diff --git a/README.md b/README.md index 758e4b7d23a2ba5835307a736968042e621c6d9c..49dab54424059e9cea46bab3d0904dd5b3e44b35 100644 --- a/README.md +++ b/README.md @@ -8,8 +8,10 @@ 该项目介绍,如何在飞腾信息科技有限公司SOC硬件平台上运行 OpenHarmony 标准系统[OpenHamony 5.0.0 release](https://gitee.com/openharmony/docs/blob/master/zh-cn/release-notes/OpenHarmony-v5.0.0-release.md)。其中腾锐D系列芯片没有图形模块,需要搭配显卡使用,目前仓库中支持的显卡包含飞腾X100套片、AMD显卡、JM9100显卡,以及cpu模拟mesa3d方案。 - 支持GPU图形硬件加速,以及X100提供的视频解码硬件加速。 - 支持Linux kernel 5.10, Linux kernel 6.6。 -- 支持cpu模拟的mesa3d方案,经优化后,在E系列的芯片上也有流畅体验。 -具体支持状态详见:[开发板简介](./device_soc_phytium/README.md) +- 支持cpu模拟的mesa3d方案,经优化后,在E系列的芯片上也有流畅体验。 +- 支持根据GPU硬件自动加载正确的GL驱动。 +- 支持根据音频硬件,自动配置ALSA mixer参数。 +具体支持状态详见:[开发板简介](./device_board_phytium/README.md) ## 飞腾公司简介 飞腾信息技术有限公司(以下简称“飞腾公司”)是国内领先的自主核心芯片提供商,由中国电子信息产业集团、天津市滨海新区政府和天津先进技术研究院于2014年联合支持成立。详情请参考[飞腾官网](https://www.phytium.com.cn/homepage/index/)介绍。 @@ -101,6 +103,7 @@ export PHY_DEV=$WORK_SPACE/phytium_device mkdir $PHY_DEV cd $PHY_DEV git clone git@gitee.com:phytium_embedded/phytium-openharmony-device.git +git checkout 5.x_release ``` ## 2.2 获取未开源代码 @@ -150,10 +153,9 @@ THE DEVICE: tengrui_d(0) 通过build.sh脚本进行编译,脚本需要带入的几个必要参数说明如下表: |参数|说明| |----|----| -| --product-name |产品名称,飞腾产品对应tengrui_d,和tenglong_e| +| --product-name |产品名称,飞腾产品对应tengrui_d,tenglong_e和phytiumpi-firefly| | --target-cpu |产品芯片架构,飞腾产品对应为arm64| -| --gn-args gpu_model|gn扩展参数,由于不同显卡目前驱动无法兼容,飞腾扩展了一个参数gpu_model,允许用户在编译时需要根据不同的硬件添加对应的参数,即--gn-args xxx,支持x100、amd、jm、sw| -| --gn-args linux_kernel_version|gn扩展参数,配置Linux版本,默认版本是5.10,OpenHarmony 5.0.0 Release以后的版本支持指定Linux kernel 6.6, --gn-args linux_kernel_version="linux-6.6"| +| --gn-args linux_kernel_version|gn扩展参数,配置Linux版本,OpenHarmony 5.0.0 Release默认的Linux内核版本是5.10,以后的版本支持指定Linux kernel 6.6, --gn-args linux_kernel_version="linux-6.6"| | --ccache |通过ccache加快编译速度| 更多的编译参数说明,可以通过./build.sh --help获取。 @@ -161,19 +163,9 @@ THE DEVICE: tengrui_d(0) ``` cd $PROJ_ROOT -#### 如果显卡是X100 -./build.sh --product-name tengrui_d --ccache --target-cpu arm64 --gn-args gpu_model=x100 - -#### 如果显卡是AMD -./build.sh --product-name tengrui_d --ccache --target-cpu arm64 --gn-args gpu_model=amd - -#### 如果显卡是JM9100 -./build.sh --product-name tengrui_d --ccache --target-cpu arm64 --gn-args gpu_model=jm - -#### 如果没有显卡,可采用cpu模拟的mesa3d方案 -./build.sh --product-name tengrui_d --ccache --target-cpu arm64 --gn-args gpu_model=sw +#### 如果linux内核版本是6.6 +./build.sh --product-name tengrui_d --ccache --target-cpu arm64 --gn-args linux_kernel_version="linux-6.6" ``` - 编译成功提示: ``` @@ -181,8 +173,6 @@ post_process =====build tengrui_d successful. ``` -> 注:JM内核驱动暂未对Linux kernel 6.6进行适配,linux_kernel_version="linux-6.6"与gpu_model=jm同时配置时,会编译失败。 - 编译生成的文件 ``` @@ -195,18 +185,17 @@ $PROJ_ROOT/out/tengrui_d/packages/phone/images/ramdisk.img >1. boot.img分区镜像格式为fat32,既支持boot启动也支持UEFI启动。 >2. boot分区镜像中主要包含内核镜像Image,ramdisk.img,以及uboot启动必备的设备树文件,UEFI启动必备的引导文件。 - # 镜像烧写 目前提供了两种镜像烧录方式,***按分区烧录***与***整体镜像烧录***,可以根据硬件形态选择其中一种合适的烧录方式。 ## 4.1 按分区烧录 1.硬盘分区: -准备一块SATA硬盘,删除原有分区后,在linux下,使用fdsik命令分区,创建4个分区,依次为boot,system,vendor,userdata,根据实际情况设定,比如可以设定为64M,1.5G,500M,1G。 +准备一块SATA硬盘,删除原有分区后,在linux下,使用fdsik命令分区,创建4个分区,依次为boot,system,vendor,userdata,根据实际情况设定,比如可以设定为256M,2G,1G,2G。 ``` -p1 64MB for BOOT/EFI -p2 1.5GB for system -p3 500MB for vendor -p4 1G for data +p1 256MB for BOOT/EFI +p2 2GB for system +p3 1GB for vendor +p4 2GB for data ``` > fdisk命令详细使用方法可自行百度谷歌,或者参考[飞腾嵌入式 LINUX 用户 > 手册](https://gitee.com/phytium_embedded/phytium-sdk/blob/master/%E9%A3%9E%E8%85%BE%E5%B5%8C%E5%85%A5%E5%BC%8FLinux%E7%94%A8%E6%88%B7%E6%89%8B%E5%86%8C.pdf)中的磁盘分区部分内容。 @@ -264,7 +253,8 @@ $sudo dd if=openharmony_img_xxx.img of=/dev/sdb bs=1M ## 5.1 Uboot启动 -在开机阶段,按回车,设置uboot环境变量 +在开机阶段,按回车,设置uboot环境变量。 +tengrui_d插显卡启动参数设置参考: ``` setenv bootargs console=ttyAMA1,115200 root=/dev/ram0 elevator=deadline rootwait rw loglevel=1 hardware=tengrui_d rootfstype=ext4 initrd=0x93000000,90M @@ -275,12 +265,19 @@ saveenv boot ``` - ->注:使用tenglong_e时hardward也要相应改为tenglong_e +- bootargs中“hardware”对应平台种类,会影响fstab的选取,tenglong_e时,hardward相应改为tenglong_e,phytiumpi-firefly时改成phytiumpi-firefly。 +- bootcmd中加载镜像的指令“fatload scsi 0:1 0x90200000 Image”中:“fatload”表示是从fat32格式的分区中加载数据,“scsi 0:1”表示是标号为0的scsi(sata)设备的第1个分区,“0x90200000”表示需要把数据加载到的内存地址,“Image”表示需要加载的文件。要根据不同介质和分区格式类型,灵活选择正确的指令,可以参考wiki文档[Openharmony多种存储介质配置说明](https://gitee.com/phytium_embedded/phytium-openharmony-device/wikis/%E9%95%9C%E5%83%8F%E7%94%9F%E6%88%90%E4%B8%8E%E7%83%A7%E5%BD%95/Openharmony%E5%A4%9A%E7%A7%8D%E5%AD%98%E5%82%A8%E4%BB%8B%E8%B4%A8%E9%85%8D%E7%BD%AE%E8%AF%B4%E6%98%8E)。 +- 如果tenglong_e搭配gpu使用的设备树是pe2204-demo-ddr4-nopb.dtb,使用sw方案使用设备树pe2204-demo-ddr4.dtb。 ## 5.2 UEFI启动 -启动参数已经在烧写EFI分区时已写好,上电后,会直接进入系统。 +UEFI的启动参数配置在boot分区/EFI/BOOT/grub.cfg文件中,源码路径: +``` +device_board_phytium//loader/EFI/BOOT/grub.cfg +``` +默认配置的参数能支持大部分场景启动,上电后,会直接进入系统。 +grub.cfg配置启动部分的参数与uboot的类似,可以根据具体情况进行调整。 +>另:还可以在loader选择界面,选择Updater选项进入Updater模式。 ## 5.3 sw模式启动参数 gpu_model=sw模式下,cpu模拟mesa,需要给DC预留更多内存才能正常启动,需要在启动参数中增加相关配置。 @@ -296,9 +293,9 @@ setenv bootargs console=ttyAMA1,115200 root=/dev/ram0 elevator=deadline rootwait # 维护者邮箱 飞腾信息技术有限公司 +xiayan1086@phytium.com.cn zhangjianwei@phytium.com.cn tangkaiwen@phytium.com.cn -xiayan1086@phytium.com.cn libowen1180@phytium.com.cn chenzigui1762@phytium.com.cn liucaicheng1476@phytium.com.cn diff --git a/device_board_phytium/README.md b/device_board_phytium/README.md index 902435aef0cbf331ad36268d9f1b864a3e2289b2..0842b08e5c32e7493ce18fa42c06f6c34363b73b 100644 --- a/device_board_phytium/README.md +++ b/device_board_phytium/README.md @@ -32,7 +32,7 @@ OH 4.1
Kernel 5.10 OH 5.0.0
Kernel 5.10 - OH 5.0.0
Kernel 6.6
(E系列暂不支持) + OH 5.0.0
Kernel 6.6 sw @@ -55,12 +55,12 @@ 景嘉微 JM9100 支持3D硬件加速 - 不支持,暂未适配 - 不支持,编译失败 + 支持3D硬件加速 + 支持3D硬件加速 amd - AND + AMD RX550、RX640、RX570 支持3D硬件加速 支持3D硬件加速 @@ -68,8 +68,8 @@ RX6400 - 不支持 - 不支持 + Linux Kernel不支持 + Linux Kernel不支持 支持3D硬件加速 diff --git a/device_board_phytium/common/audio_alsa/codec_config/config.h b/device_board_phytium/common/audio_alsa/codec_config/config.h new file mode 100644 index 0000000000000000000000000000000000000000..604cbb60dff4547943159784faeb6b982a0207a7 --- /dev/null +++ b/device_board_phytium/common/audio_alsa/codec_config/config.h @@ -0,0 +1,30 @@ + +#ifndef _CONFIG_H_ +#define _CONFIG_H_ + +struct config_control +{ + const char *ctl_name; //name of control. + const char *str_val; //value of control, which type is stream. + const int int_val[2]; //left and right value of control, which type are int. +}; + +struct config_route +{ + const struct config_control *controls; + const unsigned controls_count; +}; + +struct config_route_table +{ + const struct config_route speaker_normal; + const struct config_route main_mic_capture; + const struct config_route playback_on; + const struct config_route playback_off; + const struct config_route capture_on; + const struct config_route capture_off; +}; + +#define DEVICES_0 0 + +#endif //_CONFIG_H_ diff --git a/device_board_phytium/common/audio_alsa/codec_config/config_list.h b/device_board_phytium/common/audio_alsa/codec_config/config_list.h new file mode 100644 index 0000000000000000000000000000000000000000..84a9b5db4fdbdf69d1ab79bfec4b024245d661bc --- /dev/null +++ b/device_board_phytium/common/audio_alsa/codec_config/config_list.h @@ -0,0 +1,27 @@ + +#ifndef _CONFIG_LIST_H_ +#define _CONFIG_LIST_H_ + +#include "config.h" +#include "default_config.h" +#include "fthda_config.h" +#include "es8336_config.h" + +struct alsa_sound_card_config +{ + const char *sound_card_name; + const struct config_route_table *route_table; +}; + +struct alsa_sound_card_config sound_card_config_list[] = { + { + .sound_card_name = "fthda", + .route_table = &fthda_config_table, + }, + { + .sound_card_name = "phytiumpe220xi2", + .route_table = &es8336_config_table, + } +}; + +#endif //_CONFIG_LIST_H_ diff --git a/device_board_phytium/common/audio_alsa/codec_config/default_config.h b/device_board_phytium/common/audio_alsa/codec_config/default_config.h new file mode 100644 index 0000000000000000000000000000000000000000..4741f7290500b56807c7838cedc8deaf53f73eab --- /dev/null +++ b/device_board_phytium/common/audio_alsa/codec_config/default_config.h @@ -0,0 +1,88 @@ +#ifndef _DEFAULT_CONFIG_H_ +#define _DEFAULT_CONFIG_H_ + +#include "config.h" + +const struct config_control default_speaker_normal_controls[] = { + { + .ctl_name = "Playback Path", + .str_val = "SPK", + }, +}; + + +const struct config_control default_main_mic_capture_controls[] = { + { + .ctl_name = "Capture MIC Path", + .str_val = "Main Mic", + }, +}; + +const struct config_control default_playback_on_controls[] = { + { + .ctl_name = "Playback Path", + .str_val = "on", + }, +}; + +const struct config_control default_playback_off_controls[] = { + { + .ctl_name = "Playback Path", + .str_val = "off", + }, +}; + +const struct config_control default_capture_on_controls[] = { + { + .ctl_name = "Capture MIC Path", + .str_val = "on", + }, +}; + +const struct config_control default_capture_off_controls[] = { + { + .ctl_name = "Capture MIC Path", + .str_val = "off", + }, +}; + +const struct config_route_table default_config_table = { + //speaker init + .speaker_normal = { + .controls = default_speaker_normal_controls, + .controls_count = sizeof(default_speaker_normal_controls) / sizeof(struct config_control), + }, + + //capture init + .main_mic_capture = { + .controls = default_main_mic_capture_controls, + .controls_count = sizeof(default_main_mic_capture_controls) / sizeof(struct config_control), + }, + + //playback on + .playback_on = { + .controls = default_playback_on_controls, + .controls_count = sizeof(default_playback_on_controls) / sizeof(struct config_control), + }, + + //playback off + .playback_off = { + .controls = default_playback_off_controls, + .controls_count = sizeof(default_playback_off_controls) / sizeof(struct config_control), + }, + + //capture on + .capture_on = { + .controls = default_capture_on_controls, + .controls_count = sizeof(default_capture_on_controls) / sizeof(struct config_control), + }, + + //capture off + .capture_off = { + .controls = default_capture_off_controls, + .controls_count = sizeof(default_capture_off_controls) / sizeof(struct config_control), + }, +}; + + +#endif //_DEFAULT_CONFIG_H_ diff --git a/device_board_phytium/common/audio_alsa/codec_config/es8336_config.h b/device_board_phytium/common/audio_alsa/codec_config/es8336_config.h new file mode 100644 index 0000000000000000000000000000000000000000..e5db998604ec886e04318a96b3d007e231d152b4 --- /dev/null +++ b/device_board_phytium/common/audio_alsa/codec_config/es8336_config.h @@ -0,0 +1,70 @@ +#ifndef _ES8336_CONFIG_H_ +#define _ES8336_CONFIG_H_ + +#include "config.h" + +const struct config_control es8336_speaker_normal_controls[] = { + { + .ctl_name = "DAC Playback Volume", + .str_val = "188,188", /* min:0; max:192 */ + }, +}; + +const struct config_control es8336_main_mic_capture_controls[] = { + { + .ctl_name = "Differential Mux", + .str_val = "1", + /* Item #0 'lin1-rin1' */ + /* Item #1 'lin2-rin2' */ + /* Item #2 'lin1-rin1 with 15db Boost' */ + /* Item #3 'lin2-rin2 with 15db Boost' */ + }, +}; + +const struct config_control es8336_playback_on_controls[] = { +}; + +const struct config_control es8336_playback_off_controls[] = { +}; + +const struct config_control es8336_capture_on_controls[] = { +}; + +const struct config_control es8336_capture_off_controls[] = { +}; + +const struct config_route_table es8336_config_table = { + //speaker init + .speaker_normal = { + .controls = es8336_speaker_normal_controls, + .controls_count = sizeof(es8336_speaker_normal_controls) / sizeof(struct config_control), + }, + //capture init + .main_mic_capture = { + .controls = es8336_main_mic_capture_controls, + .controls_count = sizeof(es8336_main_mic_capture_controls) / sizeof(struct config_control), + }, + //playback on + .playback_on = { + .controls = es8336_playback_on_controls, + .controls_count = sizeof(es8336_playback_on_controls) / sizeof(struct config_control), + }, + //playback off + .playback_off = { + .controls = es8336_playback_off_controls, + .controls_count = sizeof(es8336_playback_off_controls) / sizeof(struct config_control), + }, + //capture on + .capture_on = { + .controls = es8336_capture_on_controls, + .controls_count = sizeof(es8336_capture_on_controls) / sizeof(struct config_control), + }, + //capture off + .capture_off = { + .controls = es8336_capture_off_controls, + .controls_count = sizeof(es8336_capture_off_controls) / sizeof(struct config_control), + }, +}; + + +#endif //_ES8336_CONFIG_H_ diff --git a/device_board_phytium/common/audio_alsa/codec_config/fthda_config.h b/device_board_phytium/common/audio_alsa/codec_config/fthda_config.h new file mode 100644 index 0000000000000000000000000000000000000000..ed5d6d47a6b948ee2357ab1dcd49d127eeddd051 --- /dev/null +++ b/device_board_phytium/common/audio_alsa/codec_config/fthda_config.h @@ -0,0 +1,98 @@ +#ifndef _FTHDA_CONFIG_H_ +#define _FTHDA_CONFIG_H_ + +#include "config.h" + +const struct config_control fthda_speaker_normal_controls[] = { + { + .ctl_name = "Master Playback Volume", + .str_val = "80", /* min:0; max:87 */ + }, + { + .ctl_name = "Master Playback Switch", + .str_val = "on", + }, +}; + +const struct config_control fthda_main_mic_capture_controls[] = { + { + .ctl_name = "Capture Volume", + .str_val = "56,56", /* min:0; max:63 */ + }, + { + .ctl_name = "Capture Switch", + .str_val = "on,on", + }, + { + .ctl_name = "Input Source", + .str_val = "1", /* 0:Front Mic; 1:Rear Mic; 2:Line */ + }, + { + .ctl_name = "Rear Mic Boost Volume", + .str_val = "2,2", /* min:0; max:3 */ + }, +}; + +const struct config_control fthda_playback_on_controls[] = { + { + .ctl_name = "Master Playback Switch", + .str_val = "on", + }, +}; + +const struct config_control fthda_playback_off_controls[] = { + { + .ctl_name = "Master Playback Switch", + .str_val = "off", + }, +}; + +const struct config_control fthda_capture_on_controls[] = { + { + .ctl_name = "Capture Switch", + .str_val = "on,on", + }, +}; + +const struct config_control fthda_capture_off_controls[] = { + { + .ctl_name = "Capture Switch", + .str_val = "off,off", + }, +}; + +const struct config_route_table fthda_config_table = { + //speaker init + .speaker_normal = { + .controls = fthda_speaker_normal_controls, + .controls_count = sizeof(fthda_speaker_normal_controls) / sizeof(struct config_control), + }, + //capture init + .main_mic_capture = { + .controls = fthda_main_mic_capture_controls, + .controls_count = sizeof(fthda_main_mic_capture_controls) / sizeof(struct config_control), + }, + //playback on + .playback_on = { + .controls = fthda_playback_on_controls, + .controls_count = sizeof(fthda_playback_on_controls) / sizeof(struct config_control), + }, + //playback off + .playback_off = { + .controls = fthda_playback_off_controls, + .controls_count = sizeof(fthda_playback_off_controls) / sizeof(struct config_control), + }, + //capture on + .capture_on = { + .controls = fthda_capture_on_controls, + .controls_count = sizeof(fthda_capture_on_controls) / sizeof(struct config_control), + }, + //capture off + .capture_off = { + .controls = fthda_capture_off_controls, + .controls_count = sizeof(fthda_capture_off_controls) / sizeof(struct config_control), + }, +}; + + +#endif //_FTHDA_CONFIG_H_ diff --git a/device_board_phytium/common/audio_alsa/common.c b/device_board_phytium/common/audio_alsa/common.c new file mode 100644 index 0000000000000000000000000000000000000000..3e480cfb029c119e593751851f6af2ffa6af8c48 --- /dev/null +++ b/device_board_phytium/common/audio_alsa/common.c @@ -0,0 +1,137 @@ +/* + * Copyright (c) 2025 Phyitum Technology Co., Ltd. + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#include "common.h" +#include "codec_config/config_list.h" +#define MAX_SND_CARDS 2 + + +const struct config_route_table *route_table = NULL; + +int32_t AlsaRouteInit(void) +{ + char soundCardID[20] = ""; + char str[32]= ""; + FILE * fp = NULL; + unsigned i, config_count = sizeof(sound_card_config_list) / sizeof(struct alsa_sound_card_config); + size_t read_size; + int32_t card = 0; + + AUDIO_FUNC_LOGI("AUDIO route_init()"); + + for(card = 0;card < MAX_SND_CARDS; card++) { + sprintf_s(str,sizeof(str),"/proc/asound/card%d/id",card); + AUDIO_FUNC_LOGI("AUDIO route_init() str=%s",str); + if(access(str, 0)) { + continue; + } + fp = fopen(str, "r"); + if (!fp) { + AUDIO_FUNC_LOGE("read %s failed", str); + continue; + } + read_size = fread(soundCardID, sizeof(char), sizeof(soundCardID)/sizeof(char), fp); + fclose(fp); + AUDIO_FUNC_LOGE("AUDIO route_init() read_size=%zu, %lu",read_size,sizeof(soundCardID)/sizeof(char)); + if (read_size == 0 || read_size > sizeof(soundCardID)/sizeof(char)) + continue; + if (soundCardID[read_size - 1] == '\n') { + read_size--; + soundCardID[read_size] = '\0'; + } + AUDIO_FUNC_LOGE("card[%d] Name is %s", card,soundCardID); + + for (i = 0; i < config_count; i++) { + if (!(sound_card_config_list + i) || !sound_card_config_list[i].sound_card_name || + !sound_card_config_list[i].route_table) + continue; + + if (strncmp(sound_card_config_list[i].sound_card_name, soundCardID,read_size) == 0) { + route_table = sound_card_config_list[i].route_table; + AUDIO_FUNC_LOGI("Get route table for sound card %s", soundCardID); + break; + } + } + } + if (!route_table) { + route_table = &default_config_table; + AUDIO_FUNC_LOGE("Can not get config table for sound card0 %s, so get default config table.", soundCardID); + return HDF_FAILURE; + } + + return HDF_SUCCESS; +} + +const struct config_route *get_route_config(enum AlsaAudioRoute route) +{ + AUDIO_FUNC_LOGD("get_route_config() route %d", route); + + if (!route_table) { + AUDIO_FUNC_LOGE("get_route_config() route_table is NULL!"); + return NULL; + } + switch (route) { + case SPEAKER_NORMAL_ROUTE: + AUDIO_FUNC_LOGD("SPEAKER_NORMAL_ROUTE"); + return &(route_table->speaker_normal); + case MAIN_MIC_CAPTURE_ROUTE: + return &(route_table->main_mic_capture); + case PLAYBACK_ON_ROUTE: + return &(route_table->playback_on); + case PLAYBACK_OFF_ROUTE: + return &(route_table->playback_off); + case CAPTURE_ON_ROUTE: + return &(route_table->capture_on); + case CAPTURE_OFF_ROUTE: + return &(route_table->capture_off); + default: + AUDIO_FUNC_LOGE("get_route_config() Error route %d", route); + return NULL; + } +} + +int32_t AlsaElementsSet(struct AlsaSoundCard *cardIns,enum AlsaAudioRoute route) +{ + int32_t i,ret; + unsigned int numid; + struct AlsaMixerCtlElement elem; + const struct config_route *route_info; + + CHECK_NULL_PTR_RETURN_DEFAULT(cardIns); + + route_info = get_route_config(route); + if(route_info->controls[0].ctl_name==NULL || route_info->controls[0].str_val==NULL){ + AUDIO_FUNC_LOGD("ctl_name or str_val is NULL in config file,no need to set elem"); + return HDF_SUCCESS; + } + for(i=0;icontrols_count;i++){ + SndElementItemInit(&elem); + elem.name = (char*)route_info->controls[i].ctl_name; + elem.value = (char*)route_info->controls[i].str_val; + ret = SndElementReadNumid(cardIns,&elem,&numid); + AUDIO_FUNC_LOGD("AlsaElementsSet controls[%d] name=%s,value=%s numid=%d",i,elem.name,elem.value,numid); + if (ret != HDF_SUCCESS) { + AUDIO_FUNC_LOGE("AlsaElementsSet can't find elem name=%s !!!",elem.name); + continue; + } + elem.numid=numid; + ret = SndElementWrite(cardIns,&elem); + if (ret != HDF_SUCCESS) { + AUDIO_FUNC_LOGE("SndElementWrite fail!"); + return HDF_FAILURE; + } + } + return HDF_SUCCESS; +} diff --git a/device_board_phytium/common/audio_alsa/common.h b/device_board_phytium/common/audio_alsa/common.h new file mode 100644 index 0000000000000000000000000000000000000000..9184730ad7486457133681c57fc280e0b76ffd45 --- /dev/null +++ b/device_board_phytium/common/audio_alsa/common.h @@ -0,0 +1,36 @@ +/* + * Copyright (c) 2024 Phyitum Technology Co., Ltd. + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#ifndef ALSA_SND_COMMON_H +#define ALSA_SND_COMMON_H + +#include "alsa_snd_render.h" + +enum AlsaAudioRoute{ + SPEAKER_NORMAL_ROUTE = 0, + MAIN_MIC_CAPTURE_ROUTE, + PLAYBACK_ON_ROUTE, + PLAYBACK_OFF_ROUTE, + CAPTURE_ON_ROUTE, + CAPTURE_OFF_ROUTE, + MAX_ROUTE +}; + +int32_t AlsaRouteInit(void); +const struct config_route *get_route_config(enum AlsaAudioRoute route); +int32_t AlsaElementsSet(struct AlsaSoundCard *cardIns,enum AlsaAudioRoute route); + + +#endif /* ALSA_SND_COMMON_H */ diff --git a/device_board_phytium/tengrui_d/audio_alsa/vendor_capture.c b/device_board_phytium/common/audio_alsa/vendor_capture.c similarity index 74% rename from device_board_phytium/tengrui_d/audio_alsa/vendor_capture.c rename to device_board_phytium/common/audio_alsa/vendor_capture.c index 364b9e167351552af7f61b0a1821f884a605fd28..b6c74b67944398bdc26a07ae1e5d258f7e109936 100644 --- a/device_board_phytium/tengrui_d/audio_alsa/vendor_capture.c +++ b/device_board_phytium/common/audio_alsa/vendor_capture.c @@ -1,5 +1,5 @@ /* - * Copyright (c) 2024 Phyitum Technology Co., Ltd. + * Copyright (c) 2025 Phyitum Technology Co., Ltd. * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at @@ -15,6 +15,7 @@ #include "alsa_snd_capture.h" #include "common.h" +#include "codec_config/config.h" #define HDF_LOG_TAG HDF_AUDIO_HAL_CAPTURE @@ -25,11 +26,17 @@ typedef struct _CAPTURE_DATA_ { static int32_t CaptureInitImpl(struct AlsaCapture* captureIns) { - struct AlsaMixerCtlElement mixerItem; + int32_t ret; + unsigned int numid; + const struct config_route *route_info; + + + AUDIO_FUNC_LOGI("Enter CaptureInitImpl !"); if (captureIns->priData != NULL) { return HDF_SUCCESS; } CHECK_NULL_PTR_RETURN_DEFAULT(captureIns); + CHECK_NULL_PTR_RETURN_DEFAULT(&captureIns->soundCard); CaptureData *priData = (CaptureData *)OsalMemCalloc(sizeof(CaptureData)); if (priData == NULL) { @@ -37,22 +44,37 @@ static int32_t CaptureInitImpl(struct AlsaCapture* captureIns) return HDF_FAILURE; } + if(AlsaRouteInit() != HDF_SUCCESS){ + AUDIO_FUNC_LOGE("Capture RouteInit Failure!"); + return HDF_FAILURE; + } + + route_info = get_route_config(MAIN_MIC_CAPTURE_ROUTE); + + if(route_info->controls_count <= 0){ + AUDIO_FUNC_LOGE("couldn't find catpure controls!"); + return HDF_FAILURE; + } + + AUDIO_FUNC_LOGI("route_info ctl_name =%s",route_info->controls[0].ctl_name); + SndElementItemInit(&priData->ctrlVolume); - priData->ctrlVolume.numid = SND_NUMID_CAPTURE_VOLUME; - priData->ctrlVolume.name = SND_ELEM_CAPTURE_VOLUME; - CaptureSetPriData(captureIns, (CapturePriData)priData); + priData->ctrlVolume.name = (char *)route_info->controls[0].ctl_name; + ret = SndElementReadNumid(&captureIns->soundCard,&priData->ctrlVolume,&numid); + if (ret != HDF_SUCCESS) { + AUDIO_FUNC_LOGE("read numid failed!"); + return HDF_FAILURE; + } + priData->ctrlVolume.numid = numid; + AUDIO_FUNC_LOGI("cature name =%s , numid=%d",priData->ctrlVolume.name,priData->ctrlVolume.numid); - SndElementItemInit(&mixerItem); - mixerItem.numid = SND_NUMID_INPUT_SOURCE; - mixerItem.name = SND_ELEM_INPUT_SOURCE; - mixerItem.value = SND_IN_CARD_REAR_MIC; - SndElementWrite(&captureIns->soundCard, &mixerItem); + CaptureSetPriData(captureIns, (CapturePriData)priData); - SndElementItemInit(&mixerItem); - mixerItem.numid = SND_NUMID_REAR_MIC_BOOST_VOLUME; - mixerItem.name = SND_ELEM_REAR_MIC_BOOST_VOLUME; - mixerItem.value = SND_IN_REAR_MIC_BOOST_DEFAULT_VOLUME; - SndElementWrite(&captureIns->soundCard, &mixerItem); + ret = AlsaElementsSet(&captureIns->soundCard,MAIN_MIC_CAPTURE_ROUTE); + if (ret != HDF_SUCCESS) { + AUDIO_FUNC_LOGE("AlsaElementsSet MAIN_MIC_CAPTURE_ROUTE!"); + return HDF_FAILURE; + } AUDIO_FUNC_LOGI("CaptureInitImpl init success!!!"); @@ -82,7 +104,7 @@ static int32_t CaptureGetVolThresholdImpl(struct AlsaCapture *captureIns, long * } *volMin = _volMin; *volMax = _volMax; - + return HDF_SUCCESS; } @@ -110,7 +132,7 @@ static int32_t CaptureSetVolumeImpl(struct AlsaCapture *captureIns, long volume) CaptureData *priData = CaptureGetPriData(captureIns); CHECK_NULL_PTR_RETURN_DEFAULT(cardIns); CHECK_NULL_PTR_RETURN_DEFAULT(priData); - ret = SndElementWriteIntExt(cardIns, &priData->ctrlVolume, volume); + ret = SndElementWriteInt(cardIns, &priData->ctrlVolume, volume); if (ret != HDF_SUCCESS) { AUDIO_FUNC_LOGE("Write volume fail!"); return HDF_FAILURE; @@ -149,29 +171,36 @@ static int32_t CaptureSetMuteImpl(struct AlsaCapture *captureIns, bool muteFlag) static int32_t CaptureStartImpl(struct AlsaCapture *captureIns) { - struct AlsaMixerCtlElement mixerItem; + int32_t ret; + CHECK_NULL_PTR_RETURN_DEFAULT(captureIns); + CHECK_NULL_PTR_RETURN_DEFAULT(&captureIns->soundCard); - SndElementItemInit(&mixerItem); - mixerItem.numid = SND_NUMID_CAPTURE_SWITCH; - mixerItem.name = SND_ELEM_CAPTURE_SWITCH; - mixerItem.value = SND_IN_CAPTURE_SWITCH_ON; - SndElementWrite(&captureIns->soundCard, &mixerItem); - + ret = AlsaElementsSet(&captureIns->soundCard,CAPTURE_ON_ROUTE); + if (ret != HDF_SUCCESS) { + AUDIO_FUNC_LOGE("CaptureStartImpl failed!"); + return HDF_FAILURE; + } + + AUDIO_FUNC_LOGI("CaptureStartImpl success!"); return HDF_SUCCESS; } static int32_t CaptureStopImpl(struct AlsaCapture *captureIns) { - struct AlsaMixerCtlElement mixerItem; + int32_t ret; + CHECK_NULL_PTR_RETURN_DEFAULT(captureIns); + CHECK_NULL_PTR_RETURN_DEFAULT(&captureIns->soundCard); - SndElementItemInit(&mixerItem); - mixerItem.numid = SND_NUMID_CAPTURE_SWITCH; - mixerItem.name = SND_ELEM_CAPTURE_SWITCH; - mixerItem.value = SND_IN_CAPTURE_SWITCH_OFF; - SndElementWrite(&captureIns->soundCard, &mixerItem); + ret = AlsaElementsSet(&captureIns->soundCard,CAPTURE_OFF_ROUTE); + if (ret != HDF_SUCCESS) { + AUDIO_FUNC_LOGE("CaptureStopImpl failed!"); + return HDF_FAILURE; + } + CHECK_NULL_PTR_RETURN_DEFAULT(captureIns->soundCard.pcmHandle); snd_pcm_drop(captureIns->soundCard.pcmHandle); + AUDIO_FUNC_LOGI("CaptureStopImpl success!"); return HDF_SUCCESS; } @@ -219,6 +248,6 @@ int32_t CaptureOverrideFunc(struct AlsaCapture *captureIns) captureIns->GetMute = CaptureGetMuteImpl; captureIns->SetMute = CaptureSetMuteImpl; } - + return HDF_SUCCESS; } diff --git a/device_board_phytium/tenglong_e/audio_alsa/vendor_render.c b/device_board_phytium/common/audio_alsa/vendor_render.c old mode 100755 new mode 100644 similarity index 80% rename from device_board_phytium/tenglong_e/audio_alsa/vendor_render.c rename to device_board_phytium/common/audio_alsa/vendor_render.c index 132e5261de7ffa4d7878976a952ddf1ab99cc276..a932334092377f46847a81ee01fa4cd6d5b2afbd --- a/device_board_phytium/tenglong_e/audio_alsa/vendor_render.c +++ b/device_board_phytium/common/audio_alsa/vendor_render.c @@ -1,5 +1,5 @@ /* - * Copyright (c) 2024 Phyitum Technology Co., Ltd. + * Copyright (c) 2025 Phyitum Technology Co., Ltd. * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at @@ -15,6 +15,7 @@ #include "alsa_snd_render.h" #include "common.h" +#include "codec_config/config.h" #define HDF_LOG_TAG HDF_AUDIO_HAL_RENDER @@ -25,47 +26,52 @@ typedef struct _RENDER_DATA_ { static int32_t RenderInitImpl(struct AlsaRender *renderIns) { - int32_t ret; - struct AlsaMixerCtlElement elem; + int32_t ret; + unsigned int numid; + const struct config_route *route_info; struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)renderIns; - + if (renderIns->priData != NULL) { return HDF_SUCCESS; } + CHECK_NULL_PTR_RETURN_DEFAULT(renderIns); + RenderData *priData = (RenderData *)OsalMemCalloc(sizeof(RenderData)); if (priData == NULL) { AUDIO_FUNC_LOGE("Failed to allocate memory!"); return HDF_FAILURE; } - SndElementItemInit(&priData->ctrlVolume); - priData->ctrlVolume.numid = SND_NUMID_MASTER_PLAYBACK_VOLUME; - priData->ctrlVolume.name = SND_ELEM_MASTER_PLAYBACK_VOLUME; - RenderSetPriData(renderIns, (RenderPriData)priData); + if(AlsaRouteInit() != HDF_SUCCESS){ + AUDIO_FUNC_LOGE("Render RouteInit Failure!"); + return HDF_FAILURE; + } + route_info = get_route_config(SPEAKER_NORMAL_ROUTE); + if(route_info->controls_count <= 0){ + AUDIO_FUNC_LOGE("couldn't find controls!"); + return HDF_FAILURE; + } - SndElementItemInit(&elem); - elem.numid = SND_NUMID_FRONT_PLAYBACK_SWITCH; - elem.name = SND_ELEM_FRONT_PLAYBACK_SWITCH; - elem.value = SND_OUT_CARD_DACR_DACL_ON; - ret = SndElementWrite(cardIns, &elem); + AUDIO_FUNC_LOGI("route_info ctl_name =%s",route_info->controls[0].ctl_name); + SndElementItemInit(&priData->ctrlVolume); + priData->ctrlVolume.name = (char *)route_info->controls[0].ctl_name; + ret = SndElementReadNumid(cardIns,&priData->ctrlVolume,&numid); if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("open front playback switch fail!"); - return HDF_FAILURE; + AUDIO_FUNC_LOGE("read numid failed!"); + return HDF_FAILURE; } + priData->ctrlVolume.numid = numid; + AUDIO_FUNC_LOGI("priData->ctrlVolume.name =%s , priData->ctrlVolume.numid=%d",priData->ctrlVolume.name,priData->ctrlVolume.numid); + RenderSetPriData(renderIns, (RenderPriData)priData); - SndElementItemInit(&elem); - elem.numid = SND_NUMID_MASTER_PLAYBACK_VOLUME; - elem.name = SND_ELEM_MASTER_PLAYBACK_VOLUME; - elem.value = SND_OUT_PLAYBACK_DEFAULT_VOLUME; - ret = SndElementWrite(cardIns, &elem); + ret = AlsaElementsSet(&renderIns->soundCard,SPEAKER_NORMAL_ROUTE); if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("set default volume fail!"); + AUDIO_FUNC_LOGE("AlsaElementsSet SPEAKER_NORMAL_ROUTE fail!"); return HDF_FAILURE; } - AUDIO_FUNC_LOGI("RenderInitImpl success!"); return HDF_SUCCESS; } @@ -73,7 +79,7 @@ static int32_t RenderInitImpl(struct AlsaRender *renderIns) static int32_t RenderSelectSceneImpl(struct AlsaRender *renderIns, enum AudioPortPin descPins, const struct PathDeviceInfo *deviceInfo) { - AUDIO_FUNC_LOGI("Not support descPins"); + AUDIO_FUNC_LOGI("Not support descPins"); return HDF_SUCCESS; } @@ -151,61 +157,53 @@ static int32_t RenderSetMuteImpl(struct AlsaRender *renderIns, bool muteFlag) AUDIO_FUNC_LOGE("GetVolume failed!"); return HDF_FAILURE; } - + if (muteFlag) { priData->tempVolume = vol; setVol = 0; } else { setVol = priData->tempVolume; } - + renderIns->SetVolume(renderIns, setVol); if (ret != HDF_SUCCESS) { AUDIO_FUNC_LOGE("SetVolume failed!"); return HDF_FAILURE; } renderIns->muteState = muteFlag; - return HDF_SUCCESS; } static int32_t RenderStartImpl(struct AlsaRender *renderIns) { int32_t ret; - struct AlsaMixerCtlElement elem; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)renderIns; - SndElementItemInit(&elem); - elem.numid = SND_NUMID_MASTER_PLAYBACK_SWICH; - elem.name = SND_ELEM_MASTER_PLAYBACK_SWICH; - elem.value = SND_OUT_CARD_ON; + CHECK_NULL_PTR_RETURN_DEFAULT(renderIns); + CHECK_NULL_PTR_RETURN_DEFAULT(&renderIns->soundCard); - ret = SndElementWrite(cardIns, &elem); + ret = AlsaElementsSet(&renderIns->soundCard,PLAYBACK_ON_ROUTE); if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("write render fail!"); + AUDIO_FUNC_LOGE("RenderStartImpl failed!"); return HDF_FAILURE; } - AUDIO_FUNC_LOGI("RenderStartImpl success!"); + AUDIO_FUNC_LOGI("RenderStopImpl success!"); return HDF_SUCCESS; } static int32_t RenderStopImpl(struct AlsaRender *renderIns) { + int32_t ret; - struct AlsaMixerCtlElement elem; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)renderIns; - SndElementItemInit(&elem); - elem.numid = SND_NUMID_MASTER_PLAYBACK_SWICH; - elem.name = SND_ELEM_MASTER_PLAYBACK_SWICH; - elem.value = SND_OUT_CARD_OFF; - ret = SndElementWrite(cardIns, &elem); + CHECK_NULL_PTR_RETURN_DEFAULT(renderIns); + CHECK_NULL_PTR_RETURN_DEFAULT(&renderIns->soundCard); + + ret = AlsaElementsSet(&renderIns->soundCard,PLAYBACK_OFF_ROUTE); if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("write render fail!"); + AUDIO_FUNC_LOGE("RenderStoptImpl failed!"); return HDF_FAILURE; } - snd_pcm_drain(renderIns->soundCard.pcmHandle); AUDIO_FUNC_LOGI("RenderStopImpl success!"); return HDF_SUCCESS; diff --git a/device_board_phytium/common/build_kernel/BUILD.gn b/device_board_phytium/common/build_kernel/BUILD.gn index 1271c52c540f34914e14978e2bc095da2a3a3c3a..863e8ba9b756b0d7657ed3147b1109440d751ef8 100755 --- a/device_board_phytium/common/build_kernel/BUILD.gn +++ b/device_board_phytium/common/build_kernel/BUILD.gn @@ -62,6 +62,5 @@ action("build_kernel") { device_name, linux_kernel_version, rebase_path("$root_out_dir/../.."), - gpu_model, ] } diff --git a/device_board_phytium/common/build_kernel/build_dts.sh b/device_board_phytium/common/build_kernel/build_dts.sh index 7949a084ea94fa3e71634a9cff0fe30590a4a06e..cbbbcd9e6b9ca2d375558ff58754c2ee88a73320 100755 --- a/device_board_phytium/common/build_kernel/build_dts.sh +++ b/device_board_phytium/common/build_kernel/build_dts.sh @@ -23,6 +23,10 @@ if [ ! -e $DTS_SRC_DIR ]; then exit 0 fi +if [ ! -e ${DTS_TARGET_DIR} ]; then + mkdir -p ${DTS_TARGET_DIR} +fi + dts_files=$(find ${DTS_SRC_DIR} -type f -name "*.dts") if [ -n "$dts_files" ]; then cp ${DTS_SRC_DIR}/*.dts* ${DTS_TARGET_DIR} diff --git a/device_board_phytium/common/build_kernel/build_gpu.sh b/device_board_phytium/common/build_kernel/build_gpu.sh new file mode 100755 index 0000000000000000000000000000000000000000..f1e619c603a4f1e61ca20fd63c2eb48519c50400 --- /dev/null +++ b/device_board_phytium/common/build_kernel/build_gpu.sh @@ -0,0 +1,125 @@ +#!/bin/bash +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# This file contains confidential and proprietary information of +# OSWare Technology Co., Ltd +# +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. +set -e + +GPU_KERNEL_SOURCE_PATH=${1} # $(OHOS_BUILD_HOME)/vendor/phytium/gpu_model +GPU_HCK_PATH=${2}/drivers/gpu/drm/phytium # $(OHOS_BUILD_HOME)/device/soc/phytium/common/kernel/linux-xxx/drivers/gpu/drm/phytium +VPU_HCK_PATH=${2}/drivers/media/platform # $(OHOS_BUILD_HOME)/device/soc/phytium/common/kernel/linux-xxx/drivers/media/platform +KERNEL_VERSION=${3} # linux-5.10 / linux-6.6 +DEVICE_NAME=${4} # tengrui_m / tengrui_d / tenglong_e / phytiumpi-firefly + +if [[ ${DEVICE_NAME} == "phytiumpi-firefly" ]]; then + echo "[build_gpu]phytiumpi-firefly do not need gpu, pass..." + exit 0 +fi + +function error_exit(){ + echo "[build_gpu]there is ERROR , stop build_gpu.sh..." + exit 1 +} + +function warning_exit(){ + echo "[build_gpu]there is WARNING" + exit 0 +} + +function check_src_path(){ + gpu_hck_path=${1} + vpu_hck_path=${2} + + if [ ! -d ${gpu_hck_path} ]; then + echo "[build_gpu]there isn't path ${gpu_hck_path}" + error_exit + fi + + if [ ! -d ${vpu_hck_path} ]; then + echo "[build_gpu]there isn't path ${vpu_hck_path}" + error_exit + fi +} + +check_src_path ${GPU_HCK_PATH} ${VPU_HCK_PATH} + +function build_tool(){ + src_path=${1} + hck_path=${2} + + cp -r ${src_path}/* ${hck_path}/ + find "${src_path}" -maxdepth 1 -type d ! -path "${src_path}" -exec basename {} \; | while read dir_name; do + echo >> ${hck_path}/Makefile + echo "obj-y += ${dir_name}/" >> ${hck_path}/Makefile + echo >> ${hck_path}/Kconfig + echo "source \"drivers/${hck_path#*/drivers/}/${dir_name}/Kconfig\"" >> ${hck_path}/Kconfig + done +} + +function copy_src(){ + gpu_kernel_source_path=${1} + kernel_version=${2} + gpu_hck_path=${3} + vpu_hck_path=${4} + + if [ -d "${gpu_kernel_source_path}/${kernel_version}" ]; then + + gpu_path=${gpu_kernel_source_path}/${kernel_version}/gpu + vpu_path=${gpu_kernel_source_path}/${kernel_version}/vpu + + if [ -d "${gpu_path}" ] && [ "$(ls -A "${gpu_path}")" ]; then + build_tool ${gpu_path} ${gpu_hck_path} + fi + + if [ -d "${vpu_path}" ] && [ "$(ls -A "${vpu_path}")" ]; then + build_tool ${vpu_path} ${vpu_hck_path} + fi + + if [ ! -d "${gpu_path}" ] && [ ! -d "${vpu_path}" ] ; then + build_tool ${gpu_kernel_source_path}/${kernel_version} ${gpu_hck_path} + fi + + else + + gpu_path=${gpu_kernel_source_path}/gpu + vpu_path=${gpu_kernel_source_path}/vpu + + if [ -d "${gpu_path}" ] && [ "$(ls -A "${gpu_path}")" ]; then + if [ -d "${gpu_path}/${kernel_version}" ] && [ "$(ls -A "${gpu_path}/${kernel_version}")" ]; then + build_tool ${gpu_path}/${kernel_version} ${gpu_hck_path} + else + build_tool ${gpu_path} ${gpu_hck_path} + fi + fi + if [ -d "${vpu_path}" ] && [ "$(ls -A "${vpu_path}")" ]; then + if [ -d "${vpu_path}/${kernel_version}" ] && [ "$(ls -A "${vpu_path}/${kernel_version}")" ]; then + build_tool ${vpu_path}/${kernel_version} ${vpu_hck_path} + else + build_tool ${vpu_path} ${vpu_hck_path} + fi + fi + fi +} + +find "${GPU_KERNEL_SOURCE_PATH}" -maxdepth 1 -type d ! -path "${GPU_KERNEL_SOURCE_PATH}" -exec basename {} \; | while read gpu_name; do + kernel_source=${GPU_KERNEL_SOURCE_PATH}/${gpu_name}/kernel_source + if [ -d ${kernel_source} ]; then + copy_src ${kernel_source} ${KERNEL_VERSION} ${GPU_HCK_PATH} ${VPU_HCK_PATH} + echo "[build_gpu] ${kernel_source} has done" + else + echo "[build_gpu] ${gpu_name} hasn't kernel_source , pass..." + fi +done + + diff --git a/device_board_phytium/common/build_kernel/build_kernel.sh b/device_board_phytium/common/build_kernel/build_kernel.sh index cd6bc09e1ee93407fdc0b5382825fd26b7ddca1d..da38472631f4a78a4ef89fa3bcaa8fa19b85d453 100755 --- a/device_board_phytium/common/build_kernel/build_kernel.sh +++ b/device_board_phytium/common/build_kernel/build_kernel.sh @@ -29,7 +29,6 @@ export PRODUCT_PATH=${6} export DEVICE_NAME=${7} export KERNEL_VERSION=${8} export OHOS_ROOT_PATH=${9} -export GPU_MODEL=${10} export KERNEL_SOURCE_PATH=${OHOS_ROOT_PATH}/device/board/phytium/common/kernel_source export KERNEL_PATCH=${KERNEL_SOURCE_PATH}/${KERNEL_VERSION}/phytium.patch @@ -41,7 +40,7 @@ export DEVICE_BOARD_PATH=${OHOS_ROOT_PATH}/device/board/phytium echo build_kernel if [ -f "${KERNEL_PATCH}" -a -f "${KERNEL_CONFIG}" ]; then pushd ${KERNEL_WORK_DIR} - ./kernel_module_build.sh ${OUT_KERNEL_OBJ} ${BUILD_TYPE} ${TARGET_CPU} ${PRODUCT_PATH} ${DEVICE_NAME} ${KERNEL_VERSION} ${GPU_MODEL} + ./kernel_module_build.sh ${OUT_KERNEL_OBJ} ${BUILD_TYPE} ${TARGET_CPU} ${PRODUCT_PATH} ${DEVICE_NAME} ${KERNEL_VERSION} mkdir -p ${OHOS_OUT_PATH} rm -rf ${OHOS_OUT_PATH}/../../../kernel.timestamp @@ -61,7 +60,14 @@ if [ -f "${KERNEL_PATCH}" -a -f "${KERNEL_CONFIG}" ]; then mkdir -p ${BOOT_IMAGE_PATH}/EFI cp ${DEVICE_BOARD_PATH}/${DEVICE_NAME}/loader/EFI/* ${BOOT_IMAGE_PATH}/EFI -rf - cp ${DEVICE_BOARD_PATH}/common/tools/generate_image/* ${OHOS_OUT_PATH} -rf + + if [ "${DEVICE_NAME}" != "phytiumpi-firefly" ]; then + cp ${DEVICE_BOARD_PATH}/common/tools/generate_image/* ${OHOS_OUT_PATH} -rf + rm -rf ${DEVICE_BOARD_PATH}/common/tools/generate_image/uboot/ + else + cp ${DEVICE_BOARD_PATH}/common/tools/generate_image/* ${OHOS_OUT_PATH} -rf + fi + popd else diff --git a/device_board_phytium/common/build_kernel/kernel.mk b/device_board_phytium/common/build_kernel/kernel.mk index a092b1106f96a45d2ec43319dc937491f52551f7..2f098c356c97b2758df2f51cda359234502dcf1f 100755 --- a/device_board_phytium/common/build_kernel/kernel.mk +++ b/device_board_phytium/common/build_kernel/kernel.mk @@ -26,7 +26,6 @@ endif KERNEL_SRC_PATH := $(OHOS_BUILD_HOME)/kernel/linux/${KERNEL_VERSION} KERNEL_PATCH_PATH := $(OHOS_BUILD_HOME)/kernel/linux/patches/${KERNEL_VERSION} PHYTIUM_PATCH_PATH := $(OHOS_BUILD_HOME)/device/board/phytium/common/kernel_source/${KERNEL_VERSION} -GPU_KERNEL_PATH := $(OHOS_BUILD_HOME)/vendor/phytium/gpu_model/${GPU_MODEL}/kernel_source/${KERNEL_VERSION} PREBUILTS_GCC_DIR := $(OHOS_BUILD_HOME)/prebuilts/gcc CLANG_HOST_TOOLCHAIN := $(OHOS_BUILD_HOME)/prebuilts/clang/ohos/linux-x86_64/llvm/bin @@ -51,17 +50,25 @@ KERNEL_MAKE := \ PATH="$(CLANG_HOST_TOOLCHAIN):$$PATH" \ $(KERNEL_PREBUILT_MAKE) + +HCK_PATH := $(OHOS_BUILD_HOME)/device/soc/phytium/common/kernel/${KERNEL_VERSION} + KERNEL_IMAGE_FILE := $(KERNEL_SRC_TMP_PATH)/arch/$(KERNEL_ARCH)/boot/$(KERNEL_IMAGE) DEFCONFIG_FILE := phytium_standard_defconfig $(KERNEL_IMAGE_FILE): echo "build kernel... " $(hide) rm -rf $(KERNEL_SRC_TMP_PATH);mkdir -p $(KERNEL_SRC_TMP_PATH);cp -arfL $(KERNEL_SRC_PATH)/* $(KERNEL_SRC_TMP_PATH) - $(hide) $(OHOS_BUILD_HOME)/device/board/phytium/common/build_kernel/patch_phytium.sh $(PHYTIUM_PATCH_PATH) $(KERNEL_SRC_TMP_PATH) $(GPU_KERNEL_PATH) + + $(hide) $(OHOS_BUILD_HOME)/device/board/phytium/common/build_kernel/build_gpu.sh $(OHOS_BUILD_HOME)/vendor/phytium/gpu_model $(HCK_PATH) ${KERNEL_VERSION} $(DEVICE_NAME) + + $(hide) $(OHOS_BUILD_HOME)/device/board/phytium/common/build_kernel/patch_phytium.sh $(PHYTIUM_PATCH_PATH) $(KERNEL_SRC_TMP_PATH) + + $(hide) $(OHOS_BUILD_HOME)/device/board/phytium/common/build_kernel/merge_hck.sh ${HCK_PATH} ${KERNEL_SRC_TMP_PATH} ifeq ($(KERNEL_VERSION), linux-5.10) $(hide) $(OHOS_BUILD_HOME)/drivers/hdf_core/adapter/khdf/linux/patch_hdf.sh $(OHOS_BUILD_HOME) $(KERNEL_SRC_TMP_PATH) $(KERNEL_PATCH_PATH) $(DEVICE_NAME) endif - $(hide) cp $(PHYTIUM_PATCH_PATH)/${DEFCONFIG_FILE} $(KERNEL_SRC_TMP_PATH)/arch/$(KERNEL_ARCH)/configs/ + $(hide) mkdir -p $(KERNEL_SRC_TMP_PATH)/arch/$(KERNEL_ARCH)/configs/;cp $(PHYTIUM_PATCH_PATH)/${DEFCONFIG_FILE} $(KERNEL_SRC_TMP_PATH)/arch/$(KERNEL_ARCH)/configs/ $(hide) $(OHOS_BUILD_HOME)/device/board/phytium/common/build_kernel/build_dts.sh $(OHOS_BUILD_HOME)/device/board/phytium/$(DEVICE_NAME)/dts \ $(KERNEL_SRC_TMP_PATH)/arch/$(KERNEL_ARCH)/boot/dts/phytium $(hide) $(KERNEL_MAKE) -C $(KERNEL_SRC_TMP_PATH) ARCH=$(KERNEL_ARCH) LLVM=1 LLVM_IAS=1 $(KERNEL_CROSS_COMPILE) distclean diff --git a/device_board_phytium/common/build_kernel/kernel_module_build.sh b/device_board_phytium/common/build_kernel/kernel_module_build.sh index cf2fae1a2e2204e13dc4a031b5d9bed85f503720..ea7c8eec067264b3c0ab40887e5d30192d8227e0 100755 --- a/device_board_phytium/common/build_kernel/kernel_module_build.sh +++ b/device_board_phytium/common/build_kernel/kernel_module_build.sh @@ -23,7 +23,6 @@ export KERNEL_ARCH=$3 export PRODUCT_PATH=vendor/phytium/$5 export DEVICE_NAME=$5 export KERNEL_VERSION=$6 -export GPU_MODEL=${7} LINUX_KERNEL_OUT=${OUT_DIR}/kernel/src_tmp/${KERNEL_VERSION} # it needs adaptation for more device target diff --git a/device_board_phytium/common/build_kernel/merge_hck.sh b/device_board_phytium/common/build_kernel/merge_hck.sh new file mode 100755 index 0000000000000000000000000000000000000000..ddad0307b77297624ede4cbbbba24f639aebde00 --- /dev/null +++ b/device_board_phytium/common/build_kernel/merge_hck.sh @@ -0,0 +1,58 @@ +#!/bin/bash +shopt -s nullglob dotglob + +merge_directories() { + local src_dir=$1 + local dest_dir=$2 + local type=$3 + + while IFS= read -r -d '' item; do + + local base_item=$(basename "$item") + local dest_item="$dest_dir/$base_item" + + if [ -f "$item" ]; then + if [ ! -f "$dest_item" ]; then + cp "$item" "$dest_item" + elif [[ "$base_item" == "Makefile" ]]; then + while IFS= read -r line || [[ -n "$line" ]]; do + if [[ ! "$line" =~ ^obj.*+=.*/$ ]]; then + echo "$line" >> $dest_item + fi + done < "$item" + elif [[ "$base_item" == "Kconfig" ]]; then + while IFS= read -r line || [[ -n "$line" ]]; do + if [[ ! "$line" =~ ^source.* ]]; then + echo >> $dest_item + echo "$line" >> $dest_item + fi + done < "$item" + fi + elif [ -d "$item" ]; then + if [ ! -d "$dest_item" ]; then + mkdir -p "$dest_item" + cp -r ${item}/* ${dest_item}/ + find "$item" -name "Kconfig" | while read -r kfile; do + if [[ $type == "drivers" ]]; then + echo "source \"drivers/${kfile#*/drivers/}\"" >> ${dest_dir}/Kconfig + elif [[ $type == "sound" ]]; then + echo "source \"sound/${kfile#*/sound/}\"" >> ${dest_dir}/Kconfig + fi + done + echo "obj-y += $base_item/" >> ${dest_dir}/Makefile + else + merge_directories "$item" "$dest_item" "$type" + fi + fi + done < <(find "$src_dir" -mindepth 1 -maxdepth 1 -print0) +} + +HCK="${1}" +OH_KERNEL="${2}" +DRIVER=drivers +SOUND=sound + +echo "begin merge hck..." +merge_directories "$HCK/${DRIVER}" "$OH_KERNEL/${DRIVER}" ${DRIVER} +merge_directories "$HCK/${SOUND}" "$OH_KERNEL/${SOUND}" ${SOUND} +echo "merge hck success" diff --git a/device_board_phytium/common/build_kernel/patch_phytium.sh b/device_board_phytium/common/build_kernel/patch_phytium.sh index 82d21da01421e5e3c38840475de6fd17d1c0691c..57989f99cbd8f38dc00b5c6e3850d9a1e6e1902e 100755 --- a/device_board_phytium/common/build_kernel/patch_phytium.sh +++ b/device_board_phytium/common/build_kernel/patch_phytium.sh @@ -19,7 +19,6 @@ set -e PHYTIUM_PATCH_PATH=$1 KERNEL_BUILD_ROOT=$2 -GPU_KERNEL_PATCH_PATH=$3 function patch_phytium() { @@ -40,7 +39,6 @@ function patch_phytium() function main() { patch_phytium ${PHYTIUM_PATCH_PATH} - patch_phytium ${GPU_KERNEL_PATCH_PATH} } main diff --git a/device_board_phytium/common/kernel_source/linux-5.10/phytium.patch b/device_board_phytium/common/kernel_source/linux-5.10/phytium.patch index ff8e13b1e717335bdd655a378c3c9e7796ba5b62..02952f2b1cec43ab9b2bdc4bd2ee9c1400cc3e9e 100644 --- a/device_board_phytium/common/kernel_source/linux-5.10/phytium.patch +++ b/device_board_phytium/common/kernel_source/linux-5.10/phytium.patch @@ -1156,21 +1156,6 @@ index 9b1170658..dd2db8f54 100644 subdir-y += xilinx subdir-y += zte +subdir-y += phytium -diff --git a/arch/arm64/boot/dts/phytium/Makefile b/arch/arm64/boot/dts/phytium/Makefile -new file mode 100644 -index 000000000..3a0ef31e2 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/Makefile -@@ -0,0 +1,9 @@ -+# SPDX-License-Identifier: GPL-2.0 -+ -+## pe220x general demo development board series. -+dtb-$(CONFIG_ARCH_PHYTIUM) += e2000q-demo-board.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += e2000d-demo-board.dtb -+ -+## pe220x specific industry development board series. -+dtb-$(CONFIG_ARCH_PHYTIUM) += phytiumpi_firefly.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += phytiumpi_firefly_emmc.dtb diff --git a/arch/arm64/boot/dts/phytium/e2000d-demo-board.dts b/arch/arm64/boot/dts/phytium/e2000d-demo-board.dts new file mode 100644 index 000000000..ff80c255c @@ -1427,902405 +1412,6828 @@ index 000000000..ff80c255c +&rng0 { + status = "okay"; +}; -diff --git a/arch/arm64/boot/dts/phytium/e2000q-demo-board.dts b/arch/arm64/boot/dts/phytium/e2000q-demo-board.dts -new file mode 100644 -index 000000000..3c905b3ac ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/e2000q-demo-board.dts -@@ -0,0 +1,258 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2204 demo board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * -+ * 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. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+#include "dt-bindings/gpio/gpio.h" -+ -+/{ -+ model = "Pe2204 DEMO DDR4"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@00{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x0 0x80000000>; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,pin-switches = "mic-in"; -+ simple-audio-card,widgets = "Microphone","mic-in"; -+ simple-audio-card,routing = "MIC2","mic-in"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec{ -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ /* localized demo board use this rtc device */ -+ rtc@32 { -+ compatible = "wave,sd3068"; -+ reg = <0x32>; -+ }; -+ -+ rtc@68 { -+ compatible = "dallas,ds1339"; -+ reg = <0x68>; -+ }; -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ det-gpios = <&gpio2 5 GPIO_ACTIVE_LOW>; -+ sel-gpios = <&gpio2 11 GPIO_ACTIVE_LOW>; -+ #sound-dai-cells = <0x0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ }; -+ }; -+}; -+ -+#define NOR_TIM0 (NOR_TACSEX(4)|NOR_TEADCX(6)|NOR_TCESX(1)|NOR_TEAHCX(3)) -+#define NOR_TIM1 (NOR_TACOX(0x3F)|NOR_TRADX(0x1F)|NOR_TSEQRADX(1)) -+#define NOR_TIM2 (NOR_TCSX(0xF)|NOR_TCHX(0xF)|NOR_TWPHX(4)|NOR_TWPX(0xF)) -+ -+#define GPCM_TIM0 (GPCM_TACSEX(1)|GPCM_TEADCX(4)|GPCM_TEAHCX(1)) -+#define GPCM_TIM1 (GPCM_TACOX(4)|GPCM_TAADX(1)|GPCM_TRADX(5)) -+#define GPCM_TIM2 (GPCM_TCSX(2)|GPCM_TCHX(1)|GPCM_TWPX(6)) -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; +diff --git a/arch/arm64/include/asm/arch_timer.h b/arch/arm64/include/asm/arch_timer.h +index 88d20f04c..af1fafbe7 100644 +--- a/arch/arm64/include/asm/arch_timer.h ++++ b/arch/arm64/include/asm/arch_timer.h +@@ -32,7 +32,7 @@ + ({ \ + const struct arch_timer_erratum_workaround *__wa; \ + __wa = __this_cpu_read(timer_unstable_counter_workaround); \ +- (__wa && __wa->h) ? __wa->h : arch_timer_##h; \ ++ (__wa && __wa->h) ? ({ isb(); __wa->h;}) : arch_timer_##h; \ + }) + + #else +@@ -52,8 +52,6 @@ struct arch_timer_erratum_workaround { + enum arch_timer_erratum_match_type match_type; + const void *id; + const char *desc; +- u32 (*read_cntp_tval_el0)(void); +- u32 (*read_cntv_tval_el0)(void); + u64 (*read_cntpct_el0)(void); + u64 (*read_cntvct_el0)(void); + int (*set_next_event_phys)(unsigned long, struct clock_event_device *); +@@ -64,25 +62,28 @@ struct arch_timer_erratum_workaround { + DECLARE_PER_CPU(const struct arch_timer_erratum_workaround *, + timer_unstable_counter_workaround); + +-/* inline sysreg accessors that make erratum_handler() work */ +-static inline notrace u32 arch_timer_read_cntp_tval_el0(void) ++static inline notrace u64 arch_timer_read_cntpct_el0(void) + { +- return read_sysreg(cntp_tval_el0); +-} ++ u64 cnt; + +-static inline notrace u32 arch_timer_read_cntv_tval_el0(void) +-{ +- return read_sysreg(cntv_tval_el0); +-} ++ asm volatile(ALTERNATIVE("isb\n mrs %0, cntpct_el0", ++ "nop\n" __mrs_s("%0", SYS_CNTPCTSS_EL0), ++ ARM64_HAS_ECV) ++ : "=r" (cnt)); + +-static inline notrace u64 arch_timer_read_cntpct_el0(void) +-{ +- return read_sysreg(cntpct_el0); ++ return cnt; + } + + static inline notrace u64 arch_timer_read_cntvct_el0(void) + { +- return read_sysreg(cntvct_el0); ++ u64 cnt; + -+&gpio2 { -+ status = "okay"; -+}; ++ asm volatile(ALTERNATIVE("isb\n mrs %0, cntvct_el0", ++ "nop\n" __mrs_s("%0", SYS_CNTVCTSS_EL0), ++ ARM64_HAS_ECV) ++ : "=r" (cnt)); + -+&gpio3 { -+ status = "okay"; -+}; ++ return cnt; + } + + #define arch_timer_reg_read_stable(reg) \ +@@ -102,51 +103,58 @@ static inline notrace u64 arch_timer_read_cntvct_el0(void) + * the code. + */ + static __always_inline +-void arch_timer_reg_write_cp15(int access, enum arch_timer_reg reg, u32 val) ++void arch_timer_reg_write_cp15(int access, enum arch_timer_reg reg, u64 val) + { + if (access == ARCH_TIMER_PHYS_ACCESS) { + switch (reg) { + case ARCH_TIMER_REG_CTRL: + write_sysreg(val, cntp_ctl_el0); ++ isb(); + break; +- case ARCH_TIMER_REG_TVAL: +- write_sysreg(val, cntp_tval_el0); ++ case ARCH_TIMER_REG_CVAL: ++ write_sysreg(val, cntp_cval_el0); + break; ++ default: ++ BUILD_BUG(); + } + } else if (access == ARCH_TIMER_VIRT_ACCESS) { + switch (reg) { + case ARCH_TIMER_REG_CTRL: + write_sysreg(val, cntv_ctl_el0); ++ isb(); + break; +- case ARCH_TIMER_REG_TVAL: +- write_sysreg(val, cntv_tval_el0); ++ case ARCH_TIMER_REG_CVAL: ++ write_sysreg(val, cntv_cval_el0); + break; ++ default: ++ BUILD_BUG(); + } ++ } else { ++ BUILD_BUG(); + } +- +- isb(); + } + + static __always_inline +-u32 arch_timer_reg_read_cp15(int access, enum arch_timer_reg reg) ++u64 arch_timer_reg_read_cp15(int access, enum arch_timer_reg reg) + { + if (access == ARCH_TIMER_PHYS_ACCESS) { + switch (reg) { + case ARCH_TIMER_REG_CTRL: + return read_sysreg(cntp_ctl_el0); +- case ARCH_TIMER_REG_TVAL: +- return arch_timer_reg_read_stable(cntp_tval_el0); ++ default: ++ BUILD_BUG(); + } + } else if (access == ARCH_TIMER_VIRT_ACCESS) { + switch (reg) { + case ARCH_TIMER_REG_CTRL: + return read_sysreg(cntv_ctl_el0); +- case ARCH_TIMER_REG_TVAL: +- return arch_timer_reg_read_stable(cntv_tval_el0); ++ default: ++ BUILD_BUG(); + } + } + +- BUG(); ++ BUILD_BUG(); ++ unreachable(); + } + + static inline u32 arch_timer_get_cntfrq(void) +@@ -169,7 +177,6 @@ static __always_inline u64 __arch_counter_get_cntpct_stable(void) + { + u64 cnt; + +- isb(); + cnt = arch_timer_reg_read_stable(cntpct_el0); + arch_counter_enforce_ordering(cnt); + return cnt; +@@ -179,8 +186,10 @@ static __always_inline u64 __arch_counter_get_cntpct(void) + { + u64 cnt; + +- isb(); +- cnt = read_sysreg(cntpct_el0); ++ asm volatile(ALTERNATIVE("isb\n mrs %0, cntpct_el0", ++ "nop\n" __mrs_s("%0", SYS_CNTPCTSS_EL0), ++ ARM64_HAS_ECV) ++ : "=r" (cnt)); + arch_counter_enforce_ordering(cnt); + return cnt; + } +@@ -189,7 +198,6 @@ static __always_inline u64 __arch_counter_get_cntvct_stable(void) + { + u64 cnt; + +- isb(); + cnt = arch_timer_reg_read_stable(cntvct_el0); + arch_counter_enforce_ordering(cnt); + return cnt; +@@ -199,8 +207,10 @@ static __always_inline u64 __arch_counter_get_cntvct(void) + { + u64 cnt; + +- isb(); +- cnt = read_sysreg(cntvct_el0); ++ asm volatile(ALTERNATIVE("isb\n mrs %0, cntvct_el0", ++ "nop\n" __mrs_s("%0", SYS_CNTVCTSS_EL0), ++ ARM64_HAS_ECV) ++ : "=r" (cnt)); + arch_counter_enforce_ordering(cnt); + return cnt; + } +diff --git a/arch/arm64/include/asm/cpucaps.h b/arch/arm64/include/asm/cpucaps.h +index d2080a41f..e4187003d 100644 +--- a/arch/arm64/include/asm/cpucaps.h ++++ b/arch/arm64/include/asm/cpucaps.h +@@ -67,9 +67,9 @@ + #define ARM64_MTE 57 + #define ARM64_WORKAROUND_1508412 58 + #define ARM64_SPECTRE_BHB 59 +-#define ARM64_WORKAROUND_2457168 60 +-#define ARM64_WORKAROUND_1742098 61 +- +-#define ARM64_NCAPS 62 ++#define ARM64_WORKAROUND_2457168 60 ++#define ARM64_WORKAROUND_1742098 61 ++#define ARM64_HAS_ECV 62 ++#define ARM64_NCAPS 63 + + #endif /* __ASM_CPUCAPS_H */ +diff --git a/arch/arm64/include/asm/esr.h b/arch/arm64/include/asm/esr.h +index 4a76f566e..d7638b528 100644 +--- a/arch/arm64/include/asm/esr.h ++++ b/arch/arm64/include/asm/esr.h +@@ -227,6 +227,9 @@ + #define ESR_ELx_SYS64_ISS_SYS_CNTVCT (ESR_ELx_SYS64_ISS_SYS_VAL(3, 3, 2, 14, 0) | \ + ESR_ELx_SYS64_ISS_DIR_READ) + ++#define ESR_ELx_SYS64_ISS_SYS_CNTVCTSS (ESR_ELx_SYS64_ISS_SYS_VAL(3, 3, 6, 14, 0) | \ ++ ESR_ELx_SYS64_ISS_DIR_READ) + -+&gpio4 { -+ status = "okay"; -+}; + #define ESR_ELx_SYS64_ISS_SYS_CNTFRQ (ESR_ELx_SYS64_ISS_SYS_VAL(3, 3, 0, 14, 0) | \ + ESR_ELx_SYS64_ISS_DIR_READ) + +@@ -317,6 +320,9 @@ + #define ESR_ELx_CP15_64_ISS_SYS_CNTVCT (ESR_ELx_CP15_64_ISS_SYS_VAL(1, 14) | \ + ESR_ELx_CP15_64_ISS_DIR_READ) + ++#define ESR_ELx_CP15_64_ISS_SYS_CNTVCTSS (ESR_ELx_CP15_64_ISS_SYS_VAL(9, 14) | \ ++ ESR_ELx_CP15_64_ISS_DIR_READ) + -+&gpio5 { -+ status = "okay"; -+}; + #define ESR_ELx_CP15_32_ISS_SYS_CNTFRQ (ESR_ELx_CP15_32_ISS_SYS_VAL(0, 0, 14, 0) |\ + ESR_ELx_CP15_32_ISS_DIR_READ) + +diff --git a/arch/arm64/include/asm/sysreg.h b/arch/arm64/include/asm/sysreg.h +index db39983ce..9794c7fcf 100644 +--- a/arch/arm64/include/asm/sysreg.h ++++ b/arch/arm64/include/asm/sysreg.h +@@ -453,6 +453,9 @@ + + #define SYS_CNTFRQ_EL0 sys_reg(3, 3, 14, 0, 0) + ++#define SYS_CNTPCTSS_EL0 sys_reg(3, 3, 14, 0, 5) ++#define SYS_CNTVCTSS_EL0 sys_reg(3, 3, 14, 0, 6) + -+&watchdog0 { -+ status = "okay"; + #define SYS_CNTP_TVAL_EL0 sys_reg(3, 3, 14, 2, 0) + #define SYS_CNTP_CTL_EL0 sys_reg(3, 3, 14, 2, 1) + #define SYS_CNTP_CVAL_EL0 sys_reg(3, 3, 14, 2, 2) +diff --git a/arch/arm64/kernel/cpufeature.c b/arch/arm64/kernel/cpufeature.c +index 4f6e89491..2885f3da9 100644 +--- a/arch/arm64/kernel/cpufeature.c ++++ b/arch/arm64/kernel/cpufeature.c +@@ -1769,6 +1769,16 @@ static const struct arm64_cpu_capabilities arm64_features[] = { + .sign = FTR_UNSIGNED, + .min_field_value = 1, + }, ++ { ++ .desc = "Enhanced Counter Virtualization", ++ .capability = ARM64_HAS_ECV, ++ .type = ARM64_CPUCAP_SYSTEM_FEATURE, ++ .matches = has_cpuid_feature, ++ .sys_reg = SYS_ID_AA64MMFR0_EL1, ++ .field_pos = ID_AA64MMFR0_ECV_SHIFT, ++ .sign = FTR_UNSIGNED, ++ .min_field_value = 1, ++ }, + #ifdef CONFIG_ARM64_PAN + { + .desc = "Privileged Access Never", +diff --git a/arch/arm64/kernel/traps.c b/arch/arm64/kernel/traps.c +index 10a58017d..dd19cea3b 100644 +--- a/arch/arm64/kernel/traps.c ++++ b/arch/arm64/kernel/traps.c +@@ -552,6 +552,12 @@ static const struct sys64_hook sys64_hooks[] = { + .esr_val = ESR_ELx_SYS64_ISS_SYS_CNTVCT, + .handler = cntvct_read_handler, + }, ++ { ++ /* Trap read access to CNTVCTSS_EL0 */ ++ .esr_mask = ESR_ELx_SYS64_ISS_SYS_OP_MASK, ++ .esr_val = ESR_ELx_SYS64_ISS_SYS_CNTVCTSS, ++ .handler = cntvct_read_handler, ++ }, + { + /* Trap read access to CNTFRQ_EL0 */ + .esr_mask = ESR_ELx_SYS64_ISS_SYS_OP_MASK, +@@ -628,6 +634,11 @@ static const struct sys64_hook cp15_64_hooks[] = { + .esr_val = ESR_ELx_CP15_64_ISS_SYS_CNTVCT, + .handler = compat_cntvct_read_handler, + }, ++ { ++ .esr_mask = ESR_ELx_CP15_64_ISS_SYS_MASK, ++ .esr_val = ESR_ELx_CP15_64_ISS_SYS_CNTVCTSS, ++ .handler = compat_cntvct_read_handler, ++ }, + {}, + }; + +diff --git a/arch/arm64/mm/flush.c b/arch/arm64/mm/flush.c +index 6d44c028d..1fa10d7b3 100644 +--- a/arch/arm64/mm/flush.c ++++ b/arch/arm64/mm/flush.c +@@ -78,6 +78,8 @@ EXPORT_SYMBOL(flush_dcache_page); + * Additional functions defined in assembly. + */ + EXPORT_SYMBOL(__flush_icache_range); ++EXPORT_SYMBOL(__flush_dcache_area); ++EXPORT_SYMBOL(__inval_dcache_area); + + #ifdef CONFIG_ARCH_HAS_PMEM_API + void arch_wb_cache_pmem(void *addr, size_t size) +diff --git a/drivers/acpi/acpi_apd.c b/drivers/acpi/acpi_apd.c +index 645e82a66..b7ee51710 100644 +--- a/drivers/acpi/acpi_apd.c ++++ b/drivers/acpi/acpi_apd.c +@@ -158,6 +158,16 @@ static const struct apd_device_desc hip08_lite_i2c_desc = { + .fixed_clk_rate = 125000000, + }; + ++static const struct apd_device_desc phytium_i2c_desc = { ++ .setup = acpi_apd_setup, ++ .fixed_clk_rate = 200000000, +}; + -+&watchdog1 { -+ status = "okay"; ++static const struct apd_device_desc phytium_pe220x_i2c_desc = { ++ .setup = acpi_apd_setup, ++ .fixed_clk_rate = 50000000, +}; + -+&pcie { -+ status = "okay"; -+}; + static const struct apd_device_desc thunderx2_i2c_desc = { + .setup = acpi_apd_setup, + .fixed_clk_rate = 125000000, +@@ -240,6 +250,8 @@ static const struct acpi_device_id acpi_apd_device_ids[] = { + { "HISI02A2", APD_ADDR(hip08_i2c_desc) }, + { "HISI02A3", APD_ADDR(hip08_lite_i2c_desc) }, + { "HISI0173", APD_ADDR(hip08_spi_desc) }, ++ { "PHYT0003", APD_ADDR(phytium_i2c_desc) }, ++ { "PHYT0038", APD_ADDR(phytium_pe220x_i2c_desc) }, + { "NXP0001", APD_ADDR(nxp_i2c_desc) }, + #endif + { } +diff --git a/drivers/acpi/internal.h b/drivers/acpi/internal.h +index 125e4901c..bc242c874 100644 +--- a/drivers/acpi/internal.h ++++ b/drivers/acpi/internal.h +@@ -90,6 +90,18 @@ bool acpi_scan_is_offline(struct acpi_device *adev, bool uevent); + acpi_status acpi_sysfs_table_handler(u32 event, void *table, void *context); + void acpi_scan_table_handler(u32 event, void *table, void *context); + ++#ifdef CONFIG_ACPI_GENERIC_GSI ++int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, ++ int polarity, struct fwnode_handle *fwnode); ++#else ++static inline ++int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, ++ int polarity, struct fwnode_handle *fwnode) ++{ ++ return acpi_register_gsi(dev, hwirq, trigger, polarity); ++} ++#endif + -+&usb3_0 { -+ status = "okay"; -+}; + /* -------------------------------------------------------------------------- + Device Node Initialization / Removal + -------------------------------------------------------------------------- */ +diff --git a/drivers/acpi/irq.c b/drivers/acpi/irq.c +index 6a9490ad7..86336a89f 100644 +--- a/drivers/acpi/irq.c ++++ b/drivers/acpi/irq.c +@@ -10,6 +10,8 @@ + #include + #include + ++#include "internal.h" + -+&usb3_1 { -+ status = "okay"; -+}; + enum acpi_irq_model_id acpi_irq_model; + + static struct fwnode_handle *acpi_gsi_domain_id; +@@ -38,6 +40,24 @@ int acpi_gsi_to_irq(u32 gsi, unsigned int *irq) + } + EXPORT_SYMBOL_GPL(acpi_gsi_to_irq); + ++int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, ++ int polarity, struct fwnode_handle *fwnode) ++{ ++ struct irq_fwspec fwspec; + -+&usb2_0 { -+ dr_mode = "otg"; -+ status = "okay"; -+}; ++ if (!fwnode) { ++ dev_warn(dev, "No registered irqchip for hwirq %d\n", hwirq); ++ return -EINVAL; ++ } + -+&usb2_1 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; ++ fwspec.fwnode = fwnode; ++ fwspec.param[0] = hwirq; ++ fwspec.param[1] = acpi_dev_get_irq_type(trigger, polarity); ++ fwspec.param_count = 2; + -+&usb2_2 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; ++ return irq_create_fwspec_mapping(&fwspec); ++} + -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+/* -+ * In demo board, M.2 interface may insert two types of disks: PCIE (nvme protocol) or SATA (ahci protocol), -+ * so here enable 'sata0' node by default to correspond to the sata drive case. Pin multiplexing exists -+ * in PCIE2 and SATA0, when used as a boot disk, the BIOS can automatically recognize these two conditions. -+ */ -+&sata0 { -+ status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi2 { -+ global-cs = <1>; -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000008>; -+ max-frequency = <100000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ mmc-hs200-1_8v; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-sdio; -+ no-mmc; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ dai-name = "phytium-i2s-lsd"; -+ status = "okay"; -+}; -+ -+&dc0 { -+ pipe_mask = /bits/ 8 <0x3>; -+ edp_mask = /bits/ 8 <0x0>; -+ status = "okay"; -+}; -+ -+&i2s_dp0 { -+ status = "okay"; -+}; -+ -+&i2s_dp1 { -+ status = "okay"; -+}; -+ -+&pmdk_dp { -+ num-dp = <2>; -+ dp-mask = /bits/ 8 <0x3>; -+ status = "okay"; -+}; -+ -+&rng0 { -+ status = "okay"; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2202.dtsi b/arch/arm64/boot/dts/phytium/pe2202.dtsi -new file mode 100644 -index 000000000..efafc89e4 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2202.dtsi -@@ -0,0 +1,185 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * dts file for Phytium Pe2202 SoC -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include "pe220x.dtsi" -+ -+/ { -+ compatible = "phytium,pe2202"; -+ -+ aliases { -+ ethernet0 = &macb0; -+ ethernet1 = &macb1; -+ ethernet2 = &macb2; -+ ethernet3 = &macb3; -+ }; -+}; -+ -+&cpu { -+ cpu-map { -+ cluster0 { -+ core0 { -+ cpu = <&cpu_l0>; -+ }; -+ -+ core1 { -+ cpu = <&cpu_l1>; -+ }; -+ }; -+ }; -+ -+ cpu_l0: cpu@0 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc310", "arm,armv8"; -+ reg = <0x0 0x200>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 2>; -+ }; -+ -+ cpu_l1: cpu@1 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc310", "arm,armv8"; -+ reg = <0x0 0x201>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 2>; -+ }; -+}; -+ -+&soc { -+ hda0: hda@28006000 { -+ compatible = "phytium,hda"; -+ reg = <0x0 0x28006000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ i2s0: i2s@28009000 { -+ compatible = "phytium,i2s"; -+ reg = <0x0 0x28009000 0x0 0x1000>, -+ <0x0 0x28005000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_600mhz>; -+ clock-names = "i2s_clk"; -+ status = "disabled"; -+ }; -+ -+ can0: can@2800a000 { -+ compatible = "phytium,canfd"; -+ reg = <0x0 0x2800a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_200mhz>; -+ clock-names = "can_clk"; -+ tx-fifo-depth = <64>; -+ rx-fifo-depth = <64>; -+ status = "disabled"; -+ }; -+ -+ can1: can@2800b000 { -+ compatible = "phytium,canfd"; -+ reg = <0x0 0x2800b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_200mhz>; -+ clock-names = "can_clk"; -+ tx-fifo-depth = <64>; -+ rx-fifo-depth = <64>; -+ status = "disabled"; -+ }; -+ -+ keypad: keypad@2807a000 { -+ compatible = "phytium,keypad"; -+ reg = <0x0 0x2807a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ usb3_0: usb3@31a08000 { -+ compatible = "phytium,pe220x-xhci"; -+ reg = <0x0 0x31a08000 0x0 0x18000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb3_1: usb3@31a28000 { -+ compatible = "phytium,pe220x-xhci"; -+ reg = <0x0 0x31a28000 0x0 0x18000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ sata0: sata@31a40000 { -+ compatible = "generic-ahci"; -+ reg = <0x0 0x31a40000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ sata1: sata@32014000 { -+ compatible = "generic-ahci"; -+ reg = <0x0 0x32014000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ macb0: ethernet@3200c000 { -+ compatible = "cdns,phytium-gem-1.0"; -+ reg = <0x0 0x3200c000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ , -+ , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ support-tsn; -+ status = "disabled"; -+ }; -+ -+ macb1: ethernet@3200e000 { -+ compatible = "cdns,phytium-gem-1.0"; -+ reg = <0x0 0x3200e000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ macb2: ethernet@32010000 { -+ compatible = "cdns,phytium-gem-1.0"; -+ reg = <0x0 0x32010000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ use-mii; -+ status = "disabled"; -+ }; -+ -+ macb3: ethernet@32012000 { -+ compatible = "cdns,phytium-gem-1.0"; -+ reg = <0x0 0x32012000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ use-mii; -+ status = "disabled"; -+ }; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2204.dtsi b/arch/arm64/boot/dts/phytium/pe2204.dtsi -new file mode 100644 -index 000000000..642cce46b ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2204.dtsi -@@ -0,0 +1,240 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * dts file for Phytium Pe2204 SoC -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include "pe220x.dtsi" -+ -+/ { -+ compatible = "phytium,pe2204"; -+ -+ reserved-memory { -+ #address-cells = <0x2>; -+ #size-cells = <0x2>; -+ ranges; -+ -+ rproc: rproc@b0100000 { -+ no-map; -+ reg = <0x0 0xb0100000 0x0 0x19900000>; -+ }; -+ }; -+ -+ remoteproc: remoteproc@0 { -+ compatible = "phytium,rproc"; -+ memory-region = <&rproc>; -+ status = "disabled"; -+ }; -+ -+ aliases { -+ ethernet0 = &macb0; -+ ethernet1 = &macb1; -+ ethernet2 = &macb2; -+ ethernet3 = &macb3; -+ }; -+}; -+ -+&cpu { -+ cpu-map { -+ cluster0 { -+ core0 { -+ cpu = <&cpu_b0>; -+ }; -+ }; -+ -+ cluster1 { -+ core0 { -+ cpu = <&cpu_b1>; -+ }; -+ }; -+ -+ cluster2 { -+ core0 { -+ cpu = <&cpu_l0>; -+ }; -+ -+ core1 { -+ cpu = <&cpu_l1>; -+ }; -+ }; -+ }; -+ -+ cpu_l0: cpu@0 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc310", "arm,armv8"; -+ reg = <0x0 0x200>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 2>; -+ capacity-dmips-mhz = <2850>; -+ }; -+ -+ cpu_l1: cpu@1 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc310", "arm,armv8"; -+ reg = <0x0 0x201>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 2>; -+ capacity-dmips-mhz = <2850>; -+ }; -+ -+ cpu_b0: cpu@100 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc664", "arm,armv8"; -+ reg = <0x0 0x0>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 0>; -+ capacity-dmips-mhz = <5660>; -+ }; -+ -+ cpu_b1: cpu@101 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc664", "arm,armv8"; -+ reg = <0x0 0x100>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 1>; -+ capacity-dmips-mhz = <5660>; -+ }; -+}; -+ -+&soc { -+ hda0: hda@28006000 { -+ compatible = "phytium,hda"; -+ reg = <0x0 0x28006000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ i2s0: i2s@28009000 { -+ compatible = "phytium,i2s"; -+ reg = <0x0 0x28009000 0x0 0x1000>, -+ <0x0 0x28005000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_600mhz>; -+ clock-names = "i2s_clk"; -+ status = "disabled"; -+ }; -+ -+ can0: can@2800a000 { -+ compatible = "phytium,canfd"; -+ reg = <0x0 0x2800a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_200mhz>; -+ clock-names = "can_clk"; -+ tx-fifo-depth = <64>; -+ rx-fifo-depth = <64>; -+ status = "disabled"; -+ }; -+ -+ can1: can@2800b000 { -+ compatible = "phytium,canfd"; -+ reg = <0x0 0x2800b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_200mhz>; -+ clock-names = "can_clk"; -+ tx-fifo-depth = <64>; -+ rx-fifo-depth = <64>; -+ status = "disabled"; -+ }; -+ -+ keypad: keypad@2807a000 { -+ compatible = "phytium,keypad"; -+ reg = <0x0 0x2807a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ usb3_0: usb3@31a08000 { -+ compatible = "phytium,pe220x-xhci"; -+ reg = <0x0 0x31a08000 0x0 0x18000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb3_1: usb3@31a28000 { -+ compatible = "phytium,pe220x-xhci"; -+ reg = <0x0 0x31a28000 0x0 0x18000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ sata0: sata@31a40000 { -+ compatible = "generic-ahci"; -+ reg = <0x0 0x31a40000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ sata1: sata@32014000 { -+ compatible = "generic-ahci"; -+ reg = <0x0 0x32014000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ macb0: ethernet@3200c000 { -+ compatible = "cdns,phytium-gem-1.0"; -+ reg = <0x0 0x3200c000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ , -+ , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ support-tsn; -+ status = "disabled"; -+ }; -+ -+ macb1: ethernet@3200e000 { -+ compatible = "cdns,phytium-gem-1.0"; -+ reg = <0x0 0x3200e000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ macb2: ethernet@32010000 { -+ compatible = "cdns,phytium-gem-1.0"; -+ reg = <0x0 0x32010000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ macb3: ethernet@32012000 { -+ compatible = "cdns,phytium-gem-1.0"; -+ reg = <0x0 0x32012000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ vpu0: vpu@32b00000 { -+ compatible = "phytium,vpu"; -+ reg = <0x0 0x32b00000 0x0 0x20000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe220x.dtsi b/arch/arm64/boot/dts/phytium/pe220x.dtsi -new file mode 100644 -index 000000000..694f70be2 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe220x.dtsi -@@ -0,0 +1,1017 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * dts file for Phytium Pe220x SoC -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+ -+/ { -+ compatible = "phytium,pe220x"; -+ interrupt-parent = <&gic>; -+ #address-cells = <2>; -+ #size-cells = <2>; -+ -+ aliases { -+ serial0 = &uart0; -+ serial1 = &uart1; -+ serial2 = &uart2; -+ serial3 = &uart3; -+ }; -+ -+ psci { -+ compatible = "arm,psci-1.0"; -+ method = "smc"; -+ cpu_suspend = <0xc4000001>; -+ cpu_off = <0x84000002>; -+ cpu_on = <0xc4000003>; -+ sys_poweroff = <0x84000008>; -+ sys_reset = <0x84000009>; -+ }; -+ -+ firmware { -+ scmi: scmi { -+ compatible = "arm,scmi"; -+ mboxes = <&mbox 0>; -+ mbox-names = "tx"; -+ shmem = <&cpu_scp_hpri>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ -+ scmi_dvfs: protocol@13 { -+ reg = <0x13>; -+ #clock-cells = <1>; -+ }; -+ -+ scmi_sensors0: protocol@15 { -+ reg = <0x15>; -+ #thermal-sensor-cells = <1>; -+ }; -+ }; -+ optee { -+ compatible = "linaro,optee-tz"; -+ method = "smc"; -+ }; -+ }; -+ -+ thermal-zones { -+ sensor0 { -+ polling-delay-passive = <100>; -+ polling-delay = <1000>; -+ thermal-sensors = <&scmi_sensors0 0>; -+ }; -+ -+ sensor1 { -+ polling-delay-passive = <100>; -+ polling-delay = <1000>; -+ thermal-sensors = <&scmi_sensors0 1>; -+ }; -+ }; -+ -+ cpu: cpus { -+ #address-cells = <0x2>; -+ #size-cells = <0x0>; -+ }; -+ -+ gic: interrupt-controller@30800000 { -+ compatible = "arm,gic-v3"; -+ #interrupt-cells = <3>; -+ #address-cells = <2>; -+ #size-cells = <2>; -+ ranges; -+ interrupt-controller; -+ reg = <0x0 0x30800000 0 0x20000>, /* GICD */ -+ <0x0 0x30880000 0 0x80000>, /* GICR */ -+ <0x0 0x30840000 0 0x10000>, /* GICC */ -+ <0x0 0x30850000 0 0x10000>, /* GICH */ -+ <0x0 0x30860000 0 0x10000>; /* GICV */ -+ interrupts = ; -+ -+ its: gic-its@30820000 { -+ compatible = "arm,gic-v3-its"; -+ msi-controller; -+ reg = <0x0 0x30820000 0x0 0x20000>; -+ }; -+ }; -+ -+ pmu { -+ compatible = "arm,armv8-pmuv3"; -+ interrupts = ; -+ }; -+ -+ timer { -+ compatible = "arm,armv8-timer"; -+ interrupts = , -+ , -+ , -+ ; -+ clock-frequency = <50000000>; -+ }; -+ -+ clocks { -+ #address-cells = <2>; -+ #size-cells = <2>; -+ ranges; -+ -+ sysclk_48mhz: clk48mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <48000000>; -+ }; -+ -+ sysclk_50mhz: clk50mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <50000000>; -+ }; -+ -+ sysclk_100mhz: clk100mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <100000000>; -+ }; -+ -+ sysclk_200mhz: clk200mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <200000000>; -+ }; -+ -+ sysclk_250mhz: clk250mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <250000000>; -+ }; -+ -+ sysclk_300mhz: clk300mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <300000000>; -+ }; -+ -+ sysclk_600mhz: clk600mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <600000000>; -+ }; -+ -+ sysclk_1200mhz: clk1200mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <1200000000>; -+ }; -+ }; -+ -+ smmu: iommu@30000000 { -+ compatible = "arm,smmu-v3"; -+ reg = <0x0 0x30000000 0x0 0x800000>; -+ interrupts = , -+ , -+ , -+ ; -+ interrupt-names = "eventq", "priq", "cmdq-sync", "gerror"; -+ dma-coherent; -+ #iommu-cells = <1>; -+ }; -+ -+ soc: soc { -+ compatible = "simple-bus"; -+ #address-cells = <2>; -+ #size-cells = <2>; -+ dma-coherent; -+ ranges; -+ -+ mmc0: mmc@28000000 { -+ compatible = "phytium,mci"; -+ reg = <0x0 0x28000000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_1200mhz>; -+ clock-names = "phytium_mci_clk"; -+ status = "disabled"; -+ }; -+ -+ mmc1: mmc@28001000 { -+ compatible = "phytium,mci"; -+ reg = <0x0 0x28001000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_1200mhz>; -+ clock-names = "phytium_mci_clk"; -+ status = "disabled"; -+ }; -+ -+ nand0: nand@28002000 { -+ compatible = "phytium,nfc"; -+ reg = <0x0 0x28002000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ ddma0: ddma@28003000 { -+ compatible = "phytium,ddma"; -+ reg = <0x0 0x28003000 0x0 0x1000>; -+ interrupts = ; -+ #dma-cells = <2>; -+ dma-channels = <8>; -+ }; -+ -+ ddma1: ddma@28004000 { -+ compatible = "phytium,ddma"; -+ reg = <0x0 0x28004000 0x0 0x1000>; -+ interrupts = ; -+ #dma-cells = <2>; -+ dma-channels = <8>; -+ }; -+ -+ lbc: lbc@28007000 { -+ compatible = "phytium,local-bus"; -+ #address-cells=<2>; -+ #size-cells=<1>; -+ interrupts = ; -+ reg = <0x0 0x28007000 0x0 0x1000>; -+ ranges = <0x0 0x0 0x0 0x10000000 0x1000000 -+ 0x1 0x0 0x1 0x80000000 0x1000000 -+ 0x2 0x0 0x1 0x90000000 0x1000000 -+ 0x3 0x0 0x1 0xA0000000 0x1000000 -+ 0x4 0x0 0x1 0xB0000000 0x1000000 -+ 0x5 0x0 0x1 0xC0000000 0x1000000 -+ 0x6 0x0 0x1 0xD0000000 0x1000000 -+ 0x7 0x0 0x1 0xE0000000 0x1000000>; -+ status = "disabled"; -+ }; -+ -+ qspi0: spi@28008000 { -+ compatible = "phytium,qspi-nor"; -+ reg = <0x0 0x28008000 0x0 0x1000>, -+ <0x0 0x0 0x0 0x0fffffff>; -+ reg-names = "qspi", "qspi_mm"; -+ clocks = <&sysclk_300mhz>; -+ status = "disabled"; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ -+ flash@0 { -+ compatible = "jedec,spi-nor"; -+ reg = <0x00>; -+ spi-rx-bus-width = <1>; -+ spi-max-frequency = <50000000>; -+ }; -+ }; -+ -+ uart0: uart@2800c000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2800c000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz &sysclk_100mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "disabled"; -+ }; -+ -+ uart1: uart@2800d000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2800d000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz &sysclk_100mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "disabled"; -+ }; -+ -+ uart2: uart@2800e000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2800e000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz &sysclk_100mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "disabled"; -+ }; -+ -+ uart3: uart@2800f000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2800f000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz &sysclk_100mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "disabled"; -+ }; -+ -+ lpc: lpc@28010000 { -+ compatible = "simple-mfd", "syscon"; -+ reg = <0x0 0x28010000 0x0 0x1000>; -+ reg-io-width = <4>; -+ -+ #address-cells = <1>; -+ #size-cells = <1>; -+ ranges = <0x0 0x0 0x28010000 0x1000>; -+ -+ kcs0: kcs@24 { -+ compatible = "phytium,kcs-bmc"; -+ reg = <0x24 0x1>, <0x30 0x1>, <0x3c 0x1>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ kcs1: kcs@28 { -+ compatible = "phytium,kcs-bmc"; -+ reg = <0x28 0x1>, <0x34 0x1>, <0x40 0x1>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ kcs2: kcs@2c { -+ compatible = "phytium,kcs-bmc"; -+ reg = <0x2c 0x1>, <0x38 0x1>, <0x44 0x1>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ kcs3: kcs@8c { -+ compatible = "phytium,kcs-bmc"; -+ reg = <0x8c 0x1>, <0x90 0x1>, <0x94 0x1>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ bt: bt@48 { -+ compatible = "phytium,bt-bmc"; -+ reg = <0x48 0x20>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ }; -+ -+ /* MIO */ -+ -+ gpio0: gpio@28034000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28034000 0x0 0x1000>; -+ interrupts = , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ gpio1: gpio@28035000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28035000 0x0 0x1000>; -+ interrupts = , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ gpio2: gpio@28036000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28036000 0x0 0x1000>; -+ interrupts = , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ gpio3: gpio@28037000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28037000 0x0 0x1000>; -+ interrupts = ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ gpio4: gpio@28038000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28038000 0x0 0x1000>; -+ interrupts = ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ gpio5: gpio@28039000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28039000 0x0 0x1000>; -+ interrupts = ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ spi0: spi@2803a000 { -+ compatible = "phytium,spi"; -+ reg = <0x0 0x2803a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ num-cs = <4>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ }; -+ -+ spi1: spi@2803b000 { -+ compatible = "phytium,spi"; -+ reg = <0x0 0x2803b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ num-cs = <4>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ }; -+ -+ spi2: spi@2803c000 { -+ compatible = "phytium,spi"; -+ reg = <0x0 0x2803c000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ num-cs = <4>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ }; -+ -+ spi3: spi@2803d000 { -+ compatible = "phytium,spi"; -+ reg = <0x0 0x2803d000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ num-cs = <4>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ }; -+ -+ watchdog0: watchdog@28040000 { -+ compatible = "arm,sbsa-gwdt"; -+ reg = <0x0 0x28041000 0x0 0x1000>, -+ <0x0 0x28040000 0x0 0x1000>; -+ interrupts = ; -+ timeout-sec = <30>; -+ status = "disabled"; -+ }; -+ -+ watchdog1: watchdog@28042000 { -+ compatible = "arm,sbsa-gwdt"; -+ reg = <0x0 0x28043000 0x0 0x1000>, -+ <0x0 0x28042000 0x0 0x1000>; -+ interrupts = ; -+ timeout-sec = <30>; -+ status = "disabled"; -+ }; -+ -+ pwm0: pwm@2804a000 { -+ compatible = "phytium,pwm"; -+ reg = <0x0 0x2804a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ pwm1: pwm@2804b000 { -+ compatible = "phytium,pwm"; -+ reg = <0x0 0x2804b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ tacho0: tacho@28054000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28054000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho1: tacho@28055000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28055000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho2: tacho@28056000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28056000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho3: tacho@28057000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28057000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho4: tacho@28058000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28058000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho5: tacho@28059000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28059000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho6: tacho@2805a000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho7: tacho@2805b000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho8: tacho@2805c000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805c000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho9: tacho@2805d000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805d000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho10: tacho@2805e000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805e000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho11: tacho@2805f000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805f000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho12: tacho@28060000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28060000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho13: tacho@28061000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28061000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho14: tacho@28062000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28062000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho15: tacho@28063000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28063000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho16: tacho@28064000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28064000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho17: tacho@28065000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28065000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho18: tacho@28066000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28066000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho19: tacho@28067000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28067000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho20: tacho@28068000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28068000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho21: tacho@28069000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28069000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho22: tacho@2806a000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho23: tacho@2806b000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho24: tacho@2806c000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806c000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho25: tacho@2806d000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806d000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho26: tacho@2806e000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806e000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho27: tacho@2806f000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806f000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho28: tacho@28070000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28070000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho29: tacho@28071000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28071000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho30: tacho@28072000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28072000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho31: tacho@28073000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28073000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho32: tacho@28074000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28074000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho33: tacho@28075000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28075000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho34: tacho@28076000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28076000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho35: tacho@28077000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28077000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho36: tacho@28078000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28078000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho37: tacho@28079000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28079000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ usb2_0: usb2@31800000 { /* usb_vhub0 USB2_P2 only otg mode */ -+ compatible = "phytium,usb2"; -+ reg = <0x0 0x31800000 0x0 0x80000>, -+ <0x0 0x31990000 0x0 0x10000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb2_1: usb2@31880000 { /* usb_vhub1 USB2_P2 */ -+ compatible = "phytium,usb2"; -+ reg = <0x0 0x31880000 0x0 0x80000>, -+ <0x0 0x319a0000 0x0 0x10000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb2_2: usb2@31900000 { /* usb_vhub2 USB2_P2 */ -+ compatible = "phytium,usb2"; -+ reg = <0x0 0x31900000 0x0 0x80000>, -+ <0x0 0x319b0000 0x0 0x10000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb2_3: usb2@32800000 { /* USB2_0 controller registers USB2_P3 */ -+ compatible = "phytium,usb2"; -+ reg = <0x0 0x32800000 0x0 0x40000>, -+ <0x0 0x32880000 0x0 0x40000>; /* USB2_0 UIB registers */ -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb2_4: usb2@32840000 { /* USB2_1 controller registers USB2_P4 */ -+ compatible = "phytium,usb2"; -+ reg = <0x0 0x32840000 0x0 0x40000>, -+ <0x0 0x328c0000 0x0 0x40000>; /* USB2_1 UIB registers */ -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ dc0: dc@32000000 { -+ compatible = "phytium,dc"; -+ reg = <0x0 0x32000000 0x0 0x8000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ i2s_dp0: i2s_dp0@32009000 { -+ compatible = "phytium,i2s"; -+ reg = <0x0 0x32009000 0x0 0x1000>, -+ <0x0 0x32008000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_600mhz>; -+ clock-names = "i2s_clk"; -+ dai-name = "phytium-i2s-dp0"; -+ status = "disabled"; -+ }; -+ -+ i2s_dp1: i2s_dp1@3200B000 { -+ compatible = "phytium,i2s"; -+ reg = <0x0 0x3200B000 0x0 0x1000>, -+ <0x0 0x3200A000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_600mhz>; -+ clock-names = "i2s_clk"; -+ dai-name = "phytium-i2s-dp1"; -+ status = "disabled"; -+ }; -+ -+ pmdk_dp: pmdk_dp { -+ compatible = "phytium,pmdk-dp"; -+ status = "disabled"; -+ }; -+ -+ mbox: mailbox@32a00000 { -+ compatible = "phytium,mbox"; -+ reg = <0x0 0x32a00000 0x0 0x1000>; -+ interrupts = ; -+ #mbox-cells = <1>; -+ }; -+ -+ rng0: rng@32a36000 { -+ compatible = "phytium,rng"; -+ reg = <0x0 0x32a36000 0x0 0x1000>; -+ status = "disabled"; -+ }; -+ -+ sram: sram@32a10000 { -+ compatible = "phytium,pe220x-sram-ns", "mmio-sram"; -+ reg = <0x0 0x32a10000 0x0 0x2000>; -+ -+ #address-cells = <1>; -+ #size-cells = <1>; -+ ranges = <0x0 0x0 0x32a10000 0x2000>; -+ -+ cpu_scp_lpri: scp-shmem@0 { -+ compatible = "arm,scmi-shmem"; -+ reg = <0x1000 0x400>; -+ }; -+ -+ cpu_scp_hpri: scp-shmem@1 { -+ compatible = "arm,scmi-shmem"; -+ reg = <0x1400 0x400>; -+ }; -+ }; -+ -+ hwspinlock: spinlock@32b36000 { -+ compatible = "phytium,hwspinlock"; -+ reg = <0x0 0x32b36000 0x0 0x1000>; -+ #hwlock-cells = <1>; -+ nr-locks = <32>; -+ status = "disabled"; -+ }; -+ -+ pcie: pcie@40000000 { -+ compatible = "pci-host-ecam-generic"; -+ device_type = "pci"; -+ #address-cells = <3>; -+ #size-cells = <2>; -+ #interrupt-cells = <1>; -+ reg = <0x0 0x40000000 0x0 0x10000000>; -+ msi-parent = <&its>; -+ bus-range = <0x0 0xff>; -+ interrupt-map-mask = <0x0 0x0 0x0 0x7>; -+ interrupt-map = <0x0 0x0 0x0 0x1 &gic 0x0 0x0 GIC_SPI 4 IRQ_TYPE_LEVEL_HIGH>, -+ <0x0 0x0 0x0 0x2 &gic 0x0 0x0 GIC_SPI 5 IRQ_TYPE_LEVEL_HIGH>, -+ <0x0 0x0 0x0 0x3 &gic 0x0 0x0 GIC_SPI 6 IRQ_TYPE_LEVEL_HIGH>, -+ <0x0 0x0 0x0 0x4 &gic 0x0 0x0 GIC_SPI 7 IRQ_TYPE_LEVEL_HIGH>; -+ ranges = <0x01000000 0x00 0x00000000 0x0 0x50000000 0x0 0x00f00000>, -+ <0x02000000 0x00 0x58000000 0x0 0x58000000 0x0 0x28000000>, -+ <0x03000000 0x10 0x00000000 0x10 0x00000000 0x10 0x00000000>; -+ iommu-map = <0x0 &smmu 0x0 0x10000>; -+ status = "disabled"; -+ }; -+ -+ edac: edac@32b28000 { -+ compatible = "phytium,pe220x-edac"; -+ reg = <0x0 0x32b28000 0x0 0x1000>, -+ <0x0 0x31400000 0x0 0x1000>, -+ <0x0 0x31401000 0x0 0x1000>; -+ interrupts = , -+ ; -+ }; -+ }; -+}; -diff --git a/arch/arm64/boot/dts/phytium/phytiumpi_firefly.dts b/arch/arm64/boot/dts/phytium/phytiumpi_firefly.dts -new file mode 100644 -index 000000000..eef59ef90 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/phytiumpi_firefly.dts -@@ -0,0 +1,320 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pi development board. -+ * -+ * Copyright (c) 2024 Phytium Technology Co., Ltd. -+ * -+ * Shaojun Yang -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+ -+/{ -+ model = "Phytium Pi Board"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ aliases { -+ serial4 = &mio0; -+ serial5 = &mio11; -+ serial6 = &mio15; -+ }; -+ -+ memory@00{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x2 0x00000000>; -+ }; -+ -+ leds { -+ compatible = "gpio-leds"; -+ sysled { -+ label = "sysled"; -+ gpios = <&gpio1 5 0>; -+ linux,default-trigger = "none"; -+ }; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,pin-switches = "mic-in"; -+ simple-audio-card,widgets = "Microphone","mic-in"; -+ simple-audio-card,routing = "MIC2","mic-in"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec{ -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ det-gpios = <&gpio2 11 0>; -+ sel-gpios = <&gpio2 7 0>; -+ #sound-dai-cells = <0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ }; -+ }; -+ -+ -+ mio0: uart@28014000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28014000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio1: i2c@28016000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28016000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ }; -+ -+ mio8: i2c@28024000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28024000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ }; -+ -+ mio11: uart@2802A000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2802A000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio15: uart@28032000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28032000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+}; -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&watchdog0 { -+ status = "okay"; -+}; -+ -+&watchdog1 { -+ status = "okay"; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "peripheral"; -+ status = "disabled"; -+}; -+ -+&usb2_2 { -+ dr_mode = "peripheral"; -+ status = "disabled"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb1 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&dc0 { -+ pipe_mask = /bits/ 8 <0x1>; -+ edp_mask = /bits/ 8 <0x0>; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ dai-name = "phytium-i2s-lsd"; -+ status = "okay"; -+}; -+ -+&i2s_dp0 { -+ dai-name = "phytium-i2s-dp0"; -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "okay"; -+ -+ spidev0: spidev@0 { -+ compatible = "spidev"; -+ reg = <0>; -+ spi-max-frequency = <50000000>; -+ status = "disabled"; -+ }; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-mmc; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-mmc; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&pwm0 { -+ phytium,db = <0 0 100 1000 1000 0>; -+ status = "okay"; -+}; -+ -+&pwm1 { -+ phytium,db = <0 0 100 1000 1000 0>; -+ status = "okay"; -+}; -+ -+&uart0 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&uart3 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&pmdk_dp { -+ num-dp = <1>; -+ dp-mask = /bits/ 8 <0x1>; -+ status = "okay"; -+}; -+ -+&rng0 { -+ status = "okay"; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/phytiumpi_firefly_emmc.dts b/arch/arm64/boot/dts/phytium/phytiumpi_firefly_emmc.dts -new file mode 100644 -index 000000000..95fe0187d ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/phytiumpi_firefly_emmc.dts -@@ -0,0 +1,320 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pi development board. -+ * -+ * Copyright (c) 2024 Phytium Technology Co., Ltd. -+ * -+ * Shaojun Yang -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+ -+/{ -+ model = "Phytium Pi Board"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ aliases { -+ serial4 = &mio0; -+ serial5 = &mio11; -+ serial6 = &mio15; -+ }; -+ -+ memory@00{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x2 0x00000000>; -+ }; -+ -+ leds { -+ compatible = "gpio-leds"; -+ sysled { -+ label = "sysled"; -+ gpios = <&gpio1 5 0>; -+ linux,default-trigger = "none"; -+ }; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,pin-switches = "mic-in"; -+ simple-audio-card,widgets = "Microphone","mic-in"; -+ simple-audio-card,routing = "MIC2","mic-in"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec{ -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ det-gpios = <&gpio2 11 0>; -+ sel-gpios = <&gpio2 7 0>; -+ #sound-dai-cells = <0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ }; -+ }; -+ -+ -+ mio0: uart@28014000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28014000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio1: i2c@28016000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28016000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ }; -+ -+ mio8: i2c@28024000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28024000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ }; -+ -+ mio11: uart@2802A000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2802A000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio15: uart@28032000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28032000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+}; -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&watchdog0 { -+ status = "okay"; -+}; -+ -+&watchdog1 { -+ status = "okay"; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "peripheral"; -+ status = "disabled"; -+}; -+ -+&usb2_2 { -+ dr_mode = "peripheral"; -+ status = "disabled"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb1 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&dc0 { -+ pipe_mask = /bits/ 8 <0x1>; -+ edp_mask = /bits/ 8 <0x0>; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ dai-name = "phytium-i2s-lsd"; -+ status = "okay"; -+}; -+ -+&i2s_dp0 { -+ dai-name = "phytium-i2s-dp0"; -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "okay"; -+ -+ spidev0: spidev@0 { -+ compatible = "spidev"; -+ reg = <0>; -+ spi-max-frequency = <50000000>; -+ status = "disabled"; -+ }; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000004>; -+ max-frequency = <25000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-mmc; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-mmc; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&pwm0 { -+ phytium,db = <0 0 100 1000 1000 0>; -+ status = "okay"; -+}; -+ -+&pwm1 { -+ phytium,db = <0 0 100 1000 1000 0>; -+ status = "okay"; -+}; -+ -+&uart0 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&uart3 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&pmdk_dp { -+ num-dp = <1>; -+ dp-mask = /bits/ 8 <0x1>; -+ status = "okay"; -+}; -+ -+&rng0 { -+ status = "okay"; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/configs/phytium_hdf_standard_defconfig b/arch/arm64/configs/phytium_hdf_standard_defconfig -new file mode 100644 -index 000000000..d8d4d167c ---- /dev/null -+++ b/arch/arm64/configs/phytium_hdf_standard_defconfig -@@ -0,0 +1,790 @@ -+CONFIG_LOCALVERSION="-phytium-embeded" -+# CONFIG_LOCALVERSION_AUTO is not set -+CONFIG_SYSVIPC=y -+CONFIG_POSIX_MQUEUE=y -+CONFIG_AUDIT=y -+CONFIG_NO_HZ_IDLE=y -+CONFIG_HIGH_RES_TIMERS=y -+CONFIG_PREEMPT=y -+CONFIG_IRQ_TIME_ACCOUNTING=y -+CONFIG_BSD_PROCESS_ACCT=y -+CONFIG_BSD_PROCESS_ACCT_V3=y -+CONFIG_TASK_XACCT=y -+CONFIG_TASK_IO_ACCOUNTING=y -+CONFIG_IKCONFIG=y -+CONFIG_IKCONFIG_PROC=y -+CONFIG_MEMCG=y -+CONFIG_BLK_CGROUP=y -+CONFIG_CGROUP_PIDS=y -+CONFIG_CGROUP_HUGETLB=y -+CONFIG_CPUSETS=y -+CONFIG_CGROUP_DEVICE=y -+CONFIG_CGROUP_CPUACCT=y -+CONFIG_CGROUP_PERF=y -+CONFIG_USER_NS=y -+CONFIG_SCHED_AUTOGROUP=y -+CONFIG_BLK_DEV_INITRD=y -+CONFIG_KALLSYMS_ALL=y -+# CONFIG_COMPAT_BRK is not set -+CONFIG_PROFILING=y -+CONFIG_ARCH_PHYTIUM=y -+CONFIG_ARM64_VA_BITS_48=y -+CONFIG_SCHED_MC=y -+CONFIG_SCHED_SMT=y -+CONFIG_KEXEC=y -+CONFIG_KEXEC_FILE=y -+CONFIG_CRASH_DUMP=y -+CONFIG_XEN=y -+CONFIG_COMPAT=y -+CONFIG_RANDOMIZE_BASE=y -+CONFIG_HIBERNATION=y -+CONFIG_WQ_POWER_EFFICIENT_DEFAULT=y -+CONFIG_ENERGY_MODEL=y -+CONFIG_ARM_CPUIDLE=y -+CONFIG_ARM_PSCI_CPUIDLE=y -+CONFIG_CPU_FREQ=y -+CONFIG_CPU_FREQ_STAT=y -+CONFIG_CPU_FREQ_GOV_POWERSAVE=m -+CONFIG_CPU_FREQ_GOV_USERSPACE=y -+CONFIG_CPU_FREQ_GOV_ONDEMAND=y -+CONFIG_CPU_FREQ_GOV_CONSERVATIVE=m -+CONFIG_CPUFREQ_DT=y -+CONFIG_ACPI_CPPC_CPUFREQ=m -+CONFIG_ARM_SCPI_CPUFREQ=y -+CONFIG_ARM_SCMI_CPUFREQ=y -+CONFIG_ARM_SCMI_PROTOCOL=y -+CONFIG_ARM_SCMI_TRANSPORT_FORCE_POLLING=y -+CONFIG_ARM_SCPI_PROTOCOL=y -+CONFIG_EFI_CAPSULE_LOADER=y -+CONFIG_ACPI=y -+CONFIG_ACPI_APEI=y -+CONFIG_ACPI_APEI_GHES=y -+CONFIG_ACPI_APEI_MEMORY_FAILURE=y -+CONFIG_ACPI_APEI_EINJ=y -+CONFIG_VIRTUALIZATION=y -+CONFIG_KVM=y -+CONFIG_ARM64_CRYPTO=y -+CONFIG_CRYPTO_SHA1_ARM64_CE=y -+CONFIG_CRYPTO_SHA2_ARM64_CE=y -+CONFIG_CRYPTO_SHA512_ARM64_CE=m -+CONFIG_CRYPTO_SHA3_ARM64=m -+CONFIG_CRYPTO_SM3_ARM64_CE=m -+CONFIG_CRYPTO_GHASH_ARM64_CE=y -+CONFIG_CRYPTO_CRCT10DIF_ARM64_CE=m -+CONFIG_CRYPTO_AES_ARM64_CE_CCM=y -+CONFIG_CRYPTO_AES_ARM64_CE_BLK=y -+CONFIG_CRYPTO_CHACHA20_NEON=m -+CONFIG_CRYPTO_AES_ARM64_BS=m -+CONFIG_KPROBES=y -+CONFIG_JUMP_LABEL=y -+CONFIG_MODULES=y -+CONFIG_MODULE_UNLOAD=y -+CONFIG_BLK_DEV_INTEGRITY=y -+# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set -+CONFIG_KSM=y -+CONFIG_MEMORY_FAILURE=y -+CONFIG_TRANSPARENT_HUGEPAGE=y -+CONFIG_CMA=y -+CONFIG_CMA_AREAS=19 -+CONFIG_NET=y -+CONFIG_PACKET=y -+CONFIG_UNIX=y -+CONFIG_INET=y -+CONFIG_IP_MULTICAST=y -+CONFIG_IP_PNP=y -+CONFIG_IP_PNP_DHCP=y -+CONFIG_IP_PNP_BOOTP=y -+CONFIG_IPV6=m -+CONFIG_NETFILTER=y -+CONFIG_NF_CONNTRACK=m -+CONFIG_NF_CONNTRACK_EVENTS=y -+CONFIG_NETFILTER_XT_TARGET_CHECKSUM=m -+CONFIG_NETFILTER_XT_TARGET_LOG=m -+CONFIG_NETFILTER_XT_MATCH_ADDRTYPE=m -+CONFIG_NETFILTER_XT_MATCH_CONNTRACK=m -+CONFIG_IP_NF_IPTABLES=m -+CONFIG_IP_NF_FILTER=m -+CONFIG_IP_NF_TARGET_REJECT=m -+CONFIG_IP_NF_NAT=m -+CONFIG_IP_NF_TARGET_MASQUERADE=m -+CONFIG_IP_NF_MANGLE=m -+CONFIG_IP6_NF_IPTABLES=m -+CONFIG_IP6_NF_FILTER=m -+CONFIG_IP6_NF_TARGET_REJECT=m -+CONFIG_IP6_NF_MANGLE=m -+CONFIG_IP6_NF_NAT=m -+CONFIG_IP6_NF_TARGET_MASQUERADE=m -+CONFIG_BRIDGE=m -+CONFIG_BRIDGE_VLAN_FILTERING=y -+CONFIG_NET_DSA=m -+CONFIG_NET_DSA_TAG_OCELOT=m -+CONFIG_VLAN_8021Q=m -+CONFIG_VLAN_8021Q_GVRP=y -+CONFIG_VLAN_8021Q_MVRP=y -+CONFIG_NET_SCHED=y -+CONFIG_NET_SCH_CBS=m -+CONFIG_NET_SCH_ETF=m -+CONFIG_NET_SCH_TAPRIO=m -+CONFIG_NET_SCH_MQPRIO=m -+CONFIG_NET_SCH_INGRESS=m -+CONFIG_NET_CLS_BASIC=m -+CONFIG_NET_CLS_U32=m -+CONFIG_NET_CLS_FLOWER=m -+CONFIG_NET_CLS_ACT=y -+CONFIG_NET_ACT_GACT=m -+CONFIG_NET_ACT_MIRRED=m -+CONFIG_NET_ACT_SKBEDIT=m -+CONFIG_NET_ACT_GATE=m -+CONFIG_QRTR=m -+CONFIG_QRTR_SMD=m -+CONFIG_QRTR_TUN=m -+CONFIG_BPF_JIT=y -+CONFIG_CAN=m -+CONFIG_CAN_FLEXCAN=m -+CONFIG_CAN_PHYTIUM=m -+CONFIG_CAN_PHYTIUM_PLATFORM=m -+CONFIG_CAN_PHYTIUM_PCI=m -+CONFIG_BT=m -+CONFIG_BT_HIDP=m -+# CONFIG_BT_LE is not set -+CONFIG_BT_LEDS=y -+# CONFIG_BT_DEBUGFS is not set -+CONFIG_BT_HCIBTUSB=m -+CONFIG_BT_HCIUART=m -+CONFIG_BT_HCIUART_LL=y -+CONFIG_BT_HCIUART_BCM=y -+CONFIG_BT_HCIUART_QCA=y -+CONFIG_CFG80211=m -+CONFIG_MAC80211=m -+CONFIG_MAC80211_LEDS=y -+CONFIG_RFKILL=m -+CONFIG_NET_9P=y -+CONFIG_NET_9P_VIRTIO=y -+CONFIG_NFC=m -+CONFIG_NFC_NCI=m -+CONFIG_NFC_S3FWRN5_I2C=m -+CONFIG_PCI=y -+CONFIG_PCIEPORTBUS=y -+CONFIG_HOTPLUG_PCI_PCIE=y -+CONFIG_PCI_IOV=y -+CONFIG_PCI_PASID=y -+CONFIG_HOTPLUG_PCI=y -+CONFIG_HOTPLUG_PCI_ACPI=y -+CONFIG_PCI_HOST_GENERIC=y -+CONFIG_PCI_XGENE=y -+CONFIG_PCIE_ALTERA=y -+CONFIG_PCIE_ALTERA_MSI=y -+CONFIG_PCI_HOST_THUNDER_PEM=y -+CONFIG_PCI_HOST_THUNDER_ECAM=y -+CONFIG_PCIE_LAYERSCAPE_GEN4=y -+CONFIG_PCI_ENDPOINT=y -+CONFIG_PCI_ENDPOINT_CONFIGFS=y -+CONFIG_PCI_EPF_TEST=m -+CONFIG_DEVTMPFS=y -+CONFIG_DEVTMPFS_MOUNT=y -+CONFIG_FW_LOADER_USER_HELPER=y -+CONFIG_FW_LOADER_USER_HELPER_FALLBACK=y -+CONFIG_BRCMSTB_GISB_ARB=y -+CONFIG_SIMPLE_PM_BUS=y -+CONFIG_VEXPRESS_CONFIG=y -+CONFIG_MTD=y -+CONFIG_MTD_BLOCK=y -+CONFIG_MTD_CFI=y -+CONFIG_MTD_CFI_ADV_OPTIONS=y -+CONFIG_MTD_CFI_INTELEXT=y -+CONFIG_MTD_CFI_AMDSTD=y -+CONFIG_MTD_CFI_STAA=y -+CONFIG_MTD_PHYSMAP=y -+CONFIG_MTD_PHYSMAP_OF=y -+CONFIG_MTD_DATAFLASH=y -+CONFIG_MTD_SST25L=y -+CONFIG_MTD_RAW_NAND=y -+CONFIG_MTD_NAND_DENALI_DT=y -+CONFIG_MTD_NAND_PHYTIUM_PCI=m -+CONFIG_MTD_NAND_PHYTIUM_PLAT=m -+CONFIG_MTD_SPI_NOR=y -+CONFIG_SPI_PHYTIUM_QUADSPI=y -+CONFIG_BLK_DEV_LOOP=y -+CONFIG_BLK_DEV_NBD=m -+CONFIG_BLK_DEV_RAM=y -+CONFIG_VIRTIO_BLK=y -+CONFIG_BLK_DEV_NVME=y -+CONFIG_NVME_MULTIPATH=y -+CONFIG_NVME_HWMON=y -+CONFIG_NVME_FC=y -+CONFIG_NVME_TCP=y -+CONFIG_NVME_TARGET=y -+CONFIG_NVME_TARGET_PASSTHRU=y -+CONFIG_NVME_TARGET_LOOP=y -+CONFIG_NVME_TARGET_FC=y -+CONFIG_NVME_TARGET_FCLOOP=y -+CONFIG_NVME_TARGET_TCP=y -+CONFIG_SRAM=y -+CONFIG_PCI_ENDPOINT_TEST=m -+CONFIG_EEPROM_AT24=m -+CONFIG_EEPROM_AT25=m -+CONFIG_UACCE=m -+# CONFIG_SCSI_PROC_FS is not set -+CONFIG_BLK_DEV_SD=y -+CONFIG_SCSI_SAS_LIBSAS=y -+CONFIG_SCSI_SAS_ATA=y -+CONFIG_MEGARAID_SAS=y -+CONFIG_SCSI_MPT3SAS=m -+CONFIG_SCSI_UFSHCD=y -+CONFIG_SCSI_UFSHCD_PLATFORM=y -+CONFIG_ATA=y -+CONFIG_SATA_AHCI=y -+CONFIG_SATA_AHCI_PLATFORM=y -+CONFIG_AHCI_CEVA=y -+CONFIG_AHCI_XGENE=y -+CONFIG_AHCI_QORIQ=y -+CONFIG_SATA_SIL24=y -+CONFIG_PATA_PLATFORM=y -+CONFIG_PATA_OF_PLATFORM=y -+CONFIG_MD=y -+CONFIG_BLK_DEV_MD=m -+CONFIG_BLK_DEV_DM=m -+CONFIG_DM_MIRROR=m -+CONFIG_DM_ZERO=m -+CONFIG_NETDEVICES=y -+CONFIG_MACVLAN=m -+CONFIG_MACVTAP=m -+CONFIG_TUN=y -+CONFIG_VETH=m -+CONFIG_VIRTIO_NET=y -+CONFIG_AMD_XGBE=y -+CONFIG_ATL1C=m -+CONFIG_BCMGENET=m -+CONFIG_BNX2X=m -+CONFIG_NET_VENDOR_CADENCE=y -+CONFIG_MACB=y -+CONFIG_MACB_PCI=y -+CONFIG_MACB_TSN=y -+CONFIG_THUNDER_NIC_PF=y -+# CONFIG_NET_VENDOR_HISILICON is not set -+# CONFIG_NET_VENDOR_HUAWEI is not set -+CONFIG_E1000=m -+CONFIG_E1000E=m -+CONFIG_IGB=m -+CONFIG_IGBVF=m -+CONFIG_IXGB=m -+CONFIG_IXGBE=m -+CONFIG_IXGBEVF=m -+CONFIG_I40E=m -+CONFIG_I40EVF=m -+CONFIG_MVMDIO=y -+CONFIG_SKY2=y -+CONFIG_MLX4_EN=m -+CONFIG_MLX5_CORE=m -+CONFIG_MLX5_CORE_EN=y -+CONFIG_QCOM_EMAC=m -+CONFIG_RMNET=m -+CONFIG_SMC91X=y -+CONFIG_SMSC911X=y -+CONFIG_STMMAC_ETH=y -+CONFIG_PHYTIUM_MACB=y -+CONFIG_AQUANTIA_PHY=y -+CONFIG_BROADCOM_PHY=m -+CONFIG_MARVELL_PHY=m -+CONFIG_MARVELL_10G_PHY=m -+CONFIG_MICREL_PHY=y -+CONFIG_MICROSEMI_PHY=y -+CONFIG_AT803X_PHY=y -+CONFIG_REALTEK_PHY=m -+CONFIG_ROCKCHIP_PHY=y -+CONFIG_VITESSE_PHY=y -+CONFIG_MOTORCOMM_PHY=y -+CONFIG_MDIO_BITBANG=y -+CONFIG_MDIO_BUS_MUX_MULTIPLEXER=y -+CONFIG_MDIO_BUS_MUX_MMIOREG=y -+CONFIG_USB_PEGASUS=m -+CONFIG_USB_RTL8150=m -+CONFIG_USB_RTL8152=m -+CONFIG_USB_LAN78XX=m -+CONFIG_USB_USBNET=m -+CONFIG_USB_NET_DM9601=m -+CONFIG_USB_NET_SR9800=m -+CONFIG_USB_NET_SMSC75XX=m -+CONFIG_USB_NET_SMSC95XX=m -+CONFIG_USB_NET_PLUSB=m -+CONFIG_USB_NET_MCS7830=m -+CONFIG_ATH10K=m -+CONFIG_ATH10K_PCI=m -+CONFIG_BRCMFMAC=m -+CONFIG_MWIFIEX=m -+CONFIG_MWIFIEX_PCIE=m -+CONFIG_WL18XX=m -+CONFIG_WLCORE_SDIO=m -+CONFIG_INPUT_EVDEV=y -+CONFIG_KEYBOARD_ADC=m -+CONFIG_KEYBOARD_GPIO=y -+CONFIG_KEYBOARD_CROS_EC=y -+CONFIG_KEYBOARD_PHYTIUM=m -+CONFIG_INPUT_TOUCHSCREEN=y -+CONFIG_TOUCHSCREEN_ATMEL_MXT=m -+CONFIG_INPUT_MISC=y -+# CONFIG_SERIO_SERPORT is not set -+CONFIG_SERIO_AMBAKMI=y -+CONFIG_LEGACY_PTY_COUNT=16 -+CONFIG_SERIAL_8250=y -+CONFIG_SERIAL_8250_CONSOLE=y -+CONFIG_SERIAL_8250_EXTENDED=y -+CONFIG_SERIAL_8250_SHARE_IRQ=y -+CONFIG_SERIAL_8250_DW=y -+CONFIG_SERIAL_OF_PLATFORM=y -+CONFIG_SERIAL_AMBA_PL011=y -+CONFIG_SERIAL_AMBA_PL011_CONSOLE=y -+CONFIG_SERIAL_XILINX_PS_UART=y -+CONFIG_SERIAL_XILINX_PS_UART_CONSOLE=y -+CONFIG_SERIAL_FSL_LPUART=y -+CONFIG_SERIAL_FSL_LPUART_CONSOLE=y -+CONFIG_SERIAL_FSL_LINFLEXUART=y -+CONFIG_SERIAL_FSL_LINFLEXUART_CONSOLE=y -+CONFIG_SERIAL_PHYTIUM_PCI=m -+CONFIG_SERIAL_DEV_BUS=y -+CONFIG_VIRTIO_CONSOLE=y -+CONFIG_IPMI_HANDLER=m -+CONFIG_IPMI_DEVICE_INTERFACE=m -+CONFIG_IPMI_SI=m -+CONFIG_HW_RANDOM=y -+# CONFIG_HW_RANDOM_HISI_V2 is not set -+CONFIG_HW_RANDOM_PHYTIUM=y -+CONFIG_TCG_TPM=y -+CONFIG_TCG_TIS_I2C_INFINEON=y -+CONFIG_I2C_CHARDEV=y -+CONFIG_I2C_MUX=y -+CONFIG_I2C_MUX_PCA954x=y -+CONFIG_I2C_DESIGNWARE_PLATFORM=y -+CONFIG_I2C_GPIO=m -+CONFIG_I2C_PHYTIUM_PCI=y -+CONFIG_I2C_PHYTIUM_PLATFORM=y -+CONFIG_SPI=y -+CONFIG_SPI_BITBANG=m -+CONFIG_SPI_PHYTIUM_PLAT=y -+CONFIG_SPI_PHYTIUM_PCI=y -+CONFIG_SPI_PHYTIUM_QSPI=y -+CONFIG_SPI_SPIDEV=m -+CONFIG_SPMI=y -+CONFIG_PINCTRL=y -+CONFIG_PINCTRL_SINGLE=y -+CONFIG_PINCTRL_MAX77620=y -+CONFIG_GPIO_ALTERA=m -+CONFIG_GPIO_DWAPB=y -+CONFIG_GPIO_MB86S7X=y -+CONFIG_GPIO_PL061=y -+CONFIG_GPIO_WCD934X=m -+CONFIG_GPIO_XGENE=y -+CONFIG_GPIO_MAX732X=y -+CONFIG_GPIO_PCA953X=y -+CONFIG_GPIO_PCA953X_IRQ=y -+CONFIG_GPIO_BD9571MWV=m -+CONFIG_GPIO_MAX77620=y -+CONFIG_W1=m -+CONFIG_W1_MASTER_PHYTIUM=m -+CONFIG_W1_SLAVE_THERM=m -+CONFIG_POWER_RESET_BRCMSTB=y -+CONFIG_POWER_RESET_XGENE=y -+CONFIG_POWER_RESET_SYSCON=y -+CONFIG_SYSCON_REBOOT_MODE=y -+CONFIG_BATTERY_SBS=m -+CONFIG_BATTERY_BQ27XXX=y -+CONFIG_SENSORS_ARM_SCMI=y -+CONFIG_SENSORS_ARM_SCPI=y -+CONFIG_SENSORS_LM90=m -+CONFIG_SENSORS_PWM_FAN=m -+CONFIG_SENSORS_INA2XX=m -+CONFIG_SENSORS_INA3221=m -+CONFIG_SENSORS_PHYTIUM=m -+CONFIG_THERMAL_GOV_POWER_ALLOCATOR=y -+CONFIG_CPU_THERMAL=y -+CONFIG_THERMAL_EMULATION=y -+CONFIG_WATCHDOG=y -+CONFIG_ARM_SP805_WATCHDOG=y -+CONFIG_ARM_SBSA_WATCHDOG=y -+CONFIG_DW_WATCHDOG=y -+CONFIG_ARM_SMC_WATCHDOG=y -+CONFIG_MFD_BD9571MWV=y -+CONFIG_MFD_AXP20X_I2C=y -+CONFIG_MFD_HI6421_PMIC=y -+CONFIG_MFD_MAX77620=y -+CONFIG_MFD_PHYTIUM_I2S_LSD=y -+CONFIG_MFD_PHYTIUM_I2S_MMD=y -+CONFIG_MFD_RK808=y -+CONFIG_MFD_SEC_CORE=y -+CONFIG_MFD_ROHM_BD718XX=y -+CONFIG_MFD_WCD934X=m -+CONFIG_REGULATOR=y -+CONFIG_REGULATOR_FIXED_VOLTAGE=y -+CONFIG_REGULATOR_AXP20X=y -+CONFIG_REGULATOR_BD718XX=y -+CONFIG_REGULATOR_BD9571MWV=y -+CONFIG_REGULATOR_FAN53555=y -+CONFIG_REGULATOR_GPIO=y -+CONFIG_REGULATOR_HI6421V530=y -+CONFIG_REGULATOR_MAX77620=y -+CONFIG_REGULATOR_MAX8973=y -+CONFIG_REGULATOR_PCA9450=y -+CONFIG_REGULATOR_PFUZE100=y -+CONFIG_REGULATOR_PWM=y -+CONFIG_REGULATOR_QCOM_SPMI=y -+CONFIG_REGULATOR_RK808=y -+CONFIG_REGULATOR_S2MPS11=y -+CONFIG_REGULATOR_VCTRL=m -+CONFIG_RC_CORE=m -+CONFIG_RC_DECODERS=y -+CONFIG_RC_DEVICES=y -+CONFIG_MEDIA_SUPPORT=m -+CONFIG_MEDIA_CAMERA_SUPPORT=y -+CONFIG_MEDIA_ANALOG_TV_SUPPORT=y -+CONFIG_MEDIA_DIGITAL_TV_SUPPORT=y -+CONFIG_MEDIA_SDR_SUPPORT=y -+CONFIG_MEDIA_PLATFORM_SUPPORT=y -+# CONFIG_DVB_NET is not set -+CONFIG_MEDIA_USB_SUPPORT=y -+CONFIG_USB_VIDEO_CLASS=m -+CONFIG_V4L_PLATFORM_DRIVERS=y -+CONFIG_V4L_MEM2MEM_DRIVERS=y -+CONFIG_SDR_PLATFORM_DRIVERS=y -+CONFIG_VIDEO_IMX219=m -+CONFIG_VIDEO_OV5645=m -+CONFIG_DRM=y -+CONFIG_DRM_I2C_CH7006=m -+CONFIG_DRM_I2C_SIL164=m -+CONFIG_DRM_I2C_NXP_TDA998X=m -+CONFIG_DRM_MALI_DISPLAY=m -+CONFIG_DRM_RCAR_DW_HDMI=m -+CONFIG_DRM_RCAR_LVDS=m -+CONFIG_DRM_PANEL_LVDS=m -+CONFIG_DRM_PANEL_SIMPLE=m -+CONFIG_DRM_PANEL_RAYDIUM_RM67191=m -+CONFIG_DRM_PANEL_SITRONIX_ST7703=m -+CONFIG_DRM_PANEL_TRULY_NT35597_WQXGA=m -+CONFIG_DRM_DISPLAY_CONNECTOR=m -+CONFIG_DRM_LONTIUM_LT9611=m -+CONFIG_DRM_NWL_MIPI_DSI=m -+CONFIG_DRM_SII902X=m -+CONFIG_DRM_SIMPLE_BRIDGE=m -+CONFIG_DRM_THINE_THC63LVD1024=m -+CONFIG_DRM_TI_SN65DSI86=m -+CONFIG_DRM_I2C_ADV7511=m -+CONFIG_DRM_I2C_ADV7511_AUDIO=y -+CONFIG_DRM_DW_HDMI_AHB_AUDIO=m -+CONFIG_DRM_DW_HDMI_I2S_AUDIO=m -+CONFIG_DRM_DW_HDMI_CEC=m -+CONFIG_DRM_PHYTIUM=y -+CONFIG_DRM_LEGACY=y -+CONFIG_FB_MODE_HELPERS=y -+CONFIG_BACKLIGHT_CLASS_DEVICE=y -+CONFIG_BACKLIGHT_PWM=m -+CONFIG_BACKLIGHT_LP855X=m -+CONFIG_LOGO=y -+# CONFIG_LOGO_LINUX_MONO is not set -+# CONFIG_LOGO_LINUX_VGA16 is not set -+CONFIG_SOUND=y -+CONFIG_SND=y -+CONFIG_SND_HDA_INTEL=m -+CONFIG_SND_HDA_PHYTIUM=y -+CONFIG_SND_HDA_HWDEP=y -+CONFIG_SND_HDA_INPUT_BEEP=y -+CONFIG_SND_HDA_PATCH_LOADER=y -+CONFIG_SND_HDA_CODEC_REALTEK=y -+CONFIG_SND_HDA_CODEC_HDMI=y -+CONFIG_SND_SOC=y -+CONFIG_SND_SOC_FSL_SAI=m -+CONFIG_SND_SOC_PHYTIUM_I2S=y -+CONFIG_SND_PMDK_ES8388=y -+CONFIG_SND_PMDK_ES8336=y -+CONFIG_SND_PMDK_DP=y -+CONFIG_SND_SOC_AK4613=m -+CONFIG_SND_SOC_CROS_EC_CODEC=m -+CONFIG_SND_SOC_DMIC=m -+CONFIG_SND_SOC_ES7134=m -+CONFIG_SND_SOC_ES7241=m -+CONFIG_SND_SOC_MAX98357A=m -+CONFIG_SND_SOC_MAX98927=m -+CONFIG_SND_SOC_PCM3168A_I2C=m -+CONFIG_SND_SOC_SIMPLE_AMPLIFIER=m -+CONFIG_SND_SOC_SPDIF=m -+CONFIG_SND_SOC_TAS571X=m -+CONFIG_SND_SOC_WCD934X=m -+CONFIG_SND_SOC_WM8904=m -+CONFIG_SND_SOC_WSA881X=m -+CONFIG_SND_SIMPLE_CARD=y -+CONFIG_SND_AUDIO_GRAPH_CARD=y -+CONFIG_I2C_HID=m -+CONFIG_USB_CONN_GPIO=y -+CONFIG_USB=y -+CONFIG_USB_OTG=y -+CONFIG_USB_XHCI_HCD=y -+CONFIG_USB_EHCI_HCD=y -+CONFIG_USB_EHCI_HCD_PLATFORM=y -+CONFIG_USB_OHCI_HCD=y -+CONFIG_USB_OHCI_HCD_PLATFORM=y -+CONFIG_USB_ACM=m -+CONFIG_USB_STORAGE=y -+CONFIG_USB_MUSB_HDRC=y -+CONFIG_USB_DWC3=y -+CONFIG_USB_DWC2=y -+CONFIG_USB_CHIPIDEA=y -+CONFIG_USB_CHIPIDEA_UDC=y -+CONFIG_USB_CHIPIDEA_HOST=y -+CONFIG_USB_ISP1760=y -+CONFIG_USB_PHYTIUM=y -+CONFIG_USB_SERIAL=m -+CONFIG_USB_SERIAL_FTDI_SIO=m -+CONFIG_USB_HSIC_USB3503=y -+CONFIG_NOP_USB_XCEIV=y -+CONFIG_USB_ULPI=y -+CONFIG_USB_GADGET=y -+CONFIG_USB_SNP_UDC_PLAT=y -+CONFIG_USB_BDC_UDC=y -+CONFIG_USB_LIBCOMPOSITE=y -+CONFIG_USB_F_ACM=y -+CONFIG_USB_U_SERIAL=y -+CONFIG_USB_U_ETHER=y -+CONFIG_USB_F_SERIAL=y -+CONFIG_USB_F_OBEX=y -+CONFIG_USB_F_NCM=y -+CONFIG_USB_F_ECM=y -+CONFIG_USB_F_EEM=y -+CONFIG_USB_F_SUBSET=y -+CONFIG_USB_F_RNDIS=y -+CONFIG_USB_F_MASS_STORAGE=y -+CONFIG_USB_F_FS=y -+CONFIG_USB_CONFIGFS=y -+CONFIG_USB_CONFIGFS_SERIAL=y -+CONFIG_USB_CONFIGFS_ACM=y -+CONFIG_USB_CONFIGFS_OBEX=y -+CONFIG_USB_CONFIGFS_NCM=y -+CONFIG_USB_CONFIGFS_ECM=y -+CONFIG_USB_CONFIGFS_ECM_SUBSET=y -+CONFIG_USB_CONFIGFS_RNDIS=y -+CONFIG_USB_CONFIGFS_EEM=y -+CONFIG_USB_CONFIGFS_MASS_STORAGE=y -+CONFIG_USB_CONFIGFS_F_FS=y -+CONFIG_TYPEC=m -+CONFIG_TYPEC_TCPM=m -+CONFIG_TYPEC_FUSB302=m -+CONFIG_TYPEC_HD3SS3220=m -+CONFIG_MMC=y -+CONFIG_MMC_BLOCK_MINORS=32 -+CONFIG_MMC_ARMMMCI=y -+CONFIG_MMC_SDHCI=y -+CONFIG_MMC_SDHCI_ACPI=y -+CONFIG_MMC_SDHCI_PLTFM=y -+CONFIG_MMC_SDHCI_OF_ARASAN=y -+CONFIG_MMC_SDHCI_CADENCE=y -+CONFIG_MMC_SDHCI_F_SDH30=y -+CONFIG_MMC_SPI=y -+CONFIG_MMC_DW=y -+CONFIG_MMC_DW_EXYNOS=y -+CONFIG_MMC_DW_HI3798CV200=y -+CONFIG_MMC_DW_K3=y -+CONFIG_MMC_SDHCI_XENON=y -+CONFIG_MMC_SDHCI_AM654=y -+CONFIG_LEDS_GPIO=y -+CONFIG_LEDS_PWM=y -+CONFIG_LEDS_SYSCON=y -+CONFIG_LEDS_TRIGGER_TIMER=y -+CONFIG_LEDS_TRIGGER_DISK=y -+CONFIG_LEDS_TRIGGER_HEARTBEAT=y -+CONFIG_LEDS_TRIGGER_CPU=y -+CONFIG_LEDS_TRIGGER_DEFAULT_ON=y -+CONFIG_LEDS_TRIGGER_PANIC=y -+CONFIG_EDAC=y -+CONFIG_EDAC_GHES=y -+CONFIG_RTC_CLASS=y -+CONFIG_RTC_DRV_DS1307=m -+CONFIG_RTC_DRV_MAX77686=y -+CONFIG_RTC_DRV_RK808=m -+CONFIG_RTC_DRV_PCF85363=m -+CONFIG_RTC_DRV_RX8581=m -+CONFIG_RTC_DRV_RV8803=m -+CONFIG_RTC_DRV_S5M=y -+CONFIG_RTC_DRV_SD3068=m -+CONFIG_RTC_DRV_DS3232=y -+CONFIG_RTC_DRV_PCF2127=m -+CONFIG_RTC_DRV_EFI=y -+CONFIG_RTC_DRV_CROS_EC=y -+CONFIG_RTC_DRV_PL031=y -+CONFIG_DMADEVICES=y -+CONFIG_BCM_SBA_RAID=m -+CONFIG_FSL_EDMA=y -+CONFIG_MV_XOR_V2=y -+CONFIG_PL330_DMA=y -+CONFIG_PHYTIUM_DDMA=y -+CONFIG_UIO=m -+CONFIG_UIO_CIF=m -+CONFIG_UIO_PDRV_GENIRQ=m -+CONFIG_UIO_DMEM_GENIRQ=m -+CONFIG_UIO_AEC=m -+CONFIG_UIO_SERCOS3=m -+CONFIG_UIO_PCI_GENERIC=m -+CONFIG_UIO_NETX=m -+CONFIG_UIO_PRUSS=m -+CONFIG_UIO_MF624=m -+CONFIG_VFIO=y -+CONFIG_VFIO_PCI=y -+CONFIG_VIRTIO_PCI=y -+CONFIG_VIRTIO_BALLOON=y -+CONFIG_VIRTIO_MMIO=y -+CONFIG_XEN_GNTDEV=y -+CONFIG_XEN_GRANT_DEV_ALLOC=y -+CONFIG_STAGING=y -+CONFIG_CHROME_PLATFORMS=y -+CONFIG_CROS_EC=y -+CONFIG_CROS_EC_I2C=y -+CONFIG_CROS_EC_SPI=y -+CONFIG_CROS_EC_CHARDEV=m -+CONFIG_COMMON_CLK_RK808=y -+CONFIG_COMMON_CLK_SCPI=y -+CONFIG_COMMON_CLK_CS2000_CP=y -+CONFIG_COMMON_CLK_S2MPS11=y -+CONFIG_CLK_QORIQ=y -+CONFIG_COMMON_CLK_XGENE=y -+CONFIG_COMMON_CLK_PWM=y -+CONFIG_COMMON_CLK_VC5=y -+CONFIG_COMMON_CLK_BD718XX=m -+CONFIG_HWSPINLOCK=y -+CONFIG_HWSPINLOCK_PHYTIUM=y -+CONFIG_ARM_MHU=y -+CONFIG_PLATFORM_MHU=y -+CONFIG_PHYTIUM_MBOX=y -+CONFIG_ARM_SMMU=y -+CONFIG_ARM_SMMU_V3=y -+CONFIG_REMOTEPROC=y -+CONFIG_REMOTEPROC_CDEV=y -+CONFIG_HOMO_REMOTEPROC=y -+CONFIG_RPMSG_CHAR=m -+CONFIG_RPMSG_QCOM_GLINK_RPM=y -+CONFIG_SOUNDWIRE=m -+CONFIG_SOUNDWIRE_QCOM=m -+CONFIG_SOC_BRCMSTB=y -+CONFIG_SOC_TI=y -+CONFIG_EXTCON_PTN5150=m -+CONFIG_EXTCON_USB_GPIO=y -+CONFIG_EXTCON_USBC_CROS_EC=y -+CONFIG_MEMORY=y -+CONFIG_IIO=y -+CONFIG_MAX9611=m -+CONFIG_QCOM_SPMI_ADC5=m -+CONFIG_PHYTIUM_ADC=m -+CONFIG_IIO_CROS_EC_SENSORS_CORE=m -+CONFIG_IIO_CROS_EC_SENSORS=m -+CONFIG_IIO_CROS_EC_LIGHT_PROX=m -+CONFIG_SENSORS_ISL29018=m -+CONFIG_IIO_CROS_EC_BARO=m -+CONFIG_MPL3115=m -+CONFIG_PWM=y -+CONFIG_PWM_CROS_EC=m -+CONFIG_PWM_PHYTIUM=m -+CONFIG_PHYTIUM_IXIC=y -+CONFIG_PHY_XGENE=y -+CONFIG_PHY_FSL_IMX8MQ_USB=y -+CONFIG_PHY_MIXEL_MIPI_DPHY=m -+CONFIG_PHY_QCOM_USB_HS=y -+CONFIG_PHY_SAMSUNG_USB2=y -+CONFIG_ARM_SMMU_V3_PMU=m -+CONFIG_FPGA=y -+CONFIG_FPGA_BRIDGE=m -+CONFIG_ALTERA_FREEZE_BRIDGE=m -+CONFIG_FPGA_REGION=m -+CONFIG_OF_FPGA_REGION=m -+CONFIG_MUX_MMIO=y -+CONFIG_SLIM_QCOM_CTRL=m -+CONFIG_INTERCONNECT=y -+CONFIG_EXT2_FS=y -+CONFIG_EXT3_FS=y -+CONFIG_EXT4_FS_POSIX_ACL=y -+CONFIG_BTRFS_FS=m -+CONFIG_BTRFS_FS_POSIX_ACL=y -+CONFIG_FANOTIFY=y -+CONFIG_FANOTIFY_ACCESS_PERMISSIONS=y -+CONFIG_QUOTA=y -+CONFIG_AUTOFS4_FS=y -+CONFIG_FUSE_FS=m -+CONFIG_CUSE=m -+CONFIG_OVERLAY_FS=m -+CONFIG_VFAT_FS=y -+CONFIG_TMPFS=y -+CONFIG_HUGETLBFS=y -+CONFIG_EFIVAR_FS=y -+CONFIG_SQUASHFS=y -+CONFIG_SQUASHFS_XATTR=y -+CONFIG_SQUASHFS_LZ4=y -+CONFIG_SQUASHFS_LZO=y -+CONFIG_SQUASHFS_XZ=y -+CONFIG_SQUASHFS_ZSTD=y -+CONFIG_SQUASHFS_4K_DEVBLK_SIZE=y -+CONFIG_SQUASHFS_EMBEDDED=y -+CONFIG_NFS_FS=y -+CONFIG_NFS_V4=y -+CONFIG_NFS_V4_1=y -+CONFIG_NFS_V4_2=y -+CONFIG_ROOT_NFS=y -+CONFIG_NFSD=y -+CONFIG_NFSD_V3_ACL=y -+CONFIG_NFSD_V4=y -+CONFIG_NFSD_BLOCKLAYOUT=y -+CONFIG_NFSD_SCSILAYOUT=y -+CONFIG_NFSD_FLEXFILELAYOUT=y -+CONFIG_NFSD_V4_2_INTER_SSC=y -+CONFIG_NFSD_V4_SECURITY_LABEL=y -+CONFIG_9P_FS=y -+CONFIG_NLS_CODEPAGE_437=y -+CONFIG_NLS_ISO8859_1=y -+CONFIG_SECURITY=y -+CONFIG_CRYPTO_USER=y -+CONFIG_CRYPTO_ECHAINIV=y -+CONFIG_CRYPTO_ANSI_CPRNG=y -+CONFIG_CRYPTO_DRBG_HASH=y -+CONFIG_CRYPTO_USER_API_HASH=y -+CONFIG_CRYPTO_USER_API_SKCIPHER=y -+CONFIG_CRYPTO_USER_API_RNG=m -+CONFIG_CRYPTO_USER_API_AEAD=y -+CONFIG_CRYPTO_DEV_CCREE=m -+CONFIG_CRYPTO_DEV_HISI_SEC2=m -+CONFIG_CRYPTO_DEV_HISI_ZIP=m -+CONFIG_CRYPTO_DEV_HISI_HPRE=m -+CONFIG_CRYPTO_DEV_AMLOGIC_GXL=m -+CONFIG_INDIRECT_PIO=y -+CONFIG_CRC_CCITT=m -+CONFIG_DMA_CMA=y -+CONFIG_DMA_PERNUMA_CMA=y -+CONFIG_CMA_SIZE_MBYTES=32 -+CONFIG_PRINTK_TIME=y -+CONFIG_DEBUG_INFO=y -+CONFIG_MAGIC_SYSRQ=y -+CONFIG_DEBUG_FS=y -+CONFIG_DEBUG_KERNEL=y -+# CONFIG_SCHED_DEBUG is not set -+# CONFIG_DEBUG_PREEMPT is not set -+# CONFIG_FTRACE is not set -+CONFIG_MEMTEST=y -+ -+CONFIG_HIEVENT=y -+CONFIG_BBOX_BUFFER_SIZE=2048 -+CONFIG_HISYSEVENT=y -+ -+ -+CONFIG_ASHMEM=y -+ -+CONFIG_ANDROID=y -+CONFIG_ANDROID_BINDER_IPC=y -+# CONFIG_ANDROID_BINDERFS is not set -+CONFIG_ANDROID_BINDER_DEVICES="binder,hwbinder,vndbinder" -+# CONFIG_ANDROID_BINDER_IPC_SELFTEST is not set -+CONFIG_BINDER_TRANSACTION_PROC_BRIEF=y -+ -+CONFIG_DRIVERS_HDF=y -+CONFIG_DRIVERS_HDF_PLATFORM=y -+CONFIG_DRIVERS_HDF_PLATFORM_GPIO=y -+CONFIG_DRIVERS_HDF_PLATFORM_I2C=y -+CONFIG_DRIVERS_HDF_TEST=y -+CONFIG_DRIVERS_HDF_INPUT=y -+ -+CONFIG_ACCESS_TOKENID=y -+ -+CONFIG_PSI=y -+ -+# CONFIG_SUSPEND is not set -diff --git a/arch/arm64/configs/phytium_standard_defconfig b/arch/arm64/configs/phytium_standard_defconfig -new file mode 100644 -index 000000000..cc114bb91 ---- /dev/null -+++ b/arch/arm64/configs/phytium_standard_defconfig -@@ -0,0 +1,806 @@ -+CONFIG_LOCALVERSION="-phytium-embeded" -+# CONFIG_LOCALVERSION_AUTO is not set -+CONFIG_SYSVIPC=y -+CONFIG_POSIX_MQUEUE=y -+CONFIG_AUDIT=y -+CONFIG_NO_HZ_IDLE=y -+CONFIG_HIGH_RES_TIMERS=y -+CONFIG_PREEMPT=y -+CONFIG_IRQ_TIME_ACCOUNTING=y -+CONFIG_BSD_PROCESS_ACCT=y -+CONFIG_BSD_PROCESS_ACCT_V3=y -+CONFIG_TASK_XACCT=y -+CONFIG_TASK_IO_ACCOUNTING=y -+CONFIG_IKCONFIG=y -+CONFIG_IKCONFIG_PROC=y -+CONFIG_MEMCG=y -+CONFIG_BLK_CGROUP=y -+CONFIG_CGROUP_PIDS=y -+CONFIG_CGROUP_HUGETLB=y -+CONFIG_CPUSETS=y -+CONFIG_CGROUP_DEVICE=y -+CONFIG_CGROUP_CPUACCT=y -+CONFIG_CGROUP_PERF=y -+CONFIG_USER_NS=y -+CONFIG_SCHED_AUTOGROUP=y -+CONFIG_BLK_DEV_INITRD=y -+CONFIG_KALLSYMS_ALL=y -+# CONFIG_COMPAT_BRK is not set -+CONFIG_PROFILING=y -+CONFIG_ARCH_PHYTIUM=y -+CONFIG_ARM64_VA_BITS_48=y -+CONFIG_SCHED_MC=y -+CONFIG_SCHED_SMT=y -+CONFIG_KEXEC=y -+CONFIG_KEXEC_FILE=y -+CONFIG_CRASH_DUMP=y -+CONFIG_XEN=y -+CONFIG_COMPAT=y -+CONFIG_RANDOMIZE_BASE=y -+CONFIG_HIBERNATION=y -+CONFIG_WQ_POWER_EFFICIENT_DEFAULT=y -+CONFIG_ENERGY_MODEL=y -+CONFIG_ARM_CPUIDLE=y -+CONFIG_ARM_PSCI_CPUIDLE=y -+CONFIG_CPU_FREQ=y -+CONFIG_CPU_FREQ_STAT=y -+CONFIG_CPU_FREQ_GOV_POWERSAVE=m -+CONFIG_CPU_FREQ_GOV_USERSPACE=y -+CONFIG_CPU_FREQ_GOV_ONDEMAND=y -+CONFIG_CPU_FREQ_GOV_CONSERVATIVE=m -+CONFIG_CPUFREQ_DT=y -+CONFIG_ACPI_CPPC_CPUFREQ=m -+CONFIG_ARM_SCPI_CPUFREQ=y -+CONFIG_ARM_SCMI_CPUFREQ=y -+CONFIG_ARM_SCMI_PROTOCOL=y -+CONFIG_ARM_SCMI_TRANSPORT_FORCE_POLLING=y -+CONFIG_ARM_SCPI_PROTOCOL=y -+CONFIG_EFI_CAPSULE_LOADER=y -+CONFIG_ACPI=y -+CONFIG_ACPI_APEI=y -+CONFIG_ACPI_APEI_GHES=y -+CONFIG_ACPI_APEI_MEMORY_FAILURE=y -+CONFIG_ACPI_APEI_EINJ=y -+CONFIG_VIRTUALIZATION=y -+CONFIG_KVM=y -+CONFIG_ARM64_CRYPTO=y -+CONFIG_CRYPTO_SHA1_ARM64_CE=y -+CONFIG_CRYPTO_SHA2_ARM64_CE=y -+CONFIG_CRYPTO_SHA512_ARM64_CE=m -+CONFIG_CRYPTO_SHA3_ARM64=m -+CONFIG_CRYPTO_SM3_ARM64_CE=m -+CONFIG_CRYPTO_GHASH_ARM64_CE=y -+CONFIG_CRYPTO_CRCT10DIF_ARM64_CE=m -+CONFIG_CRYPTO_AES_ARM64_CE_CCM=y -+CONFIG_CRYPTO_AES_ARM64_CE_BLK=y -+CONFIG_CRYPTO_CHACHA20_NEON=m -+CONFIG_CRYPTO_AES_ARM64_BS=m -+CONFIG_KPROBES=y -+CONFIG_JUMP_LABEL=y -+CONFIG_MODULES=y -+CONFIG_MODULE_UNLOAD=y -+CONFIG_BLK_DEV_INTEGRITY=y -+# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set -+CONFIG_KSM=y -+CONFIG_MEMORY_FAILURE=y -+CONFIG_TRANSPARENT_HUGEPAGE=y -+CONFIG_CMA=y -+CONFIG_CMA_AREAS=19 -+CONFIG_NET=y -+CONFIG_PACKET=y -+CONFIG_UNIX=y -+CONFIG_INET=y -+CONFIG_IP_MULTICAST=y -+CONFIG_IP_PNP=y -+CONFIG_IP_PNP_DHCP=y -+CONFIG_IP_PNP_BOOTP=y -+CONFIG_IPV6=m -+CONFIG_NETFILTER=y -+CONFIG_NF_CONNTRACK=m -+CONFIG_NF_CONNTRACK_EVENTS=y -+CONFIG_NETFILTER_XT_TARGET_CHECKSUM=m -+CONFIG_NETFILTER_XT_TARGET_LOG=m -+CONFIG_NETFILTER_XT_MATCH_ADDRTYPE=m -+CONFIG_NETFILTER_XT_MATCH_CONNTRACK=m -+CONFIG_IP_NF_IPTABLES=m -+CONFIG_IP_NF_FILTER=m -+CONFIG_IP_NF_TARGET_REJECT=m -+CONFIG_IP_NF_NAT=m -+CONFIG_IP_NF_TARGET_MASQUERADE=m -+CONFIG_IP_NF_MANGLE=m -+CONFIG_IP6_NF_IPTABLES=m -+CONFIG_IP6_NF_FILTER=m -+CONFIG_IP6_NF_TARGET_REJECT=m -+CONFIG_IP6_NF_MANGLE=m -+CONFIG_IP6_NF_NAT=m -+CONFIG_IP6_NF_TARGET_MASQUERADE=m -+CONFIG_BRIDGE=m -+CONFIG_BRIDGE_VLAN_FILTERING=y -+CONFIG_NET_DSA=m -+CONFIG_NET_DSA_TAG_OCELOT=m -+CONFIG_VLAN_8021Q=m -+CONFIG_VLAN_8021Q_GVRP=y -+CONFIG_VLAN_8021Q_MVRP=y -+CONFIG_NET_SCHED=y -+CONFIG_NET_SCH_CBS=m -+CONFIG_NET_SCH_ETF=m -+CONFIG_NET_SCH_TAPRIO=m -+CONFIG_NET_SCH_MQPRIO=m -+CONFIG_NET_SCH_INGRESS=m -+CONFIG_NET_CLS_BASIC=m -+CONFIG_NET_CLS_U32=m -+CONFIG_NET_CLS_FLOWER=m -+CONFIG_NET_CLS_ACT=y -+CONFIG_NET_ACT_GACT=m -+CONFIG_NET_ACT_MIRRED=m -+CONFIG_NET_ACT_SKBEDIT=m -+CONFIG_NET_ACT_GATE=m -+CONFIG_QRTR=m -+CONFIG_QRTR_SMD=m -+CONFIG_QRTR_TUN=m -+CONFIG_BPF_JIT=y -+CONFIG_CAN=m -+CONFIG_CAN_FLEXCAN=m -+CONFIG_CAN_PHYTIUM=m -+CONFIG_CAN_PHYTIUM_PLATFORM=m -+CONFIG_CAN_PHYTIUM_PCI=m -+CONFIG_BT=m -+CONFIG_BT_HIDP=m -+# CONFIG_BT_LE is not set -+CONFIG_BT_LEDS=y -+# CONFIG_BT_DEBUGFS is not set -+CONFIG_BT_HCIBTUSB=m -+CONFIG_BT_HCIUART=m -+CONFIG_BT_HCIUART_LL=y -+CONFIG_BT_HCIUART_BCM=y -+CONFIG_BT_HCIUART_QCA=y -+CONFIG_WIRELESS=y -+CONFIG_CFG80211=y -+CONFIG_MAC80211=y -+CONFIG_MAC80211_LEDS=y -+CONFIG_RFKILL=y -+CONFIG_NET_9P=y -+CONFIG_NET_9P_VIRTIO=y -+CONFIG_NFC=m -+CONFIG_NFC_NCI=m -+CONFIG_NFC_S3FWRN5_I2C=m -+CONFIG_PCI=y -+CONFIG_PCIEPORTBUS=y -+CONFIG_HOTPLUG_PCI_PCIE=y -+CONFIG_PCI_IOV=y -+CONFIG_PCI_PASID=y -+CONFIG_HOTPLUG_PCI=y -+CONFIG_HOTPLUG_PCI_ACPI=y -+CONFIG_PCI_HOST_GENERIC=y -+CONFIG_PCI_XGENE=y -+CONFIG_PCIE_ALTERA=y -+CONFIG_PCIE_ALTERA_MSI=y -+CONFIG_PCI_HOST_THUNDER_PEM=y -+CONFIG_PCI_HOST_THUNDER_ECAM=y -+CONFIG_PCIE_LAYERSCAPE_GEN4=y -+CONFIG_PCI_ENDPOINT=y -+CONFIG_PCI_ENDPOINT_CONFIGFS=y -+CONFIG_PCI_EPF_TEST=m -+CONFIG_DEVTMPFS=y -+CONFIG_DEVTMPFS_MOUNT=y -+CONFIG_FW_LOADER_USER_HELPER=y -+CONFIG_FW_LOADER_USER_HELPER_FALLBACK=y -+CONFIG_BRCMSTB_GISB_ARB=y -+CONFIG_SIMPLE_PM_BUS=y -+CONFIG_VEXPRESS_CONFIG=y -+CONFIG_MTD=y -+CONFIG_MTD_BLOCK=y -+CONFIG_MTD_CFI=y -+CONFIG_MTD_CFI_ADV_OPTIONS=y -+CONFIG_MTD_CFI_INTELEXT=y -+CONFIG_MTD_CFI_AMDSTD=y -+CONFIG_MTD_CFI_STAA=y -+CONFIG_MTD_PHYSMAP=y -+CONFIG_MTD_PHYSMAP_OF=y -+CONFIG_MTD_DATAFLASH=y -+CONFIG_MTD_SST25L=y -+CONFIG_MTD_RAW_NAND=y -+CONFIG_MTD_NAND_DENALI_DT=y -+CONFIG_MTD_NAND_PHYTIUM_PCI=m -+CONFIG_MTD_NAND_PHYTIUM_PLAT=m -+CONFIG_MTD_SPI_NOR=y -+CONFIG_SPI_PHYTIUM_QUADSPI=y -+CONFIG_BLK_DEV_LOOP=y -+CONFIG_BLK_DEV_NBD=m -+CONFIG_BLK_DEV_RAM=y -+CONFIG_VIRTIO_BLK=y -+CONFIG_BLK_DEV_NVME=y -+CONFIG_NVME_MULTIPATH=y -+CONFIG_NVME_HWMON=y -+CONFIG_NVME_FC=y -+CONFIG_NVME_TCP=y -+CONFIG_NVME_TARGET=y -+CONFIG_NVME_TARGET_PASSTHRU=y -+CONFIG_NVME_TARGET_LOOP=y -+CONFIG_NVME_TARGET_FC=y -+CONFIG_NVME_TARGET_FCLOOP=y -+CONFIG_NVME_TARGET_TCP=y -+CONFIG_SRAM=y -+CONFIG_PCI_ENDPOINT_TEST=m -+CONFIG_EEPROM_AT24=m -+CONFIG_EEPROM_AT25=m -+CONFIG_UACCE=m -+# CONFIG_SCSI_PROC_FS is not set -+CONFIG_BLK_DEV_SD=y -+CONFIG_SCSI_SAS_LIBSAS=y -+CONFIG_SCSI_SAS_ATA=y -+CONFIG_MEGARAID_SAS=y -+CONFIG_SCSI_MPT3SAS=m -+CONFIG_SCSI_UFSHCD=y -+CONFIG_SCSI_UFSHCD_PLATFORM=y -+CONFIG_ATA=y -+CONFIG_SATA_AHCI=y -+CONFIG_SATA_AHCI_PLATFORM=y -+CONFIG_AHCI_CEVA=y -+CONFIG_AHCI_XGENE=y -+CONFIG_AHCI_QORIQ=y -+CONFIG_SATA_SIL24=y -+CONFIG_PATA_PLATFORM=y -+CONFIG_PATA_OF_PLATFORM=y -+CONFIG_MD=y -+CONFIG_BLK_DEV_MD=m -+CONFIG_BLK_DEV_DM=m -+CONFIG_DM_MIRROR=m -+CONFIG_DM_ZERO=m -+CONFIG_NETDEVICES=y -+CONFIG_MACVLAN=m -+CONFIG_MACVTAP=m -+CONFIG_TUN=y -+CONFIG_VETH=m -+CONFIG_VIRTIO_NET=y -+CONFIG_AMD_XGBE=y -+CONFIG_ATL1C=m -+CONFIG_BCMGENET=m -+CONFIG_BNX2X=m -+CONFIG_NET_VENDOR_CADENCE=y -+CONFIG_MACB=y -+CONFIG_MACB_PCI=y -+CONFIG_MACB_TSN=y -+CONFIG_THUNDER_NIC_PF=y -+# CONFIG_NET_VENDOR_HISILICON is not set -+# CONFIG_NET_VENDOR_HUAWEI is not set -+CONFIG_E1000=m -+CONFIG_E1000E=m -+CONFIG_IGB=m -+CONFIG_IGBVF=m -+CONFIG_IXGB=m -+CONFIG_IXGBE=m -+CONFIG_IXGBEVF=m -+CONFIG_I40E=m -+CONFIG_I40EVF=m -+CONFIG_MVMDIO=y -+CONFIG_SKY2=y -+CONFIG_MLX4_EN=m -+CONFIG_MLX5_CORE=m -+CONFIG_MLX5_CORE_EN=y -+CONFIG_QCOM_EMAC=m -+CONFIG_RMNET=m -+CONFIG_SMC91X=y -+CONFIG_SMSC911X=y -+CONFIG_STMMAC_ETH=y -+CONFIG_PHYTIUM_MACB=y -+CONFIG_AQUANTIA_PHY=y -+CONFIG_BROADCOM_PHY=m -+CONFIG_MARVELL_PHY=m -+CONFIG_MARVELL_10G_PHY=m -+CONFIG_MICREL_PHY=y -+CONFIG_MICROSEMI_PHY=y -+CONFIG_AT803X_PHY=y -+CONFIG_REALTEK_PHY=m -+CONFIG_ROCKCHIP_PHY=y -+CONFIG_VITESSE_PHY=y -+CONFIG_MOTORCOMM_PHY=y -+CONFIG_MDIO_BITBANG=y -+CONFIG_MDIO_BUS_MUX_MULTIPLEXER=y -+CONFIG_MDIO_BUS_MUX_MMIOREG=y -+CONFIG_USB_PEGASUS=m -+CONFIG_USB_RTL8150=m -+CONFIG_USB_RTL8152=m -+CONFIG_USB_LAN78XX=m -+CONFIG_USB_USBNET=m -+CONFIG_USB_NET_DM9601=m -+CONFIG_USB_NET_SR9800=m -+CONFIG_USB_NET_SMSC75XX=m -+CONFIG_USB_NET_SMSC95XX=m -+CONFIG_USB_NET_PLUSB=m -+CONFIG_USB_NET_MCS7830=m -+CONFIG_ATH10K=m -+CONFIG_ATH10K_PCI=m -+CONFIG_BRCMFMAC=m -+CONFIG_MWIFIEX=m -+CONFIG_MWIFIEX_PCIE=m -+CONFIG_WL18XX=m -+CONFIG_WLCORE_SDIO=m -+CONFIG_RTW88=y -+CONFIG_RTW88_8821CS=y -+#CONFIG_RTL8821CS is not set -+CONFIG_INPUT_EVDEV=y -+CONFIG_KEYBOARD_ADC=m -+CONFIG_KEYBOARD_GPIO=y -+CONFIG_KEYBOARD_CROS_EC=y -+CONFIG_KEYBOARD_PHYTIUM=m -+CONFIG_INPUT_TOUCHSCREEN=y -+CONFIG_TOUCHSCREEN_ATMEL_MXT=m -+CONFIG_INPUT_MISC=y -+# CONFIG_SERIO_SERPORT is not set -+CONFIG_SERIO_AMBAKMI=y -+CONFIG_LEGACY_PTY_COUNT=16 -+CONFIG_SERIAL_8250=y -+CONFIG_SERIAL_8250_CONSOLE=y -+CONFIG_SERIAL_8250_EXTENDED=y -+CONFIG_SERIAL_8250_SHARE_IRQ=y -+CONFIG_SERIAL_8250_DW=y -+CONFIG_SERIAL_OF_PLATFORM=y -+CONFIG_SERIAL_AMBA_PL011=y -+CONFIG_SERIAL_AMBA_PL011_CONSOLE=y -+CONFIG_SERIAL_XILINX_PS_UART=y -+CONFIG_SERIAL_XILINX_PS_UART_CONSOLE=y -+CONFIG_SERIAL_FSL_LPUART=y -+CONFIG_SERIAL_FSL_LPUART_CONSOLE=y -+CONFIG_SERIAL_FSL_LINFLEXUART=y -+CONFIG_SERIAL_FSL_LINFLEXUART_CONSOLE=y -+CONFIG_SERIAL_PHYTIUM_PCI=m -+CONFIG_SERIAL_DEV_BUS=y -+CONFIG_VIRTIO_CONSOLE=y -+CONFIG_IPMI_HANDLER=m -+CONFIG_IPMI_DEVICE_INTERFACE=m -+CONFIG_IPMI_SI=m -+CONFIG_HW_RANDOM=y -+# CONFIG_HW_RANDOM_HISI_V2 is not set -+CONFIG_HW_RANDOM_PHYTIUM=y -+CONFIG_TCG_TPM=y -+CONFIG_TCG_TIS_I2C_INFINEON=y -+CONFIG_I2C_CHARDEV=y -+CONFIG_I2C_MUX=y -+CONFIG_I2C_MUX_PCA954x=y -+CONFIG_I2C_DESIGNWARE_PLATFORM=y -+CONFIG_I2C_GPIO=m -+CONFIG_I2C_PHYTIUM_PCI=y -+CONFIG_I2C_PHYTIUM_PLATFORM=y -+CONFIG_SPI=y -+CONFIG_SPI_BITBANG=m -+CONFIG_SPI_PHYTIUM_PLAT=y -+CONFIG_SPI_PHYTIUM_PCI=y -+CONFIG_SPI_PHYTIUM_QSPI=y -+CONFIG_SPI_SPIDEV=m -+CONFIG_SPMI=y -+CONFIG_PINCTRL=y -+CONFIG_PINCTRL_SINGLE=y -+CONFIG_PINCTRL_MAX77620=y -+CONFIG_GPIO_ALTERA=m -+CONFIG_GPIO_DWAPB=y -+CONFIG_GPIO_MB86S7X=y -+CONFIG_GPIO_PL061=y -+CONFIG_GPIO_WCD934X=m -+CONFIG_GPIO_XGENE=y -+CONFIG_GPIO_MAX732X=y -+CONFIG_GPIO_PCA953X=y -+CONFIG_GPIO_PCA953X_IRQ=y -+CONFIG_GPIO_BD9571MWV=m -+CONFIG_GPIO_MAX77620=y -+CONFIG_W1=m -+CONFIG_W1_MASTER_PHYTIUM=m -+CONFIG_W1_SLAVE_THERM=m -+CONFIG_POWER_RESET_BRCMSTB=y -+CONFIG_POWER_RESET_XGENE=y -+CONFIG_POWER_RESET_SYSCON=y -+CONFIG_SYSCON_REBOOT_MODE=y -+CONFIG_BATTERY_SBS=m -+CONFIG_BATTERY_BQ27XXX=y -+CONFIG_SENSORS_ARM_SCMI=y -+CONFIG_SENSORS_ARM_SCPI=y -+CONFIG_SENSORS_LM90=m -+CONFIG_SENSORS_PWM_FAN=m -+CONFIG_SENSORS_INA2XX=m -+CONFIG_SENSORS_INA3221=m -+CONFIG_SENSORS_PHYTIUM=m -+CONFIG_THERMAL_GOV_POWER_ALLOCATOR=y -+CONFIG_CPU_THERMAL=y -+CONFIG_THERMAL_EMULATION=y -+CONFIG_WATCHDOG=y -+CONFIG_ARM_SP805_WATCHDOG=y -+CONFIG_ARM_SBSA_WATCHDOG=y -+CONFIG_DW_WATCHDOG=y -+CONFIG_ARM_SMC_WATCHDOG=y -+CONFIG_MFD_BD9571MWV=y -+CONFIG_MFD_AXP20X_I2C=y -+CONFIG_MFD_HI6421_PMIC=y -+CONFIG_MFD_MAX77620=y -+CONFIG_MFD_PHYTIUM_I2S_LSD=y -+CONFIG_MFD_PHYTIUM_I2S_MMD=y -+CONFIG_MFD_RK808=y -+CONFIG_MFD_SEC_CORE=y -+CONFIG_MFD_ROHM_BD718XX=y -+CONFIG_MFD_WCD934X=m -+CONFIG_REGULATOR=y -+CONFIG_REGULATOR_FIXED_VOLTAGE=y -+CONFIG_REGULATOR_AXP20X=y -+CONFIG_REGULATOR_BD718XX=y -+CONFIG_REGULATOR_BD9571MWV=y -+CONFIG_REGULATOR_FAN53555=y -+CONFIG_REGULATOR_GPIO=y -+CONFIG_REGULATOR_HI6421V530=y -+CONFIG_REGULATOR_MAX77620=y -+CONFIG_REGULATOR_MAX8973=y -+CONFIG_REGULATOR_PCA9450=y -+CONFIG_REGULATOR_PFUZE100=y -+CONFIG_REGULATOR_PWM=y -+CONFIG_REGULATOR_QCOM_SPMI=y -+CONFIG_REGULATOR_RK808=y -+CONFIG_REGULATOR_S2MPS11=y -+CONFIG_REGULATOR_VCTRL=m -+CONFIG_RC_CORE=m -+CONFIG_RC_DECODERS=y -+CONFIG_RC_DEVICES=y -+CONFIG_MEDIA_SUPPORT=y -+CONFIG_MEDIA_CAMERA_SUPPORT=y -+CONFIG_MEDIA_ANALOG_TV_SUPPORT=y -+CONFIG_MEDIA_DIGITAL_TV_SUPPORT=y -+CONFIG_MEDIA_SDR_SUPPORT=y -+CONFIG_MEDIA_PLATFORM_SUPPORT=y -+# CONFIG_DVB_NET is not set -+CONFIG_MEDIA_USB_SUPPORT=y -+CONFIG_USB_VIDEO_CLASS=m -+CONFIG_V4L_PLATFORM_DRIVERS=y -+CONFIG_V4L_MEM2MEM_DRIVERS=y -+CONFIG_SDR_PLATFORM_DRIVERS=y -+CONFIG_VIDEO_IMX219=m -+CONFIG_VIDEO_OV5645=m -+CONFIG_DRM=y -+CONFIG_DRM_I2C_CH7006=m -+CONFIG_DRM_I2C_SIL164=m -+CONFIG_DRM_I2C_NXP_TDA998X=m -+CONFIG_DRM_MALI_DISPLAY=m -+CONFIG_DRM_RCAR_DW_HDMI=m -+CONFIG_DRM_RCAR_LVDS=m -+CONFIG_DRM_PANEL_LVDS=m -+CONFIG_DRM_PANEL_SIMPLE=m -+CONFIG_DRM_PANEL_RAYDIUM_RM67191=m -+CONFIG_DRM_PANEL_SITRONIX_ST7703=m -+CONFIG_DRM_PANEL_TRULY_NT35597_WQXGA=m -+CONFIG_DRM_DISPLAY_CONNECTOR=m -+CONFIG_DRM_LONTIUM_LT9611=m -+CONFIG_DRM_NWL_MIPI_DSI=m -+CONFIG_DRM_SII902X=m -+CONFIG_DRM_SIMPLE_BRIDGE=m -+CONFIG_DRM_THINE_THC63LVD1024=m -+CONFIG_DRM_TI_SN65DSI86=m -+CONFIG_DRM_I2C_ADV7511=m -+CONFIG_DRM_I2C_ADV7511_AUDIO=y -+CONFIG_DRM_DW_HDMI_AHB_AUDIO=m -+CONFIG_DRM_DW_HDMI_I2S_AUDIO=m -+CONFIG_DRM_DW_HDMI_CEC=m -+CONFIG_DRM_PHYTIUMVR_OCTOPUS=y -+# CONFIG_DRM_PHYTIUMVR_DVFS is not set -+CONFIG_DRM_PHYTIUMVR_OCTOPUS_DMA=y -+CONFIG_DRM_PHYTIUM=y -+CONFIG_DRM_LEGACY=y -+CONFIG_FB_MODE_HELPERS=y -+CONFIG_BACKLIGHT_CLASS_DEVICE=y -+CONFIG_BACKLIGHT_PWM=m -+CONFIG_BACKLIGHT_LP855X=m -+CONFIG_LOGO=y -+# CONFIG_LOGO_LINUX_MONO is not set -+# CONFIG_LOGO_LINUX_VGA16 is not set -+CONFIG_SOUND=y -+CONFIG_SND=y -+CONFIG_SND_HDA_INTEL=m -+CONFIG_SND_HDA_PHYTIUM=y -+CONFIG_SND_HDA_HWDEP=y -+CONFIG_SND_HDA_INPUT_BEEP=y -+CONFIG_SND_HDA_PATCH_LOADER=y -+CONFIG_SND_HDA_CODEC_REALTEK=y -+CONFIG_SND_HDA_CODEC_HDMI=y -+CONFIG_SND_SOC=y -+CONFIG_SND_SOC_FSL_SAI=m -+CONFIG_SND_SOC_PHYTIUM_I2S=y -+CONFIG_SND_PMDK_ES8388=y -+CONFIG_SND_PMDK_ES8336=y -+CONFIG_SND_PMDK_DP=y -+CONFIG_SND_SOC_AK4613=m -+CONFIG_SND_SOC_CROS_EC_CODEC=m -+CONFIG_SND_SOC_DMIC=m -+CONFIG_SND_SOC_ES7134=m -+CONFIG_SND_SOC_ES7241=m -+CONFIG_SND_SOC_MAX98357A=m -+CONFIG_SND_SOC_MAX98927=m -+CONFIG_SND_SOC_PCM3168A_I2C=m -+CONFIG_SND_SOC_SIMPLE_AMPLIFIER=m -+CONFIG_SND_SOC_SPDIF=m -+CONFIG_SND_SOC_TAS571X=m -+CONFIG_SND_SOC_WCD934X=m -+CONFIG_SND_SOC_WM8904=m -+CONFIG_SND_SOC_WSA881X=m -+CONFIG_SND_SIMPLE_CARD=y -+CONFIG_SND_AUDIO_GRAPH_CARD=y -+CONFIG_I2C_HID=m -+CONFIG_USB_CONN_GPIO=y -+CONFIG_USB=y -+CONFIG_USB_OTG=y -+CONFIG_USB_XHCI_HCD=y -+CONFIG_USB_EHCI_HCD=y -+CONFIG_USB_EHCI_HCD_PLATFORM=y -+CONFIG_USB_OHCI_HCD=y -+CONFIG_USB_OHCI_HCD_PLATFORM=y -+CONFIG_USB_ACM=m -+CONFIG_USB_STORAGE=y -+CONFIG_USB_MUSB_HDRC=y -+CONFIG_USB_DWC3=y -+CONFIG_USB_DWC2=y -+CONFIG_USB_CHIPIDEA=y -+CONFIG_USB_CHIPIDEA_UDC=y -+CONFIG_USB_CHIPIDEA_HOST=y -+CONFIG_USB_ISP1760=y -+CONFIG_USB_PHYTIUM=y -+CONFIG_USB_SERIAL=m -+CONFIG_USB_SERIAL_FTDI_SIO=m -+CONFIG_USB_HSIC_USB3503=y -+CONFIG_NOP_USB_XCEIV=y -+CONFIG_USB_ULPI=y -+CONFIG_USB_GADGET=y -+CONFIG_USB_SNP_UDC_PLAT=y -+CONFIG_USB_BDC_UDC=y -+CONFIG_USB_LIBCOMPOSITE=y -+CONFIG_USB_F_ACM=y -+CONFIG_USB_U_SERIAL=y -+CONFIG_USB_U_ETHER=y -+CONFIG_USB_F_SERIAL=y -+CONFIG_USB_F_OBEX=y -+CONFIG_USB_F_NCM=y -+CONFIG_USB_F_ECM=y -+CONFIG_USB_F_EEM=y -+CONFIG_USB_F_SUBSET=y -+CONFIG_USB_F_RNDIS=y -+CONFIG_USB_F_MASS_STORAGE=y -+CONFIG_USB_F_FS=y -+CONFIG_USB_CONFIGFS=y -+CONFIG_USB_CONFIGFS_SERIAL=y -+CONFIG_USB_CONFIGFS_ACM=y -+CONFIG_USB_CONFIGFS_OBEX=y -+CONFIG_USB_CONFIGFS_NCM=y -+CONFIG_USB_CONFIGFS_ECM=y -+CONFIG_USB_CONFIGFS_ECM_SUBSET=y -+CONFIG_USB_CONFIGFS_RNDIS=y -+CONFIG_USB_CONFIGFS_EEM=y -+CONFIG_USB_CONFIGFS_MASS_STORAGE=y -+CONFIG_USB_CONFIGFS_F_FS=y -+CONFIG_TYPEC=m -+CONFIG_TYPEC_TCPM=m -+CONFIG_TYPEC_FUSB302=m -+CONFIG_TYPEC_HD3SS3220=m -+CONFIG_MMC=y -+CONFIG_MMC_BLOCK_MINORS=32 -+CONFIG_MMC_ARMMMCI=y -+CONFIG_MMC_SDHCI=y -+CONFIG_MMC_SDHCI_ACPI=y -+CONFIG_MMC_SDHCI_PLTFM=y -+CONFIG_MMC_SDHCI_OF_ARASAN=y -+CONFIG_MMC_SDHCI_CADENCE=y -+CONFIG_MMC_SDHCI_F_SDH30=y -+CONFIG_MMC_SPI=y -+CONFIG_MMC_DW=y -+CONFIG_MMC_DW_EXYNOS=y -+CONFIG_MMC_DW_HI3798CV200=y -+CONFIG_MMC_DW_K3=y -+CONFIG_MMC_SDHCI_XENON=y -+CONFIG_MMC_SDHCI_AM654=y -+CONFIG_LEDS_GPIO=y -+CONFIG_LEDS_PWM=y -+CONFIG_LEDS_SYSCON=y -+CONFIG_LEDS_TRIGGER_TIMER=y -+CONFIG_LEDS_TRIGGER_DISK=y -+CONFIG_LEDS_TRIGGER_HEARTBEAT=y -+CONFIG_LEDS_TRIGGER_CPU=y -+CONFIG_LEDS_TRIGGER_DEFAULT_ON=y -+CONFIG_LEDS_TRIGGER_PANIC=y -+CONFIG_EDAC=y -+CONFIG_EDAC_GHES=y -+CONFIG_RTC_CLASS=y -+CONFIG_RTC_DRV_DS1307=m -+CONFIG_RTC_DRV_MAX77686=y -+CONFIG_RTC_DRV_RK808=m -+CONFIG_RTC_DRV_PCF85363=m -+CONFIG_RTC_DRV_RX8581=m -+CONFIG_RTC_DRV_RV8803=m -+CONFIG_RTC_DRV_S5M=y -+CONFIG_RTC_DRV_SD3068=m -+CONFIG_RTC_DRV_DS3232=y -+CONFIG_RTC_DRV_PCF2127=m -+CONFIG_RTC_DRV_EFI=y -+CONFIG_RTC_DRV_CROS_EC=y -+CONFIG_RTC_DRV_PL031=y -+CONFIG_DMADEVICES=y -+CONFIG_BCM_SBA_RAID=m -+CONFIG_FSL_EDMA=y -+CONFIG_MV_XOR_V2=y -+CONFIG_PL330_DMA=y -+CONFIG_PHYTIUM_PCI_DMAC=y -+CONFIG_PHYTIUM_DDMA=y -+CONFIG_UIO=m -+CONFIG_UIO_CIF=m -+CONFIG_UIO_PDRV_GENIRQ=m -+CONFIG_UIO_DMEM_GENIRQ=m -+CONFIG_UIO_AEC=m -+CONFIG_UIO_SERCOS3=m -+CONFIG_UIO_PCI_GENERIC=m -+CONFIG_UIO_NETX=m -+CONFIG_UIO_PRUSS=m -+CONFIG_UIO_MF624=m -+CONFIG_VFIO=y -+CONFIG_VFIO_PCI=y -+CONFIG_VIRTIO_PCI=y -+CONFIG_VIRTIO_BALLOON=y -+CONFIG_VIRTIO_MMIO=y -+CONFIG_XEN_GNTDEV=y -+CONFIG_XEN_GRANT_DEV_ALLOC=y -+CONFIG_STAGING=y -+CONFIG_CHROME_PLATFORMS=y -+CONFIG_CROS_EC=y -+CONFIG_CROS_EC_I2C=y -+CONFIG_CROS_EC_SPI=y -+CONFIG_CROS_EC_CHARDEV=m -+CONFIG_COMMON_CLK_RK808=y -+CONFIG_COMMON_CLK_SCPI=y -+CONFIG_COMMON_CLK_CS2000_CP=y -+CONFIG_COMMON_CLK_S2MPS11=y -+CONFIG_CLK_QORIQ=y -+CONFIG_COMMON_CLK_XGENE=y -+CONFIG_COMMON_CLK_PWM=y -+CONFIG_COMMON_CLK_VC5=y -+CONFIG_COMMON_CLK_BD718XX=m -+CONFIG_HWSPINLOCK=y -+CONFIG_HWSPINLOCK_PHYTIUM=y -+CONFIG_ARM_MHU=y -+CONFIG_PLATFORM_MHU=y -+CONFIG_PHYTIUM_MBOX=y -+CONFIG_ARM_SMMU=y -+# CONFIG_ARM_SMMU_V3 is not set -+CONFIG_REMOTEPROC=y -+CONFIG_REMOTEPROC_CDEV=y -+CONFIG_HOMO_REMOTEPROC=y -+CONFIG_RPMSG_CHAR=m -+CONFIG_RPMSG_QCOM_GLINK_RPM=y -+CONFIG_SOUNDWIRE=m -+CONFIG_SOUNDWIRE_QCOM=m -+CONFIG_SOC_BRCMSTB=y -+CONFIG_SOC_TI=y -+CONFIG_EXTCON_PTN5150=m -+CONFIG_EXTCON_USB_GPIO=y -+CONFIG_EXTCON_USBC_CROS_EC=y -+CONFIG_MEMORY=y -+CONFIG_IIO=y -+CONFIG_MAX9611=m -+CONFIG_QCOM_SPMI_ADC5=m -+CONFIG_PHYTIUM_ADC=m -+CONFIG_IIO_CROS_EC_SENSORS_CORE=m -+CONFIG_IIO_CROS_EC_SENSORS=m -+CONFIG_IIO_CROS_EC_LIGHT_PROX=m -+CONFIG_SENSORS_ISL29018=m -+CONFIG_IIO_CROS_EC_BARO=m -+CONFIG_MPL3115=m -+CONFIG_PWM=y -+CONFIG_PWM_CROS_EC=m -+CONFIG_PWM_PHYTIUM=m -+CONFIG_PHYTIUM_IXIC=y -+CONFIG_PHY_XGENE=y -+CONFIG_PHY_FSL_IMX8MQ_USB=y -+CONFIG_PHY_MIXEL_MIPI_DPHY=m -+CONFIG_PHY_QCOM_USB_HS=y -+CONFIG_PHY_SAMSUNG_USB2=y -+CONFIG_FPGA=y -+CONFIG_FPGA_BRIDGE=m -+CONFIG_ALTERA_FREEZE_BRIDGE=m -+CONFIG_FPGA_REGION=m -+CONFIG_OF_FPGA_REGION=m -+CONFIG_MUX_MMIO=y -+CONFIG_SLIM_QCOM_CTRL=m -+CONFIG_INTERCONNECT=y -+CONFIG_EXT2_FS=y -+CONFIG_EXT3_FS=y -+CONFIG_EXT4_FS_POSIX_ACL=y -+CONFIG_HMDFS_FS=y -+CONFIG_HMDFS_FS_PERMISSION=y -+CONFIG_HMDFS_FS_DEBUG=y -+CONFIG_BTRFS_FS=m -+CONFIG_BTRFS_FS_POSIX_ACL=y -+CONFIG_FANOTIFY=y -+CONFIG_FANOTIFY_ACCESS_PERMISSIONS=y -+CONFIG_QUOTA=y -+CONFIG_AUTOFS4_FS=y -+CONFIG_FUSE_FS=m -+CONFIG_CUSE=m -+CONFIG_OVERLAY_FS=m -+CONFIG_VFAT_FS=y -+CONFIG_TMPFS=y -+CONFIG_HUGETLBFS=y -+CONFIG_EFIVAR_FS=y -+CONFIG_SQUASHFS=y -+CONFIG_SQUASHFS_XATTR=y -+CONFIG_SQUASHFS_LZ4=y -+CONFIG_SQUASHFS_LZO=y -+CONFIG_SQUASHFS_XZ=y -+CONFIG_SQUASHFS_ZSTD=y -+CONFIG_SQUASHFS_4K_DEVBLK_SIZE=y -+CONFIG_SQUASHFS_EMBEDDED=y -+CONFIG_NFS_FS=y -+CONFIG_NFS_V4=y -+CONFIG_NFS_V4_1=y -+CONFIG_NFS_V4_2=y -+CONFIG_ROOT_NFS=y -+CONFIG_NFSD=y -+CONFIG_NFSD_V3_ACL=y -+CONFIG_NFSD_V4=y -+CONFIG_NFSD_BLOCKLAYOUT=y -+CONFIG_NFSD_SCSILAYOUT=y -+CONFIG_NFSD_FLEXFILELAYOUT=y -+CONFIG_NFSD_V4_2_INTER_SSC=y -+CONFIG_NFSD_V4_SECURITY_LABEL=y -+CONFIG_9P_FS=y -+CONFIG_NLS_CODEPAGE_437=y -+CONFIG_NLS_ISO8859_1=y -+CONFIG_SECURITY=y -+CONFIG_CRYPTO_USER=y -+CONFIG_CRYPTO_ECHAINIV=y -+CONFIG_CRYPTO_ANSI_CPRNG=y -+CONFIG_CRYPTO_DRBG_HASH=y -+CONFIG_CRYPTO_USER_API_HASH=y -+CONFIG_CRYPTO_USER_API_SKCIPHER=y -+CONFIG_CRYPTO_USER_API_RNG=m -+CONFIG_CRYPTO_USER_API_AEAD=y -+CONFIG_CRYPTO_DEV_CCREE=m -+CONFIG_CRYPTO_DEV_HISI_SEC2=m -+CONFIG_CRYPTO_DEV_HISI_ZIP=m -+CONFIG_CRYPTO_DEV_HISI_HPRE=m -+CONFIG_CRYPTO_DEV_AMLOGIC_GXL=m -+CONFIG_INDIRECT_PIO=y -+CONFIG_CRC_CCITT=m -+CONFIG_DMA_CMA=y -+CONFIG_DMA_PERNUMA_CMA=y -+CONFIG_CMA_SIZE_MBYTES=32 -+CONFIG_PRINTK_TIME=y -+CONFIG_DEBUG_INFO=y -+CONFIG_MAGIC_SYSRQ=y -+CONFIG_DEBUG_FS=y -+CONFIG_DEBUG_KERNEL=y -+# CONFIG_SCHED_DEBUG is not set -+# CONFIG_DEBUG_PREEMPT is not set -+# CONFIG_FTRACE is not set -+CONFIG_MEMTEST=y -+ -+CONFIG_GPIO_SYSFS=y -+CONFIG_HID_MULTITOUCH=y -+ -+CONFIG_HIEVENT=y -+CONFIG_BBOX_BUFFER_SIZE=2048 -+CONFIG_HISYSEVENT=y -+ -+ -+CONFIG_ASHMEM=y -+ -+CONFIG_ANDROID=y -+CONFIG_ANDROID_BINDER_IPC=y -+# CONFIG_ANDROID_BINDERFS is not set -+CONFIG_ANDROID_BINDER_DEVICES="binder,hwbinder,vndbinder" -+# CONFIG_ANDROID_BINDER_IPC_SELFTEST is not set -+CONFIG_BINDER_TRANSACTION_PROC_BRIEF=y -+ -+CONFIG_ACCESS_TOKENID=y -+ -+CONFIG_PSI=y -+ -+# CONFIG_SUSPEND is not set -+CONFIG_VIDEO_PHYTIUM_VPU=y -+ -+CONFIG_DRM_RADEON=y -+CONFIG_DRM_RADEON_USERPTR=y -+CONFIG_DRM_AMDGPU=y -+CONFIG_DRM_AMDGPU_SI=y -+CONFIG_DRM_AMDGPU_CIK=y -+CONFIG_DRM_AMDGPU_USERPTR=y -+CONFIG_DRM_AMDGPU_GART_DEBUGFS=y -+CONFIG_DRM_MWV207=y -diff --git a/arch/arm64/include/asm/arch_timer.h b/arch/arm64/include/asm/arch_timer.h -index 88d20f04c..af1fafbe7 100644 ---- a/arch/arm64/include/asm/arch_timer.h -+++ b/arch/arm64/include/asm/arch_timer.h -@@ -32,7 +32,7 @@ - ({ \ - const struct arch_timer_erratum_workaround *__wa; \ - __wa = __this_cpu_read(timer_unstable_counter_workaround); \ -- (__wa && __wa->h) ? __wa->h : arch_timer_##h; \ -+ (__wa && __wa->h) ? ({ isb(); __wa->h;}) : arch_timer_##h; \ - }) - - #else -@@ -52,8 +52,6 @@ struct arch_timer_erratum_workaround { - enum arch_timer_erratum_match_type match_type; - const void *id; - const char *desc; -- u32 (*read_cntp_tval_el0)(void); -- u32 (*read_cntv_tval_el0)(void); - u64 (*read_cntpct_el0)(void); - u64 (*read_cntvct_el0)(void); - int (*set_next_event_phys)(unsigned long, struct clock_event_device *); -@@ -64,25 +62,28 @@ struct arch_timer_erratum_workaround { - DECLARE_PER_CPU(const struct arch_timer_erratum_workaround *, - timer_unstable_counter_workaround); - --/* inline sysreg accessors that make erratum_handler() work */ --static inline notrace u32 arch_timer_read_cntp_tval_el0(void) -+static inline notrace u64 arch_timer_read_cntpct_el0(void) - { -- return read_sysreg(cntp_tval_el0); --} -+ u64 cnt; - --static inline notrace u32 arch_timer_read_cntv_tval_el0(void) --{ -- return read_sysreg(cntv_tval_el0); --} -+ asm volatile(ALTERNATIVE("isb\n mrs %0, cntpct_el0", -+ "nop\n" __mrs_s("%0", SYS_CNTPCTSS_EL0), -+ ARM64_HAS_ECV) -+ : "=r" (cnt)); - --static inline notrace u64 arch_timer_read_cntpct_el0(void) --{ -- return read_sysreg(cntpct_el0); -+ return cnt; - } - - static inline notrace u64 arch_timer_read_cntvct_el0(void) - { -- return read_sysreg(cntvct_el0); -+ u64 cnt; -+ -+ asm volatile(ALTERNATIVE("isb\n mrs %0, cntvct_el0", -+ "nop\n" __mrs_s("%0", SYS_CNTVCTSS_EL0), -+ ARM64_HAS_ECV) -+ : "=r" (cnt)); -+ -+ return cnt; - } - - #define arch_timer_reg_read_stable(reg) \ -@@ -102,51 +103,58 @@ static inline notrace u64 arch_timer_read_cntvct_el0(void) - * the code. - */ - static __always_inline --void arch_timer_reg_write_cp15(int access, enum arch_timer_reg reg, u32 val) -+void arch_timer_reg_write_cp15(int access, enum arch_timer_reg reg, u64 val) - { - if (access == ARCH_TIMER_PHYS_ACCESS) { - switch (reg) { - case ARCH_TIMER_REG_CTRL: - write_sysreg(val, cntp_ctl_el0); -+ isb(); - break; -- case ARCH_TIMER_REG_TVAL: -- write_sysreg(val, cntp_tval_el0); -+ case ARCH_TIMER_REG_CVAL: -+ write_sysreg(val, cntp_cval_el0); - break; -+ default: -+ BUILD_BUG(); - } - } else if (access == ARCH_TIMER_VIRT_ACCESS) { - switch (reg) { - case ARCH_TIMER_REG_CTRL: - write_sysreg(val, cntv_ctl_el0); -+ isb(); - break; -- case ARCH_TIMER_REG_TVAL: -- write_sysreg(val, cntv_tval_el0); -+ case ARCH_TIMER_REG_CVAL: -+ write_sysreg(val, cntv_cval_el0); - break; -+ default: -+ BUILD_BUG(); - } -+ } else { -+ BUILD_BUG(); - } -- -- isb(); - } - - static __always_inline --u32 arch_timer_reg_read_cp15(int access, enum arch_timer_reg reg) -+u64 arch_timer_reg_read_cp15(int access, enum arch_timer_reg reg) - { - if (access == ARCH_TIMER_PHYS_ACCESS) { - switch (reg) { - case ARCH_TIMER_REG_CTRL: - return read_sysreg(cntp_ctl_el0); -- case ARCH_TIMER_REG_TVAL: -- return arch_timer_reg_read_stable(cntp_tval_el0); -+ default: -+ BUILD_BUG(); - } - } else if (access == ARCH_TIMER_VIRT_ACCESS) { - switch (reg) { - case ARCH_TIMER_REG_CTRL: - return read_sysreg(cntv_ctl_el0); -- case ARCH_TIMER_REG_TVAL: -- return arch_timer_reg_read_stable(cntv_tval_el0); -+ default: -+ BUILD_BUG(); - } - } - -- BUG(); -+ BUILD_BUG(); -+ unreachable(); - } - - static inline u32 arch_timer_get_cntfrq(void) -@@ -169,7 +177,6 @@ static __always_inline u64 __arch_counter_get_cntpct_stable(void) - { - u64 cnt; - -- isb(); - cnt = arch_timer_reg_read_stable(cntpct_el0); - arch_counter_enforce_ordering(cnt); - return cnt; -@@ -179,8 +186,10 @@ static __always_inline u64 __arch_counter_get_cntpct(void) - { - u64 cnt; - -- isb(); -- cnt = read_sysreg(cntpct_el0); -+ asm volatile(ALTERNATIVE("isb\n mrs %0, cntpct_el0", -+ "nop\n" __mrs_s("%0", SYS_CNTPCTSS_EL0), -+ ARM64_HAS_ECV) -+ : "=r" (cnt)); - arch_counter_enforce_ordering(cnt); - return cnt; - } -@@ -189,7 +198,6 @@ static __always_inline u64 __arch_counter_get_cntvct_stable(void) - { - u64 cnt; - -- isb(); - cnt = arch_timer_reg_read_stable(cntvct_el0); - arch_counter_enforce_ordering(cnt); - return cnt; -@@ -199,8 +207,10 @@ static __always_inline u64 __arch_counter_get_cntvct(void) - { - u64 cnt; - -- isb(); -- cnt = read_sysreg(cntvct_el0); -+ asm volatile(ALTERNATIVE("isb\n mrs %0, cntvct_el0", -+ "nop\n" __mrs_s("%0", SYS_CNTVCTSS_EL0), -+ ARM64_HAS_ECV) -+ : "=r" (cnt)); - arch_counter_enforce_ordering(cnt); - return cnt; - } -diff --git a/arch/arm64/include/asm/cpucaps.h b/arch/arm64/include/asm/cpucaps.h -index d2080a41f..e4187003d 100644 ---- a/arch/arm64/include/asm/cpucaps.h -+++ b/arch/arm64/include/asm/cpucaps.h -@@ -67,9 +67,9 @@ - #define ARM64_MTE 57 - #define ARM64_WORKAROUND_1508412 58 - #define ARM64_SPECTRE_BHB 59 --#define ARM64_WORKAROUND_2457168 60 --#define ARM64_WORKAROUND_1742098 61 -- --#define ARM64_NCAPS 62 -+#define ARM64_WORKAROUND_2457168 60 -+#define ARM64_WORKAROUND_1742098 61 -+#define ARM64_HAS_ECV 62 -+#define ARM64_NCAPS 63 - - #endif /* __ASM_CPUCAPS_H */ -diff --git a/arch/arm64/include/asm/esr.h b/arch/arm64/include/asm/esr.h -index 4a76f566e..d7638b528 100644 ---- a/arch/arm64/include/asm/esr.h -+++ b/arch/arm64/include/asm/esr.h -@@ -227,6 +227,9 @@ - #define ESR_ELx_SYS64_ISS_SYS_CNTVCT (ESR_ELx_SYS64_ISS_SYS_VAL(3, 3, 2, 14, 0) | \ - ESR_ELx_SYS64_ISS_DIR_READ) - -+#define ESR_ELx_SYS64_ISS_SYS_CNTVCTSS (ESR_ELx_SYS64_ISS_SYS_VAL(3, 3, 6, 14, 0) | \ -+ ESR_ELx_SYS64_ISS_DIR_READ) -+ - #define ESR_ELx_SYS64_ISS_SYS_CNTFRQ (ESR_ELx_SYS64_ISS_SYS_VAL(3, 3, 0, 14, 0) | \ - ESR_ELx_SYS64_ISS_DIR_READ) - -@@ -317,6 +320,9 @@ - #define ESR_ELx_CP15_64_ISS_SYS_CNTVCT (ESR_ELx_CP15_64_ISS_SYS_VAL(1, 14) | \ - ESR_ELx_CP15_64_ISS_DIR_READ) - -+#define ESR_ELx_CP15_64_ISS_SYS_CNTVCTSS (ESR_ELx_CP15_64_ISS_SYS_VAL(9, 14) | \ -+ ESR_ELx_CP15_64_ISS_DIR_READ) -+ - #define ESR_ELx_CP15_32_ISS_SYS_CNTFRQ (ESR_ELx_CP15_32_ISS_SYS_VAL(0, 0, 14, 0) |\ - ESR_ELx_CP15_32_ISS_DIR_READ) - -diff --git a/arch/arm64/include/asm/sysreg.h b/arch/arm64/include/asm/sysreg.h -index db39983ce..9794c7fcf 100644 ---- a/arch/arm64/include/asm/sysreg.h -+++ b/arch/arm64/include/asm/sysreg.h -@@ -453,6 +453,9 @@ - - #define SYS_CNTFRQ_EL0 sys_reg(3, 3, 14, 0, 0) - -+#define SYS_CNTPCTSS_EL0 sys_reg(3, 3, 14, 0, 5) -+#define SYS_CNTVCTSS_EL0 sys_reg(3, 3, 14, 0, 6) -+ - #define SYS_CNTP_TVAL_EL0 sys_reg(3, 3, 14, 2, 0) - #define SYS_CNTP_CTL_EL0 sys_reg(3, 3, 14, 2, 1) - #define SYS_CNTP_CVAL_EL0 sys_reg(3, 3, 14, 2, 2) -diff --git a/arch/arm64/kernel/cpufeature.c b/arch/arm64/kernel/cpufeature.c -index 4f6e89491..2885f3da9 100644 ---- a/arch/arm64/kernel/cpufeature.c -+++ b/arch/arm64/kernel/cpufeature.c -@@ -1769,6 +1769,16 @@ static const struct arm64_cpu_capabilities arm64_features[] = { - .sign = FTR_UNSIGNED, - .min_field_value = 1, - }, -+ { -+ .desc = "Enhanced Counter Virtualization", -+ .capability = ARM64_HAS_ECV, -+ .type = ARM64_CPUCAP_SYSTEM_FEATURE, -+ .matches = has_cpuid_feature, -+ .sys_reg = SYS_ID_AA64MMFR0_EL1, -+ .field_pos = ID_AA64MMFR0_ECV_SHIFT, -+ .sign = FTR_UNSIGNED, -+ .min_field_value = 1, -+ }, - #ifdef CONFIG_ARM64_PAN - { - .desc = "Privileged Access Never", -diff --git a/arch/arm64/kernel/traps.c b/arch/arm64/kernel/traps.c -index 10a58017d..dd19cea3b 100644 ---- a/arch/arm64/kernel/traps.c -+++ b/arch/arm64/kernel/traps.c -@@ -552,6 +552,12 @@ static const struct sys64_hook sys64_hooks[] = { - .esr_val = ESR_ELx_SYS64_ISS_SYS_CNTVCT, - .handler = cntvct_read_handler, - }, -+ { -+ /* Trap read access to CNTVCTSS_EL0 */ -+ .esr_mask = ESR_ELx_SYS64_ISS_SYS_OP_MASK, -+ .esr_val = ESR_ELx_SYS64_ISS_SYS_CNTVCTSS, -+ .handler = cntvct_read_handler, -+ }, - { - /* Trap read access to CNTFRQ_EL0 */ - .esr_mask = ESR_ELx_SYS64_ISS_SYS_OP_MASK, -@@ -628,6 +634,11 @@ static const struct sys64_hook cp15_64_hooks[] = { - .esr_val = ESR_ELx_CP15_64_ISS_SYS_CNTVCT, - .handler = compat_cntvct_read_handler, - }, -+ { -+ .esr_mask = ESR_ELx_CP15_64_ISS_SYS_MASK, -+ .esr_val = ESR_ELx_CP15_64_ISS_SYS_CNTVCTSS, -+ .handler = compat_cntvct_read_handler, -+ }, - {}, - }; - -diff --git a/arch/arm64/mm/flush.c b/arch/arm64/mm/flush.c -index 6d44c028d..1fa10d7b3 100644 ---- a/arch/arm64/mm/flush.c -+++ b/arch/arm64/mm/flush.c -@@ -78,6 +78,8 @@ EXPORT_SYMBOL(flush_dcache_page); - * Additional functions defined in assembly. - */ - EXPORT_SYMBOL(__flush_icache_range); -+EXPORT_SYMBOL(__flush_dcache_area); -+EXPORT_SYMBOL(__inval_dcache_area); - - #ifdef CONFIG_ARCH_HAS_PMEM_API - void arch_wb_cache_pmem(void *addr, size_t size) -diff --git a/drivers/acpi/acpi_apd.c b/drivers/acpi/acpi_apd.c -index 645e82a66..b7ee51710 100644 ---- a/drivers/acpi/acpi_apd.c -+++ b/drivers/acpi/acpi_apd.c -@@ -158,6 +158,16 @@ static const struct apd_device_desc hip08_lite_i2c_desc = { - .fixed_clk_rate = 125000000, - }; - -+static const struct apd_device_desc phytium_i2c_desc = { -+ .setup = acpi_apd_setup, -+ .fixed_clk_rate = 200000000, -+}; -+ -+static const struct apd_device_desc phytium_pe220x_i2c_desc = { -+ .setup = acpi_apd_setup, -+ .fixed_clk_rate = 50000000, -+}; -+ - static const struct apd_device_desc thunderx2_i2c_desc = { - .setup = acpi_apd_setup, - .fixed_clk_rate = 125000000, -@@ -240,6 +250,8 @@ static const struct acpi_device_id acpi_apd_device_ids[] = { - { "HISI02A2", APD_ADDR(hip08_i2c_desc) }, - { "HISI02A3", APD_ADDR(hip08_lite_i2c_desc) }, - { "HISI0173", APD_ADDR(hip08_spi_desc) }, -+ { "PHYT0003", APD_ADDR(phytium_i2c_desc) }, -+ { "PHYT0038", APD_ADDR(phytium_pe220x_i2c_desc) }, - { "NXP0001", APD_ADDR(nxp_i2c_desc) }, - #endif - { } -diff --git a/drivers/acpi/internal.h b/drivers/acpi/internal.h -index 125e4901c..bc242c874 100644 ---- a/drivers/acpi/internal.h -+++ b/drivers/acpi/internal.h -@@ -90,6 +90,18 @@ bool acpi_scan_is_offline(struct acpi_device *adev, bool uevent); - acpi_status acpi_sysfs_table_handler(u32 event, void *table, void *context); - void acpi_scan_table_handler(u32 event, void *table, void *context); - -+#ifdef CONFIG_ACPI_GENERIC_GSI -+int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, -+ int polarity, struct fwnode_handle *fwnode); -+#else -+static inline -+int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, -+ int polarity, struct fwnode_handle *fwnode) -+{ -+ return acpi_register_gsi(dev, hwirq, trigger, polarity); -+} -+#endif -+ - /* -------------------------------------------------------------------------- - Device Node Initialization / Removal - -------------------------------------------------------------------------- */ -diff --git a/drivers/acpi/irq.c b/drivers/acpi/irq.c -index 6a9490ad7..86336a89f 100644 ---- a/drivers/acpi/irq.c -+++ b/drivers/acpi/irq.c -@@ -10,6 +10,8 @@ - #include - #include - -+#include "internal.h" -+ - enum acpi_irq_model_id acpi_irq_model; - - static struct fwnode_handle *acpi_gsi_domain_id; -@@ -38,6 +40,24 @@ int acpi_gsi_to_irq(u32 gsi, unsigned int *irq) - } - EXPORT_SYMBOL_GPL(acpi_gsi_to_irq); - -+int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, -+ int polarity, struct fwnode_handle *fwnode) -+{ -+ struct irq_fwspec fwspec; -+ -+ if (!fwnode) { -+ dev_warn(dev, "No registered irqchip for hwirq %d\n", hwirq); -+ return -EINVAL; -+ } -+ -+ fwspec.fwnode = fwnode; -+ fwspec.param[0] = hwirq; -+ fwspec.param[1] = acpi_dev_get_irq_type(trigger, polarity); -+ fwspec.param_count = 2; -+ -+ return irq_create_fwspec_mapping(&fwspec); -+} -+ - /** - * acpi_register_gsi() - Map a GSI to a linux IRQ number - * @dev: device for which IRQ has to be mapped -@@ -51,24 +71,7 @@ EXPORT_SYMBOL_GPL(acpi_gsi_to_irq); - int acpi_register_gsi(struct device *dev, u32 gsi, int trigger, - int polarity) - { -- struct irq_fwspec fwspec; -- unsigned int irq; -- -- if (WARN_ON(!acpi_gsi_domain_id)) { -- pr_warn("GSI: No registered irqchip, giving up\n"); -- return -EINVAL; -- } -- -- fwspec.fwnode = acpi_gsi_domain_id; -- fwspec.param[0] = gsi; -- fwspec.param[1] = acpi_dev_get_irq_type(trigger, polarity); -- fwspec.param_count = 2; -- -- irq = irq_create_fwspec_mapping(&fwspec); -- if (!irq) -- return -EINVAL; -- -- return irq; -+ return acpi_register_irq(dev, gsi, trigger, polarity, acpi_gsi_domain_id); - } - EXPORT_SYMBOL_GPL(acpi_register_gsi); - -@@ -97,7 +100,7 @@ EXPORT_SYMBOL_GPL(acpi_unregister_gsi); - * Return: - * The referenced device fwhandle or NULL on failure - */ --static struct fwnode_handle * -+struct fwnode_handle * - acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source) - { - struct fwnode_handle *result; -diff --git a/drivers/acpi/pci_irq.c b/drivers/acpi/pci_irq.c -index 14ee631cb..5cccc0f70 100644 ---- a/drivers/acpi/pci_irq.c -+++ b/drivers/acpi/pci_irq.c -@@ -22,6 +22,8 @@ - #include - #include - -+#include "internal.h" -+ - #define PREFIX "ACPI: " - - #define _COMPONENT ACPI_PCI_COMPONENT -@@ -410,6 +412,7 @@ int acpi_pci_irq_enable(struct pci_dev *dev) - char *link = NULL; - char link_desc[16]; - int rc; -+ struct fwnode_handle *rs_fwnode; - - pin = dev->pin; - if (!pin) { -@@ -438,7 +441,8 @@ int acpi_pci_irq_enable(struct pci_dev *dev) - gsi = acpi_pci_link_allocate_irq(entry->link, - entry->index, - &triggering, &polarity, -- &link); -+ &link, -+ &rs_fwnode); - else - gsi = entry->index; - } else -@@ -462,7 +466,7 @@ int acpi_pci_irq_enable(struct pci_dev *dev) - return 0; - } - -- rc = acpi_register_gsi(&dev->dev, gsi, triggering, polarity); -+ rc = acpi_register_irq(&dev->dev, gsi, triggering, polarity, rs_fwnode); - if (rc < 0) { - dev_warn(&dev->dev, "PCI INT %c: failed to register GSI\n", - pin_name(pin)); -diff --git a/drivers/acpi/pci_link.c b/drivers/acpi/pci_link.c -index fb4c5632a..21f3e4e30 100644 ---- a/drivers/acpi/pci_link.c -+++ b/drivers/acpi/pci_link.c -@@ -59,6 +59,7 @@ struct acpi_pci_link_irq { - u8 resource_type; - u8 possible_count; - u32 possible[ACPI_PCI_LINK_MAX_POSSIBLE]; -+ struct acpi_resource_source resource_source; - u8 initialized:1; - u8 reserved:7; - }; -@@ -120,6 +121,8 @@ static acpi_status acpi_pci_link_check_possible(struct acpi_resource *resource, - { - struct acpi_resource_extended_irq *p = - &resource->data.extended_irq; -+ struct acpi_resource_source *rs = -+ &link->irq.resource_source; - if (!p || !p->interrupt_count) { - printk(KERN_WARNING PREFIX - "Blank _PRS EXT IRQ resource\n"); -@@ -140,6 +143,12 @@ static acpi_status acpi_pci_link_check_possible(struct acpi_resource *resource, - link->irq.triggering = p->triggering; - link->irq.polarity = p->polarity; - link->irq.resource_type = ACPI_RESOURCE_TYPE_EXTENDED_IRQ; -+ if (p->resource_source.string_length) { -+ rs->index = p->resource_source.index; -+ rs->string_length = p->resource_source.string_length; -+ rs->string_ptr = kstrdup(p->resource_source.string_ptr, -+ GFP_KERNEL); -+ } - break; - } - default: -@@ -326,7 +335,8 @@ static int acpi_pci_link_set(struct acpi_pci_link *link, int irq) - resource->res.data.extended_irq.shareable = ACPI_SHARED; - resource->res.data.extended_irq.interrupt_count = 1; - resource->res.data.extended_irq.interrupts[0] = irq; -- /* ignore resource_source, it's optional */ -+ resource->res.data.extended_irq.resource_source = -+ link->irq.resource_source; - break; - default: - printk(KERN_ERR PREFIX "Invalid Resource_type %d\n", link->irq.resource_type); -@@ -612,7 +622,7 @@ static int acpi_pci_link_allocate(struct acpi_pci_link *link) - * failure: return -1 - */ - int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, -- int *polarity, char **name) -+ int *polarity, char **name, struct fwnode_handle **rs_fwnode) - { - int result; - struct acpi_device *device; -@@ -656,6 +666,8 @@ int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, - *polarity = link->irq.polarity; - if (name) - *name = acpi_device_bid(link->device); -+ if (rs_fwnode) -+ *rs_fwnode = acpi_get_irq_source_fwhandle(&link->irq.resource_source); - ACPI_DEBUG_PRINT((ACPI_DB_INFO, - "Link %s is referenced\n", - acpi_device_bid(link->device))); -diff --git a/drivers/char/hw_random/Kconfig b/drivers/char/hw_random/Kconfig -index a7d9e4600..b5ff63d39 100644 ---- a/drivers/char/hw_random/Kconfig -+++ b/drivers/char/hw_random/Kconfig -@@ -536,6 +536,18 @@ config HW_RANDOM_XIPHERA - To compile this driver as a module, choose M here: the - module will be called xiphera-trng. - -+config HW_RANDOM_PHYTIUM -+ tristate "Phytium Random Number Generator support" -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ help -+ This driver provides kernel-side support for the Random Number -+ Generator hardware found on Phytium SoCs. -+ -+ To compile this driver as a module, choose M here: the -+ module will be called phytium-rng. -+ -+ If unsure, say Y. -+ - endif # HW_RANDOM - - config UML_RANDOM -diff --git a/drivers/char/hw_random/Makefile b/drivers/char/hw_random/Makefile -index 5da344509..17cc2f445 100644 ---- a/drivers/char/hw_random/Makefile -+++ b/drivers/char/hw_random/Makefile -@@ -46,3 +46,5 @@ obj-$(CONFIG_HW_RANDOM_OPTEE) += optee-rng.o - obj-$(CONFIG_HW_RANDOM_NPCM) += npcm-rng.o - obj-$(CONFIG_HW_RANDOM_CCTRNG) += cctrng.o - obj-$(CONFIG_HW_RANDOM_XIPHERA) += xiphera-trng.o -+ -+obj-$(CONFIG_HW_RANDOM_PHYTIUM) += phytium-rng.o -\ No newline at end of file -diff --git a/drivers/char/hw_random/phytium-rng.c b/drivers/char/hw_random/phytium-rng.c -new file mode 100644 -index 000000000..f8ab17f33 ---- /dev/null -+++ b/drivers/char/hw_random/phytium-rng.c -@@ -0,0 +1,155 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SoC RNG Driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define TRNG_CR 0x00 -+#define TRNG_CR_RNGEN BIT(0) -+#define TRNG_CR_ROSEN_MASK GENMASK(7, 4) -+#define TRNG_CR_DIEN BIT(16) -+#define TRNG_CR_ERIEN BIT(17) -+#define TRNG_CR_IRQEN BIT(24) -+#define TRNG_MSEL 0x04 -+#define TRNG_MSEL_MSEL BIT(0) -+#define TRNG_SR 0x08 -+#define TRNG_SR_HTF BIT(0) -+#define TRNG_SR_DRDY BIT(1) -+#define TRNG_SR_ERERR BIT(3) -+#define TRNG_DR 0x0C -+#define TRNG_RESEED 0x40 -+#define TRNG_RESEED_RSED BIT(0) -+ -+#define DELAY 10 -+#define TIMEOUT 100 -+ -+static int msel; -+module_param(msel, int, 0444); -+MODULE_PARM_DESC(msel, "Phytium RNG mode selection: 0 - TRNG. 1 - PRNG."); -+ -+struct phytium_rng { -+ struct hwrng rng; -+ void __iomem *base; -+}; -+ -+static int phytium_rng_init(struct hwrng *rng) -+{ -+ struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); -+ u32 reg; -+ -+ /* Mode Selection */ -+ reg = msel ? TRNG_MSEL_MSEL : 0; -+ writel(reg, priv->base + TRNG_MSEL); -+ -+ /* If PRGN mode is on, do reseed operations */ -+ if (msel) -+ writel(TRNG_RESEED_RSED, priv->base + TRNG_RESEED); -+ -+ /* Clear status */ -+ writel(0x7, priv->base + TRNG_SR); -+ -+ /* Enable TRNG */ -+ reg = readl(priv->base + TRNG_CR) | TRNG_CR_ROSEN_MASK | TRNG_CR_RNGEN; -+ writel(reg, priv->base + TRNG_CR); -+ -+ return 0; -+} -+ -+static void phytium_rng_cleanup(struct hwrng *rng) -+{ -+ struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); -+ -+ writel(0x7, priv->base + TRNG_SR); -+} -+ -+static int phytium_rng_read(struct hwrng *rng, void *buf, size_t max, bool wait) -+{ -+ struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); -+ u32 reg; -+ int ret = 0; -+ -+ /* TRNG can generate at most 8*32bit random number per time */ -+ max = max > 32 ? 32 : max; -+ -+ reg = readl(priv->base + TRNG_SR); -+ if (!(reg & TRNG_SR_DRDY) && wait) { -+ ret = readl_poll_timeout(priv->base + TRNG_SR, reg, -+ reg & TRNG_SR_DRDY, DELAY, TIMEOUT); -+ if (ret) { -+ dev_err((struct device *)priv->rng.priv, -+ "%s: timeout %x!\n", __func__, reg); -+ return -EIO; -+ } -+ } -+ -+ while (max >= 4) { -+ *(u32 *)buf = readl(priv->base + TRNG_DR); -+ -+ ret += sizeof(u32); -+ buf += sizeof(u32); -+ max -= sizeof(u32); -+ } -+ -+ /* Clear DRDY by writing 1 */ -+ writel(reg | TRNG_SR_DRDY, priv->base + TRNG_SR); -+ -+ return ret; -+} -+ -+static int phytium_rng_probe(struct platform_device *pdev) -+{ -+ struct phytium_rng *priv; -+ struct resource *mem; -+ -+ priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); -+ if (!priv) -+ return -ENOMEM; -+ -+ platform_set_drvdata(pdev, priv); -+ -+ mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ priv->base = devm_ioremap_resource(&pdev->dev, mem); -+ if (IS_ERR(priv->base)) -+ return PTR_ERR(priv->base); -+ -+ priv->rng.name = pdev->name; -+ priv->rng.init = phytium_rng_init; -+ priv->rng.cleanup = phytium_rng_cleanup; -+ priv->rng.read = phytium_rng_read; -+ priv->rng.priv = (unsigned long)&pdev->dev; -+ priv->rng.quality = 1000; -+ -+ return devm_hwrng_register(&pdev->dev, &priv->rng); -+} -+ -+static const struct of_device_id phytium_rng_dt_ids[] = { -+ { .compatible = "phytium,rng" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_rng_dt_ids); -+ -+static struct platform_driver phytium_rng_driver = { -+ .probe = phytium_rng_probe, -+ .driver = { -+ .name = "phytium-rng", -+ .of_match_table = of_match_ptr(phytium_rng_dt_ids), -+ } -+}; -+module_platform_driver(phytium_rng_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium random number generator driver"); -+MODULE_AUTHOR("Chen Baozi "); -diff --git a/drivers/char/ipmi/Kconfig b/drivers/char/ipmi/Kconfig -index f44318626..1fdabf78a 100644 ---- a/drivers/char/ipmi/Kconfig -+++ b/drivers/char/ipmi/Kconfig -@@ -109,6 +109,27 @@ config ASPEED_KCS_IPMI_BMC - The driver implements the BMC side of the KCS contorller, it - provides the access of KCS IO space for BMC side. - -+config PHYTIUM_KCS_IPMI_BMC -+ depends on ARCH_PHYTIUM -+ select IPMI_KCS_BMC -+ select REGMAP_MMIO -+ tristate "PHYTIUM KCS IPMI BMC driver" -+ help -+ Provides a driver for the KCS (Kerboard Controller Style) IPMI -+ interface found on Phytium SOCs. -+ -+ The driver implements the BMC side of the KCS controller, it -+ provides the access of KCS IO space for BMC side. -+ -+config PHYTIUM_BT_IPMI_BMC -+ depends on ARCH_PHYTIUM -+ depends on REGMAP && REGMAP_MMIO && MFD_SYSCON -+ tristate "PHYTIUM BT BMC driver" -+ help -+ Provides a driver for the BT (Block Transfer) IPMI interface -+ found on Phytium SOCs. The driver implements the BMC -+ side of the BT interface. -+ - config NPCM7XX_KCS_IPMI_BMC - depends on ARCH_NPCM7XX || COMPILE_TEST - select IPMI_KCS_BMC -diff --git a/drivers/char/ipmi/Makefile b/drivers/char/ipmi/Makefile -index 0822adc2e..97712d873 100644 ---- a/drivers/char/ipmi/Makefile -+++ b/drivers/char/ipmi/Makefile -@@ -27,3 +27,5 @@ obj-$(CONFIG_ASPEED_BT_IPMI_BMC) += bt-bmc.o - obj-$(CONFIG_ASPEED_KCS_IPMI_BMC) += kcs_bmc_aspeed.o - obj-$(CONFIG_NPCM7XX_KCS_IPMI_BMC) += kcs_bmc_npcm7xx.o - obj-$(CONFIG_IPMB_DEVICE_INTERFACE) += ipmb_dev_int.o -+obj-$(CONFIG_PHYTIUM_KCS_IPMI_BMC) += kcs_bmc_phytium.o -+obj-$(CONFIG_PHYTIUM_BT_IPMI_BMC) += bt_bmc_phytium.o -\ No newline at end of file -diff --git a/drivers/char/ipmi/bt_bmc_phytium.c b/drivers/char/ipmi/bt_bmc_phytium.c -new file mode 100755 -index 000000000..d66b6b3dd ---- /dev/null -+++ b/drivers/char/ipmi/bt_bmc_phytium.c -@@ -0,0 +1,533 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from drivers/char/ipmi/bt-bmc.c -+ * Copyright (c) 2015-2016, IBM Corporation. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/* -+ * This is a BMC device used to communicate to the host -+ */ -+#define DEVICE_NAME "ipmi-bt-host" -+ -+#define BT_IO_BASE 0xe4 -+#define BT_IRQ 10 -+ -+#define LPC_HICR0 0x00 -+#define LPC_HICR0_LPC3E BIT(7) -+#define LPC_HICR0_LPC2E BIT(6) -+#define LPC_HICR0_LPC1E BIT(5) -+#define LPC_HICR0_SDWNE BIT(3) /* 0:disable, 1:enable for HICR1_SDWNB */ -+#define LPC_HICR0_PMEE BIT(2) /* 0:disable, 1:enable for HICR1_PMEB */ -+ -+#define LPC_HICR2 0x08 -+#define LPC_HICR2_IBFIF3 BIT(3) /* 0:normal, 1:enable irq 3*/ -+ -+#define LPC_HICR4 0x10 -+#define LPC_HICR4_LADR12AS BIT(7) -+#define LPC_HICR4_KCSENBL BIT(2) -+#define LPC_BTENABLE BIT(0) /* share bt channel enable, 0:disable, 1:enable */ -+#define LPC_LADR3H_BT 0x014 -+#define LPC_LADR3L_BT 0x018 -+ -+#define BT_CR1 0x4C -+#define BT_CR1_IRQ_H2B 0x04 -+#define BT_CR1_IRQ_HWRST 0x40 -+ -+#define BT_CSR1 0x54 -+#define BT_CSR1_IRQ_H2B 0x04 -+#define BT_CSR1_IRQ_HWRST 0x40 -+ -+#define BT_CTRL 0x58 -+#define BT_CTRL_B_BUSY 0x80 -+#define BT_CTRL_H_BUSY 0x40 -+#define BT_CTRL_OEM0 0x20 -+#define BT_CTRL_SMS_ATN 0x10 -+#define BT_CTRL_B2H_ATN 0x08 -+#define BT_CTRL_H2B_ATN 0x04 -+#define BT_CTRL_CLR_RD_PTR 0x02 -+#define BT_CTRL_CLR_WR_PTR 0x01 -+#define BT_BMC2HOST 0x5C -+#define BT_HOST2BMC 0x98 -+#define BT_INTMASK 0x60 -+#define BT_INTMASK_B2H_IRQEN 0x01 -+#define BT_INTMASK_B2H_IRQ 0x02 -+#define BT_INTMASK_BMC_HWRST 0x80 -+ -+#define BT_BMC_BUFFER_SIZE 256 -+ -+struct bt_bmc { -+ struct device dev; -+ struct miscdevice miscdev; -+ struct regmap *map; -+ int irq; -+ wait_queue_head_t queue; -+ struct timer_list poll_timer; -+ struct mutex mutex; -+}; -+ -+static atomic_t open_count = ATOMIC_INIT(0); -+ -+static const struct regmap_config bt_regmap_cfg = { -+ .reg_bits = 32, -+ .val_bits = 32, -+ .reg_stride = 4, -+}; -+ -+static u8 bt_inb(struct bt_bmc *bt_bmc, int reg) -+{ -+ uint32_t val = 0; -+ int rc; -+ -+ rc = regmap_read(bt_bmc->map, reg, &val); -+ WARN(rc != 0, "regmap_read() failed: %d\n", rc); -+ -+ return rc == 0 ? (u8) val : 0; -+} -+ -+static void bt_outb(struct bt_bmc *bt_bmc, u8 data, int reg) -+{ -+ int rc; -+ -+ rc = regmap_write(bt_bmc->map, reg, data); -+ WARN(rc != 0, "regmap_write() failed: %d\n", rc); -+} -+ -+static void clr_rd_ptr(struct bt_bmc *bt_bmc) -+{ -+ bt_outb(bt_bmc, BT_CTRL_CLR_RD_PTR, BT_CTRL); -+} -+ -+static void clr_wr_ptr(struct bt_bmc *bt_bmc) -+{ -+ bt_outb(bt_bmc, BT_CTRL_CLR_WR_PTR, BT_CTRL); -+} -+ -+static void clr_h2b_atn(struct bt_bmc *bt_bmc) -+{ -+ bt_outb(bt_bmc, 0, BT_CTRL); -+} -+ -+static void set_b_busy(struct bt_bmc *bt_bmc) -+{ -+ if (!(bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_B_BUSY)) -+ bt_outb(bt_bmc, BT_CTRL_B_BUSY, BT_CTRL); -+} -+ -+static void clr_b_busy(struct bt_bmc *bt_bmc) -+{ -+ if (bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_B_BUSY) -+ bt_outb(bt_bmc, 0, BT_CTRL); -+} -+ -+static void set_b2h_atn(struct bt_bmc *bt_bmc) -+{ -+ bt_outb(bt_bmc, BT_CTRL_B2H_ATN, BT_CTRL); -+} -+ -+static u8 bt_read(struct bt_bmc *bt_bmc) -+{ -+ return bt_inb(bt_bmc, BT_HOST2BMC); -+} -+ -+static ssize_t bt_readn(struct bt_bmc *bt_bmc, u8 *buf, size_t n) -+{ -+ int i; -+ -+ for (i = 0; i < n; i++) -+ buf[i] = bt_read(bt_bmc); -+ return n; -+} -+ -+static void bt_write(struct bt_bmc *bt_bmc, u8 c) -+{ -+ bt_outb(bt_bmc, c, BT_BMC2HOST); -+} -+ -+static ssize_t bt_writen(struct bt_bmc *bt_bmc, u8 *buf, size_t n) -+{ -+ int i; -+ -+ for (i = 0; i < n; i++) -+ bt_write(bt_bmc, buf[i]); -+ return n; -+} -+ -+static void set_sms_atn(struct bt_bmc *bt_bmc) -+{ -+ bt_outb(bt_bmc, BT_CTRL_SMS_ATN, BT_CTRL); -+} -+ -+static struct bt_bmc *file_bt_bmc(struct file *file) -+{ -+ return container_of(file->private_data, struct bt_bmc, miscdev); -+} -+ -+static int bt_bmc_open(struct inode *inode, struct file *file) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ -+ if (atomic_inc_return(&open_count) == 1) { -+ clr_b_busy(bt_bmc); -+ return 0; -+ } -+ -+ atomic_dec(&open_count); -+ -+ return -EBUSY; -+} -+ -+/* -+ * The BT (Block Transfer) interface means that entire messages are -+ * buffered by the host before a notification is sent to the BMC that -+ * there is data to be read. The first byte is the length and the -+ * message data follows. The read operation just tries to capture the -+ * whole before returning it to userspace. -+ * -+ * BT Message format : -+ * -+ * Byte 1 Byte 2 Byte 3 Byte 4 Byte 5:N -+ * Length NetFn/LUN Seq Cmd Data -+ * -+ */ -+static ssize_t bt_bmc_read(struct file *file, char __user *buf, -+ size_t count, loff_t *ppos) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ u8 len; -+ int len_byte = 1; -+ u8 kbuffer[BT_BMC_BUFFER_SIZE]; -+ ssize_t ret = 0; -+ ssize_t nread; -+ -+ WARN_ON(*ppos); -+ -+ if (wait_event_interruptible(bt_bmc->queue, -+ bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_H2B_ATN)) -+ return -ERESTARTSYS; -+ -+ mutex_lock(&bt_bmc->mutex); -+ -+ if (unlikely(!(bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_H2B_ATN))) { -+ ret = -EIO; -+ goto out_unlock; -+ } -+ -+ set_b_busy(bt_bmc); -+ clr_h2b_atn(bt_bmc); -+ clr_rd_ptr(bt_bmc); -+ -+ /* -+ * The BT frames start with the message length, which does not -+ * include the length byte. -+ */ -+ kbuffer[0] = bt_read(bt_bmc); -+ len = kbuffer[0]; -+ -+ /* We pass the length back to userspace as well */ -+ if (len + 1 > count) -+ len = count - 1; -+ -+ while (len) { -+ nread = min_t(ssize_t, len, sizeof(kbuffer) - len_byte); -+ -+ bt_readn(bt_bmc, kbuffer + len_byte, nread); -+ -+ if (copy_to_user(buf, kbuffer, nread + len_byte)) { -+ ret = -EFAULT; -+ break; -+ } -+ len -= nread; -+ buf += nread + len_byte; -+ ret += nread + len_byte; -+ len_byte = 0; -+ } -+ -+ clr_b_busy(bt_bmc); -+ -+out_unlock: -+ mutex_unlock(&bt_bmc->mutex); -+ return ret; -+} -+ -+/* -+ * BT Message response format : -+ * -+ * Byte 1 Byte 2 Byte 3 Byte 4 Byte 5 Byte 6:N -+ * Length NetFn/LUN Seq Cmd Code Data -+ */ -+static ssize_t bt_bmc_write(struct file *file, const char __user *buf, -+ size_t count, loff_t *ppos) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ u8 kbuffer[BT_BMC_BUFFER_SIZE]; -+ ssize_t ret = 0; -+ ssize_t nwritten; -+ -+ /* -+ * send a minimum response size -+ */ -+ if (count < 5) -+ return -EINVAL; -+ -+ WARN_ON(*ppos); -+ -+ /* -+ * There's no interrupt for clearing bmc busy so we have to -+ * poll -+ */ -+ if (wait_event_interruptible(bt_bmc->queue, -+ !(bt_inb(bt_bmc, BT_CTRL) & -+ (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN)))) -+ return -ERESTARTSYS; -+ -+ mutex_lock(&bt_bmc->mutex); -+ -+ if (unlikely(bt_inb(bt_bmc, BT_CTRL) & -+ (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN))) { -+ ret = -EIO; -+ goto out_unlock; -+ } -+ -+ clr_wr_ptr(bt_bmc); -+ -+ while (count) { -+ nwritten = min_t(ssize_t, count, sizeof(kbuffer)); -+ if (copy_from_user(&kbuffer, buf, nwritten)) { -+ ret = -EFAULT; -+ break; -+ } -+ -+ bt_writen(bt_bmc, kbuffer, nwritten); -+ -+ count -= nwritten; -+ buf += nwritten; -+ ret += nwritten; -+ } -+ -+ set_b2h_atn(bt_bmc); -+ -+out_unlock: -+ mutex_unlock(&bt_bmc->mutex); -+ return ret; -+} -+ -+static long bt_bmc_ioctl(struct file *file, unsigned int cmd, -+ unsigned long param) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ -+ switch (cmd) { -+ case BT_BMC_IOCTL_SMS_ATN: -+ set_sms_atn(bt_bmc); -+ return 0; -+ } -+ return -EINVAL; -+} -+ -+static int bt_bmc_release(struct inode *inode, struct file *file) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ -+ atomic_dec(&open_count); -+ set_b_busy(bt_bmc); -+ return 0; -+} -+ -+static __poll_t bt_bmc_poll(struct file *file, poll_table *wait) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ __poll_t mask = 0; -+ u8 ctrl; -+ -+ poll_wait(file, &bt_bmc->queue, wait); -+ -+ ctrl = bt_inb(bt_bmc, BT_CTRL); -+ -+ if (ctrl & BT_CTRL_H2B_ATN) -+ mask |= EPOLLIN; -+ -+ if (!(ctrl & (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN))) -+ mask |= EPOLLOUT; -+ -+ return mask; -+} -+ -+static const struct file_operations bt_bmc_fops = { -+ .owner = THIS_MODULE, -+ .open = bt_bmc_open, -+ .read = bt_bmc_read, -+ .write = bt_bmc_write, -+ .release = bt_bmc_release, -+ .poll = bt_bmc_poll, -+ .unlocked_ioctl = bt_bmc_ioctl, -+}; -+ -+static void poll_timer(struct timer_list *t) -+{ -+ struct bt_bmc *bt_bmc = from_timer(bt_bmc, t, poll_timer); -+ -+ bt_bmc->poll_timer.expires += msecs_to_jiffies(500); -+ wake_up(&bt_bmc->queue); -+ add_timer(&bt_bmc->poll_timer); -+} -+ -+static irqreturn_t bt_bmc_irq(int irq, void *arg) -+{ -+ struct bt_bmc *bt_bmc = arg; -+ u32 reg, intmsk; -+ int rc; -+ -+ rc = regmap_read(bt_bmc->map, BT_CR1, ®); -+ if (rc) -+ return IRQ_NONE; -+ -+ reg &= BT_CR1_IRQ_H2B | BT_CR1_IRQ_HWRST; -+ if (!reg) -+ return IRQ_NONE; -+ -+ /* ack pending IRQs */ -+ regmap_write(bt_bmc->map, BT_CR1, 0); -+ -+ if (reg & BT_CR1_IRQ_HWRST) { -+ regmap_read(bt_bmc->map, BT_INTMASK, &intmsk); -+ if (intmsk & BT_INTMASK_BMC_HWRST) -+ regmap_write(bt_bmc->map, BT_INTMASK, 0); -+ } -+ -+ wake_up(&bt_bmc->queue); -+ return IRQ_HANDLED; -+} -+ -+static int bt_bmc_config_irq(struct bt_bmc *bt_bmc, -+ struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ int rc; -+ -+ bt_bmc->irq = platform_get_irq(pdev, 0); -+ if (!bt_bmc->irq) -+ return -ENODEV; -+ -+ rc = devm_request_irq(dev, bt_bmc->irq, bt_bmc_irq, IRQF_SHARED, -+ DEVICE_NAME, bt_bmc); -+ if (rc < 0) { -+ dev_warn(dev, "Unable to request IRQ %d\n", bt_bmc->irq); -+ bt_bmc->irq = 0; -+ return rc; -+ } -+ -+ /* -+ * Configure IRQs on the bmc clearing the H2B and HBUSY bits; -+ * H2B will be asserted when the bmc has data for us; HBUSY -+ * will be cleared (along with B2H) when we can write the next -+ * message to the BT buffer -+ */ -+ rc = regmap_update_bits(bt_bmc->map, BT_CSR1, -+ BT_CSR1_IRQ_H2B | BT_CSR1_IRQ_HWRST, -+ BT_CSR1_IRQ_H2B | BT_CSR1_IRQ_HWRST); -+ -+ return rc; -+} -+ -+static int bt_bmc_probe(struct platform_device *pdev) -+{ -+ struct bt_bmc *bt_bmc; -+ struct device *dev; -+ int rc; -+ -+ if (!pdev || !pdev->dev.of_node) -+ return -ENODEV; -+ -+ dev = &pdev->dev; -+ dev_info(dev, "Found bt bmc device\n"); -+ -+ bt_bmc = devm_kzalloc(dev, sizeof(*bt_bmc), GFP_KERNEL); -+ if (!bt_bmc) -+ return -ENOMEM; -+ -+ dev_set_drvdata(&pdev->dev, bt_bmc); -+ -+ bt_bmc->map = syscon_node_to_regmap(pdev->dev.parent->of_node); -+ -+ mutex_init(&bt_bmc->mutex); -+ init_waitqueue_head(&bt_bmc->queue); -+ -+ bt_bmc->miscdev.minor = MISC_DYNAMIC_MINOR, -+ bt_bmc->miscdev.name = DEVICE_NAME, -+ bt_bmc->miscdev.fops = &bt_bmc_fops, -+ bt_bmc->miscdev.parent = dev; -+ rc = misc_register(&bt_bmc->miscdev); -+ if (rc) { -+ dev_err(dev, "Unable to register misc device\n"); -+ return rc; -+ } -+ -+ bt_bmc_config_irq(bt_bmc, pdev); -+ -+ if (bt_bmc->irq) { -+ dev_info(dev, "Using IRQ %d\n", bt_bmc->irq); -+ } else { -+ dev_info(dev, "No IRQ; using timer\n"); -+ timer_setup(&bt_bmc->poll_timer, poll_timer, 0); -+ bt_bmc->poll_timer.expires = jiffies + msecs_to_jiffies(10); -+ add_timer(&bt_bmc->poll_timer); -+ } -+ -+ regmap_update_bits(bt_bmc->map, LPC_HICR0, LPC_HICR0_LPC3E, LPC_HICR0_LPC3E); -+ regmap_update_bits(bt_bmc->map, LPC_HICR4, LPC_BTENABLE, LPC_BTENABLE); -+ regmap_write(bt_bmc->map, LPC_LADR3H_BT, BT_IO_BASE >> 8); -+ regmap_write(bt_bmc->map, LPC_LADR3L_BT, BT_IO_BASE); -+ regmap_update_bits(bt_bmc->map, LPC_HICR2, LPC_HICR2_IBFIF3, LPC_HICR2_IBFIF3); -+ clr_b_busy(bt_bmc); -+ -+ return 0; -+} -+ -+static int bt_bmc_remove(struct platform_device *pdev) -+{ -+ struct bt_bmc *bt_bmc = dev_get_drvdata(&pdev->dev); -+ -+ misc_deregister(&bt_bmc->miscdev); -+ if (!bt_bmc->irq) -+ del_timer_sync(&bt_bmc->poll_timer); -+ -+ return 0; -+} -+ -+static const struct of_device_id bt_bmc_match[] = { -+ { .compatible = "phytium,bt-bmc" }, -+ { }, -+}; -+MODULE_DEVICE_TABLE(of, bt_bmc_match); -+ -+static struct platform_driver bt_bmc_driver = { -+ .driver = { -+ .name = DEVICE_NAME, -+ .of_match_table = bt_bmc_match, -+ }, -+ .probe = bt_bmc_probe, -+ .remove = bt_bmc_remove, -+}; -+ -+module_platform_driver(bt_bmc_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Cheng Quan -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "kcs_bmc.h" -+ -+#define DEVICE_NAME "phytium-kcs-bmc" -+ -+#define KCS_CHANNEL_MAX 4 -+ -+/* mapped to lpc-bmc@0 IO space */ -+#define LPC_HICR0 0x000 -+#define LPC_HICR0_LPC3E BIT(7) -+#define LPC_HICR0_LPC2E BIT(6) -+#define LPC_HICR0_LPC1E BIT(5) -+#define LPC_HICR0_SDWNE BIT(3) /* 0:disable, 1:enable for HICR1_SDWNB */ -+#define LPC_HICR0_PMEE BIT(2) /* 0:disable, 1:enable for HICR1_PMEB */ -+#define LPC_HICR1 0x004 -+#define LPC_HICR1_LPCBSY BIT(7) /* 0:idle, 1:trans busy */ -+#define LPC_HICR1_IRQBSY BIT(5) /* 0:idle, 1:trans data */ -+#define LPC_HICR1_LPCSWRST BIT(4) /* 0:normal, 1:reset */ -+#define LPC_HICR1_SDWNB BIT(3) /* 0:normal, 1:software shutdown */ -+#define LPC_HICR1_PMEB BIT(2) /* 0:LPCPD low, 1:LPCPD high */ -+#define LPC_HICR2 0x008 -+#define LPC_LPCSWRST_ERRIRQ BIT(6) /* 0:normal, 1:reset irq */ -+#define LPC_SDWN_ERRIRQ BIT(5) /* 0:normal, 1:lpcpd irq */ -+#define LPC_ABRT_ERRIRQ BIT(4) /* 0:normal, 1:lframe low when busy*/ -+#define LPC_HICR2_IBFIF3 BIT(3) /* 0:normal, 1:enable irq 3*/ -+#define LPC_HICR2_IBFIF2 BIT(2) -+#define LPC_HICR2_IBFIF1 BIT(1) -+/* 0:normal,1:enable err irq-reset,power down,abort */ -+#define LPC_HICR2_ERRIE BIT(0) -+#define LPC_HICR3 0x00C -+#define LPC_LFRAME_STATUS BIT(7) /* R */ -+#define LPC_SERIRQ_STATUS BIT(5) /* R */ -+#define LPC_LREST_STATUS BIT(4) /* R */ -+#define LPC_LPCPD_STATUS BIT(3) /* R */ -+#define LPC_PME_STATUS BIT(2) /* R */ -+#define LPC_HICR4 0x010 -+#define LPC_HICR4_LADR12AS BIT(7) -+#define LPC_HICR4_KCSENBL BIT(2) -+#define LPC_BTENABLE BIT(0) /* share bt channel enable, 0:disable, 1:enable */ -+#define LPC_LADR3H 0x014 -+#define LPC_LADR3L 0x018 -+#define LPC_LADR12H 0x01C -+#define LPC_LADR12L 0x020 -+#define LPC_IDR1 0x024 -+#define LPC_IDR2 0x028 -+#define LPC_IDR3 0x02C -+#define LPC_ODR1 0x030 -+#define LPC_ODR2 0x034 -+#define LPC_ODR3 0x038 -+#define LPC_STR1 0x03C -+#define LPC_STR2 0x040 -+#define LPC_STR3 0x044 -+ -+#define LPC_HICRB 0x80 -+#define LPC_HICRB_IBFIF4 BIT(1) -+#define LPC_HICRB_LPC4E BIT(0) -+#define LPC_LADR4 0x88 -+#define LPC_IDR4 0x8c -+#define LPC_ODR4 0x90 -+#define LPC_STR4 0x94 -+ -+struct phytium_kcs_bmc { -+ struct regmap *map; -+}; -+ -+static u8 phytium_kcs_inb(struct kcs_bmc *kcs_bmc, u32 reg) -+{ -+ struct phytium_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc); -+ u32 val = 0; -+ int rc; -+ -+ rc = regmap_read(priv->map, reg, &val); -+ WARN(rc != 0, "regmap_read() failed: %d\n", rc); -+ -+ return rc == 0 ? (u8) val : 0; -+} -+ -+static void phytium_kcs_outb(struct kcs_bmc *kcs_bmc, u32 reg, u8 data) -+{ -+ struct phytium_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc); -+ int rc; -+ -+ rc = regmap_write(priv->map, reg, data); -+ WARN(rc != 0, "regmap_write() failed: %d\n", rc); -+} -+ -+/* -+ * Background: -+ * we note D for Data, and C for Cmd/Status, default rules are -+ * A. KCS1 / KCS2 ( D / C:X / X+4 ) -+ * D / C : CA0h / CA4h -+ * D / C : CA8h / CACh -+ * B. KCS3 ( D / C:XX2h / XX3h ) -+ * D / C : CA2h / CA3h -+ * D / C : CB2h / CB3h -use -+ * C. KCS4 -+ * D / C : CA4h / CA5h -+ * D / C : CB0h / CB1h -use -+ */ -+static void phytium_kcs_set_address(struct kcs_bmc *kcs_bmc, u16 addr) -+{ -+ struct phytium_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc); -+ -+ switch (kcs_bmc->channel) { -+ case 1: -+ regmap_update_bits(priv->map, LPC_HICR4, LPC_HICR4_LADR12AS, 0); -+ regmap_write(priv->map, LPC_LADR12H, addr >> 8); -+ regmap_write(priv->map, LPC_LADR12L, addr & 0xFF); -+ break; -+ case 2: -+ regmap_update_bits(priv->map, LPC_HICR4, -+ LPC_HICR4_LADR12AS, LPC_HICR4_LADR12AS); -+ regmap_write(priv->map, LPC_LADR12H, addr >> 8); -+ regmap_write(priv->map, LPC_LADR12L, addr & 0xFF); -+ break; -+ case 3: -+ regmap_write(priv->map, LPC_LADR3H, addr >> 8); -+ regmap_write(priv->map, LPC_LADR3L, addr & 0xFF); -+ break; -+ case 4: -+ regmap_write(priv->map, LPC_LADR4, ((addr + 1) << 16) | -+ addr); -+ break; -+ default: -+ break; -+ } -+} -+ -+static void phytium_kcs_enable_channel(struct kcs_bmc *kcs_bmc, bool enable) -+{ -+ struct phytium_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc); -+ -+ switch (kcs_bmc->channel) { -+ case 1: -+ if (enable) { -+ regmap_update_bits(priv->map, LPC_HICR2, -+ LPC_HICR2_IBFIF1, LPC_HICR2_IBFIF1); -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC1E, LPC_HICR0_LPC1E); -+ } else { -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC1E, 0); -+ regmap_update_bits(priv->map, LPC_HICR2, -+ LPC_HICR2_IBFIF1, 0); -+ } -+ break; -+ case 2: -+ if (enable) { -+ regmap_update_bits(priv->map, LPC_HICR2, -+ LPC_HICR2_IBFIF2, LPC_HICR2_IBFIF2); -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC2E, LPC_HICR0_LPC2E); -+ } else { -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC2E, 0); -+ regmap_update_bits(priv->map, LPC_HICR2, -+ LPC_HICR2_IBFIF2, 0); -+ } -+ break; -+ case 3: -+ if (enable) { -+ regmap_update_bits(priv->map, LPC_HICR2, -+ LPC_HICR2_IBFIF3, LPC_HICR2_IBFIF3); -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC3E, LPC_HICR0_LPC3E); -+ regmap_update_bits(priv->map, LPC_HICR4, -+ LPC_HICR4_KCSENBL, LPC_HICR4_KCSENBL); -+ } else { -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC3E, 0); -+ regmap_update_bits(priv->map, LPC_HICR4, -+ LPC_HICR4_KCSENBL, 0); -+ regmap_update_bits(priv->map, LPC_HICR2, -+ LPC_HICR2_IBFIF3, 0); -+ } -+ break; -+ case 4: -+ if (enable) -+ regmap_update_bits(priv->map, LPC_HICRB, -+ LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E, -+ LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E); -+ else -+ regmap_update_bits(priv->map, LPC_HICRB, -+ LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E, -+ 0); -+ break; -+ default: -+ break; -+ } -+} -+ -+static irqreturn_t phytium_kcs_irq(int irq, void *arg) -+{ -+ struct kcs_bmc *kcs_bmc = arg; -+ -+ if (!kcs_bmc_handle_event(kcs_bmc)) -+ return IRQ_HANDLED; -+ -+ return IRQ_NONE; -+} -+ -+static int phytium_kcs_config_irq(struct kcs_bmc *kcs_bmc, struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ int irq; -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) -+ return irq; -+ -+ return devm_request_irq(dev, irq, phytium_kcs_irq, IRQF_SHARED, -+ dev_name(dev), kcs_bmc); -+} -+ -+static const struct kcs_ioreg phytium_kcs_bmc_ioregs[KCS_CHANNEL_MAX] = { -+ { .idr = LPC_IDR1, .odr = LPC_ODR1, .str = LPC_STR1 }, -+ { .idr = LPC_IDR2, .odr = LPC_ODR2, .str = LPC_STR2 }, -+ { .idr = LPC_IDR3, .odr = LPC_ODR3, .str = LPC_STR3 }, -+ { .idr = LPC_IDR4, .odr = LPC_ODR4, .str = LPC_STR4 }, -+}; -+ -+static int phytium_kcs_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct phytium_kcs_bmc *priv; -+ struct kcs_bmc *kcs_bmc; -+ u32 chan, addr; -+ int rc; -+ -+ rc = of_property_read_u32(dev->of_node, "kcs_chan", &chan); -+ if ((rc != 0) || (chan == 0 || chan > KCS_CHANNEL_MAX)) { -+ dev_err(dev, "no valid 'kcs_chan' configured\n"); -+ return -ENODEV; -+ } -+ -+ rc = of_property_read_u32(dev->of_node, "kcs_addr", &addr); -+ if (rc) { -+ dev_err(dev, "no valid 'kcs_addr' configured\n"); -+ return -ENODEV; -+ } -+ -+ kcs_bmc = kcs_bmc_alloc(dev, sizeof(*priv), chan); -+ if (!kcs_bmc) -+ return -ENOMEM; -+ -+ priv = kcs_bmc_priv(kcs_bmc); -+ priv->map = syscon_node_to_regmap(dev->parent->of_node); -+ if (IS_ERR(priv->map)) { -+ dev_err(dev, "Couldn't get regmap\n"); -+ return -ENODEV; -+ } -+ -+ kcs_bmc->ioreg = phytium_kcs_bmc_ioregs[chan - 1]; -+ kcs_bmc->io_inputb = phytium_kcs_inb; -+ kcs_bmc->io_outputb = phytium_kcs_outb; -+ -+ dev_set_drvdata(dev, kcs_bmc); -+ -+ phytium_kcs_set_address(kcs_bmc, addr); -+ phytium_kcs_enable_channel(kcs_bmc, true); -+ rc = phytium_kcs_config_irq(kcs_bmc, pdev); -+ if (rc) -+ return rc; -+ -+ rc = misc_register(&kcs_bmc->miscdev); -+ if (rc) { -+ dev_err(dev, "Unable to register device\n"); -+ return rc; -+ } -+ -+ pr_info("channel=%u addr=0x%x idr=0x%x odr=0x%x str=0x%x\n", -+ chan, addr, kcs_bmc->ioreg.idr, kcs_bmc->ioreg.odr, kcs_bmc->ioreg.str); -+ -+ return 0; -+} -+ -+static int phytium_kcs_remove(struct platform_device *pdev) -+{ -+ struct kcs_bmc *kcs_bmc = dev_get_drvdata(&pdev->dev); -+ -+ misc_deregister(&kcs_bmc->miscdev); -+ -+ return 0; -+} -+ -+static const struct of_device_id phytium_kcs_bmc_match[] = { -+ { .compatible = "phytium,kcs-bmc" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_kcs_bmc_match); -+ -+static struct platform_driver phytium_kcs_bmc_driver = { -+ .driver = { -+ .name = DEVICE_NAME, -+ .of_match_table = phytium_kcs_bmc_match, -+ }, -+ .probe = phytium_kcs_probe, -+ .remove = phytium_kcs_remove, -+}; -+module_platform_driver(phytium_kcs_bmc_driver); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_DESCRIPTION("Phytium device interface to the KCS BMC device"); -diff --git a/drivers/clocksource/arm_arch_timer.c b/drivers/clocksource/arm_arch_timer.c -index f4881764b..5ebafb91c 100644 ---- a/drivers/clocksource/arm_arch_timer.c -+++ b/drivers/clocksource/arm_arch_timer.c -@@ -41,23 +41,29 @@ - #define CNTACR_RWVT BIT(4) - #define CNTACR_RWPT BIT(5) - --#define CNTVCT_LO 0x08 --#define CNTVCT_HI 0x0c -+#define CNTVCT_LO 0x00 -+#define CNTPCT_LO 0x08 - #define CNTFRQ 0x10 --#define CNTP_TVAL 0x28 -+#define CNTP_CVAL_LO 0x20 - #define CNTP_CTL 0x2c --#define CNTV_TVAL 0x38 -+#define CNTV_CVAL_LO 0x30 - #define CNTV_CTL 0x3c - --static unsigned arch_timers_present __initdata; -+/* -+ * The minimum amount of time a generic counter is guaranteed to not roll over -+ * (40 years) -+ */ -+#define MIN_ROLLOVER_SECS (40ULL * 365 * 24 * 3600) - --static void __iomem *arch_counter_base; -+static unsigned arch_timers_present __initdata; - - struct arch_timer { - void __iomem *base; - struct clock_event_device evt; - }; - -+static struct arch_timer *arch_timer_mem __ro_after_init; -+ - #define to_arch_timer(e) container_of(e, struct arch_timer, evt) - - static u32 arch_timer_rate; -@@ -84,33 +90,58 @@ static int __init early_evtstrm_cfg(char *buf) - } - early_param("clocksource.arm_arch_timer.evtstrm", early_evtstrm_cfg); - -+/* -+ * Makes an educated guess at a valid counter width based on the Generic Timer -+ * specification. Of note: -+ * 1) the system counter is at least 56 bits wide -+ * 2) a roll-over time of not less than 40 years -+ * -+ * See 'ARM DDI 0487G.a D11.1.2 ("The system counter")' for more details. -+ */ -+static int arch_counter_get_width(void) -+{ -+ u64 min_cycles = MIN_ROLLOVER_SECS * arch_timer_rate; -+ -+ /* guarantee the returned width is within the valid range */ -+ return clamp_val(ilog2(min_cycles - 1) + 1, 56, 64); -+} -+ - /* - * Architected system timer support. - */ - - static __always_inline --void arch_timer_reg_write(int access, enum arch_timer_reg reg, u32 val, -+void arch_timer_reg_write(int access, enum arch_timer_reg reg, u64 val, - struct clock_event_device *clk) - { - if (access == ARCH_TIMER_MEM_PHYS_ACCESS) { - struct arch_timer *timer = to_arch_timer(clk); - switch (reg) { - case ARCH_TIMER_REG_CTRL: -- writel_relaxed(val, timer->base + CNTP_CTL); -+ writel_relaxed((u32)val, timer->base + CNTP_CTL); - break; -- case ARCH_TIMER_REG_TVAL: -- writel_relaxed(val, timer->base + CNTP_TVAL); -+ case ARCH_TIMER_REG_CVAL: -+ /* -+ * Not guaranteed to be atomic, so the timer -+ * must be disabled at this point. -+ */ -+ writeq_relaxed(val, timer->base + CNTP_CVAL_LO); - break; -+ default: -+ BUILD_BUG(); - } - } else if (access == ARCH_TIMER_MEM_VIRT_ACCESS) { - struct arch_timer *timer = to_arch_timer(clk); - switch (reg) { - case ARCH_TIMER_REG_CTRL: -- writel_relaxed(val, timer->base + CNTV_CTL); -+ writel_relaxed((u32)val, timer->base + CNTV_CTL); - break; -- case ARCH_TIMER_REG_TVAL: -- writel_relaxed(val, timer->base + CNTV_TVAL); -+ case ARCH_TIMER_REG_CVAL: -+ /* Same restriction as above */ -+ writeq_relaxed(val, timer->base + CNTV_CVAL_LO); - break; -+ default: -+ BUILD_BUG(); - } - } else { - arch_timer_reg_write_cp15(access, reg, val); -@@ -129,9 +160,8 @@ u32 arch_timer_reg_read(int access, enum arch_timer_reg reg, - case ARCH_TIMER_REG_CTRL: - val = readl_relaxed(timer->base + CNTP_CTL); - break; -- case ARCH_TIMER_REG_TVAL: -- val = readl_relaxed(timer->base + CNTP_TVAL); -- break; -+ default: -+ BUILD_BUG(); - } - } else if (access == ARCH_TIMER_MEM_VIRT_ACCESS) { - struct arch_timer *timer = to_arch_timer(clk); -@@ -139,9 +169,8 @@ u32 arch_timer_reg_read(int access, enum arch_timer_reg reg, - case ARCH_TIMER_REG_CTRL: - val = readl_relaxed(timer->base + CNTV_CTL); - break; -- case ARCH_TIMER_REG_TVAL: -- val = readl_relaxed(timer->base + CNTV_TVAL); -- break; -+ default: -+ BUILD_BUG(); - } - } else { - val = arch_timer_reg_read_cp15(access, reg); -@@ -193,13 +222,11 @@ static struct clocksource clocksource_counter = { - .name = "arch_sys_counter", - .rating = 400, - .read = arch_counter_read, -- .mask = CLOCKSOURCE_MASK(56), - .flags = CLOCK_SOURCE_IS_CONTINUOUS, - }; - - static struct cyclecounter cyclecounter __ro_after_init = { - .read = arch_counter_read_cc, -- .mask = CLOCKSOURCE_MASK(56), - }; - - struct ate_acpi_oem_info { -@@ -227,16 +254,6 @@ struct ate_acpi_oem_info { - _new; \ - }) - --static u32 notrace fsl_a008585_read_cntp_tval_el0(void) --{ -- return __fsl_a008585_read_reg(cntp_tval_el0); --} -- --static u32 notrace fsl_a008585_read_cntv_tval_el0(void) --{ -- return __fsl_a008585_read_reg(cntv_tval_el0); --} -- - static u64 notrace fsl_a008585_read_cntpct_el0(void) - { - return __fsl_a008585_read_reg(cntpct_el0); -@@ -273,16 +290,6 @@ static u64 notrace fsl_a008585_read_cntvct_el0(void) - _new; \ - }) - --static u32 notrace hisi_161010101_read_cntp_tval_el0(void) --{ -- return __hisi_161010101_read_reg(cntp_tval_el0); --} -- --static u32 notrace hisi_161010101_read_cntv_tval_el0(void) --{ -- return __hisi_161010101_read_reg(cntv_tval_el0); --} -- - static u64 notrace hisi_161010101_read_cntpct_el0(void) - { - return __hisi_161010101_read_reg(cntpct_el0); -@@ -367,16 +374,6 @@ static u64 notrace sun50i_a64_read_cntvct_el0(void) - { - return __sun50i_a64_read_reg(cntvct_el0); - } -- --static u32 notrace sun50i_a64_read_cntp_tval_el0(void) --{ -- return read_sysreg(cntp_cval_el0) - sun50i_a64_read_cntpct_el0(); --} -- --static u32 notrace sun50i_a64_read_cntv_tval_el0(void) --{ -- return read_sysreg(cntv_cval_el0) - sun50i_a64_read_cntvct_el0(); --} - #endif - - #ifdef CONFIG_ARM_ARCH_TIMER_OOL_WORKAROUND -@@ -385,7 +382,7 @@ EXPORT_SYMBOL_GPL(timer_unstable_counter_workaround); - - static atomic_t timer_unstable_counter_workaround_in_use = ATOMIC_INIT(0); - --static void erratum_set_next_event_tval_generic(const int access, unsigned long evt, -+static void erratum_set_next_event_generic(const int access, unsigned long evt, - struct clock_event_device *clk) - { - unsigned long ctrl; -@@ -406,17 +403,17 @@ static void erratum_set_next_event_tval_generic(const int access, unsigned long - arch_timer_reg_write(access, ARCH_TIMER_REG_CTRL, ctrl, clk); - } - --static __maybe_unused int erratum_set_next_event_tval_virt(unsigned long evt, -+static __maybe_unused int erratum_set_next_event_virt(unsigned long evt, - struct clock_event_device *clk) - { -- erratum_set_next_event_tval_generic(ARCH_TIMER_VIRT_ACCESS, evt, clk); -+ erratum_set_next_event_generic(ARCH_TIMER_VIRT_ACCESS, evt, clk); - return 0; - } - --static __maybe_unused int erratum_set_next_event_tval_phys(unsigned long evt, -+static __maybe_unused int erratum_set_next_event_phys(unsigned long evt, - struct clock_event_device *clk) - { -- erratum_set_next_event_tval_generic(ARCH_TIMER_PHYS_ACCESS, evt, clk); -+ erratum_set_next_event_generic(ARCH_TIMER_PHYS_ACCESS, evt, clk); - return 0; - } - -@@ -426,12 +423,10 @@ static const struct arch_timer_erratum_workaround ool_workarounds[] = { - .match_type = ate_match_dt, - .id = "fsl,erratum-a008585", - .desc = "Freescale erratum a005858", -- .read_cntp_tval_el0 = fsl_a008585_read_cntp_tval_el0, -- .read_cntv_tval_el0 = fsl_a008585_read_cntv_tval_el0, - .read_cntpct_el0 = fsl_a008585_read_cntpct_el0, - .read_cntvct_el0 = fsl_a008585_read_cntvct_el0, -- .set_next_event_phys = erratum_set_next_event_tval_phys, -- .set_next_event_virt = erratum_set_next_event_tval_virt, -+ .set_next_event_phys = erratum_set_next_event_phys, -+ .set_next_event_virt = erratum_set_next_event_virt, - }, - #endif - #ifdef CONFIG_HISILICON_ERRATUM_161010101 -@@ -439,23 +434,19 @@ static const struct arch_timer_erratum_workaround ool_workarounds[] = { - .match_type = ate_match_dt, - .id = "hisilicon,erratum-161010101", - .desc = "HiSilicon erratum 161010101", -- .read_cntp_tval_el0 = hisi_161010101_read_cntp_tval_el0, -- .read_cntv_tval_el0 = hisi_161010101_read_cntv_tval_el0, - .read_cntpct_el0 = hisi_161010101_read_cntpct_el0, - .read_cntvct_el0 = hisi_161010101_read_cntvct_el0, -- .set_next_event_phys = erratum_set_next_event_tval_phys, -- .set_next_event_virt = erratum_set_next_event_tval_virt, -+ .set_next_event_phys = erratum_set_next_event_phys, -+ .set_next_event_virt = erratum_set_next_event_virt, - }, - { - .match_type = ate_match_acpi_oem_info, - .id = hisi_161010101_oem_info, - .desc = "HiSilicon erratum 161010101", -- .read_cntp_tval_el0 = hisi_161010101_read_cntp_tval_el0, -- .read_cntv_tval_el0 = hisi_161010101_read_cntv_tval_el0, - .read_cntpct_el0 = hisi_161010101_read_cntpct_el0, - .read_cntvct_el0 = hisi_161010101_read_cntvct_el0, -- .set_next_event_phys = erratum_set_next_event_tval_phys, -- .set_next_event_virt = erratum_set_next_event_tval_virt, -+ .set_next_event_phys = erratum_set_next_event_phys, -+ .set_next_event_virt = erratum_set_next_event_virt, - }, - #endif - #ifdef CONFIG_ARM64_ERRATUM_858921 -@@ -472,12 +463,10 @@ static const struct arch_timer_erratum_workaround ool_workarounds[] = { - .match_type = ate_match_dt, - .id = "allwinner,erratum-unknown1", - .desc = "Allwinner erratum UNKNOWN1", -- .read_cntp_tval_el0 = sun50i_a64_read_cntp_tval_el0, -- .read_cntv_tval_el0 = sun50i_a64_read_cntv_tval_el0, - .read_cntpct_el0 = sun50i_a64_read_cntpct_el0, - .read_cntvct_el0 = sun50i_a64_read_cntvct_el0, -- .set_next_event_phys = erratum_set_next_event_tval_phys, -- .set_next_event_virt = erratum_set_next_event_tval_virt, -+ .set_next_event_phys = erratum_set_next_event_phys, -+ .set_next_event_virt = erratum_set_next_event_virt, - }, - #endif - #ifdef CONFIG_ARM64_ERRATUM_1418040 -@@ -715,10 +704,18 @@ static __always_inline void set_next_event(const int access, unsigned long evt, - struct clock_event_device *clk) - { - unsigned long ctrl; -+ u64 cnt; -+ - ctrl = arch_timer_reg_read(access, ARCH_TIMER_REG_CTRL, clk); - ctrl |= ARCH_TIMER_CTRL_ENABLE; - ctrl &= ~ARCH_TIMER_CTRL_IT_MASK; -- arch_timer_reg_write(access, ARCH_TIMER_REG_TVAL, evt, clk); -+ -+ if (access == ARCH_TIMER_PHYS_ACCESS) -+ cnt = __arch_counter_get_cntpct(); -+ else -+ cnt = __arch_counter_get_cntvct(); -+ -+ arch_timer_reg_write(access, ARCH_TIMER_REG_CVAL, evt + cnt, clk); - arch_timer_reg_write(access, ARCH_TIMER_REG_CTRL, ctrl, clk); - } - -@@ -736,23 +733,79 @@ static int arch_timer_set_next_event_phys(unsigned long evt, - return 0; - } - -+static u64 arch_counter_get_cnt_mem(struct arch_timer *t, int offset_lo) -+{ -+ u32 cnt_lo, cnt_hi, tmp_hi; -+ -+ do { -+ cnt_hi = readl_relaxed(t->base + offset_lo + 4); -+ cnt_lo = readl_relaxed(t->base + offset_lo); -+ tmp_hi = readl_relaxed(t->base + offset_lo + 4); -+ } while (cnt_hi != tmp_hi); -+ -+ return ((u64) cnt_hi << 32) | cnt_lo; -+} -+ -+static __always_inline void set_next_event_mem(const int access, unsigned long evt, -+ struct clock_event_device *clk) -+{ -+ struct arch_timer *timer = to_arch_timer(clk); -+ unsigned long ctrl; -+ u64 cnt; -+ -+ ctrl = arch_timer_reg_read(access, ARCH_TIMER_REG_CTRL, clk); -+ ctrl |= ARCH_TIMER_CTRL_ENABLE; -+ ctrl &= ~ARCH_TIMER_CTRL_IT_MASK; -+ -+ if (access == ARCH_TIMER_MEM_VIRT_ACCESS) -+ cnt = arch_counter_get_cnt_mem(timer, CNTVCT_LO); -+ else -+ cnt = arch_counter_get_cnt_mem(timer, CNTPCT_LO); -+ -+ arch_timer_reg_write(access, ARCH_TIMER_REG_CVAL, evt + cnt, clk); -+ arch_timer_reg_write(access, ARCH_TIMER_REG_CTRL, ctrl, clk); -+} -+ - static int arch_timer_set_next_event_virt_mem(unsigned long evt, - struct clock_event_device *clk) - { -- set_next_event(ARCH_TIMER_MEM_VIRT_ACCESS, evt, clk); -+ set_next_event_mem(ARCH_TIMER_MEM_VIRT_ACCESS, evt, clk); - return 0; - } - - static int arch_timer_set_next_event_phys_mem(unsigned long evt, - struct clock_event_device *clk) - { -- set_next_event(ARCH_TIMER_MEM_PHYS_ACCESS, evt, clk); -+ set_next_event_mem(ARCH_TIMER_MEM_PHYS_ACCESS, evt, clk); - return 0; - } - -+static u64 __arch_timer_check_delta(void) -+{ -+#ifdef CONFIG_ARM64 -+ const struct midr_range broken_cval_midrs[] = { -+ /* -+ * XGene-1 implements CVAL in terms of TVAL, meaning -+ * that the maximum timer range is 32bit. Shame on them. -+ */ -+ MIDR_ALL_VERSIONS(MIDR_CPU_MODEL(ARM_CPU_IMP_APM, -+ APM_CPU_PART_POTENZA)), -+ {}, -+ }; -+ -+ if (is_midr_in_range_list(read_cpuid_id(), broken_cval_midrs)) { -+ pr_warn_once("Broken CNTx_CVAL_EL1, limiting width to 32bits"); -+ return CLOCKSOURCE_MASK(32); -+ } -+#endif -+ return CLOCKSOURCE_MASK(arch_counter_get_width()); -+} -+ - static void __arch_timer_setup(unsigned type, - struct clock_event_device *clk) - { -+ u64 max_delta; -+ - clk->features = CLOCK_EVT_FEAT_ONESHOT; - - if (type == ARCH_TIMER_TYPE_CP15) { -@@ -784,6 +837,7 @@ static void __arch_timer_setup(unsigned type, - } - - clk->set_next_event = sne; -+ max_delta = __arch_timer_check_delta(); - } else { - clk->features |= CLOCK_EVT_FEAT_DYNIRQ; - clk->name = "arch_mem_timer"; -@@ -800,11 +854,13 @@ static void __arch_timer_setup(unsigned type, - clk->set_next_event = - arch_timer_set_next_event_phys_mem; - } -+ -+ max_delta = CLOCKSOURCE_MASK(56); - } - - clk->set_state_shutdown(clk); - -- clockevents_config_and_register(clk, arch_timer_rate, 0xf, 0x7fffffff); -+ clockevents_config_and_register(clk, arch_timer_rate, 0xf, max_delta); - } - - static void arch_timer_evtstrm_enable(int divider) -@@ -974,15 +1030,7 @@ bool arch_timer_evtstrm_available(void) - - static u64 arch_counter_get_cntvct_mem(void) - { -- u32 vct_lo, vct_hi, tmp_hi; -- -- do { -- vct_hi = readl_relaxed(arch_counter_base + CNTVCT_HI); -- vct_lo = readl_relaxed(arch_counter_base + CNTVCT_LO); -- tmp_hi = readl_relaxed(arch_counter_base + CNTVCT_HI); -- } while (vct_hi != tmp_hi); -- -- return ((u64) vct_hi << 32) | vct_lo; -+ return arch_counter_get_cnt_mem(arch_timer_mem, CNTVCT_LO); - } - - static struct arch_timer_kvm_info arch_timer_kvm_info; -@@ -995,6 +1043,7 @@ struct arch_timer_kvm_info *arch_timer_get_kvm_info(void) - static void __init arch_counter_register(unsigned type) - { - u64 start_count; -+ int width; - - /* Register the CP15 based counter if we have one */ - if (type & ARCH_TIMER_TYPE_CP15) { -@@ -1019,6 +1068,10 @@ static void __init arch_counter_register(unsigned type) - arch_timer_read_counter = arch_counter_get_cntvct_mem; - } - -+ width = arch_counter_get_width(); -+ clocksource_counter.mask = CLOCKSOURCE_MASK(width); -+ cyclecounter.mask = CLOCKSOURCE_MASK(width); -+ - if (!arch_counter_suspend_stop) - clocksource_counter.flags |= CLOCK_SOURCE_SUSPEND_NONSTOP; - start_count = arch_timer_read_counter(); -@@ -1028,8 +1081,7 @@ static void __init arch_counter_register(unsigned type) - timecounter_init(&arch_timer_kvm_info.timecounter, - &cyclecounter, start_count); - -- /* 56 bits minimum, so we assume worst case rollover */ -- sched_clock_register(arch_timer_read_counter, 56, arch_timer_rate); -+ sched_clock_register(arch_timer_read_counter, width, arch_timer_rate); - } - - static void arch_timer_stop(struct clock_event_device *clk) -@@ -1170,25 +1222,25 @@ static int __init arch_timer_mem_register(void __iomem *base, unsigned int irq) - { - int ret; - irq_handler_t func; -- struct arch_timer *t; - -- t = kzalloc(sizeof(*t), GFP_KERNEL); -- if (!t) -+ arch_timer_mem = kzalloc(sizeof(*arch_timer_mem), GFP_KERNEL); -+ if (!arch_timer_mem) - return -ENOMEM; - -- t->base = base; -- t->evt.irq = irq; -- __arch_timer_setup(ARCH_TIMER_TYPE_MEM, &t->evt); -+ arch_timer_mem->base = base; -+ arch_timer_mem->evt.irq = irq; -+ __arch_timer_setup(ARCH_TIMER_TYPE_MEM, &arch_timer_mem->evt); - - if (arch_timer_mem_use_virtual) - func = arch_timer_handler_virt_mem; - else - func = arch_timer_handler_phys_mem; - -- ret = request_irq(irq, func, IRQF_TIMER, "arch_mem_timer", &t->evt); -+ ret = request_irq(irq, func, IRQF_TIMER, "arch_mem_timer", &arch_timer_mem->evt); - if (ret) { - pr_err("Failed to request mem timer irq\n"); -- kfree(t); -+ kfree(arch_timer_mem); -+ arch_timer_mem = NULL; - } - - return ret; -@@ -1436,7 +1488,6 @@ arch_timer_mem_frame_register(struct arch_timer_mem_frame *frame) - return ret; - } - -- arch_counter_base = base; - arch_timers_present |= ARCH_TIMER_TYPE_MEM; - - return 0; -diff --git a/drivers/crypto/Kconfig b/drivers/crypto/Kconfig -index dbdee43c6..e2f01f00a 100644 ---- a/drivers/crypto/Kconfig -+++ b/drivers/crypto/Kconfig -@@ -21,7 +21,7 @@ config CRYPTO_DEV_PADLOCK - (so called VIA PadLock ACE, Advanced Cryptography Engine) - that provides instructions for very fast cryptographic - operations with supported algorithms. -- -+ - The instructions are used only when the CPU supports them. - Otherwise software encryption is used. - -diff --git a/drivers/dma/Kconfig b/drivers/dma/Kconfig -index 7e1bd79fb..5ff36eda7 100644 ---- a/drivers/dma/Kconfig -+++ b/drivers/dma/Kconfig -@@ -712,6 +712,22 @@ config ZX_DMA - help - Support the DMA engine for ZTE ZX family platform devices. - -+config PHYTIUM_PCI_DMAC -+ bool "Phytium px210 PCI DMA support" -+ depends on OF || COMPILE_TEST -+ select DMA_ENGINE -+ select DMA_VIRTUAL_CHANNELS -+ help -+ Enable support for Phytium px210 DMA controller -+ -+ -+config PHYTIUM_DDMA -+ bool "Phytium PE220x DDMA support" -+ depends on (ARCH_PHYTIUM || COMPILE_TEST) -+ select DMA_ENGINE -+ select DMA_VIRTUAL_CHANNELS -+ help -+ Enable support for Phytium PE220x DDMA controller. - - # driver files - source "drivers/dma/bestcomm/Kconfig" -diff --git a/drivers/dma/Makefile b/drivers/dma/Makefile -index 948a8da05..e5cef402a 100644 ---- a/drivers/dma/Makefile -+++ b/drivers/dma/Makefile -@@ -87,3 +87,4 @@ obj-y += mediatek/ - obj-y += qcom/ - obj-y += ti/ - obj-y += xilinx/ -+obj-y += phytium/ -diff --git a/drivers/dma/phytium/Makefile b/drivers/dma/phytium/Makefile -new file mode 100644 -index 000000000..2698bbe8b ---- /dev/null -+++ b/drivers/dma/phytium/Makefile -@@ -0,0 +1,2 @@ -+obj-$(CONFIG_PHYTIUM_PCI_DMAC) += phytium-dmac-pci.o -+obj-$(CONFIG_PHYTIUM_DDMA) += phytium-ddmac.o -diff --git a/drivers/dma/phytium/phytium-ddmac.c b/drivers/dma/phytium/phytium-ddmac.c -new file mode 100644 -index 000000000..c4d8578a8 ---- /dev/null -+++ b/drivers/dma/phytium/phytium-ddmac.c -@@ -0,0 +1,945 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium Device DDMA Controller driver. -+ * -+ * Copyright (c) 2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium-ddmac.h" -+ -+ -+static inline struct phytium_ddma_device *to_ddma_device(struct dma_chan *chan) -+{ -+ return container_of(chan->device, struct phytium_ddma_device, dma_dev); -+} -+ -+static inline struct phytium_ddma_chan *to_ddma_chan(struct dma_chan *chan) -+{ -+ return container_of(chan, struct phytium_ddma_chan, vchan.chan); -+} -+ -+static inline struct phytium_ddma_desc *to_ddma_desc(struct virt_dma_desc *vd) -+{ -+ return container_of(vd, struct phytium_ddma_desc, vdesc); -+} -+ -+static inline struct device *chan_to_dev(struct phytium_ddma_chan *chan) -+{ -+ return chan->vchan.chan.device->dev; -+} -+ -+static inline struct phytium_ddma_device *chan_to_ddma( -+ struct phytium_ddma_chan *chan) -+{ -+ return to_ddma_device(&chan->vchan.chan); -+} -+ -+static inline void phytium_ddma_iowrite32( -+ const struct phytium_ddma_device *ddma, -+ const u32 reg, const u32 val) -+{ -+ iowrite32(val, ddma->base + reg); -+} -+ -+static inline u32 phytium_ddma_ioread32(const struct phytium_ddma_device *ddma, -+ const u32 reg) -+{ -+ return ioread32(ddma->base + reg); -+} -+ -+static inline void phytium_chan_iowrite32(const struct phytium_ddma_chan *chan, -+ const u32 reg, const u32 val) -+{ -+ iowrite32(val, chan->base + reg); -+} -+ -+static inline u32 phytium_chan_ioread32(const struct phytium_ddma_chan *chan, -+ const u32 reg) -+{ -+ return ioread32(chan->base + reg); -+} -+ -+static void phytium_ddma_disable(const struct phytium_ddma_device *ddma) -+{ -+ dev_dbg(ddma->dev, "ddma disable\n"); -+ phytium_ddma_iowrite32(ddma, DMA_CTL, !DMA_CTL_EN); -+} -+ -+static void phytium_ddma_enable(const struct phytium_ddma_device *ddma) -+{ -+ dev_dbg(ddma->dev, "ddma enable\n"); -+ phytium_ddma_iowrite32(ddma, DMA_CTL, DMA_CTL_EN); -+} -+ -+static void phytium_ddma_reset(const struct phytium_ddma_device *ddma) -+{ -+ u32 val = 0; -+ -+ dev_dbg(ddma->dev, "dma reset\n"); -+ val = phytium_ddma_ioread32(ddma, DMA_CTL); -+ val |= DMA_CTL_SRST; -+ phytium_ddma_iowrite32(ddma, DMA_CTL, val); -+ -+ udelay(10); -+ val &= ~DMA_CTL_SRST; -+ phytium_ddma_iowrite32(ddma, DMA_CTL, val); -+} -+ -+static void phytium_ddma_irq_disable(const struct phytium_ddma_device *ddma) -+{ -+ u32 val = 0; -+ -+ dev_dbg(ddma->dev, "ddma irq disable\n"); -+ val = phytium_ddma_ioread32(ddma, DMA_MASK_INT); -+ val |= DMA_INT_EN; -+ phytium_ddma_iowrite32(ddma, DMA_MASK_INT, val); -+} -+ -+static void phytium_ddma_irq_enable(const struct phytium_ddma_device *ddma) -+{ -+ u32 val = 0; -+ -+ dev_dbg(ddma->dev, "ddma irq enable\n"); -+ val = phytium_ddma_ioread32(ddma, DMA_MASK_INT); -+ val &= ~DMA_INT_EN; -+ phytium_ddma_iowrite32(ddma, DMA_MASK_INT, val); -+} -+ -+static u32 phytium_ddma_irq_read(const struct phytium_ddma_device *ddma) -+{ -+ u32 val = 0; -+ -+ val = phytium_ddma_ioread32(ddma, DMA_STAT); -+ -+ return val; -+} -+ -+static void phytium_chan_irq_disable(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d irq disable\n", chan->id); -+ val = phytium_ddma_ioread32(chan_to_ddma(chan), DMA_MASK_INT); -+ val |= DMA_INT_CHAL_EN(chan->id); -+ phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_MASK_INT, val); -+} -+ -+static void phytium_chan_irq_enable(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d irq enable\n", chan->id); -+ val = phytium_ddma_ioread32(chan_to_ddma(chan), DMA_MASK_INT); -+ val &= ~DMA_INT_CHAL_EN(chan->id); -+ phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_MASK_INT, val); -+} -+ -+static void phytium_chan_irq_clear(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d irq clear\n", chan->id); -+ val = DMA_STAT_CHAL(chan->id); -+ phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_STAT, val); -+} -+ -+static int phytium_chan_disable(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ int ret = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d disable\n", chan->id); -+ val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); -+ if (val | DMA_CHAL_EN) { -+ val &= ~DMA_CHAL_EN; -+ phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); -+ -+ ret = readl_relaxed_poll_timeout_atomic( -+ chan->base + DMA_CHALX_CTL, val, -+ !(val & DMA_CHAL_EN), 0, 100000); -+ } -+ return ret; -+} -+ -+static void phytium_chan_enable(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d enable\n", chan->id); -+ val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); -+ val |= DMA_CHAL_EN; -+ phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); -+} -+ -+static bool phytium_chan_is_running(const struct phytium_ddma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); -+ -+ if (val & DMA_CHAL_EN) -+ return true; -+ else -+ return false; -+} -+ -+static void phytium_chan_reset(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d reset\n", chan->id); -+ val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); -+ val |= DMA_CHAL_SRST; -+ phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); -+ -+ udelay(10); -+ val &= ~DMA_CHAL_SRST; -+ phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); -+} -+ -+static void phytium_ddma_vdesc_free(struct virt_dma_desc *vd) -+{ -+ kfree(to_ddma_desc(vd)); -+} -+ -+static int phytium_chan_pause(struct dma_chan *chan) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ int ret = 0; -+ -+ ret = phytium_chan_disable(pchan); -+ pchan->busy = false; -+ pchan->is_pasued = true; -+ -+ return ret; -+} -+ -+static int phytium_chan_resume(struct dma_chan *chan) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ -+ phytium_chan_enable(pchan); -+ pchan->is_pasued = false; -+ -+ return 0; -+} -+ -+static void phytium_chan_start_xfer(struct phytium_ddma_chan *chan) -+{ -+ struct virt_dma_desc *vdesc = NULL; -+ struct phytium_ddma_sg_req *sg_req = NULL; -+ char *tmp = NULL; -+ int i = 0; -+ unsigned long flags = 0; -+ -+ /* chan first xfer settings */ -+ if (!chan->desc) { -+ vdesc = vchan_next_desc(&chan->vchan); -+ if (!vdesc) -+ return; -+ -+ list_del(&vdesc->node); -+ chan->desc = to_ddma_desc(vdesc); -+ chan->next_sg = 0; -+ chan->current_sg = NULL; -+ dev_dbg(chan_to_dev(chan), "xfer start\n"); -+ } -+ -+ if (chan->next_sg == chan->desc->num_sgs) -+ chan->next_sg = 0; -+ -+ sg_req = &chan->desc->sg_req[chan->next_sg]; -+ chan->current_sg = sg_req; -+ /* fill to 4 bytes */ -+ switch (sg_req->direction) { -+ case DMA_MEM_TO_DEV: -+ tmp = phys_to_virt(sg_req->mem_addr_l); -+ memset(chan->buf, 0, sg_req->len * 4); -+ for (i = 0; i < sg_req->len; i++) -+ chan->buf[i * 4] = tmp[i]; -+ break; -+ -+ case DMA_DEV_TO_MEM: -+ memset(chan->buf, 0, sg_req->len * 4); -+ break; -+ -+ default: -+ break; -+ } -+ -+ /* start transfer */ -+ phytium_chan_iowrite32(chan, DMA_CHALX_DDR_LWADDR, -+ chan->paddr & 0xFFFFFFFF); -+ phytium_chan_iowrite32(chan, DMA_CHALX_DDR_UPADDR, -+ (chan->paddr >> 32) & 0xFFFFFFFF); -+ phytium_chan_iowrite32(chan, DMA_CHALX_DEV_ADDR, sg_req->dev_addr); -+ phytium_chan_iowrite32(chan, DMA_CHALX_TS, sg_req->len * 4); -+ -+ spin_lock_irqsave(&chan_to_ddma(chan)->lock, flags); -+ phytium_chan_irq_enable(chan); -+ spin_unlock_irqrestore(&chan_to_ddma(chan)->lock, flags); -+ phytium_chan_enable(chan); -+ -+ chan->next_sg++; -+ chan->busy = true; -+} -+ -+static void phytium_chan_xfer_done(struct phytium_ddma_chan *chan) -+{ -+ struct phytium_ddma_sg_req *sg_req = chan->current_sg; -+ char *tmp = NULL; -+ int i = 0; -+ -+ if (chan->desc) { -+ if (sg_req->direction == DMA_DEV_TO_MEM) { -+ tmp = phys_to_virt(sg_req->mem_addr_l); -+ for (i = 0; i < sg_req->len; i++) -+ tmp[i] = chan->buf[i * 4]; -+ } -+ -+ chan->busy = false; -+ if (chan->next_sg == chan->desc->num_sgs) { -+ dev_dbg(chan_to_dev(chan), "xfer complete\n"); -+ vchan_cookie_complete(&chan->desc->vdesc); -+ chan->desc = NULL; -+ chan->current_sg = NULL; -+ } -+ phytium_chan_disable(chan); -+ phytium_chan_irq_clear(chan); -+ phytium_chan_start_xfer(chan); -+ } -+} -+ -+static void phytium_dma_hw_init(struct phytium_ddma_device *ddma) -+{ -+ u32 i = 0; -+ int ret = 0; -+ -+ phytium_ddma_disable(ddma); -+ phytium_ddma_reset(ddma); -+ phytium_ddma_irq_enable(ddma); -+ phytium_ddma_enable(ddma); -+ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ phytium_chan_irq_disable(&ddma->chan[i]); -+ ret = phytium_chan_disable(&ddma->chan[i]); -+ if (ret) -+ dev_err(ddma->dev, "can't disable channel %d\n", i); -+ } -+} -+ -+static size_t phytium_ddma_desc_residue(struct phytium_ddma_chan *chan) -+{ -+ u32 trans_cnt = 0; -+ u32 residue = 0; -+ int i = 0; -+ -+ trans_cnt = phytium_chan_ioread32(chan, DMA_CHALX_TRANS_CNT); -+ residue = chan->current_sg->len - trans_cnt; -+ -+ for (i = chan->next_sg; i < chan->desc->num_sgs; i++) -+ residue += chan->desc->sg_req[i].len; -+ -+ return residue; -+} -+ -+static enum dma_status phytium_ddma_tx_status(struct dma_chan *chan, -+ dma_cookie_t cookie, -+ struct dma_tx_state *txstate) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ struct virt_dma_desc *vd = NULL; -+ enum dma_status ret = 0; -+ unsigned long flags = 0; -+ size_t residue = 0; -+ -+ ret = dma_cookie_status(chan, cookie, txstate); -+ if ((ret == DMA_COMPLETE) || !txstate) -+ return ret; -+ -+ spin_lock_irqsave(&pchan->vchan.lock, flags); -+ vd = vchan_find_desc(&pchan->vchan, cookie); -+ if (pchan->desc && cookie == pchan->desc->vdesc.tx.cookie) -+ residue = phytium_ddma_desc_residue(pchan); -+ -+ dma_set_residue(txstate, residue); -+ spin_unlock_irqrestore(&pchan->vchan.lock, flags); -+ -+ if (pchan->is_pasued && ret == DMA_IN_PROGRESS) -+ ret = DMA_PAUSED; -+ -+ return ret; -+} -+ -+static void phytium_ddma_issue_pending(struct dma_chan *chan) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ unsigned long flags = 0; -+ -+ spin_lock_irqsave(&pchan->vchan.lock, flags); -+ -+ if (vchan_issue_pending(&pchan->vchan) && !pchan->desc && !pchan->busy) -+ phytium_chan_start_xfer(pchan); -+ -+ spin_unlock_irqrestore(&pchan->vchan.lock, flags); -+} -+ -+static int phytium_ddma_terminate_all(struct dma_chan *chan) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ unsigned long flags = 0; -+ LIST_HEAD(head); -+ -+ spin_lock_irqsave(&pchan->vchan.lock, flags); -+ if (pchan->desc) { -+ vchan_terminate_vdesc(&pchan->desc->vdesc); -+ if (pchan->busy) { -+ u32 tmp_ctl, timeout; -+ phytium_chan_disable(pchan); -+ /* save some registers, reset will clear it */ -+ timeout = phytium_chan_ioread32(pchan, -+ DMA_CHALX_TIMEOUT_CNT); -+ tmp_ctl = phytium_chan_ioread32(pchan, -+ DMA_CHALX_CTL); -+ spin_lock(&chan_to_ddma(pchan)->lock); -+ phytium_chan_irq_disable(pchan); -+ spin_unlock(&chan_to_ddma(pchan)->lock); -+ /* need reset when terminate */ -+ phytium_chan_reset(pchan); -+ phytium_chan_irq_clear(pchan); -+ /* recover it */ -+ phytium_chan_iowrite32(pchan, -+ DMA_CHALX_CTL, tmp_ctl); -+ phytium_chan_iowrite32(pchan, -+ DMA_CHALX_TIMEOUT_CNT, timeout); -+ pchan->busy = false; -+ } -+ pchan->desc = NULL; -+ } -+ -+ vchan_get_all_descriptors(&pchan->vchan, &head); -+ spin_unlock_irqrestore(&pchan->vchan.lock, flags); -+ vchan_dma_desc_free_list(&pchan->vchan, &head); -+ -+ return 0; -+} -+ -+static int phytium_ddma_alloc_chan_resources(struct dma_chan *chan) -+{ -+ struct phytium_ddma_device *ddma = to_ddma_device(chan); -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ u32 bind_status = 0; -+ int ret = 0; -+ unsigned long flags = 0; -+ -+ bind_status = phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); -+ -+ if ((pchan->is_used) || (bind_status & BIT(pchan->id))) { -+ dev_err(ddma->dev, "channel %d already used\n", pchan->id); -+ ret = -EBUSY; -+ goto out; -+ } -+ -+ /* prepare channel */ -+ ret = phytium_chan_disable(pchan); -+ if (ret) { -+ dev_err(ddma->dev, "can't disable channel %d\n", pchan->id); -+ goto out; -+ } -+ phytium_chan_reset(pchan); -+ phytium_chan_irq_clear(pchan); -+ -+ /* channel bind */ -+ spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); -+ bind_status |= BIT(pchan->id); -+ phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, bind_status); -+ pchan->is_used = true; -+ spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); -+ -+ /* alloc dma memory */ -+ pchan->buf = dma_alloc_coherent(ddma->dev, 4 * PAGE_SIZE, &pchan->paddr, -+ GFP_KERNEL); -+ if (!pchan->buf) { -+ ret = -EBUSY; -+ dev_err(ddma->dev, "failed to alloc dma memory\n"); -+ } -+ -+ dev_info(ddma->dev, "alloc channel %d\n", pchan->id); -+ -+out: -+ return ret; -+} -+ -+static void phytium_ddma_free_chan_resources(struct dma_chan *chan) -+{ -+ struct phytium_ddma_device *ddma = to_ddma_device(chan); -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ u32 bind_status = 0; -+ unsigned long flags = 0; -+ -+ if (!pchan->is_used) -+ return; -+ -+ dev_dbg(ddma->dev, "free channel %d\n", pchan->id); -+ spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); -+ bind_status = phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); -+ bind_status &= ~BIT(pchan->id); -+ phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, bind_status); -+ spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); -+ -+ phytium_chan_disable(pchan); -+ -+ spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); -+ phytium_chan_irq_disable(pchan); -+ spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); -+ -+ vchan_free_chan_resources(to_virt_chan(chan)); -+ pchan->is_used = false; -+ -+ if (pchan->buf) -+ dma_free_coherent(ddma->dev, 4 * PAGE_SIZE, -+ pchan->buf, pchan->paddr); -+} -+ -+static int phytium_ddma_slave_config(struct dma_chan *chan, -+ struct dma_slave_config *config) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ u32 chal_cfg = 0; -+ u32 req_mode = 0; -+ const u32 timeout = 0xffff; -+ unsigned long flag = 0; -+ -+ /* Check if chan will be configured for slave transfers */ -+ if (!is_slave_direction(config->direction)) -+ return -EINVAL; -+ -+ memcpy(&pchan->dma_config, config, sizeof(*config)); -+ -+ /* set channel config reg */ -+ spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flag); -+ if (pchan->id > 3) { -+ chal_cfg = phytium_ddma_ioread32(chan_to_ddma(pchan), -+ DMA_CHAL_CFG_H); -+ chal_cfg &= ~(0xFF << ((pchan->id - 4) * 8)); -+ chal_cfg |= DMA_CHAL_SEL((pchan->id - 4), pchan->request_line); -+ chal_cfg |= DMA_CHAL_SEL_EN(pchan->id - 4); -+ phytium_ddma_iowrite32(chan_to_ddma(pchan), DMA_CHAL_CFG_H, -+ chal_cfg); -+ } else { -+ chal_cfg = phytium_ddma_ioread32(chan_to_ddma(pchan), -+ DMA_CHAL_CFG_L); -+ chal_cfg &= ~(0xFF << (pchan->id * 8)); -+ chal_cfg |= DMA_CHAL_SEL((pchan->id), pchan->request_line); -+ chal_cfg |= DMA_CHAL_SEL_EN(pchan->id); -+ phytium_ddma_iowrite32(chan_to_ddma(pchan), DMA_CHAL_CFG_L, -+ chal_cfg); -+ } -+ spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flag); -+ -+ /* set channel mode */ -+ req_mode = (config->direction == DMA_DEV_TO_MEM) ? -+ DMA_RX_REQ : DMA_TX_REQ; -+ phytium_chan_iowrite32(pchan, DMA_CHALX_CTL, req_mode << 2); -+ -+ /* set channel timeout */ -+ phytium_chan_iowrite32(pchan, DMA_CHALX_TIMEOUT_CNT, -+ timeout | DMA_CHAL_TIMEOUT_EN); -+ -+ return 0; -+} -+ -+static struct dma_async_tx_descriptor *phytium_ddma_prep_slave_sg( -+ struct dma_chan *chan, struct scatterlist *sgl, -+ u32 sg_len, enum dma_transfer_direction direction, -+ unsigned long flags, void *context) -+{ -+ struct phytium_ddma_device *ddma = to_ddma_device(chan); -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ struct dma_slave_config *sconfig = &pchan->dma_config; -+ struct phytium_ddma_desc *desc = NULL; -+ struct scatterlist *sg = NULL; -+ int i = 0; -+ char *tmp; -+ -+ if (unlikely(!is_slave_direction(direction))) { -+ dev_err(ddma->dev, "invalid dma direction\n"); -+ return NULL; -+ } -+ -+ if (unlikely(sg_len < 1)) { -+ dev_err(ddma->dev, "invalid segment length: %d\n", sg_len); -+ return NULL; -+ } -+ -+ desc = kzalloc(struct_size(desc, sg_req, sg_len), GFP_NOWAIT); -+ if (!desc) -+ return NULL; -+ -+ /* set sg list */ -+ for_each_sg(sgl, sg, sg_len, i) { -+ tmp = phys_to_virt(sg_dma_address(sg)); -+ desc->sg_req[i].direction = direction; -+ -+ switch (direction) { -+ case DMA_MEM_TO_DEV: -+ desc->sg_req[i].len = sg_dma_len(sg); -+ desc->sg_req[i].mem_addr_l = -+ sg_dma_address(sg) & 0xFFFFFFFF; -+ desc->sg_req[i].mem_addr_h = -+ (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; -+ desc->sg_req[i].dev_addr = -+ sconfig->dst_addr & 0xFFFFFFFF; -+ break; -+ -+ case DMA_DEV_TO_MEM: -+ desc->sg_req[i].len = sg_dma_len(sg); -+ desc->sg_req[i].mem_addr_l = -+ sg_dma_address(sg) & 0xFFFFFFFF; -+ desc->sg_req[i].mem_addr_h = -+ (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; -+ desc->sg_req[i].dev_addr = -+ sconfig->src_addr & 0xFFFFFFFF; -+ break; -+ -+ default: -+ return NULL; -+ } -+ } -+ -+ desc->num_sgs = sg_len; -+ -+ return vchan_tx_prep(&pchan->vchan, &desc->vdesc, flags); -+} -+ -+static irqreturn_t phytium_dma_interrupt(int irq, void *dev_id) -+{ -+ struct phytium_ddma_device *ddma = dev_id; -+ struct phytium_ddma_chan *chan; -+ u32 irq_status = 0; -+ u32 i = 0; -+ u32 val = 0; -+ -+ phytium_ddma_irq_disable(ddma); -+ -+ irq_status = phytium_ddma_irq_read(ddma); -+ val = phytium_ddma_ioread32(ddma, DMA_CTL); -+ -+ /* Poll, clear and process every chanel interrupt status */ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ if (!(irq_status & BIT(i * 4))) -+ continue; -+ -+ chan = &ddma->chan[i]; -+ phytium_chan_xfer_done(chan); -+ } -+ -+ phytium_ddma_irq_enable(ddma); -+ -+ return IRQ_HANDLED; -+} -+ -+ -+static struct dma_chan *phytium_ddma_of_xlate(struct of_phandle_args *dma_spec, -+ struct of_dma *ofdma) -+{ -+ struct phytium_ddma_device *ddma = ofdma->of_dma_data; -+ struct device *dev = ddma->dev; -+ struct phytium_ddma_chan *chan = NULL; -+ struct dma_chan *c = NULL; -+ u32 channel_id = 0; -+ -+ channel_id = dma_spec->args[0]; -+ -+ if (channel_id > ddma->dma_channels) { -+ dev_err(dev, "bad channel %d\n", channel_id); -+ return NULL; -+ } -+ -+ chan = &ddma->chan[channel_id]; -+ chan->request_line = dma_spec->args[1]; -+ c = dma_get_slave_channel(&chan->vchan.chan); -+ if (!c) { -+ dev_err(dev, "no more channels available\n"); -+ return NULL; -+ } -+ -+ return c; -+} -+ -+static int phytium_ddma_probe(struct platform_device *pdev) -+{ -+ struct phytium_ddma_device *ddma; -+ struct dma_device *dma_dev; -+ struct resource *mem; -+ u32 i = 0; -+ int ret = 0; -+ u32 nr_channels = 0; -+ -+ ddma = devm_kzalloc(&pdev->dev, sizeof(*ddma), GFP_KERNEL); -+ if (!ddma) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ dma_dev = &ddma->dma_dev; -+ ddma->dev = &pdev->dev; -+ -+ spin_lock_init(&ddma->lock); -+ -+ ddma->irq = platform_get_irq(pdev, 0); -+ if (ddma->irq < 0) { -+ dev_err(&pdev->dev, "no irq resource\n"); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ ddma->base = devm_ioremap_resource(&pdev->dev, mem); -+ if (IS_ERR(ddma->base)) { -+ dev_err(&pdev->dev, "no resource address"); -+ ret = PTR_ERR(ddma->base); -+ goto out; -+ } -+ -+ ret = of_property_read_u32(pdev->dev.of_node, "dma-channels", -+ &nr_channels); -+ if (ret < 0) { -+ dev_err(&pdev->dev, -+ "can't get the number of dma channels: %d\n", ret); -+ goto out; -+ } -+ -+ if (nr_channels > DDMA_MAX_NR_PCHANNELS) { -+ dev_warn(&pdev->dev, "over the max number of channels\n"); -+ nr_channels = DDMA_MAX_NR_PCHANNELS; -+ } -+ -+ ddma->dma_channels = DDMA_MAX_NR_PCHANNELS; -+ -+ ret = devm_request_irq(&pdev->dev, ddma->irq, phytium_dma_interrupt, -+ IRQF_SHARED, dev_name(&pdev->dev), ddma); -+ if (ret) { -+ dev_err(&pdev->dev, "could not to request irq %d", ddma->irq); -+ goto out; -+ } -+ -+ /* Set capabilities */ -+ dma_cap_set(DMA_SLAVE, ddma->dma_dev.cap_mask); -+ -+ /* DMA capabilities */ -+ dma_dev->dev = ddma->dev; -+ dma_dev->chancnt = ddma->dma_channels; -+ dma_dev->src_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_4_BYTES); -+ dma_dev->dst_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_4_BYTES); -+ dma_dev->directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV); -+ dma_dev->residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; -+ -+ /* function callback */ -+ dma_dev->device_tx_status = phytium_ddma_tx_status; -+ dma_dev->device_issue_pending = phytium_ddma_issue_pending; -+ dma_dev->device_terminate_all = phytium_ddma_terminate_all; -+ dma_dev->device_alloc_chan_resources = -+ phytium_ddma_alloc_chan_resources; -+ dma_dev->device_free_chan_resources = phytium_ddma_free_chan_resources; -+ dma_dev->device_config = phytium_ddma_slave_config; -+ dma_dev->device_prep_slave_sg = phytium_ddma_prep_slave_sg; -+ dma_dev->device_pause = phytium_chan_pause; -+ dma_dev->device_resume = phytium_chan_resume; -+ -+ /* init dma physical channels */ -+ INIT_LIST_HEAD(&dma_dev->channels); -+ ddma->chan = devm_kcalloc(ddma->dev, ddma->dma_channels, -+ sizeof(*ddma->chan), GFP_KERNEL); -+ if (!ddma->chan) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ for (i = 0; i < ddma->dma_channels; i++) { -+ ddma->chan[i].id = i; -+ ddma->chan[i].buf = NULL; -+ ddma->chan[i].base = ddma->base + DMA_REG_LEN + -+ i * CHAN_REG_LEN; -+ ddma->chan[i].vchan.desc_free = phytium_ddma_vdesc_free; -+ ddma->chan[i].desc = NULL; -+ ddma->chan[i].current_sg = NULL; -+ vchan_init(&ddma->chan[i].vchan, dma_dev); -+ } -+ -+ phytium_dma_hw_init(ddma); -+ -+ ret = dma_async_device_register(dma_dev); -+ if (ret) -+ goto out; -+ -+ ret = of_dma_controller_register(pdev->dev.of_node, -+ phytium_ddma_of_xlate, ddma); -+ if (ret < 0) { -+ dev_err(&pdev->dev, -+ "phytium ddma of register failed %d\n", ret); -+ goto err_unregister; -+ } -+ -+ platform_set_drvdata(pdev, ddma); -+ dev_info(ddma->dev, "phytium DDMA Controller registered\n"); -+ -+ return 0; -+ -+err_unregister: -+ dma_async_device_unregister(dma_dev); -+ -+out: -+ return ret; -+} -+ -+static void phytium_ddma_chan_remove(struct phytium_ddma_chan *chan) -+{ -+ phytium_chan_irq_disable(chan); -+ phytium_chan_disable(chan); -+ -+ if (chan->buf) -+ dma_free_coherent(chan_to_dev(chan), 4 * PAGE_SIZE, chan->buf, -+ chan->paddr); -+ -+ tasklet_kill(&chan->vchan.task); -+ list_del(&chan->vchan.chan.device_node); -+} -+ -+static int phytium_ddma_remove(struct platform_device *pdev) -+{ -+ struct phytium_ddma_device *ddma = platform_get_drvdata(pdev); -+ struct phytium_ddma_chan *chan = NULL; -+ int i = 0; -+ -+ of_dma_controller_free(pdev->dev.of_node); -+ dma_async_device_unregister(&ddma->dma_dev); -+ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ chan = &ddma->chan[i]; -+ phytium_ddma_chan_remove(chan); -+ } -+ -+ phytium_ddma_irq_disable(ddma); -+ phytium_ddma_disable(ddma); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_ddma_suspend(struct device *dev) -+{ -+ struct phytium_ddma_device *ddma = dev_get_drvdata(dev); -+ int i = 0; -+ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ if (phytium_chan_is_running(&ddma->chan[i])) { -+ dev_warn(dev, -+ "suspend is prevented by channel %d\n", i); -+ return -EBUSY; -+ } -+ } -+ -+ ddma->dma_reg.dma_chal_cfg0 = -+ phytium_ddma_ioread32(ddma, DMA_CHAL_CFG_L); -+ ddma->dma_reg.dma_chal_bind = -+ phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); -+ ddma->dma_reg.dma_chal_cfg1 = -+ phytium_ddma_ioread32(ddma, DMA_CHAL_CFG_H); -+ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ struct phytium_ddma_chan *chan = &ddma->chan[i]; -+ -+ if (!chan->is_used) -+ continue; -+ ddma->dma_chal_reg[i].dma_chalx_ctl = -+ phytium_chan_ioread32(chan, DMA_CHALX_CTL); -+ ddma->dma_chal_reg[i].dma_chalx_timeout_cnt = -+ phytium_chan_ioread32(chan, DMA_CHALX_TIMEOUT_CNT); -+ } -+ -+ phytium_ddma_irq_disable(ddma); -+ phytium_ddma_disable(ddma); -+ pm_runtime_force_suspend(dev); -+ -+ return 0; -+} -+ -+static int phytium_ddma_resume(struct device *dev) -+{ -+ struct phytium_ddma_device *ddma = dev_get_drvdata(dev); -+ u32 i = 0; -+ int ret = 0; -+ -+ phytium_dma_hw_init(ddma); -+ phytium_ddma_iowrite32(ddma, DMA_CHAL_CFG_L, -+ ddma->dma_reg.dma_chal_cfg0); -+ phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, -+ ddma->dma_reg.dma_chal_bind); -+ phytium_ddma_iowrite32(ddma, DMA_CHAL_CFG_H, -+ ddma->dma_reg.dma_chal_cfg1); -+ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ struct phytium_ddma_chan *chan = &ddma->chan[i]; -+ -+ if (!chan->is_used) -+ continue; -+ phytium_chan_iowrite32(chan, DMA_CHALX_CTL, -+ ddma->dma_chal_reg[i].dma_chalx_ctl); -+ phytium_chan_iowrite32(chan, DMA_CHALX_TIMEOUT_CNT, -+ ddma->dma_chal_reg[i].dma_chalx_timeout_cnt); -+ } -+ -+ ret = pm_runtime_force_resume(dev); -+ -+ return ret; -+} -+#endif -+ -+static const struct dev_pm_ops phytium_ddma_pm_ops = { -+ SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_ddma_suspend, -+ phytium_ddma_resume) -+}; -+ -+static const struct of_device_id phytium_dma_of_id_table[] = { -+ { .compatible = "phytium,ddma" }, -+ {} -+}; -+MODULE_DEVICE_TABLE(of, phytium_dma_of_id_table); -+ -+static struct platform_driver phytium_driver = { -+ .probe = phytium_ddma_probe, -+ .remove = phytium_ddma_remove, -+ .driver = { -+ .name = "phytium-ddma", -+ .of_match_table = of_match_ptr(phytium_dma_of_id_table), -+ .pm = &phytium_ddma_pm_ops, -+ }, -+}; -+ -+module_platform_driver(phytium_driver); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium DDMA Controller platform driver"); -+MODULE_AUTHOR("HuangJie "); -diff --git a/drivers/dma/phytium/phytium-ddmac.h b/drivers/dma/phytium/phytium-ddmac.h -new file mode 100644 -index 000000000..d99cd5756 ---- /dev/null -+++ b/drivers/dma/phytium/phytium-ddmac.h -@@ -0,0 +1,164 @@ -+/* SPDX-License-Identifier: GPL-2.0-only */ -+/* -+ * Phytium Device DDMA Controller driver. -+ * -+ * Copyright (c) 2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _PHYTIUM_DDMAC_H -+#define _PHYTIUM_DDMAC_H -+ -+#include -+#include -+#include -+#include -+#include -+#include "../virt-dma.h" -+ -+/* the number of physical channel */ -+#define DDMA_MAX_NR_PCHANNELS 8 -+ -+#define DMAC_MAX_MASTERS 1 -+#define DMAC_MAX_BLK_SIZE PAGE_SIZE -+ -+#define CHAN_REG_LEN 0x40 -+#define DMA_REG_LEN 0x40 -+ -+#define DMA_CTL 0x00 -+#define DMA_CHAL_CFG_L 0x04 -+#define DMA_CHAL_CFG_H 0x28 -+#define DMA_STAT 0x08 -+#define DMA_MASK_INT 0x0C -+#define DMA_CHAL_BIND 0x20 -+#define DMA_GCAP 0x24 -+ -+#define DMA_CHALX_DDR_UPADDR 0x00 -+#define DMA_CHALX_DDR_LWADDR 0x04 -+#define DMA_CHALX_DEV_ADDR 0x08 -+#define DMA_CHALX_TS 0x0C -+#define DMA_CHALX_CRT_UPADDR 0x10 -+#define DMA_CHALX_CRT_LWADDR 0x14 -+#define DMA_CHALX_CTL 0x18 -+#define DMA_CHALX_STS 0x1C -+#define DMA_CHALX_TIMEOUT_CNT 0x20 -+#define DMA_CHALX_TRANS_CNT 0x24 -+ -+#define DMA_CTL_EN BIT(0) -+#define DMA_CTL_SRST BIT(1) -+ -+#define DMA_CHAL_SEL(id, x) (min_t(unsigned int, x, 0x7F) << ((id) * 8)) -+#define DMA_CHAL_SEL_EN(id) BIT((id) * 8 + 7) -+ -+#define DMA_STAT_CHAL(id) BIT((id) * 4) -+ -+#define DMA_INT_EN BIT(31) -+#define DMA_INT_CHAL_EN(id) BIT(id) -+ -+#define DMA_CHAL_EN BIT(0) -+#define DMA_CHAL_SRST BIT(1) -+#define DMA_CHAL_MODE BIT(2) -+ -+#define DMA_RX_REQ 1 -+#define DMA_TX_REQ 0 -+ -+#define DMA_CHAL_TIMEOUT_EN BIT(31) -+#define DMA_CHAL_TIMEOUT_CNT(x) min_t(unsigned int, x, 0xFFFFF) -+ -+#define DMA_TIMEOUT 10 -+ -+/** -+ * struct phytium_ddma_sg_req - scatter-gatter list data info -+ * @len: number of bytes to transform -+ * @mem_addr_l: bus address low 32bit -+ * @mem_addr_h: bus address high 32bit -+ * @dev_addr: dma cousumer data reg addr -+ * @direction: dma transmit direction -+ */ -+struct phytium_ddma_sg_req { -+ u32 len; -+ u32 mem_addr_l; -+ u32 mem_addr_h; -+ u32 dev_addr; -+ enum dma_transfer_direction direction; -+}; -+ -+/** -+ * struct phytium_ddma_desc - the struct holding info describing ddma request -+ * descriptor -+ * @vdesc: ddma request descriptor -+ * @num_sgs: the size of scatter-gatter list -+ * @sg_req: use to save scatter-gatter list info -+ */ -+struct phytium_ddma_desc { -+ struct virt_dma_desc vdesc; -+ u32 num_sgs; -+ struct phytium_ddma_sg_req sg_req[]; -+}; -+ -+/** -+ * struct phytium_ddma_chan - the struct holding info describing dma channel -+ * @vchan: virtual dma channel -+ * @base: the mapped register I/O of dma physical channel -+ * @id: the id of ddma physical channel -+ * @request_line: the request line of ddma channel -+ * @desc: the transform request descriptor -+ * @dma_config: config parameters for dma channel -+ * @busy: the channel busy flag, this flag set when channel is tansferring -+ * @is_used: the channel bind flag, this flag set when channel binded -+ * @next_sg: the index of next scatter-gatter -+ * @current_sg: use to save the current transfer scatter-gatter info -+ * @paddr: use to align data between dma provider and consumer -+ */ -+struct phytium_ddma_chan { -+ struct virt_dma_chan vchan; -+ void __iomem *base; -+ u32 id; -+ u32 request_line; -+ struct phytium_ddma_desc *desc; -+ struct dma_slave_config dma_config; -+ bool busy; -+ bool is_used; -+ bool is_pasued; -+ u32 next_sg; -+ struct phytium_ddma_sg_req *current_sg; -+ dma_addr_t paddr; -+ char *buf; -+}; -+ -+struct global_reg { -+ u32 dma_chal_cfg0; -+ u32 dma_chal_bind; -+ u32 dma_chal_cfg1; -+}; -+ -+struct channel_reg { -+ u32 dma_chalx_ctl; -+ u32 dma_chalx_timeout_cnt; -+}; -+ -+/** -+ * struct phytium_ddma_device - the struct holding info describing DDMA device -+ * @dma_dev: an instance for struct dma_device -+ * @irq: the irq that DDMA using -+ * @base: the mapped register I/O base of this DDMA -+ * @core_clk: DDMA clock -+ * @dma_channels: the number of DDMA physical channels -+ * @chan: the phyical channels of DDMA -+ * @lock: spinlock to lock when set global registers -+ * @dma_reg: store global register value which need recover after resume -+ * @dma_chal_reg: store channel register value which need recover after resume -+ */ -+struct phytium_ddma_device { -+ struct dma_device dma_dev; -+ struct device *dev; -+ int irq; -+ void __iomem *base; -+ struct clk *core_clk; -+ u32 dma_channels; -+ struct phytium_ddma_chan *chan; -+ spinlock_t lock; -+ struct global_reg dma_reg; -+ struct channel_reg dma_chal_reg[DDMA_MAX_NR_PCHANNELS]; -+}; -+ -+#endif /* _PHYTIUM_DDMAC_H */ -diff --git a/drivers/dma/phytium/phytium-dmac-pci.c b/drivers/dma/phytium/phytium-dmac-pci.c -new file mode 100644 -index 000000000..2d296e285 ---- /dev/null -+++ b/drivers/dma/phytium/phytium-dmac-pci.c -@@ -0,0 +1,1053 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ * -+ * Phytium PCI DMA Controller driver. -+ * -+ * 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 -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+ -+#include -+#include -+#include -+#include -+ -+#include "phytium-dmac-pci.h" -+#include "../dmaengine.h" -+#include "../virt-dma.h" -+ -+static const struct dma_slave_map ft_px210gpu_slave_map[] = { -+ {"px210-dma", "tx", 0}, -+ {"px210-dma", "rx", 0}, -+}; -+ -+bool px210_filter_fn(struct dma_chan *chan, void *param); -+ -+static inline void -+phytium_dma_iowrite32(struct phytium_dma_chip *chip, u32 reg, u32 val) -+{ -+ iowrite32(val, chip->regs + reg); -+} -+ -+static inline u32 phytium_dma_ioread32(struct phytium_dma_chip *chip, u32 reg) -+{ -+ return ioread32(chip->regs + reg); -+} -+ -+static inline void -+phytium_chan_iowrite32(struct phytium_dma_chan *chan, u32 reg, u32 val) -+{ -+ iowrite32(val, chan->chan_regs + reg); -+} -+ -+static inline u32 phytium_chan_ioread32(struct phytium_dma_chan *chan, u32 reg) -+{ -+ return ioread32(chan->chan_regs + reg); -+} -+ -+static inline void phytium_dma_irq_disable(struct phytium_dma_chip *chip) -+{ -+ u32 val; -+ -+ val = 0; -+ phytium_dma_iowrite32(chip, DMA_IRQ_MASK, val); -+} -+ -+static inline void phytium_dma_irq_enable(struct phytium_dma_chip *chip) -+{ -+ u32 val; -+ -+ val = 0x4077FFFF; -+ phytium_dma_iowrite32(chip, DMA_IRQ_MASK, val); -+} -+ -+static inline void phytium_dma_irq_clear(struct phytium_dma_chip *chip, -+ u32 irq_status) -+{ -+ phytium_dma_iowrite32(chip, DMA_IRQ_STATUS, irq_status); -+} -+ -+static inline u32 phytium_dma_irq_read(struct phytium_dma_chip *chip) -+{ -+ u32 val; -+ -+ val = phytium_dma_ioread32(chip, DMA_IRQ_STATUS); -+ -+ return val; -+} -+ -+static inline u32 phytium_dma_irq_mask_read(struct phytium_dma_chip *chip) -+{ -+ u32 val; -+ -+ val = phytium_dma_ioread32(chip, DMA_IRQ_MASK); -+ -+ return val; -+} -+ -+ -+static inline void phytium_chan_irq_disable(struct phytium_dma_chan *chan, u32 irq_mask) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ val &= ~irq_mask; -+ phytium_chan_iowrite32(chan, DMA_CONTROL, val); -+} -+ -+static inline void phytium_chan_irq_set(struct phytium_dma_chan *chan, u32 irq_mask) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ val &= ~DMA_CTRL_IRQ_MASK(0xF); -+ val |= irq_mask; -+ val |= DMA_CTRL_IRQ_ID(1); -+ phytium_chan_iowrite32(chan, DMA_CONTROL, val); -+} -+ -+static inline void phytium_chan_irq_clear(struct phytium_dma_chan *chan, u32 irq_mask) -+{ -+ u32 val; -+ -+ val = phytium_dma_ioread32(chan->chip, DMA_IRQ_STATUS); -+ val &= ~irq_mask; -+ phytium_chan_iowrite32(chan, DMA_IRQ_STATUS, val); -+} -+ -+static inline u32 phytium_chan_irq_read(struct phytium_dma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_dma_ioread32(chan->chip, DMA_IRQ_STATUS); -+ val &= ((chan->id << 0) | (chan->id << 8)); -+ -+ return val; -+} -+ -+static inline u32 phytium_chan_status_read(struct phytium_dma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_STATUS); -+ -+ return val; -+} -+ -+static inline void phytium_chan_disable(struct phytium_dma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ val &= ~DMA_CTRL_START; -+ phytium_chan_iowrite32(chan, DMA_CONTROL, val); -+} -+ -+static inline void phytium_chan_enable(struct phytium_dma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ val |= DMA_CTRL_START; -+ phytium_chan_iowrite32(chan, DMA_CONTROL, val); -+} -+ -+static inline const char *phytium_chan_name(struct phytium_dma_chan *chan) -+{ -+ return dma_chan_name(&chan->vc.chan); -+} -+ -+static struct phytium_dma_desc *phytium_desc_get(struct phytium_dma_chan *chan) -+{ -+ struct phytium_dma_desc *desc = NULL; -+ -+ desc = kmalloc(sizeof(*desc), GFP_KERNEL); -+ if (unlikely(!desc)) { -+ dev_err(chan2dev(chan), "%s: not enough descriptors available\n", -+ phytium_chan_name(chan)); -+ return NULL; -+ } -+ -+ memset(desc, 0, sizeof(*desc)); -+ -+ INIT_LIST_HEAD(&desc->xfer_list); -+ -+ return desc; -+} -+ -+static void phytium_desc_put(struct phytium_dma_desc *desc) -+{ -+ unsigned int descs_put = 0; -+ -+ kfree(desc); -+ -+ descs_put++; -+} -+ -+static void phytium_vchan_desc_put(struct virt_dma_desc *vdesc) -+{ -+ phytium_desc_put(vd_to_desc(vdesc)); -+} -+ -+static inline bool phytium_chan_is_running(struct phytium_dma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ -+ if (val & DMA_CTRL_START) -+ return true; -+ else -+ return false; -+} -+ -+/* Called in chan locked context */ -+static void phytium_chan_block_xfer_start(struct phytium_dma_chan *chan, -+ struct phytium_dma_desc *desc) -+{ -+ u32 irq_mask; -+ u32 val; -+ -+ chan->is_idle = false; -+ if (phytium_chan_is_running(chan)) { -+ dev_err(chan2dev(chan), "%s is non-idle!\n", phytium_chan_name(chan)); -+ return; -+ } -+ -+ phytium_chan_iowrite32(chan, DMA_SRCPARAM, desc->dma_srcparam); -+ phytium_chan_iowrite32(chan, DMA_DESTPARAM, desc->dma_destparam); -+ phytium_chan_iowrite32(chan, DMA_SRCADDR_L, desc->dma_srcaddr_l); -+ phytium_chan_iowrite32(chan, DMA_SRCADDR_H, desc->dma_srcaddr_h); -+ phytium_chan_iowrite32(chan, DMA_DESTADDR_L, desc->dma_destaddr_l); -+ phytium_chan_iowrite32(chan, DMA_DESTADDR_H, desc->dma_destaddr_h); -+ phytium_chan_iowrite32(chan, DMA_LENGTH, desc->dma_len); -+ -+ /* SG_TYPE & IRQ_ID & SE_COND & SG_EN */ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ val |= desc->dma_ctrl; -+ val |= DMA_CTRL_COND_LEN | DMA_CTRL_COND_EOP | DMA_CTRL_COND_ERR; -+ -+ phytium_chan_iowrite32(chan, DMA_CONTROL, val); -+ -+ irq_mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; -+ phytium_chan_irq_set(chan, irq_mask); -+ -+ phytium_chan_enable(chan); -+} -+ -+static void phytium_chan_start_first_queued(struct phytium_dma_chan *chan) -+{ -+ struct phytium_dma_desc *desc = NULL; -+ struct virt_dma_desc *vd = NULL; -+ -+ vd = vchan_next_desc(&chan->vc); -+ if (!vd) -+ return; -+ -+ desc = vd_to_desc(vd); -+ dev_dbg(chan2dev(chan), "%s: started %u\n", phytium_chan_name(chan), -+ vd->tx.cookie); -+ -+ phytium_chan_block_xfer_start(chan, desc); -+} -+ -+static void phytium_dma_hw_init(struct phytium_dma_chip *chip) -+{ -+ u32 i; -+ -+ for (i = 0; i < chip->hdata->nr_channels; i++) { -+ phytium_chan_irq_disable(&chip->dmac->chan[i], DMA_CTRL_IRQ_MASK(0xF)); -+ phytium_chan_disable(&chip->dmac->chan[i]); -+ } -+} -+ -+ -+static enum dma_status phytium_dma_tx_status(struct dma_chan *dchan, -+ dma_cookie_t cookie, -+ struct dma_tx_state *state) -+{ -+ enum dma_status ret; -+ -+ ret = dma_cookie_status(dchan, cookie, state); -+ -+ return ret; -+} -+ -+static void phytium_dma_issue_pending(struct dma_chan *dchan) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ unsigned long flags; -+ -+ spin_lock_irqsave(&chan->vc.lock, flags); -+ if (vchan_issue_pending(&chan->vc) && chan->is_idle) -+ phytium_chan_start_first_queued(chan); -+ spin_unlock_irqrestore(&chan->vc.lock, flags); -+} -+ -+static void phytium_dma_synchronize(struct dma_chan *dchan) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ -+ vchan_synchronize(&chan->vc); -+} -+ -+static int phytium_dma_terminate_all(struct dma_chan *dchan) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ unsigned long flags; -+ LIST_HEAD(head); -+ -+ spin_lock_irqsave(&chan->vc.lock, flags); -+ -+ phytium_chan_disable(chan); -+ -+ vchan_get_all_descriptors(&chan->vc, &head); -+ -+ /* -+ * As vchan_dma_desc_free_list can access to desc_allocated list -+ * we need to call it in vc.lock context. -+ */ -+ vchan_dma_desc_free_list(&chan->vc, &head); -+ -+ spin_unlock_irqrestore(&chan->vc.lock, flags); -+ -+ dev_vdbg(dchan2dev(dchan), "terminated: %s\n", phytium_chan_name(chan)); -+ -+ return 0; -+} -+ -+static int phytium_dma_alloc_chan_resources(struct dma_chan *dchan) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ -+ /* ASSERT: channel is idle */ -+ if (chan->is_used) { -+ dev_err(chan2dev(chan), "%s is non-idle!\n", -+ phytium_chan_name(chan)); -+ return -EBUSY; -+ } -+ -+ chan->is_used = true; -+ atomic_set(&chan->releasing, 0); -+ -+ return 0; -+} -+ -+static void phytium_dma_free_chan_resources(struct dma_chan *dchan) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ -+ atomic_set(&chan->releasing, 1); -+ /* ASSERT: channel is idle */ -+ if (chan->is_used) -+ dev_err(dchan2dev(dchan), "%s is non-idle!\n", -+ phytium_chan_name(chan)); -+ -+ phytium_chan_disable(chan); -+ phytium_chan_irq_disable(chan, DMA_CTRL_IRQ_MASK(0xF)); -+ -+ vchan_free_chan_resources(&chan->vc); -+ -+ dev_vdbg(dchan2dev(dchan), -+ "%s: free resources, descriptor still allocated: %u\n", -+ phytium_chan_name(chan), atomic_read(&chan->descs_allocated)); -+ -+ chan->is_used = false; -+} -+ -+static int phytium_dma_slave_config(struct dma_chan *dchan, -+ struct dma_slave_config *sconfig) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ -+ /* Check if chan will be configured for slave transfers */ -+ if (!is_slave_direction(sconfig->direction)) -+ return -EINVAL; -+ -+ memcpy(&chan->dma_sconfig, sconfig, sizeof(*sconfig)); -+ -+ return 0; -+} -+ -+static struct dma_async_tx_descriptor *phytium_dma_prep_dma_memcpy( -+ struct dma_chan *dchan, dma_addr_t dst_adr, -+ dma_addr_t src_adr, size_t len, unsigned long flags) -+{ -+ struct phytium_dma_desc *desc = NULL; -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ struct dma_slave_config *sconfig = &chan->dma_sconfig; -+ size_t block_ts, max_block_ts, xfer_len; -+ -+ chan = dchan_to_dma_chan(dchan); -+ -+ dev_info(chan2dev(chan), "%s: memcpy: src: %pad dst: %pad length: %zd flags: %#lx", -+ phytium_chan_name(chan), &src_adr, &dst_adr, len, flags); -+ -+ max_block_ts = chan->chip->hdata->block_size[chan->id]; -+ if (len > max_block_ts) { -+ dev_err(chan2dev(chan), "The data length(%zd) is too long!\n", len); -+ return NULL; -+ } -+ -+ xfer_len = len; -+ block_ts = xfer_len >> DMA_SLAVE_BUSWIDTH_4_BYTES; -+ xfer_len = block_ts << DMA_SLAVE_BUSWIDTH_4_BYTES; -+ -+ desc = phytium_desc_get(chan); -+ if (unlikely(!desc)) -+ goto err_desc_get; -+ -+ switch (sconfig->direction) { -+ case DMA_MEM_TO_DEV: -+ desc->dma_srcparam = DMA_SRCP_SRC_ID(0); -+ desc->dma_destparam = DMA_DESTP_DEST_ID(5); -+ break; -+ case DMA_DEV_TO_MEM: -+ desc->dma_srcparam = DMA_SRCP_SRC_ID(5); -+ desc->dma_destparam = DMA_DESTP_DEST_ID(0); -+ break; -+ default: -+ return NULL; -+ } -+ -+ desc->dma_ctrl |= DMA_CTRL_SG_EN; -+ desc->dma_ctrl |= DMA_CTRL_SG_TYPE(0); -+ -+ desc->dma_ctrl |= DMA_CTRL_SG_ID(0); -+ desc->dma_ctrl |= DMA_CTRL_SG2_ID(0); -+ desc->dma_ctrl |= DMA_CTRL_IRQ_ID(0); -+ -+ desc->dma_srcaddr_l = src_adr & 0xFFFFFFFF; -+ desc->dma_srcaddr_h = (src_adr >> 32) & 0xFFFFFFFF; -+ desc->dma_destaddr_l = dst_adr & 0xFFFFFFFF; -+ desc->dma_destaddr_h = (dst_adr >> 32) & 0xFFFFFFFF; -+ desc->dma_len = xfer_len; -+ -+ return vchan_tx_prep(&chan->vc, &desc->vd, flags); -+ -+err_desc_get: -+ phytium_desc_put(desc); -+ return NULL; -+} -+ -+static struct dma_async_tx_descriptor *phytium_dma_prep_slave_sg( -+ struct dma_chan *dchan, struct scatterlist *sgl, -+ u32 sg_len, enum dma_transfer_direction direction, -+ unsigned long flags, void *context) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ struct dma_slave_config *sconfig = &chan->dma_sconfig; -+ struct phytium_dma_desc *desc = NULL; -+ struct phytium_chan_desc *chan_desc = NULL; -+ dma_addr_t reg; -+ unsigned int i = 0; -+ struct scatterlist *sg = NULL; -+ size_t total_len = 0; -+ u32 offset = 0; -+ -+ if (unlikely(!is_slave_direction(direction) || !sg_len)) { -+ dev_err(chan2dev(chan), "%s: bad direction\n", __func__); -+ return NULL; -+ } -+ -+ if (atomic_read(&chan->releasing)) { -+ dev_err(chan2dev(chan), "%s: channel is scheduled for release\n", __func__); -+ return NULL; -+ } -+ -+ desc = phytium_desc_get(chan); -+ if (unlikely(!desc)) -+ goto err_desc_get; -+ -+ chan_desc = kzalloc((sg_len + 1) * sizeof(struct phytium_chan_desc), -+ GFP_KERNEL | GFP_DMA); -+ if (unlikely(!chan_desc)) { -+ dev_err(chan->chip->dev, "Malloc space for chan_desc failed\n"); -+ goto err_desc_get; -+ } -+ -+ desc->cdesc = chan_desc; -+ -+ /* Must be aligned on 32-byte boundary */ -+ offset = (u64)chan_desc & 0x1F; -+ if (offset) -+ chan_desc = chan_desc + 32 - offset; -+ -+ for_each_sg(sgl, sg, sg_len, i) { -+ if (!sg) -+ break; -+ -+ if (direction == DMA_MEM_TO_DEV) { -+ chan_desc[i].desc_src_addr_l = sg_dma_address(sg) & 0xFFFFFFFF; -+ chan_desc[i].desc_src_addr_h = (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; -+ } else if (direction == DMA_DEV_TO_MEM) { -+ chan_desc[i].desc_dst_addr_l = sg_dma_address(sg) & 0xFFFFFFFF; -+ chan_desc[i].desc_dst_addr_h = (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; -+ } else { -+ kfree(desc->cdesc); -+ goto err_desc_get; -+ } -+ -+ chan_desc[i].desc_control = 0; -+ chan_desc[i].desc_control |= sg_dma_len(sg) << 8; -+ -+ if (sg_is_last(sg)) { -+ chan_desc[i].desc_next_addr_l = 0x01; -+ chan_desc[i].desc_next_addr_h = 0; -+ chan_desc[i].desc_control |= 0x03 << 4; -+ } else { -+ chan_desc[i].desc_next_addr_l = virt_to_phys(&chan_desc[i+1]) & 0xFFFFFFFF; -+ chan_desc[i].desc_next_addr_l |= 0x01 << 4; -+ chan_desc[i].desc_next_addr_l |= 0x02; -+ chan_desc[i].desc_next_addr_h = -+ (virt_to_phys(&chan_desc[i+1]) >> 32) & 0xFFFFFFFF; -+ } -+ total_len += sg_dma_len(sg); -+ } -+ -+ switch (direction) { -+ case DMA_MEM_TO_DEV: -+ reg = sconfig->dst_addr; -+ -+ desc->dma_srcparam = DMA_SRCP_SRC_ID(0); -+ desc->dma_destparam = DMA_DESTP_DEST_ID(5); -+ desc->dma_ctrl |= DMA_CTRL_SG_TYPE(1); -+ -+ desc->dma_srcaddr_l = virt_to_phys(chan_desc) & 0xFFFFFFFF; -+ desc->dma_srcaddr_h = (virt_to_phys(chan_desc) >> 32) & 0xFFFFFFFF; -+ desc->dma_destaddr_l = sconfig->dst_addr & 0xFFFFFFFF; -+ desc->dma_destaddr_h = (sconfig->dst_addr >> 32) & 0xFFFFFFFF; -+ break; -+ case DMA_DEV_TO_MEM: -+ reg = sconfig->src_addr; -+ -+ /* memcpy from device */ -+ desc->dma_srcparam = DMA_SRCP_SRC_ID(5); -+ desc->dma_destparam = DMA_DESTP_DEST_ID(0); -+ desc->dma_ctrl |= DMA_CTRL_SG_TYPE(2); -+ -+ desc->dma_srcaddr_l = sconfig->src_addr & 0xFFFFFFFF; -+ desc->dma_srcaddr_h = (sconfig->src_addr >> 32) & 0xFFFFFFFF; -+ desc->dma_destaddr_l = virt_to_phys(chan_desc) & 0xFFFFFFFF; -+ desc->dma_destaddr_h = (virt_to_phys(chan_desc) >> 32) & 0xFFFFFFFF; -+ break; -+ default: -+ return NULL; -+ } -+ -+ desc->dma_ctrl |= DMA_CTRL_SG_EN; -+ -+ desc->dma_ctrl |= DMA_CTRL_SG_ID(0); -+ desc->dma_ctrl |= DMA_CTRL_SG2_ID(0); -+ desc->dma_ctrl |= DMA_CTRL_IRQ_ID(0); -+ -+ desc->dma_len = total_len; -+ -+ return vchan_tx_prep(&chan->vc, &desc->vd, flags); -+ -+err_desc_get: -+ dev_err(chan2dev(chan), -+ "not enough descriptors available. Direction %d\n", direction); -+ phytium_desc_put(desc); -+ return NULL; -+} -+ -+static void phytium_chan_block_xfer_complete_msi(struct phytium_dma_chan *chan) -+{ -+ struct virt_dma_desc *vd = NULL; -+ struct phytium_dma_desc *desc = NULL; -+ -+ chan->is_idle = true; -+ if (phytium_chan_is_running(chan)) { -+ dev_err(chan2dev(chan), "DMA %s is not idle!\n", -+ phytium_chan_name(chan)); -+ phytium_chan_disable(chan); -+ } -+ -+ /* The completed descriptor currently is in the head of vc list */ -+ vd = vchan_next_desc(&chan->vc); -+ if (!vd) { -+ dev_err(chan2dev(chan), "complete vchan next desc failed\n"); -+ return; -+ } -+ -+ desc = vd_to_desc(vd); -+ if (!desc) { -+ dev_err(chan2dev(chan), "vd to desc failed\n"); -+ return; -+ } -+ -+ if (desc->cdesc) -+ kfree(desc->cdesc); -+ -+ /* Remove the completed descriptor from issued list before completing */ -+ list_del(&vd->node); -+ vchan_cookie_complete(vd); -+ -+ /* Submit queued descriptors after processing the completed ones */ -+ phytium_chan_start_first_queued(chan); -+} -+ -+static void phytium_chan_block_xfer_complete_intx(struct phytium_dma_chan *chan) -+{ -+ struct virt_dma_desc *vd = NULL; -+ struct phytium_dma_desc *desc = NULL; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&chan->vc.lock, flags); -+ chan->is_idle = true; -+ if (phytium_chan_is_running(chan)) { -+ dev_err(chan2dev(chan), "DMA %s is not idle!\n", -+ phytium_chan_name(chan)); -+ phytium_chan_disable(chan); -+ } -+ -+ /* The completed descriptor currently is in the head of vc list */ -+ vd = vchan_next_desc(&chan->vc); -+ if (!vd) { -+ dev_err(chan2dev(chan), "complete vchan next desc failed\n"); -+ return; -+ } -+ -+ desc = vd_to_desc(vd); -+ if (!desc) { -+ dev_err(chan2dev(chan), "vd to desc failed\n"); -+ return; -+ } -+ -+ if (desc->cdesc) -+ kfree(desc->cdesc); -+ -+ /* Remove the completed descriptor from issued list before completing */ -+ list_del(&vd->node); -+ vchan_cookie_complete(vd); -+ -+ /* Submit queued descriptors after processing the completed ones */ -+ phytium_chan_start_first_queued(chan); -+ spin_unlock_irqrestore(&chan->vc.lock, flags); -+} -+ -+static irqreturn_t phytium_dma_interrupt_msi(int irq, void *dev_id) -+{ -+ unsigned long flags; -+ struct phytium_dma_chan *chan = dev_id; -+ struct phytium_dma_chip *chip = chan->chip; -+ -+ u32 irq_status; -+ u32 irq_mask = 0xffff; -+ u32 chan_status; -+ u32 mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; -+ -+ spin_lock_irqsave(&chan->vc.lock, flags); -+ -+ chan_status = phytium_chan_status_read(chan); -+ irq_status = phytium_dma_irq_read(chip); -+ -+ if (!(irq_status & irq_mask)) { -+ dev_err(chan2dev(chan), "irq_status = 0x%x, irq_mask = 0x%x, chan_status = 0x%x", -+ irq_status, irq_mask, chan_status); -+ if ((chan_status & DMA_STAT_END) | (chan_status & DMA_STAT_EOP) | -+ (chan_status & DMA_STAT_EOC) | -+ (chan_status & DMA_STAT_ERR)) { -+ irq_status = phytium_dma_irq_read(chip); -+ goto next; -+ } else { -+ return IRQ_NONE; -+ } -+ } -+ -+next: -+ /* Disable DMAC inerrupts. We'll enable them after processing chanels */ -+ phytium_dma_irq_disable(chip); -+ phytium_chan_irq_disable(chan, mask); -+ phytium_chan_irq_clear(chan, mask); -+ phytium_dma_irq_clear(chip, irq_status); -+ -+ if ((chan_status & DMA_STAT_ERR)) { -+ dev_err(chan2dev(chan), "chan handle err, chan status is %x\n", -+ chan_status); -+ } else if ((chan_status & DMA_STAT_END) | (chan_status & DMA_STAT_EOP) | -+ (chan_status & DMA_STAT_EOC)) { -+ phytium_chan_block_xfer_complete_msi(chan); -+ } else { -+ dev_err(chan2dev(chan), "irq_status = 0x%x, ----unknown reason:%x\n", -+ irq_status, chan_status); -+ } -+ -+ /* Re-enable interrupts */ -+ phytium_dma_irq_enable(chip); -+ -+ spin_unlock_irqrestore(&chan->vc.lock, flags); -+ -+ return IRQ_HANDLED; -+} -+ -+static irqreturn_t phytium_dma_interrupt_intx(int irq, void *dev_id) -+{ -+ struct phytium_dma_chip *chip = dev_id; -+ struct phytium_dma *dmac = chip->dmac; -+ struct phytium_dma_chan *chan; -+ u32 irq_status = 0; -+ u32 irq_mask = 0; -+ u32 chan_status = 0; -+ u32 mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; -+ u32 i; -+ -+ irq_status = phytium_dma_irq_read(chip); -+ irq_status = irq_status & 0xffff; -+ irq_mask = phytium_dma_irq_mask_read(chip); -+ -+ if (!(irq_status & irq_mask)) -+ return IRQ_NONE; -+ -+ /* Disable DMAC inerrupts. We'll enable them after processing chanels */ -+ phytium_dma_irq_disable(chip); -+ phytium_dma_irq_clear(chip, irq_status); -+ -+ /* Poll, clear and process every chanel interrupt status */ -+ for (i = 0; i < chip->hdata->nr_channels; i++) { -+ if (!(irq_status & BIT(i)) && !(irq_status & BIT(i + 8))) -+ continue; -+ -+ chan = &dmac->chan[i]; -+ -+ chan_status = phytium_chan_status_read(chan); -+ -+ phytium_chan_irq_disable(chan, mask); -+ if ((chan_status & DMA_STAT_ERR)) -+ dev_err(chan2dev(chan), "chan handle err, chan status is %x\n", -+ chan_status); -+ else if ((chan_status & DMA_STAT_END) | (chan_status & DMA_STAT_EOP) | -+ (chan_status & DMA_STAT_EOC)) -+ phytium_chan_block_xfer_complete_intx(chan); -+ else -+ dev_err(chan2dev(chan), "irq_status = 0x%x, ----unknown reason:%x\n", -+ irq_status, chan_status); -+ -+ phytium_chan_irq_set(chan, mask); -+ } -+ -+ /* Re-enable interrupts */ -+ phytium_dma_irq_enable(chip); -+ -+ return IRQ_HANDLED; -+} -+ -+struct phytium_dma_hcfg phytium_octopus_dma_hdata = { -+ .nr_channels = 4, -+ .nr_masters = 1, -+ .m_data_width = DMA_SLAVE_BUSWIDTH_4_BYTES, -+ .block_size[0] = 0x2000000, -+ .block_size[1] = 0x2000000, -+ .priority[0] = 0, -+ .priority[1] = 1, -+ .axi_rw_burst_len = 0, -+ .restrict_axi_burst_len = false, -+}; -+ -+static int phytium_dma_probe(struct phytium_dma_chip *chip) -+{ -+ struct phytium_dma_chan *chan; -+ struct pci_dev *pdev = chip->pdev; -+ struct phytium_dma *dmac; -+ struct phytium_dma_hcfg *hdata; -+ u32 i; -+ int ret = -1; -+ -+ chip->dev = &pdev->dev; -+ dmac = devm_kzalloc(chip->dev, sizeof(*dmac), GFP_KERNEL); -+ if (!dmac) { -+ dev_err(chip->dev, "dmac zalloc failed\n"); -+ return -ENOMEM; -+ } -+ -+ hdata = devm_kzalloc(chip->dev, sizeof(*hdata), GFP_KERNEL); -+ if (!hdata) { -+ dev_err(chip->dev, "hdata zalloc failed\n"); -+ return -ENOMEM; -+ } -+ -+ hdata->nr_channels = 4; -+ memcpy(hdata, &phytium_octopus_dma_hdata, sizeof(phytium_octopus_dma_hdata)); -+ -+ chip->dmac = dmac; -+ chip->hdata = hdata; -+ -+ dmac->chan = devm_kcalloc(chip->dev, hdata->nr_channels, -+ sizeof(*dmac->chan), GFP_KERNEL); -+ if (!dmac->chan) { -+ dev_err(chip->dev, "hdata zalloc failed\n"); -+ return -ENOMEM; -+ } -+ -+ /* Set capabilities */ -+ dma_cap_set(DMA_MEMCPY, dmac->dma.cap_mask); -+ dma_cap_set(DMA_SLAVE, dmac->dma.cap_mask); -+ dma_cap_set(DMA_PRIVATE, dmac->dma.cap_mask); -+ -+ /* DMA capabilities */ -+ dmac->dma.chancnt = hdata->nr_channels; -+ dmac->dma.src_addr_widths = DMA_SLAVE_BUSWIDTH_4_BYTES; -+ dmac->dma.dst_addr_widths = DMA_SLAVE_BUSWIDTH_4_BYTES; -+ dmac->dma.directions = BIT(DMA_MEM_TO_MEM) | BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV) ; -+ dmac->dma.residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; -+ -+ dmac->dma.dev = chip->dev; -+ dmac->dma.device_tx_status = phytium_dma_tx_status; -+ dmac->dma.device_issue_pending = phytium_dma_issue_pending; -+ dmac->dma.device_terminate_all = phytium_dma_terminate_all; -+ dmac->dma.device_synchronize = phytium_dma_synchronize; -+ -+ dmac->dma.device_alloc_chan_resources = phytium_dma_alloc_chan_resources; -+ dmac->dma.device_free_chan_resources = phytium_dma_free_chan_resources; -+ -+ dmac->dma.device_prep_dma_memcpy = phytium_dma_prep_dma_memcpy; -+ dmac->dma.device_config = phytium_dma_slave_config; -+ dmac->dma.device_prep_slave_sg = phytium_dma_prep_slave_sg; -+ -+ -+ INIT_LIST_HEAD(&dmac->dma.channels); -+ for (i = 0; i < chip->hdata->nr_channels; i++) { -+ chan = &dmac->chan[i]; -+ chan->chip = chip; -+ chan->id = i; -+ chan->chan_regs = chip->regs + i * CHAN_REG_LEN; -+ chan->is_used = false; -+ chan->is_idle = true; -+ chan->is_paused = false; -+ -+ chan->vc.desc_free = phytium_vchan_desc_put; -+ vchan_init(&chan->vc, &dmac->dma); -+ } -+ -+ /* ----lt add begin--- */ -+ dmac->dma.filter.map = ft_px210gpu_slave_map; -+ dmac->dma.filter.mapcnt = ARRAY_SIZE(ft_px210gpu_slave_map); -+ dmac->dma.filter.fn = px210_filter_fn; -+ /*----lt add end----*/ -+ -+ phytium_dma_hw_init(chip); -+ -+ ret = dma_async_device_register(&dmac->dma); -+ if (ret) -+ goto err_pm_disable; -+ -+ ret = pci_alloc_irq_vectors(pdev, 4, 4, PCI_IRQ_MSI); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "fialed to allocate MSI entry"); -+ goto intx; -+ } -+ -+ for (i = 0; i < chip->hdata->nr_channels; i++) { -+ chan = &dmac->chan[i]; -+ chan->irq = pci_irq_vector(pdev, i); -+ dev_err(&pdev->dev, "desc->irq = 0x%x", chan->irq); -+ -+ ret = devm_request_irq(&pdev->dev, chan->irq, phytium_dma_interrupt_msi, 0, dev_name(chan2dev(chan)), chan); -+ if (ret) { -+ dev_err(&pdev->dev, "request irq faild %d channal with err %d", i, ret); -+ goto intx; -+ } -+ } -+ goto irq_done; -+ -+intx: -+ chip->irq = pdev->irq; -+ ret = devm_request_irq(chip->dev, chip->irq, phytium_dma_interrupt_intx, -+ IRQF_SHARED, dev_name(chip->dev), chip); -+ if (ret) { -+ dev_err(&pdev->dev, "no interrupt used\n"); -+ return ret; -+ } -+ -+irq_done: -+ return 0; -+ -+err_pm_disable: -+ pm_runtime_disable(chip->dev); -+ -+ return ret; -+} -+ -+static int phytium_dma_remove(struct phytium_dma_chip *chip) -+{ -+ struct phytium_dma *dmac = chip->dmac; -+ struct phytium_dma_chan *chan, *_chan; -+ -+ list_for_each_entry_safe(chan, _chan, &dmac->dma.channels, -+ vc.chan.device_node) { -+ list_del(&chan->vc.chan.device_node); -+ tasklet_kill(&chan->vc.task); -+ } -+ -+ dma_async_device_unregister(&dmac->dma); -+ -+ return 0; -+} -+ -+static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) -+{ -+ struct phytium_dma_chip *chip; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ ret = pcim_iomap_regions(pdev, 1 << 0, pci_name(pdev)); -+ if (ret) { -+ dev_err(&pdev->dev, "I/O memory remapping failed\n"); -+ return ret; -+ } -+ -+ pci_set_master(pdev); -+ pci_try_set_mwi(pdev); -+ -+ ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); -+ if (ret) -+ return ret; -+ -+ ret = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); -+ if (ret) -+ return ret; -+ -+ chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); -+ if (!chip) -+ return -ENOMEM; -+ -+ chip->pdev = pdev; -+ chip->dev = &pdev->dev; -+ chip->id = pdev->devfn; -+ chip->regs = pcim_iomap_table(pdev)[0] + COMMON_REG_LEN; -+ -+ ret = phytium_dma_probe(chip); -+ if (ret) -+ return ret; -+ -+ pci_set_drvdata(pdev, chip); -+ -+ dev_dbg(&pdev->dev, "Phytium dma device at 0x%p 0x%llx\n", -+ chip->regs, pdev->resource[0].start); -+ return 0; -+} -+ -+static void phytium_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_dma_chip *chip = pci_get_drvdata(pdev); -+ int ret; -+ -+ ret = phytium_dma_remove(chip); -+ if (ret) -+ dev_warn(&pdev->dev, "can't remove device properly: %d\n", ret); -+} -+ -+static const struct pci_device_id phytium_pci_id_table[] = { -+ { -+ vendor: 0x1DB7, -+ device : 0xDC3C, -+ subvendor : PCI_ANY_ID, -+ subdevice : PCI_ANY_ID, -+ class : 0, -+ class_mask : 0, -+ driver_data : (kernel_ulong_t)&phytium_octopus_dma_hdata, -+ }, -+ { } -+}; -+MODULE_DEVICE_TABLE(pci, phytium_pci_id_table); -+#ifdef CONFIG_PM_SLEEP -+ -+static int phytium_pci_prepare(struct device *dev) -+{ -+ u32 i; -+ struct pci_dev *pci = to_pci_dev(dev); -+ struct phytium_dma_chip *chip = pci_get_drvdata(pci); -+ struct phytium_dma_chan *chan; -+ -+ phytium_dma_hw_init(chip); -+ -+ for (i = 0; i < chip->hdata->nr_channels; i++) { -+ chan = &chip->dmac->chan[i]; -+ if (phytium_chan_is_running(chan)) { -+ dev_err(chan2dev(chan), "DMA driver would suspend," -+ "DMA client need to wait data transfer done!\n"); -+ return -1; -+ } -+ -+ } -+ return 0; -+}; -+ -+static int phytium_pci_suspend_late(struct device *dev) -+{ -+ struct pci_dev *pci = to_pci_dev(dev); -+ struct phytium_dma_chip *chip = pci_get_drvdata(pci); -+ -+ phytium_dma_hw_init(chip); -+ return 0; -+}; -+ -+static int phytium_pci_resume_early(struct device *dev) -+{ -+ struct pci_dev *pci = to_pci_dev(dev); -+ struct phytium_dma_chip *chip = pci_get_drvdata(pci); -+ -+ phytium_dma_hw_init(chip); -+ return 0; -+}; -+ -+#endif -+ -+static const struct dev_pm_ops phytium_pci_dev_pm_ops = { -+ .prepare = phytium_pci_prepare, -+ SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_pci_suspend_late, -+ phytium_pci_resume_early) -+}; -+ -+static struct pci_driver phytium_pci_driver = { -+ .name = "phytium_dmac_pci", -+ .id_table = phytium_pci_id_table, -+ .probe = phytium_pci_probe, -+ .remove = phytium_pci_remove, -+ .driver = { -+ .pm = &phytium_pci_dev_pm_ops, -+ }, -+}; -+ -+bool px210_filter_fn(struct dma_chan *chan, void *param) -+{ -+ if (chan->device->dev->driver != &phytium_pci_driver.driver) -+ return false; -+ -+ return true; -+} -+ -+module_pci_driver(phytium_pci_driver); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium DMA Controller platform driver"); -+MODULE_AUTHOR("Zhu mingshuai "); -+MODULE_AUTHOR("Li Wenxiang "); -diff --git a/drivers/dma/phytium/phytium-dmac-pci.h b/drivers/dma/phytium/phytium-dmac-pci.h -new file mode 100644 -index 000000000..68c9045df ---- /dev/null -+++ b/drivers/dma/phytium/phytium-dmac-pci.h -@@ -0,0 +1,186 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Synopsys DesignWare AXI DMA Controller driver. -+ * -+ * 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. -+ */ -+ -+#ifndef _AXI_DMA_PLATFORM_H -+#define _AXI_DMA_PLATFORM_H -+ -+#include -+#include -+#include -+#include -+#include -+ -+#include "../virt-dma.h" -+ -+#define DMAC_MAX_CHANNELS 4 -+#define DMAC_MAX_MASTERS 1 -+#define DMAC_MAX_BLK_SIZE (1024 * 1024 * 2) -+ -+struct phytium_dma_hcfg { -+ u32 nr_channels; -+ u32 nr_masters; -+ u32 m_data_width; -+ u32 block_size[DMAC_MAX_CHANNELS]; -+ u32 priority[DMAC_MAX_CHANNELS]; -+ /* maximum supported axi burst length */ -+ u32 axi_rw_burst_len; -+ bool restrict_axi_burst_len; -+}; -+ -+struct phytium_dma_chan { -+ struct phytium_dma_chip *chip; -+ void __iomem *chan_regs; -+ u8 id; -+ unsigned int irq; -+ atomic_t descs_allocated; -+ atomic_t releasing; -+ -+ struct virt_dma_chan vc; -+ -+ struct dma_slave_config dma_sconfig; -+ -+ bool is_used; -+ bool is_idle; -+ /* these other elements are all protected by vc.lock */ -+ bool is_paused; -+}; -+ -+struct phytium_dma { -+ struct dma_device dma; -+ //const struct phytium_dma_hcfg *hdata; -+ -+ /* channels */ -+ struct phytium_dma_chan *chan; -+}; -+ -+struct phytium_dma_chip { -+ struct pci_dev *pdev; -+ struct device *dev; -+ void __iomem *regs; -+ struct clk *core_clk; -+ struct phytium_dma *dmac; -+ -+ int irq; -+ int id; -+ struct completion complete; -+ -+ const struct phytium_dma_hcfg *hdata; -+ struct phytium_dma_chan chan[4]; -+}; -+ -+struct phytium_chan_desc { -+ u32 desc_status; -+ u32 desc_control; -+ u32 desc_next_addr_l; -+ u32 desc_next_addr_h; -+ u32 desc_src_addr_l; -+ u32 desc_src_addr_h; -+ u32 desc_dst_addr_l; -+ u32 desc_dst_addr_h; -+} __attribute__ ((__packed__)); -+ -+struct phytium_dma_desc { -+ struct virt_dma_desc vd; -+ struct phytium_dma_chan *chan; -+ struct list_head xfer_list; -+ struct dma_async_tx_descriptor *txd; -+ struct phytium_chan_desc *cdesc; -+ struct scatterlist *end_sg; -+ u32 dma_srcparam; -+ u32 dma_destparam; -+ u32 dma_srcaddr_l; -+ u32 dma_srcaddr_h; -+ u32 dma_destaddr_l; -+ u32 dma_destaddr_h; -+ u32 dma_len; -+ u32 dma_ctrl; -+ u32 sg_len; -+}; -+ -+static inline struct device *dchan2dev(struct dma_chan *dchan) -+{ -+ return &dchan->dev->device; -+} -+ -+static inline struct device *chan2dev(struct phytium_dma_chan *chan) -+{ -+ return &chan->vc.chan.dev->device; -+} -+ -+static inline struct phytium_dma_desc *vd_to_desc(struct virt_dma_desc *vd) -+{ -+ return container_of(vd, struct phytium_dma_desc, vd); -+} -+ -+static inline struct phytium_dma_chan *vc_to_dma_chan(struct virt_dma_chan *vc) -+{ -+ return container_of(vc, struct phytium_dma_chan, vc); -+} -+ -+static inline struct phytium_dma_chan *dchan_to_dma_chan(struct dma_chan *dchan) -+{ -+ return vc_to_dma_chan(to_virt_chan(dchan)); -+} -+ -+#define TX_SG_LEN (1024 * 32) -+#define PAGE_SIZE2 (PAGE_SIZE << 1) -+ -+#define COMMON_REG_LEN 0 -+#define CHAN_REG_LEN 0x40 -+ -+#define DMA_IRQ_MASK 0x180 -+#define DMA_IRQ_STATUS 0x184 -+#define DMA_SRCPARAM 0x400 -+#define DMA_DESTPARAM 0x404 -+#define DMA_SRCADDR_L 0x408 -+#define DMA_SRCADDR_H 0x40C -+#define DMA_DESTADDR_L 0x410 -+#define DMA_DESTADDR_H 0x414 -+#define DMA_LENGTH 0x418 -+#define DMA_CONTROL 0x41C -+#define DMA_STATUS 0x420 -+#define DMA_PRC_LEN 0x424 -+#define DMA_SHARE_ACCESS 0x428 -+ -+#define DMA_SRCP_SRC_ID(x) min_t(unsigned int, x, 0xF) -+#define DMA_SRCP_TRSF_PARAM(x) (min_t(unsigned int, x, 0xFFF) << 16) -+#define DMA_DESTP_DEST_ID(x) min_t(unsigned int, x, 0xF) -+#define DMA_DESTP_TRSF_PARAM(x) (min_t(unsigned int, x, 0xFFF) << 16) -+#define DMA_CTRL_START BIT(0) -+#define DMA_CTRL_PAUSE BIT(1) -+#define DMA_CTRL_SG_EN BIT(3) -+#define DMA_CTRL_COND_LEN BIT(5) -+#define DMA_CTRL_COND_EOP BIT(6) -+#define DMA_CTRL_COND_ERR BIT(7) -+#define DMA_CTRL_COND_MASK(x) (min_t(unsigned int, x, 0xF) << 4) -+#define DMA_CTRL_IRQ_END BIT(8) -+#define DMA_CTRL_IRQ_ERR BIT(9) -+#define DMA_CTRL_IRQ_EOP BIT(10) -+#define DMA_CTRL_IRQ_MASK(x) (min_t(unsigned int, x, 0xF) << 8) -+#define DMA_CTRL_IRQ_ID(x) (min_t(unsigned int, x, 0x3) << 12) -+#define DMA_CTRL_DESC_UPDT BIT(23) -+#define DMA_CTRL_SG_TYPE(x) (min_t(unsigned int, x, 0x3) << 24) -+#define DMA_CTRL_SG_ID(x) (min_t(unsigned int, x, 0x5) << 26) -+#define DMA_CTRL_SG2_ID(x) (min_t(unsigned int, x, 0x5) << 29) -+#define DMA_STAT_MASK(x) (min_t(unsigned int, x, 0xFF) << 0) -+#define DMA_STAT_END BIT(0) -+#define DMA_STAT_EOP BIT(1) -+#define DMA_STAT_EOC BIT(2) -+#define DMA_STAT_ERR BIT(3) -+#define DMA_STAT_OVER BIT(4) -+#define DMA_STAT_STOP BIT(6) -+#define DMA_STAT_INCORRECT BIT(7) -+#define DMA_SRC_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 8) -+#define DMA_DEST_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 16) -+#define DMA_DESC_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 24) -+ -+#define DMA_TIMEOUT 200 -+ -+#endif /* _AXI_DMA_PLATFORM_H */ -diff --git a/drivers/firmware/Kconfig b/drivers/firmware/Kconfig -index 807c5320d..91e8a70fc 100644 ---- a/drivers/firmware/Kconfig -+++ b/drivers/firmware/Kconfig -@@ -27,6 +27,18 @@ config ARM_SCMI_PROTOCOL - This protocol library provides interface for all the client drivers - making use of the features offered by the SCMI. - -+if ARM_SCMI_PROTOCOL -+config ARM_SCMI_TRANSPORT_FORCE_POLLING -+ bool "Support force polling mode for SCMI Mailbox" -+ help -+ Support force polling mode for SCMI Mailbox transports. -+ -+ If you want to configure SCMI Mailbox transport to use polling mode -+ on the TX path and do not use any completion IRQ facility even when -+ available through kernel parameter, answer Y. If unsure, say N. -+ -+endif #ARM_SCMI_PROTOCOL -+ - config ARM_SCMI_POWER_DOMAIN - tristate "SCMI power domain driver" - depends on ARM_SCMI_PROTOCOL || (COMPILE_TEST && OF) -diff --git a/drivers/firmware/arm_scmi/driver.c b/drivers/firmware/arm_scmi/driver.c -index 8d2408284..e79580579 100644 ---- a/drivers/firmware/arm_scmi/driver.c -+++ b/drivers/firmware/arm_scmi/driver.c -@@ -98,6 +98,10 @@ struct scmi_info { - int users; - }; - -+#ifdef CONFIG_ARM_SCMI_TRANSPORT_FORCE_POLLING -+static bool scmi_force_polling; -+#endif -+ - #define handle_to_scmi_info(h) container_of(h, struct scmi_info, handle) - - static const int scmi_linux_errmap[] = { -@@ -344,6 +348,15 @@ static bool scmi_xfer_done_no_timeout(struct scmi_chan_info *cinfo, - ktime_after(ktime_get(), stop); - } - -+ -+#ifdef CONFIG_ARM_SCMI_TRANSPORT_FORCE_POLLING -+static int __init scmi_set_force_polling(char *str) -+{ -+ return kstrtobool(str, &scmi_force_polling); -+} -+early_param("scmi.force_polling", scmi_set_force_polling); -+#endif -+ - /** - * scmi_do_xfer() - Do one transfer - * -@@ -366,6 +379,11 @@ int scmi_do_xfer(const struct scmi_handle *handle, struct scmi_xfer *xfer) - if (unlikely(!cinfo)) - return -EINVAL; - -+#ifdef CONFIG_ARM_SCMI_TRANSPORT_FORCE_POLLING -+ if (scmi_force_polling) -+ xfer->hdr.poll_completion = true; -+#endif -+ - trace_scmi_xfer_begin(xfer->transfer_id, xfer->hdr.id, - xfer->hdr.protocol_id, xfer->hdr.seq, - xfer->hdr.poll_completion); -diff --git a/drivers/firmware/arm_scmi/shmem.c b/drivers/firmware/arm_scmi/shmem.c -index 56a1f61aa..2d734faf8 100644 ---- a/drivers/firmware/arm_scmi/shmem.c -+++ b/drivers/firmware/arm_scmi/shmem.c -@@ -32,6 +32,14 @@ struct scmi_shared_mem { - void shmem_tx_prepare(struct scmi_shared_mem __iomem *shmem, - struct scmi_xfer *xfer) - { -+#ifdef CONFIG_ARCH_PHYTIUM -+ /* callee not set cahnnel free when init, caller set it */ -+ static int is_init = 0; -+ if(unlikely(is_init == 0)) { -+ iowrite32(0x1, &shmem->channel_status); -+ is_init = 1; -+ } -+#endif - /* - * Ideally channel must be free by now unless OS timeout last - * request and platform continued to process the same, wait -diff --git a/drivers/gpio/Kconfig b/drivers/gpio/Kconfig -index 39f3e1366..7c93abd3f 100644 ---- a/drivers/gpio/Kconfig -+++ b/drivers/gpio/Kconfig -@@ -108,6 +108,10 @@ config GPIO_REGMAP - config GPIO_MAX730X - tristate - -+# This symbol is selected by both MMIO and PCI expanders -+config GPIO_PHYTIUM_CORE -+ tristate -+ - menu "Memory mapped GPIO drivers" - depends on HAS_IOMEM - -@@ -739,6 +743,27 @@ config GPIO_AMD_FCH - Note: This driver doesn't registers itself automatically, as it - needs to be provided with platform specific configuration. - (See eg. CONFIG_PCENGINES_APU2.) -+ -+config GPIO_PHYTIUM_PLAT -+ tristate "Phytium GPIO Platform support" -+ default y if ARCH_PHYTIUM -+ depends on ARM64 -+ select GPIO_PHYTIUM_CORE -+ select IRQ_DOMAIN -+ select GENERIC_IRQ_CHIP -+ select GPIOLIB_IRQCHIP -+ help -+ Say yes here to enable GPIO support for Phytium SoCs. -+ -+config GPIO_PHYTIUM_SGPIO -+ tristate "Phytium SGPIO support" -+ default y if ARCH_PHYTIUM -+ depends on ARM64 -+ select IRQ_DOMAIN -+ select GENERIC_IRQ_CHIP -+ help -+ Say yes here to enable SGPIO support for Phytium SoCs. -+ - endmenu - - menu "Port-mapped I/O GPIO drivers" -@@ -1520,6 +1545,20 @@ config GPIO_SODAVILLE - help - Say Y here to support Intel Sodaville GPIO. - -+ -+config GPIO_PHYTIUM_PCI -+ tristate "Phytium GPIO PCI support" -+ select GPIO_PHYTIUM_CORE -+ select IRQ_DOMAIN -+ select GENERIC_IRQ_CHIP -+ select GPIOLIB_IRQCHIP -+ help -+ Say Y here to support Phytium PCI GPIO controller on px210 chipset. -+ An interrupt is generated when any of the inputs change state -+ (low to high or high to low). -+ -+ This driver can be used for Phytium px210. -+ - endmenu - - menu "SPI GPIO expanders" -diff --git a/drivers/gpio/Makefile b/drivers/gpio/Makefile -index 09dada80a..67dea5151 100644 ---- a/drivers/gpio/Makefile -+++ b/drivers/gpio/Makefile -@@ -180,3 +180,8 @@ obj-$(CONFIG_GPIO_XTENSA) += gpio-xtensa.o - obj-$(CONFIG_GPIO_ZEVIO) += gpio-zevio.o - obj-$(CONFIG_GPIO_ZX) += gpio-zx.o - obj-$(CONFIG_GPIO_ZYNQ) += gpio-zynq.o -+ -+obj-$(CONFIG_GPIO_PHYTIUM_CORE) += gpio-phytium-core.o -+obj-$(CONFIG_GPIO_PHYTIUM_PCI) += gpio-phytium-pci.o -+obj-$(CONFIG_GPIO_PHYTIUM_PLAT) += gpio-phytium-platform.o -+obj-$(CONFIG_GPIO_PHYTIUM_SGPIO) += gpio-phytium-sgpio.o -diff --git a/drivers/gpio/gpio-phytium-core.c b/drivers/gpio/gpio-phytium-core.c -new file mode 100644 -index 000000000..a1794f55a ---- /dev/null -+++ b/drivers/gpio/gpio-phytium-core.c -@@ -0,0 +1,363 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+ -+#include "gpio-phytium-core.h" -+ -+static int get_pin_location(struct phytium_gpio *gpio, unsigned int offset, -+ struct pin_loc *pl) -+{ -+ int ret; -+ -+ if (offset < gpio->ngpio[0]) { -+ pl->port = 0; -+ pl->offset = offset; -+ ret = 0; -+ } else if (offset < (gpio->ngpio[0] + gpio->ngpio[1])) { -+ pl->port = 1; -+ pl->offset = offset - gpio->ngpio[0]; -+ ret = 0; -+ } else { -+ ret = -EINVAL; -+ } -+ -+ return ret; -+} -+ -+static void phytium_gpio_toggle_trigger(struct phytium_gpio *gpio, -+ unsigned int offset) -+{ -+ struct gpio_chip *gc; -+ u32 pol; -+ int val; -+ -+ /* Only port A can provide interrupt source */ -+ if (offset >= gpio->ngpio[0]) -+ return; -+ -+ gc = &gpio->gc; -+ -+ pol = readl(gpio->regs + GPIO_INT_POLARITY); -+ /* Just read the current value right out of the data register */ -+ val = gc->get(gc, offset); -+ if (val) -+ pol &= ~BIT(offset); -+ else -+ pol |= BIT(offset); -+ -+ writel(pol, gpio->regs + GPIO_INT_POLARITY); -+} -+ -+int phytium_gpio_get(struct gpio_chip *gc, unsigned int offset) -+{ -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct pin_loc loc; -+ void __iomem *dat; -+ -+ if (get_pin_location(gpio, offset, &loc)) -+ return -EINVAL; -+ -+ dat = gpio->regs + GPIO_EXT_PORTA + (loc.port * GPIO_PORT_STRIDE); -+ -+ return !!(readl(dat) & BIT(loc.offset)); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_get); -+ -+void phytium_gpio_set(struct gpio_chip *gc, unsigned int offset, int value) -+{ -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct pin_loc loc; -+ void __iomem *dr; -+ unsigned long flags; -+ u32 mask; -+ -+ if (get_pin_location(gpio, offset, &loc)) -+ return; -+ dr = gpio->regs + GPIO_SWPORTA_DR + (loc.port * GPIO_PORT_STRIDE); -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ if (value) -+ mask = readl(dr) | BIT(loc.offset); -+ else -+ mask = readl(dr) & ~BIT(loc.offset); -+ -+ writel(mask, dr); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_set); -+ -+int phytium_gpio_direction_input(struct gpio_chip *gc, unsigned int offset) -+{ -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct pin_loc loc; -+ unsigned long flags; -+ void __iomem *ddr; -+ -+ if (get_pin_location(gpio, offset, &loc)) -+ return -EINVAL; -+ ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ writel(readl(ddr) & ~(BIT(loc.offset)), ddr); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_direction_input); -+ -+int phytium_gpio_direction_output(struct gpio_chip *gc, unsigned int offset, -+ int value) -+{ -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct pin_loc loc; -+ unsigned long flags; -+ void __iomem *ddr; -+ -+ if (get_pin_location(gpio, offset, &loc)) -+ return -EINVAL; -+ ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ writel(readl(ddr) | BIT(loc.offset), ddr); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ phytium_gpio_set(gc, offset, value); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_direction_output); -+ -+void phytium_gpio_irq_ack(struct irq_data *d) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ u32 val = BIT(irqd_to_hwirq(d)); -+ -+ raw_spin_lock(&gpio->lock); -+ -+ writel(val, gpio->regs + GPIO_PORTA_EOI); -+ -+ raw_spin_unlock(&gpio->lock); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_ack); -+ -+void phytium_gpio_irq_mask(struct irq_data *d) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ u32 val; -+ -+ /* Only port A can provide interrupt source */ -+ if (irqd_to_hwirq(d) >= gpio->ngpio[0]) -+ return; -+ -+ raw_spin_lock(&gpio->lock); -+ -+ val = readl(gpio->regs + GPIO_INTMASK); -+ val |= BIT(irqd_to_hwirq(d)); -+ writel(val, gpio->regs + GPIO_INTMASK); -+ -+ raw_spin_unlock(&gpio->lock); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_mask); -+ -+void phytium_gpio_irq_unmask(struct irq_data *d) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ u32 val; -+ -+ /* Only port A can provide interrupt source */ -+ if (irqd_to_hwirq(d) >= gpio->ngpio[0]) -+ return; -+ -+ raw_spin_lock(&gpio->lock); -+ -+ val = readl(gpio->regs + GPIO_INTMASK); -+ val &= ~BIT(irqd_to_hwirq(d)); -+ writel(val, gpio->regs + GPIO_INTMASK); -+ -+ raw_spin_unlock(&gpio->lock); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_unmask); -+ -+int phytium_gpio_irq_set_type(struct irq_data *d, unsigned int flow_type) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ int hwirq = irqd_to_hwirq(d); -+ unsigned long flags, lvl, pol; -+ -+ if (hwirq < 0 || hwirq >= gpio->ngpio[0]) -+ return -EINVAL; -+ -+ if ((flow_type & (IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW)) && -+ (flow_type & (IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING))) { -+ dev_err(gc->parent, -+ "trying to configure line %d for both level and edge detection, choose one!\n", -+ hwirq); -+ return -EINVAL; -+ } -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ lvl = readl(gpio->regs + GPIO_INTTYPE_LEVEL); -+ pol = readl(gpio->regs + GPIO_INT_POLARITY); -+ -+ switch (flow_type) { -+ case IRQ_TYPE_EDGE_BOTH: -+ lvl |= BIT(hwirq); -+ phytium_gpio_toggle_trigger(gpio, hwirq); -+ irq_set_handler_locked(d, handle_edge_irq); -+ dev_dbg(gc->parent, "line %d: IRQ on both edges\n", hwirq); -+ break; -+ case IRQ_TYPE_EDGE_RISING: -+ lvl |= BIT(hwirq); -+ pol |= BIT(hwirq); -+ irq_set_handler_locked(d, handle_edge_irq); -+ dev_dbg(gc->parent, "line %d: IRQ on RISING edge\n", hwirq); -+ break; -+ case IRQ_TYPE_EDGE_FALLING: -+ lvl |= BIT(hwirq); -+ pol &= ~BIT(hwirq); -+ irq_set_handler_locked(d, handle_edge_irq); -+ dev_dbg(gc->parent, "line %d: IRQ on FALLING edge\n", hwirq); -+ break; -+ case IRQ_TYPE_LEVEL_HIGH: -+ lvl &= ~BIT(hwirq); -+ pol |= BIT(hwirq); -+ irq_set_handler_locked(d, handle_level_irq); -+ dev_dbg(gc->parent, "line %d: IRQ on HIGH level\n", hwirq); -+ break; -+ case IRQ_TYPE_LEVEL_LOW: -+ lvl &= ~BIT(hwirq); -+ pol &= ~BIT(hwirq); -+ irq_set_handler_locked(d, handle_level_irq); -+ dev_dbg(gc->parent, "line %d: IRQ on LOW level\n", hwirq); -+ break; -+ } -+ -+ writel(lvl, gpio->regs + GPIO_INTTYPE_LEVEL); -+ if (flow_type != IRQ_TYPE_EDGE_BOTH) -+ writel(pol, gpio->regs + GPIO_INT_POLARITY); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_set_type); -+ -+void phytium_gpio_irq_enable(struct irq_data *d) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ unsigned long flags; -+ u32 val; -+ -+ /* Only port A can provide interrupt source */ -+ if (irqd_to_hwirq(d) >= gpio->ngpio[0]) -+ return; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ val = readl(gpio->regs + GPIO_INTEN); -+ val |= BIT(irqd_to_hwirq(d)); -+ writel(val, gpio->regs + GPIO_INTEN); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_enable); -+ -+void phytium_gpio_irq_disable(struct irq_data *d) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ unsigned long flags; -+ u32 val; -+ -+ /* Only port A can provide interrupt source */ -+ if (irqd_to_hwirq(d) >= gpio->ngpio[0]) -+ return; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ val = readl(gpio->regs + GPIO_INTEN); -+ val &= ~BIT(irqd_to_hwirq(d)); -+ writel(val, gpio->regs + GPIO_INTEN); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_disable); -+ -+void phytium_gpio_irq_handler(struct irq_desc *desc) -+{ -+ struct gpio_chip *gc = irq_desc_get_handler_data(desc); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct irq_chip *irqchip = irq_desc_get_chip(desc); -+ unsigned long pending; -+ int offset; -+ -+ chained_irq_enter(irqchip, desc); -+ -+ pending = readl(gpio->regs + GPIO_INTSTATUS); -+ if (pending) { -+ for_each_set_bit(offset, &pending, gpio->ngpio[0]) { -+ int gpio_irq = irq_find_mapping(gc->irq.domain, -+ offset); -+ generic_handle_irq(gpio_irq); -+ -+ if ((irq_get_trigger_type(gpio_irq) & -+ IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH) -+ phytium_gpio_toggle_trigger(gpio, offset); -+ } -+ } -+ -+ chained_irq_exit(irqchip, desc); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_handler); -+ -+int phytium_gpio_get_direction(struct gpio_chip *gc, unsigned int offset) -+{ -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct pin_loc loc; -+ void __iomem *ddr; -+ -+ if (get_pin_location(gpio, offset, &loc)) -+ return -EINVAL; -+ ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); -+ -+ return !(readl(ddr) & BIT(loc.offset)); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_get_direction); -+ -+#if CONFIG_SMP -+int -+phytium_gpio_irq_set_affinity(struct irq_data *d, const struct cpumask *mask_val, bool force) -+{ -+ struct gpio_chip *chip_data = irq_data_get_irq_chip_data(d); -+ struct irq_chip *chip = irq_get_chip(*(chip_data->irq.parents)); -+ struct irq_data *data = irq_get_irq_data(*(chip_data->irq.parents)); -+ -+ if (chip && chip->irq_set_affinity) -+ return chip->irq_set_affinity(data, mask_val, force); -+ -+ return -EINVAL; -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_set_affinity); -+#endif -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium GPIO Controller core"); -diff --git a/drivers/gpio/gpio-phytium-core.h b/drivers/gpio/gpio-phytium-core.h -new file mode 100644 -index 000000000..d45a9ab11 ---- /dev/null -+++ b/drivers/gpio/gpio-phytium-core.h -@@ -0,0 +1,87 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _GPIO_PHYTIUM_H -+#define _GPIO_PHYTIUM_H -+ -+#include -+#include -+ -+#include "gpiolib.h" -+ -+#define GPIO_SWPORTA_DR 0x00 /* WR Port A Output Data Register */ -+#define GPIO_SWPORTA_DDR 0x04 /* WR Port A Data Direction Register */ -+#define GPIO_EXT_PORTA 0x08 /* RO Port A Input Data Register */ -+#define GPIO_SWPORTB_DR 0x0c /* WR Port B Output Data Register */ -+#define GPIO_SWPORTB_DDR 0x10 /* WR Port B Data Direction Register */ -+#define GPIO_EXT_PORTB 0x14 /* RO Port B Input Data Register */ -+ -+#define GPIO_INTEN 0x18 /* WR Port A Interrput Enable Register */ -+#define GPIO_INTMASK 0x1c /* WR Port A Interrupt Mask Register */ -+#define GPIO_INTTYPE_LEVEL 0x20 /* WR Port A Interrupt Level Register */ -+#define GPIO_INT_POLARITY 0x24 /* WR Port A Interrupt Polarity Register */ -+#define GPIO_INTSTATUS 0x28 /* RO Port A Interrupt Status Register */ -+#define GPIO_RAW_INTSTATUS 0x2c /* RO Port A Raw Interrupt Status Register */ -+#define GPIO_LS_SYNC 0x30 /* WR Level-sensitive Synchronization Enable Register */ -+#define GPIO_DEBOUNCE 0x34 /* WR Debounce Enable Register */ -+#define GPIO_PORTA_EOI 0x38 /* WO Port A Clear Interrupt Register */ -+ -+#define MAX_NPORTS 2 -+#define NGPIO_DEFAULT 8 -+#define NGPIO_MAX 32 -+#define GPIO_PORT_STRIDE (GPIO_EXT_PORTB - GPIO_EXT_PORTA) -+ -+struct pin_loc { -+ unsigned int port; -+ unsigned int offset; -+}; -+ -+#ifdef CONFIG_PM_SLEEP -+struct phytium_gpio_ctx { -+ u32 swporta_dr; -+ u32 swporta_ddr; -+ u32 ext_porta; -+ u32 swportb_dr; -+ u32 swportb_ddr; -+ u32 ext_portb; -+ u32 inten; -+ u32 intmask; -+ u32 inttype_level; -+ u32 int_polarity; -+ u32 intstatus; -+ u32 raw_intstatus; -+ u32 ls_sync; -+ u32 debounce; -+}; -+#endif -+ -+struct phytium_gpio { -+ raw_spinlock_t lock; -+ void __iomem *regs; -+ struct gpio_chip gc; -+ struct irq_chip irq_chip; -+ unsigned int ngpio[2]; -+ int irq[32]; -+#ifdef CONFIG_PM_SLEEP -+ struct phytium_gpio_ctx ctx; -+#endif -+}; -+ -+int phytium_gpio_get(struct gpio_chip *gc, unsigned int offset); -+void phytium_gpio_set(struct gpio_chip *gc, unsigned int offset, int value); -+ -+int phytium_gpio_get_direction(struct gpio_chip *gc, unsigned int offset); -+int phytium_gpio_direction_input(struct gpio_chip *gc, unsigned int offset); -+int phytium_gpio_direction_output(struct gpio_chip *gc, unsigned int offset, int value); -+ -+void phytium_gpio_irq_ack(struct irq_data *d); -+void phytium_gpio_irq_mask(struct irq_data *d); -+void phytium_gpio_irq_unmask(struct irq_data *d); -+int phytium_gpio_irq_set_type(struct irq_data *d, unsigned int flow_type); -+void phytium_gpio_irq_enable(struct irq_data *d); -+void phytium_gpio_irq_disable(struct irq_data *d); -+void phytium_gpio_irq_handler(struct irq_desc *desc); -+int phytium_gpio_irq_set_affinity(struct irq_data *d, const struct cpumask *mask_val, bool force); -+#endif -diff --git a/drivers/gpio/gpio-phytium-pci.c b/drivers/gpio/gpio-phytium-pci.c -new file mode 100644 -index 000000000..e68772dd7 ---- /dev/null -+++ b/drivers/gpio/gpio-phytium-pci.c -@@ -0,0 +1,187 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "gpio-phytium-core.h" -+ -+static int phytium_gpio_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) -+{ -+ struct device *dev = &pdev->dev; -+ struct phytium_gpio *gpio; -+ struct gpio_irq_chip *girq; -+ int err; -+ -+ gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL); -+ if (!gpio) -+ return -ENOMEM; -+ -+ err = pcim_enable_device(pdev); -+ if (err) { -+ dev_err(dev, "Failed to enable PCI device: err %d\n", err); -+ goto out; -+ } -+ -+ err = pcim_iomap_regions(pdev, 1 << 0, pci_name(pdev)); -+ if (err) { -+ dev_err(dev, "Failed to iomap PCI device: err %d\n", err); -+ goto out; -+ } -+ -+ gpio->regs = pcim_iomap_table(pdev)[0]; -+ if (!gpio->regs) { -+ dev_err(dev, "Cannot map PCI resource\n"); -+ err = -ENOMEM; -+ goto out; -+ } -+ -+ err = pci_enable_msi(pdev); -+ if (err < 0) -+ goto out; -+ -+ pci_set_master(pdev); -+ -+ gpio->irq[0] = pdev->irq; -+ if (gpio->irq[0] < 0) -+ dev_warn(dev, "no irq is found.\n"); -+ -+ /* There is only one group of Pins at the moment. */ -+ gpio->ngpio[0] = NGPIO_MAX; -+ -+ /* irq_chip support */ -+ gpio->irq_chip.name = dev_name(dev); -+ gpio->irq_chip.irq_ack = phytium_gpio_irq_ack; -+ gpio->irq_chip.irq_mask = phytium_gpio_irq_mask; -+ gpio->irq_chip.irq_unmask = phytium_gpio_irq_unmask; -+ gpio->irq_chip.irq_set_type = phytium_gpio_irq_set_type; -+ gpio->irq_chip.irq_enable = phytium_gpio_irq_enable; -+ gpio->irq_chip.irq_disable = phytium_gpio_irq_disable; -+ -+ raw_spin_lock_init(&gpio->lock); -+ -+ gpio->gc.base = -1; -+ gpio->gc.get_direction = phytium_gpio_get_direction; -+ gpio->gc.direction_input = phytium_gpio_direction_input; -+ gpio->gc.direction_output = phytium_gpio_direction_output; -+ gpio->gc.get = phytium_gpio_get; -+ gpio->gc.set = phytium_gpio_set; -+ gpio->gc.ngpio = gpio->ngpio[0] + gpio->ngpio[1]; -+ gpio->gc.label = dev_name(dev); -+ gpio->gc.parent = dev; -+ gpio->gc.owner = THIS_MODULE; -+ -+ girq = &gpio->gc.irq; -+ girq->handler = handle_bad_irq; -+ girq->default_type = IRQ_TYPE_NONE; -+ -+ girq->num_parents = 1; -+ girq->parents = devm_kcalloc(&pdev->dev, girq->num_parents, -+ sizeof(*girq->parents), GFP_KERNEL); -+ if (!girq->parents) -+ return -ENOMEM; -+ girq->parents[0] = gpio->irq[0]; -+ girq->parent_handler = phytium_gpio_irq_handler; -+ -+ girq->chip = &gpio->irq_chip; -+ -+ err = devm_gpiochip_add_data(dev, &gpio->gc, gpio); -+ if (err) -+ goto out; -+ -+ dev_info(dev, "Phytium PCI GPIO controller @%pa registered\n", -+ &gpio->regs); -+ -+ pci_set_drvdata(pdev, gpio); -+ -+out: -+ return err; -+} -+ -+static const struct pci_device_id phytium_gpio_pci_ids[] = { -+ { PCI_DEVICE(0x1DB7, 0xDC31) }, -+ { 0 } -+}; -+MODULE_DEVICE_TABLE(pci, phytium_gpio_pci_ids); -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_gpio_pci_suspend(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_gpio *gpio = pci_get_drvdata(pdev); -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ gpio->ctx.swporta_dr = readl(gpio->regs + GPIO_SWPORTA_DR); -+ gpio->ctx.swporta_ddr = readl(gpio->regs + GPIO_SWPORTA_DDR); -+ gpio->ctx.ext_porta = readl(gpio->regs + GPIO_EXT_PORTA); -+ gpio->ctx.swportb_dr = readl(gpio->regs + GPIO_SWPORTB_DR); -+ gpio->ctx.swportb_ddr = readl(gpio->regs + GPIO_SWPORTB_DDR); -+ gpio->ctx.ext_portb = readl(gpio->regs + GPIO_EXT_PORTB); -+ -+ gpio->ctx.inten = readl(gpio->regs + GPIO_INTEN); -+ gpio->ctx.intmask = readl(gpio->regs + GPIO_INTMASK); -+ gpio->ctx.inttype_level = readl(gpio->regs + GPIO_INTTYPE_LEVEL); -+ gpio->ctx.int_polarity = readl(gpio->regs + GPIO_INT_POLARITY); -+ gpio->ctx.debounce = readl(gpio->regs + GPIO_DEBOUNCE); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+ -+static int phytium_gpio_pci_resume(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_gpio *gpio = pci_get_drvdata(pdev); -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ writel(gpio->ctx.swporta_dr, gpio->regs + GPIO_SWPORTA_DR); -+ writel(gpio->ctx.swporta_ddr, gpio->regs + GPIO_SWPORTA_DDR); -+ writel(gpio->ctx.ext_porta, gpio->regs + GPIO_EXT_PORTA); -+ writel(gpio->ctx.swportb_dr, gpio->regs + GPIO_SWPORTB_DR); -+ writel(gpio->ctx.swportb_ddr, gpio->regs + GPIO_SWPORTB_DDR); -+ writel(gpio->ctx.ext_portb, gpio->regs + GPIO_EXT_PORTB); -+ -+ writel(gpio->ctx.inten, gpio->regs + GPIO_INTEN); -+ writel(gpio->ctx.intmask, gpio->regs + GPIO_INTMASK); -+ writel(gpio->ctx.inttype_level, gpio->regs + GPIO_INTTYPE_LEVEL); -+ writel(gpio->ctx.int_polarity, gpio->regs + GPIO_INT_POLARITY); -+ writel(gpio->ctx.debounce, gpio->regs + GPIO_DEBOUNCE); -+ -+ writel(0xffffffff, gpio->regs + GPIO_PORTA_EOI); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_gpio_pci_pm_ops, -+ phytium_gpio_pci_suspend, -+ phytium_gpio_pci_resume); -+ -+static struct pci_driver phytium_gpio_pci_driver = { -+ .name = "gpio-phytium-pci", -+ .id_table = phytium_gpio_pci_ids, -+ .probe = phytium_gpio_pci_probe, -+ .driver = { -+ .pm = &phytium_gpio_pci_pm_ops, -+ }, -+}; -+ -+module_pci_driver(phytium_gpio_pci_driver); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_DESCRIPTION("Phytium GPIO PCI Driver"); -diff --git a/drivers/gpio/gpio-phytium-platform.c b/drivers/gpio/gpio-phytium-platform.c -new file mode 100644 -index 000000000..9fe3191f7 ---- /dev/null -+++ b/drivers/gpio/gpio-phytium-platform.c -@@ -0,0 +1,204 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Support functions for Phytium GPIO -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from drivers/gpio/gpio-pl061.c -+ * Copyright (C) 2008, 2009 Provigent Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "gpio-phytium-core.h" -+ -+static const struct of_device_id phytium_gpio_of_match[] = { -+ { .compatible = "phytium,gpio", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_gpio_of_match); -+ -+static const struct acpi_device_id phytium_gpio_acpi_match[] = { -+ { "PHYT0001", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_gpio_acpi_match); -+ -+static int phytium_gpio_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct resource *res; -+ struct phytium_gpio *gpio; -+ struct gpio_irq_chip *girq; -+ struct fwnode_handle *fwnode; -+ int err, irq_count; -+ -+ gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL); -+ if (!gpio) -+ return -ENOMEM; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ gpio->regs = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(gpio->regs)) -+ return PTR_ERR(gpio->regs); -+ -+ if (!device_get_child_node_count(dev)) -+ return -ENODEV; -+ -+ device_for_each_child_node(dev, fwnode) { -+ int idx; -+ -+ if (fwnode_property_read_u32(fwnode, "reg", &idx) || -+ idx >= MAX_NPORTS) { -+ dev_err(dev, "missing/invalid port index\n"); -+ fwnode_handle_put(fwnode); -+ return -EINVAL; -+ } -+ -+ if (fwnode_property_read_u32(fwnode, "ngpios", &gpio->ngpio[idx]) && -+ fwnode_property_read_u32(fwnode, "nr-gpios", &gpio->ngpio[idx])) { -+ dev_info(dev, -+ "failed to get number of gpios for Port%c\n", -+ idx ? 'B' : 'A'); -+ gpio->ngpio[idx] = NGPIO_DEFAULT; -+ } -+ } -+ -+ /* irq_chip support */ -+ gpio->irq_chip.name = dev_name(dev); -+ gpio->irq_chip.irq_ack = phytium_gpio_irq_ack; -+ gpio->irq_chip.irq_mask = phytium_gpio_irq_mask; -+ gpio->irq_chip.irq_unmask = phytium_gpio_irq_unmask; -+ gpio->irq_chip.irq_set_type = phytium_gpio_irq_set_type; -+ gpio->irq_chip.irq_enable = phytium_gpio_irq_enable; -+ gpio->irq_chip.irq_disable = phytium_gpio_irq_disable; -+#ifdef CONFIG_SMP -+ /* TODO: use irq_chip_set_affinity_parent instead? */ -+ gpio->irq_chip.irq_set_affinity = phytium_gpio_irq_set_affinity; -+#endif -+ raw_spin_lock_init(&gpio->lock); -+ -+ gpio->gc.base = -1; -+ gpio->gc.get_direction = phytium_gpio_get_direction; -+ gpio->gc.direction_input = phytium_gpio_direction_input; -+ gpio->gc.direction_output = phytium_gpio_direction_output; -+ gpio->gc.get = phytium_gpio_get; -+ gpio->gc.set = phytium_gpio_set; -+ gpio->gc.ngpio = gpio->ngpio[0] + gpio->ngpio[1]; -+ gpio->gc.label = dev_name(dev); -+ gpio->gc.parent = dev; -+ gpio->gc.owner = THIS_MODULE; -+ -+ girq = &gpio->gc.irq; -+ girq->handler = handle_bad_irq; -+ girq->default_type = IRQ_TYPE_NONE; -+ -+ for (irq_count = 0; irq_count < platform_irq_count(pdev); irq_count++) { -+ gpio->irq[irq_count] = -ENXIO; -+ gpio->irq[irq_count] = platform_get_irq(pdev, irq_count); -+ if (gpio->irq[irq_count] < 0) { -+ //dev_warn(dev, "no irq is found.\n"); -+ break; -+ } -+ }; -+ -+ girq->num_parents = irq_count; -+ girq->parents = gpio->irq; -+ girq->parent_handler = phytium_gpio_irq_handler; -+ -+ girq->chip = &gpio->irq_chip; -+ -+ err = devm_gpiochip_add_data(dev, &gpio->gc, gpio); -+ if (err) -+ return err; -+ -+ platform_set_drvdata(pdev, gpio); -+ dev_info(dev, "Phytium GPIO controller @%pa registered\n", -+ &res->start); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_gpio_suspend(struct device *dev) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct phytium_gpio *gpio = platform_get_drvdata(pdev); -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ gpio->ctx.swporta_dr = readl(gpio->regs + GPIO_SWPORTA_DR); -+ gpio->ctx.swporta_ddr = readl(gpio->regs + GPIO_SWPORTA_DDR); -+ gpio->ctx.ext_porta = readl(gpio->regs + GPIO_EXT_PORTA); -+ gpio->ctx.swportb_dr = readl(gpio->regs + GPIO_SWPORTB_DR); -+ gpio->ctx.swportb_ddr = readl(gpio->regs + GPIO_SWPORTB_DDR); -+ gpio->ctx.ext_portb = readl(gpio->regs + GPIO_EXT_PORTB); -+ -+ gpio->ctx.inten = readl(gpio->regs + GPIO_INTEN); -+ gpio->ctx.intmask = readl(gpio->regs + GPIO_INTMASK); -+ gpio->ctx.inttype_level = readl(gpio->regs + GPIO_INTTYPE_LEVEL); -+ gpio->ctx.int_polarity = readl(gpio->regs + GPIO_INT_POLARITY); -+ gpio->ctx.debounce = readl(gpio->regs + GPIO_DEBOUNCE); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+ -+static int phytium_gpio_resume(struct device *dev) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct phytium_gpio *gpio = platform_get_drvdata(pdev); -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ writel(gpio->ctx.swporta_dr, gpio->regs + GPIO_SWPORTA_DR); -+ writel(gpio->ctx.swporta_ddr, gpio->regs + GPIO_SWPORTA_DDR); -+ writel(gpio->ctx.ext_porta, gpio->regs + GPIO_EXT_PORTA); -+ writel(gpio->ctx.swportb_dr, gpio->regs + GPIO_SWPORTB_DR); -+ writel(gpio->ctx.swportb_ddr, gpio->regs + GPIO_SWPORTB_DDR); -+ writel(gpio->ctx.ext_portb, gpio->regs + GPIO_EXT_PORTB); -+ -+ writel(gpio->ctx.inten, gpio->regs + GPIO_INTEN); -+ writel(gpio->ctx.intmask, gpio->regs + GPIO_INTMASK); -+ writel(gpio->ctx.inttype_level, gpio->regs + GPIO_INTTYPE_LEVEL); -+ writel(gpio->ctx.int_polarity, gpio->regs + GPIO_INT_POLARITY); -+ writel(gpio->ctx.debounce, gpio->regs + GPIO_DEBOUNCE); -+ -+ writel(0xffffffff, gpio->regs + GPIO_PORTA_EOI); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_gpio_pm_ops, phytium_gpio_suspend, -+ phytium_gpio_resume); -+ -+static struct platform_driver phytium_gpio_driver = { -+ .driver = { -+ .name = "gpio-phytium-platform", -+ .pm = &phytium_gpio_pm_ops, -+ .of_match_table = of_match_ptr(phytium_gpio_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_gpio_acpi_match), -+ }, -+ .probe = phytium_gpio_probe, -+}; -+ -+module_platform_driver(phytium_gpio_driver); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium GPIO driver"); -diff --git a/drivers/gpio/gpio-phytium-sgpio.c b/drivers/gpio/gpio-phytium-sgpio.c -new file mode 100644 -index 000000000..4785ca45f ---- /dev/null -+++ b/drivers/gpio/gpio-phytium-sgpio.c -@@ -0,0 +1,302 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SGPIO Driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define SGPIO_CTL0_REG 0x00 -+#define SGPIO_CTL0_REG_ENABLE BIT(0) -+#define SGPIO_CTL0_REG_RX_DISABLE BIT(1) -+#define SGPIO_CTL0_REG_L3_L0 GENMASK(11, 8) -+#define SGPIO_CTL0_REG_CLK_DIV_NUM GENMASK(31, 12) -+#define SGPIO_CTL1_REG 0x04 -+#define SGPIO_CTL1_REG_READY BIT(0) -+#define SGPIO_CTL1_REG_W_UPDATA BIT(1) -+#define SGPIO_CTL1_REG_OP_MODE BIT(2) -+#define SGPIO_CTL1_REG_OP_STATE BIT(3) -+#define SGPIO_CTL1_REG_BIT_NUM GENMASK(14, 8) -+#define SGPIO_CTL1_REG_INTERVAL_TIMER GENMASK(31, 16) -+#define SGPIO_SOFT_RESET_REG 0x08 -+#define SGPIO_SOFT_RESET_REG_MASK BIT(0) -+#define SGPIO_IRQ_REG 0x0c -+#define SGPIO_IRQ_REG_MASK BIT(0) -+#define SGPIO_IRQ_M_REG 0x10 -+#define SGPIO_IRQ_M_REG_MASK BIT(0) -+#define SGPIO_WDATA0_REG 0x14 -+#define SGPIO_WDATA_REG(x) (SGPIO_WDATA0_REG + ((x) == 2 ? 3 : (x))* 4) // 0x14, 0x18, 0x20 -+#define SGPIO_RDATA0_REG 0x24 -+#define SGPIO_RDATA_REG(x) (SGPIO_RDATA0_REG + (x) * 4) -+ -+#define DEFAULT_L3_L0 0 -+ -+#define GPIO_GROUP(x) ((x) >> 6) -+#define GPIO_OFFSET(x) ((x) & GENMASK(5, 0)) -+#define GPIO_BIT(x) BIT(GPIO_OFFSET(x) >> 1) -+ -+struct phytium_sgpio { -+ struct gpio_chip gc; -+ void __iomem *regs; -+ unsigned int ngpios; -+ struct clk *pclk; -+ -+ struct mutex lock; -+ struct completion completion; -+}; -+ -+static bool phytium_sgpio_is_input(unsigned int offset) -+{ -+ return !(offset % 2); -+} -+ -+static int sgpio_set_value(struct gpio_chip *gc, unsigned int offset, int val) -+{ -+ struct phytium_sgpio *gpio = gpiochip_get_data(gc); -+ u32 reg; -+ int rc = 0; -+ -+ if (phytium_sgpio_is_input(offset)) -+ return -EINVAL; -+ -+ reinit_completion(&gpio->completion); -+ -+ /* -+ * Since this is an output, read the cached value from rdata, -+ * then update value. -+ */ -+ /* cached data from wdata? */ -+ reg = readl(gpio->regs + SGPIO_WDATA_REG(GPIO_GROUP(offset))); -+ if (val) -+ reg |= GPIO_BIT(offset); -+ else -+ reg &= GPIO_BIT(offset); -+ writel(reg, gpio->regs + SGPIO_WDATA_REG(GPIO_GROUP(offset))); -+ -+ /* Start transmission and wait for completion */ -+ writel(readl(gpio->regs + SGPIO_CTL1_REG) | SGPIO_CTL1_REG_W_UPDATA, -+ gpio->regs + SGPIO_CTL1_REG); -+ if (!wait_for_completion_timeout(&gpio->completion, msecs_to_jiffies(1000))) -+ rc = -EINVAL; -+ -+ return rc; -+} -+ -+static int phytium_sgpio_direction_input(struct gpio_chip *gc, unsigned int offset) -+{ -+ return phytium_sgpio_is_input(offset) ? 0 : -EINVAL; -+} -+ -+static int phytium_sgpio_direction_output(struct gpio_chip *gc, unsigned int offset, int val) -+{ -+ struct phytium_sgpio *gpio = gpiochip_get_data(gc); -+ int rc; -+ -+ mutex_lock(&gpio->lock); -+ -+ /* -+ * No special action is required for setting the direction; we'll -+ * error-out in sgpio_set_value if this isn't an output GPIO -+ */ -+ rc = sgpio_set_value(&gpio->gc, offset, val); -+ -+ mutex_unlock(&gpio->lock); -+ -+ return rc; -+} -+ -+static int phytium_sgpio_get_direction(struct gpio_chip *gc, unsigned int offset) -+{ -+ return !!phytium_sgpio_is_input(offset); -+} -+ -+static int phytium_sgpio_get(struct gpio_chip *gc, unsigned int offset) -+{ -+ struct phytium_sgpio *gpio = gpiochip_get_data(gc); -+ int rc = 0; -+ u32 val, ctl0; -+ -+ mutex_lock(&gpio->lock); -+ -+ if (!phytium_sgpio_is_input(offset)) { -+ val = readl(gpio->regs + SGPIO_WDATA_REG(GPIO_GROUP(offset))); -+ rc = !!(val & GPIO_BIT(offset)); -+ mutex_unlock(&gpio->lock); -+ return rc; -+ } -+ -+ reinit_completion(&gpio->completion); -+ -+ /* Enable Rx */ -+ ctl0 = readl(gpio->regs + SGPIO_CTL0_REG); -+ writel(ctl0 & ~SGPIO_CTL0_REG_RX_DISABLE, gpio->regs + SGPIO_CTL0_REG); -+ -+ /* Start reading transaction and wait for completion */ -+ writel(readl(gpio->regs + SGPIO_CTL1_REG) | SGPIO_CTL1_REG_W_UPDATA, -+ gpio->regs + SGPIO_CTL1_REG); -+ if (!wait_for_completion_timeout(&gpio->completion, msecs_to_jiffies(1000))) { -+ rc = -EINVAL; -+ goto err; -+ } -+ -+ val = readl(gpio->regs + SGPIO_RDATA_REG(GPIO_GROUP(offset))); -+ rc = !!(val & GPIO_BIT(offset)); -+ -+err: -+ /* Disalbe Rx to hold the value */ -+ writel(ctl0 | SGPIO_CTL0_REG_RX_DISABLE, gpio->regs + SGPIO_CTL0_REG); -+ mutex_unlock(&gpio->lock); -+ -+ return rc; -+} -+ -+static void phytium_sgpio_set(struct gpio_chip *gc, unsigned int offset, int val) -+{ -+ struct phytium_sgpio *gpio = gpiochip_get_data(gc); -+ -+ mutex_lock(&gpio->lock); -+ -+ sgpio_set_value(gc, offset, val); -+ -+ mutex_unlock(&gpio->lock); -+} -+ -+static irqreturn_t phytium_sgpio_irq_handler(int irq, void *data) -+{ -+ struct phytium_sgpio *gpio = data; -+ -+ if (!readl(gpio->regs + SGPIO_IRQ_REG)) -+ return IRQ_NONE; -+ -+ /* Clear the interrupt */ -+ writel(0, gpio->regs + SGPIO_IRQ_REG); -+ -+ /* Check if tx/rx has been done */ -+ if (!(readl(gpio->regs + SGPIO_CTL1_REG) & SGPIO_CTL1_REG_OP_STATE)) -+ complete(&gpio->completion); -+ -+ return IRQ_HANDLED; -+} -+ -+static int phytium_sgpio_probe(struct platform_device *pdev) -+{ -+ u32 pclk_freq, sclk_freq, clk_div; -+ struct phytium_sgpio *gpio; -+ struct resource *res; -+ struct device *dev = &pdev->dev; -+ int rc; -+ -+ gpio = devm_kzalloc(dev, sizeof(*gpio), GFP_KERNEL); -+ if (!gpio) -+ return -ENOMEM; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ gpio->regs = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(gpio->regs)) -+ return PTR_ERR(gpio->regs); -+ -+ if (devm_request_irq(dev, platform_get_irq(pdev, 0), -+ phytium_sgpio_irq_handler, -+ IRQF_SHARED, dev_name(dev), gpio)) { -+ dev_err(dev, "failed to request IRQ\n"); -+ return -ENOENT; -+ } -+ -+ rc = fwnode_property_read_u32(dev_fwnode(dev), "ngpios", &gpio->ngpios); -+ if (rc < 0) { -+ dev_err(dev, "Could not read ngpios property\n"); -+ return -EINVAL; -+ } else if (gpio->ngpios % 32) { -+ dev_err(&pdev->dev, "Number of GPIOs not multiple of 32: %d\n", -+ gpio->ngpios); -+ return -EINVAL; -+ } -+ -+ rc = fwnode_property_read_u32(dev_fwnode(dev), "bus-frequency", &sclk_freq); -+ if (rc < 0) { -+ dev_err(dev, "Could not read bus-frequency property\n"); -+ return -EINVAL; -+ } -+ -+ gpio->pclk = devm_clk_get(dev, NULL); -+ if (IS_ERR(gpio->pclk)) { -+ dev_err(dev, "Could not get the APB clock property\n"); -+ return PTR_ERR(gpio->pclk); -+ } -+ rc = clk_prepare_enable(gpio->pclk); -+ if (rc) { -+ dev_err(dev, "failed to enable pclk: %d\n", rc); -+ return rc; -+ } -+ pclk_freq = clk_get_rate(gpio->pclk); -+ -+ /* -+ * From the datasheet: -+ * (pclk / 2) / (clk_div + 1) = sclk -+ */ -+ if (sclk_freq == 0) { -+ dev_err(dev, "SCLK should not be 0\n"); -+ return -EINVAL; -+ } -+ -+ clk_div = (pclk_freq / (sclk_freq * 2)) - 1; -+ if (clk_div > (1 << 20) - 1) { -+ dev_err(dev, "clk_div is overflow\n"); -+ return -EINVAL; -+ } -+ -+ writel(FIELD_PREP(SGPIO_CTL0_REG_CLK_DIV_NUM, clk_div) | -+ FIELD_PREP(SGPIO_CTL0_REG_L3_L0, DEFAULT_L3_L0) | -+ SGPIO_CTL0_REG_RX_DISABLE | SGPIO_CTL0_REG_ENABLE, -+ gpio->regs + SGPIO_CTL0_REG); -+ -+ writel(FIELD_PREP(SGPIO_CTL1_REG_BIT_NUM, gpio->ngpios) | -+ SGPIO_CTL1_REG_READY, gpio->regs + SGPIO_CTL1_REG); -+ -+ mutex_init(&gpio->lock); -+ init_completion(&gpio->completion); -+ platform_set_drvdata(pdev, gpio); -+ -+ gpio->gc.parent = dev; -+ gpio->gc.base = -1; -+ gpio->gc.ngpio = gpio->ngpios * 2; -+ gpio->gc.label = dev_name(dev); -+ gpio->gc.direction_input = phytium_sgpio_direction_input; -+ gpio->gc.direction_output = phytium_sgpio_direction_output; -+ gpio->gc.get_direction = phytium_sgpio_get_direction; -+ gpio->gc.get = phytium_sgpio_get; -+ gpio->gc.set = phytium_sgpio_set; -+ -+ return devm_gpiochip_add_data(dev, &gpio->gc, gpio); -+} -+ -+static const struct of_device_id phytium_sgpio_of_match[] = { -+ { .compatible = "phytium,sgpio", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_sgpio_of_match); -+ -+static struct platform_driver phytium_sgpio_driver = { -+ .driver = { -+ .name = KBUILD_MODNAME, -+ .of_match_table = of_match_ptr(phytium_sgpio_of_match), -+ }, -+ .probe = phytium_sgpio_probe, -+}; -+module_platform_driver(phytium_sgpio_driver); -+ -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium SGPIO driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/gpu/drm/Kconfig b/drivers/gpu/drm/Kconfig -index 4e9b3a95f..518fd948c 100644 ---- a/drivers/gpu/drm/Kconfig -+++ b/drivers/gpu/drm/Kconfig -@@ -393,6 +393,8 @@ source "drivers/gpu/drm/tidss/Kconfig" - - source "drivers/gpu/drm/xlnx/Kconfig" - -+source "drivers/gpu/drm/phytium/Kconfig" -+ - # Keep legacy drivers last - - menuconfig DRM_LEGACY -diff --git a/drivers/gpu/drm/Makefile b/drivers/gpu/drm/Makefile -index 81569009f..d78dc598c 100644 ---- a/drivers/gpu/drm/Makefile -+++ b/drivers/gpu/drm/Makefile -@@ -124,3 +124,4 @@ obj-$(CONFIG_DRM_ASPEED_GFX) += aspeed/ - obj-$(CONFIG_DRM_MCDE) += mcde/ - obj-$(CONFIG_DRM_TIDSS) += tidss/ - obj-y += xlnx/ -+obj-$(CONFIG_DRM_PHYTIUM) += phytium/ -diff --git a/drivers/gpu/drm/phytium/Kconfig b/drivers/gpu/drm/phytium/Kconfig -new file mode 100644 -index 000000000..e3024feb6 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/Kconfig -@@ -0,0 +1,7 @@ -+config DRM_PHYTIUM -+ tristate "DRM Support for Phytium Graphics Card" -+ depends on DRM -+ select DRM_KMS_HELPER -+ help -+ Choose this option if you have a phytium graphics card. -+ This driver provides kernel mode setting and buffer management to userspace. -diff --git a/drivers/gpu/drm/phytium/Makefile b/drivers/gpu/drm/phytium/Makefile -new file mode 100644 -index 000000000..2dc7ea111 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/Makefile -@@ -0,0 +1,18 @@ -+phytium-dc-drm-y := phytium_display_drv.o \ -+ phytium_plane.o \ -+ phytium_crtc.o \ -+ phytium_dp.o \ -+ phytium_fb.o \ -+ phytium_gem.o \ -+ phytium_fbdev.o \ -+ phytium_debugfs.o \ -+ px210_dp.o \ -+ phytium_panel.o \ -+ px210_dc.o \ -+ phytium_pci.o \ -+ pe220x_dp.o \ -+ pe220x_dc.o \ -+ phytium_platform.o -+ -+obj-$(CONFIG_DRM_PHYTIUM) += phytium-dc-drm.o -+CFLAGS_REMOVE_phytium_crtc.o += -mgeneral-regs-only -diff --git a/drivers/gpu/drm/phytium/pe220x_dc.c b/drivers/gpu/drm/phytium/pe220x_dc.c -new file mode 100644 -index 000000000..cfdecad43 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/pe220x_dc.c -@@ -0,0 +1,297 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium Pe220x display controller DRM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#if defined(__arm__) || defined(__aarch64__) -+#include -+#endif -+#include -+#include "phytium_display_drv.h" -+#include "pe220x_reg.h" -+#include "phytium_crtc.h" -+#include "phytium_plane.h" -+#include "phytium_fb.h" -+#include "phytium_gem.h" -+ -+void pe220x_dc_hw_disable(struct drm_crtc *crtc); -+ -+static const unsigned int pe220x_primary_formats[] = { -+ DRM_FORMAT_ARGB2101010, -+ DRM_FORMAT_ABGR2101010, -+ DRM_FORMAT_RGBA1010102, -+ DRM_FORMAT_BGRA1010102, -+ DRM_FORMAT_ARGB8888, -+ DRM_FORMAT_ABGR8888, -+ DRM_FORMAT_RGBA8888, -+ DRM_FORMAT_BGRA8888, -+ DRM_FORMAT_XRGB8888, -+ DRM_FORMAT_XBGR8888, -+ DRM_FORMAT_RGBX8888, -+ DRM_FORMAT_BGRX8888, -+ DRM_FORMAT_ARGB4444, -+ DRM_FORMAT_ABGR4444, -+ DRM_FORMAT_RGBA4444, -+ DRM_FORMAT_BGRA4444, -+ DRM_FORMAT_XRGB4444, -+ DRM_FORMAT_XBGR4444, -+ DRM_FORMAT_RGBX4444, -+ DRM_FORMAT_BGRX4444, -+ DRM_FORMAT_ARGB1555, -+ DRM_FORMAT_ABGR1555, -+ DRM_FORMAT_RGBA5551, -+ DRM_FORMAT_BGRA5551, -+ DRM_FORMAT_XRGB1555, -+ DRM_FORMAT_XBGR1555, -+ DRM_FORMAT_RGBX5551, -+ DRM_FORMAT_BGRX5551, -+ DRM_FORMAT_RGB565, -+ DRM_FORMAT_BGR565, -+ DRM_FORMAT_YUYV, -+ DRM_FORMAT_UYVY, -+ DRM_FORMAT_NV16, -+ DRM_FORMAT_NV12, -+ DRM_FORMAT_NV21, -+}; -+ -+static const unsigned int pe220x_bmc_primary_formats[] = { -+ DRM_FORMAT_XRGB8888, -+}; -+ -+static uint64_t pe220x_primary_formats_modifiers[] = { -+ DRM_FORMAT_MOD_LINEAR, -+ DRM_FORMAT_MOD_INVALID -+}; -+ -+static uint64_t pe220x_cursor_formats_modifiers[] = { -+ DRM_FORMAT_MOD_LINEAR, -+ DRM_FORMAT_MOD_INVALID -+}; -+ -+static const unsigned int pe220x_cursor_formats[] = { -+ DRM_FORMAT_ARGB8888, -+}; -+ -+void pe220x_dc_hw_vram_init(struct phytium_display_private *priv, resource_size_t vram_addr, -+ resource_size_t vram_size) -+{ -+ uint32_t config; -+ uint32_t group_offset = priv->address_transform_base; -+ -+ phytium_writel_reg(priv, (vram_addr & SRC_ADDR_MASK) >> SRC_ADDR_OFFSET, -+ group_offset, PE220X_DC_ADDRESS_TRANSFORM_SRC_ADDR); -+ phytium_writel_reg(priv, (vram_size >> SIZE_OFFSET) | ADDRESS_TRANSFORM_ENABLE, -+ group_offset, PE220X_DC_ADDRESS_TRANSFORM_SIZE); -+ config = phytium_readl_reg(priv, group_offset, PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR); -+ phytium_writel_reg(priv, config, group_offset, PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR); -+} -+ -+void pe220x_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ int ret = 0; -+ -+ /* config pix clock */ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_PIXEL_CLOCK | (clock & PIXEL_CLOCK_MASK), -+ 0, PE220X_DC_CMD_REGISTER(phys_pipe)); -+ ret = phytium_wait_cmd_done(priv, PE220X_DC_CMD_REGISTER(phys_pipe), -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to set pixel clock\n", __func__); -+} -+ -+void pe220x_dc_hw_reset(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int config = 0; -+ int phys_pipe = phytium_crtc->phys_pipe; -+ -+ config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); -+ -+ if (priv->info.bmc_mode) { -+ pe220x_dc_hw_disable(crtc); -+ config &= (~(DC0_CORE_RESET | DC1_CORE_RESET | AHB_RESET)); -+ if (phys_pipe == 0) { -+ phytium_writel_reg(priv, config | DC0_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET | AHB_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ } else { -+ phytium_writel_reg(priv, config | DC1_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET | AHB_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ } -+ -+ } else { -+ config &= (~(DC0_CORE_RESET | DC1_CORE_RESET | AXI_RESET | AHB_RESET)); -+ if (phys_pipe == 0) { -+ phytium_writel_reg(priv, config | DC0_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET | AHB_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ } else { -+ phytium_writel_reg(priv, config | DC1_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET | AHB_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ } -+ } -+} -+ -+void pe220x_dc_hw_disable(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int config = 0; -+ int phys_pipe = phytium_crtc->phys_pipe; -+ -+ /* clear framebuffer */ -+ phytium_writel_reg(priv, CLEAR_VALUE_BLACK, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE); -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ config |= FRAMEBUFFER_CLEAR; -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ -+ /* disable cursor */ -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); -+ config = ((config & (~CURSOR_FORMAT_MASK)) | CURSOR_FORMAT_DISABLED); -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); -+ mdelay(20); -+ -+ /* reset pix clock */ -+ pe220x_dc_hw_config_pix_clock(crtc, 0); -+ -+ if (phys_pipe == 0) { -+ config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET, 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config & (~DC0_CORE_RESET), 0, PE220X_DC_CLOCK_CONTROL); -+ } else { -+ config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET, 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config & (~DC1_CORE_RESET), 0, PE220X_DC_CLOCK_CONTROL); -+ } -+ udelay(20); -+} -+ -+int pe220x_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count) -+{ -+ int ret = 0; -+ -+ if (mode_cmd->modifier[count] != DRM_FORMAT_MOD_LINEAR) { -+ DRM_ERROR("unsupported fb modifier 0x%llx\n", mode_cmd->modifier[count]); -+ ret = -EINVAL; -+ } -+ -+ return ret; -+} -+ -+void pe220x_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count) -+{ -+ *format_modifiers = pe220x_primary_formats_modifiers; -+ *formats = pe220x_primary_formats; -+ *format_count = ARRAY_SIZE(pe220x_primary_formats); -+} -+ -+void pe220x_dc_bmc_hw_plane_get_primary_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count) -+{ -+ *format_modifiers = pe220x_primary_formats_modifiers; -+ *formats = pe220x_bmc_primary_formats; -+ *format_count = ARRAY_SIZE(pe220x_bmc_primary_formats); -+} -+ -+void pe220x_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count) -+{ -+ *format_modifiers = pe220x_cursor_formats_modifiers; -+ *formats = pe220x_cursor_formats; -+ *format_count = ARRAY_SIZE(pe220x_cursor_formats); -+} -+ -+void pe220x_dc_hw_update_primary_hi_addr(struct drm_plane *plane) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ int phys_pipe = phytium_plane->phys_pipe; -+ -+ phytium_writel_reg(priv, (phytium_plane->iova[0] >> PREFIX_SHIFT) & PREFIX_MASK, -+ priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_Y_HI_ADDRESS); -+ -+ phytium_writel_reg(priv, (phytium_plane->iova[1] >> U_PREFIX_SHIFT) & U_PREFIX_MASK, -+ priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_U_HI_ADDRESS); -+ -+ phytium_writel_reg(priv, (phytium_plane->iova[2] >> V_PREFIX_SHIFT) & V_PREFIX_MASK, -+ priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_V_HI_ADDRESS); -+} -+ -+void pe220x_dc_hw_update_cursor_hi_addr(struct drm_plane *plane, uint64_t iova) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ int phys_pipe = phytium_plane->phys_pipe; -+ int config; -+ -+ config = ((iova >> CURSOR_PREFIX_SHIFT) & CURSOR_PREFIX_MASK); -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PE220X_DC_CURSOR_HI_ADDRESS); -+} -diff --git a/drivers/gpu/drm/phytium/pe220x_dc.h b/drivers/gpu/drm/phytium/pe220x_dc.h -new file mode 100644 -index 000000000..1fd0db3b8 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/pe220x_dc.h -@@ -0,0 +1,34 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium Pe220x display controller DRM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PE220X_DC_H__ -+#define __PE220X_DC_H__ -+ -+#define PE220X_DC_PIX_CLOCK_MAX (594000) -+#define PE220X_DC_HDISPLAY_MAX 3840 -+#define PE220X_DC_VDISPLAY_MAX 2160 -+#define PE220X_DC_ADDRESS_MASK 0x7f -+ -+extern void pe220x_dc_hw_vram_init(struct phytium_display_private *priv, -+ resource_size_t vram_addr, -+ resource_size_t vram_size); -+extern void pe220x_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock); -+extern void pe220x_dc_hw_disable(struct drm_crtc *crtc); -+extern int pe220x_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count); -+extern void pe220x_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+extern void pe220x_dc_bmc_hw_plane_get_primary_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+extern void pe220x_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+extern void pe220x_dc_hw_update_primary_hi_addr(struct drm_plane *plane); -+extern void pe220x_dc_hw_update_cursor_hi_addr(struct drm_plane *plane, uint64_t iova); -+void pe220x_dc_hw_reset(struct drm_crtc *crtc); -+#endif /* __PE220X_DC_H__ */ -diff --git a/drivers/gpu/drm/phytium/pe220x_dp.c b/drivers/gpu/drm/phytium/pe220x_dp.c -new file mode 100644 -index 000000000..b56484361 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/pe220x_dp.c -@@ -0,0 +1,508 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium display port DRM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "pe220x_reg.h" -+#include "phytium_dp.h" -+#include "pe220x_dp.h" -+ -+static uint8_t pe220x_dp_source_lane_count[2] = {1, 1}; -+ -+/* [reg][ling_rate 1.62->8.1] */ -+static int vco_val[12][4] = { -+ {0x0509, 0x0509, 0x0509, 0x0509}, /* CP_PADJ */ -+ {0x0f00, 0x0f00, 0x0f00, 0x0f00}, /* CP_IADJ */ -+ {0x0F08, 0x0F08, 0x0F08, 0x0F08}, /* FILT_PADJ */ -+ {0x0061, 0x006C, 0x006C, 0x0051}, /* INTDIV */ -+ {0x3333, 0x0000, 0x0000, 0x0000}, /* FRACDIVL */ -+ {0x0000, 0x0000, 0x0000, 0x0000}, /* FRACDIVH */ -+ {0x0042, 0x0048, 0x0048, 0x0036}, /* HIGH_THR */ -+ {0x0002, 0x0002, 0x0002, 0x0002}, /* PDIAG_CTRL */ -+ {0x0c5e, 0x0c5e, 0x0c5e, 0x0c5e}, /* VCOCAL_PLLCNT_START */ -+ {0x00c7, 0x00c7, 0x00c7, 0x00c7}, /* LOCK_PEFCNT */ -+ {0x00c7, 0x00c7, 0x00c7, 0x00c7}, /* LOCK_PLLCNT_START */ -+ {0x0005, 0x0005, 0x0005, 0x0005}, /* LOCK_PLLCNT_THR */ -+}; -+ -+/* [link_rate][swing][emphasis] */ -+static int mgnfs_val[4][4][4] = { -+ /* 1.62Gbps */ -+ { -+ {0x0026, 0x001f, 0x0012, 0x0000}, -+ {0x0013, 0x0013, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 2.7Gbps */ -+ { -+ {0x0026, 0x001f, 0x0012, 0x0000}, -+ {0x0013, 0x0013, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 5.4Gbps */ -+ { -+ {0x001f, 0x0013, 0x005, 0x0000}, -+ {0x0018, 0x006, 0x0000, 0x0000}, -+ {0x000c, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 8.1Gbps */ -+ { -+ {0x0026, 0x0013, 0x005, 0x0000}, -+ {0x0013, 0x006, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+}; -+ -+/* [link_rate][swing][emphasis] */ -+static int cpost_val[4][4][4] = { -+ /* 1.62Gbps */ -+ { -+ {0x0000, 0x0014, 0x0020, 0x002a}, -+ {0x0000, 0x0010, 0x001f, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 2.7Gbps */ -+ { -+ {0x0000, 0x0014, 0x0020, 0x002a}, -+ {0x0000, 0x0010, 0x001f, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 5.4Gbps */ -+ { -+ {0x0005, 0x0014, 0x0022, 0x002e}, -+ {0x0000, 0x0013, 0x0020, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 8.1Gbps */ -+ { -+ {0x0000, 0x0014, 0x0022, 0x002e}, -+ {0x0000, 0x0013, 0x0020, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+}; -+ -+static int pe220x_dp_hw_set_phy_lane_and_rate(struct phytium_dp_device *phytium_dp, -+ uint8_t link_lane_count, uint32_t link_rate) -+{ -+ int port = phytium_dp->port%2; -+ int i = 0, data, tmp, tmp1, index = 0, mask = 0; -+ int timeout = 500, ret = 0; -+ -+ /* set pma powerdown */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (A3_POWERDOWN3 << (i * A3_POWERDOWN3_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); -+ -+ /* lane pll disable */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) { -+ data |= (PLL_EN << (i * PLL_EN_SHIFT)); -+ mask |= (((1<source_max_lane_count; i++) -+ data |= (PLL_EN << (i * PLL_EN_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_EN(port), data); -+ -+ /* set pma power active */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (A0_ACTIVE << (i * A0_ACTIVE_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); -+ -+ mask = PLL0_LOCK_DONE; -+ do { -+ mdelay(1); -+ timeout--; -+ tmp = phytium_phy_readl(phytium_dp, PE220X_PHY_PMA_CONTROL2(port)); -+ } while ((!(tmp & mask)) && timeout); -+ -+ if (timeout == 0) { -+ DRM_ERROR("dp(%d) phy pll lock failed\n", port); -+ ret = -1; -+ } -+ udelay(1); -+ -+ return ret; -+} -+ -+static void pe220x_dp_hw_set_phy_lane_setting(struct phytium_dp_device *phytium_dp, -+ uint32_t link_rate, uint8_t train_set) -+{ -+ int port = phytium_dp->port % 3; -+ int voltage_swing = 0; -+ int pre_emphasis = 0, link_rate_index = 0; -+ -+ switch (train_set & DP_TRAIN_VOLTAGE_SWING_MASK) { -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_1: -+ voltage_swing = 1; -+ break; -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_2: -+ voltage_swing = 2; -+ break; -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_3: -+ voltage_swing = 3; -+ break; -+ default: -+ voltage_swing = 0; -+ break; -+ } -+ -+ switch (train_set & DP_TRAIN_PRE_EMPHASIS_MASK) { -+ case DP_TRAIN_PRE_EMPH_LEVEL_1: -+ pre_emphasis = 1; -+ break; -+ case DP_TRAIN_PRE_EMPH_LEVEL_2: -+ pre_emphasis = 2; -+ break; -+ case DP_TRAIN_PRE_EMPH_LEVEL_3: -+ pre_emphasis = 3; -+ break; -+ default: -+ pre_emphasis = 0; -+ break; -+ } -+ -+ switch (link_rate) { -+ case 810000: -+ link_rate_index = 3; -+ break; -+ case 540000: -+ link_rate_index = 2; -+ break; -+ case 270000: -+ link_rate_index = 1; -+ break; -+ case 162000: -+ link_rate_index = 0; -+ break; -+ default: -+ DRM_ERROR("phytium dp rate(%d) not support\n", link_rate); -+ link_rate_index = 2; -+ break; -+ } -+ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DIAG_ACYA(port), LOCK); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_TXCC_CTRL(port), TX_TXCC_CTRL); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DRV(port), TX_DRV); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_MGNFS(port), -+ mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_CPOST(port), -+ cpost_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DIAG_ACYA(port), UNLOCK); -+} -+ -+static int pe220x_dp_hw_init_phy(struct phytium_dp_device *phytium_dp) -+{ -+ int port = phytium_dp->port; -+ int i = 0, data, tmp, mask; -+ int timeout = 500, ret = 0; -+ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_APB_RESET(port), APB_RESET); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PIPE_RESET(port), RESET); -+ -+ /* config lane to dp mode */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (LANE_BIT << (i * LANE_BIT_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_MODE(port), data); -+ -+ /* pll clock enable */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (PLL_EN << (i * PLL_EN_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_EN(port), data); -+ -+ /* config input 20 bit */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (BIT_20 << (i * BIT_20_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PMA_WIDTH(port), data); -+ -+ /* config lane active power state */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (A0_ACTIVE << (i * A0_ACTIVE_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); -+ -+ /* link reset */ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_LINK_RESET(port), LINK_RESET); -+ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_SGMII_DPSEL_INIT(port), DP_SEL); -+ -+ /* config single link */ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_CFG(port), SINGLE_LINK); -+ -+ /* pipe reset */ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PIPE_RESET(port), RESET_DEASSERT); -+ -+ mask = PLL0_LOCK_DONE; -+ do { -+ mdelay(1); -+ timeout--; -+ tmp = phytium_phy_readl(phytium_dp, PE220X_PHY_PMA_CONTROL2(port)); -+ } while ((!(tmp & mask)) && timeout); -+ -+ if (timeout == 0) { -+ DRM_ERROR("reset dp(%d) phy failed\n", port); -+ ret = -1; -+ } -+ udelay(1); -+ -+ return ret; -+} -+ -+static void pe220x_dp_hw_poweron_panel(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret = 0; -+ -+ gpiod_set_value(priv->edp_power_en, 1); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to poweron panel\n", __func__); -+} -+ -+static void pe220x_dp_hw_poweroff_panel(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret = 0; -+ -+ gpiod_set_value(priv->edp_power_en, 0); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to poweroff panel\n", __func__); -+} -+ -+static void pe220x_dp_hw_enable_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct pwm_state state; -+ int ret = 0; -+ -+ pwm_get_state(phytium_dp->pwm, &state); -+ state.enabled = true; -+ pwm_set_relative_duty_cycle(&state, 50, 100); -+ ret = pwm_apply_state(phytium_dp->pwm, &state); -+ -+ gpiod_set_value(priv->edp_bl_en, 1); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to enable backlight\n", __func__); -+} -+ -+static void pe220x_dp_hw_disable_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret = 0; -+ -+ gpiod_set_value(priv->edp_bl_en, 0); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to disable backlight, ret = %d\n", __func__, ret); -+} -+ -+static uint32_t pe220x_dp_hw_get_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct pwm_state state; -+ uint32_t level; -+ -+ pwm_get_state(phytium_dp->pwm, &state); -+ level = pwm_get_relative_duty_cycle(&state, 100); -+ return level; -+} -+ -+static int pe220x_dp_hw_set_backlight(struct phytium_dp_device *phytium_dp, uint32_t level) -+{ -+ struct pwm_state state; -+ int ret = 0; -+ -+ if (level > PE220X_DP_BACKLIGHT_MAX) { -+ ret = -EINVAL; -+ goto out; -+ } -+ pwm_get_state(phytium_dp->pwm, &state); -+ state.enabled = true; -+ state.period = phytium_dp->pwm->args.period; -+ if (state.period == 0) -+ DRM_ERROR("%s: set pwm period to 0\n", __func__); -+ -+ pwm_set_relative_duty_cycle(&state, level, 100); -+ -+ ret = pwm_apply_state(phytium_dp->pwm, &state); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to set backlight\n", __func__); -+out: -+ return ret; -+} -+ -+bool pe220x_dp_hw_spread_is_enable(struct phytium_dp_device *phytium_dp) -+{ -+ return false; -+} -+ -+int pe220x_dp_hw_reset(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, DP_RESET, group_offset, PE220X_DP_CONTROLLER_RESET); -+ udelay(500); -+ phytium_writel_reg(priv, AUX_CLK_DIVIDER_100, group_offset, PHYTIUM_DP_AUX_CLK_DIVIDER); -+ phytium_writel_reg(priv, SUPPORT_EDP_1_4, group_offset, PHYTIUM_EDP_CRC_ENABLE); -+ -+ return 0; -+} -+ -+uint8_t pe220x_dp_hw_get_source_lane_count(struct phytium_dp_device *phytium_dp) -+{ -+ return pe220x_dp_source_lane_count[phytium_dp->port]; -+} -+ -+static struct phytium_dp_func pe220x_dp_funcs = { -+ .dp_hw_get_source_lane_count = pe220x_dp_hw_get_source_lane_count, -+ .dp_hw_reset = pe220x_dp_hw_reset, -+ .dp_hw_spread_is_enable = pe220x_dp_hw_spread_is_enable, -+ .dp_hw_set_backlight = pe220x_dp_hw_set_backlight, -+ .dp_hw_get_backlight = pe220x_dp_hw_get_backlight, -+ .dp_hw_disable_backlight = pe220x_dp_hw_disable_backlight, -+ .dp_hw_enable_backlight = pe220x_dp_hw_enable_backlight, -+ .dp_hw_poweroff_panel = pe220x_dp_hw_poweroff_panel, -+ .dp_hw_poweron_panel = pe220x_dp_hw_poweron_panel, -+ .dp_hw_init_phy = pe220x_dp_hw_init_phy, -+ .dp_hw_set_phy_lane_setting = pe220x_dp_hw_set_phy_lane_setting, -+ .dp_hw_set_phy_lane_and_rate = pe220x_dp_hw_set_phy_lane_and_rate, -+}; -+ -+void pe220x_dp_func_register(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_dp->funcs = &pe220x_dp_funcs; -+} -diff --git a/drivers/gpu/drm/phytium/pe220x_dp.h b/drivers/gpu/drm/phytium/pe220x_dp.h -new file mode 100644 -index 000000000..f9cf8a0d4 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/pe220x_dp.h -@@ -0,0 +1,15 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium display port DRM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PE220X_DP_H__ -+#define __PE220X_DP_H__ -+ -+#define PE220X_DP_BACKLIGHT_MAX 99 -+#define PE220X_DP_BACKLIGHT_MIN 2 -+ -+void pe220x_dp_func_register(struct phytium_dp_device *phytium_dp); -+#endif /* __PE220X_DP_H__ */ -diff --git a/drivers/gpu/drm/phytium/pe220x_reg.h b/drivers/gpu/drm/phytium/pe220x_reg.h -new file mode 100644 -index 000000000..696be3006 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/pe220x_reg.h -@@ -0,0 +1,209 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium Pe220x display engine register -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PE220X_REG_H__ -+#define __PE220X_REG_H__ -+ -+#include "phytium_reg.h" -+ -+/* dc register */ -+#define PE220X_DC_CLOCK_CONTROL 0x0000 -+#define DC1_CORE_RESET (1<<18) -+#define DC0_CORE_RESET (1<<17) -+#define AXI_RESET (1<<16) -+#define AHB_RESET (1<<12) -+ -+#define PE220X_DC_CMD_REGISTER(pipe) (PE220X_DC_BASE(0) + 0x00F0 + 0x4*(pipe)) -+#define FLAG_REPLY (1<<31) -+#define FLAG_REQUEST (1<<30) -+#define CMD_PIXEL_CLOCK (0x0 << 28) -+#define CMD_BACKLIGHT (0x1 << 28) -+#define CMD_DC_DP_RESET (0x3 << 28) -+#define BACKLIGHT_SHIFT 21 -+#define BACKLIGHT_MASK 0x7f -+#define BACKLIGHT_MAX 100 -+#define BACKLIGHT_ENABLE (101 << BACKLIGHT_SHIFT) -+#define BACKLIGHT_DISABLE (102 << BACKLIGHT_SHIFT) -+#define PANEL_POWER_ENABLE (103 << BACKLIGHT_SHIFT) -+#define PANEL_POWER_DISABLE (104 << BACKLIGHT_SHIFT) -+#define PIXEL_CLOCK_MASK (0x1fffff) -+ -+#define PE220X_DC_FRAMEBUFFER_Y_HI_ADDRESS 0x1404 -+#define PREFIX_MASK 0xff -+#define PREFIX_SHIFT 32 -+ -+#define PE220X_DC_CURSOR_HI_ADDRESS 0x1490 -+#define CURSOR_PREFIX_MASK 0xff -+#define CURSOR_PREFIX_SHIFT 32 -+ -+#define PE220X_DC_FRAMEBUFFER_U_HI_ADDRESS 0x1534 -+#define U_PREFIX_MASK 0xff -+#define U_PREFIX_SHIFT 32 -+ -+#define PE220X_DC_FRAMEBUFFER_V_HI_ADDRESS 0x153c -+#define V_PREFIX_MASK 0xff -+#define V_PREFIX_SHIFT 32 -+ -+/* dp register */ -+#define PE220X_DP_CONTROLLER_RESET 0x0850 -+#define DP_RESET 0x1 -+ -+/* address transform register */ -+#define PE220X_DC_ADDRESS_TRANSFORM_SRC_ADDR 0x0 -+#define SRC_ADDR_OFFSET 22 -+#define SRC_ADDR_MASK 0xffffffffff -+ -+#define PE220X_DC_ADDRESS_TRANSFORM_SIZE 0x4 -+#define ADDRESS_TRANSFORM_ENABLE (0x1 << 31) -+#define SIZE_OFFSET 22 -+ -+#define PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR 0x8 -+#define DST_ADDR_OFFSET 22 -+ -+#define PE220X_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS 0x48 -+#define DC_DP_RESET_STATUS(pipe) (1 << pipe) -+#define DP_SPREAD_ENABLE(pipe) (0x8 << pipe) -+ -+#define PE220X_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE 0x4c -+#define BACKLIGHT_VALUE_MASK (0x7f) -+#define BACKLIGHT_VALUE_SHIFT 16 -+ -+/* phy register start */ -+#define PE220X_PHY_BASE(pipe) (0x100000*pipe) -+ -+#define PE220X_PHY_PIPE_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40254) -+#define RESET 0x0 -+#define RESET_DEASSERT 0x1 -+ -+#define PE220X_PHY_MODE(pipe) (PE220X_PHY_BASE(pipe) + 0x40034) -+#define LANE_BIT (0x3) -+#define LANE_BIT_SHIFT 0x2 -+ -+#define PE220X_PHY_LINK_CFG(pipe) (PE220X_PHY_BASE(pipe) + 0x40044) -+#define LANE_MASTER 0x1 -+#define LANE_MASTER_SHIFT 1 -+ -+#define PE220X_PHY_PLL_EN(pipe) (PE220X_PHY_BASE(pipe) + 0x40214) -+#define PLL_EN 0x1 -+#define PLL_EN_SHIFT 1 -+ -+#define PE220X_PHY_PMA_WIDTH(pipe) (PE220X_PHY_BASE(pipe) + 0x4021c) -+#define BIT_20 0x5 -+#define BIT_20_SHIFT 4 -+ -+#define PE220X_PHY_PLL_SOURCE_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0x4004C) -+ -+#define PE220X_PHY_PMA0_POWER(pipe) (PE220X_PHY_BASE(pipe) + 0x402bc) -+#define A0_ACTIVE 0x1 -+#define A0_ACTIVE_SHIFT 8 -+#define A3_POWERDOWN3 0x8 -+#define A3_POWERDOWN3_SHIFT 8 -+ -+#define PE220X_PHY_LINK_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40258) -+#define LINK_RESET 0x1 -+#define LINK_RESET_MASK 0x1 -+#define LINTK_RESET_SHIFT 0x1 -+ -+#define PE220X_PHY_SGMII_DPSEL_INIT(pipe) (PE220X_PHY_BASE(pipe) + 0x40260) -+#define DP_SEL 0x1 -+ -+#define PE220X_PHY_APB_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40250) -+#define APB_RESET 0x1 -+ -+/* phy origin register */ -+#define PE220X_PHY_PLL_CFG(pipe) (PE220X_PHY_BASE(pipe) + 0x30038) -+#define SINGLE_LINK 0x0 -+ -+#define PE220X_PHY_PMA_CONTROL(pipe) (PE220X_PHY_BASE(pipe) + 0x3800c) -+#define CONTROL_ENABLE 0x1 -+#define CONTROL_ENABLE_MASK 0x1 -+#define CONTROL_ENABLE_SHIFT 0x1 -+ -+#define PE220X_PHY_PMA_CONTROL2(pipe) (PE220X_PHY_BASE(pipe) + 0x38004) -+#define PLL0_LOCK_DONE (0x1 << 6) -+ -+#define PE220X_PHY_PLL0_CLK_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0X684) -+#define PLL_LINK_RATE_162000 0xf01 -+#define PLL_LINK_RATE_270000 0x701 -+#define PLL_LINK_RATE_540000 0x301 -+#define PLL_LINK_RATE_810000 0x200 -+ -+#define PE220X_PHY_HSCLK0_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0x18398) -+#define HSCLK_LINK_0 0x0 -+#define HSCLK_LINK_1 0x1 -+ -+#define PE220X_PHY_HSCLK0_DIV(pipe) (PE220X_PHY_BASE(pipe) + 0x1839c) -+#define HSCLK_LINK_RATE_162000 0x2 -+#define HSCLK_LINK_RATE_270000 0x1 -+#define HSCLK_LINK_RATE_540000 0x0 -+#define HSCLK_LINK_RATE_810000 0x0 -+ -+#define PE220X_PHY_PLLDRC0_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x18394) -+#define PLLDRC_LINK0 0x1 -+#define PLLDRC_LINK1 0x9 -+ -+#define PE220X_PHY_PLL0_DSM_M0(pipe) (PE220X_PHY_BASE(pipe) + 0x250) -+#define PLL0_DSM_M0 0x4 -+#define PE220X_PHY_PLL0_VCOCAL_START(pipe) (PE220X_PHY_BASE(pipe) + 0x218) -+#define PLL0_VCOCAL_START 0xc5e -+#define PE220X_PHY_PLL0_VCOCAL_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x208) -+#define PLL0_VCOCAL_CTRL 0x3 -+ -+#define PE220X_PHY_PLL0_CP_PADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x690) -+#define PE220X_PHY_PLL0_CP_IADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x694) -+#define PE220X_PHY_PLL0_CP_FILT_PADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x698) -+#define PE220X_PHY_PLL0_INTDIV(pipe) (PE220X_PHY_BASE(pipe) + 0x240) -+#define PE220X_PHY_PLL0_FRACDIVL(pipe) (PE220X_PHY_BASE(pipe) + 0x244) -+#define PE220X_PHY_PLL0_FRACDIVH(pipe) (PE220X_PHY_BASE(pipe) + 0x248) -+#define PE220X_PHY_PLL0_HIGH_THR(pipe) (PE220X_PHY_BASE(pipe) + 0x24c) -+#define PE220X_PHY_PLL0_PDIAG_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x680) -+#define PE220X_PHY_PLL0_VCOCAL_PLLCNT_START(pipe) (PE220X_PHY_BASE(pipe) + 0x220) -+#define PE220X_PHY_PLL0_LOCK_PEFCNT(pipe) (PE220X_PHY_BASE(pipe) + 0x270) -+#define PE220X_PHY_PLL0_LOCK_PLLCNT_START(pipe) (PE220X_PHY_BASE(pipe) + 0x278) -+#define PE220X_PHY_PLL0_LOCK_PLLCNT_THR(pipe) (PE220X_PHY_BASE(pipe) + 0x27c) -+ -+#define PE220X_PHY_PLL0_TX_PSC_A0(pipe) (PE220X_PHY_BASE(pipe) + 0x18400) -+#define PLL0_TX_PSC_A0 0xfb -+#define PE220X_PHY_PLL0_TX_PSC_A2(pipe) (PE220X_PHY_BASE(pipe) + 0x18408) -+#define PLL0_TX_PSC_A2 0x4aa -+#define PE220X_PHY_PLL0_TX_PSC_A3(pipe) (PE220X_PHY_BASE(pipe) + 0x1840c) -+#define PLL0_TX_PSC_A3 0x4aa -+#define PE220X_PHY_PLL0_RX_PSC_A0(pipe) (PE220X_PHY_BASE(pipe) + 0x28000) -+#define PLL0_RX_PSC_A0 0x0 -+#define PE220X_PHY_PLL0_RX_PSC_A2(pipe) (PE220X_PHY_BASE(pipe) + 0x28008) -+#define PLL0_RX_PSC_A2 0x0 -+#define PE220X_PHY_PLL0_RX_PSC_A3(pipe) (PE220X_PHY_BASE(pipe) + 0x2800C) -+#define PLL0_RX_PSC_A3 0x0 -+#define PE220X_PHY_PLL0_RX_PSC_CAL(pipe) (PE220X_PHY_BASE(pipe) + 0x28018) -+#define PLL0_RX_PSC_CAL 0x0 -+ -+#define PE220X_PHY_PLL0_XCVR_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x183a8) -+#define PLL0_XCVR_CTRL 0xf -+ -+#define PE220X_PHY_PLL0_RX_GCSM1_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28420) -+#define PLL0_RX_GCSM1_CTRL 0x0 -+#define PE220X_PHY_PLL0_RX_GCSM2_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28440) -+#define PLL0_RX_GCSM2_CTRL 0x0 -+#define PE220X_PHY_PLL0_RX_PERGCSM_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28460) -+#define PLL0_RX_PERGCSM_CTRL 0x0 -+ -+/* swing and emphasis */ -+#define PE220X_PHY_PLL0_TX_DIAG_ACYA(pipe) (PE220X_PHY_BASE(pipe) + 0x1879c) -+#define LOCK 1 -+#define UNLOCK 0 -+ -+#define PE220X_PHY_PLL0_TX_TXCC_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x18100) -+#define TX_TXCC_CTRL 0x8a4 -+ -+#define PE220X_PHY_PLL0_TX_DRV(pipe) (PE220X_PHY_BASE(pipe) + 0x18318) -+#define TX_DRV 0x3 -+ -+#define PE220X_PHY_PLL0_TX_MGNFS(pipe) (PE220X_PHY_BASE(pipe) + 0x18140) -+ -+#define PE220X_PHY_PLL0_TX_CPOST(pipe) (PE220X_PHY_BASE(pipe) + 0x18130) -+ -+#endif /* __PE220X_REG_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_crtc.c b/drivers/gpu/drm/phytium/phytium_crtc.c -new file mode 100644 -index 000000000..2e932418d ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_crtc.c -@@ -0,0 +1,856 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#if defined(__arm__) || defined(__aarch64__) -+#include -+#elif defined(__x86_64) -+#include -+#endif -+#include -+#include "phytium_display_drv.h" -+#include "phytium_crtc.h" -+#include "phytium_plane.h" -+#include "phytium_dp.h" -+#include "px210_dc.h" -+#include "pe220x_dc.h" -+#include "phytium_reg.h" -+ -+#define MAXKERNELSIZE 9 -+#define SUBPIXELINDEXBITS 5 -+#define SUBPIXELCOUNT (1 << SUBPIXELINDEXBITS) -+#define SUBPIXELLOADCOUNT (SUBPIXELCOUNT / 2 + 1) -+#define WEIGHTSTATECOUNT (((SUBPIXELLOADCOUNT * MAXKERNELSIZE + 1) & ~1) / 2) -+#define KERNELTABLESIZE (SUBPIXELLOADCOUNT * MAXKERNELSIZE * sizeof(uint16_t)) -+#define PHYALIGN(n, align) (((n) + ((align) - 1)) & ~((align) - 1)) -+#define KERNELSTATES (PHYALIGN(KERNELTABLESIZE + 4, 8)) -+#define PHYPI 3.14159265358979323846f -+ -+#define MATH_Add(X, Y) (float)((X) + (Y)) -+#define MATH_Multiply(X, Y) (float)((X) * (Y)) -+#define MATH_Divide(X, Y) (float)((X) / (Y)) -+#define MATH_DivideFromUInteger(X, Y) ((float)(X) / (float)(Y)) -+#define MATH_I2Float(X) (float)(X) -+ -+struct filter_blit_array { -+ uint8_t kernelSize; -+ uint32_t scaleFactor; -+ uint32_t *kernelStates; -+}; -+ -+static uint32_t dc_scaling_get_factor(uint32_t src_size, uint32_t dst_size) -+{ -+ uint32_t factor = 0; -+ -+ factor = ((src_size - 1) << SCALE_FACTOR_SRC_OFFSET) / (dst_size - 1); -+ -+ return factor; -+} -+ -+static float dc_sint(float x) -+{ -+ const float B = 1.2732395477; -+ const float C = -0.4052847346; -+ const float P = 0.2310792853; -+ float y; -+ -+ if (x < 0) -+ y = B*x - C*x*x; -+ else -+ y = B*x + C*x*x; -+ if (y < 0) -+ y = P * (y * (0 - y) - y) + y; -+ else -+ y = P * (y * y - y) + y; -+ return y; -+} -+ -+static float dc_sinc_filter(float x, int radius) -+{ -+ float pit, pitd, f1, f2, result; -+ float f_radius = MATH_I2Float(radius); -+ -+ if (x == 0.0f) { -+ result = 1.0f; -+ } else if ((x < -f_radius) || (x > f_radius)) { -+ result = 0.0f; -+ } else { -+ pit = MATH_Multiply(PHYPI, x); -+ pitd = MATH_Divide(pit, f_radius); -+ f1 = MATH_Divide(dc_sint(pit), pit); -+ f2 = MATH_Divide(dc_sint(pitd), pitd); -+ result = MATH_Multiply(f1, f2); -+ } -+ -+ return result; -+} -+ -+static int dc_calculate_sync_table( -+ uint8_t kernel_size, -+ uint32_t src_size, -+ uint32_t dst_size, -+ struct filter_blit_array *kernel_info) -+{ -+ uint32_t scale_factor; -+ float f_scale; -+ int kernel_half; -+ float f_subpixel_step; -+ float f_subpixel_offset; -+ uint32_t subpixel_pos; -+ int kernel_pos; -+ int padding; -+ uint16_t *kernel_array; -+ int range = 0; -+ -+ do { -+ /* Compute the scale factor. */ -+ scale_factor = dc_scaling_get_factor(src_size, dst_size); -+ -+ /* Same kernel size and ratio as before? */ -+ if ((kernel_info->kernelSize == kernel_size) && -+ (kernel_info->scaleFactor == kernel_size)) { -+ break; -+ } -+ -+ /* check the array */ -+ if (kernel_info->kernelStates == NULL) -+ break; -+ -+ /* Store new parameters. */ -+ kernel_info->kernelSize = kernel_size; -+ kernel_info->scaleFactor = scale_factor; -+ -+ /* Compute the scale factor. */ -+ f_scale = MATH_DivideFromUInteger(dst_size, src_size); -+ -+ /* Adjust the factor for magnification. */ -+ if (f_scale > 1.0f) -+ f_scale = 1.0f; -+ -+ /* Calculate the kernel half. */ -+ kernel_half = (int) (kernel_info->kernelSize >> 1); -+ -+ /* Calculate the subpixel step. */ -+ f_subpixel_step = MATH_Divide(1.0f, MATH_I2Float(SUBPIXELCOUNT)); -+ -+ /* Init the subpixel offset. */ -+ f_subpixel_offset = 0.5f; -+ -+ /* Determine kernel padding size. */ -+ padding = (MAXKERNELSIZE - kernel_info->kernelSize) / 2; -+ -+ /* Set initial kernel array pointer. */ -+ kernel_array = (uint16_t *) (kernel_info->kernelStates + 1); -+ -+ /* Loop through each subpixel. */ -+ for (subpixel_pos = 0; subpixel_pos < SUBPIXELLOADCOUNT; subpixel_pos++) { -+ /* Define a temporary set of weights. */ -+ float fSubpixelSet[MAXKERNELSIZE]; -+ -+ /* Init the sum of all weights for the current subpixel. */ -+ float fWeightSum = 0.0f; -+ uint16_t weightSum = 0; -+ short int adjustCount, adjustFrom; -+ short int adjustment; -+ -+ /* Compute weights. */ -+ for (kernel_pos = 0; kernel_pos < MAXKERNELSIZE; kernel_pos++) { -+ /* Determine the current index. */ -+ int index = kernel_pos - padding; -+ -+ /* Pad with zeros. */ -+ if ((index < 0) || (index >= kernel_info->kernelSize)) { -+ fSubpixelSet[kernel_pos] = 0.0f; -+ } else { -+ if (kernel_info->kernelSize == 1) { -+ fSubpixelSet[kernel_pos] = 1.0f; -+ } else { -+ /* Compute the x position for filter function. */ -+ float fX = MATH_Add( -+ MATH_I2Float(index - kernel_half), -+ f_subpixel_offset); -+ fX = MATH_Multiply(fX, f_scale); -+ -+ /* Compute the weight. */ -+ fSubpixelSet[kernel_pos] = dc_sinc_filter(fX, -+ kernel_half); -+ } -+ -+ /* Update the sum of weights. */ -+ fWeightSum = MATH_Add(fWeightSum, -+ fSubpixelSet[kernel_pos]); -+ } -+ } -+ -+ /* Adjust weights so that the sum will be 1.0. */ -+ for (kernel_pos = 0; kernel_pos < MAXKERNELSIZE; kernel_pos++) { -+ /* Normalize the current weight. */ -+ float fWeight = MATH_Divide(fSubpixelSet[kernel_pos], -+ fWeightSum); -+ -+ /* Convert the weight to fixed point and store in the table. */ -+ if (fWeight == 0.0f) -+ kernel_array[kernel_pos] = 0x0000; -+ else if (fWeight >= 1.0f) -+ kernel_array[kernel_pos] = 0x4000; -+ else if (fWeight <= -1.0f) -+ kernel_array[kernel_pos] = 0xC000; -+ else -+ kernel_array[kernel_pos] = -+ (int16_t) MATH_Multiply(fWeight, 16384.0f); -+ weightSum += kernel_array[kernel_pos]; -+ } -+ -+ /* Adjust the fixed point coefficients. */ -+ adjustCount = 0x4000 - weightSum; -+ if (adjustCount < 0) { -+ adjustCount = -adjustCount; -+ adjustment = -1; -+ } else { -+ adjustment = 1; -+ } -+ -+ adjustFrom = (MAXKERNELSIZE - adjustCount) / 2; -+ for (kernel_pos = 0; kernel_pos < adjustCount; kernel_pos++) { -+ range = (MAXKERNELSIZE*subpixel_pos + adjustFrom + kernel_pos) * -+ sizeof(uint16_t); -+ if ((range >= 0) && (range < KERNELTABLESIZE)) -+ kernel_array[adjustFrom + kernel_pos] += adjustment; -+ else -+ DRM_ERROR("%s failed\n", __func__); -+ } -+ -+ kernel_array += MAXKERNELSIZE; -+ -+ /* Advance to the next subpixel. */ -+ f_subpixel_offset = MATH_Add(f_subpixel_offset, -f_subpixel_step); -+ } -+ } while (0); -+ -+ return 0; -+} -+ -+static void phytium_dc_scaling_config(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_state) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct drm_display_mode *mode = &crtc->state->adjusted_mode; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ uint32_t scale_factor_x, scale_factor_y, i; -+ uint32_t kernelStates[128]; -+ struct filter_blit_array kernel_info_width; -+ void *tmp = NULL; -+ -+ if (mode->hdisplay != mode->crtc_hdisplay || mode->vdisplay != mode->crtc_vdisplay) { -+ phytium_crtc->src_width = mode->hdisplay; -+ phytium_crtc->src_height = mode->vdisplay; -+ phytium_crtc->dst_width = mode->crtc_hdisplay; -+ phytium_crtc->dst_height = mode->crtc_vdisplay; -+ -+ phytium_crtc->dst_x = (mode->crtc_hdisplay - phytium_crtc->dst_width) / 2; -+ phytium_crtc->dst_y = (mode->crtc_vdisplay - phytium_crtc->dst_height) / 2; -+ -+ scale_factor_x = dc_scaling_get_factor(phytium_crtc->src_width, -+ phytium_crtc->dst_width); -+ scale_factor_y = dc_scaling_get_factor(phytium_crtc->src_height, -+ phytium_crtc->dst_height); -+ if (scale_factor_y > (SCALE_FACTOR_Y_MAX << SCALE_FACTOR_SRC_OFFSET)) -+ scale_factor_y = (SCALE_FACTOR_Y_MAX << SCALE_FACTOR_SRC_OFFSET); -+ -+ phytium_writel_reg(priv, scale_factor_x & SCALE_FACTOR_X_MASK, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_X); -+ phytium_writel_reg(priv, scale_factor_y & SCALE_FACTOR_Y_MASK, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_Y); -+ phytium_writel_reg(priv, FRAMEBUFFER_TAP, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALECONFIG); -+ -+ tmp = kmalloc(KERNELSTATES, GFP_KERNEL); -+ if (!tmp) { -+ DRM_ERROR("malloc %ld failed\n", KERNELSTATES); -+ return; -+ } -+ -+ memset(&kernel_info_width, 0, sizeof(struct filter_blit_array)); -+ kernel_info_width.kernelStates = tmp; -+ memset(kernel_info_width.kernelStates, 0, KERNELSTATES); -+#if defined(__arm__) || defined(__aarch64__) -+ kernel_neon_begin(); -+#elif defined(__x86_64__) -+ kernel_fpu_begin(); -+#endif -+ dc_calculate_sync_table(FRAMEBUFFER_HORIZONTAL_FILTER_TAP, -+ phytium_crtc->src_width, -+ phytium_crtc->dst_width, -+ &kernel_info_width); -+ memset(kernelStates, 0, sizeof(kernelStates)); -+ memcpy(kernelStates, kernel_info_width.kernelStates + 1, KERNELSTATES - 4); -+#if defined(__arm__) || defined(__aarch64__) -+ kernel_neon_end(); -+#elif defined(__x86_64__) -+ kernel_fpu_end(); -+#endif -+ phytium_writel_reg(priv, HORI_FILTER_INDEX, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER_INDEX); -+ for (i = 0; i < 128; i++) { -+ phytium_writel_reg(priv, kernelStates[i], -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER); -+ } -+ -+ memset(&kernel_info_width, 0, sizeof(struct filter_blit_array)); -+ kernel_info_width.kernelStates = tmp; -+ memset(kernel_info_width.kernelStates, 0, KERNELSTATES); -+#if defined(__arm__) || defined(__aarch64__) -+ kernel_neon_begin(); -+#elif defined(__x86_64__) -+ kernel_fpu_begin(); -+#endif -+ dc_calculate_sync_table(FRAMEBUFFER_FILTER_TAP, phytium_crtc->src_height, -+ phytium_crtc->dst_height, &kernel_info_width); -+ memset(kernelStates, 0, sizeof(kernelStates)); -+ memcpy(kernelStates, kernel_info_width.kernelStates + 1, KERNELSTATES - 4); -+#if defined(__arm__) || defined(__aarch64__) -+ kernel_neon_end(); -+#elif defined(__x86_64__) -+ kernel_fpu_end(); -+#endif -+ phytium_writel_reg(priv, VERT_FILTER_INDEX, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER_INDEX); -+ for (i = 0; i < 128; i++) -+ phytium_writel_reg(priv, kernelStates[i], -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER); -+ phytium_writel_reg(priv, INITIALOFFSET, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_INITIALOFFSET); -+ kfree(tmp); -+ phytium_crtc->scale_enable = true; -+ } else { -+ phytium_crtc->scale_enable = false; -+ } -+} -+ -+static void phytium_crtc_gamma_set(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ uint32_t config = 0, data; -+ struct drm_crtc_state *state = crtc->state; -+ struct drm_color_lut *lut; -+ unsigned long flags; -+ uint32_t active_line = 0, timeout = 500; -+ int i; -+ -+ if (state->gamma_lut) { -+ if (WARN((state->gamma_lut->length/sizeof(struct drm_color_lut) != GAMMA_INDEX_MAX), -+ "gamma size is not match\n")) -+ return; -+ lut = (struct drm_color_lut *)state->gamma_lut->data; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ if (config & FRAMEBUFFER_OUTPUT) { -+ struct drm_display_mode *mode = &state->adjusted_mode; -+ uint32_t frame_time; -+ uint32_t value_a, value_b; -+ -+ frame_time = mode->crtc_vtotal * mode->crtc_htotal / mode->crtc_clock; -+ value_b = (frame_time - 2) * mode->crtc_vtotal; -+ local_irq_save(flags); -+ do { -+ active_line = phytium_readl_reg(priv, group_offset, -+ PHYTIUM_DC_LOCATION); -+ active_line = active_line >> LOVATION_Y_SHIFT; -+ value_a = (mode->crtc_vblank_end - mode->crtc_vblank_start + -+ active_line) * frame_time; -+ if (value_a < value_b) -+ break; -+ local_irq_restore(flags); -+ udelay(1000); -+ timeout--; -+ local_irq_save(flags); -+ } while (timeout); -+ -+ if (timeout == 0) -+ DRM_ERROR("wait gamma active line timeout\n"); -+ } -+ -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DC_GAMMA_INDEX); -+ for (i = 0; i < GAMMA_INDEX_MAX; i++) { -+ data = ((lut[i].red >> 6) & GAMMA_RED_MASK) << GAMMA_RED_SHIFT; -+ data |= (((lut[i].green >> 6) & GAMMA_GREEN_MASK) << GAMMA_GREEN_SHIFT); -+ data |= (((lut[i].blue >> 6) & GAMMA_BLUE_MASK) << GAMMA_BLUE_SHIFT); -+ phytium_writel_reg(priv, data, group_offset, PHYTIUM_DC_GAMMA_DATA); -+ } -+ -+ if (config & FRAMEBUFFER_OUTPUT) -+ local_irq_restore(flags); -+ } -+} -+ -+static void phytium_crtc_gamma_init(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ struct drm_crtc_state *state = crtc->state; -+ uint32_t config = 0, data; -+ uint16_t *red, *green, *blue; -+ unsigned long flags; -+ uint32_t active_line = 0, timeout = 500; -+ int i; -+ -+ if (WARN((crtc->gamma_size != GAMMA_INDEX_MAX), "gamma size is not match\n")) -+ return; -+ -+ red = crtc->gamma_store; -+ green = red + crtc->gamma_size; -+ blue = green + crtc->gamma_size; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ if (config & FRAMEBUFFER_OUTPUT) { -+ struct drm_display_mode *mode = &state->adjusted_mode; -+ uint32_t frame_time; -+ uint32_t value_a, value_b; -+ -+ frame_time = mode->crtc_vtotal * mode->crtc_htotal / mode->crtc_clock; -+ value_b = (frame_time - 2) * mode->crtc_vtotal; -+ local_irq_save(flags); -+ do { -+ active_line = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_LOCATION); -+ active_line = active_line >> LOVATION_Y_SHIFT; -+ value_a = (mode->crtc_vblank_end - mode->crtc_vblank_start + -+ active_line) * frame_time; -+ if (value_a < value_b) -+ break; -+ local_irq_restore(flags); -+ udelay(1000); -+ timeout--; -+ local_irq_save(flags); -+ } while (timeout); -+ -+ if (timeout == 0) -+ DRM_ERROR("wait gamma active line timeout\n"); -+ } -+ -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DC_GAMMA_INDEX); -+ for (i = 0; i < GAMMA_INDEX_MAX; i++) { -+ data = ((*red++ >> 6) & GAMMA_RED_MASK) << GAMMA_RED_SHIFT; -+ data |= (((*green++ >> 6) & GAMMA_GREEN_MASK) << GAMMA_GREEN_SHIFT); -+ data |= (((*blue++ >> 6) & GAMMA_BLUE_MASK) << GAMMA_BLUE_SHIFT); -+ phytium_writel_reg(priv, data, group_offset, PHYTIUM_DC_GAMMA_DATA); -+ } -+ -+ if (config & FRAMEBUFFER_OUTPUT) -+ local_irq_restore(flags); -+} -+ -+static void phytium_crtc_destroy(struct drm_crtc *crtc) -+{ -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ -+ drm_crtc_cleanup(crtc); -+ kfree(phytium_crtc); -+} -+ -+struct drm_crtc_state * -+phytium_crtc_atomic_duplicate_state(struct drm_crtc *crtc) -+{ -+ struct phytium_crtc_state *phytium_crtc_state = NULL; -+ -+ phytium_crtc_state = kmemdup(crtc->state, sizeof(*phytium_crtc_state), -+ GFP_KERNEL); -+ if (!phytium_crtc_state) -+ return NULL; -+ __drm_atomic_helper_crtc_duplicate_state(crtc, -+ &phytium_crtc_state->base); -+ -+ return &phytium_crtc_state->base; -+} -+ -+void -+phytium_crtc_atomic_destroy_state(struct drm_crtc *crtc, -+ struct drm_crtc_state *state) -+{ -+ struct phytium_crtc_state *phytium_crtc_state = -+ to_phytium_crtc_state(state); -+ -+ phytium_crtc_state = to_phytium_crtc_state(state); -+ __drm_atomic_helper_crtc_destroy_state(state); -+ kfree(phytium_crtc_state); -+} -+ -+static int phytium_enable_vblank(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ -+ phytium_writel_reg(priv, INT_ENABLE, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_INT_ENABLE); -+ -+ return 0; -+} -+ -+static void phytium_disable_vblank(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ -+ phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_INT_ENABLE); -+} -+ -+static const struct drm_crtc_funcs phytium_crtc_funcs = { -+ .gamma_set = drm_atomic_helper_legacy_gamma_set, -+ .set_config = drm_atomic_helper_set_config, -+ .destroy = phytium_crtc_destroy, -+ .page_flip = drm_atomic_helper_page_flip, -+ .reset = drm_atomic_helper_crtc_reset, -+ .atomic_duplicate_state = phytium_crtc_atomic_duplicate_state, -+ .atomic_destroy_state = phytium_crtc_atomic_destroy_state, -+ .enable_vblank = phytium_enable_vblank, -+ .disable_vblank = phytium_disable_vblank, -+}; -+ -+static void -+phytium_crtc_atomic_enable(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_state) -+{ -+ struct drm_atomic_state *state = old_state->state; -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct drm_display_mode *mode = &crtc->state->adjusted_mode; -+ struct drm_connector_state *new_conn_state; -+ struct drm_connector *conn; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ int config = 0, i = 0; -+ -+ for_each_new_connector_in_state(state, conn, new_conn_state, i) { -+ if (new_conn_state->crtc != crtc) -+ continue; -+ -+ switch (conn->display_info.bpc) { -+ case 10: -+ phytium_crtc->bpc = DP_RGB101010; -+ break; -+ case 6: -+ phytium_crtc->bpc = DP_RGB666; -+ break; -+ default: -+ phytium_crtc->bpc = DP_RGB888; -+ break; -+ } -+ } -+ -+ /* config pix clock */ -+ phytium_crtc->dc_hw_config_pix_clock(crtc, mode->clock); -+ -+ phytium_dc_scaling_config(crtc, old_state); -+ config = ((mode->crtc_hdisplay & HDISPLAY_END_MASK) << HDISPLAY_END_SHIFT) -+ | ((mode->crtc_htotal&HDISPLAY_TOTAL_MASK) << HDISPLAY_TOTAL_SHIFT); -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_HDISPLAY); -+ config = ((mode->crtc_hsync_start & HSYNC_START_MASK) << HSYNC_START_SHIFT) -+ | ((mode->crtc_hsync_end & HSYNC_END_MASK) << HSYNC_END_SHIFT) -+ | HSYNC_PULSE_ENABLED; -+ config |= (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : HSYNC_NEGATIVE; -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_HSYNC); -+ config = ((mode->crtc_vdisplay & VDISPLAY_END_MASK) << VDISPLAY_END_SHIFT) -+ | ((mode->crtc_vtotal & VDISPLAY_TOTAL_MASK) << VDISPLAY_TOTAL_SHIFT); -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_VDISPLAY); -+ config = ((mode->crtc_vsync_start & VSYNC_START_MASK) << VSYNC_START_SHIFT) -+ | ((mode->crtc_vsync_end & VSYNC_END_MASK) << VSYNC_END_SHIFT) -+ | VSYNC_PULSE_ENABLED; -+ config |= (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : VSYNC_NEGATIVE; -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_VSYNC); -+ config = PANEL_DATAENABLE_ENABLE | PANEL_DATA_ENABLE | PANEL_CLOCK_ENABLE; -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_PANEL_CONFIG); -+ config = phytium_crtc->bpc | OUTPUT_DP; -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_DP_CONFIG); -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ -+ if (crtc->state->active) -+ config |= FRAMEBUFFER_OUTPUT | FRAMEBUFFER_RESET; -+ else -+ config &= (~(FRAMEBUFFER_OUTPUT | FRAMEBUFFER_RESET)); -+ -+ if (phytium_crtc->scale_enable) -+ config |= FRAMEBUFFER_SCALE_ENABLE; -+ else -+ config &= (~FRAMEBUFFER_SCALE_ENABLE); -+ -+ if (!priv->info.bmc_mode) -+ config |= FRAMEBUFFER_GAMMA_ENABLE; -+ -+ if (crtc->state->gamma_lut) -+ phytium_crtc_gamma_set(crtc); -+ else -+ phytium_crtc_gamma_init(crtc); -+ -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ drm_crtc_vblank_on(crtc); -+} -+ -+static void -+phytium_crtc_atomic_disable(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_state) -+{ -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ -+ drm_crtc_vblank_off(crtc); -+ phytium_crtc->dc_hw_disable(crtc); -+} -+ -+static void phytium_crtc_update_timing_for_drm_display_mode(struct drm_display_mode *drm_mode, -+ const struct drm_display_mode *native_mode) -+{ -+ if (native_mode->clock == drm_mode->clock && -+ native_mode->htotal == drm_mode->htotal && -+ native_mode->vtotal == drm_mode->vtotal) { -+ drm_mode->crtc_hdisplay = native_mode->crtc_hdisplay; -+ drm_mode->crtc_vdisplay = native_mode->crtc_vdisplay; -+ drm_mode->crtc_clock = native_mode->crtc_clock; -+ drm_mode->crtc_hblank_start = native_mode->crtc_hblank_start; -+ drm_mode->crtc_hblank_end = native_mode->crtc_hblank_end; -+ drm_mode->crtc_hsync_start = native_mode->crtc_hsync_start; -+ drm_mode->crtc_hsync_end = native_mode->crtc_hsync_end; -+ drm_mode->crtc_htotal = native_mode->crtc_htotal; -+ drm_mode->crtc_hskew = native_mode->crtc_hskew; -+ drm_mode->crtc_vblank_start = native_mode->crtc_vblank_start; -+ drm_mode->crtc_vblank_end = native_mode->crtc_vblank_end; -+ drm_mode->crtc_vsync_start = native_mode->crtc_vsync_start; -+ drm_mode->crtc_vsync_end = native_mode->crtc_vsync_end; -+ drm_mode->crtc_vtotal = native_mode->crtc_vtotal; -+ } -+} -+ -+static int -+phytium_crtc_atomic_check(struct drm_crtc *crtc, struct drm_crtc_state *crtc_state) -+{ -+ struct drm_atomic_state *state = crtc_state->state; -+ struct drm_plane_state *new_plane_state = NULL; -+ int ret = 0; -+ struct drm_connector *connector; -+ struct drm_connector_state *new_con_state; -+ uint32_t i; -+ struct phytium_dp_device *phytium_dp = NULL; -+ -+ for_each_new_connector_in_state(state, connector, new_con_state, i) { -+ if (new_con_state->crtc == crtc) { -+ phytium_dp = connector_to_dp_device(connector); -+ break; -+ } -+ } -+ if (phytium_dp) -+ phytium_crtc_update_timing_for_drm_display_mode(&crtc_state->adjusted_mode, -+ &phytium_dp->native_mode); -+ -+ new_plane_state = drm_atomic_get_new_plane_state(crtc_state->state, -+ crtc->primary); -+ if (crtc_state->enable && new_plane_state && !new_plane_state->crtc) { -+ ret = -EINVAL; -+ goto fail; -+ } -+ -+ return 0; -+fail: -+ return ret; -+} -+ -+static void -+phytium_crtc_atomic_begin(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_crtc_state) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe, config; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ if (config & FRAMEBUFFER_RESET) { -+ phytium_writel_reg(priv, config | FRAMEBUFFER_VALID_PENDING, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ } -+} -+ -+static void phytium_crtc_atomic_flush(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_crtc_state) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ struct phytium_crtc_state *phytium_crtc_state = NULL; -+ int phys_pipe = phytium_crtc->phys_pipe, config; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ -+ DRM_DEBUG_KMS("crtc->state active:%d enable:%d\n", -+ crtc->state->active, crtc->state->enable); -+ phytium_crtc_state = to_phytium_crtc_state(crtc->state); -+ -+ if (crtc->state->color_mgmt_changed) -+ phytium_crtc_gamma_set(crtc); -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ phytium_writel_reg(priv, config&(~FRAMEBUFFER_VALID_PENDING), -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ -+ if (crtc->state->event) { -+ DRM_DEBUG_KMS("vblank->refcount:%d\n", -+ atomic_read(&dev->vblank[0].refcount)); -+ spin_lock_irq(&dev->event_lock); -+ if (drm_crtc_vblank_get(crtc) == 0) -+ drm_crtc_arm_vblank_event(crtc, crtc->state->event); -+ else -+ drm_crtc_send_vblank_event(crtc, crtc->state->event); -+ crtc->state->event = NULL; -+ spin_unlock_irq(&dev->event_lock); -+ } -+} -+ -+static enum drm_mode_status -+phytium_crtc_mode_valid(struct drm_crtc *crtc, const struct drm_display_mode *mode) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ if (mode->crtc_clock > priv->info.crtc_clock_max) -+ return MODE_CLOCK_HIGH; -+ -+ if (mode->hdisplay > priv->info.hdisplay_max) -+ return MODE_BAD_HVALUE; -+ -+ if (mode->vdisplay > priv->info.vdisplay_max) -+ return MODE_BAD_VVALUE; -+ -+ if (mode->flags & DRM_MODE_FLAG_INTERLACE) -+ return MODE_NO_INTERLACE; -+ -+ return MODE_OK; -+} -+ -+static const struct drm_crtc_helper_funcs phytium_crtc_helper_funcs = { -+ .mode_valid = phytium_crtc_mode_valid, -+ .atomic_check = phytium_crtc_atomic_check, -+ .atomic_begin = phytium_crtc_atomic_begin, -+ .atomic_flush = phytium_crtc_atomic_flush, -+ .atomic_enable = phytium_crtc_atomic_enable, -+ .atomic_disable = phytium_crtc_atomic_disable, -+}; -+ -+void phytium_crtc_resume(struct drm_device *drm_dev) -+{ -+ struct drm_crtc *crtc; -+ struct phytium_crtc *phytium_crtc = NULL; -+ -+ drm_for_each_crtc(crtc, drm_dev) { -+ phytium_crtc = to_phytium_crtc(crtc); -+ if (phytium_crtc->dc_hw_reset) -+ phytium_crtc->dc_hw_reset(crtc); -+ phytium_crtc_gamma_init(crtc); -+ } -+} -+ -+int phytium_crtc_init(struct drm_device *dev, int phys_pipe) -+{ -+ struct phytium_crtc *phytium_crtc; -+ struct phytium_crtc_state *phytium_crtc_state; -+ struct phytium_plane *phytium_primary_plane = NULL; -+ struct phytium_plane *phytium_cursor_plane = NULL; -+ struct drm_plane *cursor_base = NULL; -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret; -+ -+ phytium_crtc = kzalloc(sizeof(*phytium_crtc), GFP_KERNEL); -+ if (!phytium_crtc) { -+ ret = -ENOMEM; -+ goto failed_malloc_crtc; -+ } -+ -+ phytium_crtc_state = kzalloc(sizeof(*phytium_crtc_state), GFP_KERNEL); -+ if (!phytium_crtc_state) { -+ ret = -ENOMEM; -+ goto failed_malloc_crtc_state; -+ } -+ -+ phytium_crtc_state->base.crtc = &phytium_crtc->base; -+ phytium_crtc->base.state = &phytium_crtc_state->base; -+ phytium_crtc->phys_pipe = phys_pipe; -+ -+ if (IS_PX210(priv)) { -+ phytium_crtc->dc_hw_config_pix_clock = px210_dc_hw_config_pix_clock; -+ phytium_crtc->dc_hw_disable = px210_dc_hw_disable; -+ phytium_crtc->dc_hw_reset = NULL; -+ priv->dc_reg_base[phys_pipe] = PX210_DC_BASE(phys_pipe); -+ priv->dcreq_reg_base[phys_pipe] = PX210_DCREQ_BASE(phys_pipe); -+ priv->address_transform_base = PX210_ADDRESS_TRANSFORM_BASE; -+ } else if (IS_PE220X(priv)) { -+ phytium_crtc->dc_hw_config_pix_clock = pe220x_dc_hw_config_pix_clock; -+ phytium_crtc->dc_hw_disable = pe220x_dc_hw_disable; -+ phytium_crtc->dc_hw_reset = pe220x_dc_hw_reset; -+ priv->dc_reg_base[phys_pipe] = PE220X_DC_BASE(phys_pipe); -+ priv->dcreq_reg_base[phys_pipe] = 0x0; -+ priv->address_transform_base = PE220X_ADDRESS_TRANSFORM_BASE; -+ } -+ -+ phytium_primary_plane = phytium_primary_plane_create(dev, phys_pipe); -+ if (IS_ERR(phytium_primary_plane)) { -+ ret = PTR_ERR(phytium_primary_plane); -+ DRM_ERROR("create primary plane failed, phys_pipe(%d)\n", phys_pipe); -+ goto failed_create_primary; -+ } -+ -+ if (priv->info.bmc_mode) { -+ cursor_base = NULL; -+ } else { -+ phytium_cursor_plane = phytium_cursor_plane_create(dev, phys_pipe); -+ if (IS_ERR(phytium_cursor_plane)) { -+ ret = PTR_ERR(phytium_cursor_plane); -+ DRM_ERROR("create cursor plane failed, phys_pipe(%d)\n", phys_pipe); -+ goto failed_create_cursor; -+ } -+ cursor_base = &phytium_cursor_plane->base; -+ } -+ -+ ret = drm_crtc_init_with_planes(dev, &phytium_crtc->base, -+ &phytium_primary_plane->base, -+ cursor_base, -+ &phytium_crtc_funcs, -+ "phys_pipe %d", phys_pipe); -+ -+ if (ret) { -+ DRM_ERROR("init crtc with plane failed, phys_pipe(%d)\n", phys_pipe); -+ goto failed_crtc_init; -+ } -+ drm_crtc_helper_add(&phytium_crtc->base, &phytium_crtc_helper_funcs); -+ drm_crtc_vblank_reset(&phytium_crtc->base); -+ drm_mode_crtc_set_gamma_size(&phytium_crtc->base, GAMMA_INDEX_MAX); -+ drm_crtc_enable_color_mgmt(&phytium_crtc->base, 0, false, GAMMA_INDEX_MAX); -+ if (phytium_crtc->dc_hw_reset) -+ phytium_crtc->dc_hw_reset(&phytium_crtc->base); -+ -+ return 0; -+ -+failed_crtc_init: -+failed_create_cursor: -+ /* drm_mode_config_cleanup() will free any crtcs/planes already initialized */ -+failed_create_primary: -+ kfree(phytium_crtc_state); -+failed_malloc_crtc_state: -+ kfree(phytium_crtc); -+failed_malloc_crtc: -+ return ret; -+} -diff --git a/drivers/gpu/drm/phytium/phytium_crtc.h b/drivers/gpu/drm/phytium/phytium_crtc.h -new file mode 100644 -index 000000000..8c5b2eb0e ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_crtc.h -@@ -0,0 +1,39 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_CRTC_H__ -+#define __PHYTIUM_CRTC_H__ -+ -+struct phytium_crtc { -+ struct drm_crtc base; -+ int phys_pipe; -+ unsigned int bpc; -+ -+ /* scale */ -+ uint32_t src_width; -+ uint32_t src_height; -+ uint32_t dst_width; -+ uint32_t dst_height; -+ uint32_t dst_x; -+ uint32_t dst_y; -+ bool scale_enable; -+ bool reserve[3]; -+ -+ void (*dc_hw_config_pix_clock)(struct drm_crtc *crtc, int clock); -+ void (*dc_hw_disable)(struct drm_crtc *crtc); -+ void (*dc_hw_reset)(struct drm_crtc *crtc); -+}; -+ -+struct phytium_crtc_state { -+ struct drm_crtc_state base; -+}; -+ -+#define to_phytium_crtc(x) container_of(x, struct phytium_crtc, base) -+#define to_phytium_crtc_state(x) container_of(x, struct phytium_crtc_state, base) -+ -+void phytium_crtc_resume(struct drm_device *drm_dev); -+int phytium_crtc_init(struct drm_device *dev, int pipe); -+#endif /* __PHYTIUM_CRTC_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_debugfs.c b/drivers/gpu/drm/phytium/phytium_debugfs.c -new file mode 100644 -index 000000000..8cd6c338d ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_debugfs.c -@@ -0,0 +1,456 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_dp.h" -+#include "phytium_reg.h" -+ -+const char *const mem_state[PHYTIUM_MEM_STATE_TYPE_COUNT] = { -+ "Memory_Vram_Total", -+ "Memory_Vram_Alloc", -+ "Memory_System_Carveout_Total", -+ "Memory_System_Carveout_Alloc", -+ "Memory_System_Alloc", -+}; -+ -+static ssize_t -+phytium_dp_register_write(struct file *filp, -+ const char __user *ubuf, -+ size_t len, -+ loff_t *ppos) -+{ -+ char tmp[16]; -+ -+ if (len >= sizeof(tmp)) -+ return -EINVAL; -+ -+ memset(tmp, 0, sizeof(tmp)); -+ if (copy_from_user(tmp, ubuf, len)) -+ return -EFAULT; -+ tmp[len] = '\0'; -+ -+ return len; -+} -+ -+static int phytium_dp_register_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_M_VID, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_M_VID)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_N_VID, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_N_VID)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_TRANSFER_UNIT_SIZE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_TRANSFER_UNIT_SIZE)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_DATA_COUNT, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_DATA_COUNT)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HTOTAL, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HTOTAL)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HRES, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HRES)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HSWIDTH, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HSWIDTH)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HSTART, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HSTART)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VTOTAL, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VTOTAL)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VRES, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VRES)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VSWIDTH, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VSWIDTH)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VSTART, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VSTART)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_POLARITY, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_POLARITY)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_MISC0, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_MISC0)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_MISC1, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_MISC1)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_USER_SYNC_POLARITY, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_USER_SYNC_POLARITY)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_VIDEO_STREAM_ENABLE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SECONDARY_STREAM_ENABLE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE)); -+ seq_puts(m, "audio:\n"); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_INPUT_SELECT, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_INPUT_SELECT)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_DIRECT_CLKDIV, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_DIRECT_CLKDIV)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CHANNEL_COUNT, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CHANNEL_COUNT)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CHANNEL_MAP, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CHANNEL_MAP)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_DATA_WINDOW, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_CATEGORY_CODE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_CATEGORY_CODE)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_MAUD, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_MAUD)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_NAUD, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_NAUD)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CLOCK_MODE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CLOCK_MODE)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_SOURCE_FORMAT, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_SOURCE_FORMAT)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_AUDIO_ENABLE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE)); -+ -+ return 0; -+} -+ -+static int phytium_dp_register_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_dp_register_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_dp_register_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_dp_register_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = phytium_dp_register_write, -+}; -+ -+static ssize_t -+phytium_dp_trigger_train_fail_write(struct file *filp, -+ const char __user *ubuf, -+ size_t len, -+ loff_t *ppos) -+{ -+ struct seq_file *m = filp->private_data; -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ char tmp[16]; -+ -+ if (len >= sizeof(tmp)) -+ return -EINVAL; -+ -+ memset(tmp, 0, sizeof(tmp)); -+ if (copy_from_user(tmp, ubuf, len)) -+ return -EFAULT; -+ tmp[len] = '\0'; -+ -+ if (kstrtouint(tmp, 10, &phytium_dp->trigger_train_fail) != 0) -+ return -EINVAL; -+ -+ return len; -+} -+ -+static int phytium_dp_trigger_train_fail_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ seq_printf(m, "trigger_train_fail: %d\n", phytium_dp->trigger_train_fail); -+ seq_printf(m, "train_retry_count: %d\n", phytium_dp->train_retry_count); -+ -+ return 0; -+} -+ -+static int phytium_dp_trigger_train_fail_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_dp_trigger_train_fail_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_dp_trigger_train_fail_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_dp_trigger_train_fail_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = phytium_dp_trigger_train_fail_write, -+}; -+ -+static int phytium_edp_backlight_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ if (!phytium_dp->is_edp) -+ return -ENODEV; -+ -+ mutex_lock(&phytium_dp->panel.panel_lock); -+ seq_printf(m, "backlight: %s\n", phytium_dp->panel.backlight_enabled?"enabled":"disabled"); -+ mutex_unlock(&phytium_dp->panel.panel_lock); -+ -+ return 0; -+} -+ -+static int phytium_edp_backlight_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_edp_backlight_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_edp_backlight_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_edp_backlight_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+}; -+ -+static int phytium_edp_power_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ if (!phytium_dp->is_edp) -+ return -ENODEV; -+ -+ mutex_lock(&phytium_dp->panel.panel_lock); -+ seq_printf(m, "power: %s\n", phytium_dp->panel.power_enabled?"enabled":"disabled"); -+ mutex_unlock(&phytium_dp->panel.panel_lock); -+ -+ return 0; -+} -+ -+static int phytium_edp_power_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_edp_power_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_edp_power_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_edp_power_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+}; -+ -+struct dpcd_block { -+ /* DPCD dump start address. */ -+ unsigned int offset; -+ /* DPCD dump end address, inclusive. If unset, .size will be used. */ -+ unsigned int end; -+ /* DPCD dump size. Used if .end is unset. If unset, defaults to 1. */ -+ size_t size; -+ /* Only valid for eDP. */ -+ bool edp; -+}; -+ -+static const struct dpcd_block phytium_dpcd_debug[] = { -+ { .offset = DP_DPCD_REV, .size = DP_RECEIVER_CAP_SIZE }, -+ { .offset = DP_PSR_SUPPORT, .end = DP_PSR_CAPS }, -+ { .offset = DP_DOWNSTREAM_PORT_0, .size = 16 }, -+ { .offset = DP_LINK_BW_SET, .end = DP_EDP_CONFIGURATION_SET }, -+ { .offset = DP_SINK_COUNT, .end = DP_ADJUST_REQUEST_LANE2_3 }, -+ { .offset = DP_SET_POWER }, -+ { .offset = DP_EDP_DPCD_REV }, -+ { .offset = DP_EDP_GENERAL_CAP_1, .end = DP_EDP_GENERAL_CAP_3 }, -+ { .offset = DP_EDP_DISPLAY_CONTROL_REGISTER, .end = DP_EDP_BACKLIGHT_FREQ_CAP_MAX_LSB }, -+ { .offset = DP_EDP_DBC_MINIMUM_BRIGHTNESS_SET, .end = DP_EDP_DBC_MAXIMUM_BRIGHTNESS_SET }, -+ { .offset = DP_DEVICE_SERVICE_IRQ_VECTOR, .size = 1 }, -+ { .offset = DP_TEST_REQUEST, .end = DP_TEST_PATTERN }, -+}; -+ -+static int phytium_dpcd_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ uint8_t buf[16], i; -+ ssize_t err; -+ -+ if (connector->status != connector_status_connected) -+ return -ENODEV; -+ -+ for (i = 0; i < ARRAY_SIZE(phytium_dpcd_debug); i++) { -+ const struct dpcd_block *b = &phytium_dpcd_debug[i]; -+ size_t size = b->end ? b->end - b->offset + 1 : (b->size ?: 1); -+ -+ if (WARN_ON(size > sizeof(buf))) -+ continue; -+ -+ err = drm_dp_dpcd_read(&phytium_dp->aux, b->offset, buf, size); -+ if (err <= 0) { -+ DRM_ERROR("dpcd read (%zu bytes at %u) failed (%zd)\n", -+ size, b->offset, err); -+ continue; -+ } -+ -+ seq_printf(m, "%04x: %*ph\n", b->offset, (int) size, buf); -+ } -+ -+ return 0; -+} -+ -+static int phytium_dpcd_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_dpcd_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_dpcd_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_dpcd_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+}; -+ -+static ssize_t -+phytium_dp_state_write(struct file *filp, -+ const char __user *ubuf, -+ size_t len, -+ loff_t *ppos) -+{ -+ char tmp[16]; -+ -+ if (len >= sizeof(tmp)) -+ return -EINVAL; -+ -+ memset(tmp, 0, sizeof(tmp)); -+ if (copy_from_user(tmp, ubuf, len)) -+ return -EFAULT; -+ tmp[len] = '\0'; -+ -+ return len; -+} -+ -+static int phytium_dp_state_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ seq_printf(m, "port number: %d\n", phytium_dp->port); -+ seq_printf(m, "source_max_lane_count: %d\n", phytium_dp->source_max_lane_count); -+ seq_printf(m, "max_source_rates: %d\n", -+ phytium_dp->source_rates[phytium_dp->num_source_rates-1]); -+ if (connector->status == connector_status_connected) { -+ seq_printf(m, "sink_max_lane_count: %d\n", phytium_dp->sink_max_lane_count); -+ seq_printf(m, "max_sink_rates: %d\n", -+ phytium_dp->sink_rates[phytium_dp->num_sink_rates-1]); -+ seq_printf(m, "link_rate: %d\n", phytium_dp->link_rate); -+ seq_printf(m, "link_lane_count: %d\n", phytium_dp->link_lane_count); -+ seq_printf(m, "train_set[0]: %d\n", phytium_dp->train_set[0]); -+ seq_printf(m, "has_audio: %s\n", phytium_dp->has_audio?"yes":"no"); -+ } -+ -+ return 0; -+} -+ -+static int phytium_dp_state_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_dp_state_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_dp_state_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_dp_state_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = phytium_dp_state_write, -+}; -+ -+static const struct phytium_debugfs_files { -+ const char *name; -+ const struct file_operations *fops; -+} phytium_debugfs_connector_files[] = { -+ {"dp_state", &phytium_dp_state_fops}, -+ {"dpcd", &phytium_dpcd_fops}, -+ {"dp_register", &phytium_dp_register_fops}, -+ {"dp_trigger_train_fail", &phytium_dp_trigger_train_fail_fops}, -+}; -+ -+static const struct phytium_debugfs_files phytium_edp_debugfs_connector_files[] = { -+ {"edp_power", &phytium_edp_power_fops}, -+ {"edp_backlight", &phytium_edp_backlight_fops}, -+}; -+ -+int phytium_debugfs_connector_add(struct drm_connector *connector) -+{ -+ struct dentry *root = connector->debugfs_entry; -+ struct dentry *ent; -+ int i; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ if (!root) -+ return -ENODEV; -+ -+ for (i = 0; i < ARRAY_SIZE(phytium_debugfs_connector_files); i++) { -+ ent = debugfs_create_file(phytium_debugfs_connector_files[i].name, -+ 0644, -+ root, -+ connector, -+ phytium_debugfs_connector_files[i].fops); -+ if (!ent) -+ return -ENOMEM; -+ } -+ -+ if (phytium_dp->is_edp) -+ for (i = 0; i < ARRAY_SIZE(phytium_edp_debugfs_connector_files); i++) { -+ ent = debugfs_create_file(phytium_edp_debugfs_connector_files[i].name, -+ 0644, -+ root, -+ connector, -+ phytium_edp_debugfs_connector_files[i].fops); -+ if (!ent) -+ return -ENOMEM; -+ } -+ -+ return 0; -+} -+ -+static int phytium_mem_state_show(struct seq_file *m, void *data) -+{ -+ struct phytium_display_private *priv = m->private; -+ uint8_t i; -+ -+ for (i = 0; i < ARRAY_SIZE(mem_state); i++) -+ seq_printf(m, "%-34s %10lld\n", mem_state[i], priv->mem_state[i]); -+ -+ return 0; -+} -+ -+static int phytium_mem_state_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_mem_state_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_mem_state_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_mem_state_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+}; -+ -+static const struct phytium_debugfs_files phytium_debugfs_display_files[] = { -+ {"mem_state", &phytium_mem_state_fops}, -+}; -+ -+int phytium_debugfs_display_register(struct phytium_display_private *priv) -+{ -+ struct drm_minor *minor = priv->dev->primary; -+ struct dentry *root = minor->debugfs_root; -+ struct dentry *ent; -+ -+ if (!root) -+ return -ENODEV; -+ -+ ent = debugfs_create_file(phytium_debugfs_display_files[0].name, -+ 0644, -+ root, -+ priv, -+ phytium_debugfs_display_files[0].fops); -+ if (!ent) -+ return -ENOMEM; -+ -+ return 0; -+} -diff --git a/drivers/gpu/drm/phytium/phytium_debugfs.h b/drivers/gpu/drm/phytium/phytium_debugfs.h -new file mode 100644 -index 000000000..7e632bf9c ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_debugfs.h -@@ -0,0 +1,13 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_DEBUGFS_H__ -+#define __PHYTIUM_DEBUGFS_H__ -+ -+int phytium_debugfs_connector_add(struct drm_connector *connector); -+int phytium_debugfs_display_register(struct phytium_display_private *priv); -+ -+#endif /* __PHYTIUM_DEBUGFS_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_display_drv.c b/drivers/gpu/drm/phytium/phytium_display_drv.c -new file mode 100644 -index 000000000..3f0084610 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_display_drv.c -@@ -0,0 +1,475 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_plane.h" -+#include "phytium_crtc.h" -+#include "phytium_dp.h" -+#include "phytium_gem.h" -+#include "phytium_fb.h" -+#include "phytium_fbdev.h" -+#include "phytium_reg.h" -+#include "phytium_pci.h" -+#include "phytium_platform.h" -+#include "phytium_debugfs.h" -+ -+int dc_fake_mode_enable; -+module_param(dc_fake_mode_enable, int, 0644); -+MODULE_PARM_DESC(dc_fake_mode_enable, "Enable DC fake mode (0-disabled; 1-enabled; default-0)"); -+ -+int dc_fast_training_check = 1; -+module_param(dc_fast_training_check, int, 0644); -+MODULE_PARM_DESC(dc_fast_training_check, "Check dp fast training (0-disabled; 1-enabled; default-1)"); -+ -+int num_source_rates = 4; -+module_param(num_source_rates, int, 0644); -+MODULE_PARM_DESC(num_source_rates, "set the source max rates (1-1.62Gbps; 2-2.7Gbps; 3-5.4Gbps; 4-8.1Gbps; default-4)"); -+ -+int source_max_lane_count = 4; -+module_param(source_max_lane_count, int, 0644); -+MODULE_PARM_DESC(source_max_lane_count, "set the source lane count (1-1lane; 2-2lane; 4-4lane; default-4)"); -+ -+int link_dynamic_adjust; -+module_param(link_dynamic_adjust, int, 0644); -+MODULE_PARM_DESC(link_dynamic_adjust, "dynamic select the train pamameter according to the display mode (0-disabled; 1-enabled; default-1)"); -+ -+int phytium_wait_cmd_done(struct phytium_display_private *priv, -+ uint32_t register_offset, -+ uint32_t request_bit, -+ uint32_t reply_bit) -+{ -+ int timeout = 1000, config = 0, ret = 0; -+ -+ do { -+ mdelay(1); -+ timeout--; -+ config = phytium_readl_reg(priv, 0, register_offset); -+ } while ((!(config & reply_bit)) && timeout); -+ -+ phytium_writel_reg(priv, config & (~request_bit), 0, register_offset); -+ -+ if (timeout == 0) { -+ DRM_ERROR("wait cmd reply timeout\n"); -+ ret = -EBUSY; -+ } else { -+ timeout = 500; -+ do { -+ mdelay(1); -+ timeout--; -+ config = phytium_readl_reg(priv, 0, register_offset); -+ } while ((config & reply_bit) && timeout); -+ if (timeout == 0) { -+ DRM_ERROR("clear cmd timeout\n"); -+ ret = -EBUSY; -+ } -+ } -+ mdelay(5); -+ -+ return ret; -+} -+ -+static void phytium_irq_preinstall(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ int i, status; -+ -+ for_each_pipe_masked(priv, i) { -+ status = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); -+ phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[i], PHYTIUM_DC_INT_ENABLE); -+ } -+} -+ -+static void phytium_irq_uninstall(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ int i, status; -+ -+ for_each_pipe_masked(priv, i) { -+ status = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); -+ phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[i], PHYTIUM_DC_INT_ENABLE); -+ } -+} -+ -+static irqreturn_t phytium_display_irq_handler(int irq, void *data) -+{ -+ struct drm_device *dev = data; -+ struct phytium_display_private *priv = dev->dev_private; -+ bool enabled = 0; -+ int i = 0, virt_pipe = 0; -+ irqreturn_t ret = IRQ_NONE, ret1 = IRQ_NONE; -+ -+ for_each_pipe_masked(priv, i) { -+ enabled = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); -+ if (enabled & INT_STATUS) { -+ virt_pipe = phytium_get_virt_pipe(priv, i); -+ if (virt_pipe < 0) -+ return IRQ_NONE; -+ drm_handle_vblank(dev, virt_pipe); -+ ret = IRQ_HANDLED; -+ if (priv->dc_hw_clear_msi_irq) -+ priv->dc_hw_clear_msi_irq(priv, i); -+ } -+ } -+ -+ ret1 = phytium_dp_hpd_irq_handler(priv); -+ if (ret == IRQ_HANDLED || ret1 == IRQ_HANDLED) -+ return IRQ_HANDLED; -+ -+ return IRQ_NONE; -+} -+ -+static const struct drm_mode_config_funcs phytium_mode_funcs = { -+ .fb_create = phytium_fb_create, -+ .output_poll_changed = drm_fb_helper_output_poll_changed, -+ .atomic_check = drm_atomic_helper_check, -+ .atomic_commit = drm_atomic_helper_commit, -+}; -+ -+static void phytium_atomic_commit_tail(struct drm_atomic_state *state) -+{ -+ struct drm_device *dev = state->dev; -+ -+ drm_atomic_helper_commit_modeset_disables(dev, state); -+ drm_atomic_helper_commit_planes(dev, state, false); -+ drm_atomic_helper_commit_modeset_enables(dev, state); -+ drm_atomic_helper_commit_hw_done(state); -+ drm_atomic_helper_wait_for_flip_done(dev, state); -+ drm_atomic_helper_cleanup_planes(dev, state); -+} -+ -+static struct drm_mode_config_helper_funcs phytium_mode_config_helpers = { -+ .atomic_commit_tail = phytium_atomic_commit_tail, -+}; -+ -+static int phytium_modeset_init(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ int i = 0, ret; -+ -+ drm_mode_config_init(dev); -+ dev->mode_config.min_width = 0; -+ dev->mode_config.min_height = 0; -+ dev->mode_config.max_width = 16384; -+ dev->mode_config.max_height = 16384; -+ dev->mode_config.cursor_width = 32; -+ dev->mode_config.cursor_height = 32; -+ -+ dev->mode_config.preferred_depth = 24; -+ dev->mode_config.prefer_shadow = 1; -+ dev->mode_config.allow_fb_modifiers = true; -+ -+ dev->mode_config.funcs = &phytium_mode_funcs; -+ dev->mode_config.helper_private = &phytium_mode_config_helpers; -+ -+ for_each_pipe_masked(priv, i) { -+ ret = phytium_crtc_init(dev, i); -+ if (ret) { -+ DRM_ERROR("phytium_crtc_init(pipe %d) return failed\n", i); -+ goto failed_crtc_init; -+ } -+ } -+ -+ for_each_pipe_masked(priv, i) { -+ ret = phytium_dp_init(dev, i); -+ if (ret) { -+ DRM_ERROR("phytium_dp_init(pipe %d) return failed\n", i); -+ goto failed_dp_init; -+ } -+ } -+ -+ drm_mode_config_reset(dev); -+ -+ return 0; -+failed_dp_init: -+failed_crtc_init: -+ drm_mode_config_cleanup(dev); -+ return ret; -+} -+ -+int phytium_get_virt_pipe(struct phytium_display_private *priv, int phys_pipe) -+{ -+ int i = 0; -+ int virt_pipe = 0; -+ -+ for_each_pipe_masked(priv, i) { -+ if (i != phys_pipe) -+ virt_pipe++; -+ else -+ return virt_pipe; -+ } -+ -+ DRM_ERROR("%s %d failed\n", __func__, phys_pipe); -+ return -EINVAL; -+} -+ -+int phytium_get_phys_pipe(struct phytium_display_private *priv, int virt_pipe) -+{ -+ int i = 0; -+ int tmp = 0; -+ -+ for_each_pipe_masked(priv, i) { -+ if (tmp != virt_pipe) -+ tmp++; -+ else -+ return i; -+ } -+ -+ DRM_ERROR("%s %d failed\n", __func__, virt_pipe); -+ return -EINVAL; -+} -+ -+static int phytium_display_load(struct drm_device *dev, unsigned long flags) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret = 0; -+ -+ ret = drm_vblank_init(dev, priv->info.num_pipes); -+ if (ret) { -+ DRM_ERROR("vblank init failed\n"); -+ goto failed_vblank_init; -+ } -+ -+ ret = phytium_modeset_init(dev); -+ if (ret) { -+ DRM_ERROR("phytium_modeset_init failed\n"); -+ goto failed_modeset_init; -+ } -+ -+ if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) -+ priv->vram_hw_init(priv); -+ -+ ret = drm_irq_install(dev, priv->irq); -+ if (ret) { -+ DRM_ERROR("install irq failed\n"); -+ goto failed_irq_install; -+ } -+ -+ ret = phytium_drm_fbdev_init(dev); -+ if (ret) -+ DRM_ERROR("failed to init dev\n"); -+ -+ phytium_debugfs_display_register(priv); -+ -+ return ret; -+ -+failed_irq_install: -+ drm_mode_config_cleanup(dev); -+failed_modeset_init: -+failed_vblank_init: -+ return ret; -+} -+ -+static void phytium_display_unload(struct drm_device *dev) -+{ -+ phytium_drm_fbdev_fini(dev); -+ drm_irq_uninstall(dev); -+ drm_mode_config_cleanup(dev); -+} -+ -+static const struct vm_operations_struct phytium_vm_ops = { -+ .open = drm_gem_vm_open, -+ .close = drm_gem_vm_close, -+}; -+ -+/* phytium display specific ioctls -+ * The device specific ioctl range is 0x40 to 0x79. -+ */ -+#define DRM_PHYTIUM_VRAM_TYPE_DEVICE 0x0 -+#define DRM_PHYTIUM_BMC_DEVICE 0x1 -+#define DRM_IOCTL_PHYTIUM_VRAM_TYPE_DEVICE DRM_IO(DRM_COMMAND_BASE\ -+ + DRM_PHYTIUM_VRAM_TYPE_DEVICE) -+#define DRM_IOCTL_PHYTIUM_IS_BMC_DEVICE DRM_IO(DRM_COMMAND_BASE\ -+ + DRM_PHYTIUM_BMC_DEVICE) -+ -+static int phytium_ioctl_check_vram_device(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ return ((priv->support_memory_type == MEMORY_TYPE_VRAM_DEVICE) ? 1 : 0); -+} -+ -+static int phytium_ioctl_check_bmc_device(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ return priv->info.bmc_mode ? 1 : 0; -+} -+ -+static const struct drm_ioctl_desc phytium_ioctls[] = { -+ /* for test, none so far */ -+ DRM_IOCTL_DEF_DRV(PHYTIUM_VRAM_TYPE_DEVICE, phytium_ioctl_check_vram_device, -+ DRM_AUTH|DRM_UNLOCKED), -+ DRM_IOCTL_DEF_DRV(PHYTIUM_IS_BMC_DEVICE, phytium_ioctl_check_bmc_device, -+ DRM_AUTH|DRM_UNLOCKED), -+}; -+ -+static const struct file_operations phytium_drm_driver_fops = { -+ .owner = THIS_MODULE, -+ .open = drm_open, -+ .release = drm_release, -+ .unlocked_ioctl = drm_ioctl, -+ .compat_ioctl = drm_compat_ioctl, -+ .poll = drm_poll, -+ .read = drm_read, -+ .llseek = no_llseek, -+ .mmap = phytium_gem_mmap, -+}; -+ -+struct drm_driver phytium_display_drm_driver = { -+ .driver_features = DRIVER_HAVE_IRQ | -+ DRIVER_MODESET | -+ DRIVER_ATOMIC | -+ DRIVER_GEM, -+ .load = phytium_display_load, -+ .unload = phytium_display_unload, -+ .lastclose = drm_fb_helper_lastclose, -+ .irq_handler = phytium_display_irq_handler, -+ .irq_preinstall = phytium_irq_preinstall, -+ .irq_uninstall = phytium_irq_uninstall, -+ .prime_handle_to_fd = drm_gem_prime_handle_to_fd, -+ .prime_fd_to_handle = drm_gem_prime_fd_to_handle, -+ .gem_prime_export = drm_gem_prime_export, -+ .gem_prime_import = drm_gem_prime_import, -+ .gem_prime_import_sg_table = phytium_gem_prime_import_sg_table, -+ .gem_prime_mmap = phytium_gem_prime_mmap, -+ .dumb_create = phytium_gem_dumb_create, -+ .dumb_destroy = phytium_gem_dumb_destroy, -+ .ioctls = phytium_ioctls, -+ .num_ioctls = ARRAY_SIZE(phytium_ioctls), -+ .fops = &phytium_drm_driver_fops, -+ .name = DRV_NAME, -+ .desc = DRV_DESC, -+ .date = DRV_DATE, -+ .major = DRV_MAJOR, -+ .minor = DRV_MINOR, -+}; -+ -+static void phytium_display_shutdown(struct drm_device *dev) -+{ -+ drm_atomic_helper_shutdown(dev); -+} -+ -+static int phytium_display_pm_suspend(struct drm_device *dev) -+{ -+ struct drm_atomic_state *state; -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret, ret1; -+ -+ phytium_dp_hpd_irq_setup(dev, false); -+ cancel_work_sync(&priv->hotplug_work); -+ drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 1); -+ state = drm_atomic_helper_suspend(dev); -+ if (IS_ERR(state)) { -+ DRM_ERROR("drm_atomic_helper_suspend failed: %ld\n", PTR_ERR(state)); -+ ret = PTR_ERR(state); -+ goto suspend_failed; -+ } -+ dev->mode_config.suspend_state = state; -+ ret = phytium_gem_suspend(dev); -+ if (ret) { -+ DRM_ERROR("phytium_gem_suspend failed: %d\n", ret); -+ goto gem_suspend_failed; -+ } -+ -+ return 0; -+ -+gem_suspend_failed: -+ ret1 = drm_atomic_helper_resume(dev, dev->mode_config.suspend_state); -+ if (ret1) -+ DRM_ERROR("Failed to resume (%d)\n", ret1); -+ dev->mode_config.suspend_state = NULL; -+suspend_failed: -+ drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 0); -+ phytium_dp_hpd_irq_setup(dev, true); -+ -+ return ret; -+} -+ -+static int phytium_display_pm_resume(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret = 0; -+ -+ if (WARN_ON(!dev->mode_config.suspend_state)) -+ return -EINVAL; -+ -+ ret = phytium_dp_resume(dev); -+ if (ret) -+ return -EIO; -+ -+ phytium_crtc_resume(dev); -+ phytium_gem_resume(dev); -+ -+ if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) -+ priv->vram_hw_init(priv); -+ -+ ret = drm_atomic_helper_resume(dev, dev->mode_config.suspend_state); -+ if (ret) { -+ DRM_ERROR("Failed to resume (%d)\n", ret); -+ return ret; -+ } -+ -+ dev->mode_config.suspend_state = NULL; -+ drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 0); -+ phytium_dp_hpd_irq_setup(dev, true); -+ -+ return 0; -+} -+ -+void phytium_display_private_init(struct phytium_display_private *priv, struct drm_device *dev) -+{ -+ INIT_LIST_HEAD(&priv->gem_list_head); -+ spin_lock_init(&priv->hotplug_irq_lock); -+ INIT_WORK(&priv->hotplug_work, phytium_dp_hpd_work_func); -+ memset(priv->mem_state, 0, sizeof(priv->mem_state)); -+ priv->dev = dev; -+ priv->display_shutdown = phytium_display_shutdown; -+ priv->display_pm_suspend = phytium_display_pm_suspend; -+ priv->display_pm_resume = phytium_display_pm_resume; -+} -+ -+static int __init phytium_display_init(void) -+{ -+ int ret = 0; -+ -+ ret = platform_driver_register(&phytium_platform_driver); -+ if (ret) -+ return ret; -+ -+ ret = pci_register_driver(&phytium_pci_driver); -+ -+ return ret; -+} -+ -+static void __exit phytium_display_exit(void) -+{ -+ pci_unregister_driver(&phytium_pci_driver); -+ -+ platform_driver_unregister(&phytium_platform_driver); -+} -+ -+module_init(phytium_display_init); -+module_exit(phytium_display_exit); -+ -+MODULE_LICENSE("GPL"); -+MODULE_VERSION(DC_DRIVER_VERSION); -+MODULE_AUTHOR("Yang Xun "); -+MODULE_AUTHOR("Shaojun Yang "); -+MODULE_DESCRIPTION("Phytium Display Controller"); -diff --git a/drivers/gpu/drm/phytium/phytium_display_drv.h b/drivers/gpu/drm/phytium/phytium_display_drv.h -new file mode 100644 -index 000000000..e15fc6aba ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_display_drv.h -@@ -0,0 +1,187 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_DISPLAY_DRV_H__ -+#define __PHYTIUM_DISPLAY_DRV_H__ -+ -+#include -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+#include -+#endif -+#include -+#include -+#include -+ -+#define DEBUG_LOG 0 -+ -+#define PHYTIUM_FORMAT_MAX_PLANE 3 -+#define DP_MAX_DOWNSTREAM_PORTS 0x10 -+ -+#define DRV_NAME "dc" -+#define DRV_DESC "phytium dc" -+#define DRV_DATE "20201220" -+#define DRV_MAJOR 1 -+#define DRV_MINOR 1 -+#define DC_DRIVER_VERSION "1.0.0" -+ -+/* come from GPU */ -+#define DRM_FORMAT_MOD_VENDOR_PHYTIUM 0x92 -+ -+/* dc:mode0 8x8 16bpp gpu: FBCDC_8X8_V10 */ -+#define DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC fourcc_mod_code(PHYTIUM, 21) -+/* dc:mode3 8x4 32bpp gpu: FBCDC_16X4_v10 */ -+#define DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC fourcc_mod_code(PHYTIUM, 22) -+ -+#define PIPE_MASK_SHIFT 0x0 -+#define PIPE_MASK_MASK 0x7 -+#define EDP_MASK_SHIFT 0x3 -+#define EDP_MASK_MASK 0x7 -+ -+enum phytium_platform { -+ PHYTIUM_PLATFORM_UNINITIALIZED = 0, -+ PHYTIUM_PLATFORM_PX210, -+ PHYTIUM_PLATFORM_PE220X, -+}; -+ -+enum phytium_mem_state_type { -+ PHYTIUM_MEM_VRAM_TOTAL = 0, -+ PHYTIUM_MEM_VRAM_ALLOC, -+ PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL, -+ PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC, -+ PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC, -+ PHYTIUM_MEM_STATE_TYPE_COUNT, -+}; -+ -+#define MEMORY_TYPE_VRAM_WC 0x1 -+#define MEMORY_TYPE_SYSTEM_CARVEOUT 0x2 -+#define MEMORY_TYPE_SYSTEM_UNIFIED 0x4 -+#define MEMORY_TYPE_VRAM_DEVICE 0x8 -+ -+#define IS_PLATFORM(priv, p) ((priv)->info.platform_mask & BIT(p)) -+ -+#define IS_PX210(priv) IS_PLATFORM(priv, PHYTIUM_PLATFORM_PX210) -+#define IS_PE220X(priv) IS_PLATFORM(priv, PHYTIUM_PLATFORM_PE220X) -+ -+struct phytium_device_info { -+ unsigned char platform_mask; -+ unsigned char pipe_mask; -+ unsigned char num_pipes; -+ unsigned char total_pipes; -+ unsigned char edp_mask; -+ bool bmc_mode; -+ unsigned char reserve[2]; -+ unsigned int crtc_clock_max; -+ unsigned int hdisplay_max; -+ unsigned int vdisplay_max; -+ unsigned int backlight_max; -+ unsigned int backlight_min; -+ unsigned long address_mask; -+ struct pwm_device *pwm; -+}; -+ -+struct phytium_display_private { -+ /* hw */ -+ void __iomem *regs; -+ void __iomem *vram_addr; -+ struct phytium_device_info info; -+ char support_memory_type; -+ char reserve[3]; -+ uint32_t dc_reg_base[3]; -+ uint32_t dcreq_reg_base[3]; -+ uint32_t dp_reg_base[3]; -+ uint32_t address_transform_base; -+ uint32_t phy_access_base[3]; -+ -+ /* drm */ -+ struct drm_device *dev; -+ int irq; -+ -+ /* fb_dev */ -+ struct drm_fb_helper fbdev_helper; -+ struct phytium_gem_object *fbdev_phytium_gem; -+ -+ int save_reg[3]; -+ struct list_head gem_list_head; -+ -+ struct work_struct hotplug_work; -+ spinlock_t hotplug_irq_lock; -+ -+ void (*vram_hw_init)(struct phytium_display_private *priv); -+ void (*display_shutdown)(struct drm_device *dev); -+ int (*display_pm_suspend)(struct drm_device *dev); -+ int (*display_pm_resume)(struct drm_device *dev); -+ void (*dc_hw_clear_msi_irq)(struct phytium_display_private *priv, uint32_t phys_pipe); -+ int (*dc_hw_fb_format_check)(const struct drm_mode_fb_cmd2 *mode_cmd, int count); -+ -+ struct gen_pool *memory_pool; -+ resource_size_t pool_phys_addr; -+ resource_size_t pool_size; -+ void *pool_virt_addr; -+ uint64_t mem_state[PHYTIUM_MEM_STATE_TYPE_COUNT]; -+ -+ /* DMA info */ -+ int dma_inited; -+ struct dma_chan *dma_chan; -+ /*BL GPIO info*/ -+ struct gpio_desc *edp_bl_en, *edp_power_en; -+}; -+ -+static inline unsigned int -+phytium_readl_reg(struct phytium_display_private *priv, uint32_t group_offset, uint32_t reg_offset) -+{ -+ unsigned int data; -+ -+ data = readl(priv->regs + group_offset + reg_offset); -+#if DEBUG_LOG -+ pr_info("Read 32'h%08x 32'h%08x\n", group_offset + reg_offset, data); -+#endif -+ return data; -+} -+ -+static inline void -+phytium_writel_reg(struct phytium_display_private *priv, uint32_t data, -+ uint32_t group_offset, uint32_t reg_offset) -+{ -+ -+ writel(data, priv->regs + group_offset + reg_offset); -+#if DEBUG_LOG -+ pr_info("Write 32'h%08x 32'h%08x\n", group_offset + reg_offset, data); -+#endif -+} -+ -+static inline void -+phytium_writeb_reg(struct phytium_display_private *priv, uint8_t data, -+ uint32_t group_offset, uint32_t reg_offset) -+{ -+ writeb(data, priv->regs + group_offset + reg_offset); -+#if DEBUG_LOG -+ pr_info("Write 32'h%08x 8'h%08x\n", group_offset + reg_offset, data); -+#endif -+} -+ -+#define for_each_pipe(__dev_priv, __p) \ -+ for ((__p) = 0; (__p) < __dev_priv->info.total_pipes; (__p)++) -+ -+#define for_each_pipe_masked(__dev_priv, __p) \ -+ for ((__p) = 0; (__p) < __dev_priv->info.total_pipes; (__p)++) \ -+ for_each_if((__dev_priv->info.pipe_mask) & BIT(__p)) -+ -+int phytium_get_virt_pipe(struct phytium_display_private *priv, int phys_pipe); -+int phytium_get_phys_pipe(struct phytium_display_private *priv, int virt_pipe); -+int phytium_wait_cmd_done(struct phytium_display_private *priv, -+ uint32_t register_offset, -+ uint32_t request_bit, -+ uint32_t reply_bit); -+void phytium_display_private_init(struct phytium_display_private *priv, struct drm_device *dev); -+ -+extern struct drm_driver phytium_display_drm_driver; -+extern int dc_fake_mode_enable; -+extern int dc_fast_training_check; -+extern int num_source_rates; -+extern int source_max_lane_count; -+extern int link_dynamic_adjust; -+ -+#endif /* __PHYTIUM_DISPLAY_DRV_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_dp.c b/drivers/gpu/drm/phytium/phytium_dp.c -new file mode 100644 -index 000000000..92ad326d0 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_dp.c -@@ -0,0 +1,2666 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) -+#include -+#endif -+#include "phytium_display_drv.h" -+#include "phytium_dp.h" -+#include "phytium_debugfs.h" -+#include "px210_dp.h" -+#include "pe220x_dp.h" -+#include "phytium_panel.h" -+#include "phytium_reg.h" -+ -+static void phytium_dp_aux_init(struct phytium_dp_device *phytium_dp); -+static void handle_plugged_change(struct phytium_dp_device *phytium_dp, bool plugged); -+static bool phytium_edp_init_connector(struct phytium_dp_device *phytium_dp); -+static void phytium_edp_fini_connector(struct phytium_dp_device *phytium_dp); -+static void phytium_edp_panel_poweroff(struct phytium_dp_device *phytium_dp); -+static void phytium_dp_audio_codec_fini(struct phytium_dp_device *phytium_dp); -+ -+static int phytium_rate[] = {162000, 270000, 540000, 810000}; -+static int codec_id = PHYTIUM_DP_AUDIO_ID; -+ -+void phytium_phy_writel(struct phytium_dp_device *phytium_dp, uint32_t address, uint32_t data) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->phy_access_base[port]; -+ -+#if DEBUG_LOG -+ pr_info("phy address write: 0x%x data:0x%x\n", address, data); -+#endif -+ phytium_writel_reg(priv, address, group_offset, PHYTIUM_PHY_ACCESS_ADDRESS); -+ phytium_writel_reg(priv, data, group_offset, PHYTIUM_PHY_WRITE_DATA); -+ phytium_writel_reg(priv, ACCESS_WRITE, group_offset, PHYTIUM_PHY_ACCESS_CTRL); -+ udelay(10); -+} -+ -+uint32_t phytium_phy_readl(struct phytium_dp_device *phytium_dp, uint32_t address) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->phy_access_base[port]; -+ uint32_t data; -+ -+ phytium_writel_reg(priv, address, group_offset, PHYTIUM_PHY_ACCESS_ADDRESS); -+ phytium_writel_reg(priv, ACCESS_READ, group_offset, PHYTIUM_PHY_ACCESS_CTRL); -+ udelay(10); -+ data = phytium_readl_reg(priv, group_offset, PHYTIUM_PHY_READ_DATA); -+#if DEBUG_LOG -+ pr_info("phy address read: 0x%x data:0x%x\n", address, data); -+#endif -+ -+ return data; -+} -+ -+static int -+phytium_dp_hw_aux_transfer_write(struct phytium_dp_device *phytium_dp, struct drm_dp_aux_msg *msg) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ unsigned int i = 0, j = 0; -+ unsigned int cmd = 0; -+ unsigned int aux_status = 0, interrupt_status = 0; -+ unsigned char *data = msg->buffer; -+ int count_timeout = 0; -+ long ret = 0; -+ -+ for (i = 0; i < 3; i++) { -+ /* clear PX210_DP_INTERRUPT_RAW_STATUS */ -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); -+ phytium_writel_reg(priv, msg->address, group_offset, PHYTIUM_DP_AUX_ADDRESS); -+ for (j = 0; j < msg->size; j++) -+ phytium_writeb_reg(priv, data[j], group_offset, PHYTIUM_DP_AUX_WRITE_FIFO); -+ -+ cmd = ((msg->request & COMMAND_MASK) << COMMAND_SHIFT); -+ if (msg->size == 0) -+ cmd |= ADDRESS_ONLY; -+ else -+ cmd |= (msg->size-1) & BYTE_COUNT_MASK; -+ phytium_writel_reg(priv, cmd, group_offset, PHYTIUM_DP_AUX_COMMAND); -+ -+ count_timeout = 0; -+ do { -+ mdelay(5); -+ interrupt_status = phytium_readl_reg(priv, group_offset, -+ PHYTIUM_DP_INTERRUPT_RAW_STATUS); -+ aux_status = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_STATUS); -+ if ((aux_status & REPLY_RECEIVED) || (aux_status & REPLY_ERROR) -+ || (interrupt_status & REPLY_TIMEOUT)) { -+ DRM_DEBUG_KMS("aux wait exit\n"); -+ break; -+ } -+ count_timeout++; -+ } while (count_timeout < 6); -+ -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); -+ if (interrupt_status & REPLY_TIMEOUT) { -+ DRM_DEBUG_KMS("aux write reply timeout\n"); -+ continue; -+ } else if (aux_status & REPLY_ERROR) { -+ DRM_DEBUG_KMS("aux write reply error\n"); -+ continue; -+ } else if (aux_status & REPLY_RECEIVED) { -+ DRM_DEBUG_KMS("aux write reply received succussful\n"); -+ break; -+ } -+ } -+ -+ if (interrupt_status & REPLY_TIMEOUT) { -+ DRM_NOTE("aux(%d) write reply timeout\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } else if (aux_status & REPLY_ERROR) { -+ DRM_ERROR("aux(%d) write reply error\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } else if ((aux_status & REPLY_RECEIVED) != REPLY_RECEIVED) { -+ DRM_ERROR("aux(%d) write reply no response\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } -+ -+ msg->reply = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_CODE); -+ ret = msg->size; -+out: -+ return ret; -+} -+ -+static int -+phytium_dp_hw_aux_transfer_read(struct phytium_dp_device *phytium_dp, struct drm_dp_aux_msg *msg) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ unsigned int i = 0; -+ unsigned int cmd = 0; -+ unsigned int aux_status = 0, interrupt_status = 0; -+ unsigned char *data = msg->buffer; -+ int count_timeout = 0; -+ long ret = 0; -+ -+ for (i = 0; i < 3; i++) { -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); -+ phytium_writel_reg(priv, msg->address, group_offset, PHYTIUM_DP_AUX_ADDRESS); -+ cmd = ((msg->request & COMMAND_MASK) << COMMAND_SHIFT); -+ if (msg->size == 0) -+ cmd |= ADDRESS_ONLY; -+ else -+ cmd |= ((msg->size-1) & BYTE_COUNT_MASK); -+ phytium_writel_reg(priv, cmd, group_offset, PHYTIUM_DP_AUX_COMMAND); -+ -+ count_timeout = 0; -+ do { -+ mdelay(5); -+ interrupt_status = phytium_readl_reg(priv, group_offset, -+ PHYTIUM_DP_INTERRUPT_RAW_STATUS); -+ aux_status = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_STATUS); -+ if ((aux_status & REPLY_RECEIVED) || (aux_status & REPLY_ERROR) -+ || (interrupt_status & REPLY_TIMEOUT)) { -+ DRM_DEBUG_KMS("aux wait exit\n"); -+ break; -+ } -+ count_timeout++; -+ } while (count_timeout < 6); -+ -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); -+ if (interrupt_status & REPLY_TIMEOUT) { -+ DRM_DEBUG_KMS("aux read reply timeout\n"); -+ continue; -+ } else if (aux_status & REPLY_ERROR) { -+ DRM_DEBUG_KMS("aux read reply error\n"); -+ continue; -+ } else if (aux_status & REPLY_RECEIVED) { -+ DRM_DEBUG_KMS("aux read reply received succussful\n"); -+ break; -+ } -+ } -+ -+ if (interrupt_status & REPLY_TIMEOUT) { -+ DRM_NOTE("aux(%d) read reply timeout\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } else if (aux_status & REPLY_ERROR) { -+ DRM_ERROR("aux(%d) read reply error\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } else if ((aux_status & REPLY_RECEIVED) != REPLY_RECEIVED) { -+ DRM_ERROR("aux(%d) read reply no response\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } -+ -+ msg->reply = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_CODE); -+ ret = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_DATA_COUNT); -+ -+ if (ret > msg->size) { -+ ret = msg->size; -+ } else if (ret != msg->size) { -+ DRM_DEBUG_KMS("aux read count error(ret:0x%lx != 0x%lx)\n", ret, msg->size); -+ ret = -EBUSY; -+ goto out; -+ } -+ -+ for (i = 0; i < ret; i++) -+ data[i] = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_DATA); -+ -+out: -+ return ret; -+} -+ -+static void phytium_get_native_mode(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_display_mode *t, *mode; -+ struct drm_connector *connector = &phytium_dp->connector; -+ struct drm_display_mode *native_mode = &phytium_dp->native_mode; -+ -+ list_for_each_entry_safe(mode, t, &connector->probed_modes, head) { -+ if (mode->type & DRM_MODE_TYPE_PREFERRED) { -+ if (mode->hdisplay != native_mode->hdisplay || -+ mode->vdisplay != native_mode->vdisplay) { -+ memcpy(native_mode, mode, sizeof(*mode)); -+ drm_mode_set_crtcinfo(native_mode, 0); -+ } -+ break; -+ } -+ } -+ -+ if (&mode->head == &connector->probed_modes) -+ native_mode->clock = 0; -+} -+ -+static int phytium_connector_add_common_modes(struct phytium_dp_device *phytium_dp) -+{ -+ int i = 0, ret = 0; -+ struct drm_device *dev = phytium_dp->dev; -+ struct drm_display_mode *mode = NULL, *current_mode = NULL; -+ struct drm_display_mode *native_mode = &phytium_dp->native_mode; -+ bool mode_existed = false; -+ struct mode_size { -+ char name[DRM_DISPLAY_MODE_LEN]; -+ int w; -+ int h; -+ } common_mode[] = { -+ { "640x480", 640, 480}, -+ { "800x600", 800, 600}, -+ { "1024x768", 1024, 768}, -+ { "1280x720", 1280, 720}, -+ { "1280x800", 1280, 800}, -+ {"1280x1024", 1280, 1024}, -+ { "1440x900", 1440, 900}, -+ {"1680x1050", 1680, 1050}, -+ {"1600x1200", 1600, 1200}, -+ {"1920x1080", 1920, 1080}, -+ {"1920x1200", 1920, 1200} -+ }; -+ -+ if (native_mode->clock == 0) -+ return ret; -+ -+ for (i = 0; i < ARRAY_SIZE(common_mode); i++) { -+ mode_existed = false; -+ -+ if (common_mode[i].w > native_mode->hdisplay || -+ common_mode[i].h > native_mode->vdisplay || -+ (common_mode[i].w == native_mode->hdisplay && -+ common_mode[i].h == native_mode->vdisplay)) -+ continue; -+ -+ list_for_each_entry(current_mode, &phytium_dp->connector.probed_modes, head) { -+ if (common_mode[i].w == current_mode->hdisplay && -+ common_mode[i].h == current_mode->vdisplay) { -+ mode_existed = true; -+ break; -+ } -+ } -+ -+ if (mode_existed) -+ continue; -+ -+ mode = drm_mode_duplicate(dev, native_mode); -+ if (mode == NULL) -+ continue; -+ -+ mode->hdisplay = common_mode[i].w; -+ mode->vdisplay = common_mode[i].h; -+ mode->type &= ~DRM_MODE_TYPE_PREFERRED; -+ strncpy(mode->name, common_mode[i].name, DRM_DISPLAY_MODE_LEN); -+ drm_mode_probed_add(&phytium_dp->connector, mode); -+ ret++; -+ } -+ -+ return ret; -+} -+ -+static int phytium_connector_get_modes(struct drm_connector *connector) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ struct edid *edid; -+ int ret = 0; -+ -+ if (phytium_dp->is_edp) -+ edid = phytium_dp->edp_edid; -+ else -+ edid = drm_get_edid(connector, &phytium_dp->aux.ddc); -+ -+ if (edid && drm_edid_is_valid(edid)) { -+ drm_connector_update_edid_property(connector, edid); -+ ret = drm_add_edid_modes(connector, edid); -+ phytium_dp->has_audio = drm_detect_monitor_audio(edid); -+ phytium_get_native_mode(phytium_dp); -+ if (dc_fake_mode_enable) -+ ret += phytium_connector_add_common_modes(phytium_dp); -+ } else { -+ drm_connector_update_edid_property(connector, NULL); -+ phytium_dp->has_audio = false; -+ } -+ -+ if (!phytium_dp->is_edp) -+ kfree(edid); -+ -+ return ret; -+} -+ -+static struct drm_encoder *phytium_dp_best_encoder(struct drm_connector *connector) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ return &phytium_dp->encoder; -+} -+ -+static const -+struct drm_connector_helper_funcs phytium_connector_helper_funcs = { -+ .get_modes = phytium_connector_get_modes, -+ .best_encoder = phytium_dp_best_encoder, -+}; -+ -+static void phytium_dp_set_sink_rates(struct phytium_dp_device *phytium_dp) -+{ -+ static const int dp_rates[] = {162000, 270000, 540000, 810000}; -+ int i, max_rate; -+ -+ max_rate = drm_dp_bw_code_to_link_rate(phytium_dp->dpcd[DP_MAX_LINK_RATE]); -+ for (i = 0; i < ARRAY_SIZE(dp_rates); i++) { -+ if (dp_rates[i] > max_rate) -+ break; -+ phytium_dp->sink_rates[i] = dp_rates[i]; -+ } -+ phytium_dp->num_sink_rates = i; -+} -+ -+static int get_common_rates(const int *source_rates, int source_len, const int *sink_rates, -+ int sink_len, int *common_rates) -+{ -+ int i = 0, j = 0, k = 0; -+ -+ while (i < source_len && j < sink_len) { -+ if (source_rates[i] == sink_rates[j]) { -+ if (WARN_ON(k >= DP_MAX_SUPPORTED_RATES)) -+ return k; -+ common_rates[k] = source_rates[i]; -+ ++k; -+ ++i; -+ ++j; -+ } else if (source_rates[i] < sink_rates[j]) { -+ ++i; -+ } else { -+ ++j; -+ } -+ } -+ return k; -+} -+ -+static void phytium_dp_set_common_rates(struct phytium_dp_device *phytium_dp) -+{ -+ WARN_ON(!phytium_dp->num_source_rates || !phytium_dp->num_sink_rates); -+ -+ phytium_dp->num_common_rates = get_common_rates(phytium_dp->source_rates, -+ phytium_dp->num_source_rates, -+ phytium_dp->sink_rates, -+ phytium_dp->num_sink_rates, -+ phytium_dp->common_rates); -+ -+ if (WARN_ON(phytium_dp->num_common_rates == 0)) { -+ phytium_dp->common_rates[0] = 162000; -+ phytium_dp->num_common_rates = 1; -+ } -+} -+ -+static bool phytium_dp_get_dpcd(struct phytium_dp_device *phytium_dp) -+{ -+ int ret; -+ unsigned char sink_count = 0; -+ -+ /* get dpcd capability,but don't check data error; so check revision */ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, 0x00, phytium_dp->dpcd, -+ sizeof(phytium_dp->dpcd)); -+ if (ret < 0) { -+ DRM_ERROR("port %d get DPCD capability fail\n", phytium_dp->port); -+ return false; -+ } -+ -+ if (phytium_dp->dpcd[DP_DPCD_REV] == 0) { -+ DRM_ERROR("DPCD data error: 0x%x\n", phytium_dp->dpcd[DP_DPCD_REV]); -+ return false; -+ } -+ -+ /* parse sink support link */ -+ phytium_dp_set_sink_rates(phytium_dp); -+ phytium_dp_set_common_rates(phytium_dp); -+ phytium_dp->sink_max_lane_count = drm_dp_max_lane_count(phytium_dp->dpcd); -+ phytium_dp->common_max_lane_count = min(phytium_dp->source_max_lane_count, -+ phytium_dp->sink_max_lane_count); -+ -+ /* get dpcd sink count */ -+ if (drm_dp_dpcd_readb(&phytium_dp->aux, DP_SINK_COUNT, &sink_count) <= 0) { -+ DRM_ERROR("get DPCD sink_count fail\n"); -+ return false; -+ } -+ -+ phytium_dp->sink_count = DP_GET_SINK_COUNT(sink_count); -+ if (!phytium_dp->sink_count) { -+ DRM_ERROR("DPCD sink_count should not be zero\n"); -+ return false; -+ } -+ -+ if (!drm_dp_is_branch(phytium_dp->dpcd)) -+ return true; -+ -+ if (phytium_dp->dpcd[DP_DPCD_REV] == 0x10) -+ return true; -+ -+ /* get downstream port for branch device */ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_DOWNSTREAM_PORT_0, -+ phytium_dp->downstream_ports, DP_MAX_DOWNSTREAM_PORTS); -+ if (ret < 0) { -+ DRM_ERROR("get DPCD DFP fail\n"); -+ return false; -+ } -+ -+ return true; -+} -+ -+static enum drm_connector_status -+phytium_dp_detect_dpcd(struct phytium_dp_device *phytium_dp) -+{ -+ if (!phytium_dp_get_dpcd(phytium_dp)) -+ return connector_status_disconnected; -+ -+ if (!drm_dp_is_branch(phytium_dp->dpcd)) -+ return connector_status_connected; -+ -+ if (phytium_dp->downstream_ports[0] & DP_DS_PORT_HPD) { -+ return phytium_dp->sink_count ? connector_status_connected -+ : connector_status_disconnected; -+ } -+ return connector_status_connected; -+} -+ -+static void phytium_get_adjust_train(struct phytium_dp_device *phytium_dp, -+ const uint8_t link_status[DP_LINK_STATUS_SIZE], uint8_t lane_count) -+{ -+ unsigned char v = 0; -+ unsigned char p = 0; -+ int lane; -+ unsigned char voltage_max; -+ unsigned char preemph_max; -+ -+ /* find max value */ -+ for (lane = 0; lane < lane_count; lane++) { -+ uint8_t this_v = drm_dp_get_adjust_request_voltage(link_status, lane); -+ uint8_t this_p = drm_dp_get_adjust_request_pre_emphasis(link_status, lane); -+ -+ if (this_v > v) -+ v = this_v; -+ if (this_p > p) -+ p = this_p; -+ } -+ voltage_max = DP_TRAIN_VOLTAGE_SWING_LEVEL_3; -+ if (v >= voltage_max) -+ v = voltage_max | DP_TRAIN_MAX_SWING_REACHED; -+ -+ preemph_max = DP_TRAIN_PRE_EMPH_LEVEL_3; -+ if (p >= preemph_max) -+ p = preemph_max | DP_TRAIN_MAX_PRE_EMPHASIS_REACHED; -+ -+ for (lane = 0; lane < 4; lane++) -+ phytium_dp->train_set[lane] = v | p; -+} -+ -+bool phytium_dp_coding_8b10b_need_enable(unsigned char test_pattern) -+{ -+ switch (test_pattern) { -+ case PHYTIUM_PHY_TP_D10_2: -+ case PHYTIUM_PHY_TP_SYMBOL_ERROR: -+ case PHYTIUM_PHY_TP_CP2520_1: -+ case PHYTIUM_PHY_TP_CP2520_2: -+ case PHYTIUM_PHY_TP_CP2520_3: -+ return true; -+ case PHYTIUM_PHY_TP_PRBS7: -+ case PHYTIUM_PHY_TP_80BIT_CUSTOM: -+ return false; -+ default: -+ return false; -+ } -+} -+ -+bool phytium_dp_scrambled_need_enable(unsigned char test_pattern) -+{ -+ switch (test_pattern) { -+ case PHYTIUM_PHY_TP_SYMBOL_ERROR: -+ case PHYTIUM_PHY_TP_CP2520_1: -+ case PHYTIUM_PHY_TP_CP2520_2: -+ case PHYTIUM_PHY_TP_CP2520_3: -+ return true; -+ case PHYTIUM_PHY_TP_D10_2: -+ case PHYTIUM_PHY_TP_PRBS7: -+ case PHYTIUM_PHY_TP_80BIT_CUSTOM: -+ return false; -+ default: -+ return false; -+ } -+} -+ -+static void phytium_dp_hw_set_lane_setting(struct phytium_dp_device *phytium_dp, -+ uint32_t link_rate, -+ uint8_t train_set) -+{ -+ phytium_dp->funcs->dp_hw_set_phy_lane_setting(phytium_dp, link_rate, train_set); -+} -+ -+static void phytium_dp_hw_set_link(struct phytium_dp_device *phytium_dp, -+ uint8_t lane_count, -+ uint32_t link_rate) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, ret = 0, retry = 3; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, lane_count, -+ group_offset, PHYTIUM_DP_LANE_COUNT_SET); -+ phytium_writel_reg(priv, -+ drm_dp_link_rate_to_bw_code(link_rate), -+ group_offset, PHYTIUM_DP_LINK_BW_SET); -+ -+ if (drm_dp_enhanced_frame_cap(phytium_dp->dpcd)) -+ phytium_writel_reg(priv, ENHANCED_FRAME_ENABLE, -+ group_offset, PHYTIUM_DP_ENHANCED_FRAME_EN); -+ else -+ phytium_writel_reg(priv, ENHANCED_FRAME_DISABLE, -+ group_offset, PHYTIUM_DP_ENHANCED_FRAME_EN); -+ -+try_again: -+ ret = phytium_dp->funcs->dp_hw_set_phy_lane_and_rate(phytium_dp, lane_count, link_rate); -+ if ((ret < 0) && retry) { -+ retry--; -+ goto try_again; -+ } -+} -+ -+static void phytium_dp_hw_set_test_pattern(struct phytium_dp_device *phytium_dp, -+ uint8_t lane_count, -+ uint8_t test_pattern, -+ uint8_t *custom_pattern, -+ uint32_t custom_pattern_size) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, val = 0, tmp = 0, i; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ if ((test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) -+ && custom_pattern && (custom_pattern_size > 0)) { -+ val = *(int *)custom_pattern; -+ phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_0); -+ val = *(int *)(custom_pattern + 4); -+ phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_1); -+ val = *(short int *)(custom_pattern + 8); -+ phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_2); -+ } -+ -+ if (test_pattern == PHYTIUM_PHY_TP_D10_2 || test_pattern == PHYTIUM_PHY_TP_PRBS7 -+ || test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) -+ phytium_writel_reg(priv, SCRAMBLING_DISABLE, group_offset, -+ PHYTIUM_DP_SCRAMBLING_DISABLE); -+ else -+ phytium_writel_reg(priv, SCRAMBLING_ENABLE, group_offset, -+ PHYTIUM_DP_SCRAMBLING_DISABLE); -+ -+ tmp = test_pattern - PHYTIUM_PHY_TP_NONE + TEST_PATTERN_NONE; -+ val = 0; -+ for (i = 0; i < lane_count; i++) -+ val |= (tmp << (TEST_PATTERN_LANE_SHIFT * i)); -+ phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_LINK_QUAL_PATTERN_SET); -+} -+ -+static void phytium_dp_hw_set_train_pattern(struct phytium_dp_device *phytium_dp, -+ uint8_t train_pattern) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, tmp = 0; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ /* Scrambling is disabled for TPS1/TPS2/3 and enabled for TPS4 */ -+ if (train_pattern == DP_TRAINING_PATTERN_4 -+ || train_pattern == DP_TRAINING_PATTERN_DISABLE) { -+ phytium_writel_reg(priv, SCRAMBLING_ENABLE, group_offset, -+ PHYTIUM_DP_SCRAMBLING_DISABLE); -+ phytium_writel_reg(priv, SCRAMBLER_RESET, group_offset, -+ PHYTIUM_DP_FORCE_SCRAMBLER_RESET); -+ } else { -+ phytium_writel_reg(priv, SCRAMBLING_DISABLE, group_offset, -+ PHYTIUM_DP_SCRAMBLING_DISABLE); -+ } -+ switch (train_pattern) { -+ case DP_TRAINING_PATTERN_DISABLE: -+ tmp = TRAINING_OFF; -+ break; -+ case DP_TRAINING_PATTERN_1: -+ tmp = TRAINING_PATTERN_1; -+ break; -+ case DP_TRAINING_PATTERN_2: -+ tmp = TRAINING_PATTERN_2; -+ break; -+ case DP_TRAINING_PATTERN_3: -+ tmp = TRAINING_PATTERN_3; -+ break; -+ case DP_TRAINING_PATTERN_4: -+ tmp = TRAINING_PATTERN_4; -+ break; -+ default: -+ tmp = TRAINING_OFF; -+ break; -+ } -+ -+ phytium_writel_reg(priv, tmp, group_offset, PHYTIUM_DP_TRAINING_PATTERN_SET); -+} -+ -+void phytium_dp_hw_enable_audio(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ int config = 0, config1, data_window = 0; -+ const struct dp_audio_n_m *n_m = NULL; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); -+ phytium_writel_reg(priv, CHANNEL_MUTE_ENABLE, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); -+ -+ data_window = 90*(phytium_dp->link_rate)/100 -+ *(phytium_dp->mode.htotal - phytium_dp->mode.hdisplay) -+ /phytium_dp->mode.clock/4; -+ -+ phytium_writel_reg(priv, data_window, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW); -+ -+ n_m = phytium_dp_audio_get_n_m(phytium_dp->link_rate, phytium_dp->audio_info.sample_rate); -+ if (n_m == NULL) { -+ DRM_NOTE("can not get n_m for link_rate(%d) and sample_rate(%d)\n", -+ phytium_dp->link_rate, phytium_dp->audio_info.sample_rate); -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_MAUD); -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_NAUD); -+ } else { -+ phytium_writel_reg(priv, n_m->m, group_offset, PHYTIUM_DP_SEC_MAUD); -+ phytium_writel_reg(priv, n_m->n, group_offset, PHYTIUM_DP_SEC_NAUD); -+ } -+ -+ config1 = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+ phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, -+ group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+ phytium_writel_reg(priv, config1, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); -+} -+ -+static void phytium_dp_hw_audio_shutdown(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, -+ group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+} -+ -+static void phytium_dp_hw_audio_digital_mute(struct phytium_dp_device *phytium_dp, bool enable) -+{ -+ struct phytium_display_private *priv = phytium_dp->dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ if (enable) -+ phytium_writel_reg(priv, CHANNEL_MUTE_ENABLE, -+ group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); -+ else -+ phytium_writel_reg(priv, SEC_AUDIO_ENABLE, -+ group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); -+} -+ -+static int -+phytium_dp_hw_audio_hw_params(struct phytium_dp_device *phytium_dp, struct audio_info audio_info) -+{ -+ struct phytium_display_private *priv = phytium_dp->dev->dev_private; -+ int port = phytium_dp->port; -+ int ret = 0, data_window = 0; -+ const struct dp_audio_n_m *n_m = NULL; -+ uint32_t fs, ws, fs_accurac; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ DRM_DEBUG_KMS("%s:set port%d sample_rate(%d) channels(%d) sample_width(%d)\n", -+ __func__, phytium_dp->port, audio_info.sample_rate, -+ audio_info.channels, audio_info.sample_width); -+ -+ phytium_writel_reg(priv, INPUT_SELECT_I2S, group_offset, PHYTIUM_DP_SEC_INPUT_SELECT); -+ phytium_writel_reg(priv, APB_CLOCK/audio_info.sample_rate, -+ group_offset, PHYTIUM_DP_SEC_DIRECT_CLKDIV); -+ phytium_writel_reg(priv, audio_info.channels & CHANNEL_MASK, -+ group_offset, PHYTIUM_DP_SEC_CHANNEL_COUNT); -+ phytium_writel_reg(priv, CHANNEL_MAP_DEFAULT, group_offset, PHYTIUM_DP_SEC_CHANNEL_MAP); -+ data_window = 90*(phytium_dp->link_rate)/100 -+ *(phytium_dp->mode.htotal - phytium_dp->mode.hdisplay) -+ /phytium_dp->mode.clock/4; -+ phytium_writel_reg(priv, data_window, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW); -+ phytium_writel_reg(priv, 0xb5, group_offset, PHYTIUM_DP_SEC_CS_CATEGORY_CODE); -+ -+ phytium_writel_reg(priv, CLOCK_MODE_SYNC, group_offset, PHYTIUM_DP_SEC_CLOCK_MODE); -+ phytium_writel_reg(priv, CS_SOURCE_FORMAT_DEFAULT, -+ group_offset, PHYTIUM_DP_SEC_CS_SOURCE_FORMAT); -+ -+ switch (audio_info.sample_rate) { -+ case 32000: -+ fs = ORIG_FREQ_32000; -+ fs_accurac = SAMPLING_FREQ_32000; -+ break; -+ case 44100: -+ fs = ORIG_FREQ_44100; -+ fs_accurac = SAMPLING_FREQ_44100; -+ break; -+ case 48000: -+ fs = ORIG_FREQ_48000; -+ fs_accurac = SAMPLING_FREQ_48000; -+ break; -+ case 96000: -+ fs = ORIG_FREQ_96000; -+ fs_accurac = SAMPLING_FREQ_96000; -+ break; -+ case 176400: -+ fs = ORIG_FREQ_176400; -+ fs_accurac = SAMPLING_FREQ_176400; -+ break; -+ case 192000: -+ fs = ORIG_FREQ_192000; -+ fs_accurac = SAMPLING_FREQ_192000; -+ break; -+ default: -+ DRM_ERROR("dp not support sample_rate %d\n", audio_info.sample_rate); -+ goto out; -+ } -+ -+ switch (audio_info.sample_width) { -+ case 16: -+ ws = WORD_LENGTH_16; -+ break; -+ case 18: -+ ws = WORD_LENGTH_18; -+ break; -+ case 20: -+ ws = WORD_LENGTH_20; -+ break; -+ case 24: -+ ws = WORD_LENGTH_24; -+ break; -+ default: -+ DRM_ERROR("dp not support sample_width %d\n", audio_info.sample_width); -+ goto out; -+ } -+ -+ phytium_writel_reg(priv, ((fs&ORIG_FREQ_MASK)<link_rate, audio_info.sample_rate); -+ if (n_m == NULL) { -+ DRM_NOTE("can not get n_m for link_rate(%d) and sample_rate(%d)\n", -+ phytium_dp->link_rate, audio_info.sample_rate); -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_MAUD); -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_NAUD); -+ -+ } else { -+ phytium_writel_reg(priv, n_m->m, group_offset, PHYTIUM_DP_SEC_MAUD); -+ phytium_writel_reg(priv, n_m->n, group_offset, PHYTIUM_DP_SEC_NAUD); -+ } -+ phytium_writel_reg(priv, SECONDARY_STREAM_ENABLE, -+ group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+ phytium_dp->audio_info = audio_info; -+ -+ return 0; -+ -+out: -+ phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, -+ group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+ -+ return ret; -+} -+ -+void phytium_dp_hw_disable_video(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, SST_MST_SOURCE_0_DISABLE, -+ group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); -+} -+ -+bool phytium_dp_hw_video_is_enable(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, config; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); -+ return config ? true : false; -+} -+ -+void phytium_dp_hw_enable_video(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, SST_MST_SOURCE_0_ENABLE, -+ group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); -+ phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); -+} -+ -+void phytium_dp_hw_config_video(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ unsigned long link_bw, date_rate = 0; -+ struct drm_display_info *display_info = &phytium_dp->connector.display_info; -+ unsigned char tu_size = 64; -+ unsigned long data_per_tu = 0; -+ int symbols_per_tu, frac_symbols_per_tu, symbol_count, udc, value; -+ -+ /* cal M/N and tu_size */ -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_clock/10, group_offset, PHYTIUM_DP_M_VID); -+ phytium_writel_reg(priv, phytium_dp->link_rate/10, group_offset, PHYTIUM_DP_N_VID); -+ link_bw = phytium_dp->link_rate * phytium_dp->link_lane_count; -+ date_rate = (phytium_dp->mode.crtc_clock * display_info->bpc * 3)/8; -+ -+ /* mul 10 for register setting */ -+ data_per_tu = 10*tu_size * date_rate/link_bw; -+ symbols_per_tu = (data_per_tu/10)&0xff; -+ if (symbols_per_tu == 63) -+ frac_symbols_per_tu = 0; -+ else -+ frac_symbols_per_tu = (data_per_tu%10*16/10) & 0xf; -+ phytium_writel_reg(priv, frac_symbols_per_tu<<24 | symbols_per_tu<<16 | tu_size, -+ group_offset, PHYTIUM_DP_TRANSFER_UNIT_SIZE); -+ -+ symbol_count = (phytium_dp->mode.crtc_hdisplay*display_info->bpc*3 + 7)/8; -+ udc = (symbol_count + phytium_dp->link_lane_count - 1)/phytium_dp->link_lane_count; -+ phytium_writel_reg(priv, udc, group_offset, PHYTIUM_DP_DATA_COUNT); -+ -+ /* config main stream attributes */ -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_htotal, -+ group_offset, PHYTIUM_DP_MAIN_LINK_HTOTAL); -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_hdisplay, -+ group_offset, PHYTIUM_DP_MAIN_LINK_HRES); -+ phytium_writel_reg(priv, -+ phytium_dp->mode.crtc_hsync_end - phytium_dp->mode.crtc_hsync_start, -+ group_offset, PHYTIUM_DP_MAIN_LINK_HSWIDTH); -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_htotal - phytium_dp->mode.crtc_hsync_start, -+ group_offset, PHYTIUM_DP_MAIN_LINK_HSTART); -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_vtotal, -+ group_offset, PHYTIUM_DP_MAIN_LINK_VTOTAL); -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_vdisplay, -+ group_offset, PHYTIUM_DP_MAIN_LINK_VRES); -+ phytium_writel_reg(priv, -+ phytium_dp->mode.crtc_vsync_end - phytium_dp->mode.crtc_vsync_start, -+ group_offset, PHYTIUM_DP_MAIN_LINK_VSWIDTH); -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_vtotal - phytium_dp->mode.crtc_vsync_start, -+ group_offset, PHYTIUM_DP_MAIN_LINK_VSTART); -+ -+ value = 0; -+ if (phytium_dp->mode.flags & DRM_MODE_FLAG_PHSYNC) -+ value = value & (~HSYNC_POLARITY_LOW); -+ else -+ value = value | HSYNC_POLARITY_LOW; -+ -+ if (phytium_dp->mode.flags & DRM_MODE_FLAG_PVSYNC) -+ value = value & (~VSYNC_POLARITY_LOW); -+ else -+ value = value | VSYNC_POLARITY_LOW; -+ phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_MAIN_LINK_POLARITY); -+ -+ switch (display_info->bpc) { -+ case 10: -+ value = (MISC0_BIT_DEPTH_10BIT << MISC0_BIT_DEPTH_OFFSET); -+ break; -+ case 6: -+ value = (MISC0_BIT_DEPTH_6BIT << MISC0_BIT_DEPTH_OFFSET); -+ break; -+ default: -+ value = (MISC0_BIT_DEPTH_8BIT << MISC0_BIT_DEPTH_OFFSET); -+ break; -+ } -+ value |= (MISC0_COMPONENT_FORMAT_RGB << MISC0_COMPONENT_FORMAT_SHIFT) -+ | MISC0_SYNCHRONOUS_CLOCK; -+ phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_MAIN_LINK_MISC0); -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_MAIN_LINK_MISC1); -+ -+ value = USER_ODDEVEN_POLARITY_HIGH | USER_DATA_ENABLE_POLARITY_HIGH; -+ if (phytium_dp->mode.flags & DRM_MODE_FLAG_PHSYNC) -+ value = value | USER_HSYNC_POLARITY_HIGH; -+ else -+ value = value & (~USER_HSYNC_POLARITY_HIGH); -+ if (phytium_dp->mode.flags & DRM_MODE_FLAG_PVSYNC) -+ value = value | USER_VSYNC_POLARITY_HIGH; -+ else -+ value = value & (~USER_VSYNC_POLARITY_HIGH); -+ phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_USER_SYNC_POLARITY); -+} -+ -+void phytium_dp_hw_disable_output(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, TRANSMITTER_OUTPUT_DISABLE, -+ group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); -+ phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); -+} -+ -+void phytium_dp_hw_enable_output(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); -+ phytium_writel_reg(priv, TRANSMITTER_OUTPUT_ENABLE, -+ group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); -+} -+ -+void phytium_dp_hw_enable_input_source(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, VIRTUAL_SOURCE_0_ENABLE, -+ group_offset, PHYTIUM_INPUT_SOURCE_ENABLE); -+} -+ -+void phytium_dp_hw_disable_input_source(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ -+ phytium_writel_reg(priv, (~VIRTUAL_SOURCE_0_ENABLE)&VIRTUAL_SOURCE_0_ENABLE_MASK, -+ priv->dp_reg_base[port], PHYTIUM_INPUT_SOURCE_ENABLE); -+} -+ -+bool phytium_dp_hw_output_is_enable(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ int config = 0; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); -+ return config ? true : false; -+} -+ -+static void phytium_dp_hw_get_hpd_state(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t val = 0, raw_state = 0; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ val = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_RAW_STATUS); -+ -+ /* maybe miss hpd, so used for clear PHYTIUM_DP_INTERRUPT_RAW_STATUS */ -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); -+ raw_state = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SINK_HPD_STATE); -+ if (val & HPD_EVENT) -+ phytium_dp->dp_hpd_state.hpd_event_state = true; -+ -+ if (val & HPD_IRQ) -+ phytium_dp->dp_hpd_state.hpd_irq_state = true; -+ -+ if (raw_state & HPD_CONNECT) -+ phytium_dp->dp_hpd_state.hpd_raw_state = true; -+ else -+ phytium_dp->dp_hpd_state.hpd_raw_state = false; -+} -+ -+void phytium_dp_hw_hpd_irq_setup(struct phytium_dp_device *phytium_dp, bool enable) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_dp->dp_hpd_state.hpd_irq_enable = enable; -+ if (enable) -+ phytium_writel_reg(priv, HPD_OTHER_MASK, group_offset, PHYTIUM_DP_INTERRUPT_MASK); -+ else -+ phytium_writel_reg(priv, HPD_IRQ_MASK|HPD_EVENT_MASK|HPD_OTHER_MASK, -+ group_offset, PHYTIUM_DP_INTERRUPT_MASK); -+} -+ -+int phytium_dp_hw_init(struct phytium_dp_device *phytium_dp) -+{ -+ int ret = 0; -+ uint8_t count = 0; -+ -+ phytium_dp->source_rates = phytium_rate; -+ phytium_dp->num_source_rates = num_source_rates; -+ count = phytium_dp->funcs->dp_hw_get_source_lane_count(phytium_dp); -+ phytium_dp->source_max_lane_count = count; -+ -+ ret = phytium_dp->funcs->dp_hw_reset(phytium_dp); -+ if (ret) -+ goto out; -+ ret = phytium_dp->funcs->dp_hw_init_phy(phytium_dp); -+ if (ret) -+ goto out; -+ -+ phytium_dp->fast_train_support = false; -+ phytium_dp->hw_spread_enable = phytium_dp->funcs->dp_hw_spread_is_enable(phytium_dp); -+ -+out: -+ return ret; -+} -+ -+static int phytium_dp_dpcd_get_tp_link(struct phytium_dp_device *phytium_dp, -+ uint8_t *test_lane_count, -+ uint32_t *test_link_rate) -+{ -+ uint8_t test_link_bw; -+ int ret; -+ -+ ret = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_LANE_COUNT, -+ test_lane_count); -+ if (ret <= 0) { -+ DRM_DEBUG_KMS("test pattern Lane count read failed(%d)\n", ret); -+ goto failed; -+ } -+ -+ ret = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_LINK_RATE, -+ &test_link_bw); -+ if (ret <= 0) { -+ DRM_DEBUG_KMS("test pattern link rate read failed(%d)\n", ret); -+ goto failed; -+ } -+ *test_link_rate = drm_dp_bw_code_to_link_rate(test_link_bw); -+ -+ return 0; -+failed: -+ return ret; -+} -+ -+static int phytium_dp_dpcd_set_link(struct phytium_dp_device *phytium_dp, -+ uint8_t lane_count, uint32_t link_rate) -+{ -+ uint8_t link_config[2]; -+ int ret = 0; -+ -+ link_config[0] = drm_dp_link_rate_to_bw_code(link_rate); -+ link_config[1] = lane_count; -+ if (drm_dp_enhanced_frame_cap(phytium_dp->dpcd)) { -+ link_config[1] |= DP_LANE_COUNT_ENHANCED_FRAME_EN; -+ } -+ ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_LINK_BW_SET, link_config, 2); -+ if (ret < 0) { -+ DRM_NOTE("write dpcd DP_LINK_BW_SET fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ if (phytium_dp->hw_spread_enable) -+ link_config[0] = DP_SPREAD_AMP_0_5; -+ else -+ link_config[0] = 0; -+ link_config[1] = DP_SET_ANSI_8B10B; -+ ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_DOWNSPREAD_CTRL, link_config, 2); -+ if (ret < 0) { -+ DRM_ERROR("write DP_DOWNSPREAD_CTRL fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ return 0; -+failed: -+ return ret; -+} -+ -+static int phytium_dp_dpcd_set_test_pattern(struct phytium_dp_device *phytium_dp, -+ uint8_t test_pattern) -+{ -+ unsigned char value; -+ int ret; -+ -+ if (phytium_dp_coding_8b10b_need_enable(test_pattern)) -+ value = DP_SET_ANSI_8B10B; -+ else -+ value = 0; -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_MAIN_LINK_CHANNEL_CODING_SET, value); -+ if (ret < 0) { -+ DRM_ERROR("write DP_MAIN_LINK_CHANNEL_CODING_SET fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ if (phytium_dp_scrambled_need_enable(test_pattern)) -+ value = DP_TRAINING_PATTERN_DISABLE; -+ else -+ value = (DP_TRAINING_PATTERN_DISABLE | DP_LINK_SCRAMBLING_DISABLE); -+ -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TRAINING_PATTERN_SET, value); -+ if (ret < 0) { -+ DRM_ERROR("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_LINK_QUAL_LANE0_SET, test_pattern); -+ if (ret < 0) { -+ DRM_ERROR("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ return 0; -+failed: -+ return ret; -+} -+ -+static int phytium_dp_dpcd_set_train_pattern(struct phytium_dp_device *phytium_dp, -+ uint8_t train_pattern) -+{ -+ uint8_t value; -+ int ret; -+ -+ /* Scrambling is disabled for TPS1/2/3 and enabled for TPS4 */ -+ if (train_pattern == DP_TRAINING_PATTERN_4 || train_pattern == DP_TRAINING_PATTERN_DISABLE) -+ value = train_pattern; -+ else -+ value = (train_pattern | DP_LINK_SCRAMBLING_DISABLE); -+ -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TRAINING_PATTERN_SET, value); -+ if (ret < 0) { -+ DRM_NOTE("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ return 0; -+failed: -+ return ret; -+} -+ -+static int -+phytium_dp_dpcd_set_lane_setting(struct phytium_dp_device *phytium_dp, uint8_t *train_set) -+{ -+ int ret = 0; -+ -+ ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_TRAINING_LANE0_SET, -+ phytium_dp->train_set, 4); -+ if (ret < 0) { -+ DRM_ERROR("write DP_TRAINING_LANE0_SET fail: ret:%d\n", ret); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static int -+phytium_dp_dpcd_get_adjust_request(struct phytium_dp_device *phytium_dp, uint8_t lane_count) -+{ -+ int ret = 0; -+ uint8_t link_status[DP_LINK_STATUS_SIZE]; -+ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, -+ link_status, DP_LINK_STATUS_SIZE); -+ if (ret < 0) { -+ DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); -+ goto failed; -+ } -+ phytium_get_adjust_train(phytium_dp, link_status, lane_count); -+ -+ return 0; -+failed: -+ return ret; -+} -+ -+void phytium_dp_dpcd_sink_dpms(struct phytium_dp_device *phytium_dp, int mode) -+{ -+ int ret, i; -+ -+ if (phytium_dp->dpcd[DP_DPCD_REV] < 0x11) -+ return; -+ if (mode != DRM_MODE_DPMS_ON) { -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_SET_POWER, DP_SET_POWER_D3); -+ } else { -+ for (i = 0; i < 3; i++) { -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_SET_POWER, DP_SET_POWER_D0); -+ if (ret == 1) -+ break; -+ msleep(20); -+ } -+ } -+ -+ if (ret != 1) -+ DRM_DEBUG_KMS("failed to %s sink power state\n", -+ mode == DRM_MODE_DPMS_ON ? "enable" : "disable"); -+} -+ -+static bool phytium_dp_link_training_clock_recovery(struct phytium_dp_device *phytium_dp) -+{ -+ int ret; -+ unsigned char voltage, max_vswing_tries; -+ int voltage_tries; -+ -+ /* clear the test pattern */ -+ phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->link_lane_count, -+ PHYTIUM_PHY_TP_NONE, NULL, 0); -+ -+ /* config source and sink's link rate and lane count */ -+ phytium_dp_hw_set_link(phytium_dp, phytium_dp->link_lane_count, phytium_dp->link_rate); -+ ret = phytium_dp_dpcd_set_link(phytium_dp, phytium_dp->link_lane_count, -+ phytium_dp->link_rate); -+ if (ret < 0) { -+ DRM_NOTE("phytium_dp_dpcd_set_link failed(ret=%d)\n", ret); -+ return false; -+ } -+ -+ /* config source's voltage swing and pre-emphasis(103-106) */ -+ memset(phytium_dp->train_set, 0, sizeof(phytium_dp->train_set)); -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, -+ phytium_dp->train_set[0]); -+ -+ /* config train pattern */ -+ phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); -+ ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); -+ return false; -+ } -+ -+ /* config sink's voltage swing and pre-emphasis(103-106) */ -+ ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); -+ return false; -+ } -+ -+ voltage_tries = 1; -+ max_vswing_tries = 0; -+ for (;;) { -+ unsigned char link_status[DP_LINK_STATUS_SIZE]; -+ drm_dp_link_train_clock_recovery_delay(phytium_dp->dpcd); -+ /* get link status 0x202-0x207 */ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, -+ link_status, DP_LINK_STATUS_SIZE); -+ if (ret < 0) { -+ DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); -+ return false; -+ } -+ -+ if (drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("clock revorery ok\n"); -+ return true; -+ } -+ -+ if (voltage_tries == 5) { -+ DRM_DEBUG_KMS("Same voltage tried 5 times\n"); -+ return false; -+ } -+ -+ if (max_vswing_tries == 1) { -+ DRM_DEBUG_KMS("Max Voltage Swing reached\n"); -+ return false; -+ } -+ -+ voltage = phytium_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK; -+ -+ /* config source and sink's voltage swing and pre-emphasis(103-106) */ -+ phytium_get_adjust_train(phytium_dp, link_status, phytium_dp->link_lane_count); -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, -+ phytium_dp->train_set[0]); -+ ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); -+ return false; -+ } -+ -+ if ((phytium_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK) == voltage) -+ ++voltage_tries; -+ else -+ voltage_tries = 1; -+ -+ if (phytium_dp->train_set[0] & DP_TRAIN_MAX_SWING_REACHED) -+ ++max_vswing_tries; -+ -+ DRM_DEBUG_KMS("try train_set:0x%x voltage_tries:%d max_vswing_tries:%d\n", -+ phytium_dp->train_set[0], voltage_tries, max_vswing_tries); -+ } -+} -+ -+static unsigned int phytium_dp_get_training_pattern(struct phytium_dp_device *phytium_dp) -+{ -+ bool sink_tps3, sink_tps4; -+ -+ sink_tps4 = drm_dp_tps4_supported(phytium_dp->dpcd); -+ if (sink_tps4) -+ return DP_TRAINING_PATTERN_4; -+ else if (phytium_dp->link_rate == 810000) -+ DRM_DEBUG_KMS("8.1 Gbps link rate without sink TPS4 support\n"); -+ -+ sink_tps3 = drm_dp_tps3_supported(phytium_dp->dpcd); -+ if (sink_tps3) -+ return DP_TRAINING_PATTERN_3; -+ else if (phytium_dp->link_rate >= 540000) -+ DRM_DEBUG_KMS(">=5.4/6.48 Gbps link rate without sink TPS3 support\n"); -+ -+ return DP_TRAINING_PATTERN_2; -+} -+ -+static bool phytium_dp_link_training_channel_equalization(struct phytium_dp_device *phytium_dp) -+{ -+ unsigned int training_pattern; -+ int tries, ret; -+ unsigned char link_status[DP_LINK_STATUS_SIZE]; -+ bool channel_eq = false; -+ -+ /* config source and sink's voltage swing and pre-emphasis(103-106), from clock recovery */ -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, -+ phytium_dp->train_set[0]); -+ ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); -+ return channel_eq; -+ } -+ -+ /* config source and sink's train_pattern x */ -+ training_pattern = phytium_dp_get_training_pattern(phytium_dp); -+ phytium_dp_hw_set_train_pattern(phytium_dp, training_pattern); -+ ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, training_pattern); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); -+ return channel_eq; -+ } -+ -+ for (tries = 0; tries < 5; tries++) { -+ drm_dp_link_train_channel_eq_delay(phytium_dp->dpcd); -+ -+ /* get link status 0x202-0x207 */ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, -+ link_status, DP_LINK_STATUS_SIZE); -+ if (ret < 0) { -+ DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); -+ break; -+ } -+ -+ /* Make sure clock is still ok */ -+ if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("CR check failed, cannot continue channel equalization\n"); -+ break; -+ } -+ -+ if (drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { -+ channel_eq = true; -+ DRM_DEBUG_KMS("Channel EQ done. DP Training successful\n"); -+ break; -+ } -+ -+ /* config source and sink's voltage swing and pre-emphasis(103-106) */ -+ phytium_get_adjust_train(phytium_dp, link_status, phytium_dp->link_lane_count); -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, -+ phytium_dp->train_set[0]); -+ ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); -+ break; -+ } -+ } -+ -+ /* Try 5 times, else fail and try at lower BW */ -+ if (tries == 5) -+ DRM_DEBUG_KMS("Channel equalization failed 5 times\n"); -+ -+ return channel_eq; -+} -+ -+static void phytium_dp_train_retry_work_fn(struct work_struct *work) -+{ -+ struct phytium_dp_device *phytium_dp = train_retry_to_dp_device(work); -+ struct drm_connector *connector; -+ -+ connector = &phytium_dp->connector; -+ DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector->base.id, connector->name); -+ mutex_lock(&connector->dev->mode_config.mutex); -+ drm_connector_set_link_status_property(connector, DRM_MODE_LINK_STATUS_BAD); -+ mutex_unlock(&connector->dev->mode_config.mutex); -+ drm_kms_helper_hotplug_event(connector->dev); -+} -+ -+/* return index of rate in rates array, or -1 if not found */ -+static int phytium_dp_rate_index(const int *rates, int len, int rate) -+{ -+ int i; -+ -+ for (i = 0; i < len; i++) -+ if (rate == rates[i]) -+ return i; -+ -+ return -1; -+} -+ -+int phytium_dp_get_link_train_fallback_values(struct phytium_dp_device *phytium_dp) -+{ -+ int index, ret = 0; -+ -+ if (phytium_dp->is_edp) { -+ phytium_dp->train_retry_count++; -+ DRM_INFO("Retrying Link training for eDP(%d) with same parameters\n", -+ phytium_dp->port); -+ goto out; -+ } else { -+ index = phytium_dp_rate_index(phytium_dp->common_rates, -+ phytium_dp->num_common_rates, -+ phytium_dp->link_rate); -+ if (index > 0) { -+ phytium_dp->link_rate = phytium_dp->common_rates[index - 1]; -+ } else if (phytium_dp->link_lane_count > 1) { -+ phytium_dp->link_rate = phytium_dp->max_link_rate; -+ phytium_dp->link_lane_count = phytium_dp->link_lane_count >> 1; -+ } else { -+ phytium_dp->train_retry_count++; -+ phytium_dp->link_rate = phytium_dp->max_link_rate; -+ phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; -+ DRM_INFO("Retrying Link training for DP(%d) with maximal parameters\n", -+ phytium_dp->port); -+ ret = -1; -+ } -+ } -+ -+out: -+ return ret; -+} -+ -+static int -+phytium_dp_stop_link_train(struct phytium_dp_device *phytium_dp) -+{ -+ int ret; -+ -+ /* config source and sink's train_pattern x: DP_TRAINING_PATTERN_DISABLE */ -+ phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); -+ -+ ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); -+ if (ret < 0) { -+ DRM_NOTE("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+int phytium_dp_start_link_train(struct phytium_dp_device *phytium_dp) -+{ -+ int ret = 0; -+ -+ phytium_dp_hw_disable_output(phytium_dp); -+ phytium_dp_hw_disable_input_source(phytium_dp); -+ phytium_dp_hw_disable_video(phytium_dp); -+ phytium_dp_hw_enable_input_source(phytium_dp); -+ phytium_dp_hw_enable_output(phytium_dp); -+ phytium_dp_dpcd_sink_dpms(phytium_dp, DRM_MODE_DPMS_OFF); -+ phytium_dp_dpcd_sink_dpms(phytium_dp, DRM_MODE_DPMS_ON); -+ -+ if (!phytium_dp_link_training_clock_recovery(phytium_dp)) -+ goto failure_handling; -+ -+ if (!phytium_dp_link_training_channel_equalization(phytium_dp)) -+ goto failure_handling; -+ -+ ret = phytium_dp_stop_link_train(phytium_dp); -+ if (ret < 0) { -+ DRM_NOTE("phytium_dp_stop_link_train failed: ret = %d\n", ret); -+ goto out; -+ } -+ -+ if (phytium_dp->trigger_train_fail) { -+ phytium_dp->trigger_train_fail--; -+ goto failure_handling; -+ } -+ phytium_dp->train_retry_count = 0; -+ -+ DRM_DEBUG_KMS("[CONNECTOR:%d:%s] Link Training Pass at Link Rate = %d, Lane count = %d\n", -+ phytium_dp->connector.base.id, -+ phytium_dp->connector.name, phytium_dp->link_rate, -+ phytium_dp->link_lane_count); -+ -+ return 0; -+ -+failure_handling: -+ DRM_INFO("[CONNECTOR:%d:%s] Link Training failed at Link Rate = %d, Lane count = %d", -+ phytium_dp->connector.base.id, -+ phytium_dp->connector.name, -+ phytium_dp->link_rate, phytium_dp->link_lane_count); -+ -+ ret = phytium_dp_stop_link_train(phytium_dp); -+ if (ret < 0) { -+ DRM_NOTE("phytium_dp_stop_link_train failed: ret = %d\n", ret); -+ goto out; -+ } -+ -+ phytium_dp_get_link_train_fallback_values(phytium_dp); -+ if (phytium_dp->train_retry_count < 5) -+ schedule_work(&phytium_dp->train_retry_work); -+ else -+ DRM_ERROR("DP(%d) Link Training Unsuccessful, and stop Training\n", -+ phytium_dp->port); -+ -+out: -+ return -1; -+} -+ -+static bool phytium_dp_needs_link_retrain(struct phytium_dp_device *phytium_dp) -+{ -+ unsigned char link_status[DP_LINK_STATUS_SIZE]; -+ int ret = 0; -+ -+ /* get link status 0x202-0x207 */ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, -+ link_status, DP_LINK_STATUS_SIZE); -+ if (ret < 0) { -+ DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); -+ return true; -+ } -+ -+ if ((phytium_dp->link_rate == 0) || (phytium_dp->link_lane_count == 0)) { -+ DRM_DEBUG_KMS("link_rate(%d) or lane_count(%d) is invalid\n", -+ phytium_dp->link_rate, phytium_dp->link_lane_count); -+ return true; -+ } -+ -+ /* Make sure clock is still ok */ -+ if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("Clock recovery check failed\n"); -+ return true; -+ } -+ -+ if (!drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("Channel EQ check failed\n"); -+ return true; -+ } -+ -+ if (!phytium_dp_hw_output_is_enable(phytium_dp)) { -+ DRM_DEBUG_KMS("check DP output enable failed\n"); -+ return true; -+ } -+ return false; -+} -+ -+static bool -+phytium_dp_get_sink_irq(struct phytium_dp_device *phytium_dp, u8 *sink_irq_vector) -+{ -+ return drm_dp_dpcd_readb(&phytium_dp->aux, DP_DEVICE_SERVICE_IRQ_VECTOR, -+ sink_irq_vector) == 1; -+} -+ -+static uint8_t phytium_dp_autotest_phy_pattern(struct phytium_dp_device *phytium_dp) -+{ -+ union phytium_phy_tp phytium_phy_tp; -+ int ret; -+ unsigned char test_80_bit_pattern[ -+ (DP_TEST_80BIT_CUSTOM_PATTERN_79_72 - -+ DP_TEST_80BIT_CUSTOM_PATTERN_7_0)+1] = {0}; -+ unsigned char test_pattern; -+ unsigned int offset; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ offset = DP_TEST_PHY_PATTERN; -+#else -+ offset = DP_PHY_TEST_PATTERN; -+#endif -+ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, offset, -+ &phytium_phy_tp.raw, -+ sizeof(phytium_phy_tp)); -+ if (ret <= 0) { -+ DRM_DEBUG_KMS("Could not read DP_TEST_PHY_PATTERN\n"); -+ goto failed; -+ } -+ -+ test_pattern = phytium_phy_tp.bits.PATTERN; -+ -+ if (test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) { -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_TEST_80BIT_CUSTOM_PATTERN_7_0, -+ test_80_bit_pattern, -+ sizeof(test_80_bit_pattern)); -+ if (ret <= 0) { -+ DRM_DEBUG_KMS("Could not read DP_TEST_PHY_PATTERN\n"); -+ goto failed; -+ } -+ } -+ -+ /* config source and sink's link rate and link count */ -+ ret = phytium_dp_dpcd_get_tp_link(phytium_dp, &phytium_dp->compliance.test_lane_count, -+ &phytium_dp->compliance.test_link_rate); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_get_tp_link fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ phytium_dp_hw_set_link(phytium_dp, phytium_dp->compliance.test_lane_count, -+ phytium_dp->compliance.test_link_rate); -+ ret = phytium_dp_dpcd_set_link(phytium_dp, phytium_dp->compliance.test_lane_count, -+ phytium_dp->compliance.test_link_rate); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_link fail: ret:%d\n", ret); -+ goto failed_dpcd_set_link; -+ } -+ -+ /* config source and sink's lane setting: voltage swing and pre-emphasis */ -+ ret = phytium_dp_dpcd_get_adjust_request(phytium_dp, -+ phytium_dp->compliance.test_lane_count); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_get_adjust_request fail: ret:%d\n", ret); -+ goto failed_dpcd_get_adjust_request; -+ } -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->compliance.test_link_rate, -+ phytium_dp->train_set[0]); -+ ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); -+ goto failed_dpcd_set_lane_setting; -+ } -+ -+ /* config test pattern */ -+ phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->compliance.test_lane_count, -+ test_pattern, test_80_bit_pattern, -+ sizeof(test_80_bit_pattern)); -+ ret = phytium_dp_dpcd_set_test_pattern(phytium_dp, test_pattern); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_test_pattern fail: ret:%d\n", ret); -+ goto failed_dpcd_set_tp; -+ } -+ -+ return DP_TEST_ACK; -+ -+failed_dpcd_set_tp: -+ phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->compliance.test_lane_count, -+ PHYTIUM_PHY_TP_NONE, test_80_bit_pattern, -+ sizeof(test_80_bit_pattern)); -+failed_dpcd_set_link: -+failed_dpcd_set_lane_setting: -+failed_dpcd_get_adjust_request: -+failed: -+ return DP_TEST_NAK; -+} -+ -+static void phytium_dp_handle_test_request(struct phytium_dp_device *phytium_dp) -+{ -+ uint8_t response = DP_TEST_NAK; -+ uint8_t request = 0; -+ int status; -+ -+ status = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_REQUEST, &request); -+ if (status <= 0) { -+ DRM_DEBUG_KMS("Could not read test request from sink\n"); -+ goto update_status; -+ } -+ -+ switch (request) { -+ case DP_TEST_LINK_TRAINING: -+ case DP_TEST_LINK_VIDEO_PATTERN: -+ case DP_TEST_LINK_EDID_READ: -+ DRM_DEBUG_KMS("Not support test request '%02x'\n", request); -+ response = DP_TEST_NAK; -+ break; -+ case DP_TEST_LINK_PHY_TEST_PATTERN: -+ DRM_DEBUG_KMS("PHY_PATTERN test requested\n"); -+ response = phytium_dp_autotest_phy_pattern(phytium_dp); -+ break; -+ default: -+ DRM_DEBUG_KMS("Invalid test request '%02x'\n", request); -+ break; -+ } -+ -+update_status: -+ status = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TEST_RESPONSE, response); -+ if (status <= 0) -+ DRM_DEBUG_KMS("Could not write test response to sink\n"); -+ -+} -+ -+static int phytium_dp_long_pulse(struct drm_connector *connector, bool hpd_raw_state) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ enum drm_connector_status status = connector->status; -+ bool video_enable = false; -+ uint32_t index = 0; -+ -+ if (phytium_dp->is_edp) -+ status = connector_status_connected; -+ else if (hpd_raw_state) { -+ if (!phytium_dp_needs_link_retrain(phytium_dp)) { -+ status = connector_status_connected; -+ goto out; -+ } -+ } else { -+ status = connector_status_disconnected; -+ goto out; -+ } -+ -+ if (!phytium_dp->is_edp) { -+ status = phytium_dp_detect_dpcd(phytium_dp); -+ if (status == connector_status_disconnected) -+ goto out; -+ -+ index = phytium_dp->num_common_rates-1; -+ phytium_dp->max_link_rate = phytium_dp->common_rates[index]; -+ phytium_dp->max_link_lane_count = phytium_dp->common_max_lane_count; -+ phytium_dp->link_rate = phytium_dp->max_link_rate; -+ phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; -+ DRM_DEBUG_KMS("common_max_lane_count: %d, common_max_rate:%d\n", -+ phytium_dp->max_link_lane_count, phytium_dp->max_link_rate); -+ -+ video_enable = phytium_dp_hw_video_is_enable(phytium_dp); -+ phytium_dp_start_link_train(phytium_dp); -+ -+ if (video_enable) { -+ mdelay(2); -+ phytium_dp_hw_enable_video(phytium_dp); -+ } -+ } -+ -+out: -+ return status; -+} -+ -+static int phytium_dp_short_pulse(struct drm_connector *connector) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ enum drm_connector_status status = connector->status; -+ u8 sink_irq_vector = 0; -+ bool video_enable = false; -+ -+ /* handle the test pattern */ -+ if (phytium_dp_get_sink_irq(phytium_dp, &sink_irq_vector) && -+ sink_irq_vector != 0) { -+ drm_dp_dpcd_writeb(&phytium_dp->aux, -+ DP_DEVICE_SERVICE_IRQ_VECTOR, -+ sink_irq_vector); -+ if (sink_irq_vector & DP_AUTOMATED_TEST_REQUEST) -+ phytium_dp_handle_test_request(phytium_dp); -+ if (sink_irq_vector & (DP_CP_IRQ | DP_SINK_SPECIFIC_IRQ)) -+ DRM_DEBUG_DRIVER("CP or sink specific irq unhandled\n"); -+ } -+ if (!phytium_dp_needs_link_retrain(phytium_dp)) { -+ status = connector_status_connected; -+ goto out; -+ } -+ -+ video_enable = phytium_dp_hw_video_is_enable(phytium_dp); -+ phytium_dp_start_link_train(phytium_dp); -+ if (video_enable) { -+ mdelay(2); -+ phytium_dp_hw_enable_video(phytium_dp); -+ } -+ -+out: -+ return status; -+} -+ -+void phytium_dp_hpd_poll_handler(struct phytium_display_private *priv) -+{ -+ struct drm_device *dev = priv->dev; -+ struct drm_connector_list_iter conn_iter; -+ struct drm_connector *connector; -+ enum drm_connector_status old_status; -+ bool changed = false; -+ -+ mutex_lock(&dev->mode_config.mutex); -+ DRM_DEBUG_KMS("running encoder hotplug poll functions\n"); -+ drm_connector_list_iter_begin(dev, &conn_iter); -+ drm_for_each_connector_iter(connector, &conn_iter) { -+ if (connector->force) -+ continue; -+ old_status = connector->status; -+ connector->status = drm_helper_probe_detect(connector, NULL, false); -+ if (old_status != connector->status) { -+ const char *old, *new; -+ -+ old = drm_get_connector_status_name(old_status); -+ new = drm_get_connector_status_name(connector->status); -+ DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n", -+ connector->base.id, -+ connector->name, -+ old, new); -+ changed = true; -+ } -+ } -+ drm_connector_list_iter_end(&conn_iter); -+ mutex_unlock(&dev->mode_config.mutex); -+ -+ if (changed) -+ drm_kms_helper_hotplug_event(dev); -+} -+ -+void phytium_dp_hpd_irq_setup(struct drm_device *dev, bool enable) -+{ -+ struct phytium_dp_device *phytium_dp; -+ struct drm_encoder *encoder; -+ struct phytium_display_private *priv = dev->dev_private; -+ bool handler = false; -+ bool hpd_raw_state_old = false; -+ -+ /* We might have missed any hotplugs that happened, so polling and handler */ -+ if (enable) { -+ spin_lock_irq(&priv->hotplug_irq_lock); -+ -+ drm_for_each_encoder(encoder, dev) { -+ phytium_dp = encoder_to_dp_device(encoder); -+ if (!phytium_dp->dp_hpd_state.hpd_irq_enable) { -+ hpd_raw_state_old = phytium_dp->dp_hpd_state.hpd_raw_state; -+ phytium_dp_hw_get_hpd_state(phytium_dp); -+ if (phytium_dp->dp_hpd_state.hpd_event_state -+ || phytium_dp->dp_hpd_state.hpd_irq_state -+ || (hpd_raw_state_old != phytium_dp->dp_hpd_state.hpd_raw_state)) { -+ handler = true; -+ } -+ } -+ } -+ spin_unlock_irq(&priv->hotplug_irq_lock); -+ if (handler) -+ phytium_dp_hpd_poll_handler(priv); -+ } -+ -+ drm_for_each_encoder(encoder, dev) { -+ phytium_dp = encoder_to_dp_device(encoder); -+ phytium_dp_hw_hpd_irq_setup(phytium_dp, enable); -+ } -+} -+ -+void phytium_dp_hpd_work_func(struct work_struct *work) -+{ -+ struct phytium_display_private *priv = -+ container_of(work, struct phytium_display_private, hotplug_work); -+ struct drm_device *dev = priv->dev; -+ struct drm_connector_list_iter conn_iter; -+ struct drm_connector *connector; -+ enum drm_connector_status old_status; -+ bool changed = false; -+ -+ mutex_lock(&dev->mode_config.mutex); -+ DRM_DEBUG_KMS("running encoder hotplug work functions\n"); -+ drm_connector_list_iter_begin(dev, &conn_iter); -+ drm_for_each_connector_iter(connector, &conn_iter) { -+ if (connector->force) -+ continue; -+ old_status = connector->status; -+ connector->status = drm_helper_probe_detect(connector, NULL, false); -+ if (old_status != connector->status) { -+ const char *old, *new; -+ -+ old = drm_get_connector_status_name(old_status); -+ new = drm_get_connector_status_name(connector->status); -+ DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n", -+ connector->base.id, -+ connector->name, -+ old, new); -+ changed = true; -+ } -+ } -+ drm_connector_list_iter_end(&conn_iter); -+ mutex_unlock(&dev->mode_config.mutex); -+ -+ if (changed) -+ drm_kms_helper_hotplug_event(dev); -+ -+ phytium_dp_hpd_irq_setup(dev, true); -+} -+ -+irqreturn_t phytium_dp_hpd_irq_handler(struct phytium_display_private *priv) -+{ -+ struct drm_encoder *encoder = NULL; -+ struct phytium_dp_device *phytium_dp = NULL; -+ struct drm_device *dev = priv->dev; -+ bool handler = false; -+ -+ spin_lock(&priv->hotplug_irq_lock); -+ -+ drm_for_each_encoder(encoder, dev) { -+ phytium_dp = encoder_to_dp_device(encoder); -+ if (phytium_dp->dp_hpd_state.hpd_irq_enable) { -+ phytium_dp_hw_get_hpd_state(phytium_dp); -+ if (phytium_dp->dp_hpd_state.hpd_event_state -+ || phytium_dp->dp_hpd_state.hpd_irq_state) { -+ handler = true; -+ } -+ } -+ } -+ spin_unlock(&priv->hotplug_irq_lock); -+ -+ if (handler) { -+ phytium_dp_hpd_irq_setup(dev, false); -+ schedule_work(&priv->hotplug_work); -+ return IRQ_HANDLED; -+ } -+ return IRQ_NONE; -+} -+ -+ -+static void phytium_dp_fast_link_train_detect(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_dp->fast_train_support = !!(phytium_dp->dpcd[DP_MAX_DOWNSPREAD] -+ & DP_NO_AUX_HANDSHAKE_LINK_TRAINING); -+ DRM_DEBUG_KMS("fast link training %s\n", -+ phytium_dp->fast_train_support ? "supported" : "unsupported"); -+} -+ -+bool phytium_dp_fast_link_train(struct phytium_dp_device *phytium_dp) -+{ -+ int ret = 0; -+ unsigned int training_pattern; -+ -+ /* clear the test pattern */ -+ phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->link_lane_count, -+ PHYTIUM_PHY_TP_NONE, NULL, 0); -+ -+ /* config source and sink's link rate and lane count */ -+ phytium_dp_hw_set_link(phytium_dp, phytium_dp->link_lane_count, phytium_dp->link_rate); -+ -+ /* config source and sink's voltage swing and pre-emphasis(103-106) */ -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, -+ phytium_dp->train_set[0]); -+ -+ /* config train pattern */ -+ phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); -+ usleep_range(500, 600); -+ -+ training_pattern = phytium_dp_get_training_pattern(phytium_dp); -+ phytium_dp_hw_set_train_pattern(phytium_dp, training_pattern); -+ usleep_range(500, 600); -+ -+ phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); -+ -+ if (dc_fast_training_check) { -+ unsigned char link_status[DP_LINK_STATUS_SIZE]; -+ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, -+ link_status, DP_LINK_STATUS_SIZE); -+ if (ret < 0) { -+ DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); -+ return false; -+ } -+ -+ if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("check clock recovery failed\n"); -+ return false; -+ } -+ -+ if (!drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("check channel equalization failed\n"); -+ return false; -+ } -+ } -+ -+ return true; -+} -+ -+static enum drm_connector_status -+phytium_connector_detect(struct drm_connector *connector, bool force) -+{ -+ enum drm_connector_status status = connector->status; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ bool hpd_event_state, hpd_irq_state, hpd_raw_state; -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ bool plugged = true; -+ -+ spin_lock_irq(&priv->hotplug_irq_lock); -+ hpd_event_state = phytium_dp->dp_hpd_state.hpd_event_state; -+ hpd_irq_state = phytium_dp->dp_hpd_state.hpd_irq_state; -+ hpd_raw_state = phytium_dp->dp_hpd_state.hpd_raw_state; -+ phytium_dp->dp_hpd_state.hpd_event_state = false; -+ phytium_dp->dp_hpd_state.hpd_irq_state = false; -+ spin_unlock_irq(&priv->hotplug_irq_lock); -+ -+ if (hpd_event_state) -+ status = phytium_dp_long_pulse(connector, hpd_raw_state); -+ -+ if (hpd_irq_state) -+ status = phytium_dp_short_pulse(connector); -+ -+ if (status == connector_status_unknown) -+ status = connector_status_disconnected; -+ -+ if ((!phytium_dp->is_edp) && (!hpd_raw_state)) -+ status = connector_status_disconnected; -+ -+ if (connector->status != status) { -+ if ((status == connector_status_connected) && phytium_dp->has_audio) -+ plugged = true; -+ else -+ plugged = false; -+ -+ handle_plugged_change(phytium_dp, plugged); -+ } -+ -+ return status; -+} -+ -+static void -+phytium_connector_destroy(struct drm_connector *connector) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ drm_connector_cleanup(connector); -+ kfree(phytium_dp); -+} -+ -+static int -+phytium_dp_connector_register(struct drm_connector *connector) -+{ -+ int ret; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ phytium_dp_aux_init(phytium_dp); -+ if (phytium_dp->is_edp) { -+ phytium_edp_init_connector(phytium_dp); -+ ret = phytium_edp_backlight_device_register(phytium_dp); -+ if (ret) -+ DRM_ERROR("failed to register port(%d) backlight device(ret=%d)\n", -+ phytium_dp->port, ret); -+ } -+ -+ ret = phytium_debugfs_connector_add(connector); -+ if (ret) -+ DRM_ERROR("failed to register phytium connector debugfs(ret=%d)\n", ret); -+ -+ return 0; -+} -+ -+static void -+phytium_dp_connector_unregister(struct drm_connector *connector) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ if (phytium_dp->is_edp) { -+ phytium_edp_backlight_device_unregister(phytium_dp); -+ phytium_edp_fini_connector(phytium_dp); -+ } -+ drm_dp_aux_unregister(&phytium_dp->aux); -+} -+ -+static const struct drm_connector_funcs phytium_connector_funcs = { -+ .dpms = drm_helper_connector_dpms, -+ .detect = phytium_connector_detect, -+ .fill_modes = drm_helper_probe_single_connector_modes, -+ .destroy = phytium_connector_destroy, -+ .reset = drm_atomic_helper_connector_reset, -+ .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, -+ .late_register = phytium_dp_connector_register, -+ .early_unregister = phytium_dp_connector_unregister, -+}; -+ -+static void phytium_dp_encoder_mode_set(struct drm_encoder *encoder, -+ struct drm_display_mode *mode, -+ struct drm_display_mode *adjusted) -+{ -+ struct phytium_dp_device *dp = encoder_to_dp_device(encoder); -+ -+ drm_mode_copy(&dp->mode, adjusted); -+} -+ -+static void phytium_edp_panel_poweron(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_panel_poweron(&phytium_dp->panel); -+} -+ -+static void phytium_edp_panel_poweroff(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_panel_poweroff(&phytium_dp->panel); -+} -+ -+static void phytium_edp_backlight_on(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_panel_enable_backlight(&phytium_dp->panel); -+} -+ -+static void phytium_edp_backlight_off(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_panel_disable_backlight(&phytium_dp->panel); -+} -+ -+static void phytium_encoder_disable(struct drm_encoder *encoder) -+{ -+ struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); -+ -+ if (phytium_dp->is_edp) -+ phytium_edp_backlight_off(phytium_dp); -+ -+ phytium_dp_hw_disable_video(phytium_dp); -+ -+ mdelay(50); -+ -+ if (phytium_dp->is_edp) -+ phytium_edp_panel_poweroff(phytium_dp); -+} -+ -+void phytium_dp_adjust_link_train_parameter(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_display_info *display_info = &phytium_dp->connector.display_info; -+ unsigned long link_bw, date_rate = 0, bs_limit, bs_request; -+ int rate = 0; -+ -+ bs_request = phytium_dp->mode.crtc_htotal/(phytium_dp->mode.crtc_clock/1000); -+ date_rate = (phytium_dp->mode.crtc_clock * display_info->bpc * 3)/8; -+ -+ for (;;) { -+ bs_limit = 8192 / (phytium_dp->link_rate/1000); -+ link_bw = phytium_dp->link_rate * phytium_dp->link_lane_count; -+ rate = 10 * date_rate / link_bw; -+ DRM_DEBUG_KMS("adjust link rate(%d), lane count(%d)\n", -+ phytium_dp->link_rate, phytium_dp->link_lane_count); -+ DRM_DEBUG_KMS("for crtc_clock(%d) bs_request(%ld) bs_limit(%ld) rate(%d)\n", -+ phytium_dp->mode.crtc_clock, bs_request, bs_limit, rate); -+ if ((link_dynamic_adjust && (bs_request < bs_limit) && rate < 10) || -+ ((!link_dynamic_adjust) && (rate < 10))) -+ break; -+ phytium_dp_get_link_train_fallback_values(phytium_dp); -+ } -+ -+ DRM_DEBUG_KMS("Try link training at Link Rate = %d, Lane count = %d\n", -+ phytium_dp->link_rate, phytium_dp->link_lane_count); -+} -+ -+static void phytium_encoder_enable(struct drm_encoder *encoder) -+{ -+ struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); -+ int ret = 0; -+ -+ phytium_dp_hw_disable_video(phytium_dp); -+ -+ if (phytium_dp->is_edp) { -+ phytium_edp_panel_poweron(phytium_dp); -+ if (phytium_dp->fast_train_support) -+ phytium_dp_fast_link_train(phytium_dp); -+ else -+ ret = phytium_dp_start_link_train(phytium_dp); -+ mdelay(2); -+ phytium_dp_fast_link_train_detect(phytium_dp); -+ } else { -+ phytium_dp_adjust_link_train_parameter(phytium_dp); -+ ret = phytium_dp_start_link_train(phytium_dp); -+ mdelay(2); -+ } -+ -+ phytium_dp_hw_config_video(phytium_dp); -+ if (ret == 0) { -+ phytium_dp_hw_enable_video(phytium_dp); -+ if (phytium_dp->has_audio) -+ phytium_dp_hw_enable_audio(phytium_dp); -+ } -+ -+ if (phytium_dp->is_edp) { -+ phytium_edp_backlight_on(phytium_dp); -+ } -+} -+ -+enum drm_mode_status -+phytium_encoder_mode_valid(struct drm_encoder *encoder, const struct drm_display_mode *mode) -+{ -+ struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); -+ struct drm_display_info *display_info = &phytium_dp->connector.display_info; -+ unsigned int requested, actual; -+ -+ switch (display_info->bpc) { -+ case 10: -+ case 6: -+ case 8: -+ break; -+ default: -+ DRM_DEBUG_KMS("not support bpc(%d)\n", display_info->bpc); -+ display_info->bpc = 8; -+ break; -+ } -+ -+ if ((display_info->color_formats & DRM_COLOR_FORMAT_RGB444) == 0) { -+ DRM_DEBUG_KMS("not support color_format(%d)\n", display_info->color_formats); -+ display_info->color_formats = DRM_COLOR_FORMAT_RGB444; -+ } -+ -+ requested = mode->clock * display_info->bpc * 3 / 1000; -+ actual = phytium_dp->max_link_rate * phytium_dp->max_link_lane_count / 100; -+ actual = actual * 8 / 10; -+ if (requested >= actual) { -+ DRM_DEBUG_KMS("requested=%d, actual=%d, clock=%d\n", requested, actual, -+ mode->clock); -+ return MODE_CLOCK_HIGH; -+ } -+ -+ if (dc_fake_mode_enable && -+ (phytium_dp->native_mode.clock == mode->clock) && -+ (phytium_dp->native_mode.htotal == mode->htotal) && -+ (phytium_dp->native_mode.vtotal == mode->vtotal)) -+ return MODE_OK; -+ -+ if ((mode->hdisplay == 1600) && (mode->vdisplay == 900)) -+ return MODE_BAD_HVALUE; -+ -+ if ((mode->hdisplay == 1024) && (mode->clock > 78000)) -+ return MODE_BAD_HVALUE; -+ -+ if ((mode->hdisplay < 640) || (mode->vdisplay < 480)) -+ return MODE_BAD_HVALUE; -+ -+ return MODE_OK; -+} -+ -+static const struct drm_encoder_helper_funcs phytium_encoder_helper_funcs = { -+ .mode_set = phytium_dp_encoder_mode_set, -+ .disable = phytium_encoder_disable, -+ .enable = phytium_encoder_enable, -+ .mode_valid = phytium_encoder_mode_valid, -+}; -+ -+void phytium_dp_encoder_destroy(struct drm_encoder *encoder) -+{ -+ struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); -+ -+ phytium_dp_audio_codec_fini(phytium_dp); -+ drm_encoder_cleanup(encoder); -+} -+ -+static const struct drm_encoder_funcs phytium_encoder_funcs = { -+ .destroy = phytium_dp_encoder_destroy, -+}; -+ -+static const struct dp_audio_n_m phytium_dp_audio_n_m[] = { -+ { 32000, 162000, 1024, 10125 }, -+ { 44100, 162000, 784, 5625 }, -+ { 48000, 162000, 512, 3375 }, -+ { 64000, 162000, 2048, 10125 }, -+ { 88200, 162000, 1568, 5625 }, -+ { 96000, 162000, 1024, 3375 }, -+ { 128000, 162000, 4096, 10125 }, -+ { 176400, 162000, 3136, 5625 }, -+ { 192000, 162000, 2048, 3375 }, -+ { 32000, 270000, 1024, 16875 }, -+ { 44100, 270000, 784, 9375 }, -+ { 48000, 270000, 512, 5625 }, -+ { 64000, 270000, 2048, 16875 }, -+ { 88200, 270000, 1568, 9375 }, -+ { 96000, 270000, 1024, 5625 }, -+ { 128000, 270000, 4096, 16875 }, -+ { 176400, 270000, 3136, 9375 }, -+ { 192000, 270000, 2048, 5625 }, -+ { 32000, 540000, 1024, 33750 }, -+ { 44100, 540000, 784, 18750 }, -+ { 48000, 540000, 512, 11250 }, -+ { 64000, 540000, 2048, 33750 }, -+ { 88200, 540000, 1568, 18750 }, -+ { 96000, 540000, 1024, 11250 }, -+ { 128000, 540000, 4096, 33750 }, -+ { 176400, 540000, 3136, 18750 }, -+ { 192000, 540000, 2048, 11250 }, -+ { 32000, 810000, 1024, 50625 }, -+ { 44100, 810000, 784, 28125 }, -+ { 48000, 810000, 512, 16875 }, -+ { 64000, 810000, 2048, 50625 }, -+ { 88200, 810000, 1568, 28125 }, -+ { 96000, 810000, 1024, 16875 }, -+ { 128000, 810000, 4096, 50625 }, -+ { 176400, 810000, 3136, 28125 }, -+ { 192000, 810000, 2048, 16875 }, -+}; -+ -+static int phytium_dp_audio_get_eld(struct device *dev, void *data, u8 *buf, size_t len) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ -+ memcpy(buf, phytium_dp->connector.eld, min(sizeof(phytium_dp->connector.eld), len)); -+ -+ return 0; -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+static int phytium_dp_audio_digital_mute(struct device *dev, void *data, bool enable) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ -+ phytium_dp_hw_audio_digital_mute(phytium_dp, enable); -+ -+ return 0; -+} -+#else -+static int phytium_dp_audio_mute_stream(struct device *dev, void *data, bool enable, int direction) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ -+ phytium_dp_hw_audio_digital_mute(phytium_dp, enable); -+ -+ return 0; -+} -+#endif -+ -+const struct dp_audio_n_m *phytium_dp_audio_get_n_m(int link_rate, int sample_rate) -+{ -+ int i; -+ -+ for (i = 0; i < ARRAY_SIZE(phytium_dp_audio_n_m); i++) { -+ if (sample_rate == phytium_dp_audio_n_m[i].sample_rate -+ && link_rate == phytium_dp_audio_n_m[i].link_rate) -+ return &phytium_dp_audio_n_m[i]; -+ } -+ -+ return NULL; -+} -+ -+static int phytium_dp_audio_hw_params(struct device *dev, void *data, -+ struct hdmi_codec_daifmt *daifmt, -+ struct hdmi_codec_params *params) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ int ret = 0; -+ struct audio_info audio_info = { -+ .sample_width = params->sample_width, -+ .sample_rate = params->sample_rate, -+ .channels = params->channels, -+ }; -+ -+ if (daifmt->fmt != HDMI_I2S) { -+ DRM_ERROR("invalid audio format %d\n", daifmt->fmt); -+ ret = -EINVAL; -+ goto failed; -+ } -+ -+ ret = phytium_dp_hw_audio_hw_params(phytium_dp, audio_info); -+ -+failed: -+ return ret; -+} -+ -+static void phytium_dp_audio_shutdown(struct device *dev, void *data) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ -+ phytium_dp_hw_audio_shutdown(phytium_dp); -+} -+ -+static void handle_plugged_change(struct phytium_dp_device *phytium_dp, bool plugged) -+{ -+ if (phytium_dp->plugged_cb && phytium_dp->codec_dev) -+ phytium_dp->plugged_cb(phytium_dp->codec_dev, plugged); -+} -+ -+static int phytium_dp_audio_hook_plugged_cb(struct device *dev, void *data, -+ hdmi_codec_plugged_cb fn, -+ struct device *codec_dev) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ bool plugged; -+ -+ phytium_dp->plugged_cb = fn; -+ phytium_dp->codec_dev = codec_dev; -+ -+ if ((phytium_dp->connector.status == connector_status_connected) && phytium_dp->has_audio) -+ plugged = true; -+ else -+ plugged = false; -+ -+ handle_plugged_change(phytium_dp, plugged); -+ return 0; -+} -+ -+ -+static const struct hdmi_codec_ops phytium_audio_codec_ops = { -+ .hw_params = phytium_dp_audio_hw_params, -+ .audio_shutdown = phytium_dp_audio_shutdown, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ .digital_mute = phytium_dp_audio_digital_mute, -+#else -+ .mute_stream = phytium_dp_audio_mute_stream, -+#endif -+ .get_eld = phytium_dp_audio_get_eld, -+ .hook_plugged_cb = phytium_dp_audio_hook_plugged_cb, -+}; -+ -+static int phytium_dp_audio_codec_init(struct phytium_dp_device *phytium_dp) -+{ -+ struct device *dev = phytium_dp->dev->dev; -+ struct hdmi_codec_pdata codec_data = { -+ .i2s = 1, -+ .spdif = 0, -+ .ops = &phytium_audio_codec_ops, -+ .max_i2s_channels = 2, -+ .data = phytium_dp, -+ }; -+ -+ phytium_dp->audio_pdev = platform_device_register_data(dev, HDMI_CODEC_DRV_NAME, -+ codec_id, -+ &codec_data, sizeof(codec_data)); -+ -+ if (!PTR_ERR_OR_ZERO(phytium_dp->audio_pdev)) -+ codec_id += 1; -+ -+ return PTR_ERR_OR_ZERO(phytium_dp->audio_pdev); -+} -+ -+static void phytium_dp_audio_codec_fini(struct phytium_dp_device *phytium_dp) -+{ -+ if (!PTR_ERR_OR_ZERO(phytium_dp->audio_pdev)) -+ platform_device_unregister(phytium_dp->audio_pdev); -+ phytium_dp->audio_pdev = NULL; -+ codec_id -= 1; -+} -+ -+static long phytium_dp_aux_transfer(struct drm_dp_aux *aux, struct drm_dp_aux_msg *msg) -+{ -+ struct phytium_dp_device *phytium_dp = container_of(aux, struct phytium_dp_device, aux); -+ long ret = 0; -+ -+ DRM_DEBUG_KMS("msg->size: 0x%lx\n", msg->size); -+ -+ if (WARN_ON(msg->size > 16)) -+ return -E2BIG; -+ -+ switch (msg->request & ~DP_AUX_I2C_MOT) { -+ case DP_AUX_NATIVE_WRITE: -+ case DP_AUX_I2C_WRITE: -+ case DP_AUX_I2C_WRITE_STATUS_UPDATE: -+ ret = phytium_dp_hw_aux_transfer_write(phytium_dp, msg); -+ DRM_DEBUG_KMS("aux write reply:0x%x ret:0x%lx\n", msg->reply, ret); -+ break; -+ case DP_AUX_NATIVE_READ: -+ case DP_AUX_I2C_READ: -+ ret = phytium_dp_hw_aux_transfer_read(phytium_dp, msg); -+ DRM_DEBUG_KMS("aux read ret:0x%lx\n", ret); -+ break; -+ default: -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+static void phytium_dp_aux_init(struct phytium_dp_device *phytium_dp) -+{ -+ drm_dp_aux_init(&phytium_dp->aux); -+ phytium_dp->aux.name = kasprintf(GFP_KERNEL, "dp-%d", phytium_dp->port); -+ phytium_dp->aux.transfer = phytium_dp_aux_transfer; -+} -+ -+int phytium_get_encoder_crtc_mask(struct phytium_dp_device *phytium_dp, int port) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int i, mask = 0; -+ -+ for_each_pipe_masked(priv, i) { -+ if (i != port) -+ mask++; -+ else -+ break; -+ } -+ -+ return BIT(mask); -+} -+ -+static bool phytium_dp_is_edp(struct phytium_dp_device *phytium_dp, int port) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ if (priv->info.edp_mask & BIT(port)) -+ return true; -+ else -+ return false; -+} -+ -+static bool phytium_edp_init_connector(struct phytium_dp_device *phytium_dp) -+{ -+ enum drm_connector_status status; -+ struct drm_connector *connector = &phytium_dp->connector; -+ -+ phytium_edp_panel_poweron(phytium_dp); -+ -+ status = phytium_dp_detect_dpcd(phytium_dp); -+ if (status == connector_status_disconnected) { -+ DRM_ERROR("detect edp dpcd failed\n"); -+ return false; -+ } -+ -+ phytium_dp->edp_edid = drm_get_edid(connector, &phytium_dp->aux.ddc); -+ if (!phytium_dp->edp_edid) { -+ DRM_ERROR("get edp edid failed\n"); -+ return false; -+ } -+ -+ connector->status = status; -+ phytium_dp->max_link_rate = phytium_dp->common_rates[phytium_dp->num_common_rates-1]; -+ phytium_dp->max_link_lane_count = phytium_dp->common_max_lane_count; -+ phytium_dp->link_rate = phytium_dp->max_link_rate; -+ phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; -+ DRM_DEBUG_KMS("common_max_lane_count: %d, common_max_rate:%d\n", -+ phytium_dp->max_link_lane_count, phytium_dp->max_link_rate); -+ -+ return true; -+} -+ -+static void phytium_edp_fini_connector(struct phytium_dp_device *phytium_dp) -+{ -+ if (phytium_dp->edp_edid) -+ kfree(phytium_dp->edp_edid); -+ -+ phytium_dp->edp_edid = NULL; -+ phytium_edp_panel_poweroff(phytium_dp); -+ -+ return; -+} -+ -+int phytium_dp_resume(struct drm_device *drm_dev) -+{ -+ struct phytium_dp_device *phytium_dp; -+ struct drm_encoder *encoder; -+ int ret = 0; -+ -+ drm_for_each_encoder(encoder, drm_dev) { -+ phytium_dp = encoder_to_dp_device(encoder); -+ if (phytium_dp->is_edp) { -+ phytium_edp_backlight_off(phytium_dp); -+ phytium_edp_panel_poweroff(phytium_dp); -+ } -+ ret = phytium_dp_hw_init(phytium_dp); -+ if (ret) { -+ DRM_ERROR("failed to initialize dp %d\n", phytium_dp->port); -+ return -EIO; -+ } -+ } -+ -+ return 0; -+} -+ -+int phytium_dp_init(struct drm_device *dev, int port) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_dp_device *phytium_dp = NULL; -+ int ret, type; -+ -+ DRM_DEBUG_KMS("%s: port %d\n", __func__, port); -+ phytium_dp = kzalloc(sizeof(*phytium_dp), GFP_KERNEL); -+ if (!phytium_dp) { -+ ret = -ENOMEM; -+ goto failed_malloc_dp; -+ } -+ -+ phytium_dp->dev = dev; -+ phytium_dp->port = port; -+ -+ if (IS_PX210(priv)) { -+ px210_dp_func_register(phytium_dp); -+ priv->dp_reg_base[port] = PX210_DP_BASE(port); -+ priv->phy_access_base[port] = PX210_PHY_ACCESS_BASE(port); -+ } else if (IS_PE220X(priv)) { -+ pe220x_dp_func_register(phytium_dp); -+ priv->dp_reg_base[port] = PE220X_DP_BASE(port); -+ priv->phy_access_base[port] = PE220X_PHY_ACCESS_BASE(port); -+ } -+ -+ if (phytium_dp_is_edp(phytium_dp, port)) { -+ phytium_dp->is_edp = true; -+ type = DRM_MODE_CONNECTOR_eDP; -+ phytium_dp->pwm = priv->info.pwm; -+ phytium_dp_panel_init_backlight_funcs(phytium_dp); -+ phytium_edp_backlight_off(phytium_dp); -+ phytium_edp_panel_poweroff(phytium_dp); -+ } else { -+ phytium_dp->is_edp = false; -+ type = DRM_MODE_CONNECTOR_DisplayPort; -+ } -+ -+ ret = phytium_dp_hw_init(phytium_dp); -+ if (ret) { -+ DRM_ERROR("failed to initialize dp %d\n", phytium_dp->port); -+ goto failed_init_dp; -+ } -+ -+ ret = drm_encoder_init(dev, &phytium_dp->encoder, -+ &phytium_encoder_funcs, -+ DRM_MODE_ENCODER_TMDS, "DP %d", port); -+ if (ret) { -+ DRM_ERROR("failed to initialize encoder with drm\n"); -+ goto failed_encoder_init; -+ } -+ drm_encoder_helper_add(&phytium_dp->encoder, &phytium_encoder_helper_funcs); -+ phytium_dp->encoder.possible_crtcs = phytium_get_encoder_crtc_mask(phytium_dp, port); -+ -+ phytium_dp->connector.dpms = DRM_MODE_DPMS_OFF; -+ phytium_dp->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; -+ ret = drm_connector_init(dev, &phytium_dp->connector, &phytium_connector_funcs, -+ type); -+ if (ret) { -+ DRM_ERROR("failed to initialize connector with drm\n"); -+ goto failed_connector_init; -+ } -+ drm_connector_helper_add(&phytium_dp->connector, &phytium_connector_helper_funcs); -+ drm_connector_attach_encoder(&phytium_dp->connector, &phytium_dp->encoder); -+ -+ ret = phytium_dp_audio_codec_init(phytium_dp); -+ if (ret) { -+ DRM_ERROR("failed to initialize audio codec\n"); -+ goto failed_connector_init; -+ } -+ -+ phytium_dp->train_retry_count = 0; -+ INIT_WORK(&phytium_dp->train_retry_work, phytium_dp_train_retry_work_fn); -+ drm_connector_register(&phytium_dp->connector); -+ -+ return 0; -+failed_connector_init: -+failed_encoder_init: -+failed_init_dp: -+ kfree(phytium_dp); -+failed_malloc_dp: -+ return ret; -+} -diff --git a/drivers/gpu/drm/phytium/phytium_dp.h b/drivers/gpu/drm/phytium/phytium_dp.h -new file mode 100644 -index 000000000..bbcf133d6 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_dp.h -@@ -0,0 +1,156 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_DP_H__ -+#define __PHYTIUM_DP_H__ -+ -+#include -+#include -+#include -+ -+struct phytium_dp_device; -+ -+#include "phytium_panel.h" -+ -+struct audio_info { -+ int sample_rate; -+ int channels; -+ int sample_width; -+}; -+ -+struct dp_audio_n_m { -+ int sample_rate; -+ int link_rate; -+ u16 m; -+ u16 n; -+}; -+ -+struct phytium_dp_compliance { -+ unsigned long test_type; -+ uint32_t test_link_rate; -+ u8 test_lane_count; -+ bool test_active; -+ u8 reserve[2]; -+}; -+ -+struct phytium_dp_func { -+ uint8_t (*dp_hw_get_source_lane_count)(struct phytium_dp_device *phytium_dp); -+ int (*dp_hw_reset)(struct phytium_dp_device *phytium_dp); -+ bool (*dp_hw_spread_is_enable)(struct phytium_dp_device *phytium_dp); -+ int (*dp_hw_set_backlight)(struct phytium_dp_device *phytium_dp, uint32_t level); -+ uint32_t (*dp_hw_get_backlight)(struct phytium_dp_device *phytium_dp); -+ void (*dp_hw_disable_backlight)(struct phytium_dp_device *phytium_dp); -+ void (*dp_hw_enable_backlight)(struct phytium_dp_device *phytium_dp); -+ void (*dp_hw_poweroff_panel)(struct phytium_dp_device *phytium_dp); -+ void (*dp_hw_poweron_panel)(struct phytium_dp_device *phytium_dp); -+ int (*dp_hw_init_phy)(struct phytium_dp_device *phytium_dp); -+ void (*dp_hw_set_phy_lane_setting)(struct phytium_dp_device *phytium_dp, -+ uint32_t link_rate, uint8_t train_set); -+ int (*dp_hw_set_phy_lane_and_rate)(struct phytium_dp_device *phytium_dp, -+ uint8_t link_lane_count, -+ uint32_t link_rate); -+}; -+ -+struct phytium_dp_hpd_state { -+ bool hpd_event_state; -+ bool hpd_irq_state; -+ bool hpd_raw_state; -+ bool hpd_irq_enable; -+}; -+ -+struct phytium_dp_device { -+ struct drm_device *dev; -+ struct drm_encoder encoder; -+ struct drm_connector connector; -+ int port; -+ struct drm_display_mode mode; -+ bool link_trained; -+ bool detect_done; -+ bool is_edp; -+ bool reserve0; -+ struct drm_dp_aux aux; -+ unsigned char dpcd[DP_RECEIVER_CAP_SIZE]; -+ uint8_t edp_dpcd[EDP_DISPLAY_CTL_CAP_SIZE]; -+ unsigned char downstream_ports[DP_MAX_DOWNSTREAM_PORTS]; -+ unsigned char sink_count; -+ -+ int *source_rates; -+ int num_source_rates; -+ int sink_rates[DP_MAX_SUPPORTED_RATES]; -+ int num_sink_rates; -+ int common_rates[DP_MAX_SUPPORTED_RATES]; -+ int num_common_rates; -+ -+ int source_max_lane_count; -+ int sink_max_lane_count; -+ int common_max_lane_count; -+ -+ int max_link_rate; -+ int max_link_lane_count; -+ int link_rate; -+ int link_lane_count; -+ struct work_struct train_retry_work; -+ int train_retry_count; -+ uint32_t trigger_train_fail; -+ -+ unsigned char train_set[4]; -+ struct edid *edp_edid; -+ bool has_audio; -+ bool fast_train_support; -+ bool hw_spread_enable; -+ bool reserve[1]; -+ struct platform_device *audio_pdev; -+ struct audio_info audio_info; -+ hdmi_codec_plugged_cb plugged_cb; -+ struct device *codec_dev; -+ struct phytium_dp_compliance compliance; -+ struct phytium_dp_func *funcs; -+ struct phytium_dp_hpd_state dp_hpd_state; -+ -+ struct phytium_panel panel; -+ struct drm_display_mode native_mode; -+ struct pwm_device *pwm; -+}; -+ -+union phytium_phy_tp { -+ struct { -+ /* DpcdPhyTestPatterns. This field is 2 bits for DP1.1 -+ * and 3 bits for DP1.2. -+ */ -+ uint8_t PATTERN :3; -+ uint8_t RESERVED :5; -+ } bits; -+ uint8_t raw; -+}; -+ -+/* PHY test patterns -+ * The order of test patterns follows DPCD register PHY_TEST_PATTERN (0x248) -+ */ -+enum phytium_dpcd_phy_tp { -+ PHYTIUM_PHY_TP_NONE = 0, -+ PHYTIUM_PHY_TP_D10_2, -+ PHYTIUM_PHY_TP_SYMBOL_ERROR, -+ PHYTIUM_PHY_TP_PRBS7, -+ PHYTIUM_PHY_TP_80BIT_CUSTOM, -+ PHYTIUM_PHY_TP_CP2520_1, -+ PHYTIUM_PHY_TP_CP2520_2, -+ PHYTIUM_PHY_TP_CP2520_3, -+}; -+#define PHYTIUM_DP_AUDIO_ID (('P' << 24) + ('H' << 16) + ('Y' << 8)) -+#define encoder_to_dp_device(x) container_of(x, struct phytium_dp_device, encoder) -+#define connector_to_dp_device(x) container_of(x, struct phytium_dp_device, connector) -+#define panel_to_dp_device(x) container_of(x, struct phytium_dp_device, panel) -+#define train_retry_to_dp_device(x) container_of(x, struct phytium_dp_device, train_retry_work) -+void phytium_phy_writel(struct phytium_dp_device *phytium_dp, uint32_t address, uint32_t data); -+uint32_t phytium_phy_readl(struct phytium_dp_device *phytium_dp, uint32_t address); -+ -+int phytium_dp_init(struct drm_device *dev, int pipe); -+int phytium_dp_resume(struct drm_device *drm_dev); -+void phytium_dp_hpd_irq_setup(struct drm_device *dev, bool enable); -+irqreturn_t phytium_dp_hpd_irq_handler(struct phytium_display_private *priv); -+void phytium_dp_hpd_work_func(struct work_struct *work); -+const struct dp_audio_n_m *phytium_dp_audio_get_n_m(int link_rate, int sample_rate); -+#endif /* __PHYTIUM_DP_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_fb.c b/drivers/gpu/drm/phytium/phytium_fb.c -new file mode 100644 -index 000000000..feb17920a ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_fb.c -@@ -0,0 +1,146 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_fb.h" -+#include "phytium_gem.h" -+ -+static int -+phytium_fb_create_handle(struct drm_framebuffer *fb, struct drm_file *file_priv, -+ unsigned int *handle) -+{ -+ struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); -+ -+ return drm_gem_handle_create(file_priv, &phytium_fb->phytium_gem_obj[0]->base, handle); -+} -+ -+static void phytium_fb_destroy(struct drm_framebuffer *fb) -+{ -+ struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); -+ int i, num_planes; -+ struct drm_gem_object *obj = NULL; -+ const struct drm_format_info *info; -+ -+ info = drm_format_info(fb->format->format); -+ num_planes = info ? info->num_planes : 1; -+ -+ for (i = 0; i < num_planes; i++) { -+ obj = &phytium_fb->phytium_gem_obj[i]->base; -+ if (obj) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) -+ drm_gem_object_put(obj); -+#else -+ drm_gem_object_unreference_unlocked(obj); -+#endif -+ } -+ -+ drm_framebuffer_cleanup(fb); -+ kfree(phytium_fb); -+} -+ -+static struct drm_framebuffer_funcs viv_fb_funcs = { -+ .create_handle = phytium_fb_create_handle, -+ .destroy = phytium_fb_destroy, -+}; -+ -+struct phytium_framebuffer * -+phytium_fb_alloc(struct drm_device *dev, const struct drm_mode_fb_cmd2 *mode_cmd, -+ struct phytium_gem_object **phytium_gem_obj, unsigned int num_planes) -+{ -+ struct phytium_framebuffer *phytium_fb; -+ int ret = 0, i; -+ -+ phytium_fb = kzalloc(sizeof(*phytium_fb), GFP_KERNEL); -+ if (!phytium_fb) -+ return ERR_PTR(-ENOMEM); -+ -+ drm_helper_mode_fill_fb_struct(dev, &phytium_fb->base, mode_cmd); -+ -+ /* In UEFI, efifb may also use dc hardware, remove it and use dcdrmfb */ -+ drm_fb_helper_remove_conflicting_framebuffers(NULL, "dcdrmfb", false); -+ -+ ret = drm_framebuffer_init(dev, &phytium_fb->base, &viv_fb_funcs); -+ -+ if (ret) { -+ DRM_ERROR("Failed to initialize framebuffer: %d\n", ret); -+ kfree(phytium_fb); -+ return ERR_PTR(ret); -+ } -+ -+ for (i = 0; i < num_planes; i++) { -+ phytium_fb->phytium_gem_obj[i] = phytium_gem_obj[i]; -+ phytium_fb->base.obj[i] = &phytium_gem_obj[i]->base; -+ } -+ return phytium_fb; -+} -+ -+struct drm_framebuffer * -+phytium_fb_create(struct drm_device *dev, struct drm_file *file_priv, -+ const struct drm_mode_fb_cmd2 *mode_cmd) -+{ -+ int ret = 0, i, num_planes; -+ struct drm_gem_object *obj; -+ unsigned int hsub, vsub, size; -+ struct phytium_gem_object *phytium_gem_obj[PHYTIUM_FORMAT_MAX_PLANE] = {0}; -+ struct phytium_framebuffer *phytium_fb; -+ struct phytium_display_private *priv = dev->dev_private; -+ const struct drm_format_info *info; -+ -+ info = drm_format_info(mode_cmd->pixel_format); -+ hsub = info ? info->hsub : 1; -+ vsub = info ? info->vsub : 1; -+ num_planes = info ? info->num_planes : 1; -+ num_planes = min(num_planes, PHYTIUM_FORMAT_MAX_PLANE); -+ -+ for (i = 0; i < num_planes; i++) { -+ unsigned int height = mode_cmd->height / (i ? vsub : 1); -+ -+ size = height * mode_cmd->pitches[i] + mode_cmd->offsets[i]; -+ obj = drm_gem_object_lookup(file_priv, mode_cmd->handles[i]); -+ if (!obj) { -+ DRM_ERROR("Failed to lookup GEM object\n"); -+ ret = -ENXIO; -+ goto error; -+ } -+ -+ if (obj->size < size) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) -+ drm_gem_object_put(obj); -+#else -+ drm_gem_object_unreference_unlocked(obj); -+#endif -+ ret = -EINVAL; -+ goto error; -+ } -+ -+ phytium_gem_obj[i] = to_phytium_gem_obj(obj); -+ -+ ret = priv->dc_hw_fb_format_check(mode_cmd, i); -+ if (ret < 0) -+ goto error; -+ } -+ -+ phytium_fb = phytium_fb_alloc(dev, mode_cmd, phytium_gem_obj, i); -+ if (IS_ERR(phytium_fb)) { -+ DRM_DEBUG_KMS("phytium_fb_alloc failed\n"); -+ ret = PTR_ERR(phytium_fb); -+ goto error; -+ } -+ -+ return &phytium_fb->base; -+error: -+ for (i--; i >= 0; i--) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) -+ drm_gem_object_put(&phytium_gem_obj[i]->base); -+#else -+ drm_gem_object_unreference_unlocked(&phytium_gem_obj[i]->base); -+#endif -+ -+ return ERR_PTR(ret); -+} -diff --git a/drivers/gpu/drm/phytium/phytium_fb.h b/drivers/gpu/drm/phytium/phytium_fb.h -new file mode 100644 -index 000000000..eb7903f3a ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_fb.h -@@ -0,0 +1,26 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_FB_H__ -+#define __PHYTIUM_FB_H__ -+ -+#include -+ -+struct phytium_framebuffer { -+ struct drm_framebuffer base; -+ struct phytium_gem_object *phytium_gem_obj[PHYTIUM_FORMAT_MAX_PLANE]; -+}; -+ -+#define to_phytium_framebuffer(fb) container_of(fb, struct phytium_framebuffer, base) -+ -+struct phytium_framebuffer *phytium_fb_alloc(struct drm_device *dev, -+ const struct drm_mode_fb_cmd2 *mode_cmd, -+ struct phytium_gem_object **phytium_gem_obj, -+ unsigned int num_planes); -+ -+struct drm_framebuffer *phytium_fb_create(struct drm_device *dev, struct drm_file *file_priv, -+ const struct drm_mode_fb_cmd2 *mode_cmd); -+#endif /* __PHYTIUM_FB_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_fbdev.c b/drivers/gpu/drm/phytium/phytium_fbdev.c -new file mode 100644 -index 000000000..a74b2d081 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_fbdev.c -@@ -0,0 +1,168 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_gem.h" -+#include "phytium_fb.h" -+ -+ -+#define PHYTIUM_MAX_CONNECTOR 1 -+#define helper_to_drm_private(x) container_of(x, struct phytium_display_private, fbdev_helper) -+ -+static int phytium_fbdev_mmap(struct fb_info *info, struct vm_area_struct *vma) -+{ -+ struct drm_fb_helper *helper = info->par; -+ struct phytium_display_private *priv = helper_to_drm_private(helper); -+ -+ return phytium_gem_mmap_obj(&priv->fbdev_phytium_gem->base, vma); -+} -+ -+static struct fb_ops phytium_fbdev_ops = { -+ .owner = THIS_MODULE, -+ DRM_FB_HELPER_DEFAULT_OPS, -+ .fb_mmap = phytium_fbdev_mmap, -+ .fb_fillrect = drm_fb_helper_cfb_fillrect, -+ .fb_copyarea = drm_fb_helper_cfb_copyarea, -+ .fb_imageblit = drm_fb_helper_cfb_imageblit, -+}; -+ -+static int -+phytium_drm_fbdev_create(struct drm_fb_helper *helper, struct drm_fb_helper_surface_size *sizes) -+{ -+ struct phytium_display_private *priv = helper_to_drm_private(helper); -+ struct drm_device *dev = helper->dev; -+ unsigned int bytes_per_pixel; -+ struct drm_mode_fb_cmd2 mode_cmd = {0}; -+ struct phytium_framebuffer *phytium_fb = NULL; -+ struct fb_info *fbi = NULL; -+ struct drm_framebuffer *fb = NULL; -+ size_t size = 0; -+ int ret = 0; -+ unsigned long offset; -+ -+ bytes_per_pixel = DIV_ROUND_UP(sizes->surface_bpp, 8); -+ mode_cmd.width = sizes->surface_width; -+ mode_cmd.height = sizes->surface_height; -+ mode_cmd.pitches[0] = ALIGN(sizes->surface_width * bytes_per_pixel, 128); -+ mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, sizes->surface_depth); -+ size = PAGE_ALIGN(mode_cmd.pitches[0] * mode_cmd.height); -+ -+ ret = mutex_lock_interruptible(&dev->struct_mutex); -+ if (ret < 0) { -+ DRM_ERROR("failed to get mutex lock\n"); -+ return ret; -+ } -+ -+ priv->fbdev_phytium_gem = phytium_gem_create_object(dev, size); -+ if (!priv->fbdev_phytium_gem) { -+ DRM_ERROR("failed to create gem object\n"); -+ return -ENOMEM; -+ } -+ mutex_unlock(&dev->struct_mutex); -+ -+ fbi = drm_fb_helper_alloc_fbi(helper); -+ if (IS_ERR(fbi)) { -+ DRM_DEV_ERROR(dev->dev, "Failed to create framebuffer info."); -+ ret = PTR_ERR(fbi); -+ goto out; -+ } -+ -+ phytium_fb = phytium_fb_alloc(dev, &mode_cmd, &priv->fbdev_phytium_gem, 1); -+ if (IS_ERR(phytium_fb)) { -+ DRM_DEV_ERROR(dev->dev, "Failed to alloc DRM framebuffer.\n"); -+ ret = PTR_ERR(phytium_fb); -+ goto out; -+ } -+ -+ helper->fb = &(phytium_fb->base); -+ fbi->par = helper; -+ fbi->flags = FBINFO_FLAG_DEFAULT; -+ fbi->fbops = &phytium_fbdev_ops; -+ -+ fb = helper->fb; -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ drm_fb_helper_fill_fix(fbi, fb->pitches[0], fb->format->depth); -+ drm_fb_helper_fill_var(fbi, helper, sizes->fb_width, sizes->fb_height); -+#else -+ drm_fb_helper_fill_info(fbi, helper, sizes); -+#endif -+ -+ offset = fbi->var.xoffset * bytes_per_pixel; -+ offset += fbi->var.yoffset * fb->pitches[0]; -+ dev->mode_config.fb_base = 0; -+ fbi->screen_base = priv->fbdev_phytium_gem->vaddr + offset; -+ fbi->screen_size = priv->fbdev_phytium_gem->base.size; -+ fbi->fix.smem_len = priv->fbdev_phytium_gem->base.size; -+ DRM_DEBUG_KMS("FB [%dx%d]-%d kvaddr=%pa offset=%ld size=%zu\n", fb->width, fb->height, -+ fb->format->depth, &priv->fbdev_phytium_gem->iova, offset, size); -+ fbi->skip_vt_switch = true; -+ -+ return 0; -+out: -+ phytium_gem_free_object(&priv->fbdev_phytium_gem->base); -+ return ret; -+} -+ -+static const struct drm_fb_helper_funcs phytium_drm_fb_helper_funcs = { -+ .fb_probe = phytium_drm_fbdev_create, -+}; -+ -+int phytium_drm_fbdev_init(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ struct drm_fb_helper *helper; -+ int ret; -+ -+ if (!dev->mode_config.num_crtc || !dev->mode_config.num_connector) -+ return -EINVAL; -+ -+ helper = &priv->fbdev_helper; -+ drm_fb_helper_prepare(dev, helper, &phytium_drm_fb_helper_funcs); -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ ret = drm_fb_helper_init(dev, helper, PHYTIUM_MAX_CONNECTOR); -+#else -+ ret = drm_fb_helper_init(dev, helper); -+#endif -+ if (ret < 0) { -+ DRM_DEV_ERROR(dev->dev, "Failed to initialize drm fb helper -ret %d\n", ret); -+ return ret; -+ } -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ ret = drm_fb_helper_single_add_all_connectors(helper); -+ if (ret < 0) { -+ DRM_DEV_ERROR(dev->dev, "Failed to add connectors - %d/\n", ret); -+ goto err_drm_fb_helper_fini; -+ } -+#endif -+ ret = drm_fb_helper_initial_config(helper, 32); -+ return ret; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+err_drm_fb_helper_fini: -+ drm_fb_helper_fini(helper); -+ return ret; -+#endif -+} -+ -+void phytium_drm_fbdev_fini(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ struct drm_fb_helper *helper; -+ -+ helper = &priv->fbdev_helper; -+ drm_fb_helper_unregister_fbi(helper); -+ -+ if (helper->fb) -+ drm_framebuffer_put(helper->fb); -+ -+ drm_fb_helper_fini(helper); -+} -diff --git a/drivers/gpu/drm/phytium/phytium_fbdev.h b/drivers/gpu/drm/phytium/phytium_fbdev.h -new file mode 100644 -index 000000000..ff63ba84d ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_fbdev.h -@@ -0,0 +1,13 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _PHYTIUM_FBDEV_H -+#define _PHYTIUM_FBDEV_H -+ -+int phytium_drm_fbdev_init(struct drm_device *dev); -+void phytium_drm_fbdev_fini(struct drm_device *dev); -+ -+#endif /* _PHYTIUM_FBDEV_H */ -diff --git a/drivers/gpu/drm/phytium/phytium_gem.c b/drivers/gpu/drm/phytium/phytium_gem.c -new file mode 100644 -index 000000000..d6f5494d9 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_gem.c -@@ -0,0 +1,544 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_gem.h" -+ -+#define VRAM_POOL_ALLOC_ORDER 12 -+ -+int phytium_memory_pool_alloc(struct phytium_display_private *priv, void **pvaddr, -+ phys_addr_t *phys_addr, uint64_t size) -+{ -+ unsigned long vaddr; -+ -+ vaddr = gen_pool_alloc(priv->memory_pool, size); -+ if (!vaddr) -+ return -ENOMEM; -+ -+ *phys_addr = gen_pool_virt_to_phys(priv->memory_pool, vaddr); -+ -+ *pvaddr = (void *)vaddr; -+ return 0; -+} -+ -+void phytium_memory_pool_free(struct phytium_display_private *priv, void *vaddr, uint64_t size) -+{ -+ gen_pool_free(priv->memory_pool, (unsigned long)vaddr, size); -+} -+ -+int phytium_memory_pool_init(struct device *dev, struct phytium_display_private *priv) -+{ -+ int ret = 0; -+ -+ priv->memory_pool = gen_pool_create(VRAM_POOL_ALLOC_ORDER, -1); -+ if (priv->memory_pool == NULL) { -+ DRM_ERROR("fail to create memory pool\n"); -+ ret = -1; -+ goto failed_create_pool; -+ } -+ -+ ret = gen_pool_add_virt(priv->memory_pool, (unsigned long)priv->pool_virt_addr, -+ priv->pool_phys_addr, priv->pool_size, -1); -+ if (ret) { -+ DRM_ERROR("fail to add vram pool\n"); -+ ret = -1; -+ goto failed_add_pool_virt; -+ } -+ -+ return 0; -+ -+failed_add_pool_virt: -+ gen_pool_destroy(priv->memory_pool); -+ -+failed_create_pool: -+ return ret; -+} -+ -+void phytium_memory_pool_fini(struct device *dev, struct phytium_display_private *priv) -+{ -+ gen_pool_destroy(priv->memory_pool); -+} -+ -+struct sg_table * -+phytium_gem_prime_get_sg_table(struct drm_gem_object *obj) -+{ -+ struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); -+ struct sg_table *sgt; -+ struct drm_device *dev = obj->dev; -+ int ret; -+ struct page *page = NULL; -+ -+ sgt = kzalloc(sizeof(*sgt), GFP_KERNEL); -+ if (!sgt) { -+ DRM_DEBUG_KMS("malloc sgt fail\n"); -+ return ERR_PTR(-ENOMEM); -+ } -+ -+ if ((phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) || -+ (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE) || -+ (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT)) { -+ ret = sg_alloc_table(sgt, 1, GFP_KERNEL); -+ if (ret) { -+ DRM_ERROR("failed to allocate sg\n"); -+ goto sgt_free; -+ } -+ page = pfn_to_page(__phys_to_pfn(phytium_gem_obj->phys_addr)); -+ sg_set_page(sgt->sgl, page, PAGE_ALIGN(phytium_gem_obj->size), 0); -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { -+ ret = dma_get_sgtable_attrs(dev->dev, sgt, phytium_gem_obj->vaddr, -+ phytium_gem_obj->iova, phytium_gem_obj->size, -+ DMA_ATTR_WRITE_COMBINE); -+ if (ret) { -+ DRM_ERROR("failed to allocate sgt, %d\n", ret); -+ goto sgt_free; -+ } -+ } -+ -+ return sgt; -+sgt_free: -+ kfree(sgt); -+ return ERR_PTR(ret); -+} -+ -+struct drm_gem_object * -+phytium_gem_prime_import_sg_table(struct drm_device *dev, -+ struct dma_buf_attachment *attach, -+ struct sg_table *sgt) -+{ -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ struct scatterlist *s; -+ dma_addr_t expected; -+ int ret, i; -+ -+ phytium_gem_obj = kzalloc(sizeof(*phytium_gem_obj), GFP_KERNEL); -+ if (!phytium_gem_obj) { -+ DRM_ERROR("failed to allocate phytium_gem_obj\n"); -+ ret = -ENOMEM; -+ goto failed_malloc; -+ } -+ -+ ret = drm_gem_object_init(dev, &phytium_gem_obj->base, attach->dmabuf->size); -+ if (ret) { -+ DRM_ERROR("failed to initialize drm gem object: %d\n", ret); -+ goto failed_object_init; -+ } -+ -+ expected = sg_dma_address(sgt->sgl); -+ for_each_sg(sgt->sgl, s, sgt->nents, i) { -+ if (sg_dma_address(s) != expected) { -+ DRM_ERROR("sg_table is not contiguous"); -+ ret = -EINVAL; -+ goto failed_check_continue; -+ } -+ expected = sg_dma_address(s) + sg_dma_len(s); -+ } -+ -+ phytium_gem_obj->iova = sg_dma_address(sgt->sgl); -+ phytium_gem_obj->sgt = sgt; -+ -+ return &phytium_gem_obj->base; -+failed_check_continue: -+ drm_gem_object_release(&phytium_gem_obj->base); -+failed_object_init: -+ kfree(phytium_gem_obj); -+failed_malloc: -+ return ERR_PTR(ret); -+} -+ -+void *phytium_gem_prime_vmap(struct drm_gem_object *obj) -+{ -+ struct phytium_gem_object *phytium_obj = to_phytium_gem_obj(obj); -+ -+ return phytium_obj->vaddr; -+} -+ -+void phytium_gem_prime_vunmap(struct drm_gem_object *obj, void *vaddr) -+{ -+ return; -+} -+ -+int phytium_gem_prime_mmap(struct drm_gem_object *obj, struct vm_area_struct *vma) -+{ -+ int ret = 0; -+ -+ ret = drm_gem_mmap_obj(obj, obj->size, vma); -+ if (ret < 0) -+ return ret; -+ -+ return phytium_gem_mmap_obj(obj, vma); -+} -+ -+static void phytium_dma_callback(void *callback_param) -+{ -+ struct completion *comp = callback_param; -+ -+ complete(comp); -+} -+ -+int phytium_dma_transfer(struct drm_device *drm_dev, int dev_to_mem, void *addr, -+ dma_addr_t iova, uint64_t size) -+{ -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ struct dma_chan *dma_chan = priv->dma_chan; -+ struct sg_table st; -+ struct scatterlist *sgl; -+ int ret = 0, timeout; -+ uint32_t nents, i; -+ struct dma_slave_config cfg = {0}; -+ struct dma_async_tx_descriptor *desc; -+ struct completion comp; -+ enum dma_data_direction dir; -+ size_t min = 0; -+ -+ nents = DIV_ROUND_UP(size, PAGE_SIZE); -+ ret = sg_alloc_table(&st, nents, GFP_KERNEL); -+ if (ret) { -+ DRM_ERROR("failed to allocate sg_table\n"); -+ ret = -ENOMEM; -+ goto failed_sg_alloc_table; -+ } -+ -+ for_each_sg(st.sgl, sgl, st.nents, i) { -+ min = min_t(size_t, size, PAGE_SIZE - offset_in_page(addr)); -+ sg_set_page(sgl, vmalloc_to_page(addr), min, offset_in_page(addr)); -+ addr += min; -+ size -= min; -+ } -+ -+ memset(&cfg, 0, sizeof(cfg)); -+ if (dev_to_mem) { -+ cfg.direction = DMA_DEV_TO_MEM; -+ cfg.src_addr = iova; -+ cfg.dst_addr = 0; -+ dir = DMA_FROM_DEVICE; -+ } else { -+ cfg.direction = DMA_MEM_TO_DEV; -+ cfg.src_addr = 0; -+ cfg.dst_addr = iova; -+ dir = DMA_TO_DEVICE; -+ } -+ -+ dmaengine_slave_config(dma_chan, &cfg); -+ -+ nents = dma_map_sg(dma_chan->device->dev, st.sgl, st.nents, dir); -+ if (!nents) { -+ DRM_DEV_ERROR(drm_dev->dev, "failed to dma_map_sg for dmaengine\n"); -+ ret = -EINVAL; -+ goto failed_dma_map_sg; -+ } -+ st.nents = nents; -+ dma_sync_sg_for_device(dma_chan->device->dev, st.sgl, st.nents, dir); -+ -+ sgl = st.sgl; -+ desc = dmaengine_prep_slave_sg(dma_chan, -+ st.sgl, -+ st.nents, -+ cfg.direction, -+ DMA_PREP_INTERRUPT | DMA_CTRL_ACK); -+ if (!desc) { -+ DRM_DEV_ERROR(drm_dev->dev, "failed to dmaengine_prep_slave_sg\n"); -+ ret = -EINVAL; -+ goto failed_prep_slave_sg; -+ } -+ init_completion(&comp); -+ desc->callback = phytium_dma_callback; -+ desc->callback_param = ∁ -+ -+ dmaengine_submit(desc); -+ dma_async_issue_pending(dma_chan); -+ -+ timeout = wait_for_completion_timeout(&comp, 2 * HZ); -+ if (timeout == 0) { -+ DRM_DEV_ERROR(drm_dev->dev, "wait for dma callback timeout\n"); -+ ret = -EIO; -+ } -+ dma_sync_sg_for_cpu(dma_chan->device->dev, st.sgl, st.nents, dir); -+ -+failed_prep_slave_sg: -+ dma_unmap_sg(dma_chan->device->dev, st.sgl, st.nents, dir); -+failed_dma_map_sg: -+ sg_free_table(&st); -+failed_sg_alloc_table: -+ return ret; -+} -+ -+int phytium_gem_suspend(struct drm_device *drm_dev) -+{ -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ int ret = 0; -+ -+ list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { -+ if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && -+ (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) -+ continue; -+ -+ phytium_gem_obj->vaddr_save = vmalloc(phytium_gem_obj->size); -+ if (!phytium_gem_obj->vaddr_save) -+ goto malloc_failed; -+ -+ if (priv->dma_inited) -+ ret = phytium_dma_transfer(drm_dev, 1, phytium_gem_obj->vaddr_save, -+ phytium_gem_obj->iova, phytium_gem_obj->size); -+ -+ if ((!priv->dma_inited) || ret) -+ memcpy(phytium_gem_obj->vaddr_save, phytium_gem_obj->vaddr, -+ phytium_gem_obj->size); -+ } -+ -+ return 0; -+malloc_failed: -+ list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { -+ if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && -+ (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) -+ continue; -+ -+ if (phytium_gem_obj->vaddr_save) { -+ vfree(phytium_gem_obj->vaddr_save); -+ phytium_gem_obj->vaddr_save = NULL; -+ } -+ } -+ return -ENOMEM; -+} -+ -+void phytium_gem_resume(struct drm_device *drm_dev) -+{ -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ -+ list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { -+ if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && -+ (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) -+ continue; -+ -+ memcpy(phytium_gem_obj->vaddr, phytium_gem_obj->vaddr_save, phytium_gem_obj->size); -+ vfree(phytium_gem_obj->vaddr_save); -+ phytium_gem_obj->vaddr_save = NULL; -+ } -+} -+ -+void phytium_gem_free_object(struct drm_gem_object *obj) -+{ -+ struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); -+ struct drm_device *dev = obj->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ uint64_t size = phytium_gem_obj->size; -+ -+ DRM_DEBUG_KMS("free phytium_gem_obj iova:0x%pa size:0x%lx\n", -+ &phytium_gem_obj->iova, phytium_gem_obj->size); -+ if (phytium_gem_obj->vaddr) { -+ if ((phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) || -+ (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE)) { -+ phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); -+ priv->mem_state[PHYTIUM_MEM_VRAM_ALLOC] -= size; -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { -+ dma_unmap_page(dev->dev, phytium_gem_obj->iova, size, DMA_TO_DEVICE); -+ phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC] -= size; -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { -+ dma_free_attrs(dev->dev, size, phytium_gem_obj->vaddr, -+ phytium_gem_obj->iova, 0); -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC] -= size; -+ } -+ list_del(&phytium_gem_obj->list); -+ } else if (obj->import_attach) -+ drm_prime_gem_destroy(obj, phytium_gem_obj->sgt); -+ drm_gem_object_release(obj); -+ kfree(phytium_gem_obj); -+} -+ -+int phytium_gem_mmap_obj(struct drm_gem_object *obj, struct vm_area_struct *vma) -+{ -+ int ret = 0; -+ struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); -+ unsigned long pfn = PHYS_PFN(phytium_gem_obj->phys_addr); -+ /* -+ * Clear the VM_PFNMAP flag that was set by drm_gem_mmap(), and set the -+ * vm_pgoff (used as a fake buffer offset by DRM) to 0 as we want to map -+ * the whole buffer. -+ */ -+ vma->vm_flags &= ~VM_PFNMAP; -+ vma->vm_pgoff = 0; -+ vma->vm_page_prot = vm_get_page_prot(vma->vm_flags); -+ -+ if (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) { -+ vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot); -+ ret = remap_pfn_range(vma, vma->vm_start, pfn, -+ vma->vm_end - vma->vm_start, vma->vm_page_prot); -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE) { -+ vma->vm_page_prot = pgprot_device(vma->vm_page_prot); -+ ret = remap_pfn_range(vma, vma->vm_start, pfn, -+ vma->vm_end - vma->vm_start, vma->vm_page_prot); -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { -+ ret = remap_pfn_range(vma, vma->vm_start, pfn, -+ vma->vm_end - vma->vm_start, vma->vm_page_prot); -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { -+ ret = dma_mmap_attrs(obj->dev->dev, vma, phytium_gem_obj->vaddr, -+ phytium_gem_obj->iova, vma->vm_end - vma->vm_start, 0); -+ } -+ if (ret) -+ drm_gem_vm_close(vma); -+ -+ return ret; -+} -+ -+int phytium_gem_mmap(struct file *filp, struct vm_area_struct *vma) -+{ -+ int ret = 0; -+ -+ ret = drm_gem_mmap(filp, vma); -+ if (ret < 0) -+ return ret; -+ -+ return phytium_gem_mmap_obj(vma->vm_private_data, vma); -+} -+ -+int phytium_gem_dumb_destroy(struct drm_file *file, struct drm_device *dev, uint32_t handle) -+{ -+ return drm_gem_dumb_destroy(file, dev, handle); -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) -+static const struct vm_operations_struct phytium_vm_ops = { -+ .open = drm_gem_vm_open, -+ .close = drm_gem_vm_close, -+}; -+ -+static const struct drm_gem_object_funcs phytium_drm_gem_object_funcs = { -+ .free = phytium_gem_free_object, -+ .get_sg_table = phytium_gem_prime_get_sg_table, -+ .vmap = phytium_gem_prime_vmap, -+ .vunmap = phytium_gem_prime_vunmap, -+ .vm_ops = &phytium_vm_ops, -+}; -+#endif -+ -+struct phytium_gem_object *phytium_gem_create_object(struct drm_device *dev, unsigned long size) -+{ -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct page *page = NULL; -+ int ret = 0; -+ -+ phytium_gem_obj = kzalloc(sizeof(*phytium_gem_obj), GFP_KERNEL); -+ if (!phytium_gem_obj) { -+ DRM_ERROR("failed to allocate phytium_gem_obj\n"); -+ ret = -ENOMEM; -+ goto error; -+ } -+ -+ ret = drm_gem_object_init(dev, &phytium_gem_obj->base, size); -+ if (ret) { -+ DRM_ERROR("failed to initialize drm gem object: %d\n", ret); -+ goto failed_object_init; -+ } -+ -+ if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) { -+ ret = phytium_memory_pool_alloc(priv, &phytium_gem_obj->vaddr, -+ &phytium_gem_obj->phys_addr, size); -+ if (ret) { -+ DRM_ERROR("fail to allocate vram buffer with size %lx\n", size); -+ goto failed_dma_alloc; -+ } -+ phytium_gem_obj->iova = phytium_gem_obj->phys_addr; -+ phytium_gem_obj->memory_type = priv->support_memory_type; -+ priv->mem_state[PHYTIUM_MEM_VRAM_ALLOC] += size; -+ } else if (priv->support_memory_type & MEMORY_TYPE_SYSTEM_CARVEOUT) { -+ ret = phytium_memory_pool_alloc(priv, &phytium_gem_obj->vaddr, -+ &phytium_gem_obj->phys_addr, size); -+ if (ret) { -+ DRM_ERROR("fail to allocate carveout memory with size %lx\n", size); -+ goto failed_dma_alloc; -+ } -+ page = pfn_to_page(__phys_to_pfn(phytium_gem_obj->phys_addr)); -+ phytium_gem_obj->iova = dma_map_page(dev->dev, page, 0, size, DMA_TO_DEVICE); -+ if (dma_mapping_error(dev->dev, phytium_gem_obj->iova)) { -+ DRM_ERROR("fail to dma map carveout memory with size %lx\n", size); -+ phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); -+ ret = -ENOMEM; -+ goto failed_dma_alloc; -+ } -+ phytium_gem_obj->memory_type = MEMORY_TYPE_SYSTEM_CARVEOUT; -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC] += size; -+ } else if (priv->support_memory_type & MEMORY_TYPE_SYSTEM_UNIFIED) { -+ phytium_gem_obj->vaddr = dma_alloc_attrs(dev->dev, size, &phytium_gem_obj->iova, -+ GFP_KERNEL, 0); -+ if (!phytium_gem_obj->vaddr) { -+ DRM_ERROR("fail to allocate unified buffer with size %lx\n", size); -+ ret = -ENOMEM; -+ goto failed_dma_alloc; -+ } -+ phytium_gem_obj->memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC] += size; -+ } else { -+ DRM_ERROR("fail to allocate buffer with size %lx\n", size); -+ ret = -ENOMEM; -+ goto failed_dma_alloc; -+ } -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) -+ phytium_gem_obj->base.funcs = &phytium_drm_gem_object_funcs; -+#endif -+ -+ phytium_gem_obj->size = size; -+ list_add_tail(&phytium_gem_obj->list, &priv->gem_list_head); -+ DRM_DEBUG_KMS("phytium_gem_obj iova:0x%pa size:0x%lx\n", -+ &phytium_gem_obj->iova, phytium_gem_obj->size); -+ return phytium_gem_obj; -+ -+failed_dma_alloc: -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) -+ drm_gem_object_put(&phytium_gem_obj->base); -+#else -+ drm_gem_object_unreference_unlocked(&phytium_gem_obj->base); -+#endif -+ -+ return ERR_PTR(ret); -+failed_object_init: -+ kfree(phytium_gem_obj); -+error: -+ return ERR_PTR(ret); -+} -+ -+int phytium_gem_dumb_create(struct drm_file *file, struct drm_device *dev, -+ struct drm_mode_create_dumb *args) -+{ -+ int size = 0; -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ int ret = 0; -+ -+ args->pitch = ALIGN(args->width*DIV_ROUND_UP(args->bpp, 8), 128); -+ args->size = args->pitch * args->height; -+ size = PAGE_ALIGN(args->size); -+ phytium_gem_obj = phytium_gem_create_object(dev, size); -+ if (IS_ERR(phytium_gem_obj)) -+ return PTR_ERR(phytium_gem_obj); -+ ret = drm_gem_handle_create(file, &phytium_gem_obj->base, &args->handle); -+ if (ret) { -+ DRM_ERROR("failed to drm_gem_handle_create\n"); -+ goto failed_gem_handle; -+ } -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) -+ drm_gem_object_put(&phytium_gem_obj->base); -+#else -+ drm_gem_object_unreference_unlocked(&phytium_gem_obj->base); -+#endif -+ -+ return 0; -+failed_gem_handle: -+ phytium_gem_free_object(&phytium_gem_obj->base); -+ return ret; -+} -diff --git a/drivers/gpu/drm/phytium/phytium_gem.h b/drivers/gpu/drm/phytium/phytium_gem.h -new file mode 100644 -index 000000000..50fb4f4f7 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_gem.h -@@ -0,0 +1,45 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_GEM_H__ -+#define __PHYTIUM_GEM_H__ -+ -+#include -+ -+struct phytium_gem_object { -+ struct drm_gem_object base; -+ phys_addr_t phys_addr; -+ dma_addr_t iova; -+ void *vaddr; -+ unsigned long size; -+ struct sg_table *sgt; -+ char memory_type; -+ char reserve[3]; -+ struct list_head list; -+ void *vaddr_save; -+}; -+ -+#define to_phytium_gem_obj(obj) container_of(obj, struct phytium_gem_object, base) -+ -+int phytium_memory_pool_init(struct device *dev, struct phytium_display_private *priv); -+void phytium_memory_pool_fini(struct device *dev, struct phytium_display_private *priv); -+int phytium_gem_mmap_obj(struct drm_gem_object *obj, struct vm_area_struct *vma); -+int phytium_gem_mmap(struct file *filp, struct vm_area_struct *vma); -+void phytium_gem_free_object(struct drm_gem_object *obj); -+struct sg_table *phytium_gem_prime_get_sg_table(struct drm_gem_object *obj); -+struct drm_gem_object *phytium_gem_prime_import_sg_table(struct drm_device *dev, -+ struct dma_buf_attachment *attach, struct sg_table *sgt); -+void phytium_gem_free_object(struct drm_gem_object *obj); -+int phytium_gem_dumb_destroy(struct drm_file *file, struct drm_device *dev, unsigned int handle); -+struct phytium_gem_object *phytium_gem_create_object(struct drm_device *dev, unsigned long size); -+int phytium_gem_dumb_create(struct drm_file *file, struct drm_device *dev, -+ struct drm_mode_create_dumb *args); -+void *phytium_gem_prime_vmap(struct drm_gem_object *obj); -+void phytium_gem_prime_vunmap(struct drm_gem_object *obj, void *vaddr); -+int phytium_gem_prime_mmap(struct drm_gem_object *obj, struct vm_area_struct *vma); -+int phytium_gem_suspend(struct drm_device *drm_dev); -+void phytium_gem_resume(struct drm_device *drm_dev); -+#endif /* __PHYTIUM_GEM_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_panel.c b/drivers/gpu/drm/phytium/phytium_panel.c -new file mode 100644 -index 000000000..60a20b9e6 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_panel.c -@@ -0,0 +1,420 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_dp.h" -+#include "phytium_panel.h" -+ -+static int -+phytium_dp_aux_set_backlight(struct phytium_panel *panel, unsigned int level) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ unsigned char vals[2] = { 0x0 }; -+ -+ vals[0] = level; -+ if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) { -+ vals[0] = (level & 0xFF00) >> 8; -+ vals[1] = (level & 0xFF); -+ } -+ -+ if (drm_dp_dpcd_write(&phytium_dp->aux, DP_EDP_BACKLIGHT_BRIGHTNESS_MSB, -+ vals, sizeof(vals)) < 0) { -+ DRM_DEBUG_KMS("Failed to write aux backlight level\n"); -+ return -EIO; -+ } -+ -+ return 0; -+} -+ -+static unsigned int phytium_dp_aux_get_backlight(struct phytium_panel *panel) -+{ -+ unsigned char read_val[2] = { 0x0 }; -+ unsigned char level = 0; -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ if (drm_dp_dpcd_read(&phytium_dp->aux, DP_EDP_BACKLIGHT_BRIGHTNESS_MSB, -+ &read_val, sizeof(read_val)) < 0) { -+ DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", -+ DP_EDP_BACKLIGHT_BRIGHTNESS_MSB); -+ return 0; -+ } -+ -+ level = read_val[0]; -+ if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) -+ level = (read_val[0] << 8 | read_val[1]); -+ -+ return level; -+} -+ -+static void set_aux_backlight_enable(struct phytium_panel *panel, bool enable) -+{ -+ u8 reg_val = 0; -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ if (!(phytium_dp->edp_dpcd[1] & DP_EDP_BACKLIGHT_AUX_ENABLE_CAP)) -+ return; -+ -+ if (drm_dp_dpcd_readb(&phytium_dp->aux, DP_EDP_DISPLAY_CONTROL_REGISTER, -+ ®_val) < 0) { -+ DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", -+ DP_EDP_DISPLAY_CONTROL_REGISTER); -+ return; -+ } -+ -+ if (enable) -+ reg_val |= DP_EDP_BACKLIGHT_ENABLE; -+ else -+ reg_val &= ~(DP_EDP_BACKLIGHT_ENABLE); -+ -+ if (drm_dp_dpcd_writeb(&phytium_dp->aux, DP_EDP_DISPLAY_CONTROL_REGISTER, -+ reg_val) != 1) { -+ DRM_DEBUG_KMS("Failed to %s aux backlight\n", -+ enable ? "enable" : "disable"); -+ } -+} -+ -+static void phytium_dp_aux_enable_backlight(struct phytium_panel *panel) -+{ -+ unsigned char dpcd_buf, new_dpcd_buf, edp_backlight_mode; -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ if (drm_dp_dpcd_readb(&phytium_dp->aux, -+ DP_EDP_BACKLIGHT_MODE_SET_REGISTER, &dpcd_buf) != 1) { -+ DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", -+ DP_EDP_BACKLIGHT_MODE_SET_REGISTER); -+ return; -+ } -+ -+ new_dpcd_buf = dpcd_buf; -+ edp_backlight_mode = dpcd_buf & DP_EDP_BACKLIGHT_CONTROL_MODE_MASK; -+ -+ switch (edp_backlight_mode) { -+ case DP_EDP_BACKLIGHT_CONTROL_MODE_PWM: -+ case DP_EDP_BACKLIGHT_CONTROL_MODE_PRESET: -+ case DP_EDP_BACKLIGHT_CONTROL_MODE_PRODUCT: -+ new_dpcd_buf &= ~DP_EDP_BACKLIGHT_CONTROL_MODE_MASK; -+ new_dpcd_buf |= DP_EDP_BACKLIGHT_CONTROL_MODE_DPCD; -+ break; -+ -+ /* Do nothing when it is already DPCD mode */ -+ case DP_EDP_BACKLIGHT_CONTROL_MODE_DPCD: -+ default: -+ break; -+ } -+ -+ if (new_dpcd_buf != dpcd_buf) { -+ if (drm_dp_dpcd_writeb(&phytium_dp->aux, -+ DP_EDP_BACKLIGHT_MODE_SET_REGISTER, new_dpcd_buf) < 0) { -+ DRM_DEBUG_KMS("Failed to write aux backlight mode\n"); -+ } -+ } -+ -+ set_aux_backlight_enable(panel, true); -+ phytium_dp_aux_set_backlight(panel, panel->level); -+} -+ -+static void phytium_dp_aux_disable_backlight(struct phytium_panel *panel) -+{ -+ set_aux_backlight_enable(panel, false); -+} -+ -+static void phytium_dp_aux_setup_backlight(struct phytium_panel *panel) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) -+ phytium_dp->panel.max = 0xFFFF; -+ else -+ phytium_dp->panel.max = 0xFF; -+ -+ phytium_dp->panel.min = 0; -+ phytium_dp->panel.level = phytium_dp_aux_get_backlight(panel); -+ phytium_dp->panel.backlight_enabled = (phytium_dp->panel.level != 0); -+} -+ -+static void phytium_dp_hw_poweron_panel(struct phytium_panel *panel) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ phytium_dp->funcs->dp_hw_poweron_panel(phytium_dp); -+} -+ -+static void phytium_dp_hw_poweroff_panel(struct phytium_panel *panel) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ phytium_dp->funcs->dp_hw_poweroff_panel(phytium_dp); -+} -+ -+static int -+phytium_dp_hw_set_backlight(struct phytium_panel *panel, uint32_t level) -+{ -+ int ret; -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ ret = phytium_dp->funcs->dp_hw_set_backlight(phytium_dp, level); -+ -+ return ret; -+} -+ -+static uint32_t phytium_dp_hw_get_backlight(struct phytium_panel *panel) -+{ -+ uint32_t ret; -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ ret = phytium_dp->funcs->dp_hw_get_backlight(phytium_dp); -+ -+ return ret; -+} -+ -+static void phytium_dp_hw_enable_backlight(struct phytium_panel *panel) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ phytium_dp->funcs->dp_hw_set_backlight(phytium_dp, phytium_dp->panel.level); -+ phytium_dp->funcs->dp_hw_enable_backlight(phytium_dp); -+} -+ -+static void phytium_dp_hw_disable_backlight(struct phytium_panel *panel) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ phytium_dp->funcs->dp_hw_disable_backlight(phytium_dp); -+} -+ -+static void phytium_dp_hw_setup_backlight(struct phytium_panel *panel) -+{ -+ struct drm_device *dev = panel->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ panel->max = priv->info.backlight_max; -+ panel->min = priv->info.backlight_min; -+ panel->level = phytium_dp_hw_get_backlight(panel); -+} -+ -+void phytium_dp_panel_init_backlight_funcs(struct phytium_dp_device *phytium_dp) -+{ -+ if (phytium_dp->edp_dpcd[1] & DP_EDP_TCON_BACKLIGHT_ADJUSTMENT_CAP && -+ (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_AUX_SET_CAP) && -+ !(phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_PWM_PIN_CAP)) { -+ DRM_DEBUG_KMS("AUX Backlight Control Supported!\n"); -+ phytium_dp->panel.setup_backlight = phytium_dp_aux_setup_backlight; -+ phytium_dp->panel.enable_backlight = phytium_dp_aux_enable_backlight; -+ phytium_dp->panel.disable_backlight = phytium_dp_aux_disable_backlight; -+ phytium_dp->panel.set_backlight = phytium_dp_aux_set_backlight; -+ phytium_dp->panel.get_backlight = phytium_dp_aux_get_backlight; -+ } else { -+ DRM_DEBUG_KMS("PWM Backlight Control Supported!\n"); -+ phytium_dp->panel.setup_backlight = phytium_dp_hw_setup_backlight; -+ phytium_dp->panel.enable_backlight = phytium_dp_hw_enable_backlight; -+ phytium_dp->panel.disable_backlight = phytium_dp_hw_disable_backlight; -+ phytium_dp->panel.set_backlight = phytium_dp_hw_set_backlight; -+ phytium_dp->panel.get_backlight = phytium_dp_hw_get_backlight; -+ } -+ phytium_dp->panel.poweron = phytium_dp_hw_poweron_panel; -+ phytium_dp->panel.poweroff = phytium_dp_hw_poweroff_panel; -+ mutex_init(&phytium_dp->panel.panel_lock); -+ phytium_dp->panel.dev = phytium_dp->dev; -+ -+ /* Upper limits from eDP 1.3 spec */ -+ phytium_dp->panel.panel_power_up_delay = 210; /* t1_t3 */ -+ phytium_dp->panel.backlight_on_delay = 50; /* t7 */ -+ phytium_dp->panel.backlight_off_delay = 50; -+ phytium_dp->panel.panel_power_down_delay = 0; /* t10 */ -+ phytium_dp->panel.panel_power_cycle_delay = 510; /* t11 + t12 */ -+} -+ -+void phytium_dp_panel_release_backlight_funcs(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_dp->panel.setup_backlight = NULL; -+ phytium_dp->panel.enable_backlight = NULL; -+ phytium_dp->panel.disable_backlight = NULL; -+ phytium_dp->panel.set_backlight = NULL; -+ phytium_dp->panel.get_backlight = NULL; -+ phytium_dp->panel.poweron = NULL; -+ phytium_dp->panel.poweroff = NULL; -+} -+ -+void phytium_panel_enable_backlight(struct phytium_panel *panel) -+{ -+ -+ if (panel->enable_backlight) { -+ mutex_lock(&panel->panel_lock); -+ msleep(panel->backlight_on_delay); -+ panel->enable_backlight(panel); -+ panel->backlight_enabled = true; -+ mutex_unlock(&panel->panel_lock); -+ } -+} -+ -+void phytium_panel_disable_backlight(struct phytium_panel *panel) -+{ -+ if (panel->disable_backlight) { -+ mutex_lock(&panel->panel_lock); -+ panel->disable_backlight(panel); -+ panel->backlight_enabled = false; -+ msleep(panel->backlight_off_delay); -+ mutex_unlock(&panel->panel_lock); -+ } -+} -+ -+void phytium_panel_poweron(struct phytium_panel *panel) -+{ -+ if (panel->poweron) { -+ mutex_lock(&panel->panel_lock); -+ panel->poweron(panel); -+ panel->power_enabled = true; -+ msleep(panel->panel_power_up_delay); -+ mutex_unlock(&panel->panel_lock); -+ } -+} -+ -+void phytium_panel_poweroff(struct phytium_panel *panel) -+{ -+ if (panel->poweroff) { -+ mutex_lock(&panel->panel_lock); -+ msleep(panel->panel_power_down_delay); -+ panel->poweroff(panel); -+ panel->power_enabled = false; -+ mutex_unlock(&panel->panel_lock); -+ } -+} -+ -+static uint32_t phytium_scale(uint32_t source_val, -+ uint32_t source_min, uint32_t source_max, -+ uint32_t target_min, uint32_t target_max) -+{ -+ uint64_t target_val; -+ -+ WARN_ON(source_min > source_max); -+ WARN_ON(target_min > target_max); -+ -+ /* defensive */ -+ source_val = clamp(source_val, source_min, source_max); -+ -+ /* avoid overflows */ -+ target_val = mul_u32_u32(source_val - source_min, target_max - target_min); -+ target_val = DIV_ROUND_CLOSEST_ULL(target_val, source_max - source_min); -+ target_val += target_min; -+ -+ return target_val; -+} -+ -+static inline uint32_t -+phytium_scale_hw_to_user(struct phytium_panel *panel, uint32_t hw_level, uint32_t user_max) -+{ -+ return phytium_scale(hw_level, panel->min, panel->max, -+ 0, user_max); -+} -+ -+static inline uint32_t -+phytium_scale_user_to_hw(struct phytium_panel *panel, u32 user_level, u32 user_max) -+{ -+ return phytium_scale(user_level, 0, user_max, -+ panel->min, panel->max); -+} -+ -+static int phytium_backlight_device_update_status(struct backlight_device *bd) -+{ -+ struct phytium_panel *panel = bl_get_data(bd); -+ struct drm_device *dev = panel->dev; -+ uint32_t hw_level = 0; -+ int ret = 0; -+ -+ DRM_DEBUG_KMS("updating phytium_backlight, brightness=%d/%d\n", -+ bd->props.brightness, bd->props.max_brightness); -+ drm_modeset_lock(&dev->mode_config.connection_mutex, NULL); -+ hw_level = phytium_scale_user_to_hw(panel, bd->props.brightness, bd->props.max_brightness); -+ -+ if ((panel->set_backlight) && (panel->backlight_enabled)) { -+ mutex_lock(&panel->panel_lock); -+ ret = panel->set_backlight(panel, hw_level); -+ panel->level = hw_level; -+ mutex_unlock(&panel->panel_lock); -+ } -+ drm_modeset_unlock(&dev->mode_config.connection_mutex); -+ -+ return ret; -+} -+ -+static int phytium_backlight_device_get_brightness(struct backlight_device *bd) -+{ -+ struct phytium_panel *panel = bl_get_data(bd); -+ struct drm_device *dev = panel->dev; -+ uint32_t hw_level = 0; -+ int ret; -+ -+ drm_modeset_lock(&dev->mode_config.connection_mutex, NULL); -+ if (panel->get_backlight && panel->backlight_enabled) { -+ mutex_lock(&panel->panel_lock); -+ hw_level = panel->get_backlight(panel); -+ panel->level = hw_level; -+ mutex_unlock(&panel->panel_lock); -+ } -+ drm_modeset_unlock(&dev->mode_config.connection_mutex); -+ ret = phytium_scale_hw_to_user(panel, hw_level, bd->props.max_brightness); -+ DRM_DEBUG_KMS("get phytium_backlight, brightness=%d/%d\n", -+ ret, bd->props.max_brightness); -+ -+ return ret; -+} -+ -+static const struct backlight_ops phytium_backlight_device_ops = { -+ .update_status = phytium_backlight_device_update_status, -+ .get_brightness = phytium_backlight_device_get_brightness, -+}; -+ -+int phytium_edp_backlight_device_register(struct phytium_dp_device *phytium_dp) -+{ -+ struct backlight_properties props; -+ char bl_name[16]; -+ -+ if (phytium_dp->panel.setup_backlight) { -+ mutex_lock(&phytium_dp->panel.panel_lock); -+ phytium_dp->panel.setup_backlight(&phytium_dp->panel); -+ mutex_unlock(&phytium_dp->panel.panel_lock); -+ } else { -+ return -EINVAL; -+ } -+ -+ memset(&props, 0, sizeof(props)); -+ props.max_brightness = PHYTIUM_MAX_BL_LEVEL; -+ props.type = BACKLIGHT_RAW; -+ props.brightness = phytium_scale_hw_to_user(&phytium_dp->panel, phytium_dp->panel.level, -+ props.max_brightness); -+ snprintf(bl_name, sizeof(bl_name), "phytium_bl%d", phytium_dp->port); -+ -+ phytium_dp->panel.bl_device = -+ backlight_device_register(bl_name, -+ phytium_dp->connector.kdev, -+ &phytium_dp->panel, -+ &phytium_backlight_device_ops, -+ &props); -+ -+ if (IS_ERR(phytium_dp->panel.bl_device)) { -+ DRM_ERROR("Failed to register backlight: %ld\n", -+ PTR_ERR(phytium_dp->panel.bl_device)); -+ phytium_dp->panel.bl_device = NULL; -+ return -ENODEV; -+ } -+ -+ DRM_DEBUG_KMS("Connector %s backlight sysfs interface registered\n", -+ phytium_dp->connector.name); -+ -+ return 0; -+} -+ -+void phytium_edp_backlight_device_unregister(struct phytium_dp_device *phytium_dp) -+{ -+ if (phytium_dp->panel.bl_device) { -+ backlight_device_unregister(phytium_dp->panel.bl_device); -+ phytium_dp->panel.bl_device = NULL; -+ } -+} -diff --git a/drivers/gpu/drm/phytium/phytium_panel.h b/drivers/gpu/drm/phytium/phytium_panel.h -new file mode 100644 -index 000000000..ff4d760d8 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_panel.h -@@ -0,0 +1,46 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_PANEL_H__ -+#define __PHYTIUM_PANEL_H__ -+#include "phytium_dp.h" -+ -+#define PHYTIUM_MAX_BL_LEVEL 0xFF -+ -+struct phytium_panel { -+ struct drm_device *dev; -+ bool backlight_enabled; -+ bool power_enabled; -+ bool reserve1[2]; -+ unsigned int min; -+ unsigned int level; -+ unsigned int max; -+ struct backlight_device *bl_device; -+ void (*setup_backlight)(struct phytium_panel *panel); -+ uint32_t (*get_backlight)(struct phytium_panel *panel); -+ int (*set_backlight)(struct phytium_panel *panel, uint32_t level); -+ void (*disable_backlight)(struct phytium_panel *panel); -+ void (*enable_backlight)(struct phytium_panel *panel); -+ void (*poweron)(struct phytium_panel *panel); -+ void (*poweroff)(struct phytium_panel *panel); -+ struct mutex panel_lock; -+ uint32_t panel_power_up_delay; -+ uint32_t backlight_on_delay; -+ uint32_t backlight_off_delay; -+ uint32_t panel_power_down_delay; -+ uint32_t panel_power_cycle_delay; -+}; -+ -+void phytium_dp_panel_init_backlight_funcs(struct phytium_dp_device *phytium_dp); -+void phytium_panel_release_backlight_funcs(struct phytium_dp_device *phytium_dp); -+int phytium_edp_backlight_device_register(struct phytium_dp_device *phytium_dp); -+void phytium_edp_backlight_device_unregister(struct phytium_dp_device *phytium_dp); -+void phytium_panel_enable_backlight(struct phytium_panel *panel); -+void phytium_panel_disable_backlight(struct phytium_panel *panel); -+void phytium_panel_poweron(struct phytium_panel *panel); -+void phytium_panel_poweroff(struct phytium_panel *panel); -+ -+#endif /* __PHYTIUM_PANEL_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_pci.c b/drivers/gpu/drm/phytium/phytium_pci.c -new file mode 100644 -index 000000000..bafb84107 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_pci.c -@@ -0,0 +1,446 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_pci.h" -+#include "phytium_dp.h" -+#include "phytium_gem.h" -+#include "px210_dc.h" -+#include "px210_dp.h" -+#include "pe220x_dc.h" -+#include "pe220x_dp.h" -+ -+int dc_msi_enable; -+module_param(dc_msi_enable, int, 0644); -+MODULE_PARM_DESC(dc_msi_enable, "Enable DC msi interrupt (0-disabled; 1-enabled; default-0)"); -+ -+void phytium_pci_vram_hw_init(struct phytium_display_private *priv) -+{ -+ struct phytium_pci_private *pci_priv = to_pci_priv(priv); -+ -+ pci_priv->dc_hw_vram_init(priv, priv->pool_phys_addr, priv->pool_size); -+} -+ -+static bool phytium_pci_host_is_5c01(struct pci_bus *bus) -+{ -+ struct pci_bus *child = bus; -+ struct pci_dev *root = NULL; -+ -+ while (child) { -+ if (child->parent->parent) -+ child = child->parent; -+ else -+ break; -+ } -+ -+ root = child->self; -+ if ((root->vendor == 0x1db7) && (root->device == 0x5c01)) -+ return true; -+ return false; -+} -+ -+int phytium_pci_vram_init(struct pci_dev *pdev, struct phytium_display_private *priv) -+{ -+ int ret = 0; -+ -+ priv->pool_phys_addr = pci_resource_start(pdev, 2); -+ priv->pool_size = pci_resource_len(pdev, 2); -+ if ((priv->pool_phys_addr != 0) && (priv->pool_size != 0)) { -+ if ((pdev->device == 0xdc3e) && phytium_pci_host_is_5c01(pdev->bus)) { -+ priv->pool_virt_addr = devm_ioremap(&pdev->dev, priv->pool_phys_addr, -+ priv->pool_size); -+ priv->support_memory_type = MEMORY_TYPE_VRAM_DEVICE; -+ } else { -+ priv->pool_virt_addr = devm_ioremap_wc(&pdev->dev, priv->pool_phys_addr, -+ priv->pool_size); -+ priv->support_memory_type = MEMORY_TYPE_VRAM_WC; -+ } -+ if (priv->pool_virt_addr == NULL) { -+ DRM_ERROR("pci vram ioremap fail, addr:0x%llx, size:0x%llx\n", -+ priv->pool_phys_addr, priv->pool_size); -+ ret = -EINVAL; -+ goto failed_ioremap; -+ } -+ ret = phytium_memory_pool_init(&pdev->dev, priv); -+ if (ret) -+ goto failed_init_memory_pool; -+ -+ priv->mem_state[PHYTIUM_MEM_VRAM_TOTAL] = priv->pool_size; -+ priv->vram_hw_init = phytium_pci_vram_hw_init; -+ } else { -+ DRM_DEBUG_KMS("not support vram\n"); -+ priv->pool_virt_addr = NULL; -+ priv->mem_state[PHYTIUM_MEM_VRAM_TOTAL] = 0; -+ priv->support_memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; -+ priv->vram_hw_init = NULL; -+ } -+ -+ return 0; -+ -+failed_init_memory_pool: -+ devm_iounmap(&pdev->dev, priv->pool_virt_addr); -+failed_ioremap: -+ return ret; -+} -+ -+void phytium_pci_vram_fini(struct pci_dev *pdev, struct phytium_display_private *priv) -+{ -+ if ((priv->support_memory_type == MEMORY_TYPE_VRAM_WC) || -+ (priv->support_memory_type == MEMORY_TYPE_VRAM_DEVICE)) { -+ phytium_memory_pool_fini(&pdev->dev, priv); -+ devm_iounmap(&pdev->dev, priv->pool_virt_addr); -+ } -+} -+ -+static bool phytium_pci_dma_chan_filter(struct dma_chan *chan, void *param) -+{ -+ struct phytium_dma_slave *s = param; -+ -+ if (s->dma_dev != chan->device->dev) -+ return false; -+ -+ if (s->chan_id == chan->chan_id) -+ return true; -+ else -+ return false; -+} -+ -+int phytium_pci_dma_init(struct phytium_display_private *priv) -+{ -+ struct pci_dev *dma_dev, *gpu_dev; -+ struct drm_device *drm_dev = priv->dev; -+ dma_cap_mask_t mask; -+ struct phytium_dma_slave s; -+ int ret = 0; -+ u16 cmd; -+ -+ /* check px210 gpu enable */ -+ gpu_dev = pci_get_device(PCI_VENDOR_ID_PHYTIUM, 0xdc20, NULL); -+ if (!gpu_dev) { -+ DRM_INFO("failed to get gpu_dev\n"); -+ ret = -ENODEV; -+ goto failed; -+ } -+ -+ pci_read_config_word(gpu_dev, PCI_COMMAND, &cmd); -+ if (!(cmd & PCI_COMMAND_MASTER)) { -+ DRM_INFO("gpu_dev master is disabled\n"); -+ ret = -ENODEV; -+ goto failed; -+ } -+ -+ dma_dev = pci_get_device(PCI_VENDOR_ID_PHYTIUM, 0xdc3c, NULL); -+ if (!dma_dev) { -+ DRM_INFO("failed to get dma_dev\n"); -+ ret = -ENODEV; -+ goto failed; -+ } -+ -+ dma_cap_zero(mask); -+ dma_cap_set(DMA_SLAVE, mask); -+ -+ s.dma_dev = &dma_dev->dev; -+ s.chan_id = 2; -+ priv->dma_chan = dma_request_channel(mask, phytium_pci_dma_chan_filter, &s); -+ if (!priv->dma_chan) { -+ DRM_DEV_ERROR(drm_dev->dev, "failed to request dma chan\n"); -+ ret = -EBUSY; -+ goto failed; -+ } -+ priv->dma_inited = 1; -+ -+failed: -+ return ret; -+} -+ -+void phytium_pci_dma_fini(struct phytium_display_private *priv) -+{ -+ if (priv->dma_inited) -+ dma_release_channel(priv->dma_chan); -+ priv->dma_inited = 0; -+ priv->dma_chan = NULL; -+} -+ -+static struct phytium_display_private* -+phytium_pci_private_init(struct pci_dev *pdev, const struct pci_device_id *ent) -+{ -+ struct drm_device *dev = pci_get_drvdata(pdev); -+ struct phytium_display_private *priv = NULL; -+ struct phytium_pci_private *pci_priv = NULL; -+ struct phytium_device_info *phytium_info = (struct phytium_device_info *)ent->driver_data; -+ int i = 0; -+ resource_size_t io_addr, io_size; -+ -+ pci_priv = devm_kzalloc(&pdev->dev, sizeof(*pci_priv), GFP_KERNEL); -+ if (!pci_priv) { -+ DRM_ERROR("no memory to allocate for drm_display_private\n"); -+ goto failed_malloc_priv; -+ } -+ -+ memset(pci_priv, 0, sizeof(*pci_priv)); -+ priv = &pci_priv->base; -+ phytium_display_private_init(priv, dev); -+ -+ memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); -+ DRM_DEBUG_KMS("priv->info.num_pipes :%d\n", priv->info.num_pipes); -+ priv->info.pipe_mask = ((pdev->subsystem_device >> PIPE_MASK_SHIFT) & PIPE_MASK_MASK); -+ priv->info.edp_mask = ((pdev->subsystem_device >> EDP_MASK_SHIFT) & EDP_MASK_MASK); -+ priv->info.num_pipes = 0; -+ for_each_pipe_masked(priv, i) -+ priv->info.num_pipes++; -+ if (priv->info.num_pipes == 0) { -+ DRM_ERROR("num_pipes is zero, so exit init\n"); -+ goto failed_init_numpipe; -+ } -+ -+ io_addr = pci_resource_start(pdev, 0); -+ io_size = pci_resource_len(pdev, 0); -+ priv->regs = ioremap(io_addr, io_size); -+ if (priv->regs == NULL) { -+ DRM_ERROR("pci bar0 ioremap fail, addr:0x%llx, size:0x%llx\n", io_addr, io_size); -+ goto failed_ioremap; -+ } -+ -+ priv->irq = pdev->irq; -+ if (IS_PX210(priv)) { -+ pci_priv->dc_hw_vram_init = px210_dc_hw_vram_init; -+ priv->dc_hw_clear_msi_irq = px210_dc_hw_clear_msi_irq; -+ priv->dc_hw_fb_format_check = px210_dc_hw_fb_format_check; -+ } else if (IS_PE220X(priv)) { -+ pci_priv->dc_hw_vram_init = pe220x_dc_hw_vram_init; -+ priv->dc_hw_clear_msi_irq = NULL; -+ priv->dc_hw_fb_format_check = pe220x_dc_hw_fb_format_check; -+ } -+ -+ return priv; -+ -+failed_ioremap: -+failed_init_numpipe: -+ devm_kfree(&pdev->dev, pci_priv); -+failed_malloc_priv: -+ return NULL; -+} -+ -+static void -+phytium_pci_private_fini(struct pci_dev *pdev, struct phytium_display_private *priv) -+{ -+ struct phytium_pci_private *pci_priv = to_pci_priv(priv); -+ -+ if (priv->regs) -+ iounmap(priv->regs); -+ -+ devm_kfree(&pdev->dev, pci_priv); -+} -+ -+static int phytium_kick_out_firmware_fb(struct pci_dev *pdev) -+{ -+ struct apertures_struct *ap; -+ -+ ap = alloc_apertures(1); -+ if (!ap) -+ return -ENOMEM; -+ -+ ap->ranges[0].base = pci_resource_start(pdev, 2); -+ ap->ranges[0].size = pci_resource_len(pdev, 2); -+ -+ drm_fb_helper_remove_conflicting_framebuffers(ap, "phytiumdrmfb", -+ false); -+ kfree(ap); -+ -+ return 0; -+} -+ -+static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent) -+{ -+ struct phytium_display_private *priv = NULL; -+ struct drm_device *dev = NULL; -+ int ret = 0; -+ struct phytium_device_info *phytium_info = (struct phytium_device_info *)ent->driver_data; -+ -+ if (phytium_info) { -+ if (phytium_info->platform_mask & BIT(PHYTIUM_PLATFORM_PE220X)) -+ phytium_display_drm_driver.name = "pe220x"; -+ } -+ -+ ret = phytium_kick_out_firmware_fb(pdev); -+ if (ret) -+ DRM_ERROR("failed to remove conflicting framebuffers\n"); -+ -+ dev = drm_dev_alloc(&phytium_display_drm_driver, &pdev->dev); -+ if (IS_ERR(dev)) { -+ DRM_ERROR("failed to allocate drm_device\n"); -+ return PTR_ERR(dev); -+ } -+ dev->pdev = pdev; -+ pci_set_drvdata(pdev, dev); -+ pci_set_master(pdev); -+ ret = pci_enable_device(pdev); -+ if (ret) { -+ DRM_ERROR("pci enbale device fail\n"); -+ goto failed_enable_device; -+ } -+ -+ if (dc_msi_enable) { -+ ret = pci_enable_msi(pdev); -+ if (ret) -+ DRM_ERROR("pci enbale msi fail\n"); -+ } -+ -+ dma_set_mask(&pdev->dev, DMA_BIT_MASK(40)); -+ -+ priv = phytium_pci_private_init(pdev, ent); -+ if (priv) -+ dev->dev_private = priv; -+ else -+ goto failed_pci_private_init; -+ -+ ret = phytium_pci_vram_init(pdev, priv); -+ if (ret) { -+ DRM_ERROR("failed to init pci vram\n"); -+ goto failed_pci_vram_init; -+ } -+ -+ ret = drm_dev_register(dev, 0); -+ if (ret) { -+ DRM_ERROR("failed to register drm dev\n"); -+ goto failed_register_drm; -+ } -+ -+ phytium_dp_hpd_irq_setup(dev, true); -+ -+ return 0; -+ -+failed_register_drm: -+ phytium_pci_vram_fini(pdev, priv); -+failed_pci_vram_init: -+ phytium_pci_private_fini(pdev, priv); -+failed_pci_private_init: -+ if (pdev->msi_enabled) -+ pci_disable_msi(pdev); -+ pci_disable_device(pdev); -+failed_enable_device: -+ pci_set_drvdata(pdev, NULL); -+ drm_dev_put(dev); -+ -+ return -1; -+} -+ -+static void phytium_pci_remove(struct pci_dev *pdev) -+{ -+ struct drm_device *dev = pci_get_drvdata(pdev); -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ phytium_dp_hpd_irq_setup(dev, false); -+ cancel_work_sync(&priv->hotplug_work); -+ drm_dev_unregister(dev); -+ phytium_pci_vram_fini(pdev, priv); -+ phytium_pci_private_fini(pdev, priv); -+ if (pdev->msi_enabled) -+ pci_disable_msi(pdev); -+ pci_disable_device(pdev); -+ pci_set_drvdata(pdev, NULL); -+ drm_dev_put(dev); -+} -+ -+static void phytium_pci_shutdown(struct pci_dev *pdev) -+{ -+ struct drm_device *dev = pci_get_drvdata(pdev); -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ priv->display_shutdown(dev); -+} -+ -+static int phytium_pci_pm_suspend(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct drm_device *drm_dev = pci_get_drvdata(pdev); -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ int ret = 0; -+ -+ if (IS_PX210(priv)) -+ phytium_pci_dma_init(priv); -+ -+ ret = priv->display_pm_suspend(drm_dev); -+ if (ret < 0) -+ goto out; -+ -+ pci_save_state(pdev); -+ pci_disable_device(pdev); -+ pci_set_power_state(pdev, PCI_D3hot); -+ udelay(200); -+ -+out: -+ return ret; -+} -+ -+static int phytium_pci_pm_resume(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct drm_device *drm_dev = pci_get_drvdata(pdev); -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ int ret = 0; -+ -+ pci_set_power_state(pdev, PCI_D0); -+ pci_restore_state(pdev); -+ ret = pci_enable_device(pdev); -+ if (ret) -+ return ret; -+ pci_set_master(pdev); -+ -+ ret = priv->display_pm_resume(drm_dev); -+ if (IS_PX210(priv)) -+ phytium_pci_dma_fini(priv); -+ -+ return ret; -+} -+ -+static const struct dev_pm_ops phytium_pci_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_pci_pm_suspend, phytium_pci_pm_resume) -+}; -+ -+static const struct phytium_device_info px210_info = { -+ .platform_mask = BIT(PHYTIUM_PLATFORM_PX210), -+ .total_pipes = 3, -+ .crtc_clock_max = PX210_DC_PIX_CLOCK_MAX, -+ .hdisplay_max = PX210_DC_HDISPLAY_MAX, -+ .vdisplay_max = PX210_DC_VDISPLAY_MAX, -+ .address_mask = PX210_DC_ADDRESS_MASK, -+ .backlight_max = PX210_DP_BACKLIGHT_MAX, -+ .backlight_min = PX210_DP_BACKLIGHT_MIN, -+ .bmc_mode = false, -+}; -+ -+static const struct phytium_device_info pe220x_info = { -+ .platform_mask = BIT(PHYTIUM_PLATFORM_PE220X), -+ .total_pipes = 2, -+ .crtc_clock_max = PE220X_DC_PIX_CLOCK_MAX, -+ .hdisplay_max = PE220X_DC_HDISPLAY_MAX, -+ .vdisplay_max = PE220X_DC_VDISPLAY_MAX, -+ .address_mask = PE220X_DC_ADDRESS_MASK, -+ .backlight_max = PE220X_DP_BACKLIGHT_MAX, -+ .backlight_min = PE220X_DP_BACKLIGHT_MIN, -+ .bmc_mode = false, -+}; -+ -+static const struct pci_device_id phytium_display_pci_ids[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc22), (kernel_ulong_t)&px210_info }, -+ { PCI_VDEVICE(PHYTIUM, 0xdc3e), (kernel_ulong_t)&pe220x_info }, -+ { /* End: all zeroes */ } -+}; -+MODULE_DEVICE_TABLE(pci, phytium_display_pci_ids); -+ -+struct pci_driver phytium_pci_driver = { -+ .name = "phytium_display_pci", -+ .id_table = phytium_display_pci_ids, -+ .probe = phytium_pci_probe, -+ .remove = phytium_pci_remove, -+ .shutdown = phytium_pci_shutdown, -+ .driver.pm = &phytium_pci_pm_ops, -+}; -diff --git a/drivers/gpu/drm/phytium/phytium_pci.h b/drivers/gpu/drm/phytium/phytium_pci.h -new file mode 100644 -index 000000000..7ac379717 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_pci.h -@@ -0,0 +1,26 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_PCI_H__ -+#define __PHYTIUM_PCI_H__ -+ -+#include "phytium_display_drv.h" -+ -+struct phytium_pci_private { -+ struct phytium_display_private base; -+ void (*dc_hw_vram_init)(struct phytium_display_private *priv, resource_size_t vram_addr, -+ resource_size_t vram_size); -+}; -+ -+struct phytium_dma_slave { -+ struct device *dma_dev; -+ u32 chan_id; -+}; -+ -+#define to_pci_priv(priv) container_of(priv, struct phytium_pci_private, base) -+ -+extern struct pci_driver phytium_pci_driver; -+#endif /* __PHYTIUM_PCI_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_plane.c b/drivers/gpu/drm/phytium/phytium_plane.c -new file mode 100644 -index 000000000..d5b3d9544 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_plane.c -@@ -0,0 +1,688 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+ -+#include "phytium_display_drv.h" -+#include "phytium_plane.h" -+#include "phytium_fb.h" -+#include "phytium_gem.h" -+#include "phytium_crtc.h" -+#include "px210_dc.h" -+#include "pe220x_dc.h" -+#include "phytium_reg.h" -+ -+#define PHYTIUM_CURS_W_SIZE 32 -+#define PHYTIUM_CURS_H_SIZE 32 -+ -+void phytium_plane_destroy(struct drm_plane *plane) -+{ -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ -+ drm_plane_cleanup(plane); -+ kfree(phytium_plane); -+} -+ -+/** -+ * phytium_plane_atomic_get_property - fetch plane property value -+ * @plane: plane to fetch property for -+ * @state: state containing the property value -+ * @property: property to look up -+ * @val: pointer to write property value into -+ * -+ * The DRM core does not store shadow copies of properties for -+ * atomic-capable drivers. This entrypoint is used to fetch -+ * the current value of a driver-specific plane property. -+ */ -+static int -+phytium_plane_atomic_get_property(struct drm_plane *plane, -+ const struct drm_plane_state *state, -+ struct drm_property *property, -+ uint64_t *val) -+{ -+ DRM_DEBUG_KMS("Unknown plane property [PROP:%d:%s]\n", property->base.id, property->name); -+ return -EINVAL; -+} -+ -+/** -+ * phytium_plane_atomic_set_property - set plane property value -+ * @plane: plane to set property for -+ * @state: state to update property value in -+ * @property: property to set -+ * @val: value to set property to -+ * -+ * Writes the specified property value for a plane into the provided atomic -+ * state object. -+ * -+ * Returns 0 on success, -EINVAL on unrecognized properties -+ */ -+int -+phytium_plane_atomic_set_property(struct drm_plane *plane, -+ struct drm_plane_state *state, -+ struct drm_property *property, -+ uint64_t val) -+{ -+ DRM_DEBUG_KMS("Unknown plane property [PROP:%d:%s]\n", property->base.id, property->name); -+ return -EINVAL; -+} -+ -+struct drm_plane_state * -+phytium_plane_atomic_duplicate_state(struct drm_plane *plane) -+{ -+ struct drm_plane_state *state = NULL; -+ struct phytium_plane_state *phytium_state = NULL; -+ -+ phytium_state = kmemdup(plane->state, sizeof(*phytium_state), GFP_KERNEL); -+ -+ if (!phytium_state) -+ return NULL; -+ -+ state = &phytium_state->base; -+ if (state->fb) -+ drm_framebuffer_get(state->fb); -+ -+ state->fence = NULL; -+ state->commit = NULL; -+ -+ return state; -+} -+ -+void -+phytium_plane_atomic_destroy_state(struct drm_plane *plane, struct drm_plane_state *state) -+{ -+ struct phytium_plane_state *phytium_state = to_phytium_plane_state(state); -+ -+ __drm_atomic_helper_plane_destroy_state(state); -+ kfree(phytium_state); -+} -+ -+static bool phytium_plane_format_mod_supported(struct drm_plane *plane, -+ uint32_t format, uint64_t modifier) -+{ -+ if (modifier == DRM_FORMAT_MOD_LINEAR) -+ return true; -+ -+ if (modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC) { -+ switch (format) { -+ case DRM_FORMAT_ARGB2101010: -+ case DRM_FORMAT_ABGR2101010: -+ case DRM_FORMAT_RGBA1010102: -+ case DRM_FORMAT_BGRA1010102: -+ case DRM_FORMAT_ARGB8888: -+ case DRM_FORMAT_ABGR8888: -+ case DRM_FORMAT_RGBA8888: -+ case DRM_FORMAT_BGRA8888: -+ case DRM_FORMAT_XRGB8888: -+ case DRM_FORMAT_XBGR8888: -+ case DRM_FORMAT_RGBX8888: -+ case DRM_FORMAT_BGRX8888: -+ return true; -+ default: -+ return false; -+ } -+ } -+ -+ return false; -+} -+ -+const struct drm_plane_funcs phytium_plane_funcs = { -+ .update_plane = drm_atomic_helper_update_plane, -+ .disable_plane = drm_atomic_helper_disable_plane, -+ .destroy = phytium_plane_destroy, -+ .reset = drm_atomic_helper_plane_reset, -+ .atomic_get_property = phytium_plane_atomic_get_property, -+ .atomic_set_property = phytium_plane_atomic_set_property, -+ .atomic_duplicate_state = phytium_plane_atomic_duplicate_state, -+ .atomic_destroy_state = phytium_plane_atomic_destroy_state, -+ .format_mod_supported = phytium_plane_format_mod_supported, -+}; -+ -+static int phytium_plane_prepare_fb(struct drm_plane *plane, -+ struct drm_plane_state *state) -+{ -+ struct dma_buf *dma_buf; -+ struct dma_fence *fence; -+ -+ if (!state->fb) -+ return 0; -+ dma_buf = to_phytium_framebuffer(state->fb)->phytium_gem_obj[0]->base.dma_buf; -+ if (dma_buf) { -+ fence = dma_resv_get_excl_rcu(dma_buf->resv); -+ drm_atomic_set_fence_for_plane(state, fence); -+ } -+ -+ return 0; -+} -+ -+static int -+phytium_plane_atomic_check(struct drm_plane *plane, struct drm_plane_state *state) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct drm_framebuffer *fb = state->fb; -+ struct drm_crtc *crtc = state->crtc; -+ struct drm_crtc_state *crtc_state; -+ int src_x, src_y, src_w, src_h; -+ unsigned long base_offset; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ -+ if ((!fb) || (!crtc)) -+ return 0; -+ -+ crtc_state = drm_atomic_get_crtc_state(state->state, crtc); -+ if (IS_ERR(crtc_state)) -+ return PTR_ERR(crtc_state); -+ -+ if (plane->type == DRM_PLANE_TYPE_CURSOR) { -+ src_w = state->src_w >> 16; -+ src_h = state->src_h >> 16; -+ if (phytium_crtc->scale_enable) -+ return -EINVAL; -+ if ((src_w != PHYTIUM_CURS_W_SIZE) || (src_h != PHYTIUM_CURS_W_SIZE)) { -+ DRM_INFO("Invalid cursor size(%d, %d)\n", src_w, src_h); -+ return -EINVAL; -+ } -+ } else if (plane->type == DRM_PLANE_TYPE_PRIMARY) { -+ src_x = state->src_x >> 16; -+ src_y = state->src_y >> 16; -+ src_w = state->src_w >> 16; -+ src_h = state->src_h >> 16; -+ -+ base_offset = src_x * fb->format->cpp[0] + src_y*fb->pitches[0]; -+ if (base_offset & (priv->info.address_mask)) { -+ DRM_ERROR("fb base address is not aligned by 0x%lx byte\n", -+ priv->info.address_mask); -+ return -EINVAL; -+ } -+ -+ if (src_w != state->crtc_w || src_h != state->crtc_h) { -+ DRM_ERROR("scale not support: crtc_w(0x%x)/h(0x%x) src_w(0x%x)/h(0x%x)\n", -+ state->crtc_w, state->crtc_h, src_w, src_h); -+ return -EINVAL; -+ } -+ -+ if ((state->crtc_x < 0) || (state->crtc_y < 0)) { -+ DRM_ERROR("crtc_x(0x%x)/y(0x%x) of drm plane state is invalid\n", -+ state->crtc_x, state->crtc_y); -+ return -EINVAL; -+ } -+ -+ if ((state->crtc_x + state->crtc_w > crtc_state->adjusted_mode.hdisplay) -+ || (state->crtc_y + state->crtc_h > crtc_state->adjusted_mode.vdisplay)) { -+ DRM_ERROR("plane out of crtc region\n"); -+ return -EINVAL; -+ } -+ } -+ -+ return 0; -+} -+ -+static void phytium_dc_get_plane_parameter(struct drm_plane *plane) -+{ -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ struct drm_framebuffer *fb = plane->state->fb; -+ struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ int i, num_planes = 0; -+ const struct drm_format_info *info; -+ -+ info = drm_format_info(fb->format->format); -+ num_planes = info ? info->num_planes : 1; -+ -+ for (i = 0; i < num_planes; i++) { -+ phytium_gem_obj = phytium_fb->phytium_gem_obj[i]; -+ phytium_plane->iova[i] = phytium_gem_obj->iova + fb->offsets[i]; -+ phytium_plane->size[i] = phytium_gem_obj->size - fb->offsets[i]; -+ -+ if (fb->modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC) -+ phytium_plane->tiling[i] = FRAMEBUFFER_TILE_MODE0; -+ else if (fb->modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC) -+ phytium_plane->tiling[i] = FRAMEBUFFER_TILE_MODE3; -+ else if (fb->modifier == DRM_FORMAT_MOD_LINEAR) -+ phytium_plane->tiling[i] = FRAMEBUFFER_LINEAR; -+ else -+ phytium_plane->tiling[i] = FRAMEBUFFER_LINEAR; -+ -+ if (i == 0) { -+ switch (fb->format->format) { -+ case DRM_FORMAT_ARGB2101010: -+ case DRM_FORMAT_ABGR2101010: -+ case DRM_FORMAT_RGBA1010102: -+ case DRM_FORMAT_BGRA1010102: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB2101010; -+ break; -+ -+ case DRM_FORMAT_ARGB8888: -+ case DRM_FORMAT_ABGR8888: -+ case DRM_FORMAT_RGBA8888: -+ case DRM_FORMAT_BGRA8888: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB8888; -+ break; -+ -+ case DRM_FORMAT_XRGB8888: -+ case DRM_FORMAT_XBGR8888: -+ case DRM_FORMAT_RGBX8888: -+ case DRM_FORMAT_BGRX8888: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB8888; -+ break; -+ -+ case DRM_FORMAT_ARGB4444: -+ case DRM_FORMAT_ABGR4444: -+ case DRM_FORMAT_RGBA4444: -+ case DRM_FORMAT_BGRA4444: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB4444; -+ break; -+ -+ case DRM_FORMAT_XRGB4444: -+ case DRM_FORMAT_XBGR4444: -+ case DRM_FORMAT_RGBX4444: -+ case DRM_FORMAT_BGRX4444: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB4444; -+ break; -+ -+ case DRM_FORMAT_ARGB1555: -+ case DRM_FORMAT_ABGR1555: -+ case DRM_FORMAT_RGBA5551: -+ case DRM_FORMAT_BGRA5551: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB1555; -+ break; -+ -+ case DRM_FORMAT_XRGB1555: -+ case DRM_FORMAT_XBGR1555: -+ case DRM_FORMAT_RGBX5551: -+ case DRM_FORMAT_BGRX5551: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB1555; -+ break; -+ -+ case DRM_FORMAT_RGB565: -+ case DRM_FORMAT_BGR565: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_RGB565; -+ break; -+ -+ case DRM_FORMAT_YUYV: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_YUYV; -+ break; -+ -+ case DRM_FORMAT_UYVY: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_UYVY; -+ break; -+ case DRM_FORMAT_NV16: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_NV16; -+ break; -+ case DRM_FORMAT_NV12: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_NV12; -+ break; -+ case DRM_FORMAT_NV21: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_NV12; -+ break; -+ default: -+ DRM_ERROR("unsupported pixel format (format = %d)\n", -+ fb->format->format); -+ return; -+ } -+ -+ switch (fb->format->format) { -+ case DRM_FORMAT_ARGB2101010: -+ case DRM_FORMAT_ARGB8888: -+ case DRM_FORMAT_XRGB8888: -+ case DRM_FORMAT_ARGB4444: -+ case DRM_FORMAT_XRGB4444: -+ case DRM_FORMAT_ARGB1555: -+ case DRM_FORMAT_XRGB1555: -+ case DRM_FORMAT_RGB565: -+ phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ARGB; -+ phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; -+ break; -+ -+ case DRM_FORMAT_ABGR2101010: -+ case DRM_FORMAT_ABGR8888: -+ case DRM_FORMAT_XBGR8888: -+ case DRM_FORMAT_ABGR4444: -+ case DRM_FORMAT_XBGR4444: -+ case DRM_FORMAT_ABGR1555: -+ case DRM_FORMAT_XBGR1555: -+ case DRM_FORMAT_BGR565: -+ phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ABGR; -+ phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; -+ break; -+ -+ case DRM_FORMAT_RGBA1010102: -+ case DRM_FORMAT_RGBA8888: -+ case DRM_FORMAT_RGBX8888: -+ case DRM_FORMAT_RGBA4444: -+ case DRM_FORMAT_RGBX4444: -+ case DRM_FORMAT_RGBA5551: -+ case DRM_FORMAT_RGBX5551: -+ phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_RGBA; -+ phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; -+ break; -+ -+ case DRM_FORMAT_BGRA1010102: -+ case DRM_FORMAT_BGRA8888: -+ case DRM_FORMAT_BGRX8888: -+ case DRM_FORMAT_BGRA4444: -+ case DRM_FORMAT_BGRX4444: -+ case DRM_FORMAT_BGRA5551: -+ case DRM_FORMAT_BGRX5551: -+ phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_BGRA; -+ phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; -+ break; -+ -+ case DRM_FORMAT_YUYV: -+ case DRM_FORMAT_UYVY: -+ case DRM_FORMAT_NV16: -+ case DRM_FORMAT_NV12: -+ phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ARGB; -+ phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; -+ break; -+ -+ default: -+ DRM_ERROR("unsupported pixel format (format = %d)\n", -+ fb->format->format); -+ return; -+ } -+ } -+ } -+} -+ -+static void phytium_dc_primary_plane_update(struct drm_plane *plane) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ struct drm_framebuffer *fb = plane->state->fb; -+ int phys_pipe = phytium_plane->phys_pipe; -+ int src_x, src_y, crtc_x, crtc_y, crtc_w, crtc_h; -+ unsigned long base_offset; -+ int config; -+ -+ src_x = plane->state->src_x >> 16; -+ src_y = plane->state->src_y >> 16; -+ crtc_x = plane->state->crtc_x; -+ crtc_y = plane->state->crtc_y; -+ crtc_w = plane->state->crtc_w; -+ crtc_h = plane->state->crtc_h; -+ -+ if (phytium_plane->dc_hw_update_dcreq) -+ phytium_plane->dc_hw_update_dcreq(plane); -+ phytium_plane->dc_hw_update_primary_hi_addr(plane); -+ -+ /* config dc */ -+ /* Y */ -+ base_offset = src_x * fb->format->cpp[0] + src_y*fb->pitches[0]; -+ phytium_writel_reg(priv, (phytium_plane->iova[0] + base_offset) & ADDRESS_MASK, -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_Y_ADDRESS); -+ phytium_writel_reg(priv, ALIGN(fb->pitches[0], 128), -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_Y_STRIDE); -+ -+ /* U */ -+ phytium_writel_reg(priv, phytium_plane->iova[1] & 0xffffffff, -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_U_ADDRESS); -+ phytium_writel_reg(priv, ALIGN(fb->pitches[1], 128), -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_U_STRIDE); -+ -+ /* V */ -+ phytium_writel_reg(priv, phytium_plane->iova[2] & 0xffffffff, -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_V_ADDRESS); -+ phytium_writel_reg(priv, ALIGN(fb->pitches[2], 128), -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_V_STRIDE); -+ -+ /* size */ -+ phytium_writel_reg(priv, (crtc_w & WIDTH_MASK) | ((crtc_h&HEIGHT_MASK) << HEIGHT_SHIFT), -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_SIZE); -+ /* config */ -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ config &= ~(FRAMEBUFFER_FORMAT_MASK << FRAMEBUFFER_FORMAT_SHIFT); -+ config |= (phytium_plane->format << FRAMEBUFFER_FORMAT_SHIFT); -+ config &= ~(1 << FRAMEBUFFER_UVSWIZZLE_SHIFT); -+ config |= (phytium_plane->uv_swizzle << FRAMEBUFFER_UVSWIZZLE_SHIFT); -+ config &= ~(FRAMEBUFFER_SWIZZLE_MASK << FRAMEBUFFER_SWIZZLE_SHIFT); -+ config |= (phytium_plane->swizzle << FRAMEBUFFER_SWIZZLE_SHIFT); -+ config &= ~(FRAMEBUFFER_TILE_MODE_MASK << FRAMEBUFFER_TILE_MODE_SHIFT); -+ config |= (phytium_plane->tiling[0] << FRAMEBUFFER_TILE_MODE_SHIFT); -+ config &= (~FRAMEBUFFER_CLEAR); -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+} -+ -+static void phytium_dc_cursor_plane_update(struct drm_plane *plane) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ struct drm_framebuffer *fb = plane->state->fb; -+ int phys_pipe = phytium_plane->phys_pipe; -+ int config; -+ unsigned long iova; -+ -+ phytium_plane->enable = 1; -+ phytium_plane->cursor_hot_x = fb->hot_x; -+ phytium_plane->cursor_hot_y = fb->hot_y; -+ phytium_plane->cursor_x = plane->state->crtc_x + fb->hot_x; -+ phytium_plane->cursor_y = plane->state->crtc_y + fb->hot_y; -+ -+ if (phytium_plane->cursor_x < 0) { -+ phytium_plane->cursor_hot_x = plane->state->crtc_w - 1; -+ phytium_plane->cursor_x = plane->state->crtc_x + phytium_plane->cursor_hot_x; -+ } -+ -+ if (phytium_plane->cursor_y < 0) { -+ phytium_plane->cursor_hot_y = plane->state->crtc_h - 1; -+ phytium_plane->cursor_y = plane->state->crtc_y + phytium_plane->cursor_hot_y; -+ } -+ -+ config = CURSOR_FORMAT_ARGB8888 | -+ ((phytium_plane->cursor_hot_y & CURSOR_HOT_Y_MASK) << CURSOR_HOT_Y_SHIFT) | -+ ((phytium_plane->cursor_hot_x & CURSOR_HOT_X_MASK) << CURSOR_HOT_X_SHIFT); -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); -+ -+ config = ((phytium_plane->cursor_x & CURSOR_X_MASK) << CURSOR_X_SHIFT) | -+ ((phytium_plane->cursor_y & CURSOR_Y_MASK) << CURSOR_Y_SHIFT); -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_CURSOR_LOCATION); -+ iova = phytium_plane->iova[0]; -+ phytium_writel_reg(priv, iova & 0xffffffff, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_CURSOR_ADDRESS); -+ if (phytium_plane->dc_hw_update_cursor_hi_addr) -+ phytium_plane->dc_hw_update_cursor_hi_addr(plane, iova); -+} -+ -+static void phytium_plane_atomic_update(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ struct drm_framebuffer *fb, *old_fb; -+ -+ DRM_DEBUG_KMS("update plane: type=%d\n", plane->type); -+ if (!plane->state->crtc || !plane->state->fb) -+ return; -+ -+ fb = plane->state->fb; -+ old_fb = old_state->fb; -+ -+ if (fb) -+ drm_framebuffer_get(fb); -+ if (old_fb) -+ drm_framebuffer_put(old_fb); -+ -+ phytium_dc_get_plane_parameter(plane); -+ -+ if (plane->type == DRM_PLANE_TYPE_PRIMARY) -+ phytium_dc_primary_plane_update(plane); -+ else if (plane->type == DRM_PLANE_TYPE_CURSOR) -+ phytium_dc_cursor_plane_update(plane); -+} -+ -+static void phytium_plane_atomic_disable(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ int phys_pipe = phytium_plane->phys_pipe; -+ int config; -+ struct drm_framebuffer *old_fb; -+ -+ old_fb = old_state->fb; -+ if (old_fb) -+ drm_framebuffer_put(old_fb); -+ -+ if (plane->type == DRM_PLANE_TYPE_PRIMARY) { -+ phytium_writel_reg(priv, CLEAR_VALUE_RED, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE); -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ config |= FRAMEBUFFER_CLEAR; -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ } else if (plane->type == DRM_PLANE_TYPE_CURSOR) { -+ phytium_writel_reg(priv, CURSOR_FORMAT_DISABLED, -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); -+ } -+} -+ -+const struct drm_plane_helper_funcs phytium_plane_helper_funcs = { -+ .prepare_fb = phytium_plane_prepare_fb, -+ .atomic_check = phytium_plane_atomic_check, -+ .atomic_update = phytium_plane_atomic_update, -+ .atomic_disable = phytium_plane_atomic_disable, -+}; -+ -+struct phytium_plane *phytium_primary_plane_create(struct drm_device *dev, int phys_pipe) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = NULL; -+ struct phytium_plane_state *phytium_plane_state = NULL; -+ int ret = 0; -+ unsigned int flags = 0; -+ const uint32_t *formats = NULL; -+ uint32_t format_count; -+ const uint64_t *format_modifiers; -+ -+ phytium_plane = kzalloc(sizeof(*phytium_plane), GFP_KERNEL); -+ if (!phytium_plane) { -+ ret = -ENOMEM; -+ goto failed_malloc_plane; -+ } -+ -+ phytium_plane_state = kzalloc(sizeof(*phytium_plane_state), GFP_KERNEL); -+ if (!phytium_plane_state) { -+ ret = -ENOMEM; -+ goto failed_malloc_plane_state; -+ } -+ phytium_plane_state->base.plane = &phytium_plane->base; -+ phytium_plane_state->base.rotation = DRM_MODE_ROTATE_0; -+ phytium_plane->base.state = &phytium_plane_state->base; -+ phytium_plane->phys_pipe = phys_pipe; -+ -+ if (IS_PX210(priv)) { -+ phytium_plane->dc_hw_plane_get_format = px210_dc_hw_plane_get_primary_format; -+ phytium_plane->dc_hw_update_dcreq = px210_dc_hw_update_dcreq; -+ phytium_plane->dc_hw_update_primary_hi_addr = px210_dc_hw_update_primary_hi_addr; -+ phytium_plane->dc_hw_update_cursor_hi_addr = NULL; -+ } else if (IS_PE220X(priv)) { -+ if (priv->info.bmc_mode) -+ phytium_plane->dc_hw_plane_get_format = -+ pe220x_dc_bmc_hw_plane_get_primary_format; -+ else -+ phytium_plane->dc_hw_plane_get_format = -+ pe220x_dc_hw_plane_get_primary_format; -+ phytium_plane->dc_hw_update_dcreq = NULL; -+ phytium_plane->dc_hw_update_primary_hi_addr = pe220x_dc_hw_update_primary_hi_addr; -+ phytium_plane->dc_hw_update_cursor_hi_addr = NULL; -+ } -+ -+ phytium_plane->dc_hw_plane_get_format(&format_modifiers, &formats, &format_count); -+ ret = drm_universal_plane_init(dev, &phytium_plane->base, 0x0, -+ &phytium_plane_funcs, formats, -+ format_count, -+ format_modifiers, -+ DRM_PLANE_TYPE_PRIMARY, "primary %d", phys_pipe); -+ -+ if (ret) -+ goto failed_plane_init; -+ -+ flags = DRM_MODE_ROTATE_0; -+ drm_plane_create_rotation_property(&phytium_plane->base, DRM_MODE_ROTATE_0, flags); -+ drm_plane_helper_add(&phytium_plane->base, &phytium_plane_helper_funcs); -+ -+ return phytium_plane; -+failed_plane_init: -+ kfree(phytium_plane_state); -+failed_malloc_plane_state: -+ kfree(phytium_plane); -+failed_malloc_plane: -+ return ERR_PTR(ret); -+} -+ -+struct phytium_plane *phytium_cursor_plane_create(struct drm_device *dev, int phys_pipe) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = NULL; -+ struct phytium_plane_state *phytium_plane_state = NULL; -+ int ret = 0; -+ unsigned int flags = 0; -+ const uint32_t *formats = NULL; -+ uint32_t format_count; -+ const uint64_t *format_modifiers; -+ -+ phytium_plane = kzalloc(sizeof(*phytium_plane), GFP_KERNEL); -+ if (!phytium_plane) { -+ ret = -ENOMEM; -+ goto failed_malloc_plane; -+ } -+ -+ phytium_plane_state = kzalloc(sizeof(*phytium_plane_state), GFP_KERNEL); -+ if (!phytium_plane_state) { -+ ret = -ENOMEM; -+ goto failed_malloc_plane_state; -+ } -+ phytium_plane_state->base.plane = &phytium_plane->base; -+ phytium_plane_state->base.rotation = DRM_MODE_ROTATE_0; -+ phytium_plane->base.state = &phytium_plane_state->base; -+ phytium_plane->phys_pipe = phys_pipe; -+ -+ if (IS_PX210(priv)) { -+ phytium_plane->dc_hw_plane_get_format = px210_dc_hw_plane_get_cursor_format; -+ phytium_plane->dc_hw_update_dcreq = NULL; -+ phytium_plane->dc_hw_update_primary_hi_addr = NULL; -+ phytium_plane->dc_hw_update_cursor_hi_addr = NULL; -+ } else if (IS_PE220X(priv)) { -+ phytium_plane->dc_hw_plane_get_format = pe220x_dc_hw_plane_get_cursor_format; -+ phytium_plane->dc_hw_update_dcreq = NULL; -+ phytium_plane->dc_hw_update_primary_hi_addr = NULL; -+ phytium_plane->dc_hw_update_cursor_hi_addr = pe220x_dc_hw_update_cursor_hi_addr; -+ } -+ -+ phytium_plane->dc_hw_plane_get_format(&format_modifiers, &formats, &format_count); -+ ret = drm_universal_plane_init(dev, &phytium_plane->base, 0x0, -+ &phytium_plane_funcs, -+ formats, format_count, -+ format_modifiers, -+ DRM_PLANE_TYPE_CURSOR, "cursor %d", phys_pipe); -+ -+ if (ret) -+ goto failed_plane_init; -+ -+ flags = DRM_MODE_ROTATE_0; -+ drm_plane_create_rotation_property(&phytium_plane->base, DRM_MODE_ROTATE_0, flags); -+ drm_plane_helper_add(&phytium_plane->base, &phytium_plane_helper_funcs); -+ -+ return phytium_plane; -+failed_plane_init: -+ kfree(phytium_plane_state); -+failed_malloc_plane_state: -+ kfree(phytium_plane); -+failed_malloc_plane: -+ return ERR_PTR(ret); -+} -diff --git a/drivers/gpu/drm/phytium/phytium_plane.h b/drivers/gpu/drm/phytium/phytium_plane.h -new file mode 100644 -index 000000000..25b6bba6c ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_plane.h -@@ -0,0 +1,46 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_PLANE_H__ -+#define __PHYTIUM_PLANE_H__ -+ -+struct phytium_plane { -+ struct drm_plane base; -+ int phys_pipe; -+ unsigned long iova[PHYTIUM_FORMAT_MAX_PLANE]; -+ unsigned long size[PHYTIUM_FORMAT_MAX_PLANE]; -+ unsigned int format; -+ unsigned int tiling[PHYTIUM_FORMAT_MAX_PLANE]; -+ unsigned int swizzle; -+ unsigned int uv_swizzle; -+ unsigned int rot_angle; -+ -+ /* only for cursor */ -+ bool enable; -+ bool reserve[3]; -+ int cursor_x; -+ int cursor_y; -+ int cursor_hot_x; -+ int cursor_hot_y; -+ -+ void (*dc_hw_plane_get_format)(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+ void (*dc_hw_update_dcreq)(struct drm_plane *plane); -+ void (*dc_hw_update_primary_hi_addr)(struct drm_plane *plane); -+ void (*dc_hw_update_cursor_hi_addr)(struct drm_plane *plane, uint64_t iova); -+}; -+ -+struct phytium_plane_state { -+ struct drm_plane_state base; -+}; -+ -+#define to_phytium_plane(x) container_of(x, struct phytium_plane, base) -+#define to_phytium_plane_state(x) container_of(x, struct phytium_plane_state, base) -+ -+struct phytium_plane *phytium_primary_plane_create(struct drm_device *dev, int pipe); -+struct phytium_plane *phytium_cursor_plane_create(struct drm_device *dev, int pipe); -+#endif /* __PHYTIUM_PLANE_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_platform.c b/drivers/gpu/drm/phytium/phytium_platform.c -new file mode 100644 -index 000000000..42aa82063 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_platform.c -@@ -0,0 +1,388 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium display engine DRM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_platform.h" -+#include "phytium_dp.h" -+#include "phytium_gem.h" -+#include "pe220x_dc.h" -+#include "pe220x_dp.h" -+ -+int phytium_platform_carveout_mem_init(struct platform_device *pdev, -+ struct phytium_display_private *priv) -+{ -+ struct device_node *np; -+ struct resource res; -+ struct resource *pres; -+ int ret = 0; -+ -+ if (pdev->dev.of_node) { -+ np = of_parse_phandle(pdev->dev.of_node, "memory-region", 0); -+ if(!np) -+ goto next; -+ ret = of_address_to_resource(np, 0, &res); -+ if(ret) -+ DRM_ERROR("No memory address assigned to the region\n"); -+ else { -+ priv->pool_size = resource_size(&res); -+ priv->pool_phys_addr = res.start; -+ } -+ } -+ -+next: -+ pres = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ if (pres) { -+ priv->pool_size = resource_size(pres); -+ priv->pool_phys_addr = pres->start; -+ } -+ -+ if ((priv->pool_phys_addr != 0) && (priv->pool_size != 0)) { -+ priv->pool_virt_addr = ioremap_cache(priv->pool_phys_addr, priv->pool_size); -+ if (priv->pool_virt_addr == NULL) { -+ DRM_ERROR("failed to remap carveout mem(0x%llx)\n", priv->pool_phys_addr); -+ ret = -EINVAL; -+ goto failed_ioremap; -+ } -+ ret = phytium_memory_pool_init(&pdev->dev, priv); -+ if (ret) -+ goto failed_init_memory_pool; -+ -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL] = priv->pool_size; -+ priv->support_memory_type = MEMORY_TYPE_SYSTEM_CARVEOUT; -+ priv->vram_hw_init = NULL; -+ } else { -+ DRM_DEBUG_KMS("not support carveout memory\n"); -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL] = 0; -+ priv->support_memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; -+ priv->vram_hw_init = NULL; -+ } -+ -+ return 0; -+ -+failed_init_memory_pool: -+ iounmap(priv->pool_virt_addr); -+failed_ioremap: -+ return ret; -+} -+ -+void phytium_platform_carveout_mem_fini(struct platform_device *pdev, -+ struct phytium_display_private *priv) -+{ -+ if (priv->support_memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { -+ phytium_memory_pool_fini(&pdev->dev, priv); -+ iounmap(priv->pool_virt_addr); -+ } -+} -+ -+static struct phytium_display_private * -+phytium_platform_private_init(struct platform_device *pdev) -+{ -+ struct drm_device *dev = dev_get_drvdata(&pdev->dev); -+ struct device_node *node; -+ struct fwnode_handle *np; -+ struct phytium_display_private *priv = NULL; -+ struct phytium_platform_private *platform_priv = NULL; -+ struct phytium_device_info *phytium_info = NULL; -+ int i = 0, ret = 0; -+ struct resource *res; -+ -+ platform_priv = devm_kzalloc(&pdev->dev, sizeof(*platform_priv), GFP_KERNEL); -+ if (!platform_priv) { -+ DRM_ERROR("no memory to allocate for phytium_platform_private\n"); -+ goto exit; -+ } -+ -+ memset(platform_priv, 0, sizeof(*platform_priv)); -+ priv = &platform_priv->base; -+ phytium_display_private_init(priv, dev); -+ -+ if (pdev->dev.of_node) { -+ phytium_info = (struct phytium_device_info *)of_device_get_match_data(&pdev->dev); -+ if (!phytium_info) { -+ DRM_ERROR("failed to get dts id data(phytium_info)\n"); -+ goto failed; -+ } -+ -+ memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); -+ node = pdev->dev.of_node; -+ ret = of_property_read_u8(node, "pipe_mask", &priv->info.pipe_mask); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing pipe_mask property from dts\n"); -+ goto failed; -+ } -+ -+ ret = of_property_read_u8(node, "edp_mask", &priv->info.edp_mask); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing edp_mask property from dts\n"); -+ goto failed; -+ } -+ if (priv->info.edp_mask) { -+ priv->info.pwm = devm_pwm_get(&pdev->dev, NULL); -+ if (IS_ERR(priv->info.pwm)) { -+ dev_err(&pdev->dev, "Failed to request PWM device: %ld\n", -+ PTR_ERR(priv->info.pwm)); -+ goto failed; -+ } -+ priv->edp_bl_en = gpiod_get(&pdev->dev, "edp-bl-en", GPIOD_OUT_HIGH); -+ if (!priv->edp_bl_en) { -+ dev_err(&pdev->dev, "Failed to get edp_en gpio\n"); -+ goto failed; -+ } -+ priv->edp_power_en = gpiod_get(&pdev->dev, "edp-power-en", GPIOD_OUT_HIGH); -+ if (!priv->edp_power_en) { -+ dev_err(&pdev->dev, "Failed to get edp_pwr_en gpio\n"); -+ goto failed; -+ } -+ // set GPIO pin output -+ gpiod_direction_output(priv->edp_power_en, 0); -+ gpiod_direction_output(priv->edp_bl_en, 0); -+ } -+ } else if (has_acpi_companion(&pdev->dev)) { -+ phytium_info = (struct phytium_device_info *)acpi_device_get_match_data(&pdev->dev); -+ if (!phytium_info) { -+ DRM_ERROR("failed to get acpi id data(phytium_info)\n"); -+ goto failed; -+ } -+ -+ memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); -+ np = dev_fwnode(&(pdev->dev)); -+ ret = fwnode_property_read_u8(np, "pipe_mask", &priv->info.pipe_mask); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing pipe_mask property from acpi\n"); -+ goto failed; -+ } -+ ret = fwnode_property_read_u8(np, "edp_mask", &priv->info.edp_mask); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing edp_mask property from acpi\n"); -+ goto failed; -+ } -+ if (priv->info.edp_mask) { -+ priv->info.pwm = devm_pwm_get(&pdev->dev, NULL); -+ if (IS_ERR(priv->info.pwm)) { -+ dev_err(&pdev->dev, "Failed to request PWM device: %ld\n", -+ PTR_ERR(priv->info.pwm)); -+ goto failed; -+ } -+ priv->edp_bl_en = gpiod_get(&pdev->dev, "edp-bl-en", GPIOD_OUT_HIGH); -+ if (!priv->edp_bl_en) { -+ dev_err(&pdev->dev, "Failed to get edp_en gpio\n"); -+ goto failed; -+ } -+ priv->edp_power_en = gpiod_get(&pdev->dev, "edp-power-en", GPIOD_OUT_HIGH); -+ if (!priv->edp_power_en) { -+ dev_err(&pdev->dev, "Failed to get edp_pwr_en gpio\n"); -+ goto failed; -+ } -+ // set GPIO pin output -+ gpiod_direction_output(priv->edp_power_en, 0); -+ gpiod_direction_output(priv->edp_bl_en, 0); -+ } -+ } -+ -+ priv->info.num_pipes = 0; -+ for_each_pipe_masked(priv, i) -+ priv->info.num_pipes++; -+ if (priv->info.num_pipes == 0) { -+ DRM_ERROR("num_pipes is zero, so exit init\n"); -+ goto failed; -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ priv->regs = devm_ioremap_resource(&pdev->dev, res); -+ if (priv->regs == NULL) { -+ DRM_ERROR("ioremap fail, addr:0x%llx, size:0x%llx\n", res->start, res->end); -+ goto failed; -+ } -+ -+ priv->irq = platform_get_irq(pdev, 0); -+ if (priv->irq < 0) { -+ dev_err(&pdev->dev, "failed to get irq\n"); -+ goto failed; -+ } -+ -+ if (IS_PE220X(priv)) { -+ priv->dc_hw_clear_msi_irq = NULL; -+ priv->dc_hw_fb_format_check = pe220x_dc_hw_fb_format_check; -+ } -+ -+ return priv; -+ -+failed: -+ devm_kfree(&pdev->dev, platform_priv); -+exit: -+ return NULL; -+} -+ -+static void phytium_platform_private_fini(struct platform_device *pdev) -+{ -+ struct drm_device *dev = dev_get_drvdata(&pdev->dev); -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_platform_private *platform_priv = to_platform_priv(priv); -+ -+ devm_kfree(&pdev->dev, platform_priv); -+} -+ -+static int phytium_platform_probe(struct platform_device *pdev) -+{ -+ struct phytium_display_private *priv = NULL; -+ struct drm_device *dev = NULL; -+ struct phytium_device_info *phytium_info = NULL; -+ int ret = 0; -+ -+ if (pdev->dev.of_node) { -+ phytium_info = (struct phytium_device_info *)of_device_get_match_data(&pdev->dev); -+ if (phytium_info) { -+ if (phytium_info->platform_mask & BIT(PHYTIUM_PLATFORM_PE220X)) -+ phytium_display_drm_driver.name = "pe220x"; -+ } -+ } else if (has_acpi_companion(&pdev->dev)) { -+ phytium_info = (struct phytium_device_info *)acpi_device_get_match_data(&pdev->dev); -+ if (phytium_info) { -+ if (phytium_info->platform_mask & BIT(PHYTIUM_PLATFORM_PE220X)) -+ phytium_display_drm_driver.name = "pe220x"; -+ } -+ } -+ -+ dev = drm_dev_alloc(&phytium_display_drm_driver, &pdev->dev); -+ if (IS_ERR(dev)) { -+ DRM_ERROR("failed to allocate drm_device\n"); -+ return PTR_ERR(dev); -+ } -+ -+ dev_set_drvdata(&pdev->dev, dev); -+ dma_set_mask(&pdev->dev, DMA_BIT_MASK(40)); -+ -+ priv = phytium_platform_private_init(pdev); -+ if (priv) -+ dev->dev_private = priv; -+ else -+ goto failed_platform_private_init; -+ -+ ret = phytium_platform_carveout_mem_init(pdev, priv); -+ if (ret) { -+ DRM_ERROR("failed to init system carveout memory\n"); -+ goto failed_carveout_mem_init; -+ } -+ -+ ret = drm_dev_register(dev, 0); -+ if (ret) { -+ DRM_ERROR("failed to register drm dev\n"); -+ goto failed_register_drm; -+ } -+ -+ phytium_dp_hpd_irq_setup(dev, true); -+ -+ return 0; -+ -+failed_register_drm: -+ phytium_platform_carveout_mem_fini(pdev, priv); -+failed_carveout_mem_init: -+ phytium_platform_private_fini(pdev); -+failed_platform_private_init: -+ dev_set_drvdata(&pdev->dev, NULL); -+ drm_dev_put(dev); -+ return -1; -+} -+ -+static int phytium_platform_remove(struct platform_device *pdev) -+{ -+ struct drm_device *dev = dev_get_drvdata(&pdev->dev); -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ phytium_dp_hpd_irq_setup(dev, false); -+ cancel_work_sync(&priv->hotplug_work); -+ drm_dev_unregister(dev); -+ phytium_platform_private_fini(pdev); -+ dev_set_drvdata(&pdev->dev, NULL); -+ drm_dev_put(dev); -+ -+ return 0; -+} -+ -+static void phytium_platform_shutdown(struct platform_device *pdev) -+{ -+ struct drm_device *dev = dev_get_drvdata(&pdev->dev); -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ priv->display_shutdown(dev); -+} -+ -+static int phytium_platform_pm_suspend(struct device *dev) -+{ -+ struct drm_device *drm_dev = dev_get_drvdata(dev); -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ -+ return priv->display_pm_suspend(drm_dev); -+} -+ -+static int phytium_platform_pm_resume(struct device *dev) -+{ -+ struct drm_device *drm_dev = dev_get_drvdata(dev); -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ -+ return priv->display_pm_resume(drm_dev); -+} -+ -+static const struct dev_pm_ops phytium_platform_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_platform_pm_suspend, phytium_platform_pm_resume) -+}; -+ -+static const struct phytium_device_info pe220x_info = { -+ .platform_mask = BIT(PHYTIUM_PLATFORM_PE220X), -+ .total_pipes = 2, -+ .crtc_clock_max = PE220X_DC_PIX_CLOCK_MAX, -+ .hdisplay_max = PE220X_DC_HDISPLAY_MAX, -+ .vdisplay_max = PE220X_DC_VDISPLAY_MAX, -+ .address_mask = PE220X_DC_ADDRESS_MASK, -+ .backlight_max = PE220X_DP_BACKLIGHT_MAX, -+ .backlight_min = PE220X_DP_BACKLIGHT_MIN, -+ .bmc_mode = false, -+}; -+ -+static const struct of_device_id display_of_match[] = { -+ { -+ .compatible = "phytium,dc", -+ .data = (void*)&pe220x_info, -+ }, -+ { } -+}; -+ -+MODULE_DEVICE_TABLE(of, display_of_match); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id display_acpi_ids[] = { -+ { -+ .id = "PHYT0015", -+ .driver_data = (kernel_ulong_t)&pe220x_info, -+ }, -+ {}, -+}; -+ -+MODULE_DEVICE_TABLE(acpi, display_acpi_ids); -+#else -+#define display_acpi_ids NULL -+#endif -+ -+struct platform_driver phytium_platform_driver = { -+ .driver = { -+ .name = "phytium_display_platform", -+ .of_match_table = of_match_ptr(display_of_match), -+ .acpi_match_table = ACPI_PTR(display_acpi_ids), -+ }, -+ .probe = phytium_platform_probe, -+ .remove = phytium_platform_remove, -+ .shutdown = phytium_platform_shutdown, -+ .driver.pm = &phytium_platform_pm_ops, -+}; -diff --git a/drivers/gpu/drm/phytium/phytium_platform.h b/drivers/gpu/drm/phytium/phytium_platform.h -new file mode 100644 -index 000000000..b754ef0a1 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_platform.h -@@ -0,0 +1,18 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_PLATFORM_H__ -+#define __PHYTIUM_PLATFORM_H__ -+ -+struct phytium_platform_private { -+ struct phytium_display_private base; -+}; -+ -+#define to_platform_priv(priv) container_of(priv, struct phytium_platform_private, base) -+ -+extern struct platform_driver phytium_platform_driver; -+ -+#endif /* __PHYTIUM_PLATFORM_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_reg.h b/drivers/gpu/drm/phytium/phytium_reg.h -new file mode 100644 -index 000000000..f5d4a6945 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_reg.h -@@ -0,0 +1,366 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_REG_H__ -+#define __PHYTIUM_REG_H__ -+ -+/******************************register base******************************************/ -+#define PX210_PIPE_BASE(pipe) (0x8000*pipe) -+#define PX210_DC_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x0000) -+#define PX210_DCREQ_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x2000) -+#define PX210_DP_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x3000) -+#define PX210_ADDRESS_TRANSFORM_BASE 0x4000 -+#define PX210_PHY_ACCESS_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x5000) -+ -+#define PE220X_DC_BASE(pipe) (0x1000*pipe) -+#define PE220X_DP_BASE(pipe) (0x4000 + 0x1000*pipe) -+#define PE220X_ADDRESS_TRANSFORM_BASE 0x8000 -+#define PE220X_PHY_ACCESS_BASE(pipe) (0x6000 + 0x1000*pipe) -+/******************************register base end******************************************/ -+ -+/******************************dc register start******************************************/ -+#define PHYTIUM_DC_FRAMEBUFFER_Y_ADDRESS 0x1400 -+ #define ADDRESS_MASK 0xffffff80 -+#define PHYTIUM_DC_FRAMEBUFFER_Y_STRIDE 0x1408 -+#define PHYTIUM_DC_PANEL_CONFIG 0x1418 -+ #define PANEL_DATAENABLE_ENABLE (1<<0) -+ #define PANEL_DATA_ENABLE (1<<4) -+ #define PANEL_CLOCK_ENABLE (1<<8) -+#define PHYTIUM_DC_HDISPLAY 0x1430 -+ #define HDISPLAY_END_SHIFT 0 -+ #define HDISPLAY_END_MASK 0x7fff -+ #define HDISPLAY_TOTAL_SHIFT 16 -+ #define HDISPLAY_TOTAL_MASK 0x7fff -+#define PHYTIUM_DC_HSYNC 0x1438 -+ #define HSYNC_START_SHIFT 0 -+ #define HSYNC_START_MASK 0x7fff -+ #define HSYNC_END_SHIFT 15 -+ #define HSYNC_END_MASK 0x7fff -+ #define HSYNC_PULSE_ENABLED (1<<30) -+ #define HSYNC_NEGATIVE (1<<31) -+#define PHYTIUM_DC_VDISPLAY 0x1440 -+ #define VDISPLAY_END_SHIFT 0 -+ #define VDISPLAY_END_MASK 0x7fff -+ #define VDISPLAY_TOTAL_SHIFT 16 -+ #define VDISPLAY_TOTAL_MASK 0x7fff -+#define PHYTIUM_DC_VSYNC 0x1448 -+ #define VSYNC_START_SHIFT 0 -+ #define VSYNC_START_MASK 0x7fff -+ #define VSYNC_END_SHIFT 15 -+ #define VSYNC_END_MASK 0x7fff -+ #define VSYNC_PULSE_ENABLED (1<<30) -+ #define VSYNC_NEGATIVE (1<<31) -+#define PHYTIUM_DC_LOCATION 0x1450 -+ #define LOVATION_Y_SHIFT 16 -+#define PHYTIUM_DC_GAMMA_INDEX 0x1458 -+ #define GAMMA_INDEX_MAX 256 -+#define PHYTIUM_DC_GAMMA_DATA 0x1460 -+ #define GAMMA_BLUE_SHIFT 0 -+ #define GAMMA_BLUE_MASK 0x3ff -+ #define GAMMA_GREEN_SHIFT 10 -+ #define GAMMA_GREEN_MASK 0x3ff -+ #define GAMMA_RED_SHIFT 20 -+ #define GAMMA_RED_MASK 0x3ff -+#define PHYTIUM_DC_CURSOR_CONFIG 0x1468 -+ #define CURSOR_FORMAT_DISABLED 0x0 -+ #define CURSOR_FORMAT_MASKMODE 0x3 -+ #define CURSOR_FORMAT_ARGB8888 0x2 -+ #define CURSOR_FORMAT_MASK 0x3 -+ #define CURSOR_HOT_Y_SHIFT 8 -+ #define CURSOR_HOT_Y_MASK 0x1f -+ #define CURSOR_HOT_X_SHIFT 16 -+ #define CURSOR_HOT_X_MASK 0x1f -+#define PHYTIUM_DC_CURSOR_ADDRESS 0x146c -+#define PHYTIUM_DC_CURSOR_LOCATION 0x1470 -+ #define CURSOR_X_SHIFT 0 -+ #define CURSOR_X_MASK 0x7fff -+ #define CURSOR_Y_SHIFT 16 -+ #define CURSOR_Y_MASK 0x7fff -+#define PHYTIUM_DC_CURSOR_BACKGROUND 0x1474 -+#define PHYTIUM_DC_CURSOR_FOREGROUND 0x1478 -+#define PHYTIUM_DC_INT_STATUS 0x147c -+ #define INT_STATUS 0x1 -+#define PHYTIUM_DC_INT_ENABLE 0x1480 -+ #define INT_ENABLE 0x1 -+ #define INT_DISABLE 0x0 -+ -+#define PHYTIUM_DC_FRAMEBUFFER_CONFIG 0x1518 -+ #define FRAMEBUFFER_OUTPUT BIT(0) -+ #define FRAMEBUFFER_GAMMA_ENABLE BIT(2) -+ #define FRAMEBUFFER_VALID_PENDING BIT(3) -+ #define FRAMEBUFFER_RESET BIT(4) -+ #define FRAMEBUFFER_PROGRESS BIT(6) -+ #define FRAMEBUFFER_ROT_ANGLE_SHIFT (11) -+ #define FRAMEBUFFER_ROT_ANGLE_MASK (0x7) -+ #define FRAMEBUFFER_ROT_ANGLE_ROT0 (0) -+ #define FRAMEBUFFER_ROT_ANGLE_FLIP_X (1) -+ #define FRAMEBUFFER_ROT_ANGLE_FLIP_Y (2) -+ #define FRAMEBUFFER_TILE_MODE_SHIFT (17) -+ #define FRAMEBUFFER_TILE_MODE_MASK (0x1f) -+ #define FRAMEBUFFER_LINEAR 0 -+ #define FRAMEBUFFER_TILE_MODE0 4 -+ #define FRAMEBUFFER_TILE_MODE3 7 -+ #define FRAMEBUFFER_FORMAT_SHIFT 26 -+ #define FRAMEBUFFER_FORMAT_MASK 0x3f -+ #define FRAMEBUFFER_FORMAT_XRGB4444 0x0 -+ #define FRAMEBUFFER_FORMAT_ARGB4444 0x1 -+ #define FRAMEBUFFER_FORMAT_XRGB1555 0x2 -+ #define FRAMEBUFFER_FORMAT_ARGB1555 0x3 -+ #define FRAMEBUFFER_FORMAT_RGB565 0x4 -+ #define FRAMEBUFFER_FORMAT_XRGB8888 0x5 -+ #define FRAMEBUFFER_FORMAT_ARGB8888 0x6 -+ #define FRAMEBUFFER_FORMAT_YUYV 0x7 -+ #define FRAMEBUFFER_FORMAT_UYVY 0x8 -+ #define FRAMEBUFFER_FORMAT_NV12 0x11 -+ #define FRAMEBUFFER_FORMAT_NV16 0x12 -+ #define FRAMEBUFFER_FORMAT_ARGB2101010 0x16 -+ #define FRAMEBUFFER_SWIZZLE_SHIFT 23 -+ #define FRAMEBUFFER_SWIZZLE_MASK 0x3 -+ #define FRAMEBUFFER_SWIZZLE_ARGB 0 -+ #define FRAMEBUFFER_SWIZZLE_RGBA 1 -+ #define FRAMEBUFFER_SWIZZLE_ABGR 2 -+ #define FRAMEBUFFER_SWIZZLE_BGRA 3 -+ #define FRAMEBUFFER_UVSWIZZLE_SHIFT 25 -+ #define FRAMEBUFFER_UVSWIZZLE_DISABLE 0 -+ #define FRAMEBUFFER_UVSWIZZLE_ENABLE 1 -+ #define FRAMEBUFFER_CLEAR BIT(8) -+ #define FRAMEBUFFER_SCALE_ENABLE BIT(22) -+#define PHYTIUM_DC_FRAMEBUFFER_SCALECONFIG 0x1520 -+ #define FRAMEBUFFER_FILTER_TAP 3 -+ #define FRAMEBUFFER_HORIZONTAL_FILTER_TAP 3 -+ #define FRAMEBUFFER_TAP 0x33 -+#define PHYTIUM_DC_FRAMEBUFFER_U_ADDRESS 0x1530 -+#define PHYTIUM_DC_FRAMEBUFFER_V_ADDRESS 0x1538 -+#define PHYTIUM_DC_OVERLAY_CONFIG 0x1540 -+ #define PX210_DC_OVERLAY_ENABLE BIT(24) -+ -+#define PHYTIUM_DC_FRAMEBUFFER_U_STRIDE 0x1800 -+#define PHYTIUM_DC_FRAMEBUFFER_V_STRIDE 0x1808 -+#define PHYTIUM_DC_FRAMEBUFFER_SIZE 0x1810 -+ #define WIDTH_SHIFT 0 -+ #define WIDTH_MASK 0x7fff -+ #define HEIGHT_SHIFT 15 -+ #define HEIGHT_MASK 0x7fff -+ -+#define PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_X 0x1828 -+ #define SCALE_FACTOR_X_MASK 0x7fffffff -+#define PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_Y 0x1830 -+ #define SCALE_FACTOR_Y_MASK 0x7fffffff -+ #define SCALE_FACTOR_Y_MAX 0x3 -+ #define SCALE_FACTOR_SRC_OFFSET 16 -+ -+#define PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER_INDEX 0x1838 -+ #define HORI_FILTER_INDEX 0x0 -+#define PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER 0x1a00 -+#define PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER_INDEX 0x1a08 -+ #define VERT_FILTER_INDEX 0x0 -+#define PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER 0x1a10 -+#define PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE 0x1a18 -+ #define CLEAR_VALUE_RED 0x00ff0000 -+ #define CLEAR_VALUE_GREEN 0x0000ff00 -+ #define CLEAR_VALUE_BLACK 0x00000000 -+#define PHYTIUM_DC_FRAMEBUFFER_INITIALOFFSET 0x1a20 -+ #define INITIALOFFSET (0x8000 | (0X8000 << 16)) -+#define PHYTIUM_DC_DP_CONFIG 0x1cd0 -+ #define OUTPUT_DP (1<<3) -+ #define DP_RGB666 (0x1) -+ #define DP_RGB888 (0x2) -+ #define DP_RGB101010 (0x3) -+/******************************dc register end********************************************/ -+ -+/******************************phy access register****************************************/ -+#define PHYTIUM_PHY_ACCESS_ADDRESS 0x0000 -+#define PHYTIUM_PHY_WRITE_DATA 0x0004 -+#define PHYTIUM_PHY_READ_DATA 0x0008 -+#define PHYTIUM_PHY_ACCESS_CTRL 0x000c -+ #define ACCESS_WRITE (1<<0) -+ #define ACCESS_READ (1<<1) -+/******************************phy access register end*************************************/ -+ -+/******************************dp register start******************************************/ -+#define PHYTIUM_DP_LINK_BW_SET 0x0000 -+#define PHYTIUM_DP_LANE_COUNT_SET 0x0004 -+#define PHYTIUM_DP_ENHANCED_FRAME_EN 0x0008 -+ #define ENHANCED_FRAME_ENABLE 0x1 -+ #define ENHANCED_FRAME_DISABLE 0x0 -+#define PHYTIUM_DP_TRAINING_PATTERN_SET 0x000c -+ #define TRAINING_OFF 0x0 -+ #define TRAINING_PATTERN_1 0x1 -+ #define TRAINING_PATTERN_2 0x2 -+ #define TRAINING_PATTERN_3 0x3 -+ #define TRAINING_PATTERN_4 0x4 -+#define PHYTIUM_DP_LINK_QUAL_PATTERN_SET 0x0010 -+ #define TEST_PATTERN_NONE 0x0 -+ #define TEST_PATTERN_D10_2 0x1 -+ #define TEST_PATTERN_SYMBOL_ERROR 0x2 -+ #define TEST_PATTERN_PRBS7 0x3 -+ #define TEST_PATTERN_80BIT_CUSTOM 0x4 -+ #define TEST_PATTERN_CP2520_1 0x5 -+ #define TEST_PATTERN_CP2520_2 0x6 -+ #define TEST_PATTERN_CP2520_3 0x7 -+ #define TEST_PATTERN_LANE_SHIFT 8 -+#define PHYTIUM_DP_SCRAMBLING_DISABLE 0x0014 -+ #define SCRAMBLING_ENABLE 0x0 -+ #define SCRAMBLING_DISABLE 0x1 -+#define PHYTIUM_DP_DOWNSPREAD_CTRL 0x0018 -+#define PHYTIUM_DP_ALT_SCRAMBLER_RESET 0x001c -+#define PHYTIUM_DP_HBR2_SCRAMBLER_RESET 0x0020 -+#define PHYTIUM_DP_DISPLAYPORT_VERSION 0x0024 -+#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_0 0x0030 -+#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_1 0x0034 -+#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_2 0x0038 -+#define PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE 0x0080 -+ #define TRANSMITTER_OUTPUT_ENABLE BIT(0) -+ #define TRANSMITTER_OUTPUT_DISABLE 0 -+#define PHYTIUM_DP_VIDEO_STREAM_ENABLE 0x0084 -+ #define SST_MST_SOURCE_0_ENABLE BIT(0) -+ #define SST_MST_SOURCE_0_ENABLE_MASK 0x1 -+ #define SST_MST_SOURCE_0_DISABLE 0 -+#define PHYTIUM_DP_SECONDARY_STREAM_ENABLE 0x0088 -+ #define SECONDARY_STREAM_ENABLE 0x1 -+ #define SECONDARY_STREAM_DISABLE 0x0 -+#define PHYTIUM_DP_SEC_DATA_WINDOW 0x008C -+#define PHYTIUM_DP_SOFT_RESET 0x0090 -+ #define LINK_SOFT_RESET (0x1 << 0) -+ #define VIDEO_SOFT_RESET (0x1 << 1) -+#define PHYTIUM_INPUT_SOURCE_ENABLE 0x0094 -+ #define VIRTUAL_SOURCE_0_ENABLE BIT(0) -+ #define VIRTUAL_SOURCE_0_ENABLE_MASK 0x1 -+#define PHYTIUM_DP_FORCE_SCRAMBLER_RESET 0x00C0 -+ #define SCRAMBLER_RESET BIT(0) -+#define PHYTIUM_DP_SOURCE_CONTROL_STATUS 0x00C4 -+#define PHYTIUM_DP_DATA_CONTROL 0x00C8 -+#define PHYTIUM_DP_CORE_CAPABILITY 0x00F8 -+#define PHYTIUM_DP_CORE_ID 0x00FC -+#define PHYTIUM_DP_AUX_COMMAND 0x0100 -+ #define BYTE_COUNT_MASK 0xf -+ #define COMMAND_SHIFT 8 -+ #define COMMAND_MASK 0xf -+ #define ADDRESS_ONLY (1<<12) -+#define PHYTIUM_DP_AUX_WRITE_FIFO 0x0104 -+#define PHYTIUM_DP_AUX_ADDRESS 0x0108 -+#define PHYTIUM_DP_AUX_CLK_DIVIDER 0x010C -+ #define AUX_CLK_DIVIDER 48 -+ #define AUX_CLK_DIVIDER_100 100 -+#define PHYTIUM_DP_SINK_HPD_STATE 0x0128 -+ #define HPD_CONNECT 0x1 -+ #define HPD_DISCONNECT 0x0 -+#define PHYTIUM_DP_INTERRUPT_RAW_STATUS 0x0130 -+ #define REPLY_TIMEOUT (1<<3) -+ #define DP_STATUS_REQUEST_IN_PROGRESS (1<<1) -+ #define HPD_STATE (0<<1) -+#define PHYTIUM_DP_AUX_REPLY_DATA 0x0134 -+#define PHYTIUM_DP_AUX_REPLY_CODE 0x0138 -+ #define AUX_NATIVE_ACK (0x0<<0) -+ #define AUX_NATIVE_NACK (0x1<<0) -+ #define AUX_NATIVE_DEFER (0x2<<0) -+ #define AUX_NATIVE_MASK (0x3 << 0) -+ #define AUX_I2C_ACK (0x0<<2) -+ #define AUX_I2C_NACK (0x1<<2) -+ #define AUX_I2C_DEFER (0x2<<2) -+ #define AUX_I2C_MASK (0x3 << 2) -+#define PHYTIUM_DP_INTERRUPT_STATUS 0x0140 -+ #define HPD_IRQ (1<<1) -+ #define HPD_EVENT (1<<0) -+#define PHYTIUM_DP_INTERRUPT_MASK 0x0144 -+ #define HPD_IRQ_MASK (1<<1) -+ #define HPD_EVENT_MASK (1<<0) -+ #define HPD_OTHER_MASK 0x7c -+#define PHYTIUM_DP_AUX_REPLY_DATA_COUNT 0x0148 -+#define PHYTIUM_DP_AUX_STATUS 0x014C -+ #define REPLY_RECEIVED 0x1 -+ #define REPLY_IN_PROGRESS 0x2 -+ #define REQUEST_IN_PROGRESS 0x4 -+ #define REPLY_ERROR 0x8 -+#define PHYTIUM_DP_AUX_TIMER 0x0158 -+#define PHYTIUM_DP_MAIN_LINK_HTOTAL 0x0180 -+#define PHYTIUM_DP_MAIN_LINK_VTOTAL 0x0184 -+#define PHYTIUM_DP_MAIN_LINK_POLARITY 0x0188 -+ #define VSYNC_POLARITY_LOW BIT(1) -+ #define HSYNC_POLARITY_LOW BIT(0) -+#define PHYTIUM_DP_MAIN_LINK_HSWIDTH 0x018C -+#define PHYTIUM_DP_MAIN_LINK_VSWIDTH 0x0190 -+#define PHYTIUM_DP_MAIN_LINK_HRES 0x0194 -+#define PHYTIUM_DP_MAIN_LINK_VRES 0x0198 -+#define PHYTIUM_DP_MAIN_LINK_HSTART 0x019C -+#define PHYTIUM_DP_MAIN_LINK_VSTART 0x01A0 -+#define PHYTIUM_DP_MAIN_LINK_MISC0 0x01A4 -+ #define MISC0_SYNCHRONOUS_CLOCK BIT(0) -+ #define MISC0_BIT_DEPTH_OFFSET 5 -+ #define MISC0_BIT_DEPTH_6BIT 0x0 -+ #define MISC0_BIT_DEPTH_8BIT 0x1 -+ #define MISC0_BIT_DEPTH_10BIT 0x2 -+ #define MISC0_COMPONENT_FORMAT_SHIFT 1 -+ #define MISC0_COMPONENT_FORMAT_RGB 0x0 -+#define PHYTIUM_DP_MAIN_LINK_MISC1 0x01A8 -+#define PHYTIUM_DP_M_VID 0x01AC -+#define PHYTIUM_DP_TRANSFER_UNIT_SIZE 0x01B0 -+#define PHYTIUM_DP_N_VID 0x01B4 -+#define PHYTIUM_DP_USER_PIXEL_WIDTH 0x01B8 -+#define PHYTIUM_DP_DATA_COUNT 0x01BC -+#define PHYTIUM_DP_INTERLACED 0x01C0 -+#define PHYTIUM_DP_USER_SYNC_POLARITY 0x01C4 -+ #define USER_ODDEVEN_POLARITY_HIGH BIT(3) -+ #define USER_DATA_ENABLE_POLARITY_HIGH BIT(2) -+ #define USER_VSYNC_POLARITY_HIGH BIT(1) -+ #define USER_HSYNC_POLARITY_HIGH BIT(0) -+#define PHYTIUM_DP_USER_CONTROL 0x01C8 -+#define PHYTIUM_EDP_CRC_ENABLE 0x01D0 -+ #define SUPPORT_EDP_1_4 BIT(1) -+#define PHYTIUM_EDP_CRC_RED 0x01D4 -+#define PHYTIUM_EDP_CRC_GREEN 0x01D8 -+#define PHYTIUM_EDP_CRC_BLUE 0x01DC -+#define PHYTIUM_DP_SEC_AUDIO_ENABLE 0x0300 -+ #define SEC_AUDIO_ENABLE BIT(0) -+ #define CHANNEL_MUTE_ENABLE BIT(1) -+#define PHYTIUM_DP_SEC_INPUT_SELECT 0x0304 -+ #define INPUT_SELECT_I2S 0x0 -+#define PHYTIUM_DP_SEC_CHANNEL_COUNT 0x0308 -+ #define CHANNEL_2 0x2 -+ #define CHANNEL_2_LFE 0x3 -+ #define CHANNEL_5_1 0x6 -+ #define CHANNEL_7_1 0x7 -+ #define CHANNEL_MASK 0xf -+#define PHYTIUM_DP_SEC_DIRECT_CLKDIV 0x030c -+ #define APB_CLOCK 48000000 -+#define PHYTIUM_DP_SEC_MAUD 0x0318 -+#define PHYTIUM_DP_SEC_NAUD 0x031c -+#define PHYTIUM_DP_SEC_CLOCK_MODE 0x0320 -+ #define CLOCK_MODE_SYNC 0x1 -+#define PHYTIUM_DP_SEC_CS_SOURCE_FORMAT 0x0340 -+ #define CS_SOURCE_FORMAT_DEFAULT 0x0 -+#define PHYTIUM_DP_SEC_CS_CATEGORY_CODE 0x0344 -+#define PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ 0x0348 -+ #define ORIG_FREQ_32000 0xc -+ #define ORIG_FREQ_44100 0xf -+ #define ORIG_FREQ_48000 0xd -+ #define ORIG_FREQ_88200 0x7 -+ #define ORIG_FREQ_96000 0x5 -+ #define ORIG_FREQ_176400 0x3 -+ #define ORIG_FREQ_192000 0x1 -+ #define ORIG_FREQ_MASK 0xf -+ #define ORIG_FREQ_SHIFT 0 -+ #define WORD_LENGTH_16 0x4 -+ #define WORD_LENGTH_18 0x2 -+ #define WORD_LENGTH_20 0xc -+ #define WORD_LENGTH_24 0xd -+ #define WORD_LENGTH_MASK 0xf -+ #define WORD_LENGTH_SHIFT 4 -+#define PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY 0x034c // not used -+ #define SAMPLING_FREQ_32000 0xc -+ #define SAMPLING_FREQ_44100 0x0 -+ #define SAMPLING_FREQ_48000 0x4 -+ #define SAMPLING_FREQ_88200 0x1 -+ #define SAMPLING_FREQ_96000 0x5 -+ #define SAMPLING_FREQ_176400 0x3 -+ #define SAMPLING_FREQ_192000 0x7 -+ #define SAMPLING_FREQ_MASK 0xf -+ #define SAMPLING_FREQ_SHIFT 4 -+#define PHYTIUM_DP_SEC_CHANNEL_MAP 0x035C -+ #define CHANNEL_MAP_DEFAULT 0x87654321 -+/******************************dp register end********************************************/ -+ -+#endif /* __PHYTIUM_REG_H__ */ -diff --git a/drivers/gpu/drm/phytium/px210_dc.c b/drivers/gpu/drm/phytium/px210_dc.c -new file mode 100644 -index 000000000..6b416fc77 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/px210_dc.c -@@ -0,0 +1,328 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#if defined(__arm__) || defined(__aarch64__) -+#include -+#endif -+#include -+#include "phytium_display_drv.h" -+#include "px210_reg.h" -+#include "phytium_crtc.h" -+#include "phytium_plane.h" -+#include "phytium_fb.h" -+#include "phytium_gem.h" -+ -+static const unsigned int px210_primary_formats[] = { -+ DRM_FORMAT_ARGB2101010, -+ DRM_FORMAT_ABGR2101010, -+ DRM_FORMAT_RGBA1010102, -+ DRM_FORMAT_BGRA1010102, -+ DRM_FORMAT_ARGB8888, -+ DRM_FORMAT_ABGR8888, -+ DRM_FORMAT_RGBA8888, -+ DRM_FORMAT_BGRA8888, -+ DRM_FORMAT_XRGB8888, -+ DRM_FORMAT_XBGR8888, -+ DRM_FORMAT_RGBX8888, -+ DRM_FORMAT_BGRX8888, -+ DRM_FORMAT_ARGB4444, -+ DRM_FORMAT_ABGR4444, -+ DRM_FORMAT_RGBA4444, -+ DRM_FORMAT_BGRA4444, -+ DRM_FORMAT_XRGB4444, -+ DRM_FORMAT_XBGR4444, -+ DRM_FORMAT_RGBX4444, -+ DRM_FORMAT_BGRX4444, -+ DRM_FORMAT_ARGB1555, -+ DRM_FORMAT_ABGR1555, -+ DRM_FORMAT_RGBA5551, -+ DRM_FORMAT_BGRA5551, -+ DRM_FORMAT_XRGB1555, -+ DRM_FORMAT_XBGR1555, -+ DRM_FORMAT_RGBX5551, -+ DRM_FORMAT_BGRX5551, -+ DRM_FORMAT_RGB565, -+ DRM_FORMAT_BGR565, -+ DRM_FORMAT_YUYV, -+ DRM_FORMAT_UYVY, -+}; -+ -+static uint64_t px210_primary_formats_modifiers[] = { -+ DRM_FORMAT_MOD_LINEAR, -+ DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC, -+ DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC, -+ DRM_FORMAT_MOD_INVALID -+}; -+ -+static uint64_t px210_cursor_formats_modifiers[] = { -+ DRM_FORMAT_MOD_LINEAR, -+ DRM_FORMAT_MOD_INVALID -+}; -+ -+static const unsigned int px210_cursor_formats[] = { -+ DRM_FORMAT_ARGB8888, -+}; -+ -+void px210_dc_hw_vram_init(struct phytium_display_private *priv, resource_size_t vram_addr, -+ resource_size_t vram_size) -+{ -+ uint32_t config; -+ uint32_t group_offset = priv->address_transform_base; -+ -+ config = phytium_readl_reg(priv, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR); -+ if (config) -+ phytium_writel_reg(priv, config, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR); -+ -+ config = phytium_readl_reg(priv, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_SIZE); -+ if (config) -+ phytium_writel_reg(priv, config, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_SIZE); -+ -+ config = phytium_readl_reg(priv, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR); -+ if (config) -+ phytium_writel_reg(priv, config, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR); -+ -+ phytium_writel_reg(priv, (vram_addr & SRC_ADDR_MASK) >> SRC_ADDR_OFFSET, -+ group_offset, PX210_DC_ADDRESS_TRANSFORM_SRC_ADDR); -+ phytium_writel_reg(priv, (vram_size >> SIZE_OFFSET) | ADDRESS_TRANSFORM_ENABLE, -+ group_offset, PX210_DC_ADDRESS_TRANSFORM_SIZE); -+ config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DST_ADDR); -+ phytium_writel_reg(priv, config, group_offset, PX210_DC_ADDRESS_TRANSFORM_DST_ADDR); -+} -+ -+void px210_dc_hw_clear_msi_irq(struct phytium_display_private *priv, uint32_t phys_pipe) -+{ -+ phytium_writel_reg(priv, MSI_CLEAR, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_MSI_CLEAR); -+} -+ -+void px210_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ uint32_t group_offset = priv->dcreq_reg_base[phys_pipe]; -+ int ret = 0; -+ -+ /* config pix clock */ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_PIXEL_CLOCK | (clock & PIXEL_CLOCK_MASK), -+ group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to set pixel clock\n", __func__); -+} -+ -+void px210_dc_hw_disable(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int reset_timeout = 100; -+ int config = 0; -+ int phys_pipe = phytium_crtc->phys_pipe; -+ -+ // reset dc -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, config | SOFT_RESET, priv->dc_reg_base[phys_pipe], -+ PX210_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, 0, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); -+ do { -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_IDLE); -+ if (config | IS_IDLE) -+ break; -+ mdelay(1); -+ reset_timeout--; -+ } while (reset_timeout); -+ -+ /* reset pix clock */ -+ px210_dc_hw_config_pix_clock(crtc, 0); -+ -+ // reset dc -+ reset_timeout = 100; -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, config | SOFT_RESET, priv->dc_reg_base[phys_pipe], -+ PX210_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, 0, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); -+ do { -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_IDLE); -+ if (config | IS_IDLE) -+ break; -+ mdelay(1); -+ reset_timeout--; -+ } while (reset_timeout); -+ -+ /* reset dcreq */ -+ phytium_writel_reg(priv, DCREQ_PLAN_A, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_PLAN); -+ phytium_writel_reg(priv, 0, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_CONTROL); -+ phytium_writel_reg(priv, DCREQ_RESET, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_RESET); -+ msleep(20); -+ phytium_writel_reg(priv, (~DCREQ_RESET)&DCREQ_RESET_MASK, -+ priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_RESET); -+} -+ -+int px210_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count) -+{ -+ int ret = 0; -+ -+ switch (mode_cmd->modifier[count]) { -+ case DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC: -+ switch (mode_cmd->pixel_format) { -+ case DRM_FORMAT_ARGB4444: -+ case DRM_FORMAT_ABGR4444: -+ case DRM_FORMAT_RGBA4444: -+ case DRM_FORMAT_BGRA4444: -+ case DRM_FORMAT_XRGB4444: -+ case DRM_FORMAT_XBGR4444: -+ case DRM_FORMAT_RGBX4444: -+ case DRM_FORMAT_BGRX4444: -+ case DRM_FORMAT_ARGB1555: -+ case DRM_FORMAT_ABGR1555: -+ case DRM_FORMAT_RGBA5551: -+ case DRM_FORMAT_BGRA5551: -+ case DRM_FORMAT_XRGB1555: -+ case DRM_FORMAT_XBGR1555: -+ case DRM_FORMAT_RGBX5551: -+ case DRM_FORMAT_BGRX5551: -+ case DRM_FORMAT_RGB565: -+ case DRM_FORMAT_BGR565: -+ case DRM_FORMAT_YUYV: -+ case DRM_FORMAT_UYVY: -+ break; -+ default: -+ DRM_ERROR("TILE_MODE0_FBCDC not support DRM_FORMAT %d", -+ mode_cmd->pixel_format); -+ ret = -EINVAL; -+ goto error; -+ } -+ break; -+ case DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC: -+ switch (mode_cmd->pixel_format) { -+ case DRM_FORMAT_ARGB2101010: -+ case DRM_FORMAT_ABGR2101010: -+ case DRM_FORMAT_RGBA1010102: -+ case DRM_FORMAT_BGRA1010102: -+ case DRM_FORMAT_ARGB8888: -+ case DRM_FORMAT_ABGR8888: -+ case DRM_FORMAT_RGBA8888: -+ case DRM_FORMAT_BGRA8888: -+ case DRM_FORMAT_XRGB8888: -+ case DRM_FORMAT_XBGR8888: -+ case DRM_FORMAT_RGBX8888: -+ case DRM_FORMAT_BGRX8888: -+ break; -+ default: -+ DRM_ERROR("TILE_MODE3_FBCDC not support DRM_FORMAT %d", -+ mode_cmd->pixel_format); -+ ret = -EINVAL; -+ goto error; -+ } -+ break; -+ case DRM_FORMAT_MOD_LINEAR: -+ break; -+ default: -+ DRM_ERROR("unsupported fb modifier 0x%llx\n", mode_cmd->modifier[0]); -+ ret = -EINVAL; -+ goto error; -+ } -+ -+ return 0; -+error: -+ return ret; -+} -+ -+void px210_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count) -+{ -+ *format_modifiers = px210_primary_formats_modifiers; -+ *formats = px210_primary_formats; -+ *format_count = ARRAY_SIZE(px210_primary_formats); -+} -+ -+void px210_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count) -+{ -+ *format_modifiers = px210_cursor_formats_modifiers; -+ *formats = px210_cursor_formats; -+ *format_count = ARRAY_SIZE(px210_cursor_formats); -+} -+ -+void px210_dc_hw_update_dcreq(struct drm_plane *plane) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ int phys_pipe = phytium_plane->phys_pipe; -+ uint32_t group_offset = priv->dcreq_reg_base[phys_pipe]; -+ int config; -+ -+ if (phytium_plane->tiling[0] == FRAMEBUFFER_LINEAR) { -+ phytium_writel_reg(priv, DCREQ_MODE_LINEAR, -+ group_offset, PX210_DCREQ_PLANE0_CONFIG); -+ } else { -+ config = DCREQ_NO_LOSSY; -+ if (phytium_plane->tiling[0] == FRAMEBUFFER_TILE_MODE0) -+ config |= DCREQ_TILE_TYPE_MODE0; -+ else if (phytium_plane->tiling[0] == FRAMEBUFFER_TILE_MODE3) -+ config |= DCREQ_TILE_TYPE_MODE3; -+ else -+ config |= DCREQ_TILE_TYPE_MODE0; -+ -+ switch (phytium_plane->format) { -+ case FRAMEBUFFER_FORMAT_ARGB8888: -+ case FRAMEBUFFER_FORMAT_XRGB8888: -+ config |= DCREQ_COLOURFORMAT_BGRA8888; -+ break; -+ case FRAMEBUFFER_FORMAT_ARGB2101010: -+ config |= DCREQ_COLOURFORMAT_ARGB2101010; -+ break; -+ case FRAMEBUFFER_FORMAT_XRGB4444: -+ case FRAMEBUFFER_FORMAT_ARGB4444: -+ config |= DCREQ_COLOURFORMAT_ARGB4444; -+ break; -+ case FRAMEBUFFER_FORMAT_XRGB1555: -+ case FRAMEBUFFER_FORMAT_ARGB1555: -+ config |= DCREQ_COLOURFORMAT_ARGB1555; -+ break; -+ case FRAMEBUFFER_FORMAT_RGB565: -+ config |= DCREQ_COLOURFORMAT_RGB565; -+ break; -+ case FRAMEBUFFER_FORMAT_YUYV: -+ config |= DCREQ_COLOURFORMAT_YUYV; -+ break; -+ case FRAMEBUFFER_FORMAT_UYVY: -+ config |= DCREQ_COLOURFORMAT_UYVY; -+ break; -+ } -+ config |= DCREQ_ARGBSWIZZLE_ARGB; -+ config |= DCREQ_MODE_TILE; -+ phytium_writel_reg(priv, phytium_plane->iova[0] & 0xffffffff, -+ group_offset, PX210_DCREQ_PLANE0_ADDR_START); -+ phytium_writel_reg(priv, (phytium_plane->iova[0] + phytium_plane->size[0]) & -+ 0xffffffff, group_offset, PX210_DCREQ_PLANE0_ADDR_END); -+ phytium_writel_reg(priv, config, group_offset, PX210_DCREQ_PLANE0_CONFIG); -+ } -+} -+ -+void px210_dc_hw_update_primary_hi_addr(struct drm_plane *plane) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ int phys_pipe = phytium_plane->phys_pipe; -+ -+ phytium_writel_reg(priv, (phytium_plane->iova[0] >> PREFIX_SHIFT) & PREFIX_MASK, -+ priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_PIX_DMA_PREFIX); -+} -diff --git a/drivers/gpu/drm/phytium/px210_dc.h b/drivers/gpu/drm/phytium/px210_dc.h -new file mode 100644 -index 000000000..ef2208bf4 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/px210_dc.h -@@ -0,0 +1,30 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PX210_DC_H__ -+#define __PX210_DC_H__ -+ -+#define PX210_DC_PIX_CLOCK_MAX (594000) -+#define PX210_DC_HDISPLAY_MAX 3840 -+#define PX210_DC_VDISPLAY_MAX 2160 -+#define PX210_DC_ADDRESS_MASK 0x7f -+ -+extern void px210_dc_hw_vram_init(struct phytium_display_private *priv, -+ resource_size_t vram_addr, -+ resource_size_t vram_size); -+extern void px210_dc_hw_clear_msi_irq(struct phytium_display_private *priv, uint32_t phys_pipe); -+extern void px210_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock); -+extern void px210_dc_hw_disable(struct drm_crtc *crtc); -+extern int px210_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count); -+extern void px210_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+extern void px210_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+void px210_dc_hw_update_dcreq(struct drm_plane *plane); -+void px210_dc_hw_update_primary_hi_addr(struct drm_plane *plane); -+#endif /* __PX210_DC_H__ */ -diff --git a/drivers/gpu/drm/phytium/px210_dp.c b/drivers/gpu/drm/phytium/px210_dp.c -new file mode 100644 -index 000000000..7c6555631 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/px210_dp.c -@@ -0,0 +1,920 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include "phytium_display_drv.h" -+#include "px210_reg.h" -+#include "phytium_dp.h" -+#include "px210_dp.h" -+ -+static uint8_t px210_dp_source_lane_count[3] = {4, 4, 1}; -+ -+/* [reg][ling_rate 1.62->8.1] */ -+static int vco_val[12][4] = { -+ {0x0509, 0x0509, 0x0509, 0x0509}, // CP_PADJ -+ {0x0f00, 0x0f00, 0x0f00, 0x0f00}, // CP_IADJ -+ {0x0F08, 0x0F08, 0x0F08, 0x0F08}, // FILT_PADJ -+ {0x0061, 0x006C, 0x006C, 0x0051}, // INTDIV -+ {0x3333, 0x0000, 0x0000, 0x0000}, // FRACDIVL -+ {0x0000, 0x0000, 0x0000, 0x0000}, // FRACDIVH -+ {0x0042, 0x0048, 0x0048, 0x0036}, // HIGH_THR -+ {0x0002, 0x0002, 0x0002, 0x0002}, // PDIAG_CTRL -+ {0x0c5e, 0x0c5e, 0x0c5e, 0x0c5e}, // VCOCAL_PLLCNT_START -+ {0x00c7, 0x00c7, 0x00c7, 0x00c7}, // LOCK_PEFCNT -+ {0x00c7, 0x00c7, 0x00c7, 0x00c7}, // LOCK_PLLCNT_START -+ {0x0005, 0x0005, 0x0005, 0x0005}, // LOCK_PLLCNT_THR -+}; -+ -+static int mgnfs_val[4][4][4] = // [link_rate][swing][emphasis] -+{ -+ /* 1.62Gbps */ -+ { -+ {0x0026, 0x001f, 0x0012, 0x0000}, -+ {0x0013, 0x0013, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 2.7Gbps */ -+ { -+ {0x0026, 0x001f, 0x0012, 0x0000}, -+ {0x0013, 0x0013, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 5.4Gbps */ -+ { -+ {0x0026, 0x0013, 0x005, 0x0000}, -+ {0x0018, 0x006, 0x0000, 0x0000}, -+ {0x000c, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 8.1Gbps */ -+ { -+ {0x0026, 0x0013, 0x005, 0x0000}, -+ {0x0013, 0x006, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+}; -+ -+static int cpost_val[4][4][4] = // [link_rate][swing][emphasis] -+{ -+ /* 1.62Gbps */ -+ { -+ {0x0000, 0x0014, 0x0020, 0x002a}, -+ {0x0000, 0x0010, 0x001f, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 2.7Gbps */ -+ { -+ {0x0000, 0x0014, 0x0020, 0x002a}, -+ {0x0000, 0x0010, 0x001f, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 5.4Gbps */ -+ { -+ {0x0000, 0x0014, 0x0022, 0x002e}, -+ {0x0000, 0x0013, 0x0020, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 8.1Gbps */ -+ { -+ {0x0000, 0x0014, 0x0022, 0x002e}, -+ {0x0000, 0x0013, 0x0020, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+}; -+ -+static int px210_dp_hw_set_phy_lane_and_rate(struct phytium_dp_device *phytium_dp, -+ uint8_t link_lane_count, -+ uint32_t link_rate) -+{ -+ int port = phytium_dp->port%3; -+ int i = 0, data, tmp, tmp1, index = 0, mask; -+ int timeout = 500, ret = 0; -+ -+ if (port == 0 || port == 1) { -+ /* set pma powerdown */ -+ data = 0; -+ mask = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) { -+ data |= (A3_POWERDOWN3 << i*A3_POWERDOWN3_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (PLL_EN << i*PLL_EN_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (PLL_EN << i*PLL_EN_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (A0_ACTIVE << i*A0_ACTIVE_SHIFT); -+ mask |= (((1<port%3; -+ int voltage_swing = 0; -+ int pre_emphasis = 0, link_rate_index = 0; -+ -+ switch (train_set & DP_TRAIN_VOLTAGE_SWING_MASK) { -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_0: -+ default: -+ voltage_swing = 0; -+ break; -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_1: -+ voltage_swing = 1; -+ break; -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_2: -+ voltage_swing = 2; -+ break; -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_3: -+ voltage_swing = 3; -+ break; -+ } -+ switch (train_set & DP_TRAIN_PRE_EMPHASIS_MASK) { -+ case DP_TRAIN_PRE_EMPH_LEVEL_0: -+ default: -+ pre_emphasis = 0; -+ break; -+ case DP_TRAIN_PRE_EMPH_LEVEL_1: -+ pre_emphasis = 1; -+ break; -+ case DP_TRAIN_PRE_EMPH_LEVEL_2: -+ pre_emphasis = 2; -+ break; -+ case DP_TRAIN_PRE_EMPH_LEVEL_3: -+ pre_emphasis = 3; -+ break; -+ } -+ -+ switch (link_rate) { -+ case 810000: -+ link_rate_index = 3; -+ break; -+ case 540000: -+ link_rate_index = 2; -+ break; -+ case 270000: -+ link_rate_index = 1; -+ break; -+ case 162000: -+ link_rate_index = 0; -+ break; -+ default: -+ DRM_ERROR("phytium dp rate(%d) not support\n", link_rate); -+ link_rate_index = 2; -+ break; -+ } -+ -+ if (port == 0) { -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DIAG_ACYA, LOCK); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_TXCC_CTRL, TX_TXCC_CTRL); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DRV, TX_DRV); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_MGNFS, -+ mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_CPOST, -+ cpost_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DIAG_ACYA, UNLOCK); -+ -+ } else if (port == 1) { -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DIAG_ACYA, LOCK); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_TXCC_CTRL, TX_TXCC_CTRL); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DRV, TX_DRV); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_MGNFS, -+ mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_CPOST, -+ cpost_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_CPOST1, -+ cpost_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DIAG_ACYA, UNLOCK); -+ } else { -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DIAG_ACYA, LOCK); -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_TXCC_CTRL, TX_TXCC_CTRL); -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DRV, TX_DRV); -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_MGNFS, -+ mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_CPOST, -+ cpost_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DIAG_ACYA, UNLOCK); -+ } -+} -+ -+static int px210_dp_hw_init_phy(struct phytium_dp_device *phytium_dp) -+{ -+ int port = phytium_dp->port; -+ int i = 0, data, tmp, mask; -+ int timeout = 500, ret = 0; -+ -+ if (port == 0 || port == 1) { -+ phytium_phy_writel(phytium_dp, PX210_PHY0_APB_RESET, APB_RESET); -+ -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PIPE_RESET, RESET); -+ -+ /* config lane to dp mode */ -+ data = 0; -+ mask = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) { -+ data |= (LANE_BIT << i*LANE_BIT_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (LANE_MASTER << i*LANE_MASTER_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (PLL_EN << i*PLL_EN_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (BIT_20 << i*BIT_20_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (A0_ACTIVE << i*A0_ACTIVE_SHIFT); -+ mask |= (((1<dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dcreq_reg_base[port]; -+ int ret = 0; -+ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | PANEL_POWER_ENABLE, -+ group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to poweron panel\n", __func__); -+} -+ -+static void px210_dp_hw_poweroff_panel(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dcreq_reg_base[port]; -+ int ret = 0; -+ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | PANEL_POWER_DISABLE, -+ group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to poweroff panel\n", __func__); -+} -+ -+static void px210_dp_hw_enable_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, ret = 0; -+ uint32_t group_offset = priv->dcreq_reg_base[port]; -+ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | BACKLIGHT_ENABLE, -+ group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to enable backlight\n", __func__); -+} -+ -+static void px210_dp_hw_disable_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dcreq_reg_base[port]; -+ int ret = 0; -+ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | BACKLIGHT_DISABLE, -+ group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to disable backlight\n", __func__); -+} -+ -+static uint32_t px210_dp_hw_get_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int config; -+ uint32_t group_offset = priv->address_transform_base; -+ -+ config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE); -+ return ((config >> BACKLIGHT_VALUE_SHIFT) & BACKLIGHT_VALUE_MASK); -+} -+ -+static int px210_dp_hw_set_backlight(struct phytium_dp_device *phytium_dp, uint32_t level) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dcreq_reg_base[port]; -+ int config = 0; -+ int ret = 0; -+ -+ if (level > PX210_DP_BACKLIGHT_MAX) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ config = FLAG_REQUEST | CMD_BACKLIGHT | ((level & BACKLIGHT_MASK) << BACKLIGHT_SHIFT); -+ phytium_writel_reg(priv, config, group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to set backlight\n", __func__); -+ -+out: -+ return ret; -+} -+ -+bool px210_dp_hw_spread_is_enable(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, config; -+ uint32_t group_offset = priv->address_transform_base; -+ -+ config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); -+ -+ return ((config & DP_SPREAD_ENABLE(port)) ? true:false); -+} -+ -+int px210_dp_hw_reset(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ int timeout = 100, config, ret = 0; -+ uint32_t group_offset = priv->address_transform_base; -+ uint32_t group_offset_dp = priv->dp_reg_base[port]; -+ -+ config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); -+ config &= (~DC_DP_RESET_STATUS(port)); -+ -+ phytium_writel_reg(priv, config, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_DC_DP_RESET, -+ priv->dcreq_reg_base[port], PX210_DCREQ_CMD_REGISTER); -+ do { -+ mdelay(10); -+ timeout--; -+ config = phytium_readl_reg(priv, group_offset, -+ PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); -+ if (config & DC_DP_RESET_STATUS(port)) -+ break; -+ } while (timeout); -+ if (timeout == 0) { -+ DRM_ERROR("reset dc/dp pipe(%d) failed\n", port); -+ ret = -1; -+ } -+ -+ phytium_writel_reg(priv, AUX_CLK_DIVIDER, group_offset_dp, PHYTIUM_DP_AUX_CLK_DIVIDER); -+ -+ return ret; -+} -+ -+uint8_t px210_dp_hw_get_source_lane_count(struct phytium_dp_device *phytium_dp) -+{ -+ return px210_dp_source_lane_count[phytium_dp->port]; -+} -+ -+static struct phytium_dp_func px210_dp_funcs = { -+ .dp_hw_get_source_lane_count = px210_dp_hw_get_source_lane_count, -+ .dp_hw_reset = px210_dp_hw_reset, -+ .dp_hw_spread_is_enable = px210_dp_hw_spread_is_enable, -+ .dp_hw_set_backlight = px210_dp_hw_set_backlight, -+ .dp_hw_get_backlight = px210_dp_hw_get_backlight, -+ .dp_hw_disable_backlight = px210_dp_hw_disable_backlight, -+ .dp_hw_enable_backlight = px210_dp_hw_enable_backlight, -+ .dp_hw_poweroff_panel = px210_dp_hw_poweroff_panel, -+ .dp_hw_poweron_panel = px210_dp_hw_poweron_panel, -+ .dp_hw_init_phy = px210_dp_hw_init_phy, -+ .dp_hw_set_phy_lane_setting = px210_dp_hw_set_phy_lane_setting, -+ .dp_hw_set_phy_lane_and_rate = px210_dp_hw_set_phy_lane_and_rate, -+}; -+ -+void px210_dp_func_register(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_dp->funcs = &px210_dp_funcs; -+} -diff --git a/drivers/gpu/drm/phytium/px210_dp.h b/drivers/gpu/drm/phytium/px210_dp.h -new file mode 100644 -index 000000000..b62a3c833 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/px210_dp.h -@@ -0,0 +1,14 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PX210_DP_H__ -+#define __PX210_DP_H__ -+ -+#define PX210_DP_BACKLIGHT_MAX 100 -+#define PX210_DP_BACKLIGHT_MIN 0 -+ -+void px210_dp_func_register(struct phytium_dp_device *phytium_dp); -+#endif /* __PX210_DP_H__ */ -diff --git a/drivers/gpu/drm/phytium/px210_reg.h b/drivers/gpu/drm/phytium/px210_reg.h -new file mode 100644 -index 000000000..dbe1e537f ---- /dev/null -+++ b/drivers/gpu/drm/phytium/px210_reg.h -@@ -0,0 +1,349 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PX210_REG_H__ -+#define __PX210_REG_H__ -+ -+#include "phytium_reg.h" -+ -+/******************************dc register start******************************************/ -+#define PX210_DC_CLOCK_CONTROL 0x0000 -+ #define SOFT_RESET (1<<12) -+#define PX210_DC_CLOCK_IDLE 0x0004 -+ #define IS_IDLE (1<<16) -+/******************************dc register end********************************************/ -+ -+/******************************dcreq register start**************************************/ -+#define PX210_DCREQ_PLANE0_ADDR_START 0x00 -+#define PX210_DCREQ_PLANE0_ADDR_END 0x04 -+#define PX210_DCREQ_PLANE1_ADDR_START 0x08 -+#define PX210_DCREQ_PLANE1_ADDR_END 0x0c -+#define PX210_DCREQ_PLANE0_CONFIG 0x10 -+ #define DCREQ_NO_LOSSY (0 << 0) -+ #define DCREQ_LOSSY (1 << 0) -+ #define DCREQ_TILE_TYPE_MASK (0x3 << 1) -+ #define DCREQ_TILE_TYPE_MODE0 (0x1 << 1) -+ #define DCREQ_TILE_TYPE_MODE3 (0x2 << 1) -+ #define DCREQ_COLOURFORMAT_MASK (0x7f << 8) -+ #define DCREQ_COLOURFORMAT_RGB565 (0x5 << 8) -+ #define DCREQ_COLOURFORMAT_ARGB1555 (0x4 << 8) -+ #define DCREQ_COLOURFORMAT_ARGB4444 (0x02 << 8) -+ #define DCREQ_COLOURFORMAT_BGRA8888 (0x29 << 8) -+ #define DCREQ_COLOURFORMAT_ARGB2101010 (0xe << 8) -+ #define DCREQ_COLOURFORMAT_YUYV (0x59 << 8) -+ #define DCREQ_COLOURFORMAT_UYVY (0x5b << 8) -+ #define DCREQ_ARGBSWIZZLE_MASK (0xf << 4) -+ #define DCREQ_ARGBSWIZZLE_ARGB (0X0 << 4) -+ #define DCREQ_ARGBSWIZZLE_BGRA (0XC << 4) -+ #define DCREQ_MODE_MASK (1 << 16) -+ #define DCREQ_MODE_LINEAR (0 << 16) -+ #define DCREQ_MODE_TILE (1 << 16) -+#define PX210_DCREQ_PLANE1_CONFIG(pipe) 0x14 -+#define PX210_DCREQ_PLANE0_CLEAR_COLOR_L 0x18 -+#define PX210_DCREQ_PLANE0_CLEAR_COLOR_H 0x1C -+#define PX210_DCREQ_PLANE1_CLEAR_COLOR_L 0x20 -+#define PX210_DCREQ_PLANE1_CLEAR_COLOR_H 0x24 -+#define PX210_DCREQ_CMD_REGISTER 0x38 -+ #define FLAG_REPLY (1<<31) -+ #define FLAG_REQUEST (1<<30) -+ #define CMD_PIXEL_CLOCK (0x0 << 28) -+ #define CMD_BACKLIGHT (0x1 << 28) -+ #define CMD_DC_DP_RESET (0x3 << 28) -+ #define BACKLIGHT_SHIFT 21 -+ #define BACKLIGHT_MASK 0x7f -+ #define BACKLIGHT_MAX 100 -+ #define BACKLIGHT_ENABLE (101 << BACKLIGHT_SHIFT) -+ #define BACKLIGHT_DISABLE (102 << BACKLIGHT_SHIFT) -+ #define PANEL_POWER_ENABLE (103 << BACKLIGHT_SHIFT) -+ #define PANEL_POWER_DISABLE (104 << BACKLIGHT_SHIFT) -+ #define PIXEL_CLOCK_MASK (0x1fffff) -+#define PX210_DCREQ_FBCD_CLOCK_CONFIG 0x3c -+#define PX210_DCREQ_PIX_DMA_PREFIX 0x50 -+ #define PREFIX_MASK 0xff -+ #define PREFIX_SHIFT 32 -+#define PX210_DCREQ_FRAME_START 0x54 -+#define PX210_DCREQ_FILTER_CONFIG 0x58 -+#define PX210_DCREQ_CONTROL 0x5C -+ #define DC_REQ_ENABLE (1<<0) -+#define PX210_DCREQ_MSI_CLEAR 0x60 -+ #define MSI_CLEAR 0x0 -+#define PX210_DCREQ_RESET 0x68 -+ #define DCREQ_RESET (0x3 << 0) -+ #define DCREQ_RESET_MASK 0x3 -+#define PX210_DCREQ_PLAN 0x94 -+ #define DCREQ_PLAN_A 0x0 -+ #define DCREQ_PLAN_B 0X5 -+/******************************dcreq register end**************************************/ -+ -+/******************************address transform register start**************************/ -+#define PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR 0x0 -+#define PX210_GPU_ADDRESS_TRANSFORM_SIZE 0x4 -+#define PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR 0x8 -+ -+#define PX210_DC_ADDRESS_TRANSFORM_SRC_ADDR 0x24 -+ #define SRC_ADDR_OFFSET 22 -+ #define SRC_ADDR_MASK 0xffffffffff -+#define PX210_DC_ADDRESS_TRANSFORM_SIZE 0x28 -+ #define ADDRESS_TRANSFORM_ENABLE (0x1 << 31) -+ #define SIZE_OFFSET 22 -+#define PX210_DC_ADDRESS_TRANSFORM_DST_ADDR 0x2c -+ #define DST_ADDR_OFFSET 22 -+#define PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS 0x48 -+ #define DC_DP_RESET_STATUS(pipe) (1 << pipe) -+ #define DP_SPREAD_ENABLE(pipe) (0x8 << pipe) -+#define PX210_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE 0x4c -+ #define BACKLIGHT_VALUE_MASK (0x7f) -+ #define BACKLIGHT_VALUE_SHIFT 16 -+/******************************address transform register end**************************/ -+ -+/******************************phy register start******************************************/ -+/* self define */ -+#define PX210_PHY0_PIPE_RESET 0x40104 -+ #define RESET 0x0 -+ #define RESET_DEASSERT 0x1 -+#define PX210_PHY1_PIPE_RESET 0x100100 -+ #define PHY1_PIPE_RESET 0x0 -+ #define PHY1_PIPE_RESET_DEASSERT 0x4 -+ -+#define PX210_PHY1_EN_REFCLK 0x100070 -+ -+#define PX210_PHY0_MODE 0x40088 -+ #define LANE_BIT (0x3) -+ #define LANE_BIT_SHIFT 0x2 -+#define PX210_PHY1_SEL 0x100004 -+ #define PHY1_DP_LANE_BIT 0x1 -+ #define PHY1_DP_LANE_BIT_SHIFT 2 -+ -+#define PX210_PHY0_LINK_CFG 0x40044 -+ #define LANE_MASTER 0x1 -+ #define LANE_MASTER_SHIFT 1 -+ -+#define PX210_PHY0_PLL_EN 0x40010 -+ #define PLL_EN 0x1 -+ #define PLL_EN_SHIFT 1 -+#define PX210_PHY0_PMA_WIDTH 0x40020 -+ #define BIT_20 0x5 -+ #define BIT_20_SHIFT 4 -+ -+#define PX210_PHY0_PMA0_POWER 0x40014 -+#define PX210_PHY0_PMA1_POWER 0x40018 -+ #define A0_ACTIVE 0x1 -+ #define A0_ACTIVE_SHIFT 8 -+ #define A3_POWERDOWN3 0x8 -+ #define A3_POWERDOWN3_SHIFT 8 -+ -+#define PX210_PHY1_PMA_MISC 0x1000a0 -+ #define PHY1_PLL_EN 0x1 -+ #define PHY1_PLL_EN_MASK 1 -+ #define PHY1_PLL_EN_SHIFT 8 -+ #define PHY1_BIT_20 0x5 -+ #define PHY1_BIT_20_SHIFT 9 -+ #define PHY1_A0_ACTIVE 0x1 -+ #define PHY1_A0_ACTIVE_SHIFT 2 -+ #define PHY1_A0_ACTIVE_MASK 0x3f -+ #define PHY1_A3_POWERDOWN3 0x8 -+ #define PHY1_A3_POWERDOWN3_MASK 0x3f -+ #define PHY1_A3_POWERDOWN3_SHIFT 2 -+ -+#define PX210_PHY0_LINK_RESET 0x40108 -+ #define LINK_RESET 0x1 -+ #define LINK_RESET_MASK 0x1 -+ #define LINTK_RESET_SHIFT 0x1 -+ -+#define PX210_PHY0_APB_RESET 0x40100 -+ #define APB_RESET 0x1 -+#define PX210_PHY1_APB_RESET 0x100104 -+ #define PHY1_APB_RESET 0x4 -+ -+/* phy origin register */ -+#define PX210_PHY0_PLL_CFG 0x30038 -+#define PX210_PHY1_PLL_CFG 0xb0038 -+ #define SINGLE_LINK 0x0 -+ #define DOUBLE_LINK 0x2 -+ -+#define PX210_PHY0_PMA_CONTROL 0x3800c -+#define PX210_PHY1_PMA_CONTROL 0xb800c -+ #define CONTROL_ENABLE 0x1 -+ #define CONTROL_ENABLE_MASK 0x1 -+ #define CONTROL_ENABLE_SHIFT 0x1 -+ -+#define PX210_PHY0_PMA_CONTROL2 0x38004 -+#define PX210_PHY1_PMA_CONTROL2 0xb8004 -+ #define PLL0_LOCK_DONE (0x1 << 6) -+ #define PLL1_LOCK_DONE (0x1 << 7) -+ -+#define PX210_PHY0_PLL0_CLK_SEL 0X684 -+#define PX210_PHY0_PLL1_CLK_SEL 0x704 -+#define PX210_PHY1_PLL_CLK_SEL 0X80684 -+ #define PLL_LINK_RATE_162000 0xf01 -+ #define PLL_LINK_RATE_270000 0x701 -+ #define PLL_LINK_RATE_540000 0x301 -+ #define PLL_LINK_RATE_810000 0x200 -+ -+#define PX210_PHY0_HSCLK0_SEL 0x18398 -+#define PX210_PHY0_HSCLK1_SEL 0x1a398 -+#define PX210_PHY1_HSCLK_SEL 0x90398 -+ #define HSCLK_LINK_0 0x0 -+ #define HSCLK_LINK_1 0x1 -+ -+#define PX210_PHY0_HSCLK0_DIV 0x1839c -+#define PX210_PHY0_HSCLK1_DIV 0x1a39c -+#define PX210_PHY1_HSCLK_DIV 0x9039c -+ #define HSCLK_LINK_RATE_162000 0x2 -+ #define HSCLK_LINK_RATE_270000 0x1 -+ #define HSCLK_LINK_RATE_540000 0x0 -+ #define HSCLK_LINK_RATE_810000 0x0 -+ -+#define PX210_PHY0_PLLDRC0_CTRL 0x18394 -+#define PX210_PHY0_PLLDRC1_CTRL 0x1a394 -+#define PX210_PHY1_PLLDRC_CTRL 0x90394 -+ #define PLLDRC_LINK0 0x1 -+ #define PLLDRC_LINK1 0x9 -+ -+#define PX210_PHY0_PLL0_DSM_M0 0x250 -+#define PX210_PHY1_PLL0_DSM_M0 0x80250 -+ #define PLL0_DSM_M0 0x4 -+#define PX210_PHY0_PLL0_VCOCAL_START 0x218 -+#define PX210_PHY1_PLL0_VCOCAL_START 0x80218 -+ #define PLL0_VCOCAL_START 0xc5e -+#define PX210_PHY0_PLL0_VCOCAL_CTRL 0x208 -+#define PX210_PHY1_PLL0_VCOCAL_CTRL 0x80208 -+ #define PLL0_VCOCAL_CTRL 0x3 -+ -+#define PX210_PHY0_PLL1_DSM_M0 0x350 -+ #define PLL1_DSM_M0 0x4 -+#define PX210_PHY0_PLL1_VCOCAL_START 0x318 -+ #define PLL1_VCOCAL_START 0xc5e -+#define PX210_PHY0_PLL1_VCOCAL_CTRL 0x308 -+ #define PLL1_VCOCAL_CTRL 0x3 -+ -+#define PX210_PHY0_PLL0_CP_PADJ 0x690 -+#define PX210_PHY0_PLL0_CP_IADJ 0x694 -+#define PX210_PHY0_PLL0_CP_FILT_PADJ 0x698 -+#define PX210_PHY0_PLL0_INTDIV 0x240 -+#define PX210_PHY0_PLL0_FRACDIVL 0x244 -+#define PX210_PHY0_PLL0_FRACDIVH 0x248 -+#define PX210_PHY0_PLL0_HIGH_THR 0x24c -+#define PX210_PHY0_PLL0_PDIAG_CTRL 0x680 -+#define PX210_PHY0_PLL0_VCOCAL_PLLCNT_START 0x220 -+#define PX210_PHY0_PLL0_LOCK_PEFCNT 0x270 -+#define PX210_PHY0_PLL0_LOCK_PLLCNT_START 0x278 -+#define PX210_PHY0_PLL0_LOCK_PLLCNT_THR 0x27c -+ -+#define PX210_PHY0_PLL1_CP_PADJ 0x710 -+#define PX210_PHY0_PLL1_CP_IADJ 0x714 -+#define PX210_PHY0_PLL1_CP_FILT_PADJ 0x718 -+#define PX210_PHY0_PLL1_INTDIV 0x340 -+#define PX210_PHY0_PLL1_FRACDIVL 0x344 -+#define PX210_PHY0_PLL1_FRACDIVH 0x348 -+#define PX210_PHY0_PLL1_HIGH_THR 0x34c -+#define PX210_PHY0_PLL1_PDIAG_CTRL 0x700 -+#define PX210_PHY0_PLL1_VCOCAL_PLLCNT_START 0x320 -+#define PX210_PHY0_PLL1_LOCK_PEFCNT 0x370 -+#define PX210_PHY0_PLL1_LOCK_PLLCNT_START 0x378 -+#define PX210_PHY0_PLL1_LOCK_PLLCNT_THR 0x37c -+ -+#define PX210_PHY1_PLL0_CP_PADJ 0x80690 -+#define PX210_PHY1_PLL0_CP_IADJ 0x80694 -+#define PX210_PHY1_PLL0_CP_FILT_PADJ 0x80698 -+#define PX210_PHY1_PLL0_INTDIV 0x80240 -+#define PX210_PHY1_PLL0_FRACDIVL 0x80244 -+#define PX210_PHY1_PLL0_FRACDIVH 0x80248 -+#define PX210_PHY1_PLL0_HIGH_THR 0x8024c -+#define PX210_PHY1_PLL0_PDIAG_CTRL 0x80680 -+#define PX210_PHY1_PLL0_VCOCAL_PLLCNT_START 0x80220 -+#define PX210_PHY1_PLL0_LOCK_PEFCNT 0x80270 -+#define PX210_PHY1_PLL0_LOCK_PLLCNT_START 0x80278 -+#define PX210_PHY1_PLL0_LOCK_PLLCNT_THR 0x8027c -+ -+#define PX210_PHY0_PLL0_TX_PSC_A0 0x18400 -+#define PX210_PHY1_PLL0_TX_PSC_A0 0x90400 -+ #define PLL0_TX_PSC_A0 0xfb -+#define PX210_PHY0_PLL0_TX_PSC_A2 0x18408 -+#define PX210_PHY1_PLL0_TX_PSC_A2 0x90408 -+ #define PLL0_TX_PSC_A2 0x4aa -+#define PX210_PHY0_PLL0_TX_PSC_A3 0x1840c -+#define PX210_PHY1_PLL0_TX_PSC_A3 0x9040c -+ #define PLL0_TX_PSC_A3 0x4aa -+#define PX210_PHY0_PLL0_RX_PSC_A0 0x28000 -+#define PX210_PHY1_PLL0_RX_PSC_A0 0xa0000 -+ #define PLL0_RX_PSC_A0 0x0 -+#define PX210_PHY0_PLL0_RX_PSC_A2 0x28008 -+#define PX210_PHY1_PLL0_RX_PSC_A2 0xa0008 -+ #define PLL0_RX_PSC_A2 0x0 -+#define PX210_PHY0_PLL0_RX_PSC_A3 0x2800C -+#define PX210_PHY1_PLL0_RX_PSC_A3 0xa000C -+ #define PLL0_RX_PSC_A3 0x0 -+#define PX210_PHY0_PLL0_RX_PSC_CAL 0x28018 -+#define PX210_PHY1_PLL0_RX_PSC_CAL 0xa0018 -+ #define PLL0_RX_PSC_CAL 0x0 -+ -+#define PX210_PHY0_PLL1_TX_PSC_A0 0x1a400 -+ #define PLL1_TX_PSC_A0 0xfb -+#define PX210_PHY0_PLL1_TX_PSC_A2 0x1a408 -+ #define PLL1_TX_PSC_A2 0x4aa -+#define PX210_PHY0_PLL1_TX_PSC_A3 0x1a40c -+ #define PLL1_TX_PSC_A3 0x4aa -+#define PX210_PHY0_PLL1_RX_PSC_A0 0x2a000 -+ #define PLL1_RX_PSC_A0 0x0 -+#define PX210_PHY0_PLL1_RX_PSC_A2 0x2a008 -+ #define PLL1_RX_PSC_A2 0x0 -+#define PX210_PHY0_PLL1_RX_PSC_A3 0x2a00C -+ #define PLL1_RX_PSC_A3 0x0 -+#define PX210_PHY0_PLL1_RX_PSC_CAL 0x2a018 -+ #define PLL1_RX_PSC_CAL 0x0 -+ -+#define PX210_PHY0_PLL0_XCVR_CTRL 0x183a8 -+#define PX210_PHY1_PLL0_XCVR_CTRL 0x903a8 -+ #define PLL0_XCVR_CTRL 0xf -+#define PX210_PHY0_PLL1_XCVR_CTRL 0x1a3a8 -+ #define PLL1_XCVR_CTRL 0xf -+ -+#define PX210_PHY0_PLL0_RX_GCSM1_CTRL 0x28420 -+#define PX210_PHY1_PLL0_RX_GCSM1_CTRL 0xa0420 -+ #define PLL0_RX_GCSM1_CTRL 0x0 -+#define PX210_PHY0_PLL0_RX_GCSM2_CTRL 0x28440 -+#define PX210_PHY1_PLL0_RX_GCSM2_CTRL 0xa0440 -+ #define PLL0_RX_GCSM2_CTRL 0x0 -+#define PX210_PHY0_PLL0_RX_PERGCSM_CTRL 0x28460 -+#define PX210_PHY1_PLL0_RX_PERGCSM_CTRL 0xa0460 -+ #define PLL0_RX_PERGCSM_CTRL 0x0 -+ -+#define PX210_PHY0_PLL1_RX_GCSM1_CTRL 0x2a420 -+ #define PLL1_RX_GCSM1_CTRL 0x0 -+#define PX210_PHY0_PLL1_RX_GCSM2_CTRL 0x2a440 -+ #define PLL1_RX_GCSM2_CTRL 0x0 -+#define PX210_PHY0_PLL1_RX_PERGCSM_CTRL 0x2a460 -+ #define PLL1_RX_PERGCSM_CTRL 0x0 -+ -+/* swing and emphasis */ -+#define PX210_PHY0_PLL0_TX_DIAG_ACYA 0x1879c -+#define PX210_PHY0_PLL1_TX_DIAG_ACYA 0x1a79c -+#define PX210_PHY1_PLL0_TX_DIAG_ACYA 0x9079c -+ #define LOCK 1 -+ #define UNLOCK 0 -+ -+#define PX210_PHY0_PLL0_TX_TXCC_CTRL 0x18100 -+#define PX210_PHY0_PLL1_TX_TXCC_CTRL 0x1a100 -+#define PX210_PHY1_PLL0_TX_TXCC_CTRL 0x90100 -+ #define TX_TXCC_CTRL 0x8a4 -+ -+#define PX210_PHY0_PLL0_TX_DRV 0x18318 -+#define PX210_PHY0_PLL1_TX_DRV 0x1a318 -+#define PX210_PHY1_PLL0_TX_DRV 0x90318 -+ #define TX_DRV 0x3 -+ -+#define PX210_PHY0_PLL0_TX_MGNFS 0x18140 -+#define PX210_PHY0_PLL1_TX_MGNFS 0x1a140 -+#define PX210_PHY1_PLL0_TX_MGNFS 0x90140 -+ -+#define PX210_PHY0_PLL0_TX_CPOST 0x18130 -+#define PX210_PHY0_PLL1_TX_CPOST 0x1a130 -+#define PX210_PHY0_PLL1_TX_CPOST1 0x1a13c -+#define PX210_PHY1_PLL0_TX_CPOST 0x90130 -+ -+/******************************phy register end********************************************/ -+#endif /* __PX210_REG_H__ */ -diff --git a/drivers/hwmon/Kconfig b/drivers/hwmon/Kconfig -index 8a427467a..3d8fe5982 100644 ---- a/drivers/hwmon/Kconfig -+++ b/drivers/hwmon/Kconfig -@@ -2096,6 +2096,16 @@ config SENSORS_INTEL_M10_BMC_HWMON - sensors monitor various telemetry data of different components on the - card, e.g. board temperature, FPGA core temperature/voltage/current. - -+ -+config SENSORS_PHYTIUM -+ tristate "Phytium Fan tach and capture counter driver" -+ help -+ This driver provides support for Phytium Fan Tacho and capture -+ counter controllers. -+ -+ This driver can also be built as a module. If so, the module -+ will be called tacho-phytium. -+ - if ACPI - - comment "ACPI drivers" -diff --git a/drivers/hwmon/Makefile b/drivers/hwmon/Makefile -index 9db2903b6..5b9a59433 100644 ---- a/drivers/hwmon/Makefile -+++ b/drivers/hwmon/Makefile -@@ -194,6 +194,8 @@ obj-$(CONFIG_SENSORS_WM831X) += wm831x-hwmon.o - obj-$(CONFIG_SENSORS_WM8350) += wm8350-hwmon.o - obj-$(CONFIG_SENSORS_XGENE) += xgene-hwmon.o - -+obj-$(CONFIG_SENSORS_PHYTIUM) += tacho-phytium.o -+ - obj-$(CONFIG_SENSORS_OCC) += occ/ - obj-$(CONFIG_PMBUS) += pmbus/ - -diff --git a/drivers/hwmon/tacho-phytium.c b/drivers/hwmon/tacho-phytium.c -new file mode 100644 -index 000000000..c89251f35 ---- /dev/null -+++ b/drivers/hwmon/tacho-phytium.c -@@ -0,0 +1,391 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Hwmon driver for Phytium tachometer. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define TIMER_CTRL_REG 0x00 -+#define TIMER_CTRL_MODE_SHIFT 0//0:1 -+#define TIMER_CTRL_RESET_SHIFT BIT(2) -+#define TIMER_CTRL_FORCE_SHIFT BIT(3) -+#define TIMER_CTRL_CAPTURE_EN_SHIFT BIT(4) -+#define TIMER_CTRL_CAPTURE_CNT_SHIFT 5//5:11 -+#define TIMER_CTRL_ANTI_JITTER_SHIFT 18//18:19 -+#define TIMER_CTRL_TACHO_MODE_SHIFT 20//20:21 -+#define TIMER_CTRL_TIMER_CNT_MODE_SHIFT BIT(22) -+#define TIMER_CTRL_BIT_SET_SHIFT 24 -+#define TIMER_CTRL_CNT_EN_SHIFT BIT(25) -+#define TIMER_CTRL_CNT_CLR_SHIFT BIT(26) -+#define TIMER_CTRL_TIMER_MODE_SHIFT BIT(27) -+#define TIMER_CTRL_PULSE_NUM_SHIFT 28//28:30 -+#define TIMER_CTRL_TACHO_EN_SHIFT BIT(31) -+#define TIMER_TACHO_RES_REG 0x04 -+#define TIMER_TACHO_RES_VALID_SHIFT BIT(31) -+#define TIMER_TACHO_RES_MASK GENMASK(30, 0) -+#define TIMER_CMP_VALUE_UP_REG 0x08 -+#define TIMER_CMP_VALUE_LOW_REG 0x1C -+#define TIMER_CNT_VALUE_UP_REG 0x20 -+#define TIMER_CNT_VALUE_LOW_REG 0x24 -+#define TIMER_INT_MASK_REG 0x28 -+#define TIMER_INT_STAT_REG 0x2C -+#define TIMER_INT_CAPTURE_SHIFT BIT(5) -+#define TIMER_INT_CYC_COMP_SHIFT BIT(4) -+#define TIMER_INT_ONE_COMP_SHIFT BIT(3) -+#define TIMER_INT_ROLLOVER_SHIFT BIT(2) -+#define TIMER_INT_TACHO_UNDER_SHIFT BIT(1) -+#define TIMER_INT_TACHO_OVER_SHIFT BIT(0) -+#define TIMER_TACHO_OVER_REG 0x30 -+#define TIMER_TACHO_UNDER_REG 0x34 -+#define TIMER_START_VALUE_REG 0x38 -+ -+#define TIMER_INT_CLR_MASK GENMASK(5, 0) -+ -+enum tacho_modes { -+tacho_mode = 1, -+capture_mode, -+}; -+ -+enum edge_modes { -+rising_edge, -+falling_edge, -+double_edge, -+}; -+ -+struct phytium_tacho { -+ struct device *dev; -+ struct device *hwmon; -+ void __iomem *base; -+ struct clk *clk; -+ u32 freq; -+ int irq; -+ u8 work_mode; -+ u8 edge_mode; -+ u32 debounce; -+}; -+ -+static u16 capture_count; -+ -+static void phytium_tacho_init(struct phytium_tacho *tacho) -+{ -+ u32 val; -+ -+ if (tacho->work_mode == tacho_mode) { -+ val = (TIMER_CTRL_TACHO_EN_SHIFT | -+ TIMER_CTRL_CNT_EN_SHIFT | -+ (tacho->edge_mode << TIMER_CTRL_TACHO_MODE_SHIFT) | -+ (tacho->debounce << TIMER_CTRL_ANTI_JITTER_SHIFT) | -+ (tacho->work_mode << TIMER_CTRL_MODE_SHIFT)); -+ writel_relaxed(val, tacho->base + TIMER_CTRL_REG); -+ writel_relaxed(0x2faf07f, tacho->base + TIMER_CMP_VALUE_LOW_REG); -+ } else { -+ val = (TIMER_CTRL_TACHO_EN_SHIFT | -+ TIMER_CTRL_CNT_EN_SHIFT | -+ (tacho->edge_mode << TIMER_CTRL_TACHO_MODE_SHIFT) | -+ (tacho->debounce << TIMER_CTRL_ANTI_JITTER_SHIFT) | -+ TIMER_CTRL_CAPTURE_EN_SHIFT | -+ (0x7f << TIMER_CTRL_CAPTURE_CNT_SHIFT) | -+ (tacho->work_mode << TIMER_CTRL_MODE_SHIFT)), -+ writel_relaxed(val, tacho->base + TIMER_CTRL_REG); -+ writel_relaxed(0x20, tacho->base + TIMER_INT_MASK_REG); -+ } -+} -+ -+static int phytium_get_fan_tach_rpm(struct phytium_tacho *priv) -+{ -+ u64 raw_data, tach_div, clk_source; -+ u8 mode, both; -+ unsigned long timeout; -+ unsigned long loopcounter; -+ -+ timeout = jiffies + msecs_to_jiffies(500); -+ -+ for (loopcounter = 0;; loopcounter++) { -+ raw_data = readl_relaxed(priv->base + TIMER_TACHO_RES_REG); -+ -+ if (raw_data & TIMER_TACHO_RES_VALID_SHIFT) -+ break; -+ -+ if (time_after(jiffies, timeout)) -+ return -ETIMEDOUT; -+ -+ if (loopcounter > 3000) -+ msleep(20); -+ else { -+ udelay(100); -+ cond_resched(); -+ } -+ } -+ -+ raw_data = raw_data & TIMER_TACHO_RES_MASK; -+ clk_source = priv->freq; -+ mode = priv->edge_mode; -+ both = (mode == double_edge) ? 1 : 0; -+ tach_div = 1 << both; -+ -+ if (raw_data == 0) -+ return 0; -+ -+ return (clk_source * 60 * raw_data) / 0x2faf080 / tach_div; -+} -+ -+static ssize_t show_rpm(struct device *dev, struct device_attribute *attr, -+ char *buf) -+{ -+ int rpm; -+ struct phytium_tacho *priv = dev_get_drvdata(dev); -+ -+ rpm = phytium_get_fan_tach_rpm(priv); -+ if (rpm < 0) -+ return rpm; -+ -+ return sprintf(buf, "%d\n", rpm); -+} -+ -+static SENSOR_DEVICE_ATTR(fan_input, 0444, -+ show_rpm, NULL, 0); -+ -+static struct attribute *tacho_dev_attrs[] = { -+ &sensor_dev_attr_fan_input.dev_attr.attr, -+ NULL -+}; -+ -+static umode_t tacho_dev_is_visible(struct kobject *kobj, -+ struct attribute *a, int index) -+{ -+ return a->mode; -+} -+ -+static const struct attribute_group tacho_group = { -+ .attrs = tacho_dev_attrs, -+ .is_visible = tacho_dev_is_visible, -+}; -+ -+static const struct attribute_group *tacho_groups[] = { -+ &tacho_group, -+ NULL -+}; -+ -+static irqreturn_t capture_irq_handler(int irq, void *dev_id) -+{ -+ struct phytium_tacho *priv = dev_id; -+ u32 status = readl_relaxed(priv->base + TIMER_INT_STAT_REG); -+ -+ if (status & TIMER_INT_CAPTURE_SHIFT) { -+ capture_count++; -+ -+ if (capture_count == 0) -+ dev_err(priv->dev, "Capture counter is overflowed"); -+ -+ writel_relaxed(status, priv->base + TIMER_INT_STAT_REG); -+ return IRQ_HANDLED; -+ } -+ return IRQ_NONE; -+} -+ -+static ssize_t show_capture(struct device *dev, struct device_attribute *attr, -+ char *buf) -+{ -+ int cnt; -+ struct phytium_tacho *priv = dev_get_drvdata(dev); -+ -+ cnt = capture_count * 0x7f + readl_relaxed(priv->base + TIMER_CNT_VALUE_LOW_REG); -+ -+ return sprintf(buf, "%d\n", cnt); -+} -+ -+static SENSOR_DEVICE_ATTR(capture_input, 0444, -+ show_capture, NULL, 0); -+ -+static struct attribute *capture_dev_attrs[] = { -+ &sensor_dev_attr_capture_input.dev_attr.attr, -+ NULL -+}; -+ -+static umode_t capture_dev_is_visible(struct kobject *kobj, -+ struct attribute *a, int index) -+{ -+ return a->mode; -+} -+ -+static const struct attribute_group capture_group = { -+ .attrs = capture_dev_attrs, -+ .is_visible = capture_dev_is_visible, -+}; -+ -+static const struct attribute_group *capture_groups[] = { -+ &capture_group, -+ NULL -+}; -+ -+static int phytium_tacho_get_work_mode(struct phytium_tacho *tacho) -+{ -+ struct fwnode_handle *nc = dev_fwnode(tacho->dev); -+ -+ if (fwnode_property_read_bool(nc, "tacho")) -+ return tacho_mode; -+ if (fwnode_property_read_bool(nc, "capture")) -+ return capture_mode; -+ return tacho_mode; -+} -+ -+static int phytium_tacho_get_edge_mode(struct phytium_tacho *tacho) -+{ -+ struct fwnode_handle *nc = dev_fwnode(tacho->dev); -+ -+ if (fwnode_property_read_bool(nc, "up")) -+ return rising_edge; -+ if (fwnode_property_read_bool(nc, "down")) -+ return falling_edge; -+ if (fwnode_property_read_bool(nc, "double")) -+ return double_edge; -+ return rising_edge; -+} -+ -+static int phytium_tacho_get_debounce(struct phytium_tacho *tacho) -+{ -+ u32 value; -+ struct fwnode_handle *nc = dev_fwnode(tacho->dev); -+ -+ if (!fwnode_property_read_u32(nc, "debounce-level", &value)) -+ return value; -+ else -+ return 0; -+} -+ -+static void phytium_tacho_get_of_data(struct phytium_tacho *tacho) -+{ -+ tacho->work_mode = phytium_tacho_get_work_mode(tacho); -+ tacho->edge_mode = phytium_tacho_get_edge_mode(tacho); -+ tacho->debounce = phytium_tacho_get_debounce(tacho); -+} -+ -+static int phytium_tacho_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct resource *res; -+ struct phytium_tacho *tacho; -+ int ret; -+ -+ tacho = devm_kzalloc(dev, sizeof(*tacho), GFP_KERNEL); -+ if (!tacho) -+ return -ENOMEM; -+ -+ tacho->dev = &pdev->dev; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ if (!res) -+ return -ENOENT; -+ -+ tacho->base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(tacho->base)) { -+ dev_err(&pdev->dev, "region map failed\n"); -+ return PTR_ERR(tacho->base); -+ } -+ if (dev->of_node) { -+ tacho->clk = devm_clk_get(&pdev->dev, NULL); -+ if (IS_ERR(tacho->clk)) -+ return PTR_ERR(tacho->clk); -+ ret = clk_prepare_enable(tacho->clk); -+ if (ret) -+ return ret; -+ -+ tacho->freq = clk_get_rate(tacho->clk); -+ } else if (has_acpi_companion(dev)){ -+ if(fwnode_property_read_u32(dev_fwnode(dev),"clock-frequency", (u32 *)&(tacho->freq) ) <0) -+ tacho->freq = 50000000; -+ } -+ -+ tacho->irq = platform_get_irq(pdev, 0); -+ if (tacho->irq < 0) { -+ dev_err(&pdev->dev, "no irq resource?\n"); -+ return tacho->irq; -+ } -+ -+ ret = devm_request_irq(dev, tacho->irq, capture_irq_handler, -+ 0, "phytium_tacho", tacho); -+ if (ret) { -+ dev_err(&pdev->dev, "Cannot request IRQ\n"); -+ return ret; -+ } -+ -+ phytium_tacho_get_of_data(tacho); -+ -+ phytium_tacho_init(tacho); -+ -+ if (tacho->work_mode == tacho_mode) -+ tacho->hwmon = devm_hwmon_device_register_with_groups(dev, -+ "phytium_tacho", -+ tacho, tacho_groups); -+ else -+ tacho->hwmon = devm_hwmon_device_register_with_groups(dev, -+ "phytium_capture", -+ tacho, capture_groups); -+ -+ platform_set_drvdata(pdev, tacho); -+ -+ return PTR_ERR_OR_ZERO(tacho->hwmon); -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_tacho_suspend(struct device *dev) -+{ -+ return 0; -+} -+ -+static int phytium_tacho_resume(struct device *dev) -+{ -+ struct phytium_tacho *tacho = dev_get_drvdata(dev); -+ -+ phytium_tacho_init(tacho); -+ -+ return 0; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_tacho_pm, phytium_tacho_suspend, phytium_tacho_resume); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_tacho_acpi_ids[] = { -+ { "PHYT0033", 0 }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_tacho_acpi_ids); -+#endif -+ -+static const struct of_device_id tacho_of_match[] = { -+ { .compatible = "phytium,tacho", }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, tacho_of_match); -+ -+static struct platform_driver phytium_tacho_driver = { -+ .probe = phytium_tacho_probe, -+ .driver = { -+ .name = "phytium_tacho", -+ .pm = &phytium_tacho_pm, -+ .of_match_table = of_match_ptr(tacho_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_tacho_acpi_ids), -+ }, -+}; -+ -+module_platform_driver(phytium_tacho_driver); -+ -+MODULE_AUTHOR("Zhang Yiqun "); -+MODULE_DESCRIPTION("Phytium tachometer driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/hwspinlock/Kconfig b/drivers/hwspinlock/Kconfig -index 32cd26352..da1f879f5 100644 ---- a/drivers/hwspinlock/Kconfig -+++ b/drivers/hwspinlock/Kconfig -@@ -65,4 +65,13 @@ config HSEM_U8500 - - If unsure, say N. - -+config HWSPINLOCK_PHYTIUM -+ tristate "Phytium Hardware Spinlock device" -+ depends on HWSPINLOCK -+ depends on ARCH_PHYTIUM -+ help -+ Say y here to support the Phytium Hardware Spinlock device. -+ -+ If unsure, say N. -+ - endif # HWSPINLOCK -diff --git a/drivers/hwspinlock/Makefile b/drivers/hwspinlock/Makefile -index ed053e3f0..530aa6363 100644 ---- a/drivers/hwspinlock/Makefile -+++ b/drivers/hwspinlock/Makefile -@@ -10,3 +10,5 @@ obj-$(CONFIG_HWSPINLOCK_SIRF) += sirf_hwspinlock.o - obj-$(CONFIG_HWSPINLOCK_SPRD) += sprd_hwspinlock.o - obj-$(CONFIG_HWSPINLOCK_STM32) += stm32_hwspinlock.o - obj-$(CONFIG_HSEM_U8500) += u8500_hsem.o -+ -+obj-$(CONFIG_HWSPINLOCK_PHYTIUM) += phytium_hwspinlock.o -\ No newline at end of file -diff --git a/drivers/hwspinlock/phytium_hwspinlock.c b/drivers/hwspinlock/phytium_hwspinlock.c -new file mode 100644 -index 000000000..e3af7347e ---- /dev/null -+++ b/drivers/hwspinlock/phytium_hwspinlock.c -@@ -0,0 +1,223 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium hardware spinlock driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "hwspinlock_internal.h" -+ -+/* Spinlock register offsets */ -+#define LOCK_BASE 0x10 -+ -+#define SEMA_NOTTAKEN (0) /* free */ -+#define SEMA_TAKEN (1) /* locked */ -+ -+static int phytium_hwspinlock_trylock(struct hwspinlock *lock) -+{ -+ void __iomem *lock_addr = lock->priv; -+ -+ /* attempt to acquire the lock by reading its value */ -+ return (readl(lock_addr) == SEMA_NOTTAKEN); -+} -+ -+static void phytium_hwspinlock_unlock(struct hwspinlock *lock) -+{ -+ void __iomem *lock_addr = lock->priv; -+ -+ /* release the lock by writing 0 to it */ -+ writel(SEMA_NOTTAKEN, lock_addr); -+} -+ -+static void phytium_hwspinlock_relax(struct hwspinlock *lock) -+{ -+ ndelay(50); -+} -+ -+static const struct hwspinlock_ops phytium_hwspinlock_ops = { -+ .trylock = phytium_hwspinlock_trylock, -+ .unlock = phytium_hwspinlock_unlock, -+ .relax = phytium_hwspinlock_relax, -+}; -+ -+static ssize_t phytium_hwlock_test_store(struct device *dev, -+ struct device_attribute *attr, const char *buf, size_t count) -+{ -+ struct hwspinlock *hwlock = NULL; -+ int ret; -+ -+ /* dynamically assign a hwspinlock */ -+ hwlock = hwspin_lock_request(); -+ if (!hwlock) { -+ pr_err("%s can't request hwlock\n", __func__); -+ return -ENODEV; -+ } -+ ret = hwspin_lock_timeout(hwlock, 1000); -+ if (ret < 0) { -+ pr_err("do lock fail\n"); -+ goto err; -+ } -+ pr_info("do lock success\n"); -+ -+ ret = hwspin_trylock(hwlock); -+ if (ret == -EINVAL) { -+ pr_err("lock invalid\n"); -+ goto err; -+ } -+ else -+ pr_info("lock status is %s before, than unlock it\n", ret ? "locked" : "no use"); -+ -+ pr_info("do lock test pass\n"); -+err: -+ hwspin_unlock(hwlock); -+ hwspin_lock_free(hwlock); -+ return count; -+} -+ -+static DEVICE_ATTR_WO(phytium_hwlock_test); -+ -+ -+static int phytium_hwspinlock_probe(struct platform_device *pdev) -+{ -+ struct fwnode_handle *np = dev_fwnode(&(pdev->dev)); -+ struct hwspinlock_device *bank; -+ struct hwspinlock *hwlock; -+ struct resource *res; -+ void __iomem *io_base; -+ int num_locks, i, ret; -+ -+ if (!np) -+ return -ENODEV; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ if (!res) -+ return -ENODEV; -+ -+ io_base = ioremap(res->start, resource_size(res)); -+ if (!io_base) -+ return -ENOMEM; -+ -+ /* -+ * make sure the module is enabled and clocked before reading -+ * the module SYSSTATUS register -+ */ -+ pm_runtime_enable(&pdev->dev); -+ ret = pm_runtime_get_sync(&pdev->dev); -+ if (ret < 0) { -+ pm_runtime_put_noidle(&pdev->dev); -+ goto iounmap_base; -+ } -+ -+ /* Determine number of locks */ -+ if (fwnode_property_read_u32(np, "nr-locks", &num_locks)) { -+ dev_err(&pdev->dev, "missing/invalid number of locks\n"); -+ ret = -EINVAL; -+ goto iounmap_base; -+ } -+ -+ /* -+ * runtime PM will make sure the clock of this module is -+ * enabled again iff at least one lock is requested -+ */ -+ ret = pm_runtime_put(&pdev->dev); -+ if (ret < 0) -+ goto iounmap_base; -+ -+ bank = kzalloc(struct_size(bank, lock, num_locks), GFP_KERNEL); -+ if (!bank) { -+ ret = -ENOMEM; -+ goto iounmap_base; -+ } -+ -+ platform_set_drvdata(pdev, bank); -+ -+ for (i = 0, hwlock = &bank->lock[0]; i < num_locks; i++, hwlock++) { -+ /* Set register address of each lock */ -+ hwlock->priv = io_base + LOCK_BASE + sizeof(u32) * i; -+ } -+ -+ ret = hwspin_lock_register(bank, &pdev->dev, &phytium_hwspinlock_ops, -+ 0, num_locks); -+ if (ret) -+ goto reg_fail; -+ -+ ret = device_create_file(&pdev->dev, &dev_attr_phytium_hwlock_test); -+ return ret; -+reg_fail: -+ kfree(bank); -+iounmap_base: -+ iounmap(io_base); -+ return ret; -+} -+ -+static int phytium_hwspinlock_remove(struct platform_device *pdev) -+{ -+ struct hwspinlock_device *bank = platform_get_drvdata(pdev); -+ void __iomem *io_base = bank->lock[0].priv - LOCK_BASE; -+ int ret; -+ -+ ret = hwspin_lock_unregister(bank); -+ if (ret) { -+ dev_err(&pdev->dev, "%s failed: %d\n", __func__, ret); -+ return ret; -+ } -+ -+ iounmap(io_base); -+ kfree(bank); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_hwspinlock_acpi_ids[] = { -+ { "PHYT0027", 0 }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_hwspinlock_acpi_ids); -+#endif -+ -+static const struct of_device_id phytium_hwspinlock_of_match[] = { -+ { .compatible = "phytium,hwspinlock", }, -+ { /* end */ }, -+}; -+MODULE_DEVICE_TABLE(of, phytium_hwspinlock_of_match); -+ -+static struct platform_driver phytium_hwspinlock_driver = { -+ .probe = phytium_hwspinlock_probe, -+ .remove = phytium_hwspinlock_remove, -+ .driver = { -+ .name = "phytium_hwspinlock", -+ .of_match_table = of_match_ptr(phytium_hwspinlock_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_hwspinlock_acpi_ids), -+ }, -+}; -+ -+static int __init phytium_hwspinlock_init(void) -+{ -+ return platform_driver_register(&phytium_hwspinlock_driver); -+} -+postcore_initcall(phytium_hwspinlock_init); -+ -+static void __exit phytium_hwspinlock_exit(void) -+{ -+ platform_driver_unregister(&phytium_hwspinlock_driver); -+} -+module_exit(phytium_hwspinlock_exit); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Hardware spinlock driver for Phytium"); -+MODULE_AUTHOR("Chen Baozi "); -diff --git a/drivers/i2c/busses/Kconfig b/drivers/i2c/busses/Kconfig -index ea474b16e..c2bdd7b92 100644 ---- a/drivers/i2c/busses/Kconfig -+++ b/drivers/i2c/busses/Kconfig -@@ -1206,6 +1206,34 @@ config I2C_RCAR - This driver can also be built as a module. If so, the module - will be called i2c-rcar. - -+config I2C_PHYTIUM_CORE -+ tristate -+ -+config I2C_PHYTIUM_PCI -+ tristate "Phytium I2C PCI" -+ depends on PCI && ARCH_PHYTIUM -+ select I2C_PHYTIUM_CORE -+ select I2C_SMBUS -+ help -+ If you say yes to this option, support will be included for the -+ Phytium I2C adapter. Only master mode is supported. -+ -+ This driver can also be built as a module. If so, the module -+ will be called i2c-phytium-pci. -+ -+config I2C_PHYTIUM_PLATFORM -+ tristate "Phytium I2C Platform" -+ depends on (ACPI && COMMON_CLK) || !ACPI -+ select I2C_SLAVE -+ select I2C_PHYTIUM_CORE -+ select I2C_SMBUS -+ help -+ If you say yes to this option, support will be included for the -+ Phytium I2C adapter. Only master mode is supported. -+ -+ This driver can also be built as a module. If so, the module -+ will be called i2c-phytium-platform. -+ - comment "External I2C/SMBus adapter drivers" - - config I2C_DIOLAN_U2C -diff --git a/drivers/i2c/busses/Makefile b/drivers/i2c/busses/Makefile -index 683c49fac..78372fb65 100644 ---- a/drivers/i2c/busses/Makefile -+++ b/drivers/i2c/busses/Makefile -@@ -123,6 +123,10 @@ obj-$(CONFIG_I2C_XLR) += i2c-xlr.o - obj-$(CONFIG_I2C_XLP9XX) += i2c-xlp9xx.o - obj-$(CONFIG_I2C_RCAR) += i2c-rcar.o - obj-$(CONFIG_I2C_ZX2967) += i2c-zx2967.o -+obj-$(CONFIG_I2C_PHYTIUM_CORE) += i2c-phytium-core.o -+i2c-phytium-core-objs := i2c-phytium-common.o i2c-phytium-master.o i2c-phytium-slave.o -+obj-$(CONFIG_I2C_PHYTIUM_PCI) += i2c-phytium-pci.o -+obj-$(CONFIG_I2C_PHYTIUM_PLATFORM) += i2c-phytium-platform.o - - # External I2C/SMBus adapter drivers - obj-$(CONFIG_I2C_DIOLAN_U2C) += i2c-diolan-u2c.o -diff --git a/drivers/i2c/busses/i2c-designware-platdrv.c b/drivers/i2c/busses/i2c-designware-platdrv.c -index 474754151..f49a08355 100644 ---- a/drivers/i2c/busses/i2c-designware-platdrv.c -+++ b/drivers/i2c/busses/i2c-designware-platdrv.c -@@ -57,6 +57,7 @@ static const struct acpi_device_id dw_i2c_acpi_match[] = { - { "HISI02A2", 0 }, - { "HISI02A3", 0 }, - { "HYGO0010", ACCESS_INTR_MASK }, -+ { "PHYT0003", 0 }, - { } - }; - MODULE_DEVICE_TABLE(acpi, dw_i2c_acpi_match); -diff --git a/drivers/i2c/busses/i2c-phytium-common.c b/drivers/i2c/busses/i2c-phytium-common.c -new file mode 100644 -index 000000000..d5f1ce246 ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-common.c -@@ -0,0 +1,203 @@ -+// SPDX-License-Identifier: GPL-2.0-or-later -+/* -+ * Phytium I2C adapter driver. -+ * -+ * Based on the TI DAVINCI I2C adapter driver. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "i2c-phytium-core.h" -+ -+static char *abort_sources[] = { -+ [ABRT_7B_ADDR_NOACK] = -+ "slave address not acknowledged (7bit mode)", -+ [ABRT_10ADDR1_NOACK] = -+ "first address byte not acknowledged (10bit mode)", -+ [ABRT_10ADDR2_NOACK] = -+ "second address byte not acknowledged (10bit mode)", -+ [ABRT_TXDATA_NOACK] = -+ "data not acknowledged", -+ [ABRT_GCALL_NOACK] = -+ "no acknowledgment for a general call", -+ [ABRT_GCALL_READ] = -+ "read after general call", -+ [ABRT_SBYTE_ACKDET] = -+ "start byte acknowledged", -+ [ABRT_SBYTE_NORSTRT] = -+ "trying to send start byte when restart is disabled", -+ [ABRT_10B_RD_NORSTRT] = -+ "trying to read when restart is disabled (10bit mode)", -+ [ABRT_MASTER_DIS] = -+ "trying to use disabled adapter", -+ [ARB_LOST] = -+ "lost arbitration", -+ [ABRT_SLAVE_FLUSH_TXFIFO] = -+ "read command so flush old data in the TX FIFO", -+ [ABRT_SLAVE_ARBLOST] = -+ "slave lost the bus while transmitting data to a remote master", -+ [ABRT_SLAVE_RD_INTX] = -+ "incorrect slave-transmitter mode configuration", -+}; -+ -+u32 phytium_readl(struct phytium_i2c_dev *dev, int offset) -+{ -+ return readl_relaxed(dev->base + offset); -+} -+ -+void phytium_writel(struct phytium_i2c_dev *dev, u32 b, int offset) -+{ -+ writel_relaxed(b, dev->base + offset); -+} -+ -+u32 i2c_phytium_scl_hcnt(u32 ic_clk, u32 tSYMBOL, u32 tf, int cond, int offset) -+{ -+ if (cond) -+ return (ic_clk * tSYMBOL + 500000) / 1000000 - 8 + offset; -+ else -+ return (ic_clk * (tSYMBOL + tf) + 500000) / 1000000 - 3 + offset; -+} -+ -+u32 i2c_phytium_scl_lcnt(u32 ic_clk, u32 tLOW, u32 tf, int offset) -+{ -+ return ((ic_clk * (tLOW + tf) + 500000) / 1000000) - 1 + offset; -+} -+ -+int i2c_phytium_set_sda_hold(struct phytium_i2c_dev *dev) -+{ -+ if (!dev->sda_hold_time) { -+ /* Keep previous hold time setting if no one set it */ -+ dev->sda_hold_time = phytium_readl(dev, IC_SDA_HOLD); -+ } -+ -+ if (!(dev->sda_hold_time & IC_SDA_HOLD_RX_MASK)) -+ dev->sda_hold_time |= 1 << IC_SDA_HOLD_RX_SHIFT; -+ -+ dev_dbg(dev->dev, "SDA Hold Time TX:RX = %d:%d\n", -+ dev->sda_hold_time & ~(u32)IC_SDA_HOLD_RX_MASK, -+ dev->sda_hold_time >> IC_SDA_HOLD_RX_SHIFT); -+ -+ return 0; -+} -+ -+void __i2c_phytium_disable(struct phytium_i2c_dev *dev) -+{ -+ int timeout = 100; -+ -+ do { -+ __i2c_phytium_disable_nowait(dev); -+ if ((phytium_readl(dev, IC_ENABLE_STATUS) & 1) == 0) -+ return; -+ -+ /* -+ * Wait 10 times the signaling period of the highest I2C -+ * transfer supported by the driver (for 400KHz this is -+ * 25us). -+ */ -+ usleep_range(25, 250); -+ } while (timeout--); -+ -+ dev_warn(dev->dev, "timeout in disabling adapter\n"); -+} -+ -+unsigned long i2c_phytium_clk_rate(struct phytium_i2c_dev *dev) -+{ -+ if (WARN_ON_ONCE(!dev->get_clk_rate_khz)) -+ return 0; -+ return dev->get_clk_rate_khz(dev); -+} -+ -+int i2c_phytium_prepare_clk(struct phytium_i2c_dev *dev, bool prepare) -+{ -+ if (IS_ERR(dev->clk)) -+ return PTR_ERR(dev->clk); -+ -+ if (prepare) -+ return clk_prepare_enable(dev->clk); -+ -+ clk_disable_unprepare(dev->clk); -+ return 0; -+} -+EXPORT_SYMBOL_GPL(i2c_phytium_prepare_clk); -+ -+int i2c_phytium_wait_bus_not_busy(struct phytium_i2c_dev *dev) -+{ -+ int timeout = 20; /* 20 ms */ -+ -+ while (phytium_readl(dev, IC_STATUS) & IC_STATUS_ACTIVITY) { -+ if (timeout <= 0) { -+ dev_warn(dev->dev, "timeout waiting for bus ready\n"); -+ i2c_recover_bus(&dev->adapter); -+ -+ if (phytium_readl(dev, IC_STATUS) & IC_STATUS_ACTIVITY) -+ return -ETIMEDOUT; -+ return 0; -+ } -+ timeout--; -+ usleep_range(1000, 1100); -+ } -+ -+ return 0; -+} -+ -+int i2c_phytium_handle_tx_abort(struct phytium_i2c_dev *dev) -+{ -+ unsigned long abort_source = dev->abort_source; -+ int i; -+ -+ if (abort_source & IC_TX_ABRT_NOACK) { -+ for_each_set_bit(i, &abort_source, ARRAY_SIZE(abort_sources)) -+ dev_dbg(dev->dev, -+ "%s: %s\n", __func__, abort_sources[i]); -+ return -EREMOTEIO; -+ } -+ -+ for_each_set_bit(i, &abort_source, ARRAY_SIZE(abort_sources)) -+ dev_err(dev->dev, "%s: %s\n", __func__, abort_sources[i]); -+ -+ if (abort_source & IC_TX_ARB_LOST) -+ return -EAGAIN; -+ else if (abort_source & IC_TX_ABRT_GCALL_READ) -+ return -EINVAL; -+ else -+ return -EIO; -+ -+ return 0; -+} -+ -+u32 i2c_phytium_func(struct i2c_adapter *adapter) -+{ -+ struct phytium_i2c_dev *dev = i2c_get_adapdata(adapter); -+ -+ return dev->functionality; -+} -+ -+void i2c_phytium_disable(struct phytium_i2c_dev *dev) -+{ -+ /* Disable controller */ -+ __i2c_phytium_disable(dev); -+ -+ /* Disable all interrupts */ -+ phytium_writel(dev, 0, IC_INTR_MASK); -+ phytium_readl(dev, IC_CLR_INTR); -+} -+ -+void i2c_phytium_disable_int(struct phytium_i2c_dev *dev) -+{ -+ phytium_writel(dev, 0, IC_INTR_MASK); -+} -+ -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_DESCRIPTION("Phytium I2C bus adapter core"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/i2c/busses/i2c-phytium-core.h b/drivers/i2c/busses/i2c-phytium-core.h -new file mode 100644 -index 000000000..726a4f9f4 ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-core.h -@@ -0,0 +1,254 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium I2C adapter driver. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+ -+#define IC_DEFAULT_FUNCTIONALITY (I2C_FUNC_I2C | \ -+ I2C_FUNC_SMBUS_BYTE | \ -+ I2C_FUNC_SMBUS_BYTE_DATA | \ -+ I2C_FUNC_SMBUS_WORD_DATA | \ -+ I2C_FUNC_SMBUS_BLOCK_DATA | \ -+ I2C_FUNC_SMBUS_I2C_BLOCK) -+ -+#define IC_CON_MASTER 0x1 -+#define IC_CON_SPEED_STD 0x2 -+#define IC_CON_SPEED_FAST 0x4 -+#define IC_CON_SPEED_HIGH 0x6 -+#define IC_CON_SPEED_MASK 0x6 -+#define IC_CON_10BITADDR_SLAVE 0x8 -+#define IC_CON_10BITADDR_MASTER 0x10 -+#define IC_CON_RESTART_EN 0x20 -+#define IC_CON_SLAVE_DISABLE 0x40 -+#define IC_CON_STOP_DET_IFADDRESSED 0x80 -+#define IC_CON_TX_EMPTY_CTRL 0x100 -+#define IC_CON_RX_FIFO_FULL_HLD_CTRL 0x200 -+ -+#define IC_CON 0x0 -+#define IC_TAR 0x4 -+#define IC_SAR 0x8 -+#define IC_DATA_CMD 0x10 -+#define IC_SS_SCL_HCNT 0x14 -+#define IC_SS_SCL_LCNT 0x18 -+#define IC_FS_SCL_HCNT 0x1c -+#define IC_FS_SCL_LCNT 0x20 -+#define IC_HS_SCL_HCNT 0x24 -+#define IC_HS_SCL_LCNT 0x28 -+#define IC_INTR_STAT 0x2c -+#define IC_INTR_MASK 0x30 -+#define IC_RAW_INTR_STAT 0x34 -+#define IC_RX_TL 0x38 -+#define IC_TX_TL 0x3c -+#define IC_CLR_INTR 0x40 -+#define IC_CLR_RX_UNDER 0x44 -+#define IC_CLR_RX_OVER 0x48 -+#define IC_CLR_TX_OVER 0x4c -+#define IC_CLR_RD_REQ 0x50 -+#define IC_CLR_TX_ABRT 0x54 -+#define IC_CLR_RX_DONE 0x58 -+#define IC_CLR_ACTIVITY 0x5c -+#define IC_CLR_STOP_DET 0x60 -+#define IC_CLR_START_DET 0x64 -+#define IC_CLR_GEN_CALL 0x68 -+#define IC_ENABLE 0x6c -+#define IC_STATUS 0x70 -+#define IC_TXFLR 0x74 -+#define IC_RXFLR 0x78 -+#define IC_SDA_HOLD 0x7c -+#define IC_TX_ABRT_SOURCE 0x80 -+#define IC_ENABLE_STATUS 0x9c -+#define IC_SMBCLK_LOW_MEXT 0xa8 -+#define IC_SMBCLK_LOW_TIMEOUT 0xac -+#define IC_SMBDAT_STUCK_TIMEOUT 0xb4 -+#define IC_CLR_SMBCLK_EXT_LOW_TIMEOUT 0xbc -+#define IC_CLR_SMBCLK_TMO_LOW_TIMEOUT 0xc0 -+#define IC_CLR_SMBDAT_LOW_TIMEOUT 0xc4 -+#define IC_CLR_SMBALERT_IN_N 0xd0 -+ -+#define IC_INTR_RX_UNDER 0x001 -+#define IC_INTR_RX_OVER 0x002 -+#define IC_INTR_RX_FULL 0x004 -+#define IC_INTR_TX_OVER 0x008 -+#define IC_INTR_TX_EMPTY 0x010 -+#define IC_INTR_RD_REQ 0x020 -+#define IC_INTR_TX_ABRT 0x040 -+#define IC_INTR_RX_DONE 0x080 -+#define IC_INTR_ACTIVITY 0x100 -+#define IC_INTR_STOP_DET 0x200 -+#define IC_INTR_START_DET 0x400 -+#define IC_INTR_GEN_CALL 0x800 -+#define IC_INTR_SMBCLK_EXT_LOW_TIMEOUT 0x1000 -+#define IC_INTR_SMBCLK_TMO_LOW_TIMEOUT 0x2000 -+#define IC_INTR_SMBSDA_LOW_TIMEOUT 0x4000 -+#define IC_INTR_SMBALERT_IN_N 0x20000 -+ -+#define IC_INTR_DEFAULT_MASK (IC_INTR_RX_FULL | \ -+ IC_INTR_TX_ABRT | \ -+ IC_INTR_STOP_DET) -+#define IC_INTR_MASTER_MASK (IC_INTR_DEFAULT_MASK | \ -+ IC_INTR_TX_EMPTY) -+#define IC_INTR_SLAVE_MASK (IC_INTR_DEFAULT_MASK | \ -+ IC_INTR_RX_DONE | \ -+ IC_INTR_RX_UNDER | \ -+ IC_INTR_RD_REQ) -+#define IC_INTR_SMBUS_MASK (IC_INTR_MASTER_MASK | \ -+ IC_INTR_SMBCLK_EXT_LOW_TIMEOUT | \ -+ IC_INTR_SMBCLK_TMO_LOW_TIMEOUT | \ -+ IC_INTR_SMBSDA_LOW_TIMEOUT) -+ -+#define IC_STATUS_ACTIVITY 0x1 -+#define IC_STATUS_TFE BIT(2) -+#define IC_STATUS_MASTER_ACTIVITY BIT(5) -+#define IC_STATUS_SLAVE_ACTIVITY BIT(6) -+ -+#define IC_SDA_HOLD_RX_SHIFT 16 -+#define IC_SDA_HOLD_RX_MASK GENMASK(23, IC_SDA_HOLD_RX_SHIFT) -+ -+#define IC_ERR_TX_ABRT 0x1 -+ -+#define IC_TAR_10BITADDR_MASTER BIT(12) -+ -+#define IC_COMP_PARAM_1_SPEED_MODE_HIGH (BIT(2) | BIT(3)) -+#define IC_COMP_PARAM_1_SPEED_MODE_MASK GENMASK(3, 2) -+ -+#define STATUS_IDLE 0x0 -+#define STATUS_WRITE_IN_PROGRESS 0x1 -+#define STATUS_READ_IN_PROGRESS 0x2 -+ -+/* -+ * operation modes -+ */ -+#define PHYTIUM_IC_MASTER 0 -+#define PHYTIUM_IC_SLAVE 1 -+ -+#define ABRT_7B_ADDR_NOACK 0 -+#define ABRT_10ADDR1_NOACK 1 -+#define ABRT_10ADDR2_NOACK 2 -+#define ABRT_TXDATA_NOACK 3 -+#define ABRT_GCALL_NOACK 4 -+#define ABRT_GCALL_READ 5 -+#define ABRT_SBYTE_ACKDET 7 -+#define ABRT_SBYTE_NORSTRT 9 -+#define ABRT_10B_RD_NORSTRT 10 -+#define ABRT_MASTER_DIS 11 -+#define ARB_LOST 12 -+#define ABRT_SLAVE_FLUSH_TXFIFO 13 -+#define ABRT_SLAVE_ARBLOST 14 -+#define ABRT_SLAVE_RD_INTX 15 -+ -+#define IC_TX_ABRT_7B_ADDR_NOACK (1UL << ABRT_7B_ADDR_NOACK) -+#define IC_TX_ABRT_10ADDR1_NOACK (1UL << ABRT_10ADDR1_NOACK) -+#define IC_TX_ABRT_10ADDR2_NOACK (1UL << ABRT_10ADDR2_NOACK) -+#define IC_TX_ABRT_TXDATA_NOACK (1UL << ABRT_TXDATA_NOACK) -+#define IC_TX_ABRT_GCALL_NOACK (1UL << ABRT_GCALL_NOACK) -+#define IC_TX_ABRT_GCALL_READ (1UL << ABRT_GCALL_READ) -+#define IC_TX_ABRT_SBYTE_ACKDET (1UL << ABRT_SBYTE_ACKDET) -+#define IC_TX_ABRT_SBYTE_NORSTRT (1UL << ABRT_SBYTE_NORSTRT) -+#define IC_TX_ABRT_10B_RD_NORSTRT (1UL << ABRT_10B_RD_NORSTRT) -+#define IC_TX_ABRT_MASTER_DIS (1UL << ABRT_MASTER_DIS) -+#define IC_TX_ARB_LOST (1UL << ARB_LOST) -+#define IC_RX_ABRT_SLAVE_RD_INTX (1UL << ABRT_SLAVE_RD_INTX) -+#define IC_RX_ABRT_SLAVE_ARBLOST (1UL << ABRT_SLAVE_ARBLOST) -+#define IC_RX_ABRT_SLAVE_FLUSH_TXFIFO (1UL << ABRT_SLAVE_FLUSH_TXFIFO) -+ -+#define IC_TX_ABRT_NOACK (IC_TX_ABRT_7B_ADDR_NOACK | \ -+ IC_TX_ABRT_10ADDR1_NOACK | \ -+ IC_TX_ABRT_10ADDR2_NOACK | \ -+ IC_TX_ABRT_TXDATA_NOACK | \ -+ IC_TX_ABRT_GCALL_NOACK) -+#define CONTROLLER_TYPE_IIC 0 -+#define CONTROLLER_TYPE_SMBUS 1 -+ -+struct phytium_i2c_dev { -+ struct device *dev; -+ void __iomem *base; -+ int irq; -+ u32 flags; -+ struct completion cmd_complete; -+ struct clk *clk; -+ struct reset_control *rst; -+ int mode; -+ struct i2c_client *slave; -+ u32 (*get_clk_rate_khz)(struct phytium_i2c_dev *dev); -+ -+ struct i2c_adapter adapter; -+ struct i2c_client *ara; -+ struct i2c_smbus_alert_setup alert_data; -+ -+ struct phytium_pci_i2c *controller; -+ -+ unsigned int status; -+ int cmd_err; -+ u32 abort_source; -+ -+ struct i2c_msg *msgs; -+ int msgs_num; -+ int msg_write_idx; -+ int msg_read_idx; -+ int msg_err; -+ u32 tx_buf_len; -+ u8 *tx_buf; -+ u32 rx_buf_len; -+ u8 *rx_buf; -+ -+ u32 master_cfg; -+ u32 slave_cfg; -+ u32 functionality; -+ unsigned int tx_fifo_depth; -+ unsigned int rx_fifo_depth; -+ int rx_outstanding; -+ -+ struct i2c_timings timings; -+ u32 sda_hold_time; -+ u16 ss_hcnt; -+ u16 ss_lcnt; -+ u16 fs_hcnt; -+ u16 fs_lcnt; -+ u16 fp_hcnt; -+ u16 fp_lcnt; -+ u16 hs_hcnt; -+ u16 hs_lcnt; -+ -+ bool pm_disabled; -+ void (*disable)(struct phytium_i2c_dev *dev); -+ void (*disable_int)(struct phytium_i2c_dev *dev); -+ int (*init)(struct phytium_i2c_dev *dev); -+}; -+ -+#define ACCESS_INTR_MASK 0x00000004 -+ -+#define DEFAULT_CLOCK_FREQUENCY 48000000 -+ -+u32 phytium_readl(struct phytium_i2c_dev *dev, int offset); -+void phytium_writel(struct phytium_i2c_dev *dev, u32 b, int offset); -+unsigned long i2c_phytium_clk_rate(struct phytium_i2c_dev *dev); -+int i2c_phytium_prepare_clk(struct phytium_i2c_dev *dev, bool prepare); -+int i2c_phytium_wait_bus_not_busy(struct phytium_i2c_dev *dev); -+int i2c_phytium_handle_tx_abort(struct phytium_i2c_dev *dev); -+u32 i2c_phytium_func(struct i2c_adapter *adap); -+void i2c_phytium_disable(struct phytium_i2c_dev *dev); -+void i2c_phytium_disable_int(struct phytium_i2c_dev *dev); -+int i2c_phytium_set_sda_hold(struct phytium_i2c_dev *dev); -+u32 i2c_phytium_scl_hcnt(u32 ic_clk, u32 tSYMBOL, u32 tf, int cond, int offset); -+u32 i2c_phytium_scl_lcnt(u32 ic_clk, u32 tLOW, u32 tf, int offset); -+ -+static inline void __i2c_phytium_enable(struct phytium_i2c_dev *dev) -+{ -+ phytium_writel(dev, 1, IC_ENABLE); -+} -+ -+static inline void __i2c_phytium_disable_nowait(struct phytium_i2c_dev *dev) -+{ -+ phytium_writel(dev, 0, IC_ENABLE); -+} -+ -+void __i2c_phytium_disable(struct phytium_i2c_dev *dev); -+ -+extern int i2c_phytium_probe(struct phytium_i2c_dev *dev); -+ -+extern int i2c_phytium_probe_slave(struct phytium_i2c_dev *dev); -diff --git a/drivers/i2c/busses/i2c-phytium-master.c b/drivers/i2c/busses/i2c-phytium-master.c -new file mode 100644 -index 000000000..b478e5a53 ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-master.c -@@ -0,0 +1,578 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium I2C adapter driver. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "i2c-phytium-core.h" -+ -+static int i2c_phytium_init_master(struct phytium_i2c_dev *dev) -+{ -+ /* Disable the adapter */ -+ __i2c_phytium_disable(dev); -+ -+ /* Write standard speed timing parameters */ -+ phytium_writel(dev, dev->ss_hcnt, IC_SS_SCL_HCNT); -+ phytium_writel(dev, dev->ss_lcnt, IC_SS_SCL_LCNT); -+ -+ /* Write fast mode/fast mode plus timing parameters */ -+ phytium_writel(dev, dev->fs_hcnt, IC_FS_SCL_HCNT); -+ phytium_writel(dev, dev->fs_lcnt, IC_FS_SCL_LCNT); -+ -+ /* Write high speed timing parameters if supported */ -+ if (dev->hs_hcnt && dev->hs_hcnt) { -+ phytium_writel(dev, dev->hs_hcnt, IC_HS_SCL_HCNT); -+ phytium_writel(dev, dev->hs_lcnt, IC_HS_SCL_LCNT); -+ } -+ -+ /* Write SDA hold time if supported */ -+ if (dev->sda_hold_time) -+ phytium_writel(dev, dev->sda_hold_time, IC_SDA_HOLD); -+ -+ /* Configure Tx/Rx FIFO threshold levels */ -+ phytium_writel(dev, dev->tx_fifo_depth >> 1, IC_TX_TL); -+ phytium_writel(dev, 0, IC_RX_TL); -+ -+ /* Configure the I2C master */ -+ phytium_writel(dev, dev->master_cfg, IC_CON); -+ -+ return 0; -+} -+ -+static void i2c_phytium_xfer_init(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_msg *msgs = dev->msgs; -+ u32 ic_con, ic_tar = 0; -+ -+ /* Disable the adapter */ -+ __i2c_phytium_disable(dev); -+ -+ /* If the slave address is 10-bit address, enable 10BITADDR */ -+ ic_con = phytium_readl(dev, IC_CON); -+ if (msgs[dev->msg_write_idx].flags & I2C_M_TEN) { -+ ic_con |= IC_CON_10BITADDR_MASTER; -+ ic_tar = IC_TAR_10BITADDR_MASTER; -+ } else { -+ ic_con &= ~IC_CON_10BITADDR_MASTER; -+ } -+ -+ phytium_writel(dev, ic_con, IC_CON); -+ -+ /* -+ * Set the slave (target) address and enable 10-bit addressing mode -+ * if applicable. -+ */ -+ phytium_writel(dev, msgs[dev->msg_write_idx].addr | ic_tar, IC_TAR); -+ -+ /* Enforce disabled interrupts */ -+ i2c_phytium_disable_int(dev); -+ -+ /* Enable the adapter */ -+ __i2c_phytium_enable(dev); -+ -+ /* Dummy read */ -+ phytium_readl(dev, IC_ENABLE_STATUS); -+ -+ /* Clear and enable interrupts */ -+ phytium_readl(dev, IC_CLR_INTR); -+ phytium_writel(dev, IC_INTR_SMBUS_MASK, IC_INTR_MASK); -+} -+ -+static void i2c_phytium_xfer_msg(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_msg *msgs = dev->msgs; -+ u32 intr_mask; -+ int tx_limit, rx_limit; -+ u32 addr = msgs[dev->msg_write_idx].addr; -+ u32 buf_len = dev->tx_buf_len; -+ u8 *buf = dev->tx_buf; -+ bool need_restart = false; -+ -+ intr_mask = IC_INTR_MASTER_MASK; -+ -+ for (; dev->msg_write_idx < dev->msgs_num; dev->msg_write_idx++) { -+ u32 flags = msgs[dev->msg_write_idx].flags; -+ -+ if (msgs[dev->msg_write_idx].addr != addr) { -+ dev_err(dev->dev, -+ "%s: invalid target address\n", __func__); -+ dev->msg_err = -EINVAL; -+ break; -+ } -+ -+ if (!(dev->status & STATUS_WRITE_IN_PROGRESS)) { -+ /* new i2c_msg */ -+ buf = msgs[dev->msg_write_idx].buf; -+ buf_len = msgs[dev->msg_write_idx].len; -+ -+ if ((dev->master_cfg & IC_CON_RESTART_EN) && -+ (dev->msg_write_idx > 0)) -+ need_restart = true; -+ } -+ -+ tx_limit = dev->tx_fifo_depth - phytium_readl(dev, IC_TXFLR); -+ rx_limit = dev->tx_fifo_depth - phytium_readl(dev, IC_RXFLR); -+ -+ while (buf_len > 0 && tx_limit > 0 && rx_limit > 0) { -+ u32 cmd = 0; -+ -+ if (dev->msg_write_idx == dev->msgs_num - 1 && -+ buf_len == 1 && !(flags & I2C_M_RECV_LEN)) -+ cmd |= BIT(9); -+ -+ if (need_restart) { -+ cmd |= BIT(10); -+ need_restart = false; -+ } -+ -+ if (msgs[dev->msg_write_idx].flags & I2C_M_RD) { -+ /* avoid rx buffer overrun */ -+ if (dev->rx_outstanding >= dev->rx_fifo_depth) -+ break; -+ -+ phytium_writel(dev, cmd | 0x100, IC_DATA_CMD); -+ rx_limit--; -+ dev->rx_outstanding++; -+ } else { -+ phytium_writel(dev, cmd | *buf++, IC_DATA_CMD); -+ } -+ tx_limit--; -+ buf_len--; -+ } -+ -+ dev->tx_buf = buf; -+ dev->tx_buf_len = buf_len; -+ -+ /* -+ * Because we don't know the buffer length in the -+ * I2C_FUNC_SMBUS_BLOCK_DATA case, we can't stop -+ * the transaction here. -+ */ -+ if (buf_len > 0 || flags & I2C_M_RECV_LEN) { -+ /* more bytes to be written */ -+ dev->status |= STATUS_WRITE_IN_PROGRESS; -+ break; -+ } -+ -+ dev->status &= ~STATUS_WRITE_IN_PROGRESS; -+ } -+ -+ if (dev->msg_write_idx == dev->msgs_num) -+ intr_mask &= ~IC_INTR_TX_EMPTY; -+ -+ if (dev->msg_err) -+ intr_mask = 0; -+ -+ phytium_writel(dev, intr_mask, IC_INTR_MASK); -+} -+ -+static u8 i2c_phytium_recv_len(struct phytium_i2c_dev *dev, u8 len) -+{ -+ struct i2c_msg *msgs = dev->msgs; -+ u32 flags = msgs[dev->msg_read_idx].flags; -+ -+ /* -+ * Adjust the buffer length and mask the flag -+ * after receiving the first byte. -+ */ -+ len += (flags & I2C_CLIENT_PEC) ? 2 : 1; -+ dev->tx_buf_len = len - min_t(u8, len, dev->rx_outstanding); -+ msgs[dev->msg_read_idx].len = len; -+ msgs[dev->msg_read_idx].flags &= ~I2C_M_RECV_LEN; -+ -+ return len; -+} -+ -+static void i2c_phytium_read(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_msg *msgs = dev->msgs; -+ int rx_valid; -+ -+ for (; dev->msg_read_idx < dev->msgs_num; dev->msg_read_idx++) { -+ u32 len; -+ u8 *buf; -+ -+ if (!(msgs[dev->msg_read_idx].flags & I2C_M_RD)) -+ continue; -+ -+ if (!(dev->status & STATUS_READ_IN_PROGRESS)) { -+ len = msgs[dev->msg_read_idx].len; -+ buf = msgs[dev->msg_read_idx].buf; -+ } else { -+ len = dev->rx_buf_len; -+ buf = dev->rx_buf; -+ } -+ -+ rx_valid = phytium_readl(dev, IC_RXFLR); -+ -+ for (; len > 0 && rx_valid > 0; len--, rx_valid--) { -+ u32 flags = msgs[dev->msg_read_idx].flags; -+ -+ *buf = phytium_readl(dev, IC_DATA_CMD); -+ /* Ensure length byte is a valid value */ -+ if (flags & I2C_M_RECV_LEN && -+ *buf <= I2C_SMBUS_BLOCK_MAX && *buf > 0) { -+ len = i2c_phytium_recv_len(dev, *buf); -+ } -+ buf++; -+ dev->rx_outstanding--; -+ } -+ -+ if (len > 0) { -+ dev->status |= STATUS_READ_IN_PROGRESS; -+ dev->rx_buf_len = len; -+ dev->rx_buf = buf; -+ break; -+ } -+ -+ dev->status &= ~STATUS_READ_IN_PROGRESS; -+ } -+} -+ -+static int i2c_phytium_xfer(struct i2c_adapter *adapter, struct i2c_msg msgs[], int num) -+{ -+ struct phytium_i2c_dev *dev = i2c_get_adapdata(adapter); -+ int ret; -+ -+ dev_dbg(dev->dev, "%s: msgs: %d\n", __func__, num); -+ -+ pm_runtime_get_sync(dev->dev); -+ -+ reinit_completion(&dev->cmd_complete); -+ dev->msgs = msgs; -+ dev->msgs_num = num; -+ dev->cmd_err = 0; -+ dev->msg_write_idx = 0; -+ dev->msg_read_idx = 0; -+ dev->msg_err = 0; -+ dev->status = STATUS_IDLE; -+ dev->abort_source = 0; -+ dev->rx_outstanding = 0; -+ -+ ret = i2c_phytium_wait_bus_not_busy(dev); -+ if (ret < 0) -+ goto done; -+ -+ /* Start the transfers */ -+ i2c_phytium_xfer_init(dev); -+ -+ /* Wait for tx to complete */ -+ if (!wait_for_completion_timeout(&dev->cmd_complete, adapter->timeout)) { -+ dev_err(dev->dev, "controller timed out\n"); -+ i2c_recover_bus(&dev->adapter); -+ i2c_phytium_init_master(dev); -+ ret = -ETIMEDOUT; -+ goto done; -+ } -+ -+ __i2c_phytium_disable_nowait(dev); -+ -+ if (dev->msg_err) { -+ ret = dev->msg_err; -+ goto done; -+ } -+ -+ if (likely(!dev->cmd_err && !dev->status)) { -+ ret = num; -+ goto done; -+ } -+ -+ /* We have got an error */ -+ if (dev->cmd_err == IC_ERR_TX_ABRT) { -+ ret = i2c_phytium_handle_tx_abort(dev); -+ goto done; -+ } -+ -+ if (dev->status) -+ dev_err(dev->dev, "transfer terminated early.\n"); -+ -+ ret = -EIO; -+ -+done: -+ pm_runtime_mark_last_busy(dev->dev); -+ pm_runtime_put_autosuspend(dev->dev); -+ -+ return ret; -+} -+ -+static const struct i2c_algorithm i2c_phytium_algo = { -+ .master_xfer = i2c_phytium_xfer, -+ .functionality = i2c_phytium_func, -+}; -+ -+static const struct i2c_adapter_quirks i2c_phytium_quirks = { -+ .flags = I2C_AQ_NO_ZERO_LEN, -+}; -+ -+static u32 i2c_phytium_read_clear_intrbits(struct phytium_i2c_dev *dev) -+{ -+ u32 stat; -+ -+ stat = phytium_readl(dev, IC_INTR_STAT); -+ -+ if (stat & IC_INTR_RX_UNDER) -+ phytium_readl(dev, IC_CLR_RX_UNDER); -+ if (stat & IC_INTR_RX_OVER) -+ phytium_readl(dev, IC_CLR_RX_OVER); -+ if (stat & IC_INTR_TX_OVER) -+ phytium_readl(dev, IC_CLR_TX_OVER); -+ if (stat & IC_INTR_RD_REQ) -+ phytium_readl(dev, IC_CLR_RD_REQ); -+ if (stat & IC_INTR_TX_ABRT) { -+ dev->abort_source = phytium_readl(dev, IC_TX_ABRT_SOURCE); -+ phytium_readl(dev, IC_CLR_TX_ABRT); -+ } -+ if (stat & IC_INTR_RX_DONE) -+ phytium_readl(dev, IC_CLR_RX_DONE); -+ if (stat & IC_INTR_ACTIVITY) -+ phytium_readl(dev, IC_CLR_ACTIVITY); -+ if (stat & IC_INTR_STOP_DET) -+ phytium_readl(dev, IC_CLR_STOP_DET); -+ if (stat & IC_INTR_START_DET) -+ phytium_readl(dev, IC_CLR_START_DET); -+ if (stat & IC_INTR_GEN_CALL) -+ phytium_readl(dev, IC_CLR_GEN_CALL); -+ if (stat & IC_INTR_SMBCLK_EXT_LOW_TIMEOUT) -+ phytium_readl(dev, IC_CLR_SMBCLK_EXT_LOW_TIMEOUT); -+ if (stat & IC_INTR_SMBCLK_TMO_LOW_TIMEOUT) -+ phytium_readl(dev, IC_CLR_SMBCLK_TMO_LOW_TIMEOUT); -+ if (stat & IC_INTR_SMBSDA_LOW_TIMEOUT) -+ phytium_readl(dev, IC_CLR_SMBDAT_LOW_TIMEOUT); -+ if (stat & IC_INTR_SMBALERT_IN_N) -+ phytium_readl(dev, IC_CLR_SMBALERT_IN_N); -+ -+ return stat; -+} -+ -+static int i2c_phytium_irq_handler_master(struct phytium_i2c_dev *dev) -+{ -+ u32 stat; -+ -+ stat = i2c_phytium_read_clear_intrbits(dev); -+ -+ /* SMBus interrupt */ -+ if (stat & (IC_INTR_SMBCLK_EXT_LOW_TIMEOUT | IC_INTR_SMBCLK_TMO_LOW_TIMEOUT)) { -+ phytium_writel(dev, phytium_readl(dev, IC_ENABLE) & (~BIT(6)), -+ IC_ENABLE); -+ phytium_writel(dev, phytium_readl(dev, IC_ENABLE) | BIT(4), -+ IC_ENABLE); -+ goto abort; -+ } -+ -+ if (stat & IC_INTR_SMBSDA_LOW_TIMEOUT) { -+ phytium_writel(dev, phytium_readl(dev, IC_ENABLE) | BIT(6), -+ IC_ENABLE); -+ goto abort; -+ } -+ -+ if (stat & IC_INTR_SMBALERT_IN_N && dev->ara) -+ i2c_handle_smbus_alert(dev->ara); -+ -+ if (stat & IC_INTR_TX_ABRT) { -+ dev->cmd_err |= IC_ERR_TX_ABRT; -+ dev->status = STATUS_IDLE; -+ -+ /* Anytime TX_ABRT is set, the contents of the tx/rx -+ * buffers are flushed. Make sure to skip them. -+ */ -+ phytium_writel(dev, 0, IC_INTR_MASK); -+ goto abort; -+ } -+ -+ if (stat & IC_INTR_RX_FULL) -+ i2c_phytium_read(dev); -+ -+ if (stat & IC_INTR_TX_EMPTY) -+ i2c_phytium_xfer_msg(dev); -+ -+abort: -+ if ((stat & (IC_INTR_TX_ABRT | IC_INTR_STOP_DET)) || -+ dev->msg_err) -+ complete(&dev->cmd_complete); -+ else if (unlikely(dev->flags & ACCESS_INTR_MASK)) { -+ /* Workaround to trigger pending interrupt */ -+ stat = phytium_readl(dev, IC_INTR_MASK); -+ i2c_phytium_disable_int(dev); -+ phytium_writel(dev, stat, IC_INTR_MASK); -+ } -+ -+ return 0; -+} -+ -+static int i2c_phytium_set_timings_master(struct phytium_i2c_dev *dev) -+{ -+ const char *mode_str, *fp_str = ""; -+ u32 sda_falling_time, scl_falling_time; -+ struct i2c_timings *t = &dev->timings; -+ u32 ic_clk; -+ int ret; -+ -+ /* Set standard and fast speed dividers for high/low periods */ -+ sda_falling_time = t->sda_fall_ns ?: 300; /* ns */ -+ scl_falling_time = t->scl_fall_ns ?: 300; /* ns */ -+ -+ /* Calculate SCL timing parameters for standard mode if not set */ -+ if (!dev->ss_hcnt || !dev->ss_lcnt) { -+ ic_clk = i2c_phytium_clk_rate(dev); -+ dev->ss_hcnt = -+ i2c_phytium_scl_hcnt(ic_clk, -+ 4000, /* tHD;STA = tHIGH = 4.0 us */ -+ sda_falling_time, -+ 0, /* 0: DW default, 1: Ideal */ -+ 0); /* No offset */ -+ dev->ss_lcnt = -+ i2c_phytium_scl_lcnt(ic_clk, -+ 4700, /* tLOW = 4.7 us */ -+ scl_falling_time, -+ 0); /* No offset */ -+ } -+ dev_dbg(dev->dev, "Standard Mode HCNT:LCNT = %d:%d\n", -+ dev->ss_hcnt, dev->ss_lcnt); -+ /* -+ * Set SCL timing parameters for fast mode or fast mode plus. Only -+ * difference is the timing parameter values since the registers are -+ * the same. -+ */ -+ if (t->bus_freq_hz == 1000000) { -+ /* -+ * Check are fast mode plus parameters available and use -+ * fast mode if not. -+ */ -+ if (dev->fp_hcnt && dev->fp_lcnt) { -+ dev->fs_hcnt = dev->fp_hcnt; -+ dev->fs_lcnt = dev->fp_lcnt; -+ fp_str = " Plus"; -+ } -+ } -+ /* -+ * Calculate SCL timing parameters for fast mode if not set. They are -+ * needed also in high speed mode. -+ */ -+ if (!dev->fs_hcnt || !dev->fs_lcnt) { -+ ic_clk = i2c_phytium_clk_rate(dev); -+ dev->fs_hcnt = -+ i2c_phytium_scl_hcnt(ic_clk, -+ 600, /* tHD;STA = tHIGH = 0.6 us */ -+ sda_falling_time, -+ 0, /* 0: DW default, 1: Ideal */ -+ 0); /* No offset */ -+ dev->fs_lcnt = -+ i2c_phytium_scl_lcnt(ic_clk, -+ 1300, /* tLOW = 1.3 us */ -+ scl_falling_time, -+ 0); /* No offset */ -+ } -+ dev_dbg(dev->dev, "Fast Mode%s HCNT:LCNT = %d:%d\n", -+ fp_str, dev->fs_hcnt, dev->fs_lcnt); -+ -+ if (dev->hs_hcnt && dev->hs_lcnt) -+ dev_dbg(dev->dev, "High Speed Mode HCNT:LCNT = %d:%d\n", -+ dev->hs_hcnt, dev->hs_lcnt); -+ -+ ret = i2c_phytium_set_sda_hold(dev); -+ if (ret) -+ goto out; -+ -+ switch (dev->master_cfg & IC_CON_SPEED_MASK) { -+ case IC_CON_SPEED_STD: -+ mode_str = "Standard Mode"; -+ break; -+ case IC_CON_SPEED_HIGH: -+ mode_str = "High Speed Mode"; -+ break; -+ default: -+ mode_str = "Fast Mode"; -+ } -+ dev_dbg(dev->dev, "Bus speed: %s%s\n", mode_str, fp_str); -+ -+out: -+ return ret; -+} -+ -+static irqreturn_t i2c_phytium_isr(int this_irq, void *dev_id) -+{ -+ struct phytium_i2c_dev *dev = dev_id; -+ u32 stat, enabled; -+ -+ enabled = phytium_readl(dev, IC_ENABLE); -+ stat = phytium_readl(dev, IC_RAW_INTR_STAT); -+ if (!enabled || !(stat & ~IC_INTR_ACTIVITY)) -+ return IRQ_NONE; -+ -+ i2c_phytium_irq_handler_master(dev); -+ -+ return IRQ_HANDLED; -+} -+ -+int i2c_phytium_probe(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_adapter *adapter = &dev->adapter; -+ unsigned long irq_flags; -+ int ret; -+ -+ init_completion(&dev->cmd_complete); -+ -+ dev->init = i2c_phytium_init_master; -+ dev->disable = i2c_phytium_disable; -+ dev->disable_int = i2c_phytium_disable_int; -+ -+ ret = i2c_phytium_set_timings_master(dev); -+ if (ret) -+ return ret; -+ -+ ret = dev->init(dev); -+ if (ret) -+ return ret; -+ -+ /* XXX: should be initialized in firmware, remove it in future */ -+#define DEFAULT_TIMEOUT (DEFAULT_CLOCK_FREQUENCY / 1000 * 35) -+ phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBCLK_LOW_MEXT); -+ phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBCLK_LOW_TIMEOUT); -+ phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBDAT_STUCK_TIMEOUT); -+ -+ snprintf(adapter->name, sizeof(adapter->name), "Phytium I2C adapter"); -+ adapter->retries = 3; -+ adapter->algo = &i2c_phytium_algo; -+ adapter->quirks = &i2c_phytium_quirks; -+ adapter->dev.parent = dev->dev; -+ i2c_set_adapdata(adapter, dev); -+ -+ irq_flags = IRQF_SHARED | IRQF_COND_SUSPEND; -+ -+ i2c_phytium_disable_int(dev); -+ ret = devm_request_irq(dev->dev, dev->irq, i2c_phytium_isr, irq_flags, -+ dev_name(dev->dev), dev); -+ if (ret) { -+ dev_err(dev->dev, "failed to request irq %i: %d\n", dev->irq, ret); -+ return ret; -+ } -+ -+ /* -+ * Increment PM usage count during adapter registration in order to -+ * avoid possible spurious runtime suspend when adapter device is -+ * registered to the device core and immediate resume in case bus has -+ * registered I2C slaves that do I2C transfers in their probe. -+ */ -+ pm_runtime_get_noresume(dev->dev); -+ ret = i2c_add_numbered_adapter(adapter); -+ if (ret) -+ dev_err(dev->dev, "fail to add adapter: %d\n", ret); -+ pm_runtime_put_noidle(dev->dev); -+ -+ return ret; -+} -+EXPORT_SYMBOL_GPL(i2c_phytium_probe); -+ -+MODULE_DESCRIPTION("Phytium I2C bus master adapter"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/i2c/busses/i2c-phytium-pci.c b/drivers/i2c/busses/i2c-phytium-pci.c -new file mode 100644 -index 000000000..3ef199b1a ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-pci.c -@@ -0,0 +1,240 @@ -+// SPDX-License-Identifier: GPL-2.0-or-later -+/* -+ * PCI driver for Phytium I2C adapter. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "i2c-phytium-core.h" -+ -+#define DRV_NAME "i2c-phytium-pci" -+ -+enum phytium_pci_ctl_id_t { -+ octopus_i2c, -+}; -+ -+struct scl_sda_cfg { -+ u32 ss_hcnt; -+ u32 fs_hcnt; -+ u32 ss_lcnt; -+ u32 fs_lcnt; -+ u32 sda_hold; -+}; -+ -+struct phytium_pci_i2c { -+ u32 bus_num; -+ u32 bus_cfg; -+ u32 tx_fifo_depth; -+ u32 rx_fifo_depth; -+ u32 clk_khz; -+ u32 functionality; -+ u32 flags; -+ struct scl_sda_cfg *scl_sda_cfg; -+ int (*setup)(struct pci_dev *pdev, struct phytium_pci_i2c *c); -+}; -+ -+/* Octopus HCNT/LCNT/SDA hold time */ -+static struct scl_sda_cfg octopus_config = { -+ .ss_hcnt = 0x190, -+ .ss_lcnt = 0x1d6, -+ .fs_hcnt = 0x3c, -+ .fs_lcnt = 0x82, -+ .sda_hold = 0x0, // XXX -+}; -+ -+static int octopus_setup(struct pci_dev *pdev, struct phytium_pci_i2c *c) -+{ -+ struct phytium_i2c_dev *i2c = pci_get_drvdata(pdev); -+ struct i2c_client *ara; -+ -+ if (pdev->device == 0xdc32) { -+ /* -+ * Since we have already register the adapter, the dev->irq -+ * must be valid. -+ */ -+ i2c->alert_data.irq = i2c->irq; -+ -+ ara = i2c_new_smbus_alert_device(&i2c->adapter, &i2c->alert_data); -+ if (IS_ERR(ara)) -+ return PTR_ERR(ara); -+ -+ i2c->ara = ara; -+ } -+ -+ return 0; -+} -+ -+static struct phytium_pci_i2c pci_ctrl_info[] = { -+ [octopus_i2c] = { -+ .bus_num = -1, -+ .bus_cfg = IC_CON_MASTER | IC_CON_SLAVE_DISABLE | -+ IC_CON_RESTART_EN | IC_CON_SPEED_FAST, -+ .tx_fifo_depth = 7, -+ .rx_fifo_depth = 7, -+ .functionality = I2C_FUNC_10BIT_ADDR, -+ .clk_khz = 48000000, -+ .scl_sda_cfg = &octopus_config, -+ .setup = octopus_setup, -+ }, -+}; -+ -+#ifdef CONFIG_PM -+static int i2c_phytium_pci_suspend(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_i2c_dev *i_dev = pci_get_drvdata(pdev); -+ -+ i_dev->disable(i_dev); -+ -+ return 0; -+} -+ -+static int i2c_phytium_pci_resume(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_i2c_dev *i_dev = pci_get_drvdata(pdev); -+ -+ return i_dev->init(i_dev); -+} -+#endif -+ -+static UNIVERSAL_DEV_PM_OPS(i2c_phytium_pm_ops, i2c_phytium_pci_suspend, -+ i2c_phytium_pci_resume, NULL); -+ -+static u32 i2c_phytium_get_clk_rate_khz(struct phytium_i2c_dev *dev) -+{ -+ return dev->controller->clk_khz; -+} -+ -+static int i2c_phytium_pci_probe(struct pci_dev *pdev, -+ const struct pci_device_id *id) -+{ -+ struct phytium_i2c_dev *dev; -+ struct i2c_adapter *adapter; -+ struct phytium_pci_i2c *controller; -+ struct scl_sda_cfg *cfg; -+ int ret; -+ -+ if (id->driver_data >= ARRAY_SIZE(pci_ctrl_info)) { -+ dev_err(&pdev->dev, "%s: invalid driver data %ld\n", __func__, -+ id->driver_data); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ controller = &pci_ctrl_info[id->driver_data]; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) { -+ dev_err(&pdev->dev, "Failed to enable I2C PCI device (%d)\n", ret); -+ goto out; -+ } -+ -+ ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); -+ if (ret) { -+ dev_err(&pdev->dev, "I/O memory remapping failed\n"); -+ goto out; -+ } -+ -+ dev = devm_kzalloc(&pdev->dev, sizeof(struct phytium_i2c_dev), GFP_KERNEL); -+ if (!dev) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ dev->controller = controller; -+ dev->get_clk_rate_khz = i2c_phytium_get_clk_rate_khz; -+ dev->base = pcim_iomap_table(pdev)[0]; -+ dev->dev = &pdev->dev; -+ dev->irq = pdev->irq; -+ dev->flags |= controller->flags; -+ -+ dev->functionality = controller->functionality | IC_DEFAULT_FUNCTIONALITY; -+ dev->master_cfg = controller->bus_cfg; -+ if (controller->scl_sda_cfg) { -+ cfg = controller->scl_sda_cfg; -+ dev->ss_hcnt = cfg->ss_hcnt; -+ dev->fs_hcnt = cfg->fs_hcnt; -+ dev->ss_lcnt = cfg->ss_lcnt; -+ dev->fs_lcnt = cfg->fs_lcnt; -+ dev->sda_hold_time = cfg->sda_hold; -+ } -+ -+ pci_set_drvdata(pdev, dev); -+ -+ dev->tx_fifo_depth = controller->tx_fifo_depth; -+ dev->rx_fifo_depth = controller->rx_fifo_depth; -+ -+ adapter = &dev->adapter; -+ adapter->owner = THIS_MODULE; -+ adapter->class = 0; -+ ACPI_COMPANION_SET(&adapter->dev, ACPI_COMPANION(&pdev->dev)); -+ adapter->nr = controller->bus_num; -+ -+ ret = i2c_phytium_probe(dev); -+ if (ret) -+ goto out; -+ -+ if (controller->setup) { -+ ret = controller->setup(pdev, controller); -+ if (ret) -+ goto out; -+ } -+ -+ pm_runtime_set_autosuspend_delay(&pdev->dev, 1000); -+ pm_runtime_use_autosuspend(&pdev->dev); -+ pm_runtime_put_autosuspend(&pdev->dev); -+ pm_runtime_allow(&pdev->dev); -+ -+out: -+ return ret; -+} -+ -+static void i2c_phytium_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_i2c_dev *dev = pci_get_drvdata(pdev); -+ -+ dev->disable(dev); -+ pm_runtime_forbid(&pdev->dev); -+ pm_runtime_get_noresume(&pdev->dev); -+ -+ i2c_del_adapter(&dev->adapter); -+} -+ -+static const struct pci_device_id i2_phytium_pci_ids[] = { -+ { PCI_DEVICE(0x1db7, 0xdc32), 0, 0, octopus_i2c }, -+ { PCI_DEVICE(0x1db7, 0xdc30), 0, 0, octopus_i2c }, -+ { } -+}; -+MODULE_DEVICE_TABLE(pci, i2_phytium_pci_ids); -+ -+static struct pci_driver phytium_i2c_driver = { -+ .name = DRV_NAME, -+ .id_table = i2_phytium_pci_ids, -+ .probe = i2c_phytium_pci_probe, -+ .remove = i2c_phytium_pci_remove, -+ .driver = { -+ .pm = &i2c_phytium_pm_ops, -+ }, -+}; -+ -+module_pci_driver(phytium_i2c_driver); -+ -+MODULE_ALIAS("i2c-phytium-pci"); -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_DESCRIPTION("Phytium PCI I2C bus adapter"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/i2c/busses/i2c-phytium-platform.c b/drivers/i2c/busses/i2c-phytium-platform.c -new file mode 100644 -index 000000000..d9160c428 ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-platform.c -@@ -0,0 +1,364 @@ -+// SPDX-License-Identifier: GPL-2.0-or-later -+/* -+ * Phytium I2C adapter driver. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "i2c-phytium-core.h" -+ -+#define DRV_NAME "i2c-phytium-platform" -+ -+static u32 i2c_phytium_get_clk_rate_khz(struct phytium_i2c_dev *dev) -+{ -+ return clk_get_rate(dev->clk)/1000; -+} -+ -+#ifdef CONFIG_ACPI -+static void phytium_i2c_acpi_params(struct platform_device *pdev, char method[], -+ u16 *hcnt, u16 *lcnt, u32 *sda_hold) -+{ -+ struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER }; -+ acpi_handle handle = ACPI_HANDLE(&pdev->dev); -+ union acpi_object *obj; -+ -+ if (ACPI_FAILURE(acpi_evaluate_object(handle, method, NULL, &buf))) -+ return; -+ -+ obj = (union acpi_object *)buf.pointer; -+ if (obj->type == ACPI_TYPE_PACKAGE && obj->package.count == 3) { -+ const union acpi_object *objs = obj->package.elements; -+ -+ *hcnt = (u16)objs[0].integer.value; -+ *lcnt = (u16)objs[1].integer.value; -+ *sda_hold = (u32)objs[2].integer.value; -+ } -+ -+ kfree(buf.pointer); -+} -+ -+static int phytium_i2c_acpi_configure(struct platform_device *pdev) -+{ -+ struct phytium_i2c_dev *dev = platform_get_drvdata(pdev); -+ struct i2c_timings *t = &dev->timings; -+ u32 ss_ht = 0, fp_ht = 0, hs_ht = 0, fs_ht = 0; -+ acpi_handle handle = ACPI_HANDLE(&pdev->dev); -+ const struct acpi_device_id *id; -+ struct acpi_device *adev; -+ -+ dev->adapter.nr = -1; -+ dev->tx_fifo_depth = 32; -+ dev->rx_fifo_depth = 32; -+ -+ /* -+ * Try to get SDA hold time and *CNT values from an ACPI method for -+ * selected speed modes. -+ */ -+ phytium_i2c_acpi_params(pdev, "SSCN", &dev->ss_hcnt, &dev->ss_lcnt, &ss_ht); -+ phytium_i2c_acpi_params(pdev, "FPCN", &dev->fp_hcnt, &dev->fp_lcnt, &fp_ht); -+ phytium_i2c_acpi_params(pdev, "HSCN", &dev->hs_hcnt, &dev->hs_lcnt, &hs_ht); -+ phytium_i2c_acpi_params(pdev, "FMCN", &dev->fs_hcnt, &dev->fs_lcnt, &fs_ht); -+ -+ switch (t->bus_freq_hz) { -+ case 100000: -+ dev->sda_hold_time = ss_ht; -+ break; -+ case 1000000: -+ dev->sda_hold_time = fp_ht; -+ break; -+ case 3400000: -+ dev->sda_hold_time = hs_ht; -+ break; -+ case 400000: -+ default: -+ dev->sda_hold_time = fs_ht; -+ break; -+ } -+ -+ id = acpi_match_device(pdev->dev.driver->acpi_match_table, &pdev->dev); -+ if (id && id->driver_data) -+ dev->flags |= (u32)id->driver_data; -+ -+ if (acpi_bus_get_device(handle, &adev)) -+ return -ENODEV; -+ -+ return 0; -+} -+ -+static const struct acpi_device_id phytium_i2c_acpi_match[] = { -+ { "PHYT0038", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_i2c_acpi_match); -+#else -+static inline int phytium_i2c_acpi_configure(struct platform_device *pdev) -+{ -+ return -ENODEV; -+} -+#endif -+ -+static void i2c_phytium_configure_master(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_timings *t = &dev->timings; -+ -+ dev->functionality = I2C_FUNC_10BIT_ADDR | IC_DEFAULT_FUNCTIONALITY; -+ -+ dev->master_cfg = IC_CON_MASTER | IC_CON_SLAVE_DISABLE | -+ IC_CON_RESTART_EN; -+ -+ dev->mode = PHYTIUM_IC_MASTER; -+ -+ switch (t->bus_freq_hz) { -+ case 100000: -+ dev->master_cfg |= IC_CON_SPEED_STD; -+ break; -+ case 3400000: -+ dev->master_cfg |= IC_CON_SPEED_HIGH; -+ break; -+ default: -+ dev->master_cfg |= IC_CON_SPEED_FAST; -+ } -+} -+ -+static void i2c_phytium_configure_slave(struct phytium_i2c_dev *dev) -+{ -+ dev->functionality = I2C_FUNC_SLAVE | IC_DEFAULT_FUNCTIONALITY; -+ -+ dev->slave_cfg = IC_CON_RX_FIFO_FULL_HLD_CTRL | -+ IC_CON_RESTART_EN | IC_CON_STOP_DET_IFADDRESSED; -+ -+ dev->mode = PHYTIUM_IC_SLAVE; -+} -+ -+static int phytium_i2c_plat_probe(struct platform_device *pdev) -+{ -+ struct i2c_adapter *adap; -+ struct phytium_i2c_dev *dev; -+ struct i2c_timings *t; -+ u32 acpi_speed; -+ struct resource *mem; -+ int irq, ret, i; -+ static const int supported_speeds[] = { -+ 0, 100000, 400000, 1000000, 3400000 -+ }; -+ -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) -+ return irq; -+ -+ dev = devm_kzalloc(&pdev->dev, sizeof(struct phytium_i2c_dev), GFP_KERNEL); -+ if (!dev) -+ return -ENOMEM; -+ -+ mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ dev->base = devm_ioremap_resource(&pdev->dev, mem); -+ if (IS_ERR(dev->base)) -+ return PTR_ERR(dev->base); -+ -+ dev->dev = &pdev->dev; -+ dev->irq = irq; -+ platform_set_drvdata(pdev, dev); -+ -+ dev->rst = devm_reset_control_get_optional_exclusive(&pdev->dev, NULL); -+ if (IS_ERR(dev->rst)) { -+ if (PTR_ERR(dev->rst) == -EPROBE_DEFER) -+ return -EPROBE_DEFER; -+ } else { -+ reset_control_deassert(dev->rst); -+ } -+ -+ t = &dev->timings; -+ i2c_parse_fw_timings(&pdev->dev, t, false); -+ -+ acpi_speed = i2c_acpi_find_bus_speed(&pdev->dev); -+ /* -+ * Some DSTDs use a non standard speed, round down to the lowest -+ * standard speed. -+ */ -+ for (i = 1; i < ARRAY_SIZE(supported_speeds); i++) { -+ if (acpi_speed < supported_speeds[i]) -+ break; -+ } -+ acpi_speed = supported_speeds[i - 1]; -+ -+ /* -+ * Find bus speed from the "clock-frequency" device property, ACPI -+ * or by using fast mode if neither is set. -+ */ -+ if (acpi_speed && t->bus_freq_hz) -+ t->bus_freq_hz = min(t->bus_freq_hz, acpi_speed); -+ else if (acpi_speed || t->bus_freq_hz) -+ t->bus_freq_hz = max(t->bus_freq_hz, acpi_speed); -+ else -+ t->bus_freq_hz = 400000; -+ -+ if (has_acpi_companion(&pdev->dev)) -+ phytium_i2c_acpi_configure(pdev); -+ -+ /* -+ * Only standard mode at 100kHz, fast mode at 400kHz, -+ * fast mode plus at 1MHz and high speed mode at 3.4MHz are supported. -+ */ -+ if (t->bus_freq_hz != 100000 && t->bus_freq_hz != 400000 && -+ t->bus_freq_hz != 1000000 && t->bus_freq_hz != 3400000) { -+ dev_err(&pdev->dev, -+ "%d Hz is unsupported, only 100kHz, 400kHz, 1MHz and 3.4MHz are supported\n", -+ t->bus_freq_hz); -+ ret = -EINVAL; -+ goto exit_reset; -+ } -+ -+ if (i2c_detect_slave_mode(&pdev->dev)) -+ i2c_phytium_configure_slave(dev); -+ else -+ i2c_phytium_configure_master(dev); -+ -+ dev->clk = devm_clk_get(&pdev->dev, NULL); -+ if (!i2c_phytium_prepare_clk(dev, true)) { -+ u64 clk_khz; -+ -+ dev->get_clk_rate_khz = i2c_phytium_get_clk_rate_khz; -+ clk_khz = dev->get_clk_rate_khz(dev); -+ -+ if (!dev->sda_hold_time && t->sda_hold_ns) -+ dev->sda_hold_time = -+ div_u64(clk_khz * t->sda_hold_ns + 500000, 1000000); -+ } -+ -+ dev->tx_fifo_depth = 7; -+ dev->rx_fifo_depth = 7; -+ dev->adapter.nr = pdev->id; -+ -+ adap = &dev->adapter; -+ adap->owner = THIS_MODULE; -+ adap->class = I2C_CLASS_DEPRECATED; -+ ACPI_COMPANION_SET(&adap->dev, ACPI_COMPANION(&pdev->dev)); -+ adap->dev.of_node = pdev->dev.of_node; -+ -+ dev_pm_set_driver_flags(&pdev->dev, -+ DPM_FLAG_SMART_PREPARE | -+ DPM_FLAG_SMART_SUSPEND | -+ DPM_FLAG_MAY_SKIP_RESUME); -+ -+ /* The code below assumes runtime PM to be disabled. */ -+ WARN_ON(pm_runtime_enabled(&pdev->dev)); -+ -+ pm_runtime_set_autosuspend_delay(&pdev->dev, 1000); -+ pm_runtime_use_autosuspend(&pdev->dev); -+ pm_runtime_set_active(&pdev->dev); -+ -+ pm_runtime_enable(&pdev->dev); -+ -+ if (dev->mode == PHYTIUM_IC_SLAVE) -+ ret = i2c_phytium_probe_slave(dev); -+ else -+ ret = i2c_phytium_probe(dev); -+ -+ if (ret) -+ goto exit_probe; -+ -+ return ret; -+ -+exit_probe: -+ pm_runtime_disable(dev->dev); -+exit_reset: -+ if (!IS_ERR_OR_NULL(dev->rst)) -+ reset_control_assert(dev->rst); -+ return ret; -+} -+ -+static int phytium_i2c_plat_remove(struct platform_device *pdev) -+{ -+ struct phytium_i2c_dev *dev = platform_get_drvdata(pdev); -+ -+ pm_runtime_get_sync(&pdev->dev); -+ -+ i2c_del_adapter(&dev->adapter); -+ -+ dev->disable(dev); -+ -+ pm_runtime_dont_use_autosuspend(&pdev->dev); -+ pm_runtime_put_sync(&pdev->dev); -+ pm_runtime_disable(dev->dev); -+ -+ if (!IS_ERR_OR_NULL(dev->rst)) -+ reset_control_assert(dev->rst); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_OF -+static const struct of_device_id phytium_i2c_of_match[] = { -+ { .compatible = "phytium,i2c", }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, phytium_i2c_of_match); -+#endif -+ -+static int __maybe_unused phytium_i2c_plat_suspend(struct device *dev) -+{ -+ struct phytium_i2c_dev *idev = dev_get_drvdata(dev); -+ -+ idev->disable(idev); -+ i2c_phytium_prepare_clk(idev, false); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_i2c_plat_resume(struct device *dev) -+{ -+ struct phytium_i2c_dev *idev = dev_get_drvdata(dev); -+ -+ i2c_phytium_prepare_clk(idev, true); -+ -+ idev->init(idev); -+ -+ return 0; -+} -+ -+static const struct dev_pm_ops phytium_i2c_dev_pm_ops = { -+ SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_i2c_plat_suspend, -+ phytium_i2c_plat_resume) -+ SET_RUNTIME_PM_OPS(phytium_i2c_plat_suspend, -+ phytium_i2c_plat_resume, NULL) -+}; -+ -+static struct platform_driver phytium_i2c_driver = { -+ .probe = phytium_i2c_plat_probe, -+ .remove = phytium_i2c_plat_remove, -+ .driver = { -+ .name = DRV_NAME, -+ .of_match_table = of_match_ptr(phytium_i2c_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_i2c_acpi_match), -+ .pm = &phytium_i2c_dev_pm_ops, -+ }, -+}; -+module_platform_driver(phytium_i2c_driver); -+ -+MODULE_ALIAS("platform:i2c-phytium"); -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium I2C bus adapter"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/i2c/busses/i2c-phytium-slave.c b/drivers/i2c/busses/i2c-phytium-slave.c -new file mode 100644 -index 000000000..e6d25ca1b ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-slave.c -@@ -0,0 +1,262 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium I2C adapter driver (slave only). -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "i2c-phytium-core.h" -+ -+static void i2c_phytium_configure_fifo_slave(struct phytium_i2c_dev *dev) -+{ -+ /* Configure Tx/Rx FIFO threshold levels. */ -+ phytium_writel(dev, 0, IC_TX_TL); -+ phytium_writel(dev, 0, IC_RX_TL); -+ -+ /* Configure the I2C slave. */ -+ phytium_writel(dev, dev->slave_cfg, IC_CON); -+ phytium_writel(dev, IC_INTR_SLAVE_MASK, IC_INTR_MASK); -+} -+ -+static int i2c_phytium_init_slave(struct phytium_i2c_dev *dev) -+{ -+ /* Disable the adapter. */ -+ __i2c_phytium_disable(dev); -+ -+ /* Write SDA hold time if supported */ -+ if (dev->sda_hold_time) -+ phytium_writel(dev, dev->sda_hold_time, IC_SDA_HOLD); -+ -+ i2c_phytium_configure_fifo_slave(dev); -+ -+ return 0; -+} -+ -+static int i2c_phytium_reg_slave(struct i2c_client *slave) -+{ -+ struct phytium_i2c_dev *dev = i2c_get_adapdata(slave->adapter); -+ -+ if (dev->slave) -+ return -EBUSY; -+ if (slave->flags & I2C_CLIENT_TEN) -+ return -EAFNOSUPPORT; -+ pm_runtime_get_sync(dev->dev); -+ -+ /* -+ * Set slave address in the IC_SAR register, -+ * the address to which the i2c responds. -+ */ -+ __i2c_phytium_disable_nowait(dev); -+ phytium_writel(dev, slave->addr, IC_SAR); -+ dev->slave = slave; -+ -+ __i2c_phytium_enable(dev); -+ -+ dev->cmd_err = 0; -+ dev->msg_write_idx = 0; -+ dev->msg_read_idx = 0; -+ dev->msg_err = 0; -+ dev->status = STATUS_IDLE; -+ dev->abort_source = 0; -+ dev->rx_outstanding = 0; -+ -+ return 0; -+} -+ -+static int i2c_phytium_unreg_slave(struct i2c_client *slave) -+{ -+ struct phytium_i2c_dev *dev = i2c_get_adapdata(slave->adapter); -+ -+ dev->disable_int(dev); -+ dev->disable(dev); -+ dev->slave = NULL; -+ pm_runtime_put(dev->dev); -+ -+ return 0; -+} -+ -+static u32 i2c_phytium_read_clear_intrbits_slave(struct phytium_i2c_dev *dev) -+{ -+ u32 stat; -+ -+ /* -+ * The IC_INTR_STAT register just indicates "enabled" interrupts. -+ * Ths unmasked raw version of interrupt status bits are available -+ * in the IC_RAW_INTR_STAT register. -+ * -+ * That is, -+ * stat = phytium_readl(IC_INTR_STAT); -+ * equals to, -+ * stat = phytium_readl(IC_RAW_INTR_STAT) & phytium_readl(IC_INTR_MASK); -+ * -+ * The raw version might be useful for debugging purposes. -+ */ -+ stat = phytium_readl(dev, IC_INTR_STAT); -+ -+ /* -+ * Do not use the IC_CLR_INTR register to clear interrupts, or -+ * you'll miss some interrupts, triggered during the period from -+ * phytium_readl(IC_INTR_STAT) to phytium_readl(IC_CLR_INTR). -+ * -+ * Instead, use the separately-prepared IC_CLR_* registers. -+ */ -+ if (stat & IC_INTR_TX_ABRT) -+ phytium_readl(dev, IC_CLR_TX_ABRT); -+ if (stat & IC_INTR_RX_UNDER) -+ phytium_readl(dev, IC_CLR_RX_UNDER); -+ if (stat & IC_INTR_RX_OVER) -+ phytium_readl(dev, IC_CLR_RX_OVER); -+ if (stat & IC_INTR_TX_OVER) -+ phytium_readl(dev, IC_CLR_TX_OVER); -+ if (stat & IC_INTR_RX_DONE) -+ phytium_readl(dev, IC_CLR_RX_DONE); -+ if (stat & IC_INTR_ACTIVITY) -+ phytium_readl(dev, IC_CLR_ACTIVITY); -+ if (stat & IC_INTR_STOP_DET) -+ phytium_readl(dev, IC_CLR_STOP_DET); -+ if (stat & IC_INTR_START_DET) -+ phytium_readl(dev, IC_CLR_START_DET); -+ if (stat & IC_INTR_GEN_CALL) -+ phytium_readl(dev, IC_CLR_GEN_CALL); -+ -+ return stat; -+} -+ -+/* -+ * Interrupt service routine. This gets called whenever an I2C slave interrupt -+ * occurs. -+ */ -+static int i2c_phytium_irq_handler_slave(struct phytium_i2c_dev *dev) -+{ -+ u32 raw_stat, stat, enabled; -+ u8 val, slave_activity; -+ -+ stat = phytium_readl(dev, IC_INTR_STAT); -+ enabled = phytium_readl(dev, IC_ENABLE); -+ raw_stat = phytium_readl(dev, IC_RAW_INTR_STAT); -+ slave_activity = ((phytium_readl(dev, IC_STATUS) & -+ IC_STATUS_SLAVE_ACTIVITY) >> 6); -+ -+ if (!enabled || !(raw_stat & ~IC_INTR_ACTIVITY) || !dev->slave) -+ return 0; -+ -+ dev_dbg(dev->dev, -+ "%#x STATUS SLAVE_ACTIVITY=%#x : RAW_INTR_STAT=%#x : INTR_STAT=%#x\n", -+ enabled, slave_activity, raw_stat, stat); -+ -+ if ((stat & IC_INTR_RX_FULL) && (stat & IC_INTR_STOP_DET)) -+ i2c_slave_event(dev->slave, I2C_SLAVE_WRITE_REQUESTED, &val); -+ -+ if (stat & IC_INTR_RD_REQ) { -+ if (slave_activity) { -+ if (stat & IC_INTR_RX_FULL) { -+ val = phytium_readl(dev, IC_DATA_CMD); -+ -+ if (!i2c_slave_event(dev->slave, -+ I2C_SLAVE_WRITE_RECEIVED, -+ &val)) { -+ dev_vdbg(dev->dev, "Byte %X acked!", -+ val); -+ } -+ phytium_readl(dev, IC_CLR_RD_REQ); -+ stat = i2c_phytium_read_clear_intrbits_slave(dev); -+ } else { -+ phytium_readl(dev, IC_CLR_RD_REQ); -+ phytium_readl(dev, IC_CLR_RX_UNDER); -+ stat = i2c_phytium_read_clear_intrbits_slave(dev); -+ } -+ if (!i2c_slave_event(dev->slave, -+ I2C_SLAVE_READ_REQUESTED, -+ &val)) -+ phytium_writel(dev, val, IC_DATA_CMD); -+ } -+ } -+ -+ if (stat & IC_INTR_RX_DONE) { -+ if (!i2c_slave_event(dev->slave, I2C_SLAVE_READ_PROCESSED, -+ &val)) -+ phytium_readl(dev, IC_CLR_RX_DONE); -+ -+ i2c_slave_event(dev->slave, I2C_SLAVE_STOP, &val); -+ stat = i2c_phytium_read_clear_intrbits_slave(dev); -+ return 1; -+ } -+ -+ if (stat & IC_INTR_RX_FULL) { -+ val = phytium_readl(dev, IC_DATA_CMD); -+ if (!i2c_slave_event(dev->slave, I2C_SLAVE_WRITE_RECEIVED, -+ &val)) -+ dev_vdbg(dev->dev, "Byte %X acked!", val); -+ } else { -+ i2c_slave_event(dev->slave, I2C_SLAVE_STOP, &val); -+ stat = i2c_phytium_read_clear_intrbits_slave(dev); -+ } -+ -+ return 1; -+} -+ -+static irqreturn_t i2c_phytium_isr_slave(int this_irq, void *dev_id) -+{ -+ struct phytium_i2c_dev *dev = dev_id; -+ int ret; -+ -+ i2c_phytium_read_clear_intrbits_slave(dev); -+ ret = i2c_phytium_irq_handler_slave(dev); -+ if (ret > 0) -+ complete(&dev->cmd_complete); -+ -+ return IRQ_RETVAL(ret); -+} -+ -+static const struct i2c_algorithm i2c_phytium_algo = { -+ .functionality = i2c_phytium_func, -+ .reg_slave = i2c_phytium_reg_slave, -+ .unreg_slave = i2c_phytium_unreg_slave, -+}; -+ -+int i2c_phytium_probe_slave(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_adapter *adap = &dev->adapter; -+ int ret; -+ -+ init_completion(&dev->cmd_complete); -+ -+ dev->init = i2c_phytium_init_slave; -+ dev->disable = i2c_phytium_disable; -+ dev->disable_int = i2c_phytium_disable_int; -+ -+ ret = dev->init(dev); -+ if (ret) -+ return ret; -+ -+ snprintf(adap->name, sizeof(adap->name), -+ "Phytium I2C Slave adapter"); -+ adap->retries = 3; -+ adap->algo = &i2c_phytium_algo; -+ adap->dev.parent = dev->dev; -+ i2c_set_adapdata(adap, dev); -+ -+ ret = devm_request_irq(dev->dev, dev->irq, i2c_phytium_isr_slave, -+ IRQF_SHARED, dev_name(dev->dev), dev); -+ if (ret) { -+ dev_err(dev->dev, "failure requesting irq %i: %d\n", -+ dev->irq, ret); -+ return ret; -+ } -+ -+ ret = i2c_add_numbered_adapter(adap); -+ if (ret) -+ dev_err(dev->dev, "failure adding adapter: %d\n", ret); -+ -+ return ret; -+} -+EXPORT_SYMBOL_GPL(i2c_phytium_probe_slave); -diff --git a/drivers/iio/adc/Kconfig b/drivers/iio/adc/Kconfig -index e39b67912..c08a8421c 100644 ---- a/drivers/iio/adc/Kconfig -+++ b/drivers/iio/adc/Kconfig -@@ -1226,4 +1226,16 @@ config XILINX_XADC - The driver can also be build as a module. If so, the module will be called - xilinx-xadc. - -+config PHYTIUM_ADC -+ tristate "Phytium ADC driver" -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ select IIO_BUFFER -+ select IIO_TRIGGERED_BUFFER -+ help -+ Say yes here to build support for Phytium analog to digital -+ converters (ADC). -+ -+ To compile this driver as a module, choose M here: the module -+ will be called phytium-adc. -+ - endmenu -diff --git a/drivers/iio/adc/Makefile b/drivers/iio/adc/Makefile -index 90f94ada7..49b6f4651 100644 ---- a/drivers/iio/adc/Makefile -+++ b/drivers/iio/adc/Makefile -@@ -111,3 +111,4 @@ obj-$(CONFIG_VIPERBOARD_ADC) += viperboard_adc.o - xilinx-xadc-y := xilinx-xadc-core.o xilinx-xadc-events.o - obj-$(CONFIG_XILINX_XADC) += xilinx-xadc.o - obj-$(CONFIG_SD_ADC_MODULATOR) += sd_adc_modulator.o -+obj-$(CONFIG_PHYTIUM_ADC) += phytium-adc.o -\ No newline at end of file -diff --git a/drivers/iio/adc/phytium-adc.c b/drivers/iio/adc/phytium-adc.c -new file mode 100755 -index 000000000..b9b044c2a ---- /dev/null -+++ b/drivers/iio/adc/phytium-adc.c -@@ -0,0 +1,688 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium ADC device driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/* ADC register */ -+#define ADC_CTRL_REG 0x00 -+#define ADC_CTRL_REG_PD_EN BIT(31) -+#define ADC_CTRL_REG_CH_ONLY_S(x) ((x & 0x7) << 16) -+#define ADC_CTRL_REG_CLK_DIV(x) ((x) << 12) -+#define ADC_CTRL_REG_CHANNEL_EN(x) BIT((x) + 4) -+#define ADC_CTRL_REG_CH_ONLY_EN BIT(3) -+#define ADC_CTRL_REG_SINGLE_EN BIT(2) -+#define ADC_CTRL_REG_SINGLE_SEL BIT(1) -+#define ADC_CTRL_REG_SOC_EN BIT(0) -+#define ADC_INTER_REG 0x04 -+#define ADC_STATE_REG 0x08 -+#define ADC_STATE_REG_B_STA(x) ((x) << 8) -+#define ADC_STATE_REG_EOC_STA BIT(7) -+#define ADC_STATE_REG_S_STA(x) ((x) << 4) -+#define ADC_STATE_REG_SOC_STA BIT(3) -+#define ADC_STATE_REG_ERR_STA BIT(2) -+#define ADC_STATE_REG_COV_FINISH_STA BIT(1) -+#define ADC_STATE_REG_ADCCTL_BUSY_STA BIT(0) -+#define ADC_ERRCLR_REG 0x0c -+#define ADC_LEVEL_REG(x) (0x10 + ((x) << 2)) -+#define ADC_LEVEL_REG_HIGH_LEVEL(x) ((x) << 16) -+#define ADC_LEVEL_REG_LOW_LEVEL(x) (x) -+#define ADC_INTRMASK_REG 0x30 -+#define ADC_INTRMASK_REG_ERR_INTR_MASK BIT(24) -+#define ADC_INTRMASK_REG_ULIMIT_OFF(x) BIT(9 + ((x) << 1)) -+#define ADC_INTRMASK_REG_DLIMIT_MASK(x) BIT(8 + ((x) << 1)) -+#define ADC_INTRMASK_REG_COVFIN_MASK(x) BIT((x)) -+#define ADC_INTR_REG 0x34 -+#define ADC_INTR_REG_ERR BIT(24) -+#define ADC_INTR_REG_ULIMIT(x) BIT(9 + ((x) << 1)) -+#define ADC_INTR_REG_DLIMIT(x) BIT(8 + ((x) << 1)) -+#define ADC_INTR_REG_LIMIT_MASK GENMASK(23, 8) -+#define ADC_INTR_REG_COVFIN(x) BIT((x)) -+#define ADC_INTR_REG_COVFIN_MASK GENMASK(7, 0) -+#define ADC_COV_RESULT_REG(x) (0x38 + ((x) << 2)) -+#define ADC_COV_RESULT_REG_MASK GENMASK(9, 0) -+#define ADC_FINISH_CNT_REG(x) (0x58 + ((x) << 2)) -+#define ADC_HIS_LIMIT_REG(x) (0x78 + ((x) << 2)) -+ -+#define PHYTIUM_MAX_CHANNELS 8 -+#define PHYTIUM_ADC_TIMEOUT usecs_to_jiffies(1000 * 1000) -+ -+static const struct iio_event_spec phytium_adc_event[] = { -+ { -+ .type = IIO_EV_TYPE_THRESH, -+ .dir = IIO_EV_DIR_RISING, -+ .mask_separate = BIT(IIO_EV_INFO_VALUE), -+ }, { -+ .type = IIO_EV_TYPE_THRESH, -+ .dir = IIO_EV_DIR_FALLING, -+ .mask_separate = BIT(IIO_EV_INFO_VALUE), -+ }, -+}; -+ -+struct phytium_adc_data { -+ const struct iio_chan_spec *channels; -+ u8 num_channels; -+}; -+ -+struct phytium_adc { -+ struct device *dev; -+ void __iomem *regs; -+ struct clk *adc_clk; -+ -+ u32 interval; -+ u16 thresh_high[PHYTIUM_MAX_CHANNELS]; -+ u16 thresh_low[PHYTIUM_MAX_CHANNELS]; -+ u16 last_val[PHYTIUM_MAX_CHANNELS]; -+ const struct phytium_adc_data *data; -+ u16 *scan_data; -+ -+ struct completion completion; -+ struct mutex lock; -+}; -+ -+static ssize_t phytium_adc_show_conv_interval(struct iio_dev *indio_dev, -+ uintptr_t priv, -+ struct iio_chan_spec const *ch, -+ char *buf) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ return sprintf(buf, "%u\n", adc->interval); -+} -+ -+static ssize_t phytium_adc_store_conv_interval(struct iio_dev *indio_dev, -+ uintptr_t priv, -+ struct iio_chan_spec const *ch, -+ const char *buf, size_t len) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ u32 interval; -+ int ret; -+ -+ ret = kstrtou32(buf, 0, &interval); -+ if (ret < 0) -+ return ret; -+ -+ mutex_lock(&adc->lock); -+ adc->interval = interval; -+ mutex_unlock(&adc->lock); -+ -+ return len; -+} -+ -+static const struct iio_chan_spec_ext_info phytium_adc_ext_info[] = { -+ { -+ .name = "conv_interval", -+ .read = phytium_adc_show_conv_interval, -+ .write = phytium_adc_store_conv_interval, -+ }, -+ { /* sentinel */ } -+}; -+ -+static int phytium_adc_parse_properties(struct platform_device *pdev, struct phytium_adc *adc) -+{ -+ struct iio_chan_spec *chan_array; -+ struct fwnode_handle *fwnode; -+ struct phytium_adc_data *data; -+ unsigned int channel; -+ int num_channels; -+ int ret, i = 0; -+ -+ data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL); -+ if (!data) -+ return -ENOMEM; -+ -+ num_channels = device_get_child_node_count(&pdev->dev); -+ if (!num_channels) { -+ dev_err(&pdev->dev, "no channel children\n"); -+ return -ENODEV; -+ } -+ -+ if (num_channels > PHYTIUM_MAX_CHANNELS) { -+ dev_err(&pdev->dev, "num of channel children out of range\n"); -+ return -EINVAL; -+ } -+ -+ chan_array = devm_kcalloc(&pdev->dev, num_channels, sizeof(*chan_array), -+ GFP_KERNEL); -+ if (!chan_array) -+ return -ENOMEM; -+ -+ device_for_each_child_node(&pdev->dev, fwnode) { -+ ret = fwnode_property_read_u32(fwnode, "reg", &channel); -+ if (ret) -+ return ret; -+ -+ if (channel >= PHYTIUM_MAX_CHANNELS) -+ return -EINVAL; -+ -+ chan_array[i].type = IIO_VOLTAGE; -+ chan_array[i].indexed = 1; -+ chan_array[i].channel = channel; -+ chan_array[i].info_mask_separate = BIT(IIO_CHAN_INFO_RAW); -+ chan_array[i].event_spec = phytium_adc_event; -+ chan_array[i].num_event_specs = ARRAY_SIZE(phytium_adc_event); -+ chan_array[i].scan_index = channel; -+ chan_array[i].scan_type.sign = 'u'; -+ chan_array[i].scan_type.realbits = 10; -+ chan_array[i].scan_type.storagebits = 16; -+ chan_array[i].scan_type.endianness = IIO_LE; -+ chan_array[i].ext_info = phytium_adc_ext_info; -+ i++; -+ } -+ -+ data->num_channels = num_channels; -+ data->channels = chan_array; -+ adc->data = data; -+ -+ return 0; -+} -+ -+static void phytium_adc_start_stop(struct phytium_adc *adc, bool start) -+{ -+ u32 ctrl; -+ -+ ctrl = readl(adc->regs + ADC_CTRL_REG); -+ if (start) -+ ctrl |= ADC_CTRL_REG_SOC_EN | ADC_CTRL_REG_SINGLE_EN; -+ else -+ ctrl &= ~ADC_CTRL_REG_SOC_EN; -+ /* Start conversion */ -+ writel(ctrl, adc->regs + ADC_CTRL_REG); -+} -+ -+static void phytium_adc_power_setup(struct phytium_adc *adc, bool on) -+{ -+ u32 reg; -+ -+ reg = readl(adc->regs + ADC_CTRL_REG); -+ if (on) -+ reg &= ~ADC_CTRL_REG_PD_EN; -+ else -+ reg |= ADC_CTRL_REG_PD_EN; -+ writel(reg, adc->regs + ADC_CTRL_REG); -+} -+ -+static int phytium_adc_hw_init(struct phytium_adc *adc) -+{ -+ int ret; -+ u32 reg; -+ -+ ret = clk_prepare_enable(adc->adc_clk); -+ if (ret) -+ return ret; -+ -+ /* -+ * Setup ctrl register: -+ * - Power up conversion module -+ * - Set the division by 4 as default -+ */ -+ reg = ADC_CTRL_REG_CLK_DIV(4); -+ writel(reg, adc->regs + ADC_CTRL_REG); -+ -+ /* Set all the interrupt mask, unmask them when necessary. */ -+ writel(0x1ffffff, adc->regs + ADC_INTRMASK_REG); -+ -+ /* Set default conversion interval */ -+ adc->interval = (clk_get_rate(adc->adc_clk) * 1000) / NSEC_PER_SEC; -+ -+ phytium_adc_power_setup(adc, true); -+ -+ return 0; -+} -+ -+static void phytium_adc_intrmask_setup(struct phytium_adc *adc, unsigned long chan_mask, bool on) -+{ -+ u32 reg; -+ u16 limit_mask = 0; -+ int ch; -+ -+ for_each_set_bit(ch, &chan_mask, PHYTIUM_MAX_CHANNELS) -+ limit_mask |= BIT(ch << 1) | BIT((ch << 1) + 1); -+ -+ reg = readl(adc->regs + ADC_INTRMASK_REG); -+ if (on) -+ reg &= ~(ADC_INTRMASK_REG_ERR_INTR_MASK | -+ (limit_mask << 8) | chan_mask); -+ else -+ reg |= (ADC_INTRMASK_REG_ERR_INTR_MASK | -+ (limit_mask << 8) | chan_mask); -+ writel(reg, adc->regs + ADC_INTRMASK_REG); -+} -+ -+static void phytium_adc_single_conv_setup(struct phytium_adc *adc, u8 ch) -+{ -+ u32 reg; -+ -+ /* -+ * Setup control register: -+ * - Single conversion mode selection -+ * - Single conversion enable -+ * - Fixed channel conversion -+ * - Target channel -+ */ -+ reg = readl(adc->regs + ADC_CTRL_REG); -+ -+ /* Clean ch_only_s bits */ -+ reg &= ~ADC_CTRL_REG_CH_ONLY_S(7); -+ -+ /* Clean channel_en bit */ -+ reg &= 0xFFF00F; -+ -+ reg |= ADC_CTRL_REG_SINGLE_SEL | ADC_CTRL_REG_SINGLE_EN | -+ ADC_CTRL_REG_CH_ONLY_EN | ADC_CTRL_REG_CH_ONLY_S(ch) | ADC_CTRL_REG_CHANNEL_EN(ch); -+ writel(reg, adc->regs + ADC_CTRL_REG); -+} -+ -+static int phytium_adc_single_conv(struct iio_dev *indio_dev, u8 ch) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ int ret; -+ -+ ret = iio_device_claim_direct_mode(indio_dev); -+ if (ret) -+ return ret; -+ mutex_lock(&adc->lock); -+ -+ phytium_adc_intrmask_setup(adc, BIT(ch), true); -+ reinit_completion(&adc->completion); -+ phytium_adc_single_conv_setup(adc, ch); -+ phytium_adc_start_stop(adc, true); -+ -+ if (!wait_for_completion_timeout(&adc->completion, PHYTIUM_ADC_TIMEOUT)) -+ ret = -ETIMEDOUT; -+ -+ phytium_adc_start_stop(adc, false); -+ phytium_adc_intrmask_setup(adc, BIT(ch), false); -+ -+ mutex_unlock(&adc->lock); -+ iio_device_release_direct_mode(indio_dev); -+ -+ return ret; -+} -+ -+static int phytium_adc_read_raw(struct iio_dev *indio_dev, -+ struct iio_chan_spec const *chan, -+ int *val, int *val2, long mask) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ int ret; -+ -+ switch (mask) { -+ case IIO_CHAN_INFO_RAW: -+ if (chan->type != IIO_VOLTAGE) -+ return -EINVAL; -+ -+ ret = phytium_adc_single_conv(indio_dev, chan->channel); -+ if (ret) -+ return ret; -+ *val = adc->last_val[chan->channel]; -+ -+ return IIO_VAL_INT; -+ default: -+ return -EINVAL; -+ } -+} -+ -+static int phytium_read_thresh(struct iio_dev *indio_dev, -+ const struct iio_chan_spec *chan, -+ enum iio_event_type type, -+ enum iio_event_direction dir, -+ enum iio_event_info iinfo, int *val, int *val2) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ if (dir == IIO_EV_DIR_FALLING) -+ *val = adc->thresh_low[chan->channel]; -+ else -+ *val = adc->thresh_high[chan->channel]; -+ -+ return IIO_VAL_INT; -+} -+ -+static int phytium_write_thresh(struct iio_dev *indio_dev, -+ const struct iio_chan_spec *chan, -+ enum iio_event_type type, -+ enum iio_event_direction dir, -+ enum iio_event_info einfo, int val, int val2) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ u32 thresh; -+ -+ switch (dir) { -+ case IIO_EV_DIR_FALLING: -+ adc->thresh_low[chan->channel] = val; -+ thresh = readl(adc->regs + ADC_LEVEL_REG(chan->channel)) & 0x3ff0000; -+ thresh |= ADC_LEVEL_REG_LOW_LEVEL(val); -+ writel(thresh, adc->regs + ADC_LEVEL_REG(chan->channel)); -+ break; -+ case IIO_EV_DIR_RISING: -+ adc->thresh_high[chan->channel] = val; -+ thresh = readl(adc->regs + ADC_LEVEL_REG(chan->channel)) & 0xffff; -+ thresh |= ADC_LEVEL_REG_HIGH_LEVEL(val); -+ writel(thresh, adc->regs + ADC_LEVEL_REG(chan->channel)); -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int phytium_update_scan_mode(struct iio_dev *indio_dev, const unsigned long *mask) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ unsigned int n; -+ -+ n = bitmap_weight(mask, indio_dev->masklength); -+ -+ kfree(adc->scan_data); -+ adc->scan_data = kcalloc(n, sizeof(*adc->scan_data), GFP_KERNEL); -+ if (!adc->scan_data) -+ return -ENOMEM; -+ -+ return 0; -+} -+ -+static const u64 phytium_adc_event_codes[] = { -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 0, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 0, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 1, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 1, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 2, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 2, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 3, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 3, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 4, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 4, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 5, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 5, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 6, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 6, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 7, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 7, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+}; -+ -+static irqreturn_t phytium_adc_threaded_irq(int irq, void *data) -+{ -+ struct iio_dev *indio_dev = data; -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ s64 timestamp = iio_get_time_ns(indio_dev); -+ unsigned long status; -+ int ch; -+ u32 intr; -+ -+ intr = readl(adc->regs + ADC_INTR_REG); -+ -+ if (intr & ADC_INTR_REG_ERR) { -+ dev_err(adc->dev, "conversion error: ADC_INTR_REG(0x%x)\n", intr); -+ writel(ADC_INTR_REG_ERR, adc->regs + ADC_INTR_REG); -+ return IRQ_HANDLED; -+ } -+ -+ status = (intr & ADC_INTR_REG_LIMIT_MASK) >> 8; -+ if (status) { -+ for_each_set_bit(ch, &status, PHYTIUM_MAX_CHANNELS * 2) -+ iio_push_event(indio_dev, phytium_adc_event_codes[ch], timestamp); -+ } -+ -+ status = intr & ADC_INTR_REG_COVFIN_MASK; -+ if (status) { -+ for_each_set_bit(ch, &status, PHYTIUM_MAX_CHANNELS) -+ adc->last_val[ch] = readl(adc->regs + ADC_COV_RESULT_REG(ch)) & -+ ADC_COV_RESULT_REG_MASK; -+ -+ if (iio_buffer_enabled(indio_dev)) -+ iio_trigger_poll(indio_dev->trig); -+ else -+ complete(&adc->completion); -+ } -+ -+ /* Clear all the interrupts */ -+ writel(status, adc->regs + ADC_INTR_REG); -+ -+ return IRQ_HANDLED; -+} -+ -+static void phytium_adc_cont_conv_setup(struct phytium_adc *adc, -+ unsigned long chan_mask, -+ u32 interval) -+{ -+ u32 reg; -+ -+ /* -+ * Setup control register: -+ * - Continuous conversion mode -+ * - Multi-channel rotation mode -+ * - Channel enablement -+ */ -+ reg = readl(adc->regs + ADC_CTRL_REG); -+ reg &= ~(ADC_CTRL_REG_SINGLE_SEL | ADC_CTRL_REG_SINGLE_EN | -+ ADC_CTRL_REG_CH_ONLY_EN); -+ reg |= chan_mask << 4; -+ writel(reg, adc->regs + ADC_CTRL_REG); -+ -+ /* Setup interval between two conversions */ -+ writel(interval, adc->regs + ADC_INTER_REG); -+} -+ -+static int phytium_adc_preenable(struct iio_dev *indio_dev) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ unsigned long scan_mask = *indio_dev->active_scan_mask; -+ -+ phytium_adc_cont_conv_setup(adc, scan_mask & 0xff, adc->interval); -+ phytium_adc_intrmask_setup(adc, scan_mask & 0xff, true); -+ -+ return 0; -+} -+ -+static int phytium_adc_postenable(struct iio_dev *indio_dev) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ phytium_adc_start_stop(adc, true); -+ -+ return 0; -+} -+ -+static int phytium_adc_postdisable(struct iio_dev *indio_dev) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ unsigned long scan_mask = *indio_dev->active_scan_mask; -+ -+ phytium_adc_start_stop(adc, false); -+ phytium_adc_intrmask_setup(adc, scan_mask & 0xff, false); -+ -+ return 0; -+} -+ -+static const struct iio_buffer_setup_ops phytium_buffer_setup_ops = { -+ .preenable = &phytium_adc_preenable, -+ .postenable = &phytium_adc_postenable, -+ .postdisable = &phytium_adc_postdisable, -+}; -+ -+static irqreturn_t phytium_adc_trigger_handler(int irq, void *p) -+{ -+ struct iio_poll_func *pf = p; -+ struct iio_dev *indio_dev = pf->indio_dev; -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ int i, j = 0; -+ -+ if (!adc->scan_data) -+ goto out; -+ -+ for_each_set_bit(i, indio_dev->active_scan_mask, indio_dev->masklength) -+ adc->scan_data[j++] = adc->last_val[i]; -+ -+ iio_push_to_buffers(indio_dev, adc->scan_data); -+ -+out: -+ iio_trigger_notify_done(indio_dev->trig); -+ -+ return IRQ_HANDLED; -+} -+ -+static const struct iio_info phytium_adc_iio_info = { -+ .read_raw = &phytium_adc_read_raw, -+ .read_event_value = &phytium_read_thresh, -+ .write_event_value = &phytium_write_thresh, -+ .update_scan_mode = &phytium_update_scan_mode, -+}; -+ -+static int phytium_adc_probe(struct platform_device *pdev) -+{ -+ struct phytium_adc *adc; -+ struct iio_dev *indio_dev; -+ struct device *dev = &pdev->dev; -+ struct resource *res; -+ int ret; -+ -+ indio_dev = devm_iio_device_alloc(dev, sizeof(*adc)); -+ if (!indio_dev) -+ return -ENOMEM; -+ -+ adc = iio_priv(indio_dev); -+ adc->dev = dev; -+ -+ ret = phytium_adc_parse_properties(pdev, adc); -+ if (ret) -+ return ret; -+ -+ mutex_init(&adc->lock); -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ adc->regs = devm_ioremap_resource(dev, res); -+ if (IS_ERR(adc->regs)) -+ return PTR_ERR(adc->regs); -+ -+ adc->adc_clk = devm_clk_get(dev, NULL); -+ if (IS_ERR(adc->adc_clk)) -+ return PTR_ERR(adc->adc_clk); -+ -+ init_completion(&adc->completion); -+ -+ indio_dev->name = dev_name(dev); -+ indio_dev->info = &phytium_adc_iio_info; -+ indio_dev->modes = INDIO_DIRECT_MODE; -+ indio_dev->channels = adc->data->channels; -+ indio_dev->num_channels = adc->data->num_channels; -+ -+ platform_set_drvdata(pdev, indio_dev); -+ -+ ret = devm_request_threaded_irq(adc->dev, platform_get_irq(pdev, 0), -+ NULL, phytium_adc_threaded_irq, IRQF_ONESHOT, -+ dev_name(dev), indio_dev); -+ if (ret) -+ return ret; -+ -+ ret = devm_iio_triggered_buffer_setup(dev, indio_dev, -+ &iio_pollfunc_store_time, -+ phytium_adc_trigger_handler, -+ &phytium_buffer_setup_ops); -+ if (ret) -+ return ret; -+ -+ ret = phytium_adc_hw_init(adc); -+ if (ret) { -+ dev_err(&pdev->dev, "failed to initialize Phytium ADC, %d\n", ret); -+ return ret; -+ } -+ -+ return iio_device_register(indio_dev); -+} -+ -+static int phytium_adc_remove(struct platform_device *pdev) -+{ -+ struct iio_dev *indio_dev = platform_get_drvdata(pdev); -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ phytium_adc_power_setup(adc, false); -+ iio_device_unregister(indio_dev); -+ kfree(adc->scan_data); -+ -+ return 0; -+} -+ -+static const struct of_device_id phytium_of_match[] = { -+ { .compatible = "phytium,adc", }, -+ { /* sentinel */ } -+}; -+MODULE_DEVICE_TABLE(of, phytium_of_match); -+ -+#ifdef CONFIG_PM -+static int phytium_adc_suspend(struct device *dev) -+{ -+ struct iio_dev *indio_dev = dev_get_drvdata(dev); -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ phytium_adc_power_setup(adc, false); -+ clk_disable_unprepare(adc->adc_clk); -+ -+ return 0; -+} -+ -+static int phytium_adc_resume(struct device *dev) -+{ -+ struct iio_dev *indio_dev = dev_get_drvdata(dev); -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ clk_prepare_enable(adc->adc_clk); -+ phytium_adc_power_setup(adc, true); -+ -+ return 0; -+} -+#endif -+ -+SIMPLE_DEV_PM_OPS(phytium_adc_pm_ops, phytium_adc_suspend, phytium_adc_resume); -+ -+static struct platform_driver phytium_adc_driver = { -+ .driver = { -+ .name = "phytium_adc", -+ .of_match_table = phytium_of_match, -+ .pm = &phytium_adc_pm_ops, -+ }, -+ .probe = phytium_adc_probe, -+ .remove = phytium_adc_remove, -+}; -+module_platform_driver(phytium_adc_driver); -+ -+MODULE_AUTHOR("Yang Liu "); -+MODULE_DESCRIPTION("Phytium ADC driver"); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/input/keyboard/Kconfig b/drivers/input/keyboard/Kconfig -index 3f7a5ff17..9ab0634f2 100644 ---- a/drivers/input/keyboard/Kconfig -+++ b/drivers/input/keyboard/Kconfig -@@ -788,4 +788,15 @@ config KEYBOARD_MTK_PMIC - To compile this driver as a module, choose M here: the - module will be called pmic-keys. - -+config KEYBOARD_PHYTIUM -+ tristate "Phytium keypad support" -+ depends on ARCH_PHYTIUM -+ select INPUT_MATRIXKMAP -+ help -+ Say Y here if you want to enable support for Phytium keypad -+ port. -+ -+ To compile this driver as a module, choose M here: the -+ module will be called phytium_keypad. -+ - endif -diff --git a/drivers/input/keyboard/Makefile b/drivers/input/keyboard/Makefile -index 1d689fdd5..4947b23ef 100644 ---- a/drivers/input/keyboard/Makefile -+++ b/drivers/input/keyboard/Makefile -@@ -70,3 +70,4 @@ obj-$(CONFIG_KEYBOARD_TEGRA) += tegra-kbc.o - obj-$(CONFIG_KEYBOARD_TM2_TOUCHKEY) += tm2-touchkey.o - obj-$(CONFIG_KEYBOARD_TWL4030) += twl4030_keypad.o - obj-$(CONFIG_KEYBOARD_XTKBD) += xtkbd.o -+obj-$(CONFIG_KEYBOARD_PHYTIUM) += phytium-keypad.o -diff --git a/drivers/input/keyboard/phytium-keypad.c b/drivers/input/keyboard/phytium-keypad.c -new file mode 100644 -index 000000000..f34a9cf14 ---- /dev/null -+++ b/drivers/input/keyboard/phytium-keypad.c -@@ -0,0 +1,586 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Driver for the Phytium keypad port. -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/* -+ * Keypad Controller registers -+ */ -+#define KPCR 0x00 /* Keypad Control Register */ -+ -+#define KPSR 0x04 /* Keypad Status Register */ -+#define KBD_STAT_KPKD (0x1 << 0) /* Key Press Interrupt Status bit (w1c) */ -+#define KBD_STAT_KPKR (0x1 << 1) /* Key Release Interrupt Status bit (w1c) */ -+#define KBD_STAT_KDSC (0x1 << 2) /* Key Depress Synch Chain Status bit (w1c)*/ -+#define KBD_STAT_KRSS (0x1 << 3) /* Key Release Synch Status bit (w1c)*/ -+#define KBD_STAT_KDIE (0x1 << 8) /* Key Depress Interrupt Enable Status bit */ -+#define KBD_STAT_KRIE (0x1 << 9) /* Key Release Interrupt Enable */ -+ -+#define KDDR 0x08 /* Keypad Data Direction Register */ -+#define KPDR 0x0C /* Keypad Data Register */ -+ -+#define MAX_MATRIX_KEY_ROWS 8 -+#define MAX_MATRIX_KEY_COLS 8 -+ -+#define MAX_MATRIX_KEY_NUM (MAX_MATRIX_KEY_ROWS * MAX_MATRIX_KEY_COLS) -+ -+struct phytium_keypad { -+ struct input_dev *input_dev; -+ void __iomem *mmio_base; -+ -+ int irq; -+ struct timer_list check_matrix_timer; -+ -+ /* -+ * The matrix is stable only if no changes are detected after -+ * PHYTIUM_KEYPAD_SCANS_FOR_STABILITY scans -+ */ -+#define PHYTIUM_KEYPAD_SCANS_FOR_STABILITY 3 -+ -+ int stable_count; -+ -+ bool enabled; -+ -+ unsigned int n_rows; -+ unsigned int n_cols; -+ int row_shift; -+ -+ /* Masks for enabled rows/cols */ -+ unsigned short rows_en_mask; -+ unsigned short cols_en_mask; -+ -+ unsigned short keycodes[MAX_MATRIX_KEY_NUM]; -+ -+ /* -+ * Matrix states: -+ * -stable: achieved after a complete debounce process. -+ * -unstable: used in the debouncing process. -+ */ -+ unsigned short matrix_stable_state[MAX_MATRIX_KEY_COLS]; -+ unsigned short matrix_unstable_state[MAX_MATRIX_KEY_COLS]; -+}; -+ -+static u32 phytium_read(struct phytium_keypad *keypad, int reg) -+{ -+ return readl(keypad->mmio_base + reg); -+} -+ -+static void phytium_write(struct phytium_keypad *keypad, u32 value, int reg) -+{ -+ writel(value, keypad->mmio_base + reg); -+} -+ -+/* Scan the matrix and return the new state in *matrix_volatile_state. */ -+static void phytium_keypad_scan_matrix(struct phytium_keypad *keypad, -+ unsigned short *matrix_volatile_state) -+{ -+ int col; -+ u32 reg_val; -+ -+ for (col = 0; col < keypad->n_cols; col++) { -+ if ((keypad->cols_en_mask & (1 << col)) == 0) -+ continue; -+ /* -+ * Discharge keypad capacitance: -+ * 2. write 0s on KDDR[KCD], configure columns as input. -+ */ -+ reg_val = phytium_read(keypad, KDDR); -+ reg_val = 0x00000000; -+ phytium_write(keypad, reg_val, KDDR); -+ -+ /* -+ * 3. Write a single column to 0, others to 1. -+ * 4. Sample row inputs and save data. -+ * 5. Repeat steps 3 - 4 for remaining columns. -+ */ -+ reg_val = 0; -+ reg_val |= (1 << (16 + col)); -+ phytium_write(keypad, reg_val, KDDR); -+ reg_val = phytium_read(keypad, KPDR); -+ reg_val = 0x00000000; -+ phytium_write(keypad, reg_val, KPDR); -+ -+ /* -+ * Delay added to avoid propagating the 0 from column to row -+ * when scanning. -+ */ -+ udelay(5); -+ -+ /* -+ * 1s in matrix_volatile_state[col] means key pressures -+ * throw data from non enabled rows. -+ */ -+ reg_val = phytium_read(keypad, KPDR); -+ matrix_volatile_state[col] = (~reg_val) & keypad->rows_en_mask; -+ } -+ -+ /* -+ * Return in standby mode: -+ * 6. write 0s to columns -+ */ -+ /* Configure columns as output, output 0 */ -+ reg_val = 0; -+ reg_val |= (keypad->cols_en_mask & 0xffff) << 16; -+ phytium_write(keypad, reg_val, KDDR); -+ phytium_write(keypad, 0x00000000, KPDR); -+} -+ -+/* -+ * Compare the new matrix state (volatile) with the stable one stored in -+ * keypad->matrix_stable_state and fire events if changes are detected. -+ */ -+static void phytium_keypad_fire_events(struct phytium_keypad *keypad, -+ unsigned short *matrix_volatile_state) -+{ -+ struct input_dev *input_dev = keypad->input_dev; -+ int row, col; -+ -+ for (col = 0; col < keypad->n_cols; col++) { -+ unsigned short bits_changed; -+ int code; -+ -+ if ((keypad->cols_en_mask & (1 << col)) == 0) -+ continue; /* Column is not enabled */ -+ -+ bits_changed = keypad->matrix_stable_state[col] ^ -+ matrix_volatile_state[col]; -+ -+ if (bits_changed == 0) -+ continue; /* Column does not contain changes */ -+ -+ for (row = 0; row < keypad->n_rows; row++) { -+ if ((keypad->rows_en_mask & (1 << row)) == 0) -+ continue; /* Row is not enabled */ -+ if ((bits_changed & (1 << row)) == 0) -+ continue; /* Row does not contain changes */ -+ -+ code = MATRIX_SCAN_CODE(row, col, keypad->row_shift); -+ input_event(input_dev, EV_MSC, MSC_SCAN, code); -+ input_report_key(input_dev, keypad->keycodes[code], -+ matrix_volatile_state[col] & (1 << row)); -+ dev_dbg(&input_dev->dev, "Event code: %d, val: %d", -+ keypad->keycodes[code], -+ matrix_volatile_state[col] & (1 << row)); -+ } -+ } -+ input_sync(input_dev); -+} -+ -+/* -+ * phytium_keypad_check_for_events is the timer handler. -+ */ -+static void phytium_keypad_check_for_events(struct timer_list *t) -+{ -+ struct phytium_keypad *keypad = from_timer(keypad, t, check_matrix_timer); -+ unsigned short matrix_volatile_state[MAX_MATRIX_KEY_COLS]; -+ u32 reg_val; -+ bool state_changed, is_zero_matrix; -+ int i; -+ -+ memset(matrix_volatile_state, 0, sizeof(matrix_volatile_state)); -+ -+ phytium_keypad_scan_matrix(keypad, matrix_volatile_state); -+ -+ state_changed = false; -+ for (i = 0; i < keypad->n_cols; i++) { -+ if ((keypad->cols_en_mask & (1 << i)) == 0) -+ continue; -+ -+ if (keypad->matrix_unstable_state[i] ^ matrix_volatile_state[i]) { -+ state_changed = true; -+ break; -+ } -+ } -+ -+ /* -+ * If the matrix state is changed from the previous scan -+ * (Re)Begin the debouncing process, saving the new state in -+ * keypad->matrix_unstable_state. -+ * else -+ * Increase the count of number of scans with a stable state. -+ */ -+ if (state_changed) { -+ memcpy(keypad->matrix_unstable_state, matrix_volatile_state, -+ sizeof(matrix_volatile_state)); -+ keypad->stable_count = 0; -+ } else { -+ keypad->stable_count++; -+ } -+ -+ /* -+ * If the matrix is not as stable as we want reschedule scan -+ * in the near future. -+ */ -+ if (keypad->stable_count < PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) { -+ mod_timer(&keypad->check_matrix_timer, -+ jiffies + msecs_to_jiffies(10)); -+ return; -+ } -+ -+ /* -+ * If the matrix state is stable, fire the events and save the new -+ * stable state. Note, if the matrix is kept stable for longer -+ * (keypad->stable_count > PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) all -+ * events have already been generated. -+ */ -+ if (keypad->stable_count == PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) { -+ phytium_keypad_fire_events(keypad, matrix_volatile_state); -+ memcpy(keypad->matrix_stable_state, matrix_volatile_state, -+ sizeof(matrix_volatile_state)); -+ } -+ -+ is_zero_matrix = true; -+ for (i = 0; i < keypad->n_cols; i++) { -+ if (matrix_volatile_state[i] != 0) { -+ is_zero_matrix = false; -+ break; -+ } -+ } -+ -+ if (is_zero_matrix) { -+ /* -+ * All keys have been released. Enable only the KDI -+ * interrupt for future key presses (clear the KDI -+ * status bit and its sync chain before that). -+ */ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val |= KBD_STAT_KPKD | KBD_STAT_KDSC; -+ phytium_write(keypad, reg_val, KPSR); -+ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val |= KBD_STAT_KDIE; -+ reg_val &= ~KBD_STAT_KRIE; -+ phytium_write(keypad, reg_val, KPSR); -+ } else { -+ /* -+ * Some keys are still pressed. Schedule a rescan in -+ * attempt to detect multiple key presses and enable -+ * the KRI interrupt to react quickly to key release -+ * event. -+ */ -+ mod_timer(&keypad->check_matrix_timer, -+ jiffies + msecs_to_jiffies(60)); -+ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val |= KBD_STAT_KPKR | KBD_STAT_KRSS; -+ phytium_write(keypad, reg_val, KPSR); -+ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val |= KBD_STAT_KRIE; -+ reg_val &= ~KBD_STAT_KDIE; -+ phytium_write(keypad, reg_val, KPSR); -+ } -+} -+ -+static irqreturn_t phytium_keypad_irq_handler(int irq, void *dev_id) -+{ -+ struct phytium_keypad *keypad = dev_id; -+ u32 reg_val; -+ -+ reg_val = phytium_read(keypad, KPSR); -+ /* Disable both interrupt types */ -+ reg_val &= ~(KBD_STAT_KRIE | KBD_STAT_KDIE); -+ /* Clear interrupts status bits */ -+ reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD; -+ phytium_write(keypad, reg_val, KPSR); -+ -+ if (keypad->enabled) { -+ /* The matrix is supposed to be changed */ -+ keypad->stable_count = 0; -+ -+ /* Schedule the scanning procedure near in the future */ -+ mod_timer(&keypad->check_matrix_timer, -+ jiffies + msecs_to_jiffies(2)); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static void phytium_keypad_config(struct phytium_keypad *keypad) -+{ -+ u32 reg_val; -+ -+ /* -+ * Include enabled rows in interrupt generation (KPCR[15:0]) -+ * Configure keypad columns as open-drain (KPCR[31:16]) -+ */ -+ reg_val = phytium_read(keypad, KPCR); -+ reg_val |= keypad->rows_en_mask & 0xffff; /* rows */ -+ reg_val |= (keypad->cols_en_mask & 0xffff) << 16; /* cols */ -+ phytium_write(keypad, reg_val, KPCR); -+ -+ /* Configure columns as output, output 0 */ -+ reg_val = 0; -+ reg_val |= (keypad->cols_en_mask & 0xffff) << 16; -+ phytium_write(keypad, reg_val, KDDR); -+ phytium_write(keypad, 0x00000000, KPDR); -+ -+ /* -+ * Clear Key Depress and Key Release status bit. -+ * Clear both synchronizer chain. -+ */ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD | -+ KBD_STAT_KDSC | KBD_STAT_KRSS; -+ phytium_write(keypad, reg_val, KPSR); -+ -+ /* Enable KDI and disable KRI (avoid false release events). */ -+ reg_val |= KBD_STAT_KDIE; -+ reg_val &= ~KBD_STAT_KRIE; -+ phytium_write(keypad, reg_val, KPSR); -+} -+ -+static void phytium_keypad_inhibit(struct phytium_keypad *keypad) -+{ -+ unsigned short reg_val; -+ -+ /* Inhibit KDI and KRI interrupts. */ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val &= ~(KBD_STAT_KRIE | KBD_STAT_KDIE); -+ reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD; -+ phytium_write(keypad, reg_val, KPSR); -+} -+ -+static void phytium_keypad_close(struct input_dev *dev) -+{ -+ struct phytium_keypad *keypad = input_get_drvdata(dev); -+ -+ dev_dbg(&dev->dev, ">%s\n", __func__); -+ -+ /* Mark keypad as being inactive */ -+ keypad->enabled = false; -+ synchronize_irq(keypad->irq); -+ del_timer_sync(&keypad->check_matrix_timer); -+ -+ phytium_keypad_inhibit(keypad); -+} -+ -+static int phytium_keypad_open(struct input_dev *dev) -+{ -+ struct phytium_keypad *keypad = input_get_drvdata(dev); -+ -+ dev_dbg(&dev->dev, ">%s\n", __func__); -+ -+ /* We became active from now */ -+ keypad->enabled = true; -+ -+ phytium_keypad_config(keypad); -+ -+ /* Sanity control, not all the rows must be activated now. */ -+ if ((phytium_read(keypad, KPDR) & keypad->rows_en_mask) == 0) { -+ dev_err(&dev->dev, -+ "too many keys pressed, control pins initialisation\n"); -+ goto open_err; -+ } -+ -+ return 0; -+ -+open_err: -+ phytium_keypad_close(dev); -+ return -EIO; -+} -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_keypad_acpi_ids[] = { -+ { "PHYT0028", 0 }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_keypad_acpi_ids); -+#endif -+ -+#ifdef CONFIG_OF -+static const struct of_device_id phytium_keypad_of_match[] = { -+ { .compatible = "phytium,keypad", }, -+ { /* sentinel */ } -+}; -+MODULE_DEVICE_TABLE(of, phytium_keypad_of_match); -+#endif -+ -+static int phytium_keypad_probe(struct platform_device *pdev) -+{ -+ const struct matrix_keymap_data *keymap_data = dev_get_platdata(&pdev->dev); -+ struct phytium_keypad *keypad; -+ struct input_dev *input_dev; -+ struct resource *res; -+ int irq, error, i, row, col; -+ -+ if (!keymap_data && !pdev->dev.of_node && !has_acpi_companion(&pdev->dev)) { -+ dev_err(&pdev->dev, "no keymap defined\n"); -+ return -EINVAL; -+ } -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) { -+ dev_err(&pdev->dev, "no irq defined in platform data\n"); -+ return irq; -+ } -+ -+ input_dev = devm_input_allocate_device(&pdev->dev); -+ if (!input_dev) { -+ dev_err(&pdev->dev, "failed to allocate the input device\n"); -+ return -ENOMEM; -+ } -+ -+ keypad = devm_kzalloc(&pdev->dev, sizeof(*keypad), GFP_KERNEL); -+ if (!keypad) -+ return -ENOMEM; -+ -+ keypad->input_dev = input_dev; -+ keypad->irq = irq; -+ keypad->stable_count = 0; -+ -+ timer_setup(&keypad->check_matrix_timer, -+ phytium_keypad_check_for_events, 0); -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ keypad->mmio_base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(keypad->mmio_base)) -+ return PTR_ERR(keypad->mmio_base); -+ -+ /* Init the Input device */ -+ input_dev->name = pdev->name; -+ input_dev->id.bustype = BUS_HOST; -+ input_dev->dev.parent = &pdev->dev; -+ input_dev->open = phytium_keypad_open; -+ input_dev->close = phytium_keypad_close; -+ -+ error = matrix_keypad_parse_properties(&pdev->dev, &keypad->n_rows, &keypad->n_cols); -+ if (error) { -+ dev_err(&pdev->dev, "failed to parse phytium kp params\n"); -+ return error; -+ } -+ -+ error = matrix_keypad_build_keymap(keymap_data, NULL, -+ keypad->n_rows, -+ keypad->n_cols, -+ keypad->keycodes, input_dev); -+ if (error) { -+ dev_err(&pdev->dev, "failed to build keymap\n"); -+ return error; -+ } -+ -+ keypad->row_shift = get_count_order(keypad->n_cols); -+ -+ /* Search for rows and cols enabled */ -+ for (row = 0; row < keypad->n_rows; row++) { -+ for (col = 0; col < keypad->n_cols; col++) { -+ i = MATRIX_SCAN_CODE(row, col, keypad->row_shift); -+ if (keypad->keycodes[i] != KEY_RESERVED) { -+ keypad->rows_en_mask |= 1 << row; -+ keypad->cols_en_mask |= 1 << col; -+ } -+ } -+ } -+ -+ __set_bit(EV_REP, input_dev->evbit); -+ input_set_capability(input_dev, EV_MSC, MSC_SCAN); -+ input_set_drvdata(input_dev, keypad); -+ -+ phytium_keypad_inhibit(keypad); -+ -+ error = devm_request_irq(&pdev->dev, irq, phytium_keypad_irq_handler, 0, -+ pdev->name, keypad); -+ if (error) { -+ dev_err(&pdev->dev, "failed to request IRQ\n"); -+ return error; -+ } -+ -+ /* Register the input device */ -+ error = input_register_device(input_dev); -+ if (error) { -+ dev_err(&pdev->dev, "failed to register input device\n"); -+ return error; -+ } -+ -+ platform_set_drvdata(pdev, keypad); -+ device_init_wakeup(&pdev->dev, 1); -+ -+ return 0; -+} -+ -+static int phytium_keypad_remove(struct platform_device *pdev) -+{ -+ struct phytium_keypad *keypad = platform_get_drvdata(pdev); -+ -+ input_unregister_device(keypad->input_dev); -+ devm_kfree(&pdev->dev, keypad); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_keypad_suspend(struct device *dev) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct phytium_keypad *keypad = platform_get_drvdata(pdev); -+ struct input_dev *input_dev = keypad->input_dev; -+ -+ mutex_lock(&input_dev->mutex); -+ -+ if (input_dev->users) -+ phytium_keypad_inhibit(keypad); -+ -+ mutex_unlock(&input_dev->mutex); -+ -+ if (device_may_wakeup(&pdev->dev)) -+ enable_irq_wake(keypad->irq); -+ -+ return 0; -+} -+ -+static int phytium_keypad_resume(struct device *dev) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct phytium_keypad *keypad = platform_get_drvdata(pdev); -+ struct input_dev *input_dev = keypad->input_dev; -+ int ret = 0; -+ -+ if (device_may_wakeup(&pdev->dev)) -+ disable_irq_wake(keypad->irq); -+ -+ mutex_lock(&input_dev->mutex); -+ -+ if (input_dev->users) -+ phytium_keypad_config(keypad); -+ -+ mutex_unlock(&input_dev->mutex); -+ -+ return ret; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_keypad_pm_ops, phytium_keypad_suspend, phytium_keypad_resume); -+ -+static struct platform_driver phytium_keypad_driver = { -+ .driver = { -+ .name = "phytium-keypad", -+ .pm = &phytium_keypad_pm_ops, -+ .of_match_table = of_match_ptr(phytium_keypad_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_keypad_acpi_ids), -+ }, -+ .probe = phytium_keypad_probe, -+ .remove = phytium_keypad_remove, -+}; -+module_platform_driver(phytium_keypad_driver); -+ -+MODULE_AUTHOR("Song Wenting "); -+MODULE_DESCRIPTION("PHYTIUM Keypad Port Driver"); -+MODULE_LICENSE("GPL v2"); -+MODULE_ALIAS("platform:phytium-keypad"); -diff --git a/drivers/input/serio/Kconfig b/drivers/input/serio/Kconfig -index 0754744b9..ffda99260 100644 ---- a/drivers/input/serio/Kconfig -+++ b/drivers/input/serio/Kconfig -@@ -40,6 +40,18 @@ config SERIO_I8042 - To compile this driver as a module, choose M here: the - module will be called i8042. - -+config SERIO_PHYTIUM_PS2 -+ depends on SERIO -+ tristate "PHYTIUM PS/2 (keyboard and mouse)" -+ default y if ARCH_PHYTIUM -+ depends on PCI -+ help -+ This selects support for the PS/2 Host Controller on -+ Phytium SoCs. -+ -+ To compile this driver as a module, choose M here: the -+ module will be called phytium-ps2. -+ - config SERIO_SERPORT - tristate "Serial port line discipline" - default y -diff --git a/drivers/input/serio/Makefile b/drivers/input/serio/Makefile -index 6d97bad7b..958591822 100644 ---- a/drivers/input/serio/Makefile -+++ b/drivers/input/serio/Makefile -@@ -7,6 +7,7 @@ - - obj-$(CONFIG_SERIO) += serio.o - obj-$(CONFIG_SERIO_I8042) += i8042.o -+obj-$(CONFIG_SERIO_PHYTIUM_PS2) += phytium-ps2.o - obj-$(CONFIG_SERIO_PARKBD) += parkbd.o - obj-$(CONFIG_SERIO_SERPORT) += serport.o - obj-$(CONFIG_SERIO_CT82C710) += ct82c710.o -diff --git a/drivers/input/serio/phytium-ps2.c b/drivers/input/serio/phytium-ps2.c -new file mode 100644 -index 000000000..902dd7a04 ---- /dev/null -+++ b/drivers/input/serio/phytium-ps2.c -@@ -0,0 +1,186 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * Phytium PS/2 keyboard controller driver. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define DRV_NAME "phytium_ps2_pci" -+ -+#define REG_STAT 0x0 -+#define REG_STAT_TX_TIMEOUT 0x1 -+#define REG_STAT_RX_TIMEOUT 0x2 -+#define REG_STAT_TX_FULL 0x4 -+#define REG_CTRL 0x4 -+#define REG_CTRL_RESET 0x1 -+#define REG_CTRL_TX_TIMEOUT 0x2 -+#define REG_CTRL_RX_TIMEOUT 0x4 -+#define REG_CTRL_RX_INTR 0x8 -+#define REG_INTR 0x8 -+#define REG_INTR_TIMEOUT 0x1 -+#define REG_INTR_RX 0x2 -+#define REG_TX 0xc -+#define REG_RX 0x10 -+#define REG_TIMER_VAL 0x14 -+ -+#define REG_CTRL_ENABLE (REG_CTRL_TX_TIMEOUT|REG_CTRL_RX_TIMEOUT|REG_CTRL_RX_INTR) -+#define REG_DATA_PARITY 0x100 -+ -+#define STAT_RX_COUNTER(stat) ((stat >> 8) & 0x1f) -+ -+struct phytium_ps2_data { -+ void __iomem *base; -+ struct serio *io; -+ struct pci_dev *dev; -+}; -+ -+static irqreturn_t phytium_ps2_irq(int irq, void *devid) -+{ -+ struct phytium_ps2_data *ps2if = devid; -+ u32 status, scancode, val = 0; -+ unsigned int flag; -+ int i, rxcount; -+ -+ status = readl(ps2if->base + REG_STAT); -+ if (!status) -+ return IRQ_NONE; -+ -+ /* Check if there is timeout interrupt */ -+ if (status & (REG_STAT_RX_TIMEOUT|REG_STAT_TX_TIMEOUT)) -+ val |= REG_INTR_TIMEOUT; -+ -+ rxcount = STAT_RX_COUNTER(status); -+ for (i = 0; i < rxcount; i++) { -+ scancode = readl(ps2if->base + REG_RX) & 0x1ff; -+ -+ if (rxcount <= 16 && scancode != 0x1ff) { -+ flag = ((scancode & REG_DATA_PARITY) ? SERIO_PARITY : 0); -+ serio_interrupt(ps2if->io, scancode & 0xff, flag); -+ } -+ } -+ -+ val |= REG_INTR_RX; -+ writel(val, ps2if->base + REG_INTR); -+ -+ return IRQ_HANDLED; -+} -+ -+int phytium_ps2_write(struct serio *serio, unsigned char val) -+{ -+ struct phytium_ps2_data *ps2if = serio->port_data; -+ unsigned int stat; -+ -+ do { -+ stat = readl(ps2if->base + REG_STAT); -+ cpu_relax(); -+ } while (stat & REG_STAT_TX_FULL); -+ -+ writel(val, ps2if->base + REG_TX); -+ -+ return 0; -+} -+ -+int phytium_ps2_open(struct serio *io) -+{ -+ struct phytium_ps2_data *ps2if = io->port_data; -+ -+ writel(REG_CTRL_RESET, ps2if->base + REG_CTRL); -+ /* Wait 4ms for the controller to be reset */ -+ usleep_range(4000, 6000); -+ writel(REG_CTRL_ENABLE, ps2if->base + REG_CTRL); -+ -+ return 0; -+} -+ -+void phytium_ps2_close(struct serio *io) -+{ -+ struct phytium_ps2_data *ps2if = io->port_data; -+ -+ writel(0, ps2if->base + REG_CTRL); -+} -+ -+static int phytium_pci_ps2_probe(struct pci_dev *pdev, const struct pci_device_id *id) -+{ -+ struct phytium_ps2_data *ps2if; -+ struct serio *serio; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ goto out; -+ -+ ret = pcim_iomap_regions(pdev, 0x1, DRV_NAME); -+ if (ret) -+ goto out; -+ -+ ps2if = devm_kzalloc(&pdev->dev, sizeof(struct phytium_ps2_data), GFP_KERNEL); -+ serio = kzalloc(sizeof(struct serio), GFP_KERNEL); -+ if (!ps2if || !serio) { -+ ret = -ENOMEM; -+ goto free; -+ } -+ -+ serio->id.type = SERIO_8042; -+ serio->write = phytium_ps2_write; -+ serio->open = phytium_ps2_open; -+ serio->close = phytium_ps2_close; -+ strscpy(serio->name, pci_name(pdev), sizeof(serio->name)); -+ strscpy(serio->phys, dev_name(&pdev->dev), sizeof(serio->phys)); -+ serio->port_data = ps2if; -+ serio->dev.parent = &pdev->dev; -+ ps2if->io = serio; -+ ps2if->dev = pdev; -+ ps2if->base = pcim_iomap_table(pdev)[0]; -+ -+ ret = devm_request_irq(&pdev->dev, pdev->irq, phytium_ps2_irq, -+ IRQF_SHARED, DRV_NAME, ps2if); -+ if (ret) { -+ dev_err(&pdev->dev, "could not request IRQ %d\n", pdev->irq); -+ goto free; -+ } -+ -+ pci_set_drvdata(pdev, ps2if); -+ serio_register_port(ps2if->io); -+ -+ return 0; -+ -+free: -+ kfree(serio); -+out: -+ return ret; -+} -+ -+static void phytium_pci_ps2_remove(struct pci_dev *pdev) -+{ -+ struct phytium_ps2_data *ps2if = pci_get_drvdata(pdev); -+ -+ serio_unregister_port(ps2if->io); -+ pcim_iounmap_regions(pdev, 0x1); -+} -+ -+static const struct pci_device_id phytium_pci_ps2_ids[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc34) }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(pci, phytium_pci_ps2_ids); -+ -+static struct pci_driver phytium_pci_ps2_driver = { -+ .name = DRV_NAME, -+ .id_table = phytium_pci_ps2_ids, -+ .probe = phytium_pci_ps2_probe, -+ .remove = phytium_pci_ps2_remove, -+}; -+module_pci_driver(phytium_pci_ps2_driver); -+ -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_DESCRIPTION("Phytium PCI PS/2 controller driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c -index 982c42c87..4dbeb03a0 100644 ---- a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c -+++ b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c -@@ -2873,6 +2873,13 @@ static void arm_smmu_write_msi_msg(struct msi_desc *desc, struct msi_msg *msg) - doorbell = (((u64)msg->address_hi) << 32) | msg->address_lo; - doorbell &= MSI_CFG0_ADDR_MASK; - -+#ifdef CONFIG_PM_SLEEP -+ /* Saves the msg (base addr of msi irq) and restores it during resume */ -+ desc->msg.address_lo = msg->address_lo; -+ desc->msg.address_hi = msg->address_hi; -+ desc->msg.data = msg->data; -+#endif -+ - writeq_relaxed(doorbell, smmu->base + cfg[0]); - writel_relaxed(msg->data, smmu->base + cfg[1]); - writel_relaxed(ARM_SMMU_MEMATTR_DEVICE_nGnRE, smmu->base + cfg[2]); -@@ -2928,11 +2935,51 @@ static void arm_smmu_setup_msis(struct arm_smmu_device *smmu) - devm_add_action(dev, arm_smmu_free_msis, dev); - } - --static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu) -+#ifdef CONFIG_PM_SLEEP -+static void arm_smmu_resume_msis(struct arm_smmu_device *smmu) -+{ -+ struct msi_desc *desc; -+ struct device *dev = smmu->dev; -+ -+ for_each_msi_entry(desc, dev) { -+ switch (desc->platform.msi_index) { -+ case EVTQ_MSI_INDEX: -+ case GERROR_MSI_INDEX: -+ case PRIQ_MSI_INDEX: { -+ phys_addr_t *cfg = arm_smmu_msi_cfg[desc->platform.msi_index]; -+ struct msi_msg *msg = &desc->msg; -+ phys_addr_t doorbell = (((u64)msg->address_hi) << 32) | msg->address_lo; -+ -+ doorbell &= MSI_CFG0_ADDR_MASK; -+ writeq_relaxed(doorbell, smmu->base + cfg[0]); -+ writel_relaxed(msg->data, smmu->base + cfg[1]); -+ writel_relaxed(ARM_SMMU_MEMATTR_DEVICE_nGnRE, -+ smmu->base + cfg[2]); -+ break; -+ } -+ default: -+ continue; -+ -+ } -+ } -+} -+#else -+static void arm_smmu_resume_msis(struct arm_smmu_device *smmu) -+{ -+} -+#endif -+ -+static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu, bool resume) - { - int irq, ret; - -- arm_smmu_setup_msis(smmu); -+ if (!resume) -+ arm_smmu_setup_msis(smmu); -+ else { -+ /* The irq doesn't need to be re-requested during resume */ -+ arm_smmu_resume_msis(smmu); -+ return; -+ } - - /* Request interrupt lines */ - irq = smmu->evtq.q.irq; -@@ -2974,7 +3021,7 @@ static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu) - } - } - --static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu) -+static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu, bool resume) - { - int ret, irq; - u32 irqen_flags = IRQ_CTRL_EVTQ_IRQEN | IRQ_CTRL_GERROR_IRQEN; -@@ -3001,7 +3048,7 @@ static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu) - if (ret < 0) - dev_warn(smmu->dev, "failed to enable combined irq\n"); - } else -- arm_smmu_setup_unique_irqs(smmu); -+ arm_smmu_setup_unique_irqs(smmu, resume); - - if (smmu->features & ARM_SMMU_FEAT_PRI) - irqen_flags |= IRQ_CTRL_PRIQ_IRQEN; -@@ -3026,7 +3073,7 @@ static int arm_smmu_device_disable(struct arm_smmu_device *smmu) - return ret; - } - --static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) -+static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool resume) - { - int ret; - u32 reg, enables; -@@ -3134,7 +3181,7 @@ static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) - } - } - -- ret = arm_smmu_setup_irqs(smmu); -+ ret = arm_smmu_setup_irqs(smmu, resume); - if (ret) { - dev_err(smmu->dev, "failed to setup irqs\n"); - return ret; -@@ -3144,7 +3191,7 @@ static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) - enables &= ~(CR0_EVTQEN | CR0_PRIQEN); - - /* Enable the SMMU interface, or ensure bypass */ -- if (!bypass || disable_bypass) { -+ if (!smmu->bypass || disable_bypass) { - enables |= CR0_SMMUEN; - } else { - ret = arm_smmu_update_gbpa(smmu, 0, GBPA_ABORT); -@@ -3492,6 +3539,26 @@ static void __iomem *arm_smmu_ioremap(struct device *dev, resource_size_t start, - return devm_ioremap_resource(dev, &res); - } - -+#ifdef CONFIG_PM_SLEEP -+static int arm_smmu_suspend(struct device *dev) -+{ -+ /* -+ * The smmu is powered off and related registers are automatically -+ * cleared when suspend. No need to do anything. -+ */ -+ return 0; -+} -+ -+static int arm_smmu_resume(struct device *dev) -+{ -+ struct arm_smmu_device *smmu = dev_get_drvdata(dev); -+ -+ arm_smmu_device_reset(smmu, true); -+ -+ return 0; -+} -+#endif -+ - static int arm_smmu_device_probe(struct platform_device *pdev) - { - int irq, ret; -@@ -3499,7 +3566,6 @@ static int arm_smmu_device_probe(struct platform_device *pdev) - resource_size_t ioaddr; - struct arm_smmu_device *smmu; - struct device *dev = &pdev->dev; -- bool bypass; - - smmu = devm_kzalloc(dev, sizeof(*smmu), GFP_KERNEL); - if (!smmu) { -@@ -3517,7 +3583,7 @@ static int arm_smmu_device_probe(struct platform_device *pdev) - } - - /* Set bypass mode according to firmware probing result */ -- bypass = !!ret; -+ smmu->bypass = !!ret; - - /* Base address */ - res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -@@ -3578,7 +3644,7 @@ static int arm_smmu_device_probe(struct platform_device *pdev) - platform_set_drvdata(pdev, smmu); - - /* Reset the device */ -- ret = arm_smmu_device_reset(smmu, bypass); -+ ret = arm_smmu_device_reset(smmu, false); - if (ret) - return ret; - -@@ -3623,10 +3689,21 @@ static const struct of_device_id arm_smmu_of_match[] = { - }; - MODULE_DEVICE_TABLE(of, arm_smmu_of_match); - -+#ifdef CONFIG_PM_SLEEP -+static const struct dev_pm_ops arm_smmu_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(arm_smmu_suspend, -+ arm_smmu_resume) -+}; -+#define ARM_SMMU_PM_OPS (&arm_smmu_pm_ops) -+#else -+#define ARM_SMMU_PM_OPS NULL -+#endif -+ - static struct platform_driver arm_smmu_driver = { - .driver = { - .name = "arm-smmu-v3", - .of_match_table = arm_smmu_of_match, -+ .pm = ARM_SMMU_PM_OPS, - .suppress_bind_attrs = true, - }, - .probe = arm_smmu_device_probe, -diff --git a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h -index 57e5d223c..bc95e4773 100644 ---- a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h -+++ b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h -@@ -636,6 +636,7 @@ struct arm_smmu_device { - - /* IOMMU core code handle */ - struct iommu_device iommu; -+ bool bypass; - }; - - /* SMMU private data for each master */ -diff --git a/drivers/irqchip/Kconfig b/drivers/irqchip/Kconfig -index 3c24bf452..45d9ac4db 100644 ---- a/drivers/irqchip/Kconfig -+++ b/drivers/irqchip/Kconfig -@@ -599,4 +599,12 @@ config MST_IRQ - help - Support MStar Interrupt Controller. - -+config PHYTIUM_IXIC -+ bool "Phytium SoC PCI Legacy Interrupt Controller" -+ depends on ARCH_PHYTIUM -+ select IRQ_DOMAIN -+ select IRQ_DOMAIN_HIERARCHY -+ help -+ This enables support PCI Legacy Interrupt on Phytium SoC. -+ - endmenu -diff --git a/drivers/irqchip/Makefile b/drivers/irqchip/Makefile -index 94c288588..337859dd3 100644 ---- a/drivers/irqchip/Makefile -+++ b/drivers/irqchip/Makefile -@@ -114,3 +114,4 @@ obj-$(CONFIG_LOONGSON_PCH_PIC) += irq-loongson-pch-pic.o - obj-$(CONFIG_LOONGSON_PCH_MSI) += irq-loongson-pch-msi.o - obj-$(CONFIG_MST_IRQ) += irq-mst-intc.o - obj-$(CONFIG_SL28CPLD_INTC) += irq-sl28cpld.o -+obj-$(CONFIG_PHYTIUM_IXIC) += irq-phytium-ixic.o -diff --git a/drivers/irqchip/irq-gic-v3-its.c b/drivers/irqchip/irq-gic-v3-its.c -index 23ca48741..343b6f2b9 100644 ---- a/drivers/irqchip/irq-gic-v3-its.c -+++ b/drivers/irqchip/irq-gic-v3-its.c -@@ -4783,6 +4783,7 @@ static void its_restore_enable(void) - { - struct its_node *its; - int ret; -+ int cpu; - - raw_spin_lock(&its_lock); - list_for_each_entry(its, &its_nodes, entry) { -@@ -4836,6 +4837,23 @@ static void its_restore_enable(void) - GITS_TYPER_HCC(gic_read_typer(base + GITS_TYPER))) - its_cpu_init_collection(its); - } -+ -+ /* -+ * Enable LPIs:firmware just restore GICR_CTLR_ENABLE_LPIs of boot -+ * CPU, the other CPUs also should be restored. -+ */ -+ for_each_possible_cpu(cpu) { -+ void __iomem *rbase = gic_data_rdist_cpu(cpu)->rd_base; -+ u32 val; -+ -+ /*Enable LPIs*/ -+ val = readl_relaxed(rbase + GICR_CTLR); -+ if (val & GICR_CTLR_ENABLE_LPIS) -+ continue; -+ -+ val |= GICR_CTLR_ENABLE_LPIS; -+ writel_relaxed(val, rbase + GICR_CTLR); -+ } - raw_spin_unlock(&its_lock); - } - -diff --git a/drivers/irqchip/irq-phytium-ixic.c b/drivers/irqchip/irq-phytium-ixic.c -new file mode 100755 -index 000000000..9fee4c6dc ---- /dev/null -+++ b/drivers/irqchip/irq-phytium-ixic.c -@@ -0,0 +1,264 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Driver for Phytium PCIe legacy INTx interrupt controller -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+ -+#define NUM_IRQS 4 -+ -+#define CTR_BANK_NUM 6 -+#define CTR_BANK_SIZE 0x10000 -+#define CTR_BANK_ISTATUS_LOCAL 0x184 -+ -+#define HPB_INTX_STATUS_0 0x0 -+#define HPB_INTX_STATUS_1 0x1000 -+ -+struct ixic_irq_data { -+ void __iomem *ctr; -+ void __iomem *hpb; -+ u32 spi_base; -+}; -+ -+static void phytium_ixic_irq_eoi(struct irq_data *d) -+{ -+ struct ixic_irq_data *data = irq_data_get_irq_chip_data(d); -+ unsigned int intx = irqd_to_hwirq(d); -+ u32 gstatus = readl(data->hpb) | (readl(data->hpb + HPB_INTX_STATUS_1) << 12); -+ u32 imask, istatus; -+ int i; -+ -+ WARN_ON(intx >= NUM_IRQS); -+ imask = 1 << (3 - intx); -+ istatus = (1 << intx) << 24; -+ for (i = 0; i < CTR_BANK_NUM; i++, gstatus >>= 4) { -+ if (gstatus & imask) -+ writel(istatus, data->ctr + CTR_BANK_SIZE*i + CTR_BANK_ISTATUS_LOCAL); -+ } -+ -+ irq_chip_eoi_parent(d); -+} -+ -+static struct irq_chip phytium_ixic_irq_chip = { -+ .name = "IXIU", -+ .irq_eoi = phytium_ixic_irq_eoi, -+ .irq_mask = irq_chip_mask_parent, -+ .irq_unmask = irq_chip_unmask_parent, -+ .irq_set_type = irq_chip_set_type_parent, -+ .irq_set_affinity = irq_chip_set_affinity_parent, -+ .flags = IRQCHIP_MASK_ON_SUSPEND, -+}; -+ -+static int phytium_ixic_translate(struct irq_domain *domain, -+ struct irq_fwspec *fwspec, -+ unsigned long *hwirq, -+ unsigned int *type) -+{ -+ struct ixic_irq_data *info = domain->host_data; -+ -+ if (is_of_node(fwspec->fwnode)) { -+ if (fwspec->param_count != 3) -+ return -EINVAL; -+ -+ if (fwspec->param[0] != GIC_SPI) -+ return -EINVAL; /* No PPI should point to this domain */ -+ -+ *hwirq = fwspec->param[1] - info->spi_base; -+ *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; -+ } else { -+ if (fwspec->param_count != 2) -+ return -EINVAL; -+ *hwirq = fwspec->param[0] - info->spi_base; -+ *type = fwspec->param[1] & IRQ_TYPE_SENSE_MASK; -+ } -+ -+ return 0; -+} -+ -+static int phytium_ixic_alloc(struct irq_domain *dom, unsigned int virq, -+ unsigned int nr_irqs, void *data) -+{ -+ struct irq_fwspec *fwspec = data; -+ struct irq_fwspec parent_fwspec; -+ struct ixic_irq_data *info = dom->host_data; -+ irq_hw_number_t hwirq; -+ -+ /* We assume the device use the parent's format directly */ -+ parent_fwspec = *fwspec; -+ if (is_of_node(dom->parent->fwnode)) { -+ if (fwspec->param_count != 3) -+ return -EINVAL; /* Not GIC compliant */ -+ if (fwspec->param[0] != GIC_SPI) -+ return -EINVAL; /* No PPI should point to this domain */ -+ -+ /* Get the local hwirq of IXIC */ -+ hwirq = fwspec->param[1] - info->spi_base; -+ } else { -+ hwirq = fwspec->param[0] - info->spi_base; -+ } -+ WARN_ON(nr_irqs != 1); -+ irq_domain_set_hwirq_and_chip(dom, virq, hwirq, &phytium_ixic_irq_chip, info); -+ -+ parent_fwspec.fwnode = dom->parent->fwnode; -+ return irq_domain_alloc_irqs_parent(dom, virq, nr_irqs, &parent_fwspec); -+} -+ -+static const struct irq_domain_ops ixic_domain_ops = { -+ .translate = phytium_ixic_translate, -+ .alloc = phytium_ixic_alloc, -+ .free = irq_domain_free_irqs_common, -+}; -+ -+static struct ixic_irq_data *phytium_ixic_init(const struct fwnode_handle *fwnode, -+ struct resource *ctr, struct resource *hpb) -+{ -+ struct ixic_irq_data *data; -+ int err; -+ -+ data = kzalloc(sizeof(*data), GFP_KERNEL); -+ if (!data) -+ return ERR_PTR(-ENOMEM); -+ -+ if (fwnode_property_read_u32_array(fwnode, "intx-spi-base", -+ &data->spi_base, 1)) { -+ err = -ENODEV; -+ goto out_free; -+ } -+ -+ data->ctr = ioremap(ctr->start, resource_size(ctr)); -+ if (!data->ctr) { -+ err = -ENODEV; -+ goto out_free; -+ } -+ -+ data->hpb = ioremap(hpb->start, resource_size(hpb)); -+ if (!data->hpb) { -+ err = -ENODEV; -+ goto out_free; -+ } -+ -+ return data; -+ -+out_free: -+ kfree(data); -+ return ERR_PTR(err); -+} -+ -+static int __init phytium_ixic_dt_init(struct device_node *node, -+ struct device_node *parent) -+{ -+ struct irq_domain *pd, *d; -+ struct ixic_irq_data *data; -+ struct resource ctr, hpb; -+ -+ if (!parent) { -+ pr_err("%pOF: no parent, giving up\n", node); -+ return -ENODEV; -+ } -+ -+ pd = irq_find_host(parent); -+ if (!pd) { -+ pr_err("%pOF: unable to obtain parent domain\n", node); -+ return -ENXIO; -+ } -+ -+ if (of_address_to_resource(node, 0, &ctr)) { -+ pr_err("%pOF: failed to parse 'ctr' memory resource\n", node); -+ return -ENXIO; -+ } -+ -+ if (of_address_to_resource(node, 1, &hpb)) { -+ pr_err("%pOF: failed to parse 'hpb' memory resource\n", node); -+ return -ENXIO; -+ } -+ -+ data = phytium_ixic_init(of_node_to_fwnode(node), &ctr, &hpb); -+ if (IS_ERR(data)) -+ return PTR_ERR(data); -+ -+ d = irq_domain_add_hierarchy(pd, 0, NUM_IRQS, node, &ixic_domain_ops, data); -+ if (!d) { -+ pr_err("%pOF: failed to allocate domain\n", node); -+ goto out_unmap; -+ } -+ -+ pr_info("%pOF: %d interrupts forwarded to %pOF\n", node, NUM_IRQS, parent); -+ -+ return 0; -+ -+out_unmap: -+ iounmap(data->ctr); -+ iounmap(data->hpb); -+ kfree(data); -+ return -ENOMEM; -+} -+IRQCHIP_DECLARE(ixic, "phytium,ixic", phytium_ixic_dt_init); -+ -+#ifdef CONFIG_ACPI -+static int phytium_ixic_acpi_probe(struct platform_device *pdev) -+{ -+ struct irq_domain *domain; -+ struct ixic_irq_data *data; -+ struct resource *ctr, *hpb; -+ -+ ctr = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ if (!ctr) { -+ dev_err(&pdev->dev, "failed to parse 'ctr' memory resource\n"); -+ return -ENXIO; -+ } -+ -+ hpb = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ if (!hpb) { -+ dev_err(&pdev->dev, "failed to parse 'hpb' memory resource\n"); -+ return -ENXIO; -+ } -+ -+ data = phytium_ixic_init(dev_fwnode(&pdev->dev), ctr, hpb); -+ if (IS_ERR(data)) -+ return PTR_ERR(data); -+ -+ domain = acpi_irq_create_hierarchy(0, NUM_IRQS, dev_fwnode(&pdev->dev), -+ &ixic_domain_ops, data); -+ if (!domain) { -+ dev_err(&pdev->dev, "failed to create IRQ domain\n"); -+ goto out_unmap; -+ } -+ -+ dev_info(&pdev->dev, "%d interrupts forwarded\n", NUM_IRQS); -+ -+ return 0; -+ -+out_unmap: -+ iounmap(data->ctr); -+ iounmap(data->hpb); -+ kfree(data); -+ return -ENOMEM; -+} -+ -+static const struct acpi_device_id phytium_ixic_acpi_ids[] = { -+ { "PHYT0013" }, -+ { /* sentinel */ } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_ixic_acpi_ids); -+ -+static struct platform_driver phytium_ixic_driver = { -+ .driver = { -+ .name = "phytium-ixic", -+ .acpi_match_table = phytium_ixic_acpi_ids, -+ }, -+ .probe = phytium_ixic_acpi_probe, -+}; -+builtin_platform_driver(phytium_ixic_driver); -+#endif -diff --git a/drivers/mailbox/Kconfig b/drivers/mailbox/Kconfig -index 05b1009e2..e75a6824a 100644 ---- a/drivers/mailbox/Kconfig -+++ b/drivers/mailbox/Kconfig -@@ -254,4 +254,13 @@ config QCOM_IPCC - acts as an interrupt controller for receiving interrupts from clients. - Say Y here if you want to build this driver. - -+config PHYTIUM_MBOX -+ tristate "Phytium SoC Mailbox Support" -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ help -+ Mailbox driver implementation for the Phytium platform. It is used -+ to send message between application processors and on-chip management -+ firmware. Say Y here if you want to build this mailbox controller -+ driver. -+ - endif -diff --git a/drivers/mailbox/Makefile b/drivers/mailbox/Makefile -index 2e06e02b2..e08fb4b9a 100644 ---- a/drivers/mailbox/Makefile -+++ b/drivers/mailbox/Makefile -@@ -54,3 +54,5 @@ obj-$(CONFIG_SUN6I_MSGBOX) += sun6i-msgbox.o - obj-$(CONFIG_SPRD_MBOX) += sprd-mailbox.o - - obj-$(CONFIG_QCOM_IPCC) += qcom-ipcc.o -+ -+obj-$(CONFIG_PHYTIUM_MBOX) += phytium-mailbox.o -diff --git a/drivers/mailbox/phytium-mailbox.c b/drivers/mailbox/phytium-mailbox.c -new file mode 100644 -index 000000000..c2754f766 ---- /dev/null -+++ b/drivers/mailbox/phytium-mailbox.c -@@ -0,0 +1,214 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SoC mailbox driver -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define INTR_STAT 0x0 -+#define INTR_SET 0x8 -+#define INTR_CLR 0x10 -+ -+#define TX_REG 0x100 -+ -+#define NR_CHANS 1 -+ -+static spinlock_t lock; -+ -+struct phytium_mbox_link { -+ unsigned int irq; -+ void __iomem *tx_reg; -+ void __iomem *rx_reg; -+}; -+ -+struct phytium_mbox { -+ void __iomem *base; -+ struct phytium_mbox_link mlink; -+ struct mbox_chan chan; -+ struct mbox_controller mbox; -+}; -+ -+static irqreturn_t phytium_mbox_rx_irq(int irq, void *ch) -+{ -+ struct mbox_chan *chan = ch; -+ struct phytium_mbox_link *mlink = chan->con_priv; -+ u32 val; -+ unsigned long flags = 0; -+ -+ spin_lock_irqsave(&lock, flags); -+ val = readl_relaxed(mlink->rx_reg + INTR_STAT); -+ spin_unlock_irqrestore(&lock, flags); -+ if (!val) -+ return IRQ_NONE; -+ -+ mbox_chan_received_data(chan, (void *)&val); -+ -+ spin_lock_irqsave(&lock, flags); -+ writel_relaxed(val, mlink->rx_reg + INTR_CLR); -+ spin_unlock_irqrestore(&lock, flags); -+ -+ return IRQ_HANDLED; -+} -+ -+static int phytium_mbox_send_data(struct mbox_chan *chan, void *data) -+{ -+ struct phytium_mbox_link *mlink = chan->con_priv; -+ u32 *arg = data; -+ unsigned long flags = 0; -+ -+ spin_lock_irqsave(&lock, flags); -+ writel_relaxed(*arg, mlink->tx_reg + INTR_SET); -+ spin_unlock_irqrestore(&lock, flags); -+ -+ return 0; -+} -+ -+static int phytium_mbox_startup(struct mbox_chan *chan) -+{ -+ struct phytium_mbox_link *mlink = chan->con_priv; -+ u32 val; -+ int ret; -+ unsigned long flags = 0; -+ -+ spin_lock_irqsave(&lock, flags); -+ val = readl_relaxed(mlink->tx_reg + INTR_STAT); -+ writel_relaxed(val, mlink->tx_reg + INTR_CLR); -+ spin_unlock_irqrestore(&lock, flags); -+ -+ ret = request_irq(mlink->irq, phytium_mbox_rx_irq, -+ IRQF_SHARED, "phytium_mbox_link", chan); -+ if (ret) { -+ dev_err(chan->mbox->dev, -+ "Unable to acquire IRQ %d\n", mlink->irq); -+ } -+ -+ return ret; -+} -+ -+static void phytium_mbox_shutdown(struct mbox_chan *chan) -+{ -+ struct phytium_mbox_link *mlink = chan->con_priv; -+ -+ free_irq(mlink->irq, chan); -+} -+ -+static bool phytium_mbox_last_tx_done(struct mbox_chan *chan) -+{ -+ unsigned long flags; -+ struct phytium_mbox_link *mlink = chan->con_priv; -+ u32 val; -+ -+ spin_lock_irqsave(&lock, flags); -+ val = readl_relaxed(mlink->tx_reg + INTR_STAT); -+ spin_unlock_irqrestore(&lock, flags); -+ -+ return (val == (u32)(1U << 31)); -+} -+ -+static const struct mbox_chan_ops phytium_mbox_ops = { -+ .send_data = phytium_mbox_send_data, -+ .startup = phytium_mbox_startup, -+ .shutdown = phytium_mbox_shutdown, -+ .last_tx_done = phytium_mbox_last_tx_done, -+}; -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_mbox_acpi_match[] = { -+ { "PHYT0009", 0 }, -+ { }, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_mbox_acpi_match); -+#endif -+ -+static const struct of_device_id phytium_mbox_of_match[] = { -+ { .compatible = "phytium,mbox", }, -+ { }, -+}; -+MODULE_DEVICE_TABLE(of, phytium_mbox_of_match); -+ -+static int phytium_mbox_probe(struct platform_device *pdev) -+{ -+ struct phytium_mbox *mbox; -+ struct resource *res; -+ int err, irq; -+ -+ spin_lock_init(&lock); -+ -+ /* Allocate memory for device */ -+ mbox = devm_kzalloc(&pdev->dev, sizeof(*mbox), GFP_KERNEL); -+ if (!mbox) -+ return -ENOMEM; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ mbox->base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(mbox->base)) { -+ dev_err(&pdev->dev, "ioremap base failed\n"); -+ return PTR_ERR(mbox->base); -+ } -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) { -+ dev_err(&pdev->dev, "cannot obtain irq\n"); -+ return irq; -+ } -+ -+ mbox->chan.con_priv = &mbox->mlink; -+ mbox->mlink.irq = irq; -+ mbox->mlink.rx_reg = mbox->base; -+ mbox->mlink.tx_reg = mbox->mlink.rx_reg + TX_REG; -+ -+ mbox->mbox.dev = &pdev->dev; -+ mbox->mbox.chans = &mbox->chan; -+ mbox->mbox.num_chans = NR_CHANS; -+ mbox->mbox.ops = &phytium_mbox_ops; -+ mbox->mbox.txdone_irq = false; -+ mbox->mbox.txdone_poll = true; -+ mbox->mbox.txpoll_period = 1; -+ -+ platform_set_drvdata(pdev, mbox); -+ -+ err = mbox_controller_register(&mbox->mbox); -+ if (err) { -+ dev_err(&pdev->dev, "Failed to register mailboxes %d\n", err); -+ goto fail; -+ } -+ -+ dev_info(&pdev->dev, "Phytium SoC Mailbox registered\n"); -+fail: -+ return err; -+} -+ -+static int phytium_mbox_remove(struct platform_device *pdev) -+{ -+ struct phytium_mbox *mbox = platform_get_drvdata(pdev); -+ -+ mbox_controller_unregister(&mbox->mbox); -+ -+ return 0; -+} -+ -+static struct platform_driver phytium_mbox_driver = { -+ .probe = phytium_mbox_probe, -+ .remove = phytium_mbox_remove, -+ .driver = { -+ .name = "phytium-mbox", -+ .of_match_table = of_match_ptr(phytium_mbox_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_mbox_acpi_match), -+ }, -+}; -+ -+module_platform_driver(phytium_mbox_driver); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium SoC Mailbox Driver"); -+MODULE_AUTHOR("Chen Baozi "); -diff --git a/drivers/media/platform/Kconfig b/drivers/media/platform/Kconfig -index 7e152bbb4..a7ff83d43 100644 ---- a/drivers/media/platform/Kconfig -+++ b/drivers/media/platform/Kconfig -@@ -168,6 +168,15 @@ config VIDEO_TI_CAL - In TI Technical Reference Manual this module is referred as - Camera Interface Subsystem (CAMSS). - -+config VIDEO_PHYTIUM_JPEG -+ tristate "Phytium JPEG Encoder driver" -+ depends on VIDEO_V4L2 -+ select VIDEOBUF2_DMA_CONTIG -+ help -+ Support for the Phytium JPEG Encoder Engine embedded -+ in the Phytium SOCs. The engine can capture and -+ compress video data from digital or analog sources. -+ - endif # V4L_PLATFORM_DRIVERS - - menuconfig V4L_MEM2MEM_DRIVERS -diff --git a/drivers/media/platform/Makefile b/drivers/media/platform/Makefile -index 62b6cdc8c..4fa3b8e28 100644 ---- a/drivers/media/platform/Makefile -+++ b/drivers/media/platform/Makefile -@@ -80,3 +80,5 @@ obj-$(CONFIG_VIDEO_QCOM_CAMSS) += qcom/camss/ - obj-$(CONFIG_VIDEO_QCOM_VENUS) += qcom/venus/ - - obj-y += sunxi/ -+obj-$(CONFIG_VIDEO_PHYTIUM_JPEG) += phytium-jpeg/ -+ -diff --git a/drivers/media/platform/phytium-jpeg/Makefile b/drivers/media/platform/phytium-jpeg/Makefile -new file mode 100644 -index 000000000..d9f50a1aa ---- /dev/null -+++ b/drivers/media/platform/phytium-jpeg/Makefile -@@ -0,0 +1,3 @@ -+# SPDX-License-Identifier: GPL-2.0-only -+phytium_jpeg-objs := phytium_jpeg_core.o -+obj-$(CONFIG_VIDEO_PHYTIUM_JPEG) += phytium_jpeg.o -diff --git a/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.c b/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.c -new file mode 100644 -index 000000000..f37db3030 ---- /dev/null -+++ b/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.c -@@ -0,0 +1,1379 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Driver for Phytium JPEG Encoder Engine -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include "phytium_jpeg_reg.h" -+#include "phytium_jpeg_core.h" -+#include -+ -+static u32 phytium_jpeg_header[PHYTIUM_JPEG_HEADER_SIZE] = { -+ 0xe0ffd8ff, 0x464a0100, 0x01004649, 0x01000001, -+ 0x00000100, 0x4300dbff, 0x0c0b1000, 0x100a0c0e, -+ 0x120e0d0e, 0x18131011, 0x16181a28, 0x23311816, -+ 0x3a281d25, 0x393c3d33, 0x40373833, 0x404e5c48, -+ 0x37455744, 0x516d5038, 0x67625f57, 0x4d3e6768, -+ 0x64707971, 0x67655c78, 0x00dbff63, 0x12110143, -+ 0x18151812, 0x2f1a1a2f, 0x42384263, 0x63636363, -+ 0x63636363, 0x63636363, 0x63636363, 0x63636363, -+ 0x63636363, 0x63636363, 0x63636363, 0x63636363, -+ 0x63636363, 0x63636363, 0x63636363, 0xc0ff6363, -+ /* h_index(40) indicates high 8 bits of the height -+ * w_index(41) contains the low 8 bits of the height, -+ * and the width. For example, height 480(0x01e0) -+ * locates at 0x<01> 081100 and 0x038002 . -+ * width 640 (0x0280) locates at 0x03 <80> <02> e0. -+ */ -+ -+ /* 0x0200 <11> 01 is a field marks YUV mode */ -+ 0x01081100, 0x038002e0, 0x02001101, 0x11030111, -+ 0x00c4ff01, 0x0100001f, 0x01010105, 0x00010101, -+ 0x00000000, 0x01000000, 0x05040302, 0x09080706, -+ 0xc4ff0b0a, 0x00011f00, 0x01010103, 0x01010101, -+ 0x00000101, 0x00000000, 0x04030201, 0x08070605, -+ 0xff0b0a09, 0x10b500c4, 0x03010200, 0x03040203, -+ 0x04040505, 0x7d010000, 0x00030201, 0x12051104, -+ 0x06413121, 0x07615113, 0x32147122, 0x08a19181, -+ 0xc1b14223, 0xf0d15215, 0x72623324, 0x160a0982, -+ 0x1a191817, 0x28272625, 0x35342a29, 0x39383736, -+ 0x4544433a, 0x49484746, 0x5554534a, 0x59585756, -+ 0x6564635a, 0x69686766, 0x7574736a, 0x79787776, -+ 0x8584837a, 0x89888786, 0x9493928a, 0x98979695, -+ 0xa3a29a99, 0xa7a6a5a4, 0xb2aaa9a8, 0xb6b5b4b3, -+ 0xbab9b8b7, 0xc5c4c3c2, 0xc9c8c7c6, 0xd4d3d2ca, -+ 0xd8d7d6d5, 0xe2e1dad9, 0xe6e5e4e3, 0xeae9e8e7, -+ 0xf4f3f2f1, 0xf8f7f6f5, 0xc4fffaf9, 0x0011b500, -+ 0x04020102, 0x07040304, 0x00040405, 0x00770201, -+ 0x11030201, 0x31210504, 0x51411206, 0x13716107, -+ 0x08813222, 0xa1914214, 0x2309c1b1, 0x15f05233, -+ 0x0ad17262, 0xe1342416, 0x1817f125, 0x27261a19, -+ 0x352a2928, 0x39383736, 0x4544433a, 0x49484746, -+ 0x5554534a, 0x59585756, 0x6564635a, 0x69686766, -+ 0x7574736a, 0x79787776, 0x8483827a, 0x88878685, -+ 0x93928a89, 0x97969594, 0xa29a9998, 0xa6a5a4a3, -+ 0xaaa9a8a7, 0xb5b4b3b2, 0xb9b8b7b6, 0xc4c3c2ba, -+ 0xc8c7c6c5, 0xd3d2cac9, 0xd7d6d5d4, 0xe2dad9d8, -+ 0xe6e5e4e3, 0xeae9e8e7, 0xf5f4f3f2, 0xf9f8f7f6, -+ 0x00fefffa, 0x0000008f, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0xdaff0000, 0x01030c00, 0x03110200, 0x003f0011 -+}; -+ -+static char yuv_mode_str[YUV_MODE_STR_LEN] = { "yuv444" }; -+ -+module_param_string(yuv_mode, yuv_mode_str, sizeof(yuv_mode_str), 0444); -+MODULE_PARM_DESC(yuv_mode, "Users select one mode from such modes as 'yuv444', or 'yuv422', or 'yuv420'. If no mode is set, the driver adapts defaults mode 'yuv444'."); -+ -+static u32 phytium_jpeg_read(struct phytium_jpeg_dev *jpeg_dev, u32 reg) -+{ -+ u32 reg_val = readl(jpeg_dev->base_addr + reg); -+ -+ dev_dbg(jpeg_dev->dev, "read 0x%p + 0x%x -->val[0x%x]\n", -+ jpeg_dev->base_addr, reg, reg_val); -+ -+ return reg_val; -+} -+ -+static void phytium_jpeg_write(struct phytium_jpeg_dev *jpeg_dev, -+ u32 reg, u32 val) -+{ -+ writel(val, jpeg_dev->base_addr + reg); -+ dev_dbg(jpeg_dev->dev, "write 0x%x to addr 0x%p + 0x%x\n", -+ val, jpeg_dev->base_addr, reg); -+} -+ -+static void phytium_jpeg_update(struct phytium_jpeg_dev *jpeg_dev, u32 reg, -+ u32 clear, u32 bits) -+{ -+ u32 reg_val = readl(jpeg_dev->base_addr + reg); -+ u32 tmp = reg_val; -+ -+ reg_val &= ~clear; -+ reg_val |= bits; -+ writel(reg_val, jpeg_dev->base_addr + reg); -+ -+ dev_dbg(jpeg_dev->dev, "the val of addr 0x%p + 0x%x, from 0x%x to 0x%x\n", -+ jpeg_dev->base_addr, reg, tmp, readl(jpeg_dev->base_addr + reg)); -+} -+ -+static void phytium_jpeg_init_regs(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ u32 transform_info = 0; -+ u32 disable_all_interrupt = 0; -+ u32 clear_all_interrupt = INT_FIFO_OVERFLOW | INT_OCM_BUF_OVERFLOW | -+ INT_JPEG_ENCODE_COMPLETE | INT_VIDEO_FORMAT_CHANGE; -+ u32 rate_to_reg = 0; -+ -+ /* First, disable the JPEG engine, set bit0 = 0*/ -+ phytium_jpeg_write(jpeg_dev, TRANSFORM_INFO_REG, transform_info); -+ -+ /* Second, set VGAvideo_source_information. bit1 = 0 marks VGA */ -+ transform_info |= 0; -+ -+ /* Third, set AXI burst length bit[16:22]= 0xf , default value*/ -+ transform_info |= (0xF << TRANS_AXI_LEN_SHIFT) & TRANSINFO_AXI_LEN; -+ -+ /* Fourth, the default sampling format is YUV422, set bit13 to 0 */ -+ /* ignore setting sampling interval */ -+ phytium_jpeg_write(jpeg_dev, TRANSFORM_INFO_REG, transform_info); -+ udelay(5); -+ -+ /* Fifth, setting frame rate. -+ * Linux driver prohibit float point operations. So use the -+ * format: reg_val = (1 second * 10^8 / frame_rate / 134 *100) -+ * write reg_val to register. then enable Highest bit31 = 1 -+ */ -+ if (jpeg_dev->frame_rate) { -+ rate_to_reg = 100000000 / jpeg_dev->frame_rate / 134 * 100; -+ rate_to_reg |= FRAME_SAMPLE_CTRL_EN; -+ phytium_jpeg_write(jpeg_dev, FRAME_SAMPLE_CTRL, rate_to_reg); -+ } -+ /* Sixth, HUFF_MODE, driver needn't to configure, ignore */ -+ -+ /* disable all interrupts and then clear all interrupts */ -+ phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, -+ disable_all_interrupt); -+ udelay(5); -+ phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, clear_all_interrupt); -+ -+ /* Seventh, Sample_mode, hardware default is yuv444 */ -+ jpeg_dev->yuv420 = false; -+} -+ -+/* Turn on the clock of the jpeg engine */ -+static void phytium_jpeg_on(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ if (test_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status)) -+ return; -+ -+ /* Turn on the relevant clocks */ -+ set_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status); -+} -+ -+/* Disable the jpeg engine */ -+static void phytium_jpeg_off(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ u32 disable_all_interrupt = 0; -+ u32 clear_all_interrupt = INT_FIFO_OVERFLOW | INT_OCM_BUF_OVERFLOW | -+ INT_JPEG_ENCODE_COMPLETE | INT_VIDEO_FORMAT_CHANGE; -+ -+ if (!test_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status)) { -+ dev_info(jpeg_dev->dev, "JPEG Engine is already off.\n"); -+ return; -+ } -+ -+ /* disable all interrupt */ -+ phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, disable_all_interrupt); -+ /* clear all interrupt */ -+ phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, clear_all_interrupt); -+ /* disable JPEG engine */ -+ phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 0); -+ -+ clear_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status); -+ /* wait 50 ms */ -+ mdelay(50); -+ /* C08 bit7 1:busy */ -+} -+ -+static inline void phytium_jpeg_enable_source_detecting(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ /* -+ * Enable the dectection to discovery -+ * the source resolution is changed -+ */ -+ //phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, DETECT_RESOLUTION_CHANGE_EN); -+ phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, 0, TRANSINFO_SRC_SELECT); -+} -+ -+#define res_check(val) \ -+ test_and_clear_bit(VIDEO_MODE_DETECT_DONE, &(val)->status) -+ -+static void phytium_jpeg_get_resolution(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ u32 source_info; -+ u32 width; -+ u32 height; -+ struct v4l2_bt_timings *detected_timings = &jpeg_dev->detected_timings; -+ -+ /* Before get a new resolution, maybe need to wait 10 us */ -+ detected_timings->width = MIN_WIDTH; -+ detected_timings->height = MIN_HEIGHT; -+ jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; -+ -+ -+ phytium_jpeg_enable_source_detecting(jpeg_dev); -+ source_info = phytium_jpeg_read(jpeg_dev, SRC_VGA_INFO_REG); -+ width = (source_info & SRC_HOR_PIXELS) >> SRC_WIDTH_SHIFT; -+ height = (source_info & SRC_VER_PIXELS) >> SRC_HEIGHT_SHIFT; -+ -+ if (width * height != 0) { -+ detected_timings->width = width; -+ detected_timings->height = height; -+ } -+ -+ jpeg_dev->v4l2_input_status = 0; -+ -+ /* -+ * Resolution is changed will trigger an interrupt, resolution detecting -+ * also is disable during process interrupt. So re-enable. -+ */ -+ phytium_jpeg_enable_source_detecting(jpeg_dev); -+ dev_info(jpeg_dev->dev, "Change resolution: %uX%u\n", width, height); -+} -+ -+static void phytium_jpeg_set_resolution(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ struct v4l2_bt_timings *active_timings = &jpeg_dev->active_timings; -+ int i; -+ int src_addrs[OCM_BUF_NUM]; -+ /* -+ * The OCM address space is 0x30C0_0000 ~ 0x30C7_FFFF, JPEG Engine uses the -+ * high-bottom address. src_0 uses 0x30C4_0000 ~ 0x30c6_0000 (total capacity is -+ * 128KB, greater than the requirements of the largest resolution). src_1 uses -+ * 0x30C6_0000 ~ 0x30C7_FFFF. -+ */ -+ -+ /* The OCM address should shift right 8 bits */ -+ for (i = 0; i < OCM_BUF_NUM; i++) -+ src_addrs[i] = jpeg_dev->src_addrs[i].dma_addr >> OCM_BUF_SHIFT; -+ -+ phytium_jpeg_write(jpeg_dev, OCM_BUF0_ADDR, src_addrs[0]); -+ phytium_jpeg_write(jpeg_dev, OCM_BUF1_ADDR, src_addrs[1]); -+ -+ /* -+ * In the worst case, the size of one image will be compressed to 25% the -+ * raw image's size. When a pixel is 4-byte, no need to divide 4. -+ */ -+ jpeg_dev->max_compressed_size = active_timings->width * active_timings->height; -+} -+ -+/* The below functions is implemented for various v4l2 ioctl operations */ -+static int phytium_jpeg_querycap(struct file *file, void *priv, -+ struct v4l2_capability *cap) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ strscpy(cap->driver, PHYTIUM_JPEG_NAME, sizeof(cap->driver)); -+ strscpy(cap->card, "Phytium JPEG Engine", sizeof(cap->card)); -+ snprintf(cap->bus_info, sizeof(cap->bus_info), "platform:%s", dev_name(jpeg_dev->dev)); -+ -+ return 0; -+} -+ -+static int phytium_jpeg_enum_format(struct file *file, void *priv, -+ struct v4l2_fmtdesc *f) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ if (f->index) { -+ dev_err(jpeg_dev->dev, "Failed to enum format\n"); -+ return -EINVAL; -+ } -+ -+ f->pixelformat = V4L2_PIX_FMT_JPEG; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_get_format(struct file *file, void *priv, -+ struct v4l2_format *f) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ f->fmt.pix = jpeg_dev->pix_fmt; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_enum_input(struct file *file, void *priv, -+ struct v4l2_input *input) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ if (input->index) { -+ dev_err(jpeg_dev->dev, "failed to enum input\n"); -+ return -EINVAL; -+ } -+ -+ strscpy(input->name, "Host DC Capture", sizeof(input->name)); -+ input->type = V4L2_INPUT_TYPE_CAMERA; -+ input->capabilities = V4L2_IN_CAP_DV_TIMINGS; -+ input->status = jpeg_dev->v4l2_input_status; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_get_input(struct file *file, void *priv, -+ unsigned int *i) -+{ -+ *i = 0; -+ return 0; -+} -+ -+static int phytium_jpeg_set_input(struct file *file, void *priv, -+ unsigned int i) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ if (i != 0) { -+ dev_err(jpeg_dev->dev, "Failed to set input\n"); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int phytium_jpeg_get_parm(struct file *file, void *priv, -+ struct v4l2_streamparm *stream) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ /* Readbuffers num is 3 */ -+ stream->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; -+ stream->parm.capture.readbuffers = CAPTURE_BUF_NUMBER; -+ stream->parm.capture.timeperframe.denominator = 1; -+ -+ if (jpeg_dev->frame_rate == 0) -+ stream->parm.capture.timeperframe.denominator = MAX_FRAME_RATE; -+ else -+ stream->parm.capture.timeperframe.denominator = jpeg_dev->frame_rate; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_set_parm(struct file *file, void *priv, -+ struct v4l2_streamparm *stream) -+{ -+ unsigned int frame_rate = 0; -+ u32 rate_to_reg = 0; -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ /* Readbuffers num is 3 */ -+ stream->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; -+ stream->parm.capture.readbuffers = CAPTURE_BUF_NUMBER; -+ -+ if (stream->parm.capture.timeperframe.numerator) -+ frame_rate = stream->parm.capture.timeperframe.denominator / -+ stream->parm.capture.timeperframe.numerator; -+ -+ if (frame_rate == 0 || frame_rate > MAX_FRAME_RATE) { -+ frame_rate = MAX_FRAME_RATE; -+ stream->parm.capture.timeperframe.denominator = MAX_FRAME_RATE; -+ stream->parm.capture.timeperframe.numerator = 1; -+ } -+ /* -+ * reg_val = (1 second * 10^9 / frame_rate / 13.4) -+ * Linux driver prohibit float point operations. So use the -+ * format: reg_val = (1 second * 10^8 / frame_rate / 134 *100) -+ * write reg_val to register. then enable Highest bit31 = 1 -+ */ -+ if (jpeg_dev->frame_rate != frame_rate) { -+ jpeg_dev->frame_rate = frame_rate; -+ rate_to_reg = 100000000 / jpeg_dev->frame_rate / 134 * 100; -+ rate_to_reg |= FRAME_SAMPLE_CTRL_EN; -+ phytium_jpeg_write(jpeg_dev, FRAME_SAMPLE_CTRL, rate_to_reg); -+ } -+ -+ return 0; -+} -+ -+static int phytium_jpeg_enum_framesizes(struct file *file, void *priv, -+ struct v4l2_frmsizeenum *fsize) -+ -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ if (fsize->index != 0) { -+ dev_err(jpeg_dev->dev, "Failed to enum framesize.\n"); -+ return -EINVAL; -+ } -+ -+ if (fsize->pixel_format != V4L2_PIX_FMT_JPEG) { -+ dev_err(jpeg_dev->dev, "enum framesize pixel_format is not JPEG"); -+ return -EINVAL; -+ } -+ -+ fsize->discrete.width = jpeg_dev->pix_fmt.width; -+ fsize->discrete.height = jpeg_dev->pix_fmt.height; -+ fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; -+ -+ return 0; -+ -+} -+ -+static int phytium_jpeg_enum_frameintervals(struct file *file, void *priv, -+ struct v4l2_frmivalenum *fival) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ if (fival->index != 0) { -+ dev_err(jpeg_dev->dev, "enum frame intervals failed\n"); -+ return -EINVAL; -+ } -+ -+ if (fival->width != jpeg_dev->detected_timings.width || -+ fival->height != jpeg_dev->detected_timings.height) { -+ dev_err(jpeg_dev->dev, "interval isn't same with the detected_timings.\n"); -+ return -EINVAL; -+ } -+ -+ if (fival->pixel_format != V4L2_PIX_FMT_JPEG) { -+ dev_err(jpeg_dev->dev, "enum frame interval pixel fomat is incorrect.\n"); -+ return -EINVAL; -+ } -+ -+ fival->type = V4L2_FRMIVAL_TYPE_CONTINUOUS; -+ fival->stepwise.min.denominator = MAX_FRAME_RATE; -+ fival->stepwise.min.numerator = 1; -+ fival->stepwise.max.denominator = 1; -+ fival->stepwise.max.numerator = 1; -+ fival->stepwise.step = fival->stepwise.max; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_set_dv_timings(struct file *file, void *priv, -+ struct v4l2_dv_timings *timings) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ /* the params are passed from user space are same with hardware's params */ -+ if (timings->bt.width == jpeg_dev->active_timings.width && -+ timings->bt.height == jpeg_dev->active_timings.height) -+ return 0; -+ -+ if (vb2_is_busy(&jpeg_dev->queue)) { -+ dev_err(jpeg_dev->dev, "queue is busy during setting dv timings.\n"); -+ return -EBUSY; -+ } -+ -+ jpeg_dev->active_timings = timings->bt; -+ phytium_jpeg_set_resolution(jpeg_dev); -+ jpeg_dev->pix_fmt.width = timings->bt.width; -+ jpeg_dev->pix_fmt.height = timings->bt.height; -+ jpeg_dev->pix_fmt.sizeimage = jpeg_dev->max_compressed_size; -+ timings->type = V4L2_DV_BT_656_1120; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_get_dv_timings(struct file *file, void *priv, -+ struct v4l2_dv_timings *timings) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ timings->type = V4L2_DV_BT_656_1120; -+ timings->bt = jpeg_dev->active_timings; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_query_dv_timings(struct file *file, void *priv, -+ struct v4l2_dv_timings *timings) -+{ -+ int ret; -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ /* -+ * This blocks only if the driver is currently in the process of -+ * detecting a new resolution; in the event of no signal or timeout -+ * this function is woken up. -+ */ -+ if ((file->f_flags & O_NONBLOCK) && -+ test_bit(VIDEO_RES_CHANGE, &jpeg_dev->status)) -+ return -EAGAIN; -+ -+ ret = wait_event_interruptible(jpeg_dev->wait, !test_bit(VIDEO_RES_CHANGE, -+ &jpeg_dev->status)); -+ if (ret) { -+ dev_err(jpeg_dev->dev, "Failed to query dv timing\n"); -+ return -EINTR; -+ } -+ -+ timings->type = V4L2_DV_BT_656_1120; -+ timings->bt = jpeg_dev->detected_timings; -+ -+ return jpeg_dev->v4l2_input_status ? -ENOLINK : 0; -+} -+ -+static const struct v4l2_dv_timings_cap phytium_jpeg_timings_cap = { -+ .type = V4L2_DV_BT_656_1120, -+ .bt = { -+ .min_width = MIN_WIDTH, -+ .max_width = MAX_WIDTH, -+ .min_height = MIN_HEIGHT, -+ .max_height = MAX_HEIGHT, -+ .min_pixelclock = 6574080, /* 640 x 480 x 24Hz */ -+ .max_pixelclock = 1244160000, /* 1920 x 1080 x 60Hz */ -+ .standards = V4L2_DV_BT_STD_CEA861 | V4L2_DV_BT_STD_DMT | -+ V4L2_DV_BT_STD_CVT | V4L2_DV_BT_STD_GTF, -+ .capabilities = V4L2_DV_BT_CAP_PROGRESSIVE | -+ V4L2_DV_BT_CAP_REDUCED_BLANKING | -+ V4L2_DV_BT_CAP_CUSTOM, -+ }, -+}; -+ -+static int phytium_jpeg_enum_dv_timings(struct file *file, void *priv, -+ struct v4l2_enum_dv_timings *timings) -+{ -+ return v4l2_enum_dv_timings_cap(timings, &phytium_jpeg_timings_cap, -+ NULL, NULL); -+} -+ -+static int phytium_jpeg_dv_timings_cap(struct file *file, void *priv, -+ struct v4l2_dv_timings_cap *cap) -+{ -+ *cap = phytium_jpeg_timings_cap; -+ -+ return 0; -+} -+ -+/* The function is used to notify DV that video resolution is altered */ -+static int phytium_jpeg_sub_event(struct v4l2_fh *fh, -+ const struct v4l2_event_subscription *sub) -+{ -+ switch (sub->type) { -+ case V4L2_EVENT_SOURCE_CHANGE: -+ return v4l2_src_change_event_subscribe(fh, sub); -+ default: -+ break; -+ } -+ -+ return v4l2_ctrl_subscribe_event(fh, sub); -+} -+ -+static const struct v4l2_ioctl_ops phytium_jpeg_ioctl_ops = { -+ .vidioc_querycap = phytium_jpeg_querycap, -+ .vidioc_enum_fmt_vid_cap = phytium_jpeg_enum_format, -+ .vidioc_g_fmt_vid_cap = phytium_jpeg_get_format, -+ .vidioc_s_fmt_vid_cap = phytium_jpeg_get_format, -+ .vidioc_try_fmt_vid_cap = phytium_jpeg_get_format, -+ .vidioc_reqbufs = vb2_ioctl_reqbufs, -+ .vidioc_querybuf = vb2_ioctl_querybuf, -+ .vidioc_qbuf = vb2_ioctl_qbuf, -+ .vidioc_expbuf = vb2_ioctl_expbuf, -+ .vidioc_dqbuf = vb2_ioctl_dqbuf, -+ .vidioc_create_bufs = vb2_ioctl_create_bufs, -+ .vidioc_prepare_buf = vb2_ioctl_prepare_buf, -+ .vidioc_streamon = vb2_ioctl_streamon, -+ .vidioc_streamoff = vb2_ioctl_streamoff, -+ .vidioc_enum_input = phytium_jpeg_enum_input, -+ .vidioc_g_input = phytium_jpeg_get_input, -+ .vidioc_s_input = phytium_jpeg_set_input, -+ .vidioc_g_parm = phytium_jpeg_get_parm, -+ .vidioc_s_parm = phytium_jpeg_set_parm, -+ .vidioc_enum_framesizes = phytium_jpeg_enum_framesizes, -+ .vidioc_enum_frameintervals = phytium_jpeg_enum_frameintervals, -+ .vidioc_s_dv_timings = phytium_jpeg_set_dv_timings, -+ .vidioc_g_dv_timings = phytium_jpeg_get_dv_timings, -+ .vidioc_query_dv_timings = phytium_jpeg_query_dv_timings, -+ .vidioc_enum_dv_timings = phytium_jpeg_enum_dv_timings, -+ .vidioc_dv_timings_cap = phytium_jpeg_dv_timings_cap, -+ .vidioc_subscribe_event = phytium_jpeg_sub_event, -+ .vidioc_unsubscribe_event = v4l2_event_unsubscribe, -+}; -+ -+static void phytium_jpeg_init_jpeg_quant(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ const u32 y_quant_table[QUANT_REG_NUM] = { -+ 0x08000000, 0x0ba2e8ba, 0x0aaaaaab, 0x09249249, 0x0aaaaaab, -+ 0x0ccccccc, 0x08000000, 0x09249249, 0x09d89d8a, 0x09249249, -+ 0x071c71c7, 0x07878788, 0x08000000, 0x06bca1af, 0x05555555, -+ 0x03333333, 0x04ec4ec5, 0x05555555, 0x05d1745d, 0x05d1745d, -+ 0x05555555, 0x029cbc15, 0x03a83a84, 0x03759f23, 0x0469ee58, -+ 0x03333333, 0x0234f72c, 0x02828283, 0x02192e2a, 0x02222222, -+ 0x023ee090, 0x02828283, 0x02492492, 0x0253c825, 0x02000000, -+ 0x01c71c72, 0x01642c86, 0x01a41a42, 0x02000000, 0x01e1e1e2, -+ 0x0178a4c8, 0x01dae607, 0x0253c825, 0x02492492, 0x0199999a, -+ 0x012c9fb5, 0x01948b10, 0x0178a4c8, 0x0158ed23, 0x014e5e0a, -+ 0x013e22cc, 0x013b13b1, 0x013e22cc, 0x02108421, 0x01a98ef6, -+ 0x0121fb78, 0x010ecf57, 0x01249249, 0x013e22cc, 0x01111111, -+ 0x01642c86, 0x01446f86, 0x013e22cc, 0x014afd6a -+ }; -+ -+ const u32 c_quant_table[QUANT_REG_NUM] = { -+ 0x07878788, 0x071c71c7, 0x071c71c7, 0x05555555, 0x06186186, -+ 0x05555555, 0x02b93105, 0x04ec4ec5, 0x04ec4ec5, 0x02b93105, -+ 0x014afd6a, 0x01f07c1f, 0x02492492, 0x01f07c1f, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a -+ }; -+ int i; -+ -+ for (i = 0; i < QUANT_REG_NUM; i++) { -+ phytium_jpeg_write(jpeg_dev, Y_QUANT_INDEX_ADDR_REG(i), y_quant_table[i]); -+ phytium_jpeg_write(jpeg_dev, C_QUANT_INDEX_ADDR_REG(i), c_quant_table[i]); -+ } -+ -+} -+ -+static void phytium_jpeg_start(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ phytium_jpeg_on(jpeg_dev); -+ phytium_jpeg_init_regs(jpeg_dev); -+ -+ /* Resolution set to 640x480 if no signal is found */ -+ phytium_jpeg_get_resolution(jpeg_dev); -+ -+ /* Set timings since the device is being opened for the first tiime */ -+ jpeg_dev->active_timings = jpeg_dev->detected_timings; -+ phytium_jpeg_set_resolution(jpeg_dev); -+ -+ jpeg_dev->pix_fmt.width = jpeg_dev->active_timings.width; -+ jpeg_dev->pix_fmt.height = jpeg_dev->active_timings.height; -+ jpeg_dev->pix_fmt.sizeimage = jpeg_dev->max_compressed_size; -+} -+ -+static void phytium_jpeg_stop(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ set_bit(VIDEO_STOPPED, &jpeg_dev->status); -+ cancel_delayed_work_sync(&jpeg_dev->res_work); -+ -+ phytium_jpeg_off(jpeg_dev); -+ -+ jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; -+ jpeg_dev->status = 0; -+} -+ -+static int phytium_jpeg_open(struct file *file) -+{ -+ int ret; -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ mutex_lock(&jpeg_dev->video_lock); -+ -+ ret = v4l2_fh_open(file); -+ if (ret != 0) { -+ mutex_unlock(&jpeg_dev->video_lock); -+ dev_err(jpeg_dev->dev, "Failed to open the phytium jpeg device.\n"); -+ return ret; -+ } -+ -+ if (v4l2_fh_is_singular_file(file)) -+ phytium_jpeg_start(jpeg_dev); -+ -+ mutex_unlock(&jpeg_dev->video_lock); -+ -+ return 0; -+} -+ -+static int phytium_jpeg_release(struct file *file) -+{ -+ int ret; -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ mutex_lock(&jpeg_dev->video_lock); -+ -+ if (v4l2_fh_is_singular_file(file)) -+ phytium_jpeg_stop(jpeg_dev); -+ -+ ret = _vb2_fop_release(file, NULL); -+ mutex_unlock(&jpeg_dev->video_lock); -+ -+ return ret; -+} -+ -+ -+static const struct v4l2_file_operations phytium_jpeg_fops = { -+ .owner = THIS_MODULE, -+ .read = vb2_fop_read, -+ .poll = vb2_fop_poll, -+ .unlocked_ioctl = video_ioctl2, -+ .mmap = vb2_fop_mmap, -+ .open = phytium_jpeg_open, -+ .release = phytium_jpeg_release, -+}; -+ -+static void phytium_jpeg_update_jpeg_header(u32 width, u32 height) -+{ -+ const int h_index = PHYTIUM_JPEG_HEADER_H_INDEX; -+ const int w_index = PHYTIUM_JPEG_HEADER_W_INDEX; -+ -+ /* the high 8 bits of the height locates at bit24~bit31 */ -+ phytium_jpeg_header[h_index] = phytium_jpeg_header[h_index] & 0x00FFFFFF; -+ phytium_jpeg_header[h_index] |= ((height >> 8) & 0xFF) << 24; -+ -+ /* the low 8 bits of the height locates at bit0~bit7 */ -+ phytium_jpeg_header[w_index] = phytium_jpeg_header[w_index] & 0xFF000000; -+ phytium_jpeg_header[w_index] |= height & 0xFF; -+ -+ /* the high 8 bits of the width locates at bit8~bit15 */ -+ phytium_jpeg_header[w_index] |= ((width >> 8) & 0xFF) << 8; -+ /* the low 8 bits of the width locates at bit16~bit24 */ -+ phytium_jpeg_header[w_index] |= (width & 0xFF) << 16; -+} -+ -+static void phytium_jpeg_fill_header(struct phytium_jpeg_dev *jpeg_dev, -+ struct phytium_jpeg_buffer *jpeg_buf) -+{ -+ void *vbuf = vb2_plane_vaddr(&jpeg_buf->vb.vb2_buf, 0); -+ u32 width = jpeg_dev->active_timings.width; -+ u32 height = jpeg_dev->active_timings.height; -+ -+ /* update the contents of the phytium jpeg header according to the resolution */ -+ phytium_jpeg_update_jpeg_header(width, height); -+ -+ /* replenish the contents of the JPEG header */ -+ memcpy(vbuf, phytium_jpeg_header, PHYTIUM_JPEG_HEADER_LEN); -+} -+ -+static int phytium_jpeg_start_frame(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ dma_addr_t dst_addr; -+ unsigned long status; -+ struct phytium_jpeg_buffer *jpeg_buf; -+ -+ if (jpeg_dev->v4l2_input_status) { -+ dev_err(jpeg_dev->dev, "No signal; needn't start frame\n"); -+ return 0; -+ } -+ -+ spin_lock_irqsave(&jpeg_dev->hw_lock, status); -+ jpeg_buf = list_first_entry_or_null(&jpeg_dev->buffers, -+ struct phytium_jpeg_buffer, link); -+ if (jpeg_buf == NULL) { -+ spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); -+ dev_err(jpeg_dev->dev, "No buffers; doesn't start frame\n"); -+ return -EPROTO; -+ } -+ -+ set_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); -+ dst_addr = vb2_dma_contig_plane_dma_addr(&jpeg_buf->vb.vb2_buf, 0); -+ spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); -+ -+ /* -+ * Because the JPEG Engine is unable to add a JPEG header, the phytium -+ * jpeg driver is required to fill the contents of a JPEG header before -+ * the jpeg engine write datas to the dma address. -+ */ -+ phytium_jpeg_fill_header(jpeg_dev, jpeg_buf); -+ dst_addr += PHYTIUM_JPEG_HEADER_LEN; -+ /* -+ * The ikvm application only using the last frame, so the driver replenish -+ * one output register with a dma address. -+ */ -+ dst_addr >>= JPEG_DST_ADDR_SHIFT; -+ phytium_jpeg_write(jpeg_dev, BUF_LIST_INDEX_ADDR(VB_BUF_NO), dst_addr); -+ /* Enable the validilty of the buffer marked with index */ -+ phytium_jpeg_write(jpeg_dev, BUF_LIST_INDEX_CTRL_STS_ADDR(VB_BUF_NO), -+ STS_JPEG_BUF_HIGH_LEVEL_VALID); -+ /* Enable the interruption which is used to identify an image was compressed */ -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, STS_VE_JPEG_CODE_COMP_EN); -+ /* Enable JPEG, start to capture and compress */ -+ phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 1); -+ -+ return 0; -+} -+ -+static void phytium_jpeg_resolution_work(struct work_struct *work) -+{ -+ struct delayed_work *dwork = to_delayed_work(work); -+ struct phytium_jpeg_dev *jpeg_dev = container_of(dwork, -+ struct phytium_jpeg_dev, res_work); -+ u32 input_status = jpeg_dev->v4l2_input_status; -+ -+ phytium_jpeg_on(jpeg_dev); -+ -+ /* Exit early in the case no clients remain */ -+ if (test_bit(VIDEO_STOPPED, &jpeg_dev->status)) -+ goto done; -+ -+ phytium_jpeg_init_regs(jpeg_dev); -+ phytium_jpeg_get_resolution(jpeg_dev); -+ -+ /* if source's resolution is changed, the event should be enqueued */ -+ if (jpeg_dev->detected_timings.width != jpeg_dev->active_timings.width || -+ jpeg_dev->detected_timings.height != jpeg_dev->active_timings.height || -+ input_status != jpeg_dev->v4l2_input_status) { -+ -+ static const struct v4l2_event event = { -+ .type = V4L2_EVENT_SOURCE_CHANGE, -+ .u.src_change.changes = V4L2_EVENT_SRC_CH_RESOLUTION, -+ }; -+ v4l2_event_queue(&jpeg_dev->vdev, &event); -+ clear_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); -+ dev_info(jpeg_dev->dev, "event notifies changing resolution\n"); -+ } else if (test_bit(VIDEO_STREAMING, &jpeg_dev->status)) { -+ /* No resolution change so just restart streaming */ -+ dev_info(jpeg_dev->dev, "resolution doesn't change\n"); -+ phytium_jpeg_set_resolution(jpeg_dev); -+ phytium_jpeg_start_frame(jpeg_dev); -+ } -+ -+done: -+ clear_bit(VIDEO_RES_CHANGE, &jpeg_dev->status); -+ wake_up_interruptible_all(&jpeg_dev->wait); -+} -+ -+static int phytium_jpeg_queue_setup(struct vb2_queue *q, -+ unsigned int *num_buffers, -+ unsigned int *num_planes, -+ unsigned int sizes[], -+ struct device *alloc_devs[]) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); -+ -+ if (*num_planes) { -+ if (sizes[0] < jpeg_dev->max_compressed_size) { -+ v4l2_err(&jpeg_dev->v4l2_dev, "queue v4l2_buf's size is invalid\n"); -+ return -EINVAL; -+ } -+ } -+ -+ *num_planes = 1; -+ sizes[0] = jpeg_dev->max_compressed_size; -+ return 0; -+} -+ -+static int phytium_jpeg_buf_prepare(struct vb2_buffer *vb) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(vb->vb2_queue); -+ -+ if (vb2_plane_size(vb, 0) < jpeg_dev->max_compressed_size) { -+ v4l2_err(&jpeg_dev->v4l2_dev, "failed to prepare buffer\n"); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static inline struct phytium_jpeg_buffer * -+phytium_vb2buf_to_dstbuf(struct vb2_v4l2_buffer *buf) -+{ -+ return container_of(buf, struct phytium_jpeg_buffer, vb); -+} -+ -+static void phytium_jpeg_buf_queue(struct vb2_buffer *vb) -+{ -+ bool empty; -+ struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(vb->vb2_queue); -+ struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); -+ struct phytium_jpeg_buffer *jpeg_buf = phytium_vb2buf_to_dstbuf(vbuf); -+ unsigned long status; -+ -+ spin_lock_irqsave(&jpeg_dev->hw_lock, status); -+ empty = list_empty(&jpeg_dev->buffers); -+ list_add_tail(&jpeg_buf->link, &jpeg_dev->buffers); -+ spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); -+ -+ /* the empty ensures the address of the first node's vb2_v4l2_buf -+ * in the list is written to output register -+ */ -+ if (test_bit(VIDEO_STREAMING, &jpeg_dev->status) && -+ (!test_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status)) && -+ empty) -+ phytium_jpeg_start_frame(jpeg_dev); -+} -+ -+static void phytium_jpeg_bufs_done(struct phytium_jpeg_dev *jpeg_dev, -+ enum vb2_buffer_state state) -+{ -+ unsigned long flags; -+ struct phytium_jpeg_buffer *buf; -+ -+ spin_lock_irqsave(&jpeg_dev->hw_lock, flags); -+ -+ list_for_each_entry(buf, &jpeg_dev->buffers, link) -+ vb2_buffer_done(&buf->vb.vb2_buf, state); -+ -+ INIT_LIST_HEAD(&jpeg_dev->buffers); -+ -+ spin_unlock_irqrestore(&jpeg_dev->hw_lock, flags); -+} -+ -+static void phytium_jpeg_irq_res_change(struct phytium_jpeg_dev *jpeg_dev, -+ ulong delay) -+{ -+ dev_info(jpeg_dev->dev, "Source resolution is changed, resetting\n"); -+ set_bit(VIDEO_RES_CHANGE, &jpeg_dev->status); -+ -+ phytium_jpeg_off(jpeg_dev); -+ -+ schedule_delayed_work(&jpeg_dev->res_work, delay); -+} -+ -+static irqreturn_t phytium_jpeg_irq(int irq, void *arg) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = arg; -+ u32 status; -+ struct phytium_jpeg_buffer *buf; -+ u32 frame_size; -+ -+ if (test_bit(VIDEO_POWEROFF, &jpeg_dev->status)) { -+ dev_info(jpeg_dev->dev, "jpeg engine is requested to poweroff\n"); -+ return IRQ_HANDLED; -+ } -+ -+ status = phytium_jpeg_read(jpeg_dev, INT_STATUS_CTRL_REG); -+ -+ if (status & INT_VIDEO_FORMAT_CHANGE) { -+ dev_info(jpeg_dev->dev, "receive resolution changed interrupt\n"); -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, -+ DETECT_RESOLUTION_CHANGE_EN, 0); -+ phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, INT_VIDEO_FORMAT_CHANGE); -+ phytium_jpeg_irq_res_change(jpeg_dev, RESOLUTION_CHANGE_DELAY); -+ return IRQ_HANDLED; -+ } -+ -+ /* -+ * JPEG engine finish compressing a image JPEG encoding to trigger -+ * a interruption. the status identifies the buffer number. Currently, -+ * the driver uses one buffer. -+ * -+ * Note: Because the JPEG doesn't support adding a JPEG header, and -+ * driver is also unable to add a JPEG header to vb2_buffers. One -+ * solution is that a JPEG header is added by an application. -+ */ -+ if (status & INT_JPEG_COMP_BUF_LIST_NO) { -+ frame_size = phytium_jpeg_read(jpeg_dev, jpeg_dev->comp_size_read); -+ frame_size &= JPEG_BUF_CAPACITY_SIZE; -+ frame_size >>= JPEG_BUF_CAPACITY_SIZE_SHIFT; -+ spin_lock(&jpeg_dev->hw_lock); -+ clear_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); -+ /* Delete first node from the queue */ -+ buf = list_first_entry_or_null(&jpeg_dev->buffers, -+ struct phytium_jpeg_buffer, link); -+ if (buf != NULL) { -+ frame_size += PHYTIUM_JPEG_HEADER_LEN; -+ vb2_set_plane_payload(&buf->vb.vb2_buf, 0, frame_size); -+ if (!list_is_last(&buf->link, &jpeg_dev->buffers)) { -+ buf->vb.vb2_buf.timestamp = ktime_get_ns(); -+ buf->vb.sequence = jpeg_dev->sequence++; -+ buf->vb.field = V4L2_FIELD_NONE; -+ vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE); -+ list_del(&buf->link); -+ } -+ } -+ -+ spin_unlock(&jpeg_dev->hw_lock); -+ /* Disable JPEG engine */ -+ phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 0); -+ /* Disable interruption */ -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, STS_VE_JPEG_CODE_COMP_EN, 0); -+ /* clear all interruption of the hardware's buffers */ -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, INT_JPEG_ENCODE_COMPLETE, 1); -+ -+ status &= ~INT_JPEG_COMP_BUF_LIST_NO; -+ if (test_bit(VIDEO_STREAMING, &jpeg_dev->status) && buf) -+ phytium_jpeg_start_frame(jpeg_dev); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+/* VIDIOC_STREAMON, all vb2_v4l2_buf' states are queue */ -+static int phytium_jpeg_start_streaming(struct vb2_queue *q, unsigned int count) -+{ -+ int ret; -+ struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); -+ -+ jpeg_dev->sequence = 0; -+ ret = phytium_jpeg_start_frame(jpeg_dev); -+ if (ret != 0) { -+ phytium_jpeg_bufs_done(jpeg_dev, VB2_BUF_STATE_QUEUED); -+ return ret; -+ } -+ -+ /* set the states of the jpeg engine */ -+ set_bit(VIDEO_STREAMING, &jpeg_dev->status); -+ return ret; -+} -+ -+static void phytium_jpeg_stop_streaming(struct vb2_queue *q) -+{ -+ int ret; -+ struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); -+ -+ clear_bit(VIDEO_STREAMING, &jpeg_dev->status); -+ ret = wait_event_timeout(jpeg_dev->wait, -+ !test_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status), -+ STOP_TIMEOUT); -+ -+ /* time out */ -+ if (ret == 0) { -+ dev_err(jpeg_dev->dev, "Timed out when stopping streaming.\n"); -+ /* -+ * Need to force stop any DMA and try and get HW into a good states -+ * for future calls to start streaming again. -+ */ -+ phytium_jpeg_off(jpeg_dev); -+ phytium_jpeg_on(jpeg_dev); -+ phytium_jpeg_init_regs(jpeg_dev); -+ phytium_jpeg_get_resolution(jpeg_dev); -+ } -+ /* first stop jpeg, wait, the free buffer */ -+ phytium_jpeg_bufs_done(jpeg_dev, VB2_BUF_STATE_ERROR); -+} -+ -+static const struct vb2_ops phytium_jpeg_vb2_ops = { -+ .queue_setup = phytium_jpeg_queue_setup, -+ .wait_prepare = vb2_ops_wait_prepare, -+ .wait_finish = vb2_ops_wait_finish, -+ .buf_prepare = phytium_jpeg_buf_prepare, -+ .buf_queue = phytium_jpeg_buf_queue, -+ .start_streaming = phytium_jpeg_start_streaming, -+ .stop_streaming = phytium_jpeg_stop_streaming, -+}; -+ -+static void phytium_jpeg_set_yuv_mode(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ const char *mode = yuv_mode_str; -+ enum jpeg_yuv_mode yuv_mode; -+ -+ if (strstr(mode, "yuv422") != NULL) -+ yuv_mode = YUV422; -+ else if (strstr(mode, "yuv420") != NULL) -+ yuv_mode = YUV420; -+ else -+ yuv_mode = YUV444; -+ -+ /* set the yuv mode register */ -+ phytium_jpeg_write(jpeg_dev, SAMPLE_MODE_REG, yuv_mode); -+ -+ /* update the field which indicates YUV mode locates in the JPEG header. */ -+ phytium_jpeg_header[YUVID] &= 0xFFFF00FF; -+ if (yuv_mode == YUV422) -+ phytium_jpeg_header[YUVID] |= 0x2100; -+ else if (yuv_mode == YUV420) -+ phytium_jpeg_header[YUVID] |= 0x2200; -+ else -+ phytium_jpeg_header[YUVID] |= 0x1100; -+ -+} -+ -+static irqreturn_t phytium_jpeg_timer31_irq(int irq, void *arg) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = arg; -+ -+ /* disable timer interrupt */ -+ writel(0, jpeg_dev->timer31_addr); -+ -+ /* clear timer interrupt status */ -+ writel(0x8, jpeg_dev->timer31_addr + 0x2c); -+ -+ /* clear JPEG Engine's poweroff status */ -+ clear_bit(VIDEO_POWEROFF, &jpeg_dev->status); -+ dev_info(jpeg_dev->dev, "timer31 set jpeg status 0x%lx\n", jpeg_dev->status); -+ -+ /* JPEG Engine is poweron, reconfig quntization table and YUV mode */ -+ phytium_jpeg_init_jpeg_quant(jpeg_dev); -+ phytium_jpeg_set_yuv_mode(jpeg_dev); -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, DETECT_RESOLUTION_CHANGE_EN); -+ phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, 0, TRANSINFO_SRC_SELECT); -+ -+ dev_info(jpeg_dev->dev, "reconfigure quant table and yuv mode\n"); -+ -+ return IRQ_HANDLED; -+} -+ -+static int phytium_jpeg_parser_timer31_irq(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ int irq; -+ int ret; -+ struct device *dev = jpeg_dev->dev; -+ -+ irq = irq_of_parse_and_map(dev->of_node, 2); -+ if (!irq) { -+ dev_err(dev, "Failed to get timer31 IRQ\n"); -+ return -ENODEV; -+ } -+ -+ ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_timer31_irq, -+ IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); -+ if (ret < 0) -+ dev_err(dev, "Failed to request timer31 IRQ %d\n", irq); -+ -+ return ret; -+} -+ -+static irqreturn_t phytium_jpeg_timer30_irq(int irq, void *arg) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = arg; -+ struct arm_smccc_res res; -+ -+ /* disable timer interrupt */ -+ writel(0, jpeg_dev->timer30_addr); -+ /* clear timer interrupt status */ -+ writel(0x8, jpeg_dev->timer30_addr + 0x2c); -+ -+ /* Disable interruption */ -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, STS_VE_JPEG_CODE_COMP_EN, 0); -+ -+ /* call SE to poweroff JPEG Engine */ -+ arm_smccc_smc(0xc300fff4, 0x9, 0x2, 0x80000020, 0, 0, 0, 0, &res); -+ -+ /* set JPEG Engine's status is poweroff */ -+ set_bit(VIDEO_POWEROFF, &jpeg_dev->status); -+ dev_info(jpeg_dev->dev, "timer30 set jpeg status 0x%lx\n", jpeg_dev->status); -+ -+ return IRQ_HANDLED; -+} -+ -+static int phytium_jpeg_parser_timer30_irq(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ int irq; -+ int ret; -+ struct device *dev = jpeg_dev->dev; -+ -+ irq = irq_of_parse_and_map(dev->of_node, 1); -+ if (!irq) { -+ dev_err(dev, "Failed to get timer30 IRQ\n"); -+ return -ENODEV; -+ } -+ -+ ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_timer30_irq, -+ IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); -+ if (ret < 0) -+ dev_err(dev, "Failed to request timer30 IRQ %d\n", irq); -+ -+ return ret; -+} -+ -+static int phytium_jpeg_init(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ int irq; -+ int ret; -+ struct device *dev = jpeg_dev->dev; -+ u32 ocm_buf_addr[OCM_BUF_NUM]; -+ int i; -+ -+ irq = irq_of_parse_and_map(dev->of_node, 0); -+ if (!irq) { -+ dev_err(dev, "Failed to get IRQ\n"); -+ return -ENODEV; -+ } -+ -+ ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_irq, -+ IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); -+ if (ret < 0) { -+ dev_err(dev, "Failed to request IRQ %d\n", irq); -+ return ret; -+ } -+ -+ ret = phytium_jpeg_parser_timer30_irq(jpeg_dev); -+ if (ret < 0) -+ return ret; -+ -+ ret = phytium_jpeg_parser_timer31_irq(jpeg_dev); -+ if (ret < 0) -+ return ret; -+ -+ ret = of_property_read_u32_array(dev->of_node, "phytium,ocm-buf-addr", -+ ocm_buf_addr, OCM_BUF_NUM); -+ if (ret != 0) { -+ dev_err(dev, "Failed to get the OCM address from device tree node.\n"); -+ return ret; -+ } -+ -+ for (i = 0; i < OCM_BUF_NUM; i++) -+ jpeg_dev->src_addrs[i].dma_addr = ocm_buf_addr[i]; -+ -+ /* CMA memory for JPEG device */ -+ of_reserved_mem_device_init(dev); -+ ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(32)); -+ if (ret != 0) { -+ dev_err(dev, "Failed to set DMA mask\n"); -+ return ret; -+ } -+ -+ /* Initializing JPEG Y and CbCr quantization table */ -+ phytium_jpeg_init_jpeg_quant(jpeg_dev); -+ -+ /* Select YUV mode */ -+ phytium_jpeg_set_yuv_mode(jpeg_dev); -+ dev_info(dev, "successfully initialize jpeg engine\n"); -+ return 0; -+ -+} -+ -+ -+static int phytium_jpeg_setup_video(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ struct v4l2_device *v4l2_dev = &jpeg_dev->v4l2_dev; -+ struct vb2_queue *dst_vq = &jpeg_dev->queue; -+ struct video_device *vdev = &jpeg_dev->vdev; -+ int ret; -+ -+ jpeg_dev->pix_fmt.pixelformat = V4L2_PIX_FMT_JPEG; -+ jpeg_dev->pix_fmt.field = V4L2_FIELD_NONE; -+ jpeg_dev->pix_fmt.colorspace = V4L2_COLORSPACE_SRGB; /* maybe ARGB */ -+ jpeg_dev->pix_fmt.quantization = V4L2_QUANTIZATION_FULL_RANGE; -+ jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; -+ -+ ret = v4l2_device_register(jpeg_dev->dev, v4l2_dev); -+ if (ret != 0) { -+ dev_err(jpeg_dev->dev, "Failed to register v4l2 device\n"); -+ return ret; -+ } -+ -+ /* Register how many v4l2 controls to a handler */ -+ dst_vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; -+ dst_vq->io_modes = VB2_MMAP | VB2_READ | VB2_DMABUF; -+ dst_vq->dev = v4l2_dev->dev; -+ dst_vq->lock = &jpeg_dev->video_lock; -+ dst_vq->ops = &phytium_jpeg_vb2_ops; -+ dst_vq->mem_ops = &vb2_dma_contig_memops; -+ dst_vq->drv_priv = jpeg_dev; -+ dst_vq->buf_struct_size = sizeof(struct phytium_jpeg_buffer); -+ dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; -+ dst_vq->min_buffers_needed = CAPTURE_BUF_NUMBER; -+ ret = vb2_queue_init(dst_vq); -+ if (ret) { -+ dev_err(jpeg_dev->dev, "Failed to init vb2 queue\n"); -+ goto err_v4l2_register; -+ } -+ -+ vdev->queue = dst_vq; -+ vdev->fops = &phytium_jpeg_fops; -+ vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE | -+ V4L2_CAP_STREAMING; -+ vdev->v4l2_dev = v4l2_dev; -+ strscpy(vdev->name, PHYTIUM_JPEG_NAME, sizeof(vdev->name)); -+ vdev->vfl_type = VFL_TYPE_VIDEO; -+ vdev->vfl_dir = VFL_DIR_RX; -+ vdev->release = video_device_release_empty; -+ vdev->ioctl_ops = &phytium_jpeg_ioctl_ops; -+ vdev->lock = &jpeg_dev->video_lock; -+ -+ video_set_drvdata(vdev, jpeg_dev); -+ ret = video_register_device(vdev, VFL_TYPE_VIDEO, 0); -+ if (ret != 0) { -+ dev_err(jpeg_dev->dev, "Failed to register video device\n"); -+ goto err_video_register; -+ } -+ -+ v4l2_info(v4l2_dev, "phytium JPEG registered as /dev/video%d (%d, %d)\n", -+ jpeg_dev->vdev.num, VIDEO_MAJOR, jpeg_dev->vdev.minor); -+ return ret; -+ -+err_video_register: -+ vb2_queue_release(dst_vq); -+ -+err_v4l2_register: -+ v4l2_device_unregister(v4l2_dev); -+ return ret; -+} -+ -+static const struct phytium_jpeg_config phytium_jpeg_config = { -+ .comp_size_read = BUF_LIST_INDEX_CTRL_STS_ADDR(VB_BUF_NO), -+}; -+ -+static const struct of_device_id phytium_jpeg_match[] = { -+ { -+ .compatible = "phytium,jpeg", -+ .data = &phytium_jpeg_config, -+ }, -+ {}, -+}; -+ -+MODULE_DEVICE_TABLE(of, phytium_jpeg_match); -+ -+static int phytium_jpeg_probe(struct platform_device *pdev) -+{ -+ struct phytium_jpeg_dev *jpeg_dev; -+ const struct of_device_id *match; -+ const struct phytium_jpeg_config *config; -+ struct resource *res; -+ int ret; -+ -+ jpeg_dev = devm_kzalloc(&pdev->dev, sizeof(*jpeg_dev), GFP_KERNEL); -+ if (jpeg_dev == NULL) -+ return -ENOMEM; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ jpeg_dev->base_addr = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(jpeg_dev->base_addr)) { -+ dev_err(jpeg_dev->dev, "Failed to ioremap.\n"); -+ return PTR_ERR(jpeg_dev->base_addr); -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ jpeg_dev->timer30_addr = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(jpeg_dev->base_addr)) { -+ dev_err(jpeg_dev->dev, "Failed to parse timer30.\n"); -+ return PTR_ERR(jpeg_dev->timer30_addr); -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 2); -+ jpeg_dev->timer31_addr = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(jpeg_dev->base_addr)) { -+ dev_err(jpeg_dev->dev, "Failed to parse timer30.\n"); -+ return PTR_ERR(jpeg_dev->timer31_addr); -+ } -+ match = of_match_node(phytium_jpeg_match, pdev->dev.of_node); -+ if (match == NULL) { -+ dev_err(jpeg_dev->dev, "Failed to match.\n"); -+ return -EINVAL; -+ } -+ -+ config = match->data; -+ jpeg_dev->comp_size_read = config->comp_size_read; -+ -+ jpeg_dev->frame_rate = 30; -+ jpeg_dev->dev = &pdev->dev; -+ spin_lock_init(&jpeg_dev->hw_lock); -+ mutex_init(&jpeg_dev->video_lock); -+ init_waitqueue_head(&jpeg_dev->wait); -+ INIT_DELAYED_WORK(&jpeg_dev->res_work, phytium_jpeg_resolution_work); -+ INIT_LIST_HEAD(&jpeg_dev->buffers); -+ -+ ret = phytium_jpeg_init(jpeg_dev); -+ if (ret != 0) { -+ dev_err(jpeg_dev->dev, "Failed to initialize the JPEG engine.\n"); -+ return ret; -+ } -+ -+ ret = phytium_jpeg_setup_video(jpeg_dev); -+ -+ return ret; -+} -+ -+#define to_phytium_jpeg(x) container_of((x), struct phytium_jpeg_dev, v4l2_dev) -+static int phytium_jpeg_remove(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct v4l2_device *v4l2_dev = dev_get_drvdata(dev); -+ struct phytium_jpeg_dev *jpeg_dev = to_phytium_jpeg(v4l2_dev); -+ -+ phytium_jpeg_off(jpeg_dev); -+ -+ video_unregister_device(&jpeg_dev->vdev); -+ -+ vb2_queue_release(&jpeg_dev->queue); -+ -+ v4l2_device_unregister(v4l2_dev); -+ -+ of_reserved_mem_device_release(dev); -+ -+ return 0; -+} -+ -+static struct platform_driver phytium_jpeg_driver = { -+ .probe = phytium_jpeg_probe, -+ .remove = phytium_jpeg_remove, -+ .driver = { -+ .name = PHYTIUM_JPEG_NAME, -+ .of_match_table = phytium_jpeg_match, -+ }, -+}; -+ -+module_platform_driver(phytium_jpeg_driver); -+ -+MODULE_DESCRIPTION("Phytium JPEG Encoder driver"); -+MODULE_AUTHOR("Wang Min "); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.h b/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.h -new file mode 100644 -index 000000000..27e32b2d3 ---- /dev/null -+++ b/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.h -@@ -0,0 +1,147 @@ -+/* SPDX-License-Identifier: GPL-2.0-or-later */ -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _PHYTIUM_JPEG_CORE_H -+#define _PHYTIUM_JPEG_CORE_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 -+ -+#define PHYTIUM_JPEG_NAME "phytium-jpeg" -+#define MAX_FRAME_RATE 60 -+#define MAX_HEIGHT 1080 -+#define MAX_WIDTH 1920 -+#define MIN_HEIGHT 480 -+#define MIN_WIDTH 640 -+#define MIN_PIXEL_CLOCK (640 * 480 * 60) /* 640 x 480 x 60Hz */ -+#define MAX_PIXEL_CLOCK (1920 * 1080 * 60) /* 1920 x 1080 x 60Hz */ -+ -+#define SOURCE_RESOLUTION_DETECT_TIMEOUT msecs_to_jiffies(500) -+#define RESOLUTION_CHANGE_DELAY msecs_to_jiffies(0) -+#define INVALID_RESOLUTION_DELAY msecs_to_jiffies(250) -+#define STOP_TIMEOUT msecs_to_jiffies(1000) -+ -+#define INVALID_RESOLUTION_RETRIES 2 -+#define CAPTURE_BUF_NUMBER 3 /* using how many buffers */ -+#define VB_BUF_NO 0 /* there are 16 buffer, use which one */ -+ -+/* The below macros are defined for the JPEG header of the phytium JPEG Engine */ -+#define PHYTIUM_JPEG_HEADER_LEN (256 * 3) -+#define PHYTIUM_JPEG_HEADER_SIZE (PHYTIUM_JPEG_HEADER_LEN / sizeof(u32)) -+#define PHYTIUM_JPEG_HEADER_H_INDEX 40 -+#define PHYTIUM_JPEG_HEADER_W_INDEX 41 -+ -+/* There are two ocm buffers that are used for storaging the inputing video data */ -+#define OCM_BUF_NUM 2 -+ -+enum phytium_jpeg_status { -+ VIDEO_MODE_DETECT_DONE, -+ VIDEO_RES_CHANGE, -+ VIDEO_RES_DETECT, -+ VIDEO_STREAMING, -+ VIDEO_FRAME_INPRG, -+ VIDEO_STOPPED, -+ VIDEO_CLOCKS_ON, -+ VIDEO_POWEROFF, -+}; -+ -+struct phytium_jpeg_addr { -+ unsigned int size; -+ dma_addr_t dma_addr; -+ void *virt_addr; -+}; -+ -+struct phytium_jpeg_buffer { -+ struct vb2_v4l2_buffer vb; -+ struct list_head link; -+}; -+ -+/** -+ * struct phytium_jpeg - JPEG IP abstraction -+ * @lock: the mutex protecting this structure -+ * @hw_lock: spinlock protecting the hw device resource -+ * @workqueue: decode work queue -+ * @dev: JPEG device -+ * @v4l2_dev: v4l2 device for mem2mem mode -+ * @m2m_dev: v4l2 mem2mem device data -+ * @alloc_ctx: videobuf2 memory allocator's context -+ * @dec_vdev: video device node for decoder mem2mem mode -+ * @dec_reg_base: JPEG registers mapping -+ * @clk_jdec: JPEG hw working clock -+ * @clk_jdec_smi: JPEG SMI bus clock -+ * @larb: SMI device -+ */ -+struct phytium_jpeg_dev { -+ void __iomem *base_addr; -+ struct device *dev; -+ struct v4l2_device v4l2_dev; -+ struct v4l2_pix_format pix_fmt; -+ struct v4l2_bt_timings active_timings; -+ struct v4l2_bt_timings detected_timings; -+ u32 v4l2_input_status; -+ struct vb2_queue queue; -+ struct video_device vdev; -+ /* v4l2 and videobuf2 lock, protect the structure*/ -+ struct mutex video_lock; -+ u32 jpeg_mode; -+ u32 comp_size_read; -+ wait_queue_head_t wait; -+ /* buffer list lock, protecting the hw device resource */ -+ spinlock_t hw_lock; -+ struct delayed_work res_work; -+ struct list_head buffers; -+ unsigned long status; -+ unsigned int sequence; -+ unsigned int max_compressed_size; -+ struct phytium_jpeg_addr src_addrs[OCM_BUF_NUM]; -+ struct phytium_jpeg_addr dst_addrs[16]; -+ -+ bool yuv420; -+ unsigned int frame_rate; -+ void __iomem *timer30_addr; -+ void __iomem *timer31_addr; -+}; -+ -+struct phytium_jpeg_config { -+ u32 jpeg_mode; -+ u32 comp_size_read; -+}; -+ -+#define YUV_MODE_STR_LEN 8 -+#define YUVID 42 -+ -+enum jpeg_yuv_mode { -+ YUV444 = 0x0, -+ YUV422 = 0x1, -+ YUV420 = 0x2 -+}; -+ -+#endif /* _PHYTIUM_JPEG_CORE_H */ -diff --git a/drivers/media/platform/phytium-jpeg/phytium_jpeg_reg.h b/drivers/media/platform/phytium-jpeg/phytium_jpeg_reg.h -new file mode 100644 -index 000000000..b0a27e2b7 ---- /dev/null -+++ b/drivers/media/platform/phytium-jpeg/phytium_jpeg_reg.h -@@ -0,0 +1,113 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _PHYTIUM_JPEG_REG_H -+#define _PHYTIUM_JPEG_REG_H -+ -+#include -+/* define the all kinds of control registers in a JPEG soc */ -+ -+/* The register is used to set the information of the video comes from main memory */ -+#define SRC_DDR_INFO_REG 0x00000800 -+ -+/* The register is used to get the information of the video comes from external VGA */ -+#define SRC_VGA_INFO_REG 0x00000894 -+ -+#define SRC_FORMAT BIT(0) /* 0:RGB888, 1:RGB565 */ -+#define SRC_DE_POLARITY BIT(1) /* 0:low level is effect, other */ -+#define SRC_HS_POLARITY BIT(2) /* 0:low level is effect, other */ -+#define SRC_VS_POLARITY BIT(3) /* 0:low level is effect, other */ -+#define SRC_HOR_PIXELS GENMASK(15, 4) /* the number of the horizontal pixels */ -+#define SRC_WIDTH_SHIFT 4 /* shift right to get width */ -+#define SRC_VER_PIXELS GENMASK(26, 16) /* the number of the vertical pixels */ -+#define SRC_HEIGHT_SHIFT 16 /* shift right to get height */ -+/* The below bit fields is only used by image comes from main memory */ -+#define SRC_COMP_DDR_IMG_EN BIT(27) /* 0: disable to JPEG compression, others */ -+ -+/* marks which ocm buffer is occupied to store an image */ -+#define SRC_DDR_IMG2OCM_VALID GENMASK(29, 28) -+ -+/* The register controls starting work of the JPEG engine */ -+#define TRANSFORM_INFO_REG 0x00000804 -+#define TRANSINFO_ENABLE_ENGINE BIT(0) /* 1: enable the JPEG engine */ -+/* 1: video comes from external VGA, 0: video comes from DDR */ -+#define TRANSINFO_SRC_SELECT BIT(1) -+/* 0: video comes from external VGA is cached to OCM, 1: DDR */ -+#define TRANSINFO_IMAGE_STORE BIT(2) -+#define TRANSINFO_FRAME_RATE GENMASK(9, 4) /* the value notes frame rate */ -+#define TRANSINFO_BLOCK_SIZE BIT(12) /* 0: 8x8, 1: 16x16 */ -+#define TRANSINFO_ENABLE_YUV422 BIT(13) /* 1: JPEG block is populated YUV422 */ -+/* support burst with the values such as 1, 2, 4, 8, 16, 32, 64. using default value 0xf */ -+#define TRANSINFO_AXI_LEN GENMASK(22, 16) -+#define TRANS_AXI_LEN_SHIFT 16 -+ -+/* The interrupt and status register */ -+#define INT_STATUS_CTRL_REG 0x00000808 -+#define INT_FIFO_OVERFLOW BIT(0) /* video fifo overflow, write 1 to clear */ -+#define INT_OCM_BUF_OVERFLOW BIT(1) /* ocm buffer overflow, write 1 to clear */ -+/* JPEG engine complete compression, write 1 to clear */ -+#define INT_JPEG_ENCODE_COMPLETE BIT(2) -+/* in VGA mode, video's format is changed */ -+#define INT_VIDEO_FORMAT_CHANGE BIT(3) -+/* enable the interrupt of th video fifo overflow and source resolution */ -+#define DETECT_RESOLUTION_CHANGE_EN BIT(4) -+/* enable the interrupt of the ocm buffer overflow */ -+#define STS_VE_OCM_BUF_OVERFLOW_EN BIT(5) -+/* enable the interrupt of the JPEG complete compression */ -+#define STS_VE_JPEG_CODE_COMP_EN BIT(6) -+/* in VGA mode, the bit notes ocm buff is busy */ -+#define STS_VE_OCM_BUF_BUSY BIT(7) -+/* in VGA mode, the bit notes sequence number of the frame */ -+#define STS_VE_CUR_FRAME_NUMBER GENMASK(9, 8) -+/* in VGA mode, the bit notes sequence number of the cached frame */ -+#define STS_VE_BUF_CACHE_NUMBER GENMASK(11, 10) -+/* in VGA mode, the buffer number in buffer list */ -+#define STS_JPEG_COMP_BUF_NO GENMASK(15, 12) -+#define INT_JPEG_COMP_BUF_LIST_NO GENMASK(31, 16) /* the interrupt number of the buffer */ -+ -+#define OCM_BUF0_ADDR 0x0000080C -+#define OCM_BUF1_ADDR 0x00000810 -+#define OCM_BUF_SHIFT 8 -+ -+#define BUF_LIST_BASE_ADDR 0x00000814 -+ -+#define PHYTIUM_BUF_LIST_ACTRL_AND_STS_BASE_ADDR_REG 0x00000818 -+#define STS_JPEG_BUF_HIGH_LEVEL_VALID BIT(0) /* Hight levle is validity */ -+#define JPEG_BUF_CAPACITY_SIZE GENMASK(29, 8) /* the capacity of the buffer */ -+#define JPEG_BUF_CAPACITY_SIZE_SHIFT 8 -+ -+/* There are 16 buffers in the buffer list, the width between each other' address is 8 bytes */ -+#define BUF_LIST_ADDR_OFFSET 0x8 -+#define BUF_LIST_CTRL_AND_STS_OFFSET 0x8 -+ -+/* Get the address of the specific index buffer */ -+#define BUF_LIST_INDEX_ADDR(index) \ -+ (BUF_LIST_BASE_ADDR + (index) * BUF_LIST_ADDR_OFFSET) -+ -+#define JPEG_DST_ADDR_SHIFT 8 -+ -+#define BUF_LIST_INDEX_CTRL_STS_ADDR(index) \ -+ (PHYTIUM_BUF_LIST_ACTRL_AND_STS_BASE_ADDR_REG + (index) * BUF_LIST_CTRL_AND_STS_OFFSET) -+ -+#define FRAME_SAMPLE_CTRL 0x00000898 -+#define FRAME_SAMPLE_CTRL_EN BIT(31) -+#define FRAME_SAMPLE_INTERVAL GENMASK(30, 0) -+ -+/* The below registers are all related to quantilize */ -+#define HUFF_MODE_REG 0x300 -+#define SAMPLE_MODE_REG 0x304 -+ -+#define Y_QUANT_BASE_ADDR_REG 0x400 -+#define C_QUANT_BASE_ADDR_REG 0x500 -+ -+#define QUANT_REG_NUM 64 -+ -+#define Y_QUANT_INDEX_ADDR_REG(index) \ -+ (Y_QUANT_BASE_ADDR_REG + 4 * (index)) -+ -+#define C_QUANT_INDEX_ADDR_REG(index) \ -+ (C_QUANT_BASE_ADDR_REG + 4 * (index)) -+ -+#endif /* _PHYTIUM_JPEG_REG_H */ -diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig -index b8847ae04..a00f54a23 100644 ---- a/drivers/mfd/Kconfig -+++ b/drivers/mfd/Kconfig -@@ -1035,6 +1035,21 @@ config UCB1400_CORE - To compile this driver as a module, choose M here: the - module will be called ucb1400_core. - -+config MFD_PHYTIUM_I2S_LSD -+ tristate "PHYTIUM px210 I2S LSD MFD driver" -+ depends on (PCI && ARCH_PHYTIUM) -+ select MFD_CORE -+ help -+ This enables support for the Phytium px210 LSD I2S controller. -+ -+config MFD_PHYTIUM_I2S_MMD -+ tristate "PHYTIUM px210 I2S MMD MFD driver" -+ depends on (PCI && ARCH_PHYTIUM) -+ select MFD_CORE -+ help -+ This enables support for the Phytium px210 MMD I2S controllers -+ for Display Port. -+ - config MFD_PM8XXX - tristate "Qualcomm PM8xxx PMIC chips driver" - depends on (ARM || HEXAGON || COMPILE_TEST) -diff --git a/drivers/mfd/Makefile b/drivers/mfd/Makefile -index 1780019d2..5e0bd7d96 100644 ---- a/drivers/mfd/Makefile -+++ b/drivers/mfd/Makefile -@@ -267,3 +267,6 @@ obj-$(CONFIG_MFD_KHADAS_MCU) += khadas-mcu.o - obj-$(CONFIG_SGI_MFD_IOC3) += ioc3.o - obj-$(CONFIG_MFD_SIMPLE_MFD_I2C) += simple-mfd-i2c.o - obj-$(CONFIG_MFD_INTEL_M10_BMC) += intel-m10-bmc.o -+ -+obj-$(CONFIG_MFD_PHYTIUM_I2S_LSD) += phytium_px210_i2s_lsd.o -+obj-$(CONFIG_MFD_PHYTIUM_I2S_MMD) += phytium_px210_i2s_mmd.o -diff --git a/drivers/mfd/phytium_px210_i2s_lsd.c b/drivers/mfd/phytium_px210_i2s_lsd.c -new file mode 100644 -index 000000000..ad57c59fb ---- /dev/null -+++ b/drivers/mfd/phytium_px210_i2s_lsd.c -@@ -0,0 +1,131 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium I2S LSD MFD driver over PCI bus -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+ -+struct phytium_px210_mfd { -+ struct device *dev; -+}; -+ -+struct pdata_px210_mfd { -+ struct device *dev; -+ char *name; -+ int clk_base; -+}; -+ -+static struct resource phytium_px210_i2s_res0[] = { -+ [0] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [1] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [2] = { -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+static struct mfd_cell phytium_px210_mfd_cells[] = { -+ { -+ .id = 0, -+ .name = "phytium-i2s", -+ .of_compatible = "phytium,i2s", -+ .resources = phytium_px210_i2s_res0, -+ .num_resources = ARRAY_SIZE(phytium_px210_i2s_res0), -+ .ignore_resource_conflicts = true, -+ }, -+}; -+ -+static void phytium_px210_i2s_setup(struct pci_dev *pdev) -+{ -+ struct mfd_cell *cell = &phytium_px210_mfd_cells[0]; -+ struct resource *res = (struct resource *)cell->resources; -+ struct pdata_px210_mfd *pdata; -+ -+ res[0].start = pci_resource_start(pdev, 0); -+ res[0].end = pci_resource_start(pdev, 0) + 0x0fff; -+ -+ res[1].start = pci_resource_start(pdev, 0) + 0x1000; -+ res[1].end = pci_resource_start(pdev, 0) + 0x1fff; -+ -+ res[2].start = pdev->irq; -+ res[2].end = pdev->irq; -+ -+ pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); -+ -+ pdata->dev = &pdev->dev; -+ pdata->name = "phytium-i2s-lsd"; -+ pdata->clk_base = 480000000; -+ -+ cell->platform_data = pdata; -+ cell->pdata_size = sizeof(*pdata); -+} -+ -+static int phytium_px210_mfd_probe(struct pci_dev *pdev, -+ const struct pci_device_id *id) -+{ -+ struct phytium_px210_mfd *phytium_mfd; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ pci_set_master(pdev); -+ -+ phytium_mfd = devm_kzalloc(&pdev->dev, sizeof(*phytium_mfd), GFP_KERNEL); -+ if (!phytium_mfd) -+ return -ENOMEM; -+ -+ phytium_mfd->dev = &pdev->dev; -+ dev_set_drvdata(&pdev->dev, phytium_mfd); -+ -+ phytium_px210_i2s_setup(pdev); -+ -+ ret = mfd_add_devices(&pdev->dev, 0, phytium_px210_mfd_cells, -+ ARRAY_SIZE(phytium_px210_mfd_cells), NULL, 0, -+ NULL); -+ if (ret) -+ return 0; -+ -+ return 0; -+} -+ -+ -+static void phytium_px210_mfd_remove(struct pci_dev *pdev) -+{ -+ mfd_remove_devices(&pdev->dev); -+} -+ -+static const struct pci_device_id phytium_px210_mfd_ids[] = { -+ { -+ .vendor = 0x1DB7, -+ .device = 0xDC2B, -+ .subvendor = PCI_ANY_ID, -+ .subdevice = PCI_ANY_ID, -+ .class = 0x3, -+ .class_mask = 0, -+ }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(pci, phytium_px210_mfd_ids); -+ -+static struct pci_driver phytium_i2s_lsd_mfd_driver = { -+ .name = "phytium_px210_mfd_i2s", -+ .id_table = phytium_px210_mfd_ids, -+ .probe = phytium_px210_mfd_probe, -+ .remove = phytium_px210_mfd_remove, -+}; -+ -+module_pci_driver(phytium_i2s_lsd_mfd_driver); -+ -+MODULE_AUTHOR("Yiqun Zhang "); -+MODULE_DESCRIPTION("Phytium Px210 MFD PCI driver for I2S-LSD"); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/mfd/phytium_px210_i2s_mmd.c b/drivers/mfd/phytium_px210_i2s_mmd.c -new file mode 100644 -index 000000000..c225741bb ---- /dev/null -+++ b/drivers/mfd/phytium_px210_i2s_mmd.c -@@ -0,0 +1,185 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium I2S MMD MFD driver over PCI bus -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+ -+struct phytium_px210_mfd { -+ struct device *dev; -+}; -+ -+struct pdata_px210_mfd { -+ struct device *dev; -+ char *name; -+ int clk_base; -+}; -+ -+static struct resource phytium_px210_i2s_res0[] = { -+ [0] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [1] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [2] = { -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+static struct resource phytium_px210_i2s_res1[] = { -+ [0] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [1] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [2] = { -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+static struct resource phytium_px210_i2s_res2[] = { -+ [0] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [1] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [2] = { -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+static struct mfd_cell phytium_px210_mfd_cells[] = { -+ { -+ .id = 1, -+ .name = "phytium-i2s", -+ .of_compatible = "phytium,i2s", -+ .resources = phytium_px210_i2s_res0, -+ .num_resources = ARRAY_SIZE(phytium_px210_i2s_res0), -+ .ignore_resource_conflicts = true, -+ }, -+ { -+ .id = 2, -+ .name = "phytium-i2s", -+ .of_compatible = "phytium,i2s", -+ .resources = phytium_px210_i2s_res1, -+ .num_resources = ARRAY_SIZE(phytium_px210_i2s_res1), -+ .ignore_resource_conflicts = true, -+ }, -+ { -+ .id = 3, -+ .name = "phytium-i2s", -+ .of_compatible = "phytium,i2s", -+ .resources = phytium_px210_i2s_res2, -+ .num_resources = ARRAY_SIZE(phytium_px210_i2s_res2), -+ .ignore_resource_conflicts = true, -+ }, -+}; -+ -+static void phytium_px210_i2s_setup(struct pci_dev *pdev, int i) -+{ -+ struct mfd_cell *cell = &phytium_px210_mfd_cells[i]; -+ struct resource *res = (struct resource *)cell->resources; -+ struct pdata_px210_mfd *pdata; -+ -+ res[0].start = pci_resource_start(pdev, 0) + 0x2000 * i + 0x1000; -+ res[0].end = pci_resource_start(pdev, 0) + 0x2000 * i + 0x1fff; -+ -+ res[1].start = pci_resource_start(pdev, 0) + 0x2000 * i; -+ res[1].end = pci_resource_start(pdev, 0) + 0x2000 * i + 0x0fff; -+ -+ res[2].start = pdev->irq; -+ res[2].end = pdev->irq; -+ -+ pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); -+ -+ pdata->dev = &pdev->dev; -+ pdata->clk_base = 600000000; -+ switch (i) { -+ case 0: -+ pdata->name = "phytium-i2s-dp0"; -+ break; -+ case 1: -+ pdata->name = "phytium-i2s-dp1"; -+ break; -+ case 2: -+ pdata->name = "phytium-i2s-dp2"; -+ break; -+ default: -+ break; -+ } -+ -+ cell->platform_data = pdata; -+ cell->pdata_size = sizeof(*pdata); -+} -+ -+static int phytium_px210_mfd_probe(struct pci_dev *pdev, -+ const struct pci_device_id *id) -+{ -+ struct phytium_px210_mfd *phytium_mfd; -+ int i; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ pci_set_master(pdev); -+ -+ phytium_mfd = devm_kzalloc(&pdev->dev, sizeof(*phytium_mfd), GFP_KERNEL); -+ if (!phytium_mfd) -+ return -ENOMEM; -+ -+ phytium_mfd->dev = &pdev->dev; -+ dev_set_drvdata(&pdev->dev, phytium_mfd); -+ -+ for (i = 0; i < 3; i++) -+ phytium_px210_i2s_setup(pdev, i); -+ -+ ret = mfd_add_devices(&pdev->dev, 0, phytium_px210_mfd_cells, -+ ARRAY_SIZE(phytium_px210_mfd_cells), NULL, 0, -+ NULL); -+ if (ret) -+ return 0; -+ -+ return 0; -+} -+ -+ -+static void phytium_px210_mfd_remove(struct pci_dev *pdev) -+{ -+ mfd_remove_devices(&pdev->dev); -+} -+ -+static const struct pci_device_id phytium_px210_mfd_ids[] = { -+ { -+ .vendor = 0x1DB7, -+ .device = 0xDC23, -+ .subvendor = PCI_ANY_ID, -+ .subdevice = PCI_ANY_ID, -+ .class = 0x3, -+ .class_mask = 0, -+ }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(pci, phytium_px210_mfd_ids); -+ -+static struct pci_driver phytium_i2s_mmd_mfd_driver = { -+ .name = "phytium_px210_mfd_mmd", -+ .id_table = phytium_px210_mfd_ids, -+ .probe = phytium_px210_mfd_probe, -+ .remove = phytium_px210_mfd_remove, -+}; -+ -+module_pci_driver(phytium_i2s_mmd_mfd_driver); -+ -+MODULE_AUTHOR("Yiqun Zhang "); -+MODULE_DESCRIPTION("Phytium Px210 MFD PCI driver for I2S-DP"); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/mmc/host/Kconfig b/drivers/mmc/host/Kconfig -index a5b2bf0e4..e296557eb 100644 ---- a/drivers/mmc/host/Kconfig -+++ b/drivers/mmc/host/Kconfig -@@ -1103,3 +1103,37 @@ config MMC_OWL - - config MMC_SDHCI_EXTERNAL_DMA - bool -+ -+config MMC_PHYTIUM_SDCI -+ tristate "Phytium SD Host Controller support" -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ default y if ARCH_PHYTIUM -+ help -+ This selects support for the SD/MMC Host Controller on -+ Phytium SoC family. -+ -+ If you have a controller with this interface, say Y or M here. -+ -+ If unsure, say N. -+ -+config MMC_PHYTIUM_MCI_PCI -+ tristate "Phytium octopus PCI MultiMedia Card Interface support" -+ depends on ARCH_PHYTIUM -+ default y if ARCH_PHYTIUM -+ help -+ This selects support for the PCI MultiMedia Card Interface on Phytium -+ px210 chipset. -+ -+ If you have a controller with this interface, say Y or M here. -+ -+ If unsure, say N. -+ -+config MMC_PHYTIUM_MCI_PLTFM -+ tristate "Phytium MultiMedia Card Interface support" -+ depends on ARCH_PHYTIUM && OF -+ default y if ARCH_PHYTIUM -+ help -+ This selects support for the MultiMedia Card Interface on Phytium SoCs. -+ If you have a controller with this interface, say Y or M here. -+ -+ If unsure, say N. -diff --git a/drivers/mmc/host/Makefile b/drivers/mmc/host/Makefile -index 451c25fc2..4a46cf083 100644 ---- a/drivers/mmc/host/Makefile -+++ b/drivers/mmc/host/Makefile -@@ -77,6 +77,7 @@ obj-$(CONFIG_MMC_USDHI6ROL0) += usdhi6rol0.o - obj-$(CONFIG_MMC_TOSHIBA_PCI) += toshsd.o - obj-$(CONFIG_MMC_BCM2835) += bcm2835.o - obj-$(CONFIG_MMC_OWL) += owl-mmc.o -+obj-$(CONFIG_MMC_PHYTIUM_SDCI) += phytium-sdci.o - - obj-$(CONFIG_MMC_REALTEK_PCI) += rtsx_pci_sdmmc.o - obj-$(CONFIG_MMC_REALTEK_USB) += rtsx_usb_sdmmc.o -@@ -112,3 +113,6 @@ endif - - obj-$(CONFIG_MMC_SDHCI_XENON) += sdhci-xenon-driver.o - sdhci-xenon-driver-y += sdhci-xenon.o sdhci-xenon-phy.o -+ -+obj-$(CONFIG_MMC_PHYTIUM_MCI_PCI) += phytium-mci-pci.o phytium-mci.o -+obj-$(CONFIG_MMC_PHYTIUM_MCI_PLTFM) += phytium-mci-plat.o phytium-mci.o -diff --git a/drivers/mmc/host/phytium-mci-pci.c b/drivers/mmc/host/phytium-mci-pci.c -new file mode 100644 -index 000000000..bd193bbd0 ---- /dev/null -+++ b/drivers/mmc/host/phytium-mci-pci.c -@@ -0,0 +1,175 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * Phytium Multimedia Card Interface PCI driver -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ * -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium-mci.h" -+ -+static u32 sd_caps = MMC_CAP_SD_HIGHSPEED | MMC_CAP_WAIT_WHILE_BUSY | MMC_CAP_CMD23 | -+ MMC_CAP_4_BIT_DATA; -+static u32 sd_caps2 = MMC_CAP2_NO_MMC; -+ -+static u32 emmc_caps = MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA | MMC_CAP_WAIT_WHILE_BUSY | -+ MMC_CAP_CMD23 | MMC_CAP_HW_RESET | MMC_CAP_MMC_HIGHSPEED | -+ MMC_CAP_NONREMOVABLE; -+static u32 emmc_caps2 = MMC_CAP2_NO_SDIO | MMC_CAP2_NO_SD; -+ -+#define PCI_BAR_NO 0 -+ -+#if defined CONFIG_PM && defined CONFIG_PM_SLEEP -+static const struct dev_pm_ops phytium_mci_dev_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_mci_suspend, -+ phytium_mci_resume) -+ SET_RUNTIME_PM_OPS(phytium_mci_runtime_suspend, -+ phytium_mci_runtime_resume, NULL) -+}; -+#else -+#define phytium_mci_dev_pm_ops NULL -+#endif -+ -+static int -+phytium_mci_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) -+{ -+ struct phytium_mci_host *host; -+ struct mmc_host *mmc; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ -+ if (ret) -+ return ret; -+ pci_set_master(pdev); -+ -+ mmc = mmc_alloc_host(sizeof(struct phytium_mci_host), &pdev->dev); -+ -+ if (!mmc) -+ return -ENOMEM; -+ -+ host = mmc_priv(mmc); -+ -+ pci_enable_msi(pdev); -+ -+ host->irq = pdev->irq; -+ host->irq_flags = IRQF_SHARED; -+ host->dev = &pdev->dev; -+ ret = pcim_iomap_regions(pdev, 1 << PCI_BAR_NO, pci_name(pdev)); -+ -+ if (ret) { -+ dev_err(&pdev->dev, "I/O memory remapping failed\n"); -+ goto host_free; -+ } -+ -+ host->base = pcim_iomap_table(pdev)[PCI_BAR_NO]; -+ host->is_use_dma = 1; -+ host->is_device_x100 = 1; -+ -+ if (pdev->devfn == 2) { -+ host->caps = emmc_caps; -+ host->caps2 = emmc_caps2; -+ } else { -+ host->caps = sd_caps; -+ host->caps2 = sd_caps2; -+ mmc->f_max = 25000000; /* stable frequency */ -+ } -+ -+ host->mmc = mmc; -+ host->clk_rate = MCI_CLK; -+ -+ dev_info(&pdev->dev, "%s %d: [bar %d] addr: 0x%llx size: 0x%llx km: 0x%llx devfn:%d\n", -+ __func__, __LINE__, PCI_BAR_NO, pci_resource_start(pdev, 0), -+ pci_resource_len(pdev, 0), (uint64_t)host->base, pdev->devfn); -+ -+ dev_dbg(&pdev->dev, "%s %d:irq:0x%x\n", __func__, __LINE__, host->irq); -+ -+ ret = phytium_mci_common_probe(host); -+ -+ if (ret == MCI_REALEASE_MEM) { -+ ret = -ENOMEM; -+ goto release_mem; -+ } else if (ret) { -+ goto release; -+ } -+ pci_set_drvdata(pdev, mmc); -+ dev_info(&pdev->dev, "%s %d: probe phytium mci successful.\n", __func__, __LINE__); -+ return 0; -+ -+release: -+ phytium_mci_deinit_hw(host); -+release_mem: -+ -+ if (host->dma.adma_table) { -+ dma_free_coherent(&pdev->dev, -+ MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), -+ host->dma.adma_table, host->dma.adma_addr); -+ } -+host_free: -+ mmc_free_host(mmc); -+ pci_disable_device(pdev); -+ return ret; -+} -+ -+static void phytium_mci_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_mci_host *host; -+ struct mmc_host *mmc; -+ -+ mmc = pci_get_drvdata(pdev); -+ if (!mmc) { -+ dev_info(&pdev->dev, "%s %d: mmc is null.\n", __func__, __LINE__); -+ return; -+ } -+ host = mmc_priv(mmc); -+ if (!host) { -+ dev_info(&pdev->dev, "%s %d: host is null.\n", __func__, __LINE__); -+ mmc_remove_host(mmc); -+ mmc_free_host(mmc); -+ return; -+ } -+ -+ del_timer(&host->hotplug_timer); -+ -+ mmc_remove_host(host->mmc); -+ -+ if (host->dma.adma_table) { -+ dma_free_coherent(&pdev->dev, -+ MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), -+ host->dma.adma_table, host->dma.adma_addr); -+ } -+ phytium_mci_deinit_hw(host); -+ mmc_free_host(mmc); -+ pci_set_drvdata(pdev, NULL); -+} -+ -+static const struct pci_device_id phytium_mci_pci_tbl[] = { -+ { -+ PCI_DEVICE(PCI_VENDOR_ID_PHYTIUM, 0xdc28), -+ .class = 0x5, -+ .class_mask = 0, -+ }, -+ {} -+}; -+MODULE_DEVICE_TABLE(pci, phytium_mci_pci_tbl); -+ -+static struct pci_driver phytium_mci_pci_driver = { -+ .name = "phytium-mci-pci", -+ .id_table = phytium_mci_pci_tbl, -+ .probe = phytium_mci_pci_probe, -+ .remove = phytium_mci_pci_remove, -+ .driver = { -+ .pm = &phytium_mci_dev_pm_ops, -+ } -+}; -+module_pci_driver(phytium_mci_pci_driver); -+ -+MODULE_DESCRIPTION("Phytium Multimedia Card Interface PCI driver"); -+MODULE_LICENSE("GPL v2"); -+MODULE_AUTHOR("Cheng Quan "); -diff --git a/drivers/mmc/host/phytium-mci-plat.c b/drivers/mmc/host/phytium-mci-plat.c -new file mode 100644 -index 000000000..c9d6ebff0 ---- /dev/null -+++ b/drivers/mmc/host/phytium-mci-plat.c -@@ -0,0 +1,175 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * Phytium Multimedia Card Interface PCI driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium-mci.h" -+ -+static u32 mci_caps = MMC_CAP_CMD23 | MMC_CAP_WAIT_WHILE_BUSY; -+ -+#if defined CONFIG_PM && defined CONFIG_PM_SLEEP -+ -+static const struct dev_pm_ops phytium_mci_dev_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_mci_suspend, -+ phytium_mci_resume) -+ SET_RUNTIME_PM_OPS(phytium_mci_runtime_suspend, -+ phytium_mci_runtime_resume, NULL) -+}; -+#else -+#define phytium_mci_dev_pm_ops NULL -+#endif -+ -+static int phytium_mci_probe(struct platform_device *pdev) -+{ -+ struct mmc_host *mmc; -+ struct phytium_mci_host *host; -+ struct resource *res; -+ const struct acpi_device_id *match; -+ struct device *dev = &pdev->dev; -+ int ret; -+ -+ mmc = mmc_alloc_host(sizeof(struct phytium_mci_host), &pdev->dev); -+ if (!mmc) -+ return -ENOMEM; -+ host = mmc_priv(mmc); -+ ret = mmc_of_parse(mmc); -+ if (ret) -+ goto host_free; -+ -+ if (dev->of_node) { -+ host->src_clk = devm_clk_get(&pdev->dev, "phytium_mci_clk"); -+ if (IS_ERR(host->src_clk)) { -+ ret = PTR_ERR(host->src_clk); -+ goto host_free; -+ } -+ -+ host->clk_rate = clk_get_rate(host->src_clk); -+ } else if (has_acpi_companion(dev)) { -+ match = acpi_match_device(dev->driver->acpi_match_table, dev); -+ if (!match) { -+ dev_err(dev, "Error ACPI match data is missing\n"); -+ return -ENODEV; -+ } -+ host->clk_rate = 1200000000; -+ } -+ -+ host->is_use_dma = 1; -+ host->is_device_x100 = 0; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ host->base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(host->base)) { -+ ret = PTR_ERR(host->base); -+ goto host_free; -+ } -+ -+ host->irq = platform_get_irq(pdev, 0); -+ -+ if (host->irq < 0) { -+ ret = -EINVAL; -+ goto host_free; -+ } -+ host->irq_flags = IRQF_SHARED; -+ dev_dbg(&pdev->dev, "%s %d:irq:%d\n", __func__, __LINE__, host->irq); -+ host->dev = &pdev->dev; -+ host->caps = mci_caps; -+ host->mmc = mmc; -+ ret = phytium_mci_common_probe(host); -+ if (ret == MCI_REALEASE_MEM) { -+ ret = -ENOMEM; -+ goto release_mem; -+ } else if (ret) { -+ goto release; -+ } -+ platform_set_drvdata(pdev, mmc); -+ dev_info(&pdev->dev, "%s %d: probe phytium mci successful.\n", __func__, __LINE__); -+ return 0; -+ -+release: -+ phytium_mci_deinit_hw(host); -+release_mem: -+ if (host->dma.adma_table) { -+ dma_free_coherent(&pdev->dev, -+ MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), -+ host->dma.adma_table, host->dma.adma_addr); -+ } -+host_free: -+ mmc_free_host(mmc); -+ return ret; -+} -+ -+static int phytium_mci_remove(struct platform_device *pdev) -+{ -+ struct mmc_host *mmc; -+ struct phytium_mci_host *host; -+ -+ mmc = platform_get_drvdata(pdev); -+ if (!mmc) { -+ dev_info(&pdev->dev, "%s %d: mmc is null.\n", __func__, __LINE__); -+ return -1; -+ } -+ host = mmc_priv(mmc); -+ if (!host) { -+ dev_info(&pdev->dev, "%s %d: host is null.\n", __func__, __LINE__); -+ mmc_remove_host(mmc); -+ mmc_free_host(mmc); -+ return -1; -+ } -+ del_timer(&host->hotplug_timer); -+ del_timer_sync(&host->timeout_timer); -+ mmc_remove_host(host->mmc); -+ -+ if (host->dma.adma_table) { -+ dma_free_coherent(&pdev->dev, -+ MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), -+ host->dma.adma_table, host->dma.adma_addr); -+ } -+ phytium_mci_deinit_hw(host); -+ mmc_free_host(mmc); -+ platform_set_drvdata(pdev, NULL); -+ return 0; -+} -+ -+static const struct of_device_id phytium_mci_of_ids[] = { -+ { .compatible = "phytium,mci", }, -+ {} -+}; -+ -+MODULE_DEVICE_TABLE(of, phytium_mci_of_ids); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_mci_acpi_ids[] = { -+ { .id = "PHYT0017" }, -+ { } -+}; -+ -+MODULE_DEVICE_TABLE(acpi, phytium_mci_acpi_ids); -+#else -+#define phytium_mci_acpi_ids NULL -+#endif -+ -+static struct platform_driver phytium_mci_driver = { -+ .probe = phytium_mci_probe, -+ .remove = phytium_mci_remove, -+ .driver = { -+ .name = "phytium-mci-platform", -+ .of_match_table = phytium_mci_of_ids, -+ .acpi_match_table = phytium_mci_acpi_ids, -+ .pm = &phytium_mci_dev_pm_ops, -+ }, -+}; -+ -+module_platform_driver(phytium_mci_driver); -+ -+MODULE_DESCRIPTION("Phytium Multimedia Card Interface driver"); -+MODULE_LICENSE("GPL v2"); -+MODULE_AUTHOR("Cheng Quan "); -diff --git a/drivers/mmc/host/phytium-mci.c b/drivers/mmc/host/phytium-mci.c -new file mode 100644 -index 000000000..1ecbd9994 ---- /dev/null -+++ b/drivers/mmc/host/phytium-mci.c -@@ -0,0 +1,1563 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * Driver for Phytium Multimedia Card Interface -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#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 "phytium-mci.h" -+ -+static const u32 cmd_ints_mask = MCI_INT_MASK_RE | MCI_INT_MASK_CMD | MCI_INT_MASK_RCRC | -+ MCI_INT_MASK_RTO | MCI_INT_MASK_HTO | MCI_RAW_INTS_HLE; -+ -+static const u32 data_ints_mask = MCI_INT_MASK_DTO | MCI_INT_MASK_DCRC | MCI_INT_MASK_DRTO | -+ MCI_INT_MASK_SBE_BCI; -+static const u32 cmd_err_ints_mask = MCI_INT_MASK_RTO | MCI_INT_MASK_RCRC | MCI_INT_MASK_RE | -+ MCI_INT_MASK_DCRC | MCI_INT_MASK_DRTO | -+ MCI_MASKED_INTS_SBE_BCI; -+ -+static const u32 dmac_ints_mask = MCI_DMAC_INT_ENA_FBE | MCI_DMAC_INT_ENA_DU | -+ MCI_DMAC_INT_ENA_NIS | MCI_DMAC_INT_ENA_AIS; -+static const u32 dmac_err_ints_mask = MCI_DMAC_INT_ENA_FBE | MCI_DMAC_INT_ENA_DU | -+ MCI_DMAC_INT_ENA_AIS; -+ -+static void phytium_mci_cmd_next(struct phytium_mci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd); -+static void phytium_mci_adma_reset(struct phytium_mci_host *host); -+static void phytium_mci_send_cmd(struct phytium_mci_host *host, u32 cmd, u32 arg); -+static bool phytium_mci_data_xfer_done(struct phytium_mci_host *host, u32 events, -+ struct mmc_request *mrq, struct mmc_data *data); -+static void phytium_mci_init_adma_table(struct phytium_mci_host *host, -+ struct phytium_mci_dma *dma); -+static void phytium_mci_init_hw(struct phytium_mci_host *host); -+static int phytium_mci_get_cd(struct mmc_host *mmc); -+static int phytium_mci_err_irq(struct phytium_mci_host *host, u32 dmac_events, u32 events); -+ -+static void sdr_set_bits(void __iomem *reg, u32 bs) -+{ -+ u32 val = readl(reg); -+ -+ val |= bs; -+ writel(val, reg); -+} -+ -+static void sdr_clr_bits(void __iomem *reg, u32 bs) -+{ -+ u32 val = readl(reg); -+ -+ val &= ~bs; -+ writel(val, reg); -+} -+ -+static void phytium_mci_reset_hw(struct phytium_mci_host *host) -+{ -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET); -+ -+ while (readl(host->base + MCI_CNTRL) & (MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET)) -+ cpu_relax(); -+ phytium_mci_send_cmd(host, MCI_CMD_UPD_CLK, 0); -+} -+ -+static void phytium_mci_update_external_clk(struct phytium_mci_host *host, u32 uhs_reg_value) -+{ -+ writel(0, host->base + MCI_UHS_REG_EXT); -+ writel(uhs_reg_value, host->base + MCI_UHS_REG_EXT); -+ while (!(readl(host->base + MCI_CCLK_RDY) & 0x1)) -+ cpu_relax(); -+} -+ -+static void phytium_mci_prepare_data(struct phytium_mci_host *host, -+ struct mmc_request *mrq) -+{ -+ struct mmc_data *data = mrq->data; -+ -+ if (!(data->host_cookie & MCI_PREPARE_FLAG)) { -+ data->host_cookie |= MCI_PREPARE_FLAG; -+ data->sg_count = dma_map_sg(host->dev, data->sg, data->sg_len, -+ mmc_get_dma_dir(data)); -+ } -+} -+ -+static void phytium_mci_unprepare_data(struct phytium_mci_host *host, -+ struct mmc_request *mrq) -+{ -+ struct mmc_data *data = mrq->data; -+ -+ if (data->host_cookie & MCI_ASYNC_FLAG) -+ return; -+ -+ if (data->host_cookie & MCI_PREPARE_FLAG) { -+ dma_unmap_sg(host->dev, data->sg, data->sg_len, mmc_get_dma_dir(data)); -+ data->host_cookie &= ~MCI_PREPARE_FLAG; -+ } -+} -+ -+static void phytium_mci_send_cmd(struct phytium_mci_host *host, u32 cmd, u32 arg) -+{ -+ int rc; -+ u32 data; -+ -+ writel(arg, host->base + MCI_CMDARG); -+ wmb(); /* drain writebuffer */ -+ -+ rc = readl_relaxed_poll_timeout(host->base + MCI_STATUS, -+ data, -+ !(data & MCI_STATUS_CARD_BUSY), -+ 0, 100 * 1000); -+ if (rc == -ETIMEDOUT) -+ pr_debug("%s %d, timeout mci_status: 0x%08x\n", __func__, __LINE__, data); -+ -+ writel(MCI_CMD_START | cmd, host->base + MCI_CMD); -+ -+ rc = readl_relaxed_poll_timeout(host->base + MCI_CMD, -+ data, -+ !(data & MCI_CMD_START), -+ 0, 100 * 1000); -+ if (rc == -ETIMEDOUT) -+ pr_debug("%s %d, timeout mci_cmd: 0x%08x\n", __func__, __LINE__, data); -+} -+ -+static void phytium_mci_update_cmd11(struct phytium_mci_host *host, u32 cmd) -+{ -+ writel(MCI_CMD_START | cmd, host->base + MCI_CMD); -+ -+ while (readl(host->base + MCI_CMD) & MCI_CMD_START) -+ cpu_relax(); -+} -+ -+static void phytium_mci_set_clk(struct phytium_mci_host *host, struct mmc_ios *ios) -+{ -+ u32 div = 0xff, drv = 0, sample = 0; -+ unsigned long clk_rate; -+ u32 mci_cmd_bits = MCI_CMD_UPD_CLK; -+ u32 cmd_reg; -+ u32 cur_cmd_index; -+ u32 first_uhs_div, tmp_ext_reg; -+ -+ cmd_reg = readl(host->base + MCI_CMD); -+ cur_cmd_index = cmd_reg & 0x3F; -+ -+ if (cur_cmd_index == SD_SWITCH_VOLTAGE) -+ mci_cmd_bits |= MCI_CMD_VOLT_SWITCH; -+ if (ios->clock) { -+ if (host->current_ios_clk == ios->clock) -+ return; -+ -+ dev_dbg(host->dev, "will change clock, host->clk_rate: %ld, ios->clock: %d\n", -+ host->clk_rate, ios->clock); -+ -+ if (ios->clock >= 25000000) -+ tmp_ext_reg = 0x202; -+ else if (ios->clock == 400000) -+ tmp_ext_reg = 0x502; -+ else -+ tmp_ext_reg = 0x302; -+ -+ phytium_mci_update_external_clk(host, tmp_ext_reg); -+ sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ -+ if (cur_cmd_index == SD_SWITCH_VOLTAGE) -+ phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); -+ else -+ phytium_mci_send_cmd(host, mci_cmd_bits, 0); -+ -+ clk_rate = host->clk_rate; -+ first_uhs_div = 1 + ((tmp_ext_reg >> 8)&0xFF); -+ div = clk_rate / (2 * first_uhs_div * ios->clock); -+ if (div > 2) { -+ sample = div / 2 + 1; -+ drv = sample - 1; -+ writel((sample << 16) | (drv << 8) | (div & 0xff), -+ host->base + MCI_CLKDIV); -+ } else if (div == 2) { -+ drv = 0; -+ sample = 1; -+ writel((drv << 8) | (sample << 16) | (div & 0xff), -+ host->base + MCI_CLKDIV); -+ } -+ -+ dev_dbg(host->dev, "UHS_REG_EXT ext: %x, CLKDIV: %x\n", -+ readl(host->base + MCI_UHS_REG_EXT), readl(host->base + MCI_CLKDIV)); -+ -+ sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ -+ if (cur_cmd_index == SD_SWITCH_VOLTAGE) -+ phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); -+ else -+ phytium_mci_send_cmd(host, mci_cmd_bits, 0); -+ -+ host->current_ios_clk = ios->clock; -+ -+ dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", -+ host->clk_rate, ios->clock); -+ } else { -+ host->current_ios_clk = 0; -+ sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ -+ if (cur_cmd_index == SD_SWITCH_VOLTAGE) -+ phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); -+ else -+ phytium_mci_send_cmd(host, mci_cmd_bits, 0); -+ -+ sdr_clr_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); -+ dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", -+ host->clk_rate, ios->clock); -+ } -+} -+ -+static inline u32 -+phytium_mci_cmd_find_resp(struct phytium_mci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ u32 resp; -+ -+ switch (mmc_resp_type(cmd)) { -+ case MMC_RSP_R1: -+ case MMC_RSP_R1B: -+ resp = 0x5; -+ break; -+ -+ case MMC_RSP_R2: -+ resp = 0x7; -+ break; -+ -+ case MMC_RSP_R3: -+ resp = 0x1; -+ break; -+ -+ case MMC_RSP_NONE: -+ default: -+ resp = 0x0; -+ break; -+ } -+ -+ return resp; -+} -+ -+static inline -+u32 phytium_mci_cmd_prepare_raw_cmd(struct phytium_mci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ u32 opcode = cmd->opcode; -+ u32 resp = phytium_mci_cmd_find_resp(host, mrq, cmd); -+ u32 rawcmd = ((opcode & 0x3f) | ((resp & 0x7) << 6)); -+ -+ if (opcode == MMC_GO_INACTIVE_STATE || -+ (opcode == SD_IO_RW_DIRECT && ((cmd->arg >> 9) & 0x1FFFF) == SDIO_CCCR_ABORT)) -+ rawcmd |= (0x1 << 14); -+ else if (opcode == SD_SWITCH_VOLTAGE) -+ rawcmd |= (0x1 << 28); -+ -+ if (test_and_clear_bit(MCI_CARD_NEED_INIT, &host->flags)) -+ rawcmd |= (0x1 << 15); -+ -+ if (cmd->data) { -+ struct mmc_data *data = cmd->data; -+ -+ rawcmd |= (0x1 << 9); -+ -+ if (data->flags & MMC_DATA_WRITE) -+ rawcmd |= (0x1 << 10); -+ } -+ -+ return (rawcmd | (0x1 << 29) | (0x1 << 31)); -+} -+ -+static inline void -+phytium_mci_adma_write_desc(struct phytium_mci_host *host, -+ struct phytium_adma2_64_desc *desc, -+ dma_addr_t addr, u32 len, u32 attribute) -+{ -+ desc->attribute = attribute; -+ desc->len = len; -+ desc->addr_lo = lower_32_bits(addr); -+ desc->addr_hi = upper_32_bits(addr); -+ dev_dbg(host->dev, "%s %d:addr_lo:0x%x ddr_hi:0x%x\n", __func__, -+ __LINE__, desc->addr_lo, desc->addr_hi); -+ -+ if ((attribute == 0x80000004) || (attribute == 0x8000000c)) { -+ desc->desc_lo = 0; -+ desc->desc_hi = 0; -+ } -+} -+ -+static void -+phytium_mci_data_sg_write_2_admc_table(struct phytium_mci_host *host, struct mmc_data *data) -+{ -+ struct phytium_adma2_64_desc *desc; -+ u32 dma_len, i; -+ dma_addr_t dma_address; -+ struct scatterlist *sg; -+ -+ phytium_mci_init_adma_table(host, &host->dma); -+ -+ desc = host->dma.adma_table; -+ for_each_sg(data->sg, sg, data->sg_count, i) { -+ dma_address = sg_dma_address(sg); -+ dma_len = sg_dma_len(sg); -+ -+ if (i == 0) { -+ if (sg_is_last(sg) || (data->sg_count == 1 && dma_len == SD_BLOCK_SIZE)) -+ phytium_mci_adma_write_desc(host, desc, dma_address, -+ dma_len, 0x8000000c); -+ else -+ phytium_mci_adma_write_desc(host, desc, dma_address, -+ dma_len, 0x8000001a); -+ } else if (sg_is_last(sg)) { -+ phytium_mci_adma_write_desc(host, desc, dma_address, -+ dma_len, 0x80000004); -+ } else { -+ phytium_mci_adma_write_desc(host, desc, dma_address, -+ dma_len, 0x80000012); -+ } -+ -+ desc++; -+ } -+} -+ -+static void -+phytium_mci_data_sg_write_2_fifo(struct phytium_mci_host *host, struct mmc_data *data) -+{ -+ struct scatterlist *sg; -+ u32 dma_len, i, j; -+ u32 *virt_addr; -+ -+ if (mmc_get_dma_dir(data) == DMA_TO_DEVICE) { -+ writel(0x1<<10, host->base + MCI_CMD); -+ for_each_sg(data->sg, sg, data->sg_count, i) { -+ dma_len = sg_dma_len(sg); -+ virt_addr = sg_virt(data->sg); -+ for (j = 0; j < (dma_len / 4); j++) { -+ writel(*virt_addr, host->base + MCI_DATA); -+ virt_addr++; -+ } -+ } -+ } -+} -+ -+static void phytium_mci_restart_clk(struct phytium_mci_host *host) -+{ -+ u32 clk_div, uhs; -+ -+ while (readl(host->base + MCI_CMD) & MCI_CMD_START) -+ cpu_relax(); -+ sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ clk_div = readl(host->base + MCI_CLKDIV); -+ uhs = readl(host->base + MCI_UHS_REG_EXT); -+ writel(0, host->base + MCI_UHS_REG_EXT); -+ writel(uhs, host->base + MCI_UHS_REG_EXT); -+ while (!(readl(host->base + MCI_CCLK_RDY) & 0x1)) -+ cpu_relax(); -+ -+ writel(clk_div, host->base + MCI_CLKDIV); -+ sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ writel(MCI_CMD_START | MCI_CMD_UPD_CLK, host->base + MCI_CMD); -+ while (readl(host->base + MCI_CMD) & MCI_CMD_START) -+ cpu_relax(); -+} -+ -+static int -+phytim_mci_start_multiple_write(struct phytium_mci_host *host, -+ struct mmc_request *mrq, u32 cnts, u32 offset) -+{ -+ u32 rawcmd, cmd_status; -+ struct mmc_command *cmd = mrq->cmd; -+ u32 *rsp = cmd->resp; -+ unsigned long deadline_time; -+ -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) -+ return -ESHUTDOWN; -+ -+ while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) -+ cpu_relax(); -+ -+ writel(0xffffe, host->base + MCI_RAW_INTS); -+ rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); -+ writel(mrq->data->blksz, host->base + MCI_BLKSIZ); -+ writel(cnts * mrq->data->blksz, host->base + MCI_BYTCNT); -+ writel(cmd->arg + offset, host->base + MCI_CMDARG); -+ writel(rawcmd, host->base + MCI_CMD); -+ deadline_time = jiffies + msecs_to_jiffies(200); -+ -+ cmd_status = readl(host->base + MCI_RAW_INTS); -+ while (!(cmd_status & MCI_MASKED_INTS_CMD)) { -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && -+ readl(host->base + MCI_CARD_DETECT)) -+ return -ESHUTDOWN; -+ -+ cmd_status = readl(host->base + MCI_RAW_INTS); -+ if (cmd_err_ints_mask & cmd_status) -+ return -ESHUTDOWN; -+ -+ if (cmd_status & MCI_MASKED_INTS_CMD) -+ break; -+ -+ if (time_after(jiffies, deadline_time)) -+ return -ESHUTDOWN; -+ } -+ -+ if (cmd_status & MCI_MASKED_INTS_CMD) { -+ if (cmd->flags & MMC_RSP_136) { -+ rsp[3] = readl(host->base + MCI_RESP0); -+ rsp[2] = readl(host->base + MCI_RESP1); -+ rsp[1] = readl(host->base + MCI_RESP2); -+ rsp[0] = readl(host->base + MCI_RESP3); -+ } else { -+ rsp[0] = readl(host->base + MCI_RESP0); -+ } -+ } -+ deadline_time = jiffies + msecs_to_jiffies(1000); -+ while (!(cmd_status & MCI_MASKED_INTS_DTO)) { -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && -+ readl(host->base + MCI_CARD_DETECT)) -+ return -ESHUTDOWN; -+ cmd_status = readl(host->base + MCI_RAW_INTS); -+ if (cmd_err_ints_mask & cmd_status) -+ return -ESHUTDOWN; -+ if (cmd_status & MCI_MASKED_INTS_DTO) -+ return 0; -+ if (time_after(jiffies, deadline_time)) -+ return -ESHUTDOWN; -+ } -+ return 0; -+} -+ -+static int -+phytium_mci_start_sbc_stop_cmd(struct phytium_mci_host *host, struct mmc_request *mrq, -+ struct mmc_command *cmd, u32 arg) -+{ -+ u32 rawcmd, cmd_status; -+ u32 *rsp = cmd->resp; -+ unsigned long deadline_time; -+ -+ writel(0xffffe, host->base + MCI_RAW_INTS); -+ -+ while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) -+ cpu_relax(); -+ -+ rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); -+ writel(arg, host->base + MCI_CMDARG); -+ writel(rawcmd, host->base + MCI_CMD); -+ -+ deadline_time = jiffies + msecs_to_jiffies(200); -+ cmd_status = readl(host->base + MCI_RAW_INTS); -+ while (!(cmd_status & MCI_MASKED_INTS_CMD)) { -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && -+ readl(host->base + MCI_CARD_DETECT)) -+ return -ENOMEDIUM; -+ -+ cmd_status = readl(host->base + MCI_RAW_INTS); -+ if (cmd_err_ints_mask & cmd_status) -+ return -ETIMEDOUT; -+ -+ if (cmd_status & MCI_MASKED_INTS_CMD) -+ break; -+ -+ if (time_after(jiffies, deadline_time)) -+ return -ETIMEDOUT; -+ } -+ -+ if (cmd_status & MCI_MASKED_INTS_CMD) { -+ if (cmd->flags & MMC_RSP_136) { -+ rsp[3] = readl(host->base + MCI_RESP0); -+ rsp[2] = readl(host->base + MCI_RESP1); -+ rsp[1] = readl(host->base + MCI_RESP2); -+ rsp[0] = readl(host->base + MCI_RESP3); -+ } else { -+ rsp[0] = readl(host->base + MCI_RESP0); -+ } -+ } -+ -+ if (cmd_err_ints_mask & cmd_status) -+ return -ETIMEDOUT; -+ -+ return 0; -+} -+ -+static void -+phytium_mci_start_write_multiple_non_dma(struct mmc_host *mmc, struct mmc_request *mrq) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ struct mmc_data *data = mrq->data; -+ u32 write_cnts, last_cnts; -+ u32 i, j, k, send_cnt_one_sg, block_offset; -+ int ret = 0, dma_len; -+ struct scatterlist *sg; -+ u32 *virt_addr = NULL; -+ -+ write_cnts = data->blocks / 4; -+ (data->blocks % 4) ? write_cnts++ : write_cnts; -+ last_cnts = data->blocks % 4; -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { -+ ret = -ENOMEDIUM; -+ goto write_err; -+ } -+ -+ dev_dbg(host->dev, "%s: cmd:%d, block counts:%d\n", -+ __func__, mrq->cmd->opcode, data->blocks); -+ -+ sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET); -+ while (readl(host->base + MCI_CNTRL) & MCI_CNTRL_FIFO_RESET) -+ cpu_relax(); -+ sdr_clr_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); -+ -+ if (mmc_get_dma_dir(data) == DMA_TO_DEVICE) { -+ block_offset = 0; -+ for_each_sg(data->sg, sg, data->sg_count, i) { -+ /* Each SG data transfor starts */ -+ dma_len = sg_dma_len(sg); -+ send_cnt_one_sg = (dma_len / MCI_MAX_FIFO_CNT) + 1; -+ virt_addr = sg_virt(sg); -+ for (k = 0; k < send_cnt_one_sg; k++) { -+ if (dma_len && dma_len >= MCI_MAX_FIFO_CNT) { -+ /*first write sbc cmd*/ -+ ret = phytium_mci_start_sbc_stop_cmd(host, mrq, -+ mrq->sbc, 4); -+ if (ret) -+ goto write_err; -+ writel(0x1 << 10, host->base + MCI_CMD); -+ for (j = 0; j < (MCI_MAX_FIFO_CNT / 4); j++) { -+ writel(*virt_addr, host->base + MCI_DATA); -+ virt_addr++; -+ } -+ -+ /*second write cmd25 here*/ -+ ret = phytim_mci_start_multiple_write(host, mrq, 4, -+ block_offset); -+ if (ret) -+ goto write_err; -+ block_offset += 4; -+ dma_len -= MCI_MAX_FIFO_CNT; -+ } else if (dma_len > 0) { -+ /*first write sbc cmd*/ -+ last_cnts = dma_len / 512; -+ ret = phytium_mci_start_sbc_stop_cmd(host, mrq, mrq->sbc, -+ last_cnts); -+ if (ret) -+ goto write_err; -+ writel(0x1 << 10, host->base + MCI_CMD); -+ for (j = 0; j < (dma_len / 4); j++) { -+ writel(*virt_addr, host->base + MCI_DATA); -+ virt_addr++; -+ } -+ /*second write cmd25 here*/ -+ ret = phytim_mci_start_multiple_write(host, mrq, last_cnts, -+ block_offset); -+ if (ret) -+ goto write_err; -+ block_offset += last_cnts; -+ dma_len = 0; -+ } else { -+ dev_dbg(host->dev, "%s: sg %d end\n", __func__, i); -+ break; -+ } -+ } -+ } -+ } -+ -+write_err: -+ host->data = NULL; -+ host->cmd = NULL; -+ host->mrq = NULL; -+ writel(0xffffe, host->base + MCI_RAW_INTS); -+ if (ret) { -+ data->bytes_xfered = 0; -+ if (ret == -ESHUTDOWN) { -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET); -+ while (readl(host->base + MCI_CNTRL) & MCI_CNTRL_FIFO_RESET) -+ cpu_relax(); -+ -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_CONTROLLER_RESET); -+ while (readl(host->base + MCI_STATUS) & MCI_STATUS_CARD_BUSY) -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_CONTROLLER_RESET); -+ phytium_mci_restart_clk(host); -+ phytium_mci_start_sbc_stop_cmd(host, mrq, mrq->stop, mrq->stop->arg); -+ } -+ data->error = -ETIMEDOUT; -+ mrq->cmd->error = -ETIMEDOUT; -+ mmc_request_done(host->mmc, mrq); -+ return; -+ } -+ data->bytes_xfered = data->blocks * data->blksz; -+ mmc_request_done(host->mmc, mrq); -+} -+ -+static void -+phytium_mci_start_data(struct phytium_mci_host *host, struct mmc_request *mrq, -+ struct mmc_command *cmd, struct mmc_data *data) -+{ -+ bool read; -+ u32 rawcmd; -+ unsigned long flags; -+ -+ -+ WARN_ON(host->cmd); -+ host->cmd = cmd; -+ cmd->error = 0; -+ WARN_ON(host->data); -+ host->data = data; -+ read = data->flags & MMC_DATA_READ; -+ -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { -+ phytium_mci_err_irq(host, 0, MCI_INT_MASK_RTO); -+ return; -+ } -+ /* clear interrupts */ -+ writel(0xffffe, host->base + MCI_RAW_INTS); -+ -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET); -+ -+ while (readl(host->base + MCI_CNTRL) & (MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET)) -+ cpu_relax(); -+ -+ if (host->adtc_type == COMMOM_ADTC) -+ sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); -+ else -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); -+ wmb(); /* drain writebuffer */ -+ sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE); -+ -+ rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); -+ if (host->is_use_dma && host->adtc_type == BLOCK_RW_ADTC) -+ phytium_mci_data_sg_write_2_admc_table(host, data); -+ else -+ phytium_mci_data_sg_write_2_fifo(host, data); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ sdr_set_bits(host->base + MCI_INT_MASK, cmd_ints_mask | data_ints_mask); -+ if (host->is_use_dma && host->adtc_type == BLOCK_RW_ADTC) { -+ sdr_set_bits(host->base + MCI_DMAC_INT_ENA, dmac_ints_mask); -+ /* Enable the IDMAC */ -+ sdr_set_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); -+ writel((u32)host->dma.adma_addr, host->base + MCI_DESC_LIST_ADDRL); -+ writel((u32)(host->dma.adma_addr >> 32), host->base + MCI_DESC_LIST_ADDRH); -+ } -+ writel(mrq->data->blksz, host->base + MCI_BLKSIZ); -+ writel(mrq->data->blocks * mrq->data->blksz, host->base + MCI_BYTCNT); -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE); -+ writel(cmd->arg, host->base + MCI_CMDARG); -+ wmb(); /* drain writebuffer */ -+ writel(rawcmd, host->base + MCI_CMD); -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ mod_timer(&host->timeout_timer, -+ jiffies + msecs_to_jiffies(MMC_REQ_TIMEOUT_MS)); -+} -+ -+static void phytium_mci_track_cmd_data(struct phytium_mci_host *host, -+ struct mmc_command *cmd, -+ struct mmc_data *data) -+{ -+ if (host->error) -+ dev_dbg(host->dev, "%s: cmd=%d arg=%08X; host->error=0x%08X\n", -+ __func__, cmd->opcode, cmd->arg, host->error); -+} -+ -+static void phytium_mci_request_done(struct phytium_mci_host *host, struct mmc_request *mrq) -+{ -+ unsigned long flags; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ del_timer(&host->timeout_timer); -+ host->mrq = NULL; -+ if (host->cmd) -+ host->cmd = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ phytium_mci_track_cmd_data(host, mrq->cmd, mrq->data); -+ -+ if (mrq->data) -+ phytium_mci_unprepare_data(host, mrq); -+ -+ mmc_request_done(host->mmc, mrq); -+} -+ -+static bool phytium_mci_cmd_done(struct phytium_mci_host *host, int events, -+ struct mmc_request *mrq, struct mmc_command *cmd) -+{ -+ bool done = false; -+ unsigned long flags; -+ u32 *rsp = cmd->resp; -+ -+ if (!(events & (MCI_RAW_INTS_RCRC | MCI_RAW_INTS_RE | MCI_RAW_INTS_CMD | -+ MCI_RAW_INTS_RTO | MCI_INT_MASK_HTO))) { -+ dev_err(host->dev, "No interrupt generation:h%x\n", events); -+ return done; -+ } -+ -+ spin_lock_irqsave(&host->lock, flags); -+ done = !host->cmd; -+ host->cmd = NULL; -+ if (done) { -+ spin_unlock_irqrestore(&host->lock, flags); -+ return true; -+ } -+ sdr_clr_bits(host->base + MCI_INT_MASK, cmd_ints_mask); -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (cmd->flags & MMC_RSP_PRESENT) { -+ if (cmd->flags & MMC_RSP_136) { -+ rsp[3] = readl(host->base + MCI_RESP0); -+ rsp[2] = readl(host->base + MCI_RESP1); -+ rsp[1] = readl(host->base + MCI_RESP2); -+ rsp[0] = readl(host->base + MCI_RESP3); -+ } else { -+ /* -+ * Sometimes get ACMD41 cmd done irq but the respose index still the APP_CMD, -+ * so polling the mci status entill the respose index change. -+ */ -+ if (cmd->opcode == SD_APP_OP_COND) { -+ int polling_cnt = 20; -+ while (MMC_APP_CMD == MCI_STATUS_RESPOSE_INDEX(readl(host->base + MCI_STATUS))) { -+ udelay(100); -+ polling_cnt --; -+ if (polling_cnt == 0) { -+ dev_info(host->dev, "hw respose index not equal cmd opcode, respose value may error\n"); -+ break; -+ } -+ } -+ } -+ rsp[0] = readl(host->base + MCI_RESP0); -+ } -+ -+ if (cmd->opcode == SD_SEND_RELATIVE_ADDR) -+ host->current_rca = rsp[0] & 0xFFFF0000; -+ } -+ if (!(events & (MCI_RAW_INTS_CMD | MCI_INT_MASK_HTO))) { -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && (events & MCI_RAW_INTS_RTO) -+ && readl(host->base + MCI_CARD_DETECT)) { -+ cmd->error = -ENOMEDIUM; -+ rsp[0] = 0; -+ } else if (events & MCI_RAW_INTS_RTO || -+ (cmd->opcode != MMC_SEND_TUNING_BLOCK && -+ cmd->opcode != MMC_SEND_TUNING_BLOCK_HS200)) { -+ cmd->error = -ETIMEDOUT; -+ } else if (events & MCI_RAW_INTS_RCRC) { -+ cmd->error = -EILSEQ; -+ } else { -+ cmd->error = -ETIMEDOUT; -+ } -+ } -+ phytium_mci_cmd_next(host, mrq, cmd); -+ return true; -+} -+ -+static void phytium_mci_start_command(struct phytium_mci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ u32 rawcmd; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ WARN_ON(host->cmd); -+ host->cmd = cmd; -+ cmd->error = 0; -+ writel(0xffffe, host->base + MCI_RAW_INTS); -+ -+ rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { -+ phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, cmd); -+ return; -+ } -+ -+ spin_lock_irqsave(&host->lock, flags); -+ sdr_set_bits(host->base + MCI_INT_MASK, cmd_ints_mask); -+ writel(cmd->arg, host->base + MCI_CMDARG); -+ writel(rawcmd, host->base + MCI_CMD); -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ mod_timer(&host->timeout_timer, -+ jiffies + msecs_to_jiffies(MMC_REQ_TIMEOUT_MS)); -+} -+ -+static void -+phytium_mci_cmd_next(struct phytium_mci_host *host, struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ if ((cmd->error && !(cmd->opcode == MMC_SEND_TUNING_BLOCK || -+ cmd->opcode == MMC_SEND_TUNING_BLOCK_HS200)) || -+ (mrq->sbc && mrq->sbc->error)) { -+ phytium_mci_request_done(host, mrq); -+ } else if (cmd == mrq->sbc) { -+ if ((mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_WRITE_BLOCK)) { -+ dev_dbg(host->dev, "%s %d:sbc done and next cmd :%d length:%d\n", -+ __func__, __LINE__, mrq->cmd->opcode, mrq->data->sg->length); -+ phytium_mci_prepare_data(host, mrq); -+ if (host->is_use_dma) -+ host->adtc_type = BLOCK_RW_ADTC; -+ else -+ host->adtc_type = COMMOM_ADTC; -+ phytium_mci_start_data(host, mrq, mrq->cmd, mrq->data); -+ } else { -+ dev_err(host->dev, "%s %d:ERROR: cmd %d followers the SBC\n", -+ __func__, __LINE__, cmd->opcode); -+ } -+ } else if (!cmd->data) { -+ phytium_mci_request_done(host, mrq); -+ } -+} -+ -+static void phytium_mci_ops_request(struct mmc_host *mmc, struct mmc_request *mrq) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ u32 data; -+ int rc; -+ -+ host->error = 0; -+ WARN_ON(host->mrq); -+ host->mrq = mrq; -+ -+ rc = readl_relaxed_poll_timeout(host->base + MCI_STATUS, -+ data, -+ !(data & MCI_STATUS_CARD_BUSY), -+ 0, 500 * 1000); -+ if (rc == -ETIMEDOUT) -+ pr_debug("%s %d, timeout mci_status: 0x%08x\n", __func__, __LINE__, data); -+ -+ dev_dbg(host->dev, "%s %d: cmd:%d arg:0x%x\n", __func__, __LINE__, -+ mrq->cmd->opcode, mrq->cmd->arg); -+ -+ if (host->is_device_x100 && mrq->sbc && mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) { -+ phytium_mci_start_write_multiple_non_dma(mmc, mrq); -+ return; -+ } -+ -+ if (mrq->sbc) { -+ phytium_mci_start_command(host, mrq, mrq->sbc); -+ return; -+ } -+ if (mrq->data) { -+ phytium_mci_prepare_data(host, mrq); -+ -+ if ((mrq->data->sg->length >= 512) && host->is_use_dma && -+ ((mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_WRITE_BLOCK) || -+ (mrq->cmd->opcode == SD_IO_RW_EXTENDED))) -+ -+ host->adtc_type = BLOCK_RW_ADTC; -+ else -+ host->adtc_type = COMMOM_ADTC; -+ -+ phytium_mci_start_data(host, mrq, mrq->cmd, mrq->data); -+ return; -+ } -+ phytium_mci_start_command(host, mrq, mrq->cmd); -+} -+ -+static void phytium_mci_pre_req(struct mmc_host *mmc, struct mmc_request *mrq) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ struct mmc_data *data = mrq->data; -+ -+ if (!data) -+ return; -+ -+ phytium_mci_prepare_data(host, mrq); -+ data->host_cookie |= MCI_ASYNC_FLAG; -+} -+ -+static void phytium_mci_post_req(struct mmc_host *mmc, struct mmc_request *mrq, -+ int err) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ struct mmc_data *data = mrq->data; -+ -+ if (!data) -+ return; -+ -+ if (data->host_cookie & MCI_ASYNC_FLAG) { -+ data->host_cookie &= ~MCI_ASYNC_FLAG; -+ phytium_mci_unprepare_data(host, mrq); -+ } -+} -+ -+static void phytium_mci_data_read_without_dma(struct phytium_mci_host *host, -+ struct mmc_data *data) -+{ -+ u32 length, i, data_val, dma_len, tmp = 0; -+ u32 *virt_addr; -+ unsigned long flags; -+ struct scatterlist *sg; -+ -+ length = data->blocks * data->blksz; -+ -+ if (mmc_get_dma_dir(data) == DMA_FROM_DEVICE) { -+ spin_lock_irqsave(&host->lock, flags); -+ if (data->host_cookie & MCI_ASYNC_FLAG) { -+ tmp = MCI_ASYNC_FLAG; -+ phytium_mci_post_req(host->mmc, data->mrq, 0); -+ } else { -+ phytium_mci_unprepare_data(host, data->mrq); -+ } -+ -+ for_each_sg(data->sg, sg, data->sg_count, i) { -+ dma_len = sg_dma_len(sg); -+ virt_addr = sg_virt(data->sg); -+ -+ for (i = 0; i < (dma_len / 4); i++) { -+ data_val = readl(host->base + MCI_DATA); -+ memcpy(virt_addr, &data_val, 4); -+ ++virt_addr; -+ } -+ } -+ -+ if (tmp & MCI_ASYNC_FLAG) -+ phytium_mci_pre_req(host->mmc, data->mrq); -+ else -+ phytium_mci_prepare_data(host, data->mrq); -+ -+ spin_unlock_irqrestore(&host->lock, flags); -+ } -+ data->bytes_xfered = length; -+} -+ -+static void phytium_mci_data_xfer_next(struct phytium_mci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_data *data) -+{ -+ if (mmc_op_multi(mrq->cmd->opcode) && mrq->stop && -+ (data->error || !mrq->sbc)) { -+ while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) -+ cpu_relax(); -+ phytium_mci_start_command(host, mrq, mrq->stop); -+ } else { -+ phytium_mci_request_done(host, mrq); -+ } -+} -+ -+static bool phytium_mci_data_xfer_done(struct phytium_mci_host *host, u32 events, -+ struct mmc_request *mrq, struct mmc_data *data) -+{ -+ unsigned long flags; -+ bool done; -+ -+ unsigned int check_data = events & (MCI_RAW_INTS_DTO | MCI_RAW_INTS_RCRC | -+ MCI_RAW_INTS_DCRC | MCI_RAW_INTS_RE | -+ MCI_RAW_INTS_DRTO | MCI_RAW_INTS_EBE | -+ MCI_DMAC_STATUS_AIS | MCI_DMAC_STATUS_DU | -+ MCI_RAW_INTS_SBE_BCI | MCI_INT_MASK_RTO); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ done = !host->data; -+ -+ if (check_data || host->data) -+ host->data = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (done) -+ return true; -+ if (check_data) { -+ spin_lock_irqsave(&host->lock, flags); -+ sdr_clr_bits(host->base + MCI_DMAC_INT_ENA, dmac_ints_mask); -+ sdr_clr_bits(host->base + MCI_INT_MASK, data_ints_mask); -+ /* Stop the IDMAC running */ -+ sdr_clr_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); -+ dev_dbg(host->dev, "DMA stop\n"); -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (events & MCI_RAW_INTS_DTO) { -+ if (!host->is_use_dma || -+ (host->is_use_dma && host->adtc_type == COMMOM_ADTC && -+ (mrq->cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC)) -+ phytium_mci_data_read_without_dma(host, data); -+ else -+ data->bytes_xfered = data->blocks * data->blksz; -+ } else { -+ data->bytes_xfered = 0; -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) -+ && readl(host->base + MCI_CARD_DETECT) -+ && (events & cmd_err_ints_mask)) { -+ data->error = -ENOMEDIUM; -+ data->mrq->cmd->error = -ENOMEDIUM; -+ } else if (events & (MCI_RAW_INTS_DCRC | MCI_RAW_INTS_EBE | -+ MCI_RAW_INTS_SBE_BCI)) { -+ data->error = -EILSEQ; -+ host->cmd = NULL; -+ } else { -+ data->error = -ETIMEDOUT; -+ host->cmd = NULL; -+ } -+ } -+ -+ phytium_mci_data_xfer_next(host, mrq, data); -+ done = true; -+ } -+ return done; -+} -+ -+static int phytium_mci_card_busy(struct mmc_host *mmc) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ u32 status; -+ -+ status = readl(host->base + MCI_STATUS); -+ -+ return !!(status & MCI_STATUS_CARD_BUSY); -+} -+ -+static void __phytium_mci_enable_sdio_irq(struct phytium_mci_host *host, int enable) -+{ -+ if (enable) -+ sdr_set_bits(host->base + MCI_INT_MASK, MCI_INT_MASK_SDIO); -+ else -+ sdr_clr_bits(host->base + MCI_INT_MASK, MCI_INT_MASK_SDIO); -+} -+ -+static void phytium_mci_enable_sdio_irq(struct mmc_host *mmc, int enable) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ __phytium_mci_enable_sdio_irq(host, enable); -+} -+ -+static void hotplug_timer_func(struct timer_list *t) -+{ -+ struct phytium_mci_host *host; -+ u32 status; -+ -+ host = from_timer(host, t, hotplug_timer); -+ if (!host) -+ return; -+ -+ status = readl(host->base + MCI_CARD_DETECT); -+ -+ if (status & 0x1) { -+ if (host->mmc->card) { -+ cancel_delayed_work(&host->mmc->detect); -+ mmc_detect_change(host->mmc, msecs_to_jiffies(100)); -+ } -+ } else { -+ cancel_delayed_work(&host->mmc->detect); -+ mmc_detect_change(host->mmc, msecs_to_jiffies(200)); -+ } -+} -+ -+static void phytium_mci_request_timeout(struct timer_list *t) -+{ -+ struct phytium_mci_host *host = from_timer(host, t, timeout_timer); -+ -+ dev_err(host->dev, "request timeout\n"); -+ if (host->mrq) { -+ dev_err(host->dev, "aborting mrq=%p cmd=%d\n", -+ host->mrq, host->mrq->cmd->opcode); -+ if (host->cmd) { -+ dev_err(host->dev, "aborting cmd=%d\n", host->cmd->opcode); -+ phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, host->mrq, host->cmd); -+ } else if (host->data) { -+ dev_err(host->dev, "abort data: cmd%d; %d blocks\n", -+ host->mrq->cmd->opcode, host->data->blocks); -+ phytium_mci_data_xfer_done(host, MCI_RAW_INTS_RTO, host->mrq, -+ host->data); -+ } -+ } -+} -+ -+static int phytium_mci_err_irq(struct phytium_mci_host *host, u32 dmac_events, u32 events) -+{ -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ -+ mrq = host->mrq; -+ cmd = host->cmd; -+ data = host->data; -+ -+ if (cmd && (cmd == mrq->sbc)) { -+ phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->sbc); -+ } else if (cmd && (cmd == mrq->stop)) { -+ phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->stop); -+ } else if (data) { -+ data->error = -ETIMEDOUT; -+ if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || -+ (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) -+ phytium_mci_data_xfer_done(host, events | dmac_events, mrq, data); -+ } else if (cmd) { -+ phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->cmd); -+ } -+ -+ return 0; -+} -+ -+static irqreturn_t phytium_mci_irq(int irq, void *dev_id) -+{ -+ struct phytium_mci_host *host = (struct phytium_mci_host *) dev_id; -+ unsigned long flags; -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ u32 events, event_mask, dmac_events, dmac_evt_mask; -+ -+ if (!host) -+ return IRQ_NONE; -+ writel(0, host->base + 0xfd0); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ events = readl(host->base + MCI_RAW_INTS); -+ dmac_events = readl(host->base + MCI_DMAC_STATUS); -+ event_mask = readl(host->base + MCI_INT_MASK); -+ dmac_evt_mask = readl(host->base + MCI_DMAC_INT_ENA); -+ if ((!events) && (!(dmac_events&0x1fff))) { -+ spin_unlock_irqrestore(&host->lock, flags); -+ return IRQ_NONE; -+ } -+ dev_dbg(host->dev, "%s:events:%x,mask:0x%x,dmac_events:%x,dmac_mask:0x%x,cmd:%d\n", -+ __func__, events, event_mask, dmac_events, dmac_evt_mask, -+ host->mrq ? host->mrq->cmd->opcode : 255); -+ -+ mrq = host->mrq; -+ cmd = host->cmd; -+ data = host->data; -+ -+#if 0 -+ if (((events & event_mask) & MCI_RAW_INTS_SDIO) && -+ ((events == 0x10001) || (events == 0x10000) || (events == 0x10040))) { -+ writel(events, host->base + MCI_RAW_INTS); -+ __phytium_mci_enable_sdio_irq(host, 0); -+ sdio_signal_irq(host->mmc); -+ spin_unlock_irqrestore(&host->lock, flags); -+ goto irq_out; -+ } -+#endif -+ if ((events & event_mask) & MCI_RAW_INTS_SDIO) { -+ __phytium_mci_enable_sdio_irq(host, 0); -+ } -+ -+ writel((events & event_mask), host->base + MCI_RAW_INTS); -+ writel(dmac_events, host->base + MCI_DMAC_STATUS); -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if ((events & event_mask) & MCI_RAW_INTS_SDIO) { -+ sdio_signal_irq(host->mmc); -+ } -+ -+ if (((events & event_mask) == 0) && ((dmac_evt_mask & dmac_events) == 0)) -+ goto irq_out; -+ -+ if (((events & event_mask) & MCI_RAW_INTS_CD) && -+ !(host->mmc->caps & MMC_CAP_NONREMOVABLE)) { -+ mod_timer(&host->hotplug_timer, jiffies + usecs_to_jiffies(20000)); -+ dev_dbg(host->dev, "sd status changed here ! status:[%d] [%s %d]", -+ readl(host->base + MCI_CARD_DETECT), __func__, __LINE__); -+ -+ if ((events & event_mask) == MCI_RAW_INTS_CD) -+ goto irq_out; -+ } -+ -+ if (!mrq) { -+ if (events & MCI_RAW_INTS_HLE) -+ dev_dbg(host->dev, -+ "%s: MRQ=NULL and HW write locked, events=%08x,event_mask=%08x\n", -+ __func__, events, event_mask); -+ else -+ dev_dbg(host->dev, "%s: MRQ=NULL events:%08X evt_mask=%08X,sd_status:%d\n", -+ __func__, events, event_mask, readl(host->base + MCI_CARD_DETECT)); -+ goto irq_out; -+ } -+ -+ if ((dmac_events & dmac_err_ints_mask) || (events & cmd_err_ints_mask)) { -+ dev_dbg(host->dev, "ERR:events:%x,mask:0x%x,dmac_evts:%x,dmac_mask:0x%x,cmd:%d\n", -+ events, event_mask, dmac_events, dmac_evt_mask, mrq->cmd->opcode); -+ phytium_mci_err_irq(host, dmac_events & dmac_err_ints_mask, -+ events & cmd_err_ints_mask); -+ goto irq_out; -+ } -+ -+ if ((events & MCI_MASKED_INTS_DTO) && (events & MCI_MASKED_INTS_CMD)) { -+ phytium_mci_cmd_done(host, events, mrq, cmd); -+ phytium_mci_data_xfer_done(host, (events & data_ints_mask) | -+ (dmac_events & dmac_ints_mask), mrq, data); -+ } else if (events & MCI_MASKED_INTS_CMD || -+ ((events & MCI_INT_MASK_HTO) && (cmd->opcode == SD_SWITCH_VOLTAGE))) { -+ phytium_mci_cmd_done(host, events, mrq, cmd); -+ } else if (events & MCI_MASKED_INTS_DTO) { -+ phytium_mci_data_xfer_done(host, (events & data_ints_mask) | -+ (dmac_events & dmac_ints_mask), mrq, data); -+ } -+ -+irq_out: -+ return IRQ_HANDLED; -+} -+ -+static void phytium_mci_init_hw(struct phytium_mci_host *host) -+{ -+ u32 val; -+ int uhs_reg_value = 0x502; -+ -+ writel(MCI_SET_FIFOTH(0x2, 0x7, 0x100), host->base + MCI_FIFOTH); -+ writel(0x800001, host->base + MCI_CARD_THRCTL); -+ sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ phytium_mci_update_external_clk(host, uhs_reg_value); -+ -+ sdr_set_bits(host->base + MCI_PWREN, MCI_PWREN_ENABLE); -+ sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ sdr_set_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); -+ sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); -+ -+ phytium_mci_reset_hw(host); -+ -+ if (host->mmc->caps & MMC_CAP_NONREMOVABLE) -+ sdr_set_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); -+ else -+ sdr_clr_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); -+ -+ writel(0, host->base + MCI_INT_MASK); -+ val = readl(host->base + MCI_RAW_INTS); -+ writel(val, host->base + MCI_RAW_INTS); -+ writel(0, host->base + MCI_DMAC_INT_ENA); -+ val = readl(host->base + MCI_DMAC_STATUS); -+ writel(val, host->base + MCI_DMAC_STATUS); -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE)) -+ writel(MCI_INT_MASK_CD, host->base + MCI_INT_MASK); -+ -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE | -+ MCI_CNTRL_USE_INTERNAL_DMAC); -+ -+ writel(0xFFFFFFFF, host->base + MCI_TMOUT); -+ dev_info(host->dev, "init hardware done!"); -+ -+} -+ -+void phytium_mci_deinit_hw(struct phytium_mci_host *host) -+{ -+ u32 val; -+ -+ sdr_clr_bits(host->base + MCI_PWREN, MCI_PWREN_ENABLE); -+ sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ sdr_clr_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); -+ sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); -+ writel(0, host->base + MCI_INT_MASK); -+ val = readl(host->base + MCI_RAW_INTS); -+ writel(val, host->base + MCI_RAW_INTS); -+ writel(0, host->base + MCI_DMAC_INT_ENA); -+ val = readl(host->base + MCI_DMAC_STATUS); -+ writel(val, host->base + MCI_DMAC_STATUS); -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE)) -+ writel(MCI_INT_MASK_CD, host->base + MCI_INT_MASK); -+} -+EXPORT_SYMBOL_GPL(phytium_mci_deinit_hw); -+ -+static void phytium_mci_adma_reset(struct phytium_mci_host *host) -+{ -+ u32 bmod = readl(host->base + MCI_BUS_MODE); -+ -+ bmod |= MCI_BUS_MODE_SWR; -+ writel(bmod, host->base + MCI_BUS_MODE); -+} -+ -+static void phytium_mci_init_adma_table(struct phytium_mci_host *host, -+ struct phytium_mci_dma *dma) -+{ -+ struct phytium_adma2_64_desc *adma_table = dma->adma_table; -+ dma_addr_t dma_addr; -+ int i; -+ -+ memset(adma_table, 0, sizeof(struct phytium_adma2_64_desc) * MAX_BD_NUM); -+ -+ for (i = 0; i < (MAX_BD_NUM - 1); i++) { -+ dma_addr = dma->adma_addr + sizeof(*adma_table) * (i + 1); -+ adma_table[i].desc_lo = lower_32_bits(dma_addr); -+ adma_table[i].desc_hi = upper_32_bits(dma_addr); -+ adma_table[i].attribute = 0; -+ adma_table[i].NON1 = 0; -+ adma_table[i].len = 0; -+ adma_table[i].NON2 = 0; -+ } -+ -+ phytium_mci_adma_reset(host); -+} -+ -+static void phytium_mci_set_buswidth(struct phytium_mci_host *host, u32 width) -+{ -+ u32 val; -+ -+ switch (width) { -+ case MMC_BUS_WIDTH_1: -+ val = MCI_BUS_1BITS; -+ break; -+ -+ case MMC_BUS_WIDTH_4: -+ val = MCI_BUS_4BITS; -+ break; -+ -+ case MMC_BUS_WIDTH_8: -+ val = MCI_BUS_8BITS; -+ break; -+ default: -+ val = MCI_BUS_4BITS; -+ break; -+ } -+ writel(val, host->base + MCI_CTYPE); -+ dev_dbg(host->dev, "Bus Width = %d, set value:0x%x\n", width, val); -+} -+ -+static void phytium_mci_ops_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ if (ios->timing == MMC_TIMING_MMC_DDR52 || ios->timing == MMC_TIMING_UHS_DDR50) -+ sdr_set_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_DDR); -+ else -+ sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_DDR); -+ -+ phytium_mci_set_buswidth(host, ios->bus_width); -+ -+ switch (ios->power_mode) { -+ case MMC_POWER_UP: -+ set_bit(MCI_CARD_NEED_INIT, &host->flags); -+ writel(MCI_POWER_ON, host->base + MCI_PWREN); -+ break; -+ -+ case MMC_POWER_ON: -+ break; -+ -+ case MMC_POWER_OFF: -+ writel(MCI_POWER_OFF, host->base + MCI_PWREN); -+ break; -+ -+ default: -+ break; -+ } -+ phytium_mci_set_clk(host, ios); -+} -+ -+static void phytium_mci_ack_sdio_irq(struct mmc_host *mmc) -+{ -+ unsigned long flags; -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ __phytium_mci_enable_sdio_irq(host, 1); -+ spin_unlock_irqrestore(&host->lock, flags); -+} -+ -+static int phytium_mci_get_cd(struct mmc_host *mmc) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ u32 status; -+ -+ if (mmc->caps & MMC_CAP_NONREMOVABLE) -+ return 1; -+ -+ status = readl(host->base + MCI_CARD_DETECT); -+ -+ if ((status & 0x1) == 0x1) -+ return 0; -+ -+ return 1; -+} -+ -+static int phytium_mci_ops_switch_volt(struct mmc_host *mmc, struct mmc_ios *ios) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ unsigned int is_voltage_180 = 0; -+ -+ is_voltage_180 = readl(host->base + MCI_UHS_REG); -+ if ((mmc->caps & MMC_CAP_NONREMOVABLE) && (ios->signal_voltage != MMC_SIGNAL_VOLTAGE_180)) -+ return -EINVAL; -+ -+ if ((ios->signal_voltage == MMC_SIGNAL_VOLTAGE_330) && (is_voltage_180 & 0x1)) -+ sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); -+ else if ((ios->signal_voltage == MMC_SIGNAL_VOLTAGE_180) && (!(is_voltage_180 & 0x1))) -+ sdr_set_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); -+ else if (ios->signal_voltage == MMC_SIGNAL_VOLTAGE_120) -+ return -EINVAL; -+ return 0; -+} -+ -+static void phytium_mci_hw_reset(struct mmc_host *mmc) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ u32 reset_flag; -+ -+ if (host->is_use_dma) { -+ reset_flag = MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET; -+ phytium_mci_adma_reset(host); -+ sdr_set_bits(host->base + MCI_CNTRL, reset_flag); -+ } else { -+ reset_flag = MCI_CNTRL_FIFO_RESET; -+ sdr_set_bits(host->base + MCI_CNTRL, reset_flag); -+ } -+ -+ while (readl(host->base + MCI_CNTRL) & reset_flag) -+ cpu_relax(); -+ -+ sdr_clr_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); -+ udelay(5); -+ sdr_set_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); -+ usleep_range(200, 300); -+} -+ -+#ifdef CONFIG_PM_SLEEP -+int phytium_mci_suspend(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ phytium_mci_deinit_hw(host); -+ return 0; -+} -+EXPORT_SYMBOL(phytium_mci_suspend); -+ -+int phytium_mci_resume(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ phytium_mci_init_hw(host); -+ return 0; -+} -+EXPORT_SYMBOL(phytium_mci_resume); -+ -+#endif -+ -+#ifdef CONFIG_PM -+int phytium_mci_runtime_suspend(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ phytium_mci_deinit_hw(host); -+ return 0; -+} -+EXPORT_SYMBOL(phytium_mci_runtime_suspend); -+ -+int phytium_mci_runtime_resume(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ phytium_mci_init_hw(host); -+ return 0; -+} -+EXPORT_SYMBOL(phytium_mci_runtime_resume); -+ -+#endif -+ -+static struct mmc_host_ops phytium_mci_ops = { -+ .post_req = phytium_mci_post_req, -+ .pre_req = phytium_mci_pre_req, -+ .request = phytium_mci_ops_request, -+ .set_ios = phytium_mci_ops_set_ios, -+ .get_cd = phytium_mci_get_cd, -+ .enable_sdio_irq = phytium_mci_enable_sdio_irq, -+ .ack_sdio_irq = phytium_mci_ack_sdio_irq, -+ .card_busy = phytium_mci_card_busy, -+ .start_signal_voltage_switch = phytium_mci_ops_switch_volt, -+ .hw_reset = phytium_mci_hw_reset, -+}; -+ -+int phytium_mci_common_probe(struct phytium_mci_host *host) -+{ -+ struct mmc_host *mmc = host->mmc; -+ struct device *dev = host->dev; -+ int ret; -+ -+ dma_set_mask(dev, DMA_BIT_MASK(64)); -+ dma_set_coherent_mask(dev, DMA_BIT_MASK(64)); -+ -+ timer_setup(&host->hotplug_timer, hotplug_timer_func, 0); -+ timer_setup(&host->timeout_timer, phytium_mci_request_timeout, 0); -+ -+ mmc->f_min = MCI_F_MIN; -+ if (!mmc->f_max) -+ mmc->f_max = MCI_F_MAX; -+ -+ mmc->ops = &phytium_mci_ops; -+ mmc->ocr_avail_sdio = MMC_VDD_32_33 | MMC_VDD_33_34; -+ mmc->ocr_avail_sd = MMC_VDD_32_33 | MMC_VDD_33_34; -+ mmc->ocr_avail_mmc = MMC_VDD_165_195; -+ mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34 | MMC_VDD_165_195; -+ mmc->caps |= host->caps; -+ -+ if (mmc->caps & MMC_CAP_SDIO_IRQ) { -+ mmc->caps2 |= MMC_CAP2_SDIO_IRQ_NOTHREAD; -+ dev_dbg(host->dev, "%s %d: MMC_CAP_SDIO_IRQ\n", __func__, __LINE__); -+ } -+ mmc->caps2 |= host->caps2; -+ if (host->is_use_dma) { -+ /* MMC core transfer sizes tunable parameters */ -+ mmc->max_segs = MAX_BD_NUM; -+ mmc->max_seg_size = 4 * 1024; -+ mmc->max_blk_size = 512; -+ mmc->max_req_size = 512 * 1024; -+ mmc->max_blk_count = mmc->max_req_size / 512; -+ host->dma.adma_table = dma_alloc_coherent(host->dev, -+ MAX_BD_NUM * -+ sizeof(struct phytium_adma2_64_desc), -+ &host->dma.adma_addr, GFP_KERNEL); -+ if (!host->dma.adma_table) -+ return MCI_REALEASE_MEM; -+ -+ host->dma.desc_sz = ADMA2_64_DESC_SZ; -+ phytium_mci_init_adma_table(host, &host->dma); -+ } else { -+ mmc->max_segs = MAX_BD_NUM; -+ mmc->max_seg_size = 4 * 1024; -+ mmc->max_blk_size = 512; -+ mmc->max_req_size = 4 * 512; -+ mmc->max_blk_count = mmc->max_req_size / 512; -+ } -+ -+ spin_lock_init(&host->lock); -+ -+ phytium_mci_init_hw(host); -+ ret = devm_request_irq(host->dev, host->irq, phytium_mci_irq, -+ host->irq_flags, "phytium-mci", host); -+ -+ if (ret) -+ return ret; -+ -+ ret = mmc_add_host(mmc); -+ -+ if (ret) { -+ dev_err(host->dev, "%s %d: mmc add host!\n", __func__, __LINE__); -+ return ret; -+ } -+ return 0; -+} -+EXPORT_SYMBOL(phytium_mci_common_probe); -+ -+MODULE_DESCRIPTION("Phytium Multimedia Card Interface driver"); -+MODULE_LICENSE("GPL v2"); -+MODULE_AUTHOR("Cheng Quan "); -diff --git a/drivers/mmc/host/phytium-mci.h b/drivers/mmc/host/phytium-mci.h -new file mode 100644 -index 000000000..c35e6f3b3 ---- /dev/null -+++ b/drivers/mmc/host/phytium-mci.h -@@ -0,0 +1,357 @@ -+/* SPDX-License-Identifier: GPL-2.0+ */ -+/* -+ * Driver for Phytium Multimedia Card Interface -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_MCI_H -+#define __PHYTIUM_MCI_H -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/*------------------------------------------------------*/ -+/* Common Definition */ -+/*------------------------------------------------------*/ -+#define MAX_BD_NUM 128 -+#define SD_BLOCK_SIZE 512 -+ -+#define MCI_BUS_1BITS 0x0 -+#define MCI_BUS_4BITS 0x1 -+#define MCI_BUS_8BITS (0x1 << 16) -+ -+#define MCI_SD_DRV_VALUE 0 -+#define MCI_SD_SAMP_VALUE_MAX 0 -+#define MCI_SD_SAMP_VALUE_MIN 0 -+ -+#define MCI_TIMEOUT_CMD_VALUE 0xFFFFFFFF -+#define MCI_POWER_ON 1 -+#define MCI_POWER_OFF 0 -+ -+#define MCI_PREPARE_FLAG (0x1 << 0) -+#define MCI_ASYNC_FLAG (0x1 << 1) -+#define MCI_MMAP_FLAG (0x1 << 2) -+ -+#define MCI_CMD_TIMEOUT (HZ/10 * 50) /* 100ms x5 */ -+#define MCI_DATA_TIMEOUT (HZ * 10) /* 1000ms x5 */ -+ -+#define MCI_CMD_TYPE_ADTC 0x2 -+ -+#define MCI_F_MIN 400000 -+#define MCI_F_MAX 50000000 -+ -+#define MCI_CLK 1200000000 -+#define MCI_REALEASE_MEM 0x1 -+#define MCI_MAX_FIFO_CNT 0x800 -+ -+/* FIFOTH register defines */ -+#define MCI_SET_FIFOTH(m, r, t) (((m) & 0x7) << 28 | \ -+ ((r) & 0xFFF) << 16 | ((t) & 0xFFF)) -+/* Card read threshold */ -+#define MCI_SET_THLD(v, x) (((v) & 0xFFF) << 16 | (x)) -+#define MCI_CARD_WR_THR_EN BIT(2) -+#define MCI_CARD_RD_THR_EN BIT(0) -+ -+/*----------------------------------------------------------------------*/ -+/* Register Offset */ -+/*----------------------------------------------------------------------*/ -+#define MCI_CNTRL 0x00 /* the controller config reg */ -+#define MCI_PWREN 0x04 /* the power enable reg */ -+#define MCI_CLKDIV 0x08 /* the clock divider reg */ -+#define MCI_CLKENA 0x10 /* the clock enable reg */ -+#define MCI_TMOUT 0x14 /* the timeout reg */ -+#define MCI_CTYPE 0x18 /* the card type reg */ -+#define MCI_BLKSIZ 0x1C /* the block size reg */ -+#define MCI_BYTCNT 0x20 /* the byte count reg */ -+#define MCI_INT_MASK 0x24 /* the interrupt mask reg */ -+#define MCI_CMDARG 0x28 /* the command argument reg */ -+#define MCI_CMD 0x2C /* the command reg */ -+#define MCI_RESP0 0x30 /* the response reg0 */ -+#define MCI_RESP1 0x34 /* the response reg1 */ -+#define MCI_RESP2 0x38 /* the response reg2 */ -+#define MCI_RESP3 0X3C /* the response reg3 */ -+#define MCI_MASKED_INTS 0x40 /* the masked interrupt status reg */ -+#define MCI_RAW_INTS 0x44 /* the raw interrupt status reg */ -+#define MCI_STATUS 0x48 /* the status reg */ -+#define MCI_FIFOTH 0x4C /* the FIFO threshold watermark reg */ -+#define MCI_CARD_DETECT 0x50 /* the card detect reg */ -+#define MCI_CARD_WRTPRT 0x54 /* the card write protect reg */ -+#define MCI_CCLK_RDY 0x58 /* first div is ready? 1:ready,0:not ready*/ -+#define MCI_TRAN_CARD_CNT 0x5C /* the transferred CIU card byte count reg */ -+#define MCI_TRAN_FIFO_CNT 0x60 /* the transferred host to FIFO byte count reg */ -+#define MCI_DEBNCE 0x64 /* the debounce count reg */ -+#define MCI_UID 0x68 /* the user ID reg */ -+#define MCI_VID 0x6C /* the controller version ID reg */ -+#define MCI_HWCONF 0x70 /* the hardware configuration reg */ -+#define MCI_UHS_REG 0x74 /* the UHS-I reg */ -+#define MCI_CARD_RESET 0x78 /* the card reset reg */ -+#define MCI_BUS_MODE 0x80 /* the bus mode reg */ -+#define MCI_DESC_LIST_ADDRL 0x88 /* the descriptor list low base address reg */ -+#define MCI_DESC_LIST_ADDRH 0x8C /* the descriptor list high base address reg */ -+#define MCI_DMAC_STATUS 0x90 /* the internal DMAC status reg */ -+#define MCI_DMAC_INT_ENA 0x94 /* the internal DMAC interrupt enable reg */ -+#define MCI_CUR_DESC_ADDRL 0x98 /* the current host descriptor low address reg */ -+#define MCI_CUR_DESC_ADDRH 0x9C /* the current host descriptor high address reg */ -+#define MCI_CUR_BUF_ADDRL 0xA0 /* the current buffer low address reg */ -+#define MCI_CUR_BUF_ADDRH 0xA4 /* the current buffer high address reg */ -+#define MCI_CARD_THRCTL 0x100 /* the card threshold control reg */ -+#define MCI_UHS_REG_EXT 0x108 /* the UHS register extension */ -+#define MCI_EMMC_DDR_REG 0x10C /* the EMMC DDR reg */ -+#define MCI_ENABLE_SHIFT 0x110 /* the enable phase shift reg */ -+#define MCI_DATA 0x200 /* the data FIFO access */ -+ -+/* Command register defines */ -+#define MCI_CMD_START BIT(31) -+#define MCI_CMD_USE_HOLD_REG BIT(29) -+#define MCI_CMD_VOLT_SWITCH BIT(28) -+#define MCI_CMD_CCS_EXP BIT(23) -+#define MCI_CMD_CEATA_RD BIT(22) -+#define MCI_CMD_UPD_CLK BIT(21) -+#define MCI_CMD_INIT BIT(15) -+#define MCI_CMD_STOP BIT(14) -+#define MCI_CMD_PRV_DAT_WAIT BIT(13) -+#define MCI_CMD_SEND_STOP BIT(12) -+#define MCI_CMD_STRM_MODE BIT(11) -+#define MCI_CMD_DAT_WR BIT(10) -+#define MCI_CMD_DAT_EXP BIT(9) -+#define MCI_CMD_RESP_CRC BIT(8) -+#define MCI_CMD_RESP_LONG BIT(7) -+#define MCI_CMD_RESP_EXP BIT(6) -+#define MCI_CMD_INDX(n) ((n) & 0x1F) -+ -+/*------------------------------------------------------*/ -+/* Register Mask */ -+/*------------------------------------------------------*/ -+/* MCI_CNTRL mask */ -+#define MCI_CNTRL_CONTROLLER_RESET (0x1 << 0) /* RW */ -+#define MCI_CNTRL_FIFO_RESET (0x1 << 1) /* RW */ -+#define MCI_CNTRL_DMA_RESET (0x1 << 2) /* RW */ -+#define MCI_CNTRL_RES (0x1 << 3) /* */ -+#define MCI_CNTRL_INT_ENABLE (0x1 << 4) /* RW */ -+#define MCI_CNTRL_DMA_ENABLE (0x1 << 5) /* RW */ -+#define MCI_CNTRL_READ_WAIT (0x1 << 6) /* RW */ -+#define MCI_CNTRL_SEND_IRQ_RESPONSE (0x1 << 7) /* RW */ -+#define MCI_CNTRL_ABORT_READ_DATA (0x1 << 8) /* RW */ -+#define MCI_CNTRL_ENDIAN (0x1 << 11) /* RW */ -+//#define MCI_CNTRL_CARD_VOLTAGE_A (0xF << 16) /* RW */ -+//#define MCI_CNTRL_CARD_VOLTAGE_B (0xF << 20) /* RW */ -+#define MCI_CNTRL_ENABLE_OD_PULLUP (0x1 << 24) /* RW */ -+#define MCI_CNTRL_USE_INTERNAL_DMAC (0x1 << 25) /* RW */ -+ -+/* MCI_PWREN mask */ -+#define MCI_PWREN_ENABLE (0x1 << 0) /* RW */ -+ -+/* MCI_CLKENA mask */ -+#define MCI_CLKENA_CCLK_ENABLE (0x1 << 0) /* RW */ -+#define MCI_CLKENA_CCLK_LOW_POWER (0x1 << 16) /* RW */ -+#define MCI_EXT_CLK_ENABLE (0x1 << 1) -+ -+/* MCI_INT_MASK mask */ -+#define MCI_INT_MASK_CD (0x1 << 0) /* RW */ -+#define MCI_INT_MASK_RE (0x1 << 1) /* RW */ -+#define MCI_INT_MASK_CMD (0x1 << 2) /* RW */ -+#define MCI_INT_MASK_DTO (0x1 << 3) /* RW */ -+#define MCI_INT_MASK_TXDR (0x1 << 4) /* RW */ -+#define MCI_INT_MASK_RXDR (0x1 << 5) /* RW */ -+#define MCI_INT_MASK_RCRC (0x1 << 6) /* RW */ -+#define MCI_INT_MASK_DCRC (0x1 << 7) /* RW */ -+#define MCI_INT_MASK_RTO (0x1 << 8) /* RW */ -+#define MCI_INT_MASK_DRTO (0x1 << 9) /* RW */ -+#define MCI_INT_MASK_HTO (0x1 << 10) /* RW */ -+#define MCI_INT_MASK_FRUN (0x1 << 11) /* RW */ -+#define MCI_INT_MASK_HLE (0x1 << 12) /* RW */ -+#define MCI_INT_MASK_SBE_BCI (0x1 << 13) /* RW */ -+#define MCI_INT_MASK_ACD (0x1 << 14) /* RW */ -+#define MCI_INT_MASK_EBE (0x1 << 15) /* RW */ -+#define MCI_INT_MASK_SDIO (0x1 << 16) /* RW */ -+ -+/* MCI_MASKED_INTS mask */ -+#define MCI_MASKED_INTS_CD (0x1 << 0) /* RO */ -+#define MCI_MASKED_INTS_RE (0x1 << 1) /* RO */ -+#define MCI_MASKED_INTS_CMD (0x1 << 2) /* RO */ -+#define MCI_MASKED_INTS_DTO (0x1 << 3) /* RO */ -+#define MCI_MASKED_INTS_TXDR (0x1 << 4) /* RO */ -+#define MCI_MASKED_INTS_RXDR (0x1 << 5) /* RO */ -+#define MCI_MASKED_INTS_RCRC (0x1 << 6) /* RO */ -+#define MCI_MASKED_INTS_DCRC (0x1 << 7) /* RO */ -+#define MCI_MASKED_INTS_RTO (0x1 << 8) /* RO */ -+#define MCI_MASKED_INTS_DRTO (0x1 << 9) /* RO */ -+#define MCI_MASKED_INTS_HTO (0x1 << 10) /* RO */ -+#define MCI_MASKED_INTS_FRUN (0x1 << 11) /* RO */ -+#define MCI_MASKED_INTS_HLE (0x1 << 12) /* RO */ -+#define MCI_MASKED_INTS_SBE_BCI (0x1 << 13) /* RO */ -+#define MCI_MASKED_INTS_ACD (0x1 << 14) /* RO */ -+#define MCI_MASKED_INTS_EBE (0x1 << 15) /* RO */ -+#define MCI_MASKED_INTS_SDIO (0x1 << 16) /* RO */ -+ -+/* MCI_RAW_INTS mask */ -+#define MCI_RAW_INTS_CD (0x1 << 0) /* W1C */ -+#define MCI_RAW_INTS_RE (0x1 << 1) /* W1C */ -+#define MCI_RAW_INTS_CMD (0x1 << 2) /* W1C */ -+#define MCI_RAW_INTS_DTO (0x1 << 3) /* W1C */ -+#define MCI_RAW_INTS_TXDR (0x1 << 4) /* W1C */ -+#define MCI_RAW_INTS_RXDR (0x1 << 5) /* W1C */ -+#define MCI_RAW_INTS_RCRC (0x1 << 6) /* W1C */ -+#define MCI_RAW_INTS_DCRC (0x1 << 7) /* W1C */ -+#define MCI_RAW_INTS_RTO (0x1 << 8) /* W1C */ -+#define MCI_RAW_INTS_DRTO (0x1 << 9) /* W1C */ -+#define MCI_RAW_INTS_HTO (0x1 << 10) /* W1C */ -+#define MCI_RAW_INTS_FRUN (0x1 << 11) /* W1C */ -+#define MCI_RAW_INTS_HLE (0x1 << 12) /* W1C */ -+#define MCI_RAW_INTS_SBE_BCI (0x1 << 13) /* W1C */ -+#define MCI_RAW_INTS_ACD (0x1 << 14) /* W1C */ -+#define MCI_RAW_INTS_EBE (0x1 << 15) /* W1C */ -+#define MCI_RAW_INTS_SDIO (0x1 << 16) /* W1C */ -+ -+/* MCI_STATUS mask */ -+#define MCI_STATUS_FIFO_RX (0x1 << 0) /* RO */ -+#define MCI_STATUS_FIFO_TX (0x1 << 1) /* RO */ -+#define MCI_STATUS_FIFO_EMPTY (0x1 << 2) /* RO */ -+#define MCI_STATUS_FIFO_FULL (0x1 << 3) /* RO */ -+#define MCI_STATUS_CARD_STATUS (0x1 << 8) /* RO */ -+#define MCI_STATUS_CARD_BUSY (0x1 << 9) /* RO */ -+#define MCI_STATUS_DATA_BUSY (0x1 << 10) /* RO */ -+#define MCI_STATUS_RESPOSE_INDEX_OFFSET (11) -+#define MCI_STATUS_RESPOSE_INDEX_MASK (0x3f << MCI_STATUS_RESPOSE_INDEX_OFFSET) /* RO */ -+#define MCI_STATUS_RESPOSE_INDEX(reg) (((reg) & MCI_STATUS_RESPOSE_INDEX_MASK) >> MCI_STATUS_RESPOSE_INDEX_OFFSET) -+#define MCI_STATUS_DMA_ACK (0x1 << 31) /* RO */ -+#define MCI_STATUS_DMA_REQ (0x1 << 32) /* RO */ -+ -+/* MCI_UHS_REG mask */ -+#define MCI_UHS_REG_VOLT (0x1 << 0) /* RW */ -+#define MCI_UHS_REG_DDR (0x1 << 16) /* RW */ -+ -+/* MCI_CARD_RESET mask */ -+#define MCI_CARD_RESET_ENABLE (0x1 << 0) /* RW */ -+ -+/* MCI_BUS_MODE mask */ -+#define MCI_BUS_MODE_SWR (0x1 << 0) /* RW */ -+#define MCI_BUS_MODE_FB (0x1 << 1) /* RW */ -+#define MCI_BUS_MODE_DE (0x1 << 7) /* RW */ -+ -+/* MCI_DMAC_STATUS mask */ -+#define MCI_DMAC_STATUS_TI (0x1 << 0) /* RW */ -+#define MCI_DMAC_STATUS_RI (0x1 << 1) /* RW */ -+#define MCI_DMAC_STATUS_FBE (0x1 << 2) /* RW */ -+#define MCI_DMAC_STATUS_DU (0x1 << 4) /* RW */ -+#define MCI_DMAC_STATUS_NIS (0x1 << 8) /* RW */ -+#define MCI_DMAC_STATUS_AIS (0x1 << 9) /* RW */ -+ -+/* MCI_DMAC_INT_ENA mask */ -+#define MCI_DMAC_INT_ENA_TI (0x1 << 0) /* RW */ -+#define MCI_DMAC_INT_ENA_RI (0x1 << 1) /* RW */ -+#define MCI_DMAC_INT_ENA_FBE (0x1 << 2) /* RW */ -+#define MCI_DMAC_INT_ENA_DU (0x1 << 4) /* RW */ -+#define MCI_DMAC_INT_ENA_CES (0x1 << 5) /* RW */ -+#define MCI_DMAC_INT_ENA_NIS (0x1 << 8) /* RW */ -+#define MCI_DMAC_INT_ENA_AIS (0x1 << 9) /* RW */ -+ -+/* MCI_CARD_THRCTL mask */ -+#define MCI_CARD_THRCTL_CARDRD (0x1 << 0) /* RW */ -+#define MCI_CARD_THRCTL_BUSY_CLR (0x1 << 1) /* RW */ -+#define MCI_CARD_THRCTL_CARDWR (0x1 << 2) /* RW */ -+ -+/* MCI_UHS_REG_EXT mask */ -+#define MCI_UHS_REG_EXT_MMC_VOLT (0x1 << 0) /* RW */ -+#define MCI_UHS_REG_EXT_CLK_ENA (0x1 << 1) /* RW */ -+ -+/* MCI_EMMC_DDR_REG mask */ -+#define MCI_EMMC_DDR_CYCLE (0x1 << 0) /* RW */ -+ -+/*--------------------------------------*/ -+/* Structure Type */ -+/*--------------------------------------*/ -+/* Maximum segments assuming a 512KiB maximum requisition */ -+/* size and a minimum4KiB page size. */ -+#define MCI_MAX_SEGS 128 -+/* ADMA2 64-bit DMA descriptor size */ -+#define ADMA2_64_DESC_SZ 32 -+ -+/* mmc request timeout 5000ms */ -+#define MMC_REQ_TIMEOUT_MS 5000 -+ -+/* Each descriptor can transfer up to 4KB of data in chained mode */ -+/*ADMA2 64-bit descriptor.*/ -+struct phytium_adma2_64_desc { -+ u32 attribute; -+#define IDMAC_DES0_DIC BIT(1) -+#define IDMAC_DES0_LD BIT(2) -+#define IDMAC_DES0_FD BIT(3) -+#define IDMAC_DES0_CH BIT(4) -+#define IDMAC_DES0_ER BIT(5) -+#define IDMAC_DES0_CES BIT(30) -+#define IDMAC_DES0_OWN BIT(31) -+ u32 NON1; -+ u32 len; -+ u32 NON2; -+ u32 addr_lo; /* Lower 32-bits of Buffer Address Pointer 1*/ -+ u32 addr_hi; /* Upper 32-bits of Buffer Address Pointer 1*/ -+ u32 desc_lo; /* Lower 32-bits of Next Descriptor Address */ -+ u32 desc_hi; /* Upper 32-bits of Next Descriptor Address */ -+} __packed __aligned(4); -+ -+struct phytium_mci_dma { -+ struct scatterlist *sg; /* I/O scatter list */ -+ /* ADMA descriptor table, pointer to adma_table array */ -+ struct phytium_adma2_64_desc *adma_table; -+ /* Mapped ADMA descr. table, the physical address of adma_table array */ -+ dma_addr_t adma_addr; -+ unsigned int desc_sz; /* ADMA descriptor size */ -+}; -+ -+enum adtc_t { -+ COMMOM_ADTC = 0, -+ BLOCK_RW_ADTC = 1 -+}; -+ -+struct phytium_mci_host { -+ struct device *dev; -+ struct mmc_host *mmc; -+ u32 caps; -+ u32 caps2; -+ spinlock_t lock; -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ int error; -+ void __iomem *base; /* host base address */ -+ void *adma_table1; -+ dma_addr_t adma_addr1; -+ struct phytium_mci_dma dma_rx; /* dma channel */ -+ struct phytium_mci_dma dma_tx; /* dma channel */ -+ struct phytium_mci_dma dma; /* dma channel */ -+ u64 dma_mask; -+ bool vqmmc_enabled; -+ u32 *sg_virt_addr; -+ enum adtc_t adtc_type; /* 0:common adtc cmd; 1:block r/w adtc cmd;*/ -+ struct timer_list hotplug_timer; -+ struct timer_list timeout_timer; -+ struct delayed_work req_timeout; -+ int irq; /* host interrupt */ -+ u32 current_rca; /*the current rca value*/ -+ u32 current_ios_clk; -+ u32 is_use_dma; -+ u32 is_device_x100; -+ struct clk *src_clk; /* phytium_mci source clock */ -+ unsigned long clk_rate; -+ unsigned long clk_div; -+ unsigned long irq_flags; -+ unsigned long flags; -+#define MCI_CARD_NEED_INIT 1 -+ -+}; -+ -+int phytium_mci_common_probe(struct phytium_mci_host *host); -+void phytium_mci_deinit_hw(struct phytium_mci_host *host); -+int phytium_mci_runtime_suspend(struct device *dev); -+int phytium_mci_runtime_resume(struct device *dev); -+int phytium_mci_resume(struct device *dev); -+int phytium_mci_suspend(struct device *dev); -+ -+#endif /* __PHYTIUM_MCI_HW_H */ -diff --git a/drivers/mmc/host/phytium-sdci.c b/drivers/mmc/host/phytium-sdci.c -new file mode 100755 -index 000000000..c4248f88b ---- /dev/null -+++ b/drivers/mmc/host/phytium-sdci.c -@@ -0,0 +1,1433 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SD Card Interface dirver -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co.,Ltd. -+ */ -+ -+#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 "phytium-sdci.h" -+ -+static const u32 cmd_ints_mask = SDCI_SDCI_NORMAL_ISER_ECC_EN | SDCI_SDCI_NORMAL_ISER_EEI_EN; -+static const u32 data_ints_mask = SDCI_BD_ISER_ETRS_EN; -+static const u32 err_ints_mask = SDCI_ERROR_ISER_ECTE_EN | SDCI_ERROR_ISR_CCRCE_EN | -+ SDCI_ERROR_ISR_CIR_EN | SDCI_ERROR_ISR_CNR_EN; -+ -+static void hotplug_timer_func(struct timer_list *t); -+static bool phytium_sdci_private_send_cmd(struct phytium_sdci_host *host, -+ u32 cmd, u32 resp_type, u32 arg); -+static bool phytium_sdci_cmd_done(struct phytium_sdci_host *host, int events, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd); -+static bool phytium_sdci_data_xfer_done(struct phytium_sdci_host *host, -+ u32 events, struct mmc_request *mrq, -+ struct mmc_data *data); -+static void phytium_sdci_cmd_next(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd); -+ -+static int phytium_sdci_cmd13_process(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_data *data, -+ u32 wait_timeout_ms, -+ u32 send_once_time_ms); -+ -+static int phytium_sd_error(struct phytium_sdci_host *host) -+{ -+ int temp; -+ -+ temp = readl(host->base + SDCI_NORMAL_ISR); -+ dev_err(host->dev, "[%s %d]SDCI_NORMAL_ISR:%x\n", __func__, __LINE__, temp); -+ temp = readl(host->base + SDCI_BD_ISR); -+ temp = readl(host->base + SDCI_ERROR_ISR); -+ dev_err(host->dev, "[%s %d]SDCI_ERROR_ISR:%x\n", __func__, __LINE__, temp); -+ temp = readl(host->base + SDCI_BD_ISR); -+ dev_err(host->dev, "[%s %d]SDCI_BD_ISR:%x\n", __func__, __LINE__, temp); -+ temp = readl(host->base + SDCI_RESP0); -+ dev_err(host->dev, "[%s %d]SDCI_RESP0:%x\n", __func__, __LINE__, temp); -+ -+ return 0; -+} -+ -+static void sdr_set_bits(void __iomem *reg, u32 bs) -+{ -+ u32 val; -+ -+ val = readl(reg); -+ val |= bs; -+ -+ writel(val, reg); -+} -+ -+static void sdr_clr_bits(void __iomem *reg, u32 bs) -+{ -+ u32 val; -+ -+ val = readl(reg); -+ val &= ~bs; -+ -+ writel(val, reg); -+} -+ -+static void phytium_sdci_reset_hw(struct phytium_sdci_host *host) -+{ -+ sdr_set_bits(host->base + SDCI_SOFTWARE, -+ SDCI_SOFTWARE_SRST); -+ sdr_clr_bits(host->base + SDCI_SOFTWARE, -+ SDCI_SOFTWARE_SRST); -+ while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) -+ cpu_relax(); -+} -+ -+static void phytium_sdci_prepare_data(struct phytium_sdci_host *host, -+ struct mmc_request *mrq) -+{ -+ struct mmc_data *data = mrq->data; -+ bool read; -+ -+ read = (data->flags & MMC_DATA_READ) != 0; -+ data->sg_count = dma_map_sg(host->dev, data->sg, data->sg_len, -+ read ? DMA_FROM_DEVICE : DMA_TO_DEVICE); -+} -+ -+static void phytium_sdci_unprepare_data(struct phytium_sdci_host *host, -+ struct mmc_request *mrq) -+{ -+ bool read; -+ struct mmc_data *data = mrq->data; -+ -+ read = (data->flags & MMC_DATA_READ) != 0; -+ dma_unmap_sg(host->dev, data->sg, data->sg_len, -+ read ? DMA_FROM_DEVICE : DMA_TO_DEVICE); -+} -+ -+static void phytium_sdci_set_clk(struct phytium_sdci_host *host, -+ struct mmc_ios *ios) -+{ -+ unsigned long clk_rate; -+ u32 div = 0xffffffff, div_reg; -+ -+ if (ios->clock) { -+ clk_rate = host->clk_rate; -+ div = ((clk_rate / (2 * ios->clock)) - 1); -+ div_reg = readl(host->base + SDCI_CLOCK_D); -+ if (div_reg == div) -+ return; -+ writel(div, host->base + SDCI_CLOCK_D); -+ writel(0, host->base + SDCI_SD_DRV); -+ writel(5, host->base + SDCI_SD_SAMP); -+ -+ sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); -+ sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); -+ while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) -+ cpu_relax(); -+ dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", -+ host->clk_rate, ios->clock); -+ } -+} -+ -+ -+static inline u32 phytium_sdci_cmd_find_resp(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ u32 resp; -+ -+ switch (mmc_resp_type(cmd)) { -+ case MMC_RSP_R1: -+ resp = 0x2; -+ break; -+ case MMC_RSP_R1B: -+ resp = 0x2; -+ break; -+ case MMC_RSP_R2: -+ resp = 0x1; -+ break; -+ case MMC_RSP_R3: -+ resp = 0x3; -+ break; -+ case MMC_RSP_NONE: -+ default: -+ resp = 0x0; -+ break; -+ } -+ -+ return resp; -+} -+ -+static inline u32 phytium_sdci_cmd_prepare_raw_cmd(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, struct mmc_command *cmd) -+{ -+ /* -+ * rawcmd : -+ * trty << 14 | opcode << 8 | cmdw << 6 | cice << 4 | crce << 3 | resp -+ */ -+ u32 resp, rawcmd; -+ u32 opcode = cmd->opcode; -+ -+ resp = phytium_sdci_cmd_find_resp(host, mrq, cmd); -+ rawcmd = ((opcode << 8) | resp); -+ -+ if ((cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC) -+ rawcmd = (rawcmd | (SDCI_CMD_TYPE_ADTC << 14)); -+ -+ return rawcmd; -+} -+ -+static void -+phytium_sdci_unexpected_error_handler(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_data *data, -+ int err_type) -+{ -+ unsigned long flags; -+ int error; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ host->mrq = NULL; -+ host->cmd = NULL; -+ host->data = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (err_type & ERR_CARD_ABSENT) { -+ host->mmc->detect_change = 1; -+ dev_dbg(host->dev, "SD is absent when send cmd:%d\n", mrq->cmd->opcode); -+ } -+ -+ switch (err_type) { -+ case ERR_CARD_ABSENT: -+ error = -ENOMEDIUM; -+ break; -+ case ERR_TIMEOUT: -+ error = -ETIMEDOUT; -+ break; -+ case ERR_CMD_RESPONED: -+ error = -EIO; -+ break; -+ default: -+ error = -ETIMEDOUT; -+ break; -+ } -+ -+ if (data) { -+ data->error = error; -+ phytium_sdci_unprepare_data(host, mrq); -+ -+ if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || -+ (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) -+ phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_R, mrq, data); -+ } else { -+ mrq->cmd->error = error; -+ } -+ -+ mmc_request_done(host->mmc, mrq); -+} -+ -+static bool phytium_sdci_start_data(struct phytium_sdci_host *host, struct mmc_request *mrq, -+ struct mmc_command *cmd, struct mmc_data *data) -+{ -+ bool read, res; -+ u32 sg_dma_addrh, sg_dma_addrl; -+ u32 sd_block_addrh, sd_block_addrl; -+ u32 temp, timeout, sd_status; -+ u32 block_cnt = 0; -+ u32 sd_block_addr = cmd->arg; -+ u32 private_cmd, resp_type, arg; -+ u32 j, dma_len; -+ unsigned long deadline_time; -+ dma_addr_t dma_address; -+ struct scatterlist *sg; -+ int ret; -+ -+ WARN_ON(host->cmd); -+ host->cmd = cmd; -+ -+ WARN_ON(host->data); -+ host->data = data; -+ read = data->flags & MMC_DATA_READ; -+ -+ for_each_sg(data->sg, sg, data->sg_count, j) { -+ writel(0, host->base + SDCI_COMMAND); -+ -+ dma_address = sg_dma_address(sg); -+ sg_dma_addrh = (u32) (dma_address >> 32); -+ sg_dma_addrl = (u32) dma_address; -+ -+ dma_len = sg_dma_len(sg); -+ block_cnt = (dma_len / SD_BLOCK_SIZE); -+ -+ sd_block_addrh = 0; -+ sd_block_addrl = sd_block_addr; -+ -+ sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_BDRST); -+ sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_BDRST); -+ writel(block_cnt, host->base + SDCI_BLK_CNT); -+ -+ if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { -+ writel(sg_dma_addrl, host->base + SDCI_BD_RX); -+ writel(sg_dma_addrh, host->base + SDCI_BD_RX); -+ writel(sd_block_addrl, host->base + SDCI_BD_RX); -+ writel(sd_block_addrh, host->base + SDCI_BD_RX); -+ timeout = 100 * block_cnt; -+ } else { -+ timeout = 250 * block_cnt; -+ ret = phytium_sdci_cmd13_process(host, mrq, data, timeout, 1); -+ if (ret != SDCI_CMD13_OK) -+ return false; -+ -+ writel(sg_dma_addrl, host->base + SDCI_BD_TX); -+ writel(sg_dma_addrh, host->base + SDCI_BD_TX); -+ writel(sd_block_addrl, host->base + SDCI_BD_TX); -+ writel(sd_block_addrh, host->base + SDCI_BD_TX); -+ } -+ -+ deadline_time = jiffies + msecs_to_jiffies(timeout); -+ -+ temp = readl(host->base + SDCI_BD_ISR); -+ if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { -+ while ((temp & SDCI_BD_ISR_TRS_R) != SDCI_BD_ISR_TRS_R) { -+ sd_status = readl(host->base + SDCI_STATUS); -+ if (sd_status & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CARD_ABSENT); -+ if (temp & SDCI_BD_ISR_DAIS) -+ writel(1, host->base + SDCI_BD_ISR); -+ return false; -+ } -+ -+ temp = readl(host->base + SDCI_BD_ISR); -+ if (time_after(jiffies, deadline_time)) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_TIMEOUT); -+ dev_err(host->dev, -+ "Read Data timeout:jiffies:0x%lx,dt_jiffies: 0x%lx, BD_isr_reg:0x%x,cmd:%d, REG_D0:0x%x\n", -+ jiffies, jiffies - deadline_time, temp, -+ cmd->opcode, readl(host->base + SDCI_STATUS)); -+ -+ return false; -+ } -+ } -+ } else { -+ while ((temp & SDCI_BD_ISR_TRS_W) != SDCI_BD_ISR_TRS_W) { -+ sd_status = readl(host->base + SDCI_STATUS); -+ if (sd_status & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CARD_ABSENT); -+ dev_err(host->dev, "[%s][%d]: Card absent ! cmd(%d)\n", -+ __func__, __LINE__, mrq->cmd->opcode); -+ return false; -+ } -+ -+ temp = readl(host->base + SDCI_BD_ISR); -+ if (time_after(jiffies, deadline_time)) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_TIMEOUT); -+ dev_err(host->dev, -+ "Write Date timeout: jiffies:0x%lx,dt_jiffies: 0x%lx,BD_isr_reg:0x%x\n", -+ jiffies, jiffies - deadline_time, temp); -+ return false; -+ } -+ } -+ } -+ writel(1, host->base + SDCI_BD_ISR); -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ sd_block_addr = sd_block_addr + block_cnt; -+ -+ if (j < (data->sg_count - 1) && 1 < block_cnt) { -+ private_cmd = MMC_STOP_TRANSMISSION; -+ resp_type = 0x2; -+ arg = 0; -+ res = phytium_sdci_private_send_cmd(host, private_cmd, -+ resp_type, arg); -+ if (!res) { -+ sd_status = readl(host->base + SDCI_STATUS); -+ if (sd_status & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CARD_ABSENT); -+ writel(1, host->base + SDCI_BD_ISR); -+ dev_err(host->dev, -+ "[%s][%d]:Card absent ! private_cmd(%d)\n", -+ __func__, __LINE__, private_cmd); -+ } else { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CMD_RESPONED); -+ dev_err(host->dev, -+ "[%s][%d] cmd(%d) response errored\n", -+ __func__, __LINE__, mrq->cmd->opcode); -+ phytium_sd_error(host); -+ } -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ return false; -+ } -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ } -+ } -+ -+ host->is_multi_rw_only_one_blkcnt = false; -+ -+ if ((cmd->opcode == MMC_READ_MULTIPLE_BLOCK && block_cnt == 1) || -+ (cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK && block_cnt == 1)) -+ host->is_multi_rw_only_one_blkcnt = true; -+ -+ phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_CC, mrq, cmd); -+ if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) -+ phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_R, -+ mrq, data); -+ else -+ phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_W, -+ mrq, data); -+ -+ return true; -+} -+ -+static int phytium_sdci_auto_cmd_done(struct phytium_sdci_host *host, -+ int events, struct mmc_command *cmd) -+{ -+ u32 *rsp = cmd->resp; -+ -+ rsp[0] = readl(host->base + SDCI_RESP0); -+ -+ if (events & SDCI_NORMAL_ISR_CC) -+ cmd->error = 0; -+ else { -+ phytium_sdci_reset_hw(host); -+ dev_err(host->dev, -+ "%s: AUTO_CMD%d arg=%08X; rsp %08X; cmd_error=%d\n", -+ __func__, cmd->opcode, cmd->arg, rsp[0], cmd->error); -+ } -+ -+ return cmd->error; -+} -+ -+static void phytium_sdci_track_cmd_data(struct phytium_sdci_host *host, -+ struct mmc_command *cmd, -+ struct mmc_data *data) -+{ -+ if (host->error) -+ dev_dbg(host->dev, "%s: cmd=%d arg=%08X; host->error=0x%08X\n", -+ __func__, cmd->opcode, cmd->arg, host->error); -+} -+ -+static void phytium_sdci_request_done(struct phytium_sdci_host *host, -+ struct mmc_request *mrq) -+{ -+ unsigned long flags; -+ -+ dev_dbg(host->dev, -+ "%s_%d:mrq->cmd->opcode:%d, mrq->cmd->arg:0x%x resp 0x%x 0x%x 0x%x 0x%x\n", -+ __func__, __LINE__, mrq->cmd->opcode, mrq->cmd->arg, -+ mrq->cmd->resp[0], mrq->cmd->resp[1], mrq->cmd->resp[2], -+ mrq->cmd->resp[3]); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ host->mrq = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ phytium_sdci_track_cmd_data(host, mrq->cmd, mrq->data); -+ if (mrq->data) -+ phytium_sdci_unprepare_data(host, mrq); -+ mmc_request_done(host->mmc, mrq); -+} -+ -+static bool -+phytium_sdci_auto_command_done(struct phytium_sdci_host *host, int events, -+ struct mmc_request *mrq, struct mmc_command *cmd) -+{ -+ u32 *rsp = cmd->resp; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ host->cmd = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ sdr_clr_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); -+ -+ rsp[0] = 0x900; -+ phytium_sdci_request_done(host, mrq); -+ return true; -+} -+ -+/* returns true if command is fully handled; returns false otherwise */ -+static bool phytium_sdci_cmd_done(struct phytium_sdci_host *host, int events, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ bool done = false; -+ bool sbc_error; -+ unsigned long flags; -+ u32 *rsp = cmd->resp; -+ -+ if (mrq->sbc && cmd == mrq->cmd && -+ (events & SDCI_NORMAL_ISR_CC)) -+ phytium_sdci_auto_cmd_done(host, events, mrq->sbc); -+ -+ sbc_error = mrq->sbc && mrq->sbc->error; -+ -+ if (!sbc_error && !(events & (SDCI_NORMAL_ISR_CC | -+ SDCI_NORMAL_ISR_CR | -+ SDCI_NORMAL_ISR_TIMEOUT))) -+ return done; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ done = !host->cmd; -+ host->cmd = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (done) -+ return true; -+ -+ sdr_clr_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); -+ -+ if (cmd->flags & MMC_RSP_PRESENT) { -+ if (cmd->flags & MMC_RSP_136) { -+ rsp[0] = readl(host->base + SDCI_RESP0); -+ rsp[1] = readl(host->base + SDCI_RESP1); -+ rsp[2] = readl(host->base + SDCI_RESP2); -+ rsp[3] = readl(host->base + SDCI_RESP3); -+ } else -+ rsp[0] = readl(host->base + SDCI_RESP0); -+ -+ if (cmd->opcode == SD_SEND_RELATIVE_ADDR) -+ host->current_rca = rsp[0] & 0xFFFF0000; -+ } -+ -+ if (!sbc_error && -+ !(events & SDCI_NORMAL_ISR_CC) && -+ (events & SDCI_NORMAL_ISR_TIMEOUT)) -+ cmd->error = -ETIMEDOUT; -+ -+ if (cmd->error) -+ dev_dbg(host->dev, -+ "%s: cmd=%d arg=%08X; rsp %08X; cmd_error=%d\n", -+ __func__, cmd->opcode, cmd->arg, rsp[0], -+ cmd->error); -+ -+ phytium_sdci_cmd_next(host, mrq, cmd); -+ -+ return true; -+} -+ -+static bool set_databus_width(struct phytium_sdci_host *host) -+{ -+ bool res; -+ u32 cmd, resp_type, arg; -+ -+ cmd = SD_APP_SET_BUS_WIDTH; -+ resp_type = 0x2; -+ arg = 0x2; -+ res = phytium_sdci_private_send_cmd(host, cmd, resp_type, arg); -+ if (!res) -+ return false; -+ -+ cmd = MMC_APP_CMD; -+ resp_type = 0x2; -+ arg = host->current_rca; -+ res = phytium_sdci_private_send_cmd(host, cmd, resp_type, arg); -+ if (!res) -+ return false; -+ -+ return true; -+} -+ -+ -+static void phytium_sdci_start_command(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ u32 rawcmd; -+ struct mmc_data *data = mrq->data; -+ dma_addr_t dma_adtc_buf; -+ u32 dma_bufh, dma_bufl, block_cnt = 0; -+ -+ WARN_ON(host->cmd); -+ host->cmd = cmd; -+ -+ cmd->error = 0; -+ rawcmd = phytium_sdci_cmd_prepare_raw_cmd(host, mrq, cmd); -+ if (cmd->opcode == MMC_STOP_TRANSMISSION || -+ cmd->opcode == MMC_SEND_STATUS) -+ writel(1, host->base + SDCI_ERROR_ISR); -+ sdr_set_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); -+ writel(rawcmd, host->base + SDCI_COMMAND); -+ -+ if ((cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC) { -+ WARN_ON(host->data); -+ host->data = data; -+ -+ dma_adtc_buf = host->dma_rx.bd_addr; -+ dma_bufh = (u32) (dma_adtc_buf >> 32); -+ dma_bufl = (u32) dma_adtc_buf; -+ block_cnt = mrq->data->blocks; -+ sdr_set_bits(host->base + SDCI_BD_ISER, data_ints_mask); -+ writel(block_cnt, host->base + SDCI_BLK_CNT); -+ -+ if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { -+ writel(dma_bufl, host->base + SDCI_BD_RX); -+ writel(dma_bufh, host->base + SDCI_BD_RX); -+ writel(cmd->arg, host->base + SDCI_BD_RX); -+ writel(0, host->base + SDCI_BD_RX); -+ } else { -+ writel(dma_bufl, host->base + SDCI_BD_TX); -+ writel(dma_bufh, host->base + SDCI_BD_TX); -+ writel(cmd->arg, host->base + SDCI_BD_TX); -+ writel(0, host->base + SDCI_BD_TX); -+ } -+ } else { -+ writel(cmd->arg, host->base + SDCI_ARGUMENT); -+ } -+} -+ -+static void phytium_sdci_cmd_next(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ if (cmd->error || (mrq->sbc && mrq->sbc->error)) -+ phytium_sdci_request_done(host, mrq); -+ else if (cmd == mrq->sbc) -+ phytium_sdci_start_command(host, mrq, mrq->cmd); -+ else if (!cmd->data) -+ phytium_sdci_request_done(host, mrq); -+} -+ -+static int phytium_sdci_cmd13_process(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_data *data, -+ u32 wait_timeout_ms, -+ u32 send_once_time_ms) -+{ -+ u32 private_cmd, resp_type, arg, temp, sd_status; -+ unsigned long deadline_time; -+ bool res; -+ -+ deadline_time = jiffies + msecs_to_jiffies(wait_timeout_ms); -+ -+ do { -+ private_cmd = MMC_SEND_STATUS; -+ resp_type = 0x2; -+ arg = host->current_rca; -+ -+ res = phytium_sdci_private_send_cmd(host, private_cmd, resp_type, arg); -+ if (!res) { -+ sd_status = readl(host->base + SDCI_STATUS); -+ if (sd_status & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CARD_ABSENT); -+ dev_err(host->dev, -+ "[%s][%d] Card absent! private_cmd(%d)\n", -+ __func__, __LINE__, private_cmd); -+ } else { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CMD_RESPONED); -+ -+ dev_err(host->dev, -+ "[%s][%d] private_cmd(%d) response errored\n", -+ __func__, __LINE__, private_cmd); -+ phytium_sd_error(host); -+ } -+ writel(1, host->base + SDCI_BD_ISR); -+ return SDCI_CMD13_FAILED; -+ } -+ -+ temp = readl(host->base + SDCI_RESP0); -+ -+ if (time_after(jiffies, deadline_time)) { -+ -+ if (mrq->cmd->opcode == MMC_SEND_STATUS) -+ return SDCI_CMD13_OK; -+ -+ dev_err(host->dev, -+ "SD card is not in transfer mode,timeout:%d,rsp[0]:%x\n", -+ wait_timeout_ms, temp); -+ -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_TIMEOUT); -+ phytium_sd_error(host); -+ return SDCI_CMD13_FAILED; -+ } -+ -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ -+ if (CARD_TRAN_STATE != (temp & CARD_CURRENT_STATE) && send_once_time_ms) -+ mdelay(send_once_time_ms); -+ -+ } while (CARD_TRAN_STATE != (temp & CARD_CURRENT_STATE)); -+ -+ return SDCI_CMD13_OK; -+} -+ -+static void phytium_sdci_ops_request(struct mmc_host *mmc, -+ struct mmc_request *mrq) -+{ -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ unsigned long flags; -+ bool res; -+ u32 status_sd; -+ int res_cmd13; -+ -+ host->error = 0; -+ WARN_ON(host->mrq); -+ host->mrq = mrq; -+ -+ dev_dbg(host->dev, "%s: mrq->cmd->opcode: %d, mrq->cmd->arg: 0x%x\n", -+ __func__, mrq->cmd->opcode, mrq->cmd->arg); -+ -+ if (mrq->cmd->opcode == MMC_SEND_STATUS && -+ (mrq->cmd->flags & MMC_CMD_MASK) != MMC_CMD_ADTC) { -+ u32 status = readl(host->base + SDCI_STATUS); -+ -+ if (status & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, NULL, -+ ERR_CARD_ABSENT); -+ return; -+ } -+ -+ res_cmd13 = phytium_sdci_cmd13_process(host, mrq, NULL, 400, 5); -+ if (res_cmd13 == SDCI_CMD13_FAILED) -+ return; -+ } else if (mrq->cmd->opcode == MMC_STOP_TRANSMISSION) { -+ status_sd = readl(host->base + SDCI_STATUS); -+ if (status_sd & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, NULL, -+ ERR_CARD_ABSENT); -+ return; -+ } -+ } -+ -+ if (mrq->data) { -+ phytium_sdci_prepare_data(host, mrq); -+ if (mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK || -+ mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK || -+ mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK || -+ mrq->cmd->opcode == MMC_WRITE_BLOCK) { -+ host->adtc_type = BLOCK_RW_ADTC; -+ phytium_sdci_start_data(host, mrq, -+ mrq->cmd, mrq->data); -+ return; -+ } -+ host->adtc_type = COMMOM_ADTC; -+ } -+ -+ if (mrq->cmd->opcode == SD_IO_RW_DIRECT || -+ mrq->cmd->opcode == SD_IO_SEND_OP_COND) { -+ spin_lock_irqsave(&host->lock, flags); -+ host->mrq = NULL; -+ host->cmd = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ mrq->cmd->error = -EINVAL; -+ mmc_request_done(host->mmc, mrq); -+ -+ return; -+ } -+ -+ if (mrq->cmd->opcode == SD_APP_SEND_SCR) { -+ res = set_databus_width(host); -+ if (!res) { -+ phytium_sdci_unexpected_error_handler(host, mrq, NULL, ERR_CMD_RESPONED); -+ return; -+ } -+ } -+ -+ /* if SBC is required, we have HW option and SW option. -+ * if HW option is enabled, and SBC does not have "special" flags, -+ * use HW option, otherwise use SW option -+ */ -+ if (mrq->sbc && -+ (!mmc_card_mmc(mmc->card) || (mrq->sbc->arg & 0xFFFF0000))) -+ phytium_sdci_start_command(host, mrq, mrq->sbc); -+ else -+ phytium_sdci_start_command(host, mrq, mrq->cmd); -+} -+ -+static void phytium_sdci_data_xfer_next(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_data *data) -+{ -+ if (mmc_op_multi(mrq->cmd->opcode) && -+ mrq->stop && !mrq->stop->error && -+ !mrq->sbc && host->is_multi_rw_only_one_blkcnt) { -+ host->is_multi_rw_only_one_blkcnt = false; -+ phytium_sdci_auto_command_done(host, SDCI_NORMAL_ISR_CC, mrq, mrq->stop); -+ } else if (mmc_op_multi(mrq->cmd->opcode) && -+ mrq->stop && !mrq->stop->error && -+ !mrq->sbc) -+ phytium_sdci_start_command(host, mrq, mrq->stop); -+ else -+ phytium_sdci_request_done(host, mrq); -+} -+ -+static inline void get_data_buffer(struct mmc_data *data, -+ u32 *bytes, u32 **pointer) -+{ -+ struct scatterlist *sg; -+ -+ sg = &data->sg[0]; -+ *bytes = sg->length; -+ *pointer = sg_virt(sg); -+} -+ -+static bool phytium_sdci_data_xfer_done(struct phytium_sdci_host *host, -+ u32 events, struct mmc_request *mrq, -+ struct mmc_data *data) -+{ -+ struct mmc_command *stop = data->stop; -+ unsigned long flags; -+ bool done; -+ unsigned int check_data; -+ u32 sg_length, i; -+ u32 *sg_virt_addr; -+ -+ check_data = events & (SDCI_BD_ISR_TRS_R | SDCI_BD_ISR_TRS_W | SDCI_BD_ISR_EDTE); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ done = !host->data; -+ if (check_data) -+ host->data = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (done) -+ return true; -+ -+ if (check_data || (stop && stop->error)) { -+ sdr_clr_bits(host->base + SDCI_BD_ISER, data_ints_mask); -+ dev_dbg(host->dev, "DMA stop\n"); -+ -+ if (((events & SDCI_BD_ISR_TRS_R) || -+ (events & SDCI_BD_ISR_TRS_W)) && -+ (!stop || !stop->error)) { -+ if ((mrq->cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC && -+ (host->adtc_type == COMMOM_ADTC)) { -+ get_data_buffer(data, &sg_length, -+ &host->sg_virt_addr); -+ sg_virt_addr = host->sg_virt_addr; -+ -+ for (i = 0; i < (sg_length/4); i++) { -+ *sg_virt_addr = host->dma_rx.buf[i]; -+ sg_virt_addr++; -+ } -+ } -+ data->bytes_xfered = data->blocks * data->blksz; -+ } else { -+ dev_dbg(host->dev, "interrupt events: %x\n", events); -+ phytium_sdci_reset_hw(host); -+ data->bytes_xfered = 0; -+ dev_dbg(host->dev, "%s: cmd=%d; blocks=%d", -+ __func__, mrq->cmd->opcode, data->blocks); -+ dev_dbg(host->dev, "data_error=%d xfer_size=%d\n", -+ (int)data->error, data->bytes_xfered); -+ } -+ -+ phytium_sdci_data_xfer_next(host, mrq, data); -+ done = true; -+ } -+ -+ return done; -+} -+ -+ -+static int phytium_sdci_card_busy(struct mmc_host *mmc) -+{ -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ u32 status; -+ -+ /* check if any pin between dat[0:3] is low */ -+ status = readl(host->base + SDCI_STATUS); -+ if (((status >> 20) & 0xf) != 0xf) -+ return 1; -+ -+ return 0; -+} -+ -+static void phytium_sdci_request_timeout(struct work_struct *work) -+{ -+ struct phytium_sdci_host *host; -+ -+ host = container_of(work, struct phytium_sdci_host, req_timeout.work); -+ dev_err(host->dev, "%s: aborting cmd/data/mrq\n", __func__); -+ if (host->mrq) { -+ dev_err(host->dev, "%s: aborting mrq=%p cmd=%d\n", __func__, -+ host->mrq, host->mrq->cmd->opcode); -+ if (host->cmd) { -+ dev_err(host->dev, "%s: aborting cmd=%d\n", -+ __func__, host->cmd->opcode); -+ phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_TIMEOUT, -+ host->mrq, host->cmd); -+ } else if (host->data) { -+ dev_err(host->dev, "%s: abort data: cmd%d; %d blocks\n", -+ __func__, host->mrq->cmd->opcode, -+ host->data->blocks); -+ phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_EDTE, -+ host->mrq, host->data); -+ } -+ } -+} -+ -+static void hotplug_timer_func(struct timer_list *t) -+{ -+ struct phytium_sdci_host *host; -+ u32 status; -+ -+ host = from_timer(host, t, hotplug_timer); -+ if (!host) -+ dev_err(host->dev, "%s: Not find host!\n", __func__); -+ status = readl(host->base + SDCI_STATUS); -+ -+ if (status & SDCI_STATUS_CDSL) { /* card absent */ -+ if (host->mmc->card) { -+ cancel_delayed_work(&host->mmc->detect); -+ mmc_detect_change(host->mmc, -+ msecs_to_jiffies(100)); -+ } -+ } else { /* card insert */ -+ cancel_delayed_work(&host->mmc->detect); -+ mmc_detect_change(host->mmc, msecs_to_jiffies(200)); -+ } -+} -+ -+static irqreturn_t phytium_sdci_irq(int irq, void *dev_id) -+{ -+ struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; -+ unsigned long flags; -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ u32 events; -+ -+ if (!host) -+ return IRQ_NONE; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ events = readl(host->base + SDCI_NORMAL_ISR); -+ /* clear interrupts */ -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ -+ mrq = host->mrq; -+ cmd = host->cmd; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (events & (SDCI_NORMAL_ISR_CR | SDCI_NORMAL_ISR_CI)) { -+ mod_timer(&host->hotplug_timer, -+ jiffies + usecs_to_jiffies(30000)); -+ goto irq_out; -+ } -+ -+ if (!(events & cmd_ints_mask)) -+ goto irq_out; -+ -+ if (!mrq) { -+ dev_err(host->dev, "%s: MRQ=NULL; events=%08X\n", -+ __func__, events); -+ WARN_ON(1); -+ goto irq_out; -+ } -+ -+ dev_dbg(host->dev, "%s: events=%08X\n", __func__, events); -+ -+ if (cmd) -+ phytium_sdci_cmd_done(host, events, mrq, cmd); -+ -+irq_out: -+ return IRQ_HANDLED; -+} -+ -+static irqreturn_t phytium_sdci_dma_irq(int irq, void *dev_id) -+{ -+ struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; -+ unsigned long flags; -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ u32 events; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ events = readl(host->base + SDCI_BD_ISR); -+ writel(1, host->base + SDCI_BD_ISR); -+ -+ mrq = host->mrq; -+ cmd = host->cmd; -+ data = host->data; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (!(events & data_ints_mask)) -+ goto dma_irq_out; -+ -+ if (!mrq) { -+ dev_err(host->dev, -+ "%s: MRQ=NULL; events=%08X\n", -+ __func__, events); -+ goto dma_irq_out; -+ } -+ -+ dev_dbg(host->dev, "%s: events=%08X\n", __func__, events); -+ -+ if (data) -+ phytium_sdci_data_xfer_done(host, events, mrq, data); -+ -+dma_irq_out: -+ return IRQ_HANDLED; -+} -+ -+static irqreturn_t phytium_sdci_err_irq(int irq, void *dev_id) -+{ -+ struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; -+ unsigned long flags; -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ u32 events; -+ -+ if (!host) -+ return IRQ_NONE; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ events = readl(host->base + SDCI_ERROR_ISR); -+ mrq = host->mrq; -+ cmd = host->cmd; -+ data = host->data; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (!(events&err_ints_mask)) -+ goto err_irq_out; -+ -+ if (!mrq) { -+ sdr_clr_bits(host->base + SDCI_NORMAL_ISER, SDCI_NORMAL_ISR_EI); -+ writel(1, host->base + SDCI_ERROR_ISR); -+ dev_err(host->dev, "%s: MRQ=NULL; events=%08X\n", __func__, events); -+ goto err_irq_out; -+ } -+ sdr_clr_bits(host->base + SDCI_NORMAL_ISER, SDCI_NORMAL_ISR_EI); -+ if (data) { -+ dev_err(host->dev, -+ "[%s][%d]: cmd(%d); %d read blocks, status:%x,flag:%x\n", -+ __func__, __LINE__, mrq->cmd->opcode, data->blocks, events, data->flags); -+ data->error = -ETIMEDOUT; -+ if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || -+ (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) -+ phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_EDTE | SDCI_BD_ISR_TRS_R, -+ mrq, data); -+ mrq->cmd->error = -ETIMEDOUT; -+ mmc_request_done(host->mmc, mrq); -+ } else if (cmd) { -+ phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_TIMEOUT, mrq, cmd); -+ } -+ -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ writel(1, host->base + SDCI_ERROR_ISR); -+err_irq_out: -+ return IRQ_HANDLED; -+} -+ -+static void phytium_sdci_init_hw(struct phytium_sdci_host *host) -+{ -+ u32 val; -+ -+ /* Reset */ -+ phytium_sdci_reset_hw(host); -+ -+ val = SDCI_SEN_CREFR_VAL | SDCI_SEN_DEBNCE_VAL; -+ writel(val, host->base + SDCI_SD_SEN); -+ -+ /* Disable and clear all interrupts */ -+ writel(0, host->base + SDCI_NORMAL_ISER); -+ writel(0, host->base + SDCI_ERROR_ISER); -+ writel(0, host->base + SDCI_BD_ISER); -+ -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ writel(1, host->base + SDCI_ERROR_ISR); -+ writel(1, host->base + SDCI_BD_ISR); -+ -+ sdr_set_bits(host->base + SDCI_NORMAL_ISER, -+ SDCI_SDCI_NORMAL_ISER_ECI|SDCI_SDCI_NORMAL_ISER_ECR); -+ /* Configure default cmd timeout to 0.1(s)s = val/25M */ -+ val = SDCI_F_MAX / 10; -+ writel(val, host->base + SDCI_TIMEOUT_CMD); -+ writel(SDCI_TIMEOUT_DATA_VALUE, host->base + SDCI_TIMEOUT_DATA); -+ -+ val = 0x0F00; -+ writel(val, host->base + SDCI_CONTROLLER); -+ -+ dev_dbg(host->dev, "init hardware done!"); -+} -+ -+static void phytium_sdci_deinit_hw(struct phytium_sdci_host *host) -+{ -+ /* Disable and clear all interrupts */ -+ writel(0, host->base + SDCI_NORMAL_ISER); -+ writel(0, host->base + SDCI_ERROR_ISER); -+ writel(0, host->base + SDCI_BD_ISER); -+ -+ writel(0, host->base + SDCI_NORMAL_ISR); -+ writel(0, host->base + SDCI_ERROR_ISR); -+ writel(0, host->base + SDCI_BD_ISR); -+} -+ -+static void phytium_sdci_ops_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) -+{ -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ if (ios->bus_width == MMC_BUS_WIDTH_4) -+ mmc->caps = mmc->caps & (~MMC_CAP_4_BIT_DATA); -+ -+ /* Suspend/Resume will do power off/on */ -+ switch (ios->power_mode) { -+ case MMC_POWER_UP: -+ writel(SDCI_POWER_ON, host->base + SDCI_POWER); -+ break; -+ case MMC_POWER_ON: -+ phytium_sdci_set_clk(host, ios); -+ break; -+ case MMC_POWER_OFF: -+ writel(SDCI_POWER_OFF, host->base + SDCI_POWER); -+ break; -+ default: -+ break; -+ } -+} -+ -+static int phytium_sdci_get_cd(struct mmc_host *mmc) -+{ -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ u32 status = readl(host->base + SDCI_STATUS); -+ -+ if (((status >> 19) & 0x1) == 0x1) -+ return 0; -+ -+ return 1; -+} -+ -+static void phytium_sdci_hw_reset(struct mmc_host *mmc) -+{ -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); -+ sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); -+ while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) -+ cpu_relax(); -+} -+ -+static struct mmc_host_ops phytium_sdci_ops = { -+ .request = phytium_sdci_ops_request, -+ .set_ios = phytium_sdci_ops_set_ios, -+ .get_cd = phytium_sdci_get_cd, -+ .card_busy = phytium_sdci_card_busy, -+ .hw_reset = phytium_sdci_hw_reset, -+}; -+ -+static bool phytium_sdci_private_send_cmd(struct phytium_sdci_host *host, -+ u32 cmd, u32 resp_type, u32 arg) -+{ -+ u32 temp, sd_cmd, sd_arg, sd_status; -+ unsigned long deadline_time; -+ -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ writel(1, host->base + SDCI_ERROR_ISR); -+ -+ sd_cmd = (cmd << 8) | resp_type; -+ sd_arg = arg; -+ writel(sd_cmd, host->base + SDCI_COMMAND); -+ writel(sd_arg, host->base + SDCI_ARGUMENT); -+ -+ if (cmd == MMC_STOP_TRANSMISSION) -+ deadline_time = jiffies + msecs_to_jiffies(1000); -+ else -+ deadline_time = jiffies + msecs_to_jiffies(100); -+ -+ temp = readl(host->base + SDCI_NORMAL_ISR); -+ while ((temp & SDCI_NORMAL_ISR_CC) != SDCI_NORMAL_ISR_CC) { -+ sd_status = readl(host->base + SDCI_STATUS); -+ if (sd_status & SDCI_STATUS_CDSL) -+ return false; -+ -+ temp = readl(host->base + SDCI_NORMAL_ISR); -+ if (time_after(jiffies, deadline_time)) -+ return false; -+ -+ if (cmd == MMC_STOP_TRANSMISSION) -+ mdelay(1); -+ } -+ -+ return true; -+} -+ -+static int phytium_sdci_probe(struct platform_device *pdev) -+{ -+ struct mmc_host *mmc; -+ struct phytium_sdci_host *host; -+ struct resource *res; -+ int ret; -+ const struct acpi_device_id *match; -+ struct device *dev = &pdev->dev; -+ -+ /* Allocate MMC host for this device */ -+ mmc = mmc_alloc_host(sizeof(struct phytium_sdci_host), &pdev->dev); -+ if (!mmc) -+ return -ENOMEM; -+ -+ host = mmc_priv(mmc); -+ ret = mmc_of_parse(mmc); -+ if (ret) -+ goto host_free; -+ -+ if (dev->of_node) { -+ host->src_clk = devm_clk_get(&pdev->dev, "phytium_sdc_clk"); -+ if (IS_ERR(host->src_clk)) { -+ ret = PTR_ERR(host->src_clk); -+ goto host_free; -+ } -+ -+ host->clk_rate = clk_get_rate(host->src_clk); -+ if (device_property_read_bool(dev, "no-dma-coherent")) -+ dev->dma_coherent = false; -+ } else if (has_acpi_companion(dev)) { -+ match = acpi_match_device(dev->driver->acpi_match_table, dev); -+ if (!match) { -+ dev_err(dev, "Error ACPI match data is missing\n"); -+ return -ENODEV; -+ } -+ -+ acpi_dma_configure(dev, DEV_DMA_NOT_SUPPORTED); -+ -+ host->clk_rate = 600000000; -+ } else { -+ dev_err(&pdev->dev, "No DT found\n"); -+ return -EINVAL; -+ } -+ -+ dma_set_mask(dev, DMA_BIT_MASK(40)); -+ dma_set_coherent_mask(dev, DMA_BIT_MASK(40)); -+ -+ timer_setup(&host->hotplug_timer, hotplug_timer_func, 0); -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ host->base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(host->base)) { -+ ret = PTR_ERR(host->base); -+ goto host_free; -+ } -+ -+ host->irq = platform_get_irq(pdev, 1); -+ if (host->irq < 0) { -+ ret = -EINVAL; -+ goto host_free; -+ } -+ -+ host->irq_err = platform_get_irq(pdev, 2); -+ if (host->irq_err < 0) { -+ ret = -EINVAL; -+ goto host_free; -+ } -+ -+ host->irq_bd = platform_get_irq(pdev, 0); -+ if (host->irq_bd < 0) { -+ ret = -EINVAL; -+ goto host_free; -+ } -+ -+ host->dev = &pdev->dev; -+ host->mmc = mmc; -+ -+ if ((4 * SDCI_F_MAX) > host->clk_rate) -+ host->clk_div = 1; -+ else -+ host->clk_div = ((host->clk_rate / (2 * SDCI_F_MAX)) - 1); -+ -+ /* Set host parameters to mmc */ -+ mmc->f_min = SDCI_F_MIN; -+ mmc->f_max = (host->clk_rate / ((host->clk_div + 1) * 2)); -+ mmc->ops = &phytium_sdci_ops; -+ mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; -+ -+ mmc->caps |= host->caps; -+ /* MMC core transfer sizes tunable parameters */ -+ mmc->max_segs = MAX_BD_NUM; -+ mmc->max_seg_size = 512 * 1024; -+ mmc->max_blk_size = 512; -+ mmc->max_req_size = 512 * 1024; -+ mmc->max_blk_count = mmc->max_req_size / 512; -+ -+ host->dma_rx.buf = dma_alloc_coherent(&pdev->dev, -+ MAX_BD_NUM, -+ &host->dma_rx.bd_addr, -+ GFP_KERNEL); -+ if (!host->dma_rx.buf) { -+ ret = -ENOMEM; -+ goto release_mem; -+ } -+ -+ host->cmd_timeout = msecs_to_jiffies(100); -+ host->data_timeout = msecs_to_jiffies(250); -+ -+ INIT_DELAYED_WORK(&host->req_timeout, phytium_sdci_request_timeout); -+ spin_lock_init(&host->lock); -+ -+ platform_set_drvdata(pdev, mmc); -+ phytium_sdci_init_hw(host); -+ -+ ret = devm_request_irq(&pdev->dev, host->irq, phytium_sdci_irq, -+ IRQF_SHARED, pdev->name, host); -+ if (ret) -+ goto release; -+ -+ ret = devm_request_irq(&pdev->dev, host->irq_err, phytium_sdci_err_irq, -+ IRQF_SHARED, pdev->name, host); -+ if (ret) -+ goto release; -+ -+ ret = devm_request_irq(&pdev->dev, host->irq_bd, phytium_sdci_dma_irq, -+ IRQF_SHARED, pdev->name, host); -+ if (ret) -+ goto release; -+ -+ ret = mmc_add_host(mmc); -+ if (ret) -+ goto release; -+ -+ return 0; -+ -+release: -+ platform_set_drvdata(pdev, NULL); -+ phytium_sdci_deinit_hw(host); -+release_mem: -+ if (host->dma_rx.buf) -+ dma_free_coherent(&pdev->dev, MAX_BD_NUM, -+ host->dma_rx.buf, -+ host->dma_rx.bd_addr); -+host_free: -+ mmc_free_host(mmc); -+ -+ return ret; -+} -+ -+static int phytium_sdci_remove(struct platform_device *pdev) -+{ -+ struct mmc_host *mmc; -+ struct phytium_sdci_host *host; -+ -+ mmc = platform_get_drvdata(pdev); -+ host = mmc_priv(mmc); -+ -+ cancel_delayed_work_sync(&host->req_timeout); -+ platform_set_drvdata(pdev, NULL); -+ mmc_remove_host(host->mmc); -+ phytium_sdci_deinit_hw(host); -+ -+ if (host->dma_rx.buf) -+ dma_free_coherent(&pdev->dev, MAX_BD_NUM, -+ host->dma_rx.buf, host->dma_rx.bd_addr); -+ -+ mmc_free_host(host->mmc); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_sdci_suspend(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ phytium_sdci_deinit_hw(host); -+ return 0; -+} -+ -+static int phytium_sdci_resume(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ phytium_sdci_init_hw(host); -+ mmc->caps = mmc->caps | MMC_CAP_4_BIT_DATA; -+ -+ return 0; -+} -+#endif -+ -+#ifdef CONFIG_PM -+static int phytium_sdci_runtime_suspend(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ phytium_sdci_deinit_hw(host); -+ -+ return 0; -+} -+ -+static int phytium_sdci_runtime_resume(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ phytium_sdci_init_hw(host); -+ -+ return 0; -+} -+ -+static const struct dev_pm_ops phytium_sdci_dev_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_sdci_suspend, -+ phytium_sdci_resume) -+ SET_RUNTIME_PM_OPS(phytium_sdci_runtime_suspend, -+ phytium_sdci_runtime_resume, NULL) -+}; -+#else -+#define phytium_sdci_dev_pm_ops NULL -+#endif -+ -+static const struct of_device_id phytium_sdci_of_ids[] = { -+ { .compatible = "phytium,sdci", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_sdci_of_ids); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_sdci_acpi_ids[] = { -+ { .id = "PHYT0005" }, -+ { } -+}; -+ -+MODULE_DEVICE_TABLE(acpi, phytium_sdci_acpi_ids); -+#else -+#define phytium_sdci_acpi_ids NULL -+#endif -+ -+static struct platform_driver phytium_sdci_driver = { -+ .probe = phytium_sdci_probe, -+ .remove = phytium_sdci_remove, -+ .driver = { -+ .name = "sdci-phytium", -+ .of_match_table = phytium_sdci_of_ids, -+ .acpi_match_table = phytium_sdci_acpi_ids, -+ .pm = &phytium_sdci_dev_pm_ops, -+ }, -+}; -+ -+module_platform_driver(phytium_sdci_driver); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium SD Card Interface driver"); -diff --git a/drivers/mmc/host/phytium-sdci.h b/drivers/mmc/host/phytium-sdci.h -new file mode 100755 -index 000000000..01cfd8970 ---- /dev/null -+++ b/drivers/mmc/host/phytium-sdci.h -@@ -0,0 +1,200 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium SD Card Interface driver -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co.,Ltd. -+ */ -+ -+/*---------------------------------------------------------------------------*/ -+/* Common Definition */ -+/*---------------------------------------------------------------------------*/ -+#define MAX_BD_NUM 0x1000 -+#define SD_BLOCK_SIZE 512 -+ -+/*---------------------------------------------------------------------------*/ -+/* Register Offset */ -+/*---------------------------------------------------------------------------*/ -+#define SDCI_CONTROLLER 0x00 /* controller config reg */ -+#define SDCI_ARGUMENT 0x04 /* argument reg */ -+#define SDCI_COMMAND 0x08 /* command reg */ -+#define SDCI_CLOCK_D 0x0C /* clock divide reg */ -+#define SDCI_SOFTWARE 0x10 /* controller reset reg */ -+#define SDCI_POWER 0X14 /* POWRE CONTROL REG */ -+#define SDCI_TIMEOUT_CMD 0x18 /* cmd timeout config reg */ -+#define SDCI_TIMEOUT_DATA 0x1C /* data timeout reg */ -+#define SDCI_NORMAL_ISER 0x20 /* normal ISR config reg */ -+#define SDCI_ERROR_ISER 0x24 /* erroe ISR config reg */ -+#define SDCI_BD_ISER 0x28 /* BD ISR config reg */ -+#define SDCI_CAPA 0x2C /* BD ISR config reg */ -+#define SDCI_SD_DRV 0x30 /* SD card driving phase position reg */ -+#define SDCI_SD_SAMP 0x34 /* SD card sampling phase position reg */ -+#define SDCI_SD_SEN 0x38 /* SD card detection reg */ -+#define SDCI_HDS_AXI 0x3C /* AXI boundary config reg */ -+#define SDCI_BD_RX 0x40 /* BD rx addr reg */ -+#define SDCI_BD_TX 0x60 /* BD tx addr reg */ -+#define SDCI_BLK_CNT 0x80 /* r/w block num reg */ -+#define SDCI_NORMAL_ISR 0xC0 /* normal ISR status reg */ -+#define SDCI_ERROR_ISR 0xC4 /* error ISR status reg */ -+#define SDCI_BD_ISR 0xC8 /* BD ISR status reg */ -+#define SDCI_BD_STATUS 0xCC /* BD descriptor status reg */ -+#define SDCI_STATUS 0xD0 /* status reg */ -+#define SDCI_BLOCK 0xD4 /* block len reg */ -+#define SDCI_RESP0 0xE0 /* response reg0 */ -+#define SDCI_RESP1 0xE4 /* response reg1 */ -+#define SDCI_RESP2 0xE8 /* response reg2 */ -+#define SDCI_RESP3 0XEC /* response reg3 */ -+ -+/*---------------------------------------------------------------------------*/ -+/* Register Mask */ -+/*---------------------------------------------------------------------------*/ -+/* SDCI_CONTROLLER mask */ -+#define SDCI_CONTROLLER_ECRCWR (0x1 << 0) /* RW */ -+#define SDCI_CONTROLLER_ECRCRD (0x1 << 1) /* RW */ -+#define SDCI_CONTROLLER_RESEDE (0x1 << 2) /* RW */ -+#define SDCI_CONTROLLER_PERMDR (0x3 << 8) /* RW */ -+#define SDCI_CONTROLLER_PERMDX (0x3 << 10) /* RW */ -+ -+/* SDCI_SOFTWARE mask */ -+#define SDCI_SOFTWARE_SRST (0x1 << 0) /* RW */ -+#define SDCI_SOFTWARE_SCRST (0x1 << 1) /* RW */ -+#define SDCI_SOFTWARE_BDRST (0x1 << 2) /* RW */ -+#define SDCI_SOFTWARE_CFCLF (0x1 << 3) /* RW */ -+#define SDCI_SOFTWARE_SDRST (0x1 << 4) /* RW */ -+ -+/* SDCI_NORMAL_ISER mask */ -+#define SDCI_SDCI_NORMAL_ISER_ECC_EN (0x1 << 0) /* RW */ -+#define SDCI_SDCI_NORMAL_ISER_ECR (0x1 << 1) /* RW */ -+#define SDCI_SDCI_NORMAL_ISER_ECI (0x1 << 2) /* RW */ -+#define SDCI_SDCI_NORMAL_ISER_EEI_EN (0x1 << 15) /* RW */ -+ -+/* SDCI_NORMAL_ISR mask */ -+#define SDCI_NORMAL_ISR_CC (0x1 << 0) /* R */ -+#define SDCI_NORMAL_ISR_CR (0x1 << 1) /* R */ -+#define SDCI_NORMAL_ISR_CI (0x1 << 2) /* R */ -+#define SDCI_NORMAL_ISR_TIMEOUT (0x1 << 3) /* R */ -+#define SDCI_NORMAL_ISR_EI (0x1 << 15) /* R */ -+ -+/* SDCI_ERROR_ISER mask */ -+#define SDCI_ERROR_ISER_ECTE_EN (0x1 << 0) /* RW */ -+#define SDCI_ERROR_ISR_CCRCE_EN (0x1 << 1) /* RW */ -+#define SDCI_ERROR_ISR_CIR_EN (0x1 << 3) /* RW */ -+#define SDCI_ERROR_ISR_CNR_EN (0x1 << 4) /* RW */ -+/* SDCI_ERROR_ISR mask */ -+#define SDCI_ERROR_ISR_CTE (0x1 << 0) /* R */ -+#define SDCI_ERROR_ISR_CCRCE (0x1 << 1) /* R */ -+#define SDCI_ERROR_ISR_CIR (0x1 << 3) /* R */ -+#define SDCI_ERROR_ISR_CNR (0x1 << 4) /* R */ -+ -+/* SDCI_BD_ISER mask */ -+#define SDCI_BD_ISER_ETRS_EN (0x1 << 8) /* RW */ -+#define SDCI_BD_ISER_DATFRAX_EN (0x1 << 7) /* RW */ -+ -+/* SDCI_BD_ISR mask */ -+#define SDCI_BD_ISR_TRS_W (0x1 << 0) /* R */ -+#define SDCI_BD_ISR_TRS_R (0x1 << 8) /* R */ -+#define SDCI_BD_ISR_EDTE (0x1 << 3) /* R */ -+#define SDCI_BD_ISR_DAIS (0x1 << 15) /* R */ -+#define SDCI_BD_ISR_DATFRAX (0x1 << 7) /* R */ -+ -+/* SDCI_HDS_AXI mask */ -+#define SDCI_HDS_AXI_AWDOMAIN (0x1 << 0) /* RW */ -+#define SDCI_HDS_AXI_ARDOMAIN (0x1 << 12) /* RW */ -+#define SDCI_HDS_AXI_AWCACHE (0x6 << 24) /* RW */ -+#define SDCI_HDS_AXI_ARCACHE (0xB << 28) /* RW */ -+ -+/* SDCI_STATUS mask */ -+#define SDCI_STATUS_CMD_BUSY (0x0 << 0) /* R */ -+#define SDCI_STATUS_CMD_READY (0x1 << 0) /* R */ -+#define SDCI_STATUS_IDIE (0x1 << 12) /* R */ -+#define SDCI_CARD_BUSY_IN_PRG (0x1 << 20) /* R D0 BUSY:0,IDLE:1 */ -+ -+/* SDCI_STATUS */ -+#define SDCI_STATUS_CDSL (0x1 << 19) /* R */ -+ -+/*---------------------------------------------------------------------------*/ -+/* Register Value */ -+/*---------------------------------------------------------------------------*/ -+#define SDCI_SD_DRV_VALUE 0 -+#define SDCI_SD_SAMP_VALUE_MAX 50 -+#define SDCI_SD_SAMP_VALUE_MIN 0 -+ -+#define SDCI_TIMEOUT_CMD_VALUE 0xFFFFFFFF -+#define SDCI_TIMEOUT_DATA_VALUE 0xFFFFFFFF -+#define SDCI_POWER_ON 1 -+#define SDCI_POWER_OFF 0 -+ -+#define SDCI_CMD_TIMEOUT 10 -+#define SDCI_DAT_TIMEOUT 5000 -+ -+#define SDCI_CMD_TYPE_ADTC 0x2 -+ -+#define SDCI_F_MIN 400000 -+#define SDCI_F_MAX 25000000 -+ -+#define SDCI_SEN_CREFR_VAL (0x1 << 1) -+#define SDCI_SEN_DEBNCE_VAL (0xB << 8) -+ -+#define CARD_CURRENT_STATE (0xF << 9) -+#define CARD_PRG_STATE (0x7 << 9) -+#define CARD_TRAN_STATE (0x4 << 9) -+ -+#define SDCI_CMD13_OK 1 -+#define SDCI_CMD13_FAILED 0 -+ -+#define ERR_TIMEOUT (0x1 << 0) -+#define ERR_CARD_ABSENT (0x1 << 1) -+#define ERR_CMD_RESPONED (0x1 << 2) -+ -+/*---------------------------------------------------------------------------*/ -+/* Structure Type */ -+/*---------------------------------------------------------------------------*/ -+struct phytium_sdci_dma { -+ struct scatterlist *sg; -+ u32 *buf; -+ dma_addr_t bd_addr; -+ size_t bytes; -+}; -+ -+enum adtc_type { -+ COMMOM_ADTC = 0, -+ BLOCK_RW_ADTC, -+}; -+ -+struct phytium_sdci_host { -+ struct device *dev; -+ struct mmc_host *mmc; -+ u32 caps; -+ spinlock_t lock; -+ -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ int error; -+ -+ void __iomem *base; -+ -+ struct phytium_sdci_dma dma_rx; -+ struct phytium_sdci_dma dma_tx; -+ -+ u32 *sg_virt_addr; -+ enum adtc_type adtc_type; -+ -+ struct timer_list hotplug_timer; -+ -+ struct delayed_work req_timeout; -+ u32 cmd_timeout; -+ u32 data_timeout; -+ -+ int irq; -+ int irq_err; -+ int irq_bd; -+ -+ struct clk *src_clk; -+ unsigned long clk_rate; -+ unsigned long clk_div; -+ unsigned long real_rate; -+ -+ u32 current_rca; -+ bool is_multi_rw_only_one_blkcnt; -+}; -+ -diff --git a/drivers/mtd/nand/raw/Kconfig b/drivers/mtd/nand/raw/Kconfig -index 6c46f25b5..2fce65c27 100644 ---- a/drivers/mtd/nand/raw/Kconfig -+++ b/drivers/mtd/nand/raw/Kconfig -@@ -486,6 +486,25 @@ config MTD_NAND_RICOH - expermental, readwrite - 'SmartMedia/xD new translation layer' - -+config MTD_NAND_PHYTIUM -+ tristate -+ -+config MTD_NAND_PHYTIUM_PCI -+ tristate "Support Phytium NAND controller as a PCI device" -+ select MTD_NAND_PHYTIUM -+ depends on PCI -+ help -+ Enable the driver for NAND flash controller of Phytium Px210 chipset, -+ using the Phytium NAND controller core. -+ -+config MTD_NAND_PHYTIUM_PLAT -+ tristate "Support Phytium NAND controller as a platform device" -+ select MTD_NAND_PHYTIUM -+ depends on ARCH_PHYTIUM -+ help -+ Enable the driver for NAND flash controller of Phytium CPU chipset, -+ using the Phytium NAND controller core. -+ - config MTD_NAND_DISKONCHIP - tristate "DiskOnChip 2000, Millennium and Millennium Plus (NAND reimplementation)" - depends on HAS_IOMEM -diff --git a/drivers/mtd/nand/raw/Makefile b/drivers/mtd/nand/raw/Makefile -index 2930f5b90..b603ff23e 100644 ---- a/drivers/mtd/nand/raw/Makefile -+++ b/drivers/mtd/nand/raw/Makefile -@@ -59,6 +59,10 @@ obj-$(CONFIG_MTD_NAND_MESON) += meson_nand.o - obj-$(CONFIG_MTD_NAND_CADENCE) += cadence-nand-controller.o - obj-$(CONFIG_MTD_NAND_ARASAN) += arasan-nand-controller.o - -+obj-$(CONFIG_MTD_NAND_PHYTIUM) += phytium_nand.o -+obj-$(CONFIG_MTD_NAND_PHYTIUM_PCI) += phytium_nand_pci.o -+obj-$(CONFIG_MTD_NAND_PHYTIUM_PLAT) += phytium_nand_plat.o -+ - nand-objs := nand_base.o nand_legacy.o nand_bbt.o nand_timings.o nand_ids.o - nand-objs += nand_onfi.o - nand-objs += nand_jedec.o -diff --git a/drivers/mtd/nand/raw/phytium_nand.c b/drivers/mtd/nand/raw/phytium_nand.c -new file mode 100644 -index 000000000..1c8e27d71 ---- /dev/null -+++ b/drivers/mtd/nand/raw/phytium_nand.c -@@ -0,0 +1,2167 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Core driver for Phytium NAND flash controller -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "phytium_nand.h" -+ -+#define NFC_DATA_CMD_DEBUG 0 -+ -+u16 timing_asy_mode0[TIMING_ASY_NUM] = { /* x100 pass, sample: 1 */ -+ 0x03, 0x03, 0x28, 0x28, 0x03, 0x03, 0x06, 0x06, 0x28, 0x70, 0x30, 0x50}; -+u16 timing_asy_mode1[TIMING_ASY_NUM] = { /* x100 pass, sample: 1 */ -+ 0x03, 0x03, 0x14, 0x14, 0x03, 0x03, 0x06, 0x06, 0x14, 0x70, 0x30, 0x28}; -+u16 timing_asy_mode2[TIMING_ASY_NUM] = { /* x100 pass, sample: 7/8 (unlic) */ -+ 0x03, 0x03, 0x0D, 0x0D, 0x03, 0x03, 0x06, 0x06, 0x0D, 0x70, 0x20, 0x1A}; -+u16 timing_asy_mode3[TIMING_ASY_NUM] = { /* x100 pass, sample: 4-7 */ -+ 0x03, 0x03, 0x0A, 0x0A, 0x03, 0x03, 0x06, 0x06, 0x0A, 0x70, 0x20, 0x14}; -+u16 timing_asy_mode4[TIMING_ASY_NUM] = { /* x100 1.8v pass */ -+ 0x03, 0x03, 0x08, 0x08, 0x03, 0x03, 0x06, 0x06, 0x08, 0x70, 0x15, 0x10}; -+u16 timing_asy_mode5[TIMING_ASY_NUM] = { /* x100 1.8v pass */ -+ 0x03, 0x03, 0x07, 0x07, 0x03, 0x03, 0x06, 0x06, 0x07, 0x20, 0x15, 0x0E}; -+u16 timing_syn_mode0[TIMING_SYN_NUM] = { /* x100 1.8v pass */ -+ 0x20, 0x41, 0x05, 0x20, 0x10, 0x19, 0x62, 0x40, 0x38, 0x20, 0x00, 0x09, -+ 0x50, 0x20}; -+u16 timing_syn_mode1[TIMING_SYN_NUM] = { /* x100 1.8v pass */ -+ 0x18, 0x32, 0x06, 0x18, 0x0C, 0x10, 0x76, 0x40, 0x2A, 0x1E, 0x00, 0x12, -+ 0x24, 0x18}; -+u16 timing_syn_mode2[TIMING_SYN_NUM] = { /* x100 1.8v pass */ -+ 0x10, 0x0A, 0x04, 0x10, 0x08, 0x0A, 0x6E, 0x50, 0x1D, 0x10, 0x00, 0x0C, -+ 0x18, 0x10}; -+u16 timing_syn_mode3[TIMING_SYN_NUM] = { /* x100 1.8v pass */ -+ 0x0C, 0x1A, 0x02, 0x0C, 0x06, 0x08, 0x78, 0x7C, 0x15, 0x0C, 0x00, 0x08, -+ 0x12, 0x0C}; -+u16 timing_syn_mode4[TIMING_SYN_NUM] = { /* x100 1.8v failed */ -+ 0x08, 0x17, 0x05, 0x08, 0x04, 0x01, 0x73, 0x40, 0x0C, 0x08, 0x00, 0x06, -+ 0x0C, 0x10}; -+u16 timing_tog_ddr_mode0[TIMING_TOG_NUM] = { /* 600M clk */ -+ 0x14, 0x0a, 0x08, 0x08, 0xc8, 0xc8, 0x08, 0x08, 0x20, 0x0a, 0x14, 0x08}; -+ -+static u32 nfc_ecc_errover; -+static u32 nfc_ecc_err; -+static u32 nfc_irq_st; -+static u32 nfc_irq_en; -+static u32 nfc_irq_complete; -+ -+static DECLARE_WAIT_QUEUE_HEAD(wait_done); -+ -+/* -+ * Internal helper to conditionnally apply a delay (from the above structure, -+ * most of the time). -+ */ -+static void cond_delay(unsigned int ns) -+{ -+ if (!ns) -+ return; -+ -+ if (ns < 10000) -+ ndelay(ns); -+ else -+ udelay(DIV_ROUND_UP(ns, 1000)); -+} -+ -+static inline struct phytium_nfc *to_phytium_nfc(struct nand_controller *ctrl) -+{ -+ return container_of(ctrl, struct phytium_nfc, controller); -+} -+ -+static inline struct phytium_nand_chip *to_phytium_nand(struct nand_chip *chip) -+{ -+ return container_of(chip, struct phytium_nand_chip, chip); -+} -+ -+static u32 phytium_read(struct phytium_nfc *nfc, u32 reg) -+{ -+ return readl_relaxed(nfc->regs + reg); -+} -+ -+static void phytium_write(struct phytium_nfc *nfc, u32 reg, u32 value) -+{ -+ return writel_relaxed(value, nfc->regs + reg); -+} -+ -+static inline int phytium_wait_busy(struct phytium_nfc *nfc) -+{ -+ u32 status; -+ -+ if (nfc_ecc_errover) { -+ nfc_ecc_errover = 0; -+ return 0; -+ } -+ -+ return readl_relaxed_poll_timeout(nfc->regs + NDSR, status, -+ !(status & NDSR_BUSY), 10, 10000); -+} -+ -+static void phytium_nfc_disable_int(struct phytium_nfc *nfc, u32 int_mask) -+{ -+ u32 reg; -+ -+ reg = phytium_read(nfc, NDIR_MASK); -+ phytium_write(nfc, NDIR_MASK, reg | int_mask); -+} -+ -+static void phytium_nfc_enable_int(struct phytium_nfc *nfc, u32 int_mask) -+{ -+ u32 reg; -+ -+ reg = phytium_read(nfc, NDIR_MASK); -+ phytium_write(nfc, NDIR_MASK, reg & (~int_mask)); -+} -+ -+static void phytium_nfc_clear_int(struct phytium_nfc *nfc, u32 int_mask) -+{ -+ phytium_write(nfc, NDIR_MASK, int_mask); -+} -+ -+static int phytium_nfc_cmd_correct(struct phytium_nfc_op *nfc_op) -+{ -+ if (!nfc_op) -+ return -EINVAL; -+ -+ if (nfc_op->cmd_len == 0x01) { -+ nfc_op->cmd[1] = nfc_op->cmd[0]; -+ nfc_op->cmd[0] = 0; -+ } -+ -+ return 0; -+} -+ -+static int phytium_nfc_addr_correct(struct phytium_nfc_op *nfc_op) -+{ -+ u32 len; -+ int i, j; -+ -+ if (!nfc_op) -+ return -EINVAL; -+ -+ len = nfc_op->addr_len > PHYTIUM_NFC_ADDR_MAX_LEN ? -+ PHYTIUM_NFC_ADDR_MAX_LEN : nfc_op->addr_len; -+ -+ if (len == PHYTIUM_NFC_ADDR_MAX_LEN) -+ return 0; -+ -+ for (i = len-1, j = PHYTIUM_NFC_ADDR_MAX_LEN - 1; i >= 0; i--, j--) { -+ nfc_op->addr[j] = nfc_op->addr[i]; -+ nfc_op->addr[i] = 0; -+ } -+ -+ return 0; -+} -+ -+static void phytium_nfc_parse_instructions(struct nand_chip *chip, -+ const struct nand_subop *subop, -+ struct phytium_nfc_op *nfc_op) -+{ -+ struct nand_op_instr *instr = NULL; -+ bool first_cmd = true; -+ u32 op_id; -+ int i; -+ -+ /* Reset the input structure as most of its fields will be OR'ed */ -+ memset(nfc_op, 0, sizeof(struct phytium_nfc_op)); -+ -+ for (op_id = 0; op_id < subop->ninstrs; op_id++) { -+ unsigned int offset, naddrs; -+ const u8 *addrs; -+ int len; -+ -+ instr = (struct nand_op_instr *)&subop->instrs[op_id]; -+ -+ switch (instr->type) { -+ case NAND_OP_CMD_INSTR: -+ if (first_cmd) { -+ nfc_op->cmd[0] = instr->ctx.cmd.opcode; -+ } else { -+ nfc_op->cmd[1] = instr->ctx.cmd.opcode; -+ nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; -+ } -+ -+ nfc_op->cle_ale_delay_ns = instr->delay_ns; -+ first_cmd = false; -+ nfc_op->cmd_len++; -+ -+ break; -+ -+ case NAND_OP_ADDR_INSTR: -+ offset = nand_subop_get_addr_start_off(subop, op_id); -+ naddrs = nand_subop_get_num_addr_cyc(subop, op_id); -+ addrs = &instr->ctx.addr.addrs[offset]; -+ -+ nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = naddrs; -+ -+ for (i = 0; i < min_t(u32, PHYTIUM_NFC_ADDR_MAX_LEN, naddrs); i++) -+ nfc_op->addr[i] = addrs[i]; -+ -+ nfc_op->cle_ale_delay_ns = instr->delay_ns; -+ -+ nfc_op->addr_len = naddrs; -+ break; -+ -+ case NAND_OP_DATA_IN_INSTR: -+ nfc_op->data_instr = instr; -+ nfc_op->data_instr_idx = op_id; -+ nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; -+ len = nand_subop_get_data_len(subop, op_id); -+ nfc_op->page_cnt = len; -+ nfc_op->data_delay_ns = instr->delay_ns; -+ -+ break; -+ -+ case NAND_OP_DATA_OUT_INSTR: -+ nfc_op->data_instr = instr; -+ nfc_op->data_instr_idx = op_id; -+ nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; -+ len = nand_subop_get_data_len(subop, op_id); -+ nfc_op->page_cnt = len; -+ nfc_op->data_delay_ns = instr->delay_ns; -+ break; -+ -+ case NAND_OP_WAITRDY_INSTR: -+ nfc_op->rdy_timeout_ms = instr->ctx.waitrdy.timeout_ms; -+ nfc_op->rdy_delay_ns = instr->delay_ns; -+ break; -+ } -+ } -+} -+ -+int phytium_nfc_prepare_cmd(struct nand_chip *chip, -+ struct phytium_nfc_op *nfc_op, -+ enum dma_data_direction direction) -+{ -+ struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ int i; -+ -+ phytium_nfc_cmd_correct(nfc_op); -+ phytium_nfc_addr_correct(nfc_op); -+ -+ nfc_op->cmd_ctrl.nfc_ctrl.csel = 0x0F ^ (0x01 << phytium_nand->selected_die); -+ -+ for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) -+ nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_prepare_cmd); -+ -+#if NFC_DATA_CMD_DEBUG -+ -+static int phytium_nfc_cmd_dump(struct phytium_nfc *nfc, -+ struct phytium_nfc_op *nfc_op, u8 *buf) -+{ -+ u8 *p; -+ u8 str[1024] = {0}; -+ int i; -+ -+ sprintf(str, "Phytium NFC cmd dump:\n"); -+ sprintf(str, "%s cmd0:%x, cmd1:%x, ctrl:%x, page_cnt:%d\n", -+ str, nfc_op->cmd[0], nfc_op->cmd[1], nfc_op->cmd_ctrl.ctrl, nfc_op->page_cnt); -+ -+ p = &nfc_op->addr[0]; -+ sprintf(str, "%s addr:%02x %02x %02x %02x %02x\n", -+ str, p[0], p[1], p[2], p[3], p[4]); -+ -+ p = &nfc_op->mem_addr_first[0]; -+ sprintf(str, "%s mem_addr_first:%02x %02x %02x %02x %02x\n", -+ str, p[0], p[1], p[2], p[3], p[4]); -+ -+ for (i = 0; i < PHYTIUM_NFC_DSP_SIZE; i++) -+ sprintf(str, "%s %02x", str, buf[i]); -+ -+ dev_info(nfc->dev, "%s\n", str); -+ -+ return 0; -+} -+ -+int phytium_nfc_data_dump(struct phytium_nfc *nfc, u8 *buf, u32 len) -+{ -+ u8 str[1024] = {0}; -+ int i; -+ -+ len = len > 512 ? 512 : len; -+ -+ sprintf(str, "Phytium NFC data dump: %d\n", len); -+ for (i = 0; i < len; i++) { -+ if (i && (i%128 == 0)) { -+ dev_info(nfc->dev, "next:\n%s\n", str); -+ memset(str, 0, 1024); -+ } -+ -+ if (i && (i%16 == 0)) -+ sprintf(str, "%s\n", str); -+ sprintf(str, "%s %02x", str, buf[i]); -+ } -+ -+ dev_info(nfc->dev, "%s\n", str); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_data_dump); -+#else -+#define phytium_nfc_cmd_dump(...) -+#define phytium_nfc_data_dump(...) -+#endif -+ -+int phytium_nfc_send_cmd(struct nand_chip *chip, -+ struct phytium_nfc_op *nfc_op) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 value = 0; -+ -+ memset((u8 *)nfc->dsp_addr, 0, PAGE_SIZE); -+ memcpy((u8 *)nfc->dsp_addr, (u8 *)nfc_op, PHYTIUM_NFC_DSP_SIZE); -+ -+ phytium_nfc_cmd_dump(nfc, nfc_op, (u8 *)nfc->dsp_addr); -+ -+ if (phytium_wait_busy(nfc) != 0) { -+ dev_err(nfc->dev, "NFC was always busy\n"); -+ dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); -+ dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); -+ return 0; -+ } -+ -+ spin_lock(&nfc->spinlock); -+ value = nfc->dsp_phy_addr & 0xFFFFFFFF; -+ phytium_write(nfc, NDAR0, value); -+ -+ /* Don't modify NDAR1_DMA_RLEN & NDAR1_DMA_WLEN */ -+ value = phytium_read(nfc, NDAR1); -+ value |= NDAR1_H8((nfc->dsp_phy_addr >> 32) & 0xFF); -+ phytium_write(nfc, NDAR1, value); -+ -+ phytium_nfc_enable_int(nfc, NDIR_CMD_FINISH_MASK); -+ -+ value |= NDAR1_DMA_EN; -+ phytium_write(nfc, NDAR1, value); -+ spin_unlock(&nfc->spinlock); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_send_cmd); -+ -+int phytium_nfc_prepare_cmd2(struct nand_chip *chip, -+ struct phytium_nfc_op *nfc_op, -+ enum dma_data_direction direction, -+ u32 cmd_num) -+{ -+ struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); -+ int i; -+ -+ for (i = 0; i < cmd_num; i++) { -+ phytium_nfc_cmd_correct(nfc_op); -+ phytium_nfc_addr_correct(nfc_op); -+ nfc_op->cmd_ctrl.nfc_ctrl.csel = 0x0F ^ (0x01 << phytium_nand->selected_die); -+ nfc_op++; -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_prepare_cmd2); -+ -+int phytium_nfc_send_cmd2(struct nand_chip *chip, -+ struct phytium_nfc_op *nfc_op, -+ u32 cmd_num) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 value = 0; -+ int i; -+ -+ memset((u8 *)nfc->dsp_addr, 0, PAGE_SIZE); -+ -+ for (i = 0; i < cmd_num; i++) { -+ memcpy((u8 *)nfc->dsp_addr + i*PHYTIUM_NFC_DSP_SIZE, -+ (u8 *)nfc_op, PHYTIUM_NFC_DSP_SIZE); -+ phytium_nfc_cmd_dump(nfc, nfc_op, (u8 *)nfc->dsp_addr + i*PHYTIUM_NFC_DSP_SIZE); -+ nfc_op++; -+ } -+ -+ if (phytium_wait_busy(nfc) != 0) { -+ dev_err(nfc->dev, "NFC was always busy\n"); -+ dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); -+ dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); -+ return 0; -+ } -+ -+ spin_lock(&nfc->spinlock); -+ value = nfc->dsp_phy_addr & 0xFFFFFFFF; -+ phytium_write(nfc, NDAR0, value); -+ -+ /* Don't modify NDAR1_DMA_RLEN & NDAR1_DMA_WLEN */ -+ value = phytium_read(nfc, NDAR1); -+ value |= NDAR1_H8((nfc->dsp_phy_addr >> 32) & 0xFF); -+ phytium_write(nfc, NDAR1, value); -+ -+ phytium_nfc_enable_int(nfc, NDIR_DMA_FINISH_MASK | NDIR_ECC_ERR_MASK); -+ -+ value |= NDAR1_DMA_EN; -+ phytium_write(nfc, NDAR1, value); -+ spin_unlock(&nfc->spinlock); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_send_cmd2); -+ -+int phytium_nfc_wait_op(struct nand_chip *chip, -+ u32 timeout_ms) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ int ret; -+ -+ /* Timeout is expressed in ms */ -+ if (!timeout_ms) -+ timeout_ms = IRQ_TIMEOUT; -+ else if (timeout_ms > 1000) -+ timeout_ms = 1000; -+ else if (timeout_ms < 100) -+ timeout_ms = 100; -+ -+ ret = wait_event_interruptible_timeout(wait_done, nfc_irq_complete, -+ msecs_to_jiffies(timeout_ms)); -+ nfc_irq_complete = false; -+ -+ if (!ret) { -+ dev_err(nfc->dev, "Timeout waiting for RB signal\n"); -+ dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); -+ dev_err(nfc->dev, "NFC irq state: %x, irq en:%x\n", -+ phytium_read(nfc, NDIR), phytium_read(nfc, NDIR_MASK)); -+ dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); -+ -+ phytium_nfc_clear_int(nfc, NDIR_ALL_INT(nfc->caps->int_mask_bits)); -+ return -ETIMEDOUT; -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_wait_op); -+ -+static int phytium_nfc_xfer_data_pio(struct phytium_nfc *nfc, -+ const struct nand_subop *subop, -+ struct phytium_nfc_op *nfc_op) -+{ -+ const struct nand_op_instr *instr = nfc_op->data_instr; -+ unsigned int op_id = nfc_op->data_instr_idx; -+ unsigned int len = nand_subop_get_data_len(subop, op_id); -+ unsigned int offset = nand_subop_get_data_start_off(subop, op_id); -+ bool reading = (instr->type == NAND_OP_DATA_IN_INSTR); -+ -+ if (reading) { -+ u8 *in = instr->ctx.data.buf.in + offset; -+ -+ memcpy(in, nfc->dma_buf, len); -+ -+ nfc->dma_offset = 0; -+ } else { -+ const u8 *out = instr->ctx.data.buf.out + offset; -+ -+ memcpy(nfc->dma_buf, out, len); -+ } -+ -+ return 0; -+} -+ -+static int memcpy_to_reg16(struct phytium_nfc *nfc, u32 reg, u16 *buf, size_t len) -+{ -+ int i; -+ u32 val = 0; -+ -+ if (!nfc || !buf || (len >= 16)) -+ return -EINVAL; -+ -+ for (i = 0; i < len; i++) { -+ val = (val << 16) + buf[i]; -+ if (i % 2) { -+ phytium_write(nfc, reg, val); -+ val = 0; -+ reg += 4; -+ } -+ } -+ -+ return 0; -+} -+ -+int phytium_nfc_default_data_interface(struct phytium_nfc *nfc) -+{ -+ int value; -+ -+ value = phytium_read(nfc, NDCR0); -+ value &= (~NDCR0_IN_MODE(3)); -+ value |= NDCR0_IN_MODE(nfc->inter_mode); -+ phytium_write(nfc, NDCR0, value); -+ -+ value = phytium_read(nfc, NDCR1); -+ value &= (~NDCR1_SAMPL_PHASE(0xFFFF)); -+ -+ switch (nfc->inter_mode) { -+ case ASYN_SDR: -+ if (nfc->timing_mode == ASY_MODE4) { -+ memcpy_to_reg16(nfc, NDTR0, timing_asy_mode4, TIMING_ASY_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(4)); -+ } else if (nfc->timing_mode == ASY_MODE3) { -+ memcpy_to_reg16(nfc, NDTR0, timing_asy_mode3, TIMING_ASY_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(5)); -+ } else if (nfc->timing_mode == ASY_MODE2) { -+ memcpy_to_reg16(nfc, NDTR0, timing_asy_mode2, TIMING_ASY_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(3)); -+ } else if (nfc->timing_mode == ASY_MODE1) { -+ memcpy_to_reg16(nfc, NDTR0, timing_asy_mode1, TIMING_ASY_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(2)); -+ } else { -+ memcpy_to_reg16(nfc, NDTR0, timing_asy_mode0, TIMING_ASY_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(1)); -+ } -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x01); -+ break; -+ case ONFI_DDR: -+ if (nfc->timing_mode == SYN_MODE4) { -+ memcpy_to_reg16(nfc, NDTR6, timing_syn_mode4, TIMING_SYN_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x0D)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x30); -+ } else if (nfc->timing_mode == SYN_MODE3) { -+ memcpy_to_reg16(nfc, NDTR6, timing_syn_mode3, TIMING_SYN_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x05)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x18); -+ } else if (nfc->timing_mode == SYN_MODE2) { -+ memcpy_to_reg16(nfc, NDTR6, timing_syn_mode2, TIMING_SYN_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x08)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x20); -+ } else if (nfc->timing_mode == SYN_MODE1) { -+ memcpy_to_reg16(nfc, NDTR6, timing_syn_mode1, TIMING_SYN_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x12)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x40); -+ } else { -+ memcpy_to_reg16(nfc, NDTR6, timing_syn_mode0, TIMING_SYN_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x12)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x40); -+ } -+ break; -+ case TOG_ASYN_DDR: -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(8)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0xC8); -+ memcpy_to_reg16(nfc, NDTR13, timing_tog_ddr_mode0, TIMING_TOG_NUM); -+ break; -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_default_data_interface); -+ -+static int phytium_nfc_naked_waitrdy_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ int ret = 0; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ -+ dev_info(nfc->dev, "Phytium nand command 0x%02x 0x%02x.\n", -+ nfc_op.cmd[0], nfc_op.cmd[1]); -+ -+ switch (nfc_op.cmd[0]) { -+ case NAND_CMD_PARAM: -+ memset(nfc->dma_buf, 0, PAGE_SIZE); -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_PARAM; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ if (nfc->inter_pro == NAND_ONFI) -+ nfc_op.page_cnt = 3 * sizeof(struct nand_onfi_params); -+ else if (nfc->inter_pro == NAND_JEDEC) -+ nfc_op.page_cnt = 3 * sizeof(struct nand_jedec_params); -+ if (nfc_op.page_cnt) -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc->dma_offset = 0; -+ break; -+ case NAND_CMD_SET_FEATURES: -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_SET_FTR; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ if (nfc->inter_mode != ASYN_SDR) { -+ dev_err(nfc->dev, "Not support SET_FEATURES command!\n"); -+ return 0; -+ } -+ break; -+ case NAND_CMD_GET_FEATURES: -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_GET_FTR; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ break; -+ case NAND_CMD_READ0: -+ if (nfc_op.cmd[1] == NAND_CMD_READSTART) { /* large page */ -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ } else if (nfc_op.cmd[1] == NAND_CMD_SEQIN) { /* program page begin */ -+ nfc_op.cmd[0] = NAND_CMD_SEQIN; -+ nfc_op.cmd[1] = NAND_CMD_PAGEPROG; -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ } else { /* small page */ -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ } -+ break; -+ case NAND_CMD_RNDOUT: /* change read column */ -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ break; -+ case NAND_CMD_READSTART: /* large page */ -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ break; -+ case NAND_CMD_RNDOUTSTART: /* change read column */ -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc->dma_offset = nfc_op.addr[1]; -+ nfc->dma_offset = (nfc->dma_offset << 8) + nfc_op.addr[0]; -+ break; -+ case NAND_CMD_SEQIN: /* program begin */ -+ if (nfc_op.cmd[0] == NAND_CMD_READ0) { -+ nfc_op.cmd[0] = NAND_CMD_SEQIN; -+ nfc_op.cmd[1] = NAND_CMD_PAGEPROG; -+ } -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ break; -+ case NAND_CMD_RNDIN: /* change write column */ -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_WR_COL; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ break; -+ case NAND_CMD_PAGEPROG: /* program end */ -+ nfc_op.cmd[0] = NAND_CMD_RNDIN; -+ nfc_op.cmd[1] = NAND_CMD_PAGEPROG; -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ break; -+ default: -+ dev_err(nfc->dev, "Not support cmd %d.\n", nfc_op.cmd[1]); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ if ((nfc_op.data_instr) && (direction == DMA_TO_DEVICE)) -+ phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); -+ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ nfc_op.rdy_timeout_ms = nfc_op.rdy_timeout_ms; -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ goto out; -+ -+ cond_delay(nfc_op.rdy_delay_ns); -+ -+ if ((nfc_op.data_instr) && (direction == DMA_FROM_DEVICE)) -+ phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); -+ -+out: -+ return ret; -+} -+ -+static int phytium_nfc_read_id_type_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ u16 read_len = 0; -+ int ret; -+ u8 *buf = nfc->dma_buf; -+ -+ memset(nfc->dma_buf, 0, PAGE_SIZE); -+ direction = DMA_FROM_DEVICE; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ read_len = nfc_op.page_cnt; -+ nfc_op.page_cnt = (read_len & 0x03) ? ((read_len & 0xFFFC) + 4) : read_len; -+ -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_ID; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 0; -+ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ return ret; -+ -+ cond_delay(nfc_op.rdy_delay_ns); -+ -+ if (!strncmp(nfc->dma_buf, "ONFI", 4)) { -+ nfc->inter_pro = NAND_ONFI; -+ } else if (!strncmp(nfc->dma_buf, "JEDEC", 5)) { -+ nfc->inter_pro = NAND_JEDEC; -+ if (buf[5] == 1) -+ nfc->inter_mode = ASYN_SDR; -+ else if (buf[5] == 2) -+ nfc->inter_mode = TOG_ASYN_DDR; -+ else if (buf[5] == 4) -+ nfc->inter_mode = ASYN_SDR; -+ } else { -+ nfc->inter_pro = NAND_OTHER; -+ } -+ -+ dev_info(nfc->dev, "Nand protocol: %d, interface mode: %d\n", -+ nfc->inter_pro, nfc->inter_mode); -+ -+ phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); -+ -+ return 0; -+} -+ -+static int phytium_nfc_read_status_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ u16 read_len = 0; -+ u32 timeout, count = 0; -+ int ret = 0; -+ -+ direction = DMA_FROM_DEVICE; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ read_len = nfc_op.page_cnt; -+ nfc_op.page_cnt = (read_len & 0x03) ? ((read_len & 0xFFFC) + 4) : read_len; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_STATUS; -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ -+read_status_retry: -+ count++; -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ timeout = nfc_op.rdy_timeout_ms ? nfc_op.rdy_timeout_ms : 10; -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ goto out; -+ -+ phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); -+ -+ if (0xE0 != *(u8 *)(nfc->dma_buf)) { -+ dev_info(nfc->dev, "Retry to read status (%x)\n", *(u8 *)(nfc->dma_buf)); -+ -+ if (count < 10) -+ goto read_status_retry; -+ } -+ -+out: -+ return ret; -+} -+ -+static int phytium_nfc_reset_cmd_type_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ -+ direction = DMA_NONE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_RESET; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ return phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+} -+ -+static int phytium_nfc_erase_cmd_type_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ direction = DMA_NONE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_ERASE; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ return phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+} -+ -+static int phytium_nfc_data_in_type_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nfc_op nfc_op; -+ struct nand_op_instr *instr; -+ unsigned int op_id; -+ unsigned int len; -+ unsigned int offset; -+ u8 *in = NULL; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ if (nfc_op.data_instr->type != NAND_OP_DATA_IN_INSTR) { -+ dev_err(nfc->dev, "Phytium nfc instrs parser failed!\n"); -+ return -EINVAL; -+ } -+ -+ instr = nfc_op.data_instr; -+ op_id = nfc_op.data_instr_idx; -+ len = nand_subop_get_data_len(subop, op_id); -+ offset = nand_subop_get_data_start_off(subop, op_id); -+ in = instr->ctx.data.buf.in + offset; -+ -+ phytium_nfc_cmd_dump(nfc, &nfc_op, (u8 *)nfc->dsp_addr); -+ -+ memcpy(in, nfc->dma_buf + nfc->dma_offset, len); -+ nfc->dma_offset += len; -+ phytium_nfc_data_dump(nfc, in, len); -+ -+ return 0; -+} -+ -+static const struct nand_op_parser phytium_nfc_op_parser = NAND_OP_PARSER( -+ /* Naked commands not supported, use a function for each pattern */ -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_read_id_type_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, 8)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_erase_cmd_type_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_read_status_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, 1)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_reset_cmd_type_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_naked_waitrdy_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_WAITRDY_ELEM(false), -+ NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_naked_waitrdy_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_naked_waitrdy_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_DATA_OUT_ELEM(false, 8), -+ NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_naked_waitrdy_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_data_in_type_exec, -+ NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), -+ ); -+ -+static int phytium_nfc_exec_op(struct nand_chip *chip, -+ const struct nand_operation *op, -+ bool check_only) -+{ -+ return nand_op_parser_exec_op(chip, &phytium_nfc_op_parser, -+ op, check_only); -+} -+ -+static int phytium_nfc_reset(struct phytium_nfc *nfc) -+{ -+ u32 value; -+ -+ phytium_write(nfc, NDIR_MASK, NDIR_ALL_INT(nfc->caps->int_mask_bits)); -+ phytium_write(nfc, NDSR, NDIR_ALL_INT(nfc->caps->int_mask_bits)); -+ -+ phytium_write(nfc, ND_ERR_CLR, 0x0F); -+ phytium_write(nfc, NDFIFO_CLR, 1); -+ -+ value = phytium_read(nfc, NDCR0); -+ phytium_write(nfc, NDCR0, value & ~(NDCR0_ECC_EN | NDCR0_SPARE_EN)); -+ -+ return 0; -+} -+ -+static void phytium_nfc_select_chip(struct nand_chip *chip, int die_nr) -+{ -+ struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ -+ dev_dbg(nfc->dev, "Phytium nand selected chip %d\n", die_nr); -+ -+ if (chip == nfc->selected_chip && die_nr == phytium_nand->selected_die) -+ return; -+ -+ if (die_nr < 0 || die_nr >= phytium_nand->nsels) { -+ nfc->selected_chip = NULL; -+ phytium_nand->selected_die = -1; -+ return; -+ } -+ -+ phytium_nfc_reset(nfc); -+ -+ nfc->selected_chip = chip; -+ phytium_nand->selected_die = die_nr; -+} -+ -+static int phytium_nand_ooblayout_ecc(struct mtd_info *mtd, int section, -+ struct mtd_oob_region *oobregion) -+{ -+ struct nand_chip *chip = mtd_to_nand(mtd); -+ -+ if (section) -+ return -ERANGE; -+ -+ oobregion->length = chip->ecc.total; -+ oobregion->offset = mtd->oobsize - oobregion->length; -+ -+ return 0; -+} -+ -+static int phytium_nand_ooblayout_free(struct mtd_info *mtd, int section, -+ struct mtd_oob_region *oobregion) -+{ -+ struct nand_chip *chip = mtd_to_nand(mtd); -+ -+ if (section) -+ return -ERANGE; -+ -+ /* -+ * Bootrom looks in bytes 0 & 5 for bad blocks for the -+ * 4KB page / 4bit BCH combination. -+ */ -+ if (mtd->writesize >= SZ_4K) -+ oobregion->offset = 6; -+ else -+ oobregion->offset = 2; -+ -+ oobregion->length = mtd->oobsize - chip->ecc.total - oobregion->offset; -+ -+ return 0; -+} -+ -+static const struct mtd_ooblayout_ops phytium_nand_ooblayout_ops = { -+ .ecc = phytium_nand_ooblayout_ecc, -+ .free = phytium_nand_ooblayout_free, -+}; -+ -+static void phytium_nfc_enable_hw_ecc(struct nand_chip *chip) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 ndcr0 = phytium_read(nfc, NDCR0); -+ -+ if (!(ndcr0 & NDCR0_ECC_EN)) -+ phytium_write(nfc, NDCR0, ndcr0 | NDCR0_ECC_EN); -+} -+ -+static void phytium_nfc_disable_hw_ecc(struct nand_chip *chip) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 ndcr0 = phytium_read(nfc, NDCR0); -+ -+ if (ndcr0 & NDCR0_ECC_EN) -+ phytium_write(nfc, NDCR0, ndcr0 & ~NDCR0_ECC_EN); -+} -+ -+ -+irqreturn_t phytium_nfc_isr(int irq, void *dev_id) -+{ -+ struct phytium_nfc *nfc = dev_id; -+ u32 st = phytium_read(nfc, NDIR); -+ u32 ien = (~phytium_read(nfc, NDIR_MASK)) & NDIR_ALL_INT(nfc->caps->int_mask_bits); -+ -+ if (!(st & ien)) -+ return IRQ_NONE; -+ -+ nfc_irq_st = st; -+ nfc_irq_en = ien; -+ phytium_nfc_disable_int(nfc, st & NDIR_ALL_INT(nfc->caps->int_mask_bits)); -+ phytium_write(nfc, 0xFD0, 0); -+ -+ if (st & (NDIR_CMD_FINISH | NDIR_DMA_FINISH)) { -+ if (st & NDIR_ECC_ERR) -+ nfc_ecc_err = 1; -+ phytium_write(nfc, NDIR, st); -+ nfc_irq_complete = 1; -+ } else if (st & (NDIR_FIFO_TIMEOUT | NDIR_PGFINISH)) { -+ phytium_write(nfc, NDIR, st); -+ phytium_nfc_enable_int(nfc, (~st) & (NDIR_DMA_FINISH_MASK | -+ NDIR_PGFINISH_MASK | -+ NDIR_FIFO_TIMEOUT_MASK | -+ NDIR_CMD_FINISH_MASK)); -+ nfc_irq_complete = 0; -+ } else if (st & NDIR_ECC_ERR) { -+ phytium_write(nfc, ND_ERR_CLR, 0x08); -+ phytium_write(nfc, NDIR, st); -+ phytium_write(nfc, NDFIFO_CLR, 0x01); -+ nfc_irq_complete = 1; -+ nfc_ecc_errover = 1; -+ } else { -+ phytium_write(nfc, NDIR, st); -+ nfc_irq_complete = 1; -+ } -+ -+ wake_up(&wait_done); -+ -+ return IRQ_HANDLED; -+} -+EXPORT_SYMBOL(phytium_nfc_isr); -+ -+static int phytium_nfc_hw_ecc_correct(struct nand_chip *chip, -+ char *buf, int len) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 i, j, value, tmp; -+ u32 ecc_err_reg_nums; -+ int stat = 0; -+ -+ if (!buf) -+ return -EINVAL; -+ -+ if (nfc->caps->hw_ver == 1) -+ ecc_err_reg_nums = 2; -+ else -+ ecc_err_reg_nums = 4; -+ -+ for (i = 0; i < chip->ecc.steps; i++) { -+ for (j = 0; j < ecc_err_reg_nums; j++) { -+ value = phytium_read(nfc, 0xB8 + 4 * (ecc_err_reg_nums * i + j)); -+ dev_info(nfc->dev, "ECC_FLAG: offset:%x value:0x%08x\n", -+ 0xB8 + 4 * (2 * i + j), value); -+ -+ tmp = value & 0xFFFF; -+ if (tmp && (tmp <= 4096)) { -+ tmp--; -+ stat++; -+ buf[chip->ecc.size * i + (tmp >> 3)] ^= (0x01 << tmp % 8); -+ dev_info(nfc->dev, "ECC_CORRECT %x %02x\n", -+ chip->ecc.size * i + (tmp >> 3), -+ buf[chip->ecc.size * i + (tmp >> 3)]); -+ dev_info(nfc->dev, "ECC_CORRECT xor %x %02x\n", -+ 0x01 << (tmp % 8), buf[chip->ecc.size * i + (tmp >> 3)]); -+ } else if (tmp > 4096) { -+ dev_info(nfc->dev, "ECC_CORRECT offset > 4096!\n"); -+ } -+ -+ tmp = (value >> 16) & 0xFFFF; -+ if (tmp && (tmp <= 4096)) { -+ tmp--; -+ stat++; -+ buf[chip->ecc.size * i + (tmp >> 3)] ^= (0x01 << tmp % 8); -+ dev_info(nfc->dev, "ECC_CORRECT %x %02x\n", -+ chip->ecc.size * i + (tmp >> 3), -+ buf[chip->ecc.size * i + (tmp >> 3)]); -+ dev_info(nfc->dev, "ECC_CORRECT xor %x %02x\n", -+ chip->ecc.size * i + (tmp >> 3), -+ buf[chip->ecc.size * i + (tmp >> 3)]); -+ } else if (tmp > 4096) { -+ dev_info(nfc->dev, "ECC_CORRECT offset > 4096!\n"); -+ } -+ } -+ } -+ -+ return stat; -+} -+ -+static int phytium_nand_page_read(struct mtd_info *mtd, struct nand_chip *chip, -+ u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ int ret = 0; -+ -+ memset(&nfc_op, 0, sizeof(nfc_op)); -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); -+ -+ memset(nfc->dma_buf, 0x0, mtd->writesize + mtd->oobsize); -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op.cmd[0] = NAND_CMD_READ0; -+ nfc_op.cmd[1] = NAND_CMD_READSTART; -+ nfc_op.cmd_len = 2; -+ nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); -+ nfc_op.rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); -+ -+ nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op.addr[2] = page; -+ nfc_op.addr[3] = page >> 8; -+ nfc_op.addr[4] = page >> 16; -+ nfc_op.addr_len = 5; -+ nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ -+ nfc_op.page_cnt = mtd->writesize; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; -+ -+ /* For data read/program */ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ return ret; -+ -+ if ((direction == DMA_FROM_DEVICE) && buf) -+ memcpy(buf, nfc->dma_buf, mtd->writesize); -+ -+ return ret; -+} -+ -+static int phytium_nand_oob_read(struct mtd_info *mtd, struct nand_chip *chip, -+ u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ int ret = 0; -+ -+ memset(&nfc_op, 0, sizeof(nfc_op)); -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); -+ -+ memset(nfc->dma_buf, 0x00, mtd->writesize + mtd->oobsize); -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op.cmd[0] = NAND_CMD_READ0; -+ nfc_op.cmd[1] = NAND_CMD_READSTART; -+ nfc_op.cmd_len = 2; -+ nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); -+ nfc_op.rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); -+ -+ nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op.addr[2] = page; -+ nfc_op.addr[3] = page >> 8; -+ nfc_op.addr[4] = page >> 16; -+ nfc_op.addr_len = 5; -+ nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ -+ nfc_op.page_cnt = oob_len; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; -+ nfc_op.addr[0] = mtd->writesize & 0xFF; -+ nfc_op.addr[1] = (mtd->writesize >> 8) & 0xFF; -+ -+ /* For data read/program */ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ return ret; -+ -+ cond_delay(nfc_op.rdy_delay_ns); -+ -+ if (direction == DMA_FROM_DEVICE) -+ memcpy(oob_buf, nfc->dma_buf, oob_len); -+ -+ return ret; -+} -+ -+static int phytium_nand_get_ecc_total(struct mtd_info *mtd, -+ struct nand_ecc_ctrl *ecc) -+{ -+ int ecc_total = 0; -+ -+ switch (mtd->writesize) { -+ case 0x200: -+ if (ecc->strength == 8) -+ ecc_total = 0x0D; -+ else if (ecc->strength == 4) -+ ecc_total = 7; -+ else if (ecc->strength == 2) -+ ecc_total = 4; -+ else -+ ecc_total = 0; -+ break; -+ case 0x800: -+ if (ecc->strength == 8) -+ ecc_total = 0x34; -+ else if (ecc->strength == 4) -+ ecc_total = 0x1a; -+ else if (ecc->strength == 2) -+ ecc_total = 0xd; -+ else -+ ecc_total = 0; -+ break; -+ case 0x1000: -+ if (ecc->strength == 8) -+ ecc_total = 0x68; -+ else if (ecc->strength == 4) -+ ecc_total = 0x34; -+ else if (ecc->strength == 2) -+ ecc_total = 0x1a; -+ else -+ ecc_total = 0; -+ break; -+ case 0x2000: -+ if (ecc->strength == 8) -+ ecc_total = 0xD0; -+ else if (ecc->strength == 4) -+ ecc_total = 0x68; -+ else if (ecc->strength == 2) -+ ecc_total = 0x34; -+ else -+ ecc_total = 0; -+ break; -+ case 0x4000: -+ if (ecc->strength == 8) -+ ecc_total = 0x1A0; -+ if (ecc->strength == 4) -+ ecc_total = 0xD0; -+ else if (ecc->strength == 2) -+ ecc_total = 0x68; -+ else -+ ecc_total = 0; -+ break; -+ default: -+ ecc_total = 0; -+ break; -+ } -+ -+ return ecc_total; -+} -+ -+static int phytium_nand_page_read_hwecc(struct mtd_info *mtd, struct nand_chip *chip, -+ u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op *nfc_op = NULL; -+ enum dma_data_direction direction; -+ u32 ecc_offset; -+ int max_bitflips = 0; -+ u32 nfc_state = 0; -+ int ret = 0; -+ int i; -+ -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); -+ -+ ecc_offset = phytium_nand->ecc.offset; -+ memset(nfc->dma_buf, 0x00, mtd->writesize + mtd->oobsize); -+ nfc_op = kzalloc(2 * sizeof(struct phytium_nfc_op), GFP_KERNEL); -+ if (!nfc_op) { -+ dev_err(nfc->dev, "Can't malloc space for phytium_nfc_op\n"); -+ return 0; -+ } -+ -+ nfc_op->cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op->rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); -+ nfc_op->rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); -+ -+ direction = DMA_FROM_DEVICE; -+ nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op->cmd[0] = NAND_CMD_READ0; -+ nfc_op->cmd[1] = NAND_CMD_READSTART; -+ nfc_op->cmd_len = 2; -+ nfc_op->addr_len = 5; -+ nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op->addr[2] = page; -+ nfc_op->addr[3] = page >> 8; -+ nfc_op->addr[4] = page >> 16; -+ nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc_op->page_cnt = mtd->writesize; -+ nfc_op->cmd_ctrl.nfc_ctrl.nc = 1; -+ for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) -+ nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; -+ -+ nfc_op++; -+ memcpy(nfc_op, nfc_op - 1, sizeof(struct phytium_nfc_op)); -+ nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; -+ nfc_op->cmd[0] = NAND_CMD_RNDOUT; -+ nfc_op->cmd[1] = NAND_CMD_RNDOUTSTART; -+ memset(&nfc_op->addr, 0, PHYTIUM_NFC_ADDR_MAX_LEN); -+ nfc_op->addr_len = 2; -+ nfc_op->addr[0] = mtd->writesize + phytium_nand->ecc.offset; -+ nfc_op->addr[1] = (mtd->writesize + phytium_nand->ecc.offset) >> 8; -+ nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x02; -+ nfc_op->page_cnt = phytium_nand_get_ecc_total(mtd, &chip->ecc); -+ nfc_op->cmd_ctrl.nfc_ctrl.nc = 0; -+ nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 0; -+ nfc_op->cmd_ctrl.nfc_ctrl.ecc_en = 1; -+ for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) -+ nfc_op->mem_addr_first[i] = -+ ((nfc->dma_phy_addr + mtd->writesize) >> (8 * i)) & 0xFF; -+ -+ nfc_op--; -+ phytium_nfc_prepare_cmd2(chip, nfc_op, direction, 2); -+ phytium_nfc_send_cmd2(chip, nfc_op, 2); -+ cond_delay(nfc_op->cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op->rdy_timeout_ms); -+ if (ret){ -+ kfree(nfc_op); -+ return ret; -+ } -+ -+ cond_delay(nfc_op->rdy_delay_ns*1000); -+ -+ if ((direction == DMA_FROM_DEVICE) && buf) { -+ nfc_state = phytium_read(nfc, NDSR); -+ if ((nfc_state & NDSR_ECC_ERROVER) || (nfc_ecc_errover == 1)) { -+ for (i = 0; i < mtd->writesize/16; i++) { -+ if (0xFF != *(u8 *)(nfc->dma_buf + i)) { -+ dev_info(nfc->dev, "NFC: NDSR_ECC_ERROVER %x\n", page); -+ mtd->ecc_stats.failed++; -+ mtd->ecc_stats.corrected += max_bitflips; -+ break; -+ } -+ } -+ } else if (nfc_state & NDSR_ECC_ERR) { -+ max_bitflips = phytium_nfc_hw_ecc_correct(chip, -+ nfc->dma_buf, mtd->writesize); -+ mtd->ecc_stats.corrected += max_bitflips; -+ dev_info(nfc->dev, "NFC: NDSR_ECC_ERR page:%x, bit:%d\n", -+ page, max_bitflips); -+ } -+ -+ memcpy(buf, nfc->dma_buf, mtd->writesize); -+ } -+ -+ kfree(nfc_op); -+ return max_bitflips; -+} -+ -+static int phytium_nand_page_write(struct mtd_info *mtd, struct nand_chip *chip, -+ const u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ int ret = 0; -+ -+ memset(&nfc_op, 0, sizeof(nfc_op)); -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); -+ -+ memcpy(nfc->dma_buf, buf, mtd->writesize); -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op.cmd[0] = NAND_CMD_SEQIN; -+ nfc_op.cmd[1] = NAND_CMD_PAGEPROG; -+ nfc_op.cmd_len = 2; -+ nfc_op.addr_len = 5; -+ nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tPROG_max); -+ nfc_op.rdy_delay_ns = 0; -+ -+ nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op.addr[2] = page; -+ nfc_op.addr[3] = page >> 8; -+ nfc_op.addr[4] = page >> 16; -+ nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc_op.page_cnt = mtd->writesize; -+ -+ /* For data read/program */ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ goto out; -+ -+ cond_delay(nfc_op.rdy_delay_ns); -+out: -+ return ret; -+} -+ -+static int phytium_nand_oob_write(struct mtd_info *mtd, struct nand_chip *chip, -+ u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ int ret = 0; -+ -+ memset(&nfc_op, 0, sizeof(nfc_op)); -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); -+ -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op.cmd[0] = NAND_CMD_SEQIN; -+ nfc_op.cmd[1] = NAND_CMD_PAGEPROG; -+ nfc_op.cmd_len = 2; -+ nfc_op.addr_len = 5; -+ nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tPROG_max); -+ nfc_op.rdy_delay_ns = 0; -+ -+ nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op.addr[2] = page; -+ nfc_op.addr[3] = page >> 8; -+ nfc_op.addr[4] = page >> 16; -+ nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ -+ nfc_op.page_cnt = oob_len; -+ nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; -+ nfc_op.addr[0] = mtd->writesize & 0xFF; -+ nfc_op.addr[1] = (mtd->writesize >> 8) & 0xFF; -+ nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; -+ memcpy(nfc->dma_buf, oob_buf, mtd->oobsize); -+ -+ /* For data read/program */ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ goto out; -+ -+ cond_delay(nfc_op.rdy_delay_ns); -+out: -+ return ret; -+} -+ -+static int phytium_nand_page_write_hwecc(struct mtd_info *mtd, struct nand_chip *chip, -+ const u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op *nfc_op; -+ enum dma_data_direction direction; -+ u32 ecc_offset; -+ int ret = 0; -+ int i; -+ -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); -+ ecc_offset = phytium_nand->ecc.offset; -+ -+ nfc_op = kzalloc(2 * sizeof(struct phytium_nfc_op), GFP_KERNEL); -+ if (!nfc_op) { -+ dev_err(nfc->dev, "Can't malloc space for phytium_nfc_op\n"); -+ return 0; -+ } -+ -+ nfc_op->cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op->rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); -+ nfc_op->rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); -+ -+ direction = DMA_TO_DEVICE; -+ nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_ROW_ADDR; -+ nfc_op->cmd[0] = NAND_CMD_SEQIN; -+ nfc_op->cmd_len = 1; -+ nfc_op->addr_len = 5; -+ nfc_op->cmd_ctrl.nfc_ctrl.dbc = 0; -+ nfc_op->addr[2] = page; -+ nfc_op->addr[3] = page >> 8; -+ nfc_op->addr[4] = page >> 16; -+ nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 0; -+ nfc_op->cmd_ctrl.nfc_ctrl.nc = 1; -+ for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) -+ nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; -+ -+ /* The first dsp must have data to transfer */ -+ memcpy(nfc->dma_buf, buf, mtd->writesize); -+ nfc_op->page_cnt = mtd->writesize; -+ nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; -+ -+ nfc_op++; -+ memcpy(nfc_op, nfc_op - 1, sizeof(struct phytium_nfc_op)); -+ nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc_op->cmd[0] = NAND_CMD_RNDIN; -+ nfc_op->cmd[1] = NAND_CMD_PAGEPROG; -+ memset(&nfc_op->addr, 0, PHYTIUM_NFC_ADDR_MAX_LEN); -+ nfc_op->addr_len = 2; -+ nfc_op->cmd_len = 2; -+ nfc_op->addr[0] = mtd->writesize + ecc_offset; -+ nfc_op->addr[1] = (mtd->writesize + ecc_offset) >> 8; -+ nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x02; -+ nfc_op->page_cnt = phytium_nand_get_ecc_total(mtd, &chip->ecc); -+ nfc_op->cmd_ctrl.nfc_ctrl.nc = 0; -+ nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op->cmd_ctrl.nfc_ctrl.ecc_en = 1; -+ for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) -+ nfc_op->mem_addr_first[i] = -+ ((nfc->dma_phy_addr + mtd->writesize + ecc_offset) >> (8 * i)) & 0xFF; -+ -+ /* when enable ECC, must offer ecc_offset of oob, but no oobdata */ -+ nfc_op--; -+ phytium_nfc_prepare_cmd2(chip, nfc_op, direction, 2); -+ phytium_nfc_send_cmd2(chip, nfc_op, 2); -+ cond_delay(nfc_op->cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op->rdy_timeout_ms); -+ if (ret) -+ goto out; -+ -+ cond_delay(nfc_op->rdy_delay_ns*1000); -+out: -+ kfree(nfc_op); -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_read_page_raw(struct nand_chip *chip, -+ u8 *buf, int oob_required, int page) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ u32 oob_len = oob_required ? mtd->oobsize : 0; -+ int ret; -+ -+ ret = phytium_nand_page_read(mtd, chip, buf, NULL, 0, page, true); -+ if (oob_required) -+ ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, -+ oob_len, page, true); -+ -+ phytium_nfc_data_dump(to_phytium_nfc(chip->controller), buf, mtd->writesize); -+ -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_read_oob_raw(struct nand_chip *chip, int page) -+{ -+ int ret; -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ -+ /* Invalidate page cache */ -+ chip->pagecache.page = -1; -+ memset(chip->oob_poi, 0xFF, mtd->oobsize); -+ -+ ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, -+ mtd->oobsize, page, true); -+ -+ phytium_nfc_data_dump(to_phytium_nfc(chip->controller), chip->oob_poi, mtd->oobsize); -+ -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_read_page(struct nand_chip *chip, -+ u8 *buf, int oob_required, int page) -+{ -+ int ret; -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ u32 oob_len = oob_required ? mtd->oobsize : 0; -+ struct phytium_nand_chip *phytium_nand = NULL; -+ -+ phytium_nand = to_phytium_nand(chip); -+ -+ phytium_nfc_enable_hw_ecc(chip); -+ cond_delay(20*1000); -+ -+ ret = phytium_nand_page_read_hwecc(mtd, chip, buf, NULL, -+ 0, page, true); -+ -+ phytium_nfc_disable_hw_ecc(chip); -+ -+ if (oob_required) { -+ oob_len = mtd->oobsize; -+ ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, -+ oob_len, page, true); -+ } -+ -+ phytium_nfc_data_dump(to_phytium_nfc(chip->controller), buf, mtd->writesize); -+ -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_read_oob(struct nand_chip *chip, -+ int page) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ u32 oob_len = mtd->oobsize; -+ int ret; -+ -+ ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, -+ oob_len, page, true); -+ -+ phytium_nfc_data_dump(to_phytium_nfc(chip->controller), chip->oob_poi, oob_len); -+ -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_write_page_raw(struct nand_chip *chip, -+ const u8 *buf, int oob_required, int page) -+{ -+ void *oob_buf = oob_required ? chip->oob_poi : NULL; -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ -+ if (oob_required) -+ phytium_nand_oob_write(mtd, chip, NULL, oob_buf, -+ mtd->oobsize, page, false); -+ -+ return phytium_nand_page_write(mtd, chip, buf, NULL, -+ 0, page, false); -+} -+ -+static int phytium_nfc_hw_ecc_bch_write_page(struct nand_chip *chip, -+ const u8 *buf, int oob_required, int page) -+{ -+ int ret; -+ void *oob_buf = oob_required ? chip->oob_poi : NULL; -+ u32 oob_len; -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ -+ if (oob_required) { -+ oob_len = mtd->oobsize; -+ phytium_nand_oob_write(mtd, chip, NULL, oob_buf, -+ oob_len, page, false); -+ } -+ -+ phytium_nfc_enable_hw_ecc(chip); -+ -+ cond_delay(20*1000); -+ -+ ret = phytium_nand_page_write_hwecc(mtd, chip, buf, NULL, -+ 0, page, false); -+ -+ phytium_nfc_disable_hw_ecc(chip); -+ -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_write_oob_raw(struct nand_chip *chip, int page) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ return phytium_nand_oob_write(mtd, chip, NULL, chip->oob_poi, -+ mtd->oobsize, page, false); -+} -+ -+static int phytium_nfc_hw_ecc_bch_write_oob(struct nand_chip *chip, int page) -+{ -+ struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ u32 oob_len = mtd->oobsize - phytium_nand->ecc.length; -+ -+ return phytium_nand_oob_write(mtd, chip, NULL, chip->oob_poi, -+ oob_len, page, false); -+} -+ -+static int phytium_nand_hw_ecc_ctrl_init(struct mtd_info *mtd, -+ struct nand_ecc_ctrl *ecc) -+{ -+ struct nand_chip *chip = mtd_to_nand(mtd); -+ -+ if ((mtd->writesize + mtd->oobsize > MAX_CHUNK_SIZE)) -+ return -ENOTSUPP; -+ -+ chip->ecc.algo = NAND_ECC_ALGO_BCH; -+ ecc->read_page_raw = phytium_nfc_hw_ecc_bch_read_page_raw; -+ ecc->read_page = phytium_nfc_hw_ecc_bch_read_page; -+ ecc->read_oob_raw = phytium_nfc_hw_ecc_bch_read_oob_raw; -+ ecc->read_oob = phytium_nfc_hw_ecc_bch_read_oob; -+ ecc->write_page_raw = phytium_nfc_hw_ecc_bch_write_page_raw; -+ ecc->write_page = phytium_nfc_hw_ecc_bch_write_page; -+ ecc->write_oob_raw = phytium_nfc_hw_ecc_bch_write_oob_raw; -+ ecc->write_oob = phytium_nfc_hw_ecc_bch_write_oob; -+ -+ return 0; -+} -+ -+static int phytium_nand_ecc_init(struct mtd_info *mtd, -+ struct nand_ecc_ctrl *ecc) -+{ -+ int ret = 0; -+ -+ mtd_set_ooblayout(mtd, &phytium_nand_ooblayout_ops); -+ -+ switch (ecc->engine_type) { -+ case NAND_ECC_ENGINE_TYPE_ON_HOST: -+ ret = phytium_nand_hw_ecc_ctrl_init(mtd, ecc); -+ break; -+ case NAND_ECC_ENGINE_TYPE_NONE: -+ ecc->read_page_raw = phytium_nfc_hw_ecc_bch_read_page_raw; -+ ecc->read_oob_raw = phytium_nfc_hw_ecc_bch_read_oob; -+ ecc->write_page_raw = phytium_nfc_hw_ecc_bch_write_page_raw; -+ ecc->write_oob_raw = phytium_nfc_hw_ecc_bch_write_oob_raw; -+ ecc->read_page = ecc->read_page_raw; -+ ecc->read_oob = ecc->read_oob_raw; -+ ecc->write_page = ecc->write_page_raw; -+ ecc->write_oob = ecc->write_oob_raw; -+ break; -+ case NAND_ECC_ENGINE_TYPE_SOFT: -+ case NAND_ECC_ENGINE_TYPE_ON_DIE: -+ default: -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+static u8 bbt_pattern[] = {'P', 'H', 'Y', 'b', 't', '0' }; -+static u8 bbt_mirror_pattern[] = {'1', 't', 'b', 'Y', 'H', 'P' }; -+ -+static struct nand_bbt_descr bbt_main_descr = { -+ .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE | -+ NAND_BBT_2BIT | NAND_BBT_VERSION, -+ .offs = 8, -+ .len = 6, -+ .veroffs = 14, -+ .maxblocks = 8, /* Last 8 blocks in each chip */ -+ .pattern = bbt_pattern -+}; -+ -+static struct nand_bbt_descr bbt_mirror_descr = { -+ .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE | -+ NAND_BBT_2BIT | NAND_BBT_VERSION, -+ .offs = 8, -+ .len = 6, -+ .veroffs = 14, -+ .maxblocks = 8, /* Last 8 blocks in each chip */ -+ .pattern = bbt_mirror_pattern -+}; -+ -+static int phytium_nand_attach_chip(struct nand_chip *chip) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 value; -+ int ret = 0; -+ -+ if (nfc->caps->flash_bbt) -+ chip->bbt_options |= NAND_BBT_USE_FLASH; -+ -+ if (chip->bbt_options & NAND_BBT_USE_FLASH) { -+ /* -+ * We'll use a bad block table stored in-flash and don't -+ * allow writing the bad block marker to the flash. -+ */ -+ chip->bbt_options |= NAND_BBT_NO_OOB_BBM; -+ chip->bbt_td = &bbt_main_descr; -+ chip->bbt_md = &bbt_mirror_descr; -+ } -+ -+ if (chip->options & NAND_BUSWIDTH_16) -+ phytium_nand->ndcr |= NDCR0_WIDTH; -+ -+ /* -+ * On small page NANDs, only one cycle is needed to pass the -+ * column address. -+ */ -+ if (mtd->writesize <= 512) -+ phytium_nand->addr_cyc = 1; -+ else -+ phytium_nand->addr_cyc = 2; -+ -+ /* -+ * Now add the number of cycles needed to pass the row -+ * address. -+ * -+ * Addressing a chip using CS 2 or 3 should also need the third row -+ * cycle but due to inconsistance in the documentation and lack of -+ * hardware to test this situation, this case is not supported. -+ */ -+ if (chip->options & NAND_ROW_ADDR_3) -+ phytium_nand->addr_cyc += 3; -+ else -+ phytium_nand->addr_cyc += 2; -+ -+ if (nfc->caps) { -+ if (chip->ecc.engine_type == NAND_ECC_ENGINE_TYPE_ON_HOST) { -+ chip->ecc.size = nfc->caps->ecc_step_size ? -+ nfc->caps->ecc_step_size : -+ chip->ecc.size; -+ chip->ecc.strength = nfc->caps->ecc_strength ? -+ nfc->caps->ecc_strength : -+ chip->ecc.strength; -+ chip->ecc.strength = nfc->caps->ecc_strength; -+ chip->ecc.bytes = 7; -+ } else { -+ chip->ecc.size = 512; -+ chip->ecc.strength = 1; -+ chip->ecc.bytes = 0; -+ } -+ chip->ecc.engine_type = NAND_ECC_ENGINE_TYPE_ON_HOST; -+ } -+ -+ if (nfc->caps->hw_ver == 1) { -+ if (chip->ecc.strength == 0x04) -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(4); -+ else if (chip->ecc.strength == 0x02) -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(2); -+ else -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(0); -+ } else { -+ if (chip->ecc.strength == 0x08) -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(7); -+ else if (chip->ecc.strength == 0x04) -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(3); -+ else if (chip->ecc.strength == 0x02) -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(1); -+ else -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(0); -+ } -+ -+ value = phytium_read(nfc, NDCR0); -+ value &= ~NDCR0_EN; -+ phytium_write(nfc, NDCR0, value); -+ -+ value &= ~NDCR0_ECC_STREN(7); -+ value |= phytium_nand->ndcr; -+ phytium_write(nfc, NDCR0, value | NDCR0_EN); -+ -+ ret = phytium_nand_ecc_init(mtd, &chip->ecc); -+ if (ret) { -+ dev_err(nfc->dev, "ECC init failed: %d\n", ret); -+ goto out; -+ } -+ -+ /* -+ * Subpage write not available with hardware ECC, prohibit also -+ * subpage read as in userspace subpage access would still be -+ * allowed and subpage write, if used, would lead to numerous -+ * uncorrectable ECC errors. -+ */ -+ if (chip->ecc.engine_type == NAND_ECC_ENGINE_TYPE_ON_HOST) -+ chip->options |= NAND_NO_SUBPAGE_WRITE; -+ -+ /* -+ * We keep the MTD name unchanged to avoid breaking platforms -+ * where the MTD cmdline parser is used and the bootloader -+ * has not been updated to use the new naming scheme. -+ */ -+ if (nfc->caps->legacy_of_bindings) -+ mtd->name = "phytium_nand-0"; -+ -+out: -+ return ret; -+} -+ -+static int phytium_nfc_setup_interface(struct nand_chip *chip, int chipnr, -+ const struct nand_interface_config *conf) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ unsigned int period_ns = 2; -+ const struct nand_sdr_timings *sdr; -+ struct phytium_nfc_timings nfc_tmg; -+ int read_delay; -+ -+ sdr = nand_get_sdr_timings(conf); -+ if (IS_ERR(sdr)) -+ return PTR_ERR(sdr); -+ -+ nfc_tmg.tRP = TO_CYCLES(DIV_ROUND_UP(sdr->tRC_min, 2), period_ns) - 1; -+ nfc_tmg.tRH = nfc_tmg.tRP; -+ nfc_tmg.tWP = TO_CYCLES(DIV_ROUND_UP(sdr->tWC_min, 2), period_ns) - 1; -+ nfc_tmg.tWH = nfc_tmg.tWP; -+ nfc_tmg.tCS = TO_CYCLES(sdr->tCS_min, period_ns); -+ nfc_tmg.tCH = TO_CYCLES(sdr->tCH_min, period_ns) - 1; -+ nfc_tmg.tADL = TO_CYCLES(sdr->tADL_min, period_ns); -+ dev_info(nfc->dev, "[nfc_tmg]tRP: %d, tRH:%d, tWP:%d tWH:%d\n", -+ nfc_tmg.tRP, nfc_tmg.tRH, nfc_tmg.tWP, nfc_tmg.tWH); -+ dev_info(nfc->dev, "[nfc_tmg]tCS: %d, tCH:%d, tADL:%d\n", -+ nfc_tmg.tCS, nfc_tmg.tCH, nfc_tmg.tADL); -+ -+ read_delay = sdr->tRC_min >= 30000 ? -+ MIN_RD_DEL_CNT : MIN_RD_DEL_CNT + nfc_tmg.tRH; -+ -+ nfc_tmg.tAR = TO_CYCLES(sdr->tAR_min, period_ns); -+ nfc_tmg.tWHR = TO_CYCLES(max_t(int, sdr->tWHR_min, sdr->tCCS_min), -+ period_ns) - 2, -+ nfc_tmg.tRHW = TO_CYCLES(max_t(int, sdr->tRHW_min, sdr->tCCS_min), -+ period_ns); -+ dev_info(nfc->dev, "[nfc_tmg]tAR: %d, tWHR:%d, tRHW:%d\n", -+ nfc_tmg.tAR, nfc_tmg.tWHR, nfc_tmg.tRHW); -+ -+ nfc_tmg.tR = TO_CYCLES(sdr->tWB_max, period_ns); -+ -+ if (chipnr < 0) -+ return 0; -+ -+ if (nfc_tmg.tWP > 0x10) -+ nfc->timing_mode = ASY_MODE1; -+ else if (nfc_tmg.tWP < 0x0D) -+ nfc->timing_mode = ASY_MODE3; -+ -+ if (nfc->inter_mode == ONFI_DDR) -+ nfc->timing_mode = SYN_MODE3; -+ -+ phytium_nfc_default_data_interface(nfc); -+ -+ return 0; -+} -+ -+static const struct nand_controller_ops phytium_nand_controller_ops = { -+ .attach_chip = phytium_nand_attach_chip, -+ .exec_op = phytium_nfc_exec_op, -+ .setup_interface = phytium_nfc_setup_interface, -+}; -+ -+static void phytium_nand_chips_cleanup(struct phytium_nfc *nfc) -+{ -+ struct phytium_nand_chip *entry, *temp; -+ int ret; -+ -+ list_for_each_entry_safe(entry, temp, &nfc->chips, node) { -+ ret = mtd_device_unregister(nand_to_mtd(&entry->chip)); -+ WARN_ON(ret); -+ nand_cleanup(&entry->chip); -+ list_del(&entry->node); -+ } -+} -+ -+static int phytium_nfc_init_dma(struct phytium_nfc *nfc) -+{ -+ int ret; -+ -+ ret = dma_set_mask_and_coherent(nfc->dev, DMA_BIT_MASK(64)); -+ if (ret) -+ return ret; -+ -+ nfc->dsp_addr = dma_alloc_coherent(nfc->dev, PAGE_SIZE, -+ &nfc->dsp_phy_addr, GFP_KERNEL | GFP_DMA); -+ if (!nfc->dsp_addr) -+ return -ENOMEM; -+ -+ nfc->dma_buf = dma_alloc_coherent(nfc->dev, MAX_CHUNK_SIZE, -+ &nfc->dma_phy_addr, GFP_KERNEL | GFP_DMA); -+ if (!nfc->dma_buf) -+ return -ENOMEM; -+ -+ dev_info(nfc->dev, "NFC address dsp_phy_addr:%llx, dma_phy_addr:%llx\n", -+ nfc->dsp_phy_addr, nfc->dma_phy_addr); -+ -+ return 0; -+} -+ -+int phytium_nfc_init(struct phytium_nfc *nfc) -+{ -+ u32 value; -+ -+ nfc->inter_mode = ASYN_SDR; -+ nfc->timing_mode = ASY_MODE0; -+ -+ value = phytium_read(nfc, NDCR1); -+ value &= (~NDCR1_SAMPL_PHASE(0xFFFF)); -+ value &= ~NDCR1_ECC_DATA_FIRST_EN; -+ value |= NDCR1_SAMPL_PHASE(1); -+ value |= NDCR1_ECC_BYPASS; -+ phytium_write(nfc, NDCR1, value); -+ phytium_write(nfc, ND_INTERVAL_TIME, 1); -+ phytium_write(nfc, NDFIFO_LEVEL0, 4); -+ phytium_write(nfc, NDFIFO_LEVEL1, 4); -+ phytium_write(nfc, NDFIFO_CLR, 1); -+ phytium_write(nfc, ND_ERR_CLR, 1); -+ -+ /* Configure the DMA */ -+ phytium_nfc_init_dma(nfc); -+ -+ -+ -+ phytium_nfc_reset(nfc); -+ -+ value = phytium_read(nfc, NDCR0); -+ value &= (~NDCR0_IN_MODE(3)); -+ value |= NDCR0_IN_MODE(nfc->inter_mode); -+ value |= NDCR0_EN; -+ -+ phytium_write(nfc, NDCR0, value); -+ -+ nfc_ecc_errover = 0; -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_init); -+ -+static int phytium_nand_chip_init(struct phytium_nfc *nfc) -+{ -+ struct device *dev = nfc->dev; -+ struct phytium_nand_chip *phytium_nand; -+ struct mtd_info *mtd; -+ struct nand_chip *chip; -+ int ret; -+ -+ /* Alloc the nand chip structure */ -+ phytium_nand = devm_kzalloc(dev, sizeof(*phytium_nand), GFP_KERNEL); -+ if (!phytium_nand) -+ return -ENOMEM; -+ -+ phytium_nand->nsels = 1; -+ phytium_nand->selected_die = -1; -+ -+ chip = &phytium_nand->chip; -+ chip->controller = &nfc->controller; -+ chip->legacy.select_chip = phytium_nfc_select_chip; -+ phytium_nfc_default_data_interface(nfc); -+ -+ mtd = nand_to_mtd(chip); -+ mtd->dev.parent = dev; -+ mtd->owner = THIS_MODULE; -+ -+ /* -+ * Default to HW ECC engine mode. If the nand-ecc-mode property is given -+ * in the DT node, this entry will be overwritten in nand_scan_ident(). -+ */ -+ chip->ecc.engine_type = NAND_ECC_ENGINE_TYPE_ON_HOST; -+ -+ chip->options |= NAND_BUSWIDTH_AUTO; -+ chip->options |= NAND_SKIP_BBTSCAN; -+ chip->bbt_options |= NAND_BBT_NO_OOB; -+ -+ ret = nand_scan(chip, phytium_nand->nsels); -+ if (ret) { -+ dev_err(dev, "could not scan the nand chip\n"); -+ goto out; -+ } -+ -+ if (nfc->caps->parts) { -+ ret = mtd_device_register(mtd, nfc->caps->parts, nfc->caps->nr_parts - 1); -+ } else if (dev->of_node) { -+ nand_set_flash_node(chip, dev->of_node); -+ ret = mtd_device_register(mtd, NULL, 0); -+ } else { -+ ret = -EINVAL; -+ } -+ -+ if (ret) { -+ dev_err(dev, "failed to register mtd device: %d\n", ret); -+ nand_cleanup(chip); -+ return ret; -+ } -+ -+ phytium_nand->ecc.length = phytium_nand_get_ecc_total(mtd, &chip->ecc); -+ phytium_nand->ecc.offset = mtd->oobsize - phytium_nand->ecc.length; -+ chip->ecc.total = phytium_nand_get_ecc_total(mtd, &chip->ecc); -+ -+ mtd_ooblayout_ecc(mtd, 0, &phytium_nand->ecc); -+ -+ dev_info(dev, "ooblayout ecc offset: %x, length: %x\n", -+ phytium_nand->ecc.offset, phytium_nand->ecc.length); -+ -+out: -+ list_add_tail(&phytium_nand->node, &nfc->chips); -+ return 0; -+} -+ -+int phytium_nand_init(struct phytium_nfc *nfc) -+{ -+ int ret; -+ -+ nand_controller_init(&nfc->controller); -+ nfc->controller.ops = &phytium_nand_controller_ops; -+ INIT_LIST_HEAD(&nfc->chips); -+ -+ /* Init the controller and then probe the chips */ -+ ret = phytium_nfc_init(nfc); -+ if (ret) -+ goto out; -+ -+ ret = phytium_nand_chip_init(nfc); -+ if (ret) -+ goto out; -+ -+ spin_lock_init(&nfc->spinlock); -+ -+out: -+ return ret; -+} -+EXPORT_SYMBOL_GPL(phytium_nand_init); -+ -+int phytium_nand_remove(struct phytium_nfc *nfc) -+{ -+ phytium_nand_chips_cleanup(nfc); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nand_remove); -+ -+static int phytium_nfc_wait_ndrun(struct nand_chip *chip) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ int ret = 0; -+ u32 val; -+ -+ ret = readl_relaxed_poll_timeout(nfc->regs + NDSR, val, -+ (val & NDSR_RB) == 0, -+ 0, 100 * 1000); -+ if (ret) { -+ dev_err(nfc->dev, "Timeout on NAND controller run mode\n"); -+ ret = -EAGAIN; -+ } -+ -+ return ret; -+} -+ -+int phytium_nand_prepare(struct phytium_nfc *nfc) -+{ -+ struct phytium_nand_chip *chip = NULL; -+ -+ list_for_each_entry(chip, &nfc->chips, node) -+ phytium_nfc_wait_ndrun(&chip->chip); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nand_prepare); -+ -+int phytium_nand_resume(struct phytium_nfc *nfc) -+{ -+ nfc->selected_chip = NULL; -+ phytium_nfc_init(nfc); -+ phytium_nfc_default_data_interface(nfc); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nand_resume); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium NAND controller platform driver"); -+MODULE_AUTHOR("Zhu Mingshuai "); -diff --git a/drivers/mtd/nand/raw/phytium_nand.h b/drivers/mtd/nand/raw/phytium_nand.h -new file mode 100644 -index 000000000..f666cdff5 ---- /dev/null -+++ b/drivers/mtd/nand/raw/phytium_nand.h -@@ -0,0 +1,449 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium NAND flash controller driver -+ * -+ * Copyright (c) 2020-2024 Phytium Technology, Co., Ltd. -+ */ -+#ifndef PHYTIUM_NAND_H -+#define PHYTIUM_NAND_H -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/* NFC does not support transfers of larger chunks at a time */ -+#define MAX_PAGE_NUM 16 -+#define MAX_CHUNK_SIZE ((1024 + 76) * 16) -+ -+#define POLL_PERIOD 0 -+#define POLL_TIMEOUT 100000 -+/* Interrupt maximum wait period in ms */ -+#define IRQ_TIMEOUT 1000 -+ -+/* Latency in clock cycles between SoC pins and NFC logic */ -+#define MIN_RD_DEL_CNT 3 -+ -+#define PHYTIUM_NFC_ADDR_MAX_LEN 5 -+#define PHYTIUM_NFC_DSP_SIZE 16 -+ -+/* NAND controller flash control register */ -+#define NDCR0 0x00 -+#define NDCR0_EN BIT(0) -+#define NDCR0_WIDTH BIT(1) -+#define NDCR0_IN_MODE(x) (min_t(u32, x, 0x3) << 2) -+#define NDCR0_ECC_EN BIT(4) -+#define NDCR0_ECC_STREN(x) (min_t(u32, x, 0x7) << 5) -+#define NDCR0_SPARE_EN BIT(8) -+#define NDCR0_SPARE_SIZE(x) (min_t(u32, x, 0xFFF) << 9) -+#define NDCR0_GENERIC_FIELDS_MASK -+ -+#define NDCR1 0x04 -+#define NDCR1_SAMPL_PHASE(x) min_t(u32, x, 0xFFFF) -+#define NDCR1_ECC_DATA_FIRST_EN BIT(16) -+#define NDCR1_RB_SHARE_EN BIT(17) -+#define NDCR1_ECC_BYPASS BIT(18) -+ -+#define NDAR0 0x08 -+ -+#define NDAR1 0x0C -+#define NDAR1_H8(x) min_t(u32, x, 0xFF) -+#define NDAR1_DMA_EN BIT(8) -+#define NDAR1_EMPTY(x) (min_t(u32, x, 0x7F) << 9) -+#define NDAR1_DMA_RLEN(x) (min_t(u32, x, 0xFF) << 9) -+#define NDAR1_DMA_WLEN(x) (min_t(u32, x, 0xFF) << 9) -+ -+#define NDTR0 0x10 -+#define NDTR0_TCS_TCLS(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR0_TCLS_TWP(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR1 0x14 -+#define NDTR1_TWH(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR1_TWP(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR2 0x18 -+#define NDTR2_TCH_TCLH(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR2_TCLH_TWH(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR3 0x1c -+#define NDTR3_TDQ_EN(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR3_TCH_TWH(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR4 0x20 -+#define NDTR4_TWHR_SMX(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR4_TREH(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR5 0x24 -+#define NDTR5_TRC(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR5_TADL_SMX(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR6 0x28 -+#define NDTR6_TCAD_TCS_SMX(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR6_RES(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR7 0x2c -+#define NDTR7_TCK(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR7_TDQ_EN(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR8 0x30 -+#define NDTR8_TCAD_TCK_SMX(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR8_HF_TCK(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR9 0x34 -+#define NDTR9_TWHR(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR9_TCCS_TCALS_SMX(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR10 0x38 -+#define NDTR10_TCK(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR10_MTCK(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR11 0x3c -+#define NDTR11_TCK_TCALS(x) (min_t(u32, x, 0xFFFF) << 16) -+#define NDTR11_RES(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR12 0x40 -+#define NDTR12_TWRCK(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR12_RES(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR13 0x44 -+#define NDTR13_TWRHCA(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR13_TRLCA(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR14 0x48 -+#define NDTR14_TWRHCE(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR14_RES(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR15 0x4c -+#define NDTR15_TCDQSS_TWPRE_TDS(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR15_HFTDSC(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR16 0x50 -+#define NDTR16_TWPST_TDH(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR16_TWPSTH(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR17 0x54 -+#define NDTR17_TCS_TRPRE(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR17_TRELDQS(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR18 0x58 -+#define NDTR18_TRPST_TDQSRE(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR18_RES(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDFIFO 0x5c -+#define NDFIFO_REV (min_t(u32, x, 0) << 12) -+#define NDFIFO_FULL BIT(11) -+#define NDFIFO_EMP BIT(10) -+#define NDFIFO_CNT(x) (min_t(u32, x, 0x3F) << 0) -+ -+#define ND_INTERVAL_TIME 0x60 -+#define NDCMD_INTERVAL_TIME 0x64 -+#define NDFIFO_TIMEOUT 0x68 -+#define NDFIFO_LEVEL0 0x6c -+#define NDFIFO_LEVEL1 0x70 -+#define NDWP 0x74 -+#define NDFIFO_CLR 0x78 -+ -+#define NDSR 0x7c -+#define NDSR_BUSY BIT(0) -+#define NDSR_DMA_BUSY BIT(1) -+#define NDSR_DMA_PGFINISH BIT(2) -+#define NDSR_DMA_FINISH BIT(3) -+#define NDSR_FIFO_EMP BIT(4) -+#define NDSR_FIFO_FULL BIT(5) -+#define NDSR_FIFO_TIMEOUT BIT(6) -+#define NDSR_CS(x) (min_t(u32, x, 0xF) << 7) -+#define NDSR_CMD_PGFINISH BIT(11) -+#define NDSR_PG_PGFINISH BIT(12) -+#define NDSR_RE BIT(13) -+#define NDSR_DQS BIT(14) -+#define NDSR_RB BIT(15) -+#define NDSR_ECC_BUSY BIT(16) -+#define NDSR_ECC_FINISH BIT(17) -+#define NDSR_ECC_RIGHT BIT(18) -+#define NDSR_ECC_ERR BIT(19) -+#define NDSR_ECC_ERROVER BIT(20) -+#define NDSR_AXI_DSP_ERR BIT(21) -+#define NDSR_AXI_RD_ERR BIT(22) -+#define NDSR_AXI_WR_ERR BIT(23) -+#define NDSR_RB_STATUS(x) (min_t(u32, x, 0xF) << 24) -+#define NDSR_PROT_ERR BIT(28) -+#define NDSR_ECC_BYPASS BIT(29) -+ -+#define NDIR_MASK 0x80 -+#define NDIR_BUSY_MASK BIT(0) -+#define NDIR_DMA_BUSY_MASK BIT(1) -+#define NDIR_DMA_PGFINISH_MASK BIT(2) -+#define NDIR_DMA_FINISH_MASK BIT(3) -+#define NDIR_FIFO_EMP_MASK BIT(4) -+#define NDIR_FIFO_FULL_MASK BIT(5) -+#define NDIR_FIFO_TIMEOUT_MASK BIT(6) -+#define NDIR_CMD_FINISH_MASK BIT(7) -+#define NDIR_PGFINISH_MASK BIT(8) -+#define NDIR_RE_MASK BIT(9) -+#define NDIR_DQS_MASK BIT(10) -+#define NDIR_RB_MASK BIT(11) -+#define NDIR_ECC_FINISH_MASK BIT(12) -+#define NDIR_ECC_ERR_MASK BIT(13) -+ -+#define NDIR 0x84 -+#define NDIR_ALL_INT(x) GENMASK(x, 0) -+#define NDIR_BUSY BIT(0) -+#define NDIR_DMA_BUSY BIT(1) -+#define NDIR_DMA_PGFINISH BIT(2) -+#define NDIR_DMA_FINISH BIT(3) -+#define NDIR_FIFO_EMP BIT(4) -+#define NDIR_FIFO_FULL BIT(5) -+#define NDIR_FIFO_TIMEOUT BIT(6) -+#define NDIR_CMD_FINISH BIT(7) -+#define NDIR_PGFINISH BIT(8) -+#define NDIR_RE BIT(9) -+#define NDIR_DQS BIT(10) -+#define NDIR_RB BIT(11) -+#define NDIR_ECC_FINISH BIT(12) -+#define NDIR_ECC_ERR BIT(13) -+ -+#define ND_DEBUG 0x88 -+ -+#define ND_ERR_CLR 0x8c -+#define ND_DSP_ERR_CLR BIT(0) -+#define ND_AXI_RD_ERR_CLR BIT(1) -+#define ND_AXI_WR_ERR_CLR BIT(2) -+#define ND_ECC_ERR_CLR BIT(3) -+ -+#define NDCR_PAGE_SZ(x) (x >= 2048 ? BIT(24) : 0) -+ -+enum nand_inter_pro { -+ NAND_ONFI, -+ NAND_JEDEC, -+ NAND_OTHER, -+}; -+ -+enum nand_inter_mode { -+ ASYN_SDR, -+ ONFI_DDR, -+ TOG_ASYN_DDR, -+}; -+ -+enum asy_timing_mode { -+ ASY_MODE0, -+ ASY_MODE1, -+ ASY_MODE2, -+ ASY_MODE3, -+ ASY_MODE4, -+}; -+ -+enum onfi_syn_timing_mode { -+ SYN_MODE0 = 0x10, -+ SYN_MODE1, -+ SYN_MODE2, -+ SYN_MODE3, -+ SYN_MODE4, -+}; -+ -+/** -+ * NAND controller timings expressed in NAND Controller clock cycles -+ * -+ * @tRP: ND_nRE pulse width -+ * @tRH: ND_nRE high duration -+ * @tWP: ND_nWE pulse time -+ * @tWH: ND_nWE high duration -+ * @tCS: Enable signal setup time -+ * @tCH: Enable signal hold time -+ * @tADL: Address to write data delay -+ * @tAR: ND_ALE low to ND_nRE low delay -+ * @tWHR: ND_nWE high to ND_nRE low for status read -+ * @tRHW: ND_nRE high duration, read to write delay -+ * @tR: ND_nWE high to ND_nRE low for read -+ */ -+struct phytium_nfc_timings { -+ u16 tRP; -+ u16 tRH; -+ u16 tWP; /* NDTR1_TWP */ -+ u16 tWH; /* NDTR1_TWH */ -+ u16 tCS; -+ u16 tCH; -+ u16 tADL; -+ u16 tAR; -+ u16 tWHR; -+ u16 tRHW; -+ u16 tR; -+}; -+ -+/** -+ * NAND chip structure: stores NAND chip device related information -+ * -+ * @chip: Base NAND chip structure -+ * @node: Used to store NAND chips into a list -+ * @ndcr: Controller register value for this NAND chip -+ * @ndtr0: Timing registers 0 value for this NAND chip -+ * @ndtr1: Timing registers 1 value for this NAND chip -+ * @selected_die: Current active CS -+ * @nsels: Number of CS lines required by the NAND chip -+ */ -+struct phytium_nand_chip { -+ struct nand_chip chip; -+ struct list_head node; -+ u32 ndcr; -+ u32 ndtr0; -+ u32 ndtr1; -+ int addr_cyc; -+ int selected_die; -+ unsigned int nsels; -+ struct mtd_oob_region ecc; -+}; -+ -+/** -+ * NAND controller capabilities for distinction between compatible strings -+ * -+ * @max_cs_nb: Number of Chip Select lines available -+ * @max_rb_nb: Number of Ready/Busy lines available -+ * @legacy_of_bindings: Indicates if DT parsing must be done using the old -+ * fashion way -+ * @flash_bbt: -+ * @ecc_strength: -+ * @ecc_step_size: -+ * @parts: -+ * @nr_parts: -+ */ -+struct phytium_nfc_caps { -+ unsigned int hw_ver; -+ unsigned int int_mask_bits; -+ unsigned int max_cs_nb; -+ unsigned int max_rb_nb; -+ bool legacy_of_bindings; -+ bool flash_bbt; -+ int ecc_strength; -+ int ecc_step_size; -+ struct mtd_partition *parts; -+ unsigned int nr_parts; -+}; -+ -+/** -+ * NAND controller structure: stores Marvell NAND controller information -+ * -+ * @controller: Base controller structure -+ * @dev: Parent device (used to print error messages) -+ * @regs: NAND controller registers -+ * @reg_clk: Regiters clock -+ * @complete: Completion object to wait for NAND controller events -+ * @chips: List containing all the NAND chips attached to -+ * this NAND controller -+ * @caps: NAND controller capabilities for each compatible string -+ * @dma_buf: 32-bit aligned buffer for DMA transfers (NFCv1 only) -+ */ -+struct phytium_nfc { -+ struct nand_controller controller; -+ struct device *dev; -+ void __iomem *regs; -+ int irq; -+ struct list_head chips; -+ struct nand_chip *selected_chip; -+ struct phytium_nfc_caps *caps; -+ -+ void *dsp_addr; -+ dma_addr_t dsp_phy_addr; -+ -+ void *dma_buf; -+ u32 dma_offset; -+ dma_addr_t dma_phy_addr; -+ -+ enum nand_inter_pro inter_pro; -+ enum nand_inter_mode inter_mode; -+ u32 timing_mode; -+ -+ spinlock_t spinlock; -+}; -+ -+/** -+ * Derives a duration in numbers of clock cycles. -+ * -+ * @ps: Duration in pico-seconds -+ * @period_ns: Clock period in nano-seconds -+ * -+ * Convert the duration in nano-seconds, then divide by the period and -+ * return the number of clock periods. -+ */ -+#define TO_CYCLES(ps, period_ns) (DIV_ROUND_UP(ps / 1000, period_ns)) -+#define TO_CYCLES64(ps, period_ns) (DIV_ROUND_UP_ULL(div_u64(ps, 1000), \ -+ period_ns)) -+ -+struct phytium_nfc_cmd_ctrl { -+ u16 csel:4; -+ u16 dbc:1; -+ u16 addr_cyc:3; -+ u16 nc:1; -+#define TYPE_RESET 0x00 -+#define TYPE_SET_FTR 0x01 -+#define TYPE_GET_FTR 0x02 -+#define TYPE_READ_ID 0x03 -+#define TYPE_PAGE_PRO 0x04 -+#define TYPE_ERASE 0x05 -+#define TYPE_READ 0x06 -+#define TYPE_TOGGLE 0x07 -+#define TYPE_READ_PARAM 0x02 -+#define TYPE_READ_STATUS 0x03 -+#define TYPE_CH_READ_COL 0x03 -+#define TYPE_CH_ROW_ADDR 0x01 -+#define TYPE_CH_WR_COL 0x01 -+ u16 cmd_type:4; -+ u16 dc:1; -+ u16 auto_rs:1; -+ u16 ecc_en:1; -+}; -+ -+/** -+ * NAND driver structure filled during the parsing of the ->exec_op() subop -+ * subset of instructions. -+ * -+ * @cle_ale_delay_ns: Optional delay after the last CMD or ADDR cycle -+ * @rdy_timeout_ms: Timeout for waits on Ready/Busy pin -+ * @rdy_delay_ns: Optional delay after waiting for the RB pin -+ * @data_delay_ns: Optional delay after the data xfer -+ * @data_instr_idx: Index of the data instruction in the subop -+ * @data_instr: Pointer to the data instruction in the subop -+ */ -+struct phytium_nfc_op { -+ u8 cmd[2]; -+ union { -+ u16 ctrl; -+ struct phytium_nfc_cmd_ctrl nfc_ctrl; -+ } cmd_ctrl; -+ u8 addr[PHYTIUM_NFC_ADDR_MAX_LEN]; -+ u16 page_cnt; -+ u8 mem_addr_first[PHYTIUM_NFC_ADDR_MAX_LEN]; -+ -+ u32 cmd_len; -+ u32 addr_len; -+ -+ u32 cle_ale_delay_ns; -+ u32 rdy_timeout_ms; -+ u32 rdy_delay_ns; -+ u32 data_delay_ns; -+ u32 data_instr_idx; -+ struct nand_op_instr *data_instr; -+} __attribute__ ((__packed__)); -+ -+#define TIMING_ASY_NUM 12 -+#define TIMING_SYN_NUM 14 -+#define TIMING_TOG_NUM 12 -+ -+#define TMP_DMA_DEBUG 0 /* Temporary dma space */ -+ -+int phytium_nand_init(struct phytium_nfc *nfc); -+int phytium_nand_remove(struct phytium_nfc *nfc); -+int phytium_nand_prepare(struct phytium_nfc *nfc); -+int phytium_nand_suspend(struct phytium_nfc *nfc); -+int phytium_nand_resume(struct phytium_nfc *nfc); -+ -+irqreturn_t phytium_nfc_isr(int irq, void *dev_id); -+ -+#endif /* NAND_PHYTIUM_NAND_H */ -diff --git a/drivers/mtd/nand/raw/phytium_nand_pci.c b/drivers/mtd/nand/raw/phytium_nand_pci.c -new file mode 100644 -index 000000000..a8f054d66 ---- /dev/null -+++ b/drivers/mtd/nand/raw/phytium_nand_pci.c -@@ -0,0 +1,158 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * PCI driver for Phytium NAND flash controller -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+#include -+#include -+#include -+ -+#include "phytium_nand.h" -+ -+#define DRV_NAME "phytium_nand_pci" -+ -+static struct mtd_partition partition_info[] = { -+ { -+ .name = "Flash partition 1", -+ .offset = 0x0000000, -+ .size = 0x4000000 }, -+ { -+ .name = "Flash partition 2", -+ .offset = 0x4000000, -+ .size = 0x8000000 }, -+ { -+ .name = "Flash partition 3", -+ .offset = 0x8000000, -+ .size = 0x10000000 }, -+ { -+ .name = "Flash partition 4", -+ .offset = 0x10000000, -+ .size = 0x12000000 }, -+ { -+ .name = "Flash partition 5", -+ .offset = 0x12000000, -+ .size = 0x14000000 }, -+}; -+ -+static struct phytium_nfc_caps x100_nfc_caps = { -+ .hw_ver = 1, -+ .int_mask_bits = 13, -+ .max_cs_nb = 2, -+ .max_rb_nb = 1, -+ .legacy_of_bindings = true, -+ .ecc_strength = 4, -+ .ecc_step_size = 512, -+ .nr_parts = 5, -+ .parts = partition_info, -+}; -+ -+static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) -+{ -+ struct phytium_nfc *nfc; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); -+ if (ret) { -+ dev_err(&pdev->dev, "I/O memory remapping failed\n"); -+ return ret; -+ } -+ -+ pci_set_master(pdev); -+ pci_try_set_mwi(pdev); -+ -+ ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); -+ if (ret) -+ return ret; -+ -+ ret = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); -+ if (ret) -+ return ret; -+ -+ nfc = devm_kzalloc(&pdev->dev, sizeof(struct phytium_nfc), -+ GFP_KERNEL); -+ if (!nfc) -+ return -ENOMEM; -+ -+ nfc->dev = &pdev->dev; -+ nfc->regs = pcim_iomap_table(pdev)[0]; -+ nfc->irq = pdev->irq; -+ nfc->caps = &x100_nfc_caps; -+ -+ ret = devm_request_irq(nfc->dev, nfc->irq, phytium_nfc_isr, -+ IRQF_SHARED, "phytium-nfc-pci", nfc); -+ if (ret) { -+ dev_err(nfc->dev, "Failed to register NFC interrupt.\n"); -+ return ret; -+ } -+ -+ ret = phytium_nand_init(nfc); -+ if (ret) -+ return ret; -+ -+ pci_set_drvdata(pdev, nfc); -+ -+ return ret; -+} -+ -+static void phytium_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_nfc *nfc = pci_get_drvdata(pdev); -+ int ret; -+ -+ ret = phytium_nand_remove(nfc); -+ if (ret) -+ dev_warn(&pdev->dev, "can't remove device properly: %d\n", ret); -+} -+ -+static int __maybe_unused phytium_nfc_prepare(struct device *dev) -+{ -+ struct pci_dev *pci = to_pci_dev(dev); -+ struct phytium_nfc *nfc = pci_get_drvdata(pci); -+ int ret; -+ -+ ret = phytium_nand_prepare(nfc); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_nfc_resume(struct device *dev) -+{ -+ struct pci_dev *pci = to_pci_dev(dev); -+ struct phytium_nfc *nfc = pci_get_drvdata(pci); -+ int ret; -+ -+ ret = phytium_nand_resume(nfc); -+ -+ return ret; -+} -+ -+static const struct dev_pm_ops phytium_pci_dev_pm_ops = { -+ .prepare = phytium_nfc_prepare, -+ .resume = phytium_nfc_resume, -+}; -+ -+static const struct pci_device_id phytium_pci_id_table[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc29) }, -+ { } -+}; -+MODULE_DEVICE_TABLE(pci, phytium_pci_id_table); -+ -+static struct pci_driver phytium_pci_driver = { -+ .name = DRV_NAME, -+ .id_table = phytium_pci_id_table, -+ .probe = phytium_pci_probe, -+ .remove = phytium_pci_remove, -+ .driver = { -+ .pm = &phytium_pci_dev_pm_ops, -+ }, -+}; -+module_pci_driver(phytium_pci_driver); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("PCI driver for Phytium NAND controller"); -+MODULE_AUTHOR("Zhu Mingshuai "); -diff --git a/drivers/mtd/nand/raw/phytium_nand_plat.c b/drivers/mtd/nand/raw/phytium_nand_plat.c -new file mode 100644 -index 000000000..65504785f ---- /dev/null -+++ b/drivers/mtd/nand/raw/phytium_nand_plat.c -@@ -0,0 +1,138 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Core driver for Phytium NAND flash controller -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "phytium_nand.h" -+ -+#define DRV_NAME "phytium_nand_plat" -+ -+static int phytium_nfc_plat_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct resource *r; -+ struct phytium_nfc *nfc; -+ unsigned int ecc_strength; -+ unsigned int ecc_step_size; -+ int ret; -+ -+ nfc = devm_kzalloc(&pdev->dev, sizeof(struct phytium_nfc), -+ GFP_KERNEL); -+ if (!nfc) -+ return -ENOMEM; -+ -+ nfc->dev = dev; -+ -+ r = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ nfc->regs = devm_ioremap_resource(dev, r); -+ if (IS_ERR(nfc->regs)) -+ return PTR_ERR(nfc->regs); -+ -+ dev_info(nfc->dev, "NFC register address :%p, phy address:%llx\n", -+ nfc->regs, r->start); -+ -+ nfc->irq = platform_get_irq(pdev, 0); -+ if (nfc->irq < 0) { -+ dev_err(dev, "failed to retrieve irq\n"); -+ return nfc->irq; -+ } -+ -+ ret = devm_request_irq(dev, nfc->irq, phytium_nfc_isr, 0, -+ "phytium-nfc-plat", nfc); -+ if (ret) { -+ dev_err(nfc->dev, "Failed to register NFC interrupt.\n"); -+ return ret; -+ } -+ -+ nfc->caps = devm_kzalloc(dev, sizeof(struct phytium_nfc_caps), GFP_KERNEL); -+ if (!nfc->caps) -+ return -ENOMEM; -+ -+ /* Currently hard-coded parameters */ -+ nfc->caps->hw_ver = 2; -+ nfc->caps->int_mask_bits = 17; -+ nfc->caps->max_cs_nb = 4; -+ nfc->caps->max_rb_nb = 4; -+ nfc->caps->nr_parts = 0; -+ nfc->caps->parts = NULL; -+ -+ device_property_read_u32(&pdev->dev, "nand-ecc-strength", &ecc_strength); -+ nfc->caps->ecc_strength = ecc_strength ? ecc_strength : 8; -+ -+ device_property_read_u32(&pdev->dev, "nand-ecc-step-size", &ecc_step_size); -+ nfc->caps->ecc_step_size = ecc_step_size ? ecc_step_size : 512; -+ -+ ret = phytium_nand_init(nfc); -+ if (ret) -+ return ret; -+ -+ platform_set_drvdata(pdev, nfc); -+ -+ return ret; -+} -+ -+static int phytium_nfc_plat_remove(struct platform_device *pdev) -+{ -+ struct phytium_nfc *nfc = platform_get_drvdata(pdev); -+ -+ return phytium_nand_remove(nfc); -+} -+ -+static int __maybe_unused phytium_nfc_plat_prepare(struct device *dev) -+{ -+ struct phytium_nfc *nfc = dev_get_drvdata(dev); -+ -+ return phytium_nand_prepare(nfc); -+} -+ -+static int __maybe_unused phytium_nfc_plat_resume(struct device *dev) -+{ -+ struct phytium_nfc *nfc = dev_get_drvdata(dev); -+ int ret; -+ -+ ret = phytium_nand_resume(nfc); -+ -+ return ret; -+} -+ -+static const struct dev_pm_ops phytium_dev_pm_ops = { -+ .prepare = phytium_nfc_plat_prepare, -+ .resume = phytium_nfc_plat_resume, -+}; -+ -+#ifdef CONFIG_OF -+static const struct of_device_id phytium_nfc_of_ids[] = { -+ { .compatible = "phytium,nfc", }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(of, phytium_nfc_of_ids); -+#endif -+ -+static struct platform_driver phytium_nfc_plat_driver = { -+ .driver = { -+ .name = DRV_NAME, -+ .of_match_table = phytium_nfc_of_ids, -+ .pm = &phytium_dev_pm_ops, -+ }, -+ .probe = phytium_nfc_plat_probe, -+ .remove = phytium_nfc_plat_remove, -+}; -+module_platform_driver(phytium_nfc_plat_driver) -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium NAND controller Platform driver"); -+MODULE_AUTHOR("Zhu Mingshuai "); -diff --git a/drivers/mtd/spi-nor/Makefile b/drivers/mtd/spi-nor/Makefile -index 653923896..ca91ca6b9 100644 ---- a/drivers/mtd/spi-nor/Makefile -+++ b/drivers/mtd/spi-nor/Makefile -@@ -17,6 +17,7 @@ spi-nor-objs += sst.o - spi-nor-objs += winbond.o - spi-nor-objs += xilinx.o - spi-nor-objs += xmc.o -+spi-nor-objs += boya.o - obj-$(CONFIG_MTD_SPI_NOR) += spi-nor.o - - obj-$(CONFIG_MTD_SPI_NOR) += controllers/ -diff --git a/drivers/mtd/spi-nor/boya.c b/drivers/mtd/spi-nor/boya.c -new file mode 100644 -index 000000000..db8c0c218 ---- /dev/null -+++ b/drivers/mtd/spi-nor/boya.c -@@ -0,0 +1,21 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (C) 2005, Intec Automation Inc. -+ * Copyright (C) 2014, Freescale Semiconductor, Inc. -+ */ -+ -+#include -+ -+#include "core.h" -+ -+static const struct flash_info boya_parts[] = { -+ /* Boya Microelectronics Memory Series */ -+ { "by25q64as", INFO(0x684017, 0, 64 * 1024, 128, SECT_4K) }, -+ { "by25q128as", INFO(0x684018, 0, 64 * 1024, 256, SECT_4K) }, -+}; -+ -+const struct spi_nor_manufacturer spi_nor_boya = { -+ .name = "boya", -+ .parts = boya_parts, -+ .nparts = ARRAY_SIZE(boya_parts), -+}; -diff --git a/drivers/mtd/spi-nor/controllers/Kconfig b/drivers/mtd/spi-nor/controllers/Kconfig -index 5c0e0ec2e..5bfc72f71 100644 ---- a/drivers/mtd/spi-nor/controllers/Kconfig -+++ b/drivers/mtd/spi-nor/controllers/Kconfig -@@ -62,3 +62,12 @@ config SPI_INTEL_SPI_PLATFORM - - To compile this driver as a module, choose M here: the module - will be called intel-spi-platform. -+ -+config SPI_PHYTIUM_QUADSPI -+ tristate "Phytium Quad SPI Controller" -+ depends on ARCH_PHYTIUM || ARM -+ depends on OF && HAS_IOMEM -+ help -+ This enables support for the Quad SPI controller in master mode. -+ This driver does not support generic SPI. The implementation only -+ supports SPI NOR. -diff --git a/drivers/mtd/spi-nor/controllers/Makefile b/drivers/mtd/spi-nor/controllers/Makefile -index e7abba491..a83cf25ce 100644 ---- a/drivers/mtd/spi-nor/controllers/Makefile -+++ b/drivers/mtd/spi-nor/controllers/Makefile -@@ -5,3 +5,4 @@ obj-$(CONFIG_SPI_NXP_SPIFI) += nxp-spifi.o - obj-$(CONFIG_SPI_INTEL_SPI) += intel-spi.o - obj-$(CONFIG_SPI_INTEL_SPI_PCI) += intel-spi-pci.o - obj-$(CONFIG_SPI_INTEL_SPI_PLATFORM) += intel-spi-platform.o -+obj-$(CONFIG_SPI_PHYTIUM_QUADSPI) += phytium-quadspi.o -diff --git a/drivers/mtd/spi-nor/controllers/phytium-quadspi.c b/drivers/mtd/spi-nor/controllers/phytium-quadspi.c -new file mode 100644 -index 000000000..267590aaa ---- /dev/null -+++ b/drivers/mtd/spi-nor/controllers/phytium-quadspi.c -@@ -0,0 +1,1024 @@ -+/* -+ * Phytium SPI core controller driver. -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms and conditions of the GNU General Public License, -+ * version 2, as published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope it will be useful, but WITHOUT -+ * 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 -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define QSPI_FLASH_CAP_REG 0x000 -+#define QSPI_RD_CFG_REG 0x004 -+#define QSPI_WR_CFG_REG 0x008 -+#define QSPI_FLUSH_REG 0x00C -+#define QSPI_CMD_PORT_REG 0x010 -+#define QSPI_ADDR_PORT_REG 0x014 -+#define QSPI_HD_PORT_REG 0x018 -+#define QSPI_LD_PORT_REG 0x01C -+#define QSPI_FUN_SET_REG 0x020 -+#define QSPI_WIP_REG 0x024 -+#define QSPI_WP_REG 0x028 -+#define QSPI_MODE_REG 0x02C -+ -+#define QSPI_FLASH_CAP_NUM_SHIFT 3 -+#define QSPI_FLASH_CAP_NUM_MASK (0x3 << QSPI_FLASH_CAP_NUM_SHIFT) -+#define QSPI_FLASH_CAP_CAP_SHIFT 0 -+#define QSPI_FLASH_CAP_CAP_MASK (0x7 << QSPI_FLASH_CAP_CAP_SHIFT) -+ -+#define QSPI_RD_CFG_RD_CMD_SHIFT 24 -+#define QSPI_RD_CFG_RD_CMD_MASK (0xFF << QSPI_RD_CFG_RD_CMD_SHIFT) -+#define QSPI_RD_CFG_RD_THROUGH_SHIFT 23 -+#define QSPI_RD_CFG_RD_THROUGH_MASK (0x01 << QSPI_RD_CFG_RD_THROUGH_SHIFT) -+#define QSPI_RD_CFG_RD_TRANSFER_SHIFT 20 -+#define QSPI_RD_CFG_RD_TRANSFER_MASK (0x07 << QSPI_RD_CFG_RD_TRANSFER_SHIFT) -+#define QSPI_RD_CFG_RD_ADDR_SEL_SHIFT 19 -+#define QSPI_RD_CFG_RD_ADDR_SEL_MASK (0x1 << QSPI_RD_CFG_RD_ADDR_SEL_SHIFT) -+#define QSPI_RD_CFG_RD_LATENCY_SHIFT 18 -+#define QSPI_RD_CFG_RD_LATENCY_MASK (0x1 << QSPI_RD_CFG_RD_LATENCY_SHIFT) -+#define QSPI_RD_CFG_MODE_BYTE_SHIFT 17 -+#define QSPI_RD_CFG_MODE_BYTE_MASK (0x1 << QSPI_RD_CFG_MODE_BYTE_SHIFT) -+#define QSPI_RD_CFG_CMD_SIGN_SHIFT 9 -+#define QSPI_RD_CFG_CMD_SIGN_MASK (0xFF << QSPI_RD_CFG_CMD_SIGN_SHIFT) -+#define QSPI_RD_CFG_DUMMY_SHIFT 4 -+#define QSPI_RD_CFG_DUMMY_MASK (0x1F << QSPI_RD_CFG_DUMMY_SHIFT) -+#define QSPI_RD_CFG_D_BUFFER_SHIFT 3 -+#define QSPI_RD_CFG_D_BUFFER_MASK (0x1 << QSPI_RD_CFG_D_BUFFER_SHIFT) -+#define QSPI_RD_CFG_RD_SCK_SEL_SHIFT 0 -+#define QSPI_RD_CFG_RD_SCK_SEL_MASK (0x3 << QSPI_RD_CFG_RD_SCK_SEL_SHIFT) -+ -+#define QSPI_WR_CFG_WR_CMD_SHIFT 24 -+#define QSPI_WR_CFG_WR_CMD_MASK (0xFF << QSPI_WR_CFG_WR_CMD_SHIFT) -+#define QSPI_WR_CFG_WR_WAIT_SHIFT 9 -+#define QSPI_WR_CFG_WR_WAIT_MASK (0x01 << QSPI_WR_CFG_WR_WAIT_SHIFT) -+#define QSPI_WR_CFG_WR_THROUGH_SHIFT 8 -+#define QSPI_WR_CFG_WR_THROUGH_MAS (0x01 << QSPI_WR_CFG_WR_THROUGH_SHIFT) -+#define QSPI_WR_CFG_WR_TRANSFER_SHIFT 5 -+#define QSPI_WR_CFG_WR_TRANSFER_MASK (0X7 << QSPI_WR_CFG_WR_TRANSFER_SHIFT) -+#define QSPI_WR_CFG_WR_ADDR_SEL_SHIFT 4 -+#define QSPI_WR_CFG_WR_ADDR_SEL_MASK (0x1 << QSPI_WR_CFG_WR_ADDR_SEL_SHIFT) -+#define QSPI_WR_CFG_WR_MODE_SHIFT 3 -+#define QSPI_WR_CFG_WR_MODE (0x01 << QSPI_WR_CFG_WR_MODE_SHIFT) -+#define QSPI_WR_CFG_WR_SCK_SEL_SHIFT 0 -+#define QSPI_WR_CFG_WR_SCK_SEL_MASK (0x7 << QSPI_WR_CFG_WR_SCK_SEL_SHIFT) -+ -+#define QSPI_FLUSH_EN (0x1 << 0) -+ -+#define QSPI_CMD_PORT_CMD_SHIFT 24 -+#define QSPI_CMD_PORT_CMD_MASK (0xFF << QSPI_CMD_PORT_CMD_SHIFT) -+#define QSPI_CMD_PORT_WAIT_SHIFT 22 -+#define QSPI_CMD_PORT_WAIT_MASK (0x1 << QSPI_CMD_PORT_WAIT_SHIFT) -+#define QSPI_CMD_PORT_THROUGH_SHIFT 21 -+#define QSPI_CMD_PORT_THROUGH_MASK (0x1 << QSPI_CMD_PORT_THROUGH_SHIFT) -+#define QSPI_CMD_PORT_CS_SHIFT 19 -+#define QSPI_CMD_PORT_CS_MASK (0x3 << QSPI_CMD_PORT_CS_SHIFT) -+#define QSPI_CMD_PORT_TRANSFER_SHIFT 16 -+#define QSPI_CMD_PORT_TRANSFER_MASK (0x7 << QSPI_CMD_PORT_TRANSFER_SHIFT) -+#define QSPI_CMD_PORT_CMD_ADDR_SHIFT 15 -+#define QSPI_CMD_PORT_CMD_ADDR_MASK (0x1 << QSPI_CMD_PORT_CMD_ADDR_SHIFT) -+#define QSPI_CMD_PORT_LATENCY_SHIFT 14 -+#define QSPI_CMD_PORT_LATENCY_MASK (0x1 << QSPI_CMD_PORT_LATENCY_SHIFT) -+#define QSPI_CMD_PORT_DATA_TRANSFER_SHIFT 13 -+#define QSPI_CMD_PORT_DATA_TRANSFER_MASK (0x1 << 13) -+#define QSPI_CMD_PORT_SEL_SHIFT 12 -+#define QSPI_CMD_PORT_SEL_MASK (0x1 << QSPI_CMD_PORT_SEL_SHIFT) -+#define QSPI_CMD_PORT_DUMMY_SHIFT 7 -+#define QSPI_CMD_PORT_DUMMY_MASK (0x1F << QSPI_CMD_PORT_DUMMY_SHIFT) -+#define QSPI_CMD_PORT_DUMMY(x) (((x) << QSPI_CMD_PORT_DUMMY_SHIFT) & QSPI_CMD_PORT_DUMMY_MASK) -+#define QSPI_CMD_PORT_P_BUFFER_SHIFT 6 -+#define QSPI_CMD_PORT_P_BUFFER_MASK (0x1 << QSPI_CMD_PORT_P_BUFFER_SHIFT) -+#define QSPI_CMD_PORT_RW_NUM_SHIFT 3 -+#define QSPI_CMD_PORT_RW_NUM_MASK (0x7 << QSPI_CMD_PORT_RW_NUM_SHIFT) -+#define QSPI_CMD_PORT_SCK_SEL_SHIFT 0 -+#define QSPI_CMD_PORT_SCK_SEL_MASK (0x7 << QSPI_CMD_PORT_SCK_SEL_SHIFT) -+ -+#define QSPI_FUN_SET_HOLD_SHIFT 24 -+#define QSPI_FUN_SET_HOLD_MASK (0xFF << QSPI_FUN_SET_HOLD_SHIFT) -+#define QSPI_FUN_SET_SETUP_SHIFT 16 -+#define QSPI_FUN_SET_SETUP_MASK (0xFF << QSPI_FUN_SET_SETUP_SHIFT) -+#define QSPI_FUN_SET_DELAY_SHIFT 0 -+#define QSPI_FUN_SET_DELAY_MASK (0xFFFF << QSPI_FUN_SET_DELAY_SHIFT) -+ -+#define QSPI_WIP_W_CMD_SHIFT 24 -+#define QSPI_WIP_W_CMD_MASK (0xFF << QSPI_WIP_W_CMD_SHIFT) -+#define QSPI_WIP_W_TRANSFER_SHIFT 3 -+#define QSPI_WIP_W_TRANSFER_MASK (0x3 << QSPI_WIP_W_TRANSFER_SHIFT) -+#define QSPI_WIP_W_SCK_SEL_SHIFT 0 -+#define QSPI_WIP_W_SCK_SEL_MASK (0x7 << QSPI_WIP_W_SCK_SEL_SHIFT) -+ -+#define QSPI_WP_EN_SHIFT 17 -+#define QSPI_WP_EN_MASK (0x1 << QSPI_WP_EN_SHIFT) -+#define QSPI_WP_IO2_SHIFT 16 -+#define QSPI_WP_IO2_MASK (0x1 << QSPI_WP_IO2_SHIFT) -+#define QSPI_WP_HOLD_SHIFT 8 -+#define QSPI_WP_HOLD_MASK (0xFF << QSPI_WP_HOLD_SHIFT) -+#define QSPI_WP_SETUP_SHIFT 0 -+#define QSPI_WP_SETUP_MASK (0xFF << QSPI_WP_SETUP_SHIFT) -+ -+#define QSPI_MODE_VALID_SHIFT 8 -+#define QSPI_MODE_VALID_MASK (0xFF << QSPI_MODE_VALID_SHIFT) -+#define QSPI_MODE_SHIFT 0 -+#define QSPI_MODE_MASK (0xFF << QSPI_MODE_SHIFT) -+ -+#define FSIZE_VAL(size) (__fls(size) - 1) -+ -+#define PHYTIUM_MAX_MMAP_S SZ_512M -+#define PHYTIUM_MAX_NORCHIP 4 -+ -+#define PHYTIUM_QSPI_FIFO_SZ 32 -+#define PHYTIUM_QSPI_FIFO_TIMEOUT_US 50000 -+#define PHYTIUM_QSPI_BUSY_TIMEOUT_US 100000 -+ -+#define PHYTIUM_SCK_SEL 0x05 -+#define PHYTIUM_CMD_SCK_SEL 0x07 -+ -+#define PHYTIUM_FMODE_MM 0x01 -+#define PHYTIUM_FMODE_IN 0x02 -+ -+/* -+ * the codes of the different commands -+ */ -+#define CMD_WRDI 0x04 -+#define CMD_RDID 0x9F -+#define CMD_RDSR 0x05 -+#define CMD_WREN 0x06 -+#define CMD_RDAR 0x65 -+#define CMD_P4E 0x20 -+#define CMD_4P4E 0x21 -+#define CMD_BE 0x60 -+#define CMD_4BE 0xC7 -+#define CMD_READ 0x03 -+#define CMD_FAST_READ 0x0B -+#define CMD_QOR 0x6B -+#define CMD_QIOR 0xEB -+#define CMD_DDRFR 0x0D -+#define CMD_DDRQIOQ 0xED -+#define CMD_PP 0x02 -+#define CMD_QPP 0x32 -+#define CMD_SE 0xD8 -+#define CMD_4FAST_READ 0x0C -+#define CMD_4READ 0x13 -+#define CMD_4QOR 0x6C -+#define CMD_4QIOR 0xEC -+#define CMD_4DDRFR 0x0E -+#define CMD_4DDRQIOR 0xEE -+#define CMD_4PP 0x12 -+#define CMD_4QPP 0x34 -+#define CMD_4SE 0xDC -+ -+#define PHYTIUM_QSPI_1_1_1 0 -+#define PHYTIUM_QSPI_1_1_2 1 -+#define PHYTIUM_QSPI_1_1_4 2 -+#define PHYTIUM_QSPI_1_2_2 3 -+#define PHYTIUM_QSPI_1_4_4 4 -+#define PHYTIUM_QSPI_2_2_2 5 -+#define PHYTIUM_QSPI_4_4_4 6 -+ -+struct phytium_qspi_flash { -+ struct spi_nor nor; -+ struct phytium_qspi *qspi; -+ u32 cs; -+ u32 fsize; -+ u32 presc; -+ u32 clk_div; -+ u32 read_mode; -+ bool registered; -+ u32 prefetch_limit; -+ u32 addr_width; -+ u32 read_cmd; -+}; -+ -+struct phytium_qspi { -+ struct device *dev; -+ void __iomem *io_base; -+ void __iomem *mm_base; -+ resource_size_t mm_size; -+ u32 nor_num; -+ struct clk *clk; -+ u32 clk_rate; -+ struct phytium_qspi_flash flash[PHYTIUM_MAX_NORCHIP]; -+ -+ spinlock_t spinlock; -+ -+ /* -+ * to protect device configuration, could be different between -+ * 2 flash access (bk1, bk2) -+ */ -+ struct mutex lock; -+}; -+ -+/* Need to enable p_buffer */ -+static int memcpy_from_ftreg(struct phytium_qspi *qspi, u_char *buf, size_t len) -+{ -+ int i; -+ u32 val = 0; -+ -+ if (!qspi || !buf) -+ return -EINVAL; -+ -+ for (i = 0; i < len; i++) { -+ if (0 == i % 4) -+ val = readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); -+ -+ buf[i] = (u_char) (val >> (i % 4) * 8) & 0xFF; -+ } -+ -+ return 0; -+} -+ -+/* Not to enable p_buffer */ -+static int memcpy_to_ftreg(struct phytium_qspi *qspi, const u8 *buf, size_t len) -+{ -+ u32 val = 0; -+ -+ if (!qspi || !buf || (len >= 8)) -+ return -EINVAL; -+ -+ if (1 == len) { -+ val = buf[0]; -+ } else if (2 == len) { -+ val = buf[1]; -+ val = (val << 8) + buf[0]; -+ } else if (3 == len) { -+ val = buf[2]; -+ val = (val << 8) + buf[1]; -+ val = (val << 8) + buf[0]; -+ } else if (4 == len) { -+ val = buf[3]; -+ val = (val << 8) + buf[2]; -+ val = (val << 8) + buf[1]; -+ val = (val << 8) + buf[0]; -+ } -+ -+ writel_relaxed(val, qspi->io_base + QSPI_LD_PORT_REG); -+ -+ return 0; -+} -+ -+static int phytium_qspi_wait_cmd(struct phytium_qspi *qspi, -+ struct phytium_qspi_flash *flash) -+{ -+ u32 cmd = 0; -+ u32 cnt = 0; -+ -+ cmd |= CMD_RDSR << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ -+ cnt = PHYTIUM_QSPI_BUSY_TIMEOUT_US / 10; -+ while (readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG) & 0x01) { -+ udelay(10); -+ cnt--; -+ if (!cnt) { -+ dev_err(qspi->dev, "wait command process timeout\n"); -+ break; -+ } -+ } -+ -+ return !cnt; -+} -+ -+static int phytium_qspi_cmd_enable(struct phytium_qspi *qspi) -+{ -+ u32 val = 0; -+ -+ writel_relaxed(val, qspi->io_base + QSPI_LD_PORT_REG); -+ -+ return 0; -+} -+ -+static int phytium_qspi_write_enable(struct phytium_qspi *qspi, -+ struct phytium_qspi_flash *flash) -+{ -+ u32 cmd = 0; -+ -+ cmd = CMD_WREN << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ phytium_qspi_cmd_enable(qspi); -+ -+ return 0; -+} -+ -+static int phytium_qspi_write_disable(struct phytium_qspi *qspi, -+ struct phytium_qspi_flash *flash) -+{ -+ u32 cmd = 0; -+ -+ cmd = CMD_WRDI << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ phytium_qspi_cmd_enable(qspi); -+ -+ return 0; -+} -+ -+static int phytium_qspi_read_flash_id(struct phytium_qspi *qspi, -+ struct phytium_qspi_flash *flash, u8 opcode, u8 *buf, int len) -+{ -+ u32 cmd = 0; -+ unsigned long iflags; -+ -+ cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); -+ cmd |= BIT(QSPI_CMD_PORT_P_BUFFER_SHIFT); -+ cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ phytium_qspi_cmd_enable(qspi); -+ -+ spin_lock_irqsave(&qspi->spinlock, iflags); -+ memcpy_from_ftreg(qspi, buf, len); -+ spin_unlock_irqrestore(&qspi->spinlock, iflags); -+ -+ dev_dbg(qspi->dev, "read flash id:%x\n", *(u32 *)buf); -+ return 0; -+} -+ -+static int phytium_qspi_read_flash_sfdp(struct phytium_qspi *qspi, -+ struct phytium_qspi_flash *flash, struct spi_nor *nor, loff_t from, u8 *buf, int len) -+{ -+ unsigned long iflags; -+ u32 cmd = 0; -+ u8 opcode = nor->read_opcode; -+ -+ cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); -+ cmd |= BIT(QSPI_CMD_PORT_P_BUFFER_SHIFT); -+ cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); -+ cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ cmd |= BIT(QSPI_CMD_PORT_LATENCY_SHIFT); -+ cmd |= QSPI_CMD_PORT_DUMMY(nor->read_dummy - 1); -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ writel_relaxed(from, qspi->io_base + QSPI_ADDR_PORT_REG); -+ phytium_qspi_cmd_enable(qspi); -+ -+ spin_lock_irqsave(&qspi->spinlock, iflags); -+ memcpy_from_ftreg(qspi, buf, len); -+ spin_unlock_irqrestore(&qspi->spinlock, iflags); -+ -+ dev_dbg(qspi->dev, "read flash sfdp:0x%llx 0x%llx\n", -+ *(u64 *)buf, *(u64 *)(buf + 8)); -+ return len; -+} -+ -+static int phytium_qspi_read_flash_sr1(struct phytium_qspi *qspi, -+ struct phytium_qspi_flash *flash, u8 opcode, u8 *buf, int len) -+{ -+ u32 cmd = 0; -+ u32 val; -+ -+ cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); -+ cmd |= (len << QSPI_CMD_PORT_RW_NUM_SHIFT) & QSPI_CMD_PORT_RW_NUM_MASK; -+ cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ phytium_qspi_cmd_enable(qspi); -+ -+ val = readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); -+ buf[0] = (u8)val; -+ -+ return 0; -+} -+ -+static int phytium_qspi_read_reg(struct spi_nor *nor, u8 opcode, u8 *buf, size_t len) -+{ -+ struct phytium_qspi_flash *flash = nor->priv; -+ struct device *dev = flash->qspi->dev; -+ struct phytium_qspi *qspi = flash->qspi; -+ unsigned long iflags; -+ u32 cmd = 0; -+ -+ dev_dbg(dev, "read_reg: cmd:%#.2x buf:%pK len:%#lx\n", opcode, buf, len); -+ -+ switch (opcode) { -+ case CMD_RDID: -+ phytium_qspi_read_flash_id(qspi, flash, opcode, buf, len); -+ return 0; -+ case CMD_RDSR: -+ phytium_qspi_read_flash_sr1(qspi, flash, opcode, buf, len); -+ return 0; -+ default: -+ break; -+ } -+ -+ cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); -+ cmd |= BIT(QSPI_CMD_PORT_P_BUFFER_SHIFT); -+ cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ phytium_qspi_cmd_enable(qspi); -+ -+ spin_lock_irqsave(&qspi->spinlock, iflags); -+ memcpy_from_ftreg(qspi, buf, len); -+ spin_unlock_irqrestore(&qspi->spinlock, iflags); -+ -+ return 0; -+} -+ -+static int phytium_qspi_write_reg(struct spi_nor *nor, u8 opcode, const u8 *buf, size_t len) -+{ -+ struct phytium_qspi_flash *flash = nor->priv; -+ struct device *dev = flash->qspi->dev; -+ struct phytium_qspi *qspi = flash->qspi; -+ u32 cmd = 0; -+ -+ dev_dbg(dev, "write_reg: cmd:%#.2x buf:%pK len:%#lx\n", opcode, buf, len); -+ -+ switch (opcode) { -+ case CMD_WREN: -+ phytium_qspi_write_enable(qspi, flash); -+ return 0; -+ case CMD_WRDI: -+ phytium_qspi_write_disable(qspi, flash); -+ return 0; -+ default: -+ break; -+ } -+ -+ cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ if ((len > 8) || (NULL == buf)) { -+ dev_err(dev, "data length exceed. commad %x, len:%ld \n", opcode, len); -+ return -EINVAL; -+ } else if (len > 0) { -+ cmd |= ((len - 1) << QSPI_CMD_PORT_RW_NUM_SHIFT) & QSPI_CMD_PORT_RW_NUM_MASK; -+ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); -+ } -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ memcpy_to_ftreg(qspi, buf, len); -+ -+ return 0; -+} -+ -+static ssize_t phytium_qspi_read_tmp(struct phytium_qspi *qspi, u32 read_cmd, loff_t from, size_t len, u_char *buf) -+{ -+ u32 addr = (u32)from; -+ u64 val = 0; -+ -+ if (!qspi) -+ return -1; -+ -+ dev_dbg(qspi->dev, "read cmd:%x, addr:%x len:%zx\n", read_cmd, addr, len); -+ writel_relaxed(read_cmd, qspi->io_base + QSPI_RD_CFG_REG); -+ -+ memcpy_fromio(buf, qspi->mm_base + addr, len); -+ -+ val = *(u64 *)(buf); -+ dev_dbg(qspi->dev, "read val:%llx\n", val); -+ -+ return len; -+} -+ -+static ssize_t phytium_qspi_read(struct spi_nor *nor, loff_t from, size_t len, u8 *buf) -+{ -+ struct phytium_qspi_flash *flash = nor->priv; -+ struct phytium_qspi *qspi = flash->qspi; -+ u32 cmd = nor->read_opcode; -+ u32 addr = (u32)from; -+ -+ addr = addr + flash->cs * flash->fsize; -+ -+ dev_dbg(qspi->dev, "read(%#.2x): buf:%pK from:%#.8x len:%#zx\n", nor->read_opcode, buf, addr, len); -+ -+ cmd = cmd << QSPI_RD_CFG_RD_CMD_SHIFT; -+ cmd |= BIT(QSPI_RD_CFG_D_BUFFER_SHIFT); -+ cmd |= flash->clk_div << QSPI_CMD_PORT_SCK_SEL_SHIFT; -+ -+ cmd &= ~QSPI_RD_CFG_RD_TRANSFER_MASK; -+ cmd |= (flash->addr_width << QSPI_RD_CFG_RD_TRANSFER_SHIFT); -+ -+ switch (nor->read_opcode) { -+ case CMD_READ: -+ case CMD_FAST_READ: -+ case CMD_QIOR: -+ case CMD_QOR: -+ cmd &= ~QSPI_RD_CFG_RD_ADDR_SEL_MASK; -+ break; -+ case CMD_4READ: -+ case CMD_4FAST_READ: -+ case CMD_4QOR: -+ case CMD_4QIOR: -+ cmd |= BIT(QSPI_RD_CFG_RD_ADDR_SEL_SHIFT); -+ break; -+ case 0x5A: -+ cmd &= ~QSPI_RD_CFG_RD_ADDR_SEL_MASK; -+ return phytium_qspi_read_flash_sfdp(qspi, flash, nor, from, buf, len); -+ break; -+ default: -+ break; -+ } -+ -+ if ((PHYTIUM_QSPI_1_1_4 == flash->addr_width) || (PHYTIUM_QSPI_1_4_4 == flash->addr_width)) { -+ cmd |= BIT(QSPI_RD_CFG_RD_LATENCY_SHIFT); -+ cmd &= ~QSPI_RD_CFG_DUMMY_MASK; -+ cmd |= (0x07 << QSPI_RD_CFG_DUMMY_SHIFT); -+ } -+ -+ dev_dbg(qspi->dev, "read(%#.2x): cmd:%#x\n", nor->read_opcode, cmd); -+ -+ if (cmd != flash->read_cmd) -+ flash->read_cmd = cmd; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_RD_CFG_REG); -+ -+ memcpy_fromio(buf, qspi->mm_base + addr, len); -+ -+ return len; -+} -+ -+static ssize_t phytium_qspi_write(struct spi_nor *nor, loff_t to, size_t len, const u8 *buf) -+{ -+ struct phytium_qspi_flash *flash = nor->priv; -+ struct device *dev = flash->qspi->dev; -+ struct phytium_qspi *qspi = flash->qspi; -+ u32 cmd = nor->program_opcode; -+ u32 addr = (u32)to; -+ int i; -+ u_char tmp[8] = {0}; -+ size_t mask = 0x03; -+ -+ addr = addr + flash->cs * flash->fsize; -+ -+ dev_dbg(dev, "write(%#.2x): buf:%p to:%#.8x len:%#zx\n", nor->program_opcode, buf, addr, len); -+ -+ if (addr & 0x03) { -+ dev_err(dev, "Addr not four-byte aligned!\n"); -+ return -EINVAL; -+ } -+ -+ cmd = cmd << QSPI_WR_CFG_WR_CMD_SHIFT; -+ cmd |= BIT(QSPI_WR_CFG_WR_MODE_SHIFT); -+ cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; -+ -+ switch (nor->program_opcode) { -+ case CMD_PP: -+ case CMD_QPP: -+ cmd &= ~QSPI_WR_CFG_WR_ADDR_SEL_MASK; -+ break; -+ case CMD_4PP: -+ case CMD_4QPP: -+ cmd |= BIT(QSPI_WR_CFG_WR_ADDR_SEL_SHIFT); -+ break; -+ default: -+ dev_err(qspi->dev, "Not support program command:%#x\n", nor->erase_opcode); -+ return -EINVAL; -+ } -+ -+ dev_dbg(qspi->dev, "write cmd:%x\n", cmd); -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_WR_CFG_REG); -+ -+ for (i = 0; i < len/4; i++) -+ writel_relaxed(*(u32 *)(buf + 4*i), qspi->mm_base + addr + 4*i); -+ -+ if (len & mask) { -+ addr = addr + (len & ~mask); -+ phytium_qspi_read_tmp(qspi, flash->read_cmd, addr, 4, &tmp[0]); -+ memcpy(tmp, buf + (len & ~mask), len & mask); -+ writel_relaxed(*(u32 *)(tmp), qspi->mm_base + addr); -+ } -+ -+ writel_relaxed(QSPI_FLUSH_EN, qspi->io_base + QSPI_FLUSH_REG); -+ -+ phytium_qspi_wait_cmd(qspi, flash); -+ -+ return len; -+} -+ -+static int phytium_qspi_erase(struct spi_nor *nor, loff_t offs) -+{ -+ struct phytium_qspi_flash *flash = nor->priv; -+ struct device *dev = flash->qspi->dev; -+ struct phytium_qspi *qspi = flash->qspi; -+ u32 cmd = nor->erase_opcode; -+ u32 addr = (u32)offs; -+ -+ dev_dbg(dev, "erase(%#.2x):offs:%#x\n", nor->erase_opcode, (u32)offs); -+ -+ phytium_qspi_write_enable(qspi, flash); -+ -+ cmd = cmd << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ /* s25fl256s1 not supoort D8, DC, 20, 21 */ -+ switch (nor->erase_opcode) { -+ case CMD_SE: -+ cmd &= ~QSPI_CMD_PORT_SEL_MASK; -+ cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); -+ writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); -+ break; -+ case CMD_4SE: -+ cmd |= BIT(QSPI_CMD_PORT_SEL_SHIFT); -+ cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); -+ writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); -+ break; -+ case CMD_P4E: -+ cmd &= ~QSPI_CMD_PORT_SEL_MASK; -+ cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); -+ writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); -+ break; -+ case CMD_4P4E: -+ cmd |= BIT(QSPI_CMD_PORT_SEL_SHIFT); -+ cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); -+ writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); -+ break; -+ case CMD_BE: -+ cmd &= ~QSPI_CMD_PORT_SEL_MASK; -+ break; -+ case CMD_4BE: -+ cmd |= BIT(QSPI_CMD_PORT_SEL_SHIFT); -+ break; -+ default: -+ dev_err(qspi->dev, "Not support erase command:%#x\n", nor->erase_opcode); -+ return -EINVAL; -+ } -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ phytium_qspi_cmd_enable(qspi); -+ phytium_qspi_wait_cmd(qspi, flash); -+ -+ return 0; -+} -+ -+static int phytium_qspi_prep(struct spi_nor *nor) -+{ -+ struct phytium_qspi_flash *flash = nor->priv; -+ struct phytium_qspi *qspi = flash->qspi; -+ -+ mutex_lock(&qspi->lock); -+ return 0; -+} -+ -+static void phytium_qspi_unprep(struct spi_nor *nor) -+{ -+ struct phytium_qspi_flash *flash = nor->priv; -+ struct phytium_qspi *qspi = flash->qspi; -+ -+ mutex_unlock(&qspi->lock); -+} -+ -+static int phytium_qspi_get_flash_size(struct phytium_qspi *qspi, u32 size) -+{ -+ int ret = 0; -+ u32 value; -+ -+ switch (size) { -+ case SZ_4M: -+ value = 0; -+ break; -+ case SZ_8M: -+ value = 1; -+ break; -+ case SZ_16M: -+ value = 2; -+ break; -+ case SZ_32M: -+ value = 3; -+ break; -+ case SZ_64M: -+ value = 4; -+ break; -+ case SZ_128M: -+ value = 5; -+ break; -+ case SZ_256M: -+ value = 6; -+ break; -+ case SZ_512M: -+ value = 7; -+ break; -+ default: -+ value = 0; -+ ret = -EINVAL; -+ return ret; -+ } -+ -+ return value; -+} -+ -+static const struct spi_nor_controller_ops phytium_controller_ops = { -+ .prepare = phytium_qspi_prep, -+ .unprepare = phytium_qspi_unprep, -+ .read_reg = phytium_qspi_read_reg, -+ .write_reg = phytium_qspi_write_reg, -+ .read = phytium_qspi_read, -+ .write = phytium_qspi_write, -+ .erase = phytium_qspi_erase, -+}; -+ -+static int phytium_qspi_flash_setup(struct phytium_qspi *qspi, struct fwnode_handle *np) -+{ -+ struct spi_nor_hwcaps hwcaps = { .mask = SNOR_HWCAPS_READ | SNOR_HWCAPS_READ_FAST | SNOR_HWCAPS_PP, }; -+ u32 width, presc; -+ u32 cs_num = 0; -+ u32 max_rate = 0; -+ u32 clk_div = 0; -+ u32 flash_cap = 0; -+ u32 addr_width = PHYTIUM_QSPI_1_1_1; -+ struct phytium_qspi_flash *flash; -+ struct mtd_info *mtd; -+ int ret; -+ -+ fwnode_property_read_u32(np, "reg", &cs_num); -+ if (cs_num >= PHYTIUM_MAX_NORCHIP) -+ return -EINVAL; -+ -+ fwnode_property_read_u32(np, "spi-max-frequency", &max_rate); -+ if (!max_rate) -+ return -EINVAL; -+ -+ fwnode_property_read_u32(np, "spi-clk-div", &clk_div); -+ if (!clk_div) -+ clk_div = PHYTIUM_SCK_SEL; -+ -+ if (clk_div < 4) -+ return -EINVAL; -+ -+ presc = DIV_ROUND_UP(qspi->clk_rate, max_rate) - 1; -+ -+ fwnode_property_read_u32(np, "spi-rx-bus-width", &width); -+ if (!width) -+ width = 1; -+ -+ if (width == 4) { -+ hwcaps.mask |= SNOR_HWCAPS_READ_1_1_4; -+ addr_width = PHYTIUM_QSPI_1_1_4; -+ } else if (width == 2) { -+ hwcaps.mask |= SNOR_HWCAPS_READ_1_1_2; -+ addr_width = PHYTIUM_QSPI_1_1_2; -+ } else if (width != 1) -+ return -EINVAL; -+ -+ flash = &qspi->flash[cs_num]; -+ -+ flash->qspi = qspi; -+ flash->cs = cs_num; -+ flash->presc = presc; -+ flash->clk_div = clk_div; -+ flash->addr_width = addr_width; -+ flash->nor.dev = qspi->dev; -+ if (qspi->dev->of_node) -+ spi_nor_set_flash_node(&flash->nor, qspi->dev->of_node); -+ flash->nor.priv = flash; -+ flash->nor.controller_ops = &phytium_controller_ops; -+ -+ ret = spi_nor_scan(&flash->nor, NULL, &hwcaps); -+ if (ret) { -+ dev_err(qspi->dev, "device scan failed\n"); -+ return ret; -+ } -+ -+ mtd = &flash->nor.mtd; -+ -+ flash->fsize = mtd->size; -+ flash->prefetch_limit = mtd->size - PHYTIUM_QSPI_FIFO_SZ; -+ -+ ret = phytium_qspi_get_flash_size(flash->qspi, mtd->size); -+ if (ret < 0) { -+ dev_err(qspi->dev, "flash size invalid\n"); -+ return ret; -+ } -+ -+ flash_cap = cs_num << QSPI_FLASH_CAP_NUM_SHIFT; -+ flash_cap |= ret; -+ writel_relaxed(flash_cap, qspi->io_base + QSPI_FLASH_CAP_REG); -+ -+ flash->read_mode = PHYTIUM_FMODE_MM; -+ -+ ret = mtd_device_register(mtd, NULL, 0); -+ if (ret) { -+ dev_err(qspi->dev, "mtd device parse failed\n"); -+ return ret; -+ } -+ -+ flash->registered = true; -+ -+ dev_dbg(qspi->dev, "read mm:%s %px cs:%d bus:%d clk-div:%d\n", -+ flash->read_mode == PHYTIUM_FMODE_MM ? "yes" : "no", -+ qspi->mm_base, cs_num, width, clk_div); -+ -+ dev_dbg(qspi->dev, "mtd->size:%llx, mtd->erasesize:%x, fsize:%x\n", -+ mtd->size, mtd->erasesize, flash->fsize); -+ -+ return 0; -+} -+ -+static void phytium_qspi_mtd_free(struct phytium_qspi *qspi) -+{ -+ int i; -+ -+ for (i = 0; i < PHYTIUM_MAX_NORCHIP; i++) -+ if (qspi->flash[i].registered) -+ mtd_device_unregister(&qspi->flash[i].nor.mtd); -+} -+ -+static ssize_t clk_div_show(struct device *dev, struct device_attribute *attr, -+ char *buf) -+{ -+ struct phytium_qspi *qspi = dev_get_drvdata(dev); -+ struct phytium_qspi_flash *flash = &qspi->flash[0]; -+ -+ return sprintf(buf, "Flash 0 clk-div: %d\n", flash->clk_div); -+} -+ -+static ssize_t clk_div_store(struct device *dev, -+ struct device_attribute *attr, const char *buf, -+ size_t size) -+{ -+ struct phytium_qspi *qspi = dev_get_drvdata(dev); -+ struct phytium_qspi_flash *flash = &qspi->flash[0]; -+ long value; -+ char *token; -+ ssize_t status; -+ -+ token = strsep ((char **)&buf, " "); -+ if (!token) -+ return -EINVAL; -+ -+ status = kstrtol(token, 0, &value); -+ if (status) -+ return status; -+ -+ flash->clk_div = (u8)value; -+ -+ return size; -+} -+static DEVICE_ATTR_RW(clk_div); -+ -+static struct attribute *phytium_qspi_attrs[] = { -+ &dev_attr_clk_div.attr, -+ NULL, -+}; -+ -+static struct attribute_group phytium_qspi_attr_group = { -+ .attrs = phytium_qspi_attrs, -+}; -+ -+static int phytium_qspi_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct fwnode_handle *flash_np; -+ struct phytium_qspi *qspi; -+ struct resource *res; -+ int ret; -+ -+ qspi = devm_kzalloc(dev, sizeof(*qspi), GFP_KERNEL); -+ if (!qspi) -+ return -ENOMEM; -+ -+ qspi->nor_num = device_get_child_node_count(dev); -+ if (!qspi->nor_num || qspi->nor_num > PHYTIUM_MAX_NORCHIP) -+ return -ENODEV; -+ -+ if (dev->of_node) -+ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi"); -+ else if (has_acpi_companion(dev)) { -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ } -+ qspi->io_base = devm_ioremap_resource(dev, res); -+ if (IS_ERR(qspi->io_base)) -+ return PTR_ERR(qspi->io_base); -+ -+ -+ if (dev->of_node) -+ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi_mm"); -+ else if (has_acpi_companion(dev)) -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ -+ qspi->mm_base = devm_ioremap_resource(dev, res); -+ if (IS_ERR(qspi->mm_base)) -+ return PTR_ERR(qspi->mm_base); -+ -+ qspi->mm_size = resource_size(res); -+ -+ if (dev->of_node) { -+ qspi->clk = devm_clk_get(dev, NULL); -+ if (IS_ERR(qspi->clk)) -+ return PTR_ERR(qspi->clk); -+ -+ qspi->clk_rate = clk_get_rate(qspi->clk); -+ if (!qspi->clk_rate) -+ return -EINVAL; -+ -+ ret = clk_prepare_enable(qspi->clk); -+ if (ret) { -+ dev_err(dev, "can not enable the clock\n"); -+ return ret; -+ } -+ } -+ else if (has_acpi_companion(dev)) { /* ACPI table not pass clk rate */ -+ qspi->clk_rate = 50000000; -+ } -+ -+ qspi->dev = dev; -+ platform_set_drvdata(pdev, qspi); -+ mutex_init(&qspi->lock); -+ spin_lock_init(&qspi->spinlock); -+ -+ fwnode_for_each_available_child_node(dev_fwnode(dev), flash_np) { -+ ret = phytium_qspi_flash_setup(qspi, flash_np); -+ if (ret) { -+ dev_err(dev, "unable to setup flash chip\n"); -+ goto err_flash; -+ } -+ } -+ -+ ret = sysfs_create_group(&qspi->dev->kobj, &phytium_qspi_attr_group); -+ if (ret) { -+ dev_err(dev, "unable to create sysfs\n"); -+ goto err_flash; -+ } -+ -+ return 0; -+ -+err_flash: -+ mutex_destroy(&qspi->lock); -+ phytium_qspi_mtd_free(qspi); -+ -+ clk_disable_unprepare(qspi->clk); -+ return ret; -+} -+ -+static int phytium_qspi_remove(struct platform_device *pdev) -+{ -+ struct phytium_qspi *qspi = platform_get_drvdata(pdev); -+ -+ sysfs_remove_group(&qspi->dev->kobj, &phytium_qspi_attr_group); -+ -+ phytium_qspi_mtd_free(qspi); -+ mutex_destroy(&qspi->lock); -+ -+ clk_disable_unprepare(qspi->clk); -+ return 0; -+} -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_qspi_acpi_ids[] = { -+ { "PHYT0011", 0 }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_qspi_acpi_ids); -+#endif -+ -+static const struct of_device_id phytium_qspi_match[] = { -+ { .compatible = "phytium,qspi" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_qspi_match); -+ -+static struct platform_driver phytium_qspi_driver = { -+ .probe = phytium_qspi_probe, -+ .remove = phytium_qspi_remove, -+ .driver = { -+ .name = "phytium-quadspi", -+ .of_match_table = phytium_qspi_match, -+ .acpi_match_table = ACPI_PTR(phytium_qspi_acpi_ids), -+ }, -+}; -+module_platform_driver(phytium_qspi_driver); -+ -+MODULE_AUTHOR("Mingshuai Zhu "); -+MODULE_AUTHOR("Shaojun Yang "); -+MODULE_DESCRIPTION("Phytium QuadSPI driver"); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/mtd/spi-nor/core.c b/drivers/mtd/spi-nor/core.c -index 09e112f37..0e95d7759 100644 ---- a/drivers/mtd/spi-nor/core.c -+++ b/drivers/mtd/spi-nor/core.c -@@ -2038,6 +2038,7 @@ static const struct spi_nor_manufacturer *manufacturers[] = { - &spi_nor_winbond, - &spi_nor_xilinx, - &spi_nor_xmc, -+ &spi_nor_boya, - }; - - static const struct flash_info * -diff --git a/drivers/mtd/spi-nor/core.h b/drivers/mtd/spi-nor/core.h -index 788775bb6..16a0e3a53 100644 ---- a/drivers/mtd/spi-nor/core.h -+++ b/drivers/mtd/spi-nor/core.h -@@ -398,6 +398,7 @@ extern const struct spi_nor_manufacturer spi_nor_sst; - extern const struct spi_nor_manufacturer spi_nor_winbond; - extern const struct spi_nor_manufacturer spi_nor_xilinx; - extern const struct spi_nor_manufacturer spi_nor_xmc; -+extern const struct spi_nor_manufacturer spi_nor_boya; - - int spi_nor_write_enable(struct spi_nor *nor); - int spi_nor_write_disable(struct spi_nor *nor); -diff --git a/drivers/net/can/Kconfig b/drivers/net/can/Kconfig -index 1c28eade6..09bf99e20 100644 ---- a/drivers/net/can/Kconfig -+++ b/drivers/net/can/Kconfig -@@ -179,6 +179,8 @@ source "drivers/net/can/softing/Kconfig" - source "drivers/net/can/spi/Kconfig" - source "drivers/net/can/usb/Kconfig" - -+source "drivers/net/can/phytium/Kconfig" -+ - endif - - config CAN_DEBUG_DEVICES -diff --git a/drivers/net/can/Makefile b/drivers/net/can/Makefile -index a2b4463d8..18f31d6ca 100644 ---- a/drivers/net/can/Makefile -+++ b/drivers/net/can/Makefile -@@ -29,5 +29,6 @@ obj-$(CONFIG_CAN_SUN4I) += sun4i_can.o - obj-$(CONFIG_CAN_TI_HECC) += ti_hecc.o - obj-$(CONFIG_CAN_XILINXCAN) += xilinx_can.o - obj-$(CONFIG_PCH_CAN) += pch_can.o -+obj-$(CONFIG_CAN_PHYTIUM) += phytium/ - - subdir-ccflags-$(CONFIG_CAN_DEBUG_DEVICES) += -DDEBUG -diff --git a/drivers/net/can/phytium/Kconfig b/drivers/net/can/phytium/Kconfig -new file mode 100644 -index 000000000..a23216d23 ---- /dev/null -+++ b/drivers/net/can/phytium/Kconfig -@@ -0,0 +1,34 @@ -+# SPDX-License-Identifier: GPL-2.0-only -+menuconfig CAN_PHYTIUM -+ tristate "Phytium CAN support" -+ help -+ Say Y here if you want support for Phytium CAN controller framework. -+ This is common support for devices that embed the Phytium CAN IP. -+ -+ To compile this driver as a module, choose M here: the module will -+ be called phytium_can. -+ -+if CAN_PHYTIUM -+ -+config CAN_PHYTIUM_PLATFORM -+ tristate "Phytium CAN support for io-mapped devices" -+ depends on HAS_IOMEM -+ help -+ Say Y here is you want to support for IO Mapped Phytium CAN controller. -+ This support is for devices that have the Phytium CAN controller IP -+ embedded into the device and the IP is IO Mapped to the processor. -+ -+ To compile this driver as a module, choose M here: the module will -+ be called phytium_can_platform. -+ -+config CAN_PHYTIUM_PCI -+ tristate "Phytium CAN support for PCI devices" -+ depends on PCI -+ help -+ Say Y here is you want to support for Phytium CAN controller connected -+ to the PCI bus. This support is for devices that have the Phytium CAN -+ controller IP embedded into a PCI device. -+ -+ To compile this driver as a module, choose M here: the module will -+ be called phytium_can_pci. -+endif -diff --git a/drivers/net/can/phytium/Makefile b/drivers/net/can/phytium/Makefile -new file mode 100644 -index 000000000..7ef554fca ---- /dev/null -+++ b/drivers/net/can/phytium/Makefile -@@ -0,0 +1,8 @@ -+# -+# Makefile for the Phytium CAN controller drivers. -+# -+# -+ -+obj-$(CONFIG_CAN_PHYTIUM) += phytium_can.o -+obj-$(CONFIG_CAN_PHYTIUM_PLATFORM) += phytium_can_platform.o -+obj-$(CONFIG_CAN_PHYTIUM_PCI) += phytium_can_pci.o -diff --git a/drivers/net/can/phytium/phytium_can.c b/drivers/net/can/phytium/phytium_can.c -new file mode 100644 -index 000000000..60b3f34a7 ---- /dev/null -+++ b/drivers/net/can/phytium/phytium_can.c -@@ -0,0 +1,1156 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* CAN bus driver for Phytium CAN controller -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+ -+#include "phytium_can.h" -+ -+/* register definition */ -+enum phytium_can_reg { -+ CAN_CTRL = 0x00, /* Global control register */ -+ CAN_INTR = 0x04, /* Interrupt register */ -+ CAN_ARB_RATE_CTRL = 0x08, /* Arbitration rate control register */ -+ CAN_DAT_RATE_CTRL = 0x0c, /* Data rate control register */ -+ CAN_ACC_ID0 = 0x10, /* Acceptance identifier0 register */ -+ CAN_ACC_ID1 = 0x14, /* Acceptance identifier1 register */ -+ CAN_ACC_ID2 = 0x18, /* Acceptance identifier2 register */ -+ CAN_ACC_ID3 = 0x1c, /* Acceptance identifier3 register */ -+ CAN_ACC_ID0_MASK = 0x20, /* Acceptance identifier0 mask register */ -+ CAN_ACC_ID1_MASK = 0x24, /* Acceptance identifier1 mask register */ -+ CAN_ACC_ID2_MASK = 0x28, /* Acceptance identifier2 mask register */ -+ CAN_ACC_ID3_MASK = 0x2c, /* Acceptance identifier3 mask register */ -+ CAN_XFER_STS = 0x30, /* Transfer status register */ -+ CAN_ERR_CNT = 0x34, /* Error counter register */ -+ CAN_FIFO_CNT = 0x38, /* FIFO counter register */ -+ CAN_DMA_CTRL = 0x3c, /* DMA request control register */ -+ CAN_XFER_EN = 0x40, /* Transfer enable register */ -+ CAN_INTR1 = 0x44, /* Interrupt register 1 */ -+ CAN_FRM_INFO = 0x48, /* Frame valid number register */ -+ CAN_TIME_OUT = 0x4c, /* Timeout register */ -+ CAN_TIME_OUT_CNT = 0x50, /* Timeout counter register */ -+ CAN_INTR2 = 0x54, /* Interrupt register 2 */ -+ CAN_TX_FIFO = 0x100, /* TX FIFO shadow register */ -+ CAN_RX_FIFO = 0x200, /* RX FIFO shadow register */ -+ CAN_RX_INFO_FIFO = 0x300, /* RX information FIFO shadow register */ -+ CAN_PIDR4 = 0xfd0, /* Peripheral Identification Register 4 */ -+ CAN_PIDR0 = 0xfe0, /* Peripheral Identification Register 0 */ -+ CAN_PIDR1 = 0xfe4, /* Peripheral Identification Register 1 */ -+ CAN_PIDR2 = 0xfe8, /* Peripheral Identification Register 2 */ -+ CAN_PIDR3 = 0xfec, /* Peripheral Identification Register 3 */ -+ CAN_CIDR0 = 0xff0, /* Component Identification Register 0 */ -+ CAN_CIDR1 = 0xff4, /* Component Identification Register 1 */ -+ CAN_CIDR2 = 0xff8, /* Component Identification Register 2 */ -+ CAN_CIDR3 = 0xffc, /* Component Identification Register 3 */ -+}; -+ -+/* Global control register (CTRL) */ -+#define CTRL_XFER BIT(0) /* Transfer enable */ -+#define CTRL_TXREQ BIT(1) /* Transmit request */ -+#define CTRL_AIME BIT(2) /* Acceptance identifier mask enable */ -+#define CTRL_TTS BIT(3) /* Transmit trigger strategy */ -+#define CTRL_RST BIT(7) /* Write 1 to soft reset and self clear */ -+#define CTRL_RFEIDF BIT(8) /* Allow RX frame end interrupt during ID filtered frame */ -+#define CTRL_RFEDT BIT(9) /* Allow RX frame end interrupt during TX frame */ -+#define CTRL_IOF BIT(10) /* Ignore overload flag internally */ -+#define CTRL_FDCRC BIT(11) /* CANFD CRC mode */ -+ -+/* Interrupt register (INTR) */ -+#define INTR_BOIS BIT(0) /* Bus off interrupt status */ -+#define INTR_PWIS BIT(1) /* Passive warning interrupt status */ -+#define INTR_PEIS BIT(2) /* Passive error interrupt status */ -+#define INTR_RFIS BIT(3) /* RX FIFO full interrupt status */ -+#define INTR_TFIS BIT(4) /* TX FIFO empty interrupt status */ -+#define INTR_REIS BIT(5) /* RX frame end interrupt status */ -+#define INTR_TEIS BIT(6) /* TX frame end interrupt status */ -+#define INTR_EIS BIT(7) /* Error interrupt status */ -+#define INTR_BOIE BIT(8) /* Bus off interrupt enable */ -+#define INTR_PWIE BIT(9) /* Passive warning interrupt enable */ -+#define INTR_PEIE BIT(10) /* Passive error interrupt enable */ -+#define INTR_RFIE BIT(11) /* RX FIFO full interrupt enable */ -+#define INTR_TFIE BIT(12) /* TX FIFO empty interrupt enable */ -+#define INTR_REIE BIT(13) /* RX frame end interrupt enable */ -+#define INTR_TEIE BIT(14) /* TX frame end interrupt enable */ -+#define INTR_EIE BIT(15) /* Error interrupt enable */ -+#define INTR_BOIC BIT(16) /* Bus off interrupt clear */ -+#define INTR_PWIC BIT(17) /* Passive warning interrupt clear */ -+#define INTR_PEIC BIT(18) /* Passive error interrupt clear */ -+#define INTR_RFIC BIT(19) /* RX FIFO full interrupt clear */ -+#define INTR_TFIC BIT(20) /* TX FIFO empty interrupt clear */ -+#define INTR_REIC BIT(21) /* RX frame end interrupt clear */ -+#define INTR_TEIC BIT(22) /* TX frame end interrupt clear */ -+#define INTR_EIC BIT(23) /* Error interrupt clear */ -+ -+#define INTR_STATUS_MASK (INTR_BOIS | INTR_PWIS | INTR_PEIS | INTR_RFIS | \ -+ INTR_TFIS | INTR_REIS | INTR_TEIS | INTR_EIS) -+#define INTR_EN_MASK (INTR_BOIE | INTR_RFIE | INTR_REIE | INTR_TEIE | \ -+ INTR_EIE) -+#define INTR_CLEAR_MASK (INTR_BOIC | INTR_PWIC | INTR_PEIC | INTR_RFIC | \ -+ INTR_TFIC | INTR_REIC | INTR_TEIC | INTR_EIC) -+ -+/* Arbitration rate control register (ARB_RATE_CTRL) */ -+#define ARB_RATE_CTRL_ARJW GENMASK(1, 0) /* Arbitration field resync jump width */ -+#define ARB_RATE_CTRL_APRS GENMASK(4, 2) /* Arbitration field propagation segment */ -+#define ARB_RATE_CTRL_APH1S GENMASK(7, 5) /* Arbitration field phase1 segment */ -+#define ARB_RATE_CTRL_APH2S GENMASK(10, 8) /* Arbitration field phase2 segment */ -+#define ARB_RATE_CTRL_APD GENMASK(28, 16) /* Arbitration field prescaler divider */ -+ -+/* Data rate control register (DAT_RATE_CTRL) */ -+#define DAT_RATE_CTRL_DRJW GENMASK(1, 0) /* Data field resync jump width */ -+#define DAT_RATE_CTRL_DPRS GENMASK(4, 2) /* Data field propagation segment */ -+#define DAT_RATE_CTRL_DPH1S GENMASK(7, 5) /* Data field phase1 segment */ -+#define DAT_RATE_CTRL_DPH2S GENMASK(10, 8) /* Data field phase2 segment */ -+#define DAT_RATE_CTRL_DPD GENMASK(28, 16) /* Data field prescaler divider */ -+ -+/* Acceptance identifierX register (ACC_IDX) */ -+#define ACC_IDX_AID_MASK GENMASK(28, 0) /* Acceptance identifier */ -+ -+/* Acceptance identifier0 mask register (ACC_ID0_MASK) */ -+#define ACC_IDX_MASK_AID_MASK GENMASK(28, 0) /* Acceptance identifier mask */ -+ -+/* Transfer status register (XFER_STS) */ -+#define XFER_STS_FRAS GENMASK(2, 0) /* Frame status */ -+#define XFER_STS_FIES GENMASK(7, 3) /* Field status */ -+#define XFER_STS_FIES_IDLE (0x0) /* idle */ -+#define XFER_STS_FIES_ARBITRATION (0x1) /* arbitration */ -+#define XFER_STS_FIES_TX_CTRL (0x2) /* transmit control */ -+#define XFER_STS_FIES_TX_DATA (0x3) /* transmit data */ -+#define XFER_STS_FIES_TX_CRC (0x4) /* transmit crc */ -+#define XFER_STS_FIES_TX_FRM (0x5) /* transmit frame */ -+#define XFER_STS_FIES_RX_CTRL (0x6) /* receive control */ -+#define XFER_STS_FIES_RX_DATA (0x7) /* receive data */ -+#define XFER_STS_FIES_RX_CRC (0x8) /* receive crc */ -+#define XFER_STS_FIES_RX_FRM (0x9) /* receive frame */ -+#define XFER_STS_FIES_INTERMISSION (0xa) /* intermission */ -+#define XFER_STS_FIES_TX_SUSPD (0xb) /* transmit suspend */ -+#define XFER_STS_FIES_BUS_IDLE (0xc) /* bus idle */ -+#define XFER_STS_FIES_OVL_FLAG (0xd) /* overload flag */ -+#define XFER_STS_FIES_OVL_DLM (0xe) /* overload delimiter */ -+#define XFER_STS_FIES_ERR_FLAG (0xf) /* error flag */ -+#define XFER_STS_FIES_ERR_DLM (0x10) /* error delimiter */ -+#define XFER_STS_FIES_BUS_OFF (0x11) /* bus off */ -+#define XFER_STS_TS BIT(8) /* Transmit status */ -+#define XFER_STS_RS BIT(9) /* Receive status */ -+#define XFER_STS_XFERS BIT(10) /* Transfer status */ -+ -+/* Error counter register (ERR_CNT) */ -+#define ERR_CNT_REC GENMASK(8, 0) /* Receive error counter */ -+#define ERR_CNT_TEC GENMASK(24, 16) /* Transmit error counter */ -+ -+/* FIFO counter register (FIFO_CNT) */ -+#define FIFO_CNT_RFN GENMASK(6, 0) /* Receive FIFO valid data number */ -+#define FIFO_CNT_TFN GENMASK(22, 16) /* Transmit FIFO valid data number */ -+ -+/* DMA request control register (DMA_CTRL) */ -+#define DMA_CTRL_RFTH GENMASK(5, 0) /* Receive FIFO DMA request threshold */ -+#define DMA_CTRL_RFRE BIT(6) /* Receive FIFO DMA request enable */ -+#define DMA_CTRL_TFTH GENMASK(21, 16) /* Transmit FIFO DMA request threshold */ -+#define DMA_CTRL_TFRE BIT(22) /* Transmit FIFO DMA request enable */ -+ -+/* Transfer enable register (XFER_EN) */ -+#define XFER_EN_XFER BIT(0) /* Transfer enable */ -+ -+/* Interrupt register 1 (INTR1) */ -+#define INTR1_RF1IS BIT(0) /* RX FIFO 1/4 interrupt status */ -+#define INTR1_RF2IS BIT(1) /* RX FIFO 1/2 interrupt status */ -+#define INTR1_RF3IS BIT(2) /* RX FIFO 3/4 interrupt status */ -+#define INTR1_RF4IS BIT(3) /* RX FIFO full interrupt status */ -+#define INTR1_TF1IS BIT(4) /* TX FIFO 1/4 interrupt status */ -+#define INTR1_TF2IS BIT(5) /* TX FIFO 1/2 interrupt status */ -+#define INTR1_TF3IS BIT(6) /* TX FIFO 3/4 interrupt status */ -+#define INTR1_TF4IS BIT(7) /* TX FIFO empty interrupt status */ -+#define INTR1_RF1IE BIT(8) /* RX FIFO 1/4 interrupt enable */ -+#define INTR1_RF2IE BIT(9) /* RX FIFO 1/2 interrupt enable */ -+#define INTR1_RF3IE BIT(10) /* RX FIFO 3/4 interrupt enable */ -+#define INTR1_RF4IE BIT(11) /* RX FIFO full interrupt enable */ -+#define INTR1_TF1IE BIT(12) /* TX FIFO 1/4 interrupt enable */ -+#define INTR1_TF2IE BIT(13) /* TX FIFO 1/2 interrupt enable */ -+#define INTR1_TF3IE BIT(14) /* TX FIFO 3/4 interrupt enable */ -+#define INTR1_TF4IE BIT(15) /* TX FIFO empty interrupt enable */ -+#define INTR1_RF1IC BIT(16) /* RX FIFO 1/4 interrupt clear */ -+#define INTR1_RF2IC BIT(17) /* RX FIFO 1/2 interrupt clear */ -+#define INTR1_RF3IC BIT(18) /* RX FIFO 3/4 interrupt clear */ -+#define INTR1_RF4IC BIT(19) /* RX FIFO full interrupt clear */ -+#define INTR1_TF1IC BIT(20) /* TX FIFO 1/4 interrupt clear */ -+#define INTR1_TF2IC BIT(21) /* TX FIFO 1/2 interrupt clear */ -+#define INTR1_TF3IC BIT(22) /* TX FIFO 3/4 interrupt clear */ -+#define INTR1_TF4IC BIT(23) /* TX FIFO empty interrupt clear */ -+#define INTR1_RF1RIS BIT(24) /* RX FIFO 1/4 raw interrupt status */ -+#define INTR1_RF2RIS BIT(25) /* RX FIFO 1/2 raw interrupt status */ -+#define INTR1_RF3RIS BIT(26) /* RX FIFO 3/4 raw interrupt status */ -+#define INTR1_RF4RIS BIT(27) /* RX FIFO full raw interrupt status */ -+#define INTR1_TF1RIS BIT(28) /* TX FIFO 1/4 raw interrupt status */ -+#define INTR1_TF2RIS BIT(29) /* TX FIFO 1/2 raw interrupt status */ -+#define INTR1_TF3RIS BIT(30) /* TX FIFO 3/4 raw interrupt status */ -+#define INTR1_TF4RIS BIT(31) /* TX FIFO empty raw interrupt status */ -+ -+/* Frame valid number register (FRM_INFO) */ -+#define FRM_INFO_RXFC GENMASK(5, 0) /* Valid frame number in RX FIFO */ -+#define FRM_INFO_SSPD GENMASK(31, 16) /* Secondary sample point delay */ -+ -+/* Interrupt register 2 (INTR2) */ -+#define INTR2_TOIS BIT(0) /* RX FIFO time out interrupt status */ -+#define INTR2_TOIM BIT(8) /* RX FIFO time out interrupt mask */ -+#define INTR2_TOIC BIT(16) /* RX FIFO time out interrupt clear */ -+#define INTR2_TORIS BIT(24) /* RX FIFO time out raw interrupt status */ -+ -+/* RX information FIFO shadow register (RX_INFO_FIFO) */ -+#define RX_INFO_FIFO_WNORF GENMASK(4, 0) /* Word (4-byte) number of current receive frame */ -+#define RX_INFO_FIFO_RORF BIT(5) /* RTR value of current receive frame */ -+#define RX_INFO_FIFO_FORF BIT(6) /* FDF value of current receive frame */ -+#define RX_INFO_FIFO_IORF BIT(7) /* IDE value of current receive frame */ -+ -+/* Arbitration Bits */ -+#define CAN_ID1_MASK GENMASK(31, 21) /* Base identifer */ -+/* Standard Remote Transmission Request */ -+#define CAN_ID1_RTR_MASK BIT(20) -+/* Extended Substitute remote TXreq */ -+#define CAN_ID2_SRR_MASK BIT(20) -+#define CAN_IDE_MASK BIT(19) /* IDentifier extension flag */ -+#define CAN_ID2_MASK GENMASK(18, 1) /* Identifier extension */ -+/* Extended frames remote TX request */ -+#define CAN_ID2_RTR_MASK BIT(0) -+#define CAN_ID1_FDF_MASK BIT(18) -+#define CAN_ID1_DLC_MASK GENMASK(17, 14) -+#define CANFD_ID1_BRS_MASK BIT(16) -+#define CANFD_ID1_ESI_MASK BIT(15) -+#define CANFD_ID1_DLC_MASK GENMASK(14, 11) -+ -+#define CAN_ID2_FDF_MASK BIT(31) -+#define CAN_ID2_DLC_MASK GENMASK(29, 26) -+#define CANFD_ID2_BRS_MASK BIT(29) -+#define CANFD_ID2_ESI_MASK BIT(28) -+#define CANFD_ID2_DLC_MASK GENMASK(27, 24) -+ -+#define CAN_ID1_DLC_OFF 14 -+#define CANFD_ID1_DLC_OFF 11 -+#define CAN_ID2_DLC_OFF 26 -+#define CANFD_ID2_DLC_OFF 24 -+ -+#define CAN_IDR_ID1_SHIFT 21 /* Standard Messg Identifier */ -+#define CAN_IDR_ID2_SHIFT 1 /* Extended Message Identifier */ -+#define CAN_IDR_SDLC_SHIFT 14 -+#define CAN_IDR_EDLC_SHIFT 26 -+ -+/* CANFD Standard msg padding 1 */ -+#define CANFD_IDR_PAD_MASK 0x000007FF -+#define CAN_IDR_PAD_MASK 0x00003FFF /* Standard msg padding 1 */ -+ -+/** -+ * phytium_can_set_reg_bits - set a bit value to the device register -+ * @cdev: Driver private data structure -+ * @reg: Register offset -+ * @bs: The bit mask -+ * -+ * Read data from the particular CAN register -+ * Return: value read from the CAN register -+ */ -+static void -+phytium_can_set_reg_bits(const struct phytium_can_dev *cdev, -+ enum phytium_can_reg reg, u32 bs) -+{ -+ u32 val = readl(cdev->base + reg); -+ -+ val |= bs; -+ writel(val, cdev->base + reg); -+} -+ -+/** -+ * phytium_can_clr_reg_bits - clear a bit value to the device register -+ * @cdev: Driver private data structure -+ * @reg: Register offset -+ * @bs: The bit mask -+ * -+ * Read data from the particular CAN register -+ * Return: value read from the CAN register -+ */ -+static void -+phytium_can_clr_reg_bits(const struct phytium_can_dev *cdev, -+ enum phytium_can_reg reg, u32 bs) -+{ -+ u32 val = readl(cdev->base + reg); -+ -+ val &= ~bs; -+ writel(val, cdev->base + reg); -+} -+ -+static inline u32 phytium_can_read(const struct phytium_can_dev *cdev, enum phytium_can_reg reg) -+{ -+ return readl(cdev->base + reg); -+} -+ -+static inline void phytium_can_write(const struct phytium_can_dev *cdev, enum phytium_can_reg reg, -+ u32 val) -+{ -+ writel(val, cdev->base + reg); -+} -+ -+static inline void phytium_can_enable_all_interrupts(struct phytium_can_dev *cdev) -+{ -+ phytium_can_write(cdev, CAN_INTR, INTR_EN_MASK); -+} -+ -+static inline void phytium_can_disable_all_interrupt(struct phytium_can_dev *cdev) -+{ -+ phytium_can_write(cdev, CAN_INTR, 0x0); -+} -+ -+static int phytium_can_get_berr_counter(const struct net_device *dev, -+ struct can_berr_counter *bec) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ bec->rxerr = phytium_can_read(cdev, CAN_ERR_CNT) & ERR_CNT_REC; -+ bec->txerr = (phytium_can_read(cdev, CAN_ERR_CNT) & ERR_CNT_TEC) >> 16; -+ -+ return 0; -+} -+ -+static int phytium_can_read_fifo(struct net_device *dev) -+{ -+ struct net_device_stats *stats = &dev->stats; -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ struct canfd_frame *cf; -+ struct sk_buff *skb; -+ u32 id, dlc, i; -+ -+ /* Read the frame header from FIFO */ -+ id = phytium_can_read(cdev, CAN_RX_FIFO); -+ id = be32_to_cpup(&id); -+ if (id & CAN_IDE_MASK) { -+ /* Received an extended frame */ -+ dlc = phytium_can_read(cdev, CAN_RX_FIFO); -+ dlc = be32_to_cpup(&dlc); -+ if (dlc & CAN_ID2_FDF_MASK) -+ skb = alloc_canfd_skb(dev, &cf); -+ else -+ skb = alloc_can_skb(dev, (struct can_frame **)&cf); -+ -+ if (unlikely(!skb)) { -+ stats->rx_dropped++; -+ return 0; -+ } -+ -+ if (dlc & CAN_ID2_FDF_MASK) { -+ /* CAN FD extended frame */ -+ if (dlc & CANFD_ID2_BRS_MASK) -+ cf->flags |= CANFD_BRS; -+ if (dlc & CANFD_ID2_ESI_MASK) -+ cf->flags |= CANFD_ESI; -+ cf->len = can_dlc2len((dlc & CANFD_ID2_DLC_MASK) >> CANFD_ID2_DLC_OFF); -+ } else { -+ /* CAN extended frame */ -+ cf->len = get_can_dlc((dlc & CAN_ID2_DLC_MASK) >> CAN_ID2_DLC_OFF); -+ } -+ -+ cf->can_id = (id & CAN_ID1_MASK) >> 3; -+ cf->can_id |= (id & CAN_ID2_MASK) >> 1; -+ cf->can_id |= CAN_EFF_FLAG; -+ -+ if (id & CAN_ID2_RTR_MASK) -+ cf->can_id |= CAN_RTR_FLAG; -+ } else { -+ /* Received a standard frame */ -+ if (id & CAN_ID1_FDF_MASK) -+ skb = alloc_canfd_skb(dev, &cf); -+ else -+ skb = alloc_can_skb(dev, (struct can_frame **)&cf); -+ -+ if (unlikely(!skb)) { -+ stats->rx_dropped++; -+ return 0; -+ } -+ -+ if (id & CAN_ID1_FDF_MASK) { -+ /* CAN FD extended frame */ -+ if (id & CANFD_ID1_BRS_MASK) -+ cf->flags |= CANFD_BRS; -+ if (id & CANFD_ID1_ESI_MASK) -+ cf->flags |= CANFD_ESI; -+ cf->len = can_dlc2len((id & CANFD_ID1_DLC_MASK) >> CANFD_ID1_DLC_OFF); -+ } else { -+ /* CAN extended frame */ -+ cf->len = get_can_dlc((id & CAN_ID1_DLC_MASK) >> CAN_ID1_DLC_OFF); -+ } -+ -+ cf->can_id = (id & CAN_ID1_MASK) >> 21; -+ -+ if (id & CAN_ID1_RTR_MASK) -+ cf->can_id |= CAN_RTR_FLAG; -+ } -+ -+ if (!(cf->can_id & CAN_RTR_FLAG)) -+ /* Receive data frames */ -+ for (i = 0; i < cf->len; i += 4) -+ *(__be32 *)(cf->data + i) = phytium_can_read(cdev, CAN_RX_FIFO); -+ -+ stats->rx_packets++; -+ stats->rx_bytes += cf->len; -+ netif_receive_skb(skb); -+ -+ return 1; -+} -+ -+static int phytium_can_do_rx_poll(struct net_device *dev, int quota) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ u32 rxfs, pkts = 0; -+ -+ rxfs = phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_RFN; -+ if (!rxfs) { -+ netdev_dbg(dev, "no messages in RX FIFO\n"); -+ return 0; -+ } -+ -+ while ((rxfs != 0) && (quota > 0)) { -+ pkts += phytium_can_read_fifo(dev); -+ quota--; -+ rxfs = phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_RFN; -+ netdev_dbg(dev, "Next received %d frame again.\n", rxfs); -+ } -+ -+ if (pkts) -+ can_led_event(dev, CAN_LED_EVENT_RX); -+ -+ return pkts; -+} -+ -+static int phytium_can_rx_handler(struct net_device *dev, int quota) -+{ -+ int work_done = 0; -+ int rx_work_or_err; -+ -+ /* Handle RX IRQ */ -+ rx_work_or_err = phytium_can_do_rx_poll(dev, (quota - work_done)); -+ if (rx_work_or_err < 0) -+ return rx_work_or_err; -+ -+ work_done += rx_work_or_err; -+ -+ return 0; -+} -+ -+static int phytium_can_poll(struct napi_struct *napi, int quota) -+{ -+ struct net_device *dev = napi->dev; -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ int work_done; -+ unsigned long flags; -+ -+ netdev_dbg(dev, "The receive processing is going on !\n"); -+ -+ work_done = phytium_can_rx_handler(dev, quota); -+ -+ /* Don't re-enable interrupts if the driver had a fatal error -+ * (e.g., FIFO read failure) -+ */ -+ if (work_done >= 0 && work_done < quota) { -+ napi_complete_done(napi, work_done); -+ spin_lock_irqsave(&cdev->lock, flags); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_REIE); -+ spin_unlock_irqrestore(&cdev->lock, flags); -+ } -+ -+ return work_done; -+} -+ -+static void phytium_can_write_frame(struct phytium_can_dev *cdev) -+{ -+ struct canfd_frame *cf = (struct canfd_frame *)cdev->tx_skb->data; -+ struct net_device *dev = cdev->net; -+ struct net_device_stats *stats = &dev->stats; -+ struct sk_buff *skb = cdev->tx_skb; -+ u32 i, id, dlc = 0, frame_head[2] = {0, 0}; -+ u32 data_len; -+ -+ data_len = can_len2dlc(cf->len); -+ cdev->tx_skb = NULL; -+ -+ /* Watch carefully on the bit sequence */ -+ if (cf->can_id & CAN_EFF_FLAG) { -+ /* Extended CAN ID format */ -+ id = ((cf->can_id & CAN_EFF_MASK) << 1) & CAN_ID2_MASK; -+ id |= (((cf->can_id & CAN_EFF_MASK) >> -+ (CAN_EFF_ID_BITS - CAN_SFF_ID_BITS)) << -+ CAN_IDR_ID1_SHIFT) & CAN_ID1_MASK; -+ -+ /* The substibute remote TX request bit should be "1" -+ * for extended frames as in the Phytium CAN datasheet -+ */ -+ id |= CAN_IDE_MASK | CAN_ID2_SRR_MASK; -+ -+ if (cf->can_id & CAN_RTR_FLAG) -+ /* Extended frames remote TX request */ -+ id |= CAN_ID2_RTR_MASK; -+ if ((cdev->can.ctrlmode & CAN_CTRLMODE_FD) && -+ can_is_canfd_skb(skb)) -+ dlc = data_len << CANFD_ID2_DLC_OFF; -+ else -+ dlc = data_len << CAN_ID2_DLC_OFF; -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { -+ dlc |= CAN_ID2_FDF_MASK; -+ if (cf->flags & CANFD_BRS) -+ dlc |= CANFD_ID2_BRS_MASK; -+ if (cf->flags & CANFD_ESI) -+ dlc |= CANFD_ID2_ESI_MASK; -+ } -+ -+ frame_head[0] = cpu_to_be32p(&id); -+ frame_head[1] = cpu_to_be32p(&dlc); -+ -+ /* Write the Frame to Phytium CAN TX FIFO */ -+ phytium_can_write(cdev, CAN_TX_FIFO, frame_head[0]); -+ phytium_can_write(cdev, CAN_TX_FIFO, frame_head[1]); -+ netdev_dbg(dev, "Write atbitration field [0]:0x%x [1]:0x%x\n", -+ frame_head[0], frame_head[1]); -+ } else { -+ /* Standard CAN ID format */ -+ id = ((cf->can_id & CAN_SFF_MASK) << CAN_IDR_ID1_SHIFT) -+ & CAN_ID1_MASK; -+ -+ if (cf->can_id & CAN_RTR_FLAG) -+ /* Standard frames remote TX request */ -+ id |= CAN_ID1_RTR_MASK; -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) -+ dlc = (data_len << CANFD_ID1_DLC_OFF) -+ | CANFD_IDR_PAD_MASK; -+ else -+ dlc = (data_len << CAN_ID1_DLC_OFF) | CAN_IDR_PAD_MASK; -+ -+ id |= dlc; -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { -+ id |= CAN_ID1_FDF_MASK; -+ if (cf->flags & CANFD_BRS) -+ id |= CANFD_ID1_BRS_MASK; -+ if (cf->flags & CANFD_ESI) -+ id |= CANFD_ID1_ESI_MASK; -+ } -+ -+ frame_head[0] = cpu_to_be32p(&id); -+ /* Write the Frame to Phytium CAN TX FIFO */ -+ phytium_can_write(cdev, CAN_TX_FIFO, frame_head[0]); -+ netdev_dbg(dev, "Write atbitration field [0] 0x%x\n", -+ frame_head[0]); -+ } -+ -+ if (!(cf->can_id & CAN_RTR_FLAG)) { -+ netdev_dbg(dev, "Write CAN data frame\n"); -+ for (i = 0; i < cf->len; i += 4) { -+ phytium_can_write(cdev, CAN_TX_FIFO, -+ *(__be32 *)(cf->data + i)); -+ netdev_dbg(dev, "[%d]:%x\n", i, -+ *(__be32 *)(cf->data + i)); -+ } -+ } -+ -+ stats->tx_bytes += cf->len; -+ stats->tx_packets++; -+ netdev_dbg(dev, "Trigger send message!\n"); -+ can_put_echo_skb(skb, dev, 0); -+ can_get_echo_skb(dev, 0); -+ return; -+} -+ -+static netdev_tx_t phytium_can_tx_handler(struct phytium_can_dev *cdev) -+{ -+ struct net_device *dev = cdev->net; -+ u32 tx_fifo_used; -+ unsigned long flags; -+ -+ phytium_can_write_frame(cdev); -+ -+ /* Check if the TX buffer is full */ -+ tx_fifo_used = 4 * ((phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_TFN) >> 16); -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { -+ if (CAN_FIFO_BYTE_LEN - tx_fifo_used <= KEEP_CANFD_FIFO_MIN_LEN) { -+ netif_stop_queue(dev); -+ spin_lock_irqsave(&cdev->lock, flags); -+ cdev->is_stop_queue_flag = STOP_QUEUE_TRUE; -+ spin_unlock_irqrestore(&cdev->lock, flags); -+ } -+ } else { -+ if (CAN_FIFO_BYTE_LEN - tx_fifo_used <= KEEP_CAN_FIFO_MIN_LEN) { -+ netif_stop_queue(dev); -+ spin_lock_irqsave(&cdev->lock, flags); -+ cdev->is_stop_queue_flag = STOP_QUEUE_TRUE; -+ spin_unlock_irqrestore(&cdev->lock, flags); -+ } -+ } -+ -+ return NETDEV_TX_OK; -+} -+ -+/** -+ * phytium_can_tx_interrupt - Tx Done Isr -+ * @ndev: net_device pointer -+ * @isr: Interrupt status register value -+ */ -+static void phytium_can_tx_interrupt(struct net_device *ndev, u32 isr) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ struct net_device_stats *stats = &ndev->stats; -+ u32 tx_fifo_used = 0; -+ -+ if (isr & INTR_TEIS) { -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); -+ } -+ -+ /* Check if the TX buffer is full */ -+ if (cdev->is_stop_queue_flag) { -+ tx_fifo_used = 4 * ((phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_TFN) >> 16); -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { -+ if (CAN_FIFO_BYTE_LEN - tx_fifo_used > KEEP_CANFD_FIFO_MIN_LEN) { -+ netif_wake_queue(ndev); -+ cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; -+ } -+ } else { -+ if (CAN_FIFO_BYTE_LEN - tx_fifo_used > KEEP_CAN_FIFO_MIN_LEN) { -+ netif_wake_queue(ndev); -+ cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; -+ } -+ } -+ } -+ netdev_dbg(ndev, "Finish transform packets %lu\n", stats->tx_packets); -+ can_led_event(ndev, CAN_LED_EVENT_TX); -+} -+ -+static void phytium_can_err_interrupt(struct net_device *ndev, u32 isr) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ struct net_device_stats *stats = &ndev->stats; -+ struct can_frame *cf; -+ struct sk_buff *skb; -+ u32 txerr = 0, rxerr = 0; -+ -+ skb = alloc_can_err_skb(ndev, &cf); -+ -+ rxerr = phytium_can_read(cdev, CAN_ERR_CNT) & ERR_CNT_REC; -+ txerr = ((phytium_can_read(cdev, CAN_ERR_CNT) & ERR_CNT_TEC) >> 16); -+ -+ if (isr & INTR_BOIS) { -+ netdev_dbg(ndev, "bus_off %s: txerr :%u rxerr :%u\n", -+ __func__, txerr, rxerr); -+ cdev->can.state = CAN_STATE_BUS_OFF; -+ cdev->can.can_stats.bus_off++; -+ /* Leave device in Config Mode in bus-off state */ -+ phytium_can_write(cdev, CAN_CTRL, CTRL_RST); -+ can_bus_off(ndev); -+ if (skb) -+ cf->can_id |= CAN_ERR_BUSOFF; -+ } else if ((isr & INTR_PEIS) == INTR_PEIS) { -+ netdev_dbg(ndev, "error_passive %s: txerr :%u rxerr :%u\n", -+ __func__, txerr, rxerr); -+ cdev->can.state = CAN_STATE_ERROR_PASSIVE; -+ cdev->can.can_stats.error_passive++; -+ /* Clear interrupt condition */ -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PEIC); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PWIC); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_EIC); -+ if (skb) { -+ cf->can_id |= CAN_ERR_CRTL; -+ cf->data[1] = (rxerr > 127) ? -+ CAN_ERR_CRTL_RX_PASSIVE : -+ CAN_ERR_CRTL_TX_PASSIVE; -+ cf->data[6] = txerr; -+ cf->data[7] = rxerr; -+ } -+ } else if (isr & INTR_PWIS) { -+ netdev_dbg(ndev, "error_warning %s: txerr :%u rxerr :%u\n", -+ __func__, txerr, rxerr); -+ cdev->can.state = CAN_STATE_ERROR_WARNING; -+ cdev->can.can_stats.error_warning++; -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PWIC); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_EIC); -+ if (skb) { -+ cf->can_id |= CAN_ERR_CRTL; -+ cf->data[1] |= (txerr > rxerr) ? -+ CAN_ERR_CRTL_TX_WARNING : -+ CAN_ERR_CRTL_RX_WARNING; -+ cf->data[6] = txerr; -+ cf->data[7] = rxerr; -+ } -+ } -+ -+ /* Check for RX FIFO Overflow interrupt */ -+ if (isr & INTR_RFIS) { -+ stats->rx_over_errors++; -+ stats->rx_errors++; -+ -+ if (skb) { -+ cf->can_id |= CAN_ERR_CRTL; -+ cf->data[1] |= CAN_ERR_CRTL_RX_OVERFLOW; -+ } -+ } -+ -+ if (skb) { -+ stats->rx_packets++; -+ stats->rx_bytes += cf->can_dlc; -+ netif_rx(skb); -+ } -+} -+ -+/** -+ * phytium_can_isr - CAN Isr -+ * @irq: irq number -+ * @dev_id: device id poniter -+ * -+ * This is the phytium CAN Isr. It checks for the type of interrupt -+ * and invokes the corresponding ISR. -+ * -+ * Return: -+ * * IRQ_NONE - If CAN device is in sleep mode, IRQ_HANDLED otherwise -+ */ -+static irqreturn_t phytium_can_isr(int irq, void *dev_id) -+{ -+ struct net_device *dev = (struct net_device *)dev_id; -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ u32 isr; -+ -+ /* Get the interrupt status */ -+ isr = phytium_can_read(cdev, CAN_INTR) & INTR_STATUS_MASK; -+ if (!isr) -+ return IRQ_NONE; -+ spin_lock(&cdev->lock); -+ /* Check for FIFO full interrupt and alarm */ -+ if ((isr & INTR_RFIS)) { -+ netdev_dbg(dev, "rx_fifo is full!.\n"); -+ phytium_can_clr_reg_bits(cdev, CAN_INTR, INTR_RFIE); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_RFIC); -+ napi_schedule(&cdev->napi); -+ } -+ -+ /* Check for the type of error interrupt and Processing it */ -+ if (isr & (INTR_EIS | INTR_RFIS | INTR_BOIS)) { -+ phytium_can_clr_reg_bits(cdev, CAN_INTR, (INTR_EIE -+ | INTR_RFIE | INTR_BOIE)); -+ phytium_can_err_interrupt(dev, isr); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, (INTR_EIC -+ | INTR_RFIC | INTR_BOIC)); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_EIE | INTR_BOIE); -+ spin_unlock(&cdev->lock); -+ return IRQ_HANDLED; -+ } -+ -+ /* Check for Tx interrupt and Processing it */ -+ if (isr & INTR_TEIS) { -+ phytium_can_tx_interrupt(dev, isr); -+ } -+ -+ /* Check for the type of receive interrupt and Processing it */ -+ if (isr & INTR_REIS) { -+ phytium_can_clr_reg_bits(cdev, CAN_INTR, INTR_REIE); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_REIC); -+ napi_schedule(&cdev->napi); -+ } -+ spin_unlock(&cdev->lock); -+ return IRQ_HANDLED; -+} -+ -+/** -+ * phytium_can_set_bittiming - CAN set bit timing routine -+ * @dev: Pointer to net_device structure -+ * -+ * This is the driver set bittiming routine. -+ * Return: 0 on success and failure value on error -+ */ -+static int phytium_can_set_bittiming(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ const struct can_bittiming *bt = &cdev->can.bittiming; -+ const struct can_bittiming *dbt = &cdev->can.data_bittiming; -+ u32 btr, dbtr; -+ u32 is_config_mode; -+ -+ /** -+ * Check whether Phytium CAN is in configuration mode. -+ * It cannot set bit timing if Phytium CAN is not in configuration mode. -+ */ -+ is_config_mode = phytium_can_read(cdev, CAN_CTRL) & CTRL_XFER; -+ if (is_config_mode) { -+ netdev_alert(dev, "BUG! Cannot set bittiming - CAN is not in config mode\n"); -+ return -EPERM; -+ } -+ -+ /* Setting Baud Rate prescalar value in BRPR Register */ -+ btr = (bt->brp - 1) << 16; -+ -+ /* Setting Time Segment 1 in BTR Register */ -+ btr |= (bt->prop_seg - 1) << 2; -+ -+ btr |= (bt->phase_seg1 - 1) << 5; -+ -+ /* Setting Time Segment 2 in BTR Register */ -+ btr |= (bt->phase_seg2 - 1) << 8; -+ -+ /* Setting Synchronous jump width in BTR Register */ -+ btr |= (bt->sjw - 1); -+ -+ dbtr = (dbt->brp - 1) << 16; -+ dbtr |= (dbt->prop_seg - 1) << 2; -+ dbtr |= (dbt->phase_seg1 - 1) << 5; -+ dbtr |= (dbt->phase_seg2 - 1) << 8; -+ dbtr |= (dbt->sjw - 1); -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { -+ phytium_can_write(cdev, CAN_ARB_RATE_CTRL, btr); -+ phytium_can_write(cdev, CAN_DAT_RATE_CTRL, dbtr); -+ } else { -+ phytium_can_write(cdev, CAN_ARB_RATE_CTRL, btr); -+ phytium_can_write(cdev, CAN_DAT_RATE_CTRL, btr); -+ } -+ -+ netdev_dbg(dev, "DAT=0x%08x, ARB=0x%08x\n", -+ phytium_can_read(cdev, CAN_DAT_RATE_CTRL), -+ phytium_can_read(cdev, CAN_ARB_RATE_CTRL)); -+ -+ return 0; -+} -+ -+/** -+ * phytium_can_start - This the drivers start routine -+ * @dev: Pointer to net_device structure -+ * -+ * This is the drivers start routine. -+ * Based on the State of the CAN device it puts -+ * the CAN device into a proper mode. -+ * -+ * Return: 0 on success and failure value on error -+ */ -+static void phytium_can_start(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ u32 ctrl; -+ -+ /* Disable transfer */ -+ ctrl = phytium_can_read(cdev, CAN_CTRL); -+ ctrl &= ~CTRL_XFER; -+ phytium_can_write(cdev, CAN_CTRL, ctrl); -+ -+ /* XXX: If CANFD, reset the controller */ -+ phytium_can_write(cdev, CAN_CTRL, (ctrl | CTRL_RST)); -+ -+ /* Bittiming setup */ -+ phytium_can_set_bittiming(dev); -+ -+ /* Acceptance identifier mask setup */ -+ phytium_can_write(cdev, CAN_ACC_ID0_MASK, ACC_IDX_MASK_AID_MASK); -+ phytium_can_write(cdev, CAN_ACC_ID1_MASK, ACC_IDX_MASK_AID_MASK); -+ phytium_can_write(cdev, CAN_ACC_ID2_MASK, ACC_IDX_MASK_AID_MASK); -+ phytium_can_write(cdev, CAN_ACC_ID3_MASK, ACC_IDX_MASK_AID_MASK); -+ ctrl |= CTRL_AIME; -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) -+ ctrl |= CTRL_IOF | CTRL_FDCRC; -+ -+ phytium_can_write(cdev, CAN_CTRL, ctrl); -+ -+ cdev->can.state = CAN_STATE_ERROR_ACTIVE; -+ -+ phytium_can_enable_all_interrupts(cdev); -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_LISTENONLY) -+ ctrl |= CTRL_XFER; -+ else -+ ctrl |= CTRL_XFER | CTRL_TXREQ; -+ -+ phytium_can_write(cdev, CAN_CTRL, ctrl); -+} -+ -+/** -+ * phytium_can_stop - Driver stop routine -+ * @dev: Pointer to net_device structure -+ * -+ * This is the drivers stop routine. It will disable the -+ * interrupts and put the device into configuration mode. -+ */ -+static void phytium_can_stop(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ u32 ctrl; -+ -+ /* Disable all interrupts */ -+ phytium_can_disable_all_interrupt(cdev); -+ -+ /* Disable transfer and switch to receive-only mode */ -+ ctrl = phytium_can_read(cdev, CAN_CTRL); -+ ctrl &= ~(CTRL_XFER | CTRL_TXREQ); -+ phytium_can_write(cdev, CAN_CTRL, ctrl); -+ -+ /* Set the state as STOPPED */ -+ cdev->can.state = CAN_STATE_STOPPED; -+} -+ -+static void phytium_can_clean(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ if (cdev->tx_skb) { -+ dev->stats.tx_errors++; -+ can_free_echo_skb(cdev->net, 0); -+ cdev->tx_skb = NULL; -+ } -+} -+ -+static int phytium_can_set_mode(struct net_device *dev, enum can_mode mode) -+{ -+ switch (mode) { -+ case CAN_MODE_START: -+ phytium_can_clean(dev); -+ phytium_can_start(dev); -+ netif_wake_queue(dev); -+ break; -+ default: -+ return -EOPNOTSUPP; -+ } -+ return 0; -+} -+ -+/** -+ * phytium_can_open - Driver open routine -+ * @dev: Pointer to net_device structure -+ * -+ * This is the driver open routine. -+ * Return: 0 on success and failure value on error -+ */ -+static int phytium_can_open(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ int ret; -+ -+ ret = pm_runtime_get_sync(cdev->dev); -+ if (ret < 0) { -+ netdev_err(dev, "%s: pm_runtime_get failed(%d)\n", -+ __func__, ret); -+ return ret; -+ } -+ /* Open the CAN device */ -+ ret = open_candev(dev); -+ if (ret) { -+ netdev_err(dev, "failed to open can device\n"); -+ goto disable_clk; -+ } -+ -+ /* Register interrupt handler */ -+ ret = request_irq(dev->irq, phytium_can_isr, -+ IRQF_SHARED, dev->name, dev); -+ if (ret < 0) { -+ netdev_err(dev, "failed to request interrupt\n"); -+ goto fail; -+ } -+ -+ /* Start the controller */ -+ phytium_can_start(dev); -+ -+ can_led_event(dev, CAN_LED_EVENT_OPEN); -+ napi_enable(&cdev->napi); -+ cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; -+ netif_start_queue(dev); -+ -+ return 0; -+ -+fail: -+ pm_runtime_put(cdev->dev); -+ close_candev(dev); -+disable_clk: -+ pm_runtime_put_sync(cdev->dev); -+ return ret; -+} -+ -+/** -+ * phytium_can_close - Driver close routine -+ * @dev: Pointer to net_device structure -+ * -+ * Return: 0 always -+ */ -+static int phytium_can_close(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ netif_stop_queue(dev); -+ napi_disable(&cdev->napi); -+ -+ phytium_can_stop(dev); -+ free_irq(dev->irq, dev); -+ pm_runtime_put_sync(cdev->dev); -+ -+ close_candev(dev); -+ can_led_event(dev, CAN_LED_EVENT_STOP); -+ -+ return 0; -+} -+ -+/** -+ * phytium_can_start_xmit - Starts the transmission -+ * -+ * Return: 0 on success. -+ */ -+static netdev_tx_t phytium_can_start_xmit(struct sk_buff *skb, struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ if (can_dropped_invalid_skb(dev, skb)) -+ return NETDEV_TX_OK; -+ -+ cdev->tx_skb = skb; -+ -+ return phytium_can_tx_handler(cdev); -+} -+ -+static const struct net_device_ops phytium_can_netdev_ops = { -+ .ndo_open = phytium_can_open, -+ .ndo_stop = phytium_can_close, -+ .ndo_start_xmit = phytium_can_start_xmit, -+ .ndo_change_mtu = can_change_mtu, -+}; -+ -+static int register_phytium_can_dev(struct net_device *dev) -+{ -+ dev->flags |= IFF_ECHO; -+ dev->netdev_ops = &phytium_can_netdev_ops; -+ -+ return register_candev(dev); -+} -+ -+static int phytium_can_dev_setup(struct phytium_can_dev *cdev) -+{ -+ struct net_device *dev = cdev->net; -+ -+ netif_napi_add(dev, &cdev->napi, phytium_can_poll, 64); -+ -+ cdev->can.do_set_mode = phytium_can_set_mode; -+ cdev->can.do_get_berr_counter = phytium_can_get_berr_counter; -+ -+ cdev->can.ctrlmode_supported = CAN_CTRLMODE_LISTENONLY | -+ CAN_CTRLMODE_BERR_REPORTING; -+ cdev->can.bittiming_const = cdev->bit_timing; -+ -+ if (cdev->fdmode) { -+ cdev->can.ctrlmode_supported |= CAN_CTRLMODE_FD; -+ dev->mtu = CANFD_MTU; -+ cdev->can.ctrlmode = CAN_CTRLMODE_FD; -+ cdev->can.data_bittiming_const = cdev->bit_timing; -+ } -+ spin_lock_init(&cdev->lock); -+ return 0; -+} -+ -+struct phytium_can_dev *phytium_can_allocate_dev(struct device *dev, int sizeof_priv, -+ int tx_fifo_depth) -+{ -+ struct phytium_can_dev *cdev = NULL; -+ struct net_device *net_dev; -+ -+ /* Allocate the can device struct */ -+ net_dev = alloc_candev(sizeof_priv, tx_fifo_depth); -+ if (!net_dev) { -+ dev_err(dev, "Failed to allocate CAN device.\n"); -+ goto out; -+ } -+ -+ cdev = netdev_priv(net_dev); -+ cdev->net = net_dev; -+ cdev->dev = dev; -+ SET_NETDEV_DEV(net_dev, dev); -+ -+out: -+ return cdev; -+} -+EXPORT_SYMBOL(phytium_can_allocate_dev); -+ -+void phytium_can_free_dev(struct net_device *net) -+{ -+ free_candev(net); -+} -+EXPORT_SYMBOL(phytium_can_free_dev); -+ -+int phytium_can_register(struct phytium_can_dev *cdev) -+{ -+ int ret; -+ -+ ret = phytium_can_dev_setup(cdev); -+ if (ret) -+ goto fail; -+ -+ ret = register_phytium_can_dev(cdev->net); -+ if (ret) { -+ dev_err(cdev->dev, "registering %s failed (err=%d)\n", -+ cdev->net->name, ret); -+ goto fail; -+ } -+ -+ devm_can_led_init(cdev->net); -+ -+ dev_info(cdev->dev, "%s device registered (irq=%d)\n", -+ KBUILD_MODNAME, cdev->net->irq); -+ -+ /* Probe finished -+ * Stop clocks. They will be reactivated once the device is opened. -+ */ -+ pm_runtime_put_sync(cdev->dev); -+ -+ return 0; -+ -+fail: -+ pm_runtime_put_sync(cdev->dev); -+ return ret; -+} -+EXPORT_SYMBOL(phytium_can_register); -+ -+void phytium_can_unregister(struct phytium_can_dev *cdev) -+{ -+ unregister_candev(cdev->net); -+} -+EXPORT_SYMBOL(phytium_can_unregister); -+ -+int phytium_can_suspend(struct device *dev) -+{ -+ struct net_device *ndev = dev_get_drvdata(dev); -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ -+ if (netif_running(ndev)) { -+ netif_stop_queue(ndev); -+ netif_device_detach(ndev); -+ phytium_can_stop(ndev); -+ pm_runtime_put_sync(cdev->dev); -+ } -+ -+ cdev->can.state = CAN_STATE_SLEEPING; -+ -+ return 0; -+} -+EXPORT_SYMBOL(phytium_can_suspend); -+ -+int phytium_can_resume(struct device *dev) -+{ -+ struct net_device *ndev = dev_get_drvdata(dev); -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ int ret; -+ -+ cdev->can.state = CAN_STATE_ERROR_ACTIVE; -+ -+ if (netif_running(ndev)) { -+ ret = pm_runtime_resume(cdev->dev); -+ if (ret) -+ return ret; -+ -+ phytium_can_start(ndev); -+ netif_device_attach(ndev); -+ netif_start_queue(ndev); -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL(phytium_can_resume); -+ -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("CAN bus driver for Phytium CAN controller"); -+ -diff --git a/drivers/net/can/phytium/phytium_can.h b/drivers/net/can/phytium/phytium_can.h -new file mode 100644 -index 000000000..a13969613 ---- /dev/null -+++ b/drivers/net/can/phytium/phytium_can.h -@@ -0,0 +1,73 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium CAN controller driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _PHYTIUM_CAN_H_ -+#define _PHYTIUM_CAN_H_ -+ -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define KEEP_CAN_FIFO_MIN_LEN 16 -+#define KEEP_CANFD_FIFO_MIN_LEN 128 -+#define CAN_FIFO_BYTE_LEN 256 -+#define STOP_QUEUE_TRUE 1 -+#define STOP_QUEUE_FALSE 0 -+ -+enum phytium_can_ip_type { -+ PHYTIUM_CAN = 0, -+ PHYTIUM_CANFD, -+}; -+ -+struct phytium_can_devtype { -+ enum phytium_can_ip_type cantype; -+ const struct can_bittiming_const *bittiming_const; -+}; -+ -+struct phytium_can_dev { -+ struct can_priv can; -+ unsigned int tx_head; -+ unsigned int tx_tail; -+ unsigned int tx_max; -+ struct napi_struct napi; -+ struct net_device *net; -+ struct device *dev; -+ struct clk *clk; -+ -+ struct sk_buff *tx_skb; -+ -+ const struct can_bittiming_const *bit_timing; -+ spinlock_t lock; -+ int fdmode; -+ u32 isr; -+ u32 tx_fifo_depth; -+ unsigned int is_stop_queue_flag; -+ struct completion comp; -+ void __iomem *base; -+}; -+ -+struct phytium_can_dev *phytium_can_allocate_dev(struct device *dev, int sizeof_priv, -+ int tx_fifo_depth); -+void phytium_can_free_dev(struct net_device *net); -+ -+int phytium_can_register(struct phytium_can_dev *cdev); -+void phytium_can_unregister(struct phytium_can_dev *cdev); -+ -+int phytium_can_suspend(struct device *dev); -+int phytium_can_resume(struct device *dev); -+#endif /* _PHYTIUM_CAN_H_ */ -diff --git a/drivers/net/can/phytium/phytium_can_pci.c b/drivers/net/can/phytium/phytium_can_pci.c -new file mode 100644 -index 000000000..73d58009e ---- /dev/null -+++ b/drivers/net/can/phytium/phytium_can_pci.c -@@ -0,0 +1,152 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Platform CAN bus driver for Phytium CAN controller -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+ -+#include "phytium_can.h" -+ -+struct phytium_can_pci_config { -+ const struct phytium_can_devtype *devtype; -+ unsigned int clock_freq; -+ unsigned int tx_fifo_depth; -+}; -+ -+#define cdev2priv(dev) container_of(dev, struct phytium_can_pci, cdev) -+ -+struct phytium_can_pci { -+ struct phytium_can_dev cdev; -+ -+ void __iomem *base; -+}; -+ -+static const struct can_bittiming_const phytium_bittiming_const_8192 = { -+ .name = "phytium_can", -+ .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ -+ .tseg1_max = 16, -+ .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ -+ .tseg2_max = 8, -+ .sjw_max = 4, /* Synchronisation jump width */ -+ .brp_min = 1, /* Bit-rate prescaler */ -+ .brp_max = 8192, -+ .brp_inc = 2, -+}; -+ -+static const struct phytium_can_devtype phytium_can_pci = { -+ .cantype = PHYTIUM_CAN, -+ .bittiming_const = &phytium_bittiming_const_8192, -+}; -+ -+static const struct phytium_can_pci_config phytium_can_pci_data = { -+ .devtype = &phytium_can_pci, -+ .clock_freq = 600000000, -+ .tx_fifo_depth = 64, -+}; -+ -+static int phytium_can_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) -+{ -+ const struct phytium_can_pci_config *cfg; -+ struct phytium_can_dev *cdev; -+ struct phytium_can_pci *priv; -+ int ret; -+ -+ cfg = (const struct phytium_can_pci_config *)id->driver_data; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ goto err; -+ -+ ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); -+ if (ret) -+ goto err; -+ -+ cdev = phytium_can_allocate_dev(&pdev->dev, sizeof(struct phytium_can_pci), -+ cfg->tx_fifo_depth); -+ if (!cdev) -+ return -ENOMEM; -+ -+ priv = cdev2priv(cdev); -+ priv->base = pcim_iomap_table(pdev)[0]; -+ -+ cdev->dev = &pdev->dev; -+ cdev->fdmode = cfg->devtype->cantype; -+ cdev->bit_timing = cfg->devtype->bittiming_const; -+ cdev->can.clock.freq = cfg->clock_freq; -+ cdev->tx_fifo_depth = cfg->tx_fifo_depth; -+ -+ cdev->tx_head = 0; -+ cdev->tx_tail = 0; -+ cdev->tx_max = cfg->tx_fifo_depth; -+ -+ cdev->base = priv->base; -+ cdev->net->irq = pdev->irq; -+ -+ pci_set_drvdata(pdev, cdev->net); -+ -+ if (!pm_runtime_enabled(cdev->dev)) -+ pm_runtime_enable(cdev->dev); -+ ret = pm_runtime_get_sync(cdev->dev); -+ if (ret < 0) { -+ netdev_err(cdev->net, "%s: pm_runtime_get failed(%d)\n", -+ __func__, ret); -+ goto err_pmdisable; -+ } -+ ret = phytium_can_register(cdev); -+ if (ret) -+ goto err; -+ -+ return 0; -+ -+err_pmdisable: -+ pm_runtime_disable(&pdev->dev); -+err: -+ return ret; -+} -+ -+static void phytium_can_pci_remove(struct pci_dev *pdev) -+{ -+ struct net_device *dev = pci_get_drvdata(pdev); -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ pm_runtime_disable(cdev->dev); -+ -+ phytium_can_unregister(cdev); -+ phytium_can_free_dev(cdev->net); -+} -+ -+static __maybe_unused int phytium_can_pci_suspend(struct device *dev) -+{ -+ return phytium_can_suspend(dev); -+} -+ -+static __maybe_unused int phytium_can_pci_resume(struct device *dev) -+{ -+ return phytium_can_resume(dev); -+} -+ -+static SIMPLE_DEV_PM_OPS(phytium_can_pci_pm_ops, -+ phytium_can_pci_suspend, phytium_can_pci_resume); -+ -+static const struct pci_device_id phytium_can_pci_id_table[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc2d), (kernel_ulong_t)&phytium_can_pci_data, }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(pci, phytium_can_pci_id_table); -+ -+static struct pci_driver phytium_can_pci_driver = { -+ .name = KBUILD_MODNAME, -+ .probe = phytium_can_pci_probe, -+ .remove = phytium_can_pci_remove, -+ .id_table = phytium_can_pci_id_table, -+ .driver = { -+ .pm = &phytium_can_pci_pm_ops, -+ }, -+}; -+ -+module_pci_driver(phytium_can_pci_driver); -+ -+MODULE_AUTHOR("Cheng Quan -+#include -+#include -+ -+#include "phytium_can.h" -+ -+#define cdev2priv(dev) container_of(dev, struct phytium_can_plat, cdev) -+ -+struct phytium_can_plat { -+ struct phytium_can_dev cdev; -+ struct phytium_can_devtype *devtype; -+ -+ int irq; -+ void __iomem *reg_base; -+}; -+ -+static const struct can_bittiming_const phytium_bittiming_const_512 = { -+ .name = "phytium_can", -+ .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ -+ .tseg1_max = 16, -+ .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ -+ .tseg2_max = 8, -+ .sjw_max = 4, /* Synchronisation jump width */ -+ .brp_min = 1, /* Bit-rate prescaler */ -+ .brp_max = 512, -+ .brp_inc = 2, -+}; -+ -+static const struct can_bittiming_const phytium_bittiming_const_8192 = { -+ .name = "phytium_can", -+ .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ -+ .tseg1_max = 16, -+ .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ -+ .tseg2_max = 8, -+ .sjw_max = 4, /* Synchronisation jump width */ -+ .brp_min = 1, /* Bit-rate prescaler */ -+ .brp_max = 8192, -+ .brp_inc = 2, -+}; -+ -+static const struct phytium_can_devtype phytium_can_data = { -+ .cantype = PHYTIUM_CAN, -+ .bittiming_const = &phytium_bittiming_const_512, -+}; -+ -+static const struct phytium_can_devtype phytium_canfd_data = { -+ .cantype = PHYTIUM_CANFD, -+ .bittiming_const = &phytium_bittiming_const_8192, -+}; -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_can_acpi_ids[] = { -+ { "PHYT000A", 0 }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_can_acpi_ids); -+#endif -+ -+#ifdef CONFIG_OF -+static const struct of_device_id phytium_can_of_ids[] = { -+ { .compatible = "phytium,can", .data = &phytium_can_data }, -+ { .compatible = "phytium,canfd", .data = &phytium_canfd_data }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(of, phytium_can_of_ids); -+#endif -+ -+ -+static int phytium_can_plat_probe(struct platform_device *pdev) -+{ -+ struct phytium_can_dev *cdev; -+ struct phytium_can_plat *priv; -+ struct resource *res; -+ const struct of_device_id *of_id; -+ const struct phytium_can_devtype *devtype = &phytium_can_data; -+ u32 tx_fifo_depth; -+ int ret; -+ const char *mode; -+ -+ ret = fwnode_property_read_u32(dev_fwnode(&pdev->dev), "tx-fifo-depth", &tx_fifo_depth); -+ if (ret) -+ tx_fifo_depth = 64; -+ -+ cdev = phytium_can_allocate_dev(&pdev->dev, sizeof(struct phytium_can_plat), -+ tx_fifo_depth); -+ if (!cdev) -+ return -ENOMEM; -+ -+ priv = cdev2priv(cdev); -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ priv->reg_base = devm_ioremap_resource(&pdev->dev, res); -+ priv->irq = platform_get_irq(pdev, 0); -+ if (IS_ERR(priv->reg_base) || cdev->net->irq < 0) { -+ ret = -EINVAL; -+ goto fail; -+ } -+ -+ if (pdev->dev.of_node) { -+ cdev->clk = devm_clk_get(&pdev->dev, "can_clk"); -+ if (IS_ERR(cdev->clk)) { -+ dev_err(&pdev->dev, "no clock found\n"); -+ ret = -ENODEV; -+ goto fail; -+ } -+ cdev->can.clock.freq = clk_get_rate(cdev->clk); -+ -+ of_id = of_match_device(phytium_can_of_ids, &pdev->dev); -+ if (of_id && of_id->data) -+ devtype = of_id->data; -+ } else if (has_acpi_companion(&pdev->dev)) { -+ ret = fwnode_property_read_u32(dev_fwnode(&pdev->dev), -+ "clock-frequency", -+ &cdev->can.clock.freq); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "failed to get clock frequency.\n"); -+ goto fail; -+ } -+ ret = fwnode_property_read_string(dev_fwnode(&pdev->dev), "mode-select", &mode); -+ if (ret < 0) { -+ dev_info(&pdev->dev, "get mode-select ret: %d\n", ret); -+ } -+ else { -+ if (strncmp("canfd", mode, strlen("canfd")) == 0) { -+ dev_info(&pdev->dev, "use mode-select: canfd\n"); -+ devtype = &phytium_canfd_data; -+ } -+ } -+ } -+ -+ cdev->tx_fifo_depth = tx_fifo_depth; -+ -+ if (devtype->cantype == PHYTIUM_CANFD) -+ cdev->fdmode = 1; -+ else -+ cdev->fdmode = 0; -+ -+ if (fwnode_property_present(dev_fwnode(&pdev->dev), "extend_brp")) -+ cdev->bit_timing = &phytium_bittiming_const_8192; -+ else -+ cdev->bit_timing = devtype->bittiming_const; -+ cdev->can.bittiming_const = devtype->bittiming_const; -+ cdev->base = priv->reg_base; -+ cdev->net->irq = priv->irq; -+ -+ platform_set_drvdata(pdev, cdev->net); -+ -+ pm_runtime_enable(cdev->dev); -+ ret = phytium_can_register(cdev); -+ if (ret) -+ goto out_runtime_disable; -+ -+ return ret; -+ -+out_runtime_disable: -+ pm_runtime_disable(cdev->dev); -+fail: -+ phytium_can_free_dev(cdev->net); -+ return ret; -+} -+ -+static __maybe_unused int phytium_can_plat_suspend(struct device *dev) -+{ -+ return phytium_can_suspend(dev); -+} -+ -+static __maybe_unused int phytium_can_plat_resume(struct device *dev) -+{ -+ return phytium_can_resume(dev); -+} -+ -+static int phytium_can_plat_remove(struct platform_device *pdev) -+{ -+ struct net_device *dev = platform_get_drvdata(pdev); -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ phytium_can_unregister(cdev); -+ -+ phytium_can_free_dev(cdev->net); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_can_runtime_suspend(struct device *dev) -+{ -+ struct net_device *ndev = dev_get_drvdata(dev); -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ -+ clk_disable_unprepare(cdev->clk); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_can_runtime_resume(struct device *dev) -+{ -+ struct net_device *ndev = dev_get_drvdata(dev); -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ -+ return clk_prepare_enable(cdev->clk); -+} -+ -+static const struct dev_pm_ops phytium_can_plat_pm_ops = { -+ SET_RUNTIME_PM_OPS(phytium_can_runtime_suspend, -+ phytium_can_runtime_resume, NULL) -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_can_suspend, phytium_can_resume) -+}; -+ -+static struct platform_driver phytium_can_plat_driver = { -+ .driver = { -+ .name = KBUILD_MODNAME, -+ .of_match_table = of_match_ptr(phytium_can_of_ids), -+ .acpi_match_table = ACPI_PTR(phytium_can_acpi_ids), -+ .pm = &phytium_can_plat_pm_ops, -+ }, -+ .probe = phytium_can_plat_probe, -+ .remove = phytium_can_plat_remove, -+}; -+ -+module_platform_driver(phytium_can_plat_driver); -+ -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium CAN driver for IO Mapped controllers"); -diff --git a/drivers/net/ethernet/cadence/Kconfig b/drivers/net/ethernet/cadence/Kconfig -index e432a68ac..0fb01824d 100644 ---- a/drivers/net/ethernet/cadence/Kconfig -+++ b/drivers/net/ethernet/cadence/Kconfig -@@ -50,4 +50,10 @@ config MACB_PCI - To compile this driver as a module, choose M here: the module - will be called macb_pci. - -+config MACB_TSN -+ bool "TSN supports" -+ depends on MACB -+ help -+ This is TSN supports for MACB driver. -+ - endif # NET_VENDOR_CADENCE -diff --git a/drivers/net/ethernet/cadence/Makefile b/drivers/net/ethernet/cadence/Makefile -index 1f33cdca9..a48a4318d 100644 ---- a/drivers/net/ethernet/cadence/Makefile -+++ b/drivers/net/ethernet/cadence/Makefile -@@ -8,5 +8,9 @@ ifeq ($(CONFIG_MACB_USE_HWSTAMP),y) - macb-y += macb_ptp.o - endif - -+ifeq ($(CONFIG_MACB_TSN),y) -+macb-y += macb_tsn.o -+endif -+ - obj-$(CONFIG_MACB) += macb.o - obj-$(CONFIG_MACB_PCI) += macb_pci.o -diff --git a/drivers/net/ethernet/cadence/macb.h b/drivers/net/ethernet/cadence/macb.h -index 5de47f6fd..5f2395bac 100644 ---- a/drivers/net/ethernet/cadence/macb.h -+++ b/drivers/net/ethernet/cadence/macb.h -@@ -9,6 +9,7 @@ - - #include - #include -+#include - #include - #include - #include -@@ -17,6 +18,12 @@ - #define MACB_EXT_DESC - #endif - -+enum irq_type { -+ IRQ_TYPE_INTX = 1, -+ IRQ_TYPE_MSI = 2, -+ IRQ_TYPE_MAX = 3, -+}; -+ - #define MACB_GREGS_NBR 16 - #define MACB_GREGS_VERSION 2 - #define MACB_MAX_QUEUES 8 -@@ -77,10 +84,13 @@ - #define MACB_RBQPH 0x04D4 - - /* GEM register offsets. */ -+#define GEM_NCR 0x0000 /* Network Control */ - #define GEM_NCFGR 0x0004 /* Network Config */ - #define GEM_USRIO 0x000c /* User IO */ - #define GEM_DMACFG 0x0010 /* DMA Configuration */ - #define GEM_JML 0x0048 /* Jumbo Max Length */ -+#define GEM_HS_MAC_CONFIG 0x0050 /* GEM high speed config */ -+#define GEM_AXI_PIPE 0x0054 /* Axi max pipeline register*/ - #define GEM_HRB 0x0080 /* Hash Bottom */ - #define GEM_HRT 0x0084 /* Hash Top */ - #define GEM_SA1B 0x0088 /* Specific1 Bottom */ -@@ -157,6 +167,7 @@ - #define GEM_PEFTN 0x01f4 /* PTP Peer Event Frame Tx Ns */ - #define GEM_PEFRSL 0x01f8 /* PTP Peer Event Frame Rx Sec Low */ - #define GEM_PEFRN 0x01fc /* PTP Peer Event Frame Rx Ns */ -+#define GEM_PCSCNTRL 0x0200 /* PCS Control */ - #define GEM_DCFG1 0x0280 /* Design Config 1 */ - #define GEM_DCFG2 0x0284 /* Design Config 2 */ - #define GEM_DCFG3 0x0288 /* Design Config 3 */ -@@ -166,6 +177,10 @@ - #define GEM_DCFG7 0x0298 /* Design Config 7 */ - #define GEM_DCFG8 0x029C /* Design Config 8 */ - #define GEM_DCFG10 0x02A4 /* Design Config 10 */ -+#define GEM_DCFG12 0x02AC /* Design Config 12 */ -+#define GEM_USX_CONTROL 0x0A80 /* High speed PCS control register */ -+#define GEM_USX_STATUS 0x0A88 /* High speed PCS status register */ -+#define GEM_TAIL_ENABLE 0x0E7C /* Phytium: Enable tail */ - - #define GEM_TXBDCTRL 0x04cc /* TX Buffer Descriptor control register */ - #define GEM_RXBDCTRL 0x04d0 /* RX Buffer Descriptor control register */ -@@ -200,6 +215,37 @@ - #define GEM_IER(hw_q) (0x0600 + ((hw_q) << 2)) - #define GEM_IDR(hw_q) (0x0620 + ((hw_q) << 2)) - #define GEM_IMR(hw_q) (0x0640 + ((hw_q) << 2)) -+#define GEM_TAIL(hw_q) (0x0e80 + ((hw_q) << 2)) /* Phytium: tail register */ -+#define GEM_SRC_SEL_LN 0x1C04 -+#define GEM_DIV_SEL0_LN 0x1C08 -+#define GEM_DIV_SEL1_LN 0x1C0C -+#define GEM_PMA_XCVR_POWER_STATE 0x1C10 -+#define GEM_SPEED_MODE 0x1C14 -+#define GEM_MII_SELECT 0x1C18 -+#define GEM_SEL_MII_ON_RGMII 0x1C1C -+#define GEM_TX_CLK_SEL0 0x1C20 -+#define GEM_TX_CLK_SEL1 0x1C24 -+#define GEM_TX_CLK_SEL2 0x1C28 -+#define GEM_TX_CLK_SEL3 0x1C2C -+#define GEM_RX_CLK_SEL0 0x1C30 -+#define GEM_RX_CLK_SEL1 0x1C34 -+#define GEM_CLK_250M_DIV10_DIV100_SEL 0x1C38 -+#define GEM_TX_CLK_SEL5 0x1C3C -+#define GEM_TX_CLK_SEL6 0x1C40 -+#define GEM_RX_CLK_SEL4 0x1C44 -+#define GEM_RX_CLK_SEL5 0x1C48 -+#define GEM_TX_CLK_SEL3_0 0x1C70 -+#define GEM_TX_CLK_SEL4_0 0x1C74 -+#define GEM_RX_CLK_SEL3_0 0x1C78 -+#define GEM_RX_CLK_SEL4_0 0x1C7C -+#define GEM_RGMII_TX_CLK_SEL0 0x1C80 -+#define GEM_RGMII_TX_CLK_SEL1 0x1C84 -+ -+#define GEM_PHY_INT_ENABLE 0x1C88 -+#define GEM_PHY_INT_CLEAR 0x1C8C -+#define GEM_PHY_INT_STATE 0x1C90 -+ -+#define GEM_INTX_IRQ_MASK 0x1C7C /* Phytium: irq mask */ - - /* Bitfields in NCR */ - #define MACB_LB_OFFSET 0 /* reserved */ -@@ -231,6 +277,8 @@ - #define MACB_SRTSM_OFFSET 15 - #define MACB_OSSMODE_OFFSET 24 /* Enable One Step Synchro Mode */ - #define MACB_OSSMODE_SIZE 1 -+#define MACB_2PT5G_OFFSET 29 /* 2.5G operation selected */ -+#define MACB_2PT5G_SIZE 1 - - /* Bitfields in NCFGR */ - #define MACB_SPD_OFFSET 0 /* Speed */ -@@ -272,11 +320,19 @@ - #define MACB_IRXFCS_OFFSET 19 - #define MACB_IRXFCS_SIZE 1 - -+/* GEM specific NCR bitfields. */ -+#define GEM_ENABLE_HS_MAC_OFFSET 31 -+#define GEM_ENABLE_HS_MAC_SIZE 1 -+ - /* GEM specific NCFGR bitfields. */ -+#define GEM_FD_OFFSET 1 /* Full duplex */ -+#define GEM_FD_SIZE 1 - #define GEM_GBE_OFFSET 10 /* Gigabit mode enable */ - #define GEM_GBE_SIZE 1 - #define GEM_PCSSEL_OFFSET 11 - #define GEM_PCSSEL_SIZE 1 -+#define GEM_PAE_OFFSET 13 /* Pause enable */ -+#define GEM_PAE_SIZE 1 - #define GEM_CLK_OFFSET 18 /* MDC clock division */ - #define GEM_CLK_SIZE 3 - #define GEM_DBW_OFFSET 21 /* Data bus width */ -@@ -461,11 +517,21 @@ - #define MACB_REV_OFFSET 0 - #define MACB_REV_SIZE 16 - -+/* Bitfield in HS_MAC_CONFIG */ -+#define GEM_HS_MAC_SPEED_OFFSET 0 -+#define GEM_HS_MAC_SPEED_SIZE 3 -+ -+/* Bitfields in PCSCNTRL */ -+#define GEM_PCSAUTONEG_OFFSET 12 -+#define GEM_PCSAUTONEG_SIZE 1 -+ - /* Bitfields in DCFG1. */ - #define GEM_IRQCOR_OFFSET 23 - #define GEM_IRQCOR_SIZE 1 - #define GEM_DBWDEF_OFFSET 25 - #define GEM_DBWDEF_SIZE 3 -+#define GEM_NO_PCS_OFFSET 0 -+#define GEM_NO_PCS_SIZE 1 - - /* Bitfields in DCFG2. */ - #define GEM_RX_PKT_BUFF_OFFSET 20 -@@ -500,6 +566,30 @@ - #define GEM_RXBD_RDBUFF_OFFSET 8 - #define GEM_RXBD_RDBUFF_SIZE 4 - -+/* Bitfields in DCFG12. */ -+#define GEM_HIGH_SPEED_OFFSET 26 -+#define GEM_HIGH_SPEED_SIZE 1 -+ -+/* Bitfields in USX_CONTROL. */ -+#define GEM_USX_CTRL_SPEED_OFFSET 14 -+#define GEM_USX_CTRL_SPEED_SIZE 3 -+#define GEM_SERDES_RATE_OFFSET 12 -+#define GEM_SERDES_RATE_SIZE 2 -+#define GEM_RX_SCR_BYPASS_OFFSET 9 -+#define GEM_RX_SCR_BYPASS_SIZE 1 -+#define GEM_TX_SCR_BYPASS_OFFSET 8 -+#define GEM_TX_SCR_BYPASS_SIZE 1 -+#define GEM_RX_SYNC_RESET_OFFSET 2 -+#define GEM_RX_SYNC_RESET_SIZE 1 -+#define GEM_TX_EN_OFFSET 1 -+#define GEM_TX_EN_SIZE 1 -+#define GEM_SIGNAL_OK_OFFSET 0 -+#define GEM_SIGNAL_OK_SIZE 1 -+ -+/* Bitfields in USX_STATUS. */ -+#define GEM_USX_BLOCK_LOCK_OFFSET 0 -+#define GEM_USX_BLOCK_LOCK_SIZE 1 -+ - /* Bitfields in TISUBN */ - #define GEM_SUBNSINCR_OFFSET 0 - #define GEM_SUBNSINCRL_OFFSET 24 -@@ -555,6 +645,8 @@ - #define GEM_CMPC_SIZE 5 - #define GEM_CMPCEN_OFFSET 30 /* Compare C Enable */ - #define GEM_CMPCEN_SIZE 1 -+#define GEM_DROP_ON_MATCH_OFFSET 31 /* Drop on match */ -+#define GEM_DROP_ON_MATCH_SIZE 1 - - /* Bitfields in ETHT */ - #define GEM_ETHTCMP_OFFSET 0 /* EtherType compare value */ -@@ -567,6 +659,8 @@ - #define GEM_T2MASK_SIZE 16 - - /* Bitfields in T2CMPW1 */ -+#define GEM_T2VLANID_OFFSET 10 /* compare vlan id */ -+#define GEM_T2VLANID_SIZE 1 - #define GEM_T2DISMSK_OFFSET 9 /* disable mask */ - #define GEM_T2DISMSK_SIZE 1 - #define GEM_T2CMPOFST_OFFSET 7 /* compare offset */ -@@ -658,11 +752,16 @@ - #define MACB_CAPS_GEM_HAS_PTP 0x00000040 - #define MACB_CAPS_BD_RD_PREFETCH 0x00000080 - #define MACB_CAPS_NEEDS_RSTONUBR 0x00000100 -+#define MACB_CAPS_SEL_CLK 0x00000200 -+#define MACB_CAPS_TAILPTR 0x00001000 /* Phytium: tail register */ -+#define MACB_CAPS_CLK_HW_CHG 0x04000000 - #define MACB_CAPS_MACB_IS_EMAC 0x08000000 - #define MACB_CAPS_FIFO_MODE 0x10000000 - #define MACB_CAPS_GIGABIT_MODE_AVAILABLE 0x20000000 - #define MACB_CAPS_SG_DISABLED 0x40000000 - #define MACB_CAPS_MACB_IS_GEM 0x80000000 -+#define MACB_CAPS_PCS 0x01000000 -+#define MACB_CAPS_HIGH_SPEED 0x02000000 - - /* LSO settings */ - #define MACB_LSO_UFO_ENABLE 0x01 -@@ -1112,6 +1211,7 @@ struct macb_config { - struct clk **rx_clk, struct clk **tsu_clk); - int (*init)(struct platform_device *pdev); - int jumbo_max_len; -+ void (*sel_clk_hw)(struct macb *bp, int speed); - }; - - struct tsu_incr { -@@ -1132,6 +1232,7 @@ struct macb_queue { - unsigned int RBQS; - unsigned int RBQP; - unsigned int RBQPH; -+ unsigned int TAILADDR; - - unsigned int tx_head, tx_tail; - struct macb_dma_desc *tx_ring; -@@ -1191,6 +1292,7 @@ struct macb { - struct clk *rx_clk; - struct clk *tsu_clk; - struct net_device *dev; -+ struct ncsi_dev *ndev; - union { - struct macb_stats macb; - struct gem_stats gem; -@@ -1201,7 +1303,13 @@ struct macb { - struct mii_bus *mii_bus; - struct phylink *phylink; - struct phylink_config phylink_config; -+ struct phylink_pcs phylink_pcs; -+ int link; -+ int speed; -+ int duplex; -+ int use_ncsi; - -+ int force_phy_mode; - u32 caps; - unsigned int dma_burst_length; - -@@ -1244,6 +1352,19 @@ struct macb { - u32 rx_intr_mask; - - struct macb_pm_data pm_data; -+ -+ void (*sel_clk_hw)(struct macb *bp, int speed); -+ -+#ifdef CONFIG_MACB_TSN -+ u32 tsn_cap; -+ struct device_attribute cb_setting_attr; -+ struct device_attribute qci_setting_attr; -+ struct device_attribute qav_setting_attr; -+ struct device_attribute qbv_setting_attr; -+ struct device_attribute stream_id_attr; -+ u32 num_cb_streams; -+ u32 cb_history_len; -+#endif - }; - - #ifdef CONFIG_MACB_USE_HWSTAMP -@@ -1301,6 +1422,24 @@ static inline bool gem_has_ptp(struct macb *bp) - return !!(bp->caps & MACB_CAPS_GEM_HAS_PTP); - } - -+enum phytium_type { -+ PHYTIUM_DEV_1P0 = 1, -+ PHYTIUM_DEV_2P0, -+ PHYTIUM_DEV_3P0, -+}; -+ -+struct phytium_platform_pdata { -+ int phytium_dev_type; -+ struct clk *txclk; -+ struct clk *rxclk; -+ struct clk *tsu_clk; -+ u32 caps; -+ int irq_type; -+ int irq[4]; -+ phy_interface_t phy_interface; -+ const struct property_entry *properties; -+}; -+ - /** - * struct macb_platform_data - platform data for MACB Ethernet used for PCI registration - * @pclk: platform clock -@@ -1309,6 +1448,7 @@ static inline bool gem_has_ptp(struct macb *bp) - struct macb_platform_data { - struct clk *pclk; - struct clk *hclk; -+ struct phytium_platform_pdata phytium_macb_pdata; - }; - - #endif /* _MACB_H */ -diff --git a/drivers/net/ethernet/cadence/macb_main.c b/drivers/net/ethernet/cadence/macb_main.c -index 70d57ef95..bff1a934d 100644 ---- a/drivers/net/ethernet/cadence/macb_main.c -+++ b/drivers/net/ethernet/cadence/macb_main.c -@@ -35,8 +35,14 @@ - #include - #include - #include -+#include -+#include - #include "macb.h" - -+#ifdef CONFIG_MACB_TSN -+#include "macb_tsn.h" -+#endif -+ - /* This structure is only used for MACB on SiFive FU540 devices */ - struct sifive_fu540_macb_mgmt { - void __iomem *reg; -@@ -84,6 +90,14 @@ struct sifive_fu540_macb_mgmt { - #define MACB_WOL_HAS_MAGIC_PACKET (0x1 << 0) - #define MACB_WOL_ENABLED (0x1 << 1) - -+#define HS_SPEED_100M 0 -+#define HS_SPEED_1000M 1 -+#define HS_SPEED_2500M 2 -+#define HS_SPEED_5000M 3 -+#define HS_SPEED_10000M 4 -+#define MACB_SERDES_RATE_5G 0 -+#define MACB_SERDES_RATE_10G 1 -+ - /* Graceful stop timeouts in us. We should allow up to - * 1 frame time (10 Mbits/s, full-duplex, ignoring collisions) - */ -@@ -513,6 +527,10 @@ static void macb_validate(struct phylink_config *config, - state->interface != PHY_INTERFACE_MODE_RMII && - state->interface != PHY_INTERFACE_MODE_GMII && - state->interface != PHY_INTERFACE_MODE_SGMII && -+ state->interface != PHY_INTERFACE_MODE_2500BASEX && -+ state->interface != PHY_INTERFACE_MODE_5GBASER && -+ state->interface != PHY_INTERFACE_MODE_10GBASER && -+ state->interface != PHY_INTERFACE_MODE_USXGMII && - !phy_interface_mode_is_rgmii(state->interface)) { - bitmap_zero(supported, __ETHTOOL_LINK_MODE_MASK_NBITS); - return; -@@ -525,10 +543,47 @@ static void macb_validate(struct phylink_config *config, - return; - } - -+ if ((state->interface == PHY_INTERFACE_MODE_10GBASER || -+ state->interface == PHY_INTERFACE_MODE_USXGMII || -+ state->interface == PHY_INTERFACE_MODE_5GBASER) && -+ !(bp->caps & MACB_CAPS_HIGH_SPEED && -+ bp->caps & MACB_CAPS_PCS)) { -+ bitmap_zero(supported, __ETHTOOL_LINK_MODE_MASK_NBITS); -+ return; -+ } -+ - phylink_set_port_modes(mask); - phylink_set(mask, Autoneg); - phylink_set(mask, Asym_Pause); - -+ if (bp->caps & MACB_CAPS_GIGABIT_MODE_AVAILABLE && -+ (state->interface == PHY_INTERFACE_MODE_NA || -+ state->interface == PHY_INTERFACE_MODE_10GBASER || -+ state->interface == PHY_INTERFACE_MODE_USXGMII)) { -+ bp->speed = state->speed; -+ bp->link = 1; -+ bp->duplex = state->duplex; -+ if (bp->speed == SPEED_5000) { -+ phylink_set(mask, 5000baseT_Full); -+ } else { -+ phylink_set(mask, 10000baseCR_Full); -+ phylink_set(mask, 10000baseER_Full); -+ phylink_set(mask, 10000baseKR_Full); -+ phylink_set(mask, 10000baseLR_Full); -+ phylink_set(mask, 10000baseLRM_Full); -+ phylink_set(mask, 10000baseSR_Full); -+ phylink_set(mask, 10000baseT_Full); -+ } -+ if (state->interface != PHY_INTERFACE_MODE_NA) -+ goto out; -+ } -+ -+ if (state->interface == PHY_INTERFACE_MODE_2500BASEX) -+ phylink_set(mask, 2500baseX_Full); -+ -+ if (state->interface == PHY_INTERFACE_MODE_5GBASER) -+ phylink_set(mask, 5000baseT_Full); -+ - phylink_set(mask, 10baseT_Half); - phylink_set(mask, 10baseT_Full); - phylink_set(mask, 100baseT_Half); -@@ -545,23 +600,110 @@ static void macb_validate(struct phylink_config *config, - if (!(bp->caps & MACB_CAPS_NO_GIGABIT_HALF)) - phylink_set(mask, 1000baseT_Half); - } -- -+out: - bitmap_and(supported, supported, mask, __ETHTOOL_LINK_MODE_MASK_NBITS); - bitmap_and(state->advertising, state->advertising, mask, - __ETHTOOL_LINK_MODE_MASK_NBITS); - } - --static void macb_mac_pcs_get_state(struct phylink_config *config, -+static void macb_usx_pcs_link_up(struct phylink_pcs *pcs, unsigned int mode, -+ phy_interface_t interface, int speed, -+ int duplex) -+{ -+ struct macb *bp = container_of(pcs, struct macb, phylink_pcs); -+ u32 config; -+ -+ config = gem_readl(bp, USX_CONTROL); -+ if (speed == SPEED_10000) { -+ config = GEM_BFINS(SERDES_RATE, MACB_SERDES_RATE_10G, config); -+ config = GEM_BFINS(USX_CTRL_SPEED, HS_SPEED_10000M, config); -+ } else if (speed == SPEED_5000) { -+ config = GEM_BFINS(SERDES_RATE, MACB_SERDES_RATE_5G, config); -+ config = GEM_BFINS(USX_CTRL_SPEED, HS_SPEED_5000M, config); -+ } -+ -+ config &= ~(GEM_BIT(TX_SCR_BYPASS) | GEM_BIT(RX_SCR_BYPASS)); -+ /* reset */ -+ config &= ~(GEM_BIT(SIGNAL_OK) | GEM_BIT(TX_EN)); -+ config |= GEM_BIT(RX_SYNC_RESET); -+ -+ gem_writel(bp, USX_CONTROL, config); -+ -+ /* enable rx and tx */ -+ config &= ~(GEM_BIT(RX_SYNC_RESET)); -+ config |= GEM_BIT(SIGNAL_OK) | GEM_BIT(TX_EN); -+ -+ gem_writel(bp, USX_CONTROL, config); -+} -+ -+static void macb_usx_pcs_get_state(struct phylink_pcs *pcs, - struct phylink_link_state *state) -+{ -+ struct macb *bp = container_of(pcs, struct macb, phylink_pcs); -+ u32 val; -+ -+ if (state->interface == PHY_INTERFACE_MODE_5GBASER) -+ state->speed = SPEED_5000; -+ else if (state->interface == PHY_INTERFACE_MODE_10GBASER || -+ state->interface == PHY_INTERFACE_MODE_USXGMII) -+ state->speed = bp->speed; -+ -+ state->duplex = 1; -+ state->an_complete = 1; -+ -+ val = gem_readl(bp, USX_STATUS); -+ state->link = !!(val & GEM_BIT(USX_BLOCK_LOCK)); -+ val = gem_readl(bp, NCFGR); -+ if (val & GEM_BIT(PAE)) -+ state->pause = MLO_PAUSE_RX; -+} -+ -+static int macb_usx_pcs_config(struct phylink_pcs *pcs, -+ unsigned int mode, -+ phy_interface_t interface, -+ const unsigned long *advertising, -+ bool permit_pause_to_mac) -+{ -+ struct macb *bp = container_of(pcs, struct macb, phylink_pcs); -+ -+ gem_writel(bp, USX_CONTROL, gem_readl(bp, USX_CONTROL) | -+ GEM_BIT(SIGNAL_OK)); -+ -+ return 0; -+} -+ -+static void macb_pcs_get_state(struct phylink_pcs *pcs, -+ struct phylink_link_state *state) - { - state->link = 0; - } - --static void macb_mac_an_restart(struct phylink_config *config) -+static void macb_pcs_an_restart(struct phylink_pcs *pcs) - { - /* Not supported */ - } - -+static int macb_pcs_config(struct phylink_pcs *pcs, -+ unsigned int mode, -+ phy_interface_t interface, -+ const unsigned long *advertising, -+ bool permit_pause_to_mac) -+{ -+ return 0; -+} -+ -+static const struct phylink_pcs_ops macb_phylink_usx_pcs_ops = { -+ .pcs_get_state = macb_usx_pcs_get_state, -+ .pcs_config = macb_usx_pcs_config, -+ .pcs_link_up = macb_usx_pcs_link_up, -+}; -+ -+static const struct phylink_pcs_ops macb_phylink_pcs_ops = { -+ .pcs_get_state = macb_pcs_get_state, -+ .pcs_an_restart = macb_pcs_an_restart, -+ .pcs_config = macb_pcs_config, -+}; -+ - static void macb_mac_config(struct phylink_config *config, unsigned int mode, - const struct phylink_link_state *state) - { -@@ -569,25 +711,57 @@ static void macb_mac_config(struct phylink_config *config, unsigned int mode, - struct macb *bp = netdev_priv(ndev); - unsigned long flags; - u32 old_ctrl, ctrl; -+ u32 old_ncr, ncr; - - spin_lock_irqsave(&bp->lock, flags); - -- old_ctrl = ctrl = macb_or_gem_readl(bp, NCFGR); -+ ctrl = macb_or_gem_readl(bp, NCFGR); -+ old_ctrl = ctrl; -+ ncr = macb_or_gem_readl(bp, NCR); -+ old_ncr = ncr; - - if (bp->caps & MACB_CAPS_MACB_IS_EMAC) { - if (state->interface == PHY_INTERFACE_MODE_RMII) - ctrl |= MACB_BIT(RM9200_RMII); - } else if (macb_is_gem(bp)) { - ctrl &= ~(GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL)); -+ ncr &= ~GEM_BIT(ENABLE_HS_MAC); - -- if (state->interface == PHY_INTERFACE_MODE_SGMII) -+ if (state->interface == PHY_INTERFACE_MODE_SGMII || -+ state->interface == PHY_INTERFACE_MODE_2500BASEX) { - ctrl |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL); -+ } else if (state->interface == PHY_INTERFACE_MODE_10GBASER || -+ state->interface == PHY_INTERFACE_MODE_USXGMII || -+ state->interface == PHY_INTERFACE_MODE_5GBASER) { -+ ctrl |= GEM_BIT(PCSSEL); -+ ncr |= GEM_BIT(ENABLE_HS_MAC); -+ } - } - - /* Apply the new configuration, if any */ - if (old_ctrl ^ ctrl) - macb_or_gem_writel(bp, NCFGR, ctrl); - -+ if (old_ncr ^ ncr) -+ macb_or_gem_writel(bp, NCR, ncr); -+ -+ /* Disable AN for SGMII fixed link configuration, enable otherwise. -+ * Must be written after PCSSEL is set in NCFGR, -+ * otherwise writes will not take effect. -+ */ -+ if (macb_is_gem(bp) && (state->interface == PHY_INTERFACE_MODE_SGMII || -+ PHY_INTERFACE_MODE_2500BASEX)) { -+ u32 pcsctrl, old_pcsctrl; -+ -+ old_pcsctrl = gem_readl(bp, PCSCNTRL); -+ if (mode == MLO_AN_FIXED) -+ pcsctrl = old_pcsctrl & ~GEM_BIT(PCSAUTONEG); -+ else -+ pcsctrl = old_pcsctrl | GEM_BIT(PCSAUTONEG); -+ if (old_pcsctrl != pcsctrl) -+ gem_writel(bp, PCSCNTRL, pcsctrl); -+ } -+ - spin_unlock_irqrestore(&bp->lock, flags); - } - -@@ -600,18 +774,184 @@ static void macb_mac_link_down(struct phylink_config *config, unsigned int mode, - unsigned int q; - u32 ctrl; - -+ if (bp->use_ncsi) -+ ncsi_stop_dev(bp->ndev); -+ - if (!(bp->caps & MACB_CAPS_MACB_IS_EMAC)) - for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) - queue_writel(queue, IDR, - bp->rx_intr_mask | MACB_TX_INT_FLAGS | MACB_BIT(HRESP)); - - /* Disable Rx and Tx */ -- ctrl = macb_readl(bp, NCR) & ~(MACB_BIT(RE) | MACB_BIT(TE)); -+ ctrl = macb_readl(bp, NCR) & ~(MACB_BIT(RE) | MACB_BIT(TE)) & ~(MACB_BIT(2PT5G)); - macb_writel(bp, NCR, ctrl); - - netif_tx_stop_all_queues(ndev); - } - -+static void phytium_gem1p0_sel_clk(struct macb *bp, int speed) -+{ -+ if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER || -+ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ if (speed == SPEED_5000) { -+ gem_writel(bp, DIV_SEL0_LN, 0x8); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL0_LN, 0x8); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x0); /*0x1c10*/ -+ } else { -+ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x1); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ -+ } -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ gem_writel(bp, DIV_SEL0_LN, 0x8); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x0); /*0x1c10*/ -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ gem_writel(bp, DIV_SEL0_LN, 0x1); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x1); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ -+ gem_writel(bp, TX_CLK_SEL3_0, 0x0); /*0x1c70*/ -+ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ -+ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ -+ gem_writel(bp, RX_CLK_SEL4_0, 0x0); /*0x1c7c*/ -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { -+ if (speed == SPEED_1000) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x8); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x0); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ -+ gem_writel(bp, TX_CLK_SEL3_0, 0x0); /*0x1c70*/ -+ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ -+ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ -+ gem_writel(bp, RX_CLK_SEL4_0, 0x0); /*0x1c7c*/ -+ } else if (speed == SPEED_100 || speed == SPEED_10) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x8); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x0); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x1); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ -+ gem_writel(bp, TX_CLK_SEL3_0, 0x1); /*0x1c70*/ -+ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ -+ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ -+ gem_writel(bp, RX_CLK_SEL4_0, 0x1); /*0x1c7c*/ -+ } -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_RGMII || -+ bp->phy_interface == PHY_INTERFACE_MODE_RGMII_ID) { -+ if (speed == SPEED_1000) { -+ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ -+ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ -+ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x0); /*0x1c38*/ -+ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x1); /*0x1c80*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ -+ } else if (speed == SPEED_100) { -+ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ -+ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ -+ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x0); /*0x1c38*/ -+ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x0); /*0x1c80*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ -+ } else { -+ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ -+ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ -+ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x1); /*0x1c38*/ -+ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x0); /*0x1c80*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ -+ } -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_RMII) { -+ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ -+ } -+ -+ if (speed == SPEED_100) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_100M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_1000) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_1000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_2500) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_2500M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_5000) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_10000) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_10000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+} -+ -+static void phytium_gem2p0_sel_clk(struct macb *bp, int speed) -+{ -+ if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { -+ if (speed == SPEED_100 || speed == SPEED_10) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x1); /*0x1c0c*/ -+ } -+ } -+ -+ if (speed == SPEED_100 || speed == SPEED_10) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_100M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_1000) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_1000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_2500) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_2500M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+} -+ -+static void phytium_gem3p0_sel_clk(struct macb *bp, int speed) -+{ -+ if (speed == SPEED_100 || speed == SPEED_10) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_100M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_1000) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_1000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_2500) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_2500M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+} -+ - static void macb_mac_link_up(struct phylink_config *config, - struct phy_device *phy, - unsigned int mode, phy_interface_t interface, -@@ -624,9 +964,13 @@ static void macb_mac_link_up(struct phylink_config *config, - unsigned long flags; - unsigned int q; - u32 ctrl; -+ int err; - - spin_lock_irqsave(&bp->lock, flags); - -+ if (bp->caps & MACB_CAPS_SEL_CLK) -+ bp->sel_clk_hw(bp, speed); -+ - ctrl = macb_or_gem_readl(bp, NCFGR); - - ctrl &= ~(MACB_BIT(SPD) | MACB_BIT(FD)); -@@ -642,7 +986,7 @@ static void macb_mac_link_up(struct phylink_config *config, - if (macb_is_gem(bp)) { - ctrl &= ~GEM_BIT(GBE); - -- if (speed == SPEED_1000) -+ if (speed == SPEED_1000 || speed == SPEED_2500) - ctrl |= GEM_BIT(GBE); - } - -@@ -664,18 +1008,73 @@ static void macb_mac_link_up(struct phylink_config *config, - - macb_or_gem_writel(bp, NCFGR, ctrl); - -+ if (speed == SPEED_2500) { -+ u32 network_ctrl; -+ -+ network_ctrl = macb_readl(bp, NCR); -+ network_ctrl |= MACB_BIT(2PT5G); -+ macb_writel(bp, NCR, network_ctrl); -+ } -+ -+ if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER || -+ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { -+ if (speed == SPEED_5000) -+ gem_writel(bp, HS_MAC_CONFIG, -+ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else -+ gem_writel(bp, HS_MAC_CONFIG, -+ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_10000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) -+ gem_writel(bp, HS_MAC_CONFIG, -+ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ - spin_unlock_irqrestore(&bp->lock, flags); - - /* Enable Rx and Tx */ - macb_writel(bp, NCR, macb_readl(bp, NCR) | MACB_BIT(RE) | MACB_BIT(TE)); - -+ if (bp->use_ncsi) { -+ /* Start the NCSI device */ -+ err = ncsi_start_dev(bp->ndev); -+ if (err) { -+ netdev_err(bp->dev, "Ncsi start dev failed (error %d)\n", err); -+ return; -+ } -+ } -+ -+ bp->speed = speed; -+ - netif_tx_wake_all_queues(ndev); - } - -+static int macb_mac_prepare(struct phylink_config *config, unsigned int mode, -+ phy_interface_t interface) -+{ -+ struct net_device *ndev = to_net_dev(config->dev); -+ struct macb *bp = netdev_priv(ndev); -+ -+ if (interface == PHY_INTERFACE_MODE_10GBASER || -+ interface == PHY_INTERFACE_MODE_5GBASER || -+ interface == PHY_INTERFACE_MODE_USXGMII) -+ bp->phylink_pcs.ops = &macb_phylink_usx_pcs_ops; -+ else if (interface == PHY_INTERFACE_MODE_SGMII || -+ interface == PHY_INTERFACE_MODE_2500BASEX) -+ bp->phylink_pcs.ops = &macb_phylink_pcs_ops; -+ else -+ bp->phylink_pcs.ops = NULL; -+ -+ if (bp->phylink_pcs.ops) -+ phylink_set_pcs(bp->phylink, &bp->phylink_pcs); -+ -+ return 0; -+} -+ - static const struct phylink_mac_ops macb_phylink_ops = { - .validate = macb_validate, -- .mac_pcs_get_state = macb_mac_pcs_get_state, -- .mac_an_restart = macb_mac_an_restart, -+ .mac_prepare = macb_mac_prepare, - .mac_config = macb_mac_config, - .mac_link_down = macb_mac_link_down, - .mac_link_up = macb_mac_link_up, -@@ -693,8 +1092,14 @@ static int macb_phylink_connect(struct macb *bp) - struct device_node *dn = bp->pdev->dev.of_node; - struct net_device *dev = bp->dev; - struct phy_device *phydev; -+ struct macb_platform_data *pdata = dev_get_platdata(&bp->pdev->dev); - int ret; - -+ if (pdata && pdata->phytium_macb_pdata.properties) { -+ phylink_start(bp->phylink); -+ return 0; -+ } -+ - if (dn) - ret = phylink_of_phy_connect(bp->phylink, dn, 0); - -@@ -704,6 +1109,7 @@ static int macb_phylink_connect(struct macb *bp) - netdev_err(dev, "no PHY found\n"); - return -ENXIO; - } -+ phydev->force_mode = bp->force_phy_mode; - - /* attach the mac to the phy */ - ret = phylink_connect_phy(bp->phylink, phydev); -@@ -719,6 +1125,29 @@ static int macb_phylink_connect(struct macb *bp) - return 0; - } - -+static void macb_get_pcs_fixed_state(struct phylink_config *config, -+ struct phylink_link_state *state) -+{ -+ struct net_device *ndev = to_net_dev(config->dev); -+ struct macb *bp = netdev_priv(ndev); -+ -+ state->link = (macb_readl(bp, NSR) & MACB_BIT(NSR_LINK)) != 0; -+} -+ -+static void macb_get_usx_pcs_fixed_state(struct phylink_config *config, -+ struct phylink_link_state *state) -+{ -+ u32 val; -+ struct net_device *ndev = to_net_dev(config->dev); -+ struct macb *bp = netdev_priv(ndev); -+ -+ val = gem_readl(bp, USX_STATUS); -+ state->link = !!(val & GEM_BIT(USX_BLOCK_LOCK)); -+ val = gem_readl(bp, NCFGR); -+ if (val & GEM_BIT(PAE)) -+ state->pause = MLO_PAUSE_RX; -+} -+ - /* based on au1000_eth. c*/ - static int macb_mii_probe(struct net_device *dev) - { -@@ -727,8 +1156,19 @@ static int macb_mii_probe(struct net_device *dev) - bp->phylink_config.dev = &dev->dev; - bp->phylink_config.type = PHYLINK_NETDEV; - -+ if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII || -+ bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { -+ bp->phylink_config.poll_fixed_state = true; -+ bp->phylink_config.get_fixed_state = macb_get_pcs_fixed_state; -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER || -+ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { -+ bp->phylink_config.poll_fixed_state = true; -+ bp->phylink_config.get_fixed_state = macb_get_usx_pcs_fixed_state; -+ } -+ - bp->phylink = phylink_create(&bp->phylink_config, bp->pdev->dev.fwnode, - bp->phy_interface, &macb_phylink_ops); -+ - if (IS_ERR(bp->phylink)) { - netdev_err(dev, "Could not create a phylink instance (%ld)\n", - PTR_ERR(bp->phylink)); -@@ -2097,6 +2537,8 @@ static netdev_tx_t macb_start_xmit(struct sk_buff *skb, struct net_device *dev) - wmb(); - skb_tx_timestamp(skb); - -+ if (bp->caps & MACB_CAPS_TAILPTR) -+ queue_writel(queue, TAILADDR, BIT(31) | macb_tx_ring_wrap(bp, queue->tx_head)); - macb_writel(bp, NCR, macb_readl(bp, NCR) | MACB_BIT(TSTART)); - - if (CIRC_SPACE(queue->tx_head, queue->tx_tail, bp->tx_ring_size) < 1) -@@ -2294,6 +2736,9 @@ static void gem_init_rings(struct macb *bp) - queue->tx_head = 0; - queue->tx_tail = 0; - -+ if (bp->caps & MACB_CAPS_TAILPTR) -+ queue_writel(queue, TAILADDR, BIT(31) | queue->tx_head); -+ - queue->rx_tail = 0; - queue->rx_prepared_head = 0; - -@@ -2463,6 +2908,45 @@ static void macb_configure_dma(struct macb *bp) - } - } - -+static int phytium_mac_config(struct macb *bp) -+{ -+ u32 old_ctrl, ctrl; -+ u32 old_ncr, ncr; -+ -+ netdev_dbg(bp->dev, "phytium mac config"); -+ -+ ncr = macb_readl(bp, NCR); -+ old_ncr = ncr; -+ ctrl = macb_or_gem_readl(bp, NCFGR); -+ old_ctrl = ctrl; -+ -+ ncr &= ~(GEM_BIT(ENABLE_HS_MAC) | MACB_BIT(2PT5G)); -+ ctrl &= ~(GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL) | MACB_BIT(SPD) | MACB_BIT(FD)); -+ if (macb_is_gem(bp)) -+ ctrl &= ~GEM_BIT(GBE); -+ -+ if (bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { -+ ctrl |= GEM_BIT(PCSSEL) | GEM_BIT(SGMIIEN); -+ ncr |= MACB_BIT(2PT5G); -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_USXGMII || -+ bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) { -+ ctrl |= GEM_BIT(PCSSEL); -+ ncr |= GEM_BIT(ENABLE_HS_MAC); -+ } -+ -+ if (bp->duplex) -+ ctrl |= MACB_BIT(FD); -+ -+ /* Apply the new configuration, if any */ -+ if (old_ctrl ^ ctrl) -+ macb_or_gem_writel(bp, NCFGR, ctrl); -+ -+ if (old_ncr ^ ncr) -+ macb_or_gem_writel(bp, NCR, ncr); -+ -+ return 0; -+} -+ - static void macb_init_hw(struct macb *bp) - { - u32 config; -@@ -2491,6 +2975,25 @@ static void macb_init_hw(struct macb *bp) - if (bp->caps & MACB_CAPS_JUMBO) - bp->rx_frm_len_mask = MACB_RX_JFRMLEN_MASK; - -+ gem_writel(bp, AXI_PIPE, 0x1010); -+ if (bp->caps & MACB_CAPS_TAILPTR) -+ gem_writel(bp, TAIL_ENABLE, 0x80000001); -+ -+ if (bp->phy_interface == PHY_INTERFACE_MODE_USXGMII || -+ bp->phy_interface == PHY_INTERFACE_MODE_5GBASER || -+ bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { -+ /* phytium need hwclock */ -+ if (bp->caps & MACB_CAPS_SEL_CLK) -+ bp->sel_clk_hw(bp, bp->speed); -+ phytium_mac_config(bp); -+ if (bp->link) -+ macb_usx_pcs_link_up(&bp->phylink_pcs, 0, -+ bp->phy_interface, bp->speed, bp->duplex); -+ } else { -+ bp->speed = SPEED_10; -+ bp->duplex = DUPLEX_HALF; -+ } -+ - macb_configure_dma(bp); - } - -@@ -2615,7 +3118,10 @@ static void macb_set_rx_mode(struct net_device *dev) - - static int macb_open(struct net_device *dev) - { -- size_t bufsz = dev->mtu + ETH_HLEN + ETH_FCS_LEN + NET_IP_ALIGN; -+ /* adjust bufsz to be at least the size of a standard frame, -+ * to fix rx error when set small size mtu. -+ */ -+ size_t bufsz = (dev->mtu < ETH_DATA_LEN ? ETH_DATA_LEN : dev->mtu) + ETH_HLEN + ETH_FCS_LEN + NET_IP_ALIGN; - struct macb *bp = netdev_priv(dev); - struct macb_queue *queue; - unsigned int q; -@@ -3540,9 +4046,14 @@ static const struct net_device_ops macb_netdev_ops = { - .ndo_set_mac_address = eth_mac_addr, - #ifdef CONFIG_NET_POLL_CONTROLLER - .ndo_poll_controller = macb_poll_controller, -+#endif -+#ifdef CONFIG_MACB_TSN -+ .ndo_setup_tc = phytium_setup_tc, - #endif - .ndo_set_features = macb_set_features, - .ndo_features_check = macb_features_check, -+ .ndo_vlan_rx_add_vid = ncsi_vlan_rx_add_vid, -+ .ndo_vlan_rx_kill_vid = ncsi_vlan_rx_kill_vid, - }; - - /* Configure peripheral capabilities according to device tree -@@ -3552,16 +4063,26 @@ static void macb_configure_caps(struct macb *bp, - const struct macb_config *dt_conf) - { - u32 dcfg; -+ struct macb_platform_data *pdata; - - if (dt_conf) - bp->caps = dt_conf->caps; - -+ pdata = dev_get_platdata(&bp->pdev->dev); -+ if (pdata && pdata->phytium_macb_pdata.phytium_dev_type == PHYTIUM_DEV_3P0) -+ bp->caps |= pdata->phytium_macb_pdata.caps; -+ - if (hw_is_gem(bp->regs, bp->native_io)) { - bp->caps |= MACB_CAPS_MACB_IS_GEM; - - dcfg = gem_readl(bp, DCFG1); - if (GEM_BFEXT(IRQCOR, dcfg) == 0) - bp->caps |= MACB_CAPS_ISR_CLEAR_ON_WRITE; -+ if (GEM_BFEXT(NO_PCS, dcfg) == 0) -+ bp->caps |= MACB_CAPS_PCS; -+ dcfg = gem_readl(bp, DCFG12); -+ if (GEM_BFEXT(HIGH_SPEED, dcfg) == 1) -+ bp->caps |= MACB_CAPS_HIGH_SPEED; - dcfg = gem_readl(bp, DCFG2); - if ((dcfg & (GEM_BIT(RX_PKT_BUFF) | GEM_BIT(TX_PKT_BUFF))) == 0) - bp->caps |= MACB_CAPS_FIFO_MODE; -@@ -3603,9 +4124,10 @@ static void macb_probe_queues(void __iomem *mem, - *num_queues = hweight32(*queue_mask); - } - --static int macb_clk_init(struct platform_device *pdev, struct clk **pclk, -- struct clk **hclk, struct clk **tx_clk, -- struct clk **rx_clk, struct clk **tsu_clk) -+#ifdef CONFIG_ACPI -+static int phytium_clk_acpi_init(struct platform_device *pdev, struct clk **pclk, -+ struct clk **hclk, struct clk **tx_clk, -+ struct clk **rx_clk, struct clk **tsu_clk) - { - struct macb_platform_data *pdata; - int err; -@@ -3614,38 +4136,103 @@ static int macb_clk_init(struct platform_device *pdev, struct clk **pclk, - if (pdata) { - *pclk = pdata->pclk; - *hclk = pdata->hclk; -+ *tx_clk = pdata->phytium_macb_pdata.txclk; -+ *rx_clk = pdata->phytium_macb_pdata.rxclk; -+ *tsu_clk = pdata->phytium_macb_pdata.tsu_clk; - } else { -- *pclk = devm_clk_get(&pdev->dev, "pclk"); -- *hclk = devm_clk_get(&pdev->dev, "hclk"); -+ *pclk = NULL; -+ *hclk = NULL; -+ *tx_clk = NULL; -+ *rx_clk = NULL; -+ *tsu_clk = NULL; - } - -- if (IS_ERR_OR_NULL(*pclk)) { -- err = PTR_ERR(*pclk); -- if (!err) -- err = -ENODEV; -- -- dev_err(&pdev->dev, "failed to get macb_clk (%d)\n", err); -+ err = clk_prepare_enable(*pclk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable pclk (%d)\n", err); - return err; - } - -- if (IS_ERR_OR_NULL(*hclk)) { -- err = PTR_ERR(*hclk); -- if (!err) -- err = -ENODEV; -+ err = clk_prepare_enable(*hclk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable hclk (%d)\n", err); -+ goto err_disable_pclk; -+ } - -- dev_err(&pdev->dev, "failed to get hclk (%d)\n", err); -- return err; -+ err = clk_prepare_enable(*tx_clk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable tx_clk (%d)\n", err); -+ goto err_disable_hclk; - } - -- *tx_clk = devm_clk_get_optional(&pdev->dev, "tx_clk"); -+ err = clk_prepare_enable(*rx_clk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable rx_clk (%d)\n", err); -+ goto err_disable_txclk; -+ } -+ -+ err = clk_prepare_enable(*tsu_clk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable tsu_clk (%d)\n", err); -+ goto err_disable_rxclk; -+ } -+ -+ return 0; -+ -+err_disable_rxclk: -+ clk_disable_unprepare(*rx_clk); -+ -+err_disable_txclk: -+ clk_disable_unprepare(*tx_clk); -+ -+err_disable_hclk: -+ clk_disable_unprepare(*hclk); -+ -+err_disable_pclk: -+ clk_disable_unprepare(*pclk); -+ -+ return err; -+} -+#endif -+ -+static int phytium_clk_init(struct platform_device *pdev, struct clk **pclk, -+ struct clk **hclk, struct clk **tx_clk, -+ struct clk **rx_clk, struct clk **tsu_clk) -+{ -+ struct macb_platform_data *pdata; -+ int err; -+ -+ pdata = dev_get_platdata(&pdev->dev); -+ if (pdata) { -+ *pclk = pdata->pclk; -+ *hclk = pdata->hclk; -+ *tx_clk = pdata->phytium_macb_pdata.txclk; -+ *rx_clk = pdata->phytium_macb_pdata.rxclk; -+ *tsu_clk = pdata->phytium_macb_pdata.tsu_clk; -+ } else { -+ *pclk = devm_clk_get(&pdev->dev, "pclk"); -+ *hclk = devm_clk_get(&pdev->dev, "hclk"); -+ *tx_clk = devm_clk_get_optional(&pdev->dev, "tx_clk"); -+ *rx_clk = devm_clk_get_optional(&pdev->dev, "rx_clk"); -+ *tsu_clk = devm_clk_get_optional(&pdev->dev, "tsu_clk"); -+ } -+ -+ if (IS_ERR_OR_NULL(*pclk)) -+ return dev_err_probe(&pdev->dev, -+ IS_ERR(*pclk) ? PTR_ERR(*pclk) : -ENODEV, -+ "failed to get pclk\n"); -+ -+ if (IS_ERR_OR_NULL(*hclk)) -+ return dev_err_probe(&pdev->dev, -+ IS_ERR(*hclk) ? PTR_ERR(*hclk) : -ENODEV, -+ "failed to get hclk\n"); -+ - if (IS_ERR(*tx_clk)) - return PTR_ERR(*tx_clk); - -- *rx_clk = devm_clk_get_optional(&pdev->dev, "rx_clk"); - if (IS_ERR(*rx_clk)) - return PTR_ERR(*rx_clk); - -- *tsu_clk = devm_clk_get_optional(&pdev->dev, "tsu_clk"); - if (IS_ERR(*tsu_clk)) - return PTR_ERR(*tsu_clk); - -@@ -3696,30 +4283,346 @@ static int macb_clk_init(struct platform_device *pdev, struct clk **pclk, - return err; - } - --static int macb_init(struct platform_device *pdev) -+static int macb_clk_init(struct platform_device *pdev, struct clk **pclk, -+ struct clk **hclk, struct clk **tx_clk, -+ struct clk **rx_clk, struct clk **tsu_clk) - { -- struct net_device *dev = platform_get_drvdata(pdev); -- unsigned int hw_q, q; -- struct macb *bp = netdev_priv(dev); -- struct macb_queue *queue; -+ struct macb_platform_data *pdata; - int err; -- u32 val, reg; - -- bp->tx_ring_size = DEFAULT_TX_RING_SIZE; -- bp->rx_ring_size = DEFAULT_RX_RING_SIZE; -+ pdata = dev_get_platdata(&pdev->dev); -+ if (pdata) { -+ *pclk = pdata->pclk; -+ *hclk = pdata->hclk; -+ } else { -+ *pclk = devm_clk_get(&pdev->dev, "pclk"); -+ *hclk = devm_clk_get(&pdev->dev, "hclk"); -+ } - -- /* set the queue register mapping once for all: queue0 has a special -- * register mapping but we don't want to test the queue index then -- * compute the corresponding register offset at run time. -- */ -- for (hw_q = 0, q = 0; hw_q < MACB_MAX_QUEUES; ++hw_q) { -- if (!(bp->queue_mask & (1 << hw_q))) -- continue; -+ if (IS_ERR_OR_NULL(*pclk)) { -+ err = PTR_ERR(*pclk); -+ if (!err) -+ err = -ENODEV; - -- queue = &bp->queues[q]; -- queue->bp = bp; -- netif_napi_add(dev, &queue->napi, macb_poll, NAPI_POLL_WEIGHT); -- if (hw_q) { -+ dev_err(&pdev->dev, "failed to get macb_clk (%d)\n", err); -+ return err; -+ } -+ -+ if (IS_ERR_OR_NULL(*hclk)) { -+ err = PTR_ERR(*hclk); -+ if (!err) -+ err = -ENODEV; -+ -+ dev_err(&pdev->dev, "failed to get hclk (%d)\n", err); -+ return err; -+ } -+ -+ *tx_clk = devm_clk_get_optional(&pdev->dev, "tx_clk"); -+ if (IS_ERR(*tx_clk)) -+ return PTR_ERR(*tx_clk); -+ -+ *rx_clk = devm_clk_get_optional(&pdev->dev, "rx_clk"); -+ if (IS_ERR(*rx_clk)) -+ return PTR_ERR(*rx_clk); -+ -+ *tsu_clk = devm_clk_get_optional(&pdev->dev, "tsu_clk"); -+ if (IS_ERR(*tsu_clk)) -+ return PTR_ERR(*tsu_clk); -+ -+ err = clk_prepare_enable(*pclk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable pclk (%d)\n", err); -+ return err; -+ } -+ -+ err = clk_prepare_enable(*hclk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable hclk (%d)\n", err); -+ goto err_disable_pclk; -+ } -+ -+ err = clk_prepare_enable(*tx_clk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable tx_clk (%d)\n", err); -+ goto err_disable_hclk; -+ } -+ -+ err = clk_prepare_enable(*rx_clk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable rx_clk (%d)\n", err); -+ goto err_disable_txclk; -+ } -+ -+ err = clk_prepare_enable(*tsu_clk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable tsu_clk (%d)\n", err); -+ goto err_disable_rxclk; -+ } -+ -+ return 0; -+ -+err_disable_rxclk: -+ clk_disable_unprepare(*rx_clk); -+ -+err_disable_txclk: -+ clk_disable_unprepare(*tx_clk); -+ -+err_disable_hclk: -+ clk_disable_unprepare(*hclk); -+ -+err_disable_pclk: -+ clk_disable_unprepare(*pclk); -+ -+ return err; -+} -+ -+static irqreturn_t phytium_macb_interrupt_intx(int irq, void *dev_id) -+{ -+ struct macb *bp = dev_id; -+ u32 irq_mask; -+ int i; -+ -+ irq_mask = gem_readl(bp, INTX_IRQ_MASK); -+ if (unlikely(!irq_mask)) -+ return IRQ_NONE; -+ -+ gem_writel(bp, INTX_IRQ_MASK, irq_mask); -+ -+ for (i = 0; i < bp->num_queues; i++) { -+ if ((irq_mask & bp->queue_mask) & BIT(i)) -+ macb_interrupt(irq, &bp->queues[i]); -+ } -+ return IRQ_HANDLED; -+} -+ -+static int phytium_queue_request_irq(struct platform_device *pdev, unsigned int q) -+{ -+ int err; -+ struct macb_queue *queue; -+ struct macb_platform_data *pdata = dev_get_platdata(&pdev->dev); -+ struct net_device *dev = platform_get_drvdata(pdev); -+ struct macb *bp = netdev_priv(dev); -+ -+ queue = &bp->queues[q]; -+ if (q == 0 && pdata->phytium_macb_pdata.irq_type == IRQ_TYPE_INTX) { -+ dev->irq = pdata->phytium_macb_pdata.irq[q]; -+ err = devm_request_irq(&pdev->dev, dev->irq, phytium_macb_interrupt_intx, -+ IRQF_SHARED, dev->name, bp); -+ if (err) { -+ dev_err(&pdev->dev, -+ "Unable to request dev %d (error %d)\n", -+ dev->irq, err); -+ } -+ } -+ -+ if (pdata->phytium_macb_pdata.irq_type == IRQ_TYPE_MSI) { -+ queue->irq = pdata->phytium_macb_pdata.irq[q]; -+ err = devm_request_irq(&pdev->dev, queue->irq, macb_interrupt, -+ 0, dev->name, queue); -+ if (err) { -+ dev_err(&pdev->dev, -+ "Unable to request IRQ %d (error %d)\n", -+ queue->irq, err); -+ } -+ } -+ -+ return err; -+} -+ -+static int phytium_init(struct platform_device *pdev) -+{ -+ struct net_device *dev = platform_get_drvdata(pdev); -+ unsigned int hw_q, q; -+ struct macb *bp = netdev_priv(dev); -+ struct macb_queue *queue; -+ int err; -+ u32 val, reg; -+ struct macb_platform_data *pdata; -+ -+ bp->tx_ring_size = DEFAULT_TX_RING_SIZE; -+ bp->rx_ring_size = DEFAULT_RX_RING_SIZE; -+ -+ pdata = dev_get_platdata(&pdev->dev); -+ -+ /* set the queue register mapping once for all: queue0 has a special -+ * register mapping but we don't want to test the queue index then -+ * compute the corresponding register offset at run time. -+ */ -+ for (hw_q = 0, q = 0; hw_q < MACB_MAX_QUEUES; ++hw_q) { -+ if (!(bp->queue_mask & (1 << hw_q))) -+ continue; -+ -+ queue = &bp->queues[q]; -+ queue->bp = bp; -+ netif_napi_add(dev, &queue->napi, macb_poll, NAPI_POLL_WEIGHT); -+ if (hw_q) { -+ queue->ISR = GEM_ISR(hw_q - 1); -+ queue->IER = GEM_IER(hw_q - 1); -+ queue->IDR = GEM_IDR(hw_q - 1); -+ queue->IMR = GEM_IMR(hw_q - 1); -+ queue->TBQP = GEM_TBQP(hw_q - 1); -+ queue->RBQP = GEM_RBQP(hw_q - 1); -+ queue->RBQS = GEM_RBQS(hw_q - 1); -+#ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT -+ if (bp->hw_dma_cap & HW_DMA_CAP_64B) { -+ queue->TBQPH = GEM_TBQPH(hw_q - 1); -+ queue->RBQPH = GEM_RBQPH(hw_q - 1); -+ } -+#endif -+ } else { -+ /* queue0 uses legacy registers */ -+ queue->ISR = MACB_ISR; -+ queue->IER = MACB_IER; -+ queue->IDR = MACB_IDR; -+ queue->IMR = MACB_IMR; -+ queue->TBQP = MACB_TBQP; -+ queue->RBQP = MACB_RBQP; -+#ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT -+ if (bp->hw_dma_cap & HW_DMA_CAP_64B) { -+ queue->TBQPH = MACB_TBQPH; -+ queue->RBQPH = MACB_RBQPH; -+ } -+#endif -+ } -+ -+ if (bp->caps & MACB_CAPS_TAILPTR) -+ queue->TAILADDR = GEM_TAIL(hw_q); -+ /* get irq: here we use the linux queue index, not the hardware -+ * queue index. the queue irq definitions in the device tree -+ * must remove the optional gaps that could exist in the -+ * hardware queue mask. -+ */ -+ if (pdata && pdata->phytium_macb_pdata.phytium_dev_type == PHYTIUM_DEV_3P0) { -+ err = phytium_queue_request_irq(pdev, q); -+ } else { -+ queue->irq = platform_get_irq(pdev, q); -+ err = devm_request_irq(&pdev->dev, queue->irq, macb_interrupt, -+ IRQF_SHARED, dev->name, queue); -+ if (err) { -+ dev_err(&pdev->dev, -+ "Unable to request IRQ %d (error %d)\n", -+ queue->irq, err); -+ return err; -+ } -+ } -+ -+ INIT_WORK(&queue->tx_error_task, macb_tx_error_task); -+ q++; -+ } -+ -+ dev->netdev_ops = &macb_netdev_ops; -+ -+ /* setup appropriated routines according to adapter type */ -+ if (macb_is_gem(bp)) { -+ bp->max_tx_length = GEM_MAX_TX_LEN; -+ bp->macbgem_ops.mog_alloc_rx_buffers = gem_alloc_rx_buffers; -+ bp->macbgem_ops.mog_free_rx_buffers = gem_free_rx_buffers; -+ bp->macbgem_ops.mog_init_rings = gem_init_rings; -+ bp->macbgem_ops.mog_rx = gem_rx; -+ dev->ethtool_ops = &gem_ethtool_ops; -+ } else { -+ bp->max_tx_length = MACB_MAX_TX_LEN; -+ bp->macbgem_ops.mog_alloc_rx_buffers = macb_alloc_rx_buffers; -+ bp->macbgem_ops.mog_free_rx_buffers = macb_free_rx_buffers; -+ bp->macbgem_ops.mog_init_rings = macb_init_rings; -+ bp->macbgem_ops.mog_rx = macb_rx; -+ dev->ethtool_ops = &macb_ethtool_ops; -+ } -+ -+ /* Set features */ -+ dev->hw_features = NETIF_F_SG; -+ -+ /* Check LSO capability */ -+ if (GEM_BFEXT(PBUF_LSO, gem_readl(bp, DCFG6))) -+ dev->hw_features |= MACB_NETIF_LSO; -+ -+ /* Checksum offload is only available on gem with packet buffer */ -+ if (macb_is_gem(bp) && !(bp->caps & MACB_CAPS_FIFO_MODE)) -+ dev->hw_features |= NETIF_F_HW_CSUM | NETIF_F_RXCSUM; -+ if (bp->caps & MACB_CAPS_SG_DISABLED) -+ dev->hw_features &= ~NETIF_F_SG; -+ dev->features = dev->hw_features; -+ -+ /* Check RX Flow Filters support. -+ * Max Rx flows set by availability of screeners & compare regs: -+ * each 4-tuple define requires 1 T2 screener reg + 3 compare regs -+ */ -+ reg = gem_readl(bp, DCFG8); -+ bp->max_tuples = min((GEM_BFEXT(SCR2CMP, reg) / 3), -+ GEM_BFEXT(T2SCR, reg)); -+ INIT_LIST_HEAD(&bp->rx_fs_list.list); -+ if (bp->max_tuples > 0) { -+ /* also needs one ethtype match to check IPv4 */ -+ if (GEM_BFEXT(SCR2ETH, reg) > 0) { -+ /* program this reg now */ -+ reg = 0; -+ reg = GEM_BFINS(ETHTCMP, (uint16_t)ETH_P_IP, reg); -+ gem_writel_n(bp, ETHT, SCRT2_ETHT, reg); -+ /* Filtering is supported in hw but don't enable it in kernel now */ -+ dev->hw_features |= NETIF_F_NTUPLE; -+ /* init Rx flow definitions */ -+ bp->rx_fs_list.count = 0; -+ spin_lock_init(&bp->rx_fs_lock); -+ } else { -+ bp->max_tuples = 0; -+ } -+ } -+ -+ if (!(bp->caps & MACB_CAPS_USRIO_DISABLED)) { -+ val = 0; -+ if (phy_interface_mode_is_rgmii(bp->phy_interface)) -+ val = GEM_BIT(RGMII); -+ else if (bp->phy_interface == PHY_INTERFACE_MODE_RMII && -+ (bp->caps & MACB_CAPS_USRIO_DEFAULT_IS_MII_GMII)) -+ val = MACB_BIT(RMII); -+ else if (!(bp->caps & MACB_CAPS_USRIO_DEFAULT_IS_MII_GMII)) -+ val = MACB_BIT(MII); -+ -+ if (bp->caps & MACB_CAPS_USRIO_HAS_CLKEN) -+ val |= MACB_BIT(CLKEN); -+ -+ macb_or_gem_writel(bp, USRIO, val); -+ } -+ -+ /* Set MII management clock divider */ -+ val = macb_mdc_clk_div(bp); -+ val |= macb_dbw(bp); -+ if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII || -+ bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) -+ val |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL); -+ macb_writel(bp, NCFGR, val); -+ -+#ifdef CONFIG_MACB_TSN -+ phytium_init_tsn(pdev); -+#endif -+ -+ return 0; -+} -+ -+static int macb_init(struct platform_device *pdev) -+{ -+ struct net_device *dev = platform_get_drvdata(pdev); -+ unsigned int hw_q, q; -+ struct macb *bp = netdev_priv(dev); -+ struct macb_queue *queue; -+ int err; -+ u32 val, reg; -+ -+ bp->tx_ring_size = DEFAULT_TX_RING_SIZE; -+ bp->rx_ring_size = DEFAULT_RX_RING_SIZE; -+ -+ /* set the queue register mapping once for all: queue0 has a special -+ * register mapping but we don't want to test the queue index then -+ * compute the corresponding register offset at run time. -+ */ -+ for (hw_q = 0, q = 0; hw_q < MACB_MAX_QUEUES; ++hw_q) { -+ if (!(bp->queue_mask & (1 << hw_q))) -+ continue; -+ -+ queue = &bp->queues[q]; -+ queue->bp = bp; -+ netif_napi_add(dev, &queue->napi, macb_poll, NAPI_POLL_WEIGHT); -+ if (hw_q) { - queue->ISR = GEM_ISR(hw_q - 1); - queue->IER = GEM_IER(hw_q - 1); - queue->IDR = GEM_IDR(hw_q - 1); -@@ -3848,6 +4751,10 @@ static int macb_init(struct platform_device *pdev) - val |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL); - macb_writel(bp, NCFGR, val); - -+#ifdef CONFIG_MACB_TSN -+ phytium_init_tsn(pdev); -+#endif -+ - return 0; - } - -@@ -4436,6 +5343,75 @@ static const struct macb_config zynq_config = { - .init = macb_init, - }; - -+static const struct macb_config phytium_gem1p0_config = { -+ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | -+ MACB_CAPS_JUMBO | -+ MACB_CAPS_GEM_HAS_PTP | -+ MACB_CAPS_BD_RD_PREFETCH | -+ MACB_CAPS_SEL_CLK, -+ .dma_burst_length = 16, -+ .clk_init = phytium_clk_init, -+ .init = phytium_init, -+ .jumbo_max_len = 16360, -+ .sel_clk_hw = phytium_gem1p0_sel_clk, -+}; -+ -+static const struct macb_config phytium_gem2p0_config = { -+ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | -+ MACB_CAPS_JUMBO | -+ MACB_CAPS_GEM_HAS_PTP | -+ MACB_CAPS_BD_RD_PREFETCH | -+ MACB_CAPS_SEL_CLK, -+ .dma_burst_length = 16, -+ .clk_init = macb_clk_init, -+ .init = macb_init, -+ .jumbo_max_len = 10240, -+ .sel_clk_hw = phytium_gem2p0_sel_clk, -+}; -+ -+static const struct macb_config phytium_gem3p0_config = { -+ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | -+ MACB_CAPS_JUMBO | -+ MACB_CAPS_GEM_HAS_PTP | -+ MACB_CAPS_BD_RD_PREFETCH | -+ MACB_CAPS_SEL_CLK | -+ MACB_CAPS_TAILPTR, -+ .dma_burst_length = 16, -+ .clk_init = phytium_clk_init, -+ .init = phytium_init, -+ .jumbo_max_len = 10240, -+ .sel_clk_hw = phytium_gem3p0_sel_clk, -+}; -+ -+#ifdef CONFIG_ACPI -+static const struct macb_config phytium_gem1p0_acpi_config = { -+ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | -+ MACB_CAPS_JUMBO | -+ MACB_CAPS_GEM_HAS_PTP | -+ MACB_CAPS_BD_RD_PREFETCH | -+ MACB_CAPS_SEL_CLK, -+ .dma_burst_length = 16, -+ .clk_init = phytium_clk_acpi_init, -+ .init = phytium_init, -+ .jumbo_max_len = 10240, -+ .sel_clk_hw = phytium_gem1p0_sel_clk, -+}; -+ -+static const struct macb_config phytium_gem3p0_acpi_config = { -+ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | -+ MACB_CAPS_JUMBO | -+ MACB_CAPS_GEM_HAS_PTP | -+ MACB_CAPS_BD_RD_PREFETCH | -+ MACB_CAPS_SEL_CLK | -+ MACB_CAPS_TAILPTR, -+ .dma_burst_length = 16, -+ .clk_init = phytium_clk_acpi_init, -+ .init = phytium_init, -+ .jumbo_max_len = 10240, -+ .sel_clk_hw = phytium_gem3p0_sel_clk, -+}; -+#endif -+ - static const struct of_device_id macb_dt_ids[] = { - { .compatible = "cdns,at32ap7000-macb" }, - { .compatible = "cdns,at91sam9260-macb", .data = &at91sam9260_config }, -@@ -4453,11 +5429,26 @@ static const struct of_device_id macb_dt_ids[] = { - { .compatible = "cdns,zynqmp-gem", .data = &zynqmp_config}, - { .compatible = "cdns,zynq-gem", .data = &zynq_config }, - { .compatible = "sifive,fu540-c000-gem", .data = &fu540_c000_config }, -+ { .compatible = "cdns,phytium-gem-1.0", .data = &phytium_gem1p0_config }, -+ { .compatible = "cdns,phytium-gem-2.0", .data = &phytium_gem2p0_config }, -+ { .compatible = "cdns,phytium-gem-3.0", .data = &phytium_gem3p0_config }, - { /* sentinel */ } - }; - MODULE_DEVICE_TABLE(of, macb_dt_ids); - #endif /* CONFIG_OF */ - -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id macb_acpi_ids[] = { -+ { .id = "PHYT0036", .driver_data = (kernel_ulong_t)&phytium_gem1p0_acpi_config }, -+ { .id = "PHYT0046", .driver_data = (kernel_ulong_t)&phytium_gem3p0_acpi_config }, -+ { } -+}; -+ -+MODULE_DEVICE_TABLE(acpi, macb_acpi_ids); -+#else -+#define macb_acpi_ids NULL -+#endif -+ - static const struct macb_config default_gem_config = { - .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | - MACB_CAPS_JUMBO | -@@ -4468,6 +5459,32 @@ static const struct macb_config default_gem_config = { - .jumbo_max_len = 10240, - }; - -+static void gem_ncsi_handler(struct ncsi_dev *nd) -+{ -+ if (unlikely(nd->state != ncsi_dev_state_functional)) -+ return; -+ -+ netdev_dbg(nd->dev, "NCSI interface %s\n", -+ nd->link_up ? "up" : "down"); -+} -+ -+static int macb_get_phy_mode(struct platform_device *pdev) -+{ -+ const char *pm; -+ int err, i; -+ -+ err = device_property_read_string(&pdev->dev, "phy-mode", &pm); -+ if (err < 0) -+ return err; -+ -+ for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) { -+ if (!strcasecmp(pm, phy_modes(i))) -+ return i; -+ } -+ -+ return -ENODEV; -+} -+ - static int macb_probe(struct platform_device *pdev) - { - const struct macb_config *macb_config = &default_gem_config; -@@ -4476,11 +5493,11 @@ static int macb_probe(struct platform_device *pdev) - struct clk **) = macb_config->clk_init; - int (*init)(struct platform_device *) = macb_config->init; - struct device_node *np = pdev->dev.of_node; -- struct clk *pclk, *hclk = NULL, *tx_clk = NULL, *rx_clk = NULL; -+ struct clk *pclk = NULL, *hclk = NULL, *tx_clk = NULL, *rx_clk = NULL; - struct clk *tsu_clk = NULL; - unsigned int queue_mask, num_queues; -+ struct macb_platform_data *pdata; - bool native_io; -- phy_interface_t interface; - struct net_device *dev; - struct resource *regs; - void __iomem *mem; -@@ -4488,6 +5505,15 @@ static int macb_probe(struct platform_device *pdev) - struct macb *bp; - int err, val; - -+ pdata = dev_get_platdata(&pdev->dev); -+ if (pdata) { -+ if (pdata->phytium_macb_pdata.phytium_dev_type == PHYTIUM_DEV_3P0) { -+ macb_config = &phytium_gem3p0_config; -+ clk_init = macb_config->clk_init; -+ init = macb_config->init; -+ } -+ } -+ - regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); - mem = devm_ioremap_resource(&pdev->dev, regs); - if (IS_ERR(mem)) -@@ -4502,6 +5528,15 @@ static int macb_probe(struct platform_device *pdev) - clk_init = macb_config->clk_init; - init = macb_config->init; - } -+ } else if (has_acpi_companion(&pdev->dev)) { -+ const struct acpi_device_id *match; -+ -+ match = acpi_match_device(macb_acpi_ids, &pdev->dev); -+ if (match && match->driver_data) { -+ macb_config = (void *)match->driver_data; -+ clk_init = macb_config->clk_init; -+ init = macb_config->init; -+ } - } - - err = clk_init(pdev, &pclk, &hclk, &tx_clk, &rx_clk, &tsu_clk); -@@ -4550,8 +5585,11 @@ static int macb_probe(struct platform_device *pdev) - if (macb_config) - bp->jumbo_max_len = macb_config->jumbo_max_len; - -+ if (macb_config) -+ bp->sel_clk_hw = macb_config->sel_clk_hw; -+ - bp->wol = 0; -- if (of_get_property(np, "magic-packet", NULL)) -+ if (device_property_read_bool(&pdev->dev, "magic-packet")) - bp->wol |= MACB_WOL_HAS_MAGIC_PACKET; - device_set_wakeup_capable(&pdev->dev, bp->wol & MACB_WOL_HAS_MAGIC_PACKET); - -@@ -4607,22 +5645,47 @@ static int macb_probe(struct platform_device *pdev) - macb_get_hwaddr(bp); - } - -- err = of_get_phy_mode(np, &interface); -- if (err) -- /* not found in DT, MII by default */ -- bp->phy_interface = PHY_INTERFACE_MODE_MII; -- else -- bp->phy_interface = interface; -+ err = macb_get_phy_mode(pdev); -+ if (err < 0) { -+ if (pdata && pdata->phytium_macb_pdata.phytium_dev_type == PHYTIUM_DEV_3P0) -+ bp->phy_interface = pdata->phytium_macb_pdata.phy_interface; -+ else -+ bp->phy_interface = PHY_INTERFACE_MODE_MII; -+ } else { -+ bp->phy_interface = err; -+ } -+ -+ bp->link = 0; -+ bp->duplex = DUPLEX_UNKNOWN; -+ bp->speed = SPEED_UNKNOWN; - - /* IP specific init */ - err = init(pdev); - if (err) - goto err_out_free_netdev; - -+ if (device_property_read_bool(&pdev->dev, "force-phy-mode")) { -+ bp->force_phy_mode = 1; -+ } -+ - err = macb_mii_init(bp); - if (err) - goto err_out_free_netdev; - -+ if (device_property_read_bool(&pdev->dev, "use-ncsi")) { -+ if (!IS_ENABLED(CONFIG_NET_NCSI)) { -+ dev_err(&pdev->dev, "NCSI stack not enabled\n"); -+ goto err_out_free_netdev; -+ } -+ dev_notice(&pdev->dev, "Using NCSI interface\n"); -+ bp->use_ncsi = 1; -+ bp->ndev = ncsi_register_dev(dev, gem_ncsi_handler); -+ if (!bp->ndev) -+ goto err_out_free_netdev; -+ } else { -+ bp->use_ncsi = 0; -+ } -+ - netif_carrier_off(dev); - - err = register_netdev(dev); -@@ -4666,24 +5729,34 @@ static int macb_remove(struct platform_device *pdev) - { - struct net_device *dev; - struct macb *bp; -+ struct macb_platform_data *pdata = dev_get_platdata(&pdev->dev); - - dev = platform_get_drvdata(pdev); - - if (dev) { -+#ifdef CONFIG_MACB_TSN -+ phytium_deinit_tsn(pdev); -+#endif -+ - bp = netdev_priv(dev); - mdiobus_unregister(bp->mii_bus); - mdiobus_free(bp->mii_bus); - -+ if (bp->ndev) -+ ncsi_unregister_dev(bp->ndev); - unregister_netdev(dev); - tasklet_kill(&bp->hresp_err_tasklet); - pm_runtime_disable(&pdev->dev); - pm_runtime_dont_use_autosuspend(&pdev->dev); - if (!pm_runtime_suspended(&pdev->dev)) { -- clk_disable_unprepare(bp->tx_clk); -- clk_disable_unprepare(bp->hclk); -- clk_disable_unprepare(bp->pclk); -- clk_disable_unprepare(bp->rx_clk); -- clk_disable_unprepare(bp->tsu_clk); -+ if (!pdata) { -+ clk_disable_unprepare(bp->tx_clk); -+ clk_disable_unprepare(bp->hclk); -+ clk_disable_unprepare(bp->pclk); -+ clk_disable_unprepare(bp->rx_clk); -+ clk_disable_unprepare(bp->tsu_clk); -+ } -+ - pm_runtime_set_suspended(&pdev->dev); - } - phylink_destroy(bp->phylink); -@@ -4900,6 +5973,7 @@ static struct platform_driver macb_driver = { - .driver = { - .name = "macb", - .of_match_table = of_match_ptr(macb_dt_ids), -+ .acpi_match_table = ACPI_PTR(macb_acpi_ids), - .pm = &macb_pm_ops, - }, - }; -diff --git a/drivers/net/ethernet/cadence/macb_pci.c b/drivers/net/ethernet/cadence/macb_pci.c -index 3593b310c..63d8e3e01 100644 ---- a/drivers/net/ethernet/cadence/macb_pci.c -+++ b/drivers/net/ethernet/cadence/macb_pci.c -@@ -21,17 +21,166 @@ - - #define CDNS_VENDOR_ID 0x17cd - #define CDNS_DEVICE_ID 0xe007 -+#define PCI_DEVICE_ID_GMAC_3P0 0xdc3b -+#define PCI_SUBDEVICE_ID_SGMII 0x1000 -+#define PCI_SUBDEVICE_ID_1000BASEX 0x1001 -+#define PCI_SUBDEVICE_ID_USXGMII 0x1004 -+#define PCI_SUBDEVICE_ID_10GBASER 0x1005 - - #define GEM_PCLK_RATE 50000000 - #define GEM_HCLK_RATE 50000000 -+#define GEM_TXCLK_RATE 25000000 -+#define GEM_RXCLK_RATE 25000000 -+#define GEM_TSUCLK_RATE 300000000 -+ -+static const u32 fixedlink[][5] = { -+ {0, 1, 1000, 1, 0}, -+ {0, 1, 2500, 1, 0}, -+ {0, 1, 5000, 1, 0}, -+ {0, 1, 10000, 1, 0}, -+}; -+ -+static const struct property_entry fl_properties[][2] = { -+ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[0]), {}}, -+ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[1]), {}}, -+ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[2]), {}}, -+ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[3]), {}}, -+}; -+ -+static const struct phytium_platform_pdata phytium_sgmii_pdata = { -+ .phytium_dev_type = PHYTIUM_DEV_3P0, -+ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | -+ MACB_CAPS_JUMBO | -+ MACB_CAPS_GEM_HAS_PTP | -+ MACB_CAPS_BD_RD_PREFETCH | -+ MACB_CAPS_USRIO_DISABLED | -+ MACB_CAPS_TAILPTR, -+ .phy_interface = PHY_INTERFACE_MODE_SGMII, -+}; -+ -+static const struct phytium_platform_pdata phytium_1000basex_pdata = { -+ .phytium_dev_type = PHYTIUM_DEV_3P0, -+ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | -+ MACB_CAPS_JUMBO | -+ MACB_CAPS_GEM_HAS_PTP | -+ MACB_CAPS_BD_RD_PREFETCH | -+ MACB_CAPS_USRIO_DISABLED | -+ MACB_CAPS_TAILPTR, -+ .phy_interface = PHY_INTERFACE_MODE_SGMII, -+ .properties = fl_properties[0], -+}; -+ -+static const struct phytium_platform_pdata phytium_usxgmii_pdata = { -+ .phytium_dev_type = PHYTIUM_DEV_3P0, -+ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | -+ MACB_CAPS_JUMBO | -+ MACB_CAPS_GEM_HAS_PTP | -+ MACB_CAPS_BD_RD_PREFETCH | -+ MACB_CAPS_USRIO_DISABLED | -+ MACB_CAPS_TAILPTR, -+ .phy_interface = PHY_INTERFACE_MODE_USXGMII, -+ .properties = fl_properties[3], -+}; -+ -+static int phytium_macb_pci_init(struct pci_dev *pdev, struct macb_platform_data *plat_data, -+ struct platform_device_info *plat_info, -+ struct phytium_platform_pdata *phytium_data) -+{ -+ int i; -+ int err; -+ char clkname[20]; -+ -+ err = pci_alloc_irq_vectors(pdev, 4, 4, PCI_IRQ_MSI); -+ if (err < 0) { -+ dev_err(&pdev->dev, "err=%d, fialed to allocate MSI entry", err); -+ plat_data->phytium_macb_pdata.irq_type = IRQ_TYPE_INTX; -+ plat_data->phytium_macb_pdata.irq[0] = pdev->irq; -+ -+ } else { -+ plat_data->phytium_macb_pdata.irq_type = IRQ_TYPE_MSI; -+ for (i = 0; i < 4; i++) -+ plat_data->phytium_macb_pdata.irq[i] = pci_irq_vector(pdev, i); -+ } -+ -+ plat_data->phytium_macb_pdata.phytium_dev_type = phytium_data->phytium_dev_type; -+ plat_data->phytium_macb_pdata.caps = phytium_data->caps; -+ plat_data->phytium_macb_pdata.phy_interface = phytium_data->phy_interface; -+ if (phytium_data && phytium_data->properties) { -+ plat_info->fwnode = NULL; -+ plat_info->properties = phytium_data->properties; -+ plat_data->phytium_macb_pdata.properties = phytium_data->properties; -+ } -+ -+ snprintf(clkname, 20, "txclk:%02x", plat_info->id); -+ plat_data->phytium_macb_pdata.txclk = -+ clk_register_fixed_rate(&pdev->dev, clkname, NULL, 0, GEM_TXCLK_RATE); -+ if (IS_ERR(plat_data->phytium_macb_pdata.txclk)) { -+ err = PTR_ERR(plat_data->phytium_macb_pdata.txclk); -+ goto err_txclk_register; -+ } -+ -+ snprintf(clkname, 20, "rxclk:%02x", plat_info->id); -+ plat_data->phytium_macb_pdata.rxclk = -+ clk_register_fixed_rate(&pdev->dev, clkname, NULL, 0, GEM_RXCLK_RATE); -+ if (IS_ERR(plat_data->phytium_macb_pdata.rxclk)) { -+ err = PTR_ERR(plat_data->phytium_macb_pdata.rxclk); -+ goto err_rxclk_register; -+ } -+ -+ snprintf(clkname, 20, "tsuclk:%02x", plat_info->id); -+ plat_data->phytium_macb_pdata.tsu_clk = -+ clk_register_fixed_rate(&pdev->dev, clkname, NULL, 0, GEM_TSUCLK_RATE); -+ if (IS_ERR(plat_data->phytium_macb_pdata.tsu_clk)) { -+ err = PTR_ERR(plat_data->phytium_macb_pdata.tsu_clk); -+ goto err_tsuclk_register; -+ } -+ -+ return 0; -+ -+err_tsuclk_register: -+ clk_unregister(plat_data->phytium_macb_pdata.rxclk); -+ -+err_rxclk_register: -+ clk_unregister(plat_data->phytium_macb_pdata.txclk); -+ -+err_txclk_register: -+ -+ return err; -+} -+ -+static void phytium_macb_pci_uninit(struct pci_dev *pdev) -+{ -+ struct platform_device *plat_dev = pci_get_drvdata(pdev); -+ struct macb_platform_data *plat_data = dev_get_platdata(&plat_dev->dev); -+ -+ plat_dev->dev.dma_ops = NULL; -+ plat_dev->dev.iommu = NULL; -+ plat_dev->dev.iommu_group = NULL; -+ plat_dev->dev.dma_range_map = NULL; -+ -+ clk_unregister(plat_data->phytium_macb_pdata.txclk); -+ clk_unregister(plat_data->phytium_macb_pdata.rxclk); -+ clk_unregister(plat_data->phytium_macb_pdata.tsu_clk); -+ -+ if (plat_data->phytium_macb_pdata.properties) { -+ struct fwnode_handle *fw_node = dev_fwnode(&plat_dev->dev); -+ -+ if (fw_node) -+ fwnode_remove_software_node(fw_node); -+ fw_node = NULL; -+ } -+} - - static int macb_probe(struct pci_dev *pdev, const struct pci_device_id *id) - { - int err; - struct platform_device *plat_dev; - struct platform_device_info plat_info; -+ struct phytium_platform_pdata *phytium_data = NULL; - struct macb_platform_data plat_data; - struct resource res[2]; -+ char pclk_name[20] = "pclk"; -+ char hclk_name[20] = "hclk"; - - /* enable pci device */ - err = pcim_enable_device(pdev); -@@ -48,9 +197,6 @@ static int macb_probe(struct pci_dev *pdev, const struct pci_device_id *id) - res[0].end = pci_resource_end(pdev, 0); - res[0].name = PCI_DRIVER_NAME; - res[0].flags = IORESOURCE_MEM; -- res[1].start = pci_irq_vector(pdev, 0); -- res[1].name = PCI_DRIVER_NAME; -- res[1].flags = IORESOURCE_IRQ; - - dev_info(&pdev->dev, "EMAC physical base addr: %pa\n", - &res[0].start); -@@ -58,32 +204,48 @@ static int macb_probe(struct pci_dev *pdev, const struct pci_device_id *id) - /* set up macb platform data */ - memset(&plat_data, 0, sizeof(plat_data)); - -+ /* set up platform device info */ -+ memset(&plat_info, 0, sizeof(plat_info)); -+ plat_info.parent = &pdev->dev; -+ plat_info.fwnode = pdev->dev.fwnode; -+ plat_info.name = PLAT_DRIVER_NAME; -+ plat_info.id = pdev->devfn; -+ plat_info.res = res; -+ plat_info.num_res = ARRAY_SIZE(res); -+ plat_info.data = &plat_data; -+ plat_info.size_data = sizeof(plat_data); -+ plat_info.dma_mask = pdev->dma_mask; -+ if (pdev->vendor == PCI_VENDOR_ID_PHYTIUM) -+ phytium_data = (struct phytium_platform_pdata *)id->driver_data; -+ - /* initialize clocks */ -- plat_data.pclk = clk_register_fixed_rate(&pdev->dev, "pclk", NULL, 0, -+ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) { -+ plat_info.id = (pdev->bus->number << 8) | pdev->devfn; -+ snprintf(pclk_name, 20, "pclk:%02x", plat_info.id); -+ snprintf(hclk_name, 20, "hclk:%02x", plat_info.id); -+ } -+ plat_data.pclk = clk_register_fixed_rate(&pdev->dev, pclk_name, NULL, 0, - GEM_PCLK_RATE); - if (IS_ERR(plat_data.pclk)) { - err = PTR_ERR(plat_data.pclk); - goto err_pclk_register; - } - -- plat_data.hclk = clk_register_fixed_rate(&pdev->dev, "hclk", NULL, 0, -+ plat_data.hclk = clk_register_fixed_rate(&pdev->dev, hclk_name, NULL, 0, - GEM_HCLK_RATE); - if (IS_ERR(plat_data.hclk)) { - err = PTR_ERR(plat_data.hclk); - goto err_hclk_register; - } - -- /* set up platform device info */ -- memset(&plat_info, 0, sizeof(plat_info)); -- plat_info.parent = &pdev->dev; -- plat_info.fwnode = pdev->dev.fwnode; -- plat_info.name = PLAT_DRIVER_NAME; -- plat_info.id = pdev->devfn; -- plat_info.res = res; -- plat_info.num_res = ARRAY_SIZE(res); -- plat_info.data = &plat_data; -- plat_info.size_data = sizeof(plat_data); -- plat_info.dma_mask = pdev->dma_mask; -+ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) { -+ if (phytium_macb_pci_init(pdev, &plat_data, &plat_info, phytium_data)) -+ goto err_phytium_clk_register; -+ } -+ -+ res[1].start = pci_irq_vector(pdev, 0); -+ res[1].name = PCI_DRIVER_NAME; -+ res[1].flags = IORESOURCE_IRQ; - - /* register platform device */ - plat_dev = platform_device_register_full(&plat_info); -@@ -92,11 +254,21 @@ static int macb_probe(struct pci_dev *pdev, const struct pci_device_id *id) - goto err_plat_dev_register; - } - -+ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) { -+ plat_dev->dev.dma_ops = (&pdev->dev)->dma_ops; -+ plat_dev->dev.iommu = (&pdev->dev)->iommu; -+ plat_dev->dev.iommu_group = (&pdev->dev)->iommu_group; -+ plat_dev->dev.dma_range_map = (&pdev->dev)->dma_range_map; -+ } - pci_set_drvdata(pdev, plat_dev); - - return 0; - - err_plat_dev_register: -+ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) -+ clk_unregister(plat_data.phytium_macb_pdata.tsu_clk); -+ -+err_phytium_clk_register: - clk_unregister(plat_data.hclk); - - err_hclk_register: -@@ -113,11 +285,26 @@ static void macb_remove(struct pci_dev *pdev) - - clk_unregister(plat_data->pclk); - clk_unregister(plat_data->hclk); -+ -+ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) -+ phytium_macb_pci_uninit(pdev); - platform_device_unregister(plat_dev); -+ -+ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) -+ pci_free_irq_vectors(pdev); - } - - static const struct pci_device_id dev_id_table[] = { - { PCI_DEVICE(CDNS_VENDOR_ID, CDNS_DEVICE_ID), }, -+ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC_3P0, -+ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_SGMII), -+ .driver_data = (kernel_ulong_t)&phytium_sgmii_pdata}, -+ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC_3P0, -+ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_1000BASEX), -+ .driver_data = (kernel_ulong_t)&phytium_1000basex_pdata}, -+ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC_3P0, -+ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_USXGMII), -+ .driver_data = (kernel_ulong_t)&phytium_usxgmii_pdata}, - { 0, } - }; - -diff --git a/drivers/net/ethernet/cadence/macb_tsn.c b/drivers/net/ethernet/cadence/macb_tsn.c -new file mode 100644 -index 000000000..890d15db7 ---- /dev/null -+++ b/drivers/net/ethernet/cadence/macb_tsn.c -@@ -0,0 +1,1290 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+/* -+ * Phytium TSN support driver -+ * -+ * Copyright (c) 2024 Phytium Technology Co., Ltd. -+ */ -+//#define DEBUG -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "macb.h" -+#include "macb_tsn.h" -+ -+static int phytium_set_cbs_tc(struct net_device *ndev, void *type_data) -+{ -+ struct macb *bp = netdev_priv(ndev); -+ struct tc_cbs_qopt_offload *cbs = type_data; -+ u32 cbs_ctrl, idle_slope; -+ u8 tc = cbs->queue; -+ u8 tc_nums = netdev_get_num_tc(ndev); -+ u8 prio_top, prio_next; -+ -+ prio_top = tc_nums - 1; -+ prio_next = tc_nums - 2; -+ -+ pr_debug("%s %d cbs->queue %d\n", __func__, __LINE__, cbs->queue); -+ pr_debug("%s %d tc_nums %d\n", __func__, __LINE__, tc_nums); -+ -+ /* CBS is available on the two highest priority active queues */ -+ if (tc != prio_top && tc != prio_next) -+ return -EINVAL; -+ -+ /* idleslope should be positive, sendslope should be negative */ -+ if (cbs->idleslope < 0 || cbs->sendslope > 0) -+ return -EINVAL; -+ -+ /* if set sendslope, check idle - send == speed */ -+ if (cbs->sendslope != 0 && -+ (cbs->idleslope - cbs->sendslope) != bp->speed * 1000 * 1000) { -+ pr_warn("idleslope - sendslope != portTransmitRate, please check it\n"); -+ return -EINVAL; -+ } -+ -+ cbs_ctrl = gem_readl(bp, CBS_CONTROL); -+ -+ if (!cbs->enable) { -+ cbs_ctrl &= (~BIT(prio_top - tc)); -+ gem_writel(bp, CBS_CONTROL, cbs_ctrl); -+ return 0; -+ } -+ -+ pr_debug("bp->speed %d\n", bp->speed); -+ pr_debug("cbs->idleslope %d\n", cbs->idleslope); -+ -+ /* calculate idle slope value, cbs->idleslope is kilobit/sec */ -+ /* reg value in bytes/sec for gigabit operation, and nibbles/sec */ -+ /* for 10/100 operation, and scaled by 2.5 in 2.5G operation */ -+ switch (bp->speed) { -+ case SPEED_10: -+ case SPEED_100: -+ idle_slope = 125 * cbs->idleslope * 2; -+ break; -+ case SPEED_1000: -+ idle_slope = 125 * cbs->idleslope; -+ break; -+ case SPEED_2500: -+ idle_slope = 125 * cbs->idleslope * 2 / 5; -+ break; -+ default: -+ pr_info("macb speed %d not support\n", bp->speed); -+ return -EOPNOTSUPP; -+ } -+ -+ /* cbs should be disabled prior to updating the idle slope value */ -+ cbs_ctrl &= (~BIT(prio_top - tc)); -+ gem_writel(bp, CBS_CONTROL, cbs_ctrl); -+ -+ if (tc == prio_top) -+ gem_writel(bp, CBS_IDLESLOPE_Q_A, idle_slope); -+ else -+ gem_writel(bp, CBS_IDLESLOPE_Q_B, idle_slope); -+ -+ /* after set idle slope, enable cbs */ -+ cbs_ctrl |= BIT(prio_top - tc); -+ gem_writel(bp, CBS_CONTROL, cbs_ctrl); -+ -+ return 0; -+} -+ -+static int phytium_set_mqprio_tc(struct net_device *ndev, void *type_data) -+{ -+ struct macb *bp = netdev_priv(ndev); -+ struct tc_mqprio_qopt *mqprio = type_data; -+ u8 num_tc; -+ int i; -+ -+ pr_debug("%s %d\n", __func__, __LINE__); -+ mqprio->hw = TC_MQPRIO_HW_OFFLOAD_TCS; -+ num_tc = mqprio->num_tc; -+ -+ if (!num_tc) { -+ netdev_reset_tc(ndev); -+ return 0; -+ } -+ -+ /* For easier use, num_tc need same as num_queues. */ -+ if (num_tc != bp->num_queues) { -+ netdev_err(ndev, "num_tc should same as dev num_queues %d\n", -+ bp->num_queues); -+ return -EINVAL; -+ } -+ -+ netdev_set_num_tc(ndev, num_tc); -+ -+ /* Each TC is associated with one netdev queue, the queue index is */ -+ /* used as the priority, where a higher index will have a higher */ -+ /* priority than a lower index. */ -+ for (i = 0; i < num_tc; i++) -+ netdev_set_tc_queue(ndev, i, 1, i); -+ return 0; -+} -+ -+struct queues_enst_setting { -+ u8 enable; -+ u32 start_time; -+ u32 on_time; -+ u32 off_time; -+}; -+ -+#ifdef TSN_DEBUG -+static void _dump_taprio_param(struct tc_taprio_qopt_offload *taprio) -+{ -+ int i = 0; -+ -+ _dump_param(taprio->enable); -+ _dump_param(taprio->base_time); -+ _dump_param(taprio->cycle_time); -+ _dump_param(taprio->cycle_time_extension); -+ _dump_param(taprio->num_entries); -+ for (; i < taprio->num_entries; i++) { -+ _dump_param(i); -+ _dump_param(taprio->entries[i].command); -+ _dump_param(taprio->entries[i].gate_mask); -+ _dump_param(taprio->entries[i].interval); -+ } -+} -+ -+static void _dump_enst_param(struct queues_enst_setting *setting) -+{ -+ int i = 0; -+ -+ for (; i < MACB_MAX_ENST_QUEUES; i++) { -+ if (!setting[i].enable) -+ continue; -+ _dump_param(i); -+ _dump_param(setting[i].enable); -+ _dump_param(setting[i].start_time); -+ _dump_param(setting[i].on_time); -+ _dump_param(setting[i].off_time); -+ } -+} -+#else -+#define _dump_taprio_param(taprio) -+#define _dump_enst_param(setting) -+#endif -+ -+static int _taprio_convert_enst(struct tc_taprio_qopt_offload *taprio, -+ struct queues_enst_setting *setting) -+{ -+ int i, j; -+ // TODO: queue start time need add base_time? -+ u32 queue_start_time = 0; -+ -+ for (i = 0; i < taprio->num_entries; i++) { -+ ulong bitmap = (ulong)taprio->entries[i].gate_mask; -+ -+ if (!bitmap) { -+ pr_warn("gata_mask should not be zero\n"); -+ return -EINVAL; -+ } -+ for_each_set_bit(j, &bitmap, MACB_MAX_ENST_QUEUES) { -+ /* find this entrie masked queue j */ -+ if (setting[j].enable) { -+ pr_warn("not support setting same queue two times, hw assumes with fixed period\n"); -+ return -EINVAL; -+ } -+ setting[j].enable = true; -+ setting[j].start_time = queue_start_time; -+ setting[j].on_time = taprio->entries[i].interval; -+ setting[j].off_time = -+ taprio->cycle_time - setting[j].on_time; -+ } -+ queue_start_time += taprio->entries[i].interval; -+ } -+ return 0; -+} -+ -+static int phytium_set_taprio(struct net_device *ndev, -+ struct queues_enst_setting *setting) -+{ -+ struct macb *bp = netdev_priv(ndev); -+ int i; -+ int enst_ctrl = 0; -+ int scale = 8; -+ -+ switch (bp->speed) { -+ case SPEED_10: -+ scale = 800; -+ break; -+ case SPEED_100: -+ scale = 80; -+ break; -+ case SPEED_1000: -+ scale = 8; -+ break; -+ default: -+ pr_info("macb speed %d not support\n", bp->speed); -+ return -EOPNOTSUPP; -+ } -+ -+ for (i = 0; i < bp->num_queues; i++) { -+ if (!setting[i].enable) -+ continue; -+ gem_writel_n(bp, ENST_START_TIME, i, setting[i].start_time); -+ -+ if (setting[i].on_time > 1048568 || -+ setting[i].off_time > 1048568) { -+ pr_warn("queue %d on_time:%d, off_time:%d should small 1048568 ns\n", -+ i, setting[i].on_time, setting[i].off_time); -+ return -EINVAL; -+ } -+ -+ if (setting[i].on_time / scale < -+ ndev->mtu + ETH_HLEN + -+ ETH_FCS_LEN + NET_IP_ALIGN) -+ pr_info("tx frame may too long to be transmiited in on-time, it will cause transmission hang\n"); -+ -+ gem_writel_n(bp, ENST_ON_TIME, i, setting[i].on_time / scale); -+ gem_writel_n(bp, ENST_OFF_TIME, i, setting[i].off_time / scale); -+ enst_ctrl |= BIT(i); -+ } -+ gem_writel(bp, ENST_CONTROL, enst_ctrl); -+ return 0; -+} -+ -+static int phytium_set_taprio_tc(struct net_device *ndev, void *type_data) -+{ -+ struct tc_taprio_qopt_offload *taprio = type_data; -+ struct queues_enst_setting setting[MACB_MAX_ENST_QUEUES] = {0}; -+ int ret; -+ -+ _dump_taprio_param(taprio); -+ -+ ret = _taprio_convert_enst(taprio, setting); -+ if (ret) -+ return ret; -+ -+ _dump_enst_param(setting); -+ -+ ret = phytium_set_taprio(ndev, setting); -+ -+ return ret; -+} -+ -+int phytium_setup_tc(struct net_device *ndev, -+ enum tc_setup_type type, void *type_data) -+{ -+ switch (type) { -+ case TC_SETUP_QDISC_CBS: -+ return phytium_set_cbs_tc(ndev, type_data); -+ -+ case TC_SETUP_QDISC_MQPRIO: -+ return phytium_set_mqprio_tc(ndev, type_data); -+ -+ case TC_SETUP_QDISC_TAPRIO: -+ return phytium_set_taprio_tc(ndev, type_data); -+ -+ default: -+ return -EOPNOTSUPP; -+ } -+}; -+ -+static int phytium_find_stream_id(struct macb *bp, long value, bool print); -+ -+static int phytium_set_cb(struct macb *bp, struct tsn_setting_param *setting) -+{ -+ int frer_reg_ofst, frer_stream_ofst; -+ int redundancy_tag, frer_control_a, frer_control_b; -+ -+ if (setting[CB_HIS_LEN].value > bp->cb_history_len || -+ setting[CB_OFST].value > bp->num_cb_streams || -+ setting[CB_SEQ_LEN].value > 16) -+ return -EINVAL; -+ -+ if (phytium_find_stream_id(bp, setting[CB_INDEX].value, false)) -+ return -EINVAL; -+ -+ frer_reg_ofst = (setting[CB_OFST].value > 1) ? -+ 4 * (setting[CB_OFST].value > 1) : 0; -+ frer_stream_ofst = setting[CB_OFST].value % 2; -+ -+ /* counter of 8192 rx_clk periods, */ -+ /* in gigabit means 65.536 us, set 1ms here */ -+ gem_writel(bp, FRER_TIMEOUT, 0xF); -+ -+ redundancy_tag = GEM_BFINS(STRIP_R_TAG, setting[CB_STRIP_RTAG].value, -+ gem_readl(bp, FRER_RED_TAG)); -+ gem_writel(bp, FRER_RED_TAG, redundancy_tag); -+ -+ /* before setting, set en_elimination low */ -+ frer_control_a = gem_readl_n(bp, FRER_CONTROL_1_A, frer_reg_ofst); -+ frer_control_a &= (~BIT(31)); -+ -+ gem_writel_n(bp, FRER_CONTROL_1_A, frer_reg_ofst, frer_control_a); -+ -+ if (setting[CB_ENABLE].value == 0) -+ return 0; -+ -+ /* setting enable, now set frer control b */ -+ frer_control_b = GEM_BF(SEQ_NUM_LENGTH, setting[CB_SEQ_LEN].value) | -+ GEM_BF(SEQ_REC_WINDOW, -+ setting[CB_HIS_LEN].value); -+ gem_writel_n(bp, FRER_CONTROL_1_B, frer_reg_ofst, frer_control_b); -+ -+ /* enable some default config */ -+ frer_control_a |= 0xF0000000; -+ if (frer_stream_ofst) -+ frer_control_a = GEM_BFINS(MEMBER_STREAM2, -+ setting[CB_INDEX].value, -+ frer_control_a); -+ else -+ frer_control_a = GEM_BFINS(MEMBER_STREAM1, -+ setting[CB_INDEX].value, -+ frer_control_a); -+ -+ gem_writel_n(bp, FRER_CONTROL_1_A, frer_reg_ofst, frer_control_a); -+ -+ return 0; -+} -+ -+static ssize_t cb_setting_show(struct device *dev, -+ struct device_attribute *attr, char *buf) -+{ -+ struct macb *bp = container_of(attr, struct macb, cb_setting_attr); -+ -+ return snprintf(buf, PAGE_SIZE, -+ "help:\n" -+ " index: stream id handle, if use ethtool to do stream identify, it should same as [loc]\n" -+ " ofst: set offset of cb streams to hw, valid max to %d (optional, default 0)\n" -+ " seq_len: number of significant bits of th 802.1CB sequence number, max to 16(optional, default 16)\n" -+ " his_len: sequence history windows size, max to %d(optional, default %d)\n" -+ " strip_rtag: set this to 1 will tripping of the R-TAG from received frames(optional, default 1)\n" -+ " and strip_rtag is globla config, will affect all cb stream setting.\n" -+ " enable: enable:1, disable:0\n" -+ "example:\n" -+ " echo index 1 ofst 0 seq_len 16 his_len 64 strip_rtag 1 enable 1 > cb_setting\n" -+ " echo index 1 enable 1 > cb_setting\n" -+ "note:\n" -+ " if you set ofst 0 first, and set ofst 1 after, the ofst 1's setting will cover ofst 0's\n" -+ " because ofst 0 & 1(or even & odd) use same cb streams setting register.\n" -+ , bp->num_cb_streams, bp->cb_history_len, bp->cb_history_len); -+} -+ -+static ssize_t cb_setting_store(struct device *dev, -+ struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct macb *bp = container_of(attr, struct macb, cb_setting_attr); -+ struct tsn_setting_param cb_setting[] = { -+ [CB_INDEX] = { .name = "index", 1}, -+ [CB_OFST] = { .name = "ofst", 0}, -+ [CB_SEQ_LEN] = { .name = "seq_len", 16}, -+ [CB_HIS_LEN] = { .name = "his_len", 64}, -+ [CB_STRIP_RTAG] = { .name = "strip_rtag", 1}, -+ [CB_ENABLE] = { .name = "enable", 0}, -+ }; -+ int i, ret; -+ -+ for (i = 0; i < GET_SETTING_SIZE(cb_setting); i++) { -+ /* find setting name */ -+ char *tmp = strstr(buf, cb_setting[i].name); -+ char *end; -+ int recovery = 0; -+ -+ if (!tmp) -+ continue; -+ tmp += strlen(cb_setting[i].name); -+ tmp = skip_spaces(tmp); -+ end = strpbrk(tmp, " "); -+ if (end) { -+ recovery = 1; -+ *end = '\0'; -+ } -+ /* kstrtol input string must be null-terminated */ -+ ret = kstrtol(tmp, 10, &cb_setting[i].value); -+ if (recovery) -+ *end = ' '; -+ -+ if (ret < 0) -+ return ret; -+ dev_dbg(dev, "get: %s=%ld\n", -+ cb_setting[i].name, cb_setting[i].value); -+ } -+ -+ ret = phytium_set_cb(bp, cb_setting); -+ if (ret < 0) -+ return ret; -+ return count; -+} -+DEVICE_ATTR_RW(cb_setting); -+ -+static ssize_t stream_id_show(struct device *dev, -+ struct device_attribute *attr, char *buf) -+{ -+ struct macb *bp = container_of(attr, struct macb, stream_id_attr); -+ -+ return snprintf(buf, PAGE_SIZE, -+ "help:\n" -+ " index: tsnStreamIdHandle, decimal\n" -+ " src_mac: tsnCpeSmacVlanDownSrcMac input format:aabbcc112233\n" -+ " dst_mac: tsnCpeNullDownDestMac input format:aa1122bbcc33\n" -+ " src_ip: ipv4 source address input format:192.168.1.2\n" -+ " dst_ip: ipv4 destination address input format:192.168.1.2\n" -+ " src_port: ip source port input format:5001\n" -+ " dst_port: ip destination port input format:5001\n" -+ " vlan_id: tsnCpeSmacVlanDownVlan or tsnCpeNullDownVlan, decimal\n" -+ " rx_queue: set the queue num to receive this stream id, max to %d\n" -+ " also use as IPV (internal priority value),\n" -+ " higher queue index means higher priority\n" -+ "p.s.if set src/dst mac, dst/dst ip/port will be ignored\n" -+ "example:\n" -+ " echo add index 0 src_mac aabbcc112233 vlan_id 210 > stream_id\n" -+ " echo del index 0 > stream_id\n" -+ " echo show index 0 > stream_id\n", bp->num_queues); -+} -+ -+static int phytium_set_stream_to_hw(struct macb *bp, -+ struct tsn_setting_param *stream_id) -+{ -+ unsigned long mac_value; -+ int is_src_mac = 0; -+ u16 index = stream_id[STREAM_INDEX].value; -+ u32 w0, w1, t2_scr; -+ bool cmp_a = false; -+ bool cmp_b = false; -+ bool cmp_c = false; -+ -+ /* stream_id param check */ -+ if (stream_id[STREAM_SRC_MAC].value) { -+ is_src_mac = 1; -+ mac_value = stream_id[STREAM_SRC_MAC].value; -+ } else if (stream_id[STREAM_DST_MAC].value) { -+ mac_value = stream_id[STREAM_DST_MAC].value; -+ } else { -+ return -EINVAL; -+ } -+ -+ /* compare first 4 byte in mac */ -+ w0 = 0; -+ w1 = 0; -+ w0 = __fswab32((u32)((mac_value & (0xFFFFFFFF0000L)) >> 16)); -+ w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ -+ w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_SOF, w1); -+ w1 = GEM_BFINS(T2OFST, is_src_mac * 6, w1); -+ gem_writel_n(bp, T2CMPW0, T2CMP_OFST(GEM_MAC_FIRST_CMP(index)), w0); -+ gem_writel_n(bp, T2CMPW1, T2CMP_OFST(GEM_MAC_FIRST_CMP(index)), w1); -+ cmp_a = true; -+ -+ /* compare last 2 byte in mac */ -+ w0 = 0; -+ w1 = 0; -+ w0 = __fswab32((u32)(mac_value & (0xFFFF)) | 0xFFFF0000); -+ w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_SOF, w1); -+ w1 = GEM_BFINS(T2OFST, is_src_mac * 6 + 4, w1); -+ gem_writel_n(bp, T2CMPW0, T2CMP_OFST(GEM_MAC_SECOND_CMP(index)), w0); -+ gem_writel_n(bp, T2CMPW1, T2CMP_OFST(GEM_MAC_SECOND_CMP(index)), w1); -+ cmp_b = true; -+ -+ /* vlan id!=0, compare vlan id */ -+ if (stream_id[STREAM_VLAN_ID].value) { -+ w0 = 0; -+ w1 = 0; -+ /* vid 12 bit valid */ -+ w0 = (stream_id[STREAM_VLAN_ID].value << 16) | 0x0FFF; -+ w1 = GEM_BFINS(T2VLANID, 1, w1); -+ w1 = GEM_BFINS(T2CMPOFST, 0, w1); /* 0 C-TAG VID, 1 S-TAG VID */ -+ gem_writel_n(bp, T2CMPW0, -+ T2CMP_OFST(GEM_VLAN_ID_CMP(index)), w0); -+ gem_writel_n(bp, T2CMPW1, -+ T2CMP_OFST(GEM_VLAN_ID_CMP(index)), w1); -+ cmp_c = true; -+ } -+ -+ t2_scr = 0; -+ t2_scr = GEM_BFINS(QUEUE, -+ stream_id[STREAM_RX_QUEUE].value & 0xFF, t2_scr); -+ t2_scr = GEM_BFINS(ETHT2IDX, SCRT2_ETHT, t2_scr); -+ if (cmp_a) { -+ t2_scr = GEM_BFINS(CMPA, GEM_MAC_FIRST_CMP(index), t2_scr); -+ t2_scr = GEM_BFINS(CMPAEN, 1, t2_scr); -+ } -+ if (cmp_b) { -+ t2_scr = GEM_BFINS(CMPB, GEM_MAC_SECOND_CMP(index), t2_scr); -+ t2_scr = GEM_BFINS(CMPBEN, 1, t2_scr); -+ } -+ if (cmp_c) { -+ t2_scr = GEM_BFINS(CMPC, GEM_VLAN_ID_CMP(index), t2_scr); -+ t2_scr = GEM_BFINS(CMPCEN, 1, t2_scr); -+ } -+ gem_writel_n(bp, SCRT2, index, t2_scr); -+ return 0; -+} -+ -+static int phytium_set_ip_to_hw(struct macb *bp, struct tsn_setting_param *id) -+{ -+ u16 index = id[STREAM_INDEX].value; -+ u32 w0, w1, t2_scr; -+ bool cmp_a = false; -+ bool cmp_b = false; -+ bool cmp_c = false; -+ -+ if (id[STREAM_SRC_IP].value) { -+ /* 1st compare reg - IP source address */ -+ w0 = 0; -+ w1 = 0; -+ w0 = id[STREAM_SRC_IP].value; -+ w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ -+ w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_ETYPE, w1); -+ w1 = GEM_BFINS(T2OFST, ETYPE_SRCIP_OFFSET, w1); -+ gem_writel_n(bp, T2CMPW0, -+ T2CMP_OFST(GEM_IP4SRC_CMP(index)), w0); -+ gem_writel_n(bp, T2CMPW1, -+ T2CMP_OFST(GEM_IP4SRC_CMP(index)), w1); -+ cmp_a = true; -+ } -+ -+ if (id[STREAM_DST_IP].value) { -+ /* 2nd compare reg - IP destination address */ -+ w0 = 0; -+ w1 = 0; -+ w0 = id[STREAM_DST_IP].value; -+ w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ -+ w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_ETYPE, w1); -+ w1 = GEM_BFINS(T2OFST, ETYPE_DSTIP_OFFSET, w1); -+ gem_writel_n(bp, T2CMPW0, -+ T2CMP_OFST(GEM_IP4DST_CMP(index)), w0); -+ gem_writel_n(bp, T2CMPW1, -+ T2CMP_OFST(GEM_IP4DST_CMP(index)), w1); -+ cmp_b = true; -+ } -+ -+ if (id[STREAM_SRC_PORT].value || id[STREAM_DST_PORT].value) { -+ /* 3rd compare reg - source port, destination port */ -+ w0 = 0; -+ w1 = 0; -+ w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_IPHDR, w1); -+ if (id[STREAM_DST_PORT].value && -+ id[STREAM_SRC_PORT].value) { -+ w0 = GEM_BFINS(T2MASK, -+ id[STREAM_SRC_PORT].value, w0); -+ w0 = GEM_BFINS(T2CMP, -+ id[STREAM_DST_PORT].value, w0); -+ w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ -+ w1 = GEM_BFINS(T2OFST, IPHDR_SRCPORT_OFFSET, w1); -+ } else if (id[STREAM_SRC_PORT].value) { /* src port */ -+ /* only one port definition */ -+ w1 = GEM_BFINS(T2DISMSK, 0, w1); /* 16-bit compare */ -+ w0 = GEM_BFINS(T2MASK, 0xFFFF, w0); -+ w0 = GEM_BFINS(T2CMP, id[STREAM_SRC_PORT].value, w0); -+ w1 = GEM_BFINS(T2OFST, IPHDR_SRCPORT_OFFSET, w1); -+ } else { /* dst port */ -+ w1 = GEM_BFINS(T2DISMSK, 0, w1); /* 16-bit compare */ -+ w0 = GEM_BFINS(T2MASK, 0xFFFF, w0); -+ w0 = GEM_BFINS(T2CMP, id[STREAM_DST_PORT].value, w0); -+ w1 = GEM_BFINS(T2OFST, IPHDR_DSTPORT_OFFSET, w1); -+ } -+ gem_writel_n(bp, T2CMPW0, T2CMP_OFST(GEM_PORT_CMP(index)), w0); -+ gem_writel_n(bp, T2CMPW1, T2CMP_OFST(GEM_PORT_CMP(index)), w1); -+ cmp_c = true; -+ } -+ -+ t2_scr = 0; -+ t2_scr = GEM_BFINS(QUEUE, -+ id[STREAM_RX_QUEUE].value & 0xFF, t2_scr); -+ t2_scr = GEM_BFINS(ETHT2IDX, SCRT2_ETHT, t2_scr); -+ if (cmp_a) { -+ t2_scr = GEM_BFINS(CMPA, GEM_MAC_FIRST_CMP(index), t2_scr); -+ t2_scr = GEM_BFINS(CMPAEN, 1, t2_scr); -+ } -+ if (cmp_b) { -+ t2_scr = GEM_BFINS(CMPB, GEM_MAC_SECOND_CMP(index), t2_scr); -+ t2_scr = GEM_BFINS(CMPBEN, 1, t2_scr); -+ } -+ if (cmp_c) { -+ t2_scr = GEM_BFINS(CMPC, GEM_VLAN_ID_CMP(index), t2_scr); -+ t2_scr = GEM_BFINS(CMPCEN, 1, t2_scr); -+ } -+ gem_writel_n(bp, SCRT2, index, t2_scr); -+ -+ return 0; -+} -+ -+static int phytium_add_stream_id(struct macb *bp, -+ struct tsn_setting_param *stream_id) -+{ -+ struct ethtool_rx_fs_item *item, *newfs; -+ unsigned long flags, mac_value; -+ int ret = -EINVAL; -+ bool added = false, is_src_mac, is_ip = false; -+ -+ /* stream_id param check */ -+ if (stream_id[STREAM_SRC_MAC].value) { -+ is_src_mac = true; -+ mac_value = stream_id[STREAM_SRC_MAC].value; -+ } else if (stream_id[STREAM_DST_MAC].value) { -+ mac_value = stream_id[STREAM_DST_MAC].value; -+ } else if (stream_id[STREAM_DST_IP].value || -+ stream_id[STREAM_SRC_IP].value || -+ stream_id[STREAM_DST_PORT].value || -+ stream_id[STREAM_SRC_PORT].value) { -+ is_ip = true; -+ } else { -+ return -EINVAL; -+ } -+ -+ ret = phytium_find_stream_id(bp, stream_id[STREAM_INDEX].value, false); -+ if ((ret != -ENOENT) || -+ stream_id[STREAM_RX_QUEUE].value >= bp->num_queues) -+ return -EINVAL; -+ -+ newfs = kzalloc(sizeof(*newfs), GFP_KERNEL); -+ if (!newfs) -+ return -ENOMEM; -+ -+ newfs->fs.location = stream_id[STREAM_INDEX].value; -+ newfs->fs.ring_cookie = stream_id[STREAM_RX_QUEUE].value; -+ -+ if (!is_ip) { -+ newfs->fs.flow_type = FLOW_MAC_EXT; -+ newfs->fs.h_ext.data[0] = is_src_mac; -+ newfs->fs.h_ext.vlan_tci = stream_id[STREAM_VLAN_ID].value; -+ mac_value = __fswab64(mac_value); -+ memcpy(newfs->fs.h_ext.h_dest, (char *)&mac_value + 2, 6); -+ } else { -+ newfs->fs.flow_type = TCP_V4_FLOW; -+ newfs->fs.h_u.tcp_ip4_spec.ip4src = -+ stream_id[STREAM_SRC_IP].value; -+ newfs->fs.h_u.tcp_ip4_spec.ip4dst = -+ stream_id[STREAM_DST_IP].value; -+ newfs->fs.h_u.tcp_ip4_spec.psrc = -+ stream_id[STREAM_SRC_PORT].value; -+ newfs->fs.h_u.tcp_ip4_spec.pdst = -+ stream_id[STREAM_DST_PORT].value; -+ } -+ -+ spin_lock_irqsave(&bp->rx_fs_lock, flags); -+ -+ /* find correct place to add in list */ -+ list_for_each_entry(item, &bp->rx_fs_list.list, list) { -+ if (item->fs.location > newfs->fs.location) { -+ list_add_tail(&newfs->list, &item->list); -+ added = true; -+ break; -+ } else if (item->fs.location == stream_id[STREAM_INDEX].value) { -+ pr_warn("stream id %d not added: not free\n", -+ item->fs.location); -+ ret = -EBUSY; -+ goto err; -+ } -+ } -+ if (!added) -+ list_add_tail(&newfs->list, &bp->rx_fs_list.list); -+ -+ if (!is_ip) -+ phytium_set_stream_to_hw(bp, stream_id); -+ else -+ phytium_set_ip_to_hw(bp, stream_id); -+ bp->rx_fs_list.count++; -+ -+ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); -+ return 0; -+ -+err: -+ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); -+ kfree(newfs); -+ return ret; -+} -+ -+static int phytium_del_stream_id(struct macb *bp, -+ struct tsn_setting_param *stream_id) -+{ -+ struct ethtool_rx_fs_item *item; -+ unsigned long flags; -+ -+ pr_debug("%s %d\n", __func__, __LINE__); -+ -+ spin_lock_irqsave(&bp->rx_fs_lock, flags); -+ -+ list_for_each_entry(item, &bp->rx_fs_list.list, list) { -+ if (item->fs.location == stream_id[STREAM_INDEX].value) { -+ gem_writel_n(bp, SCRT2, item->fs.location, 0); -+ list_del(&item->list); -+ bp->rx_fs_list.count--; -+ -+ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); -+ pr_info("stream id %d: delete\n", item->fs.location); -+ kfree(item); -+ return 0; -+ } -+ } -+ -+ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); -+ return -EINVAL; -+} -+ -+static int phytium_find_stream_id(struct macb *bp, long value, bool print) -+{ -+ struct ethtool_rx_fs_item *item; -+ unsigned long flags; -+ -+ if (value < 0 || value >= bp->max_tuples) -+ return -EINVAL; -+ -+ pr_debug("%s %d\n", __func__, __LINE__); -+ -+ spin_lock_irqsave(&bp->rx_fs_lock, flags); -+ -+ list_for_each_entry(item, &bp->rx_fs_list.list, list) { -+ if (item->fs.location == value) { -+ if (print) { -+ if (item->fs.flow_type != FLOW_MAC_EXT) { -+ pr_info("stream id %ld is used by ethtool\n", -+ value); -+ } else { -+ pr_info("stream id %d: %s_mac:%pm vid %d\n", -+ item->fs.location, -+ item->fs.h_ext.data[0] ? -+ "src" : "dst", -+ (item->fs.h_ext.h_dest), -+ item->fs.h_ext.vlan_tci); -+ } -+ } -+ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); -+ return 0; -+ } -+ } -+ if (print) -+ pr_info("stream id %ld not find\n", value); -+ -+ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); -+ return -ENOENT; -+} -+ -+static int phytium_show_stream_id(struct macb *bp, -+ struct tsn_setting_param *stream_id) -+{ -+ return phytium_find_stream_id(bp, stream_id[STREAM_INDEX].value, true); -+} -+ -+static ssize_t stream_id_store(struct device *dev, -+ struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct macb *bp = container_of(attr, struct macb, stream_id_attr); -+ struct tsn_setting_param stream_id[] = { -+ [STREAM_INDEX] = { .name = "index", 1}, -+ [STREAM_SRC_MAC] = { .name = "src_mac", 0}, -+ [STREAM_DST_MAC] = { .name = "dst_mac", 0}, -+ [STREAM_SRC_IP] = { .name = "src_ip", 0}, -+ [STREAM_DST_IP] = { .name = "dst_ip", 0}, -+ [STREAM_SRC_PORT] = { .name = "src_port", 0}, -+ [STREAM_DST_PORT] = { .name = "dst_port", 0}, -+ [STREAM_TAGGED] = { .name = "tagged", 3}, -+ [STREAM_VLAN_ID] = { .name = "vlan_id", 0}, -+ [STREAM_RX_QUEUE] = { .name = "rx_queue", 1}, -+ }; -+ int i, ret, action = 0; -+ -+ if (strstr(buf, "add")) -+ action = STREAM_ADD; -+ else if (strstr(buf, "del")) -+ action = STREAM_DEL; -+ else if (strstr(buf, "show")) -+ action = STREAM_SHOW; -+ else -+ return -EINVAL; -+ -+ for (i = 0; i < GET_SETTING_SIZE(stream_id); i++) { -+ /* find setting name */ -+ char *tmp = strstr(buf, stream_id[i].name); -+ char *end; -+ int recovery = 0; -+ -+ if (!tmp) -+ continue; -+ tmp += strlen(stream_id[i].name); -+ tmp = skip_spaces(tmp); -+ end = strpbrk(tmp, " "); -+ if (end) { -+ recovery = 1; -+ *end = '\0'; -+ } -+ switch (i) { -+ case STREAM_SRC_IP: -+ case STREAM_DST_IP: -+ stream_id[i].value = in_aton(tmp); -+ break; -+ case STREAM_SRC_MAC: -+ case STREAM_DST_MAC: -+ ret = kstrtol(tmp, 16, &stream_id[i].value); -+ break; -+ case STREAM_SRC_PORT: -+ case STREAM_DST_PORT: -+ ret = kstrtol(tmp, 10, &stream_id[i].value); -+ stream_id[i].value = ntohs((short)stream_id[i].value); -+ break; -+ default: -+ ret = kstrtol(tmp, 10, &stream_id[i].value); -+ break; -+ } -+ if (recovery) -+ *end = ' '; -+ -+ if (ret < 0) -+ return ret; -+ dev_dbg(dev, "get: %s=%lx\n", stream_id[i].name, -+ stream_id[i].value); -+ } -+ -+ switch (action) { -+ case STREAM_ADD: -+ ret = phytium_add_stream_id(bp, stream_id); -+ break; -+ case STREAM_DEL: -+ ret = phytium_del_stream_id(bp, stream_id); -+ break; -+ case STREAM_SHOW: -+ ret = phytium_show_stream_id(bp, stream_id); -+ break; -+ default: -+ return -EINVAL; -+ } -+ if (ret < 0) -+ return ret; -+ return count; -+} -+DEVICE_ATTR_RW(stream_id); -+ -+static ssize_t qci_setting_show(struct device *dev, -+ struct device_attribute *attr, char *buf) -+{ -+ struct macb *bp = container_of(attr, struct macb, qci_setting_attr); -+ (void)bp; -+ return snprintf(buf, PAGE_SIZE, -+ "help:\n" -+ " index: stream id handle, if use ethtool to do stream identify, it should same as [loc]\n" -+ " max_sdu: maximum SDU(service data unit) size, max to 0xFFFF, byte,\n" -+ " this param will effect rx queue, not only this stream id handle\n" -+ " ipv: same as rx_queue in stream_id, it will cover the setting in stream_id\n" -+ " interval: TimeInterval, ns\n" -+ " max_rate: IntervalOctetMax, byte\n" -+ " mark_red: MarkAllFramesRed, all frame in this stream id will drop\n" -+ "example:\n" -+ " echo index 0 max_sdu 512 ipv 7 > qci_setting\n" -+ " echo index 0 ipv 7 interval 500000 max_rate 32768 > qci_setting\n" -+ " echo index 0 ipv 6 interval 500000 max_rate 16384 > qci_setting\n" -+ " echo index 0 mark_red 1 > qci_setting\n"); -+} -+ -+static int phytium_set_qci(struct macb *bp, struct tsn_setting_param *setting) -+{ -+ int index = setting[QCI_INDEX].value; -+ u32 queue, t2_scr, max_sdu_size = 0, flush_reg = 0; -+ u32 rate_limit_reg, scale; -+ unsigned long flags; -+ -+ if (phytium_find_stream_id(bp, setting[QCI_INDEX].value, false) || -+ setting[QCI_IPV].value >= bp->num_queues || -+ setting[QCI_MAX_SDU].value > 0xFFFFL) -+ return -EINVAL; -+ -+ /* update screen type 2 register */ -+ spin_lock_irqsave(&bp->rx_fs_lock, flags); -+ t2_scr = gem_readl_n(bp, SCRT2, index); -+ if (setting[QCI_IPV].value > 0) -+ t2_scr = -+ GEM_BFINS(QUEUE, setting[QCI_IPV].value & 0xFF, t2_scr); -+ -+ if (setting[QCI_MARK_RED].value == 1) -+ t2_scr = GEM_BFINS(DROP_ON_MATCH, 1, t2_scr); -+ else -+ t2_scr = GEM_BFINS(DROP_ON_MATCH, 0, t2_scr); -+ gem_writel_n(bp, SCRT2, index, t2_scr); -+ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); -+ -+ /* get the queue num in screen type 2 */ -+ queue = GEM_BFEXT(QUEUE, t2_scr); -+ -+ if (setting[QCI_MAX_SDU].value > 0) -+ max_sdu_size = setting[QCI_MAX_SDU].value & 0xFFFFL; -+ -+ /* set rx Qx flush reg */ -+ if (max_sdu_size) -+ flush_reg = GEM_BF(MAX_VAL, max_sdu_size) | -+ GEM_BF(LIMIT_FRAME_SIZE, 1); -+ gem_writel_n(bp, RX_Q0_FLUSH, queue, flush_reg); -+ -+ /* set rate limit reg */ -+ switch (bp->speed) { -+ case SPEED_10: -+ scale = 51200; -+ break; -+ case SPEED_100: -+ scale = 5120; -+ break; -+ case SPEED_1000: -+ scale = 1024; -+ break; -+ default: -+ pr_info("macb speed %d not support\n", bp->speed); -+ return -EOPNOTSUPP; -+ } -+ rate_limit_reg = GEM_BF(MAX_RATE_VAL, setting[QCI_MAX_RATE].value) | -+ GEM_BF(INTERVAL_TIME, setting[QCI_INTERVAL].value / scale); -+ gem_writel_n(bp, SCR2_REG0_RATE_LIMIT, index, rate_limit_reg); -+ -+ return 0; -+} -+ -+static ssize_t qci_setting_store(struct device *dev, -+ struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct macb *bp = container_of(attr, struct macb, qci_setting_attr); -+ struct tsn_setting_param qci_setting[] = { -+ [QCI_INDEX] = { .name = "index", 0}, -+ [QCI_MAX_SDU] = { .name = "max_sdu", -1}, -+ [QCI_IPV] = { .name = "ipv", -1}, -+ [QCI_INTERVAL] = { .name = "interval", 0}, -+ [QCI_MAX_RATE] = { .name = "max_rate", 0}, -+ [QCI_MARK_RED] = { .name = "mark_red", 0}, -+ }; -+ int i, ret; -+ -+ for (i = 0; i < GET_SETTING_SIZE(qci_setting); i++) { -+ /* find setting name */ -+ char *tmp = strstr(buf, qci_setting[i].name); -+ char *end; -+ int recovery = 0; -+ -+ if (!tmp) -+ continue; -+ -+ tmp += strlen(qci_setting[i].name); -+ tmp = skip_spaces(tmp); -+ end = strpbrk(tmp, " "); -+ if (end) { -+ recovery = 1; -+ *end = '\0'; -+ } -+ /* kstrtol input string must be null-terminated */ -+ ret = kstrtol(tmp, 10, &qci_setting[i].value); -+ if (recovery) -+ *end = ' '; -+ -+ if (ret < 0) -+ return ret; -+ dev_dbg(dev, "get: %s=%ld\n", qci_setting[i].name, -+ qci_setting[i].value); -+ } -+ -+ ret = phytium_set_qci(bp, qci_setting); -+ if (ret < 0) -+ return ret; -+ return count; -+} -+DEVICE_ATTR_RW(qci_setting); -+ -+static ssize_t qav_setting_show(struct device *dev, -+ struct device_attribute *attr, char *buf) -+{ -+ struct macb *bp = container_of(attr, struct macb, qci_setting_attr); -+ -+ return snprintf(buf, PAGE_SIZE, -+ "help:\n" -+ " queue: queue index to set cbs, support value:%d, %d\n" -+ " idleslop: same as tc-cbs, kilobit/sec\n" -+ " enable: 1: enable, 0: disable, default enable\n" -+ "example:\n" -+ " echo queue 7 idleslop 400000 > qav_setting\n" -+ " echo queue 6 idleslop 200000 > qav_setting\n" -+ " echo queue 7 enable 0 > qav_setting\n", -+ bp->num_queues - 2, bp->num_queues - 1); -+} -+ -+static int phytium_set_qav(struct macb *bp, struct tsn_setting_param *setting) -+{ -+ int queue = setting[QAV_QUEUE].value; -+ int idle_slope, cbs_ctrl; -+ -+ if (queue != bp->num_queues - 1 && queue != bp->num_queues - 2) -+ return -EINVAL; -+ -+ cbs_ctrl = gem_readl(bp, CBS_CONTROL); -+ -+ if (!setting[QAV_ENABLE].value) { -+ cbs_ctrl &= (~BIT(bp->num_queues - 1 - queue)); -+ gem_writel(bp, CBS_CONTROL, cbs_ctrl); -+ return 0; -+ } -+ -+ if (setting[QAV_IDLESLOPE].value < 0 || -+ setting[QAV_IDLESLOPE].value > bp->speed * 1000 * 1000) { -+ pr_warn("idleslope invalid, please check it\n"); -+ return -EINVAL; -+ } -+ -+ /* calculate idle slope value, cbs->idleslope is kilobit/sec */ -+ /* reg value in bytes/sec for gigabit operation, and nibbles/sec */ -+ /* for 10/100 operation, and scaled by 2.5 in 2.5G operation */ -+ switch (bp->speed) { -+ case SPEED_10: -+ case SPEED_100: -+ idle_slope = 125 * setting[QAV_IDLESLOPE].value * 2; -+ break; -+ case SPEED_1000: -+ idle_slope = 125 * setting[QAV_IDLESLOPE].value; -+ break; -+ case SPEED_2500: -+ idle_slope = 125 * setting[QAV_IDLESLOPE].value * 2 / 5; -+ break; -+ default: -+ pr_info("macb speed %d not support\n", bp->speed); -+ return -EOPNOTSUPP; -+ } -+ -+ /* cbs should be disabled prior to updating the idle slope value */ -+ cbs_ctrl &= (~BIT(bp->num_queues - 1 - queue)); -+ gem_writel(bp, CBS_CONTROL, cbs_ctrl); -+ -+ if (queue == bp->num_queues - 1) -+ gem_writel(bp, CBS_IDLESLOPE_Q_A, idle_slope); -+ else -+ gem_writel(bp, CBS_IDLESLOPE_Q_B, idle_slope); -+ -+ /* after set idle slope, enable cbs */ -+ cbs_ctrl |= BIT(bp->num_queues - 1 - queue); -+ gem_writel(bp, CBS_CONTROL, cbs_ctrl); -+ -+ return 0; -+} -+ -+static ssize_t qav_setting_store(struct device *dev, -+ struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct macb *bp = container_of(attr, struct macb, qav_setting_attr); -+ struct tsn_setting_param qav_setting[] = { -+ [QAV_QUEUE] = { .name = "queue", 0}, -+ [QAV_IDLESLOPE] = { .name = "idleslop", 0}, -+ [QAV_ENABLE] = { .name = "enable", 1}, -+ }; -+ int i, ret; -+ -+ for (i = 0; i < GET_SETTING_SIZE(qav_setting); i++) { -+ /* find setting name */ -+ char *tmp = strstr(buf, qav_setting[i].name); -+ char *end; -+ int recovery = 0; -+ -+ if (!tmp) -+ continue; -+ -+ tmp += strlen(qav_setting[i].name); -+ tmp = skip_spaces(tmp); -+ end = strpbrk(tmp, " "); -+ if (end) { -+ recovery = 1; -+ *end = '\0'; -+ } -+ /* kstrtol input string must be null-terminated */ -+ ret = kstrtol(tmp, 10, &qav_setting[i].value); -+ if (recovery) -+ *end = ' '; -+ -+ if (ret < 0) -+ return ret; -+ dev_dbg(dev, "get: %s=%ld\n", qav_setting[i].name, -+ qav_setting[i].value); -+ } -+ -+ ret = phytium_set_qav(bp, qav_setting); -+ if (ret < 0) -+ return ret; -+ -+ return count; -+} -+DEVICE_ATTR_RW(qav_setting); -+ -+static ssize_t qbv_setting_show(struct device *dev, -+ struct device_attribute *attr, char *buf) -+{ -+ struct macb *bp = container_of(attr, struct macb, qbv_setting_attr); -+ (void)bp; -+ return snprintf(buf, PAGE_SIZE, -+ "help:\n" -+ " input format: queue [queue_number] [start_time] \\\n" -+ " [on_time] [off_time]\n" -+ " queue_number: set qbv this queue\n" -+ " start_time:after this time, period start\n" -+ " on_time: gate open time\n" -+ " off_time: gate close time\n" -+ "example:\n" -+ " echo queue 3 0 125000 375000 \\\n" -+ " queue 2 125000 125000 375000 \\\n" -+ " queue 1 250000 250000 250000 > qbv_setting\n"); -+} -+ -+static ssize_t qbv_setting_store(struct device *dev, -+ struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct queues_enst_setting setting[MACB_MAX_ENST_QUEUES] = {0}; -+ char *tmp = (char *)buf; -+ int ret; -+ -+ while ((tmp = strstr(tmp, "queue")) != NULL) { -+ long q, start_time, on_time, off_time; -+ char *next; -+ -+ tmp += strlen("queue"); -+ next = skip_spaces(tmp); -+ tmp = strsep(&next, " "); -+ if (!tmp) -+ return -EINVAL; -+ ret = kstrtol(tmp, 10, &q); -+ if (ret < 0 || q > MACB_MAX_ENST_QUEUES || q < 0) -+ return -EINVAL; -+ setting[q].enable = 1; -+ -+ tmp = strsep(&next, " "); -+ if (!tmp) -+ return -EINVAL; -+ ret = kstrtol(tmp, 10, &start_time); -+ if (ret < 0) -+ return -EINVAL; -+ setting[q].start_time = start_time; -+ -+ tmp = strsep(&next, " "); -+ if (!tmp) -+ return -EINVAL; -+ ret = kstrtol(tmp, 10, &on_time); -+ if (ret < 0 || on_time > 1048568 || on_time < 0) -+ return -EINVAL; -+ setting[q].on_time = on_time; -+ -+ tmp = strsep(&next, " "); -+ if (!tmp) -+ return -EINVAL; -+ ret = kstrtol(tmp, 10, &off_time); -+ if (ret < 0 || off_time > 1048568 || off_time < 0) -+ return -EINVAL; -+ setting[q].off_time = off_time; -+ -+ tmp = next; -+ if (!tmp) -+ break; -+ } -+ -+ _dump_enst_param(setting); -+ -+ ret = phytium_set_taprio(dev_get_drvdata(dev), setting); -+ if (ret) -+ return ret; -+ -+ return count; -+} -+DEVICE_ATTR_RW(qbv_setting); -+ -+static void _create_tsn_sysfs_entries(struct device *dev, struct macb *bp) -+{ -+ int ret; -+ -+ if (bp->tsn_cap & TSN_CAP_8021CB) { -+ bp->cb_setting_attr = dev_attr_cb_setting; -+ sysfs_attr_init(&bp->cb_setting_attr.attr); -+ ret = device_create_file(dev, &bp->cb_setting_attr); -+ if (ret < 0) -+ dev_warn(dev, "create cb_setting_attr failed %d", ret); -+ else -+ dev_dbg(dev, "create cb_setting_attr ok\n"); -+ } -+ -+ if (bp->tsn_cap & TSN_CAP_8021QCI) { -+ bp->qci_setting_attr = dev_attr_qci_setting; -+ sysfs_attr_init(&bp->qci_setting_attr.attr); -+ ret = device_create_file(dev, &bp->qci_setting_attr); -+ if (ret < 0) -+ dev_warn(dev, "create qci_setting_attr failed %d", ret); -+ else -+ dev_dbg(dev, "create qci_setting_attr ok\n"); -+ } -+ -+ if (bp->tsn_cap & TSN_CAP_8021QAV) { -+ bp->qav_setting_attr = dev_attr_qav_setting; -+ sysfs_attr_init(&bp->qav_setting_attr.attr); -+ ret = device_create_file(dev, &bp->qav_setting_attr); -+ if (ret < 0) -+ dev_warn(dev, "create qav_setting_attr failed %d", ret); -+ else -+ dev_dbg(dev, "create qav_setting_attr ok\n"); -+ } -+ -+ if (bp->tsn_cap & TSN_CAP_8021QBV) { -+ bp->qbv_setting_attr = dev_attr_qbv_setting; -+ sysfs_attr_init(&bp->qbv_setting_attr.attr); -+ ret = device_create_file(dev, &bp->qbv_setting_attr); -+ if (ret < 0) -+ dev_warn(dev, "create qbv_setting_attr failed %d", ret); -+ else -+ dev_dbg(dev, "create qbv_setting_attr ok\n"); -+ } -+ -+ if (bp->tsn_cap & (TSN_CAP_8021CB | TSN_CAP_8021QCI)) { -+ bp->stream_id_attr = dev_attr_stream_id; -+ sysfs_attr_init(&bp->stream_id_attr.attr); -+ ret = device_create_file(dev, &bp->stream_id_attr); -+ if (ret < 0) -+ dev_warn(dev, "create stream_id_attr failed %d", ret); -+ else -+ dev_dbg(dev, "create stream_id_attr ok\n"); -+ } -+} -+ -+void phytium_init_tsn(struct platform_device *pdev) -+{ -+ struct net_device *dev = platform_get_drvdata(pdev); -+ struct macb *bp = netdev_priv(dev); -+ u32 cfg12; -+ -+ if (!device_property_read_bool(&pdev->dev, "support-tsn")) { -+ dev_dbg(&pdev->dev, "not support tsn, skip it"); -+ return; -+ } -+ pr_debug("%s %d\n", __func__, __LINE__); -+ -+ bp->tsn_cap = TSN_CAP_8021QAV | TSN_CAP_8021QBV | TSN_CAP_8021QCI; -+ dev->hw_features |= NETIF_F_HW_TC; -+ -+ cfg12 = gem_readl(bp, DCFG12); -+ if (cfg12 & GEM_BIT(HAS_CB)) { -+ bp->tsn_cap |= TSN_CAP_8021CB; -+ bp->num_cb_streams = GEM_BFEXT(NUM_CB_STREAMS, cfg12); -+ bp->cb_history_len = GEM_BFEXT(CB_HISTORY_LEN, cfg12); -+ } -+ _create_tsn_sysfs_entries(&pdev->dev, bp); -+} -+ -+void phytium_deinit_tsn(struct platform_device *pdev) -+{ -+ struct net_device *dev = platform_get_drvdata(pdev); -+ struct macb *bp = netdev_priv(dev); -+ -+ if (!device_property_read_bool(&pdev->dev, "support-tsn")) { -+ dev_dbg(&pdev->dev, "not support tsn, skip it"); -+ return; -+ } -+ -+ if (bp->tsn_cap & TSN_CAP_8021CB) -+ device_remove_file(&pdev->dev, &bp->cb_setting_attr); -+ -+ if (bp->tsn_cap & TSN_CAP_8021QCI) -+ device_remove_file(&pdev->dev, &bp->qci_setting_attr); -+ -+ if (bp->tsn_cap & TSN_CAP_8021QAV) -+ device_remove_file(&pdev->dev, &bp->qav_setting_attr); -+ -+ if (bp->tsn_cap & TSN_CAP_8021QBV) -+ device_remove_file(&pdev->dev, &bp->qbv_setting_attr); -+ -+ if (bp->tsn_cap & (TSN_CAP_8021CB | TSN_CAP_8021QCI)) { -+ device_remove_file(&pdev->dev, &bp->stream_id_attr); -+ } -+} -+ -diff --git a/drivers/net/ethernet/cadence/macb_tsn.h b/drivers/net/ethernet/cadence/macb_tsn.h -new file mode 100644 -index 000000000..422a854eb ---- /dev/null -+++ b/drivers/net/ethernet/cadence/macb_tsn.h -@@ -0,0 +1,149 @@ -+/* SPDX-License-Identifier: GPL-2.0-only */ -+/* -+ * Phytium TSN support driver -+ * -+ * Copyright (c) 2024 Phytium Technology Co., Ltd. -+ */ -+#ifndef _MACB_TSN_H -+#define _MACB_TSN_H -+ -+#define MACB_MAX_ENST_QUEUES 8 -+ -+#define TSN_CAP_8021QAV 0x00000001 -+#define TSN_CAP_8021QBV 0x00000002 -+#define TSN_CAP_8021QCI 0x00000004 -+#define TSN_CAP_8021CB 0x00000008 -+#define TSN_CAP_8023BR 0x00000010 -+ -+/* 802.1Qav */ -+#define GEM_CBS_CONTROL 0x04BC -+#define GEM_CBS_IDLESLOPE_Q_A 0x04C0 -+#define GEM_CBS_IDLESLOPE_Q_B 0x04C4 -+ -+/* 802.1Qbv */ -+#define GEM_ENST_START_TIME 0x0800 -+#define GEM_ENST_ON_TIME 0x0820 -+#define GEM_ENST_OFF_TIME 0x0840 -+#define GEM_ENST_CONTROL 0x0880 -+ -+/* 802.1CB */ -+/* Bitfields in DCFG12 */ -+#define GEM_HAS_CB_OFFSET 16 -+#define GEM_HAS_CB_SIZE 1 -+#define GEM_CB_HISTORY_LEN_OFFSET 8 -+#define GEM_CB_HISTORY_LEN_SIZE 8 -+#define GEM_NUM_CB_STREAMS_OFFSET 0 -+#define GEM_NUM_CB_STREAMS_SIZE 8 -+ -+#define GEM_FRER_TIMEOUT 0x08A0 -+#define GEM_FRER_RED_TAG 0x08A4 -+#define GEM_FRER_CONTROL_1_A 0x08C0 -+#define GEM_FRER_CONTROL_1_B 0x08C4 -+#define GEM_FRER_STATISTICS_1_A 0x08C8 -+#define GEM_FRER_STATISTICS_1_B 0x08CC -+ -+/* Bitfields in FRER_RED_TAG */ -+#define GEM_STRIP_R_TAG_OFFSET 31 -+#define GEM_STRIP_R_TAG_SIZE 1 -+ -+/* Bitfields in FRER_CONTROL_B */ -+#define GEM_MEMBER_STREAM2_OFFSET 4 -+#define GEM_MEMBER_STREAM2_SIZE 4 -+#define GEM_MEMBER_STREAM1_OFFSET 0 -+#define GEM_MEMBER_STREAM1_SIZE 4 -+ -+/* Bitfields in FRER_CONTROL_B */ -+#define GEM_SEQ_NUM_LENGTH_OFFSET 8 -+#define GEM_SEQ_NUM_LENGTH_SIZE 5 -+#define GEM_SEQ_REC_WINDOW_OFFSET 0 -+#define GEM_SEQ_REC_WINDOW_SIZE 6 -+ -+/* 802.1Qci */ -+#define GEM_RX_Q0_FLUSH 0x0B00 -+#define GEM_SCR2_REG0_RATE_LIMIT 0x0B40 -+#define GEM_SCR2_RATE_STATUS 0x0B80 -+ -+/* Bitfields in rx q0 flush */ -+#define GEM_MAX_VAL_OFFSET 16 -+#define GEM_MAX_VAL_SIZE 16 -+#define GEM_LIMIT_FRAME_SIZE_OFFSET 3 -+#define GEM_LIMIT_FRAME_SIZE_SIZE 1 -+ -+/* Bitfields in scr2 reg0 rate limit */ -+#define GEM_MAX_RATE_VAL_OFFSET 16 -+#define GEM_MAX_RATE_VAL_SIZE 16 -+#define GEM_INTERVAL_TIME_OFFSET 0 -+#define GEM_INTERVAL_TIME_SIZE 16 -+ -+/* type 2 compare registers -+ * each location requires 3 compare regs -+ */ -+#define GEM_MAC_FIRST_CMP(idx) ((idx) * 3) -+#define GEM_MAC_SECOND_CMP(idx) ((idx) * 3 + 1) -+#define GEM_VLAN_ID_CMP(idx) ((idx) * 3 + 2) -+ -+#undef TSN_DEBUG -+//#define TSN_DEBUG -+#ifdef TSN_DEBUG -+#define _dump_param(param) pr_err("%s %ld\n", #param, (unsigned long)param) -+#else -+#define _dump_param(param) -+#endif -+ -+struct tsn_setting_param { -+ const char *name; -+ long value; -+}; -+ -+enum { -+ CB_INDEX, -+ CB_OFST, -+ CB_SEQ_LEN, -+ CB_HIS_LEN, -+ CB_STRIP_RTAG, -+ CB_ENABLE, -+}; -+ -+enum { -+ STREAM_ADD = 1, -+ STREAM_DEL, -+ STREAM_SHOW, -+}; -+ -+enum { -+ STREAM_INDEX, -+ STREAM_SRC_MAC, -+ STREAM_DST_MAC, -+ STREAM_SRC_IP, -+ STREAM_DST_IP, -+ STREAM_SRC_PORT, -+ STREAM_DST_PORT, -+ STREAM_TAGGED, -+ STREAM_VLAN_ID, -+ STREAM_RX_QUEUE, -+}; -+ -+enum { -+ QCI_INDEX, -+ QCI_MAX_SDU, -+ QCI_IPV, -+ QCI_INTERVAL, -+ QCI_MAX_RATE, -+ QCI_MARK_RED, -+}; -+ -+enum { -+ QAV_QUEUE, -+ QAV_IDLESLOPE, -+ QAV_ENABLE, -+}; -+ -+#define GET_SETTING_SIZE(setting) (sizeof(setting) / \ -+ sizeof(struct tsn_setting_param)) -+ -+void phytium_init_tsn(struct platform_device *pdev); -+void phytium_deinit_tsn(struct platform_device *pdev); -+int phytium_setup_tc(struct net_device *ndev, -+ enum tc_setup_type type, void *type_data); -+ -+#endif /* _MACB_TSN_H */ -diff --git a/drivers/net/ethernet/stmicro/stmmac/Kconfig b/drivers/net/ethernet/stmicro/stmmac/Kconfig -index 53f14c5a9..3f2034ef8 100644 ---- a/drivers/net/ethernet/stmicro/stmmac/Kconfig -+++ b/drivers/net/ethernet/stmicro/stmmac/Kconfig -@@ -117,6 +117,16 @@ config DWMAC_OXNAS - This selects the Oxford Semiconductor OXNASSoC glue layer support for - the stmmac device driver. This driver is used for OX820. - -+config DWMAC_PHYTIUM -+ tristate "Phytium dwmac support" -+ default ARCH_PHYTIUM -+ depends on (OF || ACPI) && (ARCH_PHYTIUM || COMPILE_TEST) -+ help -+ Support for GMAC controller on Phytium SoCs. -+ -+ This selects the Phytium GMAC glue layer support for the -+ stmmac device driver. -+ - config DWMAC_QCOM_ETHQOS - tristate "Qualcomm ETHQOS support" - default ARCH_QCOM -diff --git a/drivers/net/ethernet/stmicro/stmmac/Makefile b/drivers/net/ethernet/stmicro/stmmac/Makefile -index 24e6145d4..04823f06c 100644 ---- a/drivers/net/ethernet/stmicro/stmmac/Makefile -+++ b/drivers/net/ethernet/stmicro/stmmac/Makefile -@@ -18,6 +18,7 @@ obj-$(CONFIG_DWMAC_LPC18XX) += dwmac-lpc18xx.o - obj-$(CONFIG_DWMAC_MEDIATEK) += dwmac-mediatek.o - obj-$(CONFIG_DWMAC_MESON) += dwmac-meson.o dwmac-meson8b.o - obj-$(CONFIG_DWMAC_OXNAS) += dwmac-oxnas.o -+obj-$(CONFIG_DWMAC_PHYTIUM) += dwmac-phytium.o - obj-$(CONFIG_DWMAC_QCOM_ETHQOS) += dwmac-qcom-ethqos.o - obj-$(CONFIG_DWMAC_ROCKCHIP) += dwmac-rk.o - obj-$(CONFIG_DWMAC_SOCFPGA) += dwmac-altr-socfpga.o -diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c b/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c -new file mode 100755 -index 000000000..a56d9a193 ---- /dev/null -+++ b/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c -@@ -0,0 +1,221 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SWMAC specific glue layer -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "stmmac.h" -+#include "stmmac_platform.h" -+ -+static int phytium_get_mac_mode(struct fwnode_handle *fwnode) -+{ -+ const char *pm; -+ int err, i; -+ -+ err = fwnode_property_read_string(fwnode, "mac-mode", &pm); -+ if (err < 0) -+ return err; -+ -+ for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) { -+ if (!strcasecmp(pm, phy_modes(i))) -+ return i; -+ } -+ -+ return -ENODEV; -+} -+ -+static int phytium_dwmac_acpi_phy(struct plat_stmmacenet_data *plat, -+ struct fwnode_handle *np, struct device *dev) -+{ -+ plat->mdio_bus_data = devm_kzalloc(dev, -+ sizeof(struct stmmac_mdio_bus_data), -+ GFP_KERNEL); -+ -+ if (!plat->mdio_bus_data) -+ return -ENOMEM; -+ -+ return 0; -+} -+ -+static int phytium_dwmac_probe(struct platform_device *pdev) -+{ -+ struct fwnode_handle *fwnode = dev_fwnode(&pdev->dev); -+ struct plat_stmmacenet_data *plat; -+ struct stmmac_resources stmmac_res; -+ struct device_node *np = pdev->dev.of_node; -+ u64 clk_freq; -+ char clk_name[20]; -+ int ret; -+ -+ plat = devm_kzalloc(&pdev->dev, sizeof(*plat), GFP_KERNEL); -+ if (!plat) -+ return -ENOMEM; -+ -+ plat->dma_cfg = devm_kzalloc(&pdev->dev, sizeof(*plat->dma_cfg), GFP_KERNEL); -+ if (!plat->dma_cfg) -+ return -ENOMEM; -+ -+ plat->axi = devm_kzalloc(&pdev->dev, sizeof(*plat->axi), GFP_KERNEL); -+ if (!plat->axi) -+ return -ENOMEM; -+ -+ plat->phy_interface = device_get_phy_mode(&pdev->dev); -+ if (plat->phy_interface < 0) -+ return plat->phy_interface; -+ -+ plat->interface = phytium_get_mac_mode(fwnode); -+ if (plat->interface < 0) -+ plat->interface = plat->phy_interface; -+ -+ /* Configure PHY if using device-tree */ -+ if (pdev->dev.of_node) { -+ plat->phy_node = of_parse_phandle(np, "phy-handle", 0); -+ plat->phylink_node = np; -+ } -+ -+ if (pdev->dev.of_node) { -+ plat->bus_id = of_alias_get_id(np, "ethernet"); -+ if (plat->bus_id < 0) -+ plat->bus_id = 0; -+ } else if (fwnode_property_read_u32(fwnode, "bus_id", &plat->bus_id)) { -+ plat->bus_id = 2; -+ } -+ -+ plat->phy_addr = -1; -+ plat->clk_csr = -1; -+ plat->has_gmac = 1; -+ plat->enh_desc = 1; -+ plat->bugged_jumbo = 1; -+ plat->pmt = 1; -+ plat->force_sf_dma_mode = 1; -+ -+ if (fwnode_property_read_u32(fwnode, "max-speed", &plat->max_speed)) -+ plat->max_speed = -1; -+ -+ if (fwnode_property_read_u32(fwnode, "max-frame-size", &plat->maxmtu)) -+ plat->maxmtu = JUMBO_LEN; -+ -+ if (fwnode_property_read_u32(fwnode, "snps,multicast-filter-bins", -+ &plat->multicast_filter_bins)) -+ plat->multicast_filter_bins = HASH_TABLE_SIZE; -+ -+ if (fwnode_property_read_u32(fwnode, "snps,perfect-filter-entries", -+ &plat->unicast_filter_entries)) -+ plat->unicast_filter_entries = 1; -+ -+ if (fwnode_property_read_u32(fwnode, "tx-fifo-depth", &plat->tx_fifo_size)) -+ plat->tx_fifo_size = 0x1000; -+ -+ if (fwnode_property_read_u32(fwnode, "rx-fifo-depth", &plat->rx_fifo_size)) -+ plat->rx_fifo_size = 0x1000; -+ -+ if (phytium_dwmac_acpi_phy(plat, fwnode, &pdev->dev)) -+ return -ENODEV; -+ -+ plat->rx_queues_to_use = 1; -+ plat->tx_queues_to_use = 1; -+ plat->rx_queues_cfg[0].mode_to_use = MTL_QUEUE_DCB; -+ plat->tx_queues_cfg[0].mode_to_use = MTL_QUEUE_DCB; -+ -+ if (fwnode_property_read_u64(fwnode, "clock-frequency", &clk_freq)) -+ clk_freq = 125000000; -+ -+ /* Set system clock */ -+ snprintf(clk_name, sizeof(clk_name), "%s-%d", "stmmaceth", plat->bus_id); -+ -+ plat->stmmac_clk = clk_register_fixed_rate(&pdev->dev, clk_name, NULL, 0, clk_freq); -+ if (IS_ERR(plat->stmmac_clk)) { -+ dev_warn(&pdev->dev, "Fail to register stmmac-clk\n"); -+ plat->stmmac_clk = NULL; -+ } -+ -+ ret = clk_prepare_enable(plat->stmmac_clk); -+ if (ret) { -+ clk_unregister_fixed_rate(plat->stmmac_clk); -+ return ret; -+ } -+ -+ plat->clk_ptp_rate = clk_get_rate(plat->stmmac_clk); -+ plat->clk_ptp_ref = NULL; -+ -+ if (fwnode_property_read_u32(fwnode, "snps,pbl", &plat->dma_cfg->pbl)) -+ plat->dma_cfg->pbl = 16; -+ -+ fwnode_property_read_u32(fwnode, "snps,txpbl", &plat->dma_cfg->txpbl); -+ fwnode_property_read_u32(fwnode, "snps,rxpbl", &plat->dma_cfg->rxpbl); -+ -+ plat->dma_cfg->pblx8 = !fwnode_property_read_bool(fwnode, "snps,no-pbl-x8"); -+ plat->dma_cfg->aal = fwnode_property_read_bool(fwnode, "snps,aal"); -+ plat->dma_cfg->fixed_burst = fwnode_property_read_bool(fwnode, "snps,fixed-burst"); -+ plat->dma_cfg->mixed_burst = fwnode_property_read_bool(fwnode, "snps,mixed-burst"); -+ -+ plat->axi->axi_lpi_en = false; -+ plat->axi->axi_xit_frm = false; -+ plat->axi->axi_wr_osr_lmt = 7; -+ plat->axi->axi_rd_osr_lmt = 7; -+ plat->axi->axi_blen[0] = 16; -+ -+ memset(&stmmac_res, 0, sizeof(stmmac_res)); -+ stmmac_res.addr = devm_platform_ioremap_resource(pdev, 0); -+ stmmac_res.irq = platform_get_irq(pdev, 0); -+ if (stmmac_res.irq < 0) { -+ dev_err(&pdev->dev, "IRQ not found.\n"); -+ return -ENXIO; -+ } -+ stmmac_res.wol_irq = stmmac_res.irq; -+ stmmac_res.lpi_irq = -1; -+ -+ return stmmac_dvr_probe(&pdev->dev, plat, &stmmac_res); -+} -+ -+int phytium_dwmac_remove(struct platform_device *pdev) -+{ -+ int ret; -+ struct net_device *ndev = platform_get_drvdata(pdev); -+ struct stmmac_priv *priv = netdev_priv(ndev); -+ struct plat_stmmacenet_data *plat = priv->plat; -+ -+ ret = stmmac_pltfr_remove(pdev); -+ clk_unregister_fixed_rate(plat->stmmac_clk); -+ return ret; -+} -+ -+#ifdef CONFIG_OF -+static const struct of_device_id phytium_dwmac_of_match[] = { -+ { .compatible = "phytium,gmac" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_dwmac_of_match); -+#endif -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_dwmac_acpi_ids[] = { -+ { .id = "PHYT0004" }, -+ {} -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_dwmac_acpi_ids); -+#endif -+ -+static struct platform_driver phytium_dwmac_driver = { -+ .probe = phytium_dwmac_probe, -+ .remove = phytium_dwmac_remove, -+ .driver = { -+ .name = "phytium-dwmac", -+ .pm = &stmmac_pltfr_pm_ops, -+ .of_match_table = of_match_ptr(phytium_dwmac_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_dwmac_acpi_ids), -+ }, -+}; -+module_platform_driver(phytium_dwmac_driver); -+ -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium DWMAC specific glue layer"); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/net/phy/Kconfig b/drivers/net/phy/Kconfig -index 698bea312..44056ad58 100644 ---- a/drivers/net/phy/Kconfig -+++ b/drivers/net/phy/Kconfig -@@ -314,6 +314,12 @@ config XILINX_GMII2RGMII - the Reduced Gigabit Media Independent Interface(RGMII) between - Ethernet physical media devices and the Gigabit Ethernet controller. - -+config MOTORCOMM_PHY -+ tristate "Motorcomm PHYs" -+ help -+ Enables support for Motorcomm network PHYs. -+ Currently supports the YT8511 gigabit PHY. -+ - endif # PHYLIB - - config MICREL_KS8995MA -diff --git a/drivers/net/phy/Makefile b/drivers/net/phy/Makefile -index a13e40207..5418a896f 100644 ---- a/drivers/net/phy/Makefile -+++ b/drivers/net/phy/Makefile -@@ -80,3 +80,5 @@ obj-$(CONFIG_STE10XP) += ste10Xp.o - obj-$(CONFIG_TERANETICS_PHY) += teranetics.o - obj-$(CONFIG_VITESSE_PHY) += vitesse.o - obj-$(CONFIG_XILINX_GMII2RGMII) += xilinx_gmii2rgmii.o -+ -+obj-$(CONFIG_MOTORCOMM_PHY) += motorcomm.o -diff --git a/drivers/net/phy/at803x.c b/drivers/net/phy/at803x.c -index ac373510b..f5a17307b 100644 ---- a/drivers/net/phy/at803x.c -+++ b/drivers/net/phy/at803x.c -@@ -92,6 +92,10 @@ - #define AT803X_DEBUG_REG_5 0x05 - #define AT803X_DEBUG_TX_CLK_DLY_EN BIT(8) - -+#define AT803X_DEBUG_REG_B 0x0B -+#define AT803X_DEBUG_REG_B_HIBERNATION_ENABLE 0x1 -+#define AT803X_DEBUG_REG_B_HIBERNATION_OFFSET 15 -+ - #define AT803X_DEBUG_REG_1F 0x1F - #define AT803X_DEBUG_PLL_ON BIT(2) - #define AT803X_DEBUG_RGMII_1V8 BIT(3) -@@ -202,6 +206,20 @@ static int at803x_enable_tx_delay(struct phy_device *phydev) - AT803X_DEBUG_TX_CLK_DLY_EN); - } - -+static inline int at803x_disable_hibernate(struct phy_device *phydev) -+{ -+ int ret = 0; -+ u16 val = 0; -+ -+ ret = at803x_debug_reg_read(phydev, AT803X_DEBUG_REG_B); -+ if (ret < 0) -+ return ret; -+ -+ val = ret & 0xffff; -+ val &= (~(AT803X_DEBUG_REG_B_HIBERNATION_ENABLE << AT803X_DEBUG_REG_B_HIBERNATION_OFFSET)); -+ return phy_write(phydev, AT803X_DEBUG_DATA, val); -+} -+ - static int at803x_disable_rx_delay(struct phy_device *phydev) - { - return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_0, -@@ -563,6 +581,10 @@ static int at803x_config_init(struct phy_device *phydev) - { - int ret; - -+ ret = at803x_disable_hibernate(phydev); -+ if (ret < 0) -+ return ret; -+ - /* The RX and TX delay default is: - * after HW reset: RX delay enabled and TX delay disabled - * after SW reset: RX delay enabled, while TX delay retains the -diff --git a/drivers/net/phy/motorcomm.c b/drivers/net/phy/motorcomm.c -new file mode 100755 -index 000000000..31a64698b ---- /dev/null -+++ b/drivers/net/phy/motorcomm.c -@@ -0,0 +1,2387 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * drivers/net/phy/motorcomm.c -+ * -+ * Driver for Motorcomm PHYs -+ * -+ * Author: yinghong.zhang -+ * -+ * Copyright (c) 2019 Motorcomm, 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. -+ * -+ * Support : Motorcomm Phys: -+ * Giga phys: yt8511, yt8521, yt8531, yt8614, yt8618 -+ * 100/10 Phys : yt8512, yt8512b, yt8510 -+ * Automotive 100Mb Phys : yt8010 -+ * Automotive 100/10 hyper range Phys: yt8510 -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#ifndef LINUX_VERSION_CODE -+#include -+#else -+#define KERNEL_VERSION(a, b, c) (((a) << 16) + ((b) << 8) + (c)) -+#endif -+ -+/* for wol feature, 20210604 */ -+#include -+ -+#define YT_LINUX_MAJOR 2 -+#define YT_LINUX_MINOR 2 -+#define YT_LINUX_SUBVERSION 8661 -+#define YT_LINUX_VERSIONID "2.2.8661" -+ -+/******************************************** -+ **** configuration section begin ***********/ -+ -+/* if system depends on ethernet packet to restore from sleep, -+ * please define this macro to 1 otherwise, define it to 0. -+ */ -+#define SYS_WAKEUP_BASED_ON_ETH_PKT 0 -+ -+/* to enable system WOL feature of phy, please define this macro to 1 -+ * otherwise, define it to 0. -+ */ -+#define YTPHY_WOL_FEATURE_ENABLE 0 -+ -+/* some GMAC need clock input from PHY, for eg., 125M, -+ * please enable this macro -+ * by degault, it is set to 0 -+ * NOTE: this macro will need macro SYS_WAKEUP_BASED_ON_ETH_PKT to set to 1 -+ */ -+#define GMAC_CLOCK_INPUT_NEEDED 0 -+ -+/* the max number of yt8521 chip on pcb board -+ * the most case is only 1 chip per board, but -+ * by default, we support up to 8. -+ */ -+#define YTPHY_BOARD_MAX_NUM_OF_CHIP_8521 8 -+#define YTPHY_BOARD_MAX_NUM_OF_CHIP_8614 4 -+ -+/* for YT8531 package A xtal init config */ -+#define YTPHY8531A_XTAL_INIT (0) -+ -+/**** configuration section end *********** -+ ******************************************/ -+ -+/* no need to change below */ -+#define MOTORCOMM_PHY_ID_MASK 0x00000fff -+#define MOTORCOMM_PHY_ID_8531_MASK 0xffffffff -+#define MOTORCOMM_MPHY_ID_MASK 0x0000ffff -+#define MOTORCOMM_MPHY_ID_MASK_8614 0xffffffff -+#define MOTORCOMM_PHY_ID_MASK_8821 0xffffffff -+ -+#define PHY_ID_YT8010 0x00000309 -+#define PHY_ID_YT8010AS 0x4f51eb19 -+#define PHY_ID_YT8510 0x00000109 -+#define PHY_ID_YT8511 0x0000010a -+#define PHY_ID_YT8512 0x00000118 -+#define PHY_ID_YT8512B 0x00000128 -+#define PHY_ID_YT8521 0x0000011a -+#define PHY_ID_YT8531S 0x4f51e91a -+#define PHY_ID_YT8531 0x4f51e91b -+#define PHY_ID_YT8614 0x4F51E899 -+#define PHY_ID_YT8618 0x0000e889 -+#define PHY_ID_YT8821 0x4f51ea10 -+ -+#define REG_PHY_SPEC_STATUS 0x11 -+#define REG_DEBUG_ADDR_OFFSET 0x1e -+#define REG_DEBUG_DATA 0x1f -+ -+#define YT8512_EXTREG_LED0 0x40c0 -+#define YT8512_EXTREG_LED1 0x40c3 -+ -+#define YT8512_EXTREG_SLEEP_CONTROL1 0x2027 -+ -+#define YT_SOFTWARE_RESET 0x8000 -+ -+#define YT8512_LED0_ACT_BLK_IND 0x1000 -+#define YT8512_LED0_DIS_LED_AN_TRY 0x0001 -+#define YT8512_LED0_BT_BLK_EN 0x0002 -+#define YT8512_LED0_HT_BLK_EN 0x0004 -+#define YT8512_LED0_COL_BLK_EN 0x0008 -+#define YT8512_LED0_BT_ON_EN 0x0010 -+#define YT8512_LED1_BT_ON_EN 0x0010 -+#define YT8512_LED1_TXACT_BLK_EN 0x0100 -+#define YT8512_LED1_RXACT_BLK_EN 0x0200 -+#define YT8512_SPEED_MODE 0xc000 -+#define YT8512_DUPLEX 0x2000 -+ -+#define YT8512_SPEED_MODE_BIT 14 -+#define YT8512_DUPLEX_BIT 13 -+#define YT8512_EN_SLEEP_SW_BIT 15 -+ -+#define YT8521_EXTREG_SLEEP_CONTROL1 0x27 -+#define YT8521_EN_SLEEP_SW_BIT 15 -+ -+#define YT8521_SPEED_MODE 0xc000 -+#define YT8521_DUPLEX 0x2000 -+#define YT8521_SPEED_MODE_BIT 14 -+#define YT8521_DUPLEX_BIT 13 -+#define YT8521_LINK_STATUS_BIT 10 -+ -+/* based on yt8521 wol feature config register */ -+#define YTPHY_UTP_INTR_REG 0x12 -+/* WOL Feature Event Interrupt Enable */ -+#define YTPHY_WOL_FEATURE_INTR BIT(6) -+ -+/* Magic Packet MAC address registers */ -+#define YTPHY_WOL_FEATURE_MACADDR2_4_MAGIC_PACKET 0xa007 -+#define YTPHY_WOL_FEATURE_MACADDR1_4_MAGIC_PACKET 0xa008 -+#define YTPHY_WOL_FEATURE_MACADDR0_4_MAGIC_PACKET 0xa009 -+ -+#define YTPHY_WOL_FEATURE_REG_CFG 0xa00a -+#define YTPHY_WOL_FEATURE_TYPE_CFG BIT(0) /* WOL TYPE Config */ -+#define YTPHY_WOL_FEATURE_ENABLE_CFG BIT(3) /* WOL Enable Config */ -+#define YTPHY_WOL_FEATURE_INTR_SEL_CFG BIT(6) /* WOL Event Interrupt Enable Config */ -+#define YTPHY_WOL_FEATURE_WIDTH1_CFG BIT(1) /* WOL Pulse Width Config */ -+#define YTPHY_WOL_FEATURE_WIDTH2_CFG BIT(2) /* WOL Pulse Width Config */ -+ -+#define YTPHY_REG_SPACE_UTP 0 -+#define YTPHY_REG_SPACE_FIBER 2 -+ -+enum ytphy_wol_feature_trigger_type_e { -+ YTPHY_WOL_FEATURE_PULSE_TRIGGER, -+ YTPHY_WOL_FEATURE_LEVEL_TRIGGER, -+ YTPHY_WOL_FEATURE_TRIGGER_TYPE_MAX -+}; -+ -+enum ytphy_wol_feature_pulse_width_e { -+ YTPHY_WOL_FEATURE_672MS_PULSE_WIDTH, -+ YTPHY_WOL_FEATURE_336MS_PULSE_WIDTH, -+ YTPHY_WOL_FEATURE_168MS_PULSE_WIDTH, -+ YTPHY_WOL_FEATURE_84MS_PULSE_WIDTH, -+ YTPHY_WOL_FEATURE_PULSE_WIDTH_MAX -+}; -+ -+struct ytphy_wol_feature_cfg { -+ bool enable; -+ int type; -+ int width; -+}; -+ -+#if (YTPHY_WOL_FEATURE_ENABLE) -+#undef SYS_WAKEUP_BASED_ON_ETH_PKT -+#define SYS_WAKEUP_BASED_ON_ETH_PKT 1 -+#endif -+ -+/* YT8521 polling mode */ -+#define YT8521_PHY_MODE_FIBER 1 //fiber mode only -+#define YT8521_PHY_MODE_UTP 2 //utp mode only -+#define YT8521_PHY_MODE_POLL 3 //fiber and utp, poll mode -+ -+/* below are for bitmap */ -+#define YT_PHY_MODE_FIBER 1 //fiber/sgmii mode only -+#define YT_PHY_MODE_UTP 2 //utp mode only -+#define YT_PHY_MODE_QSGMII 4 //qsgmii mode only -+#define YT_PHY_MODE_POLL (YT_PHY_MODE_FIBER | YT_PHY_MODE_UTP | YT_PHY_MODE_QSGMII) //qsgmii, fiber/sgmii and utp, poll mode -+ -+/* support automatically check polling mode for yt8521 -+ * for Fiber only system, please define YT8521_PHY_MODE_CURR 1 -+ * for UTP only system, please define YT8521_PHY_MODE_CURR 2 -+ * for combo system, please define YT8521_PHY_MODE_CURR 3 -+ */ -+#define YTPHY_861X_ABC_VER 0 -+#if (YTPHY_861X_ABC_VER) -+static int yt8614_get_port_from_phydev(struct phy_device *phydev); -+#endif -+static int yt8521_hw_strap_polling(struct phy_device *phydev); -+static int yt8614_hw_strap_polling(struct phy_device *phydev); -+#define YT8521_PHY_MODE_CURR yt8521_hw_strap_polling(phydev) -+#define YT8614_PHY_MODE_CURR yt8614_hw_strap_polling(phydev) -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+static int ytphy_config_init(struct phy_device *phydev) -+{ -+ int val; -+ -+ val = phy_read(phydev, 3); -+ -+ return 0; -+} -+#endif -+ -+ -+#if (KERNEL_VERSION(5, 5, 0) > LINUX_VERSION_CODE) -+static inline void phy_lock_mdio_bus(struct phy_device *phydev) -+{ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ mutex_lock(&phydev->bus->mdio_lock); -+#else -+ mutex_lock(&phydev->mdio.bus->mdio_lock); -+#endif -+} -+ -+static inline void phy_unlock_mdio_bus(struct phy_device *phydev) -+{ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ mutex_unlock(&phydev->bus->mdio_lock); -+#else -+ mutex_unlock(&phydev->mdio.bus->mdio_lock); -+#endif -+} -+#endif -+ -+#if (KERNEL_VERSION(4, 16, 0) > LINUX_VERSION_CODE) -+static inline int __phy_read(struct phy_device *phydev, u32 regnum) -+{ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ struct mii_bus *bus = phydev->bus; -+ int addr = phydev->addr; -+ return bus->read(bus, phydev->addr, regnum); -+#else -+ struct mii_bus *bus = phydev->mdio.bus; -+ int addr = phydev->mdio.addr; -+#endif -+ return bus->read(bus, addr, regnum); -+} -+ -+static inline int __phy_write(struct phy_device *phydev, u32 regnum, u16 val) -+{ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ struct mii_bus *bus = phydev->bus; -+ int addr = phydev->addr; -+#else -+ struct mii_bus *bus = phydev->mdio.bus; -+ int addr = phydev->mdio.addr; -+#endif -+ return bus->write(bus, addr, regnum, val); -+} -+#endif -+ -+static int ytphy_read_ext(struct phy_device *phydev, u32 regnum) -+{ -+ int ret; -+ -+ phy_lock_mdio_bus(phydev); -+ ret = __phy_write(phydev, REG_DEBUG_ADDR_OFFSET, regnum); -+ if (ret < 0) -+ goto err_handle; -+ -+ ret = __phy_read(phydev, REG_DEBUG_DATA); -+ if (ret < 0) -+ goto err_handle; -+ -+err_handle: -+ phy_unlock_mdio_bus(phydev); -+ return ret; -+} -+ -+static int ytphy_write_ext(struct phy_device *phydev, u32 regnum, u16 val) -+{ -+ int ret; -+ -+ phy_lock_mdio_bus(phydev); -+ ret = __phy_write(phydev, REG_DEBUG_ADDR_OFFSET, regnum); -+ if (ret < 0) -+ goto err_handle; -+ -+ ret = __phy_write(phydev, REG_DEBUG_DATA, val); -+ if (ret < 0) -+ goto err_handle; -+ -+err_handle: -+ phy_unlock_mdio_bus(phydev); -+ return ret; -+} -+ -+static int ytphy_soft_reset(struct phy_device *phydev) -+{ -+ int ret = 0, val = 0; -+ -+ val = phy_read(phydev, MII_BMCR); -+ if (val < 0) -+ return val; -+ -+ ret = phy_write(phydev, MII_BMCR, val | BMCR_RESET); -+ if (ret < 0) -+ return ret; -+ -+ return ret; -+} -+ -+ -+#if (YTPHY8531A_XTAL_INIT) -+static int yt8531a_xtal_init(struct phy_device *phydev) -+{ -+ int ret = 0; -+ int val = 0; -+ bool state = false; -+ -+ msleep(50); -+ -+ do { -+ ret = ytphy_write_ext(phydev, 0xa012, 0x88); -+ if (ret < 0) -+ return ret; -+ -+ msleep(100); -+ -+ val = ytphy_read_ext(phydev, 0xa012); -+ if (val < 0) -+ return val; -+ -+ usleep_range(10000, 20000); -+ } while (val != 0x88); -+ -+ ret = ytphy_write_ext(phydev, 0xa012, 0xc8); -+ if (ret < 0) -+ return ret; -+ -+ return ret; -+} -+#endif -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+int yt8010_soft_reset(struct phy_device *phydev) -+{ -+ ytphy_soft_reset(phydev); -+ -+ return 0; -+} -+ -+int yt8010AS_soft_reset(struct phy_device *phydev) -+{ -+ int ret = 0; -+ -+ /* sgmii */ -+ ytphy_write_ext(phydev, 0xe, 1); -+ ret = ytphy_soft_reset(phydev); -+ if (ret < 0) { -+ ytphy_write_ext(phydev, 0xe, 0); -+ return ret; -+ } -+ -+ /* utp */ -+ ytphy_write_ext(phydev, 0xe, 0); -+ ret = ytphy_soft_reset(phydev); -+ if (ret < 0) -+ return ret; -+ -+ return 0; -+} -+#endif -+ -+#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) -+int yt8010_aneg_done(struct phy_device *phydev) -+{ -+ int val = 0; -+ -+ val = phy_read(phydev, 0x1); -+ val = phy_read(phydev, 0x1); -+ -+ return (val < 0) ? val : (val & BMSR_LSTATUS); -+} -+#endif -+ -+static int yt8010_config_aneg(struct phy_device *phydev) -+{ -+ phydev->speed = SPEED_100; -+ return 0; -+} -+ -+static int yt8010_read_status(struct phy_device *phydev) -+{ -+ int ret = 0; -+ -+ ret = genphy_update_link(phydev); -+ if (ret) -+ return ret; -+ -+ /* for 8010, no definition mii reg 0x04, 0x11, here force 100/full */ -+ phydev->speed = SPEED_100; -+ phydev->duplex = DUPLEX_FULL; -+ -+ return 0; -+} -+ -+static int yt8010AS_config_init(struct phy_device *phydev) -+{ -+ phydev->autoneg = AUTONEG_DISABLE; -+ -+ return 0; -+} -+ -+static int yt8512_led_init(struct phy_device *phydev) -+{ -+ int ret; -+ int val; -+ int mask; -+ -+ val = ytphy_read_ext(phydev, YT8512_EXTREG_LED0); -+ if (val < 0) -+ return val; -+ -+ val |= YT8512_LED0_ACT_BLK_IND; -+ -+ mask = YT8512_LED0_DIS_LED_AN_TRY | YT8512_LED0_BT_BLK_EN | -+ YT8512_LED0_HT_BLK_EN | YT8512_LED0_COL_BLK_EN | -+ YT8512_LED0_BT_ON_EN; -+ val &= ~mask; -+ -+ ret = ytphy_write_ext(phydev, YT8512_EXTREG_LED0, val); -+ if (ret < 0) -+ return ret; -+ -+ val = ytphy_read_ext(phydev, YT8512_EXTREG_LED1); -+ if (val < 0) -+ return val; -+ -+ val |= YT8512_LED1_BT_ON_EN; -+ -+ mask = YT8512_LED1_TXACT_BLK_EN | YT8512_LED1_RXACT_BLK_EN; -+ val &= ~mask; -+ -+ ret = ytphy_write_ext(phydev, YT8512_EXTREG_LED1, val); -+ -+ return ret; -+} -+ -+static int yt8512_config_init(struct phy_device *phydev) -+{ -+ int ret; -+ int val; -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+ ret = ytphy_config_init(phydev); -+#else -+ ret = genphy_config_init(phydev); -+#endif -+ if (ret < 0) -+ return ret; -+ -+ ret = yt8512_led_init(phydev); -+ -+ /* disable auto sleep */ -+ val = ytphy_read_ext(phydev, YT8512_EXTREG_SLEEP_CONTROL1); -+ if (val < 0) -+ return val; -+ -+ val &= (~BIT(YT8512_EN_SLEEP_SW_BIT)); -+ -+ ret = ytphy_write_ext(phydev, YT8512_EXTREG_SLEEP_CONTROL1, val); -+ if (ret < 0) -+ return ret; -+ -+ return ret; -+} -+ -+static int yt8512_read_status(struct phy_device *phydev) -+{ -+ int ret; -+ int val; -+ int speed, speed_mode, duplex; -+ -+ ret = genphy_update_link(phydev); -+ if (ret) -+ return ret; -+ -+ val = phy_read(phydev, REG_PHY_SPEC_STATUS); -+ if (val < 0) -+ return val; -+ -+ duplex = (val & YT8512_DUPLEX) >> YT8512_DUPLEX_BIT; -+ speed_mode = (val & YT8512_SPEED_MODE) >> YT8512_SPEED_MODE_BIT; -+ switch (speed_mode) { -+ case 0: -+ speed = SPEED_10; -+ break; -+ case 1: -+ speed = SPEED_100; -+ break; -+ case 2: -+ case 3: -+ default: -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ speed = -1; -+#else -+ speed = SPEED_UNKNOWN; -+#endif -+ break; -+ } -+ -+ phydev->speed = speed; -+ phydev->duplex = duplex; -+ -+ return 0; -+} -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+int yt8521_soft_reset(struct phy_device *phydev) -+{ -+ int ret, val; -+ -+ if (YT8521_PHY_MODE_CURR == YT8521_PHY_MODE_UTP) { -+ ytphy_write_ext(phydev, 0xa000, 0); -+ ytphy_soft_reset(phydev); -+ } -+ -+ if (YT8521_PHY_MODE_CURR == YT8521_PHY_MODE_FIBER) { -+ ytphy_write_ext(phydev, 0xa000, 2); -+ ytphy_soft_reset(phydev); -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ } -+ -+ if (YT8521_PHY_MODE_CURR == YT8521_PHY_MODE_POLL) { -+ val = ytphy_read_ext(phydev, 0xa001); -+ ytphy_write_ext(phydev, 0xa001, (val & ~0x8000)); -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ ret = ytphy_soft_reset(phydev); -+ } -+ -+ return 0; -+} -+#endif -+ -+#if GMAC_CLOCK_INPUT_NEEDED -+static int ytphy_mii_rd_ext(struct mii_bus *bus, int phy_id, u32 regnum) -+{ -+ int ret; -+ int val; -+ -+ ret = bus->write(bus, phy_id, REG_DEBUG_ADDR_OFFSET, regnum); -+ if (ret < 0) -+ return ret; -+ -+ val = bus->read(bus, phy_id, REG_DEBUG_DATA); -+ -+ return val; -+} -+ -+static int ytphy_mii_wr_ext(struct mii_bus *bus -+ int phy_id, -+ u32 regnum, -+ u16 val) -+{ -+ int ret; -+ -+ ret = bus->write(bus, phy_id, REG_DEBUG_ADDR_OFFSET, regnum); -+ if (ret < 0) -+ return ret; -+ -+ ret = bus->write(bus, phy_id, REG_DEBUG_DATA, val); -+ -+ return ret; -+} -+ -+int yt8511_config_dis_txdelay(struct mii_bus *bus, int phy_id) -+{ -+ int ret; -+ int val; -+ -+ /* disable auto sleep */ -+ val = ytphy_mii_rd_ext(bus, phy_id, 0x27); -+ if (val < 0) -+ return val; -+ -+ val &= (~BIT(15)); -+ -+ ret = ytphy_mii_wr_ext(bus, phy_id, 0x27, val); -+ if (ret < 0) -+ return ret; -+ -+ /* enable RXC clock when no wire plug */ -+ val = ytphy_mii_rd_ext(bus, phy_id, 0xc); -+ if (val < 0) -+ return val; -+ -+ /* ext reg 0xc b[7:4] -+ * Tx Delay time = 150ps * N - 250ps -+ */ -+ val &= ~(0xf << 4); -+ ret = ytphy_mii_wr_ext(bus, phy_id, 0xc, val); -+ -+ return ret; -+} -+ -+int yt8511_config_out_125m(struct mii_bus *bus, int phy_id) -+{ -+ int ret; -+ int val; -+ -+ /* disable auto sleep */ -+ val = ytphy_mii_rd_ext(bus, phy_id, 0x27); -+ if (val < 0) -+ return val; -+ -+ val &= (~BIT(15)); -+ -+ ret = ytphy_mii_wr_ext(bus, phy_id, 0x27, val); -+ if (ret < 0) -+ return ret; -+ -+ /* enable RXC clock when no wire plug */ -+ val = ytphy_mii_rd_ext(bus, phy_id, 0xc); -+ if (val < 0) -+ return val; -+ -+ /* ext reg 0xc.b[2:1] -+ * 00-----25M from pll; -+ * 01---- 25M from xtl;(default) -+ * 10-----62.5M from pll; -+ * 11----125M from pll(here set to this value) -+ */ -+ val |= (3 << 1); -+ ret = ytphy_mii_wr_ext(bus, phy_id, 0xc, val); -+ -+#ifdef YT_8511_INIT_TO_MASTER -+ /* for customer, please enable it based on demand. -+ * configure to master -+ */ -+ -+ /* master/slave config reg*/ -+ val = bus->read(bus, phy_id, 0x9); -+ /* to be manual config and force to be master */ -+ val |= (0x3<<11); -+ /* take effect until phy soft reset */ -+ ret = bus->write(bus, phy_id, 0x9, val); -+ if (ret < 0) -+ return ret; -+#endif -+ -+ return ret; -+} -+ -+static int yt8511_config_init(struct phy_device *phydev) -+{ -+ int ret; -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+ ret = ytphy_config_init(phydev); -+#else -+ ret = genphy_config_init(phydev); -+#endif -+ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s done, phy addr: %d\n", __func__, phydev->addr); -+#else -+ netdev_info(phydev->attached_dev, "%s done, phy addr: %d\n", __func__, phydev->mdio.addr); -+#endif -+ -+ return ret; -+} -+#endif /* GMAC_CLOCK_INPUT_NEEDED */ -+ -+#if (YTPHY_WOL_FEATURE_ENABLE) -+static int ytphy_switch_reg_space(struct phy_device *phydev, int space) -+{ -+ int ret; -+ -+ if (space == YTPHY_REG_SPACE_UTP) -+ ret = ytphy_write_ext(phydev, 0xa000, 0); -+ else -+ ret = ytphy_write_ext(phydev, 0xa000, 2); -+ -+ return ret; -+} -+ -+static int ytphy_wol_feature_enable_cfg(struct phy_device *phydev, -+ struct ytphy_wol_feature_cfg wol_cfg) -+{ -+ int ret = 0; -+ int val = 0; -+ -+ val = ytphy_read_ext(phydev, YTPHY_WOL_FEATURE_REG_CFG); -+ if (val < 0) -+ return val; -+ -+ if (wol_cfg.enable) { -+ val |= YTPHY_WOL_FEATURE_ENABLE_CFG; -+ -+ if (wol_cfg.type == YTPHY_WOL_FEATURE_LEVEL_TRIGGER) { -+ val &= ~YTPHY_WOL_FEATURE_TYPE_CFG; -+ val &= ~YTPHY_WOL_FEATURE_INTR_SEL_CFG; -+ } else if (wol_cfg.type == YTPHY_WOL_FEATURE_PULSE_TRIGGER) { -+ val |= YTPHY_WOL_FEATURE_TYPE_CFG; -+ val |= YTPHY_WOL_FEATURE_INTR_SEL_CFG; -+ -+ if (wol_cfg.width == YTPHY_WOL_FEATURE_84MS_PULSE_WIDTH) { -+ val &= ~YTPHY_WOL_FEATURE_WIDTH1_CFG; -+ val &= ~YTPHY_WOL_FEATURE_WIDTH2_CFG; -+ } else if (wol_cfg.width == YTPHY_WOL_FEATURE_168MS_PULSE_WIDTH) { -+ val |= YTPHY_WOL_FEATURE_WIDTH1_CFG; -+ val &= ~YTPHY_WOL_FEATURE_WIDTH2_CFG; -+ } else if (wol_cfg.width == YTPHY_WOL_FEATURE_336MS_PULSE_WIDTH) { -+ val &= ~YTPHY_WOL_FEATURE_WIDTH1_CFG; -+ val |= YTPHY_WOL_FEATURE_WIDTH2_CFG; -+ } else if (wol_cfg.width == YTPHY_WOL_FEATURE_672MS_PULSE_WIDTH) { -+ val |= YTPHY_WOL_FEATURE_WIDTH1_CFG; -+ val |= YTPHY_WOL_FEATURE_WIDTH2_CFG; -+ } -+ } -+ } else { -+ val &= ~YTPHY_WOL_FEATURE_ENABLE_CFG; -+ val &= ~YTPHY_WOL_FEATURE_INTR_SEL_CFG; -+ } -+ -+ ret = ytphy_write_ext(phydev, YTPHY_WOL_FEATURE_REG_CFG, val); -+ if (ret < 0) -+ return ret; -+ -+ return 0; -+} -+ -+static void ytphy_wol_feature_get(struct phy_device *phydev, -+ struct ethtool_wolinfo *wol) -+{ -+ int val = 0; -+ -+ wol->supported = WAKE_MAGIC; -+ wol->wolopts = 0; -+ -+ val = ytphy_read_ext(phydev, YTPHY_WOL_FEATURE_REG_CFG); -+ if (val < 0) -+ return; -+ -+ if (val & YTPHY_WOL_FEATURE_ENABLE_CFG) -+ wol->wolopts |= WAKE_MAGIC; -+ -+ //return; -+} -+ -+static int ytphy_wol_feature_set(struct phy_device *phydev, -+ struct ethtool_wolinfo *wol) -+{ -+ int ret, curr_reg_space, val; -+ struct ytphy_wol_feature_cfg wol_cfg; -+ struct net_device *p_attached_dev = phydev->attached_dev; -+ -+ memset(&wol_cfg, 0, sizeof(struct ytphy_wol_feature_cfg)); -+ curr_reg_space = ytphy_read_ext(phydev, 0xa000); -+ if (curr_reg_space < 0) -+ return curr_reg_space; -+ -+ /* Switch to phy UTP page */ -+ ret = ytphy_switch_reg_space(phydev, YTPHY_REG_SPACE_UTP); -+ if (ret < 0) -+ return ret; -+ -+ if (wol->wolopts & WAKE_MAGIC) { -+ /* Enable the WOL feature interrupt */ -+ val = phy_read(phydev, YTPHY_UTP_INTR_REG); -+ val |= YTPHY_WOL_FEATURE_INTR; -+ ret = phy_write(phydev, YTPHY_UTP_INTR_REG, val); -+ if (ret < 0) -+ return ret; -+ -+ /* Set the WOL feature config */ -+ wol_cfg.enable = true; -+ wol_cfg.type = YTPHY_WOL_FEATURE_PULSE_TRIGGER; -+ wol_cfg.width = YTPHY_WOL_FEATURE_672MS_PULSE_WIDTH; -+ ret = ytphy_wol_feature_enable_cfg(phydev, wol_cfg); -+ if (ret < 0) -+ return ret; -+ -+ /* Store the device address for the magic packet */ -+ ret = ytphy_write_ext(phydev, YTPHY_WOL_FEATURE_MACADDR2_4_MAGIC_PACKET, -+ ((p_attached_dev->dev_addr[0] << 8) | -+ p_attached_dev->dev_addr[1])); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, YTPHY_WOL_FEATURE_MACADDR1_4_MAGIC_PACKET, -+ ((p_attached_dev->dev_addr[2] << 8) | -+ p_attached_dev->dev_addr[3])); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, YTPHY_WOL_FEATURE_MACADDR0_4_MAGIC_PACKET, -+ ((p_attached_dev->dev_addr[4] << 8) | -+ p_attached_dev->dev_addr[5])); -+ if (ret < 0) -+ return ret; -+ } else { -+ wol_cfg.enable = false; -+ wol_cfg.type = YTPHY_WOL_FEATURE_TRIGGER_TYPE_MAX; -+ wol_cfg.width = YTPHY_WOL_FEATURE_PULSE_WIDTH_MAX; -+ ret = ytphy_wol_feature_enable_cfg(phydev, wol_cfg); -+ if (ret < 0) -+ return ret; -+ } -+ -+ /* Recover to previous register space page */ -+ ret = ytphy_switch_reg_space(phydev, curr_reg_space); -+ if (ret < 0) -+ return ret; -+ -+ return 0; -+} -+#endif /*(YTPHY_WOL_FEATURE_ENABLE)*/ -+ -+static int yt8521_hw_strap_polling(struct phy_device *phydev) -+{ -+ int val = 0; -+ -+ val = ytphy_read_ext(phydev, 0xa001) & 0x7; -+ switch (val) { -+ case 1: -+ case 4: -+ case 5: -+ return YT8521_PHY_MODE_FIBER; -+ case 2: -+ case 6: -+ case 7: -+ return YT8521_PHY_MODE_POLL; -+ case 3: -+ case 0: -+ default: -+ return YT8521_PHY_MODE_UTP; -+ } -+} -+ -+ -+static int yt8521_config_init(struct phy_device *phydev) -+{ -+ int ret; -+ int val, hw_strap_mode; -+ -+#if (YTPHY_WOL_FEATURE_ENABLE) -+ struct ethtool_wolinfo wol; -+ -+ /* set phy wol enable */ -+ memset(&wol, 0x0, sizeof(struct ethtool_wolinfo)); -+ wol.wolopts |= WAKE_MAGIC; -+ ytphy_wol_feature_set(phydev, &wol); -+#endif -+ if (phydev->force_mode) { -+ hw_strap_mode = ytphy_read_ext(phydev, 0xa001) & 0x7; -+ hw_strap_mode = hw_strap_mode & 0x7ff8; -+ hw_strap_mode = hw_strap_mode |0x140; -+ ytphy_write_ext(phydev, 0xa001, hw_strap_mode); -+ } -+ -+ phydev->irq = PHY_POLL; -+ /* NOTE: this function should not be called more than one for each chip. */ -+ hw_strap_mode = ytphy_read_ext(phydev, 0xa001) & 0x7; -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+ ret = ytphy_config_init(phydev); -+#else -+ ret = genphy_config_init(phydev); -+#endif -+ if (ret < 0) -+ return ret; -+ -+ /* disable auto sleep */ -+ val = ytphy_read_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1); -+ if (val < 0) -+ return val; -+ -+ val &= (~BIT(YT8521_EN_SLEEP_SW_BIT)); -+ -+ ret = ytphy_write_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1, val); -+ if (ret < 0) -+ return ret; -+ -+ /* enable RXC clock when no wire plug */ -+ val = ytphy_read_ext(phydev, 0xc); -+ if (val < 0) -+ return val; -+ val &= ~(1 << 12); -+ ret = ytphy_write_ext(phydev, 0xc, val); -+ if (ret < 0) -+ return ret; -+ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s done, phy addr: %d, strap mode = %d, polling mode = %d\n", -+ __func__, phydev->addr, hw_strap_mode, yt8521_hw_strap_polling(phydev)); -+#else -+ netdev_info(phydev->attached_dev, "%s done, phy addr: %d, strap mode = %d, polling mode = %d\n", -+ __func__, phydev->mdio.addr, hw_strap_mode, yt8521_hw_strap_polling(phydev)); -+#endif -+ return ret; -+} -+ -+/* for fiber mode, there is no 10M speed mode and -+ * this function is for this purpose. -+ */ -+static int yt8521_adjust_status(struct phy_device *phydev, int val, int is_utp) -+{ -+ int speed_mode, duplex; -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ int speed = -1; -+#else -+ int speed = SPEED_UNKNOWN; -+#endif -+ -+ if (is_utp) -+ duplex = (val & YT8512_DUPLEX) >> YT8521_DUPLEX_BIT; -+ else -+ duplex = 1; -+ speed_mode = (val & YT8521_SPEED_MODE) >> YT8521_SPEED_MODE_BIT; -+ switch (speed_mode) { -+ case 0: -+ if (is_utp) -+ speed = SPEED_10; -+ break; -+ case 1: -+ speed = SPEED_100; -+ break; -+ case 2: -+ speed = SPEED_1000; -+ break; -+ case 3: -+ break; -+ default: -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ speed = -1; -+#else -+ speed = SPEED_UNKNOWN; -+#endif -+ break; -+ } -+ -+ phydev->speed = speed; -+ phydev->duplex = duplex; -+ -+ return 0; -+} -+ -+/* for fiber mode, when speed is 100M, there is no definition for -+ * autonegotiation, and this function handles this case and return -+ * 1 per linux kernel's polling. -+ */ -+int yt8521_aneg_done(struct phy_device *phydev) -+{ -+ int link_fiber = 0, link_utp = 0; -+ -+ /* reading Fiber */ -+ ytphy_write_ext(phydev, 0xa000, 2); -+ link_fiber = !!(phy_read(phydev, REG_PHY_SPEC_STATUS) & (BIT(YT8521_LINK_STATUS_BIT))); -+ -+ /* reading UTP */ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ if (!link_fiber) -+ link_utp = !!(phy_read(phydev, REG_PHY_SPEC_STATUS) & (BIT(YT8521_LINK_STATUS_BIT))); -+ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link_fiber: %d, link_utp: %d\n", -+ __func__, phydev->addr, link_fiber, link_utp); -+#else -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link_fiber: %d, link_utp: %d\n", -+ __func__, phydev->mdio.addr, link_fiber, link_utp); -+#endif -+ return !!(link_fiber | link_utp); -+} -+ -+static int yt8521_read_status(struct phy_device *phydev) -+{ -+ int ret; -+ int val; -+ int yt8521_fiber_latch_val; -+ int yt8521_fiber_curr_val; -+ int link; -+ int link_utp = 0, link_fiber = 0; -+ -+ if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) { -+ /* reading UTP */ -+ ret = ytphy_write_ext(phydev, 0xa000, 0); -+ if (ret < 0) -+ return ret; -+ -+ val = phy_read(phydev, REG_PHY_SPEC_STATUS); -+ if (val < 0) -+ return val; -+ -+ link = val & (BIT(YT8521_LINK_STATUS_BIT)); -+ if (link) { -+ link_utp = 1; -+ yt8521_adjust_status(phydev, val, 1); -+ } else { -+ link_utp = 0; -+ } -+ } //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) -+ -+ if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) { -+ /* reading Fiber */ -+ ret = ytphy_write_ext(phydev, 0xa000, 2); -+ if (ret < 0) -+ return ret; -+ -+ val = phy_read(phydev, REG_PHY_SPEC_STATUS); -+ if (val < 0) -+ return val; -+ -+ //note: below debug information is used to check multiple PHy ports. -+ -+ /* for fiber, from 1000m to 100m, there is not link down from 0x11, -+ * and check reg 1 to identify such case this is important for Linux -+ * kernel for that, missing linkdown event will cause problem. -+ */ -+ yt8521_fiber_latch_val = phy_read(phydev, MII_BMSR); -+ yt8521_fiber_curr_val = phy_read(phydev, MII_BMSR); -+ link = val & (BIT(YT8521_LINK_STATUS_BIT)); -+ if (link && yt8521_fiber_latch_val != yt8521_fiber_curr_val) { -+ link = 0; -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", -+ __func__, phydev->addr, yt8521_fiber_latch_val, yt8521_fiber_curr_val); -+#else -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", -+ __func__, phydev->mdio.addr, yt8521_fiber_latch_val, yt8521_fiber_curr_val); -+#endif -+ } -+ -+ if (link) { -+ link_fiber = 1; -+ yt8521_adjust_status(phydev, val, 0); -+ } else { -+ link_fiber = 0; -+ } -+ } //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) -+ -+ if (link_utp || link_fiber) { -+ if (phydev->link == 0) -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media: %s, mii reg 0x11 = 0x%x\n", -+ __func__, phydev->addr, (link_utp && link_fiber) ? "UNKNOWN MEDIA" : (link_utp ? "UTP" : "Fiber"), (unsigned int)val); -+#else -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media: %s, mii reg 0x11 = 0x%x\n", -+ __func__, phydev->mdio.addr, (link_utp && link_fiber) ? "UNKNOWN MEDIA" : (link_utp ? "UTP" : "Fiber"), (unsigned int)val); -+#endif -+ phydev->link = 1; -+ } else { -+ if (phydev->link == 1) -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->addr); -+#else -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->mdio.addr); -+#endif -+ phydev->link = 0; -+ } -+ -+ if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) { //utp or combo -+ if (link_fiber) -+ ytphy_write_ext(phydev, 0xa000, 2); -+ if (link_utp) -+ ytphy_write_ext(phydev, 0xa000, 0); -+ } -+ return 0; -+} -+ -+int yt8521_suspend(struct phy_device *phydev) -+{ -+#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) -+ int value; -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_lock(&phydev->lock); -+#else -+ /* no need lock in 4.19 */ -+#endif -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ value = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); -+ -+ ytphy_write_ext(phydev, 0xa000, 2); -+ value = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_unlock(&phydev->lock); -+#else -+ /* no need lock/unlock in 4.19 */ -+#endif -+#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ -+ -+ return 0; -+} -+ -+int yt8521_resume(struct phy_device *phydev) -+{ -+ int value, ret; -+ -+ /* disable auto sleep */ -+ value = ytphy_read_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1); -+ if (value < 0) -+ return value; -+ -+ value &= (~BIT(YT8521_EN_SLEEP_SW_BIT)); -+ -+ ret = ytphy_write_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1, value); -+ if (ret < 0) -+ return ret; -+ -+#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_lock(&phydev->lock); -+#else -+ /* no need lock/unlock in 4.19 */ -+#endif -+ -+ /* power down both sds & phy in suspend, power up both too */ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ value = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); -+ -+ ytphy_write_ext(phydev, 0xa000, 2); -+ value = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_unlock(&phydev->lock); -+#else -+ /* no need lock/unlock in 4.19 */ -+#endif -+#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ -+ -+ return 0; -+} -+ -+static int yt8531S_config_init(struct phy_device *phydev) -+{ -+ int ret = 0; -+ -+#if (YTPHY8531A_XTAL_INIT) -+ ret = yt8531a_xtal_init(phydev); -+ if (ret < 0) -+ return ret; -+#endif -+ -+ ret = yt8521_config_init(phydev); -+ -+ return ret; -+} -+ -+static int yt8531_config_init(struct phy_device *phydev) -+{ -+ int ret = 0; -+ -+#if (YTPHY8531A_XTAL_INIT) -+ ret = yt8531a_xtal_init(phydev); -+ if (ret < 0) -+ return ret; -+#endif -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+ ret = ytphy_config_init(phydev); -+#else -+ ret = genphy_config_init(phydev); -+#endif -+ if (ret < 0) -+ return ret; -+ -+ return 0; -+} -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+int yt8618_soft_reset(struct phy_device *phydev) -+{ -+ int ret; -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ ret = ytphy_soft_reset(phydev); -+ if (ret < 0) -+ return ret; -+ -+ return 0; -+} -+ -+int yt8614_soft_reset(struct phy_device *phydev) -+{ -+ int ret; -+ -+ /* qsgmii */ -+ ytphy_write_ext(phydev, 0xa000, 2); -+ ret = ytphy_soft_reset(phydev); -+ if (ret < 0) { -+ ytphy_write_ext(phydev, 0xa000, 0); -+ return ret; -+ } -+ -+ /* sgmii */ -+ ytphy_write_ext(phydev, 0xa000, 3); -+ ret = ytphy_soft_reset(phydev); -+ if (ret < 0) { -+ ytphy_write_ext(phydev, 0xa000, 0); -+ return ret; -+ } -+ -+ /* utp */ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ ret = ytphy_soft_reset(phydev); -+ if (ret < 0) -+ return ret; -+ -+ return 0; -+} -+#endif -+ -+static int yt8618_config_init(struct phy_device *phydev) -+{ -+ int ret; -+ int val; -+ unsigned int retries = 12; -+#if (YTPHY_861X_ABC_VER) -+ int port = 0; -+#endif -+ -+ phydev->irq = PHY_POLL; -+ -+#if (YTPHY_861X_ABC_VER) -+ port = yt8614_get_port_from_phydev(phydev); -+#endif -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+ ret = ytphy_config_init(phydev); -+#else -+ ret = genphy_config_init(phydev); -+#endif -+ if (ret < 0) -+ return ret; -+ -+ /* for utp to optimize signal */ -+ ret = ytphy_write_ext(phydev, 0x41, 0x33); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x42, 0x66); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x43, 0xaa); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x44, 0xd0d); -+ if (ret < 0) -+ return ret; -+ -+#if (YTPHY_861X_ABC_VER) -+ if ((port == 2) || (port == 5)) { -+ ret = ytphy_write_ext(phydev, 0x57, 0x2929); -+ if (ret < 0) -+ return ret; -+ } -+#endif -+ -+ val = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, val | BMCR_RESET); -+ do { -+ msleep(50); -+ ret = phy_read(phydev, MII_BMCR); -+ if (ret < 0) -+ return ret; -+ } while ((ret & BMCR_RESET) && --retries); -+ if (ret & BMCR_RESET) -+ return -ETIMEDOUT; -+ -+ /* for QSGMII optimization */ -+ ytphy_write_ext(phydev, 0xa000, 0x02); -+ -+ ret = ytphy_write_ext(phydev, 0x3, 0x4F80); -+ if (ret < 0) { -+ ytphy_write_ext(phydev, 0xa000, 0); -+ return ret; -+ } -+ ret = ytphy_write_ext(phydev, 0xe, 0x4F80); -+ if (ret < 0) { -+ ytphy_write_ext(phydev, 0xa000, 0); -+ return ret; -+ } -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s done, phy addr: %d\n", __func__, phydev->addr); -+#else -+ netdev_info(phydev->attached_dev, "%s done, phy addr: %d\n", __func__, phydev->mdio.addr); -+#endif -+ return ret; -+} -+ -+static int yt8614_hw_strap_polling(struct phy_device *phydev) -+{ -+ int val = 0; -+ -+ val = ytphy_read_ext(phydev, 0xa007) & 0xf; -+ switch (val) { -+ case 8: //4'b1000, Fiber x4 + Copper x4 -+ case 12: //4'b1100, QSGMII x1 + Combo x4 mode; -+ case 13: //4'b1101, QSGMII x1 + Combo x4 mode; -+ return (YT_PHY_MODE_FIBER | YT_PHY_MODE_UTP); -+ case 14: //4'b1110, QSGMII x1 + SGMII(MAC) x4 mode; -+ case 11: //4'b1011, QSGMII x1 + Fiber x4 mode; -+ return YT_PHY_MODE_FIBER; -+ case 9: //4'b1001, Reserved. -+ case 10: //4'b1010, QSGMII x1 + Copper x4 mode -+ case 15: //4'b1111, SGMII(PHY) x4 + Copper x4 mode -+ default: -+ return YT_PHY_MODE_UTP; -+ } -+} -+ -+#if (YTPHY_861X_ABC_VER) -+static int yt8614_get_port_from_phydev(struct phy_device *phydev) -+{ -+ int tmp = ytphy_read_ext(phydev, 0xa0ff); -+ int phy_addr = 0; -+ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ phy_addr = (unsigned int)phydev->addr; -+#else -+ phy_addr = (unsigned int)phydev->mdio.addr; -+#endif -+ -+ if ((phy_addr - tmp) < 0) { -+ ytphy_write_ext(phydev, 0xa0ff, phy_addr); -+ tmp = phy_addr; -+ } -+ -+ return (phy_addr - tmp); -+} -+#endif -+ -+static int yt8614_config_init(struct phy_device *phydev) -+{ -+ int ret = 0; -+ int val, hw_strap_mode; -+ unsigned int retries = 12; -+#if (YTPHY_861X_ABC_VER) -+ int port = 0; -+#endif -+ phydev->irq = PHY_POLL; -+ -+ /* NOTE: this function should not be called more than one for each chip. */ -+ hw_strap_mode = ytphy_read_ext(phydev, 0xa007) & 0xf; -+ -+#if (YTPHY_861X_ABC_VER) -+ port = yt8614_get_port_from_phydev(phydev); -+#endif -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+ ret = ytphy_config_init(phydev); -+#else -+ ret = genphy_config_init(phydev); -+#endif -+ if (ret < 0) -+ return ret; -+ -+ /* for utp to optimize signal */ -+ ret = ytphy_write_ext(phydev, 0x41, 0x33); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x42, 0x66); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x43, 0xaa); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x44, 0xd0d); -+ if (ret < 0) -+ return ret; -+ -+#if (YTPHY_861X_ABC_VER) -+ if (port == 2) { -+ ret = ytphy_write_ext(phydev, 0x57, 0x2929); -+ if (ret < 0) -+ return ret; -+ } -+#endif -+ -+ /* soft reset to take config effect */ -+ val = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, val | BMCR_RESET); -+ do { -+ msleep(50); -+ ret = phy_read(phydev, MII_BMCR); -+ if (ret < 0) -+ return ret; -+ } while ((ret & BMCR_RESET) && --retries); -+ if (ret & BMCR_RESET) -+ return -ETIMEDOUT; -+ -+ /* for QSGMII optimization */ -+ ytphy_write_ext(phydev, 0xa000, 0x02); -+ ret = ytphy_write_ext(phydev, 0x3, 0x4F80); -+ if (ret < 0) { -+ ytphy_write_ext(phydev, 0xa000, 0); -+ return ret; -+ } -+ ret = ytphy_write_ext(phydev, 0xe, 0x4F80); -+ if (ret < 0) { -+ ytphy_write_ext(phydev, 0xa000, 0); -+ return ret; -+ } -+ -+ /* for SGMII optimization */ -+ ytphy_write_ext(phydev, 0xa000, 0x03); -+ ret = ytphy_write_ext(phydev, 0x3, 0x2420); -+ if (ret < 0) { -+ ytphy_write_ext(phydev, 0xa000, 0); -+ return ret; -+ } -+ ret = ytphy_write_ext(phydev, 0xe, 0x24a0); -+ if (ret < 0) { -+ ytphy_write_ext(phydev, 0xa000, 0); -+ return ret; -+ } -+ -+ /* back up to utp*/ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s done, phy addr: %d, chip mode: %d\n", __func__, phydev->addr, hw_strap_mode); -+#else -+ netdev_info(phydev->attached_dev, "%s done, phy addr: %d, chip mode: %d\n", __func__, phydev->mdio.addr, hw_strap_mode); -+#endif -+ return ret; -+} -+ -+int yt8618_aneg_done(struct phy_device *phydev) -+{ -+#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) -+ return genphy_aneg_done(phydev); -+#else -+ return 1; -+#endif -+} -+ -+int yt8614_aneg_done(struct phy_device *phydev) -+{ -+ int link_fiber = 0, link_utp = 0; -+ -+ if (YT8614_PHY_MODE_CURR & YT_PHY_MODE_FIBER) { -+ /* reading Fiber */ -+ ytphy_write_ext(phydev, 0xa000, 3); -+ link_fiber = !!(phy_read(phydev, REG_PHY_SPEC_STATUS) & (BIT(YT8521_LINK_STATUS_BIT))); -+ } -+ -+ if (YT8614_PHY_MODE_CURR & YT_PHY_MODE_UTP) { -+ /* reading UTP */ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ link_utp = !!(phy_read(phydev, REG_PHY_SPEC_STATUS) & (BIT(YT8521_LINK_STATUS_BIT))); -+ } -+ -+ return !!(link_fiber | link_utp); -+} -+ -+static int yt8614_read_status(struct phy_device *phydev) -+{ -+ int ret; -+ int val, yt8614_fiber_latch_val, yt8614_fiber_curr_val; -+ int link; -+ int link_utp = 0, link_fiber = 0; -+ -+ if (YT8614_PHY_MODE_CURR & YT_PHY_MODE_UTP) { -+ /* switch to utp and reading regs */ -+ ret = ytphy_write_ext(phydev, 0xa000, 0); -+ if (ret < 0) -+ return ret; -+ -+ val = phy_read(phydev, REG_PHY_SPEC_STATUS); -+ if (val < 0) -+ return val; -+ -+ link = val & (BIT(YT8521_LINK_STATUS_BIT)); -+ if (link) { -+ link_utp = 1; -+ // here is same as 8521 and re-use the function; -+ yt8521_adjust_status(phydev, val, 1); -+ } else { -+ link_utp = 0; -+ } -+ } -+ -+ if (YT8614_PHY_MODE_CURR & YT_PHY_MODE_FIBER) { -+ /* reading Fiber/sgmii */ -+ ret = ytphy_write_ext(phydev, 0xa000, 3); -+ if (ret < 0) -+ return ret; -+ -+ val = phy_read(phydev, REG_PHY_SPEC_STATUS); -+ if (val < 0) -+ return val; -+ -+ /* for fiber, from 1000m to 100m, there is not link down from 0x11, -+ * and check reg 1 to identify such case -+ */ -+ yt8614_fiber_latch_val = phy_read(phydev, MII_BMSR); -+ yt8614_fiber_curr_val = phy_read(phydev, MII_BMSR); -+ link = val & (BIT(YT8521_LINK_STATUS_BIT)); -+ if (link && yt8614_fiber_latch_val != yt8614_fiber_curr_val) { -+ link = 0; -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", -+ __func__, phydev->addr, yt8614_fiber_latch_val, yt8614_fiber_curr_val); -+#else -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", -+ __func__, phydev->mdio.addr, yt8614_fiber_latch_val, yt8614_fiber_curr_val); -+#endif -+ } -+ -+ if (link) { -+ link_fiber = 1; -+ yt8521_adjust_status(phydev, val, 0); -+ } else { -+ link_fiber = 0; -+ } -+ } -+ -+ if (link_utp || link_fiber) { -+ if (phydev->link == 0) -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media %s\n", -+ __func__, phydev->addr, (link_utp && link_fiber) ? "both UTP and Fiber" : (link_utp ? "UTP" : "Fiber")); -+#else -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media %s\n", -+ __func__, phydev->mdio.addr, (link_utp && link_fiber) ? "both UTP and Fiber" : (link_utp ? "UTP" : "Fiber")); -+#endif -+ phydev->link = 1; -+ } else { -+ if (phydev->link == 1) -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->addr); -+#else -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->mdio.addr); -+#endif -+ phydev->link = 0; -+ } -+ -+ if (YT8614_PHY_MODE_CURR & YT_PHY_MODE_UTP) { -+ if (link_utp) -+ ytphy_write_ext(phydev, 0xa000, 0); -+ } -+ return 0; -+} -+ -+static int yt8618_read_status(struct phy_device *phydev) -+{ -+ int ret; -+ /* maybe for 8614 yt8521_fiber_latch_val, yt8521_fiber_curr_val; */ -+ int val; -+ int link; -+ int link_utp = 0, link_fiber = 0; -+ -+ /* switch to utp and reading regs */ -+ ret = ytphy_write_ext(phydev, 0xa000, 0); -+ if (ret < 0) -+ return ret; -+ -+ val = phy_read(phydev, REG_PHY_SPEC_STATUS); -+ if (val < 0) -+ return val; -+ -+ link = val & (BIT(YT8521_LINK_STATUS_BIT)); -+ if (link) { -+ link_utp = 1; -+ yt8521_adjust_status(phydev, val, 1); -+ } else { -+ link_utp = 0; -+ } -+ -+ if (link_utp || link_fiber) -+ phydev->link = 1; -+ else -+ phydev->link = 0; -+ -+ return 0; -+} -+ -+int yt8618_suspend(struct phy_device *phydev) -+{ -+#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) -+ int value; -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_lock(&phydev->lock); -+#else -+ /* no need lock in 4.19 */ -+#endif -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ value = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_unlock(&phydev->lock); -+#else -+ /* no need lock/unlock in 4.19 */ -+#endif -+#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ -+ -+ return 0; -+} -+ -+int yt8618_resume(struct phy_device *phydev) -+{ -+#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) -+ int value; -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_lock(&phydev->lock); -+#else -+ /* no need lock/unlock in 4.19 */ -+#endif -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ value = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_unlock(&phydev->lock); -+#else -+ /* no need lock/unlock in 4.19 */ -+#endif -+#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ -+ -+ return 0; -+} -+ -+int yt8614_suspend(struct phy_device *phydev) -+{ -+#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) -+ int value; -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_lock(&phydev->lock); -+#else -+ /* no need lock in 4.19 */ -+#endif -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ value = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); -+ -+ ytphy_write_ext(phydev, 0xa000, 3); -+ value = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_unlock(&phydev->lock); -+#else -+ /* no need lock/unlock in 4.19 */ -+#endif -+#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ -+ -+ return 0; -+} -+ -+int yt8614_resume(struct phy_device *phydev) -+{ -+#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) -+ int value; -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_lock(&phydev->lock); -+#else -+ /* no need lock/unlock in 4.19 */ -+#endif -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ value = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); -+ -+ ytphy_write_ext(phydev, 0xa000, 3); -+ value = phy_read(phydev, MII_BMCR); -+ phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ mutex_unlock(&phydev->lock); -+#else -+ /* no need lock/unlock in 4.19 */ -+#endif -+#endif /* !(SYS_WAKEUP_BASED_ON_ETH_PKT) */ -+ -+ return 0; -+} -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+int yt8821_soft_reset(struct phy_device *phydev) -+{ -+ int ret, val; -+ -+ val = ytphy_read_ext(phydev, 0xa001); -+ ytphy_write_ext(phydev, 0xa001, (val & ~0x8000)); -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+ ret = ytphy_soft_reset(phydev); -+ -+ return ret; -+} -+#endif -+ -+static int yt8821_init(struct phy_device *phydev) -+{ -+ int ret = 0; -+ int val = 0; -+ -+ /* sds pll cfg */ -+ ret = ytphy_write_ext(phydev, 0xa050, 0x1000); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0xa000, 0x2); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x23, 0x47a1); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0xbd, 0x3547); -+ if (ret < 0) -+ return ret; -+ -+ /* wait 1s */ -+ msleep(1000); -+ -+ /* calibration dcc */ -+ ret = ytphy_write_ext(phydev, 0xbd, 0xa547); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x29, 0x3003); -+ if (ret < 0) -+ return ret; -+ -+ /* sds driver swing */ -+ ret = ytphy_write_ext(phydev, 0x25, 0x788); -+ if (ret < 0) -+ return ret; -+ -+ /* phy cfg */ -+ ret = ytphy_write_ext(phydev, 0xa000, 0x0); -+ if (ret < 0) -+ return ret; -+ -+ /* phy template cfg */ -+ ret = ytphy_write_ext(phydev, 0x471, 0x4545); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x476, 0x4848); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x477, 0x4848); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x478, 0x4848); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x479, 0x4848); -+ if (ret < 0) -+ return ret; -+ -+ /* calibrate phy lc pll */ -+ ret = ytphy_write_ext(phydev, 0x600, 0x2300); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x8, 0x8041); -+ if (ret < 0) -+ return ret; -+ -+ /* prm_small_lng/med */ -+ ret = ytphy_write_ext(phydev, 0x388, 0x90); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x387, 0x90); -+ if (ret < 0) -+ return ret; -+ -+ /* echo_delay_cfg */ -+ ret = ytphy_write_ext(phydev, 0x3, 0xa026); -+ if (ret < 0) -+ return ret; -+ -+ /* pbo setting */ -+ ret = ytphy_write_ext(phydev, 0x47e, 0x3535); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x47f, 0x3535); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x480, 0x3535); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x481, 0x3535); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x483, 0x2a2a); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x484, 0x2a2a); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x485, 0x2a2a); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x486, 0x2a2a); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x488, 0x2121); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x489, 0x2121); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x48a, 0x2121); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x48b, 0x2121); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x48d, 0x1a1a); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x48e, 0x1a1a); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x48f, 0x1a1a); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x490, 0x1a1a); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x492, 0x1515); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x493, 0x1515); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x494, 0x1515); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x495, 0x1515); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x497, 0x1111); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x498, 0x1111); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x499, 0x1111); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x49a, 0x1111); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x49c, 0x0d0d); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x49d, 0x0d0d); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x49e, 0x0d0d); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0x49f, 0x0d0d); -+ if (ret < 0) -+ return ret; -+ ret = ytphy_write_ext(phydev, 0xa052, 0x7); -+ if (ret < 0) -+ return ret; -+ -+ /* fast link down cfg */ -+ ret = ytphy_write_ext(phydev, 0x355, 0x7d07); -+ if (ret < 0) -+ return ret; -+ -+ /* soft reset */ -+ val = phy_read(phydev, MII_BMCR); -+ if (val < 0) -+ return val; -+ ret = phy_write(phydev, MII_BMCR, val | BMCR_RESET); -+ -+ return ret; -+} -+ -+static int yt8821_config_init(struct phy_device *phydev) -+{ -+ int ret; -+ int val, hw_strap_mode; -+ -+ phydev->irq = PHY_POLL; -+ -+ /* NOTE: this function should not be called more than one for each chip. */ -+ hw_strap_mode = ytphy_read_ext(phydev, 0xa001) & 0x7; -+ -+ ytphy_write_ext(phydev, 0xa000, 0); -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+ ret = ytphy_config_init(phydev); -+#else -+ ret = genphy_config_init(phydev); -+#endif -+ if (ret < 0) -+ return ret; -+ -+ ret = yt8821_init(phydev); -+ if (ret < 0) -+ return ret; -+ -+ /* disable auto sleep */ -+ val = ytphy_read_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1); -+ if (val < 0) -+ return val; -+ -+ val &= (~BIT(YT8521_EN_SLEEP_SW_BIT)); -+ -+ ret = ytphy_write_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1, val); -+ if (ret < 0) -+ return ret; -+ -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s done, phy addr: %d, strap mode = %d\n", __func__, phydev->addr, hw_strap_mode); -+#else -+ netdev_info(phydev->attached_dev, "%s done, phy addr: %d, strap mode = %d\n", __func__, phydev->mdio.addr, hw_strap_mode); -+#endif -+ -+ return ret; -+} -+ -+/* for fiber mode, there is no 10M speed mode and -+ * this function is for this purpose. -+ */ -+static int yt8821_adjust_status(struct phy_device *phydev, int val, int is_utp) -+{ -+ int speed_mode, duplex; -+ int speed_mode_bit15_14, speed_mode_bit9; -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ int speed = -1; -+#else -+ int speed = SPEED_UNKNOWN; -+#endif -+ -+ if (is_utp) -+ duplex = (val & YT8512_DUPLEX) >> YT8521_DUPLEX_BIT; -+ else -+ duplex = 1; -+ -+ /* Bit9-Bit15-Bit14 speed mode 100---2.5G; 010---1000M; 001---100M; 000---10M */ -+ speed_mode_bit15_14 = (val & YT8521_SPEED_MODE) >> YT8521_SPEED_MODE_BIT; -+ speed_mode_bit9 = (val & BIT(9)) >> 9; -+ speed_mode = (speed_mode_bit9 << 2) | speed_mode_bit15_14; -+ switch (speed_mode) { -+ case 0: -+ if (is_utp) -+ speed = SPEED_10; -+ break; -+ case 1: -+ speed = SPEED_100; -+ break; -+ case 2: -+ speed = SPEED_1000; -+ break; -+ case 4: -+ speed = SPEED_2500; -+ break; -+ default: -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+ speed = -1; -+#else -+ speed = SPEED_UNKNOWN; -+#endif -+ break; -+ } -+ -+ phydev->speed = speed; -+ phydev->duplex = duplex; -+ -+ return 0; -+} -+ -+static int yt8821_read_status(struct phy_device *phydev) -+{ -+ int ret; -+ int val; -+ int yt8521_fiber_latch_val; -+ int yt8521_fiber_curr_val; -+ int link; -+ int link_utp = 0, link_fiber = 0; -+ -+ if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) { -+ /* reading UTP */ -+ ret = ytphy_write_ext(phydev, 0xa000, 0); -+ if (ret < 0) -+ return ret; -+ -+ val = phy_read(phydev, REG_PHY_SPEC_STATUS); -+ if (val < 0) -+ return val; -+ -+ link = val & (BIT(YT8521_LINK_STATUS_BIT)); -+ if (link) { -+ link_utp = 1; -+ yt8821_adjust_status(phydev, val, 1); /* speed(2500), duplex */ -+ } else { -+ link_utp = 0; -+ } -+ } //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) -+ -+ if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) { -+ /* reading Fiber */ -+ ret = ytphy_write_ext(phydev, 0xa000, 2); -+ if (ret < 0) -+ return ret; -+ -+ val = phy_read(phydev, REG_PHY_SPEC_STATUS); -+ if (val < 0) -+ return val; -+ -+ //note: below debug information is used to check multiple PHy ports. -+ -+ /* for fiber, from 1000m to 100m, there is not link down from 0x11, -+ * and check reg 1 to identify such case this is important for Linux -+ * kernel for that, missing linkdown event will cause problem. -+ */ -+ yt8521_fiber_latch_val = phy_read(phydev, MII_BMSR); -+ yt8521_fiber_curr_val = phy_read(phydev, MII_BMSR); -+ link = val & (BIT(YT8521_LINK_STATUS_BIT)); -+ if (link && yt8521_fiber_latch_val != yt8521_fiber_curr_val) { -+ link = 0; -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", -+ __func__, phydev->addr, yt8521_fiber_latch_val, yt8521_fiber_curr_val); -+#else -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", -+ __func__, phydev->mdio.addr, yt8521_fiber_latch_val, yt8521_fiber_curr_val); -+#endif -+ } -+ -+ if (link) { -+ link_fiber = 1; -+ yt8821_adjust_status(phydev, val, 0); -+ } else { -+ link_fiber = 0; -+ } -+ } //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) -+ -+ if (link_utp || link_fiber) { -+ if (phydev->link == 0) -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media: %s, mii reg 0x11 = 0x%x\n", -+ __func__, phydev->addr, (link_utp && link_fiber) ? "UNKNOWN MEDIA" : (link_utp ? "UTP" : "Fiber"), (unsigned int)val); -+#else -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media: %s, mii reg 0x11 = 0x%x\n", -+ __func__, phydev->mdio.addr, (link_utp && link_fiber) ? "UNKNOWN MEDIA" : (link_utp ? "UTP" : "Fiber"), (unsigned int)val); -+#endif -+ phydev->link = 1; -+ } else { -+ if (phydev->link == 1) -+#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->addr); -+#else -+ netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->mdio.addr); -+#endif -+ -+ phydev->link = 0; -+ } -+ -+ if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) { -+ if (link_fiber) -+ ytphy_write_ext(phydev, 0xa000, 2); -+ if (link_utp) -+ ytphy_write_ext(phydev, 0xa000, 0); -+ } -+ return 0; -+} -+ -+#if (KERNEL_VERSION(5, 1, 21) < LINUX_VERSION_CODE) -+static int yt8821_get_features(struct phy_device *phydev) -+{ -+ linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->supported, 1); -+ return genphy_read_abilities(phydev); -+} -+#endif -+ -+static struct phy_driver ytphy_drvs[] = { -+ { -+ .phy_id = PHY_ID_YT8010, -+ .name = "YT8010 Automotive Ethernet", -+ .phy_id_mask = MOTORCOMM_PHY_ID_MASK, -+ .features = PHY_BASIC_FEATURES, -+ .flags = PHY_POLL, -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+ .soft_reset = yt8010_soft_reset, -+#endif -+ .config_aneg = yt8010_config_aneg, -+#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) -+ .aneg_done = yt8010_aneg_done, -+#endif -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+ .config_init = ytphy_config_init, -+#else -+ .config_init = genphy_config_init, -+#endif -+ .read_status = yt8010_read_status, -+ }, { -+ .phy_id = PHY_ID_YT8010AS, -+ .name = "YT8010AS Automotive Ethernet", -+ .phy_id_mask = MOTORCOMM_PHY_ID_MASK, -+ .features = PHY_BASIC_FEATURES, -+ .flags = PHY_POLL, -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+ .soft_reset = yt8010AS_soft_reset, -+#endif -+#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) -+ .aneg_done = yt8010_aneg_done, -+#endif -+ .config_init = yt8010AS_config_init, -+ .read_status = yt8010_read_status, -+ }, { -+ .phy_id = PHY_ID_YT8510, -+ .name = "YT8510 100/10Mb Ethernet", -+ .phy_id_mask = MOTORCOMM_PHY_ID_MASK, -+ .features = PHY_BASIC_FEATURES, -+ .flags = PHY_POLL, -+ .config_aneg = genphy_config_aneg, -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+ .config_init = ytphy_config_init, -+#else -+ .config_init = genphy_config_init, -+#endif -+ .read_status = genphy_read_status, -+ }, { -+ .phy_id = PHY_ID_YT8511, -+ .name = "YT8511 Gigabit Ethernet", -+ .phy_id_mask = MOTORCOMM_PHY_ID_MASK, -+ .features = PHY_GBIT_FEATURES, -+ .flags = PHY_POLL, -+ .config_aneg = genphy_config_aneg, -+#if GMAC_CLOCK_INPUT_NEEDED -+ .config_init = yt8511_config_init, -+#else -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) -+ .config_init = ytphy_config_init, -+#else -+ .config_init = genphy_config_init, -+#endif -+#endif -+ .read_status = genphy_read_status, -+ .suspend = genphy_suspend, -+ .resume = genphy_resume, -+ }, { -+ .phy_id = PHY_ID_YT8512, -+ .name = "YT8512 Ethernet", -+ .phy_id_mask = MOTORCOMM_PHY_ID_MASK, -+ .features = PHY_BASIC_FEATURES, -+ .flags = PHY_POLL, -+ .config_aneg = genphy_config_aneg, -+ .config_init = yt8512_config_init, -+ .read_status = yt8512_read_status, -+ .suspend = genphy_suspend, -+ .resume = genphy_resume, -+ }, { -+ .phy_id = PHY_ID_YT8512B, -+ .name = "YT8512B Ethernet", -+ .phy_id_mask = MOTORCOMM_PHY_ID_MASK, -+ .features = PHY_BASIC_FEATURES, -+ .flags = PHY_POLL, -+ .config_aneg = genphy_config_aneg, -+ .config_init = yt8512_config_init, -+ .read_status = yt8512_read_status, -+ .suspend = genphy_suspend, -+ .resume = genphy_resume, -+ }, { -+ .phy_id = PHY_ID_YT8521, -+ .name = "YT8521 Ethernet", -+ .phy_id_mask = MOTORCOMM_PHY_ID_MASK, -+ .features = PHY_GBIT_FEATURES, -+ .flags = PHY_POLL, -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+ .soft_reset = yt8521_soft_reset, -+#endif -+ .config_aneg = genphy_config_aneg, -+#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) -+ .aneg_done = yt8521_aneg_done, -+#endif -+ .config_init = yt8521_config_init, -+ .read_status = yt8521_read_status, -+ .suspend = yt8521_suspend, -+ .resume = yt8521_resume, -+#if (YTPHY_WOL_FEATURE_ENABLE) -+ .get_wol = &ytphy_wol_feature_get, -+ .set_wol = &ytphy_wol_feature_set, -+#endif -+ }, { -+ /* same as 8521 */ -+ .phy_id = PHY_ID_YT8531S, -+ .name = "YT8531S Ethernet", -+ .phy_id_mask = MOTORCOMM_PHY_ID_MASK, -+ .features = PHY_GBIT_FEATURES, -+ .flags = PHY_POLL, -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+ .soft_reset = yt8521_soft_reset, -+#endif -+ .config_aneg = genphy_config_aneg, -+#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) -+ .aneg_done = yt8521_aneg_done, -+#endif -+ .config_init = yt8531S_config_init, -+ .read_status = yt8521_read_status, -+ .suspend = yt8521_suspend, -+ .resume = yt8521_resume, -+#if (YTPHY_WOL_FEATURE_ENABLE) -+ .get_wol = &ytphy_wol_feature_get, -+ .set_wol = &ytphy_wol_feature_set, -+#endif -+ }, { -+ /* same as 8511 */ -+ .phy_id = PHY_ID_YT8531, -+ .name = "YT8531 Gigabit Ethernet", -+ .phy_id_mask = MOTORCOMM_PHY_ID_MASK, -+ .features = PHY_GBIT_FEATURES, -+ .flags = PHY_POLL, -+ .config_aneg = genphy_config_aneg, -+ -+ .config_init = yt8531_config_init, -+ .read_status = genphy_read_status, -+ .suspend = genphy_suspend, -+ .resume = genphy_resume, -+#if (YTPHY_WOL_FEATURE_ENABLE) -+ .get_wol = &ytphy_wol_feature_get, -+ .set_wol = &ytphy_wol_feature_set, -+#endif -+ }, { -+ .phy_id = PHY_ID_YT8618, -+ .name = "YT8618 Ethernet", -+ .phy_id_mask = MOTORCOMM_MPHY_ID_MASK, -+ .features = PHY_GBIT_FEATURES, -+ .flags = PHY_POLL, -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+ .soft_reset = yt8618_soft_reset, -+#endif -+ .config_aneg = genphy_config_aneg, -+#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) -+ .aneg_done = yt8618_aneg_done, -+#endif -+ .config_init = yt8618_config_init, -+ .read_status = yt8618_read_status, -+ .suspend = yt8618_suspend, -+ .resume = yt8618_resume, -+ }, -+ { -+ .phy_id = PHY_ID_YT8614, -+ .name = "YT8614 Ethernet", -+ .phy_id_mask = MOTORCOMM_MPHY_ID_MASK_8614, -+ .features = PHY_GBIT_FEATURES, -+ .flags = PHY_POLL, -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+ .soft_reset = yt8614_soft_reset, -+#endif -+ .config_aneg = genphy_config_aneg, -+#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) -+ .aneg_done = yt8614_aneg_done, -+#endif -+ .config_init = yt8614_config_init, -+ .read_status = yt8614_read_status, -+ .suspend = yt8614_suspend, -+ .resume = yt8614_resume, -+ }, -+ { -+ .phy_id = PHY_ID_YT8821, -+ .name = "YT8821 2.5Gb Ethernet", -+ .phy_id_mask = MOTORCOMM_PHY_ID_MASK_8821, -+#if (KERNEL_VERSION(5, 2, 0) > LINUX_VERSION_CODE) -+ .features = PHY_GBIT_FEATURES, -+#endif -+ .flags = PHY_POLL, -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+#else -+ .soft_reset = yt8821_soft_reset, -+#endif -+ .config_aneg = genphy_config_aneg, -+#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) -+ .aneg_done = yt8521_aneg_done, -+#endif -+#if (KERNEL_VERSION(5, 1, 21) < LINUX_VERSION_CODE) -+ .get_features = yt8821_get_features, -+#endif -+ .config_init = yt8821_config_init, -+ .read_status = yt8821_read_status, -+ .suspend = yt8521_suspend, -+ .resume = yt8521_resume, -+ }, -+}; -+ -+#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) -+static int ytphy_drivers_register(struct phy_driver *phy_drvs, int size) -+{ -+ int i, j; -+ int ret; -+ -+ for (i = 0; i < size; i++) { -+ ret = phy_driver_register(&phy_drvs[i]); -+ if (ret) -+ goto err; -+ } -+ -+ return 0; -+ -+err: -+ for (j = 0; j < i; j++) -+ phy_driver_unregister(&phy_drvs[j]); -+ -+ return ret; -+} -+ -+static void ytphy_drivers_unregister(struct phy_driver *phy_drvs, int size) -+{ -+ int i; -+ -+ for (i = 0; i < size; i++) -+ phy_driver_unregister(&phy_drvs[i]); -+} -+ -+static int __init ytphy_init(void) -+{ -+ return ytphy_drivers_register(ytphy_drvs, ARRAY_SIZE(ytphy_drvs)); -+} -+ -+static void __exit ytphy_exit(void) -+{ -+ ytphy_drivers_unregister(ytphy_drvs, ARRAY_SIZE(ytphy_drvs)); -+} -+ -+module_init(ytphy_init); -+module_exit(ytphy_exit); -+#else -+/* for linux 4.x */ -+module_phy_driver(ytphy_drvs); -+#endif -+ -+MODULE_DESCRIPTION("Motorcomm PHY driver"); -+MODULE_AUTHOR("Leilei Zhao"); -+MODULE_LICENSE("GPL"); -+ -+static struct mdio_device_id __maybe_unused motorcomm_tbl[] = { -+ { PHY_ID_YT8010, MOTORCOMM_PHY_ID_MASK }, -+ { PHY_ID_YT8510, MOTORCOMM_PHY_ID_MASK }, -+ { PHY_ID_YT8511, MOTORCOMM_PHY_ID_MASK }, -+ { PHY_ID_YT8512, MOTORCOMM_PHY_ID_MASK }, -+ { PHY_ID_YT8512B, MOTORCOMM_PHY_ID_MASK }, -+ { PHY_ID_YT8521, MOTORCOMM_PHY_ID_MASK }, -+ { PHY_ID_YT8531S, MOTORCOMM_PHY_ID_8531_MASK }, -+ { PHY_ID_YT8531, MOTORCOMM_PHY_ID_8531_MASK }, -+ { PHY_ID_YT8618, MOTORCOMM_MPHY_ID_MASK }, -+ { PHY_ID_YT8614, MOTORCOMM_MPHY_ID_MASK_8614 }, -+ { PHY_ID_YT8821, MOTORCOMM_PHY_ID_MASK_8821 }, -+ { } -+}; -+ -+MODULE_DEVICE_TABLE(mdio, motorcomm_tbl); -+ -diff --git a/drivers/net/phy/phylink.c b/drivers/net/phy/phylink.c -index cbdd01f31..d0c6bc96d 100644 ---- a/drivers/net/phy/phylink.c -+++ b/drivers/net/phy/phylink.c -@@ -306,6 +306,9 @@ static int phylink_parse_mode(struct phylink *pl, struct fwnode_handle *fwnode) - phylink_set(pl->supported, 2500baseX_Full); - break; - -+ case PHY_INTERFACE_MODE_5GBASER: -+ phylink_set(pl->supported, 5000baseT_Full); -+ break; - case PHY_INTERFACE_MODE_USXGMII: - case PHY_INTERFACE_MODE_10GKR: - case PHY_INTERFACE_MODE_10GBASER: -diff --git a/drivers/net/wireless/Kconfig b/drivers/net/wireless/Kconfig -index 170a64e67..12996985a 100644 ---- a/drivers/net/wireless/Kconfig -+++ b/drivers/net/wireless/Kconfig -@@ -48,6 +48,7 @@ source "drivers/net/wireless/st/Kconfig" - source "drivers/net/wireless/ti/Kconfig" - source "drivers/net/wireless/zydas/Kconfig" - source "drivers/net/wireless/quantenna/Kconfig" -+source "drivers/net/wireless/rtl8821cs/Kconfig" - - config PCMCIA_RAYCS - tristate "Aviator/Raytheon 2.4GHz wireless support" -diff --git a/drivers/net/wireless/Makefile b/drivers/net/wireless/Makefile -index 80b324499..64ad35a40 100644 ---- a/drivers/net/wireless/Makefile -+++ b/drivers/net/wireless/Makefile -@@ -30,3 +30,5 @@ obj-$(CONFIG_USB_NET_RNDIS_WLAN) += rndis_wlan.o - obj-$(CONFIG_MAC80211_HWSIM) += mac80211_hwsim.o - - obj-$(CONFIG_VIRT_WIFI) += virt_wifi.o -+ -+obj-$(CONFIG_RTL8821CS) += rtl8821cs/ -diff --git a/drivers/net/wireless/realtek/rtw88/Kconfig b/drivers/net/wireless/realtek/rtw88/Kconfig -index e3d7cb6c1..cffad1c01 100644 ---- a/drivers/net/wireless/realtek/rtw88/Kconfig -+++ b/drivers/net/wireless/realtek/rtw88/Kconfig -@@ -16,6 +16,12 @@ config RTW88_CORE - config RTW88_PCI - tristate - -+config RTW88_SDIO -+ tristate -+ -+config RTW88_USB -+ tristate -+ - config RTW88_8822B - tristate - -@@ -39,6 +45,28 @@ config RTW88_8822BE - - 802.11ac PCIe wireless network adapter - -+config RTW88_8822BS -+ tristate "Realtek 8822BS SDIO wireless network adapter" -+ depends on MMC -+ select RTW88_CORE -+ select RTW88_SDIO -+ select RTW88_8822B -+ help -+ Select this option will enable support for 8822BS chipset -+ -+ 802.11ac SDIO wireless network adapter -+ -+config RTW88_8822BU -+ tristate "Realtek 8822BU USB wireless network adapter" -+ depends on USB -+ select RTW88_CORE -+ select RTW88_USB -+ select RTW88_8822B -+ help -+ Select this option will enable support for 8822BU chipset -+ -+ 802.11ac USB wireless network adapter -+ - config RTW88_8822CE - tristate "Realtek 8822CE PCI wireless network adapter" - depends on PCI -@@ -50,6 +78,28 @@ config RTW88_8822CE - - 802.11ac PCIe wireless network adapter - -+config RTW88_8822CS -+ tristate "Realtek 8822CS SDIO wireless network adapter" -+ depends on MMC -+ select RTW88_CORE -+ select RTW88_SDIO -+ select RTW88_8822C -+ help -+ Select this option will enable support for 8822CS chipset -+ -+ 802.11ac SDIO wireless network adapter -+ -+config RTW88_8822CU -+ tristate "Realtek 8822CU USB wireless network adapter" -+ depends on USB -+ select RTW88_CORE -+ select RTW88_USB -+ select RTW88_8822C -+ help -+ Select this option will enable support for 8822CU chipset -+ -+ 802.11ac USB wireless network adapter -+ - config RTW88_8723DE - tristate "Realtek 8723DE PCI wireless network adapter" - depends on PCI -@@ -61,6 +111,28 @@ config RTW88_8723DE - - 802.11n PCIe wireless network adapter - -+config RTW88_8723DS -+ tristate "Realtek 8723DS SDIO wireless network adapter" -+ depends on MMC -+ select RTW88_CORE -+ select RTW88_SDIO -+ select RTW88_8723D -+ help -+ Select this option will enable support for 8723DS chipset -+ -+ 802.11n SDIO wireless network adapter -+ -+config RTW88_8723DU -+ tristate "Realtek 8723DU USB wireless network adapter" -+ depends on USB -+ select RTW88_CORE -+ select RTW88_USB -+ select RTW88_8723D -+ help -+ Select this option will enable support for 8723DU chipset -+ -+ 802.11n USB wireless network adapter -+ - config RTW88_8821CE - tristate "Realtek 8821CE PCI wireless network adapter" - depends on PCI -@@ -72,6 +144,28 @@ config RTW88_8821CE - - 802.11ac PCIe wireless network adapter - -+config RTW88_8821CS -+ tristate "Realtek 8821CS SDIO wireless network adapter" -+ depends on MMC -+ select RTW88_CORE -+ select RTW88_SDIO -+ select RTW88_8821C -+ help -+ Select this option will enable support for 8821CS chipset -+ -+ 802.11ac SDIO wireless network adapter -+ -+config RTW88_8821CU -+ tristate "Realtek 8821CU USB wireless network adapter" -+ depends on USB -+ select RTW88_CORE -+ select RTW88_USB -+ select RTW88_8821C -+ help -+ Select this option will enable support for 8821CU chipset -+ -+ 802.11ac USB wireless network adapter -+ - config RTW88_DEBUG - bool "Realtek rtw88 debug support" - depends on RTW88_CORE -diff --git a/drivers/net/wireless/realtek/rtw88/Makefile b/drivers/net/wireless/realtek/rtw88/Makefile -index 73d6807a8..fd212c09d 100644 ---- a/drivers/net/wireless/realtek/rtw88/Makefile -+++ b/drivers/net/wireless/realtek/rtw88/Makefile -@@ -15,6 +15,7 @@ rtw88_core-y += main.o \ - ps.o \ - sec.o \ - bf.o \ -+ sar.o \ - regd.o - - rtw88_core-$(CONFIG_PM) += wow.o -@@ -25,23 +26,53 @@ rtw88_8822b-objs := rtw8822b.o rtw8822b_table.o - obj-$(CONFIG_RTW88_8822BE) += rtw88_8822be.o - rtw88_8822be-objs := rtw8822be.o - -+obj-$(CONFIG_RTW88_8822BS) += rtw88_8822bs.o -+rtw88_8822bs-objs := rtw8822bs.o -+ -+obj-$(CONFIG_RTW88_8822BU) += rtw88_8822bu.o -+rtw88_8822bu-objs := rtw8822bu.o -+ - obj-$(CONFIG_RTW88_8822C) += rtw88_8822c.o - rtw88_8822c-objs := rtw8822c.o rtw8822c_table.o - - obj-$(CONFIG_RTW88_8822CE) += rtw88_8822ce.o - rtw88_8822ce-objs := rtw8822ce.o - -+obj-$(CONFIG_RTW88_8822CS) += rtw88_8822cs.o -+rtw88_8822cs-objs := rtw8822cs.o -+ -+obj-$(CONFIG_RTW88_8822CU) += rtw88_8822cu.o -+rtw88_8822cu-objs := rtw8822cu.o -+ - obj-$(CONFIG_RTW88_8723D) += rtw88_8723d.o - rtw88_8723d-objs := rtw8723d.o rtw8723d_table.o - - obj-$(CONFIG_RTW88_8723DE) += rtw88_8723de.o - rtw88_8723de-objs := rtw8723de.o - -+obj-$(CONFIG_RTW88_8723DS) += rtw88_8723ds.o -+rtw88_8723ds-objs := rtw8723ds.o -+ -+obj-$(CONFIG_RTW88_8723DU) += rtw88_8723du.o -+rtw88_8723du-objs := rtw8723du.o -+ - obj-$(CONFIG_RTW88_8821C) += rtw88_8821c.o - rtw88_8821c-objs := rtw8821c.o rtw8821c_table.o - - obj-$(CONFIG_RTW88_8821CE) += rtw88_8821ce.o - rtw88_8821ce-objs := rtw8821ce.o - -+obj-$(CONFIG_RTW88_8821CS) += rtw88_8821cs.o -+rtw88_8821cs-objs := rtw8821cs.o -+ -+obj-$(CONFIG_RTW88_8821CU) += rtw88_8821cu.o -+rtw88_8821cu-objs := rtw8821cu.o -+ - obj-$(CONFIG_RTW88_PCI) += rtw88_pci.o - rtw88_pci-objs := pci.o -+ -+obj-$(CONFIG_RTW88_SDIO) += rtw88_sdio.o -+rtw88_sdio-objs := sdio.o -+ -+obj-$(CONFIG_RTW88_USB) += rtw88_usb.o -+rtw88_usb-objs := usb.o -diff --git a/drivers/net/wireless/realtek/rtw88/bf.c b/drivers/net/wireless/realtek/rtw88/bf.c -index aff70e4ae..95de3d3da 100644 ---- a/drivers/net/wireless/realtek/rtw88/bf.c -+++ b/drivers/net/wireless/realtek/rtw88/bf.c -@@ -30,11 +30,11 @@ void rtw_bf_disassoc(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, - void rtw_bf_assoc(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, - struct ieee80211_bss_conf *bss_conf) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct ieee80211_hw *hw = rtwdev->hw; - struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; - struct rtw_bfee *bfee = &rtwvif->bfee; - struct rtw_bf_info *bfinfo = &rtwdev->bf_info; -- struct rtw_chip_info *chip = rtwdev->chip; - struct ieee80211_sta *sta; - struct ieee80211_sta_vht_cap *vht_cap; - struct ieee80211_sta_vht_cap *ic_vht_cap; -@@ -49,25 +49,37 @@ void rtw_bf_assoc(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, - - sta = ieee80211_find_sta(vif, bssid); - if (!sta) { -+ rcu_read_unlock(); -+ - rtw_warn(rtwdev, "failed to find station entry for bss %pM\n", - bssid); -- goto out_unlock; -+ return; - } - - ic_vht_cap = &hw->wiphy->bands[NL80211_BAND_5GHZ]->vht_cap; -+#if LINUX_VERSION_CODE < KERNEL_VERSION(5, 19, 0) - vht_cap = &sta->vht_cap; -+#else -+ vht_cap = &sta->deflink.vht_cap; -+#endif -+ -+ rcu_read_unlock(); - - if ((ic_vht_cap->cap & IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE) && - (vht_cap->cap & IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE)) { - if (bfinfo->bfer_mu_cnt >= chip->bfer_mu_max_num) { - rtw_dbg(rtwdev, RTW_DBG_BF, "mu bfer number over limit\n"); -- goto out_unlock; -+ return; - } - - ether_addr_copy(bfee->mac_addr, bssid); - bfee->role = RTW_BFEE_MU; - bfee->p_aid = (bssid[5] << 1) | (bssid[4] >> 7); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) -+ bfee->aid = vif->cfg.aid; -+#else - bfee->aid = bss_conf->aid; -+#endif - bfinfo->bfer_mu_cnt++; - - rtw_chip_config_bfee(rtwdev, rtwvif, bfee, true); -@@ -75,7 +87,7 @@ void rtw_bf_assoc(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, - (vht_cap->cap & IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE)) { - if (bfinfo->bfer_su_cnt >= chip->bfer_su_max_num) { - rtw_dbg(rtwdev, RTW_DBG_BF, "su bfer number over limit\n"); -- goto out_unlock; -+ return; - } - - sound_dim = vht_cap->cap & -@@ -98,9 +110,6 @@ void rtw_bf_assoc(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, - - rtw_chip_config_bfee(rtwdev, rtwvif, bfee, true); - } -- --out_unlock: -- rcu_read_unlock(); - } - - void rtw_bf_init_bfer_entry_mu(struct rtw_dev *rtwdev, -@@ -130,7 +139,8 @@ void rtw_bf_cfg_sounding(struct rtw_dev *rtwdev, struct rtw_vif *vif, - BIT_WMAC_USE_NDPARATE | - (csi_rsc << 13); - -- rtw_write8(rtwdev, REG_SND_PTCL_CTRL, RTW_SND_CTRL_SOUNDING); -+ rtw_write8_mask(rtwdev, REG_SND_PTCL_CTRL, BIT_MASK_BEAMFORM, -+ RTW_SND_CTRL_SOUNDING); - rtw_write8(rtwdev, REG_SND_PTCL_CTRL + 3, 0x26); - rtw_write8_clr(rtwdev, REG_RXFLTMAP1, BIT_RXFLTMAP1_BF_REPORT_POLL); - rtw_write8_clr(rtwdev, REG_RXFLTMAP4, BIT_RXFLTMAP4_BF_REPORT_POLL); -@@ -177,7 +187,7 @@ void rtw_bf_del_bfer_entry_mu(struct rtw_dev *rtwdev) - - void rtw_bf_del_sounding(struct rtw_dev *rtwdev) - { -- rtw_write8(rtwdev, REG_SND_PTCL_CTRL, 0); -+ rtw_write8_mask(rtwdev, REG_SND_PTCL_CTRL, BIT_MASK_BEAMFORM, 0); - } - - void rtw_bf_enable_bfee_su(struct rtw_dev *rtwdev, struct rtw_vif *vif, -@@ -204,7 +214,8 @@ void rtw_bf_enable_bfee_su(struct rtw_dev *rtwdev, struct rtw_vif *vif, - } - - /* Sounding protocol control */ -- rtw_write8(rtwdev, REG_SND_PTCL_CTRL, RTW_SND_CTRL_SOUNDING); -+ rtw_write8_mask(rtwdev, REG_SND_PTCL_CTRL, BIT_MASK_BEAMFORM, -+ RTW_SND_CTRL_SOUNDING); - - /* MAC address/Partial AID of Beamformer */ - for (i = 0; i < ETH_ALEN; i++) -@@ -273,7 +284,8 @@ void rtw_bf_remove_bfee_su(struct rtw_dev *rtwdev, - struct rtw_bf_info *bfinfo = &rtwdev->bf_info; - - rtw_dbg(rtwdev, RTW_DBG_BF, "remove as a su bfee\n"); -- rtw_write8(rtwdev, REG_SND_PTCL_CTRL, RTW_SND_CTRL_REMOVE); -+ rtw_write8_mask(rtwdev, REG_SND_PTCL_CTRL, BIT_MASK_BEAMFORM, -+ RTW_SND_CTRL_REMOVE); - - switch (bfee->su_reg_index) { - case 0: -@@ -298,7 +310,8 @@ void rtw_bf_remove_bfee_mu(struct rtw_dev *rtwdev, - { - struct rtw_bf_info *bfinfo = &rtwdev->bf_info; - -- rtw_write8(rtwdev, REG_SND_PTCL_CTRL, RTW_SND_CTRL_REMOVE); -+ rtw_write8_mask(rtwdev, REG_SND_PTCL_CTRL, BIT_MASK_BEAMFORM, -+ RTW_SND_CTRL_REMOVE); - - rtw_bf_del_bfer_entry_mu(rtwdev); - -diff --git a/drivers/net/wireless/realtek/rtw88/bf.h b/drivers/net/wireless/realtek/rtw88/bf.h -index 17855edb5..7b40c2c03 100644 ---- a/drivers/net/wireless/realtek/rtw88/bf.h -+++ b/drivers/net/wireless/realtek/rtw88/bf.h -@@ -13,6 +13,9 @@ - #define REG_ASSOCIATED_BFMER1_INFO 0x06EC - #define REG_TX_CSI_RPT_PARAM_BW20 0x06F4 - #define REG_SND_PTCL_CTRL 0x0718 -+#define BIT_DIS_CHK_VHTSIGB_CRC BIT(6) -+#define BIT_DIS_CHK_VHTSIGA_CRC BIT(5) -+#define BIT_MASK_BEAMFORM (GENMASK(4, 0) | BIT(7)) - #define REG_MU_TX_CTL 0x14C0 - #define REG_MU_STA_GID_VLD 0x14C4 - #define REG_MU_STA_USER_POS_INFO 0x14C8 -@@ -42,8 +45,8 @@ - #define BIT_RXFLTMAP4_BF_REPORT_POLL BIT(4) - - #define RTW_NDP_RX_STANDBY_TIME 0x70 --#define RTW_SND_CTRL_REMOVE 0xD8 --#define RTW_SND_CTRL_SOUNDING 0xDB -+#define RTW_SND_CTRL_REMOVE 0x98 -+#define RTW_SND_CTRL_SOUNDING 0x9B - - enum csi_seg_len { - HAL_CSI_SEG_4K = 0, -diff --git a/drivers/net/wireless/realtek/rtw88/bitfield.h b/drivers/net/wireless/realtek/rtw88/bitfield.h -new file mode 100644 -index 000000000..230d2383b ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/bitfield.h -@@ -0,0 +1,155 @@ -+/* -+ * Copyright (C) 2014 Felix Fietkau -+ * Copyright (C) 2004 - 2009 Ivo van Doorn -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 -+ * as published by the Free Software Foundation -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT 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_BITFIELD_H -+#define _LINUX_BITFIELD_H -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 13, 0) -+#include -+#endif -+#include -+ -+/* -+ * Bitfield access macros -+ * -+ * FIELD_{GET,PREP} macros take as first parameter shifted mask -+ * from which they extract the base mask and shift amount. -+ * Mask must be a compilation time constant. -+ * -+ * Example: -+ * -+ * #define REG_FIELD_A GENMASK(6, 0) -+ * #define REG_FIELD_B BIT(7) -+ * #define REG_FIELD_C GENMASK(15, 8) -+ * #define REG_FIELD_D GENMASK(31, 16) -+ * -+ * Get: -+ * a = FIELD_GET(REG_FIELD_A, reg); -+ * b = FIELD_GET(REG_FIELD_B, reg); -+ * -+ * Set: -+ * reg = FIELD_PREP(REG_FIELD_A, 1) | -+ * FIELD_PREP(REG_FIELD_B, 0) | -+ * FIELD_PREP(REG_FIELD_C, c) | -+ * FIELD_PREP(REG_FIELD_D, 0x40); -+ * -+ * Modify: -+ * reg &= ~REG_FIELD_C; -+ * reg |= FIELD_PREP(REG_FIELD_C, c); -+ */ -+ -+#define __bf_shf(x) (__builtin_ffsll(x) - 1) -+ -+#define __BF_FIELD_CHECK(_mask, _reg, _val, _pfx) \ -+ ({ \ -+ BUILD_BUG_ON_MSG(!__builtin_constant_p(_mask), \ -+ _pfx "mask is not constant"); \ -+ BUILD_BUG_ON_MSG((_mask) == 0, _pfx "mask is zero"); \ -+ BUILD_BUG_ON_MSG(__builtin_constant_p(_val) ? \ -+ ~((_mask) >> __bf_shf(_mask)) & (_val) : 0, \ -+ _pfx "value too large for the field"); \ -+ BUILD_BUG_ON_MSG((_mask) > (typeof(_reg))~0ull, \ -+ _pfx "type of reg too small for mask"); \ -+ __BUILD_BUG_ON_NOT_POWER_OF_2((_mask) + \ -+ (1ULL << __bf_shf(_mask))); \ -+ }) -+ -+/** -+ * FIELD_FIT() - check if value fits in the field -+ * @_mask: shifted mask defining the field's length and position -+ * @_val: value to test against the field -+ * -+ * Return: true if @_val can fit inside @_mask, false if @_val is too big. -+ */ -+#define FIELD_FIT(_mask, _val) \ -+ ({ \ -+ __BF_FIELD_CHECK(_mask, 0ULL, _val, "FIELD_FIT: "); \ -+ !((((typeof(_mask))_val) << __bf_shf(_mask)) & ~(_mask)); \ -+ }) -+ -+/** -+ * FIELD_PREP() - prepare a bitfield element -+ * @_mask: shifted mask defining the field's length and position -+ * @_val: value to put in the field -+ * -+ * FIELD_PREP() masks and shifts up the value. The result should -+ * be combined with other fields of the bitfield using logical OR. -+ */ -+#define FIELD_PREP(_mask, _val) \ -+ ({ \ -+ __BF_FIELD_CHECK(_mask, 0ULL, _val, "FIELD_PREP: "); \ -+ ((typeof(_mask))(_val) << __bf_shf(_mask)) & (_mask); \ -+ }) -+ -+/** -+ * FIELD_GET() - extract a bitfield element -+ * @_mask: shifted mask defining the field's length and position -+ * @_reg: value of entire bitfield -+ * -+ * FIELD_GET() extracts the field specified by @_mask from the -+ * bitfield passed in as @_reg by masking and shifting it down. -+ */ -+#define FIELD_GET(_mask, _reg) \ -+ ({ \ -+ __BF_FIELD_CHECK(_mask, _reg, 0U, "FIELD_GET: "); \ -+ (typeof(_mask))(((_reg) & (_mask)) >> __bf_shf(_mask)); \ -+ }) -+ -+extern void __compiletime_error("value doesn't fit into mask") -+__field_overflow(void); -+extern void __compiletime_error("bad bitfield mask") -+__bad_mask(void); -+static __always_inline u64 field_multiplier(u64 field) -+{ -+ if ((field | (field - 1)) & ((field | (field - 1)) + 1)) -+ __bad_mask(); -+ return field & -field; -+} -+static __always_inline u64 field_mask(u64 field) -+{ -+ return field / field_multiplier(field); -+} -+#define ____MAKE_OP(type,base,to,from) \ -+static __always_inline __##type type##_encode_bits(base v, base field) \ -+{ \ -+ if (__builtin_constant_p(v) && (v & ~field_mask(field))) \ -+ __field_overflow(); \ -+ return to((v & field_mask(field)) * field_multiplier(field)); \ -+} \ -+static __always_inline __##type type##_replace_bits(__##type old, \ -+ base val, base field) \ -+{ \ -+ return (old & ~to(field)) | type##_encode_bits(val, field); \ -+} \ -+static __always_inline void type##p_replace_bits(__##type *p, \ -+ base val, base field) \ -+{ \ -+ *p = (*p & ~to(field)) | type##_encode_bits(val, field); \ -+} \ -+static __always_inline base type##_get_bits(__##type v, base field) \ -+{ \ -+ return (from(v) & field)/field_multiplier(field); \ -+} -+#define __MAKE_OP(size) \ -+ ____MAKE_OP(le##size,u##size,cpu_to_le##size,le##size##_to_cpu) \ -+ ____MAKE_OP(be##size,u##size,cpu_to_be##size,be##size##_to_cpu) \ -+ ____MAKE_OP(u##size,u##size,,) -+____MAKE_OP(u8,u8,,) -+__MAKE_OP(16) -+__MAKE_OP(32) -+__MAKE_OP(64) -+#undef __MAKE_OP -+#undef ____MAKE_OP -+ -+#endif -diff --git a/drivers/net/wireless/realtek/rtw88/coex.c b/drivers/net/wireless/realtek/rtw88/coex.c -index aa08fd7d9..86467d2f8 100644 ---- a/drivers/net/wireless/realtek/rtw88/coex.c -+++ b/drivers/net/wireless/realtek/rtw88/coex.c -@@ -8,11 +8,12 @@ - #include "ps.h" - #include "debug.h" - #include "reg.h" -+#include "phy.h" - - static u8 rtw_coex_next_rssi_state(struct rtw_dev *rtwdev, u8 pre_state, - u8 rssi, u8 rssi_thresh) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - u8 tol = chip->rssi_tolerance; - u8 next_state; - -@@ -35,10 +36,10 @@ static u8 rtw_coex_next_rssi_state(struct rtw_dev *rtwdev, u8 pre_state, - static void rtw_coex_limited_tx(struct rtw_dev *rtwdev, - bool tx_limit_en, bool ampdu_limit_en) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; -- bool wifi_under_b_mode = false; -+ u8 num_of_active_port = 1; - - if (!chip->scbd_support) - return; -@@ -70,17 +71,13 @@ static void rtw_coex_limited_tx(struct rtw_dev *rtwdev, - /* set queue life time to avoid can't reach tx retry limit - * if tx is always broken by GNT_BT - */ -- rtw_write8_set(rtwdev, REG_LIFETIME_EN, 0xf); -+ if (num_of_active_port <= 1) -+ rtw_write8_set(rtwdev, REG_LIFETIME_EN, 0xf); - rtw_write16(rtwdev, REG_RETRY_LIMIT, 0x0808); - - /* auto rate fallback step within 8 retries */ -- if (wifi_under_b_mode) { -- rtw_write32(rtwdev, REG_DARFRC, 0x1000000); -- rtw_write32(rtwdev, REG_DARFRCH, 0x1010101); -- } else { -- rtw_write32(rtwdev, REG_DARFRC, 0x1000000); -- rtw_write32(rtwdev, REG_DARFRCH, 0x4030201); -- } -+ rtw_write32(rtwdev, REG_DARFRC, 0x1000000); -+ rtw_write32(rtwdev, REG_DARFRCH, 0x4030201); - } else { - rtw_write8_clr(rtwdev, REG_TX_HANG_CTRL, BIT_EN_GNT_BT_AWAKE); - rtw_write8_clr(rtwdev, REG_LIFETIME_EN, 0xf); -@@ -101,39 +98,84 @@ static void rtw_coex_limited_wl(struct rtw_dev *rtwdev) - { - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_dm *coex_dm = &coex->dm; -- struct rtw_coex_stat *coex_stat = &coex->stat; - bool tx_limit = false; - bool tx_agg_ctrl = false; - -- if (coex->under_5g || -- coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { -- /* no need to limit tx */ -- } else { -+ if (!coex->under_5g && coex_dm->bt_status != COEX_BTSTATUS_NCON_IDLE) { - tx_limit = true; -- if (coex_stat->bt_hid_exist || coex_stat->bt_hfp_exist || -- coex_stat->bt_hid_pair_num > 0) -- tx_agg_ctrl = true; -+ tx_agg_ctrl = true; - } - - rtw_coex_limited_tx(rtwdev, tx_limit, tx_agg_ctrl); - } - --static void rtw_coex_wl_ccklock_action(struct rtw_dev *rtwdev) -+static bool rtw_coex_freerun_check(struct rtw_dev *rtwdev) -+{ -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_dm *coex_dm = &coex->dm; -+ struct rtw_coex_stat *coex_stat = &coex->stat; -+ struct rtw_efuse *efuse = &rtwdev->efuse; -+ u8 bt_rssi; -+ u8 ant_distance = 10; -+ -+ if (coex_stat->bt_disabled) -+ return false; -+ -+ if (efuse->share_ant || ant_distance <= 5 || !coex_stat->wl_gl_busy) -+ return false; -+ -+ if (ant_distance >= 40 || coex_stat->bt_hid_pair_num >= 2) -+ return true; -+ -+ /* ant_distance = 5 ~ 40 */ -+ if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1]) && -+ COEX_RSSI_HIGH(coex_dm->bt_rssi_state[0])) -+ return true; -+ -+ if (coex_stat->wl_tput_dir == COEX_WL_TPUT_TX) -+ bt_rssi = coex_dm->bt_rssi_state[0]; -+ else -+ bt_rssi = coex_dm->bt_rssi_state[1]; -+ -+ if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[3]) && -+ COEX_RSSI_HIGH(bt_rssi) && -+ coex_stat->cnt_wl[COEX_CNT_WL_SCANAP] <= 5) -+ return true; -+ -+ return false; -+} -+ -+static void rtw_coex_wl_slot_extend(struct rtw_dev *rtwdev, bool enable) - { - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - u8 para[6] = {0}; - -- if (coex->stop_dm) -+ para[0] = COEX_H2C69_WL_LEAKAP; -+ para[1] = PARA1_H2C69_DIS_5MS; -+ -+ if (enable) -+ para[1] = PARA1_H2C69_EN_5MS; -+ else -+ coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] = 0; -+ -+ coex_stat->wl_slot_extend = enable; -+ rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); -+} -+ -+static void rtw_coex_wl_ccklock_action(struct rtw_dev *rtwdev) -+{ -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_stat *coex_stat = &coex->stat; -+ -+ if (coex->manual_control || coex->stop_dm) - return; - -- para[0] = COEX_H2C69_WL_LEAKAP; - - if (coex_stat->tdma_timer_base == 3 && coex_stat->wl_slot_extend) { -- para[1] = PARA1_H2C69_DIS_5MS; /* disable 5ms extend */ -- rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); -- coex_stat->wl_slot_extend = false; -- coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] = 0; -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], set h2c 0x69 opcode 12 to turn off 5ms WL slot extend!!\n"); -+ rtw_coex_wl_slot_extend(rtwdev, false); - return; - } - -@@ -144,16 +186,20 @@ static void rtw_coex_wl_ccklock_action(struct rtw_dev *rtwdev) - else - coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] = 0; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], 5ms WL slot extend cnt = %d!!\n", -+ coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND]); -+ - if (coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] == 7) { -- para[1] = 0x1; /* disable 5ms extend */ -- rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); -- coex_stat->wl_slot_extend = false; -- coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] = 0; -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], set h2c 0x69 opcode 12 to turn off 5ms WL slot extend!!\n"); -+ rtw_coex_wl_slot_extend(rtwdev, false); - } - } else if (!coex_stat->wl_slot_extend && coex_stat->wl_cck_lock) { -- para[1] = 0x0; /* enable 5ms extend */ -- rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); -- coex_stat->wl_slot_extend = true; -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], set h2c 0x69 opcode 12 to turn on 5ms WL slot extend!!\n"); -+ -+ rtw_coex_wl_slot_extend(rtwdev, true); - } - } - -@@ -161,11 +207,52 @@ static void rtw_coex_wl_ccklock_detect(struct rtw_dev *rtwdev) - { - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; -+ struct rtw_coex_dm *coex_dm = &coex->dm; - -- /* TODO: wait for rx_rate_change_notify implement */ -- coex_stat->wl_cck_lock = false; -- coex_stat->wl_cck_lock_pre = false; -- coex_stat->wl_cck_lock_ever = false; -+ bool is_cck_lock_rate = false; -+ -+ if (coex_stat->wl_coex_mode != COEX_WLINK_2G1PORT && -+ coex_stat->wl_coex_mode != COEX_WLINK_2GFREE) -+ return; -+ -+ if (coex_dm->bt_status == COEX_BTSTATUS_INQ_PAGE || -+ coex_stat->bt_setup_link) { -+ coex_stat->wl_cck_lock = false; -+ coex_stat->wl_cck_lock_pre = false; -+ return; -+ } -+ -+ if (coex_stat->wl_rx_rate <= COEX_CCK_2 || -+ coex_stat->wl_rts_rx_rate <= COEX_CCK_2) -+ is_cck_lock_rate = true; -+ -+ if (coex_stat->wl_connected && coex_stat->wl_gl_busy && -+ COEX_RSSI_HIGH(coex_dm->wl_rssi_state[3]) && -+ (coex_dm->bt_status == COEX_BTSTATUS_ACL_BUSY || -+ coex_dm->bt_status == COEX_BTSTATUS_ACL_SCO_BUSY || -+ coex_dm->bt_status == COEX_BTSTATUS_SCO_BUSY)) { -+ if (is_cck_lock_rate) { -+ coex_stat->wl_cck_lock = true; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], cck locking...\n"); -+ -+ } else { -+ coex_stat->wl_cck_lock = false; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], cck unlock...\n"); -+ } -+ } else { -+ coex_stat->wl_cck_lock = false; -+ } -+ -+ /* CCK lock identification */ -+ if (coex_stat->wl_cck_lock && !coex_stat->wl_cck_lock_pre) -+ ieee80211_queue_delayed_work(rtwdev->hw, &coex->wl_ccklock_work, -+ 3 * HZ); -+ -+ coex_stat->wl_cck_lock_pre = coex_stat->wl_cck_lock; - } - - static void rtw_coex_wl_noisy_detect(struct rtw_dev *rtwdev) -@@ -174,11 +261,12 @@ static void rtw_coex_wl_noisy_detect(struct rtw_dev *rtwdev) - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_dm_info *dm_info = &rtwdev->dm_info; - u32 cnt_cck; -+ bool wl_cck_lock = false; - - /* wifi noisy environment identification */ - cnt_cck = dm_info->cck_ok_cnt + dm_info->cck_err_cnt; - -- if (!coex_stat->wl_gl_busy) { -+ if (!coex_stat->wl_gl_busy && !wl_cck_lock) { - if (cnt_cck > 250) { - if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] < 5) - coex_stat->cnt_wl[COEX_CNT_WL_NOISY2]++; -@@ -211,6 +299,9 @@ static void rtw_coex_wl_noisy_detect(struct rtw_dev *rtwdev) - coex_stat->wl_noisy_level = 1; - else - coex_stat->wl_noisy_level = 0; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], wl_noisy_level = %d\n", -+ coex_stat->wl_noisy_level); - } - } - -@@ -219,6 +310,8 @@ static void rtw_coex_tdma_timer_base(struct rtw_dev *rtwdev, u8 type) - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - u8 para[2] = {0}; -+ u8 times; -+ u16 tbtt_interval = coex_stat->wl_beacon_interval; - - if (coex_stat->tdma_timer_base == type) - return; -@@ -227,13 +320,33 @@ static void rtw_coex_tdma_timer_base(struct rtw_dev *rtwdev, u8 type) - - para[0] = COEX_H2C69_TDMA_SLOT; - -- if (type == 3) /* 4-slot */ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], tbtt_interval = %d\n", -+ tbtt_interval); -+ -+ if (type == TDMA_TIMER_TYPE_4SLOT && tbtt_interval < 120) { - para[1] = PARA1_H2C69_TDMA_4SLOT; /* 4-slot */ -- else /* 2-slot */ -+ } else if (tbtt_interval < 80 && tbtt_interval > 0) { -+ times = 100 / tbtt_interval; -+ if (100 % tbtt_interval != 0) -+ times++; -+ -+ para[1] = FIELD_PREP(PARA1_H2C69_TBTT_TIMES, times); -+ } else if (tbtt_interval >= 180) { -+ times = tbtt_interval / 100; -+ if (tbtt_interval % 100 <= 80) -+ times--; -+ -+ para[1] = FIELD_PREP(PARA1_H2C69_TBTT_TIMES, times) | -+ FIELD_PREP(PARA1_H2C69_TBTT_DIV100, 1); -+ } else { - para[1] = PARA1_H2C69_TDMA_2SLOT; -+ } - - rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): h2c_0x69 = 0x%x\n", -+ __func__, para[1]); -+ - /* no 5ms_wl_slot_extend for 4-slot mode */ - if (coex_stat->tdma_timer_base == 3) - rtw_coex_wl_ccklock_action(rtwdev); -@@ -252,7 +365,7 @@ static void rtw_coex_set_wl_pri_mask(struct rtw_dev *rtwdev, u8 bitmap, - - void rtw_coex_write_scbd(struct rtw_dev *rtwdev, u16 bitpos, bool set) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - u16 val = 0x2; -@@ -287,7 +400,7 @@ EXPORT_SYMBOL(rtw_coex_write_scbd); - - static u16 rtw_coex_read_scbd(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - if (!chip->scbd_support) - return 0; -@@ -297,7 +410,7 @@ static u16 rtw_coex_read_scbd(struct rtw_dev *rtwdev) - - static void rtw_coex_check_rfk(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_coex_rfe *coex_rfe = &coex->rfe; -@@ -307,6 +420,9 @@ static void rtw_coex_check_rfk(struct rtw_dev *rtwdev) - - if (coex_rfe->wlg_at_btg && chip->scbd_support && - coex_stat->bt_iqk_state != 0xff) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], (Before Ant Setup) Delay by IQK\n"); -+ - wait_cnt = COEX_RFK_TIMEOUT / COEX_MIN_DELAY; - do { - /* BT RFK */ -@@ -318,6 +434,10 @@ static void rtw_coex_check_rfk(struct rtw_dev *rtwdev) - if (!btk && !wlk) - break; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], (Before Ant Setup) wlk = %d, btk = %d\n", -+ wlk, btk); -+ - mdelay(COEX_MIN_DELAY); - } while (++cnt < wait_cnt); - -@@ -334,12 +454,42 @@ static void rtw_coex_query_bt_info(struct rtw_dev *rtwdev) - if (coex_stat->bt_disabled) - return; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ - rtw_fw_query_bt_info(rtwdev); - } - -+static void rtw_coex_gnt_workaround(struct rtw_dev *rtwdev, bool force, u8 mode) -+{ -+ rtw_coex_set_gnt_fix(rtwdev); -+} -+ -+static void rtw_coex_monitor_bt_ctr(struct rtw_dev *rtwdev) -+{ -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_stat *coex_stat = &coex->stat; -+ u32 tmp; -+ -+ tmp = rtw_read32(rtwdev, REG_BT_ACT_STATISTICS); -+ coex_stat->hi_pri_tx = FIELD_GET(MASKLWORD, tmp); -+ coex_stat->hi_pri_rx = FIELD_GET(MASKHWORD, tmp); -+ -+ tmp = rtw_read32(rtwdev, REG_BT_ACT_STATISTICS_1); -+ coex_stat->lo_pri_tx = FIELD_GET(MASKLWORD, tmp); -+ coex_stat->lo_pri_rx = FIELD_GET(MASKHWORD, tmp); -+ -+ rtw_write8(rtwdev, REG_BT_COEX_ENH_INTR_CTRL, -+ BIT_R_GRANTALL_WLMASK | BIT_STATIS_BT_EN); -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ coex_stat->hi_pri_rx, coex_stat->hi_pri_tx, -+ coex_stat->lo_pri_rx, coex_stat->lo_pri_tx); -+} -+ - static void rtw_coex_monitor_bt_enable(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_coex_dm *coex_dm = &coex->dm; -@@ -352,30 +502,32 @@ static void rtw_coex_monitor_bt_enable(struct rtw_dev *rtwdev) - } - - if (coex_stat->bt_disabled != bt_disabled) { -- rtw_dbg(rtwdev, RTW_DBG_COEX, "coex: BT state changed (%d) -> (%d)\n", -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], BT state changed (%d) -> (%d)\n", - coex_stat->bt_disabled, bt_disabled); - - coex_stat->bt_disabled = bt_disabled; - coex_stat->bt_ble_scan_type = 0; - coex_dm->cur_bt_lna_lvl = 0; -- } - -- if (!coex_stat->bt_disabled) { -- coex_stat->bt_reenable = true; -- ieee80211_queue_delayed_work(rtwdev->hw, -- &coex->bt_reenable_work, 15 * HZ); -- } else { -- coex_stat->bt_mailbox_reply = false; -- coex_stat->bt_reenable = false; -+ if (!coex_stat->bt_disabled) { -+ coex_stat->bt_reenable = true; -+ ieee80211_queue_delayed_work(rtwdev->hw, -+ &coex->bt_reenable_work, -+ 15 * HZ); -+ } else { -+ coex_stat->bt_mailbox_reply = false; -+ coex_stat->bt_reenable = false; -+ } - } - } - - static void rtw_coex_update_wl_link_info(struct rtw_dev *rtwdev, u8 reason) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_coex_dm *coex_dm = &coex->dm; -- struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_traffic_stats *stats = &rtwdev->stats; - bool is_5G = false; - bool wl_busy = false; -@@ -420,6 +572,12 @@ static void rtw_coex_update_wl_link_info(struct rtw_dev *rtwdev, u8 reason) - coex_dm->wl_rssi_state[i] = rssi_state; - } - -+ if (coex_stat->wl_linkscan_proc || coex_stat->wl_hi_pri_task1 || -+ coex_stat->wl_hi_pri_task2 || coex_stat->wl_gl_busy) -+ rtw_coex_write_scbd(rtwdev, COEX_SCBD_SCAN, true); -+ else -+ rtw_coex_write_scbd(rtwdev, COEX_SCBD_SCAN, false); -+ - switch (reason) { - case COEX_RSN_5GSCANSTART: - case COEX_RSN_5GSWITCHBAND: -@@ -460,8 +618,10 @@ void rtw_coex_info_response(struct rtw_dev *rtwdev, struct sk_buff *skb) - struct rtw_coex *coex = &rtwdev->coex; - u8 *payload = get_payload_from_coex_resp(skb); - -- if (payload[0] != COEX_RESP_ACK_BY_WL_FW) -+ if (payload[0] != COEX_RESP_ACK_BY_WL_FW) { -+ dev_kfree_skb_any(skb); - return; -+ } - - skb_queue_tail(&coex->queue, skb); - wake_up(&coex->wait); -@@ -473,7 +633,7 @@ static struct sk_buff *rtw_coex_info_request(struct rtw_dev *rtwdev, - struct rtw_coex *coex = &rtwdev->coex; - struct sk_buff *skb_resp = NULL; - -- mutex_lock(&coex->mutex); -+ lockdep_assert_held(&rtwdev->mutex); - - rtw_fw_query_bt_mp_info(rtwdev, req); - -@@ -490,7 +650,6 @@ static struct sk_buff *rtw_coex_info_request(struct rtw_dev *rtwdev, - } - - out: -- mutex_unlock(&coex->mutex); - return skb_resp; - } - -@@ -499,20 +658,16 @@ static bool rtw_coex_get_bt_scan_type(struct rtw_dev *rtwdev, u8 *scan_type) - struct rtw_coex_info_req req = {0}; - struct sk_buff *skb; - u8 *payload; -- bool ret = false; - - req.op_code = BT_MP_INFO_OP_SCAN_TYPE; - skb = rtw_coex_info_request(rtwdev, &req); - if (!skb) -- goto out; -+ return false; - - payload = get_payload_from_coex_resp(skb); - *scan_type = GET_COEX_RESP_BT_SCAN_TYPE(payload); - dev_kfree_skb_any(skb); -- ret = true; -- --out: -- return ret; -+ return true; - } - - static bool rtw_coex_set_lna_constrain_level(struct rtw_dev *rtwdev, -@@ -520,27 +675,40 @@ static bool rtw_coex_set_lna_constrain_level(struct rtw_dev *rtwdev, - { - struct rtw_coex_info_req req = {0}; - struct sk_buff *skb; -- bool ret = false; - - req.op_code = BT_MP_INFO_OP_LNA_CONSTRAINT; - req.para1 = lna_constrain_level; - skb = rtw_coex_info_request(rtwdev, &req); - if (!skb) -- goto out; -+ return false; - - dev_kfree_skb_any(skb); -- ret = true; -+ return true; -+} - --out: -- return ret; -+#define case_BTSTATUS(src) \ -+ case COEX_BTSTATUS_##src: return #src -+ -+static const char *rtw_coex_get_bt_status_string(u8 bt_status) -+{ -+ switch (bt_status) { -+ case_BTSTATUS(NCON_IDLE); -+ case_BTSTATUS(CON_IDLE); -+ case_BTSTATUS(INQ_PAGE); -+ case_BTSTATUS(ACL_BUSY); -+ case_BTSTATUS(SCO_BUSY); -+ case_BTSTATUS(ACL_SCO_BUSY); -+ default: -+ return "Unknown"; -+ } - } - - static void rtw_coex_update_bt_link_info(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_coex_dm *coex_dm = &coex->dm; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 i; - u8 rssi_state; - u8 rssi_step; -@@ -551,20 +719,11 @@ static void rtw_coex_update_bt_link_info(struct rtw_dev *rtwdev) - rssi_state = coex_dm->bt_rssi_state[i]; - rssi_step = chip->bt_rssi_step[i]; - rssi = coex_stat->bt_rssi; -- rssi_state = rtw_coex_next_rssi_state(rtwdev, rssi_state, -- rssi, rssi_step); -+ rssi_state = rtw_coex_next_rssi_state(rtwdev, rssi_state, rssi, -+ rssi_step); - coex_dm->bt_rssi_state[i] = rssi_state; - } - -- for (i = 0; i < COEX_RSSI_STEP; i++) { -- rssi_state = coex_dm->wl_rssi_state[i]; -- rssi_step = chip->wl_rssi_step[i]; -- rssi = rtwdev->dm_info.min_rssi; -- rssi_state = rtw_coex_next_rssi_state(rtwdev, rssi_state, -- rssi, rssi_step); -- coex_dm->wl_rssi_state[i] = rssi_state; -- } -- - if (coex_stat->bt_ble_scan_en && - coex_stat->cnt_bt[COEX_CNT_BT_INFOUPDATE] % 3 == 0) { - u8 scan_type; -@@ -623,6 +782,7 @@ static void rtw_coex_update_bt_link_info(struct rtw_dev *rtwdev) - coex_dm->bt_status = COEX_BTSTATUS_INQ_PAGE; - } else if (!(coex_stat->bt_info_lb2 & COEX_INFO_CONNECTION)) { - coex_dm->bt_status = COEX_BTSTATUS_NCON_IDLE; -+ coex_stat->bt_multi_link_remain = false; - } else if (coex_stat->bt_info_lb2 == COEX_INFO_CONNECTION) { - coex_dm->bt_status = COEX_BTSTATUS_CON_IDLE; - } else if ((coex_stat->bt_info_lb2 & COEX_INFO_SCO_ESCO) || -@@ -639,14 +799,16 @@ static void rtw_coex_update_bt_link_info(struct rtw_dev *rtwdev) - - coex_stat->cnt_bt[COEX_CNT_BT_INFOUPDATE]++; - -- rtw_dbg(rtwdev, RTW_DBG_COEX, "coex: bt status(%d)\n", coex_dm->bt_status); -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(), %s!!!\n", __func__, -+ rtw_coex_get_bt_status_string(coex_dm->bt_status)); - } - - static void rtw_coex_update_wl_ch_info(struct rtw_dev *rtwdev, u8 type) - { -- struct rtw_chip_info *chip = rtwdev->chip; -- struct rtw_coex_dm *coex_dm = &rtwdev->coex.dm; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; -+ struct rtw_coex_dm *coex_dm = &rtwdev->coex.dm; -+ struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; - u8 link = 0; - u8 center_chan = 0; - u8 bw; -@@ -657,8 +819,12 @@ static void rtw_coex_update_wl_ch_info(struct rtw_dev *rtwdev, u8 type) - if (type != COEX_MEDIA_DISCONNECT) - center_chan = rtwdev->hal.current_channel; - -- if (center_chan == 0 || (efuse->share_ant && center_chan <= 14)) { -+ if (center_chan == 0 || -+ (efuse->share_ant && center_chan <= 14 && -+ coex_stat->wl_coex_mode != COEX_WLINK_2GFREE)) { - link = 0; -+ center_chan = 0; -+ bw = 0; - } else if (center_chan <= 14) { - link = 0x1; - -@@ -682,6 +848,9 @@ static void rtw_coex_update_wl_ch_info(struct rtw_dev *rtwdev, u8 type) - coex_dm->wl_ch_info[2] = bw; - - rtw_fw_wl_ch_info(rtwdev, link, center_chan, bw); -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s: para[0:2] = 0x%x 0x%x 0x%x\n", __func__, link, -+ center_chan, bw); - } - - static void rtw_coex_set_bt_tx_power(struct rtw_dev *rtwdev, u8 bt_pwr_dec_lvl) -@@ -714,6 +883,8 @@ static void rtw_coex_set_bt_rx_gain(struct rtw_dev *rtwdev, u8 bt_lna_lvl) - } else { - rtw_coex_write_scbd(rtwdev, COEX_SCBD_RXGAIN, false); - } -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): bt_rx_LNA_level = %d\n", -+ __func__, bt_lna_lvl); - } - - static void rtw_coex_set_rf_para(struct rtw_dev *rtwdev, -@@ -723,7 +894,7 @@ static void rtw_coex_set_rf_para(struct rtw_dev *rtwdev, - struct rtw_coex_stat *coex_stat = &coex->stat; - u8 offset = 0; - -- if (coex->freerun && coex_stat->wl_noisy_level <= 1) -+ if (coex->freerun && coex_stat->cnt_wl[COEX_CNT_WL_SCANAP] <= 5) - offset = 3; - - rtw_coex_set_wl_tx_power(rtwdev, para.wl_pwr_dec_lvl); -@@ -761,15 +932,17 @@ EXPORT_SYMBOL(rtw_coex_write_indirect_reg); - - static void rtw_coex_coex_ctrl_owner(struct rtw_dev *rtwdev, bool wifi_control) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - const struct rtw_hw_reg *btg_reg = chip->btg_reg; - - if (wifi_control) { -- rtw_write32_set(rtwdev, REG_SYS_SDIO_CTRL, BIT_LTE_MUX_CTRL_PATH); -+ rtw_write8_set(rtwdev, REG_SYS_SDIO_CTRL + 3, -+ BIT_LTE_MUX_CTRL_PATH >> 24); - if (btg_reg) - rtw_write8_set(rtwdev, btg_reg->addr, btg_reg->mask); - } else { -- rtw_write32_clr(rtwdev, REG_SYS_SDIO_CTRL, BIT_LTE_MUX_CTRL_PATH); -+ rtw_write8_clr(rtwdev, REG_SYS_SDIO_CTRL + 3, -+ BIT_LTE_MUX_CTRL_PATH >> 24); - if (btg_reg) - rtw_write8_clr(rtwdev, btg_reg->addr, btg_reg->mask); - } -@@ -777,52 +950,151 @@ static void rtw_coex_coex_ctrl_owner(struct rtw_dev *rtwdev, bool wifi_control) - - static void rtw_coex_set_gnt_bt(struct rtw_dev *rtwdev, u8 state) - { -- rtw_coex_write_indirect_reg(rtwdev, 0x38, 0xc000, state); -- rtw_coex_write_indirect_reg(rtwdev, 0x38, 0x0c00, state); -+ rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, 0xc000, state); -+ rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, 0x0c00, state); - } - - static void rtw_coex_set_gnt_wl(struct rtw_dev *rtwdev, u8 state) - { -- rtw_coex_write_indirect_reg(rtwdev, 0x38, 0x3000, state); -- rtw_coex_write_indirect_reg(rtwdev, 0x38, 0x0300, state); -+ rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, 0x3000, state); -+ rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, 0x0300, state); -+} -+ -+static void rtw_coex_mimo_ps(struct rtw_dev *rtwdev, bool force, bool state) -+{ -+ struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; -+ -+ if (!force && state == coex_stat->wl_mimo_ps) -+ return; -+ -+ coex_stat->wl_mimo_ps = state; -+ -+ rtw_set_txrx_1ss(rtwdev, state); -+ -+ rtw_coex_update_wl_ch_info(rtwdev, (u8)coex_stat->wl_connected); -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s(): state = %d\n", __func__, state); - } - --static void rtw_coex_set_table(struct rtw_dev *rtwdev, u32 table0, u32 table1) -+static void rtw_btc_wltoggle_table_a(struct rtw_dev *rtwdev, bool force, -+ u8 table_case) - { --#define DEF_BRK_TABLE_VAL 0xf0ffffff -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_efuse *efuse = &rtwdev->efuse; -+ u8 h2c_para[6] = {0}; -+ u32 table_wl = 0x5a5a5a5a; -+ -+ h2c_para[0] = COEX_H2C69_TOGGLE_TABLE_A; -+ /* no definition */ -+ h2c_para[1] = 0x1; -+ -+ if (efuse->share_ant) { -+ if (table_case < chip->table_sant_num) -+ table_wl = chip->table_sant[table_case].wl; -+ } else { -+ if (table_case < chip->table_nsant_num) -+ table_wl = chip->table_nsant[table_case].wl; -+ } -+ -+ /* tell WL FW WL slot toggle table-A*/ -+ h2c_para[2] = (u8)u32_get_bits(table_wl, GENMASK(7, 0)); -+ h2c_para[3] = (u8)u32_get_bits(table_wl, GENMASK(15, 8)); -+ h2c_para[4] = (u8)u32_get_bits(table_wl, GENMASK(23, 16)); -+ h2c_para[5] = (u8)u32_get_bits(table_wl, GENMASK(31, 24)); -+ -+ rtw_fw_bt_wifi_control(rtwdev, h2c_para[0], &h2c_para[1]); -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s(): H2C = [%02x %02x %02x %02x %02x %02x]\n", -+ __func__, h2c_para[0], h2c_para[1], h2c_para[2], -+ h2c_para[3], h2c_para[4], h2c_para[5]); -+} -+ -+#define COEX_WL_SLOT_TOGLLE 0x5a5a5aaa -+static void rtw_btc_wltoggle_table_b(struct rtw_dev *rtwdev, bool force, -+ u8 interval, u32 table) -+{ -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_stat *coex_stat = &coex->stat; -+ u8 cur_h2c_para[6] = {0}; -+ u8 i; -+ -+ cur_h2c_para[0] = COEX_H2C69_TOGGLE_TABLE_B; -+ cur_h2c_para[1] = interval; -+ cur_h2c_para[2] = (u8)u32_get_bits(table, GENMASK(7, 0)); -+ cur_h2c_para[3] = (u8)u32_get_bits(table, GENMASK(15, 8)); -+ cur_h2c_para[4] = (u8)u32_get_bits(table, GENMASK(23, 16)); -+ cur_h2c_para[5] = (u8)u32_get_bits(table, GENMASK(31, 24)); -+ -+ coex_stat->wl_toggle_interval = interval; -+ -+ for (i = 0; i <= 5; i++) -+ coex_stat->wl_toggle_para[i] = cur_h2c_para[i]; -+ -+ rtw_fw_bt_wifi_control(rtwdev, cur_h2c_para[0], &cur_h2c_para[1]); -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s(): H2C = [%02x %02x %02x %02x %02x %02x]\n", -+ __func__, cur_h2c_para[0], cur_h2c_para[1], cur_h2c_para[2], -+ cur_h2c_para[3], cur_h2c_para[4], cur_h2c_para[5]); -+} -+ -+static void rtw_coex_set_table(struct rtw_dev *rtwdev, bool force, u32 table0, -+ u32 table1) -+{ -+#define DEF_BRK_TABLE_VAL 0xf0ffffff -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_dm *coex_dm = &coex->dm; -+ -+ /* If last tdma is wl slot toggle, force write table*/ -+ if (!force && coex_dm->reason != COEX_RSN_LPS) { -+ if (table0 == rtw_read32(rtwdev, REG_BT_COEX_TABLE0) && -+ table1 == rtw_read32(rtwdev, REG_BT_COEX_TABLE1)) -+ return; -+ } - rtw_write32(rtwdev, REG_BT_COEX_TABLE0, table0); - rtw_write32(rtwdev, REG_BT_COEX_TABLE1, table1); - rtw_write32(rtwdev, REG_BT_COEX_BRK_TABLE, DEF_BRK_TABLE_VAL); -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s(): 0x6c0 = %x, 0x6c4 = %x\n", __func__, table0, -+ table1); - } - --static void rtw_coex_table(struct rtw_dev *rtwdev, u8 type) -+static void rtw_coex_table(struct rtw_dev *rtwdev, bool force, u8 type) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_dm *coex_dm = &coex->dm; -- struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; -+ struct rtw_coex_stat *coex_stat = &coex->stat; - - coex_dm->cur_table = type; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], Coex_Table - %d\n", type); -+ - if (efuse->share_ant) { - if (type < chip->table_sant_num) -- rtw_coex_set_table(rtwdev, -+ rtw_coex_set_table(rtwdev, force, - chip->table_sant[type].bt, - chip->table_sant[type].wl); - } else { - type = type - 100; - if (type < chip->table_nsant_num) -- rtw_coex_set_table(rtwdev, -+ rtw_coex_set_table(rtwdev, force, - chip->table_nsant[type].bt, - chip->table_nsant[type].wl); - } -+ if (coex_stat->wl_slot_toggle_change) -+ rtw_btc_wltoggle_table_a(rtwdev, true, type); - } - - static void rtw_coex_ignore_wlan_act(struct rtw_dev *rtwdev, bool enable) - { - struct rtw_coex *coex = &rtwdev->coex; - -- if (coex->stop_dm) -+ if (coex->manual_control || coex->stop_dm) - return; - - rtw_fw_bt_ignore_wlan_action(rtwdev, enable); -@@ -841,15 +1113,18 @@ static void rtw_coex_power_save_state(struct rtw_dev *rtwdev, u8 ps_type, - case COEX_PS_WIFI_NATIVE: - /* recover to original 32k low power setting */ - coex_stat->wl_force_lps_ctrl = false; -- -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s(): COEX_PS_WIFI_NATIVE\n", __func__); - rtw_leave_lps(rtwdev); - break; - case COEX_PS_LPS_OFF: - coex_stat->wl_force_lps_ctrl = true; - if (lps_mode) -- rtw_fw_coex_tdma_type(rtwdev, 0x8, 0, 0, 0, 0); -+ rtw_fw_coex_tdma_type(rtwdev, 0, 0, 0, 0, 0); - - rtw_leave_lps(rtwdev); -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s(): COEX_PS_LPS_OFF\n", __func__); - break; - default: - break; -@@ -859,13 +1134,17 @@ static void rtw_coex_power_save_state(struct rtw_dev *rtwdev, u8 ps_type, - static void rtw_coex_set_tdma(struct rtw_dev *rtwdev, u8 byte1, u8 byte2, - u8 byte3, u8 byte4, u8 byte5) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_dm *coex_dm = &coex->dm; -- struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_coex_stat *coex_stat = &coex->stat; - u8 ps_type = COEX_PS_WIFI_NATIVE; - bool ap_enable = false; - - if (ap_enable && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): AP mode\n", -+ __func__); -+ - byte1 &= ~BIT(4); - byte1 |= BIT(5); - -@@ -874,13 +1153,22 @@ static void rtw_coex_set_tdma(struct rtw_dev *rtwdev, u8 byte1, u8 byte2, - - ps_type = COEX_PS_WIFI_NATIVE; - rtw_coex_power_save_state(rtwdev, ps_type, 0x0, 0x0); -- } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ } else if ((byte1 & BIT(4) && !(byte1 & BIT(5))) || -+ coex_stat->wl_coex_mode == COEX_WLINK_2GFREE) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s(): Force LPS (byte1 = 0x%x)\n", __func__, -+ byte1); -+ - if (chip->pstdma_type == COEX_PSTDMA_FORCE_LPSOFF) - ps_type = COEX_PS_LPS_OFF; - else - ps_type = COEX_PS_LPS_ON; - rtw_coex_power_save_state(rtwdev, ps_type, 0x50, 0x4); - } else { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s(): native power save (byte1 = 0x%x)\n", -+ __func__, byte1); -+ - ps_type = COEX_PS_WIFI_NATIVE; - rtw_coex_power_save_state(rtwdev, ps_type, 0x0, 0x0); - } -@@ -892,39 +1180,45 @@ static void rtw_coex_set_tdma(struct rtw_dev *rtwdev, u8 byte1, u8 byte2, - coex_dm->ps_tdma_para[4] = byte5; - - rtw_fw_coex_tdma_type(rtwdev, byte1, byte2, byte3, byte4, byte5); -+ -+ if (byte1 & BIT(2)) { -+ coex_stat->wl_slot_toggle = true; -+ coex_stat->wl_slot_toggle_change = false; -+ } else { -+ coex_stat->wl_slot_toggle_change = coex_stat->wl_slot_toggle; -+ coex_stat->wl_slot_toggle = false; -+ } - } - - static void rtw_coex_tdma(struct rtw_dev *rtwdev, bool force, u32 tcase) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_dm *coex_dm = &coex->dm; - struct rtw_coex_stat *coex_stat = &coex->stat; -- struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; - u8 n, type; - bool turn_on; - bool wl_busy = false; - -- if (tcase & TDMA_4SLOT)/* 4-slot (50ms) mode */ -- rtw_coex_tdma_timer_base(rtwdev, 3); -+ if (tcase & TDMA_4SLOT) /* 4-slot (50ms) mode */ -+ rtw_coex_tdma_timer_base(rtwdev, TDMA_TIMER_TYPE_4SLOT); - else -- rtw_coex_tdma_timer_base(rtwdev, 0); -+ rtw_coex_tdma_timer_base(rtwdev, TDMA_TIMER_TYPE_2SLOT); - - type = (u8)(tcase & 0xff); - - turn_on = (type == 0 || type == 100) ? false : true; - -- if (!force) { -- if (turn_on == coex_dm->cur_ps_tdma_on && -- type == coex_dm->cur_ps_tdma) { -- return; -- } -- } -- -- /* enable TBTT interrupt */ -- if (turn_on) -- rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); -+ if (!force && turn_on == coex_dm->cur_ps_tdma_on && -+ type == coex_dm->cur_ps_tdma) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], Skip TDMA because no change TDMA(%s, %d)\n", -+ (coex_dm->cur_ps_tdma_on ? "on" : "off"), -+ coex_dm->cur_ps_tdma); - -+ return; -+ } - wl_busy = test_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags); - - if ((coex_stat->bt_a2dp_exist && -@@ -934,6 +1228,10 @@ static void rtw_coex_tdma(struct rtw_dev *rtwdev, bool force, u32 tcase) - else - rtw_coex_write_scbd(rtwdev, COEX_SCBD_TDMA, true); - -+ /* update pre state */ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ - if (efuse->share_ant) { - if (type < chip->tdma_sant_num) - rtw_coex_set_tdma(rtwdev, -@@ -953,17 +1251,16 @@ static void rtw_coex_tdma(struct rtw_dev *rtwdev, bool force, u32 tcase) - chip->tdma_nsant[n].para[4]); - } - -- /* update pre state */ -- coex_dm->cur_ps_tdma_on = turn_on; -- coex_dm->cur_ps_tdma = type; - -- rtw_dbg(rtwdev, RTW_DBG_COEX, "coex: coex tdma type (%d)\n", type); -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], coex tdma type(%s, %d)\n", -+ turn_on ? "on" : "off", type); - } - - static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) - { - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; -+ struct rtw_coex_rfe *coex_rfe = &coex->rfe; - struct rtw_coex_dm *coex_dm = &coex->dm; - u8 ctrl_type = COEX_SWITCH_CTRL_MAX; - u8 pos_type = COEX_SWITCH_TO_MAX; -@@ -976,8 +1273,14 @@ static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) - /* avoid switch coex_ctrl_owner during BT IQK */ - rtw_coex_check_rfk(rtwdev); - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], coex_stat->bt_disabled = 0x%x\n", -+ coex_stat->bt_disabled); -+ - switch (phase) { - case COEX_SET_ANT_POWERON: -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s() - PHASE_COEX_POWERON\n", __func__); - /* set path control owner to BT at power-on */ - if (coex_stat->bt_disabled) - rtw_coex_coex_ctrl_owner(rtwdev, true); -@@ -988,6 +1291,8 @@ static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) - pos_type = COEX_SWITCH_TO_BT; - break; - case COEX_SET_ANT_INIT: -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s() - PHASE_COEX_INIT\n", __func__); - if (coex_stat->bt_disabled) { - /* set GNT_BT to SW low */ - rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_LOW); -@@ -1009,10 +1314,12 @@ static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) - pos_type = COEX_SWITCH_TO_BT; - break; - case COEX_SET_ANT_WONLY: -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s() - PHASE_WLANONLY_INIT\n", __func__); - /* set GNT_BT to SW Low */ - rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_LOW); - -- /* Set GNT_WL to SW high */ -+ /* set GNT_WL to SW high */ - rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); - - /* set path control owner to wl at initial step */ -@@ -1022,6 +1329,8 @@ static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) - pos_type = COEX_SWITCH_TO_WLG; - break; - case COEX_SET_ANT_WOFF: -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s() - PHASE_WLAN_OFF\n", __func__); - /* set path control owner to BT */ - rtw_coex_coex_ctrl_owner(rtwdev, false); - -@@ -1029,6 +1338,8 @@ static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) - pos_type = COEX_SWITCH_TO_NOCARE; - break; - case COEX_SET_ANT_2G: -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s() - PHASE_2G_RUNTIME\n", __func__); - /* set GNT_BT to PTA */ - rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_HW_PTA); - -@@ -1042,8 +1353,11 @@ static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) - pos_type = COEX_SWITCH_TO_NOCARE; - break; - case COEX_SET_ANT_5G: -- /* set GNT_BT to PTA */ -- rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_HIGH); -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s() - PHASE_5G_RUNTIME\n", __func__); -+ -+ /* set GNT_BT to HW PTA */ -+ rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_HW_PTA); - - /* set GNT_WL to SW high */ - rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); -@@ -1055,8 +1369,11 @@ static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) - pos_type = COEX_SWITCH_TO_WLA; - break; - case COEX_SET_ANT_2G_FREERUN: -- /* set GNT_BT to SW high */ -- rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_HIGH); -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s() - PHASE_2G_FREERUN\n", __func__); -+ -+ /* set GNT_BT to HW PTA */ -+ rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_HW_PTA); - - /* Set GNT_WL to SW high */ - rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); -@@ -1068,10 +1385,12 @@ static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) - pos_type = COEX_SWITCH_TO_WLG_BT; - break; - case COEX_SET_ANT_2G_WLBT: -- /* set GNT_BT to SW high */ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s() - PHASE_2G_WLBT\n", __func__); -+ /* set GNT_BT to HW PTA */ - rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_HW_PTA); - -- /* Set GNT_WL to SW high */ -+ /* Set GNT_WL to HW PTA */ - rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_HW_PTA); - - /* set path control owner to wl at runtime step */ -@@ -1085,10 +1404,58 @@ static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) - return; - } - -- if (ctrl_type < COEX_SWITCH_CTRL_MAX && pos_type < COEX_SWITCH_TO_MAX) -+ if (ctrl_type < COEX_SWITCH_CTRL_MAX && pos_type < COEX_SWITCH_TO_MAX && -+ coex_rfe->ant_switch_exist) - rtw_coex_set_ant_switch(rtwdev, ctrl_type, pos_type); - } - -+#define case_ALGO(src) \ -+ case COEX_ALGO_##src: return #src -+ -+static const char *rtw_coex_get_algo_string(u8 algo) -+{ -+ switch (algo) { -+ case_ALGO(NOPROFILE); -+ case_ALGO(HFP); -+ case_ALGO(HID); -+ case_ALGO(A2DP); -+ case_ALGO(PAN); -+ case_ALGO(A2DP_HID); -+ case_ALGO(A2DP_PAN); -+ case_ALGO(PAN_HID); -+ case_ALGO(A2DP_PAN_HID); -+ default: -+ return "Unknown"; -+ } -+} -+ -+#define case_BT_PROFILE(src) \ -+ case BPM_##src: return #src -+ -+static const char *rtw_coex_get_bt_profile_string(u8 bt_profile) -+{ -+ switch (bt_profile) { -+ case_BT_PROFILE(NOPROFILE); -+ case_BT_PROFILE(HFP); -+ case_BT_PROFILE(HID); -+ case_BT_PROFILE(A2DP); -+ case_BT_PROFILE(PAN); -+ case_BT_PROFILE(HID_HFP); -+ case_BT_PROFILE(A2DP_HFP); -+ case_BT_PROFILE(A2DP_HID); -+ case_BT_PROFILE(A2DP_HID_HFP); -+ case_BT_PROFILE(PAN_HFP); -+ case_BT_PROFILE(PAN_HID); -+ case_BT_PROFILE(PAN_HID_HFP); -+ case_BT_PROFILE(PAN_A2DP); -+ case_BT_PROFILE(PAN_A2DP_HFP); -+ case_BT_PROFILE(PAN_A2DP_HID); -+ case_BT_PROFILE(PAN_A2DP_HID_HFP); -+ default: -+ return "Unknown"; -+ } -+} -+ - static u8 rtw_coex_algorithm(struct rtw_dev *rtwdev) - { - struct rtw_coex *coex = &rtwdev->coex; -@@ -1149,15 +1516,22 @@ static u8 rtw_coex_algorithm(struct rtw_dev *rtwdev) - break; - } - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], BT Profile = %s => Algorithm = %s\n", -+ rtw_coex_get_bt_profile_string(profile_map), -+ rtw_coex_get_algo_string(algorithm)); - return algorithm; - } - - static void rtw_coex_action_coex_all_off(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (efuse->share_ant) { - /* Shared-Ant */ - table_case = 2; -@@ -1168,26 +1542,28 @@ static void rtw_coex_action_coex_all_off(struct rtw_dev *rtwdev) - tdma_case = 100; - } - -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_freerun(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_coex_dm *coex_dm = &coex->dm; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 level = 0; -+ bool bt_afh_loss = true; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); - - if (efuse->share_ant) - return; - - coex->freerun = true; - -- if (coex_stat->wl_connected) -+ if (bt_afh_loss) - rtw_coex_update_wl_ch_info(rtwdev, COEX_MEDIA_CONNECT); - - rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G_FREERUN); -@@ -1211,41 +1587,49 @@ static void rtw_coex_action_freerun(struct rtw_dev *rtwdev) - else - rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[level]); - -- rtw_coex_table(rtwdev, 100); -+ rtw_coex_table(rtwdev, false, 100); - rtw_coex_tdma(rtwdev, false, 100); - } - --static void rtw_coex_action_bt_whql_test(struct rtw_dev *rtwdev) -+static void rtw_coex_action_rf4ce(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (efuse->share_ant) { - /* Shared-Ant */ -- table_case = 2; -- tdma_case = 0; -+ table_case = 9; -+ tdma_case = 16; - } else { - /* Non-Shared-Ant */ - table_case = 100; - tdma_case = 100; - } - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - --static void rtw_coex_action_bt_relink(struct rtw_dev *rtwdev) -+static void rtw_coex_action_bt_whql_test(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (efuse->share_ant) { - /* Shared-Ant */ -- table_case = 1; -+ table_case = 2; - tdma_case = 0; - } else { - /* Non-Shared-Ant */ -@@ -1253,26 +1637,68 @@ static void rtw_coex_action_bt_relink(struct rtw_dev *rtwdev) - tdma_case = 100; - } - -+ rtw_coex_table(rtwdev, false, table_case); -+ rtw_coex_tdma(rtwdev, false, tdma_case); -+} -+ -+static void rtw_coex_action_bt_relink(struct rtw_dev *rtwdev) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_stat *coex_stat = &coex->stat; -+ struct rtw_efuse *efuse = &rtwdev->efuse; -+ u8 table_case, tdma_case; -+ u32 slot_type = 0; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ - rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); - rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -- rtw_coex_tdma(rtwdev, false, tdma_case); -+ -+ if (efuse->share_ant) { /* Shared-Ant */ -+ if (coex_stat->wl_gl_busy) { -+ table_case = 26; -+ if (coex_stat->bt_hid_exist && -+ coex_stat->bt_profile_num == 1) { -+ slot_type = TDMA_4SLOT; -+ tdma_case = 20; -+ } else { -+ tdma_case = 20; -+ } -+ } else { -+ table_case = 1; -+ tdma_case = 0; -+ } -+ } else { /* Non-Shared-Ant */ -+ if (coex_stat->wl_gl_busy) -+ table_case = 115; -+ else -+ table_case = 100; -+ tdma_case = 100; -+ } -+ -+ rtw_coex_table(rtwdev, false, table_case); -+ rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); - } - - static void rtw_coex_action_bt_idle(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_coex_dm *coex_dm = &coex->dm; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex_rfe *coex_rfe = &coex->rfe; - u8 table_case = 0xff, tdma_case = 0xff; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (coex_rfe->ant_switch_with_bt && - coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { - if (efuse->share_ant && -- COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1])) { -+ COEX_RSSI_HIGH(coex_dm->wl_rssi_state[3]) && -+ coex_stat->wl_gl_busy) { - table_case = 0; - tdma_case = 0; - } else if (!efuse->share_ant) { -@@ -1283,9 +1709,7 @@ static void rtw_coex_action_bt_idle(struct rtw_dev *rtwdev) - - if (table_case != 0xff && tdma_case != 0xff) { - rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G_FREERUN); -- rtw_coex_table(rtwdev, table_case); -- rtw_coex_tdma(rtwdev, false, tdma_case); -- return; -+ goto exit; - } - - rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -@@ -1296,8 +1720,12 @@ static void rtw_coex_action_bt_idle(struct rtw_dev *rtwdev) - table_case = 10; - tdma_case = 3; - } else if (coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { -- table_case = 6; -- tdma_case = 7; -+ table_case = 11; -+ -+ if (coex_stat->lo_pri_rx + coex_stat->lo_pri_tx > 250) -+ tdma_case = 17; -+ else -+ tdma_case = 7; - } else { - table_case = 12; - tdma_case = 7; -@@ -1308,7 +1736,7 @@ static void rtw_coex_action_bt_idle(struct rtw_dev *rtwdev) - table_case = 112; - tdma_case = 104; - } else if ((coex_stat->bt_ble_scan_type & 0x2) && -- coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { -+ coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { - table_case = 114; - tdma_case = 103; - } else { -@@ -1317,21 +1745,25 @@ static void rtw_coex_action_bt_idle(struct rtw_dev *rtwdev) - } - } - -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+exit: -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_bt_inquiry(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - bool wl_hi_pri = false; - u8 table_case, tdma_case; - u32 slot_type = 0; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (coex_stat->wl_linkscan_proc || coex_stat->wl_hi_pri_task1 || - coex_stat->wl_hi_pri_task2) - wl_hi_pri = true; -@@ -1339,7 +1771,10 @@ static void rtw_coex_action_bt_inquiry(struct rtw_dev *rtwdev) - if (efuse->share_ant) { - /* Shared-Ant */ - if (wl_hi_pri) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], bt inq/page + wifi hi-pri task\n"); - table_case = 15; -+ - if (coex_stat->bt_profile_num > 0) - tdma_case = 10; - else if (coex_stat->wl_hi_pri_task1) -@@ -1349,6 +1784,8 @@ static void rtw_coex_action_bt_inquiry(struct rtw_dev *rtwdev) - else - tdma_case = 9; - } else if (coex_stat->wl_gl_busy) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], bt inq/page + wifi busy\n"); - if (coex_stat->bt_profile_num == 0) { - table_case = 12; - tdma_case = 18; -@@ -1363,63 +1800,120 @@ static void rtw_coex_action_bt_inquiry(struct rtw_dev *rtwdev) - tdma_case = 26; - } - } else if (coex_stat->wl_connected) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], bt inq/page + wifi connected\n"); - table_case = 9; - tdma_case = 27; - } else { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], bt inq/page + wifi not-connected\n"); - table_case = 1; - tdma_case = 0; - } - } else { - /* Non_Shared-Ant */ - if (wl_hi_pri) { -- table_case = 113; -- if (coex_stat->bt_a2dp_exist && -- !coex_stat->bt_pan_exist) -- tdma_case = 111; -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], bt inq/page + wifi hi-pri task\n"); -+ table_case = 114; -+ -+ if (coex_stat->bt_profile_num > 0) -+ tdma_case = 110; - else if (coex_stat->wl_hi_pri_task1) - tdma_case = 106; - else if (!coex_stat->bt_page) - tdma_case = 108; - else - tdma_case = 109; -- } else if (coex_stat->wl_gl_busy) { -+ } else if (coex_stat->wl_gl_busy) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], bt inq/page + wifi busy\n"); - table_case = 114; - tdma_case = 121; - } else if (coex_stat->wl_connected) { -- table_case = 100; -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], bt inq/page + wifi connected\n"); -+ table_case = 101; - tdma_case = 100; - } else { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], bt inq/page + wifi not-connected\n"); - table_case = 101; - tdma_case = 100; - } - } - -- rtw_dbg(rtwdev, RTW_DBG_COEX, "coex: wifi hi(%d), bt page(%d)\n", -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], wifi hi(%d), bt page(%d)\n", - wl_hi_pri, coex_stat->bt_page); - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); - } - -+static void rtw_coex_action_bt_game_hid(struct rtw_dev *rtwdev) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_stat *coex_stat = &coex->stat; -+ struct rtw_efuse *efuse = &rtwdev->efuse; -+ struct rtw_coex_dm *coex_dm = &coex->dm; -+ u8 table_case, tdma_case; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ -+ if (efuse->share_ant) { -+ coex_stat->wl_coex_mode = COEX_WLINK_2GFREE; -+ if (coex_stat->bt_whck_test) -+ table_case = 2; -+ else if (coex_stat->wl_linkscan_proc || coex_stat->bt_hid_exist) -+ table_case = 33; -+ else if (coex_stat->bt_setup_link || coex_stat->bt_inq_page) -+ table_case = 0; -+ else if (coex_stat->bt_a2dp_exist) -+ table_case = 34; -+ else -+ table_case = 33; -+ -+ tdma_case = 0; -+ } else { -+ if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1])) -+ tdma_case = 112; -+ else -+ tdma_case = 113; -+ -+ table_case = 121; -+ } -+ -+ if (coex_stat->wl_coex_mode == COEX_WLINK_2GFREE) { -+ if (coex_stat->wl_tput_dir == COEX_WL_TPUT_TX) -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_tx[6]); -+ else -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[5]); -+ } else { -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ } -+ -+ rtw_coex_table(rtwdev, false, table_case); -+ rtw_coex_tdma(rtwdev, false, tdma_case); -+} -+ - static void rtw_coex_action_bt_hfp(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (efuse->share_ant) { - /* Shared-Ant */ -- if (coex_stat->bt_multi_link) { -- table_case = 10; -- tdma_case = 17; -- } else { -- table_case = 10; -- tdma_case = 5; -- } -+ table_case = 10; -+ tdma_case = 5; - } else { - /* Non-Shared-Ant */ - if (coex_stat->bt_multi_link) { -@@ -1431,100 +1925,121 @@ static void rtw_coex_action_bt_hfp(struct rtw_dev *rtwdev) - } - } - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_bt_hid(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; -- u32 wl_bw; -+ u32 slot_type = 0; -+ bool bt_multi_link_remain = false, is_toggle_table = false; - -- wl_bw = rtwdev->hal.current_band_width; -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); - - if (efuse->share_ant) { - /* Shared-Ant */ - if (coex_stat->bt_ble_exist) { - /* RCU */ -- if (!coex_stat->wl_gl_busy) -- table_case = 14; -- else -- table_case = 15; -- -- if (coex_stat->bt_a2dp_active || wl_bw == 0) -- tdma_case = 18; -- else if (coex_stat->wl_gl_busy) -- tdma_case = 8; -- else -- tdma_case = 4; -+ if (coex_stat->cnt_wl[COEX_CNT_WL_SCANAP] > 5) { -+ table_case = 26; -+ tdma_case = 2; -+ } else { -+ table_case = 27; -+ tdma_case = 9; -+ } - } else { -- if (coex_stat->bt_a2dp_active || wl_bw == 0) { -- table_case = 8; -- tdma_case = 4; -+ /* Legacy HID */ -+ if (coex_stat->bt_profile_num == 1 && -+ (coex_stat->bt_multi_link || -+ (coex_stat->lo_pri_rx + -+ coex_stat->lo_pri_tx > 360) || -+ coex_stat->bt_slave || -+ bt_multi_link_remain)) { -+ slot_type = TDMA_4SLOT; -+ table_case = 12; -+ tdma_case = 20; -+ } else if (coex_stat->bt_a2dp_active) { -+ table_case = 9; -+ tdma_case = 18; -+ } else if (coex_stat->bt_418_hid_exist && -+ coex_stat->wl_gl_busy) { -+ is_toggle_table = true; -+ slot_type = TDMA_4SLOT; -+ table_case = 9; -+ tdma_case = 24; -+ } else if (coex_stat->bt_ble_hid_exist && -+ coex_stat->wl_gl_busy) { -+ table_case = 32; -+ tdma_case = 9; - } else { -- /* for 4/18 HID */ -- if (coex_stat->bt_418_hid_exist && -- coex_stat->wl_gl_busy) -- table_case = 12; -- else -- table_case = 10; -- tdma_case = 4; -+ table_case = 9; -+ tdma_case = 9; - } - } - } else { - /* Non-Shared-Ant */ -- if (coex_stat->bt_a2dp_active) { -- table_case = 113; -- tdma_case = 118; -- } else if (coex_stat->bt_ble_exist) { -+ if (coex_stat->bt_ble_exist) { - /* BLE */ -+ if (coex_stat->cnt_wl[COEX_CNT_WL_SCANAP] > 5) { -+ table_case = 121; -+ tdma_case = 102; -+ } else { -+ table_case = 122; -+ tdma_case = 109; -+ } -+ } else if (coex_stat->bt_a2dp_active) { - table_case = 113; -- -- if (coex_stat->wl_gl_busy) -- tdma_case = 106; -- else -- tdma_case = 104; -+ tdma_case = 118; - } else { - table_case = 113; - tdma_case = 104; - } - } - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -- rtw_coex_tdma(rtwdev, false, tdma_case); -+ rtw_coex_table(rtwdev, false, table_case); -+ if (is_toggle_table) { -+ rtw_btc_wltoggle_table_a(rtwdev, true, table_case); -+ rtw_btc_wltoggle_table_b(rtwdev, false, 1, COEX_WL_SLOT_TOGLLE); -+ } -+ -+ rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); - } - - static void rtw_coex_action_bt_a2dp(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_coex_dm *coex_dm = &coex->dm; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - u32 slot_type = 0; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ -+ slot_type = TDMA_4SLOT; -+ - if (efuse->share_ant) { - /* Shared-Ant */ -- slot_type = TDMA_4SLOT; -- - if (coex_stat->wl_gl_busy && coex_stat->wl_noisy_level == 0) -- table_case = 10; -+ table_case = 12; - else - table_case = 9; - -- if (coex_stat->wl_gl_busy) -- tdma_case = 13; -- else -+ if (coex_stat->wl_connecting || !coex_stat->wl_gl_busy) - tdma_case = 14; -+ else -+ tdma_case = 13; - } else { - /* Non-Shared-Ant */ - table_case = 112; -@@ -1535,21 +2050,24 @@ static void rtw_coex_action_bt_a2dp(struct rtw_dev *rtwdev) - tdma_case = 113; - } - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); - } - - static void rtw_coex_action_bt_a2dpsink(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - bool ap_enable = false; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (efuse->share_ant) { /* Shared-Ant */ - if (ap_enable) { - table_case = 2; -@@ -1571,20 +2089,22 @@ static void rtw_coex_action_bt_a2dpsink(struct rtw_dev *rtwdev) - } - } - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_bt_pan(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (efuse->share_ant) { - /* Shared-Ant */ - if (coex_stat->wl_gl_busy && coex_stat->wl_noisy_level == 0) -@@ -1595,7 +2115,7 @@ static void rtw_coex_action_bt_pan(struct rtw_dev *rtwdev) - if (coex_stat->wl_gl_busy) - tdma_case = 17; - else -- tdma_case = 19; -+ tdma_case = 20; - } else { - /* Non-Shared-Ant */ - table_case = 112; -@@ -1606,35 +2126,45 @@ static void rtw_coex_action_bt_pan(struct rtw_dev *rtwdev) - tdma_case = 119; - } - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_bt_a2dp_hid(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_coex_dm *coex_dm = &coex->dm; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; -- u8 table_case, tdma_case; -+ u8 table_case, tdma_case, interval = 0; - u32 slot_type = 0; -+ bool is_toggle_table = false; -+ -+ slot_type = TDMA_4SLOT; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); - - if (efuse->share_ant) { - /* Shared-Ant */ -- slot_type = TDMA_4SLOT; -- -- if (coex_stat->bt_ble_exist) -- table_case = 26; -- else -+ if (coex_stat->bt_ble_exist) { -+ table_case = 26; /* for RCU */ -+ } else if (coex_stat->bt_418_hid_exist) { - table_case = 9; -- -- if (coex_stat->wl_gl_busy) { -- tdma_case = 13; -+ interval = 1; - } else { -+ table_case = 9; -+ } -+ -+ if (coex_stat->wl_connecting || !coex_stat->wl_gl_busy) { - tdma_case = 14; -+ } else if (coex_stat->bt_418_hid_exist) { -+ is_toggle_table = true; -+ tdma_case = 23; -+ } else { -+ tdma_case = 13; - } - } else { - /* Non-Shared-Ant */ -@@ -1649,32 +2179,52 @@ static void rtw_coex_action_bt_a2dp_hid(struct rtw_dev *rtwdev) - tdma_case = 113; - } - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); -+ if (is_toggle_table) { -+ rtw_btc_wltoggle_table_a(rtwdev, true, table_case); -+ rtw_btc_wltoggle_table_b(rtwdev, false, interval, COEX_WL_SLOT_TOGLLE); -+ } - rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); - } - - static void rtw_coex_action_bt_a2dp_pan(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; -+ bool wl_cpt_test = false, bt_cpt_test = false; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); - -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); - if (efuse->share_ant) { - /* Shared-Ant */ -- if (coex_stat->wl_gl_busy && -- coex_stat->wl_noisy_level == 0) -- table_case = 14; -- else -- table_case = 10; -+ if (wl_cpt_test) { -+ if (coex_stat->wl_gl_busy) { -+ table_case = 20; -+ tdma_case = 17; -+ } else { -+ table_case = 10; -+ tdma_case = 15; -+ } -+ } else if (bt_cpt_test) { -+ table_case = 26; -+ tdma_case = 26; -+ } else { -+ if (coex_stat->wl_gl_busy && -+ coex_stat->wl_noisy_level == 0) -+ table_case = 14; -+ else -+ table_case = 10; - -- if (coex_stat->wl_gl_busy) -- tdma_case = 15; -- else -- tdma_case = 20; -+ if (coex_stat->wl_gl_busy) -+ tdma_case = 15; -+ else -+ tdma_case = 20; -+ } - } else { - /* Non-Shared-Ant */ - table_case = 112; -@@ -1685,20 +2235,28 @@ static void rtw_coex_action_bt_a2dp_pan(struct rtw_dev *rtwdev) - tdma_case = 120; - } - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ if (wl_cpt_test) -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[1]); -+ else -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_bt_pan_hid(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (efuse->share_ant) { - /* Shared-Ant */ - table_case = 9; -@@ -1717,20 +2275,22 @@ static void rtw_coex_action_bt_pan_hid(struct rtw_dev *rtwdev) - tdma_case = 119; - } - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_bt_a2dp_pan_hid(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (efuse->share_ant) { - /* Shared-Ant */ - table_case = 10; -@@ -1749,20 +2309,28 @@ static void rtw_coex_action_bt_a2dp_pan_hid(struct rtw_dev *rtwdev) - tdma_case = 120; - } - -- rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_wl_under5g(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_coex *coex = &rtwdev->coex; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_coex_stat *coex_stat = &coex->stat; - u8 table_case, tdma_case; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ -+ rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - rtw_coex_write_scbd(rtwdev, COEX_SCBD_FIX2M, false); - -+ if (coex_stat->bt_game_hid_exist && coex_stat->wl_linkscan_proc) -+ coex_stat->wl_coex_mode = COEX_WLINK_2GFREE; -+ - if (efuse->share_ant) { - /* Shared-Ant */ - table_case = 0; -@@ -1773,18 +2341,20 @@ static void rtw_coex_action_wl_under5g(struct rtw_dev *rtwdev) - tdma_case = 100; - } - -- rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_wl_only(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (efuse->share_ant) { - /* Shared-Ant */ - table_case = 2; -@@ -1795,22 +2365,25 @@ static void rtw_coex_action_wl_only(struct rtw_dev *rtwdev) - tdma_case = 100; - } - -- rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_wl_native_lps(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_coex_stat *coex_stat = &coex->stat; - u8 table_case, tdma_case; - - if (coex->under_5g) - return; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ - if (efuse->share_ant) { - /* Shared-Ant */ - table_case = 28; -@@ -1821,34 +2394,48 @@ static void rtw_coex_action_wl_native_lps(struct rtw_dev *rtwdev) - tdma_case = 100; - } - -- rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ if (coex_stat->bt_game_hid_exist) { -+ coex_stat->wl_coex_mode = COEX_WLINK_2GFREE; -+ if (coex_stat->wl_tput_dir == COEX_WL_TPUT_TX) -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_tx[6]); -+ else -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[5]); -+ } else { -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ } -+ -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - - static void rtw_coex_action_wl_linkscan(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - u32 slot_type = 0; - -- if (efuse->share_ant) { -- /* Shared-Ant */ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ -+ if (efuse->share_ant) { /* Shared-Ant */ - if (coex_stat->bt_a2dp_exist) { - slot_type = TDMA_4SLOT; -- table_case = 9; - tdma_case = 11; -+ if (coex_stat->wl_gl_busy) -+ table_case = 26; -+ else -+ table_case = 9; - } else { - table_case = 9; - tdma_case = 7; - } -- } else { -- /* Non-Shared-Ant */ -+ } else { /* Non-Shared-Ant */ - if (coex_stat->bt_a2dp_exist) { -+ slot_type = TDMA_4SLOT; - table_case = 112; - tdma_case = 111; - } else { -@@ -1857,18 +2444,20 @@ static void rtw_coex_action_wl_linkscan(struct rtw_dev *rtwdev) - } - } - -- rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); - } - - static void rtw_coex_action_wl_not_connected(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; -- struct rtw_chip_info *chip = rtwdev->chip; - u8 table_case, tdma_case; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); -+ rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); -+ rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -+ - if (efuse->share_ant) { - /* Shared-Ant */ - table_case = 1; -@@ -1879,9 +2468,7 @@ static void rtw_coex_action_wl_not_connected(struct rtw_dev *rtwdev) - tdma_case = 100; - } - -- rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); -- rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); -- rtw_coex_table(rtwdev, table_case); -+ rtw_coex_table(rtwdev, false, table_case); - rtw_coex_tdma(rtwdev, false, tdma_case); - } - -@@ -1889,17 +2476,9 @@ static void rtw_coex_action_wl_connected(struct rtw_dev *rtwdev) - { - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; -- struct rtw_coex_dm *coex_dm = &coex->dm; -- struct rtw_efuse *efuse = &rtwdev->efuse; - u8 algorithm; - -- /* Non-Shared-Ant */ -- if (!efuse->share_ant && coex_stat->wl_gl_busy && -- COEX_RSSI_HIGH(coex_dm->wl_rssi_state[3]) && -- COEX_RSSI_HIGH(coex_dm->bt_rssi_state[0])) { -- rtw_coex_action_freerun(rtwdev); -- return; -- } -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); - - algorithm = rtw_coex_algorithm(rtwdev); - -@@ -1908,10 +2487,15 @@ static void rtw_coex_action_wl_connected(struct rtw_dev *rtwdev) - rtw_coex_action_bt_hfp(rtwdev); - break; - case COEX_ALGO_HID: -- rtw_coex_action_bt_hid(rtwdev); -+ if (rtw_coex_freerun_check(rtwdev)) -+ rtw_coex_action_freerun(rtwdev); -+ else -+ rtw_coex_action_bt_hid(rtwdev); - break; - case COEX_ALGO_A2DP: -- if (coex_stat->bt_a2dp_sink) -+ if (rtw_coex_freerun_check(rtwdev)) -+ rtw_coex_action_freerun(rtwdev); -+ else if (coex_stat->bt_a2dp_sink) - rtw_coex_action_bt_a2dpsink(rtwdev); - else - rtw_coex_action_bt_a2dp(rtwdev); -@@ -1920,7 +2504,10 @@ static void rtw_coex_action_wl_connected(struct rtw_dev *rtwdev) - rtw_coex_action_bt_pan(rtwdev); - break; - case COEX_ALGO_A2DP_HID: -- rtw_coex_action_bt_a2dp_hid(rtwdev); -+ if (rtw_coex_freerun_check(rtwdev)) -+ rtw_coex_action_freerun(rtwdev); -+ else -+ rtw_coex_action_bt_a2dp_hid(rtwdev); - break; - case COEX_ALGO_A2DP_PAN: - rtw_coex_action_bt_a2dp_pan(rtwdev); -@@ -1940,9 +2527,11 @@ static void rtw_coex_action_wl_connected(struct rtw_dev *rtwdev) - - static void rtw_coex_run_coex(struct rtw_dev *rtwdev, u8 reason) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_dm *coex_dm = &coex->dm; - struct rtw_coex_stat *coex_stat = &coex->stat; -+ bool rf4ce_en = false; - - lockdep_assert_held(&rtwdev->mutex); - -@@ -1951,20 +2540,38 @@ static void rtw_coex_run_coex(struct rtw_dev *rtwdev, u8 reason) - - coex_dm->reason = reason; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): reason = %d\n", __func__, -+ reason); -+ - /* update wifi_link_info_ext variable */ - rtw_coex_update_wl_link_info(rtwdev, reason); - - rtw_coex_monitor_bt_enable(rtwdev); - -- if (coex->stop_dm) -+ if (coex->manual_control) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], return for Manual CTRL!!\n"); -+ return; -+ } -+ -+ if (coex->stop_dm) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], return for Stop Coex DM!!\n"); - return; -+ } - -- if (coex_stat->wl_under_ips) -+ if (coex_stat->wl_under_ips) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], return for wifi is under IPS!!\n"); - return; -+ } - - if (coex->freeze && coex_dm->reason == COEX_RSN_BTINFO && -- !coex_stat->bt_setup_link) -+ !coex_stat->bt_setup_link) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], return for coex_freeze!!\n"); - return; -+ } - - coex_stat->cnt_wl[COEX_CNT_WL_COEXRUN]++; - coex->freerun = false; -@@ -1976,10 +2583,16 @@ static void rtw_coex_run_coex(struct rtw_dev *rtwdev, u8 reason) - goto exit; - } - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], WiFi is single-port 2G!!\n"); - coex_stat->wl_coex_mode = COEX_WLINK_2G1PORT; -- rtw_coex_write_scbd(rtwdev, COEX_SCBD_FIX2M, false); -+ - if (coex_stat->bt_disabled) { -- rtw_coex_action_wl_only(rtwdev); -+ if (coex_stat->wl_connected && rf4ce_en) -+ rtw_coex_action_rf4ce(rtwdev); -+ else if (!coex_stat->wl_connected) -+ rtw_coex_action_wl_not_connected(rtwdev); -+ else -+ rtw_coex_action_wl_only(rtwdev); - goto exit; - } - -@@ -1988,6 +2601,11 @@ static void rtw_coex_run_coex(struct rtw_dev *rtwdev, u8 reason) - goto exit; - } - -+ if (coex_stat->bt_game_hid_exist && coex_stat->wl_connected) { -+ rtw_coex_action_bt_game_hid(rtwdev); -+ goto exit; -+ } -+ - if (coex_stat->bt_whck_test) { - rtw_coex_action_bt_whql_test(rtwdev); - goto exit; -@@ -2010,18 +2628,33 @@ static void rtw_coex_run_coex(struct rtw_dev *rtwdev, u8 reason) - goto exit; - } - -- if (coex_stat->wl_linkscan_proc) { -+ if (coex_stat->wl_linkscan_proc && !coex->freerun) { - rtw_coex_action_wl_linkscan(rtwdev); - goto exit; - } - -- if (coex_stat->wl_connected) -+ if (coex_stat->wl_connected) { - rtw_coex_action_wl_connected(rtwdev); -- else -+ goto exit; -+ } else { - rtw_coex_action_wl_not_connected(rtwdev); -+ goto exit; -+ } - - exit: -- rtw_coex_set_gnt_fix(rtwdev); -+ -+ if (chip->wl_mimo_ps_support) { -+ if (coex_stat->wl_coex_mode == COEX_WLINK_2GFREE) { -+ if (coex_dm->reason == COEX_RSN_2GMEDIA) -+ rtw_coex_mimo_ps(rtwdev, true, true); -+ else -+ rtw_coex_mimo_ps(rtwdev, false, true); -+ } else { -+ rtw_coex_mimo_ps(rtwdev, false, false); -+ } -+ } -+ -+ rtw_coex_gnt_workaround(rtwdev, false, coex_stat->wl_coex_mode); - rtw_coex_limited_wl(rtwdev); - } - -@@ -2048,14 +2681,26 @@ static void rtw_coex_init_coex_var(struct rtw_dev *rtwdev) - coex_dm->wl_rssi_state[i] = COEX_RSSI_STATE_LOW; - - coex_stat->wl_coex_mode = COEX_WLINK_MAX; -+ coex_stat->wl_rx_rate = DESC_RATE5_5M; -+ coex_stat->wl_rts_rx_rate = DESC_RATE5_5M; - } - - static void __rtw_coex_init_hw_config(struct rtw_dev *rtwdev, bool wifi_only) - { - struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_stat *coex_stat = &coex->stat; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); - - rtw_coex_init_coex_var(rtwdev); -+ -+ coex_stat->kt_ver = u8_get_bits(rtw_read8(rtwdev, 0xf1), GENMASK(7, 4)); -+ - rtw_coex_monitor_bt_enable(rtwdev); -+ rtw_coex_wl_slot_extend(rtwdev, coex_stat->wl_slot_extend); -+ -+ rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); -+ - rtw_coex_set_rfe_type(rtwdev); - rtw_coex_set_init(rtwdev); - -@@ -2073,21 +2718,24 @@ static void __rtw_coex_init_hw_config(struct rtw_dev *rtwdev, bool wifi_only) - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_WOFF); - rtw_coex_write_scbd(rtwdev, COEX_SCBD_ALL, false); - coex->stop_dm = true; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): RF Off\n", -+ __func__); - } else if (wifi_only) { - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_WONLY); -- rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_SCAN, -+ rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, - true); - coex->stop_dm = true; - } else { - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_INIT); -- rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_SCAN, -+ rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, - true); - coex->stop_dm = false; - coex->freeze = true; - } - - /* PTA parameter */ -- rtw_coex_table(rtwdev, 0); -+ rtw_coex_table(rtwdev, true, 1); - rtw_coex_tdma(rtwdev, true, 0); - rtw_coex_query_bt_info(rtwdev); - } -@@ -2095,12 +2743,16 @@ static void __rtw_coex_init_hw_config(struct rtw_dev *rtwdev, bool wifi_only) - void rtw_coex_power_on_setting(struct rtw_dev *rtwdev) - { - struct rtw_coex *coex = &rtwdev->coex; -+ u8 table_case = 1; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); - - coex->stop_dm = true; - coex->wl_rf_off = false; - - /* enable BB, we can write 0x948 */ -- rtw_write8_set(rtwdev, REG_SYS_FUNC_EN, BIT(0) | BIT(1)); -+ rtw_write8_set(rtwdev, REG_SYS_FUNC_EN, -+ BIT_FEN_BB_GLB_RST | BIT_FEN_BB_RSTB); - - rtw_coex_monitor_bt_enable(rtwdev); - rtw_coex_set_rfe_type(rtwdev); -@@ -2108,8 +2760,15 @@ void rtw_coex_power_on_setting(struct rtw_dev *rtwdev) - /* set antenna path to BT */ - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_POWERON); - -+ rtw_coex_table(rtwdev, true, table_case); - /* red x issue */ - rtw_write8(rtwdev, 0xff1a, 0x0); -+ rtw_coex_set_gnt_debug(rtwdev); -+} -+ -+void rtw_coex_power_off_setting(struct rtw_dev *rtwdev) -+{ -+ rtw_write16(rtwdev, REG_WIFI_BT_INFO, BIT_BT_INT_EN); - } - - void rtw_coex_init_hw_config(struct rtw_dev *rtwdev, bool wifi_only) -@@ -2122,10 +2781,12 @@ void rtw_coex_ips_notify(struct rtw_dev *rtwdev, u8 type) - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - -- if (coex->stop_dm) -+ if (coex->manual_control || coex->stop_dm) - return; - - if (type == COEX_IPS_ENTER) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], IPS ENTER notify\n"); -+ - coex_stat->wl_under_ips = true; - - /* for lps off */ -@@ -2134,11 +2795,11 @@ void rtw_coex_ips_notify(struct rtw_dev *rtwdev, u8 type) - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_WOFF); - rtw_coex_action_coex_all_off(rtwdev); - } else if (type == COEX_IPS_LEAVE) { -- rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, true); -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], IPS LEAVE notify\n"); - -+ rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, true); - /* run init hw config (exclude wifi only) */ - __rtw_coex_init_hw_config(rtwdev, false); -- /* sw all off */ - - coex_stat->wl_under_ips = false; - } -@@ -2149,10 +2810,12 @@ void rtw_coex_lps_notify(struct rtw_dev *rtwdev, u8 type) - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - -- if (coex->stop_dm) -+ if (coex->manual_control || coex->stop_dm) - return; - - if (type == COEX_LPS_ENABLE) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], LPS ENABLE notify\n"); -+ - coex_stat->wl_under_lps = true; - - if (coex_stat->wl_force_lps_ctrl) { -@@ -2161,10 +2824,13 @@ void rtw_coex_lps_notify(struct rtw_dev *rtwdev, u8 type) - } else { - /* for native ps */ - rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, false); -+ rtw_coex_write_scbd(rtwdev, COEX_SCBD_WLBUSY, false); - - rtw_coex_run_coex(rtwdev, COEX_RSN_LPS); - } - } else if (type == COEX_LPS_DISABLE) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], LPS DISABLE notify\n"); -+ - coex_stat->wl_under_lps = false; - - /* for lps off */ -@@ -2172,6 +2838,8 @@ void rtw_coex_lps_notify(struct rtw_dev *rtwdev, u8 type) - - if (!coex_stat->wl_force_lps_ctrl) - rtw_coex_query_bt_info(rtwdev); -+ -+ rtw_coex_run_coex(rtwdev, COEX_RSN_LPS); - } - } - -@@ -2180,25 +2848,34 @@ void rtw_coex_scan_notify(struct rtw_dev *rtwdev, u8 type) - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - -- if (coex->stop_dm) -+ if (coex->manual_control || coex->stop_dm) - return; - - coex->freeze = false; -- -- if (type != COEX_SCAN_FINISH) -- rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_SCAN | -- COEX_SCBD_ONOFF, true); -+ rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, true); - - if (type == COEX_SCAN_START_5G) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], SCAN START notify (5G)\n"); -+ - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); - rtw_coex_run_coex(rtwdev, COEX_RSN_5GSCANSTART); - } else if ((type == COEX_SCAN_START_2G) || (type == COEX_SCAN_START)) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], SCAN START notify (2G)\n"); -+ - coex_stat->wl_hi_pri_task2 = true; - - /* Force antenna setup for no scan result issue */ - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); - rtw_coex_run_coex(rtwdev, COEX_RSN_2GSCANSTART); - } else { -+ coex_stat->cnt_wl[COEX_CNT_WL_SCANAP] = 30; /* To do */ -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", -+ coex_stat->cnt_wl[COEX_CNT_WL_SCANAP]); -+ - coex_stat->wl_hi_pri_task2 = false; - rtw_coex_run_coex(rtwdev, COEX_RSN_SCANFINISH); - } -@@ -2208,9 +2885,20 @@ void rtw_coex_switchband_notify(struct rtw_dev *rtwdev, u8 type) - { - struct rtw_coex *coex = &rtwdev->coex; - -- if (coex->stop_dm) -+ if (coex->manual_control || coex->stop_dm) - return; - -+ if (type == COEX_SWITCH_TO_5G) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): TO_5G\n", -+ __func__); -+ } else if (type == COEX_SWITCH_TO_24G_NOFORSCAN) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], %s(): TO_24G_NOFORSCAN\n", __func__); -+ } else { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): TO_2G\n", -+ __func__); -+ } -+ - if (type == COEX_SWITCH_TO_5G) - rtw_coex_run_coex(rtwdev, COEX_RSN_5GSWITCHBAND); - else if (type == COEX_SWITCH_TO_24G_NOFORSCAN) -@@ -2224,22 +2912,33 @@ void rtw_coex_connect_notify(struct rtw_dev *rtwdev, u8 type) - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; - -- if (coex->stop_dm) -+ if (coex->manual_control || coex->stop_dm) - return; - -- rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_SCAN | -- COEX_SCBD_ONOFF, true); -+ rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, true); - - if (type == COEX_ASSOCIATE_5G_START) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 5G start\n", -+ __func__); -+ - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); - rtw_coex_run_coex(rtwdev, COEX_RSN_5GCONSTART); - } else if (type == COEX_ASSOCIATE_5G_FINISH) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 5G finish\n", -+ __func__); -+ - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); - rtw_coex_run_coex(rtwdev, COEX_RSN_5GCONFINISH); - } else if (type == COEX_ASSOCIATE_START) { - coex_stat->wl_hi_pri_task1 = true; -+ coex_stat->wl_connecting = true; - coex_stat->cnt_wl[COEX_CNT_WL_CONNPKT] = 2; -+ coex_stat->wl_connecting = true; -+ ieee80211_queue_delayed_work(rtwdev->hw, -+ &coex->wl_connecting_work, 2 * HZ); - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 2G start\n", -+ __func__); - /* Force antenna setup for no scan result issue */ - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); - -@@ -2254,7 +2953,10 @@ void rtw_coex_connect_notify(struct rtw_dev *rtwdev, u8 type) - } else { - coex_stat->wl_hi_pri_task1 = false; - coex->freeze = false; -+ coex_stat->wl_connecting = false; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 2G finish\n", -+ __func__); - rtw_coex_run_coex(rtwdev, COEX_RSN_2GCONFINISH); - } - } -@@ -2263,17 +2965,22 @@ void rtw_coex_media_status_notify(struct rtw_dev *rtwdev, u8 type) - { - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; -- u8 para[6] = {0}; - -- if (coex->stop_dm) -+ if (coex->manual_control || coex->stop_dm) - return; - - if (type == COEX_MEDIA_CONNECT_5G) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 5G\n", __func__); -+ - rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, true); - - rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); - rtw_coex_run_coex(rtwdev, COEX_RSN_5GMEDIA); - } else if (type == COEX_MEDIA_CONNECT) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 2G\n", __func__); -+ -+ coex_stat->wl_connecting = false; -+ - rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, true); - - /* Force antenna setup for no scan result issue */ -@@ -2281,18 +2988,11 @@ void rtw_coex_media_status_notify(struct rtw_dev *rtwdev, u8 type) - - /* Set CCK Rx high Pri */ - rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_RX_CCK, 1); -- -- /* always enable 5ms extend if connect */ -- para[0] = COEX_H2C69_WL_LEAKAP; -- para[1] = PARA1_H2C69_EN_5MS; /* enable 5ms extend */ -- rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); -- coex_stat->wl_slot_extend = true; - rtw_coex_run_coex(rtwdev, COEX_RSN_2GMEDIA); - } else { -- rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, false); -- -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): disconnect!!\n", -+ __func__); - rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_RX_CCK, 0); -- - rtw_coex_run_coex(rtwdev, COEX_RSN_MEDIADISCON); - } - -@@ -2301,28 +3001,38 @@ void rtw_coex_media_status_notify(struct rtw_dev *rtwdev, u8 type) - - void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; -- struct rtw_chip_info *chip = rtwdev->chip; -- unsigned long bt_relink_time; -+ struct rtw_coex_dm *coex_dm = &coex->dm; -+ u32 bt_relink_time; - u8 i, rsp_source = 0, type; - bool inq_page = false; - - rsp_source = buf[0] & 0xf; - if (rsp_source >= COEX_BTINFO_SRC_MAX) -- rsp_source = COEX_BTINFO_SRC_WL_FW; -+ return; -+ coex_stat->cnt_bt_info_c2h[rsp_source]++; - - if (rsp_source == COEX_BTINFO_SRC_BT_IQK) { - coex_stat->bt_iqk_state = buf[1]; -- if (coex_stat->bt_iqk_state == 1) -+ if (coex_stat->bt_iqk_state == 0) - coex_stat->cnt_bt[COEX_CNT_BT_IQK]++; - else if (coex_stat->bt_iqk_state == 2) - coex_stat->cnt_bt[COEX_CNT_BT_IQKFAIL]++; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], BT IQK by bt_info, data0 = 0x%02x\n", -+ buf[1]); -+ - return; - } - - if (rsp_source == COEX_BTINFO_SRC_BT_SCBD) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], BT Scoreboard change notify by WL FW c2h, 0xaa = 0x%02x, 0xab = 0x%02x\n", -+ buf[1], buf[2]); -+ - rtw_coex_monitor_bt_enable(rtwdev); - if (coex_stat->bt_disabled != coex_stat->bt_disabled_pre) { - coex_stat->bt_disabled_pre = coex_stat->bt_disabled; -@@ -2331,6 +3041,24 @@ void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - return; - } - -+ if (rsp_source == COEX_BTINFO_SRC_H2C60) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], H2C 0x60 content replied by WL FW: H2C_0x60 = [%02x %02x %02x %02x %02x]\n", -+ buf[1], buf[2], buf[3], buf[4], buf[5]); -+ -+ for (i = 1; i <= COEX_WL_TDMA_PARA_LENGTH; i++) -+ coex_dm->fw_tdma_para[i - 1] = buf[i]; -+ return; -+ } -+ -+ if (rsp_source == COEX_BTINFO_SRC_WL_FW) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], bt_info reply by WL FW\n"); -+ -+ rtw_coex_update_bt_link_info(rtwdev); -+ return; -+ } -+ - if (rsp_source == COEX_BTINFO_SRC_BT_RSP || - rsp_source == COEX_BTINFO_SRC_BT_ACT) { - if (coex_stat->bt_disabled) { -@@ -2339,30 +3067,36 @@ void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - ieee80211_queue_delayed_work(rtwdev->hw, - &coex->bt_reenable_work, - 15 * HZ); -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], BT enable detected by bt_info\n"); - } - } - -- for (i = 0; i < length; i++) { -- if (i < COEX_BTINFO_LENGTH_MAX) -- coex_stat->bt_info_c2h[rsp_source][i] = buf[i]; -- else -- break; -- } -+ if (length != COEX_BTINFO_LENGTH) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], Bt_info length = %d invalid!!\n", length); - -- if (rsp_source == COEX_BTINFO_SRC_WL_FW) { -- rtw_coex_update_bt_link_info(rtwdev); -- rtw_coex_run_coex(rtwdev, COEX_RSN_BTINFO); - return; - } - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], Bt_info[%d], len=%d, data=[%02x %02x %02x %02x %02x %02x]\n", -+ buf[0], length, buf[1], buf[2], buf[3], buf[4], buf[5], buf[6]); -+ -+ for (i = 0; i < COEX_BTINFO_LENGTH; i++) -+ coex_stat->bt_info_c2h[rsp_source][i] = buf[i]; -+ - /* get the same info from bt, skip it */ - if (coex_stat->bt_info_c2h[rsp_source][1] == coex_stat->bt_info_lb2 && - coex_stat->bt_info_c2h[rsp_source][2] == coex_stat->bt_info_lb3 && - coex_stat->bt_info_c2h[rsp_source][3] == coex_stat->bt_info_hb0 && - coex_stat->bt_info_c2h[rsp_source][4] == coex_stat->bt_info_hb1 && - coex_stat->bt_info_c2h[rsp_source][5] == coex_stat->bt_info_hb2 && -- coex_stat->bt_info_c2h[rsp_source][6] == coex_stat->bt_info_hb3) -+ coex_stat->bt_info_c2h[rsp_source][6] == coex_stat->bt_info_hb3) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], Return because Btinfo duplicate!!\n"); - return; -+ } - - coex_stat->bt_info_lb2 = coex_stat->bt_info_c2h[rsp_source][1]; - coex_stat->bt_info_lb3 = coex_stat->bt_info_c2h[rsp_source][2]; -@@ -2388,6 +3122,40 @@ void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - 4 * HZ); - } - coex_stat->bt_acl_busy = ((coex_stat->bt_info_lb2 & BIT(3)) == BIT(3)); -+ if (chip->ble_hid_profile_support) { -+ if (coex_stat->bt_info_lb2 & BIT(5)) { -+ if (coex_stat->bt_info_hb1 & BIT(0)) { -+ /*BLE HID*/ -+ coex_stat->bt_ble_hid_exist = true; -+ } else { -+ coex_stat->bt_ble_hid_exist = false; -+ } -+ coex_stat->bt_ble_exist = false; -+ } else if (coex_stat->bt_info_hb1 & BIT(0)) { -+ /*RCU*/ -+ coex_stat->bt_ble_hid_exist = false; -+ coex_stat->bt_ble_exist = true; -+ } else { -+ coex_stat->bt_ble_hid_exist = false; -+ coex_stat->bt_ble_exist = false; -+ } -+ } else { -+ if (coex_stat->bt_info_hb1 & BIT(0)) { -+ if (coex_stat->bt_hid_slot == 1 && -+ coex_stat->hi_pri_rx + 100 < coex_stat->hi_pri_tx && -+ coex_stat->hi_pri_rx < 100) { -+ coex_stat->bt_ble_hid_exist = true; -+ coex_stat->bt_ble_exist = false; -+ } else { -+ coex_stat->bt_ble_hid_exist = false; -+ coex_stat->bt_ble_exist = true; -+ } -+ } else { -+ coex_stat->bt_ble_hid_exist = false; -+ coex_stat->bt_ble_exist = false; -+ } -+ } -+ - coex_stat->cnt_bt[COEX_CNT_BT_RETRY] = coex_stat->bt_info_lb3 & 0xf; - if (coex_stat->cnt_bt[COEX_CNT_BT_RETRY] >= 1) - coex_stat->cnt_bt[COEX_CNT_BT_POPEVENT]++; -@@ -2398,22 +3166,13 @@ void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - coex_stat->cnt_bt[COEX_CNT_BT_INQ]++; - - coex_stat->bt_page = ((coex_stat->bt_info_lb3 & BIT(7)) == BIT(7)); -- if (coex_stat->bt_page) { -+ if (coex_stat->bt_page) - coex_stat->cnt_bt[COEX_CNT_BT_PAGE]++; -- if (coex_stat->wl_linkscan_proc || -- coex_stat->wl_hi_pri_task1 || -- coex_stat->wl_hi_pri_task2 || coex_stat->wl_gl_busy) -- rtw_coex_write_scbd(rtwdev, COEX_SCBD_SCAN, true); -- else -- rtw_coex_write_scbd(rtwdev, COEX_SCBD_SCAN, false); -- } else { -- rtw_coex_write_scbd(rtwdev, COEX_SCBD_SCAN, false); -- } - - /* unit: % (value-100 to translate to unit: dBm in coex info) */ - if (chip->bt_rssi_type == COEX_BTRSSI_RATIO) { - coex_stat->bt_rssi = coex_stat->bt_info_hb0 * 2 + 10; -- } else { /* original unit: dbm -> unit: % -> value-100 in coex info */ -+ } else { - if (coex_stat->bt_info_hb0 <= 127) - coex_stat->bt_rssi = 100; - else if (256 - coex_stat->bt_info_hb0 <= 100) -@@ -2422,7 +3181,6 @@ void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - coex_stat->bt_rssi = 0; - } - -- coex_stat->bt_ble_exist = ((coex_stat->bt_info_hb1 & BIT(0)) == BIT(0)); - if (coex_stat->bt_info_hb1 & BIT(1)) - coex_stat->cnt_bt[COEX_CNT_BT_REINIT]++; - -@@ -2432,11 +3190,14 @@ void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - if (coex_stat->bt_reenable) - bt_relink_time = 6 * HZ; - else -- bt_relink_time = 2 * HZ; -+ bt_relink_time = 1 * HZ; - - ieee80211_queue_delayed_work(rtwdev->hw, - &coex->bt_relink_work, - bt_relink_time); -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], Re-Link start in BT info!!\n"); - } - - if (coex_stat->bt_info_hb1 & BIT(3)) -@@ -2448,8 +3209,21 @@ void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - coex_stat->cnt_bt[COEX_CNT_BT_ROLESWITCH]++; - - coex_stat->bt_multi_link = ((coex_stat->bt_info_hb1 & BIT(7)) == BIT(7)); -+ /* for multi_link = 0 but bt pkt remain exist */ -+ /* Use PS-TDMA to protect WL RX */ -+ if (!coex_stat->bt_multi_link && coex_stat->bt_multi_link_pre) { -+ coex_stat->bt_multi_link_remain = true; -+ ieee80211_queue_delayed_work(rtwdev->hw, -+ &coex->bt_multi_link_remain_work, -+ 3 * HZ); -+ } -+ coex_stat->bt_multi_link_pre = coex_stat->bt_multi_link; -+ - /* resend wifi info to bt, it is reset and lost the info */ -- if ((coex_stat->bt_info_hb1 & BIT(1))) { -+ if (coex_stat->bt_info_hb1 & BIT(1)) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], BT Re-init, send wifi BW & Chnl to BT!!\n"); -+ - if (coex_stat->wl_connected) - type = COEX_MEDIA_CONNECT; - else -@@ -2459,8 +3233,11 @@ void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - - /* if ignore_wlan_act && not set_up_link */ - if ((coex_stat->bt_info_hb1 & BIT(3)) && -- (!(coex_stat->bt_info_hb1 & BIT(2)))) -+ (!(coex_stat->bt_info_hb1 & BIT(2)))) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); - rtw_coex_ignore_wlan_act(rtwdev, false); -+ } - - coex_stat->bt_opp_exist = ((coex_stat->bt_info_hb2 & BIT(0)) == BIT(0)); - if (coex_stat->bt_info_hb2 & BIT(1)) -@@ -2472,7 +3249,7 @@ void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - coex_stat->bt_hid_pair_num = (coex_stat->bt_info_hb2 & 0xc0) >> 6; - if (coex_stat->bt_hid_pair_num > 0 && coex_stat->bt_hid_slot >= 2) - coex_stat->bt_418_hid_exist = true; -- else if (coex_stat->bt_hid_pair_num == 0) -+ else if (coex_stat->bt_hid_pair_num == 0 || coex_stat->bt_hid_slot == 1) - coex_stat->bt_418_hid_exist = false; - - if ((coex_stat->bt_info_lb2 & 0x49) == 0x49) -@@ -2486,6 +3263,135 @@ void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - rtw_coex_run_coex(rtwdev, COEX_RSN_BTINFO); - } - -+#define COEX_BT_HIDINFO_MTK 0x46 -+static const u8 coex_bt_hidinfo_ps[] = {0x57, 0x69, 0x72}; -+static const u8 coex_bt_hidinfo_xb[] = {0x58, 0x62, 0x6f}; -+ -+void rtw_coex_bt_hid_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_stat *coex_stat = &coex->stat; -+ struct rtw_coex_hid *hidinfo; -+ struct rtw_coex_hid_info_a *hida; -+ struct rtw_coex_hid_handle_list *hl, *bhl; -+ u8 sub_id = buf[2], gamehid_cnt = 0, handle, i; -+ bool cur_game_hid_exist, complete; -+ -+ if (!chip->wl_mimo_ps_support && -+ (sub_id == COEX_BT_HIDINFO_LIST || sub_id == COEX_BT_HIDINFO_A)) -+ return; -+ -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], HID info notify, sub_id = 0x%x\n", sub_id); -+ -+ switch (sub_id) { -+ case COEX_BT_HIDINFO_LIST: -+ hl = &coex_stat->hid_handle_list; -+ bhl = (struct rtw_coex_hid_handle_list *)buf; -+ if (!memcmp(hl, bhl, sizeof(*hl))) -+ return; -+ coex_stat->hid_handle_list = *bhl; -+ memset(&coex_stat->hid_info, 0, sizeof(coex_stat->hid_info)); -+ for (i = 0; i < COEX_BT_HIDINFO_HANDLE_NUM; i++) { -+ hidinfo = &coex_stat->hid_info[i]; -+ if (hl->handle[i] != COEX_BT_HIDINFO_NOTCON && -+ hl->handle[i] != 0) -+ hidinfo->hid_handle = hl->handle[i]; -+ } -+ break; -+ case COEX_BT_HIDINFO_A: -+ hida = (struct rtw_coex_hid_info_a *)buf; -+ handle = hida->handle; -+ for (i = 0; i < COEX_BT_HIDINFO_HANDLE_NUM; i++) { -+ hidinfo = &coex_stat->hid_info[i]; -+ if (hidinfo->hid_handle == handle) { -+ hidinfo->hid_vendor = hida->vendor; -+ memcpy(hidinfo->hid_name, hida->name, -+ sizeof(hidinfo->hid_name)); -+ hidinfo->hid_info_completed = true; -+ break; -+ } -+ } -+ break; -+ } -+ for (i = 0; i < COEX_BT_HIDINFO_HANDLE_NUM; i++) { -+ hidinfo = &coex_stat->hid_info[i]; -+ complete = hidinfo->hid_info_completed; -+ handle = hidinfo->hid_handle; -+ if (!complete || handle == COEX_BT_HIDINFO_NOTCON || -+ handle == 0 || handle >= COEX_BT_BLE_HANDLE_THRS) { -+ hidinfo->is_game_hid = false; -+ continue; -+ } -+ -+ if (hidinfo->hid_vendor == COEX_BT_HIDINFO_MTK) { -+ if ((memcmp(hidinfo->hid_name, -+ coex_bt_hidinfo_ps, -+ COEX_BT_HIDINFO_NAME)) == 0) -+ hidinfo->is_game_hid = true; -+ else if ((memcmp(hidinfo->hid_name, -+ coex_bt_hidinfo_xb, -+ COEX_BT_HIDINFO_NAME)) == 0) -+ hidinfo->is_game_hid = true; -+ else -+ hidinfo->is_game_hid = false; -+ } else { -+ hidinfo->is_game_hid = false; -+ } -+ if (hidinfo->is_game_hid) -+ gamehid_cnt++; -+ } -+ -+ if (gamehid_cnt > 0) -+ cur_game_hid_exist = true; -+ else -+ cur_game_hid_exist = false; -+ -+ if (cur_game_hid_exist != coex_stat->bt_game_hid_exist) { -+ coex_stat->bt_game_hid_exist = cur_game_hid_exist; -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], HID info changed!bt_game_hid_exist = %d!\n", -+ coex_stat->bt_game_hid_exist); -+ rtw_coex_run_coex(rtwdev, COEX_RSN_BTSTATUS); -+ } -+} -+ -+void rtw_coex_query_bt_hid_list(struct rtw_dev *rtwdev) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_stat *coex_stat = &coex->stat; -+ struct rtw_coex_hid *hidinfo; -+ u8 i, handle; -+ bool complete; -+ -+ if (!chip->wl_mimo_ps_support || coex_stat->wl_under_ips || -+ (coex_stat->wl_under_lps && !coex_stat->wl_force_lps_ctrl)) -+ return; -+ -+ if (!coex_stat->bt_hid_exist && -+ !((coex_stat->bt_info_lb2 & COEX_INFO_CONNECTION) && -+ (coex_stat->hi_pri_tx + coex_stat->hi_pri_rx > -+ COEX_BT_GAMEHID_CNT))) -+ return; -+ -+ rtw_fw_coex_query_hid_info(rtwdev, COEX_BT_HIDINFO_LIST, 0); -+ -+ for (i = 0; i < COEX_BT_HIDINFO_HANDLE_NUM; i++) { -+ hidinfo = &coex_stat->hid_info[i]; -+ complete = hidinfo->hid_info_completed; -+ handle = hidinfo->hid_handle; -+ if (handle == 0 || handle == COEX_BT_HIDINFO_NOTCON || -+ handle >= COEX_BT_BLE_HANDLE_THRS || complete) -+ continue; -+ -+ rtw_fw_coex_query_hid_info(rtwdev, -+ COEX_BT_HIDINFO_A, -+ handle); -+ } -+} -+ - void rtw_coex_wl_fwdbginfo_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - { - struct rtw_coex *coex = &rtwdev->coex; -@@ -2493,6 +3399,9 @@ void rtw_coex_wl_fwdbginfo_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - u8 val; - int i; - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, -+ "[BTCoex], WiFi Fw Dbg info = %8ph (len = %d)\n", -+ buf, length); - if (WARN(length < 8, "invalid wl info c2h length\n")) - return; - -@@ -2504,7 +3413,7 @@ void rtw_coex_wl_fwdbginfo_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - if (buf[i] >= val) - coex_stat->wl_fw_dbg_info[i] = buf[i] - val; - else -- coex_stat->wl_fw_dbg_info[i] = val - buf[i]; -+ coex_stat->wl_fw_dbg_info[i] = 255 - val + buf[i]; - - coex_stat->wl_fw_dbg_info_pre[i] = buf[i]; - } -@@ -2514,14 +3423,20 @@ void rtw_coex_wl_fwdbginfo_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) - rtw_coex_wl_ccklock_detect(rtwdev); - } - --void rtw_coex_wl_status_change_notify(struct rtw_dev *rtwdev) -+void rtw_coex_wl_status_change_notify(struct rtw_dev *rtwdev, u32 type) - { -- struct rtw_coex *coex = &rtwdev->coex; -+ rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); -+} -+ -+void rtw_coex_wl_status_check(struct rtw_dev *rtwdev) -+{ -+ struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; - -- if (coex->stop_dm) -+ if ((coex_stat->wl_under_lps && !coex_stat->wl_force_lps_ctrl) || -+ coex_stat->wl_under_ips) - return; - -- rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); -+ rtw_coex_monitor_bt_ctr(rtwdev); - } - - void rtw_coex_bt_relink_work(struct work_struct *work) -@@ -2585,6 +3500,41 @@ void rtw_coex_bt_remain_work(struct work_struct *work) - mutex_unlock(&rtwdev->mutex); - } - -+void rtw_coex_wl_connecting_work(struct work_struct *work) -+{ -+ struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, -+ coex.wl_connecting_work.work); -+ struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; -+ -+ mutex_lock(&rtwdev->mutex); -+ coex_stat->wl_connecting = false; -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], WL connecting stop!!\n"); -+ rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); -+ mutex_unlock(&rtwdev->mutex); -+} -+ -+void rtw_coex_bt_multi_link_remain_work(struct work_struct *work) -+{ -+ struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, -+ coex.bt_multi_link_remain_work.work); -+ struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; -+ -+ mutex_lock(&rtwdev->mutex); -+ coex_stat->bt_multi_link_remain = false; -+ mutex_unlock(&rtwdev->mutex); -+} -+ -+void rtw_coex_wl_ccklock_work(struct work_struct *work) -+{ -+ struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, -+ coex.wl_ccklock_work.work); -+ struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; -+ -+ mutex_lock(&rtwdev->mutex); -+ coex_stat->wl_cck_lock = false; -+ mutex_unlock(&rtwdev->mutex); -+} -+ - #ifdef CONFIG_RTW88_DEBUGFS - #define INFO_SIZE 80 - -@@ -2628,6 +3578,81 @@ static const char *rtw_coex_get_reason_string(u8 reason) - } - } - -+static u8 rtw_coex_get_table_index(struct rtw_dev *rtwdev, u32 wl_reg_6c0, -+ u32 wl_reg_6c4) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_efuse *efuse = &rtwdev->efuse; -+ u8 ans = 0xFF; -+ u8 n, i; -+ u32 load_bt_val; -+ u32 load_wl_val; -+ bool share_ant = efuse->share_ant; -+ -+ if (share_ant) -+ n = chip->table_sant_num; -+ else -+ n = chip->table_nsant_num; -+ -+ for (i = 0; i < n; i++) { -+ if (share_ant) { -+ load_bt_val = chip->table_sant[i].bt; -+ load_wl_val = chip->table_sant[i].wl; -+ } else { -+ load_bt_val = chip->table_nsant[i].bt; -+ load_wl_val = chip->table_nsant[i].wl; -+ } -+ -+ if (wl_reg_6c0 == load_bt_val && -+ wl_reg_6c4 == load_wl_val) { -+ ans = i; -+ if (!share_ant) -+ ans += 100; -+ break; -+ } -+ } -+ -+ return ans; -+} -+ -+static u8 rtw_coex_get_tdma_index(struct rtw_dev *rtwdev, u8 *tdma_para) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_efuse *efuse = &rtwdev->efuse; -+ u8 ans = 0xFF; -+ u8 n, i, j; -+ u8 load_cur_tab_val; -+ bool valid = false; -+ bool share_ant = efuse->share_ant; -+ -+ if (share_ant) -+ n = chip->tdma_sant_num; -+ else -+ n = chip->tdma_nsant_num; -+ -+ for (i = 0; i < n; i++) { -+ valid = false; -+ for (j = 0; j < 5; j++) { -+ if (share_ant) -+ load_cur_tab_val = chip->tdma_sant[i].para[j]; -+ else -+ load_cur_tab_val = chip->tdma_nsant[i].para[j]; -+ -+ if (*(tdma_para + j) != load_cur_tab_val) -+ break; -+ -+ if (j == 4) -+ valid = true; -+ } -+ if (valid) { -+ ans = i; -+ break; -+ } -+ } -+ -+ return ans; -+} -+ - static int rtw_coex_addr_info(struct rtw_dev *rtwdev, - const struct rtw_reg_domain *reg, - char addr_info[], int n) -@@ -2710,7 +3735,7 @@ static int rtw_coex_val_info(struct rtw_dev *rtwdev, - - static void rtw_coex_set_coexinfo_hw(struct rtw_dev *rtwdev, struct seq_file *m) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - const struct rtw_reg_domain *reg; - char addr_info[INFO_SIZE]; - int n_addr = 0; -@@ -2756,6 +3781,7 @@ static bool rtw_coex_get_bt_reg(struct rtw_dev *rtwdev, - - payload = get_payload_from_coex_resp(skb); - *val = GET_COEX_RESP_BT_REG_VAL(payload); -+ dev_kfree_skb_any(skb); - - return true; - } -@@ -2766,19 +3792,17 @@ static bool rtw_coex_get_bt_patch_version(struct rtw_dev *rtwdev, - struct rtw_coex_info_req req = {0}; - struct sk_buff *skb; - u8 *payload; -- bool ret = false; - - req.op_code = BT_MP_INFO_OP_PATCH_VER; - skb = rtw_coex_info_request(rtwdev, &req); - if (!skb) -- goto out; -+ return false; - - payload = get_payload_from_coex_resp(skb); - *patch_version = GET_COEX_RESP_BT_PATCH_VER(payload); -- ret = true; -+ dev_kfree_skb_any(skb); - --out: -- return ret; -+ return true; - } - - static bool rtw_coex_get_bt_supported_version(struct rtw_dev *rtwdev, -@@ -2787,19 +3811,17 @@ static bool rtw_coex_get_bt_supported_version(struct rtw_dev *rtwdev, - struct rtw_coex_info_req req = {0}; - struct sk_buff *skb; - u8 *payload; -- bool ret = false; - - req.op_code = BT_MP_INFO_OP_SUPP_VER; - skb = rtw_coex_info_request(rtwdev, &req); - if (!skb) -- goto out; -+ return false; - - payload = get_payload_from_coex_resp(skb); - *supported_version = GET_COEX_RESP_BT_SUPP_VER(payload); -- ret = true; -+ dev_kfree_skb_any(skb); - --out: -- return ret; -+ return true; - } - - static bool rtw_coex_get_bt_supported_feature(struct rtw_dev *rtwdev, -@@ -2808,19 +3830,17 @@ static bool rtw_coex_get_bt_supported_feature(struct rtw_dev *rtwdev, - struct rtw_coex_info_req req = {0}; - struct sk_buff *skb; - u8 *payload; -- bool ret = false; - - req.op_code = BT_MP_INFO_OP_SUPP_FEAT; - skb = rtw_coex_info_request(rtwdev, &req); - if (!skb) -- goto out; -+ return false; - - payload = get_payload_from_coex_resp(skb); - *supported_feature = GET_COEX_RESP_BT_SUPP_FEAT(payload); -- ret = true; -+ dev_kfree_skb_any(skb); - --out: -- return ret; -+ return true; - } - - struct rtw_coex_sta_stat_iter_data { -@@ -2873,9 +3893,23 @@ static void rtw_coex_vif_stat_iter(void *data, u8 *mac, - &sta_iter_data); - } - -+#define case_WLINK(src) \ -+ case COEX_WLINK_##src: return #src -+ -+static const char *rtw_coex_get_wl_coex_mode(u8 coex_wl_link_mode) -+{ -+ switch (coex_wl_link_mode) { -+ case_WLINK(2G1PORT); -+ case_WLINK(5G); -+ case_WLINK(2GFREE); -+ default: -+ return "Unknown"; -+ } -+} -+ - void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_dm_info *dm_info = &rtwdev->dm_info; - struct rtw_coex *coex = &rtwdev->coex; - struct rtw_coex_stat *coex_stat = &coex->stat; -@@ -2889,19 +3923,16 @@ void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) - u16 score_board_WB, score_board_BW; - u32 wl_reg_6c0, wl_reg_6c4, wl_reg_6c8, wl_reg_778, wl_reg_6cc; - u32 lte_coex, bt_coex; -- u32 bt_hi_pri, bt_lo_pri; - int i; - - score_board_BW = rtw_coex_read_scbd(rtwdev); - score_board_WB = coex_stat->score_board; -- wl_reg_6c0 = rtw_read32(rtwdev, 0x6c0); -- wl_reg_6c4 = rtw_read32(rtwdev, 0x6c4); -- wl_reg_6c8 = rtw_read32(rtwdev, 0x6c8); -- wl_reg_6cc = rtw_read32(rtwdev, 0x6cc); -- wl_reg_778 = rtw_read32(rtwdev, 0x778); -- bt_hi_pri = rtw_read32(rtwdev, 0x770); -- bt_lo_pri = rtw_read32(rtwdev, 0x774); -- rtw_write8(rtwdev, 0x76e, 0xc); -+ wl_reg_6c0 = rtw_read32(rtwdev, REG_BT_COEX_TABLE0); -+ wl_reg_6c4 = rtw_read32(rtwdev, REG_BT_COEX_TABLE1); -+ wl_reg_6c8 = rtw_read32(rtwdev, REG_BT_COEX_BRK_TABLE); -+ wl_reg_6cc = rtw_read32(rtwdev, REG_BT_COEX_TABLE_H); -+ wl_reg_778 = rtw_read8(rtwdev, REG_BT_STAT_CTRL); -+ - sys_lte = rtw_read8(rtwdev, 0x73); - lte_coex = rtw_coex_read_indirect_reg(rtwdev, 0x38); - bt_coex = rtw_coex_read_indirect_reg(rtwdev, 0x54); -@@ -2919,9 +3950,24 @@ void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) - coex_stat->bt_mailbox_reply = true; - } - -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); - seq_printf(m, "**********************************************\n"); - seq_printf(m, "\t\tBT Coexist info %x\n", chip->id); - seq_printf(m, "**********************************************\n"); -+ -+ if (coex->manual_control) { -+ seq_puts(m, "============[Under Manual Control]============\n"); -+ seq_puts(m, "==========================================\n"); -+ -+ } else if (coex->stop_dm) { -+ seq_puts(m, "============[Coex is STOPPED]============\n"); -+ seq_puts(m, "==========================================\n"); -+ -+ } else if (coex->freeze) { -+ seq_puts(m, "============[coex_freeze]============\n"); -+ seq_puts(m, "==========================================\n"); -+ } -+ - seq_printf(m, "%-40s = %s/ %d\n", - "Mech/ RFE", - efuse->share_ant ? "Shared" : "Non-Shared", -@@ -2938,15 +3984,17 @@ void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) - coex_stat->bt_slave ? "Slave" : "Master", - coex_stat->cnt_bt[COEX_CNT_BT_ROLESWITCH], - coex_dm->ignore_wl_act); -- seq_printf(m, "%-40s = %u.%u/ 0x%x/ %c\n", -- "WL FW/ BT FW/ KT", -+ seq_printf(m, "%-40s = %u.%u/ 0x%x/ 0x%x/ %c\n", -+ "WL FW/ BT FW/ BT FW Desired/ KT", - fw->version, fw->sub_version, -- coex_stat->patch_ver, coex_stat->kt_ver + 65); -+ coex_stat->patch_ver, -+ chip->wl_fw_desired_ver, coex_stat->kt_ver + 65); - seq_printf(m, "%-40s = %u/ %u/ %u/ ch-(%u)\n", - "AFH Map", - coex_dm->wl_ch_info[0], coex_dm->wl_ch_info[1], - coex_dm->wl_ch_info[2], hal->current_channel); - -+ rtw_debugfs_get_simple_phy_info(m); - seq_printf(m, "**********************************************\n"); - seq_printf(m, "\t\tBT Status\n"); - seq_printf(m, "**********************************************\n"); -@@ -2965,6 +4013,7 @@ void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) - coex_stat->bt_hid_exist ? - (coex_stat->bt_ble_exist ? "HID(RCU)," : - coex_stat->bt_hid_slot >= 2 ? "HID(4/18)" : -+ coex_stat->bt_ble_hid_exist ? "HID(BLE)" : - "HID(2/18),") : "", - coex_stat->bt_pan_exist ? coex_stat->bt_opp_exist ? - "OPP," : "PAN," : "", -@@ -2989,8 +4038,8 @@ void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) - score_board_WB, score_board_BW); - seq_printf(m, "%-40s = %u/%u, %u/%u\n", - "Hi-Pri TX/RX, Lo-Pri TX/RX", -- bt_hi_pri & 0xffff, bt_hi_pri >> 16, -- bt_lo_pri & 0xffff, bt_lo_pri >> 16); -+ coex_stat->hi_pri_tx, coex_stat->hi_pri_rx, -+ coex_stat->lo_pri_tx, coex_stat->lo_pri_rx); - for (i = 0; i < COEX_BTINFO_SRC_BT_IQK; i++) - seq_printf(m, "%-40s = %7ph\n", - rtw_coex_get_bt_info_src_string(i), -@@ -3007,7 +4056,7 @@ void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) - rtwdev->stats.tx_throughput, rtwdev->stats.rx_throughput); - seq_printf(m, "%-40s = %u/ %u/ %u\n", - "IPS/ Low Power/ PS mode", -- test_bit(RTW_FLAG_INACTIVE_PS, rtwdev->flags), -+ !test_bit(RTW_FLAG_POWERON, rtwdev->flags), - test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags), - rtwdev->lps_conf.mode); - -@@ -3015,20 +4064,45 @@ void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) - vif_iter_data.file = m; - rtw_iterate_vifs_atomic(rtwdev, rtw_coex_vif_stat_iter, &vif_iter_data); - -- seq_printf(m, "**********************************************\n"); -- seq_printf(m, "\t\tMechanism\n"); -- seq_printf(m, "**********************************************\n"); -- seq_printf(m, "%-40s = %5ph (case-%d)\n", -- "TDMA", -- coex_dm->ps_tdma_para, coex_dm->cur_ps_tdma); -- seq_printf(m, "%-40s = %d\n", -- "Timer base", coex_stat->tdma_timer_base); -- seq_printf(m, "%-40s = %d/ 0x%08x/ 0x%08x/ 0x%08x\n", -+ if (coex->manual_control) { -+ seq_printf(m, "**********************************************\n"); -+ seq_printf(m, "\t\tMechanism (Under Manual)\n"); -+ seq_printf(m, "**********************************************\n"); -+ seq_printf(m, "%-40s = %5ph (%d)\n", -+ "TDMA Now", -+ coex_dm->fw_tdma_para, -+ rtw_coex_get_tdma_index(rtwdev, -+ &coex_dm->fw_tdma_para[0])); -+ } else { -+ seq_printf(m, "**********************************************\n"); -+ seq_printf(m, "\t\tMechanism\n"); -+ seq_printf(m, "**********************************************\n"); -+ seq_printf(m, "%-40s = %5ph (case-%d)\n", -+ "TDMA", -+ coex_dm->ps_tdma_para, coex_dm->cur_ps_tdma); -+ } -+ seq_printf(m, "%-40s = %s/ %s/ %d\n", -+ "Coex Mode/Free Run/Timer base", -+ rtw_coex_get_wl_coex_mode(coex_stat->wl_coex_mode), -+ coex->freerun ? "Yes" : "No", -+ coex_stat->tdma_timer_base); -+ seq_printf(m, "%-40s = %d(%d)/ 0x%08x/ 0x%08x/ 0x%08x\n", - "Table/ 0x6c0/ 0x6c4/ 0x6c8", -- coex_dm->cur_table, wl_reg_6c0, wl_reg_6c4, wl_reg_6c8); -- seq_printf(m, "%-40s = 0x%08x/ 0x%08x/ reason (%s)\n", -- "0x778/ 0x6cc/ Reason", -- wl_reg_778, wl_reg_6cc, rtw_coex_get_reason_string(reason)); -+ coex_dm->cur_table, -+ rtw_coex_get_table_index(rtwdev, wl_reg_6c0, wl_reg_6c4), -+ wl_reg_6c0, wl_reg_6c4, wl_reg_6c8); -+ seq_printf(m, "%-40s = 0x%08x/ 0x%08x/ %d/ reason (%s)\n", -+ "0x778/ 0x6cc/ Run Count/ Reason", -+ wl_reg_778, wl_reg_6cc, -+ coex_stat->cnt_wl[COEX_CNT_WL_COEXRUN], -+ rtw_coex_get_reason_string(reason)); -+ seq_printf(m, "%-40s = %3ph\n", -+ "AFH Map to BT", -+ coex_dm->wl_ch_info); -+ seq_printf(m, "%-40s = %s/ %d\n", -+ "AntDiv/ BtCtrlLPS/ g_busy", -+ coex_stat->wl_force_lps_ctrl ? "On" : "Off", -+ coex_stat->wl_gl_busy); - seq_printf(m, "%-40s = %u/ %u/ %u/ %u/ %u\n", - "Null All/ Retry/ Ack/ BT Empty/ BT Late", - coex_stat->wl_fw_dbg_info[1], coex_stat->wl_fw_dbg_info[2], -@@ -3040,6 +4114,12 @@ void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) - coex_stat->wl_fw_dbg_info[7], - coex_stat->wl_slot_extend ? "Yes" : "No", - coex_stat->cnt_wl[COEX_CNT_WL_FW_NOTIFY]); -+ seq_printf(m, "%-40s = %d/ %d/ %s/ %d\n", -+ "WL_TxPw/ BT_TxPw/ WL_Rx/ BT_LNA_Lvl", -+ coex_dm->cur_wl_pwr_lvl, -+ coex_dm->cur_bt_pwr_lvl, -+ coex_dm->cur_wl_rx_low_gain_en ? "On" : "Off", -+ coex_dm->cur_bt_lna_lvl); - - seq_printf(m, "**********************************************\n"); - seq_printf(m, "\t\tHW setting\n"); -@@ -3074,5 +4154,22 @@ void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) - coex_stat->wl_noisy_level); - - rtw_coex_set_coexinfo_hw(rtwdev, m); -+ seq_printf(m, "%-40s = %d/ %d/ %d/ %d\n", -+ "EVM A/ EVM B/ SNR A/ SNR B", -+ -dm_info->rx_evm_dbm[RF_PATH_A], -+ -dm_info->rx_evm_dbm[RF_PATH_B], -+ -dm_info->rx_snr[RF_PATH_A], -+ -dm_info->rx_snr[RF_PATH_B]); -+ seq_printf(m, "%-40s = %d/ %d/ %d/ %d\n", -+ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", -+ dm_info->cck_cca_cnt, dm_info->cck_fa_cnt, -+ dm_info->ofdm_cca_cnt, dm_info->ofdm_fa_cnt); -+ seq_printf(m, "%-40s = %d/ %d/ %d/ %d\n", "CRC OK CCK/11g/11n/11ac", -+ dm_info->cck_ok_cnt, dm_info->ofdm_ok_cnt, -+ dm_info->ht_ok_cnt, dm_info->vht_ok_cnt); -+ seq_printf(m, "%-40s = %d/ %d/ %d/ %d\n", "CRC Err CCK/11g/11n/11ac", -+ dm_info->cck_err_cnt, dm_info->ofdm_err_cnt, -+ dm_info->ht_err_cnt, dm_info->vht_err_cnt); -+ - } - #endif /* CONFIG_RTW88_DEBUGFS */ -diff --git a/drivers/net/wireless/realtek/rtw88/coex.h b/drivers/net/wireless/realtek/rtw88/coex.h -index 44720fdfc..57cf29da9 100644 ---- a/drivers/net/wireless/realtek/rtw88/coex.h -+++ b/drivers/net/wireless/realtek/rtw88/coex.h -@@ -5,17 +5,13 @@ - #ifndef __RTW_COEX_H__ - #define __RTW_COEX_H__ - --/* BT profile map bit definition */ --#define BPM_HFP BIT(0) --#define BPM_HID BIT(1) --#define BPM_A2DP BIT(2) --#define BPM_PAN BIT(3) -- -+#define COEX_CCK_2 0x1 - #define COEX_RESP_ACK_BY_WL_FW 0x1 - #define COEX_REQUEST_TIMEOUT msecs_to_jiffies(10) - - #define COEX_MIN_DELAY 10 /* delay unit in ms */ - #define COEX_RFK_TIMEOUT 600 /* RFK timeout in ms */ -+#define COEX_BT_GAMEHID_CNT 800 - - #define COEX_RF_OFF 0x0 - #define COEX_RF_ON 0x1 -@@ -27,10 +23,19 @@ - #define COEX_H2C69_TDMA_SLOT 0xb - #define PARA1_H2C69_TDMA_4SLOT 0xc1 - #define PARA1_H2C69_TDMA_2SLOT 0x1 -+#define PARA1_H2C69_TBTT_TIMES GENMASK(5, 0) -+#define PARA1_H2C69_TBTT_DIV100 BIT(7) -+ -+#define COEX_H2C69_TOGGLE_TABLE_A 0xd -+#define COEX_H2C69_TOGGLE_TABLE_B 0x7 - - #define TDMA_4SLOT BIT(8) - -+#define TDMA_TIMER_TYPE_2SLOT 0 -+#define TDMA_TIMER_TYPE_4SLOT 3 -+ - #define COEX_RSSI_STEP 4 -+ - #define COEX_RSSI_HIGH(rssi) \ - ({ typeof(rssi) __rssi__ = rssi; \ - (__rssi__ == COEX_RSSI_STATE_HIGH || \ -@@ -146,9 +151,29 @@ enum coex_algorithm { - COEX_ALGO_MAX - }; - -+enum coex_bt_profile { -+ BPM_NOPROFILE = 0, -+ BPM_HFP = BIT(0), -+ BPM_HID = BIT(1), -+ BPM_A2DP = BIT(2), -+ BPM_PAN = BIT(3), -+ BPM_HID_HFP = BPM_HID | BPM_HFP, -+ BPM_A2DP_HFP = BPM_A2DP | BPM_HFP, -+ BPM_A2DP_HID = BPM_A2DP | BPM_HID, -+ BPM_A2DP_HID_HFP = BPM_A2DP | BPM_HID | BPM_HFP, -+ BPM_PAN_HFP = BPM_PAN | BPM_HFP, -+ BPM_PAN_HID = BPM_PAN | BPM_HID, -+ BPM_PAN_HID_HFP = BPM_PAN | BPM_HID | BPM_HFP, -+ BPM_PAN_A2DP = BPM_PAN | BPM_A2DP, -+ BPM_PAN_A2DP_HFP = BPM_PAN | BPM_A2DP | BPM_HFP, -+ BPM_PAN_A2DP_HID = BPM_PAN | BPM_A2DP | BPM_HID, -+ BPM_PAN_A2DP_HID_HFP = BPM_PAN | BPM_A2DP | BPM_HID | BPM_HFP, -+}; -+ - enum coex_wl_link_mode { - COEX_WLINK_2G1PORT = 0x0, - COEX_WLINK_5G = 0x3, -+ COEX_WLINK_2GFREE = 0x7, - COEX_WLINK_MAX - }; - -@@ -302,7 +327,7 @@ struct coex_rf_para { - - static inline void rtw_coex_set_init(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - chip->ops->coex_set_init(rtwdev); - } -@@ -310,7 +335,7 @@ static inline void rtw_coex_set_init(struct rtw_dev *rtwdev) - static inline - void rtw_coex_set_ant_switch(struct rtw_dev *rtwdev, u8 ctrl_type, u8 pos_type) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - if (!chip->ops->coex_set_ant_switch) - return; -@@ -320,28 +345,28 @@ void rtw_coex_set_ant_switch(struct rtw_dev *rtwdev, u8 ctrl_type, u8 pos_type) - - static inline void rtw_coex_set_gnt_fix(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - chip->ops->coex_set_gnt_fix(rtwdev); - } - - static inline void rtw_coex_set_gnt_debug(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - chip->ops->coex_set_gnt_debug(rtwdev); - } - - static inline void rtw_coex_set_rfe_type(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - chip->ops->coex_set_rfe_type(rtwdev); - } - - static inline void rtw_coex_set_wl_tx_power(struct rtw_dev *rtwdev, u8 wl_pwr) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - chip->ops->coex_set_wl_tx_power(rtwdev, wl_pwr); - } -@@ -349,7 +374,7 @@ static inline void rtw_coex_set_wl_tx_power(struct rtw_dev *rtwdev, u8 wl_pwr) - static inline - void rtw_coex_set_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - chip->ops->coex_set_wl_rx_gain(rtwdev, low_gain); - } -@@ -365,19 +390,33 @@ void rtw_coex_bt_reenable_work(struct work_struct *work); - void rtw_coex_defreeze_work(struct work_struct *work); - void rtw_coex_wl_remain_work(struct work_struct *work); - void rtw_coex_bt_remain_work(struct work_struct *work); -+void rtw_coex_wl_connecting_work(struct work_struct *work); -+void rtw_coex_bt_multi_link_remain_work(struct work_struct *work); -+void rtw_coex_wl_ccklock_work(struct work_struct *work); - - void rtw_coex_power_on_setting(struct rtw_dev *rtwdev); -+void rtw_coex_power_off_setting(struct rtw_dev *rtwdev); - void rtw_coex_init_hw_config(struct rtw_dev *rtwdev, bool wifi_only); - void rtw_coex_ips_notify(struct rtw_dev *rtwdev, u8 type); - void rtw_coex_lps_notify(struct rtw_dev *rtwdev, u8 type); - void rtw_coex_scan_notify(struct rtw_dev *rtwdev, u8 type); --void rtw_coex_connect_notify(struct rtw_dev *rtwdev, u8 action); --void rtw_coex_media_status_notify(struct rtw_dev *rtwdev, u8 status); --void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 len); -+void rtw_coex_connect_notify(struct rtw_dev *rtwdev, u8 type); -+void rtw_coex_media_status_notify(struct rtw_dev *rtwdev, u8 type); -+void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length); -+void rtw_coex_bt_hid_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length); - void rtw_coex_wl_fwdbginfo_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length); - void rtw_coex_switchband_notify(struct rtw_dev *rtwdev, u8 type); --void rtw_coex_wl_status_change_notify(struct rtw_dev *rtwdev); -- -+void rtw_coex_wl_status_change_notify(struct rtw_dev *rtwdev, u32 type); -+void rtw_coex_wl_status_check(struct rtw_dev *rtwdev); -+void rtw_coex_query_bt_hid_list(struct rtw_dev *rtwdev); - void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m); - -+static inline bool rtw_coex_disabled(struct rtw_dev *rtwdev) -+{ -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_stat *coex_stat = &coex->stat; -+ -+ return coex_stat->bt_disabled; -+} -+ - #endif -diff --git a/drivers/net/wireless/realtek/rtw88/compiler.h b/drivers/net/wireless/realtek/rtw88/compiler.h -new file mode 100644 -index 000000000..adcd51c87 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/compiler.h -@@ -0,0 +1,552 @@ -+#ifndef __LINUX_COMPILER_H -+#define __LINUX_COMPILER_H -+ -+#ifndef __ASSEMBLY__ -+ -+#ifdef __CHECKER__ -+# define __user __attribute__((noderef, address_space(1))) -+# define __kernel __attribute__((address_space(0))) -+# define __safe __attribute__((safe)) -+# define __force __attribute__((force)) -+# define __nocast __attribute__((nocast)) -+# define __iomem __attribute__((noderef, address_space(2))) -+# define __must_hold(x) __attribute__((context(x,1,1))) -+# define __acquires(x) __attribute__((context(x,0,1))) -+# define __releases(x) __attribute__((context(x,1,0))) -+# define __acquire(x) __context__(x,1) -+# define __release(x) __context__(x,-1) -+# define __cond_lock(x,c) ((c) ? ({ __acquire(x); 1; }) : 0) -+# define __percpu __attribute__((noderef, address_space(3))) -+#ifdef CONFIG_SPARSE_RCU_POINTER -+# define __rcu __attribute__((noderef, address_space(4))) -+#else /* CONFIG_SPARSE_RCU_POINTER */ -+# define __rcu -+#endif /* CONFIG_SPARSE_RCU_POINTER */ -+# define __private __attribute__((noderef)) -+extern void __chk_user_ptr(const volatile void __user *); -+extern void __chk_io_ptr(const volatile void __iomem *); -+# define ACCESS_PRIVATE(p, member) (*((typeof((p)->member) __force *) &(p)->member)) -+#else /* __CHECKER__ */ -+# define __user -+# define __kernel -+# define __safe -+# define __force -+# define __nocast -+# define __iomem -+# define __chk_user_ptr(x) (void)0 -+# define __chk_io_ptr(x) (void)0 -+# define __builtin_warning(x, y...) (1) -+# define __must_hold(x) -+# define __acquires(x) -+# define __releases(x) -+# define __acquire(x) (void)0 -+# define __release(x) (void)0 -+# define __cond_lock(x,c) (c) -+# define __percpu -+# define __rcu -+# define __private -+# define ACCESS_PRIVATE(p, member) ((p)->member) -+#endif /* __CHECKER__ */ -+ -+/* Indirect macros required for expanded argument pasting, eg. __LINE__. */ -+#define ___PASTE(a,b) a##b -+#define __PASTE(a,b) ___PASTE(a,b) -+ -+#ifdef __KERNEL__ -+ -+#ifdef __GNUC__ -+#include -+#endif -+ -+#if defined(CC_USING_HOTPATCH) && !defined(__CHECKER__) -+#define notrace __attribute__((hotpatch(0,0))) -+#else -+#define notrace __attribute__((no_instrument_function)) -+#endif -+ -+/* Intel compiler defines __GNUC__. So we will overwrite implementations -+ * coming from above header files here -+ */ -+#ifdef __INTEL_COMPILER -+# include -+#endif -+ -+/* Clang compiler defines __GNUC__. So we will overwrite implementations -+ * coming from above header files here -+ */ -+#ifdef __clang__ -+#include -+#endif -+ -+/* -+ * Generic compiler-dependent macros required for kernel -+ * build go below this comment. Actual compiler/compiler version -+ * specific implementations come from the above header files -+ */ -+ -+struct ftrace_branch_data { -+ const char *func; -+ const char *file; -+ unsigned line; -+ union { -+ struct { -+ unsigned long correct; -+ unsigned long incorrect; -+ }; -+ struct { -+ unsigned long miss; -+ unsigned long hit; -+ }; -+ unsigned long miss_hit[2]; -+ }; -+}; -+ -+/* -+ * Note: DISABLE_BRANCH_PROFILING can be used by special lowlevel code -+ * to disable branch tracing on a per file basis. -+ */ -+#if defined(CONFIG_TRACE_BRANCH_PROFILING) \ -+ && !defined(DISABLE_BRANCH_PROFILING) && !defined(__CHECKER__) -+void ftrace_likely_update(struct ftrace_branch_data *f, int val, int expect); -+ -+#define likely_notrace(x) __builtin_expect(!!(x), 1) -+#define unlikely_notrace(x) __builtin_expect(!!(x), 0) -+ -+#define __branch_check__(x, expect) ({ \ -+ int ______r; \ -+ static struct ftrace_branch_data \ -+ __attribute__((__aligned__(4))) \ -+ __attribute__((section("_ftrace_annotated_branch"))) \ -+ ______f = { \ -+ .func = __func__, \ -+ .file = __FILE__, \ -+ .line = __LINE__, \ -+ }; \ -+ ______r = likely_notrace(x); \ -+ ftrace_likely_update(&______f, ______r, expect); \ -+ ______r; \ -+ }) -+ -+/* -+ * Using __builtin_constant_p(x) to ignore cases where the return -+ * value is always the same. This idea is taken from a similar patch -+ * written by Daniel Walker. -+ */ -+# ifndef likely -+# define likely(x) (__builtin_constant_p(x) ? !!(x) : __branch_check__(x, 1)) -+# endif -+# ifndef unlikely -+# define unlikely(x) (__builtin_constant_p(x) ? !!(x) : __branch_check__(x, 0)) -+# endif -+ -+#ifdef CONFIG_PROFILE_ALL_BRANCHES -+/* -+ * "Define 'is'", Bill Clinton -+ * "Define 'if'", Steven Rostedt -+ */ -+#define if(cond, ...) __trace_if( (cond , ## __VA_ARGS__) ) -+#define __trace_if(cond) \ -+ if (__builtin_constant_p(!!(cond)) ? !!(cond) : \ -+ ({ \ -+ int ______r; \ -+ static struct ftrace_branch_data \ -+ __attribute__((__aligned__(4))) \ -+ __attribute__((section("_ftrace_branch"))) \ -+ ______f = { \ -+ .func = __func__, \ -+ .file = __FILE__, \ -+ .line = __LINE__, \ -+ }; \ -+ ______r = !!(cond); \ -+ ______f.miss_hit[______r]++; \ -+ ______r; \ -+ })) -+#endif /* CONFIG_PROFILE_ALL_BRANCHES */ -+ -+#else -+# define likely(x) __builtin_expect(!!(x), 1) -+# define unlikely(x) __builtin_expect(!!(x), 0) -+#endif -+ -+/* Optimization barrier */ -+#ifndef barrier -+# define barrier() __memory_barrier() -+#endif -+ -+#ifndef barrier_data -+# define barrier_data(ptr) barrier() -+#endif -+ -+/* Unreachable code */ -+#ifndef unreachable -+# define unreachable() do { } while (1) -+#endif -+ -+/* -+ * KENTRY - kernel entry point -+ * This can be used to annotate symbols (functions or data) that are used -+ * without their linker symbol being referenced explicitly. For example, -+ * interrupt vector handlers, or functions in the kernel image that are found -+ * programatically. -+ * -+ * Not required for symbols exported with EXPORT_SYMBOL, or initcalls. Those -+ * are handled in their own way (with KEEP() in linker scripts). -+ * -+ * KENTRY can be avoided if the symbols in question are marked as KEEP() in the -+ * linker script. For example an architecture could KEEP() its entire -+ * boot/exception vector code rather than annotate each function and data. -+ */ -+#ifndef KENTRY -+# define KENTRY(sym) \ -+ extern typeof(sym) sym; \ -+ static const unsigned long __kentry_##sym \ -+ __used \ -+ __attribute__((section("___kentry" "+" #sym ), used)) \ -+ = (unsigned long)&sym; -+#endif -+ -+#ifndef RELOC_HIDE -+# define RELOC_HIDE(ptr, off) \ -+ ({ unsigned long __ptr; \ -+ __ptr = (unsigned long) (ptr); \ -+ (typeof(ptr)) (__ptr + (off)); }) -+#endif -+ -+#ifndef OPTIMIZER_HIDE_VAR -+#define OPTIMIZER_HIDE_VAR(var) barrier() -+#endif -+ -+/* Not-quite-unique ID. */ -+#ifndef __UNIQUE_ID -+# define __UNIQUE_ID(prefix) __PASTE(__PASTE(__UNIQUE_ID_, prefix), __LINE__) -+#endif -+ -+#include -+ -+#define __READ_ONCE_SIZE \ -+({ \ -+ switch (size) { \ -+ case 1: *(__u8 *)res = *(volatile __u8 *)p; break; \ -+ case 2: *(__u16 *)res = *(volatile __u16 *)p; break; \ -+ case 4: *(__u32 *)res = *(volatile __u32 *)p; break; \ -+ case 8: *(__u64 *)res = *(volatile __u64 *)p; break; \ -+ default: \ -+ barrier(); \ -+ __builtin_memcpy((void *)res, (const void *)p, size); \ -+ barrier(); \ -+ } \ -+}) -+ -+static __always_inline -+void __read_once_size(const volatile void *p, void *res, int size) -+{ -+ __READ_ONCE_SIZE; -+} -+ -+#ifdef CONFIG_KASAN -+/* -+ * This function is not 'inline' because __no_sanitize_address confilcts -+ * with inlining. Attempt to inline it may cause a build failure. -+ * https://gcc.gnu.org/bugzilla/show_bug.cgi?id=67368 -+ * '__maybe_unused' allows us to avoid defined-but-not-used warnings. -+ */ -+static __no_sanitize_address __maybe_unused -+void __read_once_size_nocheck(const volatile void *p, void *res, int size) -+{ -+ __READ_ONCE_SIZE; -+} -+#else -+static __always_inline -+void __read_once_size_nocheck(const volatile void *p, void *res, int size) -+{ -+ __READ_ONCE_SIZE; -+} -+#endif -+ -+static __always_inline void __write_once_size(volatile void *p, void *res, int size) -+{ -+ switch (size) { -+ case 1: *(volatile __u8 *)p = *(__u8 *)res; break; -+ case 2: *(volatile __u16 *)p = *(__u16 *)res; break; -+ case 4: *(volatile __u32 *)p = *(__u32 *)res; break; -+ case 8: *(volatile __u64 *)p = *(__u64 *)res; break; -+ default: -+ barrier(); -+ __builtin_memcpy((void *)p, (const void *)res, size); -+ barrier(); -+ } -+} -+ -+/* -+ * Prevent the compiler from merging or refetching reads or writes. The -+ * compiler is also forbidden from reordering successive instances of -+ * READ_ONCE, WRITE_ONCE and ACCESS_ONCE (see below), but only when the -+ * compiler is aware of some particular ordering. One way to make the -+ * compiler aware of ordering is to put the two invocations of READ_ONCE, -+ * WRITE_ONCE or ACCESS_ONCE() in different C statements. -+ * -+ * In contrast to ACCESS_ONCE these two macros will also work on aggregate -+ * data types like structs or unions. If the size of the accessed data -+ * type exceeds the word size of the machine (e.g., 32 bits or 64 bits) -+ * READ_ONCE() and WRITE_ONCE() will fall back to memcpy(). There's at -+ * least two memcpy()s: one for the __builtin_memcpy() and then one for -+ * the macro doing the copy of variable - '__u' allocated on the stack. -+ * -+ * Their two major use cases are: (1) Mediating communication between -+ * process-level code and irq/NMI handlers, all running on the same CPU, -+ * and (2) Ensuring that the compiler does not fold, spindle, or otherwise -+ * mutilate accesses that either do not require ordering or that interact -+ * with an explicit memory barrier or atomic instruction that provides the -+ * required ordering. -+ */ -+ -+#define __READ_ONCE(x, check) \ -+({ \ -+ union { typeof(x) __val; char __c[1]; } __u; \ -+ if (check) \ -+ __read_once_size(&(x), __u.__c, sizeof(x)); \ -+ else \ -+ __read_once_size_nocheck(&(x), __u.__c, sizeof(x)); \ -+ __u.__val; \ -+}) -+#define READ_ONCE(x) __READ_ONCE(x, 1) -+ -+/* -+ * Use READ_ONCE_NOCHECK() instead of READ_ONCE() if you need -+ * to hide memory access from KASAN. -+ */ -+#define READ_ONCE_NOCHECK(x) __READ_ONCE(x, 0) -+ -+#define WRITE_ONCE(x, val) \ -+({ \ -+ union { typeof(x) __val; char __c[1]; } __u = \ -+ { .__val = (__force typeof(x)) (val) }; \ -+ __write_once_size(&(x), __u.__c, sizeof(x)); \ -+ __u.__val; \ -+}) -+ -+#endif /* __KERNEL__ */ -+ -+#endif /* __ASSEMBLY__ */ -+ -+#ifdef __KERNEL__ -+/* -+ * Allow us to mark functions as 'deprecated' and have gcc emit a nice -+ * warning for each use, in hopes of speeding the functions removal. -+ * Usage is: -+ * int __deprecated foo(void) -+ */ -+#ifndef __deprecated -+# define __deprecated /* unimplemented */ -+#endif -+ -+#ifdef MODULE -+#define __deprecated_for_modules __deprecated -+#else -+#define __deprecated_for_modules -+#endif -+ -+#ifndef __must_check -+#define __must_check -+#endif -+ -+#ifndef CONFIG_ENABLE_MUST_CHECK -+#undef __must_check -+#define __must_check -+#endif -+#ifndef CONFIG_ENABLE_WARN_DEPRECATED -+#undef __deprecated -+#undef __deprecated_for_modules -+#define __deprecated -+#define __deprecated_for_modules -+#endif -+ -+#ifndef __malloc -+#define __malloc -+#endif -+ -+/* -+ * Allow us to avoid 'defined but not used' warnings on functions and data, -+ * as well as force them to be emitted to the assembly file. -+ * -+ * As of gcc 3.4, static functions that are not marked with attribute((used)) -+ * may be elided from the assembly file. As of gcc 3.4, static data not so -+ * marked will not be elided, but this may change in a future gcc version. -+ * -+ * NOTE: Because distributions shipped with a backported unit-at-a-time -+ * compiler in gcc 3.3, we must define __used to be __attribute__((used)) -+ * for gcc >=3.3 instead of 3.4. -+ * -+ * In prior versions of gcc, such functions and data would be emitted, but -+ * would be warned about except with attribute((unused)). -+ * -+ * Mark functions that are referenced only in inline assembly as __used so -+ * the code is emitted even though it appears to be unreferenced. -+ */ -+#ifndef __used -+# define __used /* unimplemented */ -+#endif -+ -+#ifndef __maybe_unused -+# define __maybe_unused /* unimplemented */ -+#endif -+ -+#ifndef __always_unused -+# define __always_unused /* unimplemented */ -+#endif -+ -+#ifndef noinline -+#define noinline -+#endif -+ -+/* -+ * Rather then using noinline to prevent stack consumption, use -+ * noinline_for_stack instead. For documentation reasons. -+ */ -+#define noinline_for_stack noinline -+ -+#ifndef __always_inline -+#define __always_inline inline -+#endif -+ -+#endif /* __KERNEL__ */ -+ -+/* -+ * From the GCC manual: -+ * -+ * Many functions do not examine any values except their arguments, -+ * and have no effects except the return value. Basically this is -+ * just slightly more strict class than the `pure' attribute above, -+ * since function is not allowed to read global memory. -+ * -+ * Note that a function that has pointer arguments and examines the -+ * data pointed to must _not_ be declared `const'. Likewise, a -+ * function that calls a non-`const' function usually must not be -+ * `const'. It does not make sense for a `const' function to return -+ * `void'. -+ */ -+#ifndef __attribute_const__ -+# define __attribute_const__ /* unimplemented */ -+#endif -+ -+#ifndef __latent_entropy -+# define __latent_entropy -+#endif -+ -+/* -+ * Tell gcc if a function is cold. The compiler will assume any path -+ * directly leading to the call is unlikely. -+ */ -+ -+#ifndef __cold -+#define __cold -+#endif -+ -+/* Simple shorthand for a section definition */ -+#ifndef __section -+# define __section(S) __attribute__ ((__section__(#S))) -+#endif -+ -+#ifndef __visible -+#define __visible -+#endif -+ -+/* -+ * Assume alignment of return value. -+ */ -+#ifndef __assume_aligned -+#define __assume_aligned(a, ...) -+#endif -+ -+ -+/* Are two types/vars the same type (ignoring qualifiers)? */ -+#ifndef __same_type -+# define __same_type(a, b) __builtin_types_compatible_p(typeof(a), typeof(b)) -+#endif -+ -+/* Is this type a native word size -- useful for atomic operations */ -+#ifndef __native_word -+# define __native_word(t) (sizeof(t) == sizeof(char) || sizeof(t) == sizeof(short) || sizeof(t) == sizeof(int) || sizeof(t) == sizeof(long)) -+#endif -+ -+/* Compile time object size, -1 for unknown */ -+#ifndef __compiletime_object_size -+# define __compiletime_object_size(obj) -1 -+#endif -+#ifndef __compiletime_warning -+# define __compiletime_warning(message) -+#endif -+#ifndef __compiletime_error -+# define __compiletime_error(message) -+# ifndef __CHECKER__ -+# define __compiletime_error_fallback(condition) \ -+ do { ((void)sizeof(char[1 - 2 * condition])); } while (0) -+# endif -+#endif -+#ifndef __compiletime_error_fallback -+# define __compiletime_error_fallback(condition) do { } while (0) -+#endif -+ -+/* -+ * Prevent the compiler from merging or refetching accesses. The compiler -+ * is also forbidden from reordering successive instances of ACCESS_ONCE(), -+ * but only when the compiler is aware of some particular ordering. One way -+ * to make the compiler aware of ordering is to put the two invocations of -+ * ACCESS_ONCE() in different C statements. -+ * -+ * ACCESS_ONCE will only work on scalar types. For union types, ACCESS_ONCE -+ * on a union member will work as long as the size of the member matches the -+ * size of the union and the size is smaller than word size. -+ * -+ * The major use cases of ACCESS_ONCE used to be (1) Mediating communication -+ * between process-level code and irq/NMI handlers, all running on the same CPU, -+ * and (2) Ensuring that the compiler does not fold, spindle, or otherwise -+ * mutilate accesses that either do not require ordering or that interact -+ * with an explicit memory barrier or atomic instruction that provides the -+ * required ordering. -+ * -+ * If possible use READ_ONCE()/WRITE_ONCE() instead. -+ */ -+#define __ACCESS_ONCE(x) ({ \ -+ __maybe_unused typeof(x) __var = (__force typeof(x)) 0; \ -+ (volatile typeof(x) *)&(x); }) -+#define ACCESS_ONCE(x) (*__ACCESS_ONCE(x)) -+ -+/** -+ * lockless_dereference() - safely load a pointer for later dereference -+ * @p: The pointer to load -+ * -+ * Similar to rcu_dereference(), but for situations where the pointed-to -+ * object's lifetime is managed by something other than RCU. That -+ * "something other" might be reference counting or simple immortality. -+ * -+ * The seemingly unused variable ___typecheck_p validates that @p is -+ * indeed a pointer type by using a pointer to typeof(*p) as the type. -+ * Taking a pointer to typeof(*p) again is needed in case p is void *. -+ */ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0) -+#define lockless_dereference(p) \ -+({ \ -+ typeof(p) _________p1 = READ_ONCE(p); \ -+ typeof(*(p)) *___typecheck_p __maybe_unused; \ -+ smp_read_barrier_depends(); /* Dependency order vs. p above. */ \ -+ (_________p1); \ -+}) -+#else -+#define lockless_dereference(p) \ -+({ \ -+ typeof(p) _________p1 = READ_ONCE(p); \ -+ smp_read_barrier_depends(); /* Dependency order vs. p above. */ \ -+ (_________p1); \ -+}) -+#endif -+ -+/* Ignore/forbid kprobes attach on very low level functions marked by this attribute: */ -+#ifdef CONFIG_KPROBES -+# define __kprobes __attribute__((__section__(".kprobes.text"))) -+# define nokprobe_inline __always_inline -+#else -+# define __kprobes -+# define nokprobe_inline inline -+#endif -+#endif /* __LINUX_COMPILER_H */ -diff --git a/drivers/net/wireless/realtek/rtw88/debug.c b/drivers/net/wireless/realtek/rtw88/debug.c -index 83413cda9..8fa8ddb99 100644 ---- a/drivers/net/wireless/realtek/rtw88/debug.c -+++ b/drivers/net/wireless/realtek/rtw88/debug.c -@@ -10,6 +10,9 @@ - #include "fw.h" - #include "debug.h" - #include "phy.h" -+#include "reg.h" -+#include "ps.h" -+#include "regd.h" - - #ifdef CONFIG_RTW88_DEBUGFS - -@@ -34,9 +37,17 @@ struct rtw_debugfs_priv { - u32 addr; - u32 len; - } read_reg; -+ struct { -+ u8 bit; -+ } dm_cap; - }; - }; - -+static const char * const rtw_dm_cap_strs[] = { -+ [RTW_DM_CAP_NA] = "NA", -+ [RTW_DM_CAP_TXGAPK] = "TXGAPK", -+}; -+ - static int rtw_debugfs_single_show(struct seq_file *m, void *v) - { - struct rtw_debugfs_priv *debugfs_priv = m->private; -@@ -133,7 +144,9 @@ static int rtw_debugfs_get_rf_read(struct seq_file *m, void *v) - addr = debugfs_priv->rf_addr; - mask = debugfs_priv->rf_mask; - -+ mutex_lock(&rtwdev->mutex); - val = rtw_read_rf(rtwdev, path, addr, mask); -+ mutex_unlock(&rtwdev->mutex); - - seq_printf(m, "rf_read path:%d addr:0x%08x mask:0x%08x val=0x%08x\n", - path, addr, mask, val); -@@ -141,6 +154,22 @@ static int rtw_debugfs_get_rf_read(struct seq_file *m, void *v) - return 0; - } - -+static int rtw_debugfs_get_fix_rate(struct seq_file *m, void *v) -+{ -+ struct rtw_debugfs_priv *debugfs_priv = m->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ u8 fix_rate = dm_info->fix_rate; -+ -+ if (fix_rate >= DESC_RATE_MAX) { -+ seq_printf(m, "Fix rate disabled, fix_rate = %u\n", fix_rate); -+ return 0; -+ } -+ -+ seq_printf(m, "Data frames fixed at desc rate %u\n", fix_rate); -+ return 0; -+} -+ - static int rtw_debugfs_copy_from_user(char tmp[], int size, - const char __user *buffer, size_t count, - int num) -@@ -154,8 +183,8 @@ static int rtw_debugfs_copy_from_user(char tmp[], int size, - - tmp_len = (count > size - 1 ? size - 1 : count); - -- if (!buffer || copy_from_user(tmp, buffer, tmp_len)) -- return count; -+ if (copy_from_user(tmp, buffer, tmp_len)) -+ return -EFAULT; - - tmp[tmp_len] = '\0'; - -@@ -172,13 +201,16 @@ static ssize_t rtw_debugfs_set_read_reg(struct file *filp, - char tmp[32 + 1]; - u32 addr, len; - int num; -+ int ret; - -- rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 2); -+ ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 2); -+ if (ret) -+ return ret; - - num = sscanf(tmp, "%x %x", &addr, &len); - - if (num != 2) -- return count; -+ return -EINVAL; - - if (len != 1 && len != 2 && len != 4) { - rtw_warn(rtwdev, "read reg setting wrong len\n"); -@@ -242,11 +274,7 @@ static int rtw_debugfs_get_rsvd_page(struct seq_file *m, void *v) - for (i = 0 ; i < buf_size ; i += 8) { - if (i % page_size == 0) - seq_printf(m, "PAGE %d\n", (i + offset) / page_size); -- seq_printf(m, "%2.2x %2.2x %2.2x %2.2x %2.2x %2.2x %2.2x %2.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)); -+ seq_printf(m, "%8ph\n", buf + i); - } - vfree(buf); - -@@ -263,8 +291,11 @@ static ssize_t rtw_debugfs_set_rsvd_page(struct file *filp, - char tmp[32 + 1]; - u32 offset, page_num; - int num; -+ int ret; - -- rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 2); -+ ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 2); -+ if (ret) -+ return ret; - - num = sscanf(tmp, "%d %d", &offset, &page_num); - -@@ -289,8 +320,11 @@ static ssize_t rtw_debugfs_set_single_input(struct file *filp, - char tmp[32 + 1]; - u32 input; - int num; -+ int ret; - -- rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 1); -+ ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 1); -+ if (ret) -+ return ret; - - num = kstrtoint(tmp, 0, &input); - -@@ -313,14 +347,17 @@ static ssize_t rtw_debugfs_set_write_reg(struct file *filp, - char tmp[32 + 1]; - u32 addr, val, len; - int num; -+ int ret; - -- rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 3); -+ ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 3); -+ if (ret) -+ return ret; - - /* write BB/MAC register */ - num = sscanf(tmp, "%x %x %x", &addr, &val, &len); - - if (num != 3) -- return count; -+ return -EINVAL; - - switch (len) { - case 1: -@@ -356,18 +393,23 @@ static ssize_t rtw_debugfs_set_h2c(struct file *filp, - char tmp[32 + 1]; - u8 param[8]; - int num; -+ int ret; - -- rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 3); -+ ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 3); -+ if (ret) -+ return ret; - - num = sscanf(tmp, "%hhx,%hhx,%hhx,%hhx,%hhx,%hhx,%hhx,%hhx", - ¶m[0], ¶m[1], ¶m[2], ¶m[3], - ¶m[4], ¶m[5], ¶m[6], ¶m[7]); - if (num != 8) { -- rtw_info(rtwdev, "invalid H2C command format for debug\n"); -+ rtw_warn(rtwdev, "invalid H2C command format for debug\n"); - return -EINVAL; - } - -+ mutex_lock(&rtwdev->mutex); - rtw_fw_h2c_cmd_dbg(rtwdev, param); -+ mutex_unlock(&rtwdev->mutex); - - return count; - } -@@ -381,17 +423,22 @@ static ssize_t rtw_debugfs_set_rf_write(struct file *filp, - char tmp[32 + 1]; - u32 path, addr, mask, val; - int num; -+ int ret; - -- rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 4); -+ ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 4); -+ if (ret) -+ return ret; - - num = sscanf(tmp, "%x %x %x %x", &path, &addr, &mask, &val); - - if (num != 4) { - rtw_warn(rtwdev, "invalid args, [path] [addr] [mask] [val]\n"); -- return count; -+ return -EINVAL; - } - -+ mutex_lock(&rtwdev->mutex); - rtw_write_rf(rtwdev, path, addr, mask, val); -+ mutex_unlock(&rtwdev->mutex); - rtw_dbg(rtwdev, RTW_DBG_DEBUGFS, - "write_rf path:%d addr:0x%08x mask:0x%08x, val:0x%08x\n", - path, addr, mask, val); -@@ -409,14 +456,17 @@ static ssize_t rtw_debugfs_set_rf_read(struct file *filp, - char tmp[32 + 1]; - u32 path, addr, mask; - int num; -+ int ret; - -- rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 3); -+ ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 3); -+ if (ret) -+ return ret; - - num = sscanf(tmp, "%x %x %x", &path, &addr, &mask); - - if (num != 3) { - rtw_warn(rtwdev, "invalid args, [path] [addr] [mask] [val]\n"); -- return count; -+ return -EINVAL; - } - - debugfs_priv->rf_path = path; -@@ -426,6 +476,33 @@ static ssize_t rtw_debugfs_set_rf_read(struct file *filp, - return count; - } - -+static ssize_t rtw_debugfs_set_fix_rate(struct file *filp, -+ const char __user *buffer, -+ size_t count, loff_t *loff) -+{ -+ struct seq_file *seqpriv = (struct seq_file *)filp->private_data; -+ struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ u8 fix_rate; -+ char tmp[32 + 1]; -+ int ret; -+ -+ ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 1); -+ if (ret) -+ return ret; -+ -+ ret = kstrtou8(tmp, 0, &fix_rate); -+ if (ret) { -+ rtw_warn(rtwdev, "invalid args, [rate]\n"); -+ return ret; -+ } -+ -+ dm_info->fix_rate = fix_rate; -+ -+ return count; -+} -+ - static int rtw_debug_get_mac_page(struct seq_file *m, void *v) - { - struct rtw_debugfs_priv *debugfs_priv = m->private; -@@ -471,6 +548,8 @@ static int rtw_debug_get_rf_dump(struct seq_file *m, void *v) - u32 addr, offset, data; - u8 path; - -+ mutex_lock(&rtwdev->mutex); -+ - for (path = 0; path < rtwdev->hal.rf_path_num; path++) { - seq_printf(m, "RF path:%d\n", path); - for (addr = 0; addr < 0x100; addr += 4) { -@@ -485,6 +564,8 @@ static int rtw_debug_get_rf_dump(struct seq_file *m, void *v) - seq_puts(m, "\n"); - } - -+ mutex_unlock(&rtwdev->mutex); -+ - return 0; - } - -@@ -573,15 +654,19 @@ static int rtw_debugfs_get_tx_pwr_tbl(struct seq_file *m, void *v) - struct rtw_debugfs_priv *debugfs_priv = m->private; - struct rtw_dev *rtwdev = debugfs_priv->rtwdev; - struct rtw_hal *hal = &rtwdev->hal; -- u8 path, rate; -+ u8 path, rate, bw, ch, regd; - struct rtw_power_params pwr_param = {0}; -- u8 bw = hal->current_band_width; -- u8 ch = hal->current_channel; -- u8 regd = rtwdev->regd.txpwr_regd; - -+ mutex_lock(&rtwdev->mutex); -+ bw = hal->current_band_width; -+ ch = hal->current_channel; -+ regd = rtw_regd_get(rtwdev); -+ -+ seq_printf(m, "channel: %u\n", ch); -+ seq_printf(m, "bandwidth: %u\n", bw); - seq_printf(m, "regulatory: %s\n", rtw_get_regd_string(regd)); -- seq_printf(m, "%-4s %-10s %-3s%6s %-4s %4s (%-4s %-4s) %-4s\n", -- "path", "rate", "pwr", "", "base", "", "byr", "lmt", "rem"); -+ seq_printf(m, "%-4s %-10s %-9s %-9s (%-4s %-4s %-4s) %-4s\n", -+ "path", "rate", "pwr", "base", "byr", "lmt", "sar", "rem"); - - mutex_lock(&hal->tx_power_mutex); - for (path = RF_PATH_A; path <= RF_PATH_B; path++) { -@@ -603,22 +688,48 @@ static int rtw_debugfs_get_tx_pwr_tbl(struct seq_file *m, void *v) - - seq_printf(m, "%4c ", path + 'A'); - rtw_print_rate(m, rate); -- seq_printf(m, " %3u(0x%02x) %4u %4d (%4d %4d) %4d\n", -+ seq_printf(m, " %3u(0x%02x) %4u %4d (%4d %4d %4d) %4d\n", - hal->tx_pwr_tbl[path][rate], - hal->tx_pwr_tbl[path][rate], - pwr_param.pwr_base, -- min_t(s8, pwr_param.pwr_offset, -- pwr_param.pwr_limit), -+ min3(pwr_param.pwr_offset, -+ pwr_param.pwr_limit, -+ pwr_param.pwr_sar), - pwr_param.pwr_offset, pwr_param.pwr_limit, -+ pwr_param.pwr_sar, - pwr_param.pwr_remnant); - } - } - - mutex_unlock(&hal->tx_power_mutex); -+ mutex_unlock(&rtwdev->mutex); - - return 0; - } - -+void rtw_debugfs_get_simple_phy_info(struct seq_file *m) -+{ -+ struct rtw_debugfs_priv *debugfs_priv = m->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ struct rtw_hal *hal = &rtwdev->hal; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ struct rtw_traffic_stats *stats = &rtwdev->stats; -+ -+ seq_printf(m, "%-40s = %ddBm/ %d\n", "RSSI/ STA Channel", -+ dm_info->rssi[RF_PATH_A] - 100, hal->current_channel); -+ -+ seq_printf(m, "TP {Tx, Rx} = {%u, %u}Mbps\n", -+ stats->tx_throughput, stats->rx_throughput); -+ -+ seq_puts(m, "[Tx Rate] = "); -+ rtw_print_rate(m, dm_info->tx_rate); -+ seq_printf(m, "(0x%x)\n", dm_info->tx_rate); -+ -+ seq_puts(m, "[Rx Rate] = "); -+ rtw_print_rate(m, dm_info->curr_rx_rate); -+ seq_printf(m, "(0x%x)\n", dm_info->curr_rx_rate); -+} -+ - static int rtw_debugfs_get_phy_info(struct seq_file *m, void *v) - { - struct rtw_debugfs_priv *debugfs_priv = m->private; -@@ -636,8 +747,10 @@ static int rtw_debugfs_get_phy_info(struct seq_file *m, void *v) - seq_printf(m, "Current CH(fc) = %u\n", rtwdev->hal.current_channel); - seq_printf(m, "Current BW = %u\n", rtwdev->hal.current_band_width); - seq_printf(m, "Current IGI = 0x%x\n", dm_info->igi_history[0]); -- seq_printf(m, "TP {Tx, Rx} = {%u, %u}Mbps\n\n", -+ seq_printf(m, "TP {Tx, Rx} = {%u, %u}Mbps\n", - stats->tx_throughput, stats->rx_throughput); -+ seq_printf(m, "1SS for TX and RX = %c\n\n", rtwdev->hal.txrx_1ss ? -+ 'Y' : 'N'); - - seq_puts(m, "==========[Tx Phy Info]========\n"); - seq_puts(m, "[Tx Rate] = "); -@@ -751,7 +864,9 @@ static int rtw_debugfs_get_coex_info(struct seq_file *m, void *v) - struct rtw_debugfs_priv *debugfs_priv = m->private; - struct rtw_dev *rtwdev = debugfs_priv->rtwdev; - -+ mutex_lock(&rtwdev->mutex); - rtw_coex_display_coex_info(rtwdev, m); -+ mutex_unlock(&rtwdev->mutex); - - return 0; - } -@@ -768,7 +883,9 @@ static ssize_t rtw_debugfs_set_coex_enable(struct file *filp, - bool enable; - int ret; - -- rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 1); -+ ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 1); -+ if (ret) -+ return ret; - - ret = kstrtobool(tmp, &enable); - if (ret) { -@@ -777,7 +894,7 @@ static ssize_t rtw_debugfs_set_coex_enable(struct file *filp, - } - - mutex_lock(&rtwdev->mutex); -- coex->stop_dm = enable == 0; -+ coex->manual_control = !enable; - mutex_unlock(&rtwdev->mutex); - - return count; -@@ -790,11 +907,201 @@ static int rtw_debugfs_get_coex_enable(struct seq_file *m, void *v) - struct rtw_coex *coex = &rtwdev->coex; - - seq_printf(m, "coex mechanism %s\n", -- coex->stop_dm ? "disabled" : "enabled"); -+ coex->manual_control ? "disabled" : "enabled"); - - return 0; - } - -+static ssize_t rtw_debugfs_set_edcca_enable(struct file *filp, -+ const char __user *buffer, -+ size_t count, loff_t *loff) -+{ -+ struct seq_file *seqpriv = (struct seq_file *)filp->private_data; -+ struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ bool input; -+ int err; -+ -+ err = kstrtobool_from_user(buffer, count, &input); -+ if (err) -+ return err; -+ -+ rtw_edcca_enabled = input; -+ rtw_phy_adaptivity_set_mode(rtwdev); -+ -+ return count; -+} -+ -+static int rtw_debugfs_get_edcca_enable(struct seq_file *m, void *v) -+{ -+ struct rtw_debugfs_priv *debugfs_priv = m->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ -+ seq_printf(m, "EDCCA %s: EDCCA mode %d\n", -+ rtw_edcca_enabled ? "enabled" : "disabled", -+ dm_info->edcca_mode); -+ return 0; -+} -+ -+static ssize_t rtw_debugfs_set_fw_crash(struct file *filp, -+ const char __user *buffer, -+ size_t count, loff_t *loff) -+{ -+ struct seq_file *seqpriv = (struct seq_file *)filp->private_data; -+ struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ char tmp[32 + 1]; -+ bool input; -+ int ret; -+ -+ ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 1); -+ if (ret) -+ return ret; -+ -+ ret = kstrtobool(tmp, &input); -+ if (ret) -+ return -EINVAL; -+ -+ if (!input) -+ return -EINVAL; -+ -+ if (test_bit(RTW_FLAG_RESTARTING, rtwdev->flags)) -+ return -EINPROGRESS; -+ -+ mutex_lock(&rtwdev->mutex); -+ rtw_leave_lps_deep(rtwdev); -+ set_bit(RTW_FLAG_RESTART_TRIGGERING, rtwdev->flags); -+ rtw_write8(rtwdev, REG_HRCV_MSG, 1); -+ mutex_unlock(&rtwdev->mutex); -+ -+ return count; -+} -+ -+static int rtw_debugfs_get_fw_crash(struct seq_file *m, void *v) -+{ -+ struct rtw_debugfs_priv *debugfs_priv = m->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ -+ seq_printf(m, "%d\n", -+ test_bit(RTW_FLAG_RESTART_TRIGGERING, rtwdev->flags) || -+ test_bit(RTW_FLAG_RESTARTING, rtwdev->flags)); -+ return 0; -+} -+ -+static ssize_t rtw_debugfs_set_force_lowest_basic_rate(struct file *filp, -+ const char __user *buffer, -+ size_t count, loff_t *loff) -+{ -+ struct seq_file *seqpriv = (struct seq_file *)filp->private_data; -+ struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ bool input; -+ int err; -+ -+ err = kstrtobool_from_user(buffer, count, &input); -+ if (err) -+ return err; -+ -+ if (input) -+ set_bit(RTW_FLAG_FORCE_LOWEST_RATE, rtwdev->flags); -+ else -+ clear_bit(RTW_FLAG_FORCE_LOWEST_RATE, rtwdev->flags); -+ -+ return count; -+} -+ -+static int rtw_debugfs_get_force_lowest_basic_rate(struct seq_file *m, void *v) -+{ -+ struct rtw_debugfs_priv *debugfs_priv = m->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ -+ seq_printf(m, "force lowest basic rate: %d\n", -+ test_bit(RTW_FLAG_FORCE_LOWEST_RATE, rtwdev->flags)); -+ -+ return 0; -+} -+ -+static ssize_t rtw_debugfs_set_dm_cap(struct file *filp, -+ const char __user *buffer, -+ size_t count, loff_t *loff) -+{ -+ struct seq_file *seqpriv = (struct seq_file *)filp->private_data; -+ struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ int bit; -+ bool en; -+ -+ if (kstrtoint_from_user(buffer, count, 10, &bit)) -+ return -EINVAL; -+ -+ en = bit > 0; -+ bit = abs(bit); -+ -+ if (bit >= RTW_DM_CAP_NUM) { -+ rtw_warn(rtwdev, "unknown DM CAP %d\n", bit); -+ return -EINVAL; -+ } -+ -+ if (en) -+ dm_info->dm_flags &= ~BIT(bit); -+ else -+ dm_info->dm_flags |= BIT(bit); -+ -+ debugfs_priv->dm_cap.bit = bit; -+ -+ return count; -+} -+ -+static void dump_gapk_status(struct rtw_dev *rtwdev, struct seq_file *m) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; -+ int i, path; -+ u32 val; -+ -+ seq_printf(m, "\n(%2d) %c%s\n\n", RTW_DM_CAP_TXGAPK, -+ dm_info->dm_flags & BIT(RTW_DM_CAP_TXGAPK) ? '-' : '+', -+ rtw_dm_cap_strs[RTW_DM_CAP_TXGAPK]); -+ -+ mutex_lock(&rtwdev->mutex); -+ -+ for (path = 0; path < rtwdev->hal.rf_path_num; path++) { -+ val = rtw_read_rf(rtwdev, path, RF_GAINTX, RFREG_MASK); -+ seq_printf(m, "path %d:\n0x%x = 0x%x\n", path, RF_GAINTX, val); -+ -+ for (i = 0; i < RF_HW_OFFSET_NUM; i++) -+ seq_printf(m, "[TXGAPK] offset %d %d\n", -+ txgapk->rf3f_fs[path][i], i); -+ seq_puts(m, "\n"); -+ } -+ mutex_unlock(&rtwdev->mutex); -+} -+ -+static int rtw_debugfs_get_dm_cap(struct seq_file *m, void *v) -+{ -+ struct rtw_debugfs_priv *debugfs_priv = m->private; -+ struct rtw_dev *rtwdev = debugfs_priv->rtwdev; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ int i; -+ -+ switch (debugfs_priv->dm_cap.bit) { -+ case RTW_DM_CAP_TXGAPK: -+ dump_gapk_status(rtwdev, m); -+ break; -+ default: -+ for (i = 1; i < RTW_DM_CAP_NUM; i++) { -+ seq_printf(m, "(%2d) %c%s\n", i, -+ dm_info->dm_flags & BIT(i) ? '-' : '+', -+ rtw_dm_cap_strs[i]); -+ } -+ break; -+ } -+ debugfs_priv->dm_cap.bit = RTW_DM_CAP_NA; -+ return 0; -+} -+ - #define rtw_debug_impl_mac(page, addr) \ - static struct rtw_debugfs_priv rtw_debug_priv_mac_ ##page = { \ - .cb_read = rtw_debug_get_mac_page, \ -@@ -875,6 +1182,11 @@ static struct rtw_debugfs_priv rtw_debug_priv_read_reg = { - .cb_read = rtw_debugfs_get_read_reg, - }; - -+static struct rtw_debugfs_priv rtw_debug_priv_fix_rate = { -+ .cb_write = rtw_debugfs_set_fix_rate, -+ .cb_read = rtw_debugfs_get_fix_rate, -+}; -+ - static struct rtw_debugfs_priv rtw_debug_priv_dump_cam = { - .cb_write = rtw_debugfs_set_single_input, - .cb_read = rtw_debugfs_get_dump_cam, -@@ -898,6 +1210,26 @@ static struct rtw_debugfs_priv rtw_debug_priv_coex_info = { - .cb_read = rtw_debugfs_get_coex_info, - }; - -+static struct rtw_debugfs_priv rtw_debug_priv_edcca_enable = { -+ .cb_write = rtw_debugfs_set_edcca_enable, -+ .cb_read = rtw_debugfs_get_edcca_enable, -+}; -+ -+static struct rtw_debugfs_priv rtw_debug_priv_fw_crash = { -+ .cb_write = rtw_debugfs_set_fw_crash, -+ .cb_read = rtw_debugfs_get_fw_crash, -+}; -+ -+static struct rtw_debugfs_priv rtw_debug_priv_force_lowest_basic_rate = { -+ .cb_write = rtw_debugfs_set_force_lowest_basic_rate, -+ .cb_read = rtw_debugfs_get_force_lowest_basic_rate, -+}; -+ -+static struct rtw_debugfs_priv rtw_debug_priv_dm_cap = { -+ .cb_write = rtw_debugfs_set_dm_cap, -+ .cb_read = rtw_debugfs_get_dm_cap, -+}; -+ - #define rtw_debugfs_add_core(name, mode, fopname, parent) \ - do { \ - rtw_debug_priv_ ##name.rtwdev = rtwdev; \ -@@ -925,6 +1257,7 @@ void rtw_debugfs_init(struct rtw_dev *rtwdev) - rtw_debugfs_add_rw(read_reg); - rtw_debugfs_add_w(rf_write); - rtw_debugfs_add_rw(rf_read); -+ rtw_debugfs_add_rw(fix_rate); - rtw_debugfs_add_rw(dump_cam); - rtw_debugfs_add_rw(rsvd_page); - rtw_debugfs_add_r(phy_info); -@@ -971,6 +1304,10 @@ void rtw_debugfs_init(struct rtw_dev *rtwdev) - } - rtw_debugfs_add_r(rf_dump); - rtw_debugfs_add_r(tx_pwr_tbl); -+ rtw_debugfs_add_rw(edcca_enable); -+ rtw_debugfs_add_rw(fw_crash); -+ rtw_debugfs_add_rw(force_lowest_basic_rate); -+ rtw_debugfs_add_rw(dm_cap); - } - - #endif /* CONFIG_RTW88_DEBUGFS */ -diff --git a/drivers/net/wireless/realtek/rtw88/debug.h b/drivers/net/wireless/realtek/rtw88/debug.h -index a0f36f29b..a9149c6c2 100644 ---- a/drivers/net/wireless/realtek/rtw88/debug.h -+++ b/drivers/net/wireless/realtek/rtw88/debug.h -@@ -19,6 +19,12 @@ enum rtw_debug_mask { - RTW_DBG_PS = 0x00000400, - RTW_DBG_BF = 0x00000800, - RTW_DBG_WOW = 0x00001000, -+ RTW_DBG_CFO = 0x00002000, -+ RTW_DBG_PATH_DIV = 0x00004000, -+ RTW_DBG_ADAPTIVITY = 0x00008000, -+ RTW_DBG_HW_SCAN = 0x00010000, -+ RTW_DBG_STATE = 0x00020000, -+ RTW_DBG_SDIO = 0x00040000, - - RTW_DBG_ALL = 0xffffffff - }; -@@ -26,6 +32,7 @@ enum rtw_debug_mask { - #ifdef CONFIG_RTW88_DEBUGFS - - void rtw_debugfs_init(struct rtw_dev *rtwdev); -+void rtw_debugfs_get_simple_phy_info(struct seq_file *m); - - #else - -diff --git a/drivers/net/wireless/realtek/rtw88/efuse.c b/drivers/net/wireless/realtek/rtw88/efuse.c -index c266c84ef..b85075cd6 100644 ---- a/drivers/net/wireless/realtek/rtw88/efuse.c -+++ b/drivers/net/wireless/realtek/rtw88/efuse.c -@@ -86,7 +86,7 @@ static int rtw_dump_logical_efuse_map(struct rtw_dev *rtwdev, u8 *phy_map, - - static int rtw_dump_physical_efuse_map(struct rtw_dev *rtwdev, u8 *map) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - u32 size = rtwdev->efuse.physical_size; - u32 efuse_ctl; - u32 addr; -@@ -145,7 +145,7 @@ EXPORT_SYMBOL(rtw_read8_physical_efuse); - - int rtw_parse_efuse_map(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; - u32 phy_size = efuse->physical_size; - u32 log_size = efuse->logical_size; -diff --git a/drivers/net/wireless/realtek/rtw88/fw.c b/drivers/net/wireless/realtek/rtw88/fw.c -index 40bcfabd2..071e8ec2f 100644 ---- a/drivers/net/wireless/realtek/rtw88/fw.c -+++ b/drivers/net/wireless/realtek/rtw88/fw.c -@@ -13,6 +13,9 @@ - #include "debug.h" - #include "util.h" - #include "wow.h" -+#include "ps.h" -+#include "phy.h" -+#include "mac.h" - - static void rtw_fw_c2h_cmd_handle_ext(struct rtw_dev *rtwdev, - struct sk_buff *skb) -@@ -27,6 +30,12 @@ static void rtw_fw_c2h_cmd_handle_ext(struct rtw_dev *rtwdev, - case C2H_CCX_RPT: - rtw_tx_report_handle(rtwdev, skb, C2H_CCX_RPT); - break; -+ case C2H_SCAN_STATUS_RPT: -+ rtw_hw_scan_status_report(rtwdev, skb); -+ break; -+ case C2H_CHAN_SWITCH: -+ rtw_hw_scan_chan_switch(rtwdev, skb); -+ break; - default: - break; - } -@@ -109,7 +118,11 @@ static void rtw_fw_ra_report_iter(void *data, struct ieee80211_sta *sta) - si->ra_report.desc_rate = rate; - si->ra_report.bit_rate = bit_rate; - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 1, 0) -+ sta->deflink.agg.max_rc_amsdu_len = get_max_amsdu_len(bit_rate); -+#else - sta->max_rc_amsdu_len = get_max_amsdu_len(bit_rate); -+#endif - } - - static void rtw_fw_ra_report_handle(struct rtw_dev *rtwdev, u8 *payload, -@@ -126,6 +139,84 @@ static void rtw_fw_ra_report_handle(struct rtw_dev *rtwdev, u8 *payload, - rtw_iterate_stas_atomic(rtwdev, rtw_fw_ra_report_iter, &ra_data); - } - -+struct rtw_beacon_filter_iter_data { -+ struct rtw_dev *rtwdev; -+ u8 *payload; -+}; -+ -+static void rtw_fw_bcn_filter_notify_vif_iter(void *data, -+ struct ieee80211_vif *vif) -+{ -+ struct rtw_beacon_filter_iter_data *iter_data = data; -+ struct rtw_dev *rtwdev = iter_data->rtwdev; -+ u8 *payload = iter_data->payload; -+ u8 type = GET_BCN_FILTER_NOTIFY_TYPE(payload); -+ u8 event = GET_BCN_FILTER_NOTIFY_EVENT(payload); -+ s8 sig = (s8)GET_BCN_FILTER_NOTIFY_RSSI(payload); -+ -+ switch (type) { -+ case BCN_FILTER_NOTIFY_SIGNAL_CHANGE: -+ event = event ? NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH : -+ NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW; -+ ieee80211_cqm_rssi_notify(vif, event, sig, GFP_KERNEL); -+ break; -+ case BCN_FILTER_CONNECTION_LOSS: -+ ieee80211_connection_loss(vif); -+ break; -+ case BCN_FILTER_CONNECTED: -+ rtwdev->beacon_loss = false; -+ break; -+ case BCN_FILTER_NOTIFY_BEACON_LOSS: -+ rtwdev->beacon_loss = true; -+ rtw_leave_lps(rtwdev); -+ break; -+ } -+} -+ -+static void rtw_fw_bcn_filter_notify(struct rtw_dev *rtwdev, u8 *payload, -+ u8 length) -+{ -+ struct rtw_beacon_filter_iter_data dev_iter_data; -+ -+ dev_iter_data.rtwdev = rtwdev; -+ dev_iter_data.payload = payload; -+ rtw_iterate_vifs(rtwdev, rtw_fw_bcn_filter_notify_vif_iter, -+ &dev_iter_data); -+} -+ -+static void rtw_fw_scan_result(struct rtw_dev *rtwdev, u8 *payload, -+ u8 length) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ -+ dm_info->scan_density = payload[0]; -+ -+ rtw_dbg(rtwdev, RTW_DBG_FW, "scan.density = %x\n", -+ dm_info->scan_density); -+} -+ -+static void rtw_fw_adaptivity_result(struct rtw_dev *rtwdev, u8 *payload, -+ u8 length) -+{ -+ struct rtw_hw_reg_offset *edcca_th = rtwdev->chip->edcca_th; -+ struct rtw_c2h_adaptivity *result = (struct rtw_c2h_adaptivity *)payload; -+ -+ rtw_dbg(rtwdev, RTW_DBG_ADAPTIVITY, -+ "Adaptivity: density %x igi %x l2h_th_init %x l2h %x h2l %x option %x\n", -+ result->density, result->igi, result->l2h_th_init, result->l2h, -+ result->h2l, result->option); -+ -+ rtw_dbg(rtwdev, RTW_DBG_ADAPTIVITY, "Reg Setting: L2H %x H2L %x\n", -+ rtw_read32_mask(rtwdev, edcca_th[EDCCA_TH_L2H_IDX].hw_reg.addr, -+ edcca_th[EDCCA_TH_L2H_IDX].hw_reg.mask), -+ rtw_read32_mask(rtwdev, edcca_th[EDCCA_TH_H2L_IDX].hw_reg.addr, -+ edcca_th[EDCCA_TH_H2L_IDX].hw_reg.mask)); -+ -+ rtw_dbg(rtwdev, RTW_DBG_ADAPTIVITY, "EDCCA Flag %s\n", -+ rtw_read32_mask(rtwdev, REG_EDCCA_REPORT, BIT_EDCCA_FLAG) ? -+ "Set" : "Unset"); -+} -+ - void rtw_fw_c2h_cmd_handle(struct rtw_dev *rtwdev, struct sk_buff *skb) - { - struct rtw_c2h_cmd *c2h; -@@ -148,9 +239,15 @@ void rtw_fw_c2h_cmd_handle(struct rtw_dev *rtwdev, struct sk_buff *skb) - case C2H_BT_INFO: - rtw_coex_bt_info_notify(rtwdev, c2h->payload, len); - break; -+ case C2H_BT_HID_INFO: -+ rtw_coex_bt_hid_info_notify(rtwdev, c2h->payload, len); -+ break; - case C2H_WLAN_INFO: - rtw_coex_wl_fwdbginfo_notify(rtwdev, c2h->payload, len); - break; -+ case C2H_BCN_FILTER_NOTIFY: -+ rtw_fw_bcn_filter_notify(rtwdev, c2h->payload, len); -+ break; - case C2H_HALMAC: - rtw_fw_c2h_cmd_handle_ext(rtwdev, skb); - break; -@@ -183,6 +280,19 @@ void rtw_fw_c2h_cmd_rx_irqsafe(struct rtw_dev *rtwdev, u32 pkt_offset, - case C2H_BT_MP_INFO: - rtw_coex_info_response(rtwdev, skb); - break; -+ case C2H_WLAN_RFON: -+ complete(&rtwdev->lps_leave_check); -+ dev_kfree_skb_any(skb); -+ break; -+ case C2H_SCAN_RESULT: -+ complete(&rtwdev->fw_scan_density); -+ rtw_fw_scan_result(rtwdev, c2h->payload, len); -+ dev_kfree_skb_any(skb); -+ break; -+ case C2H_ADAPTIVITY: -+ rtw_fw_adaptivity_result(rtwdev, c2h->payload, len); -+ dev_kfree_skb_any(skb); -+ break; - default: - /* pass offset for further operation */ - *((u32 *)skb->cb) = pkt_offset; -@@ -202,13 +312,64 @@ void rtw_fw_c2h_cmd_isr(struct rtw_dev *rtwdev) - } - EXPORT_SYMBOL(rtw_fw_c2h_cmd_isr); - -+static void rtw_fw_send_h2c_command_register(struct rtw_dev *rtwdev, -+ struct rtw_h2c_register *h2c) -+{ -+ u32 box_reg, box_ex_reg; -+ u8 box_state, box; -+ int ret; -+ -+ rtw_dbg(rtwdev, RTW_DBG_FW, "send H2C content %08x %08x\n", h2c->w0, -+ h2c->w1); -+ -+ lockdep_assert_held(&rtwdev->mutex); -+ -+ box = rtwdev->h2c.last_box_num; -+ switch (box) { -+ case 0: -+ box_reg = REG_HMEBOX0; -+ box_ex_reg = REG_HMEBOX0_EX; -+ break; -+ case 1: -+ box_reg = REG_HMEBOX1; -+ box_ex_reg = REG_HMEBOX1_EX; -+ break; -+ case 2: -+ box_reg = REG_HMEBOX2; -+ box_ex_reg = REG_HMEBOX2_EX; -+ break; -+ case 3: -+ box_reg = REG_HMEBOX3; -+ box_ex_reg = REG_HMEBOX3_EX; -+ break; -+ default: -+ WARN(1, "invalid h2c mail box number\n"); -+ return; -+ } -+ -+ ret = read_poll_timeout_atomic(rtw_read8, box_state, -+ !((box_state >> box) & 0x1), 100, 3000, -+ false, rtwdev, REG_HMETFR); -+ -+ if (ret) { -+ rtw_err(rtwdev, "failed to send h2c command\n"); -+ return; -+ } -+ -+ rtw_write32(rtwdev, box_ex_reg, h2c->w1); -+ rtw_write32(rtwdev, box_reg, h2c->w0); -+ -+ if (++rtwdev->h2c.last_box_num >= 4) -+ rtwdev->h2c.last_box_num = 0; -+} -+ - static void rtw_fw_send_h2c_command(struct rtw_dev *rtwdev, - u8 *h2c) - { -+ struct rtw_h2c_cmd *h2c_cmd = (struct rtw_h2c_cmd *)h2c; - u8 box; - u8 box_state; - u32 box_reg, box_ex_reg; -- int idx; - int ret; - - rtw_dbg(rtwdev, RTW_DBG_FW, -@@ -216,7 +377,7 @@ static void rtw_fw_send_h2c_command(struct rtw_dev *rtwdev, - h2c[3], h2c[2], h2c[1], h2c[0], - h2c[7], h2c[6], h2c[5], h2c[4]); - -- spin_lock(&rtwdev->h2c.lock); -+ lockdep_assert_held(&rtwdev->mutex); - - box = rtwdev->h2c.last_box_num; - switch (box) { -@@ -238,7 +399,7 @@ static void rtw_fw_send_h2c_command(struct rtw_dev *rtwdev, - break; - default: - WARN(1, "invalid h2c mail box number\n"); -- goto out; -+ return; - } - - ret = read_poll_timeout_atomic(rtw_read8, box_state, -@@ -247,19 +408,14 @@ static void rtw_fw_send_h2c_command(struct rtw_dev *rtwdev, - - if (ret) { - rtw_err(rtwdev, "failed to send h2c command\n"); -- goto out; -+ return; - } - -- for (idx = 0; idx < 4; idx++) -- rtw_write8(rtwdev, box_reg + idx, h2c[idx]); -- for (idx = 0; idx < 4; idx++) -- rtw_write8(rtwdev, box_ex_reg + idx, h2c[idx + 4]); -+ rtw_write32(rtwdev, box_ex_reg, le32_to_cpu(h2c_cmd->msg_ext)); -+ rtw_write32(rtwdev, box_reg, le32_to_cpu(h2c_cmd->msg)); - - if (++rtwdev->h2c.last_box_num >= 4) - rtwdev->h2c.last_box_num = 0; -- --out: -- spin_unlock(&rtwdev->h2c.lock); - } - - void rtw_fw_h2c_cmd_dbg(struct rtw_dev *rtwdev, u8 *h2c) -@@ -271,15 +427,13 @@ static void rtw_fw_send_h2c_packet(struct rtw_dev *rtwdev, u8 *h2c_pkt) - { - int ret; - -- spin_lock(&rtwdev->h2c.lock); -+ lockdep_assert_held(&rtwdev->mutex); - - FW_OFFLOAD_H2C_SET_SEQ_NUM(h2c_pkt, rtwdev->h2c.seq); - ret = rtw_hci_write_data_h2c(rtwdev, h2c_pkt, H2C_PKT_SIZE); - if (ret) - rtw_err(rtwdev, "failed to send h2c packet\n"); - rtwdev->h2c.seq++; -- -- spin_unlock(&rtwdev->h2c.lock); - } - - void -@@ -346,6 +500,18 @@ void rtw_fw_do_iqk(struct rtw_dev *rtwdev, struct rtw_iqk_para *para) - } - EXPORT_SYMBOL(rtw_fw_do_iqk); - -+void rtw_fw_inform_rfk_status(struct rtw_dev *rtwdev, bool start) -+{ -+ u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -+ -+ SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_WIFI_CALIBRATION); -+ -+ RFK_SET_INFORM_START(h2c_pkt, start); -+ -+ rtw_fw_send_h2c_command(rtwdev, h2c_pkt); -+} -+EXPORT_SYMBOL(rtw_fw_inform_rfk_status); -+ - void rtw_fw_query_bt_info(struct rtw_dev *rtwdev) - { - u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -@@ -357,6 +523,23 @@ void rtw_fw_query_bt_info(struct rtw_dev *rtwdev) - rtw_fw_send_h2c_command(rtwdev, h2c_pkt); - } - -+void rtw_fw_default_port(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif) -+{ -+ struct rtw_h2c_register h2c = {}; -+ -+ if (rtwvif->net_type != RTW_NET_MGD_LINKED) -+ return; -+ -+ /* Leave LPS before default port H2C so FW timer is correct */ -+ rtw_leave_lps(rtwdev); -+ -+ h2c.w0 = u32_encode_bits(H2C_CMD_DEFAULT_PORT, RTW_H2C_W0_CMDID) | -+ u32_encode_bits(rtwvif->port, RTW_H2C_DEFAULT_PORT_W0_PORTID) | -+ u32_encode_bits(rtwvif->mac_id, RTW_H2C_DEFAULT_PORT_W0_MACID); -+ -+ rtw_fw_send_h2c_command_register(rtwdev, &h2c); -+} -+ - void rtw_fw_wl_ch_info(struct rtw_dev *rtwdev, u8 link, u8 ch, u8 bw) - { - u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -@@ -425,6 +608,18 @@ void rtw_fw_coex_tdma_type(struct rtw_dev *rtwdev, - rtw_fw_send_h2c_command(rtwdev, h2c_pkt); - } - -+void rtw_fw_coex_query_hid_info(struct rtw_dev *rtwdev, u8 sub_id, u8 data) -+{ -+ u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -+ -+ SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_QUERY_BT_HID_INFO); -+ -+ SET_COEX_QUERY_HID_INFO_SUBID(h2c_pkt, sub_id); -+ SET_COEX_QUERY_HID_INFO_DATA1(h2c_pkt, data); -+ -+ rtw_fw_send_h2c_command(rtwdev, h2c_pkt); -+} -+ - void rtw_fw_bt_wifi_control(struct rtw_dev *rtwdev, u8 op_code, u8 *data) - { - u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -@@ -457,11 +652,18 @@ void rtw_fw_send_rssi_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si) - rtw_fw_send_h2c_command(rtwdev, h2c_pkt); - } - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 18, 0) -+void rtw_fw_send_ra_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si, -+ bool reset_ra_mask) -+#else - void rtw_fw_send_ra_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si) -+#endif - { - u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -- bool no_update = si->updated; - bool disable_pt = true; -+#if LINUX_VERSION_CODE < KERNEL_VERSION(5, 18, 0) -+ bool reset_ra_mask = true; -+#endif - - SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_RA_INFO); - -@@ -471,7 +673,7 @@ void rtw_fw_send_ra_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si) - SET_RA_INFO_SGI_EN(h2c_pkt, si->sgi_enable); - SET_RA_INFO_BW_MODE(h2c_pkt, si->bw_mode); - SET_RA_INFO_LDPC(h2c_pkt, !!si->ldpc_en); -- SET_RA_INFO_NO_UPDATE(h2c_pkt, no_update); -+ SET_RA_INFO_NO_UPDATE(h2c_pkt, !reset_ra_mask); - SET_RA_INFO_VHT_EN(h2c_pkt, si->vht_enable); - SET_RA_INFO_DIS_PT(h2c_pkt, disable_pt); - SET_RA_INFO_RA_MASK0(h2c_pkt, (si->ra_mask & 0xff)); -@@ -480,7 +682,6 @@ void rtw_fw_send_ra_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si) - SET_RA_INFO_RA_MASK3(h2c_pkt, (si->ra_mask & 0xff000000) >> 24); - - si->init_ra_lv = 0; -- si->updated = true; - - rtw_fw_send_h2c_command(rtwdev, h2c_pkt); - } -@@ -496,6 +697,64 @@ void rtw_fw_media_status_report(struct rtw_dev *rtwdev, u8 mac_id, bool connect) - rtw_fw_send_h2c_command(rtwdev, h2c_pkt); - } - -+void rtw_fw_update_wl_phy_info(struct rtw_dev *rtwdev) -+{ -+ struct rtw_traffic_stats *stats = &rtwdev->stats; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -+ -+ SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_WL_PHY_INFO); -+ SET_WL_PHY_INFO_TX_TP(h2c_pkt, stats->tx_throughput); -+ SET_WL_PHY_INFO_RX_TP(h2c_pkt, stats->rx_throughput); -+ SET_WL_PHY_INFO_TX_RATE_DESC(h2c_pkt, dm_info->tx_rate); -+ SET_WL_PHY_INFO_RX_RATE_DESC(h2c_pkt, dm_info->curr_rx_rate); -+ SET_WL_PHY_INFO_RX_EVM(h2c_pkt, dm_info->rx_evm_dbm[RF_PATH_A]); -+ rtw_fw_send_h2c_command(rtwdev, h2c_pkt); -+} -+ -+void rtw_fw_beacon_filter_config(struct rtw_dev *rtwdev, bool connect, -+ struct ieee80211_vif *vif) -+{ -+ struct ieee80211_bss_conf *bss_conf = &vif->bss_conf; -+ struct ieee80211_sta *sta = ieee80211_find_sta(vif, bss_conf->bssid); -+ static const u8 rssi_min = 0, rssi_max = 100, rssi_offset = 100; -+ struct rtw_sta_info *si = -+ sta ? (struct rtw_sta_info *)sta->drv_priv : NULL; -+ s32 threshold = bss_conf->cqm_rssi_thold + rssi_offset; -+ u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -+ -+ if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_BCN_FILTER)) -+ return; -+ -+ if (!connect) { -+ SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_BCN_FILTER_OFFLOAD_P1); -+ SET_BCN_FILTER_OFFLOAD_P1_ENABLE(h2c_pkt, connect); -+ rtw_fw_send_h2c_command(rtwdev, h2c_pkt); -+ -+ return; -+ } -+ -+ if (!si) -+ return; -+ -+ SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_BCN_FILTER_OFFLOAD_P0); -+ ether_addr_copy(&h2c_pkt[1], bss_conf->bssid); -+ rtw_fw_send_h2c_command(rtwdev, h2c_pkt); -+ -+ memset(h2c_pkt, 0, sizeof(h2c_pkt)); -+ threshold = clamp_t(s32, threshold, rssi_min, rssi_max); -+ SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_BCN_FILTER_OFFLOAD_P1); -+ SET_BCN_FILTER_OFFLOAD_P1_ENABLE(h2c_pkt, connect); -+ SET_BCN_FILTER_OFFLOAD_P1_OFFLOAD_MODE(h2c_pkt, -+ BCN_FILTER_OFFLOAD_MODE_DEFAULT); -+ SET_BCN_FILTER_OFFLOAD_P1_THRESHOLD(h2c_pkt, (u8)threshold); -+ SET_BCN_FILTER_OFFLOAD_P1_BCN_LOSS_CNT(h2c_pkt, BCN_LOSS_CNT); -+ SET_BCN_FILTER_OFFLOAD_P1_MACID(h2c_pkt, si->mac_id); -+ SET_BCN_FILTER_OFFLOAD_P1_HYST(h2c_pkt, bss_conf->cqm_rssi_hyst); -+ SET_BCN_FILTER_OFFLOAD_P1_BCN_INTERVAL(h2c_pkt, bss_conf->beacon_int); -+ rtw_fw_send_h2c_command(rtwdev, h2c_pkt); -+} -+ - void rtw_fw_set_pwr_mode(struct rtw_dev *rtwdev) - { - struct rtw_lps_conf *conf = &rtwdev->lps_conf; -@@ -628,7 +887,7 @@ void rtw_fw_set_nlo_info(struct rtw_dev *rtwdev, bool enable) - - SET_NLO_FUN_EN(h2c_pkt, enable); - if (enable) { -- if (rtw_fw_lps_deep_mode) -+ if (rtw_get_lps_deep_mode(rtwdev) != LPS_DEEP_MODE_NONE) - SET_NLO_PS_32K(h2c_pkt, enable); - SET_NLO_IGNORE_SECURITY(h2c_pkt, enable); - SET_NLO_LOC_NLO_INFO(h2c_pkt, loc_nlo); -@@ -637,6 +896,16 @@ void rtw_fw_set_nlo_info(struct rtw_dev *rtwdev, bool enable) - rtw_fw_send_h2c_command(rtwdev, h2c_pkt); - } - -+void rtw_fw_set_recover_bt_device(struct rtw_dev *rtwdev) -+{ -+ u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -+ -+ SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_RECOVER_BT_DEV); -+ SET_RECOVER_BT_DEV_EN(h2c_pkt, 1); -+ -+ rtw_fw_send_h2c_command(rtwdev, h2c_pkt); -+} -+ - void rtw_fw_set_pg_info(struct rtw_dev *rtwdev) - { - struct rtw_lps_conf *conf = &rtwdev->lps_conf; -@@ -719,7 +988,7 @@ void rtw_send_rsvd_page_h2c(struct rtw_dev *rtwdev) - static struct sk_buff *rtw_nlo_info_get(struct ieee80211_hw *hw) - { - struct rtw_dev *rtwdev = hw->priv; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_pno_request *pno_req = &rtwdev->wow.pno_req; - struct rtw_nlo_info_hdr *nlo_hdr; - struct cfg80211_ssid *ssid; -@@ -774,7 +1043,7 @@ static struct sk_buff *rtw_nlo_info_get(struct ieee80211_hw *hw) - static struct sk_buff *rtw_cs_channel_info_get(struct ieee80211_hw *hw) - { - struct rtw_dev *rtwdev = hw->priv; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_pno_request *pno_req = &rtwdev->wow.pno_req; - struct ieee80211_channel *channels = pno_req->channels; - struct sk_buff *skb; -@@ -808,7 +1077,7 @@ static struct sk_buff *rtw_cs_channel_info_get(struct ieee80211_hw *hw) - static struct sk_buff *rtw_lps_pg_dpk_get(struct ieee80211_hw *hw) - { - struct rtw_dev *rtwdev = hw->priv; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; - struct rtw_lps_pg_dpk_hdr *dpk_hdr; - struct sk_buff *skb; -@@ -833,7 +1102,7 @@ static struct sk_buff *rtw_lps_pg_dpk_get(struct ieee80211_hw *hw) - static struct sk_buff *rtw_lps_pg_info_get(struct ieee80211_hw *hw) - { - struct rtw_dev *rtwdev = hw->priv; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_lps_conf *conf = &rtwdev->lps_conf; - struct rtw_lps_pg_info_hdr *pg_info_hdr; - struct rtw_wow_param *rtw_wow = &rtwdev->wow; -@@ -866,6 +1135,7 @@ static struct sk_buff *rtw_get_rsvd_page_skb(struct ieee80211_hw *hw, - struct rtw_vif *rtwvif; - struct sk_buff *skb_new; - struct cfg80211_ssid *ssid; -+ u16 tim_offset = 0; - - if (rsvd_pkt->type == RSVD_DUMMY) { - skb_new = alloc_skb(1, GFP_KERNEL); -@@ -884,7 +1154,12 @@ static struct sk_buff *rtw_get_rsvd_page_skb(struct ieee80211_hw *hw, - - switch (rsvd_pkt->type) { - case RSVD_BEACON: -- skb_new = ieee80211_beacon_get(hw, vif); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) -+ skb_new = ieee80211_beacon_get_tim(hw, vif, &tim_offset, NULL, 0); -+#else -+ skb_new = ieee80211_beacon_get_tim(hw, vif, &tim_offset, NULL); -+#endif -+ rsvd_pkt->tim_offset = tim_offset; - break; - case RSVD_PS_POLL: - skb_new = ieee80211_pspoll_get(hw, vif); -@@ -893,10 +1168,26 @@ static struct sk_buff *rtw_get_rsvd_page_skb(struct ieee80211_hw *hw, - skb_new = ieee80211_proberesp_get(hw, vif); - break; - case RSVD_NULL: -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 17) -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 1, 0) -+ skb_new = ieee80211_nullfunc_get(hw, vif, -1, false); -+#else - skb_new = ieee80211_nullfunc_get(hw, vif, false); -+#endif -+#else -+ skb_new = ieee80211_nullfunc_get(hw, vif); -+#endif - break; - case RSVD_QOS_NULL: -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 17) -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 1, 0) -+ skb_new = ieee80211_nullfunc_get(hw, vif, -1, true); -+#else - skb_new = ieee80211_nullfunc_get(hw, vif, true); -+#endif -+#else -+ skb_new = ieee80211_nullfunc_get(hw, vif); -+#endif - break; - case RSVD_LPS_PG_DPK: - skb_new = rtw_lps_pg_dpk_get(hw); -@@ -935,7 +1226,7 @@ static void rtw_fill_rsvd_page_desc(struct rtw_dev *rtwdev, struct sk_buff *skb, - enum rtw_rsvd_packet_type type) - { - struct rtw_tx_pkt_info pkt_info = {0}; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - u8 *pkt_desc; - - rtw_tx_rsvd_page_pkt_info_update(rtwdev, &pkt_info, skb, type); -@@ -1201,6 +1492,10 @@ static void rtw_build_rsvd_page_iter(void *data, u8 *mac, - struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; - struct rtw_rsvd_page *rsvd_pkt; - -+ /* AP not yet started, don't gather its rsvd pages */ -+ if (vif->type == NL80211_IFTYPE_AP && !rtwdev->ap_active) -+ return; -+ - list_for_each_entry(rsvd_pkt, &rtwvif->rsvd_page_list, vif_list) { - if (rsvd_pkt->type == RSVD_BEACON) - list_add(&rsvd_pkt->build_list, -@@ -1246,7 +1541,7 @@ static int __rtw_build_rsvd_page_from_vifs(struct rtw_dev *rtwdev) - static u8 *rtw_build_rsvd_page(struct rtw_dev *rtwdev, u32 *size) - { - struct ieee80211_hw *hw = rtwdev->hw; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct sk_buff *iter; - struct rtw_rsvd_page *rsvd_pkt; - u32 page = 0; -@@ -1415,6 +1710,17 @@ int rtw_fw_download_rsvd_page(struct rtw_dev *rtwdev) - return ret; - } - -+void rtw_fw_update_beacon_work(struct work_struct *work) -+{ -+ struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, -+ update_beacon_work); -+ -+ mutex_lock(&rtwdev->mutex); -+ rtw_fw_download_rsvd_page(rtwdev); -+ rtw_send_rsvd_page_h2c(rtwdev); -+ mutex_unlock(&rtwdev->mutex); -+} -+ - static void rtw_fw_read_fifo_page(struct rtw_dev *rtwdev, u32 offset, u32 size, - u32 *buf, u32 residue, u16 start_pg) - { -@@ -1450,7 +1756,7 @@ static void rtw_fw_read_fifo_page(struct rtw_dev *rtwdev, u32 offset, u32 size, - static void rtw_fw_read_fifo(struct rtw_dev *rtwdev, enum rtw_fw_fifo_sel sel, - u32 offset, u32 size, u32 *buf) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - u32 start_pg, residue; - - if (sel >= RTW_FW_FIFO_MAX) { -@@ -1474,7 +1780,7 @@ static bool rtw_fw_dump_check_size(struct rtw_dev *rtwdev, - case RTW_FW_FIFO_SEL_RX: - if ((start_addr + size) > rtwdev->chip->fw_fifo_addr[sel]) - return false; -- /*fall through*/ -+ fallthrough; - default: - return true; - } -@@ -1509,7 +1815,7 @@ int rtw_fw_dump_fifo(struct rtw_dev *rtwdev, u8 fifo_sel, u32 addr, u32 size, - static void __rtw_fw_update_pkt(struct rtw_dev *rtwdev, u8 pkt_id, u16 size, - u8 location) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - u8 h2c_pkt[H2C_PKT_SIZE] = {0}; - u16 total_size = H2C_PKT_HDR_SIZE + H2C_PKT_UPDATE_PKT_LEN; - -@@ -1585,3 +1891,496 @@ void rtw_fw_channel_switch(struct rtw_dev *rtwdev, bool enable) - - rtw_fw_send_h2c_packet(rtwdev, h2c_pkt); - } -+ -+void rtw_fw_adaptivity(struct rtw_dev *rtwdev) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -+ -+ if (!rtw_edcca_enabled) { -+ dm_info->edcca_mode = RTW_EDCCA_NORMAL; -+ rtw_dbg(rtwdev, RTW_DBG_ADAPTIVITY, -+ "EDCCA disabled by debugfs\n"); -+ } -+ -+ SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_ADAPTIVITY); -+ SET_ADAPTIVITY_MODE(h2c_pkt, dm_info->edcca_mode); -+ SET_ADAPTIVITY_OPTION(h2c_pkt, 1); -+ SET_ADAPTIVITY_IGI(h2c_pkt, dm_info->igi_history[0]); -+ SET_ADAPTIVITY_L2H(h2c_pkt, dm_info->l2h_th_ini); -+ SET_ADAPTIVITY_DENSITY(h2c_pkt, dm_info->scan_density); -+ -+ rtw_fw_send_h2c_command(rtwdev, h2c_pkt); -+} -+ -+void rtw_fw_scan_notify(struct rtw_dev *rtwdev, bool start) -+{ -+ u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -+ -+ SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_SCAN); -+ SET_SCAN_START(h2c_pkt, start); -+ -+ rtw_fw_send_h2c_command(rtwdev, h2c_pkt); -+} -+ -+static int rtw_append_probe_req_ie(struct rtw_dev *rtwdev, struct sk_buff *skb, -+ struct sk_buff_head *list, u8 *bands, -+ struct rtw_vif *rtwvif) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct ieee80211_scan_ies *ies = rtwvif->scan_ies; -+ struct sk_buff *new; -+ u8 idx; -+ -+ for (idx = NL80211_BAND_2GHZ; idx < NUM_NL80211_BANDS; idx++) { -+ if (!(BIT(idx) & chip->band)) -+ continue; -+ new = skb_copy(skb, GFP_KERNEL); -+ if (!new) -+ return -ENOMEM; -+ skb_put_data(new, ies->ies[idx], ies->len[idx]); -+ skb_put_data(new, ies->common_ies, ies->common_ie_len); -+ skb_queue_tail(list, new); -+ (*bands)++; -+ } -+ -+ return 0; -+} -+ -+static int _rtw_hw_scan_update_probe_req(struct rtw_dev *rtwdev, u8 num_probes, -+ struct sk_buff_head *probe_req_list) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct sk_buff *skb, *tmp; -+ u8 page_offset = 1, *buf, page_size = chip->page_size; -+ u16 pg_addr = rtwdev->fifo.rsvd_h2c_info_addr, loc; -+ u16 buf_offset = page_size * page_offset; -+ u8 tx_desc_sz = chip->tx_pkt_desc_sz; -+ u8 page_cnt, pages; -+ unsigned int pkt_len; -+ int ret; -+ -+ if (rtw_fw_feature_ext_check(&rtwdev->fw, FW_FEATURE_EXT_OLD_PAGE_NUM)) -+ page_cnt = RTW_OLD_PROBE_PG_CNT; -+ else -+ page_cnt = RTW_PROBE_PG_CNT; -+ -+ pages = page_offset + num_probes * page_cnt; -+ -+ buf = kzalloc(page_size * pages, GFP_KERNEL); -+ if (!buf) -+ return -ENOMEM; -+ -+ buf_offset -= tx_desc_sz; -+ skb_queue_walk_safe(probe_req_list, skb, tmp) { -+ skb_unlink(skb, probe_req_list); -+ rtw_fill_rsvd_page_desc(rtwdev, skb, RSVD_PROBE_REQ); -+ if (skb->len > page_size * page_cnt) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ memcpy(buf + buf_offset, skb->data, skb->len); -+ pkt_len = skb->len - tx_desc_sz; -+ loc = pg_addr - rtwdev->fifo.rsvd_boundary + page_offset; -+ __rtw_fw_update_pkt(rtwdev, RTW_PACKET_PROBE_REQ, pkt_len, loc); -+ -+ buf_offset += page_cnt * page_size; -+ page_offset += page_cnt; -+ kfree_skb(skb); -+ } -+ -+ ret = rtw_fw_write_data_rsvd_page(rtwdev, pg_addr, buf, buf_offset); -+ if (ret) { -+ rtw_err(rtwdev, "Download probe request to firmware failed\n"); -+ goto out; -+ } -+ -+ rtwdev->scan_info.probe_pg_size = page_offset; -+out: -+ kfree(buf); -+ skb_queue_walk_safe(probe_req_list, skb, tmp) -+ kfree_skb(skb); -+ -+ return ret; -+} -+ -+static int rtw_hw_scan_update_probe_req(struct rtw_dev *rtwdev, -+ struct rtw_vif *rtwvif) -+{ -+ struct cfg80211_scan_request *req = rtwvif->scan_req; -+ struct sk_buff_head list; -+ struct sk_buff *skb, *tmp; -+ u8 num = req->n_ssids, i, bands = 0; -+ int ret; -+ -+ skb_queue_head_init(&list); -+ for (i = 0; i < num; i++) { -+ skb = ieee80211_probereq_get(rtwdev->hw, rtwvif->mac_addr, -+ req->ssids[i].ssid, -+ req->ssids[i].ssid_len, -+ req->ie_len); -+ if (!skb) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ ret = rtw_append_probe_req_ie(rtwdev, skb, &list, &bands, -+ rtwvif); -+ if (ret) -+ goto out; -+ -+ kfree_skb(skb); -+ } -+ -+ return _rtw_hw_scan_update_probe_req(rtwdev, num * bands, &list); -+ -+out: -+ skb_queue_walk_safe(&list, skb, tmp) -+ kfree_skb(skb); -+ -+ return ret; -+} -+ -+static int rtw_add_chan_info(struct rtw_dev *rtwdev, struct rtw_chan_info *info, -+ struct rtw_chan_list *list, u8 *buf) -+{ -+ u8 *chan = &buf[list->size]; -+ u8 info_size = RTW_CH_INFO_SIZE; -+ -+ if (list->size > list->buf_size) -+ return -ENOMEM; -+ -+ CH_INFO_SET_CH(chan, info->channel); -+ CH_INFO_SET_PRI_CH_IDX(chan, info->pri_ch_idx); -+ CH_INFO_SET_BW(chan, info->bw); -+ CH_INFO_SET_TIMEOUT(chan, info->timeout); -+ CH_INFO_SET_ACTION_ID(chan, info->action_id); -+ CH_INFO_SET_EXTRA_INFO(chan, info->extra_info); -+ if (info->extra_info) { -+ EXTRA_CH_INFO_SET_ID(chan, RTW_SCAN_EXTRA_ID_DFS); -+ EXTRA_CH_INFO_SET_INFO(chan, RTW_SCAN_EXTRA_ACTION_SCAN); -+ EXTRA_CH_INFO_SET_SIZE(chan, RTW_EX_CH_INFO_SIZE - -+ RTW_EX_CH_INFO_HDR_SIZE); -+ EXTRA_CH_INFO_SET_DFS_EXT_TIME(chan, RTW_DFS_CHAN_TIME); -+ info_size += RTW_EX_CH_INFO_SIZE; -+ } -+ list->size += info_size; -+ list->ch_num++; -+ -+ return 0; -+} -+ -+static int rtw_add_chan_list(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif, -+ struct rtw_chan_list *list, u8 *buf) -+{ -+ struct cfg80211_scan_request *req = rtwvif->scan_req; -+ struct rtw_fifo_conf *fifo = &rtwdev->fifo; -+ struct ieee80211_channel *channel; -+ int i, ret = 0; -+ -+ for (i = 0; i < req->n_channels; i++) { -+ struct rtw_chan_info ch_info = {0}; -+ -+ channel = req->channels[i]; -+ ch_info.channel = channel->hw_value; -+ ch_info.bw = RTW_SCAN_WIDTH; -+ ch_info.pri_ch_idx = RTW_PRI_CH_IDX; -+ ch_info.timeout = req->duration_mandatory ? -+ req->duration : RTW_CHANNEL_TIME; -+ -+ if (channel->flags & (IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IR)) { -+ ch_info.action_id = RTW_CHANNEL_RADAR; -+ ch_info.extra_info = 1; -+ /* Overwrite duration for passive scans if necessary */ -+ ch_info.timeout = ch_info.timeout > RTW_PASS_CHAN_TIME ? -+ ch_info.timeout : RTW_PASS_CHAN_TIME; -+ } else { -+ ch_info.action_id = RTW_CHANNEL_ACTIVE; -+ } -+ -+ ret = rtw_add_chan_info(rtwdev, &ch_info, list, buf); -+ if (ret) -+ return ret; -+ } -+ -+ if (list->size > fifo->rsvd_pg_num << TX_PAGE_SIZE_SHIFT) { -+ rtw_err(rtwdev, "List exceeds rsvd page total size\n"); -+ return -EINVAL; -+ } -+ -+ list->addr = fifo->rsvd_h2c_info_addr + rtwdev->scan_info.probe_pg_size; -+ ret = rtw_fw_write_data_rsvd_page(rtwdev, list->addr, buf, list->size); -+ if (ret) -+ rtw_err(rtwdev, "Download channel list failed\n"); -+ -+ return ret; -+} -+ -+static void rtw_fw_set_scan_offload(struct rtw_dev *rtwdev, -+ struct rtw_ch_switch_option *opt, -+ struct rtw_vif *rtwvif, -+ struct rtw_chan_list *list) -+{ -+ struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; -+ struct cfg80211_scan_request *req = rtwvif->scan_req; -+ struct rtw_fifo_conf *fifo = &rtwdev->fifo; -+ /* reserve one dummy page at the beginning for tx descriptor */ -+ u8 pkt_loc = fifo->rsvd_h2c_info_addr - fifo->rsvd_boundary + 1; -+ bool random_seq = req->flags & NL80211_SCAN_FLAG_RANDOM_SN; -+ u8 h2c_pkt[H2C_PKT_SIZE] = {0}; -+ -+ rtw_h2c_pkt_set_header(h2c_pkt, H2C_PKT_SCAN_OFFLOAD); -+ SET_PKT_H2C_TOTAL_LEN(h2c_pkt, H2C_PKT_CH_SWITCH_LEN); -+ -+ SCAN_OFFLOAD_SET_START(h2c_pkt, opt->switch_en); -+ SCAN_OFFLOAD_SET_BACK_OP_EN(h2c_pkt, opt->back_op_en); -+ SCAN_OFFLOAD_SET_RANDOM_SEQ_EN(h2c_pkt, random_seq); -+ SCAN_OFFLOAD_SET_NO_CCK_EN(h2c_pkt, req->no_cck); -+ SCAN_OFFLOAD_SET_CH_NUM(h2c_pkt, list->ch_num); -+ SCAN_OFFLOAD_SET_CH_INFO_SIZE(h2c_pkt, list->size); -+ SCAN_OFFLOAD_SET_CH_INFO_LOC(h2c_pkt, list->addr - fifo->rsvd_boundary); -+ SCAN_OFFLOAD_SET_OP_CH(h2c_pkt, scan_info->op_chan); -+ SCAN_OFFLOAD_SET_OP_PRI_CH_IDX(h2c_pkt, scan_info->op_pri_ch_idx); -+ SCAN_OFFLOAD_SET_OP_BW(h2c_pkt, scan_info->op_bw); -+ SCAN_OFFLOAD_SET_OP_PORT_ID(h2c_pkt, rtwvif->port); -+ SCAN_OFFLOAD_SET_OP_DWELL_TIME(h2c_pkt, req->duration_mandatory ? -+ req->duration : RTW_CHANNEL_TIME); -+ SCAN_OFFLOAD_SET_OP_GAP_TIME(h2c_pkt, RTW_OFF_CHAN_TIME); -+ SCAN_OFFLOAD_SET_SSID_NUM(h2c_pkt, req->n_ssids); -+ SCAN_OFFLOAD_SET_PKT_LOC(h2c_pkt, pkt_loc); -+ -+ rtw_fw_send_h2c_packet(rtwdev, h2c_pkt); -+} -+ -+void rtw_hw_scan_start(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, -+ struct ieee80211_scan_request *scan_req) -+{ -+ struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; -+ struct cfg80211_scan_request *req = &scan_req->req; -+ u8 mac_addr[ETH_ALEN]; -+ -+ rtwdev->scan_info.scanning_vif = vif; -+ rtwvif->scan_ies = &scan_req->ies; -+ rtwvif->scan_req = req; -+ -+ ieee80211_stop_queues(rtwdev->hw); -+ rtw_leave_lps_deep(rtwdev); -+ rtw_hci_flush_all_queues(rtwdev, false); -+ rtw_mac_flush_all_queues(rtwdev, false); -+ if (req->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) -+ get_random_mask_addr(mac_addr, req->mac_addr, -+ req->mac_addr_mask); -+ else -+ ether_addr_copy(mac_addr, vif->addr); -+ -+ rtw_core_scan_start(rtwdev, rtwvif, mac_addr, true); -+ -+ rtwdev->hal.rcr &= ~BIT_CBSSID_BCN; -+ rtw_write32(rtwdev, REG_RCR, rtwdev->hal.rcr); -+} -+ -+void rtw_hw_scan_complete(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, -+ bool aborted) -+{ -+ struct cfg80211_scan_info info = { -+ .aborted = aborted, -+ }; -+ struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; -+ struct rtw_hal *hal = &rtwdev->hal; -+ struct rtw_vif *rtwvif; -+ u8 chan = scan_info->op_chan; -+ -+ if (!vif) -+ return; -+ -+ rtwdev->hal.rcr |= BIT_CBSSID_BCN; -+ rtw_write32(rtwdev, REG_RCR, rtwdev->hal.rcr); -+ -+ rtw_core_scan_complete(rtwdev, vif, true); -+ -+ rtwvif = (struct rtw_vif *)vif->drv_priv; -+ if (chan) -+ rtw_store_op_chan(rtwdev, false); -+ rtw_phy_set_tx_power_level(rtwdev, hal->current_channel); -+ ieee80211_wake_queues(rtwdev->hw); -+ ieee80211_scan_completed(rtwdev->hw, &info); -+ -+ rtwvif->scan_req = NULL; -+ rtwvif->scan_ies = NULL; -+ rtwdev->scan_info.scanning_vif = NULL; -+} -+ -+static int rtw_hw_scan_prehandle(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif, -+ struct rtw_chan_list *list) -+{ -+ struct cfg80211_scan_request *req = rtwvif->scan_req; -+ int size = req->n_channels * (RTW_CH_INFO_SIZE + RTW_EX_CH_INFO_SIZE); -+ u8 *buf; -+ int ret; -+ -+ buf = kmalloc(size, GFP_KERNEL); -+ if (!buf) -+ return -ENOMEM; -+ -+ ret = rtw_hw_scan_update_probe_req(rtwdev, rtwvif); -+ if (ret) { -+ rtw_err(rtwdev, "Update probe request failed\n"); -+ goto out; -+ } -+ -+ list->buf_size = size; -+ list->size = 0; -+ list->ch_num = 0; -+ ret = rtw_add_chan_list(rtwdev, rtwvif, list, buf); -+out: -+ kfree(buf); -+ -+ return ret; -+} -+ -+int rtw_hw_scan_offload(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, -+ bool enable) -+{ -+ struct rtw_vif *rtwvif = vif ? (struct rtw_vif *)vif->drv_priv : NULL; -+ struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; -+ struct rtw_ch_switch_option cs_option = {0}; -+ struct rtw_chan_list chan_list = {0}; -+ int ret = 0; -+ -+ if (!rtwvif) -+ return -EINVAL; -+ -+ cs_option.switch_en = enable; -+ cs_option.back_op_en = scan_info->op_chan != 0; -+ if (enable) { -+ ret = rtw_hw_scan_prehandle(rtwdev, rtwvif, &chan_list); -+ if (ret) -+ goto out; -+ } -+ rtw_fw_set_scan_offload(rtwdev, &cs_option, rtwvif, &chan_list); -+out: -+ if (rtwdev->ap_active) { -+ ret = rtw_download_beacon(rtwdev); -+ if (ret) -+ rtw_err(rtwdev, "HW scan download beacon failed\n"); -+ } -+ -+ return ret; -+} -+ -+void rtw_hw_scan_abort(struct rtw_dev *rtwdev) -+{ -+ struct ieee80211_vif *vif = rtwdev->scan_info.scanning_vif; -+ -+ if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD)) -+ return; -+ -+ rtw_hw_scan_offload(rtwdev, vif, false); -+ rtw_hw_scan_complete(rtwdev, vif, true); -+} -+ -+void rtw_hw_scan_status_report(struct rtw_dev *rtwdev, struct sk_buff *skb) -+{ -+ struct ieee80211_vif *vif = rtwdev->scan_info.scanning_vif; -+ struct rtw_c2h_cmd *c2h; -+ bool aborted; -+ u8 rc; -+ -+ if (!test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) -+ return; -+ -+ c2h = get_c2h_from_skb(skb); -+ rc = GET_SCAN_REPORT_RETURN_CODE(c2h->payload); -+ aborted = rc != RTW_SCAN_REPORT_SUCCESS; -+ rtw_hw_scan_complete(rtwdev, vif, aborted); -+ -+ if (aborted) -+ rtw_dbg(rtwdev, RTW_DBG_HW_SCAN, "HW scan aborted with code: %d\n", rc); -+} -+ -+void rtw_store_op_chan(struct rtw_dev *rtwdev, bool backup) -+{ -+ struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; -+ struct rtw_hal *hal = &rtwdev->hal; -+ u8 band; -+ -+ if (backup) { -+ scan_info->op_chan = hal->current_channel; -+ scan_info->op_bw = hal->current_band_width; -+ scan_info->op_pri_ch_idx = hal->current_primary_channel_index; -+ scan_info->op_pri_ch = hal->primary_channel; -+ } else { -+ band = scan_info->op_chan > 14 ? RTW_BAND_5G : RTW_BAND_2G; -+ rtw_update_channel(rtwdev, scan_info->op_chan, -+ scan_info->op_pri_ch, -+ band, scan_info->op_bw); -+ } -+} -+ -+void rtw_clear_op_chan(struct rtw_dev *rtwdev) -+{ -+ struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; -+ -+ scan_info->op_chan = 0; -+ scan_info->op_bw = 0; -+ scan_info->op_pri_ch_idx = 0; -+ scan_info->op_pri_ch = 0; -+} -+ -+static bool rtw_is_op_chan(struct rtw_dev *rtwdev, u8 channel) -+{ -+ struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; -+ -+ return channel == scan_info->op_chan; -+} -+ -+void rtw_hw_scan_chan_switch(struct rtw_dev *rtwdev, struct sk_buff *skb) -+{ -+ struct rtw_hal *hal = &rtwdev->hal; -+ struct rtw_c2h_cmd *c2h; -+ enum rtw_scan_notify_id id; -+ u8 chan, band, status; -+ -+ if (!test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) -+ return; -+ -+ c2h = get_c2h_from_skb(skb); -+ chan = GET_CHAN_SWITCH_CENTRAL_CH(c2h->payload); -+ id = GET_CHAN_SWITCH_ID(c2h->payload); -+ status = GET_CHAN_SWITCH_STATUS(c2h->payload); -+ -+ if (id == RTW_SCAN_NOTIFY_ID_POSTSWITCH) { -+ band = chan > 14 ? RTW_BAND_5G : RTW_BAND_2G; -+ rtw_update_channel(rtwdev, chan, chan, band, -+ RTW_CHANNEL_WIDTH_20); -+ if (rtw_is_op_chan(rtwdev, chan)) { -+ rtw_store_op_chan(rtwdev, false); -+ ieee80211_wake_queues(rtwdev->hw); -+ rtw_core_enable_beacon(rtwdev, true); -+ } -+ } else if (id == RTW_SCAN_NOTIFY_ID_PRESWITCH) { -+ if (IS_CH_5G_BAND(chan)) { -+ rtw_coex_switchband_notify(rtwdev, COEX_SWITCH_TO_5G); -+ } else if (IS_CH_2G_BAND(chan)) { -+ u8 chan_type; -+ -+ if (test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) -+ chan_type = COEX_SWITCH_TO_24G; -+ else -+ chan_type = COEX_SWITCH_TO_24G_NOFORSCAN; -+ rtw_coex_switchband_notify(rtwdev, chan_type); -+ } -+ /* The channel of C2H RTW_SCAN_NOTIFY_ID_PRESWITCH is next -+ * channel that hardware will switch. We need to stop queue -+ * if next channel is non-op channel. -+ */ -+ if (!rtw_is_op_chan(rtwdev, chan) && -+ rtw_is_op_chan(rtwdev, hal->current_channel)) { -+ rtw_core_enable_beacon(rtwdev, false); -+ ieee80211_stop_queues(rtwdev->hw); -+ } -+ } -+ -+ rtw_dbg(rtwdev, RTW_DBG_HW_SCAN, -+ "Chan switch: %x, id: %x, status: %x\n", chan, id, status); -+} -diff --git a/drivers/net/wireless/realtek/rtw88/fw.h b/drivers/net/wireless/realtek/rtw88/fw.h -index f4aed247e..1500723d1 100644 ---- a/drivers/net/wireless/realtek/rtw88/fw.h -+++ b/drivers/net/wireless/realtek/rtw88/fw.h -@@ -24,19 +24,46 @@ - #define DLFW_BLK_SIZE_LEGACY 4 - #define FW_START_ADDR_LEGACY 0x1000 - -+#define BCN_LOSS_CNT 10 -+#define BCN_FILTER_NOTIFY_SIGNAL_CHANGE 0 -+#define BCN_FILTER_CONNECTION_LOSS 1 -+#define BCN_FILTER_CONNECTED 2 -+#define BCN_FILTER_NOTIFY_BEACON_LOSS 3 -+ -+#define SCAN_NOTIFY_TIMEOUT msecs_to_jiffies(10) -+ -+#define RTW_CHANNEL_TIME 45 -+#define RTW_OFF_CHAN_TIME 100 -+#define RTW_PASS_CHAN_TIME 105 -+#define RTW_DFS_CHAN_TIME 20 -+#define RTW_CH_INFO_SIZE 4 -+#define RTW_EX_CH_INFO_SIZE 3 -+#define RTW_EX_CH_INFO_HDR_SIZE 2 -+#define RTW_SCAN_WIDTH 0 -+#define RTW_PRI_CH_IDX 1 -+#define RTW_OLD_PROBE_PG_CNT 2 -+#define RTW_PROBE_PG_CNT 4 -+ - enum rtw_c2h_cmd_id { - C2H_CCX_TX_RPT = 0x03, - C2H_BT_INFO = 0x09, - C2H_BT_MP_INFO = 0x0b, -+ C2H_BT_HID_INFO = 0x45, - C2H_RA_RPT = 0x0c, - C2H_HW_FEATURE_REPORT = 0x19, - C2H_WLAN_INFO = 0x27, -+ C2H_WLAN_RFON = 0x32, -+ C2H_BCN_FILTER_NOTIFY = 0x36, -+ C2H_ADAPTIVITY = 0x37, -+ C2H_SCAN_RESULT = 0x38, - C2H_HW_FEATURE_DUMP = 0xfd, - C2H_HALMAC = 0xff, - }; - - enum rtw_c2h_cmd_id_ext { -+ C2H_SCAN_STATUS_RPT = 0x3, - C2H_CCX_RPT = 0x0f, -+ C2H_CHAN_SWITCH = 0x22, - }; - - struct rtw_c2h_cmd { -@@ -45,6 +72,31 @@ struct rtw_c2h_cmd { - u8 payload[]; - } __packed; - -+struct rtw_c2h_adaptivity { -+ u8 density; -+ u8 igi; -+ u8 l2h_th_init; -+ u8 l2h; -+ u8 h2l; -+ u8 option; -+} __packed; -+ -+struct rtw_h2c_register { -+ u32 w0; -+ u32 w1; -+} __packed; -+ -+#define RTW_H2C_W0_CMDID GENMASK(7, 0) -+ -+/* H2C_CMD_DEFAULT_PORT command */ -+#define RTW_H2C_DEFAULT_PORT_W0_PORTID GENMASK(15, 8) -+#define RTW_H2C_DEFAULT_PORT_W0_MACID GENMASK(23, 16) -+ -+struct rtw_h2c_cmd { -+ __le32 msg; -+ __le32 msg_ext; -+} __packed; -+ - enum rtw_rsvd_packet_type { - RSVD_BEACON, - RSVD_DUMMY, -@@ -72,6 +124,32 @@ enum rtw_fw_rf_type { - FW_RF_MAX_TYPE = 0xF, - }; - -+enum rtw_fw_feature { -+ FW_FEATURE_SIG = BIT(0), -+ FW_FEATURE_LPS_C2H = BIT(1), -+ FW_FEATURE_LCLK = BIT(2), -+ FW_FEATURE_PG = BIT(3), -+ FW_FEATURE_TX_WAKE = BIT(4), -+ FW_FEATURE_BCN_FILTER = BIT(5), -+ FW_FEATURE_NOTIFY_SCAN = BIT(6), -+ FW_FEATURE_ADAPTIVITY = BIT(7), -+ FW_FEATURE_SCAN_OFFLOAD = BIT(8), -+ FW_FEATURE_MAX = BIT(31), -+}; -+ -+enum rtw_fw_feature_ext { -+ FW_FEATURE_EXT_OLD_PAGE_NUM = BIT(0), -+}; -+ -+enum rtw_beacon_filter_offload_mode { -+ BCN_FILTER_OFFLOAD_MODE_0 = 0, -+ BCN_FILTER_OFFLOAD_MODE_1, -+ BCN_FILTER_OFFLOAD_MODE_2, -+ BCN_FILTER_OFFLOAD_MODE_3, -+ -+ BCN_FILTER_OFFLOAD_MODE_DEFAULT = BCN_FILTER_OFFLOAD_MODE_0, -+}; -+ - struct rtw_coex_info_req { - u8 seq; - u8 op_code; -@@ -115,6 +193,7 @@ struct rtw_rsvd_page { - struct sk_buff *skb; - enum rtw_rsvd_packet_type type; - u8 page; -+ u16 tim_offset; - bool add_txdesc; - struct cfg80211_ssid *ssid; - u16 probe_req_size; -@@ -155,6 +234,51 @@ struct rtw_fw_wow_disconnect_para { - u8 retry_count; - }; - -+enum rtw_channel_type { -+ RTW_CHANNEL_PASSIVE, -+ RTW_CHANNEL_ACTIVE, -+ RTW_CHANNEL_RADAR, -+}; -+ -+enum rtw_scan_extra_id { -+ RTW_SCAN_EXTRA_ID_DFS, -+}; -+ -+enum rtw_scan_extra_info { -+ RTW_SCAN_EXTRA_ACTION_SCAN, -+}; -+ -+enum rtw_scan_report_code { -+ RTW_SCAN_REPORT_SUCCESS = 0x00, -+ RTW_SCAN_REPORT_ERR_PHYDM = 0x01, -+ RTW_SCAN_REPORT_ERR_ID = 0x02, -+ RTW_SCAN_REPORT_ERR_TX = 0x03, -+ RTW_SCAN_REPORT_CANCELED = 0x10, -+ RTW_SCAN_REPORT_CANCELED_EXT = 0x11, -+ RTW_SCAN_REPORT_FW_DISABLED = 0xF0, -+}; -+ -+enum rtw_scan_notify_id { -+ RTW_SCAN_NOTIFY_ID_PRESWITCH = 0x00, -+ RTW_SCAN_NOTIFY_ID_POSTSWITCH = 0x01, -+ RTW_SCAN_NOTIFY_ID_PROBE_PRETX = 0x02, -+ RTW_SCAN_NOTIFY_ID_PROBE_ISSUETX = 0x03, -+ RTW_SCAN_NOTIFY_ID_NULL0_PRETX = 0x04, -+ RTW_SCAN_NOTIFY_ID_NULL0_ISSUETX = 0x05, -+ RTW_SCAN_NOTIFY_ID_NULL0_POSTTX = 0x06, -+ RTW_SCAN_NOTIFY_ID_NULL1_PRETX = 0x07, -+ RTW_SCAN_NOTIFY_ID_NULL1_ISSUETX = 0x08, -+ RTW_SCAN_NOTIFY_ID_NULL1_POSTTX = 0x09, -+ RTW_SCAN_NOTIFY_ID_DWELLEXT = 0x0A, -+}; -+ -+enum rtw_scan_notify_status { -+ RTW_SCAN_NOTIFY_STATUS_SUCCESS = 0x00, -+ RTW_SCAN_NOTIFY_STATUS_FAILURE = 0x01, -+ RTW_SCAN_NOTIFY_STATUS_RESOURCE = 0x02, -+ RTW_SCAN_NOTIFY_STATUS_TIMEOUT = 0x03, -+}; -+ - struct rtw_ch_switch_option { - u8 periodic_option; - u32 tsf_high; -@@ -168,6 +292,8 @@ struct rtw_ch_switch_option { - u8 slow_period; - u8 slow_period_sel; - u8 nlo_en; -+ bool switch_en; -+ bool back_op_en; - }; - - struct rtw_fw_hdr { -@@ -178,7 +304,7 @@ struct rtw_fw_hdr { - u8 subversion; - u8 subindex; - __le32 rsvd; /* 0x08 */ -- __le32 rsvd2; /* 0x0C */ -+ __le32 feature; /* 0x0C */ - u8 month; /* 0x10 */ - u8 day; - u8 hour; -@@ -218,17 +344,31 @@ struct rtw_fw_hdr_legacy { - __le32 rsvd5; - } __packed; - -+#define RTW_FW_VER_CODE(ver, sub_ver, idx) \ -+ (((ver) << 16) | ((sub_ver) << 8) | (idx)) -+#define RTW_FW_SUIT_VER_CODE(s) \ -+ RTW_FW_VER_CODE((s).version, (s).sub_version, (s).sub_index) -+ - /* C2H */ - #define GET_CCX_REPORT_SEQNUM_V0(c2h_payload) (c2h_payload[6] & 0xfc) - #define GET_CCX_REPORT_STATUS_V0(c2h_payload) (c2h_payload[0] & 0xc0) - #define GET_CCX_REPORT_SEQNUM_V1(c2h_payload) (c2h_payload[8] & 0xfc) - #define GET_CCX_REPORT_STATUS_V1(c2h_payload) (c2h_payload[9] & 0xc0) - -+#define GET_SCAN_REPORT_RETURN_CODE(c2h_payload) (c2h_payload[2] & 0xff) -+ -+#define GET_CHAN_SWITCH_CENTRAL_CH(c2h_payload) (c2h_payload[2]) -+#define GET_CHAN_SWITCH_ID(c2h_payload) (c2h_payload[3]) -+#define GET_CHAN_SWITCH_STATUS(c2h_payload) (c2h_payload[4]) - #define GET_RA_REPORT_RATE(c2h_payload) (c2h_payload[0] & 0x7f) - #define GET_RA_REPORT_SGI(c2h_payload) ((c2h_payload[0] & 0x80) >> 7) - #define GET_RA_REPORT_BW(c2h_payload) (c2h_payload[6]) - #define GET_RA_REPORT_MACID(c2h_payload) (c2h_payload[1]) - -+#define GET_BCN_FILTER_NOTIFY_TYPE(c2h_payload) (c2h_payload[1] & 0xf) -+#define GET_BCN_FILTER_NOTIFY_EVENT(c2h_payload) (c2h_payload[1] & 0x10) -+#define GET_BCN_FILTER_NOTIFY_RSSI(c2h_payload) (c2h_payload[2] - 100) -+ - /* PKT H2C */ - #define H2C_PKT_CMD_ID 0xFF - #define H2C_PKT_CATEGORY 0x01 -@@ -239,6 +379,7 @@ struct rtw_fw_hdr_legacy { - - #define H2C_PKT_CH_SWITCH 0x02 - #define H2C_PKT_UPDATE_PKT 0x0C -+#define H2C_PKT_SCAN_OFFLOAD 0x19 - - #define H2C_PKT_CH_SWITCH_LEN 0x20 - #define H2C_PKT_UPDATE_PKT_LEN 0x4 -@@ -289,6 +430,30 @@ static inline void rtw_h2c_pkt_set_header(u8 *h2c_pkt, u8 sub_id) - le32p_replace_bits((__le32 *)(pkt) + 0x00, value, GENMASK(23, 16)) - #define CHSW_INFO_SET_ACTION_ID(pkt, value) \ - le32p_replace_bits((__le32 *)(pkt) + 0x00, value, GENMASK(30, 24)) -+#define CHSW_INFO_SET_EXTRA_INFO(pkt, value) \ -+ le32p_replace_bits((__le32 *)(pkt) + 0x00, value, BIT(31)) -+ -+#define CH_INFO_SET_CH(pkt, value) \ -+ u8p_replace_bits((u8 *)(pkt) + 0x00, value, GENMASK(7, 0)) -+#define CH_INFO_SET_PRI_CH_IDX(pkt, value) \ -+ u8p_replace_bits((u8 *)(pkt) + 0x01, value, GENMASK(3, 0)) -+#define CH_INFO_SET_BW(pkt, value) \ -+ u8p_replace_bits((u8 *)(pkt) + 0x01, value, GENMASK(7, 4)) -+#define CH_INFO_SET_TIMEOUT(pkt, value) \ -+ u8p_replace_bits((u8 *)(pkt) + 0x02, value, GENMASK(7, 0)) -+#define CH_INFO_SET_ACTION_ID(pkt, value) \ -+ u8p_replace_bits((u8 *)(pkt) + 0x03, value, GENMASK(6, 0)) -+#define CH_INFO_SET_EXTRA_INFO(pkt, value) \ -+ u8p_replace_bits((u8 *)(pkt) + 0x03, value, BIT(7)) -+ -+#define EXTRA_CH_INFO_SET_ID(pkt, value) \ -+ u8p_replace_bits((u8 *)(pkt) + 0x04, value, GENMASK(6, 0)) -+#define EXTRA_CH_INFO_SET_INFO(pkt, value) \ -+ u8p_replace_bits((u8 *)(pkt) + 0x04, value, BIT(7)) -+#define EXTRA_CH_INFO_SET_SIZE(pkt, value) \ -+ u8p_replace_bits((u8 *)(pkt) + 0x05, value, GENMASK(7, 0)) -+#define EXTRA_CH_INFO_SET_DFS_EXT_TIME(pkt, value) \ -+ u8p_replace_bits((u8 *)(pkt) + 0x06, value, GENMASK(7, 0)) - - #define UPDATE_PKT_SET_SIZE(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(15, 0)) -@@ -305,12 +470,18 @@ static inline void rtw_h2c_pkt_set_header(u8 *h2c_pkt, u8 sub_id) - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(2)) - #define CH_SWITCH_SET_PERIODIC_OPT(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(4, 3)) -+#define CH_SWITCH_SET_SCAN_MODE(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(5)) -+#define CH_SWITCH_SET_BACK_OP_EN(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(6)) - #define CH_SWITCH_SET_INFO_LOC(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(15, 8)) - #define CH_SWITCH_SET_CH_NUM(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(23, 16)) - #define CH_SWITCH_SET_PRI_CH_IDX(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(27, 24)) -+#define CH_SWITCH_SET_DEST_BW(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(31, 28)) - #define CH_SWITCH_SET_DEST_CH(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(7, 0)) - #define CH_SWITCH_SET_NORMAL_PERIOD(h2c_pkt, value) \ -@@ -330,13 +501,54 @@ static inline void rtw_h2c_pkt_set_header(u8 *h2c_pkt, u8 sub_id) - #define CH_SWITCH_SET_INFO_SIZE(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x06, value, GENMASK(15, 0)) - -+#define SCAN_OFFLOAD_SET_START(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(0)) -+#define SCAN_OFFLOAD_SET_BACK_OP_EN(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(1)) -+#define SCAN_OFFLOAD_SET_RANDOM_SEQ_EN(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(2)) -+#define SCAN_OFFLOAD_SET_NO_CCK_EN(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(3)) -+#define SCAN_OFFLOAD_SET_VERBOSE(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(4)) -+#define SCAN_OFFLOAD_SET_CH_NUM(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(15, 8)) -+#define SCAN_OFFLOAD_SET_CH_INFO_SIZE(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(31, 16)) -+#define SCAN_OFFLOAD_SET_CH_INFO_LOC(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(7, 0)) -+#define SCAN_OFFLOAD_SET_OP_CH(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(15, 8)) -+#define SCAN_OFFLOAD_SET_OP_PRI_CH_IDX(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(19, 16)) -+#define SCAN_OFFLOAD_SET_OP_BW(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(23, 20)) -+#define SCAN_OFFLOAD_SET_OP_PORT_ID(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(26, 24)) -+#define SCAN_OFFLOAD_SET_OP_DWELL_TIME(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x04, value, GENMASK(15, 0)) -+#define SCAN_OFFLOAD_SET_OP_GAP_TIME(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x04, value, GENMASK(31, 16)) -+#define SCAN_OFFLOAD_SET_MODE(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x05, value, GENMASK(3, 0)) -+#define SCAN_OFFLOAD_SET_SSID_NUM(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x05, value, GENMASK(7, 4)) -+#define SCAN_OFFLOAD_SET_PKT_LOC(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x05, value, GENMASK(15, 8)) -+ - /* Command H2C */ - #define H2C_CMD_RSVD_PAGE 0x0 - #define H2C_CMD_MEDIA_STATUS_RPT 0x01 - #define H2C_CMD_SET_PWR_MODE 0x20 - #define H2C_CMD_LPS_PG_INFO 0x2b -+#define H2C_CMD_DEFAULT_PORT 0x2c - #define H2C_CMD_RA_INFO 0x40 - #define H2C_CMD_RSSI_MONITOR 0x42 -+#define H2C_CMD_BCN_FILTER_OFFLOAD_P0 0x56 -+#define H2C_CMD_BCN_FILTER_OFFLOAD_P1 0x57 -+#define H2C_CMD_WL_PHY_INFO 0x58 -+#define H2C_CMD_SCAN 0x59 -+#define H2C_CMD_ADAPTIVITY 0x5A - - #define H2C_CMD_COEX_TDMA_TYPE 0x60 - #define H2C_CMD_QUERY_BT_INFO 0x61 -@@ -345,6 +557,8 @@ static inline void rtw_h2c_pkt_set_header(u8 *h2c_pkt, u8 sub_id) - #define H2C_CMD_WL_CH_INFO 0x66 - #define H2C_CMD_QUERY_BT_MP_INFO 0x67 - #define H2C_CMD_BT_WIFI_CONTROL 0x69 -+#define H2C_CMD_WIFI_CALIBRATION 0x6d -+#define H2C_CMD_QUERY_BT_HID_INFO 0x73 - - #define H2C_CMD_KEEP_ALIVE 0x03 - #define H2C_CMD_DISCONNECT_DECISION 0x04 -@@ -353,6 +567,8 @@ static inline void rtw_h2c_pkt_set_header(u8 *h2c_pkt, u8 sub_id) - #define H2C_CMD_AOAC_GLOBAL_INFO 0x82 - #define H2C_CMD_NLO_INFO 0x8C - -+#define H2C_CMD_RECOVER_BT_DEV 0xD1 -+ - #define SET_H2C_CMD_ID_CLASS(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(7, 0)) - -@@ -361,6 +577,45 @@ static inline void rtw_h2c_pkt_set_header(u8 *h2c_pkt, u8 sub_id) - #define MEDIA_STATUS_RPT_SET_MACID(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) - -+#define SET_WL_PHY_INFO_TX_TP(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(17, 8)) -+#define SET_WL_PHY_INFO_RX_TP(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(27, 18)) -+#define SET_WL_PHY_INFO_TX_RATE_DESC(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(7, 0)) -+#define SET_WL_PHY_INFO_RX_RATE_DESC(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(15, 8)) -+#define SET_WL_PHY_INFO_RX_EVM(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(23, 16)) -+#define SET_BCN_FILTER_OFFLOAD_P1_MACID(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) -+#define SET_BCN_FILTER_OFFLOAD_P1_ENABLE(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(16)) -+#define SET_BCN_FILTER_OFFLOAD_P1_HYST(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(20, 17)) -+#define SET_BCN_FILTER_OFFLOAD_P1_OFFLOAD_MODE(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 21)) -+#define SET_BCN_FILTER_OFFLOAD_P1_THRESHOLD(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) -+#define SET_BCN_FILTER_OFFLOAD_P1_BCN_LOSS_CNT(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(3, 0)) -+#define SET_BCN_FILTER_OFFLOAD_P1_BCN_INTERVAL(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(13, 4)) -+ -+#define SET_SCAN_START(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) -+ -+#define SET_ADAPTIVITY_MODE(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(11, 8)) -+#define SET_ADAPTIVITY_OPTION(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 12)) -+#define SET_ADAPTIVITY_IGI(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) -+#define SET_ADAPTIVITY_L2H(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) -+#define SET_ADAPTIVITY_DENSITY(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(7, 0)) -+ - #define SET_PWR_MODE_SET_MODE(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(14, 8)) - #define SET_PWR_MODE_SET_RLBM(h2c_pkt, value) \ -@@ -458,6 +713,11 @@ static inline void rtw_h2c_pkt_set_header(u8 *h2c_pkt, u8 sub_id) - #define SET_BT_WIFI_CONTROL_DATA5(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(23, 16)) - -+#define SET_COEX_QUERY_HID_INFO_SUBID(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) -+#define SET_COEX_QUERY_HID_INFO_DATA1(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) -+ - #define SET_KEEP_ALIVE_ENABLE(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) - #define SET_KEEP_ALIVE_ADOPT(h2c_pkt, value) \ -@@ -508,6 +768,9 @@ static inline void rtw_h2c_pkt_set_header(u8 *h2c_pkt, u8 sub_id) - #define SET_NLO_LOC_NLO_INFO(h2c_pkt, value) \ - le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) - -+#define SET_RECOVER_BT_DEV_EN(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) -+ - #define GET_FW_DUMP_LEN(_header) \ - le32_get_bits(*((__le32 *)(_header) + 0x00), GENMASK(15, 0)) - #define GET_FW_DUMP_SEQ(_header) \ -@@ -522,6 +785,9 @@ static inline void rtw_h2c_pkt_set_header(u8 *h2c_pkt, u8 sub_id) - le32_get_bits(*((__le32 *)(_header) + 0x01), GENMASK(31, 16)) - #define GET_FW_DUMP_TLV_VAL(_header) \ - le32_get_bits(*((__le32 *)(_header) + 0x02), GENMASK(31, 0)) -+ -+#define RFK_SET_INFORM_START(h2c_pkt, value) \ -+ le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) - static inline struct rtw_c2h_cmd *get_c2h_from_skb(struct sk_buff *skb) - { - u32 pkt_offset; -@@ -530,13 +796,27 @@ static inline struct rtw_c2h_cmd *get_c2h_from_skb(struct sk_buff *skb) - return (struct rtw_c2h_cmd *)(skb->data + pkt_offset); - } - -+static inline bool rtw_fw_feature_check(struct rtw_fw_state *fw, -+ enum rtw_fw_feature feature) -+{ -+ return !!(fw->feature & feature); -+} -+ -+static inline bool rtw_fw_feature_ext_check(struct rtw_fw_state *fw, -+ enum rtw_fw_feature_ext feature) -+{ -+ return !!(fw->feature_ext & feature); -+} -+ - void rtw_fw_c2h_cmd_rx_irqsafe(struct rtw_dev *rtwdev, u32 pkt_offset, - struct sk_buff *skb); - void rtw_fw_c2h_cmd_handle(struct rtw_dev *rtwdev, struct sk_buff *skb); - void rtw_fw_send_general_info(struct rtw_dev *rtwdev); - void rtw_fw_send_phydm_info(struct rtw_dev *rtwdev); -+void rtw_fw_default_port(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif); - - void rtw_fw_do_iqk(struct rtw_dev *rtwdev, struct rtw_iqk_para *para); -+void rtw_fw_inform_rfk_status(struct rtw_dev *rtwdev, bool start); - void rtw_fw_set_pwr_mode(struct rtw_dev *rtwdev); - void rtw_fw_set_pg_info(struct rtw_dev *rtwdev); - void rtw_fw_query_bt_info(struct rtw_dev *rtwdev); -@@ -547,10 +827,20 @@ void rtw_fw_force_bt_tx_power(struct rtw_dev *rtwdev, u8 bt_pwr_dec_lvl); - void rtw_fw_bt_ignore_wlan_action(struct rtw_dev *rtwdev, bool enable); - void rtw_fw_coex_tdma_type(struct rtw_dev *rtwdev, - u8 para1, u8 para2, u8 para3, u8 para4, u8 para5); -+void rtw_fw_coex_query_hid_info(struct rtw_dev *rtwdev, u8 sub_id, u8 data); -+ - void rtw_fw_bt_wifi_control(struct rtw_dev *rtwdev, u8 op_code, u8 *data); - void rtw_fw_send_rssi_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 18, 0) -+void rtw_fw_send_ra_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si, -+ bool reset_ra_mask); -+#else - void rtw_fw_send_ra_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si); -+#endif - void rtw_fw_media_status_report(struct rtw_dev *rtwdev, u8 mac_id, bool conn); -+void rtw_fw_update_wl_phy_info(struct rtw_dev *rtwdev); -+void rtw_fw_beacon_filter_config(struct rtw_dev *rtwdev, bool connect, -+ struct ieee80211_vif *vif); - int rtw_fw_write_data_rsvd_page(struct rtw_dev *rtwdev, u16 pg_addr, - u8 *buf, u32 size); - void rtw_remove_rsvd_page(struct rtw_dev *rtwdev, -@@ -562,6 +852,7 @@ void rtw_add_rsvd_page_pno(struct rtw_dev *rtwdev, - void rtw_add_rsvd_page_sta(struct rtw_dev *rtwdev, - struct rtw_vif *rtwvif); - int rtw_fw_download_rsvd_page(struct rtw_dev *rtwdev); -+void rtw_fw_update_beacon_work(struct work_struct *work); - void rtw_send_rsvd_page_h2c(struct rtw_dev *rtwdev); - int rtw_dump_drv_rsvd_page(struct rtw_dev *rtwdev, - u32 offset, u32 size, u32 *buf); -@@ -574,6 +865,7 @@ void rtw_fw_set_aoac_global_info_cmd(struct rtw_dev *rtwdev, - u8 group_key_enc); - - void rtw_fw_set_nlo_info(struct rtw_dev *rtwdev, bool enable); -+void rtw_fw_set_recover_bt_device(struct rtw_dev *rtwdev); - void rtw_fw_update_pkt_probe_req(struct rtw_dev *rtwdev, - struct cfg80211_ssid *ssid); - void rtw_fw_channel_switch(struct rtw_dev *rtwdev, bool enable); -@@ -581,5 +873,17 @@ void rtw_fw_h2c_cmd_dbg(struct rtw_dev *rtwdev, u8 *h2c); - void rtw_fw_c2h_cmd_isr(struct rtw_dev *rtwdev); - int rtw_fw_dump_fifo(struct rtw_dev *rtwdev, u8 fifo_sel, u32 addr, u32 size, - u32 *buffer); -- -+void rtw_fw_scan_notify(struct rtw_dev *rtwdev, bool start); -+void rtw_fw_adaptivity(struct rtw_dev *rtwdev); -+void rtw_store_op_chan(struct rtw_dev *rtwdev, bool backup); -+void rtw_clear_op_chan(struct rtw_dev *rtwdev); -+void rtw_hw_scan_start(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, -+ struct ieee80211_scan_request *req); -+void rtw_hw_scan_complete(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, -+ bool aborted); -+int rtw_hw_scan_offload(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, -+ bool enable); -+void rtw_hw_scan_status_report(struct rtw_dev *rtwdev, struct sk_buff *skb); -+void rtw_hw_scan_chan_switch(struct rtw_dev *rtwdev, struct sk_buff *skb); -+void rtw_hw_scan_abort(struct rtw_dev *rtwdev); - #endif -diff --git a/drivers/net/wireless/realtek/rtw88/hci.h b/drivers/net/wireless/realtek/rtw88/hci.h -index 2cba327e6..830d7532f 100644 ---- a/drivers/net/wireless/realtek/rtw88/hci.h -+++ b/drivers/net/wireless/realtek/rtw88/hci.h -@@ -11,6 +11,7 @@ struct rtw_hci_ops { - struct rtw_tx_pkt_info *pkt_info, - struct sk_buff *skb); - void (*tx_kick_off)(struct rtw_dev *rtwdev); -+ void (*flush_queues)(struct rtw_dev *rtwdev, u32 queues, bool drop); - int (*setup)(struct rtw_dev *rtwdev); - int (*start)(struct rtw_dev *rtwdev); - void (*stop)(struct rtw_dev *rtwdev); -@@ -165,12 +166,11 @@ static inline u32 - rtw_read_rf(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, - u32 addr, u32 mask) - { -- unsigned long flags; - u32 val; - -- spin_lock_irqsave(&rtwdev->rf_lock, flags); -+ lockdep_assert_held(&rtwdev->mutex); -+ - val = rtwdev->chip->ops->read_rf(rtwdev, rf_path, addr, mask); -- spin_unlock_irqrestore(&rtwdev->rf_lock, flags); - - return val; - } -@@ -179,11 +179,9 @@ static inline void - rtw_write_rf(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, - u32 addr, u32 mask, u32 data) - { -- unsigned long flags; -+ lockdep_assert_held(&rtwdev->mutex); - -- spin_lock_irqsave(&rtwdev->rf_lock, flags); - rtwdev->chip->ops->write_rf(rtwdev, rf_path, addr, mask, data); -- spin_unlock_irqrestore(&rtwdev->rf_lock, flags); - } - - static inline u32 -@@ -258,4 +256,19 @@ static inline enum rtw_hci_type rtw_hci_type(struct rtw_dev *rtwdev) - return rtwdev->hci.type; - } - -+static inline void rtw_hci_flush_queues(struct rtw_dev *rtwdev, u32 queues, -+ bool drop) -+{ -+ if (rtwdev->hci.ops->flush_queues) -+ rtwdev->hci.ops->flush_queues(rtwdev, queues, drop); -+} -+ -+static inline void rtw_hci_flush_all_queues(struct rtw_dev *rtwdev, bool drop) -+{ -+ if (rtwdev->hci.ops->flush_queues) -+ rtwdev->hci.ops->flush_queues(rtwdev, -+ BIT(rtwdev->hw->queues) - 1, -+ drop); -+} -+ - #endif -diff --git a/drivers/net/wireless/realtek/rtw88/mac.c b/drivers/net/wireless/realtek/rtw88/mac.c -index a6d554a9d..298663b03 100644 ---- a/drivers/net/wireless/realtek/rtw88/mac.c -+++ b/drivers/net/wireless/realtek/rtw88/mac.c -@@ -7,6 +7,7 @@ - #include "reg.h" - #include "fw.h" - #include "debug.h" -+#include "sdio.h" - - void rtw_set_channel_mac(struct rtw_dev *rtwdev, u8 channel, u8 bw, - u8 primary_ch_idx) -@@ -60,6 +61,7 @@ EXPORT_SYMBOL(rtw_set_channel_mac); - - static int rtw_mac_pre_system_cfg(struct rtw_dev *rtwdev) - { -+ unsigned int retry; - u32 value32; - u8 value8; - -@@ -75,7 +77,29 @@ static int rtw_mac_pre_system_cfg(struct rtw_dev *rtwdev) - - switch (rtw_hci_type(rtwdev)) { - case RTW_HCI_TYPE_PCIE: -- rtw_write32_set(rtwdev, REG_HCI_OPT_CTRL, BIT_BT_DIG_CLK_EN); -+ rtw_write32_set(rtwdev, REG_HCI_OPT_CTRL, BIT_USB_SUS_DIS); -+ break; -+ case RTW_HCI_TYPE_SDIO: -+ rtw_write8_clr(rtwdev, REG_SDIO_HSUS_CTRL, BIT_HCI_SUS_REQ); -+ -+ for (retry = 0; retry < RTW_PWR_POLLING_CNT; retry++) { -+ if (rtw_read8(rtwdev, REG_SDIO_HSUS_CTRL) & BIT_HCI_RESUME_RDY) -+ break; -+ -+ usleep_range(10, 50); -+ } -+ -+ if (retry == RTW_PWR_POLLING_CNT) { -+ rtw_err(rtwdev, "failed to poll REG_SDIO_HSUS_CTRL[1]"); -+ return -ETIMEDOUT; -+ } -+ -+ if (rtw_sdio_is_sdio30_supported(rtwdev)) -+ rtw_write8_set(rtwdev, REG_HCI_OPT_CTRL + 2, -+ BIT_SDIO_PAD_E5 >> 16); -+ else -+ rtw_write8_clr(rtwdev, REG_HCI_OPT_CTRL + 2, -+ BIT_SDIO_PAD_E5 >> 16); - break; - case RTW_HCI_TYPE_USB: - break; -@@ -217,10 +241,13 @@ static int rtw_pwr_seq_parser(struct rtw_dev *rtwdev, - cut_mask = cut_version_to_mask(cut); - switch (rtw_hci_type(rtwdev)) { - case RTW_HCI_TYPE_PCIE: -- intf_mask = BIT(2); -+ intf_mask = RTW_PWR_INTF_PCI_MSK; - break; - case RTW_HCI_TYPE_USB: -- intf_mask = BIT(1); -+ intf_mask = RTW_PWR_INTF_USB_MSK; -+ break; -+ case RTW_HCI_TYPE_SDIO: -+ intf_mask = RTW_PWR_INTF_SDIO_MSK; - break; - default: - return -EINVAL; -@@ -243,8 +270,9 @@ static int rtw_pwr_seq_parser(struct rtw_dev *rtwdev, - - static int rtw_mac_power_switch(struct rtw_dev *rtwdev, bool pwr_on) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - const struct rtw_pwr_seq_cmd **pwr_seq; -+ u32 imr = 0; - u8 rpwm; - bool cur_pwr; - int ret; -@@ -270,12 +298,24 @@ static int rtw_mac_power_switch(struct rtw_dev *rtwdev, bool pwr_on) - if (pwr_on == cur_pwr) - return -EALREADY; - -+ if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) { -+ imr = rtw_read32(rtwdev, REG_SDIO_HIMR); -+ rtw_write32(rtwdev, REG_SDIO_HIMR, 0); -+ } -+ -+ if (!pwr_on) -+ clear_bit(RTW_FLAG_POWERON, rtwdev->flags); -+ - pwr_seq = pwr_on ? chip->pwr_on_seq : chip->pwr_off_seq; - ret = rtw_pwr_seq_parser(rtwdev, pwr_seq); -- if (ret) -- return ret; - -- return 0; -+ if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) -+ rtw_write32(rtwdev, REG_SDIO_HIMR, imr); -+ -+ if (!ret && pwr_on) -+ set_bit(RTW_FLAG_POWERON, rtwdev->flags); -+ -+ return ret; - } - - static int __rtw_mac_init_system_cfg(struct rtw_dev *rtwdev) -@@ -337,6 +377,11 @@ int rtw_mac_power_on(struct rtw_dev *rtwdev) - ret = rtw_mac_power_switch(rtwdev, true); - if (ret == -EALREADY) { - rtw_mac_power_switch(rtwdev, false); -+ -+ ret = rtw_mac_pre_system_cfg(rtwdev); -+ if (ret) -+ goto err; -+ - ret = rtw_mac_power_switch(rtwdev, true); - if (ret) - goto err; -@@ -441,6 +486,9 @@ static void download_firmware_reg_backup(struct rtw_dev *rtwdev, - rtw_write16(rtwdev, REG_FIFOPAGE_INFO_1, 0x200); - rtw_write32(rtwdev, REG_RQPN_CTRL_2, bckp[bckp_idx - 1].val); - -+ if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) -+ rtw_read32(rtwdev, REG_SDIO_FREE_TXPG); -+ - /* Disable beacon related functions */ - tmp = rtw_read8(rtwdev, REG_BCN_CTRL); - bckp[bckp_idx].len = 1; -@@ -532,6 +580,25 @@ static int iddma_download_firmware(struct rtw_dev *rtwdev, u32 src, u32 dst, - return 0; - } - -+int rtw_ddma_to_fw_fifo(struct rtw_dev *rtwdev, u32 ocp_src, u32 size) -+{ -+ u32 ch0_ctrl = BIT_DDMACH0_OWN | BIT_DDMACH0_DDMA_MODE; -+ -+ if (!check_hw_ready(rtwdev, REG_DDMA_CH0CTRL, BIT_DDMACH0_OWN, 0)) { -+ rtw_dbg(rtwdev, RTW_DBG_FW, "busy to start ddma\n"); -+ return -EBUSY; -+ } -+ -+ ch0_ctrl |= size & BIT_MASK_DDMACH0_DLEN; -+ -+ if (iddma_enable(rtwdev, ocp_src, OCPBASE_RXBUF_FW_88XX, ch0_ctrl)) { -+ rtw_dbg(rtwdev, RTW_DBG_FW, "busy to complete ddma\n"); -+ return -EBUSY; -+ } -+ -+ return 0; -+} -+ - static bool - check_fw_checksum(struct rtw_dev *rtwdev, u32 addr) - { -@@ -570,7 +637,7 @@ static int - download_firmware_to_mem(struct rtw_dev *rtwdev, const u8 *data, - u32 src, u32 dst, u32 size) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - u32 desc_size = chip->tx_pkt_desc_sz; - u8 first_part; - u32 mem_offset; -@@ -727,8 +794,10 @@ static int __rtw_download_firmware(struct rtw_dev *rtwdev, - - wlan_cpu_enable(rtwdev, true); - -- if (!ltecoex_reg_write(rtwdev, 0x38, ltecoex_bckp)) -- return -EBUSY; -+ if (!ltecoex_reg_write(rtwdev, 0x38, ltecoex_bckp)) { -+ ret = -EBUSY; -+ goto dlfw_fail; -+ } - - ret = download_firmware_validate(rtwdev); - if (ret) -@@ -889,7 +958,8 @@ static int __rtw_download_firmware_legacy(struct rtw_dev *rtwdev, - return ret; - } - --int rtw_download_firmware(struct rtw_dev *rtwdev, struct rtw_fw_state *fw) -+static -+int _rtw_download_firmware(struct rtw_dev *rtwdev, struct rtw_fw_state *fw) - { - if (rtw_chip_wcpu_11n(rtwdev)) - return __rtw_download_firmware_legacy(rtwdev, fw); -@@ -897,6 +967,21 @@ int rtw_download_firmware(struct rtw_dev *rtwdev, struct rtw_fw_state *fw) - return __rtw_download_firmware(rtwdev, fw); - } - -+int rtw_download_firmware(struct rtw_dev *rtwdev, struct rtw_fw_state *fw) -+{ -+ int ret; -+ -+ ret = _rtw_download_firmware(rtwdev, fw); -+ if (ret) -+ return ret; -+ -+ if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_PCIE && -+ rtwdev->chip->id == RTW_CHIP_TYPE_8821C) -+ rtw_fw_set_recover_bt_device(rtwdev); -+ -+ return 0; -+} -+ - static u32 get_priority_queues(struct rtw_dev *rtwdev, u32 queues) - { - const struct rtw_rqpn *rqpn = rtwdev->fifo.rqpn; -@@ -917,7 +1002,7 @@ static u32 get_priority_queues(struct rtw_dev *rtwdev, u32 queues) - static void __rtw_mac_flush_prio_queue(struct rtw_dev *rtwdev, - u32 prio_queue, bool drop) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - const struct rtw_prioq_addr *addr; - bool wsize; - u16 avail_page, rsvd_page; -@@ -979,7 +1064,7 @@ void rtw_mac_flush_queues(struct rtw_dev *rtwdev, u32 queues, bool drop) - - static int txdma_queue_mapping(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - const struct rtw_rqpn *rqpn = NULL; - u16 txdma_pq_map = 0; - -@@ -997,6 +1082,9 @@ static int txdma_queue_mapping(struct rtw_dev *rtwdev) - else - return -EINVAL; - break; -+ case RTW_HCI_TYPE_SDIO: -+ rqpn = &chip->rqpn_table[0]; -+ break; - default: - return -EINVAL; - } -@@ -1015,18 +1103,25 @@ static int txdma_queue_mapping(struct rtw_dev *rtwdev) - if (rtw_chip_wcpu_11ac(rtwdev)) - rtw_write32(rtwdev, REG_H2CQ_CSR, BIT_H2CQ_FULL); - -+ if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) { -+ rtw_read32(rtwdev, REG_SDIO_FREE_TXPG); -+ rtw_write32(rtwdev, REG_SDIO_TX_CTRL, 0); -+ } else if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_USB) { -+ rtw_write8_set(rtwdev, REG_TXDMA_PQ_MAP, BIT_RXDMA_ARBBW_EN); -+ } -+ - return 0; - } - - static int set_trx_fifo_info(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_fifo_conf *fifo = &rtwdev->fifo; -- struct rtw_chip_info *chip = rtwdev->chip; - u16 cur_pg_addr; - u8 csi_buf_pg_num = chip->csi_buf_pg_num; - - /* config rsvd page num */ -- fifo->rsvd_drv_pg_num = 8; -+ fifo->rsvd_drv_pg_num = chip->rsvd_drv_pg_num; - fifo->txff_pg_num = chip->txff_size >> 7; - if (rtw_chip_wcpu_11n(rtwdev)) - fifo->rsvd_pg_num = fifo->rsvd_drv_pg_num; -@@ -1075,8 +1170,8 @@ static int __priority_queue_cfg(struct rtw_dev *rtwdev, - const struct rtw_page_table *pg_tbl, - u16 pubq_num) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_fifo_conf *fifo = &rtwdev->fifo; -- struct rtw_chip_info *chip = rtwdev->chip; - - rtw_write16(rtwdev, REG_FIFOPAGE_INFO_1, pg_tbl->hq_num); - rtw_write16(rtwdev, REG_FIFOPAGE_INFO_2, pg_tbl->lq_num); -@@ -1106,8 +1201,8 @@ static int __priority_queue_cfg_legacy(struct rtw_dev *rtwdev, - const struct rtw_page_table *pg_tbl, - u16 pubq_num) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_fifo_conf *fifo = &rtwdev->fifo; -- struct rtw_chip_info *chip = rtwdev->chip; - u32 val32; - - val32 = BIT_RQPN_NE(pg_tbl->nq_num, pg_tbl->exq_num); -@@ -1132,8 +1227,8 @@ static int __priority_queue_cfg_legacy(struct rtw_dev *rtwdev, - - static int priority_queue_cfg(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_fifo_conf *fifo = &rtwdev->fifo; -- struct rtw_chip_info *chip = rtwdev->chip; - const struct rtw_page_table *pg_tbl = NULL; - u16 pubq_num; - int ret; -@@ -1156,6 +1251,9 @@ static int priority_queue_cfg(struct rtw_dev *rtwdev) - else - return -EINVAL; - break; -+ case RTW_HCI_TYPE_SDIO: -+ pg_tbl = &chip->page_table[0]; -+ break; - default: - return -EINVAL; - } -@@ -1260,7 +1358,7 @@ static int rtw_drv_info_cfg(struct rtw_dev *rtwdev) - - int rtw_mac_init(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - int ret; - - ret = rtw_init_trx_cfg(rtwdev); -diff --git a/drivers/net/wireless/realtek/rtw88/mac.h b/drivers/net/wireless/realtek/rtw88/mac.h -index ce64cdf7a..58c3dccc1 100644 ---- a/drivers/net/wireless/realtek/rtw88/mac.h -+++ b/drivers/net/wireless/realtek/rtw88/mac.h -@@ -7,7 +7,6 @@ - - #define RTW_HW_PORT_NUM 5 - #define cut_version_to_mask(cut) (0x1 << ((cut) + 1)) --#define SDIO_LOCAL_OFFSET 0x10250000 - #define DDMA_POLLING_COUNT 1000 - #define C2H_PKT_BUF 256 - #define REPORT_BUF 128 -@@ -15,7 +14,10 @@ - #define ILLEGAL_KEY_GROUP 0xFAAAAA00 - - /* HW memory address */ -+#define OCPBASE_RXBUF_FW_88XX 0x18680000 - #define OCPBASE_TXBUF_88XX 0x18780000 -+#define OCPBASE_ROM_88XX 0x00000000 -+#define OCPBASE_IMEM_88XX 0x00030000 - #define OCPBASE_DMEM_88XX 0x00200000 - #define OCPBASE_EMEM_88XX 0x00100000 - -@@ -33,6 +35,7 @@ void rtw_mac_power_off(struct rtw_dev *rtwdev); - int rtw_download_firmware(struct rtw_dev *rtwdev, struct rtw_fw_state *fw); - int rtw_mac_init(struct rtw_dev *rtwdev); - void rtw_mac_flush_queues(struct rtw_dev *rtwdev, u32 queues, bool drop); -+int rtw_ddma_to_fw_fifo(struct rtw_dev *rtwdev, u32 ocp_src, u32 size); - - static inline void rtw_mac_flush_all_queues(struct rtw_dev *rtwdev, bool drop) - { -diff --git a/drivers/net/wireless/realtek/rtw88/mac80211.c b/drivers/net/wireless/realtek/rtw88/mac80211.c -index 0a3766781..78bdbe2cf 100644 ---- a/drivers/net/wireless/realtek/rtw88/mac80211.c -+++ b/drivers/net/wireless/realtek/rtw88/mac80211.c -@@ -13,6 +13,9 @@ - #include "bf.h" - #include "debug.h" - #include "wow.h" -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) -+#include "sar.h" -+#endif - - static void rtw_ops_tx(struct ieee80211_hw *hw, - struct ieee80211_tx_control *control, -@@ -42,7 +45,11 @@ static void rtw_ops_wake_tx_queue(struct ieee80211_hw *hw, - list_add_tail(&rtwtxq->list, &rtwdev->txqs); - spin_unlock_bh(&rtwdev->txq_lock); - -- tasklet_schedule(&rtwdev->tx_tasklet); -+ /* ensure to dequeue EAPOL (4/4) at the right time */ -+ if (txq->ac == IEEE80211_AC_VO) -+ __rtw_tx_work(rtwdev); -+ else -+ queue_work(rtwdev->tx_wq, &rtwdev->tx_work); - } - - static int rtw_ops_start(struct ieee80211_hw *hw) -@@ -71,6 +78,9 @@ static int rtw_ops_config(struct ieee80211_hw *hw, u32 changed) - struct rtw_dev *rtwdev = hw->priv; - int ret = 0; - -+ /* let previous ips work finish to ensure we don't leave ips twice */ -+ cancel_work_sync(&rtwdev->ips_work); -+ - mutex_lock(&rtwdev->mutex); - - rtw_leave_lps_deep(rtwdev); -@@ -84,20 +94,12 @@ static int rtw_ops_config(struct ieee80211_hw *hw, u32 changed) - } - } - -- if (changed & IEEE80211_CONF_CHANGE_PS) { -- if (hw->conf.flags & IEEE80211_CONF_PS) { -- rtwdev->ps_enabled = true; -- } else { -- rtwdev->ps_enabled = false; -- rtw_leave_lps(rtwdev); -- } -- } -- - if (changed & IEEE80211_CONF_CHANGE_CHANNEL) - rtw_set_channel(rtwdev); - - if ((changed & IEEE80211_CONF_CHANGE_IDLE) && -- (hw->conf.flags & IEEE80211_CONF_IDLE)) -+ (hw->conf.flags & IEEE80211_CONF_IDLE) && -+ !test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) - rtw_enter_ips(rtwdev); - - out: -@@ -150,21 +152,32 @@ static int rtw_ops_add_interface(struct ieee80211_hw *hw, - struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; - enum rtw_net_type net_type; - u32 config = 0; -- u8 port = 0; -+ u8 port; - u8 bcn_ctrl = 0; - -- rtwvif->port = port; -+ if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_BCN_FILTER)) -+ vif->driver_flags |= IEEE80211_VIF_BEACON_FILTER | -+ IEEE80211_VIF_SUPPORTS_CQM_RSSI; - rtwvif->stats.tx_unicast = 0; - rtwvif->stats.rx_unicast = 0; - rtwvif->stats.tx_cnt = 0; - rtwvif->stats.rx_cnt = 0; -+ rtwvif->scan_req = NULL; - memset(&rtwvif->bfee, 0, sizeof(struct rtw_bfee)); -- rtwvif->conf = &rtw_vif_port[port]; - rtw_txq_init(rtwdev, vif->txq); - INIT_LIST_HEAD(&rtwvif->rsvd_page_list); - - mutex_lock(&rtwdev->mutex); - -+ port = find_first_zero_bit(rtwdev->hw_port, RTW_PORT_NUM); -+ if (port >= RTW_PORT_NUM) { -+ mutex_unlock(&rtwdev->mutex); -+ return -EINVAL; -+ } -+ set_bit(port, rtwdev->hw_port); -+ -+ rtwvif->port = port; -+ rtwvif->conf = &rtw_vif_port[port]; - rtw_leave_lps_deep(rtwdev); - - switch (vif->type) { -@@ -186,6 +199,7 @@ static int rtw_ops_add_interface(struct ieee80211_hw *hw, - break; - default: - WARN_ON(1); -+ clear_bit(rtwvif->port, rtwdev->hw_port); - mutex_unlock(&rtwdev->mutex); - return -EINVAL; - } -@@ -197,10 +211,12 @@ static int rtw_ops_add_interface(struct ieee80211_hw *hw, - rtwvif->bcn_ctrl = bcn_ctrl; - config |= PORT_SET_BCN_CTRL; - rtw_vif_port_config(rtwdev, rtwvif, config); -+ rtw_core_port_switch(rtwdev, vif); -+ rtw_recalc_lps(rtwdev, vif); - - mutex_unlock(&rtwdev->mutex); - -- rtw_info(rtwdev, "start vif %pM on port %d\n", vif->addr, rtwvif->port); -+ rtw_dbg(rtwdev, RTW_DBG_STATE, "start vif %pM on port %d\n", vif->addr, rtwvif->port); - return 0; - } - -@@ -211,7 +227,7 @@ static void rtw_ops_remove_interface(struct ieee80211_hw *hw, - struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; - u32 config = 0; - -- rtw_info(rtwdev, "stop vif %pM on port %d\n", vif->addr, rtwvif->port); -+ rtw_dbg(rtwdev, RTW_DBG_STATE, "stop vif %pM on port %d\n", vif->addr, rtwvif->port); - - mutex_lock(&rtwdev->mutex); - -@@ -227,6 +243,8 @@ static void rtw_ops_remove_interface(struct ieee80211_hw *hw, - rtwvif->bcn_ctrl = 0; - config |= PORT_SET_BCN_CTRL; - rtw_vif_port_config(rtwdev, rtwvif, config); -+ clear_bit(rtwvif->port, rtwdev->hw_port); -+ rtw_recalc_lps(rtwdev, NULL); - - mutex_unlock(&rtwdev->mutex); - } -@@ -237,8 +255,8 @@ static int rtw_ops_change_interface(struct ieee80211_hw *hw, - { - struct rtw_dev *rtwdev = hw->priv; - -- rtw_info(rtwdev, "change vif %pM (%d)->(%d), p2p (%d)->(%d)\n", -- vif->addr, vif->type, type, vif->p2p, p2p); -+ rtw_dbg(rtwdev, RTW_DBG_STATE, "change vif %pM (%d)->(%d), p2p (%d)->(%d)\n", -+ vif->addr, vif->type, type, vif->p2p, p2p); - - rtw_ops_remove_interface(hw, vif); - -@@ -347,10 +365,16 @@ static void rtw_conf_tx(struct rtw_dev *rtwdev, - static void rtw_ops_bss_info_changed(struct ieee80211_hw *hw, - struct ieee80211_vif *vif, - struct ieee80211_bss_conf *conf, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) -+ u64 changed) -+#else - u32 changed) -+#endif - { - struct rtw_dev *rtwdev = hw->priv; - struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; -+ struct rtw_coex *coex = &rtwdev->coex; -+ struct rtw_coex_stat *coex_stat = &coex->stat; - u32 config = 0; - - mutex_lock(&rtwdev->mutex); -@@ -359,17 +383,32 @@ static void rtw_ops_bss_info_changed(struct ieee80211_hw *hw, - - if (changed & BSS_CHANGED_ASSOC) { - rtw_vif_assoc_changed(rtwvif, conf); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) -+ if (vif->cfg.assoc) { -+#else - if (conf->assoc) { -+#endif - rtw_coex_connect_notify(rtwdev, COEX_ASSOCIATE_FINISH); - - rtw_fw_download_rsvd_page(rtwdev); - rtw_send_rsvd_page_h2c(rtwdev); -+ rtw_fw_default_port(rtwdev, rtwvif); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) -+ rtw_coex_media_status_notify(rtwdev, vif->cfg.assoc); -+#else - rtw_coex_media_status_notify(rtwdev, conf->assoc); -+#endif - if (rtw_bf_support) - rtw_bf_assoc(rtwdev, vif, conf); - } else { - rtw_leave_lps(rtwdev); - rtw_bf_disassoc(rtwdev, vif, conf); -+ /* Abort ongoing scan if cancel_scan isn't issued -+ * when disconnected by peer -+ */ -+ if (test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) -+ rtw_hw_scan_abort(rtwdev); -+ - } - - config |= PORT_SET_NET_TYPE; -@@ -379,10 +418,22 @@ static void rtw_ops_bss_info_changed(struct ieee80211_hw *hw, - if (changed & BSS_CHANGED_BSSID) { - ether_addr_copy(rtwvif->bssid, conf->bssid); - config |= PORT_SET_BSSID; -+ if (!rtw_core_check_sta_active(rtwdev)) -+ rtw_clear_op_chan(rtwdev); -+ else -+ rtw_store_op_chan(rtwdev, true); - } - -- if (changed & BSS_CHANGED_BEACON) -+ if (changed & BSS_CHANGED_BEACON_INT) { -+ if (ieee80211_vif_type_p2p(vif) == NL80211_IFTYPE_STATION) -+ coex_stat->wl_beacon_interval = conf->beacon_int; -+ } -+ -+ if (changed & BSS_CHANGED_BEACON) { -+ rtw_set_dtim_period(rtwdev, conf->dtim_period); - rtw_fw_download_rsvd_page(rtwdev); -+ rtw_send_rsvd_page_h2c(rtwdev); -+ } - - if (changed & BSS_CHANGED_BEACON_ENABLED) { - if (conf->enable_beacon) -@@ -392,6 +443,8 @@ static void rtw_ops_bss_info_changed(struct ieee80211_hw *hw, - rtw_write32_clr(rtwdev, REG_FWHW_TXQ_CTRL, - BIT_EN_BCNQ_DL); - } -+ if (changed & BSS_CHANGED_CQM) -+ rtw_fw_beacon_filter_config(rtwdev, true, vif); - - if (changed & BSS_CHANGED_MU_GROUPS) - rtw_chip_set_gid_table(rtwdev, vif, conf); -@@ -399,13 +452,61 @@ static void rtw_ops_bss_info_changed(struct ieee80211_hw *hw, - if (changed & BSS_CHANGED_ERP_SLOT) - rtw_conf_tx(rtwdev, rtwvif); - -+ if (changed & BSS_CHANGED_PS) -+ rtw_recalc_lps(rtwdev, NULL); -+ - rtw_vif_port_config(rtwdev, rtwvif, config); - - mutex_unlock(&rtwdev->mutex); - } - -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) -+static int rtw_ops_start_ap(struct ieee80211_hw *hw, -+ struct ieee80211_vif *vif, -+ struct ieee80211_bss_conf *link_conf) -+#else -+static int rtw_ops_start_ap(struct ieee80211_hw *hw, struct ieee80211_vif *vif) -+#endif -+{ -+ struct rtw_dev *rtwdev = hw->priv; -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ -+ mutex_lock(&rtwdev->mutex); -+ rtw_write32_set(rtwdev, REG_TCR, BIT_TCR_UPDATE_HGQMD); -+ rtwdev->ap_active = true; -+ rtw_store_op_chan(rtwdev, true); -+ chip->ops->phy_calibration(rtwdev); -+ mutex_unlock(&rtwdev->mutex); -+ -+ return 0; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) -+static void rtw_ops_stop_ap(struct ieee80211_hw *hw, -+ struct ieee80211_vif *vif, -+ struct ieee80211_bss_conf *link_conf) -+#else -+static void rtw_ops_stop_ap(struct ieee80211_hw *hw, -+ struct ieee80211_vif *vif) -+#endif -+{ -+ struct rtw_dev *rtwdev = hw->priv; -+ -+ mutex_lock(&rtwdev->mutex); -+ rtw_write32_clr(rtwdev, REG_TCR, BIT_TCR_UPDATE_HGQMD); -+ rtwdev->ap_active = false; -+ if (!rtw_core_check_sta_active(rtwdev)) -+ rtw_clear_op_chan(rtwdev); -+ mutex_unlock(&rtwdev->mutex); -+} -+ - static int rtw_ops_conf_tx(struct ieee80211_hw *hw, -- struct ieee80211_vif *vif, u16 ac, -+ struct ieee80211_vif *vif, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) -+ unsigned int link_id, u16 ac, -+#else -+ u16 ac, -+#endif - const struct ieee80211_tx_queue_params *params) - { - struct rtw_dev *rtwdev = hw->priv; -@@ -444,12 +545,23 @@ static int rtw_ops_sta_remove(struct ieee80211_hw *hw, - struct rtw_dev *rtwdev = hw->priv; - - mutex_lock(&rtwdev->mutex); -+ rtw_fw_beacon_filter_config(rtwdev, false, vif); - rtw_sta_remove(rtwdev, sta, true); - mutex_unlock(&rtwdev->mutex); - - return 0; - } - -+static int rtw_ops_set_tim(struct ieee80211_hw *hw, struct ieee80211_sta *sta, -+ bool set) -+{ -+ struct rtw_dev *rtwdev = hw->priv; -+ -+ ieee80211_queue_work(hw, &rtwdev->update_beacon_work); -+ -+ return 0; -+} -+ - static int rtw_ops_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, - struct ieee80211_vif *vif, struct ieee80211_sta *sta, - struct ieee80211_key_conf *key) -@@ -513,13 +625,14 @@ static int rtw_ops_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, - hw_key_type, hw_key_idx); - break; - case DISABLE_KEY: -+ rtw_hci_flush_all_queues(rtwdev, false); - rtw_mac_flush_all_queues(rtwdev, false); - rtw_sec_clear_cam(rtwdev, sec, key->hw_key_idx); - break; - } - - /* download new cam settings for PG to backup */ -- if (rtw_fw_lps_deep_mode == LPS_DEEP_MODE_PG) -+ if (rtw_get_lps_deep_mode(rtwdev) == LPS_DEEP_MODE_PG) - rtw_fw_download_rsvd_page(rtwdev); - - out: -@@ -528,18 +641,35 @@ static int rtw_ops_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, - return ret; - } - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 6, 0) - static int rtw_ops_ampdu_action(struct ieee80211_hw *hw, - struct ieee80211_vif *vif, - struct ieee80211_ampdu_params *params) -+#else -+static int rtw_ops_ampdu_action(struct ieee80211_hw *hw, -+ struct ieee80211_vif *vif, -+ enum ieee80211_ampdu_mlme_action action, -+ struct ieee80211_sta *sta, u16 tid, u16 *ssn, -+ u8 buf_size, bool amsdu) -+#endif - { -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 6, 0) - struct ieee80211_sta *sta = params->sta; - u16 tid = params->tid; - struct ieee80211_txq *txq = sta->txq[tid]; - struct rtw_txq *rtwtxq = (struct rtw_txq *)txq->drv_priv; - - switch (params->action) { -+#else -+ switch (action) { -+#endif - case IEEE80211_AMPDU_TX_START: -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 5, 0) - return IEEE80211_AMPDU_TX_START_IMMEDIATE; -+#else -+ ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid); -+ break; -+#endif - case IEEE80211_AMPDU_TX_STOP_CONT: - case IEEE80211_AMPDU_TX_STOP_FLUSH: - case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT: -@@ -560,6 +690,7 @@ static int rtw_ops_ampdu_action(struct ieee80211_hw *hw, - return 0; - } - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 20, 0) - static bool rtw_ops_can_aggregate_in_amsdu(struct ieee80211_hw *hw, - struct sk_buff *head, - struct sk_buff *skb) -@@ -573,6 +704,7 @@ static bool rtw_ops_can_aggregate_in_amsdu(struct ieee80211_hw *hw, - - return true; - } -+#endif - - static void rtw_ops_sw_scan_start(struct ieee80211_hw *hw, - struct ieee80211_vif *vif, -@@ -580,21 +712,9 @@ static void rtw_ops_sw_scan_start(struct ieee80211_hw *hw, - { - struct rtw_dev *rtwdev = hw->priv; - struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; -- u32 config = 0; - - mutex_lock(&rtwdev->mutex); -- -- rtw_leave_lps(rtwdev); -- -- ether_addr_copy(rtwvif->mac_addr, mac_addr); -- config |= PORT_SET_MAC_ADDR; -- rtw_vif_port_config(rtwdev, rtwvif, config); -- -- rtw_coex_scan_notify(rtwdev, COEX_SCAN_START); -- -- set_bit(RTW_FLAG_DIG_DISABLE, rtwdev->flags); -- set_bit(RTW_FLAG_SCANNING, rtwdev->flags); -- -+ rtw_core_scan_start(rtwdev, rtwvif, mac_addr, false); - mutex_unlock(&rtwdev->mutex); - } - -@@ -602,26 +722,24 @@ static void rtw_ops_sw_scan_complete(struct ieee80211_hw *hw, - struct ieee80211_vif *vif) - { - struct rtw_dev *rtwdev = hw->priv; -- struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; -- u32 config = 0; - - mutex_lock(&rtwdev->mutex); -- -- clear_bit(RTW_FLAG_SCANNING, rtwdev->flags); -- clear_bit(RTW_FLAG_DIG_DISABLE, rtwdev->flags); -- -- ether_addr_copy(rtwvif->mac_addr, vif->addr); -- config |= PORT_SET_MAC_ADDR; -- rtw_vif_port_config(rtwdev, rtwvif, config); -- -- rtw_coex_scan_notify(rtwdev, COEX_SCAN_FINISH); -- -+ rtw_core_scan_complete(rtwdev, vif, false); - mutex_unlock(&rtwdev->mutex); - } - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 18, 0) - static void rtw_ops_mgd_prepare_tx(struct ieee80211_hw *hw, - struct ieee80211_vif *vif, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5,14,0)) -+ struct ieee80211_prep_tx_info *info) -+ #else - u16 duration) -+ #endif -+#else -+static void rtw_ops_mgd_prepare_tx(struct ieee80211_hw *hw, -+ struct ieee80211_vif *vif) -+#endif - { - struct rtw_dev *rtwdev = hw->priv; - -@@ -663,6 +781,7 @@ static void rtw_ops_flush(struct ieee80211_hw *hw, - mutex_lock(&rtwdev->mutex); - rtw_leave_lps_deep(rtwdev); - -+ rtw_hci_flush_queues(rtwdev, queues, drop); - rtw_mac_flush_queues(rtwdev, queues, drop); - mutex_unlock(&rtwdev->mutex); - } -@@ -691,7 +810,7 @@ static void rtw_ra_mask_info_update_iter(void *data, struct ieee80211_sta *sta) - } - - si->use_cfg_mask = true; -- rtw_update_sta_info(br_data->rtwdev, si); -+ rtw_update_sta_info(br_data->rtwdev, si, true); - } - - static void rtw_ra_mask_info_update(struct rtw_dev *rtwdev, -@@ -703,7 +822,7 @@ static void rtw_ra_mask_info_update(struct rtw_dev *rtwdev, - br_data.rtwdev = rtwdev; - br_data.vif = vif; - br_data.mask = mask; -- rtw_iterate_stas_atomic(rtwdev, rtw_ra_mask_info_update_iter, &br_data); -+ rtw_iterate_stas(rtwdev, rtw_ra_mask_info_update_iter, &br_data); - } - - static int rtw_ops_set_bitrate_mask(struct ieee80211_hw *hw, -@@ -712,7 +831,9 @@ static int rtw_ops_set_bitrate_mask(struct ieee80211_hw *hw, - { - struct rtw_dev *rtwdev = hw->priv; - -+ mutex_lock(&rtwdev->mutex); - rtw_ra_mask_info_update(rtwdev, vif, mask); -+ mutex_unlock(&rtwdev->mutex); - - return 0; - } -@@ -722,7 +843,7 @@ static int rtw_ops_set_antenna(struct ieee80211_hw *hw, - u32 rx_antenna) - { - struct rtw_dev *rtwdev = hw->priv; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - int ret; - - if (!chip->ops->set_antenna) -@@ -797,6 +918,71 @@ static void rtw_reconfig_complete(struct ieee80211_hw *hw, - mutex_unlock(&rtwdev->mutex); - } - -+static int rtw_ops_hw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif, -+ struct ieee80211_scan_request *req) -+{ -+ struct rtw_dev *rtwdev = hw->priv; -+ int ret; -+ -+ if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD)) -+ return 1; -+ -+ if (test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) -+ return -EBUSY; -+ -+ mutex_lock(&rtwdev->mutex); -+ rtw_hw_scan_start(rtwdev, vif, req); -+ ret = rtw_hw_scan_offload(rtwdev, vif, true); -+ if (ret) { -+ rtw_hw_scan_abort(rtwdev); -+ rtw_err(rtwdev, "HW scan failed with status: %d\n", ret); -+ } -+ mutex_unlock(&rtwdev->mutex); -+ -+ return ret; -+} -+ -+static void rtw_ops_cancel_hw_scan(struct ieee80211_hw *hw, -+ struct ieee80211_vif *vif) -+{ -+ struct rtw_dev *rtwdev = hw->priv; -+ -+ if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD)) -+ return; -+ -+ if (!test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) -+ return; -+ -+ mutex_lock(&rtwdev->mutex); -+ rtw_hw_scan_abort(rtwdev); -+ mutex_unlock(&rtwdev->mutex); -+} -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) -+static int rtw_ops_set_sar_specs(struct ieee80211_hw *hw, -+ const struct cfg80211_sar_specs *sar) -+{ -+ struct rtw_dev *rtwdev = hw->priv; -+ -+ mutex_lock(&rtwdev->mutex); -+ rtw_set_sar_specs(rtwdev, sar); -+ mutex_unlock(&rtwdev->mutex); -+ -+ return 0; -+} -+#endif -+ -+static void rtw_ops_sta_rc_update(struct ieee80211_hw *hw, -+ struct ieee80211_vif *vif, -+ struct ieee80211_sta *sta, u32 changed) -+{ -+ struct rtw_dev *rtwdev = hw->priv; -+ struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; -+ -+ if (changed & IEEE80211_RC_BW_CHANGED) -+ ieee80211_queue_work(rtwdev->hw, &si->rc_work); -+} -+ - const struct ieee80211_ops rtw_ops = { - .tx = rtw_ops_tx, - .wake_tx_queue = rtw_ops_wake_tx_queue, -@@ -808,12 +994,17 @@ const struct ieee80211_ops rtw_ops = { - .change_interface = rtw_ops_change_interface, - .configure_filter = rtw_ops_configure_filter, - .bss_info_changed = rtw_ops_bss_info_changed, -+ .start_ap = rtw_ops_start_ap, -+ .stop_ap = rtw_ops_stop_ap, - .conf_tx = rtw_ops_conf_tx, - .sta_add = rtw_ops_sta_add, - .sta_remove = rtw_ops_sta_remove, -+ .set_tim = rtw_ops_set_tim, - .set_key = rtw_ops_set_key, - .ampdu_action = rtw_ops_ampdu_action, -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 20, 0) - .can_aggregate_in_amsdu = rtw_ops_can_aggregate_in_amsdu, -+#endif - .sw_scan_start = rtw_ops_sw_scan_start, - .sw_scan_complete = rtw_ops_sw_scan_complete, - .mgd_prepare_tx = rtw_ops_mgd_prepare_tx, -@@ -824,6 +1015,12 @@ const struct ieee80211_ops rtw_ops = { - .set_antenna = rtw_ops_set_antenna, - .get_antenna = rtw_ops_get_antenna, - .reconfig_complete = rtw_reconfig_complete, -+ .hw_scan = rtw_ops_hw_scan, -+ .cancel_hw_scan = rtw_ops_cancel_hw_scan, -+ .sta_rc_update = rtw_ops_sta_rc_update, -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) -+ .set_sar_specs = rtw_ops_set_sar_specs, -+#endif - #ifdef CONFIG_PM - .suspend = rtw_ops_suspend, - .resume = rtw_ops_resume, -diff --git a/drivers/net/wireless/realtek/rtw88/main.c b/drivers/net/wireless/realtek/rtw88/main.c -index 2ef141689..f58902994 100644 ---- a/drivers/net/wireless/realtek/rtw88/main.c -+++ b/drivers/net/wireless/realtek/rtw88/main.c -@@ -2,6 +2,8 @@ - /* Copyright(c) 2018-2019 Realtek Corporation - */ - -+#include -+ - #include "main.h" - #include "regd.h" - #include "fw.h" -@@ -15,18 +17,28 @@ - #include "tx.h" - #include "debug.h" - #include "bf.h" -+#include "sar.h" -+#include "sdio.h" - --unsigned int rtw_fw_lps_deep_mode; --EXPORT_SYMBOL(rtw_fw_lps_deep_mode); -+bool rtw_disable_lps_deep_mode; -+EXPORT_SYMBOL(rtw_disable_lps_deep_mode); - bool rtw_bf_support = true; - unsigned int rtw_debug_mask; - EXPORT_SYMBOL(rtw_debug_mask); -+/* EDCCA is enabled during normal behavior. For debugging purpose in -+ * a noisy environment, it can be disabled via edcca debugfs. Because -+ * all rtw88 devices will probably be affected if environment is noisy, -+ * rtw_edcca_enabled is just declared by driver instead of by device. -+ * So, turning it off will take effect for all rtw88 devices before -+ * there is a tough reason to maintain rtw_edcca_enabled by device. -+ */ -+bool rtw_edcca_enabled = true; - --module_param_named(lps_deep_mode, rtw_fw_lps_deep_mode, uint, 0644); -+module_param_named(disable_lps_deep, rtw_disable_lps_deep_mode, bool, 0644); - module_param_named(support_bf, rtw_bf_support, bool, 0644); - module_param_named(debug_mask, rtw_debug_mask, uint, 0644); - --MODULE_PARM_DESC(lps_deep_mode, "Deeper PS mode. If 0, deep PS is disabled"); -+MODULE_PARM_DESC(disable_lps_deep, "Set Y to disable Deep PS"); - MODULE_PARM_DESC(support_bf, "Set Y to enable beamformee support"); - MODULE_PARM_DESC(debug_mask, "Debugging mask"); - -@@ -67,6 +79,7 @@ static struct ieee80211_channel rtw_channeltable_5g[] = { - {.center_freq = 5660, .hw_value = 132,}, - {.center_freq = 5680, .hw_value = 136,}, - {.center_freq = 5700, .hw_value = 140,}, -+ {.center_freq = 5720, .hw_value = 144,}, - {.center_freq = 5745, .hw_value = 149,}, - {.center_freq = 5765, .hw_value = 153,}, - {.center_freq = 5785, .hw_value = 157,}, -@@ -90,6 +103,26 @@ static struct ieee80211_rate rtw_ratetable[] = { - {.bitrate = 540, .hw_value = 0x0b,}, - }; - -+static const struct ieee80211_iface_limit rtw_iface_limits[] = { -+ { -+ .max = 1, -+ .types = BIT(NL80211_IFTYPE_STATION), -+ }, -+ { -+ .max = 1, -+ .types = BIT(NL80211_IFTYPE_AP), -+ } -+}; -+ -+static const struct ieee80211_iface_combination rtw_iface_combs[] = { -+ { -+ .limits = rtw_iface_limits, -+ .n_limits = ARRAY_SIZE(rtw_iface_limits), -+ .max_interfaces = 2, -+ .num_different_channels = 1, -+ } -+}; -+ - u16 rtw_desc_to_bitrate(u8 desc_rate) - { - struct ieee80211_rate rate; -@@ -152,14 +185,17 @@ static void rtw_dynamic_csi_rate(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif) - bf_info->cur_csi_rpt_rate = new_csi_rate_idx; - } - --static void rtw_vif_watch_dog_iter(void *data, u8 *mac, -- struct ieee80211_vif *vif) -+static void rtw_vif_watch_dog_iter(void *data, struct ieee80211_vif *vif) - { - struct rtw_watch_dog_iter_data *iter_data = data; - struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; - - if (vif->type == NL80211_IFTYPE_STATION) -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) -+ if (vif->cfg.assoc) -+#else - if (vif->bss_conf.assoc) -+#endif - iter_data->rtwvif = rtwvif; - - rtw_dynamic_csi_rate(iter_data->rtwdev, rtwvif); -@@ -195,8 +231,11 @@ static void rtw_watch_dog_work(struct work_struct *work) - else - clear_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags); - -+ rtw_coex_wl_status_check(rtwdev); -+ rtw_coex_query_bt_hid_list(rtwdev); -+ - if (busy_traffic != test_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags)) -- rtw_coex_wl_status_change_notify(rtwdev); -+ rtw_coex_wl_status_change_notify(rtwdev, 0); - - if (stats->tx_cnt > RTW_LPS_THRESHOLD || - stats->rx_cnt > RTW_LPS_THRESHOLD) -@@ -226,19 +265,22 @@ static void rtw_watch_dog_work(struct work_struct *work) - rtw_phy_dynamic_mechanism(rtwdev); - - data.rtwdev = rtwdev; -- /* use atomic version to avoid taking local->iflist_mtx mutex */ -- rtw_iterate_vifs_atomic(rtwdev, rtw_vif_watch_dog_iter, &data); -+ /* rtw_iterate_vifs internally uses an atomic iterator which is needed -+ * to avoid taking local->iflist_mtx mutex -+ */ -+ rtw_iterate_vifs(rtwdev, rtw_vif_watch_dog_iter, &data); - - /* fw supports only one station associated to enter lps, if there are - * more than two stations associated to the AP, then we can not enter - * lps, because fw does not handle the overlapped beacon interval - * -- * mac80211 should iterate vifs and determine if driver can enter -- * ps by passing IEEE80211_CONF_PS to us, all we need to do is to -+ * rtw_recalc_lps() iterate vifs and determine if driver can enter -+ * ps by vif->type and vif->cfg.ps, all we need to do here is to - * get that vif and check if device is having traffic more than the - * threshold. - */ -- if (rtwdev->ps_enabled && data.rtwvif && !ps_active) -+ if (rtwdev->ps_enabled && data.rtwvif && !ps_active && -+ !rtwdev->beacon_loss && !rtwdev->ap_active) - rtw_enter_lps(rtwdev, data.rtwvif->port); - - rtwdev->watch_dog_cnt++; -@@ -259,6 +301,16 @@ static void rtw_c2h_work(struct work_struct *work) - } - } - -+static void rtw_ips_work(struct work_struct *work) -+{ -+ struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, ips_work); -+ -+ mutex_lock(&rtwdev->mutex); -+ if (rtwdev->hw->conf.flags & IEEE80211_CONF_IDLE) -+ rtw_enter_ips(rtwdev); -+ mutex_unlock(&rtwdev->mutex); -+} -+ - static u8 rtw_acquire_macid(struct rtw_dev *rtwdev) - { - unsigned long mac_id; -@@ -270,29 +322,50 @@ static u8 rtw_acquire_macid(struct rtw_dev *rtwdev) - return mac_id; - } - -+static void rtw_sta_rc_work(struct work_struct *work) -+{ -+ struct rtw_sta_info *si = container_of(work, struct rtw_sta_info, -+ rc_work); -+ struct rtw_dev *rtwdev = si->rtwdev; -+ -+ mutex_lock(&rtwdev->mutex); -+ rtw_update_sta_info(rtwdev, si, true); -+ mutex_unlock(&rtwdev->mutex); -+} -+ - int rtw_sta_add(struct rtw_dev *rtwdev, struct ieee80211_sta *sta, - struct ieee80211_vif *vif) - { - struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; -+ struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; - int i; - - si->mac_id = rtw_acquire_macid(rtwdev); - if (si->mac_id >= RTW_MAX_MAC_ID_NUM) - return -ENOSPC; - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) -+ if (vif->type == NL80211_IFTYPE_STATION && vif->cfg.assoc == 0) -+#else -+ if (vif->type == NL80211_IFTYPE_STATION && vif->bss_conf.assoc == 0) -+#endif -+ rtwvif->mac_id = si->mac_id; -+ si->rtwdev = rtwdev; - si->sta = sta; - si->vif = vif; - si->init_ra_lv = 1; - ewma_rssi_init(&si->avg_rssi); - for (i = 0; i < ARRAY_SIZE(sta->txq); i++) - rtw_txq_init(rtwdev, sta->txq[i]); -+ INIT_WORK(&si->rc_work, rtw_sta_rc_work); - -- rtw_update_sta_info(rtwdev, si); -+ rtw_update_sta_info(rtwdev, si, true); - rtw_fw_media_status_report(rtwdev, si->mac_id, true); - - rtwdev->sta_cnt++; -- rtw_info(rtwdev, "sta %pM joined with macid %d\n", -- sta->addr, si->mac_id); -+ rtwdev->beacon_loss = false; -+ rtw_dbg(rtwdev, RTW_DBG_STATE, "sta %pM joined with macid %d\n", -+ sta->addr, si->mac_id); - - return 0; - } -@@ -303,6 +376,8 @@ void rtw_sta_remove(struct rtw_dev *rtwdev, struct ieee80211_sta *sta, - struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; - int i; - -+ cancel_work_sync(&si->rc_work); -+ - rtw_release_macid(rtwdev, si->mac_id); - if (fw_exist) - rtw_fw_media_status_report(rtwdev, si->mac_id, false); -@@ -313,65 +388,203 @@ void rtw_sta_remove(struct rtw_dev *rtwdev, struct ieee80211_sta *sta, - kfree(si->mask); - - rtwdev->sta_cnt--; -- rtw_info(rtwdev, "sta %pM with macid %d left\n", -- sta->addr, si->mac_id); -+ rtw_dbg(rtwdev, RTW_DBG_STATE, "sta %pM with macid %d left\n", -+ sta->addr, si->mac_id); -+} -+ -+struct rtw_fwcd_hdr { -+ u32 item; -+ u32 size; -+ u32 padding1; -+ u32 padding2; -+} __packed; -+ -+static int rtw_fwcd_prep(struct rtw_dev *rtwdev) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_fwcd_desc *desc = &rtwdev->fw.fwcd_desc; -+ const struct rtw_fwcd_segs *segs = chip->fwcd_segs; -+ u32 prep_size = chip->fw_rxff_size + sizeof(struct rtw_fwcd_hdr); -+ u8 i; -+ -+ if (segs) { -+ prep_size += segs->num * sizeof(struct rtw_fwcd_hdr); -+ -+ for (i = 0; i < segs->num; i++) -+ prep_size += segs->segs[i]; -+ } -+ -+ desc->data = vmalloc(prep_size); -+ if (!desc->data) -+ return -ENOMEM; -+ -+ desc->size = prep_size; -+ desc->next = desc->data; -+ -+ return 0; -+} -+ -+static u8 *rtw_fwcd_next(struct rtw_dev *rtwdev, u32 item, u32 size) -+{ -+ struct rtw_fwcd_desc *desc = &rtwdev->fw.fwcd_desc; -+ struct rtw_fwcd_hdr *hdr; -+ u8 *next; -+ -+ if (!desc->data) { -+ rtw_dbg(rtwdev, RTW_DBG_FW, "fwcd isn't prepared successfully\n"); -+ return NULL; -+ } -+ -+ next = desc->next + sizeof(struct rtw_fwcd_hdr); -+ if (next - desc->data + size > desc->size) { -+ rtw_dbg(rtwdev, RTW_DBG_FW, "fwcd isn't prepared enough\n"); -+ return NULL; -+ } -+ -+ hdr = (struct rtw_fwcd_hdr *)(desc->next); -+ hdr->item = item; -+ hdr->size = size; -+ hdr->padding1 = 0x01234567; -+ hdr->padding2 = 0x89abcdef; -+ desc->next = next + size; -+ -+ return next; -+} -+ -+static void rtw_fwcd_dump(struct rtw_dev *rtwdev) -+{ -+ struct rtw_fwcd_desc *desc = &rtwdev->fw.fwcd_desc; -+ -+ rtw_dbg(rtwdev, RTW_DBG_FW, "dump fwcd\n"); -+ -+ /* Data will be freed after lifetime of device coredump. After calling -+ * dev_coredump, data is supposed to be handled by the device coredump -+ * framework. Note that a new dump will be discarded if a previous one -+ * hasn't been released yet. -+ */ -+ dev_coredumpv(rtwdev->dev, desc->data, desc->size, GFP_KERNEL); - } - --static bool rtw_fw_dump_crash_log(struct rtw_dev *rtwdev) -+static void rtw_fwcd_free(struct rtw_dev *rtwdev, bool free_self) -+{ -+ struct rtw_fwcd_desc *desc = &rtwdev->fw.fwcd_desc; -+ -+ if (free_self) { -+ rtw_dbg(rtwdev, RTW_DBG_FW, "free fwcd by self\n"); -+ vfree(desc->data); -+ } -+ -+ desc->data = NULL; -+ desc->next = NULL; -+} -+ -+static int rtw_fw_dump_crash_log(struct rtw_dev *rtwdev) - { - u32 size = rtwdev->chip->fw_rxff_size; - u32 *buf; - u8 seq; -- bool ret = true; - -- buf = vmalloc(size); -+ buf = (u32 *)rtw_fwcd_next(rtwdev, RTW_FWCD_TLV, size); - if (!buf) -- goto exit; -+ return -ENOMEM; - - if (rtw_fw_dump_fifo(rtwdev, RTW_FW_FIFO_SEL_RXBUF_FW, 0, size, buf)) { - rtw_dbg(rtwdev, RTW_DBG_FW, "dump fw fifo fail\n"); -- goto free_buf; -+ return -EINVAL; - } - - if (GET_FW_DUMP_LEN(buf) == 0) { - rtw_dbg(rtwdev, RTW_DBG_FW, "fw crash dump's length is 0\n"); -- goto free_buf; -+ return -EINVAL; - } - - seq = GET_FW_DUMP_SEQ(buf); -- if (seq > 0 && seq != (rtwdev->fw.prev_dump_seq + 1)) { -+ if (seq > 0) { - rtw_dbg(rtwdev, RTW_DBG_FW, - "fw crash dump's seq is wrong: %d\n", seq); -- goto free_buf; -+ return -EINVAL; - } -- if (seq == 0 && -- (GET_FW_DUMP_TLV_TYPE(buf) != FW_CD_TYPE || -- GET_FW_DUMP_TLV_LEN(buf) != FW_CD_LEN || -- GET_FW_DUMP_TLV_VAL(buf) != FW_CD_VAL)) { -- rtw_dbg(rtwdev, RTW_DBG_FW, "fw crash dump's tlv is wrong\n"); -- goto free_buf; -+ -+ return 0; -+} -+ -+int rtw_dump_fw(struct rtw_dev *rtwdev, const u32 ocp_src, u32 size, -+ u32 fwcd_item) -+{ -+ u32 rxff = rtwdev->chip->fw_rxff_size; -+ u32 dump_size, done_size = 0; -+ u8 *buf; -+ int ret; -+ -+ buf = rtw_fwcd_next(rtwdev, fwcd_item, size); -+ if (!buf) -+ return -ENOMEM; -+ -+ while (size) { -+ dump_size = size > rxff ? rxff : size; -+ -+ ret = rtw_ddma_to_fw_fifo(rtwdev, ocp_src + done_size, -+ dump_size); -+ if (ret) { -+ rtw_err(rtwdev, -+ "ddma fw 0x%x [+0x%x] to fw fifo fail\n", -+ ocp_src, done_size); -+ return ret; -+ } -+ -+ ret = rtw_fw_dump_fifo(rtwdev, RTW_FW_FIFO_SEL_RXBUF_FW, 0, -+ dump_size, (u32 *)(buf + done_size)); -+ if (ret) { -+ rtw_err(rtwdev, -+ "dump fw 0x%x [+0x%x] from fw fifo fail\n", -+ ocp_src, done_size); -+ return ret; -+ } -+ -+ size -= dump_size; -+ done_size += dump_size; - } - -- print_hex_dump_bytes("rtw88 fw dump: ", DUMP_PREFIX_OFFSET, buf, size); -+ return 0; -+} -+EXPORT_SYMBOL(rtw_dump_fw); -+ -+int rtw_dump_reg(struct rtw_dev *rtwdev, const u32 addr, const u32 size) -+{ -+ u8 *buf; -+ u32 i; - -- if (GET_FW_DUMP_MORE(buf) == 1) { -- rtwdev->fw.prev_dump_seq = seq; -- ret = false; -+ if (addr & 0x3) { -+ WARN(1, "should be 4-byte aligned, addr = 0x%08x\n", addr); -+ return -EINVAL; - } - --free_buf: -- vfree(buf); --exit: -- rtw_write8(rtwdev, REG_MCU_TST_CFG, 0); -+ buf = rtw_fwcd_next(rtwdev, RTW_FWCD_REG, size); -+ if (!buf) -+ return -ENOMEM; - -- return ret; -+ for (i = 0; i < size; i += 4) -+ *(u32 *)(buf + i) = rtw_read32(rtwdev, addr + i); -+ -+ return 0; - } -+EXPORT_SYMBOL(rtw_dump_reg); - - void rtw_vif_assoc_changed(struct rtw_vif *rtwvif, - struct ieee80211_bss_conf *conf) - { -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) -+ struct ieee80211_vif *vif = NULL; -+ -+ if (conf) -+ vif = container_of(conf, struct ieee80211_vif, bss_conf); -+ -+ if (conf && vif->cfg.assoc) { -+ rtwvif->aid = vif->cfg.aid; -+#else - if (conf && conf->assoc) { - rtwvif->aid = conf->aid; -+#endif - rtwvif->net_type = RTW_NET_MGD_LINKED; - } else { - rtwvif->aid = 0; -@@ -418,34 +631,46 @@ void rtw_fw_recovery(struct rtw_dev *rtwdev) - ieee80211_queue_work(rtwdev->hw, &rtwdev->fw_recovery_work); - } - --static void rtw_fw_recovery_work(struct work_struct *work) -+static void __fw_recovery_work(struct rtw_dev *rtwdev) - { -- struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, -- fw_recovery_work); -+ int ret = 0; - -- /* rtw_fw_dump_crash_log() returns false indicates that there are -- * still more log to dump. Driver set 0x1cf[7:0] = 0x1 to tell firmware -- * to dump the remaining part of the log, and firmware will trigger an -- * IMR_C2HCMD interrupt to inform driver the log is ready. -- */ -- if (!rtw_fw_dump_crash_log(rtwdev)) { -- rtw_write8(rtwdev, REG_HRCV_MSG, 1); -- return; -- } -- rtwdev->fw.prev_dump_seq = 0; -+ set_bit(RTW_FLAG_RESTARTING, rtwdev->flags); -+ clear_bit(RTW_FLAG_RESTART_TRIGGERING, rtwdev->flags); - -- WARN(1, "firmware crash, start reset and recover\n"); -+ ret = rtw_fwcd_prep(rtwdev); -+ if (ret) -+ goto free; -+ ret = rtw_fw_dump_crash_log(rtwdev); -+ if (ret) -+ goto free; -+ ret = rtw_chip_dump_fw_crash(rtwdev); -+ if (ret) -+ goto free; - -- mutex_lock(&rtwdev->mutex); -+ rtw_fwcd_dump(rtwdev); -+free: -+ rtw_fwcd_free(rtwdev, !!ret); -+ rtw_write8(rtwdev, REG_MCU_TST_CFG, 0); -+ -+ WARN(1, "firmware crash, start reset and recover\n"); - -- set_bit(RTW_FLAG_RESTARTING, rtwdev->flags); - rcu_read_lock(); - rtw_iterate_keys_rcu(rtwdev, NULL, rtw_reset_key_iter, rtwdev); - rcu_read_unlock(); - rtw_iterate_stas_atomic(rtwdev, rtw_reset_sta_iter, rtwdev); - rtw_iterate_vifs_atomic(rtwdev, rtw_reset_vif_iter, rtwdev); -+ bitmap_zero(rtwdev->hw_port, RTW_PORT_NUM); - rtw_enter_ips(rtwdev); -+} -+ -+static void rtw_fw_recovery_work(struct work_struct *work) -+{ -+ struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, -+ fw_recovery_work); - -+ mutex_lock(&rtwdev->mutex); -+ __fw_recovery_work(rtwdev); - mutex_unlock(&rtwdev->mutex); - - ieee80211_restart_hw(rtwdev->hw); -@@ -485,67 +710,145 @@ static void rtw_txq_ba_work(struct work_struct *work) - rtw_iterate_stas_atomic(rtwdev, rtw_txq_ba_iter, &data); - } - -+void rtw_set_rx_freq_band(struct rtw_rx_pkt_stat *pkt_stat, u8 channel) -+{ -+ if (IS_CH_2G_BAND(channel)) -+ pkt_stat->band = NL80211_BAND_2GHZ; -+ else if (IS_CH_5G_BAND(channel)) -+ pkt_stat->band = NL80211_BAND_5GHZ; -+ else -+ return; -+ -+ pkt_stat->freq = ieee80211_channel_to_frequency(channel, pkt_stat->band); -+} -+EXPORT_SYMBOL(rtw_set_rx_freq_band); -+ -+void rtw_set_dtim_period(struct rtw_dev *rtwdev, int dtim_period) -+{ -+ rtw_write32_set(rtwdev, REG_TCR, BIT_TCR_UPDATE_TIMIE); -+ rtw_write8(rtwdev, REG_DTIM_COUNTER_ROOT, dtim_period - 1); -+} -+ -+void rtw_update_channel(struct rtw_dev *rtwdev, u8 center_channel, -+ u8 primary_channel, enum rtw_supported_band band, -+ enum rtw_bandwidth bandwidth) -+{ -+ enum nl80211_band nl_band = rtw_hw_to_nl80211_band(band); -+ struct rtw_hal *hal = &rtwdev->hal; -+ u8 *cch_by_bw = hal->cch_by_bw; -+ u32 center_freq, primary_freq; -+ enum rtw_sar_bands sar_band; -+ u8 primary_channel_idx; -+ -+ center_freq = ieee80211_channel_to_frequency(center_channel, nl_band); -+ primary_freq = ieee80211_channel_to_frequency(primary_channel, nl_band); -+ -+ /* assign the center channel used while 20M bw is selected */ -+ cch_by_bw[RTW_CHANNEL_WIDTH_20] = primary_channel; -+ -+ /* assign the center channel used while current bw is selected */ -+ cch_by_bw[bandwidth] = center_channel; -+ -+ switch (bandwidth) { -+ case RTW_CHANNEL_WIDTH_20: -+ default: -+ primary_channel_idx = RTW_SC_DONT_CARE; -+ break; -+ case RTW_CHANNEL_WIDTH_40: -+ if (primary_freq > center_freq) -+ primary_channel_idx = RTW_SC_20_UPPER; -+ else -+ primary_channel_idx = RTW_SC_20_LOWER; -+ break; -+ case RTW_CHANNEL_WIDTH_80: -+ if (primary_freq > center_freq) { -+ if (primary_freq - center_freq == 10) -+ primary_channel_idx = RTW_SC_20_UPPER; -+ else -+ primary_channel_idx = RTW_SC_20_UPMOST; -+ -+ /* assign the center channel used -+ * while 40M bw is selected -+ */ -+ cch_by_bw[RTW_CHANNEL_WIDTH_40] = center_channel + 4; -+ } else { -+ if (center_freq - primary_freq == 10) -+ primary_channel_idx = RTW_SC_20_LOWER; -+ else -+ primary_channel_idx = RTW_SC_20_LOWEST; -+ -+ /* assign the center channel used -+ * while 40M bw is selected -+ */ -+ cch_by_bw[RTW_CHANNEL_WIDTH_40] = center_channel - 4; -+ } -+ break; -+ } -+ -+ switch (center_channel) { -+ case 1 ... 14: -+ sar_band = RTW_SAR_BAND_0; -+ break; -+ case 36 ... 64: -+ sar_band = RTW_SAR_BAND_1; -+ break; -+ case 100 ... 144: -+ sar_band = RTW_SAR_BAND_3; -+ break; -+ case 149 ... 177: -+ sar_band = RTW_SAR_BAND_4; -+ break; -+ default: -+ WARN(1, "unknown ch(%u) to SAR band\n", center_channel); -+ sar_band = RTW_SAR_BAND_0; -+ break; -+ } -+ -+ hal->current_primary_channel_index = primary_channel_idx; -+ hal->current_band_width = bandwidth; -+ hal->primary_channel = primary_channel; -+ hal->current_channel = center_channel; -+ hal->current_band_type = band; -+ hal->sar_band = sar_band; -+} -+ - void rtw_get_channel_params(struct cfg80211_chan_def *chandef, - struct rtw_channel_params *chan_params) - { - struct ieee80211_channel *channel = chandef->chan; - enum nl80211_chan_width width = chandef->width; -- u8 *cch_by_bw = chan_params->cch_by_bw; - u32 primary_freq, center_freq; - u8 center_chan; - u8 bandwidth = RTW_CHANNEL_WIDTH_20; -- u8 primary_chan_idx = 0; -- u8 i; - - center_chan = channel->hw_value; - primary_freq = channel->center_freq; - center_freq = chandef->center_freq1; - -- /* assign the center channel used while 20M bw is selected */ -- cch_by_bw[RTW_CHANNEL_WIDTH_20] = channel->hw_value; -- - switch (width) { - case NL80211_CHAN_WIDTH_20_NOHT: - case NL80211_CHAN_WIDTH_20: - bandwidth = RTW_CHANNEL_WIDTH_20; -- primary_chan_idx = RTW_SC_DONT_CARE; - break; - case NL80211_CHAN_WIDTH_40: - bandwidth = RTW_CHANNEL_WIDTH_40; -- if (primary_freq > center_freq) { -- primary_chan_idx = RTW_SC_20_UPPER; -+ if (primary_freq > center_freq) - center_chan -= 2; -- } else { -- primary_chan_idx = RTW_SC_20_LOWER; -+ else - center_chan += 2; -- } - break; - case NL80211_CHAN_WIDTH_80: - bandwidth = RTW_CHANNEL_WIDTH_80; - if (primary_freq > center_freq) { -- if (primary_freq - center_freq == 10) { -- primary_chan_idx = RTW_SC_20_UPPER; -+ if (primary_freq - center_freq == 10) - center_chan -= 2; -- } else { -- primary_chan_idx = RTW_SC_20_UPMOST; -+ else - center_chan -= 6; -- } -- /* assign the center channel used -- * while 40M bw is selected -- */ -- cch_by_bw[RTW_CHANNEL_WIDTH_40] = center_chan + 4; - } else { -- if (center_freq - primary_freq == 10) { -- primary_chan_idx = RTW_SC_20_LOWER; -+ if (center_freq - primary_freq == 10) - center_chan += 2; -- } else { -- primary_chan_idx = RTW_SC_20_LOWEST; -+ else - center_chan += 6; -- } -- /* assign the center channel used -- * while 40M bw is selected -- */ -- cch_by_bw[RTW_CHANNEL_WIDTH_40] = center_chan - 4; - } - break; - default: -@@ -555,40 +858,33 @@ void rtw_get_channel_params(struct cfg80211_chan_def *chandef, - - chan_params->center_chan = center_chan; - chan_params->bandwidth = bandwidth; -- chan_params->primary_chan_idx = primary_chan_idx; -- -- /* assign the center channel used while current bw is selected */ -- cch_by_bw[bandwidth] = center_chan; -- -- for (i = bandwidth + 1; i <= RTW_MAX_CHANNEL_WIDTH; i++) -- cch_by_bw[i] = 0; -+ chan_params->primary_chan = channel->hw_value; - } - - void rtw_set_channel(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct ieee80211_hw *hw = rtwdev->hw; - struct rtw_hal *hal = &rtwdev->hal; -- struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_channel_params ch_param; -- u8 center_chan, bandwidth, primary_chan_idx; -- u8 i; -+ u8 center_chan, primary_chan, bandwidth, band; - - rtw_get_channel_params(&hw->conf.chandef, &ch_param); - if (WARN(ch_param.center_chan == 0, "Invalid channel\n")) - return; - - center_chan = ch_param.center_chan; -+ primary_chan = ch_param.primary_chan; - bandwidth = ch_param.bandwidth; -- primary_chan_idx = ch_param.primary_chan_idx; -+ band = ch_param.center_chan > 14 ? RTW_BAND_5G : RTW_BAND_2G; - -- hal->current_band_width = bandwidth; -- hal->current_channel = center_chan; -- hal->current_band_type = center_chan > 14 ? RTW_BAND_5G : RTW_BAND_2G; -+ rtw_update_channel(rtwdev, center_chan, primary_chan, band, bandwidth); - -- for (i = RTW_CHANNEL_WIDTH_20; i <= RTW_MAX_CHANNEL_WIDTH; i++) -- hal->cch_by_bw[i] = ch_param.cch_by_bw[i]; -+ if (rtwdev->scan_info.op_chan) -+ rtw_store_op_chan(rtwdev, true); - -- chip->ops->set_channel(rtwdev, center_chan, bandwidth, primary_chan_idx); -+ chip->ops->set_channel(rtwdev, center_chan, bandwidth, -+ hal->current_primary_channel_index); - - if (hal->current_band_type == RTW_BAND_5G) { - rtw_coex_switchband_notify(rtwdev, COEX_SWITCH_TO_5G); -@@ -611,7 +907,7 @@ void rtw_set_channel(struct rtw_dev *rtwdev) - - void rtw_chip_prepare_tx(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - if (rtwdev->need_rfk) { - rtwdev->need_rfk = false; -@@ -680,8 +976,8 @@ static u8 hw_bw_cap_to_bitamp(u8 bw_cap) - - static void rtw_hw_config_rf_ant_num(struct rtw_dev *rtwdev, u8 hw_ant_num) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_hal *hal = &rtwdev->hal; -- struct rtw_chip_info *chip = rtwdev->chip; - - if (hw_ant_num == EFUSE_HW_CAP_IGNORE || - hw_ant_num >= hal->rf_path_num) -@@ -705,7 +1001,11 @@ static void rtw_hw_config_rf_ant_num(struct rtw_dev *rtwdev, u8 hw_ant_num) - static u64 get_vht_ra_mask(struct ieee80211_sta *sta) - { - u64 ra_mask = 0; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ u16 mcs_map = le16_to_cpu(sta->deflink.vht_cap.vht_mcs.rx_mcs_map); -+#else - u16 mcs_map = le16_to_cpu(sta->vht_cap.vht_mcs.rx_mcs_map); -+#endif - u8 vht_mcs_cap; - int i, nss; - -@@ -825,37 +1125,52 @@ static u8 get_rate_id(u8 wireless_set, enum rtw_bandwidth bw_mode, u8 tx_num) - #define RA_MASK_VHT_RATES (RA_MASK_VHT_RATES_1SS | \ - RA_MASK_VHT_RATES_2SS | \ - RA_MASK_VHT_RATES_3SS) -+#define RA_MASK_CCK_IN_BG 0x00005 - #define RA_MASK_CCK_IN_HT 0x00005 - #define RA_MASK_CCK_IN_VHT 0x00005 - #define RA_MASK_OFDM_IN_VHT 0x00010 - #define RA_MASK_OFDM_IN_HT_2G 0x00010 - #define RA_MASK_OFDM_IN_HT_5G 0x00030 - --static u64 rtw_update_rate_mask(struct rtw_dev *rtwdev, -- struct rtw_sta_info *si, -- u64 ra_mask, bool is_vht_enable, -- u8 wireless_set) -+static u64 rtw_rate_mask_rssi(struct rtw_sta_info *si, u8 wireless_set) -+{ -+ u8 rssi_level = si->rssi_level; -+ -+ if (wireless_set == WIRELESS_CCK) -+ return 0xffffffffffffffffULL; -+ -+ if (rssi_level == 0) -+ return 0xffffffffffffffffULL; -+ else if (rssi_level == 1) -+ return 0xfffffffffffffff0ULL; -+ else if (rssi_level == 2) -+ return 0xffffffffffffefe0ULL; -+ else if (rssi_level == 3) -+ return 0xffffffffffffcfc0ULL; -+ else if (rssi_level == 4) -+ return 0xffffffffffff8f80ULL; -+ else -+ return 0xffffffffffff0f00ULL; -+} -+ -+static u64 rtw_rate_mask_recover(u64 ra_mask, u64 ra_mask_bak) -+{ -+ if ((ra_mask & ~(RA_MASK_CCK_RATES | RA_MASK_OFDM_RATES)) == 0) -+ ra_mask |= (ra_mask_bak & ~(RA_MASK_CCK_RATES | RA_MASK_OFDM_RATES)); -+ -+ if (ra_mask == 0) -+ ra_mask |= (ra_mask_bak & (RA_MASK_CCK_RATES | RA_MASK_OFDM_RATES)); -+ -+ return ra_mask; -+} -+ -+static u64 rtw_rate_mask_cfg(struct rtw_dev *rtwdev, struct rtw_sta_info *si, -+ u64 ra_mask, bool is_vht_enable) - { - struct rtw_hal *hal = &rtwdev->hal; - const struct cfg80211_bitrate_mask *mask = si->mask; - u64 cfg_mask = GENMASK_ULL(63, 0); -- u8 rssi_level, band; -- -- if (wireless_set != WIRELESS_CCK) { -- rssi_level = si->rssi_level; -- if (rssi_level == 0) -- ra_mask &= 0xffffffffffffffffULL; -- else if (rssi_level == 1) -- ra_mask &= 0xfffffffffffffff0ULL; -- else if (rssi_level == 2) -- ra_mask &= 0xffffffffffffefe0ULL; -- else if (rssi_level == 3) -- ra_mask &= 0xffffffffffffcfc0ULL; -- else if (rssi_level == 4) -- ra_mask &= 0xffffffffffff8f80ULL; -- else if (rssi_level >= 5) -- ra_mask &= 0xffffffffffff0f00ULL; -- } -+ u8 band; - - if (!si->use_cfg_mask) - return ra_mask; -@@ -891,8 +1206,10 @@ static u64 rtw_update_rate_mask(struct rtw_dev *rtwdev, - return ra_mask; - } - --void rtw_update_sta_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si) -+void rtw_update_sta_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si, -+ bool reset_ra_mask) - { -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; - struct ieee80211_sta *sta = si->sta; - struct rtw_efuse *efuse = &rtwdev->efuse; - struct rtw_hal *hal = &rtwdev->hal; -@@ -904,16 +1221,38 @@ void rtw_update_sta_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si) - u8 ldpc_en = 0; - u8 tx_num = 1; - u64 ra_mask = 0; -+ u64 ra_mask_bak = 0; - bool is_vht_enable = false; - bool is_support_sgi = false; - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ if (sta->deflink.vht_cap.vht_supported) { -+#else - if (sta->vht_cap.vht_supported) { -+#endif - is_vht_enable = true; - ra_mask |= get_vht_ra_mask(sta); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ if (sta->deflink.vht_cap.cap & IEEE80211_VHT_CAP_RXSTBC_MASK) -+#else - if (sta->vht_cap.cap & IEEE80211_VHT_CAP_RXSTBC_MASK) -+#endif - stbc_en = VHT_STBC_EN; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ if (sta->deflink.vht_cap.cap & IEEE80211_VHT_CAP_RXLDPC) -+#else - if (sta->vht_cap.cap & IEEE80211_VHT_CAP_RXLDPC) -+#endif - ldpc_en = VHT_LDPC_EN; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ } else if (sta->deflink.ht_cap.ht_supported) { -+ ra_mask |= (sta->deflink.ht_cap.mcs.rx_mask[1] << 20) | -+ (sta->deflink.ht_cap.mcs.rx_mask[0] << 12); -+ if (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_RX_STBC) -+ stbc_en = HT_STBC_EN; -+ if (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_LDPC_CODING) -+ ldpc_en = HT_LDPC_EN; -+#else - } else if (sta->ht_cap.ht_supported) { - ra_mask |= (sta->ht_cap.mcs.rx_mask[1] << 20) | - (sta->ht_cap.mcs.rx_mask[0] << 12); -@@ -921,91 +1260,157 @@ void rtw_update_sta_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si) - stbc_en = HT_STBC_EN; - if (sta->ht_cap.cap & IEEE80211_HT_CAP_LDPC_CODING) - ldpc_en = HT_LDPC_EN; -+#endif - } - -- if (efuse->hw_cap.nss == 1) -+ if (efuse->hw_cap.nss == 1 || rtwdev->hal.txrx_1ss) - ra_mask &= RA_MASK_VHT_RATES_1SS | RA_MASK_HT_RATES_1SS; - - if (hal->current_band_type == RTW_BAND_5G) { -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ ra_mask |= (u64)sta->deflink.supp_rates[NL80211_BAND_5GHZ] << 4; -+#else - ra_mask |= (u64)sta->supp_rates[NL80211_BAND_5GHZ] << 4; -+#endif -+ ra_mask_bak = ra_mask; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ if (sta->deflink.vht_cap.vht_supported) { -+#else - if (sta->vht_cap.vht_supported) { -+#endif - ra_mask &= RA_MASK_VHT_RATES | RA_MASK_OFDM_IN_VHT; - wireless_set = WIRELESS_OFDM | WIRELESS_VHT; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ } else if (sta->deflink.ht_cap.ht_supported) { -+#else - } else if (sta->ht_cap.ht_supported) { -+#endif - ra_mask &= RA_MASK_HT_RATES | RA_MASK_OFDM_IN_HT_5G; - wireless_set = WIRELESS_OFDM | WIRELESS_HT; - } else { - wireless_set = WIRELESS_OFDM; - } -+ dm_info->rrsr_val_init = RRSR_INIT_5G; - } else if (hal->current_band_type == RTW_BAND_2G) { -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ ra_mask |= sta->deflink.supp_rates[NL80211_BAND_2GHZ]; -+#else - ra_mask |= sta->supp_rates[NL80211_BAND_2GHZ]; -+#endif -+ ra_mask_bak = ra_mask; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ if (sta->deflink.vht_cap.vht_supported) { -+#else - if (sta->vht_cap.vht_supported) { -+#endif - ra_mask &= RA_MASK_VHT_RATES | RA_MASK_CCK_IN_VHT | - RA_MASK_OFDM_IN_VHT; - wireless_set = WIRELESS_CCK | WIRELESS_OFDM | - WIRELESS_HT | WIRELESS_VHT; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ } else if (sta->deflink.ht_cap.ht_supported) { -+#else - } else if (sta->ht_cap.ht_supported) { -+#endif - ra_mask &= RA_MASK_HT_RATES | RA_MASK_CCK_IN_HT | - RA_MASK_OFDM_IN_HT_2G; - wireless_set = WIRELESS_CCK | WIRELESS_OFDM | - WIRELESS_HT; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ } else if (sta->deflink.supp_rates[0] <= 0xf) { -+#else - } else if (sta->supp_rates[0] <= 0xf) { -+#endif - wireless_set = WIRELESS_CCK; - } else { -+ ra_mask &= RA_MASK_OFDM_RATES | RA_MASK_CCK_IN_BG; - wireless_set = WIRELESS_CCK | WIRELESS_OFDM; - } -+ dm_info->rrsr_val_init = RRSR_INIT_2G; - } else { - rtw_err(rtwdev, "Unknown band type\n"); -+ ra_mask_bak = ra_mask; - wireless_set = 0; - } - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ switch (sta->deflink.bandwidth) { -+#else - switch (sta->bandwidth) { -+#endif - case IEEE80211_STA_RX_BW_80: - bw_mode = RTW_CHANNEL_WIDTH_80; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ is_support_sgi = sta->deflink.vht_cap.vht_supported && -+ (sta->deflink.vht_cap.cap & IEEE80211_VHT_CAP_SHORT_GI_80); -+#else - is_support_sgi = sta->vht_cap.vht_supported && - (sta->vht_cap.cap & IEEE80211_VHT_CAP_SHORT_GI_80); -+#endif - break; - case IEEE80211_STA_RX_BW_40: - bw_mode = RTW_CHANNEL_WIDTH_40; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ is_support_sgi = sta->deflink.ht_cap.ht_supported && -+ (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_SGI_40); -+#else - is_support_sgi = sta->ht_cap.ht_supported && - (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40); -+#endif - break; - default: - bw_mode = RTW_CHANNEL_WIDTH_20; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ is_support_sgi = sta->deflink.ht_cap.ht_supported && -+ (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_SGI_20); -+#else - is_support_sgi = sta->ht_cap.ht_supported && - (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20); -+#endif - break; - } - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ if (sta->deflink.vht_cap.vht_supported && ra_mask & 0xffc00000) { -+#else - if (sta->vht_cap.vht_supported && ra_mask & 0xffc00000) { -+#endif - tx_num = 2; - rf_type = RF_2T2R; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ } else if (sta->deflink.ht_cap.ht_supported && ra_mask & 0xfff00000) { -+#else - } else if (sta->ht_cap.ht_supported && ra_mask & 0xfff00000) { -+#endif - tx_num = 2; - rf_type = RF_2T2R; - } - - rate_id = get_rate_id(wireless_set, bw_mode, tx_num); - -- ra_mask = rtw_update_rate_mask(rtwdev, si, ra_mask, is_vht_enable, -- wireless_set); -+ ra_mask &= rtw_rate_mask_rssi(si, wireless_set); -+ ra_mask = rtw_rate_mask_recover(ra_mask, ra_mask_bak); -+ ra_mask = rtw_rate_mask_cfg(rtwdev, si, ra_mask, is_vht_enable); - - si->bw_mode = bw_mode; - si->stbc_en = stbc_en; - si->ldpc_en = ldpc_en; - si->rf_type = rf_type; -- si->wireless_set = wireless_set; - si->sgi_enable = is_support_sgi; - si->vht_enable = is_vht_enable; - si->ra_mask = ra_mask; - si->rate_id = rate_id; - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 18, 0) -+ rtw_fw_send_ra_info(rtwdev, si, reset_ra_mask); -+#else - rtw_fw_send_ra_info(rtwdev, si); -+#endif - } - - static int rtw_wait_firmware_completion(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_fw_state *fw; - - fw = &rtwdev->fw; -@@ -1023,9 +1428,29 @@ static int rtw_wait_firmware_completion(struct rtw_dev *rtwdev) - return 0; - } - -+static enum rtw_lps_deep_mode rtw_update_lps_deep_mode(struct rtw_dev *rtwdev, -+ struct rtw_fw_state *fw) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ -+ if (rtw_disable_lps_deep_mode || !chip->lps_deep_mode_supported || -+ !fw->feature) -+ return LPS_DEEP_MODE_NONE; -+ -+ if ((chip->lps_deep_mode_supported & BIT(LPS_DEEP_MODE_PG)) && -+ rtw_fw_feature_check(fw, FW_FEATURE_PG)) -+ return LPS_DEEP_MODE_PG; -+ -+ if ((chip->lps_deep_mode_supported & BIT(LPS_DEEP_MODE_LCLK)) && -+ rtw_fw_feature_check(fw, FW_FEATURE_LCLK)) -+ return LPS_DEEP_MODE_LCLK; -+ -+ return LPS_DEEP_MODE_NONE; -+} -+ - static int rtw_power_on(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_fw_state *fw = &rtwdev->fw; - bool wifi_only; - int ret; -@@ -1087,6 +1512,73 @@ static int rtw_power_on(struct rtw_dev *rtwdev) - return ret; - } - -+void rtw_core_fw_scan_notify(struct rtw_dev *rtwdev, bool start) -+{ -+ if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_NOTIFY_SCAN)) -+ return; -+ -+ if (start) { -+ rtw_fw_scan_notify(rtwdev, true); -+ } else { -+ reinit_completion(&rtwdev->fw_scan_density); -+ rtw_fw_scan_notify(rtwdev, false); -+ if (!wait_for_completion_timeout(&rtwdev->fw_scan_density, -+ SCAN_NOTIFY_TIMEOUT)) -+ rtw_warn(rtwdev, "firmware failed to report density after scan\n"); -+ } -+} -+ -+void rtw_core_scan_start(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif, -+ const u8 *mac_addr, bool hw_scan) -+{ -+ u32 config = 0; -+ int ret = 0; -+ -+ rtw_leave_lps(rtwdev); -+ -+ if (hw_scan && (rtwdev->hw->conf.flags & IEEE80211_CONF_IDLE)) { -+ ret = rtw_leave_ips(rtwdev); -+ if (ret) { -+ rtw_err(rtwdev, "failed to leave idle state\n"); -+ return; -+ } -+ } -+ -+ ether_addr_copy(rtwvif->mac_addr, mac_addr); -+ config |= PORT_SET_MAC_ADDR; -+ rtw_vif_port_config(rtwdev, rtwvif, config); -+ -+ rtw_coex_scan_notify(rtwdev, COEX_SCAN_START); -+ rtw_core_fw_scan_notify(rtwdev, true); -+ -+ set_bit(RTW_FLAG_DIG_DISABLE, rtwdev->flags); -+ set_bit(RTW_FLAG_SCANNING, rtwdev->flags); -+} -+ -+void rtw_core_scan_complete(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, -+ bool hw_scan) -+{ -+ struct rtw_vif *rtwvif = vif ? (struct rtw_vif *)vif->drv_priv : NULL; -+ u32 config = 0; -+ -+ if (!rtwvif) -+ return; -+ -+ clear_bit(RTW_FLAG_SCANNING, rtwdev->flags); -+ clear_bit(RTW_FLAG_DIG_DISABLE, rtwdev->flags); -+ -+ rtw_core_fw_scan_notify(rtwdev, false); -+ -+ ether_addr_copy(rtwvif->mac_addr, vif->addr); -+ config |= PORT_SET_MAC_ADDR; -+ rtw_vif_port_config(rtwdev, rtwvif, config); -+ -+ rtw_coex_scan_notify(rtwdev, COEX_SCAN_FINISH); -+ -+ if (hw_scan && (rtwdev->hw->conf.flags & IEEE80211_CONF_IDLE)) -+ ieee80211_queue_work(rtwdev->hw, &rtwdev->ips_work); -+} -+ - int rtw_core_start(struct rtw_dev *rtwdev) - { - int ret; -@@ -1097,6 +1589,9 @@ int rtw_core_start(struct rtw_dev *rtwdev) - - rtw_sec_enable_sec_engine(rtwdev); - -+ rtwdev->lps_conf.deep_mode = rtw_update_lps_deep_mode(rtwdev, &rtwdev->fw); -+ rtwdev->lps_conf.wow_deep_mode = rtw_update_lps_deep_mode(rtwdev, &rtwdev->wow_fw); -+ - /* rcr reset after powered on */ - rtw_write32(rtwdev, REG_RCR, rtwdev->hal.rcr); - -@@ -1111,6 +1606,7 @@ int rtw_core_start(struct rtw_dev *rtwdev) - static void rtw_power_off(struct rtw_dev *rtwdev) - { - rtw_hci_stop(rtwdev); -+ rtw_coex_power_off_setting(rtwdev); - rtw_mac_power_off(rtwdev); - } - -@@ -1124,12 +1620,16 @@ void rtw_core_stop(struct rtw_dev *rtwdev) - mutex_unlock(&rtwdev->mutex); - - cancel_work_sync(&rtwdev->c2h_work); -+ cancel_work_sync(&rtwdev->update_beacon_work); - cancel_delayed_work_sync(&rtwdev->watch_dog_work); - cancel_delayed_work_sync(&coex->bt_relink_work); - cancel_delayed_work_sync(&coex->bt_reenable_work); - cancel_delayed_work_sync(&coex->defreeze_work); - cancel_delayed_work_sync(&coex->wl_remain_work); - cancel_delayed_work_sync(&coex->bt_remain_work); -+ cancel_delayed_work_sync(&coex->wl_connecting_work); -+ cancel_delayed_work_sync(&coex->bt_multi_link_remain_work); -+ cancel_delayed_work_sync(&coex->wl_ccklock_work); - - mutex_lock(&rtwdev->mutex); - -@@ -1139,6 +1639,7 @@ void rtw_core_stop(struct rtw_dev *rtwdev) - static void rtw_init_ht_cap(struct rtw_dev *rtwdev, - struct ieee80211_sta_ht_cap *ht_cap) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; - - ht_cap->ht_supported = true; -@@ -1149,13 +1650,15 @@ static void rtw_init_ht_cap(struct rtw_dev *rtwdev, - - if (rtw_chip_has_rx_ldpc(rtwdev)) - ht_cap->cap |= IEEE80211_HT_CAP_LDPC_CODING; -+ if (rtw_chip_has_tx_stbc(rtwdev)) -+ ht_cap->cap |= IEEE80211_HT_CAP_TX_STBC; - - if (efuse->hw_cap.bw & BIT(RTW_CHANNEL_WIDTH_40)) - ht_cap->cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40 | - IEEE80211_HT_CAP_DSSSCCK40 | - IEEE80211_HT_CAP_SGI_40; - ht_cap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K; -- ht_cap->ampdu_density = IEEE80211_HT_MPDU_DENSITY_16; -+ ht_cap->ampdu_density = chip->ampdu_density; - ht_cap->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED; - if (efuse->hw_cap.nss > 1) { - ht_cap->mcs.rx_mask[0] = 0xFF; -@@ -1219,8 +1722,23 @@ static void rtw_init_vht_cap(struct rtw_dev *rtwdev, - vht_cap->vht_mcs.tx_highest = highest; - } - -+static u16 rtw_get_max_scan_ie_len(struct rtw_dev *rtwdev) -+{ -+ u16 len; -+ -+ len = rtwdev->chip->max_scan_ie_len; -+ -+ if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD) && -+ rtwdev->chip->id == RTW_CHIP_TYPE_8822C) -+ len = IEEE80211_MAX_DATA_LEN; -+ else if (rtw_fw_feature_ext_check(&rtwdev->fw, FW_FEATURE_EXT_OLD_PAGE_NUM)) -+ len -= RTW_OLD_PROBE_PG_CNT * TX_PAGE_SIZE; -+ -+ return len; -+} -+ - static void rtw_set_supported_band(struct ieee80211_hw *hw, -- struct rtw_chip_info *chip) -+ const struct rtw_chip_info *chip) - { - struct rtw_dev *rtwdev = hw->priv; - struct ieee80211_supported_band *sband; -@@ -1249,16 +1767,73 @@ static void rtw_set_supported_band(struct ieee80211_hw *hw, - - err_out: - rtw_err(rtwdev, "failed to set supported band\n"); -- kfree(sband); - } - - static void rtw_unset_supported_band(struct ieee80211_hw *hw, -- struct rtw_chip_info *chip) -+ const struct rtw_chip_info *chip) - { - kfree(hw->wiphy->bands[NL80211_BAND_2GHZ]); - kfree(hw->wiphy->bands[NL80211_BAND_5GHZ]); - } - -+static void rtw_vif_smps_iter(void *data, u8 *mac, -+ struct ieee80211_vif *vif) -+{ -+ struct rtw_dev *rtwdev = (struct rtw_dev *)data; -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) -+ if (vif->type != NL80211_IFTYPE_STATION || !vif->cfg.assoc) -+#else -+ if (vif->type != NL80211_IFTYPE_STATION || !vif->bss_conf.assoc) -+#endif -+ return; -+ -+ if (rtwdev->hal.txrx_1ss) -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) -+ ieee80211_request_smps(vif, 0, IEEE80211_SMPS_STATIC); -+#else -+ ieee80211_request_smps(vif, IEEE80211_SMPS_STATIC); -+#endif -+ else -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) -+ ieee80211_request_smps(vif, 0, IEEE80211_SMPS_OFF); -+#else -+ ieee80211_request_smps(vif, IEEE80211_SMPS_OFF); -+#endif -+} -+ -+void rtw_set_txrx_1ss(struct rtw_dev *rtwdev, bool txrx_1ss) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_hal *hal = &rtwdev->hal; -+ -+ if (!chip->ops->config_txrx_mode || rtwdev->hal.txrx_1ss == txrx_1ss) -+ return; -+ -+ rtwdev->hal.txrx_1ss = txrx_1ss; -+ if (txrx_1ss) -+ chip->ops->config_txrx_mode(rtwdev, BB_PATH_A, BB_PATH_A, false); -+ else -+ chip->ops->config_txrx_mode(rtwdev, hal->antenna_tx, -+ hal->antenna_rx, false); -+ rtw_iterate_vifs_atomic(rtwdev, rtw_vif_smps_iter, rtwdev); -+} -+ -+static void __update_firmware_feature(struct rtw_dev *rtwdev, -+ struct rtw_fw_state *fw) -+{ -+ u32 feature; -+ const struct rtw_fw_hdr *fw_hdr = -+ (const struct rtw_fw_hdr *)fw->firmware->data; -+ -+ feature = le32_to_cpu(fw_hdr->feature); -+ fw->feature = feature & FW_FEATURE_SIG ? feature : 0; -+ -+ if (rtwdev->chip->id == RTW_CHIP_TYPE_8822C && -+ RTW_FW_SUIT_VER_CODE(rtwdev->fw) < RTW_FW_VER_CODE(9, 9, 13)) -+ fw->feature_ext |= FW_FEATURE_EXT_OLD_PAGE_NUM; -+} -+ - static void __update_firmware_info(struct rtw_dev *rtwdev, - struct rtw_fw_state *fw) - { -@@ -1269,6 +1844,8 @@ static void __update_firmware_info(struct rtw_dev *rtwdev, - fw->version = le16_to_cpu(fw_hdr->version); - fw->sub_version = fw_hdr->subversion; - fw->sub_index = fw_hdr->subindex; -+ -+ __update_firmware_feature(rtwdev, fw); - } - - static void __update_firmware_info_legacy(struct rtw_dev *rtwdev, -@@ -1307,7 +1884,8 @@ static void rtw_load_firmware_cb(const struct firmware *firmware, void *context) - update_firmware_info(rtwdev, fw); - complete_all(&fw->completion); - -- rtw_info(rtwdev, "Firmware version %u.%u.%u, H2C version %u\n", -+ rtw_info(rtwdev, "%sFirmware version %u.%u.%u, H2C version %u\n", -+ fw->type == RTW_WOWLAN_FW ? "WOW " : "", - fw->version, fw->sub_version, fw->sub_index, fw->h2c_version); - } - -@@ -1333,6 +1911,7 @@ static int rtw_load_firmware(struct rtw_dev *rtwdev, enum rtw_fw_type type) - return -ENOENT; - } - -+ fw->type = type; - fw->rtwdev = rtwdev; - init_completion(&fw->completion); - -@@ -1348,16 +1927,23 @@ static int rtw_load_firmware(struct rtw_dev *rtwdev, enum rtw_fw_type type) - - static int rtw_chip_parameter_setup(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_hal *hal = &rtwdev->hal; - struct rtw_efuse *efuse = &rtwdev->efuse; -- int ret = 0; - - switch (rtw_hci_type(rtwdev)) { - case RTW_HCI_TYPE_PCIE: - rtwdev->hci.rpwm_addr = 0x03d9; - rtwdev->hci.cpwm_addr = 0x03da; - break; -+ case RTW_HCI_TYPE_SDIO: -+ rtwdev->hci.rpwm_addr = REG_SDIO_HRPWM1; -+ rtwdev->hci.cpwm_addr = REG_SDIO_HCPWM1_V2; -+ break; -+ case RTW_HCI_TYPE_USB: -+ rtwdev->hci.rpwm_addr = 0xfe58; -+ rtwdev->hci.cpwm_addr = 0xfe57; -+ break; - default: - rtw_err(rtwdev, "unsupported hci type\n"); - return -EINVAL; -@@ -1389,7 +1975,7 @@ static int rtw_chip_parameter_setup(struct rtw_dev *rtwdev) - - hal->bfee_sts_cap = 3; - -- return ret; -+ return 0; - } - - static int rtw_chip_efuse_enable(struct rtw_dev *rtwdev) -@@ -1548,9 +2134,11 @@ static int rtw_chip_board_info_setup(struct rtw_dev *rtwdev) - if (!rfe_def) - return -ENODEV; - -- rtw_phy_setup_phy_cond(rtwdev, 0); -+ rtw_phy_setup_phy_cond(rtwdev, hal->pkg_type); - - rtw_phy_init_tx_power(rtwdev); -+ if (rfe_def->agc_btg_tbl) -+ rtw_load_table(rtwdev, rfe_def->agc_btg_tbl); - rtw_load_table(rtwdev, rfe_def->phy_pg_tbl); - rtw_load_table(rtwdev, rfe_def->txpwr_lmt_tbl); - rtw_phy_tx_power_by_rate_config(hal); -@@ -1605,16 +2193,26 @@ static void rtw_stats_init(struct rtw_dev *rtwdev) - - int rtw_core_init(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_coex *coex = &rtwdev->coex; - int ret; - - INIT_LIST_HEAD(&rtwdev->rsvd_page_list); - INIT_LIST_HEAD(&rtwdev->txqs); - -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 14, 0) -+ setup_timer(&rtwdev->tx_report.purge_timer, -+ (void *)(long unsigned int)rtw_tx_report_purge_timer, -+ (long unsigned int)rtwdev); -+#else - timer_setup(&rtwdev->tx_report.purge_timer, - rtw_tx_report_purge_timer, 0); -- tasklet_setup(&rtwdev->tx_tasklet, rtw_tx_tasklet); -+#endif -+ rtwdev->tx_wq = alloc_workqueue("rtw_tx_wq", WQ_UNBOUND | WQ_HIGHPRI, 0); -+ if (!rtwdev->tx_wq) { -+ rtw_warn(rtwdev, "alloc_workqueue rtw_tx_wq failed\n"); -+ return -ENOMEM; -+ } - - INIT_DELAYED_WORK(&rtwdev->watch_dog_work, rtw_watch_dog_work); - INIT_DELAYED_WORK(&coex->bt_relink_work, rtw_coex_bt_relink_work); -@@ -1622,31 +2220,34 @@ int rtw_core_init(struct rtw_dev *rtwdev) - INIT_DELAYED_WORK(&coex->defreeze_work, rtw_coex_defreeze_work); - INIT_DELAYED_WORK(&coex->wl_remain_work, rtw_coex_wl_remain_work); - INIT_DELAYED_WORK(&coex->bt_remain_work, rtw_coex_bt_remain_work); -+ INIT_DELAYED_WORK(&coex->wl_connecting_work, rtw_coex_wl_connecting_work); -+ INIT_DELAYED_WORK(&coex->bt_multi_link_remain_work, -+ rtw_coex_bt_multi_link_remain_work); -+ INIT_DELAYED_WORK(&coex->wl_ccklock_work, rtw_coex_wl_ccklock_work); -+ INIT_WORK(&rtwdev->tx_work, rtw_tx_work); - INIT_WORK(&rtwdev->c2h_work, rtw_c2h_work); -+ INIT_WORK(&rtwdev->ips_work, rtw_ips_work); - INIT_WORK(&rtwdev->fw_recovery_work, rtw_fw_recovery_work); -+ INIT_WORK(&rtwdev->update_beacon_work, rtw_fw_update_beacon_work); - INIT_WORK(&rtwdev->ba_work, rtw_txq_ba_work); - skb_queue_head_init(&rtwdev->c2h_queue); - skb_queue_head_init(&rtwdev->coex.queue); - skb_queue_head_init(&rtwdev->tx_report.queue); - -- spin_lock_init(&rtwdev->rf_lock); -- spin_lock_init(&rtwdev->h2c.lock); - spin_lock_init(&rtwdev->txq_lock); - spin_lock_init(&rtwdev->tx_report.q_lock); - - mutex_init(&rtwdev->mutex); -- mutex_init(&rtwdev->coex.mutex); - mutex_init(&rtwdev->hal.tx_power_mutex); - - init_waitqueue_head(&rtwdev->coex.wait); -+ init_completion(&rtwdev->lps_leave_check); -+ init_completion(&rtwdev->fw_scan_density); - - rtwdev->sec.total_cam_num = 32; - rtwdev->hal.current_channel = 1; -+ rtwdev->dm_info.fix_rate = U8_MAX; - set_bit(RTW_BC_MC_MACID, rtwdev->mac_id_map); -- if (!(BIT(rtw_fw_lps_deep_mode) & chip->lps_deep_mode_supported)) -- rtwdev->lps_conf.deep_mode = LPS_DEEP_MODE_NONE; -- else -- rtwdev->lps_conf.deep_mode = rtw_fw_lps_deep_mode; - - rtw_stats_init(rtwdev); - -@@ -1658,7 +2259,7 @@ int rtw_core_init(struct rtw_dev *rtwdev) - ret = rtw_load_firmware(rtwdev, RTW_NORMAL_FW); - if (ret) { - rtw_warn(rtwdev, "no firmware loaded\n"); -- return ret; -+ goto out; - } - - if (chip->wow_fw_name) { -@@ -1668,10 +2269,15 @@ int rtw_core_init(struct rtw_dev *rtwdev) - wait_for_completion(&rtwdev->fw.completion); - if (rtwdev->fw.firmware) - release_firmware(rtwdev->fw.firmware); -- return ret; -+ goto out; - } - } -+ - return 0; -+ -+out: -+ destroy_workqueue(rtwdev->tx_wq); -+ return ret; - } - EXPORT_SYMBOL(rtw_core_init); - -@@ -1690,9 +2296,16 @@ void rtw_core_deinit(struct rtw_dev *rtwdev) - if (wow_fw->firmware) - release_firmware(wow_fw->firmware); - -- tasklet_kill(&rtwdev->tx_tasklet); -+ destroy_workqueue(rtwdev->tx_wq); -+# if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 2, 0) -+ timer_delete_sync(&rtwdev->tx_report.purge_timer); -+# else -+ del_timer_sync(&rtwdev->tx_report.purge_timer); -+# endif - spin_lock_irqsave(&rtwdev->tx_report.q_lock, flags); - skb_queue_purge(&rtwdev->tx_report.queue); -+ skb_queue_purge(&rtwdev->coex.queue); -+ skb_queue_purge(&rtwdev->c2h_queue); - spin_unlock_irqrestore(&rtwdev->tx_report.q_lock, flags); - - list_for_each_entry_safe(rsvd_pkt, tmp, &rtwdev->rsvd_page_list, -@@ -1702,7 +2315,6 @@ void rtw_core_deinit(struct rtw_dev *rtwdev) - } - - mutex_destroy(&rtwdev->mutex); -- mutex_destroy(&rtwdev->coex.mutex); - mutex_destroy(&rtwdev->hal.tx_power_mutex); - } - EXPORT_SYMBOL(rtw_core_deinit); -@@ -1713,9 +2325,11 @@ int rtw_register_hw(struct rtw_dev *rtwdev, struct ieee80211_hw *hw) - int max_tx_headroom = 0; - int ret; - -- /* TODO: USB & SDIO may need extra room? */ - max_tx_headroom = rtwdev->chip->tx_pkt_desc_sz; - -+ if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) -+ max_tx_headroom += RTW_SDIO_DATA_PTR_ALIGN; -+ - hw->extra_tx_headroom = max_tx_headroom; - hw->queues = IEEE80211_NUM_ACS; - hw->txq_data_size = sizeof(struct rtw_txq); -@@ -1733,6 +2347,7 @@ int rtw_register_hw(struct rtw_dev *rtwdev, struct ieee80211_hw *hw) - ieee80211_hw_set(hw, SUPPORTS_AMSDU_IN_AMPDU); - ieee80211_hw_set(hw, HAS_RATE_CONTROL); - ieee80211_hw_set(hw, TX_AMSDU); -+ ieee80211_hw_set(hw, SINGLE_SCAN_ON_ALL_BANDS); - - hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | - BIT(NL80211_IFTYPE_AP) | -@@ -1745,8 +2360,17 @@ int rtw_register_hw(struct rtw_dev *rtwdev, struct ieee80211_hw *hw) - WIPHY_FLAG_TDLS_EXTERNAL_SETUP; - - hw->wiphy->features |= NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR; -+ hw->wiphy->max_scan_ssids = RTW_SCAN_MAX_SSIDS; -+ hw->wiphy->max_scan_ie_len = rtw_get_max_scan_ie_len(rtwdev); -+ -+ if (rtwdev->chip->id == RTW_CHIP_TYPE_8822C) { -+ hw->wiphy->iface_combinations = rtw_iface_combs; -+ hw->wiphy->n_iface_combinations = ARRAY_SIZE(rtw_iface_combs); -+ } - - wiphy_ext_feature_set(hw->wiphy, NL80211_EXT_FEATURE_CAN_REPLACE_PTK0); -+ wiphy_ext_feature_set(hw->wiphy, NL80211_EXT_FEATURE_SCAN_RANDOM_SN); -+ wiphy_ext_feature_set(hw->wiphy, NL80211_EXT_FEATURE_SET_SCAN_DWELL); - - #ifdef CONFIG_PM - hw->wiphy->wowlan = rtwdev->chip->wowlan_stub; -@@ -1755,7 +2379,15 @@ int rtw_register_hw(struct rtw_dev *rtwdev, struct ieee80211_hw *hw) - rtw_set_supported_band(hw, rtwdev->chip); - SET_IEEE80211_PERM_ADDR(hw, rtwdev->efuse.addr); - -- rtw_regd_init(rtwdev, rtw_regd_notifier); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) -+ hw->wiphy->sar_capa = &rtw_sar_capa; -+#endif -+ -+ ret = rtw_regd_init(rtwdev); -+ if (ret) { -+ rtw_err(rtwdev, "failed to init regd\n"); -+ return ret; -+ } - - ret = ieee80211_register_hw(hw); - if (ret) { -@@ -1763,8 +2395,11 @@ int rtw_register_hw(struct rtw_dev *rtwdev, struct ieee80211_hw *hw) - return ret; - } - -- if (regulatory_hint(hw->wiphy, rtwdev->regd.alpha2)) -- rtw_err(rtwdev, "regulatory_hint fail\n"); -+ ret = rtw_regd_hint(rtwdev); -+ if (ret) { -+ rtw_err(rtwdev, "failed to hint regd\n"); -+ return ret; -+ } - - rtw_debugfs_init(rtwdev); - -@@ -1777,13 +2412,139 @@ EXPORT_SYMBOL(rtw_register_hw); - - void rtw_unregister_hw(struct rtw_dev *rtwdev, struct ieee80211_hw *hw) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - ieee80211_unregister_hw(hw); - rtw_unset_supported_band(hw, chip); - } - EXPORT_SYMBOL(rtw_unregister_hw); - -+static -+void rtw_swap_reg_nbytes(struct rtw_dev *rtwdev, const struct rtw_hw_reg *reg1, -+ const struct rtw_hw_reg *reg2, u8 nbytes) -+{ -+ u8 i; -+ -+ for (i = 0; i < nbytes; i++) { -+ u8 v1 = rtw_read8(rtwdev, reg1->addr + i); -+ u8 v2 = rtw_read8(rtwdev, reg2->addr + i); -+ -+ rtw_write8(rtwdev, reg1->addr + i, v2); -+ rtw_write8(rtwdev, reg2->addr + i, v1); -+ } -+} -+ -+static -+void rtw_swap_reg_mask(struct rtw_dev *rtwdev, const struct rtw_hw_reg *reg1, -+ const struct rtw_hw_reg *reg2) -+{ -+ u32 v1, v2; -+ -+ v1 = rtw_read32_mask(rtwdev, reg1->addr, reg1->mask); -+ v2 = rtw_read32_mask(rtwdev, reg2->addr, reg2->mask); -+ rtw_write32_mask(rtwdev, reg2->addr, reg2->mask, v1); -+ rtw_write32_mask(rtwdev, reg1->addr, reg1->mask, v2); -+} -+ -+struct rtw_iter_port_switch_data { -+ struct rtw_dev *rtwdev; -+ struct rtw_vif *rtwvif_ap; -+}; -+ -+static void rtw_port_switch_iter(void *data, struct ieee80211_vif *vif) -+{ -+ struct rtw_iter_port_switch_data *iter_data = data; -+ struct rtw_dev *rtwdev = iter_data->rtwdev; -+ struct rtw_vif *rtwvif_target = (struct rtw_vif *)vif->drv_priv; -+ struct rtw_vif *rtwvif_ap = iter_data->rtwvif_ap; -+ const struct rtw_hw_reg *reg1, *reg2; -+ -+ if (rtwvif_target->port != RTW_PORT_0) -+ return; -+ -+ rtw_dbg(rtwdev, RTW_DBG_STATE, "AP port switch from %d -> %d\n", -+ rtwvif_ap->port, rtwvif_target->port); -+ -+ /* Leave LPS so the value swapped are not in PS mode */ -+ rtw_leave_lps(rtwdev); -+ -+ reg1 = &rtwvif_ap->conf->net_type; -+ reg2 = &rtwvif_target->conf->net_type; -+ rtw_swap_reg_mask(rtwdev, reg1, reg2); -+ -+ reg1 = &rtwvif_ap->conf->mac_addr; -+ reg2 = &rtwvif_target->conf->mac_addr; -+ rtw_swap_reg_nbytes(rtwdev, reg1, reg2, ETH_ALEN); -+ -+ reg1 = &rtwvif_ap->conf->bssid; -+ reg2 = &rtwvif_target->conf->bssid; -+ rtw_swap_reg_nbytes(rtwdev, reg1, reg2, ETH_ALEN); -+ -+ reg1 = &rtwvif_ap->conf->bcn_ctrl; -+ reg2 = &rtwvif_target->conf->bcn_ctrl; -+ rtw_swap_reg_nbytes(rtwdev, reg1, reg2, 1); -+ -+ swap(rtwvif_target->port, rtwvif_ap->port); -+ swap(rtwvif_target->conf, rtwvif_ap->conf); -+ -+ rtw_fw_default_port(rtwdev, rtwvif_target); -+} -+ -+void rtw_core_port_switch(struct rtw_dev *rtwdev, struct ieee80211_vif *vif) -+{ -+ struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; -+ struct rtw_iter_port_switch_data iter_data; -+ -+ if (vif->type != NL80211_IFTYPE_AP || rtwvif->port == RTW_PORT_0) -+ return; -+ -+ iter_data.rtwdev = rtwdev; -+ iter_data.rtwvif_ap = rtwvif; -+ rtw_iterate_vifs(rtwdev, rtw_port_switch_iter, &iter_data); -+} -+ -+static void rtw_check_sta_active_iter(void *data, struct ieee80211_vif *vif) -+{ -+ struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; -+ bool *active = data; -+ -+ if (*active) -+ return; -+ -+ if (vif->type != NL80211_IFTYPE_STATION) -+ return; -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) -+ if (vif->cfg.assoc || !is_zero_ether_addr(rtwvif->bssid)) -+#else -+ if (vif->bss_conf.assoc || !is_zero_ether_addr(rtwvif->bssid)) -+#endif -+ *active = true; -+} -+ -+bool rtw_core_check_sta_active(struct rtw_dev *rtwdev) -+{ -+ bool sta_active = false; -+ -+ rtw_iterate_vifs(rtwdev, rtw_check_sta_active_iter, &sta_active); -+ -+ return rtwdev->ap_active || sta_active; -+} -+ -+void rtw_core_enable_beacon(struct rtw_dev *rtwdev, bool enable) -+{ -+ if (!rtwdev->ap_active) -+ return; -+ -+ if (enable) { -+ rtw_write32_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); -+ rtw_write32_clr(rtwdev, REG_TXPAUSE, BIT_HIGH_QUEUE); -+ } else { -+ rtw_write32_clr(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); -+ rtw_write32_set(rtwdev, REG_TXPAUSE, BIT_HIGH_QUEUE); -+ } -+} -+ - MODULE_AUTHOR("Realtek Corporation"); - MODULE_DESCRIPTION("Realtek 802.11ac wireless core module"); - MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/main.h b/drivers/net/wireless/realtek/rtw88/main.h -index 8ba0b0824..d4714c5a5 100644 ---- a/drivers/net/wireless/realtek/rtw88/main.h -+++ b/drivers/net/wireless/realtek/rtw88/main.h -@@ -5,21 +5,57 @@ - #ifndef __RTK_MAIN_H_ - #define __RTK_MAIN_H_ - -+#include -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 11, 0) -+#include "compiler.h" -+#endif - #include - #include - #include - #include - #include -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 19, 0) - #include -+#else -+#include "bitfield.h" -+#endif - #include - #include -+#include - - #include "util.h" -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 8, 0) -+#include -+#endif -+ -+#if !defined(RHEL_RELEASE_CODE) -+#define RHEL_RELEASE_CODE 0 -+#define RHEL_RELEASE_VERSION(a, b) a<<8 & b -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 8, 0)) || defined(RHEL_RELEASE) && (RHEL_RELEASE_CODE < RHEL_RELEASE_VERSION(8,0)) -+/* see Documentation/timers/timers-howto.rst for the thresholds */ -+static inline void fsleep(unsigned long usecs) -+{ -+ if (usecs <= 10) -+ udelay(usecs); -+ else if (usecs <= 20000) -+ usleep_range(usecs, 2 * usecs); -+ else -+ msleep(DIV_ROUND_UP(usecs, 1000)); -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 7, 0) -+#define NUM_NL80211_BANDS IEEE80211_NUM_BANDS -+#endif - - #define RTW_MAX_MAC_ID_NUM 32 - #define RTW_MAX_SEC_CAM_NUM 32 - #define MAX_PG_CAM_BACKUP_NUM 8 - -+#define RTW_SCAN_MAX_SSIDS 4 -+ - #define RTW_MAX_PATTERN_NUM 12 - #define RTW_MAX_PATTERN_MASK_SIZE 16 - #define RTW_MAX_PATTERN_SIZE 128 -@@ -29,6 +65,7 @@ - #define RFREG_MASK 0xfffff - #define INV_RF_DATA 0xffffffff - #define TX_PAGE_SIZE_SHIFT 7 -+#define TX_PAGE_SIZE (1 << TX_PAGE_SIZE_SHIFT) - - #define RTW_CHANNEL_WIDTH_MAX 3 - #define RTW_RF_PATH_MAX 4 -@@ -36,9 +73,69 @@ - - #define RTW_TP_SHIFT 18 /* bytes/2s --> Mbps */ - -+#ifndef read_poll_timeout -+#define read_poll_timeout(op, val, cond, sleep_us, timeout_us, \ -+ sleep_before_read, args...) \ -+({ \ -+ u64 __timeout_us = (timeout_us); \ -+ unsigned long __sleep_us = (sleep_us); \ -+ ktime_t __timeout = ktime_add_us(ktime_get(), __timeout_us); \ -+ might_sleep_if((__sleep_us) != 0); \ -+ if (sleep_before_read && __sleep_us) \ -+ usleep_range((__sleep_us >> 2) + 1, __sleep_us); \ -+ for (;;) { \ -+ (val) = op(args); \ -+ if (cond) \ -+ break; \ -+ if (__timeout_us && \ -+ ktime_compare(ktime_get(), __timeout) > 0) { \ -+ (val) = op(args); \ -+ break; \ -+ } \ -+ if (__sleep_us) \ -+ usleep_range((__sleep_us >> 2) + 1, __sleep_us); \ -+ } \ -+ (cond) ? 0 : -ETIMEDOUT; \ -+}) -+#endif -+ -+#if !defined(IEEE80211_AMPDU_TX_START_IMMEDIATE) -+#define IEEE80211_AMPDU_TX_START_IMMEDIATE 1 -+#endif -+ -+#if !defined(fallthrough) -+#define fallthrough do {} while (0) -+#endif -+ -+#ifndef read_poll_timeout_atomic -+#define read_poll_timeout_atomic(op, val, cond, delay_us, timeout_us, \ -+ delay_before_read, args...) \ -+({ \ -+ u64 __timeout_us = (timeout_us); \ -+ unsigned long __delay_us = (delay_us); \ -+ ktime_t __timeout = ktime_add_us(ktime_get(), __timeout_us); \ -+ if (delay_before_read && __delay_us) \ -+ udelay(__delay_us); \ -+ for (;;) { \ -+ (val) = op(args); \ -+ if (cond) \ -+ break; \ -+ if (__timeout_us && \ -+ ktime_compare(ktime_get(), __timeout) > 0) { \ -+ (val) = op(args); \ -+ break; \ -+ } \ -+ if (__delay_us) \ -+ udelay(__delay_us); \ -+ } \ -+ (cond) ? 0 : -ETIMEDOUT; \ -+}) -+#endif -+ - extern bool rtw_bf_support; --extern unsigned int rtw_fw_lps_deep_mode; -+extern bool rtw_disable_lps_deep_mode; - extern unsigned int rtw_debug_mask; -+extern bool rtw_edcca_enabled; - extern const struct ieee80211_ops rtw_ops; - - #define RTW_MAX_CHANNEL_NUM_2G 14 -@@ -78,14 +175,12 @@ struct rtw_hci { - IS_CH_5G_BAND_3(channel) || IS_CH_5G_BAND_4(channel)) - - enum rtw_supported_band { -- RTW_BAND_2G = 1 << 0, -- RTW_BAND_5G = 1 << 1, -- RTW_BAND_60G = 1 << 2, -- -- RTW_BAND_MAX, -+ RTW_BAND_2G = BIT(NL80211_BAND_2GHZ), -+ RTW_BAND_5G = BIT(NL80211_BAND_5GHZ), -+ RTW_BAND_60G = BIT(NL80211_BAND_60GHZ), - }; - --/* now, support upto 80M bw */ -+/* now, support up to 80M bw */ - #define RTW_MAX_CHANNEL_WIDTH RTW_CHANNEL_WIDTH_80 - - enum rtw_bandwidth { -@@ -353,13 +448,15 @@ enum rtw_flags { - RTW_FLAG_RUNNING, - RTW_FLAG_FW_RUNNING, - RTW_FLAG_SCANNING, -- RTW_FLAG_INACTIVE_PS, -+ RTW_FLAG_POWERON, - RTW_FLAG_LEISURE_PS, - RTW_FLAG_LEISURE_PS_DEEP, - RTW_FLAG_DIG_DISABLE, - RTW_FLAG_BUSY_TRAFFIC, - RTW_FLAG_WOWLAN, - RTW_FLAG_RESTARTING, -+ RTW_FLAG_RESTART_TRIGGERING, -+ RTW_FLAG_FORCE_LOWEST_RATE, - - NUM_OF_RTW_FLAGS, - }; -@@ -390,6 +487,15 @@ enum rtw_snr { - RTW_SNR_NUM - }; - -+enum rtw_port { -+ RTW_PORT_0 = 0, -+ RTW_PORT_1 = 1, -+ RTW_PORT_2 = 2, -+ RTW_PORT_3 = 3, -+ RTW_PORT_4 = 4, -+ RTW_PORT_NUM -+}; -+ - enum rtw_wow_flags { - RTW_WOW_FLAG_EN_MAGIC_PKT, - RTW_WOW_FLAG_EN_REKEY_PKT, -@@ -497,20 +603,10 @@ struct rtw_txpwr_idx { - struct rtw_5g_txpwr_idx pwr_idx_5g; - }; - --struct rtw_timer_list { -- struct timer_list timer; -- void (*function)(void *data); -- void *args; --}; -- - struct rtw_channel_params { - u8 center_chan; -+ u8 primary_chan; - u8 bandwidth; -- u8 primary_chan_idx; -- /* center channel by different available bandwidth, -- * val of (bw > current bandwidth) is invalid -- */ -- u8 cch_by_bw[RTW_MAX_CHANNEL_WIDTH + 1]; - }; - - struct rtw_hw_reg { -@@ -543,6 +639,11 @@ struct rtw_rf_sipi_addr { - u32 lssi_read_pi; - }; - -+struct rtw_hw_reg_offset { -+ struct rtw_hw_reg hw_reg; -+ u8 offset; -+}; -+ - struct rtw_backup_info { - u8 len; - u32 reg; -@@ -569,6 +670,7 @@ struct rtw_tx_pkt_info { - u32 tx_pkt_size; - u8 offset; - u8 pkt_offset; -+ u8 tim_offset; - u8 mac_id; - u8 rate_id; - u8 rate; -@@ -620,9 +722,12 @@ struct rtw_rx_pkt_stat { - s8 rx_snr[RTW_RF_PATH_MAX]; - u8 rx_evm[RTW_RF_PATH_MAX]; - s8 cfo_tail[RTW_RF_PATH_MAX]; -+ u16 freq; -+ u8 band; - - struct rtw_sta_info *si; - struct ieee80211_vif *vif; -+ struct ieee80211_hdr *hdr; - }; - - DECLARE_EWMA(tp, 10, 2); -@@ -664,6 +769,7 @@ enum rtw_pwr_state { - struct rtw_lps_conf { - enum rtw_lps_mode mode; - enum rtw_lps_deep_mode deep_mode; -+ enum rtw_lps_deep_mode wow_deep_mode; - enum rtw_pwr_state state; - u8 awake_interval; - u8 rlbm; -@@ -714,15 +820,14 @@ struct rtw_ra_report { - - struct rtw_txq { - struct list_head list; -- - unsigned long flags; -- unsigned long last_push; - }; - - #define RTW_BC_MC_MACID 1 - DECLARE_EWMA(rssi, 10, 16); - - struct rtw_sta_info { -+ struct rtw_dev *rtwdev; - struct ieee80211_sta *sta; - struct ieee80211_vif *vif; - -@@ -733,12 +838,10 @@ struct rtw_sta_info { - u8 rate_id; - enum rtw_bandwidth bw_mode; - enum rtw_rf_type rf_type; -- enum rtw_wireless_set wireless_set; - u8 stbc_en:2; - u8 ldpc_en:2; - bool sgi_enable; - bool vht_enable; -- bool updated; - u8 init_ra_lv; - u64 ra_mask; - -@@ -748,6 +851,8 @@ struct rtw_sta_info { - - bool use_cfg_mask; - struct cfg80211_bitrate_mask *mask; -+ -+ struct work_struct rc_work; - }; - - enum rtw_bfee_role { -@@ -781,6 +886,7 @@ struct rtw_bf_info { - struct rtw_vif { - enum rtw_net_type net_type; - u16 aid; -+ u8 mac_id; /* for STA mode only */ - u8 mac_addr[ETH_ALEN]; - u8 bssid[ETH_ALEN]; - u8 port; -@@ -788,6 +894,8 @@ struct rtw_vif { - struct list_head rsvd_page_list; - struct ieee80211_tx_queue_params tx_params[IEEE80211_NUM_ACS]; - const struct rtw_vif_port *conf; -+ struct cfg80211_scan_request *scan_req; -+ struct ieee80211_scan_ies *scan_ies; - - struct rtw_traffic_stats stats; - -@@ -796,12 +904,27 @@ struct rtw_vif { - - struct rtw_regulatory { - char alpha2[2]; -- u8 chplan; -- u8 txpwr_regd; -+ u8 txpwr_regd_2g; -+ u8 txpwr_regd_5g; -+}; -+ -+enum rtw_regd_state { -+ RTW_REGD_STATE_WORLDWIDE, -+ RTW_REGD_STATE_PROGRAMMED, -+ RTW_REGD_STATE_SETTING, -+ -+ RTW_REGD_STATE_NR, -+}; -+ -+struct rtw_regd { -+ enum rtw_regd_state state; -+ const struct rtw_regulatory *regulatory; -+ enum nl80211_dfs_regions dfs_region; - }; - - struct rtw_chip_ops { - int (*mac_init)(struct rtw_dev *rtwdev); -+ int (*dump_fw_crash)(struct rtw_dev *rtwdev); - void (*shutdown)(struct rtw_dev *rtwdev); - int (*read_efuse)(struct rtw_dev *rtwdev, u8 *map); - void (*phy_set_param)(struct rtw_dev *rtwdev); -@@ -834,6 +957,20 @@ struct rtw_chip_ops { - struct ieee80211_bss_conf *conf); - void (*cfg_csi_rate)(struct rtw_dev *rtwdev, u8 rssi, u8 cur_rate, - u8 fixrate_en, u8 *new_rate); -+ void (*adaptivity_init)(struct rtw_dev *rtwdev); -+ void (*adaptivity)(struct rtw_dev *rtwdev); -+ void (*cfo_init)(struct rtw_dev *rtwdev); -+ void (*cfo_track)(struct rtw_dev *rtwdev); -+ void (*config_tx_path)(struct rtw_dev *rtwdev, u8 tx_path, -+ enum rtw_bb_path tx_path_1ss, -+ enum rtw_bb_path tx_path_cck, -+ bool is_tx2_path); -+ void (*config_txrx_mode)(struct rtw_dev *rtwdev, u8 tx_path, -+ u8 rx_path, bool is_tx2_path); -+ /* for USB/SDIO only */ -+ void (*fill_txdesc_checksum)(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ u8 *txdesc); - - /* for coex */ - void (*coex_set_init)(struct rtw_dev *rtwdev); -@@ -1041,6 +1178,7 @@ enum rtw_rfe_fem { - struct rtw_rfe_def { - const struct rtw_table *phy_pg_tbl; - const struct rtw_table *txpwr_lmt_tbl; -+ const struct rtw_table *agc_btg_tbl; - }; - - #define RTW_DEF_RFE(chip, bb_pg, pwrlmt) { \ -@@ -1048,6 +1186,12 @@ struct rtw_rfe_def { - .txpwr_lmt_tbl = &rtw ## chip ## _txpwr_lmt_type ## pwrlmt ## _tbl, \ - } - -+#define RTW_DEF_RFE_EXT(chip, bb_pg, pwrlmt, btg) { \ -+ .phy_pg_tbl = &rtw ## chip ## _bb_pg_type ## bb_pg ## _tbl, \ -+ .txpwr_lmt_tbl = &rtw ## chip ## _txpwr_lmt_type ## pwrlmt ## _tbl, \ -+ .agc_btg_tbl = &rtw ## chip ## _agc_btg_type ## btg ## _tbl, \ -+ } -+ - #define RTW_PWR_TRK_5G_1 0 - #define RTW_PWR_TRK_5G_2 1 - #define RTW_PWR_TRK_5G_3 2 -@@ -1094,6 +1238,15 @@ enum rtw_fw_fifo_sel { - RTW_FW_FIFO_MAX, - }; - -+enum rtw_fwcd_item { -+ RTW_FWCD_TLV, -+ RTW_FWCD_REG, -+ RTW_FWCD_ROM, -+ RTW_FWCD_IMEM, -+ RTW_FWCD_DMEM, -+ RTW_FWCD_EMEM, -+}; -+ - /* hardware configuration for each IC */ - struct rtw_chip_info { - struct rtw_chip_ops *ops; -@@ -1111,6 +1264,7 @@ struct rtw_chip_info { - u32 txff_size; - u32 rxff_size; - u32 fw_rxff_size; -+ u16 rsvd_drv_pg_num; - u8 band; - u8 page_size; - u8 csi_buf_pg_num; -@@ -1119,10 +1273,16 @@ struct rtw_chip_info { - u8 txgi_factor; - bool is_pwr_by_rate_dec; - bool rx_ldpc; -+ bool tx_stbc; - u8 max_power_index; -+ u8 ampdu_density; - - u16 fw_fifo_addr[RTW_FW_FIFO_MAX]; -+ const struct rtw_fwcd_segs *fwcd_segs; - -+ u8 default_1ss_tx_path; -+ -+ bool path_div_supported; - bool ht_supported; - bool vht_supported; - u8 lps_deep_mode_supported; -@@ -1162,18 +1322,22 @@ struct rtw_chip_info { - u8 bfer_su_max_num; - u8 bfer_mu_max_num; - -+ struct rtw_hw_reg_offset *edcca_th; -+ s8 l2h_th_ini_cs; -+ s8 l2h_th_ini_ad; -+ - const char *wow_fw_name; - const struct wiphy_wowlan_support *wowlan_stub; - const u8 max_sched_scan_ssids; -- -- /* for 8821c set channel */ -- u32 ch_param[3]; -+ const u16 max_scan_ie_len; - - /* coex paras */ - u32 coex_para_ver; - u8 bt_desired_ver; - bool scbd_support; - bool new_scbd10_def; /* true: fix 2M(8822c) */ -+ bool ble_hid_profile_support; -+ bool wl_mimo_ps_support; - u8 pstdma_type; /* 0: LPSoff, 1:LPSon */ - u8 bt_rssi_type; - u8 ant_isolation; -@@ -1198,6 +1362,7 @@ struct rtw_chip_info { - const struct coex_5g_afh_map *afh_5g; - const struct rtw_hw_reg *btg_reg; - const struct rtw_reg_domain *coex_info_hw_regs; -+ u32 wl_fw_desired_ver; - }; - - enum rtw_coex_bt_state_cnt { -@@ -1219,6 +1384,7 @@ enum rtw_coex_bt_state_cnt { - }; - - enum rtw_coex_wl_state_cnt { -+ COEX_CNT_WL_SCANAP, - COEX_CNT_WL_CONNPKT, - COEX_CNT_WL_COEXRUN, - COEX_CNT_WL_NOISY0, -@@ -1241,6 +1407,8 @@ struct rtw_coex_rfe { - bool wlg_at_btg; - }; - -+#define COEX_WL_TDMA_PARA_LENGTH 5 -+ - struct rtw_coex_dm { - bool cur_ps_tdma_on; - bool cur_wl_rx_low_gain_en; -@@ -1260,6 +1428,7 @@ struct rtw_coex_dm { - u32 cur_ant_pos_type; - u32 cur_switch_status; - u32 setting_tdma; -+ u8 fw_tdma_para[COEX_WL_TDMA_PARA_LENGTH]; - }; - - #define COEX_BTINFO_SRC_WL_FW 0x0 -@@ -1267,7 +1436,8 @@ struct rtw_coex_dm { - #define COEX_BTINFO_SRC_BT_ACT 0x2 - #define COEX_BTINFO_SRC_BT_IQK 0x3 - #define COEX_BTINFO_SRC_BT_SCBD 0x4 --#define COEX_BTINFO_SRC_MAX 0x5 -+#define COEX_BTINFO_SRC_H2C60 0x5 -+#define COEX_BTINFO_SRC_MAX 0x6 - - #define COEX_INFO_FTP BIT(7) - #define COEX_INFO_A2DP BIT(6) -@@ -1278,6 +1448,43 @@ struct rtw_coex_dm { - #define COEX_INFO_SCO_ESCO BIT(1) - #define COEX_INFO_CONNECTION BIT(0) - #define COEX_BTINFO_LENGTH_MAX 10 -+#define COEX_BTINFO_LENGTH 7 -+ -+#define COEX_BT_HIDINFO_LIST 0x0 -+#define COEX_BT_HIDINFO_A 0x1 -+#define COEX_BT_HIDINFO_NAME 3 -+ -+#define COEX_BT_HIDINFO_LENGTH 6 -+#define COEX_BT_HIDINFO_HANDLE_NUM 4 -+#define COEX_BT_HIDINFO_C2H_HANDLE 0 -+#define COEX_BT_HIDINFO_C2H_VENDOR 1 -+#define COEX_BT_BLE_HANDLE_THRS 0x10 -+#define COEX_BT_HIDINFO_NOTCON 0xff -+ -+struct rtw_coex_hid { -+ u8 hid_handle; -+ u8 hid_vendor; -+ u8 hid_name[COEX_BT_HIDINFO_NAME]; -+ bool hid_info_completed; -+ bool is_game_hid; -+}; -+ -+struct rtw_coex_hid_handle_list { -+ u8 cmd_id; -+ u8 len; -+ u8 subid; -+ u8 handle_cnt; -+ u8 handle[COEX_BT_HIDINFO_HANDLE_NUM]; -+} __packed; -+ -+struct rtw_coex_hid_info_a { -+ u8 cmd_id; -+ u8 len; -+ u8 subid; -+ u8 handle; -+ u8 vendor; -+ u8 name[COEX_BT_HIDINFO_NAME]; -+} __packed; - - struct rtw_coex_stat { - bool bt_disabled; -@@ -1299,6 +1506,8 @@ struct rtw_coex_stat { - bool bt_fix_2M; - bool bt_setup_link; - bool bt_multi_link; -+ bool bt_multi_link_pre; -+ bool bt_multi_link_remain; - bool bt_a2dp_sink; - bool bt_a2dp_active; - bool bt_reenable; -@@ -1306,6 +1515,9 @@ struct rtw_coex_stat { - bool bt_init_scan; - bool bt_slave; - bool bt_418_hid_exist; -+ bool bt_ble_hid_exist; -+ bool bt_game_hid_exist; -+ bool bt_hid_handle_cnt; - bool bt_mailbox_reply; - - bool wl_under_lps; -@@ -1323,9 +1535,17 @@ struct rtw_coex_stat { - bool wl_cck_lock; - bool wl_cck_lock_pre; - bool wl_cck_lock_ever; -+ bool wl_connecting; -+ bool wl_slot_toggle; -+ bool wl_slot_toggle_change; /* if toggle to no-toggle */ -+ bool wl_mimo_ps; - - u32 bt_supported_version; - u32 bt_supported_feature; -+ u32 hi_pri_tx; -+ u32 hi_pri_rx; -+ u32 lo_pri_tx; -+ u32 lo_pri_rx; - u32 patch_ver; - u16 bt_reg_vendor_ae; - u16 bt_reg_vendor_ac; -@@ -1347,13 +1567,21 @@ struct rtw_coex_stat { - u8 bt_a2dp_bitpool; - u8 bt_iqk_state; - -+ u16 wl_beacon_interval; - u8 wl_noisy_level; - u8 wl_fw_dbg_info[10]; - u8 wl_fw_dbg_info_pre[10]; -+ u8 wl_rx_rate; -+ u8 wl_tx_rate; -+ u8 wl_rts_rx_rate; - u8 wl_coex_mode; -+ u8 wl_iot_peer; - u8 ampdu_max_time; - u8 wl_tput_dir; - -+ u8 wl_toggle_para[6]; -+ u8 wl_toggle_interval; -+ - u16 score_board; - u16 retry_limit; - -@@ -1363,13 +1591,17 @@ struct rtw_coex_stat { - /* counters to record wifi states */ - u32 cnt_wl[COEX_CNT_WL_MAX]; - -+ /* counters to record bt c2h data */ -+ u32 cnt_bt_info_c2h[COEX_BTINFO_SRC_MAX]; -+ - u32 darfrc; - u32 darfrch; -+ -+ struct rtw_coex_hid hid_info[COEX_BT_HIDINFO_HANDLE_NUM]; -+ struct rtw_coex_hid_handle_list hid_handle_list; - }; - - struct rtw_coex { -- /* protects coex info request section */ -- struct mutex mutex; - struct sk_buff_head queue; - wait_queue_head_t wait; - -@@ -1378,6 +1610,7 @@ struct rtw_coex { - bool freeze; - bool freerun; - bool wl_rf_off; -+ bool manual_control; - - struct rtw_coex_stat stat; - struct rtw_coex_dm dm; -@@ -1388,6 +1621,10 @@ struct rtw_coex { - struct delayed_work defreeze_work; - struct delayed_work wl_remain_work; - struct delayed_work bt_remain_work; -+ struct delayed_work wl_connecting_work; -+ struct delayed_work bt_multi_link_remain_work; -+ struct delayed_work wl_ccklock_work; -+ - }; - - #define DPK_RF_REG_NUM 7 -@@ -1454,6 +1691,60 @@ struct rtw_iqk_info { - } result; - }; - -+enum rtw_rf_band { -+ RF_BAND_2G_CCK, -+ RF_BAND_2G_OFDM, -+ RF_BAND_5G_L, -+ RF_BAND_5G_M, -+ RF_BAND_5G_H, -+ RF_BAND_MAX -+}; -+ -+#define RF_GAIN_NUM 11 -+#define RF_HW_OFFSET_NUM 10 -+ -+struct rtw_gapk_info { -+ u32 rf3f_bp[RF_BAND_MAX][RF_GAIN_NUM][RTW_RF_PATH_MAX]; -+ u32 rf3f_fs[RTW_RF_PATH_MAX][RF_GAIN_NUM]; -+ bool txgapk_bp_done; -+ s8 offset[RF_GAIN_NUM][RTW_RF_PATH_MAX]; -+ s8 fianl_offset[RF_GAIN_NUM][RTW_RF_PATH_MAX]; -+ u8 read_txgain; -+ u8 channel; -+}; -+ -+#define EDCCA_TH_L2H_IDX 0 -+#define EDCCA_TH_H2L_IDX 1 -+#define EDCCA_TH_L2H_LB 48 -+#define EDCCA_ADC_BACKOFF 12 -+#define EDCCA_IGI_BASE 50 -+#define EDCCA_IGI_L2H_DIFF 8 -+#define EDCCA_L2H_H2L_DIFF 7 -+#define EDCCA_L2H_H2L_DIFF_NORMAL 8 -+ -+enum rtw_edcca_mode { -+ RTW_EDCCA_NORMAL = 0, -+ RTW_EDCCA_ADAPTIVITY = 1, -+}; -+ -+struct rtw_cfo_track { -+ bool is_adjust; -+ u8 crystal_cap; -+ s32 cfo_tail[RTW_RF_PATH_MAX]; -+ s32 cfo_cnt[RTW_RF_PATH_MAX]; -+ u32 packet_count; -+ u32 packet_count_pre; -+}; -+ -+#define RRSR_INIT_2G 0x15f -+#define RRSR_INIT_5G 0x150 -+ -+enum rtw_dm_cap { -+ RTW_DM_CAP_NA, -+ RTW_DM_CAP_TXGAPK, -+ RTW_DM_CAP_NUM -+}; -+ - struct rtw_dm_info { - u32 cck_fa_cnt; - u32 ofdm_fa_cnt; -@@ -1483,7 +1774,10 @@ struct rtw_dm_info { - u8 cck_gi_u_bnd; - u8 cck_gi_l_bnd; - -+ u8 fix_rate; - u8 tx_rate; -+ u32 rrsr_val_init; -+ u32 rrsr_mask_min; - u8 thermal_avg[RTW_RF_PATH_MAX]; - u8 thermal_meter_k; - u8 thermal_meter_lck; -@@ -1502,6 +1796,7 @@ struct rtw_dm_info { - u8 dack_dck[RTW_RF_PATH_MAX][2][DACK_DCK_BACKUP_NUM]; - - struct rtw_dpk_info dpk_info; -+ struct rtw_cfo_track cfo_track; - - /* [bandwidth 0:20M/1:40M][number of path] */ - u8 cck_pd_lv[2][RTW_RF_PATH_MAX]; -@@ -1519,7 +1814,14 @@ struct rtw_dm_info { - struct ewma_evm ewma_evm[RTW_EVM_NUM]; - struct ewma_snr ewma_snr[RTW_SNR_NUM]; - -+ u32 dm_flags; /* enum rtw_dm_cap */ - struct rtw_iqk_info iqk; -+ struct rtw_gapk_info gapk; -+ bool is_bt_iqk_timeout; -+ -+ s8 l2h_th_ini; -+ enum rtw_edcca_mode edcca_mode; -+ u8 scan_density; - }; - - struct rtw_efuse { -@@ -1623,6 +1925,17 @@ struct rtw_fifo_conf { - const struct rtw_rqpn *rqpn; - }; - -+struct rtw_fwcd_desc { -+ u32 size; -+ u8 *next; -+ u8 *data; -+}; -+ -+struct rtw_fwcd_segs { -+ const u32 *segs; -+ u8 num; -+}; -+ - #define FW_CD_TYPE 0xffff - #define FW_CD_LEN 4 - #define FW_CD_VAL 0xaabbccdd -@@ -1630,11 +1943,41 @@ struct rtw_fw_state { - const struct firmware *firmware; - struct rtw_dev *rtwdev; - struct completion completion; -+ struct rtw_fwcd_desc fwcd_desc; - u16 version; - u8 sub_version; - u8 sub_index; - u16 h2c_version; -- u8 prev_dump_seq; -+ u32 feature; -+ u32 feature_ext; -+ enum rtw_fw_type type; -+}; -+ -+enum rtw_sar_sources { -+ RTW_SAR_SOURCE_NONE, -+ RTW_SAR_SOURCE_COMMON, -+}; -+ -+enum rtw_sar_bands { -+ RTW_SAR_BAND_0, -+ RTW_SAR_BAND_1, -+ /* RTW_SAR_BAND_2, not used now */ -+ RTW_SAR_BAND_3, -+ RTW_SAR_BAND_4, -+ -+ RTW_SAR_BAND_NR, -+}; -+ -+/* the union is reserved for other kinds of SAR sources -+ * which might not re-use same format with array common. -+ */ -+union rtw_sar_cfg { -+ s8 common[RTW_SAR_BAND_NR]; -+}; -+ -+struct rtw_sar { -+ enum rtw_sar_sources src; -+ union rtw_sar_cfg cfg[RTW_RF_PATH_MAX][RTW_RATE_SECTION_MAX]; - }; - - struct rtw_hal { -@@ -1644,12 +1987,16 @@ struct rtw_hal { - u8 cut_version; - u8 mp_chip; - u8 oem_id; -+ u8 pkg_type; - struct rtw_phy_cond phy_cond; -+ bool rfe_btg; - - u8 ps_mode; - u8 current_channel; -+ u8 current_primary_channel_index; - u8 current_band_width; - u8 current_band_type; -+ u8 primary_channel; - - /* center channel for different available bandwidth, - * val of (bw > current_band_width) is invalid -@@ -1663,6 +2010,7 @@ struct rtw_hal { - u32 antenna_tx; - u32 antenna_rx; - u8 bfee_sts_cap; -+ bool txrx_1ss; - - /* protect tx power section */ - struct mutex tx_power_mutex; -@@ -1684,6 +2032,45 @@ struct rtw_hal { - [RTW_MAX_CHANNEL_NUM_5G]; - s8 tx_pwr_tbl[RTW_RF_PATH_MAX] - [DESC_RATE_MAX]; -+ -+ enum rtw_sar_bands sar_band; -+ struct rtw_sar sar; -+ -+ /* for 8821c set channel */ -+ u32 ch_param[3]; -+}; -+ -+struct rtw_path_div { -+ enum rtw_bb_path current_tx_path; -+ u32 path_a_sum; -+ u32 path_b_sum; -+ u16 path_a_cnt; -+ u16 path_b_cnt; -+}; -+ -+struct rtw_chan_info { -+ int pri_ch_idx; -+ int action_id; -+ int bw; -+ u8 extra_info; -+ u8 channel; -+ u16 timeout; -+}; -+ -+struct rtw_chan_list { -+ u32 buf_size; -+ u32 ch_num; -+ u32 size; -+ u16 addr; -+}; -+ -+struct rtw_hw_scan_info { -+ struct ieee80211_vif *scanning_vif; -+ u8 probe_pg_size; -+ u8 op_pri_ch_idx; -+ u8 op_pri_ch; -+ u8 op_chan; -+ u8 op_bw; - }; - - struct rtw_dev { -@@ -1692,14 +2079,15 @@ struct rtw_dev { - - struct rtw_hci hci; - -- struct rtw_chip_info *chip; -+ struct rtw_hw_scan_info scan_info; -+ const struct rtw_chip_info *chip; - struct rtw_hal hal; - struct rtw_fifo_conf fifo; - struct rtw_fw_state fw; - struct rtw_efuse efuse; - struct rtw_sec_desc sec; - struct rtw_traffic_stats stats; -- struct rtw_regulatory regd; -+ struct rtw_regd regd; - struct rtw_bf_info bf_info; - - struct rtw_dm_info dm_info; -@@ -1708,9 +2096,6 @@ struct rtw_dev { - /* ensures exclusive access from mac80211 callbacks */ - struct mutex mutex; - -- /* read/write rf register */ -- spinlock_t rf_lock; -- - /* watch dog every 2 sec */ - struct delayed_work watch_dog_work; - u32 watch_dog_cnt; -@@ -1720,42 +2105,49 @@ struct rtw_dev { - /* c2h cmd queue & handler work */ - struct sk_buff_head c2h_queue; - struct work_struct c2h_work; -+ struct work_struct ips_work; - struct work_struct fw_recovery_work; -+ struct work_struct update_beacon_work; - - /* used to protect txqs list */ - spinlock_t txq_lock; - struct list_head txqs; -- struct tasklet_struct tx_tasklet; -+ struct workqueue_struct *tx_wq; -+ struct work_struct tx_work; - struct work_struct ba_work; - - struct rtw_tx_report tx_report; - - struct { -- /* incicate the mail box to use with fw */ -+ /* indicate the mail box to use with fw */ - u8 last_box_num; -- /* protect to send h2c to fw */ -- spinlock_t lock; - u32 seq; - } h2c; - - /* lps power state & handler work */ - struct rtw_lps_conf lps_conf; - bool ps_enabled; -+ bool beacon_loss; -+ struct completion lps_leave_check; - - struct dentry *debugfs; - - u8 sta_cnt; - u32 rts_threshold; - -+ DECLARE_BITMAP(hw_port, RTW_PORT_NUM); - DECLARE_BITMAP(mac_id_map, RTW_MAX_MAC_ID_NUM); - DECLARE_BITMAP(flags, NUM_OF_RTW_FLAGS); - - u8 mp_mode; -+ struct rtw_path_div dm_path_div; - - struct rtw_fw_state wow_fw; - struct rtw_wow_param wow; - - bool need_rfk; -+ struct completion fw_scan_density; -+ bool ap_active; - - /* hci related data, must be last */ - u8 priv[] __aligned(sizeof(void *)); -@@ -1821,11 +2213,40 @@ static inline bool rtw_chip_has_rx_ldpc(struct rtw_dev *rtwdev) - return rtwdev->chip->rx_ldpc; - } - -+static inline bool rtw_chip_has_tx_stbc(struct rtw_dev *rtwdev) -+{ -+ return rtwdev->chip->tx_stbc; -+} -+ - static inline void rtw_release_macid(struct rtw_dev *rtwdev, u8 mac_id) - { - clear_bit(mac_id, rtwdev->mac_id_map); - } - -+static inline int rtw_chip_dump_fw_crash(struct rtw_dev *rtwdev) -+{ -+ if (rtwdev->chip->ops->dump_fw_crash) -+ return rtwdev->chip->ops->dump_fw_crash(rtwdev); -+ -+ return 0; -+} -+ -+static inline -+enum nl80211_band rtw_hw_to_nl80211_band(enum rtw_supported_band hw_band) -+{ -+ switch (hw_band) { -+ default: -+ case RTW_BAND_2G: -+ return NL80211_BAND_2GHZ; -+ case RTW_BAND_5G: -+ return NL80211_BAND_5GHZ; -+ case RTW_BAND_60G: -+ return NL80211_BAND_60GHZ; -+ } -+} -+ -+void rtw_set_rx_freq_band(struct rtw_rx_pkt_stat *pkt_stat, u8 channel); -+void rtw_set_dtim_period(struct rtw_dev *rtwdev, int dtim_period); - void rtw_get_channel_params(struct cfg80211_chan_def *chandef, - struct rtw_channel_params *ch_param); - bool check_hw_ready(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 target); -@@ -1838,8 +2259,17 @@ void rtw_set_channel(struct rtw_dev *rtwdev); - void rtw_chip_prepare_tx(struct rtw_dev *rtwdev); - void rtw_vif_port_config(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif, - u32 config); -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 14, 0) -+void rtw_tx_report_purge_timer(void *ctx); -+#else - void rtw_tx_report_purge_timer(struct timer_list *t); --void rtw_update_sta_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si); -+#endif -+void rtw_update_sta_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si, -+ bool reset_ra_mask); -+void rtw_core_scan_start(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif, -+ const u8 *mac_addr, bool hw_scan); -+void rtw_core_scan_complete(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, -+ bool hw_scan); - int rtw_core_start(struct rtw_dev *rtwdev); - void rtw_core_stop(struct rtw_dev *rtwdev); - int rtw_chip_info_setup(struct rtw_dev *rtwdev); -@@ -1855,5 +2285,15 @@ int rtw_sta_add(struct rtw_dev *rtwdev, struct ieee80211_sta *sta, - void rtw_sta_remove(struct rtw_dev *rtwdev, struct ieee80211_sta *sta, - bool fw_exist); - void rtw_fw_recovery(struct rtw_dev *rtwdev); -- -+void rtw_core_fw_scan_notify(struct rtw_dev *rtwdev, bool start); -+int rtw_dump_fw(struct rtw_dev *rtwdev, const u32 ocp_src, u32 size, -+ u32 fwcd_item); -+int rtw_dump_reg(struct rtw_dev *rtwdev, const u32 addr, const u32 size); -+void rtw_set_txrx_1ss(struct rtw_dev *rtwdev, bool config_1ss); -+void rtw_update_channel(struct rtw_dev *rtwdev, u8 center_channel, -+ u8 primary_channel, enum rtw_supported_band band, -+ enum rtw_bandwidth bandwidth); -+void rtw_core_port_switch(struct rtw_dev *rtwdev, struct ieee80211_vif *vif); -+bool rtw_core_check_sta_active(struct rtw_dev *rtwdev); -+void rtw_core_enable_beacon(struct rtw_dev *rtwdev, bool enable); - #endif -diff --git a/drivers/net/wireless/realtek/rtw88/pci.c b/drivers/net/wireless/realtek/rtw88/pci.c -index 676d861aa..494cf6329 100644 ---- a/drivers/net/wireless/realtek/rtw88/pci.c -+++ b/drivers/net/wireless/realtek/rtw88/pci.c -@@ -30,7 +30,8 @@ static u32 rtw_pci_tx_queue_idx_addr[] = { - [RTW_TX_QUEUE_H2C] = RTK_PCI_TXBD_IDX_H2CQ, - }; - --static u8 rtw_pci_get_tx_qsel(struct sk_buff *skb, u8 queue) -+static u8 rtw_pci_get_tx_qsel(struct sk_buff *skb, -+ enum rtw_tx_queue_type queue) - { - switch (queue) { - case RTW_TX_QUEUE_BCN: -@@ -88,13 +89,6 @@ static void rtw_pci_write32(struct rtw_dev *rtwdev, u32 addr, u32 val) - writel(val, rtwpci->mmap + addr); - } - --static inline void *rtw_pci_get_tx_desc(struct rtw_pci_tx_ring *tx_ring, u8 idx) --{ -- int offset = tx_ring->r.desc_size * idx; -- -- return tx_ring->r.head + offset; --} -- - static void rtw_pci_free_tx_ring_skbs(struct rtw_dev *rtwdev, - struct rtw_pci_tx_ring *tx_ring) - { -@@ -267,11 +261,6 @@ static int rtw_pci_init_rx_ring(struct rtw_dev *rtwdev, - int i, allocated; - int ret = 0; - -- if (len > TRX_BD_IDX_MASK) { -- rtw_err(rtwdev, "len %d exceeds maximum RX entries\n", len); -- return -EINVAL; -- } -- - head = dma_alloc_coherent(&pdev->dev, ring_sz, &dma, GFP_KERNEL); - if (!head) { - rtw_err(rtwdev, "failed to allocate rx ring\n"); -@@ -327,7 +316,7 @@ static int rtw_pci_init_trx_ring(struct rtw_dev *rtwdev) - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; - struct rtw_pci_tx_ring *tx_ring; - struct rtw_pci_rx_ring *rx_ring; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - int i = 0, j = 0, tx_alloced = 0, rx_alloced = 0; - int tx_desc_size, rx_desc_size; - u32 len; -@@ -488,13 +477,14 @@ static void rtw_pci_reset_trx_ring(struct rtw_dev *rtwdev) - } - - static void rtw_pci_enable_interrupt(struct rtw_dev *rtwdev, -- struct rtw_pci *rtwpci) -+ struct rtw_pci *rtwpci, bool exclude_rx) - { - unsigned long flags; -+ u32 imr0_unmask = exclude_rx ? IMR_ROK : 0; - - spin_lock_irqsave(&rtwpci->hwirq_lock, flags); - -- rtw_write32(rtwdev, RTK_PCI_HIMR0, rtwpci->irq_mask[0]); -+ rtw_write32(rtwdev, RTK_PCI_HIMR0, rtwpci->irq_mask[0] & ~imr0_unmask); - rtw_write32(rtwdev, RTK_PCI_HIMR1, rtwpci->irq_mask[1]); - if (rtw_chip_wcpu_11ac(rtwdev)) - rtw_write32(rtwdev, RTK_PCI_HIMR3, rtwpci->irq_mask[3]); -@@ -546,7 +536,7 @@ static int rtw_pci_setup(struct rtw_dev *rtwdev) - static void rtw_pci_dma_release(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci) - { - struct rtw_pci_tx_ring *tx_ring; -- u8 queue; -+ enum rtw_tx_queue_type queue; - - rtw_pci_reset_trx_ring(rtwdev); - for (queue = 0; queue < RTK_MAX_TX_QUEUE_NUM; queue++) { -@@ -555,12 +545,36 @@ static void rtw_pci_dma_release(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci) - } - } - -+static void rtw_pci_napi_start(struct rtw_dev *rtwdev) -+{ -+ struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -+ -+ if (test_and_set_bit(RTW_PCI_FLAG_NAPI_RUNNING, rtwpci->flags)) -+ return; -+ -+ napi_enable(&rtwpci->napi); -+} -+ -+static void rtw_pci_napi_stop(struct rtw_dev *rtwdev) -+{ -+ struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -+ -+ if (!test_and_clear_bit(RTW_PCI_FLAG_NAPI_RUNNING, rtwpci->flags)) -+ return; -+ -+ napi_synchronize(&rtwpci->napi); -+ napi_disable(&rtwpci->napi); -+} -+ - static int rtw_pci_start(struct rtw_dev *rtwdev) - { - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; - -+ rtw_pci_napi_start(rtwdev); -+ - spin_lock_bh(&rtwpci->irq_lock); -- rtw_pci_enable_interrupt(rtwdev, rtwpci); -+ rtwpci->running = true; -+ rtw_pci_enable_interrupt(rtwdev, rtwpci, false); - spin_unlock_bh(&rtwpci->irq_lock); - - return 0; -@@ -569,9 +583,17 @@ static int rtw_pci_start(struct rtw_dev *rtwdev) - static void rtw_pci_stop(struct rtw_dev *rtwdev) - { - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -+ struct pci_dev *pdev = rtwpci->pdev; - - spin_lock_bh(&rtwpci->irq_lock); -+ rtwpci->running = false; - rtw_pci_disable_interrupt(rtwdev, rtwpci); -+ spin_unlock_bh(&rtwpci->irq_lock); -+ -+ synchronize_irq(pdev->irq); -+ rtw_pci_napi_stop(rtwdev); -+ -+ spin_lock_bh(&rtwpci->irq_lock); - rtw_pci_dma_release(rtwdev, rtwpci); - spin_unlock_bh(&rtwpci->irq_lock); - } -@@ -580,8 +602,11 @@ static void rtw_pci_deep_ps_enter(struct rtw_dev *rtwdev) - { - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; - struct rtw_pci_tx_ring *tx_ring; -+ enum rtw_tx_queue_type queue; - bool tx_empty = true; -- u8 queue; -+ -+ if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) -+ goto enter_deep_ps; - - lockdep_assert_held(&rtwpci->irq_lock); - -@@ -608,7 +633,7 @@ static void rtw_pci_deep_ps_enter(struct rtw_dev *rtwdev) - "TX path not empty, cannot enter deep power save state\n"); - return; - } -- -+enter_deep_ps: - set_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags); - rtw_power_mode_change(rtwdev, true); - } -@@ -638,32 +663,6 @@ static void rtw_pci_deep_ps(struct rtw_dev *rtwdev, bool enter) - spin_unlock_bh(&rtwpci->irq_lock); - } - --static u8 ac_to_hwq[] = { -- [IEEE80211_AC_VO] = RTW_TX_QUEUE_VO, -- [IEEE80211_AC_VI] = RTW_TX_QUEUE_VI, -- [IEEE80211_AC_BE] = RTW_TX_QUEUE_BE, -- [IEEE80211_AC_BK] = RTW_TX_QUEUE_BK, --}; -- --static u8 rtw_hw_queue_mapping(struct sk_buff *skb) --{ -- struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; -- __le16 fc = hdr->frame_control; -- u8 q_mapping = skb_get_queue_mapping(skb); -- u8 queue; -- -- if (unlikely(ieee80211_is_beacon(fc))) -- queue = RTW_TX_QUEUE_BCN; -- else if (unlikely(ieee80211_is_mgmt(fc) || ieee80211_is_ctl(fc))) -- queue = RTW_TX_QUEUE_MGMT; -- else if (WARN_ON_ONCE(q_mapping >= ARRAY_SIZE(ac_to_hwq))) -- queue = ac_to_hwq[IEEE80211_AC_BE]; -- else -- queue = ac_to_hwq[q_mapping]; -- -- return queue; --} -- - static void rtw_pci_release_rsvd_page(struct rtw_pci *rtwpci, - struct rtw_pci_tx_ring *ring) - { -@@ -685,7 +684,7 @@ static void rtw_pci_dma_check(struct rtw_dev *rtwdev, - u32 idx) - { - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_pci_rx_buffer_desc *buf_desc; - u32 desc_sz = chip->rx_buf_desc_sz; - u16 total_pkt_size; -@@ -701,7 +700,75 @@ static void rtw_pci_dma_check(struct rtw_dev *rtwdev, - rtwpci->rx_tag = (rtwpci->rx_tag + 1) % RX_TAG_MAX; - } - --static void rtw_pci_tx_kick_off_queue(struct rtw_dev *rtwdev, u8 queue) -+static u32 __pci_get_hw_tx_ring_rp(struct rtw_dev *rtwdev, u8 pci_q) -+{ -+ u32 bd_idx_addr = rtw_pci_tx_queue_idx_addr[pci_q]; -+ u32 bd_idx = rtw_read16(rtwdev, bd_idx_addr + 2); -+ -+ return FIELD_GET(TRX_BD_IDX_MASK, bd_idx); -+} -+ -+static void __pci_flush_queue(struct rtw_dev *rtwdev, u8 pci_q, bool drop) -+{ -+ struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -+ struct rtw_pci_tx_ring *ring = &rtwpci->tx_rings[pci_q]; -+ u32 cur_rp; -+ u8 i; -+ -+ /* Because the time taked by the I/O in __pci_get_hw_tx_ring_rp is a -+ * bit dynamic, it's hard to define a reasonable fixed total timeout to -+ * use read_poll_timeout* helper. Instead, we can ensure a reasonable -+ * polling times, so we just use for loop with udelay here. -+ */ -+ for (i = 0; i < 30; i++) { -+ cur_rp = __pci_get_hw_tx_ring_rp(rtwdev, pci_q); -+ if (cur_rp == ring->r.wp) -+ return; -+ -+ udelay(1); -+ } -+ -+ if (!drop) -+ rtw_warn(rtwdev, "timed out to flush pci tx ring[%d]\n", pci_q); -+} -+ -+static void __rtw_pci_flush_queues(struct rtw_dev *rtwdev, u32 pci_queues, -+ bool drop) -+{ -+ u8 q; -+ -+ for (q = 0; q < RTK_MAX_TX_QUEUE_NUM; q++) { -+ /* Unnecessary to flush BCN, H2C and HI tx queues. */ -+ if (q == RTW_TX_QUEUE_BCN || q == RTW_TX_QUEUE_H2C || -+ q == RTW_TX_QUEUE_HI0) -+ continue; -+ -+ if (pci_queues & BIT(q)) -+ __pci_flush_queue(rtwdev, q, drop); -+ } -+} -+ -+static void rtw_pci_flush_queues(struct rtw_dev *rtwdev, u32 queues, bool drop) -+{ -+ u32 pci_queues = 0; -+ u8 i; -+ -+ /* If all of the hardware queues are requested to flush, -+ * flush all of the pci queues. -+ */ -+ if (queues == BIT(rtwdev->hw->queues) - 1) { -+ pci_queues = BIT(RTK_MAX_TX_QUEUE_NUM) - 1; -+ } else { -+ for (i = 0; i < rtwdev->hw->queues; i++) -+ if (queues & BIT(i)) -+ pci_queues |= BIT(rtw_tx_ac_to_hwq(i)); -+ } -+ -+ __rtw_pci_flush_queues(rtwdev, pci_queues, drop); -+} -+ -+static void rtw_pci_tx_kick_off_queue(struct rtw_dev *rtwdev, -+ enum rtw_tx_queue_type queue) - { - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; - struct rtw_pci_tx_ring *ring; -@@ -711,7 +778,8 @@ static void rtw_pci_tx_kick_off_queue(struct rtw_dev *rtwdev, u8 queue) - bd_idx = rtw_pci_tx_queue_idx_addr[queue]; - - spin_lock_bh(&rtwpci->irq_lock); -- rtw_pci_deep_ps_leave(rtwdev); -+ if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) -+ rtw_pci_deep_ps_leave(rtwdev); - rtw_write16(rtwdev, bd_idx, ring->r.wp & TRX_BD_IDX_MASK); - spin_unlock_bh(&rtwpci->irq_lock); - } -@@ -719,7 +787,7 @@ static void rtw_pci_tx_kick_off_queue(struct rtw_dev *rtwdev, u8 queue) - static void rtw_pci_tx_kick_off(struct rtw_dev *rtwdev) - { - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -- u8 queue; -+ enum rtw_tx_queue_type queue; - - for (queue = 0; queue < RTK_MAX_TX_QUEUE_NUM; queue++) - if (test_and_clear_bit(queue, rtwpci->tx_queued)) -@@ -728,10 +796,11 @@ static void rtw_pci_tx_kick_off(struct rtw_dev *rtwdev) - - static int rtw_pci_tx_write_data(struct rtw_dev *rtwdev, - struct rtw_tx_pkt_info *pkt_info, -- struct sk_buff *skb, u8 queue) -+ struct sk_buff *skb, -+ enum rtw_tx_queue_type queue) - { - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_pci_tx_ring *ring; - struct rtw_pci_tx_data *tx_data; - dma_addr_t dma; -@@ -846,9 +915,9 @@ static int rtw_pci_tx_write(struct rtw_dev *rtwdev, - struct rtw_tx_pkt_info *pkt_info, - struct sk_buff *skb) - { -+ enum rtw_tx_queue_type queue = rtw_tx_queue_mapping(skb); - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; - struct rtw_pci_tx_ring *ring; -- u8 queue = rtw_hw_queue_mapping(skb); - int ret; - - ret = rtw_pci_tx_write_data(rtwdev, pkt_info, skb, queue); -@@ -856,10 +925,12 @@ static int rtw_pci_tx_write(struct rtw_dev *rtwdev, - return ret; - - ring = &rtwpci->tx_rings[queue]; -+ spin_lock_bh(&rtwpci->irq_lock); - if (avail_desc(ring->r.wp, ring->r.rp, ring->r.len) < 2) { - ieee80211_stop_queue(rtwdev->hw, skb_get_queue_mapping(skb)); - ring->queue_stopped = true; - } -+ spin_unlock_bh(&rtwpci->irq_lock); - - return 0; - } -@@ -874,7 +945,7 @@ static void rtw_pci_tx_isr(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, - struct sk_buff *skb; - u32 count; - u32 bd_idx_addr; -- u32 bd_idx, cur_rp; -+ u32 bd_idx, cur_rp, rp_idx; - u16 q_map; - - ring = &rtwpci->tx_rings[hw_queue]; -@@ -883,6 +954,7 @@ static void rtw_pci_tx_isr(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, - bd_idx = rtw_read32(rtwdev, bd_idx_addr); - cur_rp = bd_idx >> 16; - cur_rp &= TRX_BD_IDX_MASK; -+ rp_idx = ring->r.rp; - if (cur_rp >= ring->r.rp) - count = cur_rp - ring->r.rp; - else -@@ -906,12 +978,15 @@ static void rtw_pci_tx_isr(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, - } - - if (ring->queue_stopped && -- avail_desc(ring->r.wp, ring->r.rp, ring->r.len) > 4) { -+ avail_desc(ring->r.wp, rp_idx, ring->r.len) > 4) { - q_map = skb_get_queue_mapping(skb); - ieee80211_wake_queue(hw, q_map); - ring->queue_stopped = false; - } - -+ if (++rp_idx >= ring->r.len) -+ rp_idx = 0; -+ - skb_pull(skb, rtwdev->chip->tx_pkt_desc_sz); - - info = IEEE80211_SKB_CB(skb); -@@ -935,16 +1010,43 @@ static void rtw_pci_tx_isr(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, - ring->r.rp = cur_rp; - } - --static void rtw_pci_rx_isr(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, -- u8 hw_queue) -+static void rtw_pci_rx_isr(struct rtw_dev *rtwdev) -+{ -+ struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -+ struct napi_struct *napi = &rtwpci->napi; -+ -+ napi_schedule(napi); -+} -+ -+static int rtw_pci_get_hw_rx_ring_nr(struct rtw_dev *rtwdev, -+ struct rtw_pci *rtwpci) - { -- struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_pci_rx_ring *ring; -+ int count = 0; -+ u32 tmp, cur_wp; -+ -+ ring = &rtwpci->rx_rings[RTW_RX_QUEUE_MPDU]; -+ tmp = rtw_read32(rtwdev, RTK_PCI_RXBD_IDX_MPDUQ); -+ cur_wp = u32_get_bits(tmp, TRX_BD_HW_IDX_MASK); -+ if (cur_wp >= ring->r.wp) -+ count = cur_wp - ring->r.wp; -+ else -+ count = ring->r.len - (ring->r.wp - cur_wp); -+ -+ return count; -+} -+ -+static u32 rtw_pci_rx_napi(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, -+ u8 hw_queue, u32 limit) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct napi_struct *napi = &rtwpci->napi; -+ struct rtw_pci_rx_ring *ring = &rtwpci->rx_rings[RTW_RX_QUEUE_MPDU]; - struct rtw_rx_pkt_stat pkt_stat; - struct ieee80211_rx_status rx_status; - struct sk_buff *skb, *new; -- u32 cur_wp, cur_rp, tmp; -- u32 count; -+ u32 cur_rp = ring->r.rp; -+ u32 count, rx_done = 0; - u32 pkt_offset; - u32 pkt_desc_sz = chip->rx_pkt_desc_sz; - u32 buf_desc_sz = chip->rx_buf_desc_sz; -@@ -952,17 +1054,9 @@ static void rtw_pci_rx_isr(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, - u8 *rx_desc; - dma_addr_t dma; - -- ring = &rtwpci->rx_rings[RTW_RX_QUEUE_MPDU]; -- -- tmp = rtw_read32(rtwdev, RTK_PCI_RXBD_IDX_MPDUQ); -- cur_wp = tmp >> 16; -- cur_wp &= TRX_BD_IDX_MASK; -- if (cur_wp >= ring->r.wp) -- count = cur_wp - ring->r.wp; -- else -- count = ring->r.len - (ring->r.wp - cur_wp); -+ count = rtw_pci_get_hw_rx_ring_nr(rtwdev, rtwpci); -+ count = min(count, limit); - -- cur_rp = ring->r.rp; - while (count--) { - rtw_pci_dma_check(rtwdev, ring, cur_rp); - skb = ring->buf[cur_rp]; -@@ -995,7 +1089,8 @@ static void rtw_pci_rx_isr(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, - - rtw_rx_stats(rtwdev, pkt_stat.vif, new); - memcpy(new->cb, &rx_status, sizeof(rx_status)); -- ieee80211_rx_irqsafe(rtwdev->hw, new); -+ ieee80211_rx_napi(rtwdev->hw, NULL, new, napi); -+ rx_done++; - } - - next_rp: -@@ -1009,8 +1104,13 @@ static void rtw_pci_rx_isr(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, - } - - ring->r.rp = cur_rp; -- ring->r.wp = cur_wp; -+ /* 'rp', the last position we have read, is seen as previous posistion -+ * of 'wp' that is used to calculate 'count' next time. -+ */ -+ ring->r.wp = cur_rp; - rtw_write16(rtwdev, RTK_PCI_RXBD_IDX_MPDUQ, ring->r.rp); -+ -+ return rx_done; - } - - static void rtw_pci_irq_recognized(struct rtw_dev *rtwdev, -@@ -1060,6 +1160,7 @@ static irqreturn_t rtw_pci_interrupt_threadfn(int irq, void *dev) - struct rtw_dev *rtwdev = dev; - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; - u32 irq_status[4]; -+ bool rx = false; - - spin_lock_bh(&rtwpci->irq_lock); - rtw_pci_irq_recognized(rtwdev, rtwpci, irq_status); -@@ -1078,13 +1179,16 @@ static irqreturn_t rtw_pci_interrupt_threadfn(int irq, void *dev) - rtw_pci_tx_isr(rtwdev, rtwpci, RTW_TX_QUEUE_VI); - if (irq_status[3] & IMR_H2CDOK) - rtw_pci_tx_isr(rtwdev, rtwpci, RTW_TX_QUEUE_H2C); -- if (irq_status[0] & IMR_ROK) -- rtw_pci_rx_isr(rtwdev, rtwpci, RTW_RX_QUEUE_MPDU); -+ if (irq_status[0] & IMR_ROK) { -+ rtw_pci_rx_isr(rtwdev); -+ rx = true; -+ } - if (unlikely(irq_status[0] & IMR_C2HCMD)) - rtw_fw_c2h_cmd_isr(rtwdev); - - /* all of the jobs for this interrupt have been done */ -- rtw_pci_enable_interrupt(rtwdev, rtwpci); -+ if (rtwpci->running) -+ rtw_pci_enable_interrupt(rtwdev, rtwpci, rx); - spin_unlock_bh(&rtwpci->irq_lock); - - return IRQ_HANDLED; -@@ -1222,6 +1326,25 @@ static void rtw_pci_clkreq_set(struct rtw_dev *rtwdev, bool enable) - rtw_dbi_write8(rtwdev, RTK_PCIE_LINK_CFG, value); - } - -+static void rtw_pci_clkreq_pad_low(struct rtw_dev *rtwdev, bool enable) -+{ -+ u8 value; -+ int ret; -+ -+ ret = rtw_dbi_read8(rtwdev, RTK_PCIE_LINK_CFG, &value); -+ if (ret) { -+ rtw_err(rtwdev, "failed to read CLKREQ_L1, ret=%d", ret); -+ return; -+ } -+ -+ if (enable) -+ value &= ~BIT_CLKREQ_N_PAD; -+ else -+ value |= BIT_CLKREQ_N_PAD; -+ -+ rtw_dbi_write8(rtwdev, RTK_PCIE_LINK_CFG, value); -+} -+ - static void rtw_pci_aspm_set(struct rtw_dev *rtwdev, bool enable) - { - u8 value; -@@ -1258,13 +1381,17 @@ static void rtw_pci_link_ps(struct rtw_dev *rtwdev, bool enter) - * throughput. This is probably because the ASPM behavior slightly - * varies from different SOC. - */ -- if (rtwpci->link_ctrl & PCI_EXP_LNKCTL_ASPM_L1) -+ if (!(rtwpci->link_ctrl & PCI_EXP_LNKCTL_ASPM_L1)) -+ return; -+ -+ if ((enter && atomic_dec_if_positive(&rtwpci->link_usage) == 0) || -+ (!enter && atomic_inc_return(&rtwpci->link_usage) == 1)) - rtw_pci_aspm_set(rtwdev, enter); - } - - static void rtw_pci_link_cfg(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; - struct pci_dev *pdev = rtwpci->pdev; - u16 link_ctrl; -@@ -1306,7 +1433,7 @@ static void rtw_pci_link_cfg(struct rtw_dev *rtwdev) - - static void rtw_pci_interface_cfg(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - switch (chip->id) { - case RTW_CHIP_TYPE_8822C: -@@ -1321,12 +1448,15 @@ static void rtw_pci_interface_cfg(struct rtw_dev *rtwdev) - - static void rtw_pci_phy_cfg(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct pci_dev *pdev = rtwpci->pdev; - const struct rtw_intf_phy_para *para; - u16 cut; - u16 value; - u16 offset; - int i; -+ int ret; - - cut = BIT(0) << rtwdev->hal.cut_version; - -@@ -1359,15 +1489,38 @@ static void rtw_pci_phy_cfg(struct rtw_dev *rtwdev) - } - - rtw_pci_link_cfg(rtwdev); -+ -+ /* Disable 8821ce completion timeout by default */ -+ if (chip->id == RTW_CHIP_TYPE_8821C) { -+ ret = pcie_capability_set_word(pdev, PCI_EXP_DEVCTL2, -+ PCI_EXP_DEVCTL2_COMP_TMOUT_DIS); -+ if (ret) -+ rtw_err(rtwdev, "failed to set PCI cap, ret = %d\n", -+ ret); -+ } - } - - static int __maybe_unused rtw_pci_suspend(struct device *dev) - { -+ struct ieee80211_hw *hw = dev_get_drvdata(dev); -+ struct rtw_dev *rtwdev = hw->priv; -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_efuse *efuse = &rtwdev->efuse; -+ -+ if (chip->id == RTW_CHIP_TYPE_8822C && efuse->rfe_option == 6) -+ rtw_pci_clkreq_pad_low(rtwdev, true); - return 0; - } - - static int __maybe_unused rtw_pci_resume(struct device *dev) - { -+ struct ieee80211_hw *hw = dev_get_drvdata(dev); -+ struct rtw_dev *rtwdev = hw->priv; -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_efuse *efuse = &rtwdev->efuse; -+ -+ if (chip->id == RTW_CHIP_TYPE_8822C && efuse->rfe_option == 6) -+ rtw_pci_clkreq_pad_low(rtwdev, false); - return 0; - } - -@@ -1393,7 +1546,6 @@ static int rtw_pci_claim(struct rtw_dev *rtwdev, struct pci_dev *pdev) - - static void rtw_pci_declaim(struct rtw_dev *rtwdev, struct pci_dev *pdev) - { -- pci_clear_master(pdev); - pci_disable_device(pdev); - } - -@@ -1436,6 +1588,7 @@ static void rtw_pci_destroy(struct rtw_dev *rtwdev, struct pci_dev *pdev) - static struct rtw_hci_ops rtw_pci_ops = { - .tx_write = rtw_pci_tx_write, - .tx_kick_off = rtw_pci_tx_kick_off, -+ .flush_queues = rtw_pci_flush_queues, - .setup = rtw_pci_setup, - .start = rtw_pci_start, - .stop = rtw_pci_stop, -@@ -1485,11 +1638,73 @@ static void rtw_pci_free_irq(struct rtw_dev *rtwdev, struct pci_dev *pdev) - pci_free_irq_vectors(pdev); - } - -+static int rtw_pci_napi_poll(struct napi_struct *napi, int budget) -+{ -+ struct rtw_pci *rtwpci = container_of(napi, struct rtw_pci, napi); -+ struct rtw_dev *rtwdev = container_of((void *)rtwpci, struct rtw_dev, -+ priv); -+ int work_done = 0; -+ -+ if (rtwpci->rx_no_aspm) -+ rtw_pci_link_ps(rtwdev, false); -+ -+ while (work_done < budget) { -+ u32 work_done_once; -+ -+ work_done_once = rtw_pci_rx_napi(rtwdev, rtwpci, RTW_RX_QUEUE_MPDU, -+ budget - work_done); -+ if (work_done_once == 0) -+ break; -+ work_done += work_done_once; -+ } -+ if (work_done < budget) { -+ napi_complete_done(napi, work_done); -+ spin_lock_bh(&rtwpci->irq_lock); -+ if (rtwpci->running) -+ rtw_pci_enable_interrupt(rtwdev, rtwpci, false); -+ spin_unlock_bh(&rtwpci->irq_lock); -+ /* When ISR happens during polling and before napi_complete -+ * while no further data is received. Data on the dma_ring will -+ * not be processed immediately. Check whether dma ring is -+ * empty and perform napi_schedule accordingly. -+ */ -+ if (rtw_pci_get_hw_rx_ring_nr(rtwdev, rtwpci)) -+ napi_schedule(napi); -+ } -+ if (rtwpci->rx_no_aspm) -+ rtw_pci_link_ps(rtwdev, true); -+ -+ return work_done; -+} -+ -+static void rtw_pci_napi_init(struct rtw_dev *rtwdev) -+{ -+ struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -+ -+ init_dummy_netdev(&rtwpci->netdev); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 1, 0) -+ netif_napi_add(&rtwpci->netdev, &rtwpci->napi, rtw_pci_napi_poll); -+#else -+ netif_napi_add(&rtwpci->netdev, &rtwpci->napi, rtw_pci_napi_poll, -+ NAPI_POLL_WEIGHT); -+#endif -+} -+ -+static void rtw_pci_napi_deinit(struct rtw_dev *rtwdev) -+{ -+ struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; -+ -+ rtw_pci_napi_stop(rtwdev); -+ netif_napi_del(&rtwpci->napi); -+} -+ - int rtw_pci_probe(struct pci_dev *pdev, - const struct pci_device_id *id) - { -+ struct pci_dev *bridge = pci_upstream_bridge(pdev); - struct ieee80211_hw *hw; - struct rtw_dev *rtwdev; -+ struct rtw_pci *rtwpci; - int drv_data_size; - int ret; - -@@ -1507,6 +1722,9 @@ int rtw_pci_probe(struct pci_dev *pdev, - rtwdev->hci.ops = &rtw_pci_ops; - rtwdev->hci.type = RTW_HCI_TYPE_PCIE; - -+ rtwpci = (struct rtw_pci *)rtwdev->priv; -+ atomic_set(&rtwpci->link_usage, 1); -+ - ret = rtw_core_init(rtwdev); - if (ret) - goto err_release_hw; -@@ -1527,12 +1745,18 @@ int rtw_pci_probe(struct pci_dev *pdev, - goto err_pci_declaim; - } - -+ rtw_pci_napi_init(rtwdev); -+ - ret = rtw_chip_info_setup(rtwdev); - if (ret) { - rtw_err(rtwdev, "failed to setup chip information\n"); - goto err_destroy_pci; - } - -+ /* Disable PCIe ASPM L1 while doing NAPI poll for 8821CE */ -+ if (rtwdev->chip->id == RTW_CHIP_TYPE_8821C && bridge->vendor == PCI_VENDOR_ID_INTEL) -+ rtwpci->rx_no_aspm = true; -+ - rtw_pci_phy_cfg(rtwdev); - - ret = rtw_register_hw(rtwdev, hw); -@@ -1550,6 +1774,7 @@ int rtw_pci_probe(struct pci_dev *pdev, - return 0; - - err_destroy_pci: -+ rtw_pci_napi_deinit(rtwdev); - rtw_pci_destroy(rtwdev, pdev); - - err_pci_declaim: -@@ -1579,6 +1804,7 @@ void rtw_pci_remove(struct pci_dev *pdev) - - rtw_unregister_hw(rtwdev, hw); - rtw_pci_disable_interrupt(rtwdev, rtwpci); -+ rtw_pci_napi_deinit(rtwdev); - rtw_pci_destroy(rtwdev, pdev); - rtw_pci_declaim(rtwdev, pdev); - rtw_pci_free_irq(rtwdev, pdev); -@@ -1591,7 +1817,7 @@ void rtw_pci_shutdown(struct pci_dev *pdev) - { - struct ieee80211_hw *hw = pci_get_drvdata(pdev); - struct rtw_dev *rtwdev; -- struct rtw_chip_info *chip; -+ const struct rtw_chip_info *chip; - - if (!hw) - return; -diff --git a/drivers/net/wireless/realtek/rtw88/pci.h b/drivers/net/wireless/realtek/rtw88/pci.h -index ca17aa9cf..0c37efd8c 100644 ---- a/drivers/net/wireless/realtek/rtw88/pci.h -+++ b/drivers/net/wireless/realtek/rtw88/pci.h -@@ -5,6 +5,8 @@ - #ifndef __RTK_PCI_H_ - #define __RTK_PCI_H_ - -+#include "main.h" -+ - #define RTK_DEFAULT_TX_DESC_NUM 128 - #define RTK_BEQ_TX_DESC_NUM 256 - -@@ -35,6 +37,7 @@ - #define RTK_PCIE_LINK_CFG 0x0719 - #define BIT_CLKREQ_SW_EN BIT(4) - #define BIT_L1_SW_EN BIT(3) -+#define BIT_CLKREQ_N_PAD BIT(0) - #define RTK_PCIE_CLKDLY_CTRL 0x0725 - - #define BIT_PCI_BCNQ_FLAG BIT(4) -@@ -49,6 +52,7 @@ - #define RTK_PCI_RXBD_DESA_MPDUQ 0x338 - - #define TRX_BD_IDX_MASK GENMASK(11, 0) -+#define TRX_BD_HW_IDX_MASK GENMASK(27, 16) - - /* BCNQ is specialized for rsvd page, does not need to specify a number */ - #define RTK_PCI_TXBD_NUM_H2CQ 0x1328 -@@ -140,6 +144,12 @@ - /* IMR 3 */ - #define IMR_H2CDOK BIT(16) - -+enum rtw_pci_flags { -+ RTW_PCI_FLAG_NAPI_RUNNING, -+ -+ NUM_OF_RTW_PCI_FLAGS, -+}; -+ - /* one element is reserved to know if the ring is closed */ - static inline int avail_desc(u32 wp, u32 rp, u32 len) - { -@@ -198,20 +208,34 @@ struct rtw_pci { - - /* Used for PCI interrupt. */ - spinlock_t hwirq_lock; -- /* Used for PCI TX queueing. */ -+ /* Used for PCI TX ring/queueing, and enable INT. */ - spinlock_t irq_lock; - u32 irq_mask[4]; - bool irq_enabled; -+ bool running; -+ -+ /* napi structure */ -+ struct net_device netdev; -+ struct napi_struct napi; - - u16 rx_tag; - DECLARE_BITMAP(tx_queued, RTK_MAX_TX_QUEUE_NUM); - struct rtw_pci_tx_ring tx_rings[RTK_MAX_TX_QUEUE_NUM]; - struct rtw_pci_rx_ring rx_rings[RTK_MAX_RX_QUEUE_NUM]; - u16 link_ctrl; -+ atomic_t link_usage; -+ bool rx_no_aspm; -+ DECLARE_BITMAP(flags, NUM_OF_RTW_PCI_FLAGS); - - void __iomem *mmap; - }; - -+extern const struct dev_pm_ops rtw_pm_ops; -+ -+int rtw_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id); -+void rtw_pci_remove(struct pci_dev *pdev); -+void rtw_pci_shutdown(struct pci_dev *pdev); -+ - static inline u32 max_num_of_tx_queue(u8 queue) - { - u32 max_num; -diff --git a/drivers/net/wireless/realtek/rtw88/phy.c b/drivers/net/wireless/realtek/rtw88/phy.c -index af8b703d1..57534625c 100644 ---- a/drivers/net/wireless/realtek/rtw88/phy.c -+++ b/drivers/net/wireless/realtek/rtw88/phy.c -@@ -9,6 +9,10 @@ - #include "fw.h" - #include "phy.h" - #include "debug.h" -+#include "regd.h" -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) -+#include "sar.h" -+#endif - - struct phy_cfg_pair { - u32 addr; -@@ -119,9 +123,85 @@ static void rtw_phy_cck_pd_init(struct rtw_dev *rtwdev) - dm_info->cck_fa_avg = CCK_FA_AVG_RESET; - } - -+void rtw_phy_set_edcca_th(struct rtw_dev *rtwdev, u8 l2h, u8 h2l) -+{ -+ struct rtw_hw_reg_offset *edcca_th = rtwdev->chip->edcca_th; -+ -+ rtw_write32_mask(rtwdev, -+ edcca_th[EDCCA_TH_L2H_IDX].hw_reg.addr, -+ edcca_th[EDCCA_TH_L2H_IDX].hw_reg.mask, -+ l2h + edcca_th[EDCCA_TH_L2H_IDX].offset); -+ rtw_write32_mask(rtwdev, -+ edcca_th[EDCCA_TH_H2L_IDX].hw_reg.addr, -+ edcca_th[EDCCA_TH_H2L_IDX].hw_reg.mask, -+ h2l + edcca_th[EDCCA_TH_H2L_IDX].offset); -+} -+EXPORT_SYMBOL(rtw_phy_set_edcca_th); -+ -+void rtw_phy_adaptivity_set_mode(struct rtw_dev *rtwdev) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ -+ /* turn off in debugfs for debug usage */ -+ if (!rtw_edcca_enabled) { -+ dm_info->edcca_mode = RTW_EDCCA_NORMAL; -+ rtw_dbg(rtwdev, RTW_DBG_PHY, "EDCCA disabled, cannot be set\n"); -+ return; -+ } -+ -+ switch (rtwdev->regd.dfs_region) { -+ case NL80211_DFS_ETSI: -+ dm_info->edcca_mode = RTW_EDCCA_ADAPTIVITY; -+ dm_info->l2h_th_ini = chip->l2h_th_ini_ad; -+ break; -+ case NL80211_DFS_JP: -+ dm_info->edcca_mode = RTW_EDCCA_ADAPTIVITY; -+ dm_info->l2h_th_ini = chip->l2h_th_ini_cs; -+ break; -+ default: -+ dm_info->edcca_mode = RTW_EDCCA_NORMAL; -+ break; -+ } -+} -+ -+static void rtw_phy_adaptivity_init(struct rtw_dev *rtwdev) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ -+ rtw_phy_adaptivity_set_mode(rtwdev); -+ if (chip->ops->adaptivity_init) -+ chip->ops->adaptivity_init(rtwdev); -+} -+ -+static void rtw_phy_adaptivity(struct rtw_dev *rtwdev) -+{ -+ if (rtwdev->chip->ops->adaptivity) -+ rtwdev->chip->ops->adaptivity(rtwdev); -+} -+ -+static void rtw_phy_cfo_init(struct rtw_dev *rtwdev) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ -+ if (chip->ops->cfo_init) -+ chip->ops->cfo_init(rtwdev); -+} -+ -+static void rtw_phy_tx_path_div_init(struct rtw_dev *rtwdev) -+{ -+ struct rtw_path_div *path_div = &rtwdev->dm_path_div; -+ -+ path_div->current_tx_path = rtwdev->chip->default_1ss_tx_path; -+ path_div->path_a_cnt = 0; -+ path_div->path_a_sum = 0; -+ path_div->path_b_cnt = 0; -+ path_div->path_b_sum = 0; -+} -+ - void rtw_phy_init(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_dm_info *dm_info = &rtwdev->dm_info; - u32 addr, mask; - -@@ -140,12 +220,15 @@ void rtw_phy_init(struct rtw_dev *rtwdev) - rtw_phy_cck_pd_init(rtwdev); - - dm_info->iqk.done = false; -+ rtw_phy_adaptivity_init(rtwdev); -+ rtw_phy_cfo_init(rtwdev); -+ rtw_phy_tx_path_div_init(rtwdev); - } - EXPORT_SYMBOL(rtw_phy_init); - - void rtw_phy_dig_write(struct rtw_dev *rtwdev, u8 igi) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_hal *hal = &rtwdev->hal; - u32 addr, mask; - u8 path; -@@ -164,7 +247,7 @@ void rtw_phy_dig_write(struct rtw_dev *rtwdev, u8 igi) - - static void rtw_phy_stat_false_alarm(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - chip->ops->false_alarm_statistics(rtwdev); - } -@@ -219,7 +302,7 @@ static void rtw_phy_stat_rssi(struct rtw_dev *rtwdev) - - data.rtwdev = rtwdev; - data.min_rssi = U8_MAX; -- rtw_iterate_stas_atomic(rtwdev, rtw_phy_stat_rssi_iter, &data); -+ rtw_iterate_stas(rtwdev, rtw_phy_stat_rssi_iter, &data); - - dm_info->pre_min_rssi = dm_info->min_rssi; - dm_info->min_rssi = data.min_rssi; -@@ -316,7 +399,8 @@ rtw_phy_dig_check_damping(struct rtw_dm_info *dm_info) - return damping; - } - --static void rtw_phy_dig_get_boundary(struct rtw_dm_info *dm_info, -+static void rtw_phy_dig_get_boundary(struct rtw_dev *rtwdev, -+ struct rtw_dm_info *dm_info, - u8 *upper, u8 *lower, bool linked) - { - u8 dig_max, dig_min, dig_mid; -@@ -325,8 +409,7 @@ static void rtw_phy_dig_get_boundary(struct rtw_dm_info *dm_info, - if (linked) { - dig_max = DIG_PERF_MAX; - dig_mid = DIG_PERF_MID; -- /* 22B=0x1c, 22C=0x20 */ -- dig_min = 0x1c; -+ dig_min = rtwdev->chip->dig_min; - min_rssi = max_t(u8, dm_info->min_rssi, dig_min); - } else { - dig_max = DIG_CVRG_MAX; -@@ -437,7 +520,8 @@ static void rtw_phy_dig(struct rtw_dev *rtwdev) - * the peers connected with us, meanwhile make sure the igi value does - * not beyond the hardware limitation - */ -- rtw_phy_dig_get_boundary(dm_info, &upper_bound, &lower_bound, linked); -+ rtw_phy_dig_get_boundary(rtwdev, dm_info, &upper_bound, &lower_bound, -+ linked); - cur_igi = clamp_t(u8, cur_igi, lower_bound, upper_bound); - - /* record current igi value and false alarm statistics for further -@@ -454,7 +538,7 @@ static void rtw_phy_ra_info_update_iter(void *data, struct ieee80211_sta *sta) - struct rtw_dev *rtwdev = data; - struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; - -- rtw_update_sta_info(rtwdev, si); -+ rtw_update_sta_info(rtwdev, si, false); - } - - static void rtw_phy_ra_info_update(struct rtw_dev *rtwdev) -@@ -462,17 +546,127 @@ static void rtw_phy_ra_info_update(struct rtw_dev *rtwdev) - if (rtwdev->watch_dog_cnt & 0x3) - return; - -- rtw_iterate_stas_atomic(rtwdev, rtw_phy_ra_info_update_iter, rtwdev); -+ rtw_iterate_stas(rtwdev, rtw_phy_ra_info_update_iter, rtwdev); -+} -+ -+static u32 rtw_phy_get_rrsr_mask(struct rtw_dev *rtwdev, u8 rate_idx) -+{ -+ u8 rate_order; -+ -+ rate_order = rate_idx; -+ -+ if (rate_idx >= DESC_RATEVHT4SS_MCS0) -+ rate_order -= DESC_RATEVHT4SS_MCS0; -+ else if (rate_idx >= DESC_RATEVHT3SS_MCS0) -+ rate_order -= DESC_RATEVHT3SS_MCS0; -+ else if (rate_idx >= DESC_RATEVHT2SS_MCS0) -+ rate_order -= DESC_RATEVHT2SS_MCS0; -+ else if (rate_idx >= DESC_RATEVHT1SS_MCS0) -+ rate_order -= DESC_RATEVHT1SS_MCS0; -+ else if (rate_idx >= DESC_RATEMCS24) -+ rate_order -= DESC_RATEMCS24; -+ else if (rate_idx >= DESC_RATEMCS16) -+ rate_order -= DESC_RATEMCS16; -+ else if (rate_idx >= DESC_RATEMCS8) -+ rate_order -= DESC_RATEMCS8; -+ else if (rate_idx >= DESC_RATEMCS0) -+ rate_order -= DESC_RATEMCS0; -+ else if (rate_idx >= DESC_RATE6M) -+ rate_order -= DESC_RATE6M; -+ else -+ rate_order -= DESC_RATE1M; -+ -+ if (rate_idx >= DESC_RATEMCS0 || rate_order == 0) -+ rate_order++; -+ -+ return GENMASK(rate_order + RRSR_RATE_ORDER_CCK_LEN - 1, 0); -+} -+ -+static void rtw_phy_rrsr_mask_min_iter(void *data, struct ieee80211_sta *sta) -+{ -+ struct rtw_dev *rtwdev = (struct rtw_dev *)data; -+ struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ u32 mask = 0; -+ -+ mask = rtw_phy_get_rrsr_mask(rtwdev, si->ra_report.desc_rate); -+ if (mask < dm_info->rrsr_mask_min) -+ dm_info->rrsr_mask_min = mask; -+} -+ -+static void rtw_phy_rrsr_update(struct rtw_dev *rtwdev) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ -+ dm_info->rrsr_mask_min = RRSR_RATE_ORDER_MAX; -+ rtw_iterate_stas(rtwdev, rtw_phy_rrsr_mask_min_iter, rtwdev); -+ rtw_write32(rtwdev, REG_RRSR, dm_info->rrsr_val_init & dm_info->rrsr_mask_min); - } - - static void rtw_phy_dpk_track(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - - if (chip->ops->dpk_track) - chip->ops->dpk_track(rtwdev); - } - -+struct rtw_rx_addr_match_data { -+ struct rtw_dev *rtwdev; -+ struct ieee80211_hdr *hdr; -+ struct rtw_rx_pkt_stat *pkt_stat; -+ u8 *bssid; -+}; -+ -+static void rtw_phy_parsing_cfo_iter(void *data, u8 *mac, -+ struct ieee80211_vif *vif) -+{ -+ struct rtw_rx_addr_match_data *iter_data = data; -+ struct rtw_dev *rtwdev = iter_data->rtwdev; -+ struct rtw_rx_pkt_stat *pkt_stat = iter_data->pkt_stat; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ struct rtw_cfo_track *cfo = &dm_info->cfo_track; -+ u8 *bssid = iter_data->bssid; -+ u8 i; -+ -+ if (!ether_addr_equal(vif->bss_conf.bssid, bssid)) -+ return; -+ -+ for (i = 0; i < rtwdev->hal.rf_path_num; i++) { -+ cfo->cfo_tail[i] += pkt_stat->cfo_tail[i]; -+ cfo->cfo_cnt[i]++; -+ } -+ -+ cfo->packet_count++; -+} -+ -+void rtw_phy_parsing_cfo(struct rtw_dev *rtwdev, -+ struct rtw_rx_pkt_stat *pkt_stat) -+{ -+ struct ieee80211_hdr *hdr = pkt_stat->hdr; -+ struct rtw_rx_addr_match_data data = {}; -+ -+ if (pkt_stat->crc_err || pkt_stat->icv_err || !pkt_stat->phy_status || -+ ieee80211_is_ctl(hdr->frame_control)) -+ return; -+ -+ data.rtwdev = rtwdev; -+ data.hdr = hdr; -+ data.pkt_stat = pkt_stat; -+ data.bssid = get_hdr_bssid(hdr); -+ -+ rtw_iterate_vifs_atomic(rtwdev, rtw_phy_parsing_cfo_iter, &data); -+} -+EXPORT_SYMBOL(rtw_phy_parsing_cfo); -+ -+static void rtw_phy_cfo_track(struct rtw_dev *rtwdev) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ -+ if (chip->ops->cfo_track) -+ chip->ops->cfo_track(rtwdev); -+} -+ - #define CCK_PD_FA_LV1_MIN 1000 - #define CCK_PD_FA_LV0_MAX 500 - -@@ -528,8 +722,8 @@ static u8 rtw_phy_cck_pd_lv(struct rtw_dev *rtwdev) - - static void rtw_phy_cck_pd(struct rtw_dev *rtwdev) - { -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_dm_info *dm_info = &rtwdev->dm_info; -- struct rtw_chip_info *chip = rtwdev->chip; - u32 cck_fa = dm_info->cck_fa_cnt; - u8 level; - -@@ -541,6 +735,12 @@ static void rtw_phy_cck_pd(struct rtw_dev *rtwdev) - else - dm_info->cck_fa_avg = (dm_info->cck_fa_avg * 3 + cck_fa) >> 2; - -+ rtw_dbg(rtwdev, RTW_DBG_PHY, "IGI=0x%x, rssi_min=%d, cck_fa=%d\n", -+ dm_info->igi_history[0], dm_info->min_rssi, -+ dm_info->fa_history[0]); -+ rtw_dbg(rtwdev, RTW_DBG_PHY, "cck_fa_avg=%d, cck_pd_default=%d\n", -+ dm_info->cck_fa_avg, dm_info->cck_pd_default); -+ - level = rtw_phy_cck_pd_lv(rtwdev); - - if (level >= CCK_PD_LV_MAX) -@@ -555,15 +755,29 @@ static void rtw_phy_pwr_track(struct rtw_dev *rtwdev) - rtwdev->chip->ops->pwr_track(rtwdev); - } - -+static void rtw_phy_ra_track(struct rtw_dev *rtwdev) -+{ -+ rtw_fw_update_wl_phy_info(rtwdev); -+ rtw_phy_ra_info_update(rtwdev); -+ rtw_phy_rrsr_update(rtwdev); -+} -+ - void rtw_phy_dynamic_mechanism(struct rtw_dev *rtwdev) - { - /* for further calculation */ - rtw_phy_statistics(rtwdev); - rtw_phy_dig(rtwdev); - rtw_phy_cck_pd(rtwdev); -- rtw_phy_ra_info_update(rtwdev); -+ rtw_phy_ra_track(rtwdev); -+ rtw_phy_tx_path_diversity(rtwdev); -+ rtw_phy_cfo_track(rtwdev); - rtw_phy_dpk_track(rtwdev); - rtw_phy_pwr_track(rtwdev); -+ -+ if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_ADAPTIVITY)) -+ rtw_fw_adaptivity(rtwdev); -+ else -+ rtw_phy_adaptivity(rtwdev); - } - - #define FRAC_BITS 3 -@@ -604,23 +818,18 @@ static u8 rtw_phy_linear_2_db(u64 linear) - u8 j; - u32 dB; - -- if (linear >= db_invert_table[11][7]) -- return 96; /* maximum 96 dB */ -- - for (i = 0; i < 12; i++) { -- if (i <= 2 && (linear << FRAC_BITS) <= db_invert_table[i][7]) -- break; -- else if (i > 2 && linear <= db_invert_table[i][7]) -- break; -+ for (j = 0; j < 8; j++) { -+ if (i <= 2 && (linear << FRAC_BITS) <= db_invert_table[i][j]) -+ goto cnt; -+ else if (i > 2 && linear <= db_invert_table[i][j]) -+ goto cnt; -+ } - } - -- for (j = 0; j < 8; j++) { -- if (i <= 2 && (linear << FRAC_BITS) <= db_invert_table[i][j]) -- break; -- else if (i > 2 && linear <= db_invert_table[i][j]) -- break; -- } -+ return 96; /* maximum 96 dB */ - -+cnt: - if (j == 0 && i == 0) - goto end; - -@@ -688,7 +897,7 @@ u32 rtw_phy_read_rf(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, - u32 addr, u32 mask) - { - struct rtw_hal *hal = &rtwdev->hal; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - const u32 *base_addr = chip->rf_base_addr; - u32 val, direct_addr; - -@@ -711,7 +920,7 @@ u32 rtw_phy_read_rf_sipi(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, - u32 addr, u32 mask) - { - struct rtw_hal *hal = &rtwdev->hal; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - const struct rtw_rf_sipi_addr *rf_sipi_addr; - const struct rtw_rf_sipi_addr *rf_sipi_addr_a; - u32 val32; -@@ -760,8 +969,8 @@ bool rtw_phy_write_rf_reg_sipi(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, - u32 addr, u32 mask, u32 data) - { - struct rtw_hal *hal = &rtwdev->hal; -- struct rtw_chip_info *chip = rtwdev->chip; -- u32 *sipi_addr = chip->rf_sipi_addr; -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ const u32 *sipi_addr = chip->rf_sipi_addr; - u32 data_and_addr; - u32 old_data = 0; - u32 shift; -@@ -800,7 +1009,7 @@ bool rtw_phy_write_rf_reg(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, - u32 addr, u32 mask, u32 data) - { - struct rtw_hal *hal = &rtwdev->hal; -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - const u32 *base_addr = chip->rf_base_addr; - u32 direct_addr; - -@@ -1417,17 +1626,70 @@ static void rtw_xref_txpwr_lmt(struct rtw_dev *rtwdev) - rtw_xref_txpwr_lmt_by_bw(rtwdev, regd); - } - -+static void -+__cfg_txpwr_lmt_by_alt(struct rtw_hal *hal, u8 regd, u8 regd_alt, u8 bw, u8 rs) -+{ -+ u8 ch; -+ -+ for (ch = 0; ch < RTW_MAX_CHANNEL_NUM_2G; ch++) -+ hal->tx_pwr_limit_2g[regd][bw][rs][ch] = -+ hal->tx_pwr_limit_2g[regd_alt][bw][rs][ch]; -+ -+ for (ch = 0; ch < RTW_MAX_CHANNEL_NUM_5G; ch++) -+ hal->tx_pwr_limit_5g[regd][bw][rs][ch] = -+ hal->tx_pwr_limit_5g[regd_alt][bw][rs][ch]; -+} -+ -+static void -+rtw_cfg_txpwr_lmt_by_alt(struct rtw_dev *rtwdev, u8 regd, u8 regd_alt) -+{ -+ u8 bw, rs; -+ -+ for (bw = 0; bw < RTW_CHANNEL_WIDTH_MAX; bw++) -+ for (rs = 0; rs < RTW_RATE_SECTION_MAX; rs++) -+ __cfg_txpwr_lmt_by_alt(&rtwdev->hal, regd, regd_alt, -+ bw, rs); -+} -+ - void rtw_parse_tbl_txpwr_lmt(struct rtw_dev *rtwdev, - const struct rtw_table *tbl) - { - const struct rtw_txpwr_lmt_cfg_pair *p = tbl->data; - const struct rtw_txpwr_lmt_cfg_pair *end = p + tbl->size; -+ u32 regd_cfg_flag = 0; -+ u8 regd_alt; -+ u8 i; - - for (; p < end; p++) { -+ regd_cfg_flag |= BIT(p->regd); - rtw_phy_set_tx_power_limit(rtwdev, p->regd, p->band, - p->bw, p->rs, p->ch, p->txpwr_lmt); - } - -+ for (i = 0; i < RTW_REGD_MAX; i++) { -+ if (i == RTW_REGD_WW) -+ continue; -+ -+ if (regd_cfg_flag & BIT(i)) -+ continue; -+ -+ rtw_dbg(rtwdev, RTW_DBG_REGD, -+ "txpwr regd %d does not be configured\n", i); -+ -+ if (rtw_regd_has_alt(i, ®d_alt) && -+ regd_cfg_flag & BIT(regd_alt)) { -+ rtw_dbg(rtwdev, RTW_DBG_REGD, -+ "cfg txpwr regd %d by regd %d as alternative\n", -+ i, regd_alt); -+ -+ rtw_cfg_txpwr_lmt_by_alt(rtwdev, i, regd_alt); -+ continue; -+ } -+ -+ rtw_dbg(rtwdev, RTW_DBG_REGD, "cfg txpwr regd %d by WW\n", i); -+ rtw_cfg_txpwr_lmt_by_alt(rtwdev, i, RTW_REGD_WW); -+ } -+ - rtw_xref_txpwr_lmt(rtwdev); - } - EXPORT_SYMBOL(rtw_parse_tbl_txpwr_lmt); -@@ -1482,7 +1744,7 @@ EXPORT_SYMBOL(rtw_phy_cfg_rf); - - static void rtw_load_rfk_table(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; - - if (!chip->rfk_init_tbl) -@@ -1501,7 +1763,7 @@ static void rtw_load_rfk_table(struct rtw_dev *rtwdev) - - void rtw_phy_load_tables(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - u8 rf_path; - - rtw_load_table(rtwdev, chip->mac_tbl); -@@ -1610,7 +1872,7 @@ static u8 rtw_get_channel_group(u8 channel, u8 rate) - - static s8 rtw_phy_get_dis_dpd_by_rate_diff(struct rtw_dev *rtwdev, u16 rate) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - s8 dpd_diff = 0; - - if (!chip->en_dis_dpd) -@@ -1644,7 +1906,7 @@ static u8 rtw_phy_get_2g_tx_power_index(struct rtw_dev *rtwdev, - enum rtw_bandwidth bandwidth, - u8 rate, u8 group) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - u8 tx_power; - bool mcs_rate; - bool above_2ss; -@@ -1691,7 +1953,7 @@ static u8 rtw_phy_get_5g_tx_power_index(struct rtw_dev *rtwdev, - enum rtw_bandwidth bandwidth, - u8 rate, u8 group) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - u8 tx_power; - u8 upper, lower; - bool mcs_rate; -@@ -1740,6 +2002,25 @@ static u8 rtw_phy_get_5g_tx_power_index(struct rtw_dev *rtwdev, - return tx_power; - } - -+/* return RTW_RATE_SECTION_MAX to indicate rate is invalid */ -+static u8 rtw_phy_rate_to_rate_section(u8 rate) -+{ -+ if (rate >= DESC_RATE1M && rate <= DESC_RATE11M) -+ return RTW_RATE_SECTION_CCK; -+ else if (rate >= DESC_RATE6M && rate <= DESC_RATE54M) -+ return RTW_RATE_SECTION_OFDM; -+ else if (rate >= DESC_RATEMCS0 && rate <= DESC_RATEMCS7) -+ return RTW_RATE_SECTION_HT_1S; -+ else if (rate >= DESC_RATEMCS8 && rate <= DESC_RATEMCS15) -+ return RTW_RATE_SECTION_HT_2S; -+ else if (rate >= DESC_RATEVHT1SS_MCS0 && rate <= DESC_RATEVHT1SS_MCS9) -+ return RTW_RATE_SECTION_VHT_1S; -+ else if (rate >= DESC_RATEVHT2SS_MCS0 && rate <= DESC_RATEVHT2SS_MCS9) -+ return RTW_RATE_SECTION_VHT_2S; -+ else -+ return RTW_RATE_SECTION_MAX; -+} -+ - static s8 rtw_phy_get_tx_power_limit(struct rtw_dev *rtwdev, u8 band, - enum rtw_bandwidth bw, u8 rf_path, - u8 rate, u8 channel, u8 regd) -@@ -1747,7 +2028,7 @@ static s8 rtw_phy_get_tx_power_limit(struct rtw_dev *rtwdev, u8 band, - struct rtw_hal *hal = &rtwdev->hal; - u8 *cch_by_bw = hal->cch_by_bw; - s8 power_limit = (s8)rtwdev->chip->max_power_index; -- u8 rs; -+ u8 rs = rtw_phy_rate_to_rate_section(rate); - int ch_idx; - u8 cur_bw, cur_ch; - s8 cur_lmt; -@@ -1755,19 +2036,7 @@ static s8 rtw_phy_get_tx_power_limit(struct rtw_dev *rtwdev, u8 band, - if (regd > RTW_REGD_WW) - return power_limit; - -- if (rate >= DESC_RATE1M && rate <= DESC_RATE11M) -- rs = RTW_RATE_SECTION_CCK; -- else if (rate >= DESC_RATE6M && rate <= DESC_RATE54M) -- rs = RTW_RATE_SECTION_OFDM; -- else if (rate >= DESC_RATEMCS0 && rate <= DESC_RATEMCS7) -- rs = RTW_RATE_SECTION_HT_1S; -- else if (rate >= DESC_RATEMCS8 && rate <= DESC_RATEMCS15) -- rs = RTW_RATE_SECTION_HT_2S; -- else if (rate >= DESC_RATEVHT1SS_MCS0 && rate <= DESC_RATEVHT1SS_MCS9) -- rs = RTW_RATE_SECTION_VHT_1S; -- else if (rate >= DESC_RATEVHT2SS_MCS0 && rate <= DESC_RATEVHT2SS_MCS9) -- rs = RTW_RATE_SECTION_VHT_2S; -- else -+ if (rs == RTW_RATE_SECTION_MAX) - goto err; - - /* only 20M BW with cck and ofdm */ -@@ -1801,6 +2070,29 @@ static s8 rtw_phy_get_tx_power_limit(struct rtw_dev *rtwdev, u8 band, - return (s8)rtwdev->chip->max_power_index; - } - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) -+static s8 rtw_phy_get_tx_power_sar(struct rtw_dev *rtwdev, u8 sar_band, -+ u8 rf_path, u8 rate) -+{ -+ u8 rs = rtw_phy_rate_to_rate_section(rate); -+ struct rtw_sar_arg arg = { -+ .sar_band = sar_band, -+ .path = rf_path, -+ .rs = rs, -+ }; -+ -+ if (rs == RTW_RATE_SECTION_MAX) -+ goto err; -+ -+ return rtw_query_sar(rtwdev, &arg); -+ -+err: -+ WARN(1, "invalid arguments, sar_band=%d, path=%d, rate=%d\n", -+ sar_band, rf_path, rate); -+ return (s8)rtwdev->chip->max_power_index; -+} -+#endif -+ - void rtw_get_tx_power_params(struct rtw_dev *rtwdev, u8 path, u8 rate, u8 bw, - u8 ch, u8 regd, struct rtw_power_params *pwr_param) - { -@@ -1812,6 +2104,9 @@ void rtw_get_tx_power_params(struct rtw_dev *rtwdev, u8 path, u8 rate, u8 bw, - s8 *offset = &pwr_param->pwr_offset; - s8 *limit = &pwr_param->pwr_limit; - s8 *remnant = &pwr_param->pwr_remnant; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) -+ s8 *sar = &pwr_param->pwr_sar; -+#endif - - pwr_idx = &rtwdev->efuse.txpwr_idx_table[path]; - group = rtw_get_channel_group(ch, rate); -@@ -1835,6 +2130,9 @@ void rtw_get_tx_power_params(struct rtw_dev *rtwdev, u8 path, u8 rate, u8 bw, - rate, ch, regd); - *remnant = (rate <= DESC_RATE11M ? dm_info->txagc_remnant_cck : - dm_info->txagc_remnant_ofdm); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) -+ *sar = rtw_phy_get_tx_power_sar(rtwdev, hal->sar_band, path, rate); -+#endif - } - - u8 -@@ -1849,7 +2147,9 @@ rtw_phy_get_tx_power_index(struct rtw_dev *rtwdev, u8 rf_path, u8 rate, - channel, regd, &pwr_param); - - tx_power = pwr_param.pwr_base; -- offset = min_t(s8, pwr_param.pwr_offset, pwr_param.pwr_limit); -+ offset = min3(pwr_param.pwr_offset, -+ pwr_param.pwr_limit, -+ pwr_param.pwr_sar); - - if (rtwdev->chip->en_dis_dpd) - offset += rtw_phy_get_dis_dpd_by_rate_diff(rtwdev, rate); -@@ -1867,7 +2167,7 @@ static void rtw_phy_set_tx_power_index_by_rs(struct rtw_dev *rtwdev, - u8 ch, u8 path, u8 rs) - { - struct rtw_hal *hal = &rtwdev->hal; -- u8 regd = rtwdev->regd.txpwr_regd; -+ u8 regd = rtw_regd_get(rtwdev); - u8 *rates; - u8 size; - u8 rate; -@@ -1912,7 +2212,7 @@ static void rtw_phy_set_tx_power_level_by_path(struct rtw_dev *rtwdev, - - void rtw_phy_set_tx_power_level(struct rtw_dev *rtwdev, u8 channel) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_hal *hal = &rtwdev->hal; - u8 path; - -@@ -2181,3 +2481,71 @@ bool rtw_phy_pwrtrack_need_iqk(struct rtw_dev *rtwdev) - return false; - } - EXPORT_SYMBOL(rtw_phy_pwrtrack_need_iqk); -+ -+static void rtw_phy_set_tx_path_by_reg(struct rtw_dev *rtwdev, -+ enum rtw_bb_path tx_path_sel_1ss) -+{ -+ struct rtw_path_div *path_div = &rtwdev->dm_path_div; -+ enum rtw_bb_path tx_path_sel_cck = tx_path_sel_1ss; -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ -+ if (tx_path_sel_1ss == path_div->current_tx_path) -+ return; -+ -+ path_div->current_tx_path = tx_path_sel_1ss; -+ rtw_dbg(rtwdev, RTW_DBG_PATH_DIV, "Switch TX path=%s\n", -+ tx_path_sel_1ss == BB_PATH_A ? "A" : "B"); -+ chip->ops->config_tx_path(rtwdev, rtwdev->hal.antenna_tx, -+ tx_path_sel_1ss, tx_path_sel_cck, false); -+} -+ -+static void rtw_phy_tx_path_div_select(struct rtw_dev *rtwdev) -+{ -+ struct rtw_path_div *path_div = &rtwdev->dm_path_div; -+ enum rtw_bb_path path = path_div->current_tx_path; -+ s32 rssi_a = 0, rssi_b = 0; -+ -+ if (path_div->path_a_cnt) -+ rssi_a = path_div->path_a_sum / path_div->path_a_cnt; -+ else -+ rssi_a = 0; -+ if (path_div->path_b_cnt) -+ rssi_b = path_div->path_b_sum / path_div->path_b_cnt; -+ else -+ rssi_b = 0; -+ -+ if (rssi_a != rssi_b) -+ path = (rssi_a > rssi_b) ? BB_PATH_A : BB_PATH_B; -+ -+ path_div->path_a_cnt = 0; -+ path_div->path_a_sum = 0; -+ path_div->path_b_cnt = 0; -+ path_div->path_b_sum = 0; -+ rtw_phy_set_tx_path_by_reg(rtwdev, path); -+} -+ -+static void rtw_phy_tx_path_diversity_2ss(struct rtw_dev *rtwdev) -+{ -+ if (rtwdev->hal.antenna_rx != BB_PATH_AB) { -+ rtw_dbg(rtwdev, RTW_DBG_PATH_DIV, -+ "[Return] tx_Path_en=%d, rx_Path_en=%d\n", -+ rtwdev->hal.antenna_tx, rtwdev->hal.antenna_rx); -+ return; -+ } -+ if (rtwdev->sta_cnt == 0) { -+ rtw_dbg(rtwdev, RTW_DBG_PATH_DIV, "No Link\n"); -+ return; -+ } -+ -+ rtw_phy_tx_path_div_select(rtwdev); -+} -+ -+void rtw_phy_tx_path_diversity(struct rtw_dev *rtwdev) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ -+ if (!chip->path_div_supported) -+ return; -+ -+ rtw_phy_tx_path_diversity_2ss(rtwdev); -+} -diff --git a/drivers/net/wireless/realtek/rtw88/phy.h b/drivers/net/wireless/realtek/rtw88/phy.h -index 9623248c9..ccfcbd3ce 100644 ---- a/drivers/net/wireless/realtek/rtw88/phy.h -+++ b/drivers/net/wireless/realtek/rtw88/phy.h -@@ -59,6 +59,11 @@ bool rtw_phy_pwrtrack_need_lck(struct rtw_dev *rtwdev); - bool rtw_phy_pwrtrack_need_iqk(struct rtw_dev *rtwdev); - void rtw_phy_config_swing_table(struct rtw_dev *rtwdev, - struct rtw_swing_table *swing_table); -+void rtw_phy_set_edcca_th(struct rtw_dev *rtwdev, u8 l2h, u8 h2l); -+void rtw_phy_adaptivity_set_mode(struct rtw_dev *rtwdev); -+void rtw_phy_parsing_cfo(struct rtw_dev *rtwdev, -+ struct rtw_rx_pkt_stat *pkt_stat); -+void rtw_phy_tx_path_diversity(struct rtw_dev *rtwdev); - - struct rtw_txpwr_lmt_cfg_pair { - u8 regd; -@@ -109,7 +114,7 @@ const struct rtw_table name ## _tbl = { \ - - static inline const struct rtw_rfe_def *rtw_get_rfe_def(struct rtw_dev *rtwdev) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct rtw_efuse *efuse = &rtwdev->efuse; - const struct rtw_rfe_def *rfe_def = NULL; - -@@ -143,6 +148,7 @@ struct rtw_power_params { - s8 pwr_offset; - s8 pwr_limit; - s8 pwr_remnant; -+ s8 pwr_sar; - }; - - void -@@ -186,4 +192,7 @@ enum rtw_phy_cck_pd_lv { - #define LSSI_READ_EDGE_MASK 0x80000000 - #define LSSI_READ_DATA_MASK 0xfffff - -+#define RRSR_RATE_ORDER_MAX 0xfffff -+#define RRSR_RATE_ORDER_CCK_LEN 4 -+ - #endif -diff --git a/drivers/net/wireless/realtek/rtw88/ps.c b/drivers/net/wireless/realtek/rtw88/ps.c -index 7a189a992..15454dd27 100644 ---- a/drivers/net/wireless/realtek/rtw88/ps.c -+++ b/drivers/net/wireless/realtek/rtw88/ps.c -@@ -18,15 +18,16 @@ static int rtw_ips_pwr_up(struct rtw_dev *rtwdev) - if (ret) - rtw_err(rtwdev, "leave idle state failed\n"); - -+ rtw_coex_ips_notify(rtwdev, COEX_IPS_LEAVE); - rtw_set_channel(rtwdev); -- clear_bit(RTW_FLAG_INACTIVE_PS, rtwdev->flags); - - return ret; - } - - int rtw_enter_ips(struct rtw_dev *rtwdev) - { -- set_bit(RTW_FLAG_INACTIVE_PS, rtwdev->flags); -+ if (!test_bit(RTW_FLAG_POWERON, rtwdev->flags)) -+ return 0; - - rtw_coex_ips_notify(rtwdev, COEX_IPS_ENTER); - -@@ -36,8 +37,7 @@ int rtw_enter_ips(struct rtw_dev *rtwdev) - return 0; - } - --static void rtw_restore_port_cfg_iter(void *data, u8 *mac, -- struct ieee80211_vif *vif) -+static void rtw_restore_port_cfg_iter(void *data, struct ieee80211_vif *vif) - { - struct rtw_dev *rtwdev = data; - struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; -@@ -50,6 +50,9 @@ int rtw_leave_ips(struct rtw_dev *rtwdev) - { - int ret; - -+ if (test_bit(RTW_FLAG_POWERON, rtwdev->flags)) -+ return 0; -+ - rtw_hci_link_ps(rtwdev, false); - - ret = rtw_ips_pwr_up(rtwdev); -@@ -58,9 +61,7 @@ int rtw_leave_ips(struct rtw_dev *rtwdev) - return ret; - } - -- rtw_iterate_vifs_atomic(rtwdev, rtw_restore_port_cfg_iter, rtwdev); -- -- rtw_coex_ips_notify(rtwdev, COEX_IPS_LEAVE); -+ rtw_iterate_vifs(rtwdev, rtw_restore_port_cfg_iter, rtwdev); - - return 0; - } -@@ -68,48 +69,42 @@ int rtw_leave_ips(struct rtw_dev *rtwdev) - void rtw_power_mode_change(struct rtw_dev *rtwdev, bool enter) - { - u8 request, confirm, polling; -- u8 polling_cnt; -- u8 retry_cnt = 0; -- -- for (retry_cnt = 0; retry_cnt < 3; retry_cnt++) { -- request = rtw_read8(rtwdev, rtwdev->hci.rpwm_addr); -- confirm = rtw_read8(rtwdev, rtwdev->hci.cpwm_addr); -- -- /* toggle to request power mode, others remain 0 */ -- request ^= request | BIT_RPWM_TOGGLE; -- if (!enter) { -- request |= POWER_MODE_ACK; -- } else { -- request |= POWER_MODE_LCLK; -- if (rtw_fw_lps_deep_mode == LPS_DEEP_MODE_PG) -- request |= POWER_MODE_PG; -- } -- -- rtw_write8(rtwdev, rtwdev->hci.rpwm_addr, request); -- -- if (enter) -- return; -- -- /* check confirm power mode has left power save state */ -- for (polling_cnt = 0; polling_cnt < 50; polling_cnt++) { -- polling = rtw_read8(rtwdev, rtwdev->hci.cpwm_addr); -- if ((polling ^ confirm) & BIT_RPWM_TOGGLE) -- return; -- udelay(100); -- } -- -- /* in case of fw/hw missed the request, retry */ -- rtw_warn(rtwdev, "failed to leave deep PS, retry=%d\n", -- retry_cnt); -+ int ret; -+ -+ request = rtw_read8(rtwdev, rtwdev->hci.rpwm_addr); -+ confirm = rtw_read8(rtwdev, rtwdev->hci.cpwm_addr); -+ -+ /* toggle to request power mode, others remain 0 */ -+ request ^= request | BIT_RPWM_TOGGLE; -+ if (enter) { -+ request |= POWER_MODE_LCLK; -+ if (rtw_get_lps_deep_mode(rtwdev) == LPS_DEEP_MODE_PG) -+ request |= POWER_MODE_PG; - } -+ /* Each request require an ack from firmware */ -+ request |= POWER_MODE_ACK; - -- /* Hit here means that driver failed to change hardware power mode to -- * active state after retry 3 times. If the power state is locked at -- * Deep sleep, most of the hardware circuits is not working, even -- * register read/write. It should be treated as fatal error and -- * requires an entire analysis about the firmware/hardware -- */ -- WARN(1, "Hardware power state locked\n"); -+ if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) -+ request |= POWER_TX_WAKE; -+ -+ rtw_write8(rtwdev, rtwdev->hci.rpwm_addr, request); -+ -+ /* Check firmware get the power requset and ack via cpwm register */ -+ ret = read_poll_timeout_atomic(rtw_read8, polling, -+ (polling ^ confirm) & BIT_RPWM_TOGGLE, -+ 100, 15000, true, rtwdev, -+ rtwdev->hci.cpwm_addr); -+ if (ret) { -+ /* Hit here means that driver failed to get an ack from firmware. -+ * The reason could be that hardware is locked at Deep sleep, -+ * so most of the hardware circuits are not working, even -+ * register read/write; or firmware is locked in some state and -+ * cannot get the request. It should be treated as fatal error -+ * and requires an entire analysis about the firmware/hardware. -+ */ -+ WARN(1, "firmware failed to ack driver for %s Deep Power mode\n", -+ enter ? "entering" : "leaving"); -+ } - } - EXPORT_SYMBOL(rtw_power_mode_change); - -@@ -118,7 +113,7 @@ static void __rtw_leave_lps_deep(struct rtw_dev *rtwdev) - rtw_hci_deep_ps(rtwdev, false); - } - --static void rtw_fw_leave_lps_state_check(struct rtw_dev *rtwdev) -+static int __rtw_fw_leave_lps_check_reg(struct rtw_dev *rtwdev) - { - int i; - -@@ -136,12 +131,53 @@ static void rtw_fw_leave_lps_state_check(struct rtw_dev *rtwdev) - */ - for (i = 0 ; i < LEAVE_LPS_TRY_CNT; i++) { - if (rtw_read32_mask(rtwdev, REG_TCR, BIT_PWRMGT_HWDATA_EN) == 0) -- return; -+ return 0; - msleep(20); - } - -- rtw_write32_mask(rtwdev, REG_TCR, BIT_PWRMGT_HWDATA_EN, 0); -- rtw_warn(rtwdev, "firmware failed to restore hardware setting\n"); -+ return -EBUSY; -+} -+ -+static int __rtw_fw_leave_lps_check_c2h(struct rtw_dev *rtwdev) -+{ -+ if (wait_for_completion_timeout(&rtwdev->lps_leave_check, -+ LEAVE_LPS_TIMEOUT)) -+ return 0; -+ return -EBUSY; -+} -+ -+static void rtw_fw_leave_lps_check(struct rtw_dev *rtwdev) -+{ -+ bool ret = false; -+ struct rtw_fw_state *fw; -+ -+ if (test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) -+ fw = &rtwdev->wow_fw; -+ else -+ fw = &rtwdev->fw; -+ -+ if (rtw_fw_feature_check(fw, FW_FEATURE_LPS_C2H)) -+ ret = __rtw_fw_leave_lps_check_c2h(rtwdev); -+ else -+ ret = __rtw_fw_leave_lps_check_reg(rtwdev); -+ -+ if (ret) { -+ rtw_write32_clr(rtwdev, REG_TCR, BIT_PWRMGT_HWDATA_EN); -+ rtw_warn(rtwdev, "firmware failed to leave lps state\n"); -+ } -+} -+ -+static void rtw_fw_leave_lps_check_prepare(struct rtw_dev *rtwdev) -+{ -+ struct rtw_fw_state *fw; -+ -+ if (test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) -+ fw = &rtwdev->wow_fw; -+ else -+ fw = &rtwdev->fw; -+ -+ if (rtw_fw_feature_check(fw, FW_FEATURE_LPS_C2H)) -+ reinit_completion(&rtwdev->lps_leave_check); - } - - static void rtw_leave_lps_core(struct rtw_dev *rtwdev) -@@ -154,17 +190,26 @@ static void rtw_leave_lps_core(struct rtw_dev *rtwdev) - conf->smart_ps = 0; - - rtw_hci_link_ps(rtwdev, false); -+ rtw_fw_leave_lps_check_prepare(rtwdev); - rtw_fw_set_pwr_mode(rtwdev); -- rtw_fw_leave_lps_state_check(rtwdev); -+ rtw_fw_leave_lps_check(rtwdev); - - clear_bit(RTW_FLAG_LEISURE_PS, rtwdev->flags); - - rtw_coex_lps_notify(rtwdev, COEX_LPS_DISABLE); - } - -+enum rtw_lps_deep_mode rtw_get_lps_deep_mode(struct rtw_dev *rtwdev) -+{ -+ if (test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) -+ return rtwdev->lps_conf.wow_deep_mode; -+ else -+ return rtwdev->lps_conf.deep_mode; -+} -+ - static void __rtw_enter_lps_deep(struct rtw_dev *rtwdev) - { -- if (rtwdev->lps_conf.deep_mode == LPS_DEEP_MODE_NONE) -+ if (rtw_get_lps_deep_mode(rtwdev) == LPS_DEEP_MODE_NONE) - return; - - if (!test_bit(RTW_FLAG_LEISURE_PS, rtwdev->flags)) { -@@ -173,7 +218,7 @@ static void __rtw_enter_lps_deep(struct rtw_dev *rtwdev) - return; - } - -- if (rtw_fw_lps_deep_mode == LPS_DEEP_MODE_PG) -+ if (rtw_get_lps_deep_mode(rtwdev) == LPS_DEEP_MODE_PG) - rtw_fw_set_pg_info(rtwdev); - - rtw_hci_deep_ps(rtwdev, true); -@@ -252,3 +297,47 @@ void rtw_leave_lps_deep(struct rtw_dev *rtwdev) - - __rtw_leave_lps_deep(rtwdev); - } -+ -+struct rtw_vif_recalc_lps_iter_data { -+ struct rtw_dev *rtwdev; -+ struct ieee80211_vif *found_vif; -+ int count; -+}; -+ -+static void __rtw_vif_recalc_lps(struct rtw_vif_recalc_lps_iter_data *data, -+ struct ieee80211_vif *vif) -+{ -+ if (data->count < 0) -+ return; -+ -+ if (vif->type != NL80211_IFTYPE_STATION) { -+ data->count = -1; -+ return; -+ } -+ -+ data->count++; -+ data->found_vif = vif; -+} -+ -+static void rtw_vif_recalc_lps_iter(void *data, struct ieee80211_vif *vif) -+{ -+ __rtw_vif_recalc_lps(data, vif); -+} -+ -+void rtw_recalc_lps(struct rtw_dev *rtwdev, struct ieee80211_vif *new_vif) -+{ -+ struct rtw_vif_recalc_lps_iter_data data = { .rtwdev = rtwdev }; -+ -+ if (new_vif) -+ __rtw_vif_recalc_lps(&data, new_vif); -+ rtw_iterate_vifs(rtwdev, rtw_vif_recalc_lps_iter, &data); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) -+ if (data.count == 1 && data.found_vif->cfg.ps) { -+ rtwdev->ps_enabled = true; -+ } else { -+ rtwdev->ps_enabled = false; -+ rtw_leave_lps(rtwdev); -+ } -+#endif -+} -diff --git a/drivers/net/wireless/realtek/rtw88/ps.h b/drivers/net/wireless/realtek/rtw88/ps.h -index 19afceca7..5ae83d252 100644 ---- a/drivers/net/wireless/realtek/rtw88/ps.h -+++ b/drivers/net/wireless/realtek/rtw88/ps.h -@@ -9,9 +9,11 @@ - - #define POWER_MODE_ACK BIT(6) - #define POWER_MODE_PG BIT(4) -+#define POWER_TX_WAKE BIT(1) - #define POWER_MODE_LCLK BIT(0) - - #define LEAVE_LPS_TRY_CNT 5 -+#define LEAVE_LPS_TIMEOUT msecs_to_jiffies(100) - - int rtw_enter_ips(struct rtw_dev *rtwdev); - int rtw_leave_ips(struct rtw_dev *rtwdev); -@@ -20,5 +22,7 @@ void rtw_power_mode_change(struct rtw_dev *rtwdev, bool enter); - void rtw_enter_lps(struct rtw_dev *rtwdev, u8 port_id); - void rtw_leave_lps(struct rtw_dev *rtwdev); - void rtw_leave_lps_deep(struct rtw_dev *rtwdev); -+enum rtw_lps_deep_mode rtw_get_lps_deep_mode(struct rtw_dev *rtwdev); -+void rtw_recalc_lps(struct rtw_dev *rtwdev, struct ieee80211_vif *new_vif); - - #endif -diff --git a/drivers/net/wireless/realtek/rtw88/reg.h b/drivers/net/wireless/realtek/rtw88/reg.h -index 9088bfb2a..7c6c11d50 100644 ---- a/drivers/net/wireless/realtek/rtw88/reg.h -+++ b/drivers/net/wireless/realtek/rtw88/reg.h -@@ -60,7 +60,7 @@ - #define REG_GPIO_MUXCFG 0x0040 - #define BIT_FSPI_EN BIT(19) - #define BIT_EN_SIC BIT(12) --#define BIT_BT_AOD_GPIO3 BIT(9) -+ - #define BIT_PO_BT_PTA_PINS BIT(9) - #define BIT_BT_PTA_EN BIT(5) - #define BIT_WLRFE_4_5_EN BIT(2) -@@ -87,6 +87,7 @@ - #define BIT_LTE_MUX_CTRL_PATH BIT(26) - #define REG_HCI_OPT_CTRL 0x0074 - #define BIT_USB_SUS_DIS BIT(8) -+#define BIT_SDIO_PAD_E5 BIT(18) - - #define REG_AFE_CTRL_4 0x0078 - #define BIT_CK320M_AFE_EN BIT(4) -@@ -129,6 +130,9 @@ - #define REG_MCU_TST_CFG 0x84 - #define VAL_FW_TRIGGER 0x1 - -+#define REG_PMC_DBG_CTRL1 0xa8 -+#define BITS_PMC_BT_IQK_STS GENMASK(22, 21) -+ - #define REG_EFUSE_ACCESS 0x00CF - #define EFUSE_ACCESS_ON 0x69 - #define EFUSE_ACCESS_OFF 0x00 -@@ -181,6 +185,10 @@ - #define BIT_TXDMA_VIQ_MAP(x) \ - (((x) & BIT_MASK_TXDMA_VIQ_MAP) << BIT_SHIFT_TXDMA_VIQ_MAP) - #define REG_TXDMA_PQ_MAP 0x010C -+#define BIT_RXDMA_ARBBW_EN BIT(0) -+#define BIT_RXSHFT_EN BIT(1) -+#define BIT_RXDMA_AGG_EN BIT(2) -+#define BIT_TXDMA_BW_EN BIT(3) - #define BIT_SHIFT_TXDMA_BEQ_MAP 8 - #define BIT_MASK_TXDMA_BEQ_MAP 0x3 - #define BIT_TXDMA_BEQ_MAP(x) \ -@@ -279,10 +287,18 @@ - #define REG_H2C_TAIL 0x0248 - #define REG_H2C_READ_ADDR 0x024C - #define REG_H2C_INFO 0x0254 -+#define REG_RXDMA_AGG_PG_TH 0x0280 -+#define BIT_RXDMA_AGG_PG_TH GENMASK(7, 0) -+#define BIT_DMA_AGG_TO_V1 GENMASK(15, 8) -+#define BIT_EN_PRE_CALC BIT(29) - #define REG_RXPKT_NUM 0x0284 - #define BIT_RXDMA_REQ BIT(19) - #define BIT_RW_RELEASE BIT(18) - #define BIT_RXDMA_IDLE BIT(17) -+#define REG_RXDMA_STATUS 0x0288 -+#define REG_RXDMA_DPR 0x028C -+#define REG_RXDMA_MODE 0x0290 -+#define BIT_DMA_MODE BIT(1) - #define REG_RXPKTNUM 0x02B0 - - #define REG_INT_MIG 0x0304 -@@ -306,6 +322,8 @@ - #define REG_DARFRC 0x0430 - #define REG_DARFRCH 0x0434 - #define REG_RARFRCH 0x043C -+#define REG_RRSR 0x0440 -+#define BITS_RRSR_RSC GENMASK(22, 21) - #define REG_ARFR0 0x0444 - #define REG_ARFRH0 0x0448 - #define REG_ARFR1_V1 0x044C -@@ -356,9 +374,13 @@ - #define REG_AGGR_BREAK_TIME 0x051A - #define REG_SLOT 0x051B - #define REG_TX_PTCL_CTRL 0x0520 -+#define BIT_DIS_EDCCA BIT(15) - #define BIT_SIFS_BK_EN BIT(12) - #define REG_TXPAUSE 0x0522 -+#define BIT_AC_QUEUE GENMASK(7, 0) -+#define BIT_HIGH_QUEUE BIT(5) - #define REG_RD_CTRL 0x0524 -+#define BIT_EDCCA_MSK_CNTDOWN_EN BIT(11) - #define BIT_DIS_TXOP_CFE BIT(10) - #define BIT_DIS_LSIG_CFE BIT(9) - #define BIT_DIS_STBC_CFE BIT(8) -@@ -381,12 +403,15 @@ - #define BIT_EN_FREE_CNT BIT(3) - #define BIT_DIS_SECOND_CCA (BIT(0) | BIT(1)) - #define REG_HIQ_NO_LMT_EN 0x5A7 -+#define REG_DTIM_COUNTER_ROOT 0x5A8 - #define BIT_HIQ_NO_LMT_EN_ROOT BIT(0) - #define REG_TIMER0_SRC_SEL 0x05B4 - #define BIT_TSFT_SEL_TIMER0 (BIT(4) | BIT(5) | BIT(6)) - - #define REG_TCR 0x0604 - #define BIT_PWRMGT_HWDATA_EN BIT(7) -+#define BIT_TCR_UPDATE_TIMIE BIT(5) -+#define BIT_TCR_UPDATE_HGQMD BIT(4) - #define REG_RCR 0x0608 - #define BIT_APP_FCS BIT(31) - #define BIT_APP_MIC BIT(30) -@@ -464,11 +489,17 @@ - #define REG_BT_COEX_TABLE_H3 0x06CF - #define REG_BBPSF_CTRL 0x06DC - --#define REG_BT_COEX_V2 0x0763 --#define BIT_GNT_BT_POLARITY BIT(4) -+#define REG_BT_COEX_V2 0x0762 -+#define BIT_GNT_BT_POLARITY BIT(12) - #define BIT_LTE_COEX_EN BIT(7) -+#define REG_BT_COEX_ENH_INTR_CTRL 0x76E -+#define BIT_R_GRANTALL_WLMASK BIT(3) -+#define BIT_STATIS_BT_EN BIT(2) -+#define REG_BT_ACT_STATISTICS 0x0770 -+#define REG_BT_ACT_STATISTICS_1 0x0774 - #define REG_BT_STAT_CTRL 0x0778 - #define REG_BT_TDMA_TIME 0x0790 -+#define BIT_MASK_SAMPLE_RATE GENMASK(5, 0) - #define REG_LTR_IDLE_LATENCY 0x0798 - #define REG_LTR_ACTIVE_LATENCY 0x079C - #define REG_LTR_CTRL_BASIC 0x07A4 -@@ -484,6 +515,8 @@ - #define REG_2ND_CCA_CTRL 0x0976 - - #define REG_CCK0_FAREPORT 0xa2c -+#define BIT_CCK0_2RX BIT(18) -+#define BIT_CCK0_MRC BIT(22) - - #define REG_DIS_DPD 0x0a70 - #define DIS_DPD_MASK GENMASK(9, 0) -@@ -507,6 +540,7 @@ - #define BIT_RFE_BUF_EN BIT(3) - - #define REG_ANAPAR_XTAL_0 0x1040 -+#define BIT_XCAP_0 GENMASK(23, 10) - #define REG_CPU_DMEM_CON 0x1080 - #define BIT_WL_PLATFORM_RST BIT(16) - #define BIT_WL_SECURITY_CLK BIT(15) -@@ -525,6 +559,7 @@ - #define BIT_DDMACH0_OWN BIT(31) - #define BIT_DDMACH0_CHKSUM_EN BIT(29) - #define BIT_DDMACH0_CHKSUM_STS BIT(27) -+#define BIT_DDMACH0_DDMA_MODE BIT(26) - #define BIT_DDMACH0_RESET_CHKSUM_STS BIT(25) - #define BIT_DDMACH0_CHKSUM_CONT BIT(24) - #define BIT_MASK_DDMACH0_DLEN 0x3ffff -@@ -619,9 +654,15 @@ - #define REG_ANAPAR 0x1c30 - #define BIT_ANAPAR_BTPS BIT(22) - #define REG_RSTB_SEL 0x1c38 -+#define BIT_DAC_OFF_ENABLE BIT(4) -+#define BIT_PI_IGNORE_GNT_BT BIT(3) -+#define BIT_NOMASK_TXBT_ENABLE BIT(3) - - #define REG_HRCV_MSG 0x1cf - -+#define REG_EDCCA_REPORT 0x2d38 -+#define BIT_EDCCA_FLAG BIT(24) -+ - #define REG_IGN_GNTBT4 0x4160 - - #define RF_MODE 0x00 -@@ -630,10 +671,13 @@ - #define RF_WLSEL 0x02 - #define RF_DTXLOK 0x08 - #define RF_CFGCH 0x18 -+#define BIT_BAND GENMASK(18, 16) - #define RF_RCK 0x1d - #define RF_LUTWA 0x33 - #define RF_LUTWD1 0x3e - #define RF_LUTWD0 0x3f -+#define BIT_GAIN_EXT BIT(12) -+#define BIT_DATA_L GENMASK(11, 0) - #define RF_T_METER 0x42 - #define RF_BSPAD 0x54 - #define RF_GAINTX 0x56 -@@ -650,6 +694,7 @@ - #define RF_RCKD 0xde - #define RF_TXADBG 0xde - #define RF_LUTDBG 0xdf -+#define BIT_TXA_TANK BIT(4) - #define RF_LUTWE2 0xee - #define RF_LUTWE 0xef - -diff --git a/drivers/net/wireless/realtek/rtw88/regd.c b/drivers/net/wireless/realtek/rtw88/regd.c -index 69744dd65..2f547cbcf 100644 ---- a/drivers/net/wireless/realtek/rtw88/regd.c -+++ b/drivers/net/wireless/realtek/rtw88/regd.c -@@ -7,288 +7,274 @@ - #include "debug.h" - #include "phy.h" - --#define COUNTRY_CHPLAN_ENT(_alpha2, _chplan, _txpwr_regd) \ -+#define COUNTRY_REGD_ENT(_alpha2, _regd_2g, _regd_5g) \ - {.alpha2 = (_alpha2), \ -- .chplan = (_chplan), \ -- .txpwr_regd = (_txpwr_regd) \ -+ .txpwr_regd_2g = (_regd_2g), \ -+ .txpwr_regd_5g = (_regd_5g), \ - } - -+#define rtw_dbg_regd_dump(_dev, _msg, _args...) \ -+do { \ -+ struct rtw_dev *__d = (_dev); \ -+ const struct rtw_regd *__r = &__d->regd; \ -+ rtw_dbg(__d, RTW_DBG_REGD, _msg \ -+ "apply alpha2 %c%c, regd {%d, %d}, dfs_region %d\n",\ -+ ##_args, \ -+ __r->regulatory->alpha2[0], \ -+ __r->regulatory->alpha2[1], \ -+ __r->regulatory->txpwr_regd_2g, \ -+ __r->regulatory->txpwr_regd_5g, \ -+ __r->dfs_region); \ -+} while (0) -+ - /* If country code is not correctly defined in efuse, - * use worldwide country code and txpwr regd. - */ --static const struct rtw_regulatory rtw_defined_chplan = -- COUNTRY_CHPLAN_ENT("00", RTW_CHPLAN_REALTEK_DEFINE, RTW_REGD_WW); -- --static const struct rtw_regulatory all_chplan_map[] = { -- COUNTRY_CHPLAN_ENT("AD", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("AE", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("AF", RTW_CHPLAN_ETSI1_ETSI4, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("AG", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("AI", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("AL", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("AM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("AN", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("AO", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("AQ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("AR", RTW_CHPLAN_FCC2_FCC7, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("AS", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("AT", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("AU", RTW_CHPLAN_WORLD_ACMA1, RTW_REGD_ACMA), -- COUNTRY_CHPLAN_ENT("AW", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("AZ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BA", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BB", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("BD", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BE", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BF", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BG", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BH", RTW_CHPLAN_WORLD_ETSI7, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BI", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BJ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BM", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("BN", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BO", RTW_CHPLAN_WORLD_FCC7, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("BR", RTW_CHPLAN_FCC2_FCC1, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("BS", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("BT", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BV", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BW", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BY", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("BZ", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("CA", RTW_CHPLAN_IC1_IC2, RTW_REGD_IC), -- COUNTRY_CHPLAN_ENT("CC", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CD", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CF", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CG", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CH", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CI", RTW_CHPLAN_ETSI1_ETSI4, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CK", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CL", RTW_CHPLAN_WORLD_CHILE1, RTW_REGD_CHILE), -- COUNTRY_CHPLAN_ENT("CM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CN", RTW_CHPLAN_WORLD_ETSI7, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CO", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("CR", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("CV", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CX", RTW_CHPLAN_WORLD_ACMA1, RTW_REGD_ACMA), -- COUNTRY_CHPLAN_ENT("CY", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("CZ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("DE", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("DJ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("DK", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("DM", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("DO", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("DZ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("EC", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("EE", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("EG", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("EH", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("ER", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("ES", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("ET", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("FI", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("FJ", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("FK", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("FM", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("FO", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("FR", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GA", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GB", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GD", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("GE", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GF", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GG", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GH", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GI", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GL", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GN", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GP", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GQ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GR", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GS", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GT", RTW_CHPLAN_FCC2_FCC7, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("GU", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("GW", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("GY", RTW_CHPLAN_FCC1_NCC3, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("HK", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("HM", RTW_CHPLAN_WORLD_ACMA1, RTW_REGD_ACMA), -- COUNTRY_CHPLAN_ENT("HN", RTW_CHPLAN_WORLD_FCC5, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("HR", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("HT", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("HU", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("ID", RTW_CHPLAN_ETSI1_ETSI12, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("IE", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("IL", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("IM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("IN", RTW_CHPLAN_WORLD_ETSI7, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("IO", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("IQ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("IR", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("IS", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("IT", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("JE", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("JM", RTW_CHPLAN_WORLD_FCC5, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("JO", RTW_CHPLAN_WORLD_ETSI8, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("JP", RTW_CHPLAN_MKK1_MKK1, RTW_REGD_MKK), -- COUNTRY_CHPLAN_ENT("KE", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("KG", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("KH", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("KI", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("KM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("KN", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("KR", RTW_CHPLAN_KCC1_KCC3, RTW_REGD_KCC), -- COUNTRY_CHPLAN_ENT("KW", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("KY", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("KZ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("LA", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("LB", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("LC", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("LI", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("LK", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("LR", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("LS", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("LT", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("LU", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("LV", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("LY", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MA", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MC", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MD", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("ME", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MF", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("MG", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MH", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("MK", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("ML", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MN", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MO", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MP", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("MQ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MR", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MS", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MT", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MU", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MV", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MW", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MX", RTW_CHPLAN_FCC2_FCC7, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("MY", RTW_CHPLAN_WORLD_ETSI15, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("MZ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("NA", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("NC", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("NE", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("NF", RTW_CHPLAN_WORLD_ACMA1, RTW_REGD_ACMA), -- COUNTRY_CHPLAN_ENT("NG", RTW_CHPLAN_WORLD_ETSI20, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("NI", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("NL", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("NO", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("NP", RTW_CHPLAN_WORLD_ETSI7, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("NR", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("NU", RTW_CHPLAN_WORLD_ACMA1, RTW_REGD_ACMA), -- COUNTRY_CHPLAN_ENT("NZ", RTW_CHPLAN_WORLD_ACMA1, RTW_REGD_ACMA), -- COUNTRY_CHPLAN_ENT("OM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("PA", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("PE", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("PF", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("PG", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("PH", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("PK", RTW_CHPLAN_WORLD_ETSI10, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("PL", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("PM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("PR", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("PT", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("PW", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("PY", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("QA", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("RE", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("RO", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("RS", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("RU", RTW_CHPLAN_WORLD_ETSI14, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("RW", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SA", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SB", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SC", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("SE", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SG", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SH", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SI", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SJ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SK", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SL", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SN", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SO", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("SR", RTW_CHPLAN_FCC2_FCC17, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("ST", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("SV", RTW_CHPLAN_WORLD_FCC3, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("SX", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("SZ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TC", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TD", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TF", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TG", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TH", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TJ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TK", RTW_CHPLAN_WORLD_ACMA1, RTW_REGD_ACMA), -- COUNTRY_CHPLAN_ENT("TM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TN", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TO", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TR", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TT", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("TV", RTW_CHPLAN_ETSI1_NULL, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("TW", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("TZ", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("UA", RTW_CHPLAN_WORLD_ETSI3, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("UG", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("US", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("UY", RTW_CHPLAN_WORLD_FCC3, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("UZ", RTW_CHPLAN_WORLD_ETSI6, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("VA", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("VC", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("VE", RTW_CHPLAN_WORLD_FCC3, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("VG", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("VI", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("VN", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("VU", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("WF", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("WS", RTW_CHPLAN_FCC2_FCC11, RTW_REGD_FCC), -- COUNTRY_CHPLAN_ENT("YE", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("YT", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("ZA", RTW_CHPLAN_WORLD_ETSI2, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("ZM", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -- COUNTRY_CHPLAN_ENT("ZW", RTW_CHPLAN_WORLD_ETSI1, RTW_REGD_ETSI), -+static const struct rtw_regulatory rtw_reg_ww = -+ COUNTRY_REGD_ENT("00", RTW_REGD_WW, RTW_REGD_WW); -+ -+static const struct rtw_regulatory rtw_reg_map[] = { -+ COUNTRY_REGD_ENT("AD", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("AE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("AF", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("AG", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("AI", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("AL", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("AM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("AN", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("AO", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("AQ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("AR", RTW_REGD_MEXICO, RTW_REGD_MEXICO), -+ COUNTRY_REGD_ENT("AS", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("AT", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("AU", RTW_REGD_ACMA, RTW_REGD_ACMA), -+ COUNTRY_REGD_ENT("AW", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("AZ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BA", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BB", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("BD", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BF", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BH", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BI", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BJ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BM", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("BN", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BO", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("BR", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("BS", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("BT", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BV", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BW", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BY", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("BZ", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("CA", RTW_REGD_IC, RTW_REGD_IC), -+ COUNTRY_REGD_ENT("CC", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CD", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CF", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CH", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CI", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CK", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CL", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("CM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CN", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CO", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("CR", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("CV", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CX", RTW_REGD_ACMA, RTW_REGD_ACMA), -+ COUNTRY_REGD_ENT("CY", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("CZ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("DE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("DJ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("DK", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("DM", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("DO", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("DZ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("EC", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("EE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("EG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("EH", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("ER", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("ES", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("ET", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("FI", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("FJ", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("FK", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("FM", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("FO", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("FR", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GA", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GB", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GD", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("GE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GF", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GH", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GI", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GL", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GN", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GP", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GQ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GR", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GS", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GT", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("GU", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("GW", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("GY", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("HK", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("HM", RTW_REGD_ACMA, RTW_REGD_ACMA), -+ COUNTRY_REGD_ENT("HN", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("HR", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("HT", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("HU", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("ID", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("IE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("IL", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("IM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("IN", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("IO", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("IQ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("IR", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("IS", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("IT", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("JE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("JM", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("JO", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("JP", RTW_REGD_MKK, RTW_REGD_MKK), -+ COUNTRY_REGD_ENT("KE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("KG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("KH", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("KI", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("KM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("KN", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("KR", RTW_REGD_KCC, RTW_REGD_KCC), -+ COUNTRY_REGD_ENT("KW", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("KY", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("KZ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("LA", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("LB", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("LC", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("LI", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("LK", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("LR", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("LS", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("LT", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("LU", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("LV", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("LY", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MA", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MC", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MD", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("ME", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MF", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("MG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MH", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("MK", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("ML", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MN", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MO", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MP", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("MQ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MR", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MS", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MT", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MU", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MV", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MW", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MX", RTW_REGD_MEXICO, RTW_REGD_MEXICO), -+ COUNTRY_REGD_ENT("MY", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("MZ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("NA", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("NC", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("NE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("NF", RTW_REGD_ACMA, RTW_REGD_ACMA), -+ COUNTRY_REGD_ENT("NG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("NI", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("NL", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("NO", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("NP", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("NR", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("NU", RTW_REGD_ACMA, RTW_REGD_ACMA), -+ COUNTRY_REGD_ENT("NZ", RTW_REGD_ACMA, RTW_REGD_ACMA), -+ COUNTRY_REGD_ENT("OM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("PA", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("PE", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("PF", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("PG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("PH", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("PK", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("PL", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("PM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("PR", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("PS", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("PT", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("PW", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("PY", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("QA", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("RE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("RO", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("RS", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("RU", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("RW", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SA", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SB", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SC", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("SE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SH", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SI", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SJ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SK", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SL", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SN", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SO", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("SR", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("ST", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("SV", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("SX", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("SZ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TC", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TD", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TF", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TH", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TJ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TK", RTW_REGD_ACMA, RTW_REGD_ACMA), -+ COUNTRY_REGD_ENT("TM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TN", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TO", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TR", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("TT", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("TV", RTW_REGD_ETSI, RTW_REGD_WW), -+ COUNTRY_REGD_ENT("TW", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("TZ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("UA", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("UG", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("US", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("UY", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("UZ", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("VA", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("VC", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("VE", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("VG", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("VI", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("VN", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("VU", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("WF", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("WS", RTW_REGD_FCC, RTW_REGD_FCC), -+ COUNTRY_REGD_ENT("XK", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("YE", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("YT", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("ZA", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("ZM", RTW_REGD_ETSI, RTW_REGD_ETSI), -+ COUNTRY_REGD_ENT("ZW", RTW_REGD_ETSI, RTW_REGD_ETSI), - }; - --static void rtw_regd_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; -- -- for (band = 0; band < NUM_NL80211_BANDS; band++) { -- if (!wiphy->bands[band]) -- continue; -- -- sband = wiphy->bands[band]; -- for (i = 0; i < sband->n_channels; i++) { -- ch = &sband->channels[i]; -- -- reg_rule = freq_reg_info(wiphy, -- MHZ_TO_KHZ(ch->center_freq)); -- if (IS_ERR(reg_rule)) -- continue; -- -- ch->flags &= ~IEEE80211_CHAN_DISABLED; -- -- if (!(reg_rule->flags & NL80211_RRF_NO_IR)) -- ch->flags &= ~IEEE80211_CHAN_NO_IR; -- } -- } --} -- - static void rtw_regd_apply_hw_cap_flags(struct wiphy *wiphy) - { - struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy); -@@ -321,78 +307,225 @@ static void rtw_regd_apply_hw_cap_flags(struct wiphy *wiphy) - } - } - --static void rtw_regd_apply_world_flags(struct wiphy *wiphy, -- enum nl80211_reg_initiator initiator) -+static bool rtw_reg_is_ww(const struct rtw_regulatory *reg) - { -- rtw_regd_apply_beaconing_flags(wiphy, initiator); -+ return reg == &rtw_reg_ww; - } - --static struct rtw_regulatory rtw_regd_find_reg_by_name(char *alpha2) -+static bool rtw_reg_match(const struct rtw_regulatory *reg, const char *alpha2) -+{ -+ return memcmp(reg->alpha2, alpha2, 2) == 0; -+} -+ -+static const struct rtw_regulatory *rtw_reg_find_by_name(const char *alpha2) - { - unsigned int i; - -- for (i = 0; i < ARRAY_SIZE(all_chplan_map); i++) { -- if (!memcmp(all_chplan_map[i].alpha2, alpha2, 2)) -- return all_chplan_map[i]; -+ for (i = 0; i < ARRAY_SIZE(rtw_reg_map); i++) { -+ if (rtw_reg_match(&rtw_reg_map[i], alpha2)) -+ return &rtw_reg_map[i]; - } - -- return rtw_defined_chplan; -+ return &rtw_reg_ww; - } - --static int rtw_regd_notifier_apply(struct rtw_dev *rtwdev, -- struct wiphy *wiphy, -- struct regulatory_request *request) -+static -+void rtw_regd_notifier(struct wiphy *wiphy, struct regulatory_request *request); -+ -+/* call this before ieee80211_register_hw() */ -+int rtw_regd_init(struct rtw_dev *rtwdev) - { -- if (request->initiator == NL80211_REGDOM_SET_BY_USER) -- return 0; -- rtwdev->regd = rtw_regd_find_reg_by_name(request->alpha2); -- rtw_regd_apply_world_flags(wiphy, request->initiator); -+ struct wiphy *wiphy = rtwdev->hw->wiphy; -+ const struct rtw_regulatory *chip_reg; - -- return 0; --} -+ if (!wiphy) -+ return -EINVAL; - --static int --rtw_regd_init_wiphy(struct rtw_regulatory *reg, struct wiphy *wiphy, -- void (*reg_notifier)(struct wiphy *wiphy, -- struct regulatory_request *request)) --{ -- wiphy->reg_notifier = reg_notifier; -+ wiphy->reg_notifier = rtw_regd_notifier; - -- wiphy->regulatory_flags &= ~REGULATORY_CUSTOM_REG; -- wiphy->regulatory_flags &= ~REGULATORY_STRICT_REG; -- wiphy->regulatory_flags &= ~REGULATORY_DISABLE_BEACON_HINTS; -+ chip_reg = rtw_reg_find_by_name(rtwdev->efuse.country_code); -+ if (!rtw_reg_is_ww(chip_reg)) { -+ rtwdev->regd.state = RTW_REGD_STATE_PROGRAMMED; - -- rtw_regd_apply_hw_cap_flags(wiphy); -+ /* Set REGULATORY_STRICT_REG before ieee80211_register_hw(), -+ * stack will wait for regulatory_hint() and consider it -+ * as the superset for our regulatory rule. -+ */ -+ wiphy->regulatory_flags |= REGULATORY_STRICT_REG; -+ wiphy->regulatory_flags |= REGULATORY_COUNTRY_IE_IGNORE; -+ } else { -+ rtwdev->regd.state = RTW_REGD_STATE_WORLDWIDE; -+ } - -+ rtwdev->regd.regulatory = &rtw_reg_ww; -+ rtwdev->regd.dfs_region = NL80211_DFS_UNSET; -+ rtw_dbg_regd_dump(rtwdev, "regd init state %d: ", rtwdev->regd.state); -+ -+ rtw_regd_apply_hw_cap_flags(wiphy); - return 0; - } - --int rtw_regd_init(struct rtw_dev *rtwdev, -- void (*reg_notifier)(struct wiphy *wiphy, -- struct regulatory_request *request)) -+/* call this after ieee80211_register_hw() */ -+int rtw_regd_hint(struct rtw_dev *rtwdev) - { - struct wiphy *wiphy = rtwdev->hw->wiphy; -+ int ret; - - if (!wiphy) - return -EINVAL; - -- rtwdev->regd = rtw_regd_find_reg_by_name(rtwdev->efuse.country_code); -- rtw_regd_init_wiphy(&rtwdev->regd, wiphy, reg_notifier); -+ if (rtwdev->regd.state == RTW_REGD_STATE_PROGRAMMED) { -+ rtw_dbg(rtwdev, RTW_DBG_REGD, -+ "country domain %c%c is PGed on efuse", -+ rtwdev->efuse.country_code[0], -+ rtwdev->efuse.country_code[1]); -+ -+ ret = regulatory_hint(wiphy, rtwdev->efuse.country_code); -+ if (ret) { -+ rtw_warn(rtwdev, -+ "failed to hint regulatory: %d\n", ret); -+ return ret; -+ } -+ } - - return 0; - } - -+static bool rtw_regd_mgmt_worldwide(struct rtw_dev *rtwdev, -+ struct rtw_regd *next_regd, -+ struct regulatory_request *request) -+{ -+ struct wiphy *wiphy = rtwdev->hw->wiphy; -+ -+ next_regd->state = RTW_REGD_STATE_WORLDWIDE; -+ -+ if (request->initiator == NL80211_REGDOM_SET_BY_USER && -+ !rtw_reg_is_ww(next_regd->regulatory)) { -+ next_regd->state = RTW_REGD_STATE_SETTING; -+ wiphy->regulatory_flags |= REGULATORY_COUNTRY_IE_IGNORE; -+ } -+ -+ return true; -+} -+ -+static bool rtw_regd_mgmt_programmed(struct rtw_dev *rtwdev, -+ struct rtw_regd *next_regd, -+ struct regulatory_request *request) -+{ -+ if (request->initiator == NL80211_REGDOM_SET_BY_DRIVER && -+ rtw_reg_match(next_regd->regulatory, rtwdev->efuse.country_code)) { -+ next_regd->state = RTW_REGD_STATE_PROGRAMMED; -+ return true; -+ } -+ -+ return false; -+} -+ -+static bool rtw_regd_mgmt_setting(struct rtw_dev *rtwdev, -+ struct rtw_regd *next_regd, -+ struct regulatory_request *request) -+{ -+ struct wiphy *wiphy = rtwdev->hw->wiphy; -+ -+ if (request->initiator != NL80211_REGDOM_SET_BY_USER) -+ return false; -+ -+ next_regd->state = RTW_REGD_STATE_SETTING; -+ -+ if (rtw_reg_is_ww(next_regd->regulatory)) { -+ next_regd->state = RTW_REGD_STATE_WORLDWIDE; -+ wiphy->regulatory_flags &= ~REGULATORY_COUNTRY_IE_IGNORE; -+ } -+ -+ return true; -+} -+ -+static bool (*const rtw_regd_handler[RTW_REGD_STATE_NR]) -+ (struct rtw_dev *, struct rtw_regd *, struct regulatory_request *) = { -+ [RTW_REGD_STATE_WORLDWIDE] = rtw_regd_mgmt_worldwide, -+ [RTW_REGD_STATE_PROGRAMMED] = rtw_regd_mgmt_programmed, -+ [RTW_REGD_STATE_SETTING] = rtw_regd_mgmt_setting, -+}; -+ -+static bool rtw_regd_state_hdl(struct rtw_dev *rtwdev, -+ struct rtw_regd *next_regd, -+ struct regulatory_request *request) -+{ -+ next_regd->regulatory = rtw_reg_find_by_name(request->alpha2); -+ next_regd->dfs_region = request->dfs_region; -+ return rtw_regd_handler[rtwdev->regd.state](rtwdev, next_regd, request); -+} -+ -+static - void rtw_regd_notifier(struct wiphy *wiphy, struct regulatory_request *request) - { - struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy); - struct rtw_dev *rtwdev = hw->priv; - struct rtw_hal *hal = &rtwdev->hal; -+ struct rtw_regd next_regd = {0}; -+ bool hdl; -+ -+ hdl = rtw_regd_state_hdl(rtwdev, &next_regd, request); -+ if (!hdl) { -+ rtw_dbg(rtwdev, RTW_DBG_REGD, -+ "regd state %d: ignore request %c%c of initiator %d\n", -+ rtwdev->regd.state, -+ request->alpha2[0], -+ request->alpha2[1], -+ request->initiator); -+ return; -+ } -+ -+ rtw_dbg(rtwdev, RTW_DBG_REGD, "regd state: %d -> %d\n", -+ rtwdev->regd.state, next_regd.state); - -- rtw_regd_notifier_apply(rtwdev, wiphy, request); -- rtw_dbg(rtwdev, RTW_DBG_REGD, -- "get alpha2 %c%c from initiator %d, mapping to chplan 0x%x, txregd %d\n", -- request->alpha2[0], request->alpha2[1], request->initiator, -- rtwdev->regd.chplan, rtwdev->regd.txpwr_regd); -+ mutex_lock(&rtwdev->mutex); -+ rtwdev->regd = next_regd; -+ rtw_dbg_regd_dump(rtwdev, "get alpha2 %c%c from initiator %d: ", -+ request->alpha2[0], -+ request->alpha2[1], -+ request->initiator); - -+ rtw_phy_adaptivity_set_mode(rtwdev); - rtw_phy_set_tx_power_level(rtwdev, hal->current_channel); -+ mutex_unlock(&rtwdev->mutex); -+} -+ -+u8 rtw_regd_get(struct rtw_dev *rtwdev) -+{ -+ struct rtw_hal *hal = &rtwdev->hal; -+ u8 band = hal->current_band_type; -+ -+ return band == RTW_BAND_2G ? -+ rtwdev->regd.regulatory->txpwr_regd_2g : -+ rtwdev->regd.regulatory->txpwr_regd_5g; -+} -+EXPORT_SYMBOL(rtw_regd_get); -+ -+struct rtw_regd_alternative_t { -+ bool set; -+ u8 alt; -+}; -+ -+#define DECL_REGD_ALT(_regd, _regd_alt) \ -+ [(_regd)] = {.set = true, .alt = (_regd_alt)} -+ -+static const struct rtw_regd_alternative_t -+rtw_regd_alt[RTW_REGD_MAX] = { -+ DECL_REGD_ALT(RTW_REGD_IC, RTW_REGD_FCC), -+ DECL_REGD_ALT(RTW_REGD_KCC, RTW_REGD_ETSI), -+ DECL_REGD_ALT(RTW_REGD_ACMA, RTW_REGD_ETSI), -+ DECL_REGD_ALT(RTW_REGD_CHILE, RTW_REGD_FCC), -+ DECL_REGD_ALT(RTW_REGD_UKRAINE, RTW_REGD_ETSI), -+ DECL_REGD_ALT(RTW_REGD_MEXICO, RTW_REGD_FCC), -+ DECL_REGD_ALT(RTW_REGD_CN, RTW_REGD_ETSI), -+}; -+ -+bool rtw_regd_has_alt(u8 regd, u8 *regd_alt) -+{ -+ if (!rtw_regd_alt[regd].set) -+ return false; -+ -+ *regd_alt = rtw_regd_alt[regd].alt; -+ return true; - } -diff --git a/drivers/net/wireless/realtek/rtw88/regd.h b/drivers/net/wireless/realtek/rtw88/regd.h -index 5d4578331..34cb13d0c 100644 ---- a/drivers/net/wireless/realtek/rtw88/regd.h -+++ b/drivers/net/wireless/realtek/rtw88/regd.h -@@ -64,8 +64,8 @@ enum country_code_type { - COUNTRY_CODE_MAX - }; - --int rtw_regd_init(struct rtw_dev *rtwdev, -- void (*reg_notifier)(struct wiphy *wiphy, -- struct regulatory_request *request)); --void rtw_regd_notifier(struct wiphy *wiphy, struct regulatory_request *request); -+int rtw_regd_init(struct rtw_dev *rtwdev); -+int rtw_regd_hint(struct rtw_dev *rtwdev); -+u8 rtw_regd_get(struct rtw_dev *rtwdev); -+bool rtw_regd_has_alt(u8 regd, u8 *regd_alt); - #endif -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8723d.c b/drivers/net/wireless/realtek/rtw88/rtw8723d.c -index 3ddd170f1..c575476a0 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8723d.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8723d.c -@@ -60,8 +60,8 @@ static const struct rtw_hw_reg rtw8723d_txagc[] = { - #define WLAN_MAX_AGG_NR 0x0A - #define WLAN_AMPDU_MAX_TIME 0x1C - #define WLAN_ANT_SEL 0x82 --#define WLAN_LTR_IDLE_LAT 0x883C883C --#define WLAN_LTR_ACT_LAT 0x880B880B -+#define WLAN_LTR_IDLE_LAT 0x90039003 -+#define WLAN_LTR_ACT_LAT 0x883c883c - #define WLAN_LTR_CTRL1 0xCB004010 - #define WLAN_LTR_CTRL2 0x01233425 - -@@ -192,6 +192,7 @@ static void rtw8723d_phy_set_param(struct rtw_dev *rtwdev) - rtw_write32(rtwdev, REG_LTR_CTRL_BASIC + 4, WLAN_LTR_CTRL2); - - rtw_phy_init(rtwdev); -+ rtwdev->dm_info.cck_pd_default = rtw_read8(rtwdev, REG_CSRATIO) & 0x1f; - - rtw_write16_set(rtwdev, REG_TXDMA_OFFSET_CHK, BIT_DROP_DATA_EN); - -@@ -209,6 +210,18 @@ static void rtw8723de_efuse_parsing(struct rtw_efuse *efuse, - ether_addr_copy(efuse->addr, map->e.mac_addr); - } - -+static void rtw8723du_efuse_parsing(struct rtw_efuse *efuse, -+ struct rtw8723d_efuse *map) -+{ -+ ether_addr_copy(efuse->addr, map->u.mac_addr); -+} -+ -+static void rtw8723ds_efuse_parsing(struct rtw_efuse *efuse, -+ struct rtw8723d_efuse *map) -+{ -+ ether_addr_copy(efuse->addr, map->s.mac_addr); -+} -+ - static int rtw8723d_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) - { - struct rtw_efuse *efuse = &rtwdev->efuse; -@@ -238,6 +251,12 @@ static int rtw8723d_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) - case RTW_HCI_TYPE_PCIE: - rtw8723de_efuse_parsing(efuse, map); - break; -+ case RTW_HCI_TYPE_USB: -+ rtw8723du_efuse_parsing(efuse, map); -+ break; -+ case RTW_HCI_TYPE_SDIO: -+ rtw8723ds_efuse_parsing(efuse, map); -+ break; - default: - /* unsupported now */ - return -ENOTSUPP; -@@ -1498,6 +1517,34 @@ static void rtw8723d_phy_calibration(struct rtw_dev *rtwdev) - rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] finished\n"); - } - -+static void rtw8723d_phy_cck_pd_set(struct rtw_dev *rtwdev, u8 new_lvl) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ u8 pd[CCK_PD_LV_MAX] = {3, 7, 13, 13, 13}; -+ u8 cck_n_rx; -+ -+ rtw_dbg(rtwdev, RTW_DBG_PHY, "lv: (%d) -> (%d)\n", -+ dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A], new_lvl); -+ -+ if (dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A] == new_lvl) -+ return; -+ -+ cck_n_rx = (rtw_read8_mask(rtwdev, REG_CCK0_FAREPORT, BIT_CCK0_2RX) && -+ rtw_read8_mask(rtwdev, REG_CCK0_FAREPORT, BIT_CCK0_MRC)) ? 2 : 1; -+ rtw_dbg(rtwdev, RTW_DBG_PHY, -+ "is_linked=%d, lv=%d, n_rx=%d, cs_ratio=0x%x, pd_th=0x%x, cck_fa_avg=%d\n", -+ rtw_is_assoc(rtwdev), new_lvl, cck_n_rx, -+ dm_info->cck_pd_default + new_lvl * 2, -+ pd[new_lvl], dm_info->cck_fa_avg); -+ -+ dm_info->cck_fa_avg = CCK_FA_AVG_RESET; -+ -+ dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A] = new_lvl; -+ rtw_write32_mask(rtwdev, REG_PWRTH, 0x3f0000, pd[new_lvl]); -+ rtw_write32_mask(rtwdev, REG_PWRTH2, 0x1f0000, -+ dm_info->cck_pd_default + new_lvl * 2); -+} -+ - /* for coex */ - static void rtw8723d_coex_cfg_init(struct rtw_dev *rtwdev) - { -@@ -1506,14 +1553,14 @@ static void rtw8723d_coex_cfg_init(struct rtw_dev *rtwdev) - - /* BT report packet sample rate */ - /* 0x790[5:0]=0x5 */ -- rtw_write8_set(rtwdev, REG_BT_TDMA_TIME, 0x05); -+ rtw_write8_mask(rtwdev, REG_BT_TDMA_TIME, BIT_MASK_SAMPLE_RATE, 0x5); - - /* enable BT counter statistics */ - rtw_write8(rtwdev, REG_BT_STAT_CTRL, 0x1); - - /* enable PTA (3-wire function form BT side) */ - rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_PTA_EN); -- rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_AOD_GPIO3); -+ rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_PO_BT_PTA_PINS); - - /* enable PTA (tx/rx signal form WiFi side) */ - rtw_write8_set(rtwdev, REG_QUEUE_CTRL, BIT_PTA_WL_TX_EN); -@@ -1916,6 +1963,26 @@ static void rtw8723d_pwr_track(struct rtw_dev *rtwdev) - dm_info->pwr_trk_triggered = false; - } - -+static void rtw8723d_fill_txdesc_checksum(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ u8 *txdesc) -+{ -+ size_t words = 32 / 2; /* calculate the first 32 bytes (16 words) */ -+ __le16 chksum = 0; -+ __le16 *data = (__le16 *)(txdesc); -+ struct rtw_tx_desc *tx_desc = (struct rtw_tx_desc *)txdesc; -+ -+ le32p_replace_bits(&tx_desc->w7, 0, RTW_TX_DESC_W7_TXDESC_CHECKSUM); -+ -+ while (words--) -+ chksum ^= *data++; -+ -+ chksum = ~chksum; -+ -+ le32p_replace_bits(&tx_desc->w7, __le16_to_cpu(chksum), -+ RTW_TX_DESC_W7_TXDESC_CHECKSUM); -+} -+ - static struct rtw_chip_ops rtw8723d_ops = { - .phy_set_param = rtw8723d_phy_set_param, - .read_efuse = rtw8723d_read_efuse, -@@ -1931,10 +1998,12 @@ static struct rtw_chip_ops rtw8723d_ops = { - .efuse_grant = rtw8723d_efuse_grant, - .false_alarm_statistics = rtw8723d_false_alarm_statistics, - .phy_calibration = rtw8723d_phy_calibration, -+ .cck_pd_set = rtw8723d_phy_cck_pd_set, - .pwr_track = rtw8723d_pwr_track, - .config_bfee = NULL, - .set_gid_table = NULL, - .cfg_csi_rate = NULL, -+ .fill_txdesc_checksum = rtw8723d_fill_txdesc_checksum, - - .coex_set_init = rtw8723d_coex_cfg_init, - .coex_set_ant_switch = NULL, -@@ -1949,19 +2018,19 @@ static struct rtw_chip_ops rtw8723d_ops = { - static const struct coex_table_para table_sant_8723d[] = { - {0xffffffff, 0xffffffff}, /* case-0 */ - {0x55555555, 0x55555555}, -- {0x65555555, 0x65555555}, -+ {0x66555555, 0x66555555}, - {0xaaaaaaaa, 0xaaaaaaaa}, - {0x5a5a5a5a, 0x5a5a5a5a}, - {0xfafafafa, 0xfafafafa}, /* case-5 */ -- {0xa5555555, 0xaaaa5aaa}, -- {0x6a5a5a5a, 0x5a5a5a5a}, -+ {0x6a5a5555, 0xaaaaaaaa}, -+ {0x6a5a56aa, 0x6a5a56aa}, - {0x6a5a5a5a, 0x6a5a5a5a}, - {0x66555555, 0x5a5a5a5a}, -- {0x65555555, 0x6a5a5a5a}, /* case-10 */ -- {0x65555555, 0xfafafafa}, -+ {0x66555555, 0x6a5a5a5a}, /* case-10 */ -+ {0x66555555, 0x6a5a5aaa}, - {0x66555555, 0x5a5a5aaa}, -- {0x65555555, 0x5aaa5aaa}, -- {0x65555555, 0xaaaa5aaa}, -+ {0x66555555, 0x6aaa5aaa}, -+ {0x66555555, 0xaaaa5aaa}, - {0x66555555, 0xaaaaaaaa}, /* case-15 */ - {0xffff55ff, 0xfafafafa}, - {0xffff55ff, 0x6afa5afa}, -@@ -1970,38 +2039,41 @@ static const struct coex_table_para table_sant_8723d[] = { - {0xaa5555aa, 0x6a5a5a5a}, /* case-20 */ - {0xaa5555aa, 0xaaaaaaaa}, - {0xffffffff, 0x5a5a5a5a}, -- {0xffffffff, 0x6a5a5a5a}, -+ {0xffffffff, 0x5a5a5a5a}, - {0xffffffff, 0x55555555}, -- {0xffffffff, 0x6a5a5aaa}, /* case-25 */ -+ {0xffffffff, 0x5a5a5aaa}, /* case-25 */ - {0x55555555, 0x5a5a5a5a}, - {0x55555555, 0xaaaaaaaa}, -- {0x55555555, 0x6a6a6a6a}, -- {0x656a656a, 0x656a656a} -+ {0x55555555, 0x6a5a6a5a}, -+ {0x66556655, 0x66556655}, -+ {0x66556aaa, 0x6a5a6aaa}, /* case-30 */ -+ {0xffffffff, 0x5aaa5aaa}, -+ {0x56555555, 0x5a5a5aaa}, - }; - - /* Non-Shared-Antenna Coex Table */ - static const struct coex_table_para table_nsant_8723d[] = { - {0xffffffff, 0xffffffff}, /* case-100 */ - {0x55555555, 0x55555555}, -- {0x65555555, 0x65555555}, -+ {0x66555555, 0x66555555}, - {0xaaaaaaaa, 0xaaaaaaaa}, - {0x5a5a5a5a, 0x5a5a5a5a}, - {0xfafafafa, 0xfafafafa}, /* case-105 */ - {0x5afa5afa, 0x5afa5afa}, - {0x55555555, 0xfafafafa}, -- {0x65555555, 0xfafafafa}, -- {0x65555555, 0x5a5a5a5a}, -- {0x65555555, 0x6a5a5a5a}, /* case-110 */ -- {0x65555555, 0xaaaaaaaa}, -+ {0x66555555, 0xfafafafa}, -+ {0x66555555, 0x5a5a5a5a}, -+ {0x66555555, 0x6a5a5a5a}, /* case-110 */ -+ {0x66555555, 0xaaaaaaaa}, - {0xffff55ff, 0xfafafafa}, - {0xffff55ff, 0x5afa5afa}, - {0xffff55ff, 0xaaaaaaaa}, -- {0xaaffffaa, 0xfafafafa}, /* case-115 */ -+ {0xffff55ff, 0xffff55ff}, /* case-115 */ - {0xaaffffaa, 0x5afa5afa}, - {0xaaffffaa, 0xaaaaaaaa}, - {0xffffffff, 0xfafafafa}, - {0xffffffff, 0x5afa5afa}, -- {0xffffffff, 0xaaaaaaaa},/* case-120 */ -+ {0xffffffff, 0xaaaaaaaa}, /* case-120 */ - {0x55ff55ff, 0x5afa5afa}, - {0x55ff55ff, 0xaaaaaaaa}, - {0x55ff55ff, 0x55ff55ff} -@@ -2009,31 +2081,31 @@ static const struct coex_table_para table_nsant_8723d[] = { - - /* Shared-Antenna TDMA */ - static const struct coex_tdma_para tdma_sant_8723d[] = { -- { {0x08, 0x00, 0x00, 0x00, 0x00} }, /* case-0 */ -+ { {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-0 */ - { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-1 */ - { {0x61, 0x3a, 0x03, 0x11, 0x11} }, -- { {0x61, 0x20, 0x03, 0x11, 0x11} }, - { {0x61, 0x30, 0x03, 0x11, 0x11} }, -+ { {0x61, 0x20, 0x03, 0x11, 0x11} }, - { {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-5 */ -- { {0x61, 0x48, 0x03, 0x11, 0x10} }, -+ { {0x61, 0x45, 0x03, 0x11, 0x10} }, - { {0x61, 0x3a, 0x03, 0x11, 0x10} }, - { {0x61, 0x30, 0x03, 0x11, 0x10} }, - { {0x61, 0x20, 0x03, 0x11, 0x10} }, - { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-10 */ -- { {0x61, 0x10, 0x03, 0x11, 0x14} }, -+ { {0x61, 0x08, 0x03, 0x11, 0x14} }, - { {0x61, 0x08, 0x03, 0x10, 0x14} }, -- { {0x51, 0x10, 0x03, 0x10, 0x54} }, -- { {0x51, 0x10, 0x03, 0x10, 0x55} }, -- { {0x51, 0x10, 0x07, 0x10, 0x54} }, /* case-15 */ -+ { {0x51, 0x08, 0x03, 0x10, 0x54} }, -+ { {0x51, 0x08, 0x03, 0x10, 0x55} }, -+ { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-15 */ - { {0x51, 0x45, 0x03, 0x10, 0x50} }, - { {0x51, 0x3a, 0x03, 0x10, 0x50} }, - { {0x51, 0x30, 0x03, 0x10, 0x50} }, - { {0x51, 0x20, 0x03, 0x10, 0x50} }, -- { {0x51, 0x15, 0x03, 0x10, 0x50} }, /* case-20 */ -+ { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-20 */ - { {0x51, 0x4a, 0x03, 0x10, 0x50} }, - { {0x51, 0x0c, 0x03, 0x10, 0x54} }, - { {0x55, 0x08, 0x03, 0x10, 0x54} }, -- { {0x65, 0x10, 0x03, 0x11, 0x11} }, -+ { {0x65, 0x10, 0x03, 0x11, 0x10} }, - { {0x51, 0x10, 0x03, 0x10, 0x51} }, /* case-25 */ - { {0x51, 0x08, 0x03, 0x10, 0x50} }, - { {0x61, 0x08, 0x03, 0x11, 0x11} } -@@ -2041,7 +2113,7 @@ static const struct coex_tdma_para tdma_sant_8723d[] = { - - /* Non-Shared-Antenna TDMA */ - static const struct coex_tdma_para tdma_nsant_8723d[] = { -- { {0x00, 0x00, 0x00, 0x40, 0x01} }, /* case-100 */ -+ { {0x00, 0x00, 0x00, 0x00, 0x01} }, /* case-100 */ - { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-101 */ - { {0x61, 0x3a, 0x03, 0x11, 0x11} }, - { {0x61, 0x30, 0x03, 0x11, 0x11} }, -@@ -2062,7 +2134,7 @@ static const struct coex_tdma_para tdma_nsant_8723d[] = { - { {0x51, 0x30, 0x03, 0x10, 0x50} }, - { {0x51, 0x20, 0x03, 0x10, 0x50} }, - { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-120 */ -- { {0x51, 0x08, 0x03, 0x10, 0x50} }, -+ { {0x51, 0x08, 0x03, 0x10, 0x50} } - }; - - /* rssi in percentage % (dbm = % - 100) */ -@@ -2668,7 +2740,7 @@ static const struct rtw_reg_domain coex_info_hw_regs_8723d[] = { - {0x953, BIT(1), RTW_REG_DOMAIN_MAC8}, - }; - --struct rtw_chip_info rtw8723d_hw_spec = { -+const struct rtw_chip_info rtw8723d_hw_spec = { - .ops = &rtw8723d_ops, - .id = RTW_CHIP_TYPE_8723D, - .fw_name = "rtw88/rtw8723d_fw.bin", -@@ -2682,12 +2754,13 @@ struct rtw_chip_info rtw8723d_hw_spec = { - .ptct_efuse_size = 96 + 1, - .txff_size = 32768, - .rxff_size = 16384, -+ .rsvd_drv_pg_num = 8, - .txgi_factor = 1, - .is_pwr_by_rate_dec = true, - .max_power_index = 0x3f, - .csi_buf_pg_num = 0, - .band = RTW_BAND_2G, -- .page_size = 128, -+ .page_size = TX_PAGE_SIZE, - .dig_min = 0x20, - .ht_supported = true, - .vht_supported = false, -@@ -2714,11 +2787,15 @@ struct rtw_chip_info rtw8723d_hw_spec = { - .rx_ldpc = false, - .pwr_track_tbl = &rtw8723d_rtw_pwr_track_tbl, - .iqk_threshold = 8, -+ .ampdu_density = IEEE80211_HT_MPDU_DENSITY_16, -+ .max_scan_ie_len = IEEE80211_MAX_DATA_LEN, - - .coex_para_ver = 0x2007022f, - .bt_desired_ver = 0x2f, - .scbd_support = true, - .new_scbd10_def = true, -+ .ble_hid_profile_support = false, -+ .wl_mimo_ps_support = false, - .pstdma_type = COEX_PSTDMA_FORCE_LPSOFF, - .bt_rssi_type = COEX_BTRSSI_RATIO, - .ant_isolation = 15, -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8723d.h b/drivers/net/wireless/realtek/rtw88/rtw8723d.h -index 7894d321c..3642a2c7f 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8723d.h -+++ b/drivers/net/wireless/realtek/rtw88/rtw8723d.h -@@ -41,6 +41,19 @@ struct rtw8723de_efuse { - u8 sub_device_id[2]; - }; - -+struct rtw8723du_efuse { -+ u8 res4[48]; /* 0xd0 */ -+ u8 vender_id[2]; /* 0x100 */ -+ u8 product_id[2]; /* 0x102 */ -+ u8 usb_option; /* 0x104 */ -+ u8 mac_addr[ETH_ALEN]; /* 0x107 */ -+}; -+ -+struct rtw8723ds_efuse { -+ u8 res4[0x4a]; /* 0xd0 */ -+ u8 mac_addr[ETH_ALEN]; /* 0x11a */ -+}; -+ - struct rtw8723d_efuse { - __le16 rtl_id; - u8 rsvd[2]; -@@ -69,9 +82,15 @@ struct rtw8723d_efuse { - u8 rfe_option; - u8 country_code[2]; - u8 res[3]; -- struct rtw8723de_efuse e; -+ union { -+ struct rtw8723de_efuse e; -+ struct rtw8723du_efuse u; -+ struct rtw8723ds_efuse s; -+ }; - }; - -+extern const struct rtw_chip_info rtw8723d_hw_spec; -+ - /* phy status page0 */ - #define GET_PHY_STAT_P0_PWDB(phy_stat) \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(15, 8)) -@@ -163,6 +182,7 @@ static inline s32 iqk_mult(s32 x, s32 y, s32 *ext) - #define REG_CCK0_SYS 0x0a00 - #define BIT_CCK_SIDE_BAND BIT(4) - #define REG_CCK_ANT_SEL_11N 0x0a04 -+#define REG_PWRTH 0x0a08 - #define REG_CCK_FA_RST_11N 0x0a2c - #define BIT_MASK_CCK_CNT_KEEP BIT(12) - #define BIT_MASK_CCK_CNT_EN BIT(13) -@@ -175,6 +195,8 @@ static inline s32 iqk_mult(s32 x, s32 y, s32 *ext) - #define REG_CCK_CCA_CNT_11N 0x0a60 - #define BIT_MASK_CCK_FA_MSB GENMASK(7, 0) - #define BIT_MASK_CCK_FA_LSB GENMASK(15, 8) -+#define REG_PWRTH2 0x0aa8 -+#define REG_CSRATIO 0x0aaa - #define REG_OFDM_FA_HOLDC_11N 0x0c00 - #define BIT_MASK_OFDM_FA_KEEP BIT(31) - #define REG_BB_RX_PATH_11N 0x0c04 -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8723de.c b/drivers/net/wireless/realtek/rtw88/rtw8723de.c -index c81eb4c33..abbaafa32 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8723de.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8723de.c -@@ -4,7 +4,8 @@ - - #include - #include --#include "rtw8723de.h" -+#include "pci.h" -+#include "rtw8723d.h" - - static const struct pci_device_id rtw_8723de_id_table[] = { - { -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8723ds.c b/drivers/net/wireless/realtek/rtw88/rtw8723ds.c -new file mode 100644 -index 000000000..f1ffffe42 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/rtw8723ds.c -@@ -0,0 +1,41 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright(c) Martin Blumenstingl -+ */ -+ -+#include -+#include "sdio_ids.h" -+#include -+#include "main.h" -+#include "rtw8723d.h" -+#include "sdio.h" -+ -+static const struct sdio_device_id rtw_8723ds_id_table[] = { -+ { -+ SDIO_DEVICE(SDIO_VENDOR_ID_REALTEK, -+ SDIO_DEVICE_ID_REALTEK_RTW8723DS_1ANT), -+ .driver_data = (kernel_ulong_t)&rtw8723d_hw_spec, -+ }, -+ { -+ SDIO_DEVICE(SDIO_VENDOR_ID_REALTEK, -+ SDIO_DEVICE_ID_REALTEK_RTW8723DS_2ANT), -+ .driver_data = (kernel_ulong_t)&rtw8723d_hw_spec, -+ }, -+ {} -+}; -+MODULE_DEVICE_TABLE(sdio, rtw_8723ds_id_table); -+ -+static struct sdio_driver rtw_8723ds_driver = { -+ .name = "rtw_8723ds", -+ .probe = rtw_sdio_probe, -+ .remove = rtw_sdio_remove, -+ .id_table = rtw_8723ds_id_table, -+ .drv = { -+ .pm = &rtw_sdio_pm_ops, -+ .shutdown = rtw_sdio_shutdown, -+ } -+}; -+module_sdio_driver(rtw_8723ds_driver); -+ -+MODULE_AUTHOR("Martin Blumenstingl "); -+MODULE_DESCRIPTION("Realtek 802.11n wireless 8723ds driver"); -+MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8723du.c b/drivers/net/wireless/realtek/rtw88/rtw8723du.c -new file mode 100644 -index 000000000..322a805da ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/rtw8723du.c -@@ -0,0 +1,36 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright(c) 2018-2019 Realtek Corporation -+ */ -+ -+#include -+#include -+#include "main.h" -+#include "rtw8723d.h" -+#include "usb.h" -+ -+static const struct usb_device_id rtw_8723du_id_table[] = { -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xd723, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8723d_hw_spec) }, /* 8723DU 1*1 */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xd611, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8723d_hw_spec) }, /* Edimax EW-7611ULB V2 */ -+ { }, -+}; -+MODULE_DEVICE_TABLE(usb, rtw_8723du_id_table); -+ -+static int rtw8723du_probe(struct usb_interface *intf, -+ const struct usb_device_id *id) -+{ -+ return rtw_usb_probe(intf, id); -+} -+ -+static struct usb_driver rtw_8723du_driver = { -+ .name = "rtw_8723du", -+ .id_table = rtw_8723du_id_table, -+ .probe = rtw8723du_probe, -+ .disconnect = rtw_usb_disconnect, -+}; -+module_usb_driver(rtw_8723du_driver); -+ -+MODULE_AUTHOR("Hans Ulli Kroll "); -+MODULE_DESCRIPTION("Realtek 802.11n wireless 8723du driver"); -+MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8821c.c b/drivers/net/wireless/realtek/rtw88/rtw8821c.c -index f9615f76f..adf224618 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8821c.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8821c.c -@@ -14,6 +14,11 @@ - #include "reg.h" - #include "debug.h" - #include "bf.h" -+#include "regd.h" -+ -+static const s8 lna_gain_table_0[8] = {22, 8, -6, -22, -31, -40, -46, -52}; -+static const s8 lna_gain_table_1[16] = {10, 6, 2, -2, -6, -10, -14, -17, -+ -20, -24, -28, -31, -34, -37, -40, -44}; - - static void rtw8821ce_efuse_parsing(struct rtw_efuse *efuse, - struct rtw8821c_efuse *map) -@@ -21,15 +26,35 @@ static void rtw8821ce_efuse_parsing(struct rtw_efuse *efuse, - ether_addr_copy(efuse->addr, map->e.mac_addr); - } - -+static void rtw8821cu_efuse_parsing(struct rtw_efuse *efuse, -+ struct rtw8821c_efuse *map) -+{ -+ ether_addr_copy(efuse->addr, map->u.mac_addr); -+} -+ -+static void rtw8821cs_efuse_parsing(struct rtw_efuse *efuse, -+ struct rtw8821c_efuse *map) -+{ -+ ether_addr_copy(efuse->addr, map->s.mac_addr); -+} -+ -+enum rtw8821ce_rf_set { -+ SWITCH_TO_BTG, -+ SWITCH_TO_WLG, -+ SWITCH_TO_WLA, -+ SWITCH_TO_BT, -+}; -+ - static int rtw8821c_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) - { -+ struct rtw_hal *hal = &rtwdev->hal; - struct rtw_efuse *efuse = &rtwdev->efuse; - struct rtw8821c_efuse *map; - int i; - - map = (struct rtw8821c_efuse *)log_map; - -- efuse->rfe_option = map->rfe_option; -+ efuse->rfe_option = map->rfe_option & 0x1f; - efuse->rf_board_option = map->rf_board_option; - efuse->crystal_cap = map->xtal_k; - efuse->pa_type_2g = map->pa_type; -@@ -46,13 +71,35 @@ static int rtw8821c_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) - efuse->tx_bb_swing_setting_2g = map->tx_bb_swing_setting_2g; - efuse->tx_bb_swing_setting_5g = map->tx_bb_swing_setting_5g; - -+ hal->pkg_type = map->rfe_option & BIT(5) ? 1 : 0; -+ -+ switch (efuse->rfe_option) { -+ case 0x2: -+ case 0x4: -+ case 0x7: -+ case 0xa: -+ case 0xc: -+ case 0xf: -+ hal->rfe_btg = true; -+ break; -+ } -+ - for (i = 0; i < 4; i++) - efuse->txpwr_idx_table[i] = map->txpwr_idx_table[i]; - -+ if (rtwdev->efuse.rfe_option == 2 || rtwdev->efuse.rfe_option == 4) -+ efuse->txpwr_idx_table[0].pwr_idx_2g = map->txpwr_idx_table[1].pwr_idx_2g; -+ - switch (rtw_hci_type(rtwdev)) { - case RTW_HCI_TYPE_PCIE: - rtw8821ce_efuse_parsing(efuse, map); - break; -+ case RTW_HCI_TYPE_USB: -+ rtw8821cu_efuse_parsing(efuse, map); -+ break; -+ case RTW_HCI_TYPE_SDIO: -+ rtw8821cs_efuse_parsing(efuse, map); -+ break; - default: - /* unsupported now */ - return -ENOTSUPP; -@@ -110,6 +157,7 @@ static void rtw8821c_phy_bf_init(struct rtw_dev *rtwdev) - - static void rtw8821c_phy_set_param(struct rtw_dev *rtwdev) - { -+ struct rtw_hal *hal = &rtwdev->hal; - u8 crystal_cap, val; - - /* power on BB/RF domain */ -@@ -144,9 +192,9 @@ static void rtw8821c_phy_set_param(struct rtw_dev *rtwdev) - - /* post init after header files config */ - rtw_write32_set(rtwdev, REG_RXPSEL, BIT_RX_PSEL_RST); -- rtwdev->chip->ch_param[0] = rtw_read32_mask(rtwdev, REG_TXSF2, MASKDWORD); -- rtwdev->chip->ch_param[1] = rtw_read32_mask(rtwdev, REG_TXSF6, MASKDWORD); -- rtwdev->chip->ch_param[2] = rtw_read32_mask(rtwdev, REG_TXFILTER, MASKDWORD); -+ hal->ch_param[0] = rtw_read32_mask(rtwdev, REG_TXSF2, MASKDWORD); -+ hal->ch_param[1] = rtw_read32_mask(rtwdev, REG_TXSF6, MASKDWORD); -+ hal->ch_param[2] = rtw_read32_mask(rtwdev, REG_TXFILTER, MASKDWORD); - - rtw_phy_init(rtwdev); - rtwdev->dm_info.cck_pd_default = rtw_read8(rtwdev, REG_CSRATIO) & 0x1f; -@@ -208,7 +256,8 @@ static int rtw8821c_mac_init(struct rtw_dev *rtwdev) - rtw_write8(rtwdev, REG_TCR + 1, WLAN_TX_FUNC_CFG1); - rtw_write8(rtwdev, REG_ACKTO_CCK, 0x40); - rtw_write8_set(rtwdev, REG_WMAC_TRXPTCL_CTL_H, BIT(1)); -- rtw_write8_set(rtwdev, REG_SND_PTCL_CTRL, BIT(6)); -+ rtw_write8_set(rtwdev, REG_SND_PTCL_CTRL, -+ BIT_DIS_CHK_VHTSIGB_CRC); - rtw_write32(rtwdev, REG_WMAC_OPTION_FUNCTION + 8, WLAN_MAC_OPT_FUNC2); - rtw_write8(rtwdev, REG_WMAC_OPTION_FUNCTION + 4, WLAN_MAC_OPT_NORM_FUNC1); - -@@ -224,8 +273,43 @@ static void rtw8821c_cfg_ldo25(struct rtw_dev *rtwdev, bool enable) - rtw_write8(rtwdev, REG_LDO_EFUSE_CTRL + 3, ldo_pwr); - } - -+static void rtw8821c_switch_rf_set(struct rtw_dev *rtwdev, u8 rf_set) -+{ -+ u32 reg; -+ -+ rtw_write32_set(rtwdev, REG_DMEM_CTRL, BIT_WL_RST); -+ rtw_write32_set(rtwdev, REG_SYS_CTRL, BIT_FEN_EN); -+ -+ reg = rtw_read32(rtwdev, REG_RFECTL); -+ switch (rf_set) { -+ case SWITCH_TO_BTG: -+ reg |= B_BTG_SWITCH; -+ reg &= ~(B_CTRL_SWITCH | B_WL_SWITCH | B_WLG_SWITCH | -+ B_WLA_SWITCH); -+ rtw_write32_mask(rtwdev, REG_ENRXCCA, MASKBYTE2, BTG_CCA); -+ rtw_write32_mask(rtwdev, REG_ENTXCCK, MASKLWORD, BTG_LNA); -+ break; -+ case SWITCH_TO_WLG: -+ reg |= B_WL_SWITCH | B_WLG_SWITCH; -+ reg &= ~(B_BTG_SWITCH | B_CTRL_SWITCH | B_WLA_SWITCH); -+ rtw_write32_mask(rtwdev, REG_ENRXCCA, MASKBYTE2, WLG_CCA); -+ rtw_write32_mask(rtwdev, REG_ENTXCCK, MASKLWORD, WLG_LNA); -+ break; -+ case SWITCH_TO_WLA: -+ reg |= B_WL_SWITCH | B_WLA_SWITCH; -+ reg &= ~(B_BTG_SWITCH | B_CTRL_SWITCH | B_WLG_SWITCH); -+ break; -+ case SWITCH_TO_BT: -+ default: -+ break; -+ } -+ -+ rtw_write32(rtwdev, REG_RFECTL, reg); -+} -+ - static void rtw8821c_set_channel_rf(struct rtw_dev *rtwdev, u8 channel, u8 bw) - { -+ struct rtw_hal *hal = &rtwdev->hal; - u32 rf_reg18; - - rf_reg18 = rtw_read_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK); -@@ -257,9 +341,14 @@ static void rtw8821c_set_channel_rf(struct rtw_dev *rtwdev, u8 channel, u8 bw) - } - - if (channel <= 14) { -+ if (hal->rfe_btg) -+ rtw8821c_switch_rf_set(rtwdev, SWITCH_TO_BTG); -+ else -+ rtw8821c_switch_rf_set(rtwdev, SWITCH_TO_WLG); - rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTDBG, BIT(6), 0x1); - rtw_write_rf(rtwdev, RF_PATH_A, 0x64, 0xf, 0xf); - } else { -+ rtw8821c_switch_rf_set(rtwdev, SWITCH_TO_WLA); - rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTDBG, BIT(6), 0x0); - } - -@@ -295,6 +384,7 @@ static void rtw8821c_set_channel_rxdfir(struct rtw_dev *rtwdev, u8 bw) - static void rtw8821c_set_channel_bb(struct rtw_dev *rtwdev, u8 channel, u8 bw, - u8 primary_ch_idx) - { -+ struct rtw_hal *hal = &rtwdev->hal; - u32 val32; - - if (channel <= 14) { -@@ -311,11 +401,11 @@ static void rtw8821c_set_channel_bb(struct rtw_dev *rtwdev, u8 channel, u8 bw, - rtw_write32_mask(rtwdev, REG_TXFILTER, MASKDWORD, 0x00003667); - } else { - rtw_write32_mask(rtwdev, REG_TXSF2, MASKDWORD, -- rtwdev->chip->ch_param[0]); -+ hal->ch_param[0]); - rtw_write32_mask(rtwdev, REG_TXSF6, MASKLWORD, -- rtwdev->chip->ch_param[1] & MASKLWORD); -+ hal->ch_param[1] & MASKLWORD); - rtw_write32_mask(rtwdev, REG_TXFILTER, MASKDWORD, -- rtwdev->chip->ch_param[2]); -+ hal->ch_param[2]); - } - } else if (channel > 35) { - rtw_write32_mask(rtwdev, REG_ENTXCCK, BIT(18), 0x1); -@@ -426,22 +516,57 @@ static void rtw8821c_set_channel(struct rtw_dev *rtwdev, u8 channel, u8 bw, - rtw8821c_set_channel_rxdfir(rtwdev, bw); - } - -+static s8 get_cck_rx_pwr(struct rtw_dev *rtwdev, u8 lna_idx, u8 vga_idx) -+{ -+ struct rtw_efuse *efuse = &rtwdev->efuse; -+ const s8 *lna_gain_table; -+ int lna_gain_table_size; -+ s8 rx_pwr_all = 0; -+ s8 lna_gain = 0; -+ -+ if (efuse->rfe_option == 0) { -+ lna_gain_table = lna_gain_table_0; -+ lna_gain_table_size = ARRAY_SIZE(lna_gain_table_0); -+ } else { -+ lna_gain_table = lna_gain_table_1; -+ lna_gain_table_size = ARRAY_SIZE(lna_gain_table_1); -+ } -+ -+ if (lna_idx >= lna_gain_table_size) { -+ rtw_warn(rtwdev, "incorrect lna index (%d)\n", lna_idx); -+ return -120; -+ } -+ -+ lna_gain = lna_gain_table[lna_idx]; -+ rx_pwr_all = lna_gain - 2 * vga_idx; -+ -+ return rx_pwr_all; -+} -+ - static void query_phy_status_page0(struct rtw_dev *rtwdev, u8 *phy_status, - struct rtw_rx_pkt_stat *pkt_stat) - { -- s8 min_rx_power = -120; -- u8 pwdb = GET_PHY_STAT_P0_PWDB(phy_status); -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ s8 rx_power; -+ u8 lna_idx = 0; -+ u8 vga_idx = 0; - -- pkt_stat->rx_power[RF_PATH_A] = pwdb - 100; -+ vga_idx = GET_PHY_STAT_P0_VGA(phy_status); -+ lna_idx = FIELD_PREP(BIT_LNA_H_MASK, GET_PHY_STAT_P0_LNA_H(phy_status)) | -+ FIELD_PREP(BIT_LNA_L_MASK, GET_PHY_STAT_P0_LNA_L(phy_status)); -+ rx_power = get_cck_rx_pwr(rtwdev, lna_idx, vga_idx); -+ -+ pkt_stat->rx_power[RF_PATH_A] = rx_power; - pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1); -+ dm_info->rssi[RF_PATH_A] = pkt_stat->rssi; - pkt_stat->bw = RTW_CHANNEL_WIDTH_20; -- pkt_stat->signal_power = max(pkt_stat->rx_power[RF_PATH_A], -- min_rx_power); -+ pkt_stat->signal_power = rx_power; - } - - static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, - struct rtw_rx_pkt_stat *pkt_stat) - { -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; - u8 rxsc, bw; - s8 min_rx_power = -120; - -@@ -461,6 +586,7 @@ static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, - - pkt_stat->rx_power[RF_PATH_A] = GET_PHY_STAT_P1_PWDB_A(phy_status) - 110; - pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1); -+ dm_info->rssi[RF_PATH_A] = pkt_stat->rssi; - pkt_stat->bw = bw; - pkt_stat->signal_power = max(pkt_stat->rx_power[RF_PATH_A], - min_rx_power); -@@ -499,7 +625,8 @@ static void rtw8821c_query_rx_desc(struct rtw_dev *rtwdev, u8 *rx_desc, - pkt_stat->phy_status = GET_RX_DESC_PHYST(rx_desc); - pkt_stat->icv_err = GET_RX_DESC_ICV_ERR(rx_desc); - pkt_stat->crc_err = GET_RX_DESC_CRC32(rx_desc); -- pkt_stat->decrypted = !GET_RX_DESC_SWDEC(rx_desc); -+ pkt_stat->decrypted = !GET_RX_DESC_SWDEC(rx_desc) && -+ GET_RX_DESC_ENC_TYPE(rx_desc) != RX_DESC_ENC_NONE; - pkt_stat->is_c2h = GET_RX_DESC_C2H(rx_desc); - pkt_stat->pkt_len = GET_RX_DESC_PKT_LEN(rx_desc); - pkt_stat->drv_info_sz = GET_RX_DESC_DRV_INFO_SIZE(rx_desc); -@@ -656,8 +783,7 @@ static void rtw8821c_coex_cfg_init(struct rtw_dev *rtwdev) - rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); - - /* BT report packet sample rate */ -- rtw_write8_mask(rtwdev, REG_BT_TDMA_TIME, SAMPLE_RATE_MASK, -- SAMPLE_RATE); -+ rtw_write8_mask(rtwdev, REG_BT_TDMA_TIME, BIT_MASK_SAMPLE_RATE, 0x5); - - /* enable BT counter statistics */ - rtw_write8(rtwdev, REG_BT_STAT_CTRL, BT_CNT_ENABLE); -@@ -691,6 +817,15 @@ static void rtw8821c_coex_cfg_ant_switch(struct rtw_dev *rtwdev, u8 ctrl_type, - if (switch_status == coex_dm->cur_switch_status) - return; - -+ if (coex_rfe->wlg_at_btg) { -+ ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; -+ -+ if (coex_rfe->ant_switch_polarity) -+ pos_type = COEX_SWITCH_TO_WLA; -+ else -+ pos_type = COEX_SWITCH_TO_WLG_BT; -+ } -+ - coex_dm->cur_switch_status = switch_status; - - if (coex_rfe->ant_switch_diversity && -@@ -911,7 +1046,7 @@ static void rtw8821c_pwrtrack_set(struct rtw_dev *rtwdev) - s8 pwr_idx_offset_lower; - u8 channel = rtwdev->hal.current_channel; - u8 band_width = rtwdev->hal.current_band_width; -- u8 regd = rtwdev->regd.txpwr_regd; -+ u8 regd = rtw_regd_get(rtwdev); - u8 tx_rate = dm_info->tx_rate; - u8 max_pwr_idx = rtwdev->chip->max_power_index; - -@@ -1021,25 +1156,37 @@ static void rtw8821c_phy_cck_pd_set(struct rtw_dev *rtwdev, u8 new_lvl) - { - struct rtw_dm_info *dm_info = &rtwdev->dm_info; - u8 pd[CCK_PD_LV_MAX] = {3, 7, 13, 13, 13}; -+ u8 cck_n_rx; - -- if (dm_info->min_rssi > 60) { -- new_lvl = 4; -- pd[4] = 0x1d; -- goto set_cck_pd; -- } -+ rtw_dbg(rtwdev, RTW_DBG_PHY, "lv: (%d) -> (%d)\n", -+ dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A], new_lvl); - - if (dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A] == new_lvl) - return; - -+ cck_n_rx = (rtw_read8_mask(rtwdev, REG_CCK0_FAREPORT, BIT_CCK0_2RX) && -+ rtw_read8_mask(rtwdev, REG_CCK0_FAREPORT, BIT_CCK0_MRC)) ? 2 : 1; -+ rtw_dbg(rtwdev, RTW_DBG_PHY, -+ "is_linked=%d, lv=%d, n_rx=%d, cs_ratio=0x%x, pd_th=0x%x, cck_fa_avg=%d\n", -+ rtw_is_assoc(rtwdev), new_lvl, cck_n_rx, -+ dm_info->cck_pd_default + new_lvl * 2, -+ pd[new_lvl], dm_info->cck_fa_avg); -+ - dm_info->cck_fa_avg = CCK_FA_AVG_RESET; - --set_cck_pd: - dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A] = new_lvl; - rtw_write32_mask(rtwdev, REG_PWRTH, 0x3f0000, pd[new_lvl]); - rtw_write32_mask(rtwdev, REG_PWRTH2, 0x1f0000, - dm_info->cck_pd_default + new_lvl * 2); - } - -+static void rtw8821c_fill_txdesc_checksum(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ u8 *txdesc) -+{ -+ fill_txdesc_checksum_common(txdesc, 16); -+} -+ - static struct rtw_pwr_seq_cmd trans_carddis_to_cardemu_8821c[] = { - {0x0086, - RTW_PWR_CUT_ALL_MSK, -@@ -1410,6 +1557,9 @@ static const struct rtw_intf_phy_para_table phy_para_table_8821c = { - - static const struct rtw_rfe_def rtw8821c_rfe_defs[] = { - [0] = RTW_DEF_RFE(8821c, 0, 0), -+ [2] = RTW_DEF_RFE_EXT(8821c, 0, 0, 2), -+ [4] = RTW_DEF_RFE_EXT(8821c, 0, 0, 2), -+ [6] = RTW_DEF_RFE(8821c, 0, 0), - }; - - static struct rtw_hw_reg rtw8821c_dig[] = { -@@ -1484,6 +1634,7 @@ static struct rtw_chip_ops rtw8821c_ops = { - .config_bfee = rtw8821c_bf_config_bfee, - .set_gid_table = rtw_bf_set_gid_table, - .cfg_csi_rate = rtw_bf_cfg_csi_rate, -+ .fill_txdesc_checksum = rtw8821c_fill_txdesc_checksum, - - .coex_set_init = rtw8821c_coex_cfg_init, - .coex_set_ant_switch = rtw8821c_coex_cfg_ant_switch, -@@ -1768,7 +1919,7 @@ static const struct rtw_reg_domain coex_info_hw_regs_8821c[] = { - {0x60A, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, - }; - --struct rtw_chip_info rtw8821c_hw_spec = { -+const struct rtw_chip_info rtw8821c_hw_spec = { - .ops = &rtw8821c_ops, - .id = RTW_CHIP_TYPE_8821C, - .fw_name = "rtw88/rtw8821c_fw.bin", -@@ -1782,12 +1933,13 @@ struct rtw_chip_info rtw8821c_hw_spec = { - .ptct_efuse_size = 96, - .txff_size = 65536, - .rxff_size = 16384, -+ .rsvd_drv_pg_num = 8, - .txgi_factor = 1, - .is_pwr_by_rate_dec = true, - .max_power_index = 0x3f, - .csi_buf_pg_num = 0, - .band = RTW_BAND_2G | RTW_BAND_5G, -- .page_size = 128, -+ .page_size = TX_PAGE_SIZE, - .dig_min = 0x1c, - .ht_supported = true, - .vht_supported = true, -@@ -1814,11 +1966,15 @@ struct rtw_chip_info rtw8821c_hw_spec = { - .iqk_threshold = 8, - .bfer_su_max_num = 2, - .bfer_mu_max_num = 1, -+ .ampdu_density = IEEE80211_HT_MPDU_DENSITY_2, -+ .max_scan_ie_len = IEEE80211_MAX_DATA_LEN, - - .coex_para_ver = 0x19092746, - .bt_desired_ver = 0x46, - .scbd_support = true, - .new_scbd10_def = false, -+ .ble_hid_profile_support = false, -+ .wl_mimo_ps_support = false, - .pstdma_type = COEX_PSTDMA_FORCE_LPSOFF, - .bt_rssi_type = COEX_BTRSSI_RATIO, - .ant_isolation = 15, -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8821c.h b/drivers/net/wireless/realtek/rtw88/rtw8821c.h -index 8d1e8ff71..fcff31688 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8821c.h -+++ b/drivers/net/wireless/realtek/rtw88/rtw8821c.h -@@ -9,6 +9,26 @@ - - #define RCR_VHT_ACK BIT(26) - -+struct rtw8821cu_efuse { -+ u8 res4[4]; /* 0xd0 */ -+ u8 usb_optional_function; -+ u8 res5[0x1e]; -+ u8 res6[2]; -+ u8 serial[0x0b]; /* 0xf5 */ -+ u8 vid; /* 0x100 */ -+ u8 res7; -+ u8 pid; -+ u8 res8[4]; -+ u8 mac_addr[ETH_ALEN]; /* 0x107 */ -+ u8 res9[2]; -+ u8 vendor_name[0x07]; -+ u8 res10[2]; -+ u8 device_name[0x14]; -+ u8 res11[0xcf]; -+ u8 package_type; /* 0x1fb */ -+ u8 res12[0x4]; -+}; -+ - struct rtw8821ce_efuse { - u8 mac_addr[ETH_ALEN]; /* 0xd0 */ - u8 vender_id[2]; -@@ -45,6 +65,11 @@ struct rtw8821ce_efuse { - u8 res7; - }; - -+struct rtw8821cs_efuse { -+ u8 res4[0x4a]; /* 0xd0 */ -+ u8 mac_addr[ETH_ALEN]; /* 0x11a */ -+} __packed; -+ - struct rtw8821c_efuse { - __le16 rtl_id; - u8 res0[0x0e]; -@@ -73,6 +98,8 @@ struct rtw8821c_efuse { - u8 res[3]; - union { - struct rtw8821ce_efuse e; -+ struct rtw8821cu_efuse u; -+ struct rtw8821cs_efuse s; - }; - }; - -@@ -84,6 +111,8 @@ _rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) - rtw_write32_mask(rtwdev, addr + 0x200, mask, data); - } - -+extern const struct rtw_chip_info rtw8821c_hw_spec; -+ - #define rtw_write32s_mask(rtwdev, addr, mask, data) \ - do { \ - BUILD_BUG_ON((addr) < 0xC00 || (addr) >= 0xD00); \ -@@ -148,6 +177,14 @@ _rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) - /* phy status page0 */ - #define GET_PHY_STAT_P0_PWDB(phy_stat) \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(15, 8)) -+#define GET_PHY_STAT_P0_VGA(phy_stat) \ -+ le32_get_bits(*((__le32 *)(phy_stat) + 0x03), GENMASK(12, 8)) -+#define GET_PHY_STAT_P0_LNA_L(phy_stat) \ -+ le32_get_bits(*((__le32 *)(phy_stat) + 0x03), GENMASK(15, 13)) -+#define GET_PHY_STAT_P0_LNA_H(phy_stat) \ -+ le32_get_bits(*((__le32 *)(phy_stat) + 0x03), BIT(23)) -+#define BIT_LNA_H_MASK BIT(3) -+#define BIT_LNA_L_MASK GENMASK(2, 0) - - /* phy status page1 */ - #define GET_PHY_STAT_P1_PWDB_A(phy_stat) \ -@@ -173,6 +210,8 @@ _rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) - #define GET_PHY_STAT_P1_RXSNR_B(phy_stat) \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x06), GENMASK(15, 8)) - -+#define REG_SYS_CTRL 0x000 -+#define BIT_FEN_EN BIT(26) - #define REG_INIRTS_RATE_SEL 0x0480 - #define REG_HTSTFWT 0x800 - #define REG_RXPSEL 0x808 -@@ -204,6 +243,11 @@ _rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) - #define REG_FA_CCK 0xa5c - #define REG_RXDESC 0xa2c - #define REG_ENTXCCK 0xa80 -+#define BTG_LNA 0xfc84 -+#define WLG_LNA 0x7532 -+#define REG_ENRXCCA 0xa84 -+#define BTG_CCA 0x0e -+#define WLG_CCA 0x12 - #define REG_PWRTH2 0xaa8 - #define REG_CSRATIO 0xaaa - #define REG_TXFILTER 0xaac -@@ -217,6 +261,11 @@ _rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) - #define REG_RFESEL0 0xcb0 - #define REG_RFESEL8 0xcb4 - #define REG_RFECTL 0xcb8 -+#define B_BTG_SWITCH BIT(16) -+#define B_CTRL_SWITCH BIT(18) -+#define B_WL_SWITCH (BIT(20) | BIT(22)) -+#define B_WLG_SWITCH BIT(21) -+#define B_WLA_SWITCH BIT(23) - #define REG_RFEINV 0xcbc - #define REG_AGCTR_B 0xe08 - #define REG_RXIGI_B 0xe50 -@@ -227,12 +276,12 @@ _rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) - #define REG_CCA_OFDM 0xf08 - #define REG_FA_OFDM 0xf48 - #define REG_CCA_CCK 0xfcc -+#define REG_DMEM_CTRL 0x1080 -+#define BIT_WL_RST BIT(16) - #define REG_ANTWT 0x1904 - #define REG_IQKFAILMSK 0x1bf0 - #define BIT_MASK_R_RFE_SEL_15 GENMASK(31, 28) - #define BIT_SDIO_INT BIT(18) --#define SAMPLE_RATE_MASK GENMASK(5, 0) --#define SAMPLE_RATE 0x5 - #define BT_CNT_ENABLE 0x1 - #define BIT_BCN_QUEUE BIT(3) - #define BCN_PRI_EN 0x1 -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8821c_table.c b/drivers/net/wireless/realtek/rtw88/rtw8821c_table.c -index 970f903f7..6c82c4383 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8821c_table.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8821c_table.c -@@ -13,7 +13,7 @@ static const u32 rtw8821c_mac[] = { - 0x04F, 0x00000001, - 0x029, 0x000000F9, - 0x420, 0x00000080, -- 0x421, 0x0000000F, -+ 0x421, 0x0000001F, - 0x428, 0x0000000A, - 0x429, 0x00000010, - 0x430, 0x00000000, -@@ -1342,6 +1342,399 @@ static const u32 rtw8821c_agc[] = { - - RTW_DECL_TABLE_PHY_COND(rtw8821c_agc, rtw_phy_cfg_agc); - -+static const u32 rtw8821c_agc_btg_type2[] = { -+ 0x80001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFF000013, -+ 0x81C, 0xFE020013, -+ 0x81C, 0xFD040013, -+ 0x81C, 0xFC060013, -+ 0x81C, 0xFB080013, -+ 0x81C, 0xFA0A0013, -+ 0x81C, 0xF90C0013, -+ 0x81C, 0xF80E0013, -+ 0x81C, 0xF7100013, -+ 0x81C, 0xF6120013, -+ 0x81C, 0xF5140013, -+ 0x81C, 0xF4160013, -+ 0x81C, 0xF3180013, -+ 0x81C, 0xF21A0013, -+ 0x81C, 0xF11C0013, -+ 0x81C, 0xF01E0013, -+ 0x81C, 0xEF200013, -+ 0x81C, 0xEE220013, -+ 0x81C, 0xED240013, -+ 0x81C, 0xEC260013, -+ 0x81C, 0xEB280013, -+ 0x81C, 0xEA2A0013, -+ 0x81C, 0xE92C0013, -+ 0x81C, 0xE82E0013, -+ 0x81C, 0xE7300013, -+ 0x81C, 0x8B320013, -+ 0x81C, 0x8A340013, -+ 0x81C, 0x89360013, -+ 0x81C, 0x88380013, -+ 0x81C, 0x873A0013, -+ 0x81C, 0x863C0013, -+ 0x81C, 0x853E0013, -+ 0x81C, 0x84400013, -+ 0x81C, 0x83420013, -+ 0x81C, 0x82440013, -+ 0x81C, 0x81460013, -+ 0x81C, 0x08480013, -+ 0x81C, 0x074A0013, -+ 0x81C, 0x064C0013, -+ 0x81C, 0x054E0013, -+ 0x81C, 0x04500013, -+ 0x81C, 0x03520013, -+ 0x81C, 0x88540003, -+ 0x81C, 0x87560003, -+ 0x81C, 0x86580003, -+ 0x81C, 0x855A0003, -+ 0x81C, 0x845C0003, -+ 0x81C, 0x835E0003, -+ 0x81C, 0x82600003, -+ 0x81C, 0x81620003, -+ 0x81C, 0x07640003, -+ 0x81C, 0x06660003, -+ 0x81C, 0x05680003, -+ 0x81C, 0x046A0003, -+ 0x81C, 0x036C0003, -+ 0x81C, 0x026E0003, -+ 0x81C, 0x01700003, -+ 0x81C, 0x01720003, -+ 0x81C, 0x01740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x81C, 0xFF000813, -+ 0x81C, 0xFE020813, -+ 0x81C, 0xFD040813, -+ 0x81C, 0xFC060813, -+ 0x81C, 0xFB080813, -+ 0x81C, 0xFA0A0813, -+ 0x81C, 0xF90C0813, -+ 0x81C, 0xF80E0813, -+ 0x81C, 0xF7100813, -+ 0x81C, 0xF6120813, -+ 0x81C, 0xF5140813, -+ 0x81C, 0xF4160813, -+ 0x81C, 0xF3180813, -+ 0x81C, 0xF21A0813, -+ 0x81C, 0xF11C0813, -+ 0x81C, 0x941E0813, -+ 0x81C, 0x93200813, -+ 0x81C, 0x92220813, -+ 0x81C, 0x91240813, -+ 0x81C, 0x90260813, -+ 0x81C, 0x8F280813, -+ 0x81C, 0x8E2A0813, -+ 0x81C, 0x8D2C0813, -+ 0x81C, 0x8C2E0813, -+ 0x81C, 0x8B300813, -+ 0x81C, 0x8A320813, -+ 0x81C, 0x89340813, -+ 0x81C, 0x88360813, -+ 0x81C, 0x87380813, -+ 0x81C, 0x863A0813, -+ 0x81C, 0x853C0813, -+ 0x81C, 0x843E0813, -+ 0x81C, 0x83400813, -+ 0x81C, 0x82420813, -+ 0x81C, 0x81440813, -+ 0x81C, 0x07460813, -+ 0x81C, 0x06480813, -+ 0x81C, 0x054A0813, -+ 0x81C, 0x044C0813, -+ 0x81C, 0x034E0813, -+ 0x81C, 0x02500813, -+ 0x81C, 0x01520813, -+ 0x81C, 0x88540803, -+ 0x81C, 0x87560803, -+ 0x81C, 0x86580803, -+ 0x81C, 0x855A0803, -+ 0x81C, 0x845C0803, -+ 0x81C, 0x835E0803, -+ 0x81C, 0x82600803, -+ 0x81C, 0x81620803, -+ 0x81C, 0x07640803, -+ 0x81C, 0x06660803, -+ 0x81C, 0x05680803, -+ 0x81C, 0x046A0803, -+ 0x81C, 0x036C0803, -+ 0x81C, 0x026E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0x90001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFF000013, -+ 0x81C, 0xFE020013, -+ 0x81C, 0xFD040013, -+ 0x81C, 0xFC060013, -+ 0x81C, 0xFB080013, -+ 0x81C, 0xFA0A0013, -+ 0x81C, 0xF90C0013, -+ 0x81C, 0xF80E0013, -+ 0x81C, 0xF7100013, -+ 0x81C, 0xF6120013, -+ 0x81C, 0xF5140013, -+ 0x81C, 0xF4160013, -+ 0x81C, 0xF3180013, -+ 0x81C, 0xF21A0013, -+ 0x81C, 0xF11C0013, -+ 0x81C, 0xF01E0013, -+ 0x81C, 0xEF200013, -+ 0x81C, 0xEE220013, -+ 0x81C, 0xED240013, -+ 0x81C, 0xEC260013, -+ 0x81C, 0xEB280013, -+ 0x81C, 0xEA2A0013, -+ 0x81C, 0xE92C0013, -+ 0x81C, 0xE82E0013, -+ 0x81C, 0xE7300013, -+ 0x81C, 0x8B320013, -+ 0x81C, 0x8A340013, -+ 0x81C, 0x89360013, -+ 0x81C, 0x88380013, -+ 0x81C, 0x873A0013, -+ 0x81C, 0x863C0013, -+ 0x81C, 0x853E0013, -+ 0x81C, 0x84400013, -+ 0x81C, 0x83420013, -+ 0x81C, 0x82440013, -+ 0x81C, 0x81460013, -+ 0x81C, 0x08480013, -+ 0x81C, 0x074A0013, -+ 0x81C, 0x064C0013, -+ 0x81C, 0x054E0013, -+ 0x81C, 0x04500013, -+ 0x81C, 0x03520013, -+ 0x81C, 0x88540003, -+ 0x81C, 0x87560003, -+ 0x81C, 0x86580003, -+ 0x81C, 0x855A0003, -+ 0x81C, 0x845C0003, -+ 0x81C, 0x835E0003, -+ 0x81C, 0x82600003, -+ 0x81C, 0x81620003, -+ 0x81C, 0x07640003, -+ 0x81C, 0x06660003, -+ 0x81C, 0x05680003, -+ 0x81C, 0x046A0003, -+ 0x81C, 0x036C0003, -+ 0x81C, 0x026E0003, -+ 0x81C, 0x01700003, -+ 0x81C, 0x01720003, -+ 0x81C, 0x01740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x81C, 0xFF000813, -+ 0x81C, 0xFE020813, -+ 0x81C, 0xFD040813, -+ 0x81C, 0xFC060813, -+ 0x81C, 0xFB080813, -+ 0x81C, 0xFA0A0813, -+ 0x81C, 0xF90C0813, -+ 0x81C, 0xF80E0813, -+ 0x81C, 0xF7100813, -+ 0x81C, 0xF6120813, -+ 0x81C, 0xF5140813, -+ 0x81C, 0xF4160813, -+ 0x81C, 0xF3180813, -+ 0x81C, 0xF21A0813, -+ 0x81C, 0xF11C0813, -+ 0x81C, 0x941E0813, -+ 0x81C, 0x93200813, -+ 0x81C, 0x92220813, -+ 0x81C, 0x91240813, -+ 0x81C, 0x90260813, -+ 0x81C, 0x8F280813, -+ 0x81C, 0x8E2A0813, -+ 0x81C, 0x8D2C0813, -+ 0x81C, 0x8C2E0813, -+ 0x81C, 0x8B300813, -+ 0x81C, 0x8A320813, -+ 0x81C, 0x89340813, -+ 0x81C, 0x88360813, -+ 0x81C, 0x87380813, -+ 0x81C, 0x863A0813, -+ 0x81C, 0x853C0813, -+ 0x81C, 0x843E0813, -+ 0x81C, 0x83400813, -+ 0x81C, 0x82420813, -+ 0x81C, 0x81440813, -+ 0x81C, 0x07460813, -+ 0x81C, 0x06480813, -+ 0x81C, 0x054A0813, -+ 0x81C, 0x044C0813, -+ 0x81C, 0x034E0813, -+ 0x81C, 0x02500813, -+ 0x81C, 0x01520813, -+ 0x81C, 0x88540803, -+ 0x81C, 0x87560803, -+ 0x81C, 0x86580803, -+ 0x81C, 0x855A0803, -+ 0x81C, 0x845C0803, -+ 0x81C, 0x835E0803, -+ 0x81C, 0x82600803, -+ 0x81C, 0x81620803, -+ 0x81C, 0x07640803, -+ 0x81C, 0x06660803, -+ 0x81C, 0x05680803, -+ 0x81C, 0x046A0803, -+ 0x81C, 0x036C0803, -+ 0x81C, 0x026E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFF000013, -+ 0x81C, 0xFE020013, -+ 0x81C, 0xFD040013, -+ 0x81C, 0xFC060013, -+ 0x81C, 0xFB080013, -+ 0x81C, 0xFA0A0013, -+ 0x81C, 0xF90C0013, -+ 0x81C, 0xF80E0013, -+ 0x81C, 0xF7100013, -+ 0x81C, 0xF6120013, -+ 0x81C, 0xF5140013, -+ 0x81C, 0xF4160013, -+ 0x81C, 0xF3180013, -+ 0x81C, 0xF21A0013, -+ 0x81C, 0xF11C0013, -+ 0x81C, 0xF01E0013, -+ 0x81C, 0xEF200013, -+ 0x81C, 0xEE220013, -+ 0x81C, 0xED240013, -+ 0x81C, 0xEC260013, -+ 0x81C, 0xEB280013, -+ 0x81C, 0xEA2A0013, -+ 0x81C, 0xE92C0013, -+ 0x81C, 0xE82E0013, -+ 0x81C, 0xE7300013, -+ 0x81C, 0x8A320013, -+ 0x81C, 0x89340013, -+ 0x81C, 0x88360013, -+ 0x81C, 0x87380013, -+ 0x81C, 0x863A0013, -+ 0x81C, 0x853C0013, -+ 0x81C, 0x843E0013, -+ 0x81C, 0x83400013, -+ 0x81C, 0x82420013, -+ 0x81C, 0x81440013, -+ 0x81C, 0x07460013, -+ 0x81C, 0x06480013, -+ 0x81C, 0x054A0013, -+ 0x81C, 0x044C0013, -+ 0x81C, 0x034E0013, -+ 0x81C, 0x02500013, -+ 0x81C, 0x01520013, -+ 0x81C, 0x88540003, -+ 0x81C, 0x87560003, -+ 0x81C, 0x86580003, -+ 0x81C, 0x855A0003, -+ 0x81C, 0x845C0003, -+ 0x81C, 0x835E0003, -+ 0x81C, 0x82600003, -+ 0x81C, 0x81620003, -+ 0x81C, 0x07640003, -+ 0x81C, 0x06660003, -+ 0x81C, 0x05680003, -+ 0x81C, 0x046A0003, -+ 0x81C, 0x036C0003, -+ 0x81C, 0x026E0003, -+ 0x81C, 0x01700003, -+ 0x81C, 0x01720003, -+ 0x81C, 0x01740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x81C, 0xFF000813, -+ 0x81C, 0xFE020813, -+ 0x81C, 0xFD040813, -+ 0x81C, 0xFC060813, -+ 0x81C, 0xFB080813, -+ 0x81C, 0xFA0A0813, -+ 0x81C, 0xF90C0813, -+ 0x81C, 0xF80E0813, -+ 0x81C, 0xF7100813, -+ 0x81C, 0xF6120813, -+ 0x81C, 0xF5140813, -+ 0x81C, 0xF4160813, -+ 0x81C, 0xF3180813, -+ 0x81C, 0xF21A0813, -+ 0x81C, 0xF11C0813, -+ 0x81C, 0x961E0813, -+ 0x81C, 0x95200813, -+ 0x81C, 0x94220813, -+ 0x81C, 0x93240813, -+ 0x81C, 0x92260813, -+ 0x81C, 0x91280813, -+ 0x81C, 0x8F2A0813, -+ 0x81C, 0x8E2C0813, -+ 0x81C, 0x8D2E0813, -+ 0x81C, 0x8C300813, -+ 0x81C, 0x8B320813, -+ 0x81C, 0x8A340813, -+ 0x81C, 0x89360813, -+ 0x81C, 0x88380813, -+ 0x81C, 0x873A0813, -+ 0x81C, 0x863C0813, -+ 0x81C, 0x853E0813, -+ 0x81C, 0x84400813, -+ 0x81C, 0x83420813, -+ 0x81C, 0x82440813, -+ 0x81C, 0x08460813, -+ 0x81C, 0x07480813, -+ 0x81C, 0x064A0813, -+ 0x81C, 0x054C0813, -+ 0x81C, 0x044E0813, -+ 0x81C, 0x03500813, -+ 0x81C, 0x02520813, -+ 0x81C, 0x89540803, -+ 0x81C, 0x88560803, -+ 0x81C, 0x87580803, -+ 0x81C, 0x865A0803, -+ 0x81C, 0x855C0803, -+ 0x81C, 0x845E0803, -+ 0x81C, 0x83600803, -+ 0x81C, 0x82620803, -+ 0x81C, 0x07640803, -+ 0x81C, 0x06660803, -+ 0x81C, 0x05680803, -+ 0x81C, 0x046A0803, -+ 0x81C, 0x036C0803, -+ 0x81C, 0x026E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0xB0000000, 0x00000000, -+}; -+ -+RTW_DECL_TABLE_PHY_COND(rtw8821c_agc_btg_type2, rtw_phy_cfg_agc); -+ - static const u32 rtw8821c_bb[] = { - 0x800, 0x9020D010, - 0x804, 0x80018180, -@@ -1394,7 +1787,11 @@ static const u32 rtw8821c_bb[] = { - 0x8C0, 0xFFE04020, - 0x8C4, 0x47C00000, - 0x8C8, 0x00025165, -+ 0x82000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x8CC, 0x08190492, -+ 0xA0000000, 0x00000000, - 0x8CC, 0x08188492, -+ 0xB0000000, 0x00000000, - 0x8D0, 0x0000B800, - 0x8D4, 0x860308A0, - 0x8D8, 0x290B5612, -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8821c_table.h b/drivers/net/wireless/realtek/rtw88/rtw8821c_table.h -index 5ea8b4fc7..cda98f5c4 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8821c_table.h -+++ b/drivers/net/wireless/realtek/rtw88/rtw8821c_table.h -@@ -7,6 +7,7 @@ - - extern const struct rtw_table rtw8821c_mac_tbl; - extern const struct rtw_table rtw8821c_agc_tbl; -+extern const struct rtw_table rtw8821c_agc_btg_type2_tbl; - extern const struct rtw_table rtw8821c_bb_tbl; - extern const struct rtw_table rtw8821c_bb_pg_type0_tbl; - extern const struct rtw_table rtw8821c_rf_a_tbl; -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8821ce.c b/drivers/net/wireless/realtek/rtw88/rtw8821ce.c -index 616fdcfd6..f3d971fed 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8821ce.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8821ce.c -@@ -4,9 +4,14 @@ - - #include - #include --#include "rtw8821ce.h" -+#include "pci.h" -+#include "rtw8821c.h" - - static const struct pci_device_id rtw_8821ce_id_table[] = { -+ { -+ PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0xB821), -+ .driver_data = (kernel_ulong_t)&rtw8821c_hw_spec -+ }, - { - PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0xC821), - .driver_data = (kernel_ulong_t)&rtw8821c_hw_spec -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8821cs.c b/drivers/net/wireless/realtek/rtw88/rtw8821cs.c -new file mode 100644 -index 000000000..649f41baa ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/rtw8821cs.c -@@ -0,0 +1,36 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright(c) Martin Blumenstingl -+ */ -+ -+#include -+#include "sdio_ids.h" -+#include -+#include "main.h" -+#include "rtw8821c.h" -+#include "sdio.h" -+ -+static const struct sdio_device_id rtw_8821cs_id_table[] = { -+ { -+ SDIO_DEVICE(SDIO_VENDOR_ID_REALTEK, -+ SDIO_DEVICE_ID_REALTEK_RTW8821CS), -+ .driver_data = (kernel_ulong_t)&rtw8821c_hw_spec, -+ }, -+ {} -+}; -+MODULE_DEVICE_TABLE(sdio, rtw_8821cs_id_table); -+ -+static struct sdio_driver rtw_8821cs_driver = { -+ .name = "rtw_8821cs", -+ .probe = rtw_sdio_probe, -+ .remove = rtw_sdio_remove, -+ .id_table = rtw_8821cs_id_table, -+ .drv = { -+ .pm = &rtw_sdio_pm_ops, -+ .shutdown = rtw_sdio_shutdown, -+ } -+}; -+module_sdio_driver(rtw_8821cs_driver); -+ -+MODULE_AUTHOR("Martin Blumenstingl "); -+MODULE_DESCRIPTION("Realtek 802.11ac wireless 8821cs driver"); -+MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8821cu.c b/drivers/net/wireless/realtek/rtw88/rtw8821cu.c -new file mode 100644 -index 000000000..7a5cbdc31 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/rtw8821cu.c -@@ -0,0 +1,50 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright(c) 2018-2019 Realtek Corporation -+ */ -+ -+#include -+#include -+#include "main.h" -+#include "rtw8821c.h" -+#include "usb.h" -+ -+static const struct usb_device_id rtw_8821cu_id_table[] = { -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb82b, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb820, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc821, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc820, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82a, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82b, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc811, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8811CU */ -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x8811, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8811CU */ -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x2006, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* TOTOLINK A650UA v3 */ -+ {}, -+}; -+MODULE_DEVICE_TABLE(usb, rtw_8821cu_id_table); -+ -+static int rtw_8821cu_probe(struct usb_interface *intf, -+ const struct usb_device_id *id) -+{ -+ return rtw_usb_probe(intf, id); -+} -+ -+static struct usb_driver rtw_8821cu_driver = { -+ .name = "rtw_8821cu", -+ .id_table = rtw_8821cu_id_table, -+ .probe = rtw_8821cu_probe, -+ .disconnect = rtw_usb_disconnect, -+}; -+module_usb_driver(rtw_8821cu_driver); -+ -+MODULE_AUTHOR("Hans Ulli Kroll "); -+MODULE_DESCRIPTION("Realtek 802.11ac wireless 8821cu driver"); -+MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822b.c b/drivers/net/wireless/realtek/rtw88/rtw8822b.c -index dbfd67c3f..3017a9760 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8822b.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822b.c -@@ -15,6 +15,7 @@ - #include "reg.h" - #include "debug.h" - #include "bf.h" -+#include "regd.h" - - static void rtw8822b_config_trx_mode(struct rtw_dev *rtwdev, u8 tx_path, - u8 rx_path, bool is_tx2_path); -@@ -25,6 +26,18 @@ static void rtw8822be_efuse_parsing(struct rtw_efuse *efuse, - ether_addr_copy(efuse->addr, map->e.mac_addr); - } - -+static void rtw8822bu_efuse_parsing(struct rtw_efuse *efuse, -+ struct rtw8822b_efuse *map) -+{ -+ ether_addr_copy(efuse->addr, map->u.mac_addr); -+} -+ -+static void rtw8822bs_efuse_parsing(struct rtw_efuse *efuse, -+ struct rtw8822b_efuse *map) -+{ -+ ether_addr_copy(efuse->addr, map->s.mac_addr); -+} -+ - static int rtw8822b_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) - { - struct rtw_efuse *efuse = &rtwdev->efuse; -@@ -55,6 +68,12 @@ static int rtw8822b_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) - case RTW_HCI_TYPE_PCIE: - rtw8822be_efuse_parsing(efuse, map); - break; -+ case RTW_HCI_TYPE_USB: -+ rtw8822bu_efuse_parsing(efuse, map); -+ break; -+ case RTW_HCI_TYPE_SDIO: -+ rtw8822bs_efuse_parsing(efuse, map); -+ break; - default: - /* unsupported now */ - return -ENOTSUPP; -@@ -87,7 +106,7 @@ static const u32 rtw8822b_txscale_tbl[RTW_TXSCALE_SIZE] = { - 0x2d3, 0x2fe, 0x32b, 0x35c, 0x38e, 0x3c4, 0x3fe - }; - --static const u8 rtw8822b_get_swing_index(struct rtw_dev *rtwdev) -+static u8 rtw8822b_get_swing_index(struct rtw_dev *rtwdev) - { - u8 i = 0; - u32 swing, table_value; -@@ -261,6 +280,8 @@ static int rtw8822b_mac_init(struct rtw_dev *rtwdev) - rtw_write8(rtwdev, REG_TCR + 1, WLAN_TX_FUNC_CFG1); - rtw_write32(rtwdev, REG_WMAC_OPTION_FUNCTION + 8, WLAN_MAC_OPT_FUNC2); - rtw_write8(rtwdev, REG_WMAC_OPTION_FUNCTION + 4, WLAN_MAC_OPT_NORM_FUNC1); -+ rtw_write8_set(rtwdev, REG_SND_PTCL_CTRL, -+ BIT_DIS_CHK_VHTSIGB_CRC); - - return 0; - } -@@ -1009,12 +1030,12 @@ static int rtw8822b_set_antenna(struct rtw_dev *rtwdev, - antenna_tx, antenna_rx); - - if (!rtw8822b_check_rf_path(antenna_tx)) { -- rtw_info(rtwdev, "unsupported tx path 0x%x\n", antenna_tx); -+ rtw_warn(rtwdev, "unsupported tx path 0x%x\n", antenna_tx); - return -EINVAL; - } - - if (!rtw8822b_check_rf_path(antenna_rx)) { -- rtw_info(rtwdev, "unsupported rx path 0x%x\n", antenna_rx); -+ rtw_warn(rtwdev, "unsupported rx path 0x%x\n", antenna_rx); - return -EINVAL; - } - -@@ -1120,21 +1141,21 @@ static void rtw8822b_coex_cfg_init(struct rtw_dev *rtwdev) - - /* BT report packet sample rate */ - /* 0x790[5:0]=0x5 */ -- rtw_write8_set(rtwdev, REG_BT_TDMA_TIME, 0x05); -+ rtw_write8_mask(rtwdev, REG_BT_TDMA_TIME, BIT_MASK_SAMPLE_RATE, 0x5); - - /* enable BT counter statistics */ - rtw_write8(rtwdev, REG_BT_STAT_CTRL, 0x1); - - /* enable PTA (3-wire function form BT side) */ - rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_PTA_EN); -- rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_AOD_GPIO3); -+ rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_PO_BT_PTA_PINS); - - /* enable PTA (tx/rx signal form WiFi side) */ - rtw_write8_set(rtwdev, REG_QUEUE_CTRL, BIT_PTA_WL_TX_EN); - /* wl tx signal to PTA not case EDCCA */ - rtw_write8_clr(rtwdev, REG_QUEUE_CTRL, BIT_PTA_EDCCA_EN); - /* GNT_BT=1 while select both */ -- rtw_write8_set(rtwdev, REG_BT_COEX_V2, BIT_GNT_BT_POLARITY); -+ rtw_write16_set(rtwdev, REG_BT_COEX_V2, BIT_GNT_BT_POLARITY); - } - - static void rtw8822b_coex_cfg_ant_switch(struct rtw_dev *rtwdev, -@@ -1341,6 +1362,7 @@ static void rtw8822b_coex_cfg_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain) - coex_dm->cur_wl_rx_low_gain_en = low_gain; - - if (coex_dm->cur_wl_rx_low_gain_en) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], Hi-Li Table On!\n"); - for (i = 0; i < ARRAY_SIZE(wl_rx_low_gain_on); i++) - rtw_write32(rtwdev, REG_RX_GAIN_EN, wl_rx_low_gain_on[i]); - -@@ -1350,6 +1372,7 @@ static void rtw8822b_coex_cfg_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain) - rtw_write_rf(rtwdev, RF_PATH_B, RF_RCKD, 0x2, 0x1); - rtw_write_rf(rtwdev, RF_PATH_B, RF_RCK, 0x3f, 0x3f); - } else { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], Hi-Li Table Off!\n"); - for (i = 0; i < ARRAY_SIZE(wl_rx_low_gain_off); i++) - rtw_write32(rtwdev, 0x81c, wl_rx_low_gain_off[i]); - -@@ -1434,7 +1457,7 @@ static void rtw8822b_pwrtrack_set(struct rtw_dev *rtwdev, u8 path) - u8 pwr_idx_offset, tx_pwr_idx; - u8 channel = rtwdev->hal.current_channel; - u8 band_width = rtwdev->hal.current_band_width; -- u8 regd = rtwdev->regd.txpwr_regd; -+ u8 regd = rtw_regd_get(rtwdev); - u8 tx_rate = dm_info->tx_rate; - u8 max_pwr_idx = rtwdev->chip->max_power_index; - -@@ -1550,6 +1573,48 @@ static void rtw8822b_bf_config_bfee(struct rtw_dev *rtwdev, struct rtw_vif *vif, - rtw_warn(rtwdev, "wrong bfee role\n"); - } - -+static void rtw8822b_adaptivity_init(struct rtw_dev *rtwdev) -+{ -+ rtw_phy_set_edcca_th(rtwdev, RTW8822B_EDCCA_MAX, RTW8822B_EDCCA_MAX); -+ -+ /* mac edcca state setting */ -+ rtw_write32_clr(rtwdev, REG_TX_PTCL_CTRL, BIT_DIS_EDCCA); -+ rtw_write32_set(rtwdev, REG_RD_CTRL, BIT_EDCCA_MSK_CNTDOWN_EN); -+ rtw_write32_mask(rtwdev, REG_EDCCA_SOURCE, BIT_SOURCE_OPTION, -+ RTW8822B_EDCCA_SRC_DEF); -+ rtw_write32_mask(rtwdev, REG_EDCCA_POW_MA, BIT_MA_LEVEL, 0); -+ -+ /* edcca decision opt */ -+ rtw_write32_set(rtwdev, REG_EDCCA_DECISION, BIT_EDCCA_OPTION); -+} -+ -+static void rtw8822b_adaptivity(struct rtw_dev *rtwdev) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ s8 l2h, h2l; -+ u8 igi; -+ -+ igi = dm_info->igi_history[0]; -+ if (dm_info->edcca_mode == RTW_EDCCA_NORMAL) { -+ l2h = max_t(s8, igi + EDCCA_IGI_L2H_DIFF, EDCCA_TH_L2H_LB); -+ h2l = l2h - EDCCA_L2H_H2L_DIFF_NORMAL; -+ } else { -+ l2h = min_t(s8, igi, dm_info->l2h_th_ini); -+ h2l = l2h - EDCCA_L2H_H2L_DIFF; -+ } -+ -+ rtw_phy_set_edcca_th(rtwdev, l2h, h2l); -+} -+ -+static void rtw8822b_fill_txdesc_checksum(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ u8 *txdesc) -+{ -+ size_t words = 32 / 2; /* calculate the first 32 bytes (16 words) */ -+ -+ fill_txdesc_checksum_common(txdesc, words); -+} -+ - static const struct rtw_pwr_seq_cmd trans_carddis_to_cardemu_8822b[] = { - {0x0086, - RTW_PWR_CUT_ALL_MSK, -@@ -2123,6 +2188,9 @@ static struct rtw_chip_ops rtw8822b_ops = { - .config_bfee = rtw8822b_bf_config_bfee, - .set_gid_table = rtw_bf_set_gid_table, - .cfg_csi_rate = rtw_bf_cfg_csi_rate, -+ .adaptivity_init = rtw8822b_adaptivity_init, -+ .adaptivity = rtw8822b_adaptivity, -+ .fill_txdesc_checksum = rtw8822b_fill_txdesc_checksum, - - .coex_set_init = rtw8822b_coex_cfg_init, - .coex_set_ant_switch = rtw8822b_coex_cfg_ant_switch, -@@ -2141,14 +2209,14 @@ static const struct coex_table_para table_sant_8822b[] = { - {0xaaaaaaaa, 0xaaaaaaaa}, - {0x5a5a5a5a, 0x5a5a5a5a}, - {0xfafafafa, 0xfafafafa}, /* case-5 */ -- {0x6a5a6a5a, 0xaaaaaaaa}, -+ {0x6a5a5555, 0xaaaaaaaa}, - {0x6a5a56aa, 0x6a5a56aa}, - {0x6a5a5a5a, 0x6a5a5a5a}, - {0x66555555, 0x5a5a5a5a}, - {0x66555555, 0x6a5a5a5a}, /* case-10 */ - {0x66555555, 0xfafafafa}, - {0x66555555, 0x5a5a5aaa}, -- {0x66555555, 0x5aaa5aaa}, -+ {0x66555555, 0x6aaa5aaa}, - {0x66555555, 0xaaaa5aaa}, - {0x66555555, 0xaaaaaaaa}, /* case-15 */ - {0xffff55ff, 0xfafafafa}, -@@ -2158,13 +2226,16 @@ static const struct coex_table_para table_sant_8822b[] = { - {0xaa5555aa, 0x6a5a5a5a}, /* case-20 */ - {0xaa5555aa, 0xaaaaaaaa}, - {0xffffffff, 0x5a5a5a5a}, -- {0xffffffff, 0x6a5a5a5a}, -+ {0xffffffff, 0x5a5a5a5a}, - {0xffffffff, 0x55555555}, - {0xffffffff, 0x6a5a5aaa}, /* case-25 */ - {0x55555555, 0x5a5a5a5a}, - {0x55555555, 0xaaaaaaaa}, - {0x55555555, 0x6a5a6a5a}, -- {0x66556655, 0x66556655} -+ {0x66556655, 0x66556655}, -+ {0x66556aaa, 0x6a5a6aaa}, /* case-30 */ -+ {0xffffffff, 0x5aaa5aaa}, -+ {0x56555555, 0x5a5a5aaa}, - }; - - /* Non-Shared-Antenna Coex Table */ -@@ -2184,7 +2255,7 @@ static const struct coex_table_para table_nsant_8822b[] = { - {0xffff55ff, 0xfafafafa}, - {0xffff55ff, 0x5afa5afa}, - {0xffff55ff, 0xaaaaaaaa}, -- {0xaaffffaa, 0xfafafafa}, /* case-115 */ -+ {0xffff55ff, 0xffff55ff}, /* case-115 */ - {0xaaffffaa, 0x5afa5afa}, - {0xaaffffaa, 0xaaaaaaaa}, - {0xffffffff, 0xfafafafa}, -@@ -2213,7 +2284,7 @@ static const struct coex_tdma_para tdma_sant_8822b[] = { - { {0x51, 0x08, 0x03, 0x10, 0x54} }, - { {0x51, 0x08, 0x03, 0x10, 0x55} }, - { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-15 */ -- { {0x51, 0x45, 0x03, 0x10, 0x10} }, -+ { {0x51, 0x45, 0x03, 0x10, 0x50} }, - { {0x51, 0x3a, 0x03, 0x10, 0x50} }, - { {0x51, 0x30, 0x03, 0x10, 0x50} }, - { {0x51, 0x20, 0x03, 0x10, 0x50} }, -@@ -2221,7 +2292,7 @@ static const struct coex_tdma_para tdma_sant_8822b[] = { - { {0x51, 0x4a, 0x03, 0x10, 0x50} }, - { {0x51, 0x0c, 0x03, 0x10, 0x54} }, - { {0x55, 0x08, 0x03, 0x10, 0x54} }, -- { {0x65, 0x10, 0x03, 0x11, 0x11} }, -+ { {0x65, 0x10, 0x03, 0x11, 0x10} }, - { {0x51, 0x10, 0x03, 0x10, 0x51} }, /* case-25 */ - { {0x51, 0x08, 0x03, 0x10, 0x50} }, - { {0x61, 0x08, 0x03, 0x11, 0x11} } -@@ -2230,7 +2301,7 @@ static const struct coex_tdma_para tdma_sant_8822b[] = { - /* Non-Shared-Antenna TDMA */ - static const struct coex_tdma_para tdma_nsant_8822b[] = { - { {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-100 */ -- { {0x61, 0x45, 0x03, 0x11, 0x11} }, -+ { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-101 */ - { {0x61, 0x3a, 0x03, 0x11, 0x11} }, - { {0x61, 0x30, 0x03, 0x11, 0x11} }, - { {0x61, 0x20, 0x03, 0x11, 0x11} }, -@@ -2249,13 +2320,13 @@ static const struct coex_tdma_para tdma_nsant_8822b[] = { - { {0x51, 0x3a, 0x03, 0x10, 0x50} }, - { {0x51, 0x30, 0x03, 0x10, 0x50} }, - { {0x51, 0x20, 0x03, 0x10, 0x50} }, -- { {0x51, 0x10, 0x03, 0x10, 0x50} } /* case-120 */ -+ { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-120 */ -+ { {0x51, 0x08, 0x03, 0x10, 0x50} } - }; - - /* rssi in percentage % (dbm = % - 100) */ - static const u8 wl_rssi_step_8822b[] = {60, 50, 44, 30}; - static const u8 bt_rssi_step_8822b[] = {30, 30, 30, 30}; --static const struct coex_5g_afh_map afh_5g_8822b[] = { {0, 0, 0} }; - - /* wl_tx_dec_power, bt_tx_dec_power, wl_rx_gain, bt_rx_lna_constrain */ - static const struct coex_rf_para rf_para_tx_8822b[] = { -@@ -2276,6 +2347,27 @@ static const struct coex_rf_para rf_para_rx_8822b[] = { - {1, 13, true, 1} - }; - -+static const struct coex_5g_afh_map afh_5g_8822b[] = { -+ {120, 2, 4}, -+ {124, 8, 8}, -+ {128, 17, 8}, -+ {132, 26, 10}, -+ {136, 34, 8}, -+ {140, 42, 10}, -+ {144, 51, 8}, -+ {149, 62, 8}, -+ {153, 71, 10}, -+ {157, 77, 4}, -+ {118, 2, 4}, -+ {126, 12, 16}, -+ {134, 29, 16}, -+ {142, 46, 16}, -+ {151, 66, 16}, -+ {159, 76, 4}, -+ {122, 10, 20}, -+ {138, 37, 34}, -+ {155, 68, 20} -+}; - static_assert(ARRAY_SIZE(rf_para_tx_8822b) == ARRAY_SIZE(rf_para_rx_8822b)); - - static const u8 -@@ -2428,7 +2520,12 @@ static const struct rtw_reg_domain coex_info_hw_regs_8822b[] = { - {0xc50, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, - }; - --struct rtw_chip_info rtw8822b_hw_spec = { -+static struct rtw_hw_reg_offset rtw8822b_edcca_th[] = { -+ [EDCCA_TH_L2H_IDX] = {{.addr = 0x8a4, .mask = MASKBYTE0}, .offset = 0}, -+ [EDCCA_TH_H2L_IDX] = {{.addr = 0x8a4, .mask = MASKBYTE1}, .offset = 0}, -+}; -+ -+const struct rtw_chip_info rtw8822b_hw_spec = { - .ops = &rtw8822b_ops, - .id = RTW_CHIP_TYPE_8822B, - .fw_name = "rtw88/rtw8822b_fw.bin", -@@ -2443,12 +2540,13 @@ struct rtw_chip_info rtw8822b_hw_spec = { - .txff_size = 262144, - .rxff_size = 24576, - .fw_rxff_size = 12288, -+ .rsvd_drv_pg_num = 8, - .txgi_factor = 1, - .is_pwr_by_rate_dec = true, - .max_power_index = 0x3f, - .csi_buf_pg_num = 0, - .band = RTW_BAND_2G | RTW_BAND_5G, -- .page_size = 128, -+ .page_size = TX_PAGE_SIZE, - .dig_min = 0x1c, - .ht_supported = true, - .vht_supported = true, -@@ -2476,11 +2574,18 @@ struct rtw_chip_info rtw8822b_hw_spec = { - .bfer_su_max_num = 2, - .bfer_mu_max_num = 1, - .rx_ldpc = true, -+ .edcca_th = rtw8822b_edcca_th, -+ .l2h_th_ini_cs = 10 + EDCCA_IGI_BASE, -+ .l2h_th_ini_ad = -14 + EDCCA_IGI_BASE, -+ .ampdu_density = IEEE80211_HT_MPDU_DENSITY_2, -+ .max_scan_ie_len = IEEE80211_MAX_DATA_LEN, - - .coex_para_ver = 0x20070206, - .bt_desired_ver = 0x6, - .scbd_support = true, - .new_scbd10_def = false, -+ .ble_hid_profile_support = false, -+ .wl_mimo_ps_support = false, - .pstdma_type = COEX_PSTDMA_FORCE_LPSOFF, - .bt_rssi_type = COEX_BTRSSI_RATIO, - .ant_isolation = 15, -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822b.h b/drivers/net/wireless/realtek/rtw88/rtw8822b.h -index 6211f4b54..2dc3a6660 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8822b.h -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822b.h -@@ -65,6 +65,11 @@ struct rtw8822be_efuse { - u8 res7; - }; - -+struct rtw8822bs_efuse { -+ u8 res4[0x4a]; /* 0xd0 */ -+ u8 mac_addr[ETH_ALEN]; /* 0x11a */ -+} __packed; -+ - struct rtw8822b_efuse { - __le16 rtl_id; - u8 res0[0x0e]; -@@ -92,8 +97,9 @@ struct rtw8822b_efuse { - u8 country_code[2]; - u8 res[3]; - union { -- struct rtw8822bu_efuse u; - struct rtw8822be_efuse e; -+ struct rtw8822bu_efuse u; -+ struct rtw8822bs_efuse s; - }; - }; - -@@ -140,6 +146,8 @@ _rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) - #define GET_PHY_STAT_P1_RXSNR_B(phy_stat) \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x06), GENMASK(15, 8)) - -+#define RTW8822B_EDCCA_MAX 0x7f -+#define RTW8822B_EDCCA_SRC_DEF 1 - #define REG_HTSTFWT 0x800 - #define REG_RXPSEL 0x808 - #define BIT_RX_PSEL_RST (BIT(28) | BIT(29)) -@@ -152,11 +160,17 @@ _rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) - #define REG_L1PKWT 0x840 - #define REG_MRC 0x850 - #define REG_CLKTRK 0x860 -+#define REG_EDCCA_POW_MA 0x8a0 -+#define BIT_MA_LEVEL GENMASK(1, 0) - #define REG_ADCCLK 0x8ac - #define REG_ADC160 0x8c4 - #define REG_ADC40 0x8c8 -+#define REG_EDCCA_DECISION 0x8dc -+#define BIT_EDCCA_OPTION BIT(5) - #define REG_CDDTXP 0x93c - #define REG_TXPSEL1 0x940 -+#define REG_EDCCA_SOURCE 0x944 -+#define BIT_SOURCE_OPTION GENMASK(29, 28) - #define REG_ACBB0 0x948 - #define REG_ACBBRXFIR 0x94c - #define REG_ACGG2TBL 0x958 -@@ -179,4 +193,6 @@ _rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) - #define REG_ANTWT 0x1904 - #define REG_IQKFAILMSK 0x1bf0 - -+extern const struct rtw_chip_info rtw8822b_hw_spec; -+ - #endif -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822be.c b/drivers/net/wireless/realtek/rtw88/rtw8822be.c -index 921916ae1..499495077 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8822be.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822be.c -@@ -4,7 +4,8 @@ - - #include - #include --#include "rtw8822be.h" -+#include "pci.h" -+#include "rtw8822b.h" - - static const struct pci_device_id rtw_8822be_id_table[] = { - { -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822bs.c b/drivers/net/wireless/realtek/rtw88/rtw8822bs.c -new file mode 100644 -index 000000000..1ddef81da ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822bs.c -@@ -0,0 +1,36 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright(c) Jernej Skrabec -+ */ -+ -+#include -+#include "sdio_ids.h" -+#include -+#include "main.h" -+#include "rtw8822b.h" -+#include "sdio.h" -+ -+static const struct sdio_device_id rtw_8822bs_id_table[] = { -+ { -+ SDIO_DEVICE(SDIO_VENDOR_ID_REALTEK, -+ SDIO_DEVICE_ID_REALTEK_RTW8822BS), -+ .driver_data = (kernel_ulong_t)&rtw8822b_hw_spec, -+ }, -+ {} -+}; -+MODULE_DEVICE_TABLE(sdio, rtw_8822bs_id_table); -+ -+static struct sdio_driver rtw_8822bs_driver = { -+ .name = "rtw_8822bs", -+ .probe = rtw_sdio_probe, -+ .remove = rtw_sdio_remove, -+ .id_table = rtw_8822bs_id_table, -+ .drv = { -+ .pm = &rtw_sdio_pm_ops, -+ .shutdown = rtw_sdio_shutdown, -+ } -+}; -+module_sdio_driver(rtw_8822bs_driver); -+ -+MODULE_AUTHOR("Jernej Skrabec "); -+MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822bs driver"); -+MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822bu.c b/drivers/net/wireless/realtek/rtw88/rtw8822bu.c -new file mode 100644 -index 000000000..ab620a0b1 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822bu.c -@@ -0,0 +1,90 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright(c) 2018-2019 Realtek Corporation -+ */ -+ -+#include -+#include -+#include "main.h" -+#include "rtw8822b.h" -+#include "usb.h" -+ -+static const struct usb_device_id rtw_8822bu_id_table[] = { -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb812, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb82c, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x2102, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* CCNC */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xb822, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Edimax EW-7822ULC */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xc822, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Edimax EW-7822UTC */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xd822, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Edimax */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xe822, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Edimax */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xf822, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Edimax EW-7822UAD */ -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb81a, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Default ID */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x0b05, 0x1841, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* ASUS AC1300 USB-AC55 B1 */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x0b05, 0x184c, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* ASUS U2 */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x0B05, 0x19aa, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* ASUS - USB-AC58 rev A1 */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x0B05, 0x1870, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* ASUS */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x0B05, 0x1874, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* ASUS */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x331e, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Dlink - DWA-181 */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x331c, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Dlink - DWA-182 - D1 */ -+ {USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x331f, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec)}, /* Dlink - DWA-183 D Ver */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x13b1, 0x0043, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Linksys WUSB6400M */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x13b1, 0x0045, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Linksys WUSB3600 v2 */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x012d, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-Link Archer T3U v1 */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0138, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-Link Archer T3U Plus v1 */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0115, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-Link Archer T4U V3 */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x012e, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-LINK */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0116, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-LINK */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0117, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-LINK */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x0846, 0x9055, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Netgear A6150 */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x0e66, 0x0025, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Hawking HW12ACU */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x04ca, 0x8602, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* LiteOn */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x20f4, 0x808a, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TRENDnet TEW-808UBM */ -+ {}, -+}; -+MODULE_DEVICE_TABLE(usb, rtw_8822bu_id_table); -+ -+static int rtw8822bu_probe(struct usb_interface *intf, -+ const struct usb_device_id *id) -+{ -+ return rtw_usb_probe(intf, id); -+} -+ -+static struct usb_driver rtw_8822bu_driver = { -+ .name = "rtw_8822bu", -+ .id_table = rtw_8822bu_id_table, -+ .probe = rtw8822bu_probe, -+ .disconnect = rtw_usb_disconnect, -+}; -+module_usb_driver(rtw_8822bu_driver); -+ -+MODULE_AUTHOR("Realtek Corporation"); -+MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822bu driver"); -+MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822c.c b/drivers/net/wireless/realtek/rtw88/rtw8822c.c -index cee586335..8078127a5 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8822c.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822c.c -@@ -18,6 +18,8 @@ - #include "bf.h" - #include "efuse.h" - -+#define IQK_DONE_8822C 0xaa -+ - static void rtw8822c_config_trx_mode(struct rtw_dev *rtwdev, u8 tx_path, - u8 rx_path, bool is_tx2_path); - -@@ -27,6 +29,18 @@ static void rtw8822ce_efuse_parsing(struct rtw_efuse *efuse, - ether_addr_copy(efuse->addr, map->e.mac_addr); - } - -+static void rtw8822cu_efuse_parsing(struct rtw_efuse *efuse, -+ struct rtw8822c_efuse *map) -+{ -+ ether_addr_copy(efuse->addr, map->u.mac_addr); -+} -+ -+static void rtw8822cs_efuse_parsing(struct rtw_efuse *efuse, -+ struct rtw8822c_efuse *map) -+{ -+ ether_addr_copy(efuse->addr, map->s.mac_addr); -+} -+ - static int rtw8822c_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) - { - struct rtw_efuse *efuse = &rtwdev->efuse; -@@ -37,7 +51,7 @@ static int rtw8822c_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) - - efuse->rfe_option = map->rfe_option; - efuse->rf_board_option = map->rf_board_option; -- efuse->crystal_cap = map->xtal_k; -+ efuse->crystal_cap = map->xtal_k & XCAP_MASK; - efuse->channel_plan = map->channel_plan; - efuse->country_code[0] = map->country_code[0]; - efuse->country_code[1] = map->country_code[1]; -@@ -56,6 +70,12 @@ static int rtw8822c_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) - case RTW_HCI_TYPE_PCIE: - rtw8822ce_efuse_parsing(efuse, map); - break; -+ case RTW_HCI_TYPE_USB: -+ rtw8822cu_efuse_parsing(efuse, map); -+ break; -+ case RTW_HCI_TYPE_SDIO: -+ rtw8822cs_efuse_parsing(efuse, map); -+ break; - default: - /* unsupported now */ - return -ENOTSUPP; -@@ -77,6 +97,13 @@ static void rtw8822c_header_file_init(struct rtw_dev *rtwdev, bool pre) - rtw_write32_set(rtwdev, REG_ENCCK, BIT_CCK_OFDM_BLK_EN); - } - -+static void rtw8822c_bb_reset(struct rtw_dev *rtwdev) -+{ -+ rtw_write16_set(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_BB_RSTB); -+ rtw_write16_clr(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_BB_RSTB); -+ rtw_write16_set(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_BB_RSTB); -+} -+ - static void rtw8822c_dac_backup_reg(struct rtw_dev *rtwdev, - struct rtw_backup_info *backup, - struct rtw_backup_info *backup_rf) -@@ -1092,16 +1119,721 @@ static void rtw8822c_pa_bias(struct rtw_dev *rtwdev) - if (pg_pa_bias == EFUSE_READ_FAIL) - return; - pg_pa_bias = FIELD_GET(PPG_PABIAS_MASK, pg_pa_bias); -- rtw_write_rf(rtwdev, path, 0x60, RF_PABIAS_2G_MASK, pg_pa_bias); -+ rtw_write_rf(rtwdev, path, RF_PA, RF_PABIAS_2G_MASK, pg_pa_bias); - } - for (path = 0; path < rtwdev->hal.rf_path_num; path++) { - rtw_read8_physical_efuse(rtwdev, rf_efuse_5g[path], - &pg_pa_bias); - pg_pa_bias = FIELD_GET(PPG_PABIAS_MASK, pg_pa_bias); -- rtw_write_rf(rtwdev, path, 0x60, RF_PABIAS_5G_MASK, pg_pa_bias); -+ rtw_write_rf(rtwdev, path, RF_PA, RF_PABIAS_5G_MASK, pg_pa_bias); -+ } -+} -+ -+static void rtw8822c_rfk_handshake(struct rtw_dev *rtwdev, bool is_before_k) -+{ -+ struct rtw_dm_info *dm = &rtwdev->dm_info; -+ u8 u1b_tmp; -+ u8 u4b_tmp; -+ int ret; -+ -+ if (is_before_k) { -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[RFK] WiFi / BT RFK handshake start!!\n"); -+ -+ if (!dm->is_bt_iqk_timeout) { -+ ret = read_poll_timeout(rtw_read32_mask, u4b_tmp, -+ u4b_tmp == 0, 20, 600000, false, -+ rtwdev, REG_PMC_DBG_CTRL1, -+ BITS_PMC_BT_IQK_STS); -+ if (ret) { -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[RFK] Wait BT IQK finish timeout!!\n"); -+ dm->is_bt_iqk_timeout = true; -+ } -+ } -+ -+ rtw_fw_inform_rfk_status(rtwdev, true); -+ -+ ret = read_poll_timeout(rtw_read8_mask, u1b_tmp, -+ u1b_tmp == 1, 20, 100000, false, -+ rtwdev, REG_ARFR4, BIT_WL_RFK); -+ if (ret) -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[RFK] Send WiFi RFK start H2C cmd FAIL!!\n"); -+ } else { -+ rtw_fw_inform_rfk_status(rtwdev, false); -+ ret = read_poll_timeout(rtw_read8_mask, u1b_tmp, -+ u1b_tmp == 1, 20, 100000, false, -+ rtwdev, REG_ARFR4, -+ BIT_WL_RFK); -+ if (ret) -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[RFK] Send WiFi RFK finish H2C cmd FAIL!!\n"); -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[RFK] WiFi / BT RFK handshake finish!!\n"); -+ } -+} -+ -+static void rtw8822c_rfk_power_save(struct rtw_dev *rtwdev, -+ bool is_power_save) -+{ -+ u8 path; -+ -+ for (path = 0; path < rtwdev->hal.rf_path_num; path++) { -+ rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); -+ rtw_write32_mask(rtwdev, REG_DPD_CTL1_S0, BIT_PS_EN, -+ is_power_save ? 0 : 1); -+ } -+} -+ -+static void rtw8822c_txgapk_backup_bb_reg(struct rtw_dev *rtwdev, const u32 reg[], -+ u32 reg_backup[], u32 reg_num) -+{ -+ u32 i; -+ -+ for (i = 0; i < reg_num; i++) { -+ reg_backup[i] = rtw_read32(rtwdev, reg[i]); -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] Backup BB 0x%x = 0x%x\n", -+ reg[i], reg_backup[i]); -+ } -+} -+ -+static void rtw8822c_txgapk_reload_bb_reg(struct rtw_dev *rtwdev, -+ const u32 reg[], u32 reg_backup[], -+ u32 reg_num) -+{ -+ u32 i; -+ -+ for (i = 0; i < reg_num; i++) { -+ rtw_write32(rtwdev, reg[i], reg_backup[i]); -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] Reload BB 0x%x = 0x%x\n", -+ reg[i], reg_backup[i]); -+ } -+} -+ -+static bool check_rf_status(struct rtw_dev *rtwdev, u8 status) -+{ -+ u8 reg_rf0_a, reg_rf0_b; -+ -+ reg_rf0_a = (u8)rtw_read_rf(rtwdev, RF_PATH_A, -+ RF_MODE_TRXAGC, BIT_RF_MODE); -+ reg_rf0_b = (u8)rtw_read_rf(rtwdev, RF_PATH_B, -+ RF_MODE_TRXAGC, BIT_RF_MODE); -+ -+ if (reg_rf0_a == status || reg_rf0_b == status) -+ return false; -+ -+ return true; -+} -+ -+static void rtw8822c_txgapk_tx_pause(struct rtw_dev *rtwdev) -+{ -+ bool status; -+ int ret; -+ -+ rtw_write8(rtwdev, REG_TXPAUSE, BIT_AC_QUEUE); -+ rtw_write32_mask(rtwdev, REG_TX_FIFO, BIT_STOP_TX, 0x2); -+ -+ ret = read_poll_timeout_atomic(check_rf_status, status, status, -+ 2, 5000, false, rtwdev, 2); -+ if (ret) -+ rtw_warn(rtwdev, "failed to pause TX\n"); -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] Tx pause!!\n"); -+} -+ -+static void rtw8822c_txgapk_bb_dpk(struct rtw_dev *rtwdev, u8 path) -+{ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); -+ -+ rtw_write32_mask(rtwdev, REG_ENFN, BIT_IQK_DPK_EN, 0x1); -+ rtw_write32_mask(rtwdev, REG_CH_DELAY_EXTR2, -+ BIT_IQK_DPK_CLOCK_SRC, 0x1); -+ rtw_write32_mask(rtwdev, REG_CH_DELAY_EXTR2, -+ BIT_IQK_DPK_RESET_SRC, 0x1); -+ rtw_write32_mask(rtwdev, REG_CH_DELAY_EXTR2, BIT_EN_IOQ_IQK_DPK, 0x1); -+ rtw_write32_mask(rtwdev, REG_CH_DELAY_EXTR2, BIT_TST_IQK2SET_SRC, 0x0); -+ rtw_write32_mask(rtwdev, REG_CCA_OFF, BIT_CCA_ON_BY_PW, 0x1ff); -+ -+ if (path == RF_PATH_A) { -+ rtw_write32_mask(rtwdev, REG_RFTXEN_GCK_A, -+ BIT_RFTXEN_GCK_FORCE_ON, 0x1); -+ rtw_write32_mask(rtwdev, REG_3WIRE, BIT_DIS_SHARERX_TXGAT, 0x1); -+ rtw_write32_mask(rtwdev, REG_DIS_SHARE_RX_A, -+ BIT_TX_SCALE_0DB, 0x1); -+ rtw_write32_mask(rtwdev, REG_3WIRE, BIT_3WIRE_EN, 0x0); -+ } else if (path == RF_PATH_B) { -+ rtw_write32_mask(rtwdev, REG_RFTXEN_GCK_B, -+ BIT_RFTXEN_GCK_FORCE_ON, 0x1); -+ rtw_write32_mask(rtwdev, REG_3WIRE2, -+ BIT_DIS_SHARERX_TXGAT, 0x1); -+ rtw_write32_mask(rtwdev, REG_DIS_SHARE_RX_B, -+ BIT_TX_SCALE_0DB, 0x1); -+ rtw_write32_mask(rtwdev, REG_3WIRE2, BIT_3WIRE_EN, 0x0); -+ } -+ rtw_write32_mask(rtwdev, REG_CCKSB, BIT_BBMODE, 0x2); -+} -+ -+static void rtw8822c_txgapk_afe_dpk(struct rtw_dev *rtwdev, u8 path) -+{ -+ u32 reg; -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); -+ -+ if (path == RF_PATH_A) { -+ reg = REG_ANAPAR_A; -+ } else if (path == RF_PATH_B) { -+ reg = REG_ANAPAR_B; -+ } else { -+ rtw_err(rtwdev, "[TXGAPK] unknown path %d!!\n", path); -+ return; -+ } -+ -+ rtw_write32_mask(rtwdev, REG_IQK_CTRL, MASKDWORD, MASKDWORD); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x700f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x700f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x701f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x702f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x703f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x704f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x705f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x706f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x707f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x708f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x709f0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70af0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70bf0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70cf0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70df0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70ef0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70ff0001); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70ff0001); -+} -+ -+static void rtw8822c_txgapk_afe_dpk_restore(struct rtw_dev *rtwdev, u8 path) -+{ -+ u32 reg; -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); -+ -+ if (path == RF_PATH_A) { -+ reg = REG_ANAPAR_A; -+ } else if (path == RF_PATH_B) { -+ reg = REG_ANAPAR_B; -+ } else { -+ rtw_err(rtwdev, "[TXGAPK] unknown path %d!!\n", path); -+ return; -+ } -+ rtw_write32_mask(rtwdev, REG_IQK_CTRL, MASKDWORD, 0xffa1005e); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x700b8041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70144041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70244041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70344041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70444041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x705b8041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70644041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x707b8041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x708b8041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x709b8041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70ab8041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70bb8041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70cb8041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70db8041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70eb8041); -+ rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70fb8041); -+} -+ -+static void rtw8822c_txgapk_bb_dpk_restore(struct rtw_dev *rtwdev, u8 path) -+{ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); -+ -+ rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TX_GAIN, 0x0); -+ rtw_write_rf(rtwdev, path, RF_DIS_BYPASS_TXBB, BIT_TIA_BYPASS, 0x0); -+ rtw_write_rf(rtwdev, path, RF_DIS_BYPASS_TXBB, BIT_TXBB, 0x0); -+ -+ rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, 0x0); -+ rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0); -+ rtw_write32_mask(rtwdev, REG_SINGLE_TONE_SW, BIT_IRQ_TEST_MODE, 0x0); -+ rtw_write32_mask(rtwdev, REG_R_CONFIG, MASKBYTE0, 0x00); -+ rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, 0x1); -+ rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0); -+ rtw_write32_mask(rtwdev, REG_SINGLE_TONE_SW, BIT_IRQ_TEST_MODE, 0x0); -+ rtw_write32_mask(rtwdev, REG_R_CONFIG, MASKBYTE0, 0x00); -+ rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, 0x0); -+ rtw_write32_mask(rtwdev, REG_CCA_OFF, BIT_CCA_ON_BY_PW, 0x0); -+ -+ if (path == RF_PATH_A) { -+ rtw_write32_mask(rtwdev, REG_RFTXEN_GCK_A, -+ BIT_RFTXEN_GCK_FORCE_ON, 0x0); -+ rtw_write32_mask(rtwdev, REG_3WIRE, BIT_DIS_SHARERX_TXGAT, 0x0); -+ rtw_write32_mask(rtwdev, REG_DIS_SHARE_RX_A, -+ BIT_TX_SCALE_0DB, 0x0); -+ rtw_write32_mask(rtwdev, REG_3WIRE, BIT_3WIRE_EN, 0x3); -+ } else if (path == RF_PATH_B) { -+ rtw_write32_mask(rtwdev, REG_RFTXEN_GCK_B, -+ BIT_RFTXEN_GCK_FORCE_ON, 0x0); -+ rtw_write32_mask(rtwdev, REG_3WIRE2, -+ BIT_DIS_SHARERX_TXGAT, 0x0); -+ rtw_write32_mask(rtwdev, REG_DIS_SHARE_RX_B, -+ BIT_TX_SCALE_0DB, 0x0); -+ rtw_write32_mask(rtwdev, REG_3WIRE2, BIT_3WIRE_EN, 0x3); -+ } -+ -+ rtw_write32_mask(rtwdev, REG_CCKSB, BIT_BBMODE, 0x0); -+ rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_CFIR_EN, 0x5); -+} -+ -+static bool _rtw8822c_txgapk_gain_valid(struct rtw_dev *rtwdev, u32 gain) -+{ -+ if ((FIELD_GET(BIT_GAIN_TX_PAD_H, gain) >= 0xc) && -+ (FIELD_GET(BIT_GAIN_TX_PAD_L, gain) >= 0xe)) -+ return true; -+ -+ return false; -+} -+ -+static void _rtw8822c_txgapk_write_gain_bb_table(struct rtw_dev *rtwdev, -+ u8 band, u8 path) -+{ -+ struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; -+ u32 v, tmp_3f = 0; -+ u8 gain, check_txgain; -+ -+ rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); -+ -+ switch (band) { -+ case RF_BAND_2G_OFDM: -+ rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x0); -+ break; -+ case RF_BAND_5G_L: -+ rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x2); -+ break; -+ case RF_BAND_5G_M: -+ rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x3); -+ break; -+ case RF_BAND_5G_H: -+ rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x4); -+ break; -+ default: -+ break; -+ } -+ -+ rtw_write32_mask(rtwdev, REG_TX_GAIN_SET, MASKBYTE0, 0x88); -+ -+ check_txgain = 0; -+ for (gain = 0; gain < RF_GAIN_NUM; gain++) { -+ v = txgapk->rf3f_bp[band][gain][path]; -+ if (_rtw8822c_txgapk_gain_valid(rtwdev, v)) { -+ if (!check_txgain) { -+ tmp_3f = txgapk->rf3f_bp[band][gain][path]; -+ check_txgain = 1; -+ } -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] tx_gain=0x%03X >= 0xCEX\n", -+ txgapk->rf3f_bp[band][gain][path]); -+ } else { -+ tmp_3f = txgapk->rf3f_bp[band][gain][path]; -+ } -+ -+ rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN, tmp_3f); -+ rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_I_GAIN, gain); -+ rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_GAIN_RST, 0x1); -+ rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_GAIN_RST, 0x0); -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] Band=%d 0x1b98[11:0]=0x%03X path=%d\n", -+ band, tmp_3f, path); - } - } - -+static void rtw8822c_txgapk_write_gain_bb_table(struct rtw_dev *rtwdev) -+{ -+ u8 path, band; -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s channel=%d\n", -+ __func__, rtwdev->dm_info.gapk.channel); -+ -+ for (band = 0; band < RF_BAND_MAX; band++) { -+ for (path = 0; path < rtwdev->hal.rf_path_num; path++) { -+ _rtw8822c_txgapk_write_gain_bb_table(rtwdev, -+ band, path); -+ } -+ } -+} -+ -+static void rtw8822c_txgapk_read_offset(struct rtw_dev *rtwdev, u8 path) -+{ -+ static const u32 cfg1_1b00[2] = {0x00000d18, 0x00000d2a}; -+ static const u32 cfg2_1b00[2] = {0x00000d19, 0x00000d2b}; -+ static const u32 set_pi[2] = {REG_RSV_CTRL, REG_WLRF1}; -+ static const u32 path_setting[2] = {REG_ORITXCODE, REG_ORITXCODE2}; -+ struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; -+ u8 channel = txgapk->channel; -+ u32 val; -+ int i; -+ -+ if (path >= ARRAY_SIZE(cfg1_1b00) || -+ path >= ARRAY_SIZE(cfg2_1b00) || -+ path >= ARRAY_SIZE(set_pi) || -+ path >= ARRAY_SIZE(path_setting)) { -+ rtw_warn(rtwdev, "[TXGAPK] wrong path %d\n", path); -+ return; -+ } -+ -+ rtw_write32_mask(rtwdev, REG_ANTMAP0, BIT_ANT_PATH, path + 1); -+ rtw_write32_mask(rtwdev, REG_TXLGMAP, MASKDWORD, 0xe4e40000); -+ rtw_write32_mask(rtwdev, REG_TXANTSEG, BIT_ANTSEG, 0x3); -+ rtw_write32_mask(rtwdev, path_setting[path], MASK20BITS, 0x33312); -+ rtw_write32_mask(rtwdev, path_setting[path], BIT_PATH_EN, 0x1); -+ rtw_write32_mask(rtwdev, set_pi[path], BITS_RFC_DIRECT, 0x0); -+ rtw_write_rf(rtwdev, path, RF_LUTDBG, BIT_TXA_TANK, 0x1); -+ rtw_write_rf(rtwdev, path, RF_IDAC, BIT_TX_MODE, 0x820); -+ rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); -+ rtw_write32_mask(rtwdev, REG_IQKSTAT, MASKBYTE0, 0x0); -+ -+ rtw_write32_mask(rtwdev, REG_TX_TONE_IDX, MASKBYTE0, 0x018); -+ fsleep(1000); -+ if (channel >= 1 && channel <= 14) -+ rtw_write32_mask(rtwdev, REG_R_CONFIG, MASKBYTE0, BIT_2G_SWING); -+ else -+ rtw_write32_mask(rtwdev, REG_R_CONFIG, MASKBYTE0, BIT_5G_SWING); -+ fsleep(1000); -+ -+ rtw_write32_mask(rtwdev, REG_NCTL0, MASKDWORD, cfg1_1b00[path]); -+ rtw_write32_mask(rtwdev, REG_NCTL0, MASKDWORD, cfg2_1b00[path]); -+ -+ read_poll_timeout(rtw_read32_mask, val, -+ val == 0x55, 1000, 100000, false, -+ rtwdev, REG_RPT_CIP, BIT_RPT_CIP_STATUS); -+ -+ rtw_write32_mask(rtwdev, set_pi[path], BITS_RFC_DIRECT, 0x2); -+ rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); -+ rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_RPT_EN, 0x1); -+ rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_RPT_SEL, 0x12); -+ rtw_write32_mask(rtwdev, REG_TX_GAIN_SET, BIT_GAPK_RPT_IDX, 0x3); -+ val = rtw_read32(rtwdev, REG_STAT_RPT); -+ -+ txgapk->offset[0][path] = (s8)FIELD_GET(BIT_GAPK_RPT0, val); -+ txgapk->offset[1][path] = (s8)FIELD_GET(BIT_GAPK_RPT1, val); -+ txgapk->offset[2][path] = (s8)FIELD_GET(BIT_GAPK_RPT2, val); -+ txgapk->offset[3][path] = (s8)FIELD_GET(BIT_GAPK_RPT3, val); -+ txgapk->offset[4][path] = (s8)FIELD_GET(BIT_GAPK_RPT4, val); -+ txgapk->offset[5][path] = (s8)FIELD_GET(BIT_GAPK_RPT5, val); -+ txgapk->offset[6][path] = (s8)FIELD_GET(BIT_GAPK_RPT6, val); -+ txgapk->offset[7][path] = (s8)FIELD_GET(BIT_GAPK_RPT7, val); -+ -+ rtw_write32_mask(rtwdev, REG_TX_GAIN_SET, BIT_GAPK_RPT_IDX, 0x4); -+ val = rtw_read32(rtwdev, REG_STAT_RPT); -+ -+ txgapk->offset[8][path] = (s8)FIELD_GET(BIT_GAPK_RPT0, val); -+ txgapk->offset[9][path] = (s8)FIELD_GET(BIT_GAPK_RPT1, val); -+ -+ for (i = 0; i < RF_HW_OFFSET_NUM; i++) -+ if (txgapk->offset[i][path] & BIT(3)) -+ txgapk->offset[i][path] = txgapk->offset[i][path] | -+ 0xf0; -+ for (i = 0; i < RF_HW_OFFSET_NUM; i++) -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] offset %d %d path=%d\n", -+ txgapk->offset[i][path], i, path); -+} -+ -+static void rtw8822c_txgapk_calculate_offset(struct rtw_dev *rtwdev, u8 path) -+{ -+ static const u32 bb_reg[] = {REG_ANTMAP0, REG_TXLGMAP, REG_TXANTSEG, -+ REG_ORITXCODE, REG_ORITXCODE2}; -+ struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; -+ u8 channel = txgapk->channel; -+ u32 reg_backup[ARRAY_SIZE(bb_reg)] = {0}; -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s channel=%d\n", -+ __func__, channel); -+ -+ rtw8822c_txgapk_backup_bb_reg(rtwdev, bb_reg, -+ reg_backup, ARRAY_SIZE(bb_reg)); -+ -+ if (channel >= 1 && channel <= 14) { -+ rtw_write32_mask(rtwdev, -+ REG_SINGLE_TONE_SW, BIT_IRQ_TEST_MODE, 0x0); -+ rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); -+ rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x3f); -+ rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0); -+ rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TX_GAIN, 0x1); -+ rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, RFREG_MASK, 0x5000f); -+ rtw_write_rf(rtwdev, path, RF_TX_GAIN_OFFSET, BIT_RF_GAIN, 0x0); -+ rtw_write_rf(rtwdev, path, RF_RXG_GAIN, BIT_RXG_GAIN, 0x1); -+ rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_RXAGC, 0x0f); -+ rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TRXBW, 0x1); -+ rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_TXBB, 0x1); -+ rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_RXBB, 0x0); -+ rtw_write_rf(rtwdev, path, RF_EXT_TIA_BW, BIT_PW_EXT_TIA, 0x1); -+ -+ rtw_write32_mask(rtwdev, REG_IQKSTAT, MASKBYTE0, 0x00); -+ rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x0); -+ -+ rtw8822c_txgapk_read_offset(rtwdev, path); -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "=============================\n"); -+ -+ } else { -+ rtw_write32_mask(rtwdev, -+ REG_SINGLE_TONE_SW, BIT_IRQ_TEST_MODE, 0x0); -+ rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); -+ rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x3f); -+ rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0); -+ rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TX_GAIN, 0x1); -+ rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, RFREG_MASK, 0x50011); -+ rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_TXA_LB_ATT, 0x3); -+ rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_LB_ATT, 0x3); -+ rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_LB_SW, 0x1); -+ rtw_write_rf(rtwdev, path, -+ RF_RXA_MIX_GAIN, BIT_RXA_MIX_GAIN, 0x2); -+ rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_RXAGC, 0x12); -+ rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TRXBW, 0x1); -+ rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_RXBB, 0x0); -+ rtw_write_rf(rtwdev, path, RF_EXT_TIA_BW, BIT_PW_EXT_TIA, 0x1); -+ rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_RF_MODE, 0x5); -+ -+ rtw_write32_mask(rtwdev, REG_IQKSTAT, MASKBYTE0, 0x0); -+ -+ if (channel >= 36 && channel <= 64) -+ rtw_write32_mask(rtwdev, -+ REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x2); -+ else if (channel >= 100 && channel <= 144) -+ rtw_write32_mask(rtwdev, -+ REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x3); -+ else if (channel >= 149 && channel <= 177) -+ rtw_write32_mask(rtwdev, -+ REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x4); -+ -+ rtw8822c_txgapk_read_offset(rtwdev, path); -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "=============================\n"); -+ } -+ rtw8822c_txgapk_reload_bb_reg(rtwdev, bb_reg, -+ reg_backup, ARRAY_SIZE(bb_reg)); -+} -+ -+static void rtw8822c_txgapk_rf_restore(struct rtw_dev *rtwdev, u8 path) -+{ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); -+ -+ if (path >= rtwdev->hal.rf_path_num) -+ return; -+ -+ rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_RF_MODE, 0x3); -+ rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TRXBW, 0x0); -+ rtw_write_rf(rtwdev, path, RF_EXT_TIA_BW, BIT_PW_EXT_TIA, 0x0); -+} -+ -+static u32 rtw8822c_txgapk_cal_gain(struct rtw_dev *rtwdev, u32 gain, s8 offset) -+{ -+ u32 gain_x2, new_gain; -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); -+ -+ if (_rtw8822c_txgapk_gain_valid(rtwdev, gain)) { -+ new_gain = gain; -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] gain=0x%03X(>=0xCEX) offset=%d new_gain=0x%03X\n", -+ gain, offset, new_gain); -+ return new_gain; -+ } -+ -+ gain_x2 = (gain << 1) + offset; -+ new_gain = (gain_x2 >> 1) | (gain_x2 & BIT(0) ? BIT_GAIN_EXT : 0); -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] gain=0x%X offset=%d new_gain=0x%X\n", -+ gain, offset, new_gain); -+ -+ return new_gain; -+} -+ -+static void rtw8822c_txgapk_write_tx_gain(struct rtw_dev *rtwdev) -+{ -+ struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; -+ u32 i, j, tmp = 0x20, tmp_3f, v; -+ s8 offset_tmp[RF_GAIN_NUM] = {0}; -+ u8 path, band = RF_BAND_2G_OFDM, channel = txgapk->channel; -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); -+ -+ if (channel >= 1 && channel <= 14) { -+ tmp = 0x20; -+ band = RF_BAND_2G_OFDM; -+ } else if (channel >= 36 && channel <= 64) { -+ tmp = 0x200; -+ band = RF_BAND_5G_L; -+ } else if (channel >= 100 && channel <= 144) { -+ tmp = 0x280; -+ band = RF_BAND_5G_M; -+ } else if (channel >= 149 && channel <= 177) { -+ tmp = 0x300; -+ band = RF_BAND_5G_H; -+ } else { -+ rtw_err(rtwdev, "[TXGAPK] unknown channel %d!!\n", channel); -+ return; -+ } -+ -+ for (path = 0; path < rtwdev->hal.rf_path_num; path++) { -+ for (i = 0; i < RF_GAIN_NUM; i++) { -+ offset_tmp[i] = 0; -+ for (j = i; j < RF_GAIN_NUM; j++) { -+ v = txgapk->rf3f_bp[band][j][path]; -+ if (_rtw8822c_txgapk_gain_valid(rtwdev, v)) -+ continue; -+ -+ offset_tmp[i] += txgapk->offset[j][path]; -+ txgapk->fianl_offset[i][path] = offset_tmp[i]; -+ } -+ -+ v = txgapk->rf3f_bp[band][i][path]; -+ if (_rtw8822c_txgapk_gain_valid(rtwdev, v)) { -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] tx_gain=0x%03X >= 0xCEX\n", -+ txgapk->rf3f_bp[band][i][path]); -+ } else { -+ txgapk->rf3f_fs[path][i] = offset_tmp[i]; -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] offset %d %d\n", -+ offset_tmp[i], i); -+ } -+ } -+ -+ rtw_write_rf(rtwdev, path, RF_LUTWE2, RFREG_MASK, 0x10000); -+ for (i = 0; i < RF_GAIN_NUM; i++) { -+ rtw_write_rf(rtwdev, path, -+ RF_LUTWA, RFREG_MASK, tmp + i); -+ -+ tmp_3f = rtw8822c_txgapk_cal_gain(rtwdev, -+ txgapk->rf3f_bp[band][i][path], -+ offset_tmp[i]); -+ rtw_write_rf(rtwdev, path, RF_LUTWD0, -+ BIT_GAIN_EXT | BIT_DATA_L, tmp_3f); -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] 0x33=0x%05X 0x3f=0x%04X\n", -+ tmp + i, tmp_3f); -+ } -+ rtw_write_rf(rtwdev, path, RF_LUTWE2, RFREG_MASK, 0x0); -+ } -+} -+ -+static void rtw8822c_txgapk_save_all_tx_gain_table(struct rtw_dev *rtwdev) -+{ -+ struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; -+ static const u32 three_wire[2] = {REG_3WIRE, REG_3WIRE2}; -+ static const u8 ch_num[RF_BAND_MAX] = {1, 1, 36, 100, 149}; -+ static const u8 band_num[RF_BAND_MAX] = {0x0, 0x0, 0x1, 0x3, 0x5}; -+ static const u8 cck[RF_BAND_MAX] = {0x1, 0x0, 0x0, 0x0, 0x0}; -+ u8 path, band, gain, rf0_idx; -+ u32 rf18, v; -+ -+ if (rtwdev->dm_info.dm_flags & BIT(RTW_DM_CAP_TXGAPK)) -+ return; -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); -+ -+ if (txgapk->read_txgain == 1) { -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] Already Read txgapk->read_txgain return!!!\n"); -+ rtw8822c_txgapk_write_gain_bb_table(rtwdev); -+ return; -+ } -+ -+ for (band = 0; band < RF_BAND_MAX; band++) { -+ for (path = 0; path < rtwdev->hal.rf_path_num; path++) { -+ rf18 = rtw_read_rf(rtwdev, path, RF_CFGCH, RFREG_MASK); -+ -+ rtw_write32_mask(rtwdev, -+ three_wire[path], BIT_3WIRE_EN, 0x0); -+ rtw_write_rf(rtwdev, path, -+ RF_CFGCH, MASKBYTE0, ch_num[band]); -+ rtw_write_rf(rtwdev, path, -+ RF_CFGCH, BIT_BAND, band_num[band]); -+ rtw_write_rf(rtwdev, path, -+ RF_BW_TRXBB, BIT_DBG_CCK_CCA, cck[band]); -+ rtw_write_rf(rtwdev, path, -+ RF_BW_TRXBB, BIT_TX_CCK_IND, cck[band]); -+ gain = 0; -+ for (rf0_idx = 1; rf0_idx < 32; rf0_idx += 3) { -+ rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, -+ MASKBYTE0, rf0_idx); -+ v = rtw_read_rf(rtwdev, path, -+ RF_TX_RESULT, RFREG_MASK); -+ txgapk->rf3f_bp[band][gain][path] = v & BIT_DATA_L; -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] 0x5f=0x%03X band=%d path=%d\n", -+ txgapk->rf3f_bp[band][gain][path], -+ band, path); -+ gain++; -+ } -+ rtw_write_rf(rtwdev, path, RF_CFGCH, RFREG_MASK, rf18); -+ rtw_write32_mask(rtwdev, -+ three_wire[path], BIT_3WIRE_EN, 0x3); -+ } -+ } -+ rtw8822c_txgapk_write_gain_bb_table(rtwdev); -+ txgapk->read_txgain = 1; -+} -+ -+static void rtw8822c_txgapk(struct rtw_dev *rtwdev) -+{ -+ static const u32 bb_reg[2] = {REG_TX_PTCL_CTRL, REG_TX_FIFO}; -+ struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; -+ u32 bb_reg_backup[2]; -+ u8 path; -+ -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); -+ -+ rtw8822c_txgapk_save_all_tx_gain_table(rtwdev); -+ -+ if (txgapk->read_txgain == 0) { -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] txgapk->read_txgain == 0 return!!!\n"); -+ return; -+ } -+ -+ if (rtwdev->efuse.power_track_type >= 4 && -+ rtwdev->efuse.power_track_type <= 7) { -+ rtw_dbg(rtwdev, RTW_DBG_RFK, -+ "[TXGAPK] Normal Mode in TSSI mode. return!!!\n"); -+ return; -+ } -+ -+ rtw8822c_txgapk_backup_bb_reg(rtwdev, bb_reg, -+ bb_reg_backup, ARRAY_SIZE(bb_reg)); -+ rtw8822c_txgapk_tx_pause(rtwdev); -+ for (path = 0; path < rtwdev->hal.rf_path_num; path++) { -+ txgapk->channel = rtw_read_rf(rtwdev, path, -+ RF_CFGCH, RFREG_MASK) & MASKBYTE0; -+ rtw8822c_txgapk_bb_dpk(rtwdev, path); -+ rtw8822c_txgapk_afe_dpk(rtwdev, path); -+ rtw8822c_txgapk_calculate_offset(rtwdev, path); -+ rtw8822c_txgapk_rf_restore(rtwdev, path); -+ rtw8822c_txgapk_afe_dpk_restore(rtwdev, path); -+ rtw8822c_txgapk_bb_dpk_restore(rtwdev, path); -+ } -+ rtw8822c_txgapk_write_tx_gain(rtwdev); -+ rtw8822c_txgapk_reload_bb_reg(rtwdev, bb_reg, -+ bb_reg_backup, ARRAY_SIZE(bb_reg)); -+} -+ -+static void rtw8822c_do_gapk(struct rtw_dev *rtwdev) -+{ -+ struct rtw_dm_info *dm = &rtwdev->dm_info; -+ -+ if (dm->dm_flags & BIT(RTW_DM_CAP_TXGAPK)) { -+ rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] feature disable!!!\n"); -+ return; -+ } -+ rtw8822c_rfk_handshake(rtwdev, true); -+ rtw8822c_txgapk(rtwdev); -+ rtw8822c_rfk_handshake(rtwdev, false); -+} -+ - static void rtw8822c_rf_init(struct rtw_dev *rtwdev) - { - rtw8822c_rf_dac_cal(rtwdev); -@@ -1388,6 +2120,8 @@ static int rtw8822c_mac_init(struct rtw_dev *rtwdev) - BIT_RXPSF_CONT_ERRCHKEN); - value16 = BIT_SET_RXPSF_ERRTHR(value16, 0x07); - rtw_write16(rtwdev, REG_RXPSF_CTRL, value16); -+ rtw_write8_set(rtwdev, REG_SND_PTCL_CTRL, -+ BIT_DIS_CHK_VHTSIGB_CRC); - - /* Interrupt migration configuration */ - rtw_write32(rtwdev, REG_INT_MIG, WLAN_MAC_INT_MIG_CFG); -@@ -1395,6 +2129,53 @@ static int rtw8822c_mac_init(struct rtw_dev *rtwdev) - return 0; - } - -+#define FWCD_SIZE_REG_8822C 0x2000 -+#define FWCD_SIZE_DMEM_8822C 0x10000 -+#define FWCD_SIZE_IMEM_8822C 0x10000 -+#define FWCD_SIZE_EMEM_8822C 0x20000 -+#define FWCD_SIZE_ROM_8822C 0x10000 -+ -+static const u32 __fwcd_segs_8822c[] = { -+ FWCD_SIZE_REG_8822C, -+ FWCD_SIZE_DMEM_8822C, -+ FWCD_SIZE_IMEM_8822C, -+ FWCD_SIZE_EMEM_8822C, -+ FWCD_SIZE_ROM_8822C, -+}; -+ -+static const struct rtw_fwcd_segs rtw8822c_fwcd_segs = { -+ .segs = __fwcd_segs_8822c, -+ .num = ARRAY_SIZE(__fwcd_segs_8822c), -+}; -+ -+static int rtw8822c_dump_fw_crash(struct rtw_dev *rtwdev) -+{ -+#define __dump_fw_8822c(_dev, _mem) \ -+ rtw_dump_fw(_dev, OCPBASE_ ## _mem ## _88XX, \ -+ FWCD_SIZE_ ## _mem ## _8822C, RTW_FWCD_ ## _mem) -+ int ret; -+ -+ ret = rtw_dump_reg(rtwdev, 0x0, FWCD_SIZE_REG_8822C); -+ if (ret) -+ return ret; -+ ret = __dump_fw_8822c(rtwdev, DMEM); -+ if (ret) -+ return ret; -+ ret = __dump_fw_8822c(rtwdev, IMEM); -+ if (ret) -+ return ret; -+ ret = __dump_fw_8822c(rtwdev, EMEM); -+ if (ret) -+ return ret; -+ ret = __dump_fw_8822c(rtwdev, ROM); -+ if (ret) -+ return ret; -+ -+ return 0; -+ -+#undef __dump_fw_8822c -+} -+ - static void rtw8822c_rstb_3wire(struct rtw_dev *rtwdev, bool enable) - { - if (enable) { -@@ -1707,10 +2488,11 @@ static void rtw8822c_config_cck_tx_path(struct rtw_dev *rtwdev, u8 tx_path, - else - rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0xf0000000, 0x8); - } -+ rtw8822c_bb_reset(rtwdev); - } - - static void rtw8822c_config_ofdm_tx_path(struct rtw_dev *rtwdev, u8 tx_path, -- bool is_tx2_path) -+ enum rtw_bb_path tx_path_sel_1ss) - { - if (tx_path == BB_PATH_A) { - rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x11); -@@ -1719,21 +2501,28 @@ static void rtw8822c_config_ofdm_tx_path(struct rtw_dev *rtwdev, u8 tx_path, - rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x12); - rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xff, 0x0); - } else { -- if (is_tx2_path) { -+ if (tx_path_sel_1ss == BB_PATH_AB) { - rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x33); - rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xffff, 0x0404); -- } else { -+ } else if (tx_path_sel_1ss == BB_PATH_B) { -+ rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x32); -+ rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xffff, 0x0400); -+ } else if (tx_path_sel_1ss == BB_PATH_A) { - rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x31); - rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xffff, 0x0400); - } - } -+ rtw8822c_bb_reset(rtwdev); - } - - static void rtw8822c_config_tx_path(struct rtw_dev *rtwdev, u8 tx_path, -+ enum rtw_bb_path tx_path_sel_1ss, -+ enum rtw_bb_path tx_path_cck, - bool is_tx2_path) - { -- rtw8822c_config_cck_tx_path(rtwdev, tx_path, is_tx2_path); -- rtw8822c_config_ofdm_tx_path(rtwdev, tx_path, is_tx2_path); -+ rtw8822c_config_cck_tx_path(rtwdev, tx_path_cck, is_tx2_path); -+ rtw8822c_config_ofdm_tx_path(rtwdev, tx_path, tx_path_sel_1ss); -+ rtw8822c_bb_reset(rtwdev); - } - - static void rtw8822c_config_trx_mode(struct rtw_dev *rtwdev, u8 tx_path, -@@ -1749,7 +2538,8 @@ static void rtw8822c_config_trx_mode(struct rtw_dev *rtwdev, u8 tx_path, - rtw_write32_mask(rtwdev, REG_ORITXCODE2, MASK20BITS, 0x11111); - - rtw8822c_config_rx_path(rtwdev, rx_path); -- rtw8822c_config_tx_path(rtwdev, tx_path, is_tx2_path); -+ rtw8822c_config_tx_path(rtwdev, tx_path, BB_PATH_A, BB_PATH_A, -+ is_tx2_path); - - rtw8822c_toggle_igi(rtwdev); - } -@@ -1763,6 +2553,7 @@ static void query_phy_status_page0(struct rtw_dev *rtwdev, u8 *phy_status, - s8 rx_power[RTW_RF_PATH_MAX]; - s8 min_rx_power = -120; - u8 rssi; -+ u8 channel; - int path; - - rx_power[RF_PATH_A] = GET_PHY_STAT_P0_PWDB_A(phy_status); -@@ -1783,6 +2574,11 @@ static void query_phy_status_page0(struct rtw_dev *rtwdev, u8 *phy_status, - rx_power[RF_PATH_A] -= 110; - rx_power[RF_PATH_B] -= 110; - -+ channel = GET_PHY_STAT_P0_CHANNEL(phy_status); -+ if (channel == 0) -+ channel = rtwdev->hal.current_channel; -+ rtw_set_rx_freq_band(pkt_stat, channel); -+ - pkt_stat->rx_power[RF_PATH_A] = rx_power[RF_PATH_A]; - pkt_stat->rx_power[RF_PATH_B] = rx_power[RF_PATH_B]; - -@@ -1800,6 +2596,7 @@ static void query_phy_status_page0(struct rtw_dev *rtwdev, u8 *phy_status, - static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, - struct rtw_rx_pkt_stat *pkt_stat) - { -+ struct rtw_path_div *p_div = &rtwdev->dm_path_div; - struct rtw_dm_info *dm_info = &rtwdev->dm_info; - u8 rxsc, bw; - s8 min_rx_power = -120; -@@ -1807,6 +2604,7 @@ static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, - u8 evm_dbm = 0; - u8 rssi; - int path; -+ u8 channel; - - if (pkt_stat->rate > DESC_RATE11M && pkt_stat->rate < DESC_RATEMCS0) - rxsc = GET_PHY_STAT_P1_L_RXSC(phy_status); -@@ -1820,6 +2618,9 @@ static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, - else - bw = RTW_CHANNEL_WIDTH_20; - -+ channel = GET_PHY_STAT_P1_CHANNEL(phy_status); -+ rtw_set_rx_freq_band(pkt_stat, channel); -+ - pkt_stat->rx_power[RF_PATH_A] = GET_PHY_STAT_P1_PWDB_A(phy_status) - 110; - pkt_stat->rx_power[RF_PATH_B] = GET_PHY_STAT_P1_PWDB_B(phy_status) - 110; - pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 2); -@@ -1842,6 +2643,13 @@ static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, - for (path = 0; path <= rtwdev->hal.rf_path_num; path++) { - rssi = rtw_phy_rf_power_2_rssi(&pkt_stat->rx_power[path], 1); - dm_info->rssi[path] = rssi; -+ if (path == RF_PATH_A) { -+ p_div->path_a_sum += rssi; -+ p_div->path_a_cnt++; -+ } else if (path == RF_PATH_B) { -+ p_div->path_b_sum += rssi; -+ p_div->path_b_cnt++; -+ } - dm_info->rx_snr[path] = pkt_stat->rx_snr[path] >> 1; - dm_info->cfo_tail[path] = (pkt_stat->cfo_tail[path] * 5) >> 1; - -@@ -1855,6 +2663,7 @@ static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, - } - dm_info->rx_evm_dbm[path] = evm_dbm; - } -+ rtw_phy_parsing_cfo(rtwdev, pkt_stat); - } - - static void query_phy_status(struct rtw_dev *rtwdev, u8 *phy_status, -@@ -1910,6 +2719,7 @@ static void rtw8822c_query_rx_desc(struct rtw_dev *rtwdev, u8 *rx_desc, - - hdr = (struct ieee80211_hdr *)(rx_desc + desc_sz + pkt_stat->shift + - pkt_stat->drv_info_sz); -+ pkt_stat->hdr = hdr; - if (pkt_stat->phy_status) { - phy_status = rx_desc + desc_sz + pkt_stat->shift; - query_phy_status(rtwdev, phy_status, pkt_stat); -@@ -2006,7 +2816,7 @@ static int rtw8822c_set_antenna(struct rtw_dev *rtwdev, - case BB_PATH_AB: - break; - default: -- rtw_info(rtwdev, "unsupported tx path 0x%x\n", antenna_tx); -+ rtw_warn(rtwdev, "unsupported tx path 0x%x\n", antenna_tx); - return -EINVAL; - } - -@@ -2016,7 +2826,7 @@ static int rtw8822c_set_antenna(struct rtw_dev *rtwdev, - case BB_PATH_AB: - break; - default: -- rtw_info(rtwdev, "unsupported rx path 0x%x\n", antenna_rx); -+ rtw_warn(rtwdev, "unsupported rx path 0x%x\n", antenna_rx); - return -EINVAL; - } - -@@ -2131,20 +2941,17 @@ static void rtw8822c_do_iqk(struct rtw_dev *rtwdev) - { - struct rtw_iqk_para para = {0}; - u8 iqk_chk; -- int counter; -+ int ret; - - para.clear = 1; - rtw_fw_do_iqk(rtwdev, ¶); - -- for (counter = 0; counter < 300; counter++) { -- iqk_chk = rtw_read8(rtwdev, REG_RPT_CIP); -- if (iqk_chk == 0xaa) -- break; -- msleep(20); -- } -- rtw_write8(rtwdev, REG_IQKSTAT, 0x0); -+ ret = read_poll_timeout(rtw_read8, iqk_chk, iqk_chk == IQK_DONE_8822C, -+ 20000, 300000, false, rtwdev, REG_RPT_CIP); -+ if (ret) -+ rtw_warn(rtwdev, "failed to poll iqk status bit\n"); - -- rtw_dbg(rtwdev, RTW_DBG_RFK, "iqk counter=%d\n", counter); -+ rtw_write8(rtwdev, REG_IQKSTAT, 0x0); - } - - /* for coex */ -@@ -2153,28 +2960,28 @@ static void rtw8822c_coex_cfg_init(struct rtw_dev *rtwdev) - /* enable TBTT nterrupt */ - rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); - -- /* BT report packet sample rate */ -+ /* BT report packet sample rate */ - /* 0x790[5:0]=0x5 */ -- rtw_write8_set(rtwdev, REG_BT_TDMA_TIME, 0x05); -+ rtw_write8_mask(rtwdev, REG_BT_TDMA_TIME, BIT_MASK_SAMPLE_RATE, 0x5); - - /* enable BT counter statistics */ - rtw_write8(rtwdev, REG_BT_STAT_CTRL, 0x1); - - /* enable PTA (3-wire function form BT side) */ - rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_PTA_EN); -- rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_AOD_GPIO3); -+ rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_PO_BT_PTA_PINS); - - /* enable PTA (tx/rx signal form WiFi side) */ - rtw_write8_set(rtwdev, REG_QUEUE_CTRL, BIT_PTA_WL_TX_EN); - /* wl tx signal to PTA not case EDCCA */ - rtw_write8_clr(rtwdev, REG_QUEUE_CTRL, BIT_PTA_EDCCA_EN); - /* GNT_BT=1 while select both */ -- rtw_write8_set(rtwdev, REG_BT_COEX_V2, BIT_GNT_BT_POLARITY); -- /* BT_CCA = ~GNT_WL_BB, (not or GNT_BT_BB, LTE_Rx */ -+ rtw_write16_set(rtwdev, REG_BT_COEX_V2, BIT_GNT_BT_POLARITY); -+ /* BT_CCA = ~GNT_WL_BB, not or GNT_BT_BB, LTE_Rx */ - rtw_write8_clr(rtwdev, REG_DUMMY_PAGE4_V1, BIT_BTCCA_CTRL); - - /* to avoid RF parameter error */ -- rtw_write_rf(rtwdev, RF_PATH_B, 0x1, 0xfffff, 0x40000); -+ rtw_write_rf(rtwdev, RF_PATH_B, RF_MODOPT, 0xfffff, 0x40000); - } - - static void rtw8822c_coex_cfg_gnt_fix(struct rtw_dev *rtwdev) -@@ -2207,41 +3014,62 @@ static void rtw8822c_coex_cfg_gnt_fix(struct rtw_dev *rtwdev) - * enable "DAC off if GNT_WL = 0" for non-shared-antenna - * disable 0x1c30[22] = 0, - * enable: 0x1c30[22] = 1, 0x1c38[12] = 0, 0x1c38[28] = 1 -- * -- * disable WL-S1 BB chage RF mode if GNT_BT -+ */ -+ if (coex_stat->wl_coex_mode == COEX_WLINK_2GFREE) { -+ rtw_write8_mask(rtwdev, REG_ANAPAR + 2, -+ BIT_ANAPAR_BTPS >> 16, 0); -+ } else { -+ rtw_write8_mask(rtwdev, REG_ANAPAR + 2, -+ BIT_ANAPAR_BTPS >> 16, 1); -+ rtw_write8_mask(rtwdev, REG_RSTB_SEL + 1, -+ BIT_DAC_OFF_ENABLE, 0); -+ rtw_write8_mask(rtwdev, REG_RSTB_SEL + 3, -+ BIT_DAC_OFF_ENABLE, 1); -+ } -+ -+ /* disable WL-S1 BB chage RF mode if GNT_BT - * since RF TRx mask can do it - */ -- rtw_write8_mask(rtwdev, 0x1c32, BIT(6), 1); -- rtw_write8_mask(rtwdev, 0x1c39, BIT(4), 0); -- rtw_write8_mask(rtwdev, 0x1c3b, BIT(4), 1); -- rtw_write8_mask(rtwdev, 0x4160, BIT(3), 1); -+ rtw_write8_mask(rtwdev, REG_IGN_GNTBT4, -+ BIT_PI_IGNORE_GNT_BT, 1); - - /* disable WL-S0 BB chage RF mode if wifi is at 5G, - * or antenna path is separated - */ -- if (coex_stat->wl_coex_mode == COEX_WLINK_5G || -+ if (coex_stat->wl_coex_mode == COEX_WLINK_2GFREE) { -+ rtw_write8_mask(rtwdev, REG_IGN_GNT_BT1, -+ BIT_PI_IGNORE_GNT_BT, 1); -+ rtw_write8_mask(rtwdev, REG_NOMASK_TXBT, -+ BIT_NOMASK_TXBT_ENABLE, 1); -+ } else if (coex_stat->wl_coex_mode == COEX_WLINK_5G || - coex->under_5g || !efuse->share_ant) { - if (coex_stat->kt_ver >= 3) { -- rtw_write8_mask(rtwdev, 0x1860, BIT(3), 0); -- rtw_write8_mask(rtwdev, 0x1ca7, BIT(3), 1); -+ rtw_write8_mask(rtwdev, REG_IGN_GNT_BT1, -+ BIT_PI_IGNORE_GNT_BT, 0); -+ rtw_write8_mask(rtwdev, REG_NOMASK_TXBT, -+ BIT_NOMASK_TXBT_ENABLE, 1); - } else { -- rtw_write8_mask(rtwdev, 0x1860, BIT(3), 1); -+ rtw_write8_mask(rtwdev, REG_IGN_GNT_BT1, -+ BIT_PI_IGNORE_GNT_BT, 1); - } - } else { - /* shared-antenna */ -- rtw_write8_mask(rtwdev, 0x1860, BIT(3), 0); -- if (coex_stat->kt_ver >= 3) -- rtw_write8_mask(rtwdev, 0x1ca7, BIT(3), 0); -+ rtw_write8_mask(rtwdev, REG_IGN_GNT_BT1, -+ BIT_PI_IGNORE_GNT_BT, 0); -+ if (coex_stat->kt_ver >= 3) { -+ rtw_write8_mask(rtwdev, REG_NOMASK_TXBT, -+ BIT_NOMASK_TXBT_ENABLE, 0); -+ } - } - } - - static void rtw8822c_coex_cfg_gnt_debug(struct rtw_dev *rtwdev) - { -- rtw_write8_mask(rtwdev, 0x66, BIT(4), 0); -- rtw_write8_mask(rtwdev, 0x67, BIT(0), 0); -- rtw_write8_mask(rtwdev, 0x42, BIT(3), 0); -- rtw_write8_mask(rtwdev, 0x65, BIT(7), 0); -- rtw_write8_mask(rtwdev, 0x73, BIT(3), 0); -+ rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 2, BIT_BTGP_SPI_EN >> 16, 0); -+ rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 3, BIT_BTGP_JTAG_EN >> 24, 0); -+ rtw_write8_mask(rtwdev, REG_GPIO_MUXCFG + 2, BIT_FSPI_EN >> 16, 0); -+ rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 1, BIT_LED1DIS >> 8, 0); -+ rtw_write8_mask(rtwdev, REG_SYS_SDIO_CTRL + 3, BIT_DBG_GNT_WL_BT >> 24, 0); - } - - static void rtw8822c_coex_cfg_rfe_type(struct rtw_dev *rtwdev) -@@ -2262,9 +3090,9 @@ static void rtw8822c_coex_cfg_rfe_type(struct rtw_dev *rtwdev) - coex_rfe->wlg_at_btg = false; - - /* disable LTE coex in wifi side */ -- rtw_coex_write_indirect_reg(rtwdev, 0x38, BIT_LTE_COEX_EN, 0x0); -- rtw_coex_write_indirect_reg(rtwdev, 0xa0, MASKLWORD, 0xffff); -- rtw_coex_write_indirect_reg(rtwdev, 0xa4, MASKLWORD, 0xffff); -+ rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, BIT_LTE_COEX_EN, 0x0); -+ rtw_coex_write_indirect_reg(rtwdev, LTE_WL_TRX_CTRL, MASKLWORD, 0xffff); -+ rtw_coex_write_indirect_reg(rtwdev, LTE_BT_TRX_CTRL, MASKLWORD, 0xffff); - } - - static void rtw8822c_coex_cfg_wl_tx_power(struct rtw_dev *rtwdev, u8 wl_pwr) -@@ -2289,16 +3117,22 @@ static void rtw8822c_coex_cfg_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain) - coex_dm->cur_wl_rx_low_gain_en = low_gain; - - if (coex_dm->cur_wl_rx_low_gain_en) { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], Hi-Li Table On!\n"); -+ - /* set Rx filter corner RCK offset */ -- rtw_write_rf(rtwdev, RF_PATH_A, 0xde, 0xfffff, 0x22); -- rtw_write_rf(rtwdev, RF_PATH_A, 0x1d, 0xfffff, 0x36); -- rtw_write_rf(rtwdev, RF_PATH_B, 0xde, 0xfffff, 0x22); -- rtw_write_rf(rtwdev, RF_PATH_B, 0x1d, 0xfffff, 0x36); -+ rtw_write_rf(rtwdev, RF_PATH_A, RF_RCKD, RFREG_MASK, 0x22); -+ rtw_write_rf(rtwdev, RF_PATH_A, RF_RCK, RFREG_MASK, 0x36); -+ rtw_write_rf(rtwdev, RF_PATH_B, RF_RCKD, RFREG_MASK, 0x22); -+ rtw_write_rf(rtwdev, RF_PATH_B, RF_RCK, RFREG_MASK, 0x36); -+ - } else { -+ rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], Hi-Li Table Off!\n"); -+ - /* set Rx filter corner RCK offset */ -- rtw_write_rf(rtwdev, RF_PATH_A, 0xde, 0xfffff, 0x20); -- rtw_write_rf(rtwdev, RF_PATH_A, 0x1d, 0xfffff, 0x0); -- rtw_write_rf(rtwdev, RF_PATH_B, 0x1d, 0xfffff, 0x0); -+ rtw_write_rf(rtwdev, RF_PATH_A, RF_RCKD, RFREG_MASK, 0x20); -+ rtw_write_rf(rtwdev, RF_PATH_A, RF_RCK, RFREG_MASK, 0x0); -+ rtw_write_rf(rtwdev, RF_PATH_B, RF_RCKD, RFREG_MASK, 0x20); -+ rtw_write_rf(rtwdev, RF_PATH_B, RF_RCK, RFREG_MASK, 0x0); - } - } - -@@ -2463,7 +3297,7 @@ static void rtw8822c_dpk_rxbb_dc_cal(struct rtw_dev *rtwdev, u8 path) - static u8 rtw8822c_dpk_dc_corr_check(struct rtw_dev *rtwdev, u8 path) - { - u16 dc_i, dc_q; -- u8 corr_val, corr_idx; -+ u8 corr_idx; - - rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x000900f0); - dc_i = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(27, 16)); -@@ -2476,7 +3310,7 @@ static u8 rtw8822c_dpk_dc_corr_check(struct rtw_dev *rtwdev, u8 path) - - rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x000000f0); - corr_idx = (u8)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(7, 0)); -- corr_val = (u8)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(15, 8)); -+ rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(15, 8)); - - if (dc_i > 200 || dc_q > 200 || corr_idx < 40 || corr_idx > 65) - return 1; -@@ -2523,9 +3357,9 @@ static void rtw8822c_dpk_pre_setting(struct rtw_dev *rtwdev) - rtw_write_rf(rtwdev, path, RF_RXAGC_OFFSET, RFREG_MASK, 0x0); - rtw_write32(rtwdev, REG_NCTL0, 0x8 | (path << 1)); - if (rtwdev->dm_info.dpk_info.dpk_band == RTW_BAND_2G) -- rtw_write32(rtwdev, REG_DPD_LUT3, 0x1f100000); -+ rtw_write32(rtwdev, REG_DPD_CTL1_S1, 0x1f100000); - else -- rtw_write32(rtwdev, REG_DPD_LUT3, 0x1f0d0000); -+ rtw_write32(rtwdev, REG_DPD_CTL1_S1, 0x1f0d0000); - rtw_write32_mask(rtwdev, REG_DPD_LUT0, BIT_GLOSS_DB, 0x4); - rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x3); - } -@@ -2543,11 +3377,11 @@ static u32 rtw8822c_dpk_rf_setting(struct rtw_dev *rtwdev, u8 path) - - rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TX_GAIN, 0x1); - rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_PWR_TRIM, 0x1); -- rtw_write_rf(rtwdev, path, RF_TX_GAIN_OFFSET, BIT_TX_OFFSET_VAL, 0x0); -+ rtw_write_rf(rtwdev, path, RF_TX_GAIN_OFFSET, BIT_BB_GAIN, 0x0); - rtw_write_rf(rtwdev, path, RF_TX_GAIN, RFREG_MASK, ori_txbb); - - if (rtwdev->dm_info.dpk_info.dpk_band == RTW_BAND_2G) { -- rtw_write_rf(rtwdev, path, RF_TX_GAIN_OFFSET, BIT_LB_ATT, 0x1); -+ rtw_write_rf(rtwdev, path, RF_TX_GAIN_OFFSET, BIT_RF_GAIN, 0x1); - rtw_write_rf(rtwdev, path, RF_RXG_GAIN, BIT_RXG_GAIN, 0x0); - } else { - rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_TXA_LB_ATT, 0x0); -@@ -3294,9 +4128,9 @@ static void rtw8822c_dpk_reload_data(struct rtw_dev *rtwdev) - rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, - 0x8 | (path << 1)); - if (dpk_info->dpk_band == RTW_BAND_2G) -- rtw_write32(rtwdev, REG_DPD_LUT3, 0x1f100000); -+ rtw_write32(rtwdev, REG_DPD_CTL1_S1, 0x1f100000); - else -- rtw_write32(rtwdev, REG_DPD_LUT3, 0x1f0d0000); -+ rtw_write32(rtwdev, REG_DPD_CTL1_S1, 0x1f0d0000); - - rtw_write8(rtwdev, REG_DPD_AGC, dpk_info->dpk_txagc[path]); - -@@ -3380,8 +4214,11 @@ static void rtw8822c_do_dpk(struct rtw_dev *rtwdev) - - static void rtw8822c_phy_calibration(struct rtw_dev *rtwdev) - { -+ rtw8822c_rfk_power_save(rtwdev, false); -+ rtw8822c_do_gapk(rtwdev); - rtw8822c_do_iqk(rtwdev); - rtw8822c_do_dpk(rtwdev); -+ rtw8822c_rfk_power_save(rtwdev, true); - } - - static void rtw8822c_dpk_track(struct rtw_dev *rtwdev) -@@ -3416,6 +4253,128 @@ static void rtw8822c_dpk_track(struct rtw_dev *rtwdev) - } - } - -+#define XCAP_EXTEND(val) ({typeof(val) _v = (val); _v | _v << 7; }) -+static void rtw8822c_set_crystal_cap_reg(struct rtw_dev *rtwdev, u8 crystal_cap) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ struct rtw_cfo_track *cfo = &dm_info->cfo_track; -+ u32 val = 0; -+ -+ val = XCAP_EXTEND(crystal_cap); -+ cfo->crystal_cap = crystal_cap; -+ rtw_write32_mask(rtwdev, REG_ANAPAR_XTAL_0, BIT_XCAP_0, val); -+} -+ -+static void rtw8822c_set_crystal_cap(struct rtw_dev *rtwdev, u8 crystal_cap) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ struct rtw_cfo_track *cfo = &dm_info->cfo_track; -+ -+ if (cfo->crystal_cap == crystal_cap) -+ return; -+ -+ rtw8822c_set_crystal_cap_reg(rtwdev, crystal_cap); -+} -+ -+static void rtw8822c_cfo_tracking_reset(struct rtw_dev *rtwdev) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ struct rtw_cfo_track *cfo = &dm_info->cfo_track; -+ -+ cfo->is_adjust = true; -+ -+ if (cfo->crystal_cap > rtwdev->efuse.crystal_cap) -+ rtw8822c_set_crystal_cap(rtwdev, cfo->crystal_cap - 1); -+ else if (cfo->crystal_cap < rtwdev->efuse.crystal_cap) -+ rtw8822c_set_crystal_cap(rtwdev, cfo->crystal_cap + 1); -+} -+ -+static void rtw8822c_cfo_init(struct rtw_dev *rtwdev) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ struct rtw_cfo_track *cfo = &dm_info->cfo_track; -+ -+ cfo->crystal_cap = rtwdev->efuse.crystal_cap; -+ cfo->is_adjust = true; -+} -+ -+#define REPORT_TO_KHZ(val) ({typeof(val) _v = (val); (_v << 1) + (_v >> 1); }) -+static s32 rtw8822c_cfo_calc_avg(struct rtw_dev *rtwdev, u8 path_num) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ struct rtw_cfo_track *cfo = &dm_info->cfo_track; -+ s32 cfo_avg, cfo_path_sum = 0, cfo_rpt_sum; -+ u8 i; -+ -+ for (i = 0; i < path_num; i++) { -+ cfo_rpt_sum = REPORT_TO_KHZ(cfo->cfo_tail[i]); -+ -+ if (cfo->cfo_cnt[i]) -+ cfo_avg = cfo_rpt_sum / cfo->cfo_cnt[i]; -+ else -+ cfo_avg = 0; -+ -+ cfo_path_sum += cfo_avg; -+ } -+ -+ for (i = 0; i < path_num; i++) { -+ cfo->cfo_tail[i] = 0; -+ cfo->cfo_cnt[i] = 0; -+ } -+ -+ return cfo_path_sum / path_num; -+} -+ -+static void rtw8822c_cfo_need_adjust(struct rtw_dev *rtwdev, s32 cfo_avg) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ struct rtw_cfo_track *cfo = &dm_info->cfo_track; -+ -+ if (!cfo->is_adjust) { -+ if (abs(cfo_avg) > CFO_TRK_ENABLE_TH) -+ cfo->is_adjust = true; -+ } else { -+ if (abs(cfo_avg) <= CFO_TRK_STOP_TH) -+ cfo->is_adjust = false; -+ } -+ -+ if (!rtw_coex_disabled(rtwdev)) { -+ cfo->is_adjust = false; -+ rtw8822c_set_crystal_cap(rtwdev, rtwdev->efuse.crystal_cap); -+ } -+} -+ -+static void rtw8822c_cfo_track(struct rtw_dev *rtwdev) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ struct rtw_cfo_track *cfo = &dm_info->cfo_track; -+ u8 path_num = rtwdev->hal.rf_path_num; -+ s8 crystal_cap = cfo->crystal_cap; -+ s32 cfo_avg = 0; -+ -+ if (rtwdev->sta_cnt != 1) { -+ rtw8822c_cfo_tracking_reset(rtwdev); -+ return; -+ } -+ -+ if (cfo->packet_count == cfo->packet_count_pre) -+ return; -+ -+ cfo->packet_count_pre = cfo->packet_count; -+ cfo_avg = rtw8822c_cfo_calc_avg(rtwdev, path_num); -+ rtw8822c_cfo_need_adjust(rtwdev, cfo_avg); -+ -+ if (cfo->is_adjust) { -+ if (cfo_avg > CFO_TRK_ADJ_TH) -+ crystal_cap++; -+ else if (cfo_avg < -CFO_TRK_ADJ_TH) -+ crystal_cap--; -+ -+ crystal_cap = clamp_t(s8, crystal_cap, 0, XCAP_MASK); -+ rtw8822c_set_crystal_cap(rtwdev, (u8)crystal_cap); -+ } -+} -+ - static const struct rtw_phy_cck_pd_reg - rtw8822c_cck_pd_reg[RTW_CHANNEL_WIDTH_40 + 1][RTW_RF_PATH_MAX] = { - { -@@ -3463,6 +4422,10 @@ rtw8822c_phy_cck_pd_set_reg(struct rtw_dev *rtwdev, - rtw8822c_cck_pd_reg[bw][nrx].reg_cs, - rtw8822c_cck_pd_reg[bw][nrx].mask_cs, - cs); -+ -+ rtw_dbg(rtwdev, RTW_DBG_PHY, -+ "is_linked=%d, bw=%d, nrx=%d, cs_ratio=0x%x, pd_th=0x%x\n", -+ rtw_is_assoc(rtwdev), bw, nrx, cs, pd); - } - - static void rtw8822c_phy_cck_pd_set(struct rtw_dev *rtwdev, u8 new_lvl) -@@ -3476,6 +4439,10 @@ static void rtw8822c_phy_cck_pd_set(struct rtw_dev *rtwdev, u8 new_lvl) - nrx = (u8)rtw_read32_mask(rtwdev, 0x1a2c, 0x60000); - bw = (u8)rtw_read32_mask(rtwdev, 0x9b0, 0xc); - -+ rtw_dbg(rtwdev, RTW_DBG_PHY, "lv: (%d) -> (%d) bw=%d nr=%d cck_fa_avg=%d\n", -+ dm_info->cck_pd_lv[bw][nrx], new_lvl, bw, nrx, -+ dm_info->cck_fa_avg); -+ - if (dm_info->cck_pd_lv[bw][nrx] == new_lvl) - return; - -@@ -3575,6 +4542,51 @@ static void rtw8822c_pwr_track(struct rtw_dev *rtwdev) - dm_info->pwr_trk_triggered = false; - } - -+static void rtw8822c_adaptivity_init(struct rtw_dev *rtwdev) -+{ -+ rtw_phy_set_edcca_th(rtwdev, RTW8822C_EDCCA_MAX, RTW8822C_EDCCA_MAX); -+ -+ /* mac edcca state setting */ -+ rtw_write32_clr(rtwdev, REG_TX_PTCL_CTRL, BIT_DIS_EDCCA); -+ rtw_write32_set(rtwdev, REG_RD_CTRL, BIT_EDCCA_MSK_CNTDOWN_EN); -+ -+ /* edcca decistion opt */ -+ rtw_write32_clr(rtwdev, REG_EDCCA_DECISION, BIT_EDCCA_OPTION); -+} -+ -+static void rtw8822c_adaptivity(struct rtw_dev *rtwdev) -+{ -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; -+ s8 l2h, h2l; -+ u8 igi; -+ -+ igi = dm_info->igi_history[0]; -+ if (dm_info->edcca_mode == RTW_EDCCA_NORMAL) { -+ l2h = max_t(s8, igi + EDCCA_IGI_L2H_DIFF, EDCCA_TH_L2H_LB); -+ h2l = l2h - EDCCA_L2H_H2L_DIFF_NORMAL; -+ } else { -+ if (igi < dm_info->l2h_th_ini - EDCCA_ADC_BACKOFF) -+ l2h = igi + EDCCA_ADC_BACKOFF; -+ else -+ l2h = dm_info->l2h_th_ini; -+ h2l = l2h - EDCCA_L2H_H2L_DIFF; -+ } -+ -+ rtw_phy_set_edcca_th(rtwdev, l2h, h2l); -+} -+ -+static void rtw8822c_fill_txdesc_checksum(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ u8 *txdesc) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ size_t words; -+ -+ words = (pkt_info->pkt_offset * 8 + chip->tx_pkt_desc_sz) / 2; -+ -+ fill_txdesc_checksum_common(txdesc, words); -+} -+ - static const struct rtw_pwr_seq_cmd trans_carddis_to_cardemu_8822c[] = { - {0x0086, - RTW_PWR_CUT_ALL_MSK, -@@ -3913,6 +4925,8 @@ static const struct rtw_rfe_def rtw8822c_rfe_defs[] = { - [0] = RTW_DEF_RFE(8822c, 0, 0), - [1] = RTW_DEF_RFE(8822c, 0, 0), - [2] = RTW_DEF_RFE(8822c, 0, 0), -+ [3] = RTW_DEF_RFE(8822c, 0, 0), -+ [4] = RTW_DEF_RFE(8822c, 0, 0), - [5] = RTW_DEF_RFE(8822c, 0, 5), - [6] = RTW_DEF_RFE(8822c, 0, 0), - }; -@@ -3976,6 +4990,7 @@ static struct rtw_chip_ops rtw8822c_ops = { - .query_rx_desc = rtw8822c_query_rx_desc, - .set_channel = rtw8822c_set_channel, - .mac_init = rtw8822c_mac_init, -+ .dump_fw_crash = rtw8822c_dump_fw_crash, - .read_rf = rtw_phy_read_rf, - .write_rf = rtw_phy_write_rf_reg_mix, - .set_tx_power_index = rtw8822c_set_tx_power_index, -@@ -3989,6 +5004,13 @@ static struct rtw_chip_ops rtw8822c_ops = { - .config_bfee = rtw8822c_bf_config_bfee, - .set_gid_table = rtw_bf_set_gid_table, - .cfg_csi_rate = rtw_bf_cfg_csi_rate, -+ .adaptivity_init = rtw8822c_adaptivity_init, -+ .adaptivity = rtw8822c_adaptivity, -+ .cfo_init = rtw8822c_cfo_init, -+ .cfo_track = rtw8822c_cfo_track, -+ .config_tx_path = rtw8822c_config_tx_path, -+ .config_txrx_mode = rtw8822c_config_trx_mode, -+ .fill_txdesc_checksum = rtw8822c_fill_txdesc_checksum, - - .coex_set_init = rtw8822c_coex_cfg_init, - .coex_set_ant_switch = NULL, -@@ -4007,14 +5029,14 @@ static const struct coex_table_para table_sant_8822c[] = { - {0xaaaaaaaa, 0xaaaaaaaa}, - {0x5a5a5a5a, 0x5a5a5a5a}, - {0xfafafafa, 0xfafafafa}, /* case-5 */ -- {0x6a5a6a5a, 0xaaaaaaaa}, -+ {0x6a5a5555, 0xaaaaaaaa}, - {0x6a5a56aa, 0x6a5a56aa}, - {0x6a5a5a5a, 0x6a5a5a5a}, - {0x66555555, 0x5a5a5a5a}, - {0x66555555, 0x6a5a5a5a}, /* case-10 */ -- {0x66555555, 0xfafafafa}, -+ {0x66555555, 0x6a5a5aaa}, - {0x66555555, 0x5a5a5aaa}, -- {0x66555555, 0x5aaa5aaa}, -+ {0x66555555, 0x6aaa5aaa}, - {0x66555555, 0xaaaa5aaa}, - {0x66555555, 0xaaaaaaaa}, /* case-15 */ - {0xffff55ff, 0xfafafafa}, -@@ -4024,13 +5046,18 @@ static const struct coex_table_para table_sant_8822c[] = { - {0xaa5555aa, 0x6a5a5a5a}, /* case-20 */ - {0xaa5555aa, 0xaaaaaaaa}, - {0xffffffff, 0x5a5a5a5a}, -- {0xffffffff, 0x6a5a5a5a}, -+ {0xffffffff, 0x5a5a5a5a}, - {0xffffffff, 0x55555555}, -- {0xffffffff, 0x6a5a5aaa}, /* case-25 */ -+ {0xffffffff, 0x5a5a5aaa}, /* case-25 */ - {0x55555555, 0x5a5a5a5a}, - {0x55555555, 0xaaaaaaaa}, - {0x55555555, 0x6a5a6a5a}, -- {0x66556655, 0x66556655} -+ {0x66556655, 0x66556655}, -+ {0x66556aaa, 0x6a5a6aaa}, /*case-30*/ -+ {0xffffffff, 0x5aaa5aaa}, -+ {0x56555555, 0x5a5a5aaa}, -+ {0xdaffdaff, 0xdaffdaff}, -+ {0xddffddff, 0xddffddff}, - }; - - /* Non-Shared-Antenna Coex Table */ -@@ -4050,12 +5077,12 @@ static const struct coex_table_para table_nsant_8822c[] = { - {0xffff55ff, 0xfafafafa}, - {0xffff55ff, 0x5afa5afa}, - {0xffff55ff, 0xaaaaaaaa}, -- {0xaaffffaa, 0xfafafafa}, /* case-115 */ -+ {0xffff55ff, 0xffff55ff}, /* case-115 */ - {0xaaffffaa, 0x5afa5afa}, - {0xaaffffaa, 0xaaaaaaaa}, - {0xffffffff, 0xfafafafa}, - {0xffffffff, 0x5afa5afa}, -- {0xffffffff, 0xaaaaaaaa},/* case-120 */ -+ {0xffffffff, 0xaaaaaaaa}, /* case-120 */ - {0x55ff55ff, 0x5afa5afa}, - {0x55ff55ff, 0xaaaaaaaa}, - {0x55ff55ff, 0x55ff55ff} -@@ -4064,7 +5091,7 @@ static const struct coex_table_para table_nsant_8822c[] = { - /* Shared-Antenna TDMA */ - static const struct coex_tdma_para tdma_sant_8822c[] = { - { {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-0 */ -- { {0x61, 0x45, 0x03, 0x11, 0x11} }, -+ { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-1 */ - { {0x61, 0x3a, 0x03, 0x11, 0x11} }, - { {0x61, 0x30, 0x03, 0x11, 0x11} }, - { {0x61, 0x20, 0x03, 0x11, 0x11} }, -@@ -4079,7 +5106,7 @@ static const struct coex_tdma_para tdma_sant_8822c[] = { - { {0x51, 0x08, 0x03, 0x10, 0x54} }, - { {0x51, 0x08, 0x03, 0x10, 0x55} }, - { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-15 */ -- { {0x51, 0x45, 0x03, 0x10, 0x10} }, -+ { {0x51, 0x45, 0x03, 0x10, 0x50} }, - { {0x51, 0x3a, 0x03, 0x10, 0x50} }, - { {0x51, 0x30, 0x03, 0x10, 0x50} }, - { {0x51, 0x20, 0x03, 0x10, 0x50} }, -@@ -4087,7 +5114,7 @@ static const struct coex_tdma_para tdma_sant_8822c[] = { - { {0x51, 0x4a, 0x03, 0x10, 0x50} }, - { {0x51, 0x0c, 0x03, 0x10, 0x54} }, - { {0x55, 0x08, 0x03, 0x10, 0x54} }, -- { {0x65, 0x10, 0x03, 0x11, 0x11} }, -+ { {0x65, 0x10, 0x03, 0x11, 0x10} }, - { {0x51, 0x10, 0x03, 0x10, 0x51} }, /* case-25 */ - { {0x51, 0x08, 0x03, 0x10, 0x50} }, - { {0x61, 0x08, 0x03, 0x11, 0x11} } -@@ -4115,7 +5142,8 @@ static const struct coex_tdma_para tdma_nsant_8822c[] = { - { {0x51, 0x3a, 0x03, 0x10, 0x50} }, - { {0x51, 0x30, 0x03, 0x10, 0x50} }, - { {0x51, 0x20, 0x03, 0x10, 0x50} }, -- { {0x51, 0x10, 0x03, 0x10, 0x50} } /* case-120 */ -+ { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-120 */ -+ { {0x51, 0x08, 0x03, 0x10, 0x50} } - }; - - /* rssi in percentage % (dbm = % - 100) */ -@@ -4130,7 +5158,8 @@ static const struct coex_rf_para rf_para_tx_8822c[] = { - {8, 17, true, 4}, - {7, 18, true, 4}, - {6, 19, true, 4}, -- {5, 20, true, 4} -+ {5, 20, true, 4}, -+ {0, 21, true, 4} /* for gamg hid */ - }; - - static const struct coex_rf_para rf_para_rx_8822c[] = { -@@ -4139,11 +5168,10 @@ static const struct coex_rf_para rf_para_rx_8822c[] = { - {3, 24, true, 5}, - {2, 26, true, 5}, - {1, 27, true, 5}, -- {0, 28, true, 5} -+ {0, 28, true, 5}, -+ {0, 28, true, 5} /* for gamg hid */ - }; - --static_assert(ARRAY_SIZE(rf_para_tx_8822c) == ARRAY_SIZE(rf_para_rx_8822c)); -- - static const u8 - rtw8822c_pwrtrk_5gb_n[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = { - { 0, 1, 2, 3, 5, 6, 7, 8, 9, 10, -@@ -4267,6 +5295,15 @@ static const struct rtw_pwr_track_tbl rtw8822c_rtw_pwr_track_tbl = { - .pwrtrk_2g_ccka_p = rtw8822c_pwrtrk_2g_cck_a_p, - }; - -+static struct rtw_hw_reg_offset rtw8822c_edcca_th[] = { -+ [EDCCA_TH_L2H_IDX] = { -+ {.addr = 0x84c, .mask = MASKBYTE2}, .offset = 0x80 -+ }, -+ [EDCCA_TH_H2L_IDX] = { -+ {.addr = 0x84c, .mask = MASKBYTE3}, .offset = 0x80 -+ }, -+}; -+ - #ifdef CONFIG_PM - static const struct wiphy_wowlan_support rtw_wowlan_stub_8822c = { - .flags = WIPHY_WOWLAN_MAGIC_PKT | WIPHY_WOWLAN_GTK_REKEY_FAILURE | -@@ -4304,7 +5341,7 @@ static const struct rtw_reg_domain coex_info_hw_regs_8822c[] = { - {0xc50, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, - }; - --struct rtw_chip_info rtw8822c_hw_spec = { -+const struct rtw_chip_info rtw8822c_hw_spec = { - .ops = &rtw8822c_ops, - .id = RTW_CHIP_TYPE_8822C, - .fw_name = "rtw88/rtw8822c_fw.bin", -@@ -4319,13 +5356,16 @@ struct rtw_chip_info rtw8822c_hw_spec = { - .txff_size = 262144, - .rxff_size = 24576, - .fw_rxff_size = 12288, -+ .rsvd_drv_pg_num = 16, - .txgi_factor = 2, - .is_pwr_by_rate_dec = false, - .max_power_index = 0x7f, - .csi_buf_pg_num = 50, - .band = RTW_BAND_2G | RTW_BAND_5G, -- .page_size = 128, -+ .page_size = TX_PAGE_SIZE, - .dig_min = 0x20, -+ .default_1ss_tx_path = BB_PATH_A, -+ .path_div_supported = true, - .ht_supported = true, - .vht_supported = true, - .lps_deep_mode_supported = BIT(LPS_DEEP_MODE_LCLK) | BIT(LPS_DEEP_MODE_PG), -@@ -4356,16 +5396,24 @@ struct rtw_chip_info rtw8822c_hw_spec = { - .bfer_su_max_num = 2, - .bfer_mu_max_num = 1, - .rx_ldpc = true, -+ .tx_stbc = true, -+ .edcca_th = rtw8822c_edcca_th, -+ .l2h_th_ini_cs = 60, -+ .l2h_th_ini_ad = 45, -+ .ampdu_density = IEEE80211_HT_MPDU_DENSITY_2, - - #ifdef CONFIG_PM - .wow_fw_name = "rtw88/rtw8822c_wow_fw.bin", - .wowlan_stub = &rtw_wowlan_stub_8822c, - .max_sched_scan_ssids = 4, - #endif -- .coex_para_ver = 0x20070217, -- .bt_desired_ver = 0x17, -+ .max_scan_ie_len = (RTW_PROBE_PG_CNT - 1) * TX_PAGE_SIZE, -+ .coex_para_ver = 0x22020720, -+ .bt_desired_ver = 0x20, - .scbd_support = true, - .new_scbd10_def = true, -+ .ble_hid_profile_support = true, -+ .wl_mimo_ps_support = true, - .pstdma_type = COEX_PSTDMA_FORCE_LPSOFF, - .bt_rssi_type = COEX_BTRSSI_DBM, - .ant_isolation = 15, -@@ -4392,6 +5440,7 @@ struct rtw_chip_info rtw8822c_hw_spec = { - .coex_info_hw_regs = coex_info_hw_regs_8822c, - - .fw_fifo_addr = {0x780, 0x700, 0x780, 0x660, 0x650, 0x680}, -+ .fwcd_segs = &rtw8822c_fwcd_segs, - }; - EXPORT_SYMBOL(rtw8822c_hw_spec); - -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822c.h b/drivers/net/wireless/realtek/rtw88/rtw8822c.h -index 32b4771e0..1bc0e7f5d 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8822c.h -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822c.h -@@ -16,6 +16,11 @@ struct rtw8822cu_efuse { - u8 res2[0x3d]; - }; - -+struct rtw8822cs_efuse { -+ u8 res0[0x4a]; /* 0x120 */ -+ u8 mac_addr[ETH_ALEN]; /* 0x16a */ -+} __packed; -+ - struct rtw8822ce_efuse { - u8 mac_addr[ETH_ALEN]; /* 0x120 */ - u8 vender_id[2]; -@@ -91,8 +96,9 @@ struct rtw8822c_efuse { - u8 res9; - u8 res10[0x42]; - union { -- struct rtw8822cu_efuse u; - struct rtw8822ce_efuse e; -+ struct rtw8822cu_efuse u; -+ struct rtw8822cs_efuse s; - }; - }; - -@@ -118,6 +124,8 @@ enum rtw8822c_dpk_one_shot_action { - void rtw8822c_parse_tbl_dpk(struct rtw_dev *rtwdev, - const struct rtw_table *tbl); - -+extern const struct rtw_chip_info rtw8822c_hw_spec; -+ - #define RTW_DECL_TABLE_DPK(name) \ - const struct rtw_table name ## _tbl = { \ - .data = name, \ -@@ -137,6 +145,8 @@ const struct rtw_table name ## _tbl = { \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(7, 0)) - #define GET_PHY_STAT_P0_GAIN_A(phy_stat) \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(21, 16)) -+#define GET_PHY_STAT_P0_CHANNEL(phy_stat) \ -+ le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(23, 16)) - #define GET_PHY_STAT_P0_GAIN_B(phy_stat) \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(29, 24)) - -@@ -149,6 +159,8 @@ const struct rtw_table name ## _tbl = { \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(11, 8)) - #define GET_PHY_STAT_P1_HT_RXSC(phy_stat) \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(15, 12)) -+#define GET_PHY_STAT_P1_CHANNEL(phy_stat) \ -+ le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(23, 16)) - #define GET_PHY_STAT_P1_RXEVM_A(phy_stat) \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(7, 0)) - #define GET_PHY_STAT_P1_RXEVM_B(phy_stat) \ -@@ -162,179 +174,253 @@ const struct rtw_table name ## _tbl = { \ - #define GET_PHY_STAT_P1_RXSNR_B(phy_stat) \ - le32_get_bits(*((__le32 *)(phy_stat) + 0x06), GENMASK(15, 8)) - -+#define RTW8822C_EDCCA_MAX 0x7f - #define REG_ANAPARLDO_POW_MAC 0x0029 - #define BIT_LDOE25_PON BIT(0) --#define REG_RRSR 0x0440 --#define BITS_RRSR_RSC (BIT(21) | BIT(22)) -+#define XCAP_MASK GENMASK(6, 0) -+#define CFO_TRK_ENABLE_TH 20 -+#define CFO_TRK_STOP_TH 10 -+#define CFO_TRK_ADJ_TH 10 - --#define REG_TXDFIR0 0x808 --#define REG_DFIRBW 0x810 --#define REG_ANTMAP0 0x820 --#define REG_ANTMAP 0x824 --#define REG_DYMPRITH 0x86c --#define REG_DYMENTH0 0x870 --#define REG_DYMENTH 0x874 --#define REG_SBD 0x88c -+#define REG_TXDFIR0 0x808 -+#define REG_DFIRBW 0x810 -+#define REG_ANTMAP0 0x820 -+#define BIT_ANT_PATH GENMASK(1, 0) -+#define REG_ANTMAP 0x824 -+#define REG_EDCCA_DECISION 0x844 -+#define BIT_EDCCA_OPTION GENMASK(30, 29) -+#define REG_DYMPRITH 0x86c -+#define REG_DYMENTH0 0x870 -+#define REG_DYMENTH 0x874 -+#define REG_SBD 0x88c - #define BITS_SUBTUNE GENMASK(15, 12) --#define REG_DYMTHMIN 0x8a4 --#define REG_TXBWCTL 0x9b0 --#define REG_TXCLK 0x9b4 --#define REG_SCOTRK 0xc30 --#define REG_MRCM 0xc38 --#define REG_AGCSWSH 0xc44 --#define REG_ANTWTPD 0xc54 --#define REG_PT_CHSMO 0xcbc -+#define REG_DYMTHMIN 0x8a4 -+ -+#define REG_TXBWCTL 0x9b0 -+#define REG_TXCLK 0x9b4 -+ -+#define REG_SCOTRK 0xc30 -+#define REG_MRCM 0xc38 -+#define REG_AGCSWSH 0xc44 -+#define REG_ANTWTPD 0xc54 -+#define REG_PT_CHSMO 0xcbc - #define BIT_PT_OPT BIT(21) --#define REG_ORITXCODE 0x1800 --#define REG_3WIRE 0x180c -+ -+#define REG_ORITXCODE 0x1800 -+#define BIT_PATH_EN BIT(31) -+#define REG_3WIRE 0x180c -+#define BIT_DIS_SHARERX_TXGAT BIT(27) - #define BIT_3WIRE_TX_EN BIT(0) - #define BIT_3WIRE_RX_EN BIT(1) -+#define BIT_3WIRE_EN GENMASK(1, 0) - #define BIT_3WIRE_PI_ON BIT(28) --#define REG_ANAPAR_A 0x1830 -+#define REG_ANAPAR_A 0x1830 - #define BIT_ANAPAR_UPDATE BIT(29) --#define REG_RXAGCCTL0 0x18ac -+#define REG_RFTXEN_GCK_A 0x1864 -+#define BIT_RFTXEN_GCK_FORCE_ON BIT(31) -+#define REG_DIS_SHARE_RX_A 0x186c -+#define BIT_TX_SCALE_0DB BIT(7) -+#define REG_RXAGCCTL0 0x18ac - #define BITS_RXAGC_CCK GENMASK(15, 12) - #define BITS_RXAGC_OFDM GENMASK(8, 4) --#define REG_DCKA_I_0 0x18bc --#define REG_DCKA_I_1 0x18c0 --#define REG_DCKA_Q_0 0x18d8 --#define REG_DCKA_Q_1 0x18dc --#define REG_CCKSB 0x1a00 --#define REG_RXCCKSEL 0x1a04 --#define REG_BGCTRL 0x1a14 -+#define REG_DCKA_I_0 0x18bc -+#define REG_DCKA_I_1 0x18c0 -+#define REG_DCKA_Q_0 0x18d8 -+#define REG_DCKA_Q_1 0x18dc -+ -+#define REG_CCKSB 0x1a00 -+#define BIT_BBMODE GENMASK(2, 1) -+#define REG_RXCCKSEL 0x1a04 -+#define REG_BGCTRL 0x1a14 - #define BITS_RX_IQ_WEIGHT (BIT(8) | BIT(9)) --#define REG_TXF0 0x1a20 --#define REG_TXF1 0x1a24 --#define REG_TXF2 0x1a28 --#define REG_CCANRX 0x1a2c -+#define REG_TXF0 0x1a20 -+#define REG_TXF1 0x1a24 -+#define REG_TXF2 0x1a28 -+#define REG_CCANRX 0x1a2c - #define BIT_CCK_FA_RST (BIT(14) | BIT(15)) - #define BIT_OFDM_FA_RST (BIT(12) | BIT(13)) --#define REG_CCK_FACNT 0x1a5c --#define REG_CCKTXONLY 0x1a80 -+#define REG_CCK_FACNT 0x1a5c -+#define REG_CCKTXONLY 0x1a80 - #define BIT_BB_CCK_CHECK_EN BIT(18) --#define REG_TXF3 0x1a98 --#define REG_TXF4 0x1a9c --#define REG_TXF5 0x1aa0 --#define REG_TXF6 0x1aac --#define REG_TXF7 0x1ab0 --#define REG_CCK_SOURCE 0x1abc -+#define REG_TXF3 0x1a98 -+#define REG_TXF4 0x1a9c -+#define REG_TXF5 0x1aa0 -+#define REG_TXF6 0x1aac -+#define REG_TXF7 0x1ab0 -+#define REG_CCK_SOURCE 0x1abc - #define BIT_NBI_EN BIT(30) --#define REG_IQKSTAT 0x1b10 --#define REG_TXANT 0x1c28 --#define REG_ENCCK 0x1c3c --#define BIT_CCK_BLK_EN BIT(1) --#define BIT_CCK_OFDM_BLK_EN (BIT(0) | BIT(1)) --#define REG_CCAMSK 0x1c80 --#define REG_RSTB 0x1c90 --#define BIT_RSTB_3WIRE BIT(8) --#define REG_RX_BREAK 0x1d2c --#define BIT_COM_RX_GCK_EN BIT(31) --#define REG_RXFNCTL 0x1d30 --#define REG_RXIGI 0x1d70 --#define REG_ENFN 0x1e24 --#define REG_TXANTSEG 0x1e28 --#define REG_TXLGMAP 0x1e2c --#define REG_CCKPATH 0x1e5c --#define REG_CNT_CTRL 0x1eb4 --#define BIT_ALL_CNT_RST BIT(25) --#define REG_OFDM_FACNT 0x2d00 --#define REG_OFDM_FACNT1 0x2d04 --#define REG_OFDM_FACNT2 0x2d08 --#define REG_OFDM_FACNT3 0x2d0c --#define REG_OFDM_FACNT4 0x2d10 --#define REG_OFDM_FACNT5 0x2d20 --#define REG_RPT_CIP 0x2d9c --#define REG_OFDM_TXCNT 0x2de0 --#define REG_ORITXCODE2 0x4100 --#define REG_3WIRE2 0x410c --#define REG_ANAPAR_B 0x4130 --#define REG_RXAGCCTL 0x41ac --#define REG_DCKB_I_0 0x41bc --#define REG_DCKB_I_1 0x41c0 --#define REG_DCKB_Q_0 0x41d8 --#define REG_DCKB_Q_1 0x41dc -- --#define RF_MODE_TRXAGC 0x00 --#define RF_RXAGC_OFFSET 0x19 --#define RF_BW_TRXBB 0x1a --#define RF_TX_GAIN_OFFSET 0x55 --#define RF_TX_GAIN 0x56 --#define RF_TXA_LB_SW 0x63 --#define RF_RXG_GAIN 0x87 --#define RF_RXA_MIX_GAIN 0x8a --#define RF_EXT_TIA_BW 0x8f --#define RF_DEBUG 0xde - - #define REG_NCTL0 0x1b00 -+#define BIT_SEL_PATH GENMASK(2, 1) -+#define BIT_SUBPAGE GENMASK(3, 0) - #define REG_DPD_CTL0_S0 0x1b04 -+#define BIT_GS_PWSF GENMASK(27, 0) - #define REG_DPD_CTL1_S0 0x1b08 -+#define BIT_DPD_EN BIT(31) -+#define BIT_PS_EN BIT(7) -+#define REG_IQKSTAT 0x1b10 - #define REG_IQK_CTL1 0x1b20 -+#define BIT_TX_CFIR GENMASK(31, 30) -+#define BIT_CFIR_EN GENMASK(26, 24) -+#define BIT_BYPASS_DPD BIT(25) -+ -+#define REG_TX_TONE_IDX 0x1b2c - #define REG_DPD_LUT0 0x1b44 -+#define BIT_GLOSS_DB GENMASK(14, 12) - #define REG_DPD_CTL0_S1 0x1b5c --#define REG_DPD_LUT3 0x1b60 - #define REG_DPD_CTL1_S1 0x1b60 - #define REG_DPD_AGC 0x1b67 -+#define REG_TABLE_SEL 0x1b98 -+#define BIT_I_GAIN GENMASK(19, 16) -+#define BIT_GAIN_RST BIT(15) -+#define BIT_Q_GAIN_SEL GENMASK(14, 12) -+#define BIT_Q_GAIN GENMASK(11, 0) -+#define REG_TX_GAIN_SET 0x1b9c -+#define BIT_GAPK_RPT_IDX GENMASK(11, 8) - #define REG_DPD_CTL0 0x1bb4 -+#define REG_SINGLE_TONE_SW 0x1bb8 -+#define BIT_IRQ_TEST_MODE BIT(20) - #define REG_R_CONFIG 0x1bcc -+#define BIT_INNER_LB BIT(21) -+#define BIT_IQ_SWITCH GENMASK(5, 0) -+#define BIT_2G_SWING 0x2d -+#define BIT_5G_SWING 0x36 - #define REG_RXSRAM_CTL 0x1bd4 -+#define BIT_RPT_EN BIT(21) -+#define BIT_RPT_SEL GENMASK(20, 16) -+#define BIT_DPD_CLK GENMASK(7, 4) - #define REG_DPD_CTL11 0x1be4 - #define REG_DPD_CTL12 0x1be8 - #define REG_DPD_CTL15 0x1bf4 - #define REG_DPD_CTL16 0x1bf8 - #define REG_STAT_RPT 0x1bfc -+#define BIT_RPT_DGAIN GENMASK(27, 16) -+#define BIT_GAPK_RPT0 GENMASK(3, 0) -+#define BIT_GAPK_RPT1 GENMASK(7, 4) -+#define BIT_GAPK_RPT2 GENMASK(11, 8) -+#define BIT_GAPK_RPT3 GENMASK(15, 12) -+#define BIT_GAPK_RPT4 GENMASK(19, 16) -+#define BIT_GAPK_RPT5 GENMASK(23, 20) -+#define BIT_GAPK_RPT6 GENMASK(27, 24) -+#define BIT_GAPK_RPT7 GENMASK(31, 28) -+ -+#define REG_TXANT 0x1c28 -+#define REG_IQK_CTRL 0x1c38 -+#define REG_ENCCK 0x1c3c -+#define BIT_CCK_BLK_EN BIT(1) -+#define BIT_CCK_OFDM_BLK_EN (BIT(0) | BIT(1)) -+#define REG_CCAMSK 0x1c80 -+#define REG_RSTB 0x1c90 -+#define BIT_RSTB_3WIRE BIT(8) -+#define REG_CH_DELAY_EXTR2 0x1cd0 -+#define BIT_TST_IQK2SET_SRC BIT(31) -+#define BIT_EN_IOQ_IQK_DPK BIT(30) -+#define BIT_IQK_DPK_RESET_SRC BIT(29) -+#define BIT_IQK_DPK_CLOCK_SRC BIT(28) -+ -+#define REG_RX_BREAK 0x1d2c -+#define BIT_COM_RX_GCK_EN BIT(31) -+#define REG_RXFNCTL 0x1d30 -+#define REG_CCA_OFF 0x1d58 -+#define BIT_CCA_ON_BY_PW GENMASK(11, 3) -+#define REG_RXIGI 0x1d70 -+ -+#define REG_ENFN 0x1e24 -+#define BIT_IQK_DPK_EN BIT(17) -+#define REG_TXANTSEG 0x1e28 -+#define BIT_ANTSEG GENMASK(3, 0) -+#define REG_TXLGMAP 0x1e2c -+#define REG_CCKPATH 0x1e5c -+#define REG_TX_FIFO 0x1e70 -+#define BIT_STOP_TX GENMASK(3, 0) -+#define REG_CNT_CTRL 0x1eb4 -+#define BIT_ALL_CNT_RST BIT(25) -+ -+#define REG_OFDM_FACNT 0x2d00 -+#define REG_OFDM_FACNT1 0x2d04 -+#define REG_OFDM_FACNT2 0x2d08 -+#define REG_OFDM_FACNT3 0x2d0c -+#define REG_OFDM_FACNT4 0x2d10 -+#define REG_OFDM_FACNT5 0x2d20 -+#define REG_RPT_CIP 0x2d9c -+#define BIT_RPT_CIP_STATUS GENMASK(7, 0) -+#define REG_OFDM_TXCNT 0x2de0 - -+#define REG_ORITXCODE2 0x4100 -+#define REG_3WIRE2 0x410c -+#define REG_ANAPAR_B 0x4130 -+#define REG_RFTXEN_GCK_B 0x4164 -+#define REG_DIS_SHARE_RX_B 0x416c - #define BIT_EXT_TIA_BW BIT(1) --#define BIT_DE_TRXBW BIT(2) --#define BIT_DE_TX_GAIN BIT(16) --#define BIT_RXG_GAIN BIT(18) --#define BIT_DE_PWR_TRIM BIT(19) --#define BIT_INNER_LB BIT(21) --#define BIT_BYPASS_DPD BIT(25) --#define BIT_DPD_EN BIT(31) --#define BIT_SUBPAGE GENMASK(3, 0) -+#define REG_RXAGCCTL 0x41ac -+#define REG_DCKB_I_0 0x41bc -+#define REG_DCKB_I_1 0x41c0 -+#define REG_DCKB_Q_0 0x41d8 -+#define REG_DCKB_Q_1 0x41dc -+ -+#define RF_MODE_TRXAGC 0x00 -+#define BIT_RF_MODE GENMASK(19, 16) -+#define BIT_RXAGC GENMASK(9, 5) - #define BIT_TXAGC GENMASK(4, 0) -+#define RF_RXAGC_OFFSET 0x19 -+#define RF_BW_TRXBB 0x1a -+#define BIT_TX_CCK_IND BIT(16) -+#define BIT_BW_TXBB GENMASK(14, 12) -+#define BIT_BW_RXBB GENMASK(11, 10) -+#define BIT_DBG_CCK_CCA BIT(1) -+#define RF_TX_GAIN_OFFSET 0x55 -+#define BIT_BB_GAIN GENMASK(18, 14) -+#define BIT_RF_GAIN GENMASK(4, 2) -+#define RF_TX_GAIN 0x56 - #define BIT_GAIN_TXBB GENMASK(4, 0) -+#define RF_IDAC 0x58 -+#define BIT_TX_MODE GENMASK(19, 8) -+#define RF_TX_RESULT 0x5f -+#define BIT_GAIN_TX_PAD_H GENMASK(11, 8) -+#define BIT_GAIN_TX_PAD_L GENMASK(7, 4) -+#define RF_PA 0x60 -+#define RF_PABIAS_2G_MASK GENMASK(15, 12) -+#define RF_PABIAS_5G_MASK GENMASK(19, 16) -+#define RF_TXA_LB_SW 0x63 -+#define BIT_TXA_LB_ATT GENMASK(15, 14) -+#define BIT_LB_SW GENMASK(13, 12) - #define BIT_LB_ATT GENMASK(4, 2) -+#define RF_RXG_GAIN 0x87 -+#define BIT_RXG_GAIN BIT(18) -+#define RF_RXA_MIX_GAIN 0x8a - #define BIT_RXA_MIX_GAIN GENMASK(4, 3) --#define BIT_IQ_SWITCH GENMASK(5, 0) --#define BIT_DPD_CLK GENMASK(7, 4) --#define BIT_RXAGC GENMASK(9, 5) --#define BIT_BW_RXBB GENMASK(11, 10) --#define BIT_LB_SW GENMASK(13, 12) --#define BIT_BW_TXBB GENMASK(14, 12) --#define BIT_GLOSS_DB GENMASK(14, 12) --#define BIT_TXA_LB_ATT GENMASK(15, 14) --#define BIT_TX_OFFSET_VAL GENMASK(18, 14) --#define BIT_RPT_SEL GENMASK(20, 16) --#define BIT_GS_PWSF GENMASK(27, 0) --#define BIT_RPT_DGAIN GENMASK(27, 16) --#define BIT_TX_CFIR GENMASK(31, 30) -- --#define PPG_THERMAL_A 0x1ef --#define PPG_THERMAL_B 0x1b0 --#define RF_THEMAL_MASK GENMASK(19, 16) --#define PPG_2GL_TXAB 0x1d4 --#define PPG_2GM_TXAB 0x1ee --#define PPG_2GH_TXAB 0x1d2 --#define PPG_2G_A_MASK GENMASK(3, 0) --#define PPG_2G_B_MASK GENMASK(7, 4) --#define PPG_5GL1_TXA 0x1ec --#define PPG_5GL2_TXA 0x1e8 --#define PPG_5GM1_TXA 0x1e4 --#define PPG_5GM2_TXA 0x1e0 --#define PPG_5GH1_TXA 0x1dc --#define PPG_5GL1_TXB 0x1eb --#define PPG_5GL2_TXB 0x1e7 --#define PPG_5GM1_TXB 0x1e3 --#define PPG_5GM2_TXB 0x1df --#define PPG_5GH1_TXB 0x1db --#define PPG_5G_MASK GENMASK(4, 0) --#define PPG_PABIAS_2GA 0x1d6 --#define PPG_PABIAS_2GB 0x1d5 --#define PPG_PABIAS_5GA 0x1d8 --#define PPG_PABIAS_5GB 0x1d7 --#define PPG_PABIAS_MASK GENMASK(3, 0) --#define RF_PABIAS_2G_MASK GENMASK(15, 12) --#define RF_PABIAS_5G_MASK GENMASK(19, 16) -+#define RF_EXT_TIA_BW 0x8f -+#define BIT_PW_EXT_TIA BIT(1) -+#define RF_DIS_BYPASS_TXBB 0x9e -+#define BIT_TXBB BIT(10) -+#define BIT_TIA_BYPASS BIT(5) -+#define RF_DEBUG 0xde -+#define BIT_DE_PWR_TRIM BIT(19) -+#define BIT_DE_TX_GAIN BIT(16) -+#define BIT_DE_TRXBW BIT(2) - -+#define PPG_THERMAL_B 0x1b0 -+#define RF_THEMAL_MASK GENMASK(19, 16) -+#define PPG_2GH_TXAB 0x1d2 -+#define PPG_2G_A_MASK GENMASK(3, 0) -+#define PPG_2G_B_MASK GENMASK(7, 4) -+#define PPG_2GL_TXAB 0x1d4 -+#define PPG_PABIAS_2GB 0x1d5 -+#define PPG_PABIAS_2GA 0x1d6 -+#define PPG_PABIAS_MASK GENMASK(3, 0) -+#define PPG_PABIAS_5GB 0x1d7 -+#define PPG_PABIAS_5GA 0x1d8 -+#define PPG_5G_MASK GENMASK(4, 0) -+#define PPG_5GH1_TXB 0x1db -+#define PPG_5GH1_TXA 0x1dc -+#define PPG_5GM2_TXB 0x1df -+#define PPG_5GM2_TXA 0x1e0 -+#define PPG_5GM1_TXB 0x1e3 -+#define PPG_5GM1_TXA 0x1e4 -+#define PPG_5GL2_TXB 0x1e7 -+#define PPG_5GL2_TXA 0x1e8 -+#define PPG_5GL1_TXB 0x1eb -+#define PPG_5GL1_TXA 0x1ec -+#define PPG_2GM_TXAB 0x1ee -+#define PPG_THERMAL_A 0x1ef - #endif -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822c_table.c b/drivers/net/wireless/realtek/rtw88/rtw8822c_table.c -index 3a204a753..f9e3d0779 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8822c_table.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822c_table.c -@@ -13,7 +13,72 @@ static const u32 rtw8822c_mac[] = { - RTW_DECL_TABLE_PHY_COND(rtw8822c_mac, rtw_phy_cfg_mac); - - static const u32 rtw8822c_agc[] = { -- 0x80000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1D90, 0x300001FF, -+ 0x1D90, 0x300101FE, -+ 0x1D90, 0x300201FD, -+ 0x1D90, 0x300301FC, -+ 0x1D90, 0x300401FB, -+ 0x1D90, 0x300501FA, -+ 0x1D90, 0x300601F9, -+ 0x1D90, 0x300701F8, -+ 0x1D90, 0x300801F7, -+ 0x1D90, 0x300901F6, -+ 0x1D90, 0x300A01F5, -+ 0x1D90, 0x300B01F4, -+ 0x1D90, 0x300C01F3, -+ 0x1D90, 0x300D01F2, -+ 0x1D90, 0x300E01F1, -+ 0x1D90, 0x300F01F0, -+ 0x1D90, 0x301001EF, -+ 0x1D90, 0x301101EE, -+ 0x1D90, 0x301201ED, -+ 0x1D90, 0x301301EC, -+ 0x1D90, 0x301401EB, -+ 0x1D90, 0x301501EA, -+ 0x1D90, 0x301601E9, -+ 0x1D90, 0x301701E8, -+ 0x1D90, 0x301801E7, -+ 0x1D90, 0x301901E5, -+ 0x1D90, 0x301A01E4, -+ 0x1D90, 0x301B01C5, -+ 0x1D90, 0x301C01C4, -+ 0x1D90, 0x301D01C3, -+ 0x1D90, 0x301E01C2, -+ 0x1D90, 0x301F0188, -+ 0x1D90, 0x30200187, -+ 0x1D90, 0x30210186, -+ 0x1D90, 0x30220184, -+ 0x1D90, 0x30230183, -+ 0x1D90, 0x30240182, -+ 0x1D90, 0x30250181, -+ 0x1D90, 0x30260148, -+ 0x1D90, 0x30270147, -+ 0x1D90, 0x30280146, -+ 0x1D90, 0x30290144, -+ 0x1D90, 0x302A0143, -+ 0x1D90, 0x302B0142, -+ 0x1D90, 0x302C0141, -+ 0x1D90, 0x302D00C8, -+ 0x1D90, 0x302E00C7, -+ 0x1D90, 0x302F00C6, -+ 0x1D90, 0x303000C5, -+ 0x1D90, 0x303100C4, -+ 0x1D90, 0x303200C3, -+ 0x1D90, 0x30330048, -+ 0x1D90, 0x30340047, -+ 0x1D90, 0x30350046, -+ 0x1D90, 0x30360045, -+ 0x1D90, 0x30370025, -+ 0x1D90, 0x30380024, -+ 0x1D90, 0x30390023, -+ 0x1D90, 0x303A0022, -+ 0x1D90, 0x303B0021, -+ 0x1D90, 0x303C0020, -+ 0x1D90, 0x303D0003, -+ 0x1D90, 0x303E0002, -+ 0x1D90, 0x303F0001, -+ 0x90000015, 0x00000000, 0x40000000, 0x00000000, - 0x1D90, 0x300001FF, - 0x1D90, 0x300101FE, - 0x1D90, 0x300201FD, -@@ -209,7 +274,72 @@ static const u32 rtw8822c_agc[] = { - 0x1D90, 0x303E0002, - 0x1D90, 0x303F0001, - 0xB0000000, 0x00000000, -- 0x80000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1D90, 0x3040011F, -+ 0x1D90, 0x3041011F, -+ 0x1D90, 0x3042011F, -+ 0x1D90, 0x3043011F, -+ 0x1D90, 0x3044011F, -+ 0x1D90, 0x3045011F, -+ 0x1D90, 0x3046011F, -+ 0x1D90, 0x3047011F, -+ 0x1D90, 0x3048011F, -+ 0x1D90, 0x3049011F, -+ 0x1D90, 0x304A011F, -+ 0x1D90, 0x304B011F, -+ 0x1D90, 0x304C011F, -+ 0x1D90, 0x304D011F, -+ 0x1D90, 0x304E011F, -+ 0x1D90, 0x304F00F4, -+ 0x1D90, 0x305000F3, -+ 0x1D90, 0x305100F2, -+ 0x1D90, 0x305200F1, -+ 0x1D90, 0x305300F0, -+ 0x1D90, 0x305400EF, -+ 0x1D90, 0x305500EE, -+ 0x1D90, 0x305600ED, -+ 0x1D90, 0x305700EC, -+ 0x1D90, 0x305800EB, -+ 0x1D90, 0x305900EA, -+ 0x1D90, 0x305A00E9, -+ 0x1D90, 0x305B00E8, -+ 0x1D90, 0x305C00E7, -+ 0x1D90, 0x305D00E6, -+ 0x1D90, 0x305E00E4, -+ 0x1D90, 0x305F00E3, -+ 0x1D90, 0x306000E2, -+ 0x1D90, 0x306100C4, -+ 0x1D90, 0x306200C3, -+ 0x1D90, 0x306300C2, -+ 0x1D90, 0x306400A4, -+ 0x1D90, 0x306500A3, -+ 0x1D90, 0x306600A2, -+ 0x1D90, 0x306700A1, -+ 0x1D90, 0x30680084, -+ 0x1D90, 0x30690083, -+ 0x1D90, 0x306A0082, -+ 0x1D90, 0x306B0081, -+ 0x1D90, 0x306C0080, -+ 0x1D90, 0x306D0067, -+ 0x1D90, 0x306E0066, -+ 0x1D90, 0x306F0065, -+ 0x1D90, 0x30700064, -+ 0x1D90, 0x30710063, -+ 0x1D90, 0x30720044, -+ 0x1D90, 0x30730043, -+ 0x1D90, 0x30740042, -+ 0x1D90, 0x30750041, -+ 0x1D90, 0x30760024, -+ 0x1D90, 0x30770023, -+ 0x1D90, 0x30780022, -+ 0x1D90, 0x30790021, -+ 0x1D90, 0x307A0020, -+ 0x1D90, 0x307B0004, -+ 0x1D90, 0x307C0003, -+ 0x1D90, 0x307D0002, -+ 0x1D90, 0x307E0001, -+ 0x1D90, 0x307F0000, -+ 0x90000015, 0x00000000, 0x40000000, 0x00000000, - 0x1D90, 0x304001FD, - 0x1D90, 0x304101FC, - 0x1D90, 0x304201FB, -@@ -405,137 +535,202 @@ static const u32 rtw8822c_agc[] = { - 0x1D90, 0x307E0001, - 0x1D90, 0x307F0000, - 0xB0000000, 0x00000000, -- 0x80000015, 0x00000000, 0x40000000, 0x00000000, -- 0x1D90, 0x308000FA, -- 0x1D90, 0x308100F9, -- 0x1D90, 0x308200F8, -- 0x1D90, 0x308300F7, -- 0x1D90, 0x308400F6, -- 0x1D90, 0x308500F5, -- 0x1D90, 0x308600F4, -- 0x1D90, 0x308700F3, -- 0x1D90, 0x308800F2, -- 0x1D90, 0x308900F1, -- 0x1D90, 0x308A00F0, -- 0x1D90, 0x308B00EF, -- 0x1D90, 0x308C00EE, -- 0x1D90, 0x308D00ED, -- 0x1D90, 0x308E00EC, -- 0x1D90, 0x308F00EB, -- 0x1D90, 0x309000EA, -- 0x1D90, 0x309100E8, -- 0x1D90, 0x309200E7, -- 0x1D90, 0x309300E6, -- 0x1D90, 0x309400E5, -- 0x1D90, 0x309500E4, -- 0x1D90, 0x309600C4, -- 0x1D90, 0x309700C3, -- 0x1D90, 0x309800C2, -- 0x1D90, 0x309900C1, -- 0x1D90, 0x309A00A3, -- 0x1D90, 0x309B00A2, -- 0x1D90, 0x309C00A1, -- 0x1D90, 0x309D0085, -- 0x1D90, 0x309E0084, -- 0x1D90, 0x309F0083, -- 0x1D90, 0x30A00082, -- 0x1D90, 0x30A10081, -- 0x1D90, 0x30A20067, -- 0x1D90, 0x30A30066, -- 0x1D90, 0x30A40065, -- 0x1D90, 0x30A50064, -- 0x1D90, 0x30A60063, -- 0x1D90, 0x30A70044, -- 0x1D90, 0x30A80043, -- 0x1D90, 0x30A90042, -- 0x1D90, 0x30AA0026, -- 0x1D90, 0x30AB0025, -- 0x1D90, 0x30AC0024, -- 0x1D90, 0x30AD0023, -- 0x1D90, 0x30AE0022, -- 0x1D90, 0x30AF0021, -- 0x1D90, 0x30B00005, -- 0x1D90, 0x30B10004, -- 0x1D90, 0x30B20003, -- 0x1D90, 0x30B30002, -- 0x1D90, 0x30B40001, -- 0x1D90, 0x30B50000, -- 0x1D90, 0x30B60000, -- 0x1D90, 0x30B70000, -- 0x1D90, 0x30B80000, -- 0x1D90, 0x30B90000, -- 0x1D90, 0x30BA0000, -- 0x1D90, 0x30BB0000, -- 0x1D90, 0x30BC0000, -- 0x1D90, 0x30BD0000, -- 0x1D90, 0x30BE0000, -- 0x1D90, 0x30BF0000, -- 0x90000016, 0x00000000, 0x40000000, 0x00000000, -- 0x1D90, 0x308000FA, -- 0x1D90, 0x308100F9, -- 0x1D90, 0x308200F8, -- 0x1D90, 0x308300F7, -- 0x1D90, 0x308400F6, -- 0x1D90, 0x308500F5, -- 0x1D90, 0x308600F4, -- 0x1D90, 0x308700F3, -- 0x1D90, 0x308800F2, -- 0x1D90, 0x308900F1, -- 0x1D90, 0x308A00F0, -- 0x1D90, 0x308B00EF, -- 0x1D90, 0x308C00EE, -- 0x1D90, 0x308D00ED, -- 0x1D90, 0x308E00EC, -- 0x1D90, 0x308F00EB, -- 0x1D90, 0x309000EA, -- 0x1D90, 0x309100E8, -- 0x1D90, 0x309200E7, -- 0x1D90, 0x309300E6, -- 0x1D90, 0x309400E5, -- 0x1D90, 0x309500E4, -- 0x1D90, 0x309600C4, -- 0x1D90, 0x309700C3, -- 0x1D90, 0x309800C2, -- 0x1D90, 0x309900C1, -- 0x1D90, 0x309A00A3, -- 0x1D90, 0x309B00A2, -- 0x1D90, 0x309C00A1, -- 0x1D90, 0x309D0085, -- 0x1D90, 0x309E0084, -- 0x1D90, 0x309F0083, -- 0x1D90, 0x30A00082, -- 0x1D90, 0x30A10081, -- 0x1D90, 0x30A20067, -- 0x1D90, 0x30A30066, -- 0x1D90, 0x30A40065, -- 0x1D90, 0x30A50064, -- 0x1D90, 0x30A60063, -- 0x1D90, 0x30A70044, -- 0x1D90, 0x30A80043, -- 0x1D90, 0x30A90042, -- 0x1D90, 0x30AA0026, -- 0x1D90, 0x30AB0025, -- 0x1D90, 0x30AC0024, -- 0x1D90, 0x30AD0023, -- 0x1D90, 0x30AE0022, -- 0x1D90, 0x30AF0021, -- 0x1D90, 0x30B00005, -- 0x1D90, 0x30B10004, -- 0x1D90, 0x30B20003, -- 0x1D90, 0x30B30002, -- 0x1D90, 0x30B40001, -- 0x1D90, 0x30B50000, -- 0x1D90, 0x30B60000, -- 0x1D90, 0x30B70000, -- 0x1D90, 0x30B80000, -- 0x1D90, 0x30B90000, -- 0x1D90, 0x30BA0000, -- 0x1D90, 0x30BB0000, -- 0x1D90, 0x30BC0000, -- 0x1D90, 0x30BD0000, -- 0x1D90, 0x30BE0000, -- 0x1D90, 0x30BF0000, -- 0xA0000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1D90, 0x308000FF, -+ 0x1D90, 0x308100FF, -+ 0x1D90, 0x308200FF, -+ 0x1D90, 0x308300FF, -+ 0x1D90, 0x308400FF, -+ 0x1D90, 0x308500FF, -+ 0x1D90, 0x308600FE, -+ 0x1D90, 0x308700FD, -+ 0x1D90, 0x308800FC, -+ 0x1D90, 0x308900FB, -+ 0x1D90, 0x308A00FA, -+ 0x1D90, 0x308B00F9, -+ 0x1D90, 0x308C00F8, -+ 0x1D90, 0x308D00F7, -+ 0x1D90, 0x308E00F6, -+ 0x1D90, 0x308F00F5, -+ 0x1D90, 0x309000F4, -+ 0x1D90, 0x309100F3, -+ 0x1D90, 0x309200F2, -+ 0x1D90, 0x309300F1, -+ 0x1D90, 0x309400F0, -+ 0x1D90, 0x309500EF, -+ 0x1D90, 0x309600EE, -+ 0x1D90, 0x309700ED, -+ 0x1D90, 0x309800EC, -+ 0x1D90, 0x309900EB, -+ 0x1D90, 0x309A00EA, -+ 0x1D90, 0x309B00E8, -+ 0x1D90, 0x309C00E7, -+ 0x1D90, 0x309D00E6, -+ 0x1D90, 0x309E00E5, -+ 0x1D90, 0x309F00E4, -+ 0x1D90, 0x30A000C4, -+ 0x1D90, 0x30A100C3, -+ 0x1D90, 0x30A200C2, -+ 0x1D90, 0x30A300C1, -+ 0x1D90, 0x30A400A3, -+ 0x1D90, 0x30A500A2, -+ 0x1D90, 0x30A600A1, -+ 0x1D90, 0x30A70085, -+ 0x1D90, 0x30A80084, -+ 0x1D90, 0x30A90083, -+ 0x1D90, 0x30AA0082, -+ 0x1D90, 0x30AB0081, -+ 0x1D90, 0x30AC0067, -+ 0x1D90, 0x30AD0066, -+ 0x1D90, 0x30AE0065, -+ 0x1D90, 0x30AF0064, -+ 0x1D90, 0x30B00063, -+ 0x1D90, 0x30B10044, -+ 0x1D90, 0x30B20043, -+ 0x1D90, 0x30B30042, -+ 0x1D90, 0x30B40026, -+ 0x1D90, 0x30B50025, -+ 0x1D90, 0x30B60024, -+ 0x1D90, 0x30B70023, -+ 0x1D90, 0x30B80022, -+ 0x1D90, 0x30B90021, -+ 0x1D90, 0x30BA0005, -+ 0x1D90, 0x30BB0004, -+ 0x1D90, 0x30BC0003, -+ 0x1D90, 0x30BD0002, -+ 0x1D90, 0x30BE0001, -+ 0x1D90, 0x30BF0000, -+ 0x90000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x1D90, 0x308000FA, -+ 0x1D90, 0x308100F9, -+ 0x1D90, 0x308200F8, -+ 0x1D90, 0x308300F7, -+ 0x1D90, 0x308400F6, -+ 0x1D90, 0x308500F5, -+ 0x1D90, 0x308600F4, -+ 0x1D90, 0x308700F3, -+ 0x1D90, 0x308800F2, -+ 0x1D90, 0x308900F1, -+ 0x1D90, 0x308A00F0, -+ 0x1D90, 0x308B00EF, -+ 0x1D90, 0x308C00EE, -+ 0x1D90, 0x308D00ED, -+ 0x1D90, 0x308E00EC, -+ 0x1D90, 0x308F00EB, -+ 0x1D90, 0x309000EA, -+ 0x1D90, 0x309100E8, -+ 0x1D90, 0x309200E7, -+ 0x1D90, 0x309300E6, -+ 0x1D90, 0x309400E5, -+ 0x1D90, 0x309500E4, -+ 0x1D90, 0x309600C4, -+ 0x1D90, 0x309700C3, -+ 0x1D90, 0x309800C2, -+ 0x1D90, 0x309900C1, -+ 0x1D90, 0x309A00A3, -+ 0x1D90, 0x309B00A2, -+ 0x1D90, 0x309C00A1, -+ 0x1D90, 0x309D0085, -+ 0x1D90, 0x309E0084, -+ 0x1D90, 0x309F0083, -+ 0x1D90, 0x30A00082, -+ 0x1D90, 0x30A10081, -+ 0x1D90, 0x30A20067, -+ 0x1D90, 0x30A30066, -+ 0x1D90, 0x30A40065, -+ 0x1D90, 0x30A50064, -+ 0x1D90, 0x30A60063, -+ 0x1D90, 0x30A70044, -+ 0x1D90, 0x30A80043, -+ 0x1D90, 0x30A90042, -+ 0x1D90, 0x30AA0026, -+ 0x1D90, 0x30AB0025, -+ 0x1D90, 0x30AC0024, -+ 0x1D90, 0x30AD0023, -+ 0x1D90, 0x30AE0022, -+ 0x1D90, 0x30AF0021, -+ 0x1D90, 0x30B00005, -+ 0x1D90, 0x30B10004, -+ 0x1D90, 0x30B20003, -+ 0x1D90, 0x30B30002, -+ 0x1D90, 0x30B40001, -+ 0x1D90, 0x30B50000, -+ 0x1D90, 0x30B60000, -+ 0x1D90, 0x30B70000, -+ 0x1D90, 0x30B80000, -+ 0x1D90, 0x30B90000, -+ 0x1D90, 0x30BA0000, -+ 0x1D90, 0x30BB0000, -+ 0x1D90, 0x30BC0000, -+ 0x1D90, 0x30BD0000, -+ 0x1D90, 0x30BE0000, -+ 0x1D90, 0x30BF0000, -+ 0x90000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x1D90, 0x308000FA, -+ 0x1D90, 0x308100F9, -+ 0x1D90, 0x308200F8, -+ 0x1D90, 0x308300F7, -+ 0x1D90, 0x308400F6, -+ 0x1D90, 0x308500F5, -+ 0x1D90, 0x308600F4, -+ 0x1D90, 0x308700F3, -+ 0x1D90, 0x308800F2, -+ 0x1D90, 0x308900F1, -+ 0x1D90, 0x308A00F0, -+ 0x1D90, 0x308B00EF, -+ 0x1D90, 0x308C00EE, -+ 0x1D90, 0x308D00ED, -+ 0x1D90, 0x308E00EC, -+ 0x1D90, 0x308F00EB, -+ 0x1D90, 0x309000EA, -+ 0x1D90, 0x309100E8, -+ 0x1D90, 0x309200E7, -+ 0x1D90, 0x309300E6, -+ 0x1D90, 0x309400E5, -+ 0x1D90, 0x309500E4, -+ 0x1D90, 0x309600C4, -+ 0x1D90, 0x309700C3, -+ 0x1D90, 0x309800C2, -+ 0x1D90, 0x309900C1, -+ 0x1D90, 0x309A00A3, -+ 0x1D90, 0x309B00A2, -+ 0x1D90, 0x309C00A1, -+ 0x1D90, 0x309D0085, -+ 0x1D90, 0x309E0084, -+ 0x1D90, 0x309F0083, -+ 0x1D90, 0x30A00082, -+ 0x1D90, 0x30A10081, -+ 0x1D90, 0x30A20067, -+ 0x1D90, 0x30A30066, -+ 0x1D90, 0x30A40065, -+ 0x1D90, 0x30A50064, -+ 0x1D90, 0x30A60063, -+ 0x1D90, 0x30A70044, -+ 0x1D90, 0x30A80043, -+ 0x1D90, 0x30A90042, -+ 0x1D90, 0x30AA0026, -+ 0x1D90, 0x30AB0025, -+ 0x1D90, 0x30AC0024, -+ 0x1D90, 0x30AD0023, -+ 0x1D90, 0x30AE0022, -+ 0x1D90, 0x30AF0021, -+ 0x1D90, 0x30B00005, -+ 0x1D90, 0x30B10004, -+ 0x1D90, 0x30B20003, -+ 0x1D90, 0x30B30002, -+ 0x1D90, 0x30B40001, -+ 0x1D90, 0x30B50000, -+ 0x1D90, 0x30B60000, -+ 0x1D90, 0x30B70000, -+ 0x1D90, 0x30B80000, -+ 0x1D90, 0x30B90000, -+ 0x1D90, 0x30BA0000, -+ 0x1D90, 0x30BB0000, -+ 0x1D90, 0x30BC0000, -+ 0x1D90, 0x30BD0000, -+ 0x1D90, 0x30BE0000, -+ 0x1D90, 0x30BF0000, -+ 0xA0000000, 0x00000000, - 0x1D90, 0x308000FF, - 0x1D90, 0x308100FF, - 0x1D90, 0x308200FF, -@@ -601,7 +796,72 @@ static const u32 rtw8822c_agc[] = { - 0x1D90, 0x30BE0001, - 0x1D90, 0x30BF0000, - 0xB0000000, 0x00000000, -- 0x80000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1D90, 0x30C000FF, -+ 0x1D90, 0x30C100FF, -+ 0x1D90, 0x30C200FF, -+ 0x1D90, 0x30C300FF, -+ 0x1D90, 0x30C400FF, -+ 0x1D90, 0x30C500FF, -+ 0x1D90, 0x30C600FE, -+ 0x1D90, 0x30C700FD, -+ 0x1D90, 0x30C800FC, -+ 0x1D90, 0x30C900FB, -+ 0x1D90, 0x30CA00FA, -+ 0x1D90, 0x30CB00F9, -+ 0x1D90, 0x30CC00F8, -+ 0x1D90, 0x30CD00F7, -+ 0x1D90, 0x30CE00F6, -+ 0x1D90, 0x30CF00F5, -+ 0x1D90, 0x30D000F4, -+ 0x1D90, 0x30D100F3, -+ 0x1D90, 0x30D200F2, -+ 0x1D90, 0x30D300F1, -+ 0x1D90, 0x30D400F0, -+ 0x1D90, 0x30D500EF, -+ 0x1D90, 0x30D600EE, -+ 0x1D90, 0x30D700ED, -+ 0x1D90, 0x30D800EC, -+ 0x1D90, 0x30D900EB, -+ 0x1D90, 0x30DA00EA, -+ 0x1D90, 0x30DB00E8, -+ 0x1D90, 0x30DC00E7, -+ 0x1D90, 0x30DD00E6, -+ 0x1D90, 0x30DE00E5, -+ 0x1D90, 0x30DF00E4, -+ 0x1D90, 0x30E000E3, -+ 0x1D90, 0x30E100E2, -+ 0x1D90, 0x30E200A6, -+ 0x1D90, 0x30E300A5, -+ 0x1D90, 0x30E400A4, -+ 0x1D90, 0x30E500A3, -+ 0x1D90, 0x30E600A2, -+ 0x1D90, 0x30E70086, -+ 0x1D90, 0x30E80085, -+ 0x1D90, 0x30E90084, -+ 0x1D90, 0x30EA0083, -+ 0x1D90, 0x30EB0082, -+ 0x1D90, 0x30EC0067, -+ 0x1D90, 0x30ED0066, -+ 0x1D90, 0x30EE0065, -+ 0x1D90, 0x30EF0064, -+ 0x1D90, 0x30F00063, -+ 0x1D90, 0x30F10045, -+ 0x1D90, 0x30F20044, -+ 0x1D90, 0x30F30043, -+ 0x1D90, 0x30F40042, -+ 0x1D90, 0x30F50025, -+ 0x1D90, 0x30F60024, -+ 0x1D90, 0x30F70023, -+ 0x1D90, 0x30F80022, -+ 0x1D90, 0x30F90021, -+ 0x1D90, 0x30FA0005, -+ 0x1D90, 0x30FB0004, -+ 0x1D90, 0x30FC0003, -+ 0x1D90, 0x30FD0002, -+ 0x1D90, 0x30FE0001, -+ 0x1D90, 0x30FF0000, -+ 0x90000015, 0x00000000, 0x40000000, 0x00000000, - 0x1D90, 0x30C000F8, - 0x1D90, 0x30C100F7, - 0x1D90, 0x30C200F6, -@@ -797,267 +1057,397 @@ static const u32 rtw8822c_agc[] = { - 0x1D90, 0x30FE0001, - 0x1D90, 0x30FF0000, - 0xB0000000, 0x00000000, -- 0x80000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1D90, 0x310001FF, -+ 0x1D90, 0x310101FF, -+ 0x1D90, 0x310201FF, -+ 0x1D90, 0x310301FF, -+ 0x1D90, 0x310401FE, -+ 0x1D90, 0x310501FD, -+ 0x1D90, 0x310601FC, -+ 0x1D90, 0x310701FB, -+ 0x1D90, 0x310801FA, -+ 0x1D90, 0x310901F9, -+ 0x1D90, 0x310A01F8, -+ 0x1D90, 0x310B01F7, -+ 0x1D90, 0x310C01F6, -+ 0x1D90, 0x310D01F5, -+ 0x1D90, 0x310E01F4, -+ 0x1D90, 0x310F01F3, -+ 0x1D90, 0x311001F2, -+ 0x1D90, 0x311101F1, -+ 0x1D90, 0x311201F0, -+ 0x1D90, 0x311301EF, -+ 0x1D90, 0x311401EE, -+ 0x1D90, 0x311501ED, -+ 0x1D90, 0x311601EC, -+ 0x1D90, 0x311701EB, -+ 0x1D90, 0x311801EA, -+ 0x1D90, 0x311901E9, -+ 0x1D90, 0x311A01E8, -+ 0x1D90, 0x311B01E7, -+ 0x1D90, 0x311C01E5, -+ 0x1D90, 0x311D01E4, -+ 0x1D90, 0x311E01C5, -+ 0x1D90, 0x311F01C4, -+ 0x1D90, 0x312001C3, -+ 0x1D90, 0x312101C2, -+ 0x1D90, 0x31220188, -+ 0x1D90, 0x31230187, -+ 0x1D90, 0x31240186, -+ 0x1D90, 0x31250184, -+ 0x1D90, 0x31260183, -+ 0x1D90, 0x31270182, -+ 0x1D90, 0x31280181, -+ 0x1D90, 0x31290148, -+ 0x1D90, 0x312A0147, -+ 0x1D90, 0x312B0146, -+ 0x1D90, 0x312C0144, -+ 0x1D90, 0x312D0143, -+ 0x1D90, 0x312E0142, -+ 0x1D90, 0x312F0141, -+ 0x1D90, 0x313000C8, -+ 0x1D90, 0x313100C7, -+ 0x1D90, 0x313200C6, -+ 0x1D90, 0x313300C5, -+ 0x1D90, 0x313400C4, -+ 0x1D90, 0x313500C3, -+ 0x1D90, 0x31360048, -+ 0x1D90, 0x31370047, -+ 0x1D90, 0x31380046, -+ 0x1D90, 0x31390045, -+ 0x1D90, 0x313A0025, -+ 0x1D90, 0x313B0024, -+ 0x1D90, 0x313C0023, -+ 0x1D90, 0x313D0022, -+ 0x1D90, 0x313E0021, -+ 0x1D90, 0x313F0020, -+ 0x90000015, 0x00000000, 0x40000000, 0x00000000, - 0x1D90, 0x310001FF, - 0x1D90, 0x310101FF, - 0x1D90, 0x310201FF, - 0x1D90, 0x310301FF, -- 0x1D90, 0x310401FF, -- 0x1D90, 0x310501FF, -- 0x1D90, 0x310601FF, -- 0x1D90, 0x310701FF, -- 0x1D90, 0x310801FF, -- 0x1D90, 0x310901FE, -- 0x1D90, 0x310A01FD, -- 0x1D90, 0x310B01FC, -- 0x1D90, 0x310C01FB, -- 0x1D90, 0x310D01FA, -- 0x1D90, 0x310E01F9, -- 0x1D90, 0x310F01F8, -- 0x1D90, 0x311001F7, -- 0x1D90, 0x311101F6, -- 0x1D90, 0x311201F5, -- 0x1D90, 0x311301F4, -- 0x1D90, 0x311401F3, -- 0x1D90, 0x311501F2, -- 0x1D90, 0x311601F1, -- 0x1D90, 0x311701F0, -- 0x1D90, 0x311801EF, -- 0x1D90, 0x311901EE, -- 0x1D90, 0x311A01ED, -- 0x1D90, 0x311B01EC, -- 0x1D90, 0x311C01EB, -- 0x1D90, 0x311D0192, -- 0x1D90, 0x311E0191, -- 0x1D90, 0x311F0190, -- 0x1D90, 0x3120018F, -- 0x1D90, 0x3121018E, -- 0x1D90, 0x3122018D, -- 0x1D90, 0x3123018C, -- 0x1D90, 0x3124018B, -- 0x1D90, 0x3125018A, -- 0x1D90, 0x31260189, -- 0x1D90, 0x31270188, -- 0x1D90, 0x31280187, -- 0x1D90, 0x31290186, -- 0x1D90, 0x312A0185, -- 0x1D90, 0x312B0149, -- 0x1D90, 0x312C0148, -- 0x1D90, 0x312D0147, -- 0x1D90, 0x312E0146, -- 0x1D90, 0x312F0145, -- 0x1D90, 0x31300144, -- 0x1D90, 0x31310143, -- 0x1D90, 0x31320142, -- 0x1D90, 0x31330141, -- 0x1D90, 0x31340140, -- 0x1D90, 0x313500C7, -- 0x1D90, 0x313600C6, -- 0x1D90, 0x313700C5, -- 0x1D90, 0x313800C4, -- 0x1D90, 0x313900C3, -- 0x1D90, 0x313A0088, -- 0x1D90, 0x313B0087, -- 0x1D90, 0x313C0086, -- 0x1D90, 0x313D0045, -- 0x1D90, 0x313E0044, -- 0x1D90, 0x313F0043, -+ 0x1D90, 0x310401FE, -+ 0x1D90, 0x310501FD, -+ 0x1D90, 0x310601FC, -+ 0x1D90, 0x310701FB, -+ 0x1D90, 0x310801FA, -+ 0x1D90, 0x310901F9, -+ 0x1D90, 0x310A01F8, -+ 0x1D90, 0x310B01F7, -+ 0x1D90, 0x310C01F6, -+ 0x1D90, 0x310D01F5, -+ 0x1D90, 0x310E01F4, -+ 0x1D90, 0x310F01F3, -+ 0x1D90, 0x311001F2, -+ 0x1D90, 0x311101F1, -+ 0x1D90, 0x311201F0, -+ 0x1D90, 0x311301EF, -+ 0x1D90, 0x311401EE, -+ 0x1D90, 0x311501ED, -+ 0x1D90, 0x311601EC, -+ 0x1D90, 0x311701EB, -+ 0x1D90, 0x311801EA, -+ 0x1D90, 0x311901E9, -+ 0x1D90, 0x311A01E8, -+ 0x1D90, 0x311B01E7, -+ 0x1D90, 0x311C01E5, -+ 0x1D90, 0x311D01E4, -+ 0x1D90, 0x311E01C5, -+ 0x1D90, 0x311F01C4, -+ 0x1D90, 0x312001C3, -+ 0x1D90, 0x312101C2, -+ 0x1D90, 0x31220188, -+ 0x1D90, 0x31230187, -+ 0x1D90, 0x31240186, -+ 0x1D90, 0x31250184, -+ 0x1D90, 0x31260183, -+ 0x1D90, 0x31270182, -+ 0x1D90, 0x31280181, -+ 0x1D90, 0x31290148, -+ 0x1D90, 0x312A0147, -+ 0x1D90, 0x312B0146, -+ 0x1D90, 0x312C0144, -+ 0x1D90, 0x312D0143, -+ 0x1D90, 0x312E0142, -+ 0x1D90, 0x312F0141, -+ 0x1D90, 0x313000C8, -+ 0x1D90, 0x313100C7, -+ 0x1D90, 0x313200C6, -+ 0x1D90, 0x313300C5, -+ 0x1D90, 0x313400C4, -+ 0x1D90, 0x313500C3, -+ 0x1D90, 0x31360048, -+ 0x1D90, 0x31370047, -+ 0x1D90, 0x31380046, -+ 0x1D90, 0x31390045, -+ 0x1D90, 0x313A0025, -+ 0x1D90, 0x313B0024, -+ 0x1D90, 0x313C0023, -+ 0x1D90, 0x313D0022, -+ 0x1D90, 0x313E0021, -+ 0x1D90, 0x313F0020, - 0x90000016, 0x00000000, 0x40000000, 0x00000000, - 0x1D90, 0x310001FF, - 0x1D90, 0x310101FF, - 0x1D90, 0x310201FF, - 0x1D90, 0x310301FF, -- 0x1D90, 0x310401FF, -- 0x1D90, 0x310501FF, -- 0x1D90, 0x310601FF, -- 0x1D90, 0x310701FF, -- 0x1D90, 0x310801FF, -- 0x1D90, 0x310901FE, -- 0x1D90, 0x310A01FD, -- 0x1D90, 0x310B01FC, -- 0x1D90, 0x310C01FB, -- 0x1D90, 0x310D01FA, -- 0x1D90, 0x310E01F9, -- 0x1D90, 0x310F01F8, -- 0x1D90, 0x311001F7, -- 0x1D90, 0x311101F6, -- 0x1D90, 0x311201F5, -- 0x1D90, 0x311301F4, -- 0x1D90, 0x311401F3, -- 0x1D90, 0x311501F2, -- 0x1D90, 0x311601F1, -- 0x1D90, 0x311701F0, -- 0x1D90, 0x311801EF, -- 0x1D90, 0x311901EE, -- 0x1D90, 0x311A01ED, -- 0x1D90, 0x311B01EC, -- 0x1D90, 0x311C01EB, -- 0x1D90, 0x311D0192, -- 0x1D90, 0x311E0191, -- 0x1D90, 0x311F0190, -- 0x1D90, 0x3120018F, -- 0x1D90, 0x3121018E, -- 0x1D90, 0x3122018D, -- 0x1D90, 0x3123018C, -- 0x1D90, 0x3124018B, -- 0x1D90, 0x3125018A, -- 0x1D90, 0x31260189, -- 0x1D90, 0x31270188, -- 0x1D90, 0x31280187, -- 0x1D90, 0x31290186, -- 0x1D90, 0x312A0185, -- 0x1D90, 0x312B0149, -- 0x1D90, 0x312C0148, -- 0x1D90, 0x312D0147, -- 0x1D90, 0x312E0146, -- 0x1D90, 0x312F0145, -- 0x1D90, 0x31300144, -- 0x1D90, 0x31310143, -- 0x1D90, 0x31320142, -- 0x1D90, 0x31330141, -- 0x1D90, 0x31340140, -- 0x1D90, 0x313500C7, -- 0x1D90, 0x313600C6, -- 0x1D90, 0x313700C5, -- 0x1D90, 0x313800C4, -- 0x1D90, 0x313900C3, -- 0x1D90, 0x313A0088, -- 0x1D90, 0x313B0087, -- 0x1D90, 0x313C0086, -- 0x1D90, 0x313D0045, -- 0x1D90, 0x313E0044, -- 0x1D90, 0x313F0043, -+ 0x1D90, 0x310401FE, -+ 0x1D90, 0x310501FD, -+ 0x1D90, 0x310601FC, -+ 0x1D90, 0x310701FB, -+ 0x1D90, 0x310801FA, -+ 0x1D90, 0x310901F9, -+ 0x1D90, 0x310A01F8, -+ 0x1D90, 0x310B01F7, -+ 0x1D90, 0x310C01F6, -+ 0x1D90, 0x310D01F5, -+ 0x1D90, 0x310E01F4, -+ 0x1D90, 0x310F01F3, -+ 0x1D90, 0x311001F2, -+ 0x1D90, 0x311101F1, -+ 0x1D90, 0x311201F0, -+ 0x1D90, 0x311301EF, -+ 0x1D90, 0x311401EE, -+ 0x1D90, 0x311501ED, -+ 0x1D90, 0x311601EC, -+ 0x1D90, 0x311701EB, -+ 0x1D90, 0x311801EA, -+ 0x1D90, 0x311901E9, -+ 0x1D90, 0x311A01E8, -+ 0x1D90, 0x311B01E7, -+ 0x1D90, 0x311C01E5, -+ 0x1D90, 0x311D01E4, -+ 0x1D90, 0x311E01C5, -+ 0x1D90, 0x311F01C4, -+ 0x1D90, 0x312001C3, -+ 0x1D90, 0x312101C2, -+ 0x1D90, 0x31220188, -+ 0x1D90, 0x31230187, -+ 0x1D90, 0x31240186, -+ 0x1D90, 0x31250184, -+ 0x1D90, 0x31260183, -+ 0x1D90, 0x31270182, -+ 0x1D90, 0x31280181, -+ 0x1D90, 0x31290148, -+ 0x1D90, 0x312A0147, -+ 0x1D90, 0x312B0146, -+ 0x1D90, 0x312C0144, -+ 0x1D90, 0x312D0143, -+ 0x1D90, 0x312E0142, -+ 0x1D90, 0x312F0141, -+ 0x1D90, 0x313000C8, -+ 0x1D90, 0x313100C7, -+ 0x1D90, 0x313200C6, -+ 0x1D90, 0x313300C5, -+ 0x1D90, 0x313400C4, -+ 0x1D90, 0x313500C3, -+ 0x1D90, 0x31360048, -+ 0x1D90, 0x31370047, -+ 0x1D90, 0x31380046, -+ 0x1D90, 0x31390045, -+ 0x1D90, 0x313A0025, -+ 0x1D90, 0x313B0024, -+ 0x1D90, 0x313C0023, -+ 0x1D90, 0x313D0022, -+ 0x1D90, 0x313E0021, -+ 0x1D90, 0x313F0020, - 0xA0000000, 0x00000000, - 0x1D90, 0x310001FF, - 0x1D90, 0x310101FF, - 0x1D90, 0x310201FF, - 0x1D90, 0x310301FF, -- 0x1D90, 0x310401FF, -- 0x1D90, 0x310501FF, -- 0x1D90, 0x310601FF, -- 0x1D90, 0x310701FF, -- 0x1D90, 0x310801FF, -- 0x1D90, 0x310901FE, -- 0x1D90, 0x310A01FD, -- 0x1D90, 0x310B01FC, -- 0x1D90, 0x310C01FB, -- 0x1D90, 0x310D01FA, -- 0x1D90, 0x310E01F9, -- 0x1D90, 0x310F01F8, -- 0x1D90, 0x311001F7, -- 0x1D90, 0x311101F6, -- 0x1D90, 0x311201F5, -- 0x1D90, 0x311301F4, -- 0x1D90, 0x311401F3, -- 0x1D90, 0x311501F2, -- 0x1D90, 0x311601F1, -- 0x1D90, 0x311701F0, -- 0x1D90, 0x311801EF, -- 0x1D90, 0x311901EE, -- 0x1D90, 0x311A01ED, -- 0x1D90, 0x311B01EC, -- 0x1D90, 0x311C01EB, -- 0x1D90, 0x311D0192, -- 0x1D90, 0x311E0191, -- 0x1D90, 0x311F0190, -- 0x1D90, 0x3120018F, -- 0x1D90, 0x3121018E, -- 0x1D90, 0x3122018D, -- 0x1D90, 0x3123018C, -- 0x1D90, 0x3124018B, -- 0x1D90, 0x3125018A, -- 0x1D90, 0x31260189, -- 0x1D90, 0x31270188, -- 0x1D90, 0x31280187, -- 0x1D90, 0x31290186, -- 0x1D90, 0x312A0185, -- 0x1D90, 0x312B0149, -- 0x1D90, 0x312C0148, -- 0x1D90, 0x312D0147, -- 0x1D90, 0x312E0146, -- 0x1D90, 0x312F0145, -- 0x1D90, 0x31300144, -- 0x1D90, 0x31310143, -- 0x1D90, 0x31320142, -- 0x1D90, 0x31330141, -- 0x1D90, 0x31340140, -- 0x1D90, 0x313500C7, -- 0x1D90, 0x313600C6, -- 0x1D90, 0x313700C5, -- 0x1D90, 0x313800C4, -- 0x1D90, 0x313900C3, -- 0x1D90, 0x313A0088, -- 0x1D90, 0x313B0087, -- 0x1D90, 0x313C0086, -- 0x1D90, 0x313D0045, -- 0x1D90, 0x313E0044, -- 0x1D90, 0x313F0043, -+ 0x1D90, 0x310401FE, -+ 0x1D90, 0x310501FD, -+ 0x1D90, 0x310601FC, -+ 0x1D90, 0x310701FB, -+ 0x1D90, 0x310801FA, -+ 0x1D90, 0x310901F9, -+ 0x1D90, 0x310A01F8, -+ 0x1D90, 0x310B01F7, -+ 0x1D90, 0x310C01F6, -+ 0x1D90, 0x310D01F5, -+ 0x1D90, 0x310E01F4, -+ 0x1D90, 0x310F01F3, -+ 0x1D90, 0x311001F2, -+ 0x1D90, 0x311101F1, -+ 0x1D90, 0x311201F0, -+ 0x1D90, 0x311301EF, -+ 0x1D90, 0x311401EE, -+ 0x1D90, 0x311501ED, -+ 0x1D90, 0x311601EC, -+ 0x1D90, 0x311701EB, -+ 0x1D90, 0x311801EA, -+ 0x1D90, 0x311901E9, -+ 0x1D90, 0x311A01E8, -+ 0x1D90, 0x311B01E7, -+ 0x1D90, 0x311C01E5, -+ 0x1D90, 0x311D01E4, -+ 0x1D90, 0x311E01C5, -+ 0x1D90, 0x311F01C4, -+ 0x1D90, 0x312001C3, -+ 0x1D90, 0x312101C2, -+ 0x1D90, 0x31220188, -+ 0x1D90, 0x31230187, -+ 0x1D90, 0x31240186, -+ 0x1D90, 0x31250184, -+ 0x1D90, 0x31260183, -+ 0x1D90, 0x31270182, -+ 0x1D90, 0x31280181, -+ 0x1D90, 0x31290148, -+ 0x1D90, 0x312A0147, -+ 0x1D90, 0x312B0146, -+ 0x1D90, 0x312C0144, -+ 0x1D90, 0x312D0143, -+ 0x1D90, 0x312E0142, -+ 0x1D90, 0x312F0141, -+ 0x1D90, 0x313000C8, -+ 0x1D90, 0x313100C7, -+ 0x1D90, 0x313200C6, -+ 0x1D90, 0x313300C5, -+ 0x1D90, 0x313400C4, -+ 0x1D90, 0x313500C3, -+ 0x1D90, 0x31360048, -+ 0x1D90, 0x31370047, -+ 0x1D90, 0x31380046, -+ 0x1D90, 0x31390045, -+ 0x1D90, 0x313A0025, -+ 0x1D90, 0x313B0024, -+ 0x1D90, 0x313C0023, -+ 0x1D90, 0x313D0022, -+ 0x1D90, 0x313E0021, -+ 0x1D90, 0x313F0020, - 0xB0000000, 0x00000000, -- 0x80000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, - 0x1D90, 0x314001FF, - 0x1D90, 0x314101FF, - 0x1D90, 0x314201FF, - 0x1D90, 0x314301FF, - 0x1D90, 0x314401FF, - 0x1D90, 0x314501FF, -- 0x1D90, 0x314601FF, -- 0x1D90, 0x314701FE, -- 0x1D90, 0x314801FD, -- 0x1D90, 0x314901FC, -- 0x1D90, 0x314A01FB, -- 0x1D90, 0x314B01FA, -- 0x1D90, 0x314C01F9, -- 0x1D90, 0x314D01F8, -- 0x1D90, 0x314E01F7, -- 0x1D90, 0x314F01F6, -- 0x1D90, 0x315001F5, -- 0x1D90, 0x315101F4, -- 0x1D90, 0x315201F3, -- 0x1D90, 0x315301F2, -- 0x1D90, 0x315401F1, -- 0x1D90, 0x315501F0, -- 0x1D90, 0x315601EF, -- 0x1D90, 0x315701EE, -- 0x1D90, 0x315801ED, -- 0x1D90, 0x315901EC, -- 0x1D90, 0x315A01EB, -- 0x1D90, 0x315B01EA, -- 0x1D90, 0x315C01E9, -- 0x1D90, 0x315D018F, -- 0x1D90, 0x315E018E, -- 0x1D90, 0x315F018D, -- 0x1D90, 0x3160018C, -- 0x1D90, 0x3161018B, -- 0x1D90, 0x3162018A, -- 0x1D90, 0x31630189, -- 0x1D90, 0x31640188, -- 0x1D90, 0x31650187, -- 0x1D90, 0x31660186, -- 0x1D90, 0x31670185, -- 0x1D90, 0x31680184, -- 0x1D90, 0x31690183, -- 0x1D90, 0x316A0182, -- 0x1D90, 0x316B0149, -- 0x1D90, 0x316C0148, -- 0x1D90, 0x316D0147, -- 0x1D90, 0x316E0146, -- 0x1D90, 0x316F0145, -- 0x1D90, 0x31700144, -- 0x1D90, 0x31710143, -- 0x1D90, 0x31720142, -- 0x1D90, 0x31730141, -- 0x1D90, 0x31740140, -- 0x1D90, 0x317500C7, -- 0x1D90, 0x317600C6, -- 0x1D90, 0x317700C5, -- 0x1D90, 0x317800C4, -- 0x1D90, 0x317900C3, -- 0x1D90, 0x317A0088, -- 0x1D90, 0x317B0087, -- 0x1D90, 0x317C0086, -- 0x1D90, 0x317D0045, -- 0x1D90, 0x317E0044, -- 0x1D90, 0x317F0043, -+ 0x1D90, 0x314601FE, -+ 0x1D90, 0x314701FD, -+ 0x1D90, 0x314801FC, -+ 0x1D90, 0x314901FB, -+ 0x1D90, 0x314A01FA, -+ 0x1D90, 0x314B01F9, -+ 0x1D90, 0x314C01F8, -+ 0x1D90, 0x314D01F7, -+ 0x1D90, 0x314E01F6, -+ 0x1D90, 0x314F01F5, -+ 0x1D90, 0x315001F4, -+ 0x1D90, 0x315101F3, -+ 0x1D90, 0x315201F2, -+ 0x1D90, 0x315301F1, -+ 0x1D90, 0x315401F0, -+ 0x1D90, 0x315501EF, -+ 0x1D90, 0x315601EE, -+ 0x1D90, 0x315701ED, -+ 0x1D90, 0x315801EC, -+ 0x1D90, 0x315901EB, -+ 0x1D90, 0x315A01EA, -+ 0x1D90, 0x315B01E9, -+ 0x1D90, 0x315C01E7, -+ 0x1D90, 0x315D01E6, -+ 0x1D90, 0x315E01E5, -+ 0x1D90, 0x315F01E4, -+ 0x1D90, 0x316001A8, -+ 0x1D90, 0x316101A7, -+ 0x1D90, 0x316201A6, -+ 0x1D90, 0x316301A5, -+ 0x1D90, 0x31640185, -+ 0x1D90, 0x31650184, -+ 0x1D90, 0x31660183, -+ 0x1D90, 0x31670182, -+ 0x1D90, 0x31680149, -+ 0x1D90, 0x31690148, -+ 0x1D90, 0x316A0147, -+ 0x1D90, 0x316B0145, -+ 0x1D90, 0x316C0144, -+ 0x1D90, 0x316D0143, -+ 0x1D90, 0x316E0142, -+ 0x1D90, 0x316F00E6, -+ 0x1D90, 0x317000E5, -+ 0x1D90, 0x317100C9, -+ 0x1D90, 0x317200C8, -+ 0x1D90, 0x317300C7, -+ 0x1D90, 0x317400C6, -+ 0x1D90, 0x317500C5, -+ 0x1D90, 0x317600C4, -+ 0x1D90, 0x317700C3, -+ 0x1D90, 0x31780088, -+ 0x1D90, 0x31790087, -+ 0x1D90, 0x317A0086, -+ 0x1D90, 0x317B0085, -+ 0x1D90, 0x317C0026, -+ 0x1D90, 0x317D0025, -+ 0x1D90, 0x317E0024, -+ 0x1D90, 0x317F0023, -+ 0x90000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x1D90, 0x314001FF, -+ 0x1D90, 0x314101FF, -+ 0x1D90, 0x314201FF, -+ 0x1D90, 0x314301FF, -+ 0x1D90, 0x314401FF, -+ 0x1D90, 0x314501FF, -+ 0x1D90, 0x314601FE, -+ 0x1D90, 0x314701FD, -+ 0x1D90, 0x314801FC, -+ 0x1D90, 0x314901FB, -+ 0x1D90, 0x314A01FA, -+ 0x1D90, 0x314B01F9, -+ 0x1D90, 0x314C01F8, -+ 0x1D90, 0x314D01F7, -+ 0x1D90, 0x314E01F6, -+ 0x1D90, 0x314F01F5, -+ 0x1D90, 0x315001F4, -+ 0x1D90, 0x315101F3, -+ 0x1D90, 0x315201F2, -+ 0x1D90, 0x315301F1, -+ 0x1D90, 0x315401F0, -+ 0x1D90, 0x315501EF, -+ 0x1D90, 0x315601EE, -+ 0x1D90, 0x315701ED, -+ 0x1D90, 0x315801EC, -+ 0x1D90, 0x315901EB, -+ 0x1D90, 0x315A01EA, -+ 0x1D90, 0x315B01E9, -+ 0x1D90, 0x315C01E7, -+ 0x1D90, 0x315D01E6, -+ 0x1D90, 0x315E01E5, -+ 0x1D90, 0x315F01E4, -+ 0x1D90, 0x316001A8, -+ 0x1D90, 0x316101A7, -+ 0x1D90, 0x316201A6, -+ 0x1D90, 0x316301A5, -+ 0x1D90, 0x31640185, -+ 0x1D90, 0x31650184, -+ 0x1D90, 0x31660183, -+ 0x1D90, 0x31670182, -+ 0x1D90, 0x31680149, -+ 0x1D90, 0x31690148, -+ 0x1D90, 0x316A0147, -+ 0x1D90, 0x316B0145, -+ 0x1D90, 0x316C0144, -+ 0x1D90, 0x316D0143, -+ 0x1D90, 0x316E0142, -+ 0x1D90, 0x316F00E6, -+ 0x1D90, 0x317000E5, -+ 0x1D90, 0x317100C9, -+ 0x1D90, 0x317200C8, -+ 0x1D90, 0x317300C7, -+ 0x1D90, 0x317400C6, -+ 0x1D90, 0x317500C5, -+ 0x1D90, 0x317600C4, -+ 0x1D90, 0x317700C3, -+ 0x1D90, 0x31780088, -+ 0x1D90, 0x31790087, -+ 0x1D90, 0x317A0086, -+ 0x1D90, 0x317B0085, -+ 0x1D90, 0x317C0026, -+ 0x1D90, 0x317D0025, -+ 0x1D90, 0x317E0024, -+ 0x1D90, 0x317F0023, - 0x90000016, 0x00000000, 0x40000000, 0x00000000, - 0x1D90, 0x314001FF, - 0x1D90, 0x314101FF, -@@ -1065,64 +1455,64 @@ static const u32 rtw8822c_agc[] = { - 0x1D90, 0x314301FF, - 0x1D90, 0x314401FF, - 0x1D90, 0x314501FF, -- 0x1D90, 0x314601FF, -- 0x1D90, 0x314701FE, -- 0x1D90, 0x314801FD, -- 0x1D90, 0x314901FC, -- 0x1D90, 0x314A01FB, -- 0x1D90, 0x314B01FA, -- 0x1D90, 0x314C01F9, -- 0x1D90, 0x314D01F8, -- 0x1D90, 0x314E01F7, -- 0x1D90, 0x314F01F6, -- 0x1D90, 0x315001F5, -- 0x1D90, 0x315101F4, -- 0x1D90, 0x315201F3, -- 0x1D90, 0x315301F2, -- 0x1D90, 0x315401F1, -- 0x1D90, 0x315501F0, -- 0x1D90, 0x315601EF, -- 0x1D90, 0x315701EE, -- 0x1D90, 0x315801ED, -- 0x1D90, 0x315901EC, -- 0x1D90, 0x315A01EB, -- 0x1D90, 0x315B01EA, -- 0x1D90, 0x315C01E9, -- 0x1D90, 0x315D018F, -- 0x1D90, 0x315E018E, -- 0x1D90, 0x315F018D, -- 0x1D90, 0x3160018C, -- 0x1D90, 0x3161018B, -- 0x1D90, 0x3162018A, -- 0x1D90, 0x31630189, -- 0x1D90, 0x31640188, -- 0x1D90, 0x31650187, -- 0x1D90, 0x31660186, -- 0x1D90, 0x31670185, -- 0x1D90, 0x31680184, -- 0x1D90, 0x31690183, -- 0x1D90, 0x316A0182, -- 0x1D90, 0x316B0149, -- 0x1D90, 0x316C0148, -- 0x1D90, 0x316D0147, -- 0x1D90, 0x316E0146, -- 0x1D90, 0x316F0145, -- 0x1D90, 0x31700144, -- 0x1D90, 0x31710143, -- 0x1D90, 0x31720142, -- 0x1D90, 0x31730141, -- 0x1D90, 0x31740140, -- 0x1D90, 0x317500C7, -- 0x1D90, 0x317600C6, -- 0x1D90, 0x317700C5, -- 0x1D90, 0x317800C4, -- 0x1D90, 0x317900C3, -- 0x1D90, 0x317A0088, -- 0x1D90, 0x317B0087, -- 0x1D90, 0x317C0086, -- 0x1D90, 0x317D0045, -- 0x1D90, 0x317E0044, -- 0x1D90, 0x317F0043, -+ 0x1D90, 0x314601FE, -+ 0x1D90, 0x314701FD, -+ 0x1D90, 0x314801FC, -+ 0x1D90, 0x314901FB, -+ 0x1D90, 0x314A01FA, -+ 0x1D90, 0x314B01F9, -+ 0x1D90, 0x314C01F8, -+ 0x1D90, 0x314D01F7, -+ 0x1D90, 0x314E01F6, -+ 0x1D90, 0x314F01F5, -+ 0x1D90, 0x315001F4, -+ 0x1D90, 0x315101F3, -+ 0x1D90, 0x315201F2, -+ 0x1D90, 0x315301F1, -+ 0x1D90, 0x315401F0, -+ 0x1D90, 0x315501EF, -+ 0x1D90, 0x315601EE, -+ 0x1D90, 0x315701ED, -+ 0x1D90, 0x315801EC, -+ 0x1D90, 0x315901EB, -+ 0x1D90, 0x315A01EA, -+ 0x1D90, 0x315B01E9, -+ 0x1D90, 0x315C01E7, -+ 0x1D90, 0x315D01E6, -+ 0x1D90, 0x315E01E5, -+ 0x1D90, 0x315F01E4, -+ 0x1D90, 0x316001A8, -+ 0x1D90, 0x316101A7, -+ 0x1D90, 0x316201A6, -+ 0x1D90, 0x316301A5, -+ 0x1D90, 0x31640185, -+ 0x1D90, 0x31650184, -+ 0x1D90, 0x31660183, -+ 0x1D90, 0x31670182, -+ 0x1D90, 0x31680149, -+ 0x1D90, 0x31690148, -+ 0x1D90, 0x316A0147, -+ 0x1D90, 0x316B0145, -+ 0x1D90, 0x316C0144, -+ 0x1D90, 0x316D0143, -+ 0x1D90, 0x316E0142, -+ 0x1D90, 0x316F00E6, -+ 0x1D90, 0x317000E5, -+ 0x1D90, 0x317100C9, -+ 0x1D90, 0x317200C8, -+ 0x1D90, 0x317300C7, -+ 0x1D90, 0x317400C6, -+ 0x1D90, 0x317500C5, -+ 0x1D90, 0x317600C4, -+ 0x1D90, 0x317700C3, -+ 0x1D90, 0x31780088, -+ 0x1D90, 0x31790087, -+ 0x1D90, 0x317A0086, -+ 0x1D90, 0x317B0085, -+ 0x1D90, 0x317C0026, -+ 0x1D90, 0x317D0025, -+ 0x1D90, 0x317E0024, -+ 0x1D90, 0x317F0023, - 0xA0000000, 0x00000000, - 0x1D90, 0x314001FF, - 0x1D90, 0x314101FF, -@@ -1130,66 +1520,131 @@ static const u32 rtw8822c_agc[] = { - 0x1D90, 0x314301FF, - 0x1D90, 0x314401FF, - 0x1D90, 0x314501FF, -- 0x1D90, 0x314601FF, -- 0x1D90, 0x314701FE, -- 0x1D90, 0x314801FD, -- 0x1D90, 0x314901FC, -- 0x1D90, 0x314A01FB, -- 0x1D90, 0x314B01FA, -- 0x1D90, 0x314C01F9, -- 0x1D90, 0x314D01F8, -- 0x1D90, 0x314E01F7, -- 0x1D90, 0x314F01F6, -- 0x1D90, 0x315001F5, -- 0x1D90, 0x315101F4, -- 0x1D90, 0x315201F3, -- 0x1D90, 0x315301F2, -- 0x1D90, 0x315401F1, -- 0x1D90, 0x315501F0, -- 0x1D90, 0x315601EF, -- 0x1D90, 0x315701EE, -- 0x1D90, 0x315801ED, -- 0x1D90, 0x315901EC, -- 0x1D90, 0x315A01EB, -- 0x1D90, 0x315B01EA, -- 0x1D90, 0x315C01E9, -- 0x1D90, 0x315D018F, -- 0x1D90, 0x315E018E, -- 0x1D90, 0x315F018D, -- 0x1D90, 0x3160018C, -- 0x1D90, 0x3161018B, -- 0x1D90, 0x3162018A, -- 0x1D90, 0x31630189, -- 0x1D90, 0x31640188, -- 0x1D90, 0x31650187, -- 0x1D90, 0x31660186, -- 0x1D90, 0x31670185, -- 0x1D90, 0x31680184, -- 0x1D90, 0x31690183, -- 0x1D90, 0x316A0182, -- 0x1D90, 0x316B0149, -- 0x1D90, 0x316C0148, -- 0x1D90, 0x316D0147, -- 0x1D90, 0x316E0146, -- 0x1D90, 0x316F0145, -- 0x1D90, 0x31700144, -- 0x1D90, 0x31710143, -- 0x1D90, 0x31720142, -- 0x1D90, 0x31730141, -- 0x1D90, 0x31740140, -- 0x1D90, 0x317500C7, -- 0x1D90, 0x317600C6, -- 0x1D90, 0x317700C5, -- 0x1D90, 0x317800C4, -- 0x1D90, 0x317900C3, -- 0x1D90, 0x317A0088, -- 0x1D90, 0x317B0087, -- 0x1D90, 0x317C0086, -- 0x1D90, 0x317D0045, -- 0x1D90, 0x317E0044, -- 0x1D90, 0x317F0043, -+ 0x1D90, 0x314601FE, -+ 0x1D90, 0x314701FD, -+ 0x1D90, 0x314801FC, -+ 0x1D90, 0x314901FB, -+ 0x1D90, 0x314A01FA, -+ 0x1D90, 0x314B01F9, -+ 0x1D90, 0x314C01F8, -+ 0x1D90, 0x314D01F7, -+ 0x1D90, 0x314E01F6, -+ 0x1D90, 0x314F01F5, -+ 0x1D90, 0x315001F4, -+ 0x1D90, 0x315101F3, -+ 0x1D90, 0x315201F2, -+ 0x1D90, 0x315301F1, -+ 0x1D90, 0x315401F0, -+ 0x1D90, 0x315501EF, -+ 0x1D90, 0x315601EE, -+ 0x1D90, 0x315701ED, -+ 0x1D90, 0x315801EC, -+ 0x1D90, 0x315901EB, -+ 0x1D90, 0x315A01EA, -+ 0x1D90, 0x315B01E9, -+ 0x1D90, 0x315C01E7, -+ 0x1D90, 0x315D01E6, -+ 0x1D90, 0x315E01E5, -+ 0x1D90, 0x315F01E4, -+ 0x1D90, 0x316001A8, -+ 0x1D90, 0x316101A7, -+ 0x1D90, 0x316201A6, -+ 0x1D90, 0x316301A5, -+ 0x1D90, 0x31640185, -+ 0x1D90, 0x31650184, -+ 0x1D90, 0x31660183, -+ 0x1D90, 0x31670182, -+ 0x1D90, 0x31680149, -+ 0x1D90, 0x31690148, -+ 0x1D90, 0x316A0147, -+ 0x1D90, 0x316B0145, -+ 0x1D90, 0x316C0144, -+ 0x1D90, 0x316D0143, -+ 0x1D90, 0x316E0142, -+ 0x1D90, 0x316F00E6, -+ 0x1D90, 0x317000E5, -+ 0x1D90, 0x317100C9, -+ 0x1D90, 0x317200C8, -+ 0x1D90, 0x317300C7, -+ 0x1D90, 0x317400C6, -+ 0x1D90, 0x317500C5, -+ 0x1D90, 0x317600C4, -+ 0x1D90, 0x317700C3, -+ 0x1D90, 0x31780088, -+ 0x1D90, 0x31790087, -+ 0x1D90, 0x317A0086, -+ 0x1D90, 0x317B0085, -+ 0x1D90, 0x317C0026, -+ 0x1D90, 0x317D0025, -+ 0x1D90, 0x317E0024, -+ 0x1D90, 0x317F0023, - 0xB0000000, 0x00000000, -- 0x80000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1D90, 0x318001FE, -+ 0x1D90, 0x318101FD, -+ 0x1D90, 0x318201FC, -+ 0x1D90, 0x318301FB, -+ 0x1D90, 0x318401FA, -+ 0x1D90, 0x318501F9, -+ 0x1D90, 0x318601F8, -+ 0x1D90, 0x318701F7, -+ 0x1D90, 0x318801F6, -+ 0x1D90, 0x318901F5, -+ 0x1D90, 0x318A01F4, -+ 0x1D90, 0x318B01F3, -+ 0x1D90, 0x318C01F2, -+ 0x1D90, 0x318D01F1, -+ 0x1D90, 0x318E01F0, -+ 0x1D90, 0x318F01EF, -+ 0x1D90, 0x319001EE, -+ 0x1D90, 0x319101ED, -+ 0x1D90, 0x319201EC, -+ 0x1D90, 0x319301EB, -+ 0x1D90, 0x319401EA, -+ 0x1D90, 0x319501E9, -+ 0x1D90, 0x319601E7, -+ 0x1D90, 0x319701E6, -+ 0x1D90, 0x319801E5, -+ 0x1D90, 0x319901E4, -+ 0x1D90, 0x319A01A8, -+ 0x1D90, 0x319B01A7, -+ 0x1D90, 0x319C01A6, -+ 0x1D90, 0x319D01A5, -+ 0x1D90, 0x319E0185, -+ 0x1D90, 0x319F0184, -+ 0x1D90, 0x31A00183, -+ 0x1D90, 0x31A10182, -+ 0x1D90, 0x31A20149, -+ 0x1D90, 0x31A30148, -+ 0x1D90, 0x31A40147, -+ 0x1D90, 0x31A50145, -+ 0x1D90, 0x31A60144, -+ 0x1D90, 0x31A70143, -+ 0x1D90, 0x31A80142, -+ 0x1D90, 0x31A900E6, -+ 0x1D90, 0x31AA00E5, -+ 0x1D90, 0x31AB00C9, -+ 0x1D90, 0x31AC00C8, -+ 0x1D90, 0x31AD00C7, -+ 0x1D90, 0x31AE00C6, -+ 0x1D90, 0x31AF00C5, -+ 0x1D90, 0x31B000C4, -+ 0x1D90, 0x31B100C3, -+ 0x1D90, 0x31B20088, -+ 0x1D90, 0x31B30087, -+ 0x1D90, 0x31B40086, -+ 0x1D90, 0x31B50085, -+ 0x1D90, 0x31B60026, -+ 0x1D90, 0x31B70025, -+ 0x1D90, 0x31B80024, -+ 0x1D90, 0x31B90023, -+ 0x1D90, 0x31BA0022, -+ 0x1D90, 0x31BB0021, -+ 0x1D90, 0x31BC0020, -+ 0x1D90, 0x31BD0003, -+ 0x1D90, 0x31BE0002, -+ 0x1D90, 0x31BF0001, -+ 0x90000015, 0x00000000, 0x40000000, 0x00000000, - 0x1D90, 0x318001FE, - 0x1D90, 0x318101FD, - 0x1D90, 0x318201FC, -@@ -1385,7 +1840,10 @@ static const u32 rtw8822c_agc[] = { - 0x1D90, 0x31BE0002, - 0x1D90, 0x31BF0001, - 0xB0000000, 0x00000000, -- 0x80000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1D70, 0x22222222, -+ 0x1D70, 0x20202020, -+ 0x90000015, 0x00000000, 0x40000000, 0x00000000, - 0x1D70, 0x22222222, - 0x1D70, 0x20202020, - 0x90000016, 0x00000000, 0x40000000, 0x00000000, -@@ -1793,7 +2251,9 @@ static const u32 rtw8822c_bb[] = { - 0x1828, 0x000004FD, - 0x182C, 0x00000000, - 0x1834, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1838, 0x20000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x1838, 0x20100000, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x1838, 0x20100000, -@@ -1801,11 +2261,17 @@ static const u32 rtw8822c_bb[] = { - 0x1838, 0x20100000, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x1838, 0x20100000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x1838, 0x20100000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x1838, 0x20100000, - 0xA0000000, 0x00000000, - 0x1838, 0x20000000, - 0xB0000000, 0x00000000, - 0x183C, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1840, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x1840, 0x00002300, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x1840, 0x00002300, -@@ -1813,6 +2279,10 @@ static const u32 rtw8822c_bb[] = { - 0x1840, 0x00002300, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x1840, 0x00002300, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x1840, 0x00002300, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x1840, 0x00002300, - 0xA0000000, 0x00000000, - 0x1840, 0x00000000, - 0xB0000000, 0x00000000, -@@ -1826,7 +2296,9 @@ static const u32 rtw8822c_bb[] = { - 0x1860, 0xF0040FF8, - 0x1864, 0x7F000000, - 0x1868, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x186C, 0x0000FF00, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x186C, 0x0000FF02, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x186C, 0x0000FF02, -@@ -1834,6 +2306,10 @@ static const u32 rtw8822c_bb[] = { - 0x186C, 0x0000FF02, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x186C, 0x0000FF02, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x186C, 0x0000FF02, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x186C, 0x0000FF02, - 0xA0000000, 0x00000000, - 0x186C, 0x0000FF00, - 0xB0000000, 0x00000000, -@@ -1842,7 +2318,9 @@ static const u32 rtw8822c_bb[] = { - 0x1878, 0x00000000, - 0x187C, 0x00000000, - 0x1880, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1884, 0x02B00000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x1884, 0x03B00000, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x1884, 0x03B00000, -@@ -1850,6 +2328,10 @@ static const u32 rtw8822c_bb[] = { - 0x1884, 0x03B00000, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x1884, 0x03B00000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x1884, 0x03B00000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x1884, 0x03B00000, - 0xA0000000, 0x00000000, - 0x1884, 0x02B00000, - 0xB0000000, 0x00000000, -@@ -1982,7 +2464,10 @@ static const u32 rtw8822c_bb[] = { - 0x1C84, 0x245120D4, - 0x1C88, 0xC8400483, - 0x1C8C, 0x40005A20, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x1C94, 0x00000000, -+ 0x1C98, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x1C94, 0x00000B0E, - 0x1C98, 0x00450000, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -1994,6 +2479,12 @@ static const u32 rtw8822c_bb[] = { - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x1C94, 0x00000B0E, - 0x1C98, 0x00450000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x1C94, 0x00000B0E, -+ 0x1C98, 0x00450000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x1C94, 0x00000B0E, -+ 0x1C98, 0x00450000, - 0xA0000000, 0x00000000, - 0x1C94, 0x00000000, - 0x1C98, 0x00000000, -@@ -2330,7 +2821,9 @@ static const u32 rtw8822c_bb[] = { - 0x4128, 0x000004FD, - 0x412C, 0x00000000, - 0x4134, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x4138, 0x20000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x4138, 0x20100000, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x4138, 0x20100000, -@@ -2338,12 +2831,18 @@ static const u32 rtw8822c_bb[] = { - 0x4138, 0x20100000, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x4138, 0x20100000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x4138, 0x20100000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x4138, 0x20100000, - 0xA0000000, 0x00000000, - 0x4138, 0x20000000, - 0xB0000000, 0x00000000, - 0x413C, 0x00000000, - 0x4140, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x4144, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x4144, 0x00002030, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x4144, 0x00002030, -@@ -2351,6 +2850,10 @@ static const u32 rtw8822c_bb[] = { - 0x4144, 0x00002030, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x4144, 0x00002030, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x4144, 0x00002030, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x4144, 0x00002030, - 0xA0000000, 0x00000000, - 0x4144, 0x00000000, - 0xB0000000, 0x00000000, -@@ -2363,7 +2866,9 @@ static const u32 rtw8822c_bb[] = { - 0x4160, 0xF0040FF8, - 0x4164, 0x7F000000, - 0x4168, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x416C, 0x00008000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x416C, 0x00008002, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x416C, 0x00008002, -@@ -2371,6 +2876,10 @@ static const u32 rtw8822c_bb[] = { - 0x416C, 0x00008002, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x416C, 0x00008002, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x416C, 0x00008002, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x416C, 0x00008002, - 0xA0000000, 0x00000000, - 0x416C, 0x00008000, - 0xB0000000, 0x00000000, -@@ -2379,7 +2888,9 @@ static const u32 rtw8822c_bb[] = { - 0x4178, 0x00000000, - 0x417C, 0x00000000, - 0x4180, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x83000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x4184, 0x02B00000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x4184, 0x03B00000, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x4184, 0x03B00000, -@@ -2387,6 +2898,10 @@ static const u32 rtw8822c_bb[] = { - 0x4184, 0x03B00000, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x4184, 0x03B00000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x4184, 0x03B00000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x4184, 0x03B00000, - 0xA0000000, 0x00000000, - 0x4184, 0x02B00000, - 0xB0000000, 0x00000000, -@@ -2843,7 +3358,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x018, 0x00013124, - 0x093, 0x0008483F, - 0x0DE, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000B9140, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000B9140, -@@ -2861,6 +3380,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x08E, 0x000A5540, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000A5540, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000A5540, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -2875,17 +3396,39 @@ static const u32 rtw8822c_rf_a[] = { - 0x08E, 0x000A5540, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000A5540, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000A5540, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000A5540, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, - 0xA0000000, 0x00000000, - 0x08E, 0x000A5540, - 0xB0000000, 0x00000000, - 0x081, 0x0000FC01, - 0x081, 0x0002FC01, - 0x081, 0x0003FC01, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x085, 0x0006A06C, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x085, 0x0006A06C, -@@ -2903,6 +3446,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x085, 0x0006A06C, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x085, 0x0006A06C, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x085, 0x0006A06C, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -2917,14 +3462,50 @@ static const u32 rtw8822c_rf_a[] = { - 0x085, 0x0006A06C, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x085, 0x0006A06C, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x085, 0x0006A06C, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x085, 0x0006A06C, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x085, 0x0006A06C, - 0xA0000000, 0x00000000, - 0x085, 0x0006A06C, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000003F, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000003F, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000003F, -+ 0x0EE, 0x00000000, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000003F, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000003F, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000003F, -+ 0x0EE, 0x00000000, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x0EE, 0x00000010, - 0x033, 0x00000001, - 0x03F, 0x0000002A, -@@ -3005,6 +3586,15 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000002, - 0x03F, 0x0000002A, - 0x0EE, 0x00000000, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x0EE, 0x00000010, - 0x033, 0x00000001, -@@ -3068,6 +3658,15 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000002, - 0x03F, 0x0000002A, - 0x0EE, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x0EE, 0x00000010, - 0x033, 0x00000001, -@@ -3086,6 +3685,78 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000002, - 0x03F, 0x0000002A, - 0x0EE, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, - 0xA0000000, 0x00000000, - 0x0EE, 0x00000010, - 0x033, 0x00000001, -@@ -3096,7 +3767,59 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x0000003F, - 0x0EE, 0x00000000, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, - 0x03F, 0x000773C0, -@@ -3330,6 +4053,32 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, -@@ -3512,6 +4261,32 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, -@@ -3564,6 +4339,214 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0xA0000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, -@@ -3593,7 +4576,57 @@ static const u32 rtw8822c_rf_a[] = { - 0xB0000000, 0x00000000, - 0x033, 0x00000003, - 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000001B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000001B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, - 0x033, 0x0000001E, -@@ -3818,6 +4851,31 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, -@@ -3993,6 +5051,31 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, -@@ -4043,6 +5126,206 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, - 0xA0000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773E8, -@@ -4071,17 +5354,17 @@ static const u32 rtw8822c_rf_a[] = { - 0xB0000000, 0x00000000, - 0x033, 0x00000013, - 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000002F, -- 0x03F, 0x000773C0, -+ 0x03F, 0x000773E8, - 0x033, 0x0000002E, -- 0x03F, 0x000FF3C0, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000002D, -- 0x03F, 0x000773E8, -+ 0x03F, 0x00000380, - 0x033, 0x0000002C, -- 0x03F, 0x000FF3E8, -+ 0x03F, 0x000FF380, - 0x033, 0x0000002B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000300, - 0x033, 0x0000002A, - 0x03F, 0x000002A8, - 0x033, 0x00000029, -@@ -4096,17 +5379,17 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000002F, -- 0x03F, 0x000773C0, -+ 0x03F, 0x000773E8, - 0x033, 0x0000002E, -- 0x03F, 0x000FF3C0, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000002D, -- 0x03F, 0x000773E8, -+ 0x03F, 0x00000380, - 0x033, 0x0000002C, -- 0x03F, 0x000FF3E8, -+ 0x03F, 0x000FF380, - 0x033, 0x0000002B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000300, - 0x033, 0x0000002A, - 0x03F, 0x000002A8, - 0x033, 0x00000029, -@@ -4121,7 +5404,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000002F, - 0x03F, 0x000773C0, - 0x033, 0x0000002E, -@@ -4146,7 +5429,57 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000002F, - 0x03F, 0x000773C0, - 0x033, 0x0000002E, -@@ -4296,6 +5629,31 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000002F, - 0x03F, 0x000773C0, -@@ -4471,6 +5829,31 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000002F, - 0x03F, 0x000773C0, -@@ -4521,6 +5904,206 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, - 0xA0000000, 0x00000000, - 0x033, 0x0000002F, - 0x03F, 0x000773E8, -@@ -4549,17 +6132,17 @@ static const u32 rtw8822c_rf_a[] = { - 0xB0000000, 0x00000000, - 0x033, 0x00000023, - 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, -- 0x03F, 0x000773C0, -+ 0x03F, 0x000773E8, - 0x033, 0x0000003E, -- 0x03F, 0x000FF3C0, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000003D, -- 0x03F, 0x000773E8, -+ 0x03F, 0x00000380, - 0x033, 0x0000003C, -- 0x03F, 0x000FF3E8, -+ 0x03F, 0x000FF380, - 0x033, 0x0000003B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000300, - 0x033, 0x0000003A, - 0x03F, 0x000002A8, - 0x033, 0x00000039, -@@ -4574,17 +6157,17 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, -- 0x03F, 0x000773C0, -+ 0x03F, 0x000773E8, - 0x033, 0x0000003E, -- 0x03F, 0x000FF3C0, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000003D, -- 0x03F, 0x000773E8, -+ 0x03F, 0x00000380, - 0x033, 0x0000003C, -- 0x03F, 0x000FF3E8, -+ 0x03F, 0x000FF380, - 0x033, 0x0000003B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000300, - 0x033, 0x0000003A, - 0x03F, 0x000002A8, - 0x033, 0x00000039, -@@ -4599,7 +6182,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4624,7 +6207,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4649,7 +6232,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4674,7 +6257,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4699,7 +6282,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4709,11 +6292,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000003B, -- 0x03F, 0x00000287, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000003A, - 0x03F, 0x000002A8, - 0x033, 0x00000039, -- 0x03F, 0x00000207, -+ 0x03F, 0x00000280, - 0x033, 0x00000038, - 0x03F, 0x000FF280, - 0x033, 0x00000037, -@@ -4724,7 +6307,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4734,11 +6317,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000003B, -- 0x03F, 0x00000287, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000003A, - 0x03F, 0x000002A8, - 0x033, 0x00000039, -- 0x03F, 0x00000207, -+ 0x03F, 0x00000280, - 0x033, 0x00000038, - 0x03F, 0x000FF280, - 0x033, 0x00000037, -@@ -4749,7 +6332,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4759,11 +6342,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000003B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000003A, - 0x03F, 0x000002A8, - 0x033, 0x00000039, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000038, - 0x03F, 0x000FF280, - 0x033, 0x00000037, -@@ -4774,7 +6357,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4799,7 +6382,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4809,11 +6392,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000003B, -- 0x03F, 0x00000287, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000003A, - 0x03F, 0x000002A8, - 0x033, 0x00000039, -- 0x03F, 0x00000207, -+ 0x03F, 0x00000280, - 0x033, 0x00000038, - 0x03F, 0x000FF280, - 0x033, 0x00000037, -@@ -4824,7 +6407,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4849,7 +6432,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4859,11 +6442,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000003B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000003A, - 0x03F, 0x000002A8, - 0x033, 0x00000039, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000038, - 0x03F, 0x000FF280, - 0x033, 0x00000037, -@@ -4874,7 +6457,82 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -4949,6 +6607,31 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, -@@ -4999,6 +6682,206 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, - 0xA0000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773E8, -@@ -5027,7 +6910,57 @@ static const u32 rtw8822c_rf_a[] = { - 0xB0000000, 0x00000000, - 0x033, 0x00000033, - 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -5252,6 +7185,31 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000004B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, -@@ -5427,7 +7385,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -5437,11 +7395,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000004B, -- 0x03F, 0x00000287, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000004A, - 0x03F, 0x000002A8, - 0x033, 0x00000049, -- 0x03F, 0x00000207, -+ 0x03F, 0x00000280, - 0x033, 0x00000048, - 0x03F, 0x000FF280, - 0x033, 0x00000047, -@@ -5452,7 +7410,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -5477,21 +7435,21 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0xA0000000, 0x00000000, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, -- 0x03F, 0x000773E8, -+ 0x03F, 0x000773C0, - 0x033, 0x0000004E, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x000FF3C0, - 0x033, 0x0000004D, -- 0x03F, 0x00000380, -+ 0x03F, 0x000773E8, - 0x033, 0x0000004C, -- 0x03F, 0x000FF380, -+ 0x03F, 0x000FF3E8, - 0x033, 0x0000004B, -- 0x03F, 0x00000300, -+ 0x03F, 0x00000287, - 0x033, 0x0000004A, - 0x03F, 0x000002A8, - 0x033, 0x00000049, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000048, - 0x03F, 0x000FF280, - 0x033, 0x00000047, -@@ -5502,127 +7460,402 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000043, -- 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000005F, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000005E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000005D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000005C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000005B, -+ 0x033, 0x0000004B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000005A, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000059, -+ 0x033, 0x00000049, - 0x03F, 0x00000280, -- 0x033, 0x00000058, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000057, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000056, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000055, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000054, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000005F, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000005E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000005D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000005C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000005B, -+ 0x033, 0x0000004B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000005A, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000059, -+ 0x033, 0x00000049, - 0x03F, 0x00000280, -- 0x033, 0x00000058, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000057, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000056, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000055, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000054, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000005F, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000005E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000005D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000005C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000005B, -- 0x03F, 0x000FF3A0, -- 0x033, 0x0000005A, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000059, -- 0x03F, 0x00000280, -- 0x033, 0x00000058, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000057, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000056, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000055, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000054, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000005F, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000005E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000005D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000005C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000005B, -- 0x03F, 0x000FF3A0, -- 0x033, 0x0000005A, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000059, -- 0x03F, 0x00000280, -- 0x033, 0x00000058, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000057, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000056, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000055, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000054, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000005F, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000005E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000005D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000005C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000005B, -+ 0x033, 0x0000004B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000005A, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000059, -+ 0x033, 0x00000049, - 0x03F, 0x00000280, -- 0x033, 0x00000058, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000057, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000004B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0xA0000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0xB0000000, 0x00000000, -+ 0x033, 0x00000043, -+ 0x03F, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000005B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000005B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, - 0x03F, 0x00000200, - 0x033, 0x00000056, - 0x03F, 0x000001C0, -@@ -5730,6 +7963,31 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, -@@ -5905,6 +8163,31 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, -@@ -5955,17 +8238,117 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0xA0000000, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, - 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, - 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, - 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, - 0x033, 0x0000005D, -- 0x03F, 0x00000380, -+ 0x03F, 0x000773E8, - 0x033, 0x0000005C, -- 0x03F, 0x000FF380, -+ 0x03F, 0x000FF3E8, - 0x033, 0x0000005B, -- 0x03F, 0x00000300, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000005A, - 0x03F, 0x000002A8, - 0x033, 0x00000059, -@@ -5980,96 +8363,220 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000053, -- 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0xA0000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0xB0000000, 0x00000000, -- 0x08A, 0x000E7DE3, -- 0x08B, 0x0008FE00, -- 0x0EE, 0x00000008, -- 0x033, 0x00000000, -- 0x03F, 0x00000023, -- 0x033, 0x00000001, -- 0x03F, 0x00000023, -- 0x0EE, 0x00000000, -- 0x0EF, 0x00004000, -- 0x033, 0x00000000, -- 0x03F, 0x0000000F, -- 0x033, 0x00000002, -- 0x03F, 0x00000000, -- 0x0EF, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00020000, -- 0x033, 0x00000000, -- 0x03E, 0x00001C86, -- 0x03F, 0x00020000, -- 0x033, 0x00000001, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x00000002, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x00000003, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x00000004, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x00000005, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x00000006, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x00000007, -- 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -- 0x033, 0x00000008, -- 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -- 0x033, 0x00000009, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x0000000A, -- 0x03E, 0x00000F02, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0xA0000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000005B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0xB0000000, 0x00000000, -+ 0x033, 0x00000053, -+ 0x03F, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x08A, 0x000E7DE3, -+ 0x08B, 0x0008FE00, -+ 0x0EE, 0x00000008, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000023, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000023, -+ 0x0EE, 0x00000000, -+ 0x0EF, 0x00004000, -+ 0x033, 0x00000000, -+ 0x03F, 0x0000000F, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, - 0x03F, 0x00020000, - 0x033, 0x0000000B, - 0x03E, 0x00000F00, -@@ -6085,9 +8592,9 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00020000, - 0x033, 0x0000000F, - 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -+ 0x03F, 0x0002C010, - 0x033, 0x00000010, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000011, - 0x03E, 0x00001C02, -@@ -6111,7 +8618,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000018, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000019, - 0x03E, 0x00001C02, -@@ -6135,7 +8642,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000020, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000021, - 0x03E, 0x00001C02, -@@ -6159,7 +8666,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000028, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000029, - 0x03E, 0x00001C02, -@@ -6183,10 +8690,10 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000001, - 0x03E, 0x00001C02, -@@ -6208,10 +8715,10 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00020000, - 0x033, 0x00000007, - 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -+ 0x03F, 0x0002C010, - 0x033, 0x00000008, -- 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, - 0x033, 0x00000009, - 0x03E, 0x00001C02, - 0x03F, 0x00020000, -@@ -6232,9 +8739,9 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00020000, - 0x033, 0x0000000F, - 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -+ 0x03F, 0x0002C010, - 0x033, 0x00000010, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000011, - 0x03E, 0x00001C02, -@@ -6258,7 +8765,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000018, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000019, - 0x03E, 0x00001C02, -@@ -6282,7 +8789,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000020, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000021, - 0x03E, 0x00001C02, -@@ -6306,7 +8813,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000028, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000029, - 0x03E, 0x00001C02, -@@ -6330,7 +8837,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -6477,7 +8984,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -6624,7 +9131,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -6771,7 +9278,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -6918,7 +9425,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -7065,7 +9572,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -7212,7 +9719,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -7359,7 +9866,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -7506,7 +10013,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -7653,7 +10160,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -7800,7 +10307,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -7947,7 +10454,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -8094,7 +10601,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -8241,7 +10748,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -8388,7 +10895,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -8535,7 +11042,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -8682,10 +11189,10 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0xA0000000, 0x00000000, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, -- 0x03E, 0x00001910, -+ 0x03E, 0x00001C86, - 0x03F, 0x00020000, - 0x033, 0x00000001, - 0x03E, 0x00001C02, -@@ -8707,10 +11214,10 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00020000, - 0x033, 0x00000007, - 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -+ 0x03F, 0x0002F81C, - 0x033, 0x00000008, -- 0x03E, 0x00001910, -- 0x03F, 0x00020000, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, - 0x033, 0x00000009, - 0x03E, 0x00001C02, - 0x03F, 0x00020000, -@@ -8731,9 +11238,156 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00020000, - 0x033, 0x0000000F, - 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, - 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, - 0x033, 0x00000010, -- 0x03E, 0x00001910, -+ 0x03E, 0x00001C86, - 0x03F, 0x00020000, - 0x033, 0x00000011, - 0x03E, 0x00001C02, -@@ -8757,7 +11411,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000018, -- 0x03E, 0x00001910, -+ 0x03E, 0x00001C86, - 0x03F, 0x00020000, - 0x033, 0x00000019, - 0x03E, 0x00001C02, -@@ -8781,7 +11435,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000020, -- 0x03E, 0x00001910, -+ 0x03E, 0x00001C86, - 0x03F, 0x00020000, - 0x033, 0x00000021, - 0x03E, 0x00001C02, -@@ -8805,7 +11459,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000028, -- 0x03E, 0x00001910, -+ 0x03E, 0x00001C86, - 0x03F, 0x00020000, - 0x033, 0x00000029, - 0x03E, 0x00001C02, -@@ -8829,216 +11483,2478 @@ static const u32 rtw8822c_rf_a[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0xB0000000, 0x00000000, -- 0x0FE, 0x00000000, -- 0x01B, 0x00003A40, -- 0x061, 0x0000D233, -- 0x062, 0x0004D232, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -- 0xA0000000, 0x00000000, -- 0x063, 0x00000C02, -- 0xB0000000, 0x00000000, -- 0x0EF, 0x00000200, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000237, -- 0x030, 0x00001237, -- 0x030, 0x00002237, -- 0x030, 0x00003237, -- 0x030, 0x00004207, -- 0x030, 0x00005237, -- 0x030, 0x00006237, -- 0x030, 0x00007237, -- 0x030, 0x00008207, -- 0x030, 0x00009237, -- 0x030, 0x0000A237, -- 0x030, 0x0000B237, -- 0x030, 0x0000C237, -- 0x030, 0x0000D237, -- 0x030, 0x0000E207, -- 0x030, 0x0000F237, -- 0x030, 0x00010237, -- 0x030, 0x00011237, -- 0x030, 0x00012207, -- 0x030, 0x00013237, -- 0x030, 0x00014237, -- 0x030, 0x00015237, -- 0x030, 0x00016207, -- 0x030, 0x00017237, -- 0x030, 0x00018207, -- 0x030, 0x00019237, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000237, -- 0x030, 0x00001237, -- 0x030, 0x00002237, -- 0x030, 0x00003237, -- 0x030, 0x00004207, -- 0x030, 0x00005237, -- 0x030, 0x00006237, -- 0x030, 0x00007237, -- 0x030, 0x00008207, -- 0x030, 0x00009237, -- 0x030, 0x0000A237, -- 0x030, 0x0000B237, -- 0x030, 0x0000C237, -- 0x030, 0x0000D237, -- 0x030, 0x0000E207, -- 0x030, 0x0000F237, -- 0x030, 0x00010237, -- 0x030, 0x00011237, -- 0x030, 0x00012207, -- 0x030, 0x00013237, -- 0x030, 0x00014237, -- 0x030, 0x00015237, -- 0x030, 0x00016207, -- 0x030, 0x00017237, -- 0x030, 0x00018207, -- 0x030, 0x00019237, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000237, -- 0x030, 0x00001237, -- 0x030, 0x00002237, -- 0x030, 0x00003237, -- 0x030, 0x00004207, -- 0x030, 0x00005237, -- 0x030, 0x00006237, -- 0x030, 0x00007237, -- 0x030, 0x00008207, -- 0x030, 0x00009237, -- 0x030, 0x0000A237, -- 0x030, 0x0000B237, -- 0x030, 0x0000C237, -- 0x030, 0x0000D237, -- 0x030, 0x0000E207, -- 0x030, 0x0000F237, -- 0x030, 0x00010237, -- 0x030, 0x00011237, -- 0x030, 0x00012207, -- 0x030, 0x00013237, -- 0x030, 0x00014237, -- 0x030, 0x00015237, -- 0x030, 0x00016207, -- 0x030, 0x00017237, -- 0x030, 0x00018207, -- 0x030, 0x00019237, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000237, -- 0x030, 0x00001237, -- 0x030, 0x00002237, -- 0x030, 0x00003237, -- 0x030, 0x00004207, -- 0x030, 0x00005237, -- 0x030, 0x00006237, -- 0x030, 0x00007237, -- 0x030, 0x00008207, -- 0x030, 0x00009237, -- 0x030, 0x0000A237, -- 0x030, 0x0000B237, -- 0x030, 0x0000C237, -- 0x030, 0x0000D237, -- 0x030, 0x0000E207, -- 0x030, 0x0000F237, -- 0x030, 0x00010237, -- 0x030, 0x00011237, -- 0x030, 0x00012207, -- 0x030, 0x00013237, -- 0x030, 0x00014237, -- 0x030, 0x00015237, -- 0x030, 0x00016207, -- 0x030, 0x00017237, -- 0x030, 0x00018207, -- 0x030, 0x00019237, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x01B, 0x00003A40, -+ 0x061, 0x0000D233, -+ 0x062, 0x0004D232, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000C02, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000C02, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0xA0000000, 0x00000000, -+ 0x063, 0x00000C02, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000200, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000233, -+ 0x030, 0x00001233, -+ 0x030, 0x00002233, -+ 0x030, 0x00003233, -+ 0x030, 0x00004203, -+ 0x030, 0x00005233, -+ 0x030, 0x00006233, -+ 0x030, 0x00007233, -+ 0x030, 0x00008203, -+ 0x030, 0x00009233, -+ 0x030, 0x0000A233, -+ 0x030, 0x0000B233, -+ 0x030, 0x0000C233, -+ 0x030, 0x0000D233, -+ 0x030, 0x0000E203, -+ 0x030, 0x0000F233, -+ 0x030, 0x00010233, -+ 0x030, 0x00011233, -+ 0x030, 0x00012203, -+ 0x030, 0x00013233, -+ 0x030, 0x00014233, -+ 0x030, 0x00015233, -+ 0x030, 0x00016203, -+ 0x030, 0x00017233, -+ 0x030, 0x00018203, -+ 0x030, 0x00019233, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000233, -+ 0x030, 0x00001233, -+ 0x030, 0x00002233, -+ 0x030, 0x00003233, -+ 0x030, 0x00004203, -+ 0x030, 0x00005233, -+ 0x030, 0x00006233, -+ 0x030, 0x00007233, -+ 0x030, 0x00008203, -+ 0x030, 0x00009233, -+ 0x030, 0x0000A233, -+ 0x030, 0x0000B233, -+ 0x030, 0x0000C233, -+ 0x030, 0x0000D233, -+ 0x030, 0x0000E203, -+ 0x030, 0x0000F233, -+ 0x030, 0x00010233, -+ 0x030, 0x00011233, -+ 0x030, 0x00012203, -+ 0x030, 0x00013233, -+ 0x030, 0x00014233, -+ 0x030, 0x00015233, -+ 0x030, 0x00016203, -+ 0x030, 0x00017233, -+ 0x030, 0x00018203, -+ 0x030, 0x00019233, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000237, -+ 0x030, 0x00001237, -+ 0x030, 0x00002237, -+ 0x030, 0x00003237, -+ 0x030, 0x00004207, -+ 0x030, 0x00005237, -+ 0x030, 0x00006237, -+ 0x030, 0x00007237, -+ 0x030, 0x00008207, -+ 0x030, 0x00009237, -+ 0x030, 0x0000A237, -+ 0x030, 0x0000B237, -+ 0x030, 0x0000C237, -+ 0x030, 0x0000D237, -+ 0x030, 0x0000E207, -+ 0x030, 0x0000F237, -+ 0x030, 0x00010237, -+ 0x030, 0x00011237, -+ 0x030, 0x00012207, -+ 0x030, 0x00013237, -+ 0x030, 0x00014237, -+ 0x030, 0x00015237, -+ 0x030, 0x00016207, -+ 0x030, 0x00017237, -+ 0x030, 0x00018207, -+ 0x030, 0x00019237, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000237, -+ 0x030, 0x00001237, -+ 0x030, 0x00002237, -+ 0x030, 0x00003237, -+ 0x030, 0x00004207, -+ 0x030, 0x00005237, -+ 0x030, 0x00006237, -+ 0x030, 0x00007237, -+ 0x030, 0x00008207, -+ 0x030, 0x00009237, -+ 0x030, 0x0000A237, -+ 0x030, 0x0000B237, -+ 0x030, 0x0000C237, -+ 0x030, 0x0000D237, -+ 0x030, 0x0000E207, -+ 0x030, 0x0000F237, -+ 0x030, 0x00010237, -+ 0x030, 0x00011237, -+ 0x030, 0x00012207, -+ 0x030, 0x00013237, -+ 0x030, 0x00014237, -+ 0x030, 0x00015237, -+ 0x030, 0x00016207, -+ 0x030, 0x00017237, -+ 0x030, 0x00018207, -+ 0x030, 0x00019237, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000237, -+ 0x030, 0x00001237, -+ 0x030, 0x00002237, -+ 0x030, 0x00003237, -+ 0x030, 0x00004207, -+ 0x030, 0x00005237, -+ 0x030, 0x00006237, -+ 0x030, 0x00007237, -+ 0x030, 0x00008207, -+ 0x030, 0x00009237, -+ 0x030, 0x0000A237, -+ 0x030, 0x0000B237, -+ 0x030, 0x0000C237, -+ 0x030, 0x0000D237, -+ 0x030, 0x0000E207, -+ 0x030, 0x0000F237, -+ 0x030, 0x00010237, -+ 0x030, 0x00011237, -+ 0x030, 0x00012207, -+ 0x030, 0x00013237, -+ 0x030, 0x00014237, -+ 0x030, 0x00015237, -+ 0x030, 0x00016207, -+ 0x030, 0x00017237, -+ 0x030, 0x00018207, -+ 0x030, 0x00019237, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000237, -+ 0x030, 0x00001237, -+ 0x030, 0x00002237, -+ 0x030, 0x00003237, -+ 0x030, 0x00004207, -+ 0x030, 0x00005237, -+ 0x030, 0x00006237, -+ 0x030, 0x00007237, -+ 0x030, 0x00008207, -+ 0x030, 0x00009237, -+ 0x030, 0x0000A237, -+ 0x030, 0x0000B237, -+ 0x030, 0x0000C237, -+ 0x030, 0x0000D237, -+ 0x030, 0x0000E207, -+ 0x030, 0x0000F237, -+ 0x030, 0x00010237, -+ 0x030, 0x00011237, -+ 0x030, 0x00012207, -+ 0x030, 0x00013237, -+ 0x030, 0x00014237, -+ 0x030, 0x00015237, -+ 0x030, 0x00016207, -+ 0x030, 0x00017237, -+ 0x030, 0x00018207, -+ 0x030, 0x00019237, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, - 0x030, 0x00002239, - 0x030, 0x00003239, - 0x030, 0x00004239, -@@ -9063,827 +13979,2362 @@ static const u32 rtw8822c_rf_a[] = { - 0x030, 0x00017239, - 0x030, 0x00018209, - 0x030, 0x00019239, -+ 0xA0000000, 0x00000000, -+ 0x030, 0x00000233, -+ 0x030, 0x00001233, -+ 0x030, 0x00002233, -+ 0x030, 0x00003233, -+ 0x030, 0x00004203, -+ 0x030, 0x00005233, -+ 0x030, 0x00006233, -+ 0x030, 0x00007233, -+ 0x030, 0x00008203, -+ 0x030, 0x00009233, -+ 0x030, 0x0000A233, -+ 0x030, 0x0000B233, -+ 0x030, 0x0000C233, -+ 0x030, 0x0000D233, -+ 0x030, 0x0000E203, -+ 0x030, 0x0000F233, -+ 0x030, 0x00010233, -+ 0x030, 0x00011233, -+ 0x030, 0x00012203, -+ 0x030, 0x00013233, -+ 0x030, 0x00014233, -+ 0x030, 0x00015233, -+ 0x030, 0x00016203, -+ 0x030, 0x00017233, -+ 0x030, 0x00018203, -+ 0x030, 0x00019233, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000080, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000232, -+ 0x030, 0x00001232, -+ 0x030, 0x00002232, -+ 0x030, 0x00003232, -+ 0x030, 0x00004232, -+ 0x030, 0x00005232, -+ 0x030, 0x00006232, -+ 0x030, 0x00007232, -+ 0x030, 0x00008232, -+ 0x030, 0x00009232, -+ 0x030, 0x0000A232, -+ 0x030, 0x0000B232, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000232, -+ 0x030, 0x00001232, -+ 0x030, 0x00002232, -+ 0x030, 0x00003232, -+ 0x030, 0x00004232, -+ 0x030, 0x00005232, -+ 0x030, 0x00006232, -+ 0x030, 0x00007232, -+ 0x030, 0x00008232, -+ 0x030, 0x00009232, -+ 0x030, 0x0000A232, -+ 0x030, 0x0000B232, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0xA0000000, 0x00000000, -+ 0x030, 0x00000232, -+ 0x030, 0x00001232, -+ 0x030, 0x00002232, -+ 0x030, 0x00003232, -+ 0x030, 0x00004232, -+ 0x030, 0x00005232, -+ 0x030, 0x00006232, -+ 0x030, 0x00007232, -+ 0x030, 0x00008232, -+ 0x030, 0x00009232, -+ 0x030, 0x0000A232, -+ 0x030, 0x0000B232, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000040, -+ 0x030, 0x00000770, -+ 0x030, 0x00001770, -+ 0x030, 0x00002440, -+ 0x030, 0x00003440, -+ 0x030, 0x00004330, -+ 0x030, 0x00005330, -+ 0x030, 0x00008770, -+ 0x030, 0x0000A440, -+ 0x030, 0x0000C330, -+ 0x0EF, 0x00000000, -+ 0x0EE, 0x00010000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, - 0xA0000000, 0x00000000, -- 0x030, 0x00000233, -- 0x030, 0x00001233, -- 0x030, 0x00002233, -- 0x030, 0x00003233, -- 0x030, 0x00004203, -- 0x030, 0x00005233, -- 0x030, 0x00006233, -- 0x030, 0x00007233, -- 0x030, 0x00008203, -- 0x030, 0x00009233, -- 0x030, 0x0000A233, -- 0x030, 0x0000B233, -- 0x030, 0x0000C233, -- 0x030, 0x0000D233, -- 0x030, 0x0000E203, -- 0x030, 0x0000F233, -- 0x030, 0x00010233, -- 0x030, 0x00011233, -- 0x030, 0x00012203, -- 0x030, 0x00013233, -- 0x030, 0x00014233, -- 0x030, 0x00015233, -- 0x030, 0x00016203, -- 0x030, 0x00017233, -- 0x030, 0x00018203, -- 0x030, 0x00019233, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0xB0000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x0EF, 0x00000080, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000281, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000284, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000285, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000286, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000287, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000077, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000281, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000284, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000285, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000286, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000287, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000077, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0xA0000000, 0x00000000, -- 0x030, 0x00000232, -- 0x030, 0x00001232, -- 0x030, 0x00002232, -- 0x030, 0x00003232, -- 0x030, 0x00004232, -- 0x030, 0x00005232, -- 0x030, 0x00006232, -- 0x030, 0x00007232, -- 0x030, 0x00008232, -- 0x030, 0x00009232, -- 0x030, 0x0000A232, -- 0x030, 0x0000B232, -- 0xB0000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x0EF, 0x00000040, -- 0x030, 0x00000770, -- 0x030, 0x00001770, -- 0x030, 0x00002440, -- 0x030, 0x00003440, -- 0x030, 0x00004330, -- 0x030, 0x00005330, -- 0x030, 0x00008770, -- 0x030, 0x0000A440, -- 0x030, 0x0000C330, -- 0x0EF, 0x00000000, -- 0x0EE, 0x00010000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000200, -+ 0x033, 0x00000280, - 0x03F, 0x00000005, -- 0x033, 0x00000201, -+ 0x033, 0x00000281, - 0x03F, 0x00000008, -- 0x033, 0x00000202, -+ 0x033, 0x00000282, - 0x03F, 0x0000000B, -- 0x033, 0x00000203, -+ 0x033, 0x00000283, - 0x03F, 0x0000000E, -- 0x033, 0x00000204, -+ 0x033, 0x00000284, - 0x03F, 0x0000002B, -- 0x033, 0x00000205, -+ 0x033, 0x00000285, - 0x03F, 0x0000002E, -- 0x033, 0x00000206, -+ 0x033, 0x00000286, - 0x03F, 0x0000006B, -- 0x033, 0x00000207, -+ 0x033, 0x00000287, - 0x03F, 0x0000006E, -- 0x033, 0x00000208, -+ 0x033, 0x00000288, - 0x03F, 0x00000071, -- 0x033, 0x00000209, -+ 0x033, 0x00000289, - 0x03F, 0x00000074, -- 0x033, 0x0000020A, -+ 0x033, 0x0000028A, - 0x03F, 0x00000077, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000200, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, - 0x03F, 0x00000005, -- 0x033, 0x00000201, -+ 0x033, 0x00000281, - 0x03F, 0x00000008, -- 0x033, 0x00000202, -+ 0x033, 0x00000282, - 0x03F, 0x0000000B, -- 0x033, 0x00000203, -+ 0x033, 0x00000283, - 0x03F, 0x0000000E, -- 0x033, 0x00000204, -+ 0x033, 0x00000284, - 0x03F, 0x0000002B, -- 0x033, 0x00000205, -+ 0x033, 0x00000285, - 0x03F, 0x0000002E, -- 0x033, 0x00000206, -+ 0x033, 0x00000286, - 0x03F, 0x0000006B, -- 0x033, 0x00000207, -+ 0x033, 0x00000287, - 0x03F, 0x0000006E, -- 0x033, 0x00000208, -+ 0x033, 0x00000288, - 0x03F, 0x00000071, -- 0x033, 0x00000209, -+ 0x033, 0x00000289, - 0x03F, 0x00000074, -- 0x033, 0x0000020A, -+ 0x033, 0x0000028A, - 0x03F, 0x00000077, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000200, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, - 0x03F, 0x00000005, -- 0x033, 0x00000201, -+ 0x033, 0x00000281, - 0x03F, 0x00000008, -- 0x033, 0x00000202, -+ 0x033, 0x00000282, - 0x03F, 0x0000000B, -- 0x033, 0x00000203, -+ 0x033, 0x00000283, - 0x03F, 0x0000000E, -- 0x033, 0x00000204, -+ 0x033, 0x00000284, - 0x03F, 0x0000002B, -- 0x033, 0x00000205, -+ 0x033, 0x00000285, - 0x03F, 0x0000002E, -- 0x033, 0x00000206, -+ 0x033, 0x00000286, - 0x03F, 0x0000006B, -- 0x033, 0x00000207, -+ 0x033, 0x00000287, - 0x03F, 0x0000006E, -- 0x033, 0x00000208, -+ 0x033, 0x00000288, - 0x03F, 0x00000071, -- 0x033, 0x00000209, -+ 0x033, 0x00000289, - 0x03F, 0x00000074, -- 0x033, 0x0000020A, -+ 0x033, 0x0000028A, - 0x03F, 0x00000077, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000200, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, - 0x03F, 0x00000005, -- 0x033, 0x00000201, -+ 0x033, 0x00000281, - 0x03F, 0x00000008, -- 0x033, 0x00000202, -+ 0x033, 0x00000282, - 0x03F, 0x0000000B, -- 0x033, 0x00000203, -+ 0x033, 0x00000283, - 0x03F, 0x0000000E, -- 0x033, 0x00000204, -+ 0x033, 0x00000284, - 0x03F, 0x0000002B, -- 0x033, 0x00000205, -+ 0x033, 0x00000285, - 0x03F, 0x0000002E, -- 0x033, 0x00000206, -+ 0x033, 0x00000286, - 0x03F, 0x0000006B, -- 0x033, 0x00000207, -+ 0x033, 0x00000287, - 0x03F, 0x0000006E, -- 0x033, 0x00000208, -+ 0x033, 0x00000288, - 0x03F, 0x00000071, -- 0x033, 0x00000209, -+ 0x033, 0x00000289, - 0x03F, 0x00000074, -- 0x033, 0x0000020A, -+ 0x033, 0x0000028A, - 0x03F, 0x00000077, - 0xA0000000, 0x00000000, -- 0x033, 0x00000200, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0xB0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, - 0x03F, 0x0000006A, -- 0x033, 0x00000201, -+ 0x033, 0x00000301, - 0x03F, 0x0000006D, -- 0x033, 0x00000202, -+ 0x033, 0x00000302, - 0x03F, 0x0000046A, -- 0x033, 0x00000203, -+ 0x033, 0x00000303, - 0x03F, 0x0000086A, -- 0x033, 0x00000204, -+ 0x033, 0x00000304, - 0x03F, 0x00000C89, -- 0x033, 0x00000205, -+ 0x033, 0x00000305, - 0x03F, 0x00000CE8, -- 0x033, 0x00000206, -+ 0x033, 0x00000306, - 0x03F, 0x00000CEB, -- 0x033, 0x00000207, -+ 0x033, 0x00000307, - 0x03F, 0x00000CEE, -- 0x033, 0x00000208, -+ 0x033, 0x00000308, - 0x03F, 0x00000CF1, -- 0x033, 0x00000209, -+ 0x033, 0x00000309, - 0x03F, 0x00000CF4, -- 0x033, 0x0000020A, -+ 0x033, 0x0000030A, - 0x03F, 0x00000CF7, -- 0xB0000000, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000280, -+ 0x0EE, 0x00000000, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, - 0x03F, 0x00000005, -- 0x033, 0x00000281, -+ 0x033, 0x00000301, - 0x03F, 0x00000008, -- 0x033, 0x00000282, -+ 0x033, 0x00000302, - 0x03F, 0x0000000B, -- 0x033, 0x00000283, -+ 0x033, 0x00000303, - 0x03F, 0x0000000E, -- 0x033, 0x00000284, -+ 0x033, 0x00000304, - 0x03F, 0x0000002B, -- 0x033, 0x00000285, -+ 0x033, 0x00000305, - 0x03F, 0x0000002E, -- 0x033, 0x00000286, -- 0x03F, 0x0000006B, -- 0x033, 0x00000287, -- 0x03F, 0x0000006E, -- 0x033, 0x00000288, -- 0x03F, 0x00000071, -- 0x033, 0x00000289, -- 0x03F, 0x00000074, -- 0x033, 0x0000028A, -- 0x03F, 0x00000077, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000031, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000034, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000053, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000056, -+ 0x033, 0x0000030A, -+ 0x03F, 0x000000D1, -+ 0x0EE, 0x00000000, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000280, -- 0x03F, 0x00000005, -- 0x033, 0x00000281, -- 0x03F, 0x00000008, -- 0x033, 0x00000282, -- 0x03F, 0x0000000B, -- 0x033, 0x00000283, -- 0x03F, 0x0000000E, -- 0x033, 0x00000284, -- 0x03F, 0x0000002B, -- 0x033, 0x00000285, -- 0x03F, 0x0000002E, -- 0x033, 0x00000286, -- 0x03F, 0x0000006B, -- 0x033, 0x00000287, -- 0x03F, 0x0000006E, -- 0x033, 0x00000288, -- 0x03F, 0x00000071, -- 0x033, 0x00000289, -- 0x03F, 0x00000074, -- 0x033, 0x0000028A, -- 0x03F, 0x00000077, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000280, -- 0x03F, 0x00000005, -- 0x033, 0x00000281, -- 0x03F, 0x00000008, -- 0x033, 0x00000282, -- 0x03F, 0x0000000B, -- 0x033, 0x00000283, -- 0x03F, 0x0000000E, -- 0x033, 0x00000284, -- 0x03F, 0x0000002B, -- 0x033, 0x00000285, -- 0x03F, 0x0000002E, -- 0x033, 0x00000286, -- 0x03F, 0x0000006B, -- 0x033, 0x00000287, -- 0x03F, 0x0000006E, -- 0x033, 0x00000288, -- 0x03F, 0x00000071, -- 0x033, 0x00000289, -- 0x03F, 0x00000074, -- 0x033, 0x0000028A, -- 0x03F, 0x00000077, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000280, -+ 0x033, 0x00000300, - 0x03F, 0x00000005, -- 0x033, 0x00000281, -+ 0x033, 0x00000301, - 0x03F, 0x00000008, -- 0x033, 0x00000282, -+ 0x033, 0x00000302, - 0x03F, 0x0000000B, -- 0x033, 0x00000283, -+ 0x033, 0x00000303, - 0x03F, 0x0000000E, -- 0x033, 0x00000284, -+ 0x033, 0x00000304, - 0x03F, 0x0000002B, -- 0x033, 0x00000285, -+ 0x033, 0x00000305, - 0x03F, 0x0000002E, -- 0x033, 0x00000286, -- 0x03F, 0x0000006B, -- 0x033, 0x00000287, -- 0x03F, 0x0000006E, -- 0x033, 0x00000288, -- 0x03F, 0x00000071, -- 0x033, 0x00000289, -- 0x03F, 0x00000074, -- 0x033, 0x0000028A, -- 0x03F, 0x00000077, -- 0xA0000000, 0x00000000, -- 0x033, 0x00000280, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000031, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000034, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000053, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000056, -+ 0x033, 0x0000030A, -+ 0x03F, 0x000000D1, -+ 0x0EE, 0x00000000, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, - 0x03F, 0x0000006A, -- 0x033, 0x00000281, -+ 0x033, 0x00000301, - 0x03F, 0x0000006D, -- 0x033, 0x00000282, -+ 0x033, 0x00000302, - 0x03F, 0x0000046A, -- 0x033, 0x00000283, -+ 0x033, 0x00000303, - 0x03F, 0x0000086A, -- 0x033, 0x00000284, -+ 0x033, 0x00000304, - 0x03F, 0x00000C89, -- 0x033, 0x00000285, -+ 0x033, 0x00000305, - 0x03F, 0x00000CE8, -- 0x033, 0x00000286, -+ 0x033, 0x00000306, - 0x03F, 0x00000CEB, -- 0x033, 0x00000287, -+ 0x033, 0x00000307, - 0x03F, 0x00000CEE, -- 0x033, 0x00000288, -+ 0x033, 0x00000308, - 0x03F, 0x00000CF1, -- 0x033, 0x00000289, -+ 0x033, 0x00000309, - 0x03F, 0x00000CF4, -- 0x033, 0x0000028A, -+ 0x033, 0x0000030A, - 0x03F, 0x00000CF7, -- 0xB0000000, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000000, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000300, - 0x03F, 0x00000005, - 0x033, 0x00000301, -@@ -9907,7 +16358,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x0000030A, - 0x03F, 0x000000D1, - 0x0EE, 0x00000000, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000300, - 0x03F, 0x00000005, - 0x033, 0x00000301, -@@ -9931,7 +16382,151 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x0000030A, - 0x03F, 0x000000D1, - 0x0EE, 0x00000000, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000300, - 0x03F, 0x00000005, - 0x033, 0x00000301, -@@ -9955,7 +16550,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x0000030A, - 0x03F, 0x000000D1, - 0x0EE, 0x00000000, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000300, - 0x03F, 0x00000005, - 0x033, 0x00000301, -@@ -10005,7 +16600,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x0EE, 0x00000000, - 0xB0000000, 0x00000000, - 0x051, 0x0003C800, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000942CA, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000942CA, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, -@@ -10023,6 +16622,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x052, 0x000902CA, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10037,10 +16638,28 @@ static const u32 rtw8822c_rf_a[] = { - 0x052, 0x000902CA, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, - 0xA0000000, 0x00000000, - 0x052, 0x000942CA, - 0xB0000000, 0x00000000, -@@ -10050,7 +16669,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x0EF, 0x00000020, - 0x033, 0x00000000, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10068,6 +16691,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10082,16 +16707,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000001, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10109,6 +16756,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10123,16 +16772,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000002, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10141,39 +16812,63 @@ static const u32 rtw8822c_rf_a[] = { - 0x92000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00030246, -+ 0x03F, 0x0003D646, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000003, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10191,6 +16886,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10205,16 +16902,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000004, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10232,6 +16951,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10246,16 +16967,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000005, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10273,6 +17016,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00030246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10287,16 +17032,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00030246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000006, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10314,6 +17081,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10328,16 +17097,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000007, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10355,6 +17146,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10369,16 +17162,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000008, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10396,6 +17211,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00030246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10410,16 +17227,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00030246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000009, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10437,6 +17276,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10451,16 +17292,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000000A, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10478,6 +17341,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10492,16 +17357,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000000B, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10519,6 +17406,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00030246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10533,16 +17422,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00030246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000000C, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10560,6 +17471,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10574,16 +17487,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000000D, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10601,6 +17536,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10615,16 +17552,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00028246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00028246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00028246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000000E, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00010E46, -@@ -10642,6 +17601,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00030246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10656,16 +17617,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00030246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00030246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00030246, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000000F, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -10683,6 +17666,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10697,16 +17682,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000010, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -10724,6 +17731,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10738,16 +17747,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000011, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -10765,6 +17796,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00031E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10779,16 +17812,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00031E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000012, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -10806,6 +17861,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10820,16 +17877,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000013, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -10847,6 +17926,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10861,16 +17942,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000014, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -10888,6 +17991,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00031E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10902,16 +18007,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00031E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000015, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -10929,6 +18056,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10943,16 +18072,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000016, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -10970,6 +18121,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -10984,16 +18137,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000017, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11011,6 +18186,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00031E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11025,16 +18202,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00031E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000018, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11052,6 +18251,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11066,16 +18267,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000019, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11093,6 +18316,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11107,16 +18332,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000001A, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11134,6 +18381,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00031E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11148,16 +18397,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00031E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000001B, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11175,6 +18446,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11189,16 +18462,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000001C, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11216,6 +18511,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11230,16 +18527,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000001D, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11257,6 +18576,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00031E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11271,16 +18592,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00031E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00031E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00031E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000001E, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11298,6 +18641,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11312,16 +18657,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000001F, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11339,6 +18706,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11353,16 +18722,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000020, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11371,39 +18762,63 @@ static const u32 rtw8822c_rf_a[] = { - 0x92000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000021, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11421,6 +18836,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11435,16 +18852,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000022, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11462,6 +18901,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11476,16 +18917,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000023, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11494,39 +18957,63 @@ static const u32 rtw8822c_rf_a[] = { - 0x92000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000024, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11544,6 +19031,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11558,16 +19047,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000025, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11585,6 +19096,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11599,16 +19112,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000026, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11617,39 +19152,63 @@ static const u32 rtw8822c_rf_a[] = { - 0x92000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000027, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11667,6 +19226,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11681,16 +19242,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000028, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11708,6 +19291,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -11722,16 +19307,38 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00025E46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00025E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00025E46, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x00000029, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11740,39 +19347,63 @@ static const u32 rtw8822c_rf_a[] = { - 0x92000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00031E46, -+ 0x03F, 0x0003D646, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0003D646, - 0xA0000000, 0x00000000, - 0x03F, 0x00002A46, - 0xB0000000, 0x00000000, - 0x033, 0x0000002A, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0000EA46, -@@ -11790,122 +19421,418 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00021E46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00021E46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00021E46, -+ 0xA0000000, 0x00000000, -+ 0x03F, 0x00002A46, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x0EE, 0x00010000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000487, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000887, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000947, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D48, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D88, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000DE8, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000487, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000887, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000947, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D48, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D88, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000DE8, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000468, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000868, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000909, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D0A, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D4A, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000D8B, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000468, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000868, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000909, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D0A, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D4A, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000D8B, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000468, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000868, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000909, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D0A, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D4A, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000D8B, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000468, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000868, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000909, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D0A, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D4A, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000D8B, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x000008C8, -+ 0x033, 0x00000064, -+ 0x03F, 0x000008CB, -+ 0x033, 0x00000065, -+ 0x03F, 0x000008CE, -+ 0x033, 0x00000066, -+ 0x03F, 0x000008D1, -+ 0x033, 0x00000067, -+ 0x03F, 0x000008D4, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DD1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x000008C8, -+ 0x033, 0x00000064, -+ 0x03F, 0x000008CB, -+ 0x033, 0x00000065, -+ 0x03F, 0x000008CE, -+ 0x033, 0x00000066, -+ 0x03F, 0x000008D1, -+ 0x033, 0x00000067, -+ 0x03F, 0x000008D4, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DD1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x000008C8, -+ 0x033, 0x00000064, -+ 0x03F, 0x000008CB, -+ 0x033, 0x00000065, -+ 0x03F, 0x000008CE, -+ 0x033, 0x00000066, -+ 0x03F, 0x000008D1, -+ 0x033, 0x00000067, -+ 0x03F, 0x000008D4, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DD1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x000008C8, -+ 0x033, 0x00000064, -+ 0x03F, 0x000008CB, -+ 0x033, 0x00000065, -+ 0x03F, 0x000008CE, -+ 0x033, 0x00000066, -+ 0x03F, 0x000008D1, -+ 0x033, 0x00000067, -+ 0x03F, 0x000008D4, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DD1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x000008C8, -+ 0x033, 0x00000064, -+ 0x03F, 0x000008CB, -+ 0x033, 0x00000065, -+ 0x03F, 0x000008CE, -+ 0x033, 0x00000066, -+ 0x03F, 0x000008D1, -+ 0x033, 0x00000067, -+ 0x03F, 0x000008D4, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DD1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x000008C8, -+ 0x033, 0x00000064, -+ 0x03F, 0x000008CB, -+ 0x033, 0x00000065, -+ 0x03F, 0x000008CE, -+ 0x033, 0x00000066, -+ 0x03F, 0x000008D1, -+ 0x033, 0x00000067, -+ 0x03F, 0x000008D4, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DD1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00021E46, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00021E46, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00021E46, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00021E46, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00021E46, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00021E46, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00021E46, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00021E46, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00021E46, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00002A46, -- 0xB0000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x0EE, 0x00010000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, -- 0x03F, 0x00000468, -+ 0x03F, 0x00000467, - 0x033, 0x00000061, -- 0x03F, 0x00000868, -+ 0x03F, 0x00000867, - 0x033, 0x00000062, -- 0x03F, 0x00000909, -+ 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D0A, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D4A, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8B, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, -- 0x03F, 0x00000468, -+ 0x03F, 0x00000467, - 0x033, 0x00000061, -- 0x03F, 0x00000868, -+ 0x03F, 0x00000867, - 0x033, 0x00000062, -- 0x03F, 0x00000909, -+ 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D0A, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D4A, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8B, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, -- 0x03F, 0x00000468, -+ 0x03F, 0x00000467, - 0x033, 0x00000061, -- 0x03F, 0x00000868, -+ 0x03F, 0x00000867, - 0x033, 0x00000062, -- 0x03F, 0x00000909, -+ 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D0A, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D4A, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8B, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, -- 0x03F, 0x00000468, -+ 0x03F, 0x00000467, - 0x033, 0x00000061, -- 0x03F, 0x00000868, -+ 0x03F, 0x00000867, - 0x033, 0x00000062, -- 0x03F, 0x00000909, -+ 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D0A, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D4A, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8B, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -11913,22 +19840,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -11936,22 +19863,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -11959,22 +19886,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -11982,22 +19909,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -12005,22 +19932,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -12028,22 +19955,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -12051,22 +19978,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -12074,22 +20001,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -12097,22 +20024,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -12120,22 +20047,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -12143,22 +20070,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -12166,22 +20093,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -12189,22 +20116,22 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -12212,21 +20139,21 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x000008C8, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x000008CB, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x000008CE, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x000008D1, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x000008D4, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000DD1, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -+ 0x03F, 0x00000DD7, - 0xA0000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000487, -@@ -12251,7 +20178,53 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x0000006A, - 0x03F, 0x00000DF7, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000487, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000887, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000947, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D48, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D88, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000DE8, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000487, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000887, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000947, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D48, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D88, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000DE8, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000468, - 0x033, 0x00000021, -@@ -12458,6 +20431,29 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000467, -@@ -12504,7 +20500,214 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000467, - 0x033, 0x00000021, -@@ -12527,7 +20730,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000467, - 0x033, 0x00000021, -@@ -12550,7 +20753,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000467, - 0x033, 0x00000021, -@@ -12573,7 +20776,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000467, - 0x033, 0x00000021, -@@ -12596,7 +20799,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000467, - 0x033, 0x00000021, -@@ -12619,7 +20822,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000467, - 0x033, 0x00000021, -@@ -12642,7 +20845,7 @@ static const u32 rtw8822c_rf_a[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000467, - 0x033, 0x00000021, -@@ -12698,7 +20901,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x0B0, 0x0001F0FC, - 0x0B1, 0x0007DBE4, - 0x0B2, 0x00022400, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x0007C760, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x0007C760, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x0007C760, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x0007C760, -@@ -12716,6 +20923,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x0B3, 0x000FC760, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -12730,31 +20939,93 @@ static const u32 rtw8822c_rf_a[] = { - 0x0B3, 0x000FC760, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, - 0xA0000000, 0x00000000, - 0x0B3, 0x0007C760, - 0xB0000000, 0x00000000, - 0x0B4, 0x00099D40, - 0x0B5, 0x0004103F, -- 0x83000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, - 0x0B6, 0x000387F8, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, - 0x0B6, 0x000387F8, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x0B6, 0x000387F8, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x0B6, 0x000387F8, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, - 0x0B6, 0x000387F8, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, - 0x0B6, 0x000387F8, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x0B6, 0x000387F8, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x0B6, 0x000387F8, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000387F8, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000387F8, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000187F8, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000387F8, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B6, 0x000387F8, - 0xA0000000, 0x00000000, - 0x0B6, 0x000187F8, - 0xB0000000, 0x00000000, -@@ -12769,7 +21040,11 @@ static const u32 rtw8822c_rf_a[] = { - 0x0CA, 0x00080001, - 0x0FE, 0x00000000, - 0x0B0, 0x0001F0F8, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x0007C700, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x0007C700, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x0007C700, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x0007C700, -@@ -12787,6 +21062,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x0B3, 0x000FC760, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -12801,10 +21078,28 @@ static const u32 rtw8822c_rf_a[] = { - 0x0B3, 0x000FC760, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, - 0xA0000000, 0x00000000, - 0x0B3, 0x0007C700, - 0xB0000000, 0x00000000, -@@ -12812,7 +21107,11 @@ static const u32 rtw8822c_rf_a[] = { - 0xFFE, 0x00000000, - 0xFFE, 0x00000000, - 0xFFE, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x0007C760, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x0007C760, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x0007C760, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x0007C760, -@@ -12830,6 +21129,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x0B3, 0x000FC760, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -12844,10 +21145,28 @@ static const u32 rtw8822c_rf_a[] = { - 0x0B3, 0x000FC760, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x0B3, 0x000FC760, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B3, 0x000FC760, - 0xA0000000, 0x00000000, - 0x0B3, 0x0007C760, - 0xB0000000, 0x00000000, -@@ -12871,7 +21190,19 @@ static const u32 rtw8822c_rf_a[] = { - 0x033, 0x00000001, - 0x03F, 0x0000000F, - 0x0ED, 0x00000000, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000500, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000500, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000500, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000500, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000500, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000500, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, - 0x0DD, 0x00000540, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, - 0x0DD, 0x00000540, -@@ -12881,6 +21212,8 @@ static const u32 rtw8822c_rf_a[] = { - 0x0DD, 0x00000540, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x0DD, 0x00000540, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000540, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x0DD, 0x00000540, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -12895,10 +21228,28 @@ static const u32 rtw8822c_rf_a[] = { - 0x0DD, 0x00000540, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x0DD, 0x00000540, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000540, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x0DD, 0x00000540, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x0DD, 0x00000540, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000540, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000540, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000540, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000540, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000540, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000540, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000540, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000540, - 0xA0000000, 0x00000000, - 0x0DD, 0x00000500, - 0xB0000000, 0x00000000, -@@ -13008,7 +21359,19 @@ static const u32 rtw8822c_rf_b[] = { - 0x093, 0x0008483F, - 0x0EF, 0x00080000, - 0x033, 0x00000001, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00091230, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00091230, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00091230, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00091230, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00091230, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00091230, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0009123E, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0009123E, -@@ -13018,6 +21381,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0009123E, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0009123E, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0009123E, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0009123E, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -13032,16 +21397,38 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0009123E, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0009123E, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0009123E, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0009123E, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0009123E, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0009123E, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0009123E, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0009123E, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0009123E, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0009123E, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0009123E, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0009123E, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0009123E, - 0xA0000000, 0x00000000, - 0x03F, 0x00091230, - 0xB0000000, 0x00000000, - 0x0EF, 0x00000000, - 0x0DE, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000B9140, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000B9140, -@@ -13059,6 +21446,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x08E, 0x000A5540, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000A5540, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000A5540, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -13073,10 +21462,28 @@ static const u32 rtw8822c_rf_b[] = { - 0x08E, 0x000A5540, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000A5540, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000A5540, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x08E, 0x000A5540, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x08E, 0x000A5540, - 0xA0000000, 0x00000000, - 0x08E, 0x000A5540, - 0xB0000000, 0x00000000, -@@ -13084,7 +21491,25 @@ static const u32 rtw8822c_rf_b[] = { - 0x081, 0x0002FC01, - 0x081, 0x0003FC01, - 0x085, 0x0006A06C, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000003F, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000003F, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000003F, -+ 0x0EE, 0x00000000, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000003F, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000003F, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000003F, -+ 0x0EE, 0x00000000, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x0EE, 0x00000010, - 0x033, 0x00000001, - 0x03F, 0x0000002A, -@@ -13130,133 +21555,691 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0000002A, - 0x0EE, 0x00000000, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000002A, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00000010, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000003F, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000003F, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000003F, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000001, -- 0x03F, 0x0000002A, -- 0x033, 0x00000002, -- 0x03F, 0x0000002A, -- 0x0EE, 0x00000000, -- 0xA0000000, 0x00000000, -- 0x0EE, 0x00000010, -- 0x033, 0x00000001, -- 0x03F, 0x0000003F, -- 0x033, 0x00000001, -- 0x03F, 0x0000003F, -- 0x033, 0x00000002, -- 0x03F, 0x0000003F, -- 0x0EE, 0x00000000, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, - 0x03F, 0x000773C0, -@@ -13282,7 +22265,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, - 0x03F, 0x000773C0, -@@ -13308,7 +22291,85 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, - 0x03F, 0x000773C0, -@@ -13334,7 +22395,33 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000008, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000006, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000040, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, - 0x03F, 0x000773C0, -@@ -13345,11 +22432,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000000C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000000B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000000A, - 0x03F, 0x000002A8, - 0x033, 0x00000009, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000008, - 0x03F, 0x000FF280, - 0x033, 0x00000007, -@@ -13360,7 +22447,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, - 0x03F, 0x000773C0, -@@ -13386,7 +22473,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, - 0x03F, 0x000773C0, -@@ -13412,7 +22499,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, - 0x03F, 0x000773C0, -@@ -13438,7 +22525,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, - 0x03F, 0x000773C0, -@@ -13464,18 +22551,18 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0xA0000000, 0x00000000, - 0x0EF, 0x00010000, - 0x033, 0x0000000F, -- 0x03F, 0x000773C0, -+ 0x03F, 0x000773E8, - 0x033, 0x0000000E, -- 0x03F, 0x000FF3C0, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000000D, -- 0x03F, 0x000773E8, -+ 0x03F, 0x00000380, - 0x033, 0x0000000C, -- 0x03F, 0x000FF3E8, -+ 0x03F, 0x000FF380, - 0x033, 0x0000000B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000300, - 0x033, 0x0000000A, - 0x03F, 0x000002A8, - 0x033, 0x00000009, -@@ -13490,270 +22577,560 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000004, - 0x03F, 0x00000040, -+ 0xB0000000, 0x00000000, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000001B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000001B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00010000, -- 0x033, 0x0000000F, -+ 0x033, 0x0000001F, - 0x03F, 0x000773C0, -- 0x033, 0x0000000E, -+ 0x033, 0x0000001E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000000D, -+ 0x033, 0x0000001D, - 0x03F, 0x000773E8, -- 0x033, 0x0000000C, -+ 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000000B, -+ 0x033, 0x0000001B, - 0x03F, 0x00000287, -- 0x033, 0x0000000A, -+ 0x033, 0x0000001A, - 0x03F, 0x000002A8, -- 0x033, 0x00000009, -+ 0x033, 0x00000019, - 0x03F, 0x00000207, -- 0x033, 0x00000008, -+ 0x033, 0x00000018, - 0x03F, 0x000FF280, -- 0x033, 0x00000007, -+ 0x033, 0x00000017, - 0x03F, 0x00000200, -- 0x033, 0x00000006, -+ 0x033, 0x00000016, - 0x03F, 0x000001C0, -- 0x033, 0x00000005, -+ 0x033, 0x00000015, - 0x03F, 0x00000180, -- 0x033, 0x00000004, -+ 0x033, 0x00000014, - 0x03F, 0x00000040, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00010000, -- 0x033, 0x0000000F, -+ 0x033, 0x0000001F, - 0x03F, 0x000773C0, -- 0x033, 0x0000000E, -+ 0x033, 0x0000001E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000000D, -+ 0x033, 0x0000001D, - 0x03F, 0x000773E8, -- 0x033, 0x0000000C, -+ 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000000B, -+ 0x033, 0x0000001B, - 0x03F, 0x00000287, -- 0x033, 0x0000000A, -+ 0x033, 0x0000001A, - 0x03F, 0x000002A8, -- 0x033, 0x00000009, -+ 0x033, 0x00000019, - 0x03F, 0x00000207, -- 0x033, 0x00000008, -+ 0x033, 0x00000018, - 0x03F, 0x000FF280, -- 0x033, 0x00000007, -+ 0x033, 0x00000017, - 0x03F, 0x00000200, -- 0x033, 0x00000006, -+ 0x033, 0x00000016, - 0x03F, 0x000001C0, -- 0x033, 0x00000005, -+ 0x033, 0x00000015, - 0x03F, 0x00000180, -- 0x033, 0x00000004, -+ 0x033, 0x00000014, - 0x03F, 0x00000040, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00010000, -- 0x033, 0x0000000F, -+ 0x033, 0x0000001F, - 0x03F, 0x000773C0, -- 0x033, 0x0000000E, -+ 0x033, 0x0000001E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000000D, -+ 0x033, 0x0000001D, - 0x03F, 0x000773E8, -- 0x033, 0x0000000C, -+ 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000000B, -+ 0x033, 0x0000001B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000000A, -+ 0x033, 0x0000001A, - 0x03F, 0x000002A8, -- 0x033, 0x00000009, -+ 0x033, 0x00000019, - 0x03F, 0x00000280, -- 0x033, 0x00000008, -+ 0x033, 0x00000018, - 0x03F, 0x000FF280, -- 0x033, 0x00000007, -+ 0x033, 0x00000017, - 0x03F, 0x00000200, -- 0x033, 0x00000006, -+ 0x033, 0x00000016, - 0x03F, 0x000001C0, -- 0x033, 0x00000005, -+ 0x033, 0x00000015, - 0x03F, 0x00000180, -- 0x033, 0x00000004, -+ 0x033, 0x00000014, - 0x03F, 0x00000040, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00010000, -- 0x033, 0x0000000F, -+ 0x033, 0x0000001F, - 0x03F, 0x000773C0, -- 0x033, 0x0000000E, -+ 0x033, 0x0000001E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000000D, -+ 0x033, 0x0000001D, - 0x03F, 0x000773E8, -- 0x033, 0x0000000C, -+ 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000000B, -+ 0x033, 0x0000001B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000000A, -+ 0x033, 0x0000001A, - 0x03F, 0x000002A8, -- 0x033, 0x00000009, -+ 0x033, 0x00000019, - 0x03F, 0x00000280, -- 0x033, 0x00000008, -+ 0x033, 0x00000018, - 0x03F, 0x000FF280, -- 0x033, 0x00000007, -+ 0x033, 0x00000017, - 0x03F, 0x00000200, -- 0x033, 0x00000006, -+ 0x033, 0x00000016, - 0x03F, 0x000001C0, -- 0x033, 0x00000005, -+ 0x033, 0x00000015, - 0x03F, 0x00000180, -- 0x033, 0x00000004, -+ 0x033, 0x00000014, - 0x03F, 0x00000040, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00010000, -- 0x033, 0x0000000F, -+ 0x033, 0x0000001F, - 0x03F, 0x000773C0, -- 0x033, 0x0000000E, -+ 0x033, 0x0000001E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000000D, -+ 0x033, 0x0000001D, - 0x03F, 0x000773E8, -- 0x033, 0x0000000C, -+ 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000000B, -+ 0x033, 0x0000001B, - 0x03F, 0x00000287, -- 0x033, 0x0000000A, -+ 0x033, 0x0000001A, - 0x03F, 0x000002A8, -- 0x033, 0x00000009, -+ 0x033, 0x00000019, - 0x03F, 0x00000207, -- 0x033, 0x00000008, -+ 0x033, 0x00000018, - 0x03F, 0x000FF280, -- 0x033, 0x00000007, -+ 0x033, 0x00000017, - 0x03F, 0x00000200, -- 0x033, 0x00000006, -+ 0x033, 0x00000016, - 0x03F, 0x000001C0, -- 0x033, 0x00000005, -+ 0x033, 0x00000015, - 0x03F, 0x00000180, -- 0x033, 0x00000004, -+ 0x033, 0x00000014, - 0x03F, 0x00000040, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00010000, -- 0x033, 0x0000000F, -+ 0x033, 0x0000001F, - 0x03F, 0x000773C0, -- 0x033, 0x0000000E, -+ 0x033, 0x0000001E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000000D, -+ 0x033, 0x0000001D, - 0x03F, 0x000773E8, -- 0x033, 0x0000000C, -+ 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000000B, -+ 0x033, 0x0000001B, - 0x03F, 0x00000287, -- 0x033, 0x0000000A, -+ 0x033, 0x0000001A, - 0x03F, 0x000002A8, -- 0x033, 0x00000009, -+ 0x033, 0x00000019, - 0x03F, 0x00000207, -- 0x033, 0x00000008, -+ 0x033, 0x00000018, - 0x03F, 0x000FF280, -- 0x033, 0x00000007, -+ 0x033, 0x00000017, - 0x03F, 0x00000200, -- 0x033, 0x00000006, -+ 0x033, 0x00000016, - 0x03F, 0x000001C0, -- 0x033, 0x00000005, -+ 0x033, 0x00000015, - 0x03F, 0x00000180, -- 0x033, 0x00000004, -+ 0x033, 0x00000014, - 0x03F, 0x00000040, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00010000, -- 0x033, 0x0000000F, -+ 0x033, 0x0000001F, - 0x03F, 0x000773C0, -- 0x033, 0x0000000E, -+ 0x033, 0x0000001E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000000D, -+ 0x033, 0x0000001D, - 0x03F, 0x000773E8, -- 0x033, 0x0000000C, -+ 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000000B, -+ 0x033, 0x0000001B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000000A, -+ 0x033, 0x0000001A, - 0x03F, 0x000002A8, -- 0x033, 0x00000009, -+ 0x033, 0x00000019, - 0x03F, 0x00000280, -- 0x033, 0x00000008, -+ 0x033, 0x00000018, - 0x03F, 0x000FF280, -- 0x033, 0x00000007, -+ 0x033, 0x00000017, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000016, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000015, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000001E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000001D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000001C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000001B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000001A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000019, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000018, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000017, - 0x03F, 0x00000200, -- 0x033, 0x00000006, -+ 0x033, 0x00000016, - 0x03F, 0x000001C0, -- 0x033, 0x00000005, -+ 0x033, 0x00000015, - 0x03F, 0x00000180, -- 0x033, 0x00000004, -+ 0x033, 0x00000014, - 0x03F, 0x00000040, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00010000, -- 0x033, 0x0000000F, -+ 0x033, 0x0000001F, - 0x03F, 0x000773C0, -- 0x033, 0x0000000E, -+ 0x033, 0x0000001E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000000D, -+ 0x033, 0x0000001D, - 0x03F, 0x000773E8, -- 0x033, 0x0000000C, -+ 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000000B, -+ 0x033, 0x0000001B, - 0x03F, 0x00000287, -- 0x033, 0x0000000A, -+ 0x033, 0x0000001A, - 0x03F, 0x000002A8, -- 0x033, 0x00000009, -+ 0x033, 0x00000019, - 0x03F, 0x00000207, -- 0x033, 0x00000008, -+ 0x033, 0x00000018, - 0x03F, 0x000FF280, -- 0x033, 0x00000007, -+ 0x033, 0x00000017, - 0x03F, 0x00000200, -- 0x033, 0x00000006, -+ 0x033, 0x00000016, - 0x03F, 0x000001C0, -- 0x033, 0x00000005, -+ 0x033, 0x00000015, - 0x03F, 0x00000180, -- 0x033, 0x00000004, -+ 0x033, 0x00000014, - 0x03F, 0x00000040, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00010000, -- 0x033, 0x0000000F, -+ 0x033, 0x0000001F, - 0x03F, 0x000773C0, -- 0x033, 0x0000000E, -+ 0x033, 0x0000001E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000000D, -+ 0x033, 0x0000001D, - 0x03F, 0x000773E8, -- 0x033, 0x0000000C, -+ 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000000B, -+ 0x033, 0x0000001B, - 0x03F, 0x00000287, -- 0x033, 0x0000000A, -+ 0x033, 0x0000001A, - 0x03F, 0x000002A8, -- 0x033, 0x00000009, -+ 0x033, 0x00000019, - 0x03F, 0x00000207, -- 0x033, 0x00000008, -- 0x03F, 0x000FF280, -- 0x033, 0x00000007, -- 0x03F, 0x00000200, -- 0x033, 0x00000006, -- 0x03F, 0x000001C0, -- 0x033, 0x00000005, -- 0x03F, 0x00000180, -- 0x033, 0x00000004, -- 0x03F, 0x00000040, -- 0xA0000000, 0x00000000, -- 0x0EF, 0x00010000, -- 0x033, 0x0000000F, -- 0x03F, 0x000773E8, -- 0x033, 0x0000000E, -- 0x03F, 0x000FF3A0, -- 0x033, 0x0000000D, -- 0x03F, 0x00000380, -- 0x033, 0x0000000C, -- 0x03F, 0x000FF380, -- 0x033, 0x0000000B, -- 0x03F, 0x00000300, -- 0x033, 0x0000000A, -- 0x03F, 0x000002A8, -- 0x033, 0x00000009, -- 0x03F, 0x00000280, -- 0x033, 0x00000008, -+ 0x033, 0x00000018, - 0x03F, 0x000FF280, -- 0x033, 0x00000007, -+ 0x033, 0x00000017, - 0x03F, 0x00000200, -- 0x033, 0x00000006, -+ 0x033, 0x00000016, - 0x03F, 0x000001C0, -- 0x033, 0x00000005, -+ 0x033, 0x00000015, - 0x03F, 0x00000180, -- 0x033, 0x00000004, -+ 0x033, 0x00000014, - 0x03F, 0x00000040, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000003, -- 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, - 0x033, 0x0000001E, -@@ -13778,7 +23155,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, - 0x033, 0x0000001E, -@@ -13803,7 +23180,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, - 0x033, 0x0000001E, -@@ -13813,11 +23190,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000001B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000001A, - 0x03F, 0x000002A8, - 0x033, 0x00000019, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000018, - 0x03F, 0x000FF280, - 0x033, 0x00000017, -@@ -13828,7 +23205,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, - 0x033, 0x0000001E, -@@ -13838,11 +23215,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000001C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000001B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000001A, - 0x03F, 0x000002A8, - 0x033, 0x00000019, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000018, - 0x03F, 0x000FF280, - 0x033, 0x00000017, -@@ -13853,7 +23230,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, - 0x033, 0x0000001E, -@@ -13878,7 +23255,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, - 0x033, 0x0000001E, -@@ -13903,7 +23280,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, - 0x033, 0x0000001E, -@@ -13928,7 +23305,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000001F, - 0x03F, 0x000773C0, - 0x033, 0x0000001E, -@@ -13953,17 +23330,17 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000014, - 0x03F, 0x00000040, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0xA0000000, 0x00000000, - 0x033, 0x0000001F, -- 0x03F, 0x000773C0, -+ 0x03F, 0x000773E8, - 0x033, 0x0000001E, -- 0x03F, 0x000FF3C0, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000001D, -- 0x03F, 0x000773E8, -+ 0x03F, 0x00000380, - 0x033, 0x0000001C, -- 0x03F, 0x000FF3E8, -+ 0x03F, 0x000FF380, - 0x033, 0x0000001B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000300, - 0x033, 0x0000001A, - 0x03F, 0x000002A8, - 0x033, 0x00000019, -@@ -13976,262 +23353,662 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x000001C0, - 0x033, 0x00000015, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000014, -+ 0x03F, 0x00000040, -+ 0xB0000000, 0x00000000, -+ 0x033, 0x00000013, -+ 0x03F, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000040, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000026, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000001F, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, - 0x03F, 0x000773C0, -- 0x033, 0x0000001E, -+ 0x033, 0x0000002E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000001D, -+ 0x033, 0x0000002D, - 0x03F, 0x000773E8, -- 0x033, 0x0000001C, -+ 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000001B, -+ 0x033, 0x0000002B, - 0x03F, 0x00000287, -- 0x033, 0x0000001A, -+ 0x033, 0x0000002A, - 0x03F, 0x000002A8, -- 0x033, 0x00000019, -+ 0x033, 0x00000029, - 0x03F, 0x00000207, -- 0x033, 0x00000018, -+ 0x033, 0x00000028, - 0x03F, 0x000FF280, -- 0x033, 0x00000017, -+ 0x033, 0x00000027, - 0x03F, 0x00000200, -- 0x033, 0x00000016, -+ 0x033, 0x00000026, - 0x03F, 0x000001C0, -- 0x033, 0x00000015, -+ 0x033, 0x00000025, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000001F, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, - 0x03F, 0x000773C0, -- 0x033, 0x0000001E, -+ 0x033, 0x0000002E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000001D, -+ 0x033, 0x0000002D, - 0x03F, 0x000773E8, -- 0x033, 0x0000001C, -+ 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000001B, -+ 0x033, 0x0000002B, - 0x03F, 0x00000287, -- 0x033, 0x0000001A, -+ 0x033, 0x0000002A, - 0x03F, 0x000002A8, -- 0x033, 0x00000019, -+ 0x033, 0x00000029, - 0x03F, 0x00000207, -- 0x033, 0x00000018, -+ 0x033, 0x00000028, - 0x03F, 0x000FF280, -- 0x033, 0x00000017, -+ 0x033, 0x00000027, - 0x03F, 0x00000200, -- 0x033, 0x00000016, -+ 0x033, 0x00000026, - 0x03F, 0x000001C0, -- 0x033, 0x00000015, -+ 0x033, 0x00000025, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000001F, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, - 0x03F, 0x000773C0, -- 0x033, 0x0000001E, -+ 0x033, 0x0000002E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000001D, -+ 0x033, 0x0000002D, - 0x03F, 0x000773E8, -- 0x033, 0x0000001C, -+ 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000001B, -+ 0x033, 0x0000002B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000001A, -+ 0x033, 0x0000002A, - 0x03F, 0x000002A8, -- 0x033, 0x00000019, -+ 0x033, 0x00000029, - 0x03F, 0x00000280, -- 0x033, 0x00000018, -+ 0x033, 0x00000028, - 0x03F, 0x000FF280, -- 0x033, 0x00000017, -+ 0x033, 0x00000027, - 0x03F, 0x00000200, -- 0x033, 0x00000016, -+ 0x033, 0x00000026, - 0x03F, 0x000001C0, -- 0x033, 0x00000015, -+ 0x033, 0x00000025, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000001F, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, - 0x03F, 0x000773C0, -- 0x033, 0x0000001E, -+ 0x033, 0x0000002E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000001D, -+ 0x033, 0x0000002D, - 0x03F, 0x000773E8, -- 0x033, 0x0000001C, -+ 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000001B, -+ 0x033, 0x0000002B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000001A, -+ 0x033, 0x0000002A, - 0x03F, 0x000002A8, -- 0x033, 0x00000019, -+ 0x033, 0x00000029, - 0x03F, 0x00000280, -- 0x033, 0x00000018, -+ 0x033, 0x00000028, - 0x03F, 0x000FF280, -- 0x033, 0x00000017, -+ 0x033, 0x00000027, - 0x03F, 0x00000200, -- 0x033, 0x00000016, -+ 0x033, 0x00000026, - 0x03F, 0x000001C0, -- 0x033, 0x00000015, -+ 0x033, 0x00000025, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000001F, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, - 0x03F, 0x000773C0, -- 0x033, 0x0000001E, -+ 0x033, 0x0000002E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000001D, -+ 0x033, 0x0000002D, - 0x03F, 0x000773E8, -- 0x033, 0x0000001C, -+ 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000001B, -+ 0x033, 0x0000002B, - 0x03F, 0x00000287, -- 0x033, 0x0000001A, -+ 0x033, 0x0000002A, - 0x03F, 0x000002A8, -- 0x033, 0x00000019, -+ 0x033, 0x00000029, - 0x03F, 0x00000207, -- 0x033, 0x00000018, -+ 0x033, 0x00000028, - 0x03F, 0x000FF280, -- 0x033, 0x00000017, -+ 0x033, 0x00000027, - 0x03F, 0x00000200, -- 0x033, 0x00000016, -+ 0x033, 0x00000026, - 0x03F, 0x000001C0, -- 0x033, 0x00000015, -+ 0x033, 0x00000025, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000001F, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, - 0x03F, 0x000773C0, -- 0x033, 0x0000001E, -+ 0x033, 0x0000002E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000001D, -+ 0x033, 0x0000002D, - 0x03F, 0x000773E8, -- 0x033, 0x0000001C, -+ 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000001B, -+ 0x033, 0x0000002B, - 0x03F, 0x00000287, -- 0x033, 0x0000001A, -+ 0x033, 0x0000002A, - 0x03F, 0x000002A8, -- 0x033, 0x00000019, -+ 0x033, 0x00000029, - 0x03F, 0x00000207, -- 0x033, 0x00000018, -+ 0x033, 0x00000028, - 0x03F, 0x000FF280, -- 0x033, 0x00000017, -+ 0x033, 0x00000027, - 0x03F, 0x00000200, -- 0x033, 0x00000016, -+ 0x033, 0x00000026, - 0x03F, 0x000001C0, -- 0x033, 0x00000015, -+ 0x033, 0x00000025, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000001F, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, - 0x03F, 0x000773C0, -- 0x033, 0x0000001E, -+ 0x033, 0x0000002E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000001D, -+ 0x033, 0x0000002D, - 0x03F, 0x000773E8, -- 0x033, 0x0000001C, -+ 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000001B, -+ 0x033, 0x0000002B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000001A, -+ 0x033, 0x0000002A, - 0x03F, 0x000002A8, -- 0x033, 0x00000019, -+ 0x033, 0x00000029, - 0x03F, 0x00000280, -- 0x033, 0x00000018, -+ 0x033, 0x00000028, - 0x03F, 0x000FF280, -- 0x033, 0x00000017, -+ 0x033, 0x00000027, - 0x03F, 0x00000200, -- 0x033, 0x00000016, -+ 0x033, 0x00000026, - 0x03F, 0x000001C0, -- 0x033, 0x00000015, -+ 0x033, 0x00000025, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000001F, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, - 0x03F, 0x000773C0, -- 0x033, 0x0000001E, -+ 0x033, 0x0000002E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000001D, -+ 0x033, 0x0000002D, - 0x03F, 0x000773E8, -- 0x033, 0x0000001C, -+ 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000001B, -- 0x03F, 0x00000287, -- 0x033, 0x0000001A, -+ 0x033, 0x0000002B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000002A, - 0x03F, 0x000002A8, -- 0x033, 0x00000019, -- 0x03F, 0x00000207, -- 0x033, 0x00000018, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000028, - 0x03F, 0x000FF280, -- 0x033, 0x00000017, -+ 0x033, 0x00000027, - 0x03F, 0x00000200, -- 0x033, 0x00000016, -+ 0x033, 0x00000026, - 0x03F, 0x000001C0, -- 0x033, 0x00000015, -+ 0x033, 0x00000025, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000001F, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, - 0x03F, 0x000773C0, -- 0x033, 0x0000001E, -+ 0x033, 0x0000002E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000001D, -+ 0x033, 0x0000002D, - 0x03F, 0x000773E8, -- 0x033, 0x0000001C, -+ 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000001B, -+ 0x033, 0x0000002B, - 0x03F, 0x00000287, -- 0x033, 0x0000001A, -+ 0x033, 0x0000002A, - 0x03F, 0x000002A8, -- 0x033, 0x00000019, -+ 0x033, 0x00000029, - 0x03F, 0x00000207, -- 0x033, 0x00000018, -+ 0x033, 0x00000028, - 0x03F, 0x000FF280, -- 0x033, 0x00000017, -+ 0x033, 0x00000027, - 0x03F, 0x00000200, -- 0x033, 0x00000016, -+ 0x033, 0x00000026, - 0x03F, 0x000001C0, -- 0x033, 0x00000015, -+ 0x033, 0x00000025, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0xA0000000, 0x00000000, -- 0x033, 0x0000001F, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000002F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000002E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000002D, - 0x03F, 0x000773E8, -- 0x033, 0x0000001E, -- 0x03F, 0x000FF3A0, -- 0x033, 0x0000001D, -- 0x03F, 0x00000380, -- 0x033, 0x0000001C, -- 0x03F, 0x000FF380, -- 0x033, 0x0000001B, -- 0x03F, 0x00000300, -- 0x033, 0x0000001A, -+ 0x033, 0x0000002C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000002B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000002A, - 0x03F, 0x000002A8, -- 0x033, 0x00000019, -- 0x03F, 0x00000280, -- 0x033, 0x00000018, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000028, - 0x03F, 0x000FF280, -- 0x033, 0x00000017, -+ 0x033, 0x00000027, - 0x03F, 0x00000200, -- 0x033, 0x00000016, -+ 0x033, 0x00000026, - 0x03F, 0x000001C0, -- 0x033, 0x00000015, -+ 0x033, 0x00000025, - 0x03F, 0x00000180, -- 0x033, 0x00000014, -+ 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000013, -- 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000002F, - 0x03F, 0x000773C0, - 0x033, 0x0000002E, -@@ -14256,7 +24033,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000002F, - 0x03F, 0x000773C0, - 0x033, 0x0000002E, -@@ -14281,7 +24058,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000002F, - 0x03F, 0x000773C0, - 0x033, 0x0000002E, -@@ -14291,11 +24068,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000002B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000002A, - 0x03F, 0x000002A8, - 0x033, 0x00000029, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000028, - 0x03F, 0x000FF280, - 0x033, 0x00000027, -@@ -14306,7 +24083,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000002F, - 0x03F, 0x000773C0, - 0x033, 0x0000002E, -@@ -14316,11 +24093,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000002C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000002B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000002A, - 0x03F, 0x000002A8, - 0x033, 0x00000029, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000028, - 0x03F, 0x000FF280, - 0x033, 0x00000027, -@@ -14331,17 +24108,17 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0xA0000000, 0x00000000, - 0x033, 0x0000002F, -- 0x03F, 0x000773C0, -+ 0x03F, 0x000773E8, - 0x033, 0x0000002E, -- 0x03F, 0x000FF3C0, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000002D, -- 0x03F, 0x000773E8, -+ 0x03F, 0x00000380, - 0x033, 0x0000002C, -- 0x03F, 0x000FF3E8, -+ 0x03F, 0x000FF380, - 0x033, 0x0000002B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000300, - 0x033, 0x0000002A, - 0x03F, 0x000002A8, - 0x033, 0x00000029, -@@ -14356,360 +24133,560 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000024, - 0x03F, 0x00000040, -+ 0xB0000000, 0x00000000, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000003B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000003B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000280, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000036, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000035, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000040, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000003A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x00000287, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000207, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -- 0x03F, 0x00000287, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -- 0x03F, 0x00000207, -- 0x033, 0x00000028, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000280, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x00000287, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000207, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x00000287, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000207, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000280, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000280, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x00000287, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000207, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x00000287, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000207, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000280, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -- 0x03F, 0x00000287, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -- 0x03F, 0x00000207, -- 0x033, 0x00000028, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, - 0x03F, 0x000773C0, -- 0x033, 0x0000002E, -+ 0x033, 0x0000003E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000002D, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002C, -+ 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000002B, -+ 0x033, 0x0000003B, - 0x03F, 0x00000287, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -+ 0x033, 0x00000039, - 0x03F, 0x00000207, -- 0x033, 0x00000028, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0xA0000000, 0x00000000, -- 0x033, 0x0000002F, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000003F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000003E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000003D, - 0x03F, 0x000773E8, -- 0x033, 0x0000002E, -- 0x03F, 0x000FF3A0, -- 0x033, 0x0000002D, -- 0x03F, 0x00000380, -- 0x033, 0x0000002C, -- 0x03F, 0x000FF380, -- 0x033, 0x0000002B, -- 0x03F, 0x00000300, -- 0x033, 0x0000002A, -+ 0x033, 0x0000003C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000003B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000003A, - 0x03F, 0x000002A8, -- 0x033, 0x00000029, -- 0x03F, 0x00000280, -- 0x033, 0x00000028, -+ 0x033, 0x00000039, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000038, - 0x03F, 0x000FF280, -- 0x033, 0x00000027, -+ 0x033, 0x00000037, - 0x03F, 0x00000200, -- 0x033, 0x00000026, -+ 0x033, 0x00000036, - 0x03F, 0x000001C0, -- 0x033, 0x00000025, -+ 0x033, 0x00000035, - 0x03F, 0x00000180, -- 0x033, 0x00000024, -+ 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000023, -- 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -14734,7 +24711,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -14759,7 +24736,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -14769,11 +24746,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000003B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000003A, - 0x03F, 0x000002A8, - 0x033, 0x00000039, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000038, - 0x03F, 0x000FF280, - 0x033, 0x00000037, -@@ -14784,7 +24761,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -14794,11 +24771,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000003C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000003B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000003A, - 0x03F, 0x000002A8, - 0x033, 0x00000039, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000038, - 0x03F, 0x000FF280, - 0x033, 0x00000037, -@@ -14809,7 +24786,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -14834,7 +24811,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -14859,7 +24836,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -14884,7 +24861,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000003F, - 0x03F, 0x000773C0, - 0x033, 0x0000003E, -@@ -14909,17 +24886,17 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0xA0000000, 0x00000000, - 0x033, 0x0000003F, -- 0x03F, 0x000773C0, -+ 0x03F, 0x000773E8, - 0x033, 0x0000003E, -- 0x03F, 0x000FF3C0, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000003D, -- 0x03F, 0x000773E8, -+ 0x03F, 0x00000380, - 0x033, 0x0000003C, -- 0x03F, 0x000FF3E8, -+ 0x03F, 0x000FF380, - 0x033, 0x0000003B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000300, - 0x033, 0x0000003A, - 0x03F, 0x000002A8, - 0x033, 0x00000039, -@@ -14934,260 +24911,385 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000034, - 0x03F, 0x00000040, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000003F, -+ 0xB0000000, 0x00000000, -+ 0x033, 0x00000033, -+ 0x03F, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000003E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000003D, -+ 0x033, 0x0000004D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000004B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000004B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000004B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000003C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000003B, -- 0x03F, 0x00000287, -- 0x033, 0x0000003A, -+ 0x033, 0x0000004B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000039, -- 0x03F, 0x00000207, -- 0x033, 0x00000038, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000037, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000036, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000035, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000034, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000003F, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000003E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000003D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000003C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000003B, -- 0x03F, 0x00000287, -- 0x033, 0x0000003A, -+ 0x033, 0x0000004B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000039, -- 0x03F, 0x00000207, -- 0x033, 0x00000038, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000037, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000036, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000035, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000034, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000003F, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000003E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000003D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000003C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000003B, -+ 0x033, 0x0000004B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000003A, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000039, -+ 0x033, 0x00000049, - 0x03F, 0x00000280, -- 0x033, 0x00000038, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000037, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000036, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000035, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000034, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000003F, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000003E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000003D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000003C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000003B, -- 0x03F, 0x000FF3A0, -- 0x033, 0x0000003A, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000039, -- 0x03F, 0x00000280, -- 0x033, 0x00000038, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000037, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000036, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000035, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000034, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000003F, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000003E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000003D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000003C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000003B, -+ 0x033, 0x0000004B, - 0x03F, 0x00000287, -- 0x033, 0x0000003A, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000039, -+ 0x033, 0x00000049, - 0x03F, 0x00000207, -- 0x033, 0x00000038, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000037, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000036, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000035, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000034, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000003F, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000003E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000003D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000003C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000003B, -- 0x03F, 0x00000287, -- 0x033, 0x0000003A, -+ 0x033, 0x0000004B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000039, -- 0x03F, 0x00000207, -- 0x033, 0x00000038, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000037, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000036, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000035, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000034, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000003F, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000003E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000003D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000003C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000003B, -+ 0x033, 0x0000004B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000003A, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000039, -+ 0x033, 0x00000049, - 0x03F, 0x00000280, -- 0x033, 0x00000038, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000037, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000036, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000035, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000034, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000003F, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000003E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000003D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000003C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000003B, -+ 0x033, 0x0000004B, - 0x03F, 0x00000287, -- 0x033, 0x0000003A, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000039, -+ 0x033, 0x00000049, - 0x03F, 0x00000207, -- 0x033, 0x00000038, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000037, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000036, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000035, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000034, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000003F, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, - 0x03F, 0x000773C0, -- 0x033, 0x0000003E, -+ 0x033, 0x0000004E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000003D, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000003C, -+ 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000003B, -+ 0x033, 0x0000004B, - 0x03F, 0x00000287, -- 0x033, 0x0000003A, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000039, -+ 0x033, 0x00000049, - 0x03F, 0x00000207, -- 0x033, 0x00000038, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000037, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000036, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000035, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000034, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0xA0000000, 0x00000000, -- 0x033, 0x0000003F, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000004D, - 0x03F, 0x000773E8, -- 0x033, 0x0000003E, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000004B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000003D, -- 0x03F, 0x00000380, -- 0x033, 0x0000003C, -- 0x03F, 0x000FF380, -- 0x033, 0x0000003B, -- 0x03F, 0x00000300, -- 0x033, 0x0000003A, -+ 0x033, 0x0000004A, - 0x03F, 0x000002A8, -- 0x033, 0x00000039, -+ 0x033, 0x00000049, - 0x03F, 0x00000280, -- 0x033, 0x00000038, -+ 0x033, 0x00000048, - 0x03F, 0x000FF280, -- 0x033, 0x00000037, -+ 0x033, 0x00000047, - 0x03F, 0x00000200, -- 0x033, 0x00000036, -+ 0x033, 0x00000046, - 0x03F, 0x000001C0, -- 0x033, 0x00000035, -+ 0x033, 0x00000045, - 0x03F, 0x00000180, -- 0x033, 0x00000034, -+ 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000033, -- 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15212,7 +25314,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15222,11 +25324,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000004B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000004A, - 0x03F, 0x000002A8, - 0x033, 0x00000049, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000048, - 0x03F, 0x000FF280, - 0x033, 0x00000047, -@@ -15237,7 +25339,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15247,11 +25349,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000004B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000004A, - 0x03F, 0x000002A8, - 0x033, 0x00000049, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000048, - 0x03F, 0x000FF280, - 0x033, 0x00000047, -@@ -15262,7 +25364,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15287,7 +25389,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15312,7 +25414,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15322,11 +25424,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000004B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000004A, - 0x03F, 0x000002A8, - 0x033, 0x00000049, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000048, - 0x03F, 0x000FF280, - 0x033, 0x00000047, -@@ -15337,7 +25439,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15362,7 +25464,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15372,11 +25474,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000004B, -- 0x03F, 0x00000287, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000004A, - 0x03F, 0x000002A8, - 0x033, 0x00000049, -- 0x03F, 0x00000207, -+ 0x03F, 0x00000280, - 0x033, 0x00000048, - 0x03F, 0x000FF280, - 0x033, 0x00000047, -@@ -15387,7 +25489,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15412,7 +25514,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15437,7 +25539,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15462,7 +25564,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15487,7 +25589,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15512,7 +25614,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15537,7 +25639,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000044, - 0x03F, 0x00000040, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000004F, - 0x03F, 0x000773C0, - 0x033, 0x0000004E, -@@ -15546,126 +25648,326 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x000773E8, - 0x033, 0x0000004C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000004B, -- 0x03F, 0x00000287, -- 0x033, 0x0000004A, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000287, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000207, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0xA0000000, 0x00000000, -+ 0x033, 0x0000004F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000004E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000004D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000004C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000004B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000004A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000049, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000048, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000047, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000046, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000045, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000044, -+ 0x03F, 0x00000040, -+ 0xB0000000, 0x00000000, -+ 0x033, 0x00000043, -+ 0x03F, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000005B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x00000380, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF380, -+ 0x033, 0x0000005B, -+ 0x03F, 0x00000300, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, - 0x03F, 0x000002A8, -- 0x033, 0x00000049, -- 0x03F, 0x00000207, -- 0x033, 0x00000048, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, - 0x03F, 0x000FF280, -- 0x033, 0x00000047, -+ 0x033, 0x00000057, - 0x03F, 0x00000200, -- 0x033, 0x00000046, -+ 0x033, 0x00000056, - 0x03F, 0x000001C0, -- 0x033, 0x00000045, -+ 0x033, 0x00000055, - 0x03F, 0x00000180, -- 0x033, 0x00000044, -+ 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000004F, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, - 0x03F, 0x000773C0, -- 0x033, 0x0000004E, -+ 0x033, 0x0000005E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000004D, -+ 0x033, 0x0000005D, - 0x03F, 0x000773E8, -- 0x033, 0x0000004C, -+ 0x033, 0x0000005C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000004B, -+ 0x033, 0x0000005B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000004A, -+ 0x033, 0x0000005A, - 0x03F, 0x000002A8, -- 0x033, 0x00000049, -+ 0x033, 0x00000059, - 0x03F, 0x00000280, -- 0x033, 0x00000048, -+ 0x033, 0x00000058, - 0x03F, 0x000FF280, -- 0x033, 0x00000047, -+ 0x033, 0x00000057, - 0x03F, 0x00000200, -- 0x033, 0x00000046, -+ 0x033, 0x00000056, - 0x03F, 0x000001C0, -- 0x033, 0x00000045, -+ 0x033, 0x00000055, - 0x03F, 0x00000180, -- 0x033, 0x00000044, -+ 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000004F, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, - 0x03F, 0x000773C0, -- 0x033, 0x0000004E, -+ 0x033, 0x0000005E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000004D, -+ 0x033, 0x0000005D, - 0x03F, 0x000773E8, -- 0x033, 0x0000004C, -+ 0x033, 0x0000005C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000004B, -+ 0x033, 0x0000005B, - 0x03F, 0x00000287, -- 0x033, 0x0000004A, -+ 0x033, 0x0000005A, - 0x03F, 0x000002A8, -- 0x033, 0x00000049, -+ 0x033, 0x00000059, - 0x03F, 0x00000207, -- 0x033, 0x00000048, -+ 0x033, 0x00000058, - 0x03F, 0x000FF280, -- 0x033, 0x00000047, -+ 0x033, 0x00000057, - 0x03F, 0x00000200, -- 0x033, 0x00000046, -+ 0x033, 0x00000056, - 0x03F, 0x000001C0, -- 0x033, 0x00000045, -+ 0x033, 0x00000055, - 0x03F, 0x00000180, -- 0x033, 0x00000044, -+ 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x0000004F, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, - 0x03F, 0x000773C0, -- 0x033, 0x0000004E, -+ 0x033, 0x0000005E, - 0x03F, 0x000FF3C0, -- 0x033, 0x0000004D, -+ 0x033, 0x0000005D, - 0x03F, 0x000773E8, -- 0x033, 0x0000004C, -+ 0x033, 0x0000005C, - 0x03F, 0x000FF3E8, -- 0x033, 0x0000004B, -+ 0x033, 0x0000005B, - 0x03F, 0x00000287, -- 0x033, 0x0000004A, -+ 0x033, 0x0000005A, - 0x03F, 0x000002A8, -- 0x033, 0x00000049, -+ 0x033, 0x00000059, - 0x03F, 0x00000207, -- 0x033, 0x00000048, -+ 0x033, 0x00000058, - 0x03F, 0x000FF280, -- 0x033, 0x00000047, -+ 0x033, 0x00000057, - 0x03F, 0x00000200, -- 0x033, 0x00000046, -+ 0x033, 0x00000056, - 0x03F, 0x000001C0, -- 0x033, 0x00000045, -+ 0x033, 0x00000055, - 0x03F, 0x00000180, -- 0x033, 0x00000044, -+ 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0xA0000000, 0x00000000, -- 0x033, 0x0000004F, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, - 0x03F, 0x000773E8, -- 0x033, 0x0000004E, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, - 0x03F, 0x000FF3A0, -- 0x033, 0x0000004D, -- 0x03F, 0x00000380, -- 0x033, 0x0000004C, -- 0x03F, 0x000FF380, -- 0x033, 0x0000004B, -- 0x03F, 0x00000300, -- 0x033, 0x0000004A, -+ 0x033, 0x0000005A, - 0x03F, 0x000002A8, -- 0x033, 0x00000049, -+ 0x033, 0x00000059, - 0x03F, 0x00000280, -- 0x033, 0x00000048, -+ 0x033, 0x00000058, - 0x03F, 0x000FF280, -- 0x033, 0x00000047, -+ 0x033, 0x00000057, - 0x03F, 0x00000200, -- 0x033, 0x00000046, -+ 0x033, 0x00000056, - 0x03F, 0x000001C0, -- 0x033, 0x00000045, -+ 0x033, 0x00000055, - 0x03F, 0x00000180, -- 0x033, 0x00000044, -+ 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000043, -- 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15690,7 +25992,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15700,11 +26002,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000005C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000005B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000005A, - 0x03F, 0x000002A8, - 0x033, 0x00000059, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000058, - 0x03F, 0x000FF280, - 0x033, 0x00000057, -@@ -15715,7 +26017,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15725,11 +26027,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000005C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000005B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000005A, - 0x03F, 0x000002A8, - 0x033, 0x00000059, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000058, - 0x03F, 0x000FF280, - 0x033, 0x00000057, -@@ -15740,7 +26042,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15765,7 +26067,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15790,7 +26092,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15800,11 +26102,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000005C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000005B, -- 0x03F, 0x000FF3A0, -+ 0x03F, 0x00000287, - 0x033, 0x0000005A, - 0x03F, 0x000002A8, - 0x033, 0x00000059, -- 0x03F, 0x00000280, -+ 0x03F, 0x00000207, - 0x033, 0x00000058, - 0x03F, 0x000FF280, - 0x033, 0x00000057, -@@ -15815,7 +26117,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15840,7 +26142,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15850,11 +26152,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000005C, - 0x03F, 0x000FF3E8, - 0x033, 0x0000005B, -- 0x03F, 0x00000287, -+ 0x03F, 0x000FF3A0, - 0x033, 0x0000005A, - 0x03F, 0x000002A8, - 0x033, 0x00000059, -- 0x03F, 0x00000207, -+ 0x03F, 0x00000280, - 0x033, 0x00000058, - 0x03F, 0x000FF280, - 0x033, 0x00000057, -@@ -15865,7 +26167,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15890,7 +26192,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15915,7 +26217,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15940,7 +26242,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15965,7 +26267,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -15990,7 +26292,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -16015,7 +26317,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -16040,7 +26342,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -16065,7 +26367,32 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000005F, -+ 0x03F, 0x000773C0, -+ 0x033, 0x0000005E, -+ 0x03F, 0x000FF3C0, -+ 0x033, 0x0000005D, -+ 0x03F, 0x000773E8, -+ 0x033, 0x0000005C, -+ 0x03F, 0x000FF3E8, -+ 0x033, 0x0000005B, -+ 0x03F, 0x000FF3A0, -+ 0x033, 0x0000005A, -+ 0x03F, 0x000002A8, -+ 0x033, 0x00000059, -+ 0x03F, 0x00000280, -+ 0x033, 0x00000058, -+ 0x03F, 0x000FF280, -+ 0x033, 0x00000057, -+ 0x03F, 0x00000200, -+ 0x033, 0x00000056, -+ 0x03F, 0x000001C0, -+ 0x033, 0x00000055, -+ 0x03F, 0x00000180, -+ 0x033, 0x00000054, -+ 0x03F, 0x00000040, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -16090,7 +26417,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000180, - 0x033, 0x00000054, - 0x03F, 0x00000040, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x0000005F, - 0x03F, 0x000773C0, - 0x033, 0x0000005E, -@@ -16143,60 +26470,1701 @@ static const u32 rtw8822c_rf_b[] = { - 0xB0000000, 0x00000000, - 0x033, 0x00000053, - 0x03F, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x08A, 0x000E7DE3, -+ 0x08B, 0x0008FE00, -+ 0x0EE, 0x00000008, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000023, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000023, -+ 0x0EE, 0x00000000, -+ 0x0EF, 0x00004000, -+ 0x033, 0x00000000, -+ 0x03F, 0x0000000F, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, - 0x0EF, 0x00000000, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, - 0x0EF, 0x00000000, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, - 0x0EF, 0x00000000, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, - 0x0EF, 0x00000000, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, - 0x0EF, 0x00000000, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, - 0x0EF, 0x00000000, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, - 0x0EF, 0x00000000, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, - 0x0EF, 0x00000000, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0xA0000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0xB0000000, 0x00000000, -- 0x08A, 0x000E7DE3, -- 0x08B, 0x0008FE00, -- 0x0EE, 0x00000008, -+ 0x0EF, 0x00020000, - 0x033, 0x00000000, -- 0x03F, 0x00000023, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, - 0x033, 0x00000001, -- 0x03F, 0x00000023, -- 0x0EE, 0x00000000, -- 0x0EF, 0x00004000, -- 0x033, 0x00000000, -- 0x03F, 0x0000000F, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, - 0x033, 0x00000002, -- 0x03F, 0x00000000, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -16343,7 +28311,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -16368,7 +28336,154 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00020000, - 0x033, 0x00000007, - 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, - 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, - 0x033, 0x00000008, - 0x03E, 0x00000000, - 0x03F, 0x0002F81C, -@@ -16490,7 +28605,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -16637,7 +28752,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -16784,7 +28899,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -16931,7 +29046,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -17078,7 +29193,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -17225,7 +29340,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -17372,7 +29487,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -17397,7 +29512,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00020000, - 0x033, 0x00000007, - 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -+ 0x03F, 0x0002F81C, - 0x033, 0x00000008, - 0x03E, 0x00000000, - 0x03F, 0x0002F81C, -@@ -17519,7 +29634,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -17666,7 +29781,154 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -17691,7 +29953,154 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00020000, - 0x033, 0x00000007, - 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000008, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002F81C, -+ 0x033, 0x00000009, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00000000, - 0x03F, 0x0002F81C, -+ 0x033, 0x00000010, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000011, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000012, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000013, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000014, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000015, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000016, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000018, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000019, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000001F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000020, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000021, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000022, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000023, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000024, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000027, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x033, 0x00000028, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000029, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002A, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002B, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002C, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002D, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002E, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x0000002F, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, -+ 0x0EF, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x033, 0x00000000, -+ 0x03E, 0x00001C86, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000001, -+ 0x03E, 0x00001C02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000002, -+ 0x03E, 0x00000F02, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000003, -+ 0x03E, 0x00000F00, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000004, -+ 0x03E, 0x00000086, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000005, -+ 0x03E, 0x00000002, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000006, -+ 0x03E, 0x00000000, -+ 0x03F, 0x00020000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00000000, -+ 0x03F, 0x0002C010, - 0x033, 0x00000008, - 0x03E, 0x00000000, - 0x03F, 0x0002F81C, -@@ -17813,7 +30222,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -17960,7 +30369,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -18107,7 +30516,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -18254,7 +30663,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -18279,7 +30688,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00020000, - 0x033, 0x00000007, - 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -+ 0x03F, 0x0002F81C, - 0x033, 0x00000008, - 0x03E, 0x00000000, - 0x03F, 0x0002F81C, -@@ -18401,7 +30810,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, - 0x03E, 0x00001C86, -@@ -18426,7 +30835,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00020000, - 0x033, 0x00000007, - 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -+ 0x03F, 0x0002F81C, - 0x033, 0x00000008, - 0x03E, 0x00000000, - 0x03F, 0x0002F81C, -@@ -18548,10 +30957,10 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0xA0000000, 0x00000000, - 0x0EF, 0x00020000, - 0x033, 0x00000000, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000001, - 0x03E, 0x00001C02, -@@ -18573,10 +30982,10 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00020000, - 0x033, 0x00000007, - 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -+ 0x03F, 0x0002C010, - 0x033, 0x00000008, -- 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -+ 0x03E, 0x00001910, -+ 0x03F, 0x00020000, - 0x033, 0x00000009, - 0x03E, 0x00001C02, - 0x03F, 0x00020000, -@@ -18597,9 +31006,9 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00020000, - 0x033, 0x0000000F, - 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -+ 0x03F, 0x0002C010, - 0x033, 0x00000010, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000011, - 0x03E, 0x00001C02, -@@ -18623,7 +31032,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000018, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000019, - 0x03E, 0x00001C02, -@@ -18647,7 +31056,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000020, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000021, - 0x03E, 0x00001C02, -@@ -18671,7 +31080,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x033, 0x00000028, -- 0x03E, 0x00001C86, -+ 0x03E, 0x00001910, - 0x03F, 0x00020000, - 0x033, 0x00000029, - 0x03E, 0x00001C02, -@@ -18695,1285 +31104,2691 @@ static const u32 rtw8822c_rf_b[] = { - 0x03E, 0x00000000, - 0x03F, 0x0002C010, - 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x01B, 0x00003A40, -+ 0x061, 0x0000D233, -+ 0x062, 0x0004D232, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000C02, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000C02, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x063, 0x00000002, -+ 0xA0000000, 0x00000000, -+ 0x063, 0x00000C02, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000200, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000233, -+ 0x030, 0x00001233, -+ 0x030, 0x00002233, -+ 0x030, 0x00003233, -+ 0x030, 0x00004203, -+ 0x030, 0x00005233, -+ 0x030, 0x00006233, -+ 0x030, 0x00007233, -+ 0x030, 0x00008203, -+ 0x030, 0x00009233, -+ 0x030, 0x0000A233, -+ 0x030, 0x0000B233, -+ 0x030, 0x0000C233, -+ 0x030, 0x0000D233, -+ 0x030, 0x0000E203, -+ 0x030, 0x0000F233, -+ 0x030, 0x00010233, -+ 0x030, 0x00011233, -+ 0x030, 0x00012203, -+ 0x030, 0x00013233, -+ 0x030, 0x00014233, -+ 0x030, 0x00015233, -+ 0x030, 0x00016203, -+ 0x030, 0x00017233, -+ 0x030, 0x00018203, -+ 0x030, 0x00019233, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000233, -+ 0x030, 0x00001233, -+ 0x030, 0x00002233, -+ 0x030, 0x00003233, -+ 0x030, 0x00004203, -+ 0x030, 0x00005233, -+ 0x030, 0x00006233, -+ 0x030, 0x00007233, -+ 0x030, 0x00008203, -+ 0x030, 0x00009233, -+ 0x030, 0x0000A233, -+ 0x030, 0x0000B233, -+ 0x030, 0x0000C233, -+ 0x030, 0x0000D233, -+ 0x030, 0x0000E203, -+ 0x030, 0x0000F233, -+ 0x030, 0x00010233, -+ 0x030, 0x00011233, -+ 0x030, 0x00012203, -+ 0x030, 0x00013233, -+ 0x030, 0x00014233, -+ 0x030, 0x00015233, -+ 0x030, 0x00016203, -+ 0x030, 0x00017233, -+ 0x030, 0x00018203, -+ 0x030, 0x00019233, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000237, -+ 0x030, 0x00001237, -+ 0x030, 0x00002237, -+ 0x030, 0x00003237, -+ 0x030, 0x00004207, -+ 0x030, 0x00005237, -+ 0x030, 0x00006237, -+ 0x030, 0x00007237, -+ 0x030, 0x00008207, -+ 0x030, 0x00009237, -+ 0x030, 0x0000A237, -+ 0x030, 0x0000B237, -+ 0x030, 0x0000C237, -+ 0x030, 0x0000D237, -+ 0x030, 0x0000E207, -+ 0x030, 0x0000F237, -+ 0x030, 0x00010237, -+ 0x030, 0x00011237, -+ 0x030, 0x00012207, -+ 0x030, 0x00013237, -+ 0x030, 0x00014237, -+ 0x030, 0x00015237, -+ 0x030, 0x00016207, -+ 0x030, 0x00017237, -+ 0x030, 0x00018207, -+ 0x030, 0x00019237, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000237, -+ 0x030, 0x00001237, -+ 0x030, 0x00002237, -+ 0x030, 0x00003237, -+ 0x030, 0x00004207, -+ 0x030, 0x00005237, -+ 0x030, 0x00006237, -+ 0x030, 0x00007237, -+ 0x030, 0x00008207, -+ 0x030, 0x00009237, -+ 0x030, 0x0000A237, -+ 0x030, 0x0000B237, -+ 0x030, 0x0000C237, -+ 0x030, 0x0000D237, -+ 0x030, 0x0000E207, -+ 0x030, 0x0000F237, -+ 0x030, 0x00010237, -+ 0x030, 0x00011237, -+ 0x030, 0x00012207, -+ 0x030, 0x00013237, -+ 0x030, 0x00014237, -+ 0x030, 0x00015237, -+ 0x030, 0x00016207, -+ 0x030, 0x00017237, -+ 0x030, 0x00018207, -+ 0x030, 0x00019237, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000237, -+ 0x030, 0x00001237, -+ 0x030, 0x00002237, -+ 0x030, 0x00003237, -+ 0x030, 0x00004207, -+ 0x030, 0x00005237, -+ 0x030, 0x00006237, -+ 0x030, 0x00007237, -+ 0x030, 0x00008207, -+ 0x030, 0x00009237, -+ 0x030, 0x0000A237, -+ 0x030, 0x0000B237, -+ 0x030, 0x0000C237, -+ 0x030, 0x0000D237, -+ 0x030, 0x0000E207, -+ 0x030, 0x0000F237, -+ 0x030, 0x00010237, -+ 0x030, 0x00011237, -+ 0x030, 0x00012207, -+ 0x030, 0x00013237, -+ 0x030, 0x00014237, -+ 0x030, 0x00015237, -+ 0x030, 0x00016207, -+ 0x030, 0x00017237, -+ 0x030, 0x00018207, -+ 0x030, 0x00019237, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000237, -+ 0x030, 0x00001237, -+ 0x030, 0x00002237, -+ 0x030, 0x00003237, -+ 0x030, 0x00004207, -+ 0x030, 0x00005237, -+ 0x030, 0x00006237, -+ 0x030, 0x00007237, -+ 0x030, 0x00008207, -+ 0x030, 0x00009237, -+ 0x030, 0x0000A237, -+ 0x030, 0x0000B237, -+ 0x030, 0x0000C237, -+ 0x030, 0x0000D237, -+ 0x030, 0x0000E207, -+ 0x030, 0x0000F237, -+ 0x030, 0x00010237, -+ 0x030, 0x00011237, -+ 0x030, 0x00012207, -+ 0x030, 0x00013237, -+ 0x030, 0x00014237, -+ 0x030, 0x00015237, -+ 0x030, 0x00016207, -+ 0x030, 0x00017237, -+ 0x030, 0x00018207, -+ 0x030, 0x00019237, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x0EF, 0x00020000, -- 0x033, 0x00000000, -- 0x03E, 0x00001C86, -- 0x03F, 0x00020000, -- 0x033, 0x00000001, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x00000002, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x00000003, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x00000004, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x00000005, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x00000006, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x00000007, -- 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -- 0x033, 0x00000008, -- 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -- 0x033, 0x00000009, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x0000000A, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x0000000B, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x0000000C, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x0000000D, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x0000000E, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x0000000F, -- 0x03E, 0x00000000, -- 0x03F, 0x0002F81C, -- 0x033, 0x00000010, -- 0x03E, 0x00001C86, -- 0x03F, 0x00020000, -- 0x033, 0x00000011, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x00000012, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x00000013, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x00000014, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x00000015, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x00000016, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x00000017, -- 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -- 0x033, 0x00000018, -- 0x03E, 0x00001C86, -- 0x03F, 0x00020000, -- 0x033, 0x00000019, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x0000001A, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x0000001B, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x0000001C, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x0000001D, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x0000001E, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x0000001F, -- 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -- 0x033, 0x00000020, -- 0x03E, 0x00001C86, -- 0x03F, 0x00020000, -- 0x033, 0x00000021, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x00000022, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x00000023, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x00000024, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x00000025, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x00000026, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x00000027, -- 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -- 0x033, 0x00000028, -- 0x03E, 0x00001C86, -- 0x03F, 0x00020000, -- 0x033, 0x00000029, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x0000002A, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x0000002B, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x0000002C, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x0000002D, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x0000002E, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x0000002F, -- 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -- 0x0EF, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000238, -+ 0x030, 0x00001238, -+ 0x030, 0x00002238, -+ 0x030, 0x00003238, -+ 0x030, 0x00004228, -+ 0x030, 0x00005238, -+ 0x030, 0x00006238, -+ 0x030, 0x00007238, -+ 0x030, 0x00008228, -+ 0x030, 0x00009238, -+ 0x030, 0x0000A238, -+ 0x030, 0x0000B238, -+ 0x030, 0x0000C238, -+ 0x030, 0x0000D238, -+ 0x030, 0x0000E228, -+ 0x030, 0x0000F238, -+ 0x030, 0x00010238, -+ 0x030, 0x00011238, -+ 0x030, 0x00012228, -+ 0x030, 0x00013238, -+ 0x030, 0x00014238, -+ 0x030, 0x00015238, -+ 0x030, 0x00016228, -+ 0x030, 0x00017238, -+ 0x030, 0x00018228, -+ 0x030, 0x00019238, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000239, -+ 0x030, 0x00001239, -+ 0x030, 0x00002239, -+ 0x030, 0x00003239, -+ 0x030, 0x00004239, -+ 0x030, 0x00005239, -+ 0x030, 0x00006239, -+ 0x030, 0x00007239, -+ 0x030, 0x00008239, -+ 0x030, 0x00009239, -+ 0x030, 0x0000A239, -+ 0x030, 0x0000B239, -+ 0x030, 0x0000C239, -+ 0x030, 0x0000D239, -+ 0x030, 0x0000E209, -+ 0x030, 0x0000F239, -+ 0x030, 0x00010239, -+ 0x030, 0x00011239, -+ 0x030, 0x00012209, -+ 0x030, 0x00013239, -+ 0x030, 0x00014239, -+ 0x030, 0x00015239, -+ 0x030, 0x00016209, -+ 0x030, 0x00017239, -+ 0x030, 0x00018209, -+ 0x030, 0x00019239, - 0xA0000000, 0x00000000, -- 0x0EF, 0x00020000, -- 0x033, 0x00000000, -- 0x03E, 0x00001910, -- 0x03F, 0x00020000, -- 0x033, 0x00000001, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x00000002, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x00000003, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x00000004, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x00000005, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x00000006, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x00000007, -- 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -- 0x033, 0x00000008, -- 0x03E, 0x00001910, -- 0x03F, 0x00020000, -- 0x033, 0x00000009, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x0000000A, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x0000000B, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x0000000C, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x0000000D, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x0000000E, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x0000000F, -- 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -- 0x033, 0x00000010, -- 0x03E, 0x00001910, -- 0x03F, 0x00020000, -- 0x033, 0x00000011, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x00000012, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x00000013, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x00000014, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x00000015, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x00000016, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x00000017, -- 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -- 0x033, 0x00000018, -- 0x03E, 0x00001910, -- 0x03F, 0x00020000, -- 0x033, 0x00000019, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x0000001A, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x0000001B, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x0000001C, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x0000001D, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x0000001E, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x0000001F, -- 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -- 0x033, 0x00000020, -- 0x03E, 0x00001910, -- 0x03F, 0x00020000, -- 0x033, 0x00000021, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x00000022, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x00000023, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x00000024, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x00000025, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x00000026, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x00000027, -- 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -- 0x033, 0x00000028, -- 0x03E, 0x00001910, -- 0x03F, 0x00020000, -- 0x033, 0x00000029, -- 0x03E, 0x00001C02, -- 0x03F, 0x00020000, -- 0x033, 0x0000002A, -- 0x03E, 0x00000F02, -- 0x03F, 0x00020000, -- 0x033, 0x0000002B, -- 0x03E, 0x00000F00, -- 0x03F, 0x00020000, -- 0x033, 0x0000002C, -- 0x03E, 0x00000086, -- 0x03F, 0x00020000, -- 0x033, 0x0000002D, -- 0x03E, 0x00000002, -- 0x03F, 0x00020000, -- 0x033, 0x0000002E, -- 0x03E, 0x00000000, -- 0x03F, 0x00020000, -- 0x033, 0x0000002F, -- 0x03E, 0x00000000, -- 0x03F, 0x0002C010, -- 0x0EF, 0x00000000, -+ 0x030, 0x00000233, -+ 0x030, 0x00001233, -+ 0x030, 0x00002233, -+ 0x030, 0x00003233, -+ 0x030, 0x00004203, -+ 0x030, 0x00005233, -+ 0x030, 0x00006233, -+ 0x030, 0x00007233, -+ 0x030, 0x00008203, -+ 0x030, 0x00009233, -+ 0x030, 0x0000A233, -+ 0x030, 0x0000B233, -+ 0x030, 0x0000C233, -+ 0x030, 0x0000D233, -+ 0x030, 0x0000E203, -+ 0x030, 0x0000F233, -+ 0x030, 0x00010233, -+ 0x030, 0x00011233, -+ 0x030, 0x00012203, -+ 0x030, 0x00013233, -+ 0x030, 0x00014233, -+ 0x030, 0x00015233, -+ 0x030, 0x00016203, -+ 0x030, 0x00017233, -+ 0x030, 0x00018203, -+ 0x030, 0x00019233, - 0xB0000000, 0x00000000, -- 0x0FE, 0x00000000, -- 0x01B, 0x00003A40, -- 0x061, 0x0000D233, -- 0x062, 0x0004D232, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000080, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000232, -+ 0x030, 0x00001232, -+ 0x030, 0x00002232, -+ 0x030, 0x00003232, -+ 0x030, 0x00004232, -+ 0x030, 0x00005232, -+ 0x030, 0x00006232, -+ 0x030, 0x00007232, -+ 0x030, 0x00008232, -+ 0x030, 0x00009232, -+ 0x030, 0x0000A232, -+ 0x030, 0x0000B232, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000232, -+ 0x030, 0x00001232, -+ 0x030, 0x00002232, -+ 0x030, 0x00003232, -+ 0x030, 0x00004232, -+ 0x030, 0x00005232, -+ 0x030, 0x00006232, -+ 0x030, 0x00007232, -+ 0x030, 0x00008232, -+ 0x030, 0x00009232, -+ 0x030, 0x0000A232, -+ 0x030, 0x0000B232, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x063, 0x00000002, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x030, 0x00000334, -+ 0x030, 0x00001334, -+ 0x030, 0x00002334, -+ 0x030, 0x00003334, -+ 0x030, 0x00004334, -+ 0x030, 0x00005334, -+ 0x030, 0x00006334, -+ 0x030, 0x00007334, -+ 0x030, 0x00008334, -+ 0x030, 0x00009334, -+ 0x030, 0x0000A334, -+ 0x030, 0x0000B334, - 0xA0000000, 0x00000000, -- 0x063, 0x00000C02, -+ 0x030, 0x00000232, -+ 0x030, 0x00001232, -+ 0x030, 0x00002232, -+ 0x030, 0x00003232, -+ 0x030, 0x00004232, -+ 0x030, 0x00005232, -+ 0x030, 0x00006232, -+ 0x030, 0x00007232, -+ 0x030, 0x00008232, -+ 0x030, 0x00009232, -+ 0x030, 0x0000A232, -+ 0x030, 0x0000B232, - 0xB0000000, 0x00000000, -- 0x0EF, 0x00000200, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000237, -- 0x030, 0x00001237, -- 0x030, 0x00002237, -- 0x030, 0x00003237, -- 0x030, 0x00004207, -- 0x030, 0x00005237, -- 0x030, 0x00006237, -- 0x030, 0x00007237, -- 0x030, 0x00008207, -- 0x030, 0x00009237, -- 0x030, 0x0000A237, -- 0x030, 0x0000B237, -- 0x030, 0x0000C237, -- 0x030, 0x0000D237, -- 0x030, 0x0000E207, -- 0x030, 0x0000F237, -- 0x030, 0x00010237, -- 0x030, 0x00011237, -- 0x030, 0x00012207, -- 0x030, 0x00013237, -- 0x030, 0x00014237, -- 0x030, 0x00015237, -- 0x030, 0x00016207, -- 0x030, 0x00017237, -- 0x030, 0x00018207, -- 0x030, 0x00019237, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000040, -+ 0x030, 0x00000770, -+ 0x030, 0x00001770, -+ 0x030, 0x00002440, -+ 0x030, 0x00003440, -+ 0x030, 0x00004330, -+ 0x030, 0x00005330, -+ 0x030, 0x00008770, -+ 0x030, 0x0000A440, -+ 0x030, 0x0000C330, -+ 0x0EF, 0x00000000, -+ 0x0EE, 0x00010000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000237, -- 0x030, 0x00001237, -- 0x030, 0x00002237, -- 0x030, 0x00003237, -- 0x030, 0x00004207, -- 0x030, 0x00005237, -- 0x030, 0x00006237, -- 0x030, 0x00007237, -- 0x030, 0x00008207, -- 0x030, 0x00009237, -- 0x030, 0x0000A237, -- 0x030, 0x0000B237, -- 0x030, 0x0000C237, -- 0x030, 0x0000D237, -- 0x030, 0x0000E207, -- 0x030, 0x0000F237, -- 0x030, 0x00010237, -- 0x030, 0x00011237, -- 0x030, 0x00012207, -- 0x030, 0x00013237, -- 0x030, 0x00014237, -- 0x030, 0x00015237, -- 0x030, 0x00016207, -- 0x030, 0x00017237, -- 0x030, 0x00018207, -- 0x030, 0x00019237, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000237, -- 0x030, 0x00001237, -- 0x030, 0x00002237, -- 0x030, 0x00003237, -- 0x030, 0x00004207, -- 0x030, 0x00005237, -- 0x030, 0x00006237, -- 0x030, 0x00007237, -- 0x030, 0x00008207, -- 0x030, 0x00009237, -- 0x030, 0x0000A237, -- 0x030, 0x0000B237, -- 0x030, 0x0000C237, -- 0x030, 0x0000D237, -- 0x030, 0x0000E207, -- 0x030, 0x0000F237, -- 0x030, 0x00010237, -- 0x030, 0x00011237, -- 0x030, 0x00012207, -- 0x030, 0x00013237, -- 0x030, 0x00014237, -- 0x030, 0x00015237, -- 0x030, 0x00016207, -- 0x030, 0x00017237, -- 0x030, 0x00018207, -- 0x030, 0x00019237, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000237, -- 0x030, 0x00001237, -- 0x030, 0x00002237, -- 0x030, 0x00003237, -- 0x030, 0x00004207, -- 0x030, 0x00005237, -- 0x030, 0x00006237, -- 0x030, 0x00007237, -- 0x030, 0x00008207, -- 0x030, 0x00009237, -- 0x030, 0x0000A237, -- 0x030, 0x0000B237, -- 0x030, 0x0000C237, -- 0x030, 0x0000D237, -- 0x030, 0x0000E207, -- 0x030, 0x0000F237, -- 0x030, 0x00010237, -- 0x030, 0x00011237, -- 0x030, 0x00012207, -- 0x030, 0x00013237, -- 0x030, 0x00014237, -- 0x030, 0x00015237, -- 0x030, 0x00016207, -- 0x030, 0x00017237, -- 0x030, 0x00018207, -- 0x030, 0x00019237, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000238, -- 0x030, 0x00001238, -- 0x030, 0x00002238, -- 0x030, 0x00003238, -- 0x030, 0x00004228, -- 0x030, 0x00005238, -- 0x030, 0x00006238, -- 0x030, 0x00007238, -- 0x030, 0x00008228, -- 0x030, 0x00009238, -- 0x030, 0x0000A238, -- 0x030, 0x0000B238, -- 0x030, 0x0000C238, -- 0x030, 0x0000D238, -- 0x030, 0x0000E228, -- 0x030, 0x0000F238, -- 0x030, 0x00010238, -- 0x030, 0x00011238, -- 0x030, 0x00012228, -- 0x030, 0x00013238, -- 0x030, 0x00014238, -- 0x030, 0x00015238, -- 0x030, 0x00016228, -- 0x030, 0x00017238, -- 0x030, 0x00018228, -- 0x030, 0x00019238, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000239, -- 0x030, 0x00001239, -- 0x030, 0x00002239, -- 0x030, 0x00003239, -- 0x030, 0x00004239, -- 0x030, 0x00005239, -- 0x030, 0x00006239, -- 0x030, 0x00007239, -- 0x030, 0x00008239, -- 0x030, 0x00009239, -- 0x030, 0x0000A239, -- 0x030, 0x0000B239, -- 0x030, 0x0000C239, -- 0x030, 0x0000D239, -- 0x030, 0x0000E209, -- 0x030, 0x0000F239, -- 0x030, 0x00010239, -- 0x030, 0x00011239, -- 0x030, 0x00012209, -- 0x030, 0x00013239, -- 0x030, 0x00014239, -- 0x030, 0x00015239, -- 0x030, 0x00016209, -- 0x030, 0x00017239, -- 0x030, 0x00018209, -- 0x030, 0x00019239, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000200, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000201, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000204, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000205, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000206, -+ 0x03F, 0x0000006B, -+ 0x033, 0x00000207, -+ 0x03F, 0x0000006E, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000071, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000074, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000077, - 0xA0000000, 0x00000000, -- 0x030, 0x00000233, -- 0x030, 0x00001233, -- 0x030, 0x00002233, -- 0x030, 0x00003233, -- 0x030, 0x00004203, -- 0x030, 0x00005233, -- 0x030, 0x00006233, -- 0x030, 0x00007233, -- 0x030, 0x00008203, -- 0x030, 0x00009233, -- 0x030, 0x0000A233, -- 0x030, 0x0000B233, -- 0x030, 0x0000C233, -- 0x030, 0x0000D233, -- 0x030, 0x0000E203, -- 0x030, 0x0000F233, -- 0x030, 0x00010233, -- 0x030, 0x00011233, -- 0x030, 0x00012203, -- 0x030, 0x00013233, -- 0x030, 0x00014233, -- 0x030, 0x00015233, -- 0x030, 0x00016203, -- 0x030, 0x00017233, -- 0x030, 0x00018203, -- 0x030, 0x00019233, -+ 0x033, 0x00000200, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000201, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000202, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000203, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000204, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000205, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000206, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000207, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000208, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000209, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000020A, -+ 0x03F, 0x00000CF7, - 0xB0000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x0EF, 0x00000080, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x030, 0x00000334, -- 0x030, 0x00001334, -- 0x030, 0x00002334, -- 0x030, 0x00003334, -- 0x030, 0x00004334, -- 0x030, 0x00005334, -- 0x030, 0x00006334, -- 0x030, 0x00007334, -- 0x030, 0x00008334, -- 0x030, 0x00009334, -- 0x030, 0x0000A334, -- 0x030, 0x0000B334, -- 0xA0000000, 0x00000000, -- 0x030, 0x00000232, -- 0x030, 0x00001232, -- 0x030, 0x00002232, -- 0x030, 0x00003232, -- 0x030, 0x00004232, -- 0x030, 0x00005232, -- 0x030, 0x00006232, -- 0x030, 0x00007232, -- 0x030, 0x00008232, -- 0x030, 0x00009232, -- 0x030, 0x0000A232, -- 0x030, 0x0000B232, -- 0xB0000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x0EF, 0x00000040, -- 0x030, 0x00000770, -- 0x030, 0x00001770, -- 0x030, 0x00002440, -- 0x030, 0x00003440, -- 0x030, 0x00004330, -- 0x030, 0x00005330, -- 0x030, 0x00008770, -- 0x030, 0x0000A440, -- 0x030, 0x0000C330, -- 0x0EF, 0x00000000, -- 0x0EE, 0x00010000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000200, -+ 0x033, 0x00000280, - 0x03F, 0x00000005, -- 0x033, 0x00000201, -+ 0x033, 0x00000281, - 0x03F, 0x00000008, -- 0x033, 0x00000202, -+ 0x033, 0x00000282, - 0x03F, 0x0000000B, -- 0x033, 0x00000203, -+ 0x033, 0x00000283, - 0x03F, 0x0000000E, -- 0x033, 0x00000204, -+ 0x033, 0x00000284, - 0x03F, 0x0000002B, -- 0x033, 0x00000205, -+ 0x033, 0x00000285, - 0x03F, 0x0000002E, -- 0x033, 0x00000206, -+ 0x033, 0x00000286, - 0x03F, 0x0000006B, -- 0x033, 0x00000207, -+ 0x033, 0x00000287, - 0x03F, 0x0000006E, -- 0x033, 0x00000208, -+ 0x033, 0x00000288, - 0x03F, 0x00000071, -- 0x033, 0x00000209, -+ 0x033, 0x00000289, - 0x03F, 0x00000074, -- 0x033, 0x0000020A, -+ 0x033, 0x0000028A, - 0x03F, 0x00000077, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000200, -+ 0x033, 0x00000280, - 0x03F, 0x00000005, -- 0x033, 0x00000201, -+ 0x033, 0x00000281, - 0x03F, 0x00000008, -- 0x033, 0x00000202, -+ 0x033, 0x00000282, - 0x03F, 0x0000000B, -- 0x033, 0x00000203, -+ 0x033, 0x00000283, - 0x03F, 0x0000000E, -- 0x033, 0x00000204, -+ 0x033, 0x00000284, - 0x03F, 0x0000002B, -- 0x033, 0x00000205, -+ 0x033, 0x00000285, - 0x03F, 0x0000002E, -- 0x033, 0x00000206, -+ 0x033, 0x00000286, - 0x03F, 0x0000006B, -- 0x033, 0x00000207, -+ 0x033, 0x00000287, - 0x03F, 0x0000006E, -- 0x033, 0x00000208, -+ 0x033, 0x00000288, - 0x03F, 0x00000071, -- 0x033, 0x00000209, -+ 0x033, 0x00000289, - 0x03F, 0x00000074, -- 0x033, 0x0000020A, -+ 0x033, 0x0000028A, - 0x03F, 0x00000077, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000200, -+ 0x033, 0x00000280, - 0x03F, 0x00000005, -- 0x033, 0x00000201, -+ 0x033, 0x00000281, - 0x03F, 0x00000008, -- 0x033, 0x00000202, -+ 0x033, 0x00000282, - 0x03F, 0x0000000B, -- 0x033, 0x00000203, -+ 0x033, 0x00000283, - 0x03F, 0x0000000E, -- 0x033, 0x00000204, -+ 0x033, 0x00000284, - 0x03F, 0x0000002B, -- 0x033, 0x00000205, -+ 0x033, 0x00000285, - 0x03F, 0x0000002E, -- 0x033, 0x00000206, -+ 0x033, 0x00000286, - 0x03F, 0x0000006B, -- 0x033, 0x00000207, -+ 0x033, 0x00000287, - 0x03F, 0x0000006E, -- 0x033, 0x00000208, -+ 0x033, 0x00000288, - 0x03F, 0x00000071, -- 0x033, 0x00000209, -+ 0x033, 0x00000289, - 0x03F, 0x00000074, -- 0x033, 0x0000020A, -+ 0x033, 0x0000028A, - 0x03F, 0x00000077, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x033, 0x00000200, -+ 0x033, 0x00000280, - 0x03F, 0x00000005, -- 0x033, 0x00000201, -+ 0x033, 0x00000281, - 0x03F, 0x00000008, -- 0x033, 0x00000202, -+ 0x033, 0x00000282, - 0x03F, 0x0000000B, -- 0x033, 0x00000203, -+ 0x033, 0x00000283, - 0x03F, 0x0000000E, -- 0x033, 0x00000204, -+ 0x033, 0x00000284, - 0x03F, 0x0000002B, -- 0x033, 0x00000205, -+ 0x033, 0x00000285, - 0x03F, 0x0000002E, -- 0x033, 0x00000206, -+ 0x033, 0x00000286, - 0x03F, 0x0000006B, -- 0x033, 0x00000207, -+ 0x033, 0x00000287, - 0x03F, 0x0000006E, -- 0x033, 0x00000208, -+ 0x033, 0x00000288, - 0x03F, 0x00000071, -- 0x033, 0x00000209, -+ 0x033, 0x00000289, - 0x03F, 0x00000074, -- 0x033, 0x0000020A, -+ 0x033, 0x0000028A, - 0x03F, 0x00000077, -- 0xA0000000, 0x00000000, -- 0x033, 0x00000200, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, - 0x03F, 0x0000006A, -- 0x033, 0x00000201, -+ 0x033, 0x00000281, - 0x03F, 0x0000006D, -- 0x033, 0x00000202, -+ 0x033, 0x00000282, - 0x03F, 0x0000046A, -- 0x033, 0x00000203, -+ 0x033, 0x00000283, - 0x03F, 0x0000086A, -- 0x033, 0x00000204, -+ 0x033, 0x00000284, - 0x03F, 0x00000C89, -- 0x033, 0x00000205, -+ 0x033, 0x00000285, - 0x03F, 0x00000CE8, -- 0x033, 0x00000206, -+ 0x033, 0x00000286, - 0x03F, 0x00000CEB, -- 0x033, 0x00000207, -+ 0x033, 0x00000287, - 0x03F, 0x00000CEE, -- 0x033, 0x00000208, -+ 0x033, 0x00000288, - 0x03F, 0x00000CF1, -- 0x033, 0x00000209, -+ 0x033, 0x00000289, - 0x03F, 0x00000CF4, -- 0x033, 0x0000020A, -+ 0x033, 0x0000028A, - 0x03F, 0x00000CF7, -- 0xB0000000, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000280, -- 0x03F, 0x00000005, -+ 0x03F, 0x0000006A, - 0x033, 0x00000281, -- 0x03F, 0x00000008, -+ 0x03F, 0x0000006D, - 0x033, 0x00000282, -- 0x03F, 0x0000000B, -+ 0x03F, 0x0000046A, - 0x033, 0x00000283, -- 0x03F, 0x0000000E, -+ 0x03F, 0x0000086A, - 0x033, 0x00000284, -- 0x03F, 0x0000002B, -+ 0x03F, 0x00000C89, - 0x033, 0x00000285, -- 0x03F, 0x0000002E, -+ 0x03F, 0x00000CE8, - 0x033, 0x00000286, -- 0x03F, 0x0000006B, -+ 0x03F, 0x00000CEB, - 0x033, 0x00000287, -- 0x03F, 0x0000006E, -+ 0x03F, 0x00000CEE, - 0x033, 0x00000288, -- 0x03F, 0x00000071, -+ 0x03F, 0x00000CF1, - 0x033, 0x00000289, -- 0x03F, 0x00000074, -+ 0x03F, 0x00000CF4, - 0x033, 0x0000028A, -- 0x03F, 0x00000077, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000CF7, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000280, -- 0x03F, 0x00000005, -+ 0x03F, 0x0000006A, - 0x033, 0x00000281, -- 0x03F, 0x00000008, -+ 0x03F, 0x0000006D, - 0x033, 0x00000282, -- 0x03F, 0x0000000B, -+ 0x03F, 0x0000046A, - 0x033, 0x00000283, -- 0x03F, 0x0000000E, -+ 0x03F, 0x0000086A, - 0x033, 0x00000284, -- 0x03F, 0x0000002B, -+ 0x03F, 0x00000C89, - 0x033, 0x00000285, -- 0x03F, 0x0000002E, -+ 0x03F, 0x00000CE8, - 0x033, 0x00000286, -- 0x03F, 0x0000006B, -+ 0x03F, 0x00000CEB, - 0x033, 0x00000287, -- 0x03F, 0x0000006E, -+ 0x03F, 0x00000CEE, - 0x033, 0x00000288, -- 0x03F, 0x00000071, -+ 0x03F, 0x00000CF1, - 0x033, 0x00000289, -- 0x03F, 0x00000074, -+ 0x03F, 0x00000CF4, - 0x033, 0x0000028A, -- 0x03F, 0x00000077, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000CF7, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000280, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000280, - 0x03F, 0x00000005, - 0x033, 0x00000281, -@@ -19996,7 +33811,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000074, - 0x033, 0x0000028A, - 0x03F, 0x00000077, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000280, - 0x03F, 0x00000005, - 0x033, 0x00000281, -@@ -20022,28 +33837,508 @@ static const u32 rtw8822c_rf_b[] = { - 0xA0000000, 0x00000000, - 0x033, 0x00000280, - 0x03F, 0x0000006A, -- 0x033, 0x00000281, -+ 0x033, 0x00000281, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000282, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000283, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000284, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000285, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000286, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000287, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000288, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000289, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000028A, -+ 0x03F, 0x00000CF7, -+ 0xB0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000301, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000304, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000305, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000031, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000034, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000053, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000056, -+ 0x033, 0x0000030A, -+ 0x03F, 0x000000D1, -+ 0x0EE, 0x00000000, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x00000005, -+ 0x033, 0x00000301, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000000B, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000000E, -+ 0x033, 0x00000304, -+ 0x03F, 0x0000002B, -+ 0x033, 0x00000305, -+ 0x03F, 0x0000002E, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000031, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000034, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000053, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000056, -+ 0x033, 0x0000030A, -+ 0x03F, 0x000000D1, -+ 0x0EE, 0x00000000, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, - 0x03F, 0x0000006D, -- 0x033, 0x00000282, -+ 0x033, 0x00000302, - 0x03F, 0x0000046A, -- 0x033, 0x00000283, -+ 0x033, 0x00000303, - 0x03F, 0x0000086A, -- 0x033, 0x00000284, -+ 0x033, 0x00000304, - 0x03F, 0x00000C89, -- 0x033, 0x00000285, -+ 0x033, 0x00000305, - 0x03F, 0x00000CE8, -- 0x033, 0x00000286, -+ 0x033, 0x00000306, - 0x03F, 0x00000CEB, -- 0x033, 0x00000287, -+ 0x033, 0x00000307, - 0x03F, 0x00000CEE, -- 0x033, 0x00000288, -+ 0x033, 0x00000308, - 0x03F, 0x00000CF1, -- 0x033, 0x00000289, -+ 0x033, 0x00000309, - 0x03F, 0x00000CF4, -- 0x033, 0x0000028A, -+ 0x033, 0x0000030A, - 0x03F, 0x00000CF7, -- 0xB0000000, 0x00000000, -- 0x83000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000000, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000300, - 0x03F, 0x00000005, - 0x033, 0x00000301, -@@ -20067,7 +34362,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000030A, - 0x03F, 0x000000D1, - 0x0EE, 0x00000000, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000300, - 0x03F, 0x00000005, - 0x033, 0x00000301, -@@ -20091,7 +34386,151 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000030A, - 0x03F, 0x000000D1, - 0x0EE, 0x00000000, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000300, -+ 0x03F, 0x0000006A, -+ 0x033, 0x00000301, -+ 0x03F, 0x0000006D, -+ 0x033, 0x00000302, -+ 0x03F, 0x0000046A, -+ 0x033, 0x00000303, -+ 0x03F, 0x0000086A, -+ 0x033, 0x00000304, -+ 0x03F, 0x00000C89, -+ 0x033, 0x00000305, -+ 0x03F, 0x00000CE8, -+ 0x033, 0x00000306, -+ 0x03F, 0x00000CEB, -+ 0x033, 0x00000307, -+ 0x03F, 0x00000CEE, -+ 0x033, 0x00000308, -+ 0x03F, 0x00000CF1, -+ 0x033, 0x00000309, -+ 0x03F, 0x00000CF4, -+ 0x033, 0x0000030A, -+ 0x03F, 0x00000CF7, -+ 0x0EE, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000300, - 0x03F, 0x00000005, - 0x033, 0x00000301, -@@ -20115,7 +34554,7 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000030A, - 0x03F, 0x000000D1, - 0x0EE, 0x00000000, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000300, - 0x03F, 0x00000005, - 0x033, 0x00000301, -@@ -20165,7 +34604,11 @@ static const u32 rtw8822c_rf_b[] = { - 0x0EE, 0x00000000, - 0xB0000000, 0x00000000, - 0x051, 0x0003C800, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000942C0, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000942C0, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, -@@ -20183,6 +34626,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x052, 0x000902CA, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -20197,10 +34642,28 @@ static const u32 rtw8822c_rf_b[] = { - 0x052, 0x000902CA, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x000902CA, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x052, 0x000902CA, - 0xA0000000, 0x00000000, - 0x052, 0x000942C0, - 0xB0000000, 0x00000000, -@@ -20209,150 +34672,202 @@ static const u32 rtw8822c_rf_b[] = { - 0x057, 0x0004C80A, - 0x0EF, 0x00000020, - 0x033, 0x00000000, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000241C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x0000C246, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000001, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000001, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0000C246, - 0xB0000000, 0x00000000, - 0x033, 0x00000002, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0000C246, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0000C246, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, -@@ -20370,6 +34885,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002C246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -20384,158 +34901,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002C246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0xA0000000, 0x00000000, - 0x03F, 0x0000C246, - 0xB0000000, 0x00000000, - 0x033, 0x00000003, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000241C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x0000C246, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000004, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000004, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0000C246, - 0xB0000000, 0x00000000, - 0x033, 0x00000005, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0000C246, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0000C246, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, -@@ -20553,6 +35140,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002C246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -20567,158 +35156,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002C246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0xA0000000, 0x00000000, - 0x03F, 0x0000C246, - 0xB0000000, 0x00000000, - 0x033, 0x00000006, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000241C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x0000C246, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000007, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000007, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0000C246, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0000C246, - 0xB0000000, 0x00000000, - 0x033, 0x00000008, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0000C246, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0000C246, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, -@@ -20736,6 +35395,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002C246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -20750,158 +35411,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002C246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0xA0000000, 0x00000000, - 0x03F, 0x0000C246, - 0xB0000000, 0x00000000, - 0x033, 0x00000009, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000241C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x0000000A, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000000A, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x0000000B, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, -@@ -20919,6 +35650,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002C246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -20933,158 +35666,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002C246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0xA0000000, 0x00000000, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x0000000C, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000241C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x0000000D, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000241C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000000D, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000241C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000241C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x0000000E, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, -@@ -21102,6 +35905,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002C246, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -21116,158 +35921,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002C246, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002C246, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002C246, - 0xA0000000, 0x00000000, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x0000000F, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00024246, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00024246, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x00024246, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000010, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00024246, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00024246, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00024246, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000010, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00024246, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000011, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00024246, -@@ -21285,6 +36160,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -21299,158 +36176,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0xA0000000, 0x00000000, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000012, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000013, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000013, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000014, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, -@@ -21468,6 +36415,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -21482,158 +36431,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0xA0000000, 0x00000000, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000015, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000016, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000016, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000017, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, -@@ -21651,6 +36670,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -21665,158 +36686,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0xA0000000, 0x00000000, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000018, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000019, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000019, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x0000001A, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, -@@ -21834,6 +36925,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -21848,158 +36941,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0xA0000000, 0x00000000, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x0000001B, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x0000001C, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001C, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x0000001D, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, -@@ -22017,6 +37180,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -22031,158 +37196,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0xA0000000, 0x00000000, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x0000001E, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x0000001F, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000001F, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000020, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, -@@ -22200,6 +37435,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -22214,371 +37451,513 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0xA0000000, 0x00000000, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000021, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000022, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000022, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000023, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000020, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xA0000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0002CA46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0002CA46, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0002CA46, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000024, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x0002CA46, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000024, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000025, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000025, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000026, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, -@@ -22596,6 +37975,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -22610,158 +37991,228 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0xA0000000, 0x00000000, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000027, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0xA0000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000020, -- 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x000209C6, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x033, 0x00000028, -- 0x83000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03E, 0x00000030, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, - 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000028, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x0001CA46, - 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, -+ 0x03F, 0x000209C6, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03E, 0x00000030, - 0x03F, 0x000209C6, - 0xA0000000, 0x00000000, -+ 0x03E, 0x00000020, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x00000029, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, -@@ -22779,6 +38230,8 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x93000016, 0x00000000, 0x40000000, 0x00000000, -@@ -22793,16 +38246,38 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x0002CA46, - 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, - 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0002CA46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0002CA46, - 0xA0000000, 0x00000000, - 0x03F, 0x00008E46, - 0xB0000000, 0x00000000, - 0x033, 0x0000002A, - 0x03E, 0x00000020, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x91000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, -@@ -22819,123 +38294,419 @@ static const u32 rtw8822c_rf_b[] = { - 0x93000004, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x0001CA46, - 0x93000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0001CA46, -+ 0x03F, 0x0001CA46, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x0001CA46, -+ 0xA0000000, 0x00000000, -+ 0x03F, 0x00008E46, -+ 0xB0000000, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x0EE, 0x00010000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000487, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000887, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000947, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D48, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D88, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000DE8, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000487, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000887, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000947, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D48, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D88, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000DE8, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000468, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000868, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000909, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D0A, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D4A, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000D8B, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000468, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000868, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000909, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D0A, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D4A, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000D8B, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000468, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000868, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000909, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D0A, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D4A, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000D8B, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000468, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000868, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000909, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000D0A, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000D4A, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000D8B, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DF7, -+ 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000CC6, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000CC9, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000CCC, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000CCF, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000CD2, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000CD5, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, -+ 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000CC6, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000CC9, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000CCC, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000CCF, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000CD2, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000CD5, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, -+ 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000CC6, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000CC9, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000CCC, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000CCF, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000CD2, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000CD5, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, -+ 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000CC6, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000CC9, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000CCC, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000CCF, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000CD2, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000CD5, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, -+ 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000CC6, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000CC9, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000CCC, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000CCF, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000CD2, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000CD5, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000CC6, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000CC9, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000CCC, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000CCF, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000CD2, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000CD5, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000DD4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000DD7, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0001CA46, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0001CA46, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0001CA46, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0001CA46, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0001CA46, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0001CA46, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0001CA46, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0001CA46, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -- 0x03F, 0x0001CA46, -- 0xA0000000, 0x00000000, -- 0x03F, 0x00008E46, -- 0xB0000000, 0x00000000, -- 0x0EF, 0x00000000, -- 0x0EE, 0x00010000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, -- 0x03F, 0x00000468, -+ 0x03F, 0x00000467, - 0x033, 0x00000061, -- 0x03F, 0x00000868, -+ 0x03F, 0x00000867, - 0x033, 0x00000062, -- 0x03F, 0x00000909, -+ 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D0A, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D4A, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8B, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x91000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x93000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, -- 0x03F, 0x00000468, -+ 0x03F, 0x00000467, - 0x033, 0x00000061, -- 0x03F, 0x00000868, -+ 0x03F, 0x00000867, - 0x033, 0x00000062, -- 0x03F, 0x00000909, -+ 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D0A, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D4A, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8B, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x92000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, -- 0x03F, 0x00000468, -+ 0x03F, 0x00000467, - 0x033, 0x00000061, -- 0x03F, 0x00000868, -+ 0x03F, 0x00000867, - 0x033, 0x00000062, -- 0x03F, 0x00000909, -+ 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D0A, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D4A, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8B, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x92000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, -- 0x03F, 0x00000468, -+ 0x03F, 0x00000467, - 0x033, 0x00000061, -- 0x03F, 0x00000868, -+ 0x03F, 0x00000867, - 0x033, 0x00000062, -- 0x03F, 0x00000909, -+ 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D0A, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D4A, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8B, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -22943,22 +38714,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -22966,22 +38737,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -22989,22 +38760,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23012,22 +38783,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23035,22 +38806,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x94000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23058,22 +38829,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x93000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23081,22 +38852,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23104,22 +38875,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23127,22 +38898,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23150,22 +38921,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23173,22 +38944,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23196,22 +38967,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23219,22 +38990,22 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -- 0x94000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x03F, 0x00000DD7, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000467, - 0x033, 0x00000061, -@@ -23242,21 +39013,21 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000062, - 0x03F, 0x00000908, - 0x033, 0x00000063, -- 0x03F, 0x00000D09, -+ 0x03F, 0x00000CC6, - 0x033, 0x00000064, -- 0x03F, 0x00000D49, -+ 0x03F, 0x00000CC9, - 0x033, 0x00000065, -- 0x03F, 0x00000D8A, -+ 0x03F, 0x00000CCC, - 0x033, 0x00000066, -- 0x03F, 0x00000DEB, -+ 0x03F, 0x00000CCF, - 0x033, 0x00000067, -- 0x03F, 0x00000DEE, -+ 0x03F, 0x00000CD2, - 0x033, 0x00000068, -- 0x03F, 0x00000DF1, -+ 0x03F, 0x00000CD5, - 0x033, 0x00000069, -- 0x03F, 0x00000DF4, -+ 0x03F, 0x00000DD4, - 0x033, 0x0000006A, -- 0x03F, 0x00000DF7, -+ 0x03F, 0x00000DD7, - 0xA0000000, 0x00000000, - 0x033, 0x00000060, - 0x03F, 0x00000487, -@@ -23281,7 +39052,53 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x0000006A, - 0x03F, 0x00000DF7, - 0xB0000000, 0x00000000, -- 0x81000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x8f000000, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000487, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000887, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000947, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D48, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D88, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000DE8, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x9f000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000487, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000887, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000947, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D48, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D88, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000DE8, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x91000001, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000468, - 0x033, 0x00000021, -@@ -23488,6 +39305,29 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -+ 0x93000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, - 0x93000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000467, -@@ -23649,6 +39489,29 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -+ 0x94000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, - 0x94000015, 0x00000000, 0x40000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000467, -@@ -23695,6 +39558,190 @@ static const u32 rtw8822c_rf_b[] = { - 0x03F, 0x00000DF4, - 0x033, 0x0000002A, - 0x03F, 0x00000DF7, -+ 0x95000001, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x95000002, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x95000003, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x95000004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x95000005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x95000006, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x95000015, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, -+ 0x95000016, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000467, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000867, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000908, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000D09, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000D49, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000D8A, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000DEB, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000DEE, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000DF1, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000DF4, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000DF7, - 0xA0000000, 0x00000000, - 0x033, 0x00000020, - 0x03F, 0x00000487, -@@ -23770,10 +39817,6 @@ static const u32 rtw8822c_rf_b[] = { - 0x033, 0x00000007, - 0x03F, 0x00000002, - 0x0EF, 0x00000000, -- 0x0EF, 0x00080000, -- 0x033, 0x00000001, -- 0x03F, 0x000916BF, -- 0x0EF, 0x00000000, - }; - - RTW_DECL_TABLE_RF_RADIO(rtw8822c_rf_b, B); -@@ -24820,7 +40863,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 8, 1, 0, 1, 144, 76, }, - { 9, 1, 0, 1, 144, 127, }, - { 0, 1, 0, 1, 149, 76, }, -- { 2, 1, 0, 1, 149, -128, }, -+ { 2, 1, 0, 1, 149, 54, }, - { 1, 1, 0, 1, 149, 127, }, - { 3, 1, 0, 1, 149, 76, }, - { 4, 1, 0, 1, 149, 74, }, -@@ -24828,9 +40871,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 1, 149, 76, }, - { 7, 1, 0, 1, 149, 54, }, - { 8, 1, 0, 1, 149, 76, }, -- { 9, 1, 0, 1, 149, -128, }, -+ { 9, 1, 0, 1, 149, 54, }, - { 0, 1, 0, 1, 153, 76, }, -- { 2, 1, 0, 1, 153, -128, }, -+ { 2, 1, 0, 1, 153, 54, }, - { 1, 1, 0, 1, 153, 127, }, - { 3, 1, 0, 1, 153, 76, }, - { 4, 1, 0, 1, 153, 74, }, -@@ -24838,9 +40881,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 1, 153, 76, }, - { 7, 1, 0, 1, 153, 54, }, - { 8, 1, 0, 1, 153, 76, }, -- { 9, 1, 0, 1, 153, -128, }, -+ { 9, 1, 0, 1, 153, 54, }, - { 0, 1, 0, 1, 157, 76, }, -- { 2, 1, 0, 1, 157, -128, }, -+ { 2, 1, 0, 1, 157, 54, }, - { 1, 1, 0, 1, 157, 127, }, - { 3, 1, 0, 1, 157, 76, }, - { 4, 1, 0, 1, 157, 74, }, -@@ -24848,9 +40891,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 1, 157, 76, }, - { 7, 1, 0, 1, 157, 54, }, - { 8, 1, 0, 1, 157, 76, }, -- { 9, 1, 0, 1, 157, -128, }, -+ { 9, 1, 0, 1, 157, 54, }, - { 0, 1, 0, 1, 161, 76, }, -- { 2, 1, 0, 1, 161, -128, }, -+ { 2, 1, 0, 1, 161, 54, }, - { 1, 1, 0, 1, 161, 127, }, - { 3, 1, 0, 1, 161, 76, }, - { 4, 1, 0, 1, 161, 74, }, -@@ -24858,9 +40901,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 1, 161, 76, }, - { 7, 1, 0, 1, 161, 54, }, - { 8, 1, 0, 1, 161, 76, }, -- { 9, 1, 0, 1, 161, -128, }, -+ { 9, 1, 0, 1, 161, 54, }, - { 0, 1, 0, 1, 165, 76, }, -- { 2, 1, 0, 1, 165, -128, }, -+ { 2, 1, 0, 1, 165, 54, }, - { 1, 1, 0, 1, 165, 127, }, - { 3, 1, 0, 1, 165, 76, }, - { 4, 1, 0, 1, 165, 74, }, -@@ -24868,7 +40911,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 1, 165, 76, }, - { 7, 1, 0, 1, 165, 54, }, - { 8, 1, 0, 1, 165, 76, }, -- { 9, 1, 0, 1, 165, -128, }, -+ { 9, 1, 0, 1, 165, 54, }, - { 0, 1, 0, 2, 36, 72, }, - { 2, 1, 0, 2, 36, 62, }, - { 1, 1, 0, 2, 36, 62, }, -@@ -25070,7 +41113,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 8, 1, 0, 2, 144, 76, }, - { 9, 1, 0, 2, 144, 127, }, - { 0, 1, 0, 2, 149, 76, }, -- { 2, 1, 0, 2, 149, -128, }, -+ { 2, 1, 0, 2, 149, 54, }, - { 1, 1, 0, 2, 149, 127, }, - { 3, 1, 0, 2, 149, 76, }, - { 4, 1, 0, 2, 149, 74, }, -@@ -25078,9 +41121,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 2, 149, 76, }, - { 7, 1, 0, 2, 149, 54, }, - { 8, 1, 0, 2, 149, 76, }, -- { 9, 1, 0, 2, 149, -128, }, -+ { 9, 1, 0, 2, 149, 54, }, - { 0, 1, 0, 2, 153, 76, }, -- { 2, 1, 0, 2, 153, -128, }, -+ { 2, 1, 0, 2, 153, 54, }, - { 1, 1, 0, 2, 153, 127, }, - { 3, 1, 0, 2, 153, 76, }, - { 4, 1, 0, 2, 153, 74, }, -@@ -25088,9 +41131,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 2, 153, 76, }, - { 7, 1, 0, 2, 153, 54, }, - { 8, 1, 0, 2, 153, 76, }, -- { 9, 1, 0, 2, 153, -128, }, -+ { 9, 1, 0, 2, 153, 54, }, - { 0, 1, 0, 2, 157, 76, }, -- { 2, 1, 0, 2, 157, -128, }, -+ { 2, 1, 0, 2, 157, 54, }, - { 1, 1, 0, 2, 157, 127, }, - { 3, 1, 0, 2, 157, 76, }, - { 4, 1, 0, 2, 157, 74, }, -@@ -25098,9 +41141,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 2, 157, 76, }, - { 7, 1, 0, 2, 157, 54, }, - { 8, 1, 0, 2, 157, 76, }, -- { 9, 1, 0, 2, 157, -128, }, -+ { 9, 1, 0, 2, 157, 54, }, - { 0, 1, 0, 2, 161, 76, }, -- { 2, 1, 0, 2, 161, -128, }, -+ { 2, 1, 0, 2, 161, 54, }, - { 1, 1, 0, 2, 161, 127, }, - { 3, 1, 0, 2, 161, 76, }, - { 4, 1, 0, 2, 161, 74, }, -@@ -25108,9 +41151,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 2, 161, 76, }, - { 7, 1, 0, 2, 161, 54, }, - { 8, 1, 0, 2, 161, 76, }, -- { 9, 1, 0, 2, 161, -128, }, -+ { 9, 1, 0, 2, 161, 54, }, - { 0, 1, 0, 2, 165, 76, }, -- { 2, 1, 0, 2, 165, -128, }, -+ { 2, 1, 0, 2, 165, 54, }, - { 1, 1, 0, 2, 165, 127, }, - { 3, 1, 0, 2, 165, 76, }, - { 4, 1, 0, 2, 165, 74, }, -@@ -25118,7 +41161,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 2, 165, 76, }, - { 7, 1, 0, 2, 165, 54, }, - { 8, 1, 0, 2, 165, 76, }, -- { 9, 1, 0, 2, 165, -128, }, -+ { 9, 1, 0, 2, 165, 54, }, - { 0, 1, 0, 3, 36, 68, }, - { 2, 1, 0, 3, 36, 38, }, - { 1, 1, 0, 3, 36, 50, }, -@@ -25320,7 +41363,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 8, 1, 0, 3, 144, 68, }, - { 9, 1, 0, 3, 144, 127, }, - { 0, 1, 0, 3, 149, 76, }, -- { 2, 1, 0, 3, 149, -128, }, -+ { 2, 1, 0, 3, 149, 30, }, - { 1, 1, 0, 3, 149, 127, }, - { 3, 1, 0, 3, 149, 76, }, - { 4, 1, 0, 3, 149, 60, }, -@@ -25328,9 +41371,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 3, 149, 76, }, - { 7, 1, 0, 3, 149, 30, }, - { 8, 1, 0, 3, 149, 72, }, -- { 9, 1, 0, 3, 149, -128, }, -+ { 9, 1, 0, 3, 149, 30, }, - { 0, 1, 0, 3, 153, 76, }, -- { 2, 1, 0, 3, 153, -128, }, -+ { 2, 1, 0, 3, 153, 30, }, - { 1, 1, 0, 3, 153, 127, }, - { 3, 1, 0, 3, 153, 76, }, - { 4, 1, 0, 3, 153, 60, }, -@@ -25338,9 +41381,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 3, 153, 76, }, - { 7, 1, 0, 3, 153, 30, }, - { 8, 1, 0, 3, 153, 76, }, -- { 9, 1, 0, 3, 153, -128, }, -+ { 9, 1, 0, 3, 153, 30, }, - { 0, 1, 0, 3, 157, 76, }, -- { 2, 1, 0, 3, 157, -128, }, -+ { 2, 1, 0, 3, 157, 30, }, - { 1, 1, 0, 3, 157, 127, }, - { 3, 1, 0, 3, 157, 76, }, - { 4, 1, 0, 3, 157, 60, }, -@@ -25348,9 +41391,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 3, 157, 76, }, - { 7, 1, 0, 3, 157, 30, }, - { 8, 1, 0, 3, 157, 76, }, -- { 9, 1, 0, 3, 157, -128, }, -+ { 9, 1, 0, 3, 157, 30, }, - { 0, 1, 0, 3, 161, 76, }, -- { 2, 1, 0, 3, 161, -128, }, -+ { 2, 1, 0, 3, 161, 30, }, - { 1, 1, 0, 3, 161, 127, }, - { 3, 1, 0, 3, 161, 76, }, - { 4, 1, 0, 3, 161, 60, }, -@@ -25358,9 +41401,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 3, 161, 76, }, - { 7, 1, 0, 3, 161, 30, }, - { 8, 1, 0, 3, 161, 76, }, -- { 9, 1, 0, 3, 161, -128, }, -+ { 9, 1, 0, 3, 161, 30, }, - { 0, 1, 0, 3, 165, 76, }, -- { 2, 1, 0, 3, 165, -128, }, -+ { 2, 1, 0, 3, 165, 30, }, - { 1, 1, 0, 3, 165, 127, }, - { 3, 1, 0, 3, 165, 76, }, - { 4, 1, 0, 3, 165, 60, }, -@@ -25368,7 +41411,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 0, 3, 165, 76, }, - { 7, 1, 0, 3, 165, 30, }, - { 8, 1, 0, 3, 165, 76, }, -- { 9, 1, 0, 3, 165, -128, }, -+ { 9, 1, 0, 3, 165, 30, }, - { 0, 1, 1, 2, 38, 66, }, - { 2, 1, 1, 2, 38, 64, }, - { 1, 1, 1, 2, 38, 62, }, -@@ -25470,7 +41513,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 8, 1, 1, 2, 142, 72, }, - { 9, 1, 1, 2, 142, 127, }, - { 0, 1, 1, 2, 151, 72, }, -- { 2, 1, 1, 2, 151, -128, }, -+ { 2, 1, 1, 2, 151, 54, }, - { 1, 1, 1, 2, 151, 127, }, - { 3, 1, 1, 2, 151, 72, }, - { 4, 1, 1, 2, 151, 72, }, -@@ -25478,9 +41521,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 1, 2, 151, 72, }, - { 7, 1, 1, 2, 151, 54, }, - { 8, 1, 1, 2, 151, 72, }, -- { 9, 1, 1, 2, 151, -128, }, -+ { 9, 1, 1, 2, 151, 54, }, - { 0, 1, 1, 2, 159, 72, }, -- { 2, 1, 1, 2, 159, -128, }, -+ { 2, 1, 1, 2, 159, 54, }, - { 1, 1, 1, 2, 159, 127, }, - { 3, 1, 1, 2, 159, 72, }, - { 4, 1, 1, 2, 159, 72, }, -@@ -25488,7 +41531,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 1, 2, 159, 72, }, - { 7, 1, 1, 2, 159, 54, }, - { 8, 1, 1, 2, 159, 72, }, -- { 9, 1, 1, 2, 159, -128, }, -+ { 9, 1, 1, 2, 159, 54, }, - { 0, 1, 1, 3, 38, 60, }, - { 2, 1, 1, 3, 38, 40, }, - { 1, 1, 1, 3, 38, 50, }, -@@ -25590,7 +41633,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 8, 1, 1, 3, 142, 68, }, - { 9, 1, 1, 3, 142, 127, }, - { 0, 1, 1, 3, 151, 72, }, -- { 2, 1, 1, 3, 151, -128, }, -+ { 2, 1, 1, 3, 151, 30, }, - { 1, 1, 1, 3, 151, 127, }, - { 3, 1, 1, 3, 151, 72, }, - { 4, 1, 1, 3, 151, 66, }, -@@ -25598,9 +41641,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 1, 3, 151, 72, }, - { 7, 1, 1, 3, 151, 30, }, - { 8, 1, 1, 3, 151, 68, }, -- { 9, 1, 1, 3, 151, -128, }, -+ { 9, 1, 1, 3, 151, 30, }, - { 0, 1, 1, 3, 159, 72, }, -- { 2, 1, 1, 3, 159, -128, }, -+ { 2, 1, 1, 3, 159, 30, }, - { 1, 1, 1, 3, 159, 127, }, - { 3, 1, 1, 3, 159, 72, }, - { 4, 1, 1, 3, 159, 66, }, -@@ -25608,7 +41651,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 1, 3, 159, 72, }, - { 7, 1, 1, 3, 159, 30, }, - { 8, 1, 1, 3, 159, 72, }, -- { 9, 1, 1, 3, 159, -128, }, -+ { 9, 1, 1, 3, 159, 30, }, - { 0, 1, 2, 4, 42, 64, }, - { 2, 1, 2, 4, 42, 64, }, - { 1, 1, 2, 4, 42, 64, }, -@@ -25660,7 +41703,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 8, 1, 2, 4, 138, 72, }, - { 9, 1, 2, 4, 138, 127, }, - { 0, 1, 2, 4, 155, 72, }, -- { 2, 1, 2, 4, 155, -128, }, -+ { 2, 1, 2, 4, 155, 54, }, - { 1, 1, 2, 4, 155, 127, }, - { 3, 1, 2, 4, 155, 72, }, - { 4, 1, 2, 4, 155, 68, }, -@@ -25668,7 +41711,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 2, 4, 155, 72, }, - { 7, 1, 2, 4, 155, 54, }, - { 8, 1, 2, 4, 155, 68, }, -- { 9, 1, 2, 4, 155, -128, }, -+ { 9, 1, 2, 4, 155, 54, }, - { 0, 1, 2, 5, 42, 54, }, - { 2, 1, 2, 5, 42, 40, }, - { 1, 1, 2, 5, 42, 50, }, -@@ -25720,7 +41763,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 8, 1, 2, 5, 138, 66, }, - { 9, 1, 2, 5, 138, 127, }, - { 0, 1, 2, 5, 155, 62, }, -- { 2, 1, 2, 5, 155, -128, }, -+ { 2, 1, 2, 5, 155, 30, }, - { 1, 1, 2, 5, 155, 127, }, - { 3, 1, 2, 5, 155, 62, }, - { 4, 1, 2, 5, 155, 58, }, -@@ -25728,145 +41771,145 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { - { 6, 1, 2, 5, 155, 62, }, - { 7, 1, 2, 5, 155, 30, }, - { 8, 1, 2, 5, 155, 62, }, -- { 9, 1, 2, 5, 155, -128, }, -+ { 9, 1, 2, 5, 155, 30, }, - }; - - RTW_DECL_TABLE_TXPWR_LMT(rtw8822c_txpwr_lmt_type0); - - static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 0, 0, 0, 0, 1, 72, }, -- { 2, 0, 0, 0, 1, 60, }, -- { 1, 0, 0, 0, 1, 68, }, -+ { 2, 0, 0, 0, 1, 56, }, -+ { 1, 0, 0, 0, 1, 72, }, - { 3, 0, 0, 0, 1, 72, }, - { 4, 0, 0, 0, 1, 76, }, -- { 5, 0, 0, 0, 1, 60, }, -+ { 5, 0, 0, 0, 1, 56, }, - { 6, 0, 0, 0, 1, 72, }, - { 7, 0, 0, 0, 1, 60, }, - { 8, 0, 0, 0, 1, 72, }, - { 9, 0, 0, 0, 1, 60, }, - { 0, 0, 0, 0, 2, 72, }, -- { 2, 0, 0, 0, 2, 60, }, -- { 1, 0, 0, 0, 2, 68, }, -+ { 2, 0, 0, 0, 2, 56, }, -+ { 1, 0, 0, 0, 2, 72, }, - { 3, 0, 0, 0, 2, 72, }, - { 4, 0, 0, 0, 2, 76, }, -- { 5, 0, 0, 0, 2, 60, }, -+ { 5, 0, 0, 0, 2, 56, }, - { 6, 0, 0, 0, 2, 72, }, - { 7, 0, 0, 0, 2, 60, }, - { 8, 0, 0, 0, 2, 72, }, - { 9, 0, 0, 0, 2, 60, }, - { 0, 0, 0, 0, 3, 76, }, -- { 2, 0, 0, 0, 3, 60, }, -- { 1, 0, 0, 0, 3, 68, }, -+ { 2, 0, 0, 0, 3, 56, }, -+ { 1, 0, 0, 0, 3, 72, }, - { 3, 0, 0, 0, 3, 76, }, - { 4, 0, 0, 0, 3, 76, }, -- { 5, 0, 0, 0, 3, 60, }, -+ { 5, 0, 0, 0, 3, 56, }, - { 6, 0, 0, 0, 3, 76, }, - { 7, 0, 0, 0, 3, 60, }, - { 8, 0, 0, 0, 3, 76, }, - { 9, 0, 0, 0, 3, 60, }, - { 0, 0, 0, 0, 4, 76, }, -- { 2, 0, 0, 0, 4, 60, }, -- { 1, 0, 0, 0, 4, 68, }, -+ { 2, 0, 0, 0, 4, 56, }, -+ { 1, 0, 0, 0, 4, 72, }, - { 3, 0, 0, 0, 4, 76, }, - { 4, 0, 0, 0, 4, 76, }, -- { 5, 0, 0, 0, 4, 60, }, -+ { 5, 0, 0, 0, 4, 56, }, - { 6, 0, 0, 0, 4, 76, }, - { 7, 0, 0, 0, 4, 60, }, - { 8, 0, 0, 0, 4, 76, }, - { 9, 0, 0, 0, 4, 60, }, - { 0, 0, 0, 0, 5, 76, }, -- { 2, 0, 0, 0, 5, 60, }, -- { 1, 0, 0, 0, 5, 68, }, -+ { 2, 0, 0, 0, 5, 56, }, -+ { 1, 0, 0, 0, 5, 72, }, - { 3, 0, 0, 0, 5, 76, }, - { 4, 0, 0, 0, 5, 76, }, -- { 5, 0, 0, 0, 5, 60, }, -+ { 5, 0, 0, 0, 5, 56, }, - { 6, 0, 0, 0, 5, 76, }, - { 7, 0, 0, 0, 5, 60, }, - { 8, 0, 0, 0, 5, 76, }, - { 9, 0, 0, 0, 5, 60, }, - { 0, 0, 0, 0, 6, 76, }, -- { 2, 0, 0, 0, 6, 60, }, -- { 1, 0, 0, 0, 6, 68, }, -+ { 2, 0, 0, 0, 6, 56, }, -+ { 1, 0, 0, 0, 6, 72, }, - { 3, 0, 0, 0, 6, 76, }, - { 4, 0, 0, 0, 6, 76, }, -- { 5, 0, 0, 0, 6, 60, }, -+ { 5, 0, 0, 0, 6, 56, }, - { 6, 0, 0, 0, 6, 76, }, - { 7, 0, 0, 0, 6, 60, }, - { 8, 0, 0, 0, 6, 76, }, - { 9, 0, 0, 0, 6, 60, }, - { 0, 0, 0, 0, 7, 76, }, -- { 2, 0, 0, 0, 7, 60, }, -- { 1, 0, 0, 0, 7, 68, }, -+ { 2, 0, 0, 0, 7, 56, }, -+ { 1, 0, 0, 0, 7, 72, }, - { 3, 0, 0, 0, 7, 76, }, - { 4, 0, 0, 0, 7, 76, }, -- { 5, 0, 0, 0, 7, 60, }, -+ { 5, 0, 0, 0, 7, 56, }, - { 6, 0, 0, 0, 7, 76, }, - { 7, 0, 0, 0, 7, 60, }, - { 8, 0, 0, 0, 7, 76, }, - { 9, 0, 0, 0, 7, 60, }, - { 0, 0, 0, 0, 8, 76, }, -- { 2, 0, 0, 0, 8, 60, }, -- { 1, 0, 0, 0, 8, 68, }, -+ { 2, 0, 0, 0, 8, 56, }, -+ { 1, 0, 0, 0, 8, 72, }, - { 3, 0, 0, 0, 8, 76, }, - { 4, 0, 0, 0, 8, 76, }, -- { 5, 0, 0, 0, 8, 60, }, -+ { 5, 0, 0, 0, 8, 56, }, - { 6, 0, 0, 0, 8, 76, }, - { 7, 0, 0, 0, 8, 60, }, - { 8, 0, 0, 0, 8, 76, }, - { 9, 0, 0, 0, 8, 60, }, - { 0, 0, 0, 0, 9, 76, }, -- { 2, 0, 0, 0, 9, 60, }, -- { 1, 0, 0, 0, 9, 68, }, -+ { 2, 0, 0, 0, 9, 56, }, -+ { 1, 0, 0, 0, 9, 72, }, - { 3, 0, 0, 0, 9, 76, }, - { 4, 0, 0, 0, 9, 76, }, -- { 5, 0, 0, 0, 9, 60, }, -+ { 5, 0, 0, 0, 9, 56, }, - { 6, 0, 0, 0, 9, 76, }, - { 7, 0, 0, 0, 9, 60, }, - { 8, 0, 0, 0, 9, 76, }, - { 9, 0, 0, 0, 9, 60, }, - { 0, 0, 0, 0, 10, 72, }, -- { 2, 0, 0, 0, 10, 60, }, -- { 1, 0, 0, 0, 10, 68, }, -+ { 2, 0, 0, 0, 10, 56, }, -+ { 1, 0, 0, 0, 10, 72, }, - { 3, 0, 0, 0, 10, 72, }, - { 4, 0, 0, 0, 10, 76, }, -- { 5, 0, 0, 0, 10, 60, }, -+ { 5, 0, 0, 0, 10, 56, }, - { 6, 0, 0, 0, 10, 72, }, - { 7, 0, 0, 0, 10, 60, }, - { 8, 0, 0, 0, 10, 72, }, - { 9, 0, 0, 0, 10, 60, }, - { 0, 0, 0, 0, 11, 72, }, -- { 2, 0, 0, 0, 11, 60, }, -- { 1, 0, 0, 0, 11, 68, }, -+ { 2, 0, 0, 0, 11, 56, }, -+ { 1, 0, 0, 0, 11, 72, }, - { 3, 0, 0, 0, 11, 72, }, - { 4, 0, 0, 0, 11, 76, }, -- { 5, 0, 0, 0, 11, 60, }, -+ { 5, 0, 0, 0, 11, 56, }, - { 6, 0, 0, 0, 11, 72, }, - { 7, 0, 0, 0, 11, 60, }, - { 8, 0, 0, 0, 11, 72, }, - { 9, 0, 0, 0, 11, 60, }, - { 0, 0, 0, 0, 12, 44, }, -- { 2, 0, 0, 0, 12, 60, }, -- { 1, 0, 0, 0, 12, 68, }, -+ { 2, 0, 0, 0, 12, 56, }, -+ { 1, 0, 0, 0, 12, 72, }, - { 3, 0, 0, 0, 12, 52, }, - { 4, 0, 0, 0, 12, 76, }, -- { 5, 0, 0, 0, 12, 60, }, -+ { 5, 0, 0, 0, 12, 56, }, - { 6, 0, 0, 0, 12, 52, }, - { 7, 0, 0, 0, 12, 60, }, - { 8, 0, 0, 0, 12, 52, }, - { 9, 0, 0, 0, 12, 60, }, - { 0, 0, 0, 0, 13, 40, }, -- { 2, 0, 0, 0, 13, 60, }, -- { 1, 0, 0, 0, 13, 68, }, -+ { 2, 0, 0, 0, 13, 56, }, -+ { 1, 0, 0, 0, 13, 72, }, - { 3, 0, 0, 0, 13, 48, }, - { 4, 0, 0, 0, 13, 76, }, -- { 5, 0, 0, 0, 13, 60, }, -+ { 5, 0, 0, 0, 13, 56, }, - { 6, 0, 0, 0, 13, 48, }, - { 7, 0, 0, 0, 13, 60, }, - { 8, 0, 0, 0, 13, 48, }, - { 9, 0, 0, 0, 13, 60, }, - { 0, 0, 0, 0, 14, 127, }, - { 2, 0, 0, 0, 14, 127, }, -- { 1, 0, 0, 0, 14, 68, }, -+ { 1, 0, 0, 0, 14, 72, }, - { 3, 0, 0, 0, 14, 127, }, - { 4, 0, 0, 0, 14, 127, }, - { 5, 0, 0, 0, 14, 127, }, -@@ -25998,7 +42041,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 1, 13, 60, }, - { 1, 0, 0, 1, 13, 76, }, - { 3, 0, 0, 1, 13, 28, }, -- { 4, 0, 0, 1, 13, 70, }, -+ { 4, 0, 0, 1, 13, 74, }, - { 5, 0, 0, 1, 13, 60, }, - { 6, 0, 0, 1, 13, 28, }, - { 7, 0, 0, 1, 13, 60, }, -@@ -26138,7 +42181,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 2, 13, 60, }, - { 1, 0, 0, 2, 13, 76, }, - { 3, 0, 0, 2, 13, 28, }, -- { 4, 0, 0, 2, 13, 72, }, -+ { 4, 0, 0, 2, 13, 74, }, - { 5, 0, 0, 2, 13, 60, }, - { 6, 0, 0, 2, 13, 28, }, - { 7, 0, 0, 2, 13, 60, }, -@@ -26158,7 +42201,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 1, 36, }, - { 1, 0, 0, 3, 1, 66, }, - { 3, 0, 0, 3, 1, 52, }, -- { 4, 0, 0, 3, 1, 68, }, -+ { 4, 0, 0, 3, 1, 72, }, - { 5, 0, 0, 3, 1, 36, }, - { 6, 0, 0, 3, 1, 52, }, - { 7, 0, 0, 3, 1, 36, }, -@@ -26168,7 +42211,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 2, 36, }, - { 1, 0, 0, 3, 2, 66, }, - { 3, 0, 0, 3, 2, 60, }, -- { 4, 0, 0, 3, 2, 70, }, -+ { 4, 0, 0, 3, 2, 72, }, - { 5, 0, 0, 3, 2, 36, }, - { 6, 0, 0, 3, 2, 60, }, - { 7, 0, 0, 3, 2, 36, }, -@@ -26178,7 +42221,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 3, 36, }, - { 1, 0, 0, 3, 3, 66, }, - { 3, 0, 0, 3, 3, 64, }, -- { 4, 0, 0, 3, 3, 70, }, -+ { 4, 0, 0, 3, 3, 72, }, - { 5, 0, 0, 3, 3, 36, }, - { 6, 0, 0, 3, 3, 64, }, - { 7, 0, 0, 3, 3, 36, }, -@@ -26188,7 +42231,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 4, 36, }, - { 1, 0, 0, 3, 4, 66, }, - { 3, 0, 0, 3, 4, 68, }, -- { 4, 0, 0, 3, 4, 70, }, -+ { 4, 0, 0, 3, 4, 72, }, - { 5, 0, 0, 3, 4, 36, }, - { 6, 0, 0, 3, 4, 68, }, - { 7, 0, 0, 3, 4, 36, }, -@@ -26198,7 +42241,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 5, 36, }, - { 1, 0, 0, 3, 5, 66, }, - { 3, 0, 0, 3, 5, 76, }, -- { 4, 0, 0, 3, 5, 70, }, -+ { 4, 0, 0, 3, 5, 72, }, - { 5, 0, 0, 3, 5, 36, }, - { 6, 0, 0, 3, 5, 76, }, - { 7, 0, 0, 3, 5, 36, }, -@@ -26208,7 +42251,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 6, 36, }, - { 1, 0, 0, 3, 6, 66, }, - { 3, 0, 0, 3, 6, 76, }, -- { 4, 0, 0, 3, 6, 70, }, -+ { 4, 0, 0, 3, 6, 72, }, - { 5, 0, 0, 3, 6, 36, }, - { 6, 0, 0, 3, 6, 76, }, - { 7, 0, 0, 3, 6, 36, }, -@@ -26218,7 +42261,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 7, 36, }, - { 1, 0, 0, 3, 7, 66, }, - { 3, 0, 0, 3, 7, 76, }, -- { 4, 0, 0, 3, 7, 70, }, -+ { 4, 0, 0, 3, 7, 72, }, - { 5, 0, 0, 3, 7, 36, }, - { 6, 0, 0, 3, 7, 76, }, - { 7, 0, 0, 3, 7, 36, }, -@@ -26228,7 +42271,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 8, 36, }, - { 1, 0, 0, 3, 8, 66, }, - { 3, 0, 0, 3, 8, 68, }, -- { 4, 0, 0, 3, 8, 70, }, -+ { 4, 0, 0, 3, 8, 72, }, - { 5, 0, 0, 3, 8, 36, }, - { 6, 0, 0, 3, 8, 68, }, - { 7, 0, 0, 3, 8, 36, }, -@@ -26238,7 +42281,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 9, 36, }, - { 1, 0, 0, 3, 9, 66, }, - { 3, 0, 0, 3, 9, 64, }, -- { 4, 0, 0, 3, 9, 70, }, -+ { 4, 0, 0, 3, 9, 72, }, - { 5, 0, 0, 3, 9, 36, }, - { 6, 0, 0, 3, 9, 64, }, - { 7, 0, 0, 3, 9, 36, }, -@@ -26248,7 +42291,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 10, 36, }, - { 1, 0, 0, 3, 10, 66, }, - { 3, 0, 0, 3, 10, 60, }, -- { 4, 0, 0, 3, 10, 70, }, -+ { 4, 0, 0, 3, 10, 72, }, - { 5, 0, 0, 3, 10, 36, }, - { 6, 0, 0, 3, 10, 60, }, - { 7, 0, 0, 3, 10, 36, }, -@@ -26258,7 +42301,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 11, 36, }, - { 1, 0, 0, 3, 11, 66, }, - { 3, 0, 0, 3, 11, 52, }, -- { 4, 0, 0, 3, 11, 70, }, -+ { 4, 0, 0, 3, 11, 72, }, - { 5, 0, 0, 3, 11, 36, }, - { 6, 0, 0, 3, 11, 52, }, - { 7, 0, 0, 3, 11, 36, }, -@@ -26268,7 +42311,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 12, 36, }, - { 1, 0, 0, 3, 12, 66, }, - { 3, 0, 0, 3, 12, 40, }, -- { 4, 0, 0, 3, 12, 70, }, -+ { 4, 0, 0, 3, 12, 72, }, - { 5, 0, 0, 3, 12, 36, }, - { 6, 0, 0, 3, 12, 40, }, - { 7, 0, 0, 3, 12, 36, }, -@@ -26278,7 +42321,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 0, 3, 13, 36, }, - { 1, 0, 0, 3, 13, 66, }, - { 3, 0, 0, 3, 13, 28, }, -- { 4, 0, 0, 3, 13, 62, }, -+ { 4, 0, 0, 3, 13, 68, }, - { 5, 0, 0, 3, 13, 36, }, - { 6, 0, 0, 3, 13, 28, }, - { 7, 0, 0, 3, 13, 36, }, -@@ -26458,7 +42501,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 0, 1, 3, 3, 36, }, - { 1, 0, 1, 3, 3, 66, }, - { 3, 0, 1, 3, 3, 48, }, -- { 4, 0, 1, 3, 3, 66, }, -+ { 4, 0, 1, 3, 3, 68, }, - { 5, 0, 1, 3, 3, 36, }, - { 6, 0, 1, 3, 3, 48, }, - { 7, 0, 1, 3, 3, 36, }, -@@ -26575,137 +42618,137 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 8, 0, 1, 3, 14, 127, }, - { 9, 0, 1, 3, 14, 127, }, - { 0, 1, 0, 1, 36, 74, }, -- { 2, 1, 0, 1, 36, 62, }, -- { 1, 1, 0, 1, 36, 60, }, -+ { 2, 1, 0, 1, 36, 58, }, -+ { 1, 1, 0, 1, 36, 62, }, - { 3, 1, 0, 1, 36, 62, }, -- { 4, 1, 0, 1, 36, 76, }, -- { 5, 1, 0, 1, 36, 62, }, -+ { 4, 1, 0, 1, 36, 74, }, -+ { 5, 1, 0, 1, 36, 58, }, - { 6, 1, 0, 1, 36, 64, }, - { 7, 1, 0, 1, 36, 54, }, - { 8, 1, 0, 1, 36, 62, }, - { 9, 1, 0, 1, 36, 62, }, - { 0, 1, 0, 1, 40, 76, }, -- { 2, 1, 0, 1, 40, 62, }, -+ { 2, 1, 0, 1, 40, 58, }, - { 1, 1, 0, 1, 40, 62, }, - { 3, 1, 0, 1, 40, 62, }, - { 4, 1, 0, 1, 40, 76, }, -- { 5, 1, 0, 1, 40, 62, }, -+ { 5, 1, 0, 1, 40, 58, }, - { 6, 1, 0, 1, 40, 64, }, - { 7, 1, 0, 1, 40, 54, }, - { 8, 1, 0, 1, 40, 62, }, - { 9, 1, 0, 1, 40, 62, }, - { 0, 1, 0, 1, 44, 76, }, -- { 2, 1, 0, 1, 44, 62, }, -+ { 2, 1, 0, 1, 44, 58, }, - { 1, 1, 0, 1, 44, 62, }, - { 3, 1, 0, 1, 44, 62, }, - { 4, 1, 0, 1, 44, 76, }, -- { 5, 1, 0, 1, 44, 62, }, -+ { 5, 1, 0, 1, 44, 58, }, - { 6, 1, 0, 1, 44, 64, }, - { 7, 1, 0, 1, 44, 54, }, - { 8, 1, 0, 1, 44, 62, }, - { 9, 1, 0, 1, 44, 62, }, - { 0, 1, 0, 1, 48, 76, }, -- { 2, 1, 0, 1, 48, 62, }, -+ { 2, 1, 0, 1, 48, 58, }, - { 1, 1, 0, 1, 48, 62, }, - { 3, 1, 0, 1, 48, 62, }, -- { 4, 1, 0, 1, 48, 54, }, -- { 5, 1, 0, 1, 48, 62, }, -+ { 4, 1, 0, 1, 48, 58, }, -+ { 5, 1, 0, 1, 48, 58, }, - { 6, 1, 0, 1, 48, 64, }, - { 7, 1, 0, 1, 48, 54, }, - { 8, 1, 0, 1, 48, 62, }, - { 9, 1, 0, 1, 48, 62, }, - { 0, 1, 0, 1, 52, 76, }, -- { 2, 1, 0, 1, 52, 62, }, -+ { 2, 1, 0, 1, 52, 58, }, - { 1, 1, 0, 1, 52, 62, }, - { 3, 1, 0, 1, 52, 64, }, - { 4, 1, 0, 1, 52, 76, }, -- { 5, 1, 0, 1, 52, 62, }, -+ { 5, 1, 0, 1, 52, 58, }, - { 6, 1, 0, 1, 52, 76, }, - { 7, 1, 0, 1, 52, 54, }, - { 8, 1, 0, 1, 52, 76, }, - { 9, 1, 0, 1, 52, 62, }, - { 0, 1, 0, 1, 56, 76, }, -- { 2, 1, 0, 1, 56, 62, }, -+ { 2, 1, 0, 1, 56, 58, }, - { 1, 1, 0, 1, 56, 62, }, - { 3, 1, 0, 1, 56, 64, }, - { 4, 1, 0, 1, 56, 76, }, -- { 5, 1, 0, 1, 56, 62, }, -+ { 5, 1, 0, 1, 56, 58, }, - { 6, 1, 0, 1, 56, 76, }, - { 7, 1, 0, 1, 56, 54, }, - { 8, 1, 0, 1, 56, 76, }, - { 9, 1, 0, 1, 56, 62, }, - { 0, 1, 0, 1, 60, 76, }, -- { 2, 1, 0, 1, 60, 62, }, -+ { 2, 1, 0, 1, 60, 58, }, - { 1, 1, 0, 1, 60, 62, }, - { 3, 1, 0, 1, 60, 64, }, - { 4, 1, 0, 1, 60, 76, }, -- { 5, 1, 0, 1, 60, 62, }, -+ { 5, 1, 0, 1, 60, 58, }, - { 6, 1, 0, 1, 60, 76, }, - { 7, 1, 0, 1, 60, 54, }, - { 8, 1, 0, 1, 60, 76, }, - { 9, 1, 0, 1, 60, 62, }, -- { 0, 1, 0, 1, 64, 74, }, -- { 2, 1, 0, 1, 64, 62, }, -- { 1, 1, 0, 1, 64, 60, }, -+ { 0, 1, 0, 1, 64, 76, }, -+ { 2, 1, 0, 1, 64, 58, }, -+ { 1, 1, 0, 1, 64, 62, }, - { 3, 1, 0, 1, 64, 64, }, - { 4, 1, 0, 1, 64, 76, }, -- { 5, 1, 0, 1, 64, 62, }, -+ { 5, 1, 0, 1, 64, 58, }, - { 6, 1, 0, 1, 64, 74, }, - { 7, 1, 0, 1, 64, 54, }, - { 8, 1, 0, 1, 64, 74, }, - { 9, 1, 0, 1, 64, 62, }, -- { 0, 1, 0, 1, 100, 72, }, -- { 2, 1, 0, 1, 100, 62, }, -+ { 0, 1, 0, 1, 100, 68, }, -+ { 2, 1, 0, 1, 100, 58, }, - { 1, 1, 0, 1, 100, 76, }, -- { 3, 1, 0, 1, 100, 72, }, -+ { 3, 1, 0, 1, 100, 68, }, - { 4, 1, 0, 1, 100, 76, }, -- { 5, 1, 0, 1, 100, 62, }, -+ { 5, 1, 0, 1, 100, 58, }, - { 6, 1, 0, 1, 100, 72, }, - { 7, 1, 0, 1, 100, 54, }, - { 8, 1, 0, 1, 100, 72, }, - { 9, 1, 0, 1, 100, 127, }, - { 0, 1, 0, 1, 104, 76, }, -- { 2, 1, 0, 1, 104, 62, }, -+ { 2, 1, 0, 1, 104, 58, }, - { 1, 1, 0, 1, 104, 76, }, - { 3, 1, 0, 1, 104, 76, }, - { 4, 1, 0, 1, 104, 76, }, -- { 5, 1, 0, 1, 104, 62, }, -+ { 5, 1, 0, 1, 104, 58, }, - { 6, 1, 0, 1, 104, 76, }, - { 7, 1, 0, 1, 104, 54, }, - { 8, 1, 0, 1, 104, 76, }, - { 9, 1, 0, 1, 104, 127, }, - { 0, 1, 0, 1, 108, 76, }, -- { 2, 1, 0, 1, 108, 62, }, -+ { 2, 1, 0, 1, 108, 58, }, - { 1, 1, 0, 1, 108, 76, }, - { 3, 1, 0, 1, 108, 76, }, - { 4, 1, 0, 1, 108, 76, }, -- { 5, 1, 0, 1, 108, 62, }, -+ { 5, 1, 0, 1, 108, 58, }, - { 6, 1, 0, 1, 108, 76, }, - { 7, 1, 0, 1, 108, 54, }, - { 8, 1, 0, 1, 108, 76, }, - { 9, 1, 0, 1, 108, 127, }, - { 0, 1, 0, 1, 112, 76, }, -- { 2, 1, 0, 1, 112, 62, }, -+ { 2, 1, 0, 1, 112, 58, }, - { 1, 1, 0, 1, 112, 76, }, - { 3, 1, 0, 1, 112, 76, }, - { 4, 1, 0, 1, 112, 76, }, -- { 5, 1, 0, 1, 112, 62, }, -+ { 5, 1, 0, 1, 112, 58, }, - { 6, 1, 0, 1, 112, 76, }, - { 7, 1, 0, 1, 112, 54, }, - { 8, 1, 0, 1, 112, 76, }, - { 9, 1, 0, 1, 112, 127, }, - { 0, 1, 0, 1, 116, 76, }, -- { 2, 1, 0, 1, 116, 62, }, -+ { 2, 1, 0, 1, 116, 58, }, - { 1, 1, 0, 1, 116, 76, }, - { 3, 1, 0, 1, 116, 76, }, - { 4, 1, 0, 1, 116, 76, }, -- { 5, 1, 0, 1, 116, 62, }, -+ { 5, 1, 0, 1, 116, 58, }, - { 6, 1, 0, 1, 116, 76, }, - { 7, 1, 0, 1, 116, 54, }, - { 8, 1, 0, 1, 116, 76, }, - { 9, 1, 0, 1, 116, 127, }, - { 0, 1, 0, 1, 120, 76, }, -- { 2, 1, 0, 1, 120, 62, }, -+ { 2, 1, 0, 1, 120, 58, }, - { 1, 1, 0, 1, 120, 76, }, - { 3, 1, 0, 1, 120, 127, }, - { 4, 1, 0, 1, 120, 76, }, -@@ -26715,7 +42758,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 8, 1, 0, 1, 120, 76, }, - { 9, 1, 0, 1, 120, 127, }, - { 0, 1, 0, 1, 124, 76, }, -- { 2, 1, 0, 1, 124, 62, }, -+ { 2, 1, 0, 1, 124, 58, }, - { 1, 1, 0, 1, 124, 76, }, - { 3, 1, 0, 1, 124, 127, }, - { 4, 1, 0, 1, 124, 76, }, -@@ -26725,7 +42768,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 8, 1, 0, 1, 124, 76, }, - { 9, 1, 0, 1, 124, 127, }, - { 0, 1, 0, 1, 128, 76, }, -- { 2, 1, 0, 1, 128, 62, }, -+ { 2, 1, 0, 1, 128, 58, }, - { 1, 1, 0, 1, 128, 76, }, - { 3, 1, 0, 1, 128, 127, }, - { 4, 1, 0, 1, 128, 76, }, -@@ -26735,38 +42778,38 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 8, 1, 0, 1, 128, 76, }, - { 9, 1, 0, 1, 128, 127, }, - { 0, 1, 0, 1, 132, 76, }, -- { 2, 1, 0, 1, 132, 62, }, -+ { 2, 1, 0, 1, 132, 58, }, - { 1, 1, 0, 1, 132, 76, }, - { 3, 1, 0, 1, 132, 76, }, - { 4, 1, 0, 1, 132, 76, }, -- { 5, 1, 0, 1, 132, 62, }, -+ { 5, 1, 0, 1, 132, 58, }, - { 6, 1, 0, 1, 132, 76, }, - { 7, 1, 0, 1, 132, 54, }, - { 8, 1, 0, 1, 132, 76, }, - { 9, 1, 0, 1, 132, 127, }, - { 0, 1, 0, 1, 136, 76, }, -- { 2, 1, 0, 1, 136, 62, }, -+ { 2, 1, 0, 1, 136, 58, }, - { 1, 1, 0, 1, 136, 76, }, - { 3, 1, 0, 1, 136, 76, }, - { 4, 1, 0, 1, 136, 76, }, -- { 5, 1, 0, 1, 136, 62, }, -+ { 5, 1, 0, 1, 136, 58, }, - { 6, 1, 0, 1, 136, 76, }, - { 7, 1, 0, 1, 136, 54, }, - { 8, 1, 0, 1, 136, 76, }, - { 9, 1, 0, 1, 136, 127, }, -- { 0, 1, 0, 1, 140, 72, }, -- { 2, 1, 0, 1, 140, 62, }, -+ { 0, 1, 0, 1, 140, 74, }, -+ { 2, 1, 0, 1, 140, 58, }, - { 1, 1, 0, 1, 140, 76, }, -- { 3, 1, 0, 1, 140, 72, }, -+ { 3, 1, 0, 1, 140, 74, }, - { 4, 1, 0, 1, 140, 76, }, -- { 5, 1, 0, 1, 140, 62, }, -+ { 5, 1, 0, 1, 140, 58, }, - { 6, 1, 0, 1, 140, 72, }, - { 7, 1, 0, 1, 140, 54, }, - { 8, 1, 0, 1, 140, 72, }, - { 9, 1, 0, 1, 140, 127, }, - { 0, 1, 0, 1, 144, 76, }, - { 2, 1, 0, 1, 144, 127, }, -- { 1, 1, 0, 1, 144, 127, }, -+ { 1, 1, 0, 1, 144, 76, }, - { 3, 1, 0, 1, 144, 76, }, - { 4, 1, 0, 1, 144, 76, }, - { 5, 1, 0, 1, 144, 127, }, -@@ -26775,7 +42818,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 8, 1, 0, 1, 144, 76, }, - { 9, 1, 0, 1, 144, 127, }, - { 0, 1, 0, 1, 149, 76, }, -- { 2, 1, 0, 1, 149, -128, }, -+ { 2, 1, 0, 1, 149, 28, }, - { 1, 1, 0, 1, 149, 127, }, - { 3, 1, 0, 1, 149, 76, }, - { 4, 1, 0, 1, 149, 74, }, -@@ -26783,9 +42826,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 0, 1, 149, 76, }, - { 7, 1, 0, 1, 149, 54, }, - { 8, 1, 0, 1, 149, 76, }, -- { 9, 1, 0, 1, 149, -128, }, -+ { 9, 1, 0, 1, 149, 28, }, - { 0, 1, 0, 1, 153, 76, }, -- { 2, 1, 0, 1, 153, -128, }, -+ { 2, 1, 0, 1, 153, 28, }, - { 1, 1, 0, 1, 153, 127, }, - { 3, 1, 0, 1, 153, 76, }, - { 4, 1, 0, 1, 153, 74, }, -@@ -26793,9 +42836,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 0, 1, 153, 76, }, - { 7, 1, 0, 1, 153, 54, }, - { 8, 1, 0, 1, 153, 76, }, -- { 9, 1, 0, 1, 153, -128, }, -+ { 9, 1, 0, 1, 153, 28, }, - { 0, 1, 0, 1, 157, 76, }, -- { 2, 1, 0, 1, 157, -128, }, -+ { 2, 1, 0, 1, 157, 28, }, - { 1, 1, 0, 1, 157, 127, }, - { 3, 1, 0, 1, 157, 76, }, - { 4, 1, 0, 1, 157, 74, }, -@@ -26803,9 +42846,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 0, 1, 157, 76, }, - { 7, 1, 0, 1, 157, 54, }, - { 8, 1, 0, 1, 157, 76, }, -- { 9, 1, 0, 1, 157, -128, }, -+ { 9, 1, 0, 1, 157, 28, }, - { 0, 1, 0, 1, 161, 76, }, -- { 2, 1, 0, 1, 161, -128, }, -+ { 2, 1, 0, 1, 161, 28, }, - { 1, 1, 0, 1, 161, 127, }, - { 3, 1, 0, 1, 161, 76, }, - { 4, 1, 0, 1, 161, 74, }, -@@ -26813,9 +42856,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 0, 1, 161, 76, }, - { 7, 1, 0, 1, 161, 54, }, - { 8, 1, 0, 1, 161, 76, }, -- { 9, 1, 0, 1, 161, -128, }, -+ { 9, 1, 0, 1, 161, 28, }, - { 0, 1, 0, 1, 165, 76, }, -- { 2, 1, 0, 1, 165, -128, }, -+ { 2, 1, 0, 1, 165, 28, }, - { 1, 1, 0, 1, 165, 127, }, - { 3, 1, 0, 1, 165, 76, }, - { 4, 1, 0, 1, 165, 74, }, -@@ -26823,139 +42866,139 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 0, 1, 165, 76, }, - { 7, 1, 0, 1, 165, 54, }, - { 8, 1, 0, 1, 165, 76, }, -- { 9, 1, 0, 1, 165, -128, }, -- { 0, 1, 0, 2, 36, 72, }, -- { 2, 1, 0, 2, 36, 62, }, -- { 1, 1, 0, 2, 36, 62, }, -+ { 9, 1, 0, 1, 165, 28, }, -+ { 0, 1, 0, 2, 36, 70, }, -+ { 2, 1, 0, 2, 36, 58, }, -+ { 1, 1, 0, 2, 36, 64, }, - { 3, 1, 0, 2, 36, 62, }, - { 4, 1, 0, 2, 36, 76, }, -- { 5, 1, 0, 2, 36, 62, }, -+ { 5, 1, 0, 2, 36, 58, }, - { 6, 1, 0, 2, 36, 64, }, - { 7, 1, 0, 2, 36, 54, }, - { 8, 1, 0, 2, 36, 62, }, - { 9, 1, 0, 2, 36, 62, }, - { 0, 1, 0, 2, 40, 76, }, -- { 2, 1, 0, 2, 40, 62, }, -+ { 2, 1, 0, 2, 40, 58, }, - { 1, 1, 0, 2, 40, 62, }, - { 3, 1, 0, 2, 40, 62, }, - { 4, 1, 0, 2, 40, 76, }, -- { 5, 1, 0, 2, 40, 62, }, -+ { 5, 1, 0, 2, 40, 58, }, - { 6, 1, 0, 2, 40, 64, }, - { 7, 1, 0, 2, 40, 54, }, - { 8, 1, 0, 2, 40, 62, }, - { 9, 1, 0, 2, 40, 62, }, - { 0, 1, 0, 2, 44, 76, }, -- { 2, 1, 0, 2, 44, 62, }, -+ { 2, 1, 0, 2, 44, 58, }, - { 1, 1, 0, 2, 44, 62, }, - { 3, 1, 0, 2, 44, 62, }, - { 4, 1, 0, 2, 44, 76, }, -- { 5, 1, 0, 2, 44, 62, }, -+ { 5, 1, 0, 2, 44, 58, }, - { 6, 1, 0, 2, 44, 64, }, - { 7, 1, 0, 2, 44, 54, }, - { 8, 1, 0, 2, 44, 62, }, - { 9, 1, 0, 2, 44, 62, }, - { 0, 1, 0, 2, 48, 76, }, -- { 2, 1, 0, 2, 48, 62, }, -+ { 2, 1, 0, 2, 48, 58, }, - { 1, 1, 0, 2, 48, 62, }, - { 3, 1, 0, 2, 48, 62, }, -- { 4, 1, 0, 2, 48, 54, }, -- { 5, 1, 0, 2, 48, 62, }, -+ { 4, 1, 0, 2, 48, 58, }, -+ { 5, 1, 0, 2, 48, 58, }, - { 6, 1, 0, 2, 48, 64, }, - { 7, 1, 0, 2, 48, 54, }, - { 8, 1, 0, 2, 48, 62, }, - { 9, 1, 0, 2, 48, 62, }, - { 0, 1, 0, 2, 52, 76, }, -- { 2, 1, 0, 2, 52, 62, }, -+ { 2, 1, 0, 2, 52, 58, }, - { 1, 1, 0, 2, 52, 62, }, - { 3, 1, 0, 2, 52, 64, }, - { 4, 1, 0, 2, 52, 76, }, -- { 5, 1, 0, 2, 52, 62, }, -+ { 5, 1, 0, 2, 52, 58, }, - { 6, 1, 0, 2, 52, 76, }, - { 7, 1, 0, 2, 52, 54, }, - { 8, 1, 0, 2, 52, 76, }, - { 9, 1, 0, 2, 52, 62, }, - { 0, 1, 0, 2, 56, 76, }, -- { 2, 1, 0, 2, 56, 62, }, -+ { 2, 1, 0, 2, 56, 58, }, - { 1, 1, 0, 2, 56, 62, }, - { 3, 1, 0, 2, 56, 64, }, - { 4, 1, 0, 2, 56, 76, }, -- { 5, 1, 0, 2, 56, 62, }, -+ { 5, 1, 0, 2, 56, 58, }, - { 6, 1, 0, 2, 56, 76, }, - { 7, 1, 0, 2, 56, 54, }, - { 8, 1, 0, 2, 56, 76, }, - { 9, 1, 0, 2, 56, 62, }, - { 0, 1, 0, 2, 60, 76, }, -- { 2, 1, 0, 2, 60, 62, }, -+ { 2, 1, 0, 2, 60, 58, }, - { 1, 1, 0, 2, 60, 62, }, - { 3, 1, 0, 2, 60, 64, }, - { 4, 1, 0, 2, 60, 76, }, -- { 5, 1, 0, 2, 60, 62, }, -+ { 5, 1, 0, 2, 60, 58, }, - { 6, 1, 0, 2, 60, 76, }, - { 7, 1, 0, 2, 60, 54, }, - { 8, 1, 0, 2, 60, 76, }, - { 9, 1, 0, 2, 60, 62, }, -- { 0, 1, 0, 2, 64, 74, }, -- { 2, 1, 0, 2, 64, 62, }, -- { 1, 1, 0, 2, 64, 60, }, -+ { 0, 1, 0, 2, 64, 70, }, -+ { 2, 1, 0, 2, 64, 58, }, -+ { 1, 1, 0, 2, 64, 62, }, - { 3, 1, 0, 2, 64, 64, }, - { 4, 1, 0, 2, 64, 74, }, -- { 5, 1, 0, 2, 64, 62, }, -+ { 5, 1, 0, 2, 64, 58, }, - { 6, 1, 0, 2, 64, 74, }, - { 7, 1, 0, 2, 64, 54, }, - { 8, 1, 0, 2, 64, 74, }, - { 9, 1, 0, 2, 64, 62, }, -- { 0, 1, 0, 2, 100, 70, }, -- { 2, 1, 0, 2, 100, 62, }, -+ { 0, 1, 0, 2, 100, 66, }, -+ { 2, 1, 0, 2, 100, 58, }, - { 1, 1, 0, 2, 100, 76, }, -- { 3, 1, 0, 2, 100, 70, }, -+ { 3, 1, 0, 2, 100, 66, }, - { 4, 1, 0, 2, 100, 76, }, -- { 5, 1, 0, 2, 100, 62, }, -+ { 5, 1, 0, 2, 100, 58, }, - { 6, 1, 0, 2, 100, 70, }, - { 7, 1, 0, 2, 100, 54, }, - { 8, 1, 0, 2, 100, 70, }, - { 9, 1, 0, 2, 100, 127, }, - { 0, 1, 0, 2, 104, 76, }, -- { 2, 1, 0, 2, 104, 62, }, -+ { 2, 1, 0, 2, 104, 58, }, - { 1, 1, 0, 2, 104, 76, }, - { 3, 1, 0, 2, 104, 76, }, - { 4, 1, 0, 2, 104, 76, }, -- { 5, 1, 0, 2, 104, 62, }, -+ { 5, 1, 0, 2, 104, 58, }, - { 6, 1, 0, 2, 104, 76, }, - { 7, 1, 0, 2, 104, 54, }, - { 8, 1, 0, 2, 104, 76, }, - { 9, 1, 0, 2, 104, 127, }, - { 0, 1, 0, 2, 108, 76, }, -- { 2, 1, 0, 2, 108, 62, }, -+ { 2, 1, 0, 2, 108, 58, }, - { 1, 1, 0, 2, 108, 76, }, - { 3, 1, 0, 2, 108, 76, }, - { 4, 1, 0, 2, 108, 76, }, -- { 5, 1, 0, 2, 108, 62, }, -+ { 5, 1, 0, 2, 108, 58, }, - { 6, 1, 0, 2, 108, 76, }, - { 7, 1, 0, 2, 108, 54, }, - { 8, 1, 0, 2, 108, 76, }, - { 9, 1, 0, 2, 108, 127, }, - { 0, 1, 0, 2, 112, 76, }, -- { 2, 1, 0, 2, 112, 62, }, -+ { 2, 1, 0, 2, 112, 58, }, - { 1, 1, 0, 2, 112, 76, }, - { 3, 1, 0, 2, 112, 76, }, - { 4, 1, 0, 2, 112, 76, }, -- { 5, 1, 0, 2, 112, 62, }, -+ { 5, 1, 0, 2, 112, 58, }, - { 6, 1, 0, 2, 112, 76, }, - { 7, 1, 0, 2, 112, 54, }, - { 8, 1, 0, 2, 112, 76, }, - { 9, 1, 0, 2, 112, 127, }, - { 0, 1, 0, 2, 116, 76, }, -- { 2, 1, 0, 2, 116, 62, }, -+ { 2, 1, 0, 2, 116, 58, }, - { 1, 1, 0, 2, 116, 76, }, - { 3, 1, 0, 2, 116, 76, }, - { 4, 1, 0, 2, 116, 76, }, -- { 5, 1, 0, 2, 116, 62, }, -+ { 5, 1, 0, 2, 116, 58, }, - { 6, 1, 0, 2, 116, 76, }, - { 7, 1, 0, 2, 116, 54, }, - { 8, 1, 0, 2, 116, 76, }, - { 9, 1, 0, 2, 116, 127, }, - { 0, 1, 0, 2, 120, 76, }, -- { 2, 1, 0, 2, 120, 62, }, -+ { 2, 1, 0, 2, 120, 58, }, - { 1, 1, 0, 2, 120, 76, }, - { 3, 1, 0, 2, 120, 127, }, - { 4, 1, 0, 2, 120, 76, }, -@@ -26965,7 +43008,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 8, 1, 0, 2, 120, 76, }, - { 9, 1, 0, 2, 120, 127, }, - { 0, 1, 0, 2, 124, 76, }, -- { 2, 1, 0, 2, 124, 62, }, -+ { 2, 1, 0, 2, 124, 58, }, - { 1, 1, 0, 2, 124, 76, }, - { 3, 1, 0, 2, 124, 127, }, - { 4, 1, 0, 2, 124, 76, }, -@@ -26975,7 +43018,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 8, 1, 0, 2, 124, 76, }, - { 9, 1, 0, 2, 124, 127, }, - { 0, 1, 0, 2, 128, 76, }, -- { 2, 1, 0, 2, 128, 62, }, -+ { 2, 1, 0, 2, 128, 58, }, - { 1, 1, 0, 2, 128, 76, }, - { 3, 1, 0, 2, 128, 127, }, - { 4, 1, 0, 2, 128, 76, }, -@@ -26985,38 +43028,38 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 8, 1, 0, 2, 128, 76, }, - { 9, 1, 0, 2, 128, 127, }, - { 0, 1, 0, 2, 132, 76, }, -- { 2, 1, 0, 2, 132, 62, }, -+ { 2, 1, 0, 2, 132, 58, }, - { 1, 1, 0, 2, 132, 76, }, - { 3, 1, 0, 2, 132, 76, }, - { 4, 1, 0, 2, 132, 76, }, -- { 5, 1, 0, 2, 132, 62, }, -+ { 5, 1, 0, 2, 132, 58, }, - { 6, 1, 0, 2, 132, 76, }, - { 7, 1, 0, 2, 132, 54, }, - { 8, 1, 0, 2, 132, 76, }, - { 9, 1, 0, 2, 132, 127, }, - { 0, 1, 0, 2, 136, 76, }, -- { 2, 1, 0, 2, 136, 62, }, -+ { 2, 1, 0, 2, 136, 58, }, - { 1, 1, 0, 2, 136, 76, }, - { 3, 1, 0, 2, 136, 76, }, - { 4, 1, 0, 2, 136, 76, }, -- { 5, 1, 0, 2, 136, 62, }, -+ { 5, 1, 0, 2, 136, 58, }, - { 6, 1, 0, 2, 136, 76, }, - { 7, 1, 0, 2, 136, 54, }, - { 8, 1, 0, 2, 136, 76, }, - { 9, 1, 0, 2, 136, 127, }, -- { 0, 1, 0, 2, 140, 70, }, -- { 2, 1, 0, 2, 140, 62, }, -+ { 0, 1, 0, 2, 140, 66, }, -+ { 2, 1, 0, 2, 140, 58, }, - { 1, 1, 0, 2, 140, 76, }, -- { 3, 1, 0, 2, 140, 70, }, -+ { 3, 1, 0, 2, 140, 66, }, - { 4, 1, 0, 2, 140, 76, }, -- { 5, 1, 0, 2, 140, 62, }, -+ { 5, 1, 0, 2, 140, 58, }, - { 6, 1, 0, 2, 140, 70, }, - { 7, 1, 0, 2, 140, 54, }, - { 8, 1, 0, 2, 140, 70, }, - { 9, 1, 0, 2, 140, 127, }, - { 0, 1, 0, 2, 144, 76, }, - { 2, 1, 0, 2, 144, 127, }, -- { 1, 1, 0, 2, 144, 127, }, -+ { 1, 1, 0, 2, 144, 76, }, - { 3, 1, 0, 2, 144, 76, }, - { 4, 1, 0, 2, 144, 76, }, - { 5, 1, 0, 2, 144, 127, }, -@@ -27025,7 +43068,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 8, 1, 0, 2, 144, 76, }, - { 9, 1, 0, 2, 144, 127, }, - { 0, 1, 0, 2, 149, 76, }, -- { 2, 1, 0, 2, 149, -128, }, -+ { 2, 1, 0, 2, 149, 28, }, - { 1, 1, 0, 2, 149, 127, }, - { 3, 1, 0, 2, 149, 76, }, - { 4, 1, 0, 2, 149, 74, }, -@@ -27033,9 +43076,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 0, 2, 149, 76, }, - { 7, 1, 0, 2, 149, 54, }, - { 8, 1, 0, 2, 149, 76, }, -- { 9, 1, 0, 2, 149, -128, }, -+ { 9, 1, 0, 2, 149, 28, }, - { 0, 1, 0, 2, 153, 76, }, -- { 2, 1, 0, 2, 153, -128, }, -+ { 2, 1, 0, 2, 153, 28, }, - { 1, 1, 0, 2, 153, 127, }, - { 3, 1, 0, 2, 153, 76, }, - { 4, 1, 0, 2, 153, 74, }, -@@ -27043,9 +43086,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 0, 2, 153, 76, }, - { 7, 1, 0, 2, 153, 54, }, - { 8, 1, 0, 2, 153, 76, }, -- { 9, 1, 0, 2, 153, -128, }, -+ { 9, 1, 0, 2, 153, 28, }, - { 0, 1, 0, 2, 157, 76, }, -- { 2, 1, 0, 2, 157, -128, }, -+ { 2, 1, 0, 2, 157, 28, }, - { 1, 1, 0, 2, 157, 127, }, - { 3, 1, 0, 2, 157, 76, }, - { 4, 1, 0, 2, 157, 74, }, -@@ -27053,9 +43096,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 0, 2, 157, 76, }, - { 7, 1, 0, 2, 157, 54, }, - { 8, 1, 0, 2, 157, 76, }, -- { 9, 1, 0, 2, 157, -128, }, -+ { 9, 1, 0, 2, 157, 28, }, - { 0, 1, 0, 2, 161, 76, }, -- { 2, 1, 0, 2, 161, -128, }, -+ { 2, 1, 0, 2, 161, 28, }, - { 1, 1, 0, 2, 161, 127, }, - { 3, 1, 0, 2, 161, 76, }, - { 4, 1, 0, 2, 161, 74, }, -@@ -27063,9 +43106,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 0, 2, 161, 76, }, - { 7, 1, 0, 2, 161, 54, }, - { 8, 1, 0, 2, 161, 76, }, -- { 9, 1, 0, 2, 161, -128, }, -+ { 9, 1, 0, 2, 161, 28, }, - { 0, 1, 0, 2, 165, 76, }, -- { 2, 1, 0, 2, 165, -128, }, -+ { 2, 1, 0, 2, 165, 28, }, - { 1, 1, 0, 2, 165, 127, }, - { 3, 1, 0, 2, 165, 76, }, - { 4, 1, 0, 2, 165, 74, }, -@@ -27073,262 +43116,262 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 0, 2, 165, 76, }, - { 7, 1, 0, 2, 165, 54, }, - { 8, 1, 0, 2, 165, 76, }, -- { 9, 1, 0, 2, 165, -128, }, -- { 0, 1, 0, 3, 36, 68, }, -- { 2, 1, 0, 3, 36, 38, }, -+ { 9, 1, 0, 2, 165, 28, }, -+ { 0, 1, 0, 3, 36, 64, }, -+ { 2, 1, 0, 3, 36, 36, }, - { 1, 1, 0, 3, 36, 50, }, - { 3, 1, 0, 3, 36, 38, }, - { 4, 1, 0, 3, 36, 66, }, -- { 5, 1, 0, 3, 36, 38, }, -+ { 5, 1, 0, 3, 36, 36, }, - { 6, 1, 0, 3, 36, 52, }, - { 7, 1, 0, 3, 36, 30, }, - { 8, 1, 0, 3, 36, 50, }, - { 9, 1, 0, 3, 36, 38, }, - { 0, 1, 0, 3, 40, 68, }, -- { 2, 1, 0, 3, 40, 38, }, -+ { 2, 1, 0, 3, 40, 36, }, - { 1, 1, 0, 3, 40, 50, }, - { 3, 1, 0, 3, 40, 38, }, - { 4, 1, 0, 3, 40, 66, }, -- { 5, 1, 0, 3, 40, 38, }, -+ { 5, 1, 0, 3, 40, 36, }, - { 6, 1, 0, 3, 40, 52, }, - { 7, 1, 0, 3, 40, 30, }, - { 8, 1, 0, 3, 40, 50, }, - { 9, 1, 0, 3, 40, 38, }, - { 0, 1, 0, 3, 44, 68, }, -- { 2, 1, 0, 3, 44, 38, }, -+ { 2, 1, 0, 3, 44, 36, }, - { 1, 1, 0, 3, 44, 50, }, - { 3, 1, 0, 3, 44, 38, }, - { 4, 1, 0, 3, 44, 66, }, -- { 5, 1, 0, 3, 44, 38, }, -+ { 5, 1, 0, 3, 44, 36, }, - { 6, 1, 0, 3, 44, 52, }, - { 7, 1, 0, 3, 44, 30, }, - { 8, 1, 0, 3, 44, 50, }, - { 9, 1, 0, 3, 44, 38, }, - { 0, 1, 0, 3, 48, 68, }, -- { 2, 1, 0, 3, 48, 38, }, -+ { 2, 1, 0, 3, 48, 36, }, - { 1, 1, 0, 3, 48, 50, }, - { 3, 1, 0, 3, 48, 38, }, -- { 4, 1, 0, 3, 48, 36, }, -- { 5, 1, 0, 3, 48, 38, }, -+ { 4, 1, 0, 3, 48, 42, }, -+ { 5, 1, 0, 3, 48, 36, }, - { 6, 1, 0, 3, 48, 52, }, - { 7, 1, 0, 3, 48, 30, }, - { 8, 1, 0, 3, 48, 50, }, - { 9, 1, 0, 3, 48, 38, }, - { 0, 1, 0, 3, 52, 68, }, -- { 2, 1, 0, 3, 52, 38, }, -+ { 2, 1, 0, 3, 52, 36, }, - { 1, 1, 0, 3, 52, 50, }, - { 3, 1, 0, 3, 52, 40, }, - { 4, 1, 0, 3, 52, 66, }, -- { 5, 1, 0, 3, 52, 38, }, -+ { 5, 1, 0, 3, 52, 36, }, - { 6, 1, 0, 3, 52, 68, }, - { 7, 1, 0, 3, 52, 30, }, - { 8, 1, 0, 3, 52, 68, }, - { 9, 1, 0, 3, 52, 38, }, - { 0, 1, 0, 3, 56, 68, }, -- { 2, 1, 0, 3, 56, 38, }, -+ { 2, 1, 0, 3, 56, 36, }, - { 1, 1, 0, 3, 56, 50, }, - { 3, 1, 0, 3, 56, 40, }, - { 4, 1, 0, 3, 56, 66, }, -- { 5, 1, 0, 3, 56, 38, }, -+ { 5, 1, 0, 3, 56, 36, }, - { 6, 1, 0, 3, 56, 68, }, - { 7, 1, 0, 3, 56, 30, }, - { 8, 1, 0, 3, 56, 68, }, - { 9, 1, 0, 3, 56, 38, }, -- { 0, 1, 0, 3, 60, 66, }, -- { 2, 1, 0, 3, 60, 38, }, -+ { 0, 1, 0, 3, 60, 68, }, -+ { 2, 1, 0, 3, 60, 36, }, - { 1, 1, 0, 3, 60, 50, }, - { 3, 1, 0, 3, 60, 40, }, - { 4, 1, 0, 3, 60, 66, }, -- { 5, 1, 0, 3, 60, 38, }, -+ { 5, 1, 0, 3, 60, 36, }, - { 6, 1, 0, 3, 60, 66, }, - { 7, 1, 0, 3, 60, 30, }, - { 8, 1, 0, 3, 60, 66, }, - { 9, 1, 0, 3, 60, 38, }, -- { 0, 1, 0, 3, 64, 68, }, -- { 2, 1, 0, 3, 64, 38, }, -+ { 0, 1, 0, 3, 64, 66, }, -+ { 2, 1, 0, 3, 64, 36, }, - { 1, 1, 0, 3, 64, 50, }, - { 3, 1, 0, 3, 64, 40, }, - { 4, 1, 0, 3, 64, 66, }, -- { 5, 1, 0, 3, 64, 38, }, -+ { 5, 1, 0, 3, 64, 36, }, - { 6, 1, 0, 3, 64, 68, }, - { 7, 1, 0, 3, 64, 30, }, - { 8, 1, 0, 3, 64, 68, }, - { 9, 1, 0, 3, 64, 38, }, -- { 0, 1, 0, 3, 100, 60, }, -- { 2, 1, 0, 3, 100, 38, }, -+ { 0, 1, 0, 3, 100, 64, }, -+ { 2, 1, 0, 3, 100, 36, }, - { 1, 1, 0, 3, 100, 70, }, -- { 3, 1, 0, 3, 100, 60, }, -- { 4, 1, 0, 3, 100, 64, }, -- { 5, 1, 0, 3, 100, 38, }, -+ { 3, 1, 0, 3, 100, 64, }, -+ { 4, 1, 0, 3, 100, 66, }, -+ { 5, 1, 0, 3, 100, 36, }, - { 6, 1, 0, 3, 100, 60, }, - { 7, 1, 0, 3, 100, 30, }, - { 8, 1, 0, 3, 100, 60, }, - { 9, 1, 0, 3, 100, 127, }, - { 0, 1, 0, 3, 104, 68, }, -- { 2, 1, 0, 3, 104, 38, }, -+ { 2, 1, 0, 3, 104, 36, }, - { 1, 1, 0, 3, 104, 70, }, - { 3, 1, 0, 3, 104, 68, }, -- { 4, 1, 0, 3, 104, 64, }, -- { 5, 1, 0, 3, 104, 38, }, -+ { 4, 1, 0, 3, 104, 66, }, -+ { 5, 1, 0, 3, 104, 36, }, - { 6, 1, 0, 3, 104, 68, }, - { 7, 1, 0, 3, 104, 30, }, - { 8, 1, 0, 3, 104, 68, }, - { 9, 1, 0, 3, 104, 127, }, - { 0, 1, 0, 3, 108, 68, }, -- { 2, 1, 0, 3, 108, 38, }, -+ { 2, 1, 0, 3, 108, 36, }, - { 1, 1, 0, 3, 108, 70, }, - { 3, 1, 0, 3, 108, 68, }, -- { 4, 1, 0, 3, 108, 64, }, -- { 5, 1, 0, 3, 108, 38, }, -+ { 4, 1, 0, 3, 108, 66, }, -+ { 5, 1, 0, 3, 108, 36, }, - { 6, 1, 0, 3, 108, 68, }, - { 7, 1, 0, 3, 108, 30, }, - { 8, 1, 0, 3, 108, 68, }, - { 9, 1, 0, 3, 108, 127, }, - { 0, 1, 0, 3, 112, 68, }, -- { 2, 1, 0, 3, 112, 38, }, -+ { 2, 1, 0, 3, 112, 36, }, - { 1, 1, 0, 3, 112, 70, }, - { 3, 1, 0, 3, 112, 68, }, -- { 4, 1, 0, 3, 112, 64, }, -- { 5, 1, 0, 3, 112, 38, }, -+ { 4, 1, 0, 3, 112, 66, }, -+ { 5, 1, 0, 3, 112, 36, }, - { 6, 1, 0, 3, 112, 68, }, - { 7, 1, 0, 3, 112, 30, }, - { 8, 1, 0, 3, 112, 68, }, - { 9, 1, 0, 3, 112, 127, }, - { 0, 1, 0, 3, 116, 68, }, -- { 2, 1, 0, 3, 116, 38, }, -+ { 2, 1, 0, 3, 116, 36, }, - { 1, 1, 0, 3, 116, 70, }, - { 3, 1, 0, 3, 116, 68, }, -- { 4, 1, 0, 3, 116, 64, }, -- { 5, 1, 0, 3, 116, 38, }, -+ { 4, 1, 0, 3, 116, 66, }, -+ { 5, 1, 0, 3, 116, 36, }, - { 6, 1, 0, 3, 116, 68, }, - { 7, 1, 0, 3, 116, 30, }, - { 8, 1, 0, 3, 116, 68, }, - { 9, 1, 0, 3, 116, 127, }, - { 0, 1, 0, 3, 120, 68, }, -- { 2, 1, 0, 3, 120, 38, }, -+ { 2, 1, 0, 3, 120, 36, }, - { 1, 1, 0, 3, 120, 70, }, - { 3, 1, 0, 3, 120, 127, }, -- { 4, 1, 0, 3, 120, 64, }, -+ { 4, 1, 0, 3, 120, 66, }, - { 5, 1, 0, 3, 120, 127, }, - { 6, 1, 0, 3, 120, 68, }, - { 7, 1, 0, 3, 120, 30, }, - { 8, 1, 0, 3, 120, 68, }, - { 9, 1, 0, 3, 120, 127, }, - { 0, 1, 0, 3, 124, 68, }, -- { 2, 1, 0, 3, 124, 38, }, -+ { 2, 1, 0, 3, 124, 36, }, - { 1, 1, 0, 3, 124, 70, }, - { 3, 1, 0, 3, 124, 127, }, -- { 4, 1, 0, 3, 124, 64, }, -+ { 4, 1, 0, 3, 124, 66, }, - { 5, 1, 0, 3, 124, 127, }, - { 6, 1, 0, 3, 124, 68, }, - { 7, 1, 0, 3, 124, 30, }, - { 8, 1, 0, 3, 124, 68, }, - { 9, 1, 0, 3, 124, 127, }, - { 0, 1, 0, 3, 128, 68, }, -- { 2, 1, 0, 3, 128, 38, }, -+ { 2, 1, 0, 3, 128, 36, }, - { 1, 1, 0, 3, 128, 70, }, - { 3, 1, 0, 3, 128, 127, }, -- { 4, 1, 0, 3, 128, 64, }, -+ { 4, 1, 0, 3, 128, 66, }, - { 5, 1, 0, 3, 128, 127, }, - { 6, 1, 0, 3, 128, 68, }, - { 7, 1, 0, 3, 128, 30, }, - { 8, 1, 0, 3, 128, 68, }, - { 9, 1, 0, 3, 128, 127, }, - { 0, 1, 0, 3, 132, 68, }, -- { 2, 1, 0, 3, 132, 38, }, -+ { 2, 1, 0, 3, 132, 36, }, - { 1, 1, 0, 3, 132, 70, }, - { 3, 1, 0, 3, 132, 68, }, -- { 4, 1, 0, 3, 132, 64, }, -- { 5, 1, 0, 3, 132, 38, }, -+ { 4, 1, 0, 3, 132, 66, }, -+ { 5, 1, 0, 3, 132, 36, }, - { 6, 1, 0, 3, 132, 68, }, - { 7, 1, 0, 3, 132, 30, }, - { 8, 1, 0, 3, 132, 68, }, - { 9, 1, 0, 3, 132, 127, }, - { 0, 1, 0, 3, 136, 68, }, -- { 2, 1, 0, 3, 136, 38, }, -+ { 2, 1, 0, 3, 136, 36, }, - { 1, 1, 0, 3, 136, 70, }, - { 3, 1, 0, 3, 136, 68, }, -- { 4, 1, 0, 3, 136, 64, }, -- { 5, 1, 0, 3, 136, 38, }, -+ { 4, 1, 0, 3, 136, 66, }, -+ { 5, 1, 0, 3, 136, 36, }, - { 6, 1, 0, 3, 136, 68, }, - { 7, 1, 0, 3, 136, 30, }, - { 8, 1, 0, 3, 136, 68, }, - { 9, 1, 0, 3, 136, 127, }, -- { 0, 1, 0, 3, 140, 60, }, -- { 2, 1, 0, 3, 140, 38, }, -+ { 0, 1, 0, 3, 140, 58, }, -+ { 2, 1, 0, 3, 140, 36, }, - { 1, 1, 0, 3, 140, 70, }, -- { 3, 1, 0, 3, 140, 60, }, -- { 4, 1, 0, 3, 140, 64, }, -- { 5, 1, 0, 3, 140, 38, }, -+ { 3, 1, 0, 3, 140, 58, }, -+ { 4, 1, 0, 3, 140, 66, }, -+ { 5, 1, 0, 3, 140, 36, }, - { 6, 1, 0, 3, 140, 60, }, - { 7, 1, 0, 3, 140, 30, }, - { 8, 1, 0, 3, 140, 60, }, - { 9, 1, 0, 3, 140, 127, }, - { 0, 1, 0, 3, 144, 68, }, - { 2, 1, 0, 3, 144, 127, }, -- { 1, 1, 0, 3, 144, 127, }, -+ { 1, 1, 0, 3, 144, 70, }, - { 3, 1, 0, 3, 144, 68, }, -- { 4, 1, 0, 3, 144, 64, }, -+ { 4, 1, 0, 3, 144, 66, }, - { 5, 1, 0, 3, 144, 127, }, - { 6, 1, 0, 3, 144, 68, }, - { 7, 1, 0, 3, 144, 127, }, - { 8, 1, 0, 3, 144, 68, }, - { 9, 1, 0, 3, 144, 127, }, - { 0, 1, 0, 3, 149, 76, }, -- { 2, 1, 0, 3, 149, -128, }, -+ { 2, 1, 0, 3, 149, 4, }, - { 1, 1, 0, 3, 149, 127, }, - { 3, 1, 0, 3, 149, 76, }, -- { 4, 1, 0, 3, 149, 60, }, -+ { 4, 1, 0, 3, 149, 62, }, - { 5, 1, 0, 3, 149, 76, }, - { 6, 1, 0, 3, 149, 76, }, - { 7, 1, 0, 3, 149, 30, }, - { 8, 1, 0, 3, 149, 72, }, -- { 9, 1, 0, 3, 149, -128, }, -+ { 9, 1, 0, 3, 149, 4, }, - { 0, 1, 0, 3, 153, 76, }, -- { 2, 1, 0, 3, 153, -128, }, -+ { 2, 1, 0, 3, 153, 4, }, - { 1, 1, 0, 3, 153, 127, }, - { 3, 1, 0, 3, 153, 76, }, -- { 4, 1, 0, 3, 153, 60, }, -+ { 4, 1, 0, 3, 153, 62, }, - { 5, 1, 0, 3, 153, 76, }, - { 6, 1, 0, 3, 153, 76, }, - { 7, 1, 0, 3, 153, 30, }, - { 8, 1, 0, 3, 153, 76, }, -- { 9, 1, 0, 3, 153, -128, }, -+ { 9, 1, 0, 3, 153, 4, }, - { 0, 1, 0, 3, 157, 76, }, -- { 2, 1, 0, 3, 157, -128, }, -+ { 2, 1, 0, 3, 157, 4, }, - { 1, 1, 0, 3, 157, 127, }, - { 3, 1, 0, 3, 157, 76, }, -- { 4, 1, 0, 3, 157, 60, }, -+ { 4, 1, 0, 3, 157, 62, }, - { 5, 1, 0, 3, 157, 76, }, - { 6, 1, 0, 3, 157, 76, }, - { 7, 1, 0, 3, 157, 30, }, - { 8, 1, 0, 3, 157, 76, }, -- { 9, 1, 0, 3, 157, -128, }, -+ { 9, 1, 0, 3, 157, 4, }, - { 0, 1, 0, 3, 161, 76, }, -- { 2, 1, 0, 3, 161, -128, }, -+ { 2, 1, 0, 3, 161, 4, }, - { 1, 1, 0, 3, 161, 127, }, - { 3, 1, 0, 3, 161, 76, }, -- { 4, 1, 0, 3, 161, 60, }, -+ { 4, 1, 0, 3, 161, 62, }, - { 5, 1, 0, 3, 161, 76, }, - { 6, 1, 0, 3, 161, 76, }, - { 7, 1, 0, 3, 161, 30, }, - { 8, 1, 0, 3, 161, 76, }, -- { 9, 1, 0, 3, 161, -128, }, -+ { 9, 1, 0, 3, 161, 4, }, - { 0, 1, 0, 3, 165, 76, }, -- { 2, 1, 0, 3, 165, -128, }, -+ { 2, 1, 0, 3, 165, 4, }, - { 1, 1, 0, 3, 165, 127, }, - { 3, 1, 0, 3, 165, 76, }, -- { 4, 1, 0, 3, 165, 60, }, -+ { 4, 1, 0, 3, 165, 62, }, - { 5, 1, 0, 3, 165, 76, }, - { 6, 1, 0, 3, 165, 76, }, - { 7, 1, 0, 3, 165, 30, }, - { 8, 1, 0, 3, 165, 76, }, -- { 9, 1, 0, 3, 165, -128, }, -+ { 9, 1, 0, 3, 165, 4, }, - { 0, 1, 1, 2, 38, 66, }, - { 2, 1, 1, 2, 38, 64, }, -- { 1, 1, 1, 2, 38, 62, }, -+ { 1, 1, 1, 2, 38, 64, }, - { 3, 1, 1, 2, 38, 64, }, -- { 4, 1, 1, 2, 38, 72, }, -+ { 4, 1, 1, 2, 38, 64, }, - { 5, 1, 1, 2, 38, 64, }, - { 6, 1, 1, 2, 38, 64, }, - { 7, 1, 1, 2, 38, 54, }, -@@ -27336,9 +43379,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 9, 1, 1, 2, 38, 64, }, - { 0, 1, 1, 2, 46, 72, }, - { 2, 1, 1, 2, 46, 64, }, -- { 1, 1, 1, 2, 46, 62, }, -+ { 1, 1, 1, 2, 46, 64, }, - { 3, 1, 1, 2, 46, 64, }, -- { 4, 1, 1, 2, 46, 60, }, -+ { 4, 1, 1, 2, 46, 70, }, - { 5, 1, 1, 2, 46, 64, }, - { 6, 1, 1, 2, 46, 64, }, - { 7, 1, 1, 2, 46, 54, }, -@@ -27346,7 +43389,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 9, 1, 1, 2, 46, 64, }, - { 0, 1, 1, 2, 54, 72, }, - { 2, 1, 1, 2, 54, 64, }, -- { 1, 1, 1, 2, 54, 62, }, -+ { 1, 1, 1, 2, 54, 64, }, - { 3, 1, 1, 2, 54, 64, }, - { 4, 1, 1, 2, 54, 72, }, - { 5, 1, 1, 2, 54, 64, }, -@@ -27354,21 +43397,21 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 7, 1, 1, 2, 54, 54, }, - { 8, 1, 1, 2, 54, 72, }, - { 9, 1, 1, 2, 54, 64, }, -- { 0, 1, 1, 2, 62, 64, }, -+ { 0, 1, 1, 2, 62, 60, }, - { 2, 1, 1, 2, 62, 64, }, - { 1, 1, 1, 2, 62, 62, }, -- { 3, 1, 1, 2, 62, 64, }, -- { 4, 1, 1, 2, 62, 70, }, -+ { 3, 1, 1, 2, 62, 60, }, -+ { 4, 1, 1, 2, 62, 60, }, - { 5, 1, 1, 2, 62, 64, }, - { 6, 1, 1, 2, 62, 64, }, - { 7, 1, 1, 2, 62, 54, }, - { 8, 1, 1, 2, 62, 64, }, - { 9, 1, 1, 2, 62, 64, }, -- { 0, 1, 1, 2, 102, 58, }, -+ { 0, 1, 1, 2, 102, 60, }, - { 2, 1, 1, 2, 102, 64, }, - { 1, 1, 1, 2, 102, 72, }, -- { 3, 1, 1, 2, 102, 58, }, -- { 4, 1, 1, 2, 102, 72, }, -+ { 3, 1, 1, 2, 102, 60, }, -+ { 4, 1, 1, 2, 102, 64, }, - { 5, 1, 1, 2, 102, 64, }, - { 6, 1, 1, 2, 102, 58, }, - { 7, 1, 1, 2, 102, 54, }, -@@ -27416,7 +43459,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 9, 1, 1, 2, 134, 127, }, - { 0, 1, 1, 2, 142, 72, }, - { 2, 1, 1, 2, 142, 127, }, -- { 1, 1, 1, 2, 142, 127, }, -+ { 1, 1, 1, 2, 142, 72, }, - { 3, 1, 1, 2, 142, 72, }, - { 4, 1, 1, 2, 142, 72, }, - { 5, 1, 1, 2, 142, 127, }, -@@ -27425,7 +43468,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 8, 1, 1, 2, 142, 72, }, - { 9, 1, 1, 2, 142, 127, }, - { 0, 1, 1, 2, 151, 72, }, -- { 2, 1, 1, 2, 151, -128, }, -+ { 2, 1, 1, 2, 151, 28, }, - { 1, 1, 1, 2, 151, 127, }, - { 3, 1, 1, 2, 151, 72, }, - { 4, 1, 1, 2, 151, 72, }, -@@ -27433,9 +43476,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 1, 2, 151, 72, }, - { 7, 1, 1, 2, 151, 54, }, - { 8, 1, 1, 2, 151, 72, }, -- { 9, 1, 1, 2, 151, -128, }, -+ { 9, 1, 1, 2, 151, 28, }, - { 0, 1, 1, 2, 159, 72, }, -- { 2, 1, 1, 2, 159, -128, }, -+ { 2, 1, 1, 2, 159, 28, }, - { 1, 1, 1, 2, 159, 127, }, - { 3, 1, 1, 2, 159, 72, }, - { 4, 1, 1, 2, 159, 72, }, -@@ -27443,12 +43486,12 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 1, 2, 159, 72, }, - { 7, 1, 1, 2, 159, 54, }, - { 8, 1, 1, 2, 159, 72, }, -- { 9, 1, 1, 2, 159, -128, }, -+ { 9, 1, 1, 2, 159, 28, }, - { 0, 1, 1, 3, 38, 60, }, - { 2, 1, 1, 3, 38, 40, }, - { 1, 1, 1, 3, 38, 50, }, - { 3, 1, 1, 3, 38, 40, }, -- { 4, 1, 1, 3, 38, 62, }, -+ { 4, 1, 1, 3, 38, 54, }, - { 5, 1, 1, 3, 38, 40, }, - { 6, 1, 1, 3, 38, 52, }, - { 7, 1, 1, 3, 38, 30, }, -@@ -27458,7 +43501,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 1, 1, 3, 46, 40, }, - { 1, 1, 1, 3, 46, 50, }, - { 3, 1, 1, 3, 46, 40, }, -- { 4, 1, 1, 3, 46, 46, }, -+ { 4, 1, 1, 3, 46, 54, }, - { 5, 1, 1, 3, 46, 40, }, - { 6, 1, 1, 3, 46, 52, }, - { 7, 1, 1, 3, 46, 30, }, -@@ -27468,7 +43511,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 1, 1, 3, 54, 40, }, - { 1, 1, 1, 3, 54, 50, }, - { 3, 1, 1, 3, 54, 40, }, -- { 4, 1, 1, 3, 54, 62, }, -+ { 4, 1, 1, 3, 54, 66, }, - { 5, 1, 1, 3, 54, 40, }, - { 6, 1, 1, 3, 54, 68, }, - { 7, 1, 1, 3, 54, 30, }, -@@ -27478,17 +43521,17 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 1, 1, 3, 62, 40, }, - { 1, 1, 1, 3, 62, 48, }, - { 3, 1, 1, 3, 62, 40, }, -- { 4, 1, 1, 3, 62, 58, }, -+ { 4, 1, 1, 3, 62, 50, }, - { 5, 1, 1, 3, 62, 40, }, - { 6, 1, 1, 3, 62, 58, }, - { 7, 1, 1, 3, 62, 30, }, - { 8, 1, 1, 3, 62, 58, }, - { 9, 1, 1, 3, 62, 40, }, -- { 0, 1, 1, 3, 102, 54, }, -+ { 0, 1, 1, 3, 102, 56, }, - { 2, 1, 1, 3, 102, 40, }, - { 1, 1, 1, 3, 102, 70, }, -- { 3, 1, 1, 3, 102, 54, }, -- { 4, 1, 1, 3, 102, 64, }, -+ { 3, 1, 1, 3, 102, 56, }, -+ { 4, 1, 1, 3, 102, 54, }, - { 5, 1, 1, 3, 102, 40, }, - { 6, 1, 1, 3, 102, 54, }, - { 7, 1, 1, 3, 102, 30, }, -@@ -27498,7 +43541,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 1, 1, 3, 110, 40, }, - { 1, 1, 1, 3, 110, 70, }, - { 3, 1, 1, 3, 110, 68, }, -- { 4, 1, 1, 3, 110, 64, }, -+ { 4, 1, 1, 3, 110, 66, }, - { 5, 1, 1, 3, 110, 40, }, - { 6, 1, 1, 3, 110, 68, }, - { 7, 1, 1, 3, 110, 30, }, -@@ -27508,7 +43551,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 1, 1, 3, 118, 40, }, - { 1, 1, 1, 3, 118, 70, }, - { 3, 1, 1, 3, 118, 127, }, -- { 4, 1, 1, 3, 118, 64, }, -+ { 4, 1, 1, 3, 118, 66, }, - { 5, 1, 1, 3, 118, 127, }, - { 6, 1, 1, 3, 118, 68, }, - { 7, 1, 1, 3, 118, 30, }, -@@ -27518,7 +43561,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 1, 1, 3, 126, 40, }, - { 1, 1, 1, 3, 126, 70, }, - { 3, 1, 1, 3, 126, 127, }, -- { 4, 1, 1, 3, 126, 64, }, -+ { 4, 1, 1, 3, 126, 66, }, - { 5, 1, 1, 3, 126, 127, }, - { 6, 1, 1, 3, 126, 68, }, - { 7, 1, 1, 3, 126, 30, }, -@@ -27528,7 +43571,7 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 2, 1, 1, 3, 134, 40, }, - { 1, 1, 1, 3, 134, 70, }, - { 3, 1, 1, 3, 134, 68, }, -- { 4, 1, 1, 3, 134, 64, }, -+ { 4, 1, 1, 3, 134, 66, }, - { 5, 1, 1, 3, 134, 40, }, - { 6, 1, 1, 3, 134, 68, }, - { 7, 1, 1, 3, 134, 30, }, -@@ -27536,16 +43579,16 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 9, 1, 1, 3, 134, 127, }, - { 0, 1, 1, 3, 142, 68, }, - { 2, 1, 1, 3, 142, 127, }, -- { 1, 1, 1, 3, 142, 127, }, -+ { 1, 1, 1, 3, 142, 70, }, - { 3, 1, 1, 3, 142, 68, }, -- { 4, 1, 1, 3, 142, 64, }, -+ { 4, 1, 1, 3, 142, 66, }, - { 5, 1, 1, 3, 142, 127, }, - { 6, 1, 1, 3, 142, 68, }, - { 7, 1, 1, 3, 142, 127, }, - { 8, 1, 1, 3, 142, 68, }, - { 9, 1, 1, 3, 142, 127, }, - { 0, 1, 1, 3, 151, 72, }, -- { 2, 1, 1, 3, 151, -128, }, -+ { 2, 1, 1, 3, 151, 4, }, - { 1, 1, 1, 3, 151, 127, }, - { 3, 1, 1, 3, 151, 72, }, - { 4, 1, 1, 3, 151, 66, }, -@@ -27553,9 +43596,9 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 1, 3, 151, 72, }, - { 7, 1, 1, 3, 151, 30, }, - { 8, 1, 1, 3, 151, 68, }, -- { 9, 1, 1, 3, 151, -128, }, -+ { 9, 1, 1, 3, 151, 4, }, - { 0, 1, 1, 3, 159, 72, }, -- { 2, 1, 1, 3, 159, -128, }, -+ { 2, 1, 1, 3, 159, 4, }, - { 1, 1, 1, 3, 159, 127, }, - { 3, 1, 1, 3, 159, 72, }, - { 4, 1, 1, 3, 159, 66, }, -@@ -27563,32 +43606,32 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 6, 1, 1, 3, 159, 72, }, - { 7, 1, 1, 3, 159, 30, }, - { 8, 1, 1, 3, 159, 72, }, -- { 9, 1, 1, 3, 159, -128, }, -- { 0, 1, 2, 4, 42, 64, }, -+ { 9, 1, 1, 3, 159, 4, }, -+ { 0, 1, 2, 4, 42, 68, }, - { 2, 1, 2, 4, 42, 64, }, - { 1, 1, 2, 4, 42, 64, }, - { 3, 1, 2, 4, 42, 64, }, -- { 4, 1, 2, 4, 42, 68, }, -+ { 4, 1, 2, 4, 42, 60, }, - { 5, 1, 2, 4, 42, 64, }, - { 6, 1, 2, 4, 42, 64, }, - { 7, 1, 2, 4, 42, 54, }, - { 8, 1, 2, 4, 42, 62, }, - { 9, 1, 2, 4, 42, 64, }, -- { 0, 1, 2, 4, 58, 62, }, -+ { 0, 1, 2, 4, 58, 60, }, - { 2, 1, 2, 4, 58, 64, }, - { 1, 1, 2, 4, 58, 64, }, -- { 3, 1, 2, 4, 58, 62, }, -- { 4, 1, 2, 4, 58, 64, }, -+ { 3, 1, 2, 4, 58, 60, }, -+ { 4, 1, 2, 4, 58, 56, }, - { 5, 1, 2, 4, 58, 64, }, - { 6, 1, 2, 4, 58, 62, }, - { 7, 1, 2, 4, 58, 54, }, - { 8, 1, 2, 4, 58, 62, }, - { 9, 1, 2, 4, 58, 64, }, -- { 0, 1, 2, 4, 106, 58, }, -+ { 0, 1, 2, 4, 106, 60, }, - { 2, 1, 2, 4, 106, 64, }, - { 1, 1, 2, 4, 106, 72, }, -- { 3, 1, 2, 4, 106, 58, }, -- { 4, 1, 2, 4, 106, 66, }, -+ { 3, 1, 2, 4, 106, 60, }, -+ { 4, 1, 2, 4, 106, 58, }, - { 5, 1, 2, 4, 106, 64, }, - { 6, 1, 2, 4, 106, 58, }, - { 7, 1, 2, 4, 106, 54, }, -@@ -27606,84 +43649,84 @@ static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { - { 9, 1, 2, 4, 122, 127, }, - { 0, 1, 2, 4, 138, 72, }, - { 2, 1, 2, 4, 138, 127, }, -- { 1, 1, 2, 4, 138, 127, }, -+ { 1, 1, 2, 4, 138, 72, }, - { 3, 1, 2, 4, 138, 72, }, -- { 4, 1, 2, 4, 138, 68, }, -+ { 4, 1, 2, 4, 138, 70, }, - { 5, 1, 2, 4, 138, 127, }, - { 6, 1, 2, 4, 138, 72, }, - { 7, 1, 2, 4, 138, 127, }, - { 8, 1, 2, 4, 138, 72, }, - { 9, 1, 2, 4, 138, 127, }, - { 0, 1, 2, 4, 155, 72, }, -- { 2, 1, 2, 4, 155, -128, }, -+ { 2, 1, 2, 4, 155, 28, }, - { 1, 1, 2, 4, 155, 127, }, - { 3, 1, 2, 4, 155, 72, }, -- { 4, 1, 2, 4, 155, 68, }, -+ { 4, 1, 2, 4, 155, 62, }, - { 5, 1, 2, 4, 155, 72, }, - { 6, 1, 2, 4, 155, 72, }, - { 7, 1, 2, 4, 155, 54, }, - { 8, 1, 2, 4, 155, 68, }, -- { 9, 1, 2, 4, 155, -128, }, -- { 0, 1, 2, 5, 42, 54, }, -+ { 9, 1, 2, 4, 155, 28, }, -+ { 0, 1, 2, 5, 42, 56, }, - { 2, 1, 2, 5, 42, 40, }, - { 1, 1, 2, 5, 42, 50, }, - { 3, 1, 2, 5, 42, 40, }, -- { 4, 1, 2, 5, 42, 58, }, -+ { 4, 1, 2, 5, 42, 50, }, - { 5, 1, 2, 5, 42, 40, }, - { 6, 1, 2, 5, 42, 52, }, - { 7, 1, 2, 5, 42, 30, }, - { 8, 1, 2, 5, 42, 50, }, - { 9, 1, 2, 5, 42, 40, }, -- { 0, 1, 2, 5, 58, 52, }, -+ { 0, 1, 2, 5, 58, 54, }, - { 2, 1, 2, 5, 58, 40, }, - { 1, 1, 2, 5, 58, 50, }, - { 3, 1, 2, 5, 58, 40, }, -- { 4, 1, 2, 5, 58, 56, }, -+ { 4, 1, 2, 5, 58, 46, }, - { 5, 1, 2, 5, 58, 40, }, - { 6, 1, 2, 5, 58, 52, }, - { 7, 1, 2, 5, 58, 30, }, - { 8, 1, 2, 5, 58, 52, }, - { 9, 1, 2, 5, 58, 40, }, -- { 0, 1, 2, 5, 106, 50, }, -+ { 0, 1, 2, 5, 106, 48, }, - { 2, 1, 2, 5, 106, 40, }, - { 1, 1, 2, 5, 106, 72, }, -- { 3, 1, 2, 5, 106, 50, }, -- { 4, 1, 2, 5, 106, 56, }, -+ { 3, 1, 2, 5, 106, 48, }, -+ { 4, 1, 2, 5, 106, 50, }, - { 5, 1, 2, 5, 106, 40, }, - { 6, 1, 2, 5, 106, 50, }, - { 7, 1, 2, 5, 106, 30, }, - { 8, 1, 2, 5, 106, 50, }, - { 9, 1, 2, 5, 106, 127, }, -- { 0, 1, 2, 5, 122, 66, }, -+ { 0, 1, 2, 5, 122, 70, }, - { 2, 1, 2, 5, 122, 40, }, - { 1, 1, 2, 5, 122, 72, }, - { 3, 1, 2, 5, 122, 127, }, -- { 4, 1, 2, 5, 122, 56, }, -+ { 4, 1, 2, 5, 122, 62, }, - { 5, 1, 2, 5, 122, 127, }, - { 6, 1, 2, 5, 122, 66, }, - { 7, 1, 2, 5, 122, 30, }, - { 8, 1, 2, 5, 122, 66, }, - { 9, 1, 2, 5, 122, 127, }, -- { 0, 1, 2, 5, 138, 66, }, -+ { 0, 1, 2, 5, 138, 70, }, - { 2, 1, 2, 5, 138, 127, }, -- { 1, 1, 2, 5, 138, 127, }, -- { 3, 1, 2, 5, 138, 66, }, -- { 4, 1, 2, 5, 138, 58, }, -+ { 1, 1, 2, 5, 138, 72, }, -+ { 3, 1, 2, 5, 138, 70, }, -+ { 4, 1, 2, 5, 138, 62, }, - { 5, 1, 2, 5, 138, 127, }, - { 6, 1, 2, 5, 138, 66, }, - { 7, 1, 2, 5, 138, 127, }, - { 8, 1, 2, 5, 138, 66, }, - { 9, 1, 2, 5, 138, 127, }, -- { 0, 1, 2, 5, 155, 62, }, -- { 2, 1, 2, 5, 155, -128, }, -+ { 0, 1, 2, 5, 155, 72, }, -+ { 2, 1, 2, 5, 155, 4, }, - { 1, 1, 2, 5, 155, 127, }, -- { 3, 1, 2, 5, 155, 62, }, -- { 4, 1, 2, 5, 155, 58, }, -+ { 3, 1, 2, 5, 155, 72, }, -+ { 4, 1, 2, 5, 155, 52, }, - { 5, 1, 2, 5, 155, 72, }, - { 6, 1, 2, 5, 155, 62, }, - { 7, 1, 2, 5, 155, 30, }, - { 8, 1, 2, 5, 155, 62, }, -- { 9, 1, 2, 5, 155, -128, }, -+ { 9, 1, 2, 5, 155, 4, }, - }; - - RTW_DECL_TABLE_TXPWR_LMT(rtw8822c_txpwr_lmt_type5); -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822ce.c b/drivers/net/wireless/realtek/rtw88/rtw8822ce.c -index 026ac49ce..e26c6bc82 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8822ce.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822ce.c -@@ -4,7 +4,8 @@ - - #include - #include --#include "rtw8822ce.h" -+#include "pci.h" -+#include "rtw8822c.h" - - static const struct pci_device_id rtw_8822ce_id_table[] = { - { -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822cs.c b/drivers/net/wireless/realtek/rtw88/rtw8822cs.c -new file mode 100644 -index 000000000..5d68b9aa5 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822cs.c -@@ -0,0 +1,36 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright(c) Martin Blumenstingl -+ */ -+ -+#include -+#include "sdio_ids.h" -+#include -+#include "main.h" -+#include "rtw8822c.h" -+#include "sdio.h" -+ -+static const struct sdio_device_id rtw_8822cs_id_table[] = { -+ { -+ SDIO_DEVICE(SDIO_VENDOR_ID_REALTEK, -+ SDIO_DEVICE_ID_REALTEK_RTW8822CS), -+ .driver_data = (kernel_ulong_t)&rtw8822c_hw_spec, -+ }, -+ {} -+}; -+MODULE_DEVICE_TABLE(sdio, rtw_8822cs_id_table); -+ -+static struct sdio_driver rtw_8822cs_driver = { -+ .name = "rtw_8822cs", -+ .probe = rtw_sdio_probe, -+ .remove = rtw_sdio_remove, -+ .id_table = rtw_8822cs_id_table, -+ .drv = { -+ .pm = &rtw_sdio_pm_ops, -+ .shutdown = rtw_sdio_shutdown, -+ } -+}; -+module_sdio_driver(rtw_8822cs_driver); -+ -+MODULE_AUTHOR("Martin Blumenstingl "); -+MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822cs driver"); -+MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8822cu.c b/drivers/net/wireless/realtek/rtw88/rtw8822cu.c -new file mode 100644 -index 000000000..157d5102a ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/rtw8822cu.c -@@ -0,0 +1,44 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright(c) 2018-2019 Realtek Corporation -+ */ -+ -+#include -+#include -+#include "main.h" -+#include "rtw8822c.h" -+#include "usb.h" -+ -+static const struct usb_device_id rtw_8822cu_id_table[] = { -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82c, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc812, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82e, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xd820, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xd82b, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(0x13b1, 0x0043, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, /* Alpha - Alpha */ -+ {}, -+}; -+MODULE_DEVICE_TABLE(usb, rtw_8822cu_id_table); -+ -+static int rtw8822cu_probe(struct usb_interface *intf, -+ const struct usb_device_id *id) -+{ -+ return rtw_usb_probe(intf, id); -+} -+ -+static struct usb_driver rtw_8822cu_driver = { -+ .name = "rtw_8822cu", -+ .id_table = rtw_8822cu_id_table, -+ .probe = rtw8822cu_probe, -+ .disconnect = rtw_usb_disconnect, -+}; -+module_usb_driver(rtw_8822cu_driver); -+ -+MODULE_AUTHOR("Realtek Corporation"); -+MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822cu driver"); -+MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/rx.c b/drivers/net/wireless/realtek/rtw88/rx.c -index 7087e385a..b420a39b1 100644 ---- a/drivers/net/wireless/realtek/rtw88/rx.c -+++ b/drivers/net/wireless/realtek/rtw88/rx.c -@@ -6,6 +6,7 @@ - #include "rx.h" - #include "ps.h" - #include "debug.h" -+#include "fw.h" - - void rtw_rx_stats(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, - struct sk_buff *skb) -@@ -138,6 +139,13 @@ static void rtw_rx_addr_match(struct rtw_dev *rtwdev, - rtw_iterate_vifs_atomic(rtwdev, rtw_rx_addr_match_iter, &data); - } - -+static void rtw_set_rx_freq_by_pktstat(struct rtw_rx_pkt_stat *pkt_stat, -+ struct ieee80211_rx_status *rx_status) -+{ -+ rx_status->freq = pkt_stat->freq; -+ rx_status->band = pkt_stat->band; -+} -+ - void rtw_rx_fill_rx_status(struct rtw_dev *rtwdev, - struct rtw_rx_pkt_stat *pkt_stat, - struct ieee80211_hdr *hdr, -@@ -148,17 +156,37 @@ void rtw_rx_fill_rx_status(struct rtw_dev *rtwdev, - u8 path; - - memset(rx_status, 0, sizeof(*rx_status)); -+ if (!hw) { -+ rtw_warn(rtwdev, "hw NULL in %s\n", __func__); -+ return; -+ } -+ if (!hw->conf.chandef.chan) { -+ rtw_warn(rtwdev, "hw->conf.chandef.chan NULL in %s\n", __func__); -+ return; -+ } -+ - rx_status->freq = hw->conf.chandef.chan->center_freq; - rx_status->band = hw->conf.chandef.chan->band; -+ if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD) && -+ test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) -+ rtw_set_rx_freq_by_pktstat(pkt_stat, rx_status); - if (pkt_stat->crc_err) - rx_status->flag |= RX_FLAG_FAILED_FCS_CRC; - if (pkt_stat->decrypted) - rx_status->flag |= RX_FLAG_DECRYPTED; - - if (pkt_stat->rate >= DESC_RATEVHT1SS_MCS0) -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) - rx_status->encoding = RX_ENC_VHT; -+#else -+ rx_status->flag |= RX_FLAG_VHT; -+#endif - else if (pkt_stat->rate >= DESC_RATEMCS0) -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) - rx_status->encoding = RX_ENC_HT; -+#else -+ rx_status->flag |= RX_FLAG_VHT; -+#endif - - if (rx_status->band == NL80211_BAND_5GHZ && - pkt_stat->rate >= DESC_RATE6M && -@@ -177,11 +205,23 @@ void rtw_rx_fill_rx_status(struct rtw_dev *rtwdev, - rx_status->mactime = pkt_stat->tsf_low; - - if (pkt_stat->bw == RTW_CHANNEL_WIDTH_80) -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) - rx_status->bw = RATE_INFO_BW_80; -+#else -+ rx_status->vht_flag |= RX_VHT_FLAG_80MHZ; -+#endif - else if (pkt_stat->bw == RTW_CHANNEL_WIDTH_40) -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) - rx_status->bw = RATE_INFO_BW_40; -+#else -+ rx_status->flag |= RX_FLAG_40MHZ; -+#endif - else -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) - rx_status->bw = RATE_INFO_BW_20; -+#else -+ /* What goes here? */ -+#endif - - rx_status->signal = pkt_stat->signal_power; - for (path = 0; path < rtwdev->hal.rf_path_num; path++) { -diff --git a/drivers/net/wireless/realtek/rtw88/sar.c b/drivers/net/wireless/realtek/rtw88/sar.c -new file mode 100644 -index 000000000..475e79c91 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/sar.c -@@ -0,0 +1,116 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright(c) 2018-2021 Realtek Corporation -+ */ -+ -+#include -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) -+#include "sar.h" -+#include "phy.h" -+#include "debug.h" -+ -+s8 rtw_query_sar(struct rtw_dev *rtwdev, const struct rtw_sar_arg *arg) -+{ -+ const struct rtw_hal *hal = &rtwdev->hal; -+ const struct rtw_sar *sar = &hal->sar; -+ -+ switch (sar->src) { -+ default: -+ rtw_warn(rtwdev, "unknown SAR source: %d\n", sar->src); -+ fallthrough; -+ case RTW_SAR_SOURCE_NONE: -+ return (s8)rtwdev->chip->max_power_index; -+ case RTW_SAR_SOURCE_COMMON: -+ return sar->cfg[arg->path][arg->rs].common[arg->sar_band]; -+ } -+} -+ -+static int rtw_apply_sar(struct rtw_dev *rtwdev, const struct rtw_sar *new) -+{ -+ struct rtw_hal *hal = &rtwdev->hal; -+ struct rtw_sar *sar = &hal->sar; -+ -+ if (sar->src != RTW_SAR_SOURCE_NONE && new->src != sar->src) { -+ rtw_warn(rtwdev, "SAR source: %d is in use\n", sar->src); -+ return -EBUSY; -+ } -+ -+ *sar = *new; -+ rtw_phy_set_tx_power_level(rtwdev, hal->current_channel); -+ -+ return 0; -+} -+ -+static s8 rtw_sar_to_phy(struct rtw_dev *rtwdev, u8 fct, s32 sar, -+ const struct rtw_sar_arg *arg) -+{ -+ struct rtw_hal *hal = &rtwdev->hal; -+ u8 txgi = rtwdev->chip->txgi_factor; -+ u8 max = rtwdev->chip->max_power_index; -+ s32 tmp; -+ s8 base; -+ -+ tmp = fct > txgi ? sar >> (fct - txgi) : sar << (txgi - fct); -+ base = arg->sar_band == RTW_SAR_BAND_0 ? -+ hal->tx_pwr_by_rate_base_2g[arg->path][arg->rs] : -+ hal->tx_pwr_by_rate_base_5g[arg->path][arg->rs]; -+ -+ return (s8)clamp_t(s32, tmp, -max - 1, max) - base; -+} -+ -+static const struct cfg80211_sar_freq_ranges rtw_common_sar_freq_ranges[] = { -+ [RTW_SAR_BAND_0] = { .start_freq = 2412, .end_freq = 2484, }, -+ [RTW_SAR_BAND_1] = { .start_freq = 5180, .end_freq = 5320, }, -+ [RTW_SAR_BAND_3] = { .start_freq = 5500, .end_freq = 5720, }, -+ [RTW_SAR_BAND_4] = { .start_freq = 5745, .end_freq = 5825, }, -+}; -+ -+const struct cfg80211_sar_capa rtw_sar_capa = { -+ .type = NL80211_SAR_TYPE_POWER, -+ .num_freq_ranges = RTW_SAR_BAND_NR, -+ .freq_ranges = rtw_common_sar_freq_ranges, -+}; -+ -+int rtw_set_sar_specs(struct rtw_dev *rtwdev, -+ const struct cfg80211_sar_specs *sar) -+{ -+ struct rtw_sar_arg arg = {0}; -+ struct rtw_sar new = {0}; -+ u32 idx, i, j, k; -+ s32 power; -+ s8 val; -+ -+ if (sar->type != NL80211_SAR_TYPE_POWER) -+ return -EINVAL; -+ -+ memset(&new, rtwdev->chip->max_power_index, sizeof(new)); -+ new.src = RTW_SAR_SOURCE_COMMON; -+ -+ for (i = 0; i < sar->num_sub_specs; i++) { -+ idx = sar->sub_specs[i].freq_range_index; -+ if (idx >= RTW_SAR_BAND_NR) -+ return -EINVAL; -+ -+ power = sar->sub_specs[i].power; -+ rtw_dbg(rtwdev, RTW_DBG_REGD, "On freq %u to %u, set SAR %d in 1/%lu dBm\n", -+ rtw_common_sar_freq_ranges[idx].start_freq, -+ rtw_common_sar_freq_ranges[idx].end_freq, -+ power, BIT(RTW_COMMON_SAR_FCT)); -+ -+ for (j = 0; j < RTW_RF_PATH_MAX; j++) { -+ for (k = 0; k < RTW_RATE_SECTION_MAX; k++) { -+ arg = (struct rtw_sar_arg){ -+ .sar_band = idx, -+ .path = j, -+ .rs = k, -+ }; -+ val = rtw_sar_to_phy(rtwdev, RTW_COMMON_SAR_FCT, -+ power, &arg); -+ new.cfg[j][k].common[idx] = val; -+ } -+ } -+ } -+ -+ return rtw_apply_sar(rtwdev, &new); -+} -+#endif -+ -diff --git a/drivers/net/wireless/realtek/rtw88/sar.h b/drivers/net/wireless/realtek/rtw88/sar.h -new file mode 100644 -index 000000000..75f6118ef ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/sar.h -@@ -0,0 +1,25 @@ -+/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ -+/* Copyright(c) 2018-2021 Realtek Corporation -+ */ -+ -+#include "main.h" -+ -+/* NL80211_SAR_TYPE_POWER means unit is in 0.25 dBm, -+ * where 0.25 = 1/4 = 2^(-2), so make factor 2. -+ */ -+#define RTW_COMMON_SAR_FCT 2 -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) -+struct rtw_sar_arg { -+ u8 sar_band; -+ u8 path; -+ u8 rs; -+}; -+ -+extern const struct cfg80211_sar_capa rtw_sar_capa; -+ -+s8 rtw_query_sar(struct rtw_dev *rtwdev, const struct rtw_sar_arg *arg); -+int rtw_set_sar_specs(struct rtw_dev *rtwdev, -+ const struct cfg80211_sar_specs *sar); -+#endif -+ -diff --git a/drivers/net/wireless/realtek/rtw88/sch_generic.h b/drivers/net/wireless/realtek/rtw88/sch_generic.h -new file mode 100644 -index 000000000..241a0c597 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/sch_generic.h -@@ -0,0 +1,849 @@ -+#ifndef __NET_SCHED_GENERIC_H -+#define __NET_SCHED_GENERIC_H -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+struct Qdisc_ops; -+struct qdisc_walker; -+struct tcf_walker; -+struct module; -+ -+struct qdisc_rate_table { -+ struct tc_ratespec rate; -+ u32 data[256]; -+ struct qdisc_rate_table *next; -+ int refcnt; -+}; -+ -+enum qdisc_state_t { -+ __QDISC_STATE_SCHED, -+ __QDISC_STATE_DEACTIVATED, -+}; -+ -+struct qdisc_size_table { -+ struct rcu_head rcu; -+ struct list_head list; -+ struct tc_sizespec szopts; -+ int refcnt; -+ u16 data[]; -+}; -+ -+/* similar to sk_buff_head, but skb->prev pointer is undefined. */ -+struct qdisc_skb_head { -+ struct sk_buff *head; -+ struct sk_buff *tail; -+ __u32 qlen; -+ spinlock_t lock; -+}; -+ -+struct Qdisc { -+ int (*enqueue)(struct sk_buff *skb, -+ struct Qdisc *sch, -+ struct sk_buff **to_free); -+ struct sk_buff * (*dequeue)(struct Qdisc *sch); -+ unsigned int flags; -+#define TCQ_F_BUILTIN 1 -+#define TCQ_F_INGRESS 2 -+#define TCQ_F_CAN_BYPASS 4 -+#define TCQ_F_MQROOT 8 -+#define TCQ_F_ONETXQUEUE 0x10 /* dequeue_skb() can assume all skbs are for -+ * q->dev_queue : It can test -+ * netif_xmit_frozen_or_stopped() before -+ * dequeueing next packet. -+ * Its true for MQ/MQPRIO slaves, or non -+ * multiqueue device. -+ */ -+#define TCQ_F_WARN_NONWC (1 << 16) -+#define TCQ_F_CPUSTATS 0x20 /* run using percpu statistics */ -+#define TCQ_F_NOPARENT 0x40 /* root of its hierarchy : -+ * qdisc_tree_decrease_qlen() should stop. -+ */ -+ u32 limit; -+ const struct Qdisc_ops *ops; -+ struct qdisc_size_table __rcu *stab; -+ struct hlist_node hash; -+ u32 handle; -+ u32 parent; -+ void *u32_node; -+ -+ struct netdev_queue *dev_queue; -+ -+ struct net_rate_estimator __rcu *rate_est; -+ struct gnet_stats_basic_cpu __percpu *cpu_bstats; -+ struct gnet_stats_queue __percpu *cpu_qstats; -+ -+ /* -+ * For performance sake on SMP, we put highly modified fields at the end -+ */ -+ struct sk_buff *gso_skb ____cacheline_aligned_in_smp; -+ struct qdisc_skb_head q; -+ struct gnet_stats_basic_packed bstats; -+ seqcount_t running; -+ struct gnet_stats_queue qstats; -+ unsigned long state; -+ struct Qdisc *next_sched; -+ struct sk_buff *skb_bad_txq; -+ struct rcu_head rcu_head; -+ int padded; -+ atomic_t refcnt; -+ -+ spinlock_t busylock ____cacheline_aligned_in_smp; -+}; -+ -+static inline bool qdisc_is_running(const struct Qdisc *qdisc) -+{ -+ return (raw_read_seqcount(&qdisc->running) & 1) ? true : false; -+} -+ -+static inline bool qdisc_run_begin(struct Qdisc *qdisc) -+{ -+ if (qdisc_is_running(qdisc)) -+ return false; -+ /* Variant of write_seqcount_begin() telling lockdep a trylock -+ * was attempted. -+ */ -+ raw_write_seqcount_begin(&qdisc->running); -+ seqcount_acquire(&qdisc->running.dep_map, 0, 1, _RET_IP_); -+ return true; -+} -+ -+static inline void qdisc_run_end(struct Qdisc *qdisc) -+{ -+ write_seqcount_end(&qdisc->running); -+} -+ -+static inline bool qdisc_may_bulk(const struct Qdisc *qdisc) -+{ -+ return qdisc->flags & TCQ_F_ONETXQUEUE; -+} -+ -+static inline int qdisc_avail_bulklimit(const struct netdev_queue *txq) -+{ -+#ifdef CONFIG_BQL -+ /* Non-BQL migrated drivers will return 0, too. */ -+ return dql_avail(&txq->dql); -+#else -+ return 0; -+#endif -+} -+ -+struct Qdisc_class_ops { -+ /* Child qdisc manipulation */ -+ struct netdev_queue * (*select_queue)(struct Qdisc *, struct tcmsg *); -+ int (*graft)(struct Qdisc *, unsigned long cl, -+ struct Qdisc *, struct Qdisc **); -+ struct Qdisc * (*leaf)(struct Qdisc *, unsigned long cl); -+ void (*qlen_notify)(struct Qdisc *, unsigned long); -+ -+ /* Class manipulation routines */ -+ unsigned long (*get)(struct Qdisc *, u32 classid); -+ void (*put)(struct Qdisc *, unsigned long); -+ int (*change)(struct Qdisc *, u32, u32, -+ struct nlattr **, unsigned long *); -+ int (*delete)(struct Qdisc *, unsigned long); -+ void (*walk)(struct Qdisc *, struct qdisc_walker * arg); -+ -+ /* Filter manipulation */ -+ struct tcf_proto __rcu ** (*tcf_chain)(struct Qdisc *, unsigned long); -+ bool (*tcf_cl_offload)(u32 classid); -+ unsigned long (*bind_tcf)(struct Qdisc *, unsigned long, -+ u32 classid); -+ void (*unbind_tcf)(struct Qdisc *, unsigned long); -+ -+ /* rtnetlink specific */ -+ int (*dump)(struct Qdisc *, unsigned long, -+ struct sk_buff *skb, struct tcmsg*); -+ int (*dump_stats)(struct Qdisc *, unsigned long, -+ struct gnet_dump *); -+}; -+ -+struct Qdisc_ops { -+ struct Qdisc_ops *next; -+ const struct Qdisc_class_ops *cl_ops; -+ char id[IFNAMSIZ]; -+ int priv_size; -+ -+ int (*enqueue)(struct sk_buff *skb, -+ struct Qdisc *sch, -+ struct sk_buff **to_free); -+ struct sk_buff * (*dequeue)(struct Qdisc *); -+ struct sk_buff * (*peek)(struct Qdisc *); -+ -+ int (*init)(struct Qdisc *, struct nlattr *arg); -+ void (*reset)(struct Qdisc *); -+ void (*destroy)(struct Qdisc *); -+ int (*change)(struct Qdisc *, struct nlattr *arg); -+ void (*attach)(struct Qdisc *); -+ -+ int (*dump)(struct Qdisc *, struct sk_buff *); -+ int (*dump_stats)(struct Qdisc *, struct gnet_dump *); -+ -+ struct module *owner; -+}; -+ -+ -+struct tcf_result { -+ unsigned long class; -+ u32 classid; -+}; -+ -+struct tcf_proto_ops { -+ struct list_head head; -+ char kind[IFNAMSIZ]; -+ -+ int (*classify)(struct sk_buff *, -+ const struct tcf_proto *, -+ struct tcf_result *); -+ int (*init)(struct tcf_proto*); -+ bool (*destroy)(struct tcf_proto*, bool); -+ -+ unsigned long (*get)(struct tcf_proto*, u32 handle); -+ int (*change)(struct net *net, struct sk_buff *, -+ struct tcf_proto*, unsigned long, -+ u32 handle, struct nlattr **, -+ unsigned long *, bool); -+ int (*delete)(struct tcf_proto*, unsigned long); -+ void (*walk)(struct tcf_proto*, struct tcf_walker *arg); -+ -+ /* rtnetlink specific */ -+ int (*dump)(struct net*, struct tcf_proto*, unsigned long, -+ struct sk_buff *skb, struct tcmsg*); -+ -+ struct module *owner; -+}; -+ -+struct tcf_proto { -+ /* Fast access part */ -+ struct tcf_proto __rcu *next; -+ void __rcu *root; -+ int (*classify)(struct sk_buff *, -+ const struct tcf_proto *, -+ struct tcf_result *); -+ __be16 protocol; -+ -+ /* All the rest */ -+ u32 prio; -+ u32 classid; -+ struct Qdisc *q; -+ void *data; -+ const struct tcf_proto_ops *ops; -+ struct rcu_head rcu; -+}; -+ -+struct qdisc_skb_cb { -+ unsigned int pkt_len; -+ u16 slave_dev_queue_mapping; -+ u16 tc_classid; -+#define QDISC_CB_PRIV_LEN 20 -+ unsigned char data[QDISC_CB_PRIV_LEN]; -+}; -+ -+static inline void qdisc_cb_private_validate(const struct sk_buff *skb, int sz) -+{ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) -+ struct qdisc_skb_cb *qcb; -+ -+ BUILD_BUG_ON(sizeof(skb->cb) < offsetof(struct qdisc_skb_cb, data) + sz); -+ BUILD_BUG_ON(sizeof(qcb->data) < sz); -+#endif -+} -+ -+static inline int qdisc_qlen(const struct Qdisc *q) -+{ -+ return q->q.qlen; -+} -+ -+static inline struct qdisc_skb_cb *qdisc_skb_cb(const struct sk_buff *skb) -+{ -+ return (struct qdisc_skb_cb *)skb->cb; -+} -+ -+static inline spinlock_t *qdisc_lock(struct Qdisc *qdisc) -+{ -+ return &qdisc->q.lock; -+} -+ -+static inline struct Qdisc *qdisc_root(const struct Qdisc *qdisc) -+{ -+ struct Qdisc *q = rcu_dereference_rtnl(qdisc->dev_queue->qdisc); -+ -+ return q; -+} -+ -+static inline struct Qdisc *qdisc_root_sleeping(const struct Qdisc *qdisc) -+{ -+ return qdisc->dev_queue->qdisc_sleeping; -+} -+ -+/* The qdisc root lock is a mechanism by which to top level -+ * of a qdisc tree can be locked from any qdisc node in the -+ * forest. This allows changing the configuration of some -+ * aspect of the qdisc tree while blocking out asynchronous -+ * qdisc access in the packet processing paths. -+ * -+ * It is only legal to do this when the root will not change -+ * on us. Otherwise we'll potentially lock the wrong qdisc -+ * root. This is enforced by holding the RTNL semaphore, which -+ * all users of this lock accessor must do. -+ */ -+static inline spinlock_t *qdisc_root_lock(const struct Qdisc *qdisc) -+{ -+ struct Qdisc *root = qdisc_root(qdisc); -+ -+ ASSERT_RTNL(); -+ return qdisc_lock(root); -+} -+ -+static inline spinlock_t *qdisc_root_sleeping_lock(const struct Qdisc *qdisc) -+{ -+ struct Qdisc *root = qdisc_root_sleeping(qdisc); -+ -+ ASSERT_RTNL(); -+ return qdisc_lock(root); -+} -+ -+static inline seqcount_t *qdisc_root_sleeping_running(const struct Qdisc *qdisc) -+{ -+ struct Qdisc *root = qdisc_root_sleeping(qdisc); -+ -+ ASSERT_RTNL(); -+ return &root->running; -+} -+ -+static inline struct net_device *qdisc_dev(const struct Qdisc *qdisc) -+{ -+ return qdisc->dev_queue->dev; -+} -+ -+static inline void sch_tree_lock(const struct Qdisc *q) -+{ -+ spin_lock_bh(qdisc_root_sleeping_lock(q)); -+} -+ -+static inline void sch_tree_unlock(const struct Qdisc *q) -+{ -+ spin_unlock_bh(qdisc_root_sleeping_lock(q)); -+} -+ -+#define tcf_tree_lock(tp) sch_tree_lock((tp)->q) -+#define tcf_tree_unlock(tp) sch_tree_unlock((tp)->q) -+ -+extern struct Qdisc noop_qdisc; -+extern struct Qdisc_ops noop_qdisc_ops; -+extern struct Qdisc_ops pfifo_fast_ops; -+extern struct Qdisc_ops mq_qdisc_ops; -+extern struct Qdisc_ops noqueue_qdisc_ops; -+extern const struct Qdisc_ops *default_qdisc_ops; -+static inline const struct Qdisc_ops * -+get_default_qdisc_ops(const struct net_device *dev, int ntx) -+{ -+ return ntx < dev->real_num_tx_queues ? -+ default_qdisc_ops : &pfifo_fast_ops; -+} -+ -+struct Qdisc_class_common { -+ u32 classid; -+ struct hlist_node hnode; -+}; -+ -+struct Qdisc_class_hash { -+ struct hlist_head *hash; -+ unsigned int hashsize; -+ unsigned int hashmask; -+ unsigned int hashelems; -+}; -+ -+static inline unsigned int qdisc_class_hash(u32 id, u32 mask) -+{ -+ id ^= id >> 8; -+ id ^= id >> 4; -+ return id & mask; -+} -+ -+static inline struct Qdisc_class_common * -+qdisc_class_find(const struct Qdisc_class_hash *hash, u32 id) -+{ -+ struct Qdisc_class_common *cl; -+ unsigned int h; -+ -+ h = qdisc_class_hash(id, hash->hashmask); -+ hlist_for_each_entry(cl, &hash->hash[h], hnode) { -+ if (cl->classid == id) -+ return cl; -+ } -+ return NULL; -+} -+ -+int qdisc_class_hash_init(struct Qdisc_class_hash *); -+void qdisc_class_hash_insert(struct Qdisc_class_hash *, -+ struct Qdisc_class_common *); -+void qdisc_class_hash_remove(struct Qdisc_class_hash *, -+ struct Qdisc_class_common *); -+void qdisc_class_hash_grow(struct Qdisc *, struct Qdisc_class_hash *); -+void qdisc_class_hash_destroy(struct Qdisc_class_hash *); -+ -+void dev_init_scheduler(struct net_device *dev); -+void dev_shutdown(struct net_device *dev); -+void dev_activate(struct net_device *dev); -+void dev_deactivate(struct net_device *dev); -+void dev_deactivate_many(struct list_head *head); -+struct Qdisc *dev_graft_qdisc(struct netdev_queue *dev_queue, -+ struct Qdisc *qdisc); -+void qdisc_reset(struct Qdisc *qdisc); -+void qdisc_destroy(struct Qdisc *qdisc); -+void qdisc_tree_reduce_backlog(struct Qdisc *qdisc, unsigned int n, -+ unsigned int len); -+struct Qdisc *qdisc_alloc(struct netdev_queue *dev_queue, -+ const struct Qdisc_ops *ops); -+struct Qdisc *qdisc_create_dflt(struct netdev_queue *dev_queue, -+ const struct Qdisc_ops *ops, u32 parentid); -+void __qdisc_calculate_pkt_len(struct sk_buff *skb, -+ const struct qdisc_size_table *stab); -+bool tcf_destroy(struct tcf_proto *tp, bool force); -+void tcf_destroy_chain(struct tcf_proto __rcu **fl); -+int skb_do_redirect(struct sk_buff *); -+ -+static inline bool skb_at_tc_ingress(const struct sk_buff *skb) -+{ -+#ifdef CONFIG_NET_CLS_ACT -+ return G_TC_AT(skb->tc_verd) & AT_INGRESS; -+#else -+ return false; -+#endif -+} -+ -+/* Reset all TX qdiscs greater then index of a device. */ -+static inline void qdisc_reset_all_tx_gt(struct net_device *dev, unsigned int i) -+{ -+ struct Qdisc *qdisc; -+ -+ for (; i < dev->num_tx_queues; i++) { -+ qdisc = rtnl_dereference(netdev_get_tx_queue(dev, i)->qdisc); -+ if (qdisc) { -+ spin_lock_bh(qdisc_lock(qdisc)); -+ qdisc_reset(qdisc); -+ spin_unlock_bh(qdisc_lock(qdisc)); -+ } -+ } -+} -+ -+static inline void qdisc_reset_all_tx(struct net_device *dev) -+{ -+ qdisc_reset_all_tx_gt(dev, 0); -+} -+ -+/* Are all TX queues of the device empty? */ -+static inline bool qdisc_all_tx_empty(const struct net_device *dev) -+{ -+ unsigned int i; -+ -+ rcu_read_lock(); -+ for (i = 0; i < dev->num_tx_queues; i++) { -+ struct netdev_queue *txq = netdev_get_tx_queue(dev, i); -+ const struct Qdisc *q = rcu_dereference(txq->qdisc); -+ -+ if (q->q.qlen) { -+ rcu_read_unlock(); -+ return false; -+ } -+ } -+ rcu_read_unlock(); -+ return true; -+} -+ -+/* Are any of the TX qdiscs changing? */ -+static inline bool qdisc_tx_changing(const struct net_device *dev) -+{ -+ unsigned int i; -+ -+ for (i = 0; i < dev->num_tx_queues; i++) { -+ struct netdev_queue *txq = netdev_get_tx_queue(dev, i); -+ if (rcu_access_pointer(txq->qdisc) != txq->qdisc_sleeping) -+ return true; -+ } -+ return false; -+} -+ -+/* Is the device using the noop qdisc on all queues? */ -+static inline bool qdisc_tx_is_noop(const struct net_device *dev) -+{ -+ unsigned int i; -+ -+ for (i = 0; i < dev->num_tx_queues; i++) { -+ struct netdev_queue *txq = netdev_get_tx_queue(dev, i); -+ if (rcu_access_pointer(txq->qdisc) != &noop_qdisc) -+ return false; -+ } -+ return true; -+} -+ -+static inline unsigned int qdisc_pkt_len(const struct sk_buff *skb) -+{ -+ return qdisc_skb_cb(skb)->pkt_len; -+} -+ -+/* additional qdisc xmit flags (NET_XMIT_MASK in linux/netdevice.h) */ -+enum net_xmit_qdisc_t { -+ __NET_XMIT_STOLEN = 0x00010000, -+ __NET_XMIT_BYPASS = 0x00020000, -+}; -+ -+#ifdef CONFIG_NET_CLS_ACT -+#define net_xmit_drop_count(e) ((e) & __NET_XMIT_STOLEN ? 0 : 1) -+#else -+#define net_xmit_drop_count(e) (1) -+#endif -+ -+static inline void qdisc_calculate_pkt_len(struct sk_buff *skb, -+ const struct Qdisc *sch) -+{ -+#ifdef CONFIG_NET_SCHED -+ struct qdisc_size_table *stab = rcu_dereference_bh(sch->stab); -+ -+ if (stab) -+ __qdisc_calculate_pkt_len(skb, stab); -+#endif -+} -+ -+static inline int qdisc_enqueue(struct sk_buff *skb, struct Qdisc *sch, -+ struct sk_buff **to_free) -+{ -+ qdisc_calculate_pkt_len(skb, sch); -+ return sch->enqueue(skb, sch, to_free); -+} -+ -+static inline bool qdisc_is_percpu_stats(const struct Qdisc *q) -+{ -+ return q->flags & TCQ_F_CPUSTATS; -+} -+ -+static inline void _bstats_update(struct gnet_stats_basic_packed *bstats, -+ __u64 bytes, __u32 packets) -+{ -+ bstats->bytes += bytes; -+ bstats->packets += packets; -+} -+ -+static inline void bstats_update(struct gnet_stats_basic_packed *bstats, -+ const struct sk_buff *skb) -+{ -+ _bstats_update(bstats, -+ qdisc_pkt_len(skb), -+ skb_is_gso(skb) ? skb_shinfo(skb)->gso_segs : 1); -+} -+ -+static inline void _bstats_cpu_update(struct gnet_stats_basic_cpu *bstats, -+ __u64 bytes, __u32 packets) -+{ -+ u64_stats_update_begin(&bstats->syncp); -+ _bstats_update(&bstats->bstats, bytes, packets); -+ u64_stats_update_end(&bstats->syncp); -+} -+ -+static inline void bstats_cpu_update(struct gnet_stats_basic_cpu *bstats, -+ const struct sk_buff *skb) -+{ -+ u64_stats_update_begin(&bstats->syncp); -+ bstats_update(&bstats->bstats, skb); -+ u64_stats_update_end(&bstats->syncp); -+} -+ -+static inline void qdisc_bstats_cpu_update(struct Qdisc *sch, -+ const struct sk_buff *skb) -+{ -+ bstats_cpu_update(this_cpu_ptr(sch->cpu_bstats), skb); -+} -+ -+static inline void qdisc_bstats_update(struct Qdisc *sch, -+ const struct sk_buff *skb) -+{ -+ bstats_update(&sch->bstats, skb); -+} -+ -+static inline void qdisc_qstats_backlog_dec(struct Qdisc *sch, -+ const struct sk_buff *skb) -+{ -+ sch->qstats.backlog -= qdisc_pkt_len(skb); -+} -+ -+static inline void qdisc_qstats_backlog_inc(struct Qdisc *sch, -+ const struct sk_buff *skb) -+{ -+ sch->qstats.backlog += qdisc_pkt_len(skb); -+} -+ -+static inline void __qdisc_qstats_drop(struct Qdisc *sch, int count) -+{ -+ sch->qstats.drops += count; -+} -+ -+static inline void qstats_drop_inc(struct gnet_stats_queue *qstats) -+{ -+ qstats->drops++; -+} -+ -+static inline void qstats_overlimit_inc(struct gnet_stats_queue *qstats) -+{ -+ qstats->overlimits++; -+} -+ -+static inline void qdisc_qstats_drop(struct Qdisc *sch) -+{ -+ qstats_drop_inc(&sch->qstats); -+} -+ -+static inline void qdisc_qstats_cpu_drop(struct Qdisc *sch) -+{ -+ this_cpu_inc(sch->cpu_qstats->drops); -+} -+ -+static inline void qdisc_qstats_overlimit(struct Qdisc *sch) -+{ -+ sch->qstats.overlimits++; -+} -+ -+static inline void qdisc_skb_head_init(struct qdisc_skb_head *qh) -+{ -+ qh->head = NULL; -+ qh->tail = NULL; -+ qh->qlen = 0; -+} -+ -+static inline int __qdisc_enqueue_tail(struct sk_buff *skb, struct Qdisc *sch, -+ struct qdisc_skb_head *qh) -+{ -+ struct sk_buff *last = qh->tail; -+ -+ if (last) { -+ skb->next = NULL; -+ last->next = skb; -+ qh->tail = skb; -+ } else { -+ qh->tail = skb; -+ qh->head = skb; -+ } -+ qh->qlen++; -+ qdisc_qstats_backlog_inc(sch, skb); -+ -+ return NET_XMIT_SUCCESS; -+} -+ -+static inline int qdisc_enqueue_tail(struct sk_buff *skb, struct Qdisc *sch) -+{ -+ return __qdisc_enqueue_tail(skb, sch, &sch->q); -+} -+ -+static inline struct sk_buff *__qdisc_dequeue_head(struct qdisc_skb_head *qh) -+{ -+ struct sk_buff *skb = qh->head; -+ -+ if (likely(skb != NULL)) { -+ qh->head = skb->next; -+ qh->qlen--; -+ if (qh->head == NULL) -+ qh->tail = NULL; -+ skb->next = NULL; -+ } -+ -+ return skb; -+} -+ -+static inline struct sk_buff *qdisc_dequeue_head(struct Qdisc *sch) -+{ -+ struct sk_buff *skb = __qdisc_dequeue_head(&sch->q); -+ -+ if (likely(skb != NULL)) { -+ qdisc_qstats_backlog_dec(sch, skb); -+ qdisc_bstats_update(sch, skb); -+ } -+ -+ return skb; -+} -+ -+/* Instead of calling kfree_skb() while root qdisc lock is held, -+ * queue the skb for future freeing at end of __dev_xmit_skb() -+ */ -+static inline void __qdisc_drop(struct sk_buff *skb, struct sk_buff **to_free) -+{ -+ skb->next = *to_free; -+ *to_free = skb; -+} -+ -+static inline unsigned int __qdisc_queue_drop_head(struct Qdisc *sch, -+ struct qdisc_skb_head *qh, -+ struct sk_buff **to_free) -+{ -+ struct sk_buff *skb = __qdisc_dequeue_head(qh); -+ -+ if (likely(skb != NULL)) { -+ unsigned int len = qdisc_pkt_len(skb); -+ -+ qdisc_qstats_backlog_dec(sch, skb); -+ __qdisc_drop(skb, to_free); -+ return len; -+ } -+ -+ return 0; -+} -+ -+static inline unsigned int qdisc_queue_drop_head(struct Qdisc *sch, -+ struct sk_buff **to_free) -+{ -+ return __qdisc_queue_drop_head(sch, &sch->q, to_free); -+} -+ -+static inline struct sk_buff *qdisc_peek_head(struct Qdisc *sch) -+{ -+ const struct qdisc_skb_head *qh = &sch->q; -+ -+ return qh->head; -+} -+ -+/* generic pseudo peek method for non-work-conserving qdisc */ -+static inline struct sk_buff *qdisc_peek_dequeued(struct Qdisc *sch) -+{ -+ /* we can reuse ->gso_skb because peek isn't called for root qdiscs */ -+ if (!sch->gso_skb) { -+ sch->gso_skb = sch->dequeue(sch); -+ if (sch->gso_skb) { -+ /* it's still part of the queue */ -+ qdisc_qstats_backlog_inc(sch, sch->gso_skb); -+ sch->q.qlen++; -+ } -+ } -+ -+ return sch->gso_skb; -+} -+ -+/* use instead of qdisc->dequeue() for all qdiscs queried with ->peek() */ -+static inline struct sk_buff *qdisc_dequeue_peeked(struct Qdisc *sch) -+{ -+ struct sk_buff *skb = sch->gso_skb; -+ -+ if (skb) { -+ sch->gso_skb = NULL; -+ qdisc_qstats_backlog_dec(sch, skb); -+ sch->q.qlen--; -+ } else { -+ skb = sch->dequeue(sch); -+ } -+ -+ return skb; -+} -+ -+static inline void __qdisc_reset_queue(struct qdisc_skb_head *qh) -+{ -+ /* -+ * We do not know the backlog in bytes of this list, it -+ * is up to the caller to correct it -+ */ -+ ASSERT_RTNL(); -+ if (qh->qlen) { -+ rtnl_kfree_skbs(qh->head, qh->tail); -+ -+ qh->head = NULL; -+ qh->tail = NULL; -+ qh->qlen = 0; -+ } -+} -+ -+static inline void qdisc_reset_queue(struct Qdisc *sch) -+{ -+ __qdisc_reset_queue(&sch->q); -+ sch->qstats.backlog = 0; -+} -+ -+static inline struct Qdisc *qdisc_replace(struct Qdisc *sch, struct Qdisc *new, -+ struct Qdisc **pold) -+{ -+ struct Qdisc *old; -+ -+ sch_tree_lock(sch); -+ old = *pold; -+ *pold = new; -+ if (old != NULL) { -+ qdisc_tree_reduce_backlog(old, old->q.qlen, old->qstats.backlog); -+ qdisc_reset(old); -+ } -+ sch_tree_unlock(sch); -+ -+ return old; -+} -+ -+static inline void rtnl_qdisc_drop(struct sk_buff *skb, struct Qdisc *sch) -+{ -+ rtnl_kfree_skbs(skb, skb); -+ qdisc_qstats_drop(sch); -+} -+ -+ -+static inline int qdisc_drop(struct sk_buff *skb, struct Qdisc *sch, -+ struct sk_buff **to_free) -+{ -+ __qdisc_drop(skb, to_free); -+ qdisc_qstats_drop(sch); -+ -+ return NET_XMIT_DROP; -+} -+ -+/* Length to Time (L2T) lookup in a qdisc_rate_table, to determine how -+ long it will take to send a packet given its size. -+ */ -+static inline u32 qdisc_l2t(struct qdisc_rate_table* rtab, unsigned int pktlen) -+{ -+ int slot = pktlen + rtab->rate.cell_align + rtab->rate.overhead; -+ if (slot < 0) -+ slot = 0; -+ slot >>= rtab->rate.cell_log; -+ if (slot > 255) -+ return rtab->data[255]*(slot >> 8) + rtab->data[slot & 0xFF]; -+ return rtab->data[slot]; -+} -+ -+struct psched_ratecfg { -+ u64 rate_bytes_ps; /* bytes per second */ -+ u32 mult; -+ u16 overhead; -+ u8 linklayer; -+ u8 shift; -+}; -+ -+static inline u64 psched_l2t_ns(const struct psched_ratecfg *r, -+ unsigned int len) -+{ -+ len += r->overhead; -+ -+ if (unlikely(r->linklayer == TC_LINKLAYER_ATM)) -+ return ((u64)(DIV_ROUND_UP(len,48)*53) * r->mult) >> r->shift; -+ -+ return ((u64)len * r->mult) >> r->shift; -+} -+ -+void psched_ratecfg_precompute(struct psched_ratecfg *r, -+ const struct tc_ratespec *conf, -+ u64 rate64); -+ -+static inline void psched_ratecfg_getrate(struct tc_ratespec *res, -+ const struct psched_ratecfg *r) -+{ -+ memset(res, 0, sizeof(*res)); -+ -+ /* legacy struct tc_ratespec has a 32bit @rate field -+ * Qdisc using 64bit rate should add new attributes -+ * in order to maintain compatibility. -+ */ -+ res->rate = min_t(u64, r->rate_bytes_ps, ~0U); -+ -+ res->overhead = r->overhead; -+ res->linklayer = (r->linklayer & TC_LINKLAYER_MASK); -+} -+ -+#endif -diff --git a/drivers/net/wireless/realtek/rtw88/sdio.c b/drivers/net/wireless/realtek/rtw88/sdio.c -new file mode 100644 -index 000000000..b19262ec5 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/sdio.c -@@ -0,0 +1,1416 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright (C) 2021 Martin Blumenstingl -+ * Copyright (C) 2021 Jernej Skrabec -+ * -+ * Based on rtw88/pci.c: -+ * Copyright(c) 2018-2019 Realtek Corporation -+ */ -+ -+#include -+#include -+#include -+#include "main.h" -+#include "debug.h" -+#include "fw.h" -+#include "ps.h" -+#include "reg.h" -+#include "rx.h" -+#include "sdio.h" -+#include "tx.h" -+ -+#define RTW_SDIO_INDIRECT_RW_RETRIES 50 -+ -+static bool rtw_sdio_is_bus_addr(u32 addr) -+{ -+ return !!(addr & RTW_SDIO_BUS_MSK); -+} -+ -+static bool rtw_sdio_bus_claim_needed(struct rtw_sdio *rtwsdio) -+{ -+ return !rtwsdio->irq_thread || -+ rtwsdio->irq_thread != current; -+} -+ -+static u32 rtw_sdio_to_bus_offset(struct rtw_dev *rtwdev, u32 addr) -+{ -+ switch (addr & RTW_SDIO_BUS_MSK) { -+ case WLAN_IOREG_OFFSET: -+ addr &= WLAN_IOREG_REG_MSK; -+ addr |= FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, -+ REG_SDIO_CMD_ADDR_MAC_REG); -+ break; -+ case SDIO_LOCAL_OFFSET: -+ addr &= SDIO_LOCAL_REG_MSK; -+ addr |= FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, -+ REG_SDIO_CMD_ADDR_SDIO_REG); -+ break; -+ default: -+ rtw_warn(rtwdev, "Cannot convert addr 0x%08x to bus offset", -+ addr); -+ } -+ -+ return addr; -+} -+ -+static bool rtw_sdio_use_memcpy_io(struct rtw_dev *rtwdev, u32 addr, -+ u8 alignment) -+{ -+ return IS_ALIGNED(addr, alignment) && -+ test_bit(RTW_FLAG_POWERON, rtwdev->flags); -+} -+ -+static void rtw_sdio_writel(struct rtw_dev *rtwdev, u32 val, u32 addr, -+ int *err_ret) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ u8 buf[4]; -+ int i; -+ -+ if (rtw_sdio_use_memcpy_io(rtwdev, addr, 4)) { -+ sdio_writel(rtwsdio->sdio_func, val, addr, err_ret); -+ return; -+ } -+ -+ *(__le32 *)buf = cpu_to_le32(val); -+ -+ for (i = 0; i < 4; i++) { -+ sdio_writeb(rtwsdio->sdio_func, buf[i], addr + i, err_ret); -+ if (*err_ret) -+ return; -+ } -+} -+ -+static void rtw_sdio_writew(struct rtw_dev *rtwdev, u16 val, u32 addr, -+ int *err_ret) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ u8 buf[2]; -+ int i; -+ -+ *(__le16 *)buf = cpu_to_le16(val); -+ -+ for (i = 0; i < 2; i++) { -+ sdio_writeb(rtwsdio->sdio_func, buf[i], addr + i, err_ret); -+ if (*err_ret) -+ return; -+ } -+} -+ -+static u32 rtw_sdio_readl(struct rtw_dev *rtwdev, u32 addr, int *err_ret) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ u8 buf[4]; -+ int i; -+ -+ if (rtw_sdio_use_memcpy_io(rtwdev, addr, 4)) -+ return sdio_readl(rtwsdio->sdio_func, addr, err_ret); -+ -+ for (i = 0; i < 4; i++) { -+ buf[i] = sdio_readb(rtwsdio->sdio_func, addr + i, err_ret); -+ if (*err_ret) -+ return 0; -+ } -+ -+ return le32_to_cpu(*(__le32 *)buf); -+} -+ -+static u16 rtw_sdio_readw(struct rtw_dev *rtwdev, u32 addr, int *err_ret) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ u8 buf[2]; -+ int i; -+ -+ for (i = 0; i < 2; i++) { -+ buf[i] = sdio_readb(rtwsdio->sdio_func, addr + i, err_ret); -+ if (*err_ret) -+ return 0; -+ } -+ -+ return le16_to_cpu(*(__le16 *)buf); -+} -+ -+static u32 rtw_sdio_to_io_address(struct rtw_dev *rtwdev, u32 addr, -+ bool direct) -+{ -+ if (!direct) -+ return addr; -+ -+ if (!rtw_sdio_is_bus_addr(addr)) -+ addr |= WLAN_IOREG_OFFSET; -+ -+ return rtw_sdio_to_bus_offset(rtwdev, addr); -+} -+ -+static bool rtw_sdio_use_direct_io(struct rtw_dev *rtwdev, u32 addr) -+{ -+ return !rtw_sdio_is_sdio30_supported(rtwdev) || -+ rtw_sdio_is_bus_addr(addr); -+} -+ -+static int rtw_sdio_indirect_reg_cfg(struct rtw_dev *rtwdev, u32 addr, u32 cfg) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ unsigned int retry; -+ u32 reg_cfg; -+ int ret; -+ u8 tmp; -+ -+ reg_cfg = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_CFG); -+ -+ rtw_sdio_writel(rtwdev, addr | cfg | BIT_SDIO_INDIRECT_REG_CFG_UNK20, -+ reg_cfg, &ret); -+ if (ret) -+ return ret; -+ -+ for (retry = 0; retry < RTW_SDIO_INDIRECT_RW_RETRIES; retry++) { -+ tmp = sdio_readb(rtwsdio->sdio_func, reg_cfg + 2, &ret); -+ if (!ret && (tmp & BIT(4))) -+ return 0; -+ } -+ -+ return -ETIMEDOUT; -+} -+ -+static u8 rtw_sdio_indirect_read8(struct rtw_dev *rtwdev, u32 addr, -+ int *err_ret) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ u32 reg_data; -+ -+ *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, -+ BIT_SDIO_INDIRECT_REG_CFG_READ); -+ if (*err_ret) -+ return 0; -+ -+ reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); -+ return sdio_readb(rtwsdio->sdio_func, reg_data, err_ret); -+} -+ -+static int rtw_sdio_indirect_read_bytes(struct rtw_dev *rtwdev, u32 addr, -+ u8 *buf, int count) -+{ -+ int i, ret = 0; -+ -+ for (i = 0; i < count; i++) { -+ buf[i] = rtw_sdio_indirect_read8(rtwdev, addr + i, &ret); -+ if (ret) -+ break; -+ } -+ -+ return ret; -+} -+ -+static u16 rtw_sdio_indirect_read16(struct rtw_dev *rtwdev, u32 addr, -+ int *err_ret) -+{ -+ u32 reg_data; -+ u8 buf[2]; -+ -+ if (!IS_ALIGNED(addr, 2)) { -+ *err_ret = rtw_sdio_indirect_read_bytes(rtwdev, addr, buf, 2); -+ if (*err_ret) -+ return 0; -+ -+ return le16_to_cpu(*(__le16 *)buf); -+ } -+ -+ *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, -+ BIT_SDIO_INDIRECT_REG_CFG_READ); -+ if (*err_ret) -+ return 0; -+ -+ reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); -+ return rtw_sdio_readw(rtwdev, reg_data, err_ret); -+} -+ -+static u32 rtw_sdio_indirect_read32(struct rtw_dev *rtwdev, u32 addr, -+ int *err_ret) -+{ -+ u32 reg_data; -+ u8 buf[4]; -+ -+ if (!IS_ALIGNED(addr, 4)) { -+ *err_ret = rtw_sdio_indirect_read_bytes(rtwdev, addr, buf, 4); -+ if (*err_ret) -+ return 0; -+ -+ return le32_to_cpu(*(__le32 *)buf); -+ } -+ -+ *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, -+ BIT_SDIO_INDIRECT_REG_CFG_READ); -+ if (*err_ret) -+ return 0; -+ -+ reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); -+ return rtw_sdio_readl(rtwdev, reg_data, err_ret); -+} -+ -+static u8 rtw_sdio_read8(struct rtw_dev *rtwdev, u32 addr) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ bool direct, bus_claim; -+ int ret; -+ u8 val; -+ -+ direct = rtw_sdio_use_direct_io(rtwdev, addr); -+ addr = rtw_sdio_to_io_address(rtwdev, addr, direct); -+ bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); -+ -+ if (bus_claim) -+ sdio_claim_host(rtwsdio->sdio_func); -+ -+ if (direct) -+ val = sdio_readb(rtwsdio->sdio_func, addr, &ret); -+ else -+ val = rtw_sdio_indirect_read8(rtwdev, addr, &ret); -+ -+ if (bus_claim) -+ sdio_release_host(rtwsdio->sdio_func); -+ -+ if (ret) -+ rtw_warn(rtwdev, "sdio read8 failed (0x%x): %d", addr, ret); -+ -+ return val; -+} -+ -+static u16 rtw_sdio_read16(struct rtw_dev *rtwdev, u32 addr) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ bool direct, bus_claim; -+ int ret; -+ u16 val; -+ -+ direct = rtw_sdio_use_direct_io(rtwdev, addr); -+ addr = rtw_sdio_to_io_address(rtwdev, addr, direct); -+ bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); -+ -+ if (bus_claim) -+ sdio_claim_host(rtwsdio->sdio_func); -+ -+ if (direct) -+ val = rtw_sdio_readw(rtwdev, addr, &ret); -+ else -+ val = rtw_sdio_indirect_read16(rtwdev, addr, &ret); -+ -+ if (bus_claim) -+ sdio_release_host(rtwsdio->sdio_func); -+ -+ if (ret) -+ rtw_warn(rtwdev, "sdio read16 failed (0x%x): %d", addr, ret); -+ -+ return val; -+} -+ -+static u32 rtw_sdio_read32(struct rtw_dev *rtwdev, u32 addr) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ bool direct, bus_claim; -+ u32 val; -+ int ret; -+ -+ direct = rtw_sdio_use_direct_io(rtwdev, addr); -+ addr = rtw_sdio_to_io_address(rtwdev, addr, direct); -+ bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); -+ -+ if (bus_claim) -+ sdio_claim_host(rtwsdio->sdio_func); -+ -+ if (direct) -+ val = rtw_sdio_readl(rtwdev, addr, &ret); -+ else -+ val = rtw_sdio_indirect_read32(rtwdev, addr, &ret); -+ -+ if (bus_claim) -+ sdio_release_host(rtwsdio->sdio_func); -+ -+ if (ret) -+ rtw_warn(rtwdev, "sdio read32 failed (0x%x): %d", addr, ret); -+ -+ return val; -+} -+ -+static void rtw_sdio_indirect_write8(struct rtw_dev *rtwdev, u8 val, u32 addr, -+ int *err_ret) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ u32 reg_data; -+ -+ reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); -+ sdio_writeb(rtwsdio->sdio_func, val, reg_data, err_ret); -+ if (*err_ret) -+ return; -+ -+ *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, -+ BIT_SDIO_INDIRECT_REG_CFG_WRITE); -+} -+ -+static void rtw_sdio_indirect_write16(struct rtw_dev *rtwdev, u16 val, u32 addr, -+ int *err_ret) -+{ -+ u32 reg_data; -+ -+ if (!IS_ALIGNED(addr, 2)) { -+ addr = rtw_sdio_to_io_address(rtwdev, addr, true); -+ rtw_sdio_writew(rtwdev, val, addr, err_ret); -+ return; -+ } -+ -+ reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); -+ rtw_sdio_writew(rtwdev, val, reg_data, err_ret); -+ if (*err_ret) -+ return; -+ -+ *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, -+ BIT_SDIO_INDIRECT_REG_CFG_WRITE | -+ BIT_SDIO_INDIRECT_REG_CFG_WORD); -+} -+ -+static void rtw_sdio_indirect_write32(struct rtw_dev *rtwdev, u32 val, -+ u32 addr, int *err_ret) -+{ -+ u32 reg_data; -+ -+ if (!IS_ALIGNED(addr, 4)) { -+ addr = rtw_sdio_to_io_address(rtwdev, addr, true); -+ rtw_sdio_writel(rtwdev, val, addr, err_ret); -+ return; -+ } -+ -+ reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); -+ rtw_sdio_writel(rtwdev, val, reg_data, err_ret); -+ -+ *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, -+ BIT_SDIO_INDIRECT_REG_CFG_WRITE | -+ BIT_SDIO_INDIRECT_REG_CFG_DWORD); -+} -+ -+static void rtw_sdio_write8(struct rtw_dev *rtwdev, u32 addr, u8 val) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ bool direct, bus_claim; -+ int ret; -+ -+ direct = rtw_sdio_use_direct_io(rtwdev, addr); -+ addr = rtw_sdio_to_io_address(rtwdev, addr, direct); -+ bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); -+ -+ if (bus_claim) -+ sdio_claim_host(rtwsdio->sdio_func); -+ -+ if (direct) -+ sdio_writeb(rtwsdio->sdio_func, val, addr, &ret); -+ else -+ rtw_sdio_indirect_write8(rtwdev, val, addr, &ret); -+ -+ if (bus_claim) -+ sdio_release_host(rtwsdio->sdio_func); -+ -+ if (ret) -+ rtw_warn(rtwdev, "sdio write8 failed (0x%x): %d", addr, ret); -+} -+ -+static void rtw_sdio_write16(struct rtw_dev *rtwdev, u32 addr, u16 val) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ bool direct, bus_claim; -+ int ret; -+ -+ direct = rtw_sdio_use_direct_io(rtwdev, addr); -+ addr = rtw_sdio_to_io_address(rtwdev, addr, direct); -+ bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); -+ -+ if (bus_claim) -+ sdio_claim_host(rtwsdio->sdio_func); -+ -+ if (direct) -+ rtw_sdio_writew(rtwdev, val, addr, &ret); -+ else -+ rtw_sdio_indirect_write16(rtwdev, val, addr, &ret); -+ -+ if (bus_claim) -+ sdio_release_host(rtwsdio->sdio_func); -+ -+ if (ret) -+ rtw_warn(rtwdev, "sdio write16 failed (0x%x): %d", addr, ret); -+} -+ -+static void rtw_sdio_write32(struct rtw_dev *rtwdev, u32 addr, u32 val) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ bool direct, bus_claim; -+ int ret; -+ -+ direct = rtw_sdio_use_direct_io(rtwdev, addr); -+ addr = rtw_sdio_to_io_address(rtwdev, addr, direct); -+ bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); -+ -+ if (bus_claim) -+ sdio_claim_host(rtwsdio->sdio_func); -+ -+ if (direct) -+ rtw_sdio_writel(rtwdev, val, addr, &ret); -+ else -+ rtw_sdio_indirect_write32(rtwdev, val, addr, &ret); -+ -+ if (bus_claim) -+ sdio_release_host(rtwsdio->sdio_func); -+ -+ if (ret) -+ rtw_warn(rtwdev, "sdio write32 failed (0x%x): %d", addr, ret); -+} -+ -+static u32 rtw_sdio_get_tx_addr(struct rtw_dev *rtwdev, size_t size, -+ enum rtw_tx_queue_type queue) -+{ -+ u32 txaddr; -+ -+ switch (queue) { -+ case RTW_TX_QUEUE_BCN: -+ case RTW_TX_QUEUE_H2C: -+ case RTW_TX_QUEUE_HI0: -+ txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, -+ REG_SDIO_CMD_ADDR_TXFF_HIGH); -+ break; -+ case RTW_TX_QUEUE_VI: -+ case RTW_TX_QUEUE_VO: -+ txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, -+ REG_SDIO_CMD_ADDR_TXFF_NORMAL); -+ break; -+ case RTW_TX_QUEUE_BE: -+ case RTW_TX_QUEUE_BK: -+ txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, -+ REG_SDIO_CMD_ADDR_TXFF_LOW); -+ break; -+ case RTW_TX_QUEUE_MGMT: -+ txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, -+ REG_SDIO_CMD_ADDR_TXFF_EXTRA); -+ break; -+ default: -+ rtw_warn(rtwdev, "Unsupported queue for TX addr: 0x%02x\n", -+ queue); -+ return 0; -+ } -+ -+ txaddr += DIV_ROUND_UP(size, 4); -+ -+ return txaddr; -+}; -+ -+static int rtw_sdio_read_port(struct rtw_dev *rtwdev, u8 *buf, size_t count) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ struct mmc_host *host = rtwsdio->sdio_func->card->host; -+ bool bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); -+ u32 rxaddr = rtwsdio->rx_addr++; -+ size_t bytes; -+ int ret; -+ -+ if (bus_claim) -+ sdio_claim_host(rtwsdio->sdio_func); -+ -+ while (count > 0) { -+ bytes = min_t(size_t, host->max_req_size, count); -+ -+ ret = sdio_memcpy_fromio(rtwsdio->sdio_func, buf, -+ RTW_SDIO_ADDR_RX_RX0FF_GEN(rxaddr), -+ bytes); -+ if (ret) { -+ rtw_warn(rtwdev, -+ "Failed to read %zu byte(s) from SDIO port 0x%08x", -+ bytes, rxaddr); -+ break; -+ } -+ -+ count -= bytes; -+ buf += bytes; -+ } -+ -+ if (bus_claim) -+ sdio_release_host(rtwsdio->sdio_func); -+ -+ return ret; -+} -+ -+static int rtw_sdio_check_free_txpg(struct rtw_dev *rtwdev, u8 queue, -+ size_t count) -+{ -+ unsigned int pages_free, pages_needed; -+ -+ if (rtw_chip_wcpu_11n(rtwdev)) { -+ u32 free_txpg; -+ -+ free_txpg = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG); -+ -+ switch (queue) { -+ case RTW_TX_QUEUE_BCN: -+ case RTW_TX_QUEUE_H2C: -+ case RTW_TX_QUEUE_HI0: -+ case RTW_TX_QUEUE_MGMT: -+ /* high */ -+ pages_free = free_txpg & 0xff; -+ break; -+ case RTW_TX_QUEUE_VI: -+ case RTW_TX_QUEUE_VO: -+ /* normal */ -+ pages_free = (free_txpg >> 8) & 0xff; -+ break; -+ case RTW_TX_QUEUE_BE: -+ case RTW_TX_QUEUE_BK: -+ /* low */ -+ pages_free = (free_txpg >> 16) & 0xff; -+ break; -+ default: -+ rtw_warn(rtwdev, "Unknown mapping for queue %u\n", queue); -+ return -EINVAL; -+ } -+ -+ /* add the pages from the public queue */ -+ pages_free += (free_txpg >> 24) & 0xff; -+ } else { -+ u32 free_txpg[3]; -+ -+ free_txpg[0] = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG); -+ free_txpg[1] = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG + 4); -+ free_txpg[2] = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG + 8); -+ -+ switch (queue) { -+ case RTW_TX_QUEUE_BCN: -+ case RTW_TX_QUEUE_H2C: -+ case RTW_TX_QUEUE_HI0: -+ /* high */ -+ pages_free = free_txpg[0] & 0xfff; -+ break; -+ case RTW_TX_QUEUE_VI: -+ case RTW_TX_QUEUE_VO: -+ /* normal */ -+ pages_free = (free_txpg[0] >> 16) & 0xfff; -+ break; -+ case RTW_TX_QUEUE_BE: -+ case RTW_TX_QUEUE_BK: -+ /* low */ -+ pages_free = free_txpg[1] & 0xfff; -+ break; -+ case RTW_TX_QUEUE_MGMT: -+ /* extra */ -+ pages_free = free_txpg[2] & 0xfff; -+ break; -+ default: -+ rtw_warn(rtwdev, "Unknown mapping for queue %u\n", queue); -+ return -EINVAL; -+ } -+ -+ /* add the pages from the public queue */ -+ pages_free += (free_txpg[1] >> 16) & 0xfff; -+ } -+ -+ pages_needed = DIV_ROUND_UP(count, rtwdev->chip->page_size); -+ -+ if (pages_needed > pages_free) { -+ rtw_dbg(rtwdev, RTW_DBG_SDIO, -+ "Not enough free pages (%u needed, %u free) in queue %u for %zu bytes\n", -+ pages_needed, pages_free, queue, count); -+ return -EBUSY; -+ } -+ -+ return 0; -+} -+ -+static int rtw_sdio_write_port(struct rtw_dev *rtwdev, struct sk_buff *skb, -+ enum rtw_tx_queue_type queue) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ bool bus_claim; -+ size_t txsize; -+ u32 txaddr; -+ int ret; -+ -+ txaddr = rtw_sdio_get_tx_addr(rtwdev, skb->len, queue); -+ if (!txaddr) -+ return -EINVAL; -+ -+ txsize = sdio_align_size(rtwsdio->sdio_func, skb->len); -+ -+ ret = rtw_sdio_check_free_txpg(rtwdev, queue, txsize); -+ if (ret) -+ return ret; -+ -+ if (!IS_ALIGNED((unsigned long)skb->data, RTW_SDIO_DATA_PTR_ALIGN)) -+ rtw_warn(rtwdev, "Got unaligned SKB in %s() for queue %u\n", -+ __func__, queue); -+ -+ bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); -+ -+ if (bus_claim) -+ sdio_claim_host(rtwsdio->sdio_func); -+ -+ ret = sdio_memcpy_toio(rtwsdio->sdio_func, txaddr, skb->data, txsize); -+ -+ if (bus_claim) -+ sdio_release_host(rtwsdio->sdio_func); -+ -+ if (ret) -+ rtw_warn(rtwdev, -+ "Failed to write %zu byte(s) to SDIO port 0x%08x", -+ txsize, txaddr); -+ -+ return ret; -+} -+ -+static void rtw_sdio_init(struct rtw_dev *rtwdev) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ -+ rtwsdio->irq_mask = REG_SDIO_HIMR_RX_REQUEST | REG_SDIO_HIMR_CPWM1; -+} -+ -+static void rtw_sdio_enable_rx_aggregation(struct rtw_dev *rtwdev) -+{ -+ u8 size, timeout; -+ -+ if (rtw_chip_wcpu_11n(rtwdev)) { -+ size = 0x6; -+ timeout = 0x6; -+ } else { -+ size = 0xff; -+ timeout = 0x1; -+ } -+ -+ /* Make the firmware honor the size limit configured below */ -+ rtw_write32_set(rtwdev, REG_RXDMA_AGG_PG_TH, BIT_EN_PRE_CALC); -+ -+ rtw_write8_set(rtwdev, REG_TXDMA_PQ_MAP, BIT_RXDMA_AGG_EN); -+ -+ rtw_write16(rtwdev, REG_RXDMA_AGG_PG_TH, -+ FIELD_PREP(BIT_RXDMA_AGG_PG_TH, size) | -+ FIELD_PREP(BIT_DMA_AGG_TO_V1, timeout)); -+ -+ rtw_write8_set(rtwdev, REG_RXDMA_MODE, BIT_DMA_MODE); -+} -+ -+static void rtw_sdio_enable_interrupt(struct rtw_dev *rtwdev) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ -+ rtw_write32(rtwdev, REG_SDIO_HIMR, rtwsdio->irq_mask); -+} -+ -+static void rtw_sdio_disable_interrupt(struct rtw_dev *rtwdev) -+{ -+ rtw_write32(rtwdev, REG_SDIO_HIMR, 0x0); -+} -+ -+static u8 rtw_sdio_get_tx_qsel(struct rtw_dev *rtwdev, struct sk_buff *skb, -+ u8 queue) -+{ -+ switch (queue) { -+ case RTW_TX_QUEUE_BCN: -+ return TX_DESC_QSEL_BEACON; -+ case RTW_TX_QUEUE_H2C: -+ return TX_DESC_QSEL_H2C; -+ case RTW_TX_QUEUE_MGMT: -+ if (rtw_chip_wcpu_11n(rtwdev)) -+ return TX_DESC_QSEL_HIGH; -+ else -+ return TX_DESC_QSEL_MGMT; -+ case RTW_TX_QUEUE_HI0: -+ return TX_DESC_QSEL_HIGH; -+ default: -+ return skb->priority; -+ } -+} -+ -+static int rtw_sdio_setup(struct rtw_dev *rtwdev) -+{ -+ /* nothing to do */ -+ return 0; -+} -+ -+static int rtw_sdio_start(struct rtw_dev *rtwdev) -+{ -+ rtw_sdio_enable_rx_aggregation(rtwdev); -+ rtw_sdio_enable_interrupt(rtwdev); -+ -+ return 0; -+} -+ -+static void rtw_sdio_stop(struct rtw_dev *rtwdev) -+{ -+ rtw_sdio_disable_interrupt(rtwdev); -+} -+ -+static void rtw_sdio_deep_ps_enter(struct rtw_dev *rtwdev) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ bool tx_empty = true; -+ u8 queue; -+ -+ if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) { -+ /* Deep PS state is not allowed to TX-DMA */ -+ for (queue = 0; queue < RTK_MAX_TX_QUEUE_NUM; queue++) { -+ /* BCN queue is rsvd page, does not have DMA interrupt -+ * H2C queue is managed by firmware -+ */ -+ if (queue == RTW_TX_QUEUE_BCN || -+ queue == RTW_TX_QUEUE_H2C) -+ continue; -+ -+ /* check if there is any skb DMAing */ -+ if (skb_queue_len(&rtwsdio->tx_queue[queue])) { -+ tx_empty = false; -+ break; -+ } -+ } -+ } -+ -+ if (!tx_empty) { -+ rtw_dbg(rtwdev, RTW_DBG_PS, -+ "TX path not empty, cannot enter deep power save state\n"); -+ return; -+ } -+ -+ set_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags); -+ rtw_power_mode_change(rtwdev, true); -+} -+ -+static void rtw_sdio_deep_ps_leave(struct rtw_dev *rtwdev) -+{ -+ if (test_and_clear_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) -+ rtw_power_mode_change(rtwdev, false); -+} -+ -+static void rtw_sdio_deep_ps(struct rtw_dev *rtwdev, bool enter) -+{ -+ if (enter && !test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) -+ rtw_sdio_deep_ps_enter(rtwdev); -+ -+ if (!enter && test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) -+ rtw_sdio_deep_ps_leave(rtwdev); -+} -+ -+static void rtw_sdio_tx_kick_off(struct rtw_dev *rtwdev) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ -+ queue_work(rtwsdio->txwq, &rtwsdio->tx_handler_data->work); -+} -+ -+static void rtw_sdio_link_ps(struct rtw_dev *rtwdev, bool enter) -+{ -+ /* nothing to do */ -+} -+ -+static void rtw_sdio_interface_cfg(struct rtw_dev *rtwdev) -+{ -+ u32 val; -+ -+ rtw_read32(rtwdev, REG_SDIO_FREE_TXPG); -+ -+ val = rtw_read32(rtwdev, REG_SDIO_TX_CTRL); -+ val &= 0xfff8; -+ rtw_write32(rtwdev, REG_SDIO_TX_CTRL, val); -+} -+ -+static struct rtw_sdio_tx_data *rtw_sdio_get_tx_data(struct sk_buff *skb) -+{ -+ struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); -+ -+ BUILD_BUG_ON(sizeof(struct rtw_sdio_tx_data) > -+ sizeof(info->status.status_driver_data)); -+ -+ return (struct rtw_sdio_tx_data *)info->status.status_driver_data; -+} -+ -+static void rtw_sdio_tx_skb_prepare(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ struct sk_buff *skb, -+ enum rtw_tx_queue_type queue) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ unsigned long data_addr, aligned_addr; -+ size_t offset; -+ u8 *pkt_desc; -+ -+ pkt_desc = skb_push(skb, chip->tx_pkt_desc_sz); -+ -+ data_addr = (unsigned long)pkt_desc; -+ aligned_addr = ALIGN(data_addr, RTW_SDIO_DATA_PTR_ALIGN); -+ -+ if (data_addr != aligned_addr) { -+ /* Ensure that the start of the pkt_desc is always aligned at -+ * RTW_SDIO_DATA_PTR_ALIGN. -+ */ -+ offset = RTW_SDIO_DATA_PTR_ALIGN - (aligned_addr - data_addr); -+ -+ pkt_desc = skb_push(skb, offset); -+ -+ /* By inserting padding to align the start of the pkt_desc we -+ * need to inform the firmware that the actual data starts at -+ * a different offset than normal. -+ */ -+ pkt_info->offset += offset; -+ } -+ -+ memset(pkt_desc, 0, chip->tx_pkt_desc_sz); -+ -+ pkt_info->qsel = rtw_sdio_get_tx_qsel(rtwdev, skb, queue); -+ -+ rtw_tx_fill_tx_desc(pkt_info, skb); -+ rtw_tx_fill_txdesc_checksum(rtwdev, pkt_info, pkt_desc); -+} -+ -+static int rtw_sdio_write_data(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ struct sk_buff *skb, -+ enum rtw_tx_queue_type queue) -+{ -+ int ret; -+ -+ rtw_sdio_tx_skb_prepare(rtwdev, pkt_info, skb, queue); -+ -+ ret = rtw_sdio_write_port(rtwdev, skb, queue); -+ dev_kfree_skb_any(skb); -+ -+ return ret; -+} -+ -+static int rtw_sdio_write_data_rsvd_page(struct rtw_dev *rtwdev, u8 *buf, -+ u32 size) -+{ -+ struct rtw_tx_pkt_info pkt_info = {}; -+ struct sk_buff *skb; -+ -+ skb = rtw_tx_write_data_rsvd_page_get(rtwdev, &pkt_info, buf, size); -+ if (!skb) -+ return -ENOMEM; -+ -+ return rtw_sdio_write_data(rtwdev, &pkt_info, skb, RTW_TX_QUEUE_BCN); -+} -+ -+static int rtw_sdio_write_data_h2c(struct rtw_dev *rtwdev, u8 *buf, u32 size) -+{ -+ struct rtw_tx_pkt_info pkt_info = {}; -+ struct sk_buff *skb; -+ -+ skb = rtw_tx_write_data_h2c_get(rtwdev, &pkt_info, buf, size); -+ if (!skb) -+ return -ENOMEM; -+ -+ return rtw_sdio_write_data(rtwdev, &pkt_info, skb, RTW_TX_QUEUE_H2C); -+} -+ -+static int rtw_sdio_tx_write(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ struct sk_buff *skb) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ enum rtw_tx_queue_type queue = rtw_tx_queue_mapping(skb); -+ struct rtw_sdio_tx_data *tx_data; -+ -+ rtw_sdio_tx_skb_prepare(rtwdev, pkt_info, skb, queue); -+ -+ tx_data = rtw_sdio_get_tx_data(skb); -+ tx_data->sn = pkt_info->sn; -+ -+ skb_queue_tail(&rtwsdio->tx_queue[queue], skb); -+ -+ return 0; -+} -+ -+static void rtw_sdio_tx_err_isr(struct rtw_dev *rtwdev) -+{ -+ u32 val = rtw_read32(rtwdev, REG_TXDMA_STATUS); -+ -+ rtw_write32(rtwdev, REG_TXDMA_STATUS, val); -+} -+ -+static void rtw_sdio_rx_skb(struct rtw_dev *rtwdev, struct sk_buff *skb, -+ u32 pkt_offset, struct rtw_rx_pkt_stat *pkt_stat, -+ struct ieee80211_rx_status *rx_status) -+{ -+ *IEEE80211_SKB_RXCB(skb) = *rx_status; -+ -+ if (pkt_stat->is_c2h) { -+ skb_put(skb, pkt_stat->pkt_len + pkt_offset); -+ rtw_fw_c2h_cmd_rx_irqsafe(rtwdev, pkt_offset, skb); -+ return; -+ } -+ -+ skb_put(skb, pkt_stat->pkt_len); -+ skb_reserve(skb, pkt_offset); -+ -+ rtw_rx_stats(rtwdev, pkt_stat->vif, skb); -+ -+ ieee80211_rx_irqsafe(rtwdev->hw, skb); -+} -+ -+static void rtw_sdio_rxfifo_recv(struct rtw_dev *rtwdev, u32 rx_len) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ u32 pkt_desc_sz = chip->rx_pkt_desc_sz; -+ struct ieee80211_rx_status rx_status; -+ struct rtw_rx_pkt_stat pkt_stat; -+ struct sk_buff *skb, *split_skb; -+ u32 pkt_offset, curr_pkt_len; -+ size_t bufsz; -+ u8 *rx_desc; -+ int ret; -+ -+ bufsz = sdio_align_size(rtwsdio->sdio_func, rx_len); -+ -+ skb = dev_alloc_skb(bufsz); -+ if (!skb) -+ return; -+ -+ ret = rtw_sdio_read_port(rtwdev, skb->data, bufsz); -+ if (ret) { -+ dev_kfree_skb_any(skb); -+ return; -+ } -+ -+ while (true) { -+ rx_desc = skb->data; -+ chip->ops->query_rx_desc(rtwdev, rx_desc, &pkt_stat, -+ &rx_status); -+ pkt_offset = pkt_desc_sz + pkt_stat.drv_info_sz + -+ pkt_stat.shift; -+ -+ curr_pkt_len = ALIGN(pkt_offset + pkt_stat.pkt_len, -+ RTW_SDIO_DATA_PTR_ALIGN); -+ -+ if ((curr_pkt_len + pkt_desc_sz) >= rx_len) { -+ /* Use the original skb (with it's adjusted offset) -+ * when processing the last (or even the only) entry to -+ * have it's memory freed automatically. -+ */ -+ rtw_sdio_rx_skb(rtwdev, skb, pkt_offset, &pkt_stat, -+ &rx_status); -+ break; -+ } -+ -+ split_skb = dev_alloc_skb(curr_pkt_len); -+ if (!split_skb) { -+ rtw_sdio_rx_skb(rtwdev, skb, pkt_offset, &pkt_stat, -+ &rx_status); -+ break; -+ } -+ -+ skb_copy_header(split_skb, skb); -+ memcpy(split_skb->data, skb->data, curr_pkt_len); -+ -+ rtw_sdio_rx_skb(rtwdev, split_skb, pkt_offset, &pkt_stat, -+ &rx_status); -+ -+ /* Move to the start of the next RX descriptor */ -+ skb_reserve(skb, curr_pkt_len); -+ rx_len -= curr_pkt_len; -+ } -+} -+ -+static void rtw_sdio_rx_isr(struct rtw_dev *rtwdev) -+{ -+ u32 rx_len, hisr, total_rx_bytes = 0; -+ -+ do { -+ if (rtw_chip_wcpu_11n(rtwdev)) -+ rx_len = rtw_read16(rtwdev, REG_SDIO_RX0_REQ_LEN); -+ else -+ rx_len = rtw_read32(rtwdev, REG_SDIO_RX0_REQ_LEN); -+ -+ if (!rx_len) -+ break; -+ -+ rtw_sdio_rxfifo_recv(rtwdev, rx_len); -+ -+ total_rx_bytes += rx_len; -+ -+ if (rtw_chip_wcpu_11n(rtwdev)) { -+ /* Stop if no more RX requests are pending, even if -+ * rx_len could be greater than zero in the next -+ * iteration. This is needed because the RX buffer may -+ * already contain data while either HW or FW are not -+ * done filling that buffer yet. Still reading the -+ * buffer can result in packets where -+ * rtw_rx_pkt_stat.pkt_len is zero or points beyond the -+ * end of the buffer. -+ */ -+ hisr = rtw_read32(rtwdev, REG_SDIO_HISR); -+ } else { -+ /* RTW_WCPU_11AC chips have improved hardware or -+ * firmware and can use rx_len unconditionally. -+ */ -+ hisr = REG_SDIO_HISR_RX_REQUEST; -+ } -+ } while (total_rx_bytes < SZ_64K && hisr & REG_SDIO_HISR_RX_REQUEST); -+} -+ -+static void rtw_sdio_handle_interrupt(struct sdio_func *sdio_func) -+{ -+ struct ieee80211_hw *hw = sdio_get_drvdata(sdio_func); -+ struct rtw_sdio *rtwsdio; -+ struct rtw_dev *rtwdev; -+ u32 hisr; -+ -+ rtwdev = hw->priv; -+ rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ -+ rtwsdio->irq_thread = current; -+ -+ hisr = rtw_read32(rtwdev, REG_SDIO_HISR); -+ -+ if (hisr & REG_SDIO_HISR_TXERR) -+ rtw_sdio_tx_err_isr(rtwdev); -+ if (hisr & REG_SDIO_HISR_RX_REQUEST) { -+ hisr &= ~REG_SDIO_HISR_RX_REQUEST; -+ rtw_sdio_rx_isr(rtwdev); -+ } -+ -+ rtw_write32(rtwdev, REG_SDIO_HISR, hisr); -+ -+ rtwsdio->irq_thread = NULL; -+} -+ -+static int __maybe_unused rtw_sdio_suspend(struct device *dev) -+{ -+ struct sdio_func *func = dev_to_sdio_func(dev); -+ struct ieee80211_hw *hw = dev_get_drvdata(dev); -+ struct rtw_dev *rtwdev = hw->priv; -+ int ret; -+ -+ ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER); -+ if (ret) -+ rtw_err(rtwdev, "Failed to host PM flag MMC_PM_KEEP_POWER"); -+ -+ return ret; -+} -+ -+static int __maybe_unused rtw_sdio_resume(struct device *dev) -+{ -+ return 0; -+} -+ -+SIMPLE_DEV_PM_OPS(rtw_sdio_pm_ops, rtw_sdio_suspend, rtw_sdio_resume); -+EXPORT_SYMBOL(rtw_sdio_pm_ops); -+ -+static int rtw_sdio_claim(struct rtw_dev *rtwdev, struct sdio_func *sdio_func) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ int ret; -+ -+ sdio_claim_host(sdio_func); -+ -+ ret = sdio_enable_func(sdio_func); -+ if (ret) { -+ rtw_err(rtwdev, "Failed to enable SDIO func"); -+ goto err_release_host; -+ } -+ -+ ret = sdio_set_block_size(sdio_func, RTW_SDIO_BLOCK_SIZE); -+ if (ret) { -+ rtw_err(rtwdev, "Failed to set SDIO block size to 512"); -+ goto err_disable_func; -+ } -+ -+ rtwsdio->sdio_func = sdio_func; -+ -+ rtwsdio->sdio3_bus_mode = mmc_card_uhs(sdio_func->card); -+ -+ sdio_set_drvdata(sdio_func, rtwdev->hw); -+ SET_IEEE80211_DEV(rtwdev->hw, &sdio_func->dev); -+ -+ sdio_release_host(sdio_func); -+ -+ return 0; -+ -+err_disable_func: -+ sdio_disable_func(sdio_func); -+err_release_host: -+ sdio_release_host(sdio_func); -+ return ret; -+} -+ -+static void rtw_sdio_declaim(struct rtw_dev *rtwdev, -+ struct sdio_func *sdio_func) -+{ -+ sdio_claim_host(sdio_func); -+ sdio_disable_func(sdio_func); -+ sdio_release_host(sdio_func); -+} -+ -+static struct rtw_hci_ops rtw_sdio_ops = { -+ .tx_write = rtw_sdio_tx_write, -+ .tx_kick_off = rtw_sdio_tx_kick_off, -+ .setup = rtw_sdio_setup, -+ .start = rtw_sdio_start, -+ .stop = rtw_sdio_stop, -+ .deep_ps = rtw_sdio_deep_ps, -+ .link_ps = rtw_sdio_link_ps, -+ .interface_cfg = rtw_sdio_interface_cfg, -+ -+ .read8 = rtw_sdio_read8, -+ .read16 = rtw_sdio_read16, -+ .read32 = rtw_sdio_read32, -+ .write8 = rtw_sdio_write8, -+ .write16 = rtw_sdio_write16, -+ .write32 = rtw_sdio_write32, -+ .write_data_rsvd_page = rtw_sdio_write_data_rsvd_page, -+ .write_data_h2c = rtw_sdio_write_data_h2c, -+}; -+ -+static int rtw_sdio_request_irq(struct rtw_dev *rtwdev, -+ struct sdio_func *sdio_func) -+{ -+ int ret; -+ -+ sdio_claim_host(sdio_func); -+ ret = sdio_claim_irq(sdio_func, &rtw_sdio_handle_interrupt); -+ sdio_release_host(sdio_func); -+ -+ if (ret) { -+ rtw_err(rtwdev, "failed to claim SDIO IRQ"); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static void rtw_sdio_indicate_tx_status(struct rtw_dev *rtwdev, -+ struct sk_buff *skb) -+{ -+ struct rtw_sdio_tx_data *tx_data = rtw_sdio_get_tx_data(skb); -+ struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); -+ struct ieee80211_hw *hw = rtwdev->hw; -+ -+ /* enqueue to wait for tx report */ -+ if (info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS) { -+ rtw_tx_report_enqueue(rtwdev, skb, tx_data->sn); -+ return; -+ } -+ -+ /* always ACK for others, then they won't be marked as drop */ -+ ieee80211_tx_info_clear_status(info); -+ if (info->flags & IEEE80211_TX_CTL_NO_ACK) -+ info->flags |= IEEE80211_TX_STAT_NOACK_TRANSMITTED; -+ else -+ info->flags |= IEEE80211_TX_STAT_ACK; -+ -+ ieee80211_tx_status_irqsafe(hw, skb); -+} -+ -+static void rtw_sdio_process_tx_queue(struct rtw_dev *rtwdev, -+ enum rtw_tx_queue_type queue) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ struct sk_buff *skb; -+ int ret; -+ -+ skb = skb_dequeue(&rtwsdio->tx_queue[queue]); -+ if (!skb) -+ return; -+ -+ ret = rtw_sdio_write_port(rtwdev, skb, queue); -+ if (ret) { -+ skb_queue_head(&rtwsdio->tx_queue[queue], skb); -+ return; -+ } -+ -+ if (queue <= RTW_TX_QUEUE_VO) -+ rtw_sdio_indicate_tx_status(rtwdev, skb); -+ else -+ dev_kfree_skb_any(skb); -+} -+ -+static void rtw_sdio_tx_handler(struct work_struct *work) -+{ -+ struct rtw_sdio_work_data *work_data = -+ container_of(work, struct rtw_sdio_work_data, work); -+ struct rtw_sdio *rtwsdio; -+ struct rtw_dev *rtwdev; -+ int limit, queue; -+ -+ rtwdev = work_data->rtwdev; -+ rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ -+ if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) -+ rtw_sdio_deep_ps_leave(rtwdev); -+ -+ for (queue = RTK_MAX_TX_QUEUE_NUM - 1; queue >= 0; queue--) { -+ for (limit = 0; limit < 1000; limit++) { -+ rtw_sdio_process_tx_queue(rtwdev, queue); -+ -+ if (skb_queue_empty(&rtwsdio->tx_queue[queue])) -+ break; -+ } -+ } -+} -+ -+static void rtw_sdio_free_irq(struct rtw_dev *rtwdev, -+ struct sdio_func *sdio_func) -+{ -+ sdio_claim_host(sdio_func); -+ sdio_release_irq(sdio_func); -+ sdio_release_host(sdio_func); -+} -+ -+static int rtw_sdio_init_tx(struct rtw_dev *rtwdev) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ int i; -+ -+ rtwsdio->txwq = create_singlethread_workqueue("rtw88_sdio: tx wq"); -+ if (!rtwsdio->txwq) { -+ rtw_err(rtwdev, "failed to create TX work queue\n"); -+ return -ENOMEM; -+ } -+ -+ for (i = 0; i < RTK_MAX_TX_QUEUE_NUM; i++) -+ skb_queue_head_init(&rtwsdio->tx_queue[i]); -+ rtwsdio->tx_handler_data = kmalloc(sizeof(*rtwsdio->tx_handler_data), -+ GFP_KERNEL); -+ if (!rtwsdio->tx_handler_data) -+ goto err_destroy_wq; -+ -+ rtwsdio->tx_handler_data->rtwdev = rtwdev; -+ INIT_WORK(&rtwsdio->tx_handler_data->work, rtw_sdio_tx_handler); -+ -+ return 0; -+ -+err_destroy_wq: -+ destroy_workqueue(rtwsdio->txwq); -+ return -ENOMEM; -+} -+ -+static void rtw_sdio_deinit_tx(struct rtw_dev *rtwdev) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ int i; -+ -+ for (i = 0; i < RTK_MAX_TX_QUEUE_NUM; i++) -+ skb_queue_purge(&rtwsdio->tx_queue[i]); -+ -+ flush_workqueue(rtwsdio->txwq); -+ destroy_workqueue(rtwsdio->txwq); -+ kfree(rtwsdio->tx_handler_data); -+} -+ -+int rtw_sdio_probe(struct sdio_func *sdio_func, -+ const struct sdio_device_id *id) -+{ -+ struct ieee80211_hw *hw; -+ struct rtw_dev *rtwdev; -+ int drv_data_size; -+ int ret; -+ -+ drv_data_size = sizeof(struct rtw_dev) + sizeof(struct rtw_sdio); -+ hw = ieee80211_alloc_hw(drv_data_size, &rtw_ops); -+ if (!hw) { -+ dev_err(&sdio_func->dev, "failed to allocate hw"); -+ return -ENOMEM; -+ } -+ -+ rtwdev = hw->priv; -+ rtwdev->hw = hw; -+ rtwdev->dev = &sdio_func->dev; -+ rtwdev->chip = (struct rtw_chip_info *)id->driver_data; -+ rtwdev->hci.ops = &rtw_sdio_ops; -+ rtwdev->hci.type = RTW_HCI_TYPE_SDIO; -+ -+ ret = rtw_core_init(rtwdev); -+ if (ret) -+ goto err_release_hw; -+ -+ rtw_dbg(rtwdev, RTW_DBG_SDIO, -+ "rtw88 SDIO probe: vendor=0x%04x device=%04x class=%02x", -+ id->vendor, id->device, id->class); -+ -+ ret = rtw_sdio_claim(rtwdev, sdio_func); -+ if (ret) { -+ rtw_err(rtwdev, "failed to claim SDIO device"); -+ goto err_deinit_core; -+ } -+ -+ rtw_sdio_init(rtwdev); -+ -+ ret = rtw_sdio_init_tx(rtwdev); -+ if (ret) { -+ rtw_err(rtwdev, "failed to init SDIO TX queue\n"); -+ goto err_sdio_declaim; -+ } -+ -+ ret = rtw_chip_info_setup(rtwdev); -+ if (ret) { -+ rtw_err(rtwdev, "failed to setup chip information"); -+ goto err_destroy_txwq; -+ } -+ -+ ret = rtw_sdio_request_irq(rtwdev, sdio_func); -+ if (ret) -+ goto err_destroy_txwq; -+ -+ ret = rtw_register_hw(rtwdev, hw); -+ if (ret) { -+ rtw_err(rtwdev, "failed to register hw"); -+ goto err_free_irq; -+ } -+ -+ return 0; -+ -+err_free_irq: -+ rtw_sdio_free_irq(rtwdev, sdio_func); -+err_destroy_txwq: -+ rtw_sdio_deinit_tx(rtwdev); -+err_sdio_declaim: -+ rtw_sdio_declaim(rtwdev, sdio_func); -+err_deinit_core: -+ rtw_core_deinit(rtwdev); -+err_release_hw: -+ ieee80211_free_hw(hw); -+ -+ return ret; -+} -+EXPORT_SYMBOL(rtw_sdio_probe); -+ -+void rtw_sdio_remove(struct sdio_func *sdio_func) -+{ -+ struct ieee80211_hw *hw = sdio_get_drvdata(sdio_func); -+ struct rtw_dev *rtwdev; -+ -+ if (!hw) -+ return; -+ -+ rtwdev = hw->priv; -+ -+ rtw_unregister_hw(rtwdev, hw); -+ rtw_sdio_disable_interrupt(rtwdev); -+ rtw_sdio_free_irq(rtwdev, sdio_func); -+ rtw_sdio_declaim(rtwdev, sdio_func); -+ rtw_sdio_deinit_tx(rtwdev); -+ rtw_core_deinit(rtwdev); -+ ieee80211_free_hw(hw); -+} -+EXPORT_SYMBOL(rtw_sdio_remove); -+ -+void rtw_sdio_shutdown(struct device *dev) -+{ -+ struct sdio_func *sdio_func = dev_to_sdio_func(dev); -+ const struct rtw_chip_info *chip; -+ struct ieee80211_hw *hw; -+ struct rtw_dev *rtwdev; -+ -+ hw = sdio_get_drvdata(sdio_func); -+ if (!hw) -+ return; -+ -+ rtwdev = hw->priv; -+ chip = rtwdev->chip; -+ -+ if (chip->ops->shutdown) -+ chip->ops->shutdown(rtwdev); -+} -+EXPORT_SYMBOL(rtw_sdio_shutdown); -+ -+MODULE_AUTHOR("Martin Blumenstingl"); -+MODULE_AUTHOR("Jernej Skrabec"); -+MODULE_DESCRIPTION("Realtek 802.11ac wireless SDIO driver"); -+MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/sdio.h b/drivers/net/wireless/realtek/rtw88/sdio.h -new file mode 100644 -index 000000000..3c659ed18 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/sdio.h -@@ -0,0 +1,178 @@ -+/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ -+/* Copyright (C) 2021 Martin Blumenstingl -+ * Copyright (C) 2021 Jernej Skrabec -+ */ -+ -+#ifndef __REG_SDIO_H_ -+#define __REG_SDIO_H_ -+ -+/* I/O bus domain address mapping */ -+#define SDIO_LOCAL_OFFSET 0x10250000 -+#define WLAN_IOREG_OFFSET 0x10260000 -+#define FIRMWARE_FIFO_OFFSET 0x10270000 -+#define TX_HIQ_OFFSET 0x10310000 -+#define TX_MIQ_OFFSET 0x10320000 -+#define TX_LOQ_OFFSET 0x10330000 -+#define TX_EPQ_OFFSET 0x10350000 -+#define RX_RX0FF_OFFSET 0x10340000 -+ -+#define RTW_SDIO_BUS_MSK 0xffff0000 -+#define SDIO_LOCAL_REG_MSK 0x00000fff -+#define WLAN_IOREG_REG_MSK 0x0000ffff -+ -+/* SDIO Tx Control */ -+#define REG_SDIO_TX_CTRL (SDIO_LOCAL_OFFSET + 0x0000) -+ -+/*SDIO status timeout*/ -+#define REG_SDIO_TIMEOUT (SDIO_LOCAL_OFFSET + 0x0002) -+ -+/* SDIO Host Interrupt Mask */ -+#define REG_SDIO_HIMR (SDIO_LOCAL_OFFSET + 0x0014) -+#define REG_SDIO_HIMR_RX_REQUEST BIT(0) -+#define REG_SDIO_HIMR_AVAL BIT(1) -+#define REG_SDIO_HIMR_TXERR BIT(2) -+#define REG_SDIO_HIMR_RXERR BIT(3) -+#define REG_SDIO_HIMR_TXFOVW BIT(4) -+#define REG_SDIO_HIMR_RXFOVW BIT(5) -+#define REG_SDIO_HIMR_TXBCNOK BIT(6) -+#define REG_SDIO_HIMR_TXBCNERR BIT(7) -+#define REG_SDIO_HIMR_BCNERLY_INT BIT(16) -+#define REG_SDIO_HIMR_C2HCMD BIT(17) -+#define REG_SDIO_HIMR_CPWM1 BIT(18) -+#define REG_SDIO_HIMR_CPWM2 BIT(19) -+#define REG_SDIO_HIMR_HSISR_IND BIT(20) -+#define REG_SDIO_HIMR_GTINT3_IND BIT(21) -+#define REG_SDIO_HIMR_GTINT4_IND BIT(22) -+#define REG_SDIO_HIMR_PSTIMEOUT BIT(23) -+#define REG_SDIO_HIMR_OCPINT BIT(24) -+#define REG_SDIO_HIMR_ATIMEND BIT(25) -+#define REG_SDIO_HIMR_ATIMEND_E BIT(26) -+#define REG_SDIO_HIMR_CTWEND BIT(27) -+/* the following two are RTL8188 SDIO Specific */ -+#define REG_SDIO_HIMR_MCU_ERR BIT(28) -+#define REG_SDIO_HIMR_TSF_BIT32_TOGGLE BIT(29) -+ -+/* SDIO Host Interrupt Service Routine */ -+#define REG_SDIO_HISR (SDIO_LOCAL_OFFSET + 0x0018) -+#define REG_SDIO_HISR_RX_REQUEST BIT(0) -+#define REG_SDIO_HISR_AVAL BIT(1) -+#define REG_SDIO_HISR_TXERR BIT(2) -+#define REG_SDIO_HISR_RXERR BIT(3) -+#define REG_SDIO_HISR_TXFOVW BIT(4) -+#define REG_SDIO_HISR_RXFOVW BIT(5) -+#define REG_SDIO_HISR_TXBCNOK BIT(6) -+#define REG_SDIO_HISR_TXBCNERR BIT(7) -+#define REG_SDIO_HISR_BCNERLY_INT BIT(16) -+#define REG_SDIO_HISR_C2HCMD BIT(17) -+#define REG_SDIO_HISR_CPWM1 BIT(18) -+#define REG_SDIO_HISR_CPWM2 BIT(19) -+#define REG_SDIO_HISR_HSISR_IND BIT(20) -+#define REG_SDIO_HISR_GTINT3_IND BIT(21) -+#define REG_SDIO_HISR_GTINT4_IND BIT(22) -+#define REG_SDIO_HISR_PSTIMEOUT BIT(23) -+#define REG_SDIO_HISR_OCPINT BIT(24) -+#define REG_SDIO_HISR_ATIMEND BIT(25) -+#define REG_SDIO_HISR_ATIMEND_E BIT(26) -+#define REG_SDIO_HISR_CTWEND BIT(27) -+/* the following two are RTL8188 SDIO Specific */ -+#define REG_SDIO_HISR_MCU_ERR BIT(28) -+#define REG_SDIO_HISR_TSF_BIT32_TOGGLE BIT(29) -+ -+/* HCI Current Power Mode */ -+#define REG_SDIO_HCPWM (SDIO_LOCAL_OFFSET + 0x0019) -+/* RXDMA Request Length */ -+#define REG_SDIO_RX0_REQ_LEN (SDIO_LOCAL_OFFSET + 0x001C) -+/* OQT Free Page */ -+#define REG_SDIO_OQT_FREE_PG (SDIO_LOCAL_OFFSET + 0x001E) -+/* Free Tx Buffer Page */ -+#define REG_SDIO_FREE_TXPG (SDIO_LOCAL_OFFSET + 0x0020) -+/* HCI Current Power Mode 1 */ -+#define REG_SDIO_HCPWM1 (SDIO_LOCAL_OFFSET + 0x0024) -+/* HCI Current Power Mode 2 */ -+#define REG_SDIO_HCPWM2 (SDIO_LOCAL_OFFSET + 0x0026) -+/* Free Tx Page Sequence */ -+#define REG_SDIO_FREE_TXPG_SEQ (SDIO_LOCAL_OFFSET + 0x0028) -+/* HTSF Information */ -+#define REG_SDIO_HTSFR_INFO (SDIO_LOCAL_OFFSET + 0x0030) -+#define REG_SDIO_HCPWM1_V2 (SDIO_LOCAL_OFFSET + 0x0038) -+/* H2C */ -+#define REG_SDIO_H2C (SDIO_LOCAL_OFFSET + 0x0060) -+/* HCI Request Power Mode 1 */ -+#define REG_SDIO_HRPWM1 (SDIO_LOCAL_OFFSET + 0x0080) -+/* HCI Request Power Mode 2 */ -+#define REG_SDIO_HRPWM2 (SDIO_LOCAL_OFFSET + 0x0082) -+/* HCI Power Save Clock */ -+#define REG_SDIO_HPS_CLKR (SDIO_LOCAL_OFFSET + 0x0084) -+/* SDIO HCI Suspend Control */ -+#define REG_SDIO_HSUS_CTRL (SDIO_LOCAL_OFFSET + 0x0086) -+#define BIT_HCI_SUS_REQ BIT(0) -+#define BIT_HCI_RESUME_RDY BIT(1) -+/* SDIO Host Extension Interrupt Mask Always */ -+#define REG_SDIO_HIMR_ON (SDIO_LOCAL_OFFSET + 0x0090) -+/* SDIO Host Extension Interrupt Status Always */ -+#define REG_SDIO_HISR_ON (SDIO_LOCAL_OFFSET + 0x0091) -+ -+#define REG_SDIO_INDIRECT_REG_CFG (SDIO_LOCAL_OFFSET + 0x0040) -+#define BIT_SDIO_INDIRECT_REG_CFG_WORD BIT(16) -+#define BIT_SDIO_INDIRECT_REG_CFG_DWORD BIT(17) -+#define BIT_SDIO_INDIRECT_REG_CFG_WRITE BIT(18) -+#define BIT_SDIO_INDIRECT_REG_CFG_READ BIT(19) -+#define BIT_SDIO_INDIRECT_REG_CFG_UNK20 BIT(20) -+#define REG_SDIO_INDIRECT_REG_DATA (SDIO_LOCAL_OFFSET + 0x0044) -+ -+/* Sdio Address for SDIO Local Reg, TRX FIFO, MAC Reg */ -+#define REG_SDIO_CMD_ADDR_MSK GENMASK(16, 13) -+#define REG_SDIO_CMD_ADDR_SDIO_REG 0 -+#define REG_SDIO_CMD_ADDR_MAC_REG 8 -+#define REG_SDIO_CMD_ADDR_TXFF_HIGH 4 -+#define REG_SDIO_CMD_ADDR_TXFF_LOW 6 -+#define REG_SDIO_CMD_ADDR_TXFF_NORMAL 5 -+#define REG_SDIO_CMD_ADDR_TXFF_EXTRA 7 -+#define REG_SDIO_CMD_ADDR_RXFF 7 -+ -+#define RTW_SDIO_BLOCK_SIZE 512 -+#define RTW_SDIO_ADDR_RX_RX0FF_GEN(_id) (0x0e000 | ((_id) & 0x3)) -+ -+#define RTW_SDIO_DATA_PTR_ALIGN 8 -+ -+struct sdio_func; -+struct sdio_device_id; -+ -+struct rtw_sdio_tx_data { -+ u8 sn; -+}; -+ -+struct rtw_sdio_work_data { -+ struct work_struct work; -+ struct rtw_dev *rtwdev; -+}; -+ -+struct rtw_sdio { -+ struct sdio_func *sdio_func; -+ -+ u32 irq_mask; -+ u8 rx_addr; -+ bool sdio3_bus_mode; -+ -+ void *irq_thread; -+ -+ struct workqueue_struct *txwq; -+ struct rtw_sdio_work_data *tx_handler_data; -+ struct sk_buff_head tx_queue[RTK_MAX_TX_QUEUE_NUM]; -+}; -+ -+extern const struct dev_pm_ops rtw_sdio_pm_ops; -+ -+int rtw_sdio_probe(struct sdio_func *sdio_func, -+ const struct sdio_device_id *id); -+void rtw_sdio_remove(struct sdio_func *sdio_func); -+void rtw_sdio_shutdown(struct device *dev); -+ -+static inline bool rtw_sdio_is_sdio30_supported(struct rtw_dev *rtwdev) -+{ -+ struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; -+ -+ return rtwsdio->sdio3_bus_mode; -+} -+ -+#endif -diff --git a/drivers/net/wireless/realtek/rtw88/sdio_ids.h b/drivers/net/wireless/realtek/rtw88/sdio_ids.h -new file mode 100644 -index 000000000..2d1a80776 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/sdio_ids.h -@@ -0,0 +1,10 @@ -+#define SDIO_VENDOR_ID_REALTEK 0x024c -+#define SDIO_DEVICE_ID_REALTEK_RTW8723BS 0xb723 -+#define SDIO_DEVICE_ID_REALTEK_RTW8723DS_2ANT 0xd723 -+#define SDIO_DEVICE_ID_REALTEK_RTW8723DS_1ANT 0xd724 -+#define SDIO_DEVICE_ID_REALTEK_RTW8821BS 0xb821 -+#define SDIO_DEVICE_ID_REALTEK_RTW8821CS 0xc821 -+#define SDIO_DEVICE_ID_REALTEK_RTW8821DS 0xd821 -+#define SDIO_DEVICE_ID_REALTEK_RTW8822BS 0xb822 -+#define SDIO_DEVICE_ID_REALTEK_RTW8822CS 0xc822 -+ -diff --git a/drivers/net/wireless/realtek/rtw88/tx.c b/drivers/net/wireless/realtek/rtw88/tx.c -index ca8072177..77a8114b0 100644 ---- a/drivers/net/wireless/realtek/rtw88/tx.c -+++ b/drivers/net/wireless/realtek/rtw88/tx.c -@@ -34,41 +34,67 @@ void rtw_tx_stats(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, - - void rtw_tx_fill_tx_desc(struct rtw_tx_pkt_info *pkt_info, struct sk_buff *skb) - { -- __le32 *txdesc = (__le32 *)skb->data; -- -- SET_TX_DESC_TXPKTSIZE(txdesc, pkt_info->tx_pkt_size); -- SET_TX_DESC_OFFSET(txdesc, pkt_info->offset); -- SET_TX_DESC_PKT_OFFSET(txdesc, pkt_info->pkt_offset); -- SET_TX_DESC_QSEL(txdesc, pkt_info->qsel); -- SET_TX_DESC_BMC(txdesc, pkt_info->bmc); -- SET_TX_DESC_RATE_ID(txdesc, pkt_info->rate_id); -- SET_TX_DESC_DATARATE(txdesc, pkt_info->rate); -- SET_TX_DESC_DISDATAFB(txdesc, pkt_info->dis_rate_fallback); -- SET_TX_DESC_USE_RATE(txdesc, pkt_info->use_rate); -- SET_TX_DESC_SEC_TYPE(txdesc, pkt_info->sec_type); -- SET_TX_DESC_DATA_BW(txdesc, pkt_info->bw); -- SET_TX_DESC_SW_SEQ(txdesc, pkt_info->seq); -- SET_TX_DESC_MAX_AGG_NUM(txdesc, pkt_info->ampdu_factor); -- SET_TX_DESC_AMPDU_DENSITY(txdesc, pkt_info->ampdu_density); -- SET_TX_DESC_DATA_STBC(txdesc, pkt_info->stbc); -- SET_TX_DESC_DATA_LDPC(txdesc, pkt_info->ldpc); -- SET_TX_DESC_AGG_EN(txdesc, pkt_info->ampdu_en); -- SET_TX_DESC_LS(txdesc, pkt_info->ls); -- SET_TX_DESC_DATA_SHORT(txdesc, pkt_info->short_gi); -- SET_TX_DESC_SPE_RPT(txdesc, pkt_info->report); -- SET_TX_DESC_SW_DEFINE(txdesc, pkt_info->sn); -- SET_TX_DESC_USE_RTS(txdesc, pkt_info->rts); -- SET_TX_DESC_DISQSELSEQ(txdesc, pkt_info->dis_qselseq); -- SET_TX_DESC_EN_HWSEQ(txdesc, pkt_info->en_hwseq); -- SET_TX_DESC_HW_SSN_SEL(txdesc, pkt_info->hw_ssn_sel); -- SET_TX_DESC_NAVUSEHDR(txdesc, pkt_info->nav_use_hdr); -- SET_TX_DESC_BT_NULL(txdesc, pkt_info->bt_null); -+ struct rtw_tx_desc *tx_desc = (struct rtw_tx_desc *)skb->data; -+ bool more_data = false; -+ -+ if (pkt_info->qsel == TX_DESC_QSEL_HIGH) -+ more_data = true; -+ -+ tx_desc->w0 = le32_encode_bits(pkt_info->tx_pkt_size, RTW_TX_DESC_W0_TXPKTSIZE) | -+ le32_encode_bits(pkt_info->offset, RTW_TX_DESC_W0_OFFSET) | -+ le32_encode_bits(pkt_info->bmc, RTW_TX_DESC_W0_BMC) | -+ le32_encode_bits(pkt_info->ls, RTW_TX_DESC_W0_LS) | -+ le32_encode_bits(pkt_info->dis_qselseq, RTW_TX_DESC_W0_DISQSELSEQ); -+ -+ tx_desc->w1 = le32_encode_bits(pkt_info->qsel, RTW_TX_DESC_W1_QSEL) | -+ le32_encode_bits(pkt_info->rate_id, RTW_TX_DESC_W1_RATE_ID) | -+ le32_encode_bits(pkt_info->sec_type, RTW_TX_DESC_W1_SEC_TYPE) | -+ le32_encode_bits(pkt_info->pkt_offset, RTW_TX_DESC_W1_PKT_OFFSET) | -+ le32_encode_bits(more_data, RTW_TX_DESC_W1_MORE_DATA); -+ -+ tx_desc->w2 = le32_encode_bits(pkt_info->ampdu_en, RTW_TX_DESC_W2_AGG_EN) | -+ le32_encode_bits(pkt_info->report, RTW_TX_DESC_W2_SPE_RPT) | -+ le32_encode_bits(pkt_info->ampdu_density, RTW_TX_DESC_W2_AMPDU_DEN) | -+ le32_encode_bits(pkt_info->bt_null, RTW_TX_DESC_W2_BT_NULL); -+ -+ tx_desc->w3 = le32_encode_bits(pkt_info->hw_ssn_sel, RTW_TX_DESC_W3_HW_SSN_SEL) | -+ le32_encode_bits(pkt_info->use_rate, RTW_TX_DESC_W3_USE_RATE) | -+ le32_encode_bits(pkt_info->dis_rate_fallback, RTW_TX_DESC_W3_DISDATAFB) | -+ le32_encode_bits(pkt_info->rts, RTW_TX_DESC_W3_USE_RTS) | -+ le32_encode_bits(pkt_info->nav_use_hdr, RTW_TX_DESC_W3_NAVUSEHDR) | -+ le32_encode_bits(pkt_info->ampdu_factor, RTW_TX_DESC_W3_MAX_AGG_NUM); -+ -+ tx_desc->w4 = le32_encode_bits(pkt_info->rate, RTW_TX_DESC_W4_DATARATE); -+ -+ tx_desc->w5 = le32_encode_bits(pkt_info->short_gi, RTW_TX_DESC_W5_DATA_SHORT) | -+ le32_encode_bits(pkt_info->bw, RTW_TX_DESC_W5_DATA_BW) | -+ le32_encode_bits(pkt_info->ldpc, RTW_TX_DESC_W5_DATA_LDPC) | -+ le32_encode_bits(pkt_info->stbc, RTW_TX_DESC_W5_DATA_STBC); -+ -+ tx_desc->w6 = le32_encode_bits(pkt_info->sn, RTW_TX_DESC_W6_SW_DEFINE); -+ -+ tx_desc->w8 = le32_encode_bits(pkt_info->en_hwseq, RTW_TX_DESC_W8_EN_HWSEQ); -+ -+ tx_desc->w9 = le32_encode_bits(pkt_info->seq, RTW_TX_DESC_W9_SW_SEQ); -+ -+ if (pkt_info->rts) { -+ tx_desc->w4 |= le32_encode_bits(DESC_RATE24M, RTW_TX_DESC_W4_RTSRATE); -+ tx_desc->w5 |= le32_encode_bits(1, RTW_TX_DESC_W5_DATA_RTS_SHORT); -+ } -+ -+ if (pkt_info->tim_offset) -+ tx_desc->w9 |= le32_encode_bits(1, RTW_TX_DESC_W9_TIM_EN) | -+ le32_encode_bits(pkt_info->tim_offset, RTW_TX_DESC_W9_TIM_OFFSET); - } - EXPORT_SYMBOL(rtw_tx_fill_tx_desc); - - static u8 get_tx_ampdu_factor(struct ieee80211_sta *sta) - { -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ u8 exp = sta->deflink.ht_cap.ampdu_factor; -+#else - u8 exp = sta->ht_cap.ampdu_factor; -+#endif - - /* the least ampdu factor is 8K, and the value in the tx desc is the - * max aggregation num, which represents val * 2 packets can be -@@ -79,7 +105,11 @@ static u8 get_tx_ampdu_factor(struct ieee80211_sta *sta) - - static u8 get_tx_ampdu_density(struct ieee80211_sta *sta) - { -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ return sta->deflink.ht_cap.ampdu_density; -+#else - return sta->ht_cap.ampdu_density; -+#endif - } - - static u8 get_highest_ht_tx_rate(struct rtw_dev *rtwdev, -@@ -87,7 +117,11 @@ static u8 get_highest_ht_tx_rate(struct rtw_dev *rtwdev, - { - u8 rate; - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ if (rtwdev->hal.rf_type == RF_2T2R && sta->deflink.ht_cap.mcs.rx_mask[1] != 0) -+#else - if (rtwdev->hal.rf_type == RF_2T2R && sta->ht_cap.mcs.rx_mask[1] != 0) -+#endif - rate = DESC_RATEMCS15; - else - rate = DESC_RATEMCS7; -@@ -102,7 +136,11 @@ static u8 get_highest_vht_tx_rate(struct rtw_dev *rtwdev, - u8 rate; - u16 tx_mcs_map; - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ tx_mcs_map = le16_to_cpu(sta->deflink.vht_cap.vht_mcs.tx_mcs_map); -+#else - tx_mcs_map = le16_to_cpu(sta->vht_cap.vht_mcs.tx_mcs_map); -+#endif - if (efuse->hw_cap.nss == 1) { - switch (tx_mcs_map & 0x3) { - case IEEE80211_VHT_MCS_SUPPORT_0_7: -@@ -149,16 +187,24 @@ static void rtw_tx_report_enable(struct rtw_dev *rtwdev, - pkt_info->report = true; - } - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0) - void rtw_tx_report_purge_timer(struct timer_list *t) -+#else -+void rtw_tx_report_purge_timer(void *cntx) -+#endif - { -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0) - struct rtw_dev *rtwdev = from_timer(rtwdev, t, tx_report.purge_timer); -+#else -+ struct rtw_dev *rtwdev = (struct rtw_dev *)cntx; -+#endif - struct rtw_tx_report *tx_report = &rtwdev->tx_report; - unsigned long flags; - - if (skb_queue_len(&tx_report->queue) == 0) - return; - -- WARN(1, "purge skb(s) not reported by firmware\n"); -+ rtw_warn(rtwdev, "failed to get tx report from firmware\n"); - - spin_lock_irqsave(&tx_report->q_lock, flags); - skb_queue_purge(&tx_report->queue); -@@ -229,17 +275,34 @@ void rtw_tx_report_handle(struct rtw_dev *rtwdev, struct sk_buff *skb, int src) - spin_unlock_irqrestore(&tx_report->q_lock, flags); - } - -+static u8 rtw_get_mgmt_rate(struct rtw_dev *rtwdev, struct sk_buff *skb, -+ u8 lowest_rate, bool ignore_rate) -+{ -+ struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb); -+ struct ieee80211_vif *vif = tx_info->control.vif; -+ bool force_lowest = test_bit(RTW_FLAG_FORCE_LOWEST_RATE, rtwdev->flags); -+ -+ if (!vif || !vif->bss_conf.basic_rates || ignore_rate || force_lowest) -+ return lowest_rate; -+ -+ return __ffs(vif->bss_conf.basic_rates) + lowest_rate; -+} -+ - static void rtw_tx_pkt_info_update_rate(struct rtw_dev *rtwdev, - struct rtw_tx_pkt_info *pkt_info, -- struct sk_buff *skb) -+ struct sk_buff *skb, -+ bool ignore_rate) - { - if (rtwdev->hal.current_band_type == RTW_BAND_2G) { - pkt_info->rate_id = RTW_RATEID_B_20M; -- pkt_info->rate = DESC_RATE1M; -+ pkt_info->rate = rtw_get_mgmt_rate(rtwdev, skb, DESC_RATE1M, -+ ignore_rate); - } else { - pkt_info->rate_id = RTW_RATEID_G; -- pkt_info->rate = DESC_RATE6M; -+ pkt_info->rate = rtw_get_mgmt_rate(rtwdev, skb, DESC_RATE6M, -+ ignore_rate); - } -+ - pkt_info->use_rate = true; - pkt_info->dis_rate_fallback = true; - } -@@ -276,7 +339,7 @@ static void rtw_tx_mgmt_pkt_info_update(struct rtw_dev *rtwdev, - struct ieee80211_sta *sta, - struct sk_buff *skb) - { -- rtw_tx_pkt_info_update_rate(rtwdev, pkt_info, skb); -+ rtw_tx_pkt_info_update_rate(rtwdev, pkt_info, skb, false); - pkt_info->dis_qselseq = true; - pkt_info->en_hwseq = true; - pkt_info->hw_ssn_sel = 0; -@@ -290,7 +353,10 @@ static void rtw_tx_data_pkt_info_update(struct rtw_dev *rtwdev, - { - struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; - struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); -+ struct ieee80211_hw *hw = rtwdev->hw; -+ struct rtw_dm_info *dm_info = &rtwdev->dm_info; - struct rtw_sta_info *si; -+ u8 fix_rate; - u16 seq; - u8 ampdu_factor = 0; - u8 ampdu_density = 0; -@@ -313,9 +379,19 @@ static void rtw_tx_data_pkt_info_update(struct rtw_dev *rtwdev, - ampdu_density = get_tx_ampdu_density(sta); - } - -- if (info->control.use_rts) -+ if (info->control.use_rts || skb->len > hw->wiphy->rts_threshold) - pkt_info->rts = true; - -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) -+ if (sta->deflink.vht_cap.vht_supported) -+ rate = get_highest_vht_tx_rate(rtwdev, sta); -+ else if (sta->deflink.ht_cap.ht_supported) -+ rate = get_highest_ht_tx_rate(rtwdev, sta); -+ else if (sta->deflink.supp_rates[0] <= 0xf) -+ rate = DESC_RATE11M; -+ else -+ rate = DESC_RATE54M; -+#else - if (sta->vht_cap.vht_supported) - rate = get_highest_vht_tx_rate(rtwdev, sta); - else if (sta->ht_cap.ht_supported) -@@ -324,12 +400,13 @@ static void rtw_tx_data_pkt_info_update(struct rtw_dev *rtwdev, - rate = DESC_RATE11M; - else - rate = DESC_RATE54M; -+#endif - - si = (struct rtw_sta_info *)sta->drv_priv; - - bw = si->bw_mode; - rate_id = si->rate_id; -- stbc = si->stbc_en; -+ stbc = rtwdev->hal.txrx_1ss ? false : si->stbc_en; - ldpc = si->ldpc_en; - - out: -@@ -342,6 +419,13 @@ static void rtw_tx_data_pkt_info_update(struct rtw_dev *rtwdev, - pkt_info->bw = bw; - pkt_info->stbc = stbc; - pkt_info->ldpc = ldpc; -+ -+ fix_rate = dm_info->fix_rate; -+ if (fix_rate < DESC_RATE_MAX) { -+ pkt_info->rate = fix_rate; -+ pkt_info->dis_rate_fallback = true; -+ pkt_info->use_rate = true; -+ } - } - - void rtw_tx_pkt_info_update(struct rtw_dev *rtwdev, -@@ -349,7 +433,7 @@ void rtw_tx_pkt_info_update(struct rtw_dev *rtwdev, - struct ieee80211_sta *sta, - struct sk_buff *skb) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); - struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; - struct rtw_sta_info *si; -@@ -389,7 +473,7 @@ void rtw_tx_rsvd_page_pkt_info_update(struct rtw_dev *rtwdev, - struct sk_buff *skb, - enum rtw_rsvd_packet_type type) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; - bool bmc; - -@@ -399,7 +483,7 @@ void rtw_tx_rsvd_page_pkt_info_update(struct rtw_dev *rtwdev, - if (type != RSVD_BEACON && type != RSVD_DUMMY) - pkt_info->qsel = TX_DESC_QSEL_MGMT; - -- rtw_tx_pkt_info_update_rate(rtwdev, pkt_info, skb); -+ rtw_tx_pkt_info_update_rate(rtwdev, pkt_info, skb, true); - - bmc = is_broadcast_ether_addr(hdr->addr1) || - is_multicast_ether_addr(hdr->addr1); -@@ -417,6 +501,19 @@ void rtw_tx_rsvd_page_pkt_info_update(struct rtw_dev *rtwdev, - if (type == RSVD_QOS_NULL) - pkt_info->bt_null = true; - -+ if (type == RSVD_BEACON) { -+ struct rtw_rsvd_page *rsvd_pkt; -+ int hdr_len; -+ -+ rsvd_pkt = list_first_entry_or_null(&rtwdev->rsvd_page_list, -+ struct rtw_rsvd_page, -+ build_list); -+ if (rsvd_pkt && rsvd_pkt->tim_offset != 0) { -+ hdr_len = sizeof(struct ieee80211_hdr_3addr); -+ pkt_info->tim_offset = rsvd_pkt->tim_offset - hdr_len; -+ } -+ } -+ - rtw_tx_pkt_info_update_sec(rtwdev, pkt_info, skb); - - /* TODO: need to change hw port and hw ssn sel for multiple vifs */ -@@ -427,7 +524,7 @@ rtw_tx_write_data_rsvd_page_get(struct rtw_dev *rtwdev, - struct rtw_tx_pkt_info *pkt_info, - u8 *buf, u32 size) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct sk_buff *skb; - u32 tx_pkt_desc_sz; - u32 length; -@@ -453,7 +550,7 @@ rtw_tx_write_data_h2c_get(struct rtw_dev *rtwdev, - struct rtw_tx_pkt_info *pkt_info, - u8 *buf, u32 size) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - struct sk_buff *skb; - u32 tx_pkt_desc_sz; - u32 length; -@@ -544,8 +641,6 @@ static int rtw_txq_push_skb(struct rtw_dev *rtwdev, - rtw_err(rtwdev, "failed to write TX skb to HCI\n"); - return ret; - } -- rtwtxq->last_push = jiffies; -- - return 0; - } - -@@ -587,9 +682,8 @@ static void rtw_txq_push(struct rtw_dev *rtwdev, - rcu_read_unlock(); - } - --void rtw_tx_tasklet(struct tasklet_struct *t) -+void __rtw_tx_work(struct rtw_dev *rtwdev) - { -- struct rtw_dev *rtwdev = from_tasklet(rtwdev, t, tx_tasklet); - struct rtw_txq *rtwtxq, *tmp; - - spin_lock_bh(&rtwdev->txq_lock); -@@ -610,6 +704,13 @@ void rtw_tx_tasklet(struct tasklet_struct *t) - spin_unlock_bh(&rtwdev->txq_lock); - } - -+void rtw_tx_work(struct work_struct *w) -+{ -+ struct rtw_dev *rtwdev = container_of(w, struct rtw_dev, tx_work); -+ -+ __rtw_tx_work(rtwdev); -+} -+ - void rtw_txq_init(struct rtw_dev *rtwdev, struct ieee80211_txq *txq) - { - struct rtw_txq *rtwtxq; -@@ -634,3 +735,44 @@ void rtw_txq_cleanup(struct rtw_dev *rtwdev, struct ieee80211_txq *txq) - list_del_init(&rtwtxq->list); - spin_unlock_bh(&rtwdev->txq_lock); - } -+ -+static const enum rtw_tx_queue_type ac_to_hwq[] = { -+ [IEEE80211_AC_VO] = RTW_TX_QUEUE_VO, -+ [IEEE80211_AC_VI] = RTW_TX_QUEUE_VI, -+ [IEEE80211_AC_BE] = RTW_TX_QUEUE_BE, -+ [IEEE80211_AC_BK] = RTW_TX_QUEUE_BK, -+}; -+ -+static_assert(ARRAY_SIZE(ac_to_hwq) == IEEE80211_NUM_ACS); -+ -+enum rtw_tx_queue_type rtw_tx_ac_to_hwq(enum ieee80211_ac_numbers ac) -+{ -+ if (WARN_ON(unlikely(ac >= IEEE80211_NUM_ACS))) -+ return RTW_TX_QUEUE_BE; -+ -+ return ac_to_hwq[ac]; -+} -+EXPORT_SYMBOL(rtw_tx_ac_to_hwq); -+ -+enum rtw_tx_queue_type rtw_tx_queue_mapping(struct sk_buff *skb) -+{ -+ struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; -+ __le16 fc = hdr->frame_control; -+ u8 q_mapping = skb_get_queue_mapping(skb); -+ enum rtw_tx_queue_type queue; -+ -+ if (unlikely(ieee80211_is_beacon(fc))) -+ queue = RTW_TX_QUEUE_BCN; -+ else if (unlikely(ieee80211_is_mgmt(fc) || ieee80211_is_ctl(fc))) -+ queue = RTW_TX_QUEUE_MGMT; -+ else if (is_broadcast_ether_addr(hdr->addr1) || -+ is_multicast_ether_addr(hdr->addr1)) -+ queue = RTW_TX_QUEUE_HI0; -+ else if (WARN_ON_ONCE(q_mapping >= ARRAY_SIZE(ac_to_hwq))) -+ queue = ac_to_hwq[IEEE80211_AC_BE]; -+ else -+ queue = ac_to_hwq[q_mapping]; -+ -+ return queue; -+} -+EXPORT_SYMBOL(rtw_tx_queue_mapping); -diff --git a/drivers/net/wireless/realtek/rtw88/tx.h b/drivers/net/wireless/realtek/rtw88/tx.h -index 6673dbcaa..324189606 100644 ---- a/drivers/net/wireless/realtek/rtw88/tx.h -+++ b/drivers/net/wireless/realtek/rtw88/tx.h -@@ -9,60 +9,53 @@ - - #define RTW_TX_PROBE_TIMEOUT msecs_to_jiffies(500) - --#define SET_TX_DESC_TXPKTSIZE(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x00, value, GENMASK(15, 0)) --#define SET_TX_DESC_OFFSET(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x00, value, GENMASK(23, 16)) --#define SET_TX_DESC_PKT_OFFSET(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x01, value, GENMASK(28, 24)) --#define SET_TX_DESC_QSEL(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x01, value, GENMASK(12, 8)) --#define SET_TX_DESC_BMC(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x00, value, BIT(24)) --#define SET_TX_DESC_RATE_ID(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x01, value, GENMASK(20, 16)) --#define SET_TX_DESC_DATARATE(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x04, value, GENMASK(6, 0)) --#define SET_TX_DESC_DISDATAFB(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x03, value, BIT(10)) --#define SET_TX_DESC_USE_RATE(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x03, value, BIT(8)) --#define SET_TX_DESC_SEC_TYPE(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x01, value, GENMASK(23, 22)) --#define SET_TX_DESC_DATA_BW(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x05, value, GENMASK(6, 5)) --#define SET_TX_DESC_SW_SEQ(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x09, value, GENMASK(23, 12)) --#define SET_TX_DESC_MAX_AGG_NUM(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x03, value, GENMASK(21, 17)) --#define SET_TX_DESC_USE_RTS(tx_desc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x03, value, BIT(12)) --#define SET_TX_DESC_AMPDU_DENSITY(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x02, value, GENMASK(22, 20)) --#define SET_TX_DESC_DATA_STBC(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x05, value, GENMASK(9, 8)) --#define SET_TX_DESC_DATA_LDPC(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x05, value, BIT(7)) --#define SET_TX_DESC_AGG_EN(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x02, value, BIT(12)) --#define SET_TX_DESC_LS(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x00, value, BIT(26)) --#define SET_TX_DESC_DATA_SHORT(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x05, value, BIT(4)) --#define SET_TX_DESC_SPE_RPT(tx_desc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x02, value, BIT(19)) --#define SET_TX_DESC_SW_DEFINE(tx_desc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x06, value, GENMASK(11, 0)) --#define SET_TX_DESC_DISQSELSEQ(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x00, value, BIT(31)) --#define SET_TX_DESC_EN_HWSEQ(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x08, value, BIT(15)) --#define SET_TX_DESC_HW_SSN_SEL(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x03, value, GENMASK(7, 6)) --#define SET_TX_DESC_NAVUSEHDR(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x03, value, BIT(15)) --#define SET_TX_DESC_BT_NULL(txdesc, value) \ -- le32p_replace_bits((__le32 *)(txdesc) + 0x02, value, BIT(23)) -+struct rtw_tx_desc { -+ __le32 w0; -+ __le32 w1; -+ __le32 w2; -+ __le32 w3; -+ __le32 w4; -+ __le32 w5; -+ __le32 w6; -+ __le32 w7; -+ __le32 w8; -+ __le32 w9; -+} __packed; -+ -+#define RTW_TX_DESC_W0_TXPKTSIZE GENMASK(15, 0) -+#define RTW_TX_DESC_W0_OFFSET GENMASK(23, 16) -+#define RTW_TX_DESC_W0_BMC BIT(24) -+#define RTW_TX_DESC_W0_LS BIT(26) -+#define RTW_TX_DESC_W0_DISQSELSEQ BIT(31) -+#define RTW_TX_DESC_W1_QSEL GENMASK(12, 8) -+#define RTW_TX_DESC_W1_RATE_ID GENMASK(20, 16) -+#define RTW_TX_DESC_W1_SEC_TYPE GENMASK(23, 22) -+#define RTW_TX_DESC_W1_PKT_OFFSET GENMASK(28, 24) -+#define RTW_TX_DESC_W1_MORE_DATA BIT(29) -+#define RTW_TX_DESC_W2_AGG_EN BIT(12) -+#define RTW_TX_DESC_W2_SPE_RPT BIT(19) -+#define RTW_TX_DESC_W2_AMPDU_DEN GENMASK(22, 20) -+#define RTW_TX_DESC_W2_BT_NULL BIT(23) -+#define RTW_TX_DESC_W3_HW_SSN_SEL GENMASK(7, 6) -+#define RTW_TX_DESC_W3_USE_RATE BIT(8) -+#define RTW_TX_DESC_W3_DISDATAFB BIT(10) -+#define RTW_TX_DESC_W3_USE_RTS BIT(12) -+#define RTW_TX_DESC_W3_NAVUSEHDR BIT(15) -+#define RTW_TX_DESC_W3_MAX_AGG_NUM GENMASK(21, 17) -+#define RTW_TX_DESC_W4_DATARATE GENMASK(6, 0) -+#define RTW_TX_DESC_W4_RTSRATE GENMASK(28, 24) -+#define RTW_TX_DESC_W5_DATA_SHORT BIT(4) -+#define RTW_TX_DESC_W5_DATA_BW GENMASK(6, 5) -+#define RTW_TX_DESC_W5_DATA_LDPC BIT(7) -+#define RTW_TX_DESC_W5_DATA_STBC GENMASK(9, 8) -+#define RTW_TX_DESC_W5_DATA_RTS_SHORT BIT(12) -+#define RTW_TX_DESC_W6_SW_DEFINE GENMASK(11, 0) -+#define RTW_TX_DESC_W7_TXDESC_CHECKSUM GENMASK(15, 0) -+#define RTW_TX_DESC_W7_DMA_TXAGG_NUM GENMASK(31, 24) -+#define RTW_TX_DESC_W8_EN_HWSEQ BIT(15) -+#define RTW_TX_DESC_W9_SW_SEQ GENMASK(23, 12) -+#define RTW_TX_DESC_W9_TIM_EN BIT(7) -+#define RTW_TX_DESC_W9_TIM_OFFSET GENMASK(6, 0) - - enum rtw_tx_desc_queue_select { - TX_DESC_QSEL_TID0 = 0, -@@ -94,7 +87,8 @@ void rtw_tx(struct rtw_dev *rtwdev, - struct sk_buff *skb); - void rtw_txq_init(struct rtw_dev *rtwdev, struct ieee80211_txq *txq); - void rtw_txq_cleanup(struct rtw_dev *rtwdev, struct ieee80211_txq *txq); --void rtw_tx_tasklet(struct tasklet_struct *t); -+void rtw_tx_work(struct work_struct *w); -+void __rtw_tx_work(struct rtw_dev *rtwdev); - void rtw_tx_pkt_info_update(struct rtw_dev *rtwdev, - struct rtw_tx_pkt_info *pkt_info, - struct ieee80211_sta *sta, -@@ -115,4 +109,32 @@ rtw_tx_write_data_h2c_get(struct rtw_dev *rtwdev, - struct rtw_tx_pkt_info *pkt_info, - u8 *buf, u32 size); - -+enum rtw_tx_queue_type rtw_tx_ac_to_hwq(enum ieee80211_ac_numbers ac); -+enum rtw_tx_queue_type rtw_tx_queue_mapping(struct sk_buff *skb); -+ -+static inline -+void fill_txdesc_checksum_common(u8 *txdesc, size_t words) -+{ -+ __le16 chksum = 0; -+ __le16 *data = (__le16 *)(txdesc); -+ struct rtw_tx_desc *tx_desc = (struct rtw_tx_desc *)txdesc; -+ -+ le32p_replace_bits(&tx_desc->w7, 0, RTW_TX_DESC_W7_TXDESC_CHECKSUM); -+ -+ while (words--) -+ chksum ^= *data++; -+ -+ le32p_replace_bits(&tx_desc->w7, __le16_to_cpu(chksum), -+ RTW_TX_DESC_W7_TXDESC_CHECKSUM); -+} -+ -+static inline void rtw_tx_fill_txdesc_checksum(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ u8 *txdesc) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ -+ chip->ops->fill_txdesc_checksum(rtwdev, pkt_info, txdesc); -+} -+ - #endif -diff --git a/drivers/net/wireless/realtek/rtw88/usb.c b/drivers/net/wireless/realtek/rtw88/usb.c -new file mode 100644 -index 000000000..f9add1ec3 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/usb.c -@@ -0,0 +1,916 @@ -+// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause -+/* Copyright(c) 2018-2019 Realtek Corporation -+ */ -+ -+#include -+#include -+#include -+#include "main.h" -+#include "debug.h" -+#include "reg.h" -+#include "tx.h" -+#include "rx.h" -+#include "fw.h" -+#include "ps.h" -+#include "usb.h" -+ -+#define RTW_USB_MAX_RXQ_LEN 512 -+ -+struct rtw_usb_txcb { -+ struct rtw_dev *rtwdev; -+ struct sk_buff_head tx_ack_queue; -+}; -+ -+static void rtw_usb_fill_tx_checksum(struct rtw_usb *rtwusb, -+ struct sk_buff *skb, int agg_num) -+{ -+ struct rtw_tx_desc *tx_desc = (struct rtw_tx_desc *)skb->data; -+ struct rtw_dev *rtwdev = rtwusb->rtwdev; -+ struct rtw_tx_pkt_info pkt_info; -+ -+ le32p_replace_bits(&tx_desc->w7, agg_num, RTW_TX_DESC_W7_DMA_TXAGG_NUM); -+ pkt_info.pkt_offset = le32_get_bits(tx_desc->w1, RTW_TX_DESC_W1_PKT_OFFSET); -+ rtw_tx_fill_txdesc_checksum(rtwdev, &pkt_info, skb->data); -+} -+ -+static u32 rtw_usb_read(struct rtw_dev *rtwdev, u32 addr, u16 len) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ struct usb_device *udev = rtwusb->udev; -+ __le32 *data; -+ unsigned long flags; -+ int idx, ret; -+ static int count; -+ -+ spin_lock_irqsave(&rtwusb->usb_lock, flags); -+ -+ idx = rtwusb->usb_data_index; -+ rtwusb->usb_data_index = (idx + 1) & (RTW_USB_MAX_RXTX_COUNT - 1); -+ -+ spin_unlock_irqrestore(&rtwusb->usb_lock, flags); -+ -+ data = &rtwusb->usb_data[idx]; -+ -+ ret = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), -+ RTW_USB_CMD_REQ, RTW_USB_CMD_READ, addr, -+ RTW_USB_VENQT_CMD_IDX, data, len, 1000); -+ if (ret < 0 && ret != -ENODEV && count++ < 4) -+ rtw_err(rtwdev, "read register 0x%x failed with %d\n", -+ addr, ret); -+ -+ return le32_to_cpu(*data); -+} -+ -+static u8 rtw_usb_read8(struct rtw_dev *rtwdev, u32 addr) -+{ -+ return (u8)rtw_usb_read(rtwdev, addr, 1); -+} -+ -+static u16 rtw_usb_read16(struct rtw_dev *rtwdev, u32 addr) -+{ -+ return (u16)rtw_usb_read(rtwdev, addr, 2); -+} -+ -+static u32 rtw_usb_read32(struct rtw_dev *rtwdev, u32 addr) -+{ -+ return (u32)rtw_usb_read(rtwdev, addr, 4); -+} -+ -+static void rtw_usb_write(struct rtw_dev *rtwdev, u32 addr, u32 val, int len) -+{ -+ struct rtw_usb *rtwusb = (struct rtw_usb *)rtwdev->priv; -+ struct usb_device *udev = rtwusb->udev; -+ unsigned long flags; -+ __le32 *data; -+ int idx, ret; -+ static int count; -+ -+ spin_lock_irqsave(&rtwusb->usb_lock, flags); -+ -+ idx = rtwusb->usb_data_index; -+ rtwusb->usb_data_index = (idx + 1) & (RTW_USB_MAX_RXTX_COUNT - 1); -+ -+ spin_unlock_irqrestore(&rtwusb->usb_lock, flags); -+ -+ data = &rtwusb->usb_data[idx]; -+ -+ *data = cpu_to_le32(val); -+ -+ ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), -+ RTW_USB_CMD_REQ, RTW_USB_CMD_WRITE, -+ addr, 0, data, len, 30000); -+ if (ret < 0 && ret != -ENODEV && count++ < 4) -+ rtw_err(rtwdev, "write register 0x%x failed with %d\n", -+ addr, ret); -+} -+ -+static void rtw_usb_write8(struct rtw_dev *rtwdev, u32 addr, u8 val) -+{ -+ rtw_usb_write(rtwdev, addr, val, 1); -+} -+ -+static void rtw_usb_write16(struct rtw_dev *rtwdev, u32 addr, u16 val) -+{ -+ rtw_usb_write(rtwdev, addr, val, 2); -+} -+ -+static void rtw_usb_write32(struct rtw_dev *rtwdev, u32 addr, u32 val) -+{ -+ rtw_usb_write(rtwdev, addr, val, 4); -+} -+ -+static int dma_mapping_to_ep(enum rtw_dma_mapping dma_mapping) -+{ -+ switch (dma_mapping) { -+ case RTW_DMA_MAPPING_HIGH: -+ return 0; -+ case RTW_DMA_MAPPING_NORMAL: -+ return 1; -+ case RTW_DMA_MAPPING_LOW: -+ return 2; -+ case RTW_DMA_MAPPING_EXTRA: -+ return 3; -+ default: -+ return -EINVAL; -+ } -+} -+ -+static int rtw_usb_parse(struct rtw_dev *rtwdev, -+ struct usb_interface *interface) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ struct usb_host_interface *host_interface = &interface->altsetting[0]; -+ struct usb_interface_descriptor *interface_desc = &host_interface->desc; -+ struct usb_endpoint_descriptor *endpoint; -+ int num_out_pipes = 0; -+ int i; -+ u8 num; -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_rqpn *rqpn; -+ -+ for (i = 0; i < interface_desc->bNumEndpoints; i++) { -+ endpoint = &host_interface->endpoint[i].desc; -+ num = usb_endpoint_num(endpoint); -+ -+ if (usb_endpoint_dir_in(endpoint) && -+ usb_endpoint_xfer_bulk(endpoint)) { -+ if (rtwusb->pipe_in) { -+ rtw_err(rtwdev, "IN pipes overflow\n"); -+ return -EINVAL; -+ } -+ -+ rtwusb->pipe_in = num; -+ } -+ -+ if (usb_endpoint_dir_in(endpoint) && -+ usb_endpoint_xfer_int(endpoint)) { -+ if (rtwusb->pipe_interrupt) { -+ rtw_err(rtwdev, "INT pipes overflow\n"); -+ return -EINVAL; -+ } -+ -+ rtwusb->pipe_interrupt = num; -+ } -+ -+ if (usb_endpoint_dir_out(endpoint) && -+ usb_endpoint_xfer_bulk(endpoint)) { -+ if (num_out_pipes >= ARRAY_SIZE(rtwusb->out_ep)) { -+ rtw_err(rtwdev, "OUT pipes overflow\n"); -+ return -EINVAL; -+ } -+ -+ rtwusb->out_ep[num_out_pipes++] = num; -+ } -+ } -+ -+ rtwdev->hci.bulkout_num = num_out_pipes; -+ -+ if (num_out_pipes < 1 || num_out_pipes > 4) { -+ rtw_err(rtwdev, "invalid number of endpoints %d\n", num_out_pipes); -+ return -EINVAL; -+ } -+ -+ rqpn = &chip->rqpn_table[num_out_pipes]; -+ -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID0] = dma_mapping_to_ep(rqpn->dma_map_be); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID1] = dma_mapping_to_ep(rqpn->dma_map_bk); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID2] = dma_mapping_to_ep(rqpn->dma_map_bk); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID3] = dma_mapping_to_ep(rqpn->dma_map_be); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID4] = dma_mapping_to_ep(rqpn->dma_map_vi); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID5] = dma_mapping_to_ep(rqpn->dma_map_vi); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID6] = dma_mapping_to_ep(rqpn->dma_map_vo); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID7] = dma_mapping_to_ep(rqpn->dma_map_vo); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID8] = -EINVAL; -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID9] = -EINVAL; -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID10] = -EINVAL; -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID11] = -EINVAL; -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID12] = -EINVAL; -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID13] = -EINVAL; -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID14] = -EINVAL; -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_TID15] = -EINVAL; -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_BEACON] = dma_mapping_to_ep(rqpn->dma_map_hi); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_HIGH] = dma_mapping_to_ep(rqpn->dma_map_hi); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_MGMT] = dma_mapping_to_ep(rqpn->dma_map_mg); -+ rtwusb->qsel_to_ep[TX_DESC_QSEL_H2C] = dma_mapping_to_ep(rqpn->dma_map_hi); -+ -+ return 0; -+} -+ -+static void rtw_usb_write_port_tx_complete(struct urb *urb) -+{ -+ struct rtw_usb_txcb *txcb = urb->context; -+ struct rtw_dev *rtwdev = txcb->rtwdev; -+ struct ieee80211_hw *hw = rtwdev->hw; -+ -+ while (true) { -+ struct sk_buff *skb = skb_dequeue(&txcb->tx_ack_queue); -+ struct ieee80211_tx_info *info; -+ struct rtw_usb_tx_data *tx_data; -+ -+ if (!skb) -+ break; -+ -+ info = IEEE80211_SKB_CB(skb); -+ tx_data = rtw_usb_get_tx_data(skb); -+ -+ /* enqueue to wait for tx report */ -+ if (info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS) { -+ rtw_tx_report_enqueue(rtwdev, skb, tx_data->sn); -+ continue; -+ } -+ -+ /* always ACK for others, then they won't be marked as drop */ -+ ieee80211_tx_info_clear_status(info); -+ if (info->flags & IEEE80211_TX_CTL_NO_ACK) -+ info->flags |= IEEE80211_TX_STAT_NOACK_TRANSMITTED; -+ else -+ info->flags |= IEEE80211_TX_STAT_ACK; -+ -+ ieee80211_tx_status_irqsafe(hw, skb); -+ } -+ -+ kfree(txcb); -+} -+ -+static int qsel_to_ep(struct rtw_usb *rtwusb, unsigned int qsel) -+{ -+ if (qsel >= ARRAY_SIZE(rtwusb->qsel_to_ep)) -+ return -EINVAL; -+ -+ return rtwusb->qsel_to_ep[qsel]; -+} -+ -+static int rtw_usb_write_port(struct rtw_dev *rtwdev, u8 qsel, struct sk_buff *skb, -+ usb_complete_t cb, void *context) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ struct usb_device *usbd = rtwusb->udev; -+ struct urb *urb; -+ unsigned int pipe; -+ int ret; -+ int ep = qsel_to_ep(rtwusb, qsel); -+ -+ if (ep < 0) -+ return ep; -+ -+ pipe = usb_sndbulkpipe(usbd, rtwusb->out_ep[ep]); -+ urb = usb_alloc_urb(0, GFP_ATOMIC); -+ if (!urb) -+ return -ENOMEM; -+ -+ usb_fill_bulk_urb(urb, usbd, pipe, skb->data, skb->len, cb, context); -+ urb->transfer_flags |= URB_ZERO_PACKET; -+ ret = usb_submit_urb(urb, GFP_ATOMIC); -+ -+ usb_free_urb(urb); -+ -+ return ret; -+} -+ -+static bool rtw_usb_tx_agg_skb(struct rtw_usb *rtwusb, struct sk_buff_head *list) -+{ -+ struct rtw_dev *rtwdev = rtwusb->rtwdev; -+ struct rtw_tx_desc *tx_desc; -+ struct rtw_usb_txcb *txcb; -+ struct sk_buff *skb_head; -+ struct sk_buff *skb_iter; -+ int agg_num = 0; -+ unsigned int align_next = 0; -+ u8 qsel; -+ -+ if (skb_queue_empty(list)) -+ return false; -+ -+ txcb = kmalloc(sizeof(*txcb), GFP_ATOMIC); -+ if (!txcb) -+ return false; -+ -+ txcb->rtwdev = rtwdev; -+ skb_queue_head_init(&txcb->tx_ack_queue); -+ -+ skb_iter = skb_dequeue(list); -+ -+ if (skb_queue_empty(list)) { -+ skb_head = skb_iter; -+ goto queue; -+ } -+ -+ skb_head = dev_alloc_skb(RTW_USB_MAX_XMITBUF_SZ); -+ if (!skb_head) { -+ skb_head = skb_iter; -+ goto queue; -+ } -+ -+ while (skb_iter) { -+ unsigned long flags; -+ -+ skb_put(skb_head, align_next); -+ skb_put_data(skb_head, skb_iter->data, skb_iter->len); -+ -+ align_next = ALIGN(skb_iter->len, 8) - skb_iter->len; -+ -+ agg_num++; -+ -+ skb_queue_tail(&txcb->tx_ack_queue, skb_iter); -+ -+ spin_lock_irqsave(&list->lock, flags); -+ -+ skb_iter = skb_peek(list); -+ -+ if (skb_iter && skb_iter->len + skb_head->len <= RTW_USB_MAX_XMITBUF_SZ) -+ __skb_unlink(skb_iter, list); -+ else -+ skb_iter = NULL; -+ spin_unlock_irqrestore(&list->lock, flags); -+ } -+ -+ if (agg_num > 1) -+ rtw_usb_fill_tx_checksum(rtwusb, skb_head, agg_num); -+ -+queue: -+ skb_queue_tail(&txcb->tx_ack_queue, skb_head); -+ tx_desc = (struct rtw_tx_desc *)skb_head->data; -+ qsel = le32_get_bits(tx_desc->w1, RTW_TX_DESC_W1_QSEL); -+ -+ rtw_usb_write_port(rtwdev, qsel, skb_head, rtw_usb_write_port_tx_complete, txcb); -+ -+ return true; -+} -+ -+static void rtw_usb_tx_handler(struct work_struct *work) -+{ -+ struct rtw_usb *rtwusb = container_of(work, struct rtw_usb, tx_work); -+ int i, limit; -+ -+ for (i = ARRAY_SIZE(rtwusb->tx_queue) - 1; i >= 0; i--) { -+ for (limit = 0; limit < 200; limit++) { -+ struct sk_buff_head *list = &rtwusb->tx_queue[i]; -+ -+ if (!rtw_usb_tx_agg_skb(rtwusb, list)) -+ break; -+ } -+ } -+} -+ -+static void rtw_usb_tx_queue_purge(struct rtw_usb *rtwusb) -+{ -+ int i; -+ -+ for (i = 0; i < ARRAY_SIZE(rtwusb->tx_queue); i++) -+ skb_queue_purge(&rtwusb->tx_queue[i]); -+} -+ -+static void rtw_usb_write_port_complete(struct urb *urb) -+{ -+ struct sk_buff *skb = urb->context; -+ -+ dev_kfree_skb_any(skb); -+} -+ -+static int rtw_usb_write_data(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ u8 *buf) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct sk_buff *skb; -+ unsigned int desclen, headsize, size; -+ u8 qsel; -+ int ret = 0; -+ -+ size = pkt_info->tx_pkt_size; -+ qsel = pkt_info->qsel; -+ desclen = chip->tx_pkt_desc_sz; -+ headsize = pkt_info->offset ? pkt_info->offset : desclen; -+ -+ skb = dev_alloc_skb(headsize + size); -+ if (unlikely(!skb)) -+ return -ENOMEM; -+ -+ skb_reserve(skb, headsize); -+ skb_put_data(skb, buf, size); -+ skb_push(skb, headsize); -+ memset(skb->data, 0, headsize); -+ rtw_tx_fill_tx_desc(pkt_info, skb); -+ rtw_tx_fill_txdesc_checksum(rtwdev, pkt_info, skb->data); -+ -+ ret = rtw_usb_write_port(rtwdev, qsel, skb, -+ rtw_usb_write_port_complete, skb); -+ if (unlikely(ret)) -+ rtw_err(rtwdev, "failed to do USB write, ret=%d\n", ret); -+ -+ return ret; -+} -+ -+static int rtw_usb_write_data_rsvd_page(struct rtw_dev *rtwdev, u8 *buf, -+ u32 size) -+{ -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_tx_pkt_info pkt_info = {0}; -+ -+ pkt_info.tx_pkt_size = size; -+ pkt_info.qsel = TX_DESC_QSEL_BEACON; -+ pkt_info.offset = chip->tx_pkt_desc_sz; -+ -+ return rtw_usb_write_data(rtwdev, &pkt_info, buf); -+} -+ -+static int rtw_usb_write_data_h2c(struct rtw_dev *rtwdev, u8 *buf, u32 size) -+{ -+ struct rtw_tx_pkt_info pkt_info = {0}; -+ -+ pkt_info.tx_pkt_size = size; -+ pkt_info.qsel = TX_DESC_QSEL_H2C; -+ -+ return rtw_usb_write_data(rtwdev, &pkt_info, buf); -+} -+ -+static u8 rtw_usb_tx_queue_mapping_to_qsel(struct sk_buff *skb) -+{ -+ struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; -+ __le16 fc = hdr->frame_control; -+ u8 qsel; -+ -+ if (unlikely(ieee80211_is_mgmt(fc) || ieee80211_is_ctl(fc))) -+ qsel = TX_DESC_QSEL_MGMT; -+ else if (is_broadcast_ether_addr(hdr->addr1) || -+ is_multicast_ether_addr(hdr->addr1)) -+ qsel = TX_DESC_QSEL_HIGH; -+ else if (skb_get_queue_mapping(skb) <= IEEE80211_AC_BK) -+ qsel = skb->priority; -+ else -+ qsel = TX_DESC_QSEL_BEACON; -+ -+ return qsel; -+} -+ -+static int rtw_usb_tx_write(struct rtw_dev *rtwdev, -+ struct rtw_tx_pkt_info *pkt_info, -+ struct sk_buff *skb) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_usb_tx_data *tx_data; -+ u8 *pkt_desc; -+ int ep; -+ -+ pkt_info->qsel = rtw_usb_tx_queue_mapping_to_qsel(skb); -+ pkt_desc = skb_push(skb, chip->tx_pkt_desc_sz); -+ memset(pkt_desc, 0, chip->tx_pkt_desc_sz); -+ ep = qsel_to_ep(rtwusb, pkt_info->qsel); -+ rtw_tx_fill_tx_desc(pkt_info, skb); -+ rtw_tx_fill_txdesc_checksum(rtwdev, pkt_info, skb->data); -+ tx_data = rtw_usb_get_tx_data(skb); -+ tx_data->sn = pkt_info->sn; -+ -+ skb_queue_tail(&rtwusb->tx_queue[ep], skb); -+ -+ return 0; -+} -+ -+static void rtw_usb_tx_kick_off(struct rtw_dev *rtwdev) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ -+ queue_work(rtwusb->txwq, &rtwusb->tx_work); -+} -+ -+static void rtw_usb_rx_handler(struct work_struct *work) -+{ -+ struct rtw_usb *rtwusb = container_of(work, struct rtw_usb, rx_work); -+ struct rtw_dev *rtwdev = rtwusb->rtwdev; -+ const struct rtw_chip_info *chip = rtwdev->chip; -+ struct rtw_rx_pkt_stat pkt_stat; -+ struct ieee80211_rx_status rx_status; -+ struct sk_buff *skb; -+ u32 pkt_desc_sz = chip->rx_pkt_desc_sz; -+ u32 pkt_offset; -+ u8 *rx_desc; -+ int limit; -+ -+ for (limit = 0; limit < 200; limit++) { -+ skb = skb_dequeue(&rtwusb->rx_queue); -+ if (!skb) -+ break; -+ -+ rx_desc = skb->data; -+ chip->ops->query_rx_desc(rtwdev, rx_desc, &pkt_stat, -+ &rx_status); -+ pkt_offset = pkt_desc_sz + pkt_stat.drv_info_sz + -+ pkt_stat.shift; -+ -+ if (pkt_stat.is_c2h) { -+ skb_put(skb, pkt_stat.pkt_len + pkt_offset); -+ rtw_fw_c2h_cmd_rx_irqsafe(rtwdev, pkt_offset, skb); -+ continue; -+ } -+ -+ if (skb_queue_len(&rtwusb->rx_queue) >= RTW_USB_MAX_RXQ_LEN) { -+ dev_dbg_ratelimited(rtwdev->dev, "failed to get rx_queue, overflow\n"); -+ dev_kfree_skb_any(skb); -+ continue; -+ } -+ -+ skb_put(skb, pkt_stat.pkt_len); -+ skb_reserve(skb, pkt_offset); -+ memcpy(skb->cb, &rx_status, sizeof(rx_status)); -+ ieee80211_rx_irqsafe(rtwdev->hw, skb); -+ } -+} -+ -+static void rtw_usb_read_port_complete(struct urb *urb); -+ -+static void rtw_usb_rx_resubmit(struct rtw_usb *rtwusb, struct rx_usb_ctrl_block *rxcb) -+{ -+ struct rtw_dev *rtwdev = rtwusb->rtwdev; -+ int error; -+ -+ rxcb->rx_skb = alloc_skb(RTW_USB_MAX_RECVBUF_SZ, GFP_ATOMIC); -+ if (!rxcb->rx_skb) -+ return; -+ -+ usb_fill_bulk_urb(rxcb->rx_urb, rtwusb->udev, -+ usb_rcvbulkpipe(rtwusb->udev, rtwusb->pipe_in), -+ rxcb->rx_skb->data, RTW_USB_MAX_RECVBUF_SZ, -+ rtw_usb_read_port_complete, rxcb); -+ -+ error = usb_submit_urb(rxcb->rx_urb, GFP_ATOMIC); -+ if (error) { -+ kfree_skb(rxcb->rx_skb); -+ if (error != -ENODEV) -+ rtw_err(rtwdev, "Err sending rx data urb %d\n", -+ error); -+ } -+} -+ -+static void rtw_usb_read_port_complete(struct urb *urb) -+{ -+ struct rx_usb_ctrl_block *rxcb = urb->context; -+ struct rtw_dev *rtwdev = rxcb->rtwdev; -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ struct sk_buff *skb = rxcb->rx_skb; -+ -+ if (urb->status == 0) { -+ if (urb->actual_length >= RTW_USB_MAX_RECVBUF_SZ || -+ urb->actual_length < 24) { -+ rtw_err(rtwdev, "failed to get urb length:%d\n", -+ urb->actual_length); -+ if (skb) -+ dev_kfree_skb_any(skb); -+ } else { -+ skb_queue_tail(&rtwusb->rx_queue, skb); -+ queue_work(rtwusb->rxwq, &rtwusb->rx_work); -+ } -+ rtw_usb_rx_resubmit(rtwusb, rxcb); -+ } else { -+ switch (urb->status) { -+ case -EINVAL: -+ case -EPIPE: -+ case -ENODEV: -+ case -ESHUTDOWN: -+ case -ENOENT: -+ case -EPROTO: -+ case -EILSEQ: -+ case -ETIME: -+ case -ECOMM: -+ case -EOVERFLOW: -+ case -EINPROGRESS: -+ break; -+ default: -+ rtw_err(rtwdev, "status %d\n", urb->status); -+ break; -+ } -+ if (skb) -+ dev_kfree_skb_any(skb); -+ } -+} -+ -+static void rtw_usb_cancel_rx_bufs(struct rtw_usb *rtwusb) -+{ -+ struct rx_usb_ctrl_block *rxcb; -+ int i; -+ -+ for (i = 0; i < RTW_USB_RXCB_NUM; i++) { -+ rxcb = &rtwusb->rx_cb[i]; -+ if (rxcb->rx_urb) -+ usb_kill_urb(rxcb->rx_urb); -+ } -+} -+ -+static void rtw_usb_free_rx_bufs(struct rtw_usb *rtwusb) -+{ -+ struct rx_usb_ctrl_block *rxcb; -+ int i; -+ -+ for (i = 0; i < RTW_USB_RXCB_NUM; i++) { -+ rxcb = &rtwusb->rx_cb[i]; -+ if (rxcb->rx_urb) { -+ usb_kill_urb(rxcb->rx_urb); -+ usb_free_urb(rxcb->rx_urb); -+ } -+ } -+} -+ -+static int rtw_usb_alloc_rx_bufs(struct rtw_usb *rtwusb) -+{ -+ int i; -+ -+ for (i = 0; i < RTW_USB_RXCB_NUM; i++) { -+ struct rx_usb_ctrl_block *rxcb = &rtwusb->rx_cb[i]; -+ -+ rxcb->rtwdev = rtwusb->rtwdev; -+ rxcb->rx_urb = usb_alloc_urb(0, GFP_KERNEL); -+ if (!rxcb->rx_urb) -+ goto err; -+ } -+ -+ return 0; -+err: -+ rtw_usb_free_rx_bufs(rtwusb); -+ return -ENOMEM; -+} -+ -+static int rtw_usb_setup(struct rtw_dev *rtwdev) -+{ -+ /* empty function for rtw_hci_ops */ -+ return 0; -+} -+ -+static int rtw_usb_start(struct rtw_dev *rtwdev) -+{ -+ return 0; -+} -+ -+static void rtw_usb_stop(struct rtw_dev *rtwdev) -+{ -+} -+ -+static void rtw_usb_deep_ps(struct rtw_dev *rtwdev, bool enter) -+{ -+ /* empty function for rtw_hci_ops */ -+} -+ -+static void rtw_usb_link_ps(struct rtw_dev *rtwdev, bool enter) -+{ -+ /* empty function for rtw_hci_ops */ -+} -+ -+static void rtw_usb_interface_cfg(struct rtw_dev *rtwdev) -+{ -+ /* empty function for rtw_hci_ops */ -+} -+ -+static struct rtw_hci_ops rtw_usb_ops = { -+ .tx_write = rtw_usb_tx_write, -+ .tx_kick_off = rtw_usb_tx_kick_off, -+ .setup = rtw_usb_setup, -+ .start = rtw_usb_start, -+ .stop = rtw_usb_stop, -+ .deep_ps = rtw_usb_deep_ps, -+ .link_ps = rtw_usb_link_ps, -+ .interface_cfg = rtw_usb_interface_cfg, -+ -+ .write8 = rtw_usb_write8, -+ .write16 = rtw_usb_write16, -+ .write32 = rtw_usb_write32, -+ .read8 = rtw_usb_read8, -+ .read16 = rtw_usb_read16, -+ .read32 = rtw_usb_read32, -+ -+ .write_data_rsvd_page = rtw_usb_write_data_rsvd_page, -+ .write_data_h2c = rtw_usb_write_data_h2c, -+}; -+ -+static int rtw_usb_init_rx(struct rtw_dev *rtwdev) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ int i; -+ -+ rtwusb->rxwq = create_singlethread_workqueue("rtw88_usb: rx wq"); -+ if (!rtwusb->rxwq) { -+ rtw_err(rtwdev, "failed to create RX work queue\n"); -+ return -ENOMEM; -+ } -+ -+ skb_queue_head_init(&rtwusb->rx_queue); -+ -+ INIT_WORK(&rtwusb->rx_work, rtw_usb_rx_handler); -+ -+ for (i = 0; i < RTW_USB_RXCB_NUM; i++) { -+ struct rx_usb_ctrl_block *rxcb = &rtwusb->rx_cb[i]; -+ -+ rtw_usb_rx_resubmit(rtwusb, rxcb); -+ } -+ -+ return 0; -+} -+ -+static void rtw_usb_deinit_rx(struct rtw_dev *rtwdev) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ -+ skb_queue_purge(&rtwusb->rx_queue); -+ -+ flush_workqueue(rtwusb->rxwq); -+ destroy_workqueue(rtwusb->rxwq); -+} -+ -+static int rtw_usb_init_tx(struct rtw_dev *rtwdev) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ int i; -+ -+ rtwusb->txwq = create_singlethread_workqueue("rtw88_usb: tx wq"); -+ if (!rtwusb->txwq) { -+ rtw_err(rtwdev, "failed to create TX work queue\n"); -+ return -ENOMEM; -+ } -+ -+ for (i = 0; i < ARRAY_SIZE(rtwusb->tx_queue); i++) -+ skb_queue_head_init(&rtwusb->tx_queue[i]); -+ -+ INIT_WORK(&rtwusb->tx_work, rtw_usb_tx_handler); -+ -+ return 0; -+} -+ -+static void rtw_usb_deinit_tx(struct rtw_dev *rtwdev) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ -+ rtw_usb_tx_queue_purge(rtwusb); -+ flush_workqueue(rtwusb->txwq); -+ destroy_workqueue(rtwusb->txwq); -+} -+ -+static int rtw_usb_intf_init(struct rtw_dev *rtwdev, -+ struct usb_interface *intf) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ struct usb_device *udev = usb_get_dev(interface_to_usbdev(intf)); -+ int ret; -+ -+ rtwusb->udev = udev; -+ ret = rtw_usb_parse(rtwdev, intf); -+ if (ret) -+ return ret; -+ -+ rtwusb->usb_data = kcalloc(RTW_USB_MAX_RXTX_COUNT, sizeof(u32), -+ GFP_KERNEL); -+ if (!rtwusb->usb_data) -+ return -ENOMEM; -+ -+ usb_set_intfdata(intf, rtwdev->hw); -+ -+ SET_IEEE80211_DEV(rtwdev->hw, &intf->dev); -+ spin_lock_init(&rtwusb->usb_lock); -+ -+ return 0; -+} -+ -+static void rtw_usb_intf_deinit(struct rtw_dev *rtwdev, -+ struct usb_interface *intf) -+{ -+ struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); -+ -+ usb_put_dev(rtwusb->udev); -+ kfree(rtwusb->usb_data); -+ usb_set_intfdata(intf, NULL); -+} -+ -+int rtw_usb_probe(struct usb_interface *intf, const struct usb_device_id *id) -+{ -+ struct rtw_dev *rtwdev; -+ struct ieee80211_hw *hw; -+ struct rtw_usb *rtwusb; -+ int drv_data_size; -+ int ret; -+ -+ drv_data_size = sizeof(struct rtw_dev) + sizeof(struct rtw_usb); -+ hw = ieee80211_alloc_hw(drv_data_size, &rtw_ops); -+ if (!hw) -+ return -ENOMEM; -+ -+ rtwdev = hw->priv; -+ rtwdev->hw = hw; -+ rtwdev->dev = &intf->dev; -+ rtwdev->chip = (struct rtw_chip_info *)id->driver_info; -+ rtwdev->hci.ops = &rtw_usb_ops; -+ rtwdev->hci.type = RTW_HCI_TYPE_USB; -+ -+ rtwusb = rtw_get_usb_priv(rtwdev); -+ rtwusb->rtwdev = rtwdev; -+ -+ ret = rtw_usb_alloc_rx_bufs(rtwusb); -+ if (ret) -+ goto err_release_hw; -+ -+ ret = rtw_core_init(rtwdev); -+ if (ret) -+ goto err_free_rx_bufs; -+ -+ ret = rtw_usb_intf_init(rtwdev, intf); -+ if (ret) { -+ rtw_err(rtwdev, "failed to init USB interface\n"); -+ goto err_deinit_core; -+ } -+ -+ ret = rtw_usb_init_tx(rtwdev); -+ if (ret) { -+ rtw_err(rtwdev, "failed to init USB TX\n"); -+ goto err_destroy_usb; -+ } -+ -+ ret = rtw_usb_init_rx(rtwdev); -+ if (ret) { -+ rtw_err(rtwdev, "failed to init USB RX\n"); -+ goto err_destroy_txwq; -+ } -+ -+ ret = rtw_chip_info_setup(rtwdev); -+ if (ret) { -+ rtw_err(rtwdev, "failed to setup chip information\n"); -+ goto err_destroy_rxwq; -+ } -+ -+ ret = rtw_register_hw(rtwdev, rtwdev->hw); -+ if (ret) { -+ rtw_err(rtwdev, "failed to register hw\n"); -+ goto err_destroy_rxwq; -+ } -+ -+ return 0; -+ -+err_destroy_rxwq: -+ rtw_usb_deinit_rx(rtwdev); -+ -+err_destroy_txwq: -+ rtw_usb_deinit_tx(rtwdev); -+ -+err_destroy_usb: -+ rtw_usb_intf_deinit(rtwdev, intf); -+ -+err_deinit_core: -+ rtw_core_deinit(rtwdev); -+ -+err_free_rx_bufs: -+ rtw_usb_free_rx_bufs(rtwusb); -+ -+err_release_hw: -+ ieee80211_free_hw(hw); -+ -+ return ret; -+} -+EXPORT_SYMBOL(rtw_usb_probe); -+ -+void rtw_usb_disconnect(struct usb_interface *intf) -+{ -+ struct ieee80211_hw *hw = usb_get_intfdata(intf); -+ struct rtw_dev *rtwdev; -+ struct rtw_usb *rtwusb; -+ -+ if (!hw) -+ return; -+ -+ rtwdev = hw->priv; -+ rtwusb = rtw_get_usb_priv(rtwdev); -+ -+ rtw_usb_cancel_rx_bufs(rtwusb); -+ -+ rtw_unregister_hw(rtwdev, hw); -+ rtw_usb_deinit_tx(rtwdev); -+ rtw_usb_deinit_rx(rtwdev); -+ -+ if (rtwusb->udev->state != USB_STATE_NOTATTACHED) -+ usb_reset_device(rtwusb->udev); -+ -+ rtw_usb_free_rx_bufs(rtwusb); -+ -+ rtw_usb_intf_deinit(rtwdev, intf); -+ rtw_core_deinit(rtwdev); -+ ieee80211_free_hw(hw); -+} -+EXPORT_SYMBOL(rtw_usb_disconnect); -+ -+MODULE_AUTHOR("Realtek Corporation"); -+MODULE_DESCRIPTION("Realtek 802.11ac wireless USB driver"); -+MODULE_LICENSE("Dual BSD/GPL"); -diff --git a/drivers/net/wireless/realtek/rtw88/usb.h b/drivers/net/wireless/realtek/rtw88/usb.h -new file mode 100644 -index 000000000..86697a5c0 ---- /dev/null -+++ b/drivers/net/wireless/realtek/rtw88/usb.h -@@ -0,0 +1,100 @@ -+/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ -+/* Copyright(c) 2018-2019 Realtek Corporation -+ */ -+ -+#ifndef __RTW_USB_H_ -+#define __RTW_USB_H_ -+ -+#define FW_8192C_START_ADDRESS 0x1000 -+#define FW_8192C_END_ADDRESS 0x5fff -+ -+#define RTW_USB_MAX_RXTX_COUNT 128 -+#define RTW_USB_VENQT_MAX_BUF_SIZE 254 -+#define MAX_USBCTRL_VENDORREQ_TIMES 10 -+ -+#define RTW_USB_CMD_READ 0xc0 -+#define RTW_USB_CMD_WRITE 0x40 -+#define RTW_USB_CMD_REQ 0x05 -+ -+#define RTW_USB_VENQT_CMD_IDX 0x00 -+ -+#define RTW_USB_TX_SEL_HQ BIT(0) -+#define RTW_USB_TX_SEL_LQ BIT(1) -+#define RTW_USB_TX_SEL_NQ BIT(2) -+#define RTW_USB_TX_SEL_EQ BIT(3) -+ -+#define RTW_USB_BULK_IN_ADDR 0x80 -+#define RTW_USB_INT_IN_ADDR 0x81 -+ -+#define RTW_USB_HW_QUEUE_ENTRY 8 -+ -+#define RTW_USB_PACKET_OFFSET_SZ 8 -+#define RTW_USB_MAX_XMITBUF_SZ (1024 * 20) -+#define RTW_USB_MAX_RECVBUF_SZ 32768 -+ -+#define RTW_USB_RECVBUFF_ALIGN_SZ 8 -+ -+#define RTW_USB_RXAGG_SIZE 6 -+#define RTW_USB_RXAGG_TIMEOUT 10 -+ -+#define RTW_USB_RXCB_NUM 4 -+ -+#define RTW_USB_EP_MAX 4 -+ -+#define TX_DESC_QSEL_MAX 20 -+ -+#define RTW_USB_VENDOR_ID_REALTEK 0x0bda -+ -+static inline struct rtw_usb *rtw_get_usb_priv(struct rtw_dev *rtwdev) -+{ -+ return (struct rtw_usb *)rtwdev->priv; -+} -+ -+struct rx_usb_ctrl_block { -+ struct rtw_dev *rtwdev; -+ struct urb *rx_urb; -+ struct sk_buff *rx_skb; -+}; -+ -+struct rtw_usb_tx_data { -+ u8 sn; -+}; -+ -+struct rtw_usb { -+ struct rtw_dev *rtwdev; -+ struct usb_device *udev; -+ -+ /* protects usb_data_index */ -+ spinlock_t usb_lock; -+ __le32 *usb_data; -+ unsigned int usb_data_index; -+ -+ u8 pipe_interrupt; -+ u8 pipe_in; -+ u8 out_ep[RTW_USB_EP_MAX]; -+ int qsel_to_ep[TX_DESC_QSEL_MAX]; -+ -+ struct workqueue_struct *txwq, *rxwq; -+ -+ struct sk_buff_head tx_queue[RTW_USB_EP_MAX]; -+ struct work_struct tx_work; -+ -+ struct rx_usb_ctrl_block rx_cb[RTW_USB_RXCB_NUM]; -+ struct sk_buff_head rx_queue; -+ struct work_struct rx_work; -+}; -+ -+static inline struct rtw_usb_tx_data *rtw_usb_get_tx_data(struct sk_buff *skb) -+{ -+ struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); -+ -+ BUILD_BUG_ON(sizeof(struct rtw_usb_tx_data) > -+ sizeof(info->status.status_driver_data)); -+ -+ return (struct rtw_usb_tx_data *)info->status.status_driver_data; -+} -+ -+int rtw_usb_probe(struct usb_interface *intf, const struct usb_device_id *id); -+void rtw_usb_disconnect(struct usb_interface *intf); -+ -+#endif -diff --git a/drivers/net/wireless/realtek/rtw88/util.c b/drivers/net/wireless/realtek/rtw88/util.c -index 2c515af21..e222d3c01 100644 ---- a/drivers/net/wireless/realtek/rtw88/util.c -+++ b/drivers/net/wireless/realtek/rtw88/util.c -@@ -23,7 +23,7 @@ EXPORT_SYMBOL(check_hw_ready); - - bool ltecoex_read_reg(struct rtw_dev *rtwdev, u16 offset, u32 *val) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - const struct rtw_ltecoex_addr *ltecoex = chip->ltecoex_addr; - - if (!check_hw_ready(rtwdev, ltecoex->ctrl, LTECOEX_READY, 1)) -@@ -37,7 +37,7 @@ bool ltecoex_read_reg(struct rtw_dev *rtwdev, u16 offset, u32 *val) - - bool ltecoex_reg_write(struct rtw_dev *rtwdev, u16 offset, u32 value) - { -- struct rtw_chip_info *chip = rtwdev->chip; -+ const struct rtw_chip_info *chip = rtwdev->chip; - const struct rtw_ltecoex_addr *ltecoex = chip->ltecoex_addr; - - if (!check_hw_ready(rtwdev, ltecoex->ctrl, LTECOEX_READY, 1)) -@@ -105,3 +105,103 @@ void rtw_desc_to_mcsrate(u16 rate, u8 *mcs, u8 *nss) - *mcs = rate - DESC_RATEMCS0; - } - } -+ -+struct rtw_stas_entry { -+ struct list_head list; -+ struct ieee80211_sta *sta; -+}; -+ -+struct rtw_iter_stas_data { -+ struct rtw_dev *rtwdev; -+ struct list_head list; -+}; -+ -+static void rtw_collect_sta_iter(void *data, struct ieee80211_sta *sta) -+{ -+ struct rtw_iter_stas_data *iter_stas = data; -+ struct rtw_stas_entry *stas_entry; -+ -+ stas_entry = kmalloc(sizeof(*stas_entry), GFP_ATOMIC); -+ if (!stas_entry) -+ return; -+ -+ stas_entry->sta = sta; -+ list_add_tail(&stas_entry->list, &iter_stas->list); -+} -+ -+void rtw_iterate_stas(struct rtw_dev *rtwdev, -+ void (*iterator)(void *data, -+ struct ieee80211_sta *sta), -+ void *data) -+{ -+ struct rtw_iter_stas_data iter_data; -+ struct rtw_stas_entry *sta_entry, *tmp; -+ -+ /* &rtwdev->mutex makes sure no stations can be removed between -+ * collecting the stations and iterating over them. -+ */ -+ lockdep_assert_held(&rtwdev->mutex); -+ -+ iter_data.rtwdev = rtwdev; -+ INIT_LIST_HEAD(&iter_data.list); -+ -+ ieee80211_iterate_stations_atomic(rtwdev->hw, rtw_collect_sta_iter, -+ &iter_data); -+ -+ list_for_each_entry_safe(sta_entry, tmp, &iter_data.list, -+ list) { -+ list_del_init(&sta_entry->list); -+ iterator(data, sta_entry->sta); -+ kfree(sta_entry); -+ } -+} -+ -+struct rtw_vifs_entry { -+ struct list_head list; -+ struct ieee80211_vif *vif; -+}; -+ -+struct rtw_iter_vifs_data { -+ struct rtw_dev *rtwdev; -+ struct list_head list; -+}; -+ -+static void rtw_collect_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif) -+{ -+ struct rtw_iter_vifs_data *iter_stas = data; -+ struct rtw_vifs_entry *vifs_entry; -+ -+ vifs_entry = kmalloc(sizeof(*vifs_entry), GFP_ATOMIC); -+ if (!vifs_entry) -+ return; -+ -+ vifs_entry->vif = vif; -+ list_add_tail(&vifs_entry->list, &iter_stas->list); -+} -+ -+void rtw_iterate_vifs(struct rtw_dev *rtwdev, -+ void (*iterator)(void *data, struct ieee80211_vif *vif), -+ void *data) -+{ -+ struct rtw_iter_vifs_data iter_data; -+ struct rtw_vifs_entry *vif_entry, *tmp; -+ -+ /* &rtwdev->mutex makes sure no interfaces can be removed between -+ * collecting the interfaces and iterating over them. -+ */ -+ lockdep_assert_held(&rtwdev->mutex); -+ -+ iter_data.rtwdev = rtwdev; -+ INIT_LIST_HEAD(&iter_data.list); -+ -+ ieee80211_iterate_active_interfaces_atomic(rtwdev->hw, -+ IEEE80211_IFACE_ITER_NORMAL, -+ rtw_collect_vif_iter, &iter_data); -+ -+ list_for_each_entry_safe(vif_entry, tmp, &iter_data.list, -+ list) { -+ list_del_init(&vif_entry->list); -+ iterator(data, vif_entry->vif); -+ kfree(vif_entry); -+ } -+} -diff --git a/drivers/net/wireless/realtek/rtw88/util.h b/drivers/net/wireless/realtek/rtw88/util.h -index 0c23b5069..f8399128a 100644 ---- a/drivers/net/wireless/realtek/rtw88/util.h -+++ b/drivers/net/wireless/realtek/rtw88/util.h -@@ -7,9 +7,6 @@ - - struct rtw_dev; - --#define rtw_iterate_vifs(rtwdev, iterator, data) \ -- ieee80211_iterate_active_interfaces(rtwdev->hw, \ -- IEEE80211_IFACE_ITER_NORMAL, iterator, data) - #define rtw_iterate_vifs_atomic(rtwdev, iterator, data) \ - ieee80211_iterate_active_interfaces_atomic(rtwdev->hw, \ - IEEE80211_IFACE_ITER_NORMAL, iterator, data) -@@ -20,6 +17,14 @@ struct rtw_dev; - #define rtw_iterate_keys_rcu(rtwdev, vif, iterator, data) \ - ieee80211_iter_keys_rcu((rtwdev)->hw, vif, iterator, data) - -+void rtw_iterate_vifs(struct rtw_dev *rtwdev, -+ void (*iterator)(void *data, struct ieee80211_vif *vif), -+ void *data); -+void rtw_iterate_stas(struct rtw_dev *rtwdev, -+ void (*iterator)(void *data, -+ struct ieee80211_sta *sta), -+ void *data); -+ - static inline u8 *get_hdr_bssid(struct ieee80211_hdr *hdr) - { - __le16 fc = hdr->frame_control; -diff --git a/drivers/net/wireless/realtek/rtw88/wow.c b/drivers/net/wireless/realtek/rtw88/wow.c -index bb2fd4e54..16ddee577 100644 ---- a/drivers/net/wireless/realtek/rtw88/wow.c -+++ b/drivers/net/wireless/realtek/rtw88/wow.c -@@ -12,26 +12,54 @@ - - static void rtw_wow_show_wakeup_reason(struct rtw_dev *rtwdev) - { -+ struct cfg80211_wowlan_nd_info nd_info; -+ struct cfg80211_wowlan_wakeup wakeup = { -+ .pattern_idx = -1, -+ }; - u8 reason; - - reason = rtw_read8(rtwdev, REG_WOWLAN_WAKE_REASON); - -- if (reason == RTW_WOW_RSN_RX_DEAUTH) -+ switch (reason) { -+ case RTW_WOW_RSN_RX_DEAUTH: -+ wakeup.disconnect = true; - rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx deauth\n"); -- else if (reason == RTW_WOW_RSN_DISCONNECT) -+ break; -+ case RTW_WOW_RSN_DISCONNECT: -+ wakeup.disconnect = true; - rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: AP is off\n"); -- else if (reason == RTW_WOW_RSN_RX_MAGIC_PKT) -+ break; -+ case RTW_WOW_RSN_RX_MAGIC_PKT: -+ wakeup.magic_pkt = true; - rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx magic packet\n"); -- else if (reason == RTW_WOW_RSN_RX_GTK_REKEY) -+ break; -+ case RTW_WOW_RSN_RX_GTK_REKEY: -+ wakeup.gtk_rekey_failure = true; - rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx gtk rekey\n"); -- else if (reason == RTW_WOW_RSN_RX_PTK_REKEY) -- rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx ptk rekey\n"); -- else if (reason == RTW_WOW_RSN_RX_PATTERN_MATCH) -+ break; -+ case RTW_WOW_RSN_RX_PATTERN_MATCH: -+ /* Current firmware and driver don't report pattern index -+ * Use pattern_idx to 0 defaultly. -+ */ -+ wakeup.pattern_idx = 0; - rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx pattern match packet\n"); -- else if (reason == RTW_WOW_RSN_RX_NLO) -+ break; -+ case RTW_WOW_RSN_RX_NLO: -+ /* Current firmware and driver don't report ssid index. -+ * Use 0 for n_matches based on its comment. -+ */ -+ nd_info.n_matches = 0; -+ wakeup.net_detect = &nd_info; - rtw_dbg(rtwdev, RTW_DBG_WOW, "Rx NLO\n"); -- else -+ break; -+ default: - rtw_warn(rtwdev, "Unknown wakeup reason %x\n", reason); -+ ieee80211_report_wowlan_wakeup(rtwdev->wow.wow_vif, NULL, -+ GFP_KERNEL); -+ return; -+ } -+ ieee80211_report_wowlan_wakeup(rtwdev->wow.wow_vif, &wakeup, -+ GFP_KERNEL); - } - - static void rtw_wow_pattern_write_cam(struct rtw_dev *rtwdev, u8 addr, -@@ -343,7 +371,8 @@ static void rtw_wow_fw_security_type_iter(struct ieee80211_hw *hw, - key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; - break; - default: -- rtw_err(rtwdev, "Unsupported key type for wowlan mode\n"); -+ rtw_err(rtwdev, "Unsupported key type for wowlan mode: %#x\n", -+ key->cipher); - hw_key_type = 0; - break; - } -@@ -442,37 +471,31 @@ static void rtw_wow_fw_media_status(struct rtw_dev *rtwdev, bool connect) - rtw_iterate_stas_atomic(rtwdev, rtw_wow_fw_media_status_iter, &data); - } - --static void rtw_wow_config_pno_rsvd_page(struct rtw_dev *rtwdev, -- struct rtw_vif *rtwvif) --{ -- rtw_add_rsvd_page_pno(rtwdev, rtwvif); --} -- --static void rtw_wow_config_linked_rsvd_page(struct rtw_dev *rtwdev, -- struct rtw_vif *rtwvif) -+static int rtw_wow_config_wow_fw_rsvd_page(struct rtw_dev *rtwdev) - { -- rtw_add_rsvd_page_sta(rtwdev, rtwvif); --} -+ struct ieee80211_vif *wow_vif = rtwdev->wow.wow_vif; -+ struct rtw_vif *rtwvif = (struct rtw_vif *)wow_vif->drv_priv; - --static void rtw_wow_config_rsvd_page(struct rtw_dev *rtwdev, -- struct rtw_vif *rtwvif) --{ - rtw_remove_rsvd_page(rtwdev, rtwvif); - -- if (rtw_wow_mgd_linked(rtwdev)) { -- rtw_wow_config_linked_rsvd_page(rtwdev, rtwvif); -- } else if (test_bit(RTW_FLAG_WOWLAN, rtwdev->flags) && -- rtw_wow_no_link(rtwdev)) { -- rtw_wow_config_pno_rsvd_page(rtwdev, rtwvif); -- } -+ if (rtw_wow_no_link(rtwdev)) -+ rtw_add_rsvd_page_pno(rtwdev, rtwvif); -+ else -+ rtw_add_rsvd_page_sta(rtwdev, rtwvif); -+ -+ return rtw_fw_download_rsvd_page(rtwdev); - } - --static int rtw_wow_dl_fw_rsvd_page(struct rtw_dev *rtwdev) -+static int rtw_wow_config_normal_fw_rsvd_page(struct rtw_dev *rtwdev) - { - struct ieee80211_vif *wow_vif = rtwdev->wow.wow_vif; - struct rtw_vif *rtwvif = (struct rtw_vif *)wow_vif->drv_priv; - -- rtw_wow_config_rsvd_page(rtwdev, rtwvif); -+ rtw_remove_rsvd_page(rtwdev, rtwvif); -+ rtw_add_rsvd_page_sta(rtwdev, rtwvif); -+ -+ if (rtw_wow_no_link(rtwdev)) -+ return 0; - - return rtw_fw_download_rsvd_page(rtwdev); - } -@@ -566,10 +589,10 @@ static int rtw_wow_leave_no_link_ps(struct rtw_dev *rtwdev) - int ret = 0; - - if (test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) { -- if (rtw_fw_lps_deep_mode) -+ if (rtw_get_lps_deep_mode(rtwdev) != LPS_DEEP_MODE_NONE) - rtw_leave_lps_deep(rtwdev); - } else { -- if (test_bit(RTW_FLAG_INACTIVE_PS, rtwdev->flags)) { -+ if (!test_bit(RTW_FLAG_POWERON, rtwdev->flags)) { - rtw_wow->ips_enabled = true; - ret = rtw_leave_ips(rtwdev); - if (ret) -@@ -627,7 +650,8 @@ static int rtw_wow_enter_ps(struct rtw_dev *rtwdev) - - if (rtw_wow_mgd_linked(rtwdev)) - ret = rtw_wow_enter_linked_ps(rtwdev); -- else if (rtw_wow_no_link(rtwdev) && rtw_fw_lps_deep_mode) -+ else if (rtw_wow_no_link(rtwdev) && -+ rtw_get_lps_deep_mode(rtwdev) != LPS_DEEP_MODE_NONE) - ret = rtw_wow_enter_no_link_ps(rtwdev); - - return ret; -@@ -669,7 +693,7 @@ static int rtw_wow_enable(struct rtw_dev *rtwdev) - - set_bit(RTW_FLAG_WOWLAN, rtwdev->flags); - -- ret = rtw_wow_dl_fw_rsvd_page(rtwdev); -+ ret = rtw_wow_config_wow_fw_rsvd_page(rtwdev); - if (ret) { - rtw_err(rtwdev, "failed to download wowlan rsvd page\n"); - goto error; -@@ -742,7 +766,7 @@ static int rtw_wow_disable(struct rtw_dev *rtwdev) - goto out; - } - -- ret = rtw_wow_dl_fw_rsvd_page(rtwdev); -+ ret = rtw_wow_config_normal_fw_rsvd_page(rtwdev); - if (ret) - rtw_err(rtwdev, "failed to download normal rsvd page\n"); - -diff --git a/drivers/net/wireless/rtl8821cs/Kconfig b/drivers/net/wireless/rtl8821cs/Kconfig -new file mode 100644 -index 000000000..952ca5ed3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/Kconfig -@@ -0,0 +1,2 @@ -+config RTL8821CS -+ tristate "Realtek 8821C SDIO WiFi" -diff --git a/drivers/net/wireless/rtl8821cs/Makefile b/drivers/net/wireless/rtl8821cs/Makefile -new file mode 100644 -index 000000000..3103f5f52 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/Makefile -@@ -0,0 +1,2539 @@ -+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_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_RTL8188GTV = n -+CONFIG_RTL8822B = n -+CONFIG_RTL8723D = n -+CONFIG_RTL8821C = y -+CONFIG_RTL8710B = n -+CONFIG_RTL8192F = n -+CONFIG_RTL8822C = n -+CONFIG_RTL8814B = n -+CONFIG_RTL8814C = n -+CONFIG_RTL8723F = n -+######################### Interface ########################### -+CONFIG_USB_HCI = n -+CONFIG_PCI_HCI = n -+CONFIG_SDIO_HCI = y -+CONFIG_GSPI_HCI = n -+########################## Features ########################### -+CONFIG_AP_MODE = y -+CONFIG_P2P = y -+CONFIG_MP_INCLUDED = y -+CONFIG_POWER_SAVING = y -+CONFIG_IPS_MODE = default -+CONFIG_LPS_MODE = default -+CONFIG_USB_AUTOSUSPEND = n -+CONFIG_HW_PWRP_DETECTION = n -+CONFIG_BT_COEXIST = y -+CONFIG_WAPI_SUPPORT = n -+CONFIG_EFUSE_CONFIG_FILE = y -+CONFIG_EXT_CLK = n -+CONFIG_TRAFFIC_PROTECT = n -+CONFIG_LOAD_PHY_PARA_FROM_FILE = y -+CONFIG_TXPWR_BY_RATE = y -+CONFIG_TXPWR_BY_RATE_EN = y -+CONFIG_TXPWR_LIMIT = y -+CONFIG_TXPWR_LIMIT_EN = n -+CONFIG_RTW_CHPLAN = 0xFFFF -+CONFIG_RTW_ADAPTIVITY_EN = disable -+CONFIG_RTW_ADAPTIVITY_MODE = normal -+CONFIG_80211D = n -+CONFIG_SIGNAL_SCALE_MAPPING = n -+CONFIG_80211W = y -+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 -+CONFIG_RTW_NETIF_SG = y -+CONFIG_RTW_IPCAM_APPLICATION = n -+CONFIG_RTW_REPEATER_SON = n -+CONFIG_ICMP_VOQ = n -+CONFIG_IP_R_MONITOR = n #arp VOQ and high rate -+# user priority mapping rule : tos, dscp -+CONFIG_RTW_UP_MAPPING_RULE = tos -+CONFIG_RTW_MBO = n -+CONFIG_WAKE_ON_BT = n -+########################## Android ########################### -+# CONFIG_RTW_ANDROID - 0: no Android, 4/5/6/7/8/9/10/11 : Android version -+CONFIG_RTW_ANDROID = 0 -+ -+ifeq ($(shell test $(CONFIG_RTW_ANDROID) -gt 0; echo $$?), 0) -+EXTRA_CFLAGS += -DCONFIG_RTW_ANDROID=$(CONFIG_RTW_ANDROID) -+endif -+ -+########################## 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 = 0 -+ -+# enable /proc/net/rtlxxxx/ debug interfaces -+CONFIG_PROC_DEBUG = y -+ -+######################## Wake On Lan ########################## -+CONFIG_WOWLAN = n -+#bit2: deauth, bit1: unicast, bit0: magic pkt. -+CONFIG_WAKEUP_TYPE = 0x7 -+CONFIG_WOW_LPS_MODE = default -+#bit0: disBBRF off, #bit1: Wireless remote controller (WRC) -+CONFIG_SUSPEND_TYPE = 0 -+CONFIG_WOW_STA_MIX = n -+CONFIG_GPIO_WAKEUP = n -+# Please contact with RTK support team first. After getting the agreement from RTK support team, -+# you are just able to modify the CONFIG_WAKEUP_GPIO_IDX with customized requirement. -+CONFIG_WAKEUP_GPIO_IDX = default -+CONFIG_HIGH_ACTIVE_DEV2HST = n -+######### only for USB ######### -+CONFIG_ONE_PIN_GPIO = n -+CONFIG_HIGH_ACTIVE_HST2DEV = 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 -+###################### ROAMING ##################################### -+CONFIG_LAYER2_ROAMING = y -+#bit0: ROAM_ON_EXPIRED, #bit1: ROAM_ON_RESUME, #bit2: ROAM_ACTIVE -+CONFIG_ROAMING_FLAG = 0x3 -+###################### Platform Related ####################### -+CONFIG_PLATFORM_I386_PC = y -+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_LGE = 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_RTK119X_AM = n -+CONFIG_PLATFORM_RTK129X = n -+CONFIG_PLATFORM_RTK1319 = n -+CONFIG_PLATFORM_RTK390X = n -+CONFIG_PLATFORM_NOVATEK_NT72668 = n -+CONFIG_PLATFORM_HISILICON = n -+CONFIG_PLATFORM_HISILICON_HI3798 = n -+CONFIG_PLATFORM_NV_TK1 = n -+CONFIG_PLATFORM_NV_TK1_UBUNTU = n -+CONFIG_PLATFORM_RTL8197D = n -+CONFIG_PLATFORM_AML_S905 = n -+CONFIG_PLATFORM_ZTE_ZX296716 = n -+########### CUSTOMER ################################ -+CONFIG_CUSTOMER_HUAWEI_GENERAL = 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 \ -+ os_dep/linux/nlrtw.o \ -+ os_dep/linux/rtw_rhashtable.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_dm_acs.o \ -+ hal/hal_btcoex_wifionly.o \ -+ hal/hal_btcoex.o \ -+ hal/hal_mp.o \ -+ hal/hal_mcc.o \ -+ hal/hal_hci/hal_$(HCI_NAME).o \ -+ hal/led/hal_led.o \ -+ hal/led/hal_$(HCI_NAME)_led.o -+ -+ -+EXTRA_CFLAGS += -I$(src)/platform -+_PLATFORM_FILES := platform/platform_ops.o -+ -+EXTRA_CFLAGS += -I$(src)/hal/btc -+ -+########### 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 -+ -+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 -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_SDIO.o -+endif -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+_BTC_FILES += hal/btc/halbtc8192e1ant.o \ -+ hal/btc/halbtc8192e2ant.o -+endif -+ -+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 -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821A_SDIO.o -+endif -+endif -+ -+ifeq ($(CONFIG_RTL8812A), y) -+EXTRA_CFLAGS += -DCONFIG_RTL8812A -+_HAL_INTFS_FILES += hal/rtl8812a/hal8812a_fw.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 -+ -+endif -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+ifeq ($(CONFIG_RTL8812A), y) -+_BTC_FILES += hal/btc/halbtc8812a1ant.o \ -+ hal/btc/halbtc8812a2ant.o -+endif -+ifeq ($(CONFIG_RTL8821A), y) -+_BTC_FILES += hal/btc/halbtc8821a1ant.o \ -+ hal/btc/halbtc8821a2ant.o -+endif -+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 -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_SDIO.o -+endif -+ -+_BTC_FILES += hal/btc/halbtc8723bwifionly.o -+ifeq ($(CONFIG_BT_COEXIST), y) -+_BTC_FILES += hal/btc/halbtc8723b1ant.o \ -+ hal/btc/halbtc8723b2ant.o -+endif -+ -+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 -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+_BTC_FILES += hal/btc/halbtc8814a2ant.o -+endif -+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 -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+_BTC_FILES += hal/btc/halbtc8703b1ant.o -+endif -+ -+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 -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+_BTC_FILES += hal/btc/halbtc8723d1ant.o \ -+ hal/btc/halbtc8723d2ant.o -+endif -+ -+endif -+ -+########### HAL_RTL8723F ################################# -+ifeq ($(CONFIG_RTL8723F), y) -+RTL871X := rtl8723f -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8723fu -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8723fs -+endif -+ -+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 -+ -+endif -+ -+########### HAL_RTL8188GTV ################################# -+ifeq ($(CONFIG_RTL8188GTV), y) -+ -+RTL871X = rtl8188gtv -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8188gtvu -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8189gtvs -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8188GTV -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8188GTVPwrSeq.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)/hal8188gtv_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)/HalEfuseMask8188GTV_USB.o -+endif -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188GTV_SDIO.o -+endif -+ -+endif -+ -+########### HAL_RTL8822B ################################# -+ifeq ($(CONFIG_RTL8822B), y) -+RTL871X := rtl8822b -+ifeq ($(CONFIG_USB_HCI), y) -+ifeq ($(CONFIG_BT_COEXIST), n) -+MODULE_NAME = 8812bu -+else -+MODULE_NAME = 88x2bu -+endif -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 88x2be -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 88x2bs -+endif -+ -+endif -+########### HAL_RTL8821C ################################# -+ifeq ($(CONFIG_RTL8821C), y) -+RTL871X := rtl8821c -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8821cu -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8821ce -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8821cs -+endif -+ -+endif -+ -+########### HAL_RTL8710B ################################# -+ifeq ($(CONFIG_RTL8710B), y) -+ -+RTL871X = rtl8710b -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8710bu -+MODULE_SUB_NAME = 8710bu -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8710B -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8710BPwrSeq.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)/hal8710b_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 -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8710B_USB.o -+endif -+ -+endif -+ -+########### HAL_RTL8192F ################################# -+ifeq ($(CONFIG_RTL8192F), y) -+ -+RTL871X = rtl8192f -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8192fu -+MODULE_SUB_NAME = 8192fu -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8192fe -+MODULE_SUB_NAME = 8192fe -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8192fs -+MODULE_SUB_NAME = 8192fs -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8192F -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8192FPwrSeq.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)/hal8192f_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_SDIO_HCI), y) -+_HAL_INTFS_FILES += hal/efuse/$(RTL871X)/HalEfuseMask8192F_SDIO.o -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES += hal/efuse/$(RTL871X)/HalEfuseMask8192F_USB.o -+endif -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES += hal/efuse/$(RTL871X)/HalEfuseMask8192F_PCIE.o -+endif -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+_BTC_FILES += hal/btc/halbtccommon.o \ -+ hal/btc/halbtc8192f.o -+endif -+ -+endif -+ -+########### HAL_RTL8822C ################################# -+ifeq ($(CONFIG_RTL8822C), y) -+RTL871X := rtl8822c -+ifeq ($(CONFIG_USB_HCI), y) -+ifeq ($(CONFIG_BT_COEXIST), n) -+MODULE_NAME = 8812cu -+else -+MODULE_NAME = 88x2cu -+endif -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 88x2ce -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 88x2cs -+endif -+ -+endif -+ -+########### HAL_RTL8814B ################################# -+ifeq ($(CONFIG_RTL8814B), y) -+RTL871X := rtl8814b -+ifeq ($(CONFIG_RTL8814C), y) -+MODULE_NAME = 8814ce -+else -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8814bu -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8814be -+endif -+endif -+ -+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_AP_MODE), y) -+EXTRA_CFLAGS += -DCONFIG_AP_MODE -+endif -+ -+ifeq ($(CONFIG_P2P), y) -+EXTRA_CFLAGS += -DCONFIG_P2P -+ifneq ($(CONFIG_AP_MODE), y) -+$(error "CONFIG_AP_MODE is required for CONFIG_P2P") -+endif -+endif -+ -+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) -+ifneq ($(CONFIG_IPS_MODE), default) -+EXTRA_CFLAGS += -DRTW_IPS_MODE=$(CONFIG_IPS_MODE) -+endif -+ifneq ($(CONFIG_LPS_MODE), default) -+EXTRA_CFLAGS += -DRTW_LPS_MODE=$(CONFIG_LPS_MODE) -+endif -+ifneq ($(CONFIG_WOW_LPS_MODE), default) -+EXTRA_CFLAGS += -DRTW_WOW_LPS_MODE=$(CONFIG_WOW_LPS_MODE) -+endif -+EXTRA_CFLAGS += -DCONFIG_POWER_SAVING -+endif -+ -+ifeq ($(CONFIG_HW_PWRP_DETECTION), y) -+EXTRA_CFLAGS += -DCONFIG_HW_PWRP_DETECTION -+endif -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+EXTRA_CFLAGS += -DCONFIG_BT_COEXIST -+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/\" -+endif -+ -+ifeq ($(CONFIG_TXPWR_BY_RATE), n) -+EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE=0 -+else ifeq ($(CONFIG_TXPWR_BY_RATE), y) -+EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE=1 -+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), n) -+EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT=0 -+else ifeq ($(CONFIG_TXPWR_LIMIT), y) -+EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT=1 -+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 -+ -+ifneq ($(CONFIG_RTW_CHPLAN), 0xFFFF) -+EXTRA_CFLAGS += -DCONFIG_RTW_CHPLAN=$(CONFIG_RTW_CHPLAN) -+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 -+else ifeq ($(CONFIG_RTW_ADAPTIVITY_EN), auto) -+EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_EN=2 -+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_80211D), y) -+EXTRA_CFLAGS += -DCONFIG_80211D -+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 -DRTW_WAKEUP_EVENT=$(CONFIG_WAKEUP_TYPE) -+EXTRA_CFLAGS += -DRTW_SUSPEND_TYPE=$(CONFIG_SUSPEND_TYPE) -+ifeq ($(CONFIG_WOW_STA_MIX), y) -+EXTRA_CFLAGS += -DRTW_WOW_STA_MIX -+endif -+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_AP_MODE), n) -+EXTRA_CFLAGS += -DCONFIG_AP_MODE -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER -+endif -+endif -+ -+ifeq ($(CONFIG_LAYER2_ROAMING), y) -+EXTRA_CFLAGS += -DCONFIG_LAYER2_ROAMING -DCONFIG_ROAMING_FLAG=$(CONFIG_ROAMING_FLAG) -+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_ONE_PIN_GPIO), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_ONE_PIN_GPIO -+endif -+ifeq ($(CONFIG_HIGH_ACTIVE_DEV2HST), y) -+EXTRA_CFLAGS += -DHIGH_ACTIVE_DEV2HST=1 -+else -+EXTRA_CFLAGS += -DHIGH_ACTIVE_DEV2HST=0 -+endif -+endif -+ -+ifeq ($(CONFIG_HIGH_ACTIVE_HST2DEV), y) -+EXTRA_CFLAGS += -DHIGH_ACTIVE_HST2DEV=1 -+else -+EXTRA_CFLAGS += -DHIGH_ACTIVE_HST2DEV=0 -+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_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_RTW_REPEATER_SON), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_REPEATER_SON -+endif -+ -+ifeq ($(CONFIG_RTW_IPCAM_APPLICATION), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_IPCAM_APPLICATION -+ifeq ($(CONFIG_WIFI_MONITOR), n) -+EXTRA_CFLAGS += -DCONFIG_WIFI_MONITOR -+endif -+endif -+ -+ifeq ($(CONFIG_RTW_NETIF_SG), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_NETIF_SG -+endif -+ -+ifeq ($(CONFIG_ICMP_VOQ), y) -+EXTRA_CFLAGS += -DCONFIG_ICMP_VOQ -+endif -+ -+ifeq ($(CONFIG_IP_R_MONITOR), y) -+EXTRA_CFLAGS += -DCONFIG_IP_R_MONITOR -+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 -+ -+ifeq ($(CONFIG_PROC_DEBUG), y) -+EXTRA_CFLAGS += -DCONFIG_PROC_DEBUG -+endif -+ -+ifeq ($(CONFIG_RTW_UP_MAPPING_RULE), dscp) -+EXTRA_CFLAGS += -DCONFIG_RTW_UP_MAPPING_RULE=1 -+else -+EXTRA_CFLAGS += -DCONFIG_RTW_UP_MAPPING_RULE=0 -+endif -+ -+EXTRA_CFLAGS += -DDM_ODM_SUPPORT_TYPE=0x04 -+ -+ifeq ($(CONFIG_RTW_MBO), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_MBO -DCONFIG_RTW_80211K -DCONFIG_RTW_WNM -DCONFIG_RTW_BTM_ROAM -+EXTRA_CFLAGS += -DCONFIG_RTW_80211R -+endif -+ -+ifeq ($(CONFIG_WAKE_ON_BT), y) -+EXTRA_CFLAGS += -DCONFIG_WAKE_ON_BT -+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 ?= -+KVER := $(shell uname -r) -+KSRC := /lib/modules/$(KVER)/build -+MODDESTDIR := /lib/modules/$(KVER)/kernel/drivers/net/wireless/ -+INSTALL_PREFIX := -+STAGINGMODDIR := /lib/modules/$(KVER)/kernel/drivers/staging -+endif -+ -+ifeq ($(CONFIG_PLATFORM_NV_TK1), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_NV_TK1 -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_PLATFORM_ANDROID -+# 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_NV_TK1_UBUNTU), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_NV_TK1 -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ -+ARCH ?= arm -+ -+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 -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_MSTAR -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_MSTAR_HIGH -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -DCONFIG_FIX_NR_BULKIN_BUFFER -+endif -+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_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 -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DRTW_SUPPORT_PLATFORM_SHUTDOWN -+endif -+# 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 -+ -+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_PLATFORM_ARM_RTD299X -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ifeq ($(CONFIG_ANDROID), y) -+# 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 := -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_RTD299X_LG), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DRTW_P2P_GROUP_INTERFACE=1 -+EXTRA_CFLAGS += -DCONFIG_IFACE_NUMBER=3 -+#EXTRA_CFLAGS += -DCONFIG_FIX_HWPORT -+EXTRA_CFLAGS += -DLGE_PRIVATE -+EXTRA_CFLAGS += -DPURE_SUPPLICANT -+EXTRA_CFLAGS += -DCONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP -DCONFIG_RTW_IOCTL_SET_COUNTRY -+EXTRA_CFLAGS += -DDBG_RX_DFRAME_RAW_DATA -+EXTRA_CFLAGS += -DRTW_REDUCE_SCAN_SWITCH_CH_TIME -+ARCH ?= arm -+KVER ?= -+ -+ifneq ($(PLATFORM), WEBOS) -+$(info PLATFORM is empty) -+CROSS_COMPILE ?= /mnt/newdisk/LGE/arm-lg115x-linux-gnueabi-4.8-2016.03-x86_64/bin/arm-lg115x-linux-gnueabi- -+KSRC ?= /mnt/newdisk/LGE/linux-rockhopper_k3lp_drd4tv_423 -+endif -+ -+CROSS_COMPILE ?= -+KSRC ?= $(LINUX_SRC) -+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 -+ -+ifeq ($(CONFIG_PLATFORM_HISILICON_HI3798), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_HISILICON -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_HISILICON_HI3798 -+#EXTRA_CFLAGS += -DCONFIG_PLATFORM_HISILICON_HI3798_MV200_HDMI_DONGLE -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+# default setting for Android -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -+EXTRA_CFLAGS += -DRTW_USE_CFG80211_STA_EVENT -+# default setting for Android 5.x and later -+#EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ -+# If system could power on and recognize Wi-Fi SDIO automatically, -+# platfrom operations are not necessary. -+#ifeq ($(CONFIG_SDIO_HCI), y) -+#EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+#_PLATFORM_FILES += platform/platform_hisilicon_hi3798_sdio.o -+#EXTRA_CFLAGS += -DCONFIG_HISI_SDIO_ID=1 -+#endif -+ -+ARCH ?= arm -+CROSS_COMPILE ?= /HiSTBAndroidV600R003C00SPC021_git_0512/device/hisilicon/bigfish/sdk/tools/linux/toolchains/arm-histbv310-linux/bin/arm-histbv310-linux- -+ifndef KSRC -+KSRC := /HiSTBAndroidV600R003C00SPC021_git_0512/device/hisilicon/bigfish/sdk/source/kernel/linux-3.18.y -+KSRC += O=/HiSTBAndroidV600R003C00SPC021_git_0512/out/target/product/Hi3798MV200/obj/KERNEL_OBJ -+endif -+ -+ifeq ($(CONFIG_RTL8822B), y) -+ifeq ($(CONFIG_SDIO_HCI), y) -+CONFIG_RTL8822BS ?= m -+USER_MODULE_NAME := rtl8822bs -+endif -+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_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 -+ -+# Actions-Micro use this flag for DHC 1195 and DHC 1395 -+ifeq ($(CONFIG_PLATFORM_RTK119X_AM), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_RTK119X_AM -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_FULL_CH_IN_P2P_HANDSHAKE -+EXTRA_CFLAGS += -DCONFIG_SEL_P2P_IFACE=2 -+EXTRA_CFLAGS += -DCONFIG_IFACE_NUMBER=3 -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+endif -+ -+ARCH := arm -+ -+#CROSS_COMPILE := arm-linux-gnueabihf- -+KVER := 3.10.24 -+#KSRC := -+CROSS_COMPILE := -+endif -+ -+ifeq ($(CONFIG_PLATFORM_RTK129X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_RTK129X -+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 -+# Enable this for Android 5.0 -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ifeq ($(CONFIG_RTL8821C)$(CONFIG_SDIO_HCI),yy) -+EXTRA_CFLAGS += -DCONFIG_WAKEUP_GPIO_INPUT_MODE -+EXTRA_CFLAGS += -DCONFIG_BT_WAKE_HST_OPEN_DRAIN -+endif -+EXTRA_CFLAGS += -Wno-error=date-time -+# default setting for Android 7.0 -+ifeq ($(RTK_ANDROID_VERSION), nougat) -+EXTRA_CFLAGS += -DRTW_P2P_GROUP_INTERFACE=1 -+endif -+#EXTRA_CFLAGS += -DCONFIG_#PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+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) -+CROSS_COMPILE := /home/android_sdk/DHC/trunk-6.0.0_r1-QA160627/phoenix/toolchain/asdk64-4.9.4-a53-EL-3.10-g2.19-a64nt-160307/bin/asdk64-linux- -+KSRC := /home/android_sdk/DHC/trunk-6.0.0_r1-QA160627/linux-kernel -+endif -+ -+ifeq ($(CONFIG_PLATFORM_RTK1319), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_RTK1319 -+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_QOS_OPTIMIZATION -+EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION -+# Enable this for Android 5.0 -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ifeq ($(CONFIG_RTL8821C)$(CONFIG_SDIO_HCI),yy) -+EXTRA_CFLAGS += -DCONFIG_WAKEUP_GPIO_INPUT_MODE -+EXTRA_CFLAGS += -DCONFIG_BT_WAKE_HST_OPEN_DRAIN -+endif -+EXTRA_CFLAGS += -Wno-error=date-time -+# default setting for Android 7.0 -+ifeq ($(RTK_ANDROID_VERSION), nougat) -+EXTRA_CFLAGS += -DRTW_P2P_GROUP_INTERFACE=1 -+endif -+#EXTRA_CFLAGS += -DCONFIG_#PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+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) -+CROSS_COMPILE := /home/android_sdk/DHC/trunk-6.0.0_r1-QA160627/phoenix/toolchain/asdk64-4.9.4-a53-EL-3.10-g2.19-a64nt-160307/bin/asdk64-linux- -+KSRC := /home/android_sdk/DHC/trunk-6.0.0_r1-QA160627/linux-kernel -+endif -+ -+ifeq ($(CONFIG_PLATFORM_RTK390X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_RTK390X -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_RTW_NETIF_SG -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+endif -+ -+ARCH:=rlx -+ -+CROSS_COMPILE:=mips-linux- -+KSRC:= /home/realtek/share/Develop/IPCAM_SDK/RealSil/rts3901_sdk_v1.2_vanilla/linux-3.10 -+ -+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_PLATFORM_RTL8197D), y) -+EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -DCONFIG_PLATFORM_RTL8197D -+export DIR_LINUX=$(shell pwd)/../SDK/rlxlinux-sdk321-v50/linux-2.6.30 -+ARCH ?= rlx -+CROSS_COMPILE:= $(DIR_LINUX)/../toolchain/rsdk-1.5.5-5281-EB-2.6.30-0.9.30.3-110714/bin/rsdk-linux- -+KSRC := $(DIR_LINUX) -+endif -+ -+ifeq ($(CONFIG_PLATFORM_AML_S905), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_AML_S905 -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -fno-pic -+# default setting for Android -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -+EXTRA_CFLAGS += -DRTW_USE_CFG80211_STA_EVENT -+# default setting for Android 5.x and later -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+_PLATFORM_FILES += platform/platform_aml_s905_sdio.o -+endif -+ -+ARCH ?= arm64 -+CROSS_COMPILE ?= /4.4_S905L_8822bs_compile/gcc-linaro-aarch64-linux-gnu-4.9-2014.09_linux/bin/aarch64-linux-gnu- -+ifndef KSRC -+KSRC := /4.4_S905L_8822bs_compile/common -+# To locate output files in a separate directory. -+KSRC += O=/4.4_S905L_8822bs_compile/KERNEL_OBJ -+endif -+ -+ifeq ($(CONFIG_RTL8822B), y) -+ifeq ($(CONFIG_SDIO_HCI), y) -+CONFIG_RTL8822BS ?= m -+USER_MODULE_NAME := 8822bs -+endif -+endif -+ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ZTE_ZX296716), y) -+EXTRA_CFLAGS += -Wno-error=date-time -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ZTE_ZX296716 -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+# default setting for Android -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -+EXTRA_CFLAGS += -DRTW_USE_CFG80211_STA_EVENT -+# default setting for Android 5.x and later -+#EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+# mark this temporarily -+#EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+#_PLATFORM_FILES += platform/platform_zte_zx296716_sdio.o -+endif -+ -+ARCH ?= arm64 -+CROSS_COMPILE ?= -+KSRC ?= -+ -+ifeq ($(CONFIG_RTL8822B), y) -+ifeq ($(CONFIG_SDIO_HCI), y) -+CONFIG_RTL8822BS ?= m -+USER_MODULE_NAME := 8822bs -+endif -+endif -+ -+endif -+ -+########### CUSTOMER ################################ -+ifeq ($(CONFIG_CUSTOMER_HUAWEI_GENERAL), y) -+CONFIG_CUSTOMER_HUAWEI = y -+endif -+ -+ifeq ($(CONFIG_CUSTOMER_HUAWEI), y) -+EXTRA_CFLAGS += -DCONFIG_HUAWEI_PROC -+endif -+ -+CONFIG_PLATFORM_CMAP_INTFS = n -+ifeq ($(CONFIG_PLATFORM_CMAP_INTFS), y) -+PLATFORM_CMAP_INTFS_TYPE = 00 -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_CMAP_INTFS -DCMAP_UNASSOC_METRICS_STA_MAX=32 -+_OS_INTFS_FILES += os_dep/linux/custom_multiap_intfs/custom_multiap_intfs.o -+_PLATFORM_FILES += platform/custom_multiap_intfs_$(PLATFORM_CMAP_INTFS_TYPE).o -+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),) -+ -+########### this part for *.mk ############################ -+include $(src)/hal/phydm/phydm.mk -+ -+########### HAL_RTL8822B ################################# -+ifeq ($(CONFIG_RTL8822B), y) -+include $(src)/rtl8822b.mk -+endif -+ -+########### HAL_RTL8821C ################################# -+ifeq ($(CONFIG_RTL8821C), y) -+include $(src)/rtl8821c.mk -+endif -+ -+########### HAL_RTL8822C ################################# -+ifeq ($(CONFIG_RTL8822C), y) -+include $(src)/rtl8822c.mk -+endif -+ -+########### HAL_RTL8814B ################################# -+ifeq ($(CONFIG_RTL8814B), y) -+include $(src)/rtl8814b.mk -+endif -+ -+ifeq ($(CONFIG_RTL8814C), y) -+EXTRA_CFLAGS += -DCONFIG_RTL8814C -+endif -+########### HAL_RTL8723F ################################# -+ifeq ($(CONFIG_RTL8723F), y) -+include $(src)/rtl8723f.mk -+endif -+ -+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_chplan.o \ -+ core/monitor/rtw_radiotap.o \ -+ core/rtw_recv.o \ -+ core/rtw_sta_mgt.o \ -+ core/rtw_ap.o \ -+ core/wds/rtw_wds.o \ -+ core/mesh/rtw_mesh.o \ -+ core/mesh/rtw_mesh_pathtbl.o \ -+ core/mesh/rtw_mesh_hwmp.o \ -+ core/rtw_xmit.o \ -+ core/rtw_p2p.o \ -+ core/rtw_rson.o \ -+ core/rtw_tdls.o \ -+ core/rtw_br_ext.o \ -+ core/rtw_iol.o \ -+ core/rtw_sreset.o \ -+ core/rtw_btcoex_wifionly.o \ -+ core/rtw_btcoex.o \ -+ core/rtw_beamforming.o \ -+ core/rtw_odm.o \ -+ core/rtw_rm.o \ -+ core/rtw_rm_fsm.o \ -+ core/rtw_ft.o \ -+ core/rtw_wnm.o \ -+ core/rtw_mbo.o \ -+ core/rtw_rm_util.o \ -+ core/efuse/rtw_efuse.o \ -+ core/rtw_roch.o -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+rtk_core += core/rtw_sdio.o -+endif -+ -+EXTRA_CFLAGS += -I$(src)/core/crypto -+rtk_core += \ -+ core/crypto/aes-internal.o \ -+ core/crypto/aes-internal-enc.o \ -+ core/crypto/aes-gcm.o \ -+ core/crypto/aes-ccm.o \ -+ core/crypto/aes-omac1.o \ -+ core/crypto/ccmp.o \ -+ core/crypto/gcmp.o \ -+ core/crypto/aes-siv.o \ -+ core/crypto/aes-ctr.o \ -+ core/crypto/sha256-internal.o \ -+ core/crypto/sha256.o \ -+ core/crypto/sha256-prf.o \ -+ core/crypto/rtw_crypto_wrap.o \ -+ core/rtw_swcrypto.o -+ -+$(MODULE_NAME)-y += $(rtk_core) -+ -+$(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 += $(_PHYDM_FILES) -+$(MODULE_NAME)-y += $(_BTC_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_RTL8821CS) := $(MODULE_NAME).o -+ -+else -+ -+export CONFIG_RTL8821CS = 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} -+ -+backup_rtlwifi: -+ @echo "Making backup rtlwifi drivers" -+ifneq (,$(wildcard $(STAGINGMODDIR)/rtl*)) -+ @tar cPf $(wildcard $(STAGINGMODDIR))/backup_rtlwifi_driver.tar $(wildcard $(STAGINGMODDIR)/rtl*) -+ @rm -rf $(wildcard $(STAGINGMODDIR)/rtl*) -+endif -+ifneq (,$(wildcard $(MODDESTDIR)realtek)) -+ @tar cPf $(MODDESTDIR)backup_rtlwifi_driver.tar $(MODDESTDIR)realtek -+ @rm -fr $(MODDESTDIR)realtek -+endif -+ifneq (,$(wildcard $(MODDESTDIR)rtl*)) -+ @tar cPf $(MODDESTDIR)../backup_rtlwifi_driver.tar $(wildcard $(MODDESTDIR)rtl*) -+ @rm -fr $(wildcard $(MODDESTDIR)rtl*) -+endif -+ @/sbin/depmod -a ${KVER} -+ @echo "Please reboot your system" -+ -+restore_rtlwifi: -+ @echo "Restoring backups" -+ifneq (,$(wildcard $(STAGINGMODDIR)/backup_rtlwifi_driver.tar)) -+ @tar xPf $(STAGINGMODDIR)/backup_rtlwifi_driver.tar -+ @rm $(STAGINGMODDIR)/backup_rtlwifi_driver.tar -+endif -+ifneq (,$(wildcard $(MODDESTDIR)backup_rtlwifi_driver.tar)) -+ @tar xPf $(MODDESTDIR)backup_rtlwifi_driver.tar -+ @rm $(MODDESTDIR)backup_rtlwifi_driver.tar -+endif -+ifneq (,$(wildcard $(MODDESTDIR)../backup_rtlwifi_driver.tar)) -+ @tar xPf $(MODDESTDIR)../backup_rtlwifi_driver.tar -+ @rm $(MODDESTDIR)../backup_rtlwifi_driver.tar -+endif -+ @/sbin/depmod -a ${KVER} -+ @echo "Please reboot your system" -+ -+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 ; 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 --git a/drivers/net/wireless/rtl8821cs/clean b/drivers/net/wireless/rtl8821cs/clean -new file mode 100644 -index 000000000..87664218b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/clean -@@ -0,0 +1,5 @@ -+#!/bin/bash -+rmmod 8192cu -+rmmod 8192ce -+rmmod 8192du -+rmmod 8192de -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes-ccm.c b/drivers/net/wireless/rtl8821cs/core/crypto/aes-ccm.c -new file mode 100644 -index 000000000..6cee15fe9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes-ccm.c -@@ -0,0 +1,211 @@ -+/* -+ * Counter with CBC-MAC (CCM) with AES -+ * -+ * Copyright (c) 2010-2012, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+#include "aes.h" -+#include "aes_wrap.h" -+ -+ -+static void xor_aes_block(u8 *dst, const u8 *src) -+{ -+ u32 *d = (u32 *) dst; -+ u32 *s = (u32 *) src; -+ *d++ ^= *s++; -+ *d++ ^= *s++; -+ *d++ ^= *s++; -+ *d++ ^= *s++; -+} -+ -+ -+static void aes_ccm_auth_start(void *aes, size_t M, size_t L, const u8 *nonce, -+ const u8 *aad, size_t aad_len, size_t plain_len, -+ u8 *x) -+{ -+ u8 aad_buf[2 * AES_BLOCK_SIZE]; -+ u8 b[AES_BLOCK_SIZE]; -+ -+ /* Authentication */ -+ /* B_0: Flags | Nonce N | l(m) */ -+ b[0] = aad_len ? 0x40 : 0 /* Adata */; -+ b[0] |= (((M - 2) / 2) /* M' */ << 3); -+ b[0] |= (L - 1) /* L' */; -+ os_memcpy(&b[1], nonce, 15 - L); -+ WPA_PUT_BE16(&b[AES_BLOCK_SIZE - L], plain_len); -+ -+ wpa_hexdump_key(_MSG_EXCESSIVE_, "CCM B_0", b, AES_BLOCK_SIZE); -+ _aes_encrypt(aes, b, x); /* X_1 = E(K, B_0) */ -+ -+ if (!aad_len) -+ return; -+ -+ WPA_PUT_BE16(aad_buf, aad_len); -+ os_memcpy(aad_buf + 2, aad, aad_len); -+ os_memset(aad_buf + 2 + aad_len, 0, sizeof(aad_buf) - 2 - aad_len); -+ -+ xor_aes_block(aad_buf, x); -+ _aes_encrypt(aes, aad_buf, x); /* X_2 = E(K, X_1 XOR B_1) */ -+ -+ if (aad_len > AES_BLOCK_SIZE - 2) { -+ xor_aes_block(&aad_buf[AES_BLOCK_SIZE], x); -+ /* X_3 = E(K, X_2 XOR B_2) */ -+ _aes_encrypt(aes, &aad_buf[AES_BLOCK_SIZE], x); -+ } -+} -+ -+ -+static void aes_ccm_auth(void *aes, const u8 *data, size_t len, u8 *x) -+{ -+ size_t last = len % AES_BLOCK_SIZE; -+ size_t i; -+ -+ for (i = 0; i < len / AES_BLOCK_SIZE; i++) { -+ /* X_i+1 = E(K, X_i XOR B_i) */ -+ xor_aes_block(x, data); -+ data += AES_BLOCK_SIZE; -+ _aes_encrypt(aes, x, x); -+ } -+ if (last) { -+ /* XOR zero-padded last block */ -+ for (i = 0; i < last; i++) -+ x[i] ^= *data++; -+ _aes_encrypt(aes, x, x); -+ } -+} -+ -+ -+static void aes_ccm_encr_start(size_t L, const u8 *nonce, u8 *a) -+{ -+ /* A_i = Flags | Nonce N | Counter i */ -+ a[0] = L - 1; /* Flags = L' */ -+ os_memcpy(&a[1], nonce, 15 - L); -+} -+ -+ -+static void aes_ccm_encr(void *aes, size_t L, const u8 *in, size_t len, u8 *out, -+ u8 *a) -+{ -+ size_t last = len % AES_BLOCK_SIZE; -+ size_t i; -+ -+ /* crypt = msg XOR (S_1 | S_2 | ... | S_n) */ -+ for (i = 1; i <= len / AES_BLOCK_SIZE; i++) { -+ WPA_PUT_BE16(&a[AES_BLOCK_SIZE - 2], i); -+ /* S_i = E(K, A_i) */ -+ _aes_encrypt(aes, a, out); -+ xor_aes_block(out, in); -+ out += AES_BLOCK_SIZE; -+ in += AES_BLOCK_SIZE; -+ } -+ if (last) { -+ WPA_PUT_BE16(&a[AES_BLOCK_SIZE - 2], i); -+ _aes_encrypt(aes, a, out); -+ /* XOR zero-padded last block */ -+ for (i = 0; i < last; i++) -+ *out++ ^= *in++; -+ } -+} -+ -+ -+static void aes_ccm_encr_auth(void *aes, size_t M, u8 *x, u8 *a, u8 *auth) -+{ -+ size_t i; -+ u8 tmp[AES_BLOCK_SIZE]; -+ -+ wpa_hexdump_key(_MSG_EXCESSIVE_, "CCM T", x, M); -+ /* U = T XOR S_0; S_0 = E(K, A_0) */ -+ WPA_PUT_BE16(&a[AES_BLOCK_SIZE - 2], 0); -+ _aes_encrypt(aes, a, tmp); -+ for (i = 0; i < M; i++) -+ auth[i] = x[i] ^ tmp[i]; -+ wpa_hexdump_key(_MSG_EXCESSIVE_, "CCM U", auth, M); -+} -+ -+ -+static void aes_ccm_decr_auth(void *aes, size_t M, u8 *a, const u8 *auth, u8 *t) -+{ -+ size_t i; -+ u8 tmp[AES_BLOCK_SIZE]; -+ -+ wpa_hexdump_key(_MSG_EXCESSIVE_, "CCM U", auth, M); -+ /* U = T XOR S_0; S_0 = E(K, A_0) */ -+ WPA_PUT_BE16(&a[AES_BLOCK_SIZE - 2], 0); -+ _aes_encrypt(aes, a, tmp); -+ for (i = 0; i < M; i++) -+ t[i] = auth[i] ^ tmp[i]; -+ wpa_hexdump_key(_MSG_EXCESSIVE_, "CCM T", t, M); -+} -+ -+ -+/* AES-CCM with fixed L=2 and aad_len <= 30 assumption */ -+int aes_ccm_ae(const u8 *key, size_t key_len, const u8 *nonce, -+ size_t M, const u8 *plain, size_t plain_len, -+ const u8 *aad, size_t aad_len, u8 *crypt, u8 *auth) -+{ -+ const size_t L = 2; -+ void *aes; -+ u8 x[AES_BLOCK_SIZE], a[AES_BLOCK_SIZE]; -+ -+ if (aad_len > 30 || M > AES_BLOCK_SIZE) -+ return -1; -+ -+ aes = aes_encrypt_init(key, key_len); -+ if (aes == NULL) -+ return -1; -+ -+ aes_ccm_auth_start(aes, M, L, nonce, aad, aad_len, plain_len, x); -+ aes_ccm_auth(aes, plain, plain_len, x); -+ -+ /* Encryption */ -+ aes_ccm_encr_start(L, nonce, a); -+ aes_ccm_encr(aes, L, plain, plain_len, crypt, a); -+ aes_ccm_encr_auth(aes, M, x, a, auth); -+ -+ aes_encrypt_deinit(aes); -+ -+ return 0; -+} -+ -+ -+/* AES-CCM with fixed L=2 and aad_len <= 30 assumption */ -+int aes_ccm_ad(const u8 *key, size_t key_len, const u8 *nonce, -+ size_t M, const u8 *crypt, size_t crypt_len, -+ const u8 *aad, size_t aad_len, const u8 *auth, u8 *plain) -+{ -+ const size_t L = 2; -+ void *aes; -+ u8 x[AES_BLOCK_SIZE], a[AES_BLOCK_SIZE]; -+ u8 t[AES_BLOCK_SIZE]; -+ -+ if (aad_len > 30 || M > AES_BLOCK_SIZE) -+ return -1; -+ -+ aes = aes_encrypt_init(key, key_len); -+ if (aes == NULL) -+ return -1; -+ -+ /* Decryption */ -+ aes_ccm_encr_start(L, nonce, a); -+ aes_ccm_decr_auth(aes, M, a, auth, t); -+ -+ /* plaintext = msg XOR (S_1 | S_2 | ... | S_n) */ -+ aes_ccm_encr(aes, L, crypt, crypt_len, plain, a); -+ -+ aes_ccm_auth_start(aes, M, L, nonce, aad, aad_len, crypt_len, x); -+ aes_ccm_auth(aes, plain, crypt_len, x); -+ -+ aes_encrypt_deinit(aes); -+ -+ if (os_memcmp_const(x, t, M) != 0) { -+ wpa_printf(_MSG_EXCESSIVE_, "CCM: Auth mismatch"); -+ return -1; -+ } -+ -+ return 0; -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes-ctr.c b/drivers/net/wireless/rtl8821cs/core/crypto/aes-ctr.c -new file mode 100644 -index 000000000..e29650c84 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes-ctr.c -@@ -0,0 +1,70 @@ -+/* -+ * AES-128/192/256 CTR -+ * -+ * Copyright (c) 2003-2007, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+#include "aes.h" -+#include "aes_wrap.h" -+ -+/** -+ * aes_ctr_encrypt - AES-128/192/256 CTR mode encryption -+ * @key: Key for encryption (key_len bytes) -+ * @key_len: Length of the key (16, 24, or 32 bytes) -+ * @nonce: Nonce for counter mode (16 bytes) -+ * @data: Data to encrypt in-place -+ * @data_len: Length of data in bytes -+ * Returns: 0 on success, -1 on failure -+ */ -+int aes_ctr_encrypt(const u8 *key, size_t key_len, const u8 *nonce, -+ u8 *data, size_t data_len) -+{ -+ void *ctx; -+ size_t j, len, left = data_len; -+ int i; -+ u8 *pos = data; -+ u8 counter[AES_BLOCK_SIZE], buf[AES_BLOCK_SIZE]; -+ -+ ctx = aes_encrypt_init(key, key_len); -+ if (ctx == NULL) -+ return -1; -+ os_memcpy(counter, nonce, AES_BLOCK_SIZE); -+ -+ while (left > 0) { -+ _aes_encrypt(ctx, counter, buf); -+ -+ len = (left < AES_BLOCK_SIZE) ? left : AES_BLOCK_SIZE; -+ for (j = 0; j < len; j++) -+ pos[j] ^= buf[j]; -+ pos += len; -+ left -= len; -+ -+ for (i = AES_BLOCK_SIZE - 1; i >= 0; i--) { -+ counter[i]++; -+ if (counter[i]) -+ break; -+ } -+ } -+ aes_encrypt_deinit(ctx); -+ return 0; -+} -+ -+ -+/** -+ * aes_128_ctr_encrypt - AES-128 CTR mode encryption -+ * @key: Key for encryption (key_len bytes) -+ * @nonce: Nonce for counter mode (16 bytes) -+ * @data: Data to encrypt in-place -+ * @data_len: Length of data in bytes -+ * Returns: 0 on success, -1 on failure -+ */ -+int aes_128_ctr_encrypt(const u8 *key, const u8 *nonce, -+ u8 *data, size_t data_len) -+{ -+ return aes_ctr_encrypt(key, 16, nonce, data, data_len); -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes-gcm.c b/drivers/net/wireless/rtl8821cs/core/crypto/aes-gcm.c -new file mode 100644 -index 000000000..214c194fd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes-gcm.c -@@ -0,0 +1,326 @@ -+/* -+ * Galois/Counter Mode (GCM) and GMAC with AES -+ * -+ * Copyright (c) 2012, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+#include "aes.h" -+#include "aes_wrap.h" -+ -+static void inc32(u8 *block) -+{ -+ u32 val; -+ val = WPA_GET_BE32(block + AES_BLOCK_SIZE - 4); -+ val++; -+ WPA_PUT_BE32(block + AES_BLOCK_SIZE - 4, val); -+} -+ -+ -+static void xor_block(u8 *dst, const u8 *src) -+{ -+ u32 *d = (u32 *) dst; -+ u32 *s = (u32 *) src; -+ *d++ ^= *s++; -+ *d++ ^= *s++; -+ *d++ ^= *s++; -+ *d++ ^= *s++; -+} -+ -+ -+static void shift_right_block(u8 *v) -+{ -+ u32 val; -+ -+ val = WPA_GET_BE32(v + 12); -+ val >>= 1; -+ if (v[11] & 0x01) -+ val |= 0x80000000; -+ WPA_PUT_BE32(v + 12, val); -+ -+ val = WPA_GET_BE32(v + 8); -+ val >>= 1; -+ if (v[7] & 0x01) -+ val |= 0x80000000; -+ WPA_PUT_BE32(v + 8, val); -+ -+ val = WPA_GET_BE32(v + 4); -+ val >>= 1; -+ if (v[3] & 0x01) -+ val |= 0x80000000; -+ WPA_PUT_BE32(v + 4, val); -+ -+ val = WPA_GET_BE32(v); -+ val >>= 1; -+ WPA_PUT_BE32(v, val); -+} -+ -+ -+/* Multiplication in GF(2^128) */ -+static void gf_mult(const u8 *x, const u8 *y, u8 *z) -+{ -+ u8 v[16]; -+ int i, j; -+ -+ os_memset(z, 0, 16); /* Z_0 = 0^128 */ -+ os_memcpy(v, y, 16); /* V_0 = Y */ -+ -+ for (i = 0; i < 16; i++) { -+ for (j = 0; j < 8; j++) { -+ if (x[i] & BIT(7 - j)) { -+ /* Z_(i + 1) = Z_i XOR V_i */ -+ xor_block(z, v); -+ } else { -+ /* Z_(i + 1) = Z_i */ -+ } -+ -+ if (v[15] & 0x01) { -+ /* V_(i + 1) = (V_i >> 1) XOR R */ -+ shift_right_block(v); -+ /* R = 11100001 || 0^120 */ -+ v[0] ^= 0xe1; -+ } else { -+ /* V_(i + 1) = V_i >> 1 */ -+ shift_right_block(v); -+ } -+ } -+ } -+} -+ -+ -+static void ghash_start(u8 *y) -+{ -+ /* Y_0 = 0^128 */ -+ os_memset(y, 0, 16); -+} -+ -+ -+static void ghash(const u8 *h, const u8 *x, size_t xlen, u8 *y) -+{ -+ size_t m, i; -+ const u8 *xpos = x; -+ u8 tmp[16]; -+ -+ m = xlen / 16; -+ -+ for (i = 0; i < m; i++) { -+ /* Y_i = (Y^(i-1) XOR X_i) dot H */ -+ xor_block(y, xpos); -+ xpos += 16; -+ -+ /* dot operation: -+ * multiplication operation for binary Galois (finite) field of -+ * 2^128 elements */ -+ gf_mult(y, h, tmp); -+ os_memcpy(y, tmp, 16); -+ } -+ -+ if (x + xlen > xpos) { -+ /* Add zero padded last block */ -+ size_t last = x + xlen - xpos; -+ os_memcpy(tmp, xpos, last); -+ os_memset(tmp + last, 0, sizeof(tmp) - last); -+ -+ /* Y_i = (Y^(i-1) XOR X_i) dot H */ -+ xor_block(y, tmp); -+ -+ /* dot operation: -+ * multiplication operation for binary Galois (finite) field of -+ * 2^128 elements */ -+ gf_mult(y, h, tmp); -+ os_memcpy(y, tmp, 16); -+ } -+ -+ /* Return Y_m */ -+} -+ -+ -+static void aes_gctr(void *aes, const u8 *icb, const u8 *x, size_t xlen, u8 *y) -+{ -+ size_t i, n, last; -+ u8 cb[AES_BLOCK_SIZE], tmp[AES_BLOCK_SIZE]; -+ const u8 *xpos = x; -+ u8 *ypos = y; -+ -+ if (xlen == 0) -+ return; -+ -+ n = xlen / 16; -+ -+ os_memcpy(cb, icb, AES_BLOCK_SIZE); -+ /* Full blocks */ -+ for (i = 0; i < n; i++) { -+ _aes_encrypt(aes, cb, ypos); -+ xor_block(ypos, xpos); -+ xpos += AES_BLOCK_SIZE; -+ ypos += AES_BLOCK_SIZE; -+ inc32(cb); -+ } -+ -+ last = x + xlen - xpos; -+ if (last) { -+ /* Last, partial block */ -+ _aes_encrypt(aes, cb, tmp); -+ for (i = 0; i < last; i++) -+ *ypos++ = *xpos++ ^ tmp[i]; -+ } -+} -+ -+ -+static void * aes_gcm_init_hash_subkey(const u8 *key, size_t key_len, u8 *H) -+{ -+ void *aes; -+ -+ aes = aes_encrypt_init(key, key_len); -+ if (aes == NULL) -+ return NULL; -+ -+ /* Generate hash subkey H = AES_K(0^128) */ -+ os_memset(H, 0, AES_BLOCK_SIZE); -+ _aes_encrypt(aes, H, H); -+ wpa_hexdump_key(_MSG_EXCESSIVE_, "Hash subkey H for GHASH", -+ H, AES_BLOCK_SIZE); -+ return aes; -+} -+ -+ -+static void aes_gcm_prepare_j0(const u8 *iv, size_t iv_len, const u8 *H, u8 *J0) -+{ -+ u8 len_buf[16]; -+ -+ if (iv_len == 12) { -+ /* Prepare block J_0 = IV || 0^31 || 1 [len(IV) = 96] */ -+ os_memcpy(J0, iv, iv_len); -+ os_memset(J0 + iv_len, 0, AES_BLOCK_SIZE - iv_len); -+ J0[AES_BLOCK_SIZE - 1] = 0x01; -+ } else { -+ /* -+ * s = 128 * ceil(len(IV)/128) - len(IV) -+ * J_0 = GHASH_H(IV || 0^(s+64) || [len(IV)]_64) -+ */ -+ ghash_start(J0); -+ ghash(H, iv, iv_len, J0); -+ WPA_PUT_BE64(len_buf, 0); -+ WPA_PUT_BE64(len_buf + 8, iv_len * 8); -+ ghash(H, len_buf, sizeof(len_buf), J0); -+ } -+} -+ -+ -+static void aes_gcm_gctr(void *aes, const u8 *J0, const u8 *in, size_t len, -+ u8 *out) -+{ -+ u8 J0inc[AES_BLOCK_SIZE]; -+ -+ if (len == 0) -+ return; -+ -+ os_memcpy(J0inc, J0, AES_BLOCK_SIZE); -+ inc32(J0inc); -+ aes_gctr(aes, J0inc, in, len, out); -+} -+ -+ -+static void aes_gcm_ghash(const u8 *H, const u8 *aad, size_t aad_len, -+ const u8 *crypt, size_t crypt_len, u8 *S) -+{ -+ u8 len_buf[16]; -+ -+ /* -+ * u = 128 * ceil[len(C)/128] - len(C) -+ * v = 128 * ceil[len(A)/128] - len(A) -+ * S = GHASH_H(A || 0^v || C || 0^u || [len(A)]64 || [len(C)]64) -+ * (i.e., zero padded to block size A || C and lengths of each in bits) -+ */ -+ ghash_start(S); -+ ghash(H, aad, aad_len, S); -+ ghash(H, crypt, crypt_len, S); -+ WPA_PUT_BE64(len_buf, aad_len * 8); -+ WPA_PUT_BE64(len_buf + 8, crypt_len * 8); -+ ghash(H, len_buf, sizeof(len_buf), S); -+ -+ wpa_hexdump_key(_MSG_EXCESSIVE_, "S = GHASH_H(...)", S, 16); -+} -+ -+ -+/** -+ * aes_gcm_ae - GCM-AE_K(IV, P, A) -+ */ -+int aes_gcm_ae(const u8 *key, size_t key_len, const u8 *iv, size_t iv_len, -+ const u8 *plain, size_t plain_len, -+ const u8 *aad, size_t aad_len, u8 *crypt, u8 *tag) -+{ -+ u8 H[AES_BLOCK_SIZE]; -+ u8 J0[AES_BLOCK_SIZE]; -+ u8 S[16]; -+ void *aes; -+ -+ aes = aes_gcm_init_hash_subkey(key, key_len, H); -+ if (aes == NULL) -+ return -1; -+ -+ aes_gcm_prepare_j0(iv, iv_len, H, J0); -+ -+ /* C = GCTR_K(inc_32(J_0), P) */ -+ aes_gcm_gctr(aes, J0, plain, plain_len, crypt); -+ -+ aes_gcm_ghash(H, aad, aad_len, crypt, plain_len, S); -+ -+ /* T = MSB_t(GCTR_K(J_0, S)) */ -+ aes_gctr(aes, J0, S, sizeof(S), tag); -+ -+ /* Return (C, T) */ -+ -+ aes_encrypt_deinit(aes); -+ -+ return 0; -+} -+ -+ -+/** -+ * aes_gcm_ad - GCM-AD_K(IV, C, A, T) -+ */ -+int aes_gcm_ad(const u8 *key, size_t key_len, const u8 *iv, size_t iv_len, -+ const u8 *crypt, size_t crypt_len, -+ const u8 *aad, size_t aad_len, const u8 *tag, u8 *plain) -+{ -+ u8 H[AES_BLOCK_SIZE]; -+ u8 J0[AES_BLOCK_SIZE]; -+ u8 S[16], T[16]; -+ void *aes; -+ -+ aes = aes_gcm_init_hash_subkey(key, key_len, H); -+ if (aes == NULL) -+ return -1; -+ -+ aes_gcm_prepare_j0(iv, iv_len, H, J0); -+ -+ /* P = GCTR_K(inc_32(J_0), C) */ -+ aes_gcm_gctr(aes, J0, crypt, crypt_len, plain); -+ -+ aes_gcm_ghash(H, aad, aad_len, crypt, crypt_len, S); -+ -+ /* T' = MSB_t(GCTR_K(J_0, S)) */ -+ aes_gctr(aes, J0, S, sizeof(S), T); -+ -+ aes_encrypt_deinit(aes); -+ -+ if (os_memcmp_const(tag, T, 16) != 0) { -+ wpa_printf(_MSG_EXCESSIVE_, "GCM: Tag mismatch"); -+ return -1; -+ } -+ -+ return 0; -+} -+ -+ -+int aes_gmac(const u8 *key, size_t key_len, const u8 *iv, size_t iv_len, -+ const u8 *aad, size_t aad_len, u8 *tag) -+{ -+ return aes_gcm_ae(key, key_len, iv, iv_len, NULL, 0, aad, aad_len, NULL, -+ tag); -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes-internal-enc.c b/drivers/net/wireless/rtl8821cs/core/crypto/aes-internal-enc.c -new file mode 100644 -index 000000000..a9c75d87e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes-internal-enc.c -@@ -0,0 +1,129 @@ -+/* -+ * AES (Rijndael) cipher - encrypt -+ * -+ * Modifications to public domain implementation: -+ * - cleanup -+ * - use C pre-processor to make it easier to change S table access -+ * - added option (AES_SMALL_TABLES) for reducing code size by about 8 kB at -+ * cost of reduced throughput (quite small difference on Pentium 4, -+ * 10-25% when using -O1 or -O2 optimization) -+ * -+ * Copyright (c) 2003-2012, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+#include "aes_i.h" -+ -+static void rijndaelEncrypt(const u32 rk[], int Nr, const u8 pt[16], u8 ct[16]) -+{ -+ u32 s0, s1, s2, s3, t0, t1, t2, t3; -+#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) \ -+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] -+ -+#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); -+ if (Nr > 10) { -+ ROUND(10,s,t); -+ ROUND(11,t,s); -+ if (Nr > 12) { -+ ROUND(12,s,t); -+ ROUND(13,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); -+} -+ -+ -+void * aes_encrypt_init(const u8 *key, size_t len) -+{ -+ u32 *rk; -+ int res; -+ -+ if (TEST_FAIL()) -+ return NULL; -+ -+ rk = os_malloc(AES_PRIV_SIZE); -+ if (rk == NULL) -+ return NULL; -+ res = rijndaelKeySetupEnc(rk, key, len * 8); -+ if (res < 0) { -+ rtw_mfree(rk, AES_PRIV_SIZE); -+ return NULL; -+ } -+ rk[AES_PRIV_NR_POS] = res; -+ return rk; -+} -+ -+ -+int _aes_encrypt(void *ctx, const u8 *plain, u8 *crypt) -+{ -+ u32 *rk = ctx; -+ rijndaelEncrypt(ctx, rk[AES_PRIV_NR_POS], plain, crypt); -+ return 0; -+} -+ -+ -+void aes_encrypt_deinit(void *ctx) -+{ -+ os_memset(ctx, 0, AES_PRIV_SIZE); -+ rtw_mfree(ctx, AES_PRIV_SIZE); -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes-internal.c b/drivers/net/wireless/rtl8821cs/core/crypto/aes-internal.c -new file mode 100644 -index 000000000..57d653949 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes-internal.c -@@ -0,0 +1,843 @@ -+/* -+ * AES (Rijndael) cipher -+ * -+ * Modifications to public domain implementation: -+ * - cleanup -+ * - use C pre-processor to make it easier to change S table access -+ * - added option (AES_SMALL_TABLES) for reducing code size by about 8 kB at -+ * cost of reduced throughput (quite small difference on Pentium 4, -+ * 10-25% when using -O1 or -O2 optimization) -+ * -+ * Copyright (c) 2003-2012, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+#include "aes_i.h" -+ -+/* -+ * rijndael-alg-fst.c -+ * -+ * @version 3.0 (December 2000) -+ * -+ * Optimised ANSI C code for the Rijndael cipher (now AES) -+ * -+ * @author Vincent Rijmen -+ * @author Antoon Bosselaers -+ * @author Paulo Barreto -+ * -+ * This code is hereby placed in the public domain. -+ * -+ * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ''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 AUTHORS 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. -+ */ -+ -+ -+/* -+Te0[x] = S [x].[02, 01, 01, 03]; -+Te1[x] = S [x].[03, 02, 01, 01]; -+Te2[x] = S [x].[01, 03, 02, 01]; -+Te3[x] = S [x].[01, 01, 03, 02]; -+Te4[x] = S [x].[01, 01, 01, 01]; -+ -+Td0[x] = Si[x].[0e, 09, 0d, 0b]; -+Td1[x] = Si[x].[0b, 0e, 09, 0d]; -+Td2[x] = Si[x].[0d, 0b, 0e, 09]; -+Td3[x] = Si[x].[09, 0d, 0b, 0e]; -+Td4[x] = Si[x].[01, 01, 01, 01]; -+*/ -+ -+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, -+}; -+#ifndef AES_SMALL_TABLES -+const u32 Te1[256] = { -+ 0xa5c66363U, 0x84f87c7cU, 0x99ee7777U, 0x8df67b7bU, -+ 0x0dfff2f2U, 0xbdd66b6bU, 0xb1de6f6fU, 0x5491c5c5U, -+ 0x50603030U, 0x03020101U, 0xa9ce6767U, 0x7d562b2bU, -+ 0x19e7fefeU, 0x62b5d7d7U, 0xe64dababU, 0x9aec7676U, -+ 0x458fcacaU, 0x9d1f8282U, 0x4089c9c9U, 0x87fa7d7dU, -+ 0x15effafaU, 0xebb25959U, 0xc98e4747U, 0x0bfbf0f0U, -+ 0xec41adadU, 0x67b3d4d4U, 0xfd5fa2a2U, 0xea45afafU, -+ 0xbf239c9cU, 0xf753a4a4U, 0x96e47272U, 0x5b9bc0c0U, -+ 0xc275b7b7U, 0x1ce1fdfdU, 0xae3d9393U, 0x6a4c2626U, -+ 0x5a6c3636U, 0x417e3f3fU, 0x02f5f7f7U, 0x4f83ccccU, -+ 0x5c683434U, 0xf451a5a5U, 0x34d1e5e5U, 0x08f9f1f1U, -+ 0x93e27171U, 0x73abd8d8U, 0x53623131U, 0x3f2a1515U, -+ 0x0c080404U, 0x5295c7c7U, 0x65462323U, 0x5e9dc3c3U, -+ 0x28301818U, 0xa1379696U, 0x0f0a0505U, 0xb52f9a9aU, -+ 0x090e0707U, 0x36241212U, 0x9b1b8080U, 0x3ddfe2e2U, -+ 0x26cdebebU, 0x694e2727U, 0xcd7fb2b2U, 0x9fea7575U, -+ 0x1b120909U, 0x9e1d8383U, 0x74582c2cU, 0x2e341a1aU, -+ 0x2d361b1bU, 0xb2dc6e6eU, 0xeeb45a5aU, 0xfb5ba0a0U, -+ 0xf6a45252U, 0x4d763b3bU, 0x61b7d6d6U, 0xce7db3b3U, -+ 0x7b522929U, 0x3edde3e3U, 0x715e2f2fU, 0x97138484U, -+ 0xf5a65353U, 0x68b9d1d1U, 0x00000000U, 0x2cc1ededU, -+ 0x60402020U, 0x1fe3fcfcU, 0xc879b1b1U, 0xedb65b5bU, -+ 0xbed46a6aU, 0x468dcbcbU, 0xd967bebeU, 0x4b723939U, -+ 0xde944a4aU, 0xd4984c4cU, 0xe8b05858U, 0x4a85cfcfU, -+ 0x6bbbd0d0U, 0x2ac5efefU, 0xe54faaaaU, 0x16edfbfbU, -+ 0xc5864343U, 0xd79a4d4dU, 0x55663333U, 0x94118585U, -+ 0xcf8a4545U, 0x10e9f9f9U, 0x06040202U, 0x81fe7f7fU, -+ 0xf0a05050U, 0x44783c3cU, 0xba259f9fU, 0xe34ba8a8U, -+ 0xf3a25151U, 0xfe5da3a3U, 0xc0804040U, 0x8a058f8fU, -+ 0xad3f9292U, 0xbc219d9dU, 0x48703838U, 0x04f1f5f5U, -+ 0xdf63bcbcU, 0xc177b6b6U, 0x75afdadaU, 0x63422121U, -+ 0x30201010U, 0x1ae5ffffU, 0x0efdf3f3U, 0x6dbfd2d2U, -+ 0x4c81cdcdU, 0x14180c0cU, 0x35261313U, 0x2fc3ececU, -+ 0xe1be5f5fU, 0xa2359797U, 0xcc884444U, 0x392e1717U, -+ 0x5793c4c4U, 0xf255a7a7U, 0x82fc7e7eU, 0x477a3d3dU, -+ 0xacc86464U, 0xe7ba5d5dU, 0x2b321919U, 0x95e67373U, -+ 0xa0c06060U, 0x98198181U, 0xd19e4f4fU, 0x7fa3dcdcU, -+ 0x66442222U, 0x7e542a2aU, 0xab3b9090U, 0x830b8888U, -+ 0xca8c4646U, 0x29c7eeeeU, 0xd36bb8b8U, 0x3c281414U, -+ 0x79a7dedeU, 0xe2bc5e5eU, 0x1d160b0bU, 0x76addbdbU, -+ 0x3bdbe0e0U, 0x56643232U, 0x4e743a3aU, 0x1e140a0aU, -+ 0xdb924949U, 0x0a0c0606U, 0x6c482424U, 0xe4b85c5cU, -+ 0x5d9fc2c2U, 0x6ebdd3d3U, 0xef43acacU, 0xa6c46262U, -+ 0xa8399191U, 0xa4319595U, 0x37d3e4e4U, 0x8bf27979U, -+ 0x32d5e7e7U, 0x438bc8c8U, 0x596e3737U, 0xb7da6d6dU, -+ 0x8c018d8dU, 0x64b1d5d5U, 0xd29c4e4eU, 0xe049a9a9U, -+ 0xb4d86c6cU, 0xfaac5656U, 0x07f3f4f4U, 0x25cfeaeaU, -+ 0xafca6565U, 0x8ef47a7aU, 0xe947aeaeU, 0x18100808U, -+ 0xd56fbabaU, 0x88f07878U, 0x6f4a2525U, 0x725c2e2eU, -+ 0x24381c1cU, 0xf157a6a6U, 0xc773b4b4U, 0x5197c6c6U, -+ 0x23cbe8e8U, 0x7ca1ddddU, 0x9ce87474U, 0x213e1f1fU, -+ 0xdd964b4bU, 0xdc61bdbdU, 0x860d8b8bU, 0x850f8a8aU, -+ 0x90e07070U, 0x427c3e3eU, 0xc471b5b5U, 0xaacc6666U, -+ 0xd8904848U, 0x05060303U, 0x01f7f6f6U, 0x121c0e0eU, -+ 0xa3c26161U, 0x5f6a3535U, 0xf9ae5757U, 0xd069b9b9U, -+ 0x91178686U, 0x5899c1c1U, 0x273a1d1dU, 0xb9279e9eU, -+ 0x38d9e1e1U, 0x13ebf8f8U, 0xb32b9898U, 0x33221111U, -+ 0xbbd26969U, 0x70a9d9d9U, 0x89078e8eU, 0xa7339494U, -+ 0xb62d9b9bU, 0x223c1e1eU, 0x92158787U, 0x20c9e9e9U, -+ 0x4987ceceU, 0xffaa5555U, 0x78502828U, 0x7aa5dfdfU, -+ 0x8f038c8cU, 0xf859a1a1U, 0x80098989U, 0x171a0d0dU, -+ 0xda65bfbfU, 0x31d7e6e6U, 0xc6844242U, 0xb8d06868U, -+ 0xc3824141U, 0xb0299999U, 0x775a2d2dU, 0x111e0f0fU, -+ 0xcb7bb0b0U, 0xfca85454U, 0xd66dbbbbU, 0x3a2c1616U, -+}; -+const u32 Te2[256] = { -+ 0x63a5c663U, 0x7c84f87cU, 0x7799ee77U, 0x7b8df67bU, -+ 0xf20dfff2U, 0x6bbdd66bU, 0x6fb1de6fU, 0xc55491c5U, -+ 0x30506030U, 0x01030201U, 0x67a9ce67U, 0x2b7d562bU, -+ 0xfe19e7feU, 0xd762b5d7U, 0xabe64dabU, 0x769aec76U, -+ 0xca458fcaU, 0x829d1f82U, 0xc94089c9U, 0x7d87fa7dU, -+ 0xfa15effaU, 0x59ebb259U, 0x47c98e47U, 0xf00bfbf0U, -+ 0xadec41adU, 0xd467b3d4U, 0xa2fd5fa2U, 0xafea45afU, -+ 0x9cbf239cU, 0xa4f753a4U, 0x7296e472U, 0xc05b9bc0U, -+ 0xb7c275b7U, 0xfd1ce1fdU, 0x93ae3d93U, 0x266a4c26U, -+ 0x365a6c36U, 0x3f417e3fU, 0xf702f5f7U, 0xcc4f83ccU, -+ 0x345c6834U, 0xa5f451a5U, 0xe534d1e5U, 0xf108f9f1U, -+ 0x7193e271U, 0xd873abd8U, 0x31536231U, 0x153f2a15U, -+ 0x040c0804U, 0xc75295c7U, 0x23654623U, 0xc35e9dc3U, -+ 0x18283018U, 0x96a13796U, 0x050f0a05U, 0x9ab52f9aU, -+ 0x07090e07U, 0x12362412U, 0x809b1b80U, 0xe23ddfe2U, -+ 0xeb26cdebU, 0x27694e27U, 0xb2cd7fb2U, 0x759fea75U, -+ 0x091b1209U, 0x839e1d83U, 0x2c74582cU, 0x1a2e341aU, -+ 0x1b2d361bU, 0x6eb2dc6eU, 0x5aeeb45aU, 0xa0fb5ba0U, -+ 0x52f6a452U, 0x3b4d763bU, 0xd661b7d6U, 0xb3ce7db3U, -+ 0x297b5229U, 0xe33edde3U, 0x2f715e2fU, 0x84971384U, -+ 0x53f5a653U, 0xd168b9d1U, 0x00000000U, 0xed2cc1edU, -+ 0x20604020U, 0xfc1fe3fcU, 0xb1c879b1U, 0x5bedb65bU, -+ 0x6abed46aU, 0xcb468dcbU, 0xbed967beU, 0x394b7239U, -+ 0x4ade944aU, 0x4cd4984cU, 0x58e8b058U, 0xcf4a85cfU, -+ 0xd06bbbd0U, 0xef2ac5efU, 0xaae54faaU, 0xfb16edfbU, -+ 0x43c58643U, 0x4dd79a4dU, 0x33556633U, 0x85941185U, -+ 0x45cf8a45U, 0xf910e9f9U, 0x02060402U, 0x7f81fe7fU, -+ 0x50f0a050U, 0x3c44783cU, 0x9fba259fU, 0xa8e34ba8U, -+ 0x51f3a251U, 0xa3fe5da3U, 0x40c08040U, 0x8f8a058fU, -+ 0x92ad3f92U, 0x9dbc219dU, 0x38487038U, 0xf504f1f5U, -+ 0xbcdf63bcU, 0xb6c177b6U, 0xda75afdaU, 0x21634221U, -+ 0x10302010U, 0xff1ae5ffU, 0xf30efdf3U, 0xd26dbfd2U, -+ 0xcd4c81cdU, 0x0c14180cU, 0x13352613U, 0xec2fc3ecU, -+ 0x5fe1be5fU, 0x97a23597U, 0x44cc8844U, 0x17392e17U, -+ 0xc45793c4U, 0xa7f255a7U, 0x7e82fc7eU, 0x3d477a3dU, -+ 0x64acc864U, 0x5de7ba5dU, 0x192b3219U, 0x7395e673U, -+ 0x60a0c060U, 0x81981981U, 0x4fd19e4fU, 0xdc7fa3dcU, -+ 0x22664422U, 0x2a7e542aU, 0x90ab3b90U, 0x88830b88U, -+ 0x46ca8c46U, 0xee29c7eeU, 0xb8d36bb8U, 0x143c2814U, -+ 0xde79a7deU, 0x5ee2bc5eU, 0x0b1d160bU, 0xdb76addbU, -+ 0xe03bdbe0U, 0x32566432U, 0x3a4e743aU, 0x0a1e140aU, -+ 0x49db9249U, 0x060a0c06U, 0x246c4824U, 0x5ce4b85cU, -+ 0xc25d9fc2U, 0xd36ebdd3U, 0xacef43acU, 0x62a6c462U, -+ 0x91a83991U, 0x95a43195U, 0xe437d3e4U, 0x798bf279U, -+ 0xe732d5e7U, 0xc8438bc8U, 0x37596e37U, 0x6db7da6dU, -+ 0x8d8c018dU, 0xd564b1d5U, 0x4ed29c4eU, 0xa9e049a9U, -+ 0x6cb4d86cU, 0x56faac56U, 0xf407f3f4U, 0xea25cfeaU, -+ 0x65afca65U, 0x7a8ef47aU, 0xaee947aeU, 0x08181008U, -+ 0xbad56fbaU, 0x7888f078U, 0x256f4a25U, 0x2e725c2eU, -+ 0x1c24381cU, 0xa6f157a6U, 0xb4c773b4U, 0xc65197c6U, -+ 0xe823cbe8U, 0xdd7ca1ddU, 0x749ce874U, 0x1f213e1fU, -+ 0x4bdd964bU, 0xbddc61bdU, 0x8b860d8bU, 0x8a850f8aU, -+ 0x7090e070U, 0x3e427c3eU, 0xb5c471b5U, 0x66aacc66U, -+ 0x48d89048U, 0x03050603U, 0xf601f7f6U, 0x0e121c0eU, -+ 0x61a3c261U, 0x355f6a35U, 0x57f9ae57U, 0xb9d069b9U, -+ 0x86911786U, 0xc15899c1U, 0x1d273a1dU, 0x9eb9279eU, -+ 0xe138d9e1U, 0xf813ebf8U, 0x98b32b98U, 0x11332211U, -+ 0x69bbd269U, 0xd970a9d9U, 0x8e89078eU, 0x94a73394U, -+ 0x9bb62d9bU, 0x1e223c1eU, 0x87921587U, 0xe920c9e9U, -+ 0xce4987ceU, 0x55ffaa55U, 0x28785028U, 0xdf7aa5dfU, -+ 0x8c8f038cU, 0xa1f859a1U, 0x89800989U, 0x0d171a0dU, -+ 0xbfda65bfU, 0xe631d7e6U, 0x42c68442U, 0x68b8d068U, -+ 0x41c38241U, 0x99b02999U, 0x2d775a2dU, 0x0f111e0fU, -+ 0xb0cb7bb0U, 0x54fca854U, 0xbbd66dbbU, 0x163a2c16U, -+}; -+const u32 Te3[256] = { -+ -+ 0x6363a5c6U, 0x7c7c84f8U, 0x777799eeU, 0x7b7b8df6U, -+ 0xf2f20dffU, 0x6b6bbdd6U, 0x6f6fb1deU, 0xc5c55491U, -+ 0x30305060U, 0x01010302U, 0x6767a9ceU, 0x2b2b7d56U, -+ 0xfefe19e7U, 0xd7d762b5U, 0xababe64dU, 0x76769aecU, -+ 0xcaca458fU, 0x82829d1fU, 0xc9c94089U, 0x7d7d87faU, -+ 0xfafa15efU, 0x5959ebb2U, 0x4747c98eU, 0xf0f00bfbU, -+ 0xadadec41U, 0xd4d467b3U, 0xa2a2fd5fU, 0xafafea45U, -+ 0x9c9cbf23U, 0xa4a4f753U, 0x727296e4U, 0xc0c05b9bU, -+ 0xb7b7c275U, 0xfdfd1ce1U, 0x9393ae3dU, 0x26266a4cU, -+ 0x36365a6cU, 0x3f3f417eU, 0xf7f702f5U, 0xcccc4f83U, -+ 0x34345c68U, 0xa5a5f451U, 0xe5e534d1U, 0xf1f108f9U, -+ 0x717193e2U, 0xd8d873abU, 0x31315362U, 0x15153f2aU, -+ 0x04040c08U, 0xc7c75295U, 0x23236546U, 0xc3c35e9dU, -+ 0x18182830U, 0x9696a137U, 0x05050f0aU, 0x9a9ab52fU, -+ 0x0707090eU, 0x12123624U, 0x80809b1bU, 0xe2e23ddfU, -+ 0xebeb26cdU, 0x2727694eU, 0xb2b2cd7fU, 0x75759feaU, -+ 0x09091b12U, 0x83839e1dU, 0x2c2c7458U, 0x1a1a2e34U, -+ 0x1b1b2d36U, 0x6e6eb2dcU, 0x5a5aeeb4U, 0xa0a0fb5bU, -+ 0x5252f6a4U, 0x3b3b4d76U, 0xd6d661b7U, 0xb3b3ce7dU, -+ 0x29297b52U, 0xe3e33eddU, 0x2f2f715eU, 0x84849713U, -+ 0x5353f5a6U, 0xd1d168b9U, 0x00000000U, 0xeded2cc1U, -+ 0x20206040U, 0xfcfc1fe3U, 0xb1b1c879U, 0x5b5bedb6U, -+ 0x6a6abed4U, 0xcbcb468dU, 0xbebed967U, 0x39394b72U, -+ 0x4a4ade94U, 0x4c4cd498U, 0x5858e8b0U, 0xcfcf4a85U, -+ 0xd0d06bbbU, 0xefef2ac5U, 0xaaaae54fU, 0xfbfb16edU, -+ 0x4343c586U, 0x4d4dd79aU, 0x33335566U, 0x85859411U, -+ 0x4545cf8aU, 0xf9f910e9U, 0x02020604U, 0x7f7f81feU, -+ 0x5050f0a0U, 0x3c3c4478U, 0x9f9fba25U, 0xa8a8e34bU, -+ 0x5151f3a2U, 0xa3a3fe5dU, 0x4040c080U, 0x8f8f8a05U, -+ 0x9292ad3fU, 0x9d9dbc21U, 0x38384870U, 0xf5f504f1U, -+ 0xbcbcdf63U, 0xb6b6c177U, 0xdada75afU, 0x21216342U, -+ 0x10103020U, 0xffff1ae5U, 0xf3f30efdU, 0xd2d26dbfU, -+ 0xcdcd4c81U, 0x0c0c1418U, 0x13133526U, 0xecec2fc3U, -+ 0x5f5fe1beU, 0x9797a235U, 0x4444cc88U, 0x1717392eU, -+ 0xc4c45793U, 0xa7a7f255U, 0x7e7e82fcU, 0x3d3d477aU, -+ 0x6464acc8U, 0x5d5de7baU, 0x19192b32U, 0x737395e6U, -+ 0x6060a0c0U, 0x81819819U, 0x4f4fd19eU, 0xdcdc7fa3U, -+ 0x22226644U, 0x2a2a7e54U, 0x9090ab3bU, 0x8888830bU, -+ 0x4646ca8cU, 0xeeee29c7U, 0xb8b8d36bU, 0x14143c28U, -+ 0xdede79a7U, 0x5e5ee2bcU, 0x0b0b1d16U, 0xdbdb76adU, -+ 0xe0e03bdbU, 0x32325664U, 0x3a3a4e74U, 0x0a0a1e14U, -+ 0x4949db92U, 0x06060a0cU, 0x24246c48U, 0x5c5ce4b8U, -+ 0xc2c25d9fU, 0xd3d36ebdU, 0xacacef43U, 0x6262a6c4U, -+ 0x9191a839U, 0x9595a431U, 0xe4e437d3U, 0x79798bf2U, -+ 0xe7e732d5U, 0xc8c8438bU, 0x3737596eU, 0x6d6db7daU, -+ 0x8d8d8c01U, 0xd5d564b1U, 0x4e4ed29cU, 0xa9a9e049U, -+ 0x6c6cb4d8U, 0x5656faacU, 0xf4f407f3U, 0xeaea25cfU, -+ 0x6565afcaU, 0x7a7a8ef4U, 0xaeaee947U, 0x08081810U, -+ 0xbabad56fU, 0x787888f0U, 0x25256f4aU, 0x2e2e725cU, -+ 0x1c1c2438U, 0xa6a6f157U, 0xb4b4c773U, 0xc6c65197U, -+ 0xe8e823cbU, 0xdddd7ca1U, 0x74749ce8U, 0x1f1f213eU, -+ 0x4b4bdd96U, 0xbdbddc61U, 0x8b8b860dU, 0x8a8a850fU, -+ 0x707090e0U, 0x3e3e427cU, 0xb5b5c471U, 0x6666aaccU, -+ 0x4848d890U, 0x03030506U, 0xf6f601f7U, 0x0e0e121cU, -+ 0x6161a3c2U, 0x35355f6aU, 0x5757f9aeU, 0xb9b9d069U, -+ 0x86869117U, 0xc1c15899U, 0x1d1d273aU, 0x9e9eb927U, -+ 0xe1e138d9U, 0xf8f813ebU, 0x9898b32bU, 0x11113322U, -+ 0x6969bbd2U, 0xd9d970a9U, 0x8e8e8907U, 0x9494a733U, -+ 0x9b9bb62dU, 0x1e1e223cU, 0x87879215U, 0xe9e920c9U, -+ 0xcece4987U, 0x5555ffaaU, 0x28287850U, 0xdfdf7aa5U, -+ 0x8c8c8f03U, 0xa1a1f859U, 0x89898009U, 0x0d0d171aU, -+ 0xbfbfda65U, 0xe6e631d7U, 0x4242c684U, 0x6868b8d0U, -+ 0x4141c382U, 0x9999b029U, 0x2d2d775aU, 0x0f0f111eU, -+ 0xb0b0cb7bU, 0x5454fca8U, 0xbbbbd66dU, 0x16163a2cU, -+}; -+const u32 Te4[256] = { -+ 0x63636363U, 0x7c7c7c7cU, 0x77777777U, 0x7b7b7b7bU, -+ 0xf2f2f2f2U, 0x6b6b6b6bU, 0x6f6f6f6fU, 0xc5c5c5c5U, -+ 0x30303030U, 0x01010101U, 0x67676767U, 0x2b2b2b2bU, -+ 0xfefefefeU, 0xd7d7d7d7U, 0xababababU, 0x76767676U, -+ 0xcacacacaU, 0x82828282U, 0xc9c9c9c9U, 0x7d7d7d7dU, -+ 0xfafafafaU, 0x59595959U, 0x47474747U, 0xf0f0f0f0U, -+ 0xadadadadU, 0xd4d4d4d4U, 0xa2a2a2a2U, 0xafafafafU, -+ 0x9c9c9c9cU, 0xa4a4a4a4U, 0x72727272U, 0xc0c0c0c0U, -+ 0xb7b7b7b7U, 0xfdfdfdfdU, 0x93939393U, 0x26262626U, -+ 0x36363636U, 0x3f3f3f3fU, 0xf7f7f7f7U, 0xccccccccU, -+ 0x34343434U, 0xa5a5a5a5U, 0xe5e5e5e5U, 0xf1f1f1f1U, -+ 0x71717171U, 0xd8d8d8d8U, 0x31313131U, 0x15151515U, -+ 0x04040404U, 0xc7c7c7c7U, 0x23232323U, 0xc3c3c3c3U, -+ 0x18181818U, 0x96969696U, 0x05050505U, 0x9a9a9a9aU, -+ 0x07070707U, 0x12121212U, 0x80808080U, 0xe2e2e2e2U, -+ 0xebebebebU, 0x27272727U, 0xb2b2b2b2U, 0x75757575U, -+ 0x09090909U, 0x83838383U, 0x2c2c2c2cU, 0x1a1a1a1aU, -+ 0x1b1b1b1bU, 0x6e6e6e6eU, 0x5a5a5a5aU, 0xa0a0a0a0U, -+ 0x52525252U, 0x3b3b3b3bU, 0xd6d6d6d6U, 0xb3b3b3b3U, -+ 0x29292929U, 0xe3e3e3e3U, 0x2f2f2f2fU, 0x84848484U, -+ 0x53535353U, 0xd1d1d1d1U, 0x00000000U, 0xededededU, -+ 0x20202020U, 0xfcfcfcfcU, 0xb1b1b1b1U, 0x5b5b5b5bU, -+ 0x6a6a6a6aU, 0xcbcbcbcbU, 0xbebebebeU, 0x39393939U, -+ 0x4a4a4a4aU, 0x4c4c4c4cU, 0x58585858U, 0xcfcfcfcfU, -+ 0xd0d0d0d0U, 0xefefefefU, 0xaaaaaaaaU, 0xfbfbfbfbU, -+ 0x43434343U, 0x4d4d4d4dU, 0x33333333U, 0x85858585U, -+ 0x45454545U, 0xf9f9f9f9U, 0x02020202U, 0x7f7f7f7fU, -+ 0x50505050U, 0x3c3c3c3cU, 0x9f9f9f9fU, 0xa8a8a8a8U, -+ 0x51515151U, 0xa3a3a3a3U, 0x40404040U, 0x8f8f8f8fU, -+ 0x92929292U, 0x9d9d9d9dU, 0x38383838U, 0xf5f5f5f5U, -+ 0xbcbcbcbcU, 0xb6b6b6b6U, 0xdadadadaU, 0x21212121U, -+ 0x10101010U, 0xffffffffU, 0xf3f3f3f3U, 0xd2d2d2d2U, -+ 0xcdcdcdcdU, 0x0c0c0c0cU, 0x13131313U, 0xececececU, -+ 0x5f5f5f5fU, 0x97979797U, 0x44444444U, 0x17171717U, -+ 0xc4c4c4c4U, 0xa7a7a7a7U, 0x7e7e7e7eU, 0x3d3d3d3dU, -+ 0x64646464U, 0x5d5d5d5dU, 0x19191919U, 0x73737373U, -+ 0x60606060U, 0x81818181U, 0x4f4f4f4fU, 0xdcdcdcdcU, -+ 0x22222222U, 0x2a2a2a2aU, 0x90909090U, 0x88888888U, -+ 0x46464646U, 0xeeeeeeeeU, 0xb8b8b8b8U, 0x14141414U, -+ 0xdedededeU, 0x5e5e5e5eU, 0x0b0b0b0bU, 0xdbdbdbdbU, -+ 0xe0e0e0e0U, 0x32323232U, 0x3a3a3a3aU, 0x0a0a0a0aU, -+ 0x49494949U, 0x06060606U, 0x24242424U, 0x5c5c5c5cU, -+ 0xc2c2c2c2U, 0xd3d3d3d3U, 0xacacacacU, 0x62626262U, -+ 0x91919191U, 0x95959595U, 0xe4e4e4e4U, 0x79797979U, -+ 0xe7e7e7e7U, 0xc8c8c8c8U, 0x37373737U, 0x6d6d6d6dU, -+ 0x8d8d8d8dU, 0xd5d5d5d5U, 0x4e4e4e4eU, 0xa9a9a9a9U, -+ 0x6c6c6c6cU, 0x56565656U, 0xf4f4f4f4U, 0xeaeaeaeaU, -+ 0x65656565U, 0x7a7a7a7aU, 0xaeaeaeaeU, 0x08080808U, -+ 0xbabababaU, 0x78787878U, 0x25252525U, 0x2e2e2e2eU, -+ 0x1c1c1c1cU, 0xa6a6a6a6U, 0xb4b4b4b4U, 0xc6c6c6c6U, -+ 0xe8e8e8e8U, 0xddddddddU, 0x74747474U, 0x1f1f1f1fU, -+ 0x4b4b4b4bU, 0xbdbdbdbdU, 0x8b8b8b8bU, 0x8a8a8a8aU, -+ 0x70707070U, 0x3e3e3e3eU, 0xb5b5b5b5U, 0x66666666U, -+ 0x48484848U, 0x03030303U, 0xf6f6f6f6U, 0x0e0e0e0eU, -+ 0x61616161U, 0x35353535U, 0x57575757U, 0xb9b9b9b9U, -+ 0x86868686U, 0xc1c1c1c1U, 0x1d1d1d1dU, 0x9e9e9e9eU, -+ 0xe1e1e1e1U, 0xf8f8f8f8U, 0x98989898U, 0x11111111U, -+ 0x69696969U, 0xd9d9d9d9U, 0x8e8e8e8eU, 0x94949494U, -+ 0x9b9b9b9bU, 0x1e1e1e1eU, 0x87878787U, 0xe9e9e9e9U, -+ 0xcecececeU, 0x55555555U, 0x28282828U, 0xdfdfdfdfU, -+ 0x8c8c8c8cU, 0xa1a1a1a1U, 0x89898989U, 0x0d0d0d0dU, -+ 0xbfbfbfbfU, 0xe6e6e6e6U, 0x42424242U, 0x68686868U, -+ 0x41414141U, 0x99999999U, 0x2d2d2d2dU, 0x0f0f0f0fU, -+ 0xb0b0b0b0U, 0x54545454U, 0xbbbbbbbbU, 0x16161616U, -+}; -+#endif /* AES_SMALL_TABLES */ -+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, -+}; -+#ifndef AES_SMALL_TABLES -+const u32 Td1[256] = { -+ 0x5051f4a7U, 0x537e4165U, 0xc31a17a4U, 0x963a275eU, -+ 0xcb3bab6bU, 0xf11f9d45U, 0xabacfa58U, 0x934be303U, -+ 0x552030faU, 0xf6ad766dU, 0x9188cc76U, 0x25f5024cU, -+ 0xfc4fe5d7U, 0xd7c52acbU, 0x80263544U, 0x8fb562a3U, -+ 0x49deb15aU, 0x6725ba1bU, 0x9845ea0eU, 0xe15dfec0U, -+ 0x02c32f75U, 0x12814cf0U, 0xa38d4697U, 0xc66bd3f9U, -+ 0xe7038f5fU, 0x9515929cU, 0xebbf6d7aU, 0xda955259U, -+ 0x2dd4be83U, 0xd3587421U, 0x2949e069U, 0x448ec9c8U, -+ 0x6a75c289U, 0x78f48e79U, 0x6b99583eU, 0xdd27b971U, -+ 0xb6bee14fU, 0x17f088adU, 0x66c920acU, 0xb47dce3aU, -+ 0x1863df4aU, 0x82e51a31U, 0x60975133U, 0x4562537fU, -+ 0xe0b16477U, 0x84bb6baeU, 0x1cfe81a0U, 0x94f9082bU, -+ 0x58704868U, 0x198f45fdU, 0x8794de6cU, 0xb7527bf8U, -+ 0x23ab73d3U, 0xe2724b02U, 0x57e31f8fU, 0x2a6655abU, -+ 0x07b2eb28U, 0x032fb5c2U, 0x9a86c57bU, 0xa5d33708U, -+ 0xf2302887U, 0xb223bfa5U, 0xba02036aU, 0x5ced1682U, -+ 0x2b8acf1cU, 0x92a779b4U, 0xf0f307f2U, 0xa14e69e2U, -+ 0xcd65daf4U, 0xd50605beU, 0x1fd13462U, 0x8ac4a6feU, -+ 0x9d342e53U, 0xa0a2f355U, 0x32058ae1U, 0x75a4f6ebU, -+ 0x390b83ecU, 0xaa4060efU, 0x065e719fU, 0x51bd6e10U, -+ 0xf93e218aU, 0x3d96dd06U, 0xaedd3e05U, 0x464de6bdU, -+ 0xb591548dU, 0x0571c45dU, 0x6f0406d4U, 0xff605015U, -+ 0x241998fbU, 0x97d6bde9U, 0xcc894043U, 0x7767d99eU, -+ 0xbdb0e842U, 0x8807898bU, 0x38e7195bU, 0xdb79c8eeU, -+ 0x47a17c0aU, 0xe97c420fU, 0xc9f8841eU, 0x00000000U, -+ 0x83098086U, 0x48322bedU, 0xac1e1170U, 0x4e6c5a72U, -+ 0xfbfd0effU, 0x560f8538U, 0x1e3daed5U, 0x27362d39U, -+ 0x640a0fd9U, 0x21685ca6U, 0xd19b5b54U, 0x3a24362eU, -+ 0xb10c0a67U, 0x0f9357e7U, 0xd2b4ee96U, 0x9e1b9b91U, -+ 0x4f80c0c5U, 0xa261dc20U, 0x695a774bU, 0x161c121aU, -+ 0x0ae293baU, 0xe5c0a02aU, 0x433c22e0U, 0x1d121b17U, -+ 0x0b0e090dU, 0xadf28bc7U, 0xb92db6a8U, 0xc8141ea9U, -+ 0x8557f119U, 0x4caf7507U, 0xbbee99ddU, 0xfda37f60U, -+ 0x9ff70126U, 0xbc5c72f5U, 0xc544663bU, 0x345bfb7eU, -+ 0x768b4329U, 0xdccb23c6U, 0x68b6edfcU, 0x63b8e4f1U, -+ 0xcad731dcU, 0x10426385U, 0x40139722U, 0x2084c611U, -+ 0x7d854a24U, 0xf8d2bb3dU, 0x11aef932U, 0x6dc729a1U, -+ 0x4b1d9e2fU, 0xf3dcb230U, 0xec0d8652U, 0xd077c1e3U, -+ 0x6c2bb316U, 0x99a970b9U, 0xfa119448U, 0x2247e964U, -+ 0xc4a8fc8cU, 0x1aa0f03fU, 0xd8567d2cU, 0xef223390U, -+ 0xc787494eU, 0xc1d938d1U, 0xfe8ccaa2U, 0x3698d40bU, -+ 0xcfa6f581U, 0x28a57adeU, 0x26dab78eU, 0xa43fadbfU, -+ 0xe42c3a9dU, 0x0d507892U, 0x9b6a5fccU, 0x62547e46U, -+ 0xc2f68d13U, 0xe890d8b8U, 0x5e2e39f7U, 0xf582c3afU, -+ 0xbe9f5d80U, 0x7c69d093U, 0xa96fd52dU, 0xb3cf2512U, -+ 0x3bc8ac99U, 0xa710187dU, 0x6ee89c63U, 0x7bdb3bbbU, -+ 0x09cd2678U, 0xf46e5918U, 0x01ec9ab7U, 0xa8834f9aU, -+ 0x65e6956eU, 0x7eaaffe6U, 0x0821bccfU, 0xe6ef15e8U, -+ 0xd9bae79bU, 0xce4a6f36U, 0xd4ea9f09U, 0xd629b07cU, -+ 0xaf31a4b2U, 0x312a3f23U, 0x30c6a594U, 0xc035a266U, -+ 0x37744ebcU, 0xa6fc82caU, 0xb0e090d0U, 0x1533a7d8U, -+ 0x4af10498U, 0xf741ecdaU, 0x0e7fcd50U, 0x2f1791f6U, -+ 0x8d764dd6U, 0x4d43efb0U, 0x54ccaa4dU, 0xdfe49604U, -+ 0xe39ed1b5U, 0x1b4c6a88U, 0xb8c12c1fU, 0x7f466551U, -+ 0x049d5eeaU, 0x5d018c35U, 0x73fa8774U, 0x2efb0b41U, -+ 0x5ab3671dU, 0x5292dbd2U, 0x33e91056U, 0x136dd647U, -+ 0x8c9ad761U, 0x7a37a10cU, 0x8e59f814U, 0x89eb133cU, -+ 0xeecea927U, 0x35b761c9U, 0xede11ce5U, 0x3c7a47b1U, -+ 0x599cd2dfU, 0x3f55f273U, 0x791814ceU, 0xbf73c737U, -+ 0xea53f7cdU, 0x5b5ffdaaU, 0x14df3d6fU, 0x867844dbU, -+ 0x81caaff3U, 0x3eb968c4U, 0x2c382434U, 0x5fc2a340U, -+ 0x72161dc3U, 0x0cbce225U, 0x8b283c49U, 0x41ff0d95U, -+ 0x7139a801U, 0xde080cb3U, 0x9cd8b4e4U, 0x906456c1U, -+ 0x617bcb84U, 0x70d532b6U, 0x74486c5cU, 0x42d0b857U, -+}; -+const u32 Td2[256] = { -+ 0xa75051f4U, 0x65537e41U, 0xa4c31a17U, 0x5e963a27U, -+ 0x6bcb3babU, 0x45f11f9dU, 0x58abacfaU, 0x03934be3U, -+ 0xfa552030U, 0x6df6ad76U, 0x769188ccU, 0x4c25f502U, -+ 0xd7fc4fe5U, 0xcbd7c52aU, 0x44802635U, 0xa38fb562U, -+ 0x5a49deb1U, 0x1b6725baU, 0x0e9845eaU, 0xc0e15dfeU, -+ 0x7502c32fU, 0xf012814cU, 0x97a38d46U, 0xf9c66bd3U, -+ 0x5fe7038fU, 0x9c951592U, 0x7aebbf6dU, 0x59da9552U, -+ 0x832dd4beU, 0x21d35874U, 0x692949e0U, 0xc8448ec9U, -+ 0x896a75c2U, 0x7978f48eU, 0x3e6b9958U, 0x71dd27b9U, -+ 0x4fb6bee1U, 0xad17f088U, 0xac66c920U, 0x3ab47dceU, -+ 0x4a1863dfU, 0x3182e51aU, 0x33609751U, 0x7f456253U, -+ 0x77e0b164U, 0xae84bb6bU, 0xa01cfe81U, 0x2b94f908U, -+ 0x68587048U, 0xfd198f45U, 0x6c8794deU, 0xf8b7527bU, -+ 0xd323ab73U, 0x02e2724bU, 0x8f57e31fU, 0xab2a6655U, -+ 0x2807b2ebU, 0xc2032fb5U, 0x7b9a86c5U, 0x08a5d337U, -+ 0x87f23028U, 0xa5b223bfU, 0x6aba0203U, 0x825ced16U, -+ 0x1c2b8acfU, 0xb492a779U, 0xf2f0f307U, 0xe2a14e69U, -+ 0xf4cd65daU, 0xbed50605U, 0x621fd134U, 0xfe8ac4a6U, -+ 0x539d342eU, 0x55a0a2f3U, 0xe132058aU, 0xeb75a4f6U, -+ 0xec390b83U, 0xefaa4060U, 0x9f065e71U, 0x1051bd6eU, -+ -+ 0x8af93e21U, 0x063d96ddU, 0x05aedd3eU, 0xbd464de6U, -+ 0x8db59154U, 0x5d0571c4U, 0xd46f0406U, 0x15ff6050U, -+ 0xfb241998U, 0xe997d6bdU, 0x43cc8940U, 0x9e7767d9U, -+ 0x42bdb0e8U, 0x8b880789U, 0x5b38e719U, 0xeedb79c8U, -+ 0x0a47a17cU, 0x0fe97c42U, 0x1ec9f884U, 0x00000000U, -+ 0x86830980U, 0xed48322bU, 0x70ac1e11U, 0x724e6c5aU, -+ 0xfffbfd0eU, 0x38560f85U, 0xd51e3daeU, 0x3927362dU, -+ 0xd9640a0fU, 0xa621685cU, 0x54d19b5bU, 0x2e3a2436U, -+ 0x67b10c0aU, 0xe70f9357U, 0x96d2b4eeU, 0x919e1b9bU, -+ 0xc54f80c0U, 0x20a261dcU, 0x4b695a77U, 0x1a161c12U, -+ 0xba0ae293U, 0x2ae5c0a0U, 0xe0433c22U, 0x171d121bU, -+ 0x0d0b0e09U, 0xc7adf28bU, 0xa8b92db6U, 0xa9c8141eU, -+ 0x198557f1U, 0x074caf75U, 0xddbbee99U, 0x60fda37fU, -+ 0x269ff701U, 0xf5bc5c72U, 0x3bc54466U, 0x7e345bfbU, -+ 0x29768b43U, 0xc6dccb23U, 0xfc68b6edU, 0xf163b8e4U, -+ 0xdccad731U, 0x85104263U, 0x22401397U, 0x112084c6U, -+ 0x247d854aU, 0x3df8d2bbU, 0x3211aef9U, 0xa16dc729U, -+ 0x2f4b1d9eU, 0x30f3dcb2U, 0x52ec0d86U, 0xe3d077c1U, -+ 0x166c2bb3U, 0xb999a970U, 0x48fa1194U, 0x642247e9U, -+ 0x8cc4a8fcU, 0x3f1aa0f0U, 0x2cd8567dU, 0x90ef2233U, -+ 0x4ec78749U, 0xd1c1d938U, 0xa2fe8ccaU, 0x0b3698d4U, -+ 0x81cfa6f5U, 0xde28a57aU, 0x8e26dab7U, 0xbfa43fadU, -+ 0x9de42c3aU, 0x920d5078U, 0xcc9b6a5fU, 0x4662547eU, -+ 0x13c2f68dU, 0xb8e890d8U, 0xf75e2e39U, 0xaff582c3U, -+ 0x80be9f5dU, 0x937c69d0U, 0x2da96fd5U, 0x12b3cf25U, -+ 0x993bc8acU, 0x7da71018U, 0x636ee89cU, 0xbb7bdb3bU, -+ 0x7809cd26U, 0x18f46e59U, 0xb701ec9aU, 0x9aa8834fU, -+ 0x6e65e695U, 0xe67eaaffU, 0xcf0821bcU, 0xe8e6ef15U, -+ 0x9bd9bae7U, 0x36ce4a6fU, 0x09d4ea9fU, 0x7cd629b0U, -+ 0xb2af31a4U, 0x23312a3fU, 0x9430c6a5U, 0x66c035a2U, -+ 0xbc37744eU, 0xcaa6fc82U, 0xd0b0e090U, 0xd81533a7U, -+ 0x984af104U, 0xdaf741ecU, 0x500e7fcdU, 0xf62f1791U, -+ 0xd68d764dU, 0xb04d43efU, 0x4d54ccaaU, 0x04dfe496U, -+ 0xb5e39ed1U, 0x881b4c6aU, 0x1fb8c12cU, 0x517f4665U, -+ 0xea049d5eU, 0x355d018cU, 0x7473fa87U, 0x412efb0bU, -+ 0x1d5ab367U, 0xd25292dbU, 0x5633e910U, 0x47136dd6U, -+ 0x618c9ad7U, 0x0c7a37a1U, 0x148e59f8U, 0x3c89eb13U, -+ 0x27eecea9U, 0xc935b761U, 0xe5ede11cU, 0xb13c7a47U, -+ 0xdf599cd2U, 0x733f55f2U, 0xce791814U, 0x37bf73c7U, -+ 0xcdea53f7U, 0xaa5b5ffdU, 0x6f14df3dU, 0xdb867844U, -+ 0xf381caafU, 0xc43eb968U, 0x342c3824U, 0x405fc2a3U, -+ 0xc372161dU, 0x250cbce2U, 0x498b283cU, 0x9541ff0dU, -+ 0x017139a8U, 0xb3de080cU, 0xe49cd8b4U, 0xc1906456U, -+ 0x84617bcbU, 0xb670d532U, 0x5c74486cU, 0x5742d0b8U, -+}; -+const u32 Td3[256] = { -+ 0xf4a75051U, 0x4165537eU, 0x17a4c31aU, 0x275e963aU, -+ 0xab6bcb3bU, 0x9d45f11fU, 0xfa58abacU, 0xe303934bU, -+ 0x30fa5520U, 0x766df6adU, 0xcc769188U, 0x024c25f5U, -+ 0xe5d7fc4fU, 0x2acbd7c5U, 0x35448026U, 0x62a38fb5U, -+ 0xb15a49deU, 0xba1b6725U, 0xea0e9845U, 0xfec0e15dU, -+ 0x2f7502c3U, 0x4cf01281U, 0x4697a38dU, 0xd3f9c66bU, -+ 0x8f5fe703U, 0x929c9515U, 0x6d7aebbfU, 0x5259da95U, -+ 0xbe832dd4U, 0x7421d358U, 0xe0692949U, 0xc9c8448eU, -+ 0xc2896a75U, 0x8e7978f4U, 0x583e6b99U, 0xb971dd27U, -+ 0xe14fb6beU, 0x88ad17f0U, 0x20ac66c9U, 0xce3ab47dU, -+ 0xdf4a1863U, 0x1a3182e5U, 0x51336097U, 0x537f4562U, -+ 0x6477e0b1U, 0x6bae84bbU, 0x81a01cfeU, 0x082b94f9U, -+ 0x48685870U, 0x45fd198fU, 0xde6c8794U, 0x7bf8b752U, -+ 0x73d323abU, 0x4b02e272U, 0x1f8f57e3U, 0x55ab2a66U, -+ 0xeb2807b2U, 0xb5c2032fU, 0xc57b9a86U, 0x3708a5d3U, -+ 0x2887f230U, 0xbfa5b223U, 0x036aba02U, 0x16825cedU, -+ 0xcf1c2b8aU, 0x79b492a7U, 0x07f2f0f3U, 0x69e2a14eU, -+ 0xdaf4cd65U, 0x05bed506U, 0x34621fd1U, 0xa6fe8ac4U, -+ 0x2e539d34U, 0xf355a0a2U, 0x8ae13205U, 0xf6eb75a4U, -+ 0x83ec390bU, 0x60efaa40U, 0x719f065eU, 0x6e1051bdU, -+ 0x218af93eU, 0xdd063d96U, 0x3e05aeddU, 0xe6bd464dU, -+ 0x548db591U, 0xc45d0571U, 0x06d46f04U, 0x5015ff60U, -+ 0x98fb2419U, 0xbde997d6U, 0x4043cc89U, 0xd99e7767U, -+ 0xe842bdb0U, 0x898b8807U, 0x195b38e7U, 0xc8eedb79U, -+ 0x7c0a47a1U, 0x420fe97cU, 0x841ec9f8U, 0x00000000U, -+ 0x80868309U, 0x2bed4832U, 0x1170ac1eU, 0x5a724e6cU, -+ 0x0efffbfdU, 0x8538560fU, 0xaed51e3dU, 0x2d392736U, -+ 0x0fd9640aU, 0x5ca62168U, 0x5b54d19bU, 0x362e3a24U, -+ 0x0a67b10cU, 0x57e70f93U, 0xee96d2b4U, 0x9b919e1bU, -+ 0xc0c54f80U, 0xdc20a261U, 0x774b695aU, 0x121a161cU, -+ 0x93ba0ae2U, 0xa02ae5c0U, 0x22e0433cU, 0x1b171d12U, -+ 0x090d0b0eU, 0x8bc7adf2U, 0xb6a8b92dU, 0x1ea9c814U, -+ 0xf1198557U, 0x75074cafU, 0x99ddbbeeU, 0x7f60fda3U, -+ 0x01269ff7U, 0x72f5bc5cU, 0x663bc544U, 0xfb7e345bU, -+ 0x4329768bU, 0x23c6dccbU, 0xedfc68b6U, 0xe4f163b8U, -+ 0x31dccad7U, 0x63851042U, 0x97224013U, 0xc6112084U, -+ 0x4a247d85U, 0xbb3df8d2U, 0xf93211aeU, 0x29a16dc7U, -+ 0x9e2f4b1dU, 0xb230f3dcU, 0x8652ec0dU, 0xc1e3d077U, -+ 0xb3166c2bU, 0x70b999a9U, 0x9448fa11U, 0xe9642247U, -+ 0xfc8cc4a8U, 0xf03f1aa0U, 0x7d2cd856U, 0x3390ef22U, -+ 0x494ec787U, 0x38d1c1d9U, 0xcaa2fe8cU, 0xd40b3698U, -+ 0xf581cfa6U, 0x7ade28a5U, 0xb78e26daU, 0xadbfa43fU, -+ 0x3a9de42cU, 0x78920d50U, 0x5fcc9b6aU, 0x7e466254U, -+ 0x8d13c2f6U, 0xd8b8e890U, 0x39f75e2eU, 0xc3aff582U, -+ 0x5d80be9fU, 0xd0937c69U, 0xd52da96fU, 0x2512b3cfU, -+ 0xac993bc8U, 0x187da710U, 0x9c636ee8U, 0x3bbb7bdbU, -+ 0x267809cdU, 0x5918f46eU, 0x9ab701ecU, 0x4f9aa883U, -+ 0x956e65e6U, 0xffe67eaaU, 0xbccf0821U, 0x15e8e6efU, -+ 0xe79bd9baU, 0x6f36ce4aU, 0x9f09d4eaU, 0xb07cd629U, -+ 0xa4b2af31U, 0x3f23312aU, 0xa59430c6U, 0xa266c035U, -+ 0x4ebc3774U, 0x82caa6fcU, 0x90d0b0e0U, 0xa7d81533U, -+ 0x04984af1U, 0xecdaf741U, 0xcd500e7fU, 0x91f62f17U, -+ 0x4dd68d76U, 0xefb04d43U, 0xaa4d54ccU, 0x9604dfe4U, -+ 0xd1b5e39eU, 0x6a881b4cU, 0x2c1fb8c1U, 0x65517f46U, -+ 0x5eea049dU, 0x8c355d01U, 0x877473faU, 0x0b412efbU, -+ 0x671d5ab3U, 0xdbd25292U, 0x105633e9U, 0xd647136dU, -+ 0xd7618c9aU, 0xa10c7a37U, 0xf8148e59U, 0x133c89ebU, -+ 0xa927eeceU, 0x61c935b7U, 0x1ce5ede1U, 0x47b13c7aU, -+ 0xd2df599cU, 0xf2733f55U, 0x14ce7918U, 0xc737bf73U, -+ 0xf7cdea53U, 0xfdaa5b5fU, 0x3d6f14dfU, 0x44db8678U, -+ 0xaff381caU, 0x68c43eb9U, 0x24342c38U, 0xa3405fc2U, -+ 0x1dc37216U, 0xe2250cbcU, 0x3c498b28U, 0x0d9541ffU, -+ 0xa8017139U, 0x0cb3de08U, 0xb4e49cd8U, 0x56c19064U, -+ 0xcb84617bU, 0x32b670d5U, 0x6c5c7448U, 0xb85742d0U, -+}; -+const u32 Td4[256] = { -+ 0x52525252U, 0x09090909U, 0x6a6a6a6aU, 0xd5d5d5d5U, -+ 0x30303030U, 0x36363636U, 0xa5a5a5a5U, 0x38383838U, -+ 0xbfbfbfbfU, 0x40404040U, 0xa3a3a3a3U, 0x9e9e9e9eU, -+ 0x81818181U, 0xf3f3f3f3U, 0xd7d7d7d7U, 0xfbfbfbfbU, -+ 0x7c7c7c7cU, 0xe3e3e3e3U, 0x39393939U, 0x82828282U, -+ 0x9b9b9b9bU, 0x2f2f2f2fU, 0xffffffffU, 0x87878787U, -+ 0x34343434U, 0x8e8e8e8eU, 0x43434343U, 0x44444444U, -+ 0xc4c4c4c4U, 0xdedededeU, 0xe9e9e9e9U, 0xcbcbcbcbU, -+ 0x54545454U, 0x7b7b7b7bU, 0x94949494U, 0x32323232U, -+ 0xa6a6a6a6U, 0xc2c2c2c2U, 0x23232323U, 0x3d3d3d3dU, -+ 0xeeeeeeeeU, 0x4c4c4c4cU, 0x95959595U, 0x0b0b0b0bU, -+ 0x42424242U, 0xfafafafaU, 0xc3c3c3c3U, 0x4e4e4e4eU, -+ 0x08080808U, 0x2e2e2e2eU, 0xa1a1a1a1U, 0x66666666U, -+ 0x28282828U, 0xd9d9d9d9U, 0x24242424U, 0xb2b2b2b2U, -+ 0x76767676U, 0x5b5b5b5bU, 0xa2a2a2a2U, 0x49494949U, -+ 0x6d6d6d6dU, 0x8b8b8b8bU, 0xd1d1d1d1U, 0x25252525U, -+ 0x72727272U, 0xf8f8f8f8U, 0xf6f6f6f6U, 0x64646464U, -+ 0x86868686U, 0x68686868U, 0x98989898U, 0x16161616U, -+ 0xd4d4d4d4U, 0xa4a4a4a4U, 0x5c5c5c5cU, 0xccccccccU, -+ 0x5d5d5d5dU, 0x65656565U, 0xb6b6b6b6U, 0x92929292U, -+ 0x6c6c6c6cU, 0x70707070U, 0x48484848U, 0x50505050U, -+ 0xfdfdfdfdU, 0xededededU, 0xb9b9b9b9U, 0xdadadadaU, -+ 0x5e5e5e5eU, 0x15151515U, 0x46464646U, 0x57575757U, -+ 0xa7a7a7a7U, 0x8d8d8d8dU, 0x9d9d9d9dU, 0x84848484U, -+ 0x90909090U, 0xd8d8d8d8U, 0xababababU, 0x00000000U, -+ 0x8c8c8c8cU, 0xbcbcbcbcU, 0xd3d3d3d3U, 0x0a0a0a0aU, -+ 0xf7f7f7f7U, 0xe4e4e4e4U, 0x58585858U, 0x05050505U, -+ 0xb8b8b8b8U, 0xb3b3b3b3U, 0x45454545U, 0x06060606U, -+ 0xd0d0d0d0U, 0x2c2c2c2cU, 0x1e1e1e1eU, 0x8f8f8f8fU, -+ 0xcacacacaU, 0x3f3f3f3fU, 0x0f0f0f0fU, 0x02020202U, -+ 0xc1c1c1c1U, 0xafafafafU, 0xbdbdbdbdU, 0x03030303U, -+ 0x01010101U, 0x13131313U, 0x8a8a8a8aU, 0x6b6b6b6bU, -+ 0x3a3a3a3aU, 0x91919191U, 0x11111111U, 0x41414141U, -+ 0x4f4f4f4fU, 0x67676767U, 0xdcdcdcdcU, 0xeaeaeaeaU, -+ 0x97979797U, 0xf2f2f2f2U, 0xcfcfcfcfU, 0xcecececeU, -+ 0xf0f0f0f0U, 0xb4b4b4b4U, 0xe6e6e6e6U, 0x73737373U, -+ 0x96969696U, 0xacacacacU, 0x74747474U, 0x22222222U, -+ 0xe7e7e7e7U, 0xadadadadU, 0x35353535U, 0x85858585U, -+ 0xe2e2e2e2U, 0xf9f9f9f9U, 0x37373737U, 0xe8e8e8e8U, -+ 0x1c1c1c1cU, 0x75757575U, 0xdfdfdfdfU, 0x6e6e6e6eU, -+ 0x47474747U, 0xf1f1f1f1U, 0x1a1a1a1aU, 0x71717171U, -+ 0x1d1d1d1dU, 0x29292929U, 0xc5c5c5c5U, 0x89898989U, -+ 0x6f6f6f6fU, 0xb7b7b7b7U, 0x62626262U, 0x0e0e0e0eU, -+ 0xaaaaaaaaU, 0x18181818U, 0xbebebebeU, 0x1b1b1b1bU, -+ 0xfcfcfcfcU, 0x56565656U, 0x3e3e3e3eU, 0x4b4b4b4bU, -+ 0xc6c6c6c6U, 0xd2d2d2d2U, 0x79797979U, 0x20202020U, -+ 0x9a9a9a9aU, 0xdbdbdbdbU, 0xc0c0c0c0U, 0xfefefefeU, -+ 0x78787878U, 0xcdcdcdcdU, 0x5a5a5a5aU, 0xf4f4f4f4U, -+ 0x1f1f1f1fU, 0xddddddddU, 0xa8a8a8a8U, 0x33333333U, -+ 0x88888888U, 0x07070707U, 0xc7c7c7c7U, 0x31313131U, -+ 0xb1b1b1b1U, 0x12121212U, 0x10101010U, 0x59595959U, -+ 0x27272727U, 0x80808080U, 0xececececU, 0x5f5f5f5fU, -+ 0x60606060U, 0x51515151U, 0x7f7f7f7fU, 0xa9a9a9a9U, -+ 0x19191919U, 0xb5b5b5b5U, 0x4a4a4a4aU, 0x0d0d0d0dU, -+ 0x2d2d2d2dU, 0xe5e5e5e5U, 0x7a7a7a7aU, 0x9f9f9f9fU, -+ 0x93939393U, 0xc9c9c9c9U, 0x9c9c9c9cU, 0xefefefefU, -+ 0xa0a0a0a0U, 0xe0e0e0e0U, 0x3b3b3b3bU, 0x4d4d4d4dU, -+ 0xaeaeaeaeU, 0x2a2a2a2aU, 0xf5f5f5f5U, 0xb0b0b0b0U, -+ 0xc8c8c8c8U, 0xebebebebU, 0xbbbbbbbbU, 0x3c3c3c3cU, -+ 0x83838383U, 0x53535353U, 0x99999999U, 0x61616161U, -+ 0x17171717U, 0x2b2b2b2bU, 0x04040404U, 0x7e7e7e7eU, -+ 0xbabababaU, 0x77777777U, 0xd6d6d6d6U, 0x26262626U, -+ 0xe1e1e1e1U, 0x69696969U, 0x14141414U, 0x63636363U, -+ 0x55555555U, 0x21212121U, 0x0c0c0c0cU, 0x7d7d7d7dU, -+}; -+const u32 rcon[] = { -+ 0x01000000, 0x02000000, 0x04000000, 0x08000000, -+ 0x10000000, 0x20000000, 0x40000000, 0x80000000, -+ 0x1B000000, 0x36000000, /* for 128-bit blocks, Rijndael never uses more than 10 rcon values */ -+}; -+#else /* AES_SMALL_TABLES */ -+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 */ -+}; -+#endif /* AES_SMALL_TABLES */ -+/** -+ * Expand the cipher key into the encryption key schedule. -+ * -+ * @return the number of rounds for the given cipher key size. -+ */ -+int rijndaelKeySetupEnc(u32 rk[], const u8 cipherKey[], int keyBits) -+{ -+ int i; -+ u32 temp; -+ -+ rk[0] = GETU32(cipherKey ); -+ rk[1] = GETU32(cipherKey + 4); -+ rk[2] = GETU32(cipherKey + 8); -+ rk[3] = GETU32(cipherKey + 12); -+ -+ if (keyBits == 128) { -+ 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; -+ } -+ return 10; -+ } -+ -+ rk[4] = GETU32(cipherKey + 16); -+ rk[5] = GETU32(cipherKey + 20); -+ -+ if (keyBits == 192) { -+ for (i = 0; i < 8; i++) { -+ temp = rk[5]; -+ rk[6] = rk[0] ^ TE421(temp) ^ TE432(temp) ^ -+ TE443(temp) ^ TE414(temp) ^ RCON(i); -+ rk[7] = rk[1] ^ rk[6]; -+ rk[8] = rk[2] ^ rk[7]; -+ rk[9] = rk[3] ^ rk[8]; -+ if (i == 7) -+ return 12; -+ rk[10] = rk[4] ^ rk[9]; -+ rk[11] = rk[5] ^ rk[10]; -+ rk += 6; -+ } -+ } -+ -+ rk[6] = GETU32(cipherKey + 24); -+ rk[7] = GETU32(cipherKey + 28); -+ -+ if (keyBits == 256) { -+ for (i = 0; i < 7; i++) { -+ temp = rk[7]; -+ rk[8] = rk[0] ^ TE421(temp) ^ TE432(temp) ^ -+ TE443(temp) ^ TE414(temp) ^ RCON(i); -+ rk[9] = rk[1] ^ rk[8]; -+ rk[10] = rk[2] ^ rk[9]; -+ rk[11] = rk[3] ^ rk[10]; -+ if (i == 6) -+ return 14; -+ temp = rk[11]; -+ rk[12] = rk[4] ^ TE411(temp) ^ TE422(temp) ^ -+ TE433(temp) ^ TE444(temp); -+ rk[13] = rk[5] ^ rk[12]; -+ rk[14] = rk[6] ^ rk[13]; -+ rk[15] = rk[7] ^ rk[14]; -+ rk += 8; -+ } -+ } -+ -+ return -1; -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes-omac1.c b/drivers/net/wireless/rtl8821cs/core/crypto/aes-omac1.c -new file mode 100644 -index 000000000..88eeba491 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes-omac1.c -@@ -0,0 +1,172 @@ -+/* -+ * One-key CBC MAC (OMAC1) hash with AES -+ * -+ * Copyright (c) 2003-2007, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+#include "aes.h" -+#include "aes_wrap.h" -+ -+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; -+} -+ -+ -+/** -+ * omac1_aes_vector - One-Key CBC MAC (OMAC1) hash with AES -+ * @key: Key for the hash operation -+ * @key_len: Key length in octets -+ * @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. -+ */ -+int omac1_aes_vector(const u8 *key, size_t key_len, size_t num_elem, -+ const u8 *addr[], const size_t *len, u8 *mac) -+{ -+ void *ctx; -+ u8 cbc[AES_BLOCK_SIZE], pad[AES_BLOCK_SIZE]; -+ const u8 *pos, *end; -+ size_t i, e, left, total_len; -+ -+ if (TEST_FAIL()) -+ return -1; -+ -+ ctx = aes_encrypt_init(key, key_len); -+ if (ctx == NULL) -+ return -1; -+ os_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) { -+ /* -+ * Stop if there are no more bytes to process -+ * since there are no more entries in the array. -+ */ -+ if (i + 1 == AES_BLOCK_SIZE && -+ left == AES_BLOCK_SIZE) -+ break; -+ e++; -+ pos = addr[e]; -+ end = pos + len[e]; -+ } -+ } -+ if (left > AES_BLOCK_SIZE) -+ _aes_encrypt(ctx, cbc, cbc); -+ left -= AES_BLOCK_SIZE; -+ } -+ -+ os_memset(pad, 0, AES_BLOCK_SIZE); -+ _aes_encrypt(ctx, pad, pad); -+ gf_mulx(pad); -+ -+ if (left || total_len == 0) { -+ for (i = 0; i < left; i++) { -+ cbc[i] ^= *pos++; -+ if (pos >= end) { -+ /* -+ * Stop if there are no more bytes to process -+ * since there are no more entries in the array. -+ */ -+ if (i + 1 == left) -+ break; -+ 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_encrypt(ctx, pad, mac); -+ aes_encrypt_deinit(ctx); -+ return 0; -+} -+ -+ -+/** -+ * 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. -+ */ -+int omac1_aes_128_vector(const u8 *key, size_t num_elem, -+ const u8 *addr[], const size_t *len, u8 *mac) -+{ -+ return omac1_aes_vector(key, 16, num_elem, addr, len, mac); -+} -+ -+ -+/** -+ * 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. -+ */ -+int omac1_aes_128(const u8 *key, const u8 *data, size_t data_len, u8 *mac) -+{ -+ return omac1_aes_128_vector(key, 1, &data, &data_len, mac); -+} -+ -+ -+/** -+ * omac1_aes_256 - One-Key CBC MAC (OMAC1) hash with AES-256 (aka AES-CMAC) -+ * @key: 256-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. -+ */ -+int omac1_aes_256(const u8 *key, const u8 *data, size_t data_len, u8 *mac) -+{ -+ return omac1_aes_vector(key, 32, 1, &data, &data_len, mac); -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes-siv.c b/drivers/net/wireless/rtl8821cs/core/crypto/aes-siv.c -new file mode 100644 -index 000000000..58656f2b5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes-siv.c -@@ -0,0 +1,207 @@ -+/* -+ * AES SIV (RFC 5297) -+ * Copyright (c) 2013 Cozybit, Inc. -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+#include "aes.h" -+#include "aes_wrap.h" -+#include "aes_siv.h" -+ -+ -+static const u8 zero[AES_BLOCK_SIZE]; -+ -+ -+static void dbl(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 xor(u8 *a, const u8 *b) -+{ -+ int i; -+ -+ for (i = 0; i < AES_BLOCK_SIZE; i++) -+ *a++ ^= *b++; -+} -+ -+ -+static void xorend(u8 *a, int alen, const u8 *b, int blen) -+{ -+ int i; -+ -+ if (alen < blen) -+ return; -+ -+ for (i = 0; i < blen; i++) -+ a[alen - blen + i] ^= b[i]; -+} -+ -+ -+static void pad_block(u8 *pad, const u8 *addr, size_t len) -+{ -+ os_memset(pad, 0, AES_BLOCK_SIZE); -+ os_memcpy(pad, addr, len); -+ -+ if (len < AES_BLOCK_SIZE) -+ pad[len] = 0x80; -+} -+ -+ -+static int aes_s2v(const u8 *key, size_t key_len, -+ size_t num_elem, const u8 *addr[], size_t *len, u8 *mac) -+{ -+ u8 tmp[AES_BLOCK_SIZE], tmp2[AES_BLOCK_SIZE]; -+ u8 *buf = NULL; -+ int ret; -+ size_t i; -+ const u8 *data[1]; -+ size_t data_len[1]; -+ -+ if (!num_elem) { -+ os_memcpy(tmp, zero, sizeof(zero)); -+ tmp[AES_BLOCK_SIZE - 1] = 1; -+ data[0] = tmp; -+ data_len[0] = sizeof(tmp); -+ return omac1_aes_vector(key, key_len, 1, data, data_len, mac); -+ } -+ -+ data[0] = zero; -+ data_len[0] = sizeof(zero); -+ ret = omac1_aes_vector(key, key_len, 1, data, data_len, tmp); -+ if (ret) -+ return ret; -+ -+ for (i = 0; i < num_elem - 1; i++) { -+ ret = omac1_aes_vector(key, key_len, 1, &addr[i], &len[i], -+ tmp2); -+ if (ret) -+ return ret; -+ -+ dbl(tmp); -+ xor(tmp, tmp2); -+ } -+ if (len[i] >= AES_BLOCK_SIZE) { -+ buf = os_memdup(addr[i], len[i]); -+ if (!buf) -+ return -ENOMEM; -+ -+ xorend(buf, len[i], tmp, AES_BLOCK_SIZE); -+ data[0] = buf; -+ ret = omac1_aes_vector(key, key_len, 1, data, &len[i], mac); -+ bin_clear_free(buf, len[i]); -+ return ret; -+ } -+ -+ dbl(tmp); -+ pad_block(tmp2, addr[i], len[i]); -+ xor(tmp, tmp2); -+ -+ data[0] = tmp; -+ data_len[0] = sizeof(tmp); -+ return omac1_aes_vector(key, key_len, 1, data, data_len, mac); -+} -+ -+ -+int aes_siv_encrypt(const u8 *key, size_t key_len, -+ const u8 *pw, size_t pwlen, -+ size_t num_elem, const u8 *addr[], const size_t *len, -+ u8 *out) -+{ -+ const u8 *_addr[6]; -+ size_t _len[6]; -+ const u8 *k1, *k2; -+ u8 v[AES_BLOCK_SIZE]; -+ size_t i; -+ u8 *iv, *crypt_pw; -+ -+ if (num_elem > ARRAY_SIZE(_addr) - 1 || -+ (key_len != 32 && key_len != 48 && key_len != 64)) -+ return -1; -+ -+ key_len /= 2; -+ k1 = key; -+ k2 = key + key_len; -+ -+ for (i = 0; i < num_elem; i++) { -+ _addr[i] = addr[i]; -+ _len[i] = len[i]; -+ } -+ _addr[num_elem] = pw; -+ _len[num_elem] = pwlen; -+ -+ if (aes_s2v(k1, key_len, num_elem + 1, _addr, _len, v)) -+ return -1; -+ -+ iv = out; -+ crypt_pw = out + AES_BLOCK_SIZE; -+ -+ os_memcpy(iv, v, AES_BLOCK_SIZE); -+ os_memcpy(crypt_pw, pw, pwlen); -+ -+ /* zero out 63rd and 31st bits of ctr (from right) */ -+ v[8] &= 0x7f; -+ v[12] &= 0x7f; -+ return aes_ctr_encrypt(k2, key_len, v, crypt_pw, pwlen); -+} -+ -+ -+int aes_siv_decrypt(const u8 *key, size_t key_len, -+ const u8 *iv_crypt, size_t iv_c_len, -+ size_t num_elem, const u8 *addr[], const size_t *len, -+ u8 *out) -+{ -+ const u8 *_addr[6]; -+ size_t _len[6]; -+ const u8 *k1, *k2; -+ size_t crypt_len; -+ size_t i; -+ int ret; -+ u8 iv[AES_BLOCK_SIZE]; -+ u8 check[AES_BLOCK_SIZE]; -+ -+ if (iv_c_len < AES_BLOCK_SIZE || num_elem > ARRAY_SIZE(_addr) - 1 || -+ (key_len != 32 && key_len != 48 && key_len != 64)) -+ return -1; -+ crypt_len = iv_c_len - AES_BLOCK_SIZE; -+ key_len /= 2; -+ k1 = key; -+ k2 = key + key_len; -+ -+ for (i = 0; i < num_elem; i++) { -+ _addr[i] = addr[i]; -+ _len[i] = len[i]; -+ } -+ _addr[num_elem] = out; -+ _len[num_elem] = crypt_len; -+ -+ os_memcpy(iv, iv_crypt, AES_BLOCK_SIZE); -+ os_memcpy(out, iv_crypt + AES_BLOCK_SIZE, crypt_len); -+ -+ iv[8] &= 0x7f; -+ iv[12] &= 0x7f; -+ -+ ret = aes_ctr_encrypt(k2, key_len, iv, out, crypt_len); -+ if (ret) -+ return ret; -+ -+ ret = aes_s2v(k1, key_len, num_elem + 1, _addr, _len, check); -+ if (ret) -+ return ret; -+ if (os_memcmp(check, iv_crypt, AES_BLOCK_SIZE) == 0) -+ return 0; -+ -+ return -1; -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes.h b/drivers/net/wireless/rtl8821cs/core/crypto/aes.h -new file mode 100644 -index 000000000..244c38be3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes.h -@@ -0,0 +1,21 @@ -+/* -+ * AES functions -+ * Copyright (c) 2003-2006, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#ifndef AES_H -+#define AES_H -+ -+#define AES_BLOCK_SIZE 16 -+ -+void * aes_encrypt_init(const u8 *key, size_t len); -+int _aes_encrypt(void *ctx, const u8 *plain, u8 *crypt); -+void aes_encrypt_deinit(void *ctx); -+void * aes_decrypt_init(const u8 *key, size_t len); -+int aes_decrypt(void *ctx, const u8 *crypt, u8 *plain); -+void aes_decrypt_deinit(void *ctx); -+ -+#endif /* AES_H */ -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes_i.h b/drivers/net/wireless/rtl8821cs/core/crypto/aes_i.h -new file mode 100644 -index 000000000..54375cf35 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes_i.h -@@ -0,0 +1,125 @@ -+/* -+ * AES (Rijndael) cipher -+ * Copyright (c) 2003-2012, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#ifndef AES_I_H -+#define AES_I_H -+ -+#include "aes.h" -+ -+/* #define FULL_UNROLL */ -+#define AES_SMALL_TABLES -+ -+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]; -+ -+#ifndef AES_SMALL_TABLES -+ -+#define RCON(i) rcon[(i)] -+ -+#define TE0(i) Te0[((i) >> 24) & 0xff] -+#define TE1(i) Te1[((i) >> 16) & 0xff] -+#define TE2(i) Te2[((i) >> 8) & 0xff] -+#define TE3(i) Te3[(i) & 0xff] -+#define TE41(i) (Te4[((i) >> 24) & 0xff] & 0xff000000) -+#define TE42(i) (Te4[((i) >> 16) & 0xff] & 0x00ff0000) -+#define TE43(i) (Te4[((i) >> 8) & 0xff] & 0x0000ff00) -+#define TE44(i) (Te4[(i) & 0xff] & 0x000000ff) -+#define TE421(i) (Te4[((i) >> 16) & 0xff] & 0xff000000) -+#define TE432(i) (Te4[((i) >> 8) & 0xff] & 0x00ff0000) -+#define TE443(i) (Te4[(i) & 0xff] & 0x0000ff00) -+#define TE414(i) (Te4[((i) >> 24) & 0xff] & 0x000000ff) -+#define TE411(i) (Te4[((i) >> 24) & 0xff] & 0xff000000) -+#define TE422(i) (Te4[((i) >> 16) & 0xff] & 0x00ff0000) -+#define TE433(i) (Te4[((i) >> 8) & 0xff] & 0x0000ff00) -+#define TE444(i) (Te4[(i) & 0xff] & 0x000000ff) -+#define TE4(i) (Te4[(i)] & 0x000000ff) -+ -+#define TD0(i) Td0[((i) >> 24) & 0xff] -+#define TD1(i) Td1[((i) >> 16) & 0xff] -+#define TD2(i) Td2[((i) >> 8) & 0xff] -+#define TD3(i) Td3[(i) & 0xff] -+#define TD41(i) (Td4[((i) >> 24) & 0xff] & 0xff000000) -+#define TD42(i) (Td4[((i) >> 16) & 0xff] & 0x00ff0000) -+#define TD43(i) (Td4[((i) >> 8) & 0xff] & 0x0000ff00) -+#define TD44(i) (Td4[(i) & 0xff] & 0x000000ff) -+#define TD0_(i) Td0[(i) & 0xff] -+#define TD1_(i) Td1[(i) & 0xff] -+#define TD2_(i) Td2[(i) & 0xff] -+#define TD3_(i) Td3[(i) & 0xff] -+ -+#else /* AES_SMALL_TABLES */ -+ -+#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 TE411(i) ((Te0[((i) >> 24) & 0xff] << 8) & 0xff000000) -+#define TE422(i) (Te0[((i) >> 16) & 0xff] & 0x00ff0000) -+#define TE433(i) (Te0[((i) >> 8) & 0xff] & 0x0000ff00) -+#define TE444(i) ((Te0[(i) & 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) -+ -+#endif /* AES_SMALL_TABLES */ -+ -+#ifdef _MSC_VER -+#define SWAP(x) (_lrotl(x, 8) & 0x00ff00ff | _lrotr(x, 8) & 0xff00ff00) -+#define GETU32(p) SWAP(*((u32 *)(p))) -+#define PUTU32(ct, st) { *((u32 *)(ct)) = SWAP((st)); } -+#else -+#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); } -+#endif -+ -+#define AES_PRIV_SIZE (4 * 4 * 15 + 4) -+#define AES_PRIV_NR_POS (4 * 15) -+ -+int rijndaelKeySetupEnc(u32 rk[], const u8 cipherKey[], int keyBits); -+ -+#endif /* AES_I_H */ -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes_siv.h b/drivers/net/wireless/rtl8821cs/core/crypto/aes_siv.h -new file mode 100644 -index 000000000..fb05d80c1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes_siv.h -@@ -0,0 +1,21 @@ -+/* -+ * AES SIV (RFC 5297) -+ * Copyright (c) 2013 Cozybit, Inc. -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#ifndef AES_SIV_H -+#define AES_SIV_H -+ -+int aes_siv_encrypt(const u8 *key, size_t key_len, -+ const u8 *pw, size_t pwlen, -+ size_t num_elem, const u8 *addr[], const size_t *len, -+ u8 *out); -+int aes_siv_decrypt(const u8 *key, size_t key_len, -+ const u8 *iv_crypt, size_t iv_c_len, -+ size_t num_elem, const u8 *addr[], const size_t *len, -+ u8 *out); -+ -+#endif /* AES_SIV_H */ -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/aes_wrap.h b/drivers/net/wireless/rtl8821cs/core/crypto/aes_wrap.h -new file mode 100644 -index 000000000..b70b1d26e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/aes_wrap.h -@@ -0,0 +1,73 @@ -+/* -+ * AES-based functions -+ * -+ * - AES Key Wrap Algorithm (RFC3394) -+ * - One-Key CBC MAC (OMAC1) hash with AES-128 and AES-256 -+ * - AES-128/192/256 CTR mode encryption -+ * - AES-128 EAX mode encryption/decryption -+ * - AES-128 CBC -+ * - AES-GCM -+ * - AES-CCM -+ * -+ * Copyright (c) 2003-2012, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#ifndef AES_WRAP_H -+#define AES_WRAP_H -+ -+int __must_check aes_wrap(const u8 *kek, size_t kek_len, int n, const u8 *plain, -+ u8 *cipher); -+int __must_check aes_unwrap(const u8 *kek, size_t kek_len, int n, -+ const u8 *cipher, u8 *plain); -+int __must_check omac1_aes_vector(const u8 *key, size_t key_len, -+ size_t num_elem, const u8 *addr[], -+ const size_t *len, u8 *mac); -+int __must_check omac1_aes_128_vector(const u8 *key, size_t num_elem, -+ const u8 *addr[], const size_t *len, -+ u8 *mac); -+int __must_check omac1_aes_128(const u8 *key, const u8 *data, size_t data_len, -+ u8 *mac); -+int __must_check omac1_aes_256(const u8 *key, const u8 *data, size_t data_len, -+ u8 *mac); -+int __must_check aes_128_encrypt_block(const u8 *key, const u8 *in, u8 *out); -+int __must_check aes_ctr_encrypt(const u8 *key, size_t key_len, const u8 *nonce, -+ u8 *data, size_t data_len); -+int __must_check aes_128_ctr_encrypt(const u8 *key, const u8 *nonce, -+ u8 *data, size_t data_len); -+int __must_check aes_128_eax_encrypt(const u8 *key, -+ const u8 *nonce, size_t nonce_len, -+ const u8 *hdr, size_t hdr_len, -+ u8 *data, size_t data_len, u8 *tag); -+int __must_check aes_128_eax_decrypt(const u8 *key, -+ const u8 *nonce, size_t nonce_len, -+ const u8 *hdr, size_t hdr_len, -+ u8 *data, size_t data_len, const u8 *tag); -+int __must_check aes_128_cbc_encrypt(const u8 *key, const u8 *iv, u8 *data, -+ size_t data_len); -+int __must_check aes_128_cbc_decrypt(const u8 *key, const u8 *iv, u8 *data, -+ size_t data_len); -+int __must_check aes_gcm_ae(const u8 *key, size_t key_len, -+ const u8 *iv, size_t iv_len, -+ const u8 *plain, size_t plain_len, -+ const u8 *aad, size_t aad_len, -+ u8 *crypt, u8 *tag); -+int __must_check aes_gcm_ad(const u8 *key, size_t key_len, -+ const u8 *iv, size_t iv_len, -+ const u8 *crypt, size_t crypt_len, -+ const u8 *aad, size_t aad_len, const u8 *tag, -+ u8 *plain); -+int __must_check aes_gmac(const u8 *key, size_t key_len, -+ const u8 *iv, size_t iv_len, -+ const u8 *aad, size_t aad_len, u8 *tag); -+int __must_check aes_ccm_ae(const u8 *key, size_t key_len, const u8 *nonce, -+ size_t M, const u8 *plain, size_t plain_len, -+ const u8 *aad, size_t aad_len, u8 *crypt, u8 *auth); -+int __must_check aes_ccm_ad(const u8 *key, size_t key_len, const u8 *nonce, -+ size_t M, const u8 *crypt, size_t crypt_len, -+ const u8 *aad, size_t aad_len, const u8 *auth, -+ u8 *plain); -+ -+#endif /* AES_WRAP_H */ -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/ccmp.c b/drivers/net/wireless/rtl8821cs/core/crypto/ccmp.c -new file mode 100644 -index 000000000..3ebd487a9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/ccmp.c -@@ -0,0 +1,385 @@ -+/* -+ * CTR with CBC-MAC Protocol (CCMP) -+ * Copyright (c) 2010-2012, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+#include "aes.h" -+#include "aes_wrap.h" -+#include "wlancrypto_wrap.h" -+ -+ -+ -+static void ccmp_aad_nonce(_adapter *padapter, const struct ieee80211_hdr *hdr, const u8 *data, -+ u8 *aad, size_t *aad_len, u8 *nonce) -+{ -+ u16 fc, stype, seq; -+ int qos = 0, addr4 = 0; -+ u8 *pos; -+ -+ nonce[0] = 0; -+ -+ fc = le_to_host16(hdr->frame_control); -+ stype = WLAN_FC_GET_STYPE(fc); -+ if ((fc & (WLAN_FC_TODS | WLAN_FC_FROMDS)) == -+ (WLAN_FC_TODS | WLAN_FC_FROMDS)) -+ addr4 = 1; -+ -+ if (WLAN_FC_GET_TYPE(fc) == WLAN_FC_TYPE_DATA) { -+ fc &= ~0x0070; /* Mask subtype bits */ -+ if (stype & WLAN_FC_STYPE_QOS_DATA) { -+ const u8 *qc; -+ qos = 1; -+ fc &= ~WLAN_FC_ORDER; -+ qc = (const u8 *)hdr + 24; -+ if (addr4) -+ qc += ETH_ALEN; -+ nonce[0] = qc[0] & 0x0f; -+ } -+ } else if (WLAN_FC_GET_TYPE(fc) == WLAN_FC_TYPE_MGMT) -+ nonce[0] |= 0x10; /* Management */ -+ -+ fc &= ~(WLAN_FC_RETRY | WLAN_FC_PWRMGT | WLAN_FC_MOREDATA); -+ fc |= WLAN_FC_ISWEP; -+ WPA_PUT_LE16(aad, fc); -+ pos = aad + 2; -+ os_memcpy(pos, GetAddr1Ptr((u8 *)hdr), 3 * ETH_ALEN); -+ pos += 3 * ETH_ALEN; -+ seq = le_to_host16(hdr->seq_ctrl); -+ seq &= ~0xfff0; /* Mask Seq#; do not modify Frag# */ -+ WPA_PUT_LE16(pos, seq); -+ pos += 2; -+ -+ os_memcpy(pos, (u8 *)hdr + 24, addr4 * ETH_ALEN + qos * 2); -+ pos += addr4 * ETH_ALEN; -+ if (qos) { -+ pos[0] &= ~0x70; -+ /* only spp mode need to refer QoS bit7 */ -+ if (padapter->registrypriv.amsdu_mode != RTW_AMSDU_MODE_SPP) -+ pos[0] &= ~0x80; -+ pos++; -+ *pos++ = 0x00; -+ } -+ -+ *aad_len = pos - aad; -+ -+ os_memcpy(nonce + 1, hdr->addr2, ETH_ALEN); -+ nonce[7] = data[7]; /* PN5 */ -+ nonce[8] = data[6]; /* PN4 */ -+ nonce[9] = data[5]; /* PN3 */ -+ nonce[10] = data[4]; /* PN2 */ -+ nonce[11] = data[1]; /* PN1 */ -+ nonce[12] = data[0]; /* PN0 */ -+} -+ -+ -+static void ccmp_aad_nonce_pv1(const u8 *hdr, const u8 *a1, const u8 *a2, -+ const u8 *a3, const u8 *pn, -+ u8 *aad, size_t *aad_len, u8 *nonce) -+{ -+ u16 fc, type; -+ u8 *pos; -+ -+ nonce[0] = BIT(5); /* PV1 */ -+ /* TODO: Priority for QMF; 0 is used for Data frames */ -+ -+ fc = WPA_GET_LE16(hdr); -+ type = (fc & (BIT(2) | BIT(3) | BIT(4))) >> 2; -+ -+ if (type == 1) -+ nonce[0] |= 0x10; /* Management */ -+ -+ fc &= ~(BIT(10) | BIT(11) | BIT(13) | BIT(14) | BIT(15)); -+ fc |= BIT(12); -+ WPA_PUT_LE16(aad, fc); -+ pos = aad + 2; -+ if (type == 0 || type == 3) { -+ const u8 *sc; -+ -+ os_memcpy(pos, a1, ETH_ALEN); -+ pos += ETH_ALEN; -+ os_memcpy(pos, a2, ETH_ALEN); -+ pos += ETH_ALEN; -+ -+ if (type == 0) { -+ /* Either A1 or A2 contains SID */ -+ sc = hdr + 2 + 2 + ETH_ALEN; -+ } else { -+ /* Both A1 and A2 contain full addresses */ -+ sc = hdr + 2 + 2 * ETH_ALEN; -+ } -+ /* SC with Sequence Number subfield (bits 4-15 of the Sequence -+ * Control field) masked to 0. */ -+ *pos++ = *sc & 0x0f; -+ *pos++ = 0; -+ -+ if (a3) { -+ os_memcpy(pos, a3, ETH_ALEN); -+ pos += ETH_ALEN; -+ } -+ } -+ -+ *aad_len = pos - aad; -+ -+ os_memcpy(nonce + 1, a2, ETH_ALEN); -+ nonce[7] = pn[5]; /* PN5 */ -+ nonce[8] = pn[4]; /* PN4 */ -+ nonce[9] = pn[3]; /* PN3 */ -+ nonce[10] = pn[2]; /* PN2 */ -+ nonce[11] = pn[1]; /* PN1 */ -+ nonce[12] = pn[0]; /* PN0 */ -+} -+ -+ -+u8 * ccmp_decrypt(_adapter *padapter, const u8 *tk, const struct ieee80211_hdr *hdr, -+ const u8 *data, size_t data_len, size_t *decrypted_len) -+{ -+ u8 aad[30], nonce[13]; -+ size_t aad_len; -+ size_t mlen; -+ u8 *plain; -+ -+ if (data_len < 8 + 8) -+ return NULL; -+ -+ plain = os_malloc(data_len + AES_BLOCK_SIZE); -+ if (plain == NULL) -+ return NULL; -+ -+ mlen = data_len - 8 - 8; -+ -+ os_memset(aad, 0, sizeof(aad)); -+ ccmp_aad_nonce(padapter, hdr, data, aad, &aad_len, nonce); -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP AAD", aad, aad_len); -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP nonce", nonce, 13); -+ -+ if (aes_ccm_ad(tk, 16, nonce, 8, data + 8, mlen, aad, aad_len, -+ data + 8 + mlen, plain) < 0) { -+ u16 seq_ctrl = le_to_host16(hdr->seq_ctrl); -+ wpa_printf(_MSG_INFO_, "Invalid CCMP MIC in frame: A1=" MACSTR -+ " A2=" MACSTR " A3=" MACSTR " seq=%u frag=%u", -+ MAC2STR(hdr->addr1), MAC2STR(hdr->addr2), -+ MAC2STR(hdr->addr3), -+ WLAN_GET_SEQ_SEQ(seq_ctrl), -+ WLAN_GET_SEQ_FRAG(seq_ctrl)); -+ rtw_mfree(plain, data_len + AES_BLOCK_SIZE); -+ return NULL; -+ } -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP decrypted", plain, mlen); -+ -+ *decrypted_len = mlen; -+ return plain; -+} -+ -+ -+void ccmp_get_pn(u8 *pn, const u8 *data) -+{ -+ pn[0] = data[7]; /* PN5 */ -+ pn[1] = data[6]; /* PN4 */ -+ pn[2] = data[5]; /* PN3 */ -+ pn[3] = data[4]; /* PN2 */ -+ pn[4] = data[1]; /* PN1 */ -+ pn[5] = data[0]; /* PN0 */ -+} -+ -+ -+u8 * ccmp_encrypt(_adapter *padapter, const u8 *tk, u8 *frame, size_t len, size_t hdrlen, u8 *qos, -+ u8 *pn, int keyid, size_t *encrypted_len) -+{ -+ u8 aad[30], nonce[13]; -+ size_t aad_len, plen; -+ u8 *crypt, *pos, *pdata; -+ struct ieee80211_hdr *hdr; -+ -+ if (len < hdrlen || hdrlen < 24) -+ return NULL; -+ plen = len - hdrlen; -+ -+ crypt = os_malloc(hdrlen + 8 + plen + 8 + AES_BLOCK_SIZE); -+ if (crypt == NULL) -+ return NULL; -+ -+ if (pn == NULL) { -+ os_memcpy(crypt, frame, hdrlen + 8); -+ hdr = (struct ieee80211_hdr *) crypt; -+ hdr->frame_control |= host_to_le16(WLAN_FC_ISWEP); -+ pos = crypt + hdrlen + 8; -+ pdata = frame + hdrlen + 8; -+ } else { -+ os_memcpy(crypt, frame, hdrlen); -+ hdr = (struct ieee80211_hdr *) crypt; -+ hdr->frame_control |= host_to_le16(WLAN_FC_ISWEP); -+ pos = crypt + hdrlen; -+ *pos++ = pn[5]; /* PN0 */ -+ *pos++ = pn[4]; /* PN1 */ -+ *pos++ = 0x00; /* Rsvd */ -+ *pos++ = 0x20 | (keyid << 6); -+ *pos++ = pn[3]; /* PN2 */ -+ *pos++ = pn[2]; /* PN3 */ -+ *pos++ = pn[1]; /* PN4 */ -+ *pos++ = pn[0]; /* PN5 */ -+ pdata = frame + hdrlen; -+ } -+ -+ os_memset(aad, 0, sizeof(aad)); -+ ccmp_aad_nonce(padapter, hdr, crypt + hdrlen, aad, &aad_len, nonce); -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP AAD", aad, aad_len); -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP nonce", nonce, 13); -+ -+ if (aes_ccm_ae(tk, 16, nonce, 8, pdata, plen, aad, aad_len, -+ pos, pos + plen) < 0) { -+ rtw_mfree(crypt, hdrlen + 8 + plen + 8 + AES_BLOCK_SIZE); -+ return NULL; -+ } -+ -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP encrypted", crypt + hdrlen + 8, plen); -+ -+ *encrypted_len = hdrlen + 8 + plen + 8; -+ -+ return crypt; -+} -+ -+ -+u8 * ccmp_encrypt_pv1(const u8 *tk, const u8 *a1, const u8 *a2, const u8 *a3, -+ const u8 *frame, size_t len, -+ size_t hdrlen, const u8 *pn, int keyid, -+ size_t *encrypted_len) -+{ -+ u8 aad[24], nonce[13]; -+ size_t aad_len, plen; -+ u8 *crypt, *pos; -+ struct ieee80211_hdr *hdr; -+ -+ if (len < hdrlen || hdrlen < 12) -+ return NULL; -+ plen = len - hdrlen; -+ -+ crypt = os_malloc(hdrlen + plen + 8 + AES_BLOCK_SIZE); -+ if (crypt == NULL) -+ return NULL; -+ -+ os_memcpy(crypt, frame, hdrlen); -+ hdr = (struct ieee80211_hdr *) crypt; -+ hdr->frame_control |= host_to_le16(BIT(12)); /* Protected Frame */ -+ pos = crypt + hdrlen; -+ -+ os_memset(aad, 0, sizeof(aad)); -+ ccmp_aad_nonce_pv1(crypt, a1, a2, a3, pn, aad, &aad_len, nonce); -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP AAD", aad, aad_len); -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP nonce", nonce, sizeof(nonce)); -+ -+ if (aes_ccm_ae(tk, 16, nonce, 8, frame + hdrlen, plen, aad, aad_len, -+ pos, pos + plen) < 0) { -+ rtw_mfree(crypt, hdrlen + plen + 8 + AES_BLOCK_SIZE); -+ return NULL; -+ } -+ -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP encrypted", crypt + hdrlen, plen); -+ -+ *encrypted_len = hdrlen + plen + 8; -+ -+ return crypt; -+} -+ -+ -+u8 * ccmp_256_decrypt(_adapter *padapter, const u8 *tk, const struct ieee80211_hdr *hdr, -+ const u8 *data, size_t data_len, size_t *decrypted_len) -+{ -+ u8 aad[30], nonce[13]; -+ size_t aad_len; -+ size_t mlen; -+ u8 *plain; -+ -+ if (data_len < 8 + 16) -+ return NULL; -+ -+ plain = os_malloc(data_len + AES_BLOCK_SIZE); -+ if (plain == NULL) -+ return NULL; -+ -+ mlen = data_len - 8 - 16; -+ -+ os_memset(aad, 0, sizeof(aad)); -+ ccmp_aad_nonce(padapter, hdr, data, aad, &aad_len, nonce); -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP-256 AAD", aad, aad_len); -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP-256 nonce", nonce, 13); -+ -+ if (aes_ccm_ad(tk, 32, nonce, 16, data + 8, mlen, aad, aad_len, -+ data + 8 + mlen, plain) < 0) { -+ u16 seq_ctrl = le_to_host16(hdr->seq_ctrl); -+ wpa_printf(_MSG_INFO_, "Invalid CCMP-256 MIC in frame: A1=" MACSTR -+ " A2=" MACSTR " A3=" MACSTR " seq=%u frag=%u", -+ MAC2STR(hdr->addr1), MAC2STR(hdr->addr2), -+ MAC2STR(hdr->addr3), -+ WLAN_GET_SEQ_SEQ(seq_ctrl), -+ WLAN_GET_SEQ_FRAG(seq_ctrl)); -+ rtw_mfree(plain, data_len + AES_BLOCK_SIZE); -+ return NULL; -+ } -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP-256 decrypted", plain, mlen); -+ -+ *decrypted_len = mlen; -+ return plain; -+} -+ -+ -+u8 * ccmp_256_encrypt(_adapter *padapter, const u8 *tk, u8 *frame, size_t len, size_t hdrlen, -+ u8 *qos, u8 *pn, int keyid, size_t *encrypted_len) -+{ -+ u8 aad[30], nonce[13]; -+ size_t aad_len, plen; -+ u8 *crypt, *pos, *pdata; -+ struct ieee80211_hdr *hdr; -+ -+ if (len < hdrlen || hdrlen < 24) -+ return NULL; -+ plen = len - hdrlen; -+ -+ crypt = os_malloc(hdrlen + 8 + plen + 16 + AES_BLOCK_SIZE); -+ if (crypt == NULL) -+ return NULL; -+ -+ if (pn == NULL) { -+ os_memcpy(crypt, frame, hdrlen + 8); -+ hdr = (struct ieee80211_hdr *) crypt; -+ hdr->frame_control |= host_to_le16(WLAN_FC_ISWEP); -+ pos = crypt + hdrlen + 8; -+ pdata = frame + hdrlen + 8; -+ } else { -+ os_memcpy(crypt, frame, hdrlen); -+ hdr = (struct ieee80211_hdr *) crypt; -+ hdr->frame_control |= host_to_le16(WLAN_FC_ISWEP); -+ pos = crypt + hdrlen; -+ *pos++ = pn[5]; /* PN0 */ -+ *pos++ = pn[4]; /* PN1 */ -+ *pos++ = 0x00; /* Rsvd */ -+ *pos++ = 0x20 | (keyid << 6); -+ *pos++ = pn[3]; /* PN2 */ -+ *pos++ = pn[2]; /* PN3 */ -+ *pos++ = pn[1]; /* PN4 */ -+ *pos++ = pn[0]; /* PN5 */ -+ pdata = frame + hdrlen; -+ } -+ -+ os_memset(aad, 0, sizeof(aad)); -+ ccmp_aad_nonce(padapter, hdr, crypt + hdrlen, aad, &aad_len, nonce); -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP-256 AAD", aad, aad_len); -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP-256 nonce", nonce, 13); -+ -+ if (aes_ccm_ae(tk, 32, nonce, 16, pdata, plen, aad, aad_len, -+ pos, pos + plen) < 0) { -+ rtw_mfree(crypt, hdrlen + 8 + plen + 16 + AES_BLOCK_SIZE); -+ return NULL; -+ } -+ -+ wpa_hexdump(_MSG_EXCESSIVE_, "CCMP-256 encrypted", crypt + hdrlen + 8, -+ plen); -+ -+ *encrypted_len = hdrlen + 8 + plen + 16; -+ -+ return crypt; -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/gcmp.c b/drivers/net/wireless/rtl8821cs/core/crypto/gcmp.c -new file mode 100644 -index 000000000..9141d5520 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/gcmp.c -@@ -0,0 +1,194 @@ -+/* -+ * GCM with GMAC Protocol (GCMP) -+ * Copyright (c) 2012, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+#include "aes.h" -+#include "aes_wrap.h" -+#include "wlancrypto_wrap.h" -+ -+ -+static void gcmp_aad_nonce(_adapter * padapter, const struct ieee80211_hdr *hdr, const u8 *data, -+ u8 *aad, size_t *aad_len, u8 *nonce) -+{ -+ u16 fc, stype, seq; -+ int qos = 0, addr4 = 0; -+ u8 *pos; -+ -+ fc = le_to_host16(hdr->frame_control); -+ stype = WLAN_FC_GET_STYPE(fc); -+ if ((fc & (WLAN_FC_TODS | WLAN_FC_FROMDS)) == -+ (WLAN_FC_TODS | WLAN_FC_FROMDS)) -+ addr4 = 1; -+ -+ if (WLAN_FC_GET_TYPE(fc) == WLAN_FC_TYPE_DATA) { -+ fc &= ~0x0070; /* Mask subtype bits */ -+ if (stype & WLAN_FC_STYPE_QOS_DATA) { -+ const u8 *qc; -+ qos = 1; -+ fc &= ~WLAN_FC_ORDER; -+ qc = (const u8 *)hdr + 24; -+ if (addr4) -+ qc += ETH_ALEN; -+ } -+ } -+ -+ fc &= ~(WLAN_FC_RETRY | WLAN_FC_PWRMGT | WLAN_FC_MOREDATA); -+ WPA_PUT_LE16(aad, fc); -+ pos = aad + 2; -+ os_memcpy(pos, GetAddr1Ptr((u8 *)hdr), 3 * ETH_ALEN); -+ pos += 3 * ETH_ALEN; -+ seq = le_to_host16(hdr->seq_ctrl); -+ seq &= ~0xfff0; /* Mask Seq#; do not modify Frag# */ -+ WPA_PUT_LE16(pos, seq); -+ pos += 2; -+ -+ wpa_printf(_MSG_INFO_, "pos - aad = %u, qos(%d)\n", (pos - aad), qos); -+ -+ os_memcpy(pos, (u8 *)hdr + 24, addr4 * ETH_ALEN + qos * 2); -+ pos += addr4 * ETH_ALEN; -+ if (qos) { -+ pos[0] &= ~0x70; -+ /* only spp mode need to refer QoS bit7 */ -+ if (padapter->registrypriv.amsdu_mode != RTW_AMSDU_MODE_SPP) -+ pos[0] &= ~0x80; -+ pos++; -+ *pos++ = 0x00; -+ } -+ -+ wpa_printf(_MSG_INFO_, "pos - aad = %u\n", (pos - aad)); -+ *aad_len = pos - aad; -+ -+ os_memcpy(nonce, hdr->addr2, ETH_ALEN); -+ nonce[6] = data[7]; /* PN5 */ -+ nonce[7] = data[6]; /* PN4 */ -+ nonce[8] = data[5]; /* PN3 */ -+ nonce[9] = data[4]; /* PN2 */ -+ nonce[10] = data[1]; /* PN1 */ -+ nonce[11] = data[0]; /* PN0 */ -+} -+ -+/** -+ * gcmp_decrypt - -+ * @tk: the temporal key -+ * @tk_len: length of @tk -+ * @hdr: the mac header -+ * @data: payload after mac header (PN + enc_data + MIC) -+ * @data_len: length of @data (PN + enc_data + MIC) -+ * @decrypted_len: length of the data decrypted -+ */ -+u8 * gcmp_decrypt(_adapter *padapter, const u8 *tk, size_t tk_len, const struct ieee80211_hdr *hdr, -+ const u8 *data, size_t data_len, size_t *decrypted_len) -+{ -+ u8 aad[30], nonce[12], *plain; -+ size_t aad_len, mlen; -+ const u8 *m; -+ -+ if (data_len < 8 + 16) -+ return NULL; -+ -+ plain = os_malloc(data_len + AES_BLOCK_SIZE); -+ if (plain == NULL) -+ return NULL; -+ -+ m = data + 8; -+ mlen = data_len - 8 - 16; -+ -+ os_memset(aad, 0, sizeof(aad)); -+ gcmp_aad_nonce(padapter, hdr, data, aad, &aad_len, nonce); -+ wpa_hexdump(_MSG_EXCESSIVE_, "GCMP AAD", aad, aad_len); -+ wpa_hexdump(_MSG_EXCESSIVE_, "GCMP nonce", nonce, sizeof(nonce)); -+ -+ if (aes_gcm_ad(tk, tk_len, nonce, sizeof(nonce), m, mlen, aad, aad_len, -+ m + mlen, plain) < 0) { -+ u16 seq_ctrl = le_to_host16(hdr->seq_ctrl); -+ wpa_printf(_MSG_INFO_, "Invalid GCMP frame: A1=" MACSTR -+ " A2=" MACSTR " A3=" MACSTR " seq=%u frag=%u", -+ MAC2STR(hdr->addr1), MAC2STR(hdr->addr2), -+ MAC2STR(hdr->addr3), -+ WLAN_GET_SEQ_SEQ(seq_ctrl), -+ WLAN_GET_SEQ_FRAG(seq_ctrl)); -+ rtw_mfree(plain, data_len + AES_BLOCK_SIZE); -+ return NULL; -+ } -+ -+ *decrypted_len = mlen; -+ return plain; -+} -+ -+/** -+ * gcmp_encrypt - -+ * @tk: the temporal key -+ * @tk_len: length of @tk -+ * @frame: the point to mac header, the frame including mac header and payload, -+ * if @pn is NULL, then the frame including pn -+ * @len: length of @frame -+ * length = mac header + payload -+ * @hdrlen: length of the mac header -+ * @qos: pointer to the QOS field of the frame -+ * @pn: packet number -+ * @keyid: key id -+ * @encrypted_len: length of the encrypted frame -+ * including mac header, pn, payload and MIC -+ */ -+u8 * gcmp_encrypt(_adapter *padapter, const u8 *tk, size_t tk_len, const u8 *frame, size_t len, -+ size_t hdrlen, const u8 *qos, -+ const u8 *pn, int keyid, size_t *encrypted_len) -+{ -+ u8 aad[30], nonce[12], *crypt, *pos; -+ const u8 *pdata; -+ size_t aad_len, plen; -+ struct ieee80211_hdr *hdr; -+ -+ if (len < hdrlen || hdrlen < 24) -+ return NULL; -+ plen = len - hdrlen; -+ -+ crypt = os_malloc(hdrlen + 8 + plen + 16 + AES_BLOCK_SIZE); -+ if (crypt == NULL) -+ return NULL; -+ -+ if (pn == NULL) { -+ os_memcpy(crypt, frame, hdrlen + 8); -+ hdr = (struct ieee80211_hdr *)crypt; -+ pos = crypt + hdrlen + 8; -+ pdata = frame + hdrlen + 8; -+ } else { -+ os_memcpy(crypt, frame, hdrlen); -+ hdr = (struct ieee80211_hdr *)crypt; -+ pos = crypt + hdrlen; -+ -+ *pos++ = pn[5]; /* PN0 */ -+ *pos++ = pn[4]; /* PN1 */ -+ *pos++ = 0x00; /* Rsvd */ -+ *pos++ = 0x20 | (keyid << 6); -+ *pos++ = pn[3]; /* PN2 */ -+ *pos++ = pn[2]; /* PN3 */ -+ *pos++ = pn[1]; /* PN4 */ -+ *pos++ = pn[0]; /* PN5 */ -+ pdata = frame + hdrlen; -+ } -+ -+ os_memset(aad, 0, sizeof(aad)); -+ gcmp_aad_nonce(padapter, hdr, crypt + hdrlen, aad, &aad_len, nonce); -+ wpa_hexdump(_MSG_EXCESSIVE_, "GCMP AAD", aad, aad_len); -+ wpa_hexdump(_MSG_EXCESSIVE_, "GCMP nonce", nonce, sizeof(nonce)); -+ -+ if (aes_gcm_ae(tk, tk_len, nonce, sizeof(nonce), pdata, plen, -+ aad, aad_len, pos, pos + plen) < 0) { -+ rtw_mfree(crypt, hdrlen + 8 + plen + 16 + AES_BLOCK_SIZE); -+ return NULL; -+ } -+ -+ wpa_hexdump(_MSG_EXCESSIVE_, "GCMP MIC", pos + plen, 16); -+ wpa_hexdump(_MSG_EXCESSIVE_, "GCMP encrypted", pos, plen); -+ -+ *encrypted_len = hdrlen + 8 + plen + 16; -+ -+ return crypt; -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/rtw_crypto_wrap.c b/drivers/net/wireless/rtl8821cs/core/crypto/rtw_crypto_wrap.c -new file mode 100644 -index 000000000..8fdb3c903 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/rtw_crypto_wrap.c -@@ -0,0 +1,85 @@ -+#include "rtw_crypto_wrap.h" -+ -+#ifndef DEBUG_CRYPTO -+#define DEBUG_CRYPTO 0 -+#endif /* DEBUG_CRYTO */ -+ -+int os_memcmp(const void *s1, const void *s2, size_t n) -+{ -+ return _rtw_memcmp2(s1, s2, n); -+} -+ -+int os_memcmp_const(const void *a, const void *b, size_t len) -+{ -+ const u8 *aa = a; -+ const u8 *bb = b; -+ size_t i; -+ u8 res; -+ -+ for (res = 0, i = 0; i < len; i++) -+ res |= aa[i] ^ bb[i]; -+ -+ return res; -+} -+ -+void* os_memdup(const void *src, u32 sz) -+{ -+ void *r = rtw_malloc(sz); -+ -+ if (r && src) -+ _rtw_memcpy(r, src, sz); -+ return r; -+} -+ -+size_t os_strlen(const char *s) -+{ -+ const char *p = s; -+ while (*p) -+ p++; -+ return p - s; -+} -+ -+ -+void forced_memzero(void *ptr, size_t len) -+{ -+ _rtw_memset(ptr, 0, len); -+} -+ -+void bin_clear_free(void *bin, size_t len) -+{ -+ if (bin) { -+ forced_memzero(bin, len); -+ rtw_mfree(bin, len); -+ } -+} -+ -+void wpa_printf(int level, const char *fmt, ...) -+{ -+#if DEBUG_CRYPTO -+#define MSG_LEN 100 -+ va_list args; -+ u8 buf[MSG_LEN] = { 0 }; -+ int err; -+ -+ va_start(args, fmt); -+ err = vsnprintf(buf, MSG_LEN, fmt, args); -+ va_end(args); -+ -+ RTW_INFO("%s", buf); -+#undef MSG_LEN -+#endif /* DEBUG_CRYPTO */ -+} -+ -+void wpa_hexdump(int level, const char *title, const void *buf, size_t len) -+{ -+#if DEBUG_CRYPTO -+ RTW_INFO_DUMP((u8 *)title, buf, len); -+#endif /* DEBUG_CRYPTO */ -+} -+ -+void wpa_hexdump_key(int level, const char *title, const void *buf, size_t len) -+{ -+#if DEBUG_CRYPTO -+ RTW_INFO_DUMP((u8 *)title, buf, len); -+#endif /* DEBUG_CRYPTO */ -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/rtw_crypto_wrap.h b/drivers/net/wireless/rtl8821cs/core/crypto/rtw_crypto_wrap.h -new file mode 100644 -index 000000000..9b64a1419 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/rtw_crypto_wrap.h -@@ -0,0 +1,64 @@ -+#ifndef RTW_CRYTO_WRAP_H -+#define RTW_CRYTO_WRAP_H -+ -+#include -+ -+#define TEST_FAIL() 0 -+ -+#define os_memset _rtw_memset -+#define os_memcpy _rtw_memcpy -+#define os_malloc rtw_malloc -+ -+#define le_to_host16 le16_to_cpu -+#define host_to_le16 cpu_to_le16 -+ -+#define WPA_PUT_LE16 RTW_PUT_LE16 -+#define WPA_GET_LE16 RTW_GET_LE16 -+#define WPA_PUT_LE32 RTW_PUT_LE32 -+#define WPA_GET_LE32 RTW_GET_LE32 -+#define WPA_PUT_LE64 RTW_PUT_LE64 -+#define WPA_GET_LE64 RTW_GET_LE64 -+#define WPA_PUT_BE16 RTW_PUT_BE16 -+#define WPA_GET_BE16 RTW_GET_BE16 -+#define WPA_PUT_BE32 RTW_PUT_BE32 -+#define WPA_GET_BE32 RTW_GET_BE32 -+#define WPA_PUT_BE64 RTW_PUT_BE64 -+#define WPA_GET_BE64 RTW_GET_BE64 -+ -+#ifndef MAC2STR -+#define MAC2STR(a) (a)[0], (a)[1], (a)[2], (a)[3], (a)[4], (a)[5] -+#define MACSTR "%02x:%02x:%02x:%02x:%02x:%02x" -+#endif -+ -+#define WLAN_FC_PVER 0x0003 -+#define WLAN_FC_TODS 0x0100 -+#define WLAN_FC_FROMDS 0x0200 -+#define WLAN_FC_MOREFRAG 0x0400 -+#define WLAN_FC_RETRY 0x0800 -+#define WLAN_FC_PWRMGT 0x1000 -+#define WLAN_FC_MOREDATA 0x2000 -+#define WLAN_FC_ISWEP 0x4000 -+#define WLAN_FC_ORDER 0x8000 -+ -+#define WLAN_FC_TYPE_DATA RTW_IEEE80211_FTYPE_DATA -+#define WLAN_FC_TYPE_MGMT RTW_IEEE80211_FTYPE_MGMT -+ -+#define WLAN_FC_STYPE_QOS_DATA RTW_IEEE80211_STYPE_QOS_DATA -+ -+enum { -+ _MSG_EXCESSIVE_, _MSG_MSGDUMP_, _MSG_DEBUG_, _MSG_INFO_, _MSG_WARNING_, _MSG_ERROR_ -+}; -+ -+int os_memcmp(const void *s1, const void *s2, size_t n); -+int os_memcmp_const(const void *a, const void *b, size_t len); -+void* os_memdup(const void *src, u32 sz); -+size_t os_strlen(const char *s); -+ -+void forced_memzero(void *ptr, size_t len); -+void bin_clear_free(void *bin, size_t len); -+ -+void wpa_printf(int level, const char *fmt, ...); -+void wpa_hexdump(int level, const char *title, const void *buf, size_t len); -+void wpa_hexdump_key(int level, const char *title, const void *buf, size_t len); -+ -+#endif /* RTW_CRYTO_WRAP_H */ -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/sha256-internal.c b/drivers/net/wireless/rtl8821cs/core/crypto/sha256-internal.c -new file mode 100644 -index 000000000..98228ea33 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/sha256-internal.c -@@ -0,0 +1,230 @@ -+/* -+ * SHA-256 hash implementation and interface functions -+ * Copyright (c) 2003-2011, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+//#include "common.h" -+#include "sha256.h" -+#include "sha256_i.h" -+//#include "crypto.h" -+#include "wlancrypto_wrap.h" -+ -+ -+/** -+ * 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 -+ */ -+int sha256_vector(size_t num_elem, const u8 *addr[], const size_t *len, -+ u8 *mac) -+{ -+ struct _sha256_state ctx; -+ size_t i; -+ -+ if (TEST_FAIL()) -+ return -1; -+ -+ _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; -+} -+ -+ -+/* ===== 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 -+ -+/* 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) \ -+ t0 = h + Sigma1(e) + Ch(e, f, g) + K[i] + W[i]; \ -+ t1 = Sigma0(a) + Maj(a, b, c); \ -+ d += t0; \ -+ h = t0 + t1; -+ -+ 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 */ -+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 -+*/ -+int sha256_process(struct _sha256_state *md, const unsigned char *in, -+ unsigned long inlen) -+{ -+ unsigned long n; -+ -+ if (md->curlen >= sizeof(md->buf)) -+ return -1; -+ -+ while (inlen > 0) { -+ if (md->curlen == 0 && inlen >= SHA256_BLOCK_SIZE) { -+ if (sha256_compress(md, (unsigned char *) in) < 0) -+ return -1; -+ md->length += SHA256_BLOCK_SIZE * 8; -+ in += SHA256_BLOCK_SIZE; -+ inlen -= SHA256_BLOCK_SIZE; -+ } else { -+ n = MIN(inlen, (SHA256_BLOCK_SIZE - md->curlen)); -+ os_memcpy(md->buf + md->curlen, in, n); -+ md->curlen += n; -+ in += n; -+ inlen -= n; -+ if (md->curlen == SHA256_BLOCK_SIZE) { -+ if (sha256_compress(md, md->buf) < 0) -+ return -1; -+ md->length += 8 * SHA256_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 -+*/ -+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 < SHA256_BLOCK_SIZE) { -+ md->buf[md->curlen++] = (unsigned char) 0; -+ } -+ sha256_compress(md, md->buf); -+ md->curlen = 0; -+ } -+ -+ /* pad up to 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; -+} -+ -+/* ===== end - public domain SHA256 implementation ===== */ -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/sha256-prf.c b/drivers/net/wireless/rtl8821cs/core/crypto/sha256-prf.c -new file mode 100644 -index 000000000..642b38ff6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/sha256-prf.c -@@ -0,0 +1,109 @@ -+/* -+ * SHA256-based PRF (IEEE 802.11r) -+ * Copyright (c) 2003-2016, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+//#include "common.h" -+#include "sha256.h" -+//#include "crypto.h" -+#include "wlancrypto_wrap.h" -+ -+ -+/** -+ * 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 -+ * Returns: 0 on success, -1 on failure -+ * -+ * This function is used to derive new, cryptographically separate keys from a -+ * given key. -+ */ -+int sha256_prf(const u8 *key, size_t key_len, const char *label, -+ const u8 *data, size_t data_len, u8 *buf, size_t buf_len) -+{ -+ return sha256_prf_bits(key, key_len, label, data, data_len, buf, -+ buf_len * 8); -+} -+ -+ -+/** -+ * sha256_prf_bits - IEEE Std 802.11-2012, 11.6.1.7.2 Key derivation function -+ * @key: Key for KDF -+ * @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 bits of key to generate -+ * Returns: 0 on success, -1 on failure -+ * -+ * This function is used to derive new, cryptographically separate keys from a -+ * given key. If the requested buf_len is not divisible by eight, the least -+ * significant 1-7 bits of the last octet in the output are not part of the -+ * requested output. -+ */ -+int sha256_prf_bits(const u8 *key, size_t key_len, const char *label, -+ const u8 *data, size_t data_len, u8 *buf, -+ size_t buf_len_bits) -+{ -+ u16 counter = 1; -+ size_t pos, plen; -+ u8 hash[SHA256_MAC_LEN]; -+ const u8 *addr[4]; -+ size_t len[4]; -+ u8 counter_le[2], length_le[2]; -+ size_t buf_len = (buf_len_bits + 7) / 8; -+ -+ 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_bits); -+ pos = 0; -+ while (pos < buf_len) { -+ plen = buf_len - pos; -+ WPA_PUT_LE16(counter_le, counter); -+ if (plen >= SHA256_MAC_LEN) { -+ if (hmac_sha256_vector(key, key_len, 4, addr, len, -+ &buf[pos]) < 0) -+ return -1; -+ pos += SHA256_MAC_LEN; -+ } else { -+ if (hmac_sha256_vector(key, key_len, 4, addr, len, -+ hash) < 0) -+ return -1; -+ os_memcpy(&buf[pos], hash, plen); -+ pos += plen; -+ break; -+ } -+ counter++; -+ } -+ -+ /* -+ * Mask out unused bits in the last octet if it does not use all the -+ * bits. -+ */ -+ if (buf_len_bits % 8) { -+ u8 mask = 0xff << (8 - buf_len_bits % 8); -+ buf[pos - 1] &= mask; -+ } -+ -+ forced_memzero(hash, sizeof(hash)); -+ -+ return 0; -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/sha256.c b/drivers/net/wireless/rtl8821cs/core/crypto/sha256.c -new file mode 100644 -index 000000000..ea5d9e3f2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/sha256.c -@@ -0,0 +1,104 @@ -+/* -+ * SHA-256 hash implementation and interface functions -+ * Copyright (c) 2003-2012, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#include "rtw_crypto_wrap.h" -+ -+#include "sha256.h" -+//#include "crypto.h" -+#include "wlancrypto_wrap.h" -+ -+ -+/** -+ * 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) -+ * Returns: 0 on success, -1 on failure -+ */ -+int hmac_sha256_vector(const u8 *key, size_t key_len, size_t num_elem, -+ const u8 *addr[], const size_t *len, u8 *mac) -+{ -+ unsigned char k_pad[64]; /* padding - key XORd with ipad/opad */ -+ unsigned char tk[32]; -+ const 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 -1; -+ } -+ -+ /* if key is longer than 64 bytes reset it to key = SHA256(key) */ -+ if (key_len > 64) { -+ if (sha256_vector(1, &key, &key_len, tk) < 0) -+ return -1; -+ 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 */ -+ os_memset(k_pad, 0, sizeof(k_pad)); -+ os_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]; -+ } -+ if (sha256_vector(1 + num_elem, _addr, _len, mac) < 0) -+ return -1; -+ -+ os_memset(k_pad, 0, sizeof(k_pad)); -+ os_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] = SHA256_MAC_LEN; -+ return sha256_vector(2, _addr, _len, mac); -+} -+ -+ -+/** -+ * hmac_sha256 - HMAC-SHA256 over data buffer (RFC 2104) -+ * @key: Key for HMAC operations -+ * @key_len: Length of the key in bytes -+ * @data: Pointers to the data area -+ * @data_len: Length of the data area -+ * @mac: Buffer for the hash (32 bytes) -+ * Returns: 0 on success, -1 on failure -+ */ -+int hmac_sha256(const u8 *key, size_t key_len, const u8 *data, -+ size_t data_len, u8 *mac) -+{ -+ return hmac_sha256_vector(key, key_len, 1, &data, &data_len, mac); -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/sha256.h b/drivers/net/wireless/rtl8821cs/core/crypto/sha256.h -new file mode 100644 -index 000000000..5219022ed ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/sha256.h -@@ -0,0 +1,30 @@ -+/* -+ * SHA256 hash implementation and interface functions -+ * Copyright (c) 2003-2016, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#ifndef SHA256_H -+#define SHA256_H -+ -+#define SHA256_MAC_LEN 32 -+ -+int hmac_sha256_vector(const u8 *key, size_t key_len, size_t num_elem, -+ const u8 *addr[], const size_t *len, u8 *mac); -+int hmac_sha256(const u8 *key, size_t key_len, const u8 *data, -+ size_t data_len, u8 *mac); -+int sha256_prf(const u8 *key, size_t key_len, const char *label, -+ const u8 *data, size_t data_len, u8 *buf, size_t buf_len); -+int sha256_prf_bits(const u8 *key, size_t key_len, const char *label, -+ const u8 *data, size_t data_len, u8 *buf, -+ size_t buf_len_bits); -+void tls_prf_sha256(const u8 *secret, size_t secret_len, -+ const char *label, const u8 *seed, size_t seed_len, -+ u8 *out, size_t outlen); -+int hmac_sha256_kdf(const u8 *secret, size_t secret_len, -+ const char *label, const u8 *seed, size_t seed_len, -+ u8 *out, size_t outlen); -+ -+#endif /* SHA256_H */ -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/sha256_i.h b/drivers/net/wireless/rtl8821cs/core/crypto/sha256_i.h -new file mode 100644 -index 000000000..11ddd6b14 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/sha256_i.h -@@ -0,0 +1,25 @@ -+/* -+ * SHA-256 internal definitions -+ * Copyright (c) 2003-2011, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#ifndef SHA256_I_H -+#define SHA256_I_H -+ -+#define SHA256_BLOCK_SIZE 64 -+ -+struct _sha256_state { -+ u64 length; -+ u32 state[8], curlen; -+ u8 buf[SHA256_BLOCK_SIZE]; -+}; -+ -+void _sha256_init(struct _sha256_state *md); -+int sha256_process(struct _sha256_state *md, const unsigned char *in, -+ unsigned long inlen); -+int sha256_done(struct _sha256_state *md, unsigned char *out); -+ -+#endif /* SHA256_I_H */ -diff --git a/drivers/net/wireless/rtl8821cs/core/crypto/wlancrypto_wrap.h b/drivers/net/wireless/rtl8821cs/core/crypto/wlancrypto_wrap.h -new file mode 100644 -index 000000000..b909a4393 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/crypto/wlancrypto_wrap.h -@@ -0,0 +1,34 @@ -+/* -+ * wlantest - IEEE 802.11 protocol monitoring and testing tool -+ * Copyright (c) 2010-2013, Jouni Malinen -+ * -+ * This software may be distributed under the terms of the BSD license. -+ * See README for more details. -+ */ -+ -+#ifndef WLANCRYPTO_WRAP_H -+#define WLANCRYPTO_WRAP_H -+ -+int sha256_vector(size_t num_elem, const u8 *addr[], const size_t *len, -+ u8 *mac); -+ -+u8* ccmp_decrypt(_adapter *padapter, const u8 *tk, const struct ieee80211_hdr *hdr, -+ const u8 *data, size_t data_len, size_t *decrypted_len); -+u8* ccmp_encrypt(_adapter *padapter, const u8 *tk, u8 *frame, size_t len, size_t hdrlen, u8 *qos, -+ u8 *pn, int keyid, size_t *encrypted_len); -+u8* ccmp_encrypt_pv1(const u8 *tk, const u8 *a1, const u8 *a2, const u8 *a3, -+ const u8 *frame, size_t len, -+ size_t hdrlen, const u8 *pn, int keyid, -+ size_t *encrypted_len); -+u8* ccmp_256_decrypt(_adapter *padapter, const u8 *tk, const struct ieee80211_hdr *hdr, -+ const u8 *data, size_t data_len, size_t *decrypted_len); -+u8* ccmp_256_encrypt(_adapter *padapter, const u8 *tk, u8 *frame, size_t len, size_t hdrlen, -+ u8 *qos, u8 *pn, int keyid, size_t *encrypted_len); -+ -+u8* gcmp_decrypt(_adapter *padapter, const u8 *tk, size_t tk_len, const struct ieee80211_hdr *hdr, -+ const u8 *data, size_t data_len, size_t *decrypted_len); -+u8* gcmp_encrypt(_adapter *padapter, const u8 *tk, size_t tk_len, const u8 *frame, size_t len, -+ size_t hdrlen, const u8 *qos, -+ const u8 *pn, int keyid, size_t *encrypted_len); -+ -+#endif /* WLANCRYPTO_WRAP_H */ -diff --git a/drivers/net/wireless/rtl8821cs/core/efuse/rtw_efuse.c b/drivers/net/wireless/rtl8821cs/core/efuse/rtw_efuse.c -new file mode 100644 -index 000000000..1768cb2e0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/efuse/rtw_efuse.c -@@ -0,0 +1,3612 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "../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]; -+u8 btmaskfileBuffer[64]; -+ -+/*------------------------Define local variable------------------------------*/ -+BOOLEAN rtw_file_efuse_IsMasked(PADAPTER pAdapter, u16 Offset, u8 *maskbuf) -+{ -+ 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 = (maskbuf[r] & (0x10 << c)); -+ else -+ result = (maskbuf[r] & (0x01 << (c - 4))); -+ -+ return (result > 0) ? 0 : 1; -+} -+ -+BOOLEAN efuse_IsBT_Masked(PADAPTER pAdapter, u16 Offset) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+ if (pAdapter->registrypriv.boffefusemask) -+ return FALSE; -+ -+#ifdef CONFIG_BT_EFUSE_MASK -+#ifdef CONFIG_RTL8822C -+#ifdef CONFIG_USB_HCI -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ return (IS_BT_MASKED(8822C, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#ifdef CONFIG_PCI_HCI -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ return (IS_BT_MASKED(8822C, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+#ifdef CONFIG_SDIO_HCI -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ return (IS_BT_MASKED(8822C, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#endif /*#ifdef CONFIG_RTL8822C*/ -+#ifdef CONFIG_RTL8723F -+#ifdef CONFIG_USB_HCI -+ if (IS_HARDWARE_TYPE_8723F(pAdapter)) -+ return (IS_BT_MASKED(8723F, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#ifdef CONFIG_SDIO_HCI -+ if (IS_HARDWARE_TYPE_8723F(pAdapter)) -+ return (IS_BT_MASKED(8723F, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#endif /*#ifdef CONFIG_RTL8723F*/ -+#endif /* CONFIG_BT_EFUSE_MASK */ -+ return FALSE; -+} -+ -+void rtw_bt_efuse_mask_array(PADAPTER pAdapter, u8 *pArray) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+#ifdef CONFIG_BT_EFUSE_MASK -+#ifdef CONFIG_RTL8822C -+#ifdef CONFIG_USB_HCI -+if (IS_HARDWARE_TYPE_8822CU(pAdapter)) -+ GET_BT_MASK_ARRAY(8822C, _MUSB, pArray); -+#endif -+#ifdef CONFIG_PCI_HCI -+ if (IS_HARDWARE_TYPE_8822CE(pAdapter)) -+ GET_BT_MASK_ARRAY(8822C, _MPCIE, pArray); -+#endif -+#ifdef CONFIG_SDIO_HCI -+ if (IS_HARDWARE_TYPE_8822CS(pAdapter)) -+ GET_BT_MASK_ARRAY(8822C, _MSDIO, pArray); -+#endif -+#endif /*#ifdef CONFIG_RTL8822C*/ -+#ifdef CONFIG_RTL8723F -+#ifdef CONFIG_USB_HCI -+ if (IS_HARDWARE_TYPE_8723FU(pAdapter)) -+ GET_BT_MASK_ARRAY(8723F, _MUSB, pArray); -+#endif -+#ifdef CONFIG_SDIO_HCI -+ if (IS_HARDWARE_TYPE_8723FS(pAdapter)) -+ GET_BT_MASK_ARRAY(8723F, _MSDIO, pArray); -+#endif -+#endif /*#ifdef CONFIG_RTL8723F*/ -+#endif /* CONFIG_BT_EFUSE_MASK */ -+ -+} -+ -+u16 rtw_get_bt_efuse_mask_arraylen(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+#ifdef CONFIG_BT_EFUSE_MASK -+#ifdef CONFIG_RTL8822C -+#ifdef CONFIG_USB_HCI -+ if (IS_HARDWARE_TYPE_8822CU(pAdapter)) -+ return GET_BT_MASK_ARRAY_LEN(8822C, _MUSB); -+#endif -+#ifdef CONFIG_PCI_HCI -+ if (IS_HARDWARE_TYPE_8822CE(pAdapter)) -+ return GET_BT_MASK_ARRAY_LEN(8822C, _MPCIE); -+#endif -+#ifdef CONFIG_SDIO_HCI -+ if (IS_HARDWARE_TYPE_8822CS(pAdapter)) -+ return GET_BT_MASK_ARRAY_LEN(8822C, _MSDIO); -+#endif -+#endif /*#ifdef CONFIG_RTL8822C*/ -+#ifdef CONFIG_RTL8723F -+#ifdef CONFIG_USB_HCI -+ if (IS_HARDWARE_TYPE_8723FU(pAdapter)) -+ return GET_BT_MASK_ARRAY_LEN(8723F, _MUSB); -+#endif -+#ifdef CONFIG_SDIO_HCI -+ if (IS_HARDWARE_TYPE_8723FS(pAdapter)) -+ return GET_BT_MASK_ARRAY_LEN(8723F, _MSDIO); -+#endif -+#endif /*CONFIG_RTL8723F*/ -+#endif /* CONFIG_BT_EFUSE_MASK */ -+ -+ return 0; -+} -+ -+BOOLEAN efuse_IsMasked(PADAPTER pAdapter, u16 Offset) -+{ -+ -+ if (pAdapter->registrypriv.boffefusemask) -+ return FALSE; -+ -+#ifdef CONFIG_USB_HCI -+#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_RTL8188GTV) -+ if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) -+ return (IS_MASKED(8188GTV, _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_RTL8710B) -+ if (IS_HARDWARE_TYPE_8710B(pAdapter)) -+ return (IS_MASKED(8710B, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821CU(pAdapter)) -+ return (IS_MASKED(8821C, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+ -+#if defined(CONFIG_RTL8192F) -+ if (IS_HARDWARE_TYPE_8192FU(pAdapter)) -+ return (IS_MASKED(8192F, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8822C) -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ return (IS_MASKED(8822C, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8814B) -+ if (IS_HARDWARE_TYPE_8814B(pAdapter)) -+ return (IS_MASKED(8814B, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8723F) -+ if (IS_HARDWARE_TYPE_8723F(pAdapter)) -+ return (IS_MASKED(8723F, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#endif /*CONFIG_USB_HCI*/ -+ -+#ifdef CONFIG_PCI_HCI -+#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 -+#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821CE(pAdapter)) -+ return (IS_MASKED(8821C, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+ -+#if defined(CONFIG_RTL8192F) -+ if (IS_HARDWARE_TYPE_8192FE(pAdapter)) -+ return (IS_MASKED(8192F, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8822C) -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ return (IS_MASKED(8822C, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8814B) -+ if (IS_HARDWARE_TYPE_8814B(pAdapter)) -+ return (IS_MASKED(8814B, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+#endif /*CONFIG_PCI_HCI*/ -+ -+#ifdef CONFIG_SDIO_HCI -+#ifdef CONFIG_RTL8188E_SDIO -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return (IS_MASKED(8188E, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#ifdef CONFIG_RTL8723B -+ if (IS_HARDWARE_TYPE_8723BS(pAdapter)) -+ return (IS_MASKED(8723B, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#ifdef CONFIG_RTL8188F -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ return (IS_MASKED(8188F, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#ifdef CONFIG_RTL8188GTV -+ if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) -+ return (IS_MASKED(8188GTV, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#ifdef CONFIG_RTL8192E -+ if (IS_HARDWARE_TYPE_8192ES(pAdapter)) -+ return (IS_MASKED(8192E, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_8821S(pAdapter)) -+ return (IS_MASKED(8821A, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821CS(pAdapter)) -+ return (IS_MASKED(8821C, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8822B) -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) -+ return (IS_MASKED(8822B, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8192F) -+ if (IS_HARDWARE_TYPE_8192FS(pAdapter)) -+ return (IS_MASKED(8192F, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8822C) -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ return (IS_MASKED(8822C, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8723F) -+ if (IS_HARDWARE_TYPE_8723F(pAdapter)) -+ return (IS_MASKED(8723F, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#endif /*CONFIG_SDIO_HCI*/ -+ -+ return FALSE; -+} -+ -+void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray) -+{ -+ -+#ifdef CONFIG_USB_HCI -+#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_RTL8188GTV) -+ if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) -+ GET_MASK_ARRAY(8188GTV, _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_8821CU(pAdapter)) -+ GET_MASK_ARRAY(8821C, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8192F) -+ if (IS_HARDWARE_TYPE_8192FU(pAdapter)) -+ GET_MASK_ARRAY(8192F, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8822C) -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ GET_MASK_ARRAY(8822C, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8814B) -+ if (IS_HARDWARE_TYPE_8814B(pAdapter)) -+ GET_MASK_ARRAY(8814B, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8723F) -+ if (IS_HARDWARE_TYPE_8723F(pAdapter)) -+ GET_MASK_ARRAY(8723F, _MUSB, pArray); -+#endif -+#endif /*CONFIG_USB_HCI*/ -+ -+#ifdef CONFIG_PCI_HCI -+#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 -+#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821CE(pAdapter)) -+ GET_MASK_ARRAY(8821C, _MPCIE, pArray); -+#endif -+#if defined(CONFIG_RTL8192F) -+ if (IS_HARDWARE_TYPE_8192FE(pAdapter)) -+ GET_MASK_ARRAY(8192F, _MPCIE, pArray); -+#endif -+#if defined(CONFIG_RTL8822C) -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ GET_MASK_ARRAY(8822C, _MPCIE, pArray); -+#endif -+#if defined(CONFIG_RTL8814B) -+ if (IS_HARDWARE_TYPE_8814B(pAdapter)) -+ GET_MASK_ARRAY(8814B, _MPCIE, pArray); -+#endif -+#endif /*CONFIG_PCI_HCI*/ -+ -+#ifdef CONFIG_SDIO_HCI -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ GET_MASK_ARRAY(8188E, _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723BS(pAdapter)) -+ GET_MASK_ARRAY(8723B, _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ GET_MASK_ARRAY(8188F, _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8188GTV) -+ if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) -+ GET_MASK_ARRAY(8188GTV, _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192ES(pAdapter)) -+ GET_MASK_ARRAY(8192E, _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_8821S(pAdapter)) -+ GET_MASK_ARRAY(8821A, _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821CS(pAdapter)) -+ GET_MASK_ARRAY(8821C , _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8822B) -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) -+ GET_MASK_ARRAY(8822B , _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8192F) -+ if (IS_HARDWARE_TYPE_8192FS(pAdapter)) -+ GET_MASK_ARRAY(8192F, _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8822C) -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ GET_MASK_ARRAY(8822C , _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8723F) -+ if (IS_HARDWARE_TYPE_8723F(pAdapter)) -+ GET_MASK_ARRAY(8723F, _MSDIO, pArray); -+#endif -+#endif /*CONFIG_SDIO_HCI*/ -+} -+ -+u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter) -+{ -+ -+#ifdef CONFIG_USB_HCI -+#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_RTL8188GTV) -+ if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8188GTV, _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_8821CU(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8821C, _MUSB); -+#endif -+#if defined(CONFIG_RTL8192F) -+ if (IS_HARDWARE_TYPE_8192FU(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8192F, _MUSB); -+#endif -+#if defined(CONFIG_RTL8822C) -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8822C, _MUSB); -+#endif -+#if defined(CONFIG_RTL8814B) -+ if (IS_HARDWARE_TYPE_8814B(pAdapter)) { -+ return GET_MASK_ARRAY_LEN(8814B, _MUSB); -+ } -+#endif -+#if defined(CONFIG_RTL8723F) -+ if (IS_HARDWARE_TYPE_8723F(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8723F, _MUSB); -+#endif -+#endif /*CONFIG_USB_HCI*/ -+ -+#ifdef CONFIG_PCI_HCI -+#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 -+#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821CE(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8821C, _MPCIE); -+#endif -+#if defined(CONFIG_RTL8192F) -+ if (IS_HARDWARE_TYPE_8192FE(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8192F, _MPCIE); -+#endif -+#if defined(CONFIG_RTL8822C) -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8822C, _MPCIE); -+#endif -+#if defined(CONFIG_RTL8814B) -+ if (IS_HARDWARE_TYPE_8814B(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8814B, _MPCIE); -+#endif -+#endif /*CONFIG_PCI_HCI*/ -+ -+#ifdef CONFIG_SDIO_HCI -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8188E, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723BS(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8723B, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8188F, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8188GTV) -+ if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8188GTV, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192ES(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8192E, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_8821S(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8821A, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821CS(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8821C, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8822B) -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8822B, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8192F) -+ if (IS_HARDWARE_TYPE_8192FS(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8192F, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8822C) -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8822C, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8723F) -+ if (IS_HARDWARE_TYPE_8723F(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8723F, _MSDIO); -+#endif -+#endif/*CONFIG_SDIO_HCI*/ -+ return 0; -+} -+ -+static void rtw_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+ u16 i = 0; -+ -+ if (padapter->registrypriv.boffefusemask == 0) { -+ for (i = 0; i < cnts; i++) { -+ if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { -+ if (rtw_file_efuse_IsMasked(padapter, addr + i, maskfileBuffer)) /*use file efuse mask.*/ -+ data[i] = 0xff; -+ else -+ RTW_DBG("data[%x] = %x\n", i, data[i]); -+ } else { -+ if (efuse_IsMasked(padapter, addr + i)) -+ data[i] = 0xff; -+ else -+ RTW_DBG("data[%x] = %x\n", i, data[i]); -+ } -+ } -+ } -+} -+ -+u8 rtw_efuse_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+ u8 ret = _SUCCESS; -+ u16 mapLen = 0; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE); -+ -+ ret = rtw_efuse_map_read(padapter, addr, cnts , data); -+ -+ rtw_mask_map_read(padapter, addr, cnts , data); -+ -+ return ret; -+ -+} -+ -+/* *********************************************************** -+ * 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, 0x34); -+ 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, 0x34, value32); -+ } -+ -+ return bRet; -+} -+ -+void rtw_efuse_analyze(PADAPTER padapter, u8 Type, u8 Fake) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &(pHalData->EfuseHal); -+ u16 eFuse_Addr = 0; -+ u8 offset, wden; -+ u16 i, j; -+ u8 efuseHeader = 0, efuseExtHdr = 0, efuseData[EFUSE_MAX_WORD_UNIT*2] = {0}, dataCnt = 0; -+ u16 efuseHeader2Byte = 0; -+ u8 *eFuseWord = NULL;// [EFUSE_MAX_SECTION_NUM][EFUSE_MAX_WORD_UNIT]; -+ u8 offset_2_0 = 0; -+ u8 pgSectionCnt = 0; -+ u8 wd_cnt = 0; -+ u8 max_section = 64; -+ u16 mapLen = 0, maprawlen = 0; -+ boolean bExtHeader = _FALSE; -+ u8 efuseType = EFUSE_WIFI; -+ boolean bPseudoTest = _FALSE; -+ u8 bank = 0, startBank = 0, endBank = 1-1; -+ boolean bCheckNextBank = FALSE; -+ u8 protectBytesBank = 0; -+ u16 efuse_max = 0; -+ u8 ParseEfuseExtHdr, ParseEfuseHeader, ParseOffset, ParseWDEN, ParseOffset2_0; -+ -+ eFuseWord = rtw_zmalloc(EFUSE_MAX_SECTION_NUM * (EFUSE_MAX_WORD_UNIT * 2)); -+ -+ if (eFuseWord == NULL) { -+ RTW_INFO("%s:rtw_zmalloc eFuseWord = NULL !!\n", __func__); -+ return; -+ } -+ -+ RTW_INFO("\n"); -+ if (Type == 0) { -+ if (Fake == 0) { -+ RTW_INFO("\n\tEFUSE_Analyze Wifi Content\n"); -+ efuseType = EFUSE_WIFI; -+ bPseudoTest = FALSE; -+ startBank = 0; -+ endBank = 0; -+ } else { -+ RTW_INFO("\n\tEFUSE_Analyze Wifi Pseudo Content\n"); -+ efuseType = EFUSE_WIFI; -+ bPseudoTest = TRUE; -+ startBank = 0; -+ endBank = 0; -+ } -+ } else { -+ if (Fake == 0) { -+ RTW_INFO("\n\tEFUSE_Analyze BT Content\n"); -+ efuseType = EFUSE_BT; -+ bPseudoTest = FALSE; -+ startBank = 1; -+ endBank = EFUSE_MAX_BANK - 1; -+ } else { -+ RTW_INFO("\n\tEFUSE_Analyze BT Pseudo Content\n"); -+ efuseType = EFUSE_BT; -+ bPseudoTest = TRUE; -+ startBank = 1; -+ endBank = EFUSE_MAX_BANK - 1; -+ if (IS_HARDWARE_TYPE_8821(padapter)) -+ endBank = 3 - 1;/*EFUSE_MAX_BANK_8821A - 1;*/ -+ } -+ } -+ -+ RTW_INFO("\n\r 1Byte header, [7:4]=offset, [3:0]=word enable\n"); -+ RTW_INFO("\n\r 2Byte header, header[7:5]=offset[2:0], header[4:0]=0x0F\n"); -+ RTW_INFO("\n\r 2Byte header, extHeader[7:4]=offset[6:3], extHeader[3:0]=word enable\n"); -+ -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, bPseudoTest); -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_MAX_SECTION, (void *)&max_section, bPseudoTest); -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_PROTECT_BYTES_BANK, (void *)&protectBytesBank, bPseudoTest); -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_CONTENT_LEN_BANK, (void *)&efuse_max, bPseudoTest); -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&maprawlen, _FALSE); -+ -+ _rtw_memset(eFuseWord, 0xff, EFUSE_MAX_SECTION_NUM * (EFUSE_MAX_WORD_UNIT * 2)); -+ _rtw_memset(pEfuseHal->fakeEfuseInitMap, 0xff, EFUSE_MAX_MAP_LEN); -+ -+ if (IS_HARDWARE_TYPE_8821(padapter)) -+ endBank = 3 - 1;/*EFUSE_MAX_BANK_8821A - 1;*/ -+ -+ for (bank = startBank; bank <= endBank; bank++) { -+ if (!hal_EfuseSwitchToBank(padapter, bank, bPseudoTest)) { -+ RTW_INFO("EFUSE_SwitchToBank() Fail!!\n"); -+ goto out_free_buffer; -+ } -+ -+ eFuse_Addr = bank * EFUSE_MAX_BANK_SIZE; -+ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); -+ -+ if (efuseHeader == 0xFF && bank == startBank && Fake != TRUE) { -+ RTW_INFO("Non-PGed Efuse\n"); -+ goto out_free_buffer; -+ } -+ RTW_INFO("EFUSE_REAL_CONTENT_LEN = %d\n", maprawlen); -+ -+ while ((efuseHeader != 0xFF) && ((efuseType == EFUSE_WIFI && (eFuse_Addr < maprawlen)) || (efuseType == EFUSE_BT && (eFuse_Addr < (endBank + 1) * EFUSE_MAX_BANK_SIZE)))) { -+ -+ RTW_INFO("Analyzing: Offset: 0x%X\n", eFuse_Addr); -+ -+ /* Check PG header for section num.*/ -+ if (EXT_HEADER(efuseHeader)) { -+ bExtHeader = TRUE; -+ offset_2_0 = GET_HDR_OFFSET_2_0(efuseHeader); -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); -+ -+ if (efuseExtHdr != 0xff) { -+ if (ALL_WORDS_DISABLED(efuseExtHdr)) { -+ /* Read next pg header*/ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); -+ continue; -+ } else { -+ offset = ((efuseExtHdr & 0xF0) >> 1) | offset_2_0; -+ wden = (efuseExtHdr & 0x0F); -+ efuseHeader2Byte = (efuseExtHdr<<8)|efuseHeader; -+ RTW_INFO("Find efuseHeader2Byte = 0x%04X, offset=%d, wden=0x%x\n", -+ efuseHeader2Byte, offset, wden); -+ } -+ } else { -+ RTW_INFO("Error, efuse[%d]=0xff, efuseExtHdr=0xff\n", eFuse_Addr-1); -+ break; -+ } -+ } else { -+ offset = ((efuseHeader >> 4) & 0x0f); -+ wden = (efuseHeader & 0x0f); -+ } -+ -+ _rtw_memset(efuseData, '\0', EFUSE_MAX_WORD_UNIT * 2); -+ dataCnt = 0; -+ -+ if (offset < max_section) { -+ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { -+ /* Check word enable condition in the section */ -+ if (!(wden & (0x01<> 8; -+ ParseEfuseHeader = (efuseHeader2Byte & 0xff); -+ ParseOffset2_0 = GET_HDR_OFFSET_2_0(ParseEfuseHeader); -+ ParseOffset = ((ParseEfuseExtHdr & 0xF0) >> 1) | ParseOffset2_0; -+ ParseWDEN = (ParseEfuseExtHdr & 0x0F); -+ RTW_INFO("Header=0x%x, ExtHeader=0x%x, ", ParseEfuseHeader, ParseEfuseExtHdr); -+ } else { -+ ParseEfuseHeader = efuseHeader; -+ ParseOffset = ((ParseEfuseHeader >> 4) & 0x0f); -+ ParseWDEN = (ParseEfuseHeader & 0x0f); -+ RTW_INFO("Header=0x%x, ", ParseEfuseHeader); -+ } -+ RTW_INFO("offset=0x%x(%d), word enable=0x%x\n", ParseOffset, ParseOffset, ParseWDEN); -+ -+ wd_cnt = 0; -+ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { -+ if (!(wden & (0x01 << i))) { -+ RTW_INFO("Map[ %02X ] = %02X %02X\n", ((offset * EFUSE_MAX_WORD_UNIT * 2) + (i * 2)), efuseData[wd_cnt * 2 + 0], efuseData[wd_cnt * 2 + 1]); -+ wd_cnt++; -+ } -+ } -+ -+ pgSectionCnt++; -+ bExtHeader = FALSE; -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); -+ if (efuseHeader == 0xFF) { -+ if ((eFuse_Addr + protectBytesBank) >= efuse_max) -+ bCheckNextBank = TRUE; -+ else -+ bCheckNextBank = FALSE; -+ } -+ } -+ if (!bCheckNextBank) { -+ RTW_INFO("Not need to check next bank, eFuse_Addr=%d, protectBytesBank=%d, efuse_max=%d\n", -+ eFuse_Addr, protectBytesBank, efuse_max); -+ break; -+ } -+ } -+ /* switch bank back to 0 for BT/wifi later use*/ -+ hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); -+ -+ /* 3. Collect 16 sections and 4 word unit into Efuse map.*/ -+ for (i = 0; i < max_section; i++) { -+ for (j = 0; j < EFUSE_MAX_WORD_UNIT; j++) { -+ pEfuseHal->fakeEfuseInitMap[(i*8)+(j*2)] = (eFuseWord[(i*8)+(j*2)]); -+ pEfuseHal->fakeEfuseInitMap[(i*8)+((j*2)+1)] = (eFuseWord[(i*8)+((j*2)+1)]); -+ } -+ } -+ -+ RTW_INFO("\n\tEFUSE Analyze Map\n"); -+ i = 0; -+ j = 0; -+ -+ for (i = 0; i < mapLen; i++) { -+ if (i % 16 == 0) -+ RTW_PRINT_SEL(RTW_DBGDUMP, "0x%03x: ", i); -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "%02X%s" -+ , pEfuseHal->fakeEfuseInitMap[i] -+ , ((i + 1) % 16 == 0) ? "\n" : (((i + 1) % 8 == 0) ? " " : " ") -+ ); -+ } -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); -+ -+out_free_buffer: -+ if (eFuseWord) -+ rtw_mfree((u8 *)eFuseWord, EFUSE_MAX_SECTION_NUM * (EFUSE_MAX_WORD_UNIT * 2)); -+} -+ -+void efuse_PreUpdateAction( -+ PADAPTER pAdapter, -+ u32 *BackupRegs) -+{ -+ if (IS_HARDWARE_TYPE_8812AU(pAdapter) || IS_HARDWARE_TYPE_8822BU(pAdapter)) { -+ /* <20131115, Kordan> Turn off Rx to prevent from being busy when writing the EFUSE. (Asked by Chunchu.)*/ -+ BackupRegs[0] = phy_query_mac_reg(pAdapter, REG_RCR, bMaskDWord); -+ BackupRegs[1] = phy_query_mac_reg(pAdapter, REG_RXFLTMAP0, bMaskDWord); -+ BackupRegs[2] = phy_query_mac_reg(pAdapter, REG_RXFLTMAP0+4, bMaskDWord); -+#ifdef CONFIG_RTL8812A -+ BackupRegs[3] = phy_query_mac_reg(pAdapter, REG_AFE_MISC, bMaskDWord); -+#endif -+ PlatformEFIOWrite4Byte(pAdapter, REG_RCR, 0x1); -+ PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0, 0); -+ PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0+1, 0); -+ PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0+2, 0); -+ PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0+3, 0); -+ PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0+4, 0); -+ PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0+5, 0); -+#ifdef CONFIG_RTL8812A -+ /* <20140410, Kordan> 0x11 = 0x4E, lower down LX_SPS0 voltage. (Asked by Chunchu)*/ -+ phy_set_mac_reg(pAdapter, REG_AFE_MISC, bMaskByte1, 0x4E); -+#endif -+ RTW_INFO(" %s , done\n", __func__); -+ -+ } -+} -+ -+ -+void efuse_PostUpdateAction( -+ PADAPTER pAdapter, -+ u32 *BackupRegs) -+{ -+ if (IS_HARDWARE_TYPE_8812AU(pAdapter) || IS_HARDWARE_TYPE_8822BU(pAdapter)) { -+ /* <20131115, Kordan> Turn on Rx and restore the registers. (Asked by Chunchu.)*/ -+ phy_set_mac_reg(pAdapter, REG_RCR, bMaskDWord, BackupRegs[0]); -+ phy_set_mac_reg(pAdapter, REG_RXFLTMAP0, bMaskDWord, BackupRegs[1]); -+ phy_set_mac_reg(pAdapter, REG_RXFLTMAP0+4, bMaskDWord, BackupRegs[2]); -+#ifdef CONFIG_RTL8812A -+ phy_set_mac_reg(pAdapter, REG_AFE_MISC, bMaskDWord, BackupRegs[3]); -+#endif -+ RTW_INFO(" %s , done\n", __func__); -+ } -+} -+ -+ -+#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; -+} -+ -+u16 efuse_GetavailableSize(PADAPTER adapter) -+{ -+ struct dvobj_priv *d; -+ u32 size = 0; -+ int err; -+ -+ d = adapter_to_dvobj(adapter); -+ err = rtw_halmac_get_available_efuse_size(d, &size); -+ if (err) -+ return 0; -+ -+ return size; -+} -+ -+ -+u8 efuse_bt_GetCurrentSize(PADAPTER adapter, u16 *usesize) -+{ -+ u8 *efuse_map; -+ -+ *usesize = 0; -+ efuse_map = rtw_malloc(EFUSE_BT_MAP_LEN); -+ if (efuse_map == NULL) { -+ RTW_DBG("%s: malloc FAIL\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ /* for get bt phy efuse last use byte */ -+ hal_ReadEFuse_BT_logic_map(adapter, 0x00, EFUSE_BT_MAP_LEN, efuse_map); -+ *usesize = fakeBTEfuseUsedBytes; -+ -+ if (efuse_map) -+ rtw_mfree(efuse_map, EFUSE_BT_MAP_LEN); -+ -+ return _SUCCESS; -+} -+ -+u16 efuse_bt_GetMaxSize(PADAPTER adapter) -+{ -+ return EFUSE_BT_REAL_CONTENT_LEN - EFUSE_PROTECT_BYTES_BANK; -+} -+ -+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->hal_func.EFUSEGetEfuseDefinition) { -+ adapter->hal_func.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; -+ -+ case TYPE_EFUSE_REAL_CONTENT_LEN: -+ rtw_halmac_get_physical_efuse_size(d, &v32); -+ *(u16 *)out = (u16)v32; -+ return; -+ } -+ } else if (EFUSE_BT == efusetype) { -+ switch (type) { -+ case TYPE_EFUSE_MAP_LEN: -+ *(u16 *)out = EFUSE_BT_MAP_LEN; -+ return; -+ -+ case TYPE_EFUSE_REAL_CONTENT_LEN: -+ *(u16 *)out = EFUSE_BT_REAL_CONTENT_LEN; -+ 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; -+ int err; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ err = rtw_halmac_get_physical_efuse_size(d, &size); -+ if (err){ -+ size = EFUSE_MAX_SIZE; -+ RTW_INFO(" physical_efuse_size err size %d\n", 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; -+ int err = _FAIL; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ -+ size = EFUSE_BT_REAL_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_memcpy(data, efuse + addr, cnts); -+ -+ RTW_INFO("%s: rtw_halmac_read_bt_physical_efuse_map ok! data 0x%x\n", __FUNCTION__, *data); -+ 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; -+ u32 backupRegs[4] = {0}; -+ u8 status = _SUCCESS; -+ -+ efuse_PreUpdateAction(adapter, backupRegs); -+ -+ d = adapter_to_dvobj(adapter); -+ err = rtw_halmac_get_logical_efuse_size(d, &size); -+ if (err) { -+ status = _FAIL; -+ RTW_DBG("halmac_get_logical_efuse_size fail\n"); -+ goto exit; -+ } -+ /* size error handle */ -+ if ((addr + cnts) > size) { -+ if (addr < size) -+ cnts = size - addr; -+ else { -+ status = _FAIL; -+ RTW_DBG(" %s() ,addr + cnts) > size fail\n", __func__); -+ goto exit; -+ } -+ } -+ -+ if (cnts > 16) -+ efuse = rtw_zmalloc(size); -+ -+ if (efuse) { -+ err = rtw_halmac_read_logical_efuse_map(d, efuse, size, NULL, 0); -+ if (err) { -+ rtw_mfree(efuse, size); -+ status = _FAIL; -+ RTW_DBG(" %s() ,halmac_read_logical_efus map fail\n", __func__); -+ goto exit; -+ } -+ -+ _rtw_memcpy(data, efuse + addr, cnts); -+ rtw_mfree(efuse, size); -+ } else { -+ err = rtw_halmac_read_logical_efuse(d, addr, cnts, data); -+ if (err) { -+ status = _FAIL; -+ RTW_DBG(" %s() ,halmac_read_logical_efus data fail\n", __func__); -+ goto exit; -+ } -+ } -+ status = _SUCCESS; -+exit: -+ efuse_PostUpdateAction(adapter, backupRegs); -+ -+ return status; -+} -+ -+ -+u8 rtw_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) -+{ -+ struct dvobj_priv *d; -+ u8 *efuse = NULL; -+ u32 size; -+ int err; -+ u8 mask_buf[64] = ""; -+ u16 mask_len = sizeof(u8) * rtw_get_efuse_mask_arraylen(adapter); -+ u32 backupRegs[4] = {0}; -+ u8 status = _SUCCESS;; -+ -+ efuse_PreUpdateAction(adapter, backupRegs); -+ -+ d = adapter_to_dvobj(adapter); -+ err = rtw_halmac_get_logical_efuse_size(d, &size); -+ if (err) { -+ status = _FAIL; -+ goto exit; -+ } -+ -+ if ((addr + cnts) > size) { -+ status = _FAIL; -+ goto exit; -+ } -+ -+ efuse = rtw_zmalloc(size); -+ if (!efuse) { -+ status = _FAIL; -+ goto exit; -+ } -+ -+ err = rtw_halmac_read_logical_efuse_map(d, efuse, size, NULL, 0); -+ if (err) { -+ rtw_mfree(efuse, size); -+ status = _FAIL; -+ goto exit; -+ } -+ -+ _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); -+ status = _FAIL; -+ goto exit; -+ } -+ -+ rtw_mfree(efuse, size); -+ status = _SUCCESS; -+exit : -+ efuse_PostUpdateAction(adapter, backupRegs); -+ -+ return status; -+} -+ -+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; -+} -+ -+static void rtw_bt_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+ u16 i = 0; -+ -+#ifdef CONFIG_BT_EFUSE_MASK -+ if (padapter->registrypriv.boffefusemask == 0) { -+ for (i = 0; i < cnts; i++) { -+ if (padapter->registrypriv.bBTFileMaskEfuse == _TRUE) { -+ if (rtw_file_efuse_IsMasked(padapter, addr + i, btmaskfileBuffer)) /*use BT file efuse mask.*/ -+ data[i] = 0xff; -+ else -+ RTW_INFO("data[%x] = %x\n", i, data[i]); -+ } else { -+ if (efuse_IsBT_Masked(padapter, addr + i)) /*use drv internal efuse mask.*/ -+ data[i] = 0xff; -+ else -+ RTW_INFO("data[%x] = %x\n", i, data[i]); -+ } -+ } -+ } -+#endif /*CONFIG_BT_EFUSE_MASK*/ -+} -+ -+u8 rtw_BT_efuse_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) -+{ -+ hal_ReadEFuse_BT_logic_map(adapter, addr, cnts, data); -+ -+ rtw_bt_mask_map_read(adapter, addr, cnts, data); -+ -+ return _SUCCESS; -+} -+ -+ -+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; -+ -+ -+ btusedbytes = fakeBTEfuseUsedBytes; -+ -+ 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); -+ retU2 = EFUSE_BT_REAL_CONTENT_LEN - EFUSE_PROTECT_BYTES_BANK; -+ -+ for (bank = startBank; bank < 3; bank++) { -+ if (hal_EfuseSwitchToBank(padapter, bank, bPseudoTest) == _FALSE) { -+ RTW_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; -+ -+ -+ while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { -+ if (rtw_efuse_bt_access(padapter, _FALSE, efuse_addr, 1, &efuse_data) == _FALSE) { -+ RTW_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++; -+ rtw_efuse_bt_access(padapter, _FALSE, efuse_addr, 1, &efuse_data); -+ 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; -+ } -+ /* 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; -+ -+ fakeBTEfuseUsedBytes = retU2; -+ RTW_INFO("%s: CurrentSize=%d\n", __FUNCTION__, retU2); -+ return retU2; -+} -+ -+#ifdef CONFIG_RTL8822C -+void rtw_pre_bt_efuse(PADAPTER padapter) -+{ -+ char pgdata[4] = {0x72, 0x80, 0x14, 0x90}; /*BT 5M PLL*/ -+ u8 status = 1; -+ u8 bkmask; -+ BOOLEAN bt_en; -+ -+ bkmask = padapter->registrypriv.boffefusemask; -+ padapter->registrypriv.boffefusemask = 1; -+ -+ bt_en = rtw_read8(padapter, 0x6A) & BIT2 ? _TRUE : _FALSE; -+ if (IS_HARDWARE_TYPE_8822C(padapter) && bt_en == _TRUE) { -+ status = rtw_BT_efuse_map_write(padapter, 0x1f8, 4, pgdata); -+ RTW_INFO("%s done!!!\n", __FUNCTION__); -+ } -+ if (status == _FAIL) -+ RTW_INFO("%s: fail\n", __FUNCTION__); -+ padapter->registrypriv.boffefusemask = bkmask; -+} -+#endif -+ -+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 *efuse = NULL; -+ u8 *map; -+ u8 newdata[PGPKT_DATA_SIZE]; -+ s32 i = 0, j = 0, idx = 0, chk_total_byte = 0; -+ u8 ret = _SUCCESS; -+ u16 mapLen = 1024; -+ u16 startAddr = 0; -+ -+ 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 */ -+ -+ efuse = rtw_zmalloc(mapLen); -+ if (!efuse) -+ return _FAIL; -+ -+ map = rtw_zmalloc(mapLen); -+ if (map == NULL) { -+ rtw_mfree(efuse, mapLen); -+ return _FAIL; -+ } -+ -+ _rtw_memset(map, 0xFF, mapLen); -+ -+ ret = rtw_BT_efuse_map_read(adapter, 0, mapLen, map); -+ if (ret == _FAIL) -+ goto exit; -+ -+ _rtw_memcpy(efuse , map, mapLen); -+ _rtw_memcpy(efuse + addr, data, cnts); -+#ifdef CONFIG_BT_EFUSE_MASK -+ if (adapter->registrypriv.boffefusemask == 0) { -+ for (i = 0; i < cnts; i++) { -+ if (adapter->registrypriv.bBTFileMaskEfuse == _TRUE) { -+ if (rtw_file_efuse_IsMasked(adapter, addr + i, btmaskfileBuffer)) /*use file efuse mask. */ -+ efuse[addr + i] = map[addr + i]; -+ } else { -+ if (efuse_IsBT_Masked(adapter, addr + i)) -+ efuse[addr + i] = map[addr + i]; -+ } -+ RTW_INFO("%s , efuse[%x] = %x, map = %x\n", __func__, addr + i, efuse[ addr + i], map[addr + i]); -+ } -+ } -+#endif /*CONFIG_BT_EFUSE_MASK*/ -+ /* precheck pg efuse data byte*/ -+ 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 (efuse[addr + 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); -+ startAddr = hal_EfuseGetCurrentSize_BT(adapter, _FALSE); -+ RTW_INFO("%s: startAddr=%#X\n", __func__, startAddr); -+ -+ if (!AVAILABLE_EFUSE_ADDR(startAddr + chk_total_byte)) { -+ RTW_INFO("%s: startAddr(0x%X) + PG data len %d >= efuse BT available offset (0x%X)\n", -+ __func__, startAddr, chk_total_byte, EFUSE_BT_REAL_CONTENT_LEN - EFUSE_PROTECT_BYTES_BANK); -+ 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 (efuse[addr + idx] != map[addr + idx]) { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = efuse[addr + idx]; -+ } -+ } -+ -+ if (word_en != 0xF) { -+ ret = EfusePgPacketWrite_BT(adapter, offset, word_en, newdata, _FALSE); -+ 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"); -+ if (ret == _FAIL) -+ break; -+ } -+ offset++; -+ } -+exit: -+ if (efuse) -+ rtw_mfree(efuse, mapLen); -+ if (map) -+ rtw_mfree(map, mapLen); -+ return ret; -+} -+ -+void hal_ReadEFuse_BT_logic_map( -+ PADAPTER padapter, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf -+) -+{ -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ 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_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_CONTENT_LEN); -+ -+ if (rtw_efuse_bt_access(padapter, _FALSE, 0, EFUSE_BT_REAL_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; -+ RTW_INFO("%s: BTEfuseUsed last Bytes = %#x\n", __FUNCTION__, fakeBTEfuseUsedBytes); -+ -+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) -+{ -+ 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 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; -+ } else -+ RTW_INFO("%s: OK!!\n", __FUNCTION__); -+ -+ return _TRUE; -+} -+ -+u8 efuse_OneByteRead(struct _ADAPTER *a, u16 addr, u8 *data, u8 bPseudoTest) -+{ -+ struct dvobj_priv *d; -+ int err; -+ u8 ret = _TRUE; -+ -+ d = adapter_to_dvobj(a); -+ err = rtw_halmac_read_physical_efuse(d, addr, 1, data); -+ if (err) { -+ RTW_ERR("%s: addr=0x%x FAIL!!!\n", __FUNCTION__, addr); -+ ret = _FALSE; -+ } -+ -+ return ret; -+ -+} -+ -+ -+static u8 -+hal_BT_EfusePgCheckAvailableAddr( -+ PADAPTER pAdapter, -+ u8 bPseudoTest) -+{ -+ u16 max_available = EFUSE_BT_REAL_CONTENT_LEN - EFUSE_PROTECT_BYTES_BANK; -+ u16 current_size = 0; -+ -+ RTW_INFO("%s: max_available=%d\n", __FUNCTION__, max_available); -+ current_size = hal_EfuseGetCurrentSize_BT(pAdapter, 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; -+} -+ -+u8 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_BT_EfusePgCheckAvailableAddr(pAdapter, 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; -+} -+ -+ -+#else /* !RTW_HALMAC */ -+/* ------------------------------------------------------------------------------ */ -+#define REG_EFUSE_CTRL 0x0030 -+#define EFUSE_CTRL REG_EFUSE_CTRL /* E-Fuse Control. */ -+/* ------------------------------------------------------------------------------ */ -+ -+ -+BOOLEAN -+Efuse_Read1ByteFromFakeContent( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u8 *Value); -+BOOLEAN -+Efuse_Read1ByteFromFakeContent( -+ PADAPTER 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; -+} -+ -+BOOLEAN -+Efuse_Write1ByteToFakeContent( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u8 Value); -+BOOLEAN -+Efuse_Write1ByteToFakeContent( -+ PADAPTER 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( -+ PADAPTER pAdapter, -+ u8 bWrite, -+ u8 PwrState) -+{ -+ pAdapter->hal_func.EfusePowerSwitch(pAdapter, bWrite, PwrState); -+} -+ -+void -+BTEfuse_PowerSwitch( -+ PADAPTER pAdapter, -+ u8 bWrite, -+ u8 PwrState) -+{ -+ if (pAdapter->hal_func.BTEfusePowerSwitch) -+ pAdapter->hal_func.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( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ BOOLEAN bPseudoTest) -+{ -+ u16 ret = 0; -+ -+ ret = pAdapter->hal_func.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, -+ BOOLEAN bPseudoTest) -+{ -+ u32 value32; -+ u8 readbyte; -+ u16 retry; -+ /* systime 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_set_mac_reg(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, -+ BOOLEAN bPseudoTest -+); -+void -+efuse_ReadEFuse( -+ PADAPTER Adapter, -+ u8 efuseType, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ BOOLEAN bPseudoTest -+) -+{ -+ Adapter->hal_func.ReadEFuse(Adapter, efuseType, _offset, _size_byte, pbuf, bPseudoTest); -+} -+ -+void -+EFUSE_GetEfuseDefinition( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u8 type, -+ void *pOut, -+ BOOLEAN bPseudoTest -+) -+{ -+ pAdapter->hal_func.EFUSEGetEfuseDefinition(pAdapter, efuseType, type, pOut, bPseudoTest); -+} -+ -+ -+/* 11/16/2008 MH Read one byte from real Efuse. */ -+u8 -+efuse_OneByteRead( -+ PADAPTER pAdapter, -+ u16 addr, -+ u8 *data, -+ 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; -+ } -+ -+#ifdef CONFIG_RTL8710B -+ /* <20171208, Peter>, Dont do the following write16(0x34) */ -+ if (IS_HARDWARE_TYPE_8710B(pAdapter)) { -+ bResult = pAdapter->hal_func.efuse_indirect_read4(pAdapter, addr, data); -+ return bResult; -+ } -+#endif -+ -+ if (IS_HARDWARE_TYPE_8723B(pAdapter) || -+ (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->version_id))) || -+ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->version_id)) -+ ) { -+ /* <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_set_mac_reg(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( -+ PADAPTER pAdapter, -+ u16 addr, -+ u8 data, -+ 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; -+ } -+ -+ Efuse_PowerSwitch(pAdapter, _TRUE, _TRUE); -+ -+ /* -----------------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->version_id))) || -+ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->version_id)) -+ ) { -+ /* <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_set_mac_reg(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); -+ -+ rtw_mdelay_os(1); -+ -+ 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->version_id))) || -+ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->version_id)) -+ ) -+ phy_set_mac_reg(pAdapter, EFUSE_TEST, BIT(11), 0); -+ -+ Efuse_PowerSwitch(pAdapter, _TRUE, _FALSE); -+ -+ return bResult; -+} -+ -+int -+Efuse_PgPacketRead(PADAPTER pAdapter, -+ u8 offset, -+ u8 *data, -+ BOOLEAN bPseudoTest) -+{ -+ int ret = 0; -+ -+ ret = pAdapter->hal_func.Efuse_PgPacketRead(pAdapter, offset, data, bPseudoTest); -+ -+ return ret; -+} -+ -+int -+Efuse_PgPacketWrite(PADAPTER pAdapter, -+ u8 offset, -+ u8 word_en, -+ u8 *data, -+ BOOLEAN bPseudoTest) -+{ -+ int ret; -+ -+ ret = pAdapter->hal_func.Efuse_PgPacketWrite(pAdapter, offset, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+ -+int -+Efuse_PgPacketWrite_BT(PADAPTER pAdapter, -+ u8 offset, -+ u8 word_en, -+ u8 *data, -+ BOOLEAN bPseudoTest) -+{ -+ int ret; -+ -+ ret = pAdapter->hal_func.Efuse_PgPacketWrite_BT(pAdapter, offset, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+ -+u8 -+Efuse_WordEnableDataWrite(PADAPTER pAdapter, -+ u16 efuse_addr, -+ u8 word_en, -+ u8 *data, -+ BOOLEAN bPseudoTest) -+{ -+ u8 ret = 0; -+ -+ ret = pAdapter->hal_func.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 *); -+ u32 backupRegs[4] = {0}; -+ -+ -+ 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 ((start_addr + cnts) > max_available_size) -+ return _FAIL; -+ rw8 = &efuse_write8; -+ } else -+ rw8 = &efuse_read8; -+ -+ efuse_PreUpdateAction(padapter, backupRegs); -+ -+ 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); -+ -+ efuse_PostUpdateAction(padapter, backupRegs); -+ -+ return res; -+} -+/* ------------------------------------------------------------------------------ */ -+u16 efuse_GetMaxSize(PADAPTER padapter) -+{ -+ u16 max_size; -+ -+ max_size = 0; -+ 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); -+ -+ return _SUCCESS; -+} -+/* ------------------------------------------------------------------------------ */ -+u16 efuse_bt_GetMaxSize(PADAPTER padapter) -+{ -+ u16 max_size; -+ -+ max_size = 0; -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&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, (void *)&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, (void *)&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 *efuse = NULL; -+ u8 offset, word_en; -+ u8 *map = NULL; -+ 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; -+ u32 backupRegs[4] = {0}; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+ -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&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 */ -+ -+ efuse = rtw_zmalloc(mapLen); -+ if (!efuse) -+ return _FAIL; -+ -+ map = rtw_zmalloc(mapLen); -+ if (map == NULL) { -+ rtw_mfree(efuse, mapLen); -+ return _FAIL; -+ } -+ -+ _rtw_memset(map, 0xFF, mapLen); -+ -+ ret = rtw_efuse_map_read(padapter, 0, mapLen, map); -+ if (ret == _FAIL) -+ goto exit; -+ -+ _rtw_memcpy(efuse , map, mapLen); -+ _rtw_memcpy(efuse + addr, data, cnts); -+ -+ if (padapter->registrypriv.boffefusemask == 0) { -+ for (i = 0; i < cnts; i++) { -+ if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { -+ if (rtw_file_efuse_IsMasked(padapter, addr + i, maskfileBuffer)) /*use file efuse mask. */ -+ efuse[addr + i] = map[addr + i]; -+ } else { -+ if (efuse_IsMasked(padapter, addr + i)) -+ efuse[addr + i] = map[addr + i]; -+ } -+ RTW_INFO("%s , data[%d] = %x, map[addr+i]= %x\n", __func__, addr + i, efuse[ addr + 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 (efuse[addr + 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; -+ } -+ -+ efuse_PreUpdateAction(padapter, backupRegs); -+ -+ 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 (efuse[addr + idx] != map[addr + idx]) { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = efuse[addr + idx]; -+#ifdef CONFIG_RTL8723B -+ if (addr + idx == 0x8) { -+ if (IS_C_CUT(pHalData->version_id) || IS_B_CUT(pHalData->version_id)) { -+ 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);*/ -+ -+ efuse_PostUpdateAction(padapter, backupRegs); -+ -+exit: -+ -+ rtw_mfree(map, mapLen); -+ rtw_mfree(efuse, mapLen); -+ -+ 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, (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; -+ -+ 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( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u8 *Efuse, -+ BOOLEAN bPseudoTest); -+void -+Efuse_ReadAllMap( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u8 *Efuse, -+ BOOLEAN 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_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( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u8 Value); -+#endif /* PLATFORM */ -+static void -+efuse_ShadowWrite1Byte( -+ PADAPTER pAdapter, -+ u16 Offset, -+ 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( -+ PADAPTER pAdapter, -+ u16 Offset, -+ 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( -+ PADAPTER pAdapter, -+ u16 Offset, -+ 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_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( -+ PADAPTER pAdapter, -+ u8 Type, -+ u16 Offset, -+ u32 Value); -+void -+EFUSE_ShadowWrite( -+ PADAPTER pAdapter, -+ u8 Type, -+ u16 Offset, -+ 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 */ -+ -+#endif /* !RTW_HALMAC */ -+/*----------------------------------------------------------------------------- -+ * 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( -+ PADAPTER pAdapter, -+ u16 Offset, -+ 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( -+ PADAPTER pAdapter, -+ u16 Offset, -+ 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( -+ PADAPTER pAdapter, -+ u16 Offset, -+ 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_ShadowRead -+ * -+ * Overview: Read from pHalData->efuse_eeprom_data -+ *---------------------------------------------------------------------------*/ -+void -+EFUSE_ShadowRead( -+ PADAPTER 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 */ -+ -+/* 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; -+} -+ -+/*----------------------------------------------------------------------------- -+ * 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]; -+ } -+} -+ -+/*----------------------------------------------------------------------------- -+ * 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( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ 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, (void *)&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, NULL, 0); -+ if (err) -+ RTW_ERR("%s: fail to get efuse map!\n", __FUNCTION__); -+ } -+#else /* !RTW_HALMAC */ -+ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (void *)&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((void *)&pHalData->EfuseMap[EFUSE_MODIFY_MAP][0], */ -+ /* (void *)&pHalData->EfuseMap[EFUSE_INIT_MAP][0], mapLen); */ -+#endif /* !RTW_HALMAC */ -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mp_mode_check(pAdapter)) { -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+ -+ if (GET_EFUSE_UPDATE_ON(pAdapter)) -+ _rtw_memcpy(pHalData->efuse_eeprom_data, pEfuseHal->fakeEfuseModifiedMap, mapLen); -+ } -+#endif -+ rtw_mask_map_read(pAdapter, 0x00, mapLen, pHalData->efuse_eeprom_data); -+ -+ 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 *filepath, 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(filepath, ptmpbuf, bufsize); -+ if (count <= 90) { -+ rtw_mfree(ptmpbuf, bufsize); -+ RTW_ERR("%s, filepatch %s, size=%d, FAIL!!\n", __FUNCTION__, filepath, 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__, filepath, count); -+ return _TRUE; -+} -+ -+#if !defined(CONFIG_RTW_ANDROID_GKI) -+u8 rtw_efuse_file_store(PADAPTER padapter, u8 *filepath, u8 *buf, u32 len) -+{ -+ int err = 0, i = 0, j = 0, mapLen = 0 ; -+ char *cbuf, *pchr; -+ -+ cbuf = rtw_zmalloc(len * 3); -+ pchr = cbuf; -+ -+ if (filepath && buf) { -+ if (cbuf == NULL) { -+ RTW_INFO("%s, malloc cbuf _FAIL\n", __FUNCTION__); -+ err = _FAIL; -+ } else { -+ for (i = 0; i <= len; i += 16) { -+ for (j = 0; j < 16; j++) -+ pchr += sprintf(pchr, "%02X ", buf[i + j]); -+ pchr += sprintf(pchr, "\n"); -+ } -+ -+ err = rtw_store_to_file(filepath, cbuf, strlen(cbuf)); -+ RTW_INFO("%s, rtw_store_to_file len=%d,err =%d, len(cbuf)=%zd\n", __FUNCTION__, len, err, strlen(cbuf)); -+ if (err == strlen(cbuf)) { -+ err = _SUCCESS; -+ RTW_INFO("%s, filepatch %s, len=%d, done\n", __FUNCTION__, filepath, len); -+ } else { -+ err = _FAIL; -+ RTW_INFO("%s, filepatch %s, len=%d,err =%d, _FAIL\n", __FUNCTION__, filepath, len, err); -+ } -+ } -+ } -+ if (cbuf) -+ rtw_mfree(cbuf, len * 3); -+ -+ return err; -+} -+#endif /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+ -+#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 = 16384, read_size, pos = 0; -+ u8 *map = NULL; -+ -+ if (rtw_readable_file_sz_chk(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; -+ 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 --git a/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh.c b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh.c -new file mode 100755 -index 000000000..95605d964 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh.c -@@ -0,0 +1,4397 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_MESH_C_ -+ -+#ifdef CONFIG_RTW_MESH -+#include -+ -+const char *_rtw_mesh_plink_str[] = { -+ "UNKNOWN", -+ "LISTEN", -+ "OPN_SNT", -+ "OPN_RCVD", -+ "CNF_RCVD", -+ "ESTAB", -+ "HOLDING", -+ "BLOCKED", -+}; -+ -+const char *_rtw_mesh_ps_str[] = { -+ "UNKNOWN", -+ "ACTIVE", -+ "LSLEEP", -+ "DSLEEP", -+}; -+ -+const char *_action_self_protected_str[] = { -+ "ACT_SELF_PROTECTED_RSVD", -+ "MESH_OPEN", -+ "MESH_CONF", -+ "MESH_CLOSE", -+ "MESH_GK_INFORM", -+ "MESH_GK_ACK", -+}; -+ -+inline u8 *rtw_set_ie_mesh_id(u8 *buf, u32 *buf_len, const char *mesh_id, u8 id_len) -+{ -+ return rtw_set_ie(buf, WLAN_EID_MESH_ID, id_len, mesh_id, buf_len); -+} -+ -+inline u8 *rtw_set_ie_mesh_config(u8 *buf, u32 *buf_len -+ , u8 path_sel_proto, u8 path_sel_metric, u8 congest_ctl_mode, u8 sync_method, u8 auth_proto -+ , u8 num_of_peerings, bool cto_mgate, bool cto_as -+ , bool accept_peerings, bool mcca_sup, bool mcca_en, bool forwarding -+ , bool mbca_en, bool tbtt_adj, bool ps_level) -+{ -+ -+ u8 conf[7] = {0}; -+ -+ SET_MESH_CONF_ELE_PATH_SEL_PROTO_ID(conf, path_sel_proto); -+ SET_MESH_CONF_ELE_PATH_SEL_METRIC_ID(conf, path_sel_metric); -+ SET_MESH_CONF_ELE_CONGEST_CTRL_MODE_ID(conf, congest_ctl_mode); -+ SET_MESH_CONF_ELE_SYNC_METHOD_ID(conf, sync_method); -+ SET_MESH_CONF_ELE_AUTH_PROTO_ID(conf, auth_proto); -+ -+ SET_MESH_CONF_ELE_CTO_MGATE(conf, cto_mgate); -+ SET_MESH_CONF_ELE_NUM_OF_PEERINGS(conf, num_of_peerings); -+ SET_MESH_CONF_ELE_CTO_AS(conf, cto_as); -+ -+ SET_MESH_CONF_ELE_ACCEPT_PEERINGS(conf, accept_peerings); -+ SET_MESH_CONF_ELE_MCCA_SUP(conf, mcca_sup); -+ SET_MESH_CONF_ELE_MCCA_EN(conf, mcca_en); -+ SET_MESH_CONF_ELE_FORWARDING(conf, forwarding); -+ SET_MESH_CONF_ELE_MBCA_EN(conf, mbca_en); -+ SET_MESH_CONF_ELE_TBTT_ADJ(conf, tbtt_adj); -+ SET_MESH_CONF_ELE_PS_LEVEL(conf, ps_level); -+ -+ return rtw_set_ie(buf, WLAN_EID_MESH_CONFIG, 7, conf, buf_len); -+} -+ -+inline u8 *rtw_set_ie_mpm(u8 *buf, u32 *buf_len -+ , u8 proto_id, u16 llid, u16 *plid, u16 *reason, u8 *chosen_pmk) -+{ -+ u8 data[24] = {0}; -+ u8 *pos = data; -+ -+ RTW_PUT_LE16(pos, proto_id); -+ pos += 2; -+ -+ RTW_PUT_LE16(pos, llid); -+ pos += 2; -+ -+ if (plid) { -+ RTW_PUT_LE16(pos, *plid); -+ pos += 2; -+ } -+ -+ if (reason) { -+ RTW_PUT_LE16(pos, *reason); -+ pos += 2; -+ } -+ -+ if (chosen_pmk) { -+ _rtw_memcpy(pos, chosen_pmk, 16); -+ pos += 16; -+ } -+ -+ return rtw_set_ie(buf, WLAN_EID_MPM, pos - data, data, buf_len); -+} -+ -+bool rtw_bss_is_forwarding(WLAN_BSSID_EX *bss) -+{ -+ u8 *ie; -+ int ie_len; -+ bool ret = 0; -+ -+ ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, -+ BSS_EX_TLV_IES_LEN(bss)); -+ if (!ie || ie_len != 7) -+ goto exit; -+ -+ ret = GET_MESH_CONF_ELE_FORWARDING(ie + 2); -+ -+exit: -+ return ret; -+} -+ -+bool rtw_bss_is_cto_mgate(WLAN_BSSID_EX *bss) -+{ -+ u8 *ie; -+ int ie_len; -+ bool ret = 0; -+ -+ ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, -+ BSS_EX_TLV_IES_LEN(bss)); -+ if (!ie || ie_len != 7) -+ goto exit; -+ -+ ret = GET_MESH_CONF_ELE_CTO_MGATE(ie + 2); -+ -+exit: -+ return ret; -+} -+ -+int _rtw_bss_is_same_mbss(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b, u8 **a_mconf_ie_r, u8 **b_mconf_ie_r) -+{ -+ int ret = 0; -+ u8 *a_mconf_ie, *b_mconf_ie; -+ sint a_mconf_ie_len, b_mconf_ie_len; -+ -+ if (a->InfrastructureMode != Ndis802_11_mesh) -+ goto exit; -+ a_mconf_ie = rtw_get_ie(BSS_EX_TLV_IES(a), WLAN_EID_MESH_CONFIG, &a_mconf_ie_len, BSS_EX_TLV_IES_LEN(a)); -+ if (!a_mconf_ie || a_mconf_ie_len != 7) -+ goto exit; -+ if (a_mconf_ie_r) -+ *a_mconf_ie_r = a_mconf_ie; -+ -+ if (b->InfrastructureMode != Ndis802_11_mesh) -+ goto exit; -+ b_mconf_ie = rtw_get_ie(BSS_EX_TLV_IES(b), WLAN_EID_MESH_CONFIG, &b_mconf_ie_len, BSS_EX_TLV_IES_LEN(b)); -+ if (!b_mconf_ie || b_mconf_ie_len != 7) -+ goto exit; -+ if (b_mconf_ie_r) -+ *b_mconf_ie_r = b_mconf_ie; -+ -+ if (a->mesh_id.SsidLength != b->mesh_id.SsidLength -+ || _rtw_memcmp(a->mesh_id.Ssid, b->mesh_id.Ssid, a->mesh_id.SsidLength) == _FALSE) -+ goto exit; -+ -+ if (_rtw_memcmp(a_mconf_ie + 2, b_mconf_ie + 2, 5) == _FALSE) -+ goto exit; -+ -+ ret = 1; -+ -+exit: -+ return ret; -+} -+ -+int rtw_bss_is_same_mbss(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b) -+{ -+ return _rtw_bss_is_same_mbss(a, b, NULL, NULL); -+} -+ -+int rtw_bss_is_candidate_mesh_peer(_adapter *adapter, WLAN_BSSID_EX *target, u8 ch, u8 add_peer) -+{ -+ int ret = 0; -+ WLAN_BSSID_EX *self = &adapter->mlmepriv.cur_network.network; -+ u8 *s_mconf_ie, *t_mconf_ie; -+ u8 auth_pid; -+ int i, j; -+ -+ if (ch && self->Configuration.DSConfig != target->Configuration.DSConfig) -+ goto exit; -+ -+ if (!_rtw_bss_is_same_mbss(self, target, &s_mconf_ie, &t_mconf_ie)) -+ goto exit; -+ -+ if (add_peer) { -+ /* Accept additional mesh peerings */ -+ if (GET_MESH_CONF_ELE_ACCEPT_PEERINGS(t_mconf_ie + 2) == 0) -+ goto exit; -+ } -+ -+ /* BSSBasicRateSet */ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ if (target->SupportedRates[i] == 0) -+ break; -+ if (target->SupportedRates[i] & 0x80) { -+ u8 match = 0; -+ -+ if (!ch) { -+ /* off-channel, check target with our hardcode capability */ -+ if (target->Configuration.DSConfig > 14) -+ match = rtw_is_basic_rate_ofdm(target->SupportedRates[i]); -+ else -+ match = rtw_is_basic_rate_mix(target->SupportedRates[i]); -+ } else { -+ for (j = 0; j < NDIS_802_11_LENGTH_RATES_EX; j++) { -+ if (self->SupportedRates[j] == 0) -+ break; -+ if (self->SupportedRates[j] == target->SupportedRates[i]) { -+ match = 1; -+ break; -+ } -+ } -+ } -+ if (!match) -+ goto exit; -+ } -+ } -+ -+ /* BSSBasicMCSSet */ -+ -+ -+ auth_pid = GET_MESH_CONF_ELE_AUTH_PROTO_ID(s_mconf_ie + 2); -+ if (auth_pid && auth_pid <= 2) { -+ struct security_priv *sec = &adapter->securitypriv; -+ u8 *rsn_ie; -+ int rsn_ie_len; -+ int group_cipher = 0, pairwise_cipher = 0, gmcs = 0; -+ u8 mfp_opt = MFP_NO; -+ -+ /* 802.1X connected to AS ? */ -+ -+ /* RSN */ -+ rsn_ie = rtw_get_wpa2_ie(BSS_EX_TLV_IES(target), &rsn_ie_len, BSS_EX_TLV_IES_LEN(target)); -+ if (!rsn_ie || rsn_ie_len == 0) -+ goto exit; -+ if (rtw_parse_wpa2_ie(rsn_ie, rsn_ie_len + 2, &group_cipher, &pairwise_cipher, &gmcs, NULL, &mfp_opt, NULL) != _SUCCESS) -+ goto exit; -+ if ((sec->mfp_opt == MFP_REQUIRED && mfp_opt < MFP_OPTIONAL) -+ || (mfp_opt == MFP_REQUIRED && sec->mfp_opt < MFP_OPTIONAL)) -+ goto exit; -+ if (!(sec->wpa2_group_cipher & group_cipher)) -+ goto exit; -+ if (!(sec->wpa2_pairwise_cipher & pairwise_cipher)) -+ goto exit; -+ #ifdef CONFIG_IEEE80211W -+ if ((sec->mfp_opt >= MFP_OPTIONAL && mfp_opt >= MFP_OPTIONAL) -+ && security_type_bip_to_gmcs(sec->dot11wCipher) != gmcs) -+ goto exit; -+ #endif -+ } -+ -+ ret = 1; -+ -+exit: -+ return ret; -+} -+ -+void rtw_mesh_bss_peering_status(WLAN_BSSID_EX *bss, u8 *nop, u8 *accept) -+{ -+ u8 *ie; -+ int ie_len; -+ -+ if (nop) -+ *nop = 0; -+ if (accept) -+ *accept = 0; -+ -+ ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, -+ BSS_EX_TLV_IES_LEN(bss)); -+ if (!ie || ie_len != 7) -+ goto exit; -+ -+ if (nop) -+ *nop = GET_MESH_CONF_ELE_NUM_OF_PEERINGS(ie + 2); -+ if (accept) -+ *accept = GET_MESH_CONF_ELE_ACCEPT_PEERINGS(ie + 2); -+ -+exit: -+ return; -+} -+ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+void rtw_mesh_update_scanned_acnode_status(_adapter *adapter, struct wlan_network *scanned) -+{ -+ bool acnode; -+ u8 nop, accept; -+ -+ rtw_mesh_bss_peering_status(&scanned->network, &nop, &accept); -+ -+ acnode = !nop && accept; -+ -+ if (acnode && scanned->acnode_stime == 0) { -+ scanned->acnode_stime = rtw_get_current_time(); -+ if (scanned->acnode_stime == 0) -+ scanned->acnode_stime++; -+ } else if (!acnode) { -+ scanned->acnode_stime = 0; -+ scanned->acnode_notify_etime = 0; -+ } -+} -+ -+bool rtw_mesh_scanned_is_acnode_confirmed(_adapter *adapter, struct wlan_network *scanned) -+{ -+ return scanned->acnode_stime -+ && rtw_get_passing_time_ms(scanned->acnode_stime) -+ > adapter->mesh_cfg.peer_sel_policy.acnode_conf_timeout_ms; -+} -+ -+static bool rtw_mesh_scanned_is_acnode_allow_notify(_adapter *adapter, struct wlan_network *scanned) -+{ -+ return scanned->acnode_notify_etime -+ && rtw_time_after(scanned->acnode_notify_etime, rtw_get_current_time()); -+} -+ -+bool rtw_mesh_acnode_prevent_allow_sacrifice(_adapter *adapter) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ bool allow = 0; -+ -+ if (!mcfg->peer_sel_policy.acnode_prevent -+ || mcfg->max_peer_links <= 1 -+ || stapriv->asoc_list_cnt < mcfg->max_peer_links) -+ goto exit; -+ -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ if (rtw_mesh_cto_mgate_required(adapter)) -+ goto exit; -+#endif -+ -+ allow = 1; -+ -+exit: -+ return allow; -+} -+ -+static bool rtw_mesh_acnode_candidate_exist(_adapter *adapter) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ _queue *queue = &(mlme->scanned_queue); -+ _list *head, *list; -+ _irqL irqL; -+ struct wlan_network *scanned = NULL; -+ struct sta_info *sta = NULL; -+ bool need = 0; -+ -+ _enter_critical_bh(&(mlme->scanned_queue.lock), &irqL); -+ -+ head = get_list_head(queue); -+ list = get_next(head); -+ while (!rtw_end_of_queue_search(head, list)) { -+ scanned = LIST_CONTAINOR(list, struct wlan_network, list); -+ list = get_next(list); -+ -+ if (rtw_get_passing_time_ms(scanned->last_scanned) < mcfg->peer_sel_policy.scanr_exp_ms -+ && rtw_mesh_scanned_is_acnode_confirmed(adapter, scanned) -+ && (!mcfg->rssi_threshold || mcfg->rssi_threshold <= scanned->network.Rssi) -+ #if CONFIG_RTW_MACADDR_ACL -+ && rtw_access_ctrl(adapter, scanned->network.MacAddress) == _TRUE -+ #endif -+ && rtw_bss_is_candidate_mesh_peer(adapter, &scanned->network, 1, 1) -+ #if CONFIG_RTW_MESH_PEER_BLACKLIST -+ && !rtw_mesh_peer_blacklist_search(adapter, scanned->network.MacAddress) -+ #endif -+ #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ && rtw_mesh_cto_mgate_network_filter(adapter, scanned) -+ #endif -+ ) { -+ need = 1; -+ break; -+ } -+ } -+ -+ _exit_critical_bh(&(mlme->scanned_queue.lock), &irqL); -+ -+ return need; -+} -+ -+static int rtw_mesh_acnode_prevent_sacrifice_chk(_adapter *adapter, struct sta_info **sac, struct sta_info *com) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ int updated = 0; -+ -+ /* -+ * TODO: compare next_hop reference cnt of forwarding info -+ * don't sacrifice working next_hop or choose sta with least cnt -+ */ -+ -+ if (*sac == NULL) { -+ updated = 1; -+ goto exit; -+ } -+ -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ if (mcfg->peer_sel_policy.cto_mgate_require -+ && !mcfg->dot11MeshGateAnnouncementProtocol -+ ) { -+ if (IS_CTO_MGATE_CONF_TIMEOUT(com->plink)) { -+ if (!IS_CTO_MGATE_CONF_TIMEOUT((*sac)->plink)) { -+ /* blacklist > not blacklist */ -+ updated = 1; -+ goto exit; -+ } -+ } else if (!IS_CTO_MGATE_CONF_DISABLED(com->plink)) { -+ if (IS_CTO_MGATE_CONF_DISABLED((*sac)->plink)) { -+ /* confirming > disabled */ -+ updated = 1; -+ goto exit; -+ } -+ } -+ } -+#endif -+ -+exit: -+ if (updated) -+ *sac = com; -+ -+ return updated; -+} -+ -+struct sta_info *_rtw_mesh_acnode_prevent_pick_sacrifice(_adapter *adapter) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ _list *head, *list; -+ struct sta_info *sta, *sacrifice = NULL; -+ u8 nop; -+ -+ head = &stapriv->asoc_list; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); -+ list = get_next(list); -+ -+ if (!sta->plink || !sta->plink->scanned) { -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ rtw_mesh_bss_peering_status(&sta->plink->scanned->network, &nop, NULL); -+ if (nop < 2) -+ continue; -+ -+ rtw_mesh_acnode_prevent_sacrifice_chk(adapter, &sacrifice, sta); -+ } -+ -+ return sacrifice; -+} -+ -+struct sta_info *rtw_mesh_acnode_prevent_pick_sacrifice(_adapter *adapter) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct sta_info *sacrifice = NULL; -+ -+ enter_critical_bh(&stapriv->asoc_list_lock); -+ -+ sacrifice = _rtw_mesh_acnode_prevent_pick_sacrifice(adapter); -+ -+ exit_critical_bh(&stapriv->asoc_list_lock); -+ -+ return sacrifice; -+} -+ -+static void rtw_mesh_acnode_rsvd_chk(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ u8 acnode_rsvd = 0; -+ -+ if (rtw_mesh_acnode_prevent_allow_sacrifice(adapter) -+ && rtw_mesh_acnode_prevent_pick_sacrifice(adapter) -+ && rtw_mesh_acnode_candidate_exist(adapter)) -+ acnode_rsvd = 1; -+ -+ if (plink_ctl->acnode_rsvd != acnode_rsvd) { -+ plink_ctl->acnode_rsvd = acnode_rsvd; -+ RTW_INFO(FUNC_ADPT_FMT" acnode_rsvd = %d\n", FUNC_ADPT_ARG(adapter), plink_ctl->acnode_rsvd); -+ update_beacon(adapter, WLAN_EID_MESH_CONFIG, NULL, 1, 0); -+ } -+} -+ -+static void rtw_mesh_acnode_set_notify_etime(_adapter *adapter, u8 *rframe_whdr) -+{ -+ if (adapter->mesh_info.plink_ctl.acnode_rsvd) { -+ struct wlan_network *scanned = rtw_find_network(&adapter->mlmepriv.scanned_queue, get_addr2_ptr(rframe_whdr)); -+ -+ if (rtw_mesh_scanned_is_acnode_confirmed(adapter, scanned)) { -+ scanned->acnode_notify_etime = rtw_get_current_time() -+ + rtw_ms_to_systime(adapter->mesh_cfg.peer_sel_policy.acnode_notify_timeout_ms); -+ if (scanned->acnode_notify_etime == 0) -+ scanned->acnode_notify_etime++; -+ } -+ } -+} -+ -+void dump_mesh_acnode_prevent_settings(void *sel, _adapter *adapter) -+{ -+ struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; -+ -+ RTW_PRINT_SEL(sel, "%-6s %-12s %-14s\n" -+ , "enable", "conf_timeout", "nofity_timeout"); -+ RTW_PRINT_SEL(sel, "%6u %12u %14u\n" -+ , peer_sel_policy->acnode_prevent -+ , peer_sel_policy->acnode_conf_timeout_ms -+ , peer_sel_policy->acnode_notify_timeout_ms); -+} -+#endif /* CONFIG_RTW_MESH_ACNODE_PREVENT */ -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+int rtw_mesh_peer_blacklist_add(_adapter *adapter, const u8 *addr) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ return rtw_blacklist_add(&plink_ctl->peer_blacklist, addr -+ , mcfg->peer_sel_policy.peer_blacklist_timeout_ms); -+} -+ -+int rtw_mesh_peer_blacklist_del(_adapter *adapter, const u8 *addr) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ return rtw_blacklist_del(&plink_ctl->peer_blacklist, addr); -+} -+ -+int rtw_mesh_peer_blacklist_search(_adapter *adapter, const u8 *addr) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ return rtw_blacklist_search(&plink_ctl->peer_blacklist, addr); -+} -+ -+void rtw_mesh_peer_blacklist_flush(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ rtw_blacklist_flush(&plink_ctl->peer_blacklist); -+} -+ -+void dump_mesh_peer_blacklist(void *sel, _adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ dump_blacklist(sel, &plink_ctl->peer_blacklist, "blacklist"); -+} -+ -+void dump_mesh_peer_blacklist_settings(void *sel, _adapter *adapter) -+{ -+ struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; -+ -+ RTW_PRINT_SEL(sel, "%-12s %-17s\n" -+ , "conf_timeout", "blacklist_timeout"); -+ RTW_PRINT_SEL(sel, "%12u %17u\n" -+ , peer_sel_policy->peer_conf_timeout_ms -+ , peer_sel_policy->peer_blacklist_timeout_ms); -+} -+#endif /* CONFIG_RTW_MESH_PEER_BLACKLIST */ -+ -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+u8 rtw_mesh_cto_mgate_required(_adapter *adapter) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ return mcfg->peer_sel_policy.cto_mgate_require -+ && !rtw_bss_is_cto_mgate(&(mlmeext->mlmext_info.network)); -+} -+ -+u8 rtw_mesh_cto_mgate_network_filter(_adapter *adapter, struct wlan_network *scanned) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ return !rtw_mesh_cto_mgate_required(adapter) -+ || (rtw_bss_is_cto_mgate(&scanned->network) -+ && !rtw_mesh_cto_mgate_blacklist_search(adapter, scanned->network.MacAddress)); -+} -+ -+int rtw_mesh_cto_mgate_blacklist_add(_adapter *adapter, const u8 *addr) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ return rtw_blacklist_add(&plink_ctl->cto_mgate_blacklist, addr -+ , mcfg->peer_sel_policy.cto_mgate_blacklist_timeout_ms); -+} -+ -+int rtw_mesh_cto_mgate_blacklist_del(_adapter *adapter, const u8 *addr) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ return rtw_blacklist_del(&plink_ctl->cto_mgate_blacklist, addr); -+} -+ -+int rtw_mesh_cto_mgate_blacklist_search(_adapter *adapter, const u8 *addr) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ return rtw_blacklist_search(&plink_ctl->cto_mgate_blacklist, addr); -+} -+ -+void rtw_mesh_cto_mgate_blacklist_flush(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ rtw_blacklist_flush(&plink_ctl->cto_mgate_blacklist); -+} -+ -+void dump_mesh_cto_mgate_blacklist(void *sel, _adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ dump_blacklist(sel, &plink_ctl->cto_mgate_blacklist, "blacklist"); -+} -+ -+void dump_mesh_cto_mgate_blacklist_settings(void *sel, _adapter *adapter) -+{ -+ struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; -+ -+ RTW_PRINT_SEL(sel, "%-12s %-17s\n" -+ , "conf_timeout", "blacklist_timeout"); -+ RTW_PRINT_SEL(sel, "%12u %17u\n" -+ , peer_sel_policy->cto_mgate_conf_timeout_ms -+ , peer_sel_policy->cto_mgate_blacklist_timeout_ms); -+} -+ -+static void rtw_mesh_cto_mgate_blacklist_chk(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ _queue *blist = &plink_ctl->cto_mgate_blacklist; -+ _list *list, *head; -+ struct blacklist_ent *ent = NULL; -+ struct wlan_network *scanned = NULL; -+ -+ enter_critical_bh(&blist->lock); -+ head = &blist->queue; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ ent = LIST_CONTAINOR(list, struct blacklist_ent, list); -+ list = get_next(list); -+ -+ if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) { -+ rtw_list_delete(&ent->list); -+ rtw_mfree(ent, sizeof(struct blacklist_ent)); -+ continue; -+ } -+ -+ scanned = rtw_find_network(&adapter->mlmepriv.scanned_queue, ent->addr); -+ if (!scanned) -+ continue; -+ -+ if (rtw_bss_is_forwarding(&scanned->network)) { -+ rtw_list_delete(&ent->list); -+ rtw_mfree(ent, sizeof(struct blacklist_ent)); -+ } -+ } -+ -+ exit_critical_bh(&blist->lock); -+} -+#endif /* CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST */ -+ -+void rtw_chk_candidate_peer_notify(_adapter *adapter, struct wlan_network *scanned) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ bool acnode = 0; -+ -+ if (IS_CH_WAITING(rfctl) && !IS_UNDER_CAC(rfctl)) -+ goto exit; -+ -+ if (plink_ctl->num >= RTW_MESH_MAX_PEER_CANDIDATES) -+ goto exit; -+ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+ if (plink_ctl->acnode_rsvd) { -+ acnode = rtw_mesh_scanned_is_acnode_confirmed(adapter, scanned); -+ if (acnode && !rtw_mesh_scanned_is_acnode_allow_notify(adapter, scanned)) -+ goto exit; -+ } -+#endif -+ -+ /* wpa_supplicant's auto peer will initiate peering when candidate peer is reported without max_peer_links consideration */ -+ if (plink_ctl->num >= mcfg->max_peer_links + acnode ? 1 : 0) -+ goto exit; -+ -+ if (rtw_get_passing_time_ms(scanned->last_scanned) >= mcfg->peer_sel_policy.scanr_exp_ms -+ || (mcfg->rssi_threshold && mcfg->rssi_threshold > scanned->network.Rssi) -+ || !rtw_bss_is_candidate_mesh_peer(adapter, &scanned->network, 1, 1) -+ #if CONFIG_RTW_MACADDR_ACL -+ || rtw_access_ctrl(adapter, scanned->network.MacAddress) == _FALSE -+ #endif -+ || rtw_mesh_plink_get(adapter, scanned->network.MacAddress) -+ #if CONFIG_RTW_MESH_PEER_BLACKLIST -+ || rtw_mesh_peer_blacklist_search(adapter, scanned->network.MacAddress) -+ #endif -+ #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ || !rtw_mesh_cto_mgate_network_filter(adapter, scanned) -+ #endif -+ ) -+ goto exit; -+ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+ if (acnode) { -+ scanned->acnode_notify_etime = 0; -+ RTW_INFO(FUNC_ADPT_FMT" acnode "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(scanned->network.MacAddress)); -+ } -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_notify_new_peer_candidate(adapter->rtw_wdev -+ , scanned->network.MacAddress -+ , BSS_EX_TLV_IES(&scanned->network) -+ , BSS_EX_TLV_IES_LEN(&scanned->network) -+ , scanned->network.Rssi -+ , GFP_ATOMIC -+ ); -+#endif -+ -+exit: -+ return; -+} -+ -+void rtw_mesh_peer_status_chk(_adapter *adapter) -+{ -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *plink; -+ _list *head, *list; -+ struct sta_info *sta = NULL; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ int stainfo_offset; -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ u8 cto_mgate, forwarding, mgate; -+#endif -+ u8 flush; -+ s8 flush_list[NUM_STA]; -+ u8 flush_num = 0; -+ int i; -+ -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ if (rtw_mesh_cto_mgate_required(adapter)) { -+ /* active scan on operating channel */ -+ issue_probereq_ex(adapter, &adapter->mlmepriv.cur_network.network.mesh_id, NULL, 0, 0, 0, 0); -+ } -+#endif -+ -+ enter_critical_bh(&(plink_ctl->lock)); -+ -+ /* check established peers */ -+ enter_critical_bh(&stapriv->asoc_list_lock); -+ -+ head = &stapriv->asoc_list; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); -+ list = get_next(list); -+ -+ if (!sta->plink || !sta->plink->scanned) { -+ rtw_warn_on(1); -+ continue; -+ } -+ plink = sta->plink; -+ flush = 0; -+ -+ /* remove unsuitable peer */ -+ if (!rtw_bss_is_candidate_mesh_peer(adapter, &plink->scanned->network, 1, 0) -+ #if CONFIG_RTW_MACADDR_ACL -+ || rtw_access_ctrl(adapter, plink->addr) == _FALSE -+ #endif -+ ) { -+ flush = 1; -+ goto flush_add; -+ } -+ -+ #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ cto_mgate = rtw_bss_is_cto_mgate(&(plink->scanned->network)); -+ forwarding = rtw_bss_is_forwarding(&(plink->scanned->network)); -+ mgate = rtw_mesh_gate_search(minfo->mesh_paths, sta->cmn.mac_addr); -+ -+ /* CTO_MGATE required, remove peer without CTO_MGATE */ -+ if (rtw_mesh_cto_mgate_required(adapter) && !cto_mgate) { -+ flush = 1; -+ goto flush_add; -+ } -+ -+ /* cto_mgate_conf status update */ -+ if (IS_CTO_MGATE_CONF_DISABLED(plink)) { -+ if (cto_mgate && !forwarding && !mgate) -+ SET_CTO_MGATE_CONF_END_TIME(plink, mcfg->peer_sel_policy.cto_mgate_conf_timeout_ms); -+ else -+ rtw_mesh_cto_mgate_blacklist_del(adapter, sta->cmn.mac_addr); -+ } else { -+ /* cto_mgate_conf ongoing */ -+ if (cto_mgate && !forwarding && !mgate) { -+ if (IS_CTO_MGATE_CONF_TIMEOUT(plink)) { -+ rtw_mesh_cto_mgate_blacklist_add(adapter, sta->cmn.mac_addr); -+ -+ /* CTO_MGATE required, remove peering can't achieve CTO_MGATE */ -+ if (rtw_mesh_cto_mgate_required(adapter)) { -+ flush = 1; -+ goto flush_add; -+ } -+ } -+ } else { -+ SET_CTO_MGATE_CONF_DISABLED(plink); -+ rtw_mesh_cto_mgate_blacklist_del(adapter, sta->cmn.mac_addr); -+ } -+ } -+ #endif /* CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST */ -+ -+flush_add: -+ if (flush) { -+ rtw_list_delete(&sta->asoc_list); -+ stapriv->asoc_list_cnt--; -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (sta->tbtx_enable) -+ stapriv->tbtx_asoc_list_cnt--; -+#endif -+ STA_SET_MESH_PLINK(sta, NULL); -+ -+ stainfo_offset = rtw_stainfo_offset(stapriv, sta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ flush_list[flush_num++] = stainfo_offset; -+ else -+ rtw_warn_on(1); -+ } -+ } -+ -+ exit_critical_bh(&stapriv->asoc_list_lock); -+ -+ /* check non-established peers */ -+ for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { -+ plink = &plink_ctl->ent[i]; -+ if (plink->valid != _TRUE || plink->plink_state == RTW_MESH_PLINK_ESTAB) -+ continue; -+ -+ /* remove unsuitable peer */ -+ if (!rtw_bss_is_candidate_mesh_peer(adapter, &plink->scanned->network, 1, 1) -+ #if CONFIG_RTW_MACADDR_ACL -+ || rtw_access_ctrl(adapter, plink->addr) == _FALSE -+ #endif -+ ) { -+ _rtw_mesh_expire_peer_ent(adapter, plink); -+ continue; -+ } -+ -+ #if CONFIG_RTW_MESH_PEER_BLACKLIST -+ /* peer confirm check timeout, add to black list */ -+ if (IS_PEER_CONF_TIMEOUT(plink)) { -+ rtw_mesh_peer_blacklist_add(adapter, plink->addr); -+ _rtw_mesh_expire_peer_ent(adapter, plink); -+ } -+ #endif -+ } -+ -+ exit_critical_bh(&(plink_ctl->lock)); -+ -+ if (flush_num) { -+ u8 sta_addr[ETH_ALEN]; -+ u8 updated = _FALSE; -+ -+ for (i = 0; i < flush_num; i++) { -+ sta = rtw_get_stainfo_by_offset(stapriv, flush_list[i]); -+ _rtw_memcpy(sta_addr, sta->cmn.mac_addr, ETH_ALEN); -+ -+ updated |= ap_free_sta(adapter, sta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, _FALSE); -+ rtw_mesh_expire_peer(adapter, sta_addr); -+ } -+ -+ associated_clients_update(adapter, updated, STA_INFO_UPDATE_ALL); -+ } -+ -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ /* loop cto_mgate_blacklist to remove ent according to scan_r */ -+ rtw_mesh_cto_mgate_blacklist_chk(adapter); -+#endif -+ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+ rtw_mesh_acnode_rsvd_chk(adapter); -+#endif -+ -+ return; -+} -+ -+#if CONFIG_RTW_MESH_OFFCH_CAND -+static u8 rtw_mesh_offch_cto_mgate_required(_adapter *adapter) -+{ -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ _queue *queue = &(mlme->scanned_queue); -+ _list *head, *pos; -+ struct wlan_network *scanned = NULL; -+ u8 ret = 0; -+ -+ if (!rtw_mesh_cto_mgate_required(adapter)) -+ goto exit; -+ -+ enter_critical_bh(&(mlme->scanned_queue.lock)); -+ -+ head = get_list_head(queue); -+ pos = get_next(head); -+ while (!rtw_end_of_queue_search(head, pos)) { -+ scanned = LIST_CONTAINOR(pos, struct wlan_network, list); -+ -+ if (rtw_get_passing_time_ms(scanned->last_scanned) < mcfg->peer_sel_policy.scanr_exp_ms -+ && (!mcfg->rssi_threshold || mcfg->rssi_threshold <= scanned->network.Rssi) -+ #if CONFIG_RTW_MACADDR_ACL -+ && rtw_access_ctrl(adapter, scanned->network.MacAddress) == _TRUE -+ #endif -+ && rtw_bss_is_candidate_mesh_peer(adapter, &scanned->network, 1, 1) -+ && rtw_bss_is_cto_mgate(&scanned->network) -+ #if CONFIG_RTW_MESH_PEER_BLACKLIST -+ && !rtw_mesh_peer_blacklist_search(adapter, scanned->network.MacAddress) -+ #endif -+ && !rtw_mesh_cto_mgate_blacklist_search(adapter, scanned->network.MacAddress) -+ ) -+ break; -+ -+ pos = get_next(pos); -+ } -+ -+ if (rtw_end_of_queue_search(head, pos)) -+ ret = 1; -+ -+ exit_critical_bh(&(mlme->scanned_queue.lock)); -+ -+exit: -+ return ret; -+#else -+ return 0; -+#endif /* CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST */ -+} -+ -+u8 rtw_mesh_offch_candidate_accepted(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ u8 ret = 0; -+ -+ if (!adapter->mesh_cfg.peer_sel_policy.offch_cand) -+ goto exit; -+ -+ ret = MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter) -+ && (!plink_ctl->num || rtw_mesh_offch_cto_mgate_required(adapter)) -+ ; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (ret) { -+ struct mi_state mstate_no_self; -+ -+ rtw_mi_status_no_self(adapter, &mstate_no_self); -+ if (MSTATE_STA_LD_NUM(&mstate_no_self)) -+ ret = 0; -+ } -+#endif -+ -+exit: -+ return ret; -+} -+ -+/* -+ * this function is called under off channel candidate is required -+ * the channel with maximum candidate count is selected -+*/ -+u8 rtw_mesh_select_operating_ch(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ _queue *queue = &(mlme->scanned_queue); -+ _list *head, *pos; -+ _irqL irqL; -+ struct wlan_network *scanned = NULL; -+ int i; -+ /* statistics for candidate accept peering */ -+ u8 cand_ap_cnt[MAX_CHANNEL_NUM] = {0}; -+ u8 max_cand_ap_ch = 0; -+ u8 max_cand_ap_cnt = 0; -+ /* statistics for candidate including not accept peering */ -+ u8 cand_cnt[MAX_CHANNEL_NUM] = {0}; -+ u8 max_cand_ch = 0; -+ u8 max_cand_cnt = 0; -+ -+ _enter_critical_bh(&(mlme->scanned_queue.lock), &irqL); -+ -+ head = get_list_head(queue); -+ pos = get_next(head); -+ while (!rtw_end_of_queue_search(head, pos)) { -+ scanned = LIST_CONTAINOR(pos, struct wlan_network, list); -+ pos = get_next(pos); -+ -+ if (rtw_get_passing_time_ms(scanned->last_scanned) < mcfg->peer_sel_policy.scanr_exp_ms -+ && (!mcfg->rssi_threshold || mcfg->rssi_threshold <= scanned->network.Rssi) -+ #if CONFIG_RTW_MACADDR_ACL -+ && rtw_access_ctrl(adapter, scanned->network.MacAddress) == _TRUE -+ #endif -+ && rtw_bss_is_candidate_mesh_peer(adapter, &scanned->network, 0, 0) -+ #if CONFIG_RTW_MESH_PEER_BLACKLIST -+ && !rtw_mesh_peer_blacklist_search(adapter, scanned->network.MacAddress) -+ #endif -+ #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ && rtw_mesh_cto_mgate_network_filter(adapter, scanned) -+ #endif -+ ) { -+ int ch_set_idx = rtw_chset_search_ch(rfctl->channel_set, scanned->network.Configuration.DSConfig); -+ -+ if (ch_set_idx >= 0 -+ && !(rfctl->channel_set[ch_set_idx].flags & RTW_CHF_NO_IR) -+ && !CH_IS_NON_OCP(&rfctl->channel_set[ch_set_idx]) -+ ) { -+ u8 nop, accept; -+ -+ rtw_mesh_bss_peering_status(&scanned->network, &nop, &accept); -+ cand_cnt[ch_set_idx]++; -+ if (max_cand_cnt < cand_cnt[ch_set_idx]) { -+ max_cand_cnt = cand_cnt[ch_set_idx]; -+ max_cand_ch = rfctl->channel_set[ch_set_idx].ChannelNum; -+ } -+ if (accept) { -+ cand_ap_cnt[ch_set_idx]++; -+ if (max_cand_ap_cnt < cand_ap_cnt[ch_set_idx]) { -+ max_cand_ap_cnt = cand_ap_cnt[ch_set_idx]; -+ max_cand_ap_ch = rfctl->channel_set[ch_set_idx].ChannelNum; -+ } -+ } -+ } -+ } -+ } -+ -+ _exit_critical_bh(&(mlme->scanned_queue.lock), &irqL); -+ -+ return max_cand_ap_ch ? max_cand_ap_ch : max_cand_ch; -+} -+ -+void dump_mesh_offch_cand_settings(void *sel, _adapter *adapter) -+{ -+ struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; -+ -+ RTW_PRINT_SEL(sel, "%-6s %-11s\n" -+ , "enable", "find_int_ms"); -+ RTW_PRINT_SEL(sel, "%6u %11u\n" -+ , peer_sel_policy->offch_cand, peer_sel_policy->offch_find_int_ms); -+} -+#endif /* CONFIG_RTW_MESH_OFFCH_CAND */ -+ -+void dump_mesh_peer_sel_policy(void *sel, _adapter *adapter) -+{ -+ struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; -+ -+ RTW_PRINT_SEL(sel, "%-12s\n", "scanr_exp_ms"); -+ RTW_PRINT_SEL(sel, "%12u\n", peer_sel_policy->scanr_exp_ms); -+} -+ -+void dump_mesh_networks(void *sel, _adapter *adapter) -+{ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+#define NSTATE_TITLE_FMT_ACN " %-5s" -+#define NSTATE_VALUE_FMT_ACN " %5d" -+#define NSTATE_TITLE_ARG_ACN , "acn" -+#define NSTATE_VALUE_ARG_ACN , (acn_ms < 99999 ? acn_ms : 99999) -+#else -+#define NSTATE_TITLE_FMT_ACN "" -+#define NSTATE_VALUE_FMT_ACN "" -+#define NSTATE_TITLE_ARG_ACN -+#define NSTATE_VALUE_ARG_ACN -+#endif -+ -+ struct mlme_priv *mlme = &(adapter->mlmepriv); -+ _queue *queue = &(mlme->scanned_queue); -+ struct wlan_network *network; -+ _list *list, *head; -+ u8 same_mbss; -+ u8 candidate; -+ struct mesh_plink_ent *plink; -+ u8 blocked; -+ u8 established; -+ s32 age_ms; -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+ s32 acn_ms; -+#endif -+ u8 *mesh_conf_ie; -+ sint mesh_conf_ie_len; -+ u8 auth_pid; -+ u8 *rsn_ie; -+ int rsn_ie_len; -+ int gcs, pcs, gmcs; -+ u8 mfp_opt; -+ struct wlan_network **mesh_networks; -+ u8 mesh_network_cnt = 0; -+ int i; -+ -+ mesh_networks = rtw_zvmalloc(mlme->max_bss_cnt * sizeof(struct wlan_network *)); -+ if (!mesh_networks) -+ return; -+ -+ enter_critical_bh(&queue->lock); -+ head = get_list_head(queue); -+ list = get_next(head); -+ -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ network = LIST_CONTAINOR(list, struct wlan_network, list); -+ list = get_next(list); -+ -+ if (network->network.InfrastructureMode != Ndis802_11_mesh) -+ continue; -+ -+ mesh_conf_ie = rtw_get_ie(BSS_EX_TLV_IES(&network->network), WLAN_EID_MESH_CONFIG -+ , &mesh_conf_ie_len, BSS_EX_TLV_IES_LEN(&network->network)); -+ if (!mesh_conf_ie || mesh_conf_ie_len != 7) -+ continue; -+ -+ mesh_networks[mesh_network_cnt++] = network; -+ } -+ -+ exit_critical_bh(&queue->lock); -+ -+ RTW_PRINT_SEL(sel, " %-17s %-3s %-4s %-5s %-32s %-10s" -+ " %-3s %-3s %-4s" -+ " %-3s %-3s %-3s" -+ NSTATE_TITLE_FMT_ACN -+ "\n" -+ , "bssid", "ch", "rssi", "age", "mesh_id", "P M C S A " -+ , "pcs", "gcs", "gmcs" -+ , "nop", "fwd", "cto" -+ NSTATE_TITLE_ARG_ACN -+ ); -+ -+ if (MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter)) { -+ network = &mlme->cur_network; -+ mesh_conf_ie = rtw_get_ie(BSS_EX_TLV_IES(&network->network), WLAN_EID_MESH_CONFIG -+ , &mesh_conf_ie_len, BSS_EX_TLV_IES_LEN(&network->network)); -+ if (mesh_conf_ie && mesh_conf_ie_len == 7) { -+ gcs = pcs = gmcs = 0; -+ mfp_opt = MFP_NO; -+ auth_pid = GET_MESH_CONF_ELE_AUTH_PROTO_ID(mesh_conf_ie + 2); -+ if (auth_pid && auth_pid <= 2) { -+ rsn_ie = rtw_get_wpa2_ie(BSS_EX_TLV_IES(&network->network) -+ , &rsn_ie_len, BSS_EX_TLV_IES_LEN(&network->network)); -+ if (rsn_ie && rsn_ie_len) -+ rtw_parse_wpa2_ie(rsn_ie, rsn_ie_len + 2, &gcs, &pcs, &gmcs, NULL, &mfp_opt, NULL); -+ } -+ RTW_PRINT_SEL(sel, "* "MAC_FMT" %3d %-32s %2x%2x%2x%2x%2x" -+ " %03x %03x %c%03x" -+ " %c%2u %3u %c%c " -+ "\n" -+ , MAC_ARG(network->network.MacAddress) -+ , network->network.Configuration.DSConfig -+ , network->network.mesh_id.Ssid -+ , GET_MESH_CONF_ELE_PATH_SEL_PROTO_ID(mesh_conf_ie + 2) -+ , GET_MESH_CONF_ELE_PATH_SEL_METRIC_ID(mesh_conf_ie + 2) -+ , GET_MESH_CONF_ELE_CONGEST_CTRL_MODE_ID(mesh_conf_ie + 2) -+ , GET_MESH_CONF_ELE_SYNC_METHOD_ID(mesh_conf_ie + 2) -+ , auth_pid -+ , pcs, gcs, mfp_opt == MFP_REQUIRED ? 'R' : (mfp_opt == MFP_OPTIONAL ? 'C' : ' ') -+ , mfp_opt >= MFP_OPTIONAL ? gmcs : 0 -+ , GET_MESH_CONF_ELE_ACCEPT_PEERINGS(mesh_conf_ie + 2) ? '+' : ' ' -+ , GET_MESH_CONF_ELE_NUM_OF_PEERINGS(mesh_conf_ie + 2) -+ , GET_MESH_CONF_ELE_FORWARDING(mesh_conf_ie + 2) -+ , GET_MESH_CONF_ELE_CTO_MGATE(mesh_conf_ie + 2) ? 'G' : ' ' -+ , GET_MESH_CONF_ELE_CTO_AS(mesh_conf_ie + 2) ? 'A' : ' ' -+ ); -+ } -+ } -+ -+ for (i = 0; i < mesh_network_cnt; i++) { -+ network = mesh_networks[i]; -+ -+ if (network->network.InfrastructureMode != Ndis802_11_mesh) -+ continue; -+ -+ mesh_conf_ie = rtw_get_ie(BSS_EX_TLV_IES(&network->network), WLAN_EID_MESH_CONFIG -+ , &mesh_conf_ie_len, BSS_EX_TLV_IES_LEN(&network->network)); -+ if (!mesh_conf_ie || mesh_conf_ie_len != 7) -+ continue; -+ -+ gcs = pcs = gmcs = 0; -+ mfp_opt = MFP_NO; -+ auth_pid = GET_MESH_CONF_ELE_AUTH_PROTO_ID(mesh_conf_ie + 2); -+ if (auth_pid && auth_pid <= 2) { -+ rsn_ie = rtw_get_wpa2_ie(BSS_EX_TLV_IES(&network->network), &rsn_ie_len, BSS_EX_TLV_IES_LEN(&network->network)); -+ if (rsn_ie && rsn_ie_len) -+ rtw_parse_wpa2_ie(rsn_ie, rsn_ie_len + 2, &gcs, &pcs, &gmcs, NULL, &mfp_opt, NULL); -+ } -+ age_ms = rtw_get_passing_time_ms(network->last_scanned); -+ #if CONFIG_RTW_MESH_ACNODE_PREVENT -+ if (network->acnode_stime == 0) -+ acn_ms = 0; -+ else -+ acn_ms = rtw_get_passing_time_ms(network->acnode_stime); -+ #endif -+ same_mbss = 0; -+ candidate = 0; -+ plink = NULL; -+ blocked = 0; -+ established = 0; -+ -+ if (MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter)) { -+ plink = rtw_mesh_plink_get(adapter, network->network.MacAddress); -+ if (plink && plink->plink_state == RTW_MESH_PLINK_ESTAB) -+ established = 1; -+ else if (plink && plink->plink_state == RTW_MESH_PLINK_BLOCKED) -+ blocked = 1; -+ else if (plink) -+ ; -+ else if (rtw_bss_is_candidate_mesh_peer(adapter, &network->network, 0, 1)) -+ candidate = 1; -+ else if (rtw_bss_is_same_mbss(&mlme->cur_network.network, &network->network)) -+ same_mbss = 1; -+ } -+ -+ RTW_PRINT_SEL(sel, "%c "MAC_FMT" %3d %4ld %5d %-32s %2x%2x%2x%2x%2x" -+ " %03x %03x %c%03x" -+ " %c%2u %3u %c%c " -+ NSTATE_VALUE_FMT_ACN -+ "\n" -+ , established ? 'E' : (blocked ? 'B' : (plink ? 'N' : (candidate ? 'C' : (same_mbss ? 'S' : ' ')))) -+ , MAC_ARG(network->network.MacAddress) -+ , network->network.Configuration.DSConfig -+ , network->network.Rssi -+ , age_ms < 99999 ? age_ms : 99999 -+ , network->network.mesh_id.Ssid -+ , GET_MESH_CONF_ELE_PATH_SEL_PROTO_ID(mesh_conf_ie + 2) -+ , GET_MESH_CONF_ELE_PATH_SEL_METRIC_ID(mesh_conf_ie + 2) -+ , GET_MESH_CONF_ELE_CONGEST_CTRL_MODE_ID(mesh_conf_ie + 2) -+ , GET_MESH_CONF_ELE_SYNC_METHOD_ID(mesh_conf_ie + 2) -+ , auth_pid -+ , pcs, gcs, mfp_opt == MFP_REQUIRED ? 'R' : (mfp_opt == MFP_OPTIONAL ? 'C' : ' ') -+ , mfp_opt >= MFP_OPTIONAL ? gmcs : 0 -+ , GET_MESH_CONF_ELE_ACCEPT_PEERINGS(mesh_conf_ie + 2) ? '+' : ' ' -+ , GET_MESH_CONF_ELE_NUM_OF_PEERINGS(mesh_conf_ie + 2) -+ , GET_MESH_CONF_ELE_FORWARDING(mesh_conf_ie + 2) -+ , GET_MESH_CONF_ELE_CTO_MGATE(mesh_conf_ie + 2) ? 'G' : ' ' -+ , GET_MESH_CONF_ELE_CTO_AS(mesh_conf_ie + 2) ? 'A' : ' ' -+ NSTATE_VALUE_ARG_ACN -+ ); -+ } -+ -+ rtw_vmfree(mesh_networks, mlme->max_bss_cnt * sizeof(struct wlan_network *)); -+} -+ -+void rtw_mesh_adjust_chbw(u8 req_ch, u8 *req_bw, u8 *req_offset) -+{ -+ if (req_ch >= 5 && req_ch <= 9) { -+ /* prevent secondary channel offset mismatch */ -+ if (*req_bw > CHANNEL_WIDTH_20) { -+ *req_bw = CHANNEL_WIDTH_20; -+ *req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ } -+} -+ -+void rtw_mesh_sae_check_frames(_adapter *adapter, const u8 *buf, u32 len, u8 tx, u16 alg, u16 seq, u16 status) -+{ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+ if (tx && seq == 1) -+ rtw_mesh_plink_set_peer_conf_timeout(adapter, GetAddr1Ptr(buf)); -+#endif -+} -+ -+#if CONFIG_RTW_MPM_TX_IES_SYNC_BSS -+#ifdef CONFIG_RTW_MESH_AEK -+static int rtw_mpm_ampe_dec(_adapter *adapter, struct mesh_plink_ent *plink -+ , u8 *fhead, size_t flen, u8* fbody, u8 *mic_ie, u8 *ampe_buf) -+{ -+ int ret = _FAIL, verify_ret; -+ const u8 *aad[] = {adapter_mac_addr(adapter), plink->addr, fbody}; -+ const size_t aad_len[] = {ETH_ALEN, ETH_ALEN, mic_ie - fbody}; -+ u8 *iv_crypt; -+ size_t iv_crypt_len = flen - (mic_ie + 2 - fhead); -+ -+ iv_crypt = rtw_malloc(iv_crypt_len); -+ if (!iv_crypt) -+ goto exit; -+ -+ _rtw_memcpy(iv_crypt, mic_ie + 2, iv_crypt_len); -+ -+ verify_ret = rtw_aes_siv_decrypt(plink->aek, 32, iv_crypt, iv_crypt_len -+ , 3, aad, aad_len, ampe_buf); -+ -+ rtw_mfree(iv_crypt, iv_crypt_len); -+ -+ if (verify_ret) { -+ RTW_WARN("verify error, aek_valid=%u\n", plink->aek_valid); -+ goto exit; -+ } else if (*ampe_buf != WLAN_EID_AMPE) { -+ RTW_WARN("plaintext is not AMPE IE\n"); -+ goto exit; -+ } else if ( 16 /* AES_BLOCK_SIZE*/ + 2 + *(ampe_buf + 1) > iv_crypt_len) { -+ RTW_WARN("plaintext AMPE IE length is not valid\n"); -+ goto exit; -+ } -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+static int rtw_mpm_ampe_enc(_adapter *adapter, struct mesh_plink_ent *plink -+ , u8* fbody, u8 *mic_ie, u8 *ampe_buf, bool inverse) -+{ -+ int ret = _FAIL, protect_ret; -+ const u8 *aad[3]; -+ const size_t aad_len[3] = {ETH_ALEN, ETH_ALEN, mic_ie - fbody}; -+ u8 *ampe_ie; -+ size_t ampe_ie_len = *(ampe_buf + 1) + 2; /* including id & len */ -+ -+ if (inverse) { -+ aad[0] = plink->addr; -+ aad[1] = adapter_mac_addr(adapter); -+ } else { -+ aad[0] = adapter_mac_addr(adapter); -+ aad[1] = plink->addr; -+ } -+ aad[2] = fbody; -+ -+ ampe_ie = rtw_malloc(ampe_ie_len); -+ if (!ampe_ie) -+ goto exit; -+ -+ _rtw_memcpy(ampe_ie, ampe_buf, ampe_ie_len); -+ -+ protect_ret = rtw_aes_siv_encrypt(plink->aek, 32, ampe_ie, ampe_ie_len -+ , 3, aad, aad_len, mic_ie + 2); -+ -+ rtw_mfree(ampe_ie, ampe_ie_len); -+ -+ if (protect_ret) { -+ RTW_WARN("protect error, aek_valid=%u\n", plink->aek_valid); -+ goto exit; -+ } -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_RTW_MESH_AEK */ -+ -+static int rtw_mpm_tx_ies_sync_bss(_adapter *adapter, struct mesh_plink_ent *plink -+ , u8 *fhead, size_t flen, u8* fbody, u8 tlv_ies_offset, u8 *mpm_ie, u8 *mic_ie -+ , u8 **nbuf, size_t *nlen) -+{ -+ int ret = _FAIL; -+ struct mlme_priv *mlme = &(adapter->mlmepriv); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info); -+ WLAN_BSSID_EX *network = &(mlmeinfo->network); -+ uint left; -+ u8 *pos; -+ -+ uint mpm_ielen = *(mpm_ie + 1); -+ u8 *fpos; -+ u8 *new_buf = NULL; -+ size_t new_len = 0; -+ -+ u8 *new_fhead; -+ size_t new_flen; -+ u8 *new_fbody; -+ u8 *new_mic_ie; -+ -+#ifdef CONFIG_RTW_MESH_AEK -+ u8 *ampe_buf = NULL; -+ size_t ampe_buf_len = 0; -+ -+ /* decode */ -+ if (mic_ie) { -+ ampe_buf_len = flen - (mic_ie + 2 + 16 /* AES_BLOCK_SIZE */ - fhead); -+ ampe_buf = rtw_malloc(ampe_buf_len); -+ if (!ampe_buf) -+ goto exit; -+ -+ if (rtw_mpm_ampe_dec(adapter, plink, fhead, flen, fbody, mic_ie, ampe_buf) != _SUCCESS) -+ goto exit; -+ -+ if (*(ampe_buf + 1) >= 68) { -+ _rtw_memcpy(plink->sel_pcs, ampe_buf + 2, 4); -+ _rtw_memcpy(plink->l_nonce, ampe_buf + 6, 32); -+ _rtw_memcpy(plink->p_nonce, ampe_buf + 38, 32); -+ } -+ } -+#endif -+ -+ /* count for new frame length */ -+ new_len = sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset; -+ left = BSS_EX_TLV_IES_LEN(network); -+ pos = BSS_EX_TLV_IES(network); -+ while (left >= 2) { -+ u8 id, elen; -+ -+ id = *pos++; -+ elen = *pos++; -+ left -= 2; -+ -+ if (elen > left) -+ break; -+ -+ switch (id) { -+ case WLAN_EID_SSID: -+ case WLAN_EID_DS_PARAMS: -+ case WLAN_EID_TIM: -+ break; -+ default: -+ new_len += 2 + elen; -+ } -+ -+ left -= elen; -+ pos += elen; -+ } -+ new_len += mpm_ielen + 2; -+ if (mic_ie) -+ new_len += 16 /* AES_BLOCK_SIZE*/ + 2 + ampe_buf_len; -+ -+ /* alloc new frame */ -+ new_buf = rtw_malloc(new_len); -+ if (!new_buf) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ /* build new frame */ -+ _rtw_memcpy(new_buf, fhead, sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset); -+ new_fhead = new_buf; -+ new_flen = new_len; -+ new_fbody = new_fhead + sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ fpos = new_fbody + tlv_ies_offset; -+ left = BSS_EX_TLV_IES_LEN(network); -+ pos = BSS_EX_TLV_IES(network); -+ while (left >= 2) { -+ u8 id, elen; -+ -+ id = *pos++; -+ elen = *pos++; -+ left -= 2; -+ -+ if (elen > left) -+ break; -+ -+ switch (id) { -+ case WLAN_EID_SSID: -+ case WLAN_EID_DS_PARAMS: -+ case WLAN_EID_TIM: -+ break; -+ default: -+ fpos = rtw_set_ie(fpos, id, elen, pos, NULL); -+ if (id == WLAN_EID_MESH_CONFIG) -+ fpos = rtw_set_ie(fpos, WLAN_EID_MPM, mpm_ielen, mpm_ie + 2, NULL); -+ } -+ -+ left -= elen; -+ pos += elen; -+ } -+ if (mic_ie) { -+ new_mic_ie = fpos; -+ *fpos++ = WLAN_EID_MIC; -+ *fpos++ = 16 /* AES_BLOCK_SIZE */; -+ } -+ -+#ifdef CONFIG_RTW_MESH_AEK -+ /* encode */ -+ if (mic_ie) { -+ int enc_ret = rtw_mpm_ampe_enc(adapter, plink, new_fbody, new_mic_ie, ampe_buf, 0); -+ if (enc_ret != _SUCCESS) -+ goto exit; -+ } -+#endif -+ -+ *nlen = new_len; -+ *nbuf = new_buf; -+ -+ ret = _SUCCESS; -+ -+exit: -+ if (ret != _SUCCESS && new_buf) -+ rtw_mfree(new_buf, new_len); -+ -+#ifdef CONFIG_RTW_MESH_AEK -+ if (ampe_buf) -+ rtw_mfree(ampe_buf, ampe_buf_len); -+#endif -+ -+ return ret; -+} -+#endif /* CONFIG_RTW_MPM_TX_IES_SYNC_BSS */ -+ -+struct mpm_frame_info { -+ u8 *aid; -+ u16 aid_v; -+ u8 *pid; -+ u16 pid_v; -+ u8 *llid; -+ u16 llid_v; -+ u8 *plid; -+ u16 plid_v; -+ u8 *reason; -+ u16 reason_v; -+ u8 *chosen_pmk; -+}; -+ -+/* -+* pid:00000 llid:00000 chosen_pmk:0x00000000000000000000000000000000 -+* aid:00000 pid:00000 llid:00000 plid:00000 chosen_pmk:0x00000000000000000000000000000000 -+* pid:00000 llid:00000 plid:00000 reason:00000 chosen_pmk:0x00000000000000000000000000000000 -+*/ -+#define MPM_LOG_BUF_LEN 92 /* this length is limited for legal combination */ -+static void rtw_mpm_info_msg(struct mpm_frame_info *mpm_info, u8 *mpm_log_buf) -+{ -+ int cnt = 0; -+ -+ if (mpm_info->aid) { -+ cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "aid:%u ", mpm_info->aid_v); -+ if (cnt >= MPM_LOG_BUF_LEN - 1) -+ goto exit; -+ } -+ if (mpm_info->pid) { -+ cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "pid:%u ", mpm_info->pid_v); -+ if (cnt >= MPM_LOG_BUF_LEN - 1) -+ goto exit; -+ } -+ if (mpm_info->llid) { -+ cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "llid:%u ", mpm_info->llid_v); -+ if (cnt >= MPM_LOG_BUF_LEN - 1) -+ goto exit; -+ } -+ if (mpm_info->plid) { -+ cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "plid:%u ", mpm_info->plid_v); -+ if (cnt >= MPM_LOG_BUF_LEN - 1) -+ goto exit; -+ } -+ if (mpm_info->reason) { -+ cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "reason:%u ", mpm_info->reason_v); -+ if (cnt >= MPM_LOG_BUF_LEN - 1) -+ goto exit; -+ } -+ if (mpm_info->chosen_pmk) { -+ cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "chosen_pmk:0x"KEY_FMT, KEY_ARG(mpm_info->chosen_pmk)); -+ if (cnt >= MPM_LOG_BUF_LEN - 1) -+ goto exit; -+ } -+ -+exit: -+ return; -+} -+ -+static int rtw_mpm_check_frames(_adapter *adapter, u8 action, const u8 **buf, size_t *len, u8 tx) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *plink = NULL; -+ u8 *nbuf = NULL; -+ size_t nlen = 0; -+ u8 *fhead = (u8 *)*buf; -+ size_t flen = *len; -+ u8 *peer_addr = tx ? GetAddr1Ptr(fhead) : get_addr2_ptr(fhead); -+ u8 *frame_body = fhead + sizeof(struct rtw_ieee80211_hdr_3addr); -+ struct mpm_frame_info mpm_info; -+ u8 tlv_ies_offset; -+ u8 *mpm_ie = NULL; -+ uint mpm_ielen = 0; -+ u8 *mic_ie = NULL; -+ uint mic_ielen = 0; -+ int ret = 0; -+ u8 mpm_log_buf[MPM_LOG_BUF_LEN] = {0}; -+ -+ if (action == RTW_ACT_SELF_PROTECTED_MESH_OPEN) -+ tlv_ies_offset = 4; -+ else if (action == RTW_ACT_SELF_PROTECTED_MESH_CONF) -+ tlv_ies_offset = 6; -+ else if (action == RTW_ACT_SELF_PROTECTED_MESH_CLOSE) -+ tlv_ies_offset = 2; -+ else { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ plink = rtw_mesh_plink_get(adapter, peer_addr); -+ if (!plink && (tx == _TRUE || action == RTW_ACT_SELF_PROTECTED_MESH_CONF)) { -+ /* warning message if no plink when: 1.TX all MPM or 2.RX CONF */ -+ RTW_WARN("RTW_%s:%s without plink of "MAC_FMT"\n" -+ , (tx == _TRUE) ? "Tx" : "Rx", action_self_protected_str(action), MAC_ARG(peer_addr)); -+ goto exit; -+ } -+ -+ _rtw_memset(&mpm_info, 0, sizeof(struct mpm_frame_info)); -+ -+ if (action == RTW_ACT_SELF_PROTECTED_MESH_CONF) { -+ mpm_info.aid = (u8 *)frame_body + 4; -+ mpm_info.aid_v = RTW_GET_LE16(mpm_info.aid); -+ } -+ -+ mpm_ie = rtw_get_ie(fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset -+ , WLAN_EID_MPM, &mpm_ielen -+ , flen - sizeof(struct rtw_ieee80211_hdr_3addr) - tlv_ies_offset); -+ if (!mpm_ie || mpm_ielen < 2 + 2) -+ goto exit; -+ -+ mpm_info.pid = mpm_ie + 2; -+ mpm_info.pid_v = RTW_GET_LE16(mpm_info.pid); -+ mpm_info.llid = mpm_info.pid + 2; -+ mpm_info.llid_v = RTW_GET_LE16(mpm_info.llid); -+ -+ switch (action) { -+ case RTW_ACT_SELF_PROTECTED_MESH_OPEN: -+ /* pid:2, llid:2, (chosen_pmk:16) */ -+ if (mpm_info.pid_v == 0 && mpm_ielen == 4) -+ ; -+ else if (mpm_info.pid_v == 1 && mpm_ielen == 20) -+ mpm_info.chosen_pmk = mpm_info.llid + 2; -+ else -+ goto exit; -+ break; -+ case RTW_ACT_SELF_PROTECTED_MESH_CONF: -+ /* pid:2, llid:2, plid:2, (chosen_pmk:16) */ -+ mpm_info.plid = mpm_info.llid + 2; -+ mpm_info.plid_v = RTW_GET_LE16(mpm_info.plid); -+ if (mpm_info.pid_v == 0 && mpm_ielen == 6) -+ ; -+ else if (mpm_info.pid_v == 1 && mpm_ielen == 22) -+ mpm_info.chosen_pmk = mpm_info.plid + 2; -+ else -+ goto exit; -+ break; -+ case RTW_ACT_SELF_PROTECTED_MESH_CLOSE: -+ /* pid:2, llid:2, (plid:2), reason:2, (chosen_pmk:16) */ -+ if (mpm_info.pid_v == 0 && mpm_ielen == 6) { -+ /* MPM, without plid */ -+ mpm_info.reason = mpm_info.llid + 2; -+ mpm_info.reason_v = RTW_GET_LE16(mpm_info.reason); -+ } else if (mpm_info.pid_v == 0 && mpm_ielen == 8) { -+ /* MPM, with plid */ -+ mpm_info.plid = mpm_info.llid + 2; -+ mpm_info.plid_v = RTW_GET_LE16(mpm_info.plid); -+ mpm_info.reason = mpm_info.plid + 2; -+ mpm_info.reason_v = RTW_GET_LE16(mpm_info.reason); -+ } else if (mpm_info.pid_v == 1 && mpm_ielen == 22) { -+ /* AMPE, without plid */ -+ mpm_info.reason = mpm_info.llid + 2; -+ mpm_info.reason_v = RTW_GET_LE16(mpm_info.reason); -+ mpm_info.chosen_pmk = mpm_info.reason + 2; -+ } else if (mpm_info.pid_v == 1 && mpm_ielen == 24) { -+ /* AMPE, with plid */ -+ mpm_info.plid = mpm_info.llid + 2; -+ mpm_info.plid_v = RTW_GET_LE16(mpm_info.plid); -+ mpm_info.reason = mpm_info.plid + 2; -+ mpm_info.reason_v = RTW_GET_LE16(mpm_info.reason); -+ mpm_info.chosen_pmk = mpm_info.reason + 2; -+ } else -+ goto exit; -+ break; -+ }; -+ -+ if (mpm_info.pid_v == 1) { -+ mic_ie = rtw_get_ie(fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset -+ , WLAN_EID_MIC, &mic_ielen -+ , flen - sizeof(struct rtw_ieee80211_hdr_3addr) - tlv_ies_offset); -+ if (!mic_ie || mic_ielen != 16 /* AES_BLOCK_SIZE */) -+ goto exit; -+ } -+ -+#if CONFIG_RTW_MPM_TX_IES_SYNC_BSS -+ if ((action == RTW_ACT_SELF_PROTECTED_MESH_OPEN || action == RTW_ACT_SELF_PROTECTED_MESH_CONF) -+ && tx == _TRUE -+ ) { -+#define DBG_RTW_MPM_TX_IES_SYNC_BSS 0 -+ -+ if (mpm_info.pid_v == 1 && (!plink || !MESH_PLINK_AEK_VALID(plink))) { -+ RTW_WARN("AEK not ready, IEs can't sync with BSS\n"); -+ goto bypass_sync_bss; -+ } -+ -+ if (DBG_RTW_MPM_TX_IES_SYNC_BSS) { -+ RTW_INFO(FUNC_ADPT_FMT" before:\n", FUNC_ADPT_ARG(adapter)); -+ dump_ies(RTW_DBGDUMP -+ , fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset -+ , flen - sizeof(struct rtw_ieee80211_hdr_3addr) - tlv_ies_offset); -+ } -+ -+ rtw_mpm_tx_ies_sync_bss(adapter, plink -+ , fhead, flen, frame_body, tlv_ies_offset, mpm_ie, mic_ie -+ , &nbuf, &nlen); -+ if (!nbuf) -+ goto exit; -+ -+ /* update pointer & len for new frame */ -+ fhead = nbuf; -+ flen = nlen; -+ frame_body = fhead + sizeof(struct rtw_ieee80211_hdr_3addr); -+ if (mpm_info.pid_v == 1) { -+ mic_ie = rtw_get_ie(fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset -+ , WLAN_EID_MIC, &mic_ielen -+ , flen - sizeof(struct rtw_ieee80211_hdr_3addr) - tlv_ies_offset); -+ } -+ -+ if (DBG_RTW_MPM_TX_IES_SYNC_BSS) { -+ RTW_INFO(FUNC_ADPT_FMT" after:\n", FUNC_ADPT_ARG(adapter)); -+ dump_ies(RTW_DBGDUMP -+ , fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset -+ , flen - sizeof(struct rtw_ieee80211_hdr_3addr) - tlv_ies_offset); -+ } -+ } -+bypass_sync_bss: -+#endif /* CONFIG_RTW_MPM_TX_IES_SYNC_BSS */ -+ -+ if (!plink) -+ goto mpm_log; -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+ if (action == RTW_ACT_SELF_PROTECTED_MESH_OPEN) { -+ if (tx) -+ rtw_mesh_plink_set_peer_conf_timeout(adapter, peer_addr); -+ -+ } else -+#endif -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+ if (action == RTW_ACT_SELF_PROTECTED_MESH_CLOSE) { -+ if (tx && mpm_info.reason && mpm_info.reason_v == WLAN_REASON_MESH_MAX_PEERS) { -+ if (rtw_mesh_scanned_is_acnode_confirmed(adapter, plink->scanned) -+ && rtw_mesh_acnode_prevent_allow_sacrifice(adapter) -+ ) { -+ struct sta_info *sac = rtw_mesh_acnode_prevent_pick_sacrifice(adapter); -+ -+ if (sac) { -+ struct sta_priv *stapriv = &adapter->stapriv; -+ _irqL irqL; -+ u8 sta_addr[ETH_ALEN]; -+ u8 updated = _FALSE; -+ -+ _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ if (!rtw_is_list_empty(&sac->asoc_list)) { -+ rtw_list_delete(&sac->asoc_list); -+ stapriv->asoc_list_cnt--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (sac->tbtx_enable) -+ stapriv->tbtx_asoc_list_cnt--; -+ #endif -+ STA_SET_MESH_PLINK(sac, NULL); -+ } -+ _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ RTW_INFO(FUNC_ADPT_FMT" sacrifice "MAC_FMT" for acnode\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(sac->cmn.mac_addr)); -+ -+ _rtw_memcpy(sta_addr, sac->cmn.mac_addr, ETH_ALEN); -+ updated = ap_free_sta(adapter, sac, 0, 0, 1); -+ rtw_mesh_expire_peer(stapriv->padapter, sta_addr); -+ -+ associated_clients_update(adapter, updated, STA_INFO_UPDATE_ALL); -+ } -+ } -+ } -+ } else -+#endif -+ if (action == RTW_ACT_SELF_PROTECTED_MESH_CONF) { -+ _irqL irqL; -+ u8 *ies = NULL; -+ u16 ies_len = 0; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ plink = _rtw_mesh_plink_get(adapter, peer_addr); -+ if (!plink) -+ goto release_plink_ctl; -+ -+ if (tx == _FALSE) { -+ ies = plink->rx_conf_ies; -+ ies_len = plink->rx_conf_ies_len; -+ plink->rx_conf_ies = NULL; -+ plink->rx_conf_ies_len = 0; -+ -+ plink->llid = mpm_info.plid_v; -+ plink->plid = mpm_info.llid_v; -+ plink->peer_aid = mpm_info.aid_v; -+ if (mpm_info.pid_v == 1) -+ _rtw_memcpy(plink->chosen_pmk, mpm_info.chosen_pmk, 16); -+ } -+ #ifdef CONFIG_RTW_MESH_DRIVER_AID -+ else { -+ ies = plink->tx_conf_ies; -+ ies_len = plink->tx_conf_ies_len; -+ plink->tx_conf_ies = NULL; -+ plink->tx_conf_ies_len = 0; -+ } -+ #endif -+ -+ if (ies && ies_len) -+ rtw_mfree(ies, ies_len); -+ -+ #ifndef CONFIG_RTW_MESH_DRIVER_AID -+ if (tx == _TRUE) -+ goto release_plink_ctl; /* no need to copy tx conf ies */ -+ #endif -+ -+ /* copy mesh confirm IEs */ -+ if (mpm_info.pid_v == 1) /* not include MIC & encrypted AMPE */ -+ ies_len = (mic_ie - fhead) - sizeof(struct rtw_ieee80211_hdr_3addr) - 2; -+ else -+ ies_len = flen - sizeof(struct rtw_ieee80211_hdr_3addr) - 2; -+ -+ ies = rtw_zmalloc(ies_len); -+ if (ies) { -+ _rtw_memcpy(ies, fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + 2, ies_len); -+ if (tx == _FALSE) { -+ plink->rx_conf_ies = ies; -+ plink->rx_conf_ies_len = ies_len; -+ } -+ #ifdef CONFIG_RTW_MESH_DRIVER_AID -+ else { -+ plink->tx_conf_ies = ies; -+ plink->tx_conf_ies_len = ies_len; -+ } -+ #endif -+ } -+ -+release_plink_ctl: -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+ } -+ -+mpm_log: -+ rtw_mpm_info_msg(&mpm_info, mpm_log_buf); -+ RTW_INFO("RTW_%s:%s %s\n" -+ , (tx == _TRUE) ? "Tx" : "Rx" -+ , action_self_protected_str(action) -+ , mpm_log_buf -+ ); -+ -+ ret = 1; -+ -+exit: -+ if (nbuf) { -+ if (ret == 1) { -+ *buf = nbuf; -+ *len = nlen; -+ } else -+ rtw_mfree(nbuf, nlen); -+ } -+ -+ return ret; -+} -+ -+static int rtw_mesh_check_frames(_adapter *adapter, const u8 **buf, size_t *len, u8 tx) -+{ -+ int is_mesh_frame = -1; -+ const u8 *frame_body; -+ u8 category, action; -+ -+ frame_body = *buf + sizeof(struct rtw_ieee80211_hdr_3addr); -+ category = frame_body[0]; -+ -+ if (category == RTW_WLAN_CATEGORY_SELF_PROTECTED) { -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_ACT_SELF_PROTECTED_MESH_OPEN: -+ case RTW_ACT_SELF_PROTECTED_MESH_CONF: -+ case RTW_ACT_SELF_PROTECTED_MESH_CLOSE: -+ rtw_mpm_check_frames(adapter, action, buf, len, tx); -+ is_mesh_frame = action; -+ break; -+ case RTW_ACT_SELF_PROTECTED_MESH_GK_INFORM: -+ case RTW_ACT_SELF_PROTECTED_MESH_GK_ACK: -+ RTW_INFO("RTW_%s:%s\n", (tx == _TRUE) ? "Tx" : "Rx", action_self_protected_str(action)); -+ is_mesh_frame = action; -+ break; -+ default: -+ break; -+ }; -+ } -+ -+ return is_mesh_frame; -+} -+ -+int rtw_mesh_check_frames_tx(_adapter *adapter, const u8 **buf, size_t *len) -+{ -+ return rtw_mesh_check_frames(adapter, buf, len, _TRUE); -+} -+ -+int rtw_mesh_check_frames_rx(_adapter *adapter, const u8 *buf, size_t len) -+{ -+ return rtw_mesh_check_frames(adapter, &buf, &len, _FALSE); -+} -+ -+int rtw_mesh_on_auth(_adapter *adapter, union recv_frame *rframe) -+{ -+ u8 *whdr = rframe->u.hdr.rx_data; -+ -+#if CONFIG_RTW_MACADDR_ACL -+ if (rtw_access_ctrl(adapter, get_addr2_ptr(whdr)) == _FALSE) -+ return _SUCCESS; -+#endif -+ -+ if (!rtw_mesh_plink_get(adapter, get_addr2_ptr(whdr))) { -+ #if CONFIG_RTW_MESH_ACNODE_PREVENT -+ rtw_mesh_acnode_set_notify_etime(adapter, whdr); -+ #endif -+ -+ if (adapter_to_rfctl(adapter)->offch_state == OFFCHS_NONE) -+ issue_probereq(adapter, &adapter->mlmepriv.cur_network.network.mesh_id, get_addr2_ptr(whdr)); -+ -+ /* only peer being added (checked by notify conditions) is allowed */ -+ return _SUCCESS; -+ } -+ -+ rtw_cfg80211_rx_mframe(adapter, rframe, NULL); -+ return _SUCCESS; -+} -+ -+unsigned int on_action_self_protected(_adapter *adapter, union recv_frame *rframe) -+{ -+ unsigned int ret = _FAIL; -+ struct sta_info *sta = NULL; -+ u8 *pframe = rframe->u.hdr.rx_data; -+ uint frame_len = rframe->u.hdr.len; -+ u8 *frame_body = (u8 *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u8 category; -+ u8 action; -+ -+ /* check RA matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(adapter), GetAddr1Ptr(pframe), ETH_ALEN)) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_SELF_PROTECTED) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_ACT_SELF_PROTECTED_MESH_OPEN: -+ case RTW_ACT_SELF_PROTECTED_MESH_CONF: -+ case RTW_ACT_SELF_PROTECTED_MESH_CLOSE: -+ case RTW_ACT_SELF_PROTECTED_MESH_GK_INFORM: -+ case RTW_ACT_SELF_PROTECTED_MESH_GK_ACK: -+ if (!(MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter))) -+ goto exit; -+#ifdef CONFIG_IOCTL_CFG80211 -+ #if CONFIG_RTW_MACADDR_ACL -+ if (rtw_access_ctrl(adapter, get_addr2_ptr(pframe)) == _FALSE) -+ goto exit; -+ #endif -+ #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ if (rtw_mesh_cto_mgate_required(adapter) -+ /* only peer being added (checked by notify conditions) is allowed */ -+ && !rtw_mesh_plink_get(adapter, get_addr2_ptr(pframe))) -+ goto exit; -+ #endif -+ rtw_cfg80211_rx_action(adapter, rframe, NULL); -+ ret = _SUCCESS; -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+const u8 ae_to_mesh_ctrl_len[] = { -+ 6, -+ 12, /* MESH_FLAGS_AE_A4 */ -+ 18, /* MESH_FLAGS_AE_A5_A6 */ -+ 0, -+}; -+ -+unsigned int on_action_mesh(_adapter *adapter, union recv_frame *rframe) -+{ -+ unsigned int ret = _FAIL; -+ struct sta_info *sta = NULL; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ u8 *pframe = rframe->u.hdr.rx_data; -+ uint frame_len = rframe->u.hdr.len; -+ u8 *frame_body = (u8 *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u8 category; -+ u8 action; -+ -+ if (!MLME_IS_MESH(adapter)) -+ goto exit; -+ -+ /* check stainfo exist? */ -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_MESH) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_ACT_MESH_HWMP_PATH_SELECTION: -+ rtw_mesh_rx_path_sel_frame(adapter, rframe); -+ ret = _SUCCESS; -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+bool rtw_mesh_update_bss_peering_status(_adapter *adapter, WLAN_BSSID_EX *bss) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ u8 num_of_peerings = stapriv->asoc_list_cnt; -+ bool accept_peerings = stapriv->asoc_list_cnt < mcfg->max_peer_links; -+ u8 *ie; -+ int ie_len; -+ bool updated = 0; -+ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+ accept_peerings |= plink_ctl->acnode_rsvd; -+#endif -+ -+ ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, BSS_EX_TLV_IES_LEN(bss)); -+ if (!ie || ie_len != 7) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (GET_MESH_CONF_ELE_NUM_OF_PEERINGS(ie + 2) != num_of_peerings) { -+ SET_MESH_CONF_ELE_NUM_OF_PEERINGS(ie + 2, num_of_peerings); -+ updated = 1; -+ } -+ -+ if (GET_MESH_CONF_ELE_ACCEPT_PEERINGS(ie + 2) != accept_peerings) { -+ SET_MESH_CONF_ELE_ACCEPT_PEERINGS(ie + 2, accept_peerings); -+ updated = 1; -+ } -+ -+exit: -+ return updated; -+} -+ -+bool rtw_mesh_update_bss_formation_info(_adapter *adapter, WLAN_BSSID_EX *bss) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ u8 cto_mgate = (minfo->num_gates || mcfg->dot11MeshGateAnnouncementProtocol); -+ u8 cto_as = 0; -+ u8 *ie; -+ int ie_len; -+ bool updated = 0; -+ -+ ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, -+ BSS_EX_TLV_IES_LEN(bss)); -+ if (!ie || ie_len != 7) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (GET_MESH_CONF_ELE_CTO_MGATE(ie + 2) != cto_mgate) { -+ SET_MESH_CONF_ELE_CTO_MGATE(ie + 2, cto_mgate); -+ updated = 1; -+ } -+ -+ if (GET_MESH_CONF_ELE_CTO_AS(ie + 2) != cto_as) { -+ SET_MESH_CONF_ELE_CTO_AS(ie + 2, cto_as); -+ updated = 1; -+ } -+ -+exit: -+ return updated; -+} -+ -+bool rtw_mesh_update_bss_forwarding_state(_adapter *adapter, WLAN_BSSID_EX *bss) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ u8 forward = mcfg->dot11MeshForwarding; -+ u8 *ie; -+ int ie_len; -+ bool updated = 0; -+ -+ ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, -+ BSS_EX_TLV_IES_LEN(bss)); -+ if (!ie || ie_len != 7) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (GET_MESH_CONF_ELE_FORWARDING(ie + 2) != forward) { -+ SET_MESH_CONF_ELE_FORWARDING(ie + 2, forward); -+ updated = 1; -+ } -+ -+exit: -+ return updated; -+} -+ -+struct mesh_plink_ent *_rtw_mesh_plink_get(_adapter *adapter, const u8 *hwaddr) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *ent = NULL; -+ int i; -+ -+ for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { -+ if (plink_ctl->ent[i].valid == _TRUE -+ && _rtw_memcmp(plink_ctl->ent[i].addr, hwaddr, ETH_ALEN) == _TRUE -+ ) { -+ ent = &plink_ctl->ent[i]; -+ break; -+ } -+ } -+ -+ return ent; -+} -+ -+struct mesh_plink_ent *rtw_mesh_plink_get(_adapter *adapter, const u8 *hwaddr) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *ent = NULL; -+ _irqL irqL; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ ent = _rtw_mesh_plink_get(adapter, hwaddr); -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ return ent; -+} -+ -+struct mesh_plink_ent *rtw_mesh_plink_get_no_estab_by_idx(_adapter *adapter, u8 idx) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *ent = NULL; -+ int i, j = 0; -+ _irqL irqL; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { -+ if (plink_ctl->ent[i].valid == _TRUE -+ && plink_ctl->ent[i].plink_state != RTW_MESH_PLINK_ESTAB -+ ) { -+ if (j == idx) { -+ ent = &plink_ctl->ent[i]; -+ break; -+ } -+ j++; -+ } -+ } -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ return ent; -+} -+ -+int _rtw_mesh_plink_add(_adapter *adapter, const u8 *hwaddr) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *ent = NULL; -+ u8 exist = _FALSE; -+ int i; -+ -+ for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { -+ if (plink_ctl->ent[i].valid == _TRUE -+ && _rtw_memcmp(plink_ctl->ent[i].addr, hwaddr, ETH_ALEN) == _TRUE -+ ) { -+ ent = &plink_ctl->ent[i]; -+ exist = _TRUE; -+ break; -+ } -+ -+ if (ent == NULL && plink_ctl->ent[i].valid == _FALSE) -+ ent = &plink_ctl->ent[i]; -+ } -+ -+ if (exist == _FALSE && ent) { -+ _rtw_memcpy(ent->addr, hwaddr, ETH_ALEN); -+ ent->valid = _TRUE; -+ #ifdef CONFIG_RTW_MESH_AEK -+ ent->aek_valid = 0; -+ #endif -+ ent->llid = 0; -+ ent->plid = 0; -+ _rtw_memset(ent->chosen_pmk, 0, 16); -+ #ifdef CONFIG_RTW_MESH_AEK -+ _rtw_memset(ent->sel_pcs, 0, 4); -+ _rtw_memset(ent->l_nonce, 0, 32); -+ _rtw_memset(ent->p_nonce, 0, 32); -+ #endif -+ ent->plink_state = RTW_MESH_PLINK_LISTEN; -+ #ifndef CONFIG_RTW_MESH_DRIVER_AID -+ ent->aid = 0; -+ #endif -+ ent->peer_aid = 0; -+ SET_PEER_CONF_DISABLED(ent); -+ SET_CTO_MGATE_CONF_DISABLED(ent); -+ plink_ctl->num++; -+ } -+ -+ return exist == _TRUE ? RTW_ALREADY : (ent ? _SUCCESS : _FAIL); -+} -+ -+int rtw_mesh_plink_add(_adapter *adapter, const u8 *hwaddr) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ _irqL irqL; -+ int ret; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ ret = _rtw_mesh_plink_add(adapter, hwaddr); -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ return ret; -+} -+ -+int rtw_mesh_plink_set_state(_adapter *adapter, const u8 *hwaddr, u8 state) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *ent = NULL; -+ _irqL irqL; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ ent = _rtw_mesh_plink_get(adapter, hwaddr); -+ if (ent) -+ ent->plink_state = state; -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ return ent ? _SUCCESS : _FAIL; -+} -+ -+#ifdef CONFIG_RTW_MESH_AEK -+int rtw_mesh_plink_set_aek(_adapter *adapter, const u8 *hwaddr, const u8 *aek) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *ent = NULL; -+ _irqL irqL; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ ent = _rtw_mesh_plink_get(adapter, hwaddr); -+ if (ent) { -+ _rtw_memcpy(ent->aek, aek, 32); -+ ent->aek_valid = 1; -+ } -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ return ent ? _SUCCESS : _FAIL; -+} -+#endif -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+int rtw_mesh_plink_set_peer_conf_timeout(_adapter *adapter, const u8 *hwaddr) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *ent = NULL; -+ _irqL irqL; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ ent = _rtw_mesh_plink_get(adapter, hwaddr); -+ if (ent) { -+ if (IS_PEER_CONF_DISABLED(ent)) -+ SET_PEER_CONF_END_TIME(ent, mcfg->peer_sel_policy.peer_conf_timeout_ms); -+ } -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ return ent ? _SUCCESS : _FAIL; -+} -+#endif -+ -+void _rtw_mesh_plink_del_ent(_adapter *adapter, struct mesh_plink_ent *ent) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ -+ ent->valid = _FALSE; -+ #ifdef CONFIG_RTW_MESH_DRIVER_AID -+ if (ent->tx_conf_ies && ent->tx_conf_ies_len) -+ rtw_mfree(ent->tx_conf_ies, ent->tx_conf_ies_len); -+ ent->tx_conf_ies = NULL; -+ ent->tx_conf_ies_len = 0; -+ #endif -+ if (ent->rx_conf_ies && ent->rx_conf_ies_len) -+ rtw_mfree(ent->rx_conf_ies, ent->rx_conf_ies_len); -+ ent->rx_conf_ies = NULL; -+ ent->rx_conf_ies_len = 0; -+ if (ent->scanned) -+ ent->scanned = NULL; -+ plink_ctl->num--; -+} -+ -+int rtw_mesh_plink_del(_adapter *adapter, const u8 *hwaddr) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *ent = NULL; -+ u8 exist = _FALSE; -+ int i; -+ _irqL irqL; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { -+ if (plink_ctl->ent[i].valid == _TRUE -+ && _rtw_memcmp(plink_ctl->ent[i].addr, hwaddr, ETH_ALEN) == _TRUE -+ ) { -+ ent = &plink_ctl->ent[i]; -+ exist = _TRUE; -+ break; -+ } -+ } -+ -+ if (exist == _TRUE) -+ _rtw_mesh_plink_del_ent(adapter, ent); -+ -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ return exist == _TRUE ? _SUCCESS : RTW_ALREADY; -+} -+ -+void rtw_mesh_plink_ctl_init(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ int i; -+ -+ _rtw_spinlock_init(&plink_ctl->lock); -+ plink_ctl->num = 0; -+ for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) -+ plink_ctl->ent[i].valid = _FALSE; -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+ _rtw_init_queue(&plink_ctl->peer_blacklist); -+#endif -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ _rtw_init_queue(&plink_ctl->cto_mgate_blacklist); -+#endif -+} -+ -+void rtw_mesh_plink_ctl_deinit(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *ent; -+ int i; -+ _irqL irqL; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { -+ ent = &plink_ctl->ent[i]; -+ #ifdef CONFIG_RTW_MESH_DRIVER_AID -+ if (ent->tx_conf_ies && ent->tx_conf_ies_len) -+ rtw_mfree(ent->tx_conf_ies, ent->tx_conf_ies_len); -+ #endif -+ if (ent->rx_conf_ies && ent->rx_conf_ies_len) -+ rtw_mfree(ent->rx_conf_ies, ent->rx_conf_ies_len); -+ } -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ _rtw_spinlock_free(&plink_ctl->lock); -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+ rtw_mesh_peer_blacklist_flush(adapter); -+ _rtw_deinit_queue(&plink_ctl->peer_blacklist); -+#endif -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ rtw_mesh_cto_mgate_blacklist_flush(adapter); -+ _rtw_deinit_queue(&plink_ctl->cto_mgate_blacklist); -+#endif -+} -+ -+void dump_mesh_plink_ctl(void *sel, _adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *ent; -+ int i; -+ -+ RTW_PRINT_SEL(sel, "num:%u\n", plink_ctl->num); -+ #if CONFIG_RTW_MESH_ACNODE_PREVENT -+ RTW_PRINT_SEL(sel, "acnode_rsvd:%u\n", plink_ctl->acnode_rsvd); -+ #endif -+ -+ for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { -+ ent = &plink_ctl->ent[i]; -+ if (!ent->valid) -+ continue; -+ -+ RTW_PRINT_SEL(sel, "\n"); -+ RTW_PRINT_SEL(sel, "peer:"MAC_FMT"\n", MAC_ARG(ent->addr)); -+ RTW_PRINT_SEL(sel, "plink_state:%s\n", rtw_mesh_plink_str(ent->plink_state)); -+ -+ #ifdef CONFIG_RTW_MESH_AEK -+ if (ent->aek_valid) -+ RTW_PRINT_SEL(sel, "aek:"KEY_FMT KEY_FMT"\n", KEY_ARG(ent->aek), KEY_ARG(ent->aek + 16)); -+ #endif -+ -+ RTW_PRINT_SEL(sel, "llid:%u, plid:%u\n", ent->llid, ent->plid); -+ #ifndef CONFIG_RTW_MESH_DRIVER_AID -+ RTW_PRINT_SEL(sel, "aid:%u\n", ent->aid); -+ #endif -+ RTW_PRINT_SEL(sel, "peer_aid:%u\n", ent->peer_aid); -+ -+ RTW_PRINT_SEL(sel, "chosen_pmk:"KEY_FMT"\n", KEY_ARG(ent->chosen_pmk)); -+ -+ #ifdef CONFIG_RTW_MESH_AEK -+ RTW_PRINT_SEL(sel, "sel_pcs:%02x%02x%02x%02x\n" -+ , ent->sel_pcs[0], ent->sel_pcs[1], ent->sel_pcs[2], ent->sel_pcs[3]); -+ RTW_PRINT_SEL(sel, "l_nonce:"KEY_FMT KEY_FMT"\n", KEY_ARG(ent->l_nonce), KEY_ARG(ent->l_nonce + 16)); -+ RTW_PRINT_SEL(sel, "p_nonce:"KEY_FMT KEY_FMT"\n", KEY_ARG(ent->p_nonce), KEY_ARG(ent->p_nonce + 16)); -+ #endif -+ -+ #ifdef CONFIG_RTW_MESH_DRIVER_AID -+ RTW_PRINT_SEL(sel, "tx_conf_ies:%p, len:%u\n", ent->tx_conf_ies, ent->tx_conf_ies_len); -+ #endif -+ RTW_PRINT_SEL(sel, "rx_conf_ies:%p, len:%u\n", ent->rx_conf_ies, ent->rx_conf_ies_len); -+ RTW_PRINT_SEL(sel, "scanned:%p\n", ent->scanned); -+ -+ #if CONFIG_RTW_MESH_PEER_BLACKLIST -+ if (!IS_PEER_CONF_DISABLED(ent)) { -+ if (!IS_PEER_CONF_TIMEOUT(ent)) -+ RTW_PRINT_SEL(sel, "peer_conf:%d\n", rtw_systime_to_ms(ent->peer_conf_end_time - rtw_get_current_time())); -+ else -+ RTW_PRINT_SEL(sel, "peer_conf:TIMEOUT\n"); -+ } -+ #endif -+ -+ #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ if (!IS_CTO_MGATE_CONF_DISABLED(ent)) { -+ if (!IS_CTO_MGATE_CONF_TIMEOUT(ent)) -+ RTW_PRINT_SEL(sel, "cto_mgate_conf:%d\n", rtw_systime_to_ms(ent->cto_mgate_conf_end_time - rtw_get_current_time())); -+ else -+ RTW_PRINT_SEL(sel, "cto_mgate_conf:TIMEOUT\n"); -+ } -+ #endif -+ } -+} -+ -+/* this function is called with plink_ctl being locked */ -+static int rtw_mesh_peer_establish(_adapter *adapter, struct mesh_plink_ent *plink, struct sta_info *sta) -+{ -+#ifndef DBG_RTW_MESH_PEER_ESTABLISH -+#define DBG_RTW_MESH_PEER_ESTABLISH 0 -+#endif -+ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ u8 *tlv_ies; -+ u16 tlv_ieslen; -+ struct rtw_ieee802_11_elems elems; -+ _irqL irqL; -+ int i; -+ u16 status = 0; -+ int ret = _FAIL; -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ u8 sta_tbtx_enable = _FALSE; -+#endif -+ -+ if (!plink->rx_conf_ies || !plink->rx_conf_ies_len) { -+ RTW_INFO(FUNC_ADPT_FMT" no rx confirm from sta "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); -+ goto exit; -+ } -+ -+ if (plink->rx_conf_ies_len < 4) { -+ RTW_INFO(FUNC_ADPT_FMT" confirm from sta "MAC_FMT" too short\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); -+ goto exit; -+ } -+ -+#ifdef CONFIG_RTW_MESH_DRIVER_AID -+ if (!plink->tx_conf_ies || !plink->tx_conf_ies_len) { -+ RTW_INFO(FUNC_ADPT_FMT" no tx confirm to sta "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); -+ goto exit; -+ } -+ -+ if (plink->tx_conf_ies_len < 4) { -+ RTW_INFO(FUNC_ADPT_FMT" confirm to sta "MAC_FMT" too short\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); -+ goto exit; -+ } -+#endif -+ -+ tlv_ies = plink->rx_conf_ies + 4; -+ tlv_ieslen = plink->rx_conf_ies_len - 4; -+ -+ if (DBG_RTW_MESH_PEER_ESTABLISH) -+ dump_ies(RTW_DBGDUMP, tlv_ies, tlv_ieslen); -+ -+ if (rtw_ieee802_11_parse_elems(tlv_ies, tlv_ieslen, &elems, 1) == ParseFailed) { -+ RTW_INFO(FUNC_ADPT_FMT" sta "MAC_FMT" sent invalid confirm\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); -+ goto exit; -+ } -+ -+ SET_PEER_CONF_DISABLED(plink); -+ if (rtw_bss_is_cto_mgate(&plink->scanned->network) -+ && !rtw_bss_is_forwarding(&plink->scanned->network)) -+ SET_CTO_MGATE_CONF_END_TIME(plink, mcfg->peer_sel_policy.cto_mgate_conf_timeout_ms); -+ else -+ SET_CTO_MGATE_CONF_DISABLED(plink); -+ -+ sta->state &= (~WIFI_FW_AUTH_SUCCESS); -+ sta->state |= WIFI_FW_ASSOC_STATE; -+ -+ rtw_ap_parse_sta_capability(adapter, sta, plink->rx_conf_ies); -+ -+ status = rtw_ap_parse_sta_supported_rates(adapter, sta, tlv_ies, tlv_ieslen); -+ if (status != _STATS_SUCCESSFUL_) -+ goto exit; -+ -+ status = rtw_ap_parse_sta_security_ie(adapter, sta, &elems); -+ if (status != _STATS_SUCCESSFUL_) { -+ RTW_INFO(FUNC_ADPT_FMT" security check fail, status=%u\n", FUNC_ADPT_ARG(adapter), status); -+ goto exit; -+ } -+ -+ rtw_ap_parse_sta_wmm_ie(adapter, sta, tlv_ies, tlv_ieslen); -+#ifdef CONFIG_RTS_FULL_BW -+ /*check vendor IE*/ -+ rtw_parse_sta_vendor_ie_8812(adapter, sta, tlv_ies, tlv_ieslen); -+#endif/*CONFIG_RTS_FULL_BW*/ -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (elems.tbtx_cap && elems.tbtx_cap_len != 0) { -+ if(rtw_is_tbtx_capabilty(elems.tbtx_cap, elems.tbtx_cap_len)) { -+ sta_tbtx_enable = _TRUE; -+ } -+ } -+#endif -+ -+ rtw_ap_parse_sta_ht_ie(adapter, sta, &elems); -+ rtw_ap_parse_sta_vht_ie(adapter, sta, &elems); -+ -+ /* AID */ -+#ifdef CONFIG_RTW_MESH_DRIVER_AID -+ sta->cmn.aid = RTW_GET_LE16(plink->tx_conf_ies + 2); -+#else -+ sta->cmn.aid = plink->aid; -+#endif -+ stapriv->sta_aid[sta->cmn.aid - 1] = sta; -+ RTW_INFO(FUNC_ADPT_FMT" sta "MAC_FMT" aid:%u\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr), sta->cmn.aid); -+ -+ sta->state &= (~WIFI_FW_ASSOC_STATE); -+ sta->state |= WIFI_FW_ASSOC_SUCCESS; -+ -+ sta->local_mps = RTW_MESH_PS_ACTIVE; -+ -+ rtw_ewma_err_rate_init(&sta->metrics.err_rate); -+ rtw_ewma_err_rate_add(&sta->metrics.err_rate, 1); -+ /* init data_rate to 1M */ -+ sta->metrics.data_rate = 10; -+ sta->alive = _TRUE; -+ -+ _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&sta->asoc_list)) { -+ STA_SET_MESH_PLINK(sta, plink); -+ /* TBD: up layer timeout mechanism */ -+ /* sta->expire_to = mcfg->plink_timeout / 2; */ -+ rtw_list_insert_tail(&sta->asoc_list, &stapriv->asoc_list); -+ stapriv->asoc_list_cnt++; -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (sta_tbtx_enable) { -+ sta->tbtx_enable = _TRUE; -+ stapriv->tbtx_asoc_list_cnt++; -+ } -+#endif -+ } -+ _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ -+ bss_cap_update_on_sta_join(adapter, sta); -+ sta_info_update(adapter, sta); -+ report_add_sta_event(adapter, sta->cmn.mac_addr); -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int rtw_mesh_set_plink_state(_adapter *adapter, const u8 *mac, u8 plink_state) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *plink = NULL; -+ _irqL irqL2; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct sta_info *sta = NULL; -+ _irqL irqL; -+ struct sta_info *del_sta = NULL; -+ int ret = _SUCCESS; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL2); -+ -+ plink = _rtw_mesh_plink_get(adapter, mac); -+ if (!plink) { -+ ret = _FAIL; -+ goto release_plink_ctl; -+ } -+ -+ plink->plink_state = plink_state; -+ -+ #if CONFIG_RTW_MESH_ACNODE_PREVENT -+ if (plink_state == RTW_MESH_PLINK_OPN_SNT) { -+ if (rtw_mesh_scanned_is_acnode_confirmed(adapter, plink->scanned) -+ && rtw_mesh_acnode_prevent_allow_sacrifice(adapter) -+ ) { -+ struct sta_info *sac = rtw_mesh_acnode_prevent_pick_sacrifice(adapter); -+ -+ if (sac) { -+ del_sta = sac; -+ _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ if (!rtw_is_list_empty(&del_sta->asoc_list)) { -+ rtw_list_delete(&del_sta->asoc_list); -+ stapriv->asoc_list_cnt--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (del_sta->tbtx_enable) -+ stapriv->tbtx_asoc_list_cnt--; -+ #endif -+ STA_SET_MESH_PLINK(del_sta, NULL); -+ } -+ _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ RTW_INFO(FUNC_ADPT_FMT" sacrifice "MAC_FMT" for acnode\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(del_sta->cmn.mac_addr)); -+ } -+ } -+ } else -+ #endif -+ if (plink_state == RTW_MESH_PLINK_OPN_RCVD -+ || plink_state == RTW_MESH_PLINK_CNF_RCVD -+ || plink_state == RTW_MESH_PLINK_ESTAB -+ ) { -+ sta = rtw_get_stainfo(stapriv, mac); -+ if (!sta) { -+ sta = rtw_alloc_stainfo(stapriv, mac); -+ if (!sta) -+ goto release_plink_ctl; -+ } -+ -+ if (plink_state == RTW_MESH_PLINK_ESTAB) { -+ if (rtw_mesh_peer_establish(adapter, plink, sta) != _SUCCESS) { -+ del_sta = sta; -+ ret = _FAIL; -+ goto release_plink_ctl; -+ } -+ } -+ } -+ else if (plink_state == RTW_MESH_PLINK_HOLDING) { -+ del_sta = rtw_get_stainfo(stapriv, mac); -+ if (!del_sta) -+ goto release_plink_ctl; -+ -+ _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ if (!rtw_is_list_empty(&del_sta->asoc_list)) { -+ rtw_list_delete(&del_sta->asoc_list); -+ stapriv->asoc_list_cnt--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (del_sta->tbtx_enable) -+ stapriv->tbtx_asoc_list_cnt--; -+ #endif -+ STA_SET_MESH_PLINK(del_sta, NULL); -+ } -+ _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ } -+ -+release_plink_ctl: -+ _exit_critical_bh(&(plink_ctl->lock), &irqL2); -+ -+ if (del_sta) { -+ u8 sta_addr[ETH_ALEN]; -+ u8 updated = _FALSE; -+ -+ _rtw_memcpy(sta_addr, del_sta->cmn.mac_addr, ETH_ALEN); -+ updated = ap_free_sta(adapter, del_sta, 0, 0, 1); -+ rtw_mesh_expire_peer(stapriv->padapter, sta_addr); -+ -+ associated_clients_update(adapter, updated, STA_INFO_UPDATE_ALL); -+ } -+ -+ return ret; -+} -+ -+struct mesh_set_plink_cmd_parm { -+ const u8 *mac; -+ u8 plink_state; -+}; -+ -+u8 rtw_mesh_set_plink_state_cmd_hdl(_adapter *adapter, u8 *parmbuf) -+{ -+ struct mesh_set_plink_cmd_parm *parm = (struct mesh_set_plink_cmd_parm *)parmbuf; -+ -+ if (rtw_mesh_set_plink_state(adapter, parm->mac, parm->plink_state) == _SUCCESS) -+ return H2C_SUCCESS; -+ -+ return H2C_CMD_FAIL; -+} -+ -+u8 rtw_mesh_set_plink_state_cmd(_adapter *adapter, const u8 *mac, u8 plink_state) -+{ -+ struct cmd_obj *cmdobj; -+ struct mesh_set_plink_cmd_parm *parm; -+ struct cmd_priv *cmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ /* prepare cmd parameter */ -+ parm = rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ parm->mac = mac; -+ parm->plink_state = plink_state; -+ -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ rtw_mfree(parm, sizeof(*parm)); -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, CMD_SET_MESH_PLINK_STATE); -+ cmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 2000); -+ -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ if (res == _SUCCESS) { -+ rtw_sctx_wait(&sctx, __func__); -+ _enter_critical_mutex(&cmdpriv->sctx_mutex, NULL); -+ if (sctx.status == RTW_SCTX_SUBMITTED) -+ cmdobj->sctx = NULL; -+ _exit_critical_mutex(&cmdpriv->sctx_mutex, NULL); -+ if (sctx.status != RTW_SCTX_DONE_SUCCESS) -+ res = _FAIL; -+ } -+ -+exit: -+ return res; -+} -+ -+void rtw_mesh_expire_peer_notify(_adapter *adapter, const u8 *peer_addr) -+{ -+ u8 null_ssid[2] = {0, 0}; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_notify_new_peer_candidate(adapter->rtw_wdev -+ , peer_addr -+ , null_ssid -+ , 2 -+ , 0 -+ , GFP_ATOMIC -+ ); -+#endif -+ -+ return; -+} -+ -+static u8 *rtw_mesh_construct_peer_mesh_close(_adapter *adapter, struct mesh_plink_ent *plink, u16 reason, u32 *len) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ u8 *frame = NULL, *pos; -+ u32 flen; -+ struct rtw_ieee80211_hdr *whdr; -+ -+ if (minfo->mesh_auth_id && !MESH_PLINK_AEK_VALID(plink)) -+ goto exit; -+ -+ flen = sizeof(struct rtw_ieee80211_hdr_3addr) -+ + 2 /* category, action */ -+ + 2 + minfo->mesh_id_len /* mesh id */ -+ + 2 + 8 + (minfo->mesh_auth_id ? 16 : 0) /* mpm */ -+ + (minfo->mesh_auth_id ? 2 + 16 /* AES_BLOCK_SIZE */ : 0) /* mic */ -+ + (minfo->mesh_auth_id ? 70 : 0) /* ampe */ -+ ; -+ -+ pos = frame = rtw_zmalloc(flen); -+ if (!frame) -+ goto exit; -+ -+ whdr = (struct rtw_ieee80211_hdr *)frame; -+ _rtw_memcpy(whdr->addr1, adapter_mac_addr(adapter), ETH_ALEN); -+ _rtw_memcpy(whdr->addr2, plink->addr, ETH_ALEN); -+ _rtw_memcpy(whdr->addr3, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ set_frame_sub_type(frame, WIFI_ACTION); -+ -+ pos += sizeof(struct rtw_ieee80211_hdr_3addr); -+ *(pos++) = RTW_WLAN_CATEGORY_SELF_PROTECTED; -+ *(pos++) = RTW_ACT_SELF_PROTECTED_MESH_CLOSE; -+ -+ pos = rtw_set_ie_mesh_id(pos, NULL, minfo->mesh_id, minfo->mesh_id_len); -+ -+ pos = rtw_set_ie_mpm(pos, NULL -+ , minfo->mesh_auth_id ? 1 : 0 -+ , plink->plid -+ , &plink->llid -+ , &reason -+ , minfo->mesh_auth_id ? plink->chosen_pmk : NULL); -+ -+#ifdef CONFIG_RTW_MESH_AEK -+ if (minfo->mesh_auth_id) { -+ u8 ampe_buf[70]; -+ int enc_ret; -+ -+ *pos = WLAN_EID_MIC; -+ *(pos + 1) = 16 /* AES_BLOCK_SIZE */; -+ -+ ampe_buf[0] = WLAN_EID_AMPE; -+ ampe_buf[1] = 68; -+ _rtw_memcpy(ampe_buf + 2, plink->sel_pcs, 4); -+ _rtw_memcpy(ampe_buf + 6, plink->p_nonce, 32); -+ _rtw_memcpy(ampe_buf + 38, plink->l_nonce, 32); -+ -+ enc_ret = rtw_mpm_ampe_enc(adapter, plink -+ , frame + sizeof(struct rtw_ieee80211_hdr_3addr) -+ , pos, ampe_buf, 1); -+ if (enc_ret != _SUCCESS) { -+ rtw_mfree(frame, flen); -+ frame = NULL; -+ goto exit; -+ } -+ } -+#endif -+ -+ *len = flen; -+ -+exit: -+ return frame; -+} -+ -+void _rtw_mesh_expire_peer_ent(_adapter *adapter, struct mesh_plink_ent *plink) -+{ -+#if defined(CONFIG_RTW_MESH_STA_DEL_DISASOC) -+ _rtw_mesh_plink_del_ent(adapter, plink); -+ rtw_cfg80211_indicate_sta_disassoc(adapter, plink->addr, 0); -+#else -+ u8 *frame = NULL; -+ u32 flen; -+ -+ if (plink->plink_state == RTW_MESH_PLINK_ESTAB) -+ frame = rtw_mesh_construct_peer_mesh_close(adapter, plink, WLAN_REASON_MESH_CLOSE, &flen); -+ -+ if (frame) { -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct wireless_dev *wdev = adapter->rtw_wdev; -+ s32 freq = rtw_ch2freq(mlmeext->cur_channel); -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, flen, GFP_ATOMIC); -+ #else -+ cfg80211_rx_action(adapter->pnetdev, freq, frame, flen, GFP_ATOMIC); -+ #endif -+ -+ rtw_mfree(frame, flen); -+ } else { -+ rtw_mesh_expire_peer_notify(adapter, plink->addr); -+ RTW_INFO(FUNC_ADPT_FMT" set "MAC_FMT" plink unknown\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(plink->addr)); -+ plink->plink_state = RTW_MESH_PLINK_UNKNOWN; -+ } -+#endif -+} -+ -+void rtw_mesh_expire_peer(_adapter *adapter, const u8 *peer_addr) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *plink; -+ _irqL irqL; -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ plink = _rtw_mesh_plink_get(adapter, peer_addr); -+ if (!plink) -+ goto exit; -+ -+ _rtw_mesh_expire_peer_ent(adapter, plink); -+ -+exit: -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+} -+ -+u8 rtw_mesh_ps_annc(_adapter *adapter, u8 ps) -+{ -+ _irqL irqL; -+ _list *head, *list; -+ struct sta_info *sta; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ u8 sta_alive_num = 0, i; -+ char sta_alive_list[NUM_STA]; -+ u8 annc_cnt = 0; -+ -+ if (rtw_linked_check(adapter) == _FALSE) -+ goto exit; -+ -+ _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ -+ head = &stapriv->asoc_list; -+ list = get_next(head); -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ int stainfo_offset; -+ -+ sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); -+ list = get_next(list); -+ -+ stainfo_offset = rtw_stainfo_offset(stapriv, sta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ sta_alive_list[sta_alive_num++] = stainfo_offset; -+ } -+ _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ -+ for (i = 0; i < sta_alive_num; i++) { -+ sta = rtw_get_stainfo_by_offset(stapriv, sta_alive_list[i]); -+ if (!sta) -+ continue; -+ -+ issue_qos_nulldata(adapter, sta->cmn.mac_addr, 7, ps, 3, 500); -+ annc_cnt++; -+ } -+ -+exit: -+ return annc_cnt; -+} -+ -+static void mpath_tx_tasklet_hdl(unsigned long priv) -+{ -+ _adapter *adapter = (_adapter *)priv; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct xmit_frame *xframe; -+ _list *list, *head; -+ _list tmp; -+ u32 tmp_len; -+ s32 res; -+ -+ _rtw_init_listhead(&tmp); -+ -+ while (1) { -+ tmp_len = 0; -+ enter_critical_bh(&minfo->mpath_tx_queue.lock); -+ if (minfo->mpath_tx_queue_len) { -+ rtw_list_splice_init(&minfo->mpath_tx_queue.queue, &tmp); -+ tmp_len = minfo->mpath_tx_queue_len; -+ minfo->mpath_tx_queue_len = 0; -+ } -+ exit_critical_bh(&minfo->mpath_tx_queue.lock); -+ -+ if (!tmp_len) -+ break; -+ -+ head = &tmp; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ xframe = LIST_CONTAINOR(list, struct xmit_frame, list); -+ list = get_next(list); -+ rtw_list_delete(&xframe->list); -+ res = rtw_xmit_posthandle(adapter, xframe, xframe->pkt); -+ if (res < 0) { -+ #ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s rtw_xmit fail\n", __FUNCTION__); -+ #endif -+ adapter->xmitpriv.tx_drop++; -+ } -+ } -+ } -+} -+ -+static void rtw_mpath_tx_queue_flush(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct xmit_frame *xframe; -+ _list *list, *head; -+ _list tmp; -+ -+ _rtw_init_listhead(&tmp); -+ -+ enter_critical_bh(&minfo->mpath_tx_queue.lock); -+ rtw_list_splice_init(&minfo->mpath_tx_queue.queue, &tmp); -+ minfo->mpath_tx_queue_len = 0; -+ exit_critical_bh(&minfo->mpath_tx_queue.lock); -+ -+ head = &tmp; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ xframe = LIST_CONTAINOR(list, struct xmit_frame, list); -+ list = get_next(list); -+ rtw_list_delete(&xframe->list); -+ rtw_free_xmitframe(&adapter->xmitpriv, xframe); -+ } -+} -+ -+#ifdef PLATFORM_LINUX /* 3.10 ~ 4.13 checked */ -+#if defined(CONFIG_SLUB) -+#include -+#elif defined(CONFIG_SLAB) -+#include -+#endif -+typedef struct kmem_cache rtw_mcache; -+#endif -+ -+rtw_mcache *rtw_mcache_create(const char *name, size_t size) -+{ -+#ifdef PLATFORM_LINUX /* 3.10 ~ 4.13 checked */ -+ return kmem_cache_create(name, size, 0, 0, NULL); -+#else -+ #error "TBD\n"; -+#endif -+} -+ -+void rtw_mcache_destroy(rtw_mcache *s) -+{ -+#ifdef PLATFORM_LINUX /* 3.10 ~ 4.13 checked */ -+ kmem_cache_destroy(s); -+#else -+ #error "TBD\n"; -+#endif -+} -+ -+void *_rtw_mcache_alloc(rtw_mcache *cachep) -+{ -+#ifdef PLATFORM_LINUX /* 3.10 ~ 4.13 checked */ -+ return kmem_cache_alloc(cachep, GFP_ATOMIC); -+#else -+ #error "TBD\n"; -+#endif -+} -+ -+void _rtw_mcache_free(rtw_mcache *cachep, void *objp) -+{ -+#ifdef PLATFORM_LINUX /* 3.10 ~ 4.13 checked */ -+ kmem_cache_free(cachep, objp); -+#else -+ #error "TBD\n"; -+#endif -+} -+ -+#ifdef DBG_MEM_ALLOC -+inline void *dbg_rtw_mcache_alloc(rtw_mcache *cachep, const enum mstat_f flags, const char *func, const int line) -+{ -+ void *p; -+ u32 sz = cachep->size; -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%u)\n", func, line, __func__, sz); -+ -+ p = _rtw_mcache_alloc(cachep); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline void dbg_rtw_mcache_free(rtw_mcache *cachep, void *pbuf, const enum mstat_f flags, const char *func, const int line) -+{ -+ u32 sz = cachep->size; -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%u)\n", func, line, __func__, sz); -+ -+ _rtw_mcache_free(cachep, pbuf); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , sz -+ ); -+} -+ -+#define rtw_mcache_alloc(cachep) dbg_rtw_mcache_alloc(cachep, MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_mcache_free(cachep, objp) dbg_rtw_mcache_free(cachep, objp, MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#else -+#define rtw_mcache_alloc(cachep) _rtw_mcache_alloc(cachep) -+#define rtw_mcache_free(cachep, objp) _rtw_mcache_free(cachep, objp) -+#endif /* DBG_MEM_ALLOC */ -+ -+/* Mesh Received Cache */ -+#define RTW_MRC_BUCKETS 256 /* must be a power of 2 */ -+#define RTW_MRC_QUEUE_MAX_LEN 4 -+#define RTW_MRC_TIMEOUT_MS (3 * 1000) -+ -+/** -+ * struct rtw_mrc_entry - entry in the Mesh Received Cache -+ * -+ * @seqnum: mesh sequence number of the frame -+ * @exp_time: expiration time of the entry -+ * @msa: mesh source address of the frame -+ * @list: hashtable list pointer -+ * -+ * The Mesh Received Cache keeps track of the latest received frames that -+ * have been received by a mesh interface and discards received frames -+ * that are found in the cache. -+ */ -+struct rtw_mrc_entry { -+ rtw_hlist_node list; -+ systime exp_time; -+ u32 seqnum; -+ u8 msa[ETH_ALEN]; -+}; -+ -+struct rtw_mrc { -+ rtw_hlist_head bucket[RTW_MRC_BUCKETS]; -+ u32 idx_mask; -+ rtw_mcache *cache; -+}; -+ -+static int rtw_mrc_init(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ char cache_name[IFNAMSIZ + 8 + 1]; -+ int i; -+ -+ minfo->mrc = rtw_malloc(sizeof(struct rtw_mrc)); -+ if (!minfo->mrc) -+ return -ENOMEM; -+ minfo->mrc->idx_mask = RTW_MRC_BUCKETS - 1; -+ for (i = 0; i < RTW_MRC_BUCKETS; i++) -+ rtw_hlist_head_init(&minfo->mrc->bucket[i]); -+ -+ sprintf(cache_name, "rtw_mrc_%s", ADPT_ARG(adapter)); -+ minfo->mrc->cache = rtw_mcache_create(cache_name, sizeof(struct rtw_mrc_entry)); -+ -+ return 0; -+} -+ -+static void rtw_mrc_free(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct rtw_mrc *mrc = minfo->mrc; -+ struct rtw_mrc_entry *p; -+ rtw_hlist_node *np, *n; -+ int i; -+ -+ if (!mrc) -+ return; -+ -+ for (i = 0; i < RTW_MRC_BUCKETS; i++) { -+ rtw_hlist_for_each_entry_safe(p, np, n, &mrc->bucket[i], list) { -+ rtw_hlist_del(&p->list); -+ rtw_mcache_free(mrc->cache, p); -+ } -+ } -+ -+ rtw_mcache_destroy(mrc->cache); -+ -+ rtw_mfree(mrc, sizeof(struct rtw_mrc)); -+ minfo->mrc = NULL; -+} -+ -+/** -+ * rtw_mrc_check - Check frame in mesh received cache and add if absent. -+ * -+ * @adapter: interface -+ * @msa: mesh source address -+ * @seq: mesh seq number -+ * -+ * Returns: 0 if the frame is not in the cache, nonzero otherwise. -+ * -+ * Checks using the mesh source address and the mesh sequence number if we have -+ * received this frame lately. If the frame is not in the cache, it is added to -+ * it. -+ */ -+static int rtw_mrc_check(_adapter *adapter, const u8 *msa, u32 seq) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct rtw_mrc *mrc = minfo->mrc; -+ int entries = 0; -+ u8 idx; -+ struct rtw_mrc_entry *p; -+ rtw_hlist_node *np, *n; -+ u8 timeout; -+ -+ if (!mrc) -+ return -1; -+ -+ idx = seq & mrc->idx_mask; -+ rtw_hlist_for_each_entry_safe(p, np, n, &mrc->bucket[idx], list) { -+ ++entries; -+ timeout = rtw_time_after(rtw_get_current_time(), p->exp_time); -+ if (timeout || entries == RTW_MRC_QUEUE_MAX_LEN) { -+ if (!timeout) -+ minfo->mshstats.mrc_del_qlen++; -+ -+ rtw_hlist_del(&p->list); -+ rtw_mcache_free(mrc->cache, p); -+ --entries; -+ } else if ((seq == p->seqnum) && _rtw_memcmp(msa, p->msa, ETH_ALEN) == _TRUE) -+ return -1; -+ } -+ -+ p = rtw_mcache_alloc(mrc->cache); -+ if (!p) -+ return 0; -+ -+ p->seqnum = seq; -+ p->exp_time = rtw_get_current_time() + rtw_ms_to_systime(RTW_MRC_TIMEOUT_MS); -+ _rtw_memcpy(p->msa, msa, ETH_ALEN); -+ rtw_hlist_add_head(&p->list, &mrc->bucket[idx]); -+ return 0; -+} -+ -+static int rtw_mesh_decache(_adapter *adapter, const u8 *msa, u32 seq) -+{ -+ return rtw_mrc_check(adapter, msa, seq); -+} -+ -+#ifndef RTW_MESH_SCAN_RESULT_EXP_MS -+#define RTW_MESH_SCAN_RESULT_EXP_MS (10 * 1000) -+#endif -+ -+#ifndef RTW_MESH_ACNODE_PREVENT -+#define RTW_MESH_ACNODE_PREVENT 0 -+#endif -+#ifndef RTW_MESH_ACNODE_CONF_TIMEOUT_MS -+#define RTW_MESH_ACNODE_CONF_TIMEOUT_MS (20 * 1000) -+#endif -+#ifndef RTW_MESH_ACNODE_NOTIFY_TIMEOUT_MS -+#define RTW_MESH_ACNODE_NOTIFY_TIMEOUT_MS (2 * 1000) -+#endif -+ -+#ifndef RTW_MESH_OFFCH_CAND -+#define RTW_MESH_OFFCH_CAND 1 -+#endif -+#ifndef RTW_MESH_OFFCH_CAND_FIND_INT_MS -+#define RTW_MESH_OFFCH_CAND_FIND_INT_MS (10 * 1000) -+#endif -+ -+#ifndef RTW_MESH_PEER_CONF_TIMEOUT_MS -+#define RTW_MESH_PEER_CONF_TIMEOUT_MS (20 * 1000) -+#endif -+#ifndef RTW_MESH_PEER_BLACKLIST_TIMEOUT_MS -+#define RTW_MESH_PEER_BLACKLIST_TIMEOUT_MS (20 * 1000) -+#endif -+ -+#ifndef RTW_MESH_CTO_MGATE_REQUIRE -+#define RTW_MESH_CTO_MGATE_REQUIRE 0 -+#endif -+#ifndef RTW_MESH_CTO_MGATE_CONF_TIMEOUT_MS -+#define RTW_MESH_CTO_MGATE_CONF_TIMEOUT_MS (20 * 1000) -+#endif -+#ifndef RTW_MESH_CTO_MGATE_BLACKLIST_TIMEOUT_MS -+#define RTW_MESH_CTO_MGATE_BLACKLIST_TIMEOUT_MS (20 * 1000) -+#endif -+ -+void rtw_mesh_cfg_init_peer_sel_policy(struct rtw_mesh_cfg *mcfg) -+{ -+ struct mesh_peer_sel_policy *sel_policy = &mcfg->peer_sel_policy; -+ -+ sel_policy->scanr_exp_ms = RTW_MESH_SCAN_RESULT_EXP_MS; -+ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+ sel_policy->acnode_prevent = RTW_MESH_ACNODE_PREVENT; -+ sel_policy->acnode_conf_timeout_ms = RTW_MESH_ACNODE_CONF_TIMEOUT_MS; -+ sel_policy->acnode_notify_timeout_ms = RTW_MESH_ACNODE_NOTIFY_TIMEOUT_MS; -+#endif -+ -+#if CONFIG_RTW_MESH_OFFCH_CAND -+ sel_policy->offch_cand = RTW_MESH_OFFCH_CAND; -+ sel_policy->offch_find_int_ms = RTW_MESH_OFFCH_CAND_FIND_INT_MS; -+#endif -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+ sel_policy->peer_conf_timeout_ms = RTW_MESH_PEER_CONF_TIMEOUT_MS; -+ sel_policy->peer_blacklist_timeout_ms = RTW_MESH_PEER_BLACKLIST_TIMEOUT_MS; -+#endif -+ -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ sel_policy->cto_mgate_require = RTW_MESH_CTO_MGATE_REQUIRE; -+ sel_policy->cto_mgate_conf_timeout_ms = RTW_MESH_CTO_MGATE_CONF_TIMEOUT_MS; -+ sel_policy->cto_mgate_blacklist_timeout_ms = RTW_MESH_CTO_MGATE_BLACKLIST_TIMEOUT_MS; -+#endif -+} -+ -+void rtw_mesh_cfg_init(_adapter *adapter) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ -+ mcfg->max_peer_links = RTW_MESH_MAX_PEER_LINKS; -+ mcfg->plink_timeout = RTW_MESH_PEER_LINK_TIMEOUT; -+ -+ mcfg->dot11MeshTTL = RTW_MESH_TTL; -+ mcfg->element_ttl = RTW_MESH_DEFAULT_ELEMENT_TTL; -+ mcfg->dot11MeshHWMPmaxPREQretries = RTW_MESH_MAX_PREQ_RETRIES; -+ mcfg->path_refresh_time = RTW_MESH_PATH_REFRESH_TIME; -+ mcfg->min_discovery_timeout = RTW_MESH_MIN_DISCOVERY_TIMEOUT; -+ mcfg->dot11MeshHWMPactivePathTimeout = RTW_MESH_PATH_TIMEOUT; -+ mcfg->dot11MeshHWMPpreqMinInterval = RTW_MESH_PREQ_MIN_INT; -+ mcfg->dot11MeshHWMPperrMinInterval = RTW_MESH_PERR_MIN_INT; -+ mcfg->dot11MeshHWMPnetDiameterTraversalTime = RTW_MESH_DIAM_TRAVERSAL_TIME; -+ mcfg->dot11MeshHWMPRootMode = RTW_IEEE80211_ROOTMODE_NO_ROOT; -+ mcfg->dot11MeshHWMPRannInterval = RTW_MESH_RANN_INTERVAL; -+ mcfg->dot11MeshGateAnnouncementProtocol = _FALSE; -+ mcfg->dot11MeshForwarding = _TRUE; -+ mcfg->rssi_threshold = 0; -+ mcfg->dot11MeshHWMPactivePathToRootTimeout = RTW_MESH_PATH_TO_ROOT_TIMEOUT; -+ mcfg->dot11MeshHWMProotInterval = RTW_MESH_ROOT_INTERVAL; -+ mcfg->dot11MeshHWMPconfirmationInterval = RTW_MESH_ROOT_CONFIRMATION_INTERVAL; -+ mcfg->path_gate_timeout_factor = 3; -+ rtw_mesh_cfg_init_peer_sel_policy(mcfg); -+#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK -+ mcfg->sane_metric_delta = RTW_MESH_SANE_METRIC_DELTA; -+ mcfg->max_root_add_chk_cnt = RTW_MESH_MAX_ROOT_ADD_CHK_CNT; -+#endif -+ -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ mcfg->b2u_flags_msrc = regsty->msrc_b2u_flags; -+ mcfg->b2u_flags_mfwd = regsty->mfwd_b2u_flags; -+#endif -+} -+ -+void rtw_mesh_cfg_init_max_peer_links(_adapter *adapter, u8 stack_conf) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ -+ mcfg->max_peer_links = RTW_MESH_MAX_PEER_LINKS; -+ -+ if (mcfg->max_peer_links > stack_conf) -+ mcfg->max_peer_links = stack_conf; -+} -+ -+void rtw_mesh_cfg_init_plink_timeout(_adapter *adapter, u32 stack_conf) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ -+ mcfg->plink_timeout = stack_conf; -+} -+ -+void rtw_mesh_init_mesh_info(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ -+ _rtw_memset(minfo, 0, sizeof(struct rtw_mesh_info)); -+ -+ rtw_mesh_plink_ctl_init(adapter); -+ -+ minfo->last_preq = rtw_get_current_time(); -+ /* minfo->last_sn_update = rtw_get_current_time(); */ -+ minfo->next_perr = rtw_get_current_time(); -+ -+ ATOMIC_SET(&minfo->mpaths, 0); -+ rtw_mesh_pathtbl_init(adapter); -+ -+ _rtw_init_queue(&minfo->mpath_tx_queue); -+ tasklet_init(&minfo->mpath_tx_tasklet -+ , mpath_tx_tasklet_hdl -+ , (unsigned long)adapter); -+ -+ rtw_mrc_init(adapter); -+ -+ _rtw_init_listhead(&minfo->preq_queue.list); -+ _rtw_spinlock_init(&minfo->mesh_preq_queue_lock); -+ -+ rtw_init_timer(&adapter->mesh_path_timer, adapter, rtw_ieee80211_mesh_path_timer, adapter); -+ rtw_init_timer(&adapter->mesh_path_root_timer, adapter, rtw_ieee80211_mesh_path_root_timer, adapter); -+ rtw_init_timer(&adapter->mesh_atlm_param_req_timer, adapter, rtw_mesh_atlm_param_req_timer, adapter); -+ _init_workitem(&adapter->mesh_work, rtw_mesh_work_hdl, NULL); -+} -+ -+void rtw_mesh_deinit_mesh_info(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ -+ tasklet_kill(&minfo->mpath_tx_tasklet); -+ rtw_mpath_tx_queue_flush(adapter); -+ _rtw_deinit_queue(&adapter->mesh_info.mpath_tx_queue); -+ -+ rtw_mrc_free(adapter); -+ -+ rtw_mesh_pathtbl_unregister(adapter); -+ -+ rtw_mesh_plink_ctl_deinit(adapter); -+ -+ _cancel_workitem_sync(&adapter->mesh_work); -+ _cancel_timer_ex(&adapter->mesh_path_timer); -+ _cancel_timer_ex(&adapter->mesh_path_root_timer); -+ _cancel_timer_ex(&adapter->mesh_atlm_param_req_timer); -+} -+ -+/** -+ * rtw_mesh_nexthop_resolve - lookup next hop; conditionally start path discovery -+ * -+ * @skb: 802.11 frame to be sent -+ * @sdata: network subif the frame will be sent through -+ * -+ * Lookup next hop for given skb and start path discovery if no -+ * forwarding information is found. -+ * -+ * Returns: 0 if the next hop was found and -ENOENT if the frame was queued. -+ * skb is freeed here if no mpath could be allocated. -+ */ -+int rtw_mesh_nexthop_resolve(_adapter *adapter, -+ struct xmit_frame *xframe) -+{ -+ struct pkt_attrib *attrib = &xframe->attrib; -+ struct rtw_mesh_path *mpath; -+ struct xmit_frame *xframe_to_free = NULL; -+ u8 *target_addr = attrib->mda; -+ int err = 0; -+ int ret = _SUCCESS; -+ -+ rtw_rcu_read_lock(); -+ err = rtw_mesh_nexthop_lookup(adapter, target_addr, attrib->msa, attrib->ra); -+ if (!err) -+ goto endlookup; -+ -+ /* no nexthop found, start resolving */ -+ mpath = rtw_mesh_path_lookup(adapter, target_addr); -+ if (!mpath) { -+ mpath = rtw_mesh_path_add(adapter, target_addr); -+ if (IS_ERR(mpath)) { -+ xframe->pkt = NULL; /* free pkt outside */ -+ rtw_mesh_path_discard_frame(adapter, xframe); -+ err = PTR_ERR(mpath); -+ ret = _FAIL; -+ goto endlookup; -+ } -+ } -+ -+ if (!(mpath->flags & RTW_MESH_PATH_RESOLVING)) -+ rtw_mesh_queue_preq(mpath, RTW_PREQ_Q_F_START); -+ -+ enter_critical_bh(&mpath->frame_queue.lock); -+ -+ if (mpath->frame_queue_len >= RTW_MESH_FRAME_QUEUE_LEN) { -+ xframe_to_free = LIST_CONTAINOR(get_next(get_list_head(&mpath->frame_queue)), struct xmit_frame, list); -+ rtw_list_delete(&(xframe_to_free->list)); -+ mpath->frame_queue_len--; -+ } -+ -+ rtw_list_insert_tail(&xframe->list, get_list_head(&mpath->frame_queue)); -+ mpath->frame_queue_len++; -+ -+ exit_critical_bh(&mpath->frame_queue.lock); -+ -+ ret = RTW_RA_RESOLVING; -+ if (xframe_to_free) -+ rtw_mesh_path_discard_frame(adapter, xframe_to_free); -+ -+endlookup: -+ rtw_rcu_read_unlock(); -+ return ret; -+} -+ -+/** -+ * rtw_mesh_nexthop_lookup - put the appropriate next hop on a mesh frame. Calling -+ * this function is considered "using" the associated mpath, so preempt a path -+ * refresh if this mpath expires soon. -+ * -+ * @skb: 802.11 frame to be sent -+ * @sdata: network subif the frame will be sent through -+ * -+ * Returns: 0 if the next hop was found. Nonzero otherwise. -+ */ -+int rtw_mesh_nexthop_lookup(_adapter *adapter, -+ const u8 *mda, const u8 *msa, u8 *ra) -+{ -+ struct rtw_mesh_path *mpath; -+ struct sta_info *next_hop; -+ const u8 *target_addr = mda; -+ int err = -ENOENT; -+ struct registry_priv *registry_par = &adapter->registrypriv; -+ u8 peer_alive_based_preq = registry_par->peer_alive_based_preq; -+ BOOLEAN nexthop_alive = _TRUE; -+ -+ rtw_rcu_read_lock(); -+ mpath = rtw_mesh_path_lookup(adapter, target_addr); -+ -+ if (!mpath || !(mpath->flags & RTW_MESH_PATH_ACTIVE)) -+ goto endlookup; -+ -+ next_hop = rtw_rcu_dereference(mpath->next_hop); -+ if (next_hop) { -+ _rtw_memcpy(ra, next_hop->cmn.mac_addr, ETH_ALEN); -+ err = 0; -+ } -+ -+ if (peer_alive_based_preq && next_hop) -+ nexthop_alive = next_hop->alive; -+ -+ if (_rtw_memcmp(adapter_mac_addr(adapter), msa, ETH_ALEN) == _TRUE && -+ !(mpath->flags & RTW_MESH_PATH_RESOLVING) && -+ !(mpath->flags & RTW_MESH_PATH_FIXED)) { -+ u8 flags = RTW_PREQ_Q_F_START | RTW_PREQ_Q_F_REFRESH; -+ -+ if (peer_alive_based_preq && nexthop_alive == _FALSE) { -+ flags |= RTW_PREQ_Q_F_BCAST_PREQ; -+ rtw_mesh_queue_preq(mpath, flags); -+ } else if (rtw_time_after(rtw_get_current_time(), -+ mpath->exp_time - -+ rtw_ms_to_systime(adapter->mesh_cfg.path_refresh_time))) { -+ rtw_mesh_queue_preq(mpath, flags); -+ } -+ /* Avoid keeping trying unicast PREQ toward root, -+ when next_hop leaves */ -+ } else if (peer_alive_based_preq && -+ _rtw_memcmp(adapter_mac_addr(adapter), msa, ETH_ALEN) == _TRUE && -+ (mpath->flags & RTW_MESH_PATH_RESOLVING) && -+ !(mpath->flags & RTW_MESH_PATH_FIXED) && -+ !(mpath->flags & RTW_MESH_PATH_BCAST_PREQ) && -+ mpath->is_root && nexthop_alive == _FALSE) { -+ enter_critical_bh(&mpath->state_lock); -+ mpath->flags |= RTW_MESH_PATH_BCAST_PREQ; -+ exit_critical_bh(&mpath->state_lock); -+ } -+ -+endlookup: -+ rtw_rcu_read_unlock(); -+ return err; -+} -+ -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+static bool rtw_mesh_data_bmc_to_uc(_adapter *adapter -+ , const u8 *da, const u8 *sa, const u8 *mda, const u8 *msa -+ , u8 ae_need, const u8 *ori_ta, u8 mfwd_ttl -+ , u16 os_qid, _list *b2u_list, u8 *b2u_num, u32 *b2u_mseq) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct xmit_priv *xmitpriv = &adapter->xmitpriv; -+ _irqL irqL; -+ _list *head, *list; -+ struct sta_info *sta; -+ char b2u_sta_id[NUM_STA]; -+ u8 b2u_sta_num = 0; -+ bool bmc_need = _FALSE; -+ int i; -+ -+ _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ head = &stapriv->asoc_list; -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ int stainfo_offset; -+ -+ sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); -+ list = get_next(list); -+ -+ stainfo_offset = rtw_stainfo_offset(stapriv, sta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ b2u_sta_id[b2u_sta_num++] = stainfo_offset; -+ } -+ _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ -+ if (!b2u_sta_num) -+ goto exit; -+ -+ for (i = 0; i < b2u_sta_num; i++) { -+ struct xmit_frame *b2uframe; -+ struct pkt_attrib *attrib; -+ -+ sta = rtw_get_stainfo_by_offset(stapriv, b2u_sta_id[i]); -+ if (!(sta->state & WIFI_ASOC_STATE) -+ || _rtw_memcmp(sta->cmn.mac_addr, msa, ETH_ALEN) == _TRUE -+ || (ori_ta && _rtw_memcmp(sta->cmn.mac_addr, ori_ta, ETH_ALEN) == _TRUE) -+ || is_broadcast_mac_addr(sta->cmn.mac_addr) -+ || is_zero_mac_addr(sta->cmn.mac_addr)) -+ continue; -+ -+ b2uframe = rtw_alloc_xmitframe(xmitpriv, os_qid); -+ if (!b2uframe) { -+ bmc_need = _TRUE; -+ break; -+ } -+ -+ if ((*b2u_num)++ == 0 && !ori_ta) { -+ *b2u_mseq = (cpu_to_le32(adapter->mesh_info.mesh_seqnum)); -+ adapter->mesh_info.mesh_seqnum++; -+ } -+ -+ attrib = &b2uframe->attrib; -+ -+ attrib->mb2u = 1; -+ attrib->mseq = *b2u_mseq; -+ attrib->mfwd_ttl = ori_ta ? mfwd_ttl : 0; -+ _rtw_memcpy(attrib->ra, sta->cmn.mac_addr, ETH_ALEN); -+ _rtw_memcpy(attrib->ta, adapter_mac_addr(adapter), ETH_ALEN); -+ _rtw_memcpy(attrib->mda, mda, ETH_ALEN); -+ _rtw_memcpy(attrib->msa, msa, ETH_ALEN); -+ _rtw_memcpy(attrib->dst, da, ETH_ALEN); -+ _rtw_memcpy(attrib->src, sa, ETH_ALEN); -+ attrib->mesh_frame_mode = ae_need ? MESH_UCAST_PX_DATA : MESH_UCAST_DATA; -+ -+ rtw_list_insert_tail(&b2uframe->list, b2u_list); -+ } -+ -+exit: -+ return bmc_need; -+} -+ -+void dump_mesh_b2u_flags(void *sel, _adapter *adapter) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ -+ RTW_PRINT_SEL(sel, "%4s %4s\n", "msrc", "mfwd"); -+ RTW_PRINT_SEL(sel, "0x%02x 0x%02x\n", mcfg->b2u_flags_msrc, mcfg->b2u_flags_mfwd); -+} -+#endif /* CONFIG_RTW_MESH_DATA_BMC_TO_UC */ -+ -+int rtw_mesh_addr_resolve(_adapter *adapter, u16 os_qid, struct xmit_frame *xframe, _pkt *pkt, _list *b2u_list) -+{ -+ struct pkt_file pktfile; -+ struct ethhdr etherhdr; -+ struct pkt_attrib *attrib; -+ struct rtw_mesh_path *mpath = NULL, *mppath = NULL; -+ u8 is_da_mcast; -+ u8 ae_need; -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ bool bmc_need = _TRUE; -+ u8 b2u_num = 0; -+ u32 b2u_mseq = 0; -+#endif -+ int res = _SUCCESS; -+ -+ _rtw_open_pktfile(pkt, &pktfile); -+ if (_rtw_pktfile_read(&pktfile, (u8 *)ðerhdr, ETH_HLEN) != ETH_HLEN) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ xframe->pkt = pkt; -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ _rtw_init_listhead(b2u_list); -+#endif -+ -+ is_da_mcast = IS_MCAST(etherhdr.h_dest); -+ if (!is_da_mcast) { -+ struct sta_info *next_hop; -+ bool mpp_lookup = 1; -+ -+ mpath = rtw_mesh_path_lookup(adapter, etherhdr.h_dest); -+ if (mpath) { -+ mpp_lookup = 0; -+ next_hop = rtw_rcu_dereference(mpath->next_hop); -+ if (!next_hop -+ || !(mpath->flags & (RTW_MESH_PATH_ACTIVE | RTW_MESH_PATH_RESOLVING)) -+ ) { -+ /* mpath is not valid, search mppath */ -+ mpp_lookup = 1; -+ } -+ } -+ -+ if (mpp_lookup) { -+ mppath = rtw_mpp_path_lookup(adapter, etherhdr.h_dest); -+ if (mppath) -+ mppath->exp_time = rtw_get_current_time(); -+ } -+ -+ if (mppath && mpath) -+ rtw_mesh_path_del(adapter, mpath->dst); -+ -+ ae_need = _rtw_memcmp(adapter_mac_addr(adapter), etherhdr.h_source, ETH_ALEN) == _FALSE -+ || (mppath && _rtw_memcmp(mppath->mpp, etherhdr.h_dest, ETH_ALEN) == _FALSE); -+ } else { -+ ae_need = _rtw_memcmp(adapter_mac_addr(adapter), etherhdr.h_source, ETH_ALEN) == _FALSE; -+ -+ #if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ if (rtw_msrc_b2u_policy_chk(adapter->mesh_cfg.b2u_flags_msrc, etherhdr.h_dest)) { -+ bmc_need = rtw_mesh_data_bmc_to_uc(adapter -+ , etherhdr.h_dest, etherhdr.h_source -+ , etherhdr.h_dest, adapter_mac_addr(adapter), ae_need, NULL, 0 -+ , os_qid, b2u_list, &b2u_num, &b2u_mseq); -+ if (bmc_need == _FALSE) { -+ res = RTW_ORI_NO_NEED; -+ goto exit; -+ } -+ } -+ #endif -+ } -+ -+ attrib = &xframe->attrib; -+ -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ if (b2u_num) { -+ attrib->mb2u = 1; -+ attrib->mseq = b2u_mseq; -+ } else -+ attrib->mb2u = 0; -+#endif -+ -+ attrib->mfwd_ttl = 0; -+ _rtw_memcpy(attrib->dst, etherhdr.h_dest, ETH_ALEN); -+ _rtw_memcpy(attrib->src, etherhdr.h_source, ETH_ALEN); -+ _rtw_memcpy(attrib->ta, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ if (is_da_mcast) { -+ attrib->mesh_frame_mode = ae_need ? MESH_BMCAST_PX_DATA : MESH_BMCAST_DATA; -+ _rtw_memcpy(attrib->ra, attrib->dst, ETH_ALEN); -+ _rtw_memcpy(attrib->msa, adapter_mac_addr(adapter), ETH_ALEN); -+ } else { -+ attrib->mesh_frame_mode = ae_need ? MESH_UCAST_PX_DATA : MESH_UCAST_DATA; -+ _rtw_memcpy(attrib->mda, (mppath && ae_need) ? mppath->mpp : attrib->dst, ETH_ALEN); -+ _rtw_memcpy(attrib->msa, adapter_mac_addr(adapter), ETH_ALEN); -+ /* RA needs to be resolved */ -+ res = rtw_mesh_nexthop_resolve(adapter, xframe); -+ } -+ -+exit: -+ return res; -+} -+ -+s8 rtw_mesh_tx_set_whdr_mctrl_len(u8 mesh_frame_mode, struct pkt_attrib *attrib) -+{ -+ u8 ret = 0; -+ switch (mesh_frame_mode) { -+ case MESH_UCAST_DATA: -+ attrib->hdrlen = WLAN_HDR_A4_QOS_LEN; -+ /* mesh flag + mesh TTL + Mesh SN. no ext addr. */ -+ attrib->meshctrl_len = 6; -+ break; -+ case MESH_BMCAST_DATA: -+ attrib->hdrlen = WLAN_HDR_A3_QOS_LEN; -+ /* mesh flag + mesh TTL + Mesh SN. no ext addr. */ -+ attrib->meshctrl_len = 6; -+ break; -+ case MESH_UCAST_PX_DATA: -+ attrib->hdrlen = WLAN_HDR_A4_QOS_LEN; -+ /* mesh flag + mesh TTL + Mesh SN + extaddr1 + extaddr2. */ -+ attrib->meshctrl_len = 18; -+ break; -+ case MESH_BMCAST_PX_DATA: -+ attrib->hdrlen = WLAN_HDR_A3_QOS_LEN; -+ /* mesh flag + mesh TTL + Mesh SN + extaddr1 */ -+ attrib->meshctrl_len = 12; -+ break; -+ default: -+ RTW_WARN("Invalid mesh frame mode:%u\n", mesh_frame_mode); -+ ret = -1; -+ break; -+ } -+ -+ return ret; -+} -+ -+void rtw_mesh_tx_build_mctrl(_adapter *adapter, struct pkt_attrib *attrib, u8 *buf) -+{ -+ struct rtw_ieee80211s_hdr *mctrl = (struct rtw_ieee80211s_hdr *)buf; -+ -+ _rtw_memset(mctrl, 0, XATTRIB_GET_MCTRL_LEN(attrib)); -+ -+ if (attrib->mfwd_ttl -+ #if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ || attrib->mb2u -+ #endif -+ ) { -+ #if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ if (!attrib->mfwd_ttl) -+ mctrl->ttl = adapter->mesh_cfg.dot11MeshTTL; -+ else -+ #endif -+ mctrl->ttl = attrib->mfwd_ttl; -+ -+ mctrl->seqnum = (cpu_to_le32(attrib->mseq)); -+ } else { -+ mctrl->ttl = adapter->mesh_cfg.dot11MeshTTL; -+ mctrl->seqnum = (cpu_to_le32(adapter->mesh_info.mesh_seqnum)); -+ adapter->mesh_info.mesh_seqnum++; -+ } -+ -+ switch (attrib->mesh_frame_mode){ -+ case MESH_UCAST_DATA: -+ case MESH_BMCAST_DATA: -+ break; -+ case MESH_UCAST_PX_DATA: -+ mctrl->flags |= MESH_FLAGS_AE_A5_A6; -+ _rtw_memcpy(mctrl->eaddr1, attrib->dst, ETH_ALEN); -+ _rtw_memcpy(mctrl->eaddr2, attrib->src, ETH_ALEN); -+ break; -+ case MESH_BMCAST_PX_DATA: -+ mctrl->flags |= MESH_FLAGS_AE_A4; -+ _rtw_memcpy(mctrl->eaddr1, attrib->src, ETH_ALEN); -+ break; -+ case MESH_MHOP_UCAST_ACT: -+ /* TBD */ -+ break; -+ case MESH_MHOP_BMCAST_ACT: -+ /* TBD */ -+ break; -+ default: -+ break; -+ } -+} -+ -+u8 rtw_mesh_tx_build_whdr(_adapter *adapter, struct pkt_attrib *attrib -+ , u16 *fctrl, struct rtw_ieee80211_hdr *whdr) -+{ -+ switch (attrib->mesh_frame_mode) { -+ case MESH_UCAST_DATA: /* 1, 1, RA, TA, mDA(=DA), mSA(=SA) */ -+ case MESH_UCAST_PX_DATA: /* 1, 1, RA, TA, mDA, mSA, [DA, SA] */ -+ SetToDs(fctrl); -+ SetFrDs(fctrl); -+ _rtw_memcpy(whdr->addr1, attrib->ra, ETH_ALEN); -+ _rtw_memcpy(whdr->addr2, attrib->ta, ETH_ALEN); -+ _rtw_memcpy(whdr->addr3, attrib->mda, ETH_ALEN); -+ _rtw_memcpy(whdr->addr4, attrib->msa, ETH_ALEN); -+ break; -+ case MESH_BMCAST_DATA: /* 0, 1, RA(DA), TA, mSA(SA) */ -+ case MESH_BMCAST_PX_DATA: /* 0, 1, RA(DA), TA, mSA, [SA] */ -+ SetFrDs(fctrl); -+ _rtw_memcpy(whdr->addr1, attrib->ra, ETH_ALEN); -+ _rtw_memcpy(whdr->addr2, attrib->ta, ETH_ALEN); -+ _rtw_memcpy(whdr->addr3, attrib->msa, ETH_ALEN); -+ break; -+ case MESH_MHOP_UCAST_ACT: -+ /* TBD */ -+ RTW_INFO("MESH_MHOP_UCAST_ACT\n"); -+ break; -+ case MESH_MHOP_BMCAST_ACT: -+ /* TBD */ -+ RTW_INFO("MESH_MHOP_BMCAST_ACT\n"); -+ break; -+ default: -+ RTW_WARN("Invalid mesh frame mode\n"); -+ break; -+ } -+ -+ return 0; -+} -+ -+int rtw_mesh_rx_data_validate_hdr(_adapter *adapter, union recv_frame *rframe, struct sta_info **sta) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; -+ u8 *whdr = get_recvframe_data(rframe); -+ u8 is_ra_bmc = 0; -+ u8 a4_shift = 0; -+ u8 ps; -+ u8 *qc; -+ u8 mps_mode = RTW_MESH_PS_UNKNOWN; -+ sint ret = _FAIL; -+ -+ if (!(MLME_STATE(adapter) & WIFI_ASOC_STATE)) -+ goto exit; -+ -+ if (!rattrib->qos) -+ goto exit; -+ -+ switch (rattrib->to_fr_ds) { -+ case 2: -+ if (!IS_MCAST(GetAddr1Ptr(whdr))) -+ goto exit; -+ *sta = rtw_get_stainfo(stapriv, get_addr2_ptr(whdr)); -+ if (*sta == NULL) { -+ ret = _SUCCESS; /* return _SUCCESS to drop at sta checking */ -+ goto exit; -+ } -+ _rtw_memcpy(rattrib->ra, GetAddr1Ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->ta, get_addr2_ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->mda, GetAddr1Ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->msa, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ -+ _rtw_memcpy(rattrib->dst, GetAddr1Ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->src, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking mesh ctrl field */ -+ _rtw_memcpy(rattrib->bssid, get_addr2_ptr(whdr), ETH_ALEN); -+ is_ra_bmc = 1; -+ break; -+ case 3: -+ if (IS_MCAST(GetAddr1Ptr(whdr))) -+ goto exit; -+ *sta = rtw_get_stainfo(stapriv, get_addr2_ptr(whdr)); -+ if (*sta == NULL) { -+ ret = _SUCCESS; /* return _SUCCESS to drop at sta checking */ -+ goto exit; -+ } -+ _rtw_memcpy(rattrib->ra, GetAddr1Ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->ta, get_addr2_ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->mda, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ -+ _rtw_memcpy(rattrib->msa, GetAddr4Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ -+ _rtw_memcpy(rattrib->dst, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking mesh ctrl field */ -+ _rtw_memcpy(rattrib->src, GetAddr4Ptr(whdr), ETH_ALEN); /* may change after checking mesh ctrl field */ -+ _rtw_memcpy(rattrib->bssid, get_addr2_ptr(whdr), ETH_ALEN); -+ a4_shift = ETH_ALEN; -+ break; -+ default: -+ goto exit; -+ } -+ -+ qc = whdr + WLAN_HDR_A3_LEN + a4_shift; -+ ps = GetPwrMgt(whdr); -+ mps_mode = ps ? (is_ra_bmc || (get_mps_lv(qc)) ? RTW_MESH_PS_DSLEEP : RTW_MESH_PS_LSLEEP) : RTW_MESH_PS_ACTIVE; -+ -+ if (ps) { -+ if (!((*sta)->state & WIFI_SLEEP_STATE)) -+ stop_sta_xmit(adapter, *sta); -+ } else { -+ if ((*sta)->state & WIFI_SLEEP_STATE) -+ wakeup_sta_to_xmit(adapter, *sta, ALL_FRAME); -+ } -+ -+ if (is_ra_bmc) -+ (*sta)->nonpeer_mps = mps_mode; -+ else { -+ (*sta)->peer_mps = mps_mode; -+ if (mps_mode != RTW_MESH_PS_ACTIVE && (*sta)->nonpeer_mps == RTW_MESH_PS_ACTIVE) -+ (*sta)->nonpeer_mps = RTW_MESH_PS_DSLEEP; -+ } -+ -+ if (get_frame_sub_type(whdr) & BIT(6)) { -+ /* No data, will not indicate to upper layer, temporily count it here */ -+ count_rx_stats(adapter, rframe, *sta); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+ rattrib->mesh_ctrl_present = get_mctrl_present(qc) ? 1 : 0; -+ if (!rattrib->mesh_ctrl_present) -+ goto exit; -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int rtw_mesh_rx_data_validate_mctrl(_adapter *adapter, union recv_frame *rframe -+ , const struct rtw_ieee80211s_hdr *mctrl, const u8 *mda, const u8 *msa -+ , u8 *mctrl_len -+ , const u8 **da, const u8 **sa) -+{ -+ struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; -+ u8 mlen; -+ u8 ae; -+ int ret = _SUCCESS; -+ -+ ae = mctrl->flags & MESH_FLAGS_AE; -+ mlen = ae_to_mesh_ctrl_len[ae]; -+ switch (rattrib->to_fr_ds) { -+ case 2: -+ *da = mda; -+ if (ae == MESH_FLAGS_AE_A4) -+ *sa = mctrl->eaddr1; -+ else if (ae == 0) -+ *sa = msa; -+ else -+ ret = _FAIL; -+ break; -+ case 3: -+ if (ae == MESH_FLAGS_AE_A5_A6) { -+ *da = mctrl->eaddr1; -+ *sa = mctrl->eaddr2; -+ } else if (ae == 0) { -+ *da = mda; -+ *sa = msa; -+ } else -+ ret = _FAIL; -+ break; -+ default: -+ ret = _FAIL; -+ } -+ -+ if (ret == _FAIL) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" invalid tfDS:%u AE:%u combination ra="MAC_FMT" ta="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), rattrib->to_fr_ds, ae, MAC_ARG(rattrib->ra), MAC_ARG(rattrib->ta)); -+ #endif -+ *mctrl_len = 0; -+ } else -+ *mctrl_len = mlen; -+ -+ return ret; -+} -+ -+inline int rtw_mesh_rx_validate_mctrl_non_amsdu(_adapter *adapter, union recv_frame *rframe) -+{ -+ struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; -+ const u8 *da, *sa; -+ int ret; -+ -+ ret = rtw_mesh_rx_data_validate_mctrl(adapter, rframe -+ , (struct rtw_ieee80211s_hdr *)(get_recvframe_data(rframe) + rattrib->hdrlen + rattrib->iv_len) -+ , rattrib->mda, rattrib->msa -+ , &rattrib->mesh_ctrl_len -+ , &da, &sa); -+ -+ if (ret == _SUCCESS) { -+ _rtw_memcpy(rattrib->dst, da, ETH_ALEN); -+ _rtw_memcpy(rattrib->src, sa, ETH_ALEN); -+ } -+ -+ return ret; -+} -+ -+/** -+ * rtw_mesh_rx_nexthop_resolve - lookup next hop; conditionally start path discovery -+ * -+ * @skb: 802.11 frame to be sent -+ * @sdata: network subif the frame will be sent through -+ * -+ * Lookup next hop for given skb and start path discovery if no -+ * forwarding information is found. -+ * -+ * Returns: 0 if the next hop was found and -ENOENT if the frame was queued. -+ * skb is freeed here if no mpath could be allocated. -+ */ -+static int rtw_mesh_rx_nexthop_resolve(_adapter *adapter, -+ const u8 *mda, const u8 *msa, u8 *ra) -+{ -+ struct rtw_mesh_path *mpath; -+ struct xmit_frame *xframe_to_free = NULL; -+ int err = 0; -+ int ret = _SUCCESS; -+ -+ rtw_rcu_read_lock(); -+ err = rtw_mesh_nexthop_lookup(adapter, mda, msa, ra); -+ if (!err) -+ goto endlookup; -+ -+ /* no nexthop found, start resolving */ -+ mpath = rtw_mesh_path_lookup(adapter, mda); -+ if (!mpath) { -+ mpath = rtw_mesh_path_add(adapter, mda); -+ if (IS_ERR(mpath)) { -+ err = PTR_ERR(mpath); -+ ret = _FAIL; -+ goto endlookup; -+ } -+ } -+ -+ if (!(mpath->flags & RTW_MESH_PATH_RESOLVING)) -+ rtw_mesh_queue_preq(mpath, RTW_PREQ_Q_F_START); -+ -+ ret = _FAIL; -+ -+endlookup: -+ rtw_rcu_read_unlock(); -+ return ret; -+} -+ -+#define RTW_MESH_DECACHE_BMC 1 -+#define RTW_MESH_DECACHE_UC 0 -+ -+#define RTW_MESH_FORWARD_MDA_SELF_COND 0 -+#define DBG_RTW_MESH_FORWARD_MDA_SELF_COND 0 -+int rtw_mesh_rx_msdu_act_check(union recv_frame *rframe -+ , const u8 *mda, const u8 *msa -+ , const u8 *da, const u8 *sa -+ , struct rtw_ieee80211s_hdr *mctrl -+ , u8 *msdu, enum rtw_rx_llc_hdl llc_hdl -+ , struct xmit_frame **fwd_frame, _list *b2u_list) -+{ -+ _adapter *adapter = rframe->u.hdr.adapter; -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; -+ struct rtw_mesh_path *mppath; -+ u8 is_mda_bmc = IS_MCAST(mda); -+ u8 is_mda_self = !is_mda_bmc && _rtw_memcmp(mda, adapter_mac_addr(adapter), ETH_ALEN); -+ u16 os_qid; -+ struct xmit_frame *xframe; -+ struct pkt_attrib *xattrib; -+ u8 fwd_ra[ETH_ALEN] = {0}; -+ u8 fwd_mpp[ETH_ALEN] = {0}; /* forward to other gate */ -+ u32 fwd_mseq; -+ int act = 0; -+ u8 ae_need; -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ bool ori_need = _TRUE; -+ u8 b2u_num = 0; -+#endif -+ -+ /* fwd info lifetime update */ -+ #if 0 -+ if (!is_mda_self) -+ mDA(A3) fwinfo.lifetime -+ mSA(A4) fwinfo.lifetime -+ Precursor-to-mDA(A2) fwinfo.lifetime -+ #endif -+ -+ /* update/create pxoxy info for SA, mSA */ -+ if ((mctrl->flags & MESH_FLAGS_AE) -+ && sa != msa && _rtw_memcmp(sa, msa, ETH_ALEN) == _FALSE -+ ) { -+ const u8 *proxied_addr = sa; -+ const u8 *mpp_addr = msa; -+ -+ rtw_rcu_read_lock(); -+ mppath = rtw_mpp_path_lookup(adapter, proxied_addr); -+ if (!mppath) -+ rtw_mpp_path_add(adapter, proxied_addr, mpp_addr); -+ else { -+ enter_critical_bh(&mppath->state_lock); -+ if (_rtw_memcmp(mppath->mpp, mpp_addr, ETH_ALEN) == _FALSE) -+ _rtw_memcpy(mppath->mpp, mpp_addr, ETH_ALEN); -+ mppath->exp_time = rtw_get_current_time(); -+ exit_critical_bh(&mppath->state_lock); -+ } -+ rtw_rcu_read_unlock(); -+ } -+ -+ /* mSA is self, need no further process */ -+ if (_rtw_memcmp(msa, adapter_mac_addr(adapter), ETH_ALEN) == _TRUE) -+ goto exit; -+ -+ fwd_mseq = le32_to_cpu(mctrl->seqnum); -+ -+ /* check duplicate MSDU from mSA */ -+ if (((RTW_MESH_DECACHE_BMC && is_mda_bmc) -+ || (RTW_MESH_DECACHE_UC && !is_mda_bmc)) -+ && rtw_mesh_decache(adapter, msa, fwd_mseq) -+ ) { -+ minfo->mshstats.dropped_frames_duplicate++; -+ goto exit; -+ } -+ -+ if (is_mda_bmc) { -+ /* mDA is bmc addr */ -+ act |= RTW_RX_MSDU_ACT_INDICATE; -+ if (!mcfg->dot11MeshForwarding) -+ goto exit; -+ goto fwd_chk; -+ -+ } else if (!is_mda_self) { -+ /* mDA is unicast but not self */ -+ if (!mcfg->dot11MeshForwarding) { -+ rtw_mesh_path_error_tx(adapter -+ , adapter->mesh_cfg.element_ttl -+ , mda, 0 -+ , WLAN_REASON_MESH_PATH_NOFORWARD -+ , rattrib->ta -+ ); -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" mDA("MAC_FMT") not self, !dot11MeshForwarding\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(mda)); -+ #endif -+ goto exit; -+ } -+ -+ if (rtw_mesh_rx_nexthop_resolve(adapter, mda, msa, fwd_ra) != _SUCCESS) { -+ /* mDA is unknown */ -+ rtw_mesh_path_error_tx(adapter -+ , adapter->mesh_cfg.element_ttl -+ , mda, 0 -+ , WLAN_REASON_MESH_PATH_NOFORWARD -+ , rattrib->ta -+ ); -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" mDA("MAC_FMT") unknown\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(mda)); -+ #endif -+ minfo->mshstats.dropped_frames_no_route++; -+ goto exit; -+ -+ } else { -+ /* mDA is known in fwd info */ -+ #if 0 -+ if (TA is not in precursors) -+ goto exit; -+ #endif -+ goto fwd_chk; -+ } -+ -+ } else { -+ /* mDA is self */ -+ #if RTW_MESH_FORWARD_MDA_SELF_COND -+ if (da == mda -+ || _rtw_memcmp(da, adapter_mac_addr(adapter), ETH_ALEN) -+ ) { -+ /* DA is self, indicate */ -+ act |= RTW_RX_MSDU_ACT_INDICATE; -+ goto exit; -+ } -+ -+ if (rtw_get_iface_by_macddr(adapter, da)) { -+ /* DA is buddy, indicate */ -+ act |= RTW_RX_MSDU_ACT_INDICATE; -+ #if DBG_RTW_MESH_FORWARD_MDA_SELF_COND -+ RTW_INFO(FUNC_ADPT_FMT" DA("MAC_FMT") is buddy("ADPT_FMT")\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(da), ADPT_ARG(rtw_get_iface_by_macddr(adapter, da))); -+ #endif -+ goto exit; -+ } -+ -+ /* DA is not self or buddy */ -+ if (rtw_mesh_nexthop_lookup(adapter, da, msa, fwd_ra) == 0) { -+ /* DA is known in fwd info */ -+ if (!mcfg->dot11MeshForwarding) { -+ /* path error to? */ -+ #if defined(DBG_RX_DROP_FRAME) || DBG_RTW_MESH_FORWARD_MDA_SELF_COND -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" DA("MAC_FMT") not self, !dot11MeshForwarding\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(da)); -+ #endif -+ goto exit; -+ } -+ mda = da; -+ #if DBG_RTW_MESH_FORWARD_MDA_SELF_COND -+ RTW_INFO(FUNC_ADPT_FMT" fwd to DA("MAC_FMT"), fwd_RA("MAC_FMT")\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(da), MAC_ARG(fwd_ra)); -+ #endif -+ goto fwd_chk; -+ } -+ -+ rtw_rcu_read_lock(); -+ mppath = rtw_mpp_path_lookup(adapter, da); -+ if (mppath) { -+ if (_rtw_memcmp(mppath->mpp, adapter_mac_addr(adapter), ETH_ALEN) == _FALSE) { -+ /* DA is proxied by others */ -+ if (!mcfg->dot11MeshForwarding) { -+ /* path error to? */ -+ #if defined(DBG_RX_DROP_FRAME) || DBG_RTW_MESH_FORWARD_MDA_SELF_COND -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" DA("MAC_FMT") is proxied by ("MAC_FMT"), !dot11MeshForwarding\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(da), MAC_ARG(mppath->mpp)); -+ #endif -+ rtw_rcu_read_unlock(); -+ goto exit; -+ } -+ _rtw_memcpy(fwd_mpp, mppath->mpp, ETH_ALEN); -+ mda = fwd_mpp; -+ msa = adapter_mac_addr(adapter); -+ rtw_rcu_read_unlock(); -+ -+ /* resolve RA */ -+ if (rtw_mesh_nexthop_lookup(adapter, mda, msa, fwd_ra) != 0) { -+ minfo->mshstats.dropped_frames_no_route++; -+ #if defined(DBG_RX_DROP_FRAME) || DBG_RTW_MESH_FORWARD_MDA_SELF_COND -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" DA("MAC_FMT") is proxied by ("MAC_FMT"), RA resolve fail\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(da), MAC_ARG(mppath->mpp)); -+ #endif -+ goto exit; -+ } -+ #if DBG_RTW_MESH_FORWARD_MDA_SELF_COND -+ RTW_INFO(FUNC_ADPT_FMT" DA("MAC_FMT") is proxied by ("MAC_FMT"), fwd_RA("MAC_FMT")\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(da), MAC_ARG(mppath->mpp), MAC_ARG(fwd_ra)); -+ #endif -+ goto fwd_chk; /* forward to other gate */ -+ } else { -+ #if DBG_RTW_MESH_FORWARD_MDA_SELF_COND -+ RTW_INFO(FUNC_ADPT_FMT" DA("MAC_FMT") is proxied by self\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(da)); -+ #endif -+ } -+ } -+ rtw_rcu_read_unlock(); -+ -+ if (!mppath) { -+ #if DBG_RTW_MESH_FORWARD_MDA_SELF_COND -+ RTW_INFO(FUNC_ADPT_FMT" DA("MAC_FMT") unknown\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(da)); -+ #endif -+ /* DA is unknown */ -+ #if 0 /* TODO: flags with AE bit */ -+ rtw_mesh_path_error_tx(adapter -+ , adapter->mesh_cfg.element_ttl -+ , mda, adapter->mesh_info.last_sn_update -+ , WLAN_REASON_MESH_PATH_NOPROXY -+ , msa -+ ); -+ #endif -+ } -+ -+ /* -+ * indicate to DS for both cases: -+ * 1.) DA is proxied by self -+ * 2.) DA is unknown -+ */ -+ #endif /* RTW_MESH_FORWARD_MDA_SELF_COND */ -+ act |= RTW_RX_MSDU_ACT_INDICATE; -+ goto exit; -+ } -+ -+fwd_chk: -+ -+ if (adapter->stapriv.asoc_list_cnt <= 1) -+ goto exit; -+ -+ if (mctrl->ttl == 1) { -+ minfo->mshstats.dropped_frames_ttl++; -+ if (!act) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" ttl reaches 0, not forwarding\n" -+ , FUNC_ADPT_ARG(adapter)); -+ #endif -+ } -+ goto exit; -+ } -+ -+ os_qid = rtw_os_recv_select_queue(msdu, llc_hdl); -+ -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ _rtw_init_listhead(b2u_list); -+#endif -+ -+ ae_need = _rtw_memcmp(da , mda, ETH_ALEN) == _FALSE -+ || _rtw_memcmp(sa , msa, ETH_ALEN) == _FALSE; -+ -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ if (is_mda_bmc -+ && rtw_mfwd_b2u_policy_chk(mcfg->b2u_flags_mfwd, mda, rattrib->to_fr_ds == 3) -+ ) { -+ ori_need = rtw_mesh_data_bmc_to_uc(adapter -+ , da, sa, mda, msa, ae_need, rframe->u.hdr.psta->cmn.mac_addr, mctrl->ttl - 1 -+ , os_qid, b2u_list, &b2u_num, &fwd_mseq); -+ } -+ -+ if (ori_need == _TRUE) -+#endif -+ { -+ xframe = rtw_alloc_xmitframe(&adapter->xmitpriv, os_qid); -+ if (!xframe) { -+ #ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME "FUNC_ADPT_FMT" rtw_alloc_xmitframe fail\n" -+ , FUNC_ADPT_ARG(adapter)); -+ #endif -+ goto exit; -+ } -+ -+ xattrib = &xframe->attrib; -+ -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ if (b2u_num) -+ xattrib->mb2u = 1; -+ else -+ xattrib->mb2u = 0; -+#endif -+ xattrib->mfwd_ttl = mctrl->ttl - 1; -+ xattrib->mseq = fwd_mseq; -+ _rtw_memcpy(xattrib->dst, da, ETH_ALEN); -+ _rtw_memcpy(xattrib->src, sa, ETH_ALEN); -+ _rtw_memcpy(xattrib->mda, mda, ETH_ALEN); -+ _rtw_memcpy(xattrib->msa, msa, ETH_ALEN); -+ _rtw_memcpy(xattrib->ta, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ if (is_mda_bmc) { -+ xattrib->mesh_frame_mode = ae_need ? MESH_BMCAST_PX_DATA : MESH_BMCAST_DATA; -+ _rtw_memcpy(xattrib->ra, mda, ETH_ALEN); -+ } else { -+ xattrib->mesh_frame_mode = ae_need ? MESH_UCAST_PX_DATA : MESH_UCAST_DATA; -+ _rtw_memcpy(xattrib->ra, fwd_ra, ETH_ALEN); -+ } -+ -+ *fwd_frame = xframe; -+ } -+ -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ if (ori_need || b2u_num) -+#endif -+ { -+ act |= RTW_RX_MSDU_ACT_FORWARD; -+ if (is_mda_bmc) -+ minfo->mshstats.fwded_mcast++; -+ else -+ minfo->mshstats.fwded_unicast++; -+ minfo->mshstats.fwded_frames++; -+ } -+ -+exit: -+ return act; -+} -+ -+void dump_mesh_stats(void *sel, _adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct rtw_mesh_stats *stats = &minfo->mshstats; -+ -+ RTW_PRINT_SEL(sel, "fwd_bmc:%u\n", stats->fwded_mcast); -+ RTW_PRINT_SEL(sel, "fwd_uc:%u\n", stats->fwded_unicast); -+ -+ RTW_PRINT_SEL(sel, "drop_ttl:%u\n", stats->dropped_frames_ttl); -+ RTW_PRINT_SEL(sel, "drop_no_route:%u\n", stats->dropped_frames_no_route); -+ RTW_PRINT_SEL(sel, "drop_congestion:%u\n", stats->dropped_frames_congestion); -+ RTW_PRINT_SEL(sel, "drop_dup:%u\n", stats->dropped_frames_duplicate); -+ -+ RTW_PRINT_SEL(sel, "mrc_del_qlen:%u\n", stats->mrc_del_qlen); -+} -+#endif /* CONFIG_RTW_MESH */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh.h b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh.h -new file mode 100644 -index 000000000..5410ba404 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh.h -@@ -0,0 +1,537 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_MESH_H_ -+#define __RTW_MESH_H_ -+ -+#ifndef CONFIG_AP_MODE -+ #error "CONFIG_RTW_MESH can't be enabled when CONFIG_AP_MODE is not defined\n" -+#endif -+ -+#define RTW_MESH_TTL 31 -+#define RTW_MESH_PERR_MIN_INT 100 -+#define RTW_MESH_DEFAULT_ELEMENT_TTL 31 -+#define RTW_MESH_RANN_INTERVAL 5000 -+#define RTW_MESH_PATH_TO_ROOT_TIMEOUT 6000 -+#define RTW_MESH_DIAM_TRAVERSAL_TIME 50 -+#define RTW_MESH_PATH_TIMEOUT 5000 -+#define RTW_MESH_PREQ_MIN_INT 10 -+#define RTW_MESH_MAX_PREQ_RETRIES 4 -+#define RTW_MESH_MIN_DISCOVERY_TIMEOUT (2 * RTW_MESH_DIAM_TRAVERSAL_TIME) -+#define RTW_MESH_ROOT_CONFIRMATION_INTERVAL 2000 -+#define RTW_MESH_PATH_REFRESH_TIME 1000 -+#define RTW_MESH_ROOT_INTERVAL 5000 -+ -+#define RTW_MESH_SANE_METRIC_DELTA 100 -+#define RTW_MESH_MAX_ROOT_ADD_CHK_CNT 2 -+ -+#define RTW_MESH_PLINK_UNKNOWN 0 -+#define RTW_MESH_PLINK_LISTEN 1 -+#define RTW_MESH_PLINK_OPN_SNT 2 -+#define RTW_MESH_PLINK_OPN_RCVD 3 -+#define RTW_MESH_PLINK_CNF_RCVD 4 -+#define RTW_MESH_PLINK_ESTAB 5 -+#define RTW_MESH_PLINK_HOLDING 6 -+#define RTW_MESH_PLINK_BLOCKED 7 -+ -+extern const char *_rtw_mesh_plink_str[]; -+#define rtw_mesh_plink_str(s) ((s <= RTW_MESH_PLINK_BLOCKED) ? _rtw_mesh_plink_str[s] : _rtw_mesh_plink_str[RTW_MESH_PLINK_UNKNOWN]) -+ -+#define RTW_MESH_PS_UNKNOWN 0 -+#define RTW_MESH_PS_ACTIVE 1 -+#define RTW_MESH_PS_LSLEEP 2 -+#define RTW_MESH_PS_DSLEEP 3 -+ -+extern const char *_rtw_mesh_ps_str[]; -+#define rtw_mesh_ps_str(mps) ((mps <= RTW_MESH_PS_DSLEEP) ? _rtw_mesh_ps_str[mps] : _rtw_mesh_ps_str[RTW_MESH_PS_UNKNOWN]) -+ -+#define GET_MESH_CONF_ELE_PATH_SEL_PROTO_ID(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 0, 0, 8) -+#define GET_MESH_CONF_ELE_PATH_SEL_METRIC_ID(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 1, 0, 8) -+#define GET_MESH_CONF_ELE_CONGEST_CTRL_MODE_ID(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 2, 0, 8) -+#define GET_MESH_CONF_ELE_SYNC_METHOD_ID(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 3, 0, 8) -+#define GET_MESH_CONF_ELE_AUTH_PROTO_ID(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 4, 0, 8) -+ -+#define GET_MESH_CONF_ELE_MESH_FORMATION(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 5, 0, 8) -+#define GET_MESH_CONF_ELE_CTO_MGATE(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 5, 0, 1) -+#define GET_MESH_CONF_ELE_NUM_OF_PEERINGS(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 5, 1, 6) -+#define GET_MESH_CONF_ELE_CTO_AS(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 5, 7, 1) -+ -+#define GET_MESH_CONF_ELE_MESH_CAP(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 0, 8) -+#define GET_MESH_CONF_ELE_ACCEPT_PEERINGS(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 0, 1) -+#define GET_MESH_CONF_ELE_MCCA_SUP(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 1, 1) -+#define GET_MESH_CONF_ELE_MCCA_EN(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 2, 1) -+#define GET_MESH_CONF_ELE_FORWARDING(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 3, 1) -+#define GET_MESH_CONF_ELE_MBCA_EN(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 4, 1) -+#define GET_MESH_CONF_ELE_TBTT_ADJ(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 5, 1) -+#define GET_MESH_CONF_ELE_PS_LEVEL(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 6, 1) -+ -+#define SET_MESH_CONF_ELE_PATH_SEL_PROTO_ID(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 0, 0, 8, _val) -+#define SET_MESH_CONF_ELE_PATH_SEL_METRIC_ID(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 1, 0, 8, _val) -+#define SET_MESH_CONF_ELE_CONGEST_CTRL_MODE_ID(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 2, 0, 8, _val) -+#define SET_MESH_CONF_ELE_SYNC_METHOD_ID(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 3, 0, 8, _val) -+#define SET_MESH_CONF_ELE_AUTH_PROTO_ID(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 4, 0, 8, _val) -+ -+#define SET_MESH_CONF_ELE_CTO_MGATE(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 5, 0, 1, _val) -+#define SET_MESH_CONF_ELE_NUM_OF_PEERINGS(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 5, 1, 6, _val) -+#define SET_MESH_CONF_ELE_CTO_AS(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 5, 7, 1, _val) -+ -+#define SET_MESH_CONF_ELE_ACCEPT_PEERINGS(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 0, 1, _val) -+#define SET_MESH_CONF_ELE_MCCA_SUP(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 1, 1, _val) -+#define SET_MESH_CONF_ELE_MCCA_EN(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 2, 1, _val) -+#define SET_MESH_CONF_ELE_FORWARDING(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 3, 1, _val) -+#define SET_MESH_CONF_ELE_MBCA_EN(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 4, 1, _val) -+#define SET_MESH_CONF_ELE_TBTT_ADJ(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 5, 1, _val) -+#define SET_MESH_CONF_ELE_PS_LEVEL(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 6, 1, _val) -+ -+/* Mesh flags */ -+#define MESH_FLAGS_AE 0x3 /* mask */ -+#define MESH_FLAGS_AE_A4 0x1 -+#define MESH_FLAGS_AE_A5_A6 0x2 -+ -+/* Max number of paths */ -+#define RTW_MESH_MAX_PATHS 1024 -+ -+#define RTW_PREQ_Q_F_START 0x1 -+#define RTW_PREQ_Q_F_REFRESH 0x2 -+#define RTW_PREQ_Q_F_CHK 0x4 -+#define RTW_PREQ_Q_F_PEER_AKA 0x8 -+#define RTW_PREQ_Q_F_BCAST_PREQ 0x10 /* force path_dicover using broadcast */ -+struct rtw_mesh_preq_queue { -+ _list list; -+ u8 dst[ETH_ALEN]; -+ u8 flags; -+}; -+ -+extern const u8 ae_to_mesh_ctrl_len[]; -+ -+enum mesh_frame_type { -+ MESH_UCAST_DATA = 0x0, -+ MESH_BMCAST_DATA = 0x1, -+ MESH_UCAST_PX_DATA = 0x2, -+ MESH_BMCAST_PX_DATA = 0x3, -+ MESH_MHOP_UCAST_ACT = 0x4, -+ MESH_MHOP_BMCAST_ACT = 0x5, -+}; -+ -+enum mpath_sel_frame_type { -+ MPATH_PREQ = 0, -+ MPATH_PREP, -+ MPATH_PERR, -+ MPATH_RANN -+}; -+ -+/** -+ * enum rtw_mesh_deferred_task_flags - mesh deferred tasks -+ * -+ * -+ * -+ * @RTW_MESH_WORK_HOUSEKEEPING: run the periodic mesh housekeeping tasks -+ * @RTW_MESH_WORK_ROOT: the mesh root station needs to send a frame -+ * @RTW_MESH_WORK_DRIFT_ADJUST: time to compensate for clock drift relative to other -+ * mesh nodes -+ * @RTW_MESH_WORK_MBSS_CHANGED: rebuild beacon and notify driver of BSS changes -+ */ -+enum rtw_mesh_deferred_task_flags { -+ RTW_MESH_WORK_HOUSEKEEPING, -+ RTW_MESH_WORK_ROOT, -+ RTW_MESH_WORK_DRIFT_ADJUST, -+ RTW_MESH_WORK_MBSS_CHANGED, -+}; -+ -+#define RTW_MESH_MAX_PEER_CANDIDATES 15 /* aid consideration */ -+#define RTW_MESH_MAX_PEER_LINKS 8 -+#define RTW_MESH_PEER_LINK_TIMEOUT 20 -+ -+#define RTW_MESH_PEER_CONF_DISABLED 0 /* special time value means no confirmation ongoing */ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+#define IS_PEER_CONF_DISABLED(plink) ((plink)->peer_conf_end_time == RTW_MESH_PEER_CONF_DISABLED) -+#define IS_PEER_CONF_TIMEOUT(plink)(!IS_PEER_CONF_DISABLED(plink) && rtw_time_after(rtw_get_current_time(), (plink)->peer_conf_end_time)) -+#define SET_PEER_CONF_DISABLED(plink) (plink)->peer_conf_end_time = RTW_MESH_PEER_CONF_DISABLED -+#define SET_PEER_CONF_END_TIME(plink, timeout_ms) \ -+ do { \ -+ (plink)->peer_conf_end_time = rtw_get_current_time() + rtw_ms_to_systime(timeout_ms); \ -+ if ((plink)->peer_conf_end_time == RTW_MESH_PEER_CONF_DISABLED) \ -+ (plink)->peer_conf_end_time++; \ -+ } while (0) -+#else -+#define IS_PEER_CONF_DISABLED(plink) 1 -+#define IS_PEER_CONF_TIMEOUT(plink) 0 -+#define SET_PEER_CONF_DISABLED(plink) do {} while (0) -+#define SET_PEER_CONF_END_TIME(plink, timeout_ms) do {} while (0) -+#endif /* CONFIG_RTW_MESH_PEER_BLACKLIST */ -+ -+#define RTW_MESH_CTO_MGATE_CONF_DISABLED 0 /* special time value means no confirmation ongoing */ -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+#define IS_CTO_MGATE_CONF_DISABLED(plink) ((plink)->cto_mgate_conf_end_time == RTW_MESH_CTO_MGATE_CONF_DISABLED) -+#define IS_CTO_MGATE_CONF_TIMEOUT(plink)(!IS_CTO_MGATE_CONF_DISABLED(plink) && rtw_time_after(rtw_get_current_time(), (plink)->cto_mgate_conf_end_time)) -+#define SET_CTO_MGATE_CONF_DISABLED(plink) (plink)->cto_mgate_conf_end_time = RTW_MESH_CTO_MGATE_CONF_DISABLED -+#define SET_CTO_MGATE_CONF_END_TIME(plink, timeout_ms) \ -+ do { \ -+ (plink)->cto_mgate_conf_end_time = rtw_get_current_time() + rtw_ms_to_systime(timeout_ms); \ -+ if ((plink)->cto_mgate_conf_end_time == RTW_MESH_CTO_MGATE_CONF_DISABLED) \ -+ (plink)->cto_mgate_conf_end_time++; \ -+ } while (0) -+#else -+#define IS_CTO_MGATE_CONF_DISABLED(plink) 1 -+#define IS_CTO_MGATE_CONF_TIMEOUT(plink) 0 -+#define SET_CTO_MGATE_CONF_DISABLED(plink) do {} while (0) -+#define SET_CTO_MGATE_CONF_END_TIME(plink, timeout_ms) do {} while (0) -+#endif /* CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST */ -+ -+struct mesh_plink_ent { -+ u8 valid; -+ u8 addr[ETH_ALEN]; -+ u8 plink_state; -+ -+#ifdef CONFIG_RTW_MESH_AEK -+ u8 aek_valid; -+ u8 aek[32]; -+#endif -+ -+ u16 llid; -+ u16 plid; -+#ifndef CONFIG_RTW_MESH_DRIVER_AID -+ u16 aid; /* aid assigned from upper layer */ -+#endif -+ u16 peer_aid; /* aid assigned from peer */ -+ -+ u8 chosen_pmk[16]; -+ -+#ifdef CONFIG_RTW_MESH_AEK -+ u8 sel_pcs[4]; -+ u8 l_nonce[32]; -+ u8 p_nonce[32]; -+#endif -+ -+#ifdef CONFIG_RTW_MESH_DRIVER_AID -+ u8 *tx_conf_ies; -+ u16 tx_conf_ies_len; -+#endif -+ u8 *rx_conf_ies; -+ u16 rx_conf_ies_len; -+ -+ struct wlan_network *scanned; -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+ systime peer_conf_end_time; -+#endif -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ systime cto_mgate_conf_end_time; -+#endif -+}; -+ -+#ifdef CONFIG_RTW_MESH_AEK -+#define MESH_PLINK_AEK_VALID(ent) ent->aek_valid -+#else -+#define MESH_PLINK_AEK_VALID(ent) 0 -+#endif -+ -+struct mesh_plink_pool { -+ _lock lock; -+ u8 num; /* current ent being used */ -+ struct mesh_plink_ent ent[RTW_MESH_MAX_PEER_CANDIDATES]; -+ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+ u8 acnode_rsvd; -+#endif -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+ _queue peer_blacklist; -+#endif -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ _queue cto_mgate_blacklist; -+#endif -+}; -+ -+struct mesh_peer_sel_policy { -+ u32 scanr_exp_ms; -+ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+ u8 acnode_prevent; -+ u32 acnode_conf_timeout_ms; -+ u32 acnode_notify_timeout_ms; -+#endif -+ -+#if CONFIG_RTW_MESH_OFFCH_CAND -+ u8 offch_cand; -+ u32 offch_find_int_ms; /* 0 means no offch find triggerred by driver self*/ -+#endif -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+ u32 peer_conf_timeout_ms; -+ u32 peer_blacklist_timeout_ms; -+#endif -+ -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ u8 cto_mgate_require; -+ u32 cto_mgate_conf_timeout_ms; -+ u32 cto_mgate_blacklist_timeout_ms; -+#endif -+}; -+ -+/* b2u flags */ -+#define RTW_MESH_B2U_ALL BIT0 -+#define RTW_MESH_B2U_GA_UCAST BIT1 /* Group addressed unicast frame, forward only */ -+#define RTW_MESH_B2U_BCAST BIT2 -+#define RTW_MESH_B2U_IP_MCAST BIT3 -+ -+#define rtw_msrc_b2u_policy_chk(flags, mda) ( \ -+ (flags & RTW_MESH_B2U_ALL) \ -+ || ((flags & RTW_MESH_B2U_BCAST) && is_broadcast_mac_addr(mda)) \ -+ || ((flags & RTW_MESH_B2U_IP_MCAST) && (IP_MCAST_MAC(mda) || ICMPV6_MCAST_MAC(mda))) \ -+ ) -+ -+#define rtw_mfwd_b2u_policy_chk(flags, mda, ucst) ( \ -+ (flags & RTW_MESH_B2U_ALL) \ -+ || ((flags & RTW_MESH_B2U_GA_UCAST) && ucst) \ -+ || ((flags & RTW_MESH_B2U_BCAST) && is_broadcast_mac_addr(mda)) \ -+ || ((flags & RTW_MESH_B2U_IP_MCAST) && (IP_MCAST_MAC(mda) || ICMPV6_MCAST_MAC(mda))) \ -+ ) -+ -+/** -+ * @sane_metric_delta: Controlling if trigger additional path check mechanism -+ * @max_root_add_chk_cnt: The retry cnt to send additional root confirmation -+ * PREQ through old(last) path -+ */ -+struct rtw_mesh_cfg { -+ u8 max_peer_links; /* peering limit */ -+ u32 plink_timeout; /* seconds */ -+ -+ u8 dot11MeshTTL; -+ u8 element_ttl; -+ u32 path_refresh_time; -+ u16 dot11MeshHWMPpreqMinInterval; -+ u16 dot11MeshHWMPnetDiameterTraversalTime; -+ u32 dot11MeshHWMPactivePathTimeout; -+ u8 dot11MeshHWMPmaxPREQretries; -+ u16 min_discovery_timeout; -+ u16 dot11MeshHWMPconfirmationInterval; -+ u16 dot11MeshHWMPperrMinInterval; -+ u8 dot11MeshHWMPRootMode; -+ BOOLEAN dot11MeshForwarding; -+ s32 rssi_threshold; /* in dBm, 0: no specified */ -+ u16 dot11MeshHWMPRannInterval; -+ BOOLEAN dot11MeshGateAnnouncementProtocol; -+ u32 dot11MeshHWMPactivePathToRootTimeout; -+ u16 dot11MeshHWMProotInterval; -+ u8 path_gate_timeout_factor; -+#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK -+ u16 sane_metric_delta; -+ u8 max_root_add_chk_cnt; -+#endif -+ -+ struct mesh_peer_sel_policy peer_sel_policy; -+ -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ u8 b2u_flags_msrc; -+ u8 b2u_flags_mfwd; -+#endif -+}; -+ -+struct rtw_mesh_stats { -+ u32 fwded_mcast; /* Mesh forwarded multicast frames */ -+ u32 fwded_unicast; /* Mesh forwarded unicast frames */ -+ u32 fwded_frames; /* Mesh total forwarded frames */ -+ u32 dropped_frames_ttl; /* Not transmitted since mesh_ttl == 0*/ -+ u32 dropped_frames_no_route; /* Not transmitted, no route found */ -+ u32 dropped_frames_congestion;/* Not forwarded due to congestion */ -+ u32 dropped_frames_duplicate; -+ -+ u32 mrc_del_qlen; /* MRC entry deleted cause by queue length limit */ -+}; -+ -+struct rtw_mrc; -+ -+struct rtw_mesh_info { -+ u8 mesh_id[NDIS_802_11_LENGTH_SSID]; -+ size_t mesh_id_len; -+ /* Active Path Selection Protocol Identifier */ -+ u8 mesh_pp_id; -+ /* Active Path Selection Metric Identifier */ -+ u8 mesh_pm_id; -+ /* Congestion Control Mode Identifier */ -+ u8 mesh_cc_id; -+ /* Synchronization Protocol Identifier */ -+ u8 mesh_sp_id; -+ /* Authentication Protocol Identifier */ -+ u8 mesh_auth_id; -+ -+ struct mesh_plink_pool plink_ctl; -+ -+ u32 mesh_seqnum; -+ /* MSTA's own hwmp sequence number */ -+ u32 sn; -+ systime last_preq; -+ systime last_sn_update; -+ systime next_perr; -+ /* Last used Path Discovery ID */ -+ u32 preq_id; -+ -+ ATOMIC_T mpaths; -+ struct rtw_mesh_table *mesh_paths; -+ struct rtw_mesh_table *mpp_paths; -+ int mesh_paths_generation; -+ int mpp_paths_generation; -+ -+ int num_gates; -+ struct rtw_mesh_path *max_addr_gate; -+ bool max_addr_gate_is_larger_than_self; -+ -+ struct rtw_mesh_stats mshstats; -+ -+ _queue mpath_tx_queue; -+ u32 mpath_tx_queue_len; -+ _tasklet mpath_tx_tasklet; -+ -+ struct rtw_mrc *mrc; -+ -+ _lock mesh_preq_queue_lock; -+ struct rtw_mesh_preq_queue preq_queue; -+ int preq_queue_len; -+}; -+ -+extern const char *_action_self_protected_str[]; -+#define action_self_protected_str(action) ((action < RTW_ACT_SELF_PROTECTED_NUM) ? _action_self_protected_str[action] : _action_self_protected_str[0]) -+ -+u8 *rtw_set_ie_mesh_id(u8 *buf, u32 *buf_len, const char *mesh_id, u8 id_len); -+u8 *rtw_set_ie_mesh_config(u8 *buf, u32 *buf_len -+ , u8 path_sel_proto, u8 path_sel_metric, u8 congest_ctl_mode, u8 sync_method, u8 auth_proto -+ , u8 num_of_peerings, bool cto_mgate, bool cto_as -+ , bool accept_peerings, bool mcca_sup, bool mcca_en, bool forwarding -+ , bool mbca_en, bool tbtt_adj, bool ps_level); -+ -+int rtw_bss_is_same_mbss(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b); -+int rtw_bss_is_candidate_mesh_peer(_adapter *adapter, WLAN_BSSID_EX *target, u8 ch, u8 add_peer); -+ -+void rtw_chk_candidate_peer_notify(_adapter *adapter, struct wlan_network *scanned); -+ -+void rtw_mesh_peer_status_chk(_adapter *adapter); -+ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+void rtw_mesh_update_scanned_acnode_status(_adapter *adapter, struct wlan_network *scanned); -+bool rtw_mesh_scanned_is_acnode_confirmed(_adapter *adapter, struct wlan_network *scanned); -+bool rtw_mesh_acnode_prevent_allow_sacrifice(_adapter *adapter); -+struct sta_info *rtw_mesh_acnode_prevent_pick_sacrifice(_adapter *adapter); -+void dump_mesh_acnode_prevent_settings(void *sel, _adapter *adapter); -+#endif -+ -+#if CONFIG_RTW_MESH_OFFCH_CAND -+u8 rtw_mesh_offch_candidate_accepted(_adapter *adapter); -+u8 rtw_mesh_select_operating_ch(_adapter *adapter); -+void dump_mesh_offch_cand_settings(void *sel, _adapter *adapter); -+#endif -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+int rtw_mesh_peer_blacklist_add(_adapter *adapter, const u8 *addr); -+int rtw_mesh_peer_blacklist_del(_adapter *adapter, const u8 *addr); -+int rtw_mesh_peer_blacklist_search(_adapter *adapter, const u8 *addr); -+void rtw_mesh_peer_blacklist_flush(_adapter *adapter); -+void dump_mesh_peer_blacklist(void *sel, _adapter *adapter); -+void dump_mesh_peer_blacklist_settings(void *sel, _adapter *adapter); -+#endif -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+u8 rtw_mesh_cto_mgate_required(_adapter *adapter); -+u8 rtw_mesh_cto_mgate_network_filter(_adapter *adapter, struct wlan_network *scanned); -+int rtw_mesh_cto_mgate_blacklist_add(_adapter *adapter, const u8 *addr); -+int rtw_mesh_cto_mgate_blacklist_del(_adapter *adapter, const u8 *addr); -+int rtw_mesh_cto_mgate_blacklist_search(_adapter *adapter, const u8 *addr); -+void rtw_mesh_cto_mgate_blacklist_flush(_adapter *adapter); -+void dump_mesh_cto_mgate_blacklist(void *sel, _adapter *adapter); -+void dump_mesh_cto_mgate_blacklist_settings(void *sel, _adapter *adapter); -+#endif -+void dump_mesh_peer_sel_policy(void *sel, _adapter *adapter); -+void dump_mesh_networks(void *sel, _adapter *adapter); -+ -+void rtw_mesh_adjust_chbw(u8 req_ch, u8 *req_bw, u8 *req_offset); -+ -+void rtw_mesh_sae_check_frames(_adapter *adapter, const u8 *buf, u32 len, u8 tx, u16 alg, u16 seq, u16 status); -+int rtw_mesh_check_frames_tx(_adapter *adapter, const u8 **buf, size_t *len); -+int rtw_mesh_check_frames_rx(_adapter *adapter, const u8 *buf, size_t len); -+ -+int rtw_mesh_on_auth(_adapter *adapter, union recv_frame *rframe); -+unsigned int on_action_self_protected(_adapter *adapter, union recv_frame *rframe); -+ -+bool rtw_mesh_update_bss_peering_status(_adapter *adapter, WLAN_BSSID_EX *bss); -+bool rtw_mesh_update_bss_formation_info(_adapter *adapter, WLAN_BSSID_EX *bss); -+bool rtw_mesh_update_bss_forwarding_state(_adapter *adapter, WLAN_BSSID_EX *bss); -+ -+struct mesh_plink_ent *_rtw_mesh_plink_get(_adapter *adapter, const u8 *hwaddr); -+struct mesh_plink_ent *rtw_mesh_plink_get(_adapter *adapter, const u8 *hwaddr); -+struct mesh_plink_ent *rtw_mesh_plink_get_no_estab_by_idx(_adapter *adapter, u8 idx); -+int _rtw_mesh_plink_add(_adapter *adapter, const u8 *hwaddr); -+int rtw_mesh_plink_add(_adapter *adapter, const u8 *hwaddr); -+int rtw_mesh_plink_set_state(_adapter *adapter, const u8 *hwaddr, u8 state); -+#ifdef CONFIG_RTW_MESH_AEK -+int rtw_mesh_plink_set_aek(_adapter *adapter, const u8 *hwaddr, const u8 *aek); -+#endif -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+int rtw_mesh_plink_set_peer_conf_timeout(_adapter *adapter, const u8 *hwaddr); -+#endif -+void _rtw_mesh_plink_del_ent(_adapter *adapter, struct mesh_plink_ent *ent); -+int rtw_mesh_plink_del(_adapter *adapter, const u8 *hwaddr); -+void rtw_mesh_plink_ctl_init(_adapter *adapter); -+void rtw_mesh_plink_ctl_deinit(_adapter *adapter); -+void dump_mesh_plink_ctl(void *sel, _adapter *adapter); -+ -+u8 rtw_mesh_set_plink_state_cmd(_adapter *adapter, const u8 *mac, u8 plink_state); -+ -+void _rtw_mesh_expire_peer_ent(_adapter *adapter, struct mesh_plink_ent *plink); -+void rtw_mesh_expire_peer(_adapter *adapter, const u8 *peer_addr); -+u8 rtw_mesh_ps_annc(_adapter *adapter, u8 ps); -+ -+unsigned int on_action_mesh(_adapter *adapter, union recv_frame *rframe); -+ -+void rtw_mesh_cfg_init(_adapter *adapter); -+void rtw_mesh_cfg_init_max_peer_links(_adapter *adapter, u8 stack_conf); -+void rtw_mesh_cfg_init_plink_timeout(_adapter *adapter, u32 stack_conf); -+void rtw_mesh_init_mesh_info(_adapter *adapter); -+void rtw_mesh_deinit_mesh_info(_adapter *adapter); -+ -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+void dump_mesh_b2u_flags(void *sel, _adapter *adapter); -+#endif -+ -+int rtw_mesh_addr_resolve(_adapter *adapter, u16 os_qid, struct xmit_frame *xframe, _pkt *pkt, _list *b2u_list); -+ -+s8 rtw_mesh_tx_set_whdr_mctrl_len(u8 mesh_frame_mode, struct pkt_attrib *attrib); -+void rtw_mesh_tx_build_mctrl(_adapter *adapter, struct pkt_attrib *attrib, u8 *buf); -+u8 rtw_mesh_tx_build_whdr(_adapter *adapter, struct pkt_attrib *attrib -+ , u16 *fctrl, struct rtw_ieee80211_hdr *whdr); -+ -+int rtw_mesh_rx_data_validate_hdr(_adapter *adapter, union recv_frame *rframe, struct sta_info **sta); -+int rtw_mesh_rx_data_validate_mctrl(_adapter *adapter, union recv_frame *rframe -+ , const struct rtw_ieee80211s_hdr *mctrl, const u8 *mda, const u8 *msa -+ , u8 *mctrl_len, const u8 **da, const u8 **sa); -+int rtw_mesh_rx_validate_mctrl_non_amsdu(_adapter *adapter, union recv_frame *rframe); -+ -+int rtw_mesh_rx_msdu_act_check(union recv_frame *rframe -+ , const u8 *mda, const u8 *msa -+ , const u8 *da, const u8 *sa -+ , struct rtw_ieee80211s_hdr *mctrl -+ , u8 *msdu, enum rtw_rx_llc_hdl llc_hdl -+ , struct xmit_frame **fwd_frame, _list *b2u_list); -+ -+void dump_mesh_stats(void *sel, _adapter *adapter); -+ -+#if defined(PLATFORM_LINUX) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 32)) -+#define rtw_lockdep_assert_held(l) lockdep_assert_held(l) -+#define rtw_lockdep_is_held(l) lockdep_is_held(l) -+#else -+#error "TBD\n" -+#endif -+ -+#include "rtw_mesh_pathtbl.h" -+#include "rtw_mesh_hwmp.h" -+#endif /* __RTW_MESH_H_ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_hwmp.c b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_hwmp.c -new file mode 100644 -index 000000000..04be425b2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_hwmp.c -@@ -0,0 +1,1518 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HWMP_C_ -+ -+#ifdef CONFIG_RTW_MESH -+#include -+#include -+ -+#define RTW_TEST_FRAME_LEN 8192 -+#define RTW_MAX_METRIC 0xffffffff -+#define RTW_ARITH_SHIFT 8 -+#define RTW_LINK_FAIL_THRESH 95 -+#define RTW_MAX_PREQ_QUEUE_LEN 64 -+#define RTW_ATLM_REQ_CYCLE 1000 -+ -+#define rtw_ilog2(n) \ -+( \ -+ (n) < 2 ? 0 : \ -+ (n) & (1ULL << 63) ? 63 : \ -+ (n) & (1ULL << 62) ? 62 : \ -+ (n) & (1ULL << 61) ? 61 : \ -+ (n) & (1ULL << 60) ? 60 : \ -+ (n) & (1ULL << 59) ? 59 : \ -+ (n) & (1ULL << 58) ? 58 : \ -+ (n) & (1ULL << 57) ? 57 : \ -+ (n) & (1ULL << 56) ? 56 : \ -+ (n) & (1ULL << 55) ? 55 : \ -+ (n) & (1ULL << 54) ? 54 : \ -+ (n) & (1ULL << 53) ? 53 : \ -+ (n) & (1ULL << 52) ? 52 : \ -+ (n) & (1ULL << 51) ? 51 : \ -+ (n) & (1ULL << 50) ? 50 : \ -+ (n) & (1ULL << 49) ? 49 : \ -+ (n) & (1ULL << 48) ? 48 : \ -+ (n) & (1ULL << 47) ? 47 : \ -+ (n) & (1ULL << 46) ? 46 : \ -+ (n) & (1ULL << 45) ? 45 : \ -+ (n) & (1ULL << 44) ? 44 : \ -+ (n) & (1ULL << 43) ? 43 : \ -+ (n) & (1ULL << 42) ? 42 : \ -+ (n) & (1ULL << 41) ? 41 : \ -+ (n) & (1ULL << 40) ? 40 : \ -+ (n) & (1ULL << 39) ? 39 : \ -+ (n) & (1ULL << 38) ? 38 : \ -+ (n) & (1ULL << 37) ? 37 : \ -+ (n) & (1ULL << 36) ? 36 : \ -+ (n) & (1ULL << 35) ? 35 : \ -+ (n) & (1ULL << 34) ? 34 : \ -+ (n) & (1ULL << 33) ? 33 : \ -+ (n) & (1ULL << 32) ? 32 : \ -+ (n) & (1ULL << 31) ? 31 : \ -+ (n) & (1ULL << 30) ? 30 : \ -+ (n) & (1ULL << 29) ? 29 : \ -+ (n) & (1ULL << 28) ? 28 : \ -+ (n) & (1ULL << 27) ? 27 : \ -+ (n) & (1ULL << 26) ? 26 : \ -+ (n) & (1ULL << 25) ? 25 : \ -+ (n) & (1ULL << 24) ? 24 : \ -+ (n) & (1ULL << 23) ? 23 : \ -+ (n) & (1ULL << 22) ? 22 : \ -+ (n) & (1ULL << 21) ? 21 : \ -+ (n) & (1ULL << 20) ? 20 : \ -+ (n) & (1ULL << 19) ? 19 : \ -+ (n) & (1ULL << 18) ? 18 : \ -+ (n) & (1ULL << 17) ? 17 : \ -+ (n) & (1ULL << 16) ? 16 : \ -+ (n) & (1ULL << 15) ? 15 : \ -+ (n) & (1ULL << 14) ? 14 : \ -+ (n) & (1ULL << 13) ? 13 : \ -+ (n) & (1ULL << 12) ? 12 : \ -+ (n) & (1ULL << 11) ? 11 : \ -+ (n) & (1ULL << 10) ? 10 : \ -+ (n) & (1ULL << 9) ? 9 : \ -+ (n) & (1ULL << 8) ? 8 : \ -+ (n) & (1ULL << 7) ? 7 : \ -+ (n) & (1ULL << 6) ? 6 : \ -+ (n) & (1ULL << 5) ? 5 : \ -+ (n) & (1ULL << 4) ? 4 : \ -+ (n) & (1ULL << 3) ? 3 : \ -+ (n) & (1ULL << 2) ? 2 : \ -+ 1 \ -+) -+ -+enum rtw_mpath_frame_type { -+ RTW_MPATH_PREQ = 0, -+ RTW_MPATH_PREP, -+ RTW_MPATH_PERR, -+ RTW_MPATH_RANN -+}; -+ -+static inline u32 rtw_u32_field_get(const u8 *preq_elem, int shift, BOOLEAN ae) -+{ -+ if (ae) -+ shift += 6; -+ return LE_BITS_TO_4BYTE(preq_elem + shift, 0, 32); -+} -+ -+static inline u16 rtw_u16_field_get(const u8 *preq_elem, int shift, BOOLEAN ae) -+{ -+ if (ae) -+ shift += 6; -+ return LE_BITS_TO_2BYTE(preq_elem + shift, 0, 16); -+} -+ -+/* HWMP IE processing macros */ -+#define RTW_AE_F (1<<6) -+#define RTW_AE_F_SET(x) (*x & RTW_AE_F) -+#define RTW_PREQ_IE_FLAGS(x) (*(x)) -+#define RTW_PREQ_IE_HOPCOUNT(x) (*(x + 1)) -+#define RTW_PREQ_IE_TTL(x) (*(x + 2)) -+#define RTW_PREQ_IE_PREQ_ID(x) rtw_u32_field_get(x, 3, 0) -+#define RTW_PREQ_IE_ORIG_ADDR(x) (x + 7) -+#define RTW_PREQ_IE_ORIG_SN(x) rtw_u32_field_get(x, 13, 0) -+#define RTW_PREQ_IE_LIFETIME(x) rtw_u32_field_get(x, 17, RTW_AE_F_SET(x)) -+#define RTW_PREQ_IE_METRIC(x) rtw_u32_field_get(x, 21, RTW_AE_F_SET(x)) -+#define RTW_PREQ_IE_TARGET_F(x) (*(RTW_AE_F_SET(x) ? x + 32 : x + 26)) -+#define RTW_PREQ_IE_TARGET_ADDR(x) (RTW_AE_F_SET(x) ? x + 33 : x + 27) -+#define RTW_PREQ_IE_TARGET_SN(x) rtw_u32_field_get(x, 33, RTW_AE_F_SET(x)) -+ -+#define RTW_PREP_IE_FLAGS(x) RTW_PREQ_IE_FLAGS(x) -+#define RTW_PREP_IE_HOPCOUNT(x) RTW_PREQ_IE_HOPCOUNT(x) -+#define RTW_PREP_IE_TTL(x) RTW_PREQ_IE_TTL(x) -+#define RTW_PREP_IE_ORIG_ADDR(x) (RTW_AE_F_SET(x) ? x + 27 : x + 21) -+#define RTW_PREP_IE_ORIG_SN(x) rtw_u32_field_get(x, 27, RTW_AE_F_SET(x)) -+#define RTW_PREP_IE_LIFETIME(x) rtw_u32_field_get(x, 13, RTW_AE_F_SET(x)) -+#define RTW_PREP_IE_METRIC(x) rtw_u32_field_get(x, 17, RTW_AE_F_SET(x)) -+#define RTW_PREP_IE_TARGET_ADDR(x) (x + 3) -+#define RTW_PREP_IE_TARGET_SN(x) rtw_u32_field_get(x, 9, 0) -+ -+#define RTW_PERR_IE_TTL(x) (*(x)) -+#define RTW_PERR_IE_TARGET_FLAGS(x) (*(x + 2)) -+#define RTW_PERR_IE_TARGET_ADDR(x) (x + 3) -+#define RTW_PERR_IE_TARGET_SN(x) rtw_u32_field_get(x, 9, 0) -+#define RTW_PERR_IE_TARGET_RCODE(x) rtw_u16_field_get(x, 13, 0) -+ -+#define RTW_TU_TO_SYSTIME(x) (rtw_us_to_systime((x) * 1024)) -+#define RTW_TU_TO_EXP_TIME(x) (rtw_get_current_time() + RTW_TU_TO_SYSTIME(x)) -+#define RTW_MSEC_TO_TU(x) (x*1000/1024) -+#define RTW_SN_GT(x, y) ((s32)(y - x) < 0) -+#define RTW_SN_LT(x, y) ((s32)(x - y) < 0) -+#define RTW_MAX_SANE_SN_DELTA 32 -+ -+static inline u32 RTW_SN_DELTA(u32 x, u32 y) -+{ -+ return x >= y ? x - y : y - x; -+} -+ -+#define rtw_net_traversal_jiffies(adapter) \ -+ rtw_ms_to_systime(adapter->mesh_cfg.dot11MeshHWMPnetDiameterTraversalTime) -+#define rtw_default_lifetime(adapter) \ -+ RTW_MSEC_TO_TU(adapter->mesh_cfg.dot11MeshHWMPactivePathTimeout) -+#define rtw_min_preq_int_jiff(adapter) \ -+ (rtw_ms_to_systime(adapter->mesh_cfg.dot11MeshHWMPpreqMinInterval)) -+#define rtw_max_preq_retries(adapter) (adapter->mesh_cfg.dot11MeshHWMPmaxPREQretries) -+#define rtw_disc_timeout_jiff(adapter) \ -+ rtw_ms_to_systime(adapter->mesh_cfg.min_discovery_timeout) -+#define rtw_root_path_confirmation_jiffies(adapter) \ -+ rtw_ms_to_systime(adapter->mesh_cfg.dot11MeshHWMPconfirmationInterval) -+ -+static inline BOOLEAN rtw_ether_addr_equal(const u8 *addr1, const u8 *addr2) -+{ -+ return _rtw_memcmp(addr1, addr2, ETH_ALEN); -+} -+ -+#ifdef PLATFORM_LINUX -+#define rtw_print_ratelimit() printk_ratelimit() -+#define rtw_mod_timer(ptimer, expires) mod_timer(&(ptimer)->timer, expires) -+#else -+ -+#endif -+ -+#define RTW_MESH_EWMA_PRECISION 20 -+#define RTW_MESH_EWMA_WEIGHT_RCP 8 -+#define RTW_TOTAL_PKT_MIN_THRESHOLD 1 -+inline void rtw_ewma_err_rate_init(struct rtw_ewma_err_rate *e) -+{ -+ e->internal = 0; -+} -+inline unsigned long rtw_ewma_err_rate_read(struct rtw_ewma_err_rate *e) -+{ -+ return e->internal >> (RTW_MESH_EWMA_PRECISION); -+} -+inline void rtw_ewma_err_rate_add(struct rtw_ewma_err_rate *e, -+ unsigned long val) -+{ -+ unsigned long internal = e->internal; -+ unsigned long weight_rcp = rtw_ilog2(RTW_MESH_EWMA_WEIGHT_RCP); -+ unsigned long precision = RTW_MESH_EWMA_PRECISION; -+ -+ (e->internal) = internal ? (((internal << weight_rcp) - internal) + -+ (val << precision)) >> weight_rcp : -+ (val << precision); -+} -+ -+static const u8 bcast_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+static int rtw_mesh_path_sel_frame_tx(enum rtw_mpath_frame_type mpath_action, u8 flags, -+ const u8 *originator_addr, u32 originator_sn, -+ u8 target_flags, const u8 *target, -+ u32 target_sn, const u8 *da, u8 hopcount, u8 ttl, -+ u32 lifetime, u32 metric, u32 preq_id, -+ _adapter *adapter) -+{ -+ struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct xmit_frame *pmgntframe = NULL; -+ struct rtw_ieee80211_hdr *pwlanhdr = NULL; -+ struct pkt_attrib *pattrib = NULL; -+ u8 category = RTW_WLAN_CATEGORY_MESH; -+ u8 action = RTW_ACT_MESH_HWMP_PATH_SELECTION; -+ u16 *fctrl = NULL; -+ u8 *pos, ie_len; -+ -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return -1; -+ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(adapter, pattrib); -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pos = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pos; -+ -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ set_frame_sub_type(pos, WIFI_ACTION); -+ -+ pos += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pos = rtw_set_fixed_ie(pos, 1, &(category), &(pattrib->pktlen)); -+ pos = rtw_set_fixed_ie(pos, 1, &(action), &(pattrib->pktlen)); -+ -+ switch (mpath_action) { -+ case RTW_MPATH_PREQ: -+ RTW_HWMP_DBG("sending PREQ to "MAC_FMT"\n", MAC_ARG(target)); -+ ie_len = 37; -+ pattrib->pktlen += (ie_len + 2); -+ *pos++ = WLAN_EID_PREQ; -+ break; -+ case RTW_MPATH_PREP: -+ RTW_HWMP_DBG("sending PREP to "MAC_FMT"\n", MAC_ARG(originator_addr)); -+ ie_len = 31; -+ pattrib->pktlen += (ie_len + 2); -+ *pos++ = WLAN_EID_PREP; -+ break; -+ case RTW_MPATH_RANN: -+ RTW_HWMP_DBG("sending RANN from "MAC_FMT"\n", MAC_ARG(originator_addr)); -+ ie_len = sizeof(struct rtw_ieee80211_rann_ie); -+ pattrib->pktlen += (ie_len + 2); -+ *pos++ = WLAN_EID_RANN; -+ break; -+ default: -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ return _FAIL; -+ } -+ *pos++ = ie_len; -+ *pos++ = flags; -+ *pos++ = hopcount; -+ *pos++ = ttl; -+ if (mpath_action == RTW_MPATH_PREP) { -+ _rtw_memcpy(pos, target, ETH_ALEN); -+ pos += ETH_ALEN; -+ *(u32 *)pos = cpu_to_le32(target_sn); -+ pos += 4; -+ } else { -+ if (mpath_action == RTW_MPATH_PREQ) { -+ *(u32 *)pos = cpu_to_le32(preq_id); -+ pos += 4; -+ } -+ _rtw_memcpy(pos, originator_addr, ETH_ALEN); -+ pos += ETH_ALEN; -+ *(u32 *)pos = cpu_to_le32(originator_sn); -+ pos += 4; -+ } -+ *(u32 *)pos = cpu_to_le32(lifetime); -+ pos += 4; -+ *(u32 *)pos = cpu_to_le32(metric); -+ pos += 4; -+ if (mpath_action == RTW_MPATH_PREQ) { -+ *pos++ = 1; /* support only 1 destination now */ -+ *pos++ = target_flags; -+ _rtw_memcpy(pos, target, ETH_ALEN); -+ pos += ETH_ALEN; -+ *(u32 *)pos = cpu_to_le32(target_sn); -+ pos += 4; -+ } else if (mpath_action == RTW_MPATH_PREP) { -+ _rtw_memcpy(pos, originator_addr, ETH_ALEN); -+ pos += ETH_ALEN; -+ *(u32 *)pos = cpu_to_le32(originator_sn); -+ pos += 4; -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ dump_mgntframe(adapter, pmgntframe); -+ return 0; -+} -+ -+int rtw_mesh_path_error_tx(_adapter *adapter, -+ u8 ttl, const u8 *target, u32 target_sn, -+ u16 perr_reason_code, const u8 *ra) -+{ -+ -+ struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct xmit_frame *pmgntframe = NULL; -+ struct rtw_ieee80211_hdr *pwlanhdr = NULL; -+ struct pkt_attrib *pattrib = NULL; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ u8 category = RTW_WLAN_CATEGORY_MESH; -+ u8 action = RTW_ACT_MESH_HWMP_PATH_SELECTION; -+ u8 *pos, ie_len; -+ u16 *fctrl = NULL; -+ -+ if (rtw_time_before(rtw_get_current_time(), minfo->next_perr)) -+ return -1; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return -1; -+ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(adapter, pattrib); -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pos = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pos; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ set_frame_sub_type(pos, WIFI_ACTION); -+ -+ pos += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pos = rtw_set_fixed_ie(pos, 1, &(category), &(pattrib->pktlen)); -+ pos = rtw_set_fixed_ie(pos, 1, &(action), &(pattrib->pktlen)); -+ -+ ie_len = 15; -+ pattrib->pktlen += (2 + ie_len); -+ *pos++ = WLAN_EID_PERR; -+ *pos++ = ie_len; -+ /* ttl */ -+ *pos++ = ttl; -+ /* The Number of Destinations N */ -+ *pos++ = 1; -+ /* Flags format | B7 | B6 | B5:B0 | = | rsvd | AE | rsvd | */ -+ *pos = 0; -+ pos++; -+ _rtw_memcpy(pos, target, ETH_ALEN); -+ pos += ETH_ALEN; -+ *(u32 *)pos = cpu_to_le32(target_sn); -+ pos += 4; -+ *(u16 *)pos = cpu_to_le16(perr_reason_code); -+ -+ adapter->mesh_info.next_perr = RTW_TU_TO_EXP_TIME( -+ adapter->mesh_cfg.dot11MeshHWMPperrMinInterval); -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ /* Send directly. Rewrite it if deferred tx is needed */ -+ dump_mgntframe(adapter, pmgntframe); -+ -+ RTW_HWMP_DBG("TX PERR toward "MAC_FMT", ra = "MAC_FMT"\n", MAC_ARG(target), MAC_ARG(ra)); -+ -+ return 0; -+} -+ -+static u32 rtw_airtime_link_metric_get(_adapter *adapter, struct sta_info *sta) -+{ -+ struct dm_struct *dm = adapter_to_phydm(adapter); -+ int device_constant = phydm_get_plcp(dm, sta->cmn.mac_id) << RTW_ARITH_SHIFT; -+ u32 test_frame_len = RTW_TEST_FRAME_LEN << RTW_ARITH_SHIFT; -+ u32 s_unit = 1 << RTW_ARITH_SHIFT; -+ u32 err; -+ u16 rate; -+ u32 tx_time, estimated_retx; -+ u64 result; -+ /* The fail_avg should <= 100 here */ -+ u32 fail_avg = (u32)rtw_ewma_err_rate_read(&sta->metrics.err_rate); -+ -+ if (fail_avg > RTW_LINK_FAIL_THRESH) -+ return RTW_MAX_METRIC; -+ -+ rate = sta->metrics.data_rate; -+ /* rate unit is 100Kbps, min rate = 10 */ -+ if (rate < 10) { -+ RTW_HWMP_INFO("rate = %d\n", rate); -+ return RTW_MAX_METRIC; -+ } -+ -+ err = (fail_avg << RTW_ARITH_SHIFT) / 100; -+ -+ /* test_frame_len*10 to adjust the unit of rate(100kbps/unit) */ -+ tx_time = (device_constant + 10 * test_frame_len / rate); -+ estimated_retx = ((1 << (2 * RTW_ARITH_SHIFT)) / (s_unit - err)); -+ result = (tx_time * estimated_retx) >> (2 * RTW_ARITH_SHIFT); -+ /* Convert us to 0.01 TU(10.24us). x/10.24 = x*100/1024 */ -+ result = (result * 100) >> 10; -+ -+ return (u32)result; -+} -+ -+void rtw_ieee80211s_update_metric(_adapter *adapter, u8 mac_id, -+ u8 per, u8 rate, -+ u8 bw, u8 total_pkt) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct sta_info *sta; -+ u8 rate_idx; -+ u8 sgi; -+ -+ sta = macid_ctl->sta[mac_id]; -+ if (!sta) -+ return; -+ -+ /* if RA, use reported rate */ -+ if (adapter->fix_rate == 0xff) { -+ rate_idx = rate & 0x7f; -+ sgi = rate >> 7; -+ } else { -+ rate_idx = adapter->fix_rate & 0x7f; -+ sgi = adapter->fix_rate >> 7; -+ } -+ sta->metrics.data_rate = rtw_desc_rate_to_bitrate(bw, rate_idx, sgi); -+ -+ if (total_pkt < RTW_TOTAL_PKT_MIN_THRESHOLD) -+ return; -+ -+ /* TBD: sta->metrics.overhead = phydm_get_plcp(void *dm_void, u16 macid); */ -+ sta->metrics.total_pkt = total_pkt; -+ -+ rtw_ewma_err_rate_add(&sta->metrics.err_rate, per); -+ if (rtw_ewma_err_rate_read(&sta->metrics.err_rate) > -+ RTW_LINK_FAIL_THRESH) -+ rtw_mesh_plink_broken(sta); -+} -+ -+static void rtw_hwmp_preq_frame_process(_adapter *adapter, -+ struct rtw_ieee80211_hdr_3addr *mgmt, -+ const u8 *preq_elem, u32 originator_metric) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_path *path = NULL; -+ const u8 *target_addr, *originator_addr; -+ const u8 *da; -+ u8 target_flags, ttl, flags, to_gate_ask = 0; -+ u32 originator_sn, target_sn, lifetime, target_metric = 0; -+ BOOLEAN reply = _FALSE; -+ BOOLEAN forward = _TRUE; -+ BOOLEAN preq_is_gate; -+ -+ /* Update target SN, if present */ -+ target_addr = RTW_PREQ_IE_TARGET_ADDR(preq_elem); -+ originator_addr = RTW_PREQ_IE_ORIG_ADDR(preq_elem); -+ target_sn = RTW_PREQ_IE_TARGET_SN(preq_elem); -+ originator_sn = RTW_PREQ_IE_ORIG_SN(preq_elem); -+ target_flags = RTW_PREQ_IE_TARGET_F(preq_elem); -+ /* PREQ gate announcements */ -+ flags = RTW_PREQ_IE_FLAGS(preq_elem); -+ preq_is_gate = !!(flags & RTW_IEEE80211_PREQ_IS_GATE_FLAG); -+ -+ RTW_HWMP_DBG("received PREQ from "MAC_FMT"\n", MAC_ARG(originator_addr)); -+ -+ if (rtw_ether_addr_equal(target_addr, adapter_mac_addr(adapter))) { -+ RTW_HWMP_DBG("PREQ is for us\n"); -+#ifdef CONFIG_RTW_MESH_ON_DMD_GANN -+ rtw_rcu_read_lock(); -+ path = rtw_mesh_path_lookup(adapter, originator_addr); -+ if (path) { -+ if (preq_is_gate) -+ rtw_mesh_path_add_gate(path); -+ else if (path->is_gate) { -+ enter_critical_bh(&path->state_lock); -+ rtw_mesh_gate_del(adapter->mesh_info.mesh_paths, path); -+ exit_critical_bh(&path->state_lock); -+ } -+ } -+ path = NULL; -+ rtw_rcu_read_unlock(); -+#endif -+ forward = _FALSE; -+ reply = _TRUE; -+ to_gate_ask = 1; -+ target_metric = 0; -+ if (rtw_time_after(rtw_get_current_time(), minfo->last_sn_update + -+ rtw_net_traversal_jiffies(adapter)) || -+ rtw_time_before(rtw_get_current_time(), minfo->last_sn_update)) { -+ ++minfo->sn; -+ minfo->last_sn_update = rtw_get_current_time(); -+ } -+ target_sn = minfo->sn; -+ } else if (is_broadcast_mac_addr(target_addr) && -+ (target_flags & RTW_IEEE80211_PREQ_TO_FLAG)) { -+ rtw_rcu_read_lock(); -+ path = rtw_mesh_path_lookup(adapter, originator_addr); -+ if (path) { -+ if (flags & RTW_IEEE80211_PREQ_PROACTIVE_PREP_FLAG) { -+ reply = _TRUE; -+ target_addr = adapter_mac_addr(adapter); -+ target_sn = ++minfo->sn; -+ target_metric = 0; -+ minfo->last_sn_update = rtw_get_current_time(); -+ } -+ -+ if (preq_is_gate) { -+ lifetime = RTW_PREQ_IE_LIFETIME(preq_elem); -+ path->gate_ann_int = lifetime; -+ path->gate_asked = false; -+ rtw_mesh_path_add_gate(path); -+ } else if (path->is_gate) { -+ enter_critical_bh(&path->state_lock); -+ rtw_mesh_gate_del(adapter->mesh_info.mesh_paths, path); -+ exit_critical_bh(&path->state_lock); -+ } -+ } -+ rtw_rcu_read_unlock(); -+ } else { -+ rtw_rcu_read_lock(); -+#ifdef CONFIG_RTW_MESH_ON_DMD_GANN -+ path = rtw_mesh_path_lookup(adapter, originator_addr); -+ if (path) { -+ if (preq_is_gate) -+ rtw_mesh_path_add_gate(path); -+ else if (path->is_gate) { -+ enter_critical_bh(&path->state_lock); -+ rtw_mesh_gate_del(adapter->mesh_info.mesh_paths, path); -+ exit_critical_bh(&path->state_lock); -+ } -+ } -+ path = NULL; -+#endif -+ path = rtw_mesh_path_lookup(adapter, target_addr); -+ if (path) { -+ if ((!(path->flags & RTW_MESH_PATH_SN_VALID)) || -+ RTW_SN_LT(path->sn, target_sn)) { -+ path->sn = target_sn; -+ path->flags |= RTW_MESH_PATH_SN_VALID; -+ } else if ((!(target_flags & RTW_IEEE80211_PREQ_TO_FLAG)) && -+ (path->flags & RTW_MESH_PATH_ACTIVE)) { -+ reply = _TRUE; -+ target_metric = path->metric; -+ target_sn = path->sn; -+ /* Case E2 of sec 13.10.9.3 IEEE 802.11-2012*/ -+ target_flags |= RTW_IEEE80211_PREQ_TO_FLAG; -+ } -+ } -+ rtw_rcu_read_unlock(); -+ } -+ -+ if (reply) { -+ lifetime = RTW_PREQ_IE_LIFETIME(preq_elem); -+ ttl = mshcfg->element_ttl; -+ if (ttl != 0 && !to_gate_ask) { -+ RTW_HWMP_DBG("replying to the PREQ\n"); -+ rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREP, 0, originator_addr, -+ originator_sn, 0, target_addr, -+ target_sn, mgmt->addr2, 0, ttl, -+ lifetime, target_metric, 0, -+ adapter); -+ } else if (ttl != 0 && to_gate_ask) { -+ RTW_HWMP_DBG("replying to the PREQ (PREQ for us)\n"); -+ if (mshcfg->dot11MeshGateAnnouncementProtocol) { -+ /* BIT 7 is used to identify the prep is from mesh gate */ -+ to_gate_ask = RTW_IEEE80211_PREQ_IS_GATE_FLAG | BIT(7); -+ } else { -+ to_gate_ask = 0; -+ } -+ -+ rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREP, to_gate_ask, originator_addr, -+ originator_sn, 0, target_addr, -+ target_sn, mgmt->addr2, 0, ttl, -+ lifetime, target_metric, 0, -+ adapter); -+ } else { -+ minfo->mshstats.dropped_frames_ttl++; -+ } -+ } -+ -+ if (forward && mshcfg->dot11MeshForwarding) { -+ u32 preq_id; -+ u8 hopcount; -+ -+ ttl = RTW_PREQ_IE_TTL(preq_elem); -+ lifetime = RTW_PREQ_IE_LIFETIME(preq_elem); -+ if (ttl <= 1) { -+ minfo->mshstats.dropped_frames_ttl++; -+ return; -+ } -+ RTW_HWMP_DBG("forwarding the PREQ from "MAC_FMT"\n", MAC_ARG(originator_addr)); -+ --ttl; -+ preq_id = RTW_PREQ_IE_PREQ_ID(preq_elem); -+ hopcount = RTW_PREQ_IE_HOPCOUNT(preq_elem) + 1; -+ da = (path && path->is_root) ? -+ path->rann_snd_addr : bcast_addr; -+ -+ if (flags & RTW_IEEE80211_PREQ_PROACTIVE_PREP_FLAG) { -+ target_addr = RTW_PREQ_IE_TARGET_ADDR(preq_elem); -+ target_sn = RTW_PREQ_IE_TARGET_SN(preq_elem); -+ } -+ -+ rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREQ, flags, originator_addr, -+ originator_sn, target_flags, target_addr, -+ target_sn, da, hopcount, ttl, lifetime, -+ originator_metric, preq_id, adapter); -+ if (!is_multicast_mac_addr(da)) -+ minfo->mshstats.fwded_unicast++; -+ else -+ minfo->mshstats.fwded_mcast++; -+ minfo->mshstats.fwded_frames++; -+ } -+} -+ -+static inline struct sta_info * -+rtw_next_hop_deref_protected(struct rtw_mesh_path *path) -+{ -+ return rtw_rcu_dereference_protected(path->next_hop, -+ rtw_lockdep_is_held(&path->state_lock)); -+} -+ -+static void rtw_hwmp_prep_frame_process(_adapter *adapter, -+ struct rtw_ieee80211_hdr_3addr *mgmt, -+ const u8 *prep_elem, u32 metric) -+{ -+ struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_stats *mshstats = &adapter->mesh_info.mshstats; -+ struct rtw_mesh_path *path; -+ const u8 *target_addr, *originator_addr; -+ u8 ttl, hopcount, flags; -+ u8 next_hop[ETH_ALEN]; -+ u32 target_sn, originator_sn, lifetime; -+ -+ RTW_HWMP_DBG("received PREP from "MAC_FMT"\n", -+ MAC_ARG(RTW_PREP_IE_TARGET_ADDR(prep_elem))); -+ -+ originator_addr = RTW_PREP_IE_ORIG_ADDR(prep_elem); -+ if (rtw_ether_addr_equal(originator_addr, adapter_mac_addr(adapter))) { -+ /* destination, no forwarding required */ -+ rtw_rcu_read_lock(); -+ target_addr = RTW_PREP_IE_TARGET_ADDR(prep_elem); -+ path = rtw_mesh_path_lookup(adapter, target_addr); -+ if (path && path->gate_asked) { -+ flags = RTW_PREP_IE_FLAGS(prep_elem); -+ if (flags & BIT(7)) { -+ enter_critical_bh(&path->state_lock); -+ path->gate_asked = false; -+ exit_critical_bh(&path->state_lock); -+ if (!(flags & RTW_IEEE80211_PREQ_IS_GATE_FLAG)) { -+ enter_critical_bh(&path->state_lock); -+ rtw_mesh_gate_del(adapter->mesh_info.mesh_paths, path); -+ exit_critical_bh(&path->state_lock); -+ } -+ } -+ } -+ -+ rtw_rcu_read_unlock(); -+ return; -+ } -+ -+ if (!mshcfg->dot11MeshForwarding) -+ return; -+ -+ ttl = RTW_PREP_IE_TTL(prep_elem); -+ if (ttl <= 1) { -+ mshstats->dropped_frames_ttl++; -+ return; -+ } -+ -+ rtw_rcu_read_lock(); -+ path = rtw_mesh_path_lookup(adapter, originator_addr); -+ if (path) -+ enter_critical_bh(&path->state_lock); -+ else -+ goto fail; -+ if (!(path->flags & RTW_MESH_PATH_ACTIVE)) { -+ exit_critical_bh(&path->state_lock); -+ goto fail; -+ } -+ _rtw_memcpy(next_hop, rtw_next_hop_deref_protected(path)->cmn.mac_addr, ETH_ALEN); -+ exit_critical_bh(&path->state_lock); -+ --ttl; -+ flags = RTW_PREP_IE_FLAGS(prep_elem); -+ lifetime = RTW_PREP_IE_LIFETIME(prep_elem); -+ hopcount = RTW_PREP_IE_HOPCOUNT(prep_elem) + 1; -+ target_addr = RTW_PREP_IE_TARGET_ADDR(prep_elem); -+ target_sn = RTW_PREP_IE_TARGET_SN(prep_elem); -+ originator_sn = RTW_PREP_IE_ORIG_SN(prep_elem); -+ -+ rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREP, flags, originator_addr, originator_sn, 0, -+ target_addr, target_sn, next_hop, hopcount, -+ ttl, lifetime, metric, 0, adapter); -+ rtw_rcu_read_unlock(); -+ -+ mshstats->fwded_unicast++; -+ mshstats->fwded_frames++; -+ return; -+ -+fail: -+ rtw_rcu_read_unlock(); -+ mshstats->dropped_frames_no_route++; -+} -+ -+static void rtw_hwmp_perr_frame_process(_adapter *adapter, -+ struct rtw_ieee80211_hdr_3addr *mgmt, -+ const u8 *perr_elem) -+{ -+ struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_stats *mshstats = &adapter->mesh_info.mshstats; -+ struct rtw_mesh_path *path; -+ u8 ttl; -+ const u8 *ta, *target_addr; -+ u32 target_sn; -+ u16 perr_reason_code; -+ -+ ta = mgmt->addr2; -+ ttl = RTW_PERR_IE_TTL(perr_elem); -+ if (ttl <= 1) { -+ mshstats->dropped_frames_ttl++; -+ return; -+ } -+ ttl--; -+ target_addr = RTW_PERR_IE_TARGET_ADDR(perr_elem); -+ target_sn = RTW_PERR_IE_TARGET_SN(perr_elem); -+ perr_reason_code = RTW_PERR_IE_TARGET_RCODE(perr_elem); -+ -+ RTW_HWMP_DBG("received PERR toward target "MAC_FMT"\n", MAC_ARG(target_addr)); -+ -+ rtw_rcu_read_lock(); -+ path = rtw_mesh_path_lookup(adapter, target_addr); -+ if (path) { -+ struct sta_info *sta; -+ -+ enter_critical_bh(&path->state_lock); -+ sta = rtw_next_hop_deref_protected(path); -+ if (path->flags & RTW_MESH_PATH_ACTIVE && -+ rtw_ether_addr_equal(ta, sta->cmn.mac_addr) && -+ !(path->flags & RTW_MESH_PATH_FIXED) && -+ (!(path->flags & RTW_MESH_PATH_SN_VALID) || -+ RTW_SN_GT(target_sn, path->sn) || target_sn == 0)) { -+ path->flags &= ~RTW_MESH_PATH_ACTIVE; -+ if (target_sn != 0) -+ path->sn = target_sn; -+ else -+ path->sn += 1; -+ exit_critical_bh(&path->state_lock); -+ if (!mshcfg->dot11MeshForwarding) -+ goto endperr; -+ rtw_mesh_path_error_tx(adapter, ttl, target_addr, -+ target_sn, perr_reason_code, -+ bcast_addr); -+ } else -+ exit_critical_bh(&path->state_lock); -+ } -+endperr: -+ rtw_rcu_read_unlock(); -+} -+ -+static void rtw_hwmp_rann_frame_process(_adapter *adapter, -+ struct rtw_ieee80211_hdr_3addr *mgmt, -+ const struct rtw_ieee80211_rann_ie *rann) -+{ -+ struct sta_info *sta; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_stats *mshstats = &adapter->mesh_info.mshstats; -+ struct rtw_mesh_path *path; -+ u8 ttl, flags, hopcount; -+ const u8 *originator_addr; -+ u32 originator_sn, metric, metric_txsta, interval; -+ BOOLEAN root_is_gate; -+ -+ ttl = rann->rann_ttl; -+ flags = rann->rann_flags; -+ root_is_gate = !!(flags & RTW_RANN_FLAG_IS_GATE); -+ originator_addr = rann->rann_addr; -+ originator_sn = le32_to_cpu(rann->rann_seq); -+ interval = le32_to_cpu(rann->rann_interval); -+ hopcount = rann->rann_hopcount; -+ hopcount++; -+ metric = le32_to_cpu(rann->rann_metric); -+ -+ /* Ignore our own RANNs */ -+ if (rtw_ether_addr_equal(originator_addr, adapter_mac_addr(adapter))) -+ return; -+ -+ RTW_HWMP_DBG("received RANN from "MAC_FMT" via neighbour "MAC_FMT" (is_gate=%d)\n", -+ MAC_ARG(originator_addr), MAC_ARG(mgmt->addr2), root_is_gate); -+ -+ rtw_rcu_read_lock(); -+ sta = rtw_get_stainfo(pstapriv, mgmt->addr2); -+ if (!sta) { -+ rtw_rcu_read_unlock(); -+ return; -+ } -+ -+ metric_txsta = rtw_airtime_link_metric_get(adapter, sta); -+ -+ path = rtw_mesh_path_lookup(adapter, originator_addr); -+ if (!path) { -+ path = rtw_mesh_path_add(adapter, originator_addr); -+ if (IS_ERR(path)) { -+ rtw_rcu_read_unlock(); -+ mshstats->dropped_frames_no_route++; -+ return; -+ } -+ } -+ -+ if (!(RTW_SN_LT(path->sn, originator_sn)) && -+ !(path->sn == originator_sn && metric < path->rann_metric)) { -+ rtw_rcu_read_unlock(); -+ return; -+ } -+ -+ if ((!(path->flags & (RTW_MESH_PATH_ACTIVE | RTW_MESH_PATH_RESOLVING)) || -+ (rtw_time_after(rtw_get_current_time(), path->last_preq_to_root + -+ rtw_root_path_confirmation_jiffies(adapter)) || -+ rtw_time_before(rtw_get_current_time(), path->last_preq_to_root))) && -+ !(path->flags & RTW_MESH_PATH_FIXED) && (ttl != 0)) { -+ u8 preq_node_flag = RTW_PREQ_Q_F_START | RTW_PREQ_Q_F_REFRESH; -+ -+ RTW_HWMP_DBG("time to refresh root path "MAC_FMT"\n", -+ MAC_ARG(originator_addr)); -+#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK -+ if (RTW_SN_LT(path->sn, originator_sn) && -+ (path->rann_metric + mshcfg->sane_metric_delta < metric) && -+ _rtw_memcmp(bcast_addr, path->rann_snd_addr, ETH_ALEN) == _FALSE) { -+ RTW_HWMP_DBG("Trigger additional check for root " -+ "confirm PREQ. rann_snd_addr = "MAC_FMT -+ "add_chk_rann_snd_addr= "MAC_FMT"\n", -+ MAC_ARG(mgmt->addr2), -+ MAC_ARG(path->rann_snd_addr)); -+ _rtw_memcpy(path->add_chk_rann_snd_addr, -+ path->rann_snd_addr, ETH_ALEN); -+ preq_node_flag |= RTW_PREQ_Q_F_CHK; -+ -+ } -+#endif -+ rtw_mesh_queue_preq(path, preq_node_flag); -+ path->last_preq_to_root = rtw_get_current_time(); -+ } -+ -+ path->sn = originator_sn; -+ path->rann_metric = metric + metric_txsta; -+ path->is_root = _TRUE; -+ /* Recording RANNs sender address to send individually -+ * addressed PREQs destined for root mesh STA */ -+ _rtw_memcpy(path->rann_snd_addr, mgmt->addr2, ETH_ALEN); -+ -+ if (root_is_gate) { -+ path->gate_ann_int = interval; -+ path->gate_asked = false; -+ rtw_mesh_path_add_gate(path); -+ } else if (path->is_gate) { -+ enter_critical_bh(&path->state_lock); -+ rtw_mesh_gate_del(adapter->mesh_info.mesh_paths, path); -+ exit_critical_bh(&path->state_lock); -+ } -+ -+ if (ttl <= 1) { -+ mshstats->dropped_frames_ttl++; -+ rtw_rcu_read_unlock(); -+ return; -+ } -+ ttl--; -+ -+ if (mshcfg->dot11MeshForwarding) { -+ rtw_mesh_path_sel_frame_tx(RTW_MPATH_RANN, flags, originator_addr, -+ originator_sn, 0, NULL, 0, bcast_addr, -+ hopcount, ttl, interval, -+ metric + metric_txsta, 0, adapter); -+ } -+ -+ rtw_rcu_read_unlock(); -+} -+ -+static u32 rtw_hwmp_route_info_get(_adapter *adapter, -+ struct rtw_ieee80211_hdr_3addr *mgmt, -+ const u8 *hwmp_ie, enum rtw_mpath_frame_type action) -+{ -+ struct rtw_mesh_path *path; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *sta; -+ BOOLEAN fresh_info; -+ const u8 *originator_addr, *ta; -+ u32 originator_sn, originator_metric; -+ unsigned long originator_lifetime, exp_time; -+ u32 last_hop_metric, new_metric; -+ BOOLEAN process = _TRUE; -+ -+ rtw_rcu_read_lock(); -+ sta = rtw_get_stainfo(pstapriv, mgmt->addr2); -+ if (!sta) { -+ rtw_rcu_read_unlock(); -+ return 0; -+ } -+ -+ last_hop_metric = rtw_airtime_link_metric_get(adapter, sta); -+ /* Update and check originator routing info */ -+ fresh_info = _TRUE; -+ -+ switch (action) { -+ case RTW_MPATH_PREQ: -+ originator_addr = RTW_PREQ_IE_ORIG_ADDR(hwmp_ie); -+ originator_sn = RTW_PREQ_IE_ORIG_SN(hwmp_ie); -+ originator_lifetime = RTW_PREQ_IE_LIFETIME(hwmp_ie); -+ originator_metric = RTW_PREQ_IE_METRIC(hwmp_ie); -+ break; -+ case RTW_MPATH_PREP: -+ /* Note: For coding, the naming is not consist with spec */ -+ originator_addr = RTW_PREP_IE_TARGET_ADDR(hwmp_ie); -+ originator_sn = RTW_PREP_IE_TARGET_SN(hwmp_ie); -+ originator_lifetime = RTW_PREP_IE_LIFETIME(hwmp_ie); -+ originator_metric = RTW_PREP_IE_METRIC(hwmp_ie); -+ break; -+ default: -+ rtw_rcu_read_unlock(); -+ return 0; -+ } -+ new_metric = originator_metric + last_hop_metric; -+ if (new_metric < originator_metric) -+ new_metric = RTW_MAX_METRIC; -+ exp_time = RTW_TU_TO_EXP_TIME(originator_lifetime); -+ -+ if (rtw_ether_addr_equal(originator_addr, adapter_mac_addr(adapter))) { -+ process = _FALSE; -+ fresh_info = _FALSE; -+ } else { -+ path = rtw_mesh_path_lookup(adapter, originator_addr); -+ if (path) { -+ enter_critical_bh(&path->state_lock); -+ if (path->flags & RTW_MESH_PATH_FIXED) -+ fresh_info = _FALSE; -+ else if ((path->flags & RTW_MESH_PATH_ACTIVE) && -+ (path->flags & RTW_MESH_PATH_SN_VALID)) { -+ if (RTW_SN_GT(path->sn, originator_sn) || -+ (path->sn == originator_sn && -+ new_metric >= path->metric)) { -+ process = _FALSE; -+ fresh_info = _FALSE; -+ } -+ } else if (!(path->flags & RTW_MESH_PATH_ACTIVE)) { -+ BOOLEAN have_sn, newer_sn, bounced; -+ -+ have_sn = path->flags & RTW_MESH_PATH_SN_VALID; -+ newer_sn = have_sn && RTW_SN_GT(originator_sn, path->sn); -+ bounced = have_sn && -+ (RTW_SN_DELTA(originator_sn, path->sn) > -+ RTW_MAX_SANE_SN_DELTA); -+ -+ if (!have_sn || newer_sn) { -+ } else if (bounced) { -+ } else { -+ process = _FALSE; -+ fresh_info = _FALSE; -+ } -+ } -+ } else { -+ path = rtw_mesh_path_add(adapter, originator_addr); -+ if (IS_ERR(path)) { -+ rtw_rcu_read_unlock(); -+ return 0; -+ } -+ enter_critical_bh(&path->state_lock); -+ } -+ -+ if (fresh_info) { -+ rtw_mesh_path_assign_nexthop(path, sta); -+ path->flags |= RTW_MESH_PATH_SN_VALID; -+ path->metric = new_metric; -+ path->sn = originator_sn; -+ path->exp_time = rtw_time_after(path->exp_time, exp_time) -+ ? path->exp_time : exp_time; -+ rtw_mesh_path_activate(path); -+#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK -+ if (path->is_root && (action == RTW_MPATH_PREP)) { -+ _rtw_memcpy(path->rann_snd_addr, -+ mgmt->addr2, ETH_ALEN); -+ path->rann_metric = new_metric; -+ } -+#endif -+ exit_critical_bh(&path->state_lock); -+ rtw_mesh_path_tx_pending(path); -+ } else -+ exit_critical_bh(&path->state_lock); -+ } -+ -+ /* Update and check transmitter routing info */ -+ ta = mgmt->addr2; -+ if (rtw_ether_addr_equal(originator_addr, ta)) -+ fresh_info = _FALSE; -+ else { -+ fresh_info = _TRUE; -+ -+ path = rtw_mesh_path_lookup(adapter, ta); -+ if (path) { -+ enter_critical_bh(&path->state_lock); -+ if ((path->flags & RTW_MESH_PATH_FIXED) || -+ ((path->flags & RTW_MESH_PATH_ACTIVE) && -+ (last_hop_metric > path->metric))) -+ fresh_info = _FALSE; -+ } else { -+ path = rtw_mesh_path_add(adapter, ta); -+ if (IS_ERR(path)) { -+ rtw_rcu_read_unlock(); -+ return 0; -+ } -+ enter_critical_bh(&path->state_lock); -+ } -+ -+ if (fresh_info) { -+ rtw_mesh_path_assign_nexthop(path, sta); -+ path->metric = last_hop_metric; -+ path->exp_time = rtw_time_after(path->exp_time, exp_time) -+ ? path->exp_time : exp_time; -+ rtw_mesh_path_activate(path); -+ exit_critical_bh(&path->state_lock); -+ rtw_mesh_path_tx_pending(path); -+ } else -+ exit_critical_bh(&path->state_lock); -+ } -+ -+ rtw_rcu_read_unlock(); -+ -+ return process ? new_metric : 0; -+} -+ -+static void rtw_mesh_rx_hwmp_frame_cnts(_adapter *adapter, u8 *addr) -+{ -+ struct sta_info *sta; -+ -+ sta = rtw_get_stainfo(&adapter->stapriv, addr); -+ if (sta) -+ sta->sta_stats.rx_hwmp_pkts++; -+} -+ -+void rtw_mesh_rx_path_sel_frame(_adapter *adapter, union recv_frame *rframe) -+{ -+ struct mesh_plink_ent *plink = NULL; -+ struct rtw_ieee802_11_elems elems; -+ u32 path_metric; -+ struct rx_pkt_attrib *attrib = &rframe->u.hdr.attrib; -+ u8 *pframe = rframe->u.hdr.rx_data, *start; -+ uint frame_len = rframe->u.hdr.len, left; -+ struct rtw_ieee80211_hdr_3addr *frame_hdr = (struct rtw_ieee80211_hdr_3addr *)pframe; -+ u8 *frame_body = (u8 *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ ParseRes parse_res; -+ -+ plink = rtw_mesh_plink_get(adapter, get_addr2_ptr(pframe)); -+ if (!plink || plink->plink_state != RTW_MESH_PLINK_ESTAB) -+ return; -+ -+ rtw_mesh_rx_hwmp_frame_cnts(adapter, get_addr2_ptr(pframe)); -+ -+ /* Mesh action frame IE offset = 2 */ -+ attrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ left = frame_len - attrib->hdrlen - attrib->iv_len - attrib->icv_len - 2; -+ start = pframe + attrib->hdrlen + 2; -+ -+ parse_res = rtw_ieee802_11_parse_elems(start, left, &elems, 1); -+ if (parse_res == ParseFailed) -+ RTW_HWMP_INFO(FUNC_ADPT_FMT" Path Select Frame ParseFailed\n" -+ , FUNC_ADPT_ARG(adapter)); -+ else if (parse_res == ParseUnknown) -+ RTW_HWMP_INFO(FUNC_ADPT_FMT" Path Select Frame ParseUnknown\n" -+ , FUNC_ADPT_ARG(adapter)); -+ -+ if (elems.preq) { -+ if (elems.preq_len != 37) -+ /* Right now we support just 1 destination and no AE */ -+ return; -+ path_metric = rtw_hwmp_route_info_get(adapter, frame_hdr, elems.preq, -+ MPATH_PREQ); -+ if (path_metric) -+ rtw_hwmp_preq_frame_process(adapter, frame_hdr, elems.preq, -+ path_metric); -+ } -+ if (elems.prep) { -+ if (elems.prep_len != 31) -+ /* Right now we support no AE */ -+ return; -+ path_metric = rtw_hwmp_route_info_get(adapter, frame_hdr, elems.prep, -+ MPATH_PREP); -+ if (path_metric) -+ rtw_hwmp_prep_frame_process(adapter, frame_hdr, elems.prep, -+ path_metric); -+ } -+ if (elems.perr) { -+ if (elems.perr_len != 15) -+ /* Right now we support only one destination per PERR */ -+ return; -+ rtw_hwmp_perr_frame_process(adapter, frame_hdr, elems.perr); -+ } -+ if (elems.rann) -+ rtw_hwmp_rann_frame_process(adapter, frame_hdr, (struct rtw_ieee80211_rann_ie *)elems.rann); -+} -+ -+void rtw_mesh_queue_preq(struct rtw_mesh_path *path, u8 flags) -+{ -+ _adapter *adapter = path->adapter; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct rtw_mesh_preq_queue *preq_node; -+ -+ preq_node = rtw_malloc(sizeof(struct rtw_mesh_preq_queue)); -+ if (!preq_node) { -+ RTW_HWMP_INFO("could not allocate PREQ node\n"); -+ return; -+ } -+ -+ enter_critical_bh(&minfo->mesh_preq_queue_lock); -+ if (minfo->preq_queue_len == RTW_MAX_PREQ_QUEUE_LEN) { -+ exit_critical_bh(&minfo->mesh_preq_queue_lock); -+ rtw_mfree(preq_node, sizeof(struct rtw_mesh_preq_queue)); -+ if (rtw_print_ratelimit()) -+ RTW_HWMP_INFO("PREQ node queue full\n"); -+ return; -+ } -+ -+ _rtw_spinlock(&path->state_lock); -+ if (path->flags & RTW_MESH_PATH_REQ_QUEUED) { -+ _rtw_spinunlock(&path->state_lock); -+ exit_critical_bh(&minfo->mesh_preq_queue_lock); -+ rtw_mfree(preq_node, sizeof(struct rtw_mesh_preq_queue)); -+ return; -+ } -+ -+ _rtw_memcpy(preq_node->dst, path->dst, ETH_ALEN); -+ preq_node->flags = flags; -+ -+ path->flags |= RTW_MESH_PATH_REQ_QUEUED; -+#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK -+ if (flags & RTW_PREQ_Q_F_CHK) -+ path->flags |= RTW_MESH_PATH_ROOT_ADD_CHK; -+#endif -+ if (flags & RTW_PREQ_Q_F_PEER_AKA) -+ path->flags |= RTW_MESH_PATH_PEER_AKA; -+ if (flags & RTW_PREQ_Q_F_BCAST_PREQ) -+ path->flags |= RTW_MESH_PATH_BCAST_PREQ; -+ _rtw_spinunlock(&path->state_lock); -+ -+ rtw_list_insert_tail(&preq_node->list, &minfo->preq_queue.list); -+ ++minfo->preq_queue_len; -+ exit_critical_bh(&minfo->mesh_preq_queue_lock); -+ -+ if (rtw_time_after(rtw_get_current_time(), minfo->last_preq + rtw_min_preq_int_jiff(adapter))) -+ rtw_mesh_work(&adapter->mesh_work); -+ -+ else if (rtw_time_before(rtw_get_current_time(), minfo->last_preq)) { -+ /* systime wrapped around issue */ -+ minfo->last_preq = rtw_get_current_time() - rtw_min_preq_int_jiff(adapter) - 1; -+ rtw_mesh_work(&adapter->mesh_work); -+ } else -+ rtw_mod_timer(&adapter->mesh_path_timer, minfo->last_preq + -+ rtw_min_preq_int_jiff(adapter) + 1); -+} -+ -+static const u8 *rtw_hwmp_preq_da(struct rtw_mesh_path *path, -+ BOOLEAN is_root_add_chk, BOOLEAN da_is_peer, -+ BOOLEAN force_preq_bcast) -+{ -+ const u8 *da; -+ -+ if (da_is_peer) -+ da = path->dst; -+ else if (force_preq_bcast) -+ da = bcast_addr; -+ else if (path->is_root) -+#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK -+ da = is_root_add_chk ? path->add_chk_rann_snd_addr: -+ path->rann_snd_addr; -+#else -+ da = path->rann_snd_addr; -+#endif -+ else -+ da = bcast_addr; -+ -+ return da; -+} -+ -+void rtw_mesh_path_start_discovery(_adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_preq_queue *preq_node; -+ struct rtw_mesh_path *path; -+ u8 ttl, target_flags = 0; -+ const u8 *da; -+ u32 lifetime; -+ u8 flags = 0; -+ BOOLEAN is_root_add_chk = _FALSE; -+ BOOLEAN da_is_peer, force_preq_bcast; -+ -+ enter_critical_bh(&minfo->mesh_preq_queue_lock); -+ if (!minfo->preq_queue_len || -+ rtw_time_before(rtw_get_current_time(), minfo->last_preq + -+ rtw_min_preq_int_jiff(adapter))) { -+ exit_critical_bh(&minfo->mesh_preq_queue_lock); -+ return; -+ } -+ -+ preq_node = rtw_list_first_entry(&minfo->preq_queue.list, -+ struct rtw_mesh_preq_queue, list); -+ rtw_list_delete(&preq_node->list); /* list_del_init(&preq_node->list); */ -+ --minfo->preq_queue_len; -+ exit_critical_bh(&minfo->mesh_preq_queue_lock); -+ -+ rtw_rcu_read_lock(); -+ path = rtw_mesh_path_lookup(adapter, preq_node->dst); -+ if (!path) -+ goto enddiscovery; -+ -+ enter_critical_bh(&path->state_lock); -+ if (path->flags & (RTW_MESH_PATH_DELETED | RTW_MESH_PATH_FIXED)) { -+ exit_critical_bh(&path->state_lock); -+ goto enddiscovery; -+ } -+ path->flags &= ~RTW_MESH_PATH_REQ_QUEUED; -+ if (preq_node->flags & RTW_PREQ_Q_F_START) { -+ if (path->flags & RTW_MESH_PATH_RESOLVING) { -+ exit_critical_bh(&path->state_lock); -+ goto enddiscovery; -+ } else { -+ path->flags &= ~RTW_MESH_PATH_RESOLVED; -+ path->flags |= RTW_MESH_PATH_RESOLVING; -+ path->discovery_retries = 0; -+ path->discovery_timeout = rtw_disc_timeout_jiff(adapter); -+ } -+ } else if (!(path->flags & RTW_MESH_PATH_RESOLVING) || -+ path->flags & RTW_MESH_PATH_RESOLVED) { -+ path->flags &= ~RTW_MESH_PATH_RESOLVING; -+ exit_critical_bh(&path->state_lock); -+ goto enddiscovery; -+ } -+ -+ minfo->last_preq = rtw_get_current_time(); -+ -+ if (rtw_time_after(rtw_get_current_time(), minfo->last_sn_update + -+ rtw_net_traversal_jiffies(adapter)) || -+ rtw_time_before(rtw_get_current_time(), minfo->last_sn_update)) { -+ ++minfo->sn; -+ minfo->last_sn_update = rtw_get_current_time(); -+ } -+ lifetime = rtw_default_lifetime(adapter); -+ ttl = mshcfg->element_ttl; -+ if (ttl == 0) { -+ minfo->mshstats.dropped_frames_ttl++; -+ exit_critical_bh(&path->state_lock); -+ goto enddiscovery; -+ } -+ -+ if (preq_node->flags & RTW_PREQ_Q_F_REFRESH) -+ target_flags |= RTW_IEEE80211_PREQ_TO_FLAG; -+ else -+ target_flags &= ~RTW_IEEE80211_PREQ_TO_FLAG; -+ -+#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK -+ is_root_add_chk = !!(path->flags & RTW_MESH_PATH_ROOT_ADD_CHK); -+#endif -+ da_is_peer = !!(path->flags & RTW_MESH_PATH_PEER_AKA); -+ force_preq_bcast = !!(path->flags & RTW_MESH_PATH_BCAST_PREQ); -+ exit_critical_bh(&path->state_lock); -+ -+ da = rtw_hwmp_preq_da(path, is_root_add_chk, -+ da_is_peer, force_preq_bcast); -+ -+#ifdef CONFIG_RTW_MESH_ON_DMD_GANN -+ flags = (mshcfg->dot11MeshGateAnnouncementProtocol) -+ ? RTW_IEEE80211_PREQ_IS_GATE_FLAG : 0; -+#endif -+ rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREQ, flags, adapter_mac_addr(adapter), minfo->sn, -+ target_flags, path->dst, path->sn, da, 0, -+ ttl, lifetime, 0, minfo->preq_id++, adapter); -+ rtw_mod_timer(&path->timer, rtw_get_current_time() + path->discovery_timeout); -+ -+enddiscovery: -+ rtw_rcu_read_unlock(); -+ rtw_mfree(preq_node, sizeof(struct rtw_mesh_preq_queue)); -+} -+ -+void rtw_mesh_path_timer(void *ctx) -+{ -+ struct rtw_mesh_path *path = (void *) ctx; -+ _adapter *adapter = path->adapter; -+ int ret; -+ u8 retry = 0; -+#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK -+ struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; -+#endif -+ /* TBD: Proctect for suspend */ -+#if 0 -+ if (suspending) -+ return; -+#endif -+ enter_critical_bh(&path->state_lock); -+ if (path->flags & RTW_MESH_PATH_RESOLVED || -+ (!(path->flags & RTW_MESH_PATH_RESOLVING))) { -+ path->flags &= ~(RTW_MESH_PATH_RESOLVING | -+ RTW_MESH_PATH_RESOLVED | -+ RTW_MESH_PATH_ROOT_ADD_CHK | -+ RTW_MESH_PATH_PEER_AKA | -+ RTW_MESH_PATH_BCAST_PREQ); -+ exit_critical_bh(&path->state_lock); -+ } else if (path->discovery_retries < rtw_max_preq_retries(adapter)) { -+ ++path->discovery_retries; -+ path->discovery_timeout *= 2; -+ path->flags &= ~RTW_MESH_PATH_REQ_QUEUED; -+#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK -+ if (path->discovery_retries > mshcfg->max_root_add_chk_cnt) -+ path->flags &= ~RTW_MESH_PATH_ROOT_ADD_CHK; -+#endif -+ if (path->gate_asked) -+ retry |= RTW_PREQ_Q_F_REFRESH; -+ -+ exit_critical_bh(&path->state_lock); -+ rtw_mesh_queue_preq(path, retry); -+ } else { -+ path->flags &= ~(RTW_MESH_PATH_RESOLVING | -+ RTW_MESH_PATH_RESOLVED | -+ RTW_MESH_PATH_REQ_QUEUED | -+ RTW_MESH_PATH_ROOT_ADD_CHK | -+ RTW_MESH_PATH_PEER_AKA | -+ RTW_MESH_PATH_BCAST_PREQ); -+ path->exp_time = rtw_get_current_time(); -+ exit_critical_bh(&path->state_lock); -+ if (!path->is_gate && rtw_mesh_gate_num(adapter) > 0) { -+ ret = rtw_mesh_path_send_to_gates(path); -+ if (ret) -+ RTW_HWMP_DBG("no gate was reachable\n"); -+ } else -+ rtw_mesh_path_flush_pending(path); -+ } -+} -+ -+ -+void rtw_mesh_path_tx_root_frame(_adapter *adapter) -+{ -+ struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ u32 interval = mshcfg->dot11MeshHWMPRannInterval; -+ u8 flags, target_flags = 0; -+ -+ flags = (mshcfg->dot11MeshGateAnnouncementProtocol) -+ ? RTW_RANN_FLAG_IS_GATE : 0; -+ -+ switch (mshcfg->dot11MeshHWMPRootMode) { -+ case RTW_IEEE80211_PROACTIVE_RANN: -+ rtw_mesh_path_sel_frame_tx(RTW_MPATH_RANN, flags, adapter_mac_addr(adapter), -+ ++minfo->sn, 0, NULL, 0, bcast_addr, -+ 0, mshcfg->element_ttl, -+ interval, 0, 0, adapter); -+ break; -+ case RTW_IEEE80211_PROACTIVE_PREQ_WITH_PREP: -+ flags |= RTW_IEEE80211_PREQ_PROACTIVE_PREP_FLAG; -+ case RTW_IEEE80211_PROACTIVE_PREQ_NO_PREP: -+ interval = mshcfg->dot11MeshHWMPactivePathToRootTimeout; -+ target_flags |= RTW_IEEE80211_PREQ_TO_FLAG | -+ RTW_IEEE80211_PREQ_USN_FLAG; -+ rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREQ, flags, adapter_mac_addr(adapter), -+ ++minfo->sn, target_flags, -+ (u8 *) bcast_addr, 0, bcast_addr, -+ 0, mshcfg->element_ttl, interval, -+ 0, minfo->preq_id++, adapter); -+ break; -+ default: -+ RTW_HWMP_INFO("Proactive mechanism not supported\n"); -+ return; -+ } -+} -+ -+void rtw_mesh_work(_workitem *work) -+{ -+ /* use kernel global workqueue */ -+ _set_workitem(work); -+} -+ -+void rtw_ieee80211_mesh_path_timer(void *ctx) -+{ -+ _adapter *adapter = (_adapter *)ctx; -+ rtw_mesh_work(&adapter->mesh_work); -+} -+ -+void rtw_ieee80211_mesh_path_root_timer(void *ctx) -+{ -+ _adapter *adapter = (_adapter *)ctx; -+ -+ rtw_set_bit(RTW_MESH_WORK_ROOT, &adapter->wrkq_flags); -+ -+ rtw_mesh_work(&adapter->mesh_work); -+} -+ -+static void rtw_ieee80211_mesh_rootpath(_adapter *adapter) -+{ -+ u32 interval; -+ -+ rtw_mesh_path_tx_root_frame(adapter); -+ -+ if (adapter->mesh_cfg.dot11MeshHWMPRootMode == RTW_IEEE80211_PROACTIVE_RANN) -+ interval = adapter->mesh_cfg.dot11MeshHWMPRannInterval; -+ else -+ interval = adapter->mesh_cfg.dot11MeshHWMProotInterval; -+ -+ rtw_mod_timer(&adapter->mesh_path_root_timer, -+ RTW_TU_TO_EXP_TIME(interval)); -+} -+ -+BOOLEAN rtw_ieee80211_mesh_root_setup(_adapter *adapter) -+{ -+ BOOLEAN root_enabled = _FALSE; -+ -+ if (adapter->mesh_cfg.dot11MeshHWMPRootMode > RTW_IEEE80211_ROOTMODE_ROOT) { -+ rtw_set_bit(RTW_MESH_WORK_ROOT, &adapter->wrkq_flags); -+ root_enabled = _TRUE; -+ } -+ else { -+ rtw_clear_bit(RTW_MESH_WORK_ROOT, &adapter->wrkq_flags); -+ /* stop running timer */ -+ _cancel_timer_ex(&adapter->mesh_path_root_timer); -+ root_enabled = _FALSE; -+ } -+ -+ return root_enabled; -+} -+ -+void rtw_mesh_work_hdl(_workitem *work) -+{ -+ _adapter *adapter = container_of(work, _adapter, mesh_work); -+ -+ while(adapter->mesh_info.preq_queue_len) { -+ if (rtw_time_after(rtw_get_current_time(), -+ adapter->mesh_info.last_preq + rtw_min_preq_int_jiff(adapter))) -+ /* It will consume preq_queue_len */ -+ rtw_mesh_path_start_discovery(adapter); -+ else { -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ -+ rtw_mod_timer(&adapter->mesh_path_timer, -+ minfo->last_preq + rtw_min_preq_int_jiff(adapter) + 1); -+ break; -+ } -+ } -+ -+ if (rtw_test_and_clear_bit(RTW_MESH_WORK_ROOT, &adapter->wrkq_flags)) -+ rtw_ieee80211_mesh_rootpath(adapter); -+} -+ -+#ifndef RTW_PER_CMD_SUPPORT_FW -+static void rtw_update_metric_directly(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 i; -+ -+ for (i = 0; i < macid_ctl->num; i++) { -+ u8 role; -+ role = GET_H2CCMD_MSRRPT_PARM_ROLE(&macid_ctl->h2c_msr[i]); -+ if (role == H2C_MSR_ROLE_MESH) { -+ struct sta_info *sta = macid_ctl->sta[i]; -+ u8 rate_idx, sgi, bw; -+ u32 rate; -+ -+ if (!sta) -+ continue; -+ rate_idx = rtw_get_current_tx_rate(adapter, sta); -+ sgi = rtw_get_current_tx_sgi(adapter, sta); -+ bw = sta->cmn.bw_mode; -+ rate = rtw_desc_rate_to_bitrate(bw, rate_idx, sgi); -+ sta->metrics.data_rate = rate; -+ } -+ } -+} -+#endif -+ -+void rtw_mesh_atlm_param_req_timer(void *ctx) -+{ -+ _adapter *adapter = (_adapter *)ctx; -+ u8 ret = _FAIL; -+ -+#ifdef RTW_PER_CMD_SUPPORT_FW -+ ret = rtw_req_per_cmd(adapter); -+ if (ret == _FAIL) -+ RTW_HWMP_INFO("rtw_req_per_cmd fail\n"); -+#else -+ rtw_update_metric_directly(adapter); -+#endif -+ _set_timer(&adapter->mesh_atlm_param_req_timer, RTW_ATLM_REQ_CYCLE); -+} -+ -+#endif /* CONFIG_RTW_MESH */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_hwmp.h b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_hwmp.h -new file mode 100644 -index 000000000..943341781 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_hwmp.h -@@ -0,0 +1,60 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_MESH_HWMP_H_ -+#define __RTW_MESH_HWMP_H_ -+ -+#ifndef DBG_RTW_HWMP -+#define DBG_RTW_HWMP 0 -+#endif -+#if DBG_RTW_HWMP -+#define RTW_HWMP_DBG(fmt, arg...) RTW_PRINT(fmt, ##arg) -+#else -+#define RTW_HWMP_DBG(fmt, arg...) RTW_DBG(fmt, ##arg) -+#endif -+ -+#ifndef INFO_RTW_HWMP -+#define INFO_RTW_HWMP 0 -+#endif -+#if INFO_RTW_HWMP -+#define RTW_HWMP_INFO(fmt, arg...) RTW_PRINT(fmt, ##arg) -+#else -+#define RTW_HWMP_INFO(fmt, arg...) RTW_INFO(fmt, ##arg) -+#endif -+ -+ -+void rtw_ewma_err_rate_init(struct rtw_ewma_err_rate *e); -+unsigned long rtw_ewma_err_rate_read(struct rtw_ewma_err_rate *e); -+void rtw_ewma_err_rate_add(struct rtw_ewma_err_rate *e, unsigned long val); -+int rtw_mesh_path_error_tx(_adapter *adapter, -+ u8 ttl, const u8 *target, u32 target_sn, -+ u16 target_rcode, const u8 *ra); -+void rtw_ieee80211s_update_metric(_adapter *adapter, u8 mac_id, -+ u8 per, u8 rate, -+ u8 bw, u8 total_pkt); -+void rtw_mesh_rx_path_sel_frame(_adapter *adapter, union recv_frame *rframe); -+void rtw_mesh_queue_preq(struct rtw_mesh_path *mpath, u8 flags); -+void rtw_mesh_path_start_discovery(_adapter *adapter); -+void rtw_mesh_path_timer(void *ctx); -+void rtw_mesh_path_tx_root_frame(_adapter *adapter); -+void rtw_mesh_work_hdl(_workitem *work); -+void rtw_ieee80211_mesh_path_timer(void *ctx); -+void rtw_ieee80211_mesh_path_root_timer(void *ctx); -+BOOLEAN rtw_ieee80211_mesh_root_setup(_adapter *adapter); -+void rtw_mesh_work(_workitem *work); -+void rtw_mesh_atlm_param_req_timer(void *ctx); -+ -+#endif /* __RTW_MESH_HWMP_H_ */ -+ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_pathtbl.c b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_pathtbl.c -new file mode 100644 -index 000000000..b74b56792 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_pathtbl.c -@@ -0,0 +1,1242 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_MESH_PATHTBL_C_ -+ -+#ifdef CONFIG_RTW_MESH -+#include -+#include -+ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+static void rtw_mpath_free_rcu(struct rtw_mesh_path *mpath) -+{ -+ kfree_rcu(mpath, rcu); -+ rtw_mstat_update(MSTAT_TYPE_PHY, MSTAT_FREE, sizeof(struct rtw_mesh_path)); -+} -+#else -+static void rtw_mpath_free_rcu_callback(rtw_rcu_head *head) -+{ -+ struct rtw_mesh_path *mpath; -+ -+ mpath = container_of(head, struct rtw_mesh_path, rcu); -+ rtw_mfree(mpath, sizeof(struct rtw_mesh_path)); -+} -+ -+static void rtw_mpath_free_rcu(struct rtw_mesh_path *mpath) -+{ -+ call_rcu(&mpath->rcu, rtw_mpath_free_rcu_callback); -+} -+#endif -+#endif /* PLATFORM_LINUX */ -+ -+static void rtw_mesh_path_free_rcu(struct rtw_mesh_table *tbl, struct rtw_mesh_path *mpath); -+ -+static u32 rtw_mesh_table_hash(const void *addr, u32 len, u32 seed) -+{ -+ /* Use last four bytes of hw addr as hash index */ -+ return jhash_1word(*(u32 *)(addr+2), seed); -+} -+ -+static const rtw_rhashtable_params rtw_mesh_rht_params = { -+ .nelem_hint = 2, -+ .automatic_shrinking = true, -+ .key_len = ETH_ALEN, -+ .key_offset = offsetof(struct rtw_mesh_path, dst), -+ .head_offset = offsetof(struct rtw_mesh_path, rhash), -+ .hashfn = rtw_mesh_table_hash, -+}; -+ -+static inline bool rtw_mpath_expired(struct rtw_mesh_path *mpath) -+{ -+ return (mpath->flags & RTW_MESH_PATH_ACTIVE) && -+ rtw_time_after(rtw_get_current_time(), mpath->exp_time) && -+ !(mpath->flags & RTW_MESH_PATH_FIXED); -+} -+ -+static void rtw_mesh_path_rht_free(void *ptr, void *tblptr) -+{ -+ struct rtw_mesh_path *mpath = ptr; -+ struct rtw_mesh_table *tbl = tblptr; -+ -+ rtw_mesh_path_free_rcu(tbl, mpath); -+} -+ -+static struct rtw_mesh_table *rtw_mesh_table_alloc(void) -+{ -+ struct rtw_mesh_table *newtbl; -+ -+ newtbl = rtw_malloc(sizeof(struct rtw_mesh_table)); -+ if (!newtbl) -+ return NULL; -+ -+ rtw_hlist_head_init(&newtbl->known_gates); -+ ATOMIC_SET(&newtbl->entries, 0); -+ _rtw_spinlock_init(&newtbl->gates_lock); -+ -+ return newtbl; -+} -+ -+static void rtw_mesh_table_free(struct rtw_mesh_table *tbl) -+{ -+ rtw_rhashtable_free_and_destroy(&tbl->rhead, -+ rtw_mesh_path_rht_free, tbl); -+ rtw_mfree(tbl, sizeof(struct rtw_mesh_table)); -+} -+ -+/** -+ * -+ * rtw_mesh_path_assign_nexthop - update mesh path next hop -+ * -+ * @mpath: mesh path to update -+ * @sta: next hop to assign -+ * -+ * Locking: mpath->state_lock must be held when calling this function -+ */ -+void rtw_mesh_path_assign_nexthop(struct rtw_mesh_path *mpath, struct sta_info *sta) -+{ -+ struct xmit_frame *xframe; -+ _list *list, *head; -+ -+ rtw_rcu_assign_pointer(mpath->next_hop, sta); -+ -+ enter_critical_bh(&mpath->frame_queue.lock); -+ head = &mpath->frame_queue.queue; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ xframe = LIST_CONTAINOR(list, struct xmit_frame, list); -+ list = get_next(list); -+ _rtw_memcpy(xframe->attrib.ra, sta->cmn.mac_addr, ETH_ALEN); -+ } -+ -+ exit_critical_bh(&mpath->frame_queue.lock); -+} -+ -+static void rtw_prepare_for_gate(struct xmit_frame *xframe, char *dst_addr, -+ struct rtw_mesh_path *gate_mpath) -+{ -+ struct pkt_attrib *attrib = &xframe->attrib; -+ char *next_hop; -+ -+ if (attrib->mesh_frame_mode == MESH_UCAST_DATA) -+ attrib->mesh_frame_mode = MESH_UCAST_PX_DATA; -+ -+ /* update next hop */ -+ rtw_rcu_read_lock(); -+ next_hop = rtw_rcu_dereference(gate_mpath->next_hop)->cmn.mac_addr; -+ _rtw_memcpy(attrib->ra, next_hop, ETH_ALEN); -+ rtw_rcu_read_unlock(); -+ _rtw_memcpy(attrib->mda, dst_addr, ETH_ALEN); -+} -+ -+/** -+ * -+ * rtw_mesh_path_move_to_queue - Move or copy frames from one mpath queue to another -+ * -+ * This function is used to transfer or copy frames from an unresolved mpath to -+ * a gate mpath. The function also adds the Address Extension field and -+ * updates the next hop. -+ * -+ * If a frame already has an Address Extension field, only the next hop and -+ * destination addresses are updated. -+ * -+ * The gate mpath must be an active mpath with a valid mpath->next_hop. -+ * -+ * @mpath: An active mpath the frames will be sent to (i.e. the gate) -+ * @from_mpath: The failed mpath -+ * @copy: When true, copy all the frames to the new mpath queue. When false, -+ * move them. -+ */ -+static void rtw_mesh_path_move_to_queue(struct rtw_mesh_path *gate_mpath, -+ struct rtw_mesh_path *from_mpath, -+ bool copy) -+{ -+ struct xmit_frame *fskb; -+ _list *list, *head; -+ _list failq; -+ u32 failq_len; -+ _irqL flags; -+ -+ if (rtw_warn_on(gate_mpath == from_mpath)) -+ return; -+ if (rtw_warn_on(!gate_mpath->next_hop)) -+ return; -+ -+ _rtw_init_listhead(&failq); -+ -+ _enter_critical_bh(&from_mpath->frame_queue.lock, &flags); -+ rtw_list_splice_init(&from_mpath->frame_queue.queue, &failq); -+ failq_len = from_mpath->frame_queue_len; -+ from_mpath->frame_queue_len = 0; -+ _exit_critical_bh(&from_mpath->frame_queue.lock, &flags); -+ -+ head = &failq; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ if (gate_mpath->frame_queue_len >= RTW_MESH_FRAME_QUEUE_LEN) { -+ RTW_MPATH_DBG(FUNC_ADPT_FMT" mpath queue for gate %pM is full!\n" -+ , FUNC_ADPT_ARG(gate_mpath->adapter), gate_mpath->dst); -+ break; -+ } -+ -+ fskb = LIST_CONTAINOR(list, struct xmit_frame, list); -+ list = get_next(list); -+ -+ rtw_list_delete(&fskb->list); -+ failq_len--; -+ rtw_prepare_for_gate(fskb, gate_mpath->dst, gate_mpath); -+ _enter_critical_bh(&gate_mpath->frame_queue.lock, &flags); -+ rtw_list_insert_tail(&fskb->list, get_list_head(&gate_mpath->frame_queue)); -+ gate_mpath->frame_queue_len++; -+ _exit_critical_bh(&gate_mpath->frame_queue.lock, &flags); -+ -+ #if 0 /* TODO: copy */ -+ skb = rtw_skb_copy(fskb); -+ if (rtw_warn_on(!skb)) -+ break; -+ -+ rtw_prepare_for_gate(skb, gate_mpath->dst, gate_mpath); -+ skb_queue_tail(&gate_mpath->frame_queue, skb); -+ -+ if (copy) -+ continue; -+ -+ __skb_unlink(fskb, &failq); -+ rtw_skb_free(fskb); -+ #endif -+ } -+ -+ RTW_MPATH_DBG(FUNC_ADPT_FMT" mpath queue for gate %pM has %d frames\n" -+ , FUNC_ADPT_ARG(gate_mpath->adapter), gate_mpath->dst, gate_mpath->frame_queue_len); -+ -+ if (!copy) -+ return; -+ -+ _enter_critical_bh(&from_mpath->frame_queue.lock, &flags); -+ rtw_list_splice(&failq, &from_mpath->frame_queue.queue); -+ from_mpath->frame_queue_len += failq_len; -+ _exit_critical_bh(&from_mpath->frame_queue.lock, &flags); -+} -+ -+ -+static struct rtw_mesh_path *rtw_mpath_lookup(struct rtw_mesh_table *tbl, const u8 *dst) -+{ -+ struct rtw_mesh_path *mpath; -+ -+ if (!tbl) -+ return NULL; -+ -+ mpath = rtw_rhashtable_lookup_fast(&tbl->rhead, dst, rtw_mesh_rht_params); -+ -+ if (mpath && rtw_mpath_expired(mpath)) { -+ enter_critical_bh(&mpath->state_lock); -+ mpath->flags &= ~RTW_MESH_PATH_ACTIVE; -+ exit_critical_bh(&mpath->state_lock); -+ } -+ return mpath; -+} -+ -+/** -+ * rtw_mesh_path_lookup - look up a path in the mesh path table -+ * @sdata: local subif -+ * @dst: hardware address (ETH_ALEN length) of destination -+ * -+ * Returns: pointer to the mesh path structure, or NULL if not found -+ * -+ * Locking: must be called within a read rcu section. -+ */ -+struct rtw_mesh_path * -+rtw_mesh_path_lookup(_adapter *adapter, const u8 *dst) -+{ -+ return rtw_mpath_lookup(adapter->mesh_info.mesh_paths, dst); -+} -+ -+struct rtw_mesh_path * -+rtw_mpp_path_lookup(_adapter *adapter, const u8 *dst) -+{ -+ return rtw_mpath_lookup(adapter->mesh_info.mpp_paths, dst); -+} -+ -+static struct rtw_mesh_path * -+__rtw_mesh_path_lookup_by_idx(struct rtw_mesh_table *tbl, int idx) -+{ -+ int i = 0, ret; -+ struct rtw_mesh_path *mpath = NULL; -+ rtw_rhashtable_iter iter; -+ -+ if (!tbl) -+ return NULL; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return NULL; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto err; -+ -+ while ((mpath = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) -+ continue; -+ if (IS_ERR(mpath)) -+ break; -+ if (i++ == idx) -+ break; -+ } -+err: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+ -+ if (IS_ERR(mpath) || !mpath) -+ return NULL; -+ -+ if (rtw_mpath_expired(mpath)) { -+ enter_critical_bh(&mpath->state_lock); -+ mpath->flags &= ~RTW_MESH_PATH_ACTIVE; -+ exit_critical_bh(&mpath->state_lock); -+ } -+ return mpath; -+} -+ -+/** -+ * rtw_mesh_path_lookup_by_idx - look up a path in the mesh path table by its index -+ * @idx: index -+ * @sdata: local subif, or NULL for all entries -+ * -+ * Returns: pointer to the mesh path structure, or NULL if not found. -+ * -+ * Locking: must be called within a read rcu section. -+ */ -+struct rtw_mesh_path * -+rtw_mesh_path_lookup_by_idx(_adapter *adapter, int idx) -+{ -+ return __rtw_mesh_path_lookup_by_idx(adapter->mesh_info.mesh_paths, idx); -+} -+ -+void dump_mpath(void *sel, _adapter *adapter) -+{ -+ struct rtw_mesh_path *mpath; -+ int idx = 0; -+ char dst[ETH_ALEN]; -+ char next_hop[ETH_ALEN]; -+ u32 sn, metric, qlen; -+ u32 exp_ms = 0, dto_ms; -+ u8 drty; -+ enum rtw_mesh_path_flags flags; -+ -+ RTW_PRINT_SEL(sel, "%-17s %-17s %-10s %-10s %-4s %-6s %-6s %-4s flags\n" -+ , "dst", "next_hop", "sn", "metric", "qlen", "exp_ms", "dto_ms", "drty" -+ ); -+ -+ do { -+ rtw_rcu_read_lock(); -+ -+ mpath = rtw_mesh_path_lookup_by_idx(adapter, idx); -+ if (mpath) { -+ _rtw_memcpy(dst, mpath->dst, ETH_ALEN); -+ _rtw_memcpy(next_hop, mpath->next_hop->cmn.mac_addr, ETH_ALEN); -+ sn = mpath->sn; -+ metric = mpath->metric; -+ qlen = mpath->frame_queue_len; -+ if (rtw_time_after(mpath->exp_time, rtw_get_current_time())) -+ exp_ms = rtw_get_remaining_time_ms(mpath->exp_time); -+ dto_ms = rtw_systime_to_ms(mpath->discovery_timeout); -+ drty = mpath->discovery_retries; -+ flags = mpath->flags; -+ } -+ -+ rtw_rcu_read_unlock(); -+ -+ if (mpath) { -+ RTW_PRINT_SEL(sel, MAC_FMT" "MAC_FMT" %10u %10u %4u %6u %6u %4u%s%s%s%s%s%s%s%s%s%s\n" -+ , MAC_ARG(dst), MAC_ARG(next_hop), sn, metric, qlen -+ , exp_ms < 999999 ? exp_ms : 999999 -+ , dto_ms < 999999 ? dto_ms : 999999 -+ , drty -+ , (flags & RTW_MESH_PATH_ACTIVE) ? " ACT" : "" -+ , (flags & RTW_MESH_PATH_RESOLVING) ? " RSVING" : "" -+ , (flags & RTW_MESH_PATH_SN_VALID) ? " SN_VALID" : "" -+ , (flags & RTW_MESH_PATH_FIXED) ? " FIXED" : "" -+ , (flags & RTW_MESH_PATH_RESOLVED) ? " RSVED" : "" -+ , (flags & RTW_MESH_PATH_REQ_QUEUED) ? " REQ_IN_Q" : "" -+ , (flags & RTW_MESH_PATH_DELETED) ? " DELETED" : "" -+ , (flags & RTW_MESH_PATH_ROOT_ADD_CHK) ? " R_ADD_CHK" : "" -+ , (flags & RTW_MESH_PATH_PEER_AKA) ? " PEER_AKA" : "" -+ , (flags & RTW_MESH_PATH_BCAST_PREQ) ? " BC_PREQ" : "" -+ ); -+ } -+ -+ idx++; -+ } while (mpath); -+} -+ -+/** -+ * rtw_mpp_path_lookup_by_idx - look up a path in the proxy path table by its index -+ * @idx: index -+ * @sdata: local subif, or NULL for all entries -+ * -+ * Returns: pointer to the proxy path structure, or NULL if not found. -+ * -+ * Locking: must be called within a read rcu section. -+ */ -+struct rtw_mesh_path * -+rtw_mpp_path_lookup_by_idx(_adapter *adapter, int idx) -+{ -+ return __rtw_mesh_path_lookup_by_idx(adapter->mesh_info.mpp_paths, idx); -+} -+ -+/** -+ * rtw_mesh_path_add_gate - add the given mpath to a mesh gate to our path table -+ * @mpath: gate path to add to table -+ */ -+int rtw_mesh_path_add_gate(struct rtw_mesh_path *mpath) -+{ -+ struct rtw_mesh_cfg *mcfg; -+ struct rtw_mesh_info *minfo; -+ struct rtw_mesh_table *tbl; -+ int err, ori_num_gates; -+ -+ rtw_rcu_read_lock(); -+ tbl = mpath->adapter->mesh_info.mesh_paths; -+ if (!tbl) { -+ err = -ENOENT; -+ goto err_rcu; -+ } -+ -+ enter_critical_bh(&mpath->state_lock); -+ mcfg = &mpath->adapter->mesh_cfg; -+ mpath->gate_timeout = rtw_get_current_time() + -+ rtw_ms_to_systime(mcfg->path_gate_timeout_factor * -+ mpath->gate_ann_int); -+ if (mpath->is_gate) { -+ err = -EEXIST; -+ exit_critical_bh(&mpath->state_lock); -+ goto err_rcu; -+ } -+ -+ minfo = &mpath->adapter->mesh_info; -+ mpath->is_gate = true; -+ _rtw_spinlock(&tbl->gates_lock); -+ ori_num_gates = minfo->num_gates; -+ minfo->num_gates++; -+ rtw_hlist_add_head_rcu(&mpath->gate_list, &tbl->known_gates); -+ -+ if (ori_num_gates == 0 -+ || rtw_macaddr_is_larger(mpath->dst, minfo->max_addr_gate->dst) -+ ) { -+ minfo->max_addr_gate = mpath; -+ minfo->max_addr_gate_is_larger_than_self = -+ rtw_macaddr_is_larger(mpath->dst, adapter_mac_addr(mpath->adapter)); -+ } -+ -+ _rtw_spinunlock(&tbl->gates_lock); -+ -+ exit_critical_bh(&mpath->state_lock); -+ -+ if (ori_num_gates == 0) { -+ update_beacon(mpath->adapter, WLAN_EID_MESH_CONFIG, NULL, _TRUE, 0); -+ #if CONFIG_RTW_MESH_CTO_MGATE_CARRIER -+ if (!rtw_mesh_cto_mgate_required(mpath->adapter)) -+ rtw_netif_carrier_on(mpath->adapter->pnetdev); -+ #endif -+ } -+ -+ RTW_MPATH_DBG( -+ FUNC_ADPT_FMT" Mesh path: Recorded new gate: %pM. %d known gates\n", -+ FUNC_ADPT_ARG(mpath->adapter), -+ mpath->dst, mpath->adapter->mesh_info.num_gates); -+ err = 0; -+err_rcu: -+ rtw_rcu_read_unlock(); -+ return err; -+} -+ -+/** -+ * rtw_mesh_gate_del - remove a mesh gate from the list of known gates -+ * @tbl: table which holds our list of known gates -+ * @mpath: gate mpath -+ */ -+void rtw_mesh_gate_del(struct rtw_mesh_table *tbl, struct rtw_mesh_path *mpath) -+{ -+ struct rtw_mesh_cfg *mcfg; -+ struct rtw_mesh_info *minfo; -+ int ori_num_gates; -+ -+ rtw_lockdep_assert_held(&mpath->state_lock); -+ if (!mpath->is_gate) -+ return; -+ -+ mcfg = &mpath->adapter->mesh_cfg; -+ minfo = &mpath->adapter->mesh_info; -+ -+ mpath->is_gate = false; -+ enter_critical_bh(&tbl->gates_lock); -+ rtw_hlist_del_rcu(&mpath->gate_list); -+ ori_num_gates = minfo->num_gates; -+ minfo->num_gates--; -+ -+ if (ori_num_gates == 1) { -+ minfo->max_addr_gate = NULL; -+ minfo->max_addr_gate_is_larger_than_self = 0; -+ } else if (minfo->max_addr_gate == mpath) { -+ struct rtw_mesh_path *gate, *max_addr_gate = NULL; -+ rtw_hlist_node *node; -+ -+ rtw_hlist_for_each_entry_rcu(gate, node, &tbl->known_gates, gate_list) { -+ if (!max_addr_gate || rtw_macaddr_is_larger(gate->dst, max_addr_gate->dst)) -+ max_addr_gate = gate; -+ } -+ minfo->max_addr_gate = max_addr_gate; -+ minfo->max_addr_gate_is_larger_than_self = -+ rtw_macaddr_is_larger(max_addr_gate->dst, adapter_mac_addr(mpath->adapter)); -+ } -+ -+ exit_critical_bh(&tbl->gates_lock); -+ -+ if (ori_num_gates == 1) { -+ update_beacon(mpath->adapter, WLAN_EID_MESH_CONFIG, NULL, _TRUE, 0); -+ #if CONFIG_RTW_MESH_CTO_MGATE_CARRIER -+ if (rtw_mesh_cto_mgate_required(mpath->adapter)) -+ rtw_netif_carrier_off(mpath->adapter->pnetdev); -+ #endif -+ } -+ -+ RTW_MPATH_DBG( -+ FUNC_ADPT_FMT" Mesh path: Deleted gate: %pM. %d known gates\n", -+ FUNC_ADPT_ARG(mpath->adapter), -+ mpath->dst, mpath->adapter->mesh_info.num_gates); -+} -+ -+/** -+ * rtw_mesh_gate_search - search a mesh gate from the list of known gates -+ * @tbl: table which holds our list of known gates -+ * @addr: address of gate -+ */ -+bool rtw_mesh_gate_search(struct rtw_mesh_table *tbl, const u8 *addr) -+{ -+ struct rtw_mesh_path *gate; -+ rtw_hlist_node *node; -+ bool exist = 0; -+ -+ rtw_rcu_read_lock(); -+ rtw_hlist_for_each_entry_rcu(gate, node, &tbl->known_gates, gate_list) { -+ if (_rtw_memcmp(gate->dst, addr, ETH_ALEN) == _TRUE) { -+ exist = 1; -+ break; -+ } -+ } -+ -+ rtw_rcu_read_unlock(); -+ -+ return exist; -+} -+ -+/** -+ * rtw_mesh_gate_num - number of gates known to this interface -+ * @sdata: subif data -+ */ -+int rtw_mesh_gate_num(_adapter *adapter) -+{ -+ return adapter->mesh_info.num_gates; -+} -+ -+bool rtw_mesh_is_primary_gate(_adapter *adapter) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ -+ return mcfg->dot11MeshGateAnnouncementProtocol -+ && !minfo->max_addr_gate_is_larger_than_self; -+} -+ -+void dump_known_gates(void *sel, _adapter *adapter) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct rtw_mesh_table *tbl; -+ struct rtw_mesh_path *gate; -+ rtw_hlist_node *node; -+ -+ if (!rtw_mesh_gate_num(adapter)) -+ goto exit; -+ -+ rtw_rcu_read_lock(); -+ -+ tbl = minfo->mesh_paths; -+ if (!tbl) -+ goto unlock; -+ -+ RTW_PRINT_SEL(sel, "num:%d\n", rtw_mesh_gate_num(adapter)); -+ -+ rtw_hlist_for_each_entry_rcu(gate, node, &tbl->known_gates, gate_list) { -+ RTW_PRINT_SEL(sel, "%c"MAC_FMT"\n" -+ , gate == minfo->max_addr_gate ? '*' : ' ' -+ , MAC_ARG(gate->dst)); -+ } -+ -+unlock: -+ rtw_rcu_read_unlock(); -+exit: -+ return; -+} -+ -+static -+struct rtw_mesh_path *rtw_mesh_path_new(_adapter *adapter, -+ const u8 *dst) -+{ -+ struct rtw_mesh_path *new_mpath; -+ -+ new_mpath = rtw_zmalloc(sizeof(struct rtw_mesh_path)); -+ if (!new_mpath) -+ return NULL; -+ -+ _rtw_memcpy(new_mpath->dst, dst, ETH_ALEN); -+ _rtw_memset(new_mpath->rann_snd_addr, 0xFF, ETH_ALEN); -+ new_mpath->is_root = false; -+ new_mpath->adapter = adapter; -+ new_mpath->flags = 0; -+ new_mpath->gate_asked = false; -+ _rtw_init_queue(&new_mpath->frame_queue); -+ new_mpath->frame_queue_len = 0; -+ new_mpath->exp_time = rtw_get_current_time(); -+ _rtw_spinlock_init(&new_mpath->state_lock); -+ rtw_init_timer(&new_mpath->timer, adapter, rtw_mesh_path_timer, new_mpath); -+ -+ return new_mpath; -+} -+ -+/** -+ * rtw_mesh_path_add - allocate and add a new path to the mesh path table -+ * @dst: destination address of the path (ETH_ALEN length) -+ * @sdata: local subif -+ * -+ * Returns: 0 on success -+ * -+ * State: the initial state of the new path is set to 0 -+ */ -+struct rtw_mesh_path *rtw_mesh_path_add(_adapter *adapter, -+ const u8 *dst) -+{ -+ struct rtw_mesh_table *tbl = adapter->mesh_info.mesh_paths; -+ struct rtw_mesh_path *mpath, *new_mpath; -+ int ret; -+ -+ if (!tbl) -+ return ERR_PTR(-ENOTSUPP); -+ -+ if (_rtw_memcmp(dst, adapter_mac_addr(adapter), ETH_ALEN) == _TRUE) -+ /* never add ourselves as neighbours */ -+ return ERR_PTR(-ENOTSUPP); -+ -+ if (is_multicast_mac_addr(dst)) -+ return ERR_PTR(-ENOTSUPP); -+ -+ if (ATOMIC_INC_UNLESS(&adapter->mesh_info.mpaths, RTW_MESH_MAX_MPATHS) == 0) -+ return ERR_PTR(-ENOSPC); -+ -+ new_mpath = rtw_mesh_path_new(adapter, dst); -+ if (!new_mpath) -+ return ERR_PTR(-ENOMEM); -+ -+ do { -+ ret = rtw_rhashtable_lookup_insert_fast(&tbl->rhead, -+ &new_mpath->rhash, -+ rtw_mesh_rht_params); -+ -+ if (ret == -EEXIST) -+ mpath = rtw_rhashtable_lookup_fast(&tbl->rhead, -+ dst, -+ rtw_mesh_rht_params); -+ -+ } while (unlikely(ret == -EEXIST && !mpath)); -+ -+ if (ret && ret != -EEXIST) -+ return ERR_PTR(ret); -+ -+ /* At this point either new_mpath was added, or we found a -+ * matching entry already in the table; in the latter case -+ * free the unnecessary new entry. -+ */ -+ if (ret == -EEXIST) { -+ rtw_mfree(new_mpath, sizeof(struct rtw_mesh_path)); -+ new_mpath = mpath; -+ } -+ adapter->mesh_info.mesh_paths_generation++; -+ return new_mpath; -+} -+ -+int rtw_mpp_path_add(_adapter *adapter, -+ const u8 *dst, const u8 *mpp) -+{ -+ struct rtw_mesh_table *tbl = adapter->mesh_info.mpp_paths; -+ struct rtw_mesh_path *new_mpath; -+ int ret; -+ -+ if (!tbl) -+ return -ENOTSUPP; -+ -+ if (_rtw_memcmp(dst, adapter_mac_addr(adapter), ETH_ALEN) == _TRUE) -+ /* never add ourselves as neighbours */ -+ return -ENOTSUPP; -+ -+ if (is_multicast_mac_addr(dst)) -+ return -ENOTSUPP; -+ -+ new_mpath = rtw_mesh_path_new(adapter, dst); -+ -+ if (!new_mpath) -+ return -ENOMEM; -+ -+ _rtw_memcpy(new_mpath->mpp, mpp, ETH_ALEN); -+ ret = rtw_rhashtable_lookup_insert_fast(&tbl->rhead, -+ &new_mpath->rhash, -+ rtw_mesh_rht_params); -+ -+ adapter->mesh_info.mpp_paths_generation++; -+ return ret; -+} -+ -+void dump_mpp(void *sel, _adapter *adapter) -+{ -+ struct rtw_mesh_path *mpath; -+ int idx = 0; -+ char dst[ETH_ALEN]; -+ char mpp[ETH_ALEN]; -+ -+ RTW_PRINT_SEL(sel, "%-17s %-17s\n", "dst", "mpp"); -+ -+ do { -+ rtw_rcu_read_lock(); -+ -+ mpath = rtw_mpp_path_lookup_by_idx(adapter, idx); -+ if (mpath) { -+ _rtw_memcpy(dst, mpath->dst, ETH_ALEN); -+ _rtw_memcpy(mpp, mpath->mpp, ETH_ALEN); -+ } -+ -+ rtw_rcu_read_unlock(); -+ -+ if (mpath) { -+ RTW_PRINT_SEL(sel, MAC_FMT" "MAC_FMT"\n" -+ , MAC_ARG(dst), MAC_ARG(mpp)); -+ } -+ -+ idx++; -+ } while (mpath); -+} -+ -+/** -+ * rtw_mesh_plink_broken - deactivates paths and sends perr when a link breaks -+ * -+ * @sta: broken peer link -+ * -+ * This function must be called from the rate control algorithm if enough -+ * delivery errors suggest that a peer link is no longer usable. -+ */ -+void rtw_mesh_plink_broken(struct sta_info *sta) -+{ -+ _adapter *adapter = sta->padapter; -+ struct rtw_mesh_table *tbl = adapter->mesh_info.mesh_paths; -+ static const u8 bcast[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ struct rtw_mesh_path *mpath; -+ rtw_rhashtable_iter iter; -+ int ret; -+ -+ if (!tbl) -+ return; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto out; -+ -+ while ((mpath = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) -+ continue; -+ if (IS_ERR(mpath)) -+ break; -+ if (rtw_rcu_access_pointer(mpath->next_hop) == sta && -+ mpath->flags & RTW_MESH_PATH_ACTIVE && -+ !(mpath->flags & RTW_MESH_PATH_FIXED)) { -+ enter_critical_bh(&mpath->state_lock); -+ mpath->flags &= ~RTW_MESH_PATH_ACTIVE; -+ ++mpath->sn; -+ exit_critical_bh(&mpath->state_lock); -+ rtw_mesh_path_error_tx(adapter, -+ adapter->mesh_cfg.element_ttl, -+ mpath->dst, mpath->sn, -+ WLAN_REASON_MESH_PATH_DEST_UNREACHABLE, bcast); -+ } -+ } -+out: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+} -+ -+static void rtw_mesh_path_free_rcu(struct rtw_mesh_table *tbl, -+ struct rtw_mesh_path *mpath) -+{ -+ _adapter *adapter = mpath->adapter; -+ -+ enter_critical_bh(&mpath->state_lock); -+ mpath->flags |= RTW_MESH_PATH_RESOLVING | RTW_MESH_PATH_DELETED; -+ rtw_mesh_gate_del(tbl, mpath); -+ exit_critical_bh(&mpath->state_lock); -+ _cancel_timer_ex(&mpath->timer); -+ ATOMIC_DEC(&adapter->mesh_info.mpaths); -+ ATOMIC_DEC(&tbl->entries); -+ _rtw_spinlock_free(&mpath->state_lock); -+ -+ rtw_mesh_path_flush_pending(mpath); -+ -+ rtw_mpath_free_rcu(mpath); -+} -+ -+static void __rtw_mesh_path_del(struct rtw_mesh_table *tbl, struct rtw_mesh_path *mpath) -+{ -+ rtw_rhashtable_remove_fast(&tbl->rhead, &mpath->rhash, rtw_mesh_rht_params); -+ rtw_mesh_path_free_rcu(tbl, mpath); -+} -+ -+/** -+ * rtw_mesh_path_flush_by_nexthop - Deletes mesh paths if their next hop matches -+ * -+ * @sta: mesh peer to match -+ * -+ * RCU notes: this function is called when a mesh plink transitions from -+ * PLINK_ESTAB to any other state, since PLINK_ESTAB state is the only one that -+ * allows path creation. This will happen before the sta can be freed (because -+ * sta_info_destroy() calls this) so any reader in a rcu read block will be -+ * protected against the plink disappearing. -+ */ -+void rtw_mesh_path_flush_by_nexthop(struct sta_info *sta) -+{ -+ _adapter *adapter = sta->padapter; -+ struct rtw_mesh_table *tbl = adapter->mesh_info.mesh_paths; -+ struct rtw_mesh_path *mpath; -+ rtw_rhashtable_iter iter; -+ int ret; -+ -+ if (!tbl) -+ return; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto out; -+ -+ while ((mpath = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) -+ continue; -+ if (IS_ERR(mpath)) -+ break; -+ -+ if (rtw_rcu_access_pointer(mpath->next_hop) == sta) -+ __rtw_mesh_path_del(tbl, mpath); -+ } -+out: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+} -+ -+static void rtw_mpp_flush_by_proxy(_adapter *adapter, -+ const u8 *proxy) -+{ -+ struct rtw_mesh_table *tbl = adapter->mesh_info.mpp_paths; -+ struct rtw_mesh_path *mpath; -+ rtw_rhashtable_iter iter; -+ int ret; -+ -+ if (!tbl) -+ return; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto out; -+ -+ while ((mpath = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) -+ continue; -+ if (IS_ERR(mpath)) -+ break; -+ -+ if (_rtw_memcmp(mpath->mpp, proxy, ETH_ALEN) == _TRUE) -+ __rtw_mesh_path_del(tbl, mpath); -+ } -+out: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+} -+ -+static void rtw_table_flush_by_iface(struct rtw_mesh_table *tbl) -+{ -+ struct rtw_mesh_path *mpath; -+ rtw_rhashtable_iter iter; -+ int ret; -+ -+ if (!tbl) -+ return; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto out; -+ -+ while ((mpath = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) -+ continue; -+ if (IS_ERR(mpath)) -+ break; -+ __rtw_mesh_path_del(tbl, mpath); -+ } -+out: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+} -+ -+/** -+ * rtw_mesh_path_flush_by_iface - Deletes all mesh paths associated with a given iface -+ * -+ * This function deletes both mesh paths as well as mesh portal paths. -+ * -+ * @sdata: interface data to match -+ * -+ */ -+void rtw_mesh_path_flush_by_iface(_adapter *adapter) -+{ -+ rtw_table_flush_by_iface(adapter->mesh_info.mesh_paths); -+ rtw_table_flush_by_iface(adapter->mesh_info.mpp_paths); -+} -+ -+/** -+ * rtw_table_path_del - delete a path from the mesh or mpp table -+ * -+ * @tbl: mesh or mpp path table -+ * @sdata: local subif -+ * @addr: dst address (ETH_ALEN length) -+ * -+ * Returns: 0 if successful -+ */ -+static int rtw_table_path_del(struct rtw_mesh_table *tbl, -+ const u8 *addr) -+{ -+ struct rtw_mesh_path *mpath; -+ -+ if (!tbl) -+ return -ENXIO; -+ -+ rtw_rcu_read_lock(); -+ mpath = rtw_rhashtable_lookup_fast(&tbl->rhead, addr, rtw_mesh_rht_params); -+ if (!mpath) { -+ rtw_rcu_read_unlock(); -+ return -ENXIO; -+ } -+ -+ __rtw_mesh_path_del(tbl, mpath); -+ rtw_rcu_read_unlock(); -+ return 0; -+} -+ -+ -+/** -+ * rtw_mesh_path_del - delete a mesh path from the table -+ * -+ * @addr: dst address (ETH_ALEN length) -+ * @sdata: local subif -+ * -+ * Returns: 0 if successful -+ */ -+int rtw_mesh_path_del(_adapter *adapter, const u8 *addr) -+{ -+ int err; -+ -+ /* flush relevant mpp entries first */ -+ rtw_mpp_flush_by_proxy(adapter, addr); -+ -+ err = rtw_table_path_del(adapter->mesh_info.mesh_paths, addr); -+ adapter->mesh_info.mesh_paths_generation++; -+ return err; -+} -+ -+/** -+ * rtw_mesh_path_tx_pending - sends pending frames in a mesh path queue -+ * -+ * @mpath: mesh path to activate -+ * -+ * Locking: the state_lock of the mpath structure must NOT be held when calling -+ * this function. -+ */ -+void rtw_mesh_path_tx_pending(struct rtw_mesh_path *mpath) -+{ -+ if (mpath->flags & RTW_MESH_PATH_ACTIVE) { -+ struct rtw_mesh_info *minfo = &mpath->adapter->mesh_info; -+ _list q; -+ u32 q_len = 0; -+ -+ _rtw_init_listhead(&q); -+ -+ /* move to local queue */ -+ enter_critical_bh(&mpath->frame_queue.lock); -+ if (mpath->frame_queue_len) { -+ rtw_list_splice_init(&mpath->frame_queue.queue, &q); -+ q_len = mpath->frame_queue_len; -+ mpath->frame_queue_len = 0; -+ } -+ exit_critical_bh(&mpath->frame_queue.lock); -+ -+ if (q_len) { -+ /* move to mpath_tx_queue */ -+ enter_critical_bh(&minfo->mpath_tx_queue.lock); -+ rtw_list_splice_tail(&q, &minfo->mpath_tx_queue.queue); -+ minfo->mpath_tx_queue_len += q_len; -+ exit_critical_bh(&minfo->mpath_tx_queue.lock); -+ -+ /* schedule mpath_tx_tasklet */ -+ tasklet_hi_schedule(&minfo->mpath_tx_tasklet); -+ } -+ } -+} -+ -+/** -+ * rtw_mesh_path_send_to_gates - sends pending frames to all known mesh gates -+ * -+ * @mpath: mesh path whose queue will be emptied -+ * -+ * If there is only one gate, the frames are transferred from the failed mpath -+ * queue to that gate's queue. If there are more than one gates, the frames -+ * are copied from each gate to the next. After frames are copied, the -+ * mpath queues are emptied onto the transmission queue. -+ */ -+int rtw_mesh_path_send_to_gates(struct rtw_mesh_path *mpath) -+{ -+ _adapter *adapter = mpath->adapter; -+ struct rtw_mesh_table *tbl; -+ struct rtw_mesh_path *from_mpath = mpath; -+ struct rtw_mesh_path *gate; -+ bool copy = false; -+ rtw_hlist_node *node; -+ -+ tbl = adapter->mesh_info.mesh_paths; -+ if (!tbl) -+ return 0; -+ -+ rtw_rcu_read_lock(); -+ rtw_hlist_for_each_entry_rcu(gate, node, &tbl->known_gates, gate_list) { -+ if (gate->flags & RTW_MESH_PATH_ACTIVE) { -+ RTW_MPATH_DBG(FUNC_ADPT_FMT" Forwarding to %pM\n", -+ FUNC_ADPT_ARG(adapter), gate->dst); -+ rtw_mesh_path_move_to_queue(gate, from_mpath, copy); -+ from_mpath = gate; -+ copy = true; -+ } else { -+ RTW_MPATH_DBG( -+ FUNC_ADPT_FMT" Not forwarding to %pM (flags %#x)\n", -+ FUNC_ADPT_ARG(adapter), gate->dst, gate->flags); -+ } -+ } -+ -+ rtw_hlist_for_each_entry_rcu(gate, node, &tbl->known_gates, gate_list) { -+ RTW_MPATH_DBG(FUNC_ADPT_FMT" Sending to %pM\n", -+ FUNC_ADPT_ARG(adapter), gate->dst); -+ rtw_mesh_path_tx_pending(gate); -+ } -+ rtw_rcu_read_unlock(); -+ -+ return (from_mpath == mpath) ? -EHOSTUNREACH : 0; -+} -+ -+/** -+ * rtw_mesh_path_discard_frame - discard a frame whose path could not be resolved -+ * -+ * @skb: frame to discard -+ * @sdata: network subif the frame was to be sent through -+ * -+ * Locking: the function must me called within a rcu_read_lock region -+ */ -+void rtw_mesh_path_discard_frame(_adapter *adapter, -+ struct xmit_frame *xframe) -+{ -+ rtw_free_xmitframe(&adapter->xmitpriv, xframe); -+ adapter->mesh_info.mshstats.dropped_frames_no_route++; -+} -+ -+/** -+ * rtw_mesh_path_flush_pending - free the pending queue of a mesh path -+ * -+ * @mpath: mesh path whose queue has to be freed -+ * -+ * Locking: the function must me called within a rcu_read_lock region -+ */ -+void rtw_mesh_path_flush_pending(struct rtw_mesh_path *mpath) -+{ -+ struct xmit_frame *xframe; -+ _list *list, *head; -+ _list tmp; -+ -+ _rtw_init_listhead(&tmp); -+ -+ enter_critical_bh(&mpath->frame_queue.lock); -+ rtw_list_splice_init(&mpath->frame_queue.queue, &tmp); -+ mpath->frame_queue_len = 0; -+ exit_critical_bh(&mpath->frame_queue.lock); -+ -+ head = &tmp; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ xframe = LIST_CONTAINOR(list, struct xmit_frame, list); -+ list = get_next(list); -+ rtw_list_delete(&xframe->list); -+ rtw_mesh_path_discard_frame(mpath->adapter, xframe); -+ } -+} -+ -+/** -+ * rtw_mesh_path_fix_nexthop - force a specific next hop for a mesh path -+ * -+ * @mpath: the mesh path to modify -+ * @next_hop: the next hop to force -+ * -+ * Locking: this function must be called holding mpath->state_lock -+ */ -+void rtw_mesh_path_fix_nexthop(struct rtw_mesh_path *mpath, struct sta_info *next_hop) -+{ -+ enter_critical_bh(&mpath->state_lock); -+ rtw_mesh_path_assign_nexthop(mpath, next_hop); -+ mpath->sn = 0xffff; -+ mpath->metric = 0; -+ mpath->hop_count = 0; -+ mpath->exp_time = 0; -+ mpath->flags = RTW_MESH_PATH_FIXED | RTW_MESH_PATH_SN_VALID; -+ rtw_mesh_path_activate(mpath); -+ exit_critical_bh(&mpath->state_lock); -+ rtw_ewma_err_rate_init(&next_hop->metrics.err_rate); -+ /* init it at a low value - 0 start is tricky */ -+ rtw_ewma_err_rate_add(&next_hop->metrics.err_rate, 1); -+ rtw_mesh_path_tx_pending(mpath); -+} -+ -+int rtw_mesh_pathtbl_init(_adapter *adapter) -+{ -+ struct rtw_mesh_table *tbl_path, *tbl_mpp; -+ int ret; -+ -+ tbl_path = rtw_mesh_table_alloc(); -+ if (!tbl_path) -+ return -ENOMEM; -+ -+ tbl_mpp = rtw_mesh_table_alloc(); -+ if (!tbl_mpp) { -+ ret = -ENOMEM; -+ goto free_path; -+ } -+ -+ rtw_rhashtable_init(&tbl_path->rhead, &rtw_mesh_rht_params); -+ rtw_rhashtable_init(&tbl_mpp->rhead, &rtw_mesh_rht_params); -+ -+ adapter->mesh_info.mesh_paths = tbl_path; -+ adapter->mesh_info.mpp_paths = tbl_mpp; -+ -+ return 0; -+ -+free_path: -+ rtw_mesh_table_free(tbl_path); -+ return ret; -+} -+ -+static -+void rtw_mesh_path_tbl_expire(_adapter *adapter, -+ struct rtw_mesh_table *tbl) -+{ -+ struct rtw_mesh_path *mpath; -+ rtw_rhashtable_iter iter; -+ int ret; -+ -+ if (!tbl) -+ return; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto out; -+ -+ while ((mpath = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) -+ continue; -+ if (IS_ERR(mpath)) -+ break; -+ if ((!(mpath->flags & RTW_MESH_PATH_RESOLVING)) && -+ (!(mpath->flags & RTW_MESH_PATH_FIXED)) && -+ rtw_time_after(rtw_get_current_time(), mpath->exp_time + RTW_MESH_PATH_EXPIRE)) -+ __rtw_mesh_path_del(tbl, mpath); -+ -+ if (mpath->is_gate && /* need not to deal with non-gate case */ -+ rtw_time_after(rtw_get_current_time(), mpath->gate_timeout)) { -+ RTW_MPATH_DBG(FUNC_ADPT_FMT"mpath [%pM] expired systime is %lu systime is %lu\n", -+ FUNC_ADPT_ARG(adapter), mpath->dst, -+ mpath->gate_timeout, rtw_get_current_time()); -+ enter_critical_bh(&mpath->state_lock); -+ if (mpath->gate_asked) { /* asked gate before */ -+ rtw_mesh_gate_del(tbl, mpath); -+ exit_critical_bh(&mpath->state_lock); -+ } else { -+ mpath->gate_asked = true; -+ mpath->gate_timeout = rtw_get_current_time() + rtw_ms_to_systime(mpath->gate_ann_int); -+ exit_critical_bh(&mpath->state_lock); -+ rtw_mesh_queue_preq(mpath, RTW_PREQ_Q_F_START | RTW_PREQ_Q_F_REFRESH); -+ RTW_MPATH_DBG(FUNC_ADPT_FMT"mpath [%pM] ask mesh gate existence (is_root=%d)\n", -+ FUNC_ADPT_ARG(adapter), mpath->dst, mpath->is_root); -+ } -+ } -+ } -+ -+out: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+} -+ -+void rtw_mesh_path_expire(_adapter *adapter) -+{ -+ rtw_mesh_path_tbl_expire(adapter, adapter->mesh_info.mesh_paths); -+ rtw_mesh_path_tbl_expire(adapter, adapter->mesh_info.mpp_paths); -+} -+ -+void rtw_mesh_pathtbl_unregister(_adapter *adapter) -+{ -+ if (adapter->mesh_info.mesh_paths) { -+ rtw_mesh_table_free(adapter->mesh_info.mesh_paths); -+ adapter->mesh_info.mesh_paths = NULL; -+ } -+ -+ if (adapter->mesh_info.mpp_paths) { -+ rtw_mesh_table_free(adapter->mesh_info.mpp_paths); -+ adapter->mesh_info.mpp_paths = NULL; -+ } -+} -+#endif /* CONFIG_RTW_MESH */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_pathtbl.h b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_pathtbl.h -new file mode 100644 -index 000000000..be0c40980 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/mesh/rtw_mesh_pathtbl.h -@@ -0,0 +1,211 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_MESH_PATHTBL_H_ -+#define __RTW_MESH_PATHTBL_H_ -+ -+#ifndef DBG_RTW_MPATH -+#define DBG_RTW_MPATH 1 -+#endif -+#if DBG_RTW_MPATH -+#define RTW_MPATH_DBG(fmt, arg...) RTW_PRINT(fmt, ##arg) -+#else -+#define RTW_MPATH_DBG(fmt, arg...) do {} while (0) -+#endif -+ -+/** -+ * enum rtw_mesh_path_flags - mesh path flags -+ * -+ * @RTW_MESH_PATH_ACTIVE: the mesh path can be used for forwarding -+ * @RTW_MESH_PATH_RESOLVING: the discovery process is running for this mesh path -+ * @RTW_MESH_PATH_SN_VALID: the mesh path contains a valid destination sequence -+ * number -+ * @RTW_MESH_PATH_FIXED: the mesh path has been manually set and should not be -+ * modified -+ * @RTW_MESH_PATH_RESOLVED: the mesh path can has been resolved -+ * @RTW_MESH_PATH_REQ_QUEUED: there is an unsent path request for this destination -+ * already queued up, waiting for the discovery process to start. -+ * @RTW_MESH_PATH_DELETED: the mesh path has been deleted and should no longer -+ * be used -+ * @RTW_MESH_PATH_ROOT_ADD_CHK: root additional check in root mode. -+ * With this flag, It will try the last used rann_snd_addr -+ * @RTW_MESH_PATH_PEER_AKA: only used toward a peer, only used in active keep -+ * alive mechanism. PREQ's da = path dst -+ * @RTW_MESH_PATH_BCAST_PREQ: for re-checking next hop resolve toward root. -+ * Use it to force path_discover sending broadcast PREQ for root. -+ * -+ * RTW_MESH_PATH_RESOLVED is used by the mesh path timer to -+ * decide when to stop or cancel the mesh path discovery. -+ */ -+enum rtw_mesh_path_flags { -+ RTW_MESH_PATH_ACTIVE = BIT(0), -+ RTW_MESH_PATH_RESOLVING = BIT(1), -+ RTW_MESH_PATH_SN_VALID = BIT(2), -+ RTW_MESH_PATH_FIXED = BIT(3), -+ RTW_MESH_PATH_RESOLVED = BIT(4), -+ RTW_MESH_PATH_REQ_QUEUED = BIT(5), -+ RTW_MESH_PATH_DELETED = BIT(6), -+ RTW_MESH_PATH_ROOT_ADD_CHK = BIT(7), -+ RTW_MESH_PATH_PEER_AKA = BIT(8), -+ RTW_MESH_PATH_BCAST_PREQ = BIT(9), -+}; -+ -+/** -+ * struct rtw_mesh_path - mesh path structure -+ * -+ * @dst: mesh path destination mac address -+ * @mpp: mesh proxy mac address -+ * @rhash: rhashtable list pointer -+ * @gate_list: list pointer for known gates list -+ * @sdata: mesh subif -+ * @next_hop: mesh neighbor to which frames for this destination will be -+ * forwarded -+ * @timer: mesh path discovery timer -+ * @frame_queue: pending queue for frames sent to this destination while the -+ * path is unresolved -+ * @rcu: rcu head for freeing mesh path -+ * @sn: target sequence number -+ * @metric: current metric to this destination -+ * @hop_count: hops to destination -+ * @exp_time: in jiffies, when the path will expire or when it expired -+ * @discovery_timeout: timeout (lapse in jiffies) used for the last discovery -+ * retry -+ * @discovery_retries: number of discovery retries -+ * @flags: mesh path flags, as specified on &enum rtw_mesh_path_flags -+ * @state_lock: mesh path state lock used to protect changes to the -+ * mpath itself. No need to take this lock when adding or removing -+ * an mpath to a hash bucket on a path table. -+ * @rann_snd_addr: the RANN sender address -+ * @rann_metric: the aggregated path metric towards the root node -+ * @last_preq_to_root: Timestamp of last PREQ sent to root -+ * @is_root: the destination station of this path is a root node -+ * @is_gate: the destination station of this path is a mesh gate -+ * -+ * -+ * The dst address is unique in the mesh path table. Since the mesh_path is -+ * protected by RCU, deleting the next_hop STA must remove / substitute the -+ * mesh_path structure and wait until that is no longer reachable before -+ * destroying the STA completely. -+ */ -+struct rtw_mesh_path { -+ u8 dst[ETH_ALEN]; -+ u8 mpp[ETH_ALEN]; /* used for MPP or MAP */ -+ rtw_rhash_head rhash; -+ rtw_hlist_node gate_list; -+ _adapter *adapter; -+ struct sta_info __rcu *next_hop; -+ _timer timer; -+ _queue frame_queue; -+ u32 frame_queue_len; -+ rtw_rcu_head rcu; -+ u32 sn; -+ u32 metric; -+ u8 hop_count; -+ systime exp_time; -+ systime discovery_timeout; -+ systime gate_timeout; -+ u32 gate_ann_int; /* gate announce interval */ -+ u8 discovery_retries; -+ enum rtw_mesh_path_flags flags; -+ _lock state_lock; -+ u8 rann_snd_addr[ETH_ALEN]; -+#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK -+ u8 add_chk_rann_snd_addr[ETH_ALEN]; -+#endif -+ u32 rann_metric; -+ unsigned long last_preq_to_root; -+ bool is_root; -+ bool is_gate; -+ bool gate_asked; -+}; -+ -+/** -+ * struct rtw_mesh_table -+ * -+ * @known_gates: list of known mesh gates and their mpaths by the station. The -+ * gate's mpath may or may not be resolved and active. -+ * @gates_lock: protects updates to known_gates -+ * @rhead: the rhashtable containing struct mesh_paths, keyed by dest addr -+ * @entries: number of entries in the table -+ */ -+struct rtw_mesh_table { -+ rtw_hlist_head known_gates; -+ _lock gates_lock; -+ rtw_rhashtable rhead; -+ ATOMIC_T entries; -+}; -+ -+#define RTW_MESH_PATH_EXPIRE (600 * HZ) -+ -+/* Maximum number of paths per interface */ -+#define RTW_MESH_MAX_MPATHS 1024 -+ -+/* Number of frames buffered per destination for unresolved destinations */ -+#define RTW_MESH_FRAME_QUEUE_LEN 10 -+ -+int rtw_mesh_nexthop_lookup(_adapter *adapter, -+ const u8 *mda, const u8 *msa, u8 *ra); -+int rtw_mesh_nexthop_resolve(_adapter *adapter, -+ struct xmit_frame *xframe); -+ -+struct rtw_mesh_path *rtw_mesh_path_lookup(_adapter *adapter, -+ const u8 *dst); -+struct rtw_mesh_path *rtw_mpp_path_lookup(_adapter *adapter, -+ const u8 *dst); -+int rtw_mpp_path_add(_adapter *adapter, -+ const u8 *dst, const u8 *mpp); -+void dump_mpp(void *sel, _adapter *adapter); -+ -+struct rtw_mesh_path * -+rtw_mesh_path_lookup_by_idx(_adapter *adapter, int idx); -+void dump_mpath(void *sel, _adapter *adapter); -+ -+struct rtw_mesh_path * -+rtw_mpp_path_lookup_by_idx(_adapter *adapter, int idx); -+void rtw_mesh_path_fix_nexthop(struct rtw_mesh_path *mpath, struct sta_info *next_hop); -+void rtw_mesh_path_expire(_adapter *adapter); -+ -+struct rtw_mesh_path * -+rtw_mesh_path_add(_adapter *adapter, const u8 *dst); -+ -+int rtw_mesh_path_add_gate(struct rtw_mesh_path *mpath); -+void rtw_mesh_gate_del(struct rtw_mesh_table *tbl, struct rtw_mesh_path *mpath); -+bool rtw_mesh_gate_search(struct rtw_mesh_table *tbl, const u8 *addr); -+int rtw_mesh_path_send_to_gates(struct rtw_mesh_path *mpath); -+int rtw_mesh_gate_num(_adapter *adapter); -+bool rtw_mesh_is_primary_gate(_adapter *adapter); -+void dump_known_gates(void *sel, _adapter *adapter); -+ -+void rtw_mesh_plink_broken(struct sta_info *sta); -+ -+void rtw_mesh_path_assign_nexthop(struct rtw_mesh_path *mpath, struct sta_info *sta); -+void rtw_mesh_path_flush_pending(struct rtw_mesh_path *mpath); -+void rtw_mesh_path_tx_pending(struct rtw_mesh_path *mpath); -+int rtw_mesh_pathtbl_init(_adapter *adapter); -+void rtw_mesh_pathtbl_unregister(_adapter *adapter); -+int rtw_mesh_path_del(_adapter *adapter, const u8 *addr); -+ -+void rtw_mesh_path_flush_by_nexthop(struct sta_info *sta); -+void rtw_mesh_path_discard_frame(_adapter *adapter, -+ struct xmit_frame *xframe); -+ -+static inline void rtw_mesh_path_activate(struct rtw_mesh_path *mpath) -+{ -+ mpath->flags |= RTW_MESH_PATH_ACTIVE | RTW_MESH_PATH_RESOLVED; -+} -+ -+void rtw_mesh_path_flush_by_iface(_adapter *adapter); -+ -+#endif /* __RTW_MESH_PATHTBL_H_ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/monitor/rtw_radiotap.c b/drivers/net/wireless/rtl8821cs/core/monitor/rtw_radiotap.c -new file mode 100644 -index 000000000..e9ebc7d7a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/monitor/rtw_radiotap.c -@@ -0,0 +1,615 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_RADIOTAP_C_ -+ -+#ifdef CONFIG_WIFI_MONITOR -+ -+#include -+#include -+ -+#define CHAN2FREQ(a) ((a < 14) ? (2407+5*a) : (5000+5*a)) -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 20, 0)) -+#define IEEE80211_RADIOTAP_ZERO_LEN_PSDU 26 -+#define IEEE80211_RADIOTAP_LSIG 27 -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 0)) -+#define IEEE80211_RADIOTAP_TIMESTAMP 22 -+/* For IEEE80211_RADIOTAP_TIMESTAMP */ -+#define IEEE80211_RADIOTAP_TIMESTAMP_UNIT_MASK 0x000F -+#define IEEE80211_RADIOTAP_TIMESTAMP_UNIT_MS 0x0000 -+#define IEEE80211_RADIOTAP_TIMESTAMP_UNIT_US 0x0001 -+#define IEEE80211_RADIOTAP_TIMESTAMP_UNIT_NS 0x0003 -+#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_MASK 0x00F0 -+#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_BEGIN_MDPU 0x0000 -+#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_EO_MPDU 0x0010 -+#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_EO_PPDU 0x0020 -+#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_PLCP_SIG_ACQ 0x0030 -+#define IEEE80211_RADIOTAP_TIMESTAMP_SPOS_UNKNOWN 0x00F0 -+ -+#define IEEE80211_RADIOTAP_TIMESTAMP_FLAG_64BIT 0x00 -+#define IEEE80211_RADIOTAP_TIMESTAMP_FLAG_32BIT 0x01 -+#define IEEE80211_RADIOTAP_TIMESTAMP_FLAG_ACCURACY 0x02 -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0)) -+/* for IEEE80211_RADIOTAP_CHANNEL */ -+#define IEEE80211_CHAN_GSM 0x1000 /* GSM (900 MHz) */ -+#define IEEE80211_CHAN_STURBO 0x2000 /* Static Turbo */ -+#define IEEE80211_CHAN_HALF 0x4000 /* Half channel (10 MHz wide) */ -+#define IEEE80211_CHAN_QUARTER 0x8000 /* Quarter channel (5 MHz wide) */ -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+#define IEEE80211_RADIOTAP_VHT 21 -+/* For IEEE80211_RADIOTAP_VHT */ -+#define IEEE80211_RADIOTAP_VHT_KNOWN_STBC 0x0001 -+#define IEEE80211_RADIOTAP_VHT_KNOWN_TXOP_PS_NA 0x0002 -+#define IEEE80211_RADIOTAP_VHT_KNOWN_GI 0x0004 -+#define IEEE80211_RADIOTAP_VHT_KNOWN_SGI_NSYM_DIS 0x0008 -+#define IEEE80211_RADIOTAP_VHT_KNOWN_LDPC_EXTRA_OFDM_SYM 0x0010 -+#define IEEE80211_RADIOTAP_VHT_KNOWN_BEAMFORMED 0x0020 -+#define IEEE80211_RADIOTAP_VHT_KNOWN_BANDWIDTH 0x0040 -+#define IEEE80211_RADIOTAP_VHT_KNOWN_GROUP_ID 0x0080 -+#define IEEE80211_RADIOTAP_VHT_KNOWN_PARTIAL_AID 0x0100 -+ -+#define IEEE80211_RADIOTAP_VHT_FLAG_STBC 0x01 -+#define IEEE80211_RADIOTAP_VHT_FLAG_TXOP_PS_NA 0x02 -+#define IEEE80211_RADIOTAP_VHT_FLAG_SGI 0x04 -+#define IEEE80211_RADIOTAP_VHT_FLAG_SGI_NSYM_M10_9 0x08 -+#define IEEE80211_RADIOTAP_VHT_FLAG_LDPC_EXTRA_OFDM_SYM 0x10 -+#define IEEE80211_RADIOTAP_VHT_FLAG_BEAMFORMED 0x20 -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0)) -+#define IEEE80211_RADIOTAP_CODING_LDPC_USER0 0x01 -+#define IEEE80211_RADIOTAP_CODING_LDPC_USER1 0x02 -+#define IEEE80211_RADIOTAP_CODING_LDPC_USER2 0x04 -+#define IEEE80211_RADIOTAP_CODING_LDPC_USER3 0x08 -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 7, 0)) -+#define IEEE80211_RADIOTAP_AMPDU_STATUS 20 -+/* For IEEE80211_RADIOTAP_AMPDU_STATUS */ -+#define IEEE80211_RADIOTAP_AMPDU_REPORT_ZEROLEN 0x0001 -+#define IEEE80211_RADIOTAP_AMPDU_IS_ZEROLEN 0x0002 -+#define IEEE80211_RADIOTAP_AMPDU_LAST_KNOWN 0x0004 -+#define IEEE80211_RADIOTAP_AMPDU_IS_LAST 0x0008 -+#define IEEE80211_RADIOTAP_AMPDU_DELIM_CRC_ERR 0x0010 -+#define IEEE80211_RADIOTAP_AMPDU_DELIM_CRC_KNOWN 0x0020 -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(4, 17, 0)) -+#define IEEE80211_RADIOTAP_AMPDU_EOF 0x0040 -+#define IEEE80211_RADIOTAP_AMPDU_EOF_KNOWN 0x0080 -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 39)) -+#define IEEE80211_RADIOTAP_MCS 19 -+/* For IEEE80211_RADIOTAP_MCS */ -+#define IEEE80211_RADIOTAP_MCS_HAVE_BW 0x01 -+#define IEEE80211_RADIOTAP_MCS_HAVE_MCS 0x02 -+#define IEEE80211_RADIOTAP_MCS_HAVE_GI 0x04 -+#define IEEE80211_RADIOTAP_MCS_HAVE_FMT 0x08 -+#define IEEE80211_RADIOTAP_MCS_HAVE_FEC 0x10 -+ -+#define IEEE80211_RADIOTAP_MCS_BW_MASK 0x03 -+#define IEEE80211_RADIOTAP_MCS_BW_20 0 -+#define IEEE80211_RADIOTAP_MCS_BW_40 1 -+#define IEEE80211_RADIOTAP_MCS_BW_20L 2 -+#define IEEE80211_RADIOTAP_MCS_BW_20U 3 -+#define IEEE80211_RADIOTAP_MCS_SGI 0x04 -+#define IEEE80211_RADIOTAP_MCS_FMT_GF 0x08 -+#define IEEE80211_RADIOTAP_MCS_FEC_LDPC 0x10 -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0)) -+#define IEEE80211_RADIOTAP_MCS_HAVE_STBC 0x20 -+ -+#define IEEE80211_RADIOTAP_MCS_STBC_MASK 0x60 -+#define IEEE80211_RADIOTAP_MCS_STBC_1 1 -+#define IEEE80211_RADIOTAP_MCS_STBC_2 2 -+#define IEEE80211_RADIOTAP_MCS_STBC_3 3 -+#define IEEE80211_RADIOTAP_MCS_STBC_SHIFT 5 -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 34)) -+#define IEEE80211_RADIOTAP_RADIOTAP_NAMESPACE 29 -+#define IEEE80211_RADIOTAP_VENDOR_NAMESPACE 30 -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 30)) -+#define IEEE80211_RADIOTAP_F_BADFCS 0x40 -+#endif -+ -+static inline void _rtw_radiotap_fill_flags(struct rx_pkt_attrib *a, u8 *flags) -+{ -+ struct moinfo *moif = (struct moinfo *)&a->moif; -+ -+ if (0) -+ *flags |= IEEE80211_RADIOTAP_F_CFP; -+ -+ if (0) -+ *flags |= IEEE80211_RADIOTAP_F_SHORTPRE; -+ -+ if ((a->encrypt == 1) || (a->encrypt == 5)) -+ *flags |= IEEE80211_RADIOTAP_F_WEP; -+ -+ if (a->mfrag) -+ *flags |= IEEE80211_RADIOTAP_F_FRAG; -+ -+ if (1) -+ *flags |= IEEE80211_RADIOTAP_F_FCS; -+ -+ if (0) -+ *flags |= IEEE80211_RADIOTAP_F_DATAPAD; -+ -+ if (a->crc_err) -+ *flags |= IEEE80211_RADIOTAP_F_BADFCS; -+ -+ /* Currently unspecified but used -+ for short guard interval (HT) */ -+ if (moif->u.snif_info.sgi || a->sgi) -+ *flags |= 0x80; -+ -+} -+ -+sint rtw_fill_radiotap_hdr(_adapter *padapter, struct rx_pkt_attrib *a, u8 *buf) -+{ -+#define RTAP_HDR_MAX 64 -+ -+ sint ret = _SUCCESS; -+ struct moinfo *moif = (struct moinfo *)&a->moif; -+ -+ u8 rx_cnt = 0; -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ int i = 0; -+ u8 tmp_8bit = 0; -+ u16 tmp_16bit = 0; -+ u32 tmp_32bit = 0; -+ u64 tmp_64bit = 0; -+ -+ _pkt *pskb = NULL; -+ -+ struct ieee80211_radiotap_header *rtap_hdr = NULL; -+ u8 *ptr = NULL; -+ -+ /* -+ radiotap length (include header 8) -+ 11G length: 36 (0x0040002f) -+ 11N length: -+ 11AC length: 60 (0x0070002b) -+ */ -+ u8 hdr_buf[RTAP_HDR_MAX] = { 0 }; -+ u16 rt_len = 8; -+ -+ /* create header */ -+ rtap_hdr = (struct ieee80211_radiotap_header *)&hdr_buf[0]; -+ rtap_hdr->it_version = PKTHDR_RADIOTAP_VERSION; -+ -+ /* each antenna information */ -+ rx_cnt = rf_type_to_rf_rx_cnt(pHalData->rf_type); -+#if 0 -+ if (rx_cnt > 1) { -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_RADIOTAP_NAMESPACE) | -+ BIT(IEEE80211_RADIOTAP_EXT); -+ -+ for (i = 1; i < rx_cnt; i++) { -+ tmp_32bit = (BIT(IEEE80211_RADIOTAP_DBM_ANTSIGNAL) | -+ BIT(IEEE80211_RADIOTAP_LOCK_QUALITY) | -+ BIT(IEEE80211_RADIOTAP_ANTENNA) | -+ BIT(IEEE80211_RADIOTAP_RADIOTAP_NAMESPACE) | -+ BIT(IEEE80211_RADIOTAP_EXT)); -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_32bit, 4); -+ rt_len += 4; -+ } -+ -+ tmp_32bit = (BIT(IEEE80211_RADIOTAP_DBM_ANTSIGNAL) | -+ BIT(IEEE80211_RADIOTAP_LOCK_QUALITY) | -+ BIT(IEEE80211_RADIOTAP_ANTENNA)); -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_32bit, 4); -+ rt_len += 4; -+ } -+#endif -+ -+ /* tsft, Required Alignment: 8 bytes */ -+ if (0) { //(a->free_cnt) { -+ /* TSFT + free_cnt */ -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_TSFT); -+ if (!IS_ALIGNED(rt_len, 8)) -+ rt_len = ((rt_len + 7) & 0xFFF8); /* Alignment */ -+ -+ tmp_64bit = cpu_to_le64(a->free_cnt); -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_64bit, 8); -+ rt_len += 8; -+ } -+ -+ /* flags */ -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_FLAGS); -+ _rtw_radiotap_fill_flags(a, &hdr_buf[rt_len]); -+ rt_len += 1; -+ -+ /* rate */ -+ if (a->data_rate <= DESC_RATE54M) { -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_RATE); -+ hdr_buf[rt_len] = hw_rate_to_m_rate(a->data_rate); -+ rt_len += 1; -+ } -+ -+ /* channel & flags, Required Alignment: 2 bytes */ -+ if (1) { -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_CHANNEL); -+ rt_len += (rt_len % 2); /* Alignment */ -+ -+ tmp_16bit = CHAN2FREQ(rtw_get_oper_ch(padapter)); -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ -+ /* channel flags */ -+ tmp_16bit = 0; -+ if (pHalData->current_band_type == 0) -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_2GHZ); -+ else -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_5GHZ); -+ -+ if (a->data_rate <= DESC_RATE11M) { -+ /* CCK */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_CCK); -+ } else { -+ /* OFDM */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_OFDM); -+ } -+ -+ if (rtw_get_oper_bw(padapter) == CHANNEL_WIDTH_10) { -+ /* 10Mhz Channel Width */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_HALF); -+ } -+ -+ if (rtw_get_oper_bw(padapter) == CHANNEL_WIDTH_5) { -+ /* 5Mhz Channel Width */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_QUARTER); -+ } -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ } -+ -+ /* dBm Antenna Signal */ -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_DBM_ANTSIGNAL); -+ hdr_buf[rt_len] = a->phy_info.recv_signal_power; -+ rt_len += 1; -+ -+#if 0 -+ /* dBm Antenna Noise */ -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_DBM_ANTNOISE); -+ hdr_buf[rt_len] = 0; -+ rt_len += 1; -+#endif -+#if 0 -+ /* Signal Quality, Required Alignment: 2 bytes */ -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_LOCK_QUALITY); -+ if (!IS_ALIGNED(rt_len, 2)) -+ rt_len++; -+ hdr_buf[rt_len] = a->phy_info.signal_quality; -+ rt_len += 2; -+ -+#endif -+ -+#if 0 -+ /* Antenna */ -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_ANTENNA); -+ hdr_buf[rt_len] = 0; /* pHalData->rf_type; */ -+ rt_len += 1; -+#endif -+#if 0 -+ /* RX flags, Required Alignment: 2 bytes */ -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_RX_FLAGS); -+ tmp_16bit = 0; -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+#endif -+ -+ /* MCS information, Required Alignment: 1 bytes */ -+ if (a->data_rate >= DESC_RATEMCS0 && a->data_rate <= DESC_RATEMCS31) { -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_MCS); -+ /* Structure u8 known, u8 flags, u8 mcs */ -+ -+ /* known.bandwidth */ -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_MCS_HAVE_BW; -+ if (moif->u.snif_info.ofdm_bw) -+ hdr_buf[rt_len + 1] |= IEEE80211_RADIOTAP_MCS_BW_40; -+ if (a->bw == CHANNEL_WIDTH_40) -+ hdr_buf[rt_len + 1] |= IEEE80211_RADIOTAP_MCS_BW_40; -+ else -+ hdr_buf[rt_len + 1] |= IEEE80211_RADIOTAP_MCS_BW_20; -+ -+ -+ /* known.guard interval */ -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_MCS_HAVE_GI; -+ if (moif->u.snif_info.sgi) { -+ hdr_buf[rt_len + 1] |= IEEE80211_RADIOTAP_MCS_SGI; -+ } else { -+ hdr_buf[rt_len + 1] |= ((a->sgi & 0x01) << 2); -+ } -+ -+ /* FEC Type */ -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_MCS_HAVE_FEC; -+ if (moif->u.snif_info.ldpc) { -+ hdr_buf[rt_len + 1] |= ((moif->u.snif_info.ldpc & 0x01) << 4); -+ } else { -+ hdr_buf[rt_len + 1] |= ((a->ldpc & 0x01) << 4); -+ } -+ -+ /* STBC */ -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_MCS_HAVE_STBC; -+ if (moif->u.snif_info.stbc) { -+ hdr_buf[rt_len + 1] |= ((moif->u.snif_info.stbc & 0x03) << 5); -+ } else { -+ hdr_buf[rt_len + 1] |= ((a->stbc & 0x03) << 5); -+ } -+ -+ /* known.MCS index */ -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_MCS_HAVE_MCS; -+ -+ /* u8 mcs */ -+ hdr_buf[rt_len + 2] = a->data_rate - DESC_RATEMCS0; -+ -+ rt_len += 3; -+ } -+ -+ /* AMPDU, Required Alignment: 4 bytes */ -+ if (a->ampdu) { -+ static u32 ref_num = 0x10000000; -+ static u8 ppdu_cnt = 0; -+ -+ /* Structure u32 reference number, u16 flags, u8 delimiter CRC value, u8 reserved */ -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_AMPDU_STATUS); -+ if (!IS_ALIGNED(rt_len, 4)) -+ rt_len = ((rt_len + 3) & 0xFFFC); /* Alignment */ -+ -+ /* u32 reference number */ -+ if (a->ppdu_cnt != ppdu_cnt) { -+ ppdu_cnt = a->ppdu_cnt; -+ ref_num += 1; -+ } -+ tmp_32bit = cpu_to_le32(ref_num); -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_32bit, 4); -+ rt_len += 4; -+ -+ /* u16 flags */ -+ tmp_16bit = 0; -+ if (0) { -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_REPORT_ZEROLEN); -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_IS_ZEROLEN); -+ } -+ -+ if (0) { -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_IS_LAST); -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_LAST_KNOWN); -+ } -+ -+ if (0) { -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_DELIM_CRC_ERR); -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_DELIM_CRC_KNOWN); -+ } -+ -+ if (a->ampdu_eof) { -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_EOF_KNOWN); -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_AMPDU_EOF); -+ } -+ -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ -+ /* u8 delimiter CRC value, u8 reserved */ -+ rt_len += 2; -+ } -+ -+ /* VHT, Required Alignment: 2 bytes */ -+ if (a->data_rate >= DESC_RATEVHTSS1MCS0 && a->data_rate <= DESC_RATEVHTSS4MCS9) { -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_VHT); -+ -+ rt_len += (rt_len % 2); /* Alignment */ -+ -+ /* Structure -+ u16 known, u8 flags, u8 bandwidth, u8 mcs_nss[4], -+ u8 coding, u8 group_id, u16 partial_aid */ -+ -+ tmp_16bit = 0; -+ -+ /* STBC */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_STBC); -+ if (moif->u.snif_info.stbc) { -+ hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_STBC; -+ } else { -+ hdr_buf[rt_len + 2] |= (a->stbc & 0x01); -+ } -+ -+ /* TXOP_PS_NOT_ALLOWED */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_TXOP_PS_NA); -+ if (moif->u.snif_info.vht_txop_not_allow) { -+ hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_TXOP_PS_NA; -+ } -+ -+ -+ /* Guard interval */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_GI); -+ if (moif->u.snif_info.sgi) { -+ hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_SGI; -+ } else { -+ hdr_buf[rt_len + 2] |= ((a->sgi & 0x01) << 2); -+ } -+ -+ /* Short GI NSYM */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_SGI_NSYM_DIS); -+ if (moif->u.snif_info.vht_nsym_dis) { -+ hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_SGI_NSYM_M10_9; -+ } -+ -+ /* LDPC extra OFDM symbol */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_LDPC_EXTRA_OFDM_SYM); -+ if (moif->u.snif_info.vht_ldpc_extra) { -+ hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_LDPC_EXTRA_OFDM_SYM; -+ } else { -+ hdr_buf[rt_len + 2] |= ((a->ldpc & 0x01) << 4); -+ } -+ -+ /* Short GI NSYM */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_BEAMFORMED); -+ if (moif->u.snif_info.vht_beamformed) { -+ hdr_buf[rt_len + 2] |= IEEE80211_RADIOTAP_VHT_FLAG_BEAMFORMED; -+ } -+ -+ /* know.Bandwidth */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_BANDWIDTH); -+ -+ /* Group ID */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_GROUP_ID); -+ -+ /* Partial AID */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_RADIOTAP_VHT_KNOWN_PARTIAL_AID); -+ -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 3; -+ -+ /* u8 bandwidth */ -+ if (moif->u.snif_info.ofdm_bw) -+ tmp_8bit = moif->u.snif_info.ofdm_bw; -+ else -+ tmp_8bit = a->bw; -+ -+ switch (tmp_8bit) { -+ case CHANNEL_WIDTH_20: -+ hdr_buf[rt_len] |= 0; -+ break; -+ case CHANNEL_WIDTH_40: -+ hdr_buf[rt_len] |= 1; -+ break; -+ case CHANNEL_WIDTH_80: -+ hdr_buf[rt_len] |= 4; -+ break; -+ case CHANNEL_WIDTH_160: -+ hdr_buf[rt_len] |= 11; -+ break; -+ default: -+ hdr_buf[rt_len] |= 0; -+ } -+ rt_len += 1; -+ -+ /* u8 mcs_nss[4] */ -+ if ((DESC_RATEVHTSS1MCS0 <= a->data_rate) && -+ (a->data_rate <= DESC_RATEVHTSS4MCS9)) { -+ /* User 0 */ -+ /* MCS */ -+ hdr_buf[rt_len] = ((a->data_rate - DESC_RATEVHTSS1MCS0) % 10) << 4; -+ /* NSS */ -+ hdr_buf[rt_len] |= (((a->data_rate - DESC_RATEVHTSS1MCS0) / 10) + 1); -+ } -+ rt_len += 4; -+ -+ /* u8 coding, phystat? */ -+ hdr_buf[rt_len] = 0; -+ rt_len += 1; -+ -+ /* u8 group_id */ -+ hdr_buf[rt_len] = moif->u.snif_info.vht_group_id; -+ rt_len += 1; -+ -+ /* u16 partial_aid */ -+ tmp_16bit = cpu_to_le16(moif->u.snif_info.vht_nsts_aid); -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ } -+ -+ /* frame timestamp, Required Alignment: 8 bytes */ -+ if (0) { //(a->free_cnt) { -+ rtap_hdr->it_present |= BIT(IEEE80211_RADIOTAP_TIMESTAMP); -+ if (!IS_ALIGNED(rt_len, 8)) -+ rt_len = ((rt_len + 7) & 0xFFF8); /* Alignment */ -+ -+ /* u64 timestamp */ -+ tmp_64bit = cpu_to_le64(a->free_cnt); -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_64bit, 8); -+ rt_len += 8; -+ -+ /* u16 accuracy */ -+ tmp_16bit = cpu_to_le16(22); -+ _rtw_memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ -+ /* u8 unit/position */ -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_TIMESTAMP_UNIT_US; -+ rt_len += 1; -+ -+ /* u8 flags */ -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_TIMESTAMP_FLAG_32BIT; -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_TIMESTAMP_FLAG_ACCURACY; -+ rt_len += 1; -+ } -+ -+ /* each antenna information */ -+#if 0 -+ if (rx_cnt > 1) { -+ for (i = 0; i <= rx_cnt; i++) { -+ /* dBm Antenna Signal */ -+ hdr_buf[rt_len] = a->phy_info.rx_mimo_signal_strength[i]; -+ rt_len += 1; -+ -+ /* Signal Quality */ -+ if (!IS_ALIGNED(rt_len, 2)) -+ rt_len++; -+ hdr_buf[rt_len] = cpu_to_le16(a->phy_info.rx_mimo_signal_quality[i]); -+ rt_len += 2; -+ -+ /* Antenna */ -+ hdr_buf[rt_len] = i; /* pHalData->rf_type; */ -+ rt_len += 1; -+ } -+ } -+#endif -+ -+ /* 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); -+ rtap_hdr->it_present = cpu_to_le32(rtap_hdr->it_present); -+ memcpy(ptr, rtap_hdr, rt_len); -+ } else -+ ret = _FAIL; -+ -+ return ret; -+ -+} -+ -+void rx_query_moinfo(struct rx_pkt_attrib *a, u8 *desc) -+{ -+ switch (a->drvinfo_sz) { -+ case 40: -+ _rtw_memcpy(a->moif, &desc[32], 8); -+ break; -+ case 48: -+ _rtw_memcpy(a->moif, &desc[32], 12); -+ break; -+ case 32: -+ /* passthrough */ -+ default: -+ break; -+ } -+} -+ -+#endif /* CONFIG_WIFI_MONITOR */ -diff --git a/drivers/net/wireless/rtl8821cs/core/monitor/rtw_radiotap.h b/drivers/net/wireless/rtl8821cs/core/monitor/rtw_radiotap.h -new file mode 100644 -index 000000000..affacd185 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/monitor/rtw_radiotap.h -@@ -0,0 +1,63 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_RADIOTAP_H_ -+#define __RTW_RADIOTAP_H_ -+ -+struct mon_reg_backup { -+ /* flags */ -+ u8 known_rcr:1; -+ u8 known_drvinfo:1; -+ u8 known_rxfilter:1; -+ u8 known_misc0:1; -+ /* data */ -+ u8 drvinfo; -+ u16 rxfilter0; -+ u16 rxfilter1; -+ u16 rxfilter2; -+ u32 rcr; -+ u32 misc0; -+}; -+ -+struct moinfo { -+ union { -+ struct { -+ u32 sgi:1; -+ u32 ldpc:1; -+ u32 stbc:2; -+ u32 not_sounding:1; -+ u32 ofdm_bw:2; -+ u32 vht_group_id:2; -+ u32 vht_nsts_aid:12; -+ u32 vht_txop_not_allow:1; -+ u32 vht_nsym_dis:1; -+ u32 vht_ldpc_extra:1; -+ u32 vht_su_mcs:12; -+ u32 vht_beamformed:1; -+ }snif_info; -+ -+ struct { -+ u32 A; -+ u32 B; -+ u32 C; -+ }plcp_info; -+ }u; -+}; -+ -+sint rtw_fill_radiotap_hdr(_adapter *padapter, struct rx_pkt_attrib *a, u8 *buf); -+ -+void rx_query_moinfo(struct rx_pkt_attrib *a, u8 *desc); -+ -+#endif /* __RTW_RADIOTAP_H_ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_ap.c b/drivers/net/wireless/rtl8821cs/core/rtw_ap.c -new file mode 100755 -index 000000000..070318e28 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_ap.c -@@ -0,0 +1,6251 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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_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); -+ -+} -+ -+/* -+* Set TIM IE -+* return length of total TIM IE -+*/ -+u8 rtw_set_tim_ie(u8 dtim_cnt, u8 dtim_period -+ , const u8 *tim_bmp, u8 tim_bmp_len, u8 *tim_ie) -+{ -+ u8 *p = tim_ie; -+ u8 i, n1, n2; -+ u8 bmp_len; -+ -+ if (rtw_bmp_not_empty(tim_bmp, tim_bmp_len)) { -+ /* find the first nonzero octet in tim_bitmap */ -+ for (i = 0; i < tim_bmp_len; i++) -+ if (tim_bmp[i]) -+ break; -+ n1 = i & 0xFE; -+ -+ /* find the last nonzero octet in tim_bitmap, except octet 0 */ -+ for (i = tim_bmp_len - 1; i > 0; i--) -+ if (tim_bmp[i]) -+ break; -+ n2 = i; -+ bmp_len = n2 - n1 + 1; -+ } else { -+ n1 = n2 = 0; -+ bmp_len = 1; -+ } -+ -+ *p++ = WLAN_EID_TIM; -+ *p++ = 2 + 1 + bmp_len; -+ *p++ = dtim_cnt; -+ *p++ = dtim_period; -+ *p++ = (rtw_bmp_is_set(tim_bmp, tim_bmp_len, 0) ? BIT0 : 0) | n1; -+ _rtw_memcpy(p, tim_bmp + n1, bmp_len); -+ -+#if 0 -+ RTW_INFO("n1:%u, n2:%u, bmp_offset:%u, bmp_len:%u\n", n1, n2, n1 / 2, bmp_len); -+ RTW_INFO_DUMP("tim_ie: ", tim_ie + 2, 2 + 1 + bmp_len); -+#endif -+ return 2 + 2 + 1 + bmp_len; -+} -+ -+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(rtw_tim_map_anyone_be_set(padapter, pstapriv->tim_bitmap)) */ -+#endif -+ if (_TRUE) { -+ u8 *p, *dst_ie, *premainder_ie = NULL, *pbackup_remainder_ie = NULL; -+ uint offset, tmp_len, tim_ielen, tim_ie_offset, remainder_ielen; -+ -+ 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); -+ } -+ -+ /* append TIM IE */ -+ dst_ie += rtw_set_tim_ie(0, 1, pstapriv->tim_bitmap, pstapriv->aid_bmp_len, dst_ie); -+ -+ /*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 = 0, ie_offset, remainder_ielen = 0; -+ -+ /* Search element id (index) exits or not */ -+ 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); -+ } -+ -+ /* Backup remainder IE */ -+ 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; -+ -+ /* Append 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->cmn.mac_addr) -+ , psta->cmn.rssi_stat.rssi -+ /* , 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; -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(psta->padapter)) { -+ u8 bcn_alive, hwmp_alive; -+ -+ hwmp_alive = (psta->sta_stats.rx_hwmp_pkts != -+ psta->sta_stats.last_rx_hwmp_pkts); -+ bcn_alive = (psta->sta_stats.rx_beacon_pkts != -+ psta->sta_stats.last_rx_beacon_pkts); -+ /* The reference for nexthop_lookup */ -+ psta->alive = ret || hwmp_alive || bcn_alive; -+ /* The reference for expire_timeout_chk */ -+ /* Exclude bcn_alive to avoid a misjudge condition -+ that a peer unexpectedly leave and restart quickly*/ -+ ret = ret || hwmp_alive; -+ } -+#endif -+ -+ sta_update_last_rx_pkts(psta); -+ -+ return ret; -+} -+ -+/** -+ * issue_aka_chk_frame - issue active keep alive check frame -+ * aka = active keep alive -+ */ -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+static int issue_aka_chk_frame(_adapter *adapter, struct sta_info *psta) -+{ -+ int ret = _FAIL; -+ u8 *target_addr = psta->cmn.mac_addr; -+ -+ if (MLME_IS_AP(adapter)) { -+ /* issue null data to check sta alive */ -+ if (psta->state & WIFI_SLEEP_STATE) -+ ret = issue_nulldata(adapter, target_addr, 0, 1, 50); -+ else -+ ret = issue_nulldata(adapter, target_addr, 0, 3, 50); -+ } -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(adapter)) { -+ struct rtw_mesh_path *mpath; -+ -+ rtw_rcu_read_lock(); -+ mpath = rtw_mesh_path_lookup(adapter, target_addr); -+ if (!mpath) { -+ mpath = rtw_mesh_path_add(adapter, target_addr); -+ if (IS_ERR(mpath)) { -+ rtw_rcu_read_unlock(); -+ RTW_ERR(FUNC_ADPT_FMT" rtw_mesh_path_add for "MAC_FMT" fail.\n", -+ FUNC_ADPT_ARG(adapter), MAC_ARG(target_addr)); -+ return _FAIL; -+ } -+ } -+ if (mpath->flags & RTW_MESH_PATH_ACTIVE) -+ ret = _SUCCESS; -+ else { -+ u8 flags = RTW_PREQ_Q_F_START | RTW_PREQ_Q_F_PEER_AKA; -+ /* issue PREQ to check peer alive */ -+ rtw_mesh_queue_preq(mpath, flags); -+ ret = _FALSE; -+ } -+ rtw_rcu_read_unlock(); -+ } -+#endif -+ return ret; -+} -+#endif -+ -+#ifdef RTW_CONFIG_RFREG18_WA -+static void rtw_check_restore_rf18(_adapter *padapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u32 reg; -+ u8 union_ch = 0, union_bw = 0, union_offset = 0, setchbw = _FALSE; -+ -+ reg = rtw_hal_read_rfreg(padapter, 0, 0x18, 0x3FF); -+ if ((reg & 0xFF) == 0) -+ setchbw = _TRUE; -+ reg = rtw_hal_read_rfreg(padapter, 1, 0x18, 0x3FF); -+ if ((reg & 0xFF) == 0) -+ setchbw = _TRUE; -+ -+ if (setchbw) { -+ if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset)) { -+ RTW_INFO("Hit RF(0x18)=0!! restore original channel setting.\n"); -+ union_ch = pmlmeext->cur_channel; -+ union_offset = pmlmeext->cur_ch_offset ; -+ union_bw = pmlmeext->cur_bwmode; -+ } else { -+ RTW_INFO("Hit RF(0x18)=0!! set ch(%x) offset(%x) bwmode(%x)\n", union_ch, union_offset, union_bw); -+ } -+ /* Initial the channel_bw setting procedure. */ -+ pHalData->current_channel = 0; -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ } -+} -+#endif -+ -+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; -+ int stainfo_offset; -+ u8 flush_num = 0; -+ char flush_list[NUM_STA]={0}; -+ u8 data_flush = _FALSE; -+ #ifdef CONFIG_RTW_MGMT_QUEUE -+ u8 mgmt_flush = _FALSE; -+ #endif -+ struct dvobj_priv *dvobj = NULL; -+ struct rf_ctl_t *rfctl; -+ dvobj = adapter_to_dvobj(padapter); -+ rfctl = dvobj_to_rfctl(dvobj); -+ -+ /* AP is under CAC, so don't check STA alive or not */ -+ if (IS_UNDER_CAC(rfctl)) -+ return; -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter) -+ && check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) -+ ) { -+ struct rtw_mesh_cfg *mcfg = &padapter->mesh_cfg; -+ -+ rtw_mesh_path_expire(padapter); -+ -+ /* TBD: up layer timeout mechanism */ -+ /* if (!mcfg->plink_timeout) -+ return; */ -+#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ return; -+#endif -+ } -+#endif -+ -+#ifdef CONFIG_RTW_WDS -+ rtw_wds_path_expire(padapter); -+#endif -+ -+#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_ADPT_FMT" auth_list, cnt:%u\n" -+ , FUNC_ADPT_ARG(padapter), 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 (_rtw_memcmp((void *)(pstapriv->atmel_rc_pattern), (void *)(psta->cmn.mac_addr), ETH_ALEN) == _TRUE) -+ continue; -+ if (psta->flag_atmel_rc) -+ continue; -+#endif -+ if (psta->expire_to > 0) { -+ psta->expire_to--; -+ if (psta->expire_to == 0) { -+ 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->auth_list_lock, &irqL); -+ for (i = 0; i < flush_num; i++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, flush_list[i]); -+ RTW_INFO(FUNC_ADPT_FMT" auth expire "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); -+ rtw_free_stainfo(padapter, psta); -+ 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_ADPT_FMT" asoc_list, cnt:%u\n" -+ , FUNC_ADPT_ARG(padapter), 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->cmn.mac_addr[0], psta->cmn.mac_addr[5]); -+ if (_rtw_memcmp((void *)pstapriv->atmel_rc_pattern, (void *)(psta->cmn.mac_addr), ETH_ALEN) == _TRUE) -+ 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; -+ #if !defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && defined(CONFIG_80211N_HT) -+ psta->under_exist_checking = 0; -+ #endif -+ } else -+ psta->expire_to--; -+ -+#if !defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && defined(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 */ -+ /* 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->cmn.mac_addr);/* */ /* originator */ -+ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ -+ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ -+ } -+ } -+#endif /* !defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && defined(CONFIG_80211N_HT) */ -+ -+ 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->cmn.mac_addr, (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->cmn.mac_addr)); */ -+ -+ /* to update bcn with tim_bitmap for this station */ -+ rtw_tim_map_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid); -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0); -+ -+ if (!pmlmeext->active_keep_alive_check) -+ continue; -+ } -+ } -+ -+ { -+ 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; -+ } -+ } else { -+ /* TODO: Aging mechanism to digest frames in sleep_q to avoid running out of xmitframe */ -+ -+ #ifdef CONFIG_RTW_MGMT_QUEUE -+ if (psta->mgmt_sleepq_len >= (NR_XMIT_EXTBUFF / pstapriv->asoc_list_cnt) -+ && padapter->xmitpriv.free_xframe_ext_cnt < ((NR_XMIT_EXTBUFF / pstapriv->asoc_list_cnt) / 2)) -+ mgmt_flush = _TRUE; -+ #endif -+ -+ if (psta->sleepq_len >= (NR_XMITFRAME / pstapriv->asoc_list_cnt) -+ && padapter->xmitpriv.free_xmitframe_cnt < ((NR_XMITFRAME / pstapriv->asoc_list_cnt) / 2)) -+ data_flush = _TRUE; -+ -+ if (data_flush -+ #ifdef CONFIG_RTW_MGMT_QUEUE -+ || mgmt_flush -+ #endif -+ ) { -+ RTW_INFO(FUNC_ADPT_FMT" sta:"MAC_FMT", flush sta's data and management frames\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); -+ RTW_INFO("sleepq_len:%u, free_xmitframe_cnt:%u, asoc_list_cnt:%u, clear sleep_q\n" -+ , psta->sleepq_len, padapter->xmitpriv.free_xmitframe_cnt, pstapriv->asoc_list_cnt); -+ #ifdef CONFIG_RTW_MGMT_QUEUE -+ RTW_INFO("mgmt_sleepq_len:%u, free_xframe_ext_cnt:%u, asoc_list_cnt:%u, clear mgmt_sleep_q\n" -+ , psta->mgmt_sleepq_len, padapter->xmitpriv.free_xframe_ext_cnt, pstapriv->asoc_list_cnt); -+ #endif -+ wakeup_sta_to_xmit(padapter, psta, ALL_FRAME); -+ } -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ if (chk_alive_num) { -+#if defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) -+ u8 backup_ch = 0, backup_bw = 0, backup_offset = 0; -+ u8 union_ch = 0, union_bw = 0, union_offset = 0; -+ u8 switch_channel_by_drv = _TRUE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+#endif -+ char del_asoc_list[NUM_STA]; -+ -+ _rtw_memset(del_asoc_list, NUM_STA, NUM_STA); -+ -+ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ if (pmlmeext->active_keep_alive_check) { -+ #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_by_drv = _FALSE; -+ } -+ #endif -+ -+ if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset) -+ || pmlmeext->cur_channel != union_ch) -+ switch_channel_by_drv = _FALSE; -+ -+ /* switch to correct channel of current network before issue keep-alive frames */ -+ if (switch_channel_by_drv == _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); -+ } -+ } -+ #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ -+ /* check loop */ -+ for (i = 0; i < chk_alive_num; i++) { -+ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ int ret = _FAIL; -+ #endif -+ -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+ -+ #ifdef CONFIG_ATMEL_RC_PATCH -+ if (_rtw_memcmp(pstapriv->atmel_rc_pattern, psta->cmn.mac_addr, ETH_ALEN) == _TRUE) -+ continue; -+ if (psta->flag_atmel_rc) -+ continue; -+ #endif -+ -+ if (!(psta->state & WIFI_ASOC_STATE)) -+ continue; -+ -+ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ if (pmlmeext->active_keep_alive_check) { -+ /* issue active keep alive frame to check */ -+ ret = issue_aka_chk_frame(padapter, psta); -+ -+ psta->keep_alive_trycnt++; -+ if (ret == _SUCCESS) { -+ RTW_INFO(FUNC_ADPT_FMT" asoc check, "MAC_FMT" is alive\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); -+ psta->expire_to = pstapriv->expire_to; -+ psta->keep_alive_trycnt = 0; -+ continue; -+ } else if (psta->keep_alive_trycnt <= 3) { -+ RTW_INFO(FUNC_ADPT_FMT" asoc check, "MAC_FMT" keep_alive_trycnt=%d\n" -+ , FUNC_ADPT_ARG(padapter) , MAC_ARG(psta->cmn.mac_addr), psta->keep_alive_trycnt); -+ psta->expire_to = 1; -+ continue; -+ } -+ } -+ #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ -+ psta->keep_alive_trycnt = 0; -+ del_asoc_list[i] = chk_alive_list[i]; -+ _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--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (psta->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt--; -+ #endif -+ STA_SET_MESH_PLINK(psta, NULL); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ } -+ -+ /* delete loop */ -+ for (i = 0; i < chk_alive_num; i++) { -+ u8 sta_addr[ETH_ALEN]; -+ -+ if (del_asoc_list[i] >= NUM_STA) -+ continue; -+ -+ psta = rtw_get_stainfo_by_offset(pstapriv, del_asoc_list[i]); -+ _rtw_memcpy(sta_addr, psta->cmn.mac_addr, ETH_ALEN); -+ -+ RTW_INFO(FUNC_ADPT_FMT" asoc expire "MAC_FMT", state=0x%x\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr), psta->state); -+ updated |= ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING, _FALSE); -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) -+ rtw_mesh_expire_peer(padapter, sta_addr); -+ #endif -+ } -+ -+ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ if (pmlmeext->active_keep_alive_check) { -+ /* back to the original operation channel */ -+ if (switch_channel_by_drv == _TRUE && backup_ch > 0) -+ set_channel_bwmode(padapter, backup_ch, backup_offset, backup_bw); -+ } -+ #endif -+ } -+ -+#ifdef RTW_CONFIG_RFREG18_WA -+ rtw_check_restore_rf18(padapter); -+#endif -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+} -+ -+void rtw_ap_update_sta_ra_info(_adapter *padapter, struct sta_info *psta) -+{ -+ unsigned char sta_band = 0; -+ u64 tx_ra_bitmap = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ -+ if (!psta) -+ return; -+ -+ if (!(psta->state & WIFI_ASOC_STATE)) -+ return; -+ -+ rtw_hal_update_sta_ra_info(padapter, psta); -+ tx_ra_bitmap = psta->cmn.ra_info.ramask; -+ -+ 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; -+ rtw_hal_update_sta_wset(padapter, psta); -+ RTW_INFO("%s=> mac_id:%d , tx_ra_bitmap:0x%016llx, networkType:0x%02x\n", -+ __FUNCTION__, psta->cmn.mac_id, tx_ra_bitmap, psta->wireless_mode); -+} -+ -+#ifdef CONFIG_BMC_TX_RATE_SELECT -+u8 rtw_ap_find_mini_tx_rate(_adapter *adapter) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 miini_tx_rate = ODM_RATEVHTSS4MCS9, sta_tx_rate; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &adapter->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); -+ -+ sta_tx_rate = psta->cmn.ra_info.curr_tx_rate & 0x7F; -+ if (sta_tx_rate < miini_tx_rate) -+ miini_tx_rate = sta_tx_rate; -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ return miini_tx_rate; -+} -+ -+u8 rtw_ap_find_bmc_rate(_adapter *adapter, u8 tx_rate) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ u8 tx_ini_rate = ODM_RATE6M; -+ -+ 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: -+ tx_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: -+ tx_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: -+ tx_ini_rate = ODM_RATE6M; -+ break; -+ case ODM_RATE11M: -+ case ODM_RATE5_5M: -+ case ODM_RATE2M: -+ case ODM_RATE1M: -+ tx_ini_rate = ODM_RATE1M; -+ break; -+ default: -+ tx_ini_rate = ODM_RATE6M; -+ break; -+ } -+ -+ if (hal_data->current_band_type == BAND_ON_5G) -+ if (tx_ini_rate < ODM_RATE6M) -+ tx_ini_rate = ODM_RATE6M; -+ -+ return tx_ini_rate; -+} -+ -+void rtw_update_bmc_sta_tx_rate(_adapter *adapter) -+{ -+ struct sta_info *psta = NULL; -+ u8 tx_rate; -+ -+ psta = rtw_get_bcmc_stainfo(adapter); -+ if (psta == NULL) { -+ RTW_ERR(ADPT_FMT "could not get bmc_sta !!\n", ADPT_ARG(adapter)); -+ return; -+ } -+ -+ if (adapter->bmc_tx_rate != MGN_UNKNOWN) { -+ psta->init_rate = adapter->bmc_tx_rate; -+ goto _exit; -+ } -+ -+ if (adapter->stapriv.asoc_sta_count <= 2) -+ goto _exit; -+ -+ tx_rate = rtw_ap_find_mini_tx_rate(adapter); -+ #ifdef CONFIG_BMC_TX_LOW_RATE -+ tx_rate = rtw_ap_find_bmc_rate(adapter, tx_rate); -+ #endif -+ -+ psta->init_rate = hw_rate_to_m_rate(tx_rate); -+ -+_exit: -+ RTW_INFO(ADPT_FMT" BMC Tx rate - %s\n", ADPT_ARG(adapter), MGN_RATE_STR(psta->init_rate)); -+} -+#endif -+ -+void rtw_init_bmc_sta_tx_rate(_adapter *padapter, struct sta_info *psta) -+{ -+#ifdef CONFIG_BMC_TX_LOW_RATE -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+#endif -+ u8 rate_idx = 0; -+ u8 brate_table[] = {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}; -+ -+ if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) -+ return; -+ -+ if (padapter->bmc_tx_rate != MGN_UNKNOWN) -+ psta->init_rate = padapter->bmc_tx_rate; -+ else { -+ #ifdef CONFIG_BMC_TX_LOW_RATE -+ if (IsEnableHWOFDM(pmlmeext->cur_wireless_mode) && (psta->cmn.ra_info.ramask && 0xFF0)) -+ rate_idx = get_lowest_rate_idx_ex(psta->cmn.ra_info.ramask, 4); /*from basic rate*/ -+ else -+ rate_idx = get_lowest_rate_idx(psta->cmn.ra_info.ramask); /*from basic rate*/ -+ #else -+ rate_idx = get_highest_rate_idx(psta->cmn.ra_info.ramask); /*from basic rate*/ -+ #endif -+ if (rate_idx < 12) -+ psta->init_rate = brate_table[rate_idx]; -+ else -+ psta->init_rate = MGN_1M; -+ } -+ -+ RTW_INFO(ADPT_FMT" BMC Init Tx rate - %s\n", ADPT_ARG(padapter), MGN_RATE_STR(psta->init_rate)); -+} -+ -+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->cmn.aid = 0;/* default set to 0 */ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) -+ psta->qos_option = 1; -+ else -+#endif -+ 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. */ -+ -+ 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_ra_info(padapter, psta); -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state = WIFI_ASOC_STATE; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ rtw_sta_media_status_rpt(padapter, psta, 1); -+ rtw_init_bmc_sta_tx_rate(padapter, psta); -+ -+ } else -+ RTW_INFO("add_RATid_bmc_sta error!\n"); -+ -+} -+ -+#if defined(CONFIG_80211N_HT) && defined(CONFIG_BEAMFORMING) -+void update_sta_info_apmode_ht_bf_cap(_adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+ struct ht_priv *phtpriv_sta = &psta->htpriv; -+ -+ u8 cur_beamform_cap = 0; -+ -+ /*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->cmn.aid, cur_beamform_cap); -+ -+ phtpriv_sta->beamform_cap = cur_beamform_cap; -+ psta->cmn.bf_info.ht_beamform_cap = cur_beamform_cap; -+ -+} -+#endif /*CONFIG_80211N_HT && CONFIG_BEAMFORMING*/ -+ -+/* 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; -+ /* 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()*/ -+ -+ if (!MLME_IS_MESH(padapter) && 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->cmn.bw_mode = CHANNEL_WIDTH_40; -+ else -+ psta->cmn.bw_mode = CHANNEL_WIDTH_20; -+ -+ if (phtpriv_sta->op_present -+ && !GET_HT_OP_ELE_STA_CHL_WIDTH(phtpriv_sta->ht_op)) -+ psta->cmn.bw_mode = CHANNEL_WIDTH_20; -+ -+ if ((psta->ht_40mhz_intolerant)||(pmlmepriv->sw_to_20mhz)) -+ psta->cmn.bw_mode = CHANNEL_WIDTH_20; -+ -+ if (pmlmeext->cur_bwmode < psta->cmn.bw_mode) -+ psta->cmn.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->cmn.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->cmn.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->cmn.aid); -+ } -+ -+ #ifdef CONFIG_BEAMFORMING -+ update_sta_info_apmode_ht_bf_cap(padapter, psta); -+ #endif -+ } else { -+ phtpriv_sta->ampdu_enable = _FALSE; -+ -+ phtpriv_sta->sgi_20m = _FALSE; -+ phtpriv_sta->sgi_40m = _FALSE; -+ psta->cmn.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; -+ -+ /* Rx AMPDU */ -+ send_delba(padapter, 0, psta->cmn.mac_addr);/* recipient */ -+ -+ /* TX AMPDU */ -+ send_delba(padapter, 1, psta->cmn.mac_addr);/* */ /* 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 -+ psta->cmn.ra_info.is_support_sgi = query_ra_short_GI(psta, rtw_get_tx_bw_mode(padapter, psta)); -+ 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() */ -+ -+ /* ap mode */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ -+ /* Check encryption */ -+ if (!MLME_IS_MESH(padapter) && psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) -+ psta->state |= WIFI_UNDER_KEY_HANDSHAKE; -+ -+ psta->state |= WIFI_ASOC_STATE; -+ -+ _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 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->cmn.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 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; -+#ifdef CONFIG_80211N_HT -+ if (pregpriv->ht_enable && -+ (is_supported_5g(pmlmeext->cur_wireless_mode) || -+ (pmlmeext->cur_wireless_mode & WIRELESS_11_24N))) -+ aSifsTime = 16; -+ else -+#endif /* CONFIG_80211N_HT */ -+ 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]); -+ } -+ -+ } -+ -+} -+#ifdef CONFIG_80211N_HT -+static void update_hw_ht_param(_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); -+ -+ 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; */ -+ -+} -+#endif /* CONFIG_80211N_HT */ -+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_RTW_ACS -+ if (padapter->registrypriv.acs_auto_scan) { -+ do_scan = _TRUE; -+ reason |= RTW_AUTO_SCAN_REASON_ACS; -+ rtw_acs_start(padapter); -+ } -+#endif/*CONFIG_RTW_ACS*/ -+ -+ 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_RTW_ACS -+ if (padapter->registrypriv.acs_auto_scan) -+ rtw_acs_stop(padapter); -+#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_chset_search_ch(adapter_to_chset(padapter), 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); -+} -+ -+#ifdef CONFIG_FW_HANDLE_TXBCN -+bool rtw_ap_nums_check(_adapter *adapter) -+{ -+ if (rtw_ap_get_nums(adapter) < CONFIG_LIMITED_AP_NUM) -+ return _TRUE; -+ return _FALSE; -+} -+u8 rtw_ap_allocate_vapid(struct dvobj_priv *dvobj) -+{ -+ u8 vap_id; -+ -+ for (vap_id = 0; vap_id < CONFIG_LIMITED_AP_NUM; vap_id++) { -+ if (!(dvobj->vap_map & BIT(vap_id))) -+ break; -+ } -+ -+ if (vap_id < CONFIG_LIMITED_AP_NUM) -+ dvobj->vap_map |= BIT(vap_id); -+ -+ return vap_id; -+} -+u8 rtw_ap_release_vapid(struct dvobj_priv *dvobj, u8 vap_id) -+{ -+ if (vap_id >= CONFIG_LIMITED_AP_NUM) { -+ RTW_ERR("%s - vapid(%d) failed\n", __func__, vap_id); -+ rtw_warn_on(1); -+ return _FAIL; -+ } -+ dvobj->vap_map &= ~ BIT(vap_id); -+ return _SUCCESS; -+} -+#endif -+static void _rtw_iface_undersurvey_chk(const char *func, _adapter *adapter) -+{ -+ int i; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mlme_priv *pmlmepriv; -+ -+ 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_UNDER_SURVEY)) -+ RTW_ERR("%s ("ADPT_FMT") under survey\n", func, ADPT_ARG(iface)); -+ } -+ } -+} -+void start_bss_network(_adapter *padapter, struct createbss_parm *parm) -+{ -+#define DUMP_ADAPTERS_STATUS 0 -+ u8 mlme_act = MLME_ACTION_UNKNOWN; -+ 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 = REQ_CH_NONE, req_bw = REQ_BW_NONE, req_offset = REQ_OFFSET_NONE; -+ u8 u_ch = 0, u_bw, u_offset; -+ bool set_u_ch; -+ u8 doiqk = _FALSE; -+ /* use for check ch bw offset can be allowed or not */ -+ u8 chbw_allow = _TRUE; -+ int i; -+ u8 ifbmp_ch_changed = 0; -+ -+ if (parm->req_ch != 0) { -+ /* bypass other setting, go checking ch, bw, offset */ -+ mlme_act = MLME_OPCH_SWITCH; -+ req_ch = parm->req_ch; -+ req_bw = parm->req_bw; -+ req_offset = parm->req_offset; -+ goto chbw_decision; -+ } else { -+ /* request comes from upper layer */ -+ if (MLME_IS_AP(padapter)) -+ mlme_act = MLME_AP_STARTED; -+ else if (MLME_IS_MESH(padapter)) -+ mlme_act = MLME_MESH_STARTED; -+ else -+ rtw_warn_on(1); -+ req_ch = 0; -+ _rtw_memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length); -+ } -+ -+ 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 -+ pmlmeinfo->VHT_enable = pmlmepriv->vhtpriv.vht_option; -+ if (pmlmeinfo->VHT_enable) -+ 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_) -+ && !MLME_IS_MESH(padapter) /* mesh group key is set before this function */ -+ ) -+ 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 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_rcr_set_chk_bssid(padapter, mlme_act); -+ -+chbw_decision: -+ ifbmp_ch_changed = rtw_ap_chbw_decision(padapter, parm->ifbmp, parm->excl_ifbmp -+ , req_ch, req_bw, req_offset -+ , &u_ch, &u_bw, &u_offset, &chbw_allow, &set_u_ch); -+ -+ for (i = 0; i < pdvobj->iface_nums; i++) { -+ if (!(parm->ifbmp & BIT(i)) || !pdvobj->padapters[i]) -+ continue; -+ -+ /* let pnetwork_mlme == pnetwork_mlmeext */ -+ _rtw_memcpy(&(pdvobj->padapters[i]->mlmepriv.cur_network.network) -+ , &(pdvobj->padapters[i]->mlmeextpriv.mlmext_info.network) -+ , pdvobj->padapters[i]->mlmeextpriv.mlmext_info.network.Length); -+ -+ rtw_start_bss_hdl_after_chbw_decided(pdvobj->padapters[i]); -+ -+ /* Set EDCA param reg after update cur_wireless_mode & update_capinfo */ -+ if (pregpriv->wifi_spec == 1) -+ rtw_set_hw_wmm_param(pdvobj->padapters[i]); -+ } -+ -+#if defined(CONFIG_DFS_MASTER) -+ rtw_dfs_rd_en_decision(padapter, mlme_act, parm->excl_ifbmp); -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ /* -+ * due to check under rtw_ap_chbw_decision -+ * if under MCC mode, means req channel setting is the same as current channel setting -+ * if not under MCC mode, mean req channel setting is not the same as current channel setting -+ */ -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { -+ RTW_INFO(FUNC_ADPT_FMT": req channel setting is the same as current channel setting, go to update BCN\n" -+ , FUNC_ADPT_ARG(padapter)); -+ -+ goto update_beacon; -+ -+ } -+ } -+ -+ /* 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 */ -+ -+ if (!IS_CH_WAITING(adapter_to_rfctl(padapter))) { -+ doiqk = _TRUE; -+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); -+ } -+ -+ if (set_u_ch) -+ set_channel_bwmode(padapter, u_ch, u_offset, u_bw); -+ -+ doiqk = _FALSE; -+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); -+ -+#ifdef CONFIG_MCC_MODE -+ /* after set_channel_bwmode for backup IQK */ -+ if (rtw_hal_set_mcc_setting_start_bss_network(padapter, chbw_allow) == _FAIL) { -+ /* MCC setting fail, update to buddy's channel */ -+ rtw_mi_get_ch_setting_union_no_self(padapter, &u_ch, &u_bw, &u_offset); -+ pnetwork->Configuration.DSConfig = u_ch; -+ padapter->mlmeextpriv.cur_channel = u_ch; -+ padapter->mlmeextpriv.cur_bwmode = u_bw; -+ padapter->mlmeextpriv.cur_ch_offset = u_offset; -+ -+ if (ifbmp_ch_changed == 0) { -+ u8 ht_option = 0; -+ -+#ifdef CONFIG_80211N_HT -+ ht_option = padapter->mlmepriv.htpriv.ht_option; -+#endif -+ -+ rtw_cfg80211_ch_switch_notify(padapter -+ , padapter->mlmeextpriv.cur_channel -+ , padapter->mlmeextpriv.cur_bwmode -+ , padapter->mlmeextpriv.cur_ch_offset -+ , ht_option, 0); -+ } -+ } -+#endif -+ -+#if defined(CONFIG_IOCTL_CFG80211) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ for (i = 0; i < pdvobj->iface_nums; i++) { -+ if (!(ifbmp_ch_changed & BIT(i)) || !pdvobj->padapters[i]) -+ continue; -+ -+ { -+ u8 ht_option = 0; -+ -+ #ifdef CONFIG_80211N_HT -+ ht_option = pdvobj->padapters[i]->mlmepriv.htpriv.ht_option; -+ #endif -+ -+ rtw_cfg80211_ch_switch_notify(pdvobj->padapters[i] -+ , pdvobj->padapters[i]->mlmeextpriv.cur_channel -+ , pdvobj->padapters[i]->mlmeextpriv.cur_bwmode -+ , pdvobj->padapters[i]->mlmeextpriv.cur_ch_offset -+ , ht_option, 0); -+ } -+ } -+#endif /* defined(CONFIG_IOCTL_CFG80211) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) */ -+ -+ rtw_rfctl_update_op_mode(adapter_to_rfctl(padapter), parm->ifbmp, 1); -+ -+ if (DUMP_ADAPTERS_STATUS) { -+ RTW_INFO(FUNC_ADPT_FMT" done\n", FUNC_ADPT_ARG(padapter)); -+ dump_adapters_status(RTW_DBGDUMP , adapter_to_dvobj(padapter)); -+ } -+ -+#ifdef CONFIG_MCC_MODE -+update_beacon: -+#endif -+ -+ for (i = 0; i < pdvobj->iface_nums; i++) { -+ struct mlme_priv *mlme; -+ -+ if (!(parm->ifbmp & BIT(i)) || !pdvobj->padapters[i]) -+ continue; -+ -+ /* update beacon content only if bstart_bss is _TRUE */ -+ if (pdvobj->padapters[i]->mlmeextpriv.bstart_bss != _TRUE) -+ continue; -+ -+ mlme = &(pdvobj->padapters[i]->mlmepriv); -+ -+ #ifdef CONFIG_80211N_HT -+ if ((ATOMIC_READ(&mlme->olbc) == _TRUE) || (ATOMIC_READ(&mlme->olbc_ht) == _TRUE)) { -+ /* AP is not starting a 40 MHz BSS in presence of an 802.11g BSS. */ -+ mlme->ht_op_mode &= (~HT_INFO_OPERATION_MODE_OP_MODE_MASK); -+ mlme->ht_op_mode |= OP_MODE_MAY_BE_LEGACY_STAS; -+ update_beacon(pdvobj->padapters[i], _HT_ADD_INFO_IE_, NULL, _FALSE, 0); -+ } -+ #endif -+ -+ update_beacon(pdvobj->padapters[i], _TIM_IE_, NULL, _FALSE, 0); -+ #ifdef CONFIG_ACTIVE_TPC_REPORT -+ if (MLME_ACTIVE_TPC_REPORT(mlme)) -+ update_beacon(pdvobj->padapters[i], WLAN_EID_TPC_REPORT, NULL, _FALSE, 0); -+ #endif -+ } -+ -+ if (mlme_act != MLME_OPCH_SWITCH -+ && pmlmeext->bstart_bss == _TRUE -+ ) { -+#ifdef CONFIG_SUPPORT_MULTI_BCN -+ _irqL irqL; -+ -+ _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ if (rtw_is_list_empty(&padapter->list)) { -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ padapter->vap_id = rtw_ap_allocate_vapid(pdvobj); -+ #endif -+ 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); -+ -+ #ifdef CONFIG_SWTIMER_BASED_TXBCN -+ rtw_ap_set_mbid_num(padapter, pdvobj->nr_ap_if); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pdvobj->inter_bcn_space)); -+ #endif /*CONFIG_SWTIMER_BASED_TXBCN*/ -+ -+#endif /*CONFIG_SUPPORT_MULTI_BCN*/ -+ -+ #ifdef CONFIG_HW_P0_TSF_SYNC -+ correct_TSF(padapter, mlme_act); -+ #endif -+ } -+ -+ rtw_scan_wait_completed(padapter); -+ -+ _rtw_iface_undersurvey_chk(__func__, padapter); -+ /* send beacon */ -+ ResumeTxBeacon(padapter); -+ { -+#if !defined(CONFIG_INTERRUPT_BASED_TXBCN) -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) || defined(CONFIG_PCI_BCN_POLLING) -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+ if (pdvobj->nr_ap_if == 1 -+ && mlme_act != MLME_OPCH_SWITCH -+ ) { -+ RTW_INFO("start SW BCN TIMER!\n"); -+ _set_timer(&pdvobj->txbcn_timer, bcn_interval); -+ } -+#else -+ for (i = 0; i < pdvobj->iface_nums; i++) { -+ if (!(parm->ifbmp & BIT(i)) || !pdvobj->padapters[i]) -+ continue; -+ -+ if (send_beacon(pdvobj->padapters[i]) == _FAIL) -+ RTW_INFO(ADPT_FMT" issue_beacon, fail!\n", ADPT_ARG(pdvobj->padapters[i])); -+ } -+#endif -+#endif -+#endif /* !defined(CONFIG_INTERRUPT_BASED_TXBCN) */ -+ -+#ifdef CONFIG_FW_HANDLE_TXBCN -+ if (mlme_act != MLME_OPCH_SWITCH -+ && pmlmeext->bstart_bss == _TRUE) -+ rtw_ap_mbid_bcn_en(padapter, padapter->vap_id); -+#endif -+ } -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (MLME_IS_AP(padapter) && padapter->tbtx_capability == _TRUE) { -+ _set_timer(&pmlmeext->tbtx_token_dispatch_timer, 1); -+ RTW_INFO("Start token dispatch\n"); -+ } -+#endif -+} -+ -+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, gmcs; -+ u32 akm; -+ u8 mfp_opt = MFP_NO; -+ u8 channel, network_type; -+ u8 OUI1[] = {0x00, 0x50, 0xf2, 0x01}; -+ u8 WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ HT_CAP_AMPDU_DENSITY best_ampdu_density; -+ 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; -+ u8 *ie = pbss_network->IEs; -+ u8 vht_cap = _FALSE; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ u8 rf_num = 0; -+ int ret_rm; -+ /* SSID */ -+ /* Supported rates */ -+ /* DS Params */ -+ /* WLAN_EID_COUNTRY */ -+ /* ERP Information element */ -+ /* Extended supported rates */ -+ /* WPA/WPA2 */ -+ /* Radio Resource Management */ -+ /* Wi-Fi Wireless Multimedia Extensions */ -+ /* ht_capab, ht_oper */ -+ /* WPS IE */ -+ -+ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); -+ -+ if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) -+ 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 -+ && pbss_network->InfrastructureMode != Ndis802_11_mesh -+ ) { -+ rtw_warn_on(1); -+ 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 -+ } -+ -+#ifdef CONFIG_RTW_MESH -+ /* Mesh ID */ -+ if (MLME_IS_MESH(padapter)) { -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, WLAN_EID_MESH_ID, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) { -+ _rtw_memset(&pbss_network->mesh_id, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(pbss_network->mesh_id.Ssid, (p + 2), ie_len); -+ pbss_network->mesh_id.SsidLength = ie_len; -+ } -+ } -+#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; -+ -+ /* support rate ie & ext support ie & IElen & SupportedRates */ -+ network_type = rtw_update_rate_bymode(pbss_network, pregistrypriv->wireless_mode); -+ -+ /* Active TPC report */ -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+ pmlmepriv->active_tpc_report = 0; -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, WLAN_EID_TPC_REPORT, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (REGSTY_IS_ACTIVE_TPC_REPORT_CAPABLE(pregistrypriv)) { -+ if (p && ie_len != 0) -+ pmlmepriv->active_tpc_report = 1; -+ else if (REGSTY_IS_ACTIVE_TPC_REPORT_AUTO(pregistrypriv)) { -+ rtw_set_ie_tpc_report(pbss_network->IEs + pbss_network->IELength, &pbss_network->IELength, 0, 0); -+ pmlmepriv->active_tpc_report = 1; -+ } -+ } -+ if (!MLME_ACTIVE_TPC_REPORT(pmlmepriv) && p) -+#endif -+ rtw_remove_bcn_ie(padapter, pbss_network, WLAN_EID_TPC_REPORT); -+ -+ /* 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) { -+ if(padapter->registrypriv.wireless_mode == WIRELESS_11B ) { -+ -+ pbss_network->IELength = pbss_network->IELength - *(p+1) - 2; -+ ret_rm = rtw_ies_remove_ie(ie , &len, _BEACON_IE_OFFSET_, _ERPINFO_IE_,NULL,0); -+ RTW_DBG("%s, remove_ie of ERP_IE=%d\n", __FUNCTION__, ret_rm); -+ } else -+ 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 */ -+ akm = 0; -+ gmcs = 0; -+ group_cipher = 0; -+ pairwise_cipher = 0; -+ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; -+ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; -+ psecuritypriv->akmp = 0; -+ 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, &gmcs, &akm, &mfp_opt, NULL) == _SUCCESS) { -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; -+ psecuritypriv->dot8021xalg = 1;/* psk, todo:802.1x */ -+ psecuritypriv->wpa_psk |= BIT(1); -+ -+ psecuritypriv->wpa2_group_cipher = group_cipher; -+ psecuritypriv->wpa2_pairwise_cipher = pairwise_cipher; -+ psecuritypriv->akmp = akm; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ /** -+ * Kernel < v5.x, the auth_type set as -+ * NL80211_AUTHTYPE_AUTOMATIC in -+ * cfg80211_rtw_start_ap(). if the AKM SAE in the RSN -+ * IE, we have to update the auth_type for SAE in -+ * rtw_check_beacon_data() -+ */ -+ if (CHECK_BIT(WLAN_AKM_TYPE_SAE, akm)) { -+ RTW_INFO("%s: Auth type as SAE\n", __func__); -+ psecuritypriv->auth_type = MLME_AUTHTYPE_SAE; -+ psecuritypriv->auth_alg = WLAN_AUTH_SAE; -+ } -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#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->ndisauthtype = Ndis802_11AuthModeWPAPSK; -+ 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; -+ -+ } -+ -+ if (mfp_opt == MFP_INVALID) { -+ RTW_INFO(FUNC_ADPT_FMT" invalid MFP setting\n", FUNC_ADPT_ARG(padapter)); -+ return _FAIL; -+ } -+ psecuritypriv->mfp_opt = mfp_opt; -+ -+ /* Parsing extended capabilities IE */ -+ rtw_parse_ext_cap_ie(pmlmepriv->ext_capab_ie_data, &(pmlmepriv->ext_capab_ie_len), ie \ -+ , pbss_network->IELength, _BEACON_IE_OFFSET_); -+ -+ /* RRM */ -+ rm_update_cap(pbuf, padapter, len, _BEACON_IE_OFFSET_); -+ -+ /* wmm */ -+ ie_len = 0; -+ pmlmepriv->qospriv.qos_option = 0; -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) -+ pmlmepriv->qospriv.qos_option = 1; -+#endif -+ 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 */ -+ -+ WMM_param_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)p); -+ -+ break; -+ } -+ -+ if ((p == NULL) || (ie_len == 0)) -+ break; -+ } -+ } -+#ifdef CONFIG_80211N_HT -+ if(padapter->registrypriv.ht_enable && -+ is_supported_ht(padapter->registrypriv.wireless_mode)) { -+ /* 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) { -+ 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); -+ -+#ifdef CONFIG_RTW_DEBUG -+ 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); -+ } -+#endif /* CONFIG_RTW_DEBUG */ -+ 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)) { -+ rtw_hal_get_def_var(padapter, HW_VAR_BEST_AMPDU_DENSITY, &best_ampdu_density); -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & (best_ampdu_density << 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 */ -+ { -+ u8 rx_nss = 0; -+ int i; -+ -+ rx_nss = GET_HAL_RX_NSS(padapter); -+ -+ /* RX MCS Bitmask */ -+ switch (rx_nss) { -+ case 1: -+ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_1R); -+ break; -+ case 2: -+ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_2R); -+ break; -+ case 3: -+ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_3R); -+ break; -+ case 4: -+ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_4R); -+ break; -+ default: -+ RTW_WARN("rf_type:%d or rx_nss:%u is not expected\n", GET_HAL_RFPATH(padapter), rx_nss); -+ } -+ 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); -+#ifdef CONFIG_RTW_DEBUG -+ 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); -+ } -+#endif /* CONFIG_RTW_DEBUG */ -+ } -+ -+ /* 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; -+ if (channel == 0) -+ pbss_network->Configuration.DSConfig = GET_HT_OP_ELE_PRI_CHL(pHT_info_ie + 2); -+ else if (channel != GET_HT_OP_ELE_PRI_CHL(pHT_info_ie + 2)) { -+ RTW_INFO(FUNC_ADPT_FMT" ch inconsistent, DSSS:%u, HT primary:%u\n" -+ , FUNC_ADPT_ARG(padapter), channel, GET_HT_OP_ELE_PRI_CHL(pHT_info_ie + 2)); -+ } -+ } -+ } -+#endif /* CONFIG_80211N_HT */ -+ 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 (padapter->registrypriv.ht_enable && -+ is_supported_ht(padapter->registrypriv.wireless_mode) && 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 -+ pmlmepriv->vhtpriv.upper_layer_setting = _FALSE; -+ pmlmepriv->vhtpriv.vht_option = _FALSE; -+ -+ if (pmlmepriv->htpriv.ht_option == _TRUE -+ && pbss_network->Configuration.DSConfig > 14 -+ && REGSTY_IS_11AC_ENABLE(pregistrypriv) -+ && is_supported_vht(pregistrypriv->wireless_mode) -+ && RFCTL_REG_EN_11AC(rfctl) -+ ) { -+ /* 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; -+ else -+ RTW_INFO(FUNC_ADPT_FMT" No vht_capability_ie from hostapd/wpa_supplicant\n", FUNC_ADPT_ARG(padapter)); -+ -+ /* Update VHT related IEs */ -+ if (vht_cap == _TRUE) { -+ RTW_INFO(FUNC_ADPT_FMT" VHT IEs is configured by hostapd/wpa_supplicant\n", FUNC_ADPT_ARG(padapter)); -+ pmlmepriv->vhtpriv.upper_layer_setting = _TRUE; -+ pmlmepriv->vhtpriv.vht_option = _TRUE; -+ -+ rtw_check_for_vht20(padapter, ie + _BEACON_IE_OFFSET_, -+ pbss_network->IELength - _BEACON_IE_OFFSET_); -+ rtw_check_vht_ies(padapter, pbss_network); -+ } else if (REGSTY_IS_11AC_AUTO(pregistrypriv)) { -+ rtw_vht_ies_detach(padapter, pbss_network); -+ rtw_vht_ies_attach(padapter, pbss_network); -+ } -+ } -+ -+ if (pmlmepriv->vhtpriv.vht_option == _FALSE) -+ rtw_vht_ies_detach(padapter, pbss_network); -+#endif /* CONFIG_80211AC_VHT */ -+ -+#ifdef CONFIG_80211N_HT -+ if(padapter->registrypriv.ht_enable && -+ is_supported_ht(padapter->registrypriv.wireless_mode) && -+ pbss_network->Configuration.DSConfig <= 14 && padapter->registrypriv.wifi_spec == 1 && -+ pbss_network->IELength + 10 <= MAX_IE_SZ) { -+ -+ rtw_add_ext_cap_info(pmlmepriv->ext_capab_ie_data, &(pmlmepriv->ext_capab_ie_len), BSS_COEXT); -+ rtw_update_ext_cap_ie(pmlmepriv->ext_capab_ie_data, pmlmepriv->ext_capab_ie_len, pbss_network->IEs, \ -+ &(pbss_network->IELength), _BEACON_IE_OFFSET_); -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+ 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, 1, 1); -+ 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, u8 period) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl; -+ _queue *acl_node_q; -+ int i; -+ _irqL irqL; -+ -+ if (period >= RTW_ACL_PERIOD_NUM) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ acl = &stapriv->acl_list[period]; -+ acl_node_q = &acl->acl_node_q; -+ -+ _rtw_spinlock_init(&(acl_node_q->lock)); -+ -+ _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); -+} -+ -+static void _rtw_macaddr_acl_deinit(_adapter *adapter, u8 period, bool clear_only) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl; -+ _queue *acl_node_q; -+ _irqL irqL; -+ _list *head, *list; -+ struct rtw_wlan_acl_node *acl_node; -+ -+ if (period >= RTW_ACL_PERIOD_NUM) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ acl = &stapriv->acl_list[period]; -+ 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 (acl_node->valid == _TRUE) { -+ acl_node->valid = _FALSE; -+ rtw_list_delete(&acl_node->list); -+ acl->num--; -+ } -+ } -+ _exit_critical_bh(&(acl_node_q->lock), &irqL); -+ -+ if (!clear_only) -+ _rtw_spinlock_free(&(acl_node_q->lock)); -+ -+ rtw_warn_on(acl->num); -+ acl->mode = RTW_ACL_MODE_DISABLED; -+} -+ -+void rtw_macaddr_acl_deinit(_adapter *adapter, u8 period) -+{ -+ _rtw_macaddr_acl_deinit(adapter, period, 0); -+} -+ -+void rtw_macaddr_acl_clear(_adapter *adapter, u8 period) -+{ -+ _rtw_macaddr_acl_deinit(adapter, period, 1); -+} -+ -+void rtw_set_macaddr_acl(_adapter *adapter, u8 period, int mode) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl; -+ -+ if (period >= RTW_ACL_PERIOD_NUM) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ acl = &stapriv->acl_list[period]; -+ -+ RTW_INFO(FUNC_ADPT_FMT" p=%u, mode=%d\n" -+ , FUNC_ADPT_ARG(adapter), period, mode); -+ -+ acl->mode = mode; -+} -+ -+int rtw_acl_add_sta(_adapter *adapter, u8 period, 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; -+ _queue *acl_node_q; -+ -+ if (period >= RTW_ACL_PERIOD_NUM) { -+ rtw_warn_on(1); -+ ret = -1; -+ goto exit; -+ } -+ -+ acl = &stapriv->acl_list[period]; -+ 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" p=%u "MAC_FMT" %s (acl_num=%d)\n" -+ , FUNC_ADPT_ARG(adapter), period, MAC_ARG(addr) -+ , (existed ? "existed" : ((i < 0 || i >= NUM_ACL) ? "no room" : "added")) -+ , acl->num); -+exit: -+ return ret; -+} -+ -+int rtw_acl_remove_sta(_adapter *adapter, u8 period, 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; -+ _queue *acl_node_q; -+ u8 is_baddr = is_broadcast_mac_addr(addr); -+ u8 match = 0; -+ -+ if (period >= RTW_ACL_PERIOD_NUM) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ acl = &stapriv->acl_list[period]; -+ 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 (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" p=%u "MAC_FMT" %s (acl_num=%d)\n" -+ , FUNC_ADPT_ARG(adapter), period, MAC_ARG(addr) -+ , is_baddr ? "clear all" : (match ? "match" : "no found") -+ , acl->num); -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_RTW_MACADDR_ACL */ -+ -+u8 rtw_ap_set_sta_key(_adapter *adapter, const u8 *addr, u8 alg, const u8 *key, u8 keyid, u8 gk) -+{ -+ struct cmd_priv *cmdpriv = &adapter->cmdpriv; -+ struct cmd_obj *cmd; -+ struct set_stakey_parm *param; -+ u8 res = _SUCCESS; -+ -+ cmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ param = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if (param == NULL) { -+ rtw_mfree((u8 *) cmd, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmd, param, CMD_SET_STAKEY); -+ -+ _rtw_memcpy(param->addr, addr, ETH_ALEN); -+ param->algorithm = alg; -+ param->keyid = keyid; -+ if (!!(alg & _SEC_TYPE_256_)) -+ _rtw_memcpy(param->key, key, 32); -+ else -+ _rtw_memcpy(param->key, key, 16); -+ param->gk = gk; -+ -+ res = rtw_enqueue_cmd(cmdpriv, cmd); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta) -+{ -+ return rtw_ap_set_sta_key(padapter -+ , psta->cmn.mac_addr -+ , psta->dot118021XPrivacy -+ , psta->dot118021x_UncstKey.skey -+ , 0 -+ , 0 -+ ); -+} -+ -+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 _GCMP_256_: -+ case _CCMP_256_: -+ keylen = 32; -+ break; -+ case _TKIP_: -+ case _TKIP_WTMIC_: -+ case _AES_: -+ case _GCMP_: -+ default: -+ keylen = 16; -+ } -+ -+ _rtw_memcpy(&(psetkeyparm->key[0]), key, keylen); -+ -+ pcmd->cmdcode = CMD_SET_KEY; /*_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 ((rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0)) && (psta_bmc->sleepq_len > 0)) { -+ int tx_counts = 0; -+ -+ _update_beacon(padapter, _TIM_IE_, NULL, _FALSE, 0, "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 (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0)) -+ update_tim = _TRUE; -+ -+ rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, 0); -+ rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, 0); -+ -+ if (update_tim == _TRUE) { -+ RTW_INFO("clear TIB\n"); -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0, "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->cmn.mac_addr), sta_info_type); -+#ifdef CONFIG_80211N_HT -+ if (sta_info_type & STA_INFO_UPDATE_BW) { -+ -+ if ((psta->flags & WLAN_STA_HT) && !psta->ht_20mhz_set) { -+ if (pmlmepriv->sw_to_20mhz) { -+ psta->cmn.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) { -+ -+ } -+ */ -+ -+} -+ -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+static bool rtw_update_bss_tpc_report(_adapter *adapter, WLAN_BSSID_EX *bss) -+{ -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ u8 *ie; -+ int ie_len; -+ bool updated = 0; -+ u8 tx_power = 0; -+ u8 link_margin = 0; -+ s16 eirp_mbm; -+ -+ ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_TPC_REPORT, &ie_len, BSS_EX_TLV_IES_LEN(bss)); -+ if (!ie || ie_len != 2) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ eirp_mbm = phy_get_txpwr_total_mbm(adapter, mlmeext->tx_rate_section, mlmeext->tx_rate -+ , mlmeext->cur_bwmode, rtw_get_center_ch(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset) -+ , mlmeext->cur_channel, 0, 1, NULL); -+ -+ if (eirp_mbm > 0) -+ tx_power = eirp_mbm / MBM_PDBM; -+ -+ if (*(ie + 3) != tx_power -+ || *(ie + 4) != link_margin -+ ) { -+ updated = 1; -+ rtw_set_ie_tpc_report(ie, NULL , tx_power, link_margin); -+ } -+ -+exit: -+ return updated; -+} -+#endif -+ -+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); -+ } -+ -+} -+ -+static void update_bcn_htcap_ie(_adapter *padapter) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_htinfo_ie(_adapter *padapter) -+{ -+#ifdef CONFIG_80211N_HT -+ /* -+ 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__); -+ } else { -+ clr_fwstate(pmlmepriv, WIFI_UNDER_WPS); -+ RTW_INFO("%s, clr WIFI_UNDER_WPS\n", __func__); -+ } -+ } -+#endif -+} -+ -+static void update_bcn_p2p_ie(_adapter *padapter) -+{ -+ -+} -+ -+static u8 update_csa_ie(_adapter *padapter) -+{ -+ _adapter *linking_adapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ sint ie_len = 0; -+ unsigned char *pbuf; -+ u8 update = _FALSE; -+ u8 *ie = pnetwork->IEs; -+ u8 csa_data[WLAN_EID_CSA_IE_LEN] = {0}, ifbmp = 0; -+ -+ if (rfctl->ap_csa_en == AP_CSA_DISABLE || rfctl->ap_csa_en == CSA_IE_REMOVE) -+ return update; -+ -+ csa_data[CSA_NEW_CH] = rfctl->ap_csa_ch; -+ csa_data[CSA_SWITCH_COUNT] = rfctl->ap_csa_switch_cnt; -+ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, WLAN_EID_CHANNEL_SWITCH \ -+ , &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ -+ if (pbuf && ie_len == WLAN_EID_CSA_IE_LEN && csa_data[CSA_SWITCH_COUNT] > 0) { -+ /* RTW_INFO("%s, ch=%d, switch_count=%d, update CSA IE\n", __FUNCTION__, -+ csa_data[CSA_NEW_CH], csa_data[CSA_SWITCH_COUNT]); */ -+ pbuf[4] = rfctl->ap_csa_switch_cnt; -+ update = _TRUE; -+ } else if (!pbuf && csa_data[CSA_SWITCH_COUNT] > 0) { -+ RTW_INFO("%s, ch=%d, switch_count=%d, add CSA IE\n", __FUNCTION__\ -+ , csa_data[CSA_NEW_CH], csa_data[CSA_SWITCH_COUNT]); -+ rtw_add_bcn_ie(padapter, pnetwork, WLAN_EID_CHANNEL_SWITCH, csa_data, WLAN_EID_CSA_IE_LEN); -+ update = _TRUE; -+ } else if (pbuf && ie_len > 0 && csa_data[CSA_SWITCH_COUNT] == 0) { -+ RTW_INFO("%s, ch=%d, switch_count=%d, remove CSA IE\n", __FUNCTION__ \ -+ , csa_data[CSA_NEW_CH], csa_data[CSA_SWITCH_COUNT]); -+ -+ if (pbuf) { -+ rtw_remove_bcn_ie(padapter, pnetwork, WLAN_EID_CHANNEL_SWITCH); -+ update = _TRUE; -+ } -+ -+ if (rfctl->ap_csa_en == AP_SWITCH_CH_CSA) { -+ ifbmp = BIT(padapter->iface_id); -+ rtw_change_bss_chbw_cmd(padapter, 0, ifbmp, 0, rfctl->ap_csa_ch, rfctl->ap_csa_ch_width, rfctl->ap_csa_ch_offset); -+ rfctl->ap_csa_en = CSA_IE_REMOVE; -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ else if (rfctl->ap_csa_en == CSA_STA_JOINBSS) { -+ linking_adapter = rtw_mi_get_linking_adapter(padapter); -+ if (linking_adapter) { -+ rfctl->ap_csa_en = CSA_IE_REMOVE; -+ pmlmepriv = &(linking_adapter->mlmepriv); -+ rtw_joinbss_cmd(linking_adapter, &(pmlmepriv->candidate_network)); -+ } else { -+ RTW_ERR("Can't find the linking STA\n"); -+ } -+ } -+#endif -+ } else { -+ RTW_INFO("%s, unexpected case\n", __FUNCTION__); -+ } -+ -+ if (rfctl->ap_csa_switch_cnt > 0) -+ rfctl->ap_csa_switch_cnt--; -+ -+ return update; -+} -+ -+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, u8 flags, const char *tag) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv; -+ struct mlme_ext_priv *pmlmeext; -+ bool updated = 1; /* treat as upadated by default */ -+ -+ if (!padapter) -+ return; -+ -+ pmlmepriv = &(padapter->mlmepriv); -+ pmlmeext = &(padapter->mlmeextpriv); -+ -+ if (pmlmeext->bstart_bss == _FALSE) -+ return; -+ -+ _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+ -+ switch (ie_id) { -+ case _TIM_IE_: -+ update_BCNTIM(padapter); -+ break; -+ -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+ case WLAN_EID_TPC_REPORT: -+ updated = rtw_update_bss_tpc_report(padapter, &(pmlmeext->mlmext_info.network)); -+ break; -+#endif -+ -+ 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; -+ -+#ifdef CONFIG_RTW_MESH -+ case WLAN_EID_MESH_CONFIG: -+ updated = rtw_mesh_update_bss_peering_status(padapter, &(pmlmeext->mlmext_info.network)); -+ updated |= rtw_mesh_update_bss_formation_info(padapter, &(pmlmeext->mlmext_info.network)); -+ updated |= rtw_mesh_update_bss_forwarding_state(padapter, &(pmlmeext->mlmext_info.network)); -+ break; -+#endif -+ case WLAN_EID_CHANNEL_SWITCH: -+ updated = update_csa_ie(padapter); -+ break; -+ -+ case _VENDOR_SPECIFIC_IE_: -+ update_bcn_vendor_spec_ie(padapter, oui); -+ break; -+ -+ case 0xFF: -+ default: -+ break; -+ } -+ -+ if (updated) -+ 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) || defined(CONFIG_PCI_BCN_POLLING) -+ if (tx && updated) { -+ /* 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); -+ if(flags == RTW_CMDF_WAIT_ACK) -+ set_tx_beacon_cmd(padapter, RTW_CMDF_WAIT_ACK); -+ else -+ set_tx_beacon_cmd(padapter, 0); -+ } -+#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; -+ struct macid_ctl_t *macid_ctl = &padapter->dvobj->macid_ctl; -+ int i; -+ -+ psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(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, 0); -+ -+ associated_stainfo_update(padapter, psta, STA_INFO_UPDATE_BW); -+ if (pmlmepriv->sw_to_20mhz) { -+ for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { -+ psta = macid_ctl->sta[i]; -+ if (psta && !is_broadcast_mac_addr(psta->cmn.mac_addr)) { -+ psta->cmn.bw_mode = CHANNEL_WIDTH_20; -+ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); -+ } -+ } -+ } -+ } -+ -+ -+ -+} -+ -+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; /*SM Power Save Enabled*/ -+ m_field = (ctrl_field & BIT(1)) ? 1 : 0; /*SM Mode, 0:static SMPS, 1:dynamic SMPS*/ -+ -+ if (e_field) { -+ if (m_field) { /*mode*/ -+ psta->htpriv.smps_cap = WLAN_HT_CAP_SM_PS_DYNAMIC; -+ RTW_ERR("Don't support dynamic SMPS\n"); -+ } -+ else -+ psta->htpriv.smps_cap = WLAN_HT_CAP_SM_PS_STATIC; -+ } else { -+ /*disable*/ -+ psta->htpriv.smps_cap = WLAN_HT_CAP_SM_PS_DISABLED; -+ } -+ -+ if (psta->htpriv.smps_cap != WLAN_HT_CAP_SM_PS_DYNAMIC) -+ rtw_ssmps_wk_cmd(padapter, psta, e_field, 1); -+} -+ -+/* -+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; -+ } -+ } 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; -+ } -+ } -+ -+#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, _FALSE, 0); -+ } -+ } -+ -+ } 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, _FALSE, 0); -+ } -+ } -+ -+ } -+ -+ -+#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; -+ } -+ } 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; -+ } -+ } -+ -+#ifdef CONFIG_80211N_HT -+ if(padapter->registrypriv.ht_enable && -+ is_supported_ht(padapter->registrypriv.wireless_mode)) { -+ 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->cmn.mac_addr), 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->cmn.mac_addr), -+ 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->cmn.mac_addr), -+ pmlmepriv->num_sta_ht_20mhz); -+ } -+ -+ if (((ht_capab & RTW_IEEE80211_HT_CAP_40MHZ_INTOLERANT) != 0) && -+ (psta->ht_40mhz_intolerant == 0)) { -+ psta->ht_40mhz_intolerant = 1; -+ pmlmepriv->num_sta_40mhz_intolerant++; -+ RTW_INFO("%s STA " MAC_FMT " - 40MHZ_INTOLERANT, ", -+ __FUNCTION__, MAC_ARG(psta->cmn.mac_addr)); -+ } -+ -+ } 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->cmn.mac_addr), -+ pmlmepriv->num_sta_no_ht); -+ } -+ } -+ -+ if (rtw_ht_operation_update(padapter) > 0) { -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE, 0); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _FALSE, 0); -+ beacon_updated = _TRUE; -+ } -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ update_beacon(padapter, WLAN_EID_MESH_CONFIG, NULL, _FALSE, 0); -+ if (pstapriv->asoc_list_cnt == 1) -+ _set_timer(&padapter->mesh_atlm_param_req_timer, 0); -+ beacon_updated = _TRUE; -+ } -+#endif -+ -+ if (beacon_updated) -+ update_beacon(padapter, 0xFF, NULL, _TRUE, 0); -+ -+ /* 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 sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ if (!psta) -+ return beacon_updated; -+ -+ if (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid)) { -+ rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, psta->cmn.aid); -+ beacon_updated = _TRUE; -+ update_beacon(padapter, _TIM_IE_, NULL, _FALSE, 0); -+ } -+ -+ 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; -+ } -+ -+ 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, _FALSE, 0); -+ } -+ } -+ -+ 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; -+ } -+ -+#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; -+ if (pmlmepriv->num_sta_40mhz_intolerant > 0) -+ pmlmepriv->num_sta_40mhz_intolerant--; -+ else -+ rtw_warn_on(1); -+ } -+ -+ if (rtw_ht_operation_update(padapter) > 0) { -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE, 0); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _FALSE, 0); -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ update_beacon(padapter, WLAN_EID_MESH_CONFIG, NULL, _FALSE, 0); -+ if (pstapriv->asoc_list_cnt == 0) -+ _cancel_timer_ex(&padapter->mesh_atlm_param_req_timer); -+ beacon_updated = _TRUE; -+ } -+#endif -+ -+ if (beacon_updated == _TRUE) -+ update_beacon(padapter, 0xFF, NULL, _TRUE, 0); -+ -+#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; -+ -+ if (!psta) -+ return beacon_updated; -+ -+ if (active == _TRUE) { -+#ifdef CONFIG_80211N_HT -+ /* tear down Rx AMPDU */ -+ send_delba(padapter, 0, psta->cmn.mac_addr);/* recipient */ -+ -+ /* tear down TX AMPDU */ -+ send_delba(padapter, 1, psta->cmn.mac_addr);/* */ /* originator */ -+ -+#endif /* CONFIG_80211N_HT */ -+ -+ if (!MLME_IS_MESH(padapter)) -+ issue_deauth(padapter, psta->cmn.mac_addr, reason); -+ -+ /* Flush buffered management frames */ -+ if (psta->state & WIFI_SLEEP_STATE) -+ wakeup_sta_to_xmit(padapter, psta, UNI_MGMT); -+ } -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) -+ rtw_mesh_path_flush_by_nexthop(psta); -+#endif -+ -+#ifdef CONFIG_BEAMFORMING -+ beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, psta->cmn.mac_addr, ETH_ALEN, 1); -+#endif -+ -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ -+ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ -+#endif -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state &= ~(WIFI_ASOC_STATE | WIFI_UNDER_KEY_HANDSHAKE); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if ((psta->auth_len != 0) && (psta->pauth_frame != NULL)) { -+ rtw_mfree(psta->pauth_frame, psta->auth_len); -+ psta->pauth_frame = NULL; -+ psta->auth_len = 0; -+ } -+ if (psta->passoc_req && psta->assoc_req_len > 0) { -+ rtw_mfree(psta->passoc_req , psta->assoc_req_len); -+ psta->passoc_req = NULL; -+ psta->assoc_req_len = 0; -+ } -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ if (!MLME_IS_MESH(padapter)) { -+ #ifdef CONFIG_RTW_WDS -+ rtw_wds_path_flush_by_nexthop(psta); -+ #endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ #ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->cmn.mac_addr, 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->cmn.mac_addr, 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 -+ rtw_indicate_sta_disassoc_event(padapter, psta); -+#endif -+ } -+ -+ beacon_updated = bss_cap_update_on_sta_leave(padapter, psta); -+ -+ report_del_sta_event(padapter, psta->cmn.mac_addr, reason, enqueue, _FALSE); -+ -+ /* clear cam entry / key */ -+ rtw_clearstakey_cmd(padapter, psta, enqueue); -+ -+ 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->cmn.mac_addr, 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; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 flush_num = 0; -+ char flush_list[NUM_STA]; -+ int i; -+ -+ if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) -+ 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--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (psta->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt--; -+ #endif -+ STA_SET_MESH_PLINK(psta, NULL); -+ -+ 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++) { -+ u8 sta_addr[ETH_ALEN]; -+ -+ psta = rtw_get_stainfo_by_offset(pstapriv, flush_list[i]); -+ _rtw_memcpy(sta_addr, psta->cmn.mac_addr, ETH_ALEN); -+ -+ ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, enqueue); -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) -+ rtw_mesh_expire_peer(padapter, sta_addr); -+ #endif -+ } -+ -+ if (MLME_IS_ASOC(padapter) && !MLME_IS_MESH(padapter)) -+ 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 & WIFI_ASOC_STATE) -+ rtw_hal_update_ra_mask(psta); /* DM_RATR_STA_INIT */ -+} -+/* restore hw setting from sw data structures */ -+void rtw_ap_restore_network(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ 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 -+ , MLME_IS_AP(padapter) ? Ndis802_11APMode : Ndis802_11_mesh -+ , RTW_CMDF_DIRECTLY -+ ); -+ -+ 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 & WIFI_ASOC_STATE) { -+ 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; -+ -+ psecuritypriv->dot118021x_bmc_cam_id = INVALID_SEC_MAC_CAM_ID; -+ -+ for (i = 0 ; i < pstapriv->max_aid; i++) -+ pstapriv->sta_aid[i] = NULL; -+ -+#ifdef CONFIG_RTW_WDS -+ if (MLME_IS_AP(padapter)) -+ rtw_wds_pathtbl_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) -+{ -+ u8 self_action = MLME_ACTION_UNKNOWN; -+ struct sta_info *psta = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+#ifdef CONFIG_SUPPORT_MULTI_BCN -+ struct dvobj_priv *pdvobj = padapter->dvobj; -+ _irqL irqL; -+#endif -+ -+ RTW_INFO("%s -"ADPT_FMT"\n", __func__, ADPT_ARG(padapter)); -+ -+ if (MLME_IS_AP(padapter)) -+ self_action = MLME_AP_STOPPED; -+ else if (MLME_IS_MESH(padapter)) -+ self_action = MLME_MESH_STOPPED; -+ else -+ rtw_warn_on(1); -+ -+ 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; -+ -+ rtw_rfctl_update_op_mode(adapter_to_rfctl(padapter), BIT(padapter->iface_id), 0); -+ -+ /* free scan queue */ -+ rtw_free_network_queue(padapter, _TRUE); -+ -+#if CONFIG_RTW_MACADDR_ACL -+ rtw_macaddr_acl_clear(padapter, RTW_ACL_PERIOD_BSS); -+#endif -+ -+ rtw_sta_flush(padapter, _TRUE); -+ -+ /* free_assoc_sta_resources */ -+ rtw_free_all_stainfo(padapter); -+ -+ psta = rtw_get_bcmc_stainfo(padapter); -+ if (psta) { -+ rtw_sta_mstatus_disc_rpt(padapter, psta->cmn.mac_id); -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ rtw_free_stainfo(padapter, psta); -+ /*_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);*/ -+ } -+ -+ pmlmepriv->ap_isolate = 0; -+#ifdef CONFIG_RTW_WDS -+ adapter_set_use_wds(padapter, 0); -+#endif -+#ifdef CONFIG_RTW_MULTI_AP -+ padapter->multi_ap = 0; -+#endif -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ -+#ifdef CONFIG_SUPPORT_MULTI_BCN -+ if (pmlmeext->bstart_bss == _TRUE) { -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ u8 free_apid = CONFIG_LIMITED_AP_NUM; -+ #endif -+ -+ _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; -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ rtw_ap_release_vapid(pdvobj, padapter->vap_id); -+ free_apid = padapter->vap_id; -+ padapter->vap_id = CONFIG_LIMITED_AP_NUM; -+ #endif -+ rtw_list_delete(&padapter->list); -+ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ rtw_ap_mbid_bcn_dis(padapter, free_apid); -+ #endif -+ -+ #ifdef CONFIG_SWTIMER_BASED_TXBCN -+ 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 -+ } -+#endif -+ -+ pmlmeext->bstart_bss = _FALSE; -+ -+ rtw_hal_rcr_set_chk_bssid(padapter, self_action); -+ -+#ifdef CONFIG_HW_P0_TSF_SYNC -+ correct_TSF(padapter, self_action); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_MediaStatusNotify(padapter, 0); /* disconnect */ -+#endif -+ -+#ifdef CONFIG_RTW_WDS -+ if (MLME_IS_AP(padapter)) -+ rtw_wds_pathtbl_unregister(padapter); -+#endif -+ -+#ifdef CONFIG_DFS_MASTER -+ rtw_dfs_rd_en_decision(padapter, self_action, 0); -+#endif -+ -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ /* Disable beacon early interrupt IMR of AP mode */ -+ rtw_hal_set_ap_bcn_imr_cmd(padapter, 0); -+#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; -+#endif -+ { -+ 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); -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ if (vhtpriv->vht_option == _TRUE) { -+ 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) { -+ RTW_INFO(FUNC_ADPT_FMT" update VHT 20/40M\n", FUNC_ADPT_ARG(adapter)); -+ 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) { -+ RTW_INFO(FUNC_ADPT_FMT" update VHT 80M, center_freq = %u\n", FUNC_ADPT_ARG(adapter), center_freq); -+ 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 */ -+} -+ -+static u8 rtw_ap_update_chbw_by_ifbmp(struct dvobj_priv *dvobj, u8 ifbmp -+ , u8 cur_ie_ch[], u8 cur_ie_bw[], u8 cur_ie_offset[] -+ , u8 dec_ch[], u8 dec_bw[], u8 dec_offset[] -+ , const char *caller) -+{ -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ WLAN_BSSID_EX *network; -+ u8 ifbmp_ch_changed = 0; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) -+ continue; -+ -+ iface = dvobj->padapters[i]; -+ mlmeext = &(iface->mlmeextpriv); -+ -+ if (MLME_IS_ASOC(iface)) { -+ RTW_INFO(FUNC_ADPT_FMT" %u,%u,%u => %u,%u,%u%s\n", caller, ADPT_ARG(iface) -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset -+ , dec_ch[i], dec_bw[i], dec_offset[i] -+ , MLME_IS_OPCH_SW(iface) ? " OPCH_SW" : ""); -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT" %u,%u,%u => %u,%u,%u%s\n", caller, ADPT_ARG(iface) -+ , cur_ie_ch[i], cur_ie_bw[i], cur_ie_offset[i] -+ , dec_ch[i], dec_bw[i], dec_offset[i] -+ , MLME_IS_OPCH_SW(iface) ? " OPCH_SW" : ""); -+ } -+ } -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) -+ continue; -+ -+ iface = dvobj->padapters[i]; -+ mlmeext = &(iface->mlmeextpriv); -+ network = &(mlmeext->mlmext_info.network); -+ -+ /* ch setting differs from mlmeext.network IE */ -+ if (cur_ie_ch[i] != dec_ch[i] -+ || cur_ie_bw[i] != dec_bw[i] -+ || cur_ie_offset[i] != dec_offset[i]) -+ ifbmp_ch_changed |= BIT(i); -+ -+ /* ch setting differs from existing one */ -+ if (MLME_IS_ASOC(iface) -+ && (mlmeext->cur_channel != dec_ch[i] -+ || mlmeext->cur_bwmode != dec_bw[i] -+ || mlmeext->cur_ch_offset != dec_offset[i]) -+ ) { -+ if (rtw_linked_check(iface) == _TRUE) { -+ #ifdef CONFIG_SPCT_CH_SWITCH -+ if (1) -+ rtw_ap_inform_ch_switch(iface, dec_ch[i], dec_offset[i]); -+ else -+ #endif -+ { -+ if(rfctl->ap_csa_en == AP_CSA_DISABLE) -+ rtw_sta_flush(iface, _FALSE); -+ } -+ } -+ } -+ -+ mlmeext->cur_channel = dec_ch[i]; -+ mlmeext->cur_bwmode = dec_bw[i]; -+ mlmeext->cur_ch_offset = dec_offset[i]; -+ -+ rtw_ap_update_bss_chbw(iface, network, dec_ch[i], dec_bw[i], dec_offset[i]); -+ } -+ -+ return ifbmp_ch_changed; -+} -+ -+static u8 rtw_ap_ch_specific_chk(_adapter *adapter, u8 ch, u8 *bw, u8 *offset, const char *caller) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ RT_CHANNEL_INFO *chset = rfctl->channel_set; -+ int ch_idx; -+ u8 ret = _SUCCESS; -+ -+ ch_idx = rtw_chset_search_ch(chset, ch); -+ if (ch_idx < 0) { -+ RTW_WARN("%s ch:%u doesn't fit in chplan\n", caller, ch); -+ ret = _FAIL; -+ goto exit; -+ } -+ if (chset[ch_idx].flags & RTW_CHF_NO_IR) { -+ RTW_WARN("%s ch:%u is passive\n", caller, ch); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ rtw_adjust_chbw(adapter, ch, bw, offset); -+ -+ if (!rtw_get_offset_by_chbw(ch, *bw, offset)) { -+ RTW_WARN("%s %u,%u has no valid offset\n", caller, ch, *bw); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ while (!rtw_chset_is_chbw_valid(chset, ch, *bw, *offset, 0, 0) -+ || (rtw_rfctl_dfs_domain_unknown(rfctl) && rtw_chset_is_dfs_chbw(chset, ch, *bw, *offset)) -+ ) { -+ if (*bw > CHANNEL_WIDTH_20) -+ (*bw)--; -+ if (*bw == CHANNEL_WIDTH_20) { -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ } -+ -+ if (rtw_rfctl_dfs_domain_unknown(rfctl) && rtw_chset_is_dfs_chbw(chset, ch, *bw, *offset)) { -+ RTW_WARN("%s DFS channel %u can't be used\n", caller, ch); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+static bool rtw_ap_choose_chbw(_adapter *adapter, u8 sel_ch, u8 max_bw, u8 cur_ch -+ , u8 *ch, u8 *bw, u8 *offset, bool by_int_info, u8 mesh_only, const char *caller) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ bool ch_avail = _FALSE; -+ -+#if defined(CONFIG_DFS_MASTER) -+ if (!rtw_rfctl_dfs_domain_unknown(rfctl)) { -+ if (rfctl->radar_detected -+ && rfctl->dbg_dfs_choose_dfs_ch_first -+ ) { -+ ch_avail = rtw_choose_shortest_waiting_ch(rfctl, sel_ch, max_bw -+ , ch, bw, offset -+ , RTW_CHF_DFS, 0 -+ , cur_ch, by_int_info, mesh_only); -+ if (ch_avail == _TRUE) { -+ RTW_INFO("%s choose 5G DFS channel for debug\n", caller); -+ goto exit; -+ } -+ } -+ -+ if (rfctl->radar_detected -+ && (rfctl->dfs_ch_sel_e_flags || rfctl->dfs_ch_sel_d_flags) -+ ) { -+ ch_avail = rtw_choose_shortest_waiting_ch(rfctl, sel_ch, max_bw -+ , ch, bw, offset -+ , rfctl->dfs_ch_sel_e_flags, rfctl->dfs_ch_sel_d_flags -+ , cur_ch, by_int_info, mesh_only); -+ if (ch_avail == _TRUE) { -+ RTW_INFO("%s choose with dfs_ch_sel_ e_flags:0x%02x d_flags:0x%02x for debug\n" -+ , caller, rfctl->dfs_ch_sel_e_flags, rfctl->dfs_ch_sel_d_flags); -+ goto exit; -+ } -+ } -+ -+ ch_avail = rtw_choose_shortest_waiting_ch(rfctl, sel_ch, max_bw -+ , ch, bw, offset -+ , 0, 0 -+ , cur_ch, by_int_info, mesh_only); -+ } else -+#endif /* defined(CONFIG_DFS_MASTER) */ -+ { -+ ch_avail = rtw_choose_shortest_waiting_ch(rfctl, sel_ch, max_bw -+ , ch, bw, offset -+ , 0, RTW_CHF_DFS -+ , cur_ch, by_int_info, mesh_only); -+ } -+#if defined(CONFIG_DFS_MASTER) -+exit: -+#endif -+ if (ch_avail == _FALSE) -+ RTW_WARN("%s no available channel\n", caller); -+ -+ return ch_avail; -+} -+ -+u8 rtw_ap_chbw_decision(_adapter *adapter, u8 ifbmp, u8 excl_ifbmp -+ , s16 req_ch, s8 req_bw, s8 req_offset -+ , u8 *ch, u8 *bw, u8 *offset, u8 *chbw_allow, bool *set_u_ch) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ RT_CHANNEL_INFO *chset = adapter_to_chset(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ bool ch_avail = _FALSE; -+ u8 cur_ie_ch[CONFIG_IFACE_NUMBER] = {0}; -+ u8 cur_ie_bw[CONFIG_IFACE_NUMBER] = {0}; -+ u8 cur_ie_offset[CONFIG_IFACE_NUMBER] = {0}; -+ u8 dec_ch[CONFIG_IFACE_NUMBER] = {0}; -+ u8 dec_bw[CONFIG_IFACE_NUMBER] = {0}; -+ u8 dec_offset[CONFIG_IFACE_NUMBER] = {0}; -+ u8 u_ch = 0, u_bw = 0, u_offset = 0; -+ struct mlme_ext_priv *mlmeext; -+ WLAN_BSSID_EX *network; -+ struct mi_state mstate; -+ struct mi_state mstate_others; -+ u8 ifbmp_others = 0xFF & ~ifbmp & ~excl_ifbmp; -+ u8 ifbmp_ch_changed = 0; -+ bool ifbmp_all_mesh = 0; -+ _adapter *iface; -+ int i; -+ -+ *set_u_ch = _FALSE; -+ -+#ifdef CONFIG_RTW_MESH -+ for (i = 0; i < dvobj->iface_nums; i++) -+ if ((ifbmp & BIT(i)) && dvobj->padapters) -+ if (!MLME_IS_MESH(dvobj->padapters[i])) -+ break; -+ ifbmp_all_mesh = i >= dvobj->iface_nums ? 1 : 0; -+#endif -+ -+ RTW_INFO("%s ifbmp:0x%02x excl_ifbmp:0x%02x req:%d,%d,%d\n", __func__ -+ , ifbmp, excl_ifbmp, req_ch, req_bw, req_offset); -+ rtw_mi_status_by_ifbmp(dvobj, ifbmp, &mstate); -+ rtw_mi_status_by_ifbmp(dvobj, ifbmp_others, &mstate_others); -+ RTW_INFO("%s others ld_sta_num:%u, lg_sta_num:%u, ap_num:%u, mesh_num:%u\n" -+ , __func__, MSTATE_STA_LD_NUM(&mstate_others), MSTATE_STA_LG_NUM(&mstate_others) -+ , MSTATE_AP_NUM(&mstate_others), MSTATE_MESH_NUM(&mstate_others)); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) -+ continue; -+ iface = dvobj->padapters[i]; -+ mlmeext = &(iface->mlmeextpriv); -+ network = &(mlmeext->mlmext_info.network); -+ -+ /* get current IE channel settings */ -+ rtw_ies_get_chbw(BSS_EX_TLV_IES(network), BSS_EX_TLV_IES_LEN(network) -+ , &cur_ie_ch[i], &cur_ie_bw[i], &cur_ie_offset[i], 1, 1); -+ -+ /* prepare temporary channel setting decision */ -+ if (req_ch == 0) { -+ /* request comes from upper layer, use cur_ie values */ -+ dec_ch[i] = cur_ie_ch[i]; -+ dec_bw[i] = cur_ie_bw[i]; -+ dec_offset[i] = cur_ie_offset[i]; -+ } else { -+ /* use chbw of cur_ie updated with specifying req as temporary decision */ -+ dec_ch[i] = (req_ch <= REQ_CH_NONE) ? cur_ie_ch[i] : req_ch; -+ if (req_bw <= REQ_BW_NONE) { -+ if (req_bw == REQ_BW_ORI) -+ dec_bw[i] = iface->mlmepriv.ori_bw; -+ else -+ dec_bw[i] = cur_ie_bw[i]; -+ } else -+ dec_bw[i] = req_bw; -+ dec_offset[i] = (req_offset <= REQ_OFFSET_NONE) ? cur_ie_offset[i] : req_offset; -+ } -+ } -+ -+ if (MSTATE_STA_LD_NUM(&mstate_others) || MSTATE_STA_LG_NUM(&mstate_others) -+ || MSTATE_AP_NUM(&mstate_others) || MSTATE_MESH_NUM(&mstate_others) -+ ) { -+ /* has linked/linking STA or has AP/Mesh mode */ -+ rtw_warn_on(!rtw_mi_get_ch_setting_union_by_ifbmp(dvobj, ifbmp_others, &u_ch, &u_bw, &u_offset)); -+ RTW_INFO("%s others union:%u,%u,%u\n", __func__, u_ch, u_bw, u_offset); -+ } -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(adapter) && req_ch == 0) { -+ if (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { -+ u8 if_id = adapter->iface_id; -+ -+ mlmeext = &(adapter->mlmeextpriv); -+ -+ /* check channel settings are the same */ -+ if (cur_ie_ch[if_id] == mlmeext->cur_channel -+ && cur_ie_bw[if_id] == mlmeext->cur_bwmode -+ && cur_ie_offset[if_id] == mlmeext->cur_ch_offset) { -+ -+ RTW_INFO(FUNC_ADPT_FMT"req ch settings are the same as current ch setting, go to exit\n" -+ , FUNC_ADPT_ARG(adapter)); -+ -+ *chbw_allow = _FALSE; -+ goto exit; -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT"request channel settings are not the same as current channel setting(%d,%d,%d,%d,%d,%d), restart MCC\n" -+ , FUNC_ADPT_ARG(adapter) -+ , cur_ie_ch[if_id], cur_ie_bw[if_id], cur_ie_offset[if_id] -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); -+ -+ rtw_hal_set_mcc_setting_disconnect(adapter); -+ } -+ } -+ } -+#endif /* CONFIG_MCC_MODE */ -+ -+ if (MSTATE_STA_LG_NUM(&mstate_others) && !MSTATE_STA_LD_NUM(&mstate_others)) { -+ /* has linking STA but no linked STA */ -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) -+ continue; -+ iface = dvobj->padapters[i]; -+ -+ rtw_adjust_chbw(iface, dec_ch[i], &dec_bw[i], &dec_offset[i]); -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(iface)) -+ rtw_mesh_adjust_chbw(dec_ch[i], &dec_bw[i], &dec_offset[i]); -+ #endif -+ -+ if (rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch[i], dec_bw[i], dec_offset[i])) { -+ rtw_chset_sync_chbw(chset -+ , &dec_ch[i], &dec_bw[i], &dec_offset[i] -+ , &u_ch, &u_bw, &u_offset, 1, 0); -+ *set_u_ch = _TRUE; -+ -+ /* channel bw offset can be allowed, not need MCC */ -+ *chbw_allow = _TRUE; -+ } else { -+ #ifdef CONFIG_MCC_MODE -+ if (MCC_EN(iface)) { -+ mlmeext = &(iface->mlmeextpriv); -+ mlmeext->cur_channel = *ch = dec_ch[i]; -+ mlmeext->cur_bwmode = *bw = dec_bw[i]; -+ mlmeext->cur_ch_offset = *offset = dec_offset[i]; -+ -+ /* 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(iface) -+ , *ch, *bw, *offset); -+ goto exit; -+ } -+ #endif /* CONFIG_MCC_MODE */ -+ -+ /* set this for possible ch change when join down*/ -+ set_fwstate(&iface->mlmepriv, WIFI_OP_CH_SWITCHING); -+ } -+ } -+ -+ } else if (MSTATE_STA_LD_NUM(&mstate_others) -+ || MSTATE_AP_NUM(&mstate_others) || MSTATE_MESH_NUM(&mstate_others) -+ ) { -+ /* has linked STA mode or AP/Mesh mode */ -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) -+ continue; -+ iface = dvobj->padapters[i]; -+ -+ rtw_adjust_chbw(iface, u_ch, &dec_bw[i], &dec_offset[i]); -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(iface)) -+ rtw_mesh_adjust_chbw(u_ch, &dec_bw[i], &dec_offset[i]); -+ #endif -+ -+ #ifdef CONFIG_MCC_MODE -+ if (MCC_EN(iface)) { -+ if (!rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch[i], dec_bw[i], dec_offset[i])) { -+ mlmeext = &(iface->mlmeextpriv); -+ mlmeext->cur_channel = *ch = dec_ch[i] = cur_ie_ch[i]; -+ mlmeext->cur_bwmode = *bw = dec_bw[i] = cur_ie_bw[i]; -+ mlmeext->cur_ch_offset = *offset = dec_offset[i] = cur_ie_offset[i]; -+ /* 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(iface) -+ , *ch, *bw, *offset); -+ goto exit; -+ } else -+ /* channel bw offset can be allowed, not need MCC */ -+ *chbw_allow = _TRUE; -+ } -+ #endif /* CONFIG_MCC_MODE */ -+ -+ if (req_ch == 0 && dec_bw[i] > u_bw -+ && rtw_chset_is_dfs_chbw(chset, u_ch, u_bw, u_offset) -+ ) { -+ /* request comes from upper layer, prevent from additional channel waiting */ -+ dec_bw[i] = u_bw; -+ if (dec_bw[i] == CHANNEL_WIDTH_20) -+ dec_offset[i] = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ /* follow */ -+ rtw_chset_sync_chbw(chset -+ , &dec_ch[i], &dec_bw[i], &dec_offset[i] -+ , &u_ch, &u_bw, &u_offset, 1, 0); -+ } -+ -+ *set_u_ch = _TRUE; -+ -+ } else { -+ /* autonomous decision */ -+ u8 ori_ch = 0; -+ u8 max_bw; -+ bool by_int_info; -+ -+ /* autonomous decision, not need MCC */ -+ *chbw_allow = _TRUE; -+ -+ if (req_ch <= REQ_CH_NONE) /* channel is not specified */ -+ goto choose_chbw; -+ -+ /* get tmp dec union of ifbmp */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) -+ continue; -+ if (u_ch == 0) { -+ u_ch = dec_ch[i]; -+ u_bw = dec_bw[i]; -+ u_offset = dec_offset[i]; -+ rtw_adjust_chbw(adapter, u_ch, &u_bw, &u_offset); -+ rtw_get_offset_by_chbw(u_ch, u_bw, &u_offset); -+ } else { -+ u8 tmp_ch = dec_ch[i]; -+ u8 tmp_bw = dec_bw[i]; -+ u8 tmp_offset = dec_offset[i]; -+ -+ rtw_adjust_chbw(adapter, tmp_ch, &tmp_bw, &tmp_offset); -+ rtw_get_offset_by_chbw(tmp_ch, tmp_bw, &tmp_offset); -+ -+ rtw_warn_on(!rtw_is_chbw_grouped(u_ch, u_bw, u_offset, tmp_ch, tmp_bw, tmp_offset)); -+ rtw_sync_chbw(&tmp_ch, &tmp_bw, &tmp_offset, &u_ch, &u_bw, &u_offset); -+ } -+ } -+ -+ #ifdef CONFIG_RTW_MESH -+ /* if ifbmp are all mesh, apply bw restriction */ -+ if (ifbmp_all_mesh) -+ rtw_mesh_adjust_chbw(u_ch, &u_bw, &u_offset); -+ #endif -+ -+ RTW_INFO("%s ifbmp:0x%02x tmp union:%u,%u,%u\n", __func__, ifbmp, u_ch, u_bw, u_offset); -+ -+ /* check if tmp dec union is usable */ -+ if (rtw_ap_ch_specific_chk(adapter, u_ch, &u_bw, &u_offset, __func__) == _FAIL) { -+ /* channel can't be used */ -+ if (req_ch > 0) { -+ /* specific channel and not from IE => don't change channel setting */ -+ goto exit; -+ } -+ goto choose_chbw; -+ } else if (rtw_chset_is_chbw_non_ocp(chset, u_ch, u_bw, u_offset)) { -+ RTW_WARN("%s DFS channel %u,%u under non ocp\n", __func__, u_ch, u_bw); -+ if (req_ch > 0 && req_bw > REQ_BW_NONE) { -+ /* change_chbw with specific channel and specific bw, goto update_bss_chbw directly */ -+ goto update_bss_chbw; -+ } -+ } else -+ goto update_bss_chbw; -+ -+choose_chbw: -+ by_int_info = req_ch == REQ_CH_INT_INFO ? 1 : 0; -+ req_ch = req_ch > 0 ? req_ch : 0; -+ max_bw = req_bw > REQ_BW_NONE ? req_bw : CHANNEL_WIDTH_20; -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) -+ continue; -+ iface = dvobj->padapters[i]; -+ mlmeext = &(iface->mlmeextpriv); -+ -+ if (req_bw <= REQ_BW_NONE) { -+ if (req_bw == REQ_BW_ORI) { -+ if (max_bw < iface->mlmepriv.ori_bw) -+ max_bw = iface->mlmepriv.ori_bw; -+ } else { -+ if (max_bw < cur_ie_bw[i]) -+ max_bw = cur_ie_bw[i]; -+ } -+ } -+ -+ if (MSTATE_AP_NUM(&mstate) || MSTATE_MESH_NUM(&mstate)) { -+ if (ori_ch == 0) -+ ori_ch = mlmeext->cur_channel; -+ else if (ori_ch != mlmeext->cur_channel) -+ rtw_warn_on(1); -+ } else { -+ if (ori_ch == 0) -+ ori_ch = cur_ie_ch[i]; -+ else if (ori_ch != cur_ie_ch[i]) -+ rtw_warn_on(1); -+ } -+ } -+ -+ ch_avail = rtw_ap_choose_chbw(adapter, req_ch, max_bw -+ , ori_ch, &u_ch, &u_bw, &u_offset, by_int_info, ifbmp_all_mesh, __func__); -+ if (ch_avail == _FALSE) -+ goto exit; -+ -+update_bss_chbw: -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) -+ continue; -+ iface = dvobj->padapters[i]; -+ -+ dec_ch[i] = u_ch; -+ if (dec_bw[i] > u_bw) -+ dec_bw[i] = u_bw; -+ if (dec_bw[i] == CHANNEL_WIDTH_20) -+ dec_offset[i] = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ else -+ dec_offset[i] = u_offset; -+ -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(iface)) -+ rtw_mesh_adjust_chbw(dec_ch[i], &dec_bw[i], &dec_offset[i]); -+ #endif -+ } -+ -+ *set_u_ch = _TRUE; -+ } -+ -+ ifbmp_ch_changed = rtw_ap_update_chbw_by_ifbmp(dvobj, ifbmp -+ , cur_ie_ch, cur_ie_bw, cur_ie_offset -+ , dec_ch, dec_bw, dec_offset -+ , __func__); -+ -+ if (u_ch != 0) -+ RTW_INFO("%s union:%u,%u,%u\n", __func__, u_ch, u_bw, u_offset); -+ -+ if (*set_u_ch == _TRUE) { -+ rtw_mi_update_union_chan_inf(adapter, u_ch, u_offset, u_bw); -+ *ch = u_ch; -+ *bw = u_bw; -+ *offset = u_offset; -+ } -+ -+ if (rtw_mi_check_fwstate(adapter, WIFI_UNDER_SURVEY)) { -+ /* scanning, leave ch setting to scan state machine */ -+ *set_u_ch = _FALSE; -+ } -+ -+exit: -+ return ifbmp_ch_changed; -+} -+ -+u8 rtw_ap_sta_states_check(_adapter *adapter) -+{ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ _list *plist, *phead; -+ _irqL irqL; -+ u8 rst = _FALSE; -+ -+ if (!MLME_IS_AP(adapter) && !MLME_IS_MESH(adapter)) -+ return _FALSE; -+ -+ if (pstapriv->auth_list_cnt !=0) -+ return _TRUE; -+ -+ _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); -+ -+ if (!(psta->state & WIFI_ASOC_STATE)) { -+ RTW_INFO(ADPT_FMT"- SoftAP/Mesh - sta under linking, its state = 0x%x\n", ADPT_ARG(adapter), psta->state); -+ rst = _TRUE; -+ break; -+ } else if (psta->state & WIFI_UNDER_KEY_HANDSHAKE) { -+ RTW_INFO(ADPT_FMT"- SoftAP/Mesh - sta under key handshaking, its state = 0x%x\n", ADPT_ARG(adapter), psta->state); -+ rst = _TRUE; -+ break; -+ } -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ return rst; -+} -+ -+/*#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 */ -+ u32 txbcn_timer_ms; /* unit : ms */ -+ 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 -+ txbcn_timer_ms = time_offset / NET80211_TU_TO_US; -+ _set_timer(&pdvobj->txbcn_timer, txbcn_timer_ms); -+ -+ if (padapter) { -+#ifdef CONFIG_BCN_RECOVERY -+ rtw_ap_bcn_recovery(padapter); -+#endif /*CONFIG_BCN_RECOVERY*/ -+ -+#ifdef CONFIG_BCN_XMIT_PROTECT -+ rtw_ap_bcn_queue_empty_check(padapter, txbcn_timer_ms); -+#endif /*CONFIG_BCN_XMIT_PROTECT*/ -+ -+#ifdef DBG_SWTIMER_BASED_TXBCN -+ RTW_INFO("padapter=%p, PORT=%d\n", padapter, padapter->hw_port); -+#endif -+ /* bypass TX BCN queue if op ch is switching/waiting */ -+ if (!check_fwstate(&padapter->mlmepriv, WIFI_OP_CH_SWITCHING) -+ && !IS_CH_WAITING(adapter_to_rfctl(padapter)) -+ ) { -+ /*update_beacon(padapter, _TIM_IE_, NULL, _FALSE, 0);*/ -+ /*issue_beacon(padapter, 0);*/ -+ send_beacon(padapter); -+ } -+ } -+ -+#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(void *ctx) -+{ -+ struct dvobj_priv *pdvobj = (struct dvobj_priv *)ctx; -+ _adapter *padapter = pdvobj->padapters[0]; -+ -+ if (padapter) -+ set_tx_beacon_cmd(padapter, 0); -+} -+#endif -+ -+void rtw_ap_parse_sta_capability(_adapter *adapter, struct sta_info *sta, u8 *cap) -+{ -+ sta->capability = RTW_GET_LE16(cap); -+ if (sta->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) -+ sta->flags |= WLAN_STA_SHORT_PREAMBLE; -+ else -+ sta->flags &= ~WLAN_STA_SHORT_PREAMBLE; -+} -+ -+u16 rtw_ap_parse_sta_supported_rates(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len) -+{ -+ u8 rate_set[12]; -+ u8 rate_num; -+ int i; -+ u16 status = _STATS_SUCCESSFUL_; -+ -+ rtw_ies_get_supported_rate(tlv_ies, tlv_ies_len, rate_set, &rate_num); -+ if (rate_num == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" sta "MAC_FMT" with no supported rate\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); -+ status = _STATS_FAILURE_; -+ goto exit; -+ } -+ -+ _rtw_memcpy(sta->bssrateset, rate_set, rate_num); -+ sta->bssratelen = rate_num; -+ -+ if (MLME_IS_AP(adapter)) { -+ /* this function force only CCK rates to be bassic rate... */ -+ UpdateBrateTblForSoftAP(sta->bssrateset, sta->bssratelen); -+ } -+ -+ /* if (hapd->iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G) */ /* ? */ -+ sta->flags |= WLAN_STA_NONERP; -+ for (i = 0; i < sta->bssratelen; i++) { -+ if ((sta->bssrateset[i] & 0x7f) > 22) { -+ sta->flags &= ~WLAN_STA_NONERP; -+ break; -+ } -+ } -+ -+exit: -+ return status; -+} -+ -+u16 rtw_ap_parse_sta_security_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems) -+{ -+ struct security_priv *sec = &adapter->securitypriv; -+ u8 *wpa_ie; -+ int wpa_ie_len; -+ int group_cipher = 0, pairwise_cipher = 0, gmcs = 0; -+ u32 akm = 0; -+ u8 mfp_opt = MFP_NO; -+ u8 spp_opt = 0; -+ u16 status = _STATS_SUCCESSFUL_; -+ -+ sta->dot8021xalg = 0; -+ sta->wpa_psk = 0; -+ sta->wpa_group_cipher = 0; -+ sta->wpa2_group_cipher = 0; -+ sta->wpa_pairwise_cipher = 0; -+ sta->wpa2_pairwise_cipher = 0; -+ _rtw_memset(sta->wpa_ie, 0, sizeof(sta->wpa_ie)); -+ -+ if ((sec->wpa_psk & BIT(1)) && elems->rsn_ie) { -+ 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, &gmcs, &akm, &mfp_opt, &spp_opt) == _SUCCESS) { -+ sta->dot8021xalg = 1;/* psk, todo:802.1x */ -+ sta->wpa_psk |= BIT(1); -+ -+ sta->wpa2_group_cipher = group_cipher & sec->wpa2_group_cipher; -+ sta->wpa2_pairwise_cipher = pairwise_cipher & sec->wpa2_pairwise_cipher; -+ -+ sta->akm_suite_type = akm; -+ if (MLME_IS_AP(adapter) && (CHECK_BIT(WLAN_AKM_TYPE_SAE, akm)) && (MFP_NO == mfp_opt)) { -+ status = WLAN_STATUS_ROBUST_MGMT_FRAME_POLICY_VIOLATION; -+ goto exit; -+ } -+ -+ if (MLME_IS_AP(adapter) && (!CHECK_BIT(sec->akmp, akm))) { -+ status = WLAN_STATUS_AKMP_NOT_VALID; -+ goto exit; -+ } -+ -+ if (!sta->wpa2_group_cipher) { -+ status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; -+ goto exit; -+ } -+ -+ if (!sta->wpa2_pairwise_cipher) { -+ status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; -+ goto exit; -+ } -+ -+ } else { -+ status = WLAN_STATUS_INVALID_IE; -+ goto exit; -+ } -+ -+ } -+ else if ((sec->wpa_psk & BIT(0)) && elems->wpa_ie) { -+ 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) { -+ sta->dot8021xalg = 1;/* psk, todo:802.1x */ -+ sta->wpa_psk |= BIT(0); -+ -+ sta->wpa_group_cipher = group_cipher & sec->wpa_group_cipher; -+ sta->wpa_pairwise_cipher = pairwise_cipher & sec->wpa_pairwise_cipher; -+ -+ if (!sta->wpa_group_cipher) { -+ status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; -+ goto exit; -+ } -+ -+ if (!sta->wpa_pairwise_cipher) { -+ status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; -+ goto exit; -+ } -+ } else { -+ status = WLAN_STATUS_INVALID_IE; -+ goto exit; -+ } -+ -+ } else { -+ wpa_ie = NULL; -+ wpa_ie_len = 0; -+ } -+ if (sec->dot11PrivacyAlgrthm != _NO_PRIVACY_) { -+ /*check if amsdu is allowed */ -+ if (rtw_check_amsdu_disable(adapter->registrypriv.amsdu_mode, spp_opt) == _TRUE) -+ sta->flags |= WLAN_STA_AMSDU_DISABLE; -+ } -+ -+ if ((sec->mfp_opt == MFP_REQUIRED && mfp_opt < MFP_OPTIONAL) -+ || (mfp_opt == MFP_REQUIRED && sec->mfp_opt < MFP_OPTIONAL) -+ ) { -+ status = WLAN_STATUS_ROBUST_MGMT_FRAME_POLICY_VIOLATION; -+ goto exit; -+ } -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(adapter)) { -+ /* MFP is mandatory for secure mesh */ -+ if (adapter->mesh_info.mesh_auth_id) -+ sta->flags |= WLAN_STA_MFP; -+ } else -+#endif -+ if (sec->mfp_opt >= MFP_OPTIONAL && mfp_opt >= MFP_OPTIONAL) -+ sta->flags |= WLAN_STA_MFP; -+ -+#ifdef CONFIG_IEEE80211W -+ if ((sta->flags & WLAN_STA_MFP) -+ && (sec->mfp_opt >= MFP_OPTIONAL && mfp_opt >= MFP_OPTIONAL) -+ && security_type_bip_to_gmcs(sec->dot11wCipher) != gmcs -+ ) { -+ status = WLAN_STATUS_CIPHER_REJECTED_PER_POLICY; -+ goto exit; -+ } -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (MLME_IS_AP(adapter) && -+ (sec->auth_type == MLME_AUTHTYPE_SAE) && -+ (CHECK_BIT(WLAN_AKM_TYPE_SAE, sta->akm_suite_type)) && -+ (WLAN_AUTH_OPEN == sta->authalg)) { -+ /* WPA3-SAE, PMK caching */ -+ if (rtw_cached_pmkid(adapter, sta->cmn.mac_addr) == -1) { -+ RTW_INFO("SAE: No PMKSA cache entry found\n"); -+ status = WLAN_STATUS_INVALID_PMKID; -+ goto exit; -+ } else { -+ RTW_INFO("SAE: PMKSA cache entry found\n"); -+ } -+ } -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ if (!MLME_IS_AP(adapter)) -+ goto exit; -+ -+ sta->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"); -+ sta->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"); -+ sta->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 ((sec->wpa_psk > 0) -+ && (sta->flags & (WLAN_STA_WPS | WLAN_STA_MAYBE_WPS)) -+ ) { -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ if (mlme->wps_beacon_ie) { -+ u8 selected_registrar = 0; -+ -+ rtw_get_wps_attr_content(mlme->wps_beacon_ie, mlme->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 exit; -+ } -+ } -+ } -+ -+ } else { -+ int copy_len; -+ -+ if (sec->wpa_psk == 0) { -+ RTW_INFO("STA " MAC_FMT -+ ": WPA/RSN IE in association request, but AP don't support WPA/RSN\n", -+ MAC_ARG(sta->cmn.mac_addr)); -+ status = WLAN_STATUS_INVALID_IE; -+ goto exit; -+ } -+ -+ if (elems->wps_ie) { -+ RTW_INFO("STA included WPS IE in " -+ "(Re)Association Request - WPS is " -+ "used\n"); -+ sta->flags |= WLAN_STA_WPS; -+ copy_len = 0; -+ } else -+ copy_len = ((wpa_ie_len + 2) > sizeof(sta->wpa_ie)) ? (sizeof(sta->wpa_ie)) : (wpa_ie_len + 2); -+ -+ if (copy_len > 0) -+ _rtw_memcpy(sta->wpa_ie, wpa_ie - 2, copy_len); -+ } -+ -+exit: -+ return status; -+} -+ -+void rtw_ap_parse_sta_wmm_ie(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len) -+{ -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; -+ u8 *p; -+ -+ sta->flags &= ~WLAN_STA_WME; -+ sta->qos_option = 0; -+ sta->qos_info = 0; -+ sta->has_legacy_ac = _TRUE; -+ sta->uapsd_vo = 0; -+ sta->uapsd_vi = 0; -+ sta->uapsd_be = 0; -+ sta->uapsd_bk = 0; -+ -+ if (!mlme->qospriv.qos_option) -+ goto exit; -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(adapter)) { -+ /* QoS is mandatory in mesh */ -+ sta->flags |= WLAN_STA_WME; -+ } -+#endif -+ -+ p = rtw_get_ie_ex(tlv_ies, tlv_ies_len, WLAN_EID_VENDOR_SPECIFIC, WMM_IE, 6, NULL, NULL); -+ if (!p) -+ goto exit; -+ -+ sta->flags |= WLAN_STA_WME; -+ sta->qos_option = 1; -+ sta->qos_info = *(p + 8); -+ sta->max_sp_len = (sta->qos_info >> 5) & 0x3; -+ -+ if ((sta->qos_info & 0xf) != 0xf) -+ sta->has_legacy_ac = _TRUE; -+ else -+ sta->has_legacy_ac = _FALSE; -+ -+ if (sta->qos_info & 0xf) { -+ if (sta->qos_info & BIT(0)) -+ sta->uapsd_vo = BIT(0) | BIT(1); -+ else -+ sta->uapsd_vo = 0; -+ -+ if (sta->qos_info & BIT(1)) -+ sta->uapsd_vi = BIT(0) | BIT(1); -+ else -+ sta->uapsd_vi = 0; -+ -+ if (sta->qos_info & BIT(2)) -+ sta->uapsd_bk = BIT(0) | BIT(1); -+ else -+ sta->uapsd_bk = 0; -+ -+ if (sta->qos_info & BIT(3)) -+ sta->uapsd_be = BIT(0) | BIT(1); -+ else -+ sta->uapsd_be = 0; -+ } -+ -+exit: -+ return; -+} -+ -+void rtw_ap_parse_sta_ht_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems) -+{ -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ sta->flags &= ~WLAN_STA_HT; -+ -+#ifdef CONFIG_80211N_HT -+ if (mlme->htpriv.ht_option == _FALSE) -+ goto exit; -+ -+ /* save HT capabilities in the sta object */ -+ _rtw_memset(&sta->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ if (elems->ht_capabilities && elems->ht_capabilities_len >= sizeof(struct rtw_ieee80211_ht_cap)) { -+ sta->flags |= WLAN_STA_HT; -+ sta->flags |= WLAN_STA_WME; -+ _rtw_memcpy(&sta->htpriv.ht_cap, elems->ht_capabilities, sizeof(struct rtw_ieee80211_ht_cap)); -+ -+ if (elems->ht_operation && elems->ht_operation_len == HT_OP_IE_LEN) { -+ _rtw_memcpy(sta->htpriv.ht_op, elems->ht_operation, HT_OP_IE_LEN); -+ sta->htpriv.op_present = 1; -+ } -+ } -+exit: -+#endif -+ -+ return; -+} -+ -+void rtw_ap_parse_sta_vht_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems) -+{ -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ sta->flags &= ~WLAN_STA_VHT; -+ -+#ifdef CONFIG_80211AC_VHT -+ if (mlme->vhtpriv.vht_option == _FALSE) -+ goto exit; -+ -+ _rtw_memset(&sta->vhtpriv, 0, sizeof(struct vht_priv)); -+ if (elems->vht_capabilities && elems->vht_capabilities_len == VHT_CAP_IE_LEN) { -+ sta->flags |= WLAN_STA_VHT; -+ _rtw_memcpy(sta->vhtpriv.vht_cap, elems->vht_capabilities, VHT_CAP_IE_LEN); -+ -+ if (elems->vht_operation && elems->vht_operation_len== VHT_OP_IE_LEN) { -+ _rtw_memcpy(sta->vhtpriv.vht_op, elems->vht_operation, VHT_OP_IE_LEN); -+ sta->vhtpriv.op_present = 1; -+ } -+ -+ if (elems->vht_op_mode_notify && elems->vht_op_mode_notify_len == 1) { -+ _rtw_memcpy(&sta->vhtpriv.vht_op_mode_notify, elems->vht_op_mode_notify, 1); -+ sta->vhtpriv.notify_present = 1; -+ } -+ } -+exit: -+#endif -+ -+ return; -+} -+ -+void rtw_ap_parse_sta_multi_ap_ie(_adapter *adapter, struct sta_info *sta, u8 *ies, int ies_len) -+{ -+ sta->flags &= ~WLAN_STA_MULTI_AP; -+ -+#ifdef CONFIG_RTW_MULTI_AP -+ if (adapter->multi_ap -+ && (rtw_get_multi_ap_ie_ext(ies, ies_len) & MULTI_AP_BACKHAUL_STA) -+ ) { -+ if (adapter->multi_ap & MULTI_AP_BACKHAUL_BSS) /* with backhaul bss, enable WDS */ -+ sta->flags |= WLAN_STA_MULTI_AP | WLAN_STA_WDS; -+ else if (adapter->multi_ap & MULTI_AP_FRONTHAUL_BSS) /* fronthaul bss only */ -+ sta->flags |= WLAN_STA_MULTI_AP; -+ } -+#endif -+} -+ -+#if CONFIG_RTW_AP_DATA_BMC_TO_UC -+static bool rtw_ap_data_bmc_to_uc(_adapter *adapter -+ , const u8 *da, const u8 *sa, const u8 *ori_ta -+ , u16 os_qid, _list *b2u_list) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct xmit_priv *xmitpriv = &adapter->xmitpriv; -+ _irqL irqL; -+ _list *head, *list; -+ struct sta_info *sta; -+ char b2u_sta_id[NUM_STA]; -+ u8 b2u_sta_num = 0; -+ bool bmc_need = _FALSE; -+ int i; -+ -+ _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ head = &stapriv->asoc_list; -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ int stainfo_offset; -+ -+ sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); -+ list = get_next(list); -+ -+ stainfo_offset = rtw_stainfo_offset(stapriv, sta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ b2u_sta_id[b2u_sta_num++] = stainfo_offset; -+ } -+ _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ -+ if (!b2u_sta_num) -+ goto exit; -+ -+ for (i = 0; i < b2u_sta_num; i++) { -+ struct xmit_frame *b2uframe; -+ struct pkt_attrib *attrib; -+ -+ sta = rtw_get_stainfo_by_offset(stapriv, b2u_sta_id[i]); -+ if (!(sta->state & WIFI_ASOC_STATE) -+ || _rtw_memcmp(sta->cmn.mac_addr, sa, ETH_ALEN) == _TRUE -+ || (ori_ta && _rtw_memcmp(sta->cmn.mac_addr, ori_ta, ETH_ALEN) == _TRUE) -+ || is_broadcast_mac_addr(sta->cmn.mac_addr) -+ || is_zero_mac_addr(sta->cmn.mac_addr)) -+ continue; -+ -+ b2uframe = rtw_alloc_xmitframe(xmitpriv, os_qid); -+ if (!b2uframe) { -+ bmc_need = _TRUE; -+ break; -+ } -+ -+ attrib = &b2uframe->attrib; -+ -+ _rtw_memcpy(attrib->ra, sta->cmn.mac_addr, ETH_ALEN); -+ _rtw_memcpy(attrib->ta, adapter_mac_addr(adapter), ETH_ALEN); -+ #ifdef CONFIG_RTW_WDS -+ if (adapter_use_wds(adapter) && (sta->flags & WLAN_STA_WDS)) { -+ _rtw_memcpy(attrib->dst, da, ETH_ALEN); -+ attrib->wds = 1; -+ } else -+ #endif -+ _rtw_memcpy(attrib->dst, attrib->ra, ETH_ALEN); -+ _rtw_memcpy(attrib->src, sa, ETH_ALEN); -+ -+ rtw_list_insert_tail(&b2uframe->list, b2u_list); -+ } -+ -+exit: -+ return bmc_need; -+} -+ -+void dump_ap_b2u_flags(void *sel, _adapter *adapter) -+{ -+ RTW_PRINT_SEL(sel, "%4s %4s\n", "src", "fwd"); -+ RTW_PRINT_SEL(sel, "0x%02x 0x%02x\n", adapter->b2u_flags_ap_src, adapter->b2u_flags_ap_fwd); -+} -+#endif /* CONFIG_RTW_AP_DATA_BMC_TO_UC */ -+ -+static int rtw_ap_nexthop_resolve(_adapter *adapter, struct xmit_frame *xframe) -+{ -+ struct pkt_attrib *attrib = &xframe->attrib; -+ int ret = _SUCCESS; -+ -+#ifdef CONFIG_RTW_WDS -+ if (adapter_use_wds(adapter)) { -+ if (rtw_wds_nexthop_lookup(adapter, attrib->dst, attrib->ra) == 0) { -+ if (_rtw_memcmp(attrib->dst, attrib->ra, ETH_ALEN) == _FALSE) -+ attrib->wds = 1; -+ } else -+ ret = _FAIL; -+ } else -+#endif -+ _rtw_memcpy(attrib->ra, attrib->dst, ETH_ALEN); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_RTW_WDS -+static void rtw_ap_data_flood_for_unknown_da(_adapter *adapter -+ , const u8 *da, const u8 *sa, const u8 *ori_ta -+ , u16 os_qid, _list *f_list) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct xmit_priv *xmitpriv = &adapter->xmitpriv; -+ _irqL irqL; -+ _list *head, *list; -+ struct sta_info *sta; -+ char sta_id[NUM_STA]; -+ u8 sta_num = 0; -+ int i; -+ -+ _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ head = &stapriv->asoc_list; -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ int stainfo_offset; -+ -+ sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); -+ list = get_next(list); -+ -+ stainfo_offset = rtw_stainfo_offset(stapriv, sta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ sta_id[sta_num++] = stainfo_offset; -+ } -+ _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ -+ if (!sta_num) -+ goto exit; -+ -+ for (i = 0; i < sta_num; i++) { -+ struct xmit_frame *frame; -+ struct pkt_attrib *attrib; -+ -+ sta = rtw_get_stainfo_by_offset(stapriv, sta_id[i]); -+ if (!(sta->state & WIFI_ASOC_STATE) -+ || !(sta->flags & WLAN_STA_WDS) -+ || _rtw_memcmp(sta->cmn.mac_addr, sa, ETH_ALEN) == _TRUE -+ || (ori_ta && _rtw_memcmp(sta->cmn.mac_addr, ori_ta, ETH_ALEN) == _TRUE) -+ || is_broadcast_mac_addr(sta->cmn.mac_addr) -+ || is_zero_mac_addr(sta->cmn.mac_addr)) -+ continue; -+ -+ frame = rtw_alloc_xmitframe(xmitpriv, os_qid); -+ if (!frame) -+ break; -+ -+ attrib = &frame->attrib; -+ -+ _rtw_memcpy(attrib->ra, sta->cmn.mac_addr, ETH_ALEN); -+ _rtw_memcpy(attrib->ta, adapter_mac_addr(adapter), ETH_ALEN); -+ _rtw_memcpy(attrib->dst, da, ETH_ALEN); -+ _rtw_memcpy(attrib->src, sa, ETH_ALEN); -+ attrib->wds = 1; -+ -+ rtw_list_insert_tail(&frame->list, f_list); -+ } -+ -+exit: -+ return; -+} -+#endif /* CONFIG_RTW_WDS */ -+ -+int rtw_ap_addr_resolve(_adapter *adapter, u16 os_qid, struct xmit_frame *xframe, _pkt *pkt, _list *f_list) -+{ -+ struct pkt_file pktfile; -+ struct ethhdr etherhdr; -+ struct pkt_attrib *attrib; -+ struct rtw_mesh_path *mpath = NULL, *mppath = NULL; -+ u8 is_da_mcast; -+ u8 addr4_need; -+ int res = _SUCCESS; -+ -+ _rtw_open_pktfile(pkt, &pktfile); -+ if (_rtw_pktfile_read(&pktfile, (u8 *)ðerhdr, ETH_HLEN) != ETH_HLEN) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ xframe->pkt = pkt; -+#if defined(CONFIG_RTW_WDS) || CONFIG_RTW_AP_DATA_BMC_TO_UC -+ _rtw_init_listhead(f_list); -+#endif -+ -+ is_da_mcast = IS_MCAST(etherhdr.h_dest); -+ if (is_da_mcast) { -+ #if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ if (rtw_ap_src_b2u_policy_chk(adapter->b2u_flags_ap_src, etherhdr.h_dest) -+ && adapter->registrypriv.wifi_spec == 0 -+ && adapter->xmitpriv.free_xmitframe_cnt > (NR_XMITFRAME / 4) -+ ) { -+ if (rtw_ap_data_bmc_to_uc(adapter -+ , etherhdr.h_dest, etherhdr.h_source, NULL, os_qid, f_list) == 0 -+ ) { -+ res = RTW_ORI_NO_NEED; -+ goto exit; -+ } -+ } -+ #endif -+ } -+ -+ attrib = &xframe->attrib; -+ -+ _rtw_memcpy(attrib->dst, etherhdr.h_dest, ETH_ALEN); -+ _rtw_memcpy(attrib->src, etherhdr.h_source, ETH_ALEN); -+ _rtw_memcpy(attrib->ta, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ if (is_da_mcast) -+ _rtw_memcpy(attrib->ra, attrib->dst, ETH_ALEN); -+ else { -+ res = rtw_ap_nexthop_resolve(adapter, xframe); -+ #ifdef CONFIG_RTW_WDS -+ if (res != _SUCCESS) { -+ /* unknown DA, flood frame to every WDS STA */ -+ rtw_ap_data_flood_for_unknown_da(adapter -+ , etherhdr.h_dest, etherhdr.h_source, NULL, os_qid, f_list); -+ res = RTW_ORI_NO_NEED; -+ } -+ #endif -+ } -+ -+exit: -+ return res; -+} -+ -+int rtw_ap_rx_data_validate_hdr(_adapter *adapter, union recv_frame *rframe, struct sta_info **sta) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; -+ u8 *whdr = get_recvframe_data(rframe); -+ u8 is_ra_bmc = 0; -+ sint ret = _FAIL; -+ -+ if (!(MLME_STATE(adapter) & WIFI_ASOC_STATE)) -+ goto exit; -+ -+ switch (rattrib->to_fr_ds) { -+ case 1: -+ if (IS_MCAST(GetAddr1Ptr(whdr))) -+ goto exit; -+ _rtw_memcpy(rattrib->ra, GetAddr1Ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->ta, get_addr2_ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->dst, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ -+ _rtw_memcpy(rattrib->src, get_addr2_ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->bssid, GetAddr1Ptr(whdr), ETH_ALEN); -+ break; -+ case 3: -+ is_ra_bmc = IS_MCAST(GetAddr1Ptr(whdr)) ? 1 : 0; -+ _rtw_memcpy(rattrib->ra, GetAddr1Ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->ta, get_addr2_ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->dst, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ -+ _rtw_memcpy(rattrib->src, GetAddr4Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ -+ if (!is_ra_bmc) -+ _rtw_memcpy(rattrib->bssid, GetAddr1Ptr(whdr), ETH_ALEN); -+ break; -+ default: -+ ret = RTW_RX_HANDLED; /* don't count for drop */ -+ goto exit; -+ } -+ -+ *sta = rtw_get_stainfo(stapriv, rattrib->ta); -+ if (*sta == NULL) { -+ if (!is_ra_bmc && !IS_RADAR_DETECTED(adapter_to_rfctl(adapter))) { -+ #ifndef CONFIG_CUSTOMER_ALIBABA_GENERAL -+ RTW_INFO(FUNC_ADPT_FMT" issue_deauth to "MAC_FMT" with reason(7), unknown TA\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(rattrib->ta)); -+ issue_deauth(adapter, rattrib->ta, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ #endif -+ } -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+#ifdef CONFIG_RTW_WDS_AUTO_EN -+ if (rattrib->to_fr_ds == 3 && !(sta->flags & WLAN_STA_WDS)) -+ sta->flags |= WLAN_STA_WDS; -+#endif -+ -+ process_pwrbit_data(adapter, rframe, *sta); -+ -+ if ((get_frame_sub_type(whdr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) -+ process_wmmps_data(adapter, rframe, *sta); -+ -+ if (get_frame_sub_type(whdr) & BIT(6)) { -+ /* No data, will not indicate to upper layer, temporily count it here */ -+ count_rx_stats(adapter, rframe, *sta); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int rtw_ap_rx_msdu_act_check(union recv_frame *rframe -+ , const u8 *da, const u8 *sa -+ , u8 *msdu, enum rtw_rx_llc_hdl llc_hdl -+ , struct xmit_frame **fwd_frame, _list *f_list) -+{ -+ _adapter *adapter = rframe->u.hdr.adapter; -+ struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; -+ struct rtw_wds_path *wpath; -+ u8 is_da_bmc = IS_MCAST(da); -+ u8 is_da_self = !is_da_bmc && _rtw_memcmp(da, adapter_mac_addr(adapter), ETH_ALEN); -+ u8 is_da_peer = 0; -+ int in_wds_tbl = 0; -+ u16 os_qid; -+ struct xmit_frame *xframe; -+ struct pkt_attrib *xattrib; -+ u8 fwd_ra[ETH_ALEN] = {0}; -+ int act = 0; -+ -+#ifdef CONFIG_RTW_WDS -+ /* update/create wds info for SA, RA */ -+ if (adapter_use_wds(adapter) -+ && (rframe->u.hdr.psta->state & WIFI_ASOC_STATE) -+ && _rtw_memcmp(sa, rframe->u.hdr.psta->cmn.mac_addr, ETH_ALEN) == _FALSE -+ ) { -+ rtw_rcu_read_lock(); -+ wpath = rtw_wds_path_lookup(adapter, sa); -+ if (!wpath) -+ rtw_wds_path_add(adapter, sa, rframe->u.hdr.psta); -+ else { -+ rtw_wds_path_assign_nexthop(wpath, rframe->u.hdr.psta); -+ wpath->last_update = rtw_get_current_time(); -+ } -+ rtw_rcu_read_unlock(); -+ } -+#endif -+ -+ /* SA is self, need no further process */ -+ if (_rtw_memcmp(sa, adapter_mac_addr(adapter), ETH_ALEN) == _TRUE) -+ goto exit; -+ -+ if (is_da_bmc) { -+ /* DA is bmc addr */ -+ act |= RTW_RX_MSDU_ACT_INDICATE; -+ if (adapter->mlmepriv.ap_isolate) -+ goto exit; -+ goto fwd_chk; -+ -+ } -+ -+ if (is_da_self) { -+ /* DA is self, indicate */ -+ act |= RTW_RX_MSDU_ACT_INDICATE; -+ goto exit; -+ } -+ -+ /* DA is not self */ -+#ifdef CONFIG_RTW_WDS -+ if (adapter_use_wds(adapter)) -+ in_wds_tbl = rtw_wds_nexthop_lookup(adapter, da, fwd_ra) == 0; -+#endif -+ if (!in_wds_tbl) -+ is_da_peer = rtw_get_stainfo(&adapter->stapriv, da) ? 1 : 0; -+ -+ if (in_wds_tbl || is_da_peer) { -+ /* DA is known (peer or can be forwarded by peer) */ -+ if (adapter->mlmepriv.ap_isolate) { -+ #if defined(DBG_RX_DROP_FRAME) -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" DA("MAC_FMT") through peer, ap_isolate\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(da)); -+ #endif -+ goto exit; -+ } -+ goto fwd_chk; -+ } -+ -+ /* DA is unknown*/ -+ act |= RTW_RX_MSDU_ACT_INDICATE; -+ if (adapter->mlmepriv.ap_isolate) { -+ /* -+ * unknown DA and ap_isolate, indicate only -+ * (bridge will not forward packets to originating port) -+ */ -+ goto exit; -+ } -+ -+fwd_chk: -+ -+ if (adapter->stapriv.asoc_list_cnt <= 1) -+ goto exit; -+ -+ os_qid = rtw_os_recv_select_queue(msdu, llc_hdl); -+ -+#if defined(CONFIG_RTW_WDS) || CONFIG_RTW_AP_DATA_BMC_TO_UC -+ _rtw_init_listhead(f_list); -+#endif -+ -+#if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ if (is_da_bmc) { -+ if (rtw_ap_fwd_b2u_policy_chk(adapter->b2u_flags_ap_fwd, da, rattrib->to_fr_ds == 3 && !IS_MCAST(rattrib->ra)) -+ && adapter->registrypriv.wifi_spec == 0 -+ && adapter->xmitpriv.free_xmitframe_cnt > (NR_XMITFRAME / 4) -+ ) { -+ if (rtw_ap_data_bmc_to_uc(adapter -+ , da, sa, rframe->u.hdr.psta->cmn.mac_addr -+ , os_qid, f_list) == 0 -+ ) { -+ if (!rtw_is_list_empty(f_list)) -+ goto set_act_fwd; -+ else -+ goto exit; -+ } -+ } -+ } else -+#endif -+#ifdef CONFIG_RTW_WDS -+ if (adapter_use_wds(adapter) && !in_wds_tbl && !is_da_peer) { -+ /* unknown DA, flood frame to every WDS STA except receiving one */ -+ rtw_ap_data_flood_for_unknown_da(adapter -+ , da, sa, rframe->u.hdr.psta->cmn.mac_addr -+ , os_qid, f_list); -+ if (!rtw_is_list_empty(f_list)) -+ goto set_act_fwd; -+ else -+ goto exit; -+ } else -+#endif -+ ; -+ -+ xframe = rtw_alloc_xmitframe(&adapter->xmitpriv, os_qid); -+ if (!xframe) { -+ #ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME "FUNC_ADPT_FMT" rtw_alloc_xmitframe fail\n" -+ , FUNC_ADPT_ARG(adapter)); -+ #endif -+ goto exit; -+ } -+ -+ xattrib = &xframe->attrib; -+ -+ _rtw_memcpy(xattrib->dst, da, ETH_ALEN); -+ _rtw_memcpy(xattrib->src, sa, ETH_ALEN); -+ _rtw_memcpy(xattrib->ta, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ #ifdef CONFIG_RTW_WDS -+ if (in_wds_tbl && _rtw_memcmp(da, fwd_ra, ETH_ALEN) == _FALSE) { -+ _rtw_memcpy(xattrib->ra, fwd_ra, ETH_ALEN); -+ xattrib->wds = 1; -+ } else -+ #endif -+ _rtw_memcpy(xattrib->ra, da, ETH_ALEN); -+ -+ *fwd_frame = xframe; -+ -+#if defined(CONFIG_RTW_WDS) || CONFIG_RTW_AP_DATA_BMC_TO_UC -+set_act_fwd: -+#endif -+ act |= RTW_RX_MSDU_ACT_FORWARD; -+ -+exit: -+ return act; -+} -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+void rtw_issue_action_token_req(_adapter *padapter, struct sta_info *pstat) -+{ -+ /* Token Request Format -+ Category code : 1 Byte -+ Action code : 1 Byte -+ Element field: 4 Bytes, the duration of data transmission requested for the station. -+ */ -+ -+ u8 val = 0x0; -+ u8 category = RTW_WLAN_CATEGORY_TBTX; -+ u32 tbtx_duration = TBTX_TX_DURATION*1000; -+ u8 *pframe; -+ unsigned short *fctrl; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ 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); -+ -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ return; -+ -+ RTW_DBG("%s: %6ph\n", __FUNCTION__, pstat->cmn.mac_addr); -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->rate = MGN_24M; /* issue action request using OFDM rate? 20190716 Bruce add */ -+ -+ _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->cmn.mac_addr, ETH_ALEN); -+ _rtw_memcpy((void *)get_addr2_ptr(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++; -+ set_frame_sub_type(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, &(val), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *)&(tbtx_duration), &(pattrib->pktlen)); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ padapter->stapriv.last_token_holder = pstat; -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+#endif /* CONFIG_RTW_TOKEN_BASED_XMIT */ -+#endif /* CONFIG_AP_MODE */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_beamforming.c b/drivers/net/wireless/rtl8821cs/core/rtw_beamforming.c -new file mode 100644 -index 000000000..7bafe3d40 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_beamforming.c -@@ -0,0 +1,2194 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_BEAMFORMING_C_ -+ -+#include -+#include -+ -+#ifdef CONFIG_BEAMFORMING -+ -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ -+struct ndpa_sta_info { -+ u16 aid:12; -+ u16 feedback_type:1; -+ u16 nc_index:3; -+}; -+ -+static void _get_txvector_parameter(PADAPTER adapter, struct sta_info *sta, u8 *g_id, u16 *p_aid) -+{ -+ struct mlme_priv *mlme; -+ u16 aid; -+ u8 *bssid; -+ u16 val16; -+ u8 i; -+ -+ -+ mlme = &adapter->mlmepriv; -+ -+ if (check_fwstate(mlme, WIFI_AP_STATE)) { -+ /* -+ * Sent by an AP and addressed to a STA associated with that AP -+ * or sent by a DLS or TDLS STA in a direct path to -+ * a DLS or TDLS peer STA -+ */ -+ -+ aid = sta->cmn.aid; -+ bssid = adapter_mac_addr(adapter); -+ RTW_INFO("%s: AID=0x%x BSSID=" MAC_FMT "\n", -+ __FUNCTION__, sta->cmn.aid, MAC_ARG(bssid)); -+ -+ /* AID[0:8] */ -+ aid &= 0x1FF; -+ /* BSSID[44:47] xor BSSID[40:43] */ -+ val16 = ((bssid[5] & 0xF0) >> 4) ^ (bssid[5] & 0xF); -+ /* (dec(AID[0:8]) + dec(BSSID)*2^5) mod 2^9 */ -+ *p_aid = (aid + (val16 << 5)) & 0x1FF; -+ *g_id = 63; -+ } else if ((check_fwstate(mlme, WIFI_ADHOC_STATE) == _TRUE) -+ || (check_fwstate(mlme, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { -+ /* -+ * Otherwise, includes -+ * 1. Sent to an IBSS STA -+ * 2. Sent by an AP to a non associated STA -+ * 3. Sent to a STA for which it is not known -+ * which condition is applicable -+ */ -+ *p_aid = 0; -+ *g_id = 63; -+ } else { -+ /* Addressed to AP */ -+ bssid = sta->cmn.mac_addr; -+ RTW_INFO("%s: BSSID=" MAC_FMT "\n", __FUNCTION__, MAC_ARG(bssid)); -+ -+ /* BSSID[39:47] */ -+ *p_aid = (bssid[5] << 1) | (bssid[4] >> 7); -+ *g_id = 0; -+ } -+ -+ RTW_INFO("%s: GROUP_ID=0x%02x PARTIAL_AID=0x%04x\n", -+ __FUNCTION__, *g_id, *p_aid); -+} -+ -+/* -+ * 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 beamforming_info *info; -+ struct mlme_priv *mlme; -+ struct ht_priv *ht; -+ u16 ht_bf_cap; -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv *vht; -+ u16 vht_bf_cap; -+#endif /* CONFIG_80211AC_VHT */ -+ -+ -+ *sta_bf_cap = 0; -+ *sounding_dim = 0; -+ *comp_steering = 0; -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ ht = &adapter->mlmepriv.htpriv; -+#ifdef CONFIG_80211AC_VHT -+ vht = &adapter->mlmepriv.vhtpriv; -+#endif /* CONFIG_80211AC_VHT */ -+ mlme = &adapter->mlmepriv; -+ -+ if (is_supported_ht(sta->wireless_mode) == _FALSE) -+ goto get_bfcap_next; -+ -+ /* HT */ -+ if (check_fwstate(mlme, WIFI_AP_STATE)) { -+ /* Get peer clinet's BF cap: the cap. is intersected with associated AP.*/ -+ ht_bf_cap = sta->htpriv.beamform_cap; -+ RTW_INFO("At AP state, peer sta's ht_bf_cap=0x%x\n", ht_bf_cap); -+ -+ if (TEST_FLAG(ht_bf_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { -+ info->beamforming_cap |= BEAMFORMER_CAP_HT_EXPLICIT; -+ *sta_bf_cap |= BEAMFORMEE_CAP_HT_EXPLICIT; -+ *comp_steering = (ht_bf_cap & BEAMFORMING_HT_BEAMFORMER_STEER_NUM) >> 4; -+ RTW_INFO("%s: we support BEAMFORMER_CAP_HT_EXPLICIT\n", __func__); -+ } -+ if (TEST_FLAG(ht_bf_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { -+ info->beamforming_cap |= BEAMFORMEE_CAP_HT_EXPLICIT; -+ *sta_bf_cap |= BEAMFORMER_CAP_HT_EXPLICIT; -+ *sounding_dim = (ht_bf_cap & BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP) >> 6; -+ RTW_INFO("%s: we support BEAMFORMEE_CAP_HT_EXPLICIT\n", __func__); -+ } -+ } else { -+ /* Get adapter's BF Cap: the cap. is intersected with associated AP.*/ -+ ht_bf_cap = ht->beamform_cap; -+ RTW_INFO("At non-AP state, adapter's ht_bf_cap=0x%x\n", ht_bf_cap); -+ -+ if (TEST_FLAG(ht_bf_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { -+ info->beamforming_cap |= BEAMFORMEE_CAP_HT_EXPLICIT; -+ *sta_bf_cap |= BEAMFORMER_CAP_HT_EXPLICIT; -+ *sounding_dim = (ht_bf_cap & BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP) >> 6; -+ RTW_INFO("%s: we support BEAMFORMEE_CAP_HT_EXPLICIT\n", __func__); -+ } -+ if (TEST_FLAG(ht_bf_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { -+ info->beamforming_cap |= BEAMFORMER_CAP_HT_EXPLICIT; -+ *sta_bf_cap |= BEAMFORMEE_CAP_HT_EXPLICIT; -+ *comp_steering = (ht_bf_cap & BEAMFORMING_HT_BEAMFORMER_STEER_NUM) >> 4; -+ RTW_INFO("%s: we support BEAMFORMER_CAP_HT_EXPLICIT\n", __func__); -+ } -+ } -+ -+get_bfcap_next: -+#ifdef CONFIG_80211AC_VHT -+ if (is_supported_vht(sta->wireless_mode) == _FALSE) -+ return; -+ -+ /* VHT */ -+ if (check_fwstate(mlme, WIFI_AP_STATE)) { -+ /* Get peer clinet's BF cap: the cap. is intersected with associated AP.*/ -+ vht_bf_cap = sta->vhtpriv.beamform_cap; -+ RTW_INFO("At AP state, peer sta's vht_bf_cap=0x%x\n", vht_bf_cap); -+ -+ /* We are SU Beamformer because the STA is SU Beamformee */ -+ if (TEST_FLAG(vht_bf_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { -+ info->beamforming_cap |= BEAMFORMER_CAP_VHT_SU; -+ *sta_bf_cap |= BEAMFORMEE_CAP_VHT_SU; -+ RTW_INFO("%s: we support BEAMFORMER_CAP_VHT_SU\n", __func__); -+ -+ /* We are MU Beamformer because the STA is MU Beamformee */ -+ if (TEST_FLAG(vht_bf_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) { -+ info->beamforming_cap |= BEAMFORMER_CAP_VHT_MU; -+ *sta_bf_cap |= BEAMFORMEE_CAP_VHT_MU; -+ RTW_INFO("%s: we support BEAMFORMER_CAP_VHT_MU\n", __func__); -+ } -+ -+ *comp_steering = (vht_bf_cap & BEAMFORMING_VHT_BEAMFORMER_STS_CAP) >> 8; -+ } -+ /* We are SU Beamformee because the STA is SU Beamformer */ -+ if (TEST_FLAG(vht_bf_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { -+ info->beamforming_cap |= BEAMFORMEE_CAP_VHT_SU; -+ *sta_bf_cap |= BEAMFORMER_CAP_VHT_SU; -+ RTW_INFO("%s: we support BEAMFORMEE_CAP_VHT_SU\n", __func__); -+ -+ /* The STA is MU Beamformer, but we(AP) should not be MU Beamformee */ -+ if (TEST_FLAG(vht_bf_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) { -+ RTW_WARN("%s: Associated STA should not be a MU BFer.\n", __func__); -+ } -+ -+ *sounding_dim = (vht_bf_cap & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM) >> 12; -+ } -+ } else { -+ /* Get adapter's BF Cap: the cap. is intersected with associated AP.*/ -+ vht_bf_cap = vht->beamform_cap; -+ RTW_INFO("At non-AP state, adapter's vht_bf_cap=0x%x\n", vht_bf_cap); -+ -+ /* We are SU Beamformee */ -+ if (TEST_FLAG(vht_bf_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { -+ info->beamforming_cap |= BEAMFORMEE_CAP_VHT_SU; -+ *sta_bf_cap |= BEAMFORMER_CAP_VHT_SU; -+ RTW_INFO("%s: we support BEAMFORMEE_CAP_VHT_SU\n", __func__); -+ -+ /* We are MU Beamformee */ -+ if (TEST_FLAG(vht_bf_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) { -+ info->beamforming_cap |= BEAMFORMEE_CAP_VHT_MU; -+ *sta_bf_cap |= BEAMFORMER_CAP_VHT_MU; -+ RTW_INFO("%s: we support BEAMFORMEE_CAP_VHT_MU\n", __func__); -+ } -+ -+ *sounding_dim = (vht_bf_cap & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM) >> 12; -+ } -+ /* We are SU Beamformer */ -+ if (TEST_FLAG(vht_bf_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { -+ info->beamforming_cap |= BEAMFORMER_CAP_VHT_SU; -+ *sta_bf_cap |= BEAMFORMEE_CAP_VHT_SU; -+ RTW_INFO("%s: we support BEAMFORMER_CAP_VHT_SU\n", __func__); -+ -+ /* We are MU Beamformer, but client should not be a MU Beamformer */ -+ if (TEST_FLAG(vht_bf_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) { -+ RTW_WARN("%s: non-AP state should not support MU BFer.\n", __func__); -+ } -+ -+ *comp_steering = (vht_bf_cap & BEAMFORMING_VHT_BEAMFORMER_STS_CAP) >> 8; -+ } -+ } -+#endif /* CONFIG_80211AC_VHT */ -+ -+} -+ -+static u8 _send_ht_ndpa_packet(PADAPTER adapter, u8 *ra, enum channel_width bw) -+{ -+ /* General */ -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ struct xmit_frame *pmgntframe; -+ /* Beamforming */ -+ struct beamforming_info *info; -+ struct beamformee_entry *bfee; -+ struct ndpa_sta_info sta_info; -+ u8 ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xE0, 0x4C}; -+ /* MISC */ -+ struct pkt_attrib *attrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ enum MGN_RATE txrate; -+ u8 *pframe; -+ u16 duration = 0; -+ u8 aSifsTime = 0; -+ -+ -+ RTW_INFO("+%s: Send to " MAC_FMT "\n", __FUNCTION__, MAC_ARG(ra)); -+ -+ pxmitpriv = &adapter->xmitpriv; -+ pmlmeext = &adapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ bfee = rtw_bf_bfee_get_entry_by_addr(adapter, ra); -+ if (!bfee) { -+ RTW_ERR("%s: Cann't find beamformee entry!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (!pmgntframe) { -+ RTW_ERR("%s: alloc mgnt frame fail!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ txrate = beamforming_get_htndp_tx_rate(GET_PDM_ODM(adapter), bfee->comp_steering_num_of_bfer); -+ -+ /* update attribute */ -+ attrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(adapter, attrib); -+ /*attrib->type = WIFI_MGT_TYPE;*/ /* set in update_mgntframe_attrib() */ -+ attrib->subtype = WIFI_ACTION_NOACK; -+ attrib->bwmode = bw; -+ /*attrib->qsel = QSLT_MGNT;*/ /* set in update_mgntframe_attrib() */ -+ attrib->order = 1; -+ attrib->rate = (u8)txrate; -+ attrib->bf_pkt_type = 0; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ /* Frame control */ -+ pwlanhdr->frame_ctl = 0; -+ set_frame_sub_type(pframe, attrib->subtype); -+ set_order_bit(pframe); -+ -+ /* Duration */ -+ 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; -+ set_duration(pframe, duration); -+ -+ /* DA */ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ /* SA */ -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); -+ /* BSSID */ -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ -+ /* HT control field */ -+ SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1); -+ -+ /* -+ * Frame Body -+ * Category field: vender-specific value, 0x7F -+ * OUI: 0x00E04C -+ */ -+ _rtw_memcpy(pframe + 28, ActionHdr, 4); -+ -+ attrib->pktlen = 32; -+ attrib->last_txcmdsz = attrib->pktlen; -+ -+ dump_mgntframe(adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+static u8 _send_vht_ndpa_packet(PADAPTER adapter, u8 *ra, u16 aid, enum channel_width bw) -+{ -+ /* General */ -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct xmit_frame *pmgntframe; -+ /* Beamforming */ -+ struct beamforming_info *info; -+ struct beamformee_entry *bfee; -+ struct ndpa_sta_info sta_info; -+ /* MISC */ -+ struct pkt_attrib *attrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u8 *pframe; -+ enum MGN_RATE txrate; -+ u16 duration = 0; -+ u8 sequence = 0, aSifsTime = 0; -+ -+ -+ RTW_INFO("+%s: Send to " MAC_FMT "\n", __FUNCTION__, MAC_ARG(ra)); -+ -+ pxmitpriv = &adapter->xmitpriv; -+ pmlmeext = &adapter->mlmeextpriv; -+ info = GET_BEAMFORM_INFO(adapter); -+ bfee = rtw_bf_bfee_get_entry_by_addr(adapter, ra); -+ if (!bfee) { -+ RTW_ERR("%s: Cann't find beamformee entry!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (!pmgntframe) { -+ RTW_ERR("%s: alloc mgnt frame fail!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ txrate = beamforming_get_vht_ndp_tx_rate(GET_PDM_ODM(adapter), bfee->comp_steering_num_of_bfer); -+ -+ /* update attribute */ -+ attrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(adapter, attrib); -+ /*pattrib->type = WIFI_MGT_TYPE;*/ /* set in update_mgntframe_attrib() */ -+ attrib->subtype = WIFI_NDPA; -+ attrib->bwmode = bw; -+ /*attrib->qsel = QSLT_MGNT;*/ /* set in update_mgntframe_attrib() */ -+ attrib->rate = (u8)txrate; -+ attrib->bf_pkt_type = 0; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, TXDESC_OFFSET + WLANHDR_OFFSET); -+ pframe = pmgntframe->buf_addr + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ /* Frame control */ -+ pwlanhdr->frame_ctl = 0; -+ set_frame_sub_type(pframe, attrib->subtype); -+ -+ /* Duration */ -+ if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(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; -+ set_duration(pframe, duration); -+ -+ /* RA */ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ -+ /* TA */ -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ /* Sounding Sequence, bit0~1 is reserved */ -+ sequence = info->sounding_sequence << 2; -+ if (info->sounding_sequence >= 0x3f) -+ info->sounding_sequence = 0; -+ else -+ info->sounding_sequence++; -+ _rtw_memcpy(pframe + 16, &sequence, 1); -+ -+ /* STA Info */ -+ /* -+ * "AID12" Equal to 0 if the STA is an AP, mesh STA or -+ * STA that is a member of an IBSS -+ */ -+ if (check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _FALSE) -+ aid = 0; -+ sta_info.aid = aid; -+ /* "Feedback Type" set to 0 for SU */ -+ sta_info.feedback_type = 0; -+ /* "Nc Index" reserved if the Feedback Type field indicates SU */ -+ sta_info.nc_index = 0; -+ _rtw_memcpy(pframe + 17, (u8 *)&sta_info, 2); -+ -+ attrib->pktlen = 19; -+ attrib->last_txcmdsz = attrib->pktlen; -+ -+ dump_mgntframe(adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+static u8 _send_vht_mu_ndpa_packet(PADAPTER adapter, enum channel_width bw) -+{ -+ /* General */ -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct xmit_frame *pmgntframe; -+ /* Beamforming */ -+ struct beamforming_info *info; -+ struct sounding_info *sounding; -+ struct beamformee_entry *bfee; -+ struct ndpa_sta_info sta_info; -+ /* MISC */ -+ struct pkt_attrib *attrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ enum MGN_RATE txrate; -+ u8 *pframe; -+ u8 *ra = NULL; -+ u16 duration = 0; -+ u8 sequence = 0, aSifsTime = 0; -+ u8 i; -+ -+ -+ RTW_INFO("+%s\n", __FUNCTION__); -+ -+ pxmitpriv = &adapter->xmitpriv; -+ pmlmeext = &adapter->mlmeextpriv; -+ info = GET_BEAMFORM_INFO(adapter); -+ sounding = &info->sounding_info; -+ -+ txrate = MGN_VHT2SS_MCS0; -+ -+ /* -+ * 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. -+ */ -+ bfee = &info->bfee_entry[sounding->mu_sounding_list[0]]; -+ ra = bfee->mac_addr; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (!pmgntframe) { -+ RTW_ERR("%s: alloc mgnt frame fail!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ /* update attribute */ -+ attrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(adapter, attrib); -+ /*attrib->type = WIFI_MGT_TYPE;*/ /* set in update_mgntframe_attrib() */ -+ attrib->subtype = WIFI_NDPA; -+ attrib->bwmode = bw; -+ /*attrib->qsel = QSLT_MGNT;*/ /* set in update_mgntframe_attrib() */ -+ attrib->rate = (u8)txrate; -+ /* Set TxBFPktType of Tx desc to unicast type if there is only one MU STA for HW design */ -+ if (info->sounding_info.candidate_mu_bfee_cnt > 1) -+ attrib->bf_pkt_type = 1; -+ else -+ attrib->bf_pkt_type = 0; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, TXDESC_OFFSET + WLANHDR_OFFSET); -+ pframe = pmgntframe->buf_addr + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ /* Frame control */ -+ pwlanhdr->frame_ctl = 0; -+ set_frame_sub_type(pframe, attrib->subtype); -+ -+ /* Duration */ -+ if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(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; -+ set_duration(pframe, duration); -+ -+ /* RA */ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ -+ /* TA */ -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ /* Sounding Sequence, bit0~1 is reserved */ -+ sequence = info->sounding_sequence << 2; -+ if (info->sounding_sequence >= 0x3f) -+ info->sounding_sequence = 0; -+ else -+ info->sounding_sequence++; -+ _rtw_memcpy(pframe + 16, &sequence, 1); -+ -+ attrib->pktlen = 17; -+ -+ /* -+ * Construct STA info. for multiple STAs -+ * STA Info1, ..., STA Info n -+ */ -+ for (i = 0; i < sounding->candidate_mu_bfee_cnt; i++) { -+ bfee = &info->bfee_entry[sounding->mu_sounding_list[i]]; -+ sta_info.aid = bfee->aid; -+ sta_info.feedback_type = 1; /* 1'b1: MU */ -+ sta_info.nc_index = 0; -+ _rtw_memcpy(pframe + attrib->pktlen, (u8 *)&sta_info, 2); -+ attrib->pktlen += 2; -+ } -+ -+ attrib->last_txcmdsz = attrib->pktlen; -+ -+ dump_mgntframe(adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+static u8 _send_bf_report_poll(PADAPTER adapter, u8 *ra, u8 bFinalPoll) -+{ -+ /* General */ -+ struct xmit_priv *pxmitpriv; -+ struct xmit_frame *pmgntframe; -+ /* MISC */ -+ struct pkt_attrib *attrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u8 *pframe; -+ -+ -+ RTW_INFO("+%s: Send to " MAC_FMT "\n", __FUNCTION__, MAC_ARG(ra)); -+ -+ pxmitpriv = &adapter->xmitpriv; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (!pmgntframe) { -+ RTW_ERR("%s: alloc mgnt frame fail!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ /* update attribute */ -+ attrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(adapter, attrib); -+ /*attrib->type = WIFI_MGT_TYPE;*/ /* set in update_mgntframe_attrib() */ -+ attrib->subtype = WIFI_BF_REPORT_POLL; -+ attrib->bwmode = CHANNEL_WIDTH_20; -+ /*attrib->qsel = QSLT_MGNT;*/ /* set in update_mgntframe_attrib() */ -+ attrib->rate = MGN_6M; -+ if (bFinalPoll) -+ attrib->bf_pkt_type = 3; -+ else -+ attrib->bf_pkt_type = 2; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, TXDESC_OFFSET + WLANHDR_OFFSET); -+ pframe = pmgntframe->buf_addr + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ /* Frame control */ -+ pwlanhdr->frame_ctl = 0; -+ set_frame_sub_type(pframe, attrib->subtype); -+ -+ /* Duration */ -+ set_duration(pframe, 100); -+ -+ /* RA */ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ -+ /* TA */ -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ /* Feedback Segment Retransmission Bitmap */ -+ pframe[16] = 0xFF; -+ -+ attrib->pktlen = 17; -+ attrib->last_txcmdsz = attrib->pktlen; -+ -+ dump_mgntframe(adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+static void _sounding_update_min_period(PADAPTER adapter, u16 period, u8 leave) -+{ -+ struct beamforming_info *info; -+ struct beamformee_entry *bfee; -+ u8 i = 0; -+ u16 min_val = 0xFFFF; -+ -+ -+ 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++) { -+ bfee = &info->bfee_entry[i]; -+ if ((bfee->used == _TRUE) -+ && (bfee->sound_period < min_val)) -+ min_val = bfee->sound_period; -+ } -+ -+ if (min_val == 0xFFFF) -+ info->sounding_info.min_sounding_period = 0; -+ else -+ info->sounding_info.min_sounding_period = min_val; -+ } else { -+ if ((info->sounding_info.min_sounding_period == 0) -+ || (period < info->sounding_info.min_sounding_period)) -+ info->sounding_info.min_sounding_period = period; -+ } -+} -+ -+static void _sounding_init(struct sounding_info *sounding) -+{ -+ _rtw_memset(sounding->su_sounding_list, 0xFF, MAX_NUM_BEAMFORMEE_SU); -+ _rtw_memset(sounding->mu_sounding_list, 0xFF, MAX_NUM_BEAMFORMEE_MU); -+ sounding->state = SOUNDING_STATE_NONE; -+ sounding->su_bfee_curidx = 0xFF; -+ sounding->candidate_mu_bfee_cnt = 0; -+ sounding->min_sounding_period = 0; -+ sounding->sound_remain_cnt_per_period = 0; -+} -+ -+static void _sounding_reset_vars(PADAPTER adapter) -+{ -+ struct beamforming_info *info; -+ struct sounding_info *sounding; -+ u8 idx; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ sounding = &info->sounding_info; -+ -+ _rtw_memset(sounding->su_sounding_list, 0xFF, MAX_NUM_BEAMFORMEE_SU); -+ _rtw_memset(sounding->mu_sounding_list, 0xFF, MAX_NUM_BEAMFORMEE_MU); -+ sounding->su_bfee_curidx = 0xFF; -+ sounding->candidate_mu_bfee_cnt = 0; -+ -+ /* Clear bSound flag for the new period */ -+ for (idx = 0; idx < MAX_BEAMFORMEE_ENTRY_NUM; idx++) { -+ if ((info->bfee_entry[idx].used == _TRUE) -+ && (info->bfee_entry[idx].sounding == _TRUE)) { -+ info->bfee_entry[idx].sounding = _FALSE; -+ info->bfee_entry[idx].bCandidateSoundingPeer = _FALSE; -+ } -+ } -+} -+ -+/* -+ * Return -+ * 0 Prepare sounding list OK -+ * -1 Fail to prepare sounding list, because no beamformee need to souding -+ * -2 Fail to prepare sounding list, because beamformee state not ready -+ * -+ */ -+static int _sounding_get_list(PADAPTER adapter) -+{ -+ struct beamforming_info *info; -+ struct sounding_info *sounding; -+ struct beamformee_entry *bfee; -+ u8 i, mu_idx = 0, su_idx = 0, not_ready = 0; -+ int ret = 0; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ sounding = &info->sounding_info; -+ -+ /* Add MU BFee list first because MU priority is higher than SU */ -+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { -+ bfee = &info->bfee_entry[i]; -+ if (bfee->used == _FALSE) -+ continue; -+ -+ if (bfee->state != BEAMFORM_ENTRY_HW_STATE_ADDED) { -+ RTW_ERR("%s: Invalid BFee idx(%d) Hw state=%d\n", __FUNCTION__, i, bfee->state); -+ not_ready++; -+ continue; -+ } -+ -+ /* -+ * Decrease BFee's SoundCnt per period -+ * If the remain count is 0, -+ * then it can be sounded at this time -+ */ -+ if (bfee->SoundCnt) { -+ bfee->SoundCnt--; -+ if (bfee->SoundCnt) -+ continue; -+ } -+ -+ /* -+ * -+ * If the STA supports MU BFee capability then we add it to MUSoundingList directly -+ * because we can only sound one STA by unicast NDPA with MU cap enabled to get correct channel info. -+ * Suggested by BB team Luke Lee. 2015.11.25. -+ */ -+ if (bfee->cap & BEAMFORMEE_CAP_VHT_MU) { -+ /* MU BFee */ -+ if (mu_idx >= MAX_NUM_BEAMFORMEE_MU) { -+ RTW_ERR("%s: Too much MU bfee entry(Limit:%d)\n", __FUNCTION__, MAX_NUM_BEAMFORMEE_MU); -+ continue; -+ } -+ -+ if (bfee->bApplySounding == _TRUE) { -+ bfee->bCandidateSoundingPeer = _TRUE; -+ bfee->SoundCnt = GetInitSoundCnt(bfee->sound_period, sounding->min_sounding_period); -+ sounding->mu_sounding_list[mu_idx] = i; -+ mu_idx++; -+ } -+ } else if (bfee->cap & (BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { -+ /* SU BFee (HT/VHT) */ -+ if (su_idx >= MAX_NUM_BEAMFORMEE_SU) { -+ RTW_ERR("%s: Too much SU bfee entry(Limit:%d)\n", __FUNCTION__, MAX_NUM_BEAMFORMEE_SU); -+ continue; -+ } -+ -+ if (bfee->bDeleteSounding == _TRUE) { -+ sounding->su_sounding_list[su_idx] = i; -+ su_idx++; -+ } else if ((bfee->bApplySounding == _TRUE) -+ && (bfee->bSuspendSUCap == _FALSE)) { -+ bfee->bCandidateSoundingPeer = _TRUE; -+ bfee->SoundCnt = GetInitSoundCnt(bfee->sound_period, sounding->min_sounding_period); -+ sounding->su_sounding_list[su_idx] = i; -+ su_idx++; -+ } -+ } -+ } -+ -+ sounding->candidate_mu_bfee_cnt = mu_idx; -+ -+ if (su_idx + mu_idx == 0) { -+ ret = -1; -+ if (not_ready) -+ ret = -2; -+ } -+ -+ RTW_INFO("-%s: There are %d SU and %d MU BFees in this sounding period\n", __FUNCTION__, su_idx, mu_idx); -+ -+ return ret; -+} -+ -+static void _sounding_handler(PADAPTER adapter) -+{ -+ struct beamforming_info *info; -+ struct sounding_info *sounding; -+ struct beamformee_entry *bfee; -+ u8 su_idx, i; -+ u32 timeout_period = 0; -+ u8 set_timer = _FALSE; -+ int ret = 0; -+ static u16 wait_cnt = 0; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ sounding = &info->sounding_info; -+ -+ RTW_DBG("+%s: state=%d\n", __FUNCTION__, sounding->state); -+ if ((sounding->state != SOUNDING_STATE_INIT) -+ && (sounding->state != SOUNDING_STATE_SU_SOUNDDOWN) -+ && (sounding->state != SOUNDING_STATE_MU_SOUNDDOWN) -+ && (sounding->state != SOUNDING_STATE_SOUNDING_TIMEOUT)) { -+ RTW_WARN("%s: Invalid State(%d) and return!\n", __FUNCTION__, sounding->state); -+ return; -+ } -+ -+ if (sounding->state == SOUNDING_STATE_INIT) { -+ RTW_INFO("%s: Sounding start\n", __FUNCTION__); -+ -+ /* Init Var */ -+ _sounding_reset_vars(adapter); -+ -+ /* Get the sounding list of this sounding period */ -+ ret = _sounding_get_list(adapter); -+ if (ret == -1) { -+ wait_cnt = 0; -+ sounding->state = SOUNDING_STATE_NONE; -+ RTW_ERR("%s: No BFees found, set to SOUNDING_STATE_NONE\n", __FUNCTION__); -+ info->sounding_running--; -+ return; -+ } -+ if (ret == -2) { -+ RTW_WARN("%s: Temporarily cann't find BFee to sounding\n", __FUNCTION__); -+ if (wait_cnt < 5) { -+ wait_cnt++; -+ } else { -+ wait_cnt = 0; -+ sounding->state = SOUNDING_STATE_NONE; -+ RTW_ERR("%s: Wait changing state timeout!! Set to SOUNDING_STATE_NONE\n", __FUNCTION__); -+ } -+ info->sounding_running--; -+ return; -+ } -+ if (ret != 0) { -+ wait_cnt = 0; -+ RTW_ERR("%s: Unkown state(%d)!\n", __FUNCTION__, ret); -+ info->sounding_running--; -+ return; -+ -+ } -+ -+ wait_cnt = 0; -+ -+ if (check_fwstate(&adapter->mlmepriv, WIFI_UNDER_SURVEY) == _TRUE) { -+ RTW_INFO("%s: Sounding abort! scanning APs...\n", __FUNCTION__); -+ info->sounding_running--; -+ return; -+ } -+ -+ rtw_ps_deny(adapter, PS_DENY_BEAMFORMING); -+ LeaveAllPowerSaveModeDirect(adapter); -+ } -+ -+ /* Get non-sound SU BFee index */ -+ for (i = 0; i < MAX_NUM_BEAMFORMEE_SU; i++) { -+ su_idx = sounding->su_sounding_list[i]; -+ if (su_idx >= MAX_BEAMFORMEE_ENTRY_NUM) -+ continue; -+ bfee = &info->bfee_entry[su_idx]; -+ if (_FALSE == bfee->sounding) -+ break; -+ } -+ if (i < MAX_NUM_BEAMFORMEE_SU) { -+ sounding->su_bfee_curidx = su_idx; -+ /* Set to sounding start state */ -+ sounding->state = SOUNDING_STATE_SU_START; -+ RTW_DBG("%s: Set to SOUNDING_STATE_SU_START\n", __FUNCTION__); -+ -+ bfee->sounding = _TRUE; -+ /* Reset sounding timeout flag for the new sounding */ -+ bfee->bSoundingTimeout = _FALSE; -+ -+ if (_TRUE == bfee->bDeleteSounding) { -+ u8 res = _FALSE; -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_END_PERIOD, &res, 1, 0); -+ return; -+ } -+ -+ /* Start SU sounding */ -+ if (bfee->cap & BEAMFORMEE_CAP_VHT_SU) -+ _send_vht_ndpa_packet(adapter, bfee->mac_addr, bfee->aid, bfee->sound_bw); -+ else if (bfee->cap & BEAMFORMEE_CAP_HT_EXPLICIT) -+ _send_ht_ndpa_packet(adapter, bfee->mac_addr, bfee->sound_bw); -+ -+ /* Set sounding timeout timer */ -+ _set_timer(&info->sounding_timeout_timer, SU_SOUNDING_TIMEOUT); -+ return; -+ } -+ -+ if (sounding->candidate_mu_bfee_cnt > 0) { -+ /* -+ * If there is no SU BFee then find MU BFee and perform MU sounding -+ * -+ * Need to check the MU starting condition. 2015.12.15. -+ */ -+ sounding->state = SOUNDING_STATE_MU_START; -+ RTW_DBG("%s: Set to SOUNDING_STATE_MU_START\n", __FUNCTION__); -+ -+ /* Update MU BFee info */ -+ for (i = 0; i < sounding->candidate_mu_bfee_cnt; i++) { -+ bfee = &info->bfee_entry[sounding->mu_sounding_list[i]]; -+ bfee->sounding = _TRUE; -+ } -+ -+ /* Send MU NDPA */ -+ bfee = &info->bfee_entry[sounding->mu_sounding_list[0]]; -+ _send_vht_mu_ndpa_packet(adapter, bfee->sound_bw); -+ -+ /* Send BF report poll if more than 1 MU STA */ -+ for (i = 1; i < sounding->candidate_mu_bfee_cnt; i++) { -+ bfee = &info->bfee_entry[sounding->mu_sounding_list[i]]; -+ -+ if (i == (sounding->candidate_mu_bfee_cnt - 1))/* The last STA*/ -+ _send_bf_report_poll(adapter, bfee->mac_addr, _TRUE); -+ else -+ _send_bf_report_poll(adapter, bfee->mac_addr, _FALSE); -+ } -+ -+ sounding->candidate_mu_bfee_cnt = 0; -+ -+ /* Set sounding timeout timer */ -+ _set_timer(&info->sounding_timeout_timer, MU_SOUNDING_TIMEOUT); -+ return; -+ } -+ -+ info->sounding_running--; -+ sounding->state = SOUNDING_STATE_INIT; -+ RTW_INFO("%s: Sounding finished!\n", __FUNCTION__); -+ rtw_ps_deny_cancel(adapter, PS_DENY_BEAMFORMING); -+} -+ -+static void _sounding_force_stop(PADAPTER adapter) -+{ -+ struct beamforming_info *info; -+ struct sounding_info *sounding; -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ sounding = &info->sounding_info; -+ -+ if ((sounding->state == SOUNDING_STATE_SU_START) -+ || (sounding->state == SOUNDING_STATE_MU_START)) { -+ u8 res = _FALSE; -+ _cancel_timer_ex(&info->sounding_timeout_timer); -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_END_PERIOD, &res, 1, 1); -+ return; -+ } -+ -+ info->sounding_running--; -+ sounding->state = SOUNDING_STATE_INIT; -+ RTW_INFO("%s: Sounding finished!\n", __FUNCTION__); -+ rtw_ps_deny_cancel(adapter, PS_DENY_BEAMFORMING); -+} -+ -+static void _sounding_timer_handler(void *FunctionContext) -+{ -+ PADAPTER adapter; -+ struct beamforming_info *info; -+ struct sounding_info *sounding; -+ static u8 delay = 0; -+ -+ -+ RTW_DBG("+%s\n", __FUNCTION__); -+ -+ adapter = (PADAPTER)FunctionContext; -+ info = GET_BEAMFORM_INFO(adapter); -+ sounding = &info->sounding_info; -+ -+ if (SOUNDING_STATE_NONE == sounding->state) { -+ RTW_INFO("%s: Stop!\n", __FUNCTION__); -+ if (info->sounding_running) -+ RTW_WARN("%s: souding_running=%d when thread stop!\n", -+ __FUNCTION__, info->sounding_running); -+ return; -+ } -+ -+ _set_timer(&info->sounding_timer, sounding->min_sounding_period); -+ -+ if (!info->sounding_running) { -+ if (SOUNDING_STATE_INIT != sounding->state) { -+ RTW_WARN("%s: state(%d) != SOUNDING_STATE_INIT!!\n", __FUNCTION__, sounding->state); -+ sounding->state = SOUNDING_STATE_INIT; -+ } -+ delay = 0; -+ info->sounding_running++; -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_START_PERIOD, NULL, 0, 1); -+ } else { -+ if (delay != 0xFF) -+ delay++; -+ RTW_WARN("%s: souding is still processing...(state:%d, running:%d, delay:%d)\n", -+ __FUNCTION__, sounding->state, info->sounding_running, delay); -+ if (delay > 3) { -+ RTW_WARN("%s: Stop sounding!!\n", __FUNCTION__); -+ _sounding_force_stop(adapter); -+ } -+ } -+} -+ -+static void _sounding_timeout_timer_handler(void *FunctionContext) -+{ -+ PADAPTER adapter; -+ struct beamforming_info *info; -+ struct sounding_info *sounding; -+ struct beamformee_entry *bfee; -+ -+ -+ RTW_WARN("+%s\n", __FUNCTION__); -+ -+ adapter = (PADAPTER)FunctionContext; -+ info = GET_BEAMFORM_INFO(adapter); -+ sounding = &info->sounding_info; -+ -+ if (SOUNDING_STATE_SU_START == sounding->state) { -+ sounding->state = SOUNDING_STATE_SOUNDING_TIMEOUT; -+ RTW_ERR("%s: Set to SU SOUNDING_STATE_SOUNDING_TIMEOUT\n", __FUNCTION__); -+ /* SU BFee */ -+ bfee = &info->bfee_entry[sounding->su_bfee_curidx]; -+ bfee->bSoundingTimeout = _TRUE; -+ RTW_WARN("%s: The BFee entry[%d] is Sounding Timeout!\n", __FUNCTION__, sounding->su_bfee_curidx); -+ } else if (SOUNDING_STATE_MU_START == sounding->state) { -+ sounding->state = SOUNDING_STATE_SOUNDING_TIMEOUT; -+ RTW_ERR("%s: Set to MU SOUNDING_STATE_SOUNDING_TIMEOUT\n", __FUNCTION__); -+ } else { -+ RTW_WARN("%s: unexpected sounding state:0x%02x\n", __FUNCTION__, sounding->state); -+ return; -+ } -+ -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_START_PERIOD, NULL, 0, 1); -+} -+ -+static struct beamformer_entry *_bfer_get_free_entry(PADAPTER adapter) -+{ -+ u8 i = 0; -+ struct beamforming_info *info; -+ struct beamformer_entry *bfer; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { -+ bfer = &info->bfer_entry[i]; -+ if (bfer->used == _FALSE) -+ return bfer; -+ } -+ -+ return NULL; -+} -+ -+static struct beamformer_entry *_bfer_get_entry_by_addr(PADAPTER adapter, u8 *ra) -+{ -+ u8 i = 0; -+ struct beamforming_info *info; -+ struct beamformer_entry *bfer; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { -+ bfer = &info->bfer_entry[i]; -+ if (bfer->used == _FALSE) -+ continue; -+ if (_rtw_memcmp(ra, bfer->mac_addr, ETH_ALEN) == _TRUE) -+ return bfer; -+ } -+ -+ return NULL; -+} -+ -+static struct beamformer_entry *_bfer_add_entry(PADAPTER adapter, -+ struct sta_info *sta, u8 bf_cap, u8 sounding_dim, u8 comp_steering) -+{ -+ struct mlme_priv *mlme; -+ struct beamforming_info *info; -+ struct beamformer_entry *bfer; -+ u8 *bssid; -+ u16 val16; -+ u8 i; -+ -+ -+ mlme = &adapter->mlmepriv; -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ bfer = _bfer_get_entry_by_addr(adapter, sta->cmn.mac_addr); -+ if (!bfer) { -+ bfer = _bfer_get_free_entry(adapter); -+ if (!bfer) -+ return NULL; -+ } -+ -+ bfer->used = _TRUE; -+ _get_txvector_parameter(adapter, sta, &bfer->g_id, &bfer->p_aid); -+ _rtw_memcpy(bfer->mac_addr, sta->cmn.mac_addr, ETH_ALEN); -+ bfer->cap = bf_cap; -+ bfer->state = BEAMFORM_ENTRY_HW_STATE_ADD_INIT; -+ bfer->NumofSoundingDim = sounding_dim; -+ -+ if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_MU)) { -+ info->beamformer_mu_cnt += 1; -+ bfer->aid = sta->cmn.aid; -+ } else if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { -+ info->beamformer_su_cnt += 1; -+ -+ /* Record HW idx info */ -+ for (i = 0; i < MAX_NUM_BEAMFORMER_SU; i++) { -+ if ((info->beamformer_su_reg_maping & BIT(i)) == 0) { -+ info->beamformer_su_reg_maping |= BIT(i); -+ bfer->su_reg_index = i; -+ break; -+ } -+ } -+ RTW_INFO("%s: Add BFer entry beamformer_su_reg_maping=%#x, su_reg_index=%d\n", -+ __FUNCTION__, info->beamformer_su_reg_maping, bfer->su_reg_index); -+ } -+ -+ return bfer; -+} -+ -+static void _bfer_remove_entry(PADAPTER adapter, struct beamformer_entry *entry) -+{ -+ struct beamforming_info *info; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ entry->state = BEAMFORM_ENTRY_HW_STATE_DELETE_INIT; -+ -+ if (TEST_FLAG(entry->cap, BEAMFORMER_CAP_VHT_MU)) { -+ 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)) { -+ info->beamformer_su_cnt -= 1; -+ } -+ -+ if (info->beamformer_mu_cnt == 0) -+ info->beamforming_cap &= ~BEAMFORMEE_CAP_VHT_MU; -+ if (info->beamformer_su_cnt == 0) -+ info->beamforming_cap &= ~(BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT); -+} -+ -+static u8 _bfer_set_entry_gid(PADAPTER adapter, u8 *addr, u8 *gid, u8 *position) -+{ -+ struct beamformer_entry bfer; -+ -+ memset(&bfer, 0, sizeof(bfer)); -+ memcpy(bfer.mac_addr, addr, ETH_ALEN); -+ -+ /* Parsing Membership Status Array */ -+ memcpy(bfer.gid_valid, gid, 8); -+ -+ /* Parsing User Position Array */ -+ memcpy(bfer.user_position, position, 16); -+ -+ /* Config HW GID table */ -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_SET_GID_TABLE, (u8 *) &bfer, -+ sizeof(bfer), 1); -+ -+ return _SUCCESS; -+} -+ -+static struct beamformee_entry *_bfee_get_free_entry(PADAPTER adapter) -+{ -+ u8 i = 0; -+ struct beamforming_info *info; -+ struct beamformee_entry *bfee; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { -+ bfee = &info->bfee_entry[i]; -+ if (bfee->used == _FALSE) -+ return bfee; -+ } -+ -+ return NULL; -+} -+ -+static struct beamformee_entry *_bfee_get_entry_by_addr(PADAPTER adapter, u8 *ra) -+{ -+ u8 i = 0; -+ struct beamforming_info *info; -+ struct beamformee_entry *bfee; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { -+ bfee = &info->bfee_entry[i]; -+ if (bfee->used == _FALSE) -+ continue; -+ if (_rtw_memcmp(ra, bfee->mac_addr, ETH_ALEN) == _TRUE) -+ return bfee; -+ } -+ -+ return NULL; -+} -+ -+static u8 _bfee_get_first_su_entry_idx(PADAPTER adapter, struct beamformee_entry *ignore) -+{ -+ struct beamforming_info *info; -+ struct beamformee_entry *bfee; -+ u8 i; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { -+ bfee = &info->bfee_entry[i]; -+ if (ignore && (bfee == ignore)) -+ continue; -+ if (bfee->used == _FALSE) -+ continue; -+ if ((!TEST_FLAG(bfee->cap, BEAMFORMEE_CAP_VHT_MU)) -+ && TEST_FLAG(bfee->cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) -+ return i; -+ } -+ -+ return 0xFF; -+} -+ -+/* -+ * Description: -+ * Get the first entry index of MU Beamformee. -+ * -+ * Return Value: -+ * Index of the first MU sta, or 0xFF for invalid index. -+ * -+ * 2015.05.25. Created by tynli. -+ * -+ */ -+static u8 _bfee_get_first_mu_entry_idx(PADAPTER adapter, struct beamformee_entry *ignore) -+{ -+ struct beamforming_info *info; -+ struct beamformee_entry *bfee; -+ u8 i; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { -+ bfee = &info->bfee_entry[i]; -+ if (ignore && (bfee == ignore)) -+ continue; -+ if (bfee->used == _FALSE) -+ continue; -+ if (TEST_FLAG(bfee->cap, BEAMFORMEE_CAP_VHT_MU)) -+ return i; -+ } -+ -+ return 0xFF; -+} -+ -+static struct beamformee_entry *_bfee_add_entry(PADAPTER adapter, -+ struct sta_info *sta, u8 bf_cap, u8 sounding_dim, u8 comp_steering) -+{ -+ struct mlme_priv *mlme; -+ struct beamforming_info *info; -+ struct beamformee_entry *bfee; -+ u8 *bssid; -+ u16 val16; -+ u8 i; -+ -+ -+ mlme = &adapter->mlmepriv; -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ bfee = _bfee_get_entry_by_addr(adapter, sta->cmn.mac_addr); -+ if (!bfee) { -+ bfee = _bfee_get_free_entry(adapter); -+ if (!bfee) -+ return NULL; -+ } -+ -+ bfee->used = _TRUE; -+ bfee->aid = sta->cmn.aid; -+ bfee->mac_id = sta->cmn.mac_id; -+ bfee->sound_bw = sta->cmn.bw_mode; -+ -+ _get_txvector_parameter(adapter, sta, &bfee->g_id, &bfee->p_aid); -+ sta->cmn.bf_info.g_id = bfee->g_id; -+ sta->cmn.bf_info.p_aid = bfee->p_aid; -+ -+ _rtw_memcpy(bfee->mac_addr, sta->cmn.mac_addr, ETH_ALEN); -+ bfee->txbf = _FALSE; -+ bfee->sounding = _FALSE; -+ bfee->sound_period = 40; -+ _sounding_update_min_period(adapter, bfee->sound_period, _FALSE); -+ bfee->SoundCnt = GetInitSoundCnt(bfee->sound_period, info->sounding_info.min_sounding_period); -+ bfee->cap = bf_cap; -+ bfee->state = BEAMFORM_ENTRY_HW_STATE_ADD_INIT; -+ -+ bfee->bCandidateSoundingPeer = _FALSE; -+ bfee->bSoundingTimeout = _FALSE; -+ bfee->bDeleteSounding = _FALSE; -+ bfee->bApplySounding = _TRUE; -+ -+ bfee->tx_timestamp = 0; -+ bfee->tx_bytes = 0; -+ -+ bfee->LogStatusFailCnt = 0; -+ bfee->NumofSoundingDim = sounding_dim; -+ bfee->comp_steering_num_of_bfer = comp_steering; -+ bfee->bSuspendSUCap = _FALSE; -+ -+ if (TEST_FLAG(bf_cap, BEAMFORMEE_CAP_VHT_MU)) { -+ info->beamformee_mu_cnt += 1; -+ info->first_mu_bfee_index = _bfee_get_first_mu_entry_idx(adapter, NULL); -+ -+ if (_TRUE == info->bEnableSUTxBFWorkAround) { -+ /* When the first MU BFee added, discard SU BFee bfee's capability */ -+ if ((info->beamformee_mu_cnt == 1) && (info->beamformee_su_cnt > 0)) { -+ if (info->TargetSUBFee) { -+ info->TargetSUBFee->bSuspendSUCap = _TRUE; -+ info->TargetSUBFee->bDeleteSounding = _TRUE; -+ } else { -+ RTW_ERR("%s: UNEXPECTED!! info->TargetSUBFee is NULL!", __FUNCTION__); -+ } -+ info->TargetSUBFee = NULL; -+ _rtw_memset(&info->TargetCSIInfo, 0, sizeof(struct _RT_CSI_INFO)); -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_SET_CSI_REPORT, (u8*)&info->TargetCSIInfo, sizeof(struct _RT_CSI_INFO), 0); -+ } -+ } -+ -+ /* Record HW idx info */ -+ for (i = 0; i < MAX_NUM_BEAMFORMEE_MU; i++) { -+ if ((info->beamformee_mu_reg_maping & BIT(i)) == 0) { -+ info->beamformee_mu_reg_maping |= BIT(i); -+ bfee->mu_reg_index = i; -+ break; -+ } -+ } -+ RTW_INFO("%s: Add BFee entry beamformee_mu_reg_maping=%#x, mu_reg_index=%d\n", -+ __FUNCTION__, info->beamformee_mu_reg_maping, bfee->mu_reg_index); -+ -+ } else if (TEST_FLAG(bf_cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { -+ info->beamformee_su_cnt += 1; -+ -+ if (_TRUE == info->bEnableSUTxBFWorkAround) { -+ /* Record the first SU BFee index. We only allow the first SU BFee to be sound */ -+ if ((info->beamformee_su_cnt == 1) && (info->beamformee_mu_cnt == 0)) { -+ info->TargetSUBFee = bfee; -+ _rtw_memset(&info->TargetCSIInfo, 0, sizeof(struct _RT_CSI_INFO)); -+ bfee->bSuspendSUCap = _FALSE; -+ } else { -+ bfee->bSuspendSUCap = _TRUE; -+ } -+ } -+ -+ /* Record HW idx info */ -+ for (i = 0; i < MAX_NUM_BEAMFORMEE_SU; i++) { -+ if ((info->beamformee_su_reg_maping & BIT(i)) == 0) { -+ info->beamformee_su_reg_maping |= BIT(i); -+ bfee->su_reg_index = i; -+ break; -+ } -+ } -+ RTW_INFO("%s: Add BFee entry beamformee_su_reg_maping=%#x, su_reg_index=%d\n", -+ __FUNCTION__, info->beamformee_su_reg_maping, bfee->su_reg_index); -+ } -+ -+ return bfee; -+} -+ -+static void _bfee_remove_entry(PADAPTER adapter, struct beamformee_entry *entry) -+{ -+ struct beamforming_info *info; -+ u8 idx; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ entry->state = BEAMFORM_ENTRY_HW_STATE_DELETE_INIT; -+ -+ if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_MU)) { -+ info->beamformee_mu_cnt -= 1; -+ info->first_mu_bfee_index = _bfee_get_first_mu_entry_idx(adapter, entry); -+ -+ if (_TRUE == info->bEnableSUTxBFWorkAround) { -+ if ((info->beamformee_mu_cnt == 0) && (info->beamformee_su_cnt > 0)) { -+ idx = _bfee_get_first_su_entry_idx(adapter, NULL); -+ info->TargetSUBFee = &info->bfee_entry[idx]; -+ _rtw_memset(&info->TargetCSIInfo, 0, sizeof(struct _RT_CSI_INFO)); -+ info->TargetSUBFee->bSuspendSUCap = _FALSE; -+ } -+ } -+ } else if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { -+ info->beamformee_su_cnt -= 1; -+ -+ /* When the target SU BFee leaves, disable workaround */ -+ if ((_TRUE == info->bEnableSUTxBFWorkAround) -+ && (entry == info->TargetSUBFee)) { -+ entry->bSuspendSUCap = _TRUE; -+ info->TargetSUBFee = NULL; -+ _rtw_memset(&info->TargetCSIInfo, 0, sizeof(struct _RT_CSI_INFO)); -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_SET_CSI_REPORT, (u8*)&info->TargetCSIInfo, sizeof(struct _RT_CSI_INFO), 0); -+ } -+ } -+ -+ if (info->beamformee_mu_cnt == 0) -+ info->beamforming_cap &= ~BEAMFORMER_CAP_VHT_MU; -+ if (info->beamformee_su_cnt == 0) -+ info->beamforming_cap &= ~(BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT); -+ -+ _sounding_update_min_period(adapter, 0, _TRUE); -+} -+ -+static enum beamforming_cap _bfee_get_entry_cap_by_macid(PADAPTER adapter, u8 macid) -+{ -+ struct beamforming_info *info; -+ struct beamformee_entry *bfee; -+ u8 i; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { -+ bfee = &info->bfee_entry[i]; -+ if (bfee->used == _FALSE) -+ continue; -+ if (bfee->mac_id == macid) -+ return bfee->cap; -+ } -+ -+ return BEAMFORMING_CAP_NONE; -+} -+ -+static void _beamforming_enter(PADAPTER adapter, void *p) -+{ -+ 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, *sta_copy; -+ struct beamforming_info *info; -+ struct beamformer_entry *bfer = NULL; -+ struct beamformee_entry *bfee = NULL; -+ 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; -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ sta_copy = (struct sta_info *)p; -+ sta = rtw_get_stainfo(&adapter->stapriv, sta_copy->cmn.mac_addr); -+ if (!sta) { -+ RTW_ERR("%s: Cann't find STA info for " MAC_FMT "\n", -+ __FUNCTION__, MAC_ARG(sta_copy->cmn.mac_addr)); -+ return; -+ } -+ -+ RTW_INFO("%s: find STA info for " MAC_FMT "\n", -+ __FUNCTION__, MAC_ARG(sta_copy->cmn.mac_addr)); -+ -+ if (sta != sta_copy) { -+ RTW_WARN("%s: Origin sta(fake)=%p realsta=%p for " MAC_FMT "\n", -+ __FUNCTION__, sta_copy, sta, MAC_ARG(sta_copy->cmn.mac_addr)); -+ } -+ -+ /* The current setting does not support Beaforming */ -+ wireless_mode = sta->wireless_mode; -+ if ((is_supported_ht(wireless_mode) == _FALSE) -+ && (is_supported_vht(wireless_mode) == _FALSE)) { -+ RTW_WARN("%s: Not support HT or VHT mode\n", __FUNCTION__); -+ return; -+ } -+ -+ if ((0 == htpriv->beamform_cap) -+#ifdef CONFIG_80211AC_VHT -+ && (0 == vhtpriv->beamform_cap) -+#endif -+ ) { -+ RTW_INFO("The configuration disabled Beamforming! Skip...\n"); -+ return; -+ } -+ -+ _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; -+ 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; -+ if ((sta_bf_cap & BEAMFORMER_CAP_HT_EXPLICIT) -+ || (sta_bf_cap & BEAMFORMER_CAP_VHT_SU) -+ || (sta_bf_cap & BEAMFORMER_CAP_VHT_MU)) -+ sta_bf_cap |= BEAMFORMER_CAP; -+ -+ if (sta_bf_cap & BEAMFORMER_CAP) { -+ /* The other side is beamformer */ -+ bfer = _bfer_add_entry(adapter, sta, sta_bf_cap, sounding_dim, comp_steering_num); -+ if (!bfer) -+ RTW_ERR("%s: Fail to allocate bfer entry!\n", __FUNCTION__); -+ } -+ if (sta_bf_cap & BEAMFORMEE_CAP) { -+ /* The other side is beamformee */ -+ bfee = _bfee_add_entry(adapter, sta, sta_bf_cap, sounding_dim, comp_steering_num); -+ if (!bfee) -+ RTW_ERR("%s: Fail to allocate bfee entry!\n", __FUNCTION__); -+ } -+ if (!bfer && !bfee) -+ return; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_ENTER, (u8*)sta); -+ -+ /* Perform sounding if there is BFee */ -+ if ((info->beamformee_su_cnt != 0) -+ || (info->beamformee_mu_cnt != 0)) { -+ if (SOUNDING_STATE_NONE == info->sounding_info.state) { -+ info->sounding_info.state = SOUNDING_STATE_INIT; -+ /* Start sounding after 2 sec */ -+ _set_timer(&info->sounding_timer, 2000); -+ } -+ } -+} -+ -+static void _beamforming_reset(PADAPTER adapter) -+{ -+ RTW_ERR("%s: Not ready!!\n", __FUNCTION__); -+} -+ -+static void _beamforming_leave(PADAPTER adapter, u8 *ra) -+{ -+ struct beamforming_info *info; -+ struct beamformer_entry *bfer = NULL; -+ struct beamformee_entry *bfee = NULL; -+ u8 bHwStateAddInit = _FALSE; -+ -+ -+ RTW_INFO("+%s\n", __FUNCTION__); -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ bfer = _bfer_get_entry_by_addr(adapter, ra); -+ bfee = _bfee_get_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) -+ _bfer_remove_entry(adapter, bfer); -+ -+ if (bfee) -+ _bfee_remove_entry(adapter, bfee); -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, ra); -+ -+ /* Stop sounding if there is no any BFee */ -+ if ((info->beamformee_su_cnt == 0) -+ && (info->beamformee_mu_cnt == 0)) { -+ _cancel_timer_ex(&info->sounding_timer); -+ _sounding_init(&info->sounding_info); -+ } -+ -+ RTW_INFO("-%s\n", __FUNCTION__); -+} -+ -+static void _beamforming_sounding_down(PADAPTER adapter, u8 status) -+{ -+ struct beamforming_info *info; -+ struct sounding_info *sounding; -+ struct beamformee_entry *bfee; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ sounding = &info->sounding_info; -+ -+ RTW_INFO("+%s: sounding=%d, status=0x%02x\n", __FUNCTION__, sounding->state, status); -+ -+ if (sounding->state == SOUNDING_STATE_MU_START) { -+ RTW_INFO("%s: MU sounding done\n", __FUNCTION__); -+ sounding->state = SOUNDING_STATE_MU_SOUNDDOWN; -+ RTW_INFO("%s: Set to SOUNDING_STATE_MU_SOUNDDOWN\n", __FUNCTION__); -+ info->SetHalSoundownOnDemandCnt++; -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_STATUS, &status); -+ } else if (sounding->state == SOUNDING_STATE_SU_START) { -+ RTW_INFO("%s: SU entry[%d] sounding down\n", __FUNCTION__, sounding->su_bfee_curidx); -+ bfee = &info->bfee_entry[sounding->su_bfee_curidx]; -+ sounding->state = SOUNDING_STATE_SU_SOUNDDOWN; -+ RTW_INFO("%s: Set to SOUNDING_STATE_SU_SOUNDDOWN\n", __FUNCTION__); -+ -+ /* -+ * -+ * bfee->bSoundingTimeout this flag still cannot avoid -+ * old sound down event happens in the new sounding period. -+ * 2015.12.10 -+ */ -+ if (_TRUE == bfee->bSoundingTimeout) { -+ RTW_WARN("%s: The entry[%d] is bSoundingTimeout!\n", __FUNCTION__, sounding->su_bfee_curidx); -+ bfee->bSoundingTimeout = _FALSE; -+ return; -+ } -+ -+ if (_TRUE == status) { -+ /* success */ -+ bfee->LogStatusFailCnt = 0; -+ info->SetHalSoundownOnDemandCnt++; -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_STATUS, &status); -+ } else if (_TRUE == bfee->bDeleteSounding) { -+ RTW_WARN("%s: Delete entry[%d] sounding info!\n", __FUNCTION__, sounding->su_bfee_curidx); -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_STATUS, &status); -+ bfee->bDeleteSounding = _FALSE; -+ } else { -+ bfee->LogStatusFailCnt++; -+ RTW_WARN("%s: LogStatusFailCnt=%d\n", __FUNCTION__, bfee->LogStatusFailCnt); -+ if (bfee->LogStatusFailCnt > 30) { -+ RTW_ERR("%s: LogStatusFailCnt > 30, Stop SOUNDING!!\n", __FUNCTION__); -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_LEAVE, bfee->mac_addr, ETH_ALEN, 1); -+ } -+ } -+ } else { -+ RTW_WARN("%s: unexpected sounding state:0x%02x\n", __FUNCTION__, sounding->state); -+ return; -+ } -+ -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_START_PERIOD, NULL, 0, 0); -+} -+ -+static void _c2h_snd_txbf(PADAPTER adapter, u8 *buf, u8 buf_len) -+{ -+ struct beamforming_info *info; -+ u8 res; -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ _cancel_timer_ex(&info->sounding_timeout_timer); -+ -+ res = C2H_SND_TXBF_GET_SND_RESULT(buf) ? _TRUE : _FALSE; -+ RTW_INFO("+%s: %s\n", __FUNCTION__, res==_TRUE?"Success":"Fail!"); -+ -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_END_PERIOD, &res, 1, 1); -+} -+ -+/* -+ * Description: -+ * This function is for phydm only -+ */ -+enum beamforming_cap rtw_bf_bfee_get_entry_cap_by_macid(void *mlme, u8 macid) -+{ -+ PADAPTER adapter; -+ enum beamforming_cap cap = BEAMFORMING_CAP_NONE; -+ -+ -+ adapter = mlme_to_adapter((struct mlme_priv *)mlme); -+ cap = _bfee_get_entry_cap_by_macid(adapter, macid); -+ -+ return cap; -+} -+ -+struct beamformer_entry *rtw_bf_bfer_get_entry_by_addr(PADAPTER adapter, u8 *ra) -+{ -+ return _bfer_get_entry_by_addr(adapter, ra); -+} -+ -+struct beamformee_entry *rtw_bf_bfee_get_entry_by_addr(PADAPTER adapter, u8 *ra) -+{ -+ return _bfee_get_entry_by_addr(adapter, ra); -+} -+ -+void rtw_bf_get_ndpa_packet(PADAPTER adapter, union recv_frame *precv_frame) -+{ -+ RTW_DBG("+%s\n", __FUNCTION__); -+} -+ -+u32 rtw_bf_get_report_packet(PADAPTER adapter, union recv_frame *precv_frame) -+{ -+ u32 ret = _SUCCESS; -+ struct beamforming_info *info; -+ struct beamformee_entry *bfee = NULL; -+ u8 *pframe; -+ u32 frame_len; -+ u8 *ta; -+ u8 *frame_body; -+ u8 category, action; -+ u8 *pMIMOCtrlField, *pCSIMatrix; -+ u8 Nc = 0, Nr = 0, CH_W = 0, Ng = 0, CodeBook = 0; -+ u16 CSIMatrixLen = 0; -+ -+ -+ RTW_INFO("+%s\n", __FUNCTION__); -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ pframe = precv_frame->u.hdr.rx_data; -+ frame_len = precv_frame->u.hdr.len; -+ -+ /* Memory comparison to see if CSI report is the same with previous one */ -+ ta = get_addr2_ptr(pframe); -+ bfee = _bfee_get_entry_by_addr(adapter, ta); -+ if (!bfee) -+ 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; -+ Nr = ((*pMIMOCtrlField) & 0x38) >> 3; -+ CH_W = (((*pMIMOCtrlField) & 0xC0) >> 6); -+ Ng = (*(pMIMOCtrlField+1)) & 0x3; -+ CodeBook = ((*(pMIMOCtrlField+1)) & 0x4) >> 2; -+ /* -+ * 24+(1+1+3)+2 -+ * ==> MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2) -+ */ -+ pCSIMatrix = pMIMOCtrlField + 3 + Nc; -+ CSIMatrixLen = frame_len - 26 - 3 - Nc; -+ info->TargetCSIInfo.bVHT = _TRUE; -+ } else if ((category == RTW_WLAN_CATEGORY_HT) -+ && (action == RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING)) { -+ pMIMOCtrlField = pframe + 26; -+ Nc = (*pMIMOCtrlField) & 0x3; -+ Nr = ((*pMIMOCtrlField) & 0xC) >> 2; -+ CH_W = ((*pMIMOCtrlField) & 0x10) >> 4; -+ Ng = ((*pMIMOCtrlField) & 0x60) >> 5; -+ CodeBook = ((*(pMIMOCtrlField+1)) & 0x6) >> 1; -+ /* -+ * 24+(1+1+6)+2 -+ * ==> MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2) -+ */ -+ pCSIMatrix = pMIMOCtrlField + 6 + Nr; -+ CSIMatrixLen = frame_len - 26 - 6 - Nr; -+ info->TargetCSIInfo.bVHT = _FALSE; -+ } -+ -+ /* Update current CSI report info */ -+ if ((_TRUE == info->bEnableSUTxBFWorkAround) -+ && (info->TargetSUBFee == bfee)) { -+ if ((info->TargetCSIInfo.Nc != Nc) || (info->TargetCSIInfo.Nr != Nr) || -+ (info->TargetCSIInfo.ChnlWidth != CH_W) || (info->TargetCSIInfo.Ng != Ng) || -+ (info->TargetCSIInfo.CodeBook != CodeBook)) { -+ info->TargetCSIInfo.Nc = Nc; -+ info->TargetCSIInfo.Nr = Nr; -+ info->TargetCSIInfo.ChnlWidth = CH_W; -+ info->TargetCSIInfo.Ng = Ng; -+ info->TargetCSIInfo.CodeBook = CodeBook; -+ -+ rtw_bf_cmd(adapter, BEAMFORMING_CTRL_SET_CSI_REPORT, (u8*)&info->TargetCSIInfo, sizeof(struct _RT_CSI_INFO), 1); -+ } -+ } -+ -+ RTW_INFO("%s: pkt type=%d-%d, Nc=%d, Nr=%d, CH_W=%d, Ng=%d, CodeBook=%d\n", -+ __FUNCTION__, category, action, Nc, Nr, CH_W, Ng, CodeBook); -+ -+ return ret; -+} -+ -+u8 rtw_bf_send_vht_gid_mgnt_packet(PADAPTER adapter, u8 *ra, u8 *gid, u8 *position) -+{ -+ /* General */ -+ struct xmit_priv *xmitpriv; -+ struct mlme_priv *mlmepriv; -+ struct xmit_frame *pmgntframe; -+ /* MISC */ -+ struct pkt_attrib *attrib; -+ struct rtw_ieee80211_hdr *wlanhdr; -+ u8 *pframe, *ptr; -+ -+ -+ 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; -+ set_frame_sub_type(pframe, attrib->subtype); -+ set_duration(pframe, 0); -+ SetFragNum(pframe, 0); -+ SetSeqNum(pframe, 0); -+ -+ _rtw_memcpy(wlanhdr->addr1, ra, 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; -+ /* Set Membership Status Array */ -+ ptr = pframe + 26; -+ _rtw_memcpy(ptr, gid, 8); -+ /* Set User Position Array */ -+ ptr = pframe + 34; -+ _rtw_memcpy(ptr, position, 16); -+ -+ attrib->pktlen = 54; -+ attrib->last_txcmdsz = attrib->pktlen; -+ -+ dump_mgntframe(adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+/* -+ * Description: -+ * On VHT GID management frame by an MU beamformee. -+ */ -+void rtw_bf_get_vht_gid_mgnt_packet(PADAPTER adapter, union recv_frame *precv_frame) -+{ -+ u8 *pframe; -+ u8 *ta, *gid, *position; -+ -+ -+ RTW_DBG("+%s\n", __FUNCTION__); -+ -+ pframe = precv_frame->u.hdr.rx_data; -+ -+ /* Get address by Addr2 */ -+ ta = get_addr2_ptr(pframe); -+ /* Remove signaling TA */ -+ ta[0] &= 0xFE; -+ -+ /* Membership Status Array */ -+ gid = pframe + 26; -+ /* User Position Array */ -+ position= pframe + 34; -+ -+ _bfer_set_entry_gid(adapter, ta, gid, position); -+} -+ -+void rtw_bf_init(PADAPTER adapter) -+{ -+ struct beamforming_info *info; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ info->beamforming_cap = BEAMFORMING_CAP_NONE; -+ info->beamforming_state = BEAMFORMING_STATE_IDLE; -+/* -+ info->bfee_entry[MAX_BEAMFORMEE_ENTRY_NUM]; -+ info->bfer_entry[MAX_BEAMFORMER_ENTRY_NUM]; -+*/ -+ info->sounding_sequence = 0; -+ info->beamformee_su_cnt = 0; -+ info->beamformer_su_cnt = 0; -+ info->beamformee_su_reg_maping = 0; -+ info->beamformer_su_reg_maping = 0; -+ info->beamformee_mu_cnt = 0; -+ info->beamformer_mu_cnt = 0; -+ info->beamformee_mu_reg_maping = 0; -+ info->first_mu_bfee_index = 0xFF; -+ info->mu_bfer_curidx = 0xFF; -+ info->cur_csi_rpt_rate = HALMAC_OFDM24; -+ -+ _sounding_init(&info->sounding_info); -+ rtw_init_timer(&info->sounding_timer, adapter, _sounding_timer_handler, adapter); -+ rtw_init_timer(&info->sounding_timeout_timer, adapter, _sounding_timeout_timer_handler, adapter); -+ -+ info->SetHalBFEnterOnDemandCnt = 0; -+ info->SetHalBFLeaveOnDemandCnt = 0; -+ info->SetHalSoundownOnDemandCnt = 0; -+ -+ info->bEnableSUTxBFWorkAround = _TRUE; -+ info->TargetSUBFee = NULL; -+ -+ info->sounding_running = 0; -+} -+ -+void rtw_bf_cmd_hdl(PADAPTER adapter, u8 type, u8 *pbuf) -+{ -+ switch (type) { -+ case BEAMFORMING_CTRL_ENTER: -+ _beamforming_enter(adapter, pbuf); -+ break; -+ -+ case BEAMFORMING_CTRL_LEAVE: -+ if (pbuf == NULL) -+ _beamforming_reset(adapter); -+ else -+ _beamforming_leave(adapter, pbuf); -+ break; -+ -+ case BEAMFORMING_CTRL_START_PERIOD: -+ _sounding_handler(adapter); -+ break; -+ -+ case BEAMFORMING_CTRL_END_PERIOD: -+ _beamforming_sounding_down(adapter, *pbuf); -+ break; -+ -+ case BEAMFORMING_CTRL_SET_GID_TABLE: -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_SET_GID_TABLE, pbuf); -+ break; -+ -+ case BEAMFORMING_CTRL_SET_CSI_REPORT: -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_CSI_REPORT, pbuf); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+u8 rtw_bf_cmd(PADAPTER adapter, s32 type, u8 *pbuf, s32 size, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 *wk_buf; -+ u8 res = _SUCCESS; -+ -+ -+ if (!enqueue) { -+ rtw_bf_cmd_hdl(adapter, type, pbuf); -+ goto exit; -+ } -+ -+ 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, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+void rtw_bf_update_attrib(PADAPTER adapter, struct pkt_attrib *attrib, struct sta_info *sta) -+{ -+ if (sta) { -+ attrib->txbf_g_id = sta->cmn.bf_info.g_id; -+ attrib->txbf_p_aid = sta->cmn.bf_info.p_aid; -+ } -+} -+ -+void rtw_bf_c2h_handler(PADAPTER adapter, u8 id, u8 *buf, u8 buf_len) -+{ -+ switch (id) { -+ case CMD_ID_C2H_SND_TXBF: -+ _c2h_snd_txbf(adapter, buf, buf_len); -+ break; -+ } -+} -+ -+#define toMbps(bytes, secs) (rtw_division64(bytes >> 17, secs)) -+void rtw_bf_update_traffic(PADAPTER adapter) -+{ -+ struct beamforming_info *info; -+ struct sounding_info *sounding; -+ struct beamformee_entry *bfee; -+ struct sta_info *sta; -+ u8 bfee_cnt, sounding_idx, i; -+ u16 tp[MAX_BEAMFORMEE_ENTRY_NUM] = {0}; -+ u8 tx_rate[MAX_BEAMFORMEE_ENTRY_NUM] = {0}; -+ u64 tx_bytes, last_bytes; -+ u32 time; -+ systime last_timestamp; -+ u8 set_timer = _FALSE; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ sounding = &info->sounding_info; -+ -+ /* Check any bfee exist? */ -+ bfee_cnt = info->beamformee_su_cnt + info->beamformee_mu_cnt; -+ if (bfee_cnt == 0) -+ return; -+ -+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { -+ bfee = &info->bfee_entry[i]; -+ if (_FALSE == bfee->used) -+ continue; -+ -+ sta = rtw_get_stainfo(&adapter->stapriv, bfee->mac_addr); -+ if (!sta) { -+ RTW_ERR("%s: Cann't find sta_info for " MAC_FMT "!\n", __FUNCTION__, MAC_ARG(bfee->mac_addr)); -+ continue; -+ } -+ -+ last_timestamp = bfee->tx_timestamp; -+ last_bytes = bfee->tx_bytes; -+ bfee->tx_timestamp = rtw_get_current_time(); -+ bfee->tx_bytes = sta->sta_stats.tx_bytes; -+ if (last_timestamp) { -+ if (bfee->tx_bytes >= last_bytes) -+ tx_bytes = bfee->tx_bytes - last_bytes; -+ else -+ tx_bytes = bfee->tx_bytes + (~last_bytes); -+ time = rtw_get_time_interval_ms(last_timestamp, bfee->tx_timestamp); -+ time = (time > 1000) ? time/1000 : 1; -+ tp[i] = toMbps(tx_bytes, time); -+ tx_rate[i] = rtw_get_current_tx_rate(adapter, sta); -+ RTW_INFO("%s: BFee idx(%d), MadId(%d), TxTP=%lld bytes (%d Mbps), txrate=%d\n", -+ __FUNCTION__, i, bfee->mac_id, tx_bytes, tp[i], tx_rate[i]); -+ } -+ } -+ -+ sounding_idx = phydm_get_beamforming_sounding_info(GET_PDM_ODM(adapter), tp, MAX_BEAMFORMEE_ENTRY_NUM, tx_rate); -+ -+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { -+ bfee = &info->bfee_entry[i]; -+ if (_FALSE == bfee->used) { -+ if (sounding_idx & BIT(i)) -+ RTW_WARN("%s: bfee(%d) not in used but need sounding?!\n", __FUNCTION__, i); -+ continue; -+ } -+ -+ if (sounding_idx & BIT(i)) { -+ if (_FALSE == bfee->bApplySounding) { -+ bfee->bApplySounding = _TRUE; -+ bfee->SoundCnt = 0; -+ set_timer = _TRUE; -+ } -+ } else { -+ if (_TRUE == bfee->bApplySounding) { -+ bfee->bApplySounding = _FALSE; -+ bfee->bDeleteSounding = _TRUE; -+ bfee->SoundCnt = 0; -+ set_timer = _TRUE; -+ } -+ } -+ } -+ -+ if (_TRUE == set_timer) { -+ if (SOUNDING_STATE_NONE == info->sounding_info.state) { -+ info->sounding_info.state = SOUNDING_STATE_INIT; -+ _set_timer(&info->sounding_timer, 0); -+ } -+ } -+} -+ -+#else /* !RTW_BEAMFORMING_VERSION_2 */ -+ -+/*PHYDM_BF - (BEAMFORMING_SUPPORT == 1)*/ -+u32 rtw_beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame) -+{ -+ u32 ret = _SUCCESS; -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct dm_struct *pDM_Odm = &(pHalData->odmpriv); -+ -+ ret = beamforming_get_report_frame(pDM_Odm, precv_frame); -+ return ret; -+} -+ -+void rtw_beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct dm_struct *pDM_Odm = &(pHalData->odmpriv); -+ -+ beamforming_get_ndpa_frame(pDM_Odm, precv_frame); -+} -+ -+void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct dm_struct *pDM_Odm = &(pHalData->odmpriv); -+ -+ /*(BEAMFORMING_SUPPORT == 1)- for PHYDM beamfoming*/ -+ switch (type) { -+ case BEAMFORMING_CTRL_ENTER: { -+ struct sta_info *psta = (void *)pbuf; -+ u16 staIdx = psta->cmn.mac_id; -+ -+ beamforming_enter(pDM_Odm, staIdx, adapter_mac_addr(psta->padapter)); -+ break; -+ } -+ case BEAMFORMING_CTRL_LEAVE: -+ beamforming_leave(pDM_Odm, pbuf); -+ break; -+ default: -+ break; -+ -+ } -+} -+ -+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; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 res = _SUCCESS; -+ -+ /*20170214 ad_hoc mode and mp_mode not support BF*/ -+ if ((padapter->registrypriv.mp_mode == 1) -+ || (pmlmeinfo->state == WIFI_FW_ADHOC_STATE)) -+ return res; -+ -+ 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, CMD_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->cmn.bf_info.g_id; -+ pattrib->txbf_p_aid = psta->cmn.bf_info.p_aid; -+ } -+} -+#endif /* !RTW_BEAMFORMING_VERSION_2 */ -+ -+#endif /* CONFIG_BEAMFORMING */ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_br_ext.c b/drivers/net/wireless/rtl8821cs/core/rtw_br_ext.c -new file mode 100644 -index 000000000..9a0effd8b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_br_ext.c -@@ -0,0 +1,1581 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+#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; -+} -+ -+#ifdef SUPPORT_RX_UNI2MCAST -+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 */ -+#endif /* SUPPORT_RX_UNI2MCAST */ -+ -+ -+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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_bt_mp.c b/drivers/net/wireless/rtl8821cs/core/rtw_bt_mp.c -new file mode 100644 -index 000000000..ce7aa29f7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_bt_mp.c -@@ -0,0 +1,1575 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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.mpt_ctx; -+ -+ 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.mpt_ctx); -+ 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, -+ u16 h2cCmdLen -+) -+{ -+ /* KIRQL OldIrql = KeGetCurrentIrql(); */ -+ BT_CTRL_STATUS h2cStatus = BT_STATUS_H2C_SUCCESS; -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); -+ u8 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, -+ u8 btFwOpCode, -+ u8 opCodeVer, -+ u8 *pH2cPar, -+ u8 h2cParaLen -+) -+{ -+ u8 H2C_Parameter[6] = {0}; -+ PBT_H2C pH2c = (PBT_H2C)&H2C_Parameter[0]; -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); -+ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; -+ u16 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; -+} -+ -+ -+ -+ -+u16 -+mptbt_BtReady( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+) -+{ -+ u8 h2cParaBuf[6] = {0}; -+ u8 h2cParaLen = 0; -+ u16 paraLen = 0; -+ u8 retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u8 btOpcode; -+ u8 btOpcodeVer = 0; -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); -+ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; -+ u8 i; -+ u8 btFwVer = 0, bdAddr[6] = {0}; -+ u16 btRealFwVer = 0; -+ u16 *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 = (u16 *)&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 = (u16 *)&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_set_bb_reg(Adapter, 0x824, 0xF, 0x0); -+ phy_set_bb_reg(Adapter, 0x824, 0x700000, 0x0); -+ phy_set_rf_reg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x0); -+} -+ -+void mptbt_open_WiFiRF(PADAPTER Adapter) -+{ -+ phy_set_bb_reg(Adapter, 0x824, 0x700000, 0x3); -+ phy_set_bb_reg(Adapter, 0x824, 0xF, 0x2); -+ phy_set_rf_reg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x3); -+} -+ -+u32 mptbt_switch_RF(PADAPTER Adapter, u8 Enter) -+{ -+ u16 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; -+} -+ -+u16 -+mptbt_BtSetMode( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+) -+{ -+ u8 h2cParaBuf[6] = {0}; -+ u8 h2cParaLen = 0; -+ u16 paraLen = 0; -+ u8 retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u8 btOpcode; -+ u8 btOpcodeVer = 0; -+ u8 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, -+ u8 *tmpBuf, -+ u8 length -+) -+{ -+ u32 i; -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); -+ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)tmpBuf; -+ -+ if (GET_HAL_DATA(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; -+ } -+ -+ -+ -+} -+ -+ -+u16 -+mptbt_BtGetGeneral( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+) -+{ -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); -+ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; -+ u8 h2cParaBuf[6] = {0}; -+ u8 h2cParaLen = 0; -+ u16 paraLen = 0; -+ u8 retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u8 btOpcode, bdAddr[6] = {0}; -+ u8 btOpcodeVer = 0; -+ u8 getType = 0, i; -+ u16 getParaLen = 0, validParaLen = 0; -+ u8 regType = 0, reportType = 0; -+ u32 regAddr = 0, regValue = 0; -+ u32 *pu4Tmp; -+ u16 *pu2Tmp; -+ u8 *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 = (u32 *)&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 = (u16 *)&pExtC2h->buf[0]; -+ regValue = *pu2Tmp; -+ RTW_INFO("[MPT], read reg regType=0x%02x, regAddr=0x%08x, regValue=0x%04x\n", -+ regType, regAddr, regValue); -+ -+ pu4Tmp = (u32 *)&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; -+} -+ -+ -+ -+u16 -+mptbt_BtSetGeneral( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+) -+{ -+ u8 h2cParaBuf[6] = {0}; -+ u8 h2cParaLen = 0; -+ u16 paraLen = 0; -+ u8 retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u8 btOpcode; -+ u8 btOpcodeVer = 0; -+ u8 setType = 0; -+ u16 setParaLen = 0, validParaLen = 0; -+ u8 regType = 0, bdAddr[6] = {0}, calVal = 0; -+ u32 regAddr = 0, regValue = 0; -+ u32 *pu4Tmp; -+ u16 *pu2Tmp; -+ u8 *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 = (u32 *)&pBtReq->pParamStart[2]; -+ regAddr = *pu4Tmp; -+ pu4Tmp = (u32 *)&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; -+} -+ -+ -+ -+u16 -+mptbt_BtSetTxRxPars( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+) -+{ -+ u8 h2cParaBuf[6] = {0}; -+ u8 h2cParaLen = 0; -+ u16 paraLen = 0; -+ u8 retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u8 btOpcode; -+ u8 btOpcodeVer = 0; -+ PBT_TXRX_PARAMETERS pTxRxPars = (PBT_TXRX_PARAMETERS)&pBtReq->pParamStart[0]; -+ u16 lenTxRx = sizeof(BT_TXRX_PARAMETERS); -+ u8 i; -+ u8 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] = (u8)(pTxRxPars->txrxPktHeader & 0xff); -+ h2cParaBuf[1] = (u8)((pTxRxPars->txrxPktHeader & 0xff00) >> 8); -+ h2cParaBuf[2] = (u8)((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; -+ { -+ u16 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] = (u8)((pTxRxPars->txrxPayloadLen & 0xff)); -+ h2cParaBuf[2] = (u8)((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] = (u8)((pTxRxPars->txrxTxPktCnt & 0xff)); -+ h2cParaBuf[1] = (u8)((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] = (u8)((pTxRxPars->txrxTxPktCnt & 0xff0000) >> 16); -+ h2cParaBuf[1] = (u8)((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; -+} -+ -+ -+ -+u16 -+mptbt_BtTestCtrl( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+) -+{ -+ u8 h2cParaBuf[6] = {0}; -+ u8 h2cParaLen = 0; -+ u16 paraLen = 0; -+ u8 retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u8 btOpcode; -+ u8 btOpcodeVer = 0; -+ u8 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; -+} -+ -+ -+u16 -+mptbt_TestBT( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+) -+{ -+ -+ u8 h2cParaBuf[6] = {0}; -+ u8 h2cParaLen = 0; -+ u16 paraLen = 0; -+ u8 retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u8 btOpcode; -+ u8 btOpcodeVer = 0; -+ u8 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, -+ void *pInBuf -+) -+{ -+ u8 H2C_Parameter[6] = {0}; -+ PBT_H2C pH2c = (PBT_H2C)&H2C_Parameter[0]; -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); -+ PBT_REQ_CMD pBtReq = (PBT_REQ_CMD)pInBuf; -+ PBT_RSP_CMD pBtRsp; -+ u8 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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_btcoex.c b/drivers/net/wireless/rtl8821cs/core/rtw_btcoex.c -new file mode 100644 -index 000000000..5081cddfc ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_btcoex.c -@@ -0,0 +1,1817 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#ifdef CONFIG_BT_COEXIST -+#include -+ -+void rtw_btcoex_Initialize(PADAPTER padapter) -+{ -+ hal_btcoex_Initialize(padapter); -+} -+ -+void rtw_btcoex_PowerOnSetting(PADAPTER padapter) -+{ -+ hal_btcoex_PowerOnSetting(padapter); -+} -+ -+void rtw_btcoex_AntInfoSetting(PADAPTER padapter) -+{ -+ hal_btcoex_AntInfoSetting(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_UNDER_SURVEY)) -+ 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); -+} -+ -+static void _rtw_btcoex_connect_notify(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_WLRFKNotify(PADAPTER padapter, u8 path, u8 type, u8 state) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_WLRFKNotify(padapter, path, type, 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_WlFwDbgInfoNotify(PADAPTER padapter, u8* tmpBuf, u8 length) -+{ -+ hal_btcoex_WlFwDbgInfoNotify(padapter, tmpBuf, length); -+} -+ -+void rtw_btcoex_rx_rate_change_notify(PADAPTER padapter, u8 is_data_frame, u8 rate_id) -+{ -+ hal_btcoex_rx_rate_change_notify(padapter, is_data_frame, rate_id); -+} -+ -+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); -+} -+ -+void rtw_btcoex_set_policy_control(PADAPTER padapter, u8 btc_policy) -+{ -+ hal_btcoex_set_policy_control(padapter, btc_policy); -+} -+ -+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); -+} -+ -+u8 rtw_btcoex_query_reduced_wl_pwr_lvl(PADAPTER padapter) -+{ -+ return hal_btcoex_query_reduced_wl_pwr_lvl(padapter); -+} -+ -+void rtw_btcoex_set_reduced_wl_pwr_lvl(PADAPTER padapter, u8 val) -+{ -+ hal_btcoex_set_reduced_wl_pwr_lvl(padapter, val); -+} -+ -+void rtw_btcoex_do_reduce_wl_pwr_lvl(PADAPTER padapter) -+{ -+ hal_btcoex_do_reduce_wl_pwr_lvl(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_pta_off_on_notify(PADAPTER padapter, u8 bBTON) -+{ -+ hal_btcoex_pta_off_on_notify(padapter, bBTON); -+} -+ -+#ifdef CONFIG_RF4CE_COEXIST -+void rtw_btcoex_SetRf4ceLinkState(PADAPTER padapter, u8 state) -+{ -+ hal_btcoex_set_rf4ce_link_state(state); -+} -+ -+u8 rtw_btcoex_GetRf4ceLinkState(PADAPTER padapter) -+{ -+ return hal_btcoex_get_rf4ce_link_state(); -+} -+#endif -+ -+/* ================================================== -+ * 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"); -+} -+ -+u8 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"); -+ pwrpriv->bpower_saving = _FALSE; -+ } -+ -+ return _TRUE; -+} -+ -+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); -+} -+ -+u16 rtw_btcoex_btset_testmode(PADAPTER padapter, u8 type) -+{ -+ return hal_btcoex_btset_testode(padapter, type); -+} -+ -+u8 rtw_btcoex_get_reduce_wl_txpwr(PADAPTER padapter) -+{ -+ return rtw_btcoex_query_reduced_wl_pwr_lvl(padapter); -+} -+ -+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->rfe_type; -+} -+ -+u8 rtw_btcoex_is_tfbga_package_type(PADAPTER padapter) -+{ -+#ifdef CONFIG_RTL8723B -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ 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, CMD_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 = *((u16 *)&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_pta_off_on_notify(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_pta_off_on_notify(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_pta_off_on_notify(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_pta_off_on_notify(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_pta_off_on_notify(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_pta_off_on_notify(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_pta_off_on_notify(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 = (u8 *)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 */ -+ -+void rtw_btcoex_set_ant_info(PADAPTER padapter) -+{ -+#ifdef CONFIG_BT_COEXIST -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(padapter); -+ -+ if (hal->EEPROMBluetoothCoexist == _TRUE) { -+ u8 bMacPwrCtrlOn = _FALSE; -+ -+ rtw_btcoex_AntInfoSetting(padapter); -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (bMacPwrCtrlOn == _TRUE) -+ rtw_btcoex_PowerOnSetting(padapter); -+ } -+ else -+#endif -+ rtw_btcoex_wifionly_AntInfoSetting(padapter); -+} -+ -+void rtw_btcoex_connect_notify(PADAPTER padapter, u8 join_type) -+{ -+#ifdef CONFIG_BT_COEXIST -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ if (pHalData->EEPROMBluetoothCoexist == _TRUE) -+ _rtw_btcoex_connect_notify(padapter, join_type ? _FALSE : _TRUE); -+ else -+#endif /* CONFIG_BT_COEXIST */ -+ rtw_btcoex_wifionly_connect_notify(padapter); -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_btcoex_wifionly.c b/drivers/net/wireless/rtl8821cs/core/rtw_btcoex_wifionly.c -new file mode 100644 -index 000000000..d9872b022 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_btcoex_wifionly.c -@@ -0,0 +1,47 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+void rtw_btcoex_wifionly_switchband_notify(PADAPTER padapter) -+{ -+ hal_btcoex_wifionly_switchband_notify(padapter); -+} -+ -+void rtw_btcoex_wifionly_scan_notify(PADAPTER padapter) -+{ -+ hal_btcoex_wifionly_scan_notify(padapter); -+} -+ -+void rtw_btcoex_wifionly_connect_notify(PADAPTER padapter) -+{ -+ hal_btcoex_wifionly_connect_notify(padapter); -+} -+ -+void rtw_btcoex_wifionly_hw_config(PADAPTER padapter) -+{ -+ hal_btcoex_wifionly_hw_config(padapter); -+} -+ -+void rtw_btcoex_wifionly_initialize(PADAPTER padapter) -+{ -+ hal_btcoex_wifionly_initlizevariables(padapter); -+} -+ -+void rtw_btcoex_wifionly_AntInfoSetting(PADAPTER padapter) -+{ -+ hal_btcoex_wifionly_AntInfoSetting(padapter); -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_chplan.c b/drivers/net/wireless/rtl8821cs/core/rtw_chplan.c -new file mode 100644 -index 000000000..1df45f4a8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_chplan.c -@@ -0,0 +1,3506 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2018 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_CHPLAN_C_ -+ -+#include -+ -+#define RTW_DOMAIN_MAP_VER "57" -+#define RTW_DOMAIN_MAP_M_VER "h" -+#define RTW_COUNTRY_MAP_VER "31" -+ -+struct ch_list_t { -+ u8 *len_ch_attr; -+}; -+ -+#define CLA_2G_12_14_PASSIVE BIT0 -+ -+#define CLA_5G_B1_PASSIVE BIT0 -+#define CLA_5G_B2_PASSIVE BIT1 -+#define CLA_5G_B3_PASSIVE BIT2 -+#define CLA_5G_B4_PASSIVE BIT3 -+#define CLA_5G_B2_DFS BIT4 -+#define CLA_5G_B3_DFS BIT5 -+#define CLA_5G_B4_DFS BIT6 -+ -+#define CLA_6G_B1_PASSIVE BIT0 -+#define CLA_6G_B2_PASSIVE BIT1 -+#define CLA_6G_B3_PASSIVE BIT2 -+#define CLA_6G_B4_PASSIVE BIT3 -+ -+#define CH_LIST_ENT(_len, arg...) \ -+ {.len_ch_attr = (u8[_len + 2]) {_len, ##arg}, } -+ -+#define CH_LIST_LEN(_ch_list) (_ch_list.len_ch_attr[0]) -+#define CH_LIST_CH(_ch_list, _i) (_ch_list.len_ch_attr[_i + 1]) -+#define CH_LIST_ATTRIB(_ch_list) (_ch_list.len_ch_attr[CH_LIST_LEN(_ch_list) + 1]) -+ -+enum rtw_chd_2g { -+ RTW_CHD_2G_INVALID = 0, -+ -+ RTW_CHD_2G_00, -+ RTW_CHD_2G_01, -+ RTW_CHD_2G_02, -+ RTW_CHD_2G_03, -+ RTW_CHD_2G_04, -+ RTW_CHD_2G_05, -+ RTW_CHD_2G_06, -+ -+ RTW_CHD_2G_MAX, -+ RTW_CHD_2G_NULL = RTW_CHD_2G_00, -+}; -+ -+enum rtw_chd_5g { -+ RTW_CHD_5G_INVALID = 0, -+ -+ RTW_CHD_5G_00, -+ RTW_CHD_5G_01, -+ RTW_CHD_5G_02, -+ RTW_CHD_5G_03, -+ RTW_CHD_5G_04, -+ RTW_CHD_5G_05, -+ RTW_CHD_5G_06, -+ RTW_CHD_5G_07, -+ RTW_CHD_5G_08, -+ RTW_CHD_5G_09, -+ RTW_CHD_5G_10, -+ RTW_CHD_5G_11, -+ RTW_CHD_5G_12, -+ RTW_CHD_5G_13, -+ RTW_CHD_5G_14, -+ RTW_CHD_5G_15, -+ RTW_CHD_5G_16, -+ RTW_CHD_5G_17, -+ RTW_CHD_5G_18, -+ RTW_CHD_5G_19, -+ RTW_CHD_5G_20, -+ RTW_CHD_5G_21, -+ RTW_CHD_5G_22, -+ RTW_CHD_5G_23, -+ RTW_CHD_5G_24, -+ RTW_CHD_5G_25, -+ RTW_CHD_5G_26, -+ RTW_CHD_5G_27, -+ RTW_CHD_5G_28, -+ RTW_CHD_5G_29, -+ RTW_CHD_5G_30, -+ RTW_CHD_5G_31, -+ RTW_CHD_5G_32, -+ RTW_CHD_5G_33, -+ RTW_CHD_5G_34, -+ RTW_CHD_5G_35, -+ RTW_CHD_5G_36, -+ RTW_CHD_5G_37, -+ RTW_CHD_5G_38, -+ RTW_CHD_5G_39, -+ RTW_CHD_5G_40, -+ RTW_CHD_5G_41, -+ RTW_CHD_5G_42, -+ RTW_CHD_5G_43, -+ RTW_CHD_5G_44, -+ RTW_CHD_5G_45, -+ RTW_CHD_5G_46, -+ RTW_CHD_5G_47, -+ RTW_CHD_5G_48, -+ RTW_CHD_5G_49, -+ RTW_CHD_5G_50, -+ RTW_CHD_5G_51, -+ RTW_CHD_5G_52, -+ -+ RTW_CHD_5G_MAX, -+ RTW_CHD_5G_NULL = RTW_CHD_5G_00, -+}; -+ -+static const struct ch_list_t rtw_channel_def_2g[] = { -+ /* RTW_CHD_2G_INVALID */ CH_LIST_ENT(0, 0), -+ /* RTW_CHD_2G_00 */ CH_LIST_ENT(0, 0), -+ /* RTW_CHD_2G_01 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, CLA_2G_12_14_PASSIVE), -+ /* RTW_CHD_2G_02 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 0), -+ /* RTW_CHD_2G_03 */ CH_LIST_ENT(11, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 0), -+ /* RTW_CHD_2G_04 */ CH_LIST_ENT(14, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 0), -+ /* RTW_CHD_2G_05 */ CH_LIST_ENT(4, 10, 11, 12, 13, 0), -+ /* RTW_CHD_2G_06 */ CH_LIST_ENT(14, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, CLA_2G_12_14_PASSIVE), -+}; -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+static const struct ch_list_t rtw_channel_def_5g[] = { -+ /* RTW_CHD_5G_INVALID */ CH_LIST_ENT(0, 0), -+ /* RTW_CHD_5G_00 */ CH_LIST_ENT(0, 0), -+ /* RTW_CHD_5G_01 */ 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, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_02 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_03 */ 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, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_04 */ 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, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_05 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_06 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165, 0), -+ /* RTW_CHD_5G_07 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165, CLA_5G_B2_DFS), -+ /* RTW_CHD_5G_08 */ CH_LIST_ENT(12, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, CLA_5G_B2_DFS), -+ /* RTW_CHD_5G_09 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165, 0), -+ /* RTW_CHD_5G_10 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64, CLA_5G_B2_DFS), -+ /* RTW_CHD_5G_11 */ CH_LIST_ENT(11, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_12 */ CH_LIST_ENT(16, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_13 */ CH_LIST_ENT(8, 56, 60, 64, 149, 153, 157, 161, 165, CLA_5G_B2_DFS), -+ /* RTW_CHD_5G_14 */ CH_LIST_ENT(4, 36, 40, 44, 48, 0), -+ /* RTW_CHD_5G_15 */ CH_LIST_ENT(4, 149, 153, 157, 161, 0), -+ /* RTW_CHD_5G_16 */ CH_LIST_ENT(11, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 0), -+ /* RTW_CHD_5G_17 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140, 149, 153, 157, 161, 165, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_18 */ CH_LIST_ENT(17, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_19 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_20 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_21 */ CH_LIST_ENT(11, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_22 */ 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, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_23 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 149, 153, 157, 161, 165, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_24 */ 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, CLA_5G_B2_PASSIVE | CLA_5G_B3_PASSIVE | CLA_5G_B4_PASSIVE), -+ /* RTW_CHD_5G_25 */ 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, CLA_5G_B2_PASSIVE | CLA_5G_B3_PASSIVE), -+ /* RTW_CHD_5G_26 */ 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, CLA_5G_B1_PASSIVE | CLA_5G_B2_PASSIVE | CLA_5G_B3_PASSIVE), -+ /* RTW_CHD_5G_27 */ 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, CLA_5G_B2_PASSIVE | CLA_5G_B3_PASSIVE), -+ /* RTW_CHD_5G_28 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165, CLA_5G_B2_PASSIVE), -+ /* RTW_CHD_5G_29 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165, CLA_5G_B1_PASSIVE | CLA_5G_B2_PASSIVE), -+ /* RTW_CHD_5G_30 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165, CLA_5G_B1_PASSIVE | CLA_5G_B4_PASSIVE), -+ /* RTW_CHD_5G_31 */ 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, CLA_5G_B1_PASSIVE | CLA_5G_B2_PASSIVE | CLA_5G_B3_PASSIVE | CLA_5G_B4_PASSIVE), -+ /* RTW_CHD_5G_32 */ CH_LIST_ENT(9, 52, 56, 60, 64, 149, 153, 157, 161, 165, CLA_5G_B2_DFS), -+ /* RTW_CHD_5G_33 */ CH_LIST_ENT(22, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 144, 149, 153, 157, 161, 165, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_34 */ CH_LIST_ENT(13, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165, CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_35 */ CH_LIST_ENT(8, 100, 104, 108, 112, 116, 132, 136, 140, CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_36 */ 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, CLA_5G_B1_PASSIVE | CLA_5G_B2_PASSIVE | CLA_5G_B2_DFS | CLA_5G_B3_PASSIVE | CLA_5G_B3_DFS | CLA_5G_B4_PASSIVE), -+ /* RTW_CHD_5G_37 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64, CLA_5G_B1_PASSIVE | CLA_5G_B2_PASSIVE), -+ /* RTW_CHD_5G_38 */ CH_LIST_ENT(16, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_39 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 149, 153, 157, 161, 165, CLA_5G_B1_PASSIVE | CLA_5G_B2_DFS | CLA_5G_B3_DFS | CLA_5G_B4_DFS), -+ /* RTW_CHD_5G_40 */ 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, CLA_5G_B1_PASSIVE | CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_41 */ 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, CLA_5G_B2_DFS | CLA_5G_B3_DFS | CLA_5G_B4_PASSIVE), -+ /* RTW_CHD_5G_42 */ 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, CLA_5G_B1_PASSIVE | CLA_5G_B2_DFS | CLA_5G_B3_DFS | CLA_5G_B4_PASSIVE), -+ /* RTW_CHD_5G_43 */ CH_LIST_ENT(23, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 136, 140, 149, 153, 157, 161, 165, CLA_5G_B1_PASSIVE | CLA_5G_B2_PASSIVE | CLA_5G_B3_PASSIVE | CLA_5G_B4_PASSIVE), -+ /* RTW_CHD_5G_44 */ 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, CLA_5G_B1_PASSIVE | CLA_5G_B2_PASSIVE | CLA_5G_B3_PASSIVE | CLA_5G_B4_PASSIVE), -+ /* RTW_CHD_5G_45 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165, CLA_5G_B1_PASSIVE | CLA_5G_B2_PASSIVE | CLA_5G_B4_PASSIVE), -+ /* RTW_CHD_5G_46 */ CH_LIST_ENT(12, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, CLA_5G_B2_PASSIVE), -+ /* RTW_CHD_5G_47 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, CLA_5G_B2_PASSIVE | CLA_5G_B3_PASSIVE), -+ /* RTW_CHD_5G_48 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_49 */ CH_LIST_ENT(17, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_50 */ CH_LIST_ENT(17, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140, 144, 149, 153, 157, 161, 165, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_51 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+ /* RTW_CHD_5G_52 */ CH_LIST_ENT(28, 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, CLA_5G_B2_DFS | CLA_5G_B3_DFS), -+}; -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ -+struct chplan_ent_t { -+ u8 regd_2g; /* value of enum rtw_regd */ -+ u8 chd_2g; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ u8 regd_5g; /* value of enum rtw_regd */ -+ u8 chd_5g; -+#endif -+}; -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+#define CHPLAN_ENT(_regd_2g, _chd_2g, _regd_5g, _chd_5g) {.regd_2g = RTW_REGD_##_regd_2g, .chd_2g = RTW_CHD_2G_##_chd_2g, .regd_5g = RTW_REGD_##_regd_5g, .chd_5g = RTW_CHD_5G_##_chd_5g} -+#else -+#define CHPLAN_ENT(_regd_2g, _chd_2g, _regd_5g, _chd_5g) {.regd_2g = RTW_REGD_##_regd_2g, .chd_2g = RTW_CHD_2G_##_chd_2g} -+#endif -+ -+#define CHPLAN_ENT_NOT_DEFINED CHPLAN_ENT(NA, INVALID, NA, INVALID) -+ -+static const struct chplan_ent_t RTW_ChannelPlanMap[] = { -+ [0x00] = CHPLAN_ENT(ETSI , 02, ETSI , 49), -+ [0x01] = CHPLAN_ENT(ETSI , 02, ETSI , 50), -+ [0x02] = CHPLAN_ENT(ETSI , 03, ETSI , 07), -+ [0x03] = CHPLAN_ENT(ACMA , 02, ACMA , 33), -+ [0x04] = CHPLAN_ENT(ETSI , 02, ETSI , 51), -+ [0x05] = CHPLAN_ENT(ETSI , 02, ETSI , 06), -+ [0x06] = CHPLAN_ENT(ETSI , 02, ETSI , 07), -+ [0x07] = CHPLAN_ENT(ETSI , 02, ETSI , 23), -+ [0x08] = CHPLAN_ENT(ETSI , 02, ETSI , 21), -+ [0x09] = CHPLAN_ENT(ETSI , 02, ETSI , 17), -+ [0x1A] = CHPLAN_ENT(NA , 00, NA , 00), -+ [0x1B] = CHPLAN_ENT(FCC , 02, FCC , 52), -+ [0x20] = CHPLAN_ENT(WW , 01, NA , 00), -+ [0x21] = CHPLAN_ENT(ETSI , 02, NA , 00), -+ [0x22] = CHPLAN_ENT(FCC , 03, NA , 00), -+ [0x23] = CHPLAN_ENT(MKK , 04, NA , 00), -+ [0x24] = CHPLAN_ENT(ETSI , 05, NA , 00), -+ [0x25] = CHPLAN_ENT(FCC , 03, FCC , 03), -+ [0x26] = CHPLAN_ENT(ETSI , 01, ETSI , 02), -+ [0x27] = CHPLAN_ENT(MKK , 04, MKK , 02), -+ [0x28] = CHPLAN_ENT(KCC , 01, KCC , 05), -+ [0x29] = CHPLAN_ENT(FCC , 01, FCC , 06), -+ [0x2A] = CHPLAN_ENT(FCC , 02, NA , 00), -+ [0x2B] = CHPLAN_ENT(IC , 02, IC , 33), -+ [0x2C] = CHPLAN_ENT(MKK , 02, NA , 00), -+ [0x2D] = CHPLAN_ENT(CHILE, 01, CHILE, 22), -+ [0x2E] = CHPLAN_ENT(WW , 03, WW , 37), -+ [0x2F] = CHPLAN_ENT(CHILE, 01, CHILE, 38), -+ [0x30] = CHPLAN_ENT(FCC , 01, FCC , 07), -+ [0x31] = CHPLAN_ENT(FCC , 01, FCC , 08), -+ [0x32] = CHPLAN_ENT(FCC , 01, FCC , 09), -+ [0x33] = CHPLAN_ENT(FCC , 01, FCC , 10), -+ [0x34] = CHPLAN_ENT(FCC , 03, FCC , 01), -+ [0x35] = CHPLAN_ENT(ETSI , 01, ETSI , 03), -+ [0x36] = CHPLAN_ENT(ETSI , 01, ETSI , 04), -+ [0x37] = CHPLAN_ENT(MKK , 04, MKK , 10), -+ [0x38] = CHPLAN_ENT(MKK , 04, MKK , 11), -+ [0x39] = CHPLAN_ENT(NCC , 03, NCC , 12), -+ [0x3A] = CHPLAN_ENT(ETSI , 02, ETSI , 02), -+ [0x3B] = CHPLAN_ENT(ACMA , 02, ACMA , 01), -+ [0x3C] = CHPLAN_ENT(ETSI , 02, ETSI , 10), -+ [0x3D] = CHPLAN_ENT(ETSI , 02, ETSI , 15), -+ [0x3E] = CHPLAN_ENT(KCC , 02, KCC , 03), -+ [0x3F] = CHPLAN_ENT(FCC , 03, FCC , 22), -+ [0x40] = CHPLAN_ENT(NCC , 03, NCC , 13), -+ [0x41] = CHPLAN_ENT(WW , 06, NA , 00), -+ [0x42] = CHPLAN_ENT(ETSI , 02, ETSI , 14), -+ [0x43] = CHPLAN_ENT(FCC , 03, FCC , 06), -+ [0x44] = CHPLAN_ENT(NCC , 03, NCC , 09), -+ [0x45] = CHPLAN_ENT(ACMA , 01, ACMA , 01), -+ [0x46] = CHPLAN_ENT(FCC , 03, FCC , 15), -+ [0x47] = CHPLAN_ENT(ETSI , 01, ETSI , 10), -+ [0x48] = CHPLAN_ENT(ETSI , 01, ETSI , 07), -+ [0x49] = CHPLAN_ENT(ETSI , 01, ETSI , 06), -+ [0x4A] = CHPLAN_ENT(IC , 03, IC , 33), -+ [0x4B] = CHPLAN_ENT(KCC , 02, KCC , 22), -+ [0x4C] = CHPLAN_ENT(FCC , 03, FCC , 28), -+ [0x4D] = CHPLAN_ENT(MEX , 02, MEX , 01), -+ [0x4E] = CHPLAN_ENT(ETSI , 02, ETSI , 42), -+ [0x4F] = CHPLAN_ENT(NA , 00, MKK , 43), -+ [0x50] = CHPLAN_ENT(ETSI , 01, ETSI , 16), -+ [0x51] = CHPLAN_ENT(ETSI , 01, ETSI , 09), -+ [0x52] = CHPLAN_ENT(ETSI , 01, ETSI , 17), -+ [0x53] = CHPLAN_ENT(NCC , 03, NCC , 18), -+ [0x54] = CHPLAN_ENT(ETSI , 01, ETSI , 15), -+ [0x55] = CHPLAN_ENT(FCC , 03, FCC , 01), -+ [0x56] = CHPLAN_ENT(ETSI , 01, ETSI , 19), -+ [0x57] = CHPLAN_ENT(FCC , 03, FCC , 20), -+ [0x58] = CHPLAN_ENT(MKK , 02, MKK , 14), -+ [0x59] = CHPLAN_ENT(ETSI , 01, ETSI , 21), -+ [0x5A] = CHPLAN_ENT(NA , 00, FCC , 44), -+ [0x5B] = CHPLAN_ENT(NA , 00, FCC , 45), -+ [0x5C] = CHPLAN_ENT(NA , 00, FCC , 43), -+ [0x5D] = CHPLAN_ENT(ETSI , 02, ETSI , 08), -+ [0x5E] = CHPLAN_ENT(ETSI , 02, ETSI , 03), -+ [0x5F] = CHPLAN_ENT(MKK , 02, MKK , 47), -+ [0x60] = CHPLAN_ENT(FCC , 03, FCC , 09), -+ [0x61] = CHPLAN_ENT(FCC , 02, FCC , 01), -+ [0x62] = CHPLAN_ENT(FCC , 02, FCC , 03), -+ [0x63] = CHPLAN_ENT(ETSI , 01, ETSI , 23), -+ [0x64] = CHPLAN_ENT(MKK , 02, MKK , 24), -+ [0x65] = CHPLAN_ENT(ETSI , 02, ETSI , 24), -+ [0x66] = CHPLAN_ENT(FCC , 03, FCC , 27), -+ [0x67] = CHPLAN_ENT(FCC , 03, FCC , 25), -+ [0x68] = CHPLAN_ENT(FCC , 02, FCC , 27), -+ [0x69] = CHPLAN_ENT(FCC , 02, FCC , 25), -+ [0x6A] = CHPLAN_ENT(ETSI , 02, ETSI , 25), -+ [0x6B] = CHPLAN_ENT(FCC , 01, FCC , 29), -+ [0x6C] = CHPLAN_ENT(FCC , 01, FCC , 26), -+ [0x6D] = CHPLAN_ENT(FCC , 02, FCC , 28), -+ [0x6E] = CHPLAN_ENT(FCC , 01, FCC , 25), -+ [0x6F] = CHPLAN_ENT(NA , 00, ETSI , 06), -+ [0x70] = CHPLAN_ENT(NA , 00, ETSI , 30), -+ [0x71] = CHPLAN_ENT(NA , 00, ETSI , 25), -+ [0x72] = CHPLAN_ENT(NA , 00, ETSI , 31), -+ [0x73] = CHPLAN_ENT(FCC , 01, FCC , 01), -+ [0x74] = CHPLAN_ENT(FCC , 02, FCC , 19), -+ [0x75] = CHPLAN_ENT(ETSI , 01, ETSI , 32), -+ [0x76] = CHPLAN_ENT(FCC , 02, FCC , 22), -+ [0x77] = CHPLAN_ENT(ETSI , 01, ETSI , 34), -+ [0x78] = CHPLAN_ENT(FCC , 03, FCC , 35), -+ [0x79] = CHPLAN_ENT(MKK , 02, MKK , 02), -+ [0x7A] = CHPLAN_ENT(ETSI , 02, ETSI , 28), -+ [0x7B] = CHPLAN_ENT(ETSI , 02, ETSI , 46), -+ [0x7C] = CHPLAN_ENT(ETSI , 02, ETSI , 47), -+ [0x7D] = CHPLAN_ENT(MKK , 04, MKK , 48), -+ [0x7E] = CHPLAN_ENT(MKK , 02, MKK , 48), -+ [0x7F] = CHPLAN_ENT(WW , 01, WW , 36), -+}; -+ -+const int RTW_ChannelPlanMap_size = sizeof(RTW_ChannelPlanMap) / sizeof(RTW_ChannelPlanMap[0]); -+ -+u8 rtw_chplan_get_default_regd_2g(u8 id) -+{ -+ if (id < RTW_ChannelPlanMap_size) -+ return RTW_ChannelPlanMap[id].regd_2g; -+ return RTW_REGD_NA; -+} -+ -+u8 rtw_chplan_get_default_regd_5g(u8 id) -+{ -+#if CONFIG_IEEE80211_BAND_5GHZ -+ if (id < RTW_ChannelPlanMap_size) -+ return RTW_ChannelPlanMap[id].regd_5g; -+#endif -+ return RTW_REGD_NA; -+} -+ -+bool rtw_is_channel_plan_valid(u8 id) -+{ -+ if (id < RTW_ChannelPlanMap_size) { -+ const struct chplan_ent_t *chplan_map = &RTW_ChannelPlanMap[id]; -+ -+ if (chplan_map->chd_2g != RTW_CHD_2G_INVALID -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ && chplan_map->chd_5g != RTW_CHD_5G_INVALID -+ #endif -+ ) -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+bool rtw_regsty_is_excl_chs(struct registry_priv *regsty, u8 ch) -+{ -+ int i; -+ -+ for (i = 0; i < MAX_CHANNEL_NUM_2G_5G; i++) { -+ if (regsty->excl_chs[i] == 0) -+ break; -+ if (regsty->excl_chs[i] == ch) -+ return _TRUE; -+ } -+ return _FALSE; -+} -+ -+/* -+ * Search the @param ch in chplan by given @param id -+ * @id: the given channel plan id -+ * @ch: the given channel number -+ * -+ * return the index of channel_num in channel_set, -1 if not found -+ */ -+static bool rtw_chplan_get_ch(u8 id, const u32 ch, u8 *flags) -+{ -+ u8 index, chan, attrib; -+ -+ if (flags) -+ *flags = 0; -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+ if (ch > 14) { -+ u8 chd_5g = RTW_ChannelPlanMap[id].chd_5g; -+ -+ attrib = CH_LIST_ATTRIB(rtw_channel_def_5g[chd_5g]); -+ -+ for (index = 0; index < CH_LIST_LEN(rtw_channel_def_5g[chd_5g]); index++) { -+ if (CH_LIST_CH(rtw_channel_def_5g[chd_5g], index) == ch) { -+ if (flags) { -+ if ((rtw_is_5g_band1(ch) && (attrib & CLA_5G_B1_PASSIVE)) /* band1 passive */ -+ || (rtw_is_5g_band2(ch) && (attrib & CLA_5G_B2_PASSIVE)) /* band2 passive */ -+ || (rtw_is_5g_band3(ch) && (attrib & CLA_5G_B3_PASSIVE)) /* band3 passive */ -+ || (rtw_is_5g_band4(ch) && (attrib & CLA_5G_B4_PASSIVE)) /* band4 passive */ -+ ) -+ *flags |= RTW_CHF_NO_IR; -+ -+ if ((rtw_is_5g_band2(ch) && (attrib & CLA_5G_B2_DFS)) -+ || (rtw_is_5g_band3(ch) && (attrib & CLA_5G_B3_DFS)) -+ || (rtw_is_5g_band4(ch) && (attrib & CLA_5G_B4_DFS))) -+ *flags |= RTW_CHF_DFS; -+ } -+ return 1; -+ } -+ } -+ } else -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ { -+ u8 chd_2g = RTW_ChannelPlanMap[id].chd_2g; -+ -+ attrib = CH_LIST_ATTRIB(rtw_channel_def_2g[chd_2g]); -+ -+ for (index = 0; index < CH_LIST_LEN(rtw_channel_def_2g[chd_2g]); index++) { -+ if (CH_LIST_CH(rtw_channel_def_2g[chd_2g], index) == ch) { -+ if (flags) { -+ if (ch >= 12 && ch <= 14 && (attrib & CLA_2G_12_14_PASSIVE)) -+ *flags |= RTW_CHF_NO_IR; -+ } -+ return 1; -+ } -+ } -+ } -+ -+ return 0; -+} -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+enum rtw_chd_6g { -+ RTW_CHD_6G_INVALID = 0, -+ -+ RTW_CHD_6G_00, -+ RTW_CHD_6G_01, -+ RTW_CHD_6G_02, -+ RTW_CHD_6G_03, -+ RTW_CHD_6G_04, -+ RTW_CHD_6G_05, /* 6G Worldwide */ -+ -+ RTW_CHD_6G_MAX, -+ RTW_CHD_6G_NULL = RTW_CHD_6G_00, -+}; -+ -+static const struct ch_list_t rtw_channel_def_6g[] = { -+ /* RTW_CHD_6G_INVALID */ CH_LIST_ENT(0, 0), -+ /* RTW_CHD_6G_00 */ CH_LIST_ENT(0, 0), -+ /* RTW_CHD_6G_01 */ CH_LIST_ENT(24, 1, 5, 9, 13, 17, 21, 25, 29, 33, 37, 41, 45, 49, 53, 57, 61, 65, 69, 73, 77, 81, 85, 89, 93, 0), -+ /* RTW_CHD_6G_02 */ CH_LIST_ENT(6, 97, 101, 105, 109, 113, 117, 0), -+ /* RTW_CHD_6G_03 */ CH_LIST_ENT(18, 121, 125, 129, 133, 137, 141, 145, 149, 153, 157, 161, 165, 169, 173, 177, 181, 185, 189, 0), -+ /* RTW_CHD_6G_04 */ CH_LIST_ENT(11, 193, 197, 201, 205, 209, 213, 217, 221, 225, 229, 233, 0), -+ /* RTW_CHD_6G_05 */ CH_LIST_ENT(59, 1, 5, 9, 13, 17, 21, 25, 29, 33, 37, 41, 45, 49, 53, 57, 61, 65, 69, 73, 77, 81, 85, 89, 93, 97, 101, 105, 109, 113, 117, 121, 125, 129, 133, 137, 141, 145, 149, 153, 157, 161, 165, 169, 173, 177, 181, 185, 189, 193, 197, 201, 205, 209, 213, 217, 221, 225, 229, 233, CLA_6G_B1_PASSIVE | CLA_6G_B2_PASSIVE | CLA_6G_B3_PASSIVE | CLA_6G_B4_PASSIVE), -+}; -+ -+struct chplan_6g_ent_t { -+ u8 regd; /* value of enum rtw_regd */ -+ u8 chd; -+}; -+ -+#define CHPLAN_6G_ENT(_regd, _chd) {.regd = RTW_REGD_##_regd, .chd = RTW_CHD_6G_##_chd} -+ -+#define CHPLAN_6G_ENT_NOT_DEFINED CHPLAN_6G_ENT(NA, INVALID) -+ -+static const struct chplan_6g_ent_t rtw_chplan_6g_map[] = { -+ [0x00] = CHPLAN_6G_ENT(NA , 00), -+ [0x01] = CHPLAN_6G_ENT(FCC , 01), -+ [0x02] = CHPLAN_6G_ENT(FCC , 02), -+ [0x03] = CHPLAN_6G_ENT(FCC , 03), -+ [0x04] = CHPLAN_6G_ENT(FCC , 04), -+ [0x7F] = CHPLAN_6G_ENT(WW , 05), -+}; -+ -+const int rtw_chplan_6g_map_size = sizeof(rtw_chplan_6g_map) / sizeof(rtw_chplan_6g_map[0]); -+ -+u8 rtw_chplan_get_default_regd_6g(u8 id) -+{ -+ if (id < rtw_chplan_6g_map_size) -+ return rtw_chplan_6g_map[id].regd; -+ return RTW_REGD_NA; -+} -+ -+bool rtw_is_channel_plan_6g_valid(u8 id) -+{ -+ if (id < rtw_chplan_6g_map_size) { -+ const struct chplan_6g_ent_t *chplan_map = &rtw_chplan_6g_map[id]; -+ -+ if (chplan_map->chd != RTW_CHD_6G_INVALID) -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+bool rtw_regsty_is_excl_chs_6g(struct registry_priv *regsty, u8 ch) -+{ -+ int i; -+ -+ for (i = 0; i < MAX_CHANNEL_NUM_6G; i++) { -+ if (regsty->excl_chs_6g[i] == 0) -+ break; -+ if (regsty->excl_chs_6g[i] == ch) -+ return _TRUE; -+ } -+ return _FALSE; -+} -+ -+/* -+ * Search the @param ch in chplan by given @param id -+ * @id: the given channel plan id -+ * @ch: the given channel number -+ * -+ * return the index of channel_num in channel_set, -1 if not found -+ */ -+static bool rtw_chplan_6g_get_ch(u8 id, const u32 ch, u8 *flags) -+{ -+ u8 index, chan, attrib; -+ u8 chd_6g; -+ -+ if (flags) -+ *flags = 0; -+ -+ chd_6g = rtw_chplan_6g_map[id].chd; -+ -+ attrib = CH_LIST_ATTRIB(rtw_channel_def_6g[chd_6g]); -+ -+ for (index = 0; index < CH_LIST_LEN(rtw_channel_def_6g[chd_6g]); index++) { -+ if (CH_LIST_CH(rtw_channel_def_6g[chd_6g], index) == ch) { -+ if (flags) { -+ if ((rtw_is_6g_band1(ch) && (attrib & CLA_6G_B1_PASSIVE)) /* band1 passive */ -+ || (rtw_is_6g_band2(ch) && (attrib & CLA_6G_B2_PASSIVE)) /* band2 passive */ -+ || (rtw_is_6g_band3(ch) && (attrib & CLA_6G_B3_PASSIVE)) /* band3 passive */ -+ || (rtw_is_6g_band4(ch) && (attrib & CLA_6G_B4_PASSIVE)) /* band4 passive */ -+ ) -+ *flags |= RTW_CHF_NO_IR; -+ } -+ return 1; -+ } -+ } -+ -+ return 0; -+} -+#endif /* CONFIG_IEEE80211_BAND_6GHZ */ -+ -+ -+/* -+ * Check if the @param ch, bw, offset is valid for the given @param id, id_6g -+ * @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_chplan_is_chbw_valid(u8 id, u8 id_6g, BAND_TYPE band, u8 ch, u8 bw, u8 offset -+ , bool allow_primary_passive, bool allow_passive, struct registry_priv *regsty) -+{ -+ u8 cch; -+ u8 *op_chs; -+ u8 op_ch_num; -+ u8 op_ch; -+ u8 valid = 0; -+ int i; -+ int ch_idx; -+ u8 flags; -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ if (band == BAND_ON_6G) -+ goto exit; -+#endif -+ -+ cch = rtw_get_center_ch(ch, bw, offset); /* TODO: 6G */ -+ -+ if (!rtw_get_op_chs_by_cch_bw(cch, bw, &op_chs, &op_ch_num)) /* TODO: 6G */ -+ goto exit; -+ -+ for (i = 0; i < op_ch_num; i++) { -+ op_ch = *(op_chs + i); -+ if (0) -+ RTW_INFO("%u,%u,%u - cch:%u, bw:%u, op_ch:%u\n", ch, bw, offset, cch, bw, op_ch); -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ if (band == BAND_ON_6G) { -+ if (!rtw_chplan_6g_get_ch(id_6g, op_ch, &flags) -+ || (regsty && rtw_regsty_is_excl_chs_6g(regsty, op_ch) == _TRUE)) -+ break; -+ } else -+ #endif -+ { -+ if (!rtw_chplan_get_ch(id, op_ch, &flags) -+ || (regsty && rtw_regsty_is_excl_chs(regsty, op_ch) == _TRUE)) -+ break; -+ } -+ if (flags & RTW_CHF_NO_IR) { -+ if (!allow_passive -+ || (!allow_primary_passive && op_ch == ch)) -+ break; -+ } -+ } -+ -+ if (op_ch_num != 0 && i == op_ch_num) -+ valid = 1; -+ -+exit: -+ return valid; -+} -+ -+const char *_regd_src_str[] = { -+ [REGD_SRC_RTK_PRIV] = "RTK_PRIV", -+ [REGD_SRC_OS] = "OS", -+ [REGD_SRC_NUM] = "UNKNOWN", -+}; -+ -+static u8 init_channel_set_from_rtk_priv_2g_5g(_adapter *adapter, RT_CHANNEL_INFO *channel_set, u8 *ch_num) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ u8 chplan = rfctl->ChannelPlan; -+ u8 index, chanset_size = *ch_num; -+ u8 b5GBand = _FALSE, b2_4GBand = _FALSE; -+ u8 ch, attrib; -+ -+ if (!rtw_is_channel_plan_valid(chplan)) { -+ RTW_ERR(FUNC_ADPT_FMT" invalid chplan:0x%02X\n", FUNC_ADPT_ARG(adapter), chplan); -+ goto exit; -+ } -+ RTW_INFO(FUNC_ADPT_FMT" chplan:0x%02X\n", FUNC_ADPT_ARG(adapter), chplan); -+ -+ if (IsSupported24G(regsty->wireless_mode) && hal_chk_band_cap(adapter, BAND_CAP_2G)) -+ b2_4GBand = _TRUE; -+ -+ if (is_supported_5g(regsty->wireless_mode) && hal_chk_band_cap(adapter, BAND_CAP_5G)) -+ b5GBand = _TRUE; -+ -+ if (b2_4GBand) { -+ u8 chd_2g = RTW_ChannelPlanMap[chplan].chd_2g; -+ -+ attrib = CH_LIST_ATTRIB(rtw_channel_def_2g[chd_2g]); -+ -+ for (index = 0; index < CH_LIST_LEN(rtw_channel_def_2g[chd_2g]); index++) { -+ ch = CH_LIST_CH(rtw_channel_def_2g[chd_2g], index); -+ if (rtw_regsty_is_excl_chs(regsty, ch) == _TRUE) -+ continue; -+ -+ if (chanset_size >= MAX_CHANNEL_NUM) { -+ RTW_WARN("chset size can't exceed MAX_CHANNEL_NUM(%u)\n", MAX_CHANNEL_NUM); -+ break; -+ } -+ -+ channel_set[chanset_size].band = BAND_ON_2_4G; -+ channel_set[chanset_size].ChannelNum = ch; -+ -+ if (ch >= 12 && ch <= 14 && (attrib & CLA_2G_12_14_PASSIVE)) -+ channel_set[chanset_size].flags |= RTW_CHF_NO_IR; -+ -+ if (channel_set[chanset_size].flags & RTW_CHF_NO_IR) { -+ if (!rtw_rfctl_reg_allow_beacon_hint(rfctl) || !rtw_chinfo_allow_beacon_hint(&channel_set[chanset_size])) -+ RTW_INFO("band:%s ch%u is NO_IR while beacon hint not allowed\n", band_str(BAND_ON_2_4G), ch); -+ } -+ -+ chanset_size++; -+ } -+ } -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+ if (b5GBand) { -+ bool dfs; -+ u8 chd_5g = RTW_ChannelPlanMap[chplan].chd_5g; -+ -+ attrib = CH_LIST_ATTRIB(rtw_channel_def_5g[chd_5g]); -+ -+ for (index = 0; index < CH_LIST_LEN(rtw_channel_def_5g[chd_5g]); index++) { -+ ch = CH_LIST_CH(rtw_channel_def_5g[chd_5g], index); -+ if (rtw_regsty_is_excl_chs(regsty, ch) == _TRUE) -+ continue; -+ dfs = (rtw_is_5g_band2(ch) && (attrib & CLA_5G_B2_DFS)) -+ || (rtw_is_5g_band3(ch) && (attrib & CLA_5G_B3_DFS)) -+ || (rtw_is_5g_band4(ch) && (attrib & CLA_5G_B4_DFS)); -+ #if !CONFIG_DFS -+ if (dfs) -+ continue; -+ #endif -+ -+ if (chanset_size >= MAX_CHANNEL_NUM) { -+ RTW_WARN("chset size can't exceed MAX_CHANNEL_NUM(%u)\n", MAX_CHANNEL_NUM); -+ break; -+ } -+ -+ channel_set[chanset_size].band = BAND_ON_5G; -+ channel_set[chanset_size].ChannelNum = ch; -+ -+ if ((rtw_is_5g_band1(ch) && (attrib & CLA_5G_B1_PASSIVE)) /* band1 passive */ -+ || (rtw_is_5g_band2(ch) && (attrib & CLA_5G_B2_PASSIVE)) /* band2 passive */ -+ || (rtw_is_5g_band3(ch) && (attrib & CLA_5G_B3_PASSIVE)) /* band3 passive */ -+ || (rtw_is_5g_band4(ch) && (attrib & CLA_5G_B4_PASSIVE)) /* band4 passive */ -+ ) -+ channel_set[chanset_size].flags |= RTW_CHF_NO_IR; -+ -+ if (dfs) -+ channel_set[chanset_size].flags |= RTW_CHF_DFS; -+ -+ if (channel_set[chanset_size].flags & RTW_CHF_NO_IR) { -+ if (!rtw_rfctl_reg_allow_beacon_hint(rfctl) || !rtw_chinfo_allow_beacon_hint(&channel_set[chanset_size])) -+ RTW_INFO("band:%s ch%u is NO_IR%s while beacon hint not allowed\n", band_str(BAND_ON_5G), ch, dfs ? " DFS" : ""); -+ } -+ -+ chanset_size++; -+ } -+ } -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ -+exit: -+ *ch_num = chanset_size; -+ -+ return chanset_size; -+} -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+static u8 init_channel_set_from_rtk_priv_6g(_adapter *adapter, RT_CHANNEL_INFO *channel_set, u8 *ch_num) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ u8 chplan_6g = rfctl->chplan_6g; -+ u8 index, chanset_size = *ch_num; -+ bool band_6g = _FALSE; -+ u8 chd_6g; -+ u8 ch, attrib; -+ -+ if (!rtw_is_channel_plan_6g_valid(chplan_6g)) { -+ RTW_ERR(FUNC_ADPT_FMT" invalid chplan_6g:0x%02X\n", FUNC_ADPT_ARG(adapter), chplan_6g); -+ goto exit; -+ } -+ RTW_INFO(FUNC_ADPT_FMT" chplan_6g:0x%02X\n", FUNC_ADPT_ARG(adapter), chplan_6g); -+ -+ band_6g = _TRUE; /* TODO: SW conf & HW cap check */ -+ if (!band_6g) -+ goto exit; -+ -+ chd_6g = rtw_chplan_6g_map[chplan_6g].chd; -+ -+ attrib = CH_LIST_ATTRIB(rtw_channel_def_6g[chd_6g]); -+ -+ for (index = 0; index < CH_LIST_LEN(rtw_channel_def_6g[chd_6g]); index++) { -+ ch = CH_LIST_CH(rtw_channel_def_6g[chd_6g], index); -+ if (rtw_regsty_is_excl_chs_6g(regsty, ch) == _TRUE) -+ continue; -+ if (chanset_size >= MAX_CHANNEL_NUM) { -+ RTW_WARN("chset size can't exceed MAX_CHANNEL_NUM(%u)\n", MAX_CHANNEL_NUM); -+ break; -+ } -+ -+ channel_set[chanset_size].band = BAND_ON_6G; -+ channel_set[chanset_size].ChannelNum = ch; -+ -+ if ((rtw_is_6g_band1(ch) && (attrib & CLA_6G_B1_PASSIVE)) /* band1 passive */ -+ || (rtw_is_6g_band2(ch) && (attrib & CLA_6G_B2_PASSIVE)) /* band2 passive */ -+ || (rtw_is_6g_band3(ch) && (attrib & CLA_6G_B3_PASSIVE)) /* band3 passive */ -+ || (rtw_is_6g_band4(ch) && (attrib & CLA_6G_B4_PASSIVE)) /* band4 passive */ -+ ) -+ channel_set[chanset_size].flags |= RTW_CHF_NO_IR; -+ -+ chanset_size++; -+ } -+ -+exit: -+ *ch_num = chanset_size; -+ -+ return chanset_size; -+} -+#endif /* CONFIG_IEEE80211_BAND_6GHZ */ -+ -+static u8 init_channel_set_from_rtk_priv(_adapter *adapter, RT_CHANNEL_INFO *channel_set) -+{ -+ u8 chanset_size = 0; -+#ifdef CONFIG_DFS_MASTER -+ int i; -+#endif -+ -+ _rtw_memset(channel_set, 0, sizeof(RT_CHANNEL_INFO) * MAX_CHANNEL_NUM); -+ -+ init_channel_set_from_rtk_priv_2g_5g(adapter, channel_set, &chanset_size); -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ init_channel_set_from_rtk_priv_6g(adapter, channel_set, &chanset_size); -+#endif -+ -+#ifdef CONFIG_DFS_MASTER -+ for (i = 0; i < chanset_size; i++) -+ channel_set[i].non_ocp_end_time = rtw_get_current_time(); -+#endif -+ -+ if (chanset_size) -+ RTW_INFO(FUNC_ADPT_FMT" ch num:%d\n", FUNC_ADPT_ARG(adapter), chanset_size); -+ else -+ RTW_WARN(FUNC_ADPT_FMT" final chset has no channel\n", FUNC_ADPT_ARG(adapter)); -+ -+ return chanset_size; -+} -+ -+u8 init_channel_set(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ if (rfctl->regd_src == REGD_SRC_RTK_PRIV) -+ rfctl->max_chan_nums = init_channel_set_from_rtk_priv(adapter, rfctl->channel_set); -+#ifdef CONFIG_REGD_SRC_FROM_OS -+ else if (rfctl->regd_src == REGD_SRC_OS) -+ rfctl->max_chan_nums = rtw_os_init_channel_set(adapter, rfctl->channel_set); -+#endif -+ else { -+ rfctl->max_chan_nums = 0; -+ rtw_warn_on(1); -+ } -+ -+ return rfctl->max_chan_nums; -+} -+ -+bool rtw_chset_is_dfs_range(struct _RT_CHANNEL_INFO *chset, u32 hi, u32 lo) -+{ -+ u8 hi_ch = rtw_freq2ch(hi); -+ u8 lo_ch = rtw_freq2ch(lo); -+ int i; -+ -+ for (i = 0; i < MAX_CHANNEL_NUM && chset[i].ChannelNum != 0; i++){ -+ if (!(chset[i].flags & RTW_CHF_DFS)) -+ continue; -+ if (hi_ch > chset[i].ChannelNum && lo_ch < chset[i].ChannelNum) -+ return 1; -+ } -+ -+ return 0; -+} -+ -+bool rtw_chset_is_dfs_ch(struct _RT_CHANNEL_INFO *chset, u8 ch) -+{ -+ int i; -+ -+ for (i = 0; i < MAX_CHANNEL_NUM && chset[i].ChannelNum != 0; i++){ -+ if (chset[i].ChannelNum == ch) -+ return chset[i].flags & RTW_CHF_DFS ? 1 : 0; -+ } -+ -+ return 0; -+} -+ -+bool rtw_chset_is_dfs_chbw(struct _RT_CHANNEL_INFO *chset, u8 ch, u8 bw, u8 offset) -+{ -+ u32 hi, lo; -+ -+ if (!rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo)) -+ return 0; -+ -+ return rtw_chset_is_dfs_range(chset, hi, lo); -+} -+ -+/* channel specific beacon hint rules */ -+#ifndef RTW_CHPLAN_BEACON_HINT_ON_2G_CH_1_11 -+#define RTW_CHPLAN_BEACON_HINT_ON_2G_CH_1_11 0 -+#endif -+#ifndef RTW_CHPLAN_BEACON_HINT_ON_DFS_CH -+#define RTW_CHPLAN_BEACON_HINT_ON_DFS_CH 0 -+#endif -+ -+bool rtw_chinfo_allow_beacon_hint(struct _RT_CHANNEL_INFO *chinfo) -+{ -+ return (RTW_CHPLAN_BEACON_HINT_ON_2G_CH_1_11 || !(chinfo->band == BAND_ON_2_4G && chinfo->ChannelNum <= 11)) -+ && (RTW_CHPLAN_BEACON_HINT_ON_DFS_CH || !(chinfo->flags & RTW_CHF_DFS)); -+} -+ -+u8 rtw_process_beacon_hint(_adapter *adapter, WLAN_BSSID_EX *bss) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ RT_CHANNEL_INFO *chset = rfctl->channel_set; -+ u8 ch = bss->Configuration.DSConfig; -+ int chset_idx = rtw_chset_search_ch(chset, ch); -+ RT_CHANNEL_INFO *chinfo; -+ u8 act_cnt = 0; -+ -+ if (chset_idx < 0) -+ goto exit; -+ -+ chinfo = &chset[chset_idx]; -+ -+ if ((chinfo->flags & RTW_CHF_NO_IR) -+ && rtw_rfctl_reg_allow_beacon_hint(rfctl) -+ && rtw_chinfo_allow_beacon_hint(chinfo) -+ ) { -+ RTW_INFO("%s: change band:%s ch:%d to active\n", __func__, band_str(chinfo->band), ch); -+ chinfo->flags &= ~RTW_CHF_NO_IR; -+ act_cnt++; -+ } -+ -+exit: -+ return act_cnt; -+} -+ -+const char *const _regd_inr_str[] = { -+ [RTW_REGD_SET_BY_INIT] = "INIT", -+ [RTW_REGD_SET_BY_USER] = "USER", -+ [RTW_REGD_SET_BY_COUNTRY_IE] = "COUNTRY_IE", -+ [RTW_REGD_SET_BY_DRIVER] = "DRIVER", -+ [RTW_REGD_SET_BY_CORE] = "CORE", -+ [RTW_REGD_SET_BY_NUM] = "UNKNOWN", -+}; -+ -+const char *const _regd_str[] = { -+ [RTW_REGD_NA] = "NA", -+ [RTW_REGD_FCC] = "FCC", -+ [RTW_REGD_MKK] = "MKK", -+ [RTW_REGD_ETSI] = "ETSI", -+ [RTW_REGD_IC] = "IC", -+ [RTW_REGD_KCC] = "KCC", -+ [RTW_REGD_NCC] = "NCC", -+ [RTW_REGD_ACMA] = "ACMA", -+ [RTW_REGD_CHILE] = "CHILE", -+ [RTW_REGD_MEX] = "MEX", -+ [RTW_REGD_WW] = "WW", -+}; -+ -+const char *const _rtw_edcca_mode_str[] = { -+ [RTW_EDCCA_NORMAL] = "NORMAL", -+ [RTW_EDCCA_ADAPT] = "ADAPT", -+ [RTW_EDCCA_CS] = "CS", -+}; -+ -+const char *_rtw_dfs_regd_str[] = { -+ [RTW_DFS_REGD_NONE] = "NONE", -+ [RTW_DFS_REGD_FCC] = "FCC", -+ [RTW_DFS_REGD_MKK] = "MKK", -+ [RTW_DFS_REGD_ETSI] = "ETSI", -+}; -+ -+const char *const _txpwr_lmt_str[] = { -+ [TXPWR_LMT_NONE] = "NONE", -+ [TXPWR_LMT_FCC] = "FCC", -+ [TXPWR_LMT_MKK] = "MKK", -+ [TXPWR_LMT_ETSI] = "ETSI", -+ [TXPWR_LMT_IC] = "IC", -+ [TXPWR_LMT_KCC] = "KCC", -+ [TXPWR_LMT_NCC] = "NCC", -+ [TXPWR_LMT_ACMA] = "ACMA", -+ [TXPWR_LMT_CHILE] = "CHILE", -+ [TXPWR_LMT_UKRAINE] = "UKRAINE", -+ [TXPWR_LMT_MEXICO] = "MEXICO", -+ [TXPWR_LMT_CN] = "CN", -+ [TXPWR_LMT_QATAR] = "QATAR", -+ [TXPWR_LMT_WW] = "WW", -+ [TXPWR_LMT_NUM] = NULL, -+}; -+ -+const REGULATION_TXPWR_LMT _txpwr_lmt_alternate[] = { -+ [TXPWR_LMT_NONE] = TXPWR_LMT_NONE, -+ [TXPWR_LMT_FCC] = TXPWR_LMT_FCC, -+ [TXPWR_LMT_MKK] = TXPWR_LMT_MKK, -+ [TXPWR_LMT_ETSI] = TXPWR_LMT_ETSI, -+ [TXPWR_LMT_WW] = TXPWR_LMT_WW, -+ [TXPWR_LMT_NUM] = TXPWR_LMT_NUM, -+ -+ [TXPWR_LMT_IC] = TXPWR_LMT_FCC, -+ [TXPWR_LMT_KCC] = TXPWR_LMT_ETSI, -+ [TXPWR_LMT_NCC] = TXPWR_LMT_FCC, -+ [TXPWR_LMT_ACMA] = TXPWR_LMT_ETSI, -+ [TXPWR_LMT_CHILE] = TXPWR_LMT_FCC, -+ [TXPWR_LMT_UKRAINE] = TXPWR_LMT_ETSI, -+ [TXPWR_LMT_MEXICO] = TXPWR_LMT_FCC, -+ [TXPWR_LMT_CN] = TXPWR_LMT_ETSI, -+ [TXPWR_LMT_QATAR] = TXPWR_LMT_ETSI, -+}; -+ -+const enum rtw_edcca_mode _rtw_regd_to_edcca_mode[RTW_REGD_NUM] = { -+ [RTW_REGD_NA] = RTW_EDCCA_MODE_NUM, -+ [RTW_REGD_MKK] = RTW_EDCCA_CS, -+ [RTW_REGD_ETSI] = RTW_EDCCA_ADAPT, -+ [RTW_REGD_WW] = RTW_EDCCA_ADAPT, -+}; -+ -+const REGULATION_TXPWR_LMT _rtw_regd_to_txpwr_lmt[] = { -+ [RTW_REGD_NA] = TXPWR_LMT_NUM, -+ [RTW_REGD_FCC] = TXPWR_LMT_FCC, -+ [RTW_REGD_MKK] = TXPWR_LMT_MKK, -+ [RTW_REGD_ETSI] = TXPWR_LMT_ETSI, -+ [RTW_REGD_IC] = TXPWR_LMT_IC, -+ [RTW_REGD_KCC] = TXPWR_LMT_KCC, -+ [RTW_REGD_NCC] = TXPWR_LMT_NCC, -+ [RTW_REGD_ACMA] = TXPWR_LMT_ACMA, -+ [RTW_REGD_CHILE] = TXPWR_LMT_CHILE, -+ [RTW_REGD_MEX] = TXPWR_LMT_MEXICO, -+ [RTW_REGD_WW] = TXPWR_LMT_WW, -+}; -+ -+char *rtw_get_edcca_modes_str(char *buf, u8 modes[]) -+{ -+#define EDCCA_MODE_SEQ_COMPARE(result, operand) (result == RTW_EDCCA_MODE_NUM ? operand : (operand == RTW_EDCCA_MODE_NUM ? result : (result != operand ? -1 : result))) -+ -+ int mode = RTW_EDCCA_MODE_NUM; -+ int cnt = 0; -+ -+ mode = EDCCA_MODE_SEQ_COMPARE(mode, modes[BAND_ON_2_4G]); -+#if CONFIG_IEEE80211_BAND_5GHZ -+ mode = EDCCA_MODE_SEQ_COMPARE(mode, modes[BAND_ON_5G]); -+#endif -+#if CONFIG_IEEE80211_BAND_6GHZ -+ mode = EDCCA_MODE_SEQ_COMPARE(mode, modes[BAND_ON_6G]); -+#endif -+ -+ if (mode != -1) { /* all available values are the same */ -+ cnt += snprintf(buf + cnt, EDCCA_MODES_STR_LEN - cnt - 1, "%s(%u)", rtw_edcca_mode_str(mode), mode); -+ if (cnt >= EDCCA_MODES_STR_LEN - 1) -+ goto exit; -+ } else { -+ cnt += snprintf(buf + cnt, EDCCA_MODES_STR_LEN - cnt - 1, "%s(%u) ", rtw_edcca_mode_str(modes[BAND_ON_2_4G]), modes[BAND_ON_2_4G]); -+ if (cnt >= EDCCA_MODES_STR_LEN - 1) -+ goto exit; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ cnt += snprintf(buf + cnt, EDCCA_MODES_STR_LEN - cnt - 1, "%s(%u) ", rtw_edcca_mode_str(modes[BAND_ON_5G]), modes[BAND_ON_5G]); -+ if (cnt >= EDCCA_MODES_STR_LEN - 1) -+ goto exit; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ cnt += snprintf(buf + cnt, EDCCA_MODES_STR_LEN - cnt - 1, "%s(%u) ", rtw_edcca_mode_str(modes[BAND_ON_6G]), modes[BAND_ON_6G]); -+ if (cnt >= EDCCA_MODES_STR_LEN - 1) -+ goto exit; -+ #endif -+ buf[cnt - 1] = 0; -+ } -+ -+exit: -+ return buf; -+} -+ -+void rtw_edcca_mode_update(struct dvobj_priv *dvobj) -+{ -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ -+ if (regsty->adaptivity_en == 0) { -+ /* force disable */ -+ rfctl->edcca_mode_2g = RTW_EDCCA_NORMAL; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ rfctl->edcca_mode_5g = RTW_EDCCA_NORMAL; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ rfctl->edcca_mode_6g = RTW_EDCCA_NORMAL; -+ #endif -+ -+ } else if (regsty->adaptivity_en == 1) { -+ /* force enable */ -+ if (!regsty->adaptivity_mode) { -+ /* adaptivity */ -+ rfctl->edcca_mode_2g = RTW_EDCCA_ADAPT; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ rfctl->edcca_mode_5g = RTW_EDCCA_ADAPT; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ rfctl->edcca_mode_6g = RTW_EDCCA_ADAPT; -+ #endif -+ } else { -+ /* carrier sense */ -+ rfctl->edcca_mode_2g = RTW_EDCCA_CS; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ rfctl->edcca_mode_5g = RTW_EDCCA_CS; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ rfctl->edcca_mode_6g = RTW_EDCCA_CS; -+ #endif -+ } -+ -+ } else { -+ u8 modes[BAND_MAX]; -+ char buf[EDCCA_MODES_STR_LEN]; -+ -+ /* by regulatory setting */ -+ #ifdef CONFIG_REGD_SRC_FROM_OS -+ if (rfctl->regd_src == REGD_SRC_OS -+ && rfctl->ChannelPlan == RTW_CHPLAN_UNSPECIFIED -+ ) { -+ modes[BAND_ON_2_4G] = rfctl->edcca_mode_2g = RTW_EDCCA_ADAPT; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ modes[BAND_ON_5G] = rfctl->edcca_mode_5g = RTW_EDCCA_ADAPT; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ modes[BAND_ON_6G] = rfctl->edcca_mode_6g = RTW_EDCCA_ADAPT; -+ #endif -+ RTW_PRINT("mapping %scountry:%c%c to edcca_mode:%s\n" -+ , RFCTL_REG_WORLDWIDE(rfctl) ? "" : "unsupported " -+ , rfctl->alpha2[0] -+ , rfctl->alpha2[1] -+ , rtw_get_edcca_modes_str(buf, modes) -+ ); -+ } else -+ #endif -+ { -+ modes[BAND_ON_2_4G] = rfctl->edcca_mode_2g = -+ rfctl->edcca_mode_2g_override != RTW_EDCCA_DEF ? rfctl->edcca_mode_2g_override : -+ rtw_regd_to_edcca_mode(rtw_chplan_get_default_regd_2g(rfctl->ChannelPlan)); -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ modes[BAND_ON_5G] = rfctl->edcca_mode_5g = -+ rfctl->edcca_mode_5g_override != RTW_EDCCA_DEF ? rfctl->edcca_mode_5g_override : -+ rtw_regd_to_edcca_mode(rtw_chplan_get_default_regd_5g(rfctl->ChannelPlan)); -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ modes[BAND_ON_6G] = rfctl->edcca_mode_6g = -+ rfctl->edcca_mode_6g_override != RTW_EDCCA_DEF ? rfctl->edcca_mode_6g_override : -+ rtw_regd_to_edcca_mode(rtw_chplan_get_default_regd_6g(rfctl->chplan_6g)); -+ #endif -+ RTW_PRINT("update edcca_mode:%s\n" -+ , rtw_get_edcca_modes_str(buf, modes) -+ ); -+ } -+ } -+} -+ -+u8 rtw_get_edcca_mode(struct dvobj_priv *dvobj, BAND_TYPE band) -+{ -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ u8 edcca_mode = RTW_EDCCA_NORMAL; -+ -+ if (band == BAND_ON_2_4G) -+ edcca_mode = rfctl->edcca_mode_2g; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ else if (band == BAND_ON_5G) -+ edcca_mode = rfctl->edcca_mode_5g; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ else if (band == BAND_ON_6G) -+ edcca_mode = rfctl->edcca_mode_6g; -+ #endif -+ -+ return edcca_mode; -+} -+ -+char *rtw_get_txpwr_lmt_names_str(char *buf, const char *names[], u8 unknown_bmp) -+{ -+#define NAME_DIFF ((void *)1) -+/* input comes form organized database, string with same content will not have different pointer */ -+#define NAME_SEQ_COMPARE(result, operand) (result == NULL ? operand : (operand == NULL ? result : (result != operand ? NAME_DIFF : result))) -+ -+ const char *name = NULL; -+ int cnt = 0; -+ -+ name = NAME_SEQ_COMPARE(name, names[BAND_ON_2_4G]); -+#if CONFIG_IEEE80211_BAND_5GHZ -+ name = NAME_SEQ_COMPARE(name, names[BAND_ON_5G]); -+#endif -+#if CONFIG_IEEE80211_BAND_6GHZ -+ name = NAME_SEQ_COMPARE(name, names[BAND_ON_6G]); -+#endif -+ -+ if (name != NAME_DIFF) { /* all available values are the same */ -+ cnt += snprintf(buf + cnt, TXPWR_NAMES_STR_LEN - cnt - 1, "%s%s", (unknown_bmp & BIT(BAND_ON_2_4G)) ? "?" : "", name); -+ if (cnt >= TXPWR_NAMES_STR_LEN - 1) -+ goto exit; -+ } else { -+ cnt += snprintf(buf + cnt, TXPWR_NAMES_STR_LEN - cnt - 1, "%s%s ", (unknown_bmp & BIT(BAND_ON_2_4G)) ? "?" : "", names[BAND_ON_2_4G]); -+ if (cnt >= TXPWR_NAMES_STR_LEN - 1) -+ goto exit; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ cnt += snprintf(buf + cnt, TXPWR_NAMES_STR_LEN - cnt - 1, "%s%s ", (unknown_bmp & BIT(BAND_ON_5G)) ? "?" : "", names[BAND_ON_5G]); -+ if (cnt >= TXPWR_NAMES_STR_LEN - 1) -+ goto exit; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ cnt += snprintf(buf + cnt, TXPWR_NAMES_STR_LEN - cnt - 1, "%s%s ", (unknown_bmp & BIT(BAND_ON_6G)) ? "?" : "", names[BAND_ON_6G]); -+ if (cnt >= TXPWR_NAMES_STR_LEN - 1) -+ goto exit; -+ #endif -+ buf[cnt - 1] = 0; -+ } -+ -+exit: -+ return buf; -+} -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+#define COUNTRY_CHPLAN_ASSIGN_EDCCA_MODE_5G_OVERRIDE(_val) , .edcca_mode_5g_override = (_val) -+#else -+#define COUNTRY_CHPLAN_ASSIGN_EDCCA_MODE_5G_OVERRIDE(_val) -+#endif -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+#define COUNTRY_CHPLAN_ASSIGN_CHPLAN_6G(_val) , .chplan_6g = (_val) -+#define COUNTRY_CHPLAN_ASSIGN_EDCCA_MODE_6G_OVERRIDE(_val) , .edcca_mode_6g_override = (_val) -+#else -+#define COUNTRY_CHPLAN_ASSIGN_CHPLAN_6G(_val) -+#define COUNTRY_CHPLAN_ASSIGN_EDCCA_MODE_6G_OVERRIDE(_val) -+#endif -+ -+#if defined(CONFIG_80211AC_VHT) || defined(CONFIG_80211AX_HE) -+#define COUNTRY_CHPLAN_ASSIGN_PROTO_EN(_val) , .proto_en = (_val) -+#else -+#define COUNTRY_CHPLAN_ASSIGN_PROTO_EN(_val) -+#endif -+ -+#define COUNTRY_CHPLAN_ENT(_alpha2, _chplan, _chplan_6g, _txpwr_lmt_override, _en_11ax, _en_11ac) \ -+ {.alpha2 = (_alpha2), .chplan = (_chplan) \ -+ COUNTRY_CHPLAN_ASSIGN_CHPLAN_6G(_chplan_6g) \ -+ , .edcca_mode_2g_override = RTW_EDCCA_DEF \ -+ COUNTRY_CHPLAN_ASSIGN_EDCCA_MODE_5G_OVERRIDE(RTW_EDCCA_DEF) \ -+ COUNTRY_CHPLAN_ASSIGN_EDCCA_MODE_6G_OVERRIDE(RTW_EDCCA_DEF) \ -+ , .txpwr_lmt_override = TXPWR_LMT_##_txpwr_lmt_override \ -+ COUNTRY_CHPLAN_ASSIGN_PROTO_EN((_en_11ax ? CHPLAN_PROTO_EN_AX : 0) | (_en_11ac ? CHPLAN_PROTO_EN_AC : 0)) \ -+ } -+ -+static const struct country_chplan world_wide_chplan = -+ COUNTRY_CHPLAN_ENT(WORLDWIDE_ALPHA2, RTW_CHPLAN_WORLDWIDE, RTW_CHPLAN_6G_WORLDWIDE, DEF, 1, 1); -+ -+#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) /* 2013 certify */ -+static const struct country_chplan RTL8821AE_HMC_M2_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AN", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AR", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BH", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BO", 0x73, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BR", 0x62, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BW", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CI", 0x42, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CL", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x51, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CO", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CR", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DO", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DZ", 0x00, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EC", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EG", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GT", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ID", 0x3D, 0x00, DEF , 0, 0), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IL", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JM", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MA", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ME", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MX", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MY", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NI", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PA", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PE", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PR", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PY", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("QA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SV", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TT", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x39, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x36, 0x00, DEF , 0, 0), -+ COUNTRY_CHPLAN_ENT("UG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("US", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UY", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VN", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZW", 0x26, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821AU) /* 2014 certify */ -+static const struct country_chplan RTL8821AU_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AR", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ID", 0x3D, 0x00, DEF , 0, 0), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 0), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x39, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x36, 0x00, DEF , 0, 0), -+ COUNTRY_CHPLAN_ENT("US", 0x34, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8812AENF_NGFF) /* 2014 certify */ -+static const struct country_chplan RTL8812AENF_NGFF_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x39, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("US", 0x34, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8812AEBT_HMC) /* 2013 certify */ -+static const struct country_chplan RTL8812AEBT_HMC_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("QA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 0), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x39, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x36, 0x00, DEF , 0, 0), -+ COUNTRY_CHPLAN_ENT("US", 0x34, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8188EE_HMC_M2) /* 2012 certify */ -+static const struct country_chplan RTL8188EE_HMC_M2_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AN", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AR", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AW", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BB", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BH", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BO", 0x73, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BR", 0x62, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BW", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x20, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CI", 0x42, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CL", 0x2D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CO", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CR", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DO", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DZ", 0x00, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EC", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EG", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ET", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GD", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GQ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GT", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HT", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ID", 0x5D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IL", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JM", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MA", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ME", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ML", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MX", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MY", 0x63, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NI", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NP", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PA", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PE", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PR", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PY", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("QA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SC", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SV", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TT", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x39, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("US", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UY", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UZ", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VC", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VN", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZW", 0x26, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723BE_HMC_M2) /* 2013 certify */ -+static const struct country_chplan RTL8723BE_HMC_M2_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AN", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AO", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AR", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AW", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BH", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BO", 0x73, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BR", 0x62, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BS", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BW", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x20, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CI", 0x42, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CL", 0x2D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CO", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CR", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DO", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DZ", 0x00, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EC", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EG", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ET", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GD", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GQ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GT", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ID", 0x5D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IL", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JM", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MA", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ME", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ML", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MX", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MY", 0x63, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NI", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NP", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PA", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PE", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PR", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PY", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("QA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SV", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TT", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x39, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("US", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UY", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UZ", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VN", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZW", 0x26, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723BS_NGFF1216) /* 2014 certify */ -+static const struct country_chplan RTL8723BS_NGFF1216_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AN", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AO", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AR", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BB", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BH", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BO", 0x73, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BR", 0x62, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BW", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x20, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CI", 0x42, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CL", 0x2D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CO", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CR", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DO", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DZ", 0x00, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EC", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EG", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GT", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HT", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ID", 0x5D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IL", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JM", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MA", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ME", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MQ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MX", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MY", 0x63, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NI", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NP", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PA", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PE", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PR", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PY", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("QA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SV", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TT", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x39, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("US", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UY", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UZ", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VN", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("YE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZW", 0x26, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8192EEBT_HMC_M2) /* 2013 certify */ -+static const struct country_chplan RTL8192EEBT_HMC_M2_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AN", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AO", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AR", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AW", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BH", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BO", 0x73, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BR", 0x62, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BW", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x20, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CI", 0x42, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CL", 0x2D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CO", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CR", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DO", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DZ", 0x00, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EC", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EG", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EH", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ET", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GD", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GQ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GT", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ID", 0x5D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IL", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JM", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MA", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ME", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ML", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MX", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MY", 0x63, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NI", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NP", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PA", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PE", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PR", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PY", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("QA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SC", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ST", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SV", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TT", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x39, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("US", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UY", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UZ", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VN", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("YT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZW", 0x26, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723DE_NGFF1630) /* 2016 certify */ -+static const struct country_chplan RTL8723DE_NGFF1630_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AN", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AR", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BH", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BO", 0x73, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BR", 0x62, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x2A, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CI", 0x42, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CL", 0x2D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CO", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CR", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DO", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DZ", 0x00, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EC", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EG", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GT", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ID", 0x5D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IL", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JM", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MA", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ME", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MX", 0x34, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MY", 0x63, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NI", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PA", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PE", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PR", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PY", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("QA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SV", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TT", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("US", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UY", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VN", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZW", 0x26, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8822BE) /* 2016 certify */ -+static const struct country_chplan RTL8822BE_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AN", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AO", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AR", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BB", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BH", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BM", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BO", 0x73, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BR", 0x62, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BS", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BW", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x2B, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CI", 0x42, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CL", 0x2D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CO", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CR", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DO", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DZ", 0x00, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EC", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EG", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EH", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FJ", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GP", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GQ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GT", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GU", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HT", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ID", 0x3D, 0x00, DEF , 0, 0), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IL", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JM", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MA", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ME", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ML", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MO", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MQ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MX", 0x4D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MY", 0x63, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NI", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NP", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PA", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PE", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PR", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PY", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("QA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SC", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ST", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SV", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TT", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x35, 0x00, UKRAINE, 0, 1), -+ COUNTRY_CHPLAN_ENT("UG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("US", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UY", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UZ", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VN", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("YT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZW", 0x26, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821CE) /* 2016 certify */ -+static const struct country_chplan RTL8821CE_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AN", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AO", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AR", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BB", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BH", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BM", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BO", 0x73, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BR", 0x62, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BS", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BW", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x2B, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CI", 0x42, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CL", 0x2D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CO", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CR", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DO", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DZ", 0x00, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EC", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EG", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EH", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ET", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FJ", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GP", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GQ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GT", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GU", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HT", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ID", 0x3D, 0x00, DEF , 0, 0), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IL", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JM", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MA", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ME", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ML", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MO", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MQ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MX", 0x4D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MY", 0x63, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NI", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NP", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PA", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PE", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PR", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PY", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("QA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SC", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ST", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SV", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x35, 0x00, UKRAINE, 0, 1), -+ COUNTRY_CHPLAN_ENT("UG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("US", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UY", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UZ", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VN", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("YT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZW", 0x26, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8822CE) /* 2018 certify */ -+static const struct country_chplan RTL8822CE_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AE", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AN", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AO", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AR", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AW", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("AZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BB", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BH", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BM", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BO", 0x73, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BR", 0x62, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BS", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BW", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("BY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CA", 0x2B, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CI", 0x42, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CL", 0x2D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 0x00, CN , 0, 1), -+ COUNTRY_CHPLAN_ENT("CO", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CR", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DO", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("DZ", 0x00, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EC", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EG", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("EH", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ET", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FJ", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GP", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GQ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GT", 0x61, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GU", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("GW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HK", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HT", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IL", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IN", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JM", 0x32, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KH", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KR", 0x4B, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("KZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LB", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MA", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ME", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ML", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MO", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MQ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MU", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MW", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MX", 0x4D, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MY", 0x63, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("MZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NA", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NI", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NP", 0x48, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PA", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PE", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PR", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("PY", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("QA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RO", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RS", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SC", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SG", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SL", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SN", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ST", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SV", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("SZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TD", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TF", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TH", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TJ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TN", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TR", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TW", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("TZ", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UA", 0x35, 0x00, UKRAINE, 0, 1), -+ COUNTRY_CHPLAN_ENT("UG", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("US", 0x76, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UY", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("UZ", 0x47, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("VN", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("YT", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZA", 0x35, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZM", 0x26, 0x00, DEF , 0, 1), -+ COUNTRY_CHPLAN_ENT("ZW", 0x26, 0x00, DEF , 0, 1), -+}; -+#endif -+ -+/** -+ * rtw_def_module_country_chplan_map - -+ * @hal_map: returned map -+ * @return: size of map -+ */ -+static u16 rtw_def_module_country_chplan_map(const struct country_chplan **hal_map) -+{ -+ u16 hal_map_sz = 0; -+ -+ /* 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 = sizeof(RTL8821AE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821AU) -+ *hal_map = RTL8821AU_country_chplan_map; -+ hal_map_sz = sizeof(RTL8821AU_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8812AENF_NGFF) -+ *hal_map = RTL8812AENF_NGFF_country_chplan_map; -+ hal_map_sz = sizeof(RTL8812AENF_NGFF_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8812AEBT_HMC) -+ *hal_map = RTL8812AEBT_HMC_country_chplan_map; -+ hal_map_sz = sizeof(RTL8812AEBT_HMC_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8188EE_HMC_M2) -+ *hal_map = RTL8188EE_HMC_M2_country_chplan_map; -+ hal_map_sz = sizeof(RTL8188EE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8723BE_HMC_M2) -+ *hal_map = RTL8723BE_HMC_M2_country_chplan_map; -+ hal_map_sz = sizeof(RTL8723BE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8723BS_NGFF1216) -+ *hal_map = RTL8723BS_NGFF1216_country_chplan_map; -+ hal_map_sz = sizeof(RTL8723BS_NGFF1216_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8192EEBT_HMC_M2) -+ *hal_map = RTL8192EEBT_HMC_M2_country_chplan_map; -+ hal_map_sz = sizeof(RTL8192EEBT_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8723DE_NGFF1630) -+ *hal_map = RTL8723DE_NGFF1630_country_chplan_map; -+ hal_map_sz = sizeof(RTL8723DE_NGFF1630_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8822BE) -+ *hal_map = RTL8822BE_country_chplan_map; -+ hal_map_sz = sizeof(RTL8822BE_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821CE) -+ *hal_map = RTL8821CE_country_chplan_map; -+ hal_map_sz = sizeof(RTL8821CE_country_chplan_map) / sizeof(struct country_chplan); -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8822CE) -+ *hal_map = RTL8822CE_country_chplan_map; -+ hal_map_sz = sizeof(RTL8822CE_country_chplan_map) / sizeof(struct country_chplan); -+#endif -+ -+ return hal_map_sz; -+} -+#else -+ -+static const struct country_chplan country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AD", 0x3A, 0x00, DEF , 1, 1), /* Andorra */ -+ COUNTRY_CHPLAN_ENT("AE", 0x5E, 0x00, DEF , 1, 1), /* United Arab Emirates */ -+ COUNTRY_CHPLAN_ENT("AF", 0x42, 0x00, DEF , 1, 1), /* Afghanistan */ -+ COUNTRY_CHPLAN_ENT("AG", 0x76, 0x00, DEF , 1, 1), /* Antigua & Barbuda */ -+ COUNTRY_CHPLAN_ENT("AI", 0x5E, 0x00, DEF , 1, 1), /* Anguilla(UK) */ -+ COUNTRY_CHPLAN_ENT("AL", 0x5E, 0x00, DEF , 1, 1), /* Albania */ -+ COUNTRY_CHPLAN_ENT("AM", 0x5E, 0x00, DEF , 1, 1), /* Armenia */ -+ COUNTRY_CHPLAN_ENT("AN", 0x76, 0x00, DEF , 1, 1), /* Netherlands Antilles */ -+ COUNTRY_CHPLAN_ENT("AO", 0x5E, 0x00, DEF , 1, 1), /* Angola */ -+ COUNTRY_CHPLAN_ENT("AQ", 0x26, 0x00, DEF , 1, 1), /* Antarctica */ -+ COUNTRY_CHPLAN_ENT("AR", 0x4D, 0x00, DEF , 1, 1), /* Argentina */ -+ COUNTRY_CHPLAN_ENT("AS", 0x76, 0x00, DEF , 1, 1), /* American Samoa */ -+ COUNTRY_CHPLAN_ENT("AT", 0x5E, 0x00, DEF , 1, 1), /* Austria */ -+ COUNTRY_CHPLAN_ENT("AU", 0x03, 0x00, DEF , 1, 1), /* Australia */ -+ COUNTRY_CHPLAN_ENT("AW", 0x76, 0x00, DEF , 1, 1), /* Aruba */ -+ COUNTRY_CHPLAN_ENT("AZ", 0x5E, 0x00, DEF , 1, 1), /* Azerbaijan */ -+ COUNTRY_CHPLAN_ENT("BA", 0x5E, 0x00, DEF , 1, 1), /* Bosnia & Herzegovina */ -+ COUNTRY_CHPLAN_ENT("BB", 0x76, 0x00, DEF , 1, 1), /* Barbados */ -+ COUNTRY_CHPLAN_ENT("BD", 0x5E, 0x00, DEF , 1, 1), /* Bangladesh */ -+ COUNTRY_CHPLAN_ENT("BE", 0x5E, 0x00, DEF , 1, 1), /* Belgium */ -+ COUNTRY_CHPLAN_ENT("BF", 0x5E, 0x00, DEF , 1, 1), /* Burkina Faso */ -+ COUNTRY_CHPLAN_ENT("BG", 0x5E, 0x00, DEF , 1, 1), /* Bulgaria */ -+ COUNTRY_CHPLAN_ENT("BH", 0x06, 0x00, DEF , 1, 1), /* Bahrain */ -+ COUNTRY_CHPLAN_ENT("BI", 0x3A, 0x00, DEF , 1, 1), /* Burundi */ -+ COUNTRY_CHPLAN_ENT("BJ", 0x3A, 0x00, DEF , 1, 1), /* Benin */ -+ COUNTRY_CHPLAN_ENT("BM", 0x76, 0x00, DEF , 1, 1), /* Bermuda (UK) */ -+ COUNTRY_CHPLAN_ENT("BN", 0x06, 0x00, DEF , 1, 1), /* Brunei */ -+ COUNTRY_CHPLAN_ENT("BO", 0x61, 0x00, DEF , 1, 1), /* Bolivia */ -+ COUNTRY_CHPLAN_ENT("BR", 0x62, 0x00, DEF , 1, 1), /* Brazil */ -+ COUNTRY_CHPLAN_ENT("BS", 0x76, 0x00, DEF , 1, 1), /* Bahamas */ -+ COUNTRY_CHPLAN_ENT("BT", 0x5E, 0x00, DEF , 1, 1), /* Bhutan */ -+ COUNTRY_CHPLAN_ENT("BV", 0x5E, 0x00, DEF , 1, 1), /* Bouvet Island (Norway) */ -+ COUNTRY_CHPLAN_ENT("BW", 0x5E, 0x00, DEF , 1, 1), /* Botswana */ -+ COUNTRY_CHPLAN_ENT("BY", 0x08, 0x00, DEF , 0, 1), /* Belarus */ -+ COUNTRY_CHPLAN_ENT("BZ", 0x76, 0x00, DEF , 1, 1), /* Belize */ -+ COUNTRY_CHPLAN_ENT("CA", 0x2B, 0x00, DEF , 1, 1), /* Canada */ -+ COUNTRY_CHPLAN_ENT("CC", 0x3A, 0x00, DEF , 1, 1), /* Cocos (Keeling) Islands (Australia) */ -+ COUNTRY_CHPLAN_ENT("CD", 0x3A, 0x00, DEF , 1, 1), /* Congo, Republic of the */ -+ COUNTRY_CHPLAN_ENT("CF", 0x3A, 0x00, DEF , 1, 1), /* Central African Republic */ -+ COUNTRY_CHPLAN_ENT("CG", 0x3A, 0x00, DEF , 1, 1), /* Congo, Democratic Republic of the. Zaire */ -+ COUNTRY_CHPLAN_ENT("CH", 0x5E, 0x00, DEF , 1, 1), /* Switzerland */ -+ COUNTRY_CHPLAN_ENT("CI", 0x42, 0x00, DEF , 1, 1), /* Cote d'Ivoire */ -+ COUNTRY_CHPLAN_ENT("CK", 0x5E, 0x00, DEF , 1, 1), /* Cook Islands */ -+ COUNTRY_CHPLAN_ENT("CL", 0x76, 0x00, CHILE , 1, 1), /* Chile */ -+ COUNTRY_CHPLAN_ENT("CM", 0x5E, 0x00, DEF , 1, 1), /* Cameroon */ -+ COUNTRY_CHPLAN_ENT("CN", 0x06, 0x00, CN , 1, 1), /* China */ -+ COUNTRY_CHPLAN_ENT("CO", 0x76, 0x00, DEF , 1, 1), /* Colombia */ -+ COUNTRY_CHPLAN_ENT("CR", 0x76, 0x00, DEF , 1, 1), /* Costa Rica */ -+ COUNTRY_CHPLAN_ENT("CV", 0x5E, 0x00, DEF , 1, 1), /* Cape Verde */ -+ COUNTRY_CHPLAN_ENT("CX", 0x03, 0x00, DEF , 1, 1), /* Christmas Island (Australia) */ -+ COUNTRY_CHPLAN_ENT("CY", 0x5E, 0x00, DEF , 1, 1), /* Cyprus */ -+ COUNTRY_CHPLAN_ENT("CZ", 0x5E, 0x00, DEF , 1, 1), /* Czech Republic */ -+ COUNTRY_CHPLAN_ENT("DE", 0x5E, 0x00, DEF , 1, 1), /* Germany */ -+ COUNTRY_CHPLAN_ENT("DJ", 0x3A, 0x00, DEF , 1, 1), /* Djibouti */ -+ COUNTRY_CHPLAN_ENT("DK", 0x5E, 0x00, DEF , 1, 1), /* Denmark */ -+ COUNTRY_CHPLAN_ENT("DM", 0x76, 0x00, DEF , 1, 1), /* Dominica */ -+ COUNTRY_CHPLAN_ENT("DO", 0x76, 0x00, DEF , 1, 1), /* Dominican Republic */ -+ COUNTRY_CHPLAN_ENT("DZ", 0x00, 0x00, DEF , 1, 1), /* Algeria */ -+ COUNTRY_CHPLAN_ENT("EC", 0x76, 0x00, DEF , 1, 1), /* Ecuador */ -+ COUNTRY_CHPLAN_ENT("EE", 0x5E, 0x00, DEF , 1, 1), /* Estonia */ -+ COUNTRY_CHPLAN_ENT("EG", 0x3C, 0x00, DEF , 1, 1), /* Egypt */ -+ COUNTRY_CHPLAN_ENT("EH", 0x3C, 0x00, DEF , 1, 1), /* Western Sahara */ -+ COUNTRY_CHPLAN_ENT("ER", 0x3A, 0x00, DEF , 1, 1), /* Eritrea */ -+ COUNTRY_CHPLAN_ENT("ES", 0x5E, 0x00, DEF , 1, 1), /* Spain, Canary Islands, Ceuta, Melilla */ -+ COUNTRY_CHPLAN_ENT("ET", 0x3A, 0x00, DEF , 1, 1), /* Ethiopia */ -+ COUNTRY_CHPLAN_ENT("FI", 0x5E, 0x00, DEF , 1, 1), /* Finland */ -+ COUNTRY_CHPLAN_ENT("FJ", 0x76, 0x00, DEF , 1, 1), /* Fiji */ -+ COUNTRY_CHPLAN_ENT("FK", 0x3A, 0x00, DEF , 1, 1), /* Falkland Islands (Islas Malvinas) (UK) */ -+ COUNTRY_CHPLAN_ENT("FM", 0x76, 0x00, DEF , 1, 1), /* Micronesia, Federated States of (USA) */ -+ COUNTRY_CHPLAN_ENT("FO", 0x3A, 0x00, DEF , 1, 1), /* Faroe Islands (Denmark) */ -+ COUNTRY_CHPLAN_ENT("FR", 0x5E, 0x00, DEF , 1, 1), /* France */ -+ COUNTRY_CHPLAN_ENT("GA", 0x5E, 0x00, DEF , 1, 1), /* Gabon */ -+ COUNTRY_CHPLAN_ENT("GB", 0x5E, 0x00, DEF , 1, 1), /* Great Britain (United Kingdom; England) */ -+ COUNTRY_CHPLAN_ENT("GD", 0x76, 0x00, DEF , 1, 1), /* Grenada */ -+ COUNTRY_CHPLAN_ENT("GE", 0x5E, 0x00, DEF , 1, 1), /* Georgia */ -+ COUNTRY_CHPLAN_ENT("GF", 0x3A, 0x00, DEF , 1, 1), /* French Guiana */ -+ COUNTRY_CHPLAN_ENT("GG", 0x5E, 0x00, DEF , 1, 1), /* Guernsey (UK) */ -+ COUNTRY_CHPLAN_ENT("GH", 0x5E, 0x00, DEF , 1, 1), /* Ghana */ -+ COUNTRY_CHPLAN_ENT("GI", 0x3A, 0x00, DEF , 1, 1), /* Gibraltar (UK) */ -+ COUNTRY_CHPLAN_ENT("GL", 0x5E, 0x00, DEF , 1, 1), /* Greenland (Denmark) */ -+ COUNTRY_CHPLAN_ENT("GM", 0x3A, 0x00, DEF , 1, 1), /* Gambia */ -+ COUNTRY_CHPLAN_ENT("GN", 0x3A, 0x00, DEF , 1, 1), /* Guinea */ -+ COUNTRY_CHPLAN_ENT("GP", 0x3A, 0x00, DEF , 1, 1), /* Guadeloupe (France) */ -+ COUNTRY_CHPLAN_ENT("GQ", 0x5E, 0x00, DEF , 1, 1), /* Equatorial Guinea */ -+ COUNTRY_CHPLAN_ENT("GR", 0x5E, 0x00, DEF , 1, 1), /* Greece */ -+ COUNTRY_CHPLAN_ENT("GS", 0x3A, 0x00, DEF , 1, 1), /* South Georgia and the Sandwich Islands (UK) */ -+ COUNTRY_CHPLAN_ENT("GT", 0x76, 0x00, DEF , 1, 1), /* Guatemala */ -+ COUNTRY_CHPLAN_ENT("GU", 0x76, 0x00, DEF , 1, 1), /* Guam (USA) */ -+ COUNTRY_CHPLAN_ENT("GW", 0x3A, 0x00, DEF , 1, 1), /* Guinea-Bissau */ -+ COUNTRY_CHPLAN_ENT("GY", 0x44, 0x00, DEF , 1, 1), /* Guyana */ -+ COUNTRY_CHPLAN_ENT("HK", 0x5E, 0x00, DEF , 1, 1), /* Hong Kong */ -+ COUNTRY_CHPLAN_ENT("HM", 0x03, 0x00, DEF , 1, 1), /* Heard and McDonald Islands (Australia) */ -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 0x00, DEF , 1, 1), /* Honduras */ -+ COUNTRY_CHPLAN_ENT("HR", 0x5E, 0x00, DEF , 1, 1), /* Croatia */ -+ COUNTRY_CHPLAN_ENT("HT", 0x76, 0x00, DEF , 0, 1), /* Haiti */ -+ COUNTRY_CHPLAN_ENT("HU", 0x5E, 0x00, DEF , 1, 1), /* Hungary */ -+ COUNTRY_CHPLAN_ENT("ID", 0x5D, 0x00, DEF , 1, 1), /* Indonesia */ -+ COUNTRY_CHPLAN_ENT("IE", 0x5E, 0x00, DEF , 1, 1), /* Ireland */ -+ COUNTRY_CHPLAN_ENT("IL", 0x5E, 0x00, DEF , 1, 1), /* Israel */ -+ COUNTRY_CHPLAN_ENT("IM", 0x3A, 0x00, DEF , 1, 1), /* Isle of Man (UK) */ -+ COUNTRY_CHPLAN_ENT("IN", 0x06, 0x00, DEF , 1, 1), /* India */ -+ COUNTRY_CHPLAN_ENT("IO", 0x3A, 0x00, DEF , 1, 1), /* British Indian Ocean Territory (UK) */ -+ COUNTRY_CHPLAN_ENT("IQ", 0x05, 0x00, DEF , 1, 1), /* Iraq */ -+ COUNTRY_CHPLAN_ENT("IR", 0x3A, 0x00, DEF , 0, 0), /* Iran */ -+ COUNTRY_CHPLAN_ENT("IS", 0x5E, 0x00, DEF , 1, 1), /* Iceland */ -+ COUNTRY_CHPLAN_ENT("IT", 0x5E, 0x00, DEF , 1, 1), /* Italy */ -+ COUNTRY_CHPLAN_ENT("JE", 0x3A, 0x00, DEF , 1, 1), /* Jersey (UK) */ -+ COUNTRY_CHPLAN_ENT("JM", 0x76, 0x00, DEF , 1, 1), /* Jamaica */ -+ COUNTRY_CHPLAN_ENT("JO", 0x05, 0x00, DEF , 1, 1), /* Jordan */ -+ COUNTRY_CHPLAN_ENT("JP", 0x7D, 0x00, DEF , 1, 1), /* Japan- Telec */ -+ COUNTRY_CHPLAN_ENT("KE", 0x5E, 0x00, DEF , 1, 1), /* Kenya */ -+ COUNTRY_CHPLAN_ENT("KG", 0x5E, 0x00, DEF , 1, 1), /* Kyrgyzstan */ -+ COUNTRY_CHPLAN_ENT("KH", 0x5E, 0x00, DEF , 1, 1), /* Cambodia */ -+ COUNTRY_CHPLAN_ENT("KI", 0x5E, 0x00, DEF , 1, 1), /* Kiribati */ -+ COUNTRY_CHPLAN_ENT("KM", 0x3A, 0x00, DEF , 1, 1), /* Comoros */ -+ COUNTRY_CHPLAN_ENT("KN", 0x76, 0x00, DEF , 1, 1), /* Saint Kitts and Nevis */ -+ COUNTRY_CHPLAN_ENT("KR", 0x4B, 0x00, DEF , 1, 1), /* South Korea */ -+ COUNTRY_CHPLAN_ENT("KW", 0x5E, 0x00, DEF , 1, 1), /* Kuwait */ -+ COUNTRY_CHPLAN_ENT("KY", 0x76, 0x00, DEF , 1, 1), /* Cayman Islands (UK) */ -+ COUNTRY_CHPLAN_ENT("KZ", 0x5E, 0x00, DEF , 1, 1), /* Kazakhstan */ -+ COUNTRY_CHPLAN_ENT("LA", 0x5E, 0x00, DEF , 1, 1), /* Laos */ -+ COUNTRY_CHPLAN_ENT("LB", 0x5E, 0x00, DEF , 1, 1), /* Lebanon */ -+ COUNTRY_CHPLAN_ENT("LC", 0x76, 0x00, DEF , 1, 1), /* Saint Lucia */ -+ COUNTRY_CHPLAN_ENT("LI", 0x5E, 0x00, DEF , 1, 1), /* Liechtenstein */ -+ COUNTRY_CHPLAN_ENT("LK", 0x5E, 0x00, DEF , 1, 1), /* Sri Lanka */ -+ COUNTRY_CHPLAN_ENT("LR", 0x5E, 0x00, DEF , 1, 1), /* Liberia */ -+ COUNTRY_CHPLAN_ENT("LS", 0x5E, 0x00, DEF , 1, 1), /* Lesotho */ -+ COUNTRY_CHPLAN_ENT("LT", 0x5E, 0x00, DEF , 1, 1), /* Lithuania */ -+ COUNTRY_CHPLAN_ENT("LU", 0x5E, 0x00, DEF , 1, 1), /* Luxembourg */ -+ COUNTRY_CHPLAN_ENT("LV", 0x5E, 0x00, DEF , 1, 1), /* Latvia */ -+ COUNTRY_CHPLAN_ENT("LY", 0x5E, 0x00, DEF , 1, 1), /* Libya */ -+ COUNTRY_CHPLAN_ENT("MA", 0x3C, 0x00, DEF , 1, 1), /* Morocco */ -+ COUNTRY_CHPLAN_ENT("MC", 0x5E, 0x00, DEF , 1, 1), /* Monaco */ -+ COUNTRY_CHPLAN_ENT("MD", 0x5E, 0x00, DEF , 1, 1), /* Moldova */ -+ COUNTRY_CHPLAN_ENT("ME", 0x3A, 0x00, DEF , 1, 1), /* Montenegro */ -+ COUNTRY_CHPLAN_ENT("MF", 0x76, 0x00, DEF , 1, 1), /* Saint Martin */ -+ COUNTRY_CHPLAN_ENT("MG", 0x5E, 0x00, DEF , 1, 1), /* Madagascar */ -+ COUNTRY_CHPLAN_ENT("MH", 0x76, 0x00, DEF , 1, 1), /* Marshall Islands (USA) */ -+ COUNTRY_CHPLAN_ENT("MK", 0x3A, 0x00, DEF , 1, 1), /* Republic of Macedonia (FYROM) */ -+ COUNTRY_CHPLAN_ENT("ML", 0x5E, 0x00, DEF , 1, 1), /* Mali */ -+ COUNTRY_CHPLAN_ENT("MM", 0x3A, 0x00, DEF , 1, 1), /* Burma (Myanmar) */ -+ COUNTRY_CHPLAN_ENT("MN", 0x5E, 0x00, DEF , 1, 1), /* Mongolia */ -+ COUNTRY_CHPLAN_ENT("MO", 0x5E, 0x00, DEF , 1, 1), /* Macau */ -+ COUNTRY_CHPLAN_ENT("MP", 0x76, 0x00, DEF , 1, 1), /* Northern Mariana Islands (USA) */ -+ COUNTRY_CHPLAN_ENT("MQ", 0x3A, 0x00, DEF , 1, 1), /* Martinique (France) */ -+ COUNTRY_CHPLAN_ENT("MR", 0x5E, 0x00, DEF , 1, 1), /* Mauritania */ -+ COUNTRY_CHPLAN_ENT("MS", 0x3A, 0x00, DEF , 1, 1), /* Montserrat (UK) */ -+ COUNTRY_CHPLAN_ENT("MT", 0x5E, 0x00, DEF , 1, 1), /* Malta */ -+ COUNTRY_CHPLAN_ENT("MU", 0x5E, 0x00, DEF , 1, 1), /* Mauritius */ -+ COUNTRY_CHPLAN_ENT("MV", 0x3C, 0x00, DEF , 1, 1), /* Maldives */ -+ COUNTRY_CHPLAN_ENT("MW", 0x5E, 0x00, DEF , 1, 1), /* Malawi */ -+ COUNTRY_CHPLAN_ENT("MX", 0x4D, 0x00, DEF , 1, 1), /* Mexico */ -+ COUNTRY_CHPLAN_ENT("MY", 0x07, 0x00, DEF , 1, 1), /* Malaysia */ -+ COUNTRY_CHPLAN_ENT("MZ", 0x5E, 0x00, DEF , 1, 1), /* Mozambique */ -+ COUNTRY_CHPLAN_ENT("NA", 0x5E, 0x00, DEF , 1, 1), /* Namibia */ -+ COUNTRY_CHPLAN_ENT("NC", 0x3A, 0x00, DEF , 1, 1), /* New Caledonia */ -+ COUNTRY_CHPLAN_ENT("NE", 0x5E, 0x00, DEF , 1, 1), /* Niger */ -+ COUNTRY_CHPLAN_ENT("NF", 0x03, 0x00, DEF , 1, 1), /* Norfolk Island (Australia) */ -+ COUNTRY_CHPLAN_ENT("NG", 0x75, 0x00, DEF , 1, 1), /* Nigeria */ -+ COUNTRY_CHPLAN_ENT("NI", 0x76, 0x00, DEF , 1, 1), /* Nicaragua */ -+ COUNTRY_CHPLAN_ENT("NL", 0x5E, 0x00, DEF , 1, 1), /* Netherlands */ -+ COUNTRY_CHPLAN_ENT("NO", 0x5E, 0x00, DEF , 1, 1), /* Norway */ -+ COUNTRY_CHPLAN_ENT("NP", 0x06, 0x00, DEF , 1, 1), /* Nepal */ -+ COUNTRY_CHPLAN_ENT("NR", 0x3A, 0x00, DEF , 1, 1), /* Nauru */ -+ COUNTRY_CHPLAN_ENT("NU", 0x03, 0x00, DEF , 1, 1), /* Niue */ -+ COUNTRY_CHPLAN_ENT("NZ", 0x03, 0x00, DEF , 1, 1), /* New Zealand */ -+ COUNTRY_CHPLAN_ENT("OM", 0x5E, 0x00, DEF , 1, 1), /* Oman */ -+ COUNTRY_CHPLAN_ENT("PA", 0x76, 0x00, DEF , 1, 1), /* Panama */ -+ COUNTRY_CHPLAN_ENT("PE", 0x76, 0x00, DEF , 1, 1), /* Peru */ -+ COUNTRY_CHPLAN_ENT("PF", 0x3A, 0x00, DEF , 1, 1), /* French Polynesia (France) */ -+ COUNTRY_CHPLAN_ENT("PG", 0x5E, 0x00, DEF , 1, 1), /* Papua New Guinea */ -+ COUNTRY_CHPLAN_ENT("PH", 0x5E, 0x00, DEF , 1, 1), /* Philippines */ -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 0x00, DEF , 1, 1), /* Pakistan */ -+ COUNTRY_CHPLAN_ENT("PL", 0x5E, 0x00, DEF , 1, 1), /* Poland */ -+ COUNTRY_CHPLAN_ENT("PM", 0x3A, 0x00, DEF , 1, 1), /* Saint Pierre and Miquelon (France) */ -+ COUNTRY_CHPLAN_ENT("PR", 0x76, 0x00, DEF , 1, 1), /* Puerto Rico */ -+ COUNTRY_CHPLAN_ENT("PS", 0x5E, 0x00, DEF , 1, 1), /* Palestine */ -+ COUNTRY_CHPLAN_ENT("PT", 0x5E, 0x00, DEF , 1, 1), /* Portugal */ -+ COUNTRY_CHPLAN_ENT("PW", 0x76, 0x00, DEF , 1, 1), /* Palau */ -+ COUNTRY_CHPLAN_ENT("PY", 0x76, 0x00, DEF , 1, 1), /* Paraguay */ -+ COUNTRY_CHPLAN_ENT("QA", 0x5E, 0x00, QATAR , 1, 1), /* Qatar */ -+ COUNTRY_CHPLAN_ENT("RE", 0x3A, 0x00, DEF , 1, 1), /* Reunion (France) */ -+ COUNTRY_CHPLAN_ENT("RO", 0x5E, 0x00, DEF , 1, 1), /* Romania */ -+ COUNTRY_CHPLAN_ENT("RS", 0x5E, 0x00, DEF , 1, 1), /* Serbia */ -+ COUNTRY_CHPLAN_ENT("RU", 0x09, 0x00, DEF , 1, 1), /* Russia(fac/gost), Kaliningrad */ -+ COUNTRY_CHPLAN_ENT("RW", 0x5E, 0x00, DEF , 1, 1), /* Rwanda */ -+ COUNTRY_CHPLAN_ENT("SA", 0x5E, 0x00, DEF , 1, 1), /* Saudi Arabia */ -+ COUNTRY_CHPLAN_ENT("SB", 0x3A, 0x00, DEF , 1, 1), /* Solomon Islands */ -+ COUNTRY_CHPLAN_ENT("SC", 0x76, 0x00, DEF , 1, 1), /* Seychelles */ -+ COUNTRY_CHPLAN_ENT("SE", 0x5E, 0x00, DEF , 1, 1), /* Sweden */ -+ COUNTRY_CHPLAN_ENT("SG", 0x5E, 0x00, DEF , 1, 1), /* Singapore */ -+ COUNTRY_CHPLAN_ENT("SH", 0x3A, 0x00, DEF , 1, 1), /* Saint Helena (UK) */ -+ COUNTRY_CHPLAN_ENT("SI", 0x5E, 0x00, DEF , 1, 1), /* Slovenia */ -+ COUNTRY_CHPLAN_ENT("SJ", 0x3A, 0x00, DEF , 1, 1), /* Svalbard (Norway) */ -+ COUNTRY_CHPLAN_ENT("SK", 0x5E, 0x00, DEF , 1, 1), /* Slovakia */ -+ COUNTRY_CHPLAN_ENT("SL", 0x5E, 0x00, DEF , 1, 1), /* Sierra Leone */ -+ COUNTRY_CHPLAN_ENT("SM", 0x3A, 0x00, DEF , 1, 1), /* San Marino */ -+ COUNTRY_CHPLAN_ENT("SN", 0x3A, 0x00, DEF , 1, 1), /* Senegal */ -+ COUNTRY_CHPLAN_ENT("SO", 0x3A, 0x00, DEF , 1, 1), /* Somalia */ -+ COUNTRY_CHPLAN_ENT("SR", 0x74, 0x00, DEF , 1, 1), /* Suriname */ -+ COUNTRY_CHPLAN_ENT("ST", 0x76, 0x00, DEF , 1, 1), /* Sao Tome and Principe */ -+ COUNTRY_CHPLAN_ENT("SV", 0x76, 0x00, DEF , 1, 1), /* El Salvador */ -+ COUNTRY_CHPLAN_ENT("SX", 0x76, 0x00, DEF , 1, 1), /* Sint Marteen */ -+ COUNTRY_CHPLAN_ENT("SZ", 0x5E, 0x00, DEF , 1, 1), /* Swaziland */ -+ COUNTRY_CHPLAN_ENT("TC", 0x3A, 0x00, DEF , 1, 1), /* Turks and Caicos Islands (UK) */ -+ COUNTRY_CHPLAN_ENT("TD", 0x3A, 0x00, DEF , 1, 1), /* Chad */ -+ COUNTRY_CHPLAN_ENT("TF", 0x3A, 0x00, DEF , 1, 1), /* French Southern and Antarctic Lands (FR Southern Territories) */ -+ COUNTRY_CHPLAN_ENT("TG", 0x5E, 0x00, DEF , 1, 1), /* Togo */ -+ COUNTRY_CHPLAN_ENT("TH", 0x5E, 0x00, DEF , 1, 1), /* Thailand */ -+ COUNTRY_CHPLAN_ENT("TJ", 0x5E, 0x00, DEF , 1, 1), /* Tajikistan */ -+ COUNTRY_CHPLAN_ENT("TK", 0x03, 0x00, DEF , 1, 1), /* Tokelau */ -+ COUNTRY_CHPLAN_ENT("TM", 0x3A, 0x00, DEF , 1, 1), /* Turkmenistan */ -+ COUNTRY_CHPLAN_ENT("TN", 0x04, 0x00, DEF , 1, 1), /* Tunisia */ -+ COUNTRY_CHPLAN_ENT("TO", 0x3A, 0x00, DEF , 1, 1), /* Tonga */ -+ COUNTRY_CHPLAN_ENT("TR", 0x5E, 0x00, DEF , 1, 1), /* Turkey, Northern Cyprus */ -+ COUNTRY_CHPLAN_ENT("TT", 0x76, 0x00, DEF , 1, 1), /* Trinidad & Tobago */ -+ COUNTRY_CHPLAN_ENT("TV", 0x21, 0x00, DEF , 0, 0), /* Tuvalu */ -+ COUNTRY_CHPLAN_ENT("TW", 0x76, 0x00, DEF , 1, 1), /* Taiwan */ -+ COUNTRY_CHPLAN_ENT("TZ", 0x5E, 0x00, DEF , 1, 1), /* Tanzania */ -+ COUNTRY_CHPLAN_ENT("UA", 0x5E, 0x00, UKRAINE, 1, 1), /* Ukraine */ -+ COUNTRY_CHPLAN_ENT("UG", 0x3A, 0x00, DEF , 1, 1), /* Uganda */ -+ COUNTRY_CHPLAN_ENT("US", 0x76, 0x7F, DEF , 1, 1), /* United States of America (USA) */ -+ COUNTRY_CHPLAN_ENT("UY", 0x30, 0x00, DEF , 1, 1), /* Uruguay */ -+ COUNTRY_CHPLAN_ENT("UZ", 0x3C, 0x00, DEF , 1, 1), /* Uzbekistan */ -+ COUNTRY_CHPLAN_ENT("VA", 0x3A, 0x00, DEF , 1, 1), /* Holy See (Vatican City) */ -+ COUNTRY_CHPLAN_ENT("VC", 0x76, 0x00, DEF , 1, 1), /* Saint Vincent and the Grenadines */ -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 0x00, DEF , 1, 1), /* Venezuela */ -+ COUNTRY_CHPLAN_ENT("VG", 0x76, 0x00, DEF , 1, 1), /* British Virgin Islands (UK) */ -+ COUNTRY_CHPLAN_ENT("VI", 0x76, 0x00, DEF , 1, 1), /* United States Virgin Islands (USA) */ -+ COUNTRY_CHPLAN_ENT("VN", 0x5E, 0x00, DEF , 1, 1), /* Vietnam */ -+ COUNTRY_CHPLAN_ENT("VU", 0x26, 0x00, DEF , 1, 1), /* Vanuatu */ -+ COUNTRY_CHPLAN_ENT("WF", 0x3A, 0x00, DEF , 1, 1), /* Wallis and Futuna (France) */ -+ COUNTRY_CHPLAN_ENT("WS", 0x76, 0x00, DEF , 1, 1), /* Samoa */ -+ COUNTRY_CHPLAN_ENT("XK", 0x3A, 0x00, DEF , 1, 1), /* Kosovo */ -+ COUNTRY_CHPLAN_ENT("YE", 0x3A, 0x00, DEF , 1, 1), /* Yemen */ -+ COUNTRY_CHPLAN_ENT("YT", 0x5E, 0x00, DEF , 1, 1), /* Mayotte (France) */ -+ COUNTRY_CHPLAN_ENT("ZA", 0x5E, 0x00, DEF , 1, 1), /* South Africa */ -+ COUNTRY_CHPLAN_ENT("ZM", 0x5E, 0x00, DEF , 1, 1), /* Zambia */ -+ COUNTRY_CHPLAN_ENT("ZW", 0x5E, 0x00, DEF , 1, 1), /* Zimbabwe */ -+}; -+#endif /* CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP or RTW_DEF_MODULE_REGULATORY_CERT or newest */ -+ -+/* -+* rtw_get_chplan_worldwide - -+* @ent: the buf to copy country_chplan entry content -+*/ -+void rtw_get_chplan_worldwide(struct country_chplan *ent) -+{ -+ _rtw_memcpy(ent, &world_wide_chplan, sizeof(*ent)); -+} -+ -+/* -+* rtw_get_chplan_from_country - -+* @country_code: string of country code -+* @ent: the buf to copy country_chplan entry content -+* -+* Return _TRUE or _FALSE when unsupported country_code is given -+*/ -+bool rtw_get_chplan_from_country(const char *country_code, struct country_chplan *ent) -+{ -+ 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]); -+ -+#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP -+ map = CUSTOMIZED_country_chplan_map; -+ map_sz = sizeof(CUSTOMIZED_country_chplan_map) / sizeof(struct country_chplan); -+#elif RTW_DEF_MODULE_REGULATORY_CERT -+ map_sz = rtw_def_module_country_chplan_map(&map); -+#else -+ map = country_chplan_map; -+ map_sz = sizeof(country_chplan_map) / sizeof(struct country_chplan); -+#endif -+ -+ for (i = 0; i < map_sz; i++) { -+ if (strncmp(code, map[i].alpha2, 2) == 0) { -+ if (ent) -+ _rtw_memcpy(ent, &map[i], sizeof(*ent)); -+ return _TRUE; -+ } -+ } -+ -+ return _FALSE; -+} -+ -+void rtw_chplan_ioctl_input_mapping(u16 *chplan, u16 *chplan_6g) -+{ -+ if (chplan) { -+ if (*chplan == RTW_CHPLAN_IOCTL_UNSPECIFIED) -+ *chplan = RTW_CHPLAN_UNSPECIFIED; -+ else if (*chplan == RTW_CHPLAN_IOCTL_NULL) -+ *chplan = RTW_CHPLAN_NULL; -+ } -+ -+ if (chplan_6g) { -+ if (*chplan_6g == RTW_CHPLAN_IOCTL_UNSPECIFIED) -+ *chplan_6g = RTW_CHPLAN_6G_UNSPECIFIED; -+ else if (*chplan_6g == RTW_CHPLAN_IOCTL_NULL) -+ *chplan_6g = RTW_CHPLAN_6G_NULL; -+ } -+} -+ -+bool rtw_chplan_ids_is_world_wide(u8 chplan, u8 chplan_6g) -+{ -+ return !(chplan == RTW_CHPLAN_NULL -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ && chplan_6g == RTW_CHPLAN_6G_NULL -+ #endif -+ ) -+ && (chplan == RTW_CHPLAN_WORLDWIDE || chplan == RTW_CHPLAN_NULL) -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ && (chplan_6g == RTW_CHPLAN_6G_WORLDWIDE || chplan_6g == RTW_CHPLAN_6G_NULL) -+ #endif -+ ; -+} -+ -+/* -+ * Check if the @param ch, bw, offset is valid for the given @param ent -+ * @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_country_chplan_is_chbw_valid(struct country_chplan *ent, BAND_TYPE band, u8 ch, u8 bw, u8 offset -+ , bool allow_primary_passive, bool allow_passive, struct registry_priv *regsty) -+{ -+ u8 chplan_6g = RTW_CHPLAN_6G_NULL; -+ u8 valid = 0; -+ -+ if (bw >= CHANNEL_WIDTH_80 && !COUNTRY_CHPLAN_EN_11AC(ent)) -+ goto exit; -+ -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ chplan_6g = ent->chplan_6g; -+ #endif -+ -+ valid = rtw_chplan_is_chbw_valid(ent->chplan, chplan_6g, band, ch, bw, offset -+ , allow_primary_passive, allow_passive, regsty); -+ -+exit: -+ return valid; -+} -+ -+static void rtw_country_chplan_get_edcca_modes(const struct country_chplan *ent, u8 modes[]) -+{ -+ modes[BAND_ON_2_4G] = -+ ent->edcca_mode_2g_override != RTW_EDCCA_DEF ? ent->edcca_mode_2g_override : -+ rtw_regd_to_edcca_mode(rtw_chplan_get_default_regd_2g(ent->chplan)); -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ modes[BAND_ON_5G] = -+ ent->edcca_mode_5g_override != RTW_EDCCA_DEF ? ent->edcca_mode_5g_override : -+ rtw_regd_to_edcca_mode(rtw_chplan_get_default_regd_5g(ent->chplan)); -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ modes[BAND_ON_6G] = -+ ent->edcca_mode_6g_override != RTW_EDCCA_DEF ? ent->edcca_mode_6g_override : -+ rtw_regd_to_edcca_mode(rtw_chplan_get_default_regd_6g(ent->chplan_6g)); -+ #endif -+} -+ -+static void rtw_country_chplan_get_txpwr_lmts(const struct country_chplan *ent, u8 txpwr_lmt[]) -+{ -+ txpwr_lmt[BAND_ON_2_4G] = -+ ent->txpwr_lmt_override != TXPWR_LMT_DEF ? ent->txpwr_lmt_override : -+ rtw_regd_to_txpwr_lmt(rtw_chplan_get_default_regd_2g(ent->chplan)); -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ txpwr_lmt[BAND_ON_5G] = -+ ent->txpwr_lmt_override != TXPWR_LMT_DEF ? ent->txpwr_lmt_override : -+ rtw_regd_to_txpwr_lmt(rtw_chplan_get_default_regd_5g(ent->chplan)); -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ txpwr_lmt[BAND_ON_6G] = -+ ent->txpwr_lmt_override != TXPWR_LMT_DEF ? ent->txpwr_lmt_override : -+ rtw_regd_to_txpwr_lmt(rtw_chplan_get_default_regd_6g(ent->chplan_6g)); -+ #endif -+} -+ -+#ifdef CONFIG_80211D -+const char *const _cis_status_str[] = { -+ [COUNTRY_IE_SLAVE_NOCOUNTRY] = "NOCOUNTRY", -+ [COUNTRY_IE_SLAVE_UNKNOWN] = "UNKNOWN", -+ [COUNTRY_IE_SLAVE_OPCH_NOEXIST] = "OPCH_NOEXIST", -+ [COUNTRY_IE_SLAVE_APPLICABLE] = "APPLICABLE", -+ [COUNTRY_IE_SLAVE_STATUS_NUM] = "INVALID", -+}; -+ -+void dump_country_ie_slave_records(void *sel, struct rf_ctl_t *rfctl, bool skip_noset) -+{ -+ int i; -+ -+ RTW_PRINT_SEL(sel, " %-6s %-4s %-4s %s\n", "alpha2", "band", "opch", "status"); -+ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) { -+ if (skip_noset && strncmp(rfctl->cisr[i].alpha2, "\x00\x00", 2) == 0) -+ continue; -+ RTW_PRINT_SEL(sel, "%c%d "ALPHA2_FMT" %4s %4u %s\n" -+ , i == rfctl->effected_cisr_id ? '*' : ' ', i, ALPHA2_ARG(rfctl->cisr[i].alpha2) -+ , band_str(rfctl->cisr[i].band), rfctl->cisr[i].opch, cis_status_str(rfctl->cisr[i].status)); -+ } -+} -+ -+enum country_ie_slave_status rtw_get_chplan_from_recv_country_ie(_adapter *adapter -+ , BAND_TYPE band, u8 opch, const u8 *country_ie, struct country_chplan *ent -+ , struct country_ie_slave_record *cisr, const char *caller_msg) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ const char *country_code = country_ie ? country_ie + 2 : NULL; -+ u8 chplan_6g = RTW_CHPLAN_6G_NULL; -+ enum country_ie_slave_status ret; -+ -+ _rtw_memset(ent, 0, sizeof(*ent)); -+ -+ if (!country_code || strncmp(country_code, "XX", 2) == 0) { -+ if (caller_msg && country_code) -+ RTW_INFO("%s("ADPT_FMT") noncountry \"XX\"\n", caller_msg, ADPT_ARG(adapter)); -+ ret = COUNTRY_IE_SLAVE_NOCOUNTRY; -+ goto exit; -+ } -+ -+ if (!rtw_get_chplan_from_country(country_code, ent)) { -+ if (caller_msg) { -+ if (is_alpha(country_code[0]) == _FALSE || is_alpha(country_code[1]) == _FALSE) { -+ RTW_INFO("%s("ADPT_FMT") country_code is not alpha2, use world wide instead\n" -+ , caller_msg, ADPT_ARG(adapter)); -+ } else { -+ RTW_INFO("%s("ADPT_FMT") unsupported country_code:\"%c%c\", use world wide\n" -+ , caller_msg, ADPT_ARG(adapter), country_code[0], country_code[1]); -+ } -+ } -+ rtw_get_chplan_worldwide(ent); -+ ret = COUNTRY_IE_SLAVE_UNKNOWN; -+ goto exit; -+ } -+ -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ chplan_6g = ent->chplan_6g; -+ #endif -+ -+ if (!rtw_chplan_is_chbw_valid(ent->chplan, chplan_6g, band, opch -+ , CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE, 1, 1, regsty) -+ ) { -+ u8 edcca_modes[BAND_MAX]; -+ -+ if (caller_msg) { -+ RTW_INFO("%s("ADPT_FMT") \"%c%c\" no band:%s ch:%u, use world wide with ori edcca modes\n" -+ , caller_msg, ADPT_ARG(adapter), country_code[0], country_code[1], band_str(band), opch); -+ } -+ rtw_country_chplan_get_edcca_modes(ent, edcca_modes); -+ rtw_get_chplan_worldwide(ent); -+ ent->edcca_mode_2g_override = edcca_modes[BAND_ON_2_4G]; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ ent->edcca_mode_5g_override = edcca_modes[BAND_ON_5G]; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ ent->edcca_mode_6g_override = edcca_modes[BAND_ON_6G]; -+ #endif -+ ret = COUNTRY_IE_SLAVE_OPCH_NOEXIST; -+ goto exit; -+ } -+ -+ if (caller_msg) { -+ RTW_INFO("%s("ADPT_FMT") country_code:\"%c%c\" is applicapble\n" -+ , caller_msg, ADPT_ARG(adapter), country_code[0], country_code[1]); -+ } -+ ret = COUNTRY_IE_SLAVE_APPLICABLE; -+ -+exit: -+ if (cisr) { -+ _rtw_memcpy(cisr->alpha2, country_code ? country_code : "\x00\x00", 2); -+ cisr->band = band; -+ cisr->opch = opch; -+ cisr->status = ret; -+ } -+ -+ return ret; -+} -+ -+enum country_ie_slave_status rtw_get_chplan_from_cisrs(struct rf_ctl_t *rfctl -+ , struct country_chplan *ent, const char *caller_msg) -+{ -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ _adapter *adapter = dvobj->padapters[rfctl->effected_cisr_id]; -+ struct country_ie_slave_record *cisr = &rfctl->cisr[rfctl->effected_cisr_id]; -+ const u8 country_ie[4] = {WLAN_EID_COUNTRY, 2, cisr->alpha2[0], cisr->alpha2[1]}; -+ enum country_ie_slave_status status; -+ -+ status = rtw_get_chplan_from_recv_country_ie(adapter, cisr->band, cisr->opch, country_ie, ent, NULL, caller_msg); -+ rtw_warn_on(cisr->status != status); -+ -+ return status; -+} -+#endif /* CONFIG_80211D */ -+ -+void dump_country_chplan(void *sel, const struct country_chplan *ent, bool regd_info) -+{ -+ char buf[16]; -+ char *pos = buf; -+ -+ if (ent->chplan == RTW_CHPLAN_UNSPECIFIED) -+ pos += sprintf(pos, "NA"); -+ else -+ pos += sprintf(pos, "0x%02X", ent->chplan); -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ if (ent->chplan_6g == RTW_CHPLAN_6G_UNSPECIFIED) -+ pos += sprintf(pos, " NA"); -+ else -+ pos += sprintf(pos, " 0x%02X", ent->chplan_6g); -+#endif -+ -+ RTW_PRINT_SEL(sel, "\"%c%c\", %s" -+ , ent->alpha2[0], ent->alpha2[1], buf); -+ -+ if (regd_info) { -+ u8 edcca_modes[BAND_MAX]; -+ u8 txpwr_lmts[BAND_MAX]; -+ -+ rtw_country_chplan_get_edcca_modes(ent, edcca_modes); -+ _RTW_PRINT_SEL(sel, " {%-6s", rtw_edcca_mode_str(edcca_modes[BAND_ON_2_4G])); -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ _RTW_PRINT_SEL(sel, " %-6s", rtw_edcca_mode_str(edcca_modes[BAND_ON_5G])); -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ _RTW_PRINT_SEL(sel, " %-6s", rtw_edcca_mode_str(edcca_modes[BAND_ON_6G])); -+ #endif -+ _RTW_PRINT_SEL(sel, "}"); -+ -+ rtw_country_chplan_get_txpwr_lmts(ent, txpwr_lmts); -+ _RTW_PRINT_SEL(sel, " {%-7s", txpwr_lmt_str(txpwr_lmts[BAND_ON_2_4G])); -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ _RTW_PRINT_SEL(sel, " %-7s", txpwr_lmt_str(txpwr_lmts[BAND_ON_5G])); -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ _RTW_PRINT_SEL(sel, " %-7s", txpwr_lmt_str(txpwr_lmts[BAND_ON_6G])); -+ #endif -+ _RTW_PRINT_SEL(sel, "}"); -+ } -+ -+ _RTW_PRINT_SEL(sel, " %s", COUNTRY_CHPLAN_EN_11AX(ent) ? "ax" : " "); -+ _RTW_PRINT_SEL(sel, " %s", COUNTRY_CHPLAN_EN_11AC(ent) ? "ac" : " "); -+ -+ _RTW_PRINT_SEL(sel, "\n"); -+} -+ -+void dump_country_chplan_map(void *sel, bool regd_info) -+{ -+ 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 -+ -+ rtw_get_chplan_worldwide(&ent); -+ dump_country_chplan(sel, &ent, regd_info); -+ -+ for (code[0] = 'A'; code[0] <= 'Z'; code[0]++) { -+ for (code[1] = 'A'; code[1] <= 'Z'; code[1]++) { -+ if (!rtw_get_chplan_from_country(code, &ent)) -+ continue; -+ -+ dump_country_chplan(sel, &ent, regd_info); -+ } -+ } -+} -+ -+void dump_country_list(void *sel) -+{ -+ u8 code[2]; -+ -+ RTW_PRINT_SEL(sel, "%s ", WORLDWIDE_ALPHA2); -+ -+ for (code[0] = 'A'; code[0] <= 'Z'; code[0]++) { -+ for (code[1] = 'A'; code[1] <= 'Z'; code[1]++) { -+ if (!rtw_get_chplan_from_country(code, NULL)) -+ continue; -+ _RTW_PRINT_SEL(sel, "%c%c ", code[0], code[1]); -+ } -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+} -+ -+void dump_chplan_id_list(void *sel) -+{ -+ u8 first = 1; -+ int i; -+ -+ for (i = 0; i < RTW_ChannelPlanMap_size; i++) { -+ if (!rtw_is_channel_plan_valid(i)) -+ continue; -+ -+ if (first) { -+ RTW_PRINT_SEL(sel, "0x%02X ", i); -+ first = 0; -+ } else -+ _RTW_PRINT_SEL(sel, "0x%02X ", i); -+ } -+ if (first == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+} -+ -+void dump_chplan_country_list(void *sel) -+{ -+ int i; -+ -+ for (i = 0; i < RTW_ChannelPlanMap_size; i++) { -+ struct country_chplan ent; -+ u8 code[2]; -+ u8 first; -+ -+ if (!rtw_is_channel_plan_valid(i)) -+ continue; -+ -+ first = 1; -+ for (code[0] = 'A'; code[0] <= 'Z'; code[0]++) { -+ for (code[1] = 'A'; code[1] <= 'Z'; code[1]++) { -+ if (!rtw_get_chplan_from_country(code, &ent) || ent.chplan != i) -+ continue; -+ -+ if (first) { -+ RTW_PRINT_SEL(sel, "0x%02X %c%c ", i, code[0], code[1]); -+ first = 0; -+ } else -+ _RTW_PRINT_SEL(sel, "%c%c ", code[0], code[1]); -+ } -+ } -+ if (first == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+} -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+void dump_chplan_6g_id_list(void *sel) -+{ -+ u8 first = 1; -+ int i; -+ -+ for (i = 0; i < rtw_chplan_6g_map_size; i++) { -+ if (!rtw_is_channel_plan_6g_valid(i)) -+ continue; -+ -+ if (first) { -+ RTW_PRINT_SEL(sel, "0x%02X ", i); -+ first = 0; -+ } else -+ _RTW_PRINT_SEL(sel, "0x%02X ", i); -+ } -+ if (first == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+} -+ -+void dump_chplan_6g_country_list(void *sel) -+{ -+ int i; -+ -+ for (i = 0; i < rtw_chplan_6g_map_size; i++) { -+ struct country_chplan ent; -+ u8 code[2]; -+ u8 first; -+ -+ if (!rtw_is_channel_plan_6g_valid(i)) -+ continue; -+ -+ first = 1; -+ for (code[0] = 'A'; code[0] <= 'Z'; code[0]++) { -+ for (code[1] = 'A'; code[1] <= 'Z'; code[1]++) { -+ if (!rtw_get_chplan_from_country(code, &ent) || ent.chplan_6g != i) -+ continue; -+ -+ if (first) { -+ RTW_PRINT_SEL(sel, "0x%02X %c%c ", i, code[0], code[1]); -+ first = 0; -+ } else -+ _RTW_PRINT_SEL(sel, "%c%c ", code[0], code[1]); -+ } -+ } -+ if (first == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+} -+#endif /* CONFIG_IEEE80211_BAND_6GHZ */ -+ -+#ifdef CONFIG_RTW_DEBUG -+void dump_chplan_test(void *sel) -+{ -+ int i, j; -+ -+ /* check 2G CHD redundent */ -+ for (i = RTW_CHD_2G_00; i < RTW_CHD_2G_MAX; i++) { -+ for (j = RTW_CHD_2G_00; j < i; j++) { -+ if (CH_LIST_LEN(rtw_channel_def_2g[i]) == CH_LIST_LEN(rtw_channel_def_2g[j]) -+ && _rtw_memcmp(&CH_LIST_CH(rtw_channel_def_2g[i], 0), &CH_LIST_CH(rtw_channel_def_2g[j], 0), CH_LIST_LEN(rtw_channel_def_2g[i]) + 1) == _TRUE) -+ RTW_PRINT_SEL(sel, "2G chd:%u and %u is the same\n", i, j); -+ } -+ } -+ -+ /* check 2G CHD invalid channel */ -+ for (i = RTW_CHD_2G_00; i < RTW_CHD_2G_MAX; i++) { -+ for (j = 0; j < CH_LIST_LEN(rtw_channel_def_2g[i]); j++) { -+ if (rtw_ch2freq(CH_LIST_CH(rtw_channel_def_2g[i], j)) == 0) -+ RTW_PRINT_SEL(sel, "2G invalid ch:%u at (%d,%d)\n", CH_LIST_CH(rtw_channel_def_2g[i], j), i, j); -+ } -+ } -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+ /* check 5G CHD redundent */ -+ for (i = RTW_CHD_5G_00; i < RTW_CHD_5G_MAX; i++) { -+ for (j = RTW_CHD_5G_00; j < i; j++) { -+ if (CH_LIST_LEN(rtw_channel_def_5g[i]) == CH_LIST_LEN(rtw_channel_def_5g[j]) -+ && _rtw_memcmp(&CH_LIST_CH(rtw_channel_def_5g[i], 0), &CH_LIST_CH(rtw_channel_def_5g[j], 0), CH_LIST_LEN(rtw_channel_def_5g[i]) + 1) == _TRUE) -+ RTW_PRINT_SEL(sel, "5G chd:%u and %u is the same\n", i, j); -+ } -+ } -+ -+ /* check 5G CHD invalid channel */ -+ for (i = RTW_CHD_5G_00; i < RTW_CHD_5G_MAX; i++) { -+ for (j = 0; j < CH_LIST_LEN(rtw_channel_def_5g[i]); j++) { -+ if (rtw_ch2freq(CH_LIST_CH(rtw_channel_def_5g[i], j)) == 0) -+ RTW_PRINT_SEL(sel, "5G invalid ch:%u at (%d,%d)\n", CH_LIST_CH(rtw_channel_def_5g[i], j), i, j); -+ } -+ } -+#endif -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ /* check 6G CHD redundent */ -+ for (i = RTW_CHD_6G_00; i < RTW_CHD_6G_MAX; i++) { -+ for (j = RTW_CHD_6G_00; j < i; j++) { -+ if (CH_LIST_LEN(rtw_channel_def_6g[i]) == CH_LIST_LEN(rtw_channel_def_6g[j]) -+ && _rtw_memcmp(&CH_LIST_CH(rtw_channel_def_6g[i], 0), &CH_LIST_CH(rtw_channel_def_6g[j], 0), CH_LIST_LEN(rtw_channel_def_6g[i]) + 1) == _TRUE) -+ RTW_PRINT_SEL(sel, "6G chd:%u and %u is the same\n", i, j); -+ } -+ } -+ -+ /* check 6G CHD invalid channel */ -+ for (i = RTW_CHD_6G_00; i < RTW_CHD_6G_MAX; i++) { -+ for (j = 0; j < CH_LIST_LEN(rtw_channel_def_6g[i]); j++) { -+ if (rtw_6gch2freq(CH_LIST_CH(rtw_channel_def_6g[i], j)) == 0) -+ RTW_PRINT_SEL(sel, "6G invalid ch:%u at (%d,%d)\n", CH_LIST_CH(rtw_channel_def_6g[i], j), i, j); -+ } -+ } -+#endif -+ -+ /* check chplan 2G_5G redundent */ -+ for (i = 0; i < RTW_ChannelPlanMap_size; i++) { -+ if (!rtw_is_channel_plan_valid(i)) -+ continue; -+ for (j = 0; j < i; j++) { -+ if (!rtw_is_channel_plan_valid(j)) -+ continue; -+ if (_rtw_memcmp(&RTW_ChannelPlanMap[i], &RTW_ChannelPlanMap[j], sizeof(RTW_ChannelPlanMap[i])) == _TRUE) -+ RTW_PRINT_SEL(sel, "channel plan 0x%02x and 0x%02x is the same\n", i, j); -+ } -+ } -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ /* check chplan 6G redundent */ -+ for (i = 0; i < rtw_chplan_6g_map_size; i++) { -+ if (!rtw_is_channel_plan_6g_valid(i)) -+ continue; -+ for (j = 0; j < i; j++) { -+ if (!rtw_is_channel_plan_6g_valid(j)) -+ continue; -+ if (_rtw_memcmp(&rtw_chplan_6g_map[i], &rtw_chplan_6g_map[j], sizeof(rtw_chplan_6g_map[i])) == _TRUE) -+ RTW_PRINT_SEL(sel, "channel plan 6g 0x%02x and 0x%02x is the same\n", i, j); -+ } -+ } -+#endif -+ -+ -+ /* check country invalid chplan/chplan_6g */ -+{ -+ struct country_chplan ent; -+ u8 code[2]; -+ -+ for (code[0] = 'A'; code[0] <= 'Z'; code[0]++) { -+ for (code[1] = 'A'; code[1] <= 'Z'; code[1]++) { -+ if (!rtw_get_chplan_from_country(code, &ent)) -+ continue; -+ if (!rtw_is_channel_plan_valid(ent.chplan)) -+ RTW_PRINT_SEL(sel, "country \"%c%c\" has invalid chplan:0x%02X\n", code[0], code[1], ent.chplan); -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ if (!rtw_is_channel_plan_6g_valid(ent.chplan_6g)) -+ RTW_PRINT_SEL(sel, "country \"%c%c\" has invalid chplan_6g:0x%02X\n", code[0], code[1], ent.chplan_6g); -+ #endif -+ } -+ } -+} -+ -+} -+#endif /* CONFIG_RTW_DEBUG */ -+ -+void dump_chplan_ver(void *sel) -+{ -+ RTW_PRINT_SEL(sel, "%s%s-%s\n", RTW_DOMAIN_MAP_VER, RTW_DOMAIN_MAP_M_VER, RTW_COUNTRY_MAP_VER); -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_chplan.h b/drivers/net/wireless/rtl8821cs/core/rtw_chplan.h -new file mode 100644 -index 000000000..dbc41e0ea ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_chplan.h -@@ -0,0 +1,271 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2018 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_CHPLAN_H__ -+#define __RTW_CHPLAN_H__ -+ -+#define RTW_CHPLAN_IOCTL_NULL 0xFFFE /* special value by ioctl: null(empty) chplan */ -+#define RTW_CHPLAN_IOCTL_UNSPECIFIED 0xFFFF /* special value by ioctl: no change (keep original) */ -+ -+#define RTW_CHPLAN_NULL 0x1A -+#define RTW_CHPLAN_WORLDWIDE 0x7F -+#define RTW_CHPLAN_UNSPECIFIED 0xFF -+#define RTW_CHPLAN_6G_NULL 0x00 -+#define RTW_CHPLAN_6G_WORLDWIDE 0x7F -+#define RTW_CHPLAN_6G_UNSPECIFIED 0xFF -+ -+u8 rtw_chplan_get_default_regd_2g(u8 id); -+u8 rtw_chplan_get_default_regd_5g(u8 id); -+bool rtw_is_channel_plan_valid(u8 id); -+bool rtw_regsty_is_excl_chs(struct registry_priv *regsty, u8 ch); -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+u8 rtw_chplan_get_default_regd_6g(u8 id); -+bool rtw_is_channel_plan_6g_valid(u8 id); -+bool rtw_regsty_is_excl_chs_6g(struct registry_priv *regsty, u8 ch); -+#endif -+ -+u8 rtw_chplan_is_chbw_valid(u8 id, u8 id_6g, BAND_TYPE band, u8 ch, u8 bw, u8 offset -+ , bool allow_primary_passive, bool allow_passive, struct registry_priv *regsty); -+ -+enum regd_src_t { -+ REGD_SRC_RTK_PRIV = 0, /* Regulatory settings from Realtek framework (Realtek defined or customized) */ -+ REGD_SRC_OS = 1, /* Regulatory settings from OS */ -+ REGD_SRC_NUM, -+}; -+ -+#define regd_src_is_valid(src) ((src) < REGD_SRC_NUM) -+ -+extern const char *_regd_src_str[]; -+#define regd_src_str(src) ((src) >= REGD_SRC_NUM ? _regd_src_str[REGD_SRC_NUM] : _regd_src_str[src]) -+ -+struct _RT_CHANNEL_INFO; -+u8 init_channel_set(_adapter *adapter); -+bool rtw_chset_is_dfs_range(struct _RT_CHANNEL_INFO *chset, u32 hi, u32 lo); -+bool rtw_chset_is_dfs_ch(struct _RT_CHANNEL_INFO *chset, u8 ch); -+bool rtw_chset_is_dfs_chbw(struct _RT_CHANNEL_INFO *chset, u8 ch, u8 bw, u8 offset); -+bool rtw_chinfo_allow_beacon_hint(struct _RT_CHANNEL_INFO *chinfo); -+u8 rtw_process_beacon_hint(_adapter *adapter, WLAN_BSSID_EX *bss); -+ -+#define ALPHA2_FMT "%c%c" -+#define ALPHA2_ARG(a2) ((is_alpha(a2[0]) || is_decimal(a2[0])) ? a2[0] : '-'), ((is_alpha(a2[1]) || is_decimal(a2[1])) ? a2[1] : '-') -+ -+#define WORLDWIDE_ALPHA2 "00" -+#define UNSPEC_ALPHA2 "99" -+ -+#define IS_ALPHA2_WORLDWIDE(_alpha2) (strncmp(_alpha2, WORLDWIDE_ALPHA2, 2) == 0) -+#define IS_ALPHA2_UNSPEC(_alpha2) (strncmp(_alpha2, UNSPEC_ALPHA2, 2) == 0) -+#define SET_UNSPEC_ALPHA2(_alpha2) do { _rtw_memcpy(_alpha2, UNSPEC_ALPHA2, 2); } while (0) -+ -+#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 RTW_MODULE_RTL8723DE_NGFF1630 BIT8 /* RTL8723DE(NGFF1630) */ -+#define RTW_MODULE_RTL8822BE BIT9 /* RTL8822BE */ -+#define RTW_MODULE_RTL8821CE BIT10 /* RTL8821CE */ -+#define RTW_MODULE_RTL8822CE BIT11 /* RTL8822CE */ -+ -+enum rtw_regd_inr { -+ RTW_REGD_SET_BY_INIT = 0, -+ RTW_REGD_SET_BY_USER = 1, -+ RTW_REGD_SET_BY_COUNTRY_IE = 2, -+ -+ /* below is not used for REGD_SRC_RTK_PRIV */ -+ RTW_REGD_SET_BY_DRIVER = 3, -+ RTW_REGD_SET_BY_CORE = 4, -+ -+ RTW_REGD_SET_BY_NUM, -+}; -+ -+extern const char *const _regd_inr_str[]; -+#define regd_inr_str(inr) (((inr) >= RTW_REGD_SET_BY_NUM) ? _regd_inr_str[RTW_REGD_SET_BY_NUM] : _regd_inr_str[(inr)]) -+ -+enum rtw_regd { -+ RTW_REGD_NA = 0, -+ RTW_REGD_FCC = 1, -+ RTW_REGD_MKK = 2, -+ RTW_REGD_ETSI = 3, -+ RTW_REGD_IC = 4, -+ RTW_REGD_KCC = 5, -+ RTW_REGD_NCC = 6, -+ RTW_REGD_ACMA = 7, -+ RTW_REGD_CHILE = 8, -+ RTW_REGD_MEX = 9, -+ RTW_REGD_WW, -+ RTW_REGD_NUM, -+}; -+ -+extern const char *const _regd_str[]; -+#define regd_str(regd) (((regd) >= RTW_REGD_NUM) ? _regd_str[RTW_REGD_NA] : _regd_str[(regd)]) -+ -+enum rtw_edcca_mode { -+ RTW_EDCCA_NORMAL = 0, /* normal */ -+ RTW_EDCCA_ADAPT = 1, /* adaptivity */ -+ RTW_EDCCA_CS = 2, /* carrier sense */ -+ -+ RTW_EDCCA_MODE_NUM, -+ RTW_EDCCA_DEF = RTW_EDCCA_MODE_NUM, /* default (ref to domain code), used at country chplan map's override field */ -+}; -+ -+extern const char *const _rtw_edcca_mode_str[]; -+#define rtw_edcca_mode_str(mode) (((mode) >= RTW_EDCCA_MODE_NUM) ? _rtw_edcca_mode_str[RTW_EDCCA_NORMAL] : _rtw_edcca_mode_str[(mode)]) -+ -+enum rtw_dfs_regd { -+ RTW_DFS_REGD_NONE = 0, -+ RTW_DFS_REGD_FCC = 1, -+ RTW_DFS_REGD_MKK = 2, -+ RTW_DFS_REGD_ETSI = 3, -+ RTW_DFS_REGD_NUM, -+ RTW_DFS_REGD_AUTO = 0xFF, /* follow channel plan */ -+}; -+ -+extern const char *_rtw_dfs_regd_str[]; -+#define rtw_dfs_regd_str(region) (((region) >= RTW_DFS_REGD_NUM) ? _rtw_dfs_regd_str[RTW_DFS_REGD_NONE] : _rtw_dfs_regd_str[(region)]) -+ -+typedef enum _REGULATION_TXPWR_LMT { -+ TXPWR_LMT_NONE = 0, /* no limit */ -+ TXPWR_LMT_FCC = 1, -+ TXPWR_LMT_MKK = 2, -+ TXPWR_LMT_ETSI = 3, -+ TXPWR_LMT_IC = 4, -+ TXPWR_LMT_KCC = 5, -+ TXPWR_LMT_NCC = 6, -+ TXPWR_LMT_ACMA = 7, -+ TXPWR_LMT_CHILE = 8, -+ TXPWR_LMT_UKRAINE = 9, -+ TXPWR_LMT_MEXICO = 10, -+ TXPWR_LMT_CN = 11, -+ TXPWR_LMT_QATAR = 12, -+ TXPWR_LMT_WW, /* smallest of all available limit, keep last */ -+ -+ TXPWR_LMT_NUM, -+ TXPWR_LMT_DEF = TXPWR_LMT_NUM, /* default (ref to domain code), used at country chplan map's override field */ -+} REGULATION_TXPWR_LMT; -+ -+extern const char *const _txpwr_lmt_str[]; -+#define txpwr_lmt_str(regd) (((regd) >= TXPWR_LMT_NUM) ? _txpwr_lmt_str[TXPWR_LMT_NUM] : _txpwr_lmt_str[(regd)]) -+ -+extern const REGULATION_TXPWR_LMT _txpwr_lmt_alternate[]; -+#define txpwr_lmt_alternate(ori) (((ori) > TXPWR_LMT_NUM) ? _txpwr_lmt_alternate[TXPWR_LMT_WW] : _txpwr_lmt_alternate[(ori)]) -+ -+#define TXPWR_LMT_ALTERNATE_DEFINED(txpwr_lmt) (txpwr_lmt_alternate(txpwr_lmt) != txpwr_lmt) -+ -+extern const enum rtw_edcca_mode _rtw_regd_to_edcca_mode[RTW_REGD_NUM]; -+#define rtw_regd_to_edcca_mode(regd) (((regd) >= RTW_REGD_NUM) ? RTW_EDCCA_NORMAL : _rtw_regd_to_edcca_mode[(regd)]) -+ -+extern const REGULATION_TXPWR_LMT _rtw_regd_to_txpwr_lmt[]; -+#define rtw_regd_to_txpwr_lmt(regd) (((regd) >= RTW_REGD_NUM) ? TXPWR_LMT_WW : _rtw_regd_to_txpwr_lmt[(regd)]) -+ -+#define EDCCA_MODES_STR_LEN (((6 + 3 + 1) * BAND_MAX) + 1) -+char *rtw_get_edcca_modes_str(char *buf, u8 modes[]); -+void rtw_edcca_mode_update(struct dvobj_priv *dvobj); -+u8 rtw_get_edcca_mode(struct dvobj_priv *dvobj, BAND_TYPE band); -+ -+#define TXPWR_NAMES_STR_LEN (((1 + 7 + 1) * BAND_MAX) + 1) -+char *rtw_get_txpwr_lmt_names_str(char *buf, const char *names[], u8 unknown_bmp); -+ -+#define CHPLAN_PROTO_EN_AC BIT0 -+#define CHPLAN_PROTO_EN_AX BIT1 -+#define CHPLAN_PROTO_EN_ALL 0xFF -+ -+struct country_chplan { -+ char alpha2[2]; -+ u8 chplan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 chplan_6g; -+#endif -+ u8 edcca_mode_2g_override:2; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ u8 edcca_mode_5g_override:2; -+#endif -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 edcca_mode_6g_override:2; -+#endif -+ u8 txpwr_lmt_override; -+#if defined(CONFIG_80211AX_HE) || defined(CONFIG_80211AC_VHT) -+ u8 proto_en; -+#endif -+}; -+ -+#ifdef CONFIG_80211AC_VHT -+#define COUNTRY_CHPLAN_EN_11AC(_ent) (((_ent)->proto_en & CHPLAN_PROTO_EN_AC) ? 1 : 0) -+#else -+#define COUNTRY_CHPLAN_EN_11AC(_ent) 0 -+#endif -+ -+#ifdef CONFIG_80211AX_HE -+#define COUNTRY_CHPLAN_EN_11AX(_ent) (((_ent)->proto_en & CHPLAN_PROTO_EN_AX) ? 1 : 0) -+#else -+#define COUNTRY_CHPLAN_EN_11AX(_ent) 0 -+#endif -+ -+void rtw_get_chplan_worldwide(struct country_chplan *ent); -+bool rtw_get_chplan_from_country(const char *country_code, struct country_chplan *ent); -+ -+void rtw_chplan_ioctl_input_mapping(u16 *chplan, u16 *chplan_6g); -+bool rtw_chplan_ids_is_world_wide(u8 chplan, u8 chplan_6g); -+ -+u8 rtw_country_chplan_is_chbw_valid(struct country_chplan *ent, BAND_TYPE band, u8 ch, u8 bw, u8 offset -+ , bool allow_primary_passive, bool allow_passive, struct registry_priv *regsty); -+ -+enum country_ie_slave_status { -+ COUNTRY_IE_SLAVE_NOCOUNTRY = 0, -+ COUNTRY_IE_SLAVE_UNKNOWN = 1, -+ COUNTRY_IE_SLAVE_OPCH_NOEXIST = 2, -+ COUNTRY_IE_SLAVE_APPLICABLE = 3, -+ -+ COUNTRY_IE_SLAVE_STATUS_NUM, -+}; -+ -+struct country_ie_slave_record { -+ char alpha2[2]; /* country code get from connected AP of STA ifaces, "\x00\x00" is not set */ -+ BAND_TYPE band; -+ u8 opch; -+ enum country_ie_slave_status status; -+}; -+ -+#ifdef CONFIG_80211D -+extern const char *const _cis_status_str[]; -+#define cis_status_str(s) (((s) >= COUNTRY_IE_SLAVE_STATUS_NUM) ? _cis_status_str[COUNTRY_IE_SLAVE_STATUS_NUM] : _cis_status_str[(s)]) -+ -+void dump_country_ie_slave_records(void *sel, struct rf_ctl_t *rfctl, bool skip_noset); -+ -+enum country_ie_slave_status rtw_get_chplan_from_recv_country_ie(_adapter *adapter -+ , BAND_TYPE band, u8 opch, const u8 *country_ie, struct country_chplan *ent -+ , struct country_ie_slave_record *cisr, const char *caller_msg); -+ -+enum country_ie_slave_status rtw_get_chplan_from_cisrs(struct rf_ctl_t *rfctl -+ , struct country_chplan *ent, const char *caller_msg); -+#endif -+ -+void dump_country_chplan(void *sel, const struct country_chplan *ent, bool regd_info); -+void dump_country_chplan_map(void *sel, bool regd_info); -+void dump_country_list(void *sel); -+void dump_chplan_id_list(void *sel); -+void dump_chplan_country_list(void *sel); -+#if CONFIG_IEEE80211_BAND_6GHZ -+void dump_chplan_6g_id_list(void *sel); -+void dump_chplan_6g_country_list(void *sel); -+#endif -+#ifdef CONFIG_RTW_DEBUG -+void dump_chplan_test(void *sel); -+#endif -+void dump_chplan_ver(void *sel); -+ -+#endif /* __RTW_CHPLAN_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_cmd.c b/drivers/net/wireless/rtl8821cs/core/rtw_cmd.c -new file mode 100644 -index 000000000..849868030 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_cmd.c -@@ -0,0 +1,5950 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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->start_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: -+ -+ -+ 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); -+ -+ 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); -+#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)); -+ -+ 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->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) { -+ RTW_INFO("%s===> cmdcode:0x%02x\n", __FUNCTION__, obj->cmdcode); -+ if (obj->cmdcode == CMD_SET_MLME_EVT) { -+ if (obj->parmbuf) { -+ struct rtw_evt_header *evt_hdr = (struct rtw_evt_header *)(obj->parmbuf); -+ RTW_INFO("evt_hdr->id:%d\n", evt_hdr->id); -+ } -+ } -+ if (obj->cmdcode == CMD_SET_DRV_EXTRA) { -+ if (obj->parmbuf) { -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)(obj->parmbuf); -+ RTW_INFO("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 == CMD_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) -+{ -+#ifndef CONFIG_MAC_LOOPBACK_DRIVER -+ u8 bAllow = _FALSE; /* set to _TRUE to allow enqueuing cmd when hw_init_completed is _FALSE */ -+#else -+ u8 bAllow = _TRUE; /* hw_init_completed is _FALSE in the case of MAC loopback*/ -+#endif -+ -+#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 == CMD_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 == CMD_SET_CHANPLAN) -+ 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 (!is_primary_adapter(padapter)) -+ 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 == CMD_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) -+{ -+ 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) { -+ _rtw_up_sema(&adapter->cmdpriv.cmd_queue_sema); -+ rtw_thread_stop(adapter->cmdThread); -+ adapter->cmdThread = NULL; -+ } -+} -+ -+thread_return rtw_cmd_thread(thread_context context) -+{ -+ u8 ret; -+ struct cmd_obj *pcmd; -+ u8 *pcmdbuf, *prspbuf; -+ systime 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; -+ ATOMIC_SET(&(pcmdpriv->cmdthd_running), _TRUE); -+ _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_DBG(FUNC_ADPT_FMT "- bDriverStopped(%s) bSurpriseRemoved(%s)\n", -+ FUNC_ADPT_ARG(padapter), -+ rtw_is_drv_stopped(padapter) ? "True" : "False", -+ rtw_is_surprise_removed(padapter) ? "True" : "False"); -+ 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 rtw_cmd))) { -+ RTW_ERR("%s undefined cmdcode:%d\n", __func__, pcmd->cmdcode); -+ pcmd->res = H2C_PARAMETERS_ERROR; -+ goto post_process; -+ } -+ -+ cmd_hdl = wlancmds[pcmd->cmdcode].cmd_hdl; -+ 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 == CMD_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); -+ } -+ #if CONFIG_DFS -+ else if (pcmd->cmdcode == CMD_SET_CHANSWITCH) -+ adapter_to_rfctl(padapter)->csa_ch = 0; -+ #endif -+ 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(wlancmds) / sizeof(struct rtw_cmd))) -+ pcmd_callback = wlancmds[pcmd->cmdcode].callback; -+ else -+ pcmd_callback = NULL; -+ -+ 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 */ -+ } -+ -+ 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 == CMD_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); -+ } -+ #if CONFIG_DFS -+ else if (pcmd->cmdcode == CMD_SET_CHANSWITCH) -+ adapter_to_rfctl(padapter)->csa_ch = 0; -+ #endif -+ -+ _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_INFO(FUNC_ADPT_FMT " Exit\n", FUNC_ADPT_ARG(padapter)); -+ -+ rtw_thread_wait_stop(); -+ -+ 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 -+ -+void rtw_init_sitesurvey_parm(_adapter *padapter, struct sitesurvey_parm *pparm) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ _rtw_memset(pparm, 0, sizeof(struct sitesurvey_parm)); -+ pparm->scan_mode = pmlmepriv->scan_mode; -+} -+ -+/* -+rtw_sitesurvey_cmd(~) -+ ### NOTE:#### (!!!!) -+ MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock -+*/ -+u8 rtw_sitesurvey_cmd(_adapter *padapter, struct sitesurvey_parm *pparm) -+{ -+ 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_LPS -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SCAN, 0); -+#endif -+ -+#ifdef CONFIG_P2P_PS -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _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; -+ } -+ -+ if (pparm) -+ _rtw_memcpy(psurveyPara, pparm, sizeof(struct sitesurvey_parm)); -+ else -+ psurveyPara->scan_mode = pmlmepriv->scan_mode; -+ -+ rtw_free_network_queue(padapter, _FALSE); -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara, CMD_SITE_SURVEY); -+ -+ set_fwstate(pmlmepriv, WIFI_UNDER_SURVEY); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ if (res == _SUCCESS) { -+ u32 scan_timeout_ms; -+ -+ pmlmepriv->scan_start_time = rtw_get_current_time(); -+ scan_timeout_ms = rtw_scan_timeout_decision(padapter); -+ mlme_set_scan_to_timer(pmlmepriv,scan_timeout_ms); -+ -+ rtw_led_control(padapter, LED_CTL_SITE_SURVEY); -+ } else -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_SURVEY); -+ -+ -+ return res; -+} -+ -+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 -+ -+} -+ -+#ifdef CONFIG_AP_MODE -+static u8 rtw_createbss_cmd(_adapter *adapter, int flags, bool adhoc -+ , u8 ifbmp, u8 excl_ifbmp, s16 req_ch, s8 req_bw, s8 req_offset) -+{ -+ struct cmd_obj *cmdobj; -+ struct createbss_parm *parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ if (req_ch > 0 && req_bw >= 0 && req_offset >= 0) { -+ if (!rtw_chset_is_chbw_valid(adapter_to_chset(adapter), req_ch, req_bw, req_offset, 0, 0)) { -+ 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->ifbmp = ifbmp; -+ parm->excl_ifbmp = excl_ifbmp; -+ 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, CMD_CREATE_BSS); -+ -+ 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, 0 -+ , 0, REQ_BW_NONE, REQ_OFFSET_NONE /* 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 -+ , BIT(adapter->iface_id), 0 -+ , 0, REQ_BW_NONE, REQ_OFFSET_NONE /* excute entire AP setup cmd */ -+ ); -+} -+ -+inline u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags -+ , u8 ifbmp, u8 excl_ifbmp, s16 req_ch, s8 req_bw, s8 req_offset) -+{ -+ return rtw_createbss_cmd(adapter, flags -+ , 0 -+ , ifbmp, excl_ifbmp -+ , req_ch, req_bw, req_offset -+ ); -+} -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_80211D -+/* Return corresponding country_chplan setting */ -+static bool rtw_joinbss_check_country_ie(_adapter *adapter, const WLAN_BSSID_EX *network, struct country_chplan *ent, WLAN_BSSID_EX *out_network) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ bool ret = 0; -+ -+ if (rfctl->regd_src == REGD_SRC_RTK_PRIV -+ && !rtw_rfctl_is_disable_sw_channel_plan(rfctl_to_dvobj(rfctl)) -+ ) { -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ const u8 *country_ie = NULL; -+ sint country_ie_len = 0; -+ -+ if (rtw_iface_accept_country_ie(adapter)) { -+ country_ie = rtw_get_ie(BSS_EX_TLV_IES(network) -+ , WLAN_EID_COUNTRY, &country_ie_len, BSS_EX_TLV_IES_LEN(network)); -+ if (country_ie) { -+ if (country_ie_len < 6) { -+ country_ie = NULL; -+ country_ie_len = 0; -+ } else -+ country_ie_len += 2; -+ } -+ } -+ -+ if (country_ie) { -+ enum country_ie_slave_status status; -+ -+ rtw_buf_update(&mlme->recv_country_ie, &mlme->recv_country_ie_len, country_ie, country_ie_len); -+ -+ status = rtw_get_chplan_from_recv_country_ie(adapter -+ , network->Configuration.DSConfig > 14 ? BAND_ON_5G : BAND_ON_2_4G -+ , network->Configuration.DSConfig, country_ie, ent, NULL, __func__); -+ if (status != COUNTRY_IE_SLAVE_NOCOUNTRY) -+ ret = 1; -+ -+ if (out_network) { -+ _rtw_memcpy(BSS_EX_IES(out_network) + BSS_EX_IES_LEN(out_network) -+ , country_ie, country_ie_len); -+ BSS_EX_IES_LEN(out_network) += country_ie_len; -+ } -+ } else -+ rtw_buf_free(&mlme->recv_country_ie, &mlme->recv_country_ie_len); -+ } -+ -+ return ret; -+} -+#endif /* CONFIG_80211D */ -+ -+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_80211D -+ struct country_chplan country_ent; -+#endif -+ struct country_chplan *req_chplan = NULL; -+#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); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ u32 tmp_len; -+ u8 *ptmp = NULL; -+ -+ 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(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; -+#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; -+ -+ default: -+ rtw_warn_on(1); -+ break; -+ } -+ } -+ -+ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->network.IEs, pnetwork->network.IELength); -+ -+ rtw_phydm_update_ap_vendor_ie(padapter); -+ -+#ifdef CONFIG_80211AC_VHT -+ /* save AP beamform_cap info for BCM IOT issue */ -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) -+ get_vht_bf_cap(pnetwork->network.IEs, -+ pnetwork->network.IELength, -+ &pvhtpriv->ap_bf_cap); -+#endif -+ /* -+ 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); -+ -+ /* copy fixed ie */ -+ _rtw_memcpy(psecnetwork->IEs, pnetwork->network.IEs, 12); -+ psecnetwork->IELength = 12; -+ -+ psecnetwork->IELength += rtw_restruct_sec_ie(padapter, psecnetwork->IEs + psecnetwork->IELength); -+ -+ -+ pqospriv->qos_option = 0; -+ -+ if (pregistrypriv->wmm_enable) { -+#ifdef CONFIG_WMMPS_STA -+ rtw_uapsd_use_default_setting(padapter); -+#endif /* CONFIG_WMMPS_STA */ -+ 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_80211D -+ if (rtw_joinbss_check_country_ie(padapter, &pnetwork->network, &country_ent, psecnetwork)) -+ req_chplan = &country_ent; -+#endif -+ -+#ifdef CONFIG_80211N_HT -+ phtpriv->ht_option = _FALSE; -+ if (pregistrypriv->ht_enable && is_supported_ht(pregistrypriv->wireless_mode)) { -+ ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &tmp_len, pnetwork->network.IELength - 12); -+ if (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_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, req_chplan); -+ } -+ } -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ pvhtpriv->vht_option = _FALSE; -+ if (phtpriv->ht_option -+ && REGSTY_IS_11AC_ENABLE(pregistrypriv) -+ && is_supported_vht(pregistrypriv->wireless_mode) -+ && ((req_chplan && COUNTRY_CHPLAN_EN_11AC(req_chplan)) -+ || (!req_chplan && RFCTL_REG_EN_11AC(rfctl))) -+ ) { -+ u8 vht_enable = 0; -+ -+ if (pnetwork->network.Configuration.DSConfig > 14) -+ vht_enable = 1; -+ else if ((REGSTY_IS_11AC_24G_ENABLE(pregistrypriv)) && (padapter->registrypriv.wifi_spec == 0)) -+ vht_enable = 1; -+ -+ if (vht_enable == 1) -+ rtw_restructure_vht_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], -+ pnetwork->network.IELength, &psecnetwork->IELength, req_chplan); -+ } -+#endif -+#endif /* CONFIG_80211N_HT */ -+ -+ rtw_append_extended_cap(padapter, &psecnetwork->IEs[0], &psecnetwork->IELength); -+ -+#ifdef CONFIG_RTW_80211R -+ rtw_ft_validate_akm_type(padapter, pnetwork); -+#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); -+ -+ _rtw_init_listhead(&pcmd->list); -+ pcmd->cmdcode = CMD_JOINBSS;/* _JoinBss_CMD_ */ -+ 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, int flags) /* for sta_mode */ -+{ -+ struct cmd_obj *cmdobj = NULL; -+ struct disconnect_parm *param = NULL; -+ struct cmd_priv *cmdpriv = &padapter->cmdpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct submit_ctx sctx; -+ 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 (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (disconnect_hdl(padapter, (u8 *)param) != H2C_SUCCESS) -+ res = _FAIL; -+ rtw_mfree((u8 *)param, sizeof(*param)); -+ -+ } else { -+ 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, CMD_DISCONNECT); -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ cmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 2000); -+ } -+ res = rtw_enqueue_cmd(cmdpriv, 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; -+} -+ -+#ifdef CONFIG_AP_MODE -+u8 rtw_stop_ap_cmd(_adapter *adapter, u8 flags) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *parm; -+ struct cmd_priv *pcmdpriv = &adapter->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 */ -+ if (H2C_SUCCESS != stop_ap_hdl(adapter)) -+ res = _FAIL; -+ } else { -+ parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm->ec_id = STOP_AP_WK_CID; -+ parm->type = 0; -+ parm->size = 0; -+ parm->pbuf = NULL; -+ -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, CMD_SET_DRV_EXTRA); -+ -+ 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; -+} -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+u8 rtw_tx_control_cmd(_adapter *adapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ 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((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = TBTX_CONTROL_TX_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, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+#endif -+ -+u8 rtw_setopmode_cmd(_adapter *adapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, u8 flags) -+{ -+ struct cmd_obj *cmdobj; -+ struct setopmode_parm *parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ /* prepare cmd parameter */ -+ parm = (struct setopmode_parm *)rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ parm->mode = (u8)networktype; -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != setopmode_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, CMD_SET_OPMODE); -+ -+ 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; -+} -+ -+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 key_len =16; -+ 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->cmn.mac_addr, 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 ((psetstakey_para->algorithm == _GCMP_256_) || (psetstakey_para->algorithm == _CCMP_256_)) -+ key_len = 32; -+ -+ if (key_type == GROUP_KEY) { -+ _rtw_memcpy(&psetstakey_para->key, &psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, key_len); -+ psetstakey_para->gk = 1; -+ } else if (key_type == UNICAST_KEY) -+ _rtw_memcpy(&psetstakey_para->key, &sta->dot118021x_UncstKey, key_len); -+#ifdef CONFIG_TDLS -+ else if (key_type == TDLS_KEY) { -+ _rtw_memcpy(&psetstakey_para->key, sta->tpk.tk, key_len); -+ 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, CMD_SET_STAKEY); -+ 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; -+ s16 cam_id = 0; -+ u8 res = _SUCCESS; -+ -+ if (!sta) { -+ RTW_ERR("%s sta == NULL\n", __func__); -+ goto exit; -+ } -+ -+ if (!enqueue) { -+ while ((cam_id = rtw_camid_search(padapter, sta->cmn.mac_addr, -1, -1)) >= 0) { -+ RTW_PRINT("clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(sta->cmn.mac_addr), 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, CMD_SET_STAKEY); -+ ph2c->rsp = (u8 *) psetstakey_rsp; -+ ph2c->rspsz = sizeof(struct set_stakey_rsp); -+ -+ _rtw_memcpy(psetstakey_para->addr, sta->cmn.mac_addr, ETH_ALEN); -+ -+ psetstakey_para->algorithm = _NO_PRIVACY_; -+ -+ 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, CMD_ADD_BAREQ); -+ -+ /* 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, CMD_ADD_BARSP); -+ -+ 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, CMD_SET_DRV_EXTRA); -+ -+ -+ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+void free_assoc_resources_hdl(_adapter *padapter, u8 lock_scanned_queue) -+{ -+ rtw_free_assoc_resources(padapter, lock_scanned_queue); -+} -+ -+u8 rtw_free_assoc_resources_cmd(_adapter *padapter, u8 lock_scanned_queue, int flags) -+{ -+ struct cmd_obj *cmd; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ free_assoc_resources_hdl(padapter, lock_scanned_queue); -+ } -+ else { -+ cmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmd == 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 *)cmd, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = FREE_ASSOC_RESOURCES; -+ pdrvextra_cmd_parm->type = lock_scanned_queue; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(cmd, pdrvextra_cmd_parm, CMD_SET_DRV_EXTRA); -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ cmd->sctx = &sctx; -+ rtw_sctx_init(&sctx, 2000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, cmd); -+ -+ 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) -+ cmd->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ } -+ } -+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, CMD_SET_DRV_EXTRA); -+ -+ -+ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+u8 rtw_iqk_cmd(_adapter *padapter, u8 flags) -+{ -+ struct cmd_obj *pcmdobj; -+ 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 */ -+ rtw_iqk_hdl(padapter, NULL); -+ } else { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_parm_rsp(pcmdobj, CMD_DO_IQK); -+ -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ pcmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 10 * 1000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+ 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) -+ pcmdobj->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ } -+ } -+ -+exit: -+ -+ return res; -+} -+ -+u8 rtw_set_chbw_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 flags) -+{ -+ struct cmd_obj *pcmdobj; -+ struct set_ch_parm *set_ch_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct submit_ctx sctx; -+ 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 (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != rtw_set_chbw_hdl(padapter, (u8 *)set_ch_parm)) -+ res = _FAIL; -+ -+ rtw_mfree((u8 *)set_ch_parm, sizeof(*set_ch_parm)); -+ } else { -+ /* 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, CMD_SET_CHANNEL); -+ -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ pcmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 10 * 1000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+ 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) -+ pcmdobj->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ } -+ } -+ -+ /* do something based on res... */ -+ -+exit: -+ -+ RTW_INFO(FUNC_NDEV_FMT" res:%u\n", FUNC_NDEV_ARG(padapter->pnetdev), res); -+ -+ -+ return res; -+} -+ -+static u8 _rtw_set_chplan_cmd(_adapter *adapter, int flags -+ , u8 chplan, u8 chplan_6g, const struct country_chplan *country_ent -+ , enum regd_src_t regd_src, enum rtw_regd_inr inr -+ , const struct country_ie_slave_record *cisr) -+{ -+ struct cmd_obj *cmdobj; -+ struct SetChannelPlan_param *parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+#ifdef PLATFORM_LINUX -+ bool rtnl_lock_needed = rtw_rtnl_lock_needed(adapter_to_dvobj(adapter)); -+#endif -+ u8 res = _SUCCESS; -+ -+ /* check if allow software config */ -+ if (rtw_rfctl_is_disable_sw_channel_plan(adapter_to_dvobj(adapter)) == _TRUE) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if (country_ent) { -+ /* if country_entry is provided, replace chplan */ -+ chplan = country_ent->chplan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ chplan_6g = country_ent->chplan_6g; -+ #endif -+ } -+ -+ /* prepare cmd parameter */ -+ parm = (struct SetChannelPlan_param *)rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ parm->regd_src = regd_src; -+ parm->inr = inr; -+ if (country_ent) { -+ _rtw_memcpy(&parm->country_ent, country_ent, sizeof(parm->country_ent)); -+ parm->has_country = 1; -+ } -+ parm->channel_plan = chplan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ parm->channel_plan_6g = chplan_6g; -+#endif -+#ifdef CONFIG_80211D -+ if (cisr) { -+ _rtw_memcpy(&parm->cisr, cisr, sizeof(*cisr)); -+ parm->has_cisr = 1; -+ } -+#endif -+#ifdef PLATFORM_LINUX -+ if (flags & (RTW_CMDF_DIRECTLY | RTW_CMDF_WAIT_ACK)) -+ parm->rtnl_lock_needed = rtnl_lock_needed; /* synchronous call, follow caller's */ -+ else -+ parm->rtnl_lock_needed = 1; /* asynchronous call, always needed */ -+#endif -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != rtw_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, CMD_SET_CHANPLAN); -+ -+ 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); -+ if (sctx.status != RTW_SCTX_DONE_SUCCESS) -+ res = _FAIL; -+ } -+ -+ /* allow set channel plan when cmd_thread is not running */ -+ if (res != _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { -+ parm = (struct SetChannelPlan_param *)rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ parm->regd_src = regd_src; -+ parm->inr = inr; -+ if (country_ent) { -+ _rtw_memcpy(&parm->country_ent, country_ent, sizeof(parm->country_ent)); -+ parm->has_country = 1; -+ } -+ parm->channel_plan = chplan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ parm->channel_plan_6g = chplan_6g; -+ #endif -+ #ifdef CONFIG_80211D -+ if (cisr) { -+ _rtw_memcpy(&parm->cisr, cisr, sizeof(*cisr)); -+ parm->has_cisr = 1; -+ } -+ #endif -+ #ifdef PLATFORM_LINUX -+ parm->rtnl_lock_needed = rtnl_lock_needed; /* synchronous call, follow caller's */ -+ #endif -+ -+ if (H2C_SUCCESS != rtw_set_chplan_hdl(adapter, (u8 *)parm)) -+ res = _FAIL; -+ else -+ res = _SUCCESS; -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ } -+ } -+ -+exit: -+ return res; -+} -+ -+inline u8 rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, u8 chplan_6g, enum rtw_regd_inr inr) -+{ -+ return _rtw_set_chplan_cmd(adapter, flags, chplan, chplan_6g, NULL, REGD_SRC_RTK_PRIV, inr, NULL); -+} -+ -+inline u8 rtw_set_country_cmd(_adapter *adapter, int flags, const char *country_code, enum rtw_regd_inr inr) -+{ -+ struct country_chplan ent; -+ -+ if (IS_ALPHA2_WORLDWIDE(country_code)) { -+ rtw_get_chplan_worldwide(&ent); -+ goto cmd; -+ } -+ -+ 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; -+ } -+ -+ if (!rtw_get_chplan_from_country(country_code, &ent)) { -+ RTW_PRINT("%s unsupported country_code:\"%c%c\"\n", __func__, country_code[0], country_code[1]); -+ return _FAIL; -+ } -+ -+cmd: -+ RTW_PRINT("%s country_code:\"%c%c\"\n", __func__, country_code[0], country_code[1]); -+ -+ return _rtw_set_chplan_cmd(adapter, flags, RTW_CHPLAN_UNSPECIFIED, RTW_CHPLAN_6G_UNSPECIFIED, &ent, REGD_SRC_RTK_PRIV, inr, NULL); -+} -+ -+#ifdef CONFIG_REGD_SRC_FROM_OS -+inline u8 rtw_sync_os_regd_cmd(_adapter *adapter, int flags, const char *country_code, u8 dfs_region, enum rtw_regd_inr inr) -+{ -+ struct country_chplan ent; -+ struct country_chplan rtk_ent; -+ bool rtk_ent_exist; -+ -+ rtk_ent_exist = rtw_get_chplan_from_country(country_code, &rtk_ent); -+ -+ _rtw_memcpy(ent.alpha2, country_code, 2); -+ -+ /* -+ * Regulation follows OS, the internal txpwr limit selection is searched by alpha2 -+ * "00" => WW, others use string mapping -+ * When no matching txpwr limit selection is found, use -+ * 1. txpwr lmit selection associated with alpha2 inside driver regulation database -+ * 2. WW when driver has no support of this alpha2 -+ */ -+ -+ ent.chplan = rtk_ent_exist ? rtk_ent.chplan : RTW_CHPLAN_UNSPECIFIED; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ ent.chplan_6g = rtk_ent_exist ? rtk_ent.chplan_6g : RTW_CHPLAN_6G_UNSPECIFIED; -+ #endif -+ ent.edcca_mode_2g_override = rtk_ent_exist ? rtk_ent.edcca_mode_2g_override : RTW_EDCCA_DEF; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ ent.edcca_mode_5g_override = rtk_ent_exist ? rtk_ent.edcca_mode_5g_override : RTW_EDCCA_DEF; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ ent.edcca_mode_6g_override = rtk_ent_exist ? rtk_ent.edcca_mode_6g_override : RTW_EDCCA_DEF; -+ #endif -+ ent.txpwr_lmt_override = rtk_ent_exist ? rtk_ent.txpwr_lmt_override : TXPWR_LMT_DEF; -+ #if defined(CONFIG_80211AC_VHT) || defined(CONFIG_80211AX_HE) -+ ent.proto_en = CHPLAN_PROTO_EN_ALL; -+ #endif -+ -+ /* TODO: dfs_region */ -+ -+ return _rtw_set_chplan_cmd(adapter, flags, RTW_CHPLAN_UNSPECIFIED, RTW_CHPLAN_6G_UNSPECIFIED, &ent, REGD_SRC_OS, inr, NULL); -+} -+#endif /* CONFIG_REGD_SRC_FROM_OS */ -+ -+u8 rtw_get_chplan_cmd(_adapter *adapter, int flags, struct get_chplan_resp **chplan) -+{ -+ struct cmd_obj *cmdobj; -+ struct get_channel_plan_param *parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 res = _FAIL; -+ -+ if (!(flags & (RTW_CMDF_DIRECTLY | RTW_CMDF_WAIT_ACK))) -+ goto exit; -+ -+ /* prepare cmd parameter */ -+ parm = rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) -+ goto exit; -+ parm->chplan = chplan; -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS == rtw_get_chplan_hdl(adapter, (u8 *)parm)) -+ res = _SUCCESS; -+ 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) { -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, CMD_GET_CHANPLAN); -+ -+ 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); -+ if (sctx.status != RTW_SCTX_DONE_SUCCESS) -+ res = _FAIL; -+ } -+ -+ /* allow get channel plan when cmd_thread is not running */ -+ if (res != _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { -+ parm = rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) -+ goto exit; -+ parm->chplan = chplan; -+ -+ if (H2C_SUCCESS == rtw_get_chplan_hdl(adapter, (u8 *)parm)) -+ res = _SUCCESS; -+ -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ } -+ } -+ -+exit: -+ return res; -+} -+ -+#ifdef CONFIG_80211D -+inline u8 rtw_apply_recv_country_ie_cmd(_adapter *adapter, int flags, BAND_TYPE band,u8 opch, const u8 *country_ie) -+{ -+ struct country_chplan ent; -+ struct country_ie_slave_record cisr; -+ -+ rtw_get_chplan_from_recv_country_ie(adapter, band, opch, country_ie, &ent, &cisr, NULL); -+ -+ return _rtw_set_chplan_cmd(adapter, flags, RTW_CHPLAN_UNSPECIFIED, RTW_CHPLAN_6G_UNSPECIFIED -+ , NULL, REGD_SRC_RTK_PRIV, RTW_REGD_SET_BY_COUNTRY_IE, &cisr); -+} -+#endif /* CONFIG_80211D */ -+ -+u8 rtw_led_blink_cmd(_adapter *padapter, void *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, CMD_LEDBLINK); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_set_csa_cmd(_adapter *adapter) -+{ -+ struct cmd_obj *cmdobj; -+ struct cmd_priv *cmdpriv = &adapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ cmdobj = rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_parm_rsp(cmdobj, CMD_SET_CHANSWITCH); -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_set_ap_csa_cmd(_adapter *adapter) -+{ -+ u8 res = _SUCCESS; -+#ifdef CONFIG_AP_MODE -+ struct cmd_obj *cmdobj; -+ struct cmd_priv *cmdpriv = &adapter->cmdpriv; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ cmdobj = rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_parm_rsp(cmdobj, CMD_AP_CHANSWITCH); -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ -+exit: -+#endif /* CONFIG_AP_MODE */ -+ return res; -+} -+ -+u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option) -+{ -+ u8 res = _SUCCESS; -+#ifdef CONFIG_TDLS -+ struct cmd_obj *pcmdobj; -+ struct TDLSoption_param *TDLSoption; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ 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, CMD_TDLS); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+exit: -+#endif /* CONFIG_TDLS */ -+ -+ 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, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_periodic_tsf_update_end_cmd(_adapter *adapter) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *parm; -+ struct cmd_priv *cmdpriv = &adapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (parm == NULL) { -+ rtw_mfree((unsigned char *)cmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm->ec_id = PERIOD_TSF_UPDATE_END_WK_CID; -+ parm->type = 0; -+ parm->size = 0; -+ parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ -+exit: -+ return res; -+} -+u8 rtw_ssmps_wk_hdl(_adapter *adapter, struct ssmps_cmd_parm *ssmp_param) -+{ -+ u8 res = _SUCCESS; -+ struct sta_info *sta = ssmp_param->sta; -+ u8 smps = ssmp_param->smps; -+ -+ if (sta == NULL) -+ return _FALSE; -+ -+ if (smps) -+ rtw_ssmps_enter(adapter, sta); -+ else -+ rtw_ssmps_leave(adapter, sta); -+ return res; -+} -+ -+u8 rtw_ssmps_wk_cmd(_adapter *adapter, struct sta_info *sta, u8 smps, u8 enqueue) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *cmd_parm; -+ struct ssmps_cmd_parm *ssmp_param; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ if (enqueue) { -+ 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((unsigned char *)cmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ ssmp_param = (struct ssmps_cmd_parm *)rtw_zmalloc(sizeof(struct ssmps_cmd_parm)); -+ if (ssmp_param == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ ssmp_param->smps = smps; -+ ssmp_param->sta = sta; -+ -+ cmd_parm->ec_id = SSMPS_WK_CID; -+ cmd_parm->type = 0; -+ cmd_parm->size = sizeof(struct ssmps_cmd_parm); -+ cmd_parm->pbuf = (u8 *)ssmp_param; -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, cmd_parm, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ } else { -+ struct ssmps_cmd_parm tmp_ssmp_param; -+ -+ tmp_ssmp_param.smps = smps; -+ tmp_ssmp_param.sta = sta; -+ rtw_ssmps_wk_hdl(adapter, &tmp_ssmp_param); -+ } -+ -+exit: -+ return res; -+} -+ -+#ifdef CONFIG_SUPPORT_STATIC_SMPS -+u8 _ssmps_chk_by_tp(_adapter *adapter, u8 from_timer) -+{ -+ u8 enter_smps = _FALSE; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta; -+ u32 tx_tp_mbits, rx_tp_mbits; -+ -+ if (!MLME_IS_STA(adapter) || -+ !hal_is_mimo_support(adapter) || -+ !pmlmeext->ssmps_en || -+ (pmlmeext->cur_channel > 14) -+ ) -+ return enter_smps; -+ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ RTW_ERR(ADPT_FMT" sta == NULL\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ return enter_smps; -+ } -+ -+ if (psta->cmn.mimo_type == RF_1T1R) -+ return enter_smps; -+ -+ tx_tp_mbits = psta->sta_stats.tx_tp_kbits >> 10; -+ rx_tp_mbits = psta->sta_stats.rx_tp_kbits >> 10; -+ -+ #ifdef DBG_STATIC_SMPS -+ if (pmlmeext->ssmps_test) { -+ enter_smps = (pmlmeext->ssmps_test_en == 1) ? _TRUE : _FALSE; -+ } -+ else -+ #endif -+ { -+ if ((tx_tp_mbits <= pmlmeext->ssmps_tx_tp_th) && -+ (rx_tp_mbits <= pmlmeext->ssmps_rx_tp_th)) -+ enter_smps = _TRUE; -+ else -+ enter_smps = _FALSE; -+ } -+ -+ if (1) { -+ RTW_INFO(FUNC_ADPT_FMT" tx_tp:%d [%d], rx_tp:%d [%d] , SSMPS enter :%s\n", -+ FUNC_ADPT_ARG(adapter), -+ tx_tp_mbits, pmlmeext->ssmps_tx_tp_th, -+ rx_tp_mbits, pmlmeext->ssmps_rx_tp_th, -+ (enter_smps == _TRUE) ? "True" : "False"); -+ #ifdef DBG_STATIC_SMPS -+ RTW_INFO(FUNC_ADPT_FMT" test:%d test_en:%d\n", -+ FUNC_ADPT_ARG(adapter), -+ pmlmeext->ssmps_test, -+ pmlmeext->ssmps_test_en); -+ #endif -+ } -+ -+ if (enter_smps) { -+ if (!from_timer && psta->cmn.sm_ps != SM_PS_STATIC) -+ rtw_ssmps_enter(adapter, psta); -+ } else { -+ if (!from_timer && psta->cmn.sm_ps != SM_PS_DISABLE) -+ rtw_ssmps_leave(adapter, psta); -+ else { -+ u8 ps_change = _FALSE; -+ -+ if (enter_smps && psta->cmn.sm_ps != SM_PS_STATIC) -+ ps_change = _TRUE; -+ else if (!enter_smps && psta->cmn.sm_ps != SM_PS_DISABLE) -+ ps_change = _TRUE; -+ -+ if (ps_change) -+ rtw_ssmps_wk_cmd(adapter, psta, enter_smps, 1); -+ } -+ } -+ -+ return enter_smps; -+} -+#endif /*CONFIG_SUPPORT_STATIC_SMPS*/ -+ -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+void rtw_ctrl_txss_update_mimo_type(_adapter *adapter, struct sta_info *sta) -+{ -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ pmlmeext->txss_momi_type_bk = sta->cmn.mimo_type; -+} -+ -+u8 rtw_ctrl_txss(_adapter *adapter, struct sta_info *sta, bool tx_1ss) -+{ -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ u8 lps_changed = _FALSE; -+ u8 rst = _SUCCESS; -+ -+ if (pmlmeext->txss_1ss == tx_1ss) -+ return _FALSE; -+ -+ if (pwrpriv->bLeisurePs && pwrpriv->pwr_mode != PS_MODE_ACTIVE) { -+ lps_changed = _TRUE; -+ LPS_Leave(adapter, "LPS_CTRL_TXSS"); -+ } -+ -+ RTW_INFO(ADPT_FMT" STA [" MAC_FMT "] set tx to %d ss\n", -+ ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr), -+ (tx_1ss) ? 1 : rtw_get_sta_tx_nss(adapter, sta)); -+ -+ /*ra re-registed*/ -+ sta->cmn.mimo_type = (tx_1ss) ? RF_1T1R : pmlmeext->txss_momi_type_bk; -+ rtw_phydm_ra_registed(adapter, sta); -+ -+ /*configure trx mode*/ -+ rtw_phydm_trx_cfg(adapter, tx_1ss); -+ pmlmeext->txss_1ss = tx_1ss; -+ -+ if (lps_changed) -+ LPS_Enter(adapter, "LPS_CTRL_TXSS"); -+ -+ return rst; -+} -+ -+u8 rtw_ctrl_txss_wk_hdl(_adapter *adapter, struct txss_cmd_parm *txss_param) -+{ -+ if (!txss_param->sta) -+ return _FALSE; -+ -+ return rtw_ctrl_txss(adapter, txss_param->sta, txss_param->tx_1ss); -+} -+ -+u8 rtw_ctrl_txss_wk_cmd(_adapter *adapter, struct sta_info *sta, bool tx_1ss, u8 flag) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *cmd_parm; -+ struct txss_cmd_parm *txss_param; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ txss_param = (struct txss_cmd_parm *)rtw_zmalloc(sizeof(struct txss_cmd_parm)); -+ if (txss_param == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ txss_param->tx_1ss = tx_1ss; -+ txss_param->sta = sta; -+ -+ if (flag & RTW_CMDF_DIRECTLY) { -+ res = rtw_ctrl_txss_wk_hdl(adapter, txss_param); -+ rtw_mfree((u8 *)txss_param, sizeof(*txss_param)); -+ } else { -+ 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; -+ } -+ -+ cmd_parm->ec_id = TXSS_WK_CID; -+ cmd_parm->type = 0; -+ cmd_parm->size = sizeof(struct txss_cmd_parm); -+ cmd_parm->pbuf = (u8 *)txss_param; -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, cmd_parm, CMD_SET_DRV_EXTRA); -+ -+ if (flag & RTW_CMDF_WAIT_ACK) { -+ cmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 10 * 1000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ if (res == _SUCCESS && (flag & 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; -+} -+ -+void rtw_ctrl_tx_ss_by_tp(_adapter *adapter, u8 from_timer) -+{ -+ bool tx_1ss = _FALSE; /*change tx from 2ss to 1ss*/ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta; -+ u32 tx_tp_mbits; -+ -+ if (!MLME_IS_STA(adapter) || -+ !hal_is_mimo_support(adapter) || -+ !pmlmeext->txss_ctrl_en -+ ) -+ return; -+ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ RTW_ERR(ADPT_FMT" sta == NULL\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ tx_tp_mbits = psta->sta_stats.tx_tp_kbits >> 10; -+ if (tx_tp_mbits >= pmlmeext->txss_tp_th) { -+ tx_1ss = _FALSE; -+ } else { -+ if (pmlmeext->txss_tp_chk_cnt && --pmlmeext->txss_tp_chk_cnt) -+ tx_1ss = _FALSE; -+ else -+ tx_1ss = _TRUE; -+ } -+ -+ if (1) { -+ RTW_INFO(FUNC_ADPT_FMT" tx_tp:%d [%d] tx_1ss(%d):%s\n", -+ FUNC_ADPT_ARG(adapter), -+ tx_tp_mbits, pmlmeext->txss_tp_th, -+ pmlmeext->txss_tp_chk_cnt, -+ (tx_1ss == _TRUE) ? "True" : "False"); -+ } -+ -+ if (pmlmeext->txss_1ss != tx_1ss) { -+ if (from_timer) -+ rtw_ctrl_txss_wk_cmd(adapter, psta, tx_1ss, 0); -+ else -+ rtw_ctrl_txss(adapter, psta, tx_1ss); -+ } -+} -+#ifdef DBG_CTRL_TXSS -+void dbg_ctrl_txss(_adapter *adapter, bool tx_1ss) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta; -+ -+ if (!MLME_IS_STA(adapter) || -+ !hal_is_mimo_support(adapter) -+ ) -+ return; -+ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ RTW_ERR(ADPT_FMT" sta == NULL\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ rtw_ctrl_txss(adapter, psta, tx_1ss); -+} -+#endif -+#endif /*CONFIG_CTRL_TXSS_BY_TP*/ -+ -+#ifdef CONFIG_LPS -+#ifdef CONFIG_LPS_CHK_BY_TP -+#ifdef LPS_BCN_CNT_MONITOR -+static u8 _bcn_cnt_expected(struct sta_info *psta) -+{ -+ _adapter *adapter = psta->padapter; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 dtim = rtw_get_bcn_dtim_period(adapter); -+ u8 bcn_cnt = 0; -+ -+ if ((pmlmeinfo->bcn_interval !=0) && (dtim != 0)) -+ bcn_cnt = 2000 / pmlmeinfo->bcn_interval / dtim * 4 / 5; /*2s*/ -+ if (0) -+ RTW_INFO("%s bcn_cnt:%d\n", __func__, bcn_cnt); -+ -+ if (bcn_cnt == 0) { -+ RTW_ERR(FUNC_ADPT_FMT" bcn_cnt == 0\n", FUNC_ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ } -+ -+ return bcn_cnt; -+} -+#endif -+u8 _lps_chk_by_tp(_adapter *adapter, u8 from_timer) -+{ -+ u8 enter_ps = _FALSE; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ u32 tx_tp_mbits, rx_tp_mbits, bi_tp_mbits; -+ u8 rx_bcn_cnt; -+ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ RTW_ERR(ADPT_FMT" sta == NULL\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ return enter_ps; -+ } -+ -+ rx_bcn_cnt = rtw_get_bcn_cnt(psta->padapter); -+ psta->sta_stats.acc_tx_bytes = psta->sta_stats.tx_bytes; -+ psta->sta_stats.acc_rx_bytes = psta->sta_stats.rx_bytes; -+ -+#if 1 -+ tx_tp_mbits = psta->sta_stats.tx_tp_kbits >> 10; -+ rx_tp_mbits = psta->sta_stats.rx_tp_kbits >> 10; -+ bi_tp_mbits = tx_tp_mbits + rx_tp_mbits; -+#else -+ tx_tp_mbits = psta->sta_stats.smooth_tx_tp_kbits >> 10; -+ rx_tp_mbits = psta->sta_stats.smooth_rx_tp_kbits >> 10; -+ bi_tp_mbits = tx_tp_mbits + rx_tp_mbits; -+#endif -+ -+ if ((bi_tp_mbits >= pwrpriv->lps_bi_tp_th) || -+ (tx_tp_mbits >= pwrpriv->lps_tx_tp_th) || -+ (rx_tp_mbits >= pwrpriv->lps_rx_tp_th)) { -+ enter_ps = _FALSE; -+ pwrpriv->lps_chk_cnt = pwrpriv->lps_chk_cnt_th; -+ } -+ else { -+#ifdef LPS_BCN_CNT_MONITOR -+ u8 bcn_cnt = _bcn_cnt_expected(psta); -+ -+ if (bcn_cnt && (rx_bcn_cnt < bcn_cnt)) { -+ pwrpriv->lps_chk_cnt = 2; -+ RTW_ERR(FUNC_ADPT_FMT" BCN_CNT:%d(%d) invalid\n", -+ FUNC_ADPT_ARG(adapter), rx_bcn_cnt, bcn_cnt); -+ } -+#endif -+ -+ if (pwrpriv->lps_chk_cnt && --pwrpriv->lps_chk_cnt) -+ enter_ps = _FALSE; -+ else -+ enter_ps = _TRUE; -+ } -+ -+ if (1) { -+ RTW_INFO(FUNC_ADPT_FMT" tx_tp:%d [%d], rx_tp:%d [%d], bi_tp:%d [%d], enter_ps(%d):%s\n", -+ FUNC_ADPT_ARG(adapter), -+ tx_tp_mbits, pwrpriv->lps_tx_tp_th, -+ rx_tp_mbits, pwrpriv->lps_rx_tp_th, -+ bi_tp_mbits, pwrpriv->lps_bi_tp_th, -+ pwrpriv->lps_chk_cnt, -+ (enter_ps == _TRUE) ? "True" : "False"); -+ RTW_INFO(FUNC_ADPT_FMT" tx_pkt_cnt :%d [%d], rx_pkt_cnt :%d [%d]\n", -+ FUNC_ADPT_ARG(adapter), -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, -+ pwrpriv->lps_tx_pkts, -+ pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod, -+ pwrpriv->lps_rx_pkts); -+ if (!adapter->bsta_tp_dump) -+ RTW_INFO(FUNC_ADPT_FMT" bcn_cnt:%d (per-%d second)\n", -+ FUNC_ADPT_ARG(adapter), -+ rx_bcn_cnt, -+ 2); -+ } -+ -+ if (enter_ps) { -+ if (!from_timer) -+ LPS_Enter(adapter, "TRAFFIC_IDLE"); -+ } else { -+ if (!from_timer) -+ LPS_Leave(adapter, "TRAFFIC_BUSY"); -+ else { -+ #ifdef CONFIG_CONCURRENT_MODE -+ #ifndef CONFIG_FW_MULTI_PORT_SUPPORT -+ if (adapter->hw_port == HW_PORT0) -+ #endif -+ #endif -+ rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_TRAFFIC_BUSY, 0); -+ } -+ } -+ -+ return enter_ps; -+} -+#endif -+ -+static u8 _lps_chk_by_pkt_cnts(_adapter *padapter, u8 from_timer, u8 bBusyTraffic) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bEnterPS = _FALSE; -+ -+ /* 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, 0); */ -+ /* 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 -+ #ifndef CONFIG_FW_MULTI_PORT_SUPPORT -+ if (padapter->hw_port == HW_PORT0) -+ #endif -+ #endif -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_TRAFFIC_BUSY, 0); -+ } -+ } -+ -+ return bEnterPS; -+} -+#endif /* CONFIG_LPS */ -+ -+/* 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 */ -+#ifdef CONFIG_TRAFFIC_PROTECT -+ RT_LINK_DETECT_T *link_detect = &pmlmepriv->LinkDetectInfo; -+#endif -+ -+#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, WIFI_ASOC_STATE) == _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_SUPPORT_STATIC_SMPS -+ _ssmps_chk_by_tp(padapter, from_timer); -+#endif -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+ rtw_ctrl_tx_ss_by_tp(padapter, from_timer); -+#endif -+ -+#ifdef CONFIG_LPS -+ if (adapter_to_pwrctl(padapter)->bLeisurePs && MLME_IS_STA(padapter)) { -+ #ifdef CONFIG_LPS_CHK_BY_TP -+ if (adapter_to_pwrctl(padapter)->lps_chk_by_tp) -+ bEnterPS = _lps_chk_by_tp(padapter, from_timer); -+ else -+ #endif /*CONFIG_LPS_CHK_BY_TP*/ -+ bEnterPS = _lps_chk_by_pkt_cnts(padapter, from_timer, bBusyTraffic); -+ } -+#endif /* CONFIG_LPS */ -+ -+ } else { -+#ifdef CONFIG_LPS -+ if (!from_timer && rtw_mi_get_assoc_if_num(padapter) == 0) -+ LPS_Leave(padapter, "NON_LINKED"); -+#endif -+ } -+ -+ session_tracker_chk_cmd(padapter, NULL); -+ -+#ifdef CONFIG_BEAMFORMING -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ rtw_bf_update_traffic(padapter); -+#endif /* RTW_BEAMFORMING_VERSION_2 */ -+#endif /* CONFIG_BEAMFORMING */ -+ -+ 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; -+ -+} -+ -+#ifdef CONFIG_AP_MODE -+/* 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 (!padapter->registrypriv.ht_enable || !is_supported_ht(padapter->registrypriv.wireless_mode)) -+ return; -+ -+ if (!MLME_IS_AP(padapter)) -+ return; -+ -+ 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; -+#ifdef CONFIG_80211N_HT -+ 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, 0); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE, 0); -+ } -+ } -+#endif /* CONFIG_80211N_HT */ -+ } -+ -+#ifdef CONFIG_80211N_HT -+ /* 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, 0); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE, 0); -+ -+ } -+ ATOMIC_SET(&pmlmepriv->olbc, _FALSE); -+ ATOMIC_SET(&pmlmepriv->olbc_ht, _FALSE); -+ count = 0; -+ } -+#endif /* CONFIG_80211N_HT */ -+ count ++; -+ } -+} -+#endif /* CONFIG_AP_MODE */ -+ -+void rtw_iface_dynamic_chk_wk_hdl(_adapter *padapter) -+{ -+ #ifdef CONFIG_AP_MODE -+ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { -+ expire_timeout_chk(padapter); -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter) && MLME_IS_ASOC(padapter)) -+ rtw_mesh_peer_status_chk(padapter); -+ #endif -+ } -+ #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ -+ dynamic_update_bcn_check(padapter); -+ -+ #endif /* CONFIG_AP_MODE */ -+ -+ linked_status_chk(padapter, 0); -+ traffic_status_watchdog(padapter, 0); -+ -+ /* for debug purpose */ -+ _linked_info_dump(padapter); -+ -+#ifdef CONFIG_RTW_CFGVENDOR_RSSIMONITOR -+ rtw_cfgvendor_rssi_monitor_evt(padapter); -+#endif -+ -+ -+} -+void rtw_dynamic_chk_wk_hdl(_adapter *padapter) -+{ -+ rtw_mi_dynamic_chk_wk_hdl(padapter); -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mp_mode_check(padapter) == _FALSE) -+#endif -+ { -+#ifdef DBG_CONFIG_ERROR_DETECT -+ rtw_hal_sreset_xmit_status_check(padapter); -+ rtw_hal_sreset_linked_status_check(padapter); -+#endif -+ } -+ -+ /* if(check_fwstate(pmlmepriv, WIFI_UNDER_LINKING|WIFI_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_RTW_MULTI_AP -+ rtw_ch_util_rpt(padapter); -+#endif -+ -+#ifdef CONFIG_DFS_MASTER -+ rtw_chset_chk_non_ocp_finish(adapter_to_rfctl(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 */ -+ -+ rtw_hal_periodic_tsf_update_chk(padapter); -+} -+ -+#ifdef CONFIG_LPS -+struct lps_ctrl_wk_parm { -+ s8 lps_level; -+ #ifdef CONFIG_LPS_1T1R -+ s8 lps_1t1r; -+ #endif -+}; -+ -+void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type, u8 *buf) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct lps_ctrl_wk_parm *parm = (struct lps_ctrl_wk_parm *)buf; -+ 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, WIFI_ASOC_STATE) == _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"); */ -+ rtw_set_lps_deny(padapter, LPS_DELAY_MS); -+#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_SET_OPTION: -+ LPS_Leave(padapter, "LPS_CTRL_LEAVE_SET_OPTION"); -+ if (parm) { -+ if (parm->lps_level >= 0) -+ pwrpriv->lps_level = parm->lps_level; -+ #ifdef CONFIG_LPS_1T1R -+ if (parm->lps_1t1r >= 0) -+ pwrpriv->lps_1t1r = parm->lps_1t1r; -+ #endif -+ } -+ 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; -+ } -+ -+} -+ -+static u8 _rtw_lps_ctrl_wk_cmd(_adapter *adapter, u8 lps_ctrl_type, s8 lps_level, s8 lps_1t1r, u8 flags) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *parm; -+ struct lps_ctrl_wk_parm *wk_parm = NULL; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ if (lps_ctrl_type == LPS_CTRL_LEAVE_SET_OPTION) { -+ wk_parm = rtw_zmalloc(sizeof(*wk_parm)); -+ if (wk_parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ wk_parm->lps_level = lps_level; -+ #ifdef CONFIG_LPS_1T1R -+ wk_parm->lps_1t1r = lps_1t1r; -+ #endif -+ } -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly */ -+ lps_ctrl_wk_hdl(adapter, lps_ctrl_type, (u8 *)wk_parm); -+ if (wk_parm) -+ rtw_mfree(wk_parm, sizeof(*wk_parm)); -+ } else { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ parm = rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) { -+ if (wk_parm) -+ rtw_mfree(wk_parm, sizeof(*wk_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm->ec_id = LPS_CTRL_WK_CID; -+ parm->type = lps_ctrl_type; -+ parm->size = wk_parm ? sizeof(*wk_parm) : 0; -+ parm->pbuf = (u8 *)wk_parm; -+ -+ cmdobj = rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ rtw_mfree(parm, sizeof(*parm)); -+ if (wk_parm) -+ rtw_mfree(wk_parm, sizeof(*wk_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, CMD_SET_DRV_EXTRA); -+ -+ 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); -+ if (sctx.status != RTW_SCTX_DONE_SUCCESS) -+ res = _FAIL; -+ } -+ } -+ -+exit: -+ return res; -+} -+ -+u8 rtw_lps_ctrl_wk_cmd(_adapter *adapter, u8 lps_ctrl_type, u8 flags) -+{ -+ return _rtw_lps_ctrl_wk_cmd(adapter, lps_ctrl_type, -1, -1, flags); -+} -+ -+u8 rtw_lps_ctrl_leave_set_level_cmd(_adapter *adapter, u8 lps_level, u8 flags) -+{ -+ return _rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_LEAVE_SET_OPTION, lps_level, -1, flags); -+} -+ -+#ifdef CONFIG_LPS_1T1R -+u8 rtw_lps_ctrl_leave_set_1t1r_cmd(_adapter *adapter, u8 lps_1t1r, u8 flags) -+{ -+ return _rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_LEAVE_SET_OPTION, -1, lps_1t1r, flags); -+} -+#endif -+ -+void rtw_dm_in_lps_hdl(_adapter *padapter) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_IN_LPS_LCLK, 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, CMD_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_exec_lps(padapter, 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, CMD_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, CMD_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, CMD_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, CMD_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); -+} -+ -+#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, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+ -+} -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+static struct rtw_roch_parm *rtw_alloc_roch_parm(_adapter *adapter -+ , u64 cookie, struct wireless_dev *wdev -+ , struct ieee80211_channel *ch, enum nl80211_channel_type ch_type -+ , unsigned int duration -+ , u8 flags -+) -+{ -+ struct rtw_roch_parm *roch_parm; -+ bool cancel = duration ? 0 : 1; -+ -+ roch_parm = (struct rtw_roch_parm *)rtw_zmalloc(sizeof(struct rtw_roch_parm)); -+ if (!roch_parm) -+ return NULL; -+ -+ 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; -+ } -+ -+ return roch_parm; -+} -+ -+inline u8 rtw_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 rtw_roch_parm *roch_parm; -+ -+ roch_parm = rtw_alloc_roch_parm(adapter, cookie, wdev, ch, ch_type, duration, flags); -+ if (!roch_parm) -+ return _FAIL; -+ -+ return rtw_roch_wk_cmd(adapter, ROCH_RO_CH_WK, roch_parm, flags); -+} -+ -+inline u8 rtw_cancel_roch_cmd(_adapter *adapter, u64 cookie, struct wireless_dev *wdev, u8 flags) -+{ -+ struct rtw_roch_parm *roch_parm; -+ -+ roch_parm = rtw_alloc_roch_parm(adapter, cookie, wdev, NULL, 0, 0, flags); -+ if (!roch_parm) -+ return _FAIL; -+ -+ return rtw_roch_wk_cmd(adapter, ROCH_CANCEL_RO_CH_WK, roch_parm, flags); -+} -+ -+inline u8 rtw_mgnt_tx_cmd(_adapter *adapter, u8 tx_ch, u8 no_cck, const u8 *buf, size_t len, int wait_ack, u8 flags) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *parm; -+ struct mgnt_tx_parm *mgnt_parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ mgnt_parm = (struct mgnt_tx_parm *)rtw_zmalloc(sizeof(struct mgnt_tx_parm)); -+ if (mgnt_parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ mgnt_parm->tx_ch = tx_ch; -+ mgnt_parm->no_cck = no_cck; -+ mgnt_parm->buf = buf; -+ mgnt_parm->len = len; -+ mgnt_parm->wait_ack = wait_ack; -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != rtw_mgnt_tx_handler(adapter, (u8 *)mgnt_parm)) -+ res = _FAIL; -+ rtw_mfree((u8 *)mgnt_parm, sizeof(*mgnt_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 *)mgnt_parm, sizeof(*mgnt_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm->ec_id = MGNT_TX_WK_CID; -+ parm->type = 0; -+ parm->size = sizeof(*mgnt_parm); -+ parm->pbuf = (u8 *)mgnt_parm; -+ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ rtw_mfree((u8 *)mgnt_parm, sizeof(*mgnt_parm)); -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, CMD_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; -+} -+#endif -+ -+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 (!is_primary_adapter(padapter)) -+ 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, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ppscmd); -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+#if CONFIG_DFS -+void rtw_dfs_ch_switch_hdl(struct dvobj_priv *dvobj) -+{ -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ _adapter *pri_adapter = dvobj_get_primary_adapter(dvobj); -+ struct mlme_ext_priv *pmlmeext = &pri_adapter->mlmeextpriv; -+ u8 ifbmp_m = rtw_mi_get_ap_mesh_ifbmp(pri_adapter); -+ u8 ifbmp_s = rtw_mi_get_ld_sta_ifbmp(pri_adapter); -+ s16 req_ch; -+ u8 req_bw = CHANNEL_WIDTH_20, req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE, csa_timer = _FALSE; -+ u8 need_discon = _FALSE; -+ -+ rtw_hal_macid_sleep_all_used(pri_adapter); -+ -+ if (rtw_chset_search_ch(rfctl->channel_set, rfctl->csa_ch) >= 0 -+ && !rtw_chset_is_ch_non_ocp(rfctl->channel_set, rfctl->csa_ch) -+ ) { -+ /* CSA channel available and valid */ -+ req_ch = rfctl->csa_ch; -+ RTW_INFO("%s valid CSA ch%u\n", __func__, rfctl->csa_ch); -+ csa_timer = _TRUE; -+ } else if (ifbmp_m) { -+ /* no available or valid CSA channel, having AP/MESH ifaces */ -+ req_ch = REQ_CH_NONE; -+ need_discon = _TRUE; -+ RTW_INFO("%s ch sel by AP/MESH ifaces\n", __func__); -+ } else { -+ /* no available or valid CSA channel and no AP/MESH ifaces */ -+ if (!IsSupported24G(dvobj_to_regsty(dvobj)->wireless_mode) -+ #ifdef CONFIG_DFS_MASTER -+ || rfctl->radar_detected -+ #endif -+ ) -+ req_ch = 36; -+ else -+ req_ch = 1; -+ need_discon = _TRUE; -+ RTW_INFO("%s switch to ch%d, then disconnect with AP\n", __func__, req_ch); -+ } -+ -+ if (!need_discon) { -+ /* fault tolerant for AP */ -+ if(rfctl->csa_ch_width == 1 || rfctl->csa_ch_width == 2 || rfctl->csa_ch_width == 3) { -+ if (rtw_get_offset_by_chbw(req_ch, CHANNEL_WIDTH_80, &req_offset)) { -+ /* always use 80 Mhz to connect if ch/bw/offset is valid */ -+ req_bw = CHANNEL_WIDTH_80; -+ } else { -+ req_bw = CHANNEL_WIDTH_20; -+ req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ } else if(rfctl->csa_ch_offset == 1) { -+ req_bw = CHANNEL_WIDTH_40; -+ req_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ } else if(rfctl->csa_ch_offset == 3) { -+ req_bw = CHANNEL_WIDTH_40; -+ req_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ } else{ -+ req_bw = CHANNEL_WIDTH_20; -+ req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ } -+ -+ RTW_INFO("req_ch=%d, req_bw=%d, req_offset=%d, ifbmp_m=0x%02x, ifbmp_s=0x%02x\n" -+ , req_ch, req_bw, req_offset, ifbmp_m, ifbmp_s); -+ -+ /* check all STA ifaces status */ -+ if (ifbmp_s) { -+ _adapter *iface; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface || !(ifbmp_s & BIT(iface->iface_id))) -+ continue; -+ -+ if (need_discon) { -+ /* CSA channel not available or not valid, then disconnect */ -+ set_fwstate(&iface->mlmepriv, WIFI_OP_CH_SWITCHING); -+ issue_deauth(iface, get_bssid(&iface->mlmepriv), WLAN_REASON_DEAUTH_LEAVING); -+ } else { -+ /* update STA mode ch/bw/offset */ -+ iface->mlmeextpriv.cur_channel = req_ch; -+ iface->mlmeextpriv.cur_bwmode = req_bw; -+ iface->mlmeextpriv.cur_ch_offset = req_offset; -+ /* updaet STA mode DSConfig , ap mode will update in rtw_change_bss_chbw_cmd */ -+ iface->mlmepriv.cur_network.network.Configuration.DSConfig = req_ch; -+ set_fwstate(&iface->mlmepriv, WIFI_CSA_UPDATE_BEACON); -+ -+ #ifdef CONFIG_80211D -+ if (iface->mlmepriv.recv_country_ie) { -+ if (rtw_apply_recv_country_ie_cmd(iface, RTW_CMDF_DIRECTLY -+ , req_ch > 14 ? BAND_ON_5G : BAND_ON_2_4G, req_ch -+ , iface->mlmepriv.recv_country_ie) != _SUCCESS -+ ) -+ RTW_WARN(FUNC_ADPT_FMT" rtw_apply_recv_country_ie_cmd() fail\n", FUNC_ADPT_ARG(iface)); -+ } -+ #endif -+ } -+ } -+ } -+ -+ if (csa_timer) { -+ RTW_INFO("pmlmeext->csa_timer 70 seconds\n"); -+ /* wait 70 seconds for receiving beacons */ -+ _set_timer(&pmlmeext->csa_timer, CAC_TIME_MS + 10000); -+ } -+ -+#ifdef CONFIG_AP_MODE -+ if (ifbmp_m) { -+ u8 execlude = 0; -+ -+ if (need_discon) -+ execlude = ifbmp_s; -+ /* trigger channel selection with consideraton of asoc STA ifaces */ -+ rtw_change_bss_chbw_cmd(dvobj_get_primary_adapter(dvobj), RTW_CMDF_DIRECTLY -+ , ifbmp_m, execlude, req_ch, REQ_BW_ORI, REQ_OFFSET_NONE); -+ } else -+#endif -+ { -+ /* no AP/MESH iface, switch DFS status and channel directly */ -+ rtw_warn_on(req_ch <= 0); -+ #ifdef CONFIG_DFS_MASTER -+ if (need_discon) -+ rtw_dfs_rd_en_decision(pri_adapter, MLME_OPCH_SWITCH, ifbmp_s); -+ else -+ rtw_dfs_rd_en_decision(pri_adapter, MLME_OPCH_SWITCH, 0); -+ #endif -+ LeaveAllPowerSaveModeDirect(pri_adapter); -+ set_channel_bwmode(pri_adapter, req_ch, req_offset, req_bw); -+ /* update union ch/bw/offset for STA only */ -+ rtw_mi_update_union_chan_inf(pri_adapter, req_ch, req_offset, req_bw); -+ rtw_rfctl_update_op_mode(rfctl, 0, 0); -+ } -+ -+ /* make asoc STA ifaces disconnect */ -+ if (ifbmp_s && need_discon) { -+ _adapter *iface; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface || !(ifbmp_s & BIT(iface->iface_id))) -+ continue; -+ rtw_disassoc_cmd(iface, 0, RTW_CMDF_DIRECTLY); -+ rtw_indicate_disconnect(iface, 0, _FALSE); -+ rtw_free_assoc_resources(iface, _TRUE); -+ rtw_free_network_queue(iface, _TRUE); -+ } -+ } -+ -+ rfctl->csa_ch = 0; -+ rfctl->csa_switch_cnt = 0; -+ rfctl->csa_ch_offset = 0; -+ rfctl->csa_ch_width = 0; -+ rfctl->csa_ch_freq_seg0 = 0; -+ rfctl->csa_ch_freq_seg1 = 0; -+ -+ rtw_hal_macid_wakeup_all_used(pri_adapter); -+ rtw_mi_os_xmit_schedule(pri_adapter); -+} -+#endif /* CONFIG_DFS */ -+ -+#ifdef CONFIG_AP_MODE -+ -+static void rtw_chk_hi_queue_hdl(_adapter *padapter) -+{ -+ struct sta_info *psta_bmc; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ systime 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 (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0)) -+ update_tim = _TRUE; -+ -+ rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, 0); -+ rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, 0); -+ -+ if (update_tim == _TRUE) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0,"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, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+#ifdef CONFIG_DFS_MASTER -+u8 rtw_dfs_rd_hdl(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ u8 cch; -+ -+ if (!rfctl->radar_detect_enabled) -+ goto exit; -+ -+ cch = rtw_get_center_ch(rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); -+ -+ if (dvobj->oper_channel != rfctl->radar_detect_ch -+ || rtw_get_passing_time_ms(rtw_get_on_oper_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_fake_radar_detect_cnt -+ && rtw_odm_radar_detect(adapter) != _TRUE) -+ goto cac_status_chk; -+ -+ if (!rfctl->dbg_dfs_fake_radar_detect_cnt -+ && rfctl->dbg_dfs_radar_detect_trigger_non -+ ) { -+ /* radar detect debug mode, trigger no mlme flow */ -+ RTW_INFO("%s radar detected on test mode, trigger no mlme flow\n", __func__); -+ goto cac_status_chk; -+ } -+ -+ if (rfctl->dbg_dfs_fake_radar_detect_cnt != 0) { -+ RTW_INFO("%s fake radar detected, cnt:%d\n", __func__ -+ , rfctl->dbg_dfs_fake_radar_detect_cnt); -+ rfctl->dbg_dfs_fake_radar_detect_cnt--; -+ } else -+ RTW_INFO("%s radar detected\n", __func__); -+ -+ rfctl->radar_detected = 1; -+ -+ rtw_chset_update_non_ocp(rfctl->channel_set -+ , rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); -+ -+ if (IS_UNDER_CAC(rfctl)) -+ rtw_nlrtw_cac_abort_event(adapter, cch, rfctl->radar_detect_bw); -+ rtw_nlrtw_radar_detect_event(adapter, cch, rfctl->radar_detect_bw); -+ -+ rtw_dfs_ch_switch_hdl(dvobj); -+ -+ if (rfctl->radar_detect_enabled) -+ goto set_timer; -+ goto exit; -+ -+cac_status_chk: -+ -+ if (!IS_CAC_STOPPED(rfctl) -+ && ((IS_UNDER_CAC(rfctl) && rfctl->cac_force_stop) -+ || !IS_CH_WAITING(rfctl) -+ ) -+ ) { -+ u8 pause = 0x00; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); -+ rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; -+ rtw_nlrtw_cac_finish_event(adapter, cch, rfctl->radar_detect_bw); -+ -+ if (rtw_mi_check_fwstate(adapter, WIFI_UNDER_LINKING|WIFI_UNDER_SURVEY) == _FALSE) { -+ u8 doiqk = _TRUE; -+ u8 u_ch, u_bw, u_offset; -+ -+ rtw_hal_set_hwreg(adapter , HW_VAR_DO_IQK , &doiqk); -+ -+ if (rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset)) -+ set_channel_bwmode(adapter, u_ch, u_offset, u_bw); -+ else -+ rtw_warn_on(1); -+ -+ doiqk = _FALSE; -+ rtw_hal_set_hwreg(adapter , HW_VAR_DO_IQK , &doiqk); -+ -+ #ifdef CONFIG_AP_MODE -+ ResumeTxBeacon(adapter); -+ rtw_mi_tx_beacon_hdl(adapter); -+ #endif -+ } -+ } -+ -+set_timer: -+ _set_timer(&rfctl->radar_detect_timer -+ , rtw_odm_radar_detect_polling_int_ms(dvobj)); -+ -+exit: -+ return H2C_SUCCESS; -+} -+ -+u8 rtw_dfs_rd_cmd(_adapter *adapter, bool enqueue) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *parm; -+ struct cmd_priv *cmdpriv = &adapter->cmdpriv; -+ u8 res = _FAIL; -+ -+ if (enqueue) { -+ cmdobj = rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == NULL) -+ goto exit; -+ -+ parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (parm == NULL) { -+ rtw_mfree(cmdobj, sizeof(struct cmd_obj)); -+ goto exit; -+ } -+ -+ parm->ec_id = DFS_RADAR_DETECT_WK_CID; -+ parm->type = 0; -+ parm->size = 0; -+ parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, CMD_SET_DRV_EXTRA); -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ } else { -+ rtw_dfs_rd_hdl(adapter); -+ res = _SUCCESS; -+ } -+ -+exit: -+ return res; -+} -+ -+void rtw_dfs_rd_timer_hdl(void *ctx) -+{ -+ struct rf_ctl_t *rfctl = (struct rf_ctl_t *)ctx; -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ -+ rtw_dfs_rd_cmd(dvobj_get_primary_adapter(dvobj), _TRUE); -+} -+ -+static void rtw_dfs_rd_enable(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, bool bypass_cac) -+{ -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ _adapter *adapter = dvobj_get_primary_adapter(dvobj); -+ -+ RTW_INFO("%s on %u,%u,%u\n", __func__, ch, bw, offset); -+ -+ if (bypass_cac) -+ rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; -+ else if (rtw_is_cac_reset_needed(rfctl, ch, bw, offset) == _TRUE) -+ rtw_reset_cac(rfctl, 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 (IS_CH_WAITING(rfctl)) -+ StopTxBeacon(adapter); -+ -+ if (!rfctl->radar_detect_enabled) { -+ RTW_INFO("%s set radar_detect_enabled\n", __func__); -+ rfctl->radar_detect_enabled = 1; -+ #ifdef CONFIG_LPS -+ LPS_Leave(adapter, "RADAR_DETECT_EN"); -+ #endif -+ _set_timer(&rfctl->radar_detect_timer -+ , rtw_odm_radar_detect_polling_int_ms(dvobj)); -+ -+ 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); -+ } -+ } -+} -+ -+static void rtw_dfs_rd_disable(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, bool by_others) -+{ -+ _adapter *adapter = dvobj_get_primary_adapter(rfctl_to_dvobj(rfctl)); -+ -+ rfctl->radar_detect_by_others = by_others; -+ -+ if (rfctl->radar_detect_enabled) { -+ bool overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); -+ -+ RTW_INFO("%s clear radar_detect_enabled\n", __func__); -+ -+ rfctl->radar_detect_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(&rfctl->radar_detect_timer); -+ -+ if (rtw_mi_check_fwstate(adapter, WIFI_UNDER_LINKING|WIFI_UNDER_SURVEY) == _FALSE) { -+ ResumeTxBeacon(adapter); -+ rtw_mi_tx_beacon_hdl(adapter); -+ } -+ -+ 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; -+ } else { -+ rfctl->radar_detect_ch = 0; -+ rfctl->radar_detect_bw = 0; -+ rfctl->radar_detect_offset = 0; -+ } -+} -+ -+void rtw_dfs_rd_en_decision(_adapter *adapter, u8 mlme_act, u8 excl_ifbmp) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct mi_state mstate; -+ u8 ifbmp; -+ u8 u_ch, u_bw, u_offset; -+ bool ld_sta_in_dfs = _FALSE; -+ bool sync_ch = _FALSE; /* _FALSE: asign channel directly */ -+ bool needed = _FALSE; -+ -+ if (mlme_act == MLME_OPCH_SWITCH -+ || mlme_act == MLME_ACTION_NONE -+ ) { -+ ifbmp = ~excl_ifbmp; -+ rtw_mi_status_by_ifbmp(dvobj, ifbmp, &mstate); -+ rtw_mi_get_ch_setting_union_by_ifbmp(dvobj, ifbmp, &u_ch, &u_bw, &u_offset); -+ } else { -+ ifbmp = ~excl_ifbmp & ~BIT(adapter->iface_id); -+ rtw_mi_status_by_ifbmp(dvobj, ifbmp, &mstate); -+ rtw_mi_get_ch_setting_union_by_ifbmp(dvobj, ifbmp, &u_ch, &u_bw, &u_offset); -+ if (u_ch != 0) -+ sync_ch = _TRUE; -+ -+ switch (mlme_act) { -+ case MLME_STA_CONNECTING: -+ MSTATE_STA_LG_NUM(&mstate)++; -+ break; -+ case MLME_STA_CONNECTED: -+ MSTATE_STA_LD_NUM(&mstate)++; -+ break; -+ case MLME_STA_DISCONNECTED: -+ break; -+#ifdef CONFIG_AP_MODE -+ case MLME_AP_STARTED: -+ MSTATE_AP_NUM(&mstate)++; -+ break; -+ case MLME_AP_STOPPED: -+ break; -+#endif -+#ifdef CONFIG_RTW_MESH -+ case MLME_MESH_STARTED: -+ MSTATE_MESH_NUM(&mstate)++; -+ break; -+ case MLME_MESH_STOPPED: -+ break; -+#endif -+ default: -+ rtw_warn_on(1); -+ break; -+ } -+ -+ if (sync_ch == _TRUE) { -+ if (!MLME_IS_OPCH_SW(adapter)) { -+ 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_LG_NUM(&mstate) > 0) { -+ /* STA mode is linking */ -+ goto apply; -+ } -+ -+ if (MSTATE_STA_LD_NUM(&mstate) > 0) { -+ if (rtw_chset_is_dfs_chbw(rfctl->channel_set, u_ch, u_bw, u_offset)) { -+ /* -+ * if operate as slave w/o radar detect, -+ * rely on AP on which STA mode connects -+ */ -+ if (IS_DFS_SLAVE_WITH_RD(rfctl) && !rtw_rfctl_dfs_domain_unknown(rfctl)) -+ needed = _TRUE; -+ ld_sta_in_dfs = _TRUE; -+ } -+ goto apply; -+ } -+ -+ if (!MSTATE_AP_NUM(&mstate) && !MSTATE_MESH_NUM(&mstate)) { -+ /* No working AP/Mesh mode */ -+ goto apply; -+ } -+ -+ if (rtw_chset_is_dfs_chbw(rfctl->channel_set, u_ch, u_bw, u_offset)) -+ needed = _TRUE; -+ -+apply: -+ -+ RTW_INFO(FUNC_ADPT_FMT" needed:%d, mlme_act:%u, excl_ifbmp:0x%02x\n" -+ , FUNC_ADPT_ARG(adapter), needed, mlme_act, excl_ifbmp); -+ RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num:%u, ap_num:%u, mesh_num:%u, %u,%u,%u\n" -+ , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_STA_LG_NUM(&mstate) -+ , MSTATE_AP_NUM(&mstate), MSTATE_MESH_NUM(&mstate) -+ , u_ch, u_bw, u_offset); -+ -+ if (needed == _TRUE) -+ rtw_dfs_rd_enable(rfctl, u_ch, u_bw, u_offset, ld_sta_in_dfs); -+ else -+ rtw_dfs_rd_disable(rfctl, u_ch, u_bw, u_offset, ld_sta_in_dfs); -+} -+ -+u8 rtw_dfs_rd_en_decision_cmd(_adapter *adapter) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *parm; -+ struct cmd_priv *cmdpriv = &adapter->cmdpriv; -+ u8 res = _FAIL; -+ -+ cmdobj = rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == NULL) -+ goto exit; -+ -+ parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (parm == NULL) { -+ rtw_mfree(cmdobj, sizeof(struct cmd_obj)); -+ goto exit; -+ } -+ -+ parm->ec_id = DFS_RADAR_DETECT_EN_DEC_WK_CID; -+ parm->type = 0; -+ parm->size = 0; -+ parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, CMD_SET_DRV_EXTRA); -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ -+exit: -+ return res; -+} -+#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, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+static void rtw_btc_reduce_wl_txpwr_hdl(_adapter *adapter, u32 pwr_lvl) -+{ -+ rtw_btcoex_set_reduced_wl_pwr_lvl(adapter, pwr_lvl); -+ rtw_btcoex_do_reduce_wl_pwr_lvl(adapter); -+ -+ RTW_INFO(FUNC_ADPT_FMT ": BTC reduce WL TxPwr %d dB!\n", -+ FUNC_ADPT_ARG(adapter), pwr_lvl); -+} -+ -+u8 rtw_btc_reduce_wl_txpwr_cmd(_adapter *adapter, u32 val) -+{ -+ struct cmd_obj *pcmdobj; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ 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; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = BTC_REDUCE_WL_TXPWR_CID; -+ pdrvextra_cmd_parm->type = val; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, pdrvextra_cmd_parm, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+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, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+exit: -+ return res; -+} -+ -+#ifdef CONFIG_MP_INCLUDED -+static s32 rtw_mp_cmd_hdl(_adapter *padapter, u8 mp_cmd_id) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ int ret = H2C_SUCCESS; -+ uint status = _SUCCESS; -+ -+ if (mp_cmd_id == MP_START) { -+ if (padapter->registrypriv.mp_mode == 0) { -+ rtw_intf_stop(padapter); -+ rtw_hal_deinit(padapter); -+ padapter->registrypriv.mp_mode = 1; -+#ifdef CONFIG_BT_COEXIST -+ padapter->mppriv.CureFuseBTCoex = pHalData->EEPROMBluetoothCoexist; -+ pHalData->EEPROMBluetoothCoexist = _FALSE; -+#endif -+#ifdef CONFIG_RF_POWER_TRIM -+ if (!IS_HARDWARE_TYPE_8814A(padapter) && !IS_HARDWARE_TYPE_8822B(padapter) -+ && !IS_HARDWARE_TYPE_8822C(padapter) && !IS_HARDWARE_TYPE_8723F(padapter)) { -+ padapter->registrypriv.RegPwrTrimEnable = 1; -+ rtw_hal_read_chip_info(padapter); -+ } -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ rtw_reset_drv_sw(padapter); -+#ifdef CONFIG_NEW_NETDEV_HDL -+ if (!rtw_is_hw_init_completed(padapter)) { -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) { -+ ret = H2C_REJECTED; -+ goto exit; -+ } -+ rtw_hal_iface_init(padapter); -+ } -+#else -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) { -+ ret = H2C_REJECTED; -+ goto exit; -+ } -+#endif /*CONFIG_NEW_NETDEV_HDL*/ -+#ifndef RTW_HALMAC -+ rtw_intf_start(padapter); -+#endif /* !RTW_HALMAC */ -+#ifdef RTW_HALMAC /*for New IC*/ -+ MPT_InitializeAdapter(padapter, 1); -+#endif /* CONFIG_MP_INCLUDED */ -+ } -+ -+ if (padapter->registrypriv.mp_mode == 0) { -+ ret = H2C_REJECTED; -+ goto exit; -+ } -+ -+ if (padapter->mppriv.mode == MP_OFF) { -+ if (mp_start_test(padapter) == _FAIL) { -+ ret = H2C_REJECTED; -+ goto exit; -+ } -+ 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); -+ -+ } else if (mp_cmd_id == MP_STOP) { -+ if (padapter->registrypriv.mp_mode == 1) { -+ MPT_DeInitAdapter(padapter); -+ rtw_intf_stop(padapter); -+ rtw_hal_deinit(padapter); -+ padapter->registrypriv.mp_mode = 0; -+#ifdef CONFIG_BT_COEXIST -+ pHalData->EEPROMBluetoothCoexist = padapter->mppriv.CureFuseBTCoex; -+#endif -+ rtw_reset_drv_sw(padapter); -+#ifdef CONFIG_NEW_NETDEV_HDL -+ if (!rtw_is_hw_init_completed(padapter)) { -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) { -+ ret = H2C_REJECTED; -+ goto exit; -+ } -+ rtw_hal_iface_init(padapter); -+ } -+#else -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) { -+ ret = H2C_REJECTED; -+ goto exit; -+ } -+#endif /*CONFIG_NEW_NETDEV_HDL*/ -+#ifndef RTW_HALMAC -+ rtw_intf_start(padapter); -+#endif /* !RTW_HALMAC */ -+ } -+ -+ if (padapter->mppriv.mode != MP_OFF) { -+ mp_stop_test(padapter); -+ padapter->mppriv.mode = MP_OFF; -+ } -+ -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT"invalid id:%d\n", FUNC_ADPT_ARG(padapter), mp_cmd_id); -+ ret = H2C_PARAMETERS_ERROR; -+ rtw_warn_on(1); -+ } -+ -+exit: -+ return ret; -+} -+ -+u8 rtw_mp_cmd(_adapter *adapter, u8 mp_cmd_id, u8 flags) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *parm; -+ 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; -+ } -+ -+ parm->ec_id = MP_CMD_WK_CID; -+ parm->type = mp_cmd_id; -+ parm->size = 0; -+ parm->pbuf = NULL; -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != rtw_mp_cmd_hdl(adapter, mp_cmd_id)) -+ 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, CMD_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; -+} -+#endif /*CONFIG_MP_INCLUDED*/ -+ -+#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, CMD_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, CMD_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 -+ -+static u8 _rtw_run_in_thread_cmd(_adapter *adapter, void (*func)(void *), void *context, s32 timeout_ms) -+{ -+ struct cmd_priv *cmdpriv = &adapter->cmdpriv; -+ struct cmd_obj *cmdobj; -+ struct RunInThread_param *parm; -+ struct submit_ctx sctx; -+ s32 res = _SUCCESS; -+ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (NULL == cmdobj) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm = (struct RunInThread_param *)rtw_zmalloc(sizeof(struct RunInThread_param)); -+ if (NULL == parm) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm->func = func; -+ parm->context = context; -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, CMD_RUN_INTHREAD); -+ -+ if (timeout_ms >= 0) { -+ cmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, timeout_ms); -+ } -+ -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ -+ if (res == _SUCCESS && timeout_ms >= 0) { -+ rtw_sctx_wait(&sctx, __func__); -+ _enter_critical_mutex(&cmdpriv->sctx_mutex, NULL); -+ if (sctx.status == RTW_SCTX_SUBMITTED) -+ cmdobj->sctx = NULL; -+ _exit_critical_mutex(&cmdpriv->sctx_mutex, NULL); -+ if (sctx.status != RTW_SCTX_DONE_SUCCESS) -+ res = _FAIL; -+ } -+ -+exit: -+ return res; -+} -+ -+u8 rtw_run_in_thread_cmd(_adapter *adapter, void (*func)(void *), void *context) -+{ -+ return _rtw_run_in_thread_cmd(adapter, func, context, -1); -+} -+ -+u8 rtw_run_in_thread_cmd_wait(_adapter *adapter, void (*func)(void *), void *context, s32 timeout_ms) -+{ -+ return _rtw_run_in_thread_cmd(adapter, func, context, timeout_ms); -+} -+ -+#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, CMD_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 & WIFI_ASOC_STATE)) -+ 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 & WIFI_ASOC_STATE)) -+ 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; -+} -+ -+#if defined(CONFIG_RTW_MESH) && defined(RTW_PER_CMD_SUPPORT_FW) -+static s32 rtw_req_per_cmd_hdl(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct macid_bmp req_macid_bmp, *macid_bmp; -+ u8 i, ret = _FAIL; -+ -+ macid_bmp = &macid_ctl->if_g[adapter->iface_id]; -+ _rtw_memcpy(&req_macid_bmp, macid_bmp, sizeof(struct macid_bmp)); -+ -+ /* Clear none mesh's macid */ -+ for (i = 0; i < macid_ctl->num; i++) { -+ u8 role; -+ role = GET_H2CCMD_MSRRPT_PARM_ROLE(&macid_ctl->h2c_msr[i]); -+ if (role != H2C_MSR_ROLE_MESH) -+ rtw_macid_map_clr(&req_macid_bmp, i); -+ } -+ -+ /* group_macid: always be 0 in NIC, so only pass macid_bitmap.m0 -+ * rpt_type: 0 includes all info in 1, use 0 for now -+ * macid_bitmap: pass m0 only for NIC -+ */ -+ ret = rtw_hal_set_req_per_rpt_cmd(adapter, 0, 0, req_macid_bmp.m0); -+ -+ return ret; -+} -+ -+u8 rtw_req_per_cmd(_adapter *adapter) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *parm; -+ 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; -+ } -+ -+ parm->ec_id = REQ_PER_CMD_WK_CID; -+ parm->type = 0; -+ parm->size = 0; -+ parm->pbuf = NULL; -+ -+ 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, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ -+exit: -+ return res; -+} -+#endif -+ -+ -+void rtw_ac_parm_cmd_hdl(_adapter *padapter, u8 *_ac_parm_buf, int ac_type) -+{ -+ -+ u32 ac_parm_buf; -+ -+ _rtw_memcpy(&ac_parm_buf, _ac_parm_buf, sizeof(ac_parm_buf)); -+ switch (ac_type) { -+ case XMIT_VO_QUEUE: -+ RTW_INFO(FUNC_NDEV_FMT" AC_VO = 0x%08x\n", FUNC_ADPT_ARG(padapter), (unsigned int) ac_parm_buf); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&ac_parm_buf)); -+ break; -+ -+ case XMIT_VI_QUEUE: -+ RTW_INFO(FUNC_NDEV_FMT" AC_VI = 0x%08x\n", FUNC_ADPT_ARG(padapter), (unsigned int) ac_parm_buf); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&ac_parm_buf)); -+ break; -+ -+ case XMIT_BE_QUEUE: -+ RTW_INFO(FUNC_NDEV_FMT" AC_BE = 0x%08x\n", FUNC_ADPT_ARG(padapter), (unsigned int) ac_parm_buf); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&ac_parm_buf)); -+ break; -+ -+ case XMIT_BK_QUEUE: -+ RTW_INFO(FUNC_NDEV_FMT" AC_BK = 0x%08x\n", FUNC_ADPT_ARG(padapter), (unsigned int) ac_parm_buf); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&ac_parm_buf)); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+ -+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, pdrvextra_cmd->pbuf); -+ 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 -+ /* 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, (u8)pdrvextra_cmd->type); -+ 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; -+ case BTC_REDUCE_WL_TXPWR_CID: -+ rtw_btc_reduce_wl_txpwr_hdl(padapter, pdrvextra_cmd->type); -+ break; -+#endif -+#ifdef CONFIG_DFS_MASTER -+ case DFS_RADAR_DETECT_WK_CID: -+ rtw_dfs_rd_hdl(padapter); -+ break; -+ case DFS_RADAR_DETECT_EN_DEC_WK_CID: -+ rtw_dfs_rd_en_decision(padapter, MLME_ACTION_NONE, 0); -+ 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 PERIOD_TSF_UPDATE_END_WK_CID: -+ rtw_hal_periodic_tsf_update_chk(padapter); -+ break; -+ case TEST_H2C_CID: -+ rtw_hal_fill_h2c_cmd(padapter, pdrvextra_cmd->pbuf[0], pdrvextra_cmd->size - 1, &pdrvextra_cmd->pbuf[1]); -+ break; -+ case MP_CMD_WK_CID: -+#ifdef CONFIG_MP_INCLUDED -+ ret = rtw_mp_cmd_hdl(padapter, pdrvextra_cmd->type); -+#endif -+ 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 -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ case RSON_SCAN_WK_CID: -+ rtw_rson_scan_cmd_hdl(padapter, pdrvextra_cmd->type); -+ break; -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ case MGNT_TX_WK_CID: -+ ret = rtw_mgnt_tx_handler(padapter, pdrvextra_cmd->pbuf); -+ break; -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+#if (defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE)) || defined(CONFIG_IOCTL_CFG80211) -+ case ROCH_WK_CID: -+ ret = rtw_roch_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); -+ break; -+#endif /* (defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE)) || defined(CONFIG_IOCTL_CFG80211) */ -+ -+#ifdef CONFIG_MCC_MODE -+ case MCC_CMD_WK_CID: -+ ret = rtw_mcc_cmd_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); -+ break; -+#endif /* CONFIG_MCC_MODE */ -+#if defined(CONFIG_RTW_MESH) && defined(RTW_PER_CMD_SUPPORT_FW) -+ case REQ_PER_CMD_WK_CID: -+ ret = rtw_req_per_cmd_hdl(padapter); -+ break; -+#endif -+#ifdef CONFIG_SUPPORT_STATIC_SMPS -+ case SSMPS_WK_CID : -+ rtw_ssmps_wk_hdl(padapter, (struct ssmps_cmd_parm *)pdrvextra_cmd->pbuf); -+ break; -+#endif -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+ case TXSS_WK_CID : -+ rtw_ctrl_txss_wk_hdl(padapter, (struct txss_cmd_parm *)pdrvextra_cmd->pbuf); -+ break; -+#endif -+ case AC_PARM_CMD_WK_CID: -+ rtw_ac_parm_cmd_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type); -+ break; -+#ifdef CONFIG_AP_MODE -+ case STOP_AP_WK_CID: -+ stop_ap_hdl(padapter); -+ break; -+#endif -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ case TBTX_CONTROL_TX_WK_CID: -+ tx_control_hdl(padapter); -+ 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, WIFI_ASOC_STATE); -+ _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_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; -+ 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_ex(&pmlmepriv->assoc_timer); -+ -+ _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, WIFI_UNDER_LINKING); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ /* we will set WIFI_ASOC_STATE when there is one more sat to join us (rtw_stassoc_event_callback) */ -+ } -+ -+createbss_cmd_fail: -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ 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->cmn.aid = psta->cmn.mac_id = psetstakey_rsp->keyid; */ /* CAM_ID(CAM_ENTRY) */ -+ -+exit: -+ -+ rtw_free_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 -+ -+ -+} -+ -+u8 set_txq_params_cmd(_adapter *adapter, u32 ac_parm, u8 ac_type) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 *ac_parm_buf = NULL; -+ u8 sz; -+ u8 res = _SUCCESS; -+ -+ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == 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 *)cmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ sz = sizeof(ac_parm); -+ ac_parm_buf = rtw_zmalloc(sz); -+ if (ac_parm_buf == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = AC_PARM_CMD_WK_CID; -+ pdrvextra_cmd_parm->type = ac_type; -+ pdrvextra_cmd_parm->size = sz; -+ pdrvextra_cmd_parm->pbuf = ac_parm_buf; -+ -+ _rtw_memcpy(ac_parm_buf, &ac_parm, sz); -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, CMD_SET_DRV_EXTRA); -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ -+exit: -+ return res; -+} -+ -+/* Driver writes beacon length to REG for FW adjusting beacon receive time */ -+#ifdef CONFIG_WRITE_BCN_LEN_TO_FW -+u8 rtw_write_bcnlen_to_fw_cmd(_adapter *padapter, u16 bcn_len) -+{ -+ struct cmd_obj *pcmd; -+ struct write_bcnlen_param *parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm = (struct write_bcnlen_param *)rtw_zmalloc(sizeof(struct write_bcnlen_param)); -+ if (parm == NULL) { -+ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm->bcn_len = bcn_len; -+ init_h2fwcmd_w_parm_no_rsp(pcmd, parm, CMD_WRITE_BCN_LEN); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ return res; -+} -+#endif /* CONFIG_WRITE_BCN_LEN_TO_FW */ -+ -+u8 rtw_reqtxrpt_cmd(_adapter *adapter, u8 macid) -+{ -+ struct cmd_obj *cmdobj; -+ struct reqtxrpt_param *parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 flags = RTW_CMDF_WAIT_ACK; -+ u8 res = _FAIL; -+ -+ /* prepare cmd parameter */ -+ parm = rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) -+ goto exit; -+ parm->macid = macid; -+ -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, CMD_REQ_TXRPT); -+ -+ 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); -+ if (sctx.status != RTW_SCTX_DONE_SUCCESS) -+ res = _FAIL; -+ } -+ -+exit: -+ return res; -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_debug.c b/drivers/net/wireless/rtl8821cs/core/rtw_debug.c -new file mode 100755 -index 000000000..4d599bfac ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_debug.c -@@ -0,0 +1,8532 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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__); -+} -+ -+#ifdef CONFIG_PROC_DEBUG -+void dump_drv_cfg(void *sel) -+{ -+extern uint rtw_recvbuf_nr; -+ -+#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 -+ -+#ifdef CONFIG_RTW_ANDROID -+ RTW_PRINT_SEL(sel, "Android Driver: %d\n", CONFIG_RTW_ANDROID); -+#else -+ RTW_PRINT_SEL(sel, "Linux Driver: \n"); -+#endif /* CONFIG_RTW_ANDROID */ -+ -+ 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 -+ #ifdef CONFIG_RADIO_WORK -+ RTW_PRINT_SEL(sel, "CONFIG_RADIO_WORK\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"); -+ #ifdef CONFIG_IPS -+ RTW_PRINT_SEL(sel, "CONFIG_IPS\n"); -+ #endif -+ #ifdef CONFIG_LPS -+ RTW_PRINT_SEL(sel, "CONFIG_LPS\n"); -+ #ifdef CONFIG_LPS_LCLK -+ RTW_PRINT_SEL(sel, "CONFIG_LPS_LCLK\n"); -+ #ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ RTW_PRINT_SEL(sel, "CONFIG_DETECT_CPWM_BY_POLLING\n"); -+ #endif -+ #endif /*CONFIG_LPS_LCLK*/ -+ #ifdef CONFIG_LPS_CHK_BY_TP -+ RTW_PRINT_SEL(sel, "CONFIG_LPS_CHK_BY_TP\n"); -+ #endif -+ #ifdef CONFIG_LPS_ACK -+ RTW_PRINT_SEL(sel, "CONFIG_LPS_ACK\n"); -+ #endif -+ #endif/*CONFIG_LPS*/ -+#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=%d\n", CONFIG_TXPWR_BY_RATE); -+ RTW_PRINT_SEL(sel, "CONFIG_TXPWR_BY_RATE_EN=%d\n", CONFIG_TXPWR_BY_RATE_EN); -+ RTW_PRINT_SEL(sel, "CONFIG_TXPWR_LIMIT=%d\n", CONFIG_TXPWR_LIMIT); -+ 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); -+ RTW_PRINT_SEL(sel, "CONFIG_RTW_ADAPTIVITY_MODE = %d\n", CONFIG_RTW_ADAPTIVITY_MODE); -+ -+#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_RTW_NETIF_SG -+ RTW_PRINT_SEL(sel, "CONFIG_RTW_NETIF_SG\n"); -+#endif -+ -+#ifdef CONFIG_RTW_WIFI_HAL -+ RTW_PRINT_SEL(sel, "CONFIG_RTW_WIFI_HAL\n"); -+#endif -+ -+#ifdef RTW_BUSY_DENY_SCAN -+ RTW_PRINT_SEL(sel, "RTW_BUSY_DENY_SCAN\n"); -+ RTW_PRINT_SEL(sel, "BUSY_TRAFFIC_SCAN_DENY_PERIOD = %u ms\n", \ -+ BUSY_TRAFFIC_SCAN_DENY_PERIOD); -+#endif -+ -+#ifdef CONFIG_RTW_TPT_MODE -+ RTW_PRINT_SEL(sel, "CONFIG_RTW_TPT_MODE\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 -+#ifdef RTW_XMIT_THREAD_HIGH_PRIORITY -+ RTW_PRINT_SEL(sel, "RTW_XMIT_THREAD_HIGH_PRIORITY\n"); -+#endif -+#ifdef RTW_XMIT_THREAD_HIGH_PRIORITY_AGG -+ RTW_PRINT_SEL(sel, "RTW_XMIT_THREAD_HIGH_PRIORITY_AGG\n"); -+#endif -+ -+#ifdef DBG_SDIO -+ RTW_PRINT_SEL(sel, "DBG_SDIO = %d\n", DBG_SDIO); -+#endif -+#endif /*CONFIG_SDIO_HCI*/ -+ -+#ifdef CONFIG_PCI_HCI -+#endif -+ -+ RTW_PRINT_SEL(sel, "CONFIG_IFACE_NUMBER = %d\n", CONFIG_IFACE_NUMBER); -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ RTW_PRINT_SEL(sel, "CONFIG_MI_WITH_MBSSID_CAM\n"); -+#endif -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+ RTW_PRINT_SEL(sel, "CONFIG_SWTIMER_BASED_TXBCN\n"); -+#endif -+#ifdef CONFIG_FW_HANDLE_TXBCN -+ RTW_PRINT_SEL(sel, "CONFIG_FW_HANDLE_TXBCN\n"); -+ RTW_PRINT_SEL(sel, "CONFIG_LIMITED_AP_NUM = %d\n", CONFIG_LIMITED_AP_NUM); -+#endif -+#ifdef CONFIG_CLIENT_PORT_CFG -+ RTW_PRINT_SEL(sel, "CONFIG_CLIENT_PORT_CFG\n"); -+#endif -+#ifdef CONFIG_PCI_TX_POLLING -+ RTW_PRINT_SEL(sel, "CONFIG_PCI_TX_POLLING\n"); -+#endif -+ RTW_PRINT_SEL(sel, "CONFIG_RTW_UP_MAPPING_RULE = %s\n", (CONFIG_RTW_UP_MAPPING_RULE == 1) ? "dscp" : "tos"); -+ -+ RTW_PRINT_SEL(sel, "\n=== XMIT-INFO ===\n"); -+ RTW_PRINT_SEL(sel, "NR_XMITFRAME = %d\n", NR_XMITFRAME); -+ RTW_PRINT_SEL(sel, "NR_XMITBUFF = %d\n", NR_XMITBUFF); -+ RTW_PRINT_SEL(sel, "MAX_XMITBUF_SZ = %d\n", MAX_XMITBUF_SZ); -+ RTW_PRINT_SEL(sel, "NR_XMIT_EXTBUFF = %d\n", NR_XMIT_EXTBUFF); -+ RTW_PRINT_SEL(sel, "MAX_XMIT_EXTBUF_SZ = %d\n", MAX_XMIT_EXTBUF_SZ); -+ RTW_PRINT_SEL(sel, "MAX_CMDBUF_SZ = %d\n", MAX_CMDBUF_SZ); -+ -+ RTW_PRINT_SEL(sel, "\n=== RECV-INFO ===\n"); -+ RTW_PRINT_SEL(sel, "NR_RECVFRAME = %d\n", NR_RECVFRAME); -+ RTW_PRINT_SEL(sel, "NR_RECVBUFF = %d, rtw_recvbuf_nr = %d\n", NR_RECVBUFF, rtw_recvbuf_nr); -+ RTW_PRINT_SEL(sel, "MAX_RECVBUF_SZ = %d\n", MAX_RECVBUF_SZ); -+ -+} -+#endif /* CONFIG_PROC_DEBUG */ -+ -+ -+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%04x", 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%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ } -+#endif /* CONFIG_RTL8814A */ -+ -+#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) \ -+ || defined(CONFIG_RTL8723F) -+ for (i = 0x1000; i < 0x1800; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif /* CONFIG_RTL8822B or 8821c*/ -+ -+#if defined(CONFIG_RTL8192F) -+ for (i = 0x1000; i < 0x1100; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ for (i = 0x1300; i < 0x1360; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8814B) -+ for (i = 0x2000; i < 0x2800; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+ for (i = 0x3000; i < 0x3800; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif -+ -+} -+ -+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%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) \ -+ || defined(CONFIG_RTL8723F) -+ for (i = 0x1800; i < 0x2000; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif /* CONFIG_RTL8822B */ -+ -+#if defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) || defined(CONFIG_RTL8723F) -+ for (i = 0x2c00; i < 0x2c60; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+ for (i = 0x2d00; i < 0x2df0; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+ for (i = 0x4000; i < 0x4060; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+ for (i = 0x4100; i < 0x4200; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+#endif /* CONFIG_RTL8822C || CONFIG_RTL8814B || CONFIG_8723F */ -+ -+#if defined(CONFIG_RTL8814B) -+ for (i = 0x5200; i < 0x5400; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif /* CONFIG_RTL8814B */ -+ -+#if defined(CONFIG_RTL8723F) -+ /* RFK(IQK/DPK) */ -+ RTW_PRINT_SEL(sel, "RFK(IQK/DPK)\n"); -+ for (i = 0x1B00; i < 0x1C00; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+ /* Debug port */ -+ RTW_PRINT_SEL(sel, "Debug port\n"); -+ for (i = 0x2A00; i < 0x2B00; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+ /* TSSI/DPK */ -+ RTW_PRINT_SEL(sel, "TSSI/DPK\n"); -+ for (i = 0x4200; i < 0x43C0; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif /* CONFIG_RTL8723F */ -+} -+ -+void bb_reg_dump_ex(void *sel, _adapter *adapter) -+{ -+ int i; -+ -+ RTW_PRINT_SEL(sel, "======= BB REG =======\n"); -+ for (i = 0x800; i < 0x1000; i += 4) { -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) -+ for (i = 0x1800; i < 0x2000; i += 4) { -+ RTW_PRINT_SEL(sel, "0x%04x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif /* CONFIG_RTL8822B */ -+} -+ -+void rf_reg_dump(void *sel, _adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ int i, j = 1, path; -+ u32 value; -+ u8 path_nums = hal_spec->rf_reg_path_num; -+ -+ 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"); -+ } -+ } -+} -+ -+void rtw_sink_rtp_seq_dbg(_adapter *adapter, u8 *ehdr_pos) -+{ -+ struct recv_priv *precvpriv = &(adapter->recvpriv); -+ if (precvpriv->sink_udpport > 0) { -+ if (*((u16 *)(ehdr_pos + 0x24)) == cpu_to_be16(precvpriv->sink_udpport)) { -+ precvpriv->pre_rtp_rxseq = precvpriv->cur_rtp_rxseq; -+ precvpriv->cur_rtp_rxseq = be16_to_cpu(*((u16 *)(ehdr_pos + 0x2C))); -+ if (precvpriv->pre_rtp_rxseq + 1 != precvpriv->cur_rtp_rxseq) { -+ if(precvpriv->pre_rtp_rxseq == 65535 ) { -+ if( precvpriv->cur_rtp_rxseq != 0) { -+ RTW_INFO("%s : RTP Seq num from %d to %d\n", __FUNCTION__, precvpriv->pre_rtp_rxseq, precvpriv->cur_rtp_rxseq); -+ } -+ } else { -+ 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, " %-15s", "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 %03x" -+ , RATE_BMP_GET_VHT_4SS(rfctl->rate_bmp_vht_by_bw[bw]) -+ , 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) -+{ -+#if defined(CONFIG_RTW_DEBUG) || defined(CONFIG_PROC_DEBUG) -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ int i; -+ _adapter *iface; -+ u8 u_ch, u_bw, u_offset; -+#if (defined(CONFIG_SUPPORT_MULTI_BCN) && defined(CONFIG_FW_HANDLE_TXBCN)) || defined(CONFIG_CLIENT_PORT_CFG) -+ char str_val[64] = {'\0'}; -+#endif -+ dump_mi_status(sel, dvobj); -+ -+#if defined(CONFIG_SUPPORT_MULTI_BCN) && defined(CONFIG_FW_HANDLE_TXBCN) -+ RTW_PRINT_SEL(sel, "[AP] LIMITED_AP_NUM:%d\n", CONFIG_LIMITED_AP_NUM); -+ RTW_PRINT_SEL(sel, "[AP] vap_map:0x%02x\n", dvobj->vap_map); -+#endif -+#ifdef CONFIG_HW_P0_TSF_SYNC -+ RTW_PRINT_SEL(sel, "[AP] p0 tsf sync port = %d\n", dvobj->p0_tsf.sync_port); -+ RTW_PRINT_SEL(sel, "[AP] p0 tsf timer offset = %d\n", dvobj->p0_tsf.offset); -+#endif -+#ifdef CONFIG_CLIENT_PORT_CFG -+ RTW_PRINT_SEL(sel, "[CLT] clt_num = %d\n", dvobj->clt_port.num); -+ RTW_PRINT_SEL(sel, "[CLT] clt_map = 0x%02x\n", dvobj->clt_port.bmp); -+#endif -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ RTW_PRINT_SEL(sel, "[MI] default port id:%d\n\n", dvobj->dft.port_id); -+#endif /* CONFIG_FW_MULTI_PORT_SUPPORT */ -+ -+ 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 -+ -+#ifdef DBG_TSF_UPDATE -+#define TSF_PAUSE_TIME_TITLE_FMT " %-5s" -+#define TSF_PAUSE_TIME_TITLE_ARG , "tsfup" -+#define TSF_PAUSE_TIME_VALUE_FMT " %5d" -+#define TSF_PAUSE_TIME_VALUE_ARG , ((iface->mlmeextpriv.tsf_update_required && iface->mlmeextpriv.tsf_update_pause_stime) ? (rtw_get_passing_time_ms(iface->mlmeextpriv.tsf_update_pause_stime) > 99999 ? 99999 : rtw_get_passing_time_ms(iface->mlmeextpriv.tsf_update_pause_stime)) : 0) -+#else -+#define TSF_PAUSE_TIME_TITLE_FMT "" -+#define TSF_PAUSE_TIME_TITLE_ARG -+#define TSF_PAUSE_TIME_VALUE_FMT "" -+#define TSF_PAUSE_TIME_VALUE_ARG -+#endif -+ -+#if (defined(CONFIG_SUPPORT_MULTI_BCN) && defined(CONFIG_FW_HANDLE_TXBCN)) || defined(CONFIG_CLIENT_PORT_CFG) -+#define INFO_FMT " %-4s" -+#define INFO_ARG , "info" -+#define INFO_CNT_FMT " %-20s" -+#define INFO_CNT_ARG , str_val -+#else -+#define INFO_FMT "" -+#define INFO_ARG -+#define INFO_CNT_FMT "" -+#define INFO_CNT_ARG -+#endif -+ -+ RTW_PRINT_SEL(sel, "%-2s %-15s %c %-3s %-3s %-3s %-17s %-4s %-7s %-5s" -+ P2P_INFO_TITLE_FMT -+ TSF_PAUSE_TIME_TITLE_FMT -+ " %s"INFO_FMT"\n" -+ , "id", "ifname", ' ', "bup", "nup", "ncd", "macaddr", "port", "ch", "class" -+ P2P_INFO_TITLE_ARG -+ TSF_PAUSE_TIME_TITLE_ARG -+ , "status"INFO_ARG); -+ -+ RTW_PRINT_SEL(sel, "---------------------------------------------------------------" -+ P2P_INFO_DASH -+ "-------\n"); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) { -+ #if (defined(CONFIG_SUPPORT_MULTI_BCN) && defined(CONFIG_FW_HANDLE_TXBCN)) || defined(CONFIG_CLIENT_PORT_CFG) -+ _rtw_memset(&str_val, '\0', sizeof(str_val)); -+ #endif -+ #if defined(CONFIG_AP_MODE) && defined(CONFIG_SUPPORT_MULTI_BCN) && defined(CONFIG_FW_HANDLE_TXBCN) -+ if (MLME_IS_AP(iface) || MLME_IS_MESH(iface)) { -+ u8 len; -+ char *p = str_val; -+ char tmp_str[10] = {'\0'}; -+ -+ len = snprintf(tmp_str, sizeof(tmp_str), "%s", "ap_id:"); -+ strncpy(p, tmp_str, len); -+ p += len; -+ _rtw_memset(&tmp_str, '\0', sizeof(tmp_str)); -+ #ifdef DBG_HW_PORT -+ len = snprintf(tmp_str, sizeof(tmp_str), "%d (%d,%d)", iface->vap_id, iface->hw_port, iface->client_port); -+ #else -+ len = snprintf(tmp_str, sizeof(tmp_str), "%d", iface->vap_id); -+ #endif -+ strncpy(p, tmp_str, len); -+ } -+ #endif -+ #ifdef CONFIG_CLIENT_PORT_CFG -+ if (MLME_IS_STA(iface)) { -+ u8 len; -+ char *p = str_val; -+ char tmp_str[10] = {'\0'}; -+ -+ len = snprintf(tmp_str, sizeof(tmp_str), "%s", "c_pid:"); -+ strncpy(p, tmp_str, len); -+ p += len; -+ _rtw_memset(&tmp_str, '\0', sizeof(tmp_str)); -+ #ifdef DBG_HW_PORT -+ len = snprintf(tmp_str, sizeof(tmp_str), "%d (%d,%d)", iface->client_port, iface->hw_port, iface->client_port); -+ #else -+ len = snprintf(tmp_str, sizeof(tmp_str), "%d", iface->client_port); -+ #endif -+ strncpy(p, tmp_str, len); -+ } -+ #endif -+ -+ RTW_PRINT_SEL(sel, "%2d %-15s %c %3u %3u %3u "MAC_FMT" %4hhu %3u,%u,%u %5u" -+ P2P_INFO_VALUE_FMT -+ TSF_PAUSE_TIME_VALUE_FMT -+ " "MLME_STATE_FMT" " INFO_CNT_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)) -+ , rtw_hal_get_port(iface) -+ , iface->mlmeextpriv.cur_channel -+ , iface->mlmeextpriv.cur_bwmode -+ , iface->mlmeextpriv.cur_ch_offset -+ , rtw_get_op_class_by_chbw(iface->mlmeextpriv.cur_channel -+ , iface->mlmeextpriv.cur_bwmode -+ , iface->mlmeextpriv.cur_ch_offset) -+ P2P_INFO_VALUE_ARG -+ TSF_PAUSE_TIME_VALUE_ARG -+ , MLME_STATE_ARG(iface) -+ INFO_CNT_ARG -+ ); -+ } -+ } -+ -+ RTW_PRINT_SEL(sel, "---------------------------------------------------------------" -+ P2P_INFO_DASH -+ "-------\n"); -+ -+ if (rtw_mi_get_ch_setting_union(dvobj_get_primary_adapter(dvobj), &u_ch, &u_bw, &u_offset)) -+ RTW_PRINT_SEL(sel, "%55s %3u,%u,%u %5u\n" -+ , "union:" -+ , u_ch, u_bw, u_offset, rtw_get_op_class_by_chbw(u_ch, u_bw, u_offset)); -+ -+ RTW_PRINT_SEL(sel, "%55s %3u,%u,%u offch_state:%d\n" -+ , "oper:" -+ , dvobj->oper_channel -+ , dvobj->oper_bwmode -+ , dvobj->oper_ch_offset -+ , rfctl->offch_state -+ ); -+ -+#ifdef CONFIG_DFS_MASTER -+ if (rfctl->radar_detect_ch != 0) { -+ RTW_PRINT_SEL(sel, "%55s %3u,%u,%u" -+ , "radar_detect:" -+ , rfctl->radar_detect_ch -+ , rfctl->radar_detect_bw -+ , rfctl->radar_detect_offset -+ ); -+ -+ if (rfctl->radar_detect_by_others) -+ _RTW_PRINT_SEL(sel, ", by AP of STA link"); -+ else { -+ u32 non_ocp_ms; -+ u32 cac_ms; -+ u8 dfs_domain = rtw_rfctl_get_dfs_domain(rfctl); -+ -+ _RTW_PRINT_SEL(sel, ", domain:%s(%u)", rtw_dfs_regd_str(dfs_domain), dfs_domain); -+ -+ rtw_get_ch_waiting_ms(rfctl -+ , 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); -+ } -+ -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif /* CONFIG_DFS_MASTER */ -+#endif /* CONFIG_RTW_DEBUG || CONFIG_PROC_DEBUG */ -+} -+ -+#if defined(CONFIG_RTW_DEBUG) || defined(CONFIG_PROC_DEBUG) -+#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 %-8s %-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 %-8s %2u %2u %5u" -+#define SEC_CAM_ENT_VALUE_ARG(ent) \ -+ (ent)->ctrl \ -+ , MAC_ARG((ent)->mac) \ -+ , KEY_ARG((ent)->key) \ -+ , ((ent)->ctrl) & 0x03 \ -+ , (((ent)->ctrl) & 0x200) ? \ -+ security_type_str((((ent)->ctrl) >> 2 & 0x7) | _SEC_TYPE_256_) : \ -+ security_type_str(((ent)->ctrl) >> 2 & 0x7) \ -+ , (((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); -+} -+#endif -+ -+void dump_sec_cam(void *sel, _adapter *adapter) -+{ -+#if defined(CONFIG_RTW_DEBUG) || defined(CONFIG_PROC_DEBUG) -+ 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); -+ } -+#endif -+} -+ -+void dump_sec_cam_cache(void *sel, _adapter *adapter) -+{ -+#if defined(CONFIG_RTW_DEBUG) || defined(CONFIG_PROC_DEBUG) -+ 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); -+ } -+#endif -+} -+ -+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 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; -+} -+ -+static u32 g_wait_hiq_empty_ms = 0; -+ -+u32 rtw_get_wait_hiq_empty_ms(void) -+{ -+ return g_wait_hiq_empty_ms; -+} -+ -+static systime sta_linking_test_start_time = 0; -+static u32 sta_linking_test_wait_ms = 0; -+static u8 sta_linking_test_force_fail = 0; -+ -+void rtw_sta_linking_test_set_start(void) -+{ -+ sta_linking_test_start_time = rtw_get_current_time(); -+} -+ -+bool rtw_sta_linking_test_wait_done(void) -+{ -+ return rtw_get_passing_time_ms(sta_linking_test_start_time) >= sta_linking_test_wait_ms; -+} -+ -+bool rtw_sta_linking_test_force_fail(void) -+{ -+ return sta_linking_test_force_fail; -+} -+ -+#ifdef CONFIG_AP_MODE -+static u16 ap_linking_test_force_auth_fail = 0; -+static u16 ap_linking_test_force_asoc_fail = 0; -+ -+u16 rtw_ap_linking_test_force_auth_fail(void) -+{ -+ return ap_linking_test_force_auth_fail; -+} -+ -+u16 rtw_ap_linking_test_force_asoc_fail(void) -+{ -+ return ap_linking_test_force_asoc_fail; -+} -+#endif -+ -+#ifdef CONFIG_PROC_DEBUG -+int proc_get_defs_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, "%s %15s\n", "lmt_sta", "lmt_time"); -+ RTW_PRINT_SEL(m, "%-15u %-15u\n" -+ , mlme->defs_lmt_sta -+ , mlme->defs_lmt_time -+ ); -+ -+ return 0; -+} -+ -+ssize_t proc_set_defs_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]; -+ u32 defs_lmt_sta; -+ u32 defs_lmt_time; -+ -+ 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", &defs_lmt_sta, &defs_lmt_time); -+ -+ if (num >= 1) -+ mlme->defs_lmt_sta = defs_lmt_sta; -+ if (num >= 2) -+ mlme->defs_lmt_time = defs_lmt_time; -+ } -+ -+ return count; -+ -+} -+ -+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) -+{ -+ 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_rx_stat(struct seq_file *m, void *v) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_info *psta = NULL; -+ struct stainfo_stats *pstats = NULL; -+ struct sta_priv *pstapriv = &(adapter->stapriv); -+ u32 i, j; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 null_addr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ -+ _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); -+ pstats = &psta->sta_stats; -+ -+ if (pstats == NULL) -+ continue; -+ if ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) -+ && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) != _TRUE) -+ && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(adapter), ETH_ALEN) != _TRUE)) { -+ RTW_PRINT_SEL(m, "MAC :\t\t"MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); -+ RTW_PRINT_SEL(m, "data_rx_cnt :\t%llu\n", sta_rx_data_uc_pkts(psta) - pstats->last_rx_data_uc_pkts); -+ pstats->last_rx_data_uc_pkts = sta_rx_data_uc_pkts(psta); -+ RTW_PRINT_SEL(m, "duplicate_cnt :\t%u\n", pstats->duplicate_cnt); -+ pstats->duplicate_cnt = 0; -+ RTW_PRINT_SEL(m, "rx_per_rate_cnt :\n"); -+ -+ for (j = 0; j < 0x60; j++) { -+ RTW_PRINT_SEL(m, "%08u ", pstats->rxratecnt[j]); -+ pstats->rxratecnt[j] = 0; -+ if ((j%8) == 7) -+ RTW_PRINT_SEL(m, "\n"); -+ } -+ RTW_PRINT_SEL(m, "\n"); -+ } -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ return 0; -+} -+ -+int proc_get_sta_tx_stat(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_priv *stapriv = &(adapter->stapriv); -+ struct sta_priv *stapriv_primary = &(GET_PRIMARY_ADAPTER(adapter))->stapriv; -+ struct sta_info *sta; -+ struct stainfo_stats *stats; -+ u8 mac[ETH_ALEN] = {0}; -+ int ret = 0; -+ -+ _rtw_memcpy(mac, stapriv_primary->c2h_sta_mac, ETH_ALEN); -+ sta = rtw_get_stainfo(stapriv, mac); -+ if (sta) { -+ ret = rtw_get_sta_tx_stat(adapter, sta->cmn.mac_id, sta->cmn.mac_addr); -+ stats = &sta->sta_stats; -+ RTW_PRINT_SEL(m, "MAC: " MAC_FMT " fail: %u retry: %u\n", -+ MAC_ARG(mac), stats->tx_fail_cnt_sum, stats->tx_retry_cnt_sum); -+ } else -+ ret = -ENODATA; -+ return ret; -+} -+ -+ssize_t proc_set_sta_tx_stat(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 sta_priv *stapriv_primary = &(GET_PRIMARY_ADAPTER(adapter))->stapriv; -+ char tmp[18] = {0}; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (!adapter->hal_func.reqtxrpt) { -+ RTW_INFO("Not support.\n"); -+ return -ENOTSUPP; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ if (sscanf(tmp, MAC_SFMT, MAC_SARG(stapriv_primary->c2h_sta_mac)) != 6) { -+ _rtw_memset(stapriv_primary->c2h_sta_mac, 0, 6); -+ RTW_PRINT(FUNC_ADPT_FMT" Invalid format\n", -+ FUNC_ADPT_ARG(adapter)); -+ } -+ -+ } -+ -+ return count; -+} -+ -+int proc_get_tx_stat(struct seq_file *m, void *v) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_info *psta = NULL; -+ u8 sta_mac[NUM_STA][ETH_ALEN] = {{0}}; -+ uint mac_id[NUM_STA]; -+ struct stainfo_stats *pstats = NULL; -+ struct sta_priv *pstapriv = &(adapter->stapriv); -+ u32 i, macid_rec_idx = 0; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 null_addr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ -+ if (!adapter->hal_func.reqtxrpt) { -+ RTW_PRINT_SEL(m, "Not support.\n"); -+ return 0; -+ } -+ -+ _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 ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) -+ && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) != _TRUE) -+ && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(adapter), ETH_ALEN) != _TRUE)) { -+ _rtw_memcpy(&sta_mac[macid_rec_idx][0], psta->cmn.mac_addr, ETH_ALEN); -+ mac_id[macid_rec_idx] = psta->cmn.mac_id; -+ macid_rec_idx++; -+ } -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (i = 0; i < macid_rec_idx; i++) { -+ if (rtw_get_sta_tx_stat(adapter, mac_id[i], &sta_mac[i][0]) == _SUCCESS) { -+ psta = rtw_get_stainfo(pstapriv, &sta_mac[i][0]); -+ if(psta) { -+ pstats = &psta->sta_stats; -+#if (!defined(ROKU_PRIVATE) && !defined(CONFIG_RTW_MULTI_AP)) -+ RTW_PRINT_SEL(m, "data_sent_cnt :\t%u\n", pstats->tx_ok_cnt + pstats->tx_fail_cnt); -+ RTW_PRINT_SEL(m, "success_cnt :\t%u\n", pstats->tx_ok_cnt); -+ RTW_PRINT_SEL(m, "failure_cnt :\t%u\n", pstats->tx_fail_cnt); -+ RTW_PRINT_SEL(m, "retry_cnt :\t%u\n\n", pstats->tx_retry_cnt); -+#else -+ RTW_PRINT_SEL(m, "MAC: " MAC_FMT " sent: %u fail: %u retry: %u\n", -+ MAC_ARG(&sta_mac[i][0]), pstats->tx_ok_cnt, pstats->tx_fail_cnt, pstats->tx_retry_cnt); -+#endif /* ROKU_PRIVATE */ -+ -+ } else -+ RTW_PRINT_SEL(m, "STA is gone\n"); -+ } else { -+ //to avoid c2h modify counters -+ break; -+ } -+ } -+ return 0; -+} -+ -+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); -+ -+ RTW_PRINT_SEL(m, "gcmp_sw_enc_cnt=%llu, %llu, %llu\n" -+ , sec->gcmp_sw_enc_cnt_bc , sec->gcmp_sw_enc_cnt_mc, sec->gcmp_sw_enc_cnt_uc); -+ RTW_PRINT_SEL(m, "gcmp_sw_dec_cnt=%llu, %llu, %llu\n" -+ , sec->gcmp_sw_dec_cnt_bc , sec->gcmp_sw_dec_cnt_mc, sec->gcmp_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 %15s %26s %16s\n", "rssi_diff_th", "scanr_exp_ms", "scan_interval(unit:2 sec)", "rssi_threshold"); -+ RTW_PRINT_SEL(m, "%-15u %-13u %-27u %-11u\n" -+ , mlme->roam_rssi_diff_th -+ , mlme->roam_scanr_exp_ms -+ , mlme->roam_scan_int -+ , 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; -+ 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, &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 = scan_int; -+ 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_WAR_OFFLOAD -+int proc_get_war_offload_enable(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 pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ -+ if (_TRUE == pwrpriv->wowlan_war_offload_mode) { -+ RTW_PRINT_SEL(m, "\n[ Offload Feature Enabled ]\n"); -+ -+ if (WAR_ARP_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) { -+ RTW_PRINT_SEL(m, "\n ARP Reponse offload enabled\n"); -+ } -+#ifdef CONFIG_OFFLOAD_MDNS_V4 -+ if (WAR_MDNS_V4_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) { -+ RTW_PRINT_SEL(m, "\n MDNS v4 Reponse offload enabled\n"); -+ } -+ if (WAR_MDNS_V4_WAKEUP_EN & pwrpriv->wowlan_war_offload_ctrl) { -+ RTW_PRINT_SEL(m, "\n MDNS v4 Wakeup offload enabled\n"); -+ } -+#endif /* CONFIG_OFFLOAD_MDNS_v4 */ -+#ifdef CONFIG_OFFLOAD_MDNS_V6 -+ if (WAR_MDNS_V6_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) { -+ RTW_PRINT_SEL(m, "\n MDNS v6 Reponse offload enabled\n"); -+ } -+ if (WAR_MDNS_V6_WAKEUP_EN & pwrpriv->wowlan_war_offload_ctrl) { -+ RTW_PRINT_SEL(m, "\n MDNS v6 Wakeup offload enabled\n"); -+ } -+#endif /* CONFIG_OFFLOAD_MDNS_V6 */ -+ -+ if (WAR_ARP_WAKEUP_EN & pwrpriv->wowlan_war_offload_ctrl) { -+ RTW_PRINT_SEL(m, "\n ARP Request wakeup enabled\n"); -+ } -+ -+ } else { -+ RTW_PRINT_SEL(m, "\n[ Offload Feature Disabled ]\n"); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_war_offload_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 dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ char tmp[32]; -+ u32 offload_cfg = 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, "%x", &offload_cfg); -+ -+ if (num == 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": Set war offload cfg = %x\n", FUNC_ADPT_ARG(padapter), offload_cfg); -+ pwrpriv->wowlan_war_offload_ctrl = offload_cfg; -+ pwrpriv->wowlan_war_offload_mode = offload_cfg?_TRUE:_FALSE; -+ -+ } -+ } -+ -+ return count; -+} -+ -+ssize_t proc_set_war_offload_ipv4_addr(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 = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ char tmp[128]; -+ u32 ip_addr = 0, ip_subnet = 0, ip_gateway = 0, index = 0; -+ struct war_ipv4_fmt* pip_info = &pwrpriv->wowlan_war_offload_ipv4; -+ -+ 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, "%d %x %x %x", &index, &ip_addr, &ip_subnet, &ip_gateway); -+ -+ if (num == 4) { -+ pip_info->ip_addr[index-1] = ip_addr; -+ pip_info->ip_subnet[index-1] = ip_subnet; -+ pip_info->ip_gateway[index-1] = ip_gateway; -+ RTW_INFO(FUNC_ADPT_FMT "Setup IPv4 address:\n", FUNC_ADPT_ARG(padapter)); -+ RTW_INFO("Index(%d) IP=%d.%d.%d.%d\n", index, (ip_addr & 0xff), ((ip_addr & 0xff00)>>8), ((ip_addr & 0xff0000)>>16), ((ip_addr & 0xff000000)>>24)); -+ } else { -+ RTW_INFO("Wrong input buffer count (%d)\n", num); -+ return -EFAULT; -+ } -+ } -+ -+ return count; -+} -+ -+ssize_t proc_set_war_offload_ipv6_addr(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 = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ char tmp[255]; -+ u32 ip_addr = 0, ip_subnet = 0, ip_gateway = 0; -+ struct war_ipv6_fmt* pip_info = &pwrpriv->wowlan_war_offload_ipv6; -+ -+ 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; -+ int i; -+ u32 index; -+ u16 val[64]; -+ u16 big_endian_val[64]; -+ -+ num = sscanf(tmp, "%d %hx:%hx:%hx:%hx:%hx:%hx:%hx:%hx", &index, &val[0], &val[1], &val[2], &val[3], &val[4], &val[5], &val[6], &val[7]); -+ for (i=0;i<8;i++) { -+ big_endian_val[i] = htons(val[i]); -+ } -+ _rtw_memcpy(pip_info->ipv6_addr[index-1], big_endian_val, RTW_IPv6_ADDR_LEN); -+ -+ if (num == 9) { -+ RTW_INFO(FUNC_ADPT_FMT "Setup IPv6 address\n", FUNC_ADPT_ARG(padapter)); -+ } else { -+ RTW_INFO("Wrong input count (%d)\n", num); -+ return -EFAULT; -+ } -+ } -+ -+ return count; -+} -+ -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+ -+int proc_get_war_offload_mdns_domain_name(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 pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ -+ if (_TRUE == pwrpriv->wowlan_war_offload_mode) { -+ if ((WAR_MDNS_V4_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V6_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V4_WAKEUP_EN & pwrpriv->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V6_WAKEUP_EN & pwrpriv->wowlan_war_offload_ctrl)) { -+ RTW_PRINT_SEL(m, "\nDomain Name:[%s](%d)\n\n", -+ pwrpriv->wowlan_war_offload_mdns_domain_name, pwrpriv->wowlan_war_offload_mdns_domain_name_len); -+ } else { -+ RTW_PRINT_SEL(m, "\nMSND RSP Not enabled\n\n"); -+ } -+ } else { -+ RTW_PRINT_SEL(m, "\nOffload Not enabled\n\n"); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_war_offload_mdns_domain_name(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 = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ char tmp[MAX_MDNS_DOMAIN_NAME_LEN+1]; -+ char domain_name[MAX_MDNS_DOMAIN_NAME_LEN+1]; -+ -+ 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 large than MAX_MDNS_DOMAIN_NAME_LEN(%d)\n", FUNC_ADPT_ARG(padapter), MAX_MDNS_DOMAIN_NAME_LEN); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%s", domain_name); -+ if(1 == num) { -+ pwrpriv->wowlan_war_offload_mdns_domain_name_len = strlen(domain_name); -+ _rtw_memset(pwrpriv->wowlan_war_offload_mdns_domain_name, 0x00, MAX_MDNS_DOMAIN_NAME_LEN); -+ _rtw_memcpy(pwrpriv->wowlan_war_offload_mdns_domain_name, domain_name, strlen(domain_name)); -+ } -+ } -+ -+ return count; -+} -+ -+ -+int proc_get_war_offload_mdns_machine_name(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 pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ int i=0; -+ -+ if (_TRUE == pwrpriv->wowlan_war_offload_mode) { -+ if ((WAR_MDNS_V4_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V6_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V4_WAKEUP_EN & pwrpriv->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V6_WAKEUP_EN & pwrpriv->wowlan_war_offload_ctrl)) { -+ for(i=0; iwowlan_war_offload_mdns_mnane_num; i++) -+ { -+ RTW_PRINT_SEL(m, "[%d]", i); -+ rtw_wow_war_mdns_dump_buf(m, "Machine Name", -+ pwrpriv->wowlan_war_offload_mdns_mnane[i].name, pwrpriv->wowlan_war_offload_mdns_mnane[i].name_len); -+ } -+ RTW_PRINT_SEL(m, "\n"); -+ } else { -+ RTW_PRINT_SEL(m, "\nMSND RSP Not enabled\n\n"); -+ } -+ } else { -+ RTW_PRINT_SEL(m, "\nOffload Not enabled\n\n"); -+ } -+ -+ return 0; -+} -+ -+ -+ssize_t proc_set_war_offload_mdns_machine_name(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 = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ char tmp[MAX_MDNS_MACHINE_NAME_LEN*3-1+1]; -+ -+ 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, %lu, is large than MAX_MDNS_MACHINE_NAME_LEN(%d)\n", FUNC_ADPT_ARG(padapter), (count+1)/3, MAX_MDNS_MACHINE_NAME_LEN); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ if( strncmp(tmp, "clean", 5) == 0 ) -+ { -+ _rtw_memset(pwrpriv->wowlan_war_offload_mdns_mnane, 0, sizeof(pwrpriv->wowlan_war_offload_mdns_mnane)); -+ pwrpriv->wowlan_war_offload_mdns_mnane_num = 0; -+ }else{ -+ int idx = pwrpriv->wowlan_war_offload_mdns_mnane_num; -+ if(idx == MAX_MDNS_MACHINE_NAME_NUM){ -+ RTW_INFO(FUNC_ADPT_FMT ": the num of machine name is already %d(MAX_MDNS_MACHINE_NAME_NUM)!\n", FUNC_ADPT_ARG(padapter), MAX_MDNS_MACHINE_NAME_NUM); -+ return -EFAULT; -+ } -+ if(rtw_wow_war_mdns_parser_pattern(tmp, pwrpriv->wowlan_war_offload_mdns_mnane[idx].name, -+ (u32 *) &pwrpriv->wowlan_war_offload_mdns_mnane[idx].name_len, MAX_MDNS_MACHINE_NAME_LEN)) -+ pwrpriv->wowlan_war_offload_mdns_mnane_num++; -+ } -+ } -+ -+ return count; -+} -+ -+ -+int proc_get_war_offload_mdns_service_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 pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ struct war_mdns_service_info *psinfo = pwrpriv->wowlan_war_offload_mdns_service; -+ int i=0, j=0; -+ -+ if (_TRUE == pwrpriv->wowlan_war_offload_mode) { -+ if ((WAR_MDNS_V4_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V6_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V4_WAKEUP_EN & pwrpriv->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V6_WAKEUP_EN & pwrpriv->wowlan_war_offload_ctrl)) { -+ for(i=0; iwowlan_war_offload_mdns_service_info_num; i++) -+ { -+ RTW_PRINT_SEL(m, "[%d] service info ===> \n", i+1); -+ RTW_PRINT_SEL(m, "\tservice-transport-domain : %s(%d)- %s(%d)- %s(%d)\n", -+ psinfo[i].service, psinfo[i].service_len, -+ psinfo[i].transport, psinfo[i].transport_len, -+ psinfo[i].domain, psinfo[i].domain_len); -+ RTW_PRINT_SEL(m, "\ttarget for srv rsp : %s(%d)\n", psinfo[i].target, psinfo[i].target_len); -+ RTW_PRINT_SEL(m, "\tport : %x-%x, ttl : %d \n", psinfo[i].port[0], psinfo[i].port[1], psinfo[i].ttl); -+ j = psinfo[i].txt_rsp_idx; -+ RTW_PRINT_SEL(m, "\ttype txt rsp. [%d] \n", j); -+ rtw_wow_war_mdns_dump_txt(m, "type txt rsp. (Str)", -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[j].txt, pwrpriv->wowlan_war_offload_mdns_txt_rsp[j].txt_len); -+ -+ } -+ RTW_PRINT_SEL(m, "\n"); -+ } else { -+ RTW_PRINT_SEL(m, "\nMSND RSP Not enabled\n\n"); -+ } -+ } else { -+ RTW_PRINT_SEL(m, "\nOffload Not enabled\n\n"); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_war_offload_mdns_service_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 *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ struct war_mdns_service_info *psinfo = pwrpriv->wowlan_war_offload_mdns_service; -+ u8 idx = 0, port[2], i=0; -+ char *tmp=NULL; -+ char srv[MAX_MDNS_SERVICE_NAME_LEN+1], trans[MAX_MDNS_TRANS_LEN+1], domain[MAX_MDNS_DOMAIN_LEN+1]; -+ char target[MAX_MDNS_TARGET_LEN+1]; -+ u32 ttl, tmp_txt_len=0, port0 =0, port1 =0; -+ u16 max_input_size = (MAX_MDNS_SERVICE_NAME_LEN+MAX_MDNS_TRANS_LEN+MAX_MDNS_DOMAIN_LEN+MAX_MDNS_TARGET_LEN+2); -+ int txt_idx; -+ -+ 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(char)*(max_input_size)) ) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ tmp = rtw_zvmalloc(sizeof(char)*(max_input_size)); -+ if (NULL == tmp) { -+ RTW_INFO(FUNC_ADPT_FMT ": tmp buffer allocate fail!!\n", FUNC_ADPT_ARG(padapter)); -+ count = -EFAULT; -+ goto exit; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%15s %4s %5s %63s %x %x %u %d", srv, trans, domain, target, &port0, &port1, &ttl, &txt_idx); -+ /* MAX_MDNS_SERVICE_NAME_LEN(15), MAX_MDNS_TRANS_LEN(4), MAX_MDNS_DOMAIN_LEN(5), MAX_MDNS_TARGET_LEN(63) */ -+ int idx = pwrpriv->wowlan_war_offload_mdns_service_info_num; -+ u16 curent_txt_total_size = 0; -+ //u16 sscanf_parameter_length = strlen(srv)+strlen(trans)+strlen(domain)+strlen(target)+2+2+4+1+num; -+ -+ if( strncmp(srv, "clean", 5) == 0 ) { -+ _rtw_memset(pwrpriv->wowlan_war_offload_mdns_service, 0, sizeof(pwrpriv->wowlan_war_offload_mdns_service)); -+ pwrpriv->wowlan_war_offload_mdns_service_info_num = 0; -+ } -+ /*else if(count != sscanf_parameter_length) -+ { -+ RTW_INFO(FUNC_ADPT_FMT ": Length of total parameters does not match the input buffer. (%d != %lu)\n", -+ FUNC_ADPT_ARG(padapter), sscanf_parameter_length, count); -+ RTW_INFO(FUNC_ADPT_FMT ": Please check the content and length of each parameter.\n", FUNC_ADPT_ARG(padapter)); -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer = (%s)(%lu)!\n\n", FUNC_ADPT_ARG(padapter), tmp, count); -+ RTW_INFO(FUNC_ADPT_FMT ": srv = %s (%lu)!\n", FUNC_ADPT_ARG(padapter), srv, strlen(srv)); -+ RTW_INFO(FUNC_ADPT_FMT ": trans = %s (%lu)!\n", FUNC_ADPT_ARG(padapter), trans, strlen(trans)); -+ RTW_INFO(FUNC_ADPT_FMT ": domain = %s (%lu)!\n", FUNC_ADPT_ARG(padapter), domain, strlen(domain)); -+ RTW_INFO(FUNC_ADPT_FMT ": target = %s (%lu)!\n", FUNC_ADPT_ARG(padapter), target, strlen(target)); -+ RTW_INFO(FUNC_ADPT_FMT ": port = %x-%x, ttl = %d!\n", FUNC_ADPT_ARG(padapter), port0, port1, ttl); -+ RTW_INFO(FUNC_ADPT_FMT ": txt idx = %d!\n", FUNC_ADPT_ARG(padapter), txt_idx); -+ count = -EFAULT; -+ goto exit; -+ }*/else -+ { -+ port[0] = (u8)port0; -+ port[1] = (u8)port1; -+ -+ if(txt_idx >= MAX_MDNS_TXT_NUM) { -+ RTW_INFO(FUNC_ADPT_FMT ": input txt idx, %d, is out of range (0~%d)!\n", FUNC_ADPT_ARG(padapter), txt_idx, MAX_MDNS_TXT_NUM-1); -+ count = -EFAULT; -+ goto exit; -+ } -+ -+ if(pwrpriv->wowlan_war_offload_mdns_txt_rsp[txt_idx].txt_len == 0) { -+ RTW_INFO(FUNC_ADPT_FMT ": wowlan_war_offload_mdns_txt_rsp[%d] is null! Please initiate it first.\n", FUNC_ADPT_ARG(padapter), txt_idx); -+ count = -EFAULT; -+ goto exit; -+ } -+ -+ // 1. set the value of members for this new service -+ psinfo[idx].service_len = strlen(srv); -+ _rtw_memcpy(psinfo[idx].service, srv, psinfo[idx].service_len ); -+ psinfo[idx].transport_len = strlen(trans); -+ _rtw_memcpy(psinfo[idx].transport, trans, psinfo[idx].transport_len ); -+ psinfo[idx].domain_len = strlen(domain); -+ _rtw_memcpy(psinfo[idx].domain, domain, psinfo[idx].domain_len ); -+ psinfo[idx].target_len = strlen(target); -+ _rtw_memcpy(psinfo[idx].target, target, psinfo[idx].target_len ); -+ _rtw_memcpy(psinfo[idx].port, port, 2 ); -+ psinfo[idx].ttl = ttl; -+ psinfo[idx].txt_rsp_idx = txt_idx; -+ pwrpriv->wowlan_war_offload_mdns_service_info_num++; -+ } -+ } -+ -+exit: -+ if(tmp) -+ rtw_vmfree(tmp, sizeof(char)*(max_input_size)); -+ return count; -+ -+} -+ -+int proc_get_war_offload_mdns_txt_rsp(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 pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ int i=0; -+ -+ if (_TRUE == pwrpriv->wowlan_war_offload_mode) { -+ if ((WAR_MDNS_V4_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V6_RSP_EN & pwrpriv->wowlan_war_offload_ctrl) ) { -+ for(i=0; iwowlan_war_offload_mdns_txt_rsp_num; i++) { -+ RTW_PRINT_SEL(m, "[%d]", i); -+ if(pwrpriv->wowlan_war_offload_mdns_txt_rsp[i].txt_len==0){ -+ RTW_PRINT_SEL(m, " (null)\n"); -+ continue; -+ } -+ rtw_wow_war_mdns_dump_txt(m, "type txt rsp. (Str)", -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[i].txt, pwrpriv->wowlan_war_offload_mdns_txt_rsp[i].txt_len); -+ rtw_wow_war_mdns_dump_buf(m, "type txt rsp. (Hex)", -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[i].txt, pwrpriv->wowlan_war_offload_mdns_txt_rsp[i].txt_len); -+ } -+ RTW_PRINT_SEL(m, "\n"); -+ } else { -+ RTW_PRINT_SEL(m, "\nMSND RSP Not enabled\n\n"); -+ } -+ } else { -+ RTW_PRINT_SEL(m, "\nOffload Not enabled\n\n"); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_war_offload_mdns_txt_rsp(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 = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ u16 max_input_size = (1+6+MAX_MDNS_TXT_SINGLE_LEN+2); -+ char* tmp=NULL; -+ char op[7]={0}, txt_str[MAX_MDNS_TXT_SINGLE_LEN+1]={0}; -+ int idx; -+ -+ 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; -+ } -+ -+ tmp = rtw_zvmalloc(sizeof(char)*(max_input_size)); -+ if (NULL == tmp) { -+ RTW_INFO(FUNC_ADPT_FMT ": tmp buffer allocate fail!!\n", FUNC_ADPT_ARG(padapter)); -+ count = -EFAULT; -+ goto exit; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ if( strncmp(tmp, "clean", 5) == 0 ) -+ { -+ /* clean ==> */ -+ if(pwrpriv->wowlan_war_offload_mdns_service_info_num==0){ -+ _rtw_memset(pwrpriv->wowlan_war_offload_mdns_txt_rsp, 0, sizeof(pwrpriv->wowlan_war_offload_mdns_txt_rsp)); -+ }else{ -+ RTW_INFO(FUNC_ADPT_FMT ": Txt rsp are refered! (Current service_info_num = %d)\n", FUNC_ADPT_ARG(padapter), pwrpriv->wowlan_war_offload_mdns_service_info_num); -+ count = -EFAULT; -+ goto exit; -+ } -+ -+ }else{ -+ /* set ==> */ -+ int num = sscanf(tmp, "%d %6s %256c", &idx, op, txt_str); -+ u16 sscanf_parameter_length = 0, txt_len = 0; -+ -+ txt_len = (strlen(txt_str)>MAX_MDNS_TXT_SINGLE_LEN)?MAX_MDNS_TXT_SINGLE_LEN:(strlen(txt_str)-1); -+ txt_str[txt_len]='\0'; -+ sscanf_parameter_length = 1 + strlen(op) + txt_len + num; -+ -+ if(count != sscanf_parameter_length) { -+ RTW_INFO(FUNC_ADPT_FMT ": Length of total parameters does not match the input buffer. (%d != %lu)(num=%d)\n", -+ FUNC_ADPT_ARG(padapter), sscanf_parameter_length, count, num); -+ RTW_INFO(FUNC_ADPT_FMT ": Please check the content and length of each parameter.\n", FUNC_ADPT_ARG(padapter)); -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer = (%s)(%lu)!\n\n", FUNC_ADPT_ARG(padapter), tmp, count); -+ RTW_INFO(FUNC_ADPT_FMT ": op. = %s (%lu)!\n", FUNC_ADPT_ARG(padapter), op, strlen(op)); -+ RTW_INFO(FUNC_ADPT_FMT ": txt = %s (%lu)!\n", FUNC_ADPT_ARG(padapter), txt_str, strlen(txt_str)); -+ count = -EFAULT; -+ goto exit; -+ } else { -+ -+ u16 offset; -+ -+ if(idx >= MAX_MDNS_TXT_NUM) { -+ RTW_INFO(FUNC_ADPT_FMT ": the index, %d, is over the range of txt rsp(0~%d)!\n", FUNC_ADPT_ARG(padapter), idx, MAX_MDNS_TXT_NUM-1); -+ count = -EFAULT; -+ goto exit; -+ } -+ -+ if( strncmp(op, "new", 3) == 0 ) { -+ _rtw_memset(pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt, 0, pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt_len); -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt_len = 0; -+ }else if(strncmp(op, "append", 6) == 0 ){ -+ if((pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt_len+strlen(txt_str)+1) > MAX_MDNS_TXT_LEN) { -+ RTW_INFO(FUNC_ADPT_FMT ": the txt rsp(%d) will be over the limitation(%d) if append input string(%lu)!\n", FUNC_ADPT_ARG(padapter), -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt_len, -+ MAX_MDNS_TXT_LEN, strlen(txt_str)+1); -+ count = -EFAULT; -+ goto exit; -+ } -+ }else{ -+ RTW_INFO(FUNC_ADPT_FMT ": Invaild op str %s (new/append only)!\n", FUNC_ADPT_ARG(padapter), op); -+ count = -EFAULT; -+ goto exit; -+ } -+ -+ offset = pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt_len; -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt[offset++] = strlen(txt_str); -+ _rtw_memcpy(pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt + offset, txt_str, strlen(txt_str)); -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt_len += (strlen(txt_str) + 1); /* actul len with length field */ -+ -+ /* Dump ==> */ -+ //RTW_PRINT_SEL(RTW_DBGDUMP, "[%d]", idx); -+ //rtw_wow_war_mdns_dump_txt(RTW_DBGDUMP, "type txt rsp. (Str)", -+ // pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt, pwrpriv->wowlan_war_offload_mdns_txt_rsp[idx].txt_len); -+ } -+ } -+ } -+ -+exit: -+ if(tmp) -+ rtw_vmfree(tmp, sizeof(char)*(max_input_size)); -+ return count; -+ -+} -+ -+#endif /* CONFIG_OFFLOAD_MDNS_V4 || CONFIG_OFFLOAD_MDNS_V6 */ -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+ -+ -+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_RTW_REPEATER_SON -+int proc_get_rson_data(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char rson_data_str[256]; -+ -+ rtw_rson_get_property_str(padapter, rson_data_str); -+ RTW_PRINT_SEL(m, "%s\n", rson_data_str); -+ return 0; -+} -+ -+ssize_t proc_set_rson_data(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 *pdvobj = adapter_to_dvobj(padapter); -+ char tmp[64] = {0}; -+ int num; -+ u8 field[10], value[64]; -+ -+ 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, "%s %s", field, value); -+ if (num != 2) { -+ RTW_INFO("Invalid format : echo > son_data\n"); -+ return count; -+ } -+ RTW_INFO("field=%s value=%s\n", field, value); -+ num = rtw_rson_set_property(padapter, field, value); -+ if (num != 1) { -+ RTW_INFO("Invalid field(%s) or value(%s)\n", field, value); -+ return count; -+ } -+ } -+ return count; -+} -+#endif /*CONFIG_RTW_REPEATER_SON*/ -+ -+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; -+#ifdef CONFIG_RTW_MESH -+ const char *ssid_title_str = "ssid/mesh_id"; -+#else -+ const char *ssid_title_str = "ssid"; -+#endif -+ u8 rsni = 255; -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ phead = get_list_head(queue); -+ if (!phead) -+ goto _exit; -+ plist = get_next(phead); -+ if (!plist) -+ goto _exit; -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ rtw_rson_show_survey_info(m, plist, phead); -+#else -+ -+ RTW_PRINT_SEL(m, "%5s %-17s %3s %-3s %-4s %-4s %4s %5s %32s %32s \n", -+ "index", "bssid", "ch", "RSSI", "SdBm", "Noise", "rsni", "age", "flag", ssid_title_str); -+ 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, WIFI_ASOC_STATE) == _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 */ -+ } -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ if (IS_NM_ENABLE(padapter)) -+ notify_noise = rtw_noise_query_by_chan_num(padapter, pnetwork->network.Configuration.DSConfig); -+#endif -+#ifdef CONFIG_RTW_ACS -+ rsni = rtw_acs_get_rsni(padapter, (int)(pnetwork->network.Rssi), pnetwork->network.Configuration.DSConfig); -+#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); -+#ifdef CONFIG_P2P -+ ie_p2p = rtw_get_p2p_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &ielen); -+#endif -+ 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]" : -+ (pnetwork->network.InfrastructureMode == Ndis802_11_mesh) ? "[MESH]" : "", -+ (ie_cap & BIT(0)) ? "[ESS]" : "", -+ (ie_p2p) ? "[P2P]" : ""); -+ RTW_PRINT_SEL(m, "%5d "MAC_FMT" %3d %4d %4d %4d %4d %5d %32s %32s\n", -+ ++index, -+ MAC_ARG(pnetwork->network.MacAddress), -+ pnetwork->network.Configuration.DSConfig, -+ (int)pnetwork->network.Rssi, -+ notify_signal, -+ notify_noise, -+ rsni, -+ rtw_get_passing_time_ms(pnetwork->last_scanned), -+ flag_str, -+ pnetwork->network.InfrastructureMode == Ndis802_11_mesh ? pnetwork->network.mesh_id.Ssid : pnetwork->network.Ssid.Ssid -+ ); -+ plist = get_next(plist); -+ } -+#endif -+_exit: -+ _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) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 _status = _FALSE; -+ u8 ssc_chk; -+ char tmp[32] = {0}; -+ char cmd[8] = {0}; -+ bool acs = 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, "%s", cmd); -+ -+ if (num < 1) -+ return count; -+ -+ if (strcmp("acs", cmd) == 0) -+ acs = 1; -+ } -+ -+#if 1 -+ ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); -+ if (ssc_chk != SS_ALLOW) -+ 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; -+ } -+#else -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_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)) { -+ 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, WIFI_UNDER_SURVEY | WIFI_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, -+ WIFI_UNDER_SURVEY | WIFI_UNDER_LINKING | WIFI_UNDER_WPS)) { -+ RTW_INFO("scan abort!! buddy_fwstate check failed\n"); -+ goto cancel_ps_deny; -+ } -+#endif -+#endif -+ -+ if (acs) { -+ #ifdef CONFIG_RTW_ACS -+ _status = rtw_set_acs_sitesurvey(padapter); -+ #endif -+ } else -+ _status = rtw_set_802_11_bssid_list_scan(padapter, NULL); -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); -+exit: -+ return count; -+} -+#ifdef ROKU_PRIVATE -+int proc_get_infra_ap(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 ht_priv_infra_ap *phtpriv = &pmlmepriv->htpriv_infra_ap; -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv_infra_ap *pvhtpriv = &pmlmepriv->vhtpriv_infra_ap; -+#endif -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if (psta) { -+ unsigned int i, j; -+ unsigned int Rx_ss = 0, Tx_ss = 0; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+ RTW_PRINT_SEL(m, "SSID=%s\n", pmlmeinfo->network.Ssid.Ssid); -+ RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); -+ RTW_PRINT_SEL(m, "Supported rate="); -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ if (pmlmeinfo->SupportedRates_infra_ap[i] == 0) -+ break; -+ RTW_PRINT_SEL(m, " 0x%x", pmlmeinfo->SupportedRates_infra_ap[i]); -+ } -+ RTW_PRINT_SEL(m, "\n"); -+#ifdef CONFIG_80211N_HT -+ if (pmlmeinfo->ht_vht_received & BIT(0)) { -+ RTW_PRINT_SEL(m, "Supported MCS set="); -+ for (i = 0; i < 16 ; i++) -+ RTW_PRINT_SEL(m, " 0x%02x", phtpriv->MCS_set_infra_ap[i]); -+ RTW_PRINT_SEL(m, "\n"); -+ RTW_PRINT_SEL(m, "highest supported data rate=0x%x\n", phtpriv->rx_highest_data_rate_infra_ap); -+ RTW_PRINT_SEL(m, "HT_supported_channel_width_set=0x%x\n", phtpriv->channel_width_infra_ap); -+ RTW_PRINT_SEL(m, "sgi_20m=%d, sgi_40m=%d\n", phtpriv->sgi_20m_infra_ap, phtpriv->sgi_40m_infra_ap); -+ RTW_PRINT_SEL(m, "ldpc_cap=0x%x, stbc_cap=0x%x\n", phtpriv->ldpc_cap_infra_ap, phtpriv->stbc_cap_infra_ap); -+ RTW_PRINT_SEL(m, "HT_number_of_stream=%d\n", phtpriv->Rx_ss_infra_ap); -+ } -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ if (pmlmeinfo->ht_vht_received & BIT(1)) { -+ RTW_PRINT_SEL(m, "VHT_supported_channel_width_set=0x%x\n", pvhtpriv->channel_width_infra_ap); -+ RTW_PRINT_SEL(m, "vht_ldpc_cap=0x%x, vht_stbc_cap=0x%x, vht_beamform_cap=0x%x\n", pvhtpriv->ldpc_cap_infra_ap, pvhtpriv->stbc_cap_infra_ap, pvhtpriv->beamform_cap_infra_ap); -+ RTW_PRINT_SEL(m, "Rx_vht_mcs_map=0x%x, Tx_vht_mcs_map=0x%x\n", *(u16 *)pvhtpriv->vht_mcs_map_infra_ap, *(u16 *)pvhtpriv->vht_mcs_map_tx_infra_ap); -+ RTW_PRINT_SEL(m, "VHT_number_of_stream=%d\n", pvhtpriv->number_of_streams_infra_ap); -+ } -+#endif -+ } else -+ RTW_PRINT_SEL(m, "can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); -+ } else -+ RTW_PRINT_SEL(m, "this only applies to STA mode\n"); -+ return 0; -+} -+ -+#endif /* ROKU_PRIVATE */ -+ -+static int wireless_mode_to_str(u32 mode, char *str) -+{ -+ str[0]='\0'; -+ if (mode&WIRELESS_11A) -+ sprintf(str+strlen(str),"%s","A/"); -+ if (mode&WIRELESS_11B) -+ sprintf(str+strlen(str),"%s","B/"); -+ if (mode&WIRELESS_11G) -+ sprintf(str+strlen(str),"%s","G/"); -+ if (mode&(WIRELESS_11_24N|WIRELESS_11_5N)) -+ sprintf(str+strlen(str),"%s","N/"); -+ if (mode&WIRELESS_11AC) -+ sprintf(str+strlen(str),"%s","AC/"); -+ -+ if (strlen(str)>1) -+ str[strlen(str)-1]='\0'; -+ -+ return strlen(str); -+} -+ -+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 mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ char wl_mode[16]; -+ -+ /* ap vendor */ -+ char vendor[VENDOR_NAME_LEN] = {0}; -+ get_assoc_AP_Vendor(vendor,pmlmeinfo->assoc_AP_vendor); -+ RTW_PRINT_SEL(m,"AP Vendor %s\n", vendor); -+ -+ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if (psta) { -+ wireless_mode_to_str(psta->wireless_mode, wl_mode); -+ 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->cmn.mac_addr)); -+ RTW_PRINT_SEL(m, "cur_channel=%d, cur_bwmode=%d(%s), cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, ch_width_str(pmlmeext->cur_bwmode), pmlmeext->cur_ch_offset); -+ RTW_PRINT_SEL(m, "wireless_mode=0x%x(%s), rtsen=%d, cts2slef=%d\n", psta->wireless_mode, wl_mode, psta->rtsen, psta->cts2self); -+ RTW_PRINT_SEL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", -+ psta->state, psta->cmn.aid, psta->cmn.mac_id, psta->cmn.ra_info.rate_id); -+#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->cmn.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; -+} -+ -+inline void rtw_rx_dbg_ip_statistic_init( -+ char *pcmd, struct rtw_ip_dbg_cnt_statistic *pstatistic) -+{ -+#define DBG_IP_ARG_IN(x) \ -+ &((u8 *)(x))[0], &((u8 *)(x))[1], \ -+ &((u8 *)(x))[2], &((u8 *)(x))[3] -+ /* Inpit : [iperf-client-ip]:[iperf-server-port] [iperf-version] */ -+ int num = sscanf(pcmd, "%hhu.%hhu.%hhu.%hhu:%hu %hhx", -+ DBG_IP_ARG_IN(pstatistic->ip), -+ &pstatistic->dst_port, -+ &pstatistic->iperf_ver); -+ pstatistic->enabled = _TRUE; -+ pstatistic->defrag_done = _TRUE; -+} -+ -+inline void rtw_rx_dbg_ip_statistic_rest( -+ struct rtw_ip_dbg_cnt_statistic *pstatistic, u8 off) -+{ -+ pstatistic->ip_cnt = pstatistic->tcp_cnt = pstatistic->udp_cnt = \ -+ pstatistic->frag_cnt = pstatistic->iperf_seq = pstatistic->iperf_err_cnt = \ -+ pstatistic->iperf_out_of_order_cnt = 0; -+ -+ pstatistic->ip_seq_chk = 0; -+ pstatistic->frag_offset_chk = pstatistic->max_frag_offset_chk = 0; -+ pstatistic->defrag_done = _TRUE; -+ -+ if (off) { -+ pstatistic->enabled = _FALSE; -+ pstatistic->iperf_ver = 0; -+ pstatistic->dst_port = 0; -+ _rtw_memset(&pstatistic->ip, 0, 4); -+ } -+} -+ -+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 recv_priv *precvpriv = &padapter->recvpriv; -+ 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 = 0; -+ if (count > 12) -+ rtw_rx_dbg_ip_statistic_init(cmd, &(precvpriv->ip_statistic)); -+ else -+ num = sscanf(cmd, "%hhx", &cnt); -+ -+ if (num == 1 && cnt == 0) { -+ precvpriv->dbg_rx_ampdu_drop_count = 0; -+ precvpriv->dbg_rx_ampdu_forced_indicate_count = 0; -+ precvpriv->dbg_rx_ampdu_loss_count = 0; -+ precvpriv->dbg_rx_dup_mgt_frame_drop_count = 0; -+ precvpriv->dbg_rx_ampdu_window_shift_cnt = 0; -+ precvpriv->dbg_rx_conflic_mac_addr_cnt = 0; -+ precvpriv->dbg_rx_drop_count = 0; -+ /* Reset ip packet statistic */ -+ rtw_rx_dbg_ip_statistic_rest(&(precvpriv->ip_statistic), 0); -+ } else if ((num == 1) && (cnt == 2)) { -+ /* Disable ip packet statistic */ -+ rtw_rx_dbg_ip_statistic_rest(&(precvpriv->ip_statistic), 1); -+ } -+ } -+ -+ 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 hw_xmit *phwxmit; -+ u16 vo_params[4], vi_params[4], be_params[4], bk_params[4]; -+ -+ padapter->hal_func.read_wmmedca_reg(padapter, vo_params, vi_params, be_params, bk_params); -+ -+ RTW_PRINT_SEL(m, "wmm_edca_vo, aifs = %u us, cw_min = %u, cw_max = %u, txop_limit = %u us\n", vo_params[0], vo_params[1], vo_params[2], vo_params[3]); -+ RTW_PRINT_SEL(m, "wmm_edca_vi, aifs = %u us, cw_min = %u, cw_max = %u, txop_limit = %u us\n", vi_params[0], vi_params[1], vi_params[2], vi_params[3]); -+ RTW_PRINT_SEL(m, "wmm_edca_be, aifs = %u us, cw_min = %u, cw_max = %u, txop_limit = %u us\n", be_params[0], be_params[1], be_params[2], be_params[3]); -+ RTW_PRINT_SEL(m, "wmm_edca_bk, aifs = %u us, cw_min = %u, cw_max = %u, txop_limit = %u us\n", bk_params[0], bk_params[1], bk_params[2], bk_params[3]); -+ -+ 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 < pxmitpriv->hwxmit_entry; i++) { -+ phwxmit = pxmitpriv->hwxmits + i; -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ if (i == pxmitpriv->hwxmit_entry - 1) -+ RTW_PRINT_SEL(m, "%d, hw_mgmt_q.accnt=%d\n", i, phwxmit->accnt); -+ else -+#endif -+ RTW_PRINT_SEL(m, "%d, hwq.accnt=%d\n", i, phwxmit->accnt); -+ } -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_DUMP_MAC_TXFIFO, (u8 *)m); -+ -+#ifdef CONFIG_USB_HCI -+ RTW_PRINT_SEL(m, "rx_urb_pending_cn=%d\n", ATOMIC_READ(&(precvpriv->rx_pending_cnt))); -+#ifdef CONFIG_USB_PROTECT_RX_CLONED_SKB -+ RTW_PRINT_SEL(m, "rx_cloned_skb_pending_cn=%d\n", skb_queue_len(&precvpriv->rx_cloned_skb_queue)); -+#endif -+#endif -+ -+ dump_rx_bh_tk(m, &GET_PRIMARY_ADAPTER(padapter)->recvpriv); -+ -+ /* Folowing are RX info */ -+ RTW_PRINT_SEL(m, "RX: Count of Packets dropped by Driver: %llu\n", (unsigned long long)precvpriv->dbg_rx_drop_count); -+ /* 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)precvpriv->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)precvpriv->dbg_rx_ampdu_forced_indicate_count); -+ /* Total counts of packets loss */ -+ RTW_PRINT_SEL(m, "Rx: Packet Loss Counts: %llu\n", (unsigned long long)precvpriv->dbg_rx_ampdu_loss_count); -+ RTW_PRINT_SEL(m, "Rx: Duplicate Management Frame Drop Count: %llu\n", (unsigned long long)precvpriv->dbg_rx_dup_mgt_frame_drop_count); -+ RTW_PRINT_SEL(m, "Rx: AMPDU BA window shift Count: %llu\n", (unsigned long long)precvpriv->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)precvpriv->dbg_rx_conflic_mac_addr_cnt); -+ -+ if (precvpriv->ip_statistic.enabled) { -+ RTW_PRINT_SEL(m,"Rx : %u IP Packets, Frag %u at "IP_FMT":%u\n", -+ precvpriv->ip_statistic.ip_cnt, precvpriv->ip_statistic.frag_cnt, -+ IP_ARG(precvpriv->ip_statistic.ip), precvpriv->ip_statistic.dst_port); -+ RTW_PRINT_SEL(m, "Rx: TCP Count: %u, UDP Count : %u\n", -+ precvpriv->ip_statistic.tcp_cnt, precvpriv->ip_statistic.udp_cnt); -+ -+ if (precvpriv->ip_statistic.iperf_ver > 0) -+ RTW_PRINT_SEL(m, "Rx: Iperf Packet: %u, Error : %u, Out-of-Order: %u,\n", -+ precvpriv->ip_statistic.iperf_seq, precvpriv->ip_statistic.iperf_err_cnt, -+ precvpriv->ip_statistic.iperf_out_of_order_cnt); -+ /* Reset ip packet statistic */ -+ rtw_rx_dbg_ip_statistic_rest(&(precvpriv->ip_statistic), 0); -+ } -+ return 0; -+} -+ -+int proc_get_rate_ctl(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _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; -+} -+ -+#ifdef CONFIG_PHDYM_FW_FIXRATE -+void phydm_fw_fix_rate(void *dm_void, u8 en, u8 macid, u8 bw, u8 rate); -+#endif -+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); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ char tmp[32]; -+ u8 fix_rate = 0xFF; -+#ifdef CONFIG_PHDYM_FW_FIXRATE -+ u8 bw = 0; -+#else -+ u8 data_fb = 0; -+#endif -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+#ifdef CONFIG_PHDYM_FW_FIXRATE -+ struct dm_struct *dm = adapter_to_phydm(adapter); -+ u8 en = 1, macid = 255; -+ _irqL irqL; -+ _list *plist, *phead; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &(adapter->stapriv); -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 null_addr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ uint mac_id[NUM_STA]; -+ int i, macid_rec_idx = 0; -+ int num = sscanf(tmp, "%hhx %hhu %hhu", &fix_rate, &bw, &macid); -+ -+ if (num < 1) { -+ RTW_INFO("Invalid input!! \"ex: echo > /proc/.../rate_ctl\"\n"); -+ return count; -+ } -+ -+ if ((fix_rate == 0) || (fix_rate == 0xFF)) -+ en = 0; -+ -+ if (macid != 255) { -+ RTW_INFO("Call phydm_fw_fix_rate()--en[%d] mac_id[%d] bw[%d] fix_rate[%d]\n", en, macid, bw, fix_rate); -+ phydm_fw_fix_rate(dm, en, macid, bw, fix_rate); -+ return count; -+ } -+ -+ /* no specific macid, apply to all macids except bc/mc macid */ -+ _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 ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) -+ && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) != _TRUE) -+ && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(adapter), ETH_ALEN) != _TRUE)) { -+ mac_id[macid_rec_idx] = psta->cmn.mac_id; -+ macid_rec_idx++; -+ } -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (i = 0; i < macid_rec_idx; i++) { -+ RTW_INFO("Call phydm_fw_fix_rate()--en[%d] mac_id[%d] bw[%d] fix_rate[%d]\n", en, mac_id[i], bw, fix_rate); -+ phydm_fw_fix_rate(dm, en, mac_id[i], bw, fix_rate); -+ } -+#else -+ 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 (fix_rate == 0xFF) -+ hal_data->ForcedDataRate = 0; -+ else -+ hal_data->ForcedDataRate = hw_rate_to_m_rate(fix_rate & 0x7F); -+ -+ if (adapter->fix_bw != 0xFF && fix_rate_ori != fix_rate) -+ rtw_run_in_thread_cmd(adapter, ((void *)(rtw_update_tx_rate_bmp)), adapter_to_dvobj(adapter)); -+ } -+ if (num >= 2) -+ adapter->data_fb = data_fb ? 1 : 0; -+#endif -+ } -+ -+ return count; -+} -+ -+#ifdef CONFIG_AP_MODE -+int proc_get_bmc_tx_rate(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (!MLME_IS_AP(adapter) && !MLME_IS_MESH(adapter)) { -+ RTW_PRINT_SEL(m, "[ERROR] Not in SoftAP/Mesh mode !!\n"); -+ return 0; -+ } -+ -+ RTW_PRINT_SEL(m, " BMC Tx rate - %s\n", MGN_RATE_STR(adapter->bmc_tx_rate)); -+ return 0; -+} -+ -+ssize_t proc_set_bmc_tx_rate(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 bmc_tx_rate; -+ -+ 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", &bmc_tx_rate); -+ -+ if (num >= 1) -+ /*adapter->bmc_tx_rate = hw_rate_to_m_rate(bmc_tx_rate);*/ -+ adapter->bmc_tx_rate = bmc_tx_rate; -+ } -+ -+ return count; -+} -+#endif /*CONFIG_AP_MODE*/ -+ -+ -+int proc_get_tx_power_offset(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "Tx power offset - %u\n", adapter->power_offset); -+ return 0; -+} -+ -+ssize_t proc_set_tx_power_offset(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 power_offset = 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", &power_offset); -+ -+ if (num >= 1) { -+ if (power_offset > 5) -+ power_offset = 0; -+ -+ adapter->power_offset = power_offset; -+ } -+ } -+ -+ 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_run_in_thread_cmd(adapter, ((void *)(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); -+ -+ if (num == 1) { -+ 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) -+{ -+ 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)) -+ 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) -+{ -+ 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)) -+ sscanf(tmp, "%hhu", &del_rx_ampdu_test_no_tx_fail); -+ -+ return count; -+} -+ -+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 (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) -+ sscanf(tmp, "%u", &g_wait_hiq_empty_ms); -+ -+ return count; -+} -+ -+ssize_t proc_set_sta_linking_test(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ 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)) { -+ u32 wait_ms = 0; -+ u8 force_fail = 0; -+ int num = sscanf(tmp, "%u %hhu", &wait_ms, &force_fail); -+ -+ if (num >= 1) -+ sta_linking_test_wait_ms = wait_ms; -+ if (num >= 2) -+ sta_linking_test_force_fail = force_fail; -+ } -+ -+ return count; -+} -+ -+#ifdef CONFIG_AP_MODE -+ssize_t proc_set_ap_linking_test(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ 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)) { -+ u16 force_auth_fail = 0; -+ u16 force_asoc_fail = 0; -+ int num = sscanf(tmp, "%hu %hu", &force_auth_fail, &force_asoc_fail); -+ -+ if (num >= 1) -+ ap_linking_test_force_auth_fail = force_auth_fail; -+ if (num >= 2) -+ ap_linking_test_force_asoc_fail = force_asoc_fail; -+ } -+ -+ return count; -+} -+#endif /* CONFIG_AP_MODE */ -+ -+int proc_get_ps_dbg_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); -+ RTW_PRINT_SEL(m, "dbg_fw_mem_dl_error_cnt=%d\n", pdbgpriv->dbg_fw_mem_dl_error_cnt); -+ -+ return 0; -+} -+ssize_t proc_set_ps_dbg_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); -+ struct dvobj_priv *dvobj = adapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ char tmp[32]; -+ u8 ps_dbg_cmd_id; -+ -+ 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", &ps_dbg_cmd_id); -+ -+ if (num == 1 && ps_dbg_cmd_id == 1) /*Clean all*/ -+ _rtw_memset(pdbgpriv, 0, sizeof(struct debug_priv)); -+ -+ } -+ -+ return count; -+} -+ -+ -+#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 (num == 1 && regsty && enable <= 1) { -+ regsty->check_hw_status = enable; -+ RTW_INFO("check_hw_status=%d\n", regsty->check_hw_status); -+ } -+ } -+ -+ return count; -+} -+ -+#ifdef CONFIG_HUAWEI_PROC -+int proc_get_huawei_trx_info(struct seq_file *sel, void *v) -+{ -+ struct net_device *dev = sel->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dm_struct *dm = adapter_to_phydm(padapter); -+ struct sta_info *psta; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct ra_sta_info *ra_info; -+ u8 curr_tx_sgi = _FALSE; -+ u8 curr_tx_rate = 0; -+ u8 mac_id; -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ u8 isCCKrate, rf_path; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; -+#endif -+ -+ if (!dm->is_linked) { -+ RTW_PRINT_SEL(sel, "NO link\n\n"); -+ return 0; -+ } -+ -+ /*============ tx info ============ */ -+ for (mac_id = 0; mac_id < macid_ctl->num; mac_id++) { -+ if (rtw_macid_is_used(macid_ctl, mac_id) && !rtw_macid_is_bmc(macid_ctl, mac_id)) { -+ psta = macid_ctl->sta[mac_id]; -+ if (!psta) -+ continue; -+ -+ RTW_PRINT_SEL(sel, "STA [" MAC_FMT "]\n", MAC_ARG(psta->cmn.mac_addr)); -+ -+ ra_info = &psta->cmn.ra_info; -+ curr_tx_sgi = rtw_get_current_tx_sgi(padapter, psta); -+ curr_tx_rate = rtw_get_current_tx_rate(padapter, psta); -+ RTW_PRINT_SEL(sel, "curr_tx_rate : %s (%s)\n", -+ HDATA_RATE(curr_tx_rate), (curr_tx_sgi) ? "S" : "L"); -+ RTW_PRINT_SEL(sel, "curr_tx_bw : %s\n", ch_width_str(ra_info->curr_tx_bw)); -+ } -+ } -+ -+ /*============ rx info ============ */ -+ RTW_PRINT_SEL(sel, "rx_rate : %s\n", HDATA_RATE(dm->rx_rate)); -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ isCCKrate = (psample_pkt_rssi->data_rate <= DESC_RATE11M) ? TRUE : FALSE; -+ -+ for (rf_path = 0; rf_path < hal_spec->rf_reg_path_num; rf_path++) { -+ if (!(GET_HAL_RX_PATH_BMP(padapter) & BIT(rf_path))) -+ continue; -+ if (!isCCKrate) -+ _RTW_PRINT_SEL(sel , "RF_PATH_%d : rx_ofdm_pwr:%d(dBm), rx_ofdm_snr:%d(dB)\n", -+ rf_path, psample_pkt_rssi->ofdm_pwr[rf_path], psample_pkt_rssi->ofdm_snr[rf_path]); -+ } -+#endif -+ RTW_PRINT_SEL(sel, "\n"); -+ return 0; -+} -+#endif /* CONFIG_HUAWEI_PROC */ -+ -+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); -+ -+ /*============ 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); -+ -+ RTW_PRINT_SEL(m, "rssi:%d\n", padapter->recvpriv.rssi); -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) { -+ struct dm_struct *odm = adapter_to_phydm(padapter); -+ 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"); -+ -+ RTW_PRINT_SEL(m, "rx_rate = %s\n", HDATA_RATE(odm->rx_rate)); -+ return 0; -+ } else -+#endif -+ { -+ /* 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); -+ } -+#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); -+ -+ if (num < 1) -+ return count; -+ -+ 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; -+ -+} -+ -+int proc_get_mac_rptbuf(struct seq_file *m, void *v) -+{ -+#ifdef CONFIG_RTL8814A -+ 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; -+ -+ 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; -+} -+ -+#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 ( num == 1 && 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 (num == 1 && 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 (num == 1 && pregpriv && mode < 2) { -+ pregpriv->ampdu_enable = mode; -+ printk("ampdu_enable=%d\n", mode); -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+ -+void dump_regsty_rx_ampdu_size_limit(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ int i; -+ -+ RTW_PRINT_SEL(sel, "%-3s %-3s %-3s %-3s %-4s\n" -+ , "", "20M", "40M", "80M", "160M"); -+ for (i = 0; i < 4; i++) -+ RTW_PRINT_SEL(sel, "%dSS %3u %3u %3u %4u\n", i + 1 -+ , regsty->rx_ampdu_sz_limit_by_nss_bw[i][0] -+ , regsty->rx_ampdu_sz_limit_by_nss_bw[i][1] -+ , regsty->rx_ampdu_sz_limit_by_nss_bw[i][2] -+ , regsty->rx_ampdu_sz_limit_by_nss_bw[i][3]); -+} -+ -+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) with conditional limit:"); -+ dump_regsty_rx_ampdu_size_limit(m, padapter); -+ } else -+ RTW_PRINT_SEL(m, "%u%s\n", padapter->fix_rx_ampdu_size, "(fixed)"); -+ RTW_PRINT_SEL(m, "\n"); -+ -+ 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); -+ 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); -+ } -+ -+ return count; -+} -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+int proc_get_tx_aval_th(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ if (padapter) { -+ -+ switch(dvobj->tx_aval_int_thr_mode) { -+ case 0: -+ RTW_PRINT_SEL(m, "tx_aval_int_thr_mode = %u (auto) \n", dvobj->tx_aval_int_thr_mode); -+ break; -+ case 1: -+ RTW_PRINT_SEL(m, "tx_aval_int_thr_mode = %u (fixed)\n", dvobj->tx_aval_int_thr_mode); -+ RTW_PRINT_SEL(m, "tx_aval_threshold = 0x%x\n", dvobj->tx_aval_int_thr_value); -+ break; -+ case 2: -+ RTW_PRINT_SEL(m, "tx_aval_int_thr_mode = %u(by sdio_tx_max_len)\n", dvobj->tx_aval_int_thr_mode); -+ break; -+ default: -+ break; -+ } -+ } -+ return 0; -+} -+ -+ssize_t proc_set_tx_aval_th(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 = adapter_to_dvobj(padapter); -+ char tmp[32]; -+ u32 mode; -+ u32 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, "%d %d ",&mode, &threshold); -+ -+ if(num >= 1) -+ dvobj->tx_aval_int_thr_mode = mode; -+ if(num >= 2) -+ dvobj->tx_aval_int_thr_value = threshold; -+ RTW_INFO("dvobj->tx_aval_int_thr_mode= 0x%x\n", mode); -+ RTW_INFO("dvobj->tx_aval_int_thr_value= 0x%x(range need 1~255)\n", threshold); -+ } -+ -+ return count; -+} -+#endif /*CONFIG_SDIO_TX_ENABLE_AVAL_INT*/ -+ -+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_tx_max_agg_num(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 max AMPDU num = 0x%02x\n", padapter->driver_tx_max_agg_num); -+ -+ return 0; -+} -+ -+ssize_t proc_set_tx_max_agg_num(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 agg_num; -+ -+ 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 ", &agg_num); -+ -+ if (padapter && (num == 1)) { -+ RTW_INFO("padapter->driver_tx_max_agg_num = 0x%02x\n", agg_num); -+ -+ padapter->driver_tx_max_agg_num = agg_num; -+ } -+ } -+ -+ 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; -+} -+ -+int proc_get_tx_quick_addba_req(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 (padapter) -+ RTW_PRINT_SEL(m, "tx_quick_addba_req = %x\n", pregpriv->tx_quick_addba_req); -+ -+ return 0; -+} -+ -+ssize_t proc_set_tx_quick_addba_req(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 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 (padapter && (num == 1)) { -+ pregpriv->tx_quick_addba_req = enable; -+ RTW_INFO("tx_quick_addba_req = %d\n", pregpriv->tx_quick_addba_req); -+ } -+ } -+ -+ return count; -+} -+#ifdef CONFIG_TX_AMSDU -+int proc_get_tx_amsdu(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter) -+ { -+ RTW_PRINT_SEL(m, "tx amsdu = %d\n", padapter->tx_amsdu); -+ RTW_PRINT_SEL(m, "amsdu set timer conut = %u\n", pxmitpriv->amsdu_debug_set_timer); -+ RTW_PRINT_SEL(m, "amsdu time out count = %u\n", pxmitpriv->amsdu_debug_timeout); -+ RTW_PRINT_SEL(m, "amsdu coalesce one count = %u\n", pxmitpriv->amsdu_debug_coalesce_one); -+ RTW_PRINT_SEL(m, "amsdu coalesce two count = %u\n", pxmitpriv->amsdu_debug_coalesce_two); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_tx_amsdu(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 xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ char tmp[32]; -+ u32 amsdu; -+ -+ 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 ", &amsdu); -+ -+ if (padapter && (num == 1)) { -+ RTW_INFO("padapter->tx_amsdu = %x\n", amsdu); -+ -+ if (amsdu > 3) -+ padapter->tx_amsdu = 0; -+ else if(amsdu == 3) -+ { -+ pxmitpriv->amsdu_debug_set_timer = 0; -+ pxmitpriv->amsdu_debug_timeout = 0; -+ pxmitpriv->amsdu_debug_coalesce_one = 0; -+ pxmitpriv->amsdu_debug_coalesce_two = 0; -+ } -+ else -+ padapter->tx_amsdu = amsdu; -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_tx_amsdu_rate(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 amsdu rate = %d Mbps\n", padapter->tx_amsdu_rate); -+ -+ return 0; -+} -+ -+ssize_t proc_set_tx_amsdu_rate(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 amsdu_rate; -+ -+ 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 ", &amsdu_rate); -+ -+ if (padapter && (num == 1)) { -+ RTW_INFO("padapter->tx_amsdu_rate = %x\n", amsdu_rate); -+ padapter->tx_amsdu_rate = amsdu_rate; -+ } -+ } -+ -+ return count; -+} -+#endif /* CONFIG_TX_AMSDU */ -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_80211AC_VHT -+int proc_get_vht_24g_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->vht_24g_enable); -+ -+ return 0; -+} -+ -+ssize_t proc_set_vht_24g_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 ((num == 1) && pregpriv && (mode < 2)) { -+ pregpriv->vht_24g_enable = mode; -+ RTW_INFO("vht_24g_enable = %d\n", pregpriv->vht_24g_enable); -+ } -+ } -+ -+ return count; -+ -+} -+#endif -+ -+ssize_t proc_set_dyn_rrsr(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] = {0}; -+ u32 num = 0, enable = 0, rrsr_val = 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 0x%x", &enable, &rrsr_val); -+ RTW_INFO("num=%u enable=%d rrsr_val=0x%x\n", num, enable, rrsr_val); -+ pregpriv->en_dyn_rrsr = enable; -+ pregpriv->set_rrsr_value = rrsr_val; -+ rtw_phydm_dyn_rrsr_en(padapter, enable); -+ rtw_phydm_set_rrsr(padapter, rrsr_val, TRUE); -+ -+ } -+ return count; -+ -+} -+int proc_get_dyn_rrsr(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; -+ u32 init_rrsr =0xFFFFFFFF; -+ -+ if (padapter) -+ RTW_PRINT_SEL(m, "en_dyn_rrsr = %d fixed_rrsr_value =0x%x %s\n" -+ , pregpriv->en_dyn_rrsr -+ , pregpriv->set_rrsr_value -+ , (pregpriv->set_rrsr_value == init_rrsr)?"(default)":"(fixed)" -+ ); -+ -+ 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; -+ -+ 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; -+ 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 (num == 1 && 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 -+void rtw_dump_dft_phy_cap(void *sel, _adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ #ifdef CONFIG_80211AC_VHT -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ #endif -+ -+ #ifdef CONFIG_80211AC_VHT -+ RTW_PRINT_SEL(sel, "[DFT CAP] VHT STBC Tx : %s\n", (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DFT CAP] VHT STBC Rx : %s\n", (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX)) ? "V" : "X"); -+ #endif -+ RTW_PRINT_SEL(sel, "[DFT CAP] HT STBC Tx : %s\n", (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DFT CAP] HT STBC Rx : %s\n\n", (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX)) ? "V" : "X"); -+ -+ #ifdef CONFIG_80211AC_VHT -+ RTW_PRINT_SEL(sel, "[DFT CAP] VHT LDPC Tx : %s\n", (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DFT CAP] VHT LDPC Rx : %s\n", (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX)) ? "V" : "X"); -+ #endif -+ RTW_PRINT_SEL(sel, "[DFT CAP] HT LDPC Tx : %s\n", (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DFT CAP] HT LDPC Rx : %s\n\n", (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX)) ? "V" : "X"); -+ -+ #ifdef CONFIG_BEAMFORMING -+ #ifdef CONFIG_80211AC_VHT -+ RTW_PRINT_SEL(sel, "[DFT CAP] VHT MU Bfer : %s\n", (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DFT CAP] VHT MU Bfee : %s\n", (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DFT CAP] VHT SU Bfer : %s\n", (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DFT CAP] VHT SU Bfee : %s\n", (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) ? "V" : "X"); -+ #endif -+ RTW_PRINT_SEL(sel, "[DFT CAP] HT Bfer : %s\n", (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DFT CAP] HT Bfee : %s\n", (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) ? "V" : "X"); -+ #endif -+} -+ -+void rtw_get_dft_phy_cap(void *sel, _adapter *adapter) -+{ -+ RTW_PRINT_SEL(sel, "\n ======== PHY CAP protocol ========\n"); -+ rtw_ht_use_default_setting(adapter); -+ #ifdef CONFIG_80211AC_VHT -+ rtw_vht_use_default_setting(adapter); -+ #endif -+ #ifdef CONFIG_80211N_HT -+ rtw_dump_dft_phy_cap(sel, adapter); -+ #endif -+} -+ -+void rtw_dump_drv_phy_cap(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *pregistry_priv = &adapter->registrypriv; -+ -+ RTW_PRINT_SEL(sel, "\n ======== DRV's configuration ========\n"); -+ #if 0 -+ RTW_PRINT_SEL(sel, "[DRV CAP] TRx Capability : 0x%08x\n", phy_spec->trx_cap); -+ RTW_PRINT_SEL(sel, "[DRV CAP] Tx Stream Num Index : %d\n", (phy_spec->trx_cap >> 24) & 0xFF); /*Tx Stream Num Index [31:24]*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] Rx Stream Num Index : %d\n", (phy_spec->trx_cap >> 16) & 0xFF); /*Rx Stream Num Index [23:16]*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] Tx Path Num Index : %d\n", (phy_spec->trx_cap >> 8) & 0xFF);/*Tx Path Num Index [15:8]*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] Rx Path Num Index : %d\n", (phy_spec->trx_cap & 0xFF));/*Rx Path Num Index [7:0]*/ -+ #endif -+ #ifdef CONFIG_80211N_HT -+ RTW_PRINT_SEL(sel, "[DRV CAP] STBC Capability : 0x%02x\n", pregistry_priv->stbc_cap); -+ RTW_PRINT_SEL(sel, "[DRV CAP] VHT STBC Tx : %s\n", (TEST_FLAG(pregistry_priv->stbc_cap, BIT1)) ? "V" : "X"); /*BIT1: Enable VHT STBC Tx*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] VHT STBC Rx : %s\n", (TEST_FLAG(pregistry_priv->stbc_cap, BIT0)) ? "V" : "X"); /*BIT0: Enable VHT STBC Rx*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] HT STBC Tx : %s\n", (TEST_FLAG(pregistry_priv->stbc_cap, BIT5)) ? "V" : "X"); /*BIT5: Enable HT STBC Tx*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] HT STBC Rx : %s\n\n", (TEST_FLAG(pregistry_priv->stbc_cap, BIT4)) ? "V" : "X"); /*BIT4: Enable HT STBC Rx*/ -+ -+ RTW_PRINT_SEL(sel, "[DRV CAP] LDPC Capability : 0x%02x\n", pregistry_priv->ldpc_cap); -+ RTW_PRINT_SEL(sel, "[DRV CAP] VHT LDPC Tx : %s\n", (TEST_FLAG(pregistry_priv->ldpc_cap, BIT1)) ? "V" : "X"); /*BIT1: Enable VHT LDPC Tx*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] VHT LDPC Rx : %s\n", (TEST_FLAG(pregistry_priv->ldpc_cap, BIT0)) ? "V" : "X"); /*BIT0: Enable VHT LDPC Rx*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] HT LDPC Tx : %s\n", (TEST_FLAG(pregistry_priv->ldpc_cap, BIT5)) ? "V" : "X"); /*BIT5: Enable HT LDPC Tx*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] HT LDPC Rx : %s\n\n", (TEST_FLAG(pregistry_priv->ldpc_cap, BIT4)) ? "V" : "X"); /*BIT4: Enable HT LDPC Rx*/ -+ #endif /* CONFIG_80211N_HT */ -+ #ifdef CONFIG_BEAMFORMING -+ #if 0 -+ RTW_PRINT_SEL(sel, "[DRV CAP] TxBF parameter : 0x%08x\n", phy_spec->txbf_param); -+ RTW_PRINT_SEL(sel, "[DRV CAP] VHT Sounding Dim : %d\n", (phy_spec->txbf_param >> 24) & 0xFF); /*VHT Sounding Dim [31:24]*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] VHT Steering Ant : %d\n", (phy_spec->txbf_param >> 16) & 0xFF); /*VHT Steering Ant [23:16]*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] HT Sounding Dim : %d\n", (phy_spec->txbf_param >> 8) & 0xFF); /*HT Sounding Dim [15:8]*/ -+ RTW_PRINT_SEL(sel, "[DRV CAP] HT Steering Ant : %d\n", phy_spec->txbf_param & 0xFF); /*HT Steering Ant [7:0]*/ -+ #endif -+ -+ /* -+ * 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 -+ */ -+ RTW_PRINT_SEL(sel, "[DRV CAP] TxBF Capability : 0x%02x\n", pregistry_priv->beamform_cap); -+ RTW_PRINT_SEL(sel, "[DRV CAP] VHT MU Bfer : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT2)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DRV CAP] VHT MU Bfee : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT3)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DRV CAP] VHT SU Bfer : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT0)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DRV CAP] VHT SU Bfee : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT1)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DRV CAP] HT Bfer : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT4)) ? "V" : "X"); -+ RTW_PRINT_SEL(sel, "[DRV CAP] HT Bfee : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT5)) ? "V" : "X"); -+ -+ RTW_PRINT_SEL(sel, "[DRV CAP] Tx Bfer rf_num : %d\n", pregistry_priv->beamformer_rf_num); -+ RTW_PRINT_SEL(sel, "[DRV CAP] Tx Bfee rf_num : %d\n", pregistry_priv->beamformee_rf_num); -+ #endif -+} -+ -+int proc_get_stbc_cap(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->stbc_cap); -+ -+ return 0; -+} -+ -+ssize_t proc_set_stbc_cap(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 (num == 1 && pregpriv) { -+ pregpriv->stbc_cap = mode; -+ RTW_INFO("stbc_cap = 0x%02x\n", mode); -+ } -+ } -+ -+ return count; -+} -+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 (num == 1 && pregpriv && (mode == 0 || mode == 1 || mode == 2 || mode == 3)) { -+ pregpriv->rx_stbc = mode; -+ printk("rx_stbc=%d\n", mode); -+ } -+ } -+ -+ return count; -+ -+} -+int proc_get_ldpc_cap(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->ldpc_cap); -+ -+ return 0; -+} -+ -+ssize_t proc_set_ldpc_cap(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 (num == 1 && pregpriv) { -+ pregpriv->ldpc_cap = mode; -+ RTW_INFO("ldpc_cap = 0x%02x\n", mode); -+ } -+ } -+ -+ return count; -+} -+#ifdef CONFIG_BEAMFORMING -+int proc_get_txbf_cap(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->beamform_cap); -+ -+ return 0; -+} -+ -+ssize_t proc_set_txbf_cap(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 (num == 1 && pregpriv) { -+ pregpriv->beamform_cap = mode; -+ RTW_INFO("beamform_cap = 0x%02x\n", mode); -+ } -+ } -+ -+ return count; -+} -+#endif -+#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_MAP_DUMP_SEL(m, "sta_dz_bitmap=", pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); -+ RTW_MAP_DUMP_SEL(m, "tim_bitmap=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); -+ -+ _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->cmn.aid) */ -+ { -+ RTW_PRINT_SEL(m, "==============================\n"); -+ RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); -+ 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->cmn.aid, psta->cmn.mac_id, psta->cmn.ra_info.rate_id); -+#ifdef CONFIG_RTS_FULL_BW -+ if(psta->vendor_8812) -+ RTW_PRINT_SEL(m,"Vendor Realtek 8812\n"); -+#endif/*CONFIG_RTS_FULL_BW*/ -+#ifdef CONFIG_80211N_HT -+ RTW_PRINT_SEL(m, "qos_en=%d, ht_en=%d, init_rate=%d, ht_bitrate=%u\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate -+ , rtw_desc_rate_to_bitrate(psta->cmn.bw_mode, psta->init_rate, psta->cmn.bw_mode ? psta->htpriv.sgi_40m : psta->htpriv.sgi_20m) / 10); -+ RTW_PRINT_SEL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n" -+ , psta->cmn.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, "tx_amsdu_enable = %d\n", psta->htpriv.tx_amsdu_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 */ -+#ifdef CONFIG_80211AC_VHT -+ RTW_PRINT_SEL(m, "vht_en=%d, vht_sgi_80m=%d, vht_bitrate=%u\n", psta->vhtpriv.vht_option, psta->vhtpriv.sgi_80m -+ , psta->vhtpriv.vht_option ? rtw_vht_mcs_to_data_rate(CHANNEL_WIDTH_80, psta->vhtpriv.sgi_80m, psta->vhtpriv.vht_highest_rate) / 2 : 0); -+ 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 -+ 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); -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ RTW_PRINT_SEL(m, "management sleepq_len=%d\n", psta->mgmt_sleepq_len); -+ RTW_PRINT_SEL(m, "sta_xmitpriv.mgmt_q_qcnt=%d\n", psta->sta_xmitpriv.mgmt_q.qcnt); -+#endif -+ -+ 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); -+#endif /* CONFIG_TDLS */ -+ RTW_PRINT_SEL(m, "rx_data_uc_pkts=%llu\n", sta_rx_data_uc_pkts(psta)); -+ RTW_PRINT_SEL(m, "rx_data_mc_pkts=%llu\n", psta->sta_stats.rx_data_mc_pkts); -+ RTW_PRINT_SEL(m, "rx_data_bc_pkts=%llu\n", psta->sta_stats.rx_data_bc_pkts); -+ RTW_PRINT_SEL(m, "rx_uc_bytes=%llu\n", sta_rx_uc_bytes(psta)); -+ RTW_PRINT_SEL(m, "rx_mc_bytes=%llu\n", psta->sta_stats.rx_mc_bytes); -+ RTW_PRINT_SEL(m, "rx_bc_bytes=%llu\n", psta->sta_stats.rx_bc_bytes); -+ if (psta->sta_stats.rx_tp_kbits >> 10) -+ RTW_PRINT_SEL(m, "rx_tp =%d (Mbps)\n", psta->sta_stats.rx_tp_kbits >> 10); -+ else -+ RTW_PRINT_SEL(m, "rx_tp =%d (Kbps)\n", psta->sta_stats.rx_tp_kbits); -+ -+ 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); -+ if (psta->sta_stats.tx_tp_kbits >> 10) -+ RTW_PRINT_SEL(m, "tx_tp =%d (Mbps)\n", psta->sta_stats.tx_tp_kbits >> 10); -+ else -+ RTW_PRINT_SEL(m, "tx_tp =%d (Kbps)\n", psta->sta_stats.tx_tp_kbits); -+#ifdef CONFIG_RTW_80211K -+ RTW_PRINT_SEL(m, "rm_en_cap="RM_CAP_FMT"\n", RM_CAP_ARG(psta->rm_en_cap)); -+#endif -+ 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, "tx_bitrate_100kbps=%u\n", rtw_desc_rate_to_bitrate(psta->cmn.bw_mode, rtw_get_current_tx_rate(padapter, psta), rtw_get_current_tx_sgi(padapter, psta))); -+ RTW_PRINT_SEL(m, "rx_bitrate_100kbps=%u\n", rtw_desc_rate_to_bitrate(psta->cmn.bw_mode, psta->curr_rx_rate & 0x7f, (psta->curr_rx_rate & 0x80) >> 7)); -+ RTW_PRINT_SEL(m, "rssi=%d\n", psta->cmn.rssi_stat.rssi); -+ 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) -+{ -+#ifdef CONFIG_USB_HCI -+ 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; -+#endif /* CONFIG_USB_HCI */ -+ -+ 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); -+#ifdef CONFIG_USB_HCI -+ RTW_PRINT_SEL(m, "MAX_RECVBUF_SZ: %d\n", precvbuf->alloc_sz); -+#else /* !CONFIG_USB_HCI */ -+ RTW_PRINT_SEL(m, "MAX_RECVBUF_SZ: %d\n", MAX_RECVBUF_SZ); -+#endif /* !CONFIG_USB_HCI */ -+ -+ 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 rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; -+ -+ for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) { -+ if (rfctl->channel_set[i].ChannelNum == 1) -+ index_24G = i; -+ if (rfctl->channel_set[i].ChannelNum == 36) -+ index_5G = i; -+ } -+ -+ for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) { -+ /* 2.4G */ -+ if (rfctl->channel_set[i].ChannelNum == 6) { -+ if (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_24G].rx_count) { -+ index_24G = i; -+ best_channel_24G = rfctl->channel_set[i].ChannelNum; -+ } -+ } -+ -+ /* 5G */ -+ if (rfctl->channel_set[i].ChannelNum >= 36 -+ && rfctl->channel_set[i].ChannelNum < 140) { -+ /* Find primary channel */ -+ if (((rfctl->channel_set[i].ChannelNum - 36) % 8 == 0) -+ && (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_5G].rx_count)) { -+ index_5G = i; -+ best_channel_5G = rfctl->channel_set[i].ChannelNum; -+ } -+ } -+ -+ if (rfctl->channel_set[i].ChannelNum >= 149 -+ && rfctl->channel_set[i].ChannelNum < 165) { -+ /* find primary channel */ -+ if (((rfctl->channel_set[i].ChannelNum - 149) % 8 == 0) -+ && (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_5G].rx_count)) { -+ index_5G = i; -+ best_channel_5G = rfctl->channel_set[i].ChannelNum; -+ } -+ } -+#if 1 /* debug */ -+ RTW_PRINT_SEL(m, "The rx cnt of channel %3d = %d\n", -+ rfctl->channel_set[i].ChannelNum, rfctl->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 rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ 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; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) -+ rfctl->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 = 40 * 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; -+} -+ -+#ifdef CONFIG_RF4CE_COEXIST -+int proc_get_rf4ce_state(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 state = 0, voice = 0; -+ -+ state = rtw_btcoex_GetRf4ceLinkState(adapter); -+ -+ RTW_PRINT_SEL(m, "RF4CE %s\n", state?"Connected":"Disconnect"); -+ -+ return 0; -+} -+ -+/* This interface is designed for user space application to inform RF4CE state -+ * Initial define for DHC 1295 E387 project -+ * -+ * echo state voice > rf4ce_state -+ * state -+ * 0: RF4CE disconnected -+ * 1: RF4CE connected -+ */ -+ssize_t proc_set_rf4ce_state(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 state; -+ -+ 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", &state); -+ -+ if (num >= 1) -+ rtw_btcoex_SetRf4ceLinkState(adapter, state); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RF4CE_COEXIST */ -+#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 dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ if (psrtpriv->dbg_sreset_ctrl == _TRUE) { -+ RTW_PRINT_SEL(m, "self_dect_tx_cnt:%llu\n", psrtpriv->self_dect_tx_cnt); -+ RTW_PRINT_SEL(m, "self_dect_rx_cnt:%llu\n", psrtpriv->self_dect_rx_cnt); -+ RTW_PRINT_SEL(m, "self_dect_fw_cnt:%llu\n", psrtpriv->self_dect_fw_cnt); -+ RTW_PRINT_SEL(m, "tx_dma_status_cnt:%llu\n", psrtpriv->tx_dma_status_cnt); -+ RTW_PRINT_SEL(m, "rx_dma_status_cnt:%llu\n", psrtpriv->rx_dma_status_cnt); -+ RTW_PRINT_SEL(m, "self_dect_case:%d\n", psrtpriv->self_dect_case); -+ RTW_PRINT_SEL(m, "dbg_sreset_cnt:%d\n", pdbgpriv->dbg_sreset_cnt); -+ } -+ 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); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ 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 (num < 1) -+ return count; -+ -+ if (trigger_point == SRESET_TGP_NULL) -+ rtw_hal_sreset_reset(padapter); -+ else if (trigger_point == SRESET_TGP_INFO) -+ psrtpriv->dbg_sreset_ctrl = _TRUE; -+ else -+ sreset_set_trigger_point(padapter, trigger_point); -+ } -+ -+ return count; -+ -+} -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+#ifdef CONFIG_PCI_HCI -+ -+ssize_t proc_set_pci_bridge_conf_space(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 *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ struct pci_dev *bridge_pdev = pdev->bus->self; -+ -+ char tmp[32] = { 0 }; -+ int num; -+ -+ u32 reg = 0, value = 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, "%x %x", ®, &value); -+ if (num != 2) { -+ RTW_INFO("invalid parameter!\n"); -+ return count; -+ } -+ -+ if (reg >= 0x1000) { -+ RTW_INFO("invalid register!\n"); -+ return count; -+ } -+ -+ if (value > 0xFF) { -+ RTW_INFO("invalid value! Only one byte\n"); -+ return count; -+ } -+ -+ RTW_INFO(FUNC_ADPT_FMT ": register 0x%x value 0x%x\n", -+ FUNC_ADPT_ARG(padapter), reg, value); -+ -+ pci_write_config_byte(bridge_pdev, reg, value); -+ } -+ return count; -+} -+ -+ -+int proc_get_pci_bridge_conf_space(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ struct pci_dev *bridge_pdev = pdev->bus->self; -+ -+ u32 tmp[4] = { 0 }; -+ u32 i, j; -+ -+ RTW_PRINT_SEL(m, "\n***** PCI Host Device Configuration Space*****\n\n"); -+ -+ for (i = 0; i < 0x1000; i += 0x10) { -+ for (j = 0 ; j < 4 ; j++) -+ pci_read_config_dword(bridge_pdev, i + j * 4, tmp+j); -+ -+ RTW_PRINT_SEL(m, "%03x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", -+ i, tmp[0] & 0xFF, (tmp[0] >> 8) & 0xFF, (tmp[0] >> 16) & 0xFF, (tmp[0] >> 24) & 0xFF, -+ tmp[1] & 0xFF, (tmp[1] >> 8) & 0xFF, (tmp[1] >> 16) & 0xFF, (tmp[1] >> 24) & 0xFF, -+ tmp[2] & 0xFF, (tmp[2] >> 8) & 0xFF, (tmp[2] >> 16) & 0xFF, (tmp[2] >> 24) & 0xFF, -+ tmp[3] & 0xFF, (tmp[3] >> 8) & 0xFF, (tmp[3] >> 16) & 0xFF, (tmp[3] >> 24) & 0xFF); -+ } -+ return 0; -+} -+ -+ -+ssize_t proc_set_pci_conf_space(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 *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ -+ char tmp[32] = { 0 }; -+ int num; -+ -+ u32 reg = 0, value = 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, "%x %x", ®, &value); -+ -+ if (num != 2) { -+ RTW_INFO("invalid parameter!\n"); -+ return count; -+ } -+ -+ -+ if (reg >= 0x1000) { -+ RTW_INFO("invalid register!\n"); -+ return count; -+ } -+ -+ if (value > 0xFF) { -+ RTW_INFO("invalid value! Only one byte\n"); -+ return count; -+ } -+ -+ RTW_INFO(FUNC_ADPT_FMT ": register 0x%x value 0x%x\n", -+ FUNC_ADPT_ARG(padapter), reg, value); -+ -+ pci_write_config_byte(pdev, reg, value); -+ -+ -+ } -+ return count; -+} -+ -+ -+int proc_get_pci_conf_space(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ struct pci_dev *bridge_pdev = pdev->bus->self; -+ -+ u32 tmp[4] = { 0 }; -+ u32 i, j; -+ -+ RTW_PRINT_SEL(m, "\n***** PCI Device Configuration Space *****\n\n"); -+ -+ for (i = 0; i < 0x1000; i += 0x10) { -+ for (j = 0 ; j < 4 ; j++) -+ pci_read_config_dword(pdev, i + j * 4, tmp+j); -+ -+ RTW_PRINT_SEL(m, "%03x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", -+ i, tmp[0] & 0xFF, (tmp[0] >> 8) & 0xFF, (tmp[0] >> 16) & 0xFF, (tmp[0] >> 24) & 0xFF, -+ tmp[1] & 0xFF, (tmp[1] >> 8) & 0xFF, (tmp[1] >> 16) & 0xFF, (tmp[1] >> 24) & 0xFF, -+ tmp[2] & 0xFF, (tmp[2] >> 8) & 0xFF, (tmp[2] >> 16) & 0xFF, (tmp[2] >> 24) & 0xFF, -+ tmp[3] & 0xFF, (tmp[3] >> 8) & 0xFF, (tmp[3] >> 16) & 0xFF, (tmp[3] >> 24) & 0xFF); -+ } -+ -+ return 0; -+} -+ -+ -+int proc_get_pci_aspm(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); -+ u8 tmp8 = 0; -+ u16 tmp16 = 0; -+ u32 tmp32 = 0; -+ u8 l1_idle = 0; -+ -+ -+ RTW_PRINT_SEL(m, "***** ASPM Capability *****\n"); -+ -+ pci_read_config_dword(pdvobjpriv->ppcidev, pcipriv->pciehdr_offset + PCI_EXP_LNKCAP, &tmp32); -+ -+ RTW_PRINT_SEL(m, "CLK REQ: %s\n", (tmp32&PCI_EXP_LNKCAP_CLKPM) ? "Enable" : "Disable"); -+ RTW_PRINT_SEL(m, "ASPM L0s: %s\n", (tmp32&BIT10) ? "Enable" : "Disable"); -+ RTW_PRINT_SEL(m, "ASPM L1: %s\n", (tmp32&BIT11) ? "Enable" : "Disable"); -+ -+ tmp8 = rtw_hal_pci_l1off_capability(padapter); -+ RTW_PRINT_SEL(m, "ASPM L1OFF: %s\n", tmp8 ? "Enable" : "Disable"); -+ -+ RTW_PRINT_SEL(m, "***** ASPM CTRL Reg *****\n"); -+ -+ pci_read_config_word(pdvobjpriv->ppcidev, pcipriv->pciehdr_offset + PCI_EXP_LNKCTL, &tmp16); -+ -+ RTW_PRINT_SEL(m, "CLK REQ: %s\n", (tmp16&PCI_EXP_LNKCTL_CLKREQ_EN) ? "Enable" : "Disable"); -+ RTW_PRINT_SEL(m, "ASPM L0s: %s\n", (tmp16&BIT0) ? "Enable" : "Disable"); -+ RTW_PRINT_SEL(m, "ASPM L1: %s\n", (tmp16&BIT1) ? "Enable" : "Disable"); -+ -+ tmp8 = rtw_hal_pci_l1off_nic_support(padapter); -+ RTW_PRINT_SEL(m, "ASPM L1OFF: %s\n", tmp8 ? "Enable" : "Disable"); -+ -+ RTW_PRINT_SEL(m, "***** ASPM Backdoor *****\n"); -+ -+ tmp8 = rtw_hal_pci_dbi_read(padapter, 0x719); -+ RTW_PRINT_SEL(m, "CLK REQ: %s\n", (tmp8 & BIT4) ? "Enable" : "Disable"); -+ -+ tmp8 = rtw_hal_pci_dbi_read(padapter, 0x70f); -+ l1_idle = tmp8 & 0x38; -+ RTW_PRINT_SEL(m, "ASPM L0s: %s\n", (tmp8&BIT7) ? "Enable" : "Disable"); -+ -+ tmp8 = rtw_hal_pci_dbi_read(padapter, 0x719); -+ RTW_PRINT_SEL(m, "ASPM L1: %s\n", (tmp8 & BIT3) ? "Enable" : "Disable"); -+ -+ tmp8 = rtw_hal_pci_dbi_read(padapter, 0x718); -+ RTW_PRINT_SEL(m, "ASPM L1OFF: %s\n", (tmp8 & BIT5) ? "Enable" : "Disable"); -+ -+ RTW_PRINT_SEL(m, "********* MISC **********\n"); -+ RTW_PRINT_SEL(m, "ASPM L1 Idel Time: 0x%x\n", l1_idle>>3); -+ RTW_PRINT_SEL(m, "*************************\n"); -+ -+#ifdef CONFIG_PCI_DYNAMIC_ASPM -+ RTW_PRINT_SEL(m, "Dynamic ASPM mode: %d (%s)\n", pcipriv->aspm_mode, -+ pcipriv->aspm_mode == ASPM_MODE_PERF ? "Perf" : -+ pcipriv->aspm_mode == ASPM_MODE_PS ? "PS" : "Und"); -+#endif -+ -+ return 0; -+} -+ -+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]; -+ RTW_PRINT_SEL(m, " buf_desc[%03d]: %p\n", j, entry); -+#else -+ struct tx_desc *entry = &tx_ring->desc[j]; -+ RTW_PRINT_SEL(m, " desc[%03d]: %p\n", j, entry); -+#endif -+ -+ 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; -+} -+ -+#ifdef DBG_TXBD_DESC_DUMP -+int proc_get_tx_ring_ext(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; -+ struct rtw_tx_desc_backup *pbuf; -+ int i, j, k, idx; -+ -+ RTW_PRINT_SEL(m, "<<<< tx ring ext dump settings >>>>\n"); -+ RTW_PRINT_SEL(m, " - backup frame num: %d\n", TX_BAK_FRMAE_CNT); -+ RTW_PRINT_SEL(m, " - backup max. desc size: %d bytes\n", TX_BAK_DESC_LEN); -+ RTW_PRINT_SEL(m, " - backup data size: %d bytes\n\n", TX_BAK_DATA_LEN); -+ -+ if (!pxmitpriv->dump_txbd_desc) { -+ RTW_PRINT_SEL(m, "Dump function is disabled.\n"); -+ return 0; -+ } -+ -+ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ for (i = 0; i < HW_QUEUE_ENTRY; i++) { -+ struct rtw_tx_ring *tx_ring = &pxmitpriv->tx_ring[i]; -+ -+ idx = rtw_get_tx_desc_backup(padapter, i, &pbuf); -+ -+ RTW_PRINT_SEL(m, "Tx ring[%d]", i); -+ switch (i) { -+ case 0: -+ RTW_PRINT_SEL(m, " (VO)\n"); -+ break; -+ case 1: -+ RTW_PRINT_SEL(m, " (VI)\n"); -+ break; -+ case 2: -+ RTW_PRINT_SEL(m, " (BE)\n"); -+ break; -+ case 3: -+ RTW_PRINT_SEL(m, " (BK)\n"); -+ break; -+ case 4: -+ RTW_PRINT_SEL(m, " (BCN)\n"); -+ break; -+ case 5: -+ RTW_PRINT_SEL(m, " (MGT)\n"); -+ break; -+ case 6: -+ RTW_PRINT_SEL(m, " (HIGH)\n"); -+ break; -+ case 7: -+ RTW_PRINT_SEL(m, " (TXCMD)\n"); -+ break; -+ default: -+ RTW_PRINT_SEL(m, " (?)\n"); -+ break; -+ } -+ -+ RTW_PRINT_SEL(m, " Entries: %d\n", TX_BAK_FRMAE_CNT); -+ RTW_PRINT_SEL(m, " Last idx: %d\n", idx); -+ -+ for (j = 0; j < TX_BAK_FRMAE_CNT; j++) { -+ RTW_PRINT_SEL(m, " desc[%03d]:\n", j); -+ -+ for (k = 0; k < (pbuf->tx_desc_size) / 4; k++) { -+ if ((k % 4) == 0) -+ RTW_PRINT_SEL(m, " 0x%03x", k); -+ -+ RTW_PRINT_SEL(m, " 0x%08x ", ((int *)pbuf->tx_bak_desc)[k]); -+ -+ if ((k % 4) == 3) -+ RTW_PRINT_SEL(m, "\n"); -+ } -+ -+#if 1 /* data dump */ -+ if (pbuf->tx_desc_size) { -+ RTW_PRINT_SEL(m, " data[%03d]:\n", j); -+ -+ for (k = 0; k < (TX_BAK_DATA_LEN) / 4; k++) { -+ if ((k % 4) == 0) -+ RTW_PRINT_SEL(m, " 0x%03x", k); -+ -+ RTW_PRINT_SEL(m, " 0x%08x ", ((int *)pbuf->tx_bak_data_hdr)[k]); -+ -+ if ((k % 4) == 3) -+ RTW_PRINT_SEL(m, "\n"); -+ } -+ RTW_PRINT_SEL(m, "\n"); -+ } -+#endif -+ -+ RTW_PRINT_SEL(m, " R/W pointer: %d/%d\n", pbuf->tx_bak_rp, pbuf->tx_bak_wp); -+ -+ pbuf = pbuf + 1; -+ } -+ RTW_PRINT_SEL(m, "\n"); -+ } -+ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ -+ return 0; -+} -+ -+ssize_t proc_set_tx_ring_ext(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 xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ char tmp[32]; -+ u32 reset = 0; -+ u32 dump = 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, "%u %u", &dump, &reset); -+ -+ if (num != 2) { -+ RTW_INFO("invalid parameter!\n"); -+ return count; -+ } -+ -+ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ pxmitpriv->dump_txbd_desc = (BOOLEAN) dump; -+ -+ if (reset == 1) -+ rtw_tx_desc_backup_reset(); -+ -+ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ -+ } -+ -+ return count; -+} -+ -+#endif -+ -+#endif -+ -+#ifdef CONFIG_WOWLAN -+int proc_get_wow_enable(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *registry_pair = &padapter->registrypriv; -+ -+ RTW_PRINT_SEL(m, "wow - %s\n", (registry_pair->wowlan_enable)? "enable" : "disable"); -+ return 0; -+} -+ -+ssize_t proc_set_wow_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 *registry_pair = &padapter->registrypriv; -+ char tmp[8]; -+ int num = 0; -+ int mode = 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", &mode); -+ else -+ return -EFAULT; -+ -+ if (num != 1) { -+ RTW_ERR("%s: %s - invalid parameter!\n", __func__, tmp); -+ return -EINVAL; -+ } -+ -+ if (mode == 1) { -+ RTW_PRINT("%s: wowlan - enable\n", __func__); -+ } else if (mode == 0) { -+ RTW_PRINT("%s: wowlan - disable\n", __func__); -+ } else { -+ RTW_ERR("%s: %s - invalid parameter!, mode=%d\n", -+ __func__, tmp, mode); -+ return -EINVAL; -+ } -+ -+ registry_pair->wowlan_enable = mode; -+ -+ return count; -+} -+ -+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); -+ u8 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", -+ (pwrpriv->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_STR_LEN + 1] = {0}; -+ int ret = 0; -+ u8 index = 0; -+ -+ poidparam.subcode = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count >= sizeof(tmp)) { -+ RTW_ERR("%s: pattern string is too long, count=%zu\n", -+ __func__, count); -+ return -EFAULT; -+ } -+ -+ if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_CAM_NUM) { -+ RTW_ERR("priv-pattern is full(idx: %d)\n", -+ pwrpriv->wowlan_pattern_idx); -+ RTW_ERR("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++; -+ } -+ } else { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ return count; -+} -+ -+int proc_get_wakeup_event(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ -+ RTW_PRINT_SEL(m, "wakeup event: %#02x\n", registry_par->wakeup_event); -+ return 0; -+} -+ -+ssize_t proc_set_wakeup_event(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 *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ u32 wakeup_event = 0; -+ -+ u8 tmp[8] = {0}; -+ int num = 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", &wakeup_event); -+ else -+ return -EFAULT; -+ -+ if (num == 1 && wakeup_event <= 0x07) { -+ registry_par->wakeup_event = wakeup_event; -+ -+ if (wakeup_event & BIT(1)) -+ pwrctrlpriv->default_patterns_en = _TRUE; -+ else -+ pwrctrlpriv->default_patterns_en = _FALSE; -+ -+ rtw_wow_pattern_sw_reset(padapter); -+ -+ RTW_INFO("%s: wakeup_event: %#2x, default pattern: %d\n", -+ __func__, registry_par->wakeup_event, -+ pwrctrlpriv->default_patterns_en); -+ } else { -+ return -EINVAL; -+ } -+ -+ 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; -+} -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+int proc_dump_wow_keep_alive_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); -+ int i; -+ -+ RTW_PRINT_SEL(m, "wowlan_keep_alive_mode: %d\n", pwrpriv->wowlan_keep_alive_mode); -+ RTW_PRINT_SEL(m,"LocKeepAlive: %d\n", pwrpriv->keep_alive_pattern_loc ); -+ RTW_PRINT_SEL(m, "keep_alive_pattern_len: %d\n", pwrpriv->keep_alive_pattern_len); -+ RTW_PRINT_SEL(m,"keep_alive_pattern= \n" ); -+ for (i=0 ; i < pwrpriv->keep_alive_pattern_len ; i++) { -+ RTW_PRINT_SEL(m,"[0x%x] ",pwrpriv->keep_alive_pattern[i]); -+ if(i%8 == 7) -+ RTW_PRINT_SEL(m,"\n"); -+ } -+ RTW_PRINT_SEL(m,"\n"); -+ RTW_PRINT_SEL(m," wowlan_keep_alive_period= %d ms\n", pwrpriv->wowlan_keep_alive_period*100); -+ RTW_PRINT_SEL(m," wowlan_keep_alive_retry_counter= %d\n", pwrpriv->wowlan_keep_alive_retry_counter); -+ RTW_PRINT_SEL(m," wowlan_keep_alive_retry_interval= %d ms\n", pwrpriv->wowlan_keep_alive_retry_interval*100); -+ return 0; -+} -+#endif /* CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ -+#endif /*CONFIG_WOWLAN*/ -+ -+#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 gpio_index = pwrpriv->wowlan_gpio_index; -+ u8 gpio_output_state = pwrpriv->wowlan_gpio_output_state; -+ u8 val = pwrpriv->is_high_active; -+ -+ RTW_PRINT_SEL(m, "wakeup_gpio_idx: %d\n", gpio_index); -+#if (!defined(CONFIG_WAKEUP_GPIO_INPUT_MODE) && !defined(CONFIG_RTW_ONE_PIN_GPIO)) -+ RTW_PRINT_SEL(m, "current_gpio_output_state: %d\n", gpio_output_state); -+#endif -+ 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); -+ -+ if (num != 1) { -+ RTW_INFO("Invalid format\n"); -+ return count; -+ } -+ -+ 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); -+ -+#ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE -+ if (pwrpriv->is_high_active == 0) -+ rtw_hal_set_input_gpio(padapter, pwrpriv->wowlan_gpio_index); -+ else -+ rtw_hal_set_output_gpio(padapter, pwrpriv->wowlan_gpio_index, -+ GPIO_OUTPUT_LOW); -+#else -+ val8 = (pwrpriv->is_high_active == 0) ? 1 : 0; -+ rtw_hal_switch_gpio_wl_ctrl(padapter, pwrpriv->wowlan_gpio_index, _TRUE); -+ rtw_hal_set_output_gpio(padapter, pwrpriv->wowlan_gpio_index, val8); -+#endif -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ -+ RTW_INFO("%s set GPIO_%d to %s_ACTIVE\n", __func__, -+ pwrpriv->wowlan_gpio_index, -+ pwrpriv->is_high_active ? "HIGH" : "LOW"); -+ } -+ -+ 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 */ -+#ifdef CONFIG_BCN_CNT_CONFIRM_HDL -+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; -+} -+#endif -+#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_req; -+ u8 lps_mode = pwrpriv->power_mgnt; -+ u8 lps_level = pwrpriv->lps_level; -+#ifdef CONFIG_LPS_1T1R -+ u8 lps_1t1r = pwrpriv->lps_1t1r; -+#endif -+#ifdef CONFIG_WOWLAN -+ u8 wow_lps_mode = pwrpriv->wowlan_power_mgmt; -+ u8 wow_lps_level = pwrpriv->wowlan_lps_level; -+ #ifdef CONFIG_LPS_1T1R -+ u8 wow_lps_1t1r = pwrpriv->wowlan_lps_1t1r; -+ #endif -+#endif /* CONFIG_WOWLAN */ -+ 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); -+ -+ if (lps_level == LPS_LCLK) -+ str = "LPS_LCLK"; -+ else if (lps_level == LPS_PG) -+ str = "LPS_PG"; -+ else -+ str = "LPS_NORMAL"; -+ RTW_PRINT_SEL(m, " LPS level: %s\n", str); -+ -+#ifdef CONFIG_LPS_1T1R -+ RTW_PRINT_SEL(m, " LPS 1T1R: %d\n", lps_1t1r); -+#endif -+ -+#ifdef CONFIG_WOWLAN -+ RTW_PRINT_SEL(m, "------------------------------\n"); -+ RTW_PRINT_SEL(m, "*WOW LPS:\n"); -+ -+ if (wow_lps_mode == PS_MODE_ACTIVE) -+ str = "NO LPS"; -+ else if (wow_lps_mode == PS_MODE_MIN) -+ str = "MIN"; -+ else if (wow_lps_mode == PS_MODE_MAX) -+ str = "MAX"; -+ else if (wow_lps_mode == PS_MODE_DTIM) -+ str = "DTIM"; -+ else -+ sprintf(str, "%d", wow_lps_mode); -+ -+ RTW_PRINT_SEL(m, " WOW LPS mode: %s\n", str); -+ -+ if (wow_lps_level == LPS_LCLK) -+ str = "LPS_LCLK"; -+ else if (wow_lps_level == LPS_PG) -+ str = "LPS_PG"; -+ else -+ str = "LPS_NORMAL"; -+ RTW_PRINT_SEL(m, " WOW LPS level: %s\n", str); -+ -+ #ifdef CONFIG_LPS_1T1R -+ RTW_PRINT_SEL(m, " WOW LPS 1T1R: %d\n", wow_lps_1t1r); -+ #endif -+#endif /* CONFIG_WOWLAN */ -+ -+ RTW_PRINT_SEL(m, "=============================\n"); -+ return 0; -+} -+ -+ssize_t proc_set_ps_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct _ADAPTER *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[8]; -+ int num = 0; -+ int mode = 0; -+ int en = 0; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (!buffer || copy_from_user(tmp, buffer, count)) -+ goto exit; -+ -+ num = sscanf(tmp, "%d %d", &mode, &en); -+ if (num > 2) { -+ RTW_ERR("%s: invalid parameter!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ if (num == 1 && mode == 0) { -+ /* back to original LPS/IPS Mode */ -+ RTW_INFO("%s: back to original LPS/IPS Mode\n", __FUNCTION__); -+ -+ rtw_pm_set_lps(adapter, adapter->registrypriv.power_mgnt); -+ -+ rtw_pm_set_ips(adapter, adapter->registrypriv.ips_mode); -+ -+#ifdef CONFIG_WOWLAN -+ RTW_INFO("%s: back to original WOW LPS Mode\n", __FUNCTION__); -+ -+ rtw_pm_set_wow_lps(adapter, adapter->registrypriv.wow_power_mgnt); -+#endif /* CONFIG_WOWLAN */ -+ -+ goto exit; -+ } -+ -+ if (mode == 1) { -+ /* LPS */ -+ RTW_INFO("%s: LPS: %s, en=%d\n", __FUNCTION__, (en == 0) ? "disable":"enable", en); -+ if (rtw_pm_set_lps(adapter, en) != 0 ) -+ RTW_ERR("%s: invalid parameter, mode=%d, level=%d\n", __FUNCTION__, mode, en); -+ -+ } else if (mode == 2) { -+ /* IPS */ -+ RTW_INFO("%s: IPS: %s, en=%d\n", __FUNCTION__, (en == 0) ? "disable":"enable", en); -+ if (rtw_pm_set_ips(adapter, en) != 0 ) -+ RTW_ERR("%s: invalid parameter, mode=%d, level=%d\n", __FUNCTION__, mode, en); -+ } -+#ifdef CONFIG_WOWLAN -+ else if (mode == 3) { -+ /* WOW LPS */ -+ RTW_INFO("%s: WOW LPS: %s, en=%d\n", __FUNCTION__, (en == 0) ? "disable":"enable", en); -+ if (rtw_pm_set_wow_lps(adapter, en) != 0 ) -+ RTW_ERR("%s: invalid parameter, mode=%d, level=%d\n", __FUNCTION__, mode, en); -+ } -+#endif /* CONFIG_WOWLAN */ -+ else -+ RTW_ERR("%s: invalid parameter, mode = %d!\n", __FUNCTION__, mode); -+ -+exit: -+ return count; -+} -+ -+#ifdef CONFIG_WMMPS_STA -+int proc_get_wmmps_info(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; -+ char *uapsd_max_sp_str=""; -+ -+ if (pregpriv){ -+ switch(pregpriv->uapsd_max_sp_len) { -+ case 0: -+ uapsd_max_sp_str = "NO_LIMIT"; -+ break; -+ case 1: -+ uapsd_max_sp_str = "TWO_MSDU"; -+ break; -+ case 2: -+ uapsd_max_sp_str = "FOUR_MSDU"; -+ break; -+ case 3: -+ uapsd_max_sp_str = "SIX_MSDU"; -+ break; -+ default: -+ uapsd_max_sp_str = "UNSPECIFIED"; -+ break; -+ } -+ -+ RTW_PRINT_SEL(m, "====== WMMPS_STA Info:======\n"); -+ RTW_PRINT_SEL(m, "uapsd_max_sp_len=0x%02x (%s)\n", pregpriv->uapsd_max_sp_len, uapsd_max_sp_str); -+ RTW_PRINT_SEL(m, "uapsd_ac_enable=0x%02x\n", pregpriv->uapsd_ac_enable); -+ RTW_PRINT_SEL(m, "BIT0 - AC_VO UAPSD: %s\n", (pregpriv->uapsd_ac_enable & DRV_CFG_UAPSD_VO) ? "Enabled" : "Disabled"); -+ RTW_PRINT_SEL(m, "BIT1 - AC_VI UAPSD: %s\n", (pregpriv->uapsd_ac_enable & DRV_CFG_UAPSD_VI) ? "Enabled" : "Disabled"); -+ RTW_PRINT_SEL(m, "BIT2 - AC_BK UAPSD: %s\n", (pregpriv->uapsd_ac_enable & DRV_CFG_UAPSD_BK) ? "Enabled" : "Disabled"); -+ RTW_PRINT_SEL(m, "BIT3 - AC_BE UAPSD: %s\n", (pregpriv->uapsd_ac_enable & DRV_CFG_UAPSD_BE) ? "Enabled" : "Disabled"); -+ RTW_PRINT_SEL(m, "============================\n"); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_wmmps_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 registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u8 uapsd_ac_setting; -+ u8 uapsd_max_sp_len_setting; -+ -+ 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 %hhx", &uapsd_max_sp_len_setting, &uapsd_ac_setting); -+ -+ if (pregpriv) { -+ if (num >= 1) { -+ pregpriv->uapsd_max_sp_len = uapsd_max_sp_len_setting; -+ RTW_INFO("uapsd_max_sp_len = %d\n", pregpriv->uapsd_max_sp_len); -+ } -+ -+ if (num >= 2) { -+ pregpriv->uapsd_ac_enable = uapsd_ac_setting; -+ RTW_INFO("uapsd_ac_enable = 0x%02x\n", pregpriv->uapsd_ac_enable); -+ } -+ } -+ } -+ -+ return count; -+} -+#endif /* CONFIG_WMMPS_STA */ -+#endif /* CONFIG_POWER_SAVING */ -+ -+#ifdef CONFIG_TDLS -+int proc_get_tdls_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, "TDLS is %s !\n", (rtw_is_tdls_enabled(padapter) == _TRUE) ? "enabled" : "disabled"); -+ -+ return 0; -+} -+ -+ssize_t proc_set_tdls_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 en_tdls = 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, "%d ", &en_tdls); -+ -+ if (num == 1 && pregpriv) { -+ if (en_tdls > 0) -+ rtw_enable_tdls_func(padapter); -+ else -+ rtw_disable_tdls_func(padapter, _TRUE); -+ } -+ } -+ -+ return count; -+} -+ -+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 Enable", (rtw_is_tdls_enabled(padapter) == _TRUE) ? "_TRUE" : "_FALSE"); -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Driver Setup", (ptdlsinfo->driver_setup == _TRUE) ? "_TRUE" : "_FALSE"); -+ 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"); -+ -+ 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 & WIFI_ASOC_STATE)) { -+ 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; -+#if 0 /* no this setting */ -+ case _WEP_WPA_MIXED_: -+ RTW_PRINT_SEL(m, "%s\n", "WEP/WPA Mixed"); -+ break; -+#endif -+ case _SMS4_: -+ RTW_PRINT_SEL(m, "%s\n", "SMS4"); -+ break; -+#ifdef CONFIG_IEEE80211W -+ case _BIP_CMAC_128_: -+ 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->cmn.mac_addr)); -+ 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->cmn.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; -+ case CHANNEL_WIDTH_5: -+ RTW_PRINT_SEL(m, "%s\n", "5MHz"); -+ break; -+ case CHANNEL_WIDTH_10: -+ RTW_PRINT_SEL(m, "%s\n", "10MHz"); -+ break; -+ default: -+ RTW_PRINT_SEL(m, "(%d)%s\n", psta->cmn.bw_mode, "invalid"); -+ 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; -+#if 0 /* no this setting */ -+ case _WEP_WPA_MIXED_: -+ RTW_PRINT_SEL(m, "%s\n", "WEP/WPA Mixed"); -+ break; -+#endif -+ case _SMS4_: -+ RTW_PRINT_SEL(m, "%s\n", "SMS4"); -+ break; -+#ifdef CONFIG_IEEE80211W -+ case _BIP_CMAC_128_: -+ 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); -+ -+ if (MLME_IS_MONITOR(padapter)) { -+ RTW_PRINT_SEL(m, "Monitor mode : Enable\n"); -+ RTW_PRINT_SEL(m, "Device type : %u\n", dev->type); -+ -+ 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); -+ u16 target_type; -+ u8 target_ch, 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 = 0; -+ -+ num = sscanf(tmp, "type %hu", &target_type); -+ if ((num == 1) && -+ ((target_type != ARPHRD_IEEE80211) && -+ (target_type != ARPHRD_IEEE80211_RADIOTAP))) { -+ dev->type = ARPHRD_IEEE80211_RADIOTAP; -+ return count; -+ } -+ -+ num = sscanf(tmp, "%hhu %hhu %hhu", &target_ch, &target_offset, &target_bw); -+ if (num != 3) { -+ RTW_INFO("invalid write_reg parameter!\n"); -+ return count; -+ } -+ -+ padapter->mlmeextpriv.cur_channel = target_ch; -+ set_channel_bwmode(padapter, target_ch, target_offset, target_bw); -+ } -+ -+ return count; -+} -+ -+#ifdef RTW_SIMPLE_CONFIG -+/* For RtwSimleConfig */ -+int proc_get_simple_config(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "RTW Simple Config : %s\n", padapter->rtw_simple_config ? "Enable" : "Disable"); -+ -+ return 0; -+} -+ -+ssize_t proc_set_simple_config(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 ret; -+ -+ 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, "%hhd", &ret); -+ -+ padapter->rtw_simple_config = ret ? _TRUE : _FALSE; -+ } -+ -+ return count; -+} -+#endif -+ -+#ifdef DBG_XMIT_BLOCK -+int proc_get_xmit_block(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_xmit_block(m, padapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_xmit_block(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 xb_mode, xb_reason; -+ -+ 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", &xb_mode, &xb_reason); -+ -+ if (num != 2) { -+ RTW_INFO("invalid parameter!\n"); -+ return count; -+ } -+ -+ if (xb_mode == 0)/*set*/ -+ rtw_set_xmit_block(padapter, xb_reason); -+ else if (xb_mode == 1)/*clear*/ -+ rtw_clr_xmit_block(padapter, xb_reason); -+ else -+ RTW_INFO("invalid parameter!\n"); -+ } -+ -+ return count; -+} -+#endif -+ -+#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); -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ 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 -+#endif -+ -+ { -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mp_mode_check(padapter)) { -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+ -+ if (GET_EFUSE_UPDATE_ON(padapter)) -+ RTW_PRINT_SEL(m, "Driver eFuse Map From fake\n"); -+ else -+ RTW_PRINT_SEL(m, "Driver eFuse Map From HW\n"); -+ } else -+#endif -+ { -+ 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, WIFI_ASOC_STATE) == _TRUE) && SEC_IS_BIP_KEY_INSTALLED(&padapter->securitypriv) == _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 && SEC_IS_BIP_KEY_INSTALLED(&padapter->securitypriv) == _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->cmn.mac_id][0], psta->cmn.mac_addr, 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, WIFI_ASOC_STATE) == _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); -+#ifdef CONFIG_AP_MODE -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ u8 updated = _FALSE; -+ -+ 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->cmn.mac_id][0], psta->cmn.mac_addr, 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) { -+ _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--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (psta->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt--; -+ #endif -+ updated |= ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ } -+ -+ RTW_INFO("STA[%u]:"MAC_FMT"\n", index , MAC_ARG(&mac_addr[index][0])); -+ } -+ } -+ } -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+#endif /* CONFIG_AP_MODE */ -+ } -+ -+ 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, WIFI_ASOC_STATE) == _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_CUSTOMER01_SMART_ANTENNA -+static u32 phase_idx; -+int proc_get_pathb_phase(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "PathB phase index =%d\n", phase_idx); -+ return 0; -+} -+ -+ssize_t proc_set_pathb_phase(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]; -+ int num; -+ u32 tmp_idx; -+ -+ 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 (buffer && !copy_from_user(tmp, buffer, count)) { -+ num = sscanf(tmp, "%u", &tmp_idx); -+ if ((tmp_idx < 0) || (tmp_idx > 11)) { -+ RTW_INFO(FUNC_ADPT_FMT "Invalid input value\n", FUNC_ADPT_ARG(padapter)); -+ return count; -+ } -+ phase_idx = tmp_idx; -+ rtw_hal_set_pathb_phase(padapter, phase_idx); -+ } -+ return count; -+} -+#endif -+ -+#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; -+} -+ -+int proc_get_mcc_policy_table(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_hal_dump_mcc_policy_table(m); -+ 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_duration(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 enable_runtime_duration = 0, mcc_duration = 0, type = 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 %u %u", &enable_runtime_duration, &type, &mcc_duration); -+ -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ if (num > 3) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters > 2\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ if (num == 2) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters > 2\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ if (num >= 1) { -+ SET_MCC_RUNTIME_DURATION(padapter, enable_runtime_duration); -+ RTW_INFO("runtime duration:%s\n", enable_runtime_duration ? "enable":"disable"); -+ } -+ -+ if (num == 3) { -+ RTW_INFO("type:%d, mcc duration:%d\n", type, mcc_duration); -+ rtw_set_mcc_duration_cmd(padapter, type, mcc_duration); -+ } -+ } -+ -+ return count; -+} -+ -+#ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ssize_t proc_set_mcc_phydm_offload_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 mcc_phydm_enable = 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); -+ u8 i = 0; -+ int num = sscanf(tmp, "%u", &mcc_phydm_enable); -+ -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ RTW_INFO("%s: mcc phydm enable = %d\n", __func__, mcc_phydm_enable); -+ rtw_set_mcc_phydm_offload_enable_cmd(padapter, mcc_phydm_enable, _TRUE); -+ } -+ -+ return count; -+} -+#endif -+ -+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 */ -+ -+int proc_get_ack_timeout(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 ack_timeout_val; -+#ifdef CONFIG_RTL8821C -+ u8 ack_timeout_val_cck; -+#endif -+ -+ ack_timeout_val = rtw_read8(padapter, REG_ACKTO); -+ -+#ifdef CONFIG_RTL8821C -+ ack_timeout_val_cck = rtw_read8(padapter, REG_ACKTO_CCK_8821C); -+ RTW_PRINT_SEL(m, "Current CCK packet ACK Timeout = %d us (0x%x).\n", ack_timeout_val_cck, ack_timeout_val_cck); -+ RTW_PRINT_SEL(m, "Current non-CCK packet ACK Timeout = %d us (0x%x).\n", ack_timeout_val, ack_timeout_val); -+#else -+ RTW_PRINT_SEL(m, "Current ACK Timeout = %d us (0x%x).\n", ack_timeout_val, ack_timeout_val); -+#endif -+ -+ return 0; -+} -+ -+ssize_t proc_set_ack_timeout(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 ack_timeout_ms, ack_timeout_ms_cck; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u %u", &ack_timeout_ms, &ack_timeout_ms_cck); -+ -+#ifdef CONFIG_RTL8821C -+ if (num < 2) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 2\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+#else -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+#endif -+ /* This register sets the Ack time out value after Tx unicast packet. It is in units of us. */ -+ rtw_write8(padapter, REG_ACKTO, (u8)ack_timeout_ms); -+ -+#ifdef CONFIG_RTL8821C -+ /* This register sets the Ack time out value after Tx unicast CCK packet. It is in units of us. */ -+ rtw_write8(padapter, REG_ACKTO_CCK_8821C, (u8)ack_timeout_ms_cck); -+ RTW_INFO("Set CCK packet ACK Timeout to %d us.\n", ack_timeout_ms_cck); -+ RTW_INFO("Set non-CCK packet ACK Timeout to %d us.\n", ack_timeout_ms); -+#else -+ RTW_INFO("Set ACK Timeout to %d us.\n", ack_timeout_ms); -+#endif -+ } -+ -+ return count; -+} -+ -+ssize_t proc_set_fw_offload(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); -+ _adapter *pri_adapter = GET_PRIMARY_ADAPTER(adapter); -+ HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); -+ char tmp[32]; -+ u32 iqk_offload_enable = 0, ch_switch_offload_enable = 0; -+ -+ if (buffer == NULL) { -+ RTW_INFO("input buffer is NULL!\n"); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO("input length is 0!\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO("input length is too large\n"); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%d %d", &iqk_offload_enable, &ch_switch_offload_enable); -+ -+ if (num < 2) { -+ RTW_INFO("input parameters < 1\n"); -+ return -EINVAL; -+ } -+ -+ if (hal->RegIQKFWOffload != iqk_offload_enable) { -+ hal->RegIQKFWOffload = iqk_offload_enable; -+ rtw_run_in_thread_cmd(pri_adapter, ((void *)(rtw_hal_update_iqk_fw_offload_cap)), pri_adapter); -+ } -+ -+ if (hal->ch_switch_offload != ch_switch_offload_enable) -+ hal->ch_switch_offload = ch_switch_offload_enable; -+ } -+ -+ return count; -+} -+ -+int proc_get_fw_offload(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); -+ -+ -+ RTW_PRINT_SEL(m, "IQK FW offload:%s\n", hal->RegIQKFWOffload?"enable":"disable"); -+ RTW_PRINT_SEL(m, "Channel switch FW offload:%s\n", hal->ch_switch_offload?"enable":"disable"); -+ return 0; -+} -+#ifdef CONFIG_FW_HANDLE_TXBCN -+extern void rtw_hal_set_fw_ap_bcn_offload_cmd(_adapter *adapter, bool fw_bcn_en, u8 tbtt_rpt_map); -+ssize_t proc_set_fw_tbtt_rpt(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 fw_tbtt_rpt, fw_bcn_offload; -+ -+ -+ if (buffer == NULL) { -+ RTW_INFO("input buffer is NULL!\n"); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO("input length is 0!\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO("input length is too large\n"); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%d %x",&fw_bcn_offload, &fw_tbtt_rpt); -+ -+ if (num < 2) { -+ RTW_INFO("input parameters < 2\n"); -+ return -EINVAL; -+ } -+ rtw_hal_set_fw_ap_bcn_offload_cmd(adapter, fw_bcn_offload, fw_tbtt_rpt); -+ } -+ -+ return count; -+} -+ -+int proc_get_fw_tbtt_rpt(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); -+ -+ RTW_PRINT_SEL(m, "FW BCN offload:%s\n", dvobj->fw_bcn_offload ? "enable" : "disable"); -+ RTW_PRINT_SEL(m, "FW TBTT RPT:%x\n", dvobj->vap_tbtt_rpt_map); -+ return 0; -+} -+ -+#endif -+ -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+ssize_t proc_set_txss_tp(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 *pmlmeext = &(adapter->mlmeextpriv); -+ -+ char tmp[32]; -+ u32 enable = 0; -+ u32 txss_tx_tp = 0; -+ int txss_chk_cnt = 0; -+ -+ if (buffer == NULL) { -+ RTW_INFO("input buffer is NULL!\n"); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO("input length is 0!\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO("input length is too large\n"); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u %u %d", -+ &enable, &txss_tx_tp, &txss_chk_cnt); -+ -+ if (num < 1) { -+ RTW_INFO("input parameters < 1\n"); -+ return -EINVAL; -+ } -+ pmlmeext->txss_ctrl_en = enable; -+ -+ if (txss_tx_tp) -+ pmlmeext->txss_tp_th = txss_tx_tp; -+ if (txss_chk_cnt) -+ pmlmeext->txss_tp_chk_cnt = txss_chk_cnt; -+ -+ RTW_INFO("%s txss_ctl_en :%s , txss_tp_th:%d, tp_chk_cnt:%d\n", -+ __func__, pmlmeext->txss_tp_th ? "Y" : "N", -+ pmlmeext->txss_tp_th, pmlmeext->txss_tp_chk_cnt); -+ -+ } -+ -+ return count; -+} -+ -+int proc_get_txss_tp(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ RTW_PRINT_SEL(m, "TXSS Control - %s\n", pmlmeext->txss_ctrl_en ? "enable" : "disable"); -+ RTW_PRINT_SEL(m, "TXSS Tx TP TH - %d\n", pmlmeext->txss_tp_th); -+ RTW_PRINT_SEL(m, "TXSS check cnt - %d\n", pmlmeext->txss_tp_chk_cnt); -+ -+ return 0; -+} -+#ifdef DBG_CTRL_TXSS -+ssize_t proc_set_txss_ctrl(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 *pmlmeext = &(adapter->mlmeextpriv); -+ -+ char tmp[32]; -+ u32 tx_1ss = 0; -+ -+ if (buffer == NULL) { -+ RTW_INFO("input buffer is NULL!\n"); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO("input length is 0!\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO("input length is too large\n"); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u", &tx_1ss); -+ -+ if (num < 1) { -+ RTW_INFO("input parameters < 1\n"); -+ return -EINVAL; -+ } -+ -+ pmlmeext->txss_ctrl_en = _FALSE; -+ -+ dbg_ctrl_txss(adapter, tx_1ss); -+ -+ RTW_INFO("%s set tx to 1ss :%s\n", __func__, tx_1ss ? "Y" : "N"); -+ } -+ -+ return count; -+} -+ -+int proc_get_txss_ctrl(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ RTW_PRINT_SEL(m, "TXSS 1ss - %s\n", pmlmeext->txss_1ss ? "Y" : "N"); -+ -+ return 0; -+} -+#endif -+#endif -+ -+#ifdef CONFIG_DBG_RF_CAL -+int proc_get_iqk_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ return 0; -+} -+ -+ssize_t proc_set_iqk(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 recovery, clear, segment; -+ -+ 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 %d %d", &recovery, &clear, &segment); -+ -+ if (num != 3) { -+ RTW_INFO("Invalid format\n"); -+ return count; -+ } -+ -+ rtw_hal_iqk_test(padapter, recovery, clear, segment); -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_lck_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ return 0; -+} -+ -+ssize_t proc_set_lck(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 trigger; -+ -+ 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); -+ -+ if (num != 1) { -+ RTW_INFO("Invalid format\n"); -+ return count; -+ } -+ -+ rtw_hal_lck_test(padapter); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_DBG_RF_CAL */ -+ -+#ifdef CONFIG_LPS_CHK_BY_TP -+ssize_t proc_set_lps_chk_tp(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 pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ char tmp[32]; -+ u32 enable = 0; -+ u32 lps_tx_tp = 0, lps_rx_tp = 0, lps_bi_tp = 0; -+ int lps_chk_cnt_th = 0; -+ u32 lps_tx_pkts = 0, lps_rx_pkts = 0; -+ -+ if (buffer == NULL) { -+ RTW_INFO("input buffer is NULL!\n"); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO("input length is 0!\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO("input length is too large\n"); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u %u %u %u %d %u %u", -+ &enable, &lps_tx_tp, &lps_rx_tp, &lps_bi_tp, -+ &lps_chk_cnt_th, &lps_tx_pkts, &lps_rx_pkts); -+ -+ if (num < 1) { -+ RTW_INFO("input parameters < 1\n"); -+ return -EINVAL; -+ } -+ pwrpriv->lps_chk_by_tp = enable; -+ -+ if (lps_tx_tp) { -+ pwrpriv->lps_tx_tp_th = lps_tx_tp; -+ pwrpriv->lps_rx_tp_th = lps_tx_tp; -+ pwrpriv->lps_bi_tp_th = lps_tx_tp; -+ } -+ if (lps_rx_tp) -+ pwrpriv->lps_rx_tp_th = lps_rx_tp; -+ if (lps_bi_tp) -+ pwrpriv->lps_bi_tp_th = lps_bi_tp; -+ -+ if (lps_chk_cnt_th) -+ pwrpriv->lps_chk_cnt_th = lps_chk_cnt_th; -+ -+ if (lps_tx_pkts) -+ pwrpriv->lps_tx_pkts = lps_tx_pkts; -+ -+ if (lps_rx_pkts) -+ pwrpriv->lps_rx_pkts = lps_rx_pkts; -+ -+ RTW_INFO("%s lps_chk_by_tp:%s , lps_tx_tp_th:%d, lps_tx_tp_th:%d, lps_bi_tp:%d\n", -+ __func__, pwrpriv->lps_chk_by_tp ? "Y" : "N", -+ pwrpriv->lps_tx_tp_th, pwrpriv->lps_tx_tp_th, pwrpriv->lps_bi_tp_th); -+ RTW_INFO("%s lps_chk_cnt_th:%d , lps_tx_pkts:%d, lps_rx_pkts:%d\n", -+ __func__, pwrpriv->lps_chk_cnt_th, pwrpriv->lps_tx_pkts, pwrpriv->lps_rx_pkts); -+ } -+ -+ return count; -+} -+ -+int proc_get_lps_chk_tp(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ -+ RTW_PRINT_SEL(m, "LPS chk by tp - %s\n", pwrpriv->lps_chk_by_tp ? "enable" : "disable"); -+ RTW_PRINT_SEL(m, "LPS Tx TP TH - %d(Mbps)\n", pwrpriv->lps_tx_tp_th); -+ RTW_PRINT_SEL(m, "LPS Rx TP TH - %d(Mbps)\n", pwrpriv->lps_rx_tp_th); -+ RTW_PRINT_SEL(m, "LPS BI TP TH - %d(Mbps)\n", pwrpriv->lps_bi_tp_th); -+ -+ RTW_PRINT_SEL(m, "LPS CHK CNT - %d\n", pwrpriv->lps_chk_cnt_th); -+ RTW_PRINT_SEL(m, "LPS Tx PKTs - %d\n", pwrpriv->lps_tx_pkts); -+ RTW_PRINT_SEL(m, "LPS Rx PKTs - %d\n", pwrpriv->lps_rx_pkts); -+ return 0; -+} -+#endif /*CONFIG_LPS_CHK_BY_TP*/ -+#ifdef CONFIG_SUPPORT_STATIC_SMPS -+ssize_t proc_set_smps(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 *pmlmeext = &(adapter->mlmeextpriv); -+ char tmp[32]; -+ u32 enable = 0; -+ u32 smps_en, smps_tx_tp = 0, smps_rx_tp = 0; -+ u32 smps_test = 0, smps_test_en = 0; -+ -+ if (buffer == NULL) { -+ RTW_INFO("input buffer is NULL!\n"); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO("input length is 0!\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO("input length is too large\n"); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u %u %u %u %u", &smps_en, &smps_tx_tp, &smps_rx_tp, -+ &smps_test, &smps_test_en); -+ -+ if (num < 1) { -+ RTW_INFO("input parameters < 1\n"); -+ return -EINVAL; -+ } -+ -+ pmlmeext->ssmps_en = smps_en; -+ if (smps_tx_tp) { -+ pmlmeext->ssmps_tx_tp_th= smps_tx_tp; -+ pmlmeext->ssmps_rx_tp_th= smps_tx_tp; -+ } -+ if (smps_rx_tp) -+ pmlmeext->ssmps_rx_tp_th = smps_rx_tp; -+ -+ #ifdef DBG_STATIC_SMPS -+ if (num > 3) { -+ pmlmeext->ssmps_test = smps_test; -+ pmlmeext->ssmps_test_en = smps_test_en; -+ } -+ #endif -+ RTW_INFO("SM PS : %s tx_tp_th:%d, rx_tp_th:%d\n", -+ (smps_en) ? "Enable" : "Disable", -+ pmlmeext->ssmps_tx_tp_th, -+ pmlmeext->ssmps_rx_tp_th); -+ #ifdef DBG_STATIC_SMPS -+ RTW_INFO("SM PS : %s ssmps_test_en:%d\n", -+ (smps_test) ? "Enable" : "Disable", -+ pmlmeext->ssmps_test_en); -+ #endif -+ } -+ -+ return count; -+} -+ -+int proc_get_smps(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ RTW_PRINT_SEL(m, "Static SMPS %s\n", pmlmeext->ssmps_en ? "enable" : "disable"); -+ RTW_PRINT_SEL(m, "Tx TP TH %d\n", pmlmeext->ssmps_tx_tp_th); -+ RTW_PRINT_SEL(m, "Rx TP TH %d\n", pmlmeext->ssmps_rx_tp_th); -+ #ifdef DBG_STATIC_SMPS -+ RTW_PRINT_SEL(m, "test %d, test_en:%d\n", pmlmeext->ssmps_test, pmlmeext->ssmps_test_en); -+ #endif -+ return 0; -+} -+#endif /*CONFIG_SUPPORT_STATIC_SMPS*/ -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+ssize_t proc_set_ap_csa_cnt(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; -+ char tmp[6]; -+ u8 ap_csa_cnt; -+ rfctl = adapter_to_rfctl(adapter); -+ -+ if (buffer == NULL) { -+ RTW_INFO("input buffer is NULL!\n"); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO("input length is 0!\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO("input length is too large\n"); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%hhu", &ap_csa_cnt); -+ -+ if (num < 1) { -+ RTW_INFO("input parameters < 1\n"); -+ return -EINVAL; -+ } -+ -+ if (ap_csa_cnt > MAX_CSA_CNT) { -+ RTW_INFO("ap_csa_cnt can't set more than %u, so driver force ap_csa_cnt to %u.\n", MAX_CSA_CNT, MAX_CSA_CNT); -+ ap_csa_cnt = MAX_CSA_CNT; -+ } -+ -+ RTW_INFO("set rfctl->ap_csa_cnt_input to %u\n", ap_csa_cnt); -+ rfctl->ap_csa_cnt_input = ap_csa_cnt; -+ } -+ -+ return count; -+} -+ -+int proc_get_ap_csa_cnt(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rf_ctl_t *rfctl; -+ rfctl = adapter_to_rfctl(adapter); -+ -+ RTW_PRINT_SEL(m, "ap_csa_switch_cnt = %u\n", rfctl->ap_csa_cnt_input); -+ -+ return 0; -+} -+#endif -+ -+#endif /* CONFIG_PROC_DEBUG */ -+#define RTW_BUFDUMP_BSIZE 16 -+#if 1 -+inline void RTW_BUF_DUMP_SEL(uint _loglevel, void *sel, u8 *_titlestring, -+ bool _idx_show, const u8 *_hexdata, int _hexdatalen) -+{ -+#ifdef CONFIG_RTW_DEBUG -+ int __i; -+ u8 *ptr = (u8 *)_hexdata; -+ -+ if (_loglevel <= rtw_drv_log_level) { -+ if (_titlestring) { -+ if (sel == RTW_DBGDUMP) -+ RTW_PRINT(""); -+ _RTW_PRINT_SEL(sel, "%s", _titlestring); -+ if (_hexdatalen >= RTW_BUFDUMP_BSIZE) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+ for (__i = 0; __i < _hexdatalen; __i++) { -+ if (((__i % RTW_BUFDUMP_BSIZE) == 0) && (_hexdatalen >= RTW_BUFDUMP_BSIZE)) { -+ if (sel == RTW_DBGDUMP) -+ RTW_PRINT(""); -+ if (_idx_show) -+ _RTW_PRINT_SEL(sel, "0x%03X: ", __i); -+ } -+ _RTW_PRINT_SEL(sel, "%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); -+ if ((__i + 1 < _hexdatalen) && ((__i + 1) % RTW_BUFDUMP_BSIZE) == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif -+} -+#else -+inline void _RTW_STR_DUMP_SEL(void *sel, char *str_out) -+{ -+ if (sel == RTW_DBGDUMP) -+ _dbgdump("%s\n", str_out); -+ #if defined(_seqdump) -+ else -+ _seqdump(sel, "%s\n", str_out); -+ #endif /*_seqdump*/ -+} -+inline void RTW_BUF_DUMP_SEL(uint _loglevel, void *sel, u8 *_titlestring, -+ bool _idx_show, u8 *_hexdata, int _hexdatalen) -+{ -+ int __i, len; -+ int __j, idx; -+ int block_num, remain_byte; -+ char str_out[128] = {'\0'}; -+ char str_val[32] = {'\0'}; -+ char *p = NULL; -+ u8 *ptr = (u8 *)_hexdata; -+ -+ if (_loglevel <= rtw_drv_log_level) { -+ /*dump title*/ -+ p = &str_out[0]; -+ if (_titlestring) { -+ if (sel == RTW_DBGDUMP) { -+ len = snprintf(str_val, sizeof(str_val), "%s", DRIVER_PREFIX); -+ strncpy(p, str_val, len); -+ p += len; -+ } -+ len = snprintf(str_val, sizeof(str_val), "%s", _titlestring); -+ strncpy(p, str_val, len); -+ p += len; -+ } -+ if (p != &str_out[0]) { -+ _RTW_STR_DUMP_SEL(sel, str_out); -+ _rtw_memset(&str_out, '\0', sizeof(str_out)); -+ } -+ -+ /*dump buffer*/ -+ block_num = _hexdatalen / RTW_BUFDUMP_BSIZE; -+ remain_byte = _hexdatalen % RTW_BUFDUMP_BSIZE; -+ for (__i = 0; __i < block_num; __i++) { -+ p = &str_out[0]; -+ if (sel == RTW_DBGDUMP) { -+ len = snprintf(str_val, sizeof(str_val), "%s", DRIVER_PREFIX); -+ strncpy(p, str_val, len); -+ p += len; -+ } -+ if (_idx_show) { -+ len = snprintf(str_val, sizeof(str_val), "0x%03X: ", __i * RTW_BUFDUMP_BSIZE); -+ strncpy(p, str_val, len); -+ p += len; -+ } -+ for (__j =0; __j < RTW_BUFDUMP_BSIZE; __j++) { -+ idx = __i * RTW_BUFDUMP_BSIZE + __j; -+ len = snprintf(str_val, sizeof(str_val), "%02X%s", ptr[idx], (((__j + 1) % 4) == 0) ? " " : " "); -+ strncpy(p, str_val, len); -+ p += len; -+ } -+ _RTW_STR_DUMP_SEL(sel, str_out); -+ _rtw_memset(&str_out, '\0', sizeof(str_out)); -+ } -+ -+ p = &str_out[0]; -+ if ((sel == RTW_DBGDUMP) && remain_byte) { -+ len = snprintf(str_val, sizeof(str_val), "%s", DRIVER_PREFIX); -+ strncpy(p, str_val, len); -+ p += len; -+ } -+ if (_idx_show && remain_byte) { -+ len = snprintf(str_val, sizeof(str_val), "0x%03X: ", block_num * RTW_BUFDUMP_BSIZE); -+ strncpy(p, str_val, len); -+ p += len; -+ } -+ for (__i = 0; __i < remain_byte; __i++) { -+ idx = block_num * RTW_BUFDUMP_BSIZE + __i; -+ len = snprintf(str_val, sizeof(str_val), "%02X%s", ptr[idx], (((__i + 1) % 4) == 0) ? " " : " "); -+ strncpy(p, str_val, len); -+ p += len; -+ } -+ _RTW_STR_DUMP_SEL(sel, str_out); -+ } -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_eeprom.c b/drivers/net/wireless/rtl8821cs/core/rtw_eeprom.c -new file mode 100644 -index 000000000..62c0be06c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_eeprom.c -@@ -0,0 +1,329 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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) -+{ -+ *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; -+ 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: -+ return; -+} -+ -+u16 eeprom_read16(_adapter *padapter, u16 reg) /* ReadEEprom */ -+{ -+ -+ u16 x; -+ u16 data = 0; -+ -+ 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: -+ -+ 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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_ft.c b/drivers/net/wireless/rtl8821cs/core/rtw_ft.c -new file mode 100755 -index 000000000..62b9b4417 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_ft.c -@@ -0,0 +1,670 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#ifdef CONFIG_RTW_80211R -+ -+#ifndef RTW_FT_DBG -+ #define RTW_FT_DBG 0 -+#endif -+#if RTW_FT_DBG -+ #define RTW_FT_INFO(fmt, arg...) \ -+ RTW_INFO(fmt, arg) -+ #define RTW_FT_DUMP(str, data, len) \ -+ RTW_INFO_DUMP(str, data, len) -+#else -+ #define RTW_FT_INFO(fmt, arg...) do {} while (0) -+ #define RTW_FT_DUMP(str, data, len) do {} while (0) -+#endif -+ -+void rtw_ft_info_init(struct ft_roam_info *pft) -+{ -+ _rtw_memset(pft, 0, sizeof(struct ft_roam_info)); -+ pft->ft_flags = 0 -+ | RTW_FT_EN -+ /* | RTW_FT_OTD_EN */ -+#ifdef CONFIG_RTW_BTM_ROAM -+ | RTW_FT_BTM_ROAM -+#endif -+ ; -+ pft->ft_updated_bcn = _FALSE; -+ RTW_FT_INFO("%s : ft_flags=0x%02x\n", __func__, pft->ft_flags); -+} -+ -+ssize_t rtw_ft_proc_flags_set(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.ft_roam.ft_flags = flags; -+ } -+ -+ return count; -+ -+} -+ -+int rtw_ft_proc_flags_get(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.ft_roam.ft_flags); -+ -+ return 0; -+} -+ -+u8 rtw_ft_chk_roaming_candidate( -+ _adapter *padapter, struct wlan_network *competitor) -+{ -+ u8 *pmdie; -+ u32 mdie_len = 0; -+ struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); -+ -+ if (!(pmdie = rtw_get_ie(&competitor->network.IEs[12], -+ _MDIE_, &mdie_len, competitor->network.IELength-12))) { -+ RTW_INFO("FT : MDIE not foud in competitor!\n"); -+ return _FALSE; -+ } -+ -+ if (!_rtw_memcmp(&pft_roam->mdid, (pmdie+2), 2)) { -+ RTW_INFO("FT : unmatched MDIE!\n"); -+ return _FALSE; -+ } -+ -+ /*The candidate don't support over-the-DS*/ -+ if (rtw_ft_valid_otd_candidate(padapter, pmdie)) { -+ RTW_INFO("FT: ignore the candidate(" -+ MAC_FMT ") for over-the-DS\n", -+ MAC_ARG(competitor->network.MacAddress)); -+ /* rtw_ft_clr_flags(padapter, RTW_FT_PEER_OTD_EN); */ -+ return _FALSE; -+ } -+ -+ if (rtw_ft_chk_flags(padapter, RTW_FT_TEST_RSSI_ROAM)) { -+ if (!_rtw_memcmp(padapter->mlmepriv.cur_network.network.MacAddress, -+ competitor->network.MacAddress, ETH_ALEN) ) { -+ competitor->network.Rssi +=20; -+ RTW_FT_INFO("%s : update "MAC_FMT" RSSI to %d for RTW_FT_TEST_RSSI_ROAM\n", -+ __func__, MAC_ARG(competitor->network.MacAddress), -+ (int)competitor->network.Rssi); -+ rtw_ft_clr_flags(padapter, RTW_FT_TEST_RSSI_ROAM); -+ } -+ } -+ -+ return _TRUE; -+} -+ -+void rtw_ft_update_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; -+ -+ _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)); -+ } -+ -+} -+ -+void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct stassoc_event *pstassoc = (struct stassoc_event *)pbuf; -+ struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); -+ 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_ft_update_stainfo(padapter, pnetwork); -+ ft_evt_parms.ies_len = pft_roam->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, pft_roam->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 = pft_roam->ft_event.ric_ies; -+ ft_evt_parms.ric_ies_len = pft_roam->ft_event.ric_ies_len; -+ -+ /* It's a KERNEL issue between v4.11 ~ v4.16, -+ * <= v4.10, NLMSG_DEFAULT_SIZE is used for nlmsg_new(). -+ * v4.11 ~ v4.16, only used "100 + >ric_ies_len" for nlmsg_new() -+ * even then DRIVER don't support RIC. -+ * >= v4.17, issue should correct as "100 + ies_len + ric_ies_len". -+ */ -+ #if ((LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0)) && \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(4, 17, 0))) -+ if (!ft_evt_parms.ric_ies_len) -+ ft_evt_parms.ric_ies_len = ft_evt_parms.ies_len; -+ else -+ ft_evt_parms.ric_ies_len += ft_evt_parms.ies_len; -+ #endif -+ -+ rtw_ft_lock_set_status(padapter, RTW_FT_AUTHENTICATED_STA, &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 *)pft_roam->ft_event.target_ap, ETH_ALEN); -+err_1: -+ rtw_mfree((u8 *)ft_evt_parms.ies, ft_evt_parms.ies_len); -+err_2: -+ return; -+} -+ -+void rtw_ft_validate_akm_type(_adapter *padapter, -+ struct wlan_network *pnetwork) -+{ -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); -+ u32 tmp_len; -+ u8 *ptmp; -+ -+ /*IEEE802.11-2012 Std. Table 8-101-AKM suite selectors*/ -+ if (rtw_ft_valid_akm(padapter, psecuritypriv->rsn_akm_suite_type)) { -+ ptmp = rtw_get_ie(&pnetwork->network.IEs[12], -+ _MDIE_, &tmp_len, (pnetwork->network.IELength-12)); -+ if (ptmp) { -+ pft_roam->mdid = *(u16 *)(ptmp+2); -+ pft_roam->ft_cap = *(ptmp+4); -+ -+ RTW_INFO("FT: target " MAC_FMT " mdid=(0x%2x), capacity=(0x%2x)\n", -+ MAC_ARG(pnetwork->network.MacAddress), pft_roam->mdid, pft_roam->ft_cap); -+ rtw_ft_set_flags(padapter, RTW_FT_PEER_EN); -+ RTW_FT_INFO("%s : peer support FTOTA(0x%02x)\n", __func__, pft_roam->ft_flags); -+ -+ if (rtw_ft_otd_roam_en(padapter)) { -+ rtw_ft_set_flags(padapter, RTW_FT_PEER_OTD_EN); -+ RTW_FT_INFO("%s : peer support FTOTD(0x%02x)\n", __func__, pft_roam->ft_flags); -+ } -+ } else { -+ /* Don't use FT roaming if target AP cannot support FT */ -+ rtw_ft_clr_flags(padapter, (RTW_FT_PEER_EN|RTW_FT_PEER_OTD_EN)); -+ rtw_ft_reset_status(padapter); -+ } -+ } else { -+ /* It could be a non-FT connection */ -+ rtw_ft_clr_flags(padapter, (RTW_FT_PEER_EN|RTW_FT_PEER_OTD_EN)); -+ rtw_ft_reset_status(padapter); -+ } -+ -+ RTW_FT_INFO("%s : ft_flags=0x%02x\n", __func__, pft_roam->ft_flags); -+} -+ -+void rtw_ft_update_bcn(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ WLAN_BSSID_EX *pbss; -+ -+ if (rtw_ft_chk_status(padapter,RTW_FT_ASSOCIATED_STA) -+ && (pmlmepriv->ft_roam.ft_updated_bcn == _FALSE)) { -+ 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); -+ /* Move into rtw_get_bcn_keys */ -+ /* rtw_get_bcn_info(&(pmlmepriv->cur_network)); */ -+ -+ /* update bcn keys */ -+ if (rtw_get_bcn_keys(padapter, pframe, len, &recv_beacon) == _TRUE) { -+ RTW_FT_INFO("%s: beacon keys ready\n", __func__); -+ _rtw_memcpy(&pmlmepriv->cur_beacon_keys, -+ &recv_beacon, sizeof(recv_beacon)); -+ if (is_hidden_ssid(recv_beacon.ssid, recv_beacon.ssid_len)) { -+ _rtw_memcpy(pmlmepriv->cur_beacon_keys.ssid, pmlmeinfo->network.Ssid.Ssid, IW_ESSID_MAX_SIZE); -+ pmlmepriv->cur_beacon_keys.ssid_len = pmlmeinfo->network.Ssid.SsidLength; -+ } -+ } else { -+ RTW_ERR("%s: get beacon keys failed\n", __func__); -+ _rtw_memset(&pmlmepriv->cur_beacon_keys, 0, sizeof(recv_beacon)); -+ } -+ #ifdef CONFIG_BCN_CNT_CONFIRM_HDL -+ pmlmepriv->new_beacon_cnts = 0; -+ #endif -+ } -+ 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))); -+ -+ rtw_phydm_update_ap_vendor_ie(padapter); -+ -+ /* update TSF Value */ -+ update_TSF(pmlmeext, pframe, len); -+ pmlmeext->bcn_cnt = 0; -+ pmlmeext->last_bcn_cnt = 0; -+ pmlmepriv->ft_roam.ft_updated_bcn = _TRUE; -+ } -+} -+ -+void rtw_ft_start_clnt_join(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); -+ -+ if (rtw_ft_otd_roam(padapter)) { -+ pmlmeinfo->state = WIFI_FW_AUTH_SUCCESS | WIFI_FW_STATION_STATE; -+ pft_roam->ft_event.ies = -+ (pft_roam->ft_action + sizeof(struct rtw_ieee80211_hdr_3addr) + 16); -+ pft_roam->ft_event.ies_len = -+ (pft_roam->ft_action_len - sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ /*Not support RIC*/ -+ pft_roam->ft_event.ric_ies = NULL; -+ pft_roam->ft_event.ric_ies_len = 0; -+ rtw_ft_report_evt(padapter); -+ return; -+ } -+ -+ pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; -+ start_clnt_auth(padapter); -+} -+ -+u8 rtw_ft_update_rsnie( -+ _adapter *padapter, u8 bwrite, -+ struct pkt_attrib *pattrib, u8 **pframe) -+{ -+ struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); -+ u8 *pie; -+ u32 len; -+ -+ pie = rtw_get_ie(pft_roam->updated_ft_ies, EID_WPA2, &len, -+ pft_roam->updated_ft_ies_len); -+ -+ if (!bwrite) -+ return (pie)?_SUCCESS:_FAIL; -+ -+ if (pie) { -+ *pframe = rtw_set_ie(((u8 *)*pframe), EID_WPA2, len, -+ pie+2, &(pattrib->pktlen)); -+ } else -+ return _FAIL; -+ -+ return _SUCCESS; -+} -+ -+static u8 rtw_ft_update_mdie( -+ _adapter *padapter, struct pkt_attrib *pattrib, u8 **pframe) -+{ -+ struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); -+ u8 *pie, mdie[3]; -+ u32 len = 3; -+ -+ if (rtw_ft_roam(padapter)) { -+ if ((pie = rtw_get_ie(pft_roam->updated_ft_ies, _MDIE_, -+ &len, pft_roam->updated_ft_ies_len))) { -+ pie = (pie + 2); /* ignore md-id & length */ -+ } else -+ return _FAIL; -+ } else { -+ *((u16 *)&mdie[0]) = pft_roam->mdid; -+ mdie[2] = pft_roam->ft_cap; -+ pie = &mdie[0]; -+ } -+ -+ *pframe = rtw_set_ie(((u8 *)*pframe), _MDIE_, len , pie, &(pattrib->pktlen)); -+ return _SUCCESS; -+} -+ -+static u8 rtw_ft_update_ftie( -+ _adapter *padapter, struct pkt_attrib *pattrib, u8 **pframe) -+{ -+ struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); -+ u8 *pie; -+ u32 len; -+ -+ if ((pie = rtw_get_ie(pft_roam->updated_ft_ies, _FTIE_, &len, -+ pft_roam->updated_ft_ies_len)) != NULL) { -+ *pframe = rtw_set_ie(*pframe, _FTIE_, len , -+ (pie+2), &(pattrib->pktlen)); -+ } else -+ return _FAIL; -+ -+ return _SUCCESS; -+} -+ -+void rtw_ft_build_auth_req_ies(_adapter *padapter, -+ struct pkt_attrib *pattrib, u8 **pframe) -+{ -+ u8 ftie_append = _TRUE; -+ -+ if (!pattrib || !(*pframe)) -+ return; -+ -+ if (!rtw_ft_roam(padapter)) -+ return; -+ -+ ftie_append = rtw_ft_update_rsnie(padapter, _TRUE, pattrib, pframe); -+ rtw_ft_update_mdie(padapter, pattrib, pframe); -+ if (ftie_append) -+ rtw_ft_update_ftie(padapter, pattrib, pframe); -+} -+ -+void rtw_ft_build_assoc_req_ies(_adapter *padapter, -+ u8 is_reassoc, struct pkt_attrib *pattrib, u8 **pframe) -+{ -+ if (!pattrib || !(*pframe)) -+ return; -+ -+ if (rtw_ft_chk_flags(padapter, RTW_FT_PEER_EN)) -+ rtw_ft_update_mdie(padapter, pattrib, pframe); -+ -+ if ((!is_reassoc) || (!rtw_ft_roam(padapter))) -+ return; -+ -+ if (rtw_ft_update_rsnie(padapter, _FALSE, pattrib, pframe)) -+ rtw_ft_update_ftie(padapter, pattrib, pframe); -+} -+ -+u8 rtw_ft_update_auth_rsp_ies(_adapter *padapter, u8 *pframe, u32 len) -+{ -+ u8 ret = _SUCCESS; -+ u8 target_ap_addr[ETH_ALEN] = {0}; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); -+ -+ if (!rtw_ft_roam(padapter)) -+ return _FAIL; -+ -+ /*rtw_ft_report_reassoc_evt already, -+ * and waiting for cfg80211_rtw_update_ft_ies */ -+ if (rtw_ft_authed_sta(padapter)) -+ return ret; -+ -+ if (!pframe || !len) -+ return _FAIL; -+ -+ rtw_buf_update(&pmlmepriv->auth_rsp, -+ &pmlmepriv->auth_rsp_len, pframe, len); -+ pft_roam->ft_event.ies = -+ (pmlmepriv->auth_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6); -+ pft_roam->ft_event.ies_len = -+ (pmlmepriv->auth_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6); -+ -+ /*Not support RIC*/ -+ pft_roam->ft_event.ric_ies = NULL; -+ pft_roam->ft_event.ric_ies_len = 0; -+ _rtw_memcpy(target_ap_addr, pmlmepriv->assoc_bssid, ETH_ALEN); -+ rtw_ft_report_reassoc_evt(padapter, target_ap_addr); -+ -+ return ret; -+} -+ -+static void rtw_ft_start_clnt_action(_adapter *padapter, u8 *pTargetAddr) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ rtw_ft_set_status(padapter, RTW_FT_REQUESTING_STA); -+ rtw_ft_issue_action_req(padapter, pTargetAddr); -+ _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); -+} -+ -+void rtw_ft_start_roam(_adapter *padapter, u8 *pTargetAddr) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (rtw_ft_otd_roam(padapter)) { -+ RTW_FT_INFO("%s : try OTD roaming\n", __func__); -+ rtw_ft_start_clnt_action(padapter, pTargetAddr); -+ } else { -+ /*wait a little time to retrieve packets buffered in the current ap while scan*/ -+ RTW_FT_INFO("%s : start roaming timer\n", __func__); -+ _set_timer(&pmlmeext->ft_roam_timer, 30); -+ } -+} -+ -+void rtw_ft_issue_action_req(_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; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct pkt_attrib *pattrib; -+ u8 *pframe; -+ u8 category = RTW_WLAN_CATEGORY_FT; -+ u8 action = RTW_WLAN_ACTION_FT_REQ; -+ -+ 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; -+ pwlanhdr->frame_ctl = 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++; -+ set_frame_sub_type(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; -+ -+ rtw_ft_update_mdie(padapter, pattrib, &pframe); -+ if (rtw_ft_update_rsnie(padapter, _TRUE, pattrib, &pframe)) -+ rtw_ft_update_ftie(padapter, pattrib, &pframe); -+ -+ RTW_INFO("FT : issue RTW_WLAN_ACTION_FT_REQ\n"); -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+} -+ -+void rtw_ft_report_evt(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); -+ 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_ft_update_stainfo(padapter, pnetwork); -+ -+ if (!pnetwork) -+ goto err_2; -+ -+ ft_evt_parms.ies_len = pft_roam->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, pft_roam->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 = pft_roam->ft_event.ric_ies; -+ ft_evt_parms.ric_ies_len = pft_roam->ft_event.ric_ies_len; -+ -+ /* It's a KERNEL issue between v4.11 ~ v4.16, -+ * <= v4.10, NLMSG_DEFAULT_SIZE is used for nlmsg_new(). -+ * v4.11 ~ v4.16, only used "100 + >ric_ies_len" for nlmsg_new() -+ * even then DRIVER don't support RIC. -+ * >= v4.17, issue should correct as "100 + ies_len + ric_ies_len". -+ */ -+ #if ((LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0)) && \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(4, 17, 0))) -+ ft_evt_parms.ric_ies_len = (ft_evt_parms.ies_len <= 100 )? -+ (0):(ft_evt_parms.ies_len - 100); -+ #endif -+ -+ rtw_ft_lock_set_status(padapter, RTW_FT_AUTHENTICATED_STA, &irqL); -+ rtw_cfg80211_ft_event(padapter, &ft_evt_parms); -+ RTW_INFO("FT: rtw_ft_report_evt\n"); -+ rtw_mfree((u8 *)pft_roam->ft_event.target_ap, ETH_ALEN); -+err_1: -+ rtw_mfree((u8 *)ft_evt_parms.ies, ft_evt_parms.ies_len); -+err_2: -+ return; -+} -+ -+void rtw_ft_report_reassoc_evt(_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 rtw_evt_header *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 rtw_evt_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 = CMD_SET_MLME_EVT; -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ evt_hdr = (struct rtw_evt_header *)(pevtcmd); -+ evt_hdr->len = sizeof(struct stassoc_event); -+ evt_hdr->id = EVT_FT_REASSOC; -+ evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ passoc_sta_evt = (struct stassoc_event *)(pevtcmd + sizeof(struct rtw_evt_header)); -+ _rtw_memcpy((unsigned char *)(&(passoc_sta_evt->macaddr)), pMacAddr, ETH_ALEN); -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+} -+ -+void rtw_ft_link_timer_hdl(void *ctx) -+{ -+ _adapter *padapter = (_adapter *)ctx; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); -+ -+ if (rtw_ft_chk_status(padapter, RTW_FT_REQUESTING_STA)) { -+ if (pft_roam->ft_req_retry_cnt < RTW_FT_ACTION_REQ_LMT) { -+ pft_roam->ft_req_retry_cnt++; -+ rtw_ft_issue_action_req(padapter, (u8 *)pmlmepriv->roam_network->network.MacAddress); -+ _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); -+ } else { -+ pft_roam->ft_req_retry_cnt = 0; -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ rtw_ft_set_status(padapter, RTW_FT_ASSOCIATED_STA); -+ else -+ rtw_ft_reset_status(padapter); -+ } -+ } -+} -+ -+void rtw_ft_roam_timer_hdl(void *ctx) -+{ -+ _adapter *padapter = (_adapter *)ctx; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ RTW_FT_INFO("%s : try roaming\n", __func__); -+ receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress -+ , WLAN_REASON_ACTIVE_ROAM, _FALSE); -+} -+ -+void rtw_ft_roam_status_reset(_adapter *padapter) -+{ -+ struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); -+ -+ if ((rtw_to_roam(padapter) > 0) && -+ (!rtw_ft_chk_status(padapter, RTW_FT_REQUESTED_STA))) { -+ rtw_ft_reset_status(padapter); -+ } -+ -+ padapter->mlmepriv.ft_roam.ft_updated_bcn = _FALSE; -+} -+ -+#endif /* CONFIG_RTW_80211R */ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_ieee80211.c b/drivers/net/wireless/rtl8821cs/core/rtw_ieee80211.c -new file mode 100755 -index 000000000..52d95366e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_ieee80211.c -@@ -0,0 +1,3389 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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_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_AES_128_CMAC[] = { 0x00, 0x0f, 0xac, 6 }; -+u8 RSN_CIPHER_SUITE_GCMP[] = { 0x00, 0x0f, 0xac, 8 }; -+u8 RSN_CIPHER_SUITE_GCMP_256[] = { 0x00, 0x0f, 0xac, 9 }; -+u8 RSN_CIPHER_SUITE_CCMP_256[] = { 0x00, 0x0f, 0xac, 10 }; -+u8 RSN_CIPHER_SUITE_BIP_GMAC_128[] = { 0x00, 0x0f, 0xac, 11 }; -+u8 RSN_CIPHER_SUITE_BIP_GMAC_256[] = { 0x00, 0x0f, 0xac, 12 }; -+u8 RSN_CIPHER_SUITE_BIP_CMAC_256[] = { 0x00, 0x0f, 0xac, 13 }; -+u8 RSN_CIPHER_SUITE_WEP104[] = { 0x00, 0x0f, 0xac, 5 }; -+ -+u8 WLAN_AKM_8021X[] = {0x00, 0x0f, 0xac, 1}; -+u8 WLAN_AKM_PSK[] = {0x00, 0x0f, 0xac, 2}; -+u8 WLAN_AKM_FT_8021X[] = {0x00, 0x0f, 0xac, 3}; -+u8 WLAN_AKM_FT_PSK[] = {0x00, 0x0f, 0xac, 4}; -+u8 WLAN_AKM_8021X_SHA256[] = {0x00, 0x0f, 0xac, 5}; -+u8 WLAN_AKM_PSK_SHA256[] = {0x00, 0x0f, 0xac, 6}; -+u8 WLAN_AKM_TDLS[] = {0x00, 0x0f, 0xac, 7}; -+u8 WLAN_AKM_SAE[] = {0x00, 0x0f, 0xac, 8}; -+u8 WLAN_AKM_FT_OVER_SAE[] = {0x00, 0x0f, 0xac, 9}; -+u8 WLAN_AKM_8021X_SUITE_B[] = {0x00, 0x0f, 0xac, 11}; -+u8 WLAN_AKM_8021X_SUITE_B_192[] = {0x00, 0x0f, 0xac, 12}; -+u8 WLAN_AKM_FILS_SHA256[] = {0x00, 0x0f, 0xac, 14}; -+u8 WLAN_AKM_FILS_SHA384[] = {0x00, 0x0f, 0xac, 15}; -+u8 WLAN_AKM_FT_FILS_SHA256[] = {0x00, 0x0f, 0xac, 16}; -+u8 WLAN_AKM_FT_FILS_SHA384[] = {0x00, 0x0f, 0xac, 17}; -+/* ----------------------------------------------------------- -+ * for adhoc-master to generate ie and provide supported-rate to fw -+ * ----------------------------------------------------------- */ -+ -+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) -+}; -+ -+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 -+}; -+ -+const char *MGN_RATE_STR(enum MGN_RATE rate) -+{ -+ u8 hw_rate; -+ -+ if (rate == MGN_MCS32) -+ return "MCS32"; -+ -+ hw_rate = MRateToHwRate(rate); -+ if (hw_rate == DESC_RATE1M && rate != MGN_1M) -+ hw_rate = DESC_RATE_NUM; /* invalid case */ -+ -+ return HDATA_RATE(hw_rate); -+} -+ -+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 -+ }; -+ -+RATE_SECTION mgn_rate_to_rs(enum MGN_RATE rate) -+{ -+ RATE_SECTION rs = RATE_SECTION_NUM; -+ -+ if (IS_CCK_RATE(rate)) -+ rs = CCK; -+ else if (IS_OFDM_RATE(rate)) -+ rs = OFDM; -+ else if (IS_HT1SS_RATE(rate)) -+ rs = HT_1SS; -+ else if (IS_HT2SS_RATE(rate)) -+ rs = HT_2SS; -+ else if (IS_HT3SS_RATE(rate)) -+ rs = HT_3SS; -+ else if (IS_HT4SS_RATE(rate)) -+ rs = HT_4SS; -+ else if (IS_VHT1SS_RATE(rate)) -+ rs = VHT_1SS; -+ else if (IS_VHT2SS_RATE(rate)) -+ rs = VHT_2SS; -+ else if (IS_VHT3SS_RATE(rate)) -+ rs = VHT_3SS; -+ else if (IS_VHT4SS_RATE(rate)) -+ rs = VHT_4SS; -+ -+ return rs; -+} -+ -+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_get_cckrate_size(u8 *rate, u32 rate_length) -+{ -+ int i = 0; -+ while(i < rate_length){ -+ RTW_DBG("%s, rate[%d]=%u\n", __FUNCTION__, i, rate[i]); -+ if (((rate[i] & 0x7f) == 2) || ((rate[i] & 0x7f) == 4) || -+ ((rate[i] & 0x7f) == 11) || ((rate[i] & 0x7f) == 22)) -+ i++; -+ else -+ break; -+ } -+ return i; -+} -+ -+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, /* IE content length, not entire IE length */ -+ const u8 *source, -+ uint *frlen /* frame length */ -+) -+{ -+ *pbuf = (u8)index; -+ -+ *(pbuf + 1) = (u8)len; -+ -+ if (len > 0) -+ _rtw_memcpy((void *)(pbuf + 2), (void *)source, len); -+ -+ if (frlen) -+ *frlen = *frlen + (len + 2); -+ -+ return pbuf + len + 2; -+} -+ -+u8 *rtw_set_ie_tpc_report(u8 *buf, u32 *buf_len, u8 tx_power, u8 link_margin) -+{ -+ u8 ie_data[2]; -+ -+ ie_data[0] = tx_power; -+ ie_data[1] = link_margin; -+ return rtw_set_ie(buf, WLAN_EID_TPC_REPORT, 2, ie_data, buf_len); -+} -+ -+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_LOWER; -+ else if (ch_offset == SCB) -+ return HAL_PRIME_CHNL_OFFSET_UPPER; -+ -+ 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 SCA; -+ else if (ch_offset == HAL_PRIME_CHNL_OFFSET_UPPER) -+ return SCB; -+ -+ 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(const u8 *pbuf, sint index, sint *len, sint limit) -+{ -+ sint tmp, i; -+ const u8 *p; -+ if (limit < 1) { -+ return NULL; -+ } -+ -+ p = pbuf; -+ i = 0; -+ *len = 0; -+ while (1) { -+ if (*p == index) { -+ *len = *(p + 1); -+ return (u8 *)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(const u8 *in_ie, uint in_len, u8 eid, const u8 *oui, u8 oui_len, u8 *ie, uint *ielen) -+{ -+ uint cnt; -+ const u8 *target_ie = NULL; -+ -+ -+ if (ielen) -+ *ielen = 0; -+ -+ if (!in_ie || in_len <= 0) -+ return (u8 *)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 (u8 *)target_ie; -+} -+ -+/** -+ * rtw_ies_update_ie - Find matching IEs and update it -+ * -+ * @ies: address of IEs to search -+ * @ies_len: address of length of ies, will update to new length -+ * @offset: the offset to start scarch -+ * @eid: element ID to match -+ * @content: new content will update to matching element -+ * @content_len: length of new content -+ * Returns: _SUCCESS: ies is updated, _FAIL: not updated -+ */ -+u8 rtw_ies_update_ie(u8 *ies, uint *ies_len, uint ies_offset, u8 eid, const u8 *content, u8 content_len) -+{ -+ u8 ret = _FAIL; -+ u8 *target_ie; -+ u32 target_ielen; -+ u8 *start, *remain_ies = NULL, *backup_ies = NULL; -+ uint search_len, remain_len = 0; -+ sint offset; -+ -+ if (ies == NULL || *ies_len == 0 || *ies_len <= ies_offset) -+ goto exit; -+ -+ start = ies + ies_offset; -+ search_len = *ies_len - ies_offset; -+ -+ target_ie = rtw_get_ie(start, eid, &target_ielen, search_len); -+ if (target_ie && target_ielen) { -+ if (target_ielen != content_len) { -+ remain_ies = target_ie + 2 + target_ielen; -+ remain_len = search_len - (remain_ies - start); -+ -+ backup_ies = rtw_malloc(remain_len); -+ if (!backup_ies) -+ goto exit; -+ -+ _rtw_memcpy(backup_ies, remain_ies, remain_len); -+ } -+ -+ _rtw_memcpy(target_ie + 2, content, content_len); -+ *(target_ie + 1) = content_len; -+ ret = _SUCCESS; -+ -+ if (target_ielen != content_len) { -+ remain_ies = target_ie + 2 + content_len; -+ _rtw_memcpy(remain_ies, backup_ies, remain_len); -+ rtw_mfree(backup_ies, remain_len); -+ offset = content_len - target_ielen; -+ *ies_len = *ies_len + offset; -+ } -+ } -+exit: -+ return ret; -+} -+ -+/** -+ * 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; -+ -+ } -+} -+ -+void rtw_filter_suppport_rateie(WLAN_BSSID_EX *pbss_network, u8 keep) -+{ -+ u8 i, idx = 0, new_rate[NDIS_802_11_LENGTH_RATES_EX], *p; -+ uint iscck, isofdm, ie_orilen = 0, remain_len; -+ u8 *remain_ies; -+ -+ p = rtw_get_ie(pbss_network->IEs + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &ie_orilen, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (!p) -+ return; -+ -+ _rtw_memset(new_rate, 0, NDIS_802_11_LENGTH_RATES_EX); -+ for (i=0; i < ie_orilen; i++) { -+ iscck = rtw_is_cck_rate(p[i+2]); -+ isofdm= rtw_is_ofdm_rate(p[i+2]); -+ if (((keep == CCK) && iscck) -+ || ((keep == OFDM) && isofdm)) -+ new_rate[idx++]= rtw_is_basic_rate_ofdm(p[i+2]) ? p[i+2]|IEEE80211_BASIC_RATE_MASK : p[i+2]; -+ } -+ /* update rate ie */ -+ p[1] = idx; -+ _rtw_memcpy(p+2, new_rate, idx); -+ /* update remain ie & IELength*/ -+ remain_ies = p + 2 + ie_orilen; -+ remain_len = pbss_network->IELength - (remain_ies - pbss_network->IEs); -+ _rtw_memmove(p+2+idx, remain_ies, remain_len); -+ pbss_network->IELength -= (ie_orilen - idx); -+} -+ -+ -+/* -+ Adjust those items by given wireless_mode -+ 1. pbss_network->IELength -+ 2. pbss_network->IE (SUPPORTRATE & EXT_SUPPORTRATE) -+ 3. pbss_network->SupportedRates -+*/ -+ -+u8 rtw_update_rate_bymode(WLAN_BSSID_EX *pbss_network, u32 mode) -+{ -+ u8 network_type, *p, *ie = pbss_network->IEs; -+ sint ie_len; -+ uint network_ielen = pbss_network->IELength; -+ -+ if (mode == WIRELESS_11B) { -+ /*only keep CCK in support_rate IE and remove whole ext_support_rate IE*/ -+ rtw_filter_suppport_rateie(pbss_network, CCK); -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ie_len, pbss_network->IELength - _BEACON_IE_OFFSET_); -+ if (p) { -+ rtw_ies_remove_ie(ie , &network_ielen, _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, NULL, 0); -+ pbss_network->IELength -= ie_len; -+ } -+ network_type = WIRELESS_11B; -+ } else { -+ if (pbss_network->Configuration.DSConfig > 14) { -+ /* Remove CCK in support_rate IE */ -+ rtw_filter_suppport_rateie(pbss_network, OFDM); -+ network_type = WIRELESS_11A; -+ } else { -+ if ((mode & WIRELESS_11B) == 0) { -+ /* Remove CCK in support_rate IE */ -+ rtw_filter_suppport_rateie(pbss_network, OFDM); -+ network_type = WIRELESS_11G; -+ } else { -+ network_type = WIRELESS_11BG; -+ } -+ } -+ } -+ -+ rtw_set_supported_rate(pbss_network->SupportedRates, network_type); -+ -+ return network_type; -+} -+ -+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 (is_supported_ht(pregistrypriv->wireless_mode) -+ && (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_rsn_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_GCMP, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_GCMP; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_GCMP_256, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_GCMP_256; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_CCMP_256, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_CCMP_256; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP104, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_WEP104; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_AES_128_CMAC, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_BIP_CMAC_128; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_BIP_GMAC_128, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_BIP_GMAC_128; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_BIP_GMAC_256, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_BIP_GMAC_256; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_BIP_CMAC_256, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_BIP_CMAC_256; -+ return 0; -+} -+ -+u32 rtw_get_akm_suite_bitmap(u8 *s) -+{ -+ if (_rtw_memcmp(s, WLAN_AKM_8021X, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_8021X; -+ if (_rtw_memcmp(s, WLAN_AKM_PSK, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_PSK; -+ if (_rtw_memcmp(s, WLAN_AKM_FT_8021X, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_FT_8021X; -+ if (_rtw_memcmp(s, WLAN_AKM_FT_PSK, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_FT_PSK; -+ if (_rtw_memcmp(s, WLAN_AKM_8021X_SHA256, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_8021X_SHA256; -+ if (_rtw_memcmp(s, WLAN_AKM_PSK_SHA256, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_PSK_SHA256; -+ if (_rtw_memcmp(s, WLAN_AKM_TDLS, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_TDLS; -+ if (_rtw_memcmp(s, WLAN_AKM_SAE, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_SAE; -+ if (_rtw_memcmp(s, WLAN_AKM_FT_OVER_SAE, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_FT_OVER_SAE; -+ if (_rtw_memcmp(s, WLAN_AKM_8021X_SUITE_B, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_8021X_SUITE_B; -+ if (_rtw_memcmp(s, WLAN_AKM_8021X_SUITE_B_192, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_8021X_SUITE_B_192; -+ if (_rtw_memcmp(s, WLAN_AKM_FILS_SHA256, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_FILS_SHA256; -+ if (_rtw_memcmp(s, WLAN_AKM_FILS_SHA384, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_FILS_SHA384; -+ if (_rtw_memcmp(s, WLAN_AKM_FT_FILS_SHA256, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_FT_FILS_SHA256; -+ if (_rtw_memcmp(s, WLAN_AKM_FT_FILS_SHA384, RSN_SELECTOR_LEN) == _TRUE) -+ return WLAN_AKM_TYPE_FT_FILS_SHA384; -+ -+ return 0; -+} -+ -+int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, -+ int *pairwise_cipher, u32 *akm) -+{ -+ 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 (akm) { -+ if (left >= 6) { -+ pos += 2; -+ if (_rtw_memcmp(pos, SUITE_1X, 4) == 1) { -+ *akm = WLAN_AKM_TYPE_8021X; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+int rtw_rsne_info_parse(const u8 *ie, uint ie_len, struct rsne_info *info) -+{ -+ const u8 *pos = ie; -+ u16 ver; -+ u16 cnt; -+ -+ _rtw_memset(info, 0, sizeof(struct rsne_info)); -+ -+ if (ie + ie_len < pos + 4) -+ goto err; -+ -+ if (*ie != WLAN_EID_RSN || *(ie + 1) != ie_len - 2) -+ goto err; -+ pos += 2; -+ -+ /* Version */ -+ ver = RTW_GET_LE16(pos); -+ if(1 != ver) -+ goto err; -+ pos += 2; -+ -+ /* Group CS */ -+ if (ie + ie_len < pos + 4) { -+ if (ie + ie_len != pos) -+ goto err; -+ goto exit; -+ } -+ info->gcs = (u8 *)pos; -+ pos += 4; -+ -+ /* Pairwise CS */ -+ if (ie + ie_len < pos + 2) { -+ if (ie + ie_len != pos) -+ goto err; -+ goto exit; -+ } -+ cnt = RTW_GET_LE16(pos); -+ pos += 2; -+ if (ie + ie_len < pos + 4 * cnt) { -+ if (ie + ie_len != pos) -+ goto err; -+ goto exit; -+ } -+ info->pcs_cnt = cnt; -+ info->pcs_list = (u8 *)pos; -+ pos += 4 * cnt; -+ -+ /* AKM */ -+ if (ie + ie_len < pos + 2) { -+ if (ie + ie_len != pos) -+ goto err; -+ goto exit; -+ } -+ cnt = RTW_GET_LE16(pos); -+ pos += 2; -+ if (ie + ie_len < pos + 4 * cnt) { -+ if (ie + ie_len != pos) -+ goto err; -+ goto exit; -+ } -+ info->akm_cnt = cnt; -+ info->akm_list = (u8 *)pos; -+ pos += 4 * cnt; -+ -+ /* RSN cap */ -+ if (ie + ie_len < pos + 2) { -+ if (ie + ie_len != pos) -+ goto err; -+ goto exit; -+ } -+ info->cap = (u8 *)pos; -+ pos += 2; -+ -+ /* PMKID */ -+ if (ie + ie_len < pos + 2) { -+ if (ie + ie_len != pos) -+ goto err; -+ goto exit; -+ } -+ cnt = RTW_GET_LE16(pos); -+ pos += 2; -+ if (ie + ie_len < pos + 16 * cnt) -+ goto err; -+ info->pmkid_cnt = cnt; -+ info->pmkid_list = (u8 *)pos; -+ pos += 16 * cnt; -+ -+ /* Group Mgmt CS */ -+ if (ie + ie_len < pos + 4) { -+ if (ie + ie_len != pos) -+ goto err; -+ goto exit; -+ } -+ info->gmcs = (u8 *)pos; -+ -+exit: -+ return _SUCCESS; -+ -+err: -+ info->err = 1; -+ return _FAIL; -+} -+ -+int rtw_parse_wpa2_ie(u8 *rsn_ie, int rsn_ie_len, int *group_cipher, -+ int *pairwise_cipher, int *gmcs, u32 *akm, u8 *mfp_opt, u8 *spp_opt) -+{ -+ struct rsne_info info; -+ int i, ret = _SUCCESS; -+ -+ ret = rtw_rsne_info_parse(rsn_ie, rsn_ie_len, &info); -+ if (ret != _SUCCESS) -+ goto exit; -+ -+ if (group_cipher) { -+ if (info.gcs) -+ *group_cipher = rtw_get_rsn_cipher_suite(info.gcs); -+ else -+ *group_cipher = 0; -+ } -+ -+ if (pairwise_cipher) { -+ *pairwise_cipher = 0; -+ if (info.pcs_list) { -+ for (i = 0; i < info.pcs_cnt; i++) -+ *pairwise_cipher |= rtw_get_rsn_cipher_suite(info.pcs_list + 4 * i); -+ } -+ } -+ -+ if (gmcs) { -+ if (info.gmcs) -+ *gmcs = rtw_get_rsn_cipher_suite(info.gmcs); -+ else -+ *gmcs = WPA_CIPHER_BIP_CMAC_128; /* default value when absent */ -+ } -+ -+ if (akm) { -+ *akm = 0; -+ if (info.akm_list) { -+ for (i = 0; i < info.akm_cnt; i++) -+ *akm |= rtw_get_akm_suite_bitmap(info.akm_list + 4 * i); -+ } -+ } -+ -+ if (mfp_opt) { -+ *mfp_opt = MFP_NO; -+ if (info.cap) -+ *mfp_opt = GET_RSN_CAP_MFP_OPTION(info.cap); -+ } -+ -+ if (spp_opt) { -+ *spp_opt = 0; -+ if (info.cap) -+ *spp_opt = GET_RSN_CAP_SPP_OPT(info.cap); -+ } -+ -+exit: -+ 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; -+ 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; -+ 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, enum bss_type frame_type) -+{ -+ u8 *wps = NULL; -+ -+ RTW_INFO("[%s] frame_type = %d\n", __FUNCTION__, frame_type); -+ switch (frame_type) { -+ case BSS_TYPE_BCN: -+ case BSS_TYPE_PROB_RSP: { -+ /* 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 BSS_TYPE_PROB_REQ: { -+ /* Probe Request */ -+ wps = rtw_get_wps_ie(in_ie + _PROBEREQ_IE_OFFSET_ , in_len - _PROBEREQ_IE_OFFSET_ , wps_ie, wps_ielen); -+ break; -+ } -+ default: -+ case BSS_TYPE_UNDEF: -+ 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(const u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen) -+{ -+ uint cnt; -+ const 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 (u8 *)wpsie_ptr; -+ } -+ -+ if (in_len <= 0) -+ return (u8 *)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 (u8 *)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 -+ * If len_content is NULL, only copy one byte. -+ * @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; -+ -+ attr_ptr = rtw_get_wps_attr(wps_ie, wps_ielen, target_attr_id, NULL, &attr_len); -+ -+ if (attr_ptr && attr_len) { -+ if (len_content) { -+ if ((buf_content && (*len_content > (attr_len - 4))) || !buf_content) -+ *len_content = attr_len - 4; -+ } -+ -+ if (len_content && buf_content) { -+ _rtw_memcpy(buf_content, attr_ptr + 4, *len_content); -+ } else if (buf_content) { -+ _rtw_memcpy(buf_content, attr_ptr + 4, 1); -+ } -+ -+ return attr_ptr + 4; -+ } -+ -+ if (len_content) -+ *len_content = 0; -+ -+ return NULL; -+} -+ -+/* OWE */ -+ -+/** -+ * rtw_get_OWE_ie - Search OWE 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 OWE IE is found, OWE IE will be copied to the buf starting from owe_ie -+ * @wps_ielen: If not NULL and OWE IE is found, will set to the length of the entire OWE IE -+ * -+ * Returns: The address of the OWE IE found, or NULL -+ */ -+u8 *rtw_get_owe_ie(const u8 *in_ie, uint in_len, u8 *owe_ie, uint *owe_ielen) -+{ -+ uint cnt; -+ const u8 *oweie_ptr = NULL; -+ u8 eid; -+ -+ if (owe_ielen) -+ *owe_ielen = 0; -+ -+ if (!in_ie) { -+ rtw_warn_on(1); -+ return (u8 *)oweie_ptr; -+ } -+ -+ if (in_len <= 0) -+ return (u8 *)oweie_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_EXTENSION) && (in_ie[cnt + 2] == WLAN_EID_EXT_OWE_DH_PARAM)) { -+ oweie_ptr = in_ie + cnt; -+ -+ if (owe_ie) -+ _rtw_memcpy(owe_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); -+ -+ if (owe_ielen) -+ *owe_ielen = in_ie[cnt + 1] + 2; -+ -+ break; -+ } else -+ cnt += in_ie[cnt + 1] + 2; -+ -+ } -+ -+ return (u8 *)oweie_ptr; -+} -+ -+/* Add extended capabilities element infomation into ext_cap_data of driver */ -+void rtw_add_ext_cap_info(u8 *ext_cap_data, u8 *ext_cap_data_len, u8 cap_info) -+{ -+ u8 byte_offset = cap_info >> 3; -+ u8 bit_offset = cap_info % 8; -+ -+ ext_cap_data[byte_offset] |= BIT(bit_offset); -+ -+ /* Enlarge the length of EXT_CAP_IE */ -+ if (byte_offset + 1 > *ext_cap_data_len) -+ *ext_cap_data_len = byte_offset + 1; -+ -+ #ifdef DBG_EXT_CAP_IE -+ RTW_INFO("%s : cap_info = %u, byte_offset = %u, bit_offset = %u, ext_cap_data_len = %u\n", \ -+ __func__, cap_info, byte_offset, bit_offset, *ext_cap_data_len); -+ #endif -+} -+ -+/* Remvoe extended capabilities element infomation from ext_cap_data of driver */ -+void rtw_remove_ext_cap_info(u8 *ext_cap_data, u8 *ext_cap_data_len, u8 cap_info) -+{ -+ u8 byte_offset = cap_info >> 3; -+ u8 bit_offset = cap_info % 8; -+ u8 i, max_len = 0; -+ -+ ext_cap_data[byte_offset] &= (~BIT(bit_offset)); -+ -+ /* Reduce the length of EXT_CAP_IE */ -+ for (i = 0; i < WLAN_EID_EXT_CAP_MAX_LEN; i++) { -+ if (ext_cap_data[i] != 0x0) -+ max_len = i + 1; -+ } -+ *ext_cap_data_len = max_len; -+ -+ #ifdef DBG_EXT_CAP_IE -+ RTW_INFO("%s : cap_info = %u, byte_offset = %u, bit_offset = %u, ext_cap_data_len = %u\n", \ -+ __func__, cap_info, byte_offset, bit_offset, *ext_cap_data_len); -+ #endif -+} -+ -+/** -+ * rtw_update_ext_cap_ie - add/update/remove the extended capabilities element of frame -+ * -+ * @ext_cap_data: from &(mlme_priv->ext_capab_ie_data) -+ * @ext_cap_data_len: length of ext_cap_data -+ * @ies: address of ies, e.g. pnetwork->IEs -+ * @ies_len: address of length of ies, e.g. &(pnetwork->IELength) -+ * @ies_offset: offset of ies, e.g. _BEACON_IE_OFFSET_ -+ */ -+u8 rtw_update_ext_cap_ie(u8 *ext_cap_data, u8 ext_cap_data_len, u8 *ies, u32 *ies_len, u8 ies_offset) -+{ -+ u8 *extcap_ie; -+ uint extcap_len_field = 0; -+ uint ie_len = 0; -+ -+ if (ext_cap_data_len != 0) { -+ extcap_ie = rtw_get_ie(ies + ies_offset, WLAN_EID_EXT_CAP, &extcap_len_field, *ies_len - ies_offset); -+ -+ if (extcap_ie == NULL) { -+ rtw_set_ie(ies + *ies_len, WLAN_EID_EXT_CAP, ext_cap_data_len, ext_cap_data, &ie_len); -+ *ies_len += ie_len; -+ } else { -+ rtw_ies_update_ie(ies, ies_len, ies_offset, WLAN_EID_EXT_CAP, ext_cap_data, ext_cap_data_len); -+ } -+ } else { -+ rtw_ies_remove_ie(ies, ies_len, ies_offset, WLAN_EID_EXT_CAP, NULL, 0); -+ } -+ -+ return _SUCCESS; -+} -+ -+void rtw_parse_ext_cap_ie(u8 *ext_cap_data, u8 *ext_cap_data_len, u8 *ies, u32 ies_len, u8 ies_offset) -+{ -+ u8 *extcap_ie; -+ uint extcap_len_field = 0; -+ u8 i; -+ -+ extcap_ie = rtw_get_ie(ies + ies_offset, WLAN_EID_EXT_CAP, &extcap_len_field, ies_len - ies_offset); -+ -+ if (extcap_ie != NULL) { -+ extcap_ie = extcap_ie + 2; /* element id and length filed */ -+ if (*ext_cap_data_len == 0) { -+ _rtw_memcpy(ext_cap_data, extcap_ie, extcap_len_field); -+ *ext_cap_data_len = extcap_len_field; -+ } else { -+ for (i = 0; i < extcap_len_field; i++) -+ ext_cap_data[i] |= extcap_ie[i]; -+ } -+ -+ #ifdef DBG_EXT_CAP_IE -+ for (i = 0; i < extcap_len_field; i++) -+ RTW_INFO("%s : Parse extended capabilties[%u] = 0x%x\n", __func__, i, extcap_ie[i]); -+ #endif -+ } -+} -+ -+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; -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ case OUI_REALTEK: -+ if (elen == 8) { // TBTX capable IE length is 8 -+ elems->tbtx_cap = pos; -+ elems->tbtx_cap_len = elen; -+ } -+ break; -+#endif -+ 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; -+ case _EID_RRM_EN_CAP_IE_: -+ elems->rm_en_cap = pos; -+ elems->rm_en_cap_len = elen; -+ break; -+#ifdef CONFIG_RTW_MESH -+ case WLAN_EID_PREQ: -+ elems->preq = pos; -+ elems->preq_len = elen; -+ break; -+ case WLAN_EID_PREP: -+ elems->prep = pos; -+ elems->prep_len = elen; -+ break; -+ case WLAN_EID_PERR: -+ elems->perr = pos; -+ elems->perr_len = elen; -+ break; -+ case WLAN_EID_RANN: -+ elems->rann = pos; -+ elems->rann_len = elen; -+ break; -+#endif -+ 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_RTW_DEBUG -+#ifdef CONFIG_80211N_HT -+void dump_ht_cap_ie_content(void *sel, const u8 *buf, u32 buf_len) -+{ -+ if (buf_len != HT_CAP_IE_LEN) { -+ RTW_PRINT_SEL(sel, "Invalid HT capability IE len:%d != %d\n", buf_len, HT_CAP_IE_LEN); -+ return; -+ } -+ -+ RTW_PRINT_SEL(sel, "cap_info:%02x%02x:%s\n", *(buf), *(buf + 1) -+ , GET_HT_CAP_ELE_CHL_WIDTH(buf) ? " 40MHz" : " 20MHz"); -+ 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, const u8 *ie, u32 ie_len) -+{ -+ const u8 *ht_cap_ie; -+ sint ht_cap_ielen; -+ -+ ht_cap_ie = rtw_get_ie(ie, WLAN_EID_HT_CAP, &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); -+} -+ -+const char *const _ht_sc_offset_str[] = { -+ "SCN", -+ "SCA", -+ "SC-RSVD", -+ "SCB", -+}; -+ -+void dump_ht_op_ie_content(void *sel, const u8 *buf, u32 buf_len) -+{ -+ if (buf_len != HT_OP_IE_LEN) { -+ RTW_PRINT_SEL(sel, "Invalid HT operation IE len:%d != %d\n", buf_len, HT_OP_IE_LEN); -+ return; -+ } -+ -+ RTW_PRINT_SEL(sel, "ch:%u%s %s\n" -+ , GET_HT_OP_ELE_PRI_CHL(buf) -+ , GET_HT_OP_ELE_STA_CHL_WIDTH(buf) ? "" : " 20MHz only" -+ , ht_sc_offset_str(GET_HT_OP_ELE_2ND_CHL_OFFSET(buf)) -+ ); -+} -+ -+void dump_ht_op_ie(void *sel, const u8 *ie, u32 ie_len) -+{ -+ const u8 *ht_op_ie; -+ sint ht_op_ielen; -+ -+ ht_op_ie = rtw_get_ie(ie, WLAN_EID_HT_OPERATION, &ht_op_ielen, ie_len); -+ if (!ie || ht_op_ie != ie) -+ return; -+ -+ dump_ht_op_ie_content(sel, ht_op_ie + 2, ht_op_ielen); -+} -+#endif /* CONFIG_80211N_HT */ -+ -+void dump_wps_ie(void *sel, const u8 *ie, u32 ie_len) -+{ -+ const u8 *pos = ie; -+ u16 id; -+ u16 len; -+ -+ const 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); -+ } -+} -+#endif /* CONFIG_RTW_DEBUG */ -+void dump_ies(void *sel, const u8 *buf, u32 buf_len) -+{ -+#ifdef CONFIG_RTW_DEBUG -+ const u8 *pos = 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); -+ dump_ht_op_ie(sel, pos, len + 2); -+#endif -+#ifdef CONFIG_80211AC_VHT -+ dump_vht_cap_ie(sel, pos, len + 2); -+ dump_vht_op_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 -+#ifdef CONFIG_RTW_MULTI_AP -+ dump_multi_ap_ie(sel, pos, len + 2); -+#endif -+ -+ pos += (2 + len); -+ } -+#endif /* CONFIG_RTW_DEBUG */ -+} -+ -+/** -+ * 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 -+ * @ht: check HT IEs -+ * @vht: check VHT IEs, if true imply ht is true -+ */ -+void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset, u8 ht, u8 vht) -+{ -+ 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 -+ if (ht || vht) { -+ 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; -+ } -+ } -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ if (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 /* CONFIG_80211AC_VHT */ -+ -+ } -+#endif /* CONFIG_80211N_HT */ -+} -+ -+void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset, u8 ht, u8 vht) -+{ -+ rtw_ies_get_chbw(bss->IEs + sizeof(NDIS_802_11_FIXED_IEs) -+ , bss->IELength - sizeof(NDIS_802_11_FIXED_IEs) -+ , ch, bw, offset, ht, vht); -+ -+ 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) -+ rtw_get_offset_by_chbw(*req_ch, *req_bw, req_offset); -+ -+ 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) -+ rtw_get_offset_by_chbw(*req_ch, *req_bw, req_offset); -+ -+ 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; -+ } -+} -+ -+#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 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, const u8 *ie, u32 ie_len) -+{ -+ const u8 *pos = ie; -+ u8 id; -+ u16 len; -+ -+ const 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(const u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen) -+{ -+ uint cnt; -+ const 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 (u8 *)p2p_ie_ptr; -+ } -+ -+ if (in_len <= 0) -+ return (u8 *)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 (u8 *)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 -+ * If len_content is NULL, only copy one byte. -+ * @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; -+ -+ attr_ptr = rtw_get_p2p_attr(p2p_ie, p2p_ielen, target_attr_id, NULL, &attr_len); -+ -+ if (attr_ptr && attr_len) { -+ if (len_content) { -+ if ((buf_content && (*len_content > (attr_len - 3))) || !buf_content) -+ *len_content = attr_len - 3; -+ } -+ -+ if (len_content && buf_content) { -+ _rtw_memcpy(buf_content, attr_ptr + 3, *len_content); -+ } else if (buf_content) { -+ _rtw_memcpy(buf_content, attr_ptr + 3, 1); -+ } -+ -+ return attr_ptr + 3; -+ } -+ -+ if (len_content) -+ *len_content = 0; -+ -+ 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; -+ } -+} -+#endif /* CONFIG_P2P */ -+ -+/** -+ * 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(const u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen) -+{ -+ uint cnt; -+ const 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 (u8 *)wfd_ie_ptr; -+ } -+ -+ if (in_len <= 0) -+ return (u8 *)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 (u8 *)wfd_ie_ptr; -+} -+ -+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; -+} -+ -+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; -+} -+ -+#ifdef CONFIG_WFD -+void dump_wfd_ie(void *sel, const u8 *ie, u32 ie_len) -+{ -+ const u8 *pos = ie; -+ u8 id; -+ u16 len; -+ -+ const 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_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_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_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; -+ } -+} -+#endif /* CONFIG_WFD */ -+ -+#ifdef CONFIG_RTW_MULTI_AP -+void dump_multi_ap_ie(void *sel, const u8 *ie, u32 ie_len) -+{ -+ const u8 *pos = ie; -+ u8 id; -+ u8 len; -+ -+ const u8 *multi_ap_ie; -+ uint multi_ap_ielen; -+ -+ multi_ap_ie = rtw_get_ie_ex(ie, ie_len, WLAN_EID_VENDOR_SPECIFIC, MULTI_AP_OUI, 4, NULL, &multi_ap_ielen); -+ if (multi_ap_ie != ie || multi_ap_ielen == 0) -+ return; -+ -+ pos += 6; -+ while (pos - ie + 2 <= ie_len) { -+ id = *pos; -+ len = *(pos + 1); -+ -+ RTW_PRINT_SEL(sel, "%s ID:%u, LEN:%u%s\n", __func__, id, len -+ , ((pos - ie + 2 + len) <= ie_len) ? "" : "(exceed ie_len)"); -+ RTW_DUMP_SEL(sel, pos + 2, len); -+ -+ pos += (2 + len); -+ } -+} -+ -+/** -+ * rtw_get_multi_ap_ext - Search Multi-AP IE from a series of IEs and return extension subelement value -+ * @ies: Address of IEs to search -+ * @ies_len: Length limit from in_ie -+ * -+ * Returns: The address of the target IE found, or NULL -+ */ -+u8 rtw_get_multi_ap_ie_ext(const u8 *ies, int ies_len) -+{ -+ u8 *ie; -+ uint ielen; -+ u8 val = 0; -+ -+ ie = rtw_get_ie_ex(ies, ies_len, WLAN_EID_VENDOR_SPECIFIC, MULTI_AP_OUI, 4, NULL, &ielen); -+ if (ielen < 9) -+ goto exit; -+ -+ if (ie[6] != MULTI_AP_SUB_ELEM_TYPE) -+ goto exit; -+ -+ val = ie[8]; -+ -+exit: -+ return val; -+} -+ -+u8 *rtw_set_multi_ap_ie_ext(u8 *pbuf, uint *frlen, u8 val) -+{ -+ u8 cont_len = 7; -+ -+ *pbuf++ = WLAN_EID_VENDOR_SPECIFIC; -+ *pbuf++ = cont_len; -+ _rtw_memcpy(pbuf, MULTI_AP_OUI, 4); -+ pbuf += 4; -+ *pbuf++ = MULTI_AP_SUB_ELEM_TYPE; -+ *pbuf++ = 1; /* len */ -+ *pbuf++ = val; -+ -+ if (frlen) -+ *frlen = *frlen + (cont_len + 2); -+ -+ return pbuf; -+} -+#endif /* CONFIG_RTW_MULTI_AP */ -+ -+/* 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; -+} -+ -+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; -+} -+ -+u32 rtw_ht_mcs_set_to_bitmap(u8 *mcs_set, u8 nss) -+{ -+ u8 i; -+ u32 bitmap = 0; -+ -+ for (i = 0; i < nss; i++) -+ bitmap |= mcs_set[i] << (i * 8); -+ -+ RTW_INFO("ht_mcs_set=%02x %02x %02x %02x, nss=%u, bitmap=%08x\n" -+ , mcs_set[0], mcs_set[1], mcs_set[2], mcs_set[3], nss, bitmap); -+ -+ return bitmap; -+} -+ -+/* show MCS rate, unit: 100Kbps */ -+u16 rtw_ht_mcs_rate(u8 bw_40MHz, u8 short_GI, unsigned char *MCS_rate) -+{ -+ u16 max_rate = 0; -+ -+ if (MCS_rate[3]) { -+ if (MCS_rate[3] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 6000 : 5400) : ((short_GI) ? 2889 : 2600); -+ else if (MCS_rate[3] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 5400 : 4860) : ((short_GI) ? 2600 : 2340); -+ else if (MCS_rate[3] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 4800 : 4320) : ((short_GI) ? 2311 : 2080); -+ else if (MCS_rate[3] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 3600 : 3240) : ((short_GI) ? 1733 : 1560); -+ else if (MCS_rate[3] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 2400 : 2160) : ((short_GI) ? 1156 : 1040); -+ else if (MCS_rate[3] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 1800 : 1620) : ((short_GI) ? 867 : 780); -+ else if (MCS_rate[3] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 1200 : 1080) : ((short_GI) ? 578 : 520); -+ else if (MCS_rate[3] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 600 : 540) : ((short_GI) ? 289 : 260); -+ } else 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; -+} -+ -+u8 rtw_ht_cap_get_rx_nss(u8 *ht_cap) -+{ -+ u8 *ht_mcs_set = HT_CAP_ELE_SUP_MCS_SET(ht_cap); -+ -+ return rtw_ht_mcsset_to_nss(ht_mcs_set); -+} -+ -+u8 rtw_ht_cap_get_tx_nss(u8 *ht_cap) -+{ -+ u8 *ht_mcs_set = HT_CAP_ELE_SUP_MCS_SET(ht_cap); -+ -+ if (GET_HT_CAP_ELE_TX_MCS_DEF(ht_cap) && GET_HT_CAP_ELE_TRX_MCS_NEQ(ht_cap)) -+ return GET_HT_CAP_ELE_TX_MAX_SS(ht_cap) + 1; -+ -+ return rtw_ht_cap_get_rx_nss(ht_cap); -+} -+ -+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_PUBLIC_BSSCOEXIST] = "ACT_PUB_BSSCOEXIST", -+ [ACT_PUBLIC_DSE_ENABLE] = "ACT_PUB_DSE_ENABLE", -+ [ACT_PUBLIC_DSE_DEENABLE] = "ACT_PUB_DSE_DEENABLE", -+ [ACT_PUBLIC_DSE_REG_LOCATION] = "ACT_PUB_DSE_REG_LOCATION", -+ [ACT_PUBLIC_EXT_CHL_SWITCH] = "ACT_PUB_EXT_CHL_SWITCH", -+ [ACT_PUBLIC_DSE_MSR_REQ] = "ACT_PUB_DSE_MSR_REQ", -+ [ACT_PUBLIC_DSE_MSR_RPRT] = "ACT_PUB_DSE_MSR_RPRT", -+ [ACT_PUBLIC_MP] = "ACT_PUB_MP", -+ [ACT_PUBLIC_DSE_PWR_CONSTRAINT] = "ACT_PUB_DSE_PWR_CONSTRAINT", -+ [ACT_PUBLIC_VENDOR] = "ACT_PUB_VENDOR", -+ [ACT_PUBLIC_GAS_INITIAL_REQ] = "ACT_PUB_GAS_INITIAL_REQ", -+ [ACT_PUBLIC_GAS_INITIAL_RSP] = "ACT_PUB_GAS_INITIAL_RSP", -+ [ACT_PUBLIC_GAS_COMEBACK_REQ] = "ACT_PUB_GAS_COMEBACK_REQ", -+ [ACT_PUBLIC_GAS_COMEBACK_RSP] = "ACT_PUB_GAS_COMEBACK_RSP", -+ [ACT_PUBLIC_TDLS_DISCOVERY_RSP] = "ACT_PUB_TDLS_DISCOVERY_RSP", -+ [ACT_PUBLIC_LOCATION_TRACK] = "ACT_PUB_LOCATION_TRACK", -+ [ACT_PUBLIC_QAB_REQ] = "ACT_PUB_QAB_REQ", -+ [ACT_PUBLIC_QAB_RSP] = "ACT_PUB_QAB_RSP", -+ [ACT_PUBLIC_QMF_POLICY] = "ACT_PUB_QMF_POLICY", -+ [ACT_PUBLIC_QMF_POLICY_CHANGE] = "ACT_PUB_QMF_POLICY_CHANGE", -+ [ACT_PUBLIC_QLOAD_REQ] = "ACT_PUB_QLOAD_REQ", -+ [ACT_PUBLIC_QLOAD_REPORT] = "ACT_PUB_QLOAD_REPORT", -+ [ACT_PUBLIC_HCCA_TXOP_ADV] = "ACT_PUB_HCCA_TXOP_ADV", -+ [ACT_PUBLIC_HCCA_TXOP_RSP] = "ACT_PUB_HCCA_TXOP_RSP", -+ [ACT_PUBLIC_PUBLIC_KEY] = "ACT_PUB_PUBLIC_KEY", -+ [ACT_PUBLIC_CH_AVAILABILITY_QUERY] = "ACT_PUB_CH_AVAILABILITY_QUERY", -+ [ACT_PUBLIC_CH_SCHEDULE_MGMT] = "ACT_PUB_CH_SCHEDULE_MGMT", -+ [ACT_PUBLIC_CONTACT_VERI_SIGNAL] = "ACT_PUB_CONTACT_VERI_SIGNAL", -+ [ACT_PUBLIC_GDD_ENABLE_REQ] = "ACT_PUB_GDD_ENABLE_REQ", -+ [ACT_PUBLIC_GDD_ENABLE_RSP] = "ACT_PUB_GDD_ENABLE_RSP", -+ [ACT_PUBLIC_NETWORK_CH_CONTROL] = "ACT_PUB_NETWORK_CH_CONTROL", -+ [ACT_PUBLIC_WHITE_SPACE_MAP_ANN] = "ACT_PUB_WHITE_SPACE_MAP_ANN", -+ [ACT_PUBLIC_FTM_REQ] = "ACT_PUB_FTM_REQ", -+ [ACT_PUBLIC_FTM] = "ACT_PUB_FTM", -+ [ACT_PUBLIC_MAX] = "ACT_PUB_RSVD", -+}; -+ -+const char *action_public_str(u8 action) -+{ -+ action = (action >= ACT_PUBLIC_MAX) ? ACT_PUBLIC_MAX : action; -+ return _action_public_str[action]; -+} -+ -+#if 0 -+/*tmp for sta mode, root cause have to wait supplicant's update.*/ -+void rtw_set_spp_amsdu_mode(u8 mode, u8 *rsn_ie, int rsn_ie_len) -+{ -+ struct rsne_info info; -+ int i, ret = _SUCCESS; -+ u8 spp_req_cap = 0; -+ -+ ret = rtw_rsne_info_parse(rsn_ie, rsn_ie_len, &info); -+ if (ret != _SUCCESS) -+ return; -+ -+ if (mode == RTW_AMSDU_MODE_NON_SPP ) { -+ spp_req_cap = 0; /* SPP_CAP=0, SPP_REQ=0 */ -+ } else if (mode == RTW_AMSDU_MODE_SPP) { -+ spp_req_cap = SPP_CAP | SPP_REQ; -+ } else if (mode == RTW_AMSDU_MODE_ALL_DROP) { -+ spp_req_cap = SPP_REQ; /* SPP_CAP=0, SPP_REQ=1 */ -+ } else { -+ RTW_INFO("%s unexpected mode = %d, please check the config\n", __func__, mode); -+ return; -+ } -+ -+ SET_RSN_CAP_SPP(info.cap, spp_req_cap); -+ RTW_INFO("%s set spp opt = %d\n", __func__, GET_RSN_CAP_SPP_OPT(info.cap)); -+} -+#endif -+ -+/* Returns: -+ _TRUE -- Disable AMSDU -+ _FALSE -- Enable AMSDU -+*/ -+u8 rtw_check_amsdu_disable(u8 mode, u8 spp_opt) -+{ -+ u8 ret = _FALSE; -+ -+ /* pp amsdu: peer's required has to be 0, or disable */ -+ if ((mode == RTW_AMSDU_MODE_NON_SPP) && (spp_opt & SPP_REQ)) -+ ret = _TRUE; -+ /* spp amsdu: peer's cap has to be 1, or disable */ -+ else if ((mode == RTW_AMSDU_MODE_SPP) && (!(spp_opt & SPP_CAP))) -+ ret = _TRUE; -+ /* mode = all drop */ -+ else if (mode == RTW_AMSDU_MODE_ALL_DROP) -+ ret = _TRUE; -+ else -+ ret = _FALSE; -+ return ret; -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_io.c b/drivers/net/wireless/rtl8821cs/core/rtw_io.c -new file mode 100644 -index 000000000..c5e2fa080 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_io.c -@@ -0,0 +1,958 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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. -+ -+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(CONFIG_SDIO_HCI) || defined(CONFIG_PLATFORM_RTL8197D) -+ #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__); -+ -+ if (ret != _SUCCESS) -+ pxmitbuf->sctx = NULL; -+ } -+ -+ 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 -+#define RTW_IO_SNIFF_TYPE_RANGE 0 /* specific address range is accessed */ -+#define RTW_IO_SNIFF_TYPE_VALUE 1 /* value match for sniffed range */ -+ -+struct rtw_io_sniff_ent { -+ u8 chip; -+ u8 hci; -+ u32 addr; -+ u8 type; -+ union { -+ u32 end_addr; -+ struct { -+ u32 mask; -+ u32 val; -+ bool equal; -+ } vm; /* value match */ -+ } u; -+ bool trace; -+ char *tag; -+ bool (*assert_protsel)(_adapter *adapter, u32 addr, u8 len); -+}; -+ -+#define RTW_IO_SNIFF_RANGE_ENT(_chip, _hci, _addr, _end_addr, _trace, _tag) \ -+ {.chip = _chip, .hci = _hci, .addr = _addr, .u.end_addr = _end_addr, .trace = _trace, .tag = _tag, .type = RTW_IO_SNIFF_TYPE_RANGE,} -+ -+#define RTW_IO_SNIFF_RANGE_PROT_ENT(_chip, _hci, _addr, _end_addr, _assert_protsel, _tag) \ -+ {.chip = _chip, .hci = _hci, .addr = _addr, .u.end_addr = _end_addr, .trace = 1, .assert_protsel = _assert_protsel, .tag = _tag, .type = RTW_IO_SNIFF_TYPE_RANGE,} -+ -+#define RTW_IO_SNIFF_VALUE_ENT(_chip, _hci, _addr, _mask, _val, _equal, _trace, _tag) \ -+ {.chip = _chip, .hci = _hci, .addr = _addr, .u.vm.mask = _mask, .u.vm.val = _val, .u.vm.equal = _equal, .trace = _trace, .tag = _tag, .type = RTW_IO_SNIFF_TYPE_VALUE,} -+ -+/* part or all sniffed range is enabled (not all 0) */ -+#define RTW_IO_SNIFF_EN_ENT(_chip, _hci, _addr, _mask, _trace, _tag) \ -+ {.chip = _chip, .hci = _hci, .addr = _addr, .u.vm.mask = _mask, .u.vm.val = 0, .u.vm.equal = 0, .trace = _trace, .tag = _tag, .type = RTW_IO_SNIFF_TYPE_VALUE,} -+ -+/* part or all sniffed range is disabled (not all 1) */ -+#define RTW_IO_SNIFF_DIS_ENT(_chip, _hci, _addr, _mask, _trace, _tag) \ -+ {.chip = _chip, .hci = _hci, .addr = _addr, .u.vm.mask = _mask, .u.vm.val = 0xFFFFFFFF, .u.vm.equal = 0, .trace = _trace, .tag = _tag, .type = RTW_IO_SNIFF_TYPE_VALUE,} -+ -+const struct rtw_io_sniff_ent read_sniff[] = { -+#ifdef DBG_IO_HCI_EN_CHK -+ RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_SDIO, 0x02, 0x1FC, 1, "SDIO 0x02[8:2] not all 0"), -+ RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_USB, 0x02, 0x1E0, 1, "USB 0x02[8:5] not all 0"), -+ RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_PCIE, 0x02, 0x01C, 1, "PCI 0x02[4:2] not all 0"), -+#endif -+#ifdef DBG_IO_SNIFF_EXAMPLE -+ RTW_IO_SNIFF_RANGE_ENT(MAX_CHIP_TYPE, 0, 0x522, 0x522, 0, "read TXPAUSE"), -+ RTW_IO_SNIFF_DIS_ENT(MAX_CHIP_TYPE, 0, 0x02, 0x3, 0, "0x02[1:0] not all 1"), -+#endif -+#ifdef DBG_IO_PROT_SEL -+ RTW_IO_SNIFF_RANGE_PROT_ENT(MAX_CHIP_TYPE, 0, 0x1501, 0x1513, rtw_assert_protsel_port, "protsel port"), -+ RTW_IO_SNIFF_RANGE_PROT_ENT(MAX_CHIP_TYPE, 0, 0x153a, 0x153b, rtw_assert_protsel_atimdtim, "protsel atimdtim"), -+#endif -+}; -+ -+const int read_sniff_num = sizeof(read_sniff) / sizeof(struct rtw_io_sniff_ent); -+ -+const struct rtw_io_sniff_ent write_sniff[] = { -+#ifdef DBG_IO_HCI_EN_CHK -+ RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_SDIO, 0x02, 0x1FC, 1, "SDIO 0x02[8:2] not all 0"), -+ RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_USB, 0x02, 0x1E0, 1, "USB 0x02[8:5] not all 0"), -+ RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_PCIE, 0x02, 0x01C, 1, "PCI 0x02[4:2] not all 0"), -+#endif -+#ifdef DBG_IO_SIFS_SETTING -+ RTW_IO_SNIFF_RANGE_ENT(MAX_CHIP_TYPE, 0, 0x428, 0x429, 0, "SIFS"), -+ RTW_IO_SNIFF_RANGE_ENT(MAX_CHIP_TYPE, 0, 0x514, 0x517, 0, "SIFS"), -+ RTW_IO_SNIFF_RANGE_ENT(MAX_CHIP_TYPE, 0, 0x63a, 0x63b, 0, "SIFS"), -+ RTW_IO_SNIFF_RANGE_ENT(MAX_CHIP_TYPE, 0, 0x63c, 0x63f, 0, "SIFS"), -+#endif -+#ifdef DBG_IO_8822C_1TX_PATH_EN -+ RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x1a04, 0xc0000000, 0x02, 1, 0, "write tx_path_en_cck A enabled"), -+ RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x1a04, 0xc0000000, 0x01, 1, 0, "write tx_path_en_cck B enabled"), -+ RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x1a04, 0xc0000000, 0x03, 1, 1, "write tx_path_en_cck AB enabled"), -+ RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x03, 0x01, 1, 0, "write tx_path_en_ofdm_1sts A enabled"), -+ RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x03, 0x02, 1, 0, "write tx_path_en_ofdm_1sts B enabled"), -+ RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x03, 0x03, 1, 1, "write tx_path_en_ofdm_1sts AB enabled"), -+ RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x30, 0x01, 1, 0, "write tx_path_en_ofdm_2sts A enabled"), -+ RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x30, 0x02, 1, 0, "write tx_path_en_ofdm_2sts B enabled"), -+ RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x30, 0x03, 1, 1, "write tx_path_en_ofdm_2sts AB enabled"), -+#endif -+#ifdef DBG_IO_SNIFF_EXAMPLE -+ RTW_IO_SNIFF_RANGE_ENT(MAX_CHIP_TYPE, 0, 0x522, 0x522, 0, "write TXPAUSE"), -+ RTW_IO_SNIFF_DIS_ENT(MAX_CHIP_TYPE, 0, 0x02, 0x3, 0, "0x02[1:0] not all 1"), -+#endif -+}; -+ -+const int write_sniff_num = sizeof(write_sniff) / sizeof(struct rtw_io_sniff_ent); -+ -+static bool match_io_sniff_ranges(_adapter *adapter -+ , const struct rtw_io_sniff_ent *sniff, int i, u32 addr, u16 len) -+{ -+ -+ /* check if IO range after sniff end address */ -+ if (addr > sniff->u.end_addr) -+ return 0; -+ -+ if (sniff->assert_protsel && -+ sniff->assert_protsel(adapter, addr, len)) -+ return 0; -+ -+ return 1; -+} -+ -+static bool match_io_sniff_value(_adapter *adapter -+ , const struct rtw_io_sniff_ent *sniff, int i, u32 addr, u8 len, u32 val) -+{ -+ u8 sniff_len; -+ s8 mask_shift; -+ u32 mask; -+ s8 value_shift; -+ u32 value; -+ bool ret = 0; -+ -+ /* check if IO range after sniff end address */ -+ sniff_len = 4; -+ while (!(sniff->u.vm.mask & (0xFF << ((sniff_len - 1) * 8)))) { -+ sniff_len--; -+ if (sniff_len == 0) -+ goto exit; -+ } -+ if (sniff->addr + sniff_len <= addr) -+ goto exit; -+ -+ /* align to IO addr */ -+ mask_shift = (sniff->addr - addr) * 8; -+ value_shift = mask_shift + bitshift(sniff->u.vm.mask); -+ if (mask_shift > 0) -+ mask = sniff->u.vm.mask << mask_shift; -+ else if (mask_shift < 0) -+ mask = sniff->u.vm.mask >> -mask_shift; -+ else -+ mask = sniff->u.vm.mask; -+ -+ if (value_shift > 0) -+ value = sniff->u.vm.val << value_shift; -+ else if (mask_shift < 0) -+ value = sniff->u.vm.val >> -value_shift; -+ else -+ value = sniff->u.vm.val; -+ -+ if ((sniff->u.vm.equal && (mask & val) == (mask & value)) -+ || (!sniff->u.vm.equal && (mask & val) != (mask & value)) -+ ) { -+ ret = 1; -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" addr:0x%x len:%u val:0x%x (i:%d sniff_len:%u m_shift:%d mask:0x%x v_shifd:%d value:0x%x equal:%d)\n" -+ , FUNC_ADPT_ARG(adapter), addr, len, val, i, sniff_len, mask_shift, mask, value_shift, value, sniff->u.vm.equal); -+ } -+ -+exit: -+ return ret; -+} -+ -+static bool match_io_sniff(_adapter *adapter -+ , const struct rtw_io_sniff_ent *sniff, int i, u32 addr, u8 len, u32 val) -+{ -+ bool ret = 0; -+ -+ if (sniff->chip != MAX_CHIP_TYPE -+ && sniff->chip != rtw_get_chip_type(adapter)) -+ goto exit; -+ if (sniff->hci -+ && !(sniff->hci & rtw_get_intf_type(adapter))) -+ goto exit; -+ if (sniff->addr >= addr + len) /* IO range below sniff start address */ -+ goto exit; -+ -+ switch (sniff->type) { -+ case RTW_IO_SNIFF_TYPE_RANGE: -+ ret = match_io_sniff_ranges(adapter, sniff, i, addr, len); -+ break; -+ case RTW_IO_SNIFF_TYPE_VALUE: -+ if (len == 1 || len == 2 || len == 4) -+ ret = match_io_sniff_value(adapter, sniff, i, addr, len, val); -+ break; -+ default: -+ rtw_warn_on(1); -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+u32 match_read_sniff(_adapter *adapter, u32 addr, u16 len, u32 val) -+{ -+ int i; -+ bool trace = 0; -+ u32 match = 0; -+ -+ for (i = 0; i < read_sniff_num; i++) { -+ if (match_io_sniff(adapter, &read_sniff[i], i, addr, len, val)) { -+ match++; -+ trace |= read_sniff[i].trace; -+ if (read_sniff[i].tag) -+ RTW_INFO("DBG_IO TAG %s\n", read_sniff[i].tag); -+ } -+ } -+ -+ rtw_warn_on(trace); -+ -+ return match; -+} -+ -+u32 match_write_sniff(_adapter *adapter, u32 addr, u16 len, u32 val) -+{ -+ int i; -+ bool trace = 0; -+ u32 match = 0; -+ -+ for (i = 0; i < write_sniff_num; i++) { -+ if (match_io_sniff(adapter, &write_sniff[i], i, addr, len, val)) { -+ match++; -+ trace |= write_sniff[i].trace; -+ if (write_sniff[i].tag) -+ RTW_INFO("DBG_IO TAG %s\n", write_sniff[i].tag); -+ } -+ } -+ -+ rtw_warn_on(trace); -+ -+ return match; -+} -+ -+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(_adapter *adapter, 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(_adapter *adapter, 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; -+} -+ -+void dbg_rtw_reg_read_monitor(_adapter *adapter, u32 addr, u32 len, u32 val, const char *caller, const int line) -+{ -+ if (match_read_sniff(adapter, addr, len, val)) { -+ switch (len) { -+ case 1: -+ RTW_INFO("DBG_IO %s:%d read8(0x%04x) return 0x%02x\n" -+ , caller, line, addr, val); -+ break; -+ case 2: -+ RTW_INFO("DBG_IO %s:%d read16(0x%04x) return 0x%04x\n" -+ , caller, line, addr, val); -+ break; -+ case 4: -+ RTW_INFO("DBG_IO %s:%d read32(0x%04x) return 0x%08x\n" -+ , caller, line, addr, val); -+ break; -+ default: -+ RTW_INFO("DBG_IO %s:%d readN(0x%04x, %u)\n" -+ , caller, line, addr, len); -+ } -+ } -+} -+ -+void dbg_rtw_reg_write_monitor(_adapter *adapter, u32 addr, u32 len, u32 val, const char *caller, const int line) -+{ -+ if (match_write_sniff(adapter, addr, len, val)) { -+ switch (len) { -+ case 1: -+ RTW_INFO("DBG_IO %s:%d write8(0x%04x, 0x%02x)\n" -+ , caller, line, addr, val); -+ break; -+ case 2: -+ RTW_INFO("DBG_IO %s:%d write16(0x%04x, 0x%04x)\n" -+ , caller, line, addr, val); -+ break; -+ case 4: -+ RTW_INFO("DBG_IO %s:%d write32(0x%04x, 0x%08x)\n" -+ , caller, line, addr, val); -+ break; -+ default: -+ RTW_INFO("DBG_IO %s:%d rtw_writeN(0x%04x, %u)\n" -+ , caller, line, addr, len); -+ } -+ } -+} -+ -+u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u8 val = _rtw_read8(adapter, addr); -+ -+ if (match_read_sniff(adapter, addr, 1, val)) { -+ 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(adapter, addr, 2, val)) { -+ 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(adapter, addr, 4, val)) { -+ 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(adapter, addr, 1, val)) { -+ 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(adapter, addr, 2, val)) { -+ 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(adapter, addr, 4, val)) { -+ 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(adapter, addr, length, 0)) { -+ 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(adapter, addr, 1, val)) { -+ 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(adapter, addr, 1, val)) { -+ 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(adapter, addr, 2, val)) { -+ 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(adapter, addr, 4, val)) { -+ 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(adapter, addr, 1, val)) { -+ 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(adapter, addr, 2, val)) { -+ 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(adapter, addr, 4, val)) { -+ 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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_ioctl_query.c b/drivers/net/wireless/rtl8821cs/core/rtw_ioctl_query.c -new file mode 100644 -index 000000000..939213843 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_ioctl_query.c -@@ -0,0 +1,19 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_QUERY_C_ -+ -+#include -+ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_ioctl_set.c b/drivers/net/wireless/rtl8821cs/core/rtw_ioctl_set.c -new file mode 100644 -index 000000000..96126ebbe ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_ioctl_set.c -@@ -0,0 +1,938 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+ -+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) -+{ -+#ifdef CONFIG_VALIDATE_SSID -+ u8 i; -+#endif -+ 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); -+ struct sitesurvey_parm parm; -+ _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, WIFI_UNDER_LINKING); -+ -+ pmlmepriv->pscanned = plist; -+ -+ pmlmepriv->to_join = _TRUE; -+ -+ rtw_init_sitesurvey_parm(padapter, &parm); -+ _rtw_memcpy(&parm.ssid[0], &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ parm.ssid_num = 1; -+ -+ if (pmlmepriv->assoc_ch) { -+ parm.ch_num = 1; -+ parm.ch[0].hw_value = pmlmepriv->assoc_ch; -+ parm.ch[0].flags = 0; -+ } -+ -+ if (_rtw_queue_empty(queue) == _TRUE) { -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ _clr_fwstate_(pmlmepriv, WIFI_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 -+ ) { -+ u8 ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); -+ -+ if ((ssc_chk == SS_ALLOW) || (ssc_chk == SS_DENY_BUSY_TRAFFIC) ){ -+ /* submit site_survey_cmd */ -+ ret = rtw_sitesurvey_cmd(padapter, &parm); -+ if (_SUCCESS != ret) -+ pmlmepriv->to_join = _FALSE; -+ } else { -+ /*if (ssc_chk == SS_DENY_BUDDY_UNDER_SURVEY)*/ -+ pmlmepriv->to_join = _FALSE; -+ ret = _FAIL; -+ } -+ } 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) { -+ u32 join_timeout = MAX_JOIN_TIMEOUT; -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+ struct rf_ctl_t *rfctl; -+ rfctl = adapter_to_rfctl(padapter); -+ if (rfctl->ap_csa_en == CSA_STA_JOINBSS) -+ join_timeout += (rfctl->ap_csa_switch_cnt * 100); -+#endif -+ -+ pmlmepriv->to_join = _FALSE; -+ _set_timer(&pmlmepriv->assoc_timer, join_timeout); -+ } else { -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { -+ #ifdef CONFIG_AP_MODE -+ /* 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; -+ #endif /* CONFIG_AP_MODE */ -+ } else { -+ /* can't associate ; reset under-linking */ -+ _clr_fwstate_(pmlmepriv, WIFI_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 -+ ) { -+ u8 ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); -+ -+ if ((ssc_chk == SS_ALLOW) || (ssc_chk == SS_DENY_BUSY_TRAFFIC)){ -+ /* RTW_INFO(("rtw_do_join() when no desired bss in scanning queue\n"); */ -+ ret = rtw_sitesurvey_cmd(padapter, &parm); -+ if (_SUCCESS != ret) -+ pmlmepriv->to_join = _FALSE; -+ } else { -+ /*if (ssc_chk == SS_DENY_BUDDY_UNDER_SURVEY) { -+ } else {*/ -+ ret = _FAIL; -+ pmlmepriv->to_join = _FALSE; -+ } -+ } else { -+ ret = _FAIL; -+ pmlmepriv->to_join = _FALSE; -+ } -+ } -+ -+ } -+ -+ } -+ -+exit: -+ -+ return ret; -+} -+ -+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, WIFI_UNDER_SURVEY) == _TRUE) -+ goto handle_tkip_countermeasure; -+ else if (check_fwstate(pmlmepriv, WIFI_UNDER_LINKING) == _TRUE) -+ goto release_mlme_lock; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE | 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, 0); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ -+ rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); -+ -+ 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_ch = 0; -+ pmlmepriv->assoc_by_bssid = _TRUE; -+ -+ if (check_fwstate(pmlmepriv, WIFI_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; -+ -+ 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, WIFI_UNDER_SURVEY) == _TRUE) -+ goto handle_tkip_countermeasure; -+ else if (check_fwstate(pmlmepriv, WIFI_UNDER_LINKING) == _TRUE) -+ goto release_mlme_lock; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE | 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, 0); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ -+ rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); -+ -+ 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, 0); -+#endif -+ } else { -+ -+ rtw_disassoc_cmd(padapter, 0, 0); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ -+ rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); -+ -+ 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_ch = 0; -+ pmlmepriv->assoc_by_bssid = _FALSE; -+ -+ if (check_fwstate(pmlmepriv, WIFI_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, u16 ch) -+{ -+ _irqL irqL; -+ 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) { -+ 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, WIFI_UNDER_SURVEY) == _TRUE) -+ goto handle_tkip_countermeasure; -+ else if (check_fwstate(pmlmepriv, WIFI_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; -+ -+ pmlmepriv->assoc_ch = ch; -+ -+ if (check_fwstate(pmlmepriv, WIFI_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, u8 flags) -+{ -+ _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); -+ u8 ap2sta_mode = _FALSE; -+ u8 ret = _TRUE; -+ u8 is_linked = _FALSE, is_adhoc_master = _FALSE; -+ -+ 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 -+ || *pold_state == Ndis802_11_mesh -+ ) { -+ /* change to other mode from Ndis802_11APMode/Ndis802_11_mesh */ -+ cur_network->join_res = -1; -+ ap2sta_mode = _TRUE; -+#ifdef CONFIG_NATIVEAP_MLME -+ stop_ap_mode(padapter); -+#endif -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ is_linked = check_fwstate(pmlmepriv, WIFI_ASOC_STATE); -+ is_adhoc_master = check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ -+ /* flags = 0, means enqueue cmd and no wait */ -+ if (flags != 0) -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if ((is_linked == _TRUE) || (*pold_state == Ndis802_11IBSS)) -+ rtw_disassoc_cmd(padapter, 0, flags); -+ -+ if ((is_linked == _TRUE) || -+ (is_adhoc_master == _TRUE)) -+ rtw_free_assoc_resources_cmd(padapter, _TRUE, flags); -+ -+ if ((*pold_state == Ndis802_11Infrastructure) || (*pold_state == Ndis802_11IBSS)) { -+ if (is_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*/ -+ } -+ } -+ -+ /* flags = 0, means enqueue cmd and no wait */ -+ if (flags != 0) -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ *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); -+ -+ if (ap2sta_mode) -+ rtw_init_bcmc_stainfo(padapter); -+ break; -+ -+ case Ndis802_11APMode: -+ set_fwstate(pmlmepriv, WIFI_AP_STATE); -+#ifdef CONFIG_NATIVEAP_MLME -+ start_ap_mode(padapter); -+ /* rtw_indicate_connect(padapter); */ -+#endif -+ -+ break; -+ -+#ifdef CONFIG_RTW_MESH -+ case Ndis802_11_mesh: -+ set_fwstate(pmlmepriv, WIFI_MESH_STATE); -+ start_ap_mode(padapter); -+ break; -+#endif -+ -+ case Ndis802_11AutoUnknown: -+ case Ndis802_11InfrastructureMax: -+ break; -+#ifdef CONFIG_WIFI_MONITOR -+ case Ndis802_11Monitor: -+ set_fwstate(pmlmepriv, WIFI_MONITOR_STATE); -+ break; -+#endif /* CONFIG_WIFI_MONITOR */ -+ default: -+ ret = _FALSE; -+ rtw_warn_on(1); -+ } -+ -+ /* SecClearAllKeys(adapter); */ -+ -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ } -+ -+ return ret; -+} -+ -+ -+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, WIFI_ASOC_STATE) == _TRUE) { -+ -+ rtw_disassoc_cmd(padapter, 0, 0); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ /* modify for CONFIG_IEEE80211W, none 11w can use it */ -+ rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); -+ 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, struct sitesurvey_parm *pparm) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 res = _TRUE; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ res = rtw_sitesurvey_cmd(padapter, pparm); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ return res; -+} -+ -+#else -+u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, struct sitesurvey_parm *pparm) -+{ -+ _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, WIFI_UNDER_SURVEY | WIFI_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, pparm); -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ } -+exit: -+ -+ -+ return res; -+} -+#endif -+ -+#ifdef CONFIG_RTW_ACS -+u8 rtw_set_acs_sitesurvey(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct sitesurvey_parm parm; -+ u8 uch; -+ u8 ch_num = 0; -+ int i; -+ BAND_TYPE band; -+ u8 (*center_chs_num)(u8) = NULL; -+ u8 (*center_chs)(u8, u8) = NULL; -+ u8 ret = _FAIL; -+ -+ if (!rtw_mi_get_ch_setting_union(adapter, &uch, NULL, NULL)) -+ goto exit; -+ -+ _rtw_memset(&parm, 0, sizeof(struct sitesurvey_parm)); -+ parm.scan_mode = SCAN_PASSIVE; -+ parm.bw = CHANNEL_WIDTH_20; -+ parm.acs = 1; -+ -+ for (band = BAND_ON_2_4G; band < BAND_MAX; band++) { -+ if (band == BAND_ON_2_4G) { -+ center_chs_num = center_chs_2g_num; -+ center_chs = center_chs_2g; -+ } else -+ #ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (band == BAND_ON_5G) { -+ center_chs_num = center_chs_5g_num; -+ center_chs = center_chs_5g; -+ } else -+ #endif -+ { -+ center_chs_num = NULL; -+ center_chs = NULL; -+ } -+ -+ if (!center_chs_num || !center_chs) -+ continue; -+ -+ if (rfctl->ch_sel_within_same_band) { -+ if (rtw_is_2g_ch(uch) && band != BAND_ON_2_4G) -+ continue; -+ #ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (rtw_is_5g_ch(uch) && band != BAND_ON_5G) -+ continue; -+ #endif -+ } -+ -+ ch_num = center_chs_num(CHANNEL_WIDTH_20); -+ for (i = 0; i < ch_num && parm.ch_num < RTW_CHANNEL_SCAN_AMOUNT; i++) { -+ parm.ch[parm.ch_num].hw_value = center_chs(CHANNEL_WIDTH_20, i); -+ parm.ch[parm.ch_num].flags = RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ parm.ch_num++; -+ } -+ } -+ -+ ret = rtw_set_802_11_bssid_list_scan(adapter, &parm); -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_RTW_ACS */ -+ -+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; -+ -+} -+ -+/* -+* rtw_get_cur_max_rate - -+* @adapter: pointer to _adapter structure -+* -+* Return 0 or 100Kbps -+*/ -+u16 rtw_get_cur_max_rate(_adapter *adapter) -+{ -+ int j; -+ int i = 0; -+ u16 rate = 0, max_rate = 0; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ int sta_bssrate_len = 0; -+ unsigned char sta_bssrate[NumRates]; -+ struct sta_info *psta = NULL; -+ u8 short_GI = 0; -+ -+#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, WIFI_ASOC_STATE) != _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, rtw_get_tx_bw_mode(adapter, psta)); -+ -+#ifdef CONFIG_80211N_HT -+ if (is_supported_ht(psta->wireless_mode)) { -+ max_rate = rtw_ht_mcs_rate((psta->cmn.bw_mode == CHANNEL_WIDTH_40) ? 1 : 0 -+ , short_GI -+ , psta->htpriv.ht_cap.supp_mcs_set -+ ); -+ } -+#ifdef CONFIG_80211AC_VHT -+ else if (is_supported_vht(psta->wireless_mode)) -+ max_rate = ((rtw_vht_mcs_to_data_rate(psta->cmn.bw_mode, short_GI, pmlmepriv->vhtpriv.vht_highest_rate) + 1) >> 1) * 10; -+#endif /* CONFIG_80211AC_VHT */ -+ else -+#endif /* CONFIG_80211N_HT */ -+ { -+ /*station mode show :station && ap support rate; softap :show ap support rate*/ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ get_rate_set(adapter, sta_bssrate, &sta_bssrate_len);/*get sta rate and length*/ -+ -+ -+ while ((pcur_bss->SupportedRates[i] != 0) && (pcur_bss->SupportedRates[i] != 0xFF)) { -+ rate = pcur_bss->SupportedRates[i] & 0x7F;/*AP support rates*/ -+ /*RTW_INFO("%s rate=%02X \n", __func__, rate);*/ -+ -+ /*check STA support rate or not */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ for (j = 0; j < sta_bssrate_len; j++) { -+ /* Avoid the proprietary data rate (22Mbps) of Handlink WSG-4000 AP */ -+ if ((rate | IEEE80211_BASIC_RATE_MASK) -+ == (sta_bssrate[j] | IEEE80211_BASIC_RATE_MASK)) { -+ if (rate > max_rate) { -+ max_rate = rate; -+ } -+ break; -+ } -+ } -+ } else { -+ -+ 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, u8 chplan_6g, enum rtw_regd_inr inr) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ -+ if (!REGSTY_REGD_SRC_FROM_OS(regsty)) -+ return rtw_set_chplan_cmd(adapter, RTW_CMDF_WAIT_ACK, channel_plan, chplan_6g, inr); -+ RTW_WARN("%s(): not applied\n", __func__); -+ return _SUCCESS; -+} -+ -+/* -+* 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, enum rtw_regd_inr inr) -+{ -+#ifdef CONFIG_RTW_IOCTL_SET_COUNTRY -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ -+ if (!REGSTY_REGD_SRC_FROM_OS(regsty)) -+ return rtw_set_country_cmd(adapter, RTW_CMDF_WAIT_ACK, country_code, inr); -+#endif -+ RTW_WARN("%s(): not applied\n", __func__); -+ return _SUCCESS; -+} -+ -+/* -+* 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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_iol.c b/drivers/net/wireless/rtl8821cs/core/rtw_iol.c -new file mode 100644 -index 000000000..714a3f44e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_iol.c -@@ -0,0 +1,388 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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, 0); -+ 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(xmit_frame->padapter, addr, 1, value)) { -+ 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(xmit_frame->padapter, addr, 2, value)) { -+ 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(xmit_frame->padapter, addr, 4, value)) { -+ 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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_mbo.c b/drivers/net/wireless/rtl8821cs/core/rtw_mbo.c -new file mode 100755 -index 000000000..20da58fca ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_mbo.c -@@ -0,0 +1,803 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#ifdef CONFIG_RTW_MBO -+ -+#ifndef RTW_MBO_DBG -+#define RTW_MBO_DBG 0 -+#endif -+#if RTW_MBO_DBG -+ #define RTW_MBO_INFO(fmt, arg...) \ -+ RTW_INFO(fmt, arg) -+ #define RTW_MBO_DUMP(str, data, len) \ -+ RTW_INFO_DUMP(str, data, len) -+#else -+ #define RTW_MBO_INFO(fmt, arg...) do {} while (0) -+ #define RTW_MBO_DUMP(str, data, len) do {} while (0) -+#endif -+ -+/* Cellular Data Connectivity field -+ * 1 : Cellular data connection available -+ * 2 : Cellular data connection not available -+ * 3 : Not Cellular data capable -+ * otherwise : Reserved -+*/ -+int rtw_mbo_cell_data_conn = 2; -+module_param(rtw_mbo_cell_data_conn, int, 0644); -+ -+static u8 wfa_mbo_oui[] = {0x50, 0x6F, 0x9A, 0x16}; -+ -+#define rtw_mbo_get_oui(p) ((u8 *)(p) + 2) -+ -+#define rtw_mbo_get_attr_id(p) ((u8 *)(p)) -+ -+#define rtw_mbo_get_disallow_res(p) ((u8 *)(p) + 3) -+ -+#define rtw_mbo_set_1byte_ie(p, v, l) \ -+ rtw_set_fixed_ie((p), 1, (v), (l)) -+ -+#define rtw_mbo_set_4byte_ie(p, v, l) \ -+ rtw_set_fixed_ie((p), 4, (v), (l)) -+ -+#define rtw_mbo_set_nbyte_ie(p, sz, v, l) \ -+ rtw_set_fixed_ie((p), (sz), (v), (l)) -+ -+#define rtw_mbo_subfield_set(p, offset, val) (*(p + offset) = val) -+ -+#define rtw_mbo_subfields_set(p, offset, buf, len) \ -+ do { \ -+ u32 _offset = 0; \ -+ u8 *_p = p + offset; \ -+ while(_offset < len) { \ -+ *(_p + _offset) = *(buf + _offset); \ -+ _offset++; \ -+ } \ -+ } while(0) -+ -+static u8 *rtw_mbo_ie_get(u8 *pie, u32 *plen, u32 limit) -+{ -+ const u8 *p = pie; -+ u32 tmp, i; -+ -+ if (limit <= 1) -+ return NULL; -+ -+ i = 0; -+ *plen = 0; -+ while (1) { -+ if ((*p == _VENDOR_SPECIFIC_IE_) && -+ (_rtw_memcmp(rtw_mbo_get_oui(p), wfa_mbo_oui, 4))) { -+ *plen = *(p + 1); -+ RTW_MBO_DUMP("VENDOR_SPECIFIC_IE MBO: ", p, *(p + 1)); -+ return (u8 *)p; -+ } else { -+ tmp = *(p + 1); -+ p += (tmp + 2); -+ i += (tmp + 2); -+ } -+ -+ if (i >= limit) -+ break; -+ } -+ -+ return NULL; -+} -+ -+static u8 *rtw_mbo_attrs_get(u8 *pie, u32 limit, u8 attr_id, u32 *attr_len) -+{ -+ u8 *p = NULL; -+ u32 offset, plen = 0; -+ -+ if ((pie == NULL) || (limit <= 1)) -+ goto exit; -+ -+ if ((p = rtw_mbo_ie_get(pie, &plen, limit)) == NULL) -+ goto exit; -+ -+ /* shift 2 + OUI size and move to attributes content */ -+ p = p + 2 + sizeof(wfa_mbo_oui); -+ plen = plen - 4; -+ RTW_MBO_DUMP("Attributes contents: ", p, plen); -+ -+ if ((p = rtw_get_ie(p, attr_id, attr_len, plen)) == NULL) -+ goto exit; -+ -+ RTW_MBO_INFO("%s : id=%u(len=%u)\n", __func__, attr_id, *attr_len); -+ RTW_MBO_DUMP("contents : ", p, *attr_len); -+ -+exit: -+ return p; -+ -+} -+ -+static u32 rtw_mbo_attr_sz_get( -+ _adapter *padapter, u8 id) -+{ -+ u32 len = 0; -+ -+ switch (id) { -+ case RTW_MBO_ATTR_NPREF_CH_RPT_ID: -+ { -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ struct npref_ch_rtp *prpt = &(prfctl->ch_rtp); -+ struct npref_ch* pch; -+ u32 i, attr_len, offset; -+ -+ for (i=0; i < prpt->nm_of_rpt; i++) { -+ pch = &prpt->ch_rpt[i]; -+ /*attr_len = ch list + op class + preference + reason */ -+ attr_len = pch->nm_of_ch + 3; -+ /* offset = id + len field + attr_len */ -+ offset = attr_len + 2; -+ len += offset; -+ } -+ } -+ break; -+ case RTW_MBO_ATTR_CELL_DATA_CAP_ID: -+ case RTW_MBO_ATTR_TRANS_REJ_ID: -+ len = 3; -+ break; -+ default: -+ break; -+ } -+ -+ return len; -+} -+ -+static void rtw_mbo_build_mbo_ie_hdr( -+ u8 **pframe, struct pkt_attrib *pattrib, u8 payload_len) -+{ -+ u8 eid = RTW_MBO_EID; -+ u8 len = payload_len + 4; -+ -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &eid, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &len, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_4byte_ie(*pframe, wfa_mbo_oui, &(pattrib->pktlen)); -+} -+ -+void rtw_mbo_build_cell_data_cap_attr( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 attr_id = RTW_MBO_ATTR_CELL_DATA_CAP_ID; -+ u8 attr_len = 1; -+ u8 cell_data_con = rtw_mbo_cell_data_conn; -+ -+ /* used Cellular Data Capabilities from supplicant */ -+ if (!rtw_mbo_wifi_logo_test(padapter) && -+ pmlmepriv->pcell_data_cap_ie && pmlmepriv->cell_data_cap_len == 1) { -+ cell_data_con = *pmlmepriv->pcell_data_cap_ie; -+ RTW_MBO_INFO("%s : used Cellular Data Capabilities(%u) from supplicant!\n", -+ __func__, *pmlmepriv->pcell_data_cap_ie); -+ } -+ -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &attr_id, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &attr_len, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &cell_data_con, &(pattrib->pktlen)); -+} -+ -+static void rtw_mbo_update_cell_data_cap( -+ _adapter *padapter, u8 *pie, u32 ie_len) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 *mbo_attr; -+ u32 mbo_attrlen; -+ -+ if ((pie == NULL) || (ie_len == 0)) -+ return; -+ -+ mbo_attr = rtw_mbo_attrs_get(pie, ie_len, -+ RTW_MBO_ATTR_CELL_DATA_CAP_ID, &mbo_attrlen); -+ -+ if ((mbo_attr == NULL) || (mbo_attrlen == 0) ) { -+ RTW_INFO("MBO : Cellular Data Capabilities not found!\n"); -+ return; -+ } -+ -+ rtw_buf_update(&pmlmepriv->pcell_data_cap_ie, -+ &pmlmepriv->cell_data_cap_len, (mbo_attr + 2), mbo_attrlen); -+ RTW_MBO_DUMP("rtw_mbo_update_cell_data_cap : ", -+ pmlmepriv->pcell_data_cap_ie, pmlmepriv->cell_data_cap_len); -+} -+ -+void rtw_mbo_update_ie_data( -+ _adapter *padapter, u8 *pie, u32 ie_len) -+{ -+ rtw_mbo_update_cell_data_cap(padapter, pie, ie_len); -+} -+ -+static u8 rtw_mbo_current_op_class_get(_adapter *padapter) -+{ -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ struct p2p_channels *pch_list = &(prfctl->channel_list); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct p2p_reg_class *preg_class; -+ int class_idx, ch_idx; -+ u8 cur_op_class = 0; -+ -+ for(class_idx =0; class_idx < pch_list->reg_classes; class_idx++) { -+ preg_class = &pch_list->reg_class[class_idx]; -+ for (ch_idx = 0; ch_idx <= preg_class->channels; ch_idx++) { -+ if (pmlmeext->cur_channel == preg_class->channel[ch_idx]) { -+ cur_op_class = preg_class->reg_class; -+ RTW_MBO_INFO("%s : current ch : %d, op class : %d\n", -+ __func__, pmlmeext->cur_channel, cur_op_class); -+ break; -+ } -+ } -+ } -+ -+ return cur_op_class; -+} -+ -+static void rtw_mbo_supp_op_classes_get(_adapter *padapter, u8 *pclasses) -+{ -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ struct p2p_channels *pch_list = &(prfctl->channel_list); -+ int class_idx; -+ -+ if (pclasses == NULL) -+ return; -+ -+ RTW_MBO_INFO("%s : support op class \n", __func__); -+ for(class_idx = 0; class_idx < pch_list->reg_classes; class_idx++) { -+ *(pclasses + class_idx) = pch_list->reg_class[class_idx].reg_class; -+ RTW_MBO_INFO("%u ,", *(pclasses + class_idx)); -+ } -+ -+ RTW_MBO_INFO("%s : \n", __func__); -+} -+ -+void rtw_mbo_build_supp_op_class_elem( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib) -+{ -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ u8 payload[32] = {0}; -+ u8 delimiter_130 = 130; /*0x82*/ -+ u8 reg_class_nm, len; -+ -+ if ((reg_class_nm = prfctl->channel_list.reg_classes) == 0) -+ return; -+ -+ payload[0] = rtw_mbo_current_op_class_get(padapter); -+ rtw_mbo_supp_op_classes_get(padapter, &payload[1]); -+ -+ /* IEEE 802.11 Std Current Operating Class Extension Sequence */ -+ payload[reg_class_nm + 1] = delimiter_130; -+ payload[reg_class_nm + 2] = 0x00; -+ -+ RTW_MBO_DUMP("op class :", payload, reg_class_nm); -+ -+ /* Current Operating Class field + Operating Class field -+ + OneHundredAndThirty Delimiter field */ -+ len = reg_class_nm + 3; -+ *pframe = rtw_set_ie(*pframe, EID_SupRegulatory, len , -+ payload, &(pattrib->pktlen)); -+} -+ -+static u8 rtw_mbo_construct_npref_ch_rpt_attr( -+ _adapter *padapter, u8 *pbuf, u32 buf_len, u32 *plen) -+{ -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ struct npref_ch_rtp *prpt = &(prfctl->ch_rtp); -+ struct npref_ch* pch; -+ u32 attr_len, offset; -+ int i; -+ u8 *p = pbuf; -+ -+ if (prpt->nm_of_rpt == 0) { -+ *plen = 0; -+ return _FALSE; -+ } -+ -+ for (i=0; i < prpt->nm_of_rpt; i++) { -+ pch = &prpt->ch_rpt[i]; -+ /* attr_len = ch list + op class + preference + reason */ -+ attr_len = pch->nm_of_ch + 3; -+ /* offset = id + len field + attr_len */ -+ offset = attr_len + 2; -+ rtw_mbo_subfield_set(p, 0, RTW_MBO_ATTR_NPREF_CH_RPT_ID); -+ rtw_mbo_subfield_set(p, 1, attr_len); -+ rtw_mbo_subfield_set(p, 2, pch->op_class); -+ rtw_mbo_subfields_set(p, 3, pch->chs, pch->nm_of_ch); -+ rtw_mbo_subfield_set(p, (offset - 2), pch->preference); -+ rtw_mbo_subfield_set(p, (offset - 1), pch->reason); -+ p += offset; -+ *plen += offset; -+ -+ if (*plen >= buf_len) { -+ RTW_ERR("MBO : construct non-preferred channel report fail!\n"); -+ return _FALSE; -+ } -+ } -+ -+ return _TRUE; -+} -+ -+void rtw_mbo_build_npref_ch_rpt_attr( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib) -+{ -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ struct npref_ch_rtp *prpt = &(prfctl->ch_rtp); -+ u32 tmp_sz = 0, body_len = 0; -+ u8 *ptmp; -+ -+ tmp_sz = prpt->nm_of_rpt * sizeof(struct npref_ch); -+ ptmp = rtw_zmalloc(tmp_sz); -+ if (ptmp == NULL) -+ return; -+ -+ if (rtw_mbo_construct_npref_ch_rpt_attr(padapter, ptmp, tmp_sz, &body_len) == _FALSE) { -+ rtw_mfree(ptmp, tmp_sz); -+ return; -+ } -+ -+ RTW_MBO_DUMP("Non-preferred Channel Report :", ptmp, body_len); -+ *pframe = rtw_mbo_set_nbyte_ie(*pframe, body_len, ptmp, &(pattrib->pktlen)); -+ -+ rtw_mfree(ptmp, tmp_sz); -+} -+ -+void rtw_mbo_build_trans_reject_reason_attr( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib, u8 *pres) -+{ -+ u8 attr_id = RTW_MBO_ATTR_TRANS_REJ_ID; -+ u8 attr_len = 1; -+ u32 len = 0; -+ -+ len = rtw_mbo_attr_sz_get(padapter, RTW_MBO_ATTR_TRANS_REJ_ID); -+ if ((len == 0) || (len > 3)) { -+ RTW_ERR("MBO : build Transition Rejection Reason attribute fail(len=%u)\n", len); -+ return; -+ } -+ -+ rtw_mbo_build_mbo_ie_hdr(pframe, pattrib, len); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &attr_id, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &attr_len, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, pres, &(pattrib->pktlen)); -+} -+ -+u8 rtw_mbo_disallowed_network(struct wlan_network *pnetwork) -+{ -+ u8 *p, *attr_id, *res; -+ u32 attr_len = 0; -+ u8 disallow = _FALSE; -+ -+ if (pnetwork == NULL) -+ goto exit; -+ -+ p = rtw_mbo_attrs_get(pnetwork->network.IEs, -+ pnetwork->network.IELength, -+ RTW_MBO_ATTR_ASSOC_DISABLED_ID, -+ &attr_len); -+ -+ if (p == NULL) { -+ RTW_MBO_INFO("%s :Assoc Disallowed attribute not found!\n",__func__); -+ goto exit; -+ } -+ -+ RTW_MBO_DUMP("Association Disallowed attribute :",p , attr_len + 2); -+ RTW_INFO("MBO : block "MAC_FMT" assoc disallowed reason %d\n", -+ MAC_ARG(pnetwork->network.MacAddress), *(rtw_mbo_get_disallow_res(p))); -+ -+ disallow = _TRUE; -+exit: -+ return disallow; -+} -+ -+void rtw_mbo_build_exented_cap( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib) -+{ -+ u8 content[8] = { 0 }; -+ -+ rtw_wnm_set_ext_cap_btm(content, 1); -+ rtw_mbo_set_ext_cap_internw(content, 1); -+ *pframe = rtw_set_ie(*pframe, -+ WLAN_EID_EXT_CAP, -+ 8, -+ content, -+ &(pattrib->pktlen)); -+} -+ -+static void rtw_mbo_non_pref_chans_dump(struct npref_ch* pch) -+{ -+ int i; -+ u8 buf[128] = {0}; -+ -+ for (i=0; i < pch->nm_of_ch; i++) -+ rtw_sprintf(buf, 128, "%s,%d", buf, pch->chs[i]); -+ -+ RTW_MBO_INFO("%s : op_class=%01x, ch=%s, preference=%d, reason=%d\n", -+ __func__, pch->op_class, buf, pch->preference, pch->reason); -+} -+ -+static u8 rtw_mbo_non_pref_chan_exist(struct npref_ch* pch, u8 ch) -+{ -+ u32 i; -+ u8 found = _FALSE; -+ -+ for (i=0; i < pch->nm_of_ch; i++) { -+ if (pch->chs[i] == ch) { -+ found = _TRUE; -+ break; -+ } -+ } -+ -+ return found; -+} -+ -+static struct npref_ch* rtw_mbo_non_pref_chan_get( -+ _adapter *padapter, u8 op_class, u8 prefe, u8 res) -+{ -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ struct npref_ch_rtp *prpt = &(prfctl->ch_rtp); -+ struct npref_ch* pch = NULL; -+ int i; -+ -+ if (prpt->nm_of_rpt == 0) -+ return pch; -+ -+ for (i=0; i < prpt->nm_of_rpt; i++) { -+ if ((prpt->ch_rpt[i].op_class == op_class) && -+ (prpt->ch_rpt[i].preference == prefe) && -+ (prpt->ch_rpt[i].reason == res)) { -+ pch = &prpt->ch_rpt[i]; -+ break; -+ } -+ } -+ -+ return pch; -+} -+ -+static void rtw_mbo_non_pref_chan_set( -+ struct npref_ch* pch, u8 op_class, u8 ch, u8 prefe, u8 res, u8 update) -+{ -+ u32 offset = pch->nm_of_ch; -+ -+ if (update) { -+ if (rtw_mbo_non_pref_chan_exist(pch, ch) == _FALSE) { -+ pch->chs[offset] = ch; -+ pch->nm_of_ch++; -+ } -+ } else { -+ pch->op_class = op_class; -+ pch->chs[0] = ch; -+ pch->preference = prefe; -+ pch->reason = res; -+ pch->nm_of_ch = 1; -+ } -+} -+ -+static void rtw_mbo_non_pref_chans_update( -+ _adapter *padapter, u8 op_class, u8 ch, u8 prefe, u8 res) -+{ -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ struct npref_ch_rtp *pch_rpt = &(prfctl->ch_rtp); -+ struct npref_ch* pch; -+ -+ if (pch_rpt->nm_of_rpt >= RTW_MBO_MAX_CH_RPT_NUM) { -+ RTW_ERR("MBO : %d non_pref_chan entries supported!", -+ RTW_MBO_MAX_CH_RPT_NUM); -+ return; -+ } -+ -+ if (pch_rpt->nm_of_rpt == 0) { -+ pch = &pch_rpt->ch_rpt[0]; -+ rtw_mbo_non_pref_chan_set(pch, op_class, ch, prefe, res, _FALSE); -+ pch_rpt->nm_of_rpt = 1; -+ return; -+ } -+ -+ pch = rtw_mbo_non_pref_chan_get(padapter, op_class, prefe, res); -+ if (pch == NULL) { -+ pch = &pch_rpt->ch_rpt[pch_rpt->nm_of_rpt]; -+ rtw_mbo_non_pref_chan_set(pch, op_class, ch, prefe, res, _FALSE); -+ pch_rpt->nm_of_rpt++; -+ } else -+ rtw_mbo_non_pref_chan_set(pch, op_class, ch, prefe, res, _TRUE); -+ -+ rtw_mbo_non_pref_chans_dump(pch); -+} -+ -+static void rtw_mbo_non_pref_chans_set( -+ _adapter *padapter, char *param, ssize_t sz) -+{ -+ char *pnext; -+ u32 op_class, ch, prefe, res; -+ int i = 0; -+ -+ do { -+ pnext = strsep(¶m, " "); -+ if (pnext == NULL) -+ break; -+ -+ sscanf(pnext, "%d:%d:%d:%d", &op_class, &ch, &prefe, &res); -+ rtw_mbo_non_pref_chans_update(padapter, op_class, ch, prefe, res); -+ -+ if ((i++) > 10) { -+ RTW_ERR("MBO : overflow %d \n", i); -+ break; -+ } -+ -+ } while(param != '\0'); -+ -+} -+ -+static void rtw_mbo_non_pref_chans_del( -+ _adapter *padapter, char *param, ssize_t sz) -+{ -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ struct npref_ch_rtp *prpt = &(prfctl->ch_rtp); -+ -+ RTW_INFO("%s : delete non_pref_chan %s\n", __func__, param); -+ _rtw_memset(prpt, 0, sizeof(struct npref_ch_rtp)); -+} -+ -+ssize_t rtw_mbo_proc_non_pref_chans_set( -+ struct file *pfile, const char __user *buffer, -+ size_t count, loff_t *pos, void *pdata) -+{ -+ struct net_device *dev = pdata; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 tmp[128] = {0}; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ if (strncmp(tmp, "add", 3) == 0) -+ rtw_mbo_non_pref_chans_set(padapter, &tmp[4], (count - 4)); -+ else if (strncmp(tmp, "delete", 6) == 0) -+ rtw_mbo_non_pref_chans_del(padapter, &tmp[7], (count - 7)); -+ else { -+ RTW_ERR("MBO : Invalid format : echo [add|delete] :::\n"); -+ return -EFAULT; -+ } -+ } -+ -+#ifdef CONFIG_RTW_WNM -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) && -+ check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ rtw_wnm_issue_action(padapter, RTW_WLAN_ACTION_WNM_NOTIF_REQ, 0, 0); -+#endif -+ -+ return count; -+} -+ -+int rtw_mbo_proc_non_pref_chans_get( -+ struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ struct npref_ch_rtp *prpt = &(prfctl->ch_rtp); -+ struct npref_ch* pch; -+ int i,j; -+ u8 buf[32] = {0}; -+ -+ RTW_PRINT_SEL(m, "op_class ch preference reason \n"); -+ RTW_PRINT_SEL(m, "=======================================================\n"); -+ -+ -+ if (prpt->nm_of_rpt == 0) { -+ RTW_PRINT_SEL(m, " empty table \n"); -+ return 0; -+ } -+ -+ for (i=0; i < prpt->nm_of_rpt; i++) { -+ pch = &prpt->ch_rpt[i]; -+ buf[0]='\0'; -+ for (j=0; j < pch->nm_of_ch; j++) { -+ if (j == 0) -+ rtw_sprintf(buf, 32, "%02u", pch->chs[j]); -+ else -+ rtw_sprintf(buf, 32, "%s,%02u", buf, pch->chs[j]); -+ } -+ -+ RTW_PRINT_SEL(m, " %04u %20s %02u %02u\n", -+ pch->op_class, buf, pch->preference, pch->reason); -+ } -+ -+ return 0; -+} -+ -+ssize_t rtw_mbo_proc_cell_data_set( -+ struct file *pfile, const char __user *buffer, -+ size_t count, loff_t *pos, void *pdata) -+{ -+ struct net_device *dev = pdata; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ int mbo_cell_data = 0; -+ u8 tmp[8] = {0}; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%d", &mbo_cell_data); -+ if (num == 1) { -+ rtw_mbo_cell_data_conn = mbo_cell_data; -+ #ifdef CONFIG_RTW_WNM -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) && -+ check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ rtw_wnm_issue_action(padapter, RTW_WLAN_ACTION_WNM_NOTIF_REQ, 0, 0); -+ #endif -+ } -+ } -+ -+ -+ return count; -+} -+ -+int rtw_mbo_proc_cell_data_get( -+ struct seq_file *m, void *v) -+{ -+#if 0 -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+#endif -+ -+ RTW_PRINT_SEL(m, "Cellular Data Connectivity : %d\n", rtw_mbo_cell_data_conn); -+ return 0; -+} -+ -+static void rtw_mbo_non_pref_chan_subelem_parsing( -+ _adapter *padapter, u8 *subelem, size_t subelem_len) -+{ -+ u8 *pnon_pref_chans; -+ u32 non_pref_chan_offset, op_subelem_len; -+ u32 oui_offset = 3; -+ /* wpa_supplicant don't apped OUI Type */ -+ u32 oui_type_offset = 0; -+ -+ RTW_MBO_DUMP("Non-preferred Channel subelem : ", subelem , subelem_len); -+ -+ /* Subelem : -+ Vendor Specific | Length | WFA OUI | OUI Type | MBO Attributes */ -+ non_pref_chan_offset = 2 + oui_offset + oui_type_offset; -+ pnon_pref_chans = subelem + non_pref_chan_offset; -+ op_subelem_len = subelem_len - non_pref_chan_offset; -+ -+ /* wpa_supplicant don't indicate non_pref_chan length, -+ so we cannot get how many non_pref_chan in a wnm notification */ -+ RTW_MBO_DUMP("Non-preferred Channel : ", pnon_pref_chans, op_subelem_len); -+} -+ -+void rtw_mbo_wnm_notification_parsing( -+ _adapter *padapter, const u8 *pdata, size_t data_len) -+{ -+ u8 *paction; -+ u8 category, action, dialog, type; -+ u32 len; -+ -+ if ((pdata == NULL) || (data_len == 0)) -+ return; -+ -+ RTW_MBO_DUMP("WNM notification data : ", pdata, data_len); -+ paction = (u8 *)pdata + sizeof(struct rtw_ieee80211_hdr_3addr); -+ category = paction[0]; -+ action = paction[1]; -+ dialog = paction[2]; -+ type = paction[3]; -+ -+ if ((action == RTW_WLAN_ACTION_WNM_NOTIF_REQ) && -+ (type == WLAN_EID_VENDOR_SPECIFIC)) { -+ rtw_mbo_non_pref_chan_subelem_parsing(padapter, &paction[4], -+ (data_len - sizeof(struct rtw_ieee80211_hdr_3addr))); -+ } -+ -+} -+ -+void rtw_mbo_build_wnm_notification( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib) -+{ -+ struct rf_ctl_t *prfctl = adapter_to_rfctl(padapter); -+ struct npref_ch_rtp *prpt = &(prfctl->ch_rtp); -+ struct npref_ch* pch; -+ u8 subelem_id = WLAN_EID_VENDOR_SPECIFIC; -+ u8 non_pref_ch_oui[] = {0x50, 0x6F, 0x9A, 0x2}; -+ u8 cell_data_cap_oui[] = {0x50, 0x6F, 0x9A, 0x3}; -+ u8 cell_data_con = rtw_mbo_cell_data_conn; -+ u8 len, cell_data_con_len = 0, *pcont = *pframe; -+ int i; -+ -+ if (rtw_mbo_cell_data_conn > 0) { -+ len = 0x5; -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &subelem_id, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &len, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_4byte_ie(*pframe, cell_data_cap_oui, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &cell_data_con, &(pattrib->pktlen)); -+ RTW_MBO_INFO("%s : Cellular Data Capabilities subelemen\n", __func__); -+ RTW_MBO_DUMP(":", pcont, len + 2); -+ pcont += len + 2 ; -+ } -+ -+ if (prpt->nm_of_rpt == 0) { -+ len = 0x4; -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &subelem_id, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &len, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_4byte_ie(*pframe, non_pref_ch_oui, &(pattrib->pktlen)); -+ RTW_MBO_INFO("%s :Non-preferred Channel Report subelement without data\n", __func__); -+ return; -+ } -+ -+ for (i=0; i < prpt->nm_of_rpt; i++) { -+ pch = &prpt->ch_rpt[i]; -+ /* OUI(3B) + OUT-type(1B) + op-class(1B) + ch list(nB) -+ + Preference(1B) + reason(1B) */ -+ len = pch->nm_of_ch + 7; -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &subelem_id, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &len, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_4byte_ie(*pframe, non_pref_ch_oui, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &pch->op_class, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_nbyte_ie(*pframe, pch->nm_of_ch, pch->chs, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &pch->preference, &(pattrib->pktlen)); -+ *pframe = rtw_mbo_set_1byte_ie(*pframe, &pch->reason, &(pattrib->pktlen)); -+ RTW_MBO_INFO("%s :Non-preferred Channel Report subelement\n", __func__); -+ RTW_MBO_DUMP(":", pcont, len); -+ pcont = *pframe; -+ } -+} -+ -+void rtw_mbo_build_probe_req_ies( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib) -+{ -+ u32 len =0; -+ -+ rtw_mbo_build_exented_cap(padapter, pframe, pattrib); -+ -+ len = rtw_mbo_attr_sz_get(padapter, RTW_MBO_ATTR_CELL_DATA_CAP_ID); -+ if ((len == 0) || (len > 3)) { -+ RTW_ERR("MBO : build Cellular Data Capabilities attribute fail(len=%u)\n", len); -+ return; -+ } -+ -+ rtw_mbo_build_mbo_ie_hdr(pframe, pattrib, len); -+ rtw_mbo_build_cell_data_cap_attr(padapter, pframe, pattrib); -+} -+ -+void rtw_mbo_build_assoc_req_ies( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib) -+{ -+ u32 len = 0; -+ -+ rtw_mbo_build_supp_op_class_elem(padapter, pframe, pattrib); -+ -+ len += rtw_mbo_attr_sz_get(padapter, RTW_MBO_ATTR_CELL_DATA_CAP_ID); -+ len += rtw_mbo_attr_sz_get(padapter, RTW_MBO_ATTR_NPREF_CH_RPT_ID); -+ if ((len == 0)|| (len < 3)) { -+ RTW_ERR("MBO : build assoc MBO IE fail(len=%u)\n", len); -+ return; -+ } -+ -+ rtw_mbo_build_mbo_ie_hdr(pframe, pattrib, len); -+ rtw_mbo_build_cell_data_cap_attr(padapter, pframe, pattrib); -+ rtw_mbo_build_npref_ch_rpt_attr(padapter, pframe, pattrib); -+} -+ -+#endif /* CONFIG_RTW_MBO */ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_mem.c b/drivers/net/wireless/rtl8821cs/core/rtw_mem.c -new file mode 100644 -index 000000000..d42a4fb03 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_mem.c -@@ -0,0 +1,171 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Realtek Wireless Lan Driver"); -+MODULE_AUTHOR("Realtek Semiconductor Corp."); -+MODULE_VERSION("DRIVERVERSION"); -+ -+/* for MAX_RECVBUF_SZ */ -+#if defined(CONFIG_RTL8188E) -+#include -+#elif defined(CONFIG_RTL8188F) -+#include -+#elif defined(CONFIG_RTL8188GTV) -+#include -+#elif defined(CONFIG_RTL8710B) -+#include -+#elif defined(CONFIG_RTL8192E) -+#include -+#elif defined(CONFIG_RTL8192F) -+#include -+#elif defined(CONFIG_RTL8723B) -+#include -+#elif defined(CONFIG_RTL8703B) -+#include -+#elif defined(CONFIG_RTL8723D) -+#include -+#elif defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+#include -+#elif defined(CONFIG_RTL8822B) -+#include -+#elif defined(CONFIG_RTL8822C) -+#include -+#elif defined(CONFIG_RTL8814A) -+#include -+#elif defined(CONFIG_RTL8814B) -+#include -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#define MAX_RTKM_RECVBUF_SZ MAX_RECVBUF_SZ -+#define MAX_RTKM_NR_PREALLOC_RECV_SKB NR_RECVBUFF -+#else /* !CONFIG_SDIO_HCI */ -+#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 -+#endif /* !CONFIG_SDIO_HCI */ -+ -+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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_mi.c b/drivers/net/wireless/rtl8821cs/core/rtw_mi.c -new file mode 100644 -index 000000000..72d41f775 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_mi.c -@@ -0,0 +1,1579 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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); -+ -+ if (!ch) { -+ dvobj->union_ch_bak = dvobj->union_ch; -+ dvobj->union_bw_bak = dvobj->union_bw; -+ dvobj->union_offset_bak = dvobj->union_offset; -+ } -+ dvobj->union_ch = ch; -+ dvobj->union_bw = bw; -+ dvobj->union_offset = offset; -+} -+ -+#ifdef DBG_IFACE_STATUS -+#ifdef CONFIG_P2P -+static u8 _rtw_mi_p2p_listen_scan_chk(_adapter *adapter) -+{ -+ int i; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 p2p_listen_scan_state = _FALSE; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_LISTEN) || -+ rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_SCAN)) { -+ p2p_listen_scan_state = _TRUE; -+ break; -+ } -+ } -+ return p2p_listen_scan_state; -+} -+#endif -+#endif -+ -+u8 rtw_mi_stayin_union_ch_chk(_adapter *adapter) -+{ -+ u8 rst = _TRUE; -+ u8 u_ch, u_bw, u_offset; -+ u8 o_ch, o_bw, o_offset; -+ -+ u_ch = rtw_mi_get_union_chan(adapter); -+ u_bw = rtw_mi_get_union_bw(adapter); -+ u_offset = rtw_mi_get_union_offset(adapter); -+ -+ o_ch = rtw_get_oper_ch(adapter); -+ o_bw = rtw_get_oper_bw(adapter); -+ o_offset = rtw_get_oper_choffset(adapter); -+ -+ if ((u_ch != o_ch) || (u_bw != o_bw) || (u_offset != o_offset)) -+ rst = _FALSE; -+ -+ #ifdef DBG_IFACE_STATUS -+ if (rst == _FALSE) { -+ RTW_ERR("%s Not stay in union channel\n", __func__); -+ if (GET_HAL_DATA(adapter)->bScanInProcess == _TRUE) -+ RTW_ERR("ScanInProcess\n"); -+ #ifdef CONFIG_P2P -+ if (_rtw_mi_p2p_listen_scan_chk(adapter)) -+ RTW_ERR("P2P in listen or scan state\n"); -+ #endif -+ RTW_ERR("union ch, bw, offset: %u,%u,%u\n", u_ch, u_bw, u_offset); -+ RTW_ERR("oper ch, bw, offset: %u,%u,%u\n", o_ch, o_bw, o_offset); -+ RTW_ERR("=========================\n"); -+ } -+ #endif -+ return rst; -+} -+ -+u8 rtw_mi_stayin_union_band_chk(_adapter *adapter) -+{ -+ u8 rst = _TRUE; -+ u8 u_ch, o_ch; -+ u8 u_band, o_band; -+ -+ u_ch = rtw_mi_get_union_chan(adapter); -+ o_ch = rtw_get_oper_ch(adapter); -+ u_band = (u_ch > 14) ? BAND_ON_5G : BAND_ON_2_4G; -+ o_band = (o_ch > 14) ? BAND_ON_5G : BAND_ON_2_4G; -+ -+ if (u_ch != o_ch) -+ if(u_band != o_band) -+ rst = _FALSE; -+ -+ #ifdef DBG_IFACE_STATUS -+ if (rst == _FALSE) -+ RTW_ERR("%s Not stay in union band\n", __func__); -+ #endif -+ -+ return rst; -+} -+ -+/* Find union about ch, bw, ch_offset of all linked/linking interfaces */ -+int rtw_mi_get_ch_setting_union_by_ifbmp(struct dvobj_priv *dvobj, u8 ifbmp, u8 *ch, u8 *bw, u8 *offset) -+{ -+ _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]; -+ if (!iface || !(ifbmp & BIT(iface->iface_id))) -+ continue; -+ -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (!check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE | WIFI_UNDER_LINKING)) -+ continue; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_OP_CH_SWITCHING)) -+ 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_by_ifbmp(adapter_to_dvobj(adapter), 0xFF, ch, bw, offset); -+} -+ -+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_by_ifbmp(adapter_to_dvobj(adapter), 0xFF & ~BIT(adapter->iface_id), ch, bw, offset); -+} -+ -+void rtw_mi_status_by_ifbmp(struct dvobj_priv *dvobj, u8 ifbmp, struct mi_state *mstate) -+{ -+ _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 (!iface || !(ifbmp & BIT(iface->iface_id))) -+ continue; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ MSTATE_STA_NUM(mstate)++; -+ if (check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ MSTATE_STA_LD_NUM(mstate)++; -+ -+ #ifdef CONFIG_TDLS -+ if (iface->tdlsinfo.link_established == _TRUE) -+ MSTATE_TDLS_LD_NUM(mstate)++; -+ #endif -+ #ifdef CONFIG_P2P -+ if (MLME_IS_GC(iface)) -+ MSTATE_P2P_GC_NUM(mstate)++; -+ #endif -+ } -+ if (check_fwstate(&iface->mlmepriv, WIFI_UNDER_LINKING) == _TRUE) -+ MSTATE_STA_LG_NUM(mstate)++; -+ -+#ifdef CONFIG_AP_MODE -+ } else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE ) { -+ if (check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ MSTATE_AP_NUM(mstate)++; -+ if (iface->stapriv.asoc_sta_count > 2) -+ MSTATE_AP_LD_NUM(mstate)++; -+ #ifdef CONFIG_P2P -+ if (MLME_IS_GO(iface)) -+ MSTATE_P2P_GO_NUM(mstate)++; -+ #endif -+ } else -+ MSTATE_AP_STARTING_NUM(mstate)++; -+#endif -+ -+ } else if (check_fwstate(&iface->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) == _TRUE -+ && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE -+ ) { -+ MSTATE_ADHOC_NUM(mstate)++; -+ if (iface->stapriv.asoc_sta_count > 2) -+ MSTATE_ADHOC_LD_NUM(mstate)++; -+ -+#ifdef CONFIG_RTW_MESH -+ } else if (check_fwstate(&iface->mlmepriv, WIFI_MESH_STATE) == _TRUE -+ && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE -+ ) { -+ MSTATE_MESH_NUM(mstate)++; -+ if (iface->stapriv.asoc_sta_count > 2) -+ MSTATE_MESH_LD_NUM(mstate)++; -+#endif -+ -+ } -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_UNDER_WPS) == _TRUE) -+ MSTATE_WPS_NUM(mstate)++; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_UNDER_SURVEY) == _TRUE) { -+ MSTATE_SCAN_NUM(mstate)++; -+ -+ if (mlmeext_scan_state(&iface->mlmeextpriv) != SCAN_DISABLE -+ && mlmeext_scan_state(&iface->mlmeextpriv) != SCAN_BACK_OP) -+ MSTATE_SCAN_ENTER_NUM(mstate)++; -+ } -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (rtw_cfg80211_get_is_mgmt_tx(iface)) -+ MSTATE_MGMT_TX_NUM(mstate)++; -+ -+ if (rtw_cfg80211_get_is_roch(iface) == _TRUE) -+ MSTATE_ROCH_NUM(mstate)++; -+ -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#ifdef CONFIG_P2P -+ if (MLME_IS_PD(iface)) -+ MSTATE_P2P_DV_NUM(mstate)++; -+#endif -+ } -+} -+ -+inline void rtw_mi_status(_adapter *adapter, struct mi_state *mstate) -+{ -+ return rtw_mi_status_by_ifbmp(adapter_to_dvobj(adapter), 0xFF, mstate); -+} -+ -+inline void rtw_mi_status_no_self(_adapter *adapter, struct mi_state *mstate) -+{ -+ return rtw_mi_status_by_ifbmp(adapter_to_dvobj(adapter), 0xFF & ~BIT(adapter->iface_id), mstate); -+} -+ -+inline void rtw_mi_status_no_others(_adapter *adapter, struct mi_state *mstate) -+{ -+ return rtw_mi_status_by_ifbmp(adapter_to_dvobj(adapter), BIT(adapter->iface_id), mstate); -+} -+ -+inline void rtw_mi_status_merge(struct mi_state *d, struct mi_state *a) -+{ -+ d->sta_num += a->sta_num; -+ d->ld_sta_num += a->ld_sta_num; -+ d->lg_sta_num += a->lg_sta_num; -+#ifdef CONFIG_TDLS -+ d->ld_tdls_num += a->ld_tdls_num; -+#endif -+#ifdef CONFIG_AP_MODE -+ d->ap_num += a->ap_num; -+ d->ld_ap_num += a->ld_ap_num; -+#endif -+ d->adhoc_num += a->adhoc_num; -+ d->ld_adhoc_num += a->ld_adhoc_num; -+#ifdef CONFIG_RTW_MESH -+ d->mesh_num += a->mesh_num; -+ d->ld_mesh_num += a->ld_mesh_num; -+#endif -+ d->scan_num += a->scan_num; -+ d->scan_enter_num += a->scan_enter_num; -+ d->uwps_num += a->uwps_num; -+#ifdef CONFIG_IOCTL_CFG80211 -+ #ifdef CONFIG_P2P -+ d->roch_num += a->roch_num; -+ #endif -+ d->mgmt_tx_num += a->mgmt_tx_num; -+#endif -+} -+ -+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)); -+#ifdef CONFIG_TDLS -+ RTW_PRINT_SEL(sel, "linked_tdls_num:%d\n", DEV_TDLS_LD_NUM(dvobj)); -+#endif -+#ifdef CONFIG_AP_MODE -+ RTW_PRINT_SEL(sel, "ap_num:%d\n", DEV_AP_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "starting_ap_num:%d\n", DEV_AP_STARTING_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "linked_ap_num:%d\n", DEV_AP_LD_NUM(dvobj)); -+#endif -+ 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_RTW_MESH -+ RTW_PRINT_SEL(sel, "mesh_num:%d\n", DEV_MESH_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "linked_mesh_num:%d\n", DEV_MESH_LD_NUM(dvobj)); -+#endif -+#ifdef CONFIG_P2P -+ RTW_PRINT_SEL(sel, "p2p_device_num:%d\n", DEV_P2P_DV_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "p2p_gc_num:%d\n", DEV_P2P_GC_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "p2p_go_num:%d\n", DEV_P2P_GO_NUM(dvobj)); -+#endif -+ RTW_PRINT_SEL(sel, "scan_num:%d\n", DEV_SCAN_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "under_wps_num:%d\n", DEV_WPS_NUM(dvobj)); -+#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, "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; -+ -+ if (state == WIFI_MONITOR_STATE -+ || 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)); -+ -+#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) || MSTATE_MESH_NUM(iface_state)) /*check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE)*/ -+ 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) || MSTATE_MESH_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; -+ -+#ifdef CONFIG_RTW_MESH -+ case MI_MESH: -+ if (MSTATE_MESH_NUM(iface_state)) -+ ret = _TRUE; -+ break; -+ case MI_MESH_ASSOC: -+ if (MSTATE_MESH_LD_NUM(iface_state)) -+ ret = _TRUE; -+ break; -+#endif -+ -+ 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; -+} -+ -+/* -+* 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_process_without_schk(_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) { -+ if ((exclude_self) && (iface == padapter)) -+ continue; -+ -+ if (ops_func) -+ if (ops_func(iface, data) == _TRUE) -+ ret++; -+ } -+ } -+ return ret; -+} -+ -+static u8 _rtw_mi_netif_caroff_qstop(_adapter *padapter, void *data) -+{ -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ rtw_netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ return _TRUE; -+} -+u8 rtw_mi_netif_caroff_qstop(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_caroff_qstop); -+} -+u8 rtw_mi_buddy_netif_caroff_qstop(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_caroff_qstop); -+} -+ -+static u8 _rtw_mi_netif_caron_qstart(_adapter *padapter, void *data) -+{ -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ rtw_netif_carrier_on(pnetdev); -+ rtw_netif_start_queue(pnetdev); -+ return _TRUE; -+} -+u8 rtw_mi_netif_caron_qstart(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_caron_qstart); -+} -+u8 rtw_mi_buddy_netif_caron_qstart(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_caron_qstart); -+} -+ -+static u8 _rtw_mi_netif_stop_queue(_adapter *padapter, void *data) -+{ -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ rtw_netif_stop_queue(pnetdev); -+ return _TRUE; -+} -+u8 rtw_mi_netif_stop_queue(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_stop_queue); -+} -+u8 rtw_mi_buddy_netif_stop_queue(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _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_netif_carrier_off(_adapter *padapter, void *data) -+{ -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ if (pnetdev) -+ rtw_netif_carrier_off(pnetdev); -+ return _TRUE; -+} -+u8 rtw_mi_netif_carrier_off(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_carrier_off); -+} -+u8 rtw_mi_buddy_netif_carrier_off(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_carrier_off); -+} -+ -+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 u32 _rtw_mi_start_drv_threads(_adapter *adapter, bool exclude_self) -+{ -+ int i; -+ _adapter *iface = NULL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u32 _status = _SUCCESS; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) { -+ if ((exclude_self) && (iface == adapter)) -+ continue; -+ if (rtw_start_drv_threads(iface) == _FAIL) { -+ _status = _FAIL; -+ break; -+ } -+ } -+ } -+ return _status; -+} -+u32 rtw_mi_start_drv_threads(_adapter *adapter) -+{ -+ return _rtw_mi_start_drv_threads(adapter, _FALSE); -+} -+u32 rtw_mi_buddy_start_drv_threads(_adapter *adapter) -+{ -+ return _rtw_mi_start_drv_threads(adapter, _TRUE); -+} -+ -+static void _rtw_mi_stop_drv_threads(_adapter *adapter, bool exclude_self) -+{ -+ int i; -+ _adapter *iface = NULL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) { -+ if ((exclude_self) && (iface == adapter)) -+ continue; -+ rtw_stop_drv_threads(iface); -+ } -+ } -+} -+void rtw_mi_stop_drv_threads(_adapter *adapter) -+{ -+ _rtw_mi_stop_drv_threads(adapter, _FALSE); -+} -+void rtw_mi_buddy_stop_drv_threads(_adapter *adapter) -+{ -+ _rtw_mi_stop_drv_threads(adapter, _TRUE); -+} -+ -+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_without_schk(adapter, _FALSE, NULL, _rtw_mi_reset_drv_sw); -+} -+void rtw_mi_buddy_reset_drv_sw(_adapter *adapter) -+{ -+ _rtw_mi_process_without_schk(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); -+} -+ -+#ifdef CONFIG_NEW_NETDEV_HDL -+u8 rtw_mi_hal_iface_init(_adapter *padapter) -+{ -+ int i; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ u8 ret = _TRUE; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface && iface->netif_up) -+ rtw_hal_iface_init(padapter); -+ } -+ return ret; -+} -+#endif -+ -+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 /*CONFIG_SET_SCAN_DENY_TIMER*/ -+ -+#ifdef CONFIG_AP_MODE -+static u8 _rtw_mi_beacon_update(_adapter *padapter, void *data) -+{ -+ if (!MLME_IS_STA(padapter) -+ && check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ RTW_INFO(ADPT_FMT" - update_beacon\n", ADPT_ARG(padapter)); -+ update_beacon(padapter, 0xFF, NULL, _TRUE, 0); -+ } -+ 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_update_csa(_adapter *adapter, void *data) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ if (check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ _update_beacon(adapter, WLAN_EID_CHANNEL_SWITCH, NULL, _TRUE, 0, "update CSA count"); -+ return _TRUE; -+} -+ -+void rtw_mi_update_csa(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_update_csa); -+} -+#endif /* CONFIG_AP_MODE */ -+ -+#ifndef CONFIG_MI_WITH_MBSSID_CAM -+static u8 _rtw_mi_hal_dump_macaddr(_adapter *padapter, void *sel) -+{ -+ u8 mac_addr[ETH_ALEN] = {0}; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_MAC_ADDR, mac_addr); -+ RTW_PRINT_SEL(sel, ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", -+ ADPT_ARG(padapter), padapter->hw_port, MAC_ARG(mac_addr)); -+ -+ return _TRUE; -+} -+void rtw_mi_hal_dump_macaddr(void *sel, _adapter *padapter) -+{ -+ _rtw_mi_process(padapter, _FALSE, sel, _rtw_mi_hal_dump_macaddr); -+} -+void rtw_mi_buddy_hal_dump_macaddr(void *sel, _adapter *padapter) -+{ -+ _rtw_mi_process(padapter, _TRUE, sel, _rtw_mi_hal_dump_macaddr); -+} -+#endif -+ -+#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) -+{ -+ return padapter->mlmepriv.LinkDetectInfo.bBusyTraffic; -+} -+ -+u8 rtw_mi_busy_traffic_check(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_busy_traffic_check); -+} -+u8 rtw_mi_buddy_busy_traffic_check(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _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 & WIFI_ASOC_STATE) { -+ _rtw_memset(buf, 0, 32); -+ sprintf(buf, "WIFI_ASOC_STATE"); -+ RTW_INFO(FUNC_ADPT_FMT"fwstate-%s\n", FUNC_ADPT_ARG(padapter), buf); -+ } -+ -+ if (state & WIFI_UNDER_LINKING) { -+ _rtw_memset(buf, 0, 32); -+ sprintf(buf, "WIFI_UNDER_LINKING"); -+ RTW_INFO(FUNC_ADPT_FMT"fwstate-%s\n", FUNC_ADPT_ARG(padapter), buf); -+ } -+ -+ if (state & WIFI_UNDER_SURVEY) { -+ _rtw_memset(buf, 0, 32); -+ sprintf(buf, "WIFI_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_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); -+} -+ -+#if defined(CONFIG_AP_MODE) && defined(DBG_CONFIG_ERROR_RESET) && defined(CONFIG_CONCURRENT_MODE) -+void rtw_mi_ap_info_restore(_adapter *adapter) -+{ -+ int i; -+ _adapter *iface; -+ struct mlme_priv *pmlmepriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) { -+ pmlmepriv = &iface->mlmepriv; -+ -+ if (MLME_IS_AP(iface) || MLME_IS_MESH(iface)) { -+ RTW_INFO(FUNC_ADPT_FMT" %s\n", FUNC_ADPT_ARG(iface), MLME_IS_AP(iface) ? "AP" : "MESH"); -+ rtw_iface_bcmc_sec_cam_map_restore(iface); -+ } -+ } -+ } -+} -+#endif /*#if defined(DBG_CONFIG_ERROR_RESET) && defined(CONFIG_CONCURRENT_MODE)*/ -+ -+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 ((MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) -+ && 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) || defined(CONFIG_PCI_BCN_POLLING) -+ 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 (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { -+ if (pmlmepriv->update_bcn == _TRUE) -+ set_tx_beacon_cmd(adapter, 0); -+ } -+ 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; -+ -+ if ((padapter == NULL) || (iface_id >= CONFIG_IFACE_NUMBER)) { -+ rtw_warn_on(1); -+ return iface; -+ } -+ -+ dvobj = adapter_to_dvobj(padapter); -+ return dvobj->padapters[iface_id]; -+} -+ -+_adapter *rtw_get_iface_by_macddr(_adapter *padapter, const 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; -+#ifdef CONFIG_SKB_ALLOCATED -+ u8 *pbuf = precvframe->u.hdr.rx_data; -+#endif -+ struct rx_pkt_attrib *pattrib = NULL; -+ -+ 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 (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); -+ u8 *fhead = get_recvframe_data(precvframe); -+ u8 type = GetFrameType(fhead); -+ -+ 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; -+ if (type == WIFI_DATA_TYPE && !adapter_allow_bmc_data_rx(iface)) -+ 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 -+ -+u8 rtw_mi_get_ld_sta_ifbmp(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int i; -+ _adapter *iface = NULL; -+ u8 ifbmp = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ if (MLME_IS_STA(iface) && MLME_IS_ASOC(iface)) -+ ifbmp |= BIT(i); -+ } -+ -+ return ifbmp; -+} -+ -+u8 rtw_mi_get_ap_mesh_ifbmp(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int i; -+ _adapter *iface = NULL; -+ u8 ifbmp = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ if (CHK_MLME_STATE(iface, WIFI_AP_STATE | WIFI_MESH_STATE) -+ && MLME_IS_ASOC(iface)) -+ ifbmp |= BIT(i); -+ } -+ -+ return ifbmp; -+} -+ -+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 -+} -+ -+u8 rtw_mi_get_assoc_if_num(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 n_assoc_iface = 0; -+#if 1 -+ u8 i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) -+ n_assoc_iface++; -+ } -+#else -+ n_assoc_iface = DEV_STA_LD_NUM(dvobj) + DEV_AP_NUM(dvobj) + DEV_ADHOC_NUM(dvobj) + DEV_MESH_NUM(dvobj); -+#endif -+ return n_assoc_iface; -+} -+ -+_adapter *rtw_mi_get_linking_adapter(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface = NULL; -+ u8 i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_UNDER_LINKING) == _TRUE) -+ break; -+ -+ iface = NULL; -+ } -+ return iface; -+} -\ No newline at end of file -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_mlme.c b/drivers/net/wireless/rtl8821cs/core/rtw_mlme.c -new file mode 100755 -index 000000000..b9af82c2e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_mlme.c -@@ -0,0 +1,5831 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+#include "../os_dep/linux/custom_multiap_intfs/custom_multiap_intfs.h" -+#endif -+ -+extern void indicate_wx_scan_complete_event(_adapter *padapter); -+extern u8 rtw_do_join(_adapter *padapter); -+ -+ -+void rtw_init_mlme_timer(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ rtw_init_timer(&(pmlmepriv->assoc_timer), padapter, rtw_join_timeout_handler, padapter); -+ rtw_init_timer(&(pmlmepriv->scan_to_timer), padapter, rtw_scan_timeout_handler, padapter); -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+ rtw_init_timer(&(pmlmepriv->set_scan_deny_timer), padapter, 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 -+} -+ -+sint _rtw_init_mlme_priv(_adapter *padapter) -+{ -+ sint i; -+ u8 *pbuf; -+ struct wlan_network *pnetwork; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ sint res = _SUCCESS; -+#ifdef CONFIG_RTW_MULTI_AP -+ struct unassoc_sta_info *unassoc_sta; -+#endif -+ -+ -+ /* 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; -+ init_fwstate(pmlmepriv, WIFI_STATION_STATE); -+ 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)); -+ -+ if (padapter->registrypriv.max_bss_cnt != 0) -+ pmlmepriv->max_bss_cnt = padapter->registrypriv.max_bss_cnt; -+ else if (rfctl->max_chan_nums <= MAX_CHANNEL_NUM_2G) -+ pmlmepriv->max_bss_cnt = MAX_BSS_CNT; -+ else -+ pmlmepriv->max_bss_cnt = MAX_BSS_CNT + MAX_BSS_CNT; -+ -+ -+ pbuf = rtw_zvmalloc(pmlmepriv->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 < pmlmepriv->max_bss_cnt; i++) { -+ _rtw_init_listhead(&(pnetwork->list)); -+ -+ rtw_list_insert_tail(&(pnetwork->list), &(pmlmepriv->free_bss_pool.queue)); -+ -+ pnetwork++; -+ } -+ -+#ifdef CONFIG_RTW_MULTI_AP -+ if (is_primary_adapter(padapter)) { -+ _rtw_init_queue(&(pmlmepriv->free_unassoc_sta_queue)); -+ _rtw_init_queue(&(pmlmepriv->unassoc_sta_queue)); -+ for (i = 0; i < UNASOC_STA_SRC_NUM; i++) -+ pmlmepriv->unassoc_sta_mode_of_stype[i] = padapter->registrypriv.unassoc_sta_mode_of_stype[i]; -+ if (padapter->registrypriv.max_unassoc_sta_cnt != 0) -+ pmlmepriv->max_unassoc_sta_cnt = padapter->registrypriv.max_unassoc_sta_cnt; -+ else if (rfctl->max_chan_nums <= MAX_CHANNEL_NUM_2G) -+ pmlmepriv->max_unassoc_sta_cnt = MAX_UNASSOC_STA_CNT; -+ else -+ pmlmepriv->max_unassoc_sta_cnt = MAX_UNASSOC_STA_CNT * 2; -+ pbuf = rtw_zvmalloc(pmlmepriv->max_unassoc_sta_cnt * (sizeof(struct unassoc_sta_info))); -+ if (pbuf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ pmlmepriv->free_unassoc_sta_buf = pbuf; -+ unassoc_sta = (struct unassoc_sta_info *) pbuf; -+ for (i = 0; i < pmlmepriv->max_unassoc_sta_cnt; i++) { -+ _rtw_init_listhead(&(unassoc_sta->list)); -+ rtw_list_insert_tail(&(unassoc_sta->list), &(pmlmepriv->free_unassoc_sta_queue.queue)); -+ unassoc_sta++; -+ } -+ } -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ rtw_init_timer(&pmlmepriv->cmap_unassoc_sta_timer, padapter, cmap_unassoc_sta_report_info_timer, padapter); -+#endif -+#endif -+ /* 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 (5) /* 5*(2 second)*/ -+#define RTW_ROAM_RSSI_THRESHOLD 70 -+#define RTW_ROAM_DICONNECT_DELAY 20 -+ _rtw_spinlock_init(&pmlmepriv->clnt_auth_lock); -+ pmlmepriv->roam_flags = CONFIG_ROAMING_FLAG; -+ -+ 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 = RTW_ROAM_SCAN_INTERVAL; -+ pmlmepriv->roam_rssi_threshold = RTW_ROAM_RSSI_THRESHOLD; -+ pmlmepriv->need_to_roam = _FALSE; -+ pmlmepriv->last_roaming = rtw_get_current_time(); -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+#ifdef CONFIG_RTW_80211R -+ rtw_ft_info_init(&pmlmepriv->ft_roam); -+#endif -+#ifdef CONFIG_LAYER2_ROAMING -+#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) -+ rtw_roam_nb_info_init(padapter); -+ pmlmepriv->ch_cnt = 0; -+#endif -+#endif -+ -+ pmlmepriv->defs_lmt_sta = 2; -+ pmlmepriv->defs_lmt_time = 5; -+ -+ 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); -+#ifdef CONFIG_LAYER2_ROAMING -+ _rtw_spinlock_free(&pmlmepriv->clnt_auth_lock); -+#endif -+ _rtw_spinlock_free(&(pmlmepriv->free_bss_pool.lock)); -+ _rtw_spinlock_free(&(pmlmepriv->scanned_queue.lock)); -+#ifdef CONFIG_RTW_MULTI_AP -+ if (is_primary_adapter(mlme_to_adapter(pmlmepriv))) { -+ _rtw_spinlock_free(&(pmlmepriv->unassoc_sta_queue.lock)); -+ _rtw_spinlock_free(&(pmlmepriv->free_unassoc_sta_queue.lock)); -+ } -+#endif -+} -+ -+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); -+#ifdef CONFIG_80211D -+ rtw_buf_free(&pmlmepriv->recv_country_ie, &pmlmepriv->recv_country_ie_len); -+#endif -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ rtw_buf_free(&pmlmepriv->wps_beacon_ie, &pmlmepriv->wps_beacon_ie_len); -+ rtw_buf_free(&pmlmepriv->wps_probe_req_ie, &pmlmepriv->wps_probe_req_ie_len); -+ rtw_buf_free(&pmlmepriv->wps_probe_resp_ie, &pmlmepriv->wps_probe_resp_ie_len); -+ rtw_buf_free(&pmlmepriv->wps_assoc_resp_ie, &pmlmepriv->wps_assoc_resp_ie_len); -+ -+ rtw_buf_free(&pmlmepriv->p2p_beacon_ie, &pmlmepriv->p2p_beacon_ie_len); -+ rtw_buf_free(&pmlmepriv->p2p_probe_req_ie, &pmlmepriv->p2p_probe_req_ie_len); -+ rtw_buf_free(&pmlmepriv->p2p_probe_resp_ie, &pmlmepriv->p2p_probe_resp_ie_len); -+ rtw_buf_free(&pmlmepriv->p2p_go_probe_resp_ie, &pmlmepriv->p2p_go_probe_resp_ie_len); -+ rtw_buf_free(&pmlmepriv->p2p_assoc_req_ie, &pmlmepriv->p2p_assoc_req_ie_len); -+ rtw_buf_free(&pmlmepriv->p2p_assoc_resp_ie, &pmlmepriv->p2p_assoc_resp_ie_len); -+#endif -+ -+#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) -+ rtw_buf_free(&pmlmepriv->wfd_beacon_ie, &pmlmepriv->wfd_beacon_ie_len); -+ rtw_buf_free(&pmlmepriv->wfd_probe_req_ie, &pmlmepriv->wfd_probe_req_ie_len); -+ rtw_buf_free(&pmlmepriv->wfd_probe_resp_ie, &pmlmepriv->wfd_probe_resp_ie_len); -+ rtw_buf_free(&pmlmepriv->wfd_go_probe_resp_ie, &pmlmepriv->wfd_go_probe_resp_ie_len); -+ rtw_buf_free(&pmlmepriv->wfd_assoc_req_ie, &pmlmepriv->wfd_assoc_req_ie_len); -+ rtw_buf_free(&pmlmepriv->wfd_assoc_resp_ie, &pmlmepriv->wfd_assoc_resp_ie_len); -+#endif -+ -+#ifdef CONFIG_RTW_80211R -+ rtw_buf_free(&pmlmepriv->auth_rsp, &pmlmepriv->auth_rsp_len); -+#endif -+#ifdef CONFIG_RTW_MBO -+ rtw_buf_free(&pmlmepriv->pcell_data_cap_ie, &pmlmepriv->cell_data_cap_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) -+{ -+ _adapter *adapter = mlme_to_adapter(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, pmlmepriv->max_bss_cnt * sizeof(struct wlan_network)); -+#ifdef CONFIG_RTW_MULTI_AP -+ if (is_primary_adapter(adapter)) { -+ if (pmlmepriv->free_unassoc_sta_buf) -+ rtw_vmfree(pmlmepriv->free_unassoc_sta_buf, pmlmepriv->max_unassoc_sta_cnt * sizeof(struct unassoc_sta_info)); -+ } -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ _cancel_timer_ex(&pmlmepriv->cmap_unassoc_sta_timer); -+#endif -+#endif -+ } -+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->last_non_hidden_ssid_ap = pnetwork->last_scanned; -+#if defined(CONFIG_RTW_MESH) && CONFIG_RTW_MESH_ACNODE_PREVENT -+ pnetwork->acnode_stime = 0; -+ pnetwork->acnode_notify_etime = 0; -+#endif -+ -+ 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; -+} -+ -+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, WIFI_ASOC_STATE) == _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); -+} -+ -+struct wlan_network *_rtw_find_network(_queue *scanned_queue, const u8 *addr) -+{ -+ _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; -+ } -+ -+ 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: -+ return pnetwork; -+} -+ -+struct wlan_network *rtw_find_network(_queue *scanned_queue, const u8 *addr) -+{ -+ struct wlan_network *pnetwork; -+ _irqL irqL; -+ -+ _enter_critical_bh(&scanned_queue->lock, &irqL); -+ pnetwork = _rtw_find_network(scanned_queue, addr); -+ _exit_critical_bh(&scanned_queue->lock, &irqL); -+ -+ 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 -+ -+ /* Wi-Fi driver doesn't consider the situation of BCN and ProbRsp sent from the same hidden AP, -+ * it considers these two packets are sent from different AP. -+ * Therefore, the scan queue may store two scan results of the same hidden AP, likes below. -+ * -+ * index bssid ch RSSI SdBm Noise age flag ssid -+ * 1 00:e0:4c:55:50:01 153 -73 -73 0 7044 [WPS][ESS] RTK5G -+ * 3 00:e0:4c:55:50:01 153 -73 -73 0 7044 [WPS][ESS] -+ * -+ * Original rules will compare Ssid, SsidLength, MacAddress, s_cap, d_cap at the same time. -+ * Wi-Fi driver will assume that the BCN and ProbRsp sent from the same hidden AP are the same network -+ * after we add an additional rule to compare SsidLength and Ssid. -+ * It means the scan queue will not store two scan results of the same hidden AP, it only store ProbRsp. -+ * For customer request. -+ */ -+ -+ if (((_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN)) == _TRUE) && -+ ((s_cap & WLAN_CAPABILITY_IBSS) == (d_cap & WLAN_CAPABILITY_IBSS)) && -+ ((s_cap & WLAN_CAPABILITY_BSS) == (d_cap & WLAN_CAPABILITY_BSS))) { -+ if ((src->Ssid.SsidLength == dst->Ssid.SsidLength) && -+ (((_rtw_memcmp(src->Ssid.Ssid, dst->Ssid.Ssid, src->Ssid.SsidLength)) == _TRUE) || //Case of normal AP -+ (is_all_null(src->Ssid.Ssid, src->Ssid.SsidLength) == _TRUE || is_all_null(dst->Ssid.Ssid, dst->Ssid.SsidLength) == _TRUE))) //Case of hidden AP -+ return _TRUE; -+ else if ((src->Ssid.SsidLength == 0 || dst->Ssid.SsidLength == 0)) //Case of hidden AP -+ return _TRUE; -+ else -+ return _FALSE; -+ } else { -+ return _FALSE; -+ } -+} -+ -+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; -+ -+ 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 || rtw_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) -+{ -+#if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) && 1 -+ u8 ss_ori = dst->PhyInfo.SignalStrength; -+ u8 sq_ori = dst->PhyInfo.SignalQuality; -+ u8 ss_smp = src->PhyInfo.SignalStrength; -+ long rssi_smp = src->Rssi; -+#endif -+ long rssi_ori = dst->Rssi; -+ -+ u8 sq_smp = src->PhyInfo.SignalQuality; -+ 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, WIFI_ASOC_STATE) && 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)); -+ } -+#ifdef CONFIG_LAYER2_ROAMING -+ dst->tsf = src->tsf; -+#endif -+ 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, WIFI_ASOC_STATE) && 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, WIFI_ASOC_STATE) == _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. -+ -+ -+*/ -+bool rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ u32 bssid_ex_sz; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+#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 *choice = NULL; -+ int target_find = 0; -+ u8 feature = 0; -+ bool update_ie = _FALSE; -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+#if 0 -+ RTW_INFO("%s => ssid:%s , rssi:%ld , ss:%d\n", -+ __func__, target->Ssid.Ssid, target->Rssi, target->PhyInfo.SignalStrength); -+#endif -+ -+#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 choice if it's new enough*/ -+ } -+ if (pnetwork->fixed) { -+ plist = get_next(plist); -+ continue; -+ } -+ -+#ifdef CONFIG_RSSI_PRIORITY -+ if ((choice == NULL) || (pnetwork->network.PhyInfo.SignalStrength < choice->network.PhyInfo.SignalStrength)) -+ #ifdef CONFIG_RTW_MESH -+ if (!MLME_IS_MESH(adapter) || !MLME_IS_ASOC(adapter) -+ || !rtw_bss_is_same_mbss(&pmlmepriv->cur_network.network, &pnetwork->network)) -+ #endif -+ choice = pnetwork; -+#else -+ if (choice == NULL || rtw_time_after(choice->last_scanned, pnetwork->last_scanned)) -+ #ifdef CONFIG_RTW_MESH -+ if (!MLME_IS_MESH(adapter) || !MLME_IS_ASOC(adapter) -+ || !rtw_bss_is_same_mbss(&pmlmepriv->cur_network.network, &pnetwork->network)) -+ #endif -+ choice = pnetwork; -+#endif -+ 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 choice */ -+ /* list_del_init(&choice->list); */ -+ pnetwork = choice; -+ if (pnetwork == NULL) -+ goto unlock_scan_queue; -+ -+#ifdef CONFIG_RSSI_PRIORITY -+ RTW_DBG("%s => ssid:%s ,bssid:"MAC_FMT" will be deleted from scanned_queue (rssi:%ld , ss:%d)\n", -+ __func__, pnetwork->network.Ssid.Ssid, MAC_ARG(pnetwork->network.MacAddress), pnetwork->network.Rssi, pnetwork->network.PhyInfo.SignalStrength); -+#else -+ RTW_DBG("%s => ssid:%s ,bssid:"MAC_FMT" will be deleted from scanned_queue\n", -+ __func__, pnetwork->network.Ssid.Ssid, MAC_ARG(pnetwork->network.MacAddress)); -+#endif -+ -+#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->bcn_keys_valid = 0; -+ if (target->Reserved[0] == BSS_TYPE_BCN || target->Reserved[0] == BSS_TYPE_PROB_RSP) -+ rtw_update_bcn_keys_of_network(pnetwork); -+ /* variable initialize */ -+ pnetwork->fixed = _FALSE; -+ pnetwork->last_scanned = rtw_get_current_time(); -+ pnetwork->last_non_hidden_ssid_ap = pnetwork->last_scanned; -+ #if defined(CONFIG_RTW_MESH) && CONFIG_RTW_MESH_ACNODE_PREVENT -+ pnetwork->acnode_stime = 0; -+ pnetwork->acnode_notify_etime = 0; -+ #endif -+#ifdef CONFIG_LAYER2_ROAMING -+ pnetwork->network.tsf = target->tsf; -+#endif -+ 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 unlock_scan_queue; -+ -+ 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->bcn_keys_valid = 0; -+ if (target->Reserved[0] == BSS_TYPE_BCN || target->Reserved[0] == BSS_TYPE_PROB_RSP) -+ rtw_update_bcn_keys_of_network(pnetwork); -+ -+ /* 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 -+ */ -+ #if defined(CONFIG_RTW_MESH) && CONFIG_RTW_MESH_ACNODE_PREVENT -+ systime last_scanned = pnetwork->last_scanned; -+ #endif -+ struct beacon_keys bcn_keys; -+ bool bcn_keys_valid = 0; -+ bool is_hidden_ssid_ap = 0; -+ -+ pnetwork->last_scanned = rtw_get_current_time(); -+ -+ if (target->Reserved[0] == BSS_TYPE_BCN || target->Reserved[0] == BSS_TYPE_PROB_RSP) { -+ if (target->InfrastructureMode == Ndis802_11Infrastructure) { -+ is_hidden_ssid_ap = hidden_ssid_ap(target); -+ if (!is_hidden_ssid_ap) /* update last time it's non hidden ssid AP */ -+ pnetwork->last_non_hidden_ssid_ap = rtw_get_current_time(); -+ } -+ bcn_keys_valid = rtw_get_bcn_keys_from_bss(target, &bcn_keys); -+ } -+ -+ if (target->InfrastructureMode == Ndis802_11_mesh -+ || target->Reserved[0] >= pnetwork->network.Reserved[0]) -+ update_ie = _TRUE; -+ else if (target->InfrastructureMode == Ndis802_11Infrastructure && !pnetwork->fixed -+ && rtw_get_passing_time_ms(pnetwork->last_non_hidden_ssid_ap) > SCANQUEUE_LIFETIME) -+ update_ie = _TRUE; -+ else if (bcn_keys_valid) { -+ if (is_hidden_ssid(bcn_keys.ssid, bcn_keys.ssid_len)) { -+ /* hidden ssid, replace with current beacon ssid directly */ -+ _rtw_memcpy(bcn_keys.ssid, pnetwork->bcn_keys.ssid, pnetwork->bcn_keys.ssid_len); -+ bcn_keys.ssid_len = pnetwork->bcn_keys.ssid_len; -+ } -+ if (rtw_bcn_key_compare(&pnetwork->bcn_keys, &bcn_keys) == _FALSE) -+ update_ie = _TRUE; -+ } -+ -+ #if defined(CONFIG_RTW_MESH) && CONFIG_RTW_MESH_ACNODE_PREVENT -+ if (!MLME_IS_MESH(adapter) || !MLME_IS_ASOC(adapter) -+ || pnetwork->network.Configuration.DSConfig != target->Configuration.DSConfig -+ || rtw_get_passing_time_ms(last_scanned) > adapter->mesh_cfg.peer_sel_policy.scanr_exp_ms -+ || !rtw_bss_is_same_mbss(&pnetwork->network, target) -+ ) { -+ pnetwork->acnode_stime = 0; -+ pnetwork->acnode_notify_etime = 0; -+ } -+ #endif -+ -+ if (bcn_keys_valid) { -+ _rtw_memcpy(&pnetwork->bcn_keys, &bcn_keys, sizeof(bcn_keys)); -+ pnetwork->bcn_keys_valid = 1; -+ } else if (update_ie) -+ pnetwork->bcn_keys_valid = 0; -+ -+ update_network(&(pnetwork->network), target, adapter, update_ie); -+ } -+ -+ #if defined(CONFIG_RTW_MESH) && CONFIG_RTW_MESH_ACNODE_PREVENT -+ if (MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter)) -+ rtw_mesh_update_scanned_acnode_status(adapter, pnetwork); -+ #endif -+ -+unlock_scan_queue: -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+#ifdef CONFIG_RTW_MESH -+ if (pnetwork && MLME_IS_MESH(adapter) -+ && check_fwstate(pmlmepriv, WIFI_ASOC_STATE) -+ && !check_fwstate(pmlmepriv, WIFI_UNDER_SURVEY) -+ ) -+ rtw_chk_candidate_peer_notify(adapter, pnetwork); -+#endif -+ -+ return update_ie; -+} -+ -+void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork); -+void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork) -+{ -+ bool update_ie; -+ /* _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); -+ /* Wi-Fi driver will update the current network if the scan result of the connected AP be updated by scan. */ -+ update_ie = rtw_update_scanned_network(adapter, pnetwork); -+ -+ if (update_ie) -+ update_current_network(adapter, pnetwork); -+ -+ /* _exit_critical_bh(&queue->lock, &irqL); */ -+ -+} -+ -+#ifdef CONFIG_RTW_MULTI_AP -+void rtw_unassoc_sta_set_mode(_adapter *adapter, u8 stype, u8 mode) -+{ -+ if (stype >= UNASOC_STA_SRC_NUM -+ || mode >= UNASOC_STA_MODE_NUM) -+ return; -+ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ -+ if (adapter->mlmepriv.unassoc_sta_mode_of_stype[stype] == mode) -+ return; -+ -+ adapter->mlmepriv.unassoc_sta_mode_of_stype[stype] = mode; -+ -+ rtw_run_in_thread_cmd_wait(adapter, ((void *)(rtw_hal_rcr_set_chk_bssid_act_non)), adapter, 2000); -+} -+ -+bool rtw_unassoc_sta_src_chk(_adapter *adapter, u8 stype) -+{ -+ if (stype >= UNASOC_STA_SRC_NUM) -+ return 0; -+ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ -+ return adapter->mlmepriv.unassoc_sta_mode_of_stype[stype] == UNASOC_STA_MODE_ALL -+ || (adapter->mlmepriv.unassoc_sta_mode_of_stype[stype] == UNASOC_STA_MODE_INTERESTED -+ && adapter->mlmepriv.interested_unassoc_sta_cnt) -+ ; -+} -+ -+const char *unasoc_sta_src_str[] = { -+ "BMC", -+ "NMY_UC", -+}; -+ -+const char *unasoc_sta_mode_str[] = { -+ "DISABLED", -+ "INTERESTED", -+ "ALL", -+}; -+ -+void dump_unassoc_sta(void *sel, _adapter *adapter) -+{ -+ struct mlme_priv *mlmepriv; -+ _queue *queue; -+ _list *list, *head; -+ struct unassoc_sta_info **unassoc_sta_arr; -+ struct unassoc_sta_info *unassoc_sta; -+ u16 i, unassoc_sta_cnt = 0; -+ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ mlmepriv = &(adapter->mlmepriv); -+ queue = &(mlmepriv->unassoc_sta_queue); -+ -+ for (i = 0; i < UNASOC_STA_SRC_NUM; i++) { -+ RTW_PRINT_SEL(sel, "[%u]%-6s:%u(%s)\n", i, unasoc_sta_src_str[i] -+ , mlmepriv->unassoc_sta_mode_of_stype[i], unasoc_sta_mode_str[mlmepriv->unassoc_sta_mode_of_stype[i]]); -+ } -+ RTW_PRINT_SEL(sel, "interested_unassoc_sta_cnt:%u\n", mlmepriv->interested_unassoc_sta_cnt); -+ -+ unassoc_sta_arr = rtw_zvmalloc(mlmepriv->max_unassoc_sta_cnt * sizeof(struct unassoc_sta_info *)); -+ if (!unassoc_sta_arr) -+ return; -+ -+ enter_critical_bh(&queue->lock); -+ head = get_list_head(queue); -+ list = get_next(head); -+ -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ unassoc_sta = LIST_CONTAINOR(list, struct unassoc_sta_info, list); -+ list = get_next(list); -+ -+ unassoc_sta_arr[unassoc_sta_cnt++] = unassoc_sta; -+ } -+ -+ exit_critical_bh(&queue->lock); -+ -+ RTW_PRINT_SEL(sel, " %17s %18s %6s\n", "mac_addr", "measure_delta_time", "rssi"); -+ -+ for (i = 0; i < unassoc_sta_cnt; i++) { -+ u8 rcpi; -+ s8 rx_power; -+ u32 measure_delta_time; -+ -+ unassoc_sta = unassoc_sta_arr[i]; -+ -+ measure_delta_time = rtw_systime_to_ms(rtw_get_current_time() - unassoc_sta->time); -+ -+ RTW_PRINT_SEL(sel, "%c "MAC_FMT" %18u %6d\n" -+ , unassoc_sta->interested ? '*' : ' ' -+ , MAC_ARG(unassoc_sta->addr), measure_delta_time, unassoc_sta->recv_signal_power); -+ } -+ -+ rtw_vmfree(unassoc_sta_arr, mlmepriv->max_unassoc_sta_cnt * sizeof(struct unassoc_sta_info *)); -+} -+ -+static void del_unassoc_sta(struct mlme_priv *mlmepriv, struct unassoc_sta_info *unassoc_sta) -+{ -+ _irqL irqL; -+ _queue *free_queue = &(mlmepriv->free_unassoc_sta_queue); -+ -+ if (unassoc_sta->interested) -+ mlmepriv->interested_unassoc_sta_cnt--; -+ if (mlmepriv->interested_unassoc_sta_cnt == 0) { -+ rtw_run_in_thread_cmd(mlme_to_adapter(mlmepriv) -+ , ((void *)(rtw_hal_rcr_set_chk_bssid_act_non)), mlme_to_adapter(mlmepriv)); -+ } -+ -+ _enter_critical_bh(&free_queue->lock, &irqL); -+ rtw_list_delete(&(unassoc_sta->list)); -+ rtw_list_insert_tail(&(unassoc_sta->list), &(free_queue->queue)); -+ _exit_critical_bh(&free_queue->lock, &irqL); -+} -+ -+static u8 del_unassoc_sta_chk(struct mlme_priv *mlmepriv, struct unassoc_sta_info *unassoc_sta) -+{ -+ systime cur, lifetime; -+ -+ if (unassoc_sta == NULL) -+ return UNASOC_STA_DEL_CHK_SKIP; -+ -+ if (unassoc_sta->interested) -+ return UNASOC_STA_DEL_CHK_SKIP; -+ -+ cur = rtw_get_current_time(); -+ lifetime = unassoc_sta->time + rtw_ms_to_systime(UNASSOC_STA_LIFETIME_MS); -+ if (rtw_time_before(cur, lifetime)) -+ return UNASOC_STA_DEL_CHK_ALIVE; -+ -+ del_unassoc_sta(mlmepriv, unassoc_sta); -+ -+ return UNASOC_STA_DEL_CHK_DELETED; -+} -+ -+static struct unassoc_sta_info *alloc_unassoc_sta(struct mlme_priv *mlmepriv) -+{ -+ _irqL irqL; -+ struct unassoc_sta_info *unassoc_sta; -+ _queue *free_queue = &mlmepriv->free_unassoc_sta_queue; -+ _list *list = NULL; -+ -+ -+ _enter_critical_bh(&free_queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(free_queue) == _TRUE) { -+ unassoc_sta = NULL; -+ goto exit; -+ } -+ list = get_next(&(free_queue->queue)); -+ -+ unassoc_sta = LIST_CONTAINOR(list, struct unassoc_sta_info, list); -+ -+ rtw_list_delete(&unassoc_sta->list); -+ -+ _rtw_memset(unassoc_sta->addr, 0, ETH_ALEN); -+ unassoc_sta->recv_signal_power = 0; -+ unassoc_sta->time = 0; -+ unassoc_sta->interested = 0; -+exit: -+ _exit_critical_bh(&free_queue->lock, &irqL); -+ -+ return unassoc_sta; -+ -+} -+ -+void rtw_del_unassoc_sta_queue(_adapter *adapter) -+{ -+ struct unassoc_sta_info *unassoc_sta; -+ struct mlme_priv *mlmepriv; -+ _queue *queue; -+ _irqL irqL; -+ _list *head, *list; -+ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ mlmepriv = &(adapter->mlmepriv); -+ queue = &(mlmepriv->unassoc_sta_queue); -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ head = get_list_head(queue); -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ unassoc_sta = LIST_CONTAINOR(list , struct unassoc_sta_info, list); -+ list = get_next(list); -+ -+ del_unassoc_sta(mlmepriv, unassoc_sta); -+ } -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+} -+ -+void rtw_del_unassoc_sta(_adapter *adapter, u8 *addr) -+{ -+ struct unassoc_sta_info *unassoc_sta; -+ struct mlme_priv *mlmepriv; -+ _queue *queue; -+ _irqL irqL; -+ _list *head, *list; -+ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ mlmepriv = &(adapter->mlmepriv); -+ queue = &(mlmepriv->unassoc_sta_queue); -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ head = get_list_head(queue); -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ unassoc_sta = LIST_CONTAINOR(list , struct unassoc_sta_info, list); -+ list = get_next(list); -+ -+ if (_rtw_memcmp(addr, unassoc_sta->addr, ETH_ALEN) == _TRUE) { -+ del_unassoc_sta(mlmepriv, unassoc_sta); -+ goto unlock_unassoc_sta_queue; -+ } -+ } -+ -+unlock_unassoc_sta_queue: -+ _exit_critical_bh(&queue->lock, &irqL); -+} -+ -+void rtw_rx_add_unassoc_sta(_adapter *adapter, u8 stype, u8 *addr, s8 recv_signal_power) -+{ -+ struct unassoc_sta_info *unassoc_sta; -+ struct unassoc_sta_info *oldest_unassoc_sta = NULL; -+ struct mlme_priv *mlmepriv; -+ _queue *queue; -+ _irqL irqL; -+ _list *head, *list; -+ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ mlmepriv = &(adapter->mlmepriv); -+ queue = &(mlmepriv->unassoc_sta_queue); -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ head = get_list_head(queue); -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ unassoc_sta = LIST_CONTAINOR(list , struct unassoc_sta_info, list); -+ list = get_next(list); -+ -+ if (_rtw_memcmp(addr, unassoc_sta->addr, ETH_ALEN) == _TRUE) { -+ if (unassoc_sta->interested -+ || mlmepriv->unassoc_sta_mode_of_stype[stype] >= UNASOC_STA_MODE_ALL -+ ) { -+ unassoc_sta->recv_signal_power = recv_signal_power; -+ unassoc_sta->time = rtw_get_current_time(); -+ goto unlock_unassoc_sta_queue; -+ } -+ } -+ -+ if (del_unassoc_sta_chk(mlmepriv, unassoc_sta) == UNASOC_STA_DEL_CHK_ALIVE) { -+ if (oldest_unassoc_sta == NULL) -+ oldest_unassoc_sta = unassoc_sta; -+ else if (rtw_time_before(unassoc_sta->time, oldest_unassoc_sta->time)) -+ oldest_unassoc_sta = unassoc_sta; -+ } -+ } -+ -+ if (mlmepriv->unassoc_sta_mode_of_stype[stype] <= UNASOC_STA_MODE_INTERESTED) -+ goto unlock_unassoc_sta_queue; -+ -+ unassoc_sta = alloc_unassoc_sta(mlmepriv); -+ if (unassoc_sta == NULL) { -+ if (oldest_unassoc_sta) { -+ del_unassoc_sta(mlmepriv, oldest_unassoc_sta); -+ unassoc_sta = alloc_unassoc_sta(mlmepriv); -+ } else -+ goto unlock_unassoc_sta_queue; -+ } -+ _rtw_memcpy(unassoc_sta->addr, addr, ETH_ALEN); -+ unassoc_sta->recv_signal_power = recv_signal_power; -+ unassoc_sta->time = rtw_get_current_time(); -+ rtw_list_insert_tail(&(unassoc_sta->list), &(queue->queue)); -+ -+unlock_unassoc_sta_queue: -+ _exit_critical_bh(&queue->lock, &irqL); -+} -+ -+void rtw_add_interested_unassoc_sta(_adapter *adapter, u8 *addr) -+{ -+ struct unassoc_sta_info *unassoc_sta; -+ struct unassoc_sta_info *oldest_unassoc_sta = NULL; -+ struct mlme_priv *mlmepriv; -+ _queue *queue; -+ _irqL irqL; -+ _list *head, *list; -+ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ mlmepriv = &(adapter->mlmepriv); -+ queue = &(mlmepriv->unassoc_sta_queue); -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ head = get_list_head(queue); -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ unassoc_sta = LIST_CONTAINOR(list , struct unassoc_sta_info, list); -+ list = get_next(list); -+ -+ if (_rtw_memcmp(addr, unassoc_sta->addr, ETH_ALEN) == _TRUE) { -+ if (!unassoc_sta->interested) { -+ unassoc_sta->interested = 1; -+ mlmepriv->interested_unassoc_sta_cnt++; -+ if (mlmepriv->interested_unassoc_sta_cnt == 1) { -+ rtw_run_in_thread_cmd(mlme_to_adapter(mlmepriv) -+ , ((void *)(rtw_hal_rcr_set_chk_bssid_act_non)), mlme_to_adapter(mlmepriv)); -+ } -+ } -+ goto unlock_unassoc_sta_queue; -+ } -+ -+ if (del_unassoc_sta_chk(mlmepriv, unassoc_sta) == UNASOC_STA_DEL_CHK_ALIVE) { -+ if (oldest_unassoc_sta == NULL) -+ oldest_unassoc_sta = unassoc_sta; -+ else if (rtw_time_after(unassoc_sta->time, oldest_unassoc_sta->time)) -+ oldest_unassoc_sta = unassoc_sta; -+ } -+ } -+ unassoc_sta = alloc_unassoc_sta(mlmepriv); -+ if (unassoc_sta == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT": Allocate fail\n", FUNC_ADPT_ARG(adapter)); -+ if (oldest_unassoc_sta) { -+ RTW_INFO(FUNC_ADPT_FMT": Delete oldest entry and try again.\n", FUNC_ADPT_ARG(adapter)); -+ del_unassoc_sta(mlmepriv, oldest_unassoc_sta); -+ unassoc_sta = alloc_unassoc_sta(mlmepriv); -+ } else -+ goto unlock_unassoc_sta_queue; -+ } -+ _rtw_memcpy(unassoc_sta->addr, addr, ETH_ALEN); -+ unassoc_sta->interested = 1; -+ unassoc_sta->recv_signal_power = 0; -+ unassoc_sta->time = rtw_get_current_time() - rtw_ms_to_systime(UNASSOC_STA_LIFETIME_MS); -+ rtw_list_insert_tail(&(unassoc_sta->list), &(queue->queue)); -+ mlmepriv->interested_unassoc_sta_cnt++; -+ if (mlmepriv->interested_unassoc_sta_cnt == 1) { -+ rtw_run_in_thread_cmd(mlme_to_adapter(mlmepriv) -+ , ((void *)(rtw_hal_rcr_set_chk_bssid_act_non)), mlme_to_adapter(mlmepriv)); -+ } -+ -+unlock_unassoc_sta_queue: -+ _exit_critical_bh(&queue->lock, &irqL); -+} -+ -+void rtw_undo_interested_unassoc_sta(_adapter *adapter, u8 *addr) -+{ -+ struct unassoc_sta_info *unassoc_sta; -+ struct mlme_priv *mlmepriv; -+ _queue *queue; -+ _irqL irqL; -+ _list *head, *list; -+ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ mlmepriv = &(adapter->mlmepriv); -+ queue = &(mlmepriv->unassoc_sta_queue); -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ head = get_list_head(queue); -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ unassoc_sta = LIST_CONTAINOR(list , struct unassoc_sta_info, list); -+ list = get_next(list); -+ -+ if (_rtw_memcmp(addr, unassoc_sta->addr, ETH_ALEN) == _TRUE) { -+ if (unassoc_sta->interested) { -+ unassoc_sta->interested = 0; -+ mlmepriv->interested_unassoc_sta_cnt--; -+ if (mlmepriv->interested_unassoc_sta_cnt == 0) { -+ rtw_run_in_thread_cmd(mlme_to_adapter(mlmepriv) -+ , ((void *)(rtw_hal_rcr_set_chk_bssid_act_non)), mlme_to_adapter(mlmepriv)); -+ } -+ } -+ goto unlock_unassoc_sta_queue; -+ } -+ } -+unlock_unassoc_sta_queue: -+ _exit_critical_bh(&queue->lock, &irqL); -+} -+ -+void rtw_undo_all_interested_unassoc_sta(_adapter *adapter) -+{ -+ struct unassoc_sta_info *unassoc_sta; -+ struct mlme_priv *mlmepriv; -+ _queue *queue; -+ _irqL irqL; -+ _list *head, *list; -+ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ mlmepriv = &(adapter->mlmepriv); -+ queue = &(mlmepriv->unassoc_sta_queue); -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ head = get_list_head(queue); -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ unassoc_sta = LIST_CONTAINOR(list , struct unassoc_sta_info, list); -+ list = get_next(list); -+ -+ if (unassoc_sta->interested) { -+ unassoc_sta->interested = 0; -+ mlmepriv->interested_unassoc_sta_cnt--; -+ if (mlmepriv->interested_unassoc_sta_cnt == 0) { -+ rtw_run_in_thread_cmd(mlme_to_adapter(mlmepriv) -+ , ((void *)(rtw_hal_rcr_set_chk_bssid_act_non)), mlme_to_adapter(mlmepriv)); -+ goto unlock_unassoc_sta_queue; -+ } -+ } -+ } -+unlock_unassoc_sta_queue: -+ _exit_critical_bh(&queue->lock, &irqL); -+} -+ -+u8 rtw_search_unassoc_sta(_adapter *adapter, u8 *addr, struct unassoc_sta_info *ret_sta) -+{ -+ struct unassoc_sta_info *unassoc_sta = NULL; -+ struct mlme_priv *mlmepriv; -+ _queue *queue; -+ _irqL irqL; -+ _list *head, *list; -+ u8 searched = 0; -+ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ mlmepriv = &(adapter->mlmepriv); -+ queue = &(mlmepriv->unassoc_sta_queue); -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ head = get_list_head(queue); -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ unassoc_sta = LIST_CONTAINOR(list , struct unassoc_sta_info, list); -+ list = get_next(list); -+ -+ if (_rtw_memcmp(addr, unassoc_sta->addr, ETH_ALEN) == _TRUE) { -+ memcpy(ret_sta, unassoc_sta, sizeof(struct unassoc_sta_info)); -+ searched = 1; -+ break; -+ } -+ } -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ return searched; -+} -+#endif /* CONFIG_RTW_MULTI_AP */ -+ -+/* 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; -+ } -+ -+#ifdef CONFIG_RTW_MBO -+ if (rtw_mbo_disallowed_network(pnetwork) == _TRUE) -+ bselected = _FALSE; -+#endif -+ -+ return bselected; -+} -+ -+void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL; -+ u32 len; -+ u8 val8; -+ WLAN_BSSID_EX *pnetwork; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ pnetwork = (WLAN_BSSID_EX *)pbuf; -+ -+ len = get_WLAN_BSSID_EX_sz(pnetwork); -+ if (len > (sizeof(WLAN_BSSID_EX))) { -+ return; -+ } -+ -+#ifdef CONFIG_RTW_80211K -+ val8 = 0; -+ rtw_hal_get_hwreg(adapter, HW_VAR_FREECNT, &val8); -+ -+ /* use TSF if no free run counter */ -+ if (val8==0) -+ pnetwork->PhyInfo.free_cnt = (u32)rtw_hal_get_tsftr_by_port( -+ adapter, rtw_hal_get_port(adapter)); -+#endif -+ -+ if (pnetwork->InfrastructureMode == Ndis802_11Infrastructure) { -+ if (MLME_IS_SCAN(adapter)) { -+ adapter->mlmeextpriv.sitesurvey_res.activate_ch_cnt -+ += rtw_process_beacon_hint(adapter, pnetwork); -+ } -+ } -+ -+ _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, WIFI_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; -+ struct surveydone_event *parm = (struct surveydone_event *)pbuf; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ -+#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, WIFI_UNDER_SURVEY) == _FALSE) { -+ RTW_INFO(FUNC_ADPT_FMT" fw_state:0x%x\n", FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); -+ /* rtw_warn_on(1); */ -+ } -+ -+ if (pmlmeext->scan_abort == _TRUE) -+ pmlmeext->scan_abort = _FALSE; -+ -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_SURVEY); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ _cancel_timer_ex(&pmlmepriv->scan_to_timer); -+ -+ _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, WIFI_ASOC_STATE) == _FALSE) { -+ set_fwstate(pmlmepriv, WIFI_UNDER_LINKING); -+ -+ if (rtw_select_and_join_from_scanned_queue(pmlmepriv) == _SUCCESS) -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ #ifdef CONFIG_AP_MODE -+ else { -+ WLAN_BSSID_EX *pdev_network = &(adapter->registrypriv.dev_network); -+ u8 *pibss = adapter->registrypriv.dev_network.MacAddress; -+ -+ /* pmlmepriv->fw_state ^= WIFI_UNDER_SURVEY; */ /* because don't set assoc_timer */ -+ _clr_fwstate_(pmlmepriv, WIFI_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; -+ } -+ #endif /* CONFIG_AP_MODE */ -+ } -+ } else { -+ int s_ret; -+ set_fwstate(pmlmepriv, WIFI_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, WIFI_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) { -+ struct sitesurvey_parm scan_parm; -+ u8 ssc_chk = rtw_sitesurvey_condition_check(adapter, _FALSE); -+ -+ rtw_init_sitesurvey_parm(adapter, &scan_parm); -+ _rtw_memcpy(&scan_parm.ssid[0], &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ scan_parm.ssid_num = 1; -+ -+ if (rtw_dec_to_roam(adapter) == 0 -+ || (ssc_chk != SS_ALLOW && ssc_chk != SS_DENY_BUSY_TRAFFIC) -+ || _SUCCESS != rtw_sitesurvey_cmd(adapter, &scan_parm) -+ ) { -+ rtw_set_to_roam(adapter, 0); -+ rtw_free_assoc_resources(adapter, _TRUE); -+ rtw_indicate_disconnect(adapter, 0, _FALSE); -+ } else -+ pmlmepriv->to_join = _TRUE; -+ } else -+ rtw_indicate_disconnect(adapter, 0, _FALSE); -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_LINKING); -+ } -+ } -+ } else { -+ if (rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE) -+ #if (defined(CONFIG_RTW_WNM) && defined(CONFIG_RTW_80211R)) -+ || rtw_wnm_btm_roam_triggered(adapter) -+ #endif -+ ) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) { -+ if (rtw_select_roaming_candidate(pmlmepriv) == _SUCCESS) { -+ #ifdef CONFIG_RTW_80211R -+ rtw_ft_start_roam(adapter, -+ (u8 *)pmlmepriv->roam_network->network.MacAddress); -+ #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, WIFI_ASOC_STATE) == _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 -+ -+ if (parm->activate_ch_cnt) { -+ #ifdef CONFIG_IOCTL_CFG80211 -+ struct get_chplan_resp *chplan; -+ -+ if (rtw_get_chplan_cmd(adapter, RTW_CMDF_DIRECTLY, &chplan) != _SUCCESS -+ || rtw_regd_change_complete_async(adapter_to_wiphy(adapter), chplan) != _SUCCESS) -+ rtw_warn_on(1); -+ #endif -+ -+ op_class_pref_apply_regulatory(adapter, REG_BEACON_HINT); -+ rtw_nlrtw_reg_beacon_hint_event(adapter); -+ } -+ -+#ifdef CONFIG_RTW_MESH -+ #if CONFIG_RTW_MESH_OFFCH_CAND -+ if (rtw_mesh_offch_candidate_accepted(adapter)) { -+ u8 ch; -+ -+ ch = rtw_mesh_select_operating_ch(adapter); -+ if (ch && pmlmepriv->cur_network.network.Configuration.DSConfig != ch) { -+ u8 ifbmp = rtw_mi_get_ap_mesh_ifbmp(adapter); -+ -+ if (ifbmp) { -+ /* switch to selected channel */ -+ rtw_change_bss_chbw_cmd(adapter, RTW_CMDF_DIRECTLY, ifbmp, 0, ch, REQ_BW_ORI, REQ_OFFSET_NONE); -+ issue_probereq_ex(adapter, &pmlmepriv->cur_network.network.mesh_id, NULL, 0, 0, 0, 0); -+ } else -+ rtw_warn_on(1); -+ } -+ } -+ #endif -+#endif /* CONFIG_RTW_MESH */ -+ -+#ifdef CONFIG_RTW_ACS -+ if (parm->acs) { -+ u8 ifbmp = rtw_mi_get_ap_mesh_ifbmp(adapter); -+ -+ if (ifbmp) -+ rtw_change_bss_chbw_cmd(adapter, RTW_CMDF_DIRECTLY, ifbmp, 0, REQ_CH_INT_INFO, REQ_BW_ORI, REQ_OFFSET_NONE); -+ } -+#endif -+} -+ -+u8 _rtw_sitesurvey_condition_check(const char *caller, _adapter *adapter, bool check_sc_interval) -+{ -+ u8 ss_condition = SS_ALLOW; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct registry_priv *registry_par = &adapter->registrypriv; -+ -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mp_mode_check(adapter)) { -+ RTW_INFO("%s ("ADPT_FMT") MP mode block Scan request\n", caller, ADPT_ARG(adapter)); -+ ss_condition = SS_DENY_MP_MODE; -+ goto _exit; -+ } -+#endif -+ -+#ifdef DBG_LA_MODE -+ if(registry_par->la_mode_en == 1 && MLME_IS_ASOC(adapter)) { -+ RTW_INFO("%s ("ADPT_FMT") LA debug mode block Scan request\n", caller, ADPT_ARG(adapter)); -+ ss_condition = SS_DENY_LA_MODE; -+ goto _exit; -+ } -+#endif -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ if (adapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) { -+ RTW_INFO("%s ("ADPT_FMT") blocking scan for under rson scanning process\n", caller, ADPT_ARG(adapter)); -+ ss_condition = SS_DENY_RSON_SCANING; -+ goto _exit; -+ } -+#endif -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(adapter)->block_scan == _TRUE) { -+ RTW_INFO("%s ("ADPT_FMT") wdev_priv.block_scan is set\n", caller, ADPT_ARG(adapter)); -+ ss_condition = SS_DENY_BLOCK_SCAN; -+ goto _exit; -+ } -+#endif -+ -+ if (adapter_to_dvobj(adapter)->scan_deny == _TRUE) { -+ RTW_INFO("%s ("ADPT_FMT") tpt mode, scan deny!\n", caller, ADPT_ARG(adapter)); -+ ss_condition = SS_DENY_BLOCK_SCAN; -+ goto _exit; -+ } -+ -+ if (rtw_is_scan_deny(adapter)) { -+ RTW_INFO("%s ("ADPT_FMT") : scan deny\n", caller, ADPT_ARG(adapter)); -+ ss_condition = SS_DENY_BY_DRV; -+ goto _exit; -+ } -+ -+#ifdef CONFIG_ADAPTIVITY_DENY_SCAN -+ if (adapter_to_rfctl(adapter)->adaptivity_en -+ && rtw_phydm_get_edcca_flag(adapter) -+ && rtw_is_2g_ch(GET_HAL_DATA(adapter)->current_channel)) { -+ RTW_WARN(FUNC_ADPT_FMT": Adaptivity block scan! (ch=%u)\n", -+ FUNC_ADPT_ARG(adapter), -+ GET_HAL_DATA(adapter)->current_channel); -+ ss_condition = SS_DENY_ADAPTIVITY; -+ goto _exit; -+ } -+#endif /* CONFIG_ADAPTIVITY_DENY_SCAN */ -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)){ -+ if(check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { -+ RTW_INFO("%s ("ADPT_FMT") : scan abort!! AP mode process WPS\n", caller, ADPT_ARG(adapter)); -+ ss_condition = SS_DENY_SELF_AP_UNDER_WPS; -+ goto _exit; -+ } else if (check_fwstate(pmlmepriv, WIFI_UNDER_LINKING) == _TRUE) { -+ RTW_INFO("%s ("ADPT_FMT") : scan abort!!AP mode under linking (fwstate=0x%x)\n", -+ caller, ADPT_ARG(adapter), pmlmepriv->fw_state); -+ ss_condition = SS_DENY_SELF_AP_UNDER_LINKING; -+ goto _exit; -+ } else if (check_fwstate(pmlmepriv, WIFI_UNDER_SURVEY) == _TRUE) { -+ RTW_INFO("%s ("ADPT_FMT") : scan abort!!AP mode under survey (fwstate=0x%x)\n", -+ caller, ADPT_ARG(adapter), pmlmepriv->fw_state); -+ ss_condition = SS_DENY_SELF_AP_UNDER_SURVEY; -+ goto _exit; -+ } -+ } else { -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_LINKING) == _TRUE) { -+ RTW_INFO("%s ("ADPT_FMT") : scan abort!!STA mode under linking (fwstate=0x%x)\n", -+ caller, ADPT_ARG(adapter), pmlmepriv->fw_state); -+ ss_condition = SS_DENY_SELF_STA_UNDER_LINKING; -+ goto _exit; -+ } else if (check_fwstate(pmlmepriv, WIFI_UNDER_SURVEY) == _TRUE) { -+ RTW_INFO("%s ("ADPT_FMT") : scan abort!!STA mode under survey (fwstate=0x%x)\n", -+ caller, ADPT_ARG(adapter), pmlmepriv->fw_state); -+ ss_condition = SS_DENY_SELF_STA_UNDER_SURVEY; -+ goto _exit; -+ } -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(adapter, WIFI_UNDER_LINKING | WIFI_UNDER_WPS)) { -+ RTW_INFO("%s ("ADPT_FMT") : scan abort!! buddy_intf under linking or wps\n", caller, ADPT_ARG(adapter)); -+ ss_condition = SS_DENY_BUDDY_UNDER_LINK_WPS; -+ goto _exit; -+ -+ } else if (rtw_mi_buddy_check_fwstate(adapter, WIFI_UNDER_SURVEY)) { -+ RTW_INFO("%s ("ADPT_FMT") : scan abort!! buddy_intf under survey\n", caller, ADPT_ARG(adapter)); -+ ss_condition = SS_DENY_BUDDY_UNDER_SURVEY; -+ goto _exit; -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+#ifdef RTW_BUSY_DENY_SCAN -+ /* -+ * busy traffic check -+ * Rules: -+ * 1. If (scan interval <= BUSY_TRAFFIC_SCAN_DENY_PERIOD) always allow -+ * scan, otherwise goto rule 2. -+ * 2. Deny scan if any interface is busy, otherwise allow scan. -+ */ -+ if (pmlmepriv->lastscantime -+ && (rtw_get_passing_time_ms(pmlmepriv->lastscantime) > -+ registry_par->scan_interval_thr) -+ && rtw_mi_busy_traffic_check(adapter)) { -+ RTW_WARN("%s ("ADPT_FMT") : scan abort!! BusyTraffic\n", -+ caller, ADPT_ARG(adapter)); -+ ss_condition = SS_DENY_BUSY_TRAFFIC; -+ goto _exit; -+ } -+#endif /* RTW_BUSY_DENY_SCAN */ -+ -+_exit: -+ return ss_condition; -+} -+ -+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(_adapter *adapter) -+{ -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ -+ precvpriv->dbg_rx_ampdu_drop_count = 0; -+ precvpriv->dbg_rx_ampdu_forced_indicate_count = 0; -+ precvpriv->dbg_rx_ampdu_loss_count = 0; -+ precvpriv->dbg_rx_dup_mgt_frame_drop_count = 0; -+ precvpriv->dbg_rx_ampdu_window_shift_cnt = 0; -+ precvpriv->dbg_rx_drop_count = 0; -+ precvpriv->dbg_rx_conflic_mac_addr_cnt = 0; -+} -+ -+/* -+*rtw_free_assoc_resources: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_free_assoc_resources(_adapter *adapter, u8 lock_scanned_queue) -+{ -+ _irqL irqL; -+ struct wlan_network *pwlan = NULL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ -+ -+#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 -+ rtw_free_all_tdls_sta(adapter, _TRUE); -+ rtw_reset_tdls_info(adapter); -+ -+ if (ptdlsinfo->link_established == _TRUE) -+ rtw_tdls_cmd(adapter, NULL, TDLS_RS_RCR); -+#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); -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS) || (pmlmepriv->wpa_phase == _TRUE)){ -+ RTW_INFO("Dont free disconnecting network of scanned_queue due to uner %s %s phase\n\n", -+ check_fwstate(pmlmepriv, WIFI_UNDER_WPS) ? "WPS" : "", -+ (pmlmepriv->wpa_phase == _TRUE) ? "WPA" : ""); -+ } else { -+ pwlan = _rtw_find_same_network(&pmlmepriv->scanned_queue, tgt_network); -+ if (pwlan) { -+ 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_set_scan_deny(adapter, 2000); -+ /* rtw_clear_scan_deny(adapter); */ -+ } -+#endif /* CONFIG_P2P */ -+ } else -+ RTW_ERR("Free disconnecting network of scanned_queue failed due to pwlan == NULL\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(adapter); -+ -+ -+} -+ -+/* -+*rtw_indicate_connect: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_indicate_connect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ pmlmepriv->to_join = _FALSE; -+ -+ if (!check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) { -+ -+ set_fwstate(pmlmepriv, WIFI_ASOC_STATE); -+ -+ rtw_led_control(padapter, LED_CTL_LINK); -+ -+ rtw_os_indicate_connect(padapter); -+ -+ #ifdef CONFIG_RTW_WDS -+ if (MLME_IS_STA(padapter)) -+ rtw_wds_gptr_tbl_init(padapter); -+ #endif -+ } -+ -+ rtw_set_to_roam(padapter, 0); -+ if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) -+ 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); -+#ifdef CONFIG_WAPI_SUPPORT -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+#endif -+ u8 *wps_ie = NULL; -+ uint wpsie_len = 0; -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) -+ pmlmepriv->wpa_phase = _TRUE; -+ -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS | WIFI_OP_CH_SWITCHING | WIFI_UNDER_KEY_HANDSHAKE); -+ -+ /* 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, WIFI_ASOC_STATE); -+ -+#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->cmn.mac_addr); -+ 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, WIFI_ASOC_STATE) -+ || (rtw_to_roam(padapter) <= 0) -+ ) { -+ #ifdef CONFIG_RTW_WDS -+ adapter_set_use_wds(padapter, 0); -+ rtw_wds_gptr_tbl_unregister(padapter); -+ #endif -+ #ifdef CONFIG_RTW_MULTI_AP -+ padapter->multi_ap = 0; -+ #endif -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (ATOMIC_READ(&padapter->tbtx_tx_pause) == _TRUE) { -+ ATOMIC_SET(&padapter->tbtx_tx_pause, _FALSE); -+ rtw_tx_control_cmd(padapter); -+ } -+#endif -+ -+ 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, WIFI_ASOC_STATE); -+ -+ 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, 0); -+#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) -+{ -+ systime 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, WIFI_UNDER_SURVEY) -+ && rtw_get_passing_time_ms(start) <= timeout_ms) { -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ break; -+ -+ RTW_INFO(FUNC_NDEV_FMT"fw_state=WIFI_UNDER_SURVEY!\n", FUNC_NDEV_ARG(adapter->pnetdev)); -+ rtw_msleep_os(20); -+ } -+ -+ if (_TRUE == abort) { -+ if (check_fwstate(pmlmepriv, WIFI_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, WIFI_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) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct ss_res *ss = &pmlmeext->sitesurvey_res; -+ -+ _rtw_wait_scan_done(adapter, _FALSE, ss->scan_timeout_ms); -+} -+ -+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, WIFI_UNDER_SURVEY)) -+ pmlmeext->scan_abort = _TRUE; -+} -+ -+void rtw_scan_abort(_adapter *adapter) -+{ -+ rtw_scan_abort_timeout(adapter, 200); -+} -+ -+static u32 _rtw_wait_join_done(_adapter *adapter, u8 abort, u32 timeout_ms) -+{ -+ systime start; -+ u32 pass_ms; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ start = rtw_get_current_time(); -+ -+ pmlmeext->join_abort = abort; -+ if (abort) -+ set_link_timer(pmlmeext, 1); -+ -+ while (rtw_get_passing_time_ms(start) <= timeout_ms -+ && (check_fwstate(pmlmepriv, WIFI_UNDER_LINKING) -+ #ifdef CONFIG_IOCTL_CFG80211 -+ || rtw_cfg80211_is_connect_requested(adapter) -+ #endif -+ ) -+ ) { -+ if (RTW_CANNOT_RUN(adapter)) -+ break; -+ -+ RTW_INFO(FUNC_ADPT_FMT" linking...\n", FUNC_ADPT_ARG(adapter)); -+ rtw_msleep_os(20); -+ } -+ -+ if (abort) { -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_LINKING) -+ #ifdef CONFIG_IOCTL_CFG80211 -+ || rtw_cfg80211_is_connect_requested(adapter) -+ #endif -+ ) { -+ if (!RTW_CANNOT_RUN(adapter)) -+ RTW_INFO(FUNC_ADPT_FMT" waiting for join_abort time out!\n", FUNC_ADPT_ARG(adapter)); -+ } -+ } -+ -+ pmlmeext->join_abort = 0; -+ pass_ms = rtw_get_passing_time_ms(start); -+ -+ return pass_ms; -+} -+ -+u32 rtw_join_abort_timeout(_adapter *adapter, u32 timeout_ms) -+{ -+ return _rtw_wait_join_done(adapter, _TRUE, timeout_ms); -+} -+ -+static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wlan_network *pnetwork) -+{ -+ int i; -+ struct sta_info *psta = NULL; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+#if defined(CONFIG_RTS_FULL_BW) || defined(CONFIG_RTW_MULTI_AP) -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+#endif -+#ifdef CONFIG_RTS_FULL_BW -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+#endif -+ -+ 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->cmn.aid = pnetwork->join_res; -+ -+ 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_ra_info(padapter, psta); -+ -+ psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ rtw_hal_update_sta_wset(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 -+ u8 *ie; -+ sint ie_len; -+ u8 mfp_opt = MFP_NO; -+ u8 spp_opt = 0; -+ -+ padapter->securitypriv.binstallGrpkey = _FALSE; -+ padapter->securitypriv.busetkipkey = _FALSE; -+ padapter->securitypriv.bgrpkey_handshake = _FALSE; -+ -+ ie = rtw_get_ie(pnetwork->network.IEs + _BEACON_IE_OFFSET_, WLAN_EID_RSN -+ , &ie_len, (pnetwork->network.IELength - _BEACON_IE_OFFSET_)); -+ if (ie && ie_len > 0 -+ && rtw_parse_wpa2_ie(ie, ie_len + 2, NULL, NULL, NULL, NULL, &mfp_opt, &spp_opt) == _SUCCESS -+ ) { -+ if (padapter->securitypriv.mfp_opt >= MFP_OPTIONAL && mfp_opt >= MFP_OPTIONAL) -+ psta->flags |= WLAN_STA_MFP; -+ } -+ -+ if (padapter->securitypriv.dot11PrivacyAlgrthm != _NO_PRIVACY_ ) { -+ /*check if amsdu is allowed */ -+ if (rtw_check_amsdu_disable(padapter->registrypriv.amsdu_mode, spp_opt) == _TRUE) -+ psta->flags |= WLAN_STA_AMSDU_DISABLE; -+ } -+ 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)); -+ } -+ -+ /* 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 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; -+ rtw_clear_bit(RTW_RECV_ACK_OR_TIMEOUT, &preorder_ctrl->rec_abba_rsp_ack); -+ #ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_CLEAR indicate_seq:%u preorder_ctrl->rec_abba_rsp_ack:%lu\n" -+ , FUNC_ADPT_ARG(padapter) -+ , i -+ , preorder_ctrl->indicate_seq -+ ,preorder_ctrl->rec_abba_rsp_ack -+ ); -+ #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; -+ } -+ } -+ -+#ifdef CONFIG_RTW_80211K -+ _rtw_memcpy(&psta->rm_en_cap, pnetwork->network.PhyInfo.rm_en_cap, 5); -+#endif -+#ifdef CONFIG_RTW_MULTI_AP -+ if (padapter->multi_ap & MULTI_AP_BACKHAUL_STA) { -+ u8 multi_ap = rtw_get_multi_ap_ie_ext(pmlmepriv->assoc_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6 -+ , pmlmepriv->assoc_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6); -+ -+ if (multi_ap & MULTI_AP_BACKHAUL_BSS) /* backhaul bss, enable WDS */ -+ psta->flags |= WLAN_STA_MULTI_AP | WLAN_STA_WDS; -+ else if (multi_ap & MULTI_AP_FRONTHAUL_BSS) /* fronthaul bss only */ -+ psta->flags |= WLAN_STA_MULTI_AP; -+ } -+#endif -+#ifdef CONFIG_RTS_FULL_BW -+ rtw_parse_sta_vendor_ie_8812(padapter, psta, BSS_EX_TLV_IES(&cur_network->network), BSS_EX_TLV_IES_LEN(&cur_network->network)); -+#endif -+ 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 security_priv *psecuritypriv = &padapter->securitypriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ sint tmp_fw_state = 0x0; -+ -+ 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 WIFI_UNDER_LINKING here indirectly */ -+ -+ switch (pnetwork->network.InfrastructureMode) { -+ case Ndis802_11Infrastructure: -+ /* Check encryption */ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) -+ tmp_fw_state = tmp_fw_state | WIFI_UNDER_KEY_HANDSHAKE; -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) -+ tmp_fw_state = tmp_fw_state | WIFI_UNDER_WPS; -+ -+ init_fwstate(pmlmepriv, WIFI_STATION_STATE | tmp_fw_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, u16 status) -+{ -+ _irqL irqL; -+ static u8 retry = 0; -+ 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; -+ -+ 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 exit; -+ -+ _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, WIFI_UNDER_LINKING)) { -+ /* s1. find ptarget_wlan */ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) { -+ 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; -+ } -+ -+ /* Queue TX packets before FW/HW ready */ -+ /* clear in mlmeext_joinbss_event_callback() */ -+ rtw_xmit_queue_set(ptarget_sta); -+ } -+ -+ /* 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_ex(&pmlmepriv->assoc_timer); -+ -+ -+ } 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); -+ pmlmepriv->join_status = status; -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ -+ /* rtw_free_assoc_resources(adapter, _TRUE); */ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_UNDER_LINKING)) == _TRUE) { -+ _clr_fwstate_(pmlmepriv, WIFI_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, WIFI_UNDER_LINKING); -+ rtw_indicate_connect(adapter); -+ } else { -+#endif -+ pmlmepriv->join_status = status; -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ /* rtw_free_assoc_resources(adapter, _TRUE); */ -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_LINKING); -+ -+#ifdef REJOIN -+ retry = 0; -+ } -+#endif -+ } -+ -+ignore_joinbss_callback: -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+exit: -+ return; -+} -+ -+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->cmn.mac_id >= macid_ctl->num) { -+ RTW_PRINT(FUNC_ADPT_FMT" invalid macid:%u\n" -+ , FUNC_ADPT_ARG(adapter), sta->cmn.mac_id); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ if (!rtw_macid_is_used(macid_ctl, sta->cmn.mac_id)) { -+ RTW_PRINT(FUNC_ADPT_FMT" macid:%u not is used, set connected to 0\n" -+ , FUNC_ADPT_ARG(adapter), sta->cmn.mac_id); -+ connected = 0; -+ rtw_warn_on(1); -+ } -+ -+ if (connected && !rtw_macid_is_bmc(macid_ctl, sta->cmn.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; -+ else if (MLME_IS_MESH(adapter)) -+ role = H2C_MSR_ROLE_MESH; -+ -+#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->cmn.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, CMD_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 CONFIG_RTW_MACADDR_ACL -+ if (rtw_access_ctrl(adapter, pstassoc->macaddr) == _FALSE) -+ return; -+#endif -+ -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ if (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { -+ 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); -+ -+#ifdef CONFIG_MCC_MODE -+ rtw_hal_mcc_update_macid_bitmap(adapter, psta->cmn.mac_id, _TRUE); -+#endif /* CONFIG_MCC_MODE */ -+ -+#ifndef CONFIG_AUTO_AP_MODE -+ ap_sta_info_defer_update(adapter, psta); -+ -+ if (!MLME_IS_MESH(adapter)) { -+ /* 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); -+ } -+ } -+ _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); -+ -+ #ifdef CONFIG_PLATFORM_CMAP_INTFS -+ if (MLME_IS_AP(adapter)) { -+ cmap_intfs_nl_sta_event(psta->cmn.mac_addr, adapter_mac_addr(adapter), 1 -+ , psta->passoc_req + IEEE80211_3ADDR_LEN, psta->assoc_req_len - IEEE80211_3ADDR_LEN); -+ } -+ #endif -+ } -+ 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_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: -+#ifdef CONFIG_RTS_FULL_BW -+ rtw_set_rts_bw(adapter); -+#endif/*CONFIG_RTS_FULL_BW*/ -+ return; -+} -+ -+#ifdef CONFIG_IEEE80211W -+void rtw_sta_timeout_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+#ifdef CONFIG_AP_MODE -+ _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--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (psta->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt--; -+ #endif -+ 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_AP_MODE */ -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+void rtw_sta_mstatus_disc_rpt(_adapter *adapter, u8 mac_id) -+{ -+ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; -+ -+ if (mac_id < macid_ctl->num) { -+ u8 id_is_shared = mac_id == RTW_DEFAULT_MGMT_MACID; /* TODO: real shared macid judgment */ -+ -+ RTW_INFO(FUNC_ADPT_FMT" - mac_id=%d%s\n", FUNC_ADPT_ARG(adapter) -+ , mac_id, id_is_shared ? " shared" : ""); -+ -+ if (!id_is_shared) { -+ rtw_hal_macid_drop(adapter, mac_id); -+ 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, WIFI_ASOC_STATE)) { -+ psta = rtw_get_stainfo(&adapter->stapriv, tgt_network->network.MacAddress); -+ if (psta) -+ rtw_sta_mstatus_disc_rpt(adapter, psta->cmn.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); -+ } -+ } -+} -+ -+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 wlan_network *tgt_network = &(pmlmepriv->cur_network); -+ -+ RTW_INFO("%s(mac_id=%d)=" MAC_FMT "\n", __func__, pstadel->mac_id, MAC_ARG(pstadel->macaddr)); -+#ifdef CONFIG_LAYER2_ROAMING -+ if (pmlmepriv->roam_network) -+ rtw_msleep_os(RTW_ROAM_DICONNECT_DELAY); -+#endif -+ rtw_sta_mstatus_disc_rpt(adapter, pstadel->mac_id); -+ -+#ifdef CONFIG_MCC_MODE -+ rtw_hal_mcc_update_macid_bitmap(adapter, pstadel->mac_id, _FALSE); -+#endif /* CONFIG_MCC_MODE */ -+ -+ 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 (MLME_IS_MESH(adapter)) { -+ rtw_free_stainfo(adapter, psta); -+ goto exit; -+ } -+ -+#ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(adapter)) { -+#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 */ -+ -+ #ifdef CONFIG_PLATFORM_CMAP_INTFS -+ cmap_intfs_nl_sta_event(pstadel->macaddr, adapter_mac_addr(adapter), 0, NULL, 0); -+ #endif -+ -+ rtw_free_stainfo(adapter, psta); -+ -+ goto exit; -+ } -+#endif /* CONFIG_AP_MODE */ -+ -+ 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 (rtw_ft_roam_expired(adapter, reason)) -+ pmlmepriv->ft_roam.ft_roam_on_expired = _TRUE; -+ else -+ pmlmepriv->ft_roam.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_RTW_80211R -+ if (reason == WLAN_REASON_ACTIVE_ROAM && rtw_ft_chk_flags(adapter, RTW_FT_BTM_ROAM)) { -+ roam = _TRUE; -+ roam_target = pmlmepriv->roam_network; -+ } -+#endif -+ -+ 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, _TRUE); -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ -+ rtw_indicate_disconnect(adapter, *(u16 *)pstadel->rsvd, pstadel->locally_generated); -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ _rtw_roaming(adapter, roam_target); -+#endif -+ } -+ -+#ifdef CONFIG_AP_MODE -+ 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"); -+ -+ } -+ -+ } -+#endif /* CONFIG_AP_MODE */ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL2); -+exit: -+ #ifdef CONFIG_RTS_FULL_BW -+ rtw_set_rts_bw(adapter); -+ #endif/*CONFIG_RTS_FULL_BW*/ -+ return; -+} -+ -+void rtw_wmm_event_callback(PADAPTER padapter, u8 *pbuf) -+{ -+ -+ WMMOnAssocRsp(padapter); -+ -+ -+} -+ -+/* -+* rtw_join_timeout_handler - Timeout/failure handler for CMD JoinBss -+*/ -+void rtw_join_timeout_handler(void *ctx) -+{ -+ _adapter *adapter = (_adapter *)ctx; -+ _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 { -+ RTW_INFO("%s We've try roaming but fail\n", __FUNCTION__); -+#ifdef CONFIG_RTW_80211R -+ rtw_ft_clr_flags(adapter, RTW_FT_PEER_EN|RTW_FT_PEER_OTD_EN); -+ rtw_ft_reset_status(adapter); -+#endif -+ rtw_indicate_disconnect(adapter, pmlmepriv->join_status, _FALSE); -+ break; -+ } -+ } -+ -+ } else -+#endif -+ { -+ rtw_indicate_disconnect(adapter, pmlmepriv->join_status, _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, pmlmepriv->join_status, _FALSE); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ } -+ -+ pmlmepriv->join_status = 0; /* reset */ -+ -+ _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(void *ctx) -+{ -+ _adapter *adapter = (_adapter *)ctx; -+ _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, WIFI_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) -+{ -+#if defined(CONFIG_RTW_MESH) && defined(CONFIG_DFS_MASTER) -+#if CONFIG_RTW_MESH_OFFCH_CAND -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+#endif -+#endif -+ 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; -+ } -+ -+#ifdef CONFIG_RTW_MESH -+ #if CONFIG_RTW_MESH_OFFCH_CAND -+ if (adapter->mesh_cfg.peer_sel_policy.offch_find_int_ms -+ && rtw_mesh_offch_candidate_accepted(adapter) -+ #ifdef CONFIG_DFS_MASTER -+ && (!rfctl->radar_detect_ch || (IS_CH_WAITING(rfctl) && !IS_UNDER_CAC(rfctl))) -+ #endif -+ ) { -+ interval_ms = rtw_min(interval_ms, adapter->mesh_cfg.peer_sel_policy.offch_find_int_ms); -+ *reason |= RTW_AUTO_SCAN_REASON_MESH_OFFCH_CAND; -+ } -+ #endif -+#endif /* CONFIG_RTW_MESH */ -+ -+ 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 sitesurvey_parm parm; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ int i; -+#if 1 -+ u8 ssc_chk; -+ -+ ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); -+ if( ssc_chk == SS_DENY_BUSY_TRAFFIC) { -+ #ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE) && pmlmepriv->need_to_roam == _TRUE) -+ RTW_INFO(FUNC_ADPT_FMT" need to roam, don't care BusyTraffic\n", FUNC_ADPT_ARG(padapter)); -+ else -+ #endif -+ { -+ RTW_INFO(FUNC_ADPT_FMT" exit BusyTraffic\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ } -+ else if (ssc_chk != SS_ALLOW) -+ goto exit; -+ -+ if (!rtw_is_adapter_up(padapter)) -+ goto exit; -+#else -+ if (rtw_is_scan_deny(padapter)) -+ goto exit; -+ -+ if (!rtw_is_adapter_up(padapter)) -+ goto exit; -+ -+ if (rtw_mi_busy_traffic_check(padapter)) { -+#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, (WIFI_UNDER_SURVEY | WIFI_UNDER_LINKING)) == _TRUE) { -+ RTW_INFO(FUNC_ADPT_FMT" WIFI_UNDER_SURVEY|WIFI_UNDER_LINKING\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, (WIFI_UNDER_SURVEY | WIFI_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 -+#endif -+ -+ RTW_INFO(FUNC_ADPT_FMT" reason:0x%02x\n", FUNC_ADPT_ARG(padapter), reason); -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if ((reason == RTW_AUTO_SCAN_REASON_ROAM_ACTIVE) && -+ (rtw_get_passing_time_ms(pmlmepriv->last_roaming) >= pmlmepriv->roam_scan_int*2000)) -+ pmlmepriv->last_roaming = rtw_get_current_time(); -+ else -+ goto exit; -+#endif -+ /* only for 20/40 BSS */ -+ if (reason == RTW_AUTO_SCAN_REASON_2040_BSS) { -+ rtw_init_sitesurvey_parm(padapter, &parm); -+ for (i=0;i<14;i++) { -+ parm.ch[i].hw_value = i + 1; -+ parm.ch[i].flags = RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ } -+ parm.ch_num = 14; -+ rtw_set_802_11_bssid_list_scan(padapter, &parm); -+ goto exit; -+ } -+ -+#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) -+ if ((reason == RTW_AUTO_SCAN_REASON_ROAM) -+ && (rtw_roam_nb_scan_list_set(padapter, &parm))) -+ goto exit; -+#endif -+ -+ rtw_init_sitesurvey_parm(padapter, &parm); -+ parm.reason = reason; -+ rtw_set_802_11_bssid_list_scan(padapter, &parm); -+exit: -+ return; -+} -+ -+static void rtw_auto_scan_handler(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 reason = RTW_AUTO_SCAN_REASON_UNSPECIFIED; -+#ifdef CONFIG_LAYER2_ROAMING -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+#endif -+ -+ 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 -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if (is_client_associated_to_ap(padapter) && -+ 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) { -+#ifdef CONFIG_RTW_80211K -+ rtw_roam_nb_discover(padapter, _FALSE); -+#endif -+ pmlmepriv->need_to_roam = _TRUE; -+ reason = RTW_AUTO_SCAN_REASON_ROAM_ACTIVE; -+ goto do_scan; -+ } else -+ pmlmepriv->need_to_roam = _FALSE; -+ } -+#endif -+ -+ if (pmlmepriv->auto_scan_int_ms == 0 -+ || rtw_get_passing_time_ms(pmlmepriv->scan_start_time) < pmlmepriv->auto_scan_int_ms) -+ goto exit; -+ -+do_scan: -+ 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, 0); */ -+ rtw_hal_dm_watchdog_in_lps(adapter); -+ } else { -+ /* call rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0) in traffic_status_watchdog() */ -+ } -+ } -+ #endif /* CONFIG_LPS_LCLK_WD_TIMER */ -+ -+ /* auto site survey */ -+ rtw_auto_scan_handler(adapter); -+ -+#ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(adapter)|| MLME_IS_MESH(adapter)) { -+ #ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ expire_timeout_chk(adapter); -+ #endif /* !CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ -+ #ifdef CONFIG_BMC_TX_RATE_SELECT -+ rtw_update_bmc_sta_tx_rate(adapter); -+ #endif /*CONFIG_BMC_TX_RATE_SELECT*/ -+ } -+#endif /*CONFIG_AP_MODE*/ -+ -+ -+#ifdef CONFIG_BR_EXT -+if (!adapter_use_wds(adapter)) { -+#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 */ -+ -+} -+ -+/*TP_avg(t) = (1/10) * TP_avg(t-1) + (9/10) * TP(t) MBps*/ -+static void collect_sta_traffic_statistics(_adapter *adapter) -+{ -+ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; -+ struct sta_info *sta; -+ u64 curr_tx_bytes = 0, curr_rx_bytes = 0; -+ u32 curr_tx_mbytes = 0, curr_rx_mbytes = 0; -+ int i; -+ -+ for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { -+ sta = macid_ctl->sta[i]; -+ if (sta && !is_broadcast_mac_addr(sta->cmn.mac_addr)) { -+ if (sta->sta_stats.last_tx_bytes > sta->sta_stats.tx_bytes) -+ sta->sta_stats.last_tx_bytes = sta->sta_stats.tx_bytes; -+ if (sta->sta_stats.last_rx_bytes > sta->sta_stats.rx_bytes) -+ sta->sta_stats.last_rx_bytes = sta->sta_stats.rx_bytes; -+ if (sta->sta_stats.last_rx_bc_bytes > sta->sta_stats.rx_bc_bytes) -+ sta->sta_stats.last_rx_bc_bytes = sta->sta_stats.rx_bc_bytes; -+ if (sta->sta_stats.last_rx_mc_bytes > sta->sta_stats.rx_mc_bytes) -+ sta->sta_stats.last_rx_mc_bytes = sta->sta_stats.rx_mc_bytes; -+ -+ curr_tx_bytes = sta->sta_stats.tx_bytes - sta->sta_stats.last_tx_bytes; -+ curr_rx_bytes = sta->sta_stats.rx_bytes - sta->sta_stats.last_rx_bytes; -+ sta->sta_stats.tx_tp_kbits = (curr_tx_bytes * 8 / 2) >> 10;/*Kbps*/ -+ sta->sta_stats.rx_tp_kbits = (curr_rx_bytes * 8 / 2) >> 10;/*Kbps*/ -+ -+ sta->sta_stats.smooth_tx_tp_kbits = (sta->sta_stats.smooth_tx_tp_kbits * 6 / 10) + (sta->sta_stats.tx_tp_kbits * 4 / 10);/*Kbps*/ -+ sta->sta_stats.smooth_rx_tp_kbits = (sta->sta_stats.smooth_rx_tp_kbits * 6 / 10) + (sta->sta_stats.rx_tp_kbits * 4 / 10);/*Kbps*/ -+ -+ curr_tx_mbytes = (curr_tx_bytes / 2) >> 20;/*MBps*/ -+ curr_rx_mbytes = (curr_rx_bytes / 2) >> 20;/*MBps*/ -+ -+ sta->cmn.tx_moving_average_tp = -+ (sta->cmn.tx_moving_average_tp / 10) + (curr_tx_mbytes * 9 / 10); /*MBps*/ -+ -+ sta->cmn.rx_moving_average_tp = -+ (sta->cmn.rx_moving_average_tp / 10) + (curr_rx_mbytes * 9 /10); /*MBps*/ -+ -+ rtw_collect_bcn_info(sta->padapter); -+ -+ if (adapter->bsta_tp_dump) -+ dump_sta_traffic(RTW_DBGDUMP, adapter, sta); -+ -+ sta->sta_stats.last_tx_bytes = sta->sta_stats.tx_bytes; -+ sta->sta_stats.last_rx_bytes = sta->sta_stats.rx_bytes; -+ sta->sta_stats.last_rx_bc_bytes = sta->sta_stats.rx_bc_bytes; -+ sta->sta_stats.last_rx_mc_bytes = sta->sta_stats.rx_mc_bytes; -+ } -+ } -+} -+ -+void rtw_sta_traffic_info(void *sel, _adapter *adapter) -+{ -+ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; -+ 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->cmn.mac_addr)) -+ dump_sta_traffic(sel, adapter, sta); -+ } -+} -+ -+/*#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);/*Mbps*/ -+ pdvobjpriv->traffic_stat.cur_rx_tp = (u32)(pdvobjpriv->traffic_stat.cur_rx_bytes * 8 / 2 / 1024 / 1024);/*Mbps*/ -+ -+ #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 (Mbps)\n", pdvobjpriv->traffic_stat.cur_tx_tp); -+ RTW_INFO("cur_rx_tp:%d (Mbps)\n", pdvobjpriv->traffic_stat.cur_rx_tp); -+ #endif -+ -+#ifdef CONFIG_RTW_NAPI -+#ifdef CONFIG_RTW_NAPI_DYNAMIC -+ dynamic_napi_th_chk (padapter); -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+#endif -+ -+} -+ -+void rtw_dynamic_check_timer_handlder(void *ctx) -+{ -+ struct dvobj_priv *pdvobj = (struct dvobj_priv *)ctx; -+ _adapter *adapter = dvobj_get_primary_adapter(pdvobj); -+ -+ if (!adapter) -+ goto exit; -+ -+#if (MP_DRIVER == 1) -+ if (adapter->registrypriv.mp_mode == 1 && adapter->mppriv.mp_dm == 0) { /* for MP ODM dynamic Tx power tracking */ -+ /* RTW_INFO("%s mp_dm =0 return\n", __func__); */ -+ goto exit; -+ } -+#endif -+ -+ if (!rtw_is_hw_init_completed(adapter)) -+ goto exit; -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ goto exit; -+ -+ collect_traffic_statistics(adapter); -+ collect_sta_traffic_statistics(adapter); -+ rtw_mi_dynamic_check_timer_handlder(adapter); -+ -+ if (!is_drv_in_lps(adapter)) -+ rtw_dynamic_chk_wk_cmd(adapter); -+ -+exit: -+ _set_timer(&pdvobj->dynamic_chk_timer, 2000); -+} -+ -+ -+#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(void *ctx) -+{ -+ _adapter *adapter = (_adapter *)ctx; -+ -+ 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); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ RT_CHANNEL_INFO *chset = rfctl->channel_set; -+ u8 ch = competitor->network.Configuration.DSConfig; -+ -+ if (rtw_chset_search_ch(chset, ch) < 0) -+ goto exit; -+ if (IS_DFS_SLAVE_WITH_RD(rfctl) -+ && !rtw_rfctl_dfs_domain_unknown(rfctl) -+ && rtw_chset_is_ch_non_ocp(chset, ch)) -+ goto exit; -+ -+#if defined(CONFIG_RTW_REPEATER_SON) && (!defined(CONFIG_RTW_REPEATER_SON_ROOT)) -+ if (rtw_rson_isupdate_roamcan(mlme, candidate, competitor)) -+ goto update; -+ goto exit; -+#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_RTW_ROAM_QUICKSCAN -+ if (competitor->network.PhyInfo.SignalStrength > CONFIG_RTW_ROAM_QUICKSCAN_TH) -+ adapter->mlmeextpriv.quickscan_next = _TRUE; -+#endif -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if (mlme->need_to_roam == _FALSE) -+ goto exit; -+#endif -+ -+ RTW_INFO("roam candidate:%s %s("MAC_FMT", ch%3u) rssi:%d dBm, 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; -+ } -+ -+#ifdef CONFIG_RTW_80211R -+ if (rtw_ft_chk_flags(adapter, RTW_FT_PEER_EN)) { -+ if (rtw_ft_chk_roaming_candidate(adapter, competitor) == _FALSE) -+ goto exit; -+ } -+ -+#ifdef CONFIG_RTW_WNM -+ if (rtw_wnm_btm_diff_bss(adapter) && -+ rtw_wnm_btm_roam_candidate(adapter, competitor)) { -+ goto update; -+ } -+#endif -+#endif -+ -+#if 1 -+ if (rtw_get_passing_time_ms(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; -+ -+ 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) { -+ /* if parent note lost the path to root and there is no other cadidate, report disconnection */ -+#if defined(CONFIG_RTW_REPEATER_SON) && (!defined(CONFIG_RTW_REPEATER_SON_ROOT)) -+ struct rtw_rson_struct rson_curr; -+ u8 rson_score; -+ -+ rtw_get_rson_struct(&(mlme->cur_network_scanned->network), &rson_curr); -+ rson_score = rtw_cal_rson_score(&rson_curr, mlme->cur_network_scanned->network.Rssi); -+ if (check_fwstate(mlme, WIFI_ASOC_STATE) -+ && ((rson_score == RTW_RSON_SCORE_NOTCNNT) -+ || (rson_score == RTW_RSON_SCORE_NOTSUP))) -+ receive_disconnect(adapter, mlme->cur_network_scanned->network.MacAddress -+ , WLAN_REASON_EXPIRATION_CHK, _FALSE); -+#endif -+ RTW_INFO("%s: return _FAIL(candidate == NULL)\n", __FUNCTION__); -+ ret = _FAIL; -+ goto exit; -+ } else { -+#if defined(CONFIG_RTW_REPEATER_SON) && (!defined(CONFIG_RTW_REPEATER_SON_ROOT)) -+ struct rtw_rson_struct rson_curr; -+ u8 rson_score; -+ -+ rtw_get_rson_struct(&(candidate->network), &rson_curr); -+ rson_score = rtw_cal_rson_score(&rson_curr, candidate->network.Rssi); -+ RTW_INFO("%s: candidate: %s("MAC_FMT", ch:%u) rson_score:%d\n", __FUNCTION__, -+ candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), -+ candidate->network.Configuration.DSConfig, rson_score); -+#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); -+#endif -+ 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); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ RT_CHANNEL_INFO *chset = rfctl->channel_set; -+ u8 ch = competitor->network.Configuration.DSConfig; -+ -+ if (rtw_chset_search_ch(chset, ch) < 0) -+ goto exit; -+ if (IS_DFS_SLAVE_WITH_RD(rfctl) -+ && !rtw_rfctl_dfs_domain_unknown(rfctl) -+ && rtw_chset_is_ch_non_ocp(chset, ch)) -+ goto exit; -+ -+#if defined(CONFIG_RTW_REPEATER_SON) && (!defined(CONFIG_RTW_REPEATER_SON_ROOT)) -+ s16 rson_score; -+ struct rtw_rson_struct rson_data; -+ -+ if (rtw_rson_choose(candidate, competitor)) { -+ *candidate = competitor; -+ rtw_get_rson_struct(&((*candidate)->network), &rson_data); -+ rson_score = rtw_cal_rson_score(&rson_data, (*candidate)->network.Rssi); -+ RTW_INFO("[assoc_ssid:%s] new candidate: %s("MAC_FMT", ch%u) rson_score:%d\n", -+ mlme->assoc_ssid.Ssid, -+ (*candidate)->network.Ssid.Ssid, -+ MAC_ARG((*candidate)->network.MacAddress), -+ (*candidate)->network.Configuration.DSConfig, -+ rson_score); -+ return _TRUE; -+ } -+ return _FALSE; -+#endif -+ -+ /* 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(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 dBm\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; -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ u8 bSupportAntDiv = _FALSE; -+#endif -+ -+ 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; -+ 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, WIFI_ASOC_STATE | WIFI_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 WIFI_ASOC_STATE */ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ RTW_INFO("%s: WIFI_ASOC_STATE 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: WIFI_ASOC_STATE 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, 0); -+ rtw_indicate_disconnect(adapter, 0, _FALSE); -+ rtw_free_assoc_resources_cmd(adapter, _TRUE, 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, WIFI_UNDER_LINKING); -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+{ -+ u8 ifbmp = 0; -+ u8 csa_cnt; -+ struct mi_state mstate; -+ struct rf_ctl_t *rfctl; -+ -+ rfctl = adapter_to_rfctl(adapter); -+ csa_cnt = rfctl->ap_csa_cnt_input; -+ ifbmp = rtw_mi_get_ap_mesh_ifbmp(adapter); -+ rtw_mi_status_no_self(adapter, &mstate); -+ -+ if (csa_cnt > 0 && ifbmp && MSTATE_AP_LD_NUM(&mstate) && -+ rtw_mi_get_union_chan(adapter) != candidate->network.Configuration.DSConfig) { -+ rfctl->ap_csa_en = CSA_STA_JOINBSS; -+ rfctl->ap_csa_switch_cnt = csa_cnt; -+ rtw_bss_get_chbw(&(candidate->network), &rfctl->ap_csa_ch -+ , &rfctl->ap_csa_ch_width, &rfctl->ap_csa_ch_offset, 1, 1); -+ rtw_set_ap_csa_cmd(adapter); -+ -+ /* Store candidata network until softap switch channel done */ -+ _rtw_memcpy(&(pmlmepriv->candidate_network), candidate, sizeof(struct wlan_network)); -+ ret = _SUCCESS; -+ goto exit; -+ } -+} -+#endif -+ -+ 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 = CMD_SET_AUTH; -+ 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); -+ 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); -+ break; -+ case _AES_: -+ case _GCMP_: -+ keylen = 16; -+ _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); -+ break; -+ case _GCMP_256_: -+ case _CCMP_256_: -+ keylen = 32; -+ _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); -+ 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 =CMD_SET_KEY; -+ 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; -+ -+} -+ -+#ifdef CONFIG_WMMPS_STA -+/* -+ * rtw_uapsd_use_default_setting -+ * This function is used for setting default uapsd max sp length to uapsd_max_sp_len -+ * in qos_priv data structure from registry. In additional, it will also map default uapsd -+ * ac to each uapsd TID, delivery-enabled and trigger-enabled of corresponding TID. -+ * -+ * Arguments: -+ * @padapter: _adapter pointer. -+ * -+ * Auther: Arvin Liu -+ * Date: 2017/05/03 -+ */ -+void rtw_uapsd_use_default_setting(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ if (pregistrypriv->uapsd_ac_enable != 0) { -+ pqospriv->uapsd_max_sp_len = pregistrypriv->uapsd_max_sp_len; -+ -+ CLEAR_FLAGS(pqospriv->uapsd_tid); -+ CLEAR_FLAGS(pqospriv->uapsd_tid_delivery_enabled); -+ CLEAR_FLAGS(pqospriv->uapsd_tid_trigger_enabled); -+ -+ /* check the uapsd setting of AC_VO from registry then map these setting to each TID if necessary */ -+ if(TEST_FLAG(pregistrypriv->uapsd_ac_enable, DRV_CFG_UAPSD_VO)) { -+ SET_FLAG(pqospriv->uapsd_tid, WMM_TID7); -+ SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID7); -+ SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID7); -+ SET_FLAG(pqospriv->uapsd_tid, WMM_TID6); -+ SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID6); -+ SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID6); -+ } -+ -+ /* check the uapsd setting of AC_VI from registry then map these setting to each TID if necessary */ -+ if(TEST_FLAG(pregistrypriv->uapsd_ac_enable, DRV_CFG_UAPSD_VI)) { -+ SET_FLAG(pqospriv->uapsd_tid, WMM_TID5); -+ SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID5); -+ SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID5); -+ SET_FLAG(pqospriv->uapsd_tid, WMM_TID4); -+ SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID4); -+ SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID4); -+ } -+ -+ /* check the uapsd setting of AC_BK from registry then map these setting to each TID if necessary */ -+ if(TEST_FLAG(pregistrypriv->uapsd_ac_enable, DRV_CFG_UAPSD_BK)) { -+ SET_FLAG(pqospriv->uapsd_tid, WMM_TID2); -+ SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID2); -+ SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID2); -+ SET_FLAG(pqospriv->uapsd_tid, WMM_TID1); -+ SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID1); -+ SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID1); -+ } -+ -+ /* check the uapsd setting of AC_BE from registry then map these setting to each TID if necessary */ -+ if(TEST_FLAG(pregistrypriv->uapsd_ac_enable, DRV_CFG_UAPSD_BE)) { -+ SET_FLAG(pqospriv->uapsd_tid, WMM_TID3); -+ SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID3); -+ SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID3); -+ SET_FLAG(pqospriv->uapsd_tid, WMM_TID0); -+ SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID0); -+ SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID0); -+ } -+ -+ RTW_INFO("[WMMPS] UAPSD MAX SP Len = 0x%02x, UAPSD TID enabled = 0x%02x\n", -+ pqospriv->uapsd_max_sp_len, (u8)pqospriv->uapsd_tid); -+ } -+ -+} -+ -+/* -+ * rtw_is_wmmps_mode -+ * This function is used for checking whether Driver and an AP support uapsd function or not. -+ * If both of them support uapsd function, it will return true. Otherwise returns false. -+ * -+ * Arguments: -+ * @padapter: _adapter pointer. -+ * -+ * Auther: Arvin Liu -+ * Date: 2017/06/12 -+ */ -+bool rtw_is_wmmps_mode(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ -+ if ((pqospriv->uapsd_ap_supported) && ((pqospriv->uapsd_tid & BIT_MASK_TID_TC) != 0)) -+ return _TRUE; -+ -+ return _FALSE; -+} -+#endif /* CONFIG_WMMPS_STA */ -+ -+/* 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) -+{ -+#ifdef CONFIG_WMMPS_STA -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+#endif /* CONFIG_WMMPS_STA */ -+ unsigned int ielength = 0; -+ unsigned int i, j; -+ u8 qos_info = 0; -+ -+ 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; -+ -+#ifdef CONFIG_WMMPS_STA -+ switch(pqospriv->uapsd_max_sp_len) { -+ case NO_LIMIT: -+ /* do nothing */ -+ break; -+ case TWO_MSDU: -+ SET_FLAG(qos_info, BIT5); -+ break; -+ case FOUR_MSDU: -+ SET_FLAG(qos_info, BIT6); -+ break; -+ case SIX_MSDU: -+ SET_FLAG(qos_info, BIT5); -+ SET_FLAG(qos_info, BIT6); -+ break; -+ default: -+ /* do nothing */ -+ break; -+ }; -+ -+ /* check TID7 and TID6 for AC_VO to set corresponding Qos_info bit in WMM IE */ -+ if((TEST_FLAG(pqospriv->uapsd_tid, WMM_TID7)) && (TEST_FLAG(pqospriv->uapsd_tid, WMM_TID6))) -+ SET_FLAG(qos_info, WMM_IE_UAPSD_VO); -+ /* check TID5 and TID4 for AC_VI to set corresponding Qos_info bit in WMM IE */ -+ if((TEST_FLAG(pqospriv->uapsd_tid, WMM_TID5)) && (TEST_FLAG(pqospriv->uapsd_tid, WMM_TID4))) -+ SET_FLAG(qos_info, WMM_IE_UAPSD_VI); -+ /* check TID2 and TID1 for AC_BK to set corresponding Qos_info bit in WMM IE */ -+ if((TEST_FLAG(pqospriv->uapsd_tid, WMM_TID2)) && (TEST_FLAG(pqospriv->uapsd_tid, WMM_TID1))) -+ SET_FLAG(qos_info, WMM_IE_UAPSD_BK); -+ /* check TID3 and TID0 for AC_BE to set corresponding Qos_info bit in WMM IE */ -+ if((TEST_FLAG(pqospriv->uapsd_tid, WMM_TID3)) && (TEST_FLAG(pqospriv->uapsd_tid, WMM_TID0))) -+ SET_FLAG(qos_info, WMM_IE_UAPSD_BE); -+#endif /* CONFIG_WMMPS_STA */ -+ -+ out_ie[initial_out_len + 8] = qos_info; -+ -+ 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; -+ -+} -+ -+int rtw_cached_pmkid(_adapter *Adapter, u8 *bssid) -+{ -+ return SecIsInPMKIDList(Adapter, bssid); -+} -+ -+int rtw_rsn_sync_pmkid(_adapter *adapter, u8 *ie, uint ie_len, int i_ent) -+{ -+ struct security_priv *sec = &adapter->securitypriv; -+ struct rsne_info info; -+ u8 gm_cs[4]; -+ int i; -+ -+ rtw_rsne_info_parse(ie, ie_len, &info); -+ -+ if (info.err) { -+ RTW_WARN(FUNC_ADPT_FMT" rtw_rsne_info_parse error\n" -+ , FUNC_ADPT_ARG(adapter)); -+ return 0; -+ } -+ -+ if (i_ent < 0 && info.pmkid_cnt == 0) -+ goto exit; -+ -+ if (info.pmkid_list == NULL) -+ goto exit; -+ -+ if (i_ent >= 0 && info.pmkid_cnt == 1 && _rtw_memcmp(info.pmkid_list, sec->PMKIDList[i_ent].PMKID, 16)) { -+ RTW_INFO(FUNC_ADPT_FMT" has carried the same PMKID:"KEY_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), KEY_ARG(&sec->PMKIDList[i_ent].PMKID)); -+ goto exit; -+ } -+ -+ /* bakcup group mgmt cs */ -+ if (info.gmcs) -+ _rtw_memcpy(gm_cs, info.gmcs, 4); -+ -+ if (info.pmkid_cnt) { -+ RTW_INFO(FUNC_ADPT_FMT" remove original PMKID, count:%u\n" -+ , FUNC_ADPT_ARG(adapter), info.pmkid_cnt); -+ for (i = 0; i < info.pmkid_cnt; i++) -+ RTW_INFO(" "KEY_FMT"\n", KEY_ARG(info.pmkid_list + i * 16)); -+ } -+ -+ if (i_ent >= 0) { -+ RTW_INFO(FUNC_ADPT_FMT" append PMKID:"KEY_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), KEY_ARG(sec->PMKIDList[i_ent].PMKID)); -+ -+ info.pmkid_cnt = 1; /* update new pmkid_cnt */ -+ _rtw_memcpy(info.pmkid_list, sec->PMKIDList[i_ent].PMKID, 16); -+ } else -+ info.pmkid_cnt = 0; /* update new pmkid_cnt */ -+ -+ RTW_PUT_LE16(info.pmkid_list - 2, info.pmkid_cnt); -+ if (info.gmcs) -+ _rtw_memcpy(info.pmkid_list + 16 * info.pmkid_cnt, gm_cs, 4); -+ -+ ie_len = 1 + 1 + 2 + 4 -+ + 2 + 4 * info.pcs_cnt -+ + 2 + 4 * info.akm_cnt -+ + 2 -+ + 2 + 16 * info.pmkid_cnt -+ + (info.gmcs ? 4 : 0) -+ ; -+ -+ ie[1] = (u8)(ie_len - 2); -+ -+exit: -+ return ie_len; -+} -+ -+sint rtw_restruct_sec_ie(_adapter *adapter, u8 *out_ie) -+{ -+ u8 authmode = 0x0; -+ uint ielength = 0; -+ int iEntry; -+ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ uint ndisauthmode = psecuritypriv->ndisauthtype; -+ -+ 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, 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, psecuritypriv->supplicant_ie, 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); -+ } -+ -+ if (authmode == WLAN_EID_RSN) { -+ iEntry = SecIsInPMKIDList(adapter, pmlmepriv->assoc_bssid); -+ ielength = rtw_rsn_sync_pmkid(adapter, out_ie, ielength, iEntry); -+ } -+ -+ if ((psecuritypriv->auth_type == MLME_AUTHTYPE_SAE) && -+ (psecuritypriv->rsnx_ie_len >= 3)) { -+ u8 *_pos = out_ie + (psecuritypriv->supplicant_ie[1] + 2); -+ _rtw_memcpy(_pos, psecuritypriv->rsnx_ie, -+ psecuritypriv->rsnx_ie_len); -+ ielength += psecuritypriv->rsnx_ie_len; -+ RTW_INFO_DUMP("update IE for RSNX :", 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; -+} -+ -+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; -+ -+ 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 -+#ifdef RTW_BEAMFORMING_VERSION_2 -+#ifdef CONFIG_CONCURRENT_MODE -+ /* only enable beamforming in STA client mode */ -+ if (MLME_IS_STA(padapter) && !MLME_IS_GC(padapter)) -+#else -+ if ((MLME_IS_AP(padapter) && !MLME_IS_GO(padapter)) || -+ (MLME_IS_STA(padapter) && !MLME_IS_GC(padapter))) -+#endif -+#endif -+ { -+ 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; -+ } -+} -+#if defined(CONFIG_80211N_HT) -+/* 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, struct country_chplan *req_chplan) -+{ -+ 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; -+ BAND_TYPE band = channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; -+ struct rtw_ieee80211_ht_cap ht_capie; -+ u8 cbw40_enable = 0, rf_num = 0, rx_stbc_nss = 0, rx_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; -+#ifdef CONFIG_80211AC_VHT -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+#endif /* CONFIG_80211AC_VHT */ -+ -+ 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; -+ -+ /* check if 40MHz is allowed according to hal cap and registry */ -+ if (hal_chk_bw_cap(padapter, BW_CAP_40M)) { -+ if (band == BAND_ON_5G) { -+ if (REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) -+ cbw40_enable = 1; -+ } else if (band == BAND_ON_2_4G) { -+ if (REGSTY_IS_BW_2G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) -+ cbw40_enable = 1; -+ } -+ } -+ -+ if (cbw40_enable) { -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ RT_CHANNEL_INFO *chset = rfctl->channel_set; -+ u8 oper_bw = CHANNEL_WIDTH_20, oper_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if (in_ie == NULL) { -+ /* TDLS: TODO 20/40 issue */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ oper_bw = padapter->mlmeextpriv.cur_bwmode; -+ if (oper_bw > CHANNEL_WIDTH_40) -+ oper_bw = CHANNEL_WIDTH_40; -+ } else -+ /* TDLS: TODO 40? */ -+ oper_bw = CHANNEL_WIDTH_40; -+ } else { -+ p = rtw_get_ie(in_ie, WLAN_EID_HT_OPERATION, &ielen, in_len); -+ if (p && ielen == HT_OP_IE_LEN) { -+ if (GET_HT_OP_ELE_STA_CHL_WIDTH(p + 2)) { -+ switch (GET_HT_OP_ELE_2ND_CHL_OFFSET(p + 2)) { -+ case SCA: -+ oper_bw = CHANNEL_WIDTH_40; -+ oper_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ case SCB: -+ oper_bw = CHANNEL_WIDTH_40; -+ oper_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ } -+ } -+ } -+ -+ /* IOT issue : AP TP-link Archer C7, correct the secondary channel offset of 5G channel */ -+ if (oper_bw == CHANNEL_WIDTH_40 && p && ielen == HT_OP_IE_LEN) { -+ u8 primary_ch = GET_HT_OP_ELE_PRI_CHL(p + 2); -+ u8 offset_bak = oper_offset; -+ -+ if (primary_ch > 14) { -+ rtw_get_offset_by_chbw(primary_ch, oper_bw, &oper_offset); -+ -+ /* secondary channel offset is wrong */ -+ if (offset_bak != oper_offset) { -+ RTW_INFO(FUNC_ADPT_FMT": secondary channel offset is wrong, so workaround\n", FUNC_ADPT_ARG(padapter)); -+ switch (oper_offset) { -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(p + 2, SCA); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(p + 2, SCB); -+ break; -+ } -+ } -+ } -+ } -+ -+ // IOT issue : AP TP-Link WDR6500 -+ if(oper_bw == CHANNEL_WIDTH_40){ -+ p = rtw_get_ie(in_ie, WLAN_EID_HT_CAP, &ielen, in_len); -+ if (p && ielen == HT_CAP_IE_LEN) { -+ oper_bw = GET_HT_CAP_ELE_CHL_WIDTH(p + 2) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20; -+ if(oper_bw == CHANNEL_WIDTH_20) -+ oper_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ } -+ } -+ -+ /* adjust bw to fit in channel plan setting */ -+ if (oper_bw == CHANNEL_WIDTH_40 -+ && oper_offset != HAL_PRIME_CHNL_OFFSET_DONT_CARE /* check this because TDLS has no info to set offset */ -+ ) { -+ if ((req_chplan && !rtw_country_chplan_is_chbw_valid(req_chplan, band, channel, oper_bw, oper_offset, 1, 1, pregistrypriv)) -+ || (!req_chplan && !rtw_chset_is_chbw_valid(chset, channel, oper_bw, oper_offset, 1, 1)) -+ || (IS_DFS_SLAVE_WITH_RD(rfctl) -+ && !rtw_rfctl_dfs_domain_unknown(rfctl) -+ && rtw_chset_is_chbw_non_ocp(chset, channel, oper_bw, oper_offset)) -+ ) { -+ oper_bw = CHANNEL_WIDTH_20; -+ oper_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ rtw_warn_on(req_chplan && !rtw_country_chplan_is_chbw_valid(req_chplan, band, channel, oper_bw, oper_offset, 1, 1, pregistrypriv)); -+ rtw_warn_on(!req_chplan && !rtw_chset_is_chbw_valid(chset, channel, oper_bw, oper_offset, 1, 1)); -+ if (IS_DFS_SLAVE_WITH_RD(rfctl) && !rtw_rfctl_dfs_domain_unknown(rfctl)) -+ rtw_warn_on(rtw_chset_is_chbw_non_ocp(chset, channel, oper_bw, oper_offset)); -+ } -+ } -+ -+ if (oper_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; -+ } -+ -+ cbw40_enable = oper_bw == CHANNEL_WIDTH_40 ? 1 : 0; -+ } -+ -+ /* 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 */ -+ rx_nss = GET_HAL_RX_NSS(padapter); -+ -+ switch (rx_nss) { -+ case 1: -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_1R); -+ break; -+ case 2: -+ #ifdef CONFIG_DISABLE_MCS13TO15 -+ if (cbw40_enable && pregistrypriv->wifi_spec != 1) -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R_13TO15_OFF); -+ else -+ #endif -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); -+ break; -+ case 3: -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_3R); -+ break; -+ case 4: -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_4R); -+ break; -+ default: -+ RTW_WARN("rf_type:%d or rx_nss:%u is not expected\n", GET_HAL_RFPATH(padapter), rx_nss); -+ } -+ -+ { -+ 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); -+#ifdef CONFIG_80211AC_VHT -+ /* IOT action suggested by Yu Chen 2017/3/3 */ -+ if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) && -+ !pvhtpriv->ap_bf_cap.is_mu_bfer && -+ pvhtpriv->ap_bf_cap.su_sound_dim == 2) -+ rf_num = (rf_num >= 2 ? 2 : rf_num); -+#endif -+ 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 rx_nss = 0; -+ -+ rx_nss = GET_HAL_RX_NSS(padapter); -+ -+ /* 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 (rx_nss) { -+ case 1: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); -+ break; -+ case 2: -+ #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 -+ #endif -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+ break; -+ case 3: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_3R); -+ break; -+ case 4: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_4R); -+ break; -+ default: -+ RTW_WARN("rx_nss:%u is not expected\n", rx_nss); -+ } -+ -+ /* 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_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ RTW_INFO("%s : ch offset is not assigned for HT40 mod , update cur_bwmode=%u, cur_ch_offset=%u\n", -+ __func__, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ 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; -+} -+#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 */ -+ -+#ifdef CONFIG_80211N_HT -+static u8 rtw_issue_addbareq_check(_adapter *padapter, struct xmit_frame *pxmitframe, u8 issue_when_busy) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct registry_priv *pregistry = &padapter->registrypriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ -+ if (bmcst) -+ return _FALSE; -+ -+ if (pregistry->tx_quick_addba_req == 0) { -+ if ((issue_when_busy == _TRUE) && (pmlmepriv->LinkDetectInfo.bBusyTraffic == _FALSE)) -+ return _FALSE; -+ -+ if (pmlmepriv->LinkDetectInfo.NumTxOkInPeriod < 100) -+ return _FALSE; -+ } -+ -+ return _TRUE; -+} -+ -+void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe, u8 issue_when_busy) -+{ -+ u8 issued; -+ int priority; -+ struct sta_info *psta = NULL; -+ struct ht_priv *phtpriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ if (rtw_issue_addbareq_check(padapter,pxmitframe, issue_when_busy) == _FALSE) -+ 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 & WIFI_ASOC_STATE)) { -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\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); -+ } -+ } -+ -+} -+#endif /* CONFIG_80211N_HT */ -+void rtw_append_extended_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 *ext_cap_data = pmlmepriv->ext_capab_ie_data; -+ u8 *ext_cap_data_len = &(pmlmepriv->ext_capab_ie_len); -+ -+ if (phtpriv->bss_coexist) -+ rtw_add_ext_cap_info(ext_cap_data, ext_cap_data_len, BSS_COEXT); -+ -+#ifdef CONFIG_80211AC_VHT -+ if (pvhtpriv->vht_option) -+ rtw_add_ext_cap_info(ext_cap_data, ext_cap_data_len, OP_MODE_NOTIFICATION); -+#endif /* CONFIG_80211AC_VHT */ -+#ifdef CONFIG_RTW_WNM -+ rtw_add_ext_cap_info(ext_cap_data, ext_cap_data_len, BSS_TRANSITION); -+#endif -+ -+#ifdef CONFIG_RTW_MBO -+ rtw_add_ext_cap_info(ext_cap_data, ext_cap_data_len, INTERWORKING); -+#endif -+ -+ /* -+ 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. -+ */ -+ rtw_update_ext_cap_ie(ext_cap_data, *ext_cap_data_len, out_ie, pout_len, _BEACON_IE_OFFSET_); -+} -+#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_ch = 0; -+ 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_ft_clr_flags(padapter, RTW_FT_PEER_EN|RTW_FT_PEER_OTD_EN); -+ rtw_ft_reset_status(padapter); -+#endif -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ break; -+ } -+ } -+ } -+ } -+ -+} -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+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 if (req_ch == 14) -+ allowed_bw = CHANNEL_WIDTH_20; -+ 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; -+} -+ -+sint rtw_linked_check(_adapter *padapter) -+{ -+ if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter) -+ || MLME_IS_ADHOC(padapter) || MLME_IS_ADHOC_MASTER(padapter) -+ ) { -+ if (padapter->stapriv.asoc_sta_count > 2) -+ return _TRUE; -+ } else { -+ /* Station mode */ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ return _TRUE; -+ } -+ return _FALSE; -+} -+/*#define DBG_ADAPTER_STATE_CHK*/ -+u8 rtw_is_adapter_up(_adapter *padapter) -+{ -+ if (padapter == NULL) -+ return _FALSE; -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ #ifdef DBG_ADAPTER_STATE_CHK -+ RTW_INFO(FUNC_ADPT_FMT " FALSE -bDriverStopped(%s) bSurpriseRemoved(%s)\n" -+ , FUNC_ADPT_ARG(padapter) -+ , rtw_is_drv_stopped(padapter) ? "True" : "False" -+ , rtw_is_surprise_removed(padapter) ? "True" : "False"); -+ #endif -+ return _FALSE; -+ } -+ -+ if (!rtw_is_hw_init_completed(padapter)) { -+ #ifdef DBG_ADAPTER_STATE_CHK -+ RTW_INFO(FUNC_ADPT_FMT " FALSE -(hw_init_completed == _FALSE)\n", FUNC_ADPT_ARG(padapter)); -+ #endif -+ return _FALSE; -+ } -+ -+ if (padapter->bup == _FALSE) { -+ #ifdef DBG_ADAPTER_STATE_CHK -+ RTW_INFO(FUNC_ADPT_FMT " FALSE -(bup == _FALSE)\n", FUNC_ADPT_ARG(padapter)); -+ #endif -+ 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 -+} -+ -+void dump_arp_pkt(void *sel, u8 *da, u8 *sa, u8 *arp, bool tx) -+{ -+ RTW_PRINT_SEL(sel, "%s ARP da="MAC_FMT", sa="MAC_FMT"\n" -+ , tx ? "send" : "recv", MAC_ARG(da), MAC_ARG(sa)); -+ RTW_PRINT_SEL(sel, "htype=%u, ptype=0x%04x, hlen=%u, plen=%u, oper=%u\n" -+ , GET_ARP_HTYPE(arp), GET_ARP_PTYPE(arp), GET_ARP_HLEN(arp) -+ , GET_ARP_PLEN(arp), GET_ARP_OPER(arp)); -+ RTW_PRINT_SEL(sel, "sha="MAC_FMT", spa="IP_FMT"\n" -+ , MAC_ARG(ARP_SENDER_MAC_ADDR(arp)), IP_ARG(ARP_SENDER_IP_ADDR(arp))); -+ RTW_PRINT_SEL(sel, "tha="MAC_FMT", tpa="IP_FMT"\n" -+ , MAC_ARG(ARP_TARGET_MAC_ADDR(arp)), IP_ARG(ARP_TARGET_IP_ADDR(arp))); -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_mlme_ext.c b/drivers/net/wireless/rtl8821cs/core/rtw_mlme_ext.c -new file mode 100755 -index 000000000..7aab4f00c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_mlme_ext.c -@@ -0,0 +1,17645 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+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_MEAS, "ACTION_RADIO_MEAS", &on_action_rm}, -+ {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}, -+#ifdef CONFIG_RTW_MESH -+ {RTW_WLAN_CATEGORY_MESH, "ACTION_MESH", &on_action_mesh}, -+ {RTW_WLAN_CATEGORY_SELF_PROTECTED, "ACTION_SELF_PROTECTED", &on_action_self_protected}, -+#endif -+ {RTW_WLAN_CATEGORY_WMM, "ACTION_WMM", &OnAction_wmm}, -+ {RTW_WLAN_CATEGORY_VHT, "ACTION_VHT", &OnAction_vht}, -+ {RTW_WLAN_CATEGORY_P2P, "ACTION_P2P", &OnAction_p2p}, -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ {RTW_WLAN_CATEGORY_TBTX, "ACTION_TBTX_TOKEN", &OnAction_tbtx_token} -+#endif -+}; -+ -+ -+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 DPP_OUI[] = {0x50, 0x6F, 0x9A, 0x1A}; -+unsigned char MULTI_AP_OUI[] = {0x50, 0x6F, 0x9A, 0x1B}; -+ -+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}; -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+unsigned char REALTEK_TBTX_IE[] = {0x00, 0xe0, 0x4c, 0x01, 0x00, 0x00, 0x00, 0x00}; -+#endif -+extern unsigned char REALTEK_96B_IE[]; -+ -+static void init_channel_list(_adapter *padapter, RT_CHANNEL_INFO *channel_set -+ , 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 (rtw_chset_search_ch(channel_set, ch) == -1) -+ continue; -+#if defined(CONFIG_80211N_HT) || defined(CONFIG_80211AC_VHT) -+ if ((padapter->registrypriv.ht_enable == 0) && (o->inc == 8)) -+ continue; -+ -+ if ((REGSTY_IS_BW_5G_SUPPORT(regsty, CHANNEL_WIDTH_40)) && -+ ((o->bw == BW40MINUS) || (o->bw == BW40PLUS))) -+ 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; -+ -+} -+ -+#if CONFIG_TXPWR_LIMIT -+static void rtw_txpwr_init_regd_default(struct rf_ctl_t *rfctl) -+{ -+ bool country_txpwr_lmt_override = 0; -+ u8 txpwr_lmt[BAND_MAX]; -+ const char *name[BAND_MAX]; -+ u8 unknown_bmp = 0; /* unknown bitmap */ -+ char buf[TXPWR_NAMES_STR_LEN]; -+ u8 band; -+ bool altenate_applied = 0; -+ -+ for (band = 0; band < BAND_MAX; band++) { -+ txpwr_lmt[band] = TXPWR_LMT_NONE; -+ name[band] = NULL; -+ unknown_bmp |= BIT(band); -+ } -+ -+ if (rfctl->txpwr_lmt_override != TXPWR_LMT_DEF) { -+ country_txpwr_lmt_override = 1; -+ for (band = 0; band < BAND_MAX; band++) -+ txpwr_lmt[band] = rfctl->txpwr_lmt_override; -+ } else { -+ txpwr_lmt[BAND_ON_2_4G] = rtw_regd_to_txpwr_lmt(rtw_chplan_get_default_regd_2g(rfctl->ChannelPlan)); -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ txpwr_lmt[BAND_ON_5G] = rtw_regd_to_txpwr_lmt(rtw_chplan_get_default_regd_5g(rfctl->ChannelPlan)); -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ txpwr_lmt[BAND_ON_6G] = rtw_regd_to_txpwr_lmt(rtw_chplan_get_default_regd_6g(rfctl->chplan_6g)); -+ #endif -+ } -+ -+ for (band = 0; band < BAND_MAX; band++) { -+ name[band] = txpwr_lmt_str(txpwr_lmt[band]); -+ if (txpwr_lmt[band] == TXPWR_LMT_NONE || txpwr_lmt[band] == TXPWR_LMT_WW || txpwr_lmt[band] == TXPWR_LMT_NUM -+ || _rtw_txpwr_lmt_get_by_name(rfctl, name[band])) -+ unknown_bmp &= ~BIT(band); -+ } -+ -+ if (country_txpwr_lmt_override) { -+ RTW_PRINT("default mapping country:%c%c to txpwr_lmt:%s\n" -+ , rfctl->alpha2[0], rfctl->alpha2[1] -+ , rtw_get_txpwr_lmt_names_str(buf, name, unknown_bmp) -+ ); -+ } else { -+ RTW_PRINT("default mapping domain to txpwr_lmt:%s\n" -+ , rtw_get_txpwr_lmt_names_str(buf, name, unknown_bmp)); -+ } -+ if (unknown_bmp == 0) -+ goto exit; -+ -+ for (band = 0; band < BAND_MAX; band++) { -+ if (!(unknown_bmp & BIT(band))) -+ continue; -+ if (TXPWR_LMT_ALTERNATE_DEFINED(txpwr_lmt[band])) { -+ /* -+ * To support older chips without new predefined txpwr_lmt: -+ * - use txpwr_lmt_alternate() to get alternate if the selection is not found -+ */ -+ altenate_applied = 1; -+ txpwr_lmt[band] = txpwr_lmt_alternate(txpwr_lmt[band]); -+ name[band] = txpwr_lmt_str(txpwr_lmt[band]); -+ if (_rtw_txpwr_lmt_get_by_name(rfctl, name[band])) -+ unknown_bmp &= ~BIT(band); -+ } -+ } -+ if (altenate_applied) { -+ RTW_PRINT("alternate applied txpwr_lmt:%s\n" -+ , rtw_get_txpwr_lmt_names_str(buf, name, unknown_bmp)); -+ if (unknown_bmp == 0) -+ goto exit; -+ } -+ -+ for (band = 0; band < BAND_MAX; band++) { -+ if (!(unknown_bmp & BIT(band))) -+ continue; -+ txpwr_lmt[band] = TXPWR_LMT_WW; -+ name[band] = txpwr_lmt_str(txpwr_lmt[band]); -+ unknown_bmp &= ~BIT(band); -+ } -+ RTW_PRINT("world wide applied txpwr_lmt:%s\n" -+ , rtw_get_txpwr_lmt_names_str(buf, name, unknown_bmp)); -+ -+exit: -+ for (band = 0; band < BAND_MAX; band++) -+ rfctl->txpwr_lmt_name[band] = name[band]; -+} -+ -+void rtw_txpwr_init_regd(struct rf_ctl_t *rfctl) -+{ -+ const char *name = NULL; -+ u8 band; -+ struct regd_exc_ent *exc; -+ struct txpwr_lmt_ent *ent; -+ _irqL irqL; -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ for (band = 0; band < BAND_MAX; band++) -+ rfctl->txpwr_lmt_name[band] = NULL; -+ -+ if (rfctl->txpwr_lmt_num == 0) { -+ RTW_PRINT("there is no any txpwr_regd\n"); -+ goto release_lock; -+ } -+ -+ /* search from exception mapping */ -+ exc = _rtw_regd_exc_search(rfctl, rfctl->alpha2, rfctl->ChannelPlan); -+ if (exc) { -+ u8 has_country = (exc->country[0] == '\0' && exc->country[1] == '\0') ? 0 : 1; -+ -+ if (strcmp(exc->lmt_name, txpwr_lmt_str(TXPWR_LMT_NONE)) == 0) -+ name = txpwr_lmt_str(TXPWR_LMT_NONE); -+ else if (strcmp(exc->lmt_name, txpwr_lmt_str(TXPWR_LMT_WW)) == 0) -+ name = txpwr_lmt_str(TXPWR_LMT_WW); -+ else { -+ ent = _rtw_txpwr_lmt_get_by_name(rfctl, exc->lmt_name); -+ if (ent) -+ name = ent->name; -+ } -+ -+ RTW_PRINT("exception mapping country:%c%c domain:0x%02x to%s txpwr_lmt:%s\n" -+ , has_country ? exc->country[0] : '-' -+ , has_country ? exc->country[1] : '-' -+ , exc->domain -+ , name ? "" : " unknown" -+ , exc->lmt_name -+ ); -+ if (name) { -+ for (band = 0; band < BAND_MAX; band++) -+ rfctl->txpwr_lmt_name[band] = name; -+ goto release_lock; -+ } -+ } -+ -+#ifdef CONFIG_REGD_SRC_FROM_OS -+ if (rfctl->regd_src == REGD_SRC_OS) { -+ if (RFCTL_REG_WORLDWIDE(rfctl)) -+ name = txpwr_lmt_str(TXPWR_LMT_WW); -+ else { -+ char alpha2[3] = { -+ rfctl->alpha2[0], rfctl->alpha2[1], 0}; -+ -+ ent = _rtw_txpwr_lmt_get_by_name(rfctl, alpha2); -+ if (ent) -+ name = ent->name; -+ } -+ -+ if (name) { -+ for (band = 0; band < BAND_MAX; band++) -+ rfctl->txpwr_lmt_name[band] = name; -+ RTW_PRINT("mapping country:%c%c to txpwr_lmt:%s\n" -+ , rfctl->alpha2[0] -+ , rfctl->alpha2[1] -+ , name -+ ); -+ goto release_lock; -+ } -+ -+ if (rfctl->ChannelPlan == RTW_CHPLAN_UNSPECIFIED) { -+ name = txpwr_lmt_str(TXPWR_LMT_WW); -+ for (band = 0; band < BAND_MAX; band++) -+ rfctl->txpwr_lmt_name[band] = name; -+ RTW_PRINT("mapping unsupported country:%c%c to txpwr_lmt:%s\n" -+ , rfctl->alpha2[0] -+ , rfctl->alpha2[1] -+ , name -+ ); -+ goto release_lock; -+ } -+ } -+#endif -+ -+ /* follow default channel plan mapping */ -+ rtw_txpwr_init_regd_default(rfctl); -+ -+release_lock: -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+} -+ -+bool rtw_rfctl_is_current_txpwr_lmt(struct rf_ctl_t *rfctl, const char *name) -+{ -+ int band; -+ -+ for (band = 0; band < BAND_MAX; band++) -+ if (rfctl->txpwr_lmt_name[band] && strcmp(name, rfctl->txpwr_lmt_name[band]) == 0) -+ return 1; -+ -+ return 0; -+} -+#endif /* CONFIG_TXPWR_LIMIT */ -+ -+int rtw_rfctl_init(_adapter *adapter) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ int ret; -+ -+ _rtw_mutex_init(&rfctl->offch_mutex); -+ -+ rfctl->user_ChannelPlan = RTW_CHPLAN_UNSPECIFIED; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ rfctl->user_chplan_6g = RTW_CHPLAN_6G_UNSPECIFIED; -+#endif -+ -+#ifdef CONFIG_80211D -+ rfctl->country_ie_slave_en_role = regsty->country_ie_slave_en_role; -+ rfctl->country_ie_slave_en_ifbmp = regsty->country_ie_slave_en_ifbmp; -+ rfctl->effected_cisr_id = CONFIG_IFACE_NUMBER; -+#endif -+ -+#if CONFIG_TXPWR_LIMIT -+ _rtw_mutex_init(&rfctl->txpwr_lmt_mutex); -+ _rtw_init_listhead(&rfctl->reg_exc_list); -+ _rtw_init_listhead(&rfctl->txpwr_lmt_list); -+#endif -+ -+ rfctl->ch_sel_within_same_band = 1; -+ -+#ifdef CONFIG_DFS_MASTER -+ rfctl->dfs_region_domain = regsty->dfs_region_domain; -+ rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; -+ rtw_init_timer(&(rfctl->radar_detect_timer), adapter, rtw_dfs_rd_timer_hdl, rfctl); -+#endif -+#if CONFIG_DFS_SLAVE_WITH_RADAR_DETECT -+ rfctl->dfs_slave_with_rd = 1; -+#endif -+ -+ if (regsty->antenna_gain != UNSPECIFIED_MBM) -+ rfctl->antenna_gain = regsty->antenna_gain; -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+ rfctl->ap_csa_cnt_input = DEFAULT_CSA_CNT; -+#endif -+ -+ ret = op_class_pref_init(adapter); -+ if (ret != _SUCCESS) -+ op_class_pref_deinit(adapter); -+ -+ return ret; -+} -+ -+void rtw_rfctl_deinit(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ _rtw_mutex_free(&rfctl->offch_mutex); -+ -+#if CONFIG_TXPWR_LIMIT -+ rtw_regd_exc_list_free(rfctl); -+ rtw_txpwr_lmt_list_free(rfctl); -+ _rtw_mutex_free(&rfctl->txpwr_lmt_mutex); -+#endif -+ -+ op_class_pref_deinit(adapter); -+} -+ -+/* -+ * Description: -+ * Use hardware(efuse), driver parameter(registry) and default channel plan -+ * to decide which one should be used. -+ * -+ * Parameters: -+ * rfctl pointer of rfctl -+ * hw_alpha2 country code from HW (efuse/eeprom/mapfile) -+ * hw_chplan domain code from HW (efuse/eeprom/mapfile) -+ * hw_chplan_6g 6g domain code from HW (efuse/eeprom/mapfile) -+ * hw_force_chplan if forcing HW channel plan setting (efuse/eeprom/mapfile) -+ * will modified tif HW channel plan setting is invlid, will -+ */ -+void rtw_rfctl_decide_init_chplan(struct rf_ctl_t *rfctl, -+ const char *hw_alpha2, u8 hw_chplan, u8 hw_chplan_6g, u8 hw_force_chplan) -+{ -+ struct registry_priv *regsty; -+ char *sw_alpha2; -+ const struct country_chplan *country_ent = NULL; -+ struct country_chplan ent; -+ int chplan = -1; -+ int chplan_6g = -1; -+ -+ u8 sw_chplan; -+ u8 def_chplan = RTW_CHPLAN_WORLDWIDE; /* worldwide, used when HW, SW both invalid */ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 sw_chplan_6g; -+ u8 def_chplan_6g = RTW_CHPLAN_6G_WORLDWIDE; /* worldwide, used when HW, SW both invalid */ -+#endif -+ -+ if (hw_alpha2) { -+ if (rtw_get_chplan_from_country(hw_alpha2, &ent)) { -+ /* get chplan from hw country code, by pass hw chplan setting */ -+ country_ent = &ent; -+ chplan = ent.chplan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ chplan_6g = ent.chplan_6g; -+ #endif -+ 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 (hw_force_chplan == _TRUE) { -+ RTW_PRINT("%s unsupported hw_chplan:0x%02X\n", __func__, hw_chplan); -+ /* hw infomaton invalid, refer to sw information */ -+ hw_force_chplan = _FALSE; -+ } -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ if (rtw_is_channel_plan_6g_valid(hw_chplan_6g)) -+ chplan_6g = hw_chplan_6g; -+ else if (hw_force_chplan == _TRUE) { -+ RTW_PRINT("%s unsupported hw_chplan_6g:0x%02X\n", __func__, hw_chplan_6g); -+ /* hw infomaton invalid, refer to sw information */ -+ hw_force_chplan = _FALSE; -+ } -+#endif -+ -+chk_sw_config: -+ if (hw_force_chplan == _TRUE) -+ goto done; -+ -+ regsty = dvobj_to_regsty(rfctl_to_dvobj(rfctl)); -+ sw_alpha2 = regsty->alpha2; -+ sw_chplan = regsty->channel_plan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ sw_chplan_6g = regsty->channel_plan_6g; -+ #endif -+ -+ if (sw_alpha2 && !IS_ALPHA2_UNSPEC(sw_alpha2)) { -+ if (IS_ALPHA2_WORLDWIDE(sw_alpha2) -+ || rtw_get_chplan_from_country(sw_alpha2, &ent) -+ ) { -+ /* get chplan from sw country code, by pass sw chplan setting */ -+ if (IS_ALPHA2_WORLDWIDE(sw_alpha2)) -+ rtw_get_chplan_worldwide(&ent); -+ country_ent = &ent; -+ chplan = ent.chplan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ chplan_6g = ent.chplan_6g; -+ #endif -+ 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_UNSPECIFIED) -+ RTW_PRINT("%s unsupported sw_chplan:0x%02X\n", __func__, sw_chplan); -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ if (rtw_is_channel_plan_6g_valid(sw_chplan_6g)) { -+ /* cancel hw_alpha2 because chplan_6g is specified by sw_chplan_6g */ -+ country_ent = NULL; -+ chplan_6g = sw_chplan_6g; -+ } else if (sw_chplan_6g != RTW_CHPLAN_6G_UNSPECIFIED) -+ RTW_PRINT("%s unsupported sw_chplan_6g:0x%02X\n", __func__, sw_chplan_6g); -+#endif -+ -+done: -+ if (chplan == -1) { -+ RTW_PRINT("%s use def_chplan:0x%02X\n", __func__, def_chplan); -+ chplan = def_chplan; -+ } else -+ RTW_PRINT("%s chplan:0x%02X\n", __func__, chplan); -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ if (chplan_6g == -1) { -+ RTW_PRINT("%s use def_chplan_6g:0x%02X\n", __func__, def_chplan_6g); -+ chplan_6g = def_chplan_6g; -+ } else -+ RTW_PRINT("%s chplan_6g:0x%02X\n", __func__, chplan_6g); -+#endif -+ -+ if (!country_ent) { -+ if (rtw_chplan_ids_is_world_wide(chplan, chplan_6g)) -+ rtw_get_chplan_worldwide(&ent); -+ else { -+ SET_UNSPEC_ALPHA2(ent.alpha2); -+ ent.edcca_mode_2g_override = RTW_EDCCA_DEF; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ ent.edcca_mode_5g_override = RTW_EDCCA_DEF; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ ent.edcca_mode_6g_override = RTW_EDCCA_DEF; -+ #endif -+ ent.txpwr_lmt_override = TXPWR_LMT_DEF; -+ #if defined(CONFIG_80211AX_HE) || defined(CONFIG_80211AC_VHT) -+ ent.proto_en = CHPLAN_PROTO_EN_ALL; -+ #endif -+ } -+ } else { -+ RTW_PRINT("%s country code:\"%c%c\"\n", __func__ -+ , country_ent->alpha2[0], country_ent->alpha2[1]); -+ } -+ -+ rfctl->disable_sw_chplan = hw_force_chplan; -+ -+ rfctl->regd_inr = RTW_REGD_SET_BY_INIT; -+ rfctl->init_alpha2[0] = rfctl->alpha2[0] = ent.alpha2[0]; -+ rfctl->init_alpha2[1] = rfctl->alpha2[1] = ent.alpha2[1]; -+ rfctl->init_ChannelPlan = rfctl->ChannelPlan = chplan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ rfctl->init_chplan_6g = rfctl->chplan_6g = chplan_6g; -+#endif -+ rfctl->edcca_mode_2g_override = ent.edcca_mode_2g_override; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ rfctl->edcca_mode_5g_override = ent.edcca_mode_5g_override; -+#endif -+#if CONFIG_IEEE80211_BAND_6GHZ -+ rfctl->edcca_mode_6g_override = ent.edcca_mode_6g_override; -+#endif -+#if CONFIG_TXPWR_LIMIT -+ rfctl->txpwr_lmt_override = ent.txpwr_lmt_override; -+#endif -+#if defined(CONFIG_80211AX_HE) || defined(CONFIG_80211AC_VHT) -+ rfctl->proto_en = ent.proto_en; -+#endif -+} -+ -+void rtw_rfctl_chplan_init(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ init_channel_set(adapter); -+ op_class_pref_apply_regulatory(adapter, REG_CHANGE); -+ init_channel_list(adapter, rfctl->channel_set, &rfctl->channel_list); -+} -+ -+bool rtw_rfctl_is_disable_sw_channel_plan(struct dvobj_priv *dvobj) -+{ -+ return dvobj_to_rfctl(dvobj)->disable_sw_chplan; -+} -+ -+void rtw_rfctl_update_op_mode(struct rf_ctl_t *rfctl, u8 ifbmp_mod, u8 if_op) -+{ -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ u8 op_class = 0; -+ u8 op_ch = 0; -+ s16 op_txpwr_max; -+ u8 if_op_class[CONFIG_IFACE_NUMBER] = {0}; -+ u8 if_op_ch[CONFIG_IFACE_NUMBER] = {0}; -+ u8 ch, bw, offset; -+ u8 u_ch = 0, u_bw, u_offset; -+ bool notify = 0; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (ifbmp_mod & BIT(i)) { -+ if (!if_op) -+ continue; -+ } else if (!MLME_IS_ASOC(iface) || MLME_IS_OPCH_SW(iface)) -+ continue; -+ -+ ch = mlmeext->cur_channel; -+ bw = mlmeext->cur_bwmode; -+ offset = mlmeext->cur_ch_offset; -+ if_op_class[i] = rtw_get_op_class_by_chbw(ch, bw, offset); -+ if_op_ch[i] = if_op_class[i] ? ch : 0; -+ -+ if (!u_ch) { -+ u_ch = ch; -+ u_bw = bw; -+ u_offset = offset; -+ } else { -+ rtw_warn_on(!rtw_is_chbw_grouped(u_ch, u_bw, u_offset, ch, bw, offset)); -+ rtw_sync_chbw(&ch, &bw, &offset, &u_ch, &u_bw, &u_offset); -+ } -+ } -+ -+ op_class = rtw_get_op_class_by_chbw(u_ch, u_bw, u_offset); -+ op_ch = op_class ? u_ch : 0; -+ op_txpwr_max = rtw_rfctl_get_oper_txpwr_max_mbm(rfctl, u_ch, u_bw, u_offset, ifbmp_mod, if_op, 1); -+ -+ if (op_class != rfctl->op_class -+ || op_ch != rfctl->op_ch -+ || op_txpwr_max != rfctl->op_txpwr_max -+ || _rtw_memcmp(if_op_class, rfctl->if_op_class, sizeof(u8) * CONFIG_IFACE_NUMBER) == _FALSE -+ || _rtw_memcmp(if_op_ch, rfctl->if_op_ch, sizeof(u8) * CONFIG_IFACE_NUMBER) == _FALSE) -+ notify = 1; -+ -+ rfctl->op_class = op_class; -+ rfctl->op_ch = op_ch; -+ rfctl->op_txpwr_max = op_txpwr_max; -+ _rtw_memcpy(rfctl->if_op_class, if_op_class, sizeof(u8) * CONFIG_IFACE_NUMBER); -+ _rtw_memcpy(rfctl->if_op_ch, if_op_ch, sizeof(u8) * CONFIG_IFACE_NUMBER); -+ -+ if (0) -+ RTW_INFO("radio: %u,%u,%u %d notify:%d\n", u_ch, u_bw, u_offset, op_txpwr_max, notify); -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (ifbmp_mod & BIT(i)) { -+ if (!if_op) -+ continue; -+ } else if (!MLME_IS_ASOC(iface)) -+ continue; -+ if (0) -+ RTW_INFO(ADPT_FMT": %u,%u,%u\n", ADPT_ARG(iface) -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); -+ } -+ -+ if (notify) -+ rtw_nlrtw_radio_opmode_notify(rfctl); -+ -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ cmap_intfs_nl_bss_status_event(iface, 0); -+ } -+#endif -+} -+ -+/* domain status specific beacon hint rules */ -+#ifndef RTW_CHPLAN_BEACON_HINT_SPECIFIC_COUNTRY -+#define RTW_CHPLAN_BEACON_HINT_SPECIFIC_COUNTRY 0 -+#endif -+ -+bool rtw_rfctl_reg_allow_beacon_hint(struct rf_ctl_t *rfctl) -+{ -+ return RTW_CHPLAN_BEACON_HINT_SPECIFIC_COUNTRY || RFCTL_REG_WORLDWIDE(rfctl) || RFCTL_REG_ALPHA2_UNSPEC(rfctl); -+} -+ -+inline u8 rtw_rfctl_get_dfs_domain(struct rf_ctl_t *rfctl) -+{ -+#ifdef CONFIG_DFS_MASTER -+ return rfctl->dfs_region_domain; -+#else -+ return RTW_DFS_REGD_NONE; -+#endif -+} -+ -+inline u8 rtw_rfctl_dfs_domain_unknown(struct rf_ctl_t *rfctl) -+{ -+#ifdef CONFIG_DFS_MASTER -+ return rtw_rfctl_get_dfs_domain(rfctl) == RTW_DFS_REGD_NONE; -+#else -+ return 1; -+#endif -+} -+ -+#ifdef CONFIG_DFS_MASTER -+/* -+* called in rtw_dfs_rd_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(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset) -+{ -+ 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_chset_is_dfs_range(rfctl->channel_set, hi, cur_hi)) -+ || (lo != cur_lo && rtw_chset_is_dfs_range(rfctl->channel_set, cur_lo, lo))) -+ needed = _TRUE; -+ } else { -+ /* request is not supper set of current, but has overlap */ -+ if ((lo < cur_lo && rtw_chset_is_dfs_range(rfctl->channel_set, cur_lo, lo)) -+ || (hi > cur_hi && rtw_chset_is_dfs_range(rfctl->channel_set, 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_chbw_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; i < MAX_CHANNEL_NUM && 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; -+} -+ -+bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch) -+{ -+ return rtw_chset_is_chbw_non_ocp(ch_set, ch, CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE); -+} -+ -+u32 rtw_chset_get_ch_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) -+{ -+ int ms = 0; -+ systime 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; i < MAX_CHANNEL_NUM && 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 bool _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; -+ bool updated = 0; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) -+ goto exit; -+ -+ for (i = 0; i < MAX_CHANNEL_NUM && 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); -+ ch_set[i].flags |= RTW_CHF_NON_OCP; -+ updated = 1; -+ } -+ } -+ -+exit: -+ return updated; -+} -+ -+inline bool rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) -+{ -+ return _rtw_chset_update_non_ocp(ch_set, ch, bw, offset, -1); -+} -+ -+inline bool rtw_chset_update_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms) -+{ -+ return _rtw_chset_update_non_ocp(ch_set, ch, bw, offset, ms); -+} -+ -+static bool rtw_chset_chk_non_ocp_finish_for_chbw(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset) -+{ -+ RT_CHANNEL_INFO *ch_set = rfctl->channel_set; -+ u8 cch; -+ u8 *op_chs; -+ u8 op_ch_num; -+ int i; -+ int ch_idx; -+ bool ret = 0; -+ -+ 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)); -+ ch_idx = rtw_chset_search_ch(ch_set, *(op_chs + i)); -+ if (ch_idx == -1) -+ break; -+ if (!(ch_set[ch_idx].flags & RTW_CHF_NON_OCP) || CH_IS_NON_OCP(&ch_set[ch_idx])) -+ break; -+ } -+ -+ if (op_ch_num != 0 && i == op_ch_num) { -+ ret = 1; -+ /* clear RTTW_CHF_NON_OCP flag */ -+ for (i = 0; i < op_ch_num; i++) { -+ ch_idx = rtw_chset_search_ch(ch_set, *(op_chs + i)); -+ ch_set[ch_idx].flags &= ~RTW_CHF_NON_OCP; -+ } -+ rtw_nlrtw_nop_finish_event(dvobj_get_primary_adapter(rfctl_to_dvobj(rfctl)), cch, bw); -+ } -+ -+exit: -+ return ret; -+} -+ -+/* called by watchdog to clear RTW_CHF_NON_OCP and generate NON_OCP finish event */ -+void rtw_chset_chk_non_ocp_finish(struct rf_ctl_t *rfctl) -+{ -+ u8 ch, bw, offset; -+ int i; -+ -+ bw = CHANNEL_WIDTH_160; -+ while (1) { -+ for (i = 0; i < rfctl->max_chan_nums; i++) { -+ ch = rfctl->channel_set[i].ChannelNum; -+ if (!(rfctl->channel_set[i].flags & RTW_CHF_NON_OCP)) -+ continue; -+ if (!rtw_get_offset_by_chbw(ch, bw, &offset)) -+ continue; -+ -+ rtw_chset_chk_non_ocp_finish_for_chbw(rfctl, ch, bw, offset); -+ } -+ if (bw-- == CHANNEL_WIDTH_20) -+ break; -+ } -+} -+ -+u32 rtw_get_ch_waiting_ms(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, u32 *r_non_ocp_ms, u32 *r_cac_ms) -+{ -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ u32 non_ocp_ms; -+ u32 cac_ms; -+ u8 in_rd_range = 0; /* if in current radar detection range*/ -+ -+ if (rtw_chset_is_chbw_non_ocp(rfctl->channel_set, ch, bw, offset)) -+ non_ocp_ms = rtw_chset_get_ch_non_ocp_ms(rfctl->channel_set, ch, bw, offset); -+ else -+ non_ocp_ms = 0; -+ -+ if (rfctl->radar_detect_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_chset_is_dfs_chbw(rfctl->channel_set, 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_rfctl_get_dfs_domain(rfctl))) -+ 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(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset) -+{ -+ u32 non_ocp_ms; -+ u32 cac_ms; -+ -+ rtw_get_ch_waiting_ms(rfctl -+ , 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++; -+} -+ -+u32 rtw_force_stop_cac(struct rf_ctl_t *rfctl, u32 timeout_ms) -+{ -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ systime start; -+ u32 pass_ms; -+ -+ start = rtw_get_current_time(); -+ -+ rfctl->cac_force_stop = 1; -+ -+ while (rtw_get_passing_time_ms(start) <= timeout_ms -+ && IS_UNDER_CAC(rfctl) -+ ) { -+ if (dev_is_surprise_removed(dvobj) || dev_is_drv_stopped(dvobj)) -+ break; -+ rtw_msleep_os(20); -+ } -+ -+ if (IS_UNDER_CAC(rfctl)) { -+ if (!dev_is_surprise_removed(dvobj) && !dev_is_drv_stopped(dvobj)) -+ RTW_INFO("%s waiting for cac stop timeout!\n", __func__); -+ } -+ -+ rfctl->cac_force_stop = 0; -+ -+ pass_ms = rtw_get_passing_time_ms(start); -+ -+ return pass_ms; -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+/* choose channel with shortest waiting (non ocp + cac) time */ -+bool rtw_choose_shortest_waiting_ch(struct rf_ctl_t *rfctl, u8 sel_ch, u8 max_bw -+ , u8 *dec_ch, u8 *dec_bw, u8 *dec_offset -+ , u8 e_flags, u8 d_flags, u8 cur_ch, bool by_int_info, u8 mesh_only) -+{ -+#ifndef DBG_CHOOSE_SHORTEST_WAITING_CH -+#define DBG_CHOOSE_SHORTEST_WAITING_CH 0 -+#endif -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+#ifdef CONFIG_RTW_ACS -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(dvobj_get_primary_adapter(dvobj)); -+#endif -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ u8 ch, bw, offset; -+ u8 ch_c = 0, bw_c = 0, offset_c = 0; -+ int i; -+ u32 min_waiting_ms = 0; -+ u16 int_factor_c = 0; -+ -+ if (!dec_ch || !dec_bw || !dec_offset) { -+ rtw_warn_on(1); -+ return _FALSE; -+ } -+ -+ RTW_INFO("%s: sel_ch:%u max_bw:%u e_flags:0x%02x d_flags:0x%02x cur_ch:%u within_sb:%d%s%s\n" -+ , __func__, sel_ch, max_bw, e_flags, d_flags, cur_ch, rfctl->ch_sel_within_same_band -+ , by_int_info ? " int" : "", mesh_only ? " mesh_only" : ""); -+ -+ /* full search and narrow bw judegement first to avoid potetial judegement timing issue */ -+ for (bw = CHANNEL_WIDTH_20; bw <= max_bw; bw++) { -+ if (!hal_is_bw_support(dvobj_get_primary_adapter(dvobj), bw)) -+ continue; -+ -+ for (i = 0; i < rfctl->max_chan_nums; i++) { -+ u32 non_ocp_ms = 0; -+ u32 cac_ms = 0; -+ u32 waiting_ms = 0; -+ u16 int_factor = 0; -+ bool dfs_ch; -+ bool non_ocp; -+ bool long_cac; -+ -+ ch = rfctl->channel_set[i].ChannelNum; -+ if (sel_ch) { -+ if (ch != sel_ch) -+ continue; -+ } else if (rfctl->ch_sel_within_same_band && !rtw_is_same_band(cur_ch, ch)) -+ continue; -+ -+ if (ch > 14) { -+ if (bw > REGSTY_BW_5G(regsty)) -+ continue; -+ } else { -+ if (bw > REGSTY_BW_2G(regsty)) -+ continue; -+ } -+ -+ if (mesh_only && ch >= 5 && ch <= 9 && bw > CHANNEL_WIDTH_20) -+ continue; -+ -+ if (!rtw_get_offset_by_chbw(ch, bw, &offset)) -+ continue; -+ -+ if (!rtw_chset_is_chbw_valid(rfctl->channel_set, ch, bw, offset, 0, 0)) -+ continue; -+ -+ if ((e_flags & RTW_CHF_DFS) || (d_flags & RTW_CHF_DFS)) { -+ dfs_ch = rtw_chset_is_dfs_chbw(rfctl->channel_set, ch, bw, offset); -+ if (((e_flags & RTW_CHF_DFS) && !dfs_ch) -+ || ((d_flags & RTW_CHF_DFS) && dfs_ch)) -+ continue; -+ } -+ -+ if ((e_flags & RTW_CHF_LONG_CAC) || (d_flags & RTW_CHF_LONG_CAC)) { -+ long_cac = rtw_is_long_cac_ch(ch, bw, offset, rtw_rfctl_get_dfs_domain(rfctl)); -+ if (((e_flags & RTW_CHF_LONG_CAC) && !long_cac) -+ || ((d_flags & RTW_CHF_LONG_CAC) && long_cac)) -+ continue; -+ } -+ -+ if ((e_flags & RTW_CHF_NON_OCP) || (d_flags & RTW_CHF_NON_OCP)) { -+ non_ocp = rtw_chset_is_chbw_non_ocp(rfctl->channel_set, ch, bw, offset); -+ if (((e_flags & RTW_CHF_NON_OCP) && !non_ocp) -+ || ((d_flags & RTW_CHF_NON_OCP) && non_ocp)) -+ continue; -+ } -+ -+ #ifdef CONFIG_DFS_MASTER -+ waiting_ms = rtw_get_ch_waiting_ms(rfctl, ch, bw, offset, &non_ocp_ms, &cac_ms); -+ #endif -+ -+ #ifdef CONFIG_RTW_ACS -+ if (by_int_info) { -+ /* for now, consider only primary channel */ -+ int_factor = hal_data->acs.interference_time[i]; -+ } -+ #endif -+ -+ if (DBG_CHOOSE_SHORTEST_WAITING_CH) -+ RTW_INFO("%s:%u,%u,%u %u(non_ocp:%u, cac:%u), int:%u\n" -+ , __func__, ch, bw, offset, waiting_ms, non_ocp_ms, cac_ms, int_factor); -+ -+ if (ch_c == 0 -+ /* first: smaller wating time */ -+ || min_waiting_ms > waiting_ms -+ /* then: less interference */ -+ || (min_waiting_ms == waiting_ms && int_factor_c > int_factor) -+ /* then: wider bw */ -+ || (min_waiting_ms == waiting_ms && int_factor_c == int_factor && bw > bw_c) -+ /* if all condition equal, same channel -> same band prefer */ -+ || (min_waiting_ms == waiting_ms && int_factor_c == int_factor && bw == bw_c -+ && ((cur_ch != ch_c && cur_ch == ch) -+ || (!rtw_is_same_band(cur_ch, ch_c) && rtw_is_same_band(cur_ch, ch))) -+ ) -+ ) { -+ ch_c = ch; -+ bw_c = bw; -+ offset_c = offset; -+ min_waiting_ms = waiting_ms; -+ int_factor_c = int_factor; -+ } -+ } -+ } -+ -+ if (ch_c != 0) { -+ RTW_INFO("%s: select %u,%u,%u waiting_ms:%u\n" -+ , __func__, ch_c, bw_c, offset_c, min_waiting_ms); -+ *dec_ch = ch_c; -+ *dec_bw = bw_c; -+ *dec_offset = offset_c; -+ return _TRUE; -+ } else { -+ RTW_INFO("%s: not found\n", __func__); -+ if (d_flags == 0) -+ rtw_warn_on(1); -+ } -+ -+ return _FALSE; -+} -+ -+#ifdef CONFIG_PROC_DEBUG -+#define RTW_CHF_FMT "%s%s%s%s%s%s" -+ -+#define RTW_CHF_ARG_NO_IR(flags) (flags & RTW_CHF_NO_IR) ? " NO_IR" : "" -+#define RTW_CHF_ARG_DFS(flags) , (flags & RTW_CHF_DFS) ? " DFS" : "" -+#define RTW_CHF_ARG_NO_HT40U(flags) , (flags & RTW_CHF_NO_HT40U) ? " NO_40M+" : "" -+#define RTW_CHF_ARG_NO_HT40L(flags) , (flags & RTW_CHF_NO_HT40L) ? " NO_40M-" : "" -+#define RTW_CHF_ARG_NO_80MHZ(flags) , (flags & RTW_CHF_NO_80MHZ) ? " NO_80M" : "" -+#define RTW_CHF_ARG_NO_160MHZ(flags) , (flags & RTW_CHF_NO_160MHZ) ? " NO_160M" : "" -+ -+#define RTW_CHF_ARG(flags) \ -+ RTW_CHF_ARG_NO_IR(flags) \ -+ RTW_CHF_ARG_DFS(flags) \ -+ RTW_CHF_ARG_NO_HT40U(flags) \ -+ RTW_CHF_ARG_NO_HT40L(flags) \ -+ RTW_CHF_ARG_NO_80MHZ(flags) \ -+ RTW_CHF_ARG_NO_160MHZ(flags) -+ -+static void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set, u8 chset_num) -+{ -+ char buf[8]; -+ u8 i; -+ -+ RTW_PRINT_SEL(sel, "%-3s %-4s %-4s flags\n", "ch", "freq", "nocp"); -+ -+ for (i = 0; i < MAX_CHANNEL_NUM && i < chset_num && ch_set[i].ChannelNum != 0; i++) { -+ #ifdef CONFIG_DFS_MASTER -+ if ((ch_set[i].flags & RTW_CHF_DFS) && CH_IS_NON_OCP(&ch_set[i])) -+ snprintf(buf, 8, "%d", rtw_systime_to_ms(ch_set[i].non_ocp_end_time - rtw_get_current_time()) / 1000); -+ else -+ #endif -+ snprintf(buf, 8, "0"); -+ -+ RTW_PRINT_SEL(sel, "%3u %4u %4s"RTW_CHF_FMT"\n" -+ , ch_set[i].ChannelNum, rtw_ch2freq_by_band(ch_set[i].band, ch_set[i].ChannelNum), buf -+ , RTW_CHF_ARG(ch_set[i].flags) -+ ); -+ } -+ -+ RTW_PRINT_SEL(sel, "total ch number:%d\n", i); -+} -+ -+static void dump_chplan_txpwr_lmts(void *sel, struct get_chplan_resp *chplan) -+{ -+ char buf[TXPWR_NAMES_STR_LEN]; -+ -+ RTW_PRINT_SEL(sel, "txpwr_lmt:%s\n", rtw_get_txpwr_lmt_names_str(buf, chplan->txpwr_lmt_name, 0)); -+} -+ -+static void dump_chplan_edcca_modes(void *sel, struct get_chplan_resp *chplan) -+{ -+ u8 modes[BAND_MAX]; -+ char buf[EDCCA_MODES_STR_LEN]; -+ -+ modes[BAND_ON_2_4G] = chplan->edcca_mode_2g; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ modes[BAND_ON_5G] = chplan->edcca_mode_5g; -+#endif -+#if CONFIG_IEEE80211_BAND_6GHZ -+ modes[BAND_ON_6G] = chplan->edcca_mode_6g; -+#endif -+ -+ RTW_PRINT_SEL(sel, "edcca_mode:%s\n", rtw_get_edcca_modes_str(buf, modes)); -+} -+ -+void dump_cur_country(void *sel, struct rf_ctl_t *rfctl) -+{ -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ struct get_chplan_resp *chplan; -+ int i; -+ -+ if (rtw_get_chplan_cmd(dvobj_get_primary_adapter(dvobj), RTW_CMDF_WAIT_ACK, &chplan) == _FAIL) -+ return; -+ -+ RTW_PRINT_SEL(sel, "%c%c\n", chplan->alpha2[0], chplan->alpha2[1]); -+ -+ rtw_vmfree(chplan, sizeof(struct get_chplan_resp) + sizeof(RT_CHANNEL_INFO) * chplan->chset_num); -+} -+ -+void dump_cur_chset(void *sel, struct rf_ctl_t *rfctl) -+{ -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ struct get_chplan_resp *chplan; -+ int i; -+ -+ if (rtw_get_chplan_cmd(dvobj_get_primary_adapter(dvobj), RTW_CMDF_WAIT_ACK, &chplan) == _FAIL) -+ return; -+ -+ RTW_PRINT_SEL(sel, "regd_src:%s(%d)\n", regd_src_str(chplan->regd_src), chplan->regd_src); -+ RTW_PRINT_SEL(sel, "regd_inr:%s\n", regd_inr_str(chplan->regd_inr)); -+ -+ RTW_PRINT_SEL(sel, "alpha2:%c%c\n", chplan->alpha2[0], chplan->alpha2[1]); -+ -+#ifdef CONFIG_80211AX_HE -+ RTW_PRINT_SEL(sel, "ax:%d\n", (chplan->proto_en & CHPLAN_PROTO_EN_AX) ? 1 : 0); -+#endif -+#ifdef CONFIG_80211AC_VHT -+ RTW_PRINT_SEL(sel, "ac:%d\n", (chplan->proto_en & CHPLAN_PROTO_EN_AC) ? 1 : 0); -+#endif -+ -+ if (chplan->channel_plan == RTW_CHPLAN_UNSPECIFIED) -+ RTW_PRINT_SEL(sel, "chplan:NA\n"); -+ else -+ RTW_PRINT_SEL(sel, "chplan:0x%02X\n", chplan->channel_plan); -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ if (chplan->chplan_6g == RTW_CHPLAN_6G_UNSPECIFIED) -+ RTW_PRINT_SEL(sel, "chplan_6g:NA\n"); -+ else -+ RTW_PRINT_SEL(sel, "chplan_6g:0x%02X\n", chplan->chplan_6g); -+#endif -+ -+#if CONFIG_TXPWR_LIMIT -+ dump_chplan_txpwr_lmts(sel, chplan); -+#endif -+ -+ dump_chplan_edcca_modes(sel, chplan); -+ -+#ifdef CONFIG_DFS_MASTER -+ RTW_PRINT_SEL(sel, "dfs_domain:%s(%u)\n", rtw_dfs_regd_str(chplan->dfs_domain), chplan->dfs_domain); -+#endif -+ -+ for (i = 0; i < MAX_CHANNEL_NUM_2G_5G; i++) -+ if (regsty->excl_chs[i] != 0) -+ break; -+ -+ if (i < MAX_CHANNEL_NUM_2G_5G) { -+ RTW_PRINT_SEL(sel, "excl_chs:"); -+ for (i = 0; i < MAX_CHANNEL_NUM_2G_5G; i++) { -+ if (regsty->excl_chs[i] == 0) -+ break; -+ _RTW_PRINT_SEL(sel, "%u ", regsty->excl_chs[i]); -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ for (i = 0; i < MAX_CHANNEL_NUM_6G; i++) -+ if (regsty->excl_chs_6g[i] != 0) -+ break; -+ -+ if (i < MAX_CHANNEL_NUM_6G) { -+ RTW_PRINT_SEL(sel, "excl_chs_6g:"); -+ for (i = 0; i < MAX_CHANNEL_NUM_6G; i++) { -+ if (regsty->excl_chs_6g[i] == 0) -+ break; -+ _RTW_PRINT_SEL(sel, "%u ", regsty->excl_chs_6g[i]); -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif -+ -+ dump_chset(sel, chplan->chset, chplan->chset_num); -+ -+ rtw_vmfree(chplan, sizeof(struct get_chplan_resp) + sizeof(RT_CHANNEL_INFO) * chplan->chset_num); -+} -+#endif /* CONFIG_PROC_DEBUG */ -+ -+/* -+ * 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_chset_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch) -+{ -+ int i; -+ -+ if (ch == 0) -+ return -1; -+ -+ for (i = 0; i < MAX_CHANNEL_NUM && ch_set[i].ChannelNum != 0; i++) { -+ if (ch == ch_set[i].ChannelNum) -+ return i; -+ } -+ -+ return -1; -+} -+ -+/* -+ * Search the @param ch of @param band in given @param ch_set -+ * @ch_set: the given channel set -+ * @band: the given band -+ * @ch: the given channel number -+ * -+ * return the index of channel_num in channel_set, -1 if not found -+ */ -+int rtw_chset_search_ch_by_band(RT_CHANNEL_INFO *ch_set, BAND_TYPE band, const u32 ch) -+{ -+ int i; -+ -+ if (ch == 0) -+ return -1; -+ -+ for (i = 0; i < MAX_CHANNEL_NUM && ch_set[i].ChannelNum != 0; i++) { -+ if (band == ch_set[i].band && ch == ch_set[i].ChannelNum) -+ return i; -+ } -+ -+ return -1; -+} -+ -+/* -+ * 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 -+ , bool allow_primary_passive, bool allow_passive) -+{ -+ u8 cch; -+ u8 *op_chs; -+ u8 op_ch_num; -+ u8 valid = 0; -+ int i; -+ int ch_idx; -+ -+ 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)); -+ ch_idx = rtw_chset_search_ch(ch_set, *(op_chs + i)); -+ if (ch_idx == -1) -+ break; -+ if (ch_set[ch_idx].flags & RTW_CHF_NO_IR) { -+ if (!allow_passive -+ || (!allow_primary_passive && ch_set[ch_idx].ChannelNum == ch)) -+ break; -+ } -+ if (bw >= CHANNEL_WIDTH_40) { -+ if ((ch_set[ch_idx].flags & RTW_CHF_NO_HT40U) && i % 2 == 0) -+ break; -+ if ((ch_set[ch_idx].flags & RTW_CHF_NO_HT40L) && i % 2 == 1) -+ break; -+ } -+ if (bw >= CHANNEL_WIDTH_80 && (ch_set[ch_idx].flags & RTW_CHF_NO_80MHZ)) -+ break; -+ if (bw >= CHANNEL_WIDTH_160 && (ch_set[ch_idx].flags & RTW_CHF_NO_160MHZ)) -+ break; -+ } -+ -+ if (op_ch_num != 0 && i == op_ch_num) -+ valid = 1; -+ -+exit: -+ return valid; -+} -+ -+/** -+ * rtw_chset_sync_chbw - obey g_ch, adjust g_bw, g_offset, bw, offset to fit in channel plan -+ * @ch_set: channel plan to check -+ * @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 -+ * @allow_primary_passive: if allow passive primary ch when deciding chbw -+ * @allow_passive: if allow passive ch (not primary) when deciding chbw -+ */ -+void rtw_chset_sync_chbw(RT_CHANNEL_INFO *ch_set, u8 *req_ch, u8 *req_bw, u8 *req_offset -+ , u8 *g_ch, u8 *g_bw, u8 *g_offset, bool allow_primary_passive, bool allow_passive) -+{ -+ u8 r_ch, r_bw, r_offset; -+ u8 u_ch, u_bw, u_offset; -+ u8 cur_bw = *req_bw; -+ -+ while (1) { -+ r_ch = *req_ch; -+ r_bw = cur_bw; -+ r_offset = *req_offset; -+ u_ch = *g_ch; -+ u_bw = *g_bw; -+ u_offset = *g_offset; -+ -+ rtw_sync_chbw(&r_ch, &r_bw, &r_offset, &u_ch, &u_bw, &u_offset); -+ -+ if (rtw_chset_is_chbw_valid(ch_set, r_ch, r_bw, r_offset, allow_primary_passive, allow_passive)) -+ break; -+ if (cur_bw == CHANNEL_WIDTH_20) { -+ rtw_warn_on(1); -+ break; -+ } -+ cur_bw--; -+ }; -+ -+ *req_ch = r_ch; -+ *req_bw = r_bw; -+ *req_offset = r_offset; -+ *g_ch = u_ch; -+ *g_bw = u_bw; -+ *g_offset = u_offset; -+} -+ -+/* -+ * 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; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 rx_bar_enble = _TRUE; -+ -+ /* -+ * Sync driver status and hardware setting -+ */ -+ -+ /* Modify to make sure first time change channel(band) would be done properly */ -+ pHalData->current_channel = 0; -+ pHalData->current_channel_bw = CHANNEL_WIDTH_MAX; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ pHalData->current_band_type = BAND_MAX; -+ #else -+ pHalData->current_band_type = BAND_ON_2_4G; -+ #endif -+ -+ /* set_opmode_cmd(padapter, infra_client_with_mlme); */ /* removed */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_ENABLE_RX_BAR, &rx_bar_enble); -+ 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 end_set[1] = {0xff}; -+ u8 offset_datarate = 0; -+ u8 offset_basicrate = 0; -+#ifdef CONFIG_80211N_HT -+ unsigned char supported_mcs_set[16] = {0xff, 0xff, 0xff, 0xff, 0x00, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+#endif -+ -+ if (IsSupportedTxCCK(padapter->registrypriv.wireless_mode)) { -+ -+ unsigned char datarate_b[B_MODE_RATE_NUM] ={_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_}; -+ _rtw_memcpy(pmlmeext->datarate, datarate_b, B_MODE_RATE_NUM); -+ _rtw_memcpy(pmlmeext->basicrate, datarate_b, B_MODE_RATE_NUM); -+ offset_datarate += B_MODE_RATE_NUM; -+ offset_basicrate += B_MODE_RATE_NUM; -+ RTW_INFO("%s: support CCK\n", __func__); -+ } -+ if(IsSupportedTxOFDM(padapter->registrypriv.wireless_mode)) { -+ unsigned char datarate_g[G_MODE_RATE_NUM] ={_6M_RATE_, _9M_RATE_, _12M_RATE_, _18M_RATE_,_24M_RATE_, _36M_RATE_, _48M_RATE_, _54M_RATE_}; -+ unsigned char basicrate_g[G_MODE_BASIC_RATE_NUM] = {_6M_RATE_, _12M_RATE_, _24M_RATE_}; -+ _rtw_memcpy(pmlmeext->datarate + offset_datarate, datarate_g, G_MODE_RATE_NUM); -+ _rtw_memcpy(pmlmeext->basicrate + offset_basicrate,basicrate_g, G_MODE_BASIC_RATE_NUM); -+ offset_datarate += G_MODE_RATE_NUM; -+ offset_basicrate += G_MODE_BASIC_RATE_NUM; -+ RTW_INFO("%s: support OFDM\n", __func__); -+ -+ } -+ _rtw_memcpy(pmlmeext->datarate + offset_datarate, end_set, 1); -+ _rtw_memcpy(pmlmeext->basicrate + offset_basicrate, end_set, 1); -+ -+#ifdef CONFIG_80211N_HT -+ if( padapter->registrypriv.ht_enable && is_supported_ht(padapter->registrypriv.wireless_mode)) -+ _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; -+#endif -+ 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) || ((padapter->registrypriv.wireless_mode & WIRELESS_11B) == 0)) { -+ pmlmeext->tx_rate = IEEE80211_OFDM_RATE_6MB; -+ pmlmeext->tx_rate_section = OFDM; -+ } else { -+ pmlmeext->tx_rate = IEEE80211_CCK_RATE_1MB; -+ pmlmeext->tx_rate_section = CCK; -+ } -+ -+ 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 -+#ifdef CONFIG_LAYER2_ROAMING -+ if (padapter->mlmepriv.roam_flags & RTW_ROAM_ACTIVE) -+ mlmeext_assign_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN | SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); -+ else -+#endif -+ mlmeext_assign_scan_backop_flags_sta(pmlmeext, /*SS_BACKOP_EN |*/ SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); -+ #ifdef CONFIG_AP_MODE -+ #ifdef CONFIG_CUSTOMER_EZVIZ_CHIME2 -+ mlmeext_assign_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN | SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME | SS_BACKOP_EN_NL); -+ #else -+ mlmeext_assign_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN | SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); -+ #endif -+ #endif -+ #ifdef CONFIG_RTW_MESH -+ mlmeext_assign_scan_backop_flags_mesh(pmlmeext, /*SS_BACKOP_EN | */SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); -+ #endif -+ 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; -+#ifdef ROKU_PRIVATE -+/*infra mode, used to store AP's info*/ -+ _rtw_memset(pmlmeinfo->SupportedRates_infra_ap, 0, NDIS_802_11_LENGTH_RATES_EX); -+ pmlmeinfo->ht_vht_received = 0; -+#endif /* ROKU_PRIVATE */ -+#ifdef CONFIG_WRITE_BCN_LEN_TO_FW -+ pmlmeinfo->last_bcn_len = 0; -+#endif -+} -+ -+void init_mlme_ext_timer(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ rtw_init_timer(&pmlmeext->survey_timer, padapter, survey_timer_hdl, padapter); -+ rtw_init_timer(&pmlmeext->link_timer, padapter, link_timer_hdl, padapter); -+#ifdef CONFIG_RTW_80211R -+ rtw_init_timer(&pmlmeext->ft_link_timer, padapter, rtw_ft_link_timer_hdl, padapter); -+ rtw_init_timer(&pmlmeext->ft_roam_timer, padapter, rtw_ft_roam_timer_hdl, padapter); -+#endif -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ rtw_init_timer(&pmlmeext->rson_scan_timer, padapter, rson_timer_hdl, padapter); -+#endif -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ rtw_init_timer(&pmlmeext->tbtx_xmit_timer, padapter, rtw_tbtx_xmit_timer_hdl, padapter); -+ rtw_init_timer(&pmlmeext->tbtx_token_dispatch_timer, padapter, rtw_tbtx_token_dispatch_timer_hdl, padapter); -+#endif -+#ifdef CONFIG_DFS -+ rtw_init_timer(&pmlmeext->csa_timer, padapter->pnetdev, csa_timer_hdl, padapter); -+#endif -+} -+ -+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_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->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 -+ -+ pmlmeext->tsf_update_pause_factor = pregistrypriv->tsf_update_pause_factor; -+ pmlmeext->tsf_update_restore_factor = pregistrypriv->tsf_update_restore_factor; -+ -+#ifdef CONFIG_SUPPORT_STATIC_SMPS -+ pmlmeext->ssmps_en = _FALSE; -+ pmlmeext->ssmps_tx_tp_th = SSMPS_TX_TP_TH;/*Mbps*/ -+ pmlmeext->ssmps_rx_tp_th = SSMPS_RX_TP_TH;/*Mbps*/ -+ #ifdef DBG_STATIC_SMPS -+ pmlmeext->ssmps_test = _FALSE; -+ #endif -+#endif -+ -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+ pmlmeext->txss_ctrl_en = _TRUE; -+ pmlmeext->txss_tp_th = TXSS_TP_TH; -+ pmlmeext->txss_tp_chk_cnt = TXSS_TP_CHK_CNT; -+#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); -+#ifdef CONFIG_DFS -+ _cancel_timer_ex(&pmlmeext->csa_timer); -+#endif /* CONFIG_DFS */ -+ } -+} -+ -+#ifdef CONFIG_PATCH_JOIN_WRONG_CHANNEL -+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; -+} -+#endif /* CONFIG_PATCH_JOIN_WRONG_CHANNEL */ -+ -+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)) -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ { -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) != _TRUE) -+ return; -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ return; -+ -+ if ( pwdev_priv->pno_mac_addr[0] == 0xFF) -+ return; -+ -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_pno_mac_addr(padapter), ETH_ALEN)) -+ return; -+ } -+#else -+ return; -+#endif -+ -+ ptable->func(padapter, precv_frame); -+ } -+ -+} -+ -+void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ int index; -+ struct mlme_handler *ptable; -+ 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, get_addr2_ptr(pframe)); -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ -+#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 = get_addr2_ptr(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)) -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ { -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) != _TRUE) -+ return; -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ return; -+ -+ if ( pwdev_priv->pno_mac_addr[0] == 0xFF) -+ return; -+ -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_pno_mac_addr(padapter), ETH_ALEN)) -+ return; -+ } -+#else -+ return; -+#endif -+ -+ ptable = mlme_sta_tbl; -+ -+ index = get_frame_sub_type(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(get_addr2_ptr(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 */ -+ precvpriv->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 (get_frame_sub_type(pframe)) { -+ case WIFI_AUTH: -+ if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) -+ ptable->func = &OnAuth; -+ else -+ ptable->func = &OnAuthClient; -+ fallthrough; -+ case WIFI_ASSOCREQ: -+ case WIFI_REASSOCREQ: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ #ifdef CONFIG_HOSTAPD_MLME -+ if (MLME_IS_AP(padapter)) -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+ #endif -+ break; -+ case WIFI_PROBEREQ: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ #ifdef CONFIG_HOSTAPD_MLME -+ if (MLME_IS_AP(padapter)) -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+ #endif -+ break; -+ case WIFI_BEACON: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ case WIFI_ACTION: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ default: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ #ifdef CONFIG_HOSTAPD_MLME -+ if (MLME_IS_AP(padapter)) -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+ #endif -+ 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 -+#ifdef CONFIG_P2P -+ if ((adapter_to_dvobj(padapter)->wpas_type == RTW_WPAS_W1FI) && -+ !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 -+#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 <= DESC_RATE11M) -+ 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, WIFI_ASOC_STATE) == _FALSE && -+ check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_AP_STATE | WIFI_MESH_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, WIFI_ASOC_STATE) == _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++; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (psta->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt++; -+ #endif -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ /* generate pairing ID */ -+ mac_addr = adapter_mac_addr(padapter); -+ peer_addr = psta->cmn.mac_addr; -+ psta->pid = (u16)(((mac_addr[4] << 8) + mac_addr[5]) + ((peer_addr[4] << 8) + peer_addr[5])); -+ -+ /* update peer stainfo */ -+ psta->isrc = _TRUE; -+ -+ /* AID assignment */ -+ if (psta->cmn.aid > 0) -+ RTW_INFO(FUNC_ADPT_FMT" old AID=%d\n", FUNC_ADPT_ARG(padapter), psta->cmn.aid); -+ else { -+ if (!rtw_aid_alloc(padapter, psta)) { -+ RTW_INFO(FUNC_ADPT_FMT" no room for more AIDs\n", FUNC_ADPT_ARG(padapter)); -+ return _SUCCESS; -+ } -+ RTW_INFO(FUNC_ADPT_FMT" allocate new AID=%d\n", FUNC_ADPT_ARG(padapter), psta->cmn.aid); -+ } -+ -+ psta->qos_option = 1; -+ psta->cmn.bw_mode = CHANNEL_WIDTH_20; -+ psta->ieee8021x_blocked = _FALSE; -+#ifdef CONFIG_80211N_HT -+ if(padapter->registrypriv.ht_enable && -+ is_supported_ht(padapter->registrypriv.wireless_mode)) { -+ 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 |= WIFI_ASOC_STATE; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ report_add_sta_event(padapter, psta->cmn.mac_addr); -+ -+ } -+ -+ 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, WIFI_UNDER_LINKING | WIFI_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)) -+ goto exit; -+ -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, WLAN_EID_MESH_ID, (int *)&ielen, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ if (!p) -+ goto exit; -+ if (ielen != 0 && _rtw_memcmp((void *)(p + 2), (void *)cur->mesh_id.Ssid, cur->mesh_id.SsidLength) == _FALSE) -+ goto exit; -+ } -+ #endif -+ -+_issue_probersp: -+ if (((check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _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); -+ } -+ -+ } -+ -+exit: -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ 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, get_addr2_ptr(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, get_addr2_ptr(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, get_addr2_ptr(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)) -+ || (MLME_IS_MESH(padapter) && check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) -+ #ifdef CONFIG_RTW_REPEATER_SON -+ || (padapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) -+ #endif -+ ) { -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN) -+ && (pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE && (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ ) { -+ if (!rtw_check_bcn_info(padapter, pframe, precv_frame->u.hdr.len)) { -+ RTW_PRINT(FUNC_ADPT_FMT" ap has changed, disconnect now\n", FUNC_ADPT_ARG(padapter)); -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress , 0, _FALSE); -+ } -+ } -+ -+ 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, get_addr2_ptr(pframe)); -+ if (psta != NULL) -+ psta->sta_stats.rx_mgnt_pkts++; -+ } -+ } -+#endif -+ -+ return _SUCCESS; -+ -+} -+ -+/* for 11n Logo 4.2.31/4.2.32 */ -+#ifdef CONFIG_AP_MODE -+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; -+ -+ if (pmlmeext->bstart_bss == _TRUE) { -+ int left; -+ unsigned char *pos; -+ struct rtw_ieee802_11_elems elems; -+#ifdef CONFIG_80211N_HT -+ u16 cur_op_mode; -+#endif -+ /* 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 /* CONFIG_AP_MODE */ -+ -+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; -+#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_LAYER2_ROAMING -+ _irqL irqL; -+#endif -+ -+ if (validate_beacon_len(pframe, len) == _FALSE) -+ return _SUCCESS; -+ -+ if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS) -+ || (MLME_IS_MESH(padapter) && check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) -+ ) { -+ if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN) -+ && (pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE && (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ ) { -+ if (!rtw_check_bcn_info(padapter, pframe, len)) { -+ RTW_PRINT(FUNC_ADPT_FMT" ap has changed, disconnect now\n", FUNC_ADPT_ARG(padapter)); -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress , 0, _FALSE); -+ } -+ } -+ -+ rtw_mi_report_survey_event(padapter, precv_frame); -+ return _SUCCESS; -+ } -+ -+#ifdef CONFIG_WRITE_BCN_LEN_TO_FW -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) -+ && (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) { -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ -+ if (pmlmeinfo->last_bcn_len != pattrib->pkt_len) { -+ pmlmeinfo->last_bcn_len = pattrib->pkt_len; -+ rtw_write_bcnlen_to_fw_cmd(padapter, pattrib->pkt_len); -+ } -+ } -+#endif -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ if (padapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) -+ rtw_mi_report_survey_event(padapter, precv_frame); -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ rtw_check_legacy_ap(padapter, pframe, len); -+#endif -+ -+ if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) { -+ if ((pmlmeinfo->state & WIFI_FW_AUTH_NULL) -+ && (rtw_sta_linking_test_wait_done() || pmlmeext->join_abort) -+ ) { -+ if (rtw_sta_linking_test_force_fail() || pmlmeext->join_abort) { -+ set_link_timer(pmlmeext, 1); -+ return _SUCCESS; -+ } -+#ifdef CONFIG_LAYER2_ROAMING -+ _enter_critical_bh(&pmlmepriv->clnt_auth_lock, &irqL); -+#endif -+ /* 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); -+ -+ /* 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)); -+ if (is_hidden_ssid(recv_beacon.ssid, recv_beacon.ssid_len)) { -+ _rtw_memcpy(pmlmepriv->cur_beacon_keys.ssid, pmlmeinfo->network.Ssid.Ssid, IW_ESSID_MAX_SIZE); -+ pmlmepriv->cur_beacon_keys.ssid_len = pmlmeinfo->network.Ssid.SsidLength; -+ } -+ } else { -+ RTW_ERR("%s: get beacon keys failed\n", __func__); -+ _rtw_memset(&pmlmepriv->cur_beacon_keys, 0, sizeof(recv_beacon)); -+ } -+ #ifdef CONFIG_BCN_CNT_CONFIRM_HDL -+ pmlmepriv->new_beacon_cnts = 0; -+ #endif -+ } -+ 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)); -+ -+ rtw_phydm_update_ap_vendor_ie(padapter); -+ -+ /* update TSF Value */ -+ update_TSF(pmlmeext, pframe, len); -+ pmlmeext->bcn_cnt = 0; -+ pmlmeext->last_bcn_cnt = 0; -+ -+#ifdef CONFIG_P2P_PS -+ /* Comment by YiWei , in wifi p2p spec the "3.3 P2P Power Management" , "These mechanisms are available in a P2P Group in which only P2P Devices are associated." */ -+ /* 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); -+#ifdef CONFIG_LAYER2_ROAMING -+ _exit_critical_bh(&pmlmepriv->clnt_auth_lock, &irqL); -+#endif -+ return _SUCCESS; -+ } -+ -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) && (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { -+ psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(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 */ -+#ifdef CONFIG_RTW_80211R -+ rtw_ft_update_bcn(padapter, precv_frame); -+#endif -+ ret = rtw_check_bcn_info(padapter, pframe, len); -+ if (!ret) { -+ RTW_PRINT(FUNC_ADPT_FMT" ap has changed, disconnect now\n", FUNC_ADPT_ARG(padapter)); -+ 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.recv_signal_power; -+ pmlmeext->bcn_cnt++; -+#ifdef CONFIG_BCN_RECV_TIME -+ rtw_rx_bcn_time_update(padapter, len, precv_frame->u.hdr.attrib.data_rate); -+#endif -+#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 */ -+ -+ #if CONFIG_DFS -+ process_csa_ie(padapter -+ , pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_ -+ , len - (WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_)); -+ #endif -+ -+ #ifdef CONFIG_80211D -+ process_country_ie(padapter -+ , pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_ -+ , len - (WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_)); -+ #endif -+ -+#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->tsf_update_required && 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) { -+ u8 rate_set[16]; -+ u8 rate_num = 0; -+ -+ psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(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->tsf_update_required && 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, get_addr2_ptr(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, get_addr2_ptr(pframe)); -+ } -+ } -+ } -+ -+_END_ONBEACON_: -+ -+ return _SUCCESS; -+ -+} -+ -+#ifdef CONFIG_AP_MODE -+static u32 rtw_get_sta_num_by_state(_adapter *padapter, u32 state) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ u32 index, sta_num = 0; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &(padapter->stapriv); -+ -+ _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); -+ if ((psta->state & (state))) -+ sta_num++; -+ plist = get_next(plist); -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ /* RTW_INFO("%s : waiting for %u sta under linking \n", __func__, sta_num); */ -+ return sta_num; -+} -+ -+static u8 rtw_defs_attack_chk(_adapter *padapter) -+{ -+ struct mlme_priv *mlme = &(padapter->mlmepriv); -+ u8 is_reject = _FALSE; -+ u32 sta_limit = 0; -+ u32 stime = rtw_systime_to_ms(rtw_get_current_time()); -+ static u32 ptime = 0; -+ -+ /* RTW_INFO("%s : ptime=%u, stime=%u, diff=%u\n", __func__, ptime, stime, (stime - ptime)); */ -+ if ((ptime > 0) && ((stime - ptime) < mlme->defs_lmt_time)) { -+ sta_limit = rtw_get_sta_num_by_state(padapter, WIFI_FW_LINKING_STATE); -+ if (sta_limit >= mlme->defs_lmt_sta) -+ is_reject = _TRUE; -+ } -+ -+ ptime = stime; -+ /* RTW_INFO("%s : current linking num=%u\n", __func__, sta_limit); */ -+ return is_reject; -+} -+#endif -+ -+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, WIFI_UNDER_LINKING | WIFI_UNDER_SURVEY)) { -+ /* don't process auth request; */ -+ return _SUCCESS; -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) -+ return _FAIL; -+ -+ if (!MLME_IS_ASOC(padapter)) -+ return _SUCCESS; -+ -+#if defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_RTW_MESH) -+ if (MLME_IS_MESH(padapter)) -+ return rtw_mesh_on_auth(padapter, precv_frame); -+#endif -+ -+ RTW_INFO("+OnAuth from "MAC_FMT"\n", MAC_ARG(get_addr2_ptr(pframe))); -+ -+ sa = get_addr2_ptr(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 (rtw_check_invalid_mac_address(sa, _FALSE)){ -+ RTW_INFO("%s : reject invalid AUTH-req "MAC_FMT"\n", -+ __func__, MAC_ARG(get_addr2_ptr(pframe))); -+ return _FAIL; -+ } -+ -+ if(rtw_defs_attack_chk(padapter)) { -+ struct sta_info *_psta; -+ _psta = rtw_get_stainfo(pstapriv, sa); -+ if ((_psta == NULL) || !(_psta->state & WIFI_FW_ASSOC_SUCCESS)) { -+ status = _STATS_REFUSED_TEMPORARILY_; -+ RTW_ERR("%s : refused temporarily for sa "MAC_FMT" !\n", __func__, MAC_ARG(sa)); -+ goto auth_fail; -+ } -+ } -+ -+ if (rtw_ap_linking_test_force_auth_fail()) { -+ status = rtw_ap_linking_test_force_auth_fail(); -+ RTW_INFO(FUNC_ADPT_FMT" force auth fail with status:%u\n" -+ , FUNC_ADPT_ARG(padapter), status); -+ goto auth_fail; -+ } -+ -+ if ((auth_mode == 2) && (algorithm != WLAN_AUTH_SAE) && -+ (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 CONFIG_RTW_MACADDR_ACL -+ 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->flags & WLAN_STA_MFP)) -+ || !(pstat->flags & WLAN_STA_MFP)) -+#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--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (pstat->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt--; -+ #endif -+ 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->flags & WLAN_STA_MFP)) -+ || !(pstat->flags & WLAN_STA_MFP)) -+#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; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (GET_CFG80211_REPORT_MGMT(adapter_wdev_data(padapter), IEEE80211_STYPE_AUTH) == _TRUE) { -+ if ((algorithm == WLAN_AUTH_SAE) && -+ (auth_mode == dot11AuthAlgrthm_8021X)) { -+ pstat->authalg = algorithm; -+ -+ rtw_cfg80211_rx_mframe(padapter, precv_frame, NULL); -+ return _SUCCESS; -+ } -+ } -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ 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->flags & WLAN_STA_MFP)) -+ || !(pstat->flags & WLAN_STA_MFP)) -+#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->flags & WLAN_STA_MFP)) -+ || !(pstat->flags & WLAN_STA_MFP)) -+#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->flags & WLAN_STA_MFP)) -+ || !(pstat->flags & WLAN_STA_MFP)) -+#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->cmn.mac_addr, sa, ETH_ALEN); -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ issue_auth(padapter, pstat, (unsigned short)status); -+#endif -+ -+#endif /* CONFIG_AP_MODE */ -+ 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); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint pkt_len = precv_frame->u.hdr.len; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (GET_CFG80211_REPORT_MGMT(adapter_wdev_data(padapter), IEEE80211_STYPE_AUTH) == _TRUE) { -+ if (rtw_sec_chk_auth_type(padapter, MLME_AUTHTYPE_SAE)) { -+ if (rtw_cached_pmkid(padapter, get_my_bssid(&pmlmeinfo->network)) != -1) { -+ RTW_INFO("SAE: PMKSA cache entry found\n"); -+ goto normal; -+ } -+ rtw_cfg80211_rx_mframe(padapter, precv_frame, NULL); -+ return _SUCCESS; -+ } -+ } -+ -+normal: -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ /* 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) || pmlmeext->join_abort) -+ 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; */ -+ } -+ -+ pmlmeinfo->auth_status = status; -+ 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; -+ } -+ -+ if (len > sizeof(pmlmeinfo->chg_txt)) { -+ 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_ft_update_auth_rsp_ies(padapter, pframe, pkt_len)) -+ 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 listen_interval; -+ struct rtw_ieee802_11_elems elems; -+ struct sta_info *pstat; -+ unsigned char reassoc, *pos; -+ int left; -+ unsigned short status = _STATS_SUCCESSFUL_; -+ unsigned short frame_type, ie_offset = 0; -+ 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_RTW_TOKEN_BASED_XMIT -+ u8 sta_tbtx_enable = _FALSE; -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) && -+ rtw_mi_buddy_check_fwstate(padapter, WIFI_UNDER_LINKING | WIFI_UNDER_SURVEY)) { -+ /* don't process assoc request; */ -+ return _SUCCESS; -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) -+ return _FAIL; -+ -+ if (rtw_check_invalid_mac_address(get_addr2_ptr(pframe), _FALSE)) { -+ RTW_INFO("%s : reject invalid ASSOC-req "MAC_FMT"\n", -+ __func__, MAC_ARG(get_addr2_ptr(pframe))); -+ return _FAIL; -+ } -+ -+ frame_type = get_frame_sub_type(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, get_addr2_ptr(pframe)); -+ if (pstat == (struct sta_info *)NULL) { -+ status = _RSON_CLS2_; -+ goto asoc_class2_error; -+ } -+ -+ RTW_INFO("%s from "MAC_FMT"\n", __FUNCTION__, MAC_ARG(get_addr2_ptr(pframe))); -+ -+ if (pstat->authalg == WLAN_AUTH_SAE) { -+ /* WPA3-SAE */ -+ if (((pstat->state) & WIFI_FW_AUTH_NULL)) { -+ /* TODO: -+ Queue AssocReq and Proccess -+ by external auth trigger. */ -+ RTW_INFO("%s: wait external auth trigger\n", __func__); -+ return _SUCCESS; -+ } -+ } -+ -+ /* 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 -+ -+ if (rtw_ap_linking_test_force_asoc_fail()) { -+ status = rtw_ap_linking_test_force_asoc_fail(); -+ RTW_INFO(FUNC_ADPT_FMT" force asoc fail with status:%u\n" -+ , FUNC_ADPT_ARG(padapter), status); -+ goto OnAssocReqFail; -+ } -+ -+ /* now parse all ieee802_11 ie to point to elems */ -+ left = pkt_len - (IEEE80211_3ADDR_LEN + ie_offset); -+ pos = pframe + (IEEE80211_3ADDR_LEN + ie_offset); -+ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed) { -+ RTW_INFO("STA " MAC_FMT " sent invalid association request\n", -+ MAC_ARG(pstat->cmn.mac_addr)); -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+ -+ rtw_ap_parse_sta_capability(padapter, pstat, pframe + WLAN_HDR_A3_LEN); -+ -+ listen_interval = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN + 2); -+#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 we should check all the fields... */ -+ /* checking SSID */ -+ if (elems.ssid == NULL -+ || elems.ssid_len == 0 -+ || elems.ssid_len != cur->Ssid.SsidLength -+ || _rtw_memcmp(elems.ssid, cur->Ssid.Ssid, cur->Ssid.SsidLength) == _FALSE -+ ) { -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+ -+ /* (Extended) Supported rates */ -+ status = rtw_ap_parse_sta_supported_rates(padapter, pstat -+ , pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (status != _STATS_SUCCESSFUL_) -+ goto OnAssocReqFail; -+ -+ /* check RSN/WPA/WPS */ -+ status = rtw_ap_parse_sta_security_ie(padapter, pstat, &elems); -+ if (status != _STATS_SUCCESSFUL_) -+ goto OnAssocReqFail; -+ -+ /* check if there is WMM IE & support WWM-PS */ -+ rtw_ap_parse_sta_wmm_ie(padapter, pstat -+ , pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ -+#ifdef CONFIG_RTS_FULL_BW -+ /*check vendor IE*/ -+ rtw_parse_sta_vendor_ie_8812(padapter, pstat -+ , pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+#endif/*CONFIG_RTS_FULL_BW*/ -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (elems.tbtx_cap && elems.tbtx_cap_len != 0) { -+ if(rtw_is_tbtx_capabilty(elems.tbtx_cap, elems.tbtx_cap_len)) { -+ sta_tbtx_enable = _TRUE; -+ } -+ } -+ -+#endif -+ -+ rtw_ap_parse_sta_ht_ie(padapter, pstat, &elems); -+ rtw_ap_parse_sta_vht_ie(padapter, pstat, &elems); -+ -+ 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->cmn.mac_addr)); -+ -+ pstat->flags &= ~WLAN_STA_HT; -+ pstat->flags &= ~WLAN_STA_VHT; -+ /*status = WLAN_STATUS_CIPHER_REJECTED_PER_POLICY; -+ * 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 */ -+ -+ rtw_ap_parse_sta_multi_ap_ie(padapter, pstat, pos, left); -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ if (rtw_rson_ap_check_sta(padapter, pframe, pkt_len, ie_offset)) -+ goto OnAssocReqFail; -+#endif -+ -+ /* TODO: identify_proprietary_vendor_ie(); */ -+ /* Realtek proprietary IE */ -+ /* identify if this is Broadcom sta */ -+ /* identify if this is ralink sta */ -+ /* Customer proprietary IE */ -+ -+#ifdef CONFIG_RTW_80211K -+ rtw_ap_parse_sta_rm_en_cap(padapter, pstat, &elems); -+#endif -+ -+ /* AID assignment */ -+ if (pstat->cmn.aid > 0) -+ RTW_INFO(FUNC_ADPT_FMT" use old AID=%d for "MAC_FMT"\n", -+ FUNC_ADPT_ARG(padapter), pstat->cmn.aid, MAC_ARG(pstat->cmn.mac_addr)); -+ else { -+ if (!rtw_aid_alloc(padapter, pstat)) { -+ RTW_INFO(FUNC_ADPT_FMT" no room for more AIDs for "MAC_FMT"\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(pstat->cmn.mac_addr)); -+ status = WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA; -+ goto OnAssocReqFail; -+ } -+ RTW_INFO(FUNC_ADPT_FMT" allocate new AID=%d for "MAC_FMT"\n", -+ FUNC_ADPT_ARG(padapter), pstat->cmn.aid, MAC_ARG(pstat->cmn.mac_addr)); -+ } -+ -+ 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->cmn.mac_addr)); */ -+#ifdef CONFIG_IEEE80211W -+ if ((pstat->bpairwise_key_installed != _TRUE && (pstat->flags & WLAN_STA_MFP)) -+ || !(pstat->flags & WLAN_STA_MFP)) -+#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++; -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (sta_tbtx_enable) { -+ pstat->tbtx_enable = _TRUE; -+ pstapriv->tbtx_asoc_list_cnt++; -+ } -+#endif -+ } -+ _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 && (pstat->flags & WLAN_STA_MFP)) -+ || !(pstat->flags & WLAN_STA_MFP)) -+#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 && (pstat->flags & WLAN_STA_MFP)) -+ 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 && (pstat->flags & WLAN_STA_MFP)) -+ || !(pstat->flags & WLAN_STA_MFP)) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ /* .3-(1) report sta add event */ -+ report_add_sta_event(padapter, pstat->cmn.mac_addr); -+ } -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed == _TRUE && (pstat->flags & WLAN_STA_MFP)) { -+ RTW_INFO(MAC_FMT"\n", MAC_ARG(pstat->cmn.mac_addr)); -+ issue_action_SA_Query(padapter, pstat->cmn.mac_addr, 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 *)get_addr2_ptr(pframe), status); -+#endif -+ -+ return _FAIL; -+ -+OnAssocReqFail: -+ -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ /* pstat->cmn.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; -+ -+} -+ -+#if defined(CONFIG_LAYER2_ROAMING) && defined(CONFIG_RTW_80211K) -+void rtw_roam_nb_discover(_adapter *padapter, u8 bfroce) -+{ -+ 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; -+ struct sta_info *psta; -+ u8 nb_req_issue = _FALSE; -+ -+ if (!check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) -+ return; -+ -+ if (!rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE)) -+ return; -+ -+ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); -+ if (!psta) -+ return; -+ -+ if (bfroce || (!pmlmepriv->nb_info.nb_rpt_is_same)) -+ nb_req_issue = _TRUE; -+ -+ if (nb_req_issue && (psta->rm_en_cap[0] & RTW_RRM_NB_RPT_EN)) -+ rm_add_nb_req(padapter, psta); -+} -+#endif -+ -+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; -+#ifdef CONFIG_WAPI_SUPPORT -+ PNDIS_802_11_VARIABLE_IEs pWapiIE = NULL; -+#endif -+ -+ 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)) || pmlmeext->join_abort) -+ 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); -+ -+ /* check aid value */ -+ if (res < 1 || res > 2007) { -+ RTW_INFO("assoc reject, aid: %d\n", res); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ res = -4; -+ goto report_assoc_result; -+ } -+ -+ /* 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); -+#ifdef ROKU_PRIVATE -+ HT_caps_handler_infra_ap(padapter, pIE); -+#endif /* ROKU_PRIVATE */ -+ 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); -+#ifdef ROKU_PRIVATE -+ VHT_caps_handler_infra_ap(padapter, pIE); -+#endif /* ROKU_PRIVATE */ -+ break; -+ -+ case EID_VHTOperation: -+ VHT_operation_handler(padapter, pIE); -+ break; -+#endif -+ -+ case _ERPINFO_IE_: -+ ERP_IE_handler(padapter, pIE); -+ break; -+#ifdef CONFIG_TDLS -+ case WLAN_EID_EXT_CAP: -+ 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 */ -+ -+#ifdef CONFIG_RTW_80211K -+ case _EID_RRM_EN_CAP_IE_: -+ RM_IE_handler(padapter, pIE); -+ break; -+#endif -+ -+#ifdef ROKU_PRIVATE -+ /* Infra mode, used to store AP's info , Parse the supported rates from AssocRsp */ -+ case _SUPPORTEDRATES_IE_: -+ Supported_rate_infra_ap(padapter, pIE); -+ break; -+ -+ case _EXT_SUPPORTEDRATES_IE_: -+ Extended_Supported_rate_infra_ap(padapter, pIE); -+ break; -+#endif /* ROKU_PRIVATE */ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_on_assoc_ok(padapter, pWapiIE); -+#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, status); -+ -+#if defined(CONFIG_LAYER2_ROAMING) && defined(CONFIG_RTW_80211K) -+ rtw_roam_nb_discover(padapter, _TRUE); -+#endif -+ 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)); -+ -+#ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(padapter)) { -+ _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, get_addr2_ptr(pframe)); -+ -+ psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(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--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (psta->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt--; -+ #endif -+ 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 -+ if (!MLME_IS_MESH(padapter)) { -+ 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, get_addr2_ptr(pframe), ignore_received_deauth); -+ -+ if (0 == ignore_received_deauth) -+ receive_disconnect(padapter, get_addr2_ptr(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)); -+ -+#ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(padapter)) { -+ _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, get_addr2_ptr(pframe)); -+ -+ psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(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--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (psta->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt--; -+ #endif -+ 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 -+ if (!MLME_IS_MESH(padapter)) { -+ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" -+ , FUNC_ADPT_ARG(padapter), reason, get_addr2_ptr(pframe)); -+ -+ #ifdef CONFIG_RTW_WNM -+ if (rtw_wnm_try_btm_roam_imnt(padapter) > 0) -+ #endif -+ receive_disconnect(padapter, get_addr2_ptr(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->cmn.mac_addr)); -+ -+ 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_chbw_cmd(padapter, ch, bwmode, ch_offset, 0); -+ } -+ -+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; -+ -+ psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); -+ -+ if (!psta) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_SPECTRUM_MGMT) -+ goto exit; -+ -+ action = frame_body[1]; -+ -+ RTW_INFO(FUNC_ADPT_FMT" action:%u\n", FUNC_ADPT_ARG(padapter), action); -+ -+ 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); -+#elif CONFIG_DFS -+ if (MLME_IS_STA(padapter) && MLME_IS_ASOC(padapter)) { -+ process_csa_ie(padapter -+ , 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 mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct sta_priv *stapriv = &(adapter->stapriv); -+ u8 *frame = rframe->u.hdr.rx_data; -+ u32 frame_len = rframe->u.hdr.len; -+ u8 *frame_body = (u8 *)(frame + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u32 frame_body_len = frame_len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 category, action; -+ int cnt = 0; -+ char msg[16]; -+ -+ sta = rtw_get_stainfo(stapriv, get_addr2_ptr(frame)); -+ if (!sta) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_WNM) -+ goto exit; -+ -+ action = frame_body[1]; -+ -+ switch (action) { -+#ifdef CONFIG_RTW_80211R -+ case RTW_WLAN_ACTION_WNM_BTM_REQ: -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ RTW_INFO("WNM: BSS Transition Management Request recv.\n"); -+ rtw_wnm_process_btm_req(adapter, frame_body, frame_body_len); -+ } -+ ret = _SUCCESS; -+ break; -+#endif -+ case RTW_WLAN_ACTION_WNM_BTM_RSP: -+ if ((check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) && -+ (pmlmepriv->nb_info.features & RTW_WNM_FEATURE_BTM_REQ_EN)) { -+ struct btm_rsp_hdr rsp; -+ u32 sz; -+ -+ RTW_INFO("WNM: BSS Transition Management Response recv.\n"); -+ sz = rtw_wnm_btm_rsp_candidates_sz_get(adapter, -+ frame_body, frame_body_len); -+ _rtw_memset(&rsp, 0, sizeof(rsp)); -+ -+ if (sz > 0) -+ rsp.pcandidates = rtw_zmalloc(sz); -+ -+ rtw_wnm_process_btm_rsp(adapter, frame_body, frame_body_len, &rsp); -+ /* TODO : handle candidates info in rsp.pcandidates for upper-layer services */ -+ #ifdef CONFIG_PLATFORM_CMAP_INTFS -+ cmap_intfs_nl_btm_resp_event(adapter, sta->cmn.mac_addr, -+ adapter_mac_addr(adapter), -+ rsp.status, rsp.bssid, -+ rsp.pcandidates, -+ rsp.candidates_num); -+ #endif -+ if (0 && rsp.pcandidates && (rsp.candidates_num > 0)) -+ RTW_INFO_DUMP("pcandidates : ", rsp.pcandidates, sz); -+ -+ if ((sz > 0) && (rsp.pcandidates != NULL)) -+ rtw_mfree(rsp.pcandidates, sz); -+ } -+ fallthrough; -+ 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; -+ -+#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); -+ -+ /* In Maximum A-MPDU Length Exponent subfield of A-MPDU Parameters field of HT Capabilities element, -+ the unit of max_rx_ampdu_factor are octets. 8K, 16K, 32K, 64K is right. -+ But the buffer size subfield of Block Ack Parameter Set field in ADDBA action frame indicates -+ the number of buffers available for this particular TID. Each buffer is equal to max. size of -+ MSDU or AMSDU. -+ The size variable means how many MSDUs or AMSDUs, it's not Kbytes. -+ */ -+ 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; -+} -+ -+u8 rx_ampdu_size_sta_limit(_adapter *adapter, struct sta_info *sta) -+{ -+ u8 sz_limit = 0xFF; -+ -+#ifdef CONFIG_80211N_HT -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct mlme_ext_info *mlmeinfo = &adapter->mlmeextpriv.mlmext_info; -+ s8 nss = -1; -+ u8 bw = rtw_min(sta->cmn.bw_mode, adapter->mlmeextpriv.cur_bwmode); -+ -+ #ifdef CONFIG_80211AC_VHT -+ if (is_supported_vht(sta->wireless_mode)) { -+ nss = rtw_min(rtw_vht_mcsmap_to_nss(mlme->vhtpriv.vht_mcs_map) -+ , rtw_vht_mcsmap_to_nss(sta->vhtpriv.vht_mcs_map)); -+ } else -+ #endif -+ if (is_supported_ht(sta->wireless_mode)) { -+ nss = rtw_min(rtw_ht_mcsset_to_nss(mlmeinfo->HT_caps.u.HT_cap_element.MCS_rate) -+ , rtw_ht_mcsset_to_nss(sta->htpriv.ht_cap.supp_mcs_set)); -+ } -+ -+ if (nss >= 1) -+ sz_limit = regsty->rx_ampdu_sz_limit_by_nss_bw[nss - 1][bw]; -+#endif /* CONFIG_80211N_HT */ -+ -+ return sz_limit; -+} -+ -+/** -+ * 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 sta_info *sta; -+ u8 accept = rtw_rx_ampdu_is_accept(adapter); -+ u8 size; -+ -+ if (adapter->fix_rx_ampdu_size != RX_AMPDU_SIZE_INVALID) -+ size = adapter->fix_rx_ampdu_size; -+ else -+ size = rtw_rx_ampdu_size(adapter); -+ -+ if (MLME_IS_STA(adapter)) { -+ sta = rtw_get_stainfo(&adapter->stapriv, get_bssid(&adapter->mlmepriv)); -+ if (sta) { -+ u8 sta_size = size; -+ -+ if (adapter->fix_rx_ampdu_size == RX_AMPDU_SIZE_INVALID) -+ sta_size = rtw_min(size, rx_ampdu_size_sta_limit(adapter, sta)); -+ adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, sta_size); -+ } -+ /* TODO: TDLS peer */ -+#ifdef CONFIG_AP_MODE -+ } else if (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { -+ _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) { -+ u8 sta_size = size; -+ -+ if (adapter->fix_rx_ampdu_size == RX_AMPDU_SIZE_INVALID) -+ sta_size = rtw_min(size, rx_ampdu_size_sta_limit(adapter, sta)); -+ adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, sta_size); -+ } -+ } -+#endif /* CONFIG_AP_MODE */ -+ } -+ -+ /* TODO: ADHOC */ -+ -+ 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; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+#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 = get_addr2_ptr(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; -+ -+ 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); -+ /* amsdu in ampdu */ -+ if (pregpriv->tx_ampdu_amsdu == 0) -+ psta->htpriv.tx_amsdu_enable = _FALSE; -+ else if (pregpriv->tx_ampdu_amsdu == 1) -+ psta->htpriv.tx_amsdu_enable = _TRUE; -+ else { -+ if (frame_body[5] & 1) -+ psta->htpriv.tx_amsdu_enable = _TRUE; -+ } -+ } else -+ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ -+ #ifdef CONFIG_AP_MODE -+ 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; -+ } -+ #endif -+ -+ /* RTW_INFO("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->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_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_P2P -+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; -+} -+ -+void issue_p2p_GO_request(_adapter *padapter, u8 *raddr) -+{ -+ struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); -+ 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; -+ 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 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++; -+ set_frame_sub_type(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)(ch_list->reg_classes) -+ + get_reg_classes_full_count(ch_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 -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < ch_list->reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < ch_list->reg_class[j].channels; i++) -+ p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; -+ } -+ } -+ -+ /* 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) -+{ -+ struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); -+ 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; -+ uint wpsielen = 0; -+ u16 wps_devicepassword_id = 0x0000; -+ uint wps_devicepassword_id_len = 0; -+ 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 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++; -+ set_frame_sub_type(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); -+ wps_devicepassword_id_len = sizeof(wps_devicepassword_id); -+ 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)ch_list->reg_classes -+ + get_reg_classes_full_count(ch_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 -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < ch_list->reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < ch_list->reg_class[j].channels; i++) -+ p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; -+ } -+ } -+ -+ /* 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 p2pie[255] = { 0x00 }; -+ u8 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 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++; -+ set_frame_sub_type(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) -+{ -+ struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); -+ 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; -+ u8 dialogToken = 3; -+ 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 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++; -+ set_frame_sub_type(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)ch_list->reg_classes -+ + get_reg_classes_full_count(ch_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 -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < ch_list->reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < ch_list->reg_class[j].channels; i++) -+ p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; -+ } -+ } -+ -+ -+ /* 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) -+{ -+ struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); -+ 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; -+ 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 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++; -+ set_frame_sub_type(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)ch_list->reg_classes -+ + get_reg_classes_full_count(ch_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 -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < ch_list->reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < ch_list->reg_class[j].channels; i++) -+ p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; -+ } -+ } -+ } -+ -+ 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 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++; -+ set_frame_sub_type(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_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 -+ -+ /* 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++; -+ set_frame_sub_type(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 */ -+ -+ /* 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 -+ -+/* Vendor Specific IE */ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ pattrib->pktlen += rtw_build_vendor_ie(padapter , &pframe , WIFI_P2P_PROBERESP_VENDOR_IE_BIT); -+#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; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ 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++; -+ set_frame_sub_type(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 -+ -+/* Vendor Specific IE */ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ pattrib->pktlen += rtw_build_vendor_ie(padapter , &pframe , WIFI_P2P_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_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; -+ systime 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; -+ 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; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#endif -+#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, WIFI_ASOC_STATE)) -+ _cancel_timer_ex(&prochinfo->ap_roch_ch_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, get_addr2_ptr(pframe), ETH_ALEN); -+ -+ result = process_p2p_group_negotation_req(pwdinfo, frame_body, len); -+ issue_p2p_GO_response(padapter, get_addr2_ptr(pframe), frame_body, len, result); -+ -+ /* 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, get_addr2_ptr(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; -+ -+ 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); -+ -+ attr_contentlen = sizeof(invitation_flag); -+ rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_INVITATION_FLAGS, &invitation_flag, &attr_contentlen); -+ if (attr_contentlen) { -+ -+ attr_contentlen = sizeof(pwdinfo->p2p_peer_interface_addr); -+ 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)); -+ attr_contentlen = 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 }; -+ attr_contentlen = sizeof(operatingch_info); -+ if (rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, -+ &attr_contentlen)) { -+ if (rtw_chset_search_ch(adapter_to_chset(padapter), (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); -+ 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)); -+ attr_contentlen = 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, get_addr2_ptr(pframe), pwdinfo->inviteresp_info.token, status_code); -+ _set_timer(&pwdinfo->restore_p2p_state_timer, 3000); -+ } -+ 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) { -+ attr_contentlen = sizeof(attr_content); -+ 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, get_addr2_ptr(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); -+ 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; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ _adapter *adapter = precv_frame->u.hdr.adapter; -+ int cnt = 0; -+ char msg[64]; -+ -+ 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); -+ } else if (_rtw_memcmp(frame_body + 2, DPP_OUI, 4) == _TRUE) { -+ u8 dpp_type = frame_body[7]; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ cnt += sprintf((msg + cnt), "DPP(type:%u)", dpp_type); -+ rtw_cfg80211_rx_action(adapter, precv_frame, msg); -+#endif -+ } -+ -+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; -+ 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 broadcast */ -+ if (!(_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN) || -+ is_broadcast_mac_addr(GetAddr1Ptr(pframe)))) -+ 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 tgt_addr[ETH_ALEN]; -+ 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; -+ struct ft_roam_info *pft_roam = NULL; -+ _irqL irqL; -+ -+ pmlmeext = &(padapter->mlmeextpriv); -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ pmlmepriv = &(padapter->mlmepriv); -+ pft_roam = &(pmlmepriv->ft_roam); -+ 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_RSP: -+ RTW_INFO("FT: RTW_WLAN_ACTION_FT_RSP recv.\n"); -+ 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; -+ } -+ -+ _rtw_memcpy(tgt_addr, &pframe_body[8], ETH_ALEN); -+ if (is_zero_mac_addr(tgt_addr) || is_broadcast_mac_addr(tgt_addr)) { -+ RTW_ERR("FT: Invalid Target MAC Address "MAC_FMT"\n", MAC_ARG(tgt_addr)); -+ goto exit; -+ } -+ -+ pie = rtw_get_ie(pframe_body, _MDIE_, &ft_ie_len, frame_len); -+ if (pie) { -+ if (!_rtw_memcmp(&pft_roam->mdid, pie+2, 2)) { -+ RTW_ERR("FT: Invalid MDID\n"); -+ goto exit; -+ } -+ } -+ -+ rtw_ft_set_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); -+ -+ pft_roam->ft_action_len = frame_len; -+ _rtw_memcpy(pft_roam->ft_action, pframe, rtw_min(frame_len, RTW_FT_MAX_IE_SZ)); -+ ret = _SUCCESS; -+ break; -+ case RTW_WLAN_ACTION_FT_REQ: -+ case RTW_WLAN_ACTION_FT_CONF: -+ 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; -+ 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, get_addr2_ptr(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");*/ -+ rtw_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, get_addr2_ptr(pframe), 1, tid, IEEE80211W_RIGHT_KEY); -+ break; -+ -+ case 1: /* SA Query rsp */ -+ psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(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 on_action_rm(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_RTW_80211K -+ return rm_on_action(padapter, precv_frame); -+#else -+ return _SUCCESS; -+#endif /* CONFIG_RTW_80211K */ -+} -+ -+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 -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ 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");*/ -+ rtw_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 -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ rtw_beamforming_get_vht_gid_mgnt_frame(padapter, precv_frame); -+#endif /* RTW_BEAMFORMING_VERSION_2 */ -+#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; -+ -+} -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+unsigned int OnAction_tbtx_token(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#define TOKEN_REQ 0x00 -+#define TOKEN_REL 0x01 -+ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ u32 xmit_time; -+ u8 *src=NULL, *pframe = precv_frame->u.hdr.rx_data; -+ u8 tbtx_action_code; -+ u8 i, nr_send; -+ uint tx_duration = 0; -+ -+ if (padapter->tbtx_capability == _FALSE) -+ goto exit; -+ -+ tbtx_action_code = *(pframe + WLAN_HDR_A3_LEN + 1); -+ -+ -+ switch (tbtx_action_code) -+ { -+ case TOKEN_REQ: -+ // parse duration -+ tx_duration = le32_to_cpu(*(uint *)(pframe + WLAN_HDR_A3_LEN + 2)); -+ padapter->tbtx_duration = tx_duration/1000; // Mirocsecond to Millisecond -+ ATOMIC_SET(&padapter->tbtx_tx_pause, _FALSE); -+ rtw_tx_control_cmd(padapter); -+ _set_timer(&pmlmeext->tbtx_xmit_timer, padapter->tbtx_duration); -+ ATOMIC_SET(&padapter->tbtx_remove_tx_pause, _FALSE); -+#if defined(CONFIG_SDIO_HCI) && !defined(CONFIG_SDIO_TX_TASKLET) -+ _rtw_up_sema(&pxmitpriv->SdioXmitSema); -+#else -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+#endif -+ break; -+#ifdef CONFIG_AP_MODE -+ case TOKEN_REL: -+ src = get_addr2_ptr(pframe); -+ if (!src) -+ goto exit; -+ psta = rtw_get_stainfo(&padapter->stapriv, src); -+ if (!psta) -+ goto exit; -+ -+ if (ATOMIC_READ(&pstapriv->nr_token_keeper) < 1) -+ goto exit; -+ -+ for (i=0; i< NR_MAXSTA_INSLOT; i++) { -+ if (pstapriv->token_holder[i] == psta) { -+ pstapriv->token_holder[i] = NULL; -+ //RTW_INFO("macaddr1:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); -+ ATOMIC_DEC(&pstapriv->nr_token_keeper); -+ break; -+ } -+ } -+ -+ if (ATOMIC_READ(&pstapriv->nr_token_keeper) == 0) -+ _set_timer(&pmlmeext->tbtx_token_dispatch_timer, 1); -+ -+ break; -+#endif -+ default: -+ RTW_INFO("Undefined Action Code\n"); -+ goto exit; -+ break; -+ } -+ -+exit: -+ return _SUCCESS; -+} -+ -+void rtw_issue_action_token_rel(_adapter *padapter) -+{ -+ -+ // Todo: -+ // gen token -+ /* Token Release Format -+ Category code : 1 Byte -+ Action code : 1 Byte */ -+ int ret = _FAIL; -+ //u16 *fctrl; -+ u8 val = 0x01; -+ u8 category = RTW_WLAN_CATEGORY_TBTX; -+ u8 *pframe; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ 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 sta_info *psta; -+ //struct sta_priv *pstapriv = &padapter->stapriv; -+ //struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ 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); -+ pattrib->rate = MGN_24M; /* issue action release using OFDM rate? 20190716 Bruce add */ -+ -+ _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?? -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ set_frame_sub_type(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, &(val), &(pattrib->pktlen)); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ //RTW_INFO("%s\n", __func__); -+ -+} -+#endif -+ -+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", (get_frame_sub_type(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; -+ pmlmeext->tx_rate_section = mgn_rate_to_rs(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; -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ -+ pattrib->hdrlen = 24; -+ pattrib->nr_frags = 1; -+ pattrib->priority = 7; -+ pattrib->mac_id = RTW_DEFAULT_MGMT_MACID; -+ pattrib->qsel = QSLT_MGNT; -+ -+ 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); -+#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; -+ -+} -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+void update_mgntframe_subtype(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ struct pkt_attrib *pattrib = &pmgntframe->attrib; -+ u8 *pframe; -+ u8 subtype, category ,action; -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ subtype = get_frame_sub_type(pframe); /* bit(7)~bit(2) */ -+ pattrib->subtype = subtype; -+ -+ rtw_action_frame_parse(pframe, pattrib->pktlen, &category, &action); -+ -+ if ((subtype == WIFI_ACTION && !(action == ACT_PUBLIC_FTM_REQ || action == ACT_PUBLIC_FTM)) || -+ subtype == WIFI_DISASSOC || subtype == WIFI_DEAUTH || -+ (subtype == WIFI_PROBERSP && MLME_IS_ADHOC(padapter))) -+ pattrib->ps_dontq = 0; -+ else -+ pattrib->ps_dontq = 1; -+} -+#endif -+ -+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_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ -+#ifdef CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P_PS_NOA_USE_MACID_SLEEP */ -+ -+ /* _rtw_memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); */ -+ -+ pattrib->hdrlen = 24; -+ pattrib->nr_frags = 1; -+ pattrib->priority = 7; -+ pattrib->mac_id = RTW_DEFAULT_MGMT_MACID; -+ pattrib->qsel = QSLT_MGNT; -+ -+#ifdef CONFIG_MCC_MODE -+ update_mcc_mgntframe_attrib(padapter, pattrib); -+#endif -+ -+ -+#ifdef CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, WIFI_ASOC_STATE)) -+#endif /* CONFIG_CONCURRENT_MODE */ -+ if (MLME_IS_GC(padapter)) { -+ if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) { -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ -+ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); -+ if (psta) { -+ /* use macid sleep during NoA, mgmt frame use ac queue & ap macid */ -+ pattrib->mac_id = psta->cmn.mac_id; -+ pattrib->qsel = QSLT_VO; -+ } else { -+ if (pwdinfo->p2p_ps_state != P2P_PS_DISABLE) -+ RTW_ERR("%s , psta was NULL\n", __func__); -+ } -+ } -+ } -+#endif /* CONFIG_P2P_PS_NOA_USE_MACID_SLEEP */ -+ -+ 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_RTW_MGMT_QUEUE -+ pattrib->ps_dontq = 1; -+#endif -+} -+ -+void update_mgntframe_attrib_addr(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ u8 *pframe; -+ struct pkt_attrib *pattrib = &pmgntframe->attrib; -+#if defined(CONFIG_BEAMFORMING) || defined(CONFIG_ANTENNA_DIVERSITY) || defined(CONFIG_RTW_MGMT_QUEUE) -+ struct sta_info *sta = NULL; -+#endif -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(pframe), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, get_addr2_ptr(pframe), ETH_ALEN); -+ -+#if defined(CONFIG_BEAMFORMING) || defined(CONFIG_ANTENNA_DIVERSITY) || defined(CONFIG_RTW_MGMT_QUEUE) -+ sta = pattrib->psta; -+ if (!sta) { -+ sta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ pattrib->psta = sta; -+ } -+ -+ #ifdef CONFIG_BEAMFORMING -+ if (sta) -+ update_attrib_txbf_info(padapter, pattrib, sta); -+ #endif -+#endif /* defined(CONFIG_BEAMFORMING) || defined(CONFIG_ANTENNA_DIVERSITY) || defined(CONFIG_RTW_MGMT_QUEUE) */ -+} -+ -+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 -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ || ret == RTW_QUEUE_MGMT -+#endif -+ ) -+ 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); -+ -+ ret = rtw_hal_mgnt_xmit(padapter, pmgntframe); -+ -+ if (ret == _SUCCESS -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ || ret == RTW_QUEUE_MGMT -+#endif -+ ) -+ 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_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 -+#ifdef CONFIG_FW_HANDLE_TXBCN -+ if (padapter->vap_id != CONFIG_LIMITED_AP_NUM) -+ pattrib->mbssid = padapter->vap_id; -+#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++; */ -+ set_frame_sub_type(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { -+ /* 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_MCC_MODE -+ pframe = rtw_hal_mcc_append_go_p2p_ie(padapter, pframe, &pattrib->pktlen); -+#endif /* CONFIG_MCC_MODE*/ -+ -+#ifdef CONFIG_WFD -+ len = rtw_append_beacon_wfd_ie(padapter, pframe); -+ pframe += len; -+ pattrib->pktlen += len; -+#endif -+ } -+#endif /* CONFIG_P2P */ -+#ifdef CONFIG_RTW_REPEATER_SON -+ rtw_rson_append_ie(padapter, pframe, &pattrib->pktlen); -+#endif -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ pattrib->pktlen += rtw_build_vendor_ie(padapter , &pframe , WIFI_BEACON_VENDOR_IE_BIT); -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ pframe = rtw_hal_set_8812a_vendor_ie(padapter, pframe, &pattrib->pktlen ); -+#endif/*CONFIG_RTL8812A*/ -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (padapter->tbtx_capability == _TRUE) -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 8, REALTEK_TBTX_IE, &pattrib->pktlen); -+#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) > MAX_BEACON_LEN) { -+ RTW_ERR("beacon frame too large ,len(%d,%d)\n", -+ (pattrib->pktlen + TXDESC_SIZE), MAX_BEACON_LEN); -+ rtw_warn_on(1); -+ 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 /* CONFIG_AP_MODE */ -+ -+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); -+#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++; -+ set_frame_sub_type(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_RTW_REPEATER_SON -+ rtw_rson_append_ie(padapter, pframe, &pattrib->pktlen); -+#endif -+#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_MCC_MODE -+ pframe = rtw_hal_mcc_append_go_p2p_ie(padapter, pframe, &pattrib->pktlen); -+#endif /* CONFIG_MCC_MODE*/ -+ -+#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->cmn.mac_addr), 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 */ -+ -+#ifdef CONFIG_RTL8812A -+ pframe = rtw_hal_set_8812a_vendor_ie(padapter, pframe, &pattrib->pktlen); -+#endif/*CONFIG_RTL8812A*/ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+int _issue_probereq(_adapter *padapter, const NDIS_802_11_SSID *pssid, const 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); -+ int bssrate_len = 0; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+#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; -+ -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ if ((pwdev_priv->pno_mac_addr[0] != 0xFF) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _FALSE)) -+ mac = pwdev_priv->pno_mac_addr; -+ else -+#endif -+ 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); -+ -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ if ((pwdev_priv->pno_mac_addr[0] != 0xFF) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _FALSE)) { -+#ifdef CONFIG_RTW_DEBUG -+ RTW_DBG("%s pno_scan_seq_num: %d\n", __func__, -+ pwdev_priv->pno_scan_seq_num); -+#endif -+ SetSeqNum(pwlanhdr, pwdev_priv->pno_scan_seq_num); -+ pattrib->seqnum = pwdev_priv->pno_scan_seq_num; -+ pattrib->qos_en = 1; -+ pwdev_priv->pno_scan_seq_num++; -+ } else -+#endif -+ { -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ } -+ set_frame_sub_type(pframe, WIFI_PROBEREQ); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (pssid && !MLME_IS_MESH(padapter)) -+ 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); -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ if (pssid) -+ pframe = rtw_set_ie_mesh_id(pframe, &pattrib->pktlen, pssid->Ssid, pssid->SsidLength); -+ else -+ pframe = rtw_set_ie_mesh_id(pframe, &pattrib->pktlen, NULL, 0); -+ } -+#endif -+ -+ 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 -+ -+#ifdef CONFIG_RTL8812A -+ pframe = rtw_hal_set_8812a_vendor_ie(padapter, pframe, &pattrib->pktlen ); -+#endif/*CONFIG_RTL8812A*/ -+ -+ -+#ifdef CONFIG_RTW_MBO -+ rtw_mbo_build_probe_req_ies( padapter, &pframe, pattrib); -+#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, const NDIS_802_11_SSID *pssid, const 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, const NDIS_802_11_SSID *pssid, const u8 *da, u8 ch, bool append_wps, -+ int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ systime 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); -+ -+ 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++; -+ set_frame_sub_type(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->cmn.mac_addr, 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 -+ if (rtw_ft_roam(padapter)) { -+ /* 2: 802.11R FTAA */ -+ val16 = cpu_to_le16(2); -+ } 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 -+ rtw_ft_build_auth_req_ies(padapter, pattrib, &pframe); -+#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 to "MAC_FMT" status:%u\n", __FUNCTION__, MAC_ARG(pwlanhdr->addr1), status); -+ 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, cap[5], i; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+#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 to "MAC_FMT" status:%u\n", __FUNCTION__, MAC_ARG(pstat->cmn.mac_addr), status); -+ -+ 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->cmn.mac_addr, ETH_ALEN); -+ _rtw_memcpy((void *)get_addr2_ptr(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)) -+ set_frame_sub_type(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); -+#ifdef CONFIG_RTW_80211K -+ val |= cap_RM; -+#endif -+ 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->cmn.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_, WLAN_EID_EXT_CAP, &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 */ -+ -+#ifdef CONFIG_RTW_80211K -+ /* FILL RM Enabled Capabilities with joint capabilities */ -+ for (i = 0; i < 5; i++) { -+ cap[i] = padapter->rmpriv.rm_en_cap_def[i] -+ & pstat->rm_en_cap[i]; -+ } -+ if (pstat->capability & cap_RM) -+ pframe = rtw_set_ie(pframe, _EID_RRM_EN_CAP_IE_, 5, -+ (u8 *)cap, &(pattrib->pktlen)); -+#endif /* CONFIG_RTW_80211K */ -+ -+ /* 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; -+ } -+ -+ -+ if ((psecuritypriv->auth_type == MLME_AUTHTYPE_SAE) && -+ pmlmepriv->assoc_rsp && pmlmepriv->assoc_rsp_len > 0) { -+ _rtw_memcpy(pframe, pmlmepriv->assoc_rsp, pmlmepriv->assoc_rsp_len); -+ pframe += pmlmepriv->assoc_rsp_len; -+ pattrib->pktlen += pmlmepriv->assoc_rsp_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 if (pmlmepriv->assoc_rsp && pmlmepriv->assoc_rsp_len > 0) { -+ len = pmlmepriv->assoc_rsp_len; -+ _rtw_memcpy(pframe, pmlmepriv->assoc_rsp, 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_RTW_MULTI_AP -+ if (padapter->multi_ap && (pstat->flags & WLAN_STA_MULTI_AP)) -+ pframe = rtw_set_multi_ap_ie_ext(pframe, &pattrib->pktlen, padapter->multi_ap); -+#endif -+ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ pattrib->pktlen += rtw_build_vendor_ie(padapter , &pframe , WIFI_ASSOCRESP_VENDOR_IE_BIT); -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ pframe = rtw_hal_set_8812a_vendor_ie(padapter, pframe, &pattrib->pktlen ); -+#endif/*CONFIG_RTL8812A*/ -+ -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (padapter->tbtx_capability == _TRUE) -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 8, REALTEK_TBTX_IE, &pattrib->pktlen); -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+#endif -+} -+ -+static u32 rtw_append_assoc_req_owe_ie(_adapter *adapter, u8 *pbuf) -+{ -+ struct security_priv *sec = &adapter->securitypriv; -+ u32 len = 0; -+ -+ if (sec == NULL) -+ goto exit; -+ -+ if (sec->owe_ie_len > 0) { -+ len = sec->owe_ie_len; -+ _rtw_memcpy(pbuf, sec->owe_ie, len); -+ } -+ -+exit: -+ return len; -+} -+ -+void _issue_assocreq(_adapter *padapter, u8 is_reassoc) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned short val16; -+ unsigned int i, j, index = 0; -+ unsigned char bssrate[NumRates], sta_bssrate[NumRates]; -+ PNDIS_802_11_VARIABLE_IEs 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; -+#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 */ -+ -+#if CONFIG_DFS -+ u16 cap; -+#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) -+ set_frame_sub_type(pframe, WIFI_REASSOCREQ); -+ else -+ set_frame_sub_type(pframe, WIFI_ASSOCREQ); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* caps */ -+ -+#if CONFIG_DFS -+ _rtw_memcpy(&cap, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+ cap |= cap_SpecMgmt; -+#ifdef CONFIG_RTW_80211K -+ cap |= cap_RM; -+#endif -+ _rtw_memcpy(pframe, &cap, 2); -+#else -+ _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+#endif -+ -+ 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)); -+ -+#if CONFIG_IEEE80211_BAND_5GHZ && CONFIG_DFS -+ /* Dot H */ -+ if (pmlmeext->cur_channel > 14) { -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ u8 pow_cap_ele[2] = { 0x00 }; -+ u8 sup_ch[30 * 2] = {0x00 }, sup_ch_idx = 0, idx_5g = 2; /* For supported channel */ -+ -+ 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 */ -+ while (sup_ch_idx < rfctl->max_chan_nums && rfctl->channel_set[sup_ch_idx].ChannelNum != 0) { -+ if (rfctl->channel_set[sup_ch_idx].ChannelNum <= 14) { -+ /* TODO: fix 2.4G supported channel when channel doesn't start from 1 and continuous */ -+ sup_ch[0] = 1; /* First channel number */ -+ sup_ch[1] = rfctl->channel_set[sup_ch_idx].ChannelNum; /* Number of channel */ -+ } else { -+ sup_ch[idx_5g++] = rfctl->channel_set[sup_ch_idx].ChannelNum; -+ sup_ch[idx_5g++] = 1; -+ } -+ sup_ch_idx++; -+ } -+ pframe = rtw_set_ie(pframe, EID_SupportedChannels, idx_5g, sup_ch, &(pattrib->pktlen)); -+ } -+#endif /* CONFIG_IEEE80211_BAND_5GHZ && 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__); -+ -+#ifdef CONFIG_RTW_MBO -+ rtw_mbo_build_assoc_req_ies(padapter, &pframe, pattrib); -+#endif -+#ifdef CONFIG_RTW_80211R -+ rtw_ft_build_assoc_req_ies(padapter, is_reassoc, pattrib, &pframe); -+#endif -+#ifdef CONFIG_RTW_80211K -+ pframe = rtw_set_ie(pframe, _EID_RRM_EN_CAP_IE_, 5, -+ (u8 *)padapter->rmpriv.rm_en_cap_def, -+ &(pattrib->pktlen)); -+#endif /* CONFIG_RTW_80211K */ -+ -+ /* 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) && (rtw_ft_roam(padapter))) { -+ rtw_ft_update_rsnie(padapter, _TRUE, pattrib, &pframe); -+ } else -+#endif -+ { -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (rtw_sec_chk_auth_alg(padapter, WLAN_AUTH_OPEN) && -+ rtw_sec_chk_auth_type(padapter, MLME_AUTHTYPE_SAE)) { -+ s32 entry = rtw_cached_pmkid(padapter, pmlmepriv->assoc_bssid); -+ -+ rtw_rsn_sync_pmkid(padapter, (u8 *)pIE, (pIE->Length + 2), entry); -+ } -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ pframe = rtw_set_ie(pframe, EID_WPA2, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ /* tmp: update rsn's spp related opt. */ -+ /*rtw_set_spp_amsdu_mode(padapter->registrypriv.amsdu_mode, pframe - (pIE->Length + 2), pIE->Length +2);*/ -+ } -+ break; -+ case WLAN_EID_RSNX: -+ pframe = rtw_set_ie(pframe, WLAN_EID_RSNX, 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; -+#endif /* CONFIG_80211N_HT */ -+ -+ case WLAN_EID_EXT_CAP: -+ pframe = rtw_set_ie(pframe, WLAN_EID_EXT_CAP, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ break; -+ -+#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); -+ } -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (padapter->tbtx_capability == _TRUE) -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 8 , REALTEK_TBTX_IE, &(pattrib->pktlen)); -+#endif -+ -+ 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); -+ } -+ } -+ -+#ifdef CONFIG_WFD -+ wfdielen = rtw_append_assoc_req_wfd_ie(padapter, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_RTW_MULTI_AP -+ if (padapter->multi_ap) -+ pframe = rtw_set_multi_ap_ie_ext(pframe, &pattrib->pktlen, padapter->multi_ap); -+#endif -+ -+ /* OWE */ -+ { -+ u32 owe_ie_len; -+ -+ owe_ie_len = rtw_append_assoc_req_owe_ie(padapter, pframe); -+ pframe += owe_ie_len; -+ pattrib->pktlen += owe_ie_len; -+ } -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ rtw_rson_append_ie(padapter, pframe, &pattrib->pktlen); -+#endif -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ pattrib->pktlen += rtw_build_vendor_ie(padapter , &pframe , WIFI_ASSOCREQ_VENDOR_IE_BIT); -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ pframe = rtw_hal_set_8812a_vendor_ie(padapter, pframe, &pattrib->pktlen ); -+#endif/*CONFIG_RTL8812A*/ -+ -+ 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); -+ #ifdef CONFIG_RTW_WNM -+ if (is_reassoc == _TRUE) -+ rtw_wnm_update_reassoc_req_ie(padapter); -+ #endif -+ } 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; -+ u8 a4_shift; -+ -+ /* 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 (MLME_IS_AP(padapter)) -+ SetFrDs(fctrl); -+ else if (MLME_IS_STA(padapter)) -+ SetToDs(fctrl); -+ else if (MLME_IS_MESH(padapter)) { -+ SetToDs(fctrl); -+ SetFrDs(fctrl); -+ } -+ -+ if (power_mode) -+ SetPwrMgt(fctrl); -+ -+ if (get_tofr_ds(fctrl) == 3) { -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr4, adapter_mac_addr(padapter), ETH_ALEN); -+ a4_shift = ETH_ALEN; -+ pattrib->hdrlen += ETH_ALEN; -+ } else { -+ _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); -+ a4_shift = 0; -+ } -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ set_frame_sub_type(pframe, WIFI_DATA_NULL); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr) + a4_shift; -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr) + a4_shift; -+ -+ 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_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ systime 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_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; -+} -+ -+/* 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, u8 ps, 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); -+ u8 a4_shift; -+ -+ 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 (MLME_IS_AP(padapter)) -+ SetFrDs(fctrl); -+ else if (MLME_IS_STA(padapter)) -+ SetToDs(fctrl); -+ else if (MLME_IS_MESH(padapter)) { -+ SetToDs(fctrl); -+ SetFrDs(fctrl); -+ } -+ -+ if (ps) -+ SetPwrMgt(fctrl); -+ -+ if (pattrib->mdata) -+ SetMData(fctrl); -+ -+ if (get_tofr_ds(fctrl) == 3) { -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr4, adapter_mac_addr(padapter), ETH_ALEN); -+ a4_shift = ETH_ALEN; -+ pattrib->hdrlen += ETH_ALEN; -+ } else { -+ _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); -+ a4_shift = 0; -+ } -+ -+ qc = (unsigned short *)(pframe + pattrib->hdrlen - 2); -+ -+ SetPriority(qc, tid); -+ -+ SetEOSP(qc, pattrib->eosp); -+ -+ SetAckpolicy(qc, pattrib->ack_policy); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ set_frame_sub_type(pframe, WIFI_QOS_DATA_NULL); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos) + a4_shift; -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos) + a4_shift; -+ -+ 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, u8 ps, int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ systime 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, ps, 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++; -+ set_frame_sub_type(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 reason(%u) to "MAC_FMT"\n", __func__, reason, 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; -+ systime 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) -+{ -+ 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); -+ -+ 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++; -+ set_frame_sub_type(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++; -+ set_frame_sub_type(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, pwlanhdr->addr1); -+ 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++; -+ set_frame_sub_type(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 -+ -+#ifdef CONFIG_TX_AMSDU -+ if (padapter->tx_amsdu >= 1) /* TX AMSDU enabled */ -+ BA_para_set |= BIT(0); -+ else /* TX AMSDU disabled */ -+ BA_para_set &= ~BIT(0); -+#endif -+ psta = rtw_get_stainfo(pstapriv, raddr); -+ if (psta != NULL) { -+ if (psta->flags & WLAN_STA_AMSDU_DISABLE) -+ 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)); -+ -+ /* 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->rx_ampdu_amsdu == 0) /* disabled */ -+ BA_para_set &= ~BIT(0); -+ else if (pregpriv->rx_ampdu_amsdu == 1) /* enabled */ -+ BA_para_set |= BIT(0); -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, raddr); -+ if (psta != NULL) { -+ if (psta->flags & WLAN_STA_AMSDU_DISABLE) -+ 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; -+ systime 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" status:=%u tid=%u size:%u%s, %d/%d in %u ms\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), status, tid, size -+ , 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; -+ systime 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; -+} -+ -+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++; -+ set_frame_sub_type(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)); -+ -+ /* TODO calculate 40Mhz intolerant via ch and ch offset */ -+ /* 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++; -+ set_frame_sub_type(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; -+ systime 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->cmn.mac_addr, tid, 37, initiator, 3, 1); -+ else -+ issue_del_ba(adapter, sta->cmn.mac_addr, 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->cmn.mac_addr, 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; -+} -+ -+#ifdef CONFIG_AP_MODE -+unsigned int send_beacon(_adapter *padapter) -+{ -+#if defined(CONFIG_PCI_HCI) && !defined(CONFIG_PCI_BCN_POLLING) -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ u8 vap_id = padapter->vap_id; -+ -+ /* bypass TX BCN because vap_id is invalid*/ -+ if (vap_id == CONFIG_LIMITED_AP_NUM) -+ return _SUCCESS; -+ #endif -+ -+ /* bypass TX BCN queue because op ch is switching/waiting */ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_OP_CH_SWITCHING) -+ || IS_CH_WAITING(adapter_to_rfctl(padapter)) -+ ) -+ return _SUCCESS; -+ -+ /* 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); -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_HEAD_SEL, &vap_id); -+ #endif -+ -+ issue_beacon(padapter, 0); -+ -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ vap_id = 0xFF; -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_HEAD_SEL, &vap_id); -+ #endif -+ -+ #ifdef RTL8814AE_SW_BCN -+ if (GET_HAL_DATA(padapter)->bCorrectBCN != 0) -+ RTW_INFO("%s, line%d, Warnning, pHalData->bCorrectBCN != 0\n", __func__, __LINE__); -+ GET_HAL_DATA(padapter)->bCorrectBCN = 1; -+ #endif -+ -+ return _SUCCESS; -+#endif -+ -+/* CONFIG_PCI_BCN_POLLING is for pci interface beacon polling mode */ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)|| defined(CONFIG_PCI_BCN_POLLING) -+ u8 bxmitok = _FALSE; -+ int issue = 0; -+ int poll = 0; -+ systime start = rtw_get_current_time(); -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ u8 vap_id = padapter->vap_id; -+ -+ /* bypass TX BCN because vap_id is invalid*/ -+ if (vap_id == CONFIG_LIMITED_AP_NUM) -+ return _SUCCESS; -+ #endif -+ -+ /* bypass TX BCN queue because op ch is switching/waiting */ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_OP_CH_SWITCHING) -+ || IS_CH_WAITING(adapter_to_rfctl(padapter)) -+ ) -+ return _SUCCESS; -+ -+ #if defined(CONFIG_USB_HCI) -+ #if defined(CONFIG_RTL8812A) -+ if (IS_FULL_SPEED_USB(padapter)) { -+ issue_beacon(padapter, 300); -+ bxmitok = _TRUE; -+ } else -+ #endif -+ #endif -+ { -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_HEAD_SEL, &vap_id); -+ #endif -+ do { -+ #if defined(CONFIG_PCI_BCN_POLLING) -+ issue_beacon(padapter, 0); -+ #else -+ issue_beacon(padapter, 100); -+ #endif -+ issue++; -+ do { -+ #if defined(CONFIG_PCI_BCN_POLLING) -+ rtw_msleep_os(1); -+ #else -+ rtw_yield_os(); -+ #endif -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bxmitok)); -+ poll++; -+ } while ((poll % 10) != 0 && _FALSE == bxmitok && !RTW_CANNOT_RUN(padapter)); -+ #if defined(CONFIG_PCI_BCN_POLLING) -+ rtw_hal_unmap_beacon_icf(padapter); -+ #endif -+ } while (bxmitok == _FALSE && (issue < 100) && !RTW_CANNOT_RUN(padapter)); -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ vap_id = 0xFF; -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_HEAD_SEL, &vap_id); -+ #endif -+ } -+ if (RTW_CANNOT_RUN(padapter)) -+ return _FAIL; -+ -+ -+ if (_FALSE == bxmitok) { -+ RTW_INFO("%s fail! %u ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); -+ #ifdef CONFIG_BCN_RECOVERY -+ GET_HAL_DATA(padapter)->issue_bcn_fail++; -+ #endif /*CONFIG_BCN_RECOVERY*/ -+ 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)); -+ -+ #ifdef CONFIG_FW_CORRECT_BCN -+ rtw_hal_fw_correct_bcn(padapter); -+ #endif -+ return _SUCCESS; -+ } -+ -+#endif /*defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)*/ -+ -+} -+#endif /* CONFIG_AP_MODE */ -+ -+/**************************************************************************** -+ -+Following are some utitity fuctions for WiFi MLME -+ -+*****************************************************************************/ -+ -+BOOLEAN 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, -+ 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; -+ sint len; -+ u8 *p; -+ u8 rf_path; -+ u16 val16, subtype; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u32 packet_len = precv_frame->u.hdr.len; -+ u8 ie_offset; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+#ifdef CONFIG_LAYER2_ROAMING -+ u32 *pbuf; -+#endif -+ -+ 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 = get_frame_sub_type(pframe); -+ -+ if (subtype == WIFI_BEACON) { -+ bssid->Reserved[0] = BSS_TYPE_BCN; -+ ie_offset = _BEACON_IE_OFFSET_; -+ } else { -+ /* FIXME : more type */ -+ if (subtype == WIFI_PROBERSP) { -+ ie_offset = _PROBERSP_IE_OFFSET_; -+ bssid->Reserved[0] = BSS_TYPE_PROB_RSP; -+ } else if (subtype == WIFI_PROBEREQ) { -+ ie_offset = _PROBEREQ_IE_OFFSET_; -+ bssid->Reserved[0] = BSS_TYPE_PROB_REQ; -+ } else { -+ bssid->Reserved[0] = BSS_TYPE_UNDEF; -+ 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.recv_signal_power; /* in dBM.raw data */ -+ bssid->PhyInfo.SignalQuality = precv_frame->u.hdr.attrib.phy_info.signal_quality;/* in percentage */ -+ bssid->PhyInfo.SignalStrength = precv_frame->u.hdr.attrib.phy_info.signal_strength;/* in percentage */ -+ -+ /* get rx_snr */ -+ if (precv_frame->u.hdr.attrib.data_rate >= DESC_RATE11M) { -+ bssid->PhyInfo.is_cck_rate = 0; -+ for (rf_path = 0; rf_path < hal_spec->rf_reg_path_num; rf_path++) -+ bssid->PhyInfo.rx_snr[rf_path] = -+ precv_frame->u.hdr.attrib.phy_info.rx_snr[rf_path]; -+ } else -+ bssid->PhyInfo.is_cck_rate = 1; -+ -+#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; -+ } -+#ifdef CONFIG_CHECK_SPECIFIC_IE_CONTENT -+ if (rtw_validate_value(_SUPPORTEDRATES_IE_, p+2, len) == _FALSE) { -+ rtw_absorb_ssid_ifneed(padapter, bssid, pframe); -+ RTW_DBG_DUMP("Invalidated Support Rate IE --", p, len+2); -+ return _FAIL; -+ } -+#endif /* #ifdef CONFIG_CHECK_SPECIFIC_IE_CONTENT */ -+ _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; -+ } -+#ifdef CONFIG_CHECK_SPECIFIC_IE_CONTENT -+ if (rtw_validate_value(_EXT_SUPPORTEDRATES_IE_, p+2, len) == _FALSE) { -+ rtw_absorb_ssid_ifneed(padapter, bssid, pframe); -+ RTW_DBG_DUMP("Invalidated EXT Support Rate IE --", p, len+2); -+ return _FAIL; -+ } -+#endif /* #ifdef CONFIG_CHECK_SPECIFIC_IE_CONTENT */ -+ _rtw_memcpy(bssid->SupportedRates + i, (p + 2), len); -+ } -+ -+#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 }; -+ -+ attr_contentlen = sizeof(listen_ch); -+ 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, get_addr2_ptr(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 & 0x03) == cap_ESS) { -+ bssid->InfrastructureMode = Ndis802_11Infrastructure; -+ _rtw_memcpy(bssid->MacAddress, get_addr2_ptr(pframe), ETH_ALEN); -+ } else if ((val16 & 0x03) == cap_IBSS){ -+ bssid->InfrastructureMode = Ndis802_11IBSS; -+ _rtw_memcpy(bssid->MacAddress, GetAddr3Ptr(pframe), ETH_ALEN); -+ } else if ((val16 & 0x03) == 0x00){ -+ u8 *mesh_id_ie, *mesh_conf_ie; -+ sint mesh_id_ie_len, mesh_conf_ie_len; -+ -+ mesh_id_ie = rtw_get_ie(bssid->IEs + ie_offset, WLAN_EID_MESH_ID, &mesh_id_ie_len, bssid->IELength - ie_offset); -+ mesh_conf_ie = rtw_get_ie(bssid->IEs + ie_offset, WLAN_EID_MESH_CONFIG, &mesh_conf_ie_len, bssid->IELength - ie_offset); -+ if (mesh_id_ie || mesh_conf_ie) { -+ if (!mesh_id_ie) { -+ RTW_INFO("cannot find Mesh ID for survey event\n"); -+ return _FAIL; -+ } -+ if (mesh_id_ie_len) { -+ if (mesh_id_ie_len > NDIS_802_11_LENGTH_SSID) { -+ RTW_INFO("Mesh ID too long (%d) for survey event\n", mesh_id_ie_len); -+ return _FAIL; -+ } -+ _rtw_memcpy(bssid->mesh_id.Ssid, (mesh_id_ie + 2), mesh_id_ie_len); -+ bssid->mesh_id.SsidLength = mesh_id_ie_len; -+ } else -+ bssid->mesh_id.SsidLength = 0; -+ -+ if (!mesh_conf_ie) { -+ RTW_INFO("cannot find Mesh config for survey event\n"); -+ return _FAIL; -+ } -+ if (mesh_conf_ie_len != 7) { -+ RTW_INFO("invalid Mesh conf IE len (%d) for survey event\n", mesh_conf_ie_len); -+ return _FAIL; -+ } -+ -+ bssid->InfrastructureMode = Ndis802_11_mesh; -+ _rtw_memcpy(bssid->MacAddress, GetAddr3Ptr(pframe), ETH_ALEN); -+ } else { -+ /* default cases */ -+ 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 */ -+ -+ } -+ -+#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; -+ -+#ifdef CONFIG_RTW_80211K -+ p = rtw_get_ie(bssid->IEs + ie_offset, _EID_RRM_EN_CAP_IE_, &len, bssid->IELength - ie_offset); -+ if (p) -+ _rtw_memcpy(bssid->PhyInfo.rm_en_cap, (p + 2), MIN(*(p + 1), -+ sizeof(bssid->PhyInfo.rm_en_cap))); -+ -+ /* save freerun counter */ -+ bssid->PhyInfo.free_cnt = precv_frame->u.hdr.attrib.free_cnt; -+#endif -+#ifdef CONFIG_LAYER2_ROAMING -+ pbuf = (u32 *)((u8 *)pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ bssid->tsf = le32_to_cpu(*(pbuf + 1)); -+ bssid->tsf = bssid->tsf << 32; -+ bssid->tsf |= le32_to_cpu(*pbuf); -+#endif -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_AP_MODE -+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, WLAN_STATUS_UNSPECIFIED_FAILURE); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ } else { -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, padapter->registrypriv.dev_network.MacAddress); -+ rtw_hal_rcr_set_chk_bssid(padapter, MLME_ADHOC_STARTED); -+ join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ rtw_btcoex_connect_notify(padapter, join_type); -+ -+ report_join_res(padapter, 1, WLAN_STATUS_SUCCESS); -+ 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 */ -+ 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] == BSS_TYPE_PROB_REQ ? 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_ft_roam(padapter)) { -+ rtw_ft_start_clnt_join(padapter); -+ } else -+#endif -+ { -+ rtw_sta_linking_test_set_start(); -+ 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, WLAN_STATUS_SUCCESS); -+ } 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_ft_roam(padapter)) { -+ rtw_ft_set_status(padapter, RTW_FT_AUTHENTICATING_STA); -+ RTW_PRINT("start ft auth\n"); -+ } else -+#endif -+ RTW_PRINT("start auth\n"); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (rtw_sec_chk_auth_type(padapter, MLME_AUTHTYPE_SAE)) { -+ if (rtw_cached_pmkid(padapter, get_my_bssid(&pmlmeinfo->network)) != -1) { -+ RTW_INFO("SAE: PMKSA cache entry found\n"); -+ padapter->securitypriv.auth_alg = WLAN_AUTH_OPEN; -+ goto no_external_auth; -+ } -+ -+ RTW_PRINT("SAE: start external auth\n"); -+ rtw_cfg80211_external_auth_request(padapter, NULL); -+ return; -+ } -+no_external_auth: -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ 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_ft_roam(padapter) -+ #ifdef CONFIG_RTW_WNM -+ || rtw_wnm_btm_reassoc_req(padapter) -+ #endif -+ ) -+ 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__); -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ rtw_rson_do_disconnect(padapter); -+#endif -+ 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, reason) != _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 -+ rtw_ft_roam_status_reset(padapter); -+#endif -+#ifdef CONFIG_RTW_WNM -+ rtw_wnm_reset_btm_state(padapter); -+#endif -+ } -+ -+ return _SUCCESS; -+} -+ -+static void rtw_hidden_ssid_bss_count(_adapter *adapter, WLAN_BSSID_EX *bss) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ RT_CHANNEL_INFO *chset = rfctl->channel_set; -+ int chset_idx; -+ -+ if (bss->InfrastructureMode != Ndis802_11Infrastructure) -+ return; -+ -+ if (!hidden_ssid_ap(bss)) -+ return; -+ -+ chset_idx = rtw_chset_search_ch(chset, bss->Configuration.DSConfig); -+ if (chset_idx < 0) -+ return; -+ -+ chset[chset_idx].hidden_bss_cnt++; -+} -+ -+/**************************************************************************** -+ -+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 rtw_evt_header *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 rtw_evt_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 = CMD_SET_MLME_EVT; -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ evt_hdr = (struct rtw_evt_header *)(pevtcmd); -+ evt_hdr->len = sizeof(struct survey_event); -+ evt_hdr->id = EVT_SURVEY; -+ evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ psurvey_evt = (struct survey_event *)(pevtcmd + sizeof(struct rtw_evt_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; -+ } -+ -+ rtw_hidden_ssid_bss_count(padapter, &psurvey_evt->bss); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ pmlmeext->sitesurvey_res.bss_cnt++; -+ -+ return; -+ -+} -+ -+/* -+* @acs: aim to trigger channel selection -+*/ -+void report_surveydone_event(_adapter *padapter, bool acs) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct surveydone_event *psurveydone_evt; -+ struct rtw_evt_header *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 rtw_evt_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 = CMD_SET_MLME_EVT; -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ evt_hdr = (struct rtw_evt_header *)(pevtcmd); -+ evt_hdr->len = sizeof(struct surveydone_event); -+ evt_hdr->id = EVT_SURVEY_DONE; -+ evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ psurveydone_evt = (struct surveydone_event *)(pevtcmd + sizeof(struct rtw_evt_header)); -+ psurveydone_evt->bss_cnt = pmlmeext->sitesurvey_res.bss_cnt; -+ psurveydone_evt->activate_ch_cnt = pmlmeext->sitesurvey_res.activate_ch_cnt; -+ psurveydone_evt->acs = acs; -+ -+ 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 aid_res, u16 status) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct joinbss_event *pjoinbss_evt; -+ struct rtw_evt_header *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 rtw_evt_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 = CMD_SET_MLME_EVT; -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ evt_hdr = (struct rtw_evt_header *)(pevtcmd); -+ evt_hdr->len = sizeof(struct joinbss_event); -+ evt_hdr->id = EVT_JOINBSS; -+ evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pjoinbss_evt = (struct joinbss_event *)(pevtcmd + sizeof(struct rtw_evt_header)); -+ _rtw_memcpy((unsigned char *)(&(pjoinbss_evt->network.network)), &(pmlmeinfo->network), sizeof(WLAN_BSSID_EX)); -+ pjoinbss_evt->network.join_res = pjoinbss_evt->network.aid = aid_res; -+ -+ RTW_INFO("report_join_res(%d, %u)\n", aid_res, status); -+ -+ -+ rtw_joinbss_event_prehandle(padapter, (u8 *)&pjoinbss_evt->network, status); -+ -+ -+ 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 rtw_evt_header *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 rtw_evt_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 = CMD_SET_MLME_EVT; -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ evt_hdr = (struct rtw_evt_header *)(pevtcmd); -+ evt_hdr->len = sizeof(struct wmm_event); -+ evt_hdr->id = EVT_WMM_UPDATE; -+ evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pwmm_event = (struct wmm_event *)(pevtcmd + sizeof(struct rtw_evt_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 rtw_evt_header *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 rtw_evt_header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ evt_hdr = (struct rtw_evt_header *)(pevtcmd); -+ evt_hdr->len = sizeof(struct stadel_event); -+ evt_hdr->id = EVT_DEL_STA; -+ evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pdel_sta_evt = (struct stadel_event *)(pevtcmd + sizeof(struct rtw_evt_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->cmn.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 = CMD_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 rtw_evt_header *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 rtw_evt_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 = CMD_SET_MLME_EVT; -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ evt_hdr = (struct rtw_evt_header *)(pevtcmd); -+ evt_hdr->len = sizeof(struct stassoc_event); -+ evt_hdr->id = EVT_ADD_STA; -+ evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ padd_sta_evt = (struct stassoc_event *)(pevtcmd + sizeof(struct rtw_evt_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/Mesh 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/Mesh\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)); -+ #ifdef CONFIG_BEAMFORMING -+ psta->htpriv.beamform_cap = pmlmepriv->htpriv.beamform_cap; -+ psta->cmn.bf_info.ht_beamform_cap = pmlmepriv->htpriv.beamform_cap; -+ #endif -+ } else -+#endif /* CONFIG_80211N_HT */ -+ { -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.ht_option = _FALSE; -+ psta->htpriv.ampdu_enable = _FALSE; -+ psta->htpriv.tx_amsdu_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->cmn.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)); -+ if (psta->vhtpriv.vht_option) { -+ psta->cmn.ra_info.is_vht_enable = _TRUE; -+ #ifdef CONFIG_BEAMFORMING -+ psta->vhtpriv.beamform_cap = pmlmepriv->vhtpriv.beamform_cap; -+ psta->cmn.bf_info.vht_beamform_cap = pmlmepriv->vhtpriv.beamform_cap; -+ #endif /*CONFIG_BEAMFORMING*/ -+ } -+#endif /* CONFIG_80211AC_VHT */ -+ psta->cmn.ra_info.is_support_sgi = query_ra_short_GI(psta, rtw_get_tx_bw_mode(padapter, psta)); -+ update_ldpc_stbc_cap(psta); -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state = WIFI_ASOC_STATE; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+} -+ -+#ifdef CONFIG_80211D -+static void rtw_joinbss_update_regulatory(_adapter *adapter, const WLAN_BSSID_EX *network) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ if (rfctl->regd_src == REGD_SRC_RTK_PRIV -+ && !rtw_rfctl_is_disable_sw_channel_plan(rfctl_to_dvobj(rfctl)) -+ ) { -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ const u8 *country_ie = NULL; -+ sint country_ie_len = 0; -+ -+ if (network) { -+ if (rtw_iface_accept_country_ie(adapter)) { -+ country_ie = rtw_get_ie(BSS_EX_TLV_IES(network) -+ , WLAN_EID_COUNTRY, &country_ie_len, BSS_EX_TLV_IES_LEN(network)); -+ if (country_ie) { -+ if (country_ie_len < 6) { -+ country_ie = NULL; -+ country_ie_len = 0; -+ } else -+ country_ie_len += 2; -+ } -+ } -+ } -+ -+ if (country_ie) { -+ rtw_buf_update(&mlme->recv_country_ie, &mlme->recv_country_ie_len, country_ie, country_ie_len); -+ if (rtw_apply_recv_country_ie_cmd(adapter, RTW_CMDF_DIRECTLY -+ , network->Configuration.DSConfig > 14 ? BAND_ON_5G : BAND_ON_2_4G -+ , network->Configuration.DSConfig, country_ie) != _SUCCESS -+ ) -+ RTW_WARN(FUNC_ADPT_FMT" rtw_apply_recv_country_ie_cmd() fail\n", FUNC_ADPT_ARG(adapter)); -+ } else -+ rtw_buf_free(&mlme->recv_country_ie, &mlme->recv_country_ie_len); -+ } -+} -+ -+static void rtw_leavebss_update_regulatory(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ -+ if (rfctl->regd_src == REGD_SRC_RTK_PRIV -+ && !rtw_rfctl_is_disable_sw_channel_plan(dvobj) -+ ) { -+ if (rtw_apply_recv_country_ie_cmd(adapter, RTW_CMDF_DIRECTLY, 0, 0, NULL) != _SUCCESS) -+ RTW_WARN(FUNC_ADPT_FMT" rtw_apply_recv_country_ie_cmd() fail\n", FUNC_ADPT_ARG(adapter)); -+ } -+} -+#endif /* CONFIG_80211D */ -+ -+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); -+ u8 self_action = MLME_ACTION_UNKNOWN; -+ u8 state_backup = (pmlmeinfo->state & 0x03); -+ u8 ASIX_ID[] = {0x00, 0x0E, 0xC6}; -+ -+ if (MLME_IS_AP(padapter)) -+ self_action = MLME_AP_STOPPED; -+ else if (MLME_IS_MESH(padapter)) -+ self_action = MLME_MESH_STOPPED; -+ else if (MLME_IS_STA(padapter)) -+ self_action = MLME_STA_DISCONNECTED; -+ else if (MLME_IS_ADHOC(padapter) || MLME_IS_ADHOC_MASTER(padapter)) -+ self_action = MLME_ADHOC_STOPPED; -+ else { -+ RTW_INFO("state:0x%x\n", MLME_STATE(padapter)); -+ rtw_warn_on(1); -+ } -+ -+ /* set_opmode_cmd(padapter, infra_client_with_mlme); */ -+#ifdef CONFIG_HW_P0_TSF_SYNC -+ if (self_action == MLME_STA_DISCONNECTED) -+ correct_TSF(padapter, self_action); -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, 0); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); -+ if (self_action == MLME_STA_DISCONNECTED) -+ rtw_hal_rcr_set_chk_bssid(padapter, self_action); -+ -+ /* 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, RTW_CMDF_DIRECTLY); -+ } -+#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_CTRL_TXSS_BY_TP -+ pmlmeext->txss_1ss = _FALSE; -+#endif -+ -+#ifdef CONFIG_FCS_MODE -+ if (EN_FCS(padapter)) -+ rtw_hal_set_hwreg(padapter, HW_VAR_STOP_FCS_MODE, NULL); -+#endif -+ -+#ifdef CONFIG_80211D -+ if (self_action == MLME_STA_DISCONNECTED) -+ rtw_leavebss_update_regulatory(padapter); -+#endif -+ -+ if (!(MLME_IS_STA(padapter) && MLME_IS_OPCH_SW(padapter))) { -+ /* DFS and channel status no need to check here for STA under OPCH_SW */ -+ u8 ch, bw, offset; -+ -+ #ifdef CONFIG_DFS_MASTER -+ rtw_dfs_rd_en_decision(padapter, self_action, 0); -+ #endif -+ -+ 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); -+ rtw_rfctl_update_op_mode(adapter_to_rfctl(padapter), BIT(padapter->iface_id), 0); -+ } -+ -+ 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 */ -+ -+#ifdef CONFIG_WMMPS_STA -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ /* reset currently related uapsd setting when the connection has broken */ -+ pmlmepriv->qospriv.uapsd_max_sp_len = 0; -+ pmlmepriv->qospriv.uapsd_tid = 0; -+ pmlmepriv->qospriv.uapsd_tid_delivery_enabled = 0; -+ pmlmepriv->qospriv.uapsd_tid_trigger_enabled = 0; -+ pmlmepriv->qospriv.uapsd_ap_supported = 0; -+ } -+#endif /* CONFIG_WMMPS_STA */ -+#ifdef CONFIG_RTS_FULL_BW -+ rtw_set_rts_bw(padapter); -+#endif/*CONFIG_RTS_FULL_BW*/ -+ -+ pmlmeinfo->assoc_AP_vendor = HT_IOT_PEER_UNKNOWN; -+ rtw_phydm_update_ap_vendor_ie(padapter); -+} -+ -+void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) -+{ -+ struct sta_info *psta; -+ 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; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+#if (!defined(CONFIG_IOCTL_CFG80211)) || defined(CONFIG_LAYER2_ROAMING) -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+#endif -+ -+ if (pmlmepriv->wpa_phase == _TRUE) -+ pmlmepriv->wpa_phase = _FALSE; -+ -+ 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); -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) -+ rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_DISCONNECTED); -+ -+ rtw_btcoex_connect_notify(padapter, join_type); -+ pmlmeinfo->assoc_AP_vendor = HT_IOT_PEER_UNKNOWN; -+ goto exit_mlmeext_joinbss_event_callback; -+ } -+ -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ pmlmepriv->bGetGateway = 1; -+ pmlmepriv->GetGatewayTryCnt = 0; -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { -+ /* update bc/mc sta_info */ -+ 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); -+ -+ #ifdef CONFIG_RTS_FULL_BW -+ rtw_set_rts_bw(padapter); -+ #endif/*CONFIG_RTS_FULL_BW*/ -+ -+ 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); -+#ifdef CONFIG_80211N_HT -+ /* HT */ -+ HTOnAssocRsp(padapter); -+#endif /* CONFIG_80211N_HT */ -+#ifdef CONFIG_80211AC_VHT -+ /* VHT */ -+ VHTOnAssocRsp(padapter); -+#endif -+ -+ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); -+ if (psta) { /* only for infra. mode */ -+ 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->cmn.mac_id); -+ -+ rtw_xmit_queue_clear(psta); -+ } -+ -+#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) { -+ rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_CONNECTED); -+ -+ /* correcting TSF */ -+ correct_TSF(padapter, MLME_STA_CONNECTED); -+ -+ /* set_link_timer(pmlmeext, DISCONNECT_TO); */ -+ } -+ -+#ifdef CONFIG_LPS -+ #ifndef CONFIG_FW_MULTI_PORT_SUPPORT -+ if (get_hw_port(padapter) == HW_PORT0) -+ #endif -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_CONNECT, RTW_CMDF_DIRECTLY); -+#endif -+ -+ rtw_btcoex_connect_notify(padapter, join_type); -+ -+#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_phydm_update_ap_vendor_ie(padapter); -+ -+ rtw_join_done_chk_ch(padapter, join_res); -+#ifdef CONFIG_RTW_REPEATER_SON -+ rtw_rson_join_done(padapter); -+#endif -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if ((psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_) && -+ (pmlmepriv->roam_network)) { -+ struct xmit_frame *rframe; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _list *plist, *phead; -+ _irqL irqL; -+ _pkt *pkt; -+ -+ padapter->mlmepriv.roam_network = NULL; -+ _enter_critical_bh(&pxmitpriv->rpkt_queue.lock, &irqL); -+ phead = get_list_head(&pxmitpriv->rpkt_queue); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ rframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ plist = get_next(plist); -+ rtw_list_delete(&rframe->list); -+ pkt = rframe->pkt; -+ rtw_xmit_posthandle(padapter, rframe, pkt); -+ } -+ _exit_critical_bh(&pxmitpriv->rpkt_queue.lock, &irqL); -+ } -+#endif -+ 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 */ -+ #ifdef CONFIG_AP_MODE -+ /* update TSF Value */ -+ /* update_TSF(pmlmeext, pframe, len); */ -+ -+ /* correcting TSF */ -+ correct_TSF(padapter, MLME_ADHOC_STARTED); -+ -+ /* start beacon */ -+ if (send_beacon(padapter) == _FAIL) -+ rtw_warn_on(1); -+ -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ #endif -+ } -+ -+ join_type = 2; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ rtw_btcoex_connect_notify(padapter, join_type); -+ } -+ -+ /* update adhoc sta_info */ -+ update_sta_info(padapter, psta); -+ -+ rtw_hal_update_sta_ra_info(padapter, psta); -+ -+ /* ToDo: HT for Ad-hoc */ -+ psta->wireless_mode = rtw_check_network_type(psta->bssrateset, psta->bssratelen, pmlmeext->cur_channel); -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); -+ -+ /* rate radaptive */ -+ Update_RA_Entry(padapter, psta); -+} -+ -+void mlmeext_sta_del_event_callback(_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(_adapter *padapter) -+{ -+ if (padapter->bLinkInfoDump) { -+ 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); -+ } -+} -+/******************************************************************** -+ -+When station does not receive any packet in MAX_CONTINUAL_NORXPACKET_COUNT*2 seconds, -+recipient station will teardown the block ack by issuing DELBA frame. -+ -+*********************************************************************/ -+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->cmn.mac_addr, i, 39, 0, 3, 1); -+ else -+ issue_del_ba(padapter, psta->cmn.mac_addr, 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; -+#ifdef DBG_EXPIRATION_CHK -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ 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) -+ , sta_tx_pkts(psta) -+ , 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; -+} -+ -+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->cmn.mac_addr) -+ , psta->cmn.rssi_stat.rssi -+ , 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->cmn.mac_addr, ETH_ALEN); -+ checkalive[num_checkalive].psta = psta; -+ num_checkalive++; -+ } else { -+ _rtw_memcpy(teardown[num_teardown].addr, psta->cmn.mac_addr, 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 */ -+ -+inline int rtw_get_rx_chk_limit(_adapter *adapter) -+{ -+ return adapter->stapriv.rx_chk_limit; -+} -+ -+inline void rtw_set_rx_chk_limit(_adapter *adapter, int limit) -+{ -+ adapter->stapriv.rx_chk_limit = limit; -+} -+ -+/* from_timer == 1 means driver is in LPS */ -+void linked_status_chk(_adapter *padapter, u8 from_timer) -+{ -+ u32 i; -+ 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; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+#ifdef CONFIG_RTW_WDS -+ rtw_wds_gptr_expire(padapter); -+#endif -+ -+ if (padapter->registrypriv.mp_mode == _TRUE) -+ return; -+ -+ if (check_fwstate(pmlmepriv, WIFI_CSA_UPDATE_BEACON)) -+ 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; -+ -+#if defined(CONFIG_RTW_REPEATER_SON) -+ rtw_rson_scan_wk_cmd(padapter, RSON_SCAN_PROCESS); -+#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 -+ -+ rx_chk_limit = rtw_get_rx_chk_limit(padapter); -+ -+#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, ETH_ALEN); -+ } -+ } -+#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_ISSUE_DELBA_WHEN_NO_TRAFFIC -+ /*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 (sta_last_tx_pkts(psta) == sta_tx_pkts(psta)) -+ tx_chk = _FAIL; -+ -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ if (!from_timer && pmlmeext->active_keep_alive_check && (rx_chk == _FAIL || tx_chk == _FAIL) -+ ) { -+ u8 backup_ch = 0, backup_bw = 0, backup_offset = 0; -+ u8 union_ch = 0, union_bw = 0, union_offset = 0; -+ u8 switch_channel_by_drv = _TRUE; -+ -+ -+#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_by_drv = _FALSE; -+ } -+#endif -+ if (switch_channel_by_drv) { -+ 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->cmn.mac_addr, 0, 0, 3, 1); -+ -+ if ((tx_chk != _SUCCESS && pmlmeinfo->link_count++ == link_count_limit) || rx_chk != _SUCCESS) { -+ if (rtw_mi_check_fwstate(padapter, WIFI_UNDER_SURVEY)) -+ tx_chk = issue_nulldata(padapter, psta->cmn.mac_addr, 1, 3, 1); -+ else -+ tx_chk = issue_nulldata(padapter, psta->cmn.mac_addr, 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 && switch_channel_by_drv) -+ 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, (from_timer ? 0 : 1)); -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, (from_timer ? 0 : 1)); -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, (from_timer ? 0 : 1)); -+ } -+ } -+ -+ 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 -+ if (from_timer || rtw_mi_check_fwstate(padapter, WIFI_UNDER_SURVEY)) -+ tx_chk = issue_nulldata(padapter, NULL, 1, 0, 0); -+ else -+ tx_chk = issue_nulldata(padapter, NULL, 0, 1, 1); -+ } -+ } -+ -+ 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 { -+ psta->sta_stats.last_tx_pkts = psta->sta_stats.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->cmn.mac_addr)) -+ 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->cmn.mac_addr)); -+ report_del_sta_event(padapter, psta->cmn.mac_addr, WLAN_REASON_EXPIRATION_CHK, from_timer ? _TRUE : _FALSE, _FALSE); -+ } -+ } -+ -+} -+ -+void survey_timer_hdl(void *ctx) -+{ -+ _adapter *padapter = (_adapter *)ctx; -+ struct cmd_obj *cmd; -+ struct sitesurvey_parm *psurveyPara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ 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, CMD_SITE_SURVEY); -+ rtw_enqueue_cmd(pcmdpriv, cmd); -+ } -+ -+exit: -+ return; -+} -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+/* 100ms pass, stop rson_scan */ -+void rson_timer_hdl(void *ctx) -+{ -+ _adapter *padapter = (_adapter *)ctx; -+ -+ rtw_rson_scan_wk_cmd(padapter, RSON_SCAN_DISABLE); -+} -+ -+#endif -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+void rtw_tbtx_xmit_timer_hdl(void *ctx) -+{ -+ _adapter *padapter = (_adapter *)ctx; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (ATOMIC_READ(&padapter->tbtx_remove_tx_pause) == _TRUE){ -+ ATOMIC_SET(&padapter->tbtx_tx_pause, _FALSE); -+ rtw_tx_control_cmd(padapter); -+ }else { -+ rtw_issue_action_token_rel(padapter); -+ ATOMIC_SET(&padapter->tbtx_tx_pause, _TRUE); -+ rtw_tx_control_cmd(padapter); -+ _set_timer(&pmlmeext->tbtx_xmit_timer, MAX_TXPAUSE_DURATION); -+ ATOMIC_SET(&padapter->tbtx_remove_tx_pause, _TRUE); -+ } -+} -+ -+#ifdef CONFIG_AP_MODE -+void rtw_tbtx_token_dispatch_timer_hdl(void *ctx) -+{ -+ _adapter *padapter = (_adapter *)ctx; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ _irqL irqL; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ _list *phead, *plist; -+ int i, found = _FALSE; -+ u8 nr_send, th_idx = 0; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ RTW_DBG("%s:asoc_cnt: %d\n",__func__, pstapriv->tbtx_asoc_list_cnt); -+ -+ // check number of TBTX sta -+ if (padapter->stapriv.tbtx_asoc_list_cnt < 2) -+ goto exit; -+ -+ // dispatch token -+ -+ nr_send = RTW_DIV_ROUND_UP(pstapriv->tbtx_asoc_list_cnt, NR_TBTX_SLOT); -+ -+ 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); -+ /* psta is supporting TBTX */ -+ if ((!psta) || (!psta->tbtx_enable)) -+ RTW_DBG("sta tbtx_enable is false\n"); -+ else { -+ for (i = 0; i < nr_send; i++) { -+ if (pstapriv->last_token_holder == psta) { -+ found = _TRUE; -+ goto outof_loop; -+ } -+ } -+ } -+ plist = get_next(plist); -+ } -+outof_loop: -+ -+ RTW_DBG("rtw_tbtx_token_dispatch_timer_hdl() th_idx=%d, nr_send=%d, phead=%p, plist=%p, found=%d\n ", th_idx , nr_send, phead, plist, found); -+ if (!found) { -+ plist = get_next(phead); -+ while(rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ if ((!psta) || (!psta->tbtx_enable)) -+ RTW_DBG("sta tbtx_enable is false\n"); -+ else { -+ pstapriv->token_holder[th_idx] = psta; -+ rtw_issue_action_token_req(padapter, pstapriv->token_holder[th_idx++]); -+ break; -+ } -+ plist = get_next(plist); -+ } -+ } -+ -+ for (i=th_idx; itbtx_enable)) -+ RTW_DBG("sta tbtx_enable is false\n"); -+ else { -+ pstapriv->token_holder[th_idx] = psta; -+ rtw_issue_action_token_req(padapter, pstapriv->token_holder[th_idx++]); -+ i++; -+ } -+ } -+ ATOMIC_SET(&pstapriv->nr_token_keeper, nr_send); -+ -+ -+exit: -+ // set_timer -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ _set_timer(&pmlmeext->tbtx_token_dispatch_timer, TBTX_TX_DURATION); -+} -+#endif /* CONFIG_AP_MODE */ -+#endif /* CONFIG_RTW_TOKEN_BASED_XMIT */ -+ -+void link_timer_hdl(void *ctx) -+{ -+ _adapter *padapter = (_adapter *)ctx; -+ /* 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 (rtw_sta_linking_test_force_fail()) -+ RTW_INFO("rtw_sta_linking_test_force_fail\n"); -+ -+ if (pmlmeext->join_abort && pmlmeinfo->state != WIFI_FW_NULL_STATE) { -+ RTW_INFO(FUNC_ADPT_FMT" join abort\n", FUNC_ADPT_ARG(padapter)); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_join_res(padapter, -4, WLAN_STATUS_UNSPECIFIED_FAILURE); -+ goto exit; -+ } -+ -+ 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, WLAN_STATUS_UNSPECIFIED_FAILURE); -+ } else if (pmlmeinfo->state & WIFI_FW_AUTH_STATE) { -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (rtw_sec_chk_auth_type(padapter, MLME_AUTHTYPE_SAE)) -+ return; -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ /* re-auth timer */ -+ if (++pmlmeinfo->reauth_count > REAUTH_LIMIT) { -+ /* if (pmlmeinfo->auth_algo != dot11AuthAlgrthm_Auto) */ -+ /* { */ -+ pmlmeinfo->state = 0; -+ if (pmlmeinfo->auth_status) { -+ report_join_res(padapter, -1, pmlmeinfo->auth_status); -+ pmlmeinfo->auth_status = 0; /* reset */ -+ } else -+ report_join_res(padapter, -1, WLAN_STATUS_UNSPECIFIED_FAILURE); -+ 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_ft_roam(padapter)) { -+ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); -+ if (psta) -+ rtw_free_stainfo(padapter, psta); -+ } -+#endif -+ report_join_res(padapter, -2, WLAN_STATUS_UNSPECIFIED_FAILURE); -+ return; -+ } -+ -+#ifdef CONFIG_RTW_80211R -+ if (rtw_ft_roam(padapter)) { -+ 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); -+ } -+ -+exit: -+ return; -+} -+ -+void addba_timer_hdl(void *ctx) -+{ -+ struct sta_info *psta = (struct sta_info *)ctx; -+ -+#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 rtw_evt_header *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 rtw_evt_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 = CMD_SET_MLME_EVT; -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ evt_hdr = (struct rtw_evt_header *)(pevtcmd); -+ evt_hdr->len = sizeof(struct stadel_event); -+ evt_hdr->id = EVT_TIMEOUT_STA; -+ evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pdel_sta_evt = (struct stadel_event *)(pevtcmd + sizeof(struct rtw_evt_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->cmn.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) -+{ -+ struct mlme_ext_priv *mlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info); -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ receive_disconnect(padapter, get_my_bssid(&(mlmeinfo->network)), WLAN_REASON_SA_QUERY_TIMEOUT, _FALSE); -+} -+ -+void sa_query_timer_hdl(void *ctx) -+{ -+ struct sta_info *psta = (struct sta_info *)ctx; -+ _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, WIFI_ASOC_STATE) == _TRUE) -+ clnt_sa_query_timeout(padapter); -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ report_sta_timeout_event(padapter, psta->cmn.mac_addr, WLAN_REASON_PREV_AUTH_NOT_VALID); -+} -+ -+#endif /* CONFIG_IEEE80211W */ -+ -+#ifdef CONFIG_AUTO_AP_MODE -+void rtw_auto_ap_rx_msg_dump(_adapter *padapter, union recv_frame *precv_frame, u8 *ehdr_pos) -+{ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_info *psta = precv_frame->u.hdr.psta; -+ struct ethhdr *ehdr = (struct ethhdr *)ehdr_pos; -+ -+ RTW_INFO("eth rx: got eth_type=0x%x\n", ntohs(ehdr->h_proto)); -+ -+ if (psta && psta->isrc && psta->pid > 0) { -+ u16 rx_pid; -+ -+ rx_pid = *(u16 *)(ehdr_pos + ETH_HLEN); -+ -+ RTW_INFO("eth rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", -+ rx_pid, MAC_ARG(psta->cmn.mac_addr), psta->pid); -+ -+ if (rx_pid == psta->pid) { -+ int i; -+ u16 len = *(u16 *)(ehdr_pos + ETH_HLEN + 2); -+ /* u16 ctrl_type = *(u16 *)(ehdr_pos + 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", *(ehdr_pos + ETH_HLEN + 4 + i)); -+ /* RTW_INFO("0x%x\n", *(ehdr_pos + ETH_HLEN + 6 + i)); */ -+ -+ RTW_INFO("eth, RC-end\n"); -+ } -+ } -+ -+} -+ -+void rtw_start_auto_ap(_adapter *adapter) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ rtw_set_802_11_infrastructure_mode(adapter, Ndis802_11APMode, 0); -+ -+ rtw_setopmode_cmd(adapter, Ndis802_11APMode, RTW_CMDF_WAIT_ACK); -+} -+ -+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 & padapter->registrypriv.wireless_mode); -+ 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 */ -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+u8 tx_control_hdl(_adapter *adapter) -+{ -+ u8 val; -+ -+ if(ATOMIC_READ(&adapter->tbtx_tx_pause)) -+ val = 0xff; -+ else -+ val = 0x00; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &val); -+ -+ return H2C_SUCCESS; -+} -+#endif -+ -+#ifdef CONFIG_AP_MODE -+u8 stop_ap_hdl(_adapter *adapter) -+{ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ -+ rtw_set_802_11_infrastructure_mode(adapter, Ndis802_11Infrastructure, RTW_CMDF_DIRECTLY); -+ rtw_setopmode_cmd(adapter, Ndis802_11Infrastructure, RTW_CMDF_DIRECTLY); -+ -+ return H2C_SUCCESS; -+} -+#endif -+ -+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 -+ || psetop->mode == Ndis802_11_mesh -+ ) { -+ pmlmeinfo->state = WIFI_FW_AP_STATE; -+ type = _HW_STATE_AP_; -+ } 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_; -+ -+#ifdef CONFIG_AP_PORT_SWAP -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, (u8 *)(&type)); -+#endif -+ -+ 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, RTW_CMDF_DIRECTLY); -+#endif -+ } -+ } -+ -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ /* Enable beacon early interrupt IMR of AP mode after port switch done */ -+ if (MLME_IS_AP(padapter)) -+ rtw_hal_set_ap_bcn_imr_cmd(padapter, 1); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ if (psetop->mode == Ndis802_11APMode -+ || psetop->mode == Ndis802_11_mesh -+ || 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) -+{ -+#ifdef CONFIG_AP_MODE -+ 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; */ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ -+ if ((parm->req_ch == 0 && pmlmeinfo->state == WIFI_FW_AP_STATE) -+ || parm->req_ch != 0 -+ ) { -+ start_bss_network(padapter, parm); -+ if (rfctl->ap_csa_en) { -+ u8 enable = 0; -+ rfctl->ap_csa_en = AP_CSA_DISABLE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_EARLY_C2H_RPT, &enable); -+ } -+ goto exit; -+ } -+ -+ /* 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; -+ -+ /* 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; -+#else -+ return H2C_SUCCESS; -+#endif /* CONFIG_AP_MODE */ -+} -+ -+u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ u8 join_type; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ 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 */ -+#ifdef CONFIG_LAYER2_ROAMING -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *rnetwork = pmlmepriv->roam_network; -+ struct beacon_keys bcn_keys; -+ u32 roam_ielen; -+ _irqL irqL; -+#endif -+ 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); -+ if (pmlmeinfo->state & WIFI_FW_STATION_STATE) -+ rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_DISCONNECTED); -+ } -+ -+#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; -+#ifdef ROKU_PRIVATE -+ pmlmeinfo->ht_vht_received = 0; -+ _rtw_memset(pmlmeinfo->SupportedRates_infra_ap, 0, NDIS_802_11_LENGTH_RATES_EX); -+#endif /* ROKU_PRIVATE */ -+ _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), WLAN_STATUS_UNSPECIFIED_FAILURE); -+ 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, 1, 1); -+ -+ rtw_adjust_chbw(padapter, 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 */ -+ 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), WLAN_STATUS_UNSPECIFIED_FAILURE); -+ 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); -+ if (MLME_IS_STA(padapter)) -+ rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_CONNECTING); -+ else -+ rtw_hal_rcr_set_chk_bssid(padapter, MLME_ADHOC_STARTED); -+ -+ join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ rtw_btcoex_connect_notify(padapter, join_type); -+ -+ doiqk = _TRUE; -+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); -+ -+ set_channel_bwmode(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); -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ _enter_critical_bh(&pmlmepriv->clnt_auth_lock, &irqL); -+ if (rnetwork && (pmlmeinfo->state & (WIFI_FW_AUTH_NULL | WIFI_FW_AUTH_STATE))) { -+ struct beacon_keys bcn_keys; -+ u32 roam_ielen; -+ -+ roam_ielen = rnetwork->network.IELength; -+ update_network(&(pmlmepriv->cur_network.network), &(rnetwork->network), padapter, _TRUE); -+ -+ /* update bcn keys */ -+ if (rtw_get_bcn_keys_from_bss(&rnetwork->network, &bcn_keys) == _TRUE) { -+ _rtw_memcpy(&pmlmepriv->cur_beacon_keys, &bcn_keys, sizeof(bcn_keys)); -+ if (is_hidden_ssid(bcn_keys.ssid, bcn_keys.ssid_len)) { -+ _rtw_memcpy(pmlmepriv->cur_beacon_keys.ssid, pmlmeinfo->network.Ssid.Ssid, IW_ESSID_MAX_SIZE); -+ pmlmepriv->cur_beacon_keys.ssid_len = pmlmeinfo->network.Ssid.SsidLength; -+ } -+ } else { -+ RTW_ERR("%s: get beacon keys failed\n", __func__); -+ _rtw_memset(&pmlmepriv->cur_beacon_keys, 0, sizeof(bcn_keys)); -+ } -+ #ifdef CONFIG_BCN_CNT_CONFIRM_HDL -+ pmlmepriv->new_beacon_cnts = 0; -+ #endif -+ -+ /* check the vendor of the assoc AP */ -+ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(rnetwork->network.IEs, rnetwork->network.IELength); -+ rtw_phydm_update_ap_vendor_ie(padapter); -+ -+ /* update TSF Value */ -+ pmlmeext->TSFValue = rnetwork->network.tsf + rtw_get_passing_time_ms(rnetwork->last_scanned)*1000; -+ pmlmeext->bcn_cnt = 0; -+ pmlmeext->last_bcn_cnt = 0; -+ /* start auth */ -+ start_clnt_auth(padapter); -+ } -+ _exit_critical_bh(&pmlmepriv->clnt_auth_lock, &irqL); -+#endif -+ return H2C_SUCCESS; -+ -+} -+ -+u8 disconnect_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+#if CONFIG_DFS -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+#endif -+ 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) -+ #if CONFIG_DFS -+ && !IS_RADAR_DETECTED(rfctl) && !rfctl->csa_ch -+ #endif -+ ) { -+ #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 */ -+ } -+ -+#ifndef CONFIG_SUPPORT_MULTI_BCN -+ 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)); -+ } -+#endif -+ -+ rtw_sta_mstatus_report(padapter); -+ -+ 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 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 -+ ); -+ } -+ 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 mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ 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)) -+ 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 (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(); -+ } -+ -+ return ret_num; -+} -+ -+#ifdef CONFIG_SCAN_BACKOP -+u8 rtw_scan_backop_decision(_adapter *adapter) -+{ -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct mi_state mstate; -+ u8 backop_flags = 0; -+ -+ rtw_mi_status(adapter, &mstate); -+ -+ if ((MSTATE_STA_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_sta(mlmeext, SS_BACKOP_EN)) -+ || (MSTATE_STA_NUM(&mstate) && mlmeext_chk_scan_backop_flags_sta(mlmeext, SS_BACKOP_EN_NL))) -+ backop_flags |= mlmeext_scan_backop_flags_sta(mlmeext); -+ -+#ifdef CONFIG_AP_MODE -+ if ((MSTATE_AP_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_ap(mlmeext, SS_BACKOP_EN)) -+ || (MSTATE_AP_NUM(&mstate) && mlmeext_chk_scan_backop_flags_ap(mlmeext, SS_BACKOP_EN_NL))) -+ backop_flags |= mlmeext_scan_backop_flags_ap(mlmeext); -+#endif -+ -+#ifdef CONFIG_RTW_MESH -+ if ((MSTATE_MESH_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_mesh(mlmeext, SS_BACKOP_EN)) -+ || (MSTATE_MESH_NUM(&mstate) && mlmeext_chk_scan_backop_flags_mesh(mlmeext, SS_BACKOP_EN_NL))) -+ backop_flags |= mlmeext_scan_backop_flags_mesh(mlmeext); -+#endif -+ -+ return backop_flags; -+} -+#endif -+ -+#define SCANNING_TIMEOUT_EX 2000 -+u32 rtw_scan_timeout_decision(_adapter *padapter) -+{ -+ u32 back_op_times= 0; -+ u8 max_chan_num; -+ u16 scan_ms; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct ss_res *ss = &pmlmeext->sitesurvey_res; -+ -+ if (is_supported_5g(padapter->registrypriv.wireless_mode) -+ && IsSupported24G(padapter->registrypriv.wireless_mode)) -+ max_chan_num = MAX_CHANNEL_NUM_2G_5G;/* dual band */ -+ else -+ max_chan_num = MAX_CHANNEL_NUM_2G;/*single band*/ -+ -+ #ifdef CONFIG_SCAN_BACKOP -+ if (rtw_scan_backop_decision(padapter)) -+ back_op_times = (max_chan_num / ss->scan_cnt_max) * ss->backop_ms; -+ #endif -+ -+ if (ss->duration) -+ scan_ms = ss->duration; -+ else -+ #if defined(CONFIG_RTW_ACS) && defined(CONFIG_RTW_ACS_DBG) -+ if (IS_ACS_ENABLE(padapter) && rtw_is_acs_st_valid(padapter)) -+ scan_ms = rtw_acs_get_adv_st(padapter); -+ else -+ #endif /*CONFIG_RTW_ACS*/ -+ scan_ms = ss->scan_ch_ms; -+ -+ ss->scan_timeout_ms = (scan_ms * max_chan_num) + back_op_times + SCANNING_TIMEOUT_EX; -+ #ifdef DBG_SITESURVEY -+ RTW_INFO("%s , scan_timeout_ms = %d (ms)\n", __func__, ss->scan_timeout_ms); -+ #endif /*DBG_SITESURVEY*/ -+ return ss->scan_timeout_ms; -+} -+ -+static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel *out, -+ u32 out_num, struct rtw_ieee80211_channel *in, u32 in_num, bool no_sparse, int reason) -+{ -+ int i, j; -+ int set_idx; -+ u8 chan; -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(padapter)); -+#ifdef CONFIG_RTW_ROAM_QUICKSCAN -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+#endif -+ -+ /* clear first */ -+ _rtw_memset(out, 0, sizeof(struct rtw_ieee80211_channel) * out_num); -+ -+#ifdef CONFIG_RTW_ROAM_QUICKSCAN -+ if ((reason == RTW_AUTO_SCAN_REASON_ROAM_ACTIVE) && (pmlmeext->quickscan_next)) { -+ pmlmeext->quickscan_next = _FALSE; -+ _rtw_memcpy(out, pmlmeext->roam_ch, sizeof(struct rtw_ieee80211_channel)*RTW_CHANNEL_SCAN_AMOUNT); -+ return pmlmeext->roam_ch_num; -+ } -+#endif -+ -+ /* 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_chset_search_ch(rfctl->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 (rfctl->channel_set[set_idx].flags & (RTW_CHF_NO_IR | RTW_CHF_DFS)) -+ 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 < rfctl->max_chan_nums; i++) { -+ chan = rfctl->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 (rfctl->channel_set[i].flags & (RTW_CHF_NO_IR | RTW_CHF_DFS)) -+ out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ -+ j++; -+ } -+ } -+ } -+ -+ if (!no_sparse -+ && !regsty->wifi_spec -+ && j > 6 /* assume ch_num > 6 is normal scan */ -+ ) { -+ /* 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; -+ RT_CHANNEL_INFO *chset = adapter_to_chset(adapter); -+ int i, reason = 0; -+ -+ ss->bss_cnt = 0; -+ ss->activate_ch_cnt = 0; -+ ss->channel_idx = 0; -+ ss->force_ssid_scan = 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 -+ ss->ssid_num = 0; -+ 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; -+ ss->ssid_num++; -+ } else -+ ss->ssid[i].SsidLength = 0; -+ } -+ reason = parm->reason; -+ ss->ch_num = rtw_scan_ch_decision(adapter -+ , ss->ch, RTW_CHANNEL_SCAN_AMOUNT -+ , parm->ch, parm->ch_num -+ , parm->acs -+ , reason -+ ); -+ -+ for (i = 0; i < MAX_CHANNEL_NUM; i++) -+ chset[i].hidden_bss_cnt = 0; -+ -+ ss->bw = parm->bw; -+ ss->igi = parm->igi; -+ ss->token = parm->token; -+ ss->duration = parm->duration; -+ ss->scan_mode = parm->scan_mode; -+ ss->token = parm->token; -+ ss->acs = parm->acs; -+} -+ -+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 ss_res *ss = &pmlmeext->sitesurvey_res; -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ int ch_set_idx; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif -+#ifdef CONFIG_SCAN_BACKOP -+ u8 backop_flags = 0; -+#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. -+ */ -+ scan_ch = pwdinfo->social_chan[ss->channel_idx]; -+ ch_set_idx = rtw_chset_search_ch(rfctl->channel_set, scan_ch); -+ if (ch_set_idx >= 0) -+ scan_type = rfctl->channel_set[ch_set_idx].flags & RTW_CHF_NO_IR ? SCAN_PASSIVE : SCAN_ACTIVE; -+ else -+ scan_type = SCAN_ACTIVE; -+ } else -+#endif /* CONFIG_P2P */ -+ { -+ struct rtw_ieee80211_channel *ch; -+ -+ #ifdef CONFIG_SCAN_BACKOP -+ backop_flags = rtw_scan_backop_decision(padapter); -+ #endif -+ -+ #ifdef CONFIG_SCAN_BACKOP -+ if (!(backop_flags && ss->scan_cnt >= ss->scan_cnt_max)) -+ #endif -+ { -+ #ifdef CONFIG_RTW_WIFI_HAL -+ if (adapter_to_dvobj(padapter)->nodfs) { -+ while (ss->channel_idx < ss->ch_num && rtw_chset_is_dfs_ch(rfctl->channel_set, ss->ch[ss->channel_idx].hw_value)) -+ ss->channel_idx++; -+ } else -+ #endif -+ if (ss->channel_idx != 0 && ss->force_ssid_scan == 0 -+ && pmlmeext->sitesurvey_res.ssid_num -+ && (ss->ch[ss->channel_idx - 1].flags & RTW_IEEE80211_CHAN_PASSIVE_SCAN) -+ ) { -+ ch_set_idx = rtw_chset_search_ch(rfctl->channel_set, ss->ch[ss->channel_idx - 1].hw_value); -+ if (ch_set_idx != -1 && rfctl->channel_set[ch_set_idx].hidden_bss_cnt -+ && (!IS_DFS_SLAVE_WITH_RD(rfctl) -+ || rtw_rfctl_dfs_domain_unknown(rfctl) -+ || !CH_IS_NON_OCP(&rfctl->channel_set[ch_set_idx])) -+ ) { -+ ss->channel_idx--; -+ ss->force_ssid_scan = 1; -+ } -+ } else -+ ss->force_ssid_scan = 0; -+ } -+ -+ if (ss->channel_idx < ss->ch_num) { -+ ch = &ss->ch[ss->channel_idx]; -+ scan_ch = ch->hw_value; -+ -+ #if defined(CONFIG_RTW_ACS) && defined(CONFIG_RTW_ACS_DBG) -+ if (IS_ACS_ENABLE(padapter) && rtw_is_acs_passiv_scan(padapter)) -+ scan_type = SCAN_PASSIVE; -+ else -+ #endif /*CONFIG_RTW_ACS*/ -+ 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 -+ 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 -+ -+ } 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 ss_res *ss = &pmlmeext->sitesurvey_res; -+ u8 ssid_scan = 0; -+ -+#ifdef CONFIG_P2P -+#ifndef CONFIG_IOCTL_CFG80211 -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif -+#endif -+ -+ if (survey_channel != 0) { -+ set_channel_bwmode(padapter, survey_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ -+ if (ScanType == SCAN_PASSIVE && ss->force_ssid_scan) -+ ssid_scan = 1; -+ else 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 */ -+ { -+ 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); -+ } -+ -+ ssid_scan = 1; -+ } -+ } -+ -+ if (ssid_scan) { -+ 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); -+ } -+ } -+ } -+ } 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); -+ } -+ } -+#ifdef CONFIG_MCC_MODE -+exit: -+#endif -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+} -+ -+/** -+ * rtw_ps_annc - check and doing ps announcement for all the adapters -+ * @adapter: the requesting adapter -+ * @ps: power saving or not -+ * -+ * Returns: 0: no ps announcement is doing. 1: ps announcement is doing -+ */ -+u8 rtw_ps_annc(_adapter *adapter, bool ps) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ int i; -+ u8 ps_anc = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ if (MLME_IS_STA(iface)) { -+ if (is_client_associated_to_ap(iface) == _TRUE) { -+ /* TODO: TDLS peers */ -+ #ifdef CONFIG_MCC_MODE -+ /* for two station case */ -+ if (MCC_EN(adapter) && rtw_hal_check_mcc_status(adapter, MCC_STATUS_NEED_MCC)) { -+ u8 ch = iface->mlmeextpriv.cur_channel; -+ u8 offset = iface->mlmeextpriv.cur_ch_offset; -+ u8 bw = iface->mlmeextpriv.cur_bwmode; -+ -+ set_channel_bwmode(iface, ch, offset, bw); -+ } -+ #endif /* CONFIG_MCC_MODE */ -+ issue_nulldata(iface, NULL, ps, 3, 500); -+ ps_anc = 1; -+ } -+ #ifdef CONFIG_RTW_MESH -+ } else if (MLME_IS_MESH(iface)) { -+ if (rtw_mesh_ps_annc(iface, ps)) -+ ps_anc = 1; -+ #endif -+ } -+ } -+ return ps_anc; -+} -+ -+void rtw_leave_opch(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(adapter) && rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) -+ return; -+#endif -+ -+ _enter_critical_mutex(&rfctl->offch_mutex, NULL); -+ -+ if (rfctl->offch_state == OFFCHS_NONE) { -+ /* prepare to leave operating channel */ -+ rfctl->offch_state = OFFCHS_LEAVING_OP; -+ -+ /* clear HW TX queue */ -+ rtw_hal_set_hwreg(adapter, HW_VAR_CHECK_TXBUF, 0); -+ -+ rtw_hal_macid_sleep_all_used(adapter); -+ -+ rtw_ps_annc(adapter, 1); -+ -+ rfctl->offch_state = OFFCHS_LEAVE_OP; -+ } -+ -+ _exit_critical_mutex(&rfctl->offch_mutex, NULL); -+} -+ -+void rtw_back_opch(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(adapter) && rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) -+ return; -+#endif -+ -+ _enter_critical_mutex(&rfctl->offch_mutex, NULL); -+ -+ if (rfctl->offch_state != OFFCHS_NONE) { -+ rfctl->offch_state = OFFCHS_BACKING_OP; -+ rtw_hal_macid_wakeup_all_used(adapter); -+ rtw_ps_annc(adapter, 0); -+ -+ rfctl->offch_state = OFFCHS_NONE; -+ rtw_mi_os_xmit_schedule(adapter); -+ } -+ -+ _exit_critical_mutex(&rfctl->offch_mutex, NULL); -+} -+ -+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 (pwdinfo->driver_interface == DRIVER_CFG80211 && rtw_cfg80211_is_p2p_scan(adapter)) -+ igi = 0x30; -+ else -+ #endif /* CONFIG_IOCTL_CFG80211 */ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ igi = 0x28; -+ else -+ #endif /* CONFIG_P2P */ -+ -+ if (ss->igi) -+ igi = ss->igi; -+ else -+ #if defined(CONFIG_RTW_ACS) && defined(CONFIG_RTW_ACS_DBG) -+ if (IS_ACS_ENABLE(adapter) && rtw_is_acs_igi_valid(adapter)) -+ igi = rtw_acs_get_adv_igi(adapter); -+ else -+ #endif /*CONFIG_RTW_ACS*/ -+ 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(adapter_to_phydm(adapter), ss->igi_before_scan); -+ break; -+ case SCAN_LEAVE_OP: -+ /* write IGI for scan when DIG is not enabled */ -+ odm_write_dig(adapter_to_phydm(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); -+} -+ -+void sitesurvey_set_offch_state(_adapter *adapter, u8 scan_state) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ _enter_critical_mutex(&rfctl->offch_mutex, NULL); -+ -+ switch (scan_state) { -+ case SCAN_DISABLE: -+ case SCAN_BACK_OP: -+ rfctl->offch_state = OFFCHS_NONE; -+ break; -+ case SCAN_START: -+ case SCAN_LEAVING_OP: -+ rfctl->offch_state = OFFCHS_LEAVING_OP; -+ break; -+ case SCAN_ENTER: -+ case SCAN_LEAVE_OP: -+ rfctl->offch_state = OFFCHS_LEAVE_OP; -+ break; -+ case SCAN_COMPLETE: -+ case SCAN_BACKING_OP: -+ rfctl->offch_state = OFFCHS_BACKING_OP; -+ break; -+ default: -+ break; -+ } -+ -+ _exit_critical_mutex(&rfctl->offch_mutex, NULL); -+} -+ -+#ifdef CONFIG_RTW_ROAM_QUICKSCAN -+extern inline int is_same_ess(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b); -+extern int rtw_is_desired_network(_adapter *adapter, struct wlan_network *pnetwork); -+void generate_quickss(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *pnetwork = NULL; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct rtw_ieee80211_channel *roam_ch = pmlmeext->roam_ch; -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ int chan; -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 *target_ssid=NULL, *ssid=NULL, ds_cfg, j, ch_num; -+ u32 target_ssid_len=0, ssid_len=0; -+ u8 mark[166]; -+ -+ target_ssid = pmlmepriv->cur_network.network.Ssid.Ssid; -+ target_ssid_len = pmlmepriv->cur_network.network.Ssid.SsidLength; -+ _rtw_memset(mark, 0, sizeof(u8)*166); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ phead = get_list_head(&(pmlmepriv->scanned_queue)); -+ if (!phead) { -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ return; -+ } -+ plist = get_next(phead); -+ if (!plist) { -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ return; -+ } -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (!pnetwork) -+ break; -+ -+ ds_cfg = pnetwork->network.Configuration.DSConfig; -+ if (is_same_ess(&pnetwork->network, &pmlmepriv->cur_network.network) && -+ rtw_is_desired_network(padapter, pnetwork)) -+ mark[ds_cfg] = 1; -+ -+ plist = get_next(plist); -+ } -+ /* ex: assume roaming channel=1/6/40/165, then mark[1]/[6]/[40]/[165] are 1. */ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ ch_num = 0; -+ for (j = 0; j < rfctl->max_chan_nums; j++) { -+ chan = rfctl->channel_set[j].ChannelNum; -+ if (mark[chan]) { -+ roam_ch[ch_num].hw_value = chan; -+ roam_ch[ch_num++].flags = rfctl->channel_set[j].flags; -+ } -+ } -+ pmlmeext->roam_ch_num = ch_num; -+} -+#endif -+ -+u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ struct sitesurvey_parm *pparm = (struct sitesurvey_parm *)pbuf; -+#ifdef DBG_CHECK_FW_PS_STATE -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+#endif -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct ss_res *ss = &pmlmeext->sitesurvey_res; -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+#endif -+ u8 val8; -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#endif -+#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: -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ if ((pwdev_priv->pno_mac_addr[0] != 0xFF) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _FALSE)) { -+ u16 seq_num; -+ -+#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI -+ rtw_hal_pno_random_gen_mac_addr(padapter); -+#endif -+ rtw_hal_set_hw_macaddr(padapter, pwdev_priv->pno_mac_addr); -+ get_random_bytes(&seq_num, 2); -+ pwdev_priv->pno_scan_seq_num = seq_num & 0xFFF; -+ RTW_INFO("%s pno_scan_seq_num %d\n", __func__, -+ pwdev_priv->pno_scan_seq_num); -+ } -+#endif -+ -+ /* -+ * 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); -+ -+ rtw_hal_macid_sleep_all_used(padapter); -+ -+ /* power save state announcement */ -+ if (rtw_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_RTW_ACS -+ if (IS_ACS_ENABLE(padapter)) -+ rtw_acs_get_rst(padapter); -+#endif -+ -+ next_state = sitesurvey_pick_ch_behavior(padapter, &scan_ch, &scan_type); -+ -+ if (next_state != SCAN_PROCESS) { -+ mlmeext_set_scan_state(pmlmeext, next_state); -+ goto operation_by_state; -+ } -+ -+ /* still SCAN_PROCESS state */ -+ #ifdef DBG_SITESURVEY -+ #ifdef CONFIG_P2P -+ RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (cnt:%u,idx:%d) at %dms, %c%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' : ' ' -+ , ss->force_ssid_scan ? 'F' : ' ' -+ ); -+ #else -+ RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (idx:%d) at %dms, %c%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' : ' ' -+ , ss->force_ssid_scan ? 'F' : ' ' -+ ); -+ #endif /* CONFIG_P2P */ -+ #endif /*DBG_SITESURVEY*/ -+#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, WIFI_ASOC_STATE) == _TRUE) -+ scan_ms = 20; -+ else -+ scan_ms = 40; -+#else -+ #if defined(CONFIG_RTW_ACS) && defined(CONFIG_RTW_ACS_DBG) -+ if (IS_ACS_ENABLE(padapter) && rtw_is_acs_st_valid(padapter)) -+ scan_ms = rtw_acs_get_adv_st(padapter); -+ else -+ #endif /*CONFIG_RTW_ACS*/ -+ 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 -+ -+#ifdef CONFIG_RTW_ACS -+ if (IS_ACS_ENABLE(padapter)) { -+ if (pparm->token) -+ rtw_acs_trigger(padapter, scan_ms, scan_ch, NHM_PID_IEEE_11K_HIGH); -+ else -+ rtw_acs_trigger(padapter, scan_ms, scan_ch, NHM_PID_ACS); -+ } -+#endif -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ if (IS_NM_ENABLE(padapter)) -+ rtw_noise_measure(padapter, scan_ch, _FALSE, 0, scan_ms / 2); -+#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); -+ back_ch = pmlmeext->cur_channel; -+ back_bw = pmlmeext->cur_bwmode; -+ back_ch_offset = pmlmeext->cur_ch_offset; -+ } -+ } -+ -+ #ifdef DBG_SITESURVEY -+ 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) -+ ); -+ #endif /*DBG_SITESURVEY*/ -+ 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); -+ rtw_hal_macid_wakeup_all_used(padapter); -+ rtw_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); -+ -+ rtw_hal_macid_sleep_all_used(padapter); -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC) -+ && rtw_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: -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ rtw_hal_set_hw_macaddr(padapter, adapter_mac_addr(padapter)); -+#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 (rtw_mi_check_status(padapter, MI_LINKED)) -+ _set_timer(&prochinfo->ap_roch_ch_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 -+ { -+ rtw_hal_macid_wakeup_all_used(padapter); -+ rtw_ps_annc(padapter, 0); -+ } -+ -+ /* apply rx ampdu setting */ -+ rtw_rx_ampdu_apply(padapter); -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_DISABLE); -+ -+ report_surveydone_event(padapter, ss->acs); -+#ifdef CONFIG_RTW_ACS -+ if (IS_ACS_ENABLE(padapter)) -+ rtw_acs_select_best_chan(padapter); -+#endif -+ -+#if defined(CONFIG_BACKGROUND_NOISE_MONITOR) && defined(DBG_NOISE_MONITOR) -+ if (IS_NM_ENABLE(padapter)) -+ rtw_noise_info_dump(RTW_DBGDUMP, padapter); -+#endif -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ -+#ifdef CONFIG_RTW_80211K -+ if (ss->token) -+ rm_post_event(padapter, ss->token, RM_EV_survey_done); -+#endif /* CONFIG_RTW_80211K */ -+#ifdef CONFIG_RTW_ROAM_QUICKSCAN -+ if (padapter->mlmepriv.need_to_roam == _TRUE) -+ generate_quickss(padapter); -+#endif -+ break; -+ } -+ -+ 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; -+} -+ -+static u8 amsdu_spp_enable(_adapter *pdapter, enum security_type type) -+{ -+ u8 ret = _FALSE; -+ -+ if (pdapter->registrypriv.amsdu_mode == RTW_AMSDU_MODE_SPP) { -+ if ( type == _AES_ || type == _CCMP_256_ -+ || type == _GCMP_ || type == _GCMP_256_ ) -+ ret = _SUCCESS; -+ } -+ -+ return ret; -+} -+ -+/* -+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; -+ -+#ifndef SEC_DEFAULT_KEY_SEARCH -+ 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, 1, -+ !!(pparm->algorithm & _SEC_TYPE_256_), &used); -+ -+ if (cam_id < 0) -+ goto enable_mc; -+ -+#ifdef SEC_DEFAULT_KEY_SEARCH -+ if (cam_id >= 0 && cam_id <= 3) { -+ /* default key camid */ -+ addr = null_addr; -+ } else -+#endif -+ { -+ /* not default key camid */ -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) { -+ /* group TX, force sec cam entry_id */ -+ addr = adapter_mac_addr(padapter); -+ } else { -+ /* group RX, searched by A2 (TA) */ -+ addr = get_bssid(&padapter->mlmepriv); -+ } -+ } -+ -+#ifdef CONFIG_LPS_PG -+ if (adapter_to_pwrctl(padapter)->lps_level == LPS_PG) -+ LPS_Leave(padapter, "SET_KEY"); -+#endif -+ -+ /* 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 & 0x07) << 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)); -+ -+ if (pparm->algorithm & _SEC_TYPE_256_) { -+ RTW_INFO_DUMP("GTK : ", pparm->key, sizeof(pparm->key)); -+ ctrl |= BIT(9); -+ } -+ if (amsdu_spp_enable(padapter, pparm->algorithm) == _SUCCESS) -+ ctrl |= BIT(7); -+ 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)))*/ -+#ifndef SEC_DEFAULT_KEY_SEARCH -+ 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); -+ }*/ -+ } -+ } -+#else -+ 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; -+ -+ _rtw_memset(&sta_pparm, 0, sizeof(struct set_stakey_parm)); -+ 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); -+#ifdef CONFIG_LAYER2_ROAMING -+ if (padapter->mlmepriv.roam_network) { -+ struct xmit_frame *rframe; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _list *plist, *phead; -+ _irqL irqL; -+ _pkt *pkt; -+ -+ padapter->mlmepriv.roam_network = NULL; -+ _enter_critical_bh(&pxmitpriv->rpkt_queue.lock, &irqL); -+ phead = get_list_head(&pxmitpriv->rpkt_queue); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ rframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ plist = get_next(plist); -+ rtw_list_delete(&rframe->list); -+ pkt = rframe->pkt; -+ rtw_xmit_posthandle(padapter, rframe, pkt); -+ } -+ _exit_critical_bh(&pxmitpriv->rpkt_queue.lock, &irqL); -+ } -+#endif -+ 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; -+ sta_pparm.gk = 0; -+ _rtw_memcpy(sta_pparm.key, &(psecuritypriv->dot11DefKey[keyid].skey[0]), 16); -+ _rtw_memcpy(sta_pparm.addr, psta->cmn.mac_addr, ETH_ALEN); -+ -+ RTW_PRINT(FUNC_ADPT_FMT"set WEP - PK with "MAC_FMT" keyid:%u\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr), 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 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; -+ -+ cam_id = rtw_camid_alloc(padapter, psta, pparm->keyid, pparm->gk, -+ !!(pparm->algorithm & _SEC_TYPE_256_), &used); -+ if (cam_id < 0) -+ goto exit; -+ -+#ifdef CONFIG_LPS_PG -+ if (adapter_to_pwrctl(padapter)->lps_level == LPS_PG) -+ LPS_Leave(padapter, "SET_KEY"); -+#endif -+ -+ /* cam entry searched is group key when setting pariwise key */ -+ if (!pparm->gk && 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 %s key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n" -+ , pparm->gk ? "group" : "pairwise" -+ , cam_id, MAC_ARG(pparm->addr), pparm->keyid, security_type_str(pparm->algorithm)); -+ ctrl = BIT(15) | ((pparm->algorithm & 0x07) << 2) | pparm->keyid; -+ if (pparm->gk) -+ ctrl |= BIT(6); -+ if (pparm->algorithm & _SEC_TYPE_256_) { -+ RTW_INFO_DUMP("PTK : ", pparm->key, sizeof(pparm->key)); -+ ctrl |= BIT(9); -+ } -+ -+ if (amsdu_spp_enable(padapter, pparm->algorithm) == _SUCCESS) -+ ctrl |= BIT(7); -+ -+ write_cam(padapter, cam_id, ctrl, pparm->addr, pparm->key); -+ if (!(pparm->gk)) -+ ATOMIC_INC(&psta->keytrack); /*CVE-2020-24587*/ -+ } -+ 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(&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; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ u8 ret = _TRUE; -+ -+ 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 "FUNC_ADPT_FMT" tid:%u SN_UPDATE indicate_seq:%d, start_seq:%d\n" -+ , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, pparm->start_seq); -+ #endif -+ } -+#else -+ rtw_set_bit(RTW_RECV_ACK_OR_TIMEOUT, &preorder_ctrl->rec_abba_rsp_ack); -+ #ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_CLEAR indicate_seq:%d, start_seq:%d preorder_ctrl->rec_abba_rsp_ack =%lu \n" -+ , FUNC_ADPT_ARG(padapter) -+ , preorder_ctrl->tid -+ , preorder_ctrl->indicate_seq -+ , pparm->start_seq -+ ,preorder_ctrl->rec_abba_rsp_ack -+ ); -+ #endif -+#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, CMD_CHK_BMCSLEEPQ); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+} -+ -+u8 set_tx_beacon_cmd(_adapter *padapter, u8 flags) -+{ -+ 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); -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ int len_diff = 0; -+ -+ /*prepare cmd parameter*/ -+ ptxBeacon_parm = (struct Tx_Beacon_param *)rtw_zmalloc(sizeof(struct Tx_Beacon_param)); -+ if (ptxBeacon_parm == NULL) { -+ 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; -+ -+ -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ rtw_mfree((u8 *)ptxBeacon_parm, sizeof(*ptxBeacon_parm)); -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, ptxBeacon_parm, CMD_TX_BEACON); -+ -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ ph2c->sctx = &sctx; -+ rtw_sctx_init(&sctx, 10 * 1000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ 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) -+ ph2c->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ } -+ -+ -+exit: -+ -+ -+ return res; -+} -+ -+ -+u8 mlme_evt_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct rtw_evt_header *evt_hdr; -+ u8 *peventbuf; -+ void (*event_callback)(_adapter *dev, u8 *pbuf); -+ struct evt_priv *pevt_priv = &(padapter->evtpriv); -+ -+ if (pbuf == NULL) -+ goto _abort_event_; -+ -+ evt_hdr = (struct rtw_evt_header *)pbuf; -+ peventbuf = pbuf + sizeof(struct rtw_evt_header); -+ -+#ifdef CHECK_EVENT_SEQ -+ /* checking event sequence... */ -+ if (evt_hdr->seq != (ATOMIC_READ(&pevt_priv->event_seq) & 0x7f)) { -+ pevt_priv->event_seq = (evt_hdr->seq + 1) & 0x7f; -+ goto _abort_event_; -+ } -+#endif -+ -+ /* checking if event code is valid */ -+ if (evt_hdr->id >= EVT_ID_MAX) { -+ goto _abort_event_; -+ } -+ -+ /* checking if event size match the event parm size */ -+ if ((wlanevents[evt_hdr->id].parmsize != 0) && -+ (wlanevents[evt_hdr->id].parmsize != evt_hdr->len)) { -+ -+ goto _abort_event_; -+ -+ } -+ -+ ATOMIC_INC(&pevt_priv->event_seq); -+ -+ if (peventbuf) { -+ event_callback = wlanevents[evt_hdr->id].event_callback; -+ event_callback(padapter, (u8 *)peventbuf); -+ pevt_priv->evt_done_cnt++; -+ } -+ -+_abort_event_: -+ 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 ((rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 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_AP_MODE -+ /*RTW_INFO(FUNC_ADPT_FMT, FUNC_ADPT_ARG(padapter));*/ -+#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 -+#endif /* CONFIG_AP_MODE */ -+ 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 -+*/ -+#ifdef CONFIG_AP_MODE -+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_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ 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_); -+ #ifdef CONFIG_80211AC_VHT -+ /* if channel in 5G band, then add vht ie . */ -+ if ((pmlmepriv->htpriv.ht_option == _TRUE) -+ && REGSTY_IS_11AC_ENABLE(&padapter->registrypriv) -+ && is_supported_vht(padapter->registrypriv.wireless_mode) -+ && RFCTL_REG_EN_11AC(rfctl) -+ ) { -+ if (pmlmepriv->vhtpriv.upper_layer_setting) -+ rtw_reattach_vht_ies(padapter, pnetwork); -+ else if (REGSTY_IS_11AC_AUTO(&padapter->registrypriv)) -+ rtw_vht_ies_attach(padapter, pnetwork); -+ } -+ #endif -+ } else { -+ network_type = 0; -+ total_rate_len = 0; -+ if (padapter->registrypriv.wireless_mode & WIRELESS_11B) { -+ network_type |= WIRELESS_11B; -+ total_rate_len += IEEE80211_CCK_RATE_LEN; -+ } -+ if (padapter->registrypriv.wireless_mode & WIRELESS_11G) { -+ network_type |= WIRELESS_11G; -+ total_rate_len += IEEE80211_NUM_OFDM_RATESLEN; -+ } -+ rtw_add_bcn_ie(padapter, pnetwork, _ERPINFO_IE_, &erpinfo, 1); -+ #ifdef CONFIG_80211AC_VHT -+ rtw_vht_ies_detach(padapter, pnetwork); -+ #endif -+ } -+ -+ 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 /* CONFIG_AP_MODE */ -+ -+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, ret; -+ -+ 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); -+ } -+ -+ ret = rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset); -+ if (join_res >= 0 && ret <= 0) { -+ join_res = -1; -+ dump_adapters_status(RTW_DBGDUMP , dvobj); -+ rtw_warn_on(1); -+ } -+ -+ 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 */ -+ -+ 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 ((MLME_IS_AP(iface) || MLME_IS_MESH(iface)) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+ ) { -+ u8 ori_ch, ori_bw, ori_offset; -+ 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 */ -+ -+ ori_ch = mlmeext->cur_channel; -+ ori_bw = mlmeext->cur_bwmode; -+ ori_offset = mlmeext->cur_ch_offset; -+ -+ /* restore original bw, adjust bw by registry setting on target ch */ -+ mlmeext->cur_bwmode = mlme->ori_bw; -+ mlmeext->cur_channel = u_ch; -+ rtw_adjust_chbw(iface, mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset); -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(iface)) -+ rtw_mesh_adjust_chbw(mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset); -+ #endif -+ -+ rtw_chset_sync_chbw(adapter_to_chset(adapter) -+ , &mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset -+ , &u_ch, &u_bw, &u_offset, 1, 0); -+ -+ RTW_INFO(FUNC_ADPT_FMT" %u,%u,%u => %u,%u,%u\n", FUNC_ADPT_ARG(iface) -+ , ori_ch, ori_bw, ori_offset -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_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); -+ -+ { -+ #if defined(CONFIG_IOCTL_CFG80211) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ u8 ht_option = 0; -+ -+ #ifdef CONFIG_80211N_HT -+ ht_option = mlme->htpriv.ht_option; -+ #endif -+ -+ rtw_cfg80211_ch_switch_notify(iface -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset -+ , ht_option, 0); -+ #endif -+ } -+ } -+ -+ clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); -+ #ifdef CONFIG_ACTIVE_TPC_REPORT -+ if (MLME_ACTIVE_TPC_REPORT(mlme)) -+ update_beacon(iface, WLAN_EID_TPC_REPORT, NULL, _FALSE, 0); -+ #endif -+ update_beacon(iface, 0xFF, NULL, _TRUE, 0); -+ } -+#endif /* CONFIG_AP_MODE */ -+ } -+ -+#ifdef CONFIG_DFS_MASTER -+ rtw_dfs_rd_en_decision(adapter, MLME_STA_CONNECTED, 0); -+#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 ((MLME_IS_AP(iface) || MLME_IS_MESH(iface)) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+ ) { -+ clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); -+ update_beacon(iface, 0xFF, NULL, _TRUE, 0); -+ } -+#endif -+ } -+ -+ #ifdef CONFIG_80211D -+ rtw_leavebss_update_regulatory(adapter); -+ #endif -+ -+#ifdef CONFIG_DFS_MASTER -+ rtw_dfs_rd_en_decision(adapter, MLME_STA_DISCONNECTED, 0); -+#endif -+ } -+ -+ if (rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset)) { -+ RTW_INFO(FUNC_ADPT_FMT" union:%u,%u,%u\n", FUNC_ADPT_ARG(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 (join_res >= 0) -+ rtw_rfctl_update_op_mode(adapter_to_rfctl(adapter), BIT(adapter->iface_id), 1); -+ -+ 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) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ bool chbw_allow = _TRUE; -+#endif -+ 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" others ld_sta_num:%u, ap_num:%u, mesh_num:%u\n" -+ , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate) -+ , MSTATE_AP_NUM(&mstate), MSTATE_MESH_NUM(&mstate)); -+ -+ if (!MSTATE_STA_LD_NUM(&mstate) && !MSTATE_AP_NUM(&mstate) && !MSTATE_MESH_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" others union:%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) + MSTATE_MESH_LD_NUM(&mstate) >= 4) -+ 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 */ -+ -+ 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; -+ -+ #ifdef CONFIG_AP_MODE -+ if ((MLME_IS_AP(iface) || MLME_IS_MESH(iface)) -+ && 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 -+ if (rfctl->ap_csa_en == AP_CSA_DISABLE) -+ rtw_sta_flush(iface, _FALSE); -+ -+ rtw_hal_set_hwreg(iface, HW_VAR_CHECK_TXBUF, 0); -+ set_fwstate(mlme, WIFI_OP_CH_SWITCHING); -+ } else -+ #endif /* CONFIG_AP_MODE */ -+ if (check_fwstate(mlme, WIFI_STATION_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+ ) { -+ rtw_disassoc_cmd(iface, 500, RTW_CMDF_DIRECTLY); -+ rtw_indicate_disconnect(iface, 0, _FALSE); -+ rtw_free_assoc_resources(iface, _TRUE); -+ } -+ } -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ #ifdef CONFIG_80211D -+ rtw_joinbss_update_regulatory(adapter, &adapter->mlmeextpriv.mlmext_info.network); -+ #endif -+ -+ #ifdef CONFIG_DFS_MASTER -+ rtw_dfs_rd_en_decision(adapter, MLME_STA_CONNECTING, 0); -+ #endif -+ -+exit: -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+ if (rfctl->ap_csa_en != AP_CSA_DISABLE) { -+ u8 enable = 0; -+ rfctl->ap_csa_en = AP_CSA_DISABLE; -+ rtw_hal_set_hwreg(adapter, HW_VAR_BCN_EARLY_C2H_RPT, &enable); -+ } -+#endif -+ -+ if (connect_allow == _TRUE) { -+ RTW_INFO(FUNC_ADPT_FMT" union: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ rtw_mi_update_union_chan_inf(adapter, u_ch, u_offset, u_bw); -+ *ch = u_ch; -+ *bw = u_bw; -+ *offset = u_offset; -+ -+#if defined(CONFIG_IOCTL_CFG80211) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ { -+ u8 ht_option = 0; -+ -+#ifdef CONFIG_80211N_HT -+ ht_option = adapter->mlmepriv.htpriv.ht_option; -+#endif /* CONFIG_80211N_HT */ -+ -+ /* -+ when supplicant send the mlme frame, -+ the bss freq is updated by channel switch event. -+ */ -+ rtw_cfg80211_ch_switch_notify(adapter, -+ cur_ch, cur_bw, cur_ch_offset, ht_option, 1); -+ } -+#endif -+ } -+ -+ return connect_allow == _TRUE ? _SUCCESS : _FAIL; -+} -+ -+void rtw_set_external_auth_status(_adapter *padapter, -+ const void *data, int len) -+{ -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct net_device *dev = padapter->pnetdev; -+ struct wiphy *wiphy = adapter_to_wiphy(padapter); -+ struct rtw_external_auth_params params; -+ -+ /* convert data to external_auth_params */ -+ params.action = RTW_GET_BE32((u8 *)data); -+ _rtw_memcpy(¶ms.bssid, (u8 *)data + 4, ETH_ALEN); -+ _rtw_memcpy(¶ms.ssid.ssid, (u8 *)data + 10, WLAN_SSID_MAXLEN); -+ params.ssid.ssid_len = RTW_GET_BE64((u8 *)data + 42); -+ params.key_mgmt_suite = RTW_GET_BE32((u8 *)data + 58); -+ params.status = RTW_GET_BE16((u8 *)data + 62); -+ _rtw_memcpy(¶ms.pmkid, (u8 *)data + 64, PMKID_LEN); -+ -+ rtw_cfg80211_external_auth_status(wiphy, dev, ¶ms); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+} -+ -+u8 rtw_iqk_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ rtw_hal_phydm_cal_trigger(padapter); -+ return H2C_SUCCESS; -+} -+ -+u8 rtw_set_chbw_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ struct set_ch_parm *set_ch_parm; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 ifbmp_s = rtw_mi_get_ld_sta_ifbmp(padapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ u8 u_ch, u_bw, u_offset; -+ -+ 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); -+ -+ /* update ch, bw, offset for all asoc STA ifaces */ -+ if (ifbmp_s) { -+ _adapter *iface; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface || !(ifbmp_s & BIT(iface->iface_id))) -+ continue; -+ -+ /* update STA mode ch/bw/offset */ -+ iface->mlmeextpriv.cur_channel = set_ch_parm->ch; -+ iface->mlmeextpriv.cur_bwmode = set_ch_parm->bw; -+ iface->mlmeextpriv.cur_ch_offset = set_ch_parm->ch_offset; -+ /* updaet STA mode DSConfig , ap mode will update in rtw_change_bss_chbw_cmd */ -+ iface->mlmepriv.cur_network.network.Configuration.DSConfig = set_ch_parm->ch; -+ } -+ } -+ -+ LeaveAllPowerSaveModeDirect(padapter); -+ -+ set_channel_bwmode(padapter, set_ch_parm->ch, set_ch_parm->ch_offset, set_ch_parm->bw); -+ -+ rtw_mi_get_ch_setting_union(padapter, &u_ch, &u_bw, &u_offset); -+ rtw_mi_update_union_chan_inf(padapter, u_ch, u_offset, u_bw); -+ rtw_rfctl_update_op_mode(dvobj_to_rfctl(dvobj), 0, 0); -+ -+ return H2C_SUCCESS; -+} -+ -+static void get_str_of_set_chplan_keys(char *buf, u8 buf_len, struct SetChannelPlan_param *param) -+{ -+ char *pos = buf; -+ -+#ifdef CONFIG_80211D -+ if (param->has_cisr) { -+ pos += snprintf(pos, buf_len - (pos - buf), "alpha2:"ALPHA2_FMT" %s" -+ , ALPHA2_ARG(param->cisr.alpha2), cis_status_str(param->cisr.status)); -+ } else -+#endif -+ if (param->has_country) -+ pos += snprintf(pos, buf_len - (pos - buf), "alpha2:"ALPHA2_FMT, ALPHA2_ARG(param->country_ent.alpha2)); -+ else { -+ if (param->channel_plan == RTW_CHPLAN_UNSPECIFIED) -+ pos += snprintf(pos, buf_len - (pos - buf), "chplan:NA"); -+ else -+ pos += snprintf(pos, buf_len - (pos - buf), "chplan:0x%02X", param->channel_plan); -+ -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ if (param->channel_plan_6g == RTW_CHPLAN_6G_UNSPECIFIED) -+ pos += snprintf(pos, buf_len - (pos - buf), " chplan_6g:NA"); -+ else -+ pos += snprintf(pos, buf_len - (pos - buf), " chplan_6g:0x%02X", param->channel_plan_6g); -+ #endif -+ } -+} -+ -+#ifdef CONFIG_80211D -+static bool rtw_chplan_rtk_priv_req_prehdl_country_ie(_adapter *adapter, struct SetChannelPlan_param *param, const char *caller) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ int i; -+ bool effected = 1; -+ -+#ifdef CONFIG_RTW_DEBUG -+ if (rtw_drv_log_level >= _DRV_DEBUG_) { -+ RTW_PRINT("%s cisr before\n", caller); -+ dump_country_ie_slave_records(RTW_DBGDUMP, rfctl, 0); -+ } -+#endif -+ -+ if (param->inr == RTW_REGD_SET_BY_USER -+ && rfctl->effected_cisr_id != CONFIG_IFACE_NUMBER -+ ) { -+ /* country IE setting is applied, user setting is only recorded but not applied */ -+ effected = 0; -+ goto exit; -+ } -+ -+ if (param->inr == RTW_REGD_SET_BY_COUNTRY_IE) { -+ struct country_ie_slave_record ori_cisr = rfctl->cisr[adapter->iface_id]; -+ struct country_ie_slave_record ori_ecisr; -+ u8 ori_ecisr_id = rfctl->effected_cisr_id; -+ u8 new_ecisr_id = CONFIG_IFACE_NUMBER; -+ u8 status_score[] = { /* conservative policy */ -+ [COUNTRY_IE_SLAVE_UNKNOWN] = 3, -+ [COUNTRY_IE_SLAVE_OPCH_NOEXIST] = 2, -+ [COUNTRY_IE_SLAVE_APPLICABLE] = 1, -+ }; -+ char buf[32]; -+ -+ if (_rtw_memcmp(&rfctl->cisr[adapter->iface_id], ¶m->cisr, sizeof(param->cisr)) == _TRUE) { -+ /* record no change */ -+ effected = 0; -+ goto exit; -+ } -+ -+ if (ori_ecisr_id != CONFIG_IFACE_NUMBER) -+ _rtw_memcpy(&ori_ecisr, &rfctl->cisr[ori_ecisr_id], sizeof(ori_ecisr)); -+ -+ _rtw_memcpy(&rfctl->cisr[adapter->iface_id], ¶m->cisr, sizeof(param->cisr)); -+ if ((ori_cisr.status == COUNTRY_IE_SLAVE_NOCOUNTRY -+ && rfctl->cisr[adapter->iface_id].status == COUNTRY_IE_SLAVE_NOCOUNTRY) -+ || (ori_cisr.status == COUNTRY_IE_SLAVE_UNKNOWN -+ && rfctl->cisr[adapter->iface_id].status == COUNTRY_IE_SLAVE_UNKNOWN) -+ ) { -+ /* will take no effect */ -+ effected = 0; -+ goto exit; -+ } -+ -+ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) { -+ if (rfctl->cisr[i].status == COUNTRY_IE_SLAVE_NOCOUNTRY) -+ continue; -+ if (new_ecisr_id == CONFIG_IFACE_NUMBER -+ /* high score */ -+ || status_score[rfctl->cisr[i].status] > status_score[rfctl->cisr[new_ecisr_id].status] -+ /* same score, prefer the same alpha2 as current effected(same score) one */ -+ || (status_score[rfctl->cisr[i].status] == status_score[rfctl->cisr[new_ecisr_id].status] -+ && ori_ecisr_id != CONFIG_IFACE_NUMBER -+ && rfctl->cisr[ori_ecisr_id].status == rfctl->cisr[new_ecisr_id].status -+ && _rtw_memcmp(rfctl->cisr[ori_ecisr_id].alpha2, rfctl->cisr[new_ecisr_id].alpha2, 2) == _FALSE -+ && _rtw_memcmp(rfctl->cisr[ori_ecisr_id].alpha2, rfctl->cisr[i].alpha2, 2) == _TRUE) -+ ) -+ new_ecisr_id = i; -+ } -+ -+ rfctl->effected_cisr_id = new_ecisr_id; -+ -+ if (rfctl->effected_cisr_id == CONFIG_IFACE_NUMBER) { -+ /* no country IE setting */ -+ const char *alpha2; -+ -+ if (strncmp(rfctl->user_alpha2, "\x00\x00", 2) != 0) { -+ /* restore to user setting */ -+ param->inr = RTW_REGD_SET_BY_USER; -+ alpha2 = rfctl->user_alpha2; -+ param->channel_plan = rfctl->user_ChannelPlan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ param->channel_plan_6g = rfctl->user_chplan_6g; -+ #endif -+ } else { -+ /* restore to init setting */ -+ param->inr = RTW_REGD_SET_BY_INIT; -+ alpha2 = rfctl->init_alpha2; -+ param->channel_plan = rfctl->init_ChannelPlan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ param->channel_plan_6g = rfctl->init_chplan_6g; -+ #endif -+ } -+ -+ if (IS_ALPHA2_UNSPEC(alpha2) || IS_ALPHA2_WORLDWIDE(alpha2)) -+ param->has_country = 0; -+ else if (rtw_get_chplan_from_country(alpha2, ¶m->country_ent)) { -+ param->channel_plan = param->country_ent.chplan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ param->channel_plan_6g = param->country_ent.chplan_6g; -+ #endif -+ param->has_country = 1; -+ } else { -+ RTW_WARN("%s unexpected country_code:\"%c%c\", set to \"00\"\n", caller, alpha2[0], alpha2[1]); -+ rtw_warn_on(1); -+ rtw_get_chplan_worldwide(¶m->country_ent); -+ param->channel_plan = param->country_ent.chplan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ param->channel_plan_6g = param->country_ent.chplan_6g; -+ #endif -+ param->has_country = 1; -+ } -+ param->has_cisr = 0; -+ -+ get_str_of_set_chplan_keys(buf, 32, param); -+ RTW_INFO("%s restore inr:%s %s\n", caller, regd_inr_str(param->inr), buf); -+ } -+ else { -+ /* has country IE setting */ -+ if (ori_ecisr_id != CONFIG_IFACE_NUMBER) { -+ /* has country IE setting originally */ -+ if (_rtw_memcmp(&ori_ecisr, &rfctl->cisr[new_ecisr_id], sizeof(ori_ecisr)) == _TRUE) { -+ /* same record content, no effect */ -+ effected = 0; -+ goto exit; -+ } -+ } -+ rtw_get_chplan_from_cisrs(rfctl, ¶m->country_ent, caller); -+ param->channel_plan = param->country_ent.chplan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ param->channel_plan_6g = param->country_ent.chplan_6g; -+ #endif -+ param->has_country = 1; -+ param->has_cisr = 0; -+ -+ get_str_of_set_chplan_keys(buf, 32, param); -+ RTW_INFO("%s trigger inr:%s %s\n", caller, regd_inr_str(param->inr), buf); -+ } -+ } -+ -+exit: -+#ifdef CONFIG_RTW_DEBUG -+ if (rtw_drv_log_level >= _DRV_DEBUG_) { -+ RTW_PRINT("%s cisr after\n", caller); -+ dump_country_ie_slave_records(RTW_DBGDUMP, rfctl, 0); -+ } -+#endif -+ -+ return effected; -+} -+#endif /* CONFIG_80211D */ -+ -+static bool rtw_chplan_rtk_priv_req_prehdl_domain_code(_adapter *adapter, struct SetChannelPlan_param *param, const char *caller) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ /* disallow invalid input */ -+ if ((param->channel_plan != RTW_CHPLAN_UNSPECIFIED -+ && !rtw_is_channel_plan_valid(param->channel_plan)) -+ ) { -+ RTW_WARN("%s invalid chplan:0x%02X\n", caller, param->channel_plan); -+ return _FAIL; -+ } -+ -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ if (param->channel_plan_6g != RTW_CHPLAN_6G_UNSPECIFIED -+ && !rtw_is_channel_plan_6g_valid(param->channel_plan_6g) -+ ) { -+ RTW_WARN("%s invalid chplan_6g:0x%02X\n", caller, param->channel_plan_6g); -+ return _FAIL; -+ } -+ #endif -+ -+ /* use original value when unspecified */ -+ if (param->channel_plan == RTW_CHPLAN_UNSPECIFIED) -+ param->channel_plan = rfctl->ChannelPlan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ if (param->channel_plan_6g == RTW_CHPLAN_6G_UNSPECIFIED) -+ param->channel_plan_6g = rfctl->chplan_6g; -+ #endif -+ -+ return _SUCCESS; -+} -+ -+static void rtw_chplan_rtk_priv_req_prehdl_country_ent(struct SetChannelPlan_param *param) -+{ -+ if (!param->has_country) { -+ u8 chplan_6g = RTW_CHPLAN_6G_NULL; -+ -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ chplan_6g = param->channel_plan_6g; -+ #endif -+ -+ if (rtw_chplan_ids_is_world_wide(param->channel_plan, chplan_6g)) -+ rtw_get_chplan_worldwide(¶m->country_ent); -+ else { -+ SET_UNSPEC_ALPHA2(param->country_ent.alpha2); -+ param->country_ent.edcca_mode_2g_override = RTW_EDCCA_DEF; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ param->country_ent.edcca_mode_5g_override = RTW_EDCCA_DEF; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ param->country_ent.edcca_mode_6g_override = RTW_EDCCA_DEF; -+ #endif -+ param->country_ent.txpwr_lmt_override = TXPWR_LMT_DEF; -+ #if defined(CONFIG_80211AX_HE) || defined(CONFIG_80211AC_VHT) -+ param->country_ent.proto_en = CHPLAN_PROTO_EN_ALL; -+ #endif -+ } -+ param->has_country = 1; -+ } -+} -+ -+u8 rtw_set_chplan_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct SetChannelPlan_param *param; -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ bool effected = 1; -+ char buf[32]; -+ enum rtw_regd_inr ori_inr; -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct get_chplan_resp *chplan; -+#endif -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ param = (struct SetChannelPlan_param *)pbuf; -+ ori_inr = param->inr; -+ -+ get_str_of_set_chplan_keys(buf, 32, param); -+ RTW_INFO("%s iface_id:%u src:%s inr:%s %s\n", __func__, padapter->iface_id -+ , regd_src_str(param->regd_src), regd_inr_str(param->inr), buf); -+ -+ /* check input parameter */ -+ if (param->regd_src == REGD_SRC_RTK_PRIV) { -+ #ifdef CONFIG_80211D -+ effected = rtw_chplan_rtk_priv_req_prehdl_country_ie(padapter, param, __func__); -+ #endif -+ -+ if (rtw_chplan_rtk_priv_req_prehdl_domain_code(padapter, param, __func__) != _SUCCESS) -+ return H2C_PARAMETERS_ERROR; -+ -+ rtw_chplan_rtk_priv_req_prehdl_country_ent(param); -+ } -+ -+ rtw_warn_on(!param->has_country); -+ -+ if (param->inr == RTW_REGD_SET_BY_USER) { -+ rfctl->user_alpha2[0] = param->country_ent.alpha2[0]; -+ rfctl->user_alpha2[1] = param->country_ent.alpha2[1]; -+ rfctl->user_ChannelPlan = param->channel_plan; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ rfctl->user_chplan_6g = param->channel_plan_6g; -+ #endif -+ } -+ -+ if (!effected) -+ goto exit; -+ -+ rfctl->regd_src = param->regd_src; -+ rfctl->regd_inr = param->inr; -+ rfctl->alpha2[0] = param->country_ent.alpha2[0]; -+ rfctl->alpha2[1] = param->country_ent.alpha2[1]; -+ rfctl->edcca_mode_2g_override = param->country_ent.edcca_mode_2g_override; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ rfctl->edcca_mode_5g_override = param->country_ent.edcca_mode_5g_override; -+#endif -+#if CONFIG_IEEE80211_BAND_6GHZ -+ rfctl->edcca_mode_6g_override = param->country_ent.edcca_mode_6g_override; -+#endif -+#if CONFIG_TXPWR_LIMIT -+ rfctl->txpwr_lmt_override = param->country_ent.txpwr_lmt_override; -+#endif -+#if defined(CONFIG_80211AX_HE) || defined(CONFIG_80211AC_VHT) -+ rfctl->proto_en = param->country_ent.proto_en; -+#endif -+ -+ rfctl->ChannelPlan = param->channel_plan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ rfctl->chplan_6g = param->channel_plan_6g; -+#endif -+ -+#if CONFIG_TXPWR_LIMIT -+ rtw_txpwr_init_regd(rfctl); -+#endif -+ -+ rtw_edcca_mode_update(rfctl_to_dvobj(rfctl)); -+ rtw_odm_adaptivity_update(rfctl_to_dvobj(rfctl)); -+ -+ rtw_rfctl_chplan_init(padapter); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (rfctl->regd_src != REGD_SRC_OS) -+ rtw_chset_hook_os_channels(rfctl); -+ -+ if (rtw_get_chplan_cmd(padapter, RTW_CMDF_DIRECTLY, &chplan) == _SUCCESS) { -+ if (!param->rtnl_lock_needed) -+ rtw_regd_change_complete_sync(adapter_to_wiphy(padapter), chplan, 0); -+ else -+ rtw_warn_on(rtw_regd_change_complete_async(adapter_to_wiphy(padapter), chplan) != _SUCCESS); -+ } else -+ rtw_warn_on(1); -+#endif -+ -+ rtw_nlrtw_reg_change_event(padapter); -+ -+ #ifdef CONFIG_LPS -+ LPS_Leave(padapter, "SET_CHPLAN"); -+ #endif -+ -+ if (GET_HAL_DATA(padapter)->txpwr_limit_loaded -+ && rtw_get_hw_init_completed(padapter)) -+ rtw_hal_update_txpwr_level(padapter); -+ -+exit: -+ return H2C_SUCCESS; -+} -+ -+u8 rtw_get_chplan_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct get_channel_plan_param *param; -+ struct get_chplan_resp *chplan; -+ struct rf_ctl_t *rfctl; -+ int i; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ rfctl = adapter_to_rfctl(padapter); -+ param = (struct get_channel_plan_param *)pbuf; -+ -+ chplan = rtw_vmalloc(sizeof(struct get_chplan_resp) + sizeof(RT_CHANNEL_INFO) * rfctl->max_chan_nums); -+ if (!chplan) -+ return H2C_CMD_FAIL; -+ -+ chplan->regd_src = rfctl->regd_src; -+ chplan->regd_inr = rfctl->regd_inr; -+ -+ chplan->alpha2[0] = rfctl->alpha2[0]; -+ chplan->alpha2[1] = rfctl->alpha2[1]; -+ -+ chplan->channel_plan = rfctl->ChannelPlan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ chplan->chplan_6g = rfctl->chplan_6g; -+#endif -+#if CONFIG_TXPWR_LIMIT -+ for (i = 0; i < BAND_MAX; i++) -+ chplan->txpwr_lmt_name[i] = rfctl->txpwr_lmt_name[i]; -+#endif -+ chplan->edcca_mode_2g = rfctl->edcca_mode_2g; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ chplan->edcca_mode_5g = rfctl->edcca_mode_5g; -+#endif -+#if CONFIG_IEEE80211_BAND_6GHZ -+ chplan->edcca_mode_6g = rfctl->edcca_mode_6g; -+#endif -+#ifdef CONFIG_DFS_MASTER -+ chplan->dfs_domain = rtw_rfctl_get_dfs_domain(rfctl); -+#endif -+ -+ chplan->proto_en = 0 -+ #if defined(CONFIG_80211AX_HE) || defined(CONFIG_80211AC_VHT) -+ | rfctl->proto_en -+ #endif -+ ; -+ -+ chplan->chset_num = rfctl->max_chan_nums; -+ _rtw_memcpy(chplan->chset, rfctl->channel_set, sizeof(RT_CHANNEL_INFO) * rfctl->max_chan_nums); -+ *param->chplan = chplan; -+ -+ 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_RTW_LED_HANDLED_BY_CMD_THREAD -+ BlinkHandler((PLED_DATA)ledBlink_param->pLed); -+#endif -+ -+ return H2C_SUCCESS; -+} -+ -+void csa_timer_hdl(void *FunctionContext) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ u8 i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ _adapter *iface; -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ if (check_fwstate(&(iface->mlmepriv), WIFI_CSA_UPDATE_BEACON)) { -+ clr_fwstate(&(iface->mlmepriv), WIFI_CSA_UPDATE_BEACON); -+ RTW_INFO(FUNC_ADPT_FMT" wait beacons more than 70 seconds\n", FUNC_ADPT_ARG(iface)); -+ return; -+ } -+ } -+ -+ if (rfctl->csa_ch == 0) { -+ RTW_INFO("channel switch done\n"); -+ return ; -+ } -+ -+ /* channel switch */ -+ if (rtw_set_csa_cmd(padapter) != _SUCCESS) { -+ rfctl->csa_ch = 0; -+ rfctl->csa_switch_cnt = 0; -+ rfctl->csa_ch_offset = 0; -+ rfctl->csa_ch_width = 0; -+ rfctl->csa_ch_freq_seg0 = 0; -+ rfctl->csa_ch_freq_seg1 = 0; -+ } -+} -+ -+u8 set_csa_hdl(_adapter *adapter, unsigned char *pbuf) -+{ -+#if CONFIG_DFS -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ if (rfctl->csa_ch) -+ rtw_dfs_ch_switch_hdl(adapter_to_dvobj(adapter)); -+#endif -+ return H2C_SUCCESS; -+} -+ -+u8 set_ap_csa_hdl(_adapter *adapter, unsigned char *pbuf) -+{ -+#ifdef CONFIG_AP_MODE -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 ifbmp_m = rtw_mi_get_ap_mesh_ifbmp(adapter); -+ u8 enable = 1; -+ int i; -+ _adapter *iface; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface || !(ifbmp_m & BIT(iface->iface_id))) -+ continue; -+ RTW_INFO("%s, HW_VAR_BCN_EARLY_C2H_RPT enable=%d\n", __FUNCTION__, enable); -+ rtw_hal_set_hwreg(iface, HW_VAR_BCN_EARLY_C2H_RPT, &enable); -+ } -+#endif -+ return H2C_SUCCESS; -+} -+ -+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; -+ struct sta_info *ap_sta = rtw_get_stainfo(&padapter->stapriv, get_my_bssid(&(pmlmeinfo->network))); -+ 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; -+ u64 tx_ra_bitmap = 0; -+ -+ 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_rcr_set_chk_bssid(padapter, MLME_TDLS_LINKED); -+ RTW_INFO("Created Direct Link with "MAC_FMT"\n", MAC_ARG(ptdls_sta->cmn.mac_addr)); -+ -+ /* Set TDLS sta rate. */ -+ /* Update station supportRate */ -+ rtw_hal_update_sta_ra_info(padapter, ptdls_sta); -+ tx_ra_bitmap = ptdls_sta->cmn.ra_info.ramask; -+ -+ if (pmlmeext->cur_channel > 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 (ptdls_sta->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; -+ } -+ ptdls_sta->wireless_mode = sta_band; -+ rtw_hal_update_sta_wset(padapter, ptdls_sta); -+ /* Sta mode */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, ptdls_sta, _TRUE); -+ -+ set_sta_rate(padapter, ptdls_sta); -+ rtw_sta_media_status_rpt(padapter, ptdls_sta, 1); -+ 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->cmn.mac_addr, ETH_ALEN); -+ -+ if (ap_sta) -+ rtw_hal_macid_sleep(padapter, ap_sta->cmn.mac_id); -+ 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->cmn.mac_addr, TDLS_CH_SW_END_TO_BASE_CHNL); -+ break; -+ } -+ -+ if (ret == _SUCCESS) -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, 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 */ -+ 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); -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, 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: -+ if (ap_sta) -+ rtw_hal_macid_sleep(padapter, ap_sta->cmn.mac_id); -+ issue_nulldata(padapter, NULL, 1, 3, 3); -+ -+ if (padapter->registrypriv.wifi_spec == 0) { -+ 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->cmn.mac_addr, 0, 1, -+ (padapter->registrypriv.wifi_spec == 0) ? 3 : 0) == _FAIL) -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_TO_BASE_CHNL); -+ } -+ } else { -+ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) -+ _cancel_timer_ex(&ptdls_sta->ch_sw_timer); -+ } -+ -+ -+ 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->cmn.mac_addr, 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->cmn.mac_addr, 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) { -+ if (ap_sta) -+ rtw_hal_macid_wakeup(padapter, ap_sta->cmn.mac_id); -+ 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_rcr_set_chk_bssid(padapter, MLME_TDLS_NOLINK); -+ break; -+ case TDLS_TEARDOWN_STA: -+ case TDLS_TEARDOWN_STA_NO_WAIT: -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->cmn.mac_addr, ETH_ALEN); -+ -+ issue_tdls_teardown(padapter, &txmgmt, (option == TDLS_TEARDOWN_STA) ? _TRUE : _FALSE); -+ -+ break; -+ case TDLS_TEARDOWN_STA_LOCALLY: -+ case TDLS_TEARDOWN_STA_LOCALLY_POST: -+#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 -+ -+ if (option == TDLS_TEARDOWN_STA_LOCALLY) -+ rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); -+ -+ rtw_tdls_teardown_post_hdl(padapter, ptdls_sta, _FALSE); -+ -+ if (ptdlsinfo->tdls_sctx != NULL) -+ rtw_sctx_done(&(ptdlsinfo->tdls_sctx)); -+ -+ 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; -+} -+ -+int rtw_sae_preprocess(_adapter *adapter, const u8 *buf, u32 len, u8 tx) -+{ -+#ifdef CONFIG_IOCTL_CFG80211 -+ const u8 *frame_body = buf + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u16 alg; -+ u16 seq; -+ u16 status; -+ int ret = _FAIL; -+ -+ alg = RTW_GET_LE16(frame_body); -+ if (alg != WLAN_AUTH_SAE) -+ goto exit; -+ -+ seq = RTW_GET_LE16(frame_body + 2); -+ status = RTW_GET_LE16(frame_body + 4); -+ -+ RTW_INFO("RTW_%s:AUTH alg:0x%04x, seq:0x%04x, status:0x%04x, mesg:%s\n", -+ (tx == _TRUE) ? "Tx" : "Rx", alg, seq, status, -+ (seq == 1) ? "Commit" : "Confirm"); -+ -+ ret = _SUCCESS; -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(adapter)) { -+ rtw_mesh_sae_check_frames(adapter, buf, len, tx, alg, seq, status); -+ goto exit; -+ } -+#endif -+ -+ if (tx && (seq == 2) && (status == 0)) { -+ /* quere commit frame until external auth statue update */ -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta = NULL; -+ _irqL irqL; -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr1Ptr(buf)); -+ if (psta) { -+ _enter_critical_bh(&psta->lock, &irqL); -+ if (psta->pauth_frame) { -+ rtw_mfree(psta->pauth_frame, psta->auth_len); -+ psta->pauth_frame = NULL; -+ psta->auth_len = 0; -+ } -+ -+ psta->pauth_frame = rtw_zmalloc(len); -+ if (psta->pauth_frame) { -+ _rtw_memcpy(psta->pauth_frame, buf, len); -+ psta->auth_len = len; -+ } -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ ret = 2; -+ } -+ } -+exit: -+ return ret; -+#else -+ return _SUCCESS; -+#endif /* CONFIG_IOCTL_CFG80211 */ -+} -+ -+/* Needs to confirm with FW the value of REG_RX_BEACON_LENGTH */ -+u8 rtw_write_bcnlen_hdl(_adapter *padapter, u8 *pbuf) -+{ -+#ifdef CONFIG_WRITE_BCN_LEN_TO_FW -+ struct write_bcnlen_param *parm = (struct write_bcnlen_param *)pbuf; -+ u16 bcn_len = parm->bcn_len; -+ -+ rtw_write16(padapter, REG_RX_BEACON_LENGTH + 2, bcn_len); -+#endif -+ return H2C_SUCCESS; -+} -+ -+u8 rtw_reqtxrpt_cmd_hdl(_adapter *adapter, u8 *pbuf) -+{ -+ struct reqtxrpt_param *parm = (struct reqtxrpt_param *)pbuf; -+ -+ rtw_hal_reqtxrpt(adapter, parm->macid); -+ -+ return H2C_SUCCESS; -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_mp.c b/drivers/net/wireless/rtl8821cs/core/rtw_mp.c -new file mode 100755 -index 000000000..0c5b11e40 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_mp.c -@@ -0,0 +1,3997 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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->txpower_dbm_offset = 0; -+ -+ 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; -+ pmp_priv->brx_filter_beacon = _FALSE; -+ pmp_priv->mplink_brx = _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 = MP_TX_Payload_default_random; -+#ifdef CONFIG_80211N_HT -+ pmp_priv->tx.attrib.ht_en = 1; -+#endif -+ -+ pmp_priv->mpt_ctx.mpt_rate_index = 1; -+ -+} -+ -+ -+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; -+ -+ if (pHalData->rf_type == RF_2T2R) -+ pattrib->raid = RATEID_IDX_BGN_40M_2SS; -+ else -+ pattrib->raid = RATEID_IDX_BGN_40M_1SS; -+ -+#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; -+ if (IS_HARDWARE_TYPE_8822C(padapter)) -+ pmppriv->mp_dm = 1;/* default enable dpk tracking */ -+ else -+ 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; -+ pmppriv->bprocess_mp_mode = _FALSE; -+ pmppriv->efuse_update_file= _FALSE; -+ pmppriv->efuse_update_on = _FALSE; -+ -+ mp_init_xmit_attrib(&pmppriv->tx, padapter); -+ -+ switch (GET_HAL_RFPATH(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: -+ 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->antenna_tx_path = 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; -+} -+ -+#if 0 -+static void PHY_IQCalibrate_default( -+ PADAPTER pAdapter, -+ BOOLEAN bReCovery -+) -+{ -+ RTW_INFO("%s\n", __func__); -+} -+ -+static void PHY_LCCalibrate_default( -+ PADAPTER pAdapter -+) -+{ -+ RTW_INFO("%s\n", __func__); -+} -+ -+static void PHY_SetRFPathSwitch_default( -+ PADAPTER pAdapter, -+ BOOLEAN bMain -+) -+{ -+ RTW_INFO("%s\n", __func__); -+} -+#endif -+ -+void mpt_InitHWConfig(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ -+ hal = GET_HAL_DATA(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_set_mac_reg(Adapter, 0x64, BIT20, 0x0); /* 0x66[4]=0 */ -+ phy_set_mac_reg(Adapter, 0x64, BIT24, 0x0); /* 0x66[8]=0 */ -+ phy_set_mac_reg(Adapter, 0x40, BIT4, 0x0); /* 0x40[4]=0 */ -+ phy_set_mac_reg(Adapter, 0x40, BIT3, 0x1); /* 0x40[3]=1 */ -+ phy_set_mac_reg(Adapter, 0x4C, BIT24, 0x1); /* 0x4C[24:23]=10 */ -+ phy_set_mac_reg(Adapter, 0x4C, BIT23, 0x0); /* 0x4C[24:23]=10 */ -+ phy_set_bb_reg(Adapter, 0x944, BIT1 | BIT0, 0x3); /* 0x944[1:0]=11 */ -+ phy_set_bb_reg(Adapter, 0x930, bMaskByte0, 0x77);/* 0x930[7:0]=77 */ -+ phy_set_mac_reg(Adapter, 0x38, BIT11, 0x1);/* 0x38[11]=1 */ -+ -+ /* TODO: <20130206, Kordan> The default setting is wrong, hard-coded here. */ -+ phy_set_mac_reg(Adapter, 0x778, 0x3, 0x3); /* Turn off hardware PTA control (Asked by Scott) */ -+ phy_set_mac_reg(Adapter, 0x64, bMaskDWord, 0x36000000);/* Fix BT S0/S1 */ -+ phy_set_mac_reg(Adapter, 0x948, bMaskDWord, 0x0); /* Fix BT can't Tx */ -+ -+ /* <20130522, Kordan> Turn off equalizer to improve Rx sensitivity. (Asked by EEChou) */ -+ phy_set_bb_reg(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_set_mac_reg(Adapter, 0x4C, BIT23, 0x0); /*0x4C[23:22]=01*/ -+ phy_set_mac_reg(Adapter, 0x4C, BIT22, 0x1); /*0x4C[23:22]=01*/ -+ } else if (IS_HARDWARE_TYPE_8188ES(Adapter)) -+ phy_set_mac_reg(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_RTL8812A -+ else if (IS_HARDWARE_TYPE_8812(Adapter)) { -+ rtw_write32(Adapter, 0x520, rtw_read32(Adapter, 0x520) | 0x8000); -+ rtw_write32(Adapter, 0x524, rtw_read32(Adapter, 0x524) & (~0x800)); -+ } -+#endif -+ -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(Adapter)) { -+ u32 tmp_reg = 0; -+ -+ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8822B, 0x2000); -+ /* fixed wifi can't 2.4g tx suggest by Szuyitasi 20160504 */ -+ phy_set_bb_reg(Adapter, 0x70, bMaskByte3, 0x0e); -+ RTW_INFO(" 0x73 = 0x%x\n", phy_query_bb_reg(Adapter, 0x70, bMaskByte3)); -+ phy_set_bb_reg(Adapter, 0x1704, bMaskDWord, 0x0000ff00); -+ RTW_INFO(" 0x1704 = 0x%x\n", phy_query_bb_reg(Adapter, 0x1704, bMaskDWord)); -+ phy_set_bb_reg(Adapter, 0x1700, bMaskDWord, 0xc00f0038); -+ RTW_INFO(" 0x1700 = 0x%x\n", phy_query_bb_reg(Adapter, 0x1700, bMaskDWord)); -+ } -+#endif /* CONFIG_RTL8822B */ -+#ifdef CONFIG_RTL8821C -+ else if (IS_HARDWARE_TYPE_8821C(Adapter)) -+ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8821C, 0x2000); -+#endif /* CONFIG_RTL8821C */ -+#if defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) -+ else if (IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8188GTV(Adapter)) { -+ if (IS_A_CUT(hal->version_id) || IS_B_CUT(hal->version_id)) { -+ RTW_INFO("%s() Active large power detection\n", __func__); -+ phy_active_large_power_detection_8188f(&(GET_HAL_DATA(Adapter)->odmpriv)); -+ } -+ } -+#endif -+#if defined(CONFIG_RTL8822C) -+ else if( IS_HARDWARE_TYPE_8822C(Adapter)) { -+ rtw_write16(Adapter, REG_RXFLTMAP1_8822C, 0x2000); -+ /* 0x7D8[31] : time out enable when cca is not assert -+ 0x60D[7:0] : time out value (Unit : us)*/ -+ rtw_write8(Adapter, 0x7db, 0xc0); -+ RTW_INFO(" 0x7d8 = 0x%x\n", rtw_read8(Adapter, 0x7d8)); -+ rtw_write8(Adapter, 0x60d, 0x0c); -+ RTW_INFO(" 0x60d = 0x%x\n", rtw_read8(Adapter, 0x60d)); -+ phy_set_bb_reg(Adapter, 0x1c44, BIT10, 0x1); -+ RTW_INFO(" 0x1c44 = 0x%x\n", phy_query_bb_reg(Adapter, 0x1c44, bMaskDWord)); -+ } -+#endif -+#if defined(CONFIG_RTL8814B) -+ else if(IS_HARDWARE_TYPE_8814B(Adapter)) -+ { -+ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8814B, 0x2000); -+ } -+#endif -+#if defined(CONFIG_RTL8723F) -+ /* todo: 8723F not verify yet */ -+ else if (IS_HARDWARE_TYPE_8723F(Adapter)) { -+ /* 8723F mac is similar with 8723D, -+ * but can't find 8723D here. -+ */ -+ } -+#endif -+} -+ -+static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) -+{ -+ halrf_iqk_trigger(&(GET_HAL_DATA(padapter)->odmpriv), bReCovery); -+} -+ -+static void PHY_LCCalibrate(PADAPTER padapter) -+{ -+ halrf_lck_trigger(&(GET_HAL_DATA(padapter)->odmpriv)); -+} -+ -+static u8 PHY_QueryRFPathSwitch(PADAPTER padapter) -+{ -+ u8 bmain = 0; -+/* -+ if (IS_HARDWARE_TYPE_8723B(padapter)) { -+#ifdef CONFIG_RTL8723B -+ bmain = PHY_QueryRFPathSwitch_8723B(padapter); -+#endif -+ } else if (IS_HARDWARE_TYPE_8188E(padapter)) { -+#ifdef CONFIG_RTL8188E -+ bmain = PHY_QueryRFPathSwitch_8188E(padapter); -+#endif -+ } else if (IS_HARDWARE_TYPE_8814A(padapter)) { -+#ifdef CONFIG_RTL8814A -+ bmain = PHY_QueryRFPathSwitch_8814A(padapter); -+#endif -+ } else if (IS_HARDWARE_TYPE_8812(padapter) || IS_HARDWARE_TYPE_8821(padapter)) { -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ bmain = PHY_QueryRFPathSwitch_8812A(padapter); -+#endif -+ } else if (IS_HARDWARE_TYPE_8192E(padapter)) { -+#ifdef CONFIG_RTL8192E -+ bmain = PHY_QueryRFPathSwitch_8192E(padapter); -+#endif -+ } else if (IS_HARDWARE_TYPE_8703B(padapter)) { -+#ifdef CONFIG_RTL8703B -+ bmain = PHY_QueryRFPathSwitch_8703B(padapter); -+#endif -+ } else if (IS_HARDWARE_TYPE_8188F(padapter)) { -+#ifdef CONFIG_RTL8188F -+ bmain = PHY_QueryRFPathSwitch_8188F(padapter); -+#endif -+ } else if (IS_HARDWARE_TYPE_8188GTV(padapter)) { -+#ifdef CONFIG_RTL8188GTV -+ bmain = PHY_QueryRFPathSwitch_8188GTV(padapter); -+#endif -+ } else if (IS_HARDWARE_TYPE_8822B(padapter)) { -+#ifdef CONFIG_RTL8822B -+ bmain = PHY_QueryRFPathSwitch_8822B(padapter); -+#endif -+ } else if (IS_HARDWARE_TYPE_8723D(padapter)) { -+#ifdef CONFIG_RTL8723D -+ bmain = PHY_QueryRFPathSwitch_8723D(padapter); -+#endif -+ } else -+*/ -+ -+ if (IS_HARDWARE_TYPE_8821C(padapter)) { -+#ifdef CONFIG_RTL8821C -+ bmain = phy_query_rf_path_switch_8821c(padapter); -+#endif -+ } -+ -+ return bmain; -+} -+ -+static void PHY_SetRFPathSwitch(PADAPTER padapter , BOOLEAN bMain) { -+ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(padapter); -+ struct dm_struct *phydm = &hal->odmpriv; -+ -+ if (IS_HARDWARE_TYPE_8723B(padapter)) { -+#ifdef CONFIG_RTL8723B -+ phy_set_rf_path_switch_8723b(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8188E(padapter)) { -+#ifdef CONFIG_RTL8188E -+ phy_set_rf_path_switch_8188e(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8814A(padapter)) { -+#ifdef CONFIG_RTL8814A -+ phy_set_rf_path_switch_8814a(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8812(padapter) || IS_HARDWARE_TYPE_8821(padapter)) { -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ phy_set_rf_path_switch_8812a(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8192E(padapter)) { -+#ifdef CONFIG_RTL8192E -+ phy_set_rf_path_switch_8192e(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8703B(padapter)) { -+#ifdef CONFIG_RTL8703B -+ phy_set_rf_path_switch_8703b(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8188F(padapter) || IS_HARDWARE_TYPE_8188GTV(padapter)) { -+#if defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) -+ phy_set_rf_path_switch_8188f(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8192F(padapter)) { -+#ifdef CONFIG_RTL8192F -+ phy_set_rf_path_switch_8192f(padapter, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8822B(padapter)) { -+#ifdef CONFIG_RTL8822B -+ phy_set_rf_path_switch_8822b(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8723D(padapter)) { -+#ifdef CONFIG_RTL8723D -+ phy_set_rf_path_switch_8723d(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8821C(padapter)) { -+#ifdef CONFIG_RTL8821C -+ phy_set_rf_path_switch_8821c(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8822C(padapter)) { -+#ifdef CONFIG_RTL8822C -+ phy_set_rf_path_switch_8822c(phydm, bMain); -+#endif -+ } else if (IS_HARDWARE_TYPE_8814B(padapter)) { -+#ifdef CONFIG_RTL8814B -+ /* phy_set_rf_path_switch_8814b(phydm, bMain); */ -+#endif -+ } else if (IS_HARDWARE_TYPE_8723F(padapter)) { -+#ifdef CONFIG_RTL8723F -+ phy_set_rf_path_switch_8723f(phydm, bMain); -+#endif -+ } -+} -+ -+ -+static void phy_switch_rf_path_set(PADAPTER padapter , u8 *prf_set_State) { -+#ifdef CONFIG_RTL8821C -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_struct *p_dm = &pHalData->odmpriv; -+ -+ if (IS_HARDWARE_TYPE_8821C(padapter)) { -+ config_phydm_set_ant_path(p_dm, *prf_set_State, p_dm->current_ant_num_8821c); -+ /* Do IQK when switching to BTG/WLG, requested by RF Binson */ -+ if (*prf_set_State == SWITCH_TO_BTG || *prf_set_State == SWITCH_TO_WLG) -+ PHY_IQCalibrate(padapter, FALSE); -+ } -+#endif -+ -+} -+ -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+u8 rtw_mp_set_antdiv(PADAPTER padapter, BOOLEAN bMain) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 cur_ant, change_ant; -+ -+ if (!pHalData->AntDivCfg) -+ return _FALSE; -+ /*rtw_hal_get_odm_var(padapter, HAL_ODM_ANTDIV_SELECT, &cur_ant, NULL);*/ -+ change_ant = (bMain == MAIN_ANT) ? MAIN_ANT : AUX_ANT; -+ -+ RTW_INFO("%s: config %s\n", __func__, (bMain == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ rtw_antenna_select_cmd(padapter, change_ant, _FALSE); -+ -+ return _TRUE; -+} -+#endif -+ -+s32 -+MPT_InitializeAdapter( -+ PADAPTER pAdapter, -+ u8 Channel -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ s32 rtStatus = _SUCCESS; -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.mpt_ctx; -+ u32 ledsetting; -+ -+ 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); -+ rtw_init_timer(&pMptCtx->MPh2c_timeout_timer, pAdapter, 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_set_bb_reg(pAdapter, 0xA00, BIT8, 0x0); -+ PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); /*default use Main*/ -+ -+ if (pHalData->PackageType == PACKAGE_DEFAULT) -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); -+ else -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6F10E); -+ -+ } -+ /*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->mpt_rf_path = 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_check_txpowertracking(&pHalData->odmpriv); */ /* trigger thermal meter */ -+ -+ PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); /* default use Main */ -+ -+ pMptCtx->backup0xc50 = (u8)phy_query_bb_reg(pAdapter, rOFDM0_XAAGCCore1, bMaskByte0); -+ pMptCtx->backup0xc58 = (u8)phy_query_bb_reg(pAdapter, rOFDM0_XBAGCCore1, bMaskByte0); -+ pMptCtx->backup0xc30 = (u8)phy_query_bb_reg(pAdapter, rOFDM0_RxDetector1, bMaskByte0); -+ pMptCtx->backup0x52_RF_A = (u8)phy_query_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); -+ pMptCtx->backup0x52_RF_B = (u8)phy_query_rf_reg(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] = (u8)phy_query_bb_reg(pAdapter, rA_IGI_Jaguar, bMaskByte0); -+ pHalData->BackUp_IG_REG_4_Chnl_Section[1] = (u8)phy_query_bb_reg(pAdapter, rB_IGI_Jaguar, bMaskByte0); -+ pHalData->BackUp_IG_REG_4_Chnl_Section[2] = (u8)phy_query_bb_reg(pAdapter, rC_IGI_Jaguar2, bMaskByte0); -+ pHalData->BackUp_IG_REG_4_Chnl_Section[3] = (u8)phy_query_bb_reg(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( -+ PADAPTER pAdapter -+) -+{ -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.mpt_ctx; -+ -+ 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_set_bb_reg(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.mpt_ctx; -+ -+ pMptCtx->bMassProdTest = _TRUE; -+ pMptCtx->is_start_cont_tx = _FALSE; -+ pMptCtx->bCckContTx = _FALSE; -+ pMptCtx->bOfdmContTx = _FALSE; -+ pMptCtx->bSingleCarrier = _FALSE; -+ pMptCtx->is_carrier_suppression = _FALSE; -+ pMptCtx->is_single_tone = _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); -+} -+ -+void rtw_mp_trigger_dpk(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ -+ halrf_dpk_trigger(pDM_Odm); -+} -+ -+static void init_mp_data(PADAPTER padapter) -+{ -+ u8 v8; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ -+ /*disable BCN*/ -+#ifdef CONFIG_PROTSEL_PORT -+ rtw_hal_hw_port_disable(padapter); -+#else -+ v8 = rtw_read8(padapter, REG_BCN_CTRL); -+ v8 &= ~EN_BCN_FUNCTION; -+ rtw_write8(padapter, REG_BCN_CTRL, v8); -+#endif -+ -+ pDM_Odm->rf_calibrate_info.txpowertrack_control = _FALSE; -+} -+ -+ -+void MPT_PwrCtlDM(PADAPTER padapter, u32 trk_type) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ u32 rf_ability; -+ -+ padapter->mppriv.tssitrk_on = trk_type == 3; -+ -+ if (trk_type == 0) { /* thermal PwrTrk off*/ -+ struct txpwrtrack_cfg c; -+ u8 chnl = 0 ; -+ -+ RTW_INFO("in Thermal tracking off\n"); -+ rf_ability = ((u32)halrf_cmn_info_get(pDM_Odm, HALRF_CMNINFO_ABILITY)) & ~HAL_RF_TX_PWR_TRACK; -+ halrf_cmn_info_set(pDM_Odm, HALRF_CMNINFO_ABILITY, rf_ability); -+ halrf_cmn_info_set(pDM_Odm, HALRF_CMNINFO_POWER_TRACK_CONTROL, trk_type); -+ halrf_set_pwr_track(pDM_Odm, FALSE); -+ pDM_Odm->rf_calibrate_info.txpowertrack_control = trk_type; -+ if (IS_HARDWARE_TYPE_8822C(padapter)) -+ padapter->mppriv.mp_dm = 1; /* default enable dpk tracking */ -+ else -+ padapter->mppriv.mp_dm = 0; -+ -+ _rtw_memset(&c, 0, sizeof(struct txpwrtrack_cfg)); -+ configure_txpower_track(pDM_Odm, &c); -+ odm_clear_txpowertracking_state(pDM_Odm); -+ if (*c.odm_tx_pwr_track_set_pwr) { -+ if (pDM_Odm->support_ic_type == ODM_RTL8188F) -+ (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, MIX_MODE, RF_PATH_A, chnl); -+ else if (pDM_Odm->support_ic_type == ODM_RTL8723D) { -+ (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, BBSWING, RF_PATH_A, chnl); -+ SetTxPower(padapter); -+ } else if (pDM_Odm->support_ic_type == ODM_RTL8192F) { -+ (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, MIX_MODE, RF_PATH_A, chnl); -+ (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, MIX_MODE, RF_PATH_B, chnl); -+ } else { -+ (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, BBSWING, RF_PATH_A, chnl); -+ (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, BBSWING, RF_PATH_B, chnl); -+ } -+ } -+ return ; -+ } -+ -+ rf_ability = ((u32)halrf_cmn_info_get(pDM_Odm, HALRF_CMNINFO_ABILITY)) | HAL_RF_TX_PWR_TRACK; -+ halrf_cmn_info_set(pDM_Odm, HALRF_CMNINFO_ABILITY, rf_ability); -+ halrf_cmn_info_set(pDM_Odm, HALRF_CMNINFO_POWER_TRACK_CONTROL, trk_type); -+ if (trk_type == 1 || trk_type == 3) /* Thermal PwrTrk ON , TSSI PwrTrk ON */ -+ halrf_set_pwr_track(pDM_Odm, TRUE); -+ else -+ halrf_set_pwr_track(pDM_Odm, false);/* TSSI K */ -+ pDM_Odm->rf_calibrate_info.txpowertrack_control = trk_type; -+ padapter->mppriv.mp_dm = 1; -+ -+} -+ -+ -+u32 mp_join(PADAPTER padapter, u8 mode) -+{ -+ WLAN_BSSID_EX bssid; -+ struct sta_info *psta; -+ u32 length; -+ _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)); -+ -+ /* 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.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.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, WIFI_ASOC_STATE) == _TRUE) { -+ rtw_disassoc_cmd(padapter, 500, 0); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); -+ } -+ pmppriv->prev_fw_state = get_fwstate(pmlmepriv); -+ /*pmlmepriv->fw_state = WIFI_MP_STATE;*/ -+ init_fwstate(pmlmepriv, WIFI_MP_STATE); -+ -+ set_fwstate(pmlmepriv, WIFI_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->cmn.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, WIFI_UNDER_LINKING); -+ set_fwstate(pmlmepriv, WIFI_ASOC_STATE); -+ -+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); -+ rtw_hal_rcr_set_chk_bssid(padapter, MLME_ADHOC_STARTED); -+ 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; -+#ifdef CONFIG_PCI_HCI -+ PHAL_DATA_TYPE hal; -+#endif -+ s32 res = _SUCCESS; -+ -+ padapter->registrypriv.mp_mode = 1; -+ -+ init_mp_data(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 -+#ifdef CONFIG_RTL8188GTV -+ rtl8188gtv_InitHalDm(padapter); -+#endif -+#ifdef CONFIG_RTL8188E -+ rtl8188e_InitHalDm(padapter); -+#endif -+#ifdef CONFIG_RTL8723D -+ rtl8723d_InitHalDm(padapter); -+#endif /* CONFIG_RTL8723D */ -+ -+#ifdef CONFIG_PCI_HCI -+ hal = GET_HAL_DATA(padapter); -+ hal->pci_backdoor_ctrl = 0; -+ rtw_pci_aspm_config(padapter); -+#endif -+ -+ -+ /* 3 0. update mp_priv */ -+ switch (GET_HAL_RFPATH(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: -+ 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 mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ struct sta_info *psta; -+#ifdef CONFIG_PCI_HCI -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ PHAL_DATA_TYPE hal; -+#endif -+ -+ _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, _TRUE); */ -+ 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); -+ -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+end_of_mp_stop_test: -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+#ifdef CONFIG_PCI_HCI -+ hal = GET_HAL_DATA(padapter); -+ hal->pci_backdoor_ctrl = registry_par->pci_aspm_config; -+ rtw_pci_aspm_config(padapter); -+#endif -+ -+#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_RTL8188GTV -+ rtl8188gtv_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; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(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 < hal_spec->rf_reg_path_num; 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: 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. -+ * -+ *---------------------------------------------------------------------------*/ -+#if 0 -+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); -+} -+#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 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); -+ -+} -+ -+void mp_phy_switch_rf_path_set(PADAPTER pAdapter , u8 *pstate) -+{ -+ -+ phy_switch_rf_path_set(pAdapter, pstate); -+ -+} -+ -+u8 MP_PHY_QueryRFPathSwitch(PADAPTER pAdapter) -+{ -+ return PHY_QueryRFPathSwitch(pAdapter); -+} -+ -+s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther) -+{ -+ return hal_mpt_SetThermalMeter(pAdapter, target_ther); -+} -+ -+#if 0 -+static void TriggerRFThermalMeter(PADAPTER pAdapter) -+{ -+ hal_mpt_TriggerRFThermalMeter(pAdapter); -+} -+ -+static u8 ReadRFThermalMeter(PADAPTER pAdapter) -+{ -+ return hal_mpt_ReadRFThermalMeter(pAdapter); -+} -+#endif -+ -+void GetThermalMeter(PADAPTER pAdapter, u8 rfpath ,u8 *value) -+{ -+ hal_mpt_GetThermalMeter(pAdapter, rfpath, 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 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, 0); -+ 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; -+ -+} -+ -+#ifdef CONFIG_PCI_HCI -+static u8 check_nic_enough_desc(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ u32 prio; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct rtw_tx_ring *ring; -+ -+ 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; -+ } -+ -+ 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) >= 2) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+#endif -+ -+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); -+#ifdef CONFIG_PCI_HCI -+ if(check_nic_enough_desc(padapter, &pmptx->attrib) == _FALSE) { -+ rtw_usleep_os(1000); -+ continue; -+ } -+#endif -+ 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 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_RTL8188GTV) -+void fill_tx_desc_8188gtv(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_8188GTV(ptxdesc, 1); -+ SET_TX_DESC_MACID_8188GTV(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8188GTV(ptxdesc, pattrib->qsel); -+ -+ SET_TX_DESC_RATE_ID_8188GTV(ptxdesc, pattrib->raid); -+ SET_TX_DESC_SEQ_8188GTV(ptxdesc, pattrib->seqnum); -+ SET_TX_DESC_HWSEQ_EN_8188GTV(ptxdesc, 1); -+ SET_TX_DESC_USE_RATE_8188GTV(ptxdesc, 1); -+ SET_TX_DESC_DISABLE_FB_8188GTV(ptxdesc, 1); -+ -+ if (pmp_priv->preamble) -+ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) -+ SET_TX_DESC_DATA_SHORT_8188GTV(ptxdesc, 1); -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ SET_TX_DESC_DATA_BW_8188GTV(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8188GTV(ptxdesc, pmp_priv->rateidx); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8188GTV(ptxdesc, 0x1F); -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8188GTV(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 -+ -+#if defined(CONFIG_RTL8710B) -+void fill_tx_desc_8710b(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_8710B(ptxdesc, 1); -+ SET_TX_DESC_MACID_8710B(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8710B(ptxdesc, pattrib->qsel); -+ -+ SET_TX_DESC_RATE_ID_8710B(ptxdesc, pattrib->raid); -+ SET_TX_DESC_SEQ_8710B(ptxdesc, pattrib->seqnum); -+ SET_TX_DESC_HWSEQ_EN_8710B(ptxdesc, 1); -+ SET_TX_DESC_USE_RATE_8710B(ptxdesc, 1); -+ SET_TX_DESC_DISABLE_FB_8710B(ptxdesc, 1); -+ -+ if (pmp_priv->preamble) { -+ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) -+ SET_TX_DESC_DATA_SHORT_8710B(ptxdesc, 1); -+ } -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ SET_TX_DESC_DATA_BW_8710B(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8710B(ptxdesc, pmp_priv->rateidx); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8710B(ptxdesc, 0x1F); -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8710B(ptxdesc, 0xF); -+} -+#endif -+ -+#if defined(CONFIG_RTL8192F) -+void fill_tx_desc_8192f(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_8192F(ptxdesc, 1); -+ SET_TX_DESC_MACID_8192F(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8192F(ptxdesc, pattrib->qsel); -+ -+ SET_TX_DESC_RATE_ID_8192F(ptxdesc, pattrib->raid); -+ SET_TX_DESC_SEQ_8192F(ptxdesc, pattrib->seqnum); -+ SET_TX_DESC_HWSEQ_EN_8192F(ptxdesc, 1); -+ SET_TX_DESC_USE_RATE_8192F(ptxdesc, 1); -+ SET_TX_DESC_DISABLE_FB_8192F(ptxdesc, 1); -+ -+ if (pmp_priv->preamble) { -+ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) -+ SET_TX_DESC_DATA_SHORT_8192F(ptxdesc, 1); -+ } -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ SET_TX_DESC_DATA_BW_8192F(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8192F(ptxdesc, pmp_priv->rateidx); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8192F(ptxdesc, 0x1F); -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8192F(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_set_mac_reg(padapter, 0x458 , bMaskDWord , 0x0); -+ /*RTW_INFO("%s()!!!!! 0x460 = 0x%x\n" ,__func__, phy_query_bb_reg(padapter, 0x460, bMaskDWord));*/ -+ phy_set_mac_reg(padapter, 0x460 , bMaskLWord , 0x0); /* fast EDCA queue packet interval & time out value*/ -+ /*phy_set_mac_reg(padapter, ODM_EDCA_VO_PARAM ,bMaskLWord , 0x431C);*/ -+ /*phy_set_mac_reg(padapter, ODM_EDCA_BE_PARAM ,bMaskLWord , 0x431C);*/ -+ /*phy_set_mac_reg(padapter, ODM_EDCA_BK_PARAM ,bMaskLWord , 0x431C);*/ -+ RTW_INFO("%s()!!!!! 0x460 = 0x%x\n" , __func__, phy_query_bb_reg(padapter, 0x460, bMaskDWord)); -+ -+} -+ -+void SetPacketTx(PADAPTER padapter) -+{ -+ u8 *ptr, *pkt_start, *pkt_end; -+ u32 pkt_size = 0, i = 0, idx = 0, tmp_idx = 0; -+ 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->psta = rtw_get_bcmc_stainfo(padapter); -+ else -+ pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ -+ if (pattrib->psta == NULL) { -+ RTW_INFO("%s:psta = NULL !!\n", __func__); -+ return; -+ } -+ -+ pattrib->mac_id = pattrib->psta->cmn.mac_id; -+ 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_RTL8822C) -+ if (IS_HARDWARE_TYPE_8822C(padapter)) -+ rtl8822c_prepare_mp_txdesc(padapter, pmp_priv); -+#endif /* CONFIG_RTL8822C */ -+ -+#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_RTL8188GTV) -+ if (IS_HARDWARE_TYPE_8188GTV(padapter)) -+ fill_tx_desc_8188gtv(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8723D) -+ if (IS_HARDWARE_TYPE_8723D(padapter)) -+ fill_tx_desc_8723d(padapter); -+#endif -+#if defined(CONFIG_RTL8192F) -+ if (IS_HARDWARE_TYPE_8192F(padapter)) -+ fill_tx_desc_8192f(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8710B) -+ if (IS_HARDWARE_TYPE_8710B(padapter)) -+ fill_tx_desc_8710b(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8814B) -+ if (IS_HARDWARE_TYPE_8814B(padapter)) -+ rtl8814b_prepare_mp_txdesc(padapter, pmp_priv); -+#endif /* CONFIG_RTL8814B */ -+ -+#if defined(CONFIG_RTL8723F) -+ if (IS_HARDWARE_TYPE_8723F(padapter)) -+ rtl8723f_prepare_mp_txdesc(padapter, pmp_priv); -+#endif /* CONFIG_RTL8723F */ -+ -+ /* 3 4. make wlan header, make_wlanhdr() */ -+ hdr = (struct rtw_ieee80211_hdr *)pkt_start; -+ set_frame_sub_type(&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; -+ -+ if (pmp_priv->mplink_btx == _TRUE) { -+ _rtw_memcpy(ptr, pmp_priv->mplink_buf, pkt_end - ptr); -+ } else { -+ switch (pmp_priv->tx.payload) { -+ case MP_TX_Payload_00: -+ RTW_INFO("MP packet tx 0x00 payload!\n"); -+ payload = 0x00; -+ _rtw_memset(ptr, 0x00, pkt_end - ptr); -+ break; -+ case MP_TX_Payload_5a: -+ RTW_INFO("MP packet tx 0x5a payload!\n"); -+ payload = 0x5a; -+ _rtw_memset(ptr, 0x5a, pkt_end - ptr); -+ break; -+ case MP_TX_Payload_a5: -+ RTW_INFO("MP packet tx 0xa5 payload!\n"); -+ payload = 0xa5; -+ _rtw_memset(ptr, 0xa5, pkt_end - ptr); -+ break; -+ case MP_TX_Payload_ff: -+ RTW_INFO("MP packet tx 0xff payload!\n"); -+ payload = 0xff; -+ _rtw_memset(ptr, 0xff, pkt_end - ptr); -+ break; -+ case MP_TX_Payload_prbs9: -+ RTW_INFO("MP packet tx PRBS9 payload!\n"); -+ while (idx <= pkt_end - ptr) { -+ int start = 0x02; -+ int a = start; -+ -+ for (i = 0;; i++) { -+ int newbit = (((a >> 8) ^ (a >> 4)) & 1); -+ a = ((a << 1) | newbit) & 0x1ff; -+ RTW_DBG("%x ", a); -+ ptr[idx + i] = a; -+ -+ if (a == start) { -+ RTW_INFO("payload repetition period is %d , end %d\n", i , idx); -+ tmp_idx += i; -+ break; -+ } -+ if (idx + i >= (pkt_end - ptr)) { -+ tmp_idx += (idx + i); -+ RTW_INFO(" repetition period payload end curr ptr %d\n", idx + i); -+ break; -+ } -+ } -+ idx = tmp_idx; -+ } -+ break; -+ case MP_TX_Payload_default_random: -+ RTW_INFO("MP packet tx default random payload!\n"); -+ for (i = 0; i < pkt_end - ptr; i++) -+ ptr[i] = rtw_random32() % 0xFF; -+ break; -+ default: -+ RTW_INFO("Config payload type default use 0x%x\n!", pmp_priv->tx.payload); -+ _rtw_memset(ptr, pmp_priv->tx.payload, pkt_end - ptr); -+ break; -+ } -+ } -+ /* 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_ERR("Create PktTx Thread Fail !!!!!\n"); -+ pmp_priv->tx.PktTxThread = NULL; -+ } -+#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); -+ 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_set_mac_reg(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; -+ pHalData->ReceiveConfig |= RCR_APP_PHYST_RXFF; -+ -+#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) -+/* todo: 8723F */ -+ write_bbreg(pAdapter, 0x550, BIT3, bEnable); -+#endif -+ rtw_write16(pAdapter, REG_RXFLTMAP0, 0xFFEF); /* REG_RXFLTMAP0 (RX Filter Map Group 0) */ -+ pmppriv->brx_filter_beacon = _TRUE; -+ -+ } 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_set_mac_reg(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; -+} -+ -+struct psd_init_regs { -+ /* 3 wire */ -+ int reg_88c; -+ int reg_c00; -+ int reg_e00; -+ int reg_1800; -+ int reg_1a00; -+ /* cck */ -+ int reg_800; -+ int reg_808; -+}; -+ -+static int rtw_mp_psd_init(PADAPTER padapter, struct psd_init_regs *regs) -+{ -+ HAL_DATA_TYPE *phal_data = GET_HAL_DATA(padapter); -+ -+ switch (phal_data->rf_type) { -+ /* 1R */ -+ case RF_1T1R: -+ if (hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) { -+ /* 11AC 1R PSD Setting 3wire & cck off */ -+ regs->reg_c00 = rtw_read32(padapter, 0xC00); -+ phy_set_bb_reg(padapter, 0xC00, 0x3, 0x00); -+ regs->reg_808 = rtw_read32(padapter, 0x808); -+ phy_set_bb_reg(padapter, 0x808, 0x10000000, 0x0); -+ } else { -+ /* 11N 3-wire off 1 */ -+ regs->reg_88c = rtw_read32(padapter, 0x88C); -+ phy_set_bb_reg(padapter, 0x88C, 0x300000, 0x3); -+ /* 11N CCK off */ -+ regs->reg_800 = rtw_read32(padapter, 0x800); -+ phy_set_bb_reg(padapter, 0x800, 0x1000000, 0x0); -+ } -+ break; -+ -+ /* 2R */ -+ case RF_1T2R: -+ case RF_2T2R: -+ if (hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) { -+ /* 11AC 2R PSD Setting 3wire & cck off */ -+ regs->reg_c00 = rtw_read32(padapter, 0xC00); -+ regs->reg_e00 = rtw_read32(padapter, 0xE00); -+ phy_set_bb_reg(padapter, 0xC00, 0x3, 0x00); -+ phy_set_bb_reg(padapter, 0xE00, 0x3, 0x00); -+ regs->reg_808 = rtw_read32(padapter, 0x808); -+ phy_set_bb_reg(padapter, 0x808, 0x10000000, 0x0); -+ } else { -+ /* 11N 3-wire off 2 */ -+ regs->reg_88c = rtw_read32(padapter, 0x88C); -+ phy_set_bb_reg(padapter, 0x88C, 0xF00000, 0xF); -+ /* 11N CCK off */ -+ regs->reg_800 = rtw_read32(padapter, 0x800); -+ phy_set_bb_reg(padapter, 0x800, 0x1000000, 0x0); -+ } -+ break; -+ -+ /* 3R */ -+ case RF_2T3R: -+ case RF_3T3R: -+ if (hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) { -+ /* 11AC 3R PSD Setting 3wire & cck off */ -+ regs->reg_c00 = rtw_read32(padapter, 0xC00); -+ regs->reg_e00 = rtw_read32(padapter, 0xE00); -+ regs->reg_1800 = rtw_read32(padapter, 0x1800); -+ phy_set_bb_reg(padapter, 0xC00, 0x3, 0x00); -+ phy_set_bb_reg(padapter, 0xE00, 0x3, 0x00); -+ phy_set_bb_reg(padapter, 0x1800, 0x3, 0x00); -+ regs->reg_808 = rtw_read32(padapter, 0x808); -+ phy_set_bb_reg(padapter, 0x808, 0x10000000, 0x0); -+ } else { -+ RTW_ERR("%s: 11n don't support 3R\n", __func__); -+ return -1; -+ } -+ break; -+ -+ /* 4R */ -+ case RF_2T4R: -+ case RF_3T4R: -+ case RF_4T4R: -+ if (hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) { -+ /* 11AC 4R PSD Setting 3wire & cck off */ -+ regs->reg_c00 = rtw_read32(padapter, 0xC00); -+ regs->reg_e00 = rtw_read32(padapter, 0xE00); -+ regs->reg_1800 = rtw_read32(padapter, 0x1800); -+ regs->reg_1a00 = rtw_read32(padapter, 0x1A00); -+ phy_set_bb_reg(padapter, 0xC00, 0x3, 0x00); -+ phy_set_bb_reg(padapter, 0xE00, 0x3, 0x00); -+ phy_set_bb_reg(padapter, 0x1800, 0x3, 0x00); -+ phy_set_bb_reg(padapter, 0x1A00, 0x3, 0x00); -+ regs->reg_808 = rtw_read32(padapter, 0x808); -+ phy_set_bb_reg(padapter, 0x808, 0x10000000, 0x0); -+ } else { -+ RTW_ERR("%s: 11n don't support 4R\n", __func__); -+ return -1; -+ } -+ break; -+ -+ default: -+ RTW_ERR("%s: unknown %d rf type\n", __func__, phal_data->rf_type); -+ return -1; -+ } -+ -+ /* Set PSD points, 0=128, 1=256, 2=512, 3=1024 */ -+ if (hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) -+ phy_set_bb_reg(padapter, 0x910, 0xC000, 3); -+ else -+ phy_set_bb_reg(padapter, 0x808, 0xC000, 3); -+ -+ RTW_INFO("%s: set %d rf type done\n", __func__, phal_data->rf_type); -+ return 0; -+} -+ -+static int rtw_mp_psd_close(PADAPTER padapter, struct psd_init_regs *regs) -+{ -+ HAL_DATA_TYPE *phal_data = GET_HAL_DATA(padapter); -+ -+ -+ if (!hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) { -+ /* 11n 3wire restore */ -+ rtw_write32(padapter, 0x88C, regs->reg_88c); -+ /* 11n cck restore */ -+ rtw_write32(padapter, 0x800, regs->reg_800); -+ RTW_INFO("%s: restore %d rf type\n", __func__, phal_data->rf_type); -+ return 0; -+ } -+ -+ /* 11ac 3wire restore */ -+ switch (phal_data->rf_type) { -+ case RF_1T1R: -+ rtw_write32(padapter, 0xC00, regs->reg_c00); -+ break; -+ case RF_1T2R: -+ case RF_2T2R: -+ rtw_write32(padapter, 0xC00, regs->reg_c00); -+ rtw_write32(padapter, 0xE00, regs->reg_e00); -+ break; -+ case RF_2T3R: -+ case RF_3T3R: -+ rtw_write32(padapter, 0xC00, regs->reg_c00); -+ rtw_write32(padapter, 0xE00, regs->reg_e00); -+ rtw_write32(padapter, 0x1800, regs->reg_1800); -+ break; -+ case RF_2T4R: -+ case RF_3T4R: -+ case RF_4T4R: -+ rtw_write32(padapter, 0xC00, regs->reg_c00); -+ rtw_write32(padapter, 0xE00, regs->reg_e00); -+ rtw_write32(padapter, 0x1800, regs->reg_1800); -+ rtw_write32(padapter, 0x1A00, regs->reg_1a00); -+ break; -+ default: -+ RTW_WARN("%s: unknown %d rf type\n", __func__, phal_data->rf_type); -+ break; -+ } -+ -+ /* 11ac cck restore */ -+ rtw_write32(padapter, 0x808, regs->reg_808); -+ RTW_INFO("%s: restore %d rf type done\n", __func__, phal_data->rf_type); -+ return 0; -+} -+ -+/* 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); -+#if defined(CONFIG_RTL8821C) -+ psd_val = (psd_val & 0x00FFFFFF) / 32; -+#else -+ psd_val &= 0x0000FFFF; -+#endif -+ -+ 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) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct dm_struct *p_dm = adapter_to_phydm(pAdapter); -+ -+ u32 i, psd_pts = 0, psd_start = 0, psd_stop = 0; -+ u32 psd_data = 0; -+ struct psd_init_regs regs = {}; -+ int psd_analysis = 0; -+ char *pdata = NULL; -+ -+ -+#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 if (strncmp(data, "analysis,", 9) == 0) { -+ if (rtw_mp_psd_init(pAdapter, ®s) != 0) -+ return 0; -+ psd_analysis = 1; -+ sscanf(data + 9, "pts=%d,start=%d,stop=%d", &psd_pts, &psd_start, &psd_stop); -+ } else -+ sscanf(data, "pts=%d,start=%d,stop=%d", &psd_pts, &psd_start, &psd_stop); -+ -+ data[0] = '\0'; -+ pdata = data; -+ -+ if (psd_stop > 1920 || psd_stop < 1) { -+ rtw_warn_on(1); -+ psd_stop = 1920; -+ } -+ -+ if (IS_HARDWARE_TYPE_8822C(pAdapter) || IS_HARDWARE_TYPE_8723F(pAdapter)) { -+ u32 *psdbuf = rtw_zmalloc(sizeof(u32)*256); -+ -+ if (psdbuf == NULL) { -+ RTW_INFO("%s: psd buf malloc fail!!\n", __func__); -+ return 0; -+ } -+ -+ halrf_cmn_info_set(p_dm, HALRF_CMNINFO_MP_PSD_POINT, psd_pts); -+ halrf_cmn_info_set(p_dm, HALRF_CMNINFO_MP_PSD_START_POINT, psd_start); -+ halrf_cmn_info_set(p_dm, HALRF_CMNINFO_MP_PSD_STOP_POINT, psd_stop); -+ halrf_cmn_info_set(p_dm, HALRF_CMNINFO_MP_PSD_AVERAGE, 0x20000); -+ -+ halrf_psd_init(p_dm); -+#ifdef CONFIG_LONG_DELAY_ISSUE -+ rtw_msleep_os(100); -+#else -+ rtw_mdelay_os(10); -+#endif -+ halrf_psd_query(p_dm, psdbuf, 256); -+ -+ i = 0; -+ while (i < 256) { -+ pdata += sprintf(pdata, "%x ", (psdbuf[i])); -+ i++; -+ } -+ -+ if (psdbuf) -+ rtw_mfree(psdbuf, sizeof(u32)*256); -+ -+ } else { -+ 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); -+ -+ pdata += sprintf(pdata, "%x ", psd_data); -+ i++; -+ } -+ -+ } -+ -+#ifdef CONFIG_LONG_DELAY_ISSUE -+ rtw_msleep_os(100); -+#else -+ rtw_mdelay_os(100); -+#endif -+ -+ if (psd_analysis) -+ rtw_mp_psd_close(pAdapter, ®s); -+ -+ 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 -+mpt_to_mgnt_rate( -+ u32 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("<===mpt_to_mgnt_rate(), 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("hw_rate_to_m_rate(): 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; -+} -+ -+u8 rtw_mp_mode_check(PADAPTER pAdapter) -+{ -+ PADAPTER primary_adapter = GET_PRIMARY_ADAPTER(pAdapter); -+ -+ if (primary_adapter->registrypriv.mp_mode == 1 || primary_adapter->mppriv.bprocess_mp_mode == _TRUE) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+bool rtw_is_mp_tssitrk_on(_adapter *adapter) -+{ -+ _adapter *primary_adapter = GET_PRIMARY_ADAPTER(adapter); -+ -+ return primary_adapter->mppriv.tssitrk_on; -+} -+ -+u32 mpt_ProQueryCalTxPower( -+ PADAPTER pAdapter, -+ u8 RfPath -+) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ -+ u32 TxPower = 1; -+ struct txpwr_idx_comp tic; -+ u8 mgn_rate = mpt_to_mgnt_rate(pMptCtx->mpt_rate_index); -+ RATE_SECTION rs = mgn_rate_to_rs(mgn_rate); -+ -+ TxPower = rtw_hal_get_tx_power_index(pAdapter, RfPath, rs, mgn_rate -+ , pHalData->current_channel_bw, pHalData->current_band_type, pHalData->current_channel, 0, &tic); -+ -+ dump_tx_power_index_inline(RTW_DBGDUMP, pAdapter, RfPath -+ , pHalData->current_channel_bw, pHalData->current_channel -+ , mgn_rate, TxPower, &tic); -+ -+ pAdapter->mppriv.txpoweridx = (u8)TxPower; -+ if (RfPath == RF_PATH_A) -+ pMptCtx->TxPwrLevel[RF_PATH_A] = (u8)TxPower; -+ else if (RfPath == RF_PATH_B) -+ pMptCtx->TxPwrLevel[RF_PATH_B] = (u8)TxPower; -+ else if (RfPath == RF_PATH_C) -+ pMptCtx->TxPwrLevel[RF_PATH_C] = (u8)TxPower; -+ else if (RfPath == RF_PATH_D) -+ pMptCtx->TxPwrLevel[RF_PATH_D] = (u8)TxPower; -+ hal_mpt_SetTxPower(pAdapter); -+ -+ return TxPower; -+} -+ -+u32 mpt_get_tx_power_finalabs_val(PADAPTER padapter, u8 rf_path) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); -+ -+ u8 mgn_rate = mpt_to_mgnt_rate(pMptCtx->mpt_rate_index); -+ u32 powerdbm = 0; -+ -+ powerdbm = phy_get_tx_power_final_absolute_value(padapter, rf_path, mgn_rate, pHalData->current_channel_bw, pHalData->current_channel); -+ -+ RTW_INFO("bw=%d, ch=%d, rateid=%d, TSSI Power(dBm):%d\n", -+ pHalData->current_channel_bw, pHalData->current_channel, mgn_rate ,powerdbm); -+ -+ return powerdbm; -+} -+ -+#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( -+ u8 *out, -+ bool *in, -+ u8 in_size) -+{ -+ u8 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, -+ u8 in_size -+) -+{ -+ u8 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; -+ u8 i; -+ u32 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 = (u32)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) -+{ -+ -+ u8 TX_RATE_HEX = 0, MCS = 0; -+ u8 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; -+} -+ -+ -+u32 LDPC_parameter_generator( -+ u32 N_pld_int, -+ u32 N_CBPSS, -+ u32 N_SS, -+ u32 R, -+ u32 m_STBC, -+ u32 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.; -+ u32 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) -+{ -+ u32 SIGA2B3 = 0; -+ u8 TX_RATE = pPMacTxInfo->TX_RATE; -+ -+ u32 R, R_list[10] = {0, 0, 2, 0, 2, 1, 2, 3, 2, 3}; -+ double CR = 0; -+ u32 N_SD, N_BPSC_list[10] = {1, 2, 2, 4, 4, 6, 6, 6, 8, 8}; -+ u32 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)) { -+ u8 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 = (u32)((double)N_CBPS * CR); -+ -+ if (pPMacTxInfo->bLDPC == FALSE) { -+ N_ES = (u32)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 * (u32)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 * (u32)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 = (u32)((double)N_CBPS * CR); -+ if (pPMacTxInfo->bLDPC == FALSE) { -+ if (pPMacTxInfo->bSGI) -+ N_ES = (u32)ceil((double)(N_DBPS) / 3.6 / 600.); -+ else -+ N_ES = (u32)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 * (u32)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 * (u32)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( -+ u32 N_SYM, /* Max: 750*/ -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo) -+{ -+ u8 sig_bi[24] = {0}; /* 24 BIT*/ -+ u32 mode, LENGTH; -+ int i; -+ -+ if (MPT_IS_OFDM_RATE(pPMacTxInfo->TX_RATE)) { -+ mode = pPMacPktInfo->MCS; -+ LENGTH = pPMacTxInfo->PacketLength; -+ } else { -+ u8 N_LTF; -+ double T_data; -+ u32 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 = (u32)ceil((double)(8 + 4 + N_LTF * 4 + N_SYM * T_data + 4) / 4.); -+ else -+ OFDM_symbol = (u32)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, -+ u8 in_size -+) -+{ -+ u8 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 -+) -+{ -+ u32 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) -+{ -+ u32 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]; -+ u32 i, len, res, tail = 6, total_len, crc8_in_len; -+ u32 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}; -+ u32 crc8_in_len = 16; -+ u32 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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_odm.c b/drivers/net/wireless/rtl8821cs/core/rtw_odm.c -new file mode 100644 -index 000000000..cd2e5bbbc ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_odm.c -@@ -0,0 +1,630 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ struct dm_struct *podmpriv = &pHalData->odmpriv; -+ u32 result = 0; -+ -+ switch (ops) { -+ case HAL_PHYDM_DIS_ALL_FUNC: -+ podmpriv->support_ability = DYNAMIC_FUNC_DISABLE; -+ halrf_cmn_info_set(podmpriv, HALRF_CMNINFO_ABILITY, DYNAMIC_FUNC_DISABLE); -+ break; -+ case HAL_PHYDM_FUNC_SET: -+ podmpriv->support_ability |= ability; -+ break; -+ case HAL_PHYDM_FUNC_CLR: -+ podmpriv->support_ability &= ~(ability); -+ break; -+ case HAL_PHYDM_ABILITY_BK: -+ /* dm flag backup*/ -+ podmpriv->bk_support_ability = podmpriv->support_ability; -+ pHalData->bk_rf_ability = halrf_cmn_info_get(podmpriv, HALRF_CMNINFO_ABILITY); -+ break; -+ case HAL_PHYDM_ABILITY_RESTORE: -+ /* restore dm flag */ -+ podmpriv->support_ability = podmpriv->bk_support_ability; -+ halrf_cmn_info_set(podmpriv, HALRF_CMNINFO_ABILITY, pHalData->bk_rf_ability); -+ break; -+ case HAL_PHYDM_ABILITY_SET: -+ podmpriv->support_ability = ability; -+ break; -+ case HAL_PHYDM_ABILITY_GET: -+ result = podmpriv->support_ability; -+ break; -+ } -+ return result; -+} -+ -+/* set ODM_CMNINFO_IC_TYPE based on chip_type */ -+void rtw_odm_init_ic_type(_adapter *adapter) -+{ -+ struct dm_struct *odm = adapter_to_phydm(adapter); -+ u32 ic_type = chip_type_to_odm_ic_type(rtw_get_chip_type(adapter)); -+ -+ rtw_warn_on(!ic_type); -+ -+ odm_cmn_info_init(odm, ODM_CMNINFO_IC_TYPE, ic_type); -+} -+ -+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 -+#define RTW_ADAPTIVITY_EN_AUTO 2 -+ -+void rtw_odm_adaptivity_en_msg(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ -+ 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 if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_AUTO) -+ _RTW_PRINT_SEL(sel, "AUTO\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; -+ -+ if (regsty->adaptivity_en != RTW_ADAPTIVITY_EN_ENABLE) -+ return; -+ -+ 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"); -+} -+ -+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); -+} -+ -+bool rtw_odm_adaptivity_needed(_adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ bool ret = _FALSE; -+ -+ if (regsty->adaptivity_en) -+ ret = _TRUE; -+ -+ return ret; -+} -+ -+void rtw_odm_adaptivity_update(struct dvobj_priv *dvobj) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(dvobj_get_primary_adapter(dvobj)); -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ struct dm_struct *odm = dvobj_to_phydm(dvobj); -+ u8 edcca_mode = RTW_EDCCA_NORMAL; -+ -+ if (hal_data->current_band_type == BAND_ON_2_4G) -+ edcca_mode = rfctl->edcca_mode_2g; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ else if (hal_data->current_band_type == BAND_ON_5G) -+ edcca_mode = rfctl->edcca_mode_5g; -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ else if (hal_data->current_band_type == BAND_ON_6G) -+ edcca_mode = rfctl->edcca_mode_6g; -+ #endif -+ -+ rfctl->adaptivity_en = (edcca_mode == RTW_EDCCA_NORMAL || edcca_mode == RTW_EDCCA_MODE_NUM) ? 0 : 1; -+ phydm_adaptivity_info_init(odm, PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE, edcca_mode == RTW_EDCCA_CS ? TRUE : FALSE); -+} -+ -+void rtw_odm_adaptivity_parm_msg(void *sel, _adapter *adapter) -+{ -+ struct dm_struct *odm = adapter_to_phydm(adapter); -+ -+ rtw_odm_adaptivity_config_msg(sel, adapter); -+ -+ RTW_PRINT_SEL(sel, "%10s %16s\n" -+ , "th_l2h_ini", "th_edcca_hl_diff"); -+ RTW_PRINT_SEL(sel, "0x%-8x %-16d\n" -+ , (u8)odm->th_l2h_ini -+ , odm->th_edcca_hl_diff -+ ); -+} -+ -+void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 th_l2h_ini, s8 th_edcca_hl_diff) -+{ -+ struct dm_struct *odm = adapter_to_phydm(adapter); -+ -+ odm->th_l2h_ini = th_l2h_ini; -+ odm->th_edcca_hl_diff = th_edcca_hl_diff; -+} -+ -+void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter) -+{ -+ struct dm_struct *odm = adapter_to_phydm(adapter); -+ -+ RTW_PRINT_SEL(sel, "rx_rate = %s, rssi_a = %d(%%), rssi_b = %d(%%)\n", -+ HDATA_RATE(odm->rx_rate), odm->rssi_a, odm->rssi_b); -+} -+ -+ -+void rtw_odm_acquirespinlock(_adapter *adapter, enum 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); -+ break; -+ default: -+ break; -+ } -+} -+ -+void rtw_odm_releasespinlock(_adapter *adapter, enum 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); -+ break; -+ default: -+ break; -+ } -+} -+ -+s16 rtw_odm_get_tx_power_mbm(struct dm_struct *dm, u8 rfpath, u8 rate, u8 bw, u8 cch) -+{ -+ return phy_get_txpwr_single_mbm(dm->adapter, rfpath, mgn_rate_to_rs(rate), rate, bw, cch, 0, 0, 0, NULL); -+} -+ -+#ifdef CONFIG_DFS_MASTER -+inline void rtw_odm_radar_detect_reset(_adapter *adapter) -+{ -+ phydm_radar_detect_reset(adapter_to_phydm(adapter)); -+} -+ -+inline void rtw_odm_radar_detect_disable(_adapter *adapter) -+{ -+ phydm_radar_detect_disable(adapter_to_phydm(adapter)); -+} -+ -+/* called after ch, bw is set */ -+inline void rtw_odm_radar_detect_enable(_adapter *adapter) -+{ -+ phydm_radar_detect_enable(adapter_to_phydm(adapter)); -+} -+ -+inline BOOLEAN rtw_odm_radar_detect(_adapter *adapter) -+{ -+ return phydm_radar_detect(adapter_to_phydm(adapter)); -+} -+ -+static enum phydm_dfs_region_domain _rtw_dfs_regd_to_phydm[] = { -+ [RTW_DFS_REGD_NONE] = PHYDM_DFS_DOMAIN_UNKNOWN, -+ [RTW_DFS_REGD_FCC] = PHYDM_DFS_DOMAIN_FCC, -+ [RTW_DFS_REGD_MKK] = PHYDM_DFS_DOMAIN_MKK, -+ [RTW_DFS_REGD_ETSI] = PHYDM_DFS_DOMAIN_ETSI, -+}; -+ -+#define rtw_dfs_regd_to_phydm(region) (((region) >= RTW_DFS_REGD_NUM) ? _rtw_dfs_regd_to_phydm[RTW_DFS_REGD_NONE] : _rtw_dfs_regd_to_phydm[(region)]) -+ -+void rtw_odm_update_dfs_region(struct dvobj_priv *dvobj) -+{ -+ odm_cmn_info_init(dvobj_to_phydm(dvobj), ODM_CMNINFO_DFS_REGION_DOMAIN, rtw_dfs_regd_to_phydm(rtw_rfctl_get_dfs_domain(dvobj_to_rfctl(dvobj)))); -+} -+ -+inline u8 rtw_odm_radar_detect_polling_int_ms(struct dvobj_priv *dvobj) -+{ -+ return phydm_dfs_polling_time(dvobj_to_phydm(dvobj)); -+} -+#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 dm_struct *phydm = adapter_to_phydm(adapter); -+ struct rx_pkt_attrib *attrib = &rframe->u.hdr.attrib; -+ u8 *wlanhdr = get_recvframe_data(rframe); -+ -+ if (phydm->support_ic_type & PHYSTS_2ND_TYPE_IC) { -+ /* -+ * 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_sts_rpt_jgr2_type0 *phys_t0 = (struct phy_sts_rpt_jgr2_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_sts_rpt_jgr2_type1 *phys_t1 = (struct phy_sts_rpt_jgr2_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 (phydm->support_ic_type & 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 (phydm->support_ic_type & 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 == 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_sts_rpt_jgr2_type2 *phys_t2 = (struct phy_sts_rpt_jgr2_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) */ -+ -+} -+ -+#if defined(CONFIG_RTL8822C) && defined(CONFIG_LPS_PG) -+void -+debug_DACK( -+ struct dm_struct *dm -+) -+{ -+ //P_PHYDM_FUNC dm; -+ //dm = &(SysMib.ODM.Phydm); -+ //PIQK_OFFLOAD_PARM pIQK_info; -+ //pIQK_info= &(SysMib.ODM.IQKParm); -+ u8 i; -+ u32 temp1, temp2, temp3; -+ -+ temp1 = odm_get_bb_reg(dm, 0x1860, bMaskDWord); -+ temp2 = odm_get_bb_reg(dm, 0x4160, bMaskDWord); -+ temp3 = odm_get_bb_reg(dm, 0x9b4, bMaskDWord); -+ -+ odm_set_bb_reg(dm, 0x9b4, bMaskDWord, 0xdb66db00); -+ -+ //pathA -+ odm_set_bb_reg(dm, 0x1830, BIT(30), 0x0); -+ odm_set_bb_reg(dm, 0x1860, 0xfc000000, 0x3c); -+ -+ RTW_INFO("path A i\n"); -+ //i -+ for (i = 0; i < 0xf; i++) { -+ odm_set_bb_reg(dm, 0x18b0, 0xf0000000, i); -+ RTW_INFO("[0][0][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x2810,0x7fc0000)); -+ //pIQK_info->msbk_d[0][0][i] = (u16)odm_get_bb_reg(dm,0x2810,0x7fc0000); -+ } -+ RTW_INFO("path A q\n"); -+ //q -+ for (i = 0; i < 0xf; i++) { -+ odm_set_bb_reg(dm, 0x18cc, 0xf0000000, i); -+ RTW_INFO("[0][1][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x283c,0x7fc0000)); -+ //pIQK_info->msbk_d[0][1][i] = (u16)odm_get_bb_reg(dm,0x283c,0x7fc0000); -+ } -+ //pathB -+ odm_set_bb_reg(dm, 0x4130, BIT(30), 0x0); -+ odm_set_bb_reg(dm, 0x4160, 0xfc000000, 0x3c); -+ -+ RTW_INFO("\npath B i\n"); -+ //i -+ for (i = 0; i < 0xf; i++) { -+ odm_set_bb_reg(dm, 0x41b0, 0xf0000000, i); -+ RTW_INFO("[1][0][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x4510,0x7fc0000)); -+ //pIQK_info->msbk_d[1][0][i] = (u16)odm_get_bb_reg(dm,0x2810,0x7fc0000); -+ } -+ RTW_INFO("path B q\n"); -+ //q -+ for (i = 0; i < 0xf; i++) { -+ odm_set_bb_reg(dm, 0x41cc, 0xf0000000, i); -+ RTW_INFO("[1][1][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x453c,0x7fc0000)); -+ //pIQK_info->msbk_d[1][1][i] = (u16)odm_get_bb_reg(dm,0x283c,0x7fc0000); -+ } -+ -+ //restore to normal -+ odm_set_bb_reg(dm, 0x1830, BIT(30), 0x1); -+ odm_set_bb_reg(dm, 0x4130, BIT(30), 0x1); -+ odm_set_bb_reg(dm, 0x1860, bMaskDWord, temp1); -+ odm_set_bb_reg(dm, 0x4160, bMaskDWord, temp2); -+ odm_set_bb_reg(dm, 0x9b4, bMaskDWord, temp3); -+ -+ -+} -+ -+void -+debug_IQK( -+ struct dm_struct *dm, -+ IN u8 idx, -+ IN u8 path -+) -+{ -+ u8 i, ch; -+ u32 tmp; -+ u32 bit_mask_20_16 = BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16); -+ -+ RTW_INFO("idx = %d, path = %d\n", idx, path); -+ -+ odm_set_bb_reg(dm, 0x1b00, MASKDWORD, 0x8 | path << 1); -+ -+ if (idx == TX_IQK) {//TXCFIR -+ odm_set_bb_reg(dm, R_0x1b20, BIT(31) | BIT(30), 0x3); -+ } else {//RXCFIR -+ odm_set_bb_reg(dm, R_0x1b20, BIT(31) | BIT(30), 0x1); -+ } -+ odm_set_bb_reg(dm, R_0x1bd4, BIT(21), 0x1); -+ odm_set_bb_reg(dm, R_0x1bd4, bit_mask_20_16, 0x10); -+ for (i = 0; i <= 16; i++) { -+ odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0xe0000001 | i << 2); -+ tmp = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); -+ RTW_INFO("iqk_cfir_real[%d][%d][%d] = 0x%x\n", path, idx, i, ((tmp & 0x0fff0000) >> 16)); -+ //iqk_info->iqk_cfir_real[ch][path][idx][i] = -+ // (tmp & 0x0fff0000) >> 16; -+ RTW_INFO("iqk_cfir_imag[%d][%d][%d] = 0x%x\n", path, idx, i, (tmp & 0x0fff)); -+ //iqk_info->iqk_cfir_imag[ch][path][idx][i] = tmp & 0x0fff; -+ } -+ odm_set_bb_reg(dm, R_0x1b20, BIT(31) | BIT(30), 0x0); -+ //odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0x0); -+} -+ -+__odm_func__ void -+debug_information_8822c( -+ struct dm_struct *dm) -+{ -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ -+ u32 reg_rf18; -+ -+ if (odm_get_bb_reg(dm, R_0x1e7c, BIT(30))) -+ dpk_info->is_tssi_mode = true; -+ else -+ dpk_info->is_tssi_mode = false; -+ -+ reg_rf18 = odm_get_rf_reg(dm, RF_PATH_A, RF_0x18, RFREG_MASK); -+ -+ dpk_info->dpk_band = (u8)((reg_rf18 & BIT(16)) >> 16); /*0/1:G/A*/ -+ dpk_info->dpk_ch = (u8)reg_rf18 & 0xff; -+ dpk_info->dpk_bw = (u8)((reg_rf18 & 0x3000) >> 12); /*3/2/1:20/40/80*/ -+ -+ RTW_INFO("[DPK] TSSI/ Band/ CH/ BW = %d / %s / %d / %s\n", -+ dpk_info->is_tssi_mode, dpk_info->dpk_band == 0 ? "2G" : "5G", -+ dpk_info->dpk_ch, -+ dpk_info->dpk_bw == 3 ? "20M" : (dpk_info->dpk_bw == 2 ? "40M" : "80M")); -+} -+ -+extern void _dpk_get_coef_8822c(void *dm_void, u8 path); -+ -+__odm_func__ void -+debug_reload_data_8822c( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ -+ u8 path; -+ u32 u32tmp; -+ -+ debug_information_8822c(dm); -+ -+ for (path = 0; path < DPK_RF_PATH_NUM_8822C; path++) { -+ -+ RTW_INFO("[DPK] Reload path: 0x%x\n", path); -+ -+ odm_set_bb_reg(dm, R_0x1b00, MASKDWORD, 0x8 | (path << 1)); -+ -+ /*txagc bnd*/ -+ if (dpk_info->dpk_band == 0x0) -+ u32tmp = odm_get_bb_reg(dm, R_0x1b60, MASKDWORD); -+ else -+ u32tmp = odm_get_bb_reg(dm, R_0x1b60, MASKDWORD); -+ -+ RTW_INFO("[DPK] txagc bnd = 0x%08x\n", u32tmp); -+ -+ u32tmp = odm_get_bb_reg(dm, R_0x1b64, MASKBYTE3); -+ RTW_INFO("[DPK] dpk_txagc = 0x%08x\n", u32tmp); -+ -+ //debug_coef_write_8822c(dm, path, dpk_info->dpk_path_ok & BIT(path) >> path); -+ _dpk_get_coef_8822c(dm, path); -+ -+ //debug_one_shot_8822c(dm, path, DPK_ON); -+ -+ odm_set_bb_reg(dm, R_0x1b00, 0x0000000f, 0xc); -+ -+ if (path == RF_PATH_A) -+ u32tmp = odm_get_bb_reg(dm, R_0x1b04, 0x0fffffff); -+ else -+ u32tmp = odm_get_bb_reg(dm, R_0x1b5c, 0x0fffffff); -+ -+ RTW_INFO("[DPK] dpk_gs = 0x%08x\n", u32tmp); -+ -+ } -+} -+ -+void odm_lps_pg_debug_8822c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ debug_DACK(dm); -+ debug_IQK(dm, TX_IQK, RF_PATH_A); -+ debug_IQK(dm, RX_IQK, RF_PATH_A); -+ debug_IQK(dm, TX_IQK, RF_PATH_B); -+ debug_IQK(dm, RX_IQK, RF_PATH_B); -+ debug_reload_data_8822c(dm); -+} -+#endif /* defined(CONFIG_RTL8822C) && defined(CONFIG_LPS_PG) */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_p2p.c b/drivers/net/wireless/rtl8821cs/core/rtw_p2p.c -new file mode 100644 -index 000000000..61eba1d40 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_p2p.c -@@ -0,0 +1,5029 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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->cmn.mac_addr, 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++; -+ set_frame_sub_type(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++; -+ set_frame_sub_type(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); -+ -+ -+ 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++; -+ set_frame_sub_type(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++; -+ set_frame_sub_type(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, WIFI_ASOC_STATE) == _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, WIFI_ASOC_STATE) == _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; -+ u16 v16 = 0; -+ -+ 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 ) */ -+ v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT; -+ RTW_PUT_BE16(wfdie + wfdielen, v16); -+ } else { -+ /* WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT; -+ RTW_PUT_BE16(wfdie + wfdielen, v16); -+ } -+ } else { -+ if (pwdinfo->wfd_tdls_enable) { -+ /* available for WFD session + TDLS mode + WSD ( WFD Service Discovery ) */ -+ v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT; -+ RTW_PUT_BE16(wfdie + wfdielen, v16); -+ } else { -+ /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT; -+ RTW_PUT_BE16(wfdie + wfdielen, v16); -+ } -+ } -+ } else { -+ if (pwdinfo->wfd_tdls_enable) { -+ /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT; -+ RTW_PUT_BE16(wfdie + wfdielen, v16); -+ } else { -+ /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT; -+ RTW_PUT_BE16(wfdie + wfdielen, v16); -+ } -+ } -+ } else { -+ if (pwdinfo->wfd_tdls_enable) { -+ v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT; -+ RTW_PUT_BE16(wfdie + wfdielen, v16); -+ } else { -+ v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT; -+ RTW_PUT_BE16(wfdie + wfdielen, v16); -+ } -+ } -+ -+ 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, WIFI_ASOC_STATE) == _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, WIFI_ASOC_STATE) == _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, WIFI_ASOC_STATE) == _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, WIFI_ASOC_STATE) == _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, WIFI_ASOC_STATE) == _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, WIFI_ASOC_STATE) == _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, WIFI_ASOC_STATE) == _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, WIFI_ASOC_STATE) == _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, WIFI_ASOC_STATE) == _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, WIFI_ASOC_STATE) == _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; -+ -+ /* 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 ); */ -+ 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; -+ -+ { -+ /* 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; -+ -+ /* 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 = get_frame_sub_type(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 */ -+ attr_contentlen = sizeof(cap_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; -+ -+ attr_contentlen = sizeof(groupid); -+ 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 = sizeof(dev_addr); -+ 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->cmn.mac_addr); -+ /* _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, get_addr2_ptr(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) { -+ attr_contentlen = sizeof(uconfig_method); -+ 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, get_addr2_ptr(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_ch_inclusion(_adapter *adapter, u8 *peer_ch_list, u8 peer_ch_num, u8 *ch_list_inclusioned) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ int i = 0, j = 0, temp = 0; -+ u8 ch_no = 0; -+ -+ for (i = 0; i < peer_ch_num; i++) { -+ for (j = temp; j < rfctl->max_chan_nums; j++) { -+ if (*(peer_ch_list + i) == rfctl->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)) { -+ wps_devicepassword_id_len = sizeof(wps_devicepassword_id); -+ 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 */ -+ attr_contentlen = sizeof(cap_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) */ -+ } -+ -+ attr_contentlen = sizeof(attr_content); -+ 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); -+ } -+ } -+ -+ attr_contentlen = sizeof(listen_ch_attr); -+ 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 = sizeof(pwdinfo->p2p_peer_interface_addr); -+ 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); -+ } -+ -+ ch_cnt = sizeof(ch_content); -+ 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, 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 = sizeof(operatingch_info); -+ 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 }; -+ 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 */ -+ attr_contentlen = sizeof(cap_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 */ -+ } -+ -+ attr_contentlen = sizeof(attr_content); -+ 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 = sizeof(pwdinfo->p2p_peer_interface_addr); -+ 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 = sizeof(attr_content); -+ 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 = sizeof(operatingch_info); -+ 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 */ -+ pwdinfo->channel_list_attr_len = sizeof(pwdinfo->channel_list_attr); -+ 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, 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 = sizeof(operatingch_info); -+ -+ 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 */ -+ _rtw_memset(groupid, 0x00, 38); -+ attr_contentlen = sizeof(groupid); -+ 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) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *padapter = pwdinfo->padapter; -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#endif -+ 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; -+ attr_contentlen = sizeof(attr_content); -+ 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) { -+ -+ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); -+ -+ /* 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(&prochinfo->ap_roch_ch_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 */ -+ _rtw_memset(groupid, 0x00, 38); -+ attr_contentlen = sizeof(groupid); -+ 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 = sizeof(operatingch_info); -+ 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, get_addr2_ptr(pframe), status, dialogToken); -+ -+ return _TRUE; -+} -+ -+void find_phase_handler(_adapter *padapter) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sitesurvey_parm parm; -+ _irqL irqL; -+ u8 _status = 0; -+ -+ -+ rtw_init_sitesurvey_parm(padapter, &parm); -+ _rtw_memcpy(&parm.ssid[0].Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN); -+ parm.ssid[0].SsidLength = P2P_WILDCARD_SSID_LEN; -+ parm.ssid_num = 1; -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _status = rtw_sitesurvey_cmd(padapter, &parm); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+} -+ -+void restore_p2p_state_handler(_adapter *padapter) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ -+ 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_back_opch(padapter); -+ } -+ } -+#endif -+ -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) { -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_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_IOCTL_CFG80211 -+ -+#if 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; -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) -+ return; -+#endif /* CONFIG_MCC_MODE */ -+ -+ 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); -+ } -+} -+#endif -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+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; -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) -+ return; -+#endif /* CONFIG_MCC_MODE */ -+ -+ 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); -+ } -+} -+#endif -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+static bool rtw_chk_p2pie_ch_list_with_buddy(_adapter *padapter, const u8 *frame_body, u32 len) -+{ -+ bool fit = _FALSE; -+ 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); -+ } -+ -+ return fit; -+} -+ -+#if defined(CONFIG_P2P_INVITE_IOT) -+static bool rtw_chk_p2pie_op_ch_with_buddy(_adapter *padapter, const u8 *frame_body, u32 len) -+{ -+ bool fit = _FALSE; -+ 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); -+ } -+ -+ return fit; -+} -+#endif -+ -+static void rtw_cfg80211_adjust_p2pie_channel(_adapter *padapter, const u8 *frame_body, u32 len) -+{ -+ u8 *ies, *p2p_ie; -+ u32 ies_len, p2p_ielen; -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) -+ return; -+#endif /* CONFIG_MCC_MODE */ -+ -+ 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 -+ 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; -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+#endif -+ u8 build = 0; -+ u8 del = 0; -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ del = 1; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (wdinfo->wfd_info->wfd_enable == _TRUE) -+#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]; -+ -+ 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) : get_addr2_ptr(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) : get_addr2_ptr(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) : get_addr2_ptr(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) : get_addr2_ptr(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 defined(CONFIG_P2P_INVITE_IOT) -+ 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 -+ #endif -+ 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) : get_addr2_ptr(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; -+ } -+ -+ } -+ -+ return is_p2p_frame; -+} -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+s32 p2p_protocol_wk_hdl(_adapter *padapter, int intCmdType, u8 *buf) -+{ -+ int ret = H2C_SUCCESS; -+ -+ 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)) -+ rtw_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)) -+ rtw_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)) -+ rtw_concurrent_handler(padapter); -+ else -+ pre_tx_negoreq_handler(padapter); -+#else -+ pre_tx_negoreq_handler(padapter); -+#endif -+ break; -+ -+ 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; -+ -+ -+ -+ 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. */ -+ attr_contentlen = sizeof(p2p_attr); -+ 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; /* 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 -+#ifndef CONFIG_FW_MULTI_PORT_SUPPORT -+ if (padapter->hw_port != HW_PORT0) -+ return; -+#endif -+#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. */ -+ noa_attr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_NOA, NULL, &attr_contentlen); -+ if (noa_attr) { -+ 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; -+ if (pwdinfo->opp_ps != 1) -+ pwdinfo->ctwindow = 0; -+ else -+ pwdinfo->ctwindow = noa_attr[1] & 0x7F; -+ noa_offset = 2; -+ noa_num = 0; -+ /* NoA length should be n*(13) + 2 */ -+ if (attr_contentlen > 2 && (attr_contentlen - 2) % 13 == 0) { -+ while (noa_offset < attr_contentlen && noa_num < P2P_MAX_NOA_NUM) { -+ /* _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); -+ u32 ps_deny = 0; -+ -+ /* 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)); -+ -+#ifdef CONFIG_LPS -+ if (pwdinfo->opp_ps == 1) { -+ if (pwrpriv->smart_ps == 0) { -+ pwrpriv->smart_ps = 2; -+ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) -+ rtw_exec_lps(padapter, pwrpriv->pwr_mode); -+ } -+ } -+#endif /* CONFIG_LPS */ -+ -+ pwdinfo->noa_index = 0; -+ pwdinfo->ctwindow = 0; -+ pwdinfo->opp_ps = 0; -+ pwdinfo->noa_num = 0; -+ pwdinfo->p2p_ps_mode = P2P_PS_NONE; -+ -+ break; -+ case P2P_PS_ENABLE: -+ _enter_pwrlock(&adapter_to_pwrctl(padapter)->lock); -+ ps_deny = rtw_ps_deny_get(padapter); -+ _exit_pwrlock(&adapter_to_pwrctl(padapter)->lock); -+ -+ if ((ps_deny & (PS_DENY_SCAN | PS_DENY_JOIN)) -+ || rtw_mi_check_fwstate(padapter, (WIFI_UNDER_SURVEY | WIFI_UNDER_LINKING))) { -+ pwdinfo->p2p_ps_mode = P2P_PS_NONE; -+ RTW_DBG(FUNC_ADPT_FMT" Block P2P PS under site survey or LINKING\n", FUNC_ADPT_ARG(padapter)); -+ return; -+ } -+ 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; -+ -+#ifdef CONFIG_LPS -+ if (pwdinfo->ctwindow > 0) { -+ if (pwrpriv->smart_ps != 0) { -+ pwrpriv->smart_ps = 0; -+ RTW_INFO("%s(): Enter CTW, change SmartPS\n", __FUNCTION__); -+ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) -+ rtw_exec_lps(padapter, pwrpriv->pwr_mode); -+ } -+ } -+#endif /* CONFIG_LPS */ -+ -+ 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; -+ } -+ -+#ifdef CONFIG_MCC_MODE -+ rtw_hal_mcc_process_noa(padapter); -+#endif /* CONFIG_MCC_MODE */ -+} -+ -+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 -+#ifndef CONFIG_FW_MULTI_PORT_SUPPORT -+ || (padapter->hw_port != HW_PORT0) -+#endif -+#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, CMD_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; -+ -+ 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); -+} -+ -+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; -+ -+ rtw_init_timer(&pwdinfo->find_phase_timer, padapter, find_phase_timer_process, padapter); -+ rtw_init_timer(&pwdinfo->restore_p2p_state_timer, padapter, restore_p2p_state_timer_process, padapter); -+ rtw_init_timer(&pwdinfo->pre_tx_scan_timer, padapter, pre_tx_scan_timer_process, padapter); -+ rtw_init_timer(&pwdinfo->reset_ch_sitesurvey, padapter, reset_ch_sitesurvey_timer_process, padapter); -+ rtw_init_timer(&pwdinfo->reset_ch_sitesurvey2, padapter, reset_ch_sitesurvey_timer_process2, padapter); -+} -+ -+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 -+ 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 -+ u8 union_ch = 0; -+ -+ 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; -+} -+ -+void _rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role) -+{ -+ if (wdinfo->role != role) { -+ wdinfo->role = role; -+ rtw_mi_update_iface_status(&(wdinfo->padapter->mlmepriv), 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); -+#ifdef CONFIG_CONCURRENT_MODE -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#endif -+ -+ if (role == P2P_ROLE_DEVICE || role == P2P_ROLE_CLIENT || role == P2P_ROLE_GO) { -+#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;*/ -+ /* Only selected interface can be P2P interface */ -+ if (padapter->iface_id != padapter->registrypriv.sel_p2p_iface) { -+ RTW_ERR("%s, iface_id:%d is not P2P interface!\n", __func__, padapter->iface_id); -+ ret = _FAIL; -+ 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_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(&prochinfo->ap_roch_ch_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); -+ -+ /* 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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_pwrctrl.c b/drivers/net/wireless/rtl8821cs/core/rtw_pwrctrl.c -new file mode 100755 -index 000000000..a617590c6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_pwrctrl.c -@@ -0,0 +1,2997 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#ifdef DBG_CHECK_FW_PS_STATE -+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; -+ 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; -+ } -+ #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) -+ rtw_hal_get_hwreg(padapter, HW_VAR_FW_PS_STATE, (u8 *)&fw_ps_state); -+ if ((fw_ps_state & BIT_LPS_STATUS) == 0) -+ ret = _SUCCESS; -+ else { -+ pdbgpriv->dbg_poll_fail_cnt++; -+ RTW_INFO("%s: fw_ps_state=%04x\n", __FUNCTION__, fw_ps_state); -+ } -+ #else -+ 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); -+ } -+ } -+ #endif -+ -+exit_fw_ps_state: -+ _exit_pwrlock(&pwrpriv->check_32k_lock); -+ return ret; -+} -+#endif /*DBG_CHECK_FW_PS_STATE*/ -+#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; -+ -+#ifdef CONFIG_RTW_CFGVENDOR_LLSTATS -+ pwrpriv->pwr_saving_start_time = rtw_get_current_time(); -+#endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ -+ -+ 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); -+ -+#ifdef CONFIG_PCI_DYNAMIC_ASPM -+ rtw_pci_dynamic_aspm_set_mode(padapter, ASPM_MODE_PS); -+#endif -+} -+ -+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; -+ -+#ifdef CONFIG_RTW_CFGVENDOR_LLSTATS -+ pwrpriv->pwr_saving_time += rtw_get_passing_time_ms(pwrpriv->pwr_saving_start_time); -+#endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ -+ -+ 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); -+#ifdef DBG_CHECK_FW_PS_STATE -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+#endif -+ 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); -+ -+#ifdef CONFIG_PCI_DYNAMIC_ASPM -+ rtw_pci_dynamic_aspm_set_mode(padapter, ASPM_MODE_PERF); -+#endif -+ -+ if (_SUCCESS == ret) -+ odm_dm_reset(&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 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; -+#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 (rtw_time_after(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); -+#endif -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE | WIFI_UNDER_SURVEY) -+ || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) -+ || MLME_IS_AP(iface) -+ || MLME_IS_MESH(iface) -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) -+ #if defined(CONFIG_IOCTL_CFG80211) -+ || rtw_cfg80211_get_is_roch(iface) == _TRUE -+ || (rtw_cfg80211_is_ro_ch_once(adapter) -+ && rtw_cfg80211_get_last_ro_ch_passing_ms(adapter) < 3000) -+ #elif defined(CONFIG_P2P) -+ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) -+ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) -+ #endif -+ ) -+ goto exit; -+ -+ } -+ } -+ -+#if (MP_DRIVER == 1) -+ if (adapter->registrypriv.mp_mode == 1) -+ goto exit; -+#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) -+{ -+ 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) { -+ if (!MLME_IS_MONITOR(padapter)) { -+ 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) { -+ -+ 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)); -+ pwrpriv->change_rfpwrstate = rf_off; -+ -+#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(void *ctx) -+{ -+ _adapter *padapter = (_adapter *)ctx; -+ rtw_ps_cmd(padapter); -+} -+ -+#ifdef CONFIG_LPS -+#ifdef CONFIG_CHECK_LEAVE_LPS -+#ifdef CONFIG_LPS_CHK_BY_TP -+void traffic_check_for_leave_lps_by_tp(PADAPTER padapter, u8 tx, struct sta_info *sta) -+{ -+ struct stainfo_stats *pstats = &sta->sta_stats; -+ u64 cur_acc_tx_bytes = 0, cur_acc_rx_bytes = 0; -+ u32 tx_tp_kbyte = 0, rx_tp_kbyte = 0; -+ u32 tx_tp_th = 0, rx_tp_th = 0; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 leave_lps = _FALSE; -+ -+ if (tx) { /* from tx */ -+ cur_acc_tx_bytes = pstats->tx_bytes - pstats->acc_tx_bytes; -+ tx_tp_kbyte = cur_acc_tx_bytes >> 10; -+ tx_tp_th = pwrpriv->lps_tx_tp_th * 1024 / 8 * 2; /*KBytes @2s*/ -+ -+ if (tx_tp_kbyte >= tx_tp_th || -+ padapter->mlmepriv.LinkDetectInfo.NumTxOkInPeriod >= pwrpriv->lps_tx_pkts){ -+ if (pwrpriv->bLeisurePs -+ && (pwrpriv->pwr_mode != PS_MODE_ACTIVE) -+ #ifdef CONFIG_BT_COEXIST -+ && (rtw_btcoex_IsBtControlLps(padapter) == _FALSE) -+ #endif -+ ) { -+ leave_lps = _TRUE; -+ } -+ } -+ -+ } else { /* from rx path */ -+ cur_acc_rx_bytes = pstats->rx_bytes - pstats->acc_rx_bytes; -+ rx_tp_kbyte = cur_acc_rx_bytes >> 10; -+ rx_tp_th = pwrpriv->lps_rx_tp_th * 1024 / 8 * 2; -+ -+ if (rx_tp_kbyte>= rx_tp_th || -+ padapter->mlmepriv.LinkDetectInfo.NumRxUnicastOkInPeriod >= pwrpriv->lps_rx_pkts) { -+ if (pwrpriv->bLeisurePs -+ && (pwrpriv->pwr_mode != PS_MODE_ACTIVE) -+ #ifdef CONFIG_BT_COEXIST -+ && (rtw_btcoex_IsBtControlLps(padapter) == _FALSE) -+ #endif -+ ) { -+ leave_lps = _TRUE; -+ } -+ } -+ } -+ -+ if (leave_lps) { -+ #ifdef DBG_LPS_CHK_BY_TP -+ RTW_INFO("leave lps via %s, ", tx ? "Tx" : "Rx"); -+ if (tx) -+ RTW_INFO("Tx = %d [%d] (KB)\n", tx_tp_kbyte, tx_tp_th); -+ else -+ RTW_INFO("Rx = %d [%d] (KB)\n", rx_tp_kbyte, rx_tp_th); -+ #endif -+ pwrpriv->lps_chk_cnt = pwrpriv->lps_chk_cnt_th; -+ /* rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0); */ -+ rtw_lps_ctrl_wk_cmd(padapter, tx ? LPS_CTRL_TX_TRAFFIC_LEAVE : LPS_CTRL_RX_TRAFFIC_LEAVE, 0); -+ } -+} -+#endif /*CONFIG_LPS_CHK_BY_TP*/ -+ -+void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets) -+{ -+ static systime 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, 0); */ -+ rtw_lps_ctrl_wk_cmd(padapter, tx ? LPS_CTRL_TX_TRAFFIC_LEAVE : LPS_CTRL_RX_TRAFFIC_LEAVE, tx ? RTW_CMDF_DIRECTLY : 0); -+ } -+} -+#endif /* CONFIG_CHECK_LEAVE_LPS */ -+ -+#ifdef CONFIG_LPS_LCLK -+#define LPS_CPWM_TIMEOUT_MS 10 /*ms*/ -+#define LPS_RPWM_RETRY_CNT 3 -+ -+u8 rtw_cpwm_polling(_adapter *adapter, u8 rpwm, u8 cpwm_orig) -+{ -+ u8 rst = _FAIL; -+ u8 cpwm_now = 0; -+ systime start_time; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ #ifdef DBG_CHECK_FW_PS_STATE -+ struct debug_priv *pdbgpriv = &(adapter_to_dvobj(adapter)->drv_dbg); -+ #endif -+ -+ pwrpriv->rpwm_retry = 0; -+ -+ do { -+ start_time = rtw_get_current_time(); -+ do { -+ rtw_msleep_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; -+ rst = _SUCCESS; -+ break; -+ } -+ } while (rtw_get_passing_time_ms(start_time) < LPS_CPWM_TIMEOUT_MS && !RTW_CANNOT_RUN(adapter)); -+ -+ if (rst == _SUCCESS) -+ break; -+ else { -+ /* rpwm retry */ -+ cpwm_orig = cpwm_now; -+ rpwm &= ~PS_TOGGLE; -+ rpwm |= pwrpriv->tog; -+ rtw_hal_set_hwreg(adapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); -+ pwrpriv->tog += 0x80; -+ } -+ } while (pwrpriv->rpwm_retry++ < LPS_RPWM_RETRY_CNT && !RTW_CANNOT_RUN(adapter)); -+ -+ if (rst == _SUCCESS) { -+ #ifdef DBG_CHECK_FW_PS_STATE -+ RTW_INFO("%s: polling cpwm OK! rpwm_retry=%d, cpwm_orig=%02x, cpwm_now=%02x , 0x100=0x%x\n" -+ , __func__, pwrpriv->rpwm_retry, cpwm_orig, cpwm_now, rtw_read8(adapter, REG_CR)); -+ if (rtw_fw_ps_state(adapter) == _FAIL) { -+ RTW_INFO("leave 32k but fw state in 32k\n"); -+ pdbgpriv->dbg_rpwm_toogle_cnt++; -+ } -+ #endif /* DBG_CHECK_FW_PS_STATE */ -+ } else { -+ RTW_ERR("%s: polling cpwm timeout! rpwm_retry=%d, cpwm_orig=%02x, cpwm_now=%02x\n" -+ , __func__, pwrpriv->rpwm_retry, 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 */ -+ -+ #ifdef CONFIG_LPS_RPWM_TIMER -+ _set_timer(&pwrpriv->pwr_rpwm_timer, 1); -+ #endif /* CONFIG_LPS_RPWM_TIMER */ -+ } -+ -+ return rst; -+} -+#endif -+/* -+ * 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 -+ * -+ */ -+u8 rtw_set_rpwm(PADAPTER padapter, u8 pslv) -+{ -+ u8 rpwm = 0xFF; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+#ifdef CONFIG_LPS_LCLK -+ u8 cpwm_orig; -+#endif -+ -+ 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 -+ || (pwrpriv->lps_level == LPS_NORMAL) -+ ) { -+ return rpwm; -+ } -+ } -+ -+ if (rtw_is_surprise_removed(padapter) || -+ (!rtw_is_hw_init_completed(padapter))) { -+ -+ pwrpriv->cpwm = PS_STATE_S4; -+ -+ return rpwm; -+ } -+ -+ if (rtw_is_drv_stopped(padapter)) -+ if (pslv < PS_STATE_S2) -+ return rpwm; -+ -+ 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_LPS_LCLK -+ 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) { -+ #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) -+ #endif -+ _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_CPWM_TIMEOUT_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 -+ rtw_cpwm_polling(padapter, rpwm, cpwm_orig); -+ #else -+ #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) -+ rtw_cpwm_polling(padapter, rpwm, cpwm_orig); -+ #endif /*#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN)*/ -+ #endif /*#ifdef CONFIG_DETECT_CPWM_BY_POLLING*/ -+ } else -+#endif /* CONFIG_LPS_LCLK */ -+ { -+ pwrpriv->cpwm = pslv; -+ } -+ -+ return rpwm; -+} -+ -+u8 PS_RDY_CHECK(_adapter *padapter) -+{ -+ 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 -+ -+ if (rtw_time_after(pwrpriv->lps_deny_time, rtw_get_current_time())) -+ return _FALSE; -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_SURVEY) -+ || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) -+ || MLME_IS_AP(padapter) -+ || MLME_IS_MESH(padapter) -+ || MLME_IS_MONITOR(padapter) -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) -+ #if 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 */ -+ #ifdef CONFIG_DFS_MASTER -+ || adapter_to_rfctl(padapter)->radar_detect_enabled -+ #endif -+ ) -+ 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; -+} -+ -+#ifdef CONFIG_LPS_LCLK -+void rtw_set_lps_lclk(_adapter *padapter, u8 enable) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ u8 val8 = 0; -+ u8 polling_cnt = 0; -+ u8 cpwm_orig = 0; -+ u8 cpwm_now = 0; -+ u8 result = _FAIL; -+ systime start_time; -+ -+ if (enable) { -+ /* set rpwm to enter 32k */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RPWM_TOG, &val8); -+ RTW_INFO("%s: read rpwm=%02x\n", __func__, val8); -+ val8 += PS_TOGGLE; -+ val8 |= PS_LCLK; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&val8)); -+ RTW_INFO("%s: write rpwm=%02x\n", __func__, val8); -+ pwrctl->tog = (val8 + PS_TOGGLE) & PS_TOGGLE; -+ -+ /* When using PNO, the FW may scan first, so polling register 100 -+ * may not see 0xEA at this point. -+ */ -+ if (!pwrctl->wowlan_pno_enable) { -+ do { -+ val8 = rtw_read8(padapter, REG_CR); -+ polling_cnt++; -+ RTW_INFO("%s polling 0x100=0x%x, cnt=%d\n", -+ __func__, val8, polling_cnt); -+ RTW_INFO("%s 0x08:%02x, 0x03:%02x\n", -+ __func__, -+ rtw_read8(padapter, 0x08), -+ rtw_read8(padapter, 0x03)); -+ rtw_mdelay_os(10); -+ } while (polling_cnt < 20 && (val8 != 0xEA)); -+ } -+ } else { -+ /* for polling cpwm */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); -+ -+ /* set rpwm to leave 32k */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RPWM_TOG, &val8); -+ RTW_INFO("%s: read rpwm=%02x\n", __func__, val8); -+ val8 += PS_TOGGLE; -+ val8 |= PS_ACK; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&val8)); -+ RTW_INFO("%s: write rpwm=%02x\n", __func__, val8); -+ pwrctl->tog = (val8 + PS_TOGGLE) & PS_TOGGLE; -+ -+ /* 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) & PS_TOGGLE) -+ break; -+ -+ if (rtw_get_passing_time_ms(start_time) > 100) { -+ RTW_INFO("%s: polling cpwm timeout\n", -+ __func__); -+ break; -+ } -+ } while (1); -+ -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrctl->wowlan_pno_enable) { -+ do { -+ rtw_mdelay_os(1); -+ -+ val8 = rtw_read8(padapter, REG_CR); -+ if (val8 != 0xEA) { -+ result = _SUCCESS; -+ break; -+ } -+ -+ polling_cnt++; -+ } while (polling_cnt < 100); -+ -+ if (result == _FAIL ) -+ RTW_INFO("%s: It is not finished to leave 32K\n", -+ __func__); -+ } -+#endif -+ } -+} -+#endif -+ -+#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; -+ u8 val8 = 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) -+ rtw_set_lps_lclk(padapter, _TRUE); -+#endif -+ } else { -+ /* Leave IPS */ -+ RTW_INFO("%s: Leaving IPS in FWLPS state\n", __func__); -+ -+#ifdef CONFIG_LPS_LCLK -+ rtw_set_lps_lclk(padapter, _FALSE); -+#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_FWLPS_IN_IPS */ -+ -+void rtw_exec_lps(_adapter *padapter, u8 ps_mode) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ if (ps_mode == PS_MODE_ACTIVE) { -+#ifdef CONFIG_LPS_ACK -+ _enter_critical_mutex(&pwrpriv->lps_ack_mutex, NULL); -+ rtw_sctx_init(&pwrpriv->lps_ack_sctx, 100); -+#endif /* CONFIG_LPS_ACK */ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_STATE_CHK, (u8 *)(&ps_mode)); -+ -+#ifdef CONFIG_LPS_ACK -+ _exit_critical_mutex(&pwrpriv->lps_ack_mutex, NULL); -+#endif /* CONFIG_LPS_ACK */ -+ } else { -+ if (MLME_IS_ASOC(padapter)) -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT": It can't execute LPS without Wi-Fi connection!\n", -+ FUNC_ADPT_ARG(padapter)); -+ } -+} -+ -+void rtw_lps_rfon_ctrl(_adapter *padapter, u8 rfon_ctrl) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 rpwm = 0; -+ -+ if (pwrpriv->bFwCurrentInPSMode && pwrpriv->pwr_mode != PS_MODE_ACTIVE) { -+ if (rfon_ctrl == rf_on) { -+#ifdef CONFIG_LPS_LCLK -+ if (pwrpriv->lps_level >= LPS_LCLK) { -+ s32 ready = _FAIL; -+ systime stime; -+ s32 utime; -+ u32 timeout; /* unit: ms */ -+ -+#ifdef LPS_RPWM_WAIT_MS -+ timeout = LPS_RPWM_WAIT_MS; -+#else -+ timeout = 30; -+#endif /* !LPS_RPWM_WAIT_MS */ -+ -+ stime = rtw_get_current_time(); -+ do { -+ ready = rtw_register_task_alive(padapter, LPS_ALIVE); -+ if (ready == _SUCCESS) -+ break; -+ -+ utime = rtw_get_passing_time_ms(stime); -+ if (utime > timeout) -+ break; -+ -+ rtw_msleep_os(1); -+ } while (1); -+ -+ if (ready == _FAIL) -+ RTW_INFO(FUNC_ADPT_FMT": It is not ready to leave 32K !!!\n", -+ FUNC_ADPT_ARG(padapter)); -+ } -+#endif /* CONFIG_LPS_LCLK */ -+ -+#ifdef CONFIG_LPS_ACK -+ _enter_critical_mutex(&pwrpriv->lps_ack_mutex, NULL); -+ rtw_sctx_init(&pwrpriv->lps_ack_sctx, 100); -+#endif /* CONFIG_LPS_ACK */ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE_RFON_CTRL, (u8 *)(&rfon_ctrl)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_RFON_CHK, (u8 *)(&rfon_ctrl)); -+ -+#ifdef CONFIG_LPS_ACK -+ _exit_critical_mutex(&pwrpriv->lps_ack_mutex, NULL); -+#endif /* CONFIG_LPS_ACK */ -+ } else { -+ if (MLME_IS_ASOC(padapter)) { -+#ifdef CONFIG_LPS_PG -+ if (pwrpriv->lps_level == LPS_PG) { -+ if (rtw_hal_set_lps_pg_info_cmd(padapter) == _FAIL) -+ RTW_INFO(FUNC_ADPT_FMT": Send PG H2C command Fail! \n", -+ FUNC_ADPT_ARG(padapter)); -+ } -+#endif /* CONFIG_LPS_PG */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE_RFON_CTRL, (u8 *)(&rfon_ctrl)); -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT": It can't execute RFON without Wi-Fi connection!\n", -+ FUNC_ADPT_ARG(padapter)); -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ if (pwrpriv->lps_level >= LPS_LCLK) { -+ rtw_unregister_task_alive(padapter, LPS_ALIVE); -+ -+ if (pwrpriv->alives == 0) { -+ u8 polling_cnt = 0; -+ u8 reg_val8 = 0; -+ u8 result = _FAIL; -+ -+ do { -+ rtw_msleep_os(1); -+ reg_val8 = rtw_read8(padapter, REG_CR); -+ if (reg_val8 == 0xEA) { -+ result= _SUCCESS; -+ break; -+ } -+ polling_cnt++; -+ } while (polling_cnt < 100); -+ -+ if (result == _FAIL ) -+ RTW_INFO(FUNC_ADPT_FMT": It is not finished to enter 32K !!!\n", -+ FUNC_ADPT_ARG(padapter)); -+ } -+ } -+#endif /* CONFIG_LPS_LCLK */ -+ } -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT": RFON can't work due to ps state is not in LPS !\n", -+ FUNC_ADPT_ARG(padapter)); -+ } -+} -+ -+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 mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN) -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+#endif -+#ifdef CONFIG_WMMPS_STA -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+#endif -+#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 */ -+#ifdef CONFIG_LPS_PG -+ u8 lps_pg_hdl_id = 0; -+#endif -+ -+ -+ -+ if (ps_mode > PM_Card_Disable) { -+ return; -+ } -+ -+ if (pwrpriv->pwr_mode == ps_mode) { -+ if (PS_MODE_ACTIVE == ps_mode) -+ return; -+ -+#ifndef CONFIG_BT_COEXIST -+#ifdef CONFIG_WMMPS_STA -+ if (!rtw_is_wmmps_mode(padapter)) -+#endif /* CONFIG_WMMPS_STA */ -+ if ((pwrpriv->smart_ps == smart_ps) && -+ (pwrpriv->bcn_ant_mode == bcn_ant_mode)) -+ return; -+#endif /* !CONFIG_BT_COEXIST */ -+ } -+ -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ if (PS_MODE_ACTIVE != ps_mode) { -+ rtw_set_ps_rsvd_page(padapter); -+ rtw_set_default_port_id(padapter); -+ } -+#endif -+ -+#ifdef CONFIG_LPS_PG -+ if ((PS_MODE_ACTIVE != ps_mode) && (pwrpriv->lps_level == LPS_PG)) { -+ if (pwrpriv->wowlan_mode != _TRUE) { -+ /*rtw_hal_set_lps_pg_info(padapter);*/ -+ lps_pg_hdl_id = LPS_PG_INFO_CFG; -+ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); -+ } -+ } -+#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->cmn.mac_addr, 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) { -+ systime start_time; -+ u32 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 -+#ifdef CONFIG_LPS_PG -+ if (pwrpriv->lps_level == LPS_PG) { -+ lps_pg_hdl_id = LPS_PG_REDLEMEM; -+ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); -+ } -+#endif -+#ifdef CONFIG_WOWLAN -+ if (pwrpriv->wowlan_mode == _TRUE) -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_INACTIVE_IPS, (u8 *)(&ps_mode)); -+#endif /* CONFIG_WOWLAN */ -+ -+ rtw_exec_lps(padapter, ps_mode); -+ -+#ifdef CONFIG_LPS_PG -+ if (pwrpriv->lps_level == LPS_PG) { -+ lps_pg_hdl_id = LPS_PG_PHYDM_EN; -+ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); -+ } -+#endif -+ -+#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 */ -+#ifdef CONFIG_WOWLAN -+ || WOWLAN_IS_STA_MIX_MODE(padapter) -+#endif /* CONFIG_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->cmn.mac_addr, 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; -+#ifdef CONFIG_LPS_PG -+ if (pwrpriv->lps_level == LPS_PG) { -+ lps_pg_hdl_id = LPS_PG_PHYDM_DIS; -+ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); -+ } -+#endif -+ -+#ifdef CONFIG_WMMPS_STA -+ pwrpriv->wmm_smart_ps = pregistrypriv->wmm_smart_ps; -+#endif /* CONFIG_WMMPS_STA */ -+ -+ rtw_exec_lps(padapter, ps_mode); -+ -+#ifdef CONFIG_WOWLAN -+ if (pwrpriv->wowlan_mode == _TRUE) -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_INACTIVE_IPS, (u8 *)(&ps_mode)); -+#endif /* CONFIG_WOWLAN */ -+ -+#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 -+ -+} -+ -+const char * const LPS_CTRL_PHYDM = "LPS_CTRL_PHYDM"; -+ -+/* -+ * 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); -+ int i; -+ char buf[32] = {0}; -+#ifdef DBG_LA_MODE -+ struct registry_priv *registry_par = &(padapter->registrypriv); -+#endif -+ -+ /* RTW_INFO("+LeisurePSEnter\n"); */ -+ if (GET_HAL_DATA(padapter)->bFWReady == _FALSE) -+ return; -+ -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ return; -+#endif -+ -+#ifdef DBG_LA_MODE -+ if(registry_par->la_mode_en == 1) { -+ RTW_INFO("%s LA debug mode lps_leave \n", __func__); -+ return; -+ } -+#endif -+ /* Skip lps enter request if number of assocated adapters is not 1 */ -+ if (rtw_mi_get_assoc_if_num(padapter) != 1) -+ return; -+ -+#ifndef CONFIG_FW_MULTI_PORT_SUPPORT -+ /* Skip lps enter request for adapter not port0 */ -+ if (get_hw_port(padapter) != HW_PORT0) -+ return; -+#endif -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (PS_RDY_CHECK(dvobj->padapters[i]) == _FALSE) -+ return; -+ } -+ -+#ifdef CONFIG_CLIENT_PORT_CFG -+ if ((rtw_hal_get_port(padapter) == CLT_PORT_INVALID) || -+ get_clt_num(padapter) > MAX_CLIENT_PORT_NUM){ -+ RTW_ERR(ADPT_FMT" cannot get client port or clt num(%d) over than 4\n", ADPT_ARG(padapter), get_clt_num(padapter)); -+ return; -+ } -+#endif -+ -+#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) { -+ -+#ifdef CONFIG_WMMPS_STA -+ if (rtw_is_wmmps_mode(padapter)) -+ msg = "WMMPS_IDLE"; -+#endif /* CONFIG_WMMPS_STA */ -+ -+ sprintf(buf, "WIFI-%s", msg); -+ pwrpriv->bpower_saving = _TRUE; -+ -+#ifdef CONFIG_RTW_CFGVENDOR_LLSTATS -+ pwrpriv->pwr_saving_start_time = rtw_get_current_time(); -+#endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ -+ -+ rtw_set_ps_mode(padapter, pwrpriv->power_mgnt, padapter->registrypriv.smart_ps, 0, buf); -+ -+#ifdef CONFIG_PCI_DYNAMIC_ASPM -+ if (msg != LPS_CTRL_PHYDM) -+ rtw_pci_dynamic_aspm_set_mode(padapter, ASPM_MODE_PS); -+#endif -+ } -+ } 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); -+ char buf[32] = {0}; -+#ifdef DBG_CHECK_FW_PS_STATE -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+#endif -+ -+ -+ /* 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) { -+#ifdef CONFIG_PCI_DYNAMIC_ASPM -+ if (msg != LPS_CTRL_PHYDM) -+ rtw_pci_dynamic_aspm_set_mode(padapter, ASPM_MODE_PERF); -+#endif -+#ifdef CONFIG_WMMPS_STA -+ if (rtw_is_wmmps_mode(padapter)) -+ msg = "WMMPS_BUSY"; -+#endif /* CONFIG_WMMPS_STA */ -+ -+ sprintf(buf, "WIFI-%s", msg); -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, buf); -+ -+#ifdef CONFIG_RTW_CFGVENDOR_LLSTATS -+ pwrpriv->pwr_saving_time += rtw_get_passing_time_ms(pwrpriv->pwr_saving_start_time); -+#endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ -+ } -+ } -+ -+ 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"); */ -+ -+} -+ -+#ifdef CONFIG_WOWLAN -+void rtw_wow_lps_level_decide(_adapter *adapter, u8 wow_en) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ -+ if (wow_en) { -+ pwrpriv->lps_level_bk = pwrpriv->lps_level; -+ pwrpriv->lps_level = pwrpriv->wowlan_lps_level; -+ #ifdef CONFIG_LPS_1T1R -+ pwrpriv->lps_1t1r_bk = pwrpriv->lps_1t1r; -+ pwrpriv->lps_1t1r = pwrpriv->wowlan_lps_1t1r; -+ #endif -+ } else { -+ pwrpriv->lps_level = pwrpriv->lps_level_bk; -+ #ifdef CONFIG_LPS_1T1R -+ pwrpriv->lps_1t1r = pwrpriv->lps_1t1r_bk; -+ #endif -+ } -+} -+#endif /* CONFIG_WOWLAN */ -+#endif /* CONFIG_LPS */ -+ -+void LeaveAllPowerSaveModeDirect(PADAPTER Adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); -+ PADAPTER pri_padapter = GET_PRIMARY_ADAPTER(Adapter); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); -+#ifdef CONFIG_LPS_LCLK -+#ifndef CONFIG_DETECT_CPWM_BY_POLLING -+ u8 cpwm_orig; -+#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ -+ u8 rpwm; -+#endif -+ int i; -+ -+ 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 */ -+ rpwm = rtw_set_rpwm(Adapter, PS_STATE_S4); -+ -+#ifndef CONFIG_DETECT_CPWM_BY_POLLING -+ if (rpwm != 0xFF && rpwm & PS_ACK) -+ rtw_cpwm_polling(Adapter, rpwm, cpwm_orig); -+#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ -+ -+ _exit_pwrlock(&pwrpriv->lock); -+#endif/*CONFIG_LPS_LCLK*/ -+ -+#ifdef CONFIG_P2P_PS -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ _adapter *iface = dvobj->padapters[i]; -+ struct wifidirect_info *pwdinfo = &(iface->wdinfo); -+ -+ if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) -+ p2p_ps_wk_cmd(iface, P2P_PS_DISABLE, 0); -+ } -+#endif /* CONFIG_P2P_PS */ -+ -+#ifdef CONFIG_LPS -+ rtw_lps_ctrl_wk_cmd(pri_padapter, LPS_CTRL_LEAVE, RTW_CMDF_DIRECTLY); -+#endif -+ } else { -+ if (pwrpriv->rf_pwrstate == rf_off) { -+ -+#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_RTL8188E) || defined(CONFIG_PNO_SUPPORT) -+#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(PADAPTER Adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); -+ u8 enqueue = 0; -+ int i; -+ -+ #ifndef CONFIG_NEW_NETDEV_HDL -+ if (_FALSE == Adapter->bup) { -+ RTW_INFO(FUNC_ADPT_FMT ": bup=%d Skip!\n", -+ FUNC_ADPT_ARG(Adapter), Adapter->bup); -+ return; -+ } -+ #endif -+ -+/* RTW_INFO(FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(Adapter));*/ -+ -+ if (rtw_is_surprise_removed(Adapter)) { -+ RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=_TRUE Skip!\n", FUNC_ADPT_ARG(Adapter)); -+ return; -+ } -+ -+ if (rtw_mi_get_assoc_if_num(Adapter)) { -+ /* connect */ -+#ifdef CONFIG_LPS_LCLK -+ enqueue = 1; -+#endif -+ -+#ifdef CONFIG_P2P_PS -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ _adapter *iface = dvobj->padapters[i]; -+ struct wifidirect_info *pwdinfo = &(iface->wdinfo); -+ -+ if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) -+ p2p_ps_wk_cmd(iface, P2P_PS_DISABLE, enqueue); -+ } -+#endif /* CONFIG_P2P_PS */ -+ -+#ifdef CONFIG_LPS -+ rtw_lps_ctrl_wk_cmd(Adapter, LPS_CTRL_LEAVE, enqueue ? 0 : RTW_CMDF_DIRECTLY); -+#endif -+ -+#ifdef CONFIG_LPS_LCLK -+ LPS_Leave_check(Adapter); -+#endif -+ } else { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate == rf_off) { -+ -+#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; -+ systime 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_ERR("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; -+ -+ if (!padapter) -+ goto exit; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ goto exit; -+ -+ 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_get_primary_adapter(dvobj); -+ struct reportpwrstate_parm report; -+ -+ /* RTW_INFO("%s\n",__FUNCTION__); */ -+ -+ report.state = PS_STATE_S2; -+ cpwm_int_hdl(adapter, &report); -+} -+ -+static void dma_event_callback(struct work_struct *work) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, dma_event); -+ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); -+ _adapter *adapter = dvobj_get_primary_adapter(dvobj); -+ -+ rtw_unregister_tx_alive(adapter); -+} -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ -+#define DBG_CPWM_CHK_FAIL -+#if defined(DBG_CPWM_CHK_FAIL) && (defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) \ -+ || defined(CONFIG_RTL8723F)) -+#define CPU_EXCEPTION_CODE 0xFAFAFAFA -+static void rtw_cpwm_chk_fail_debug(_adapter *padapter) -+{ -+ u32 cpu_state; -+ -+ cpu_state = rtw_read32(padapter, 0x10FC); -+ -+ RTW_INFO("[PS-DBG] Reg_10FC =0x%08x\n", cpu_state); -+ RTW_INFO("[PS-DBG] Reg_10F8 =0x%08x\n", rtw_read32(padapter, 0x10F8)); -+ RTW_INFO("[PS-DBG] Reg_11F8 =0x%08x\n", rtw_read32(padapter, 0x11F8)); -+ RTW_INFO("[PS-DBG] Reg_4A4 =0x%08x\n", rtw_read32(padapter, 0x4A4)); -+ RTW_INFO("[PS-DBG] Reg_4A8 =0x%08x\n", rtw_read32(padapter, 0x4A8)); -+ -+ if (cpu_state == CPU_EXCEPTION_CODE) { -+ RTW_INFO("[PS-DBG] Reg_48C =0x%08x\n", rtw_read32(padapter, 0x48C)); -+ RTW_INFO("[PS-DBG] Reg_490 =0x%08x\n", rtw_read32(padapter, 0x490)); -+ RTW_INFO("[PS-DBG] Reg_494 =0x%08x\n", rtw_read32(padapter, 0x494)); -+ RTW_INFO("[PS-DBG] Reg_498 =0x%08x\n", rtw_read32(padapter, 0x498)); -+ RTW_INFO("[PS-DBG] Reg_49C =0x%08x\n", rtw_read32(padapter, 0x49C)); -+ RTW_INFO("[PS-DBG] Reg_4A0 =0x%08x\n", rtw_read32(padapter, 0x4A0)); -+ RTW_INFO("[PS-DBG] Reg_1BC =0x%08x\n", rtw_read32(padapter, 0x1BC)); -+ -+ RTW_INFO("[PS-DBG] Reg_008 =0x%08x\n", rtw_read32(padapter, 0x08)); -+ RTW_INFO("[PS-DBG] Reg_2F0 =0x%08x\n", rtw_read32(padapter, 0x2F0)); -+ RTW_INFO("[PS-DBG] Reg_2F4 =0x%08x\n", rtw_read32(padapter, 0x2F4)); -+ RTW_INFO("[PS-DBG] Reg_2F8 =0x%08x\n", rtw_read32(padapter, 0x2F8)); -+ RTW_INFO("[PS-DBG] Reg_2FC =0x%08x\n", rtw_read32(padapter, 0x2FC)); -+ -+ rtw_dump_fifo(RTW_DBGDUMP, padapter, 5, 0, 3072); -+ } -+} -+#endif -+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_get_primary_adapter(dvobj); -+ -+ if (!padapter) -+ return; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ return; -+ -+ _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; -+ } -+ -+ if (pwrpriv->rpwm_retry++ < LPS_RPWM_RETRY_CNT) { -+ u8 rpwm = (pwrpriv->rpwm | pwrpriv->tog | PS_ACK); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); -+ -+ pwrpriv->tog += 0x80; -+ _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_CPWM_TIMEOUT_MS); -+ goto exit; -+ } -+ -+ pwrpriv->rpwm_retry = 0; -+ _exit_pwrlock(&pwrpriv->lock); -+ -+#if defined(DBG_CPWM_CHK_FAIL) && (defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) \ -+ || defined(CONFIG_RTL8723F)) -+ RTW_INFO("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ rtw_cpwm_chk_fail_debug(padapter); -+#endif -+ -+ 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); -+ if (!padapter) -+ return; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ return; -+ -+ 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) -+{ -+#ifdef CONFIG_LPS_1T1R -+#define LPS_1T1R_FMT ", LPS_1T1R=%d" -+#define LPS_1T1R_ARG , pwrctrlpriv->lps_1t1r -+#else -+#define LPS_1T1R_FMT "" -+#define LPS_1T1R_ARG -+#endif -+ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+#ifdef CONFIG_WOWLAN -+ struct registry_priv *registry_par = &padapter->registrypriv; -+#endif -+#ifdef CONFIG_GPIO_WAKEUP -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+#endif -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (!is_primary_adapter(padapter)) -+ return; -+#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; -+#ifdef CONFIG_LPS_CHK_BY_TP -+ pwrctrlpriv->lps_chk_by_tp = padapter->registrypriv.lps_chk_by_tp; -+ pwrctrlpriv->lps_tx_tp_th = LPS_TX_TP_TH; -+ pwrctrlpriv->lps_rx_tp_th = LPS_RX_TP_TH; -+ pwrctrlpriv->lps_bi_tp_th = LPS_BI_TP_TH; -+ pwrctrlpriv->lps_chk_cnt = pwrctrlpriv->lps_chk_cnt_th = LPS_TP_CHK_CNT; -+ pwrctrlpriv->lps_tx_pkts = LPS_CHK_PKTS_TX; -+ pwrctrlpriv->lps_rx_pkts = LPS_CHK_PKTS_RX; -+#endif -+ -+ pwrctrlpriv->ips_mode = padapter->registrypriv.ips_mode; -+ pwrctrlpriv->ips_mode_req = padapter->registrypriv.ips_mode; -+ pwrctrlpriv->ips_deny_time = rtw_get_current_time(); -+ pwrctrlpriv->lps_level = padapter->registrypriv.lps_level; -+#ifdef CONFIG_LPS_1T1R -+ pwrctrlpriv->lps_1t1r = padapter->registrypriv.lps_1t1r; -+#endif -+ -+ pwrctrlpriv->pwr_state_check_interval = RTW_PWR_STATE_CHK_INTERVAL; -+ pwrctrlpriv->pwr_state_check_cnts = 0; -+ pwrctrlpriv->bInSuspend = _FALSE; -+ pwrctrlpriv->bkeepfwalive = _FALSE; -+ pwrctrlpriv->LpsIdleCount = 0; -+ -+ /* 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->lps_deny_time = rtw_get_current_time(); -+ -+ 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; -+ pwrctrlpriv->rpwm_retry = 0; -+ -+ RTW_INFO("%s: IPS_mode=%d, LPS_mode=%d, LPS_level=%d"LPS_1T1R_FMT"\n", -+ __func__, pwrctrlpriv->ips_mode, pwrctrlpriv->power_mgnt, pwrctrlpriv->lps_level -+ LPS_1T1R_ARG -+ ); -+ -+#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); -+ -+ _init_workitem(&pwrctrlpriv->dma_event, dma_event_callback, NULL); -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ pwrctrlpriv->brpwmtimeout = _FALSE; -+ _init_workitem(&pwrctrlpriv->rpwmtimeoutwi, rpwmtimeout_workitem_callback, NULL); -+ rtw_init_timer(&pwrctrlpriv->pwr_rpwm_timer, padapter, pwr_rpwm_timeout_handler, padapter); -+#endif /* CONFIG_LPS_RPWM_TIMER */ -+#endif /* CONFIG_LPS_LCLK */ -+ -+#ifdef CONFIG_LPS_PG -+ pwrctrlpriv->lpspg_info.name = "LPSPG_INFO"; -+ #ifdef CONFIG_RTL8822C -+ pwrctrlpriv->lpspg_dpk_info.name = "LPSPG_DPK_INFO"; -+ pwrctrlpriv->lpspg_iqk_info.name = "LPSPG_IQK_INFO"; -+ #endif -+#endif -+ -+ rtw_init_timer(&pwrctrlpriv->pwr_state_check_timer, padapter, pwr_state_check_handler, padapter); -+ -+ pwrctrlpriv->wowlan_mode = _FALSE; -+ pwrctrlpriv->wowlan_ap_mode = _FALSE; -+ pwrctrlpriv->wowlan_p2p_mode = _FALSE; -+ pwrctrlpriv->wowlan_in_resume = _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_GPIO_WAKEUP -+ pwrctrlpriv->wowlan_gpio_index = WAKEUP_GPIO_IDX; -+ /* set output low state in initial */ -+ pwrctrlpriv->wowlan_gpio_output_state = GPIO_OUTPUT_LOW; -+ /*default low active*/ -+ pwrctrlpriv->is_high_active = HIGH_ACTIVE_DEV2HST; -+ pwrctrlpriv->hst2dev_high_active = HIGH_ACTIVE_HST2DEV; -+ -+#if (defined(CONFIG_RTL8192F) && defined(CONFIG_USB_HCI) && defined(CONFIG_BT_COEXIST)) -+ if (pHalData->EEPROMBluetoothCoexist == _TRUE) { -+ /* for 8725AU case */ -+ pwrctrlpriv->wowlan_gpio_index = WAKEUP_GPIO_IDX_8725AU; -+ pwrctrlpriv->is_high_active = HIGH_ACTIVE_DEV2HST_8725AU; -+ } -+#endif -+#ifdef CONFIG_RTW_ONE_PIN_GPIO -+ rtw_hal_switch_gpio_wl_ctrl(padapter, pwrctrlpriv->wowlan_gpio_index, _TRUE); -+ rtw_hal_set_input_gpio(padapter, pwrctrlpriv->wowlan_gpio_index); -+#else -+ #ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE -+ if (pwrctrlpriv->is_high_active == 0) -+ rtw_hal_set_input_gpio(padapter, pwrctrlpriv->wowlan_gpio_index); -+ else -+ rtw_hal_set_output_gpio(padapter, pwrctrlpriv->wowlan_gpio_index, -+ GPIO_OUTPUT_LOW); -+ #else -+ rtw_hal_set_output_gpio(padapter, pwrctrlpriv->wowlan_gpio_index -+ , pwrctrlpriv->wowlan_gpio_output_state); -+ rtw_hal_switch_gpio_wl_ctrl(padapter, pwrctrlpriv->wowlan_gpio_index, _TRUE); -+ RTW_INFO("%s: set GPIO_%d to OUTPUT %s state in initial and %s_ACTIVE.\n", -+ __func__, pwrctrlpriv->wowlan_gpio_index, -+ pwrctrlpriv->wowlan_gpio_output_state ? "HIGH" : "LOW", -+ pwrctrlpriv->is_high_active ? "HIGI" : "LOW"); -+ #endif /*CONFIG_WAKEUP_GPIO_INPUT_MODE*/ -+#endif /* CONFIG_RTW_ONE_PIN_GPIO */ -+#endif /* CONFIG_GPIO_WAKEUP */ -+ -+#ifdef CONFIG_WOWLAN -+#ifdef CONFIG_LPS_1T1R -+#define WOW_LPS_1T1R_FMT ", WOW_LPS_1T1R=%d" -+#define WOW_LPS_1T1R_ARG , pwrctrlpriv->wowlan_lps_1t1r -+#else -+#define WOW_LPS_1T1R_FMT "" -+#define WOW_LPS_1T1R_ARG -+#endif -+ -+ pwrctrlpriv->wowlan_power_mgmt = padapter->registrypriv.wow_power_mgnt; -+ pwrctrlpriv->wowlan_lps_level = padapter->registrypriv.wow_lps_level; -+#ifdef CONFIG_LPS_1T1R -+ pwrctrlpriv->wowlan_lps_1t1r = padapter->registrypriv.wow_lps_1t1r; -+#endif -+ -+ RTW_INFO("%s: WOW_LPS_mode=%d, WOW_LPS_level=%d"WOW_LPS_1T1R_FMT"\n", -+ __func__, pwrctrlpriv->wowlan_power_mgmt, pwrctrlpriv->wowlan_lps_level -+ WOW_LPS_1T1R_ARG -+ ); -+ -+ if (registry_par->wakeup_event & BIT(1)) -+ pwrctrlpriv->default_patterns_en = _TRUE; -+ else -+ pwrctrlpriv->default_patterns_en = _FALSE; -+ -+ rtw_wow_pattern_sw_reset(padapter); -+#ifdef CONFIG_PNO_SUPPORT -+ pwrctrlpriv->pno_inited = _FALSE; -+ pwrctrlpriv->pnlo_info = NULL; -+ #ifndef RTW_HALMAC -+ pwrctrlpriv->pscan_info = NULL; -+ #endif -+ pwrctrlpriv->pno_ssid_list = NULL; -+#endif /* CONFIG_PNO_SUPPORT */ -+#ifdef CONFIG_WOW_PATTERN_HW_CAM -+ _rtw_mutex_init(&pwrctrlpriv->wowlan_pattern_cam_mutex); -+#endif -+ -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ pwrctrlpriv->wowlan_keep_alive_ack_index = 0xFF; -+ pwrctrlpriv->wowlan_wake_pattern_index = 0xFF; -+#endif/*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ pwrctrlpriv->wowlan_aoac_rpt_loc = 0; -+#ifdef CONFIG_WAR_OFFLOAD -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+ rtw_wow_war_mdns_parms_reset(padapter, _TRUE); -+#endif /* defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) */ -+#endif /* CONFIG_WAR_OFFLOAD */ -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_LPS_POFF -+ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_POFF_INIT, 0); -+#endif -+ -+#ifdef CONFIG_LPS_ACK -+ _rtw_mutex_init(&pwrctrlpriv->lps_ack_mutex); -+ pwrctrlpriv->lps_ack_status = -1; -+#endif /* CONFIG_LPS_ACK */ -+} -+ -+ -+void rtw_free_pwrctrl_priv(PADAPTER adapter) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(adapter); -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (!is_primary_adapter(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_LPS_LCLK -+ _cancel_workitem_sync(&pwrctrlpriv->cpwm_event); -+ _cancel_workitem_sync(&pwrctrlpriv->dma_event); -+ #ifdef CONFIG_LPS_RPWM_TIMER -+ _cancel_workitem_sync(&pwrctrlpriv->rpwmtimeoutwi); -+ #endif -+#endif /* CONFIG_LPS_LCLK */ -+ -+#ifdef CONFIG_LPS_PG -+ rsvd_page_cache_free(&pwrctrlpriv->lpspg_info); -+ #ifdef CONFIG_RTL8822C -+ rsvd_page_cache_free(&pwrctrlpriv->lpspg_dpk_info); -+ rsvd_page_cache_free(&pwrctrlpriv->lpspg_iqk_info); -+ #endif -+#endif -+ -+#ifdef CONFIG_WOWLAN -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrctrlpriv->pnlo_info != NULL) -+ printk("****** pnlo_info memory leak********\n"); -+ -+ #ifndef RTW_HALMAC -+ if (pwrctrlpriv->pscan_info != NULL) -+ printk("****** pscan_info memory leak********\n"); -+ #endif -+ -+ if (pwrctrlpriv->pno_ssid_list != NULL) -+ printk("****** pno_ssid_list memory leak********\n"); -+#endif -+#ifdef CONFIG_WOW_PATTERN_HW_CAM -+ _rtw_mutex_free(&pwrctrlpriv->wowlan_pattern_cam_mutex); -+#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_LPS_ACK -+ _rtw_mutex_free(&pwrctrlpriv->lps_ack_mutex); -+#endif /* CONFIG_LPS_ACK */ -+} -+ -+#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_get_primary_adapter(dvobj); -+ -+ 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_get_primary_adapter(dvobj); -+ -+ 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_get_primary_adapter(dvobj); -+ -+ 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; -+ systime start = rtw_get_current_time(); -+ -+ /*RTW_INFO(FUNC_ADPT_FMT "===>\n", FUNC_ADPT_ARG(padapter));*/ -+ /* for LPS */ -+ LeaveAllPowerSaveMode(padapter); -+ -+ /* IPS still bound with primary adapter */ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+ -+ if (rtw_time_after(rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms), pwrpriv->ips_deny_time)) -+ 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->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 (_TRUE == pwrpriv->bInSuspend) { -+ ret = _FAIL; -+ goto exit; -+ } -+ /* I think this should be check in IPS, LPS, autosuspend functions... */ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ ret = _SUCCESS; -+ goto exit; -+ } -+ -+ if (rf_off == pwrpriv->rf_pwrstate) { -+ -+#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 (rtw_time_after(rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms), pwrpriv->ips_deny_time)) -+ pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); -+ /*RTW_INFO(FUNC_ADPT_FMT "<===\n", FUNC_ADPT_ARG(padapter));*/ -+ 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_lps_level(_adapter *padapter, u8 level) -+{ -+ int ret = 0; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (level < LPS_LEVEL_MAX) { -+ if (pwrctrlpriv->lps_level != level) { -+ #ifdef CONFIG_LPS -+ if (rtw_lps_ctrl_leave_set_level_cmd(padapter, level, RTW_CMDF_WAIT_ACK) != _SUCCESS) -+ #endif -+ pwrctrlpriv->lps_level = level; -+ } -+ } else -+ ret = -EINVAL; -+ -+ return ret; -+} -+ -+#ifdef CONFIG_LPS_1T1R -+int rtw_pm_set_lps_1t1r(_adapter *padapter, u8 en) -+{ -+ int ret = 0; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ en = en ? 1 : 0; -+ if (pwrctrlpriv->lps_1t1r != en) { -+ if (rtw_lps_ctrl_leave_set_1t1r_cmd(padapter, en, RTW_CMDF_WAIT_ACK) != _SUCCESS) -+ pwrctrlpriv->lps_1t1r = en; -+ } -+ -+ return ret; -+} -+#endif -+ -+inline void rtw_set_lps_deny(_adapter *adapter, u32 ms) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ pwrpriv->lps_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ms); -+} -+ -+#ifdef CONFIG_WOWLAN -+int rtw_pm_set_wow_lps(_adapter *padapter, u8 mode) -+{ -+ int ret = 0; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (mode < PS_MODE_NUM) { -+ if (pwrctrlpriv->wowlan_power_mgmt != mode) -+ pwrctrlpriv->wowlan_power_mgmt = mode; -+ } else -+ ret = -EINVAL; -+ -+ return ret; -+} -+int rtw_pm_set_wow_lps_level(_adapter *padapter, u8 level) -+{ -+ int ret = 0; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (level < LPS_LEVEL_MAX) -+ pwrctrlpriv->wowlan_lps_level = level; -+ else -+ ret = -EINVAL; -+ -+ return ret; -+} -+ -+#ifdef CONFIG_LPS_1T1R -+int rtw_pm_set_wow_lps_1t1r(_adapter *padapter, u8 en) -+{ -+ int ret = 0; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ en = en ? 1 : 0; -+ pwrctrlpriv->wowlan_lps_1t1r = en; -+ -+ return ret; -+} -+#endif /* CONFIG_LPS_1T1R */ -+#endif /* CONFIG_WOWLAN */ -+ -+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; -+ -+ /* 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; -+} -+ -+static void _rtw_ssmps(_adapter *adapter, struct sta_info *sta) -+{ -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (MLME_IS_STA(adapter)) { -+ issue_action_SM_PS_wait_ack(adapter , get_my_bssid(&(pmlmeinfo->network)), -+ sta->cmn.sm_ps, 3 , 1); -+ } -+ else if (MLME_IS_AP(adapter)) { -+ -+ } -+ rtw_phydm_ra_registed(adapter, sta); -+} -+void rtw_ssmps_enter(_adapter *adapter, struct sta_info *sta) -+{ -+ if (sta->cmn.sm_ps == SM_PS_STATIC) -+ return; -+ -+ RTW_INFO(ADPT_FMT" STA [" MAC_FMT "]\n", ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); -+ -+ sta->cmn.sm_ps = SM_PS_STATIC; -+ _rtw_ssmps(adapter, sta); -+} -+void rtw_ssmps_leave(_adapter *adapter, struct sta_info *sta) -+{ -+ if (sta->cmn.sm_ps == SM_PS_DISABLE) -+ return; -+ -+ RTW_INFO(ADPT_FMT" STA [" MAC_FMT "] \n", ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); -+ sta->cmn.sm_ps = SM_PS_DISABLE; -+ _rtw_ssmps(adapter, sta); -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_recv.c b/drivers/net/wireless/rtl8821cs/core/rtw_recv.c -new file mode 100755 -index 000000000..b82b2cd7d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_recv.c -@@ -0,0 +1,5026 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+static void rtw_signal_stat_timer_hdl(void *ctx); -+ -+enum { -+ SIGNAL_STAT_CALC_PROFILE_0 = 0, -+ SIGNAL_STAT_CALC_PROFILE_1, -+ SIGNAL_STAT_CALC_PROFILE_2, -+ SIGNAL_STAT_CALC_PROFILE_MAX -+}; -+ -+u8 signal_stat_calc_profile[SIGNAL_STAT_CALC_PROFILE_MAX][3] = { -+ {4, 1}, /* Profile 0 => pre_stat : curr_stat = 4 : 1 */ -+ {3, 7}, /* Profile 1 => pre_stat : curr_stat = 3 : 7 */ -+ {0, 10} /* Profile 2 => pre_stat : curr_stat = 0 : 10 */ -+}; -+ -+#ifndef RTW_SIGNAL_STATE_CALC_PROFILE -+ #define RTW_SIGNAL_STATE_CALC_PROFILE SIGNAL_STAT_CALC_PROFILE_1 -+#endif -+ -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ -+u8 rtw_bridge_tunnel_header[] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 }; -+u8 rtw_rfc1042_header[] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 }; -+static u8 SNAP_ETH_TYPE_IPX[2] = {0x81, 0x37}; -+static u8 SNAP_ETH_TYPE_APPLETALK_AARP[2] = {0x80, 0xf3}; -+#ifdef CONFIG_TDLS -+static u8 SNAP_ETH_TYPE_TDLS[2] = {0x89, 0x0d}; -+#endif -+ -+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); -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+ _rtw_init_sema(&precvpriv->recv_sema, 0); -+ -+#endif -+ -+ _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)); -+ -+ 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_signal_stat_timer_hdl, padapter); -+ -+ 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 */ -+ -+ _rtw_memset(&precvpriv->ip_statistic, 0, -+ sizeof(struct rtw_ip_dbg_cnt_statistic)); -+ -+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); -+#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; -+ precvframe->u.hdr.attrib.phy_info.physts_rpt_valid = _FALSE; -+ -+ 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; -+} -+ -+ -+#ifndef CONFIG_RECVBUF_QUEUE_LOCK_BH -+#ifdef CONFIG_SDIO_HCI -+#define CONFIG_RECVBUF_QUEUE_LOCK_BH 1 -+#else -+#define CONFIG_RECVBUF_QUEUE_LOCK_BH 0 -+#endif -+#endif /* CONFIG_RECVBUF_QUEUE_LOCK_BH */ -+ -+sint rtw_enqueue_recvbuf_to_head(struct recv_buf *precvbuf, _queue *queue) -+{ -+ _irqL irqL; -+ -+#if CONFIG_RECVBUF_QUEUE_LOCK_BH -+ _enter_critical_bh(&queue->lock, &irqL); -+#else -+ _enter_critical_ex(&queue->lock, &irqL); -+#endif -+ -+ rtw_list_delete(&precvbuf->list); -+ rtw_list_insert_head(&precvbuf->list, get_list_head(queue)); -+ -+#if CONFIG_RECVBUF_QUEUE_LOCK_BH -+ _exit_critical_bh(&queue->lock, &irqL); -+#else -+ _exit_critical_ex(&queue->lock, &irqL); -+#endif -+ -+ return _SUCCESS; -+} -+ -+sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, _queue *queue) -+{ -+ _irqL irqL; -+ -+#if CONFIG_RECVBUF_QUEUE_LOCK_BH -+ _enter_critical_bh(&queue->lock, &irqL); -+#else -+ _enter_critical_ex(&queue->lock, &irqL); -+#endif -+ -+ rtw_list_delete(&precvbuf->list); -+ -+ rtw_list_insert_tail(&precvbuf->list, get_list_head(queue)); -+ -+#if CONFIG_RECVBUF_QUEUE_LOCK_BH -+ _exit_critical_bh(&queue->lock, &irqL); -+#else -+ _exit_critical_ex(&queue->lock, &irqL); -+#endif -+ -+ return _SUCCESS; -+ -+} -+ -+struct recv_buf *rtw_dequeue_recvbuf(_queue *queue) -+{ -+ _irqL irqL; -+ struct recv_buf *precvbuf; -+ _list *plist, *phead; -+ -+#if CONFIG_RECVBUF_QUEUE_LOCK_BH -+ _enter_critical_bh(&queue->lock, &irqL); -+#else -+ _enter_critical_ex(&queue->lock, &irqL); -+#endif -+ -+ 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); -+ -+ } -+ -+#if CONFIG_RECVBUF_QUEUE_LOCK_BH -+ _exit_critical_bh(&queue->lock, &irqL); -+#else -+ _exit_critical_ex(&queue->lock, &irqL); -+#endif -+ -+ 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_: -+ case _GCMP_: -+ case _GCMP_256_: -+ case _CCMP_256_: -+ default: -+ prxattrib->key_index = psecuritypriv->dot118021XGrpKeyid; -+ break; -+ } -+ } -+ } -+ -+ if (prxattrib->encrypt && !prxattrib->bdecrypted) { -+ if (GetFrameType(get_recvframe_data(precv_frame)) == WIFI_DATA -+ #ifdef CONFIG_CONCURRENT_MODE -+ && !IS_MCAST(prxattrib->ra) /* bc/mc packets may 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_: -+ case _CCMP_256_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_aes); -+ res = rtw_aes_decrypt(padapter, (u8 *)precv_frame); -+ break; -+ case _GCMP_: -+ case _GCMP_256_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_gcmp); -+ res = rtw_gcmp_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 -+ } -+ -+ #ifdef CONFIG_RTW_MESH -+ if (res != _FAIL -+ && !prxattrib->amsdu -+ && prxattrib->mesh_ctrl_present) -+ res = rtw_mesh_rx_validate_mctrl_non_amsdu(padapter, precv_frame); -+ #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; -+ -+} -+ -+/* VALID_PN_CHK -+ * Return true when PN is legal, otherwise false. -+ * Legal PN: -+ * 1. If old PN is 0, any PN is legal -+ * 2. PN > old PN -+ */ -+#define PN_LESS_CHK(a, b) (((a-b) & 0x800000000000) != 0) -+#define VALID_PN_CHK(new, old) (((old) == 0) || PN_LESS_CHK(old, new)) -+#define CCMPH_2_KEYID(ch) (((ch) & 0x00000000c0000000) >> 30) -+sint recv_ucast_pn_decache(union recv_frame *precv_frame); -+sint recv_ucast_pn_decache(union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_info *sta = precv_frame->u.hdr.psta; -+ struct stainfo_rxcache *prxcache = &sta->sta_recvpriv.rxcache; -+ u8 *pdata = precv_frame->u.hdr.rx_data; -+ 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_) { -+ tmp_iv_hdr = le64_to_cpu(*(u64*)(pdata + pattrib->hdrlen)); -+ pkt_pn = CCMPH_2_PN(tmp_iv_hdr); -+ tmp_iv_hdr = le64_to_cpu(*(u64*)prxcache->iv[tid]); -+ curr_pn = CCMPH_2_PN(tmp_iv_hdr); -+ -+ if (!VALID_PN_CHK(pkt_pn, curr_pn)) { -+ /* return _FAIL; */ -+ } else { -+ prxcache->last_tid = tid; -+ _rtw_memcpy(prxcache->iv[tid], -+ (pdata + pattrib->hdrlen), -+ sizeof(prxcache->iv[tid])); -+ } -+ } -+ -+ 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; -+ 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)) { -+ -+ tmp_iv_hdr = le64_to_cpu(*(u64*)(pdata + pattrib->hdrlen)); -+ key_id = CCMPH_2_KEYID(tmp_iv_hdr); -+ pkt_pn = CCMPH_2_PN(tmp_iv_hdr); -+ -+ curr_pn = le64_to_cpu(*(u64*)psecuritypriv->iv_seq[key_id]); -+ curr_pn &= 0x0000ffffffffffff; -+ -+ if (!VALID_PN_CHK(pkt_pn, curr_pn)) -+ return _FAIL; -+ -+ *(u64*)psecuritypriv->iv_seq[key_id] = cpu_to_le64(pkt_pn); -+ } -+ -+ return _SUCCESS; -+} -+ -+sint recv_decache(union recv_frame *precv_frame) -+{ -+ struct sta_info *psta = precv_frame->u.hdr.psta; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ _adapter *adapter = psta->padapter; -+ sint tid = pattrib->priority; -+ u16 seq_ctrl = ((precv_frame->u.hdr.attrib.seq_num & 0xffff) << 4) | -+ (precv_frame->u.hdr.attrib.frag_num & 0xf); -+ u16 *prxseq; -+ -+ if (tid > 15) -+ return _FAIL; -+ -+ if (pattrib->qos) { -+ if (IS_MCAST(pattrib->ra)) -+ prxseq = &psta->sta_recvpriv.bmc_tid_rxseq[tid]; -+ else -+ prxseq = &psta->sta_recvpriv.rxcache.tid_rxseq[tid]; -+ } else { -+ if (IS_MCAST(pattrib->ra)) { -+ prxseq = &psta->sta_recvpriv.nonqos_bmc_rxseq; -+ #ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" nonqos bmc seq_num:%d\n" -+ , FUNC_ADPT_ARG(adapter), pattrib->seq_num); -+ #endif -+ -+ } else { -+ prxseq = &psta->sta_recvpriv.nonqos_rxseq; -+ #ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" nonqos seq_num:%d\n" -+ , FUNC_ADPT_ARG(adapter), pattrib->seq_num); -+ #endif -+ } -+ } -+ -+ if (seq_ctrl == *prxseq) { -+ /* for non-AMPDU case */ -+ psta->sta_stats.duplicate_cnt++; -+ -+ if (psta->sta_stats.duplicate_cnt % 100 == 0) -+ RTW_INFO("%s: tid=%u seq=%d frag=%d\n", __func__ -+ , tid, precv_frame->u.hdr.attrib.seq_num -+ , precv_frame->u.hdr.attrib.frag_num); -+ -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recv_decache _FAIL for sta="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); -+ #endif -+ return _FAIL; -+ } -+ *prxseq = seq_ctrl; -+ -+ return _SUCCESS; -+} -+ -+void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *psta) -+{ -+#ifdef CONFIG_AP_MODE -+ unsigned char pwrbit; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ -+ pwrbit = GetPwrMgt(ptr); -+ -+ if (pwrbit) { -+ if (!(psta->state & WIFI_SLEEP_STATE)) { -+ /* psta->state |= WIFI_SLEEP_STATE; */ -+ /* rtw_tim_map_set(padapter, pstapriv->sta_dz_bitmap, BIT(psta->cmn.aid)); */ -+ -+ stop_sta_xmit(padapter, psta); -+ /* RTW_INFO_DUMP("to sleep, sta_dz_bitmap=", pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); */ -+ } -+ } else { -+ if (psta->state & WIFI_SLEEP_STATE) { -+ /* psta->state ^= WIFI_SLEEP_STATE; */ -+ /* rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, BIT(psta->cmn.aid)); */ -+ -+ wakeup_sta_to_xmit(padapter, psta, ALL_FRAME); -+ /* RTW_INFO_DUMP("to wakeup, sta_dz_bitmap=", pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); */ -+ } -+ } -+#endif -+} -+ -+void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *psta) -+{ -+#ifdef CONFIG_AP_MODE -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ -+#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->cmn.mac_addr, (u16)pattrib->priority, 0, 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); -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct sta_priv *pstapriv = &(adapter->stapriv); -+ struct sta_info *ptdls_sta = NULL; -+ -+ /* 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 (rtw_is_tdls_enabled(adapter) == _FALSE) { -+ RTW_INFO("recv tdls frame, " -+ "but tdls haven't enabled\n"); -+ ret = _FAIL; -+ return ret; -+ } -+ -+ ptdls_sta = rtw_get_stainfo(pstapriv, get_sa(ptr)); -+ if (ptdls_sta == NULL) { -+ switch (*paction) { -+ case TDLS_SETUP_REQUEST: -+ case TDLS_DISCOVERY_REQUEST: -+ break; -+ default: -+ RTW_INFO("[TDLS] %s - Direct Link Peer = "MAC_FMT" not found for action = %d\n", __func__, MAC_ARG(get_sa(ptr)), *paction); -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ -+ switch (*paction) { -+ case TDLS_SETUP_REQUEST: -+ ret = On_TDLS_Setup_Req(adapter, precv_frame, ptdls_sta); -+ break; -+ case TDLS_SETUP_RESPONSE: -+ ret = On_TDLS_Setup_Rsp(adapter, precv_frame, ptdls_sta); -+ break; -+ case TDLS_SETUP_CONFIRM: -+ ret = On_TDLS_Setup_Cfm(adapter, precv_frame, ptdls_sta); -+ break; -+ case TDLS_TEARDOWN: -+ ret = On_TDLS_Teardown(adapter, precv_frame, ptdls_sta); -+ 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, ptdls_sta); -+ break; -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ ret = On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame, ptdls_sta); -+ break; -+#ifdef CONFIG_TDLS_CH_SW -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ ret = On_TDLS_Ch_Switch_Req(adapter, precv_frame, ptdls_sta); -+ break; -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ ret = On_TDLS_Ch_Switch_Rsp(adapter, precv_frame, ptdls_sta); -+ 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; -+ -+} -+ -+sint rtw_tdls_rx_data_validate_hdr( -+ _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 = pattrib->ta; -+ sint bmcast = IS_MCAST(pattrib->dst); -+ -+ 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; -+ -+ *psta = ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->ta); -+ 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, ptdls_sta); -+ -+ /* if NULL-frame, check pwrbit */ -+ if ((get_frame_sub_type(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 ((get_frame_sub_type(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) -+ process_wmmps_data(adapter, precv_frame, ptdls_sta); -+ -+ ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); -+ -+ } -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_TDLS */ -+ -+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; -+ -+ 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) { -+ u8 is_ra_bmc = IS_MCAST(pattrib->ra); -+ -+ pstats = &psta->sta_stats; -+ -+ pstats->last_rx_time = rtw_get_current_time(); -+ pstats->rx_data_pkts++; -+ pstats->rx_bytes += sz; -+ if (is_broadcast_mac_addr(pattrib->ra)) { -+ pstats->rx_data_bc_pkts++; -+ pstats->rx_bc_bytes += sz; -+ } else if (is_ra_bmc) { -+ pstats->rx_data_mc_pkts++; -+ pstats->rx_mc_bytes += sz; -+ } -+ -+ if (!is_ra_bmc) { -+ pstats->rxratecnt[pattrib->data_rate]++; -+ /*record rx packets for every tid*/ -+ pstats->rx_data_qos_pkts[pattrib->priority]++; -+ } -+#ifdef CONFIG_DYNAMIC_SOML -+ rtw_dyn_soml_byte_update(padapter, pattrib->data_rate, sz); -+#endif -+#if defined(CONFIG_CHECK_LEAVE_LPS) && defined(CONFIG_LPS_CHK_BY_TP) -+ if (adapter_to_pwrctl(padapter)->lps_chk_by_tp) -+ traffic_check_for_leave_lps_by_tp(padapter, _FALSE, psta); -+#endif /* CONFIG_LPS */ -+ -+ } -+ -+#ifdef CONFIG_CHECK_LEAVE_LPS -+#ifdef CONFIG_LPS_CHK_BY_TP -+ if (!adapter_to_pwrctl(padapter)->lps_chk_by_tp) -+#endif -+ traffic_check_for_leave_lps(padapter, _FALSE, 0); -+#endif /* CONFIG_CHECK_LEAVE_LPS */ -+ -+} -+ -+int rtw_sta_rx_data_validate_hdr(_adapter *adapter, union recv_frame *rframe, struct sta_info **sta) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ u8 *mybssid = get_bssid(&adapter->mlmepriv); -+ u8 *myhwaddr = adapter_mac_addr(adapter); -+ struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; -+ u8 *whdr = get_recvframe_data(rframe); -+ u8 is_ra_bmc = IS_MCAST(GetAddr1Ptr(whdr)) ? 1 : 0; -+ sint ret = _FAIL; -+ -+ if (rattrib->to_fr_ds == 0) { -+ _rtw_memcpy(rattrib->ra, GetAddr1Ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->ta, get_addr2_ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->dst, GetAddr1Ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->src, get_addr2_ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->bssid, GetAddr3Ptr(whdr), ETH_ALEN); -+ -+ #ifdef CONFIG_TDLS -+ if (adapter->tdlsinfo.link_established == _TRUE) -+ ret = rtw_tdls_rx_data_validate_hdr(adapter, rframe, sta); -+ else -+ #endif -+ { -+ /* For Station mode, sa and bssid should always be BSSID, and DA is my mac-address */ -+ if (!_rtw_memcmp(rattrib->bssid, rattrib->src, ETH_ALEN)) -+ goto exit; -+ -+ *sta = rtw_get_stainfo(stapriv, get_addr2_ptr(whdr)); -+ if (*sta) -+ ret = _SUCCESS; -+ } -+ goto exit; -+ } -+ -+ if (!(MLME_STATE(adapter) & (WIFI_ASOC_STATE | WIFI_UNDER_LINKING))) { -+ if (!is_ra_bmc) { -+ /* for AP multicast issue , modify by yiwei */ -+ static systime 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(FUNC_ADPT_FMT" issue_deauth to "MAC_FMT" with reason(7), mlme_state:0x%x\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(get_addr2_ptr(whdr)), MLME_STATE(adapter)); -+ issue_deauth(adapter, get_addr2_ptr(whdr), WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ } -+ } -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" fw_state:0x%x\n" -+ , FUNC_ADPT_ARG(adapter), MLME_STATE(adapter)); -+ #endif -+ goto exit; -+ } -+ -+ _rtw_memcpy(rattrib->ra, GetAddr1Ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->ta, get_addr2_ptr(whdr), ETH_ALEN); -+ -+ switch (rattrib->to_fr_ds) { -+ case 2: -+ _rtw_memcpy(rattrib->dst, GetAddr1Ptr(whdr), ETH_ALEN); -+ _rtw_memcpy(rattrib->src, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ -+ _rtw_memcpy(rattrib->bssid, get_addr2_ptr(whdr), ETH_ALEN); -+ break; -+ case 3: -+ _rtw_memcpy(rattrib->dst, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ -+ _rtw_memcpy(rattrib->src, GetAddr4Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ -+ _rtw_memcpy(rattrib->bssid, get_addr2_ptr(whdr), ETH_ALEN); -+ break; -+ default: -+ ret = RTW_RX_HANDLED; /* don't count for drop */ -+ goto exit; -+ } -+ -+ /* filter packets that SA is myself */ -+ if (!rattrib->amsdu && _rtw_memcmp(myhwaddr, rattrib->src, ETH_ALEN)) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" SA="MAC_FMT", myhwaddr="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(rattrib->src), MAC_ARG(myhwaddr)); -+ #endif -+ goto exit; -+ } -+ -+ *sta = rtw_get_stainfo(stapriv, rattrib->ta); -+ if (*sta == NULL) { -+ #ifndef CONFIG_CUSTOMER_ALIBABA_GENERAL -+ if (!is_ra_bmc && !IS_RADAR_DETECTED(adapter_to_rfctl(adapter))) { -+ RTW_INFO(FUNC_ADPT_FMT" issue_deauth to "MAC_FMT" with reason(7), unknown TA\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(rattrib->ta)); -+ issue_deauth(adapter, rattrib->ta, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ } -+ #endif -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" can't get psta under STATION_MODE ; drop pkt\n" -+ , FUNC_ADPT_ARG(adapter)); -+ #endif -+ goto exit; -+ } -+ -+#ifdef CONFIG_RTW_WDS_AUTO_EN -+ if (rattrib->to_fr_ds == 3 && !(sta->flags & WLAN_STA_WDS)) -+ sta->flags |= WLAN_STA_WDS; -+#endif -+ -+ /*if ((get_frame_sub_type(whdr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) { -+ } -+ */ -+ -+ if (get_frame_sub_type(whdr) & BIT(6)) { -+ /* No data, will not indicate to upper layer, temporily count it here */ -+ count_rx_stats(adapter, rframe, *sta); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+#ifdef CONFIG_RTW_WDS -+ if (adapter_use_wds(adapter) -+ && !rattrib->amsdu && IS_MCAST(rattrib->dst) -+ && rtw_rx_wds_gptr_check(adapter, rattrib->src) -+ ) { -+ /* will not indicate to upper layer, temporily count it here */ -+ count_rx_stats(adapter, rframe, *sta); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int rtw_sta_rx_amsdu_act_check(union recv_frame *rframe -+ , const u8 *da, const u8 *sa) -+{ -+ int act = RTW_RX_MSDU_ACT_INDICATE; -+ -+#ifdef CONFIG_RTW_WDS -+ _adapter *adapter = rframe->u.hdr.adapter; -+ -+ if (adapter_use_wds(adapter) -+ && IS_MCAST(da) -+ && rtw_rx_wds_gptr_check(adapter, sa) -+ ) { -+ act = 0; -+ } -+#endif -+ -+ return act; -+} -+ -+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 = pattrib->ta; -+ sint bmcast = IS_MCAST(pattrib->dst); -+ -+ /* 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; -+ } -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) { -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, get_addr2_ptr(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; -+ -+ *psta = rtw_get_stainfo(pstapriv, sta_addr); -+ 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) -+{ -+ 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 *myhwaddr = adapter_mac_addr(adapter); -+ sint bmcast = IS_MCAST(pattrib->dst); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && -+ (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE)) { -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, get_addr2_ptr(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 "FUNC_ADPT_FMT" can't get psta under WIFI_MP_STATE ; drop pkt\n" -+ , FUNC_ADPT_ARG(adapter)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ } else { -+ if (_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN) && (!bmcast)) { -+ *psta = rtw_get_stainfo(pstapriv, pattrib->ta); -+ if (*psta == NULL) { -+ -+ /* for AP multicast issue , modify by yiwei */ -+ static systime 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 "FUNC_ADPT_FMT" fw_state:0x%x\n" -+ , FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); -+ #endif -+ } -+ -+exit: -+ return ret; -+ -+} -+ -+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_MP_STATE) == _TRUE) && -+ (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE)) { -+ /* RTW_INFO("%s ,in WIFI_MP_STATE\n",__func__); */ -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, get_addr2_ptr(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 "FUNC_ADPT_FMT" can't get psta under WIFI_MP_STATE ; drop pkt\n" -+ , FUNC_ADPT_ARG(adapter)); -+ #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; -+ } -+#ifndef CONFIG_CUSTOMER_ALIBABA_GENERAL -+ 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); -+#endif -+ 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; -+ u8 dataq_null = _TRUE; -+ #ifdef CONFIG_RTW_MGMT_QUEUE -+ u8 mgmtq_null = _TRUE; -+ #endif -+ -+ /* 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, get_addr2_ptr(pframe)); -+ if (psta == NULL) -+ return _FAIL; -+ -+ /* for rx pkt statistics */ -+ psta->sta_stats.last_rx_time = rtw_get_current_time(); -+ psta->sta_stats.rx_ctrl_pkts++; -+ -+ /* only handle ps-poll */ -+ if (get_frame_sub_type(pframe) == WIFI_PSPOLL) { -+#ifdef CONFIG_AP_MODE -+ u16 aid; -+ u8 wmmps_ac = 0; -+ -+ aid = GetAid(pframe); -+ if (psta->cmn.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) && (rtw_tim_map_is_set(padapter, pstapriv->sta_dz_bitmap, psta->cmn.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); -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ xmitframe_phead = get_list_head(&psta->mgmt_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); -+ -+ #ifdef DBG_MGMT_QUEUE -+ RTW_INFO("%s seq_num = %u, subtype = 0x%x\n", -+ __func__, pxmitframe->attrib.seqnum, pxmitframe->attrib.subtype); -+ #endif -+ -+ psta->mgmt_sleepq_len--; -+ -+ if (psta->mgmt_sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered = 1; -+ -+ rtw_hal_mgmt_xmitframe_enqueue(padapter, pxmitframe); -+ -+ mgmtq_null = _FALSE; -+ } -+#endif -+ 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\n", psta->sleepq_len); */ -+ /* RTW_INFO_DUMP("handling, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ -+ -+#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); -+ -+ dataq_null = _FALSE; -+ } -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ -+ /* Error handler : TIM is setted, but data queue and management queue is empty. */ -+ if (dataq_null -+ #ifdef CONFIG_RTW_MGMT_QUEUE -+ && mgmtq_null -+ #endif -+ && rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid)) { -+ -+ if (psta->sleepq_len == 0 -+ #ifdef CONFIG_RTW_MGMT_QUEUE -+ && psta->mgmt_sleepq_len == 0 -+ #endif -+ ) { -+ RTW_INFO("No buffered packets to xmit\n"); -+ -+ /* issue nulldata with More data bit = 0 to indicate we have no buffered packets */ -+ issue_nulldata(padapter, psta->cmn.mac_addr, 0, 0, 0); -+ } else { -+ if (psta->sleepq_len != 0) { -+ RTW_INFO("error!psta->sleepq_len=%d\n", psta->sleepq_len); -+ psta->sleepq_len = 0; -+ } -+ #ifdef CONFIG_RTW_MGMT_QUEUE -+ if (psta->mgmt_sleepq_len != 0) { -+ RTW_INFO("error!psta->mgmt_sleepq_len=%d\n", psta->mgmt_sleepq_len); -+ psta->mgmt_sleepq_len = 0; -+ } -+ #endif -+ } -+ } -+ -+ if (psta->sleepq_len == 0 -+ #ifdef CONFIG_RTW_MGMT_QUEUE -+ && psta->mgmt_sleepq_len == 0 -+ #endif -+ ) { -+ rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, psta->cmn.aid); -+ -+ /* upate BCN for TIM IE */ -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0); -+ } -+ } -+#endif /* CONFIG_AP_MODE */ -+ } else if (get_frame_sub_type(pframe) == WIFI_NDPA) { -+#ifdef CONFIG_BEAMFORMING -+ rtw_beamforming_get_ndpa_frame(padapter, precv_frame); -+#endif/*CONFIG_BEAMFORMING*/ -+ } else if (get_frame_sub_type(pframe) == WIFI_BAR) { -+ rtw_process_bar_frame(padapter, precv_frame); -+ } -+ -+ return _FAIL; -+ -+} -+ -+#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) -+static sint validate_mgmt_protect(_adapter *adapter, union recv_frame *precv_frame) -+{ -+#define DBG_VALIDATE_MGMT_PROTECT 0 -+#define DBG_VALIDATE_MGMT_DEC 0 -+ -+ struct security_priv *sec = &adapter->securitypriv; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_info *psta = precv_frame->u.hdr.psta; -+ u8 *ptr; -+ u8 type; -+ u8 subtype; -+ u8 is_bmc; -+ u8 category = 0xFF; -+ -+#ifdef CONFIG_IEEE80211W -+ const u8 *igtk; -+ u16 igtk_id; -+ u64* ipn; -+ enum security_type bip_cipher; -+#endif -+ -+ u8 *mgmt_DATA; -+ u32 data_len = 0; -+ -+ sint ret; -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(adapter)) { -+ if (!adapter->mesh_info.mesh_auth_id) -+ return pattrib->privacy ? _FAIL : _SUCCESS; -+ } else -+#endif -+ if (SEC_IS_BIP_KEY_INSTALLED(sec) == _FALSE) -+ return _SUCCESS; -+ -+ ptr = precv_frame->u.hdr.rx_data; -+ type = GetFrameType(ptr); -+ subtype = get_frame_sub_type(ptr); /* bit(7)~bit(2) */ -+ is_bmc = IS_MCAST(GetAddr1Ptr(ptr)); -+ -+#if DBG_VALIDATE_MGMT_PROTECT -+ if (subtype == WIFI_DEAUTH) { -+ RTW_INFO(FUNC_ADPT_FMT" bmc:%u, deauth, privacy:%u, encrypt:%u, bdecrypted:%u\n" -+ , FUNC_ADPT_ARG(adapter) -+ , is_bmc, pattrib->privacy, pattrib->encrypt, pattrib->bdecrypted); -+ } else if (subtype == WIFI_DISASSOC) { -+ RTW_INFO(FUNC_ADPT_FMT" bmc:%u, disassoc, privacy:%u, encrypt:%u, bdecrypted:%u\n" -+ , FUNC_ADPT_ARG(adapter) -+ , is_bmc, pattrib->privacy, pattrib->encrypt, pattrib->bdecrypted); -+ } if (subtype == WIFI_ACTION) { -+ if (pattrib->privacy) { -+ RTW_INFO(FUNC_ADPT_FMT" bmc:%u, action(?), privacy:%u, encrypt:%u, bdecrypted:%u\n" -+ , FUNC_ADPT_ARG(adapter) -+ , is_bmc, pattrib->privacy, pattrib->encrypt, pattrib->bdecrypted); -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT" bmc:%u, action(%u), privacy:%u, encrypt:%u, bdecrypted:%u\n" -+ , FUNC_ADPT_ARG(adapter), is_bmc -+ , *(ptr + sizeof(struct rtw_ieee80211_hdr_3addr)) -+ , pattrib->privacy, pattrib->encrypt, pattrib->bdecrypted); -+ } -+ } -+#endif -+ -+ if (!pattrib->privacy) { -+ if (!psta || !(psta->flags & WLAN_STA_MFP)) { -+ /* peer is not MFP capable, no need to check */ -+ goto exit; -+ } -+ -+ if (subtype == WIFI_ACTION) -+ category = *(ptr + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ if (is_bmc) { -+ /* broadcast cases */ -+ if (subtype == WIFI_ACTION) { -+ if (CATEGORY_IS_GROUP_PRIVACY(category)) { -+ /* drop broadcast group privacy action frame without encryption */ -+ #if DBG_VALIDATE_MGMT_PROTECT -+ RTW_INFO(FUNC_ADPT_FMT" broadcast gp action(%u) w/o encrypt\n" -+ , FUNC_ADPT_ARG(adapter), category); -+ #endif -+ goto fail; -+ } -+ if (CATEGORY_IS_ROBUST(category)) { -+ /* broadcast robust action frame need BIP check */ -+ goto bip_verify; -+ } -+ } -+ if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC) { -+ /* broadcast deauth or disassoc frame need BIP check */ -+ goto bip_verify; -+ } -+ goto exit; -+ -+ } else { -+ /* unicast cases */ -+ #ifdef CONFIG_IEEE80211W -+ if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC) { -+ if (!MLME_IS_MESH(adapter)) { -+ unsigned short reason = le16_to_cpu(*(unsigned short *)(ptr + WLAN_HDR_A3_LEN)); -+ -+ #if DBG_VALIDATE_MGMT_PROTECT -+ RTW_INFO(FUNC_ADPT_FMT" unicast %s, reason=%d w/o encrypt\n" -+ , FUNC_ADPT_ARG(adapter), subtype == WIFI_DEAUTH ? "deauth" : "disassoc", reason); -+ #endif -+ if (reason == 6 || reason == 7) { -+ /* issue sa query request */ -+ issue_action_SA_Query(adapter, psta->cmn.mac_addr, 0, 0, IEEE80211W_RIGHT_KEY); -+ } -+ } -+ goto fail; -+ } -+ #endif -+ -+ if (subtype == WIFI_ACTION && CATEGORY_IS_ROBUST(category)) { -+ if (psta->bpairwise_key_installed == _TRUE) { -+ #if DBG_VALIDATE_MGMT_PROTECT -+ RTW_INFO(FUNC_ADPT_FMT" unicast robust action(%d) w/o encrypt\n" -+ , FUNC_ADPT_ARG(adapter), category); -+ #endif -+ goto fail; -+ } -+ } -+ goto exit; -+ } -+ -+bip_verify: -+#ifdef CONFIG_IEEE80211W -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(adapter)) { -+ if (psta->igtk_bmp) { -+ bip_cipher = psta->dot11wCipher; -+ igtk = psta->igtk.skey; -+ igtk_id = psta->igtk_id; -+ ipn = &psta->igtk_pn.val; -+ } else { -+ /* mesh MFP without IGTK */ -+ goto exit; -+ } -+ } else -+ #endif -+ { -+ bip_cipher = sec->dot11wCipher; -+ igtk = sec->dot11wBIPKey[sec->dot11wBIPKeyid].skey; -+ igtk_id = sec->dot11wBIPKeyid; -+ ipn = &sec->dot11wBIPrxpn.val; -+ } -+ -+ /* verify BIP MME IE */ -+ ret = rtw_bip_verify(bip_cipher, pattrib->pkt_len, -+ get_recvframe_data(precv_frame), -+ get_recvframe_len(precv_frame), -+ igtk, igtk_id, ipn); -+ -+ if (ret == _FAIL) { -+ /* RTW_INFO("802.11w BIP verify fail\n"); */ -+ goto fail; -+ -+ } else if (ret == RTW_RX_HANDLED) { -+ #if DBG_VALIDATE_MGMT_PROTECT -+ RTW_INFO(FUNC_ADPT_FMT" none protected packet\n", FUNC_ADPT_ARG(adapter)); -+ #endif -+ goto fail; -+ } -+#endif /* CONFIG_IEEE80211W */ -+ goto exit; -+ } -+ -+ if (!psta || !(psta->flags & WLAN_STA_MFP)) { -+ /* not peer or peer is not MFP capable, drop it */ -+ goto fail; -+ } -+ -+ /* cases to decrypt mgmt frame */ -+ pattrib->bdecrypted = 0; -+#ifdef CONFIG_RTW_MESH -+ if (is_bmc) -+ pattrib->encrypt = psta->group_privacy; -+ else -+#endif -+ pattrib->encrypt = psta->dot118021XPrivacy; -+ 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, get_addr2_ptr(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(FUNC_ADPT_FMT" mgmt allocate fail !!!!!!!!!\n", FUNC_ADPT_ARG(adapter)); -+ goto fail; -+ } -+ -+#if DBG_VALIDATE_MGMT_DEC -+ /* 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 DBG_VALIDATE_MGMT_DEC -+ /* 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) { -+ #if DBG_VALIDATE_MGMT_PROTECT -+ RTW_INFO(FUNC_ADPT_FMT" mgmt descrypt fail !!!!!!!!!\n", FUNC_ADPT_ARG(adapter)); -+ #endif -+ goto fail; -+ } -+ -+exit: -+ return _SUCCESS; -+ -+fail: -+ return _FAIL; -+ -+} -+#endif /* defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) */ -+ -+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) -+{ -+ struct sta_info *psta = precv_frame->u.hdr.psta -+ = rtw_get_stainfo(&padapter->stapriv, get_addr2_ptr(precv_frame->u.hdr.rx_data)); -+ -+#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) -+ if (validate_mgmt_protect(padapter, precv_frame) == _FAIL) { -+ DBG_COUNTER(padapter->rx_logs.core_rx_pre_mgmt_err_80211w); -+ goto exit; -+ } -+#endif -+ -+ precv_frame = recvframe_chk_defrag(padapter, precv_frame); -+ if (precv_frame == NULL) -+ return _SUCCESS; -+ -+ /* for rx pkt statistics */ -+ if (psta) { -+ psta->sta_stats.last_rx_time = rtw_get_current_time(); -+ psta->sta_stats.rx_mgnt_pkts++; -+ if (get_frame_sub_type(precv_frame->u.hdr.rx_data) == WIFI_BEACON) -+ psta->sta_stats.rx_beacon_pkts++; -+ else if (get_frame_sub_type(precv_frame->u.hdr.rx_data) == WIFI_PROBEREQ) -+ psta->sta_stats.rx_probereq_pkts++; -+ else if (get_frame_sub_type(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++; -+ } -+ } -+ -+ mgt_dispatcher(padapter, precv_frame); -+ -+#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) -+exit: -+#endif -+ return _SUCCESS; -+ -+} -+ -+sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ u8 bretry, a4_shift; -+ 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); -+ a4_shift = (pattrib->to_fr_ds == 3) ? ETH_ALEN : 0; -+ -+ /* some address fields are different when using AMSDU */ -+ if (pattrib->qos) -+ pattrib->amsdu = GetAMsdu(ptr + WLAN_HDR_A3_LEN + a4_shift); -+ else -+ pattrib->amsdu = 0; -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(adapter)) { -+ ret = rtw_mesh_rx_data_validate_hdr(adapter, precv_frame, &psta); -+ goto pre_validate_status_chk; -+ } else -+#endif -+#ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(adapter)) { -+ ret = rtw_ap_rx_data_validate_hdr(adapter, precv_frame, &psta); -+ goto pre_validate_status_chk; -+ } else -+#endif -+ if (MLME_IS_STA(adapter)) { -+ ret = rtw_sta_rx_data_validate_hdr(adapter, precv_frame, &psta); -+ goto pre_validate_status_chk; -+ } -+ -+ switch (pattrib->to_fr_ds) { -+ case 0: -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, get_addr2_ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); -+ ret = sta2sta_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 1: -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->dst, GetAddr3Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, get_addr2_ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, GetAddr1Ptr(ptr), ETH_ALEN); -+ ret = sta2ap_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 2: -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, GetAddr3Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, get_addr2_ptr(ptr), ETH_ALEN); -+ ret = ap2sta_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 3: -+ default: -+ /* WDS is not supported */ -+ ret = _FAIL; -+ break; -+ } -+ -+pre_validate_status_chk: -+ -+ if (ret == _FAIL) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" case:%d, res:%d, ra="MAC_FMT", ta="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), pattrib->to_fr_ds, ret, MAC_ARG(GetAddr1Ptr(ptr)), MAC_ARG(get_addr2_ptr(ptr))); -+ #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 "FUNC_ADPT_FMT" psta == NULL, ra="MAC_FMT", ta="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(GetAddr1Ptr(ptr)), MAC_ARG(get_addr2_ptr(ptr))); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if ((psta->flags & WLAN_STA_AMSDU_DISABLE) && pattrib->amsdu) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" amsdu not allowed"MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ -+ } -+ -+ precv_frame->u.hdr.psta = psta; -+ precv_frame->u.hdr.preorder_ctrl = NULL; -+ pattrib->ack_policy = 0; -+ -+ /* parsing QC field */ -+ if (pattrib->qos == 1) { -+ pattrib->priority = GetPriority((ptr + WLAN_HDR_A3_LEN + a4_shift)); /* point to Qos field*/ -+ pattrib->ack_policy = GetAckpolicy((ptr + WLAN_HDR_A3_LEN + a4_shift)); -+ pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN + a4_shift; -+ if (pattrib->priority != 0 && pattrib->priority != 3) -+ adapter->recvpriv.is_any_non_be_pkts = _TRUE; -+ else -+ adapter->recvpriv.is_any_non_be_pkts = _FALSE; -+ } else { -+ pattrib->priority = 0; -+ pattrib->hdrlen = WLAN_HDR_A3_LEN + a4_shift; -+ } -+ -+ if (pattrib->order) /* HT-CTRL 11n */ -+ pattrib->hdrlen += 4; -+ -+ /* decache, drop duplicate recv packets */ -+ ret = recv_decache(precv_frame); -+ if (ret == _FAIL) -+ goto exit; -+ -+ if (!IS_MCAST(pattrib->ra)) { -+ -+ if (pattrib->qos) -+ precv_frame->u.hdr.preorder_ctrl = &psta->recvreorder_ctrl[pattrib->priority]; -+ -+ if (recv_ucast_pn_decache(precv_frame) == _FAIL) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recv_ucast_pn_decache return _FAIL for sta="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); -+ #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 return _FAIL for sta="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); -+ #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; -+ } -+ -+ /* drop unprotected frame in protected network. */ -+ if (psecuritypriv->dot11PrivacyAlgrthm != _NO_PRIVACY_ ) { -+ if (IS_MCAST(pattrib->ra)) { -+ if (!pattrib->privacy) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT"recv plaintext bmc packet for sta="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ } else { -+ /* unicast */ -+ u16 ether_type; -+ u8* ether_ptr = NULL; -+ u16 eapol_type = 0x888e; -+ ether_ptr = ptr + pattrib->hdrlen + pattrib->iv_len + RATTRIB_GET_MCTRL_LEN(pattrib) + LLC_HEADER_SIZE; -+ _rtw_memcpy(ðer_type, ether_ptr, 2); -+ ether_type = ntohs((unsigned short)ether_type); -+ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { -+ /* CVE-2020-26140, CVE-2020-26143, CVE-2020-26147, let eapol packet go through*/ -+ if (!pattrib->privacy && ether_type != eapol_type ) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT"recv plaintext unicast packet for sta="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ /* CVE-2020-26144, pevernt plaintext A-MSDU */ -+ /* This can prevent plantext A-MSDU cloacked as an EAPOL frame */ -+ if (!pattrib->privacy && pattrib->amsdu) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT"recv plaintext A-MSDU for sta="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ /* CVE-2020-26139, Drop any forwarding eapol packet until 4-way has done. */ -+ if ((ether_type == eapol_type) -+ && (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) -+ && (psta->dot118021XPrivacy == _NO_PRIVACY_) -+ && (!_rtw_memcmp( adapter_mac_addr(adapter), pattrib->dst, ETH_ALEN))) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recv eapol packet forwarding(dst:"MAC_FMT") before 4-way finish.\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(pattrib->dst)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ } else { -+ /* CVE-2020-26140, CVE-2020-26143, CVE-2020-26147 */ -+ if (!pattrib->privacy -+ #ifdef CONFIG_WAPI_SUPPORT -+ && (0x88b4 != ether_type) /* Let WAI packet pass here */ -+ #endif -+ ) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT"recv plaintext packet for sta="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ } -+ } -+ -+#ifdef CONFIG_RTW_MESH -+ if (!pattrib->amsdu -+ && pattrib->mesh_ctrl_present -+ && (!pattrib->encrypt || pattrib->bdecrypted)) -+ ret = rtw_mesh_rx_validate_mctrl_non_amsdu(adapter, precv_frame); -+#endif -+ -+exit: -+ return ret; -+} -+ -+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; -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ u8 ver = (unsigned char)(*ptr) & 0x3 ; -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ 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_chset_search_ch(rfctl->channel_set, rtw_get_oper_ch(adapter)); -+ if (ch_set_idx >= 0) -+ rfctl->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 = get_frame_sub_type(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); -+ 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, get_addr2_ptr(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) { -+ precvpriv->dbg_rx_drop_count++; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_err); -+ } else if (retval == _SUCCESS) { -+ #ifdef DBG_RX_DUMP_EAP -+ if (!pattrib->encrypt || pattrib->bdecrypted) { -+ 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 + RATTRIB_GET_MCTRL_LEN(pattrib) + 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 "FUNC_ADPT_FMT" fail! type=0x%x\n" -+ , FUNC_ADPT_ARG(adapter), type); -+ #endif -+ retval = _FAIL; -+ break; -+ } -+ -+exit: -+ -+ -+ return retval; -+} -+ -+/* Reture expected handling for LLC */ -+enum rtw_rx_llc_hdl rtw_recv_llc_parse(u8 *msdu, u16 msdu_len) -+{ -+ u16 eth_type; -+ -+ if (msdu_len < 8) -+ return RTW_RX_LLC_KEEP; -+ -+ eth_type = RTW_GET_BE16(msdu + SNAP_SIZE); -+ -+ if ((_rtw_memcmp(msdu, rtw_rfc1042_header, SNAP_SIZE) -+ && eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) -+ || _rtw_memcmp(msdu, rtw_bridge_tunnel_header, SNAP_SIZE)) { -+ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ return RTW_RX_LLC_REMOVE; -+ } else { -+ /* Leave Ethernet header part of hdr and full payload */ -+ return RTW_RX_LLC_KEEP; -+ } -+ -+ /* TODO: VLAN tagged */ -+} -+ -+/* remove the wlanhdr and add the eth_hdr */ -+sint wlanhdr_to_ethhdr(union recv_frame *precvframe, enum rtw_rx_llc_hdl llc_hdl) -+{ -+ u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ sint rmv_len; -+ u16 eth_type, len; -+ sint ret = _SUCCESS; -+ -+ if (pattrib->encrypt) -+ recvframe_pull_tail(precvframe, pattrib->icv_len); -+ -+ rmv_len = pattrib->hdrlen + pattrib->iv_len + RATTRIB_GET_MCTRL_LEN(pattrib) + (llc_hdl ? SNAP_SIZE : 0); -+ len = precvframe->u.hdr.len - rmv_len; -+ -+ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + (llc_hdl ? 2 : 0))); -+ if (!ptr) { -+ ret = _FAIL; -+ goto exiting; -+ } -+ -+ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(ptr + ETH_ALEN, pattrib->src, ETH_ALEN); -+ -+ if (!llc_hdl) { -+ len = htons(len); -+ _rtw_memcpy(ptr + 12, &len, 2); -+ } -+ -+ rtw_rframe_set_os_pkt(precvframe); -+ -+exiting: -+ return ret; -+} -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifndef CONFIG_SDIO_RX_COPY -+#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 /*!= PLATFORM_LINUX*/ -+#warning "recvframe_expand_pkt not implement, defrag may crash system" -+#endif -+#endif /*#ifndef CONFIG_SDIO_RX_COPY*/ -+#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; -+ u8 *pdata = NULL; -+ u64 tmp_iv_hdr = 0; -+ u64 pkt_pn = 0, cur_pn = 0; -+ struct rx_pkt_attrib *pattrib = NULL; -+ -+ 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); -+ /* CVE-2020-26146 */ -+ pattrib = &prframe->u.hdr.attrib; -+ if (pattrib->encrypt == _AES_ || pattrib->encrypt == _CCMP_256_ -+ || pattrib->encrypt == _GCMP_ || pattrib->encrypt == _GCMP_256_ ) { -+ pdata = prframe->u.hdr.rx_data; -+ tmp_iv_hdr = le64_to_cpu(*(u64*)(pdata + pattrib->hdrlen)); -+ /* get the first frame's PN. */ -+ cur_pn = CCMPH_2_PN(tmp_iv_hdr); -+ } -+ 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; -+ /* CVE-2020-26146, check whether the PN is consecutive. */ -+ pattrib = &pnextrframe->u.hdr.attrib; -+ if (pattrib->encrypt == _AES_ || pattrib->encrypt == _CCMP_256_ -+ || pattrib->encrypt == _GCMP_ || pattrib->encrypt == _GCMP_256_ ) { -+ pdata = pnextrframe->u.hdr.rx_data; -+ tmp_iv_hdr = le64_to_cpu(*(u64*)(pdata + pattrib->hdrlen)); -+ pkt_pn = CCMPH_2_PN(tmp_iv_hdr); -+ if (pkt_pn != cur_pn + 1) { -+ RTW_INFO("%s non-consective PN! old:%llu, new:%llu\n", -+ __func__, cur_pn, pkt_pn); -+ /* PN must be consecutive */ -+ /* release the defrag_q & prframe */ -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ return NULL; -+ } else { -+ cur_pn = pkt_pn; -+ } -+ } -+ -+ /* CVE-2020-24587, The keytrack of the fragment is supposed to be the same with other's */ -+ if (pfhdr->keytrack != pnfhdr->keytrack) { -+ RTW_INFO("Inconsistent key track, drop fragmented frame!\n"); -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ return NULL; -+ } -+ -+ /* 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; -+ } -+ -+ /* 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); -+ -+ if ((pfhdr->rx_end - pfhdr->rx_tail) < pnfhdr->len) { -+ RTW_INFO("Not enough buffer space, drop fragmented frame!\n"); -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ return NULL; -+ } -+ -+ curfragnum++; -+ -+ /* 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 = NULL; -+ -+ -+ 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); -+ if (psta) -+ 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 */ -+ } else { -+ /* CVE-2020-26145, group addressed frame cannot use fragmentation!! */ -+ if (IS_MCAST(pfhdr->attrib.ra)) { -+ RTW_INFO("DROP group addressed fragment!\n"); -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ return NULL; -+ } -+ /* CVE-2020-24587 */ -+ if ((psta) && (pdefrag_q)) -+ precv_frame->u.hdr.keytrack = ATOMIC_READ(&psta->keytrack); -+ } -+ -+ 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; -+ -+} -+ -+static int rtw_recv_indicatepkt_check(union recv_frame *rframe, u8 *ehdr_pos, u32 pkt_len) -+{ -+ _adapter *adapter = rframe->u.hdr.adapter; -+ struct recv_priv *recvpriv = &adapter->recvpriv; -+ struct ethhdr *ehdr = (struct ethhdr *)ehdr_pos; -+ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; -+#ifdef DBG_IP_R_MONITOR -+ int i; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+#endif/*DBG_IP_R_MONITOR*/ -+ enum eap_type eapol_type; -+ int ret = _FAIL; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (rtw_wapi_check_for_drop(adapter, rframe, ehdr_pos)) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" rtw_wapi_check_for_drop\n" -+ , FUNC_ADPT_ARG(adapter)); -+ #endif -+ goto exit; -+ } -+#endif -+ -+ if (rframe->u.hdr.psta) -+ rtw_st_ctl_rx(rframe->u.hdr.psta, ehdr_pos); -+ -+ if (ntohs(ehdr->h_proto) == 0x888e) { -+ eapol_type = parsing_eapol_packet(adapter, ehdr_pos + ETH_HLEN, rframe->u.hdr.psta, 0); -+ if ((eapol_type == EAPOL_1_4 || eapol_type == EAPOL_3_4) && pattrib->encrypt == 0) { -+ rframe->u.hdr.psta->resp_nonenc_eapol_key_starttime = rtw_get_current_time(); -+ RTW_INFO("Receive unencrypted eapol key\n"); -+ } -+ } -+#ifdef DBG_ARP_DUMP -+ else if (ntohs(ehdr->h_proto) == ETH_P_ARP) -+ dump_arp_pkt(RTW_DBGDUMP, ehdr->h_dest, ehdr->h_source, ehdr_pos + ETH_HLEN, 0); -+#endif -+ -+ if (recvpriv->sink_udpport > 0) -+ rtw_sink_rtp_seq_dbg(adapter, ehdr_pos); -+ -+#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)) */ -+ -+ if (ntohs(ehdr->h_proto) == 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 (ntohs(ehdr->h_proto) == ETH_P_IP) { -+ if (be16_to_cpu(*((u16 *)(ehdr_pos + 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 *)(ehdr_pos + PAYLOAD_LEN_LOC_OF_IP_HDR)))); -+ RTW_INFO("%s, Pkt real length=%u\n" , __func__ , (pkt_len) - ETH_HLEN); -+ } -+ } -+#endif -+ -+#ifdef DBG_IP_R_MONITOR -+ #define LEN_ARP_OP_HDR 7 /*ARP OERATION */ -+ if (ntohs(ehdr->h_proto) == ETH_P_ARP) { -+ -+ if(check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE){ -+ if(ehdr_pos[ETHERNET_HEADER_SIZE+LEN_ARP_OP_HDR] == 2) { -+ -+ RTW_INFO("%s,[DBG_ARP] Rx ARP RSP Packet;SeqNum = %d !\n", -+ __FUNCTION__, pattrib->seq_num); -+ -+ dump_arp_pkt(RTW_DBGDUMP, ehdr->h_dest, ehdr->h_source, ehdr_pos + ETH_HLEN, 0); -+ -+ } -+ } -+ } -+#endif/*DBG_IP_R_MONITOR*/ -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (ntohs(ehdr->h_proto) == 0x8899) -+ rtw_auto_ap_rx_msg_dump(adapter, rframe, ehdr_pos); -+#endif -+ -+ ret = _SUCCESS; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+exit: -+#endif -+ return ret; -+} -+ -+#if defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) -+static void recv_free_fwd_resource(_adapter *adapter, struct xmit_frame *fwd_frame, _list *f_list) -+{ -+ struct xmit_priv *xmitpriv = &adapter->xmitpriv; -+ -+ if (fwd_frame) -+ rtw_free_xmitframe(xmitpriv, fwd_frame); -+ -+#if defined(CONFIG_RTW_WDS) || CONFIG_RTW_DATA_BMC_TO_UC -+ if (!rtw_is_list_empty(f_list)) { -+ struct xmit_frame *fframe; -+ _list *list; -+ -+ list = get_next(f_list); -+ while (rtw_end_of_queue_search(f_list, list) == _FALSE) { -+ fframe = LIST_CONTAINOR(list, struct xmit_frame, list); -+ list = get_next(list); -+ rtw_list_delete(&fframe->list); -+ rtw_free_xmitframe(xmitpriv, fframe); -+ } -+ } -+#endif -+} -+ -+static void recv_fwd_pkt_hdl(_adapter *adapter, _pkt *pkt -+ , u8 act, struct xmit_frame *fwd_frame, _list *f_list) -+{ -+ struct xmit_priv *xmitpriv = &adapter->xmitpriv; -+ _pkt *fwd_pkt = pkt; -+ -+ if (act & RTW_RX_MSDU_ACT_INDICATE) { -+ fwd_pkt = rtw_os_pkt_copy(pkt); -+ if (!fwd_pkt) { -+ #ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s rtw_os_pkt_copy fail\n", __func__); -+ #endif -+ recv_free_fwd_resource(adapter, fwd_frame, f_list); -+ goto exit; -+ } -+ } -+ -+#if defined(CONFIG_RTW_WDS) || CONFIG_RTW_DATA_BMC_TO_UC -+ if (!rtw_is_list_empty(f_list)) { -+ _list *list = get_next(f_list); -+ struct xmit_frame *fframe; -+ -+ while (rtw_end_of_queue_search(f_list, list) == _FALSE) { -+ fframe = LIST_CONTAINOR(list, struct xmit_frame, list); -+ list = get_next(list); -+ rtw_list_delete(&fframe->list); -+ -+ if (!fwd_frame && rtw_is_list_empty(f_list)) /* the last fwd_pkt */ -+ fframe->pkt = fwd_pkt; -+ else -+ fframe->pkt = rtw_os_pkt_copy(fwd_pkt); -+ if (!fframe->pkt) { -+ rtw_free_xmitframe(xmitpriv, fframe); -+ continue; -+ } -+ -+ rtw_xmit_posthandle(adapter, fframe, fframe->pkt); -+ } -+ } -+#endif -+ -+ if (fwd_frame) { -+ fwd_frame->pkt = fwd_pkt; -+ if (rtw_xmit_posthandle(adapter, fwd_frame, fwd_pkt) < 0) { -+ #ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s rtw_xmit_posthandle fail\n", __func__); -+ #endif -+ xmitpriv->tx_drop++; -+ } -+ } -+ -+exit: -+ return; -+} -+#endif /* defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) */ -+ -+/* -+ * From WFA suggestion: * -+ * If first subframe meets one of the following condition, * -+ * the whole received AMSDU should drop. * -+ * 1. subframe's DA is not the same as RA in From DS case. * -+ * 2. subframe's SA is not the same as TA in To DS case. * -+ * 3. subframe's DA is AA:AA:03:00:00:00 * -+ */ -+static u8 validate_amsdu_content(_adapter *padapter, union recv_frame *prframe, -+ const u8 *da, const u8 *sa) -+{ -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ u8 ret = _SUCCESS; -+ -+ /* Use the recommendation method form Wi-Fi alliance to check subframe */ -+ /* in protected network */ -+ if (padapter->registrypriv.amsdu_mode == RTW_AMSDU_MODE_NON_SPP && -+ padapter->securitypriv.dot11PrivacyAlgrthm != _NO_PRIVACY_) { -+ -+ /* 1.check From DS */ -+ if (pattrib->to_fr_ds == 2) { -+ if (_rtw_memcmp(da, pattrib->ra, ETH_ALEN) == _FALSE) -+ ret = _FAIL; -+ } -+ -+ /* 2.check To DS */ -+ if (pattrib->to_fr_ds == 1) { -+ if (_rtw_memcmp(sa, pattrib->ta, ETH_ALEN) == _FALSE) -+ ret = _FAIL; -+ } -+ -+ /* 3.Check whether DA is AA:AA:03:00:00:00 */ -+ if (_rtw_memcmp(da, rtw_rfc1042_header, ETH_ALEN) == _TRUE) -+ ret = _FAIL; -+ -+ } -+ -+ return ret; -+ -+} -+ -+int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) -+{ -+ struct rx_pkt_attrib *rattrib = &prframe->u.hdr.attrib; -+ 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); -+ const u8 *da, *sa; -+ int act; -+#if defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) -+ struct xmit_frame *fwd_frame; -+ _list f_list; -+#endif -+ enum rtw_rx_llc_hdl llc_hdl; -+ u8 mctrl_len = 0; -+ int ret = _SUCCESS; -+ -+ nr_subframes = 0; -+ -+ recvframe_pull(prframe, rattrib->hdrlen); -+ -+ if (rattrib->iv_len > 0) -+ recvframe_pull(prframe, rattrib->iv_len); -+ if (rattrib->encrypt) -+ recvframe_pull_tail(prframe, rattrib->icv_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; -+ } -+ -+ act = RTW_RX_MSDU_ACT_INDICATE; -+ #if defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) -+ fwd_frame = NULL; -+ #endif -+ -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ u8 *mda = pdata, *msa = pdata + ETH_ALEN; -+ struct rtw_ieee80211s_hdr *mctrl = (struct rtw_ieee80211s_hdr *)(pdata + ETH_HLEN); -+ int v_ret; -+ -+ v_ret = rtw_mesh_rx_data_validate_mctrl(padapter, prframe -+ , mctrl, mda, msa, &mctrl_len, &da, &sa); -+ -+ if (validate_amsdu_content(padapter, prframe, da, sa) == _FAIL) { -+ RTW_INFO("%s check subframe content fail!\n", __func__); -+ break; -+ } -+ -+ if (v_ret != _SUCCESS) -+ goto move_to_next; -+ -+ llc_hdl = rtw_recv_llc_parse(pdata + ETH_HLEN + mctrl_len, nSubframe_Length - mctrl_len); -+ act = rtw_mesh_rx_msdu_act_check(prframe -+ , mda, msa, da, sa, mctrl -+ , pdata + ETH_HLEN + mctrl_len, llc_hdl -+ , &fwd_frame, &f_list); -+ } else -+ #endif -+ { -+ da = pdata; -+ sa = pdata + ETH_ALEN; -+ -+ if (validate_amsdu_content(padapter, prframe, da, sa) == _FAIL) { -+ RTW_INFO("%s check subframe content fail!\n", __func__); -+ break; -+ } -+ -+ llc_hdl = rtw_recv_llc_parse(pdata + ETH_HLEN, nSubframe_Length); -+ #ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(padapter)) { -+ act = rtw_ap_rx_msdu_act_check(prframe, da, sa -+ , pdata + ETH_HLEN, llc_hdl, &fwd_frame, &f_list); -+ } else -+ #endif -+ if (MLME_IS_STA(padapter)) -+ act = rtw_sta_rx_amsdu_act_check(prframe, da, sa); -+ } -+ -+ if (!act) -+ goto move_to_next; -+ -+ rtw_led_rx_control(padapter, da); -+ -+ sub_pkt = rtw_os_alloc_msdu_pkt(prframe, da, sa -+ , pdata + ETH_HLEN + mctrl_len, nSubframe_Length - mctrl_len, llc_hdl); -+ if (sub_pkt == NULL) { -+ if (act & RTW_RX_MSDU_ACT_INDICATE) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s rtw_os_alloc_msdu_pkt fail\n", __func__); -+ #endif -+ } -+ #if defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) -+ if (act & RTW_RX_MSDU_ACT_FORWARD) { -+ #ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s rtw_os_alloc_msdu_pkt fail\n", __func__); -+ #endif -+ recv_free_fwd_resource(padapter, fwd_frame, &f_list); -+ } -+ #endif -+ break; -+ } -+ -+ #if defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) -+ if (act & RTW_RX_MSDU_ACT_FORWARD) { -+ recv_fwd_pkt_hdl(padapter, sub_pkt, act, fwd_frame, &f_list); -+ if (!(act & RTW_RX_MSDU_ACT_INDICATE)) -+ goto move_to_next; -+ } -+ #endif -+ -+ if (rtw_recv_indicatepkt_check(prframe, rtw_os_pkt_data(sub_pkt), rtw_os_pkt_len(sub_pkt)) == _SUCCESS) -+ subframes[nr_subframes++] = sub_pkt; -+ else -+ rtw_os_pkt_free(sub_pkt); -+ -+move_to_next: -+ /* move the data point to data content */ -+ pdata += ETH_HLEN; -+ a_len -= ETH_HLEN; -+ -+ if (nr_subframes >= MAX_SUBFRAME_COUNT) { -+ RTW_WARN("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); -+ } -+ -+ prframe->u.hdr.len = 0; -+ rtw_free_recvframe(prframe, pfree_recv_queue);/* free this recv_frame */ -+ -+ return ret; -+} -+ -+static int recv_process_mpdu(_adapter *padapter, union recv_frame *prframe) -+{ -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ int ret; -+ -+ if (pattrib->amsdu) { -+ ret = amsdu_to_msdu(padapter, prframe); -+ if (ret != _SUCCESS) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" amsdu_to_msdu fail\n" -+ , FUNC_ADPT_ARG(padapter)); -+ #endif -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ goto exit; -+ } -+ } else { -+ u8 *msdu = get_recvframe_data(prframe) -+ + pattrib->hdrlen + pattrib->iv_len + RATTRIB_GET_MCTRL_LEN(pattrib); -+ u16 msdu_len = prframe->u.hdr.len -+ - pattrib->hdrlen - pattrib->iv_len - RATTRIB_GET_MCTRL_LEN(pattrib) -+ - (pattrib->encrypt ? pattrib->icv_len : 0); -+ enum rtw_rx_llc_hdl llc_hdl = rtw_recv_llc_parse(msdu, msdu_len); -+ int act = RTW_RX_MSDU_ACT_INDICATE; -+ -+ #if defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) -+ struct xmit_frame *fwd_frame = NULL; -+ _list f_list; -+ -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ if (pattrib->mesh_ctrl_present) -+ act = rtw_mesh_rx_msdu_act_check(prframe -+ , pattrib->mda, pattrib->msa -+ , pattrib->dst, pattrib->src -+ , (struct rtw_ieee80211s_hdr *)(msdu - RATTRIB_GET_MCTRL_LEN(pattrib)) -+ , msdu, llc_hdl -+ , &fwd_frame, &f_list); -+ } else -+ #endif -+ if (MLME_IS_AP(padapter)) -+ act = rtw_ap_rx_msdu_act_check(prframe, pattrib->dst, pattrib->src -+ , msdu, llc_hdl, &fwd_frame, &f_list); -+ #endif -+ -+ #if defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) -+ if (!act) { -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ ret = _FAIL; -+ goto exit; -+ } -+ #endif -+ -+ rtw_led_rx_control(padapter, pattrib->dst); -+ -+ ret = wlanhdr_to_ethhdr(prframe, llc_hdl); -+ if (ret != _SUCCESS) { -+ if (act & RTW_RX_MSDU_ACT_INDICATE) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" wlanhdr_to_ethhdr: drop pkt\n" -+ , FUNC_ADPT_ARG(padapter)); -+ #endif -+ } -+ #if defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) -+ if (act & RTW_RX_MSDU_ACT_FORWARD) { -+ #ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s wlanhdr_to_ethhdr fail\n", __func__); -+ #endif -+ recv_free_fwd_resource(padapter, fwd_frame, &f_list); -+ } -+ #endif -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ goto exit; -+ } -+ -+ #if defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) -+ if (act & RTW_RX_MSDU_ACT_FORWARD) { -+ recv_fwd_pkt_hdl(padapter, prframe->u.hdr.pkt, act, fwd_frame, &f_list); -+ if (!(act & RTW_RX_MSDU_ACT_INDICATE)) { -+ prframe->u.hdr.pkt = NULL; -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ goto exit; -+ } -+ } -+ #endif -+ -+ if (!RTW_CANNOT_RUN(padapter)) { -+ ret = rtw_recv_indicatepkt_check(prframe -+ , get_recvframe_data(prframe), get_recvframe_len(prframe)); -+ if (ret != _SUCCESS) { -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ goto exit; -+ } -+ -+ /* indicate this recv_frame */ -+ ret = rtw_recv_indicatepkt(padapter, prframe); -+ if (ret != _SUCCESS) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" rtw_recv_indicatepkt fail!\n" -+ , FUNC_ADPT_ARG(padapter)); -+ #endif -+ goto exit; -+ } -+ } else { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" DS:%u SR:%u\n" -+ , FUNC_ADPT_ARG(padapter) -+ , rtw_is_drv_stopped(padapter) -+ , rtw_is_surprise_removed(padapter)); -+ #endif -+ ret = _SUCCESS; /* don't count as packet drop */ -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ } -+ } -+ -+exit: -+ return ret; -+} -+ -+#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) -+static int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num) -+{ -+ PADAPTER padapter = preorder_ctrl->padapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ u8 wsize = preorder_ctrl->wsize_b; -+ u16 wend; -+ -+ /* 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 "FUNC_ADPT_FMT" tid:%u SN_INIT indicate_seq:%d, seq_num:%d\n" -+ , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ } -+ wend = (preorder_ctrl->indicate_seq + wsize - 1) & 0xFFF; /* % 4096; */ -+ -+ /* Drop out the packet which SeqNum is smaller than WinStart */ -+ if (SN_LESS(seq_num, preorder_ctrl->indicate_seq)) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO(FUNC_ADPT_FMT" tid:%u indicate_seq:%d > seq_num:%d\n" -+ , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, 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 "FUNC_ADPT_FMT" tid:%u SN_EQUAL indicate_seq:%d, seq_num:%d\n" -+ , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ -+ } else if (SN_LESS(wend, 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; -+ -+ precvpriv->dbg_rx_ampdu_window_shift_cnt++; -+ #ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_LESS(wend, seq_num) indicate_seq:%d, seq_num:%d\n" -+ , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ } -+ -+ return _TRUE; -+} -+ -+static 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; -+ -+} -+ -+static void recv_indicatepkts_pkt_loss_cnt(_adapter *padapter, u64 prev_seq, u64 current_seq) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ if (current_seq < prev_seq) { -+ precvpriv->dbg_rx_ampdu_loss_count += (4096 + current_seq - prev_seq); -+ precvpriv->rx_drop += (4096 + current_seq - prev_seq); -+ } else { -+ precvpriv->dbg_rx_ampdu_loss_count += (current_seq - prev_seq); -+ precvpriv->rx_drop += (current_seq - prev_seq); -+ } -+} -+ -+static int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced) -+{ -+ /* _irqL irql; */ -+ _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; -+ -+ 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) { -+ precvpriv->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 "FUNC_ADPT_FMT" tid:%u FORCE indicate_seq:%d, seq_num:%d\n" -+ , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ recv_indicatepkts_pkt_loss_cnt(padapter, 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 "FUNC_ADPT_FMT" tid:%u SN_EQUAL indicate_seq:%d, seq_num:%d\n" -+ , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, 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_ex(&preorder_ctrl->reordering_ctrl_timer);\n"); */ -+ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); -+ } -+ } -+#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 (recv_process_mpdu(padapter, prframe) != _SUCCESS) -+ precvpriv->dbg_rx_drop_count++; -+ -+ /* 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; -+ -+} -+ -+static int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe) -+{ -+ _irqL irql; -+ 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 ? &preorder_ctrl->pending_recvframe_queue : NULL; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ if (!pattrib->qos || !preorder_ctrl || preorder_ctrl->enable == _FALSE) -+ goto _success_exit; -+ -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_reoder); -+ -+ _enter_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+ -+ if(rtw_test_and_clear_bit(RTW_RECV_ACK_OR_TIMEOUT, &preorder_ctrl->rec_abba_rsp_ack)) -+ preorder_ctrl->indicate_seq = 0xFFFF; -+ if(rtw_test_and_clear_bit(RTW_RECV_REORDER_WOW, &preorder_ctrl->rec_abba_rsp_ack)) { -+ preorder_ctrl->indicate_seq = 0xFFFF; -+ RTW_INFO("DBG_RX_SEQ %s:preorder_ctrl->rec_abba_rsp_ack = %lu,indicate_seq = %d\n" -+ , __func__ -+ , preorder_ctrl->rec_abba_rsp_ack -+ , preorder_ctrl->indicate_seq); -+ } -+ #ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:preorder_ctrl->rec_abba_rsp_ack = %lu,indicate_seq = %d\n" -+ , __func__ -+ , preorder_ctrl->rec_abba_rsp_ack -+ , preorder_ctrl->indicate_seq); -+ #endif -+ -+ /* s2. check if winstart_b(indicate_seq) needs to been updated */ -+ if (!check_indicate_seq(preorder_ctrl, pattrib->seq_num)) { -+ precvpriv->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 "FUNC_ADPT_FMT" check_indicate_seq fail\n" -+ , FUNC_ADPT_ARG(padapter)); -+ #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 "FUNC_ADPT_FMT" enqueue_reorder_recvframe fail\n" -+ , FUNC_ADPT_ARG(padapter)); -+ #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); -+ } -+ -+ return RTW_RX_HANDLED; -+ -+_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 = NULL; -+ _queue *ppending_recvframe_queue = NULL; -+ -+ -+ if (preorder_ctrl == NULL) -+ return; -+ -+ padapter = preorder_ctrl->padapter; -+ if (RTW_CANNOT_RUN(padapter)) -+ return; -+ -+ ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ -+ /* RTW_INFO("+rtw_reordering_ctrl_timeout_handler()=>\n"); */ -+ -+ _enter_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+ 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); -+ -+} -+#endif /* defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) */ -+ -+static void recv_set_iseq_before_mpdu_process(union recv_frame *rframe, u16 seq_num, const char *caller) -+{ -+#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) -+ struct recv_reorder_ctrl *reorder_ctrl = rframe->u.hdr.preorder_ctrl; -+ -+ if (reorder_ctrl) { -+ reorder_ctrl->indicate_seq = seq_num; -+ #ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s("ADPT_FMT")-B tid:%u indicate_seq:%d, seq_num:%d\n" -+ , caller, ADPT_ARG(reorder_ctrl->padapter) -+ , reorder_ctrl->tid, reorder_ctrl->indicate_seq, seq_num); -+ #endif -+ } -+#endif -+} -+ -+static void recv_set_iseq_after_mpdu_process(union recv_frame *rframe, u16 seq_num, const char *caller) -+{ -+#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) -+ struct recv_reorder_ctrl *reorder_ctrl = rframe->u.hdr.preorder_ctrl; -+ -+ if (reorder_ctrl) { -+ reorder_ctrl->indicate_seq = (reorder_ctrl->indicate_seq + 1) % 4096; -+ #ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s("ADPT_FMT")-A tid:%u indicate_seq:%d, seq_num:%d\n" -+ , caller, ADPT_ARG(reorder_ctrl->padapter) -+ , reorder_ctrl->tid, reorder_ctrl->indicate_seq, seq_num); -+ #endif -+ } -+#endif -+} -+ -+#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; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ u32 i = 0; -+ u8 rtk_prefix[]={0x52, 0x65, 0x61, 0x6C, 0x4C, 0x6F, 0x76, 0x65, 0x54, 0x65, 0x6B}; -+ u8 *prx_data; -+ pmptx = &pmppriv->tx; -+ -+ -+ if (pmppriv->mplink_brx == _FALSE) { -+ -+ u8 bDumpRxPkt = 0; -+ type = GetFrameType(ptr); -+ subtype = get_frame_sub_type(ptr); /* bit(7)~bit(2) */ -+ -+ RTW_DBG("hdr len = %d iv_len=%d \n", pattrib->hdrlen , pattrib->iv_len); -+ prx_data = ptr + pattrib->hdrlen + pattrib->iv_len; -+ -+ for (i = 0; i < precv_frame->u.hdr.len; i++) { -+ if (precv_frame->u.hdr.len < (11 + i)) -+ break; -+ -+ if (_rtw_memcmp(prx_data + i, (void *)&rtk_prefix, 11) == _FALSE) { -+ bDumpRxPkt = 0; -+ RTW_DBG("prx_data = %02X != rtk_prefix[%d] = %02X \n", *(prx_data + i), i , rtk_prefix[i]); -+ } else { -+ bDumpRxPkt = 1; -+ RTW_DBG("prx_data = %02X = rtk_prefix[%d] = %02X \n", *(prx_data + i), i , rtk_prefix[i]); -+ break; -+ } -+ } -+ -+ if (bDumpRxPkt == 1) { /* dump all rx packets */ -+ int i; -+ RTW_INFO("############ type:0x%02x subtype:0x%02x #################\n", type, subtype); -+ -+ for (i = 0; i < precv_frame->u.hdr.len; 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"); -+ _rtw_memset(pmppriv->mplink_buf, '\0' , sizeof(pmppriv->mplink_buf)); -+ _rtw_memcpy(pmppriv->mplink_buf, ptr, precv_frame->u.hdr.len); -+ pmppriv->mplink_rx_len = precv_frame->u.hdr.len; -+ pmppriv->mplink_brx =_TRUE; -+ } -+ } -+ 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 = get_addr2_ptr(ptr); -+ da = GetAddr1Ptr(ptr); -+ bs = GetAddr3Ptr(ptr); -+ type = GetFrameType(ptr); -+ subtype = get_frame_sub_type(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(get_addr2_ptr(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 len; -+ u8 mcastheadermac[] = {0x01, 0x00, 0x5e}; -+ sint ret = _SUCCESS; -+ _adapter *adapter = precvframe->u.hdr.adapter; -+ -+ u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ enum rtw_rx_llc_hdl llc_hdl; -+ -+ -+ if (pattrib->encrypt) -+ recvframe_pull_tail(precvframe, pattrib->icv_len); -+ -+ llc_hdl = rtw_recv_llc_parse(ptr + pattrib->hdrlen + pattrib->iv_len -+ , precvframe->u.hdr.len - pattrib->hdrlen - pattrib->iv_len); -+ -+ rmv_len = pattrib->hdrlen + pattrib->iv_len + (llc_hdl ? SNAP_SIZE : 0); -+ len = precvframe->u.hdr.len - rmv_len; -+ -+ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + (llc_hdl ? 2 : 0))); -+ -+ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(ptr + ETH_ALEN, pattrib->src, ETH_ALEN); -+ -+ if (!llc_hdl) { -+ 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; -+ _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, WIFI_ASOC_STATE) == _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, pbssid, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2ap_data_frame(padapter, rframe, &psta); -+ break; -+ case 2: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); -+ ret = ap2sta_data_frame(padapter, rframe, &psta); -+ break; -+ case 3: -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); -+ ret = _FAIL; -+ break; -+ default: -+ ret = _FAIL; -+ break; -+ } -+ -+ if (ret != _SUCCESS) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" 2_data_frame fail: drop pkt\n" -+ , FUNC_ADPT_ARG(padapter)); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ ret = MPwlanhdr_to_ethhdr(rframe); -+ -+ if (ret != _SUCCESS) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" wlanhdr_to_ethhdr: drop pkt\n" -+ , FUNC_ADPT_ARG(padapter)); -+ #endif -+ 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 "FUNC_ADPT_FMT" rtw_recv_indicatepkt fail!\n" -+ , FUNC_ADPT_ARG(padapter)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ } else { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" bDriverStopped(%s) OR bSurpriseRemoved(%s)\n" -+ , FUNC_ADPT_ARG(padapter) -+ , rtw_is_drv_stopped(padapter) ? "True" : "False" -+ , rtw_is_surprise_removed(padapter) ? "True" : "False"); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ } -+ } -+ } -+exit: -+ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ -+ ret = _FAIL; -+ return ret; -+ -+} -+#endif -+ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+int recv_frame_monitor(_adapter *padapter, union recv_frame *rframe) -+{ -+ int ret = _SUCCESS; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+#ifdef CONFIG_WIFI_MONITOR -+ struct net_device *ndev = padapter->pnetdev; -+ _pkt *pskb = NULL; -+ -+ if (rframe == NULL) -+ goto exit; -+ -+ /* 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); -+ -+ if (ndev->type == ARPHRD_IEEE80211_RADIOTAP) { -+ /* fill radiotap header */ -+ if (rtw_fill_radiotap_hdr(padapter, &rframe->u.hdr.attrib, (u8 *)pskb) == _FAIL) { -+ ret = _FAIL; -+ 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); -+ } else -+ ret = _FAIL; -+ -+exit: -+#endif /* CONFIG_WIFI_MONITOR */ -+ -+ if (rframe) /* free this recv_frame */ -+ rtw_free_recvframe(rframe, pfree_recv_queue); -+ -+ return ret; -+} -+#endif -+int recv_func_prehandle(_adapter *padapter, union recv_frame *rframe) -+{ -+ int ret = _SUCCESS; -+#ifdef DBG_RX_COUNTER_DUMP -+ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; -+#endif -+ _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); -+ -+ prframe = decryptor(padapter, prframe); -+ if (prframe == NULL) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" decryptor: drop pkt\n" -+ , FUNC_ADPT_ARG(padapter)); -+ #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)) -+ RTW_INFO("%s =>"ADPT_FMT" Rx BC/MC from "MAC_FMT"\n", __func__, ADPT_ARG(padapter), MAC_ARG(pattrib->ta)); -+#endif -+ -+#if 0 -+ if (is_primary_adapter(padapter)) { -+ 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 "FUNC_ADPT_FMT" recvframe_chk_defrag: drop pkt\n" -+ , FUNC_ADPT_ARG(padapter)); -+ #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 "FUNC_ADPT_FMT" portctrl: drop pkt\n" -+ , FUNC_ADPT_ARG(padapter)); -+ #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 -+ -+#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) -+ /* including perform A-MPDU Rx Ordering Buffer Control */ -+ ret = recv_indicatepkt_reorder(padapter, prframe); -+ if (ret == _FAIL) { -+ rtw_free_recvframe(orig_prframe, pfree_recv_queue); -+ goto _recv_data_drop; -+ } else if (ret == RTW_RX_HANDLED) /* queued OR indicated in order */ -+ goto _exit_recv_func; -+#endif -+ -+ recv_set_iseq_before_mpdu_process(prframe, pattrib->seq_num, __func__); -+ ret = recv_process_mpdu(padapter, prframe); -+ recv_set_iseq_after_mpdu_process(prframe, pattrib->seq_num, __func__); -+ if (ret == _FAIL) -+ goto _recv_data_drop; -+ -+_exit_recv_func: -+ return ret; -+ -+_recv_data_drop: -+ precvpriv->dbg_rx_drop_count++; -+ return ret; -+} -+ -+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; -+ u8 *ptr = rframe->u.hdr.rx_data; -+#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL -+ u8 type; -+#endif -+ -+ if (check_fwstate(mlmepriv, WIFI_MONITOR_STATE) -+#ifdef RTW_SIMPLE_CONFIG -+ || (check_fwstate(mlmepriv, WIFI_AP_STATE) && padapter->rtw_simple_config == _TRUE && IS_MCAST(get_ra(ptr))) -+#endif -+ ) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+ recv_frame_monitor(padapter, rframe); -+#endif -+ ret = _SUCCESS; -+ goto exit; -+ } -+ -+#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL -+ type = GetFrameType(ptr); -+ if ((type == WIFI_DATA_TYPE)&& check_fwstate(mlmepriv, WIFI_STATION_STATE)) { -+ struct wlan_network *cur_network = &(mlmepriv->cur_network); -+ if ( _rtw_memcmp(get_addr2_ptr(ptr), cur_network->network.MacAddress, ETH_ALEN)==0) { -+ recv_frame_monitor(padapter, rframe); -+ ret = _SUCCESS; -+ goto exit; -+ } -+ } -+#endif -+ /* 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 -+static void rtw_signal_stat_timer_hdl(void *ctx) -+{ -+ _adapter *adapter = (_adapter *)ctx; -+ 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, WIFI_UNDER_SURVEY) == _TRUE -+ || check_fwstate(&adapter->mlmepriv, WIFI_ASOC_STATE) == _FALSE -+ ) -+ goto set_timer; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(adapter, WIFI_UNDER_SURVEY) == _TRUE) -+ goto set_timer; -+#endif -+ if (adapter->registrypriv.mp_mode == 1) -+ ratio_profile = SIGNAL_STAT_CALC_PROFILE_2; -+ else 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) -+{ -+ 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; -+#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ u32 last_rssi, tmp_val; -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ -+ /* RTW_INFO("process_rssi=> pattrib->rssil(%d) signal_strength(%d)\n ",pattrib->recv_signal_power,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.signal_strength; -+ 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.signal_strength; -+ -+ padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index++] = pattrib->phy_info.signal_strength; -+ 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) -+{ -+ struct rx_pkt_attrib *pattrib; -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ struct signal_stat *signal_stat; -+#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ u32 last_evm = 0, tmpVal; -+#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.signal_quality; -+ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; -+ -+#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ if (pattrib->phy_info.signal_quality != 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.signal_quality; -+ -+ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = pattrib->phy_info.signal_quality; -+ 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); -+ struct phydm_phyinfo_struct *p_phy_info = &pattrib->phy_info; -+ u8 *wlanhdr; -+ struct phydm_perpkt_info_struct pkt_info; -+ u8 *ta, *ra; -+ u8 is_ra_bmc; -+ struct sta_priv *pstapriv; -+ struct sta_info *psta = NULL; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ /* _irqL irqL; */ -+ -+ pkt_info.is_packet_match_bssid = _FALSE; -+ pkt_info.is_packet_to_self = _FALSE; -+ pkt_info.is_packet_beacon = _FALSE; -+ pkt_info.ppdu_cnt = pattrib->ppdu_cnt; -+ pkt_info.station_id = 0xFF; -+ -+ wlanhdr = get_recvframe_data(precvframe); -+ -+ ta = get_ta(wlanhdr); -+ ra = get_ra(wlanhdr); -+ is_ra_bmc = IS_MCAST(ra); -+ -+ if (_rtw_memcmp(adapter_mac_addr(padapter), ta, ETH_ALEN) == _TRUE) { -+ static systime 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", get_frame_sub_type(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(); -+ } -+ precvpriv->dbg_rx_conflic_mac_addr_cnt++; -+ } else { -+ pstapriv = &padapter->stapriv; -+ psta = rtw_get_stainfo(pstapriv, ta); -+ if (psta) -+ pkt_info.station_id = psta->cmn.mac_id; -+ } -+ -+ pkt_info.is_packet_match_bssid = (!IsFrameTypeCtrl(wlanhdr)) -+ && (!pattrib->icv_err) && (!pattrib->crc_err) -+ && ((!MLME_IS_MESH(padapter) && _rtw_memcmp(get_hdr_bssid(wlanhdr), get_bssid(&padapter->mlmepriv), ETH_ALEN)) -+ || (MLME_IS_MESH(padapter) && psta)); -+ -+ pkt_info.is_to_self = (!pattrib->icv_err) && (!pattrib->crc_err) -+ && _rtw_memcmp(ra, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ pkt_info.is_packet_to_self = pkt_info.is_packet_match_bssid -+ && _rtw_memcmp(ra, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ pkt_info.is_packet_beacon = pkt_info.is_packet_match_bssid -+ && (get_frame_sub_type(wlanhdr) == WIFI_BEACON); -+ -+ if (psta && IsFrameTypeData(wlanhdr) -+ && !(get_frame_sub_type(wlanhdr) & BIT(6)) /* don't count NULL data */ -+ ) { -+ if (is_ra_bmc) -+ psta->curr_rx_rate_bmc = pattrib->data_rate; -+ else -+ psta->curr_rx_rate = pattrib->data_rate; -+ } -+ pkt_info.data_rate = pattrib->data_rate; -+ -+ odm_phy_status_query(&pHalData->odmpriv, p_phy_info, pphy_status, &pkt_info); -+ -+ /* If bw is initial value, get from phy status */ -+ if (pattrib->bw == CHANNEL_WIDTH_MAX) -+ pattrib->bw = p_phy_info->band_width; -+ -+ if (p_phy_info->physts_rpt_valid == _TRUE) { -+ precvframe->u.hdr.psta = NULL; -+ if (padapter->registrypriv.mp_mode != 1) { -+ if ((!MLME_IS_MESH(padapter) && pkt_info.is_packet_match_bssid) -+ || (MLME_IS_MESH(padapter) && psta)) { -+ if (psta) { -+ precvframe->u.hdr.psta = psta; -+ rx_process_phy_info(padapter, precvframe); -+ } -+ } else if (pkt_info.is_packet_to_self || pkt_info.is_packet_beacon) { -+ if (psta) -+ precvframe->u.hdr.psta = psta; -+ rx_process_phy_info(padapter, precvframe); -+ } -+ } else { -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->mppriv.brx_filter_beacon == _TRUE) { -+ if (pkt_info.is_packet_beacon) { -+ RTW_INFO("in MP Rx is_packet_beacon\n"); -+ if (psta) -+ precvframe->u.hdr.psta = psta; -+ rx_process_phy_info(padapter, precvframe); -+ } -+ } else -+#endif -+ { -+ 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); -+} -+ -+u8 adapter_allow_bmc_data_rx(_adapter *adapter) -+{ -+ if (check_fwstate(&adapter->mlmepriv, WIFI_MONITOR_STATE | WIFI_MP_STATE) == _TRUE) -+ return 1; -+ -+#ifdef RTW_SIMPLE_CONFIG -+ /* allow AP to receive multicast packet for RtwSimpleConfigV4 */ -+ if (MLME_IS_AP(adapter) && adapter->rtw_simple_config) -+ return 1; -+#endif -+ -+ if (MLME_IS_AP(adapter)) -+ return 0; -+ -+ if (rtw_linked_check(adapter) == _FALSE) -+ return 0; -+ -+ return 1; -+} -+ -+s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status) -+{ -+ s32 ret = _SUCCESS; -+ u8 *pbuf = precvframe->u.hdr.rx_data; -+ u8 *ra = get_ra(pbuf); -+ u8 ra_is_bmc = IS_MCAST(ra); -+ bool phy_queried = 0; -+ _adapter *primary_padapter = precvframe->u.hdr.adapter; -+ _adapter *iface = NULL; -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mp_mode_check(primary_padapter)) -+ goto query_phy_status; -+#endif -+#ifdef CONFIG_WIFI_MONITOR -+ if (MLME_IS_MONITOR(primary_padapter)) -+ goto query_phy_status; -+#endif -+ -+ if (ra_is_bmc == _FALSE) { -+ /* UC frame */ -+ iface = rtw_get_iface_by_macddr(primary_padapter , ra); -+ if (!iface) { -+ #if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ if (_rtw_memcmp(ra, adapter_pno_mac_addr(primary_padapter), ETH_ALEN)) -+ goto query_phy_status; -+ #endif -+ -+ #ifdef CONFIG_RTW_MULTI_AP -+ /* unasoc STA RCPI */ -+ if (rtw_unassoc_sta_src_chk(primary_padapter, UNASOC_STA_SRC_RX_NMY_UC)) { -+ if (pphy_status) { -+ rx_query_phy_status(precvframe, pphy_status); -+ rtw_rx_add_unassoc_sta(primary_padapter, UNASOC_STA_SRC_RX_NMY_UC, get_ta(pbuf) -+ , precvframe->u.hdr.attrib.phy_info.recv_signal_power); -+ } -+ } else -+ #endif -+ RTW_INFO("%s [WARN] Cannot find appropriate adapter - mac_addr : "MAC_FMT"\n" -+ , __func__, MAC_ARG(ra)); -+ -+ rtw_free_recvframe(precvframe, &precvframe->u.hdr.adapter->recvpriv.free_recv_queue); -+ goto exit; -+ } -+ #ifdef CONFIG_CONCURRENT_MODE -+ else -+ precvframe->u.hdr.adapter = iface; -+ #endif -+ -+ } else { -+ /* BMC frame */ -+ #ifdef CONFIG_CONCURRENT_MODE -+ rtw_mi_buddy_clone_bcmc_packet(primary_padapter, precvframe, pphy_status); -+ #endif -+ -+ #ifdef CONFIG_RTW_MULTI_AP -+ /* unasoc STA RCPI */ -+ if (pphy_status -+ && rtw_unassoc_sta_src_chk(primary_padapter, UNASOC_STA_SRC_RX_BMC) -+ ) { -+ phy_queried = 1; -+ rx_query_phy_status(precvframe, pphy_status); -+ rtw_rx_add_unassoc_sta(primary_padapter, UNASOC_STA_SRC_RX_BMC, get_ta(pbuf) -+ , precvframe->u.hdr.attrib.phy_info.recv_signal_power); -+ } -+ #endif -+ -+ /* skip unnecessary BMC data frame for primary adapter */ -+ if (GetFrameType(pbuf) == WIFI_DATA_TYPE -+ && !adapter_allow_bmc_data_rx(precvframe->u.hdr.adapter) -+ ) { -+ rtw_free_recvframe(precvframe, &precvframe->u.hdr.adapter->recvpriv.free_recv_queue); -+ goto exit; -+ } -+ } -+#if defined(CONFIG_MP_INCLUDED) || defined(CONFIG_WIFI_MONITOR) || defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+query_phy_status: -+#endif -+ if (pphy_status) { -+ if (!phy_queried) -+ rx_query_phy_status(precvframe, pphy_status); -+ #ifdef CONFIG_WIFI_MONITOR -+ if (MLME_IS_MONITOR(primary_padapter)) -+ rx_query_moinfo(&precvframe->u.hdr.attrib, pphy_status); -+ #endif -+ } -+ -+ ret = rtw_recv_entry(precvframe); -+ -+exit: -+ return ret; -+} -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+thread_return rtw_recv_thread(thread_context context) -+{ -+ _adapter *adapter = (_adapter *)context; -+ struct recv_priv *recvpriv = &adapter->recvpriv; -+ s32 err = _SUCCESS; -+#ifdef RTW_RECV_THREAD_HIGH_PRIORITY -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 9, 0)) -+ sched_set_fifo_low(current); -+#else -+ struct sched_param param = { .sched_priority = 1 }; -+ -+ sched_setscheduler(current, SCHED_FIFO, ¶m); -+#endif -+#endif /* PLATFORM_LINUX */ -+#endif /*RTW_RECV_THREAD_HIGH_PRIORITY*/ -+ thread_enter("RTW_RECV_THREAD"); -+ -+ RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(adapter)); -+ -+ do { -+ err = _rtw_down_sema(&recvpriv->recv_sema); -+ if (_FAIL == err) { -+ RTW_ERR(FUNC_ADPT_FMT" down recv_sema fail!\n", FUNC_ADPT_ARG(adapter)); -+ goto exit; -+ } -+ -+ if (RTW_CANNOT_RUN(adapter)) { -+ RTW_DBG(FUNC_ADPT_FMT "- bDriverStopped(%s) bSurpriseRemoved(%s)\n", -+ FUNC_ADPT_ARG(adapter), -+ rtw_is_drv_stopped(adapter) ? "True" : "False", -+ rtw_is_surprise_removed(adapter) ? "True" : "False"); -+ goto exit; -+ } -+ -+ err = rtw_hal_recv_hdl(adapter); -+ -+ if (err == RTW_RFRAME_UNAVAIL -+ || err == RTW_RFRAME_PKT_UNAVAIL -+ ) { -+ rtw_msleep_os(1); -+ _rtw_up_sema(&recvpriv->recv_sema); -+ } -+ -+ flush_signals_thread(); -+ -+ } while (err != _FAIL); -+ -+exit: -+ -+ RTW_INFO(FUNC_ADPT_FMT " Exit\n", FUNC_ADPT_ARG(adapter)); -+ -+ rtw_thread_wait_stop(); -+ -+ return 0; -+} -+#endif /* CONFIG_RECV_THREAD_MODE */ -+ -+#if DBG_RX_BH_TRACKING -+void rx_bh_tk_set_stage(struct recv_priv *recv, u32 s) -+{ -+ recv->rx_bh_stage = s; -+} -+ -+void rx_bh_tk_set_buf(struct recv_priv *recv, void *buf, void *data, u32 dlen) -+{ -+ if (recv->rx_bh_cbuf) -+ recv->rx_bh_lbuf = recv->rx_bh_cbuf; -+ recv->rx_bh_cbuf = buf; -+ if (buf) { -+ recv->rx_bh_cbuf_data = data; -+ recv->rx_bh_cbuf_dlen = dlen; -+ recv->rx_bh_buf_dq_cnt++; -+ } else { -+ recv->rx_bh_cbuf_data = NULL; -+ recv->rx_bh_cbuf_dlen = 0; -+ } -+} -+ -+void rx_bh_tk_set_buf_pos(struct recv_priv *recv, void *pos) -+{ -+ if (recv->rx_bh_cbuf) { -+ recv->rx_bh_cbuf_pos = pos - recv->rx_bh_cbuf_data; -+ } else { -+ rtw_warn_on(1); -+ recv->rx_bh_cbuf_pos = 0; -+ } -+} -+ -+void rx_bh_tk_set_frame(struct recv_priv *recv, void *frame) -+{ -+ recv->rx_bh_cframe = frame; -+} -+ -+void dump_rx_bh_tk(void *sel, struct recv_priv *recv) -+{ -+ RTW_PRINT_SEL(sel, "[RXBHTK]s:%u, buf_dqc:%u, lbuf:%p, cbuf:%p, dlen:%u, pos:%u, cframe:%p\n" -+ , recv->rx_bh_stage -+ , recv->rx_bh_buf_dq_cnt -+ , recv->rx_bh_lbuf -+ , recv->rx_bh_cbuf -+ , recv->rx_bh_cbuf_dlen -+ , recv->rx_bh_cbuf_pos -+ , recv->rx_bh_cframe -+ ); -+} -+#endif /* DBG_RX_BH_TRACKING */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_rf.c b/drivers/net/wireless/rtl8821cs/core/rtw_rf.c -new file mode 100644 -index 000000000..e5ce9d5e3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_rf.c -@@ -0,0 +1,2489 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#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 -+}; -+ -+#define ch_to_cch_2g_idx(ch) ((ch) - 1) -+ -+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 -+}; -+ -+#define ch_to_cch_5g_20m_idx(ch) \ -+ ( \ -+ ((ch) >= 36 && (ch) <= 64) ? (((ch) - 36) >> 2) : \ -+ ((ch) >= 100 && (ch) <= 144) ? 8 + (((ch) - 100) >> 2) : \ -+ ((ch) >= 149 && (ch) <= 177) ? 20 + (((ch) - 149) >> 2) : 255 \ -+ ) -+ -+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) -+{ -+ 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; -+} -+ -+/* -+ * Get center channel of smaller bandwidth by @param cch, @param bw, @param opch -+ * @cch: the given center channel -+ * @bw: the given bandwidth -+ * @opch: the given operating channel -+ * -+ * return center channel of smaller bandiwdth if valid, or 0 -+ */ -+u8 rtw_get_scch_by_cch_opch(u8 cch, u8 bw, u8 opch) -+{ -+ u8 offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if (opch > cch) -+ offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else if (opch < cch) -+ offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ -+ return rtw_get_scch_by_cch_offset(cch, bw, offset); -+} -+ -+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_160) -+ return 0; -+ -+ return center_chs_5g_by_bw[bw].ch_num; -+} -+ -+inline u8 center_chs_5g(u8 bw, u8 id) -+{ -+ if (bw > CHANNEL_WIDTH_160) -+ 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_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_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_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_center_ch(u8 ch, u8 bw, u8 offset) -+{ -+ u8 cch = ch; -+ -+ if (bw == CHANNEL_WIDTH_160) { -+ if (ch % 4 == 0) { -+ if (ch >= 36 && ch <= 64) -+ cch = 50; -+ else if (ch >= 100 && ch <= 128) -+ cch = 114; -+ } else if (ch % 4 == 1) { -+ if (ch >= 149 && ch <= 177) -+ cch = 163; -+ } -+ -+ } else if (bw == CHANNEL_WIDTH_80) { -+ if (ch <= 14) -+ cch = 7; /* special case for 2.4G */ -+ else if (ch % 4 == 0) { -+ if (ch >= 36 && ch <= 48) -+ cch = 42; -+ else if (ch >= 52 && ch <= 64) -+ cch = 58; -+ else if (ch >= 100 && ch <= 112) -+ cch = 106; -+ else if (ch >= 116 && ch <= 128) -+ cch = 122; -+ else if (ch >= 132 && ch <= 144) -+ cch = 138; -+ } else if (ch % 4 == 1) { -+ if (ch >= 149 && ch <= 161) -+ cch = 155; -+ else if (ch >= 165 && ch <= 177) -+ cch = 171; -+ } -+ -+ } else if (bw == CHANNEL_WIDTH_40) { -+ if (offset == HAL_PRIME_CHNL_OFFSET_LOWER) -+ cch = ch + 2; -+ else if (offset == HAL_PRIME_CHNL_OFFSET_UPPER) -+ cch = ch - 2; -+ -+ } else if (bw == CHANNEL_WIDTH_20 -+ || bw == CHANNEL_WIDTH_10 -+ || bw == CHANNEL_WIDTH_5 -+ ) -+ ; /* same as ch */ -+ else -+ rtw_warn_on(1); -+ -+ return cch; -+} -+ -+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; -+} -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+int rtw_6gch2freq(int chan) -+{ -+ if (chan >= 1 && chan <= 253) -+ return 5950 + chan * 5; -+ -+ return 0; /* not supported */ -+} -+#endif -+ -+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_ch2freq_by_band(BAND_TYPE band, int ch) -+{ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ if (band == BAND_ON_6G) -+ return rtw_6gch2freq(ch); -+ else -+#endif -+ return rtw_ch2freq(ch); -+} -+ -+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 >= 5000 && freq < 5950) -+ return (freq - 5000) / 5; -+ else if (freq >= 5950 && freq <= 7215) -+ return (freq - 5950) / 5; -+ else if (freq >= 58320 && freq <= 64800) -+ return (freq - 56160) / 2160; -+ else -+ return 0; -+} -+ -+BAND_TYPE rtw_freq2band(int freq) -+{ -+ if (freq <= 2484) -+ return BAND_ON_2_4G; -+ else if (freq >= 5000 && freq < 5950) -+ return BAND_ON_5G; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ else if (freq >= 5950 && freq <= 7215) -+ return BAND_ON_6G; -+#endif -+ else -+ return BAND_MAX; -+} -+ -+bool rtw_freq_consecutive(int a, int b) -+{ -+ BAND_TYPE band_a, band_b; -+ -+ band_a = rtw_freq2band(a); -+ if (band_a == BAND_MAX) -+ return 0; -+ band_b = rtw_freq2band(b); -+ if (band_b == BAND_MAX || band_a != band_b) -+ return 0; -+ -+ switch (band_a) { -+ case BAND_ON_2_4G: -+ return rtw_abs(a - b) == 5; -+ case BAND_ON_5G: -+#if CONFIG_IEEE80211_BAND_6GHZ -+ case BAND_ON_6G: -+#endif -+ return rtw_abs(a - b) == 20; -+ default: -+ 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; -+ 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_160) { -+ hi_ret = freq + 80; -+ lo_ret = freq - 80; -+ } else 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[CHANNEL_WIDTH_MAX] = { -+ [CHANNEL_WIDTH_20] = "20MHz", -+ [CHANNEL_WIDTH_40] = "40MHz", -+ [CHANNEL_WIDTH_80] = "80MHz", -+ [CHANNEL_WIDTH_160] = "160MHz", -+ [CHANNEL_WIDTH_80_80] = "80_80MHz", -+ [CHANNEL_WIDTH_5] = "5MHz", -+ [CHANNEL_WIDTH_10] = "10MHz", -+}; -+ -+const u8 _ch_width_to_bw_cap[CHANNEL_WIDTH_MAX] = { -+ [CHANNEL_WIDTH_20] = BW_CAP_20M, -+ [CHANNEL_WIDTH_40] = BW_CAP_40M, -+ [CHANNEL_WIDTH_80] = BW_CAP_80M, -+ [CHANNEL_WIDTH_160] = BW_CAP_160M, -+ [CHANNEL_WIDTH_80_80] = BW_CAP_80_80M, -+ [CHANNEL_WIDTH_5] = BW_CAP_5M, -+ [CHANNEL_WIDTH_10] = BW_CAP_10M, -+}; -+ -+const char *const _band_str[] = { -+ [BAND_ON_2_4G] = "2.4G", -+ [BAND_ON_5G] = "5G", -+#if CONFIG_IEEE80211_BAND_6GHZ -+ [BAND_ON_6G] = "6G", -+#endif -+ [BAND_MAX] = "BAND_MAX", -+}; -+ -+const u8 _band_to_band_cap[] = { -+ [BAND_ON_2_4G] = BAND_CAP_2G, -+ [BAND_ON_5G] = BAND_CAP_5G, -+#if CONFIG_IEEE80211_BAND_6GHZ -+ [BAND_ON_6G] = BAND_CAP_6G, -+#endif -+ [BAND_MAX] = 0, -+}; -+ -+const char *const _opc_bw_str[OPC_BW_NUM] = { -+ "20M ", /* OPC_BW20 */ -+ "40M+", /* OPC_BW40PLUS */ -+ "40M-", /* OPC_BW40MINUS */ -+ "80M ", /* OPC_BW80 */ -+ "160M ", /* OPC_BW160 */ -+ "80+80M ", /* OPC_BW80P80 */ -+}; -+ -+const u8 _opc_bw_to_ch_width[OPC_BW_NUM] = { -+ CHANNEL_WIDTH_20, /* OPC_BW20 */ -+ CHANNEL_WIDTH_40, /* OPC_BW40PLUS */ -+ CHANNEL_WIDTH_40, /* OPC_BW40MINUS */ -+ CHANNEL_WIDTH_80, /* OPC_BW80 */ -+ CHANNEL_WIDTH_160, /* OPC_BW160 */ -+ CHANNEL_WIDTH_80_80, /* OPC_BW80P80 */ -+}; -+ -+/* global operating class database */ -+ -+struct op_class_t { -+ u8 class_id; -+ BAND_TYPE band; -+ enum opc_bw bw; -+ u8 *len_ch_attr; -+}; -+ -+#define OPC_CH_LIST_LEN(_opc) (_opc.len_ch_attr[0]) -+#define OPC_CH_LIST_CH(_opc, _i) (_opc.len_ch_attr[_i + 1]) -+ -+#define OP_CLASS_ENT(_class, _band, _bw, _len, arg...) \ -+ {.class_id = _class, .band = _band, .bw = _bw, .len_ch_attr = (uint8_t[_len + 1]) {_len, ##arg},} -+ -+/* 802.11-2020, 802.11ax-2021 Table E-4, partial */ -+static const struct op_class_t global_op_class[] = { -+ /* 2G ch1~13, 20M */ -+ OP_CLASS_ENT(81, BAND_ON_2_4G, OPC_BW20, 13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), -+ /* 2G ch14, 20M */ -+ OP_CLASS_ENT(82, BAND_ON_2_4G, OPC_BW20, 1, 14), -+ /* 2G, 40M */ -+ OP_CLASS_ENT(83, BAND_ON_2_4G, OPC_BW40PLUS, 9, 1, 2, 3, 4, 5, 6, 7, 8, 9), -+ OP_CLASS_ENT(84, BAND_ON_2_4G, OPC_BW40MINUS, 9, 5, 6, 7, 8, 9, 10, 11, 12, 13), -+ /* 5G band 1, 20M & 40M */ -+ OP_CLASS_ENT(115, BAND_ON_5G, OPC_BW20, 4, 36, 40, 44, 48), -+ OP_CLASS_ENT(116, BAND_ON_5G, OPC_BW40PLUS, 2, 36, 44), -+ OP_CLASS_ENT(117, BAND_ON_5G, OPC_BW40MINUS, 2, 40, 48), -+ /* 5G band 2, 20M & 40M */ -+ OP_CLASS_ENT(118, BAND_ON_5G, OPC_BW20, 4, 52, 56, 60, 64), -+ OP_CLASS_ENT(119, BAND_ON_5G, OPC_BW40PLUS, 2, 52, 60), -+ OP_CLASS_ENT(120, BAND_ON_5G, OPC_BW40MINUS, 2, 56, 64), -+ /* 5G band 3, 20M & 40M */ -+ OP_CLASS_ENT(121, BAND_ON_5G, OPC_BW20, 12, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144), -+ OP_CLASS_ENT(122, BAND_ON_5G, OPC_BW40PLUS, 6, 100, 108, 116, 124, 132, 140), -+ OP_CLASS_ENT(123, BAND_ON_5G, OPC_BW40MINUS, 6, 104, 112, 120, 128, 136, 144), -+ /* 5G band 4, 20M & 40M */ -+ OP_CLASS_ENT(124, BAND_ON_5G, OPC_BW20, 4, 149, 153, 157, 161), -+ OP_CLASS_ENT(125, BAND_ON_5G, OPC_BW20, 8, 149, 153, 157, 161, 165, 169, 173, 177), -+ OP_CLASS_ENT(126, BAND_ON_5G, OPC_BW40PLUS, 4, 149, 157, 165, 173), -+ OP_CLASS_ENT(127, BAND_ON_5G, OPC_BW40MINUS, 4, 153, 161, 169, 177), -+ /* 5G, 80M & 160M */ -+ OP_CLASS_ENT(128, BAND_ON_5G, OPC_BW80, 28, 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), -+ OP_CLASS_ENT(129, BAND_ON_5G, OPC_BW160, 24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 149, 153, 157, 161, 165, 169, 173, 177), -+ #if 0 /* TODO */ -+ /* 5G, 80+80M */ -+ OP_CLASS_ENT(130, BAND_ON_5G, OPC_BW80P80, 28, 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), -+ #endif -+}; -+ -+static const int global_op_class_num = sizeof(global_op_class) / sizeof(struct op_class_t); -+ -+static const struct op_class_t *get_global_op_class_by_id(u8 gid) -+{ -+ int i; -+ -+ for (i = 0; i < global_op_class_num; i++) -+ if (global_op_class[i].class_id == gid) -+ break; -+ -+ return i < global_op_class_num ? &global_op_class[i] : NULL; -+} -+ -+bool is_valid_global_op_class_id(u8 gid) -+{ -+ return get_global_op_class_by_id(gid) ? 1 : 0; -+} -+ -+static bool is_valid_global_op_class_ch(const struct op_class_t *opc, u8 ch) -+{ -+ int array_idx; -+ int i; -+ -+ if (opc < global_op_class -+ || (((u8 *)opc) - ((u8 *)global_op_class)) % sizeof(struct op_class_t) -+ ) { -+ RTW_ERR("Invalid opc pointer:%p (global_op_class:%p, sizeof(struct op_class_t):%zu, %zu)\n" -+ , opc, global_op_class, sizeof(struct op_class_t), (((u8 *)opc) - ((u8 *)global_op_class)) % sizeof(struct op_class_t)); -+ return 0; -+ } -+ -+ array_idx = (((u8 *)opc) - ((u8 *)global_op_class)) / sizeof(struct op_class_t); -+ -+ for (i = 0; i < OPC_CH_LIST_LEN(global_op_class[array_idx]); i++) -+ if (OPC_CH_LIST_CH(global_op_class[array_idx], i) == ch) -+ break; -+ -+ return i < OPC_CH_LIST_LEN(global_op_class[array_idx]); -+} -+ -+static enum opc_bw get_global_opc_bw_by_id(u8 gid) -+{ -+ int i; -+ -+ for (i = 0; i < global_op_class_num; i++) -+ if (global_op_class[i].class_id == gid) -+ break; -+ -+ return i < global_op_class_num ? global_op_class[i].bw : OPC_BW_NUM; -+} -+ -+/* -2: logic error, -1: error, 0: is already BW20 */ -+s16 get_sub_op_class(u8 gid, u8 ch) -+{ -+ const struct op_class_t *opc = get_global_op_class_by_id(gid); -+ int i; -+ enum channel_width bw; -+ -+ if (!opc) -+ return -1; -+ -+ if (!is_valid_global_op_class_ch(opc, ch)) { -+ return -1; -+ } -+ -+ if (opc->bw == OPC_BW20) -+ return 0; -+ -+ bw = opc_bw_to_ch_width(opc->bw); -+ -+ for (i = 0; i < global_op_class_num; i++) { -+ if (bw != opc_bw_to_ch_width(global_op_class[i].bw) + 1) -+ continue; -+ if (is_valid_global_op_class_ch(&global_op_class[i], ch)) -+ break; -+ } -+ -+ return i < global_op_class_num ? global_op_class[i].class_id : -2; -+} -+ -+static void dump_op_class_ch_title(void *sel) -+{ -+ RTW_PRINT_SEL(sel, "%-5s %-4s %-7s ch_list\n" -+ , "class", "band", "bw"); -+} -+ -+static void dump_global_op_class_ch_single(void *sel, u8 gid) -+{ -+ u8 i; -+ -+ RTW_PRINT_SEL(sel, "%5u %4s %7s" -+ , global_op_class[gid].class_id -+ , band_str(global_op_class[gid].band) -+ , opc_bw_str(global_op_class[gid].bw)); -+ -+ for (i = 0; i < OPC_CH_LIST_LEN(global_op_class[gid]); i++) -+ _RTW_PRINT_SEL(sel, " %u", OPC_CH_LIST_CH(global_op_class[gid], i)); -+ -+ _RTW_PRINT_SEL(sel, "\n"); -+} -+ -+#ifdef CONFIG_RTW_DEBUG -+static bool dbg_global_op_class_validate(u8 gid) -+{ -+ u8 i; -+ u8 ch, bw, offset, cch; -+ bool ret = 1; -+ -+ switch (global_op_class[gid].bw) { -+ case OPC_BW20: -+ bw = CHANNEL_WIDTH_20; -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case OPC_BW40PLUS: -+ bw = CHANNEL_WIDTH_40; -+ offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ case OPC_BW40MINUS: -+ bw = CHANNEL_WIDTH_40; -+ offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ case OPC_BW80: -+ bw = CHANNEL_WIDTH_80; -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case OPC_BW160: -+ bw = CHANNEL_WIDTH_160; -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case OPC_BW80P80: /* TODO */ -+ default: -+ RTW_ERR("%s class:%u unsupported opc_bw:%u\n" -+ , __func__, global_op_class[gid].class_id, global_op_class[gid].bw); -+ ret = 0; -+ goto exit; -+ } -+ -+ for (i = 0; i < OPC_CH_LIST_LEN(global_op_class[gid]); i++) { -+ u8 *op_chs; -+ u8 op_ch_num; -+ u8 k; -+ -+ ch = OPC_CH_LIST_CH(global_op_class[gid], i); -+ cch = rtw_get_center_ch(ch ,bw, offset); -+ if (!cch) { -+ RTW_ERR("%s can't get cch from class:%u ch:%u\n" -+ , __func__, global_op_class[gid].class_id, ch); -+ ret = 0; -+ continue; -+ } -+ -+ if (!rtw_get_op_chs_by_cch_bw(cch, bw, &op_chs, &op_ch_num)) { -+ RTW_ERR("%s can't get op chs from class:%u cch:%u\n" -+ , __func__, global_op_class[gid].class_id, cch); -+ ret = 0; -+ continue; -+ } -+ -+ for (k = 0; k < op_ch_num; k++) { -+ if (*(op_chs + k) == ch) -+ break; -+ } -+ if (k >= op_ch_num) { -+ RTW_ERR("%s can't get ch:%u from op_chs class:%u cch:%u\n" -+ , __func__, ch, global_op_class[i].class_id, cch); -+ ret = 0; -+ } -+ } -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_RTW_DEBUG */ -+ -+void dump_global_op_class(void *sel) -+{ -+ u8 i; -+ -+ dump_op_class_ch_title(sel); -+ -+ for (i = 0; i < global_op_class_num; i++) -+ dump_global_op_class_ch_single(sel, i); -+} -+ -+u8 rtw_get_op_class_by_chbw(u8 ch, u8 bw, u8 offset) -+{ -+ BAND_TYPE band = BAND_MAX; -+ int i; -+ u8 gid = 0; /* invalid */ -+ -+ if (rtw_is_2g_ch(ch)) -+ band = BAND_ON_2_4G; -+ else if (rtw_is_5g_ch(ch)) -+ band = BAND_ON_5G; -+ else -+ goto exit; -+ -+ switch (bw) { -+ case CHANNEL_WIDTH_20: -+ case CHANNEL_WIDTH_40: -+ case CHANNEL_WIDTH_80: -+ case CHANNEL_WIDTH_160: -+ #if 0 /* TODO */ -+ case CHANNEL_WIDTH_80_80: -+ #endif -+ break; -+ default: -+ goto exit; -+ } -+ -+ for (i = 0; i < global_op_class_num; i++) { -+ if (band != global_op_class[i].band) -+ continue; -+ -+ if (opc_bw_to_ch_width(global_op_class[i].bw) != bw) -+ continue; -+ -+ if ((global_op_class[i].bw == OPC_BW40PLUS -+ && offset != HAL_PRIME_CHNL_OFFSET_LOWER) -+ || (global_op_class[i].bw == OPC_BW40MINUS -+ && offset != HAL_PRIME_CHNL_OFFSET_UPPER) -+ ) -+ continue; -+ -+ if (is_valid_global_op_class_ch(&global_op_class[i], ch)) -+ goto get; -+ } -+ -+get: -+ if (i < global_op_class_num) { -+ #if 0 /* TODO */ -+ if (bw == CHANNEL_WIDTH_80_80) { -+ /* search another ch */ -+ if (!is_valid_global_op_class_ch(&global_op_class[i], ch2)) -+ goto exit; -+ } -+ #endif -+ -+ gid = global_op_class[i].class_id; -+ } -+ -+exit: -+ return gid; -+} -+ -+u8 rtw_get_bw_offset_by_op_class_ch(u8 gid, u8 ch, u8 *bw, u8 *offset) -+{ -+ enum opc_bw opc_bw; -+ u8 valid = 0; -+ int i; -+ -+ opc_bw = get_global_opc_bw_by_id(gid); -+ if (opc_bw == OPC_BW_NUM) -+ goto exit; -+ -+ *bw = opc_bw_to_ch_width(opc_bw); -+ -+ if (opc_bw == OPC_BW40PLUS) -+ *offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else if (opc_bw == OPC_BW40MINUS) -+ *offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ -+ if (rtw_get_offset_by_chbw(ch, *bw, offset)) -+ valid = 1; -+ -+exit: -+ return valid; -+} -+ -+static struct op_class_pref_t *opc_pref_alloc(u8 class_id) -+{ -+ int i, j; -+ struct op_class_pref_t *opc_pref = NULL; -+ u8 ch_num; -+ -+ for (i = 0; i < global_op_class_num; i++) -+ if (global_op_class[i].class_id == class_id) -+ break; -+ -+ if (i >= global_op_class_num) -+ goto exit; -+ -+ ch_num = OPC_CH_LIST_LEN(global_op_class[i]); -+ opc_pref = rtw_zmalloc(sizeof(*opc_pref) + (sizeof(struct op_ch_t) * ch_num)); -+ if (!opc_pref) -+ goto exit; -+ -+ opc_pref->class_id = global_op_class[i].class_id; -+ opc_pref->band = global_op_class[i].band; -+ opc_pref->bw = global_op_class[i].bw; -+ -+ for (j = 0; j < OPC_CH_LIST_LEN(global_op_class[i]); j++) { -+ opc_pref->chs[j].ch = OPC_CH_LIST_CH(global_op_class[i], j); -+ opc_pref->chs[j].static_non_op = 1; -+ opc_pref->chs[j].no_ir = 1; -+ opc_pref->chs[j].max_txpwr = UNSPECIFIED_MBM; -+ } -+ opc_pref->ch_num = ch_num; -+ -+exit: -+ return opc_pref; -+} -+ -+static void opc_pref_free(struct op_class_pref_t *opc_pref) -+{ -+ rtw_mfree(opc_pref, sizeof(*opc_pref) + (sizeof(struct op_ch_t) * opc_pref->ch_num)); -+} -+ -+int op_class_pref_init(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ u8 bw; -+ struct op_class_pref_t *opc_pref; -+ int i; -+ u8 op_class_num = 0; -+ u8 band_bmp = 0; -+ u8 bw_bmp[BAND_MAX] = {0}; -+ int ret = _FAIL; -+ -+ rfctl->spt_op_class_ch = rtw_zmalloc(sizeof(struct op_class_pref_t *) * global_op_class_num); -+ if (!rfctl->spt_op_class_ch) { -+ RTW_ERR("%s alloc rfctl->spt_op_class_ch fail\n", __func__); -+ goto exit; -+ } -+ -+ if (IsSupported24G(regsty->wireless_mode) && hal_chk_band_cap(adapter, BAND_CAP_2G)) -+ band_bmp |= BAND_CAP_2G; -+ if (is_supported_5g(regsty->wireless_mode) && hal_chk_band_cap(adapter, BAND_CAP_5G)) -+ band_bmp |= BAND_CAP_5G; -+ -+ bw_bmp[BAND_ON_2_4G] = (ch_width_to_bw_cap(REGSTY_BW_2G(regsty) + 1) - 1) & (GET_HAL_SPEC(adapter)->bw_cap); -+ bw_bmp[BAND_ON_5G] = (ch_width_to_bw_cap(REGSTY_BW_5G(regsty) + 1) - 1) & (GET_HAL_SPEC(adapter)->bw_cap); -+ if (!REGSTY_IS_11AC_ENABLE(regsty) -+ || !is_supported_vht(regsty->wireless_mode) -+ ) -+ bw_bmp[BAND_ON_5G] &= ~(BW_CAP_80M | BW_CAP_160M); -+ -+ if (0) { -+ RTW_INFO("REGSTY_BW_2G(regsty):%u\n", REGSTY_BW_2G(regsty)); -+ RTW_INFO("REGSTY_BW_5G(regsty):%u\n", REGSTY_BW_5G(regsty)); -+ RTW_INFO("GET_HAL_SPEC(adapter)->bw_cap:0x%x\n", GET_HAL_SPEC(adapter)->bw_cap); -+ RTW_INFO("band_bmp:0x%x\n", band_bmp); -+ RTW_INFO("bw_bmp[2G]:0x%x\n", bw_bmp[BAND_ON_2_4G]); -+ RTW_INFO("bw_bmp[5G]:0x%x\n", bw_bmp[BAND_ON_5G]); -+ } -+ -+ for (i = 0; i < global_op_class_num; i++) { -+ #ifdef CONFIG_RTW_DEBUG -+ rtw_warn_on(!dbg_global_op_class_validate(i)); -+ #endif -+ -+ if (!(band_bmp & band_to_band_cap(global_op_class[i].band))) -+ continue; -+ -+ bw = opc_bw_to_ch_width(global_op_class[i].bw); -+ if (bw == CHANNEL_WIDTH_MAX -+ || bw == CHANNEL_WIDTH_80_80 /* TODO */ -+ ) -+ continue; -+ -+ if (!(bw_bmp[global_op_class[i].band] & ch_width_to_bw_cap(bw))) -+ continue; -+ -+ opc_pref = opc_pref_alloc(global_op_class[i].class_id); -+ if (!opc_pref) { -+ RTW_ERR("%s opc_pref_alloc(%u) fail\n", __func__, global_op_class[i].class_id); -+ goto exit; -+ } -+ -+ if (opc_pref->ch_num) { -+ rfctl->spt_op_class_ch[i] = opc_pref; -+ op_class_num++; -+ } else -+ opc_pref_free(opc_pref); -+ } -+ -+ rfctl->cap_spt_op_class_num = op_class_num; -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+void op_class_pref_deinit(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ int i; -+ -+ if (!rfctl->spt_op_class_ch) -+ return; -+ -+ for (i = 0; i < global_op_class_num; i++) { -+ if (rfctl->spt_op_class_ch[i]) { -+ opc_pref_free(rfctl->spt_op_class_ch[i]); -+ rfctl->spt_op_class_ch[i] = NULL; -+ } -+ } -+ -+ rtw_mfree(rfctl->spt_op_class_ch, sizeof(struct op_class_pref_t *) * global_op_class_num); -+ rfctl->spt_op_class_ch = NULL; -+} -+ -+void op_class_pref_apply_regulatory(_adapter *adapter, u8 reason) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ RT_CHANNEL_INFO *chset = rfctl->channel_set; -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ u8 ch, bw, offset, cch; -+ struct op_class_pref_t *opc_pref; -+ int i, j; -+ u8 reg_op_class_num = 0; -+ u8 op_class_num = 0; -+ -+ for (i = 0; i < global_op_class_num; i++) { -+ if (!rfctl->spt_op_class_ch[i]) -+ continue; -+ opc_pref = rfctl->spt_op_class_ch[i]; -+ -+ /* reset all channel */ -+ for (j = 0; j < opc_pref->ch_num; j++) { -+ if (reason >= REG_CHANGE) -+ opc_pref->chs[j].static_non_op = 1; -+ if (reason != REG_TXPWR_CHANGE) -+ opc_pref->chs[j].no_ir = 1; -+ if (reason >= REG_TXPWR_CHANGE) -+ opc_pref->chs[j].max_txpwr = UNSPECIFIED_MBM; -+ } -+ if (reason >= REG_CHANGE) -+ opc_pref->op_ch_num = 0; -+ if (reason != REG_TXPWR_CHANGE) -+ opc_pref->ir_ch_num = 0; -+ -+ switch (opc_pref->bw) { -+ case OPC_BW20: -+ bw = CHANNEL_WIDTH_20; -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case OPC_BW40PLUS: -+ bw = CHANNEL_WIDTH_40; -+ offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ case OPC_BW40MINUS: -+ bw = CHANNEL_WIDTH_40; -+ offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ case OPC_BW80: -+ bw = CHANNEL_WIDTH_80; -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case OPC_BW160: -+ bw = CHANNEL_WIDTH_160; -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case OPC_BW80P80: /* TODO */ -+ default: -+ continue; -+ } -+ -+ if (!RFCTL_REG_EN_11AC(rfctl) -+ && (bw == CHANNEL_WIDTH_80 || bw == CHANNEL_WIDTH_160)) -+ continue; -+ -+ for (j = 0; j < opc_pref->ch_num; j++) { -+ u8 *op_chs; -+ u8 op_ch_num; -+ u8 k, l; -+ int chset_idx; -+ -+ ch = opc_pref->chs[j].ch; -+ -+ if (reason >= REG_TXPWR_CHANGE) -+ opc_pref->chs[j].max_txpwr = rtw_rfctl_get_reg_max_txpwr_mbm(rfctl, ch, bw, offset, 1); -+ -+ if (reason == REG_TXPWR_CHANGE) -+ continue; -+ -+ cch = rtw_get_center_ch(ch ,bw, offset); -+ if (!cch) -+ continue; -+ -+ if (!rtw_get_op_chs_by_cch_bw(cch, bw, &op_chs, &op_ch_num)) -+ continue; -+ -+ for (k = 0, l = 0; k < op_ch_num; k++) { -+ chset_idx = rtw_chset_search_ch(chset, *(op_chs + k)); -+ if (chset_idx == -1) -+ break; -+ if (bw >= CHANNEL_WIDTH_40) { -+ if ((chset[chset_idx].flags & RTW_CHF_NO_HT40U) && k % 2 == 0) -+ break; -+ if ((chset[chset_idx].flags & RTW_CHF_NO_HT40L) && k % 2 == 1) -+ break; -+ } -+ if (bw >= CHANNEL_WIDTH_80 && (chset[chset_idx].flags & RTW_CHF_NO_80MHZ)) -+ break; -+ if (bw >= CHANNEL_WIDTH_160 && (chset[chset_idx].flags & RTW_CHF_NO_160MHZ)) -+ break; -+ if ((chset[chset_idx].flags & RTW_CHF_DFS) && rtw_rfctl_dfs_domain_unknown(rfctl)) -+ continue; -+ if (chset[chset_idx].flags & RTW_CHF_NO_IR) -+ continue; -+ l++; -+ } -+ if (k < op_ch_num) -+ continue; -+ -+ if (reason >= REG_CHANGE) { -+ opc_pref->chs[j].static_non_op = 0; -+ opc_pref->op_ch_num++; -+ } -+ -+ if (l >= op_ch_num) { -+ opc_pref->chs[j].no_ir = 0; -+ opc_pref->ir_ch_num++; -+ } -+ } -+ -+ if (opc_pref->op_ch_num) -+ reg_op_class_num++; -+ if (opc_pref->ir_ch_num) -+ op_class_num++; -+ } -+ -+ rfctl->reg_spt_op_class_num = reg_op_class_num; -+ rfctl->cur_spt_op_class_num = op_class_num; -+} -+ -+static void dump_opc_pref_single(void *sel, struct op_class_pref_t *opc_pref, bool show_snon_ocp, bool show_no_ir, bool detail) -+{ -+ u8 i; -+ u8 ch_num = 0; -+ -+ if (!show_snon_ocp && !opc_pref->op_ch_num) -+ return; -+ if (!show_no_ir && !opc_pref->ir_ch_num) -+ return; -+ -+ RTW_PRINT_SEL(sel, "%5u %4s %7s" -+ , opc_pref->class_id -+ , band_str(opc_pref->band) -+ , opc_bw_str(opc_pref->bw)); -+ for (i = 0; i < opc_pref->ch_num; i++) { -+ if ((show_snon_ocp || !opc_pref->chs[i].static_non_op) -+ && (show_no_ir || !opc_pref->chs[i].no_ir) -+ ) { -+ if (detail) -+ _RTW_PRINT_SEL(sel, " %4u", opc_pref->chs[i].ch); -+ else -+ _RTW_PRINT_SEL(sel, " %u", opc_pref->chs[i].ch); -+ } -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ -+ if (!detail) -+ return; -+ -+ RTW_PRINT_SEL(sel, " "); -+ for (i = 0; i < opc_pref->ch_num; i++) { -+ if ((show_snon_ocp || !opc_pref->chs[i].static_non_op) -+ && (show_no_ir || !opc_pref->chs[i].no_ir) -+ ) { -+ _RTW_PRINT_SEL(sel, " %c%c" -+ , opc_pref->chs[i].no_ir ? ' ' : 'I' -+ , opc_pref->chs[i].static_non_op ? ' ' : 'E' -+ ); -+ } -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, " "); -+ for (i = 0; i < opc_pref->ch_num; i++) { -+ if ((show_snon_ocp || !opc_pref->chs[i].static_non_op) -+ && (show_no_ir || !opc_pref->chs[i].no_ir) -+ ) { -+ if (opc_pref->chs[i].max_txpwr == UNSPECIFIED_MBM) -+ _RTW_PRINT_SEL(sel, " "); -+ else -+ _RTW_PRINT_SEL(sel, " %4d", opc_pref->chs[i].max_txpwr); -+ } -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+} -+ -+void dump_cap_spt_op_class_ch(void *sel, struct rf_ctl_t *rfctl, bool detail) -+{ -+ u8 i; -+ -+ dump_op_class_ch_title(sel); -+ -+ for (i = 0; i < global_op_class_num; i++) { -+ if (!rfctl->spt_op_class_ch[i]) -+ continue; -+ dump_opc_pref_single(sel, rfctl->spt_op_class_ch[i], 1, 1, detail); -+ } -+ -+ RTW_PRINT_SEL(sel, "op_class number:%d\n", rfctl->cap_spt_op_class_num); -+} -+ -+void dump_reg_spt_op_class_ch(void *sel, struct rf_ctl_t *rfctl, bool detail) -+{ -+ u8 i; -+ -+ dump_op_class_ch_title(sel); -+ -+ for (i = 0; i < global_op_class_num; i++) { -+ if (!rfctl->spt_op_class_ch[i]) -+ continue; -+ dump_opc_pref_single(sel, rfctl->spt_op_class_ch[i], 0, 1, detail); -+ } -+ -+ RTW_PRINT_SEL(sel, "op_class number:%d\n", rfctl->reg_spt_op_class_num); -+} -+ -+void dump_cur_spt_op_class_ch(void *sel, struct rf_ctl_t *rfctl, bool detail) -+{ -+ u8 i; -+ -+ dump_op_class_ch_title(sel); -+ -+ for (i = 0; i < global_op_class_num; i++) { -+ if (!rfctl->spt_op_class_ch[i]) -+ continue; -+ dump_opc_pref_single(sel, rfctl->spt_op_class_ch[i], 0, 0, detail); -+ } -+ -+ RTW_PRINT_SEL(sel, "op_class number:%d\n", rfctl->cur_spt_op_class_num); -+} -+ -+const u8 _rf_type_to_rf_tx_cnt[RF_TYPE_MAX] = { -+ [RF_1T1R] = 1, -+ [RF_1T2R] = 1, -+ [RF_1T3R] = 1, -+ [RF_1T4R] = 1, -+ [RF_2T1R] = 2, -+ [RF_2T2R] = 2, -+ [RF_2T3R] = 2, -+ [RF_2T4R] = 2, -+ [RF_3T1R] = 3, -+ [RF_3T2R] = 3, -+ [RF_3T3R] = 3, -+ [RF_3T4R] = 3, -+ [RF_4T1R] = 4, -+ [RF_4T2R] = 4, -+ [RF_4T3R] = 4, -+ [RF_4T4R] = 4, -+}; -+ -+const u8 _rf_type_to_rf_rx_cnt[RF_TYPE_MAX] = { -+ [RF_1T1R] = 1, -+ [RF_1T2R] = 2, -+ [RF_1T3R] = 3, -+ [RF_1T4R] = 4, -+ [RF_2T1R] = 1, -+ [RF_2T2R] = 2, -+ [RF_2T3R] = 3, -+ [RF_2T4R] = 4, -+ [RF_3T1R] = 1, -+ [RF_3T2R] = 2, -+ [RF_3T3R] = 3, -+ [RF_3T4R] = 4, -+ [RF_4T1R] = 1, -+ [RF_4T2R] = 2, -+ [RF_4T3R] = 3, -+ [RF_4T4R] = 4, -+}; -+ -+const char *const _rf_type_to_rfpath_str[RF_TYPE_MAX] = { -+ [RF_1T1R] = "RF_1T1R", -+ [RF_1T2R] = "RF_1T2R", -+ [RF_1T3R] = "RF_1T3R", -+ [RF_1T4R] = "RF_1T4R", -+ [RF_2T1R] = "RF_2T1R", -+ [RF_2T2R] = "RF_2T2R", -+ [RF_2T3R] = "RF_2T3R", -+ [RF_2T4R] = "RF_2T4R", -+ [RF_3T1R] = "RF_3T1R", -+ [RF_3T2R] = "RF_3T2R", -+ [RF_3T3R] = "RF_3T3R", -+ [RF_3T4R] = "RF_3T4R", -+ [RF_4T1R] = "RF_4T1R", -+ [RF_4T2R] = "RF_4T2R", -+ [RF_4T3R] = "RF_4T3R", -+ [RF_4T4R] = "RF_4T4R", -+}; -+ -+void rf_type_to_default_trx_bmp(enum rf_type rf, enum bb_path *tx, enum bb_path *rx) -+{ -+ u8 tx_num = rf_type_to_rf_tx_cnt(rf); -+ u8 rx_num = rf_type_to_rf_rx_cnt(rf); -+ int i; -+ -+ *tx = *rx = 0; -+ -+ for (i = 0; i < tx_num; i++) -+ *tx |= BIT(i); -+ for (i = 0; i < rx_num; i++) -+ *rx |= BIT(i); -+} -+ -+static const u8 _trx_num_to_rf_type[RF_PATH_MAX][RF_PATH_MAX] = { -+ {RF_1T1R, RF_1T2R, RF_1T3R, RF_1T4R}, -+ {RF_2T1R, RF_2T2R, RF_2T3R, RF_2T4R}, -+ {RF_3T1R, RF_3T2R, RF_3T3R, RF_3T4R}, -+ {RF_4T1R, RF_4T2R, RF_4T3R, RF_4T4R}, -+}; -+ -+enum rf_type trx_num_to_rf_type(u8 tx_num, u8 rx_num) -+{ -+ if (tx_num > 0 && tx_num <= RF_PATH_MAX && rx_num > 0 && rx_num <= RF_PATH_MAX) -+ return _trx_num_to_rf_type[tx_num - 1][rx_num - 1]; -+ return RF_TYPE_MAX; -+} -+ -+enum rf_type trx_bmp_to_rf_type(u8 tx_bmp, u8 rx_bmp) -+{ -+ u8 tx_num = 0; -+ u8 rx_num = 0; -+ int i; -+ -+ for (i = 0; i < RF_PATH_MAX; i++) { -+ if (tx_bmp >> i & BIT0) -+ tx_num++; -+ if (rx_bmp >> i & BIT0) -+ rx_num++; -+ } -+ -+ return trx_num_to_rf_type(tx_num, rx_num); -+} -+ -+bool rf_type_is_a_in_b(enum rf_type a, enum rf_type b) -+{ -+ return rf_type_to_rf_tx_cnt(a) <= rf_type_to_rf_tx_cnt(b) -+ && rf_type_to_rf_rx_cnt(a) <= rf_type_to_rf_rx_cnt(b); -+} -+ -+static void rtw_path_bmp_limit_from_higher(u8 *bmp, u8 *bmp_bit_cnt, u8 bit_cnt_lmt) -+{ -+ int i; -+ -+ for (i = RF_PATH_MAX - 1; *bmp_bit_cnt > bit_cnt_lmt && i >= 0; i--) { -+ if (*bmp & BIT(i)) { -+ *bmp &= ~BIT(i); -+ (*bmp_bit_cnt)--; -+ } -+ } -+} -+ -+u8 rtw_restrict_trx_path_bmp_by_trx_num_lmt(u8 trx_path_bmp, u8 tx_num_lmt, u8 rx_num_lmt, u8 *tx_num, u8 *rx_num) -+{ -+ u8 bmp_tx = (trx_path_bmp & 0xF0) >> 4; -+ u8 bmp_rx = trx_path_bmp & 0x0F; -+ u8 bmp_tx_num = 0, bmp_rx_num = 0; -+ enum rf_type ret_type = RF_TYPE_MAX; -+ int i, j; -+ -+ for (i = 0; i < RF_PATH_MAX; i++) { -+ if (bmp_tx & BIT(i)) -+ bmp_tx_num++; -+ if (bmp_rx & BIT(i)) -+ bmp_rx_num++; -+ } -+ -+ /* limit higher bit first according to input type */ -+ if (tx_num_lmt) -+ rtw_path_bmp_limit_from_higher(&bmp_tx, &bmp_tx_num, tx_num_lmt); -+ if (rx_num_lmt) -+ rtw_path_bmp_limit_from_higher(&bmp_rx, &bmp_rx_num, rx_num_lmt); -+ -+ /* search for valid rf_type (larger RX prefer) */ -+ for (j = bmp_rx_num; j > 0; j--) { -+ for (i = bmp_tx_num; i > 0; i--) { -+ ret_type = trx_num_to_rf_type(i, j); -+ if (RF_TYPE_VALID(ret_type)) { -+ rtw_path_bmp_limit_from_higher(&bmp_tx, &bmp_tx_num, i); -+ rtw_path_bmp_limit_from_higher(&bmp_rx, &bmp_rx_num, j); -+ if (tx_num) -+ *tx_num = bmp_tx_num; -+ if (rx_num) -+ *rx_num = bmp_rx_num; -+ goto exit; -+ } -+ } -+ } -+ -+exit: -+ return RF_TYPE_VALID(ret_type) ? ((bmp_tx << 4) | bmp_rx) : 0x00; -+} -+ -+u8 rtw_restrict_trx_path_bmp_by_rftype(u8 trx_path_bmp, enum rf_type type, u8 *tx_num, u8 *rx_num) -+{ -+ return rtw_restrict_trx_path_bmp_by_trx_num_lmt(trx_path_bmp -+ , rf_type_to_rf_tx_cnt(type), rf_type_to_rf_rx_cnt(type), tx_num, rx_num); -+} -+ -+/* config to non N-TX value, path with lower index prefer */ -+void tx_path_nss_set_default(enum bb_path txpath_nss[], u8 txpath_num_nss[], u8 txpath) -+{ -+ int i, j; -+ u8 cnt; -+ -+ for (i = 4; i > 0; i--) { -+ cnt = 0; -+ txpath_nss[i - 1] = 0; -+ for (j = 0; j < RF_PATH_MAX; j++) { -+ if (txpath & BIT(j)) { -+ txpath_nss[i - 1] |= BIT(j); -+ if (++cnt == i) -+ break; -+ } -+ } -+ txpath_num_nss[i - 1] = i; -+ } -+} -+ -+/* config to full N-TX value */ -+void tx_path_nss_set_full_tx(enum bb_path txpath_nss[], u8 txpath_num_nss[], u8 txpath) -+{ -+ u8 tx_num = 0; -+ int i; -+ -+ for (i = 0; i < RF_PATH_MAX; i++) -+ if (txpath & BIT(i)) -+ tx_num++; -+ -+ for (i = 4; i > 0; i--) { -+ txpath_nss[i - 1] = txpath; -+ txpath_num_nss[i - 1] = tx_num; -+ } -+} -+ -+/* -+* input with txpwr value in unit of txpwr index -+* return string in length 6 at least (for -xx.xx) -+*/ -+void txpwr_idx_get_dbm_str(s8 idx, u8 txgi_max, u8 txgi_pdbm, SIZE_T cwidth, char dbm_str[], u8 dbm_str_len) -+{ -+ char fmt[16]; -+ -+ if (idx == txgi_max) { -+ snprintf(fmt, 16, "%%%zus", cwidth >= 6 ? cwidth + 1 : 6); -+ snprintf(dbm_str, dbm_str_len, fmt, "NA"); -+ } else if (idx > -txgi_pdbm && idx < 0) { /* -0.xx */ -+ snprintf(fmt, 16, "%%%zus-0.%%02d", cwidth >= 6 ? cwidth - 4 : 1); -+ snprintf(dbm_str, dbm_str_len, fmt, "", (rtw_abs(idx) % txgi_pdbm) * 100 / txgi_pdbm); -+ } else if (idx % txgi_pdbm) { /* d.xx */ -+ snprintf(fmt, 16, "%%%zud.%%02d", cwidth >= 6 ? cwidth - 2 : 3); -+ snprintf(dbm_str, dbm_str_len, fmt, idx / txgi_pdbm, (rtw_abs(idx) % txgi_pdbm) * 100 / txgi_pdbm); -+ } else { /* d */ -+ snprintf(fmt, 16, "%%%zud", cwidth >= 6 ? cwidth + 1 : 6); -+ snprintf(dbm_str, dbm_str_len, fmt, idx / txgi_pdbm); -+ } -+} -+ -+/* -+* input with txpwr value in unit of mbm -+* return string in length 6 at least (for -xx.xx) -+*/ -+void txpwr_mbm_get_dbm_str(s16 mbm, SIZE_T cwidth, char dbm_str[], u8 dbm_str_len) -+{ -+ char fmt[16]; -+ -+ if (mbm == UNSPECIFIED_MBM) { -+ snprintf(fmt, 16, "%%%zus", cwidth >= 6 ? cwidth + 1 : 6); -+ snprintf(dbm_str, dbm_str_len, fmt, "NA"); -+ } else if (mbm > -MBM_PDBM && mbm < 0) { /* -0.xx */ -+ snprintf(fmt, 16, "%%%zus-0.%%02d", cwidth >= 6 ? cwidth - 4 : 1); -+ snprintf(dbm_str, dbm_str_len, fmt, "", (rtw_abs(mbm) % MBM_PDBM) * 100 / MBM_PDBM); -+ } else if (mbm % MBM_PDBM) { /* d.xx */ -+ snprintf(fmt, 16, "%%%zud.%%02d", cwidth >= 6 ? cwidth - 2 : 3); -+ snprintf(dbm_str, dbm_str_len, fmt, mbm / MBM_PDBM, (rtw_abs(mbm) % MBM_PDBM) * 100 / MBM_PDBM); -+ } else { /* d */ -+ snprintf(fmt, 16, "%%%zud", cwidth >= 6 ? cwidth + 1 : 6); -+ snprintf(dbm_str, dbm_str_len, fmt, mbm / MBM_PDBM); -+ } -+} -+ -+static const s16 _mb_of_ntx[] = { -+ 0, /* 1TX */ -+ 301, /* 2TX */ -+ 477, /* 3TX */ -+ 602, /* 4TX */ -+ 699, /* 5TX */ -+ 778, /* 6TX */ -+ 845, /* 7TX */ -+ 903, /* 8TX */ -+}; -+ -+/* get mB(100 *dB) for specifc TX count relative to 1TX */ -+s16 mb_of_ntx(u8 ntx) -+{ -+ if (ntx == 0 || ntx > 8) { -+ RTW_ERR("ntx=%u, out of range\n", ntx); -+ rtw_warn_on(1); -+ } -+ -+ return _mb_of_ntx[ntx - 1]; -+} -+ -+#if CONFIG_TXPWR_LIMIT -+void _dump_regd_exc_list(void *sel, struct rf_ctl_t *rfctl) -+{ -+ struct regd_exc_ent *ent; -+ _list *cur, *head; -+ -+ RTW_PRINT_SEL(sel, "regd_exc_num:%u\n", rfctl->regd_exc_num); -+ -+ if (!rfctl->regd_exc_num) -+ goto exit; -+ -+ RTW_PRINT_SEL(sel, "%-7s %-6s %-8s\n", "country", "domain", "lmt_name"); -+ -+ head = &rfctl->reg_exc_list; -+ cur = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ u8 has_country; -+ -+ ent = LIST_CONTAINOR(cur, struct regd_exc_ent, list); -+ cur = get_next(cur); -+ has_country = (ent->country[0] == '\0' && ent->country[1] == '\0') ? 0 : 1; -+ -+ RTW_PRINT_SEL(sel, " %c%c 0x%02x %s\n" -+ , has_country ? ent->country[0] : '0' -+ , has_country ? ent->country[1] : '0' -+ , ent->domain -+ , ent->lmt_name -+ ); -+ } -+ -+exit: -+ return; -+} -+ -+inline void dump_regd_exc_list(void *sel, struct rf_ctl_t *rfctl) -+{ -+ _irqL irqL; -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ _dump_regd_exc_list(sel, rfctl); -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+} -+ -+void rtw_regd_exc_add_with_nlen(struct rf_ctl_t *rfctl, const char *country, u8 domain, const char *lmt_name, u32 nlen) -+{ -+ struct regd_exc_ent *ent; -+ _irqL irqL; -+ -+ if (!lmt_name || !nlen) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ ent = (struct regd_exc_ent *)rtw_zmalloc(sizeof(struct regd_exc_ent) + nlen + 1); -+ if (!ent) -+ goto exit; -+ -+ _rtw_init_listhead(&ent->list); -+ if (country) -+ _rtw_memcpy(ent->country, country, 2); -+ ent->domain = domain; -+ _rtw_memcpy(ent->lmt_name, lmt_name, nlen); -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ rtw_list_insert_tail(&ent->list, &rfctl->reg_exc_list); -+ rfctl->regd_exc_num++; -+ -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+exit: -+ return; -+} -+ -+inline void rtw_regd_exc_add(struct rf_ctl_t *rfctl, const char *country, u8 domain, const char *lmt_name) -+{ -+ rtw_regd_exc_add_with_nlen(rfctl, country, domain, lmt_name, strlen(lmt_name)); -+} -+ -+struct regd_exc_ent *_rtw_regd_exc_search(struct rf_ctl_t *rfctl, const char *country, u8 domain) -+{ -+ struct regd_exc_ent *ent; -+ _list *cur, *head; -+ u8 match = 0; -+ -+ head = &rfctl->reg_exc_list; -+ cur = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ u8 has_country; -+ -+ ent = LIST_CONTAINOR(cur, struct regd_exc_ent, list); -+ cur = get_next(cur); -+ has_country = (ent->country[0] == '\0' && ent->country[1] == '\0') ? 0 : 1; -+ -+ /* entry has country condition to match */ -+ if (has_country) { -+ if (!country) -+ continue; -+ if (ent->country[0] != country[0] -+ || ent->country[1] != country[1]) -+ continue; -+ } -+ -+ /* entry has domain condition to match */ -+ if (ent->domain != 0xFF) { -+ if (domain == 0xFF) -+ continue; -+ if (ent->domain != domain) -+ continue; -+ } -+ -+ match = 1; -+ break; -+ } -+ -+ if (match) -+ return ent; -+ else -+ return NULL; -+} -+ -+inline struct regd_exc_ent *rtw_regd_exc_search(struct rf_ctl_t *rfctl, const char *country, u8 domain) -+{ -+ struct regd_exc_ent *ent; -+ _irqL irqL; -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ ent = _rtw_regd_exc_search(rfctl, country, domain); -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ return ent; -+} -+ -+void rtw_regd_exc_list_free(struct rf_ctl_t *rfctl) -+{ -+ struct regd_exc_ent *ent; -+ _irqL irqL; -+ _list *cur, *head; -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ head = &rfctl->reg_exc_list; -+ cur = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct regd_exc_ent, list); -+ cur = get_next(cur); -+ rtw_list_delete(&ent->list); -+ rtw_mfree((u8 *)ent, sizeof(struct regd_exc_ent) + strlen(ent->lmt_name) + 1); -+ } -+ rfctl->regd_exc_num = 0; -+ -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+} -+ -+void dump_txpwr_lmt(void *sel, _adapter *adapter) -+{ -+#define TMP_STR_LEN 16 -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ _irqL irqL; -+ char fmt[16]; -+ char tmp_str[TMP_STR_LEN]; -+ s8 *lmt_idx = NULL; -+ int bw, band, ch_num, tlrs, ntx_idx, rs, i, path; -+ u8 ch, n, rfpath_num; -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ _dump_regd_exc_list(sel, rfctl); -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ if (!rfctl->txpwr_lmt_num) -+ goto release_lock; -+ -+ lmt_idx = rtw_malloc(sizeof(s8) * RF_PATH_MAX * rfctl->txpwr_lmt_num); -+ if (!lmt_idx) { -+ RTW_ERR("%s alloc fail\n", __func__); -+ goto release_lock; -+ } -+ -+ RTW_PRINT_SEL(sel, "txpwr_lmt_2g_cck_ofdm_state:0x%02x\n", rfctl->txpwr_lmt_2g_cck_ofdm_state); -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ if (IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) { -+ RTW_PRINT_SEL(sel, "txpwr_lmt_5g_cck_ofdm_state:0x%02x\n", rfctl->txpwr_lmt_5g_cck_ofdm_state); -+ RTW_PRINT_SEL(sel, "txpwr_lmt_5g_20_40_ref:0x%02x\n", rfctl->txpwr_lmt_5g_20_40_ref); -+ } -+ #endif -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ if (!hal_is_band_support(adapter, band)) -+ continue; -+ -+ 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 (tlrs = TXPWR_LMT_RS_CCK; tlrs < TXPWR_LMT_RS_NUM; tlrs++) { -+ -+ if (band == BAND_ON_2_4G && tlrs == TXPWR_LMT_RS_VHT) -+ continue; -+ if (band == BAND_ON_5G && tlrs == TXPWR_LMT_RS_CCK) -+ continue; -+ if (bw > CHANNEL_WIDTH_20 && (tlrs == TXPWR_LMT_RS_CCK || tlrs == TXPWR_LMT_RS_OFDM)) -+ continue; -+ if (bw > CHANNEL_WIDTH_40 && tlrs == TXPWR_LMT_RS_HT) -+ continue; -+ if (tlrs == TXPWR_LMT_RS_VHT && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ continue; -+ -+ for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { -+ struct txpwr_lmt_ent *ent; -+ _list *cur, *head; -+ -+ if (ntx_idx + 1 > hal_data->max_tx_cnt) -+ continue; -+ -+ /* bypass CCK multi-TX is not defined */ -+ if (tlrs == TXPWR_LMT_RS_CCK && ntx_idx > RF_1TX) { -+ if (band == BAND_ON_2_4G -+ && !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_CCK_1T << ntx_idx))) -+ continue; -+ } -+ -+ /* bypass OFDM multi-TX is not defined */ -+ if (tlrs == TXPWR_LMT_RS_OFDM && ntx_idx > RF_1TX) { -+ if (band == BAND_ON_2_4G -+ && !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))) -+ continue; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ if (band == BAND_ON_5G -+ && !(rfctl->txpwr_lmt_5g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))) -+ continue; -+ #endif -+ } -+ -+ /* bypass 5G 20M, 40M pure reference */ -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ if (band == BAND_ON_5G && (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40)) { -+ if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_HT_FROM_VHT) { -+ if (tlrs == TXPWR_LMT_RS_HT) -+ continue; -+ } else if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_VHT_FROM_HT) { -+ if (tlrs == TXPWR_LMT_RS_VHT && bw <= CHANNEL_WIDTH_40) -+ continue; -+ } -+ } -+ #endif -+ -+ /* choose n-SS mapping rate section to get lmt diff value */ -+ if (tlrs == TXPWR_LMT_RS_CCK) -+ rs = CCK; -+ else if (tlrs == TXPWR_LMT_RS_OFDM) -+ rs = OFDM; -+ else if (tlrs == TXPWR_LMT_RS_HT) -+ rs = HT_1SS + ntx_idx; -+ else if (tlrs == TXPWR_LMT_RS_VHT) -+ rs = VHT_1SS + ntx_idx; -+ else { -+ RTW_ERR("%s invalid tlrs %u\n", __func__, tlrs); -+ continue; -+ } -+ -+ RTW_PRINT_SEL(sel, "[%s][%s][%s][%uT]\n" -+ , band_str(band) -+ , ch_width_str(bw) -+ , txpwr_lmt_rs_str(tlrs) -+ , ntx_idx + 1 -+ ); -+ -+ /* header for limit in db */ -+ RTW_PRINT_SEL(sel, "%3s ", "ch"); -+ -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ -+ sprintf(fmt, "%%%zus%%s ", strlen(ent->name) >= 6 ? 1 : 6 - strlen(ent->name)); -+ snprintf(tmp_str, TMP_STR_LEN, fmt -+ , rtw_rfctl_is_current_txpwr_lmt(rfctl, ent->name) ? "*" : "" -+ , ent->name); -+ _RTW_PRINT_SEL(sel, "%s", tmp_str); -+ } -+ sprintf(fmt, "%%%zus%%s ", strlen(txpwr_lmt_str(TXPWR_LMT_WW)) >= 6 ? 1 : 6 - strlen(txpwr_lmt_str(TXPWR_LMT_WW))); -+ snprintf(tmp_str, TMP_STR_LEN, fmt -+ , rtw_rfctl_is_current_txpwr_lmt(rfctl, txpwr_lmt_str(TXPWR_LMT_WW)) ? "*" : "" -+ , txpwr_lmt_str(TXPWR_LMT_WW)); -+ _RTW_PRINT_SEL(sel, "%s", tmp_str); -+ -+ /* header for limit offset */ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (path >= rfpath_num) -+ break; -+ _RTW_PRINT_SEL(sel, "|"); -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ _RTW_PRINT_SEL(sel, "%3c " -+ , rtw_rfctl_is_current_txpwr_lmt(rfctl, ent->name) ? rf_path_char(path) : ' '); -+ } -+ _RTW_PRINT_SEL(sel, "%3c " -+ , rtw_rfctl_is_current_txpwr_lmt(rfctl, txpwr_lmt_str(TXPWR_LMT_WW)) ? rf_path_char(path) : ' '); -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ -+ for (n = 0; n < ch_num; n++) { -+ s8 lmt; -+ s8 lmt_offset; -+ 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 dBm */ -+ RTW_PRINT_SEL(sel, "%3u ", ch); -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ lmt = phy_get_txpwr_lmt(adapter, ent->name, band, bw, tlrs, ntx_idx, ch, 0); -+ txpwr_idx_get_dbm_str(lmt, hal_spec->txgi_max, hal_spec->txgi_pdbm, strlen(ent->name), tmp_str, TMP_STR_LEN); -+ _RTW_PRINT_SEL(sel, "%s ", tmp_str); -+ } -+ lmt = phy_get_txpwr_lmt(adapter, txpwr_lmt_str(TXPWR_LMT_WW), band, bw, tlrs, ntx_idx, ch, 0); -+ txpwr_idx_get_dbm_str(lmt, hal_spec->txgi_max, hal_spec->txgi_pdbm, strlen(txpwr_lmt_str(TXPWR_LMT_WW)), tmp_str, TMP_STR_LEN); -+ _RTW_PRINT_SEL(sel, "%s ", tmp_str); -+ -+ /* dump limit offset of each path */ -+ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { -+ if (path >= rfpath_num) -+ break; -+ -+ base = phy_get_target_txpwr(adapter, band, path, rs); -+ -+ _RTW_PRINT_SEL(sel, "|"); -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ i = 0; -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ lmt_offset = phy_get_txpwr_lmt_diff(adapter, ent->name, band, bw, path, rs, tlrs, ntx_idx, ch, 0); -+ if (lmt_offset == hal_spec->txgi_max) { -+ *(lmt_idx + i * RF_PATH_MAX + path) = hal_spec->txgi_max; -+ _RTW_PRINT_SEL(sel, "%3s ", "NA"); -+ } else { -+ *(lmt_idx + i * RF_PATH_MAX + path) = lmt_offset + base; -+ _RTW_PRINT_SEL(sel, "%3d ", lmt_offset); -+ } -+ i++; -+ } -+ lmt_offset = phy_get_txpwr_lmt_diff(adapter, txpwr_lmt_str(TXPWR_LMT_WW), band, bw, path, rs, tlrs, ntx_idx, ch, 0); -+ if (lmt_offset == hal_spec->txgi_max) -+ _RTW_PRINT_SEL(sel, "%3s ", "NA"); -+ else -+ _RTW_PRINT_SEL(sel, "%3d ", lmt_offset); -+ -+ } -+ -+ /* compare limit_idx of each path, print 'x' when mismatch */ -+ if (rfpath_num > 1) { -+ for (i = 0; i < rfctl->txpwr_lmt_num; i++) { -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (path >= rfpath_num) -+ break; -+ if (*(lmt_idx + i * RF_PATH_MAX + path) != *(lmt_idx + i * RF_PATH_MAX + ((path + 1) % rfpath_num))) -+ 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 */ -+ -+ if (lmt_idx) -+ rtw_mfree(lmt_idx, sizeof(s8) * RF_PATH_MAX * rfctl->txpwr_lmt_num); -+ -+release_lock: -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+} -+ -+/* search matcing first, if not found, alloc one */ -+void rtw_txpwr_lmt_add_with_nlen(struct rf_ctl_t *rfctl, const char *lmt_name, u32 nlen -+ , u8 band, u8 bw, u8 tlrs, u8 ntx_idx, u8 ch_idx, s8 lmt) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(dvobj_get_primary_adapter(rfctl_to_dvobj(rfctl))); -+ struct txpwr_lmt_ent *ent; -+ _irqL irqL; -+ _list *cur, *head; -+ s8 pre_lmt; -+ -+ if (!lmt_name || !nlen) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ /* search for existed entry */ -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ -+ if (strlen(ent->name) == nlen -+ && _rtw_memcmp(ent->name, lmt_name, nlen) == _TRUE) -+ goto chk_lmt_val; -+ } -+ -+ /* alloc new one */ -+ ent = (struct txpwr_lmt_ent *)rtw_zvmalloc(sizeof(struct txpwr_lmt_ent) + nlen + 1); -+ if (!ent) -+ goto release_lock; -+ -+ _rtw_init_listhead(&ent->list); -+ _rtw_memcpy(ent->name, lmt_name, nlen); -+ { -+ u8 j, k, l, m; -+ -+ for (j = 0; j < MAX_2_4G_BANDWIDTH_NUM; ++j) -+ for (k = 0; k < TXPWR_LMT_RS_NUM_2G; ++k) -+ for (m = 0; m < CENTER_CH_2G_NUM; ++m) -+ for (l = 0; l < MAX_TX_COUNT; ++l) -+ ent->lmt_2g[j][k][m][l] = hal_spec->txgi_max; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ for (j = 0; j < MAX_5G_BANDWIDTH_NUM; ++j) -+ for (k = 0; k < TXPWR_LMT_RS_NUM_5G; ++k) -+ for (m = 0; m < CENTER_CH_5G_ALL_NUM; ++m) -+ for (l = 0; l < MAX_TX_COUNT; ++l) -+ ent->lmt_5g[j][k][m][l] = hal_spec->txgi_max; -+ #endif -+ } -+ -+ rtw_list_insert_tail(&ent->list, &rfctl->txpwr_lmt_list); -+ rfctl->txpwr_lmt_num++; -+ -+chk_lmt_val: -+ if (band == BAND_ON_2_4G) -+ pre_lmt = ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx]; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ else if (band == BAND_ON_5G) -+ pre_lmt = ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx]; -+ #endif -+ else -+ goto release_lock; -+ -+ if (pre_lmt != hal_spec->txgi_max) -+ RTW_PRINT("duplicate txpwr_lmt for [%s][%s][%s][%s][%uT][%d]\n" -+ , lmt_name, band_str(band), ch_width_str(bw), txpwr_lmt_rs_str(tlrs), ntx_idx + 1 -+ , band == BAND_ON_2_4G ? ch_idx + 1 : center_ch_5g_all[ch_idx]); -+ -+ lmt = rtw_min(pre_lmt, lmt); -+ if (band == BAND_ON_2_4G) -+ ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx] = lmt; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ else if (band == BAND_ON_5G) -+ ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx] = lmt; -+ #endif -+ -+ if (0) -+ RTW_PRINT("%s, %4s, %6s, %7s, %uT, ch%3d = %d\n" -+ , lmt_name, band_str(band), ch_width_str(bw), txpwr_lmt_rs_str(tlrs), ntx_idx + 1 -+ , band == BAND_ON_2_4G ? ch_idx + 1 : center_ch_5g_all[ch_idx] -+ , lmt); -+ -+release_lock: -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+exit: -+ return; -+} -+ -+inline void rtw_txpwr_lmt_add(struct rf_ctl_t *rfctl, const char *lmt_name -+ , u8 band, u8 bw, u8 tlrs, u8 ntx_idx, u8 ch_idx, s8 lmt) -+{ -+ rtw_txpwr_lmt_add_with_nlen(rfctl, lmt_name, strlen(lmt_name) -+ , band, bw, tlrs, ntx_idx, ch_idx, lmt); -+} -+ -+struct txpwr_lmt_ent *_rtw_txpwr_lmt_get_by_name(struct rf_ctl_t *rfctl, const char *lmt_name) -+{ -+ struct txpwr_lmt_ent *ent; -+ _list *cur, *head; -+ u8 found = 0; -+ -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ -+ if (strcmp(ent->name, lmt_name) == 0) { -+ found = 1; -+ break; -+ } -+ } -+ -+ if (found) -+ return ent; -+ return NULL; -+} -+ -+inline struct txpwr_lmt_ent *rtw_txpwr_lmt_get_by_name(struct rf_ctl_t *rfctl, const char *lmt_name) -+{ -+ struct txpwr_lmt_ent *ent; -+ _irqL irqL; -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ ent = _rtw_txpwr_lmt_get_by_name(rfctl, lmt_name); -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ return ent; -+} -+ -+void rtw_txpwr_lmt_list_free(struct rf_ctl_t *rfctl) -+{ -+ struct txpwr_lmt_ent *ent; -+ _irqL irqL; -+ _list *cur, *head; -+ int band; -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ rtw_list_delete(&ent->list); -+ rtw_vmfree((u8 *)ent, sizeof(struct txpwr_lmt_ent) + strlen(ent->name) + 1); -+ } -+ rfctl->txpwr_lmt_num = 0; -+ -+ for (band = 0; band < BAND_MAX; band++) -+ rfctl->txpwr_lmt_name[band] = NULL; -+ -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+} -+#endif /* CONFIG_TXPWR_LIMIT */ -+ -+int rtw_ch_to_bb_gain_sel(int ch) -+{ -+ int sel = -1; -+ -+ if (ch >= 1 && ch <= 14) -+ sel = BB_GAIN_2G; -+#if 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 -+ 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) -+{ -+#if !defined(CONFIG_RTL8814A) && !defined(CONFIG_RTL8822B) && !defined(CONFIG_RTL8821C) && !defined(CONFIG_RTL8822C) \ -+ && !defined(CONFIG_RTL8723F) -+ u8 write_value; -+#endif -+ 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_RTL8188GTV -+ case RTL8188GTV: -+ write_value = RF_TX_GAIN_OFFSET_8188GTV(offset); -+ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0fc000, write_value); -+ break; -+#endif /* CONFIG_RTL8188GTV */ -+#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) || defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8822C) \ -+ || defined(CONFIG_RTL8723F) -+ case RTL8814A: -+ case RTL8822B: -+ case RTL8822C: -+ case RTL8821C: -+ case RTL8192F: -+ case RTL8723F: -+ RTW_INFO("\nkfree by PhyDM on the sw CH. path %d\n", path); -+ break; -+#endif /* CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C || CONFIG_RTL8723F */ -+ -+ 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) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(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_spec->rf_reg_path_num; -+ -+ 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_long_cac_range(u32 hi, u32 lo, u8 dfs_region) -+{ -+ return (dfs_region == RTW_DFS_REGD_ETSI && rtw_is_range_overlap(hi, lo, 5650, 5600)) ? _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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_rm.c b/drivers/net/wireless/rtl8821cs/core/rtw_rm.c -new file mode 100644 -index 000000000..de627e822 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_rm.c -@@ -0,0 +1,2867 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#ifdef CONFIG_RTW_80211K -+#include "rtw_rm_fsm.h" -+#include "rtw_rm_util.h" -+#endif -+ -+#define pstr(s) s+strlen(s) -+#ifndef MIN -+#define MIN(x, y) (((x) < (y)) ? (x) : (y)) -+#endif -+ -+u8 rm_post_event_hdl(_adapter *padapter, u8 *pbuf) -+{ -+#ifdef CONFIG_RTW_80211K -+ struct rm_event *pev = (struct rm_event *)pbuf; -+ -+ _rm_post_event(padapter, pev->rmid, pev->evid); -+ rm_handler(padapter, pev); -+#endif -+ return H2C_SUCCESS; -+} -+ -+void rm_update_cap(u8 *frame_head, _adapter *pa, u32 pktlen, int offset) -+{ -+#ifdef CONFIG_RTW_80211K -+ u8 *res; -+ sint len; -+ -+ res = rtw_get_ie(frame_head + offset, _EID_RRM_EN_CAP_IE_, &len, -+ pktlen - offset); -+ if (res != NULL) -+ _rtw_memcpy((void *)pa->rmpriv.rm_en_cap_def, (res + 2), -+ MIN(len, sizeof(pa->rmpriv.rm_en_cap_def))); -+#endif -+} -+ -+#ifdef CONFIG_RTW_80211K -+struct cmd_meas_type_ { -+ u8 id; -+ char *name; -+}; -+ -+char *rm_type_req_name(u8 meas_type) { -+ -+ switch (meas_type) { -+ case basic_req: -+ return "basic_req"; -+ case cca_req: -+ return "cca_req"; -+ case rpi_histo_req: -+ return "rpi_histo_req"; -+ case ch_load_req: -+ return "ch_load_req"; -+ case noise_histo_req: -+ return "noise_histo_req"; -+ case bcn_req: -+ return "bcn_req"; -+ case frame_req: -+ return "frame_req"; -+ case sta_statis_req: -+ return "sta_statis_req"; -+ } -+ return "unknown_req"; -+}; -+ -+char *rm_type_rep_name(u8 meas_type) { -+ -+ switch (meas_type) { -+ case basic_rep: -+ return "basic_rep"; -+ case cca_rep: -+ return "cca_rep"; -+ case rpi_histo_rep: -+ return "rpi_histo_rep"; -+ case ch_load_rep: -+ return "ch_load_rep"; -+ case noise_histo_rep: -+ return "noise_histo_rep"; -+ case bcn_rep: -+ return "bcn_rep"; -+ case frame_rep: -+ return "frame_rep"; -+ case sta_statis_rep: -+ return "sta_statis_rep"; -+ } -+ return "unknown_rep"; -+}; -+ -+char *rm_en_cap_name(enum rm_cap_en en) -+{ -+ switch (en) { -+ case RM_LINK_MEAS_CAP_EN: -+ return "RM_LINK_MEAS_CAP_EN"; -+ case RM_NB_REP_CAP_EN: -+ return "RM_NB_REP_CAP_EN"; -+ case RM_PARAL_MEAS_CAP_EN: -+ return "RM_PARAL_MEAS_CAP_EN"; -+ case RM_REPEAT_MEAS_CAP_EN: -+ return "RM_REPEAT_MEAS_CAP_EN"; -+ case RM_BCN_PASSIVE_MEAS_CAP_EN: -+ return "RM_BCN_PASSIVE_MEAS_CAP_EN"; -+ case RM_BCN_ACTIVE_MEAS_CAP_EN: -+ return "RM_BCN_ACTIVE_MEAS_CAP_EN"; -+ case RM_BCN_TABLE_MEAS_CAP_EN: -+ return "RM_BCN_TABLE_MEAS_CAP_EN"; -+ case RM_BCN_MEAS_REP_COND_CAP_EN: -+ return "RM_BCN_MEAS_REP_COND_CAP_EN"; -+ -+ case RM_FRAME_MEAS_CAP_EN: -+ return "RM_FRAME_MEAS_CAP_EN"; -+ case RM_CH_LOAD_CAP_EN: -+ return "RM_CH_LOAD_CAP_EN"; -+ case RM_NOISE_HISTO_CAP_EN: -+ return "RM_NOISE_HISTO_CAP_EN"; -+ case RM_STATIS_MEAS_CAP_EN: -+ return "RM_STATIS_MEAS_CAP_EN"; -+ case RM_LCI_MEAS_CAP_EN: -+ return "RM_LCI_MEAS_CAP_EN"; -+ case RM_LCI_AMIMUTH_CAP_EN: -+ return "RM_LCI_AMIMUTH_CAP_EN"; -+ case RM_TRANS_STREAM_CAT_MEAS_CAP_EN: -+ return "RM_TRANS_STREAM_CAT_MEAS_CAP_EN"; -+ case RM_TRIG_TRANS_STREAM_CAT_MEAS_CAP_EN: -+ return "RM_TRIG_TRANS_STREAM_CAT_MEAS_CAP_EN"; -+ -+ case RM_AP_CH_REP_CAP_EN: -+ return "RM_AP_CH_REP_CAP_EN"; -+ case RM_RM_MIB_CAP_EN: -+ return "RM_RM_MIB_CAP_EN"; -+ case RM_OP_CH_MAX_MEAS_DUR0: -+ return "RM_OP_CH_MAX_MEAS_DUR0"; -+ case RM_OP_CH_MAX_MEAS_DUR1: -+ return "RM_OP_CH_MAX_MEAS_DUR1"; -+ case RM_OP_CH_MAX_MEAS_DUR2: -+ return "RM_OP_CH_MAX_MEAS_DUR2"; -+ case RM_NONOP_CH_MAX_MEAS_DUR0: -+ return "RM_NONOP_CH_MAX_MEAS_DUR0"; -+ case RM_NONOP_CH_MAX_MEAS_DUR1: -+ return "RM_NONOP_CH_MAX_MEAS_DUR1"; -+ case RM_NONOP_CH_MAX_MEAS_DUR2: -+ return "RM_NONOP_CH_MAX_MEAS_DUR2"; -+ -+ case RM_MEAS_PILOT_CAP0: -+ return "RM_MEAS_PILOT_CAP0"; /* 24-26 */ -+ case RM_MEAS_PILOT_CAP1: -+ return "RM_MEAS_PILOT_CAP1"; -+ case RM_MEAS_PILOT_CAP2: -+ return "RM_MEAS_PILOT_CAP2"; -+ case RM_MEAS_PILOT_TRANS_INFO_CAP_EN: -+ return "RM_MEAS_PILOT_TRANS_INFO_CAP_EN"; -+ case RM_NB_REP_TSF_OFFSET_CAP_EN: -+ return "RM_NB_REP_TSF_OFFSET_CAP_EN"; -+ case RM_RCPI_MEAS_CAP_EN: -+ return "RM_RCPI_MEAS_CAP_EN"; /* 29 */ -+ case RM_RSNI_MEAS_CAP_EN: -+ return "RM_RSNI_MEAS_CAP_EN"; -+ case RM_BSS_AVG_ACCESS_DELAY_CAP_EN: -+ return "RM_BSS_AVG_ACCESS_DELAY_CAP_EN"; -+ -+ case RM_AVALB_ADMIS_CAPACITY_CAP_EN: -+ return "RM_AVALB_ADMIS_CAPACITY_CAP_EN"; -+ case RM_ANT_CAP_EN: -+ return "RM_ANT_CAP_EN"; -+ case RM_RSVD: -+ case RM_MAX: -+ default: -+ break; -+ } -+ return "unknown"; -+} -+ -+int rm_en_cap_chk_and_set(struct rm_obj *prm, enum rm_cap_en en) -+{ -+ int idx; -+ u8 cap; -+ -+ -+ if (en >= RM_MAX) -+ return _FALSE; -+ -+ idx = en / 8; -+ cap = prm->psta->padapter->rmpriv.rm_en_cap_def[idx]; -+ -+ if (!(cap & BIT(en - (idx*8)))) { -+ RTW_INFO("RM: %s incapable\n",rm_en_cap_name(en)); -+ rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP); -+ return _FALSE; -+ } -+ return _SUCCESS; -+} -+ -+/* for caller outside rm */ -+u8 rm_add_nb_req(_adapter *padapter, struct sta_info *psta) -+{ -+ struct rm_obj *prm; -+ -+ -+ prm = rm_alloc_rmobj(padapter); -+ -+ if (prm == NULL) { -+ RTW_ERR("RM: unable to alloc rm obj for requeset\n"); -+ return _FALSE; -+ } -+ -+ prm->psta = psta; -+ prm->q.category = RTW_WLAN_CATEGORY_RADIO_MEAS; -+ prm->q.diag_token = rm_gen_dialog_token(padapter); -+ prm->q.m_token = rm_gen_meas_token(padapter); -+ prm->rmid = rm_gen_rmid(padapter, prm, RM_MASTER); -+ -+ prm->q.action_code = RM_ACT_NB_REP_REQ; -+ -+ #if 0 -+ if (pmac) { /* find sta_info according to bssid */ -+ pmac += 4; /* skip mac= */ -+ if (hwaddr_parse(pmac, bssid) == NULL) { -+ sprintf(pstr(s), "Err: \nincorrect mac format\n"); -+ return _FAIL; -+ } -+ psta = rm_get_sta(padapter, 0xff, bssid); -+ } -+ #endif -+ -+ /* enquee rmobj */ -+ rm_enqueue_rmobj(padapter, prm, _FALSE); -+ -+ RTW_INFO("RM: rmid=%x add req to " MAC_FMT "\n", -+ prm->rmid, MAC_ARG(psta->cmn.mac_addr)); -+ -+ return _SUCCESS; -+} -+ -+static u8 *build_wlan_hdr(_adapter *padapter, struct xmit_frame *pmgntframe, -+ struct sta_info *psta, u16 frame_type) -+{ -+ u8 *pframe; -+ u16 *fctrl; -+ struct pkt_attrib *pattr; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ -+ /* update attribute */ -+ pattr = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattr); -+ -+ _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, psta->cmn.mac_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, -+ get_my_bssid(&(pmlmeinfo->network)),ETH_ALEN); -+ -+ RTW_INFO("RM: dst = " MAC_FMT "\n", MAC_ARG(pwlanhdr->addr1)); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFragNum(pframe, 0); -+ -+ set_frame_sub_type(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattr->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ return pframe; -+} -+ -+void rm_set_rep_mode(struct rm_obj *prm, u8 mode) -+{ -+ -+ RTW_INFO("RM: rmid=%x set %s\n", -+ prm->rmid, -+ mode|MEAS_REP_MOD_INCAP?"INCAP": -+ mode|MEAS_REP_MOD_REFUSE?"REFUSE": -+ mode|MEAS_REP_MOD_LATE?"LATE":""); -+ -+ prm->p.m_mode |= mode; -+} -+ -+int issue_null_reply(struct rm_obj *prm) -+{ -+ int len=0, my_len; -+ u8 *pframe, m_mode; -+ _adapter *padapter = prm->psta->padapter; -+ struct pkt_attrib *pattr; -+ struct xmit_frame *pmgntframe; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ -+ -+ m_mode = prm->p.m_mode; -+ if (m_mode || prm->p.rpt == 0) { -+ RTW_INFO("RM: rmid=%x reply (%s repeat=%d)\n", -+ prm->rmid, -+ m_mode&MEAS_REP_MOD_INCAP?"INCAP": -+ m_mode&MEAS_REP_MOD_REFUSE?"REFUSE": -+ m_mode&MEAS_REP_MOD_LATE?"LATE":"no content", -+ prm->p.rpt); -+ } -+ -+ switch (prm->p.action_code) { -+ case RM_ACT_RADIO_MEAS_REQ: -+ len = 8; -+ break; -+ case RM_ACT_NB_REP_REQ: -+ len = 3; -+ break; -+ case RM_ACT_LINK_MEAS_REQ: -+ len = 3; -+ break; -+ default: -+ break; -+ } -+ -+ if (len==0) -+ return _FALSE; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__); -+ return _FALSE; -+ } -+ pattr = &pmgntframe->attrib; -+ pframe = build_wlan_hdr(padapter, pmgntframe, prm->psta, WIFI_ACTION); -+ pframe = rtw_set_fixed_ie(pframe, 3, &prm->p.category, &pattr->pktlen); -+ -+ my_len = 0; -+ if (len>5) { -+ prm->p.len = len - 3 - 2; -+ pframe = rtw_set_fixed_ie(pframe, len - 3, -+ &prm->p.e_id, &my_len); -+ } -+ -+ pattr->pktlen += my_len; -+ pattr->last_txcmdsz = pattr->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return _SUCCESS; -+} -+ -+int ready_for_scan(struct rm_obj *prm) -+{ -+ _adapter *padapter = prm->psta->padapter; -+ u8 ssc_chk; -+ -+ if (!rtw_is_adapter_up(padapter)) -+ return _FALSE; -+ -+ ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); -+ -+ if (ssc_chk == SS_ALLOW) -+ return _SUCCESS; -+ -+ return _FALSE; -+} -+ -+int rm_sitesurvey(struct rm_obj *prm) -+{ -+ int meas_ch_amount=0; -+ u8 op_class=0, val8; -+ struct rtw_ieee80211_channel *pch_set; -+ struct sitesurvey_parm parm; -+ -+ -+ RTW_INFO("RM: rmid=%x %s\n",prm->rmid, __func__); -+ -+ pch_set = &prm->q.ch_set[0]; -+ -+ _rtw_memset(pch_set, 0, -+ sizeof(struct rtw_ieee80211_channel) * RTW_CHANNEL_SCAN_AMOUNT); -+ -+ op_class = prm->q.op_class; -+ if (prm->q.ch_num == 0) { -+ /* ch_num=0 : scan all ch in operating class */ -+ meas_ch_amount = rm_get_ch_set(pch_set, -+ op_class, prm->q.ch_num); -+ -+ } else if (prm->q.ch_num == 255) { -+ /* 802.11 p.1066 */ -+ /* ch_num=255 : If the Channel Number is 255 and includes -+ * AP Channel Report subelements -+ */ -+ meas_ch_amount = rm_get_ch_set_from_bcn_req_opt(pch_set, &prm->q.opt.bcn); -+ } else -+ meas_ch_amount = rm_get_ch_set(pch_set, op_class, prm->q.ch_num); -+ -+ /* get means channel */ -+ prm->q.ch_set_ch_amount = meas_ch_amount; -+ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("survey (%d) chaannels\n", meas_ch_amount); -+#endif -+ -+ _rtw_memset(&parm, 0, sizeof(struct sitesurvey_parm)); -+ _rtw_memcpy(parm.ch, pch_set, -+ sizeof(struct rtw_ieee80211_channel) * -+ MIN(meas_ch_amount, RTW_CHANNEL_SCAN_AMOUNT)); -+ -+ _rtw_memcpy(&parm.ssid[0], &prm->q.opt.bcn.ssid, IW_ESSID_MAX_SIZE); -+ -+ parm.ssid_num = 1; -+ parm.scan_mode = prm->q.m_mode; -+ parm.ch_num = meas_ch_amount; -+ parm.igi = 0; -+ parm.token = prm->rmid; -+ parm.duration = prm->q.meas_dur; -+ /* parm.bw = BW_20M; */ -+ -+ rtw_sitesurvey_cmd(prm->psta->padapter, &parm); -+ -+ return _SUCCESS; -+} -+ -+static int rm_parse_ch_load_s_elem(struct rm_obj *prm, u8 *pbody, int req_len) -+{ -+ u8 *popt_id; -+ int i, p=0; /* position */ -+ int len = req_len; -+ -+ -+ prm->q.opt_s_elem_len = len; -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: opt_s_elem_len=%d\n", len); -+#endif -+ while (len) { -+ -+ switch (pbody[p]) { -+ case ch_load_rep_info: -+ /* check RM_EN */ -+ rm_en_cap_chk_and_set(prm, RM_CH_LOAD_CAP_EN); -+ -+ _rtw_memcpy(&(prm->q.opt.clm.rep_cond), -+ &pbody[p+2], sizeof(prm->q.opt.clm.rep_cond)); -+ -+ RTW_INFO("RM: ch_load_rep_info=%u:%u\n", -+ prm->q.opt.clm.rep_cond.cond, -+ prm->q.opt.clm.rep_cond.threshold); -+ break; -+ default: -+ break; -+ -+ } -+ len = len - (int)pbody[p+1] - 2; -+ p = p + (int)pbody[p+1] + 2; -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: opt_s_elem_len=%d\n",len); -+#endif -+ } -+ return _SUCCESS; -+} -+ -+static int rm_parse_noise_histo_s_elem(struct rm_obj *prm, -+ u8 *pbody, int req_len) -+{ -+ u8 *popt_id; -+ int i, p=0; /* position */ -+ int len = req_len; -+ -+ -+ prm->q.opt_s_elem_len = len; -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: opt_s_elem_len=%d\n", len); -+#endif -+ -+ while (len) { -+ -+ switch (pbody[p]) { -+ case noise_histo_rep_info: -+ /* check RM_EN */ -+ rm_en_cap_chk_and_set(prm, RM_NOISE_HISTO_CAP_EN); -+ -+ _rtw_memcpy(&(prm->q.opt.nhm.rep_cond), -+ &pbody[p+2], sizeof(prm->q.opt.nhm.rep_cond)); -+ -+ RTW_INFO("RM: noise_histo_rep_info=%u:%u\n", -+ prm->q.opt.nhm.rep_cond.cond, -+ prm->q.opt.nhm.rep_cond.threshold); -+ break; -+ default: -+ break; -+ -+ } -+ len = len - (int)pbody[p+1] - 2; -+ p = p + (int)pbody[p+1] + 2; -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: opt_s_elem_len=%d\n",len); -+#endif -+ } -+ return _SUCCESS; -+} -+ -+static int rm_parse_bcn_req_s_elem(struct rm_obj *prm, u8 *pbody, int req_len) -+{ -+ u8 *popt_id; -+ int i, p=0; /* position */ -+ int len = req_len; -+ int ap_ch_rpt_idx = 0; -+ struct _RT_OPERATING_CLASS *op; -+ -+ -+ /* opt length,2:pbody[0]+ pbody[1] */ -+ /* first opt id : pbody[18] */ -+ -+ prm->q.opt_s_elem_len = len; -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: opt_s_elem_len=%d\n", len); -+#endif -+ -+ popt_id = prm->q.opt.bcn.opt_id; -+ while (len && prm->q.opt.bcn.opt_id_num < BCN_REQ_OPT_MAX_NUM) { -+ -+ switch (pbody[p]) { -+ case bcn_req_ssid: -+ RTW_INFO("bcn_req_ssid\n"); -+ -+#if (DBG_BCN_REQ_WILDCARD) -+ RTW_INFO("DBG set ssid to WILDCARD\n"); -+#else -+#if (DBG_BCN_REQ_SSID) -+ RTW_INFO("DBG set ssid to %s\n",DBG_BCN_REQ_SSID_NAME); -+ i = strlen(DBG_BCN_REQ_SSID_NAME); -+ prm->q.opt.bcn.ssid.SsidLength = i; -+ _rtw_memcpy(&(prm->q.opt.bcn.ssid.Ssid), DBG_BCN_REQ_SSID_NAME, -+ MIN(i, sizeof(prm->q.opt.bcn.ssid.Ssid)-1)); -+ -+#else /* original */ -+ prm->q.opt.bcn.ssid.SsidLength = pbody[p+1]; -+ _rtw_memcpy(&(prm->q.opt.bcn.ssid.Ssid), &pbody[p+2], -+ MIN(pbody[p+1], sizeof(prm->q.opt.bcn.ssid.Ssid)-1)); -+#endif -+#endif -+ RTW_INFO("RM: bcn_req_ssid=%s\n", -+ prm->q.opt.bcn.ssid.Ssid); -+ -+ popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p]; -+ break; -+ -+ case bcn_req_rep_info: -+ /* check RM_EN */ -+ rm_en_cap_chk_and_set(prm, RM_BCN_MEAS_REP_COND_CAP_EN); -+ -+ _rtw_memcpy(&(prm->q.opt.bcn.rep_cond), -+ &pbody[p+2], sizeof(prm->q.opt.bcn.rep_cond)); -+ -+ RTW_INFO("bcn_req_rep_info=%u:%u\n", -+ prm->q.opt.bcn.rep_cond.cond, -+ prm->q.opt.bcn.rep_cond.threshold); -+ -+ /*popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p];*/ -+ break; -+ -+ case bcn_req_rep_detail: -+#if DBG_BCN_REQ_DETAIL -+ prm->q.opt.bcn.rep_detail = 2; /* all IE in beacon */ -+#else -+ prm->q.opt.bcn.rep_detail = pbody[p+2]; -+#endif -+ popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p]; -+ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: report_detail=%d\n", -+ prm->q.opt.bcn.rep_detail); -+#endif -+ break; -+ -+ case bcn_req_req: -+ RTW_INFO("RM: bcn_req_req\n"); -+ -+ prm->q.opt.bcn.req_start = rtw_malloc(pbody[p+1]); -+ -+ if (prm->q.opt.bcn.req_start == NULL) { -+ RTW_ERR("RM: req_start malloc fail!!\n"); -+ break; -+ } -+ -+ for (i = 0; i < pbody[p+1]; i++) -+ *((prm->q.opt.bcn.req_start)+i) = -+ pbody[p+2+i]; -+ -+ prm->q.opt.bcn.req_len = pbody[p+1]; -+ popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p]; -+ break; -+ -+ case bcn_req_ap_ch_rep: -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: bcn_req_ap_ch_rep\n"); -+#endif -+ if (ap_ch_rpt_idx > BCN_REQ_OPT_AP_CH_RPT_MAX_NUM) { -+ RTW_ERR("RM: bcn_req_ap_ch_rep over size\n"); -+ break; -+ } -+ -+ popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p]; -+ /* get channel list -+ * EID:len:op-class:ch-list -+ */ -+ op = rtw_malloc(sizeof (*op)); -+ op->global_op_class = pbody[p + 2]; -+ i = pbody[p + 1] - 1; /* ch list len; (-1) is op class */ -+ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("%d op class %d has %d ch\n", -+ ap_ch_rpt_idx,op->global_op_class,i); -+#endif -+ op->Len = i; -+ memcpy(op->Channel, &pbody[p + 3], -+ MIN(i, MAX_CH_NUM_IN_OP_CLASS)); -+ prm->q.opt.bcn.ap_ch_rpt[ap_ch_rpt_idx++] = op; -+ prm->q.opt.bcn.ap_ch_rpt_num = ap_ch_rpt_idx; -+ break; -+ -+ default: -+ break; -+ -+ } -+ len = len - (int)pbody[p+1] - 2; -+ p = p + (int)pbody[p+1] + 2; -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: opt_s_elem_len=%d\n",len); -+#endif -+ } -+ -+ return _SUCCESS; -+} -+ -+static int rm_parse_meas_req(struct rm_obj *prm, u8 *pbody) -+{ -+ int p; /* position */ -+ int req_len; -+ -+ -+ req_len = (int)pbody[1]; -+ p = 5; -+ -+ prm->q.op_class = pbody[p++]; -+ prm->q.ch_num = pbody[p++]; -+ prm->q.rand_intvl = le16_to_cpu(*(u16*)(&pbody[p])); -+ p+=2; -+ prm->q.meas_dur = le16_to_cpu(*(u16*)(&pbody[p])); -+ p+=2; -+ -+ if (prm->q.m_type == bcn_req) { -+ /* -+ * 0: passive -+ * 1: active -+ * 2: bcn_table -+ */ -+ prm->q.m_mode = pbody[p++]; -+ -+ /* BSSID */ -+ _rtw_memcpy(&(prm->q.bssid), &pbody[p], 6); -+ p+=6; -+ -+ /* -+ * default, used when Reporting detail subelement -+ * is not included in Beacon Request -+ */ -+ prm->q.opt.bcn.rep_detail = 2; -+ } -+ -+ if (req_len-(p-2) <= 0) /* without sub-element */ -+ return _SUCCESS; -+ -+ switch (prm->q.m_type) { -+ case bcn_req: -+ rm_parse_bcn_req_s_elem(prm, &pbody[p], req_len-(p-2)); -+ break; -+ case ch_load_req: -+ rm_parse_ch_load_s_elem(prm, &pbody[p], req_len-(p-2)); -+ break; -+ case noise_histo_req: -+ rm_parse_noise_histo_s_elem(prm, &pbody[p], req_len-(p-2)); -+ break; -+ default: -+ break; -+ } -+ -+ return _SUCCESS; -+} -+ -+/* receive measurement request */ -+int rm_recv_radio_mens_req(_adapter *padapter, -+ union recv_frame *precv_frame, struct sta_info *psta) -+{ -+ struct rm_obj *prm; -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data + -+ sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u8 *pmeas_body = &pdiag_body[5]; -+ u8 rmid, update = 0; -+ -+ -+#if 0 -+ /* search existing rm_obj */ -+ rmid = psta->cmn.aid << 16 -+ | pdiag_body[2] << 8 -+ | RM_SLAVE; -+ -+ prm = rm_get_rmobj(padapter, rmid); -+ if (prm) { -+ RTW_INFO("RM: Found an exist meas rmid=%u\n", rmid); -+ update = 1; -+ } else -+#endif -+ prm = rm_alloc_rmobj(padapter); -+ -+ if (prm == NULL) { -+ RTW_ERR("RM: unable to alloc rm obj for requeset\n"); -+ return _FALSE; -+ } -+ -+ prm->psta = psta; -+ prm->q.diag_token = pdiag_body[2]; -+ prm->q.rpt = le16_to_cpu(*(u16*)(&pdiag_body[3])); -+ -+ /* Figure 8-104 Measurement Requested format */ -+ prm->q.e_id = pmeas_body[0]; -+ prm->q.m_token = pmeas_body[2]; -+ prm->q.m_mode = pmeas_body[3]; -+ prm->q.m_type = pmeas_body[4]; -+ prm->rmid = rm_gen_rmid(padapter, prm, RM_SLAVE); -+ -+ RTW_INFO("RM: rmid=%x, bssid " MAC_FMT "\n", prm->rmid, -+ MAC_ARG(prm->psta->cmn.mac_addr)); -+ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: element_id = %d\n", prm->q.e_id); -+ RTW_INFO("RM: length = %d\n", (int)pmeas_body[1]); -+ RTW_INFO("RM: meas_token = %d\n", prm->q.m_token); -+ RTW_INFO("RM: meas_mode = %d\n", prm->q.m_mode); -+ RTW_INFO("RM: meas_type = %d\n", prm->q.m_type); -+#endif -+ -+ if (prm->q.e_id != _MEAS_REQ_IE_) /* 38 */ -+ return _FALSE; -+ -+ switch (prm->q.m_type) { -+ case bcn_req: -+ RTW_INFO("RM: recv beacon_request\n"); -+ switch (prm->q.m_mode) { -+ case bcn_req_passive: -+ rm_en_cap_chk_and_set(prm, RM_BCN_PASSIVE_MEAS_CAP_EN); -+ break; -+ case bcn_req_active: -+ rm_en_cap_chk_and_set(prm, RM_BCN_ACTIVE_MEAS_CAP_EN); -+ break; -+ case bcn_req_bcn_table: -+ rm_en_cap_chk_and_set(prm, RM_BCN_TABLE_MEAS_CAP_EN); -+ break; -+ default: -+ rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP); -+ break; -+ } -+ break; -+ case ch_load_req: -+ RTW_INFO("RM: recv ch_load_request\n"); -+ rm_en_cap_chk_and_set(prm, RM_CH_LOAD_CAP_EN); -+ break; -+ case noise_histo_req: -+ RTW_INFO("RM: recv noise_histogram_request\n"); -+ rm_en_cap_chk_and_set(prm, RM_NOISE_HISTO_CAP_EN); -+ break; -+ default: -+ RTW_INFO("RM: recv unknown request type 0x%02x\n", -+ prm->q.m_type); -+ rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP); -+ goto done; -+ } -+ rm_parse_meas_req(prm, pmeas_body); -+done: -+ if (!update) -+ rm_enqueue_rmobj(padapter, prm, _FALSE); -+ -+ return _SUCCESS; -+} -+ -+static u8 cnt_rm_report_ies(struct rm_obj *prm, u8 eid, u8 *buf, u32 buf_len) -+{ -+ u8 *pos = buf; -+ u8 id, len, cnt = 0; -+ -+ while (pos - buf + 1 < buf_len) { -+ id = *pos; -+ len = *(pos + 1); -+ -+ if (id == eid) -+ cnt++; -+ /*indicate_beacon_report(prm->psta->cmn.mac_addr,*/ -+ /*1, 2 + len, pos);*/ -+ -+ pos += (2 + len); -+ } -+ return cnt; -+} -+ -+/* receive measurement report */ -+int rm_recv_radio_mens_rep(_adapter *padapter, -+ union recv_frame *precv_frame, struct sta_info *psta) -+{ -+ u32 len; -+ struct rm_obj *prm; -+ u32 rmid; -+ u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data + -+ sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u8 *pmeas_body = &pdiag_body[3]; -+ u8 bcn_rpt_cnt; -+ -+ -+ rmid = psta->cmn.aid << 16 -+ | pdiag_body[2] << 8 -+ | RM_MASTER; -+ -+ prm = rm_get_rmobj(padapter, rmid); -+ if (prm == NULL) { -+ /* not belong to us, report to upper */ -+ rtw_cfg80211_rx_rrm_action(psta->padapter, precv_frame); -+ return _TRUE; -+ } -+ -+ prm->p.action_code = pdiag_body[1]; -+ prm->p.diag_token = pdiag_body[2]; -+ -+ /* Figure 8-140 Measuremnt Report format */ -+ prm->p.e_id = pmeas_body[0]; -+ prm->p.m_token = pmeas_body[2]; -+ prm->p.m_mode = pmeas_body[3]; -+ prm->p.m_type = pmeas_body[4]; -+ -+ RTW_INFO("RM: rmid=%x, bssid " MAC_FMT "\n", prm->rmid, -+ MAC_ARG(prm->psta->cmn.mac_addr)); -+ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: element_id = %d\n", prm->p.e_id); -+ RTW_INFO("RM: length = %d\n", (int)pmeas_body[1]); -+ RTW_INFO("RM: meas_token = %d\n", prm->p.m_token); -+ RTW_INFO("RM: meas_mode = %d\n", prm->p.m_mode); -+ RTW_INFO("RM: meas_type = %d\n", prm->p.m_type); -+#endif -+ if (prm->p.e_id != _MEAS_RSP_IE_) /* 39 */ -+ return _FALSE; -+ -+ RTW_INFO("RM: recv %s\n", rm_type_rep_name(prm->p.m_type)); -+ rm_post_event(padapter, prm->rmid, RM_EV_recv_rep); -+ -+ /* report to upper via ioctl */ -+ if ((prm->from_ioctl == true) && -+ prm->q.m_type == bcn_req) { -+ len = precv_frame->u.hdr.len - -+ sizeof(struct rtw_ieee80211_hdr_3addr) - -+ 3; /* Category + Action code + token */ -+ -+ bcn_rpt_cnt = cnt_rm_report_ies(prm, _MEAS_RSP_IE_, -+ pmeas_body, len); -+ if (bcn_rpt_cnt > 0) -+ indicate_beacon_report(prm->psta->cmn.mac_addr, -+ bcn_rpt_cnt, len, pmeas_body); -+ } -+ return _TRUE; -+} -+ -+/* receive link measurement request */ -+int rm_recv_link_mens_req(_adapter *padapter, -+ union recv_frame *precv_frame, struct sta_info *psta) -+{ -+ struct rm_obj *prm; -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data + -+ sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u8 *pmeas_body = &pdiag_body[3]; -+ u8 rmid, update = 0; -+ int i; -+ -+ -+ prm = rm_alloc_rmobj(padapter); -+ -+ if (prm == NULL) { -+ RTW_ERR("RM: unable to alloc rm obj for requeset\n"); -+ return _FALSE; -+ } -+ -+ prm->psta = psta; -+ prm->q.action_code = pdiag_body[1]; -+ prm->q.diag_token = pdiag_body[2]; -+ -+ prm->q.tx_pwr_used = pmeas_body[0]; -+ prm->q.tx_pwr_max = pmeas_body[1]; -+ prm->q.rx_pwr = precv_frame->u.hdr.attrib.phy_info.rx_power; -+ prm->q.rx_rate = hw_rate_to_m_rate(precv_frame->u.hdr.attrib.data_rate); -+ prm->q.rx_bw = precv_frame->u.hdr.attrib.bw; -+ prm->q.rx_rsni = rm_get_frame_rsni(prm, precv_frame); -+ prm->rmid = rm_gen_rmid(padapter, prm, RM_SLAVE); -+ -+ RTW_INFO("RM: rmid=%x, bssid" MAC_FMT " rx_pwr=%ddBm, rate=%s\n", -+ prm->rmid, MAC_ARG(prm->psta->cmn.mac_addr), prm->q.rx_pwr, -+ MGN_RATE_STR(prm->q.rx_rate)); -+ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: tx_pwr_used =%d dBm\n", prm->q.tx_pwr_used); -+ RTW_INFO("RM: tx_pwr_max =%d dBm\n", prm->q.tx_pwr_max); -+#endif -+ -+ if (!update) -+ rm_enqueue_rmobj(padapter, prm, _FALSE); -+ -+ return _SUCCESS; -+} -+ -+/* receive link measurement report */ -+int rm_recv_link_mens_rep(_adapter *padapter, -+ union recv_frame *precv_frame, struct sta_info *psta) -+{ -+ int ret = _FALSE; -+ struct rm_obj *prm; -+ u32 rmid; -+ u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data + -+ sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u8 *pmeas_body = pdiag_body + 3; -+ s8 val; -+ -+ -+ rmid = psta->cmn.aid << 16 -+ | pdiag_body[2] << 8 -+ | RM_MASTER; -+ -+ prm = rm_get_rmobj(padapter, rmid); -+ if (prm == NULL) { -+ /* not belong to us, report to upper */ -+ rtw_cfg80211_rx_rrm_action(psta->padapter, precv_frame); -+ return _TRUE; -+ } -+ -+ RTW_INFO("RM: rmid=%x, bssid " MAC_FMT "\n", prm->rmid, -+ MAC_ARG(prm->psta->cmn.mac_addr)); -+ -+ prm->p.action_code = pdiag_body[1]; -+ prm->p.diag_token = pdiag_body[2]; -+ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: action_code = %d\n", prm->p.action_code); -+ RTW_INFO("RM: diag_token = %d\n", prm->p.diag_token); -+ RTW_INFO("RM: xmit_power = %d dBm\n", pmeas_body[2]); -+ RTW_INFO("RM: link_margin = %d dBm\n", pmeas_body[3]); -+ RTW_INFO("RM: xmit_ant = %d\n", pmeas_body[4]); -+ RTW_INFO("RM: recv_ant = %d\n", pmeas_body[5]); -+ RTW_INFO("RM: RCPI = %d\n", pmeas_body[6]); -+ RTW_INFO("RM: RSNI = %d\n", pmeas_body[7]); -+#endif -+ RTW_INFO("RM: recv link meas report ...\n"); -+ ret = rm_post_event(padapter, prm->rmid, RM_EV_recv_rep); -+ -+ return ret; -+} -+ -+ -+int rm_radio_mens_nb_rep(_adapter *padapter, -+ union recv_frame *precv_frame, struct sta_info *psta) -+{ -+ u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data + -+ sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u8 *pmeas_body = &pdiag_body[3]; -+ u32 len = precv_frame->u.hdr.len; -+ u32 rmid; -+ struct rm_obj *prm; -+ -+ -+ rmid = psta->cmn.aid << 16 -+ | pdiag_body[2] << 8 -+ | RM_MASTER; -+ -+ prm = rm_get_rmobj(padapter, rmid); -+ -+ if (prm == NULL) { -+ /* not belong to us, report to upper */ -+ rtw_cfg80211_rx_rrm_action(psta->padapter, precv_frame); -+ return _TRUE; -+ } -+ -+ prm->p.action_code = pdiag_body[1]; -+ prm->p.diag_token = pdiag_body[2]; -+ prm->p.e_id = pmeas_body[0]; -+ -+ RTW_INFO("RM: rmid=%x, bssid " MAC_FMT "\n", prm->rmid, -+ MAC_ARG(prm->psta->cmn.mac_addr)); -+ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: element_id = %d\n", prm->p.e_id); -+ RTW_INFO("RM: length = %d\n", (int)pmeas_body[1]); -+#endif -+ rm_post_event(padapter, prm->rmid, RM_EV_recv_rep); -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_wnm_btm_candidates_survey(padapter -+ ,(pdiag_body + 3) -+ ,(len - sizeof(struct rtw_ieee80211_hdr_3addr)) -+ ,_FALSE) == _FAIL) -+ return _FALSE; -+#endif -+ rtw_cfg80211_rx_rrm_action(padapter, precv_frame); -+ -+ return _TRUE; -+} -+ -+unsigned int rm_on_action(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ u32 ret = _FAIL; -+ u8 *pframe = NULL; -+ u8 *pframe_body = NULL; -+ u8 action_code = 0; -+ u8 diag_token = 0; -+ struct rtw_ieee80211_hdr_3addr *whdr; -+ struct sta_info *psta; -+ -+ -+ pframe = precv_frame->u.hdr.rx_data; -+ -+ /* check RA matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), -+ GetAddr1Ptr(pframe), ETH_ALEN)) -+ goto exit; -+ -+ whdr = (struct rtw_ieee80211_hdr_3addr *)pframe; -+ RTW_INFO("RM: %s bssid = " MAC_FMT "\n", -+ __func__, MAC_ARG(whdr->addr2)); -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, whdr->addr2); -+ -+ if (!psta) { -+ RTW_ERR("RM: psta not found\n"); -+ goto exit; -+ } -+ -+ pframe_body = (unsigned char *)(pframe + -+ sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ /* Figure 8-438 radio measurement request frame Action field format */ -+ /* Category = pframe_body[0] = 5 (Radio Measurement) */ -+ action_code = pframe_body[1]; -+ diag_token = pframe_body[2]; -+ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: %s radio_action=%x, diag_token=%x\n", __func__, -+ action_code, diag_token); -+#endif -+ -+ switch (action_code) { -+ -+ case RM_ACT_RADIO_MEAS_REQ: -+ RTW_INFO("RM: RM_ACT_RADIO_MEAS_REQ\n"); -+ ret = rm_recv_radio_mens_req(padapter, precv_frame, psta); -+ break; -+ -+ case RM_ACT_RADIO_MEAS_REP: -+ RTW_INFO("RM: RM_ACT_RADIO_MEAS_REP\n"); -+ ret = rm_recv_radio_mens_rep(padapter, precv_frame, psta); -+ break; -+ -+ case RM_ACT_LINK_MEAS_REQ: -+ RTW_INFO("RM: RM_ACT_LINK_MEAS_REQ\n"); -+ ret = rm_recv_link_mens_req(padapter, precv_frame, psta); -+ break; -+ -+ case RM_ACT_LINK_MEAS_REP: -+ RTW_INFO("RM: RM_ACT_LINK_MEAS_REP\n"); -+ ret = rm_recv_link_mens_rep(padapter, precv_frame, psta); -+ break; -+ -+ case RM_ACT_NB_REP_REQ: -+ RTW_INFO("RM: RM_ACT_NB_REP_REQ\n"); -+ break; -+ -+ case RM_ACT_NB_REP_RESP: -+ RTW_INFO("RM: RM_ACT_NB_REP_RESP\n"); -+ ret = rm_radio_mens_nb_rep(padapter, precv_frame, psta); -+ break; -+ -+ default: -+ /* TODO reply incabable */ -+ RTW_ERR("RM: unknown specturm management action %2x\n", -+ action_code); -+ break; -+ } -+exit: -+ return ret; -+} -+ -+static u8 *rm_gen_bcn_detail_elem(_adapter *padapter, u8 *pframe, -+ struct rm_obj *prm, struct wlan_network *pnetwork, -+ unsigned int *fr_len) -+{ -+ WLAN_BSSID_EX *pbss = &pnetwork->network; -+ unsigned int my_len; -+ int j, k, len; -+ u8 *plen; -+ u8 *ptr; -+ u8 val8, eid; -+ -+ -+ my_len = 0; -+ /* Reporting Detail values -+ * 0: No fixed length fields or elements -+ * 1: All fixed length fields and any requested elements -+ * in the Request info element if present -+ * 2: All fixed length fields and elements -+ * 3-255: Reserved -+ */ -+ -+ /* report_detail = 0 */ -+ if (prm->q.opt.bcn.rep_detail == 0 -+ || prm->q.opt.bcn.rep_detail > 2) { -+ return pframe; -+ } -+ -+ /* ID */ -+ val8 = 1; /* 1:reported frame body */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ plen = pframe; -+ val8 = 0; -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* report_detail = 2 */ -+ if (prm->q.opt.bcn.rep_detail == 2) { -+ pframe = rtw_set_fixed_ie(pframe, pbss->IELength - 4, -+ pbss->IEs, &my_len); /* -4 remove FCS */ -+ goto done; -+ } -+ -+ /* report_detail = 1 */ -+ /* all fixed lenght fields */ -+ pframe = rtw_set_fixed_ie(pframe, -+ _FIXED_IE_LENGTH_, pbss->IEs, &my_len); -+ -+ for (j = 0; j < prm->q.opt.bcn.opt_id_num; j++) { -+ switch (prm->q.opt.bcn.opt_id[j]) { -+ case bcn_req_ssid: -+ /* SSID */ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: bcn_req_ssid\n"); -+#endif -+ pframe = rtw_set_ie(pframe, _SSID_IE_, -+ pbss->Ssid.SsidLength, -+ pbss->Ssid.Ssid, &my_len); -+ break; -+ case bcn_req_req: -+ if (prm->q.opt.bcn.req_start == NULL) -+ break; -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: bcn_req_req"); -+#endif -+ for (k=0; kq.opt.bcn.req_len; k++) { -+ eid = prm->q.opt.bcn.req_start[k]; -+ -+ val8 = pbss->IELength - _FIXED_IE_LENGTH_; -+ ptr = rtw_get_ie(pbss->IEs + _FIXED_IE_LENGTH_, -+ eid, &len, val8); -+ -+ if (!ptr) -+ continue; -+#if (RM_MORE_DBG_MSG) -+ switch (eid) { -+ case EID_SsId: -+ RTW_INFO("RM: EID_SSID\n"); -+ break; -+ case EID_QBSSLoad: -+ RTW_INFO("RM: EID_QBSSLoad\n"); -+ break; -+ case EID_HTCapability: -+ RTW_INFO("RM: EID_HTCapability\n"); -+ break; -+ case _MDIE_: -+ RTW_INFO("RM: EID_MobilityDomain\n"); -+ break; -+ case EID_Vendor: -+ RTW_INFO("RM: EID_Vendor\n"); -+ break; -+ default: -+ RTW_INFO("RM: EID %d todo\n",eid); -+ break; -+ } -+#endif -+ pframe = rtw_set_ie(pframe, eid, -+ len, ptr+2, &my_len); -+ } /* for() */ -+ break; -+ case bcn_req_rep_detail: -+ RTW_INFO("RM: bcn_req_rep_detail\n"); -+ break; -+ case bcn_req_ap_ch_rep: -+ RTW_INFO("RM: bcn_req_ap_ch_rep\n"); -+ break; -+ default: -+ RTW_INFO("RM: OPT %d TODO\n",prm->q.opt.bcn.opt_id[j]); -+ break; -+ } -+ } -+done: -+ /* -+ * update my length -+ * content length does NOT include ID and LEN -+ */ -+ val8 = my_len - 2; -+ rtw_set_fixed_ie(plen, 1, &val8, &j); -+ -+ /* update length to caller */ -+ *fr_len += my_len; -+ -+ return pframe; -+} -+ -+u8 rm_bcn_req_cond_mach(struct rm_obj *prm, struct wlan_network *pnetwork) -+{ -+ u8 val8; -+ -+ -+ switch(prm->q.opt.bcn.rep_cond.cond) { -+ case bcn_rep_cond_immediately: -+ return _SUCCESS; -+ case bcn_req_cond_rcpi_greater: -+ val8 = rm_get_bcn_rcpi(prm, pnetwork); -+ if (val8 > prm->q.opt.bcn.rep_cond.threshold) -+ return _SUCCESS; -+ break; -+ case bcn_req_cond_rcpi_less: -+ val8 = rm_get_bcn_rcpi(prm, pnetwork); -+ if (val8 < prm->q.opt.bcn.rep_cond.threshold) -+ return _SUCCESS; -+ break; -+ case bcn_req_cond_rsni_greater: -+ val8 = rm_get_bcn_rsni(prm, pnetwork); -+ if (val8 != 255 && val8 > prm->q.opt.bcn.rep_cond.threshold) -+ return _SUCCESS; -+ break; -+ case bcn_req_cond_rsni_less: -+ val8 = rm_get_bcn_rsni(prm, pnetwork); -+ if (val8 != 255 && val8 < prm->q.opt.bcn.rep_cond.threshold) -+ return _SUCCESS; -+ break; -+ default: -+ RTW_ERR("RM: bcn_req cond %u not support\n", -+ prm->q.opt.bcn.rep_cond.cond); -+ break; -+ } -+ return _FALSE; -+} -+ -+static u8 *rm_gen_bcn_rep_ie (struct rm_obj *prm, -+ u8 *pframe, struct wlan_network *pnetwork, unsigned int *fr_len) -+{ -+ int snr, i; -+ u8 val8, *plen; -+ u16 val16; -+ u32 val32; -+ u64 val64; -+ unsigned int my_len; -+ _adapter *padapter = prm->psta->padapter; -+ -+ -+ my_len = 0; -+ plen = pframe + 1; -+ pframe = rtw_set_fixed_ie(pframe, 7, &prm->p.e_id, &my_len); -+ -+ /* Actual Measurement StartTime */ -+ val64 = cpu_to_le64(prm->meas_start_time); -+ pframe = rtw_set_fixed_ie(pframe, 8, (u8 *)&val64, &my_len); -+ -+ /* Measurement Duration */ -+ val16 = prm->meas_end_time - prm->meas_start_time; -+ val16 = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, 2, (u8*)&val16, &my_len); -+ -+ /* TODO -+ * ReportedFrameInformation: -+ * 0 :beacon or probe rsp -+ * 1 :pilot frame -+ */ -+ val8 = 0; /* report frame info */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* RCPI */ -+ val8 = rm_get_bcn_rcpi(prm, pnetwork); -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* RSNI */ -+ val8 = rm_get_bcn_rsni(prm, pnetwork); -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* BSSID */ -+ pframe = rtw_set_fixed_ie(pframe, 6, -+ (u8 *)&pnetwork->network.MacAddress, &my_len); -+ -+ /* -+ * AntennaID -+ * 0: unknown -+ * 255: multiple antenna (Diversity) -+ */ -+ val8 = 0; -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* ParentTSF */ -+ val32 = pnetwork->network.PhyInfo.free_cnt; -+ if (prm->free_run_counter_valid) -+ val32 += prm->meas_start_time; -+ -+ pframe = rtw_set_fixed_ie(pframe, 4, (u8 *)&val32, &my_len); -+ -+ /* Generate Beacon detail */ -+ pframe = rm_gen_bcn_detail_elem(padapter, pframe, -+ prm, pnetwork, &my_len); -+ /* -+ * update my length -+ * content length does NOT include ID and LEN -+ */ -+ val8 = my_len - 2; -+ rtw_set_fixed_ie(plen, 1, &val8, &i); -+ -+ /* update length to caller */ -+ *fr_len += my_len; -+ -+ return pframe; -+} -+ -+#if 0 /* check MBO logo */ -+static int rm_match_sub_elem(_adapter *padapter, -+ struct rm_obj *prm, struct wlan_network *pnetwork) -+{ -+ WLAN_BSSID_EX *pbss = &pnetwork->network; -+ unsigned int my_len; -+ int j, k, len; -+ u8 *plen; -+ u8 *ptr; -+ u8 val8, eid; -+ -+ -+ my_len = 0; -+ /* Reporting Detail values -+ * 0: No fixed length fields or elements -+ * 1: All fixed length fields and any requested elements -+ * in the Request info element if present -+ * 2: All fixed length fields and elements -+ * 3-255: Reserved -+ */ -+ -+ /* report_detail != 1 */ -+ if (prm->q.opt.bcn.rep_detail != 1) -+ return _TRUE; -+ -+ /* report_detail = 1 */ -+ -+ for (j = 0; j < prm->q.opt.bcn.opt_id_num; j++) { -+ switch (prm->q.opt.bcn.opt_id[j]) { -+ case bcn_req_ssid: -+ /* SSID */ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: bcn_req_ssid\n"); -+#endif -+ if (pbss->Ssid.SsidLength == 0) -+ return _FALSE; -+ break; -+ case bcn_req_req: -+ if (prm->q.opt.bcn.req_start == NULL) -+ break; -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: bcn_req_req"); -+#endif -+ for (k=0; kq.opt.bcn.req_len; k++) { -+ eid = prm->q.opt.bcn.req_start[k]; -+ -+ val8 = pbss->IELength - _FIXED_IE_LENGTH_; -+ ptr = rtw_get_ie(pbss->IEs + _FIXED_IE_LENGTH_, -+ eid, &len, val8); -+ -+#if (RM_MORE_DBG_MSG) -+ switch (eid) { -+ case EID_SsId: -+ RTW_INFO("RM: EID_SSID\n"); -+ break; -+ case EID_QBSSLoad: -+ RTW_INFO("RM: EID_QBSSLoad\n"); -+ break; -+ case EID_HTCapability: -+ RTW_INFO("RM: EID_HTCapability\n"); -+ break; -+ case _MDIE_: -+ RTW_INFO("RM: EID_MobilityDomain\n"); -+ break; -+ case EID_Vendor: -+ RTW_INFO("RM: EID_Vendor\n"); -+ break; -+ default: -+ RTW_INFO("RM: EID %d todo\n",eid); -+ break; -+ } -+#endif -+ if (!ptr) { -+ RTW_INFO("RM: EID %d not found\n",eid); -+ return _FALSE; -+ } -+ } /* for() */ -+ break; -+ case bcn_req_rep_detail: -+ RTW_INFO("RM: bcn_req_rep_detail\n"); -+ break; -+ case bcn_req_ap_ch_rep: -+ RTW_INFO("RM: bcn_req_ap_ch_rep\n"); -+ break; -+ default: -+ RTW_INFO("RM: OPT %d TODO\n",prm->q.opt.bcn.opt_id[j]); -+ break; -+ } -+ } -+ return _TRUE; -+} -+#endif -+ -+static int retrieve_scan_result(struct rm_obj *prm) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue; -+ _adapter *padapter = prm->psta->padapter; -+ struct rtw_ieee80211_channel *pch_set; -+ struct wlan_network *pnetwork = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ int i; -+ PWLAN_BSSID_EX pbss; -+ unsigned int matched_network; -+ int len, my_len; -+ u8 buf_idx, *pbuf = NULL, *tmp_buf = NULL; -+ -+ -+ tmp_buf = rtw_malloc(MAX_XMIT_EXTBUF_SZ); -+ if (tmp_buf == NULL) -+ return 0; -+ -+ my_len = 0; -+ buf_idx = 0; -+ matched_network = 0; -+ queue = &(pmlmepriv->scanned_queue); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ /* get requested measurement channel set */ -+ pch_set = prm->q.ch_set; -+ -+ /* search scan queue to find requested SSID */ -+ while (1) { -+ -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ pbss = &pnetwork->network; -+ -+#if 0 -+ RTW_INFO("RM: ooo ch %u ssid %s bssid "MAC_FMT"\n", -+ pbss->Configuration.DSConfig, pbss->Ssid.Ssid, -+ MAC_ARG(pbss->MacAddress)); -+ /* -+ * report network if requested channel set contains -+ * the channel matchs selected network -+ */ -+ if (rtw_chset_search_ch(adapter_to_chset(padapter), -+ pbss->Configuration.DSConfig) < 0) /* not match */ -+ goto next; -+ -+ if (rtw_mlme_band_check(padapter, pbss->Configuration.DSConfig) -+ == _FALSE) -+ goto next; -+#endif -+ if (rtw_validate_ssid(&(pbss->Ssid)) == _FALSE) -+ goto next; -+ -+ /* match bssid */ -+ if (is_wildcard_bssid(prm->q.bssid) == FALSE) -+ if (_rtw_memcmp(prm->q.bssid, -+ pbss->MacAddress, 6) == _FALSE) -+ //continue; -+ goto next; -+ /* -+ * default wildcard SSID. wildcard SSID: -+ * A SSID value (null) used to represent all SSIDs -+ */ -+ -+ /* match ssid */ -+ if ((prm->q.opt.bcn.ssid.SsidLength > 0) && -+ _rtw_memcmp(prm->q.opt.bcn.ssid.Ssid, -+ pbss->Ssid.Ssid, -+ prm->q.opt.bcn.ssid.SsidLength) == _FALSE) -+ goto next; -+ -+ /* go through measurement requested channels */ -+ for (i = 0; i < prm->q.ch_set_ch_amount; i++) { -+ if ((pch_set[i].hw_value) == -+ (pbss->Configuration.DSConfig)) /* match ch */ -+ break; -+ } -+ if (i >= prm->q.ch_set_ch_amount) /* channel mismatch */ -+ goto next; -+ -+ /* match condition */ -+ if (rm_bcn_req_cond_mach(prm, pnetwork) == _FALSE) { -+ RTW_INFO("RM: condition mismatch ch %u ssid %s bssid "MAC_FMT"\n", -+ pbss->Configuration.DSConfig, pbss->Ssid.Ssid, -+ MAC_ARG(pbss->MacAddress)); -+ RTW_INFO("RM: condition %u:%u\n", -+ prm->q.opt.bcn.rep_cond.cond, -+ prm->q.opt.bcn.rep_cond.threshold); -+ goto next; -+ //continue; -+ } -+#if 0 /* check MBO logo */ -+ /* match subelement */ -+ if (rm_match_sub_elem(padapter, prm, pnetwork) == _FALSE) -+ goto next; -+#endif -+ /* Found a matched SSID */ -+ matched_network++; -+ -+ RTW_INFO("RM: ch %u Found %s bssid "MAC_FMT"\n", -+ pbss->Configuration.DSConfig, pbss->Ssid.Ssid, -+ MAC_ARG(pbss->MacAddress)); -+ -+ len = 0; -+ _rtw_memset(tmp_buf, 0, MAX_XMIT_EXTBUF_SZ); -+ rm_gen_bcn_rep_ie(prm, tmp_buf, pnetwork, &len); -+new_packet: -+ if (my_len == 0) { -+ pbuf = rtw_malloc(MAX_XMIT_EXTBUF_SZ); -+ if (pbuf == NULL) -+ goto fail; -+ prm->buf[buf_idx].pbuf = pbuf; -+ } -+ -+ if ((MAX_XMIT_EXTBUF_SZ - (my_len+len+24+4)) > 0) { -+ pbuf = rtw_set_fixed_ie(pbuf, -+ len, tmp_buf, &my_len); -+ prm->buf[buf_idx].len = my_len; -+ } else { -+ if (my_len == 0) /* not enough space */ -+ goto fail; -+ -+ my_len = 0; -+ buf_idx++; -+ goto new_packet; -+ } -+next: -+ plist = get_next(plist); -+ } /* while() */ -+fail: -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (tmp_buf) -+ rtw_mfree(tmp_buf, MAX_XMIT_EXTBUF_SZ); -+ -+ RTW_INFO("RM: Found %d matched %s\n", matched_network, -+ prm->q.opt.bcn.ssid.Ssid); -+ -+ if (prm->buf[buf_idx].pbuf) -+ return buf_idx+1; -+ -+ return 0; -+} -+ -+int issue_beacon_rep(struct rm_obj *prm) -+{ -+ int i, my_len; -+ u8 *pframe; -+ _adapter *padapter = prm->psta->padapter; -+ struct pkt_attrib *pattr; -+ struct xmit_frame *pmgntframe; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int pkt_num; -+ -+ -+ pkt_num = retrieve_scan_result(prm); -+ -+ if (pkt_num == 0) { -+ issue_null_reply(prm); -+ return _SUCCESS; -+ } -+ -+ for (i=0;iattrib; -+ pframe = build_wlan_hdr(padapter, -+ pmgntframe, prm->psta, WIFI_ACTION); -+ pframe = rtw_set_fixed_ie(pframe, -+ 3, &prm->p.category, &pattr->pktlen); -+ -+ my_len = 0; -+ pframe = rtw_set_fixed_ie(pframe, -+ prm->buf[i].len, prm->buf[i].pbuf, &my_len); -+ -+ pattr->pktlen += my_len; -+ pattr->last_txcmdsz = pattr->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ } -+fail: -+ for (i=0;ibuf[i].pbuf) { -+ rtw_mfree(prm->buf[i].pbuf, MAX_XMIT_EXTBUF_SZ); -+ prm->buf[i].pbuf = NULL; -+ prm->buf[i].len = 0; -+ } -+ } -+ return _SUCCESS; -+} -+ -+/* neighbor request */ -+int issue_nb_req(struct rm_obj *prm) -+{ -+ _adapter *padapter = prm->psta->padapter; -+ struct sta_info *psta = prm->psta; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_frame *pmgntframe = NULL; -+ struct pkt_attrib *pattr = NULL; -+ u8 val8; -+ u8 *pframe = NULL; -+ -+ -+ RTW_INFO("RM: %s\n", __func__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__); -+ return _FALSE; -+ } -+ pattr = &pmgntframe->attrib; -+ pframe = build_wlan_hdr(padapter, pmgntframe, psta, WIFI_ACTION); -+ pframe = rtw_set_fixed_ie(pframe, -+ 3, &prm->q.category, &pattr->pktlen); -+ -+ if (prm->q.pssid) { -+ -+ u8 sub_ie[64] = {0}; -+ u8 *pie = &sub_ie[2]; -+ -+ RTW_INFO("RM: Send NB Req to "MAC_FMT" for(SSID) %s searching\n", -+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), -+ pmlmepriv->cur_network.network.Ssid.Ssid); -+ -+ val8 = strlen(prm->q.pssid); -+ sub_ie[0] = 0; /*SSID*/ -+ sub_ie[1] = val8; -+ -+ _rtw_memcpy(pie, prm->q.pssid, val8); -+ -+ pframe = rtw_set_fixed_ie(pframe, val8 + 2, -+ sub_ie, &pattr->pktlen); -+ } else { -+ -+ if (!pmlmepriv->cur_network.network.Ssid.SsidLength) -+ RTW_INFO("RM: Send NB Req to "MAC_FMT"\n", -+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress)); -+ else { -+ u8 sub_ie[64] = {0}; -+ u8 *pie = &sub_ie[2]; -+ -+ RTW_INFO("RM: Send NB Req to "MAC_FMT" for(SSID) %s searching\n", -+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), -+ pmlmepriv->cur_network.network.Ssid.Ssid); -+ -+ sub_ie[0] = 0; /*SSID*/ -+ sub_ie[1] = pmlmepriv->cur_network.network.Ssid.SsidLength; -+ -+ _rtw_memcpy(pie, pmlmepriv->cur_network.network.Ssid.Ssid, -+ pmlmepriv->cur_network.network.Ssid.SsidLength); -+ -+ pframe = rtw_set_fixed_ie(pframe, -+ pmlmepriv->cur_network.network.Ssid.SsidLength + 2, -+ sub_ie, &pattr->pktlen); -+ } -+ } -+ -+ pattr->last_txcmdsz = pattr->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return _SUCCESS; -+} -+ -+/* issue link measurement request */ -+int issue_link_meas_req(struct rm_obj *prm) -+{ -+ _adapter *padapter = prm->psta->padapter; -+ struct sta_info *psta = prm->psta; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_frame *pmgntframe = NULL; -+ struct pkt_attrib *pattr = NULL; -+ u8 *pframe = NULL; -+ s8 pwr_used, path_a_pwr; -+ -+ -+ RTW_INFO("RM: %s\n", __func__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__); -+ return _FALSE; -+ } -+ pattr = &pmgntframe->attrib; -+ pframe = build_wlan_hdr(padapter, pmgntframe, psta, WIFI_ACTION); -+ -+ /* Category, Action code, Dialog token */ -+ pframe = rtw_set_fixed_ie(pframe, -+ 3, &prm->q.category, &pattr->pktlen); -+ -+ /* xmit power used */ -+ /* we don't know actual TX power due to RA may change TX rate; -+ * But if we fix TX rate then we can get specific tx power -+ */ -+ pattr->rate = MGN_6M; -+ rm_get_tx_power(padapter, RF_PATH_A, MGN_6M, &pwr_used); -+ pframe = rtw_set_fixed_ie(pframe, -+ 1, &pwr_used, &pattr->pktlen); -+ -+ /* Max xmit power */ -+ rm_get_path_a_max_tx_power(padapter, &path_a_pwr); -+ pframe = rtw_set_fixed_ie(pframe, -+ 1, &path_a_pwr, &pattr->pktlen); -+ -+ pattr->last_txcmdsz = pattr->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return _SUCCESS; -+} -+ -+/* issue link measurement report */ -+int issue_link_meas_rep(struct rm_obj *prm) -+{ -+ u8 val8; -+ u8 *pframe; -+ unsigned int my_len; -+ _adapter *padapter = prm->psta->padapter; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattr; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = prm->psta; -+ int i; -+ u8 tpc[4]; -+ s8 pwr_used; -+ -+ -+ RTW_INFO("RM: %s\n", __func__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ RTW_ERR("RM: ERR %s alloc xmit_frame fail\n",__func__); -+ return _FALSE; -+ } -+ pattr = &pmgntframe->attrib; -+ pframe = build_wlan_hdr(padapter, pmgntframe, psta, WIFI_ACTION); -+ /* Category, action code, Dialog token */ -+ pframe = rtw_set_fixed_ie(pframe, 3, -+ &prm->p.category, &pattr->pktlen); -+ -+ my_len = 0; -+ -+ /* TPC report */ -+ rm_get_tx_power(padapter, RF_PATH_A, MGN_6M, &pwr_used); -+ tpc[0] = EID_TPC; -+ tpc[1] = 2; /* length */ -+ -+ /* TX power */ -+ tpc[2] = pwr_used; -+ -+ /* link margin */ -+ rm_get_rx_sensitivity(padapter, prm->q.rx_bw, prm->q.rx_rate, &pwr_used); -+ tpc[3] = prm->q.rx_pwr - pwr_used; /* RX sensitivity */ -+ pattr->rate = MGN_6M; /* use fix rate to get fixed RX sensitivity */ -+ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: rx_pwr=%ddBm - rx_sensitivity=%ddBm = link_margin=%ddB\n", -+ prm->q.rx_pwr, pwr_used, tpc[3]); -+#endif -+ pframe = rtw_set_fixed_ie(pframe, 4, tpc, &my_len); -+ -+ /* RECV antenna ID */ -+ val8 = 0; /* unknown antenna */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* XMIT antenna ID */ -+ /* Fix rate 6M(1T) always use main antenna to TX */ -+ val8 = 1; /* main antenna */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* RCPI */ -+ val8 = translate_dbm_to_rcpi(prm->q.rx_pwr); -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* RSNI */ -+ val8 = prm->q.rx_rsni; -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* length */ -+ //val8 = (u8)my_len-2; -+ //rtw_set_fixed_ie(plen, 1, &val8, &i); /* use variable i to ignore it */ -+ -+ pattr->pktlen += my_len; -+ pattr->last_txcmdsz = pattr->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return _SUCCESS; -+} -+ -+static u8 *rm_gen_bcn_req_s_elem(_adapter *padapter, -+ struct rm_obj *prm, u8 *pframe, unsigned int *fr_len) -+{ -+ u8 val8, l; -+ int i; -+ unsigned int my_len = 0; -+ struct _RT_OPERATING_CLASS *op; -+ -+ /* meas mode */ -+ val8 = bcn_req_active; /* measurement mode T8-64 */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* bssid */ -+ pframe = rtw_set_fixed_ie(pframe, 6, prm->q.bssid, &my_len); -+ -+ /* -+ * opt ssid (0) -+ */ -+ l = MIN(32, (int)prm->q.opt.bcn.ssid.SsidLength); -+ -+ l = (int)prm->q.opt.bcn.ssid.SsidLength; -+ -+ if (l > 32) -+ RTW_ERR("RM: %s SSID len over size %d! skip it!\n",__func__, l); -+ -+ if (l > 0 && l <= 32) { -+ /* Type */ -+ val8 = bcn_req_ssid; -+ pframe = rtw_set_fixed_ie(pframe, 1, -+ &val8, &my_len); -+ /* Len */ -+ pframe = rtw_set_fixed_ie(pframe, 1, -+ &l, &my_len); -+ /* Value */ -+ pframe = rtw_set_fixed_ie(pframe, l, -+ prm->q.opt.bcn.ssid.Ssid, &my_len); -+ } -+ -+ /* -+ * opt reporting detail (2) -+ */ -+ /* Type */ -+ val8 = bcn_req_rep_detail; -+ pframe = rtw_set_fixed_ie(pframe, 1, -+ &val8, &my_len); -+ /* Len */ -+ l = 1; -+ pframe = rtw_set_fixed_ie(pframe, 1, -+ &l, &my_len); -+ /* Value */ -+ pframe = rtw_set_fixed_ie(pframe, l, -+ &prm->q.opt.bcn.rep_detail, &my_len); -+ -+ /* -+ * opt request (10) -+ */ -+ -+ if (prm->q.opt.bcn.req_id_num > 0) { -+ /* Type */ -+ val8 = bcn_req_req; -+ pframe = rtw_set_fixed_ie(pframe, 1, -+ &val8, &my_len); -+ /* Len */ -+ l = prm->q.opt.bcn.req_id_num; -+ pframe = rtw_set_fixed_ie(pframe, 1, -+ &l, &my_len); -+ /* Value */ -+ pframe = rtw_set_fixed_ie(pframe, l, -+ prm->q.opt.bcn.req_id, &my_len); -+ } -+ -+ /* -+ * opt ap channel report (51) -+ */ -+ for (i = 0; i < prm->q.opt.bcn.ap_ch_rpt_num; i++) { -+ op = prm->q.opt.bcn.ap_ch_rpt[i]; -+ if (op == NULL) -+ break; -+ /* Type */ -+ val8 = bcn_req_ap_ch_rep; -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ l = (u8)op->Len + 1; -+ /* length */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &l, &my_len); -+ -+ /* op class */ -+ val8 = op->global_op_class; -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ /* channel */ -+ pframe = rtw_set_fixed_ie(pframe, op->Len, op->Channel, &my_len); -+ } -+ -+ /* update length to caller */ -+ *fr_len += my_len; -+ -+ /* optional subelements */ -+ return pframe; -+} -+ -+static u8 *rm_gen_ch_load_req_s_elem(_adapter *padapter, -+ u8 *pframe, unsigned int *fr_len) -+{ -+ u8 val8; -+ unsigned int my_len = 0; -+ -+ -+ val8 = 1; /* 1: channel load T8-60 */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ val8 = 2; /* channel load length = 2 (extensible) */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ val8 = 0; /* channel load condition : 0 (issue when meas done) T8-61 */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ val8 = 0; /* channel load reference value : 0 */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* update length to caller */ -+ *fr_len += my_len; -+ -+ return pframe; -+} -+ -+static u8 *rm_gen_noise_histo_req_s_elem(_adapter *padapter, -+ u8 *pframe, unsigned int *fr_len) -+{ -+ u8 val8; -+ unsigned int my_len = 0; -+ -+ -+ val8 = 1; /* 1: noise histogram T8-62 */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ val8 = 2; /* noise histogram length = 2 (extensible) */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ val8 = 0; /* noise histogram condition : 0 (issue when meas done) T8-63 */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ val8 = 0; /* noise histogram reference value : 0 */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ -+ /* update length to caller */ -+ *fr_len += my_len; -+ -+ return pframe; -+} -+ -+int issue_radio_meas_req(struct rm_obj *prm) -+{ -+ u8 val8; -+ u8 *pframe; -+ u8 *plen; -+ u16 val16; -+ int my_len, i; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattr; -+ _adapter *padapter = prm->psta->padapter; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ -+ RTW_INFO("RM: %s - %s\n", __func__, rm_type_req_name(prm->q.m_type)); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__); -+ return _FALSE; -+ } -+ pattr = &pmgntframe->attrib; -+ pframe = build_wlan_hdr(padapter, pmgntframe, prm->psta, WIFI_ACTION); -+ -+ /* Category, Action code, Dialog token */ -+ pframe = rtw_set_fixed_ie(pframe, 3, &prm->q.category, &pattr->pktlen); -+ -+ /* repeat */ -+ val16 = cpu_to_le16(prm->q.rpt); -+ pframe = rtw_set_fixed_ie(pframe, 2, -+ (unsigned char *)&(val16), &pattr->pktlen); -+ -+ my_len = 0; -+ plen = pframe + 1; -+ /* Element ID, Length, Meas token, Meas Mode, Meas type, op class, ch */ -+ pframe = rtw_set_fixed_ie(pframe, 7, &prm->q.e_id, &my_len); -+ -+ /* random interval */ -+ val16 = cpu_to_le16(prm->q.rand_intvl); /* TU */ -+ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len); -+ -+ /* measurement duration */ -+ val16 = cpu_to_le16(prm->q.meas_dur); -+ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len); -+ -+ /* optional subelement */ -+ switch (prm->q.m_type) { -+ case bcn_req: -+ pframe = rm_gen_bcn_req_s_elem(padapter, prm, pframe, &my_len); -+ break; -+ case ch_load_req: -+ pframe = rm_gen_ch_load_req_s_elem(padapter, pframe, &my_len); -+ break; -+ case noise_histo_req: -+ pframe = rm_gen_noise_histo_req_s_elem(padapter, -+ pframe, &my_len); -+ break; -+ case basic_req: -+ default: -+ break; -+ } -+ -+ /* length */ -+ val8 = (u8)my_len - 2; -+ rtw_set_fixed_ie(plen, 1, &val8, &i); -+ -+ pattr->pktlen += my_len; -+ -+ pattr->last_txcmdsz = pattr->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return _SUCCESS; -+} -+ -+int rm_radio_meas_report_cond(struct rm_obj *prm) -+{ -+ u8 val8; -+ int i; -+ -+ -+ switch (prm->q.m_type) { -+ case ch_load_req: -+ -+ val8 = prm->p.ch_load; -+ switch (prm->q.opt.clm.rep_cond.cond) { -+ case ch_load_cond_immediately: -+ return _SUCCESS; -+ case ch_load_cond_anpi_equal_greater: -+ if (val8 >= prm->q.opt.clm.rep_cond.threshold) -+ return _SUCCESS; -+ break; -+ case ch_load_cond_anpi_equal_less: -+ if (val8 <= prm->q.opt.clm.rep_cond.threshold) -+ return _SUCCESS; -+ break; -+ default: -+ break; -+ } -+ break; -+ case noise_histo_req: -+ val8 = prm->p.anpi; -+ switch (prm->q.opt.nhm.rep_cond.cond) { -+ case noise_histo_cond_immediately: -+ return _SUCCESS; -+ case noise_histo_cond_anpi_equal_greater: -+ if (val8 >= prm->q.opt.nhm.rep_cond.threshold) -+ return _SUCCESS; -+ break; -+ case noise_histo_cond_anpi_equal_less: -+ if (val8 <= prm->q.opt.nhm.rep_cond.threshold) -+ return _SUCCESS; -+ break; -+ default: -+ break; -+ } -+ break; -+ default: -+ break; -+ } -+ return _FAIL; -+} -+ -+int retrieve_radio_meas_result(struct rm_obj *prm) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(prm->psta->padapter); -+ int i, ch = -1; -+ u8 val8; -+ -+ -+ ch = rtw_chset_search_ch(adapter_to_chset(prm->psta->padapter), -+ prm->q.ch_num); -+ -+ if ((ch == -1) || (ch >= MAX_CHANNEL_NUM)) { -+ RTW_ERR("RM: get ch(CH:%d) fail\n", prm->q.ch_num); -+ ch = 0; -+ } -+ -+ switch (prm->q.m_type) { -+ case ch_load_req: -+#ifdef CONFIG_RTW_ACS -+ val8 = hal_data->acs.clm_ratio[ch]; -+#else -+ val8 = 0; -+#endif -+ prm->p.ch_load = val8; -+ break; -+ case noise_histo_req: -+#ifdef CONFIG_RTW_ACS -+ /* ANPI */ -+ prm->p.anpi = hal_data->acs.nhm_ratio[ch]; -+ -+ /* IPI 0~10 */ -+ for (i=0;i<11;i++) -+ prm->p.ipi[i] = hal_data->acs.nhm[ch][i]; -+ -+#else -+ val8 = 0; -+ prm->p.anpi = val8; -+ for (i=0;i<11;i++) -+ prm->p.ipi[i] = val8; -+#endif -+ break; -+ default: -+ break; -+ } -+ return _SUCCESS; -+} -+ -+int issue_radio_meas_rep(struct rm_obj *prm) -+{ -+ u8 val8; -+ u8 *pframe; -+ u8 *plen; -+ u16 val16; -+ u64 val64; -+ unsigned int my_len; -+ _adapter *padapter = prm->psta->padapter; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattr; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct sta_info *psta = prm->psta; -+ int i; -+ -+ -+ RTW_INFO("RM: %s\n", __func__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ RTW_ERR("RM: ERR %s alloc xmit_frame fail\n",__func__); -+ return _FALSE; -+ } -+ pattr = &pmgntframe->attrib; -+ pframe = build_wlan_hdr(padapter, pmgntframe, psta, WIFI_ACTION); -+ pframe = rtw_set_fixed_ie(pframe, 3, -+ &prm->p.category, &pattr->pktlen); -+ -+ my_len = 0; -+ plen = pframe + 1; -+ pframe = rtw_set_fixed_ie(pframe, 7, &prm->p.e_id, &my_len); -+ -+ /* Actual Meas start time - 8 bytes */ -+ val64 = cpu_to_le64(prm->meas_start_time); -+ pframe = rtw_set_fixed_ie(pframe, 8, (u8 *)&val64, &my_len); -+ -+ /* measurement duration */ -+ val16 = prm->meas_end_time - prm->meas_start_time; -+ val16 = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len); -+ -+ /* optional subelement */ -+ switch (prm->q.m_type) { -+ case ch_load_req: -+ val8 = prm->p.ch_load; -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ break; -+ case noise_histo_req: -+ /* -+ * AntennaID -+ * 0: unknown -+ * 255: multiple antenna (Diversity) -+ */ -+ val8 = 0; -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ /* ANPI */ -+ val8 = prm->p.anpi; -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ /* IPI 0~10 */ -+ for (i=0;i<11;i++) { -+ val8 = prm->p.ipi[i]; -+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); -+ } -+ break; -+ default: -+ break; -+ } -+ /* length */ -+ val8 = (u8)my_len-2; -+ rtw_set_fixed_ie(plen, 1, &val8, &i); /* use variable i to ignore it */ -+ -+ pattr->pktlen += my_len; -+ pattr->last_txcmdsz = pattr->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return _SUCCESS; -+} -+ -+void rtw_ap_parse_sta_rm_en_cap(_adapter *padapter, -+ struct sta_info *psta, struct rtw_ieee802_11_elems *elem) -+{ -+ if (elem->rm_en_cap) { -+ RTW_INFO("assoc.rm_en_cap="RM_CAP_FMT"\n", -+ RM_CAP_ARG(elem->rm_en_cap)); -+ -+ _rtw_memcpy(psta->rm_en_cap, (elem->rm_en_cap), -+ MIN(elem->rm_en_cap_len, sizeof(psta->rm_en_cap))); -+ } -+} -+ -+void RM_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ int i; -+ -+ _rtw_memcpy(&padapter->rmpriv.rm_en_cap_assoc, pIE->data, -+ MIN(pIE->Length, sizeof(padapter->rmpriv.rm_en_cap_assoc))); -+ RTW_INFO("assoc.rm_en_cap="RM_CAP_FMT"\n", RM_CAP_ARG(pIE->data)); -+} -+ -+/* Debug command */ -+ -+#if (RM_SUPPORT_IWPRIV_DBG) -+static int hex2num(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; -+} -+ -+int hex2byte(const char *hex) -+{ -+ int a, b; -+ a = hex2num(*hex++); -+ if (a < 0) -+ return -1; -+ b = hex2num(*hex++); -+ if (b < 0) -+ return -1; -+ return (a << 4) | b; -+} -+ -+static char * hwaddr_parse(char *txt, u8 *addr) -+{ -+ size_t i; -+ -+ for (i = 0; i < ETH_ALEN; i++) { -+ int a; -+ -+ a = hex2byte(txt); -+ if (a < 0) -+ return NULL; -+ txt += 2; -+ addr[i] = a; -+ if (i < ETH_ALEN - 1 && *txt++ != ':') -+ return NULL; -+ } -+ return txt; -+} -+ -+void rm_dbg_list_sta(_adapter *padapter, char *s) -+{ -+ int i; -+ _irqL irqL; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ _list *plist, *phead; -+ -+ -+ sprintf(pstr(s), "\n"); -+ _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); -+ -+ sprintf(pstr(s), "=========================================\n"); -+ sprintf(pstr(s), "mac=" MAC_FMT "\n", -+ MAC_ARG(psta->cmn.mac_addr)); -+ sprintf(pstr(s), "state=0x%x, aid=%d, macid=%d\n", -+ psta->state, psta->cmn.aid, psta->cmn.mac_id); -+ sprintf(pstr(s), "rm_cap="RM_CAP_FMT"\n", -+ RM_CAP_ARG(psta->rm_en_cap)); -+ } -+ -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ sprintf(pstr(s), "=========================================\n"); -+} -+ -+void rm_dbg_help(_adapter *padapter, char *s) -+{ -+ int i; -+ -+ -+ sprintf(pstr(s), "\n"); -+ sprintf(pstr(s), "rrm list_sta\n"); -+ sprintf(pstr(s), "rrm list_meas\n"); -+ -+ sprintf(pstr(s), "rrm add_meas ,m=,rpt=\n"); -+ sprintf(pstr(s), "rrm run_meas \n"); -+ sprintf(pstr(s), "rrm del_meas\n"); -+ -+ sprintf(pstr(s), "rrm run_meas rmid=xxxx,ev=xx\n"); -+ sprintf(pstr(s), "rrm activate\n"); -+ -+ for (i=0;istapriv; -+ _list *plist, *phead; -+ -+ -+ _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->cmn.aid == aid) -+ goto done; -+ -+ if (pbssid && _rtw_memcmp(psta->cmn.mac_addr, -+ pbssid, 6)) -+ goto done; -+ } -+ -+ } -+ psta = NULL; -+done: -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ return psta; -+} -+ -+static int rm_dbg_modify_meas(_adapter *padapter, char *s) -+{ -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ struct rm_obj *prm; -+ struct sta_info *psta; -+ char *pmac, *ptr, *paid, *prpt, *pnbp, *pclm, *pnhm, *pbcn, *plnk; -+ unsigned val; -+ u8 bssid[ETH_ALEN]; -+ -+ -+ /* example : -+ * rrm add_meas ,m=, -+ * rrm run_meas -+ */ -+ paid = strstr(s, "aid="); -+ pmac = strstr(s, "mac="); -+ pbcn = strstr(s, "m=bcn"); -+ pclm = strstr(s, "m=clm"); -+ pnhm = strstr(s, "m=nhm"); -+ pnbp = strstr(s, "m=nb"); -+ plnk = strstr(s, "m=link"); -+ prpt = strstr(s, "rpt="); -+ -+ /* set all ',' to NULL (end of line) */ -+ ptr = s; -+ while (ptr) { -+ ptr = strchr(ptr, ','); -+ if (ptr) { -+ *(ptr) = 0x0; -+ ptr++; -+ } -+ } -+ prm = (struct rm_obj *)prmpriv->prm_sel; -+ prm->q.m_token = rm_gen_meas_token(padapter); -+ psta = prm->psta; -+ -+ if (paid) { /* find sta_info according to aid */ -+ paid += 4; /* skip aid= */ -+ sscanf(paid, "%u", &val); /* aid=x */ -+ psta = rm_get_sta(padapter, val, NULL); -+ -+ } else if (pmac) { /* find sta_info according to bssid */ -+ pmac += 4; /* skip mac= */ -+ if (hwaddr_parse(pmac, bssid) == NULL) { -+ sprintf(pstr(s), "Err: \nincorrect mac format\n"); -+ return _FAIL; -+ } -+ psta = rm_get_sta(padapter, 0xff, bssid); -+ } -+ -+ if (psta) { -+ prm->psta = psta; -+ prm->q.diag_token = rm_gen_dialog_token(padapter); -+ prm->rmid = rm_gen_rmid(padapter, prm, RM_MASTER); -+ } else -+ return _FAIL; -+ -+ prm->q.action_code = RM_ACT_RADIO_MEAS_REQ; -+ if (pbcn) { -+ prm->q.m_type = bcn_req; -+ prm->q.rand_intvl = le16_to_cpu(100); -+ prm->q.meas_dur = le16_to_cpu(100); -+ } else if (pnhm) { -+ prm->q.m_type = noise_histo_req; -+ } else if (pclm) { -+ prm->q.m_type = ch_load_req; -+ } else if (pnbp) { -+ prm->q.action_code = RM_ACT_NB_REP_REQ; -+ } else if (plnk) { -+ prm->q.action_code = RM_ACT_LINK_MEAS_REQ; -+ } else -+ return _FAIL; -+ -+ if (prpt) { -+ prpt += 4; /* skip rpt= */ -+ sscanf(prpt, "%u", &val); -+ prm->q.rpt = (u8)val; -+ } -+ -+ return _SUCCESS; -+} -+ -+static void rm_dbg_activate_meas(_adapter *padapter, char *s) -+{ -+ struct rm_priv *prmpriv = &(padapter->rmpriv); -+ struct rm_obj *prm; -+ -+ -+ if (prmpriv->prm_sel == NULL) { -+ sprintf(pstr(s), "\nErr: No inActivate measurement\n"); -+ return; -+ } -+ prm = (struct rm_obj *)prmpriv->prm_sel; -+ -+ /* verify attributes */ -+ if (prm->psta == NULL) { -+ sprintf(pstr(s), "\nErr: inActivate meas has no psta\n"); -+ return; -+ } -+ -+ /* measure current channel */ -+ prm->q.ch_num = padapter->mlmeextpriv.cur_channel; -+ prm->q.op_class = rm_get_oper_class_via_ch(prm->q.ch_num); -+ -+ /* enquee rmobj */ -+ rm_enqueue_rmobj(padapter, prm, _FALSE); -+ -+ sprintf(pstr(s), "\nActivate rmid=%x, state=%s, meas_type=%s\n", -+ prm->rmid, rm_state_name(prm->state), -+ rm_type_req_name(prm->q.m_type)); -+ -+ sprintf(pstr(s), "aid=%d, mac=" MAC_FMT "\n", -+ prm->psta->cmn.aid, MAC_ARG(prm->psta->cmn.mac_addr)); -+ -+ /* clearn inActivate prm info */ -+ prmpriv->prm_sel = NULL; -+} -+ -+/* for ioctl */ -+int rm_send_bcn_reqs(_adapter *padapter, u8 *sta_addr, u8 op_class, u8 ch, -+ u16 measure_duration, u8 measure_mode, u8 *bssid, u8 *ssid, -+ u8 reporting_detail, -+ u8 n_ap_ch_rpt, struct _RT_OPERATING_CLASS *rpt, -+ u8 n_elem_id, u8 *elem_id_list) -+ -+{ -+ struct rm_obj *prm; -+ char *pact; -+ struct sta_info *psta; -+ struct _RT_OPERATING_CLASS *prpt; -+ void *ptr; -+ int i,j,sz; -+ u8 bcast[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ -+ if (n_ap_ch_rpt > BCN_REQ_OPT_AP_CH_RPT_MAX_NUM) { -+ RTW_ERR("RM: chset num %d > %d\n", -+ n_ap_ch_rpt, BCN_REQ_OPT_AP_CH_RPT_MAX_NUM); -+ return -1; -+ } -+ /* dest sta */ -+ psta = rtw_get_stainfo(&padapter->stapriv, sta_addr); -+ if (!psta) { -+ RTW_ERR("RM: psta not found\n"); -+ return -2; -+ } -+ prm = rm_alloc_rmobj(padapter); -+ if (prm == NULL) { -+ RTW_ERR("RM: unable to alloc rm obj for requeset\n"); -+ return -3; -+ } -+ -+ prm->psta = psta; -+ prm->q.meas_dur = measure_duration; -+ -+ /* Figure 8-104 Measurement Requested format */ -+ prm->q.category = RTW_WLAN_CATEGORY_RADIO_MEAS; -+ prm->q.action_code = RM_ACT_RADIO_MEAS_REQ; -+ prm->q.m_mode = measure_mode; -+ prm->q.m_type = bcn_req; -+ prm->q.diag_token = rm_gen_dialog_token(padapter); -+ prm->q.m_token = rm_gen_meas_token(padapter); -+ prm->rmid = rm_gen_rmid(padapter, prm, RM_MASTER); -+ -+ prm->q.e_id = _MEAS_REQ_IE_; /* 38 */ -+ prm->q.ch_num = ch; -+ prm->q.op_class = op_class; -+ prm->from_ioctl = true; -+ -+ if (bssid != NULL) -+ memcpy(prm->q.bssid, bssid, ETH_ALEN); -+ else -+ memcpy(prm->q.bssid, bcast, ETH_ALEN); -+ -+ if (ssid != NULL) { -+ i = MIN(32, strlen(ssid)); -+ prm->q.opt.bcn.ssid.SsidLength = i; -+ memcpy(prm->q.opt.bcn.ssid.Ssid, ssid, i); -+ } -+ -+ if (n_ap_ch_rpt > 0) { -+ prm->q.opt.bcn.ap_ch_rpt_num = n_ap_ch_rpt; -+ j = 0; -+ for (i = 0; i < n_ap_ch_rpt; i++) { -+ prpt = rpt++; -+ if (prpt == NULL) -+ break; -+ -+ sz = sizeof(struct _RT_OPERATING_CLASS) * prpt->Len; -+ ptr = rtw_malloc(sz); -+ _rtw_memcpy(ptr, prpt, sz); -+ prm->q.opt.bcn.ap_ch_rpt[i] = (struct _RT_OPERATING_CLASS *)ptr; -+ } -+ } -+ prm->q.opt.bcn.rep_detail = reporting_detail; -+ -+ if ((n_elem_id > 0) && (n_elem_id < BCN_REQ_REQ_OPT_MAX_NUM)) { -+ prm->q.opt.bcn.req_id_num = n_elem_id; -+ _rtw_memcpy(prm->q.opt.bcn.req_id, elem_id_list, n_elem_id); -+ } -+ /* enquee rmobj */ -+ rm_enqueue_rmobj(padapter, prm, _FALSE); -+ -+ RTW_INFO("\nAdd rmid=%x, meas_type=%s ok\n", -+ prm->rmid, rm_type_req_name(prm->q.m_type)); -+ -+ if (prm->psta) -+ RTW_INFO("mac="MAC_FMT"\n", MAC_ARG(prm->psta->cmn.mac_addr)); -+ return 0; -+} -+ -+void indicate_beacon_report(u8 *sta_addr, -+ u8 n_measure_rpt, u32 elem_len, u8 *elem) -+{ -+ RTW_INFO("RM: recv bcn reprot from mac="MAC_FMT"\n", MAC_ARG(sta_addr)); -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ cmap_intfs_nl_beacon_report_event(sta_addr, n_measure_rpt, elem_len, elem); -+#endif -+} -+ -+static void rm_dbg_add_meas(_adapter *padapter, char *s) -+{ -+ struct rm_priv *prmpriv = &(padapter->rmpriv); -+ struct rm_obj *prm; -+ char *pact; -+ -+ -+ /* example : -+ * rrm add_meas ,m= -+ * rrm run_meas -+ */ -+ prm = (struct rm_obj *)prmpriv->prm_sel; -+ if (prm == NULL) -+ prm = rm_alloc_rmobj(padapter); -+ -+ if (prm == NULL) { -+ sprintf(pstr(s), "\nErr: alloc meas fail\n"); -+ return; -+ } -+ -+ prmpriv->prm_sel = prm; -+ -+ pact = strstr(s, "act"); -+ if (rm_dbg_modify_meas(padapter, s) == _FAIL) { -+ -+ sprintf(pstr(s), "\nErr: add meas fail\n"); -+ rm_free_rmobj(prm); -+ prmpriv->prm_sel = NULL; -+ return; -+ } -+ prm->q.category = RTW_WLAN_CATEGORY_RADIO_MEAS; -+ prm->q.e_id = _MEAS_REQ_IE_; /* 38 */ -+ -+ sprintf(pstr(s), "\nAdd rmid=%x, meas_type=%s ok\n", -+ prm->rmid, rm_type_req_name(prm->q.m_type)); -+ -+ if (prm->psta) -+ sprintf(pstr(s), "mac="MAC_FMT"\n", -+ MAC_ARG(prm->psta->cmn.mac_addr)); -+ -+ if (pact) -+ rm_dbg_activate_meas(padapter, pstr(s)); -+} -+ -+static void rm_dbg_del_meas(_adapter *padapter, char *s) -+{ -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ struct rm_obj *prm = (struct rm_obj *)prmpriv->prm_sel; -+ -+ -+ if (prm) { -+ sprintf(pstr(s), "\ndelete rmid=%x\n",prm->rmid); -+ -+ /* free inActivate meas - enqueue yet */ -+ prmpriv->prm_sel = NULL; -+ rtw_mfree(prmpriv->prm_sel, sizeof(struct rm_obj)); -+ } else -+ sprintf(pstr(s), "Err: no inActivate measurement\n"); -+} -+ -+static void rm_dbg_run_meas(_adapter *padapter, char *s) -+{ -+ struct rm_obj *prm; -+ char *pevid, *prmid; -+ u32 rmid, evid; -+ -+ -+ prmid = strstr(s, "rmid="); /* hex */ -+ pevid = strstr(s, "evid="); /* dec */ -+ -+ if (prmid && pevid) { -+ prmid += 5; /* rmid= */ -+ sscanf(prmid, "%x", &rmid); -+ -+ pevid += 5; /* evid= */ -+ sscanf(pevid, "%u", &evid); -+ } else { -+ sprintf(pstr(s), "\nErr: incorrect attribute\n"); -+ return; -+ } -+ -+ prm = rm_get_rmobj(padapter, rmid); -+ -+ if (!prm) { -+ sprintf(pstr(s), "\nErr: measurement not found\n"); -+ return; -+ } -+ -+ if (evid >= RM_EV_max) { -+ sprintf(pstr(s), "\nErr: wrong event id\n"); -+ return; -+ } -+ -+ rm_post_event(padapter, prm->rmid, evid); -+ sprintf(pstr(s), "\npost %s to rmid=%x\n",rm_event_name(evid), rmid); -+} -+ -+static void rm_dbg_show_meas(struct rm_obj *prm, char *s) -+{ -+ struct sta_info *psta; -+ -+ psta = prm->psta; -+ -+ if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) { -+ -+ sprintf(pstr(s), "\nrmid=%x, meas_type=%s\n", -+ prm->rmid, rm_type_req_name(prm->q.m_type)); -+ -+ } else if (prm->q.action_code == RM_ACT_NB_REP_REQ) { -+ -+ sprintf(pstr(s), "\nrmid=%x, action=neighbor_req\n", -+ prm->rmid); -+ } else -+ sprintf(pstr(s), "\nrmid=%x, action=unknown\n", -+ prm->rmid); -+ -+ if (psta) -+ sprintf(pstr(s), "aid=%d, mac="MAC_FMT"\n", -+ psta->cmn.aid, MAC_ARG(psta->cmn.mac_addr)); -+ -+ sprintf(pstr(s), "clock=%d, state=%s, rpt=%u/%u\n", -+ (int)ATOMIC_READ(&prm->pclock->counter), -+ rm_state_name(prm->state), prm->p.rpt, prm->q.rpt); -+} -+ -+static void rm_dbg_list_meas(_adapter *padapter, char *s) -+{ -+ int meas_amount; -+ _irqL irqL; -+ struct rm_obj *prm; -+ struct sta_info *psta; -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ _queue *queue = &prmpriv->rm_queue; -+ _list *plist, *phead; -+ -+ -+ sprintf(pstr(s), "\n"); -+ _enter_critical(&queue->lock, &irqL); -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ meas_amount = 0; -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ prm = LIST_CONTAINOR(plist, struct rm_obj, list); -+ meas_amount++; -+ plist = get_next(plist); -+ psta = prm->psta; -+ sprintf(pstr(s), "=========================================\n"); -+ -+ rm_dbg_show_meas(prm, s); -+ } -+ _exit_critical(&queue->lock, &irqL); -+ -+ sprintf(pstr(s), "=========================================\n"); -+ -+ if (meas_amount==0) { -+ sprintf(pstr(s), "No Activate measurement\n"); -+ sprintf(pstr(s), "=========================================\n"); -+ } -+ -+ if (prmpriv->prm_sel == NULL) -+ sprintf(pstr(s), "\nNo inActivate measurement\n"); -+ else { -+ sprintf(pstr(s), "\ninActivate measurement\n"); -+ rm_dbg_show_meas((struct rm_obj *)prmpriv->prm_sel, s); -+ } -+} -+#endif /* RM_SUPPORT_IWPRIV_DBG */ -+ -+int verify_bcn_req(_adapter *padapter, struct sta_info *psta) -+{ -+ char *bssid = NULL; -+ char ssid[] = "RealKungFu"; -+ u8 op_class = 0; -+ u8 ch = 255; -+ u16 measure_duration = 100; -+ u8 reporting_detaial = 0; -+ u8 n_ap_ch_rpt = 6; -+ u8 measure_mode = bcn_req_active; -+ u8 req[] = {1,2,3}; -+ u8 req_len = sizeof(req); -+ -+ -+ static RT_OPERATING_CLASS US[] = { -+ /* 0, OP_CLASS_NULL */ //{ 0, 0, {}}, -+ /* 1, OP_CLASS_1 */ {115, 4, {36, 40, 44, 48}}, -+ /* 2, OP_CLASS_2 */ {118, 4, {52, 56, 60, 64}}, -+ /* 3, OP_CLASS_3 */ {124, 4, {149, 153, 157, 161}}, -+ /* 4, OP_CLASS_4 */ {121, 11, {100, 104, 108, 112, 116, 120, 124, -+ 128, 132, 136, 140}}, -+ /* 5, OP_CLASS_5 */ {125, 5, {149, 153, 157, 161, 165}}, -+ /* 6, OP_CLASS_12 */ { 81, 11, {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}} -+ }; -+ -+ rm_send_bcn_reqs(padapter, psta->cmn.mac_addr, op_class, ch, -+ measure_duration, measure_mode, bssid, ssid, -+ reporting_detaial, n_ap_ch_rpt, US, req_len, req); -+ return 0; -+} -+ -+void rm_dbg_cmd(_adapter *padapter, char *s) -+{ -+ unsigned val; -+ char *paid; -+ struct sta_info *psta=NULL; -+ -+#if (RM_SUPPORT_IWPRIV_DBG) -+ if (_rtw_memcmp(s, "help", 4)) { -+ rm_dbg_help(padapter, s); -+ -+ } else if (_rtw_memcmp(s, "send_bcn_req", 12)) { -+ -+ /* rtwpriv wls1 rrm send_bcn_req aid=1 */ -+ paid = strstr(s, "aid="); -+ if (paid) { /* find sta_info according to aid */ -+ paid += 4; /* skip aid= */ -+ sscanf(paid, "%u", &val); /* aid=x */ -+ psta = rm_get_sta(padapter, val, NULL); -+ -+ if (psta) -+ verify_bcn_req(padapter, psta); -+ } -+ -+ } else if (_rtw_memcmp(s, "list_sta", 8)) { -+ rm_dbg_list_sta(padapter, s); -+ -+ } else if (_rtw_memcmp(s, "list_meas", 9)) { -+ rm_dbg_list_meas(padapter, s); -+ -+ } else if (_rtw_memcmp(s, "add_meas", 8)) { -+ rm_dbg_add_meas(padapter, s); -+ -+ } else if (_rtw_memcmp(s, "del_meas", 8)) { -+ rm_dbg_del_meas(padapter, s); -+ -+ } else if (_rtw_memcmp(s, "activate", 8)) { -+ rm_dbg_activate_meas(padapter, s); -+ -+ } else if (_rtw_memcmp(s, "run_meas", 8)) { -+ rm_dbg_run_meas(padapter, s); -+ -+ } else if (_rtw_memcmp(s, "nb", 2)) { -+ -+ paid = strstr(s, "aid="); -+ -+ if (paid) { /* find sta_info according to aid */ -+ paid += 4; /* skip aid= */ -+ sscanf(paid, "%u", &val); /* aid=x */ -+ psta = rm_get_sta(padapter, val, NULL); -+ -+ if (psta) -+ rm_add_nb_req(padapter, psta); -+ } -+ } -+#else -+ sprintf(pstr(s), "\n"); -+ sprintf(pstr(s), "rrm debug command was disabled\n"); -+#endif -+} -+#endif /* CONFIG_RTW_80211K */ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_rm_fsm.c b/drivers/net/wireless/rtl8821cs/core/rtw_rm_fsm.c -new file mode 100644 -index 000000000..244b799a2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_rm_fsm.c -@@ -0,0 +1,1017 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#ifdef CONFIG_RTW_80211K -+#include "rtw_rm_fsm.h" -+#include "rtw_rm_util.h" -+ -+struct fsm_state { -+ u8 *name; -+ int(*fsm_func)(struct rm_obj *prm, enum RM_EV_ID evid); -+}; -+ -+static void rm_state_initial(struct rm_obj *prm); -+static void rm_state_goto(struct rm_obj *prm, enum RM_STATE rm_state); -+static void rm_state_run(struct rm_obj *prm, enum RM_EV_ID evid); -+static struct rm_event *rm_dequeue_ev(_queue *queue); -+static struct rm_obj *rm_dequeue_rm(_queue *queue); -+ -+void rm_timer_callback(void *data) -+{ -+ int i; -+ _adapter *padapter = (_adapter *)data; -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ struct rm_clock *pclock; -+ -+ -+ /* deal with clock */ -+ for (i=0;iclock[i]; -+ if (pclock->prm == NULL -+ ||(ATOMIC_READ(&(pclock->counter)) == 0)) -+ continue; -+ -+ ATOMIC_DEC(&(pclock->counter)); -+ -+ if (ATOMIC_READ(&(pclock->counter)) == 0) -+ rm_post_event(pclock->prm->psta->padapter, -+ pclock->prm->rmid, prmpriv->clock[i].evid); -+ } -+ _set_timer(&prmpriv->rm_timer, CLOCK_UNIT); -+} -+ -+int rtw_init_rm(_adapter *padapter) -+{ -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ -+ -+ RTW_INFO("RM: %s\n",__func__); -+ _rtw_init_queue(&(prmpriv->rm_queue)); -+ _rtw_init_queue(&(prmpriv->ev_queue)); -+ -+ /* bit 0-7 */ -+ prmpriv->rm_en_cap_def[0] = 0 -+ | BIT(RM_LINK_MEAS_CAP_EN) -+ | BIT(RM_NB_REP_CAP_EN) -+ /*| BIT(RM_PARAL_MEAS_CAP_EN)*/ -+ | BIT(RM_REPEAT_MEAS_CAP_EN) -+ | BIT(RM_BCN_PASSIVE_MEAS_CAP_EN) -+ | BIT(RM_BCN_ACTIVE_MEAS_CAP_EN) -+ | BIT(RM_BCN_TABLE_MEAS_CAP_EN) -+ /*| BIT(RM_BCN_MEAS_REP_COND_CAP_EN)*/; -+ -+ /* bit 8-15 */ -+ prmpriv->rm_en_cap_def[1] = 0 -+ /*| BIT(RM_FRAME_MEAS_CAP_EN - 8)*/ -+#ifdef CONFIG_RTW_ACS -+ | BIT(RM_CH_LOAD_CAP_EN - 8) -+ | BIT(RM_NOISE_HISTO_CAP_EN - 8) -+#endif -+ /*| BIT(RM_STATIS_MEAS_CAP_EN - 8)*/ -+ /*| BIT(RM_LCI_MEAS_CAP_EN - 8)*/ -+ /*| BIT(RM_LCI_AMIMUTH_CAP_EN - 8)*/ -+ /*| BIT(RM_TRANS_STREAM_CAT_MEAS_CAP_EN - 8)*/ -+ /*| BIT(RM_TRIG_TRANS_STREAM_CAT_MEAS_CAP_EN - 8)*/; -+ -+ /* bit 16-23 */ -+ prmpriv->rm_en_cap_def[2] = 0 -+ /*| BIT(RM_AP_CH_REP_CAP_EN - 16)*/ -+ /*| BIT(RM_RM_MIB_CAP_EN - 16)*/ -+ /*| BIT(RM_OP_CH_MAX_MEAS_DUR0 - 16)*/ -+ /*| BIT(RM_OP_CH_MAX_MEAS_DUR1 - 16)*/ -+ /*| BIT(RM_OP_CH_MAX_MEAS_DUR2 - 16)*/ -+ /*| BIT(RM_NONOP_CH_MAX_MEAS_DUR0 - 16)*/ -+ /*| BIT(RM_NONOP_CH_MAX_MEAS_DUR1 - 16)*/ -+ /*| BIT(RM_NONOP_CH_MAX_MEAS_DUR2 - 16)*/; -+ -+ /* bit 24-31 */ -+ prmpriv->rm_en_cap_def[3] = 0 -+ /*| BIT(RM_MEAS_PILOT_CAP0 - 24)*/ -+ /*| BIT(RM_MEAS_PILOT_CAP1 - 24)*/ -+ /*| BIT(RM_MEAS_PILOT_CAP2 - 24)*/ -+ /*| BIT(RM_MEAS_PILOT_TRANS_INFO_CAP_EN - 24)*/ -+ /*| BIT(RM_NB_REP_TSF_OFFSET_CAP_EN - 24)*/ -+ | BIT(RM_RCPI_MEAS_CAP_EN - 24) -+ | BIT(RM_RSNI_MEAS_CAP_EN - 24) -+ /*| BIT(RM_BSS_AVG_ACCESS_DELAY_CAP_EN - 24)*/; -+ -+ /* bit 32-39 */ -+ prmpriv->rm_en_cap_def[4] = 0 -+ /*| BIT(RM_BSS_AVG_ACCESS_DELAY_CAP_EN - 32)*/ -+ /*| BIT(RM_AVALB_ADMIS_CAPACITY_CAP_EN - 32)*/ -+ /*| BIT(RM_ANT_CAP_EN - 32)*/; -+ -+ prmpriv->enable = _TRUE; -+ -+ /* clock timer */ -+ rtw_init_timer(&prmpriv->rm_timer, -+ padapter, rm_timer_callback, padapter); -+ _set_timer(&prmpriv->rm_timer, CLOCK_UNIT); -+ -+ prmpriv->meas_token = 1; -+ return _SUCCESS; -+} -+ -+int rtw_deinit_rm(_adapter *padapter) -+{ -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ struct rm_obj *prm; -+ struct rm_event *pev; -+ -+ -+ RTW_INFO("RM: %s\n",__func__); -+ prmpriv->enable = _FALSE; -+ _cancel_timer_ex(&prmpriv->rm_timer); -+ -+ /* free all events and measurements */ -+ while((pev = rm_dequeue_ev(&prmpriv->ev_queue)) != NULL) -+ rtw_mfree((void *)pev, sizeof(struct rm_event)); -+ -+ while((prm = rm_dequeue_rm(&prmpriv->rm_queue)) != NULL) -+ rm_state_run(prm, RM_EV_cancel); -+ -+ _rtw_deinit_queue(&(prmpriv->rm_queue)); -+ _rtw_deinit_queue(&(prmpriv->ev_queue)); -+ -+ return _SUCCESS; -+} -+ -+int rtw_free_rm_priv(_adapter *padapter) -+{ -+ return rtw_deinit_rm(padapter); -+} -+ -+static int rm_enqueue_ev(_queue *queue, struct rm_event *obj, bool to_head) -+{ -+ _irqL irqL; -+ -+ -+ if (obj == NULL) -+ return _FAIL; -+ -+ _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); -+ -+ _exit_critical(&queue->lock, &irqL); -+ -+ return _SUCCESS; -+} -+ -+static void rm_set_clock(struct rm_obj *prm, u32 ms, enum RM_EV_ID evid) -+{ -+ ATOMIC_SET(&(prm->pclock->counter), (ms/CLOCK_UNIT)); -+ prm->pclock->evid = evid; -+} -+ -+static struct rm_clock *rm_alloc_clock(_adapter *padapter, struct rm_obj *prm) -+{ -+ int i; -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ struct rm_clock *pclock = NULL; -+ -+ -+ for (i=0;iclock[i]; -+ -+ if (pclock->prm == NULL) { -+ pclock->prm = prm; -+ ATOMIC_SET(&(pclock->counter), 0); -+ pclock->evid = RM_EV_max; -+ break; -+ } -+ } -+ return pclock; -+} -+ -+static void rm_cancel_clock(struct rm_obj *prm) -+{ -+ ATOMIC_SET(&(prm->pclock->counter), 0); -+ prm->pclock->evid = RM_EV_max; -+} -+ -+static void rm_free_clock(struct rm_clock *pclock) -+{ -+ pclock->prm = NULL; -+ ATOMIC_SET(&(pclock->counter), 0); -+ pclock->evid = RM_EV_max; -+} -+ -+static int is_list_linked(const struct list_head *head) -+{ -+ return head->prev != NULL; -+} -+ -+void rm_free_rmobj(struct rm_obj *prm) -+{ -+ if (is_list_linked(&prm->list)) -+ rtw_list_delete(&prm->list); -+ -+ if (prm->q.pssid) -+ rtw_mfree(prm->q.pssid, strlen(prm->q.pssid)+1); -+ -+ if (prm->q.opt.bcn.req_start) -+ rtw_mfree(prm->q.opt.bcn.req_start, -+ prm->q.opt.bcn.req_len); -+ -+ if (prm->pclock) -+ rm_free_clock(prm->pclock); -+ -+ rtw_mfree((void *)prm, sizeof(struct rm_obj)); -+} -+ -+struct rm_obj *rm_alloc_rmobj(_adapter *padapter) -+{ -+ struct rm_obj *prm; -+ -+ -+ prm = (struct rm_obj *)rtw_malloc(sizeof(struct rm_obj)); -+ if (prm == NULL) -+ return NULL; -+ -+ _rtw_memset(prm, 0, sizeof(struct rm_obj)); -+ -+ /* alloc timer */ -+ if ((prm->pclock = rm_alloc_clock(padapter, prm)) == NULL) { -+ rm_free_rmobj(prm); -+ return NULL; -+ } -+ return prm; -+} -+ -+int rm_enqueue_rmobj(_adapter *padapter, struct rm_obj *prm, bool to_head) -+{ -+ _irqL irqL; -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ _queue *queue = &prmpriv->rm_queue; -+ -+ -+ if (prm == NULL) -+ return _FAIL; -+ -+ _enter_critical(&queue->lock, &irqL); -+ if (to_head) -+ rtw_list_insert_head(&prm->list, &queue->queue); -+ else -+ rtw_list_insert_tail(&prm->list, &queue->queue); -+ _exit_critical(&queue->lock, &irqL); -+ -+ rm_state_initial(prm); -+ -+ return _SUCCESS; -+} -+ -+static struct rm_obj *rm_dequeue_rm(_queue *queue) -+{ -+ _irqL irqL; -+ struct rm_obj *prm; -+ -+ -+ _enter_critical(&queue->lock, &irqL); -+ if (rtw_is_list_empty(&(queue->queue))) -+ prm = NULL; -+ else { -+ prm = LIST_CONTAINOR(get_next(&(queue->queue)), -+ struct rm_obj, list); -+ /* rtw_list_delete(&prm->list); */ -+ } -+ _exit_critical(&queue->lock, &irqL); -+ -+ return prm; -+} -+ -+static struct rm_event *rm_dequeue_ev(_queue *queue) -+{ -+ _irqL irqL; -+ struct rm_event *ev; -+ -+ -+ _enter_critical(&queue->lock, &irqL); -+ if (rtw_is_list_empty(&(queue->queue))) -+ ev = NULL; -+ else { -+ ev = LIST_CONTAINOR(get_next(&(queue->queue)), -+ struct rm_event, list); -+ rtw_list_delete(&ev->list); -+ } -+ _exit_critical(&queue->lock, &irqL); -+ -+ return ev; -+} -+ -+static struct rm_obj *_rm_get_rmobj(_queue *queue, u32 rmid) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ struct rm_obj *prm = NULL; -+ -+ -+ if (rmid == 0) -+ return NULL; -+ -+ _enter_critical(&queue->lock, &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ -+ prm = LIST_CONTAINOR(plist, struct rm_obj, list); -+ if (rmid == (prm->rmid)) { -+ _exit_critical(&queue->lock, &irqL); -+ return prm; -+ } -+ plist = get_next(plist); -+ } -+ _exit_critical(&queue->lock, &irqL); -+ -+ return NULL; -+} -+ -+struct sta_info *rm_get_psta(_adapter *padapter, u32 rmid) -+{ -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ struct rm_obj *prm; -+ -+ -+ prm = _rm_get_rmobj(&prmpriv->rm_queue, rmid); -+ -+ if (prm) -+ return prm->psta; -+ -+ return NULL; -+} -+ -+struct rm_obj *rm_get_rmobj(_adapter *padapter, u32 rmid) -+{ -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ -+ return _rm_get_rmobj(&prmpriv->rm_queue, rmid); -+} -+ -+u8 rtw_rm_post_envent_cmd(_adapter *padapter, u32 rmid, u8 evid) -+{ -+ struct cmd_obj *pcmd; -+ struct rm_event *pev; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ pev = (struct rm_event*)rtw_zmalloc(sizeof(struct rm_event)); -+ -+ if (pev == NULL) { -+ rtw_mfree((u8 *) pcmd, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ pev->rmid = rmid; -+ pev->evid = evid; -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmd, pev, CMD_RM_POST_EVENT); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+exit: -+ return res; -+} -+ -+int rm_post_event(_adapter *padapter, u32 rmid, enum RM_EV_ID evid) -+{ -+ if (padapter->rmpriv.enable == _FALSE) -+ return _FALSE; -+ -+ RTW_INFO("RM: post asyn %s to rmid=%x\n", rm_event_name(evid), rmid); -+ rtw_rm_post_envent_cmd(padapter, rmid, evid); -+ return _SUCCESS; -+} -+ -+int _rm_post_event(_adapter *padapter, u32 rmid, enum RM_EV_ID evid) -+{ -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ struct rm_event *pev; -+ -+ if (evid >= RM_EV_max || rmid == 0) -+ return _FALSE; -+ -+ pev = (struct rm_event *)rtw_malloc(sizeof(struct rm_event)); -+ if (pev == NULL) -+ return _FALSE; -+ -+ pev->rmid = rmid; -+ pev->evid = evid; -+ -+ RTW_INFO("RM: post sync %s to rmid=%x\n", rm_event_name(evid), rmid); -+ rm_enqueue_ev(&prmpriv->ev_queue, pev, FALSE); -+ -+ return _SUCCESS; -+} -+ -+static void rm_bcast_aid_handler(_adapter *padapter, struct rm_event *pev) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ _queue *queue = &padapter->rmpriv.rm_queue; -+ struct rm_obj *prm; -+ -+ -+ _enter_critical(&queue->lock, &irqL); -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ -+ prm = LIST_CONTAINOR(plist, struct rm_obj, list); -+ plist = get_next(plist); -+ if (RM_GET_AID(pev->rmid) == RM_GET_AID(prm->rmid)) { -+ _exit_critical(&queue->lock, &irqL); -+ rm_state_run(prm, pev->evid); -+ _enter_critical(&queue->lock, &irqL); -+ } -+ } -+ _exit_critical(&queue->lock, &irqL); -+ return; -+} -+ -+/* main handler of RM (Resource Management) */ -+void rm_handler(_adapter *padapter, struct rm_event *pe) -+{ -+ int i; -+ struct rm_priv *prmpriv = &padapter->rmpriv; -+ struct rm_obj *prm; -+ struct rm_event *pev; -+ -+ -+ /* dequeue event */ -+ while((pev = rm_dequeue_ev(&prmpriv->ev_queue)) != NULL) -+ { -+ if (RM_IS_ID_FOR_ALL(pev->rmid)) { -+ /* apply to all aid mateched measurement */ -+ rm_bcast_aid_handler(padapter, pev); -+ rtw_mfree((void *)pev, sizeof(struct rm_event)); -+ continue; -+ } -+ -+ /* retrieve rmobj */ -+ prm = _rm_get_rmobj(&prmpriv->rm_queue, pev->rmid); -+ if (prm == NULL) { -+ RTW_ERR("RM: rmid=%x event=%s doesn't find rm obj\n", -+ pev->rmid, rm_event_name(pev->evid)); -+ rtw_mfree((void *)pev, sizeof(struct rm_event)); -+ return; -+ } -+ /* run state machine */ -+ rm_state_run(prm, pev->evid); -+ rtw_mfree((void *)pev, sizeof(struct rm_event)); -+ } -+} -+ -+static int rm_issue_meas_req(struct rm_obj *prm) -+{ -+ switch (prm->q.action_code) { -+ case RM_ACT_RADIO_MEAS_REQ: -+ switch (prm->q.m_type) { -+ case bcn_req: -+ case ch_load_req: -+ case noise_histo_req: -+ issue_radio_meas_req(prm); -+ break; -+ default: -+ break; -+ } /* meas_type */ -+ break; -+ case RM_ACT_NB_REP_REQ: -+ /* issue neighbor request */ -+ issue_nb_req(prm); -+ break; -+ case RM_ACT_LINK_MEAS_REQ: -+ issue_link_meas_req(prm); -+ break; -+ default: -+ return _FALSE; -+ } /* action_code */ -+ -+ return _SUCCESS; -+} -+ -+/* -+* RM state machine -+*/ -+ -+static int rm_state_idle(struct rm_obj *prm, enum RM_EV_ID evid) -+{ -+ _adapter *padapter = prm->psta->padapter; -+ u8 val8; -+ u32 val32; -+ -+ -+ prm->p.category = RTW_WLAN_CATEGORY_RADIO_MEAS; -+ -+ switch (evid) { -+ case RM_EV_state_in: -+ switch (prm->q.action_code) { -+ case RM_ACT_RADIO_MEAS_REQ: -+ /* copy attrib from meas_req to meas_rep */ -+ prm->p.action_code = RM_ACT_RADIO_MEAS_REP; -+ prm->p.diag_token = prm->q.diag_token; -+ prm->p.e_id = _MEAS_RSP_IE_; -+ prm->p.m_token = prm->q.m_token; -+ prm->p.m_type = prm->q.m_type; -+ prm->p.rpt = prm->q.rpt; -+ prm->p.ch_num = prm->q.ch_num; -+ prm->p.op_class = prm->q.op_class; -+ -+ if (prm->q.m_type == ch_load_req -+ || prm->q.m_type == noise_histo_req) { -+ /* -+ * phydm measure current ch periodically -+ * scan current ch is not necessary -+ */ -+ val8 = padapter->mlmeextpriv.cur_channel; -+ if (prm->q.ch_num == val8) -+ prm->poll_mode = 1; -+ } -+ RTW_INFO("RM: rmid=%x %s switch in repeat=%u\n", -+ prm->rmid, rm_type_req_name(prm->q.m_type), -+ prm->q.rpt); -+ break; -+ case RM_ACT_NB_REP_REQ: -+ prm->p.action_code = RM_ACT_NB_REP_RESP; -+ RTW_INFO("RM: rmid=%x Neighbor request switch in\n", -+ prm->rmid); -+ break; -+ case RM_ACT_LINK_MEAS_REQ: -+ prm->p.diag_token = prm->q.diag_token; -+ prm->p.action_code = RM_ACT_LINK_MEAS_REP; -+ RTW_INFO("RM: rmid=%x Link meas switch in\n", -+ prm->rmid); -+ break; -+ default: -+ prm->p.action_code = prm->q.action_code; -+ rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP); -+ RTW_INFO("RM: rmid=%x recv unknown action %d\n", -+ prm->rmid,prm->p.action_code); -+ break; -+ } /* switch() */ -+ -+ if (prm->rmid & RM_MASTER) { -+ if (rm_issue_meas_req(prm) == _SUCCESS) -+ rm_state_goto(prm, RM_ST_WAIT_MEAS); -+ else -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ } else { -+ rm_state_goto(prm, RM_ST_DO_MEAS); -+ return _SUCCESS; -+ } -+ -+ if (prm->p.m_mode) { -+ issue_null_reply(prm); -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ } -+ if (prm->q.rand_intvl) { -+ /* get low tsf to generate random interval */ -+ val32 = rtw_read32(padapter, REG_TSFTR); -+ val32 = val32 % prm->q.rand_intvl; -+ RTW_INFO("RM: rmid=%x rand_intval=%d, rand=%d\n", -+ prm->rmid, (int)prm->q.rand_intvl,val32); -+ rm_set_clock(prm, prm->q.rand_intvl, -+ RM_EV_delay_timer_expire); -+ return _SUCCESS; -+ } -+ break; -+ case RM_EV_delay_timer_expire: -+ rm_state_goto(prm, RM_ST_DO_MEAS); -+ break; -+ case RM_EV_cancel: -+ rm_state_goto(prm, RM_ST_END); -+ break; -+ case RM_EV_state_out: -+ rm_cancel_clock(prm); -+ break; -+ default: -+ break; -+ } -+ return _SUCCESS; -+} -+ -+/* we do the measuring */ -+static int rm_state_do_meas(struct rm_obj *prm, enum RM_EV_ID evid) -+{ -+ _adapter *padapter = prm->psta->padapter; -+ u8 val8; -+ u64 val64; -+ -+ -+ switch (evid) { -+ case RM_EV_state_in: -+ if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) { -+ switch (prm->q.m_type) { -+ case bcn_req: -+ if (prm->q.m_mode == bcn_req_bcn_table) { -+ RTW_INFO("RM: rmid=%x Beacon table\n", -+ prm->rmid); -+ _rm_post_event(padapter, prm->rmid, -+ RM_EV_survey_done); -+ return _SUCCESS; -+ } -+ break; -+ case ch_load_req: -+ case noise_histo_req: -+ if (prm->poll_mode) -+ _rm_post_event(padapter, prm->rmid, -+ RM_EV_survey_done); -+ return _SUCCESS; -+ default: -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ } -+ -+ if (!ready_for_scan(prm)) { -+ prm->wait_busy = RM_BUSY_TRAFFIC_TIMES; -+ RTW_INFO("RM: wait busy traffic - %d\n", -+ prm->wait_busy); -+ rm_set_clock(prm, RM_WAIT_BUSY_TIMEOUT, -+ RM_EV_busy_timer_expire); -+ return _SUCCESS; -+ } -+ } else if (prm->q.action_code == RM_ACT_LINK_MEAS_REQ) { -+ ; /* do nothing */ -+ rm_state_goto(prm, RM_ST_SEND_REPORT); -+ return _SUCCESS; -+ } -+ _rm_post_event(padapter, prm->rmid, RM_EV_start_meas); -+ break; -+ case RM_EV_start_meas: -+ if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) { -+ /* resotre measurement start time */ -+ prm->meas_start_time = rtw_hal_get_tsftr_by_port(padapter -+ , rtw_hal_get_port(padapter)); -+ -+ switch (prm->q.m_type) { -+ case bcn_req: -+ val8 = 1; /* Enable free run counter */ -+ prm->free_run_counter_valid = rtw_hal_set_hwreg( -+ padapter, HW_VAR_FREECNT, &val8); -+ -+ rm_sitesurvey(prm); -+ break; -+ case ch_load_req: -+ case noise_histo_req: -+ rm_sitesurvey(prm); -+ break; -+ default: -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ break; -+ } -+ } -+ /* handle measurement timeout */ -+ rm_set_clock(prm, RM_MEAS_TIMEOUT, RM_EV_meas_timer_expire); -+ break; -+ case RM_EV_survey_done: -+ if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) { -+ switch (prm->q.m_type) { -+ case bcn_req: -+ rm_cancel_clock(prm); -+ rm_state_goto(prm, RM_ST_SEND_REPORT); -+ return _SUCCESS; -+ case ch_load_req: -+ case noise_histo_req: -+ retrieve_radio_meas_result(prm); -+ -+ if (rm_radio_meas_report_cond(prm) == _SUCCESS) -+ rm_state_goto(prm, RM_ST_SEND_REPORT); -+ else -+ rm_set_clock(prm, RM_COND_INTVL, -+ RM_EV_retry_timer_expire); -+ break; -+ default: -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ } -+ } -+ break; -+ case RM_EV_meas_timer_expire: -+ RTW_INFO("RM: rmid=%x measurement timeount\n",prm->rmid); -+ rm_set_rep_mode(prm, MEAS_REP_MOD_REFUSE); -+ issue_null_reply(prm); -+ rm_state_goto(prm, RM_ST_END); -+ break; -+ case RM_EV_busy_timer_expire: -+ if (!ready_for_scan(prm) && prm->wait_busy--) { -+ RTW_INFO("RM: wait busy - %d\n",prm->wait_busy); -+ rm_set_clock(prm, RM_WAIT_BUSY_TIMEOUT, -+ RM_EV_busy_timer_expire); -+ break; -+ } -+ else if (prm->wait_busy <= 0) { -+ RTW_INFO("RM: wait busy timeout\n"); -+ rm_set_rep_mode(prm, MEAS_REP_MOD_REFUSE); -+ issue_null_reply(prm); -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ } -+ _rm_post_event(padapter, prm->rmid, RM_EV_start_meas); -+ break; -+ case RM_EV_request_timer_expire: -+ rm_set_rep_mode(prm, MEAS_REP_MOD_REFUSE); -+ issue_null_reply(prm); -+ rm_state_goto(prm, RM_ST_END); -+ break; -+ case RM_EV_retry_timer_expire: -+ /* expired due to meas condition mismatch, meas again */ -+ _rm_post_event(padapter, prm->rmid, RM_EV_start_meas); -+ break; -+ case RM_EV_cancel: -+ rm_set_rep_mode(prm, MEAS_REP_MOD_REFUSE); -+ issue_null_reply(prm); -+ rm_state_goto(prm, RM_ST_END); -+ break; -+ case RM_EV_state_out: -+ rm_cancel_clock(prm); -+ /* resotre measurement end time */ -+ prm->meas_end_time = rtw_hal_get_tsftr_by_port(padapter -+ , rtw_hal_get_port(padapter)); -+ -+ val8 = 0; /* Disable free run counter */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_FREECNT, &val8); -+ break; -+ default: -+ break; -+ } -+ -+ return _SUCCESS; -+} -+ -+static int rm_state_wait_meas(struct rm_obj *prm, enum RM_EV_ID evid) -+{ -+ u8 val8; -+ u64 val64; -+ -+ -+ switch (evid) { -+ case RM_EV_state_in: -+ /* we create meas_req, waiting for peer report */ -+ rm_set_clock(prm, RM_REQ_TIMEOUT, -+ RM_EV_request_timer_expire); -+ break; -+ case RM_EV_recv_rep: -+ rm_state_goto(prm, RM_ST_RECV_REPORT); -+ break; -+ case RM_EV_request_timer_expire: -+ case RM_EV_cancel: -+ rm_state_goto(prm, RM_ST_END); -+ break; -+ case RM_EV_state_out: -+ rm_cancel_clock(prm); -+ break; -+ default: -+ break; -+ } -+ return _SUCCESS; -+} -+ -+static int rm_state_send_report(struct rm_obj *prm, enum RM_EV_ID evid) -+{ -+ u8 val8; -+ -+ -+ switch (evid) { -+ case RM_EV_state_in: -+ /* we have to issue report */ -+ if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) { -+ switch (prm->q.m_type) { -+ case bcn_req: -+ issue_beacon_rep(prm); -+ break; -+ case ch_load_req: -+ case noise_histo_req: -+ issue_radio_meas_rep(prm); -+ break; -+ default: -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ } -+ -+ } else if (prm->q.action_code == RM_ACT_LINK_MEAS_REQ) { -+ issue_link_meas_rep(prm); -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ -+ } else { -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ } -+ -+ /* check repeat */ -+ if (prm->p.rpt) { -+ RTW_INFO("RM: rmid=%x repeat=%u/%u\n", -+ prm->rmid, prm->p.rpt, -+ prm->q.rpt); -+ prm->p.rpt--; -+ /* -+ * we recv meas_req, -+ * delay for a wihile and than meas again -+ */ -+ if (prm->poll_mode) -+ rm_set_clock(prm, RM_REPT_POLL_INTVL, -+ RM_EV_repeat_delay_expire); -+ else -+ rm_set_clock(prm, RM_REPT_SCAN_INTVL, -+ RM_EV_repeat_delay_expire); -+ return _SUCCESS; -+ } -+ /* we are done */ -+ rm_state_goto(prm, RM_ST_END); -+ break; -+ case RM_EV_repeat_delay_expire: -+ rm_state_goto(prm, RM_ST_DO_MEAS); -+ break; -+ case RM_EV_cancel: -+ rm_state_goto(prm, RM_ST_END); -+ break; -+ case RM_EV_state_out: -+ rm_cancel_clock(prm); -+ break; -+ default: -+ break; -+ } -+ return _SUCCESS; -+} -+ -+static int rm_state_recv_report(struct rm_obj *prm, enum RM_EV_ID evid) -+{ -+ u8 val8; -+ -+ -+ switch (evid) { -+ case RM_EV_state_in: -+ /* we issue meas_req, got peer's meas report */ -+ switch (prm->p.action_code) { -+ case RM_ACT_RADIO_MEAS_REP: -+ /* check refuse, incapable and repeat */ -+ val8 = prm->p.m_mode; -+ if (val8) { -+ RTW_INFO("RM: rmid=%x peer reject (%s repeat=%d)\n", -+ prm->rmid, -+ val8|MEAS_REP_MOD_INCAP?"INCAP": -+ val8|MEAS_REP_MOD_REFUSE?"REFUSE": -+ val8|MEAS_REP_MOD_LATE?"LATE":"", -+ prm->p.rpt); -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ } -+ break; -+ case RM_ACT_NB_REP_RESP: -+ /* report to upper layer if needing */ -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ default: -+ rm_state_goto(prm, RM_ST_END); -+ return _SUCCESS; -+ } -+ /* check repeat */ -+ if (prm->p.rpt) { -+ RTW_INFO("RM: rmid=%x repeat=%u/%u\n", -+ prm->rmid, prm->p.rpt, -+ prm->q.rpt); -+ prm->p.rpt--; -+ /* waitting more report */ -+ rm_state_goto(prm, RM_ST_WAIT_MEAS); -+ break; -+ } -+ /* we are done */ -+ rm_state_goto(prm, RM_ST_END); -+ break; -+ case RM_EV_cancel: -+ rm_state_goto(prm, RM_ST_END); -+ break; -+ case RM_EV_state_out: -+ rm_cancel_clock(prm); -+ break; -+ default: -+ break; -+ } -+ return _SUCCESS; -+} -+ -+static int rm_state_end(struct rm_obj *prm, enum RM_EV_ID evid) -+{ -+ switch (evid) { -+ case RM_EV_state_in: -+ _rm_post_event(prm->psta->padapter, prm->rmid, RM_EV_state_out); -+ break; -+ -+ case RM_EV_cancel: -+ case RM_EV_state_out: -+ default: -+ rm_free_rmobj(prm); -+ break; -+ } -+ return _SUCCESS; -+} -+ -+struct fsm_state rm_fsm[] = { -+ {"RM_ST_IDLE", rm_state_idle}, -+ {"RM_ST_DO_MEAS", rm_state_do_meas}, -+ {"RM_ST_WAIT_MEAS", rm_state_wait_meas}, -+ {"RM_ST_SEND_REPORT", rm_state_send_report}, -+ {"RM_ST_RECV_REPORT", rm_state_recv_report}, -+ {"RM_ST_END", rm_state_end} -+}; -+ -+char *rm_state_name(enum RM_STATE state) -+{ -+ return rm_fsm[state].name; -+} -+ -+char *rm_event_name(enum RM_EV_ID evid) -+{ -+ switch(evid) { -+ case RM_EV_state_in: -+ return "RM_EV_state_in"; -+ case RM_EV_busy_timer_expire: -+ return "RM_EV_busy_timer_expire"; -+ case RM_EV_delay_timer_expire: -+ return "RM_EV_delay_timer_expire"; -+ case RM_EV_meas_timer_expire: -+ return "RM_EV_meas_timer_expire"; -+ case RM_EV_repeat_delay_expire: -+ return "RM_EV_repeat_delay_expire"; -+ case RM_EV_retry_timer_expire: -+ return "RM_EV_retry_timer_expire"; -+ case RM_EV_request_timer_expire: -+ return "RM_EV_request_timer_expire"; -+ case RM_EV_wait_report: -+ return "RM_EV_wait_report"; -+ case RM_EV_start_meas: -+ return "RM_EV_start_meas"; -+ case RM_EV_survey_done: -+ return "RM_EV_survey_done"; -+ case RM_EV_recv_rep: -+ return "RM_EV_recv_report"; -+ case RM_EV_cancel: -+ return "RM_EV_cancel"; -+ case RM_EV_state_out: -+ return "RM_EV_state_out"; -+ case RM_EV_max: -+ return "RM_EV_max"; -+ default: -+ return "RM_EV_unknown"; -+ } -+ return "UNKNOWN"; -+} -+ -+static void rm_state_initial(struct rm_obj *prm) -+{ -+ prm->state = RM_ST_IDLE; -+ -+ RTW_INFO("\n"); -+ RTW_INFO("RM: rmid=%x %-18s -> %s\n",prm->rmid, -+ "new measurement", rm_fsm[prm->state].name); -+ -+ rm_post_event(prm->psta->padapter, prm->rmid, RM_EV_state_in); -+} -+ -+static void rm_state_run(struct rm_obj *prm, enum RM_EV_ID evid) -+{ -+ RTW_INFO("RM: rmid=%x %-18s %s\n",prm->rmid, -+ rm_fsm[prm->state].name,rm_event_name(evid)); -+ -+ rm_fsm[prm->state].fsm_func(prm, evid); -+} -+ -+static void rm_state_goto(struct rm_obj *prm, enum RM_STATE rm_state) -+{ -+ if (prm->state == rm_state) -+ return; -+ -+ rm_state_run(prm, RM_EV_state_out); -+ -+ RTW_INFO("\n"); -+ RTW_INFO("RM: rmid=%x %-18s -> %s\n",prm->rmid, -+ rm_fsm[prm->state].name, rm_fsm[rm_state].name); -+ -+ prm->state = rm_state; -+ rm_state_run(prm, RM_EV_state_in); -+} -+#endif /* CONFIG_RTW_80211K */ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_rm_util.c b/drivers/net/wireless/rtl8821cs/core/rtw_rm_util.c -new file mode 100644 -index 000000000..1df0110c8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_rm_util.c -@@ -0,0 +1,477 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#ifdef CONFIG_RTW_80211K -+#include "rtw_rm_fsm.h" -+#include "rtw_rm_util.h" -+ -+/* 802.11-2012 Table E-1 Operationg classes in United States */ -+static RT_OPERATING_CLASS RTW_OP_CLASS_US[] = { -+ /* 0, OP_CLASS_NULL */ { 0, 0, {}}, -+ /* 1, OP_CLASS_1 */ {115, 4, {36, 40, 44, 48}}, -+ /* 2, OP_CLASS_2 */ {118, 4, {52, 56, 60, 64}}, -+ /* 3, OP_CLASS_3 */ {124, 4, {149, 153, 157, 161}}, -+ /* 4, OP_CLASS_4 */ {121, 11, {100, 104, 108, 112, 116, 120, 124, -+ 128, 132, 136, 140}}, -+ /* 5, OP_CLASS_5 */ {125, 5, {149, 153, 157, 161, 165}}, -+ /* 6, OP_CLASS_12 */ { 81, 11, {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}} -+}; -+ -+u8 rm_get_ch_set( -+ struct rtw_ieee80211_channel *pch_set, u8 op_class, u8 ch_num) -+{ -+ int i,j,sz; -+ u8 ch_amount = 0; -+ -+ -+ sz = sizeof(RTW_OP_CLASS_US)/sizeof(struct _RT_OPERATING_CLASS); -+ -+ if (ch_num != 0) { -+ pch_set[0].hw_value = ch_num; -+ ch_amount = 1; -+ RTW_INFO("RM: meas_ch->hw_value = %u\n", pch_set->hw_value); -+ goto done; -+ } -+ -+ for (i = 0; i < sz; i++) { -+ -+ if (RTW_OP_CLASS_US[i].global_op_class == op_class) { -+ -+ for (j = 0; j < RTW_OP_CLASS_US[i].Len; j++) { -+ pch_set[j].hw_value = -+ RTW_OP_CLASS_US[i].Channel[j]; -+ RTW_INFO("RM: meas_ch[%d].hw_value = %u\n", -+ j, pch_set[j].hw_value); -+ } -+ ch_amount = RTW_OP_CLASS_US[i].Len; -+ break; -+ } -+ } -+done: -+ return ch_amount; -+} -+ -+u8 rm_get_ch_set_from_bcn_req_opt( -+ struct rtw_ieee80211_channel *pch_set, struct bcn_req_opt *opt) -+{ -+ int i,j,k,sz; -+ struct _RT_OPERATING_CLASS *ap_ch_rpt; -+ u8 ch_amount = 0; -+ -+ k = 0; -+ for (i = 0; i < opt->ap_ch_rpt_num; i++) { -+ if (opt->ap_ch_rpt[i] == NULL) -+ break; -+ ap_ch_rpt = opt->ap_ch_rpt[i]; -+ for (j = 0; j < ap_ch_rpt->Len; j++) { -+ pch_set[k].hw_value = -+ ap_ch_rpt->Channel[j]; -+ RTW_INFO("RM: meas_ch[%d].hw_value = %u\n", -+ j, pch_set[k].hw_value); -+ k++; -+ } -+ } -+ return k; -+} -+ -+u8 rm_get_oper_class_via_ch(u8 ch) -+{ -+ int i,j,sz; -+ -+ -+ sz = sizeof(RTW_OP_CLASS_US)/sizeof(struct _RT_OPERATING_CLASS); -+ -+ for (i = 0; i < sz; i++) { -+ for (j = 0; j < RTW_OP_CLASS_US[i].Len; j++) { -+ if ( ch == RTW_OP_CLASS_US[i].Channel[j]) { -+ RTW_INFO("RM: ch %u in oper_calss %u\n", -+ ch, RTW_OP_CLASS_US[i].global_op_class); -+ return RTW_OP_CLASS_US[i].global_op_class; -+ break; -+ } -+ } -+ } -+ return 0; -+} -+ -+int is_wildcard_bssid(u8 *bssid) -+{ -+ int i; -+ u8 val8 = 0xff; -+ -+ -+ for (i=0;i<6;i++) -+ val8 &= bssid[i]; -+ -+ if (val8 == 0xff) -+ return _SUCCESS; -+ return _FALSE; -+} -+ -+u8 translate_dbm_to_rcpi(s8 SignalPower) -+{ -+ /* RCPI = Int{(Power in dBm + 110)*2} for 0dBm > Power > -110dBm -+ * 0 : power <= -110.0 dBm -+ * 1 : power = -109.5 dBm -+ * 2 : power = -109.0 dBm -+ */ -+ return (SignalPower + 110)*2; -+} -+ -+u8 translate_percentage_to_rcpi(u32 SignalStrengthIndex) -+{ -+ /* Translate to dBm (x=y-100) */ -+ return translate_dbm_to_rcpi(SignalStrengthIndex - 100); -+} -+ -+u8 rm_get_bcn_rcpi(struct rm_obj *prm, struct wlan_network *pnetwork) -+{ -+ return translate_percentage_to_rcpi( -+ pnetwork->network.PhyInfo.SignalStrength); -+} -+ -+u8 rm_get_frame_rsni(struct rm_obj *prm, union recv_frame *pframe) -+{ -+ s8 pwr; -+ u8 ch; -+ -+ pwr = pframe->u.hdr.attrib.phy_info.recv_signal_power; -+ ch = pframe->u.hdr.attrib.phy_info.channel; -+ -+ return rtw_acs_get_rsni(prm->psta->padapter, pwr, ch); -+} -+ -+u8 rm_get_bcn_rsni(struct rm_obj *prm, struct wlan_network *pnetwork) -+{ -+ s8 pwr; -+ u8 ch; -+ -+ pwr = (u8)pnetwork->network.Rssi; -+ ch = pnetwork->network.Configuration.DSConfig; -+ -+ return rtw_acs_get_rsni(prm->psta->padapter, pwr, ch); -+} -+ -+/* output: pwr (unit dBm) */ -+int rm_get_tx_power(PADAPTER adapter, enum rf_path path, enum MGN_RATE rate, s8 *pwr) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int tx_num, band, bw, ch, n, rs; -+ u8 base; -+ s8 limt_offset = 127; /* max value of s8 */ -+ s8 rate_offset; -+ s8 powr_offset; -+ int rate_pos; -+ -+ -+ band = hal_data->current_band_type; -+ bw = hal_data->current_channel_bw; -+ ch = hal_data->current_channel; -+ -+ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) -+ return -1; -+ -+ if (HAL_IsLegalChannel(adapter, ch) == _FALSE) { -+ RTW_INFO("Illegal channel!!\n"); -+ return -2; -+ } -+ -+ *pwr = phy_get_tx_power_final_absolute_value(adapter, path, rate, bw, ch); -+ -+ return 0; -+} -+ -+int rm_get_rx_sensitivity(PADAPTER adapter, enum channel_width bw, enum MGN_RATE rate, s8 *pwr) -+{ -+ s8 rx_sensitivity = -110; -+ -+ switch(rate) { -+ case MGN_1M: -+ rx_sensitivity= -101; -+ break; -+ case MGN_2M: -+ rx_sensitivity= -98; -+ break; -+ case MGN_5_5M: -+ rx_sensitivity= -92; -+ break; -+ case MGN_11M: -+ rx_sensitivity= -89; -+ break; -+ case MGN_6M: -+ case MGN_9M: -+ case MGN_12M: -+ rx_sensitivity = -92; -+ break; -+ case MGN_18M: -+ rx_sensitivity = -90; -+ break; -+ case MGN_24M: -+ rx_sensitivity = -88; -+ break; -+ case MGN_36M: -+ rx_sensitivity = -84; -+ break; -+ case MGN_48M: -+ rx_sensitivity = -79; -+ break; -+ case MGN_54M: -+ rx_sensitivity = -78; -+ break; -+ -+ case MGN_MCS0: -+ case MGN_MCS8: -+ case MGN_MCS16: -+ case MGN_MCS24: -+ case MGN_VHT1SS_MCS0: -+ case MGN_VHT2SS_MCS0: -+ case MGN_VHT3SS_MCS0: -+ case MGN_VHT4SS_MCS0: -+ /* BW20 BPSK 1/2 */ -+ rx_sensitivity = -82; -+ break; -+ -+ case MGN_MCS1: -+ case MGN_MCS9: -+ case MGN_MCS17: -+ case MGN_MCS25: -+ case MGN_VHT1SS_MCS1: -+ case MGN_VHT2SS_MCS1: -+ case MGN_VHT3SS_MCS1: -+ case MGN_VHT4SS_MCS1: -+ /* BW20 QPSK 1/2 */ -+ rx_sensitivity = -79; -+ break; -+ -+ case MGN_MCS2: -+ case MGN_MCS10: -+ case MGN_MCS18: -+ case MGN_MCS26: -+ case MGN_VHT1SS_MCS2: -+ case MGN_VHT2SS_MCS2: -+ case MGN_VHT3SS_MCS2: -+ case MGN_VHT4SS_MCS2: -+ /* BW20 QPSK 3/4 */ -+ rx_sensitivity = -77; -+ break; -+ -+ case MGN_MCS3: -+ case MGN_MCS11: -+ case MGN_MCS19: -+ case MGN_MCS27: -+ case MGN_VHT1SS_MCS3: -+ case MGN_VHT2SS_MCS3: -+ case MGN_VHT3SS_MCS3: -+ case MGN_VHT4SS_MCS3: -+ /* BW20 16-QAM 1/2 */ -+ rx_sensitivity = -74; -+ break; -+ -+ case MGN_MCS4: -+ case MGN_MCS12: -+ case MGN_MCS20: -+ case MGN_MCS28: -+ case MGN_VHT1SS_MCS4: -+ case MGN_VHT2SS_MCS4: -+ case MGN_VHT3SS_MCS4: -+ case MGN_VHT4SS_MCS4: -+ /* BW20 16-QAM 3/4 */ -+ rx_sensitivity = -70; -+ break; -+ -+ case MGN_MCS5: -+ case MGN_MCS13: -+ case MGN_MCS21: -+ case MGN_MCS29: -+ case MGN_VHT1SS_MCS5: -+ case MGN_VHT2SS_MCS5: -+ case MGN_VHT3SS_MCS5: -+ case MGN_VHT4SS_MCS5: -+ /* BW20 64-QAM 2/3 */ -+ rx_sensitivity = -66; -+ break; -+ -+ case MGN_MCS6: -+ case MGN_MCS14: -+ case MGN_MCS22: -+ case MGN_MCS30: -+ case MGN_VHT1SS_MCS6: -+ case MGN_VHT2SS_MCS6: -+ case MGN_VHT3SS_MCS6: -+ case MGN_VHT4SS_MCS6: -+ /* BW20 64-QAM 3/4 */ -+ rx_sensitivity = -65; -+ break; -+ -+ case MGN_MCS7: -+ case MGN_MCS15: -+ case MGN_MCS23: -+ case MGN_MCS31: -+ case MGN_VHT1SS_MCS7: -+ case MGN_VHT2SS_MCS7: -+ case MGN_VHT3SS_MCS7: -+ case MGN_VHT4SS_MCS7: -+ /* BW20 64-QAM 5/6 */ -+ rx_sensitivity = -64; -+ break; -+ -+ case MGN_VHT1SS_MCS8: -+ case MGN_VHT2SS_MCS8: -+ case MGN_VHT3SS_MCS8: -+ case MGN_VHT4SS_MCS8: -+ /* BW20 256-QAM 3/4 */ -+ rx_sensitivity = -59; -+ break; -+ -+ case MGN_VHT1SS_MCS9: -+ case MGN_VHT2SS_MCS9: -+ case MGN_VHT3SS_MCS9: -+ case MGN_VHT4SS_MCS9: -+ /* BW20 256-QAM 5/6 */ -+ rx_sensitivity = -57; -+ break; -+ -+ default: -+ return -1; -+ break; -+ -+ } -+ -+ switch(bw) { -+ case CHANNEL_WIDTH_20: -+ break; -+ case CHANNEL_WIDTH_40: -+ rx_sensitivity -= 3; -+ break; -+ case CHANNEL_WIDTH_80: -+ rx_sensitivity -= 6; -+ break; -+ case CHANNEL_WIDTH_160: -+ rx_sensitivity -= 9; -+ break; -+ case CHANNEL_WIDTH_5: -+ case CHANNEL_WIDTH_10: -+ case CHANNEL_WIDTH_80_80: -+ default: -+ return -1; -+ break; -+ } -+ *pwr = rx_sensitivity; -+ -+ return 0; -+} -+ -+/* output: path_a max tx power in dBm */ -+int rm_get_path_a_max_tx_power(_adapter *adapter, s8 *path_a) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int path, tx_num, band, bw, ch, n, rs; -+ u8 rate_num; -+ s8 max_pwr[RF_PATH_MAX], pwr; -+ -+ -+ band = hal_data->current_band_type; -+ bw = hal_data->current_channel_bw; -+ ch = hal_data->current_channel; -+ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) -+ break; -+ -+ max_pwr[path] = -127; /* min value of s8 */ -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: [%s][%c]\n", band_str(band), rf_path_char(path)); -+#endif -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ tx_num = rate_section_to_tx_num(rs); -+ -+ if (tx_num >= hal_spec->tx_nss_num) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ continue; -+ -+ rate_num = rate_section_rate_num(rs); -+ -+ /* get power by rate in db */ -+ for (n = rate_num - 1; n >= 0; n--) { -+ pwr = phy_get_tx_power_final_absolute_value(adapter, path, rates_by_sections[rs].rates[n], bw, ch); -+ max_pwr[path] = MAX(max_pwr[path], pwr); -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: %9s = %2d\n", -+ MGN_RATE_STR(rates_by_sections[rs].rates[n]), pwr); -+#endif -+ } -+ } -+ } -+#if (RM_MORE_DBG_MSG) -+ RTW_INFO("RM: path_a max_pwr=%ddBm\n", max_pwr[0]); -+#endif -+ *path_a = max_pwr[0]; -+ return 0; -+} -+ -+u8 rm_gen_dialog_token(_adapter *padapter) -+{ -+ struct rm_priv *prmpriv = &(padapter->rmpriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ do { -+ pmlmeinfo->dialogToken++; -+ } while (pmlmeinfo->dialogToken == 0); -+ -+ return pmlmeinfo->dialogToken; -+} -+ -+u8 rm_gen_meas_token(_adapter *padapter) -+{ -+ struct rm_priv *prmpriv = &(padapter->rmpriv); -+ -+ do { -+ prmpriv->meas_token++; -+ } while (prmpriv->meas_token == 0); -+ -+ return prmpriv->meas_token; -+} -+ -+u32 rm_gen_rmid(_adapter *padapter, struct rm_obj *prm, u8 role) -+{ -+ u32 rmid; -+ -+ if (prm->psta == NULL) -+ goto err; -+ -+ if (prm->q.diag_token == 0) -+ goto err; -+ -+ rmid = prm->psta->cmn.aid << 16 -+ | prm->q.diag_token << 8 -+ | role; -+ -+ return rmid; -+err: -+ RTW_ERR("RM: unable to gen rmid\n"); -+ return 0; -+} -+ -+#endif /* CONFIG_RTW_80211K */ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_roch.c b/drivers/net/wireless/rtl8821cs/core/rtw_roch.c -new file mode 100644 -index 000000000..4be863192 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_roch.c -@@ -0,0 +1,591 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2020 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+u8 rtw_roch_stay_in_cur_chan(_adapter *padapter) -+{ -+ int i; -+ _adapter *iface; -+ struct mlme_priv *pmlmepriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ u8 rst = _FALSE; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) { -+ pmlmepriv = &iface->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS | WIFI_UNDER_KEY_HANDSHAKE) == _TRUE) { -+ RTW_INFO(ADPT_FMT"- WIFI_UNDER_LINKING |WIFI_UNDER_WPS | WIFI_UNDER_KEY_HANDSHAKE (mlme state:0x%x)\n", -+ ADPT_ARG(iface), get_fwstate(&iface->mlmepriv)); -+ rst = _TRUE; -+ break; -+ } -+ #ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(iface) || MLME_IS_MESH(iface)) { -+ if (rtw_ap_sta_states_check(iface) == _TRUE) { -+ rst = _TRUE; -+ break; -+ } -+ } -+ #endif -+ } -+ } -+ -+ return rst; -+} -+ -+static int rtw_ro_ch_handler(_adapter *adapter, u8 *buf) -+{ -+ int ret = H2C_SUCCESS; -+ struct rtw_roch_parm *roch_parm = (struct rtw_roch_parm *)buf; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+ struct roch_info *prochinfo = &adapter->rochinfo; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+#endif -+ u8 ready_on_channel = _FALSE; -+ u8 remain_ch; -+ unsigned int duration; -+ -+ _enter_critical_mutex(&pwdev_priv->roch_mutex, NULL); -+ -+ if (rtw_cfg80211_get_is_roch(adapter) != _TRUE) -+ goto exit; -+ -+ remain_ch = (u8)ieee80211_frequency_to_channel(roch_parm->ch.center_freq); -+ duration = roch_parm->duration; -+ -+ RTW_INFO(FUNC_ADPT_FMT" ch:%u duration:%d, cookie:0x%llx\n" -+ , FUNC_ADPT_ARG(adapter), remain_ch, roch_parm->duration, roch_parm->cookie); -+ -+ if (roch_parm->wdev && roch_parm->cookie) { -+ if (prochinfo->ro_ch_wdev != roch_parm->wdev) { -+ RTW_WARN(FUNC_ADPT_FMT" ongoing wdev:%p, wdev:%p\n" -+ , FUNC_ADPT_ARG(adapter), prochinfo->ro_ch_wdev, roch_parm->wdev); -+ rtw_warn_on(1); -+ } -+ -+ if (prochinfo->remain_on_ch_cookie != roch_parm->cookie) { -+ RTW_WARN(FUNC_ADPT_FMT" ongoing cookie:0x%llx, cookie:0x%llx\n" -+ , FUNC_ADPT_ARG(adapter), prochinfo->remain_on_ch_cookie, roch_parm->cookie); -+ rtw_warn_on(1); -+ } -+ } -+ -+ if (rtw_roch_stay_in_cur_chan(adapter) == _TRUE) { -+ remain_ch = rtw_mi_get_union_chan(adapter); -+ RTW_INFO(FUNC_ADPT_FMT" stay in union ch:%d\n", FUNC_ADPT_ARG(adapter), remain_ch); -+ } -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(adapter, MI_LINKED) && (0 != rtw_mi_get_union_chan(adapter))) { -+ if ((remain_ch != rtw_mi_get_union_chan(adapter)) && !check_fwstate(&adapter->mlmepriv, WIFI_ASOC_STATE)) { -+ if (remain_ch != pmlmeext->cur_channel -+ #ifdef RTW_ROCH_BACK_OP -+ || ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1 -+ #endif -+ ) { -+ rtw_leave_opch(adapter); -+ -+ #ifdef RTW_ROCH_BACK_OP -+ RTW_INFO("%s, set switch ch timer, duration=%d\n", __func__, prochinfo->max_away_dur); -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); -+ /* remain_ch is not same as union channel. duration is max_away_dur to -+ * back to AP's channel. -+ */ -+ _set_timer(&prochinfo->ap_roch_ch_switch_timer, prochinfo->max_away_dur); -+ #endif -+ } -+ } -+ ready_on_channel = _TRUE; -+ } else -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ if (remain_ch != rtw_get_oper_ch(adapter)) -+ ready_on_channel = _TRUE; -+ } -+ -+ if (ready_on_channel == _TRUE) { -+ #ifndef RTW_SINGLE_WIPHY -+ if (!check_fwstate(&adapter->mlmepriv, WIFI_ASOC_STATE)) -+ #endif -+ { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_get_oper_ch(adapter) != remain_ch) -+ #endif -+ { -+ /* if (!padapter->mlmepriv.LinkDetectInfo.bBusyTraffic) */ -+ set_channel_bwmode(adapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ } -+ } -+ -+ #ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_ScanNotify(adapter, _TRUE); -+ #endif -+ -+ RTW_INFO("%s, set ro ch timer, duration=%d\n", __func__, duration); -+ _set_timer(&prochinfo->remain_on_ch_timer, duration); -+ -+exit: -+ _exit_critical_mutex(&pwdev_priv->roch_mutex, NULL); -+ -+ return ret; -+} -+ -+static int rtw_cancel_ro_ch_handler(_adapter *padapter, u8 *buf) -+{ -+ int ret = H2C_SUCCESS; -+ struct rtw_roch_parm *roch_parm = (struct rtw_roch_parm *)buf; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ struct roch_info *prochinfo = &padapter->rochinfo; -+ struct wireless_dev *wdev; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif -+ 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 (prochinfo->ro_ch_wdev != roch_parm->wdev) { -+ RTW_WARN(FUNC_ADPT_FMT" ongoing wdev:%p, wdev:%p\n" -+ , FUNC_ADPT_ARG(padapter), prochinfo->ro_ch_wdev, roch_parm->wdev); -+ rtw_warn_on(1); -+ } -+ -+ if (prochinfo->remain_on_ch_cookie != roch_parm->cookie) { -+ RTW_WARN(FUNC_ADPT_FMT" ongoing cookie:0x%llx, cookie:0x%llx\n" -+ , FUNC_ADPT_ARG(padapter), prochinfo->remain_on_ch_cookie, roch_parm->cookie); -+ rtw_warn_on(1); -+ } -+ } -+ -+#if defined(RTW_ROCH_BACK_OP) && defined(CONFIG_CONCURRENT_MODE) -+ _cancel_timer_ex(&prochinfo->ap_roch_ch_switch_timer); -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); -+#endif -+ -+ 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); -+#ifdef CONFIG_P2P -+ } 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); -+#endif -+ } else { -+ ch = prochinfo->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_back_opch(padapter); -+#ifdef CONFIG_P2P -+ 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 -+#endif -+ -+ wdev = prochinfo->ro_ch_wdev; -+ -+ rtw_cfg80211_set_is_roch(padapter, _FALSE); -+ prochinfo->ro_ch_wdev = NULL; -+ rtw_cfg80211_set_last_ro_ch_time(padapter); -+ -+ rtw_cfg80211_remain_on_channel_expired(wdev -+ , prochinfo->remain_on_ch_cookie -+ , &prochinfo->remain_on_ch_channel -+ , prochinfo->remain_on_ch_type, GFP_KERNEL); -+ -+ RTW_INFO("cfg80211_remain_on_channel_expired cookie:0x%llx\n" -+ , prochinfo->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 rtw_ro_ch_timer_process(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ rtw_cancel_roch_cmd(adapter, 0, NULL, 0); -+} -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+#if (defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE)) || defined(CONFIG_IOCTL_CFG80211) -+s32 rtw_roch_wk_hdl(_adapter *padapter, int intCmdType, u8 *buf) -+{ -+ int ret = H2C_SUCCESS; -+ -+ switch (intCmdType) { -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ case ROCH_RO_CH_WK: -+ ret = rtw_ro_ch_handler(padapter, buf); -+ break; -+ case ROCH_CANCEL_RO_CH_WK: -+ ret = rtw_cancel_ro_ch_handler(padapter, buf); -+ break; -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ case ROCH_AP_ROCH_CH_SWITCH_PROCESS_WK: -+ rtw_concurrent_handler(padapter); -+ break; -+#endif -+ -+ default: -+ rtw_warn_on(1); -+ break; -+ } -+ -+ return ret; -+} -+ -+static int get_roch_parm_size(struct rtw_roch_parm *roch_parm) -+{ -+#ifdef CONFIG_IOCTL_CFG80211 -+ return (roch_parm ? sizeof(*roch_parm) : 0); -+#else -+ rtw_warn_on(roch_parm); -+ return 0; -+#endif -+} -+ -+u8 rtw_roch_wk_cmd(_adapter *padapter, int intCmdType, struct rtw_roch_parm *roch_parm, u8 flags) -+{ -+ struct cmd_obj *ph2c = NULL; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm = NULL; -+ 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 */ -+ if (H2C_SUCCESS != rtw_roch_wk_hdl(padapter, intCmdType, (u8 *)roch_parm)) -+ res = _FAIL; -+ goto free_parm; -+ } else { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (!ph2c) { -+ res = _FAIL; -+ goto free_parm; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (!pdrvextra_cmd_parm) { -+ res = _FAIL; -+ goto free_parm; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = ROCH_WK_CID; -+ pdrvextra_cmd_parm->type = intCmdType; -+ pdrvextra_cmd_parm->size = get_roch_parm_size(roch_parm); -+ pdrvextra_cmd_parm->pbuf = (u8 *)roch_parm; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, CMD_SET_DRV_EXTRA); -+ -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ ph2c->sctx = &sctx; -+ rtw_sctx_init(&sctx, 10 * 1000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ 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) -+ ph2c->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ if (sctx.status != RTW_SCTX_DONE_SUCCESS) -+ res = _FAIL; -+ } -+ } -+ -+ return res; -+ -+free_parm: -+ if (roch_parm) -+ rtw_mfree((u8 *)roch_parm, get_roch_parm_size(roch_parm)); -+ if (ph2c) -+ rtw_mfree((u8 *)ph2c, sizeof(*ph2c)); -+ -+ return res; -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+void rtw_ap_roch_ch_switch_timer_process(void *ctx) -+{ -+ _adapter *adapter = (_adapter *)ctx; -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); -+#endif -+ -+ rtw_roch_wk_cmd(adapter, ROCH_AP_ROCH_CH_SWITCH_PROCESS_WK, NULL, 0); -+} -+ -+static bool chk_need_stay_in_cur_chan(_adapter *padapter) -+{ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ -+ /* When CONFIG_FULL_CH_IN_P2P_HANDSHAKE is defined and the -+ * interface is in the P2P_STATE_GONEGO_OK state, do not let the -+ * interface switch to the listen channel, because the interface will -+ * switch to the OP channel after the GO negotiation is successful. -+ */ -+ if (padapter->registrypriv.full_ch_in_p2p_handshake == 1 && rtw_p2p_chk_state(pwdinfo , P2P_STATE_GONEGO_OK)) { -+ RTW_INFO("%s, No linked interface now, but go nego ok, do not back to listen channel\n", __func__); -+ return _TRUE; -+ } -+#endif -+ -+ return _FALSE; -+} -+ -+static bool chk_driver_interface(_adapter *padapter, u8 driver_interface) -+{ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ -+ if (pwdinfo->driver_interface == driver_interface) -+ return _TRUE; -+#elif defined(CONFIG_IOCTL_CFG80211) -+ if (driver_interface == DRIVER_CFG80211) -+ return _TRUE; -+#endif -+ -+ return _FALSE; -+} -+ -+static u8 get_remain_ch(_adapter *padapter) -+{ -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif -+ u8 remain_ch; -+ -+#ifdef CONFIG_P2P -+ remain_ch = pwdinfo->listen_channel; -+#elif defined(CONFIG_IOCTL_CFG80211) -+ if (chk_driver_interface(padapter, DRIVER_CFG80211)) -+ remain_ch = ieee80211_frequency_to_channel(prochinfo->remain_on_ch_channel.center_freq); -+ else -+ rtw_warn_on(1); -+#endif -+ -+ return remain_ch; -+} -+ -+void rtw_concurrent_handler(_adapter *padapter) -+{ -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+#endif -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ u8 val8; -+#endif -+ u8 remain_ch = get_remain_ch(padapter); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (chk_driver_interface(padapter, DRIVER_CFG80211) -+ && !rtw_cfg80211_get_is_roch(padapter)) -+ return; -+#endif -+ -+ 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); -+ unsigned int duration; -+ -+ #ifdef CONFIG_P2P -+ pwdinfo->operating_channel = union_ch; -+ #endif -+ -+ if (chk_driver_interface(padapter, DRIVER_CFG80211)) { -+ #ifdef CONFIG_IOCTL_CFG80211 -+ _enter_critical_mutex(&pwdev_priv->roch_mutex, NULL); -+ -+ if (rtw_get_oper_ch(padapter) != union_ch) { -+ /* Current channel is not AP's channel - switching to AP's channel */ -+ RTW_INFO("%s, switch ch back to union=%u,%u, %u\n" -+ , __func__, union_ch, union_bw, union_offset); -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ rtw_back_opch(padapter); -+ -+ /* Now, the driver stays on AP's channel. We should stay on AP's -+ * channel for min_home_dur (duration) and next switch channel is -+ * listen channel. -+ */ -+ duration = prochinfo->min_home_dur; -+ } else { -+ /* Current channel is AP's channel - switching to listen channel */ -+ RTW_INFO("%s, switch ch to roch=%u\n" -+ , __func__, remain_ch); -+ rtw_leave_opch(padapter); -+ set_channel_bwmode(padapter, -+ remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ -+ /* Now, the driver stays on listen channel. We should stay on listen -+ * channel for max_away_dur (duration) and next switch channel is AP's -+ * channel. -+ */ -+ duration = prochinfo->max_away_dur; -+ } -+ -+ /* set channel switch timer */ -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); -+ _set_timer(&prochinfo->ap_roch_ch_switch_timer, duration); -+ RTW_INFO("%s, set switch ch timer, duration=%d\n", __func__, duration); -+ -+ _exit_critical_mutex(&pwdev_priv->roch_mutex, NULL); -+ #endif -+ } -+ #ifdef CONFIG_P2P -+ else if (chk_driver_interface(padapter, 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) { -+ rtw_leave_opch(padapter); -+ 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(&prochinfo->ap_roch_ch_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_back_opch(padapter); -+ } -+ -+ /* Todo: To check the value of pwdinfo->ext_listen_interval is equal to 0 or not. */ -+ _set_timer(&prochinfo->ap_roch_ch_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_back_opch(padapter); -+ -+ } 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 ); -+ */ -+ } -+ } -+ #endif /* CONFIG_P2P */ -+ } else if (!chk_need_stay_in_cur_chan(padapter)) { -+ set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+} -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+void rtw_init_roch_info(_adapter *padapter) -+{ -+ struct roch_info *prochinfo = &padapter->rochinfo; -+ -+ _rtw_memset(prochinfo, 0x00, sizeof(struct roch_info)); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_init_timer(&prochinfo->ap_roch_ch_switch_timer, padapter, rtw_ap_roch_ch_switch_timer_process, padapter); -+#ifdef CONFIG_IOCTL_CFG80211 -+ prochinfo->min_home_dur = 1500; /* min duration for traffic, home_time */ -+ prochinfo->max_away_dur = 250; /* max acceptable away duration, home_away_time */ -+#endif -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_init_timer(&prochinfo->remain_on_ch_timer, padapter, rtw_ro_ch_timer_process, padapter); -+#endif -+} -+#endif /* (defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE)) || defined(CONFIG_IOCTL_CFG80211) */ -\ No newline at end of file -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_rson.c b/drivers/net/wireless/rtl8821cs/core/rtw_rson.c -new file mode 100644 -index 000000000..dba8fb73b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_rson.c -@@ -0,0 +1,592 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General 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_RSON_C_ -+ -+#include -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ -+/******** Custommize Part ***********************/ -+ -+unsigned char RTW_RSON_OUI[] = {0xFA, 0xFA, 0xFA}; -+#define RSON_SCORE_DIFF_TH 8 -+ -+/* -+ Calculate the corresponding score. -+*/ -+inline u8 rtw_cal_rson_score(struct rtw_rson_struct *cand_rson_data, NDIS_802_11_RSSI Rssi) -+{ -+ if ((cand_rson_data->hopcnt == RTW_RSON_HC_NOTREADY) -+ || (cand_rson_data->connectible == RTW_RSON_DENYCONNECT)) -+ return RTW_RSON_SCORE_NOTCNNT; -+ -+ return RTW_RSON_SCORE_MAX - (cand_rson_data->hopcnt * 10) + (Rssi/10); -+} -+ -+/*************************************************/ -+ -+ -+static u8 rtw_rson_block_bssid_idx = 0; -+u8 rtw_rson_block_bssid[10][6] = { -+ /*{0x02, 0xE0, 0x4C, 0x07, 0xC3, 0xF6}*/ -+}; -+ -+/* fake root, regard a real AP as a SO root */ -+static u8 rtw_rson_root_bssid_idx = 0; -+u8 rtw_rson_root_bssid[10][6] = { -+ /*{0x1c, 0x5f, 0x2b, 0x5a, 0x60, 0x24}*/ -+}; -+ -+int is_match_bssid(u8 *mac, u8 bssid_array[][6], int num) -+{ -+ int i; -+ -+ for (i = 0; i < num; i++) -+ if (_rtw_memcmp(mac, bssid_array[i], 6) == _TRUE) -+ return _TRUE; -+ return _FALSE; -+} -+ -+void init_rtw_rson_data(struct dvobj_priv *dvobj) -+{ -+ /*Aries todo. if pdvobj->rson_data.ver == 1 */ -+ dvobj->rson_data.ver = RTW_RSON_VER; -+ dvobj->rson_data.id = CONFIG_RTW_REPEATER_SON_ID; -+#ifdef CONFIG_RTW_REPEATER_SON_ROOT -+ dvobj->rson_data.hopcnt = RTW_RSON_HC_ROOT; -+ dvobj->rson_data.connectible = RTW_RSON_ALLOWCONNECT; -+#else -+ dvobj->rson_data.hopcnt = RTW_RSON_HC_NOTREADY; -+ dvobj->rson_data.connectible = RTW_RSON_DENYCONNECT; -+#endif -+ dvobj->rson_data.loading = 0; -+ _rtw_memset(dvobj->rson_data.res, 0xAA, sizeof(dvobj->rson_data.res)); -+} -+ -+void rtw_rson_get_property_str(_adapter *padapter, char *rson_data_str) -+{ -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ -+ sprintf(rson_data_str, "version : \t%d\nid : \t\t%08x\nhop count : \t%d\nconnectible : \t%s\nloading : \t%d\nreserve : \t%16ph\n", -+ pdvobj->rson_data.ver, -+ pdvobj->rson_data.id, -+ pdvobj->rson_data.hopcnt, -+ pdvobj->rson_data.connectible ? "connectable":"unconnectable", -+ pdvobj->rson_data.loading, -+ pdvobj->rson_data.res); -+} -+ -+int str2hexbuf(char *str, u8 *hexbuf, int len) -+{ -+ u8 *p; -+ int i, slen, idx = 0; -+ -+ p = (unsigned char *)str; -+ if ((*p != '0') || (*(p+1) != 'x')) -+ return _FALSE; -+ slen = strlen(str); -+ if (slen > (len*2) + 2) -+ return _FALSE; -+ p += 2; -+ for (i = 0 ; i < len; i++, idx = idx+2) { -+ hexbuf[i] = key_2char2num(p[idx], p[idx + 1]); -+ if (slen <= idx+2) -+ break; -+ } -+ return _TRUE; -+} -+ -+int rtw_rson_set_property(_adapter *padapter, char *field, char *value) -+{ -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ int num = 0; -+ -+ if (_rtw_memcmp(field, (u8 *)"ver", 3) == _TRUE) -+ pdvobj->rson_data.ver = rtw_atoi(value); -+ else if (_rtw_memcmp(field, (u8 *)"id", 2) == _TRUE) -+ num = sscanf(value, "%08x", &(pdvobj->rson_data.id)); -+ else if (_rtw_memcmp(field, (u8 *)"hc", 2) == _TRUE) -+ num = sscanf(value, "%hhu", &(pdvobj->rson_data.hopcnt)); -+ else if (_rtw_memcmp(field, (u8 *)"cnt", 3) == _TRUE) -+ num = sscanf(value, "%hhu", &(pdvobj->rson_data.connectible)); -+ else if (_rtw_memcmp(field, (u8 *)"loading", 2) == _TRUE) -+ num = sscanf(value, "%hhu", &(pdvobj->rson_data.loading)); -+ else if (_rtw_memcmp(field, (u8 *)"res", 2) == _TRUE) { -+ str2hexbuf(value, pdvobj->rson_data.res, 16); -+ return 1; -+ } else -+ return _FALSE; -+ return num; -+} -+ -+/* -+ return : TRUE -- competitor is taking advantage than condidate -+ FALSE -- we should continue keeping candidate -+*/ -+int rtw_rson_choose(struct wlan_network **candidate, struct wlan_network *competitor) -+{ -+ s16 comp_score = 0, cand_score = 0; -+ struct rtw_rson_struct rson_cand, rson_comp; -+ -+ if (is_match_bssid(competitor->network.MacAddress, rtw_rson_block_bssid, rtw_rson_block_bssid_idx) == _TRUE) -+ return _FALSE; -+ -+ if ((competitor == NULL) -+ || (rtw_get_rson_struct(&(competitor->network), &rson_comp) != _TRUE) -+ || (rson_comp.id != CONFIG_RTW_REPEATER_SON_ID)) -+ return _FALSE; -+ -+ comp_score = rtw_cal_rson_score(&rson_comp, competitor->network.Rssi); -+ if (comp_score == RTW_RSON_SCORE_NOTCNNT) -+ return _FALSE; -+ -+ if (*candidate == NULL) -+ return _TRUE; -+ if (rtw_get_rson_struct(&((*candidate)->network), &rson_cand) != _TRUE) -+ return _FALSE; -+ -+ cand_score = rtw_cal_rson_score(&rson_cand, (*candidate)->network.Rssi); -+ RTW_INFO("%s: competitor_score=%d, candidate_score=%d\n", __func__, comp_score, cand_score); -+ if (comp_score - cand_score > RSON_SCORE_DIFF_TH) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+inline u8 rtw_rson_varify_ie(u8 *p) -+{ -+ u8 *ptr = NULL; -+ u8 ver; -+ u32 id; -+ u8 hopcnt; -+ u8 allcnnt; -+ -+ ptr = p + 2 + sizeof(RTW_RSON_OUI); -+ ver = *ptr; -+ -+ /* for (ver == 1) */ -+ if (ver != 1) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+/* -+ Parsing RTK self-organization vendor IE -+*/ -+int rtw_get_rson_struct(WLAN_BSSID_EX *bssid, struct rtw_rson_struct *rson_data) -+{ -+ sint limit = 0; -+ u32 len; -+ u8 *p; -+ -+ if ((rson_data == NULL) || (bssid == NULL)) -+ return -EINVAL; -+ -+ /* Default */ -+ rson_data->id = 0; -+ rson_data->ver = 0; -+ rson_data->hopcnt = 0; -+ rson_data->connectible = 0; -+ rson_data->loading = 0; -+ /* fake root */ -+ if (is_match_bssid(bssid->MacAddress, rtw_rson_root_bssid, rtw_rson_root_bssid_idx) == _TRUE) { -+ rson_data->id = CONFIG_RTW_REPEATER_SON_ID; -+ rson_data->ver = RTW_RSON_VER; -+ rson_data->hopcnt = RTW_RSON_HC_ROOT; -+ rson_data->connectible = RTW_RSON_ALLOWCONNECT; -+ rson_data->loading = 0; -+ return _TRUE; -+ } -+ limit = bssid->IELength - _BEACON_IE_OFFSET_; -+ -+ for (p = bssid->IEs + _BEACON_IE_OFFSET_; ; p += (len + 2)) { -+ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &len, limit); -+ limit -= len; -+ if ((p == NULL) || (len == 0)) -+ break; -+ if (p && (_rtw_memcmp(p + 2, RTW_RSON_OUI, sizeof(RTW_RSON_OUI)) == _TRUE) -+ && rtw_rson_varify_ie(p)) { -+ p = p + 2 + sizeof(RTW_RSON_OUI); -+ rson_data->ver = *p; -+ /* for (ver == 1) */ -+ p = p + 1; -+ rson_data->id = le32_to_cpup((__le32 *)p); -+ p = p + 4; -+ rson_data->hopcnt = *p; -+ p = p + 1; -+ rson_data->connectible = *p; -+ p = p + 1; -+ rson_data->loading = *p; -+ -+ return _TRUE; -+ } -+ } -+ return -EBADMSG; -+} -+ -+u32 rtw_rson_append_ie(_adapter *padapter, unsigned char *pframe, u32 *len) -+{ -+ u8 *ptr, *ori, ie_len = 0; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+/* static int iii = 0;*/ -+ -+ if ((!pdvobj) || (!pframe)) -+ return 0; -+ ptr = ori = pframe; -+ *ptr++ = _VENDOR_SPECIFIC_IE_; -+ *ptr++ = ie_len = sizeof(RTW_RSON_OUI)+sizeof(pdvobj->rson_data); -+ _rtw_memcpy(ptr, RTW_RSON_OUI, sizeof(RTW_RSON_OUI)); -+ ptr = ptr + sizeof(RTW_RSON_OUI); -+ *ptr++ = pdvobj->rson_data.ver; -+ *(s32 *)ptr = cpu_to_le32(pdvobj->rson_data.id); -+ ptr = ptr + sizeof(pdvobj->rson_data.id); -+ *ptr++ = pdvobj->rson_data.hopcnt; -+ *ptr++ = pdvobj->rson_data.connectible; -+ *ptr++ = pdvobj->rson_data.loading; -+ _rtw_memcpy(ptr, pdvobj->rson_data.res, sizeof(pdvobj->rson_data.res)); -+ pframe = ptr; -+/* -+ iii = iii % 20; -+ if (iii++ == 0) -+ RTW_INFO("%s : RTW RSON IE : %20ph\n", __func__, ori); -+*/ -+ *len += (ie_len+2); -+ return ie_len; -+ -+} -+ -+void rtw_rson_do_disconnect(_adapter *padapter) -+{ -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+#ifndef CONFIG_RTW_REPEATER_SON_ROOT -+ pdvobj->rson_data.ver = RTW_RSON_VER; -+ pdvobj->rson_data.id = CONFIG_RTW_REPEATER_SON_ID; -+ pdvobj->rson_data.hopcnt = RTW_RSON_HC_NOTREADY; -+ pdvobj->rson_data.connectible = RTW_RSON_DENYCONNECT; -+ pdvobj->rson_data.loading = 0; -+ #ifdef CONFIG_AP_MODE -+ rtw_mi_tx_beacon_hdl(padapter); -+ #endif -+#endif -+} -+ -+void rtw_rson_join_done(_adapter *padapter) -+{ -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ WLAN_BSSID_EX *cur_network = NULL; -+ struct rtw_rson_struct rson_data; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ if (!padapter->mlmepriv.cur_network_scanned) -+ return; -+ cur_network = &(padapter->mlmepriv.cur_network_scanned->network); -+ if (rtw_get_rson_struct(cur_network, &rson_data) != _TRUE) { -+ RTW_ERR("%s: try to join a improper network(%s)\n", __func__, cur_network->Ssid.Ssid); -+ return; -+ } -+ -+#ifndef CONFIG_RTW_REPEATER_SON_ROOT -+ /* update rson_data */ -+ pdvobj->rson_data.ver = RTW_RSON_VER; -+ pdvobj->rson_data.id = rson_data.id; -+ pdvobj->rson_data.hopcnt = rson_data.hopcnt + 1; -+ pdvobj->rson_data.connectible = RTW_RSON_ALLOWCONNECT; -+ pdvobj->rson_data.loading = 0; -+ #ifdef CONFIG_AP_MODE -+ rtw_mi_tx_beacon_hdl(padapter); -+ #endif -+#endif -+} -+ -+int rtw_rson_isupdate_roamcan(struct mlme_priv *mlme -+ , struct wlan_network **candidate, struct wlan_network *competitor) -+{ -+ struct rtw_rson_struct rson_cand, rson_comp, rson_curr; -+ s16 comp_score, cand_score, curr_score; -+ -+ if ((competitor == NULL) -+ || (rtw_get_rson_struct(&(competitor->network), &rson_comp) != _TRUE) -+ || (rson_comp.id != CONFIG_RTW_REPEATER_SON_ID)) -+ return _FALSE; -+ -+ if (is_match_bssid(competitor->network.MacAddress, rtw_rson_block_bssid, rtw_rson_block_bssid_idx) == _TRUE) -+ return _FALSE; -+ -+ if ((!mlme->cur_network_scanned) -+ || (mlme->cur_network_scanned == competitor) -+ || (rtw_get_rson_struct(&(mlme->cur_network_scanned->network), &rson_curr)) != _TRUE) -+ return _FALSE; -+ -+ if (rtw_get_passing_time_ms((u32)competitor->last_scanned) >= mlme->roam_scanr_exp_ms) -+ return _FALSE; -+ -+ comp_score = rtw_cal_rson_score(&rson_comp, competitor->network.Rssi); -+ curr_score = rtw_cal_rson_score(&rson_curr, mlme->cur_network_scanned->network.Rssi); -+ if (comp_score - curr_score < RSON_SCORE_DIFF_TH) -+ return _FALSE; -+ -+ if (*candidate == NULL) -+ return _TRUE; -+ -+ if (rtw_get_rson_struct(&((*candidate)->network), &rson_cand) != _TRUE) { -+ RTW_ERR("%s : Unable to get rson_struct from candidate(%s -- " MAC_FMT")\n", -+ __func__, (*candidate)->network.Ssid.Ssid, MAC_ARG((*candidate)->network.MacAddress)); -+ return _FALSE; -+ } -+ cand_score = rtw_cal_rson_score(&rson_cand, (*candidate)->network.Rssi); -+ RTW_DBG("comp_score=%d , cand_score=%d , curr_score=%d\n", comp_score, cand_score, curr_score); -+ if (cand_score < comp_score) -+ return _TRUE; -+ -+#if 0 /* Handle 11R protocol */ -+#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 -+#endif -+ return _FALSE; -+} -+ -+void rtw_rson_show_survey_info(struct seq_file *m, _list *plist, _list *phead) -+{ -+ struct wlan_network *pnetwork = NULL; -+ struct rtw_rson_struct rson_data; -+ s16 rson_score; -+ u16 index = 0; -+ -+ RTW_PRINT_SEL(m, "%5s %-17s %3s %5s %14s %10s %-3s %5s %32s\n", "index", "bssid", "ch", "id", "hop_cnt", "loading", "RSSI", "score", "ssid"); -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (!pnetwork) -+ break; -+ -+ _rtw_memset(&rson_data, 0, sizeof(rson_data)); -+ rson_score = 0; -+ if (rtw_get_rson_struct(&(pnetwork->network), &rson_data) == _TRUE) -+ rson_score = rtw_cal_rson_score(&rson_data, pnetwork->network.Rssi); -+ RTW_PRINT_SEL(m, "%5d "MAC_FMT" %3d 0x%08x %6d %10d %6d %6d %32s\n", -+ ++index, -+ MAC_ARG(pnetwork->network.MacAddress), -+ pnetwork->network.Configuration.DSConfig, -+ rson_data.id, -+ rson_data.hopcnt, -+ rson_data.loading, -+ (int)pnetwork->network.Rssi, -+ rson_score, -+ pnetwork->network.Ssid.Ssid); -+ plist = get_next(plist); -+ } -+ -+} -+ -+/* -+ Description : As a AP role, We need to check the qualify of associating STA. -+ We also need to check if we are ready to be associated. -+ -+ return : TRUE -- AP REJECT this STA -+ FALSE -- AP ACCEPT this STA -+*/ -+u8 rtw_rson_ap_check_sta(_adapter *padapter, u8 *pframe, uint pkt_len, unsigned short ie_offset) -+{ -+ struct wlan_network *pnetwork = NULL; -+ struct rtw_rson_struct rson_target; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ int len = 0; -+ u8 ret = _FALSE; -+ u8 *p; -+ -+#ifndef CONFIG_RTW_REPEATER_SON_ROOT -+ _rtw_memset(&rson_target, 0, sizeof(rson_target)); -+ for (p = pframe + WLAN_HDR_A3_LEN + ie_offset; ; p += (len + 2)) { -+ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &len, pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ -+ if ((p == NULL) || (len == 0)) -+ break; -+ -+ if (p && (_rtw_memcmp(p + 2, RTW_RSON_OUI, sizeof(RTW_RSON_OUI)) == _TRUE) -+ && rtw_rson_varify_ie(p)) { -+ p = p + 2 + sizeof(RTW_RSON_OUI); -+ rson_target.ver = *p; -+ /* for (ver == 1) */ -+ p = p + 1; -+ rson_target.id = le32_to_cpup((__le32 *)p); -+ p = p + 4; -+ rson_target.hopcnt = *p; -+ p = p + 1; -+ rson_target.connectible = *p; -+ p = p + 1; -+ rson_target.loading = *p; -+ break; -+ } -+ } -+ -+ if (rson_target.id == 0) /* Normal STA, not a RSON STA */ -+ ret = _FALSE; -+ else if (rson_target.id != pdvobj->rson_data.id) { -+ ret = _TRUE; -+ RTW_INFO("%s : Reject AssoReq because RSON ID not match, STA=%08x, our=%08x\n", -+ __func__, rson_target.id, pdvobj->rson_data.id); -+ } else if ((pdvobj->rson_data.hopcnt == RTW_RSON_HC_NOTREADY) -+ || (pdvobj->rson_data.connectible == RTW_RSON_DENYCONNECT)) { -+ ret = _TRUE; -+ RTW_INFO("%s : Reject AssoReq becuase our hopcnt=%d or connectbile=%d\n", -+ __func__, pdvobj->rson_data.hopcnt, pdvobj->rson_data.connectible); -+ } -+#endif -+ return ret; -+} -+ -+u8 rtw_rson_scan_wk_cmd(_adapter *padapter, int op) -+{ -+ 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; -+ } -+ pdrvextra_cmd_parm->ec_id = RSON_SCAN_WK_CID; -+ pdrvextra_cmd_parm->type = op; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, CMD_SET_DRV_EXTRA); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+ -+} -+ -+void rtw_rson_scan_cmd_hdl(_adapter *padapter, int op) -+{ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 val8; -+ -+ if (mlmeext_chk_scan_state(pmlmeext, SCAN_DISABLE) != _TRUE) -+ return; -+ if (op == RSON_SCAN_PROCESS) { -+ padapter->rtw_rson_scanstage = RSON_SCAN_PROCESS; -+ val8 = 0x1e; -+ rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &val8, _FALSE); -+ val8 = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq(padapter, NULL, NULL); -+ /* stop rson_scan after 100ms */ -+ _set_timer(&(pmlmeext->rson_scan_timer), 100); -+ } else if (op == RSON_SCAN_DISABLE) { -+ padapter->rtw_rson_scanstage = RSON_SCAN_DISABLE; -+ val8 = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ val8 = 0xff; -+ rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &val8, _FALSE); -+ /* report_surveydone_event(padapter);*/ -+ if (pmlmepriv->to_join == _TRUE) { -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) != _TRUE) { -+ int s_ret; -+ -+ set_fwstate(pmlmepriv, WIFI_UNDER_LINKING); -+ pmlmepriv->to_join = _FALSE; -+ s_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv); -+ if (s_ret == _SUCCESS) -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ else if (s_ret == 2) { -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_LINKING); -+ rtw_indicate_connect(padapter); -+ } else { -+ RTW_INFO("try_to_join, but select scanning queue fail, to_roam:%d\n", rtw_to_roam(padapter)); -+ if (rtw_to_roam(padapter) != 0) { -+ if (rtw_dec_to_roam(padapter) == 0) { -+ rtw_set_to_roam(padapter, 0); -+ rtw_free_assoc_resources(padapter, _TRUE); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ } else -+ pmlmepriv->to_join = _TRUE; -+ } else -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_LINKING); -+ } -+ } -+ } else { -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE)) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) { -+ if (rtw_select_roaming_candidate(pmlmepriv) == _SUCCESS) { -+#ifdef CONFIG_RTW_80211R -+ if (rtw_chk_ft_flags(padapter, 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(padapter, pmlmepriv->cur_network.network.MacAddress -+ , WLAN_REASON_ACTIVE_ROAM, _FALSE); -+#endif -+ } -+ } -+ } -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ } -+ } else { -+ RTW_ERR("%s : improper parameter -- op = %d\n", __func__, op); -+ } -+} -+ -+#endif /* CONFIG_RTW_REPEATER_SON */ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_sdio.c b/drivers/net/wireless/rtl8821cs/core/rtw_sdio.c -new file mode 100644 -index 000000000..cdadbaff7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_sdio.c -@@ -0,0 +1,157 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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) -+{ -+#ifdef DBG_SDIO -+#if (DBG_SDIO >= 3) -+ struct sdio_data *sdio; -+#endif /* DBG_SDIO >= 3 */ -+#endif /* DBG_SDIO */ -+ u32 addr_drv; /* address with driver defined bit */ -+ int err; -+ u8 retry = 0; -+ u8 stop_retry = _FALSE; /* flag for stopping retry or not */ -+ -+ -+#ifdef DBG_SDIO -+#if (DBG_SDIO >= 3) -+ sdio = &d->intf_data; -+#endif /* DBG_SDIO >= 3 */ -+#endif /* DBG_SDIO */ -+ -+ if (rtw_is_surprise_removed(dvobj_get_primary_adapter(d))) { -+ RTW_ERR("%s: bSurpriseRemoved, skip %s 0x%05x, %zu bytes\n", -+ __FUNCTION__, write?"write":"read", addr, len); -+ return _FAIL; -+ } -+ -+ addr_drv = addr; -+ if (cmd52) -+ addr_drv = RTW_SDIO_ADDR_CMD52_GEN(addr_drv); -+ -+ do { -+ if (write) -+ err = d->intf_ops->write(d, addr_drv, buf, len, 0); -+ else -+ err = d->intf_ops->read(d, addr_drv, buf, len, 0); -+ if (!err) { -+ if (retry) { -+ RTW_INFO("%s: Retry %s OK! addr=0x%05x %zu bytes, retry=%u,%u\n", -+ __FUNCTION__, write?"write":"read", -+ addr, len, retry, ATOMIC_READ(&d->continual_io_error)); -+ RTW_INFO_DUMP("Data: ", buf, len); -+ } -+ rtw_reset_continual_io_error(d); -+ break; -+ } -+ RTW_ERR("%s: %s FAIL! error(%d) addr=0x%05x %zu bytes, retry=%u,%u\n", -+ __FUNCTION__, write?"write":"read", err, addr, len, -+ retry, ATOMIC_READ(&d->continual_io_error)); -+ -+#ifdef DBG_SDIO -+#if (DBG_SDIO >= 3) -+ if (sdio->dbg_enable) { -+ if (sdio->err_test && sdio->err_test_triggered) -+ sdio->err_test = 0; -+ -+ if (sdio->err_stop) { -+ RTW_ERR("%s: I/O error! Set surprise remove flag ON!\n", -+ __FUNCTION__); -+ rtw_set_surprise_removed(dvobj_get_primary_adapter(d)); -+ return _FAIL; -+ } -+ } -+#endif /* DBG_SDIO >= 3 */ -+#endif /* DBG_SDIO */ -+ -+ retry++; -+ stop_retry = rtw_inc_and_chk_continual_io_error(d); -+ if ((err == -1) || (stop_retry == _TRUE) || (retry > SD_IO_TRY_CNT)) { -+ /* critical error, unrecoverable */ -+ RTW_ERR("%s: Fatal error! Set surprise remove flag ON! (retry=%u,%u)\n", -+ __FUNCTION__, retry, ATOMIC_READ(&d->continual_io_error)); -+ rtw_set_surprise_removed(dvobj_get_primary_adapter(d)); -+ return _FAIL; -+ } -+ -+ /* WLAN IOREG or SDIO Local */ -+ if ((addr & 0x10000) || !(addr & 0xE000)) { -+ RTW_WARN("%s: Retry %s addr=0x%05x %zu bytes, retry=%u,%u\n", -+ __FUNCTION__, write?"write":"read", addr, len, -+ retry, ATOMIC_READ(&d->continual_io_error)); -+ continue; -+ } -+ return _FAIL; -+ } while (1); -+ -+ 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) -+ ret = _FAIL; -+ -+ return ret; -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_security.c b/drivers/net/wireless/rtl8821cs/core/rtw_security.c -new file mode 100644 -index 000000000..639e1e574 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_security.c -@@ -0,0 +1,2872 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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", -+ "GCMP", -+}; -+ -+static const char *_security_type_bip_str[] = { -+ "BIP_CMAC_128", -+ "BIP_GMAC_128", -+ "BIP_GMAC_256", -+ "BIP_CMAC_256", -+}; -+ -+const char *security_type_str(u8 value) -+{ -+#ifdef CONFIG_IEEE80211W -+ if ((_BIP_MAX_ > value) && (value >= _BIP_CMAC_128_)) -+ return _security_type_bip_str[value & ~_SEC_TYPE_BIT_]; -+#endif -+ -+ if (_CCMP_256_ == value) -+ return "CCMP_256"; -+ if (_GCMP_256_ == value) -+ return "GCMP_256"; -+ -+ if (_SEC_TYPE_MAX_ > value) -+ return _security_type_str[value]; -+ -+ return NULL; -+} -+ -+#ifdef CONFIG_IEEE80211W -+u32 security_type_bip_to_gmcs(enum security_type type) -+{ -+ switch (type) { -+ case _BIP_CMAC_128_: -+ return WPA_CIPHER_BIP_CMAC_128; -+ case _BIP_GMAC_128_: -+ return WPA_CIPHER_BIP_GMAC_128; -+ case _BIP_GMAC_256_: -+ return WPA_CIPHER_BIP_GMAC_256; -+ case _BIP_CMAC_256_: -+ return WPA_CIPHER_BIP_CMAC_256; -+ default: -+ return 0; -+ } -+} -+#endif -+ -+#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) -+ -+#define GCMP_SW_ENC_CNT_INC(sec, ra) do {\ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->gcmp_sw_enc_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->gcmp_sw_enc_cnt_mc++; \ -+ else \ -+ sec->gcmp_sw_enc_cnt_uc++; \ -+ } while (0) -+ -+#define GCMP_SW_DEC_CNT_INC(sec, ra) do {\ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->gcmp_sw_dec_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->gcmp_sw_dec_cnt_mc++; \ -+ else \ -+ sec->gcmp_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) -+#define GCMP_SW_ENC_CNT_INC(sec, ra) -+#define GCMP_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 &WIFI_ASOC_STATE)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\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 systime 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===== */ -+#if (NEW_CRYPTO == 0) -+ -+#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; -+#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) -+ /* 802.11w management frame should set management bit(4) */ -+ if (frtype == WIFI_MGT_TYPE) -+ mic_iv[1] |= BIT(4); -+#endif -+ 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); -+#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) -+ /* 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 -+ 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; -+#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) -+ /* 802.11w management frame should set management bit(4) */ -+ if (frtype == WIFI_MGT_TYPE) -+ ctr_preload[1] |= BIT(4); -+#endif -+ 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 = get_frame_sub_type(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 != WLAN_HDR_A4_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 != WLAN_HDR_A4_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; -+ sint curfragnum, plen; -+ u32 prwskeylen; -+ u8 *pframe; -+ u8 *prwskey; -+ u8 hw_hdr_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; -+ -+ /* start to encrypt each fragment */ -+ if ((pattrib->encrypt == _AES_) || -+ (pattrib->encrypt == _CCMP_256_)) { -+ -+ if (IS_MCAST(pattrib->ra)) -+ prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ else { -+ 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 = (pattrib->encrypt == _CCMP_256_) ? 32 : 16; -+ -+ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { -+ -+ if ((curfragnum + 1) == pattrib->nr_frags) { /* the last fragment */ -+ plen = pattrib->last_txcmdsz - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; -+ -+ _rtw_ccmp_encrypt(padapter, prwskey, prwskeylen, pattrib->hdrlen, pframe, plen); -+ } else { -+ plen = pxmitpriv->frag_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; -+ -+ _rtw_ccmp_encrypt(padapter, prwskey, prwskeylen, pattrib->hdrlen, pframe, plen); -+ pframe += pxmitpriv->frag_len; -+ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); -+ -+ } -+ } -+ -+ AES_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); -+ -+ } -+ -+ -+ -+ return res; -+} -+#else -+u32 rtw_aes_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ -+ /* exclude ICV */ -+ -+ -+ /*static*/ -+ /* unsigned char message[MAX_MSG_SIZE]; */ -+ -+ /* Intermediate Buffers */ -+ sint curfragnum, length; -+ u32 prwskeylen; -+ u8 *pframe, *prwskey; /* , *payload,*iv */ -+ u8 hw_hdr_offset = 0; -+ /* struct sta_info *stainfo=NULL; */ -+ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ 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 &WIFI_ASOC_STATE)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\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; -+} -+#endif -+ -+#if (NEW_CRYPTO == 0) -+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 = get_frame_sub_type(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 != WLAN_HDR_A4_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 != WLAN_HDR_A4_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; -+} -+#endif /* (NEW_CRYPTO == 0) */ -+ -+#if NEW_CRYPTO -+u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ struct sta_info *stainfo; -+ struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u8 *pframe; -+ u8 *prwskey; -+ u32 res = _SUCCESS; -+ -+ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; -+ /* start to encrypt each fragment */ -+ if ((prxattrib->encrypt == _AES_) || -+ (prxattrib->encrypt == _CCMP_256_)) { -+ -+ stainfo = rtw_get_stainfo(&padapter->stapriv, &prxattrib->ta[0]); -+ if (stainfo != NULL) { -+ -+ if (IS_MCAST(prxattrib->ra)) { -+ static systime start = 0; -+ static u32 no_gkey_bc_cnt = 0; -+ static u32 no_gkey_mc_cnt = 0; -+ -+ if ((!MLME_IS_MESH(padapter) && psecuritypriv->binstallGrpkey == _FALSE) -+ #ifdef CONFIG_RTW_MESH -+ || !(stainfo->gtk_bmp | BIT(prxattrib->key_index)) -+ #endif -+ ) { -+ 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; -+ -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ /* TODO: multiple GK? */ -+ prwskey = &stainfo->gtk.skey[0]; -+ } else -+ #endif -+ { -+ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; -+ if (psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) { -+ RTW_DBG("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]; -+ -+ res = _rtw_ccmp_decrypt(padapter, prwskey, -+ prxattrib->encrypt == _CCMP_256_ ? 32 : 16, -+ prxattrib->hdrlen, pframe, -+ ((union recv_frame *)precvframe)->u.hdr.len); -+ -+ AES_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); -+ } else { -+ res = _FAIL; -+ } -+ -+ } -+exit: -+ return res; -+} -+#else -+u32 rtw_aes_decrypt(_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) { -+ -+ if (IS_MCAST(prxattrib->ra)) { -+ static systime 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 ((!MLME_IS_MESH(padapter) && psecuritypriv->binstallGrpkey == _FALSE) -+ #ifdef CONFIG_RTW_MESH -+ || !(stainfo->gtk_bmp | BIT(prxattrib->key_index)) -+ #endif -+ ) { -+ 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; -+ -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ /* TODO: multiple GK? */ -+ prwskey = &stainfo->gtk.skey[0]; -+ } else -+ #endif -+ { -+ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; -+ if (psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) { -+ RTW_DBG("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; -+} -+#endif -+ -+#ifdef CONFIG_RTW_MESH_AEK -+/* for AES-SIV, wrapper to ase_siv_encrypt and aes_siv_decrypt */ -+int rtw_aes_siv_encrypt(const u8 *key, size_t key_len, const u8 *pw, -+ size_t pwlen, size_t num_elem, -+ const u8 *addr[], const size_t *len, u8 *out) -+{ -+ return _aes_siv_encrypt(key, key_len, pw, pwlen, -+ num_elem, addr, len, out); -+} -+ -+int rtw_aes_siv_decrypt(const u8 *key, size_t key_len, const u8 *iv_crypt, size_t iv_c_len, -+ size_t num_elem, const u8 *addr[], const size_t *len, u8 *out) -+{ -+ return _aes_siv_decrypt(key, key_len, iv_crypt, -+ iv_c_len, num_elem, addr, len, out); -+} -+#endif /* CONFIG_RTW_MESH_AEK */ -+ -+#ifdef CONFIG_TDLS -+void wpa_tdls_generate_tpk(_adapter *padapter, void *sta) -+{ -+ struct sta_info *psta = (struct sta_info *)sta; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _tdls_generate_tpk(psta, adapter_mac_addr(padapter), get_bssid(pmlmepriv)); -+} -+ -+/** -+ * 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); */ -+ ret = _bip_ccmp_protect(kck, 16, 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); */ -+ ret = _bip_ccmp_protect(kck, 16, 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); */ -+ ret = _bip_ccmp_protect(kck, 16, buf, pos - buf, mic); -+ rtw_mfree(buf, len); -+ if (ret == _FAIL) -+ return _FAIL; -+ rx_ftie = ftie + 4; -+ -+ if (_rtw_memcmp2(mic, rx_ftie, 16) == 0) { -+ /* Valid MIC */ -+ return _SUCCESS; -+ } -+ -+ /* Invalid MIC */ -+ RTW_INFO("[%s] Invalid MIC\n", __FUNCTION__); -+ return _FAIL; -+ -+} -+#endif /* CONFIG_TDLS */ -+ -+/* 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*/ -+ -+u32 rtw_calc_crc32(u8 *data, size_t len) -+{ -+ size_t i; -+ u32 crc = 0xFFFFFFFF; -+ -+ if (bcrc32initialized == 0) -+ crc32_init(); -+ -+ for (i = 0; i < len; i++) -+ crc = crc32_table[(crc ^ data[i]) & 0xff] ^ (crc >> 8); -+ -+ /* return 1' complement */ -+ return ~crc; -+} -+ -+ -+/** -+ * rtw_gcmp_encrypt - -+ * @padapter: -+ * @pxmitframe: -+ * -+ */ -+u32 rtw_gcmp_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ -+ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ /* Intermediate Buffers */ -+ sint curfragnum, plen; -+ u32 prwskeylen; -+ u8 *pframe = NULL; -+ u8 *prwskey = NULL; -+ u8 hw_hdr_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; -+ -+ /* start to encrypt each fragment */ -+ if ((pattrib->encrypt == _GCMP_) || -+ (pattrib->encrypt == _GCMP_256_)) { -+ -+ if (IS_MCAST(pattrib->ra)) -+ prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ else -+ prwskey = pattrib->dot118021x_UncstKey.skey; -+ -+ prwskeylen = (pattrib->encrypt == _GCMP_256_) ? 32 : 16; -+ -+ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { -+ if ((curfragnum + 1) == pattrib->nr_frags) { -+ /* the last fragment */ -+ plen = pattrib->last_txcmdsz - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; -+ -+ _rtw_gcmp_encrypt(padapter, prwskey, prwskeylen, pattrib->hdrlen, pframe, plen); -+ } else { -+ plen = pxmitpriv->frag_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; -+ -+ _rtw_gcmp_encrypt(padapter, prwskey, prwskeylen, pattrib->hdrlen, pframe, plen); -+ pframe += pxmitpriv->frag_len; -+ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); -+ } -+ } -+ -+ GCMP_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); -+ } -+ -+ return res; -+} -+ -+u32 rtw_gcmp_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ u32 prwskeylen; -+ u8 * pframe,*prwskey; -+ struct sta_info *stainfo; -+ struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u32 res = _SUCCESS; -+ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; -+ -+ if ((prxattrib->encrypt == _GCMP_) || -+ (prxattrib->encrypt == _GCMP_256_)) { -+ stainfo = rtw_get_stainfo(&padapter->stapriv, &prxattrib->ta[0]); -+ if (stainfo != NULL) { -+ if (IS_MCAST(prxattrib->ra)) { -+ static systime start = 0; -+ static u32 no_gkey_bc_cnt = 0; -+ static u32 no_gkey_mc_cnt = 0; -+ -+ if ((!MLME_IS_MESH(padapter) && psecuritypriv->binstallGrpkey == _FALSE) -+ #ifdef CONFIG_RTW_MESH -+ || !(stainfo->gtk_bmp | BIT(prxattrib->key_index)) -+ #endif -+ ) { -+ 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; -+ -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ /* TODO: multiple GK? */ -+ prwskey = &stainfo->gtk.skey[0]; -+ } else -+ #endif -+ { -+ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; -+ if (psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) { -+ RTW_DBG("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]; -+ -+ res = _rtw_gcmp_decrypt(padapter, prwskey, -+ prxattrib->encrypt == _GCMP_256_ ? 32 : 16, -+ prxattrib->hdrlen, pframe, -+ ((union recv_frame *)precvframe)->u.hdr.len); -+ -+ GCMP_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); -+ } else { -+ res = _FAIL; -+ } -+ -+ } -+exit: -+ return res; -+} -+ -+ -+#ifdef CONFIG_IEEE80211W -+u8 rtw_calculate_bip_mic(enum security_type gmcs, u8 *whdr_pos, s32 len, -+ const u8 *key, const u8 *data, size_t data_len, u8 *mic) -+{ -+ u8 res = _SUCCESS; -+ -+ if (gmcs == _BIP_CMAC_128_) { -+ if (_bip_ccmp_protect(key, 16, data, data_len, mic) == _FALSE) { -+ res = _FAIL; -+ RTW_ERR("%s : _bip_ccmp_protect(128) fail!", __func__); -+ } -+ } else if (gmcs == _BIP_CMAC_256_) { -+ if (_bip_ccmp_protect(key, 32, data, data_len, mic) == _FALSE) { -+ res = _FAIL; -+ RTW_ERR("%s : _bip_ccmp_protect(256) fail!", __func__); -+ } -+ } else if (gmcs == _BIP_GMAC_128_) { -+ if (_bip_gcmp_protect(whdr_pos, len, key, 16, -+ data, data_len, mic) == _FALSE) { -+ res = _FAIL; -+ RTW_ERR("%s : _bip_gcmp_protect(128) fail!", __func__); -+ } -+ } else if (gmcs == _BIP_GMAC_256_) { -+ if (_bip_gcmp_protect(whdr_pos, len, key, 32, -+ data, data_len, mic) == _FALSE) { -+ res = _FAIL; -+ RTW_ERR("%s : _bip_gcmp_protect(256) fail!", __func__); -+ } -+ } else { -+ res = _FAIL; -+ RTW_ERR("%s : unsupport dot11wCipher !\n", __func__); -+ } -+ -+ return res; -+} -+ -+ -+u32 rtw_bip_verify(enum security_type gmcs, u16 pkt_len, -+ u8 *whdr_pos, sint flen, const u8 *key, u16 keyid, u64 *ipn) -+{ -+ u8 * BIP_AAD,*mme; -+ u32 res = _FAIL; -+ uint len, ori_len; -+ u16 pkt_keyid = 0; -+ u64 pkt_ipn = 0; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u8 mic[16]; -+ u8 mic_len, mme_offset; -+ -+ mic_len = (gmcs == _BIP_CMAC_128_) ? 8 : 16; -+ -+ if (flen < WLAN_HDR_A3_LEN || flen - WLAN_HDR_A3_LEN < mic_len) -+ return RTW_RX_HANDLED; -+ -+ mme_offset = (mic_len == 8) ? 18 : 26; -+ mme = whdr_pos + flen - mme_offset; -+ if (*mme != _MME_IE_) -+ return RTW_RX_HANDLED; -+ -+ /* copy key index */ -+ _rtw_memcpy(&pkt_keyid, mme + 2, 2); -+ pkt_keyid = le16_to_cpu(pkt_keyid); -+ if (pkt_keyid != keyid) { -+ RTW_INFO("BIP key index error!\n"); -+ return _FAIL; -+ } -+ -+ /* save packet number */ -+ _rtw_memcpy(&pkt_ipn, mme + 4, 6); -+ pkt_ipn = le64_to_cpu(pkt_ipn); -+ /* BIP packet number should bigger than previous BIP packet */ -+ if (pkt_ipn <= *ipn) { /* wrap around? */ -+ RTW_INFO("replay BIP packet\n"); -+ return _FAIL; -+ } -+ -+ ori_len = flen - 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; -+ } -+ -+ /* mapping to wlan header */ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)whdr_pos; -+ -+ /* save the frame body + MME (w/o mic) */ -+ _rtw_memcpy(BIP_AAD + BIP_AAD_SIZE, -+ whdr_pos + WLAN_HDR_A3_LEN, -+ flen - WLAN_HDR_A3_LEN - mic_len); -+ -+ /* 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, GetAddr1Ptr((u8 *)pwlanhdr), 18); -+ -+ if (rtw_calculate_bip_mic(gmcs, whdr_pos, -+ pkt_len, key, BIP_AAD, ori_len, mic) == _FAIL) -+ goto BIP_exit; -+ -+ /* MIC field should be last 8 bytes of packet (packet without FCS) */ -+ if (_rtw_memcmp(mic, whdr_pos + flen - mic_len, mic_len)) { -+ *ipn = pkt_ipn; -+ res = _SUCCESS; -+ } else -+ RTW_INFO("BIP MIC error!\n"); -+ -+#if 0 -+ /* management packet content */ -+ { -+ int pp; -+ RTW_INFO("pkt: "); -+ RTW_INFO_DUMP("", whdr_pos, flen); -+ RTW_INFO("\n"); -+ /* BIP AAD + management frame body + MME(MIC is zero) */ -+ RTW_INFO("AAD+PKT: "); -+ RTW_INFO_DUMP("", BIP_AAD, ori_len); -+ RTW_INFO("\n"); -+ /* show the MIC result */ -+ RTW_INFO("mic: "); -+ RTW_INFO_DUMP("", mic, mic_len); -+ RTW_INFO("\n"); -+ } -+#endif -+ -+BIP_exit: -+ -+ rtw_mfree(BIP_AAD, ori_len); -+ return res; -+} -+ -+#endif /* CONFIG_IEEE80211W */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_sreset.c b/drivers/net/wireless/rtl8821cs/core/rtw_sreset.c -new file mode 100644 -index 000000000..21cc18bc4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_sreset.c -@@ -0,0 +1,320 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+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; -+ -+ 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) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ 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 ((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; -+ -+ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, RTW_CMDF_DIRECTLY); -+ -+ { -+ 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. */ -+#ifdef CONFIG_80211N_HT -+ 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 /* CONFIG_80211N_HT */ -+#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_rcr_set_chk_bssid(padapter, MLME_STA_CONNECTING); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ rtw_btcoex_connect_notify(padapter, 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; -+ -+ 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 (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { -+ RTW_INFO(FUNC_ADPT_FMT" %s\n", FUNC_ADPT_ARG(padapter), MLME_IS_AP(padapter) ? "AP" : "MESH"); -+ rtw_ap_restore_network(padapter); -+ } -+#endif -+ 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, WIFI_UNDER_SURVEY)) -+ rtw_scan_abort(padapter); -+ -+ if (check_fwstate(pmlmepriv, WIFI_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, WIFI_ASOC_STATE)) -+ 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; -+ systime 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 -+#if defined(CONFIG_AP_MODE) && defined(CONFIG_CONCURRENT_MODE) -+ rtw_mi_ap_info_restore(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++; -+ -+ psrtpriv->self_dect_fw = _FALSE; -+ psrtpriv->rx_cnt = 0; -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_sta_mgt.c b/drivers/net/wireless/rtl8821cs/core/rtw_sta_mgt.c -new file mode 100644 -index 000000000..d0966567c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_sta_mgt.c -@@ -0,0 +1,1387 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+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; -+} -+ -+void rtw_st_ctl_rx(struct sta_info *sta, u8 *ehdr_pos) -+{ -+ _adapter *adapter = sta->padapter; -+ struct ethhdr *etherhdr = (struct ethhdr *)ehdr_pos; -+ -+ if (ntohs(etherhdr->h_proto) == ETH_P_IP) { -+ u8 *ip = ehdr_pos + ETH_HLEN; -+ -+ 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, adapter, 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(adapter, 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(adapter) -+ , 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(adapter, 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(adapter) -+ , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp)) -+ , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp))); -+ } -+ } -+ -+ } -+ } -+} -+ -+#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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ _rtw_init_queue(&psta->mgmt_sleep_q); -+#endif -+ _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->bpairwise_key_installed = _FALSE; -+ -+#ifdef CONFIG_RTW_80211R -+ psta->ft_pairwise_key_installed = _FALSE; -+#endif -+#endif /* CONFIG_AP_MODE */ -+ -+ rtw_st_ctl_init(&psta->st_ctl); -+} -+ -+u32 _rtw_init_sta_priv(struct sta_priv *pstapriv) -+{ -+ _adapter *adapter = container_of(pstapriv, _adapter, stapriv); -+ struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); -+ struct sta_info *psta; -+ s32 i; -+ u32 ret = _FAIL; -+ -+ pstapriv->padapter = adapter; -+ -+ pstapriv->pallocated_stainfo_buf = rtw_zvmalloc( -+ sizeof(struct sta_info) * NUM_STA + MEM_ALIGNMENT_OFFSET); -+ if (!pstapriv->pallocated_stainfo_buf) -+ goto exit; -+ -+ pstapriv->pstainfo_buf = pstapriv->pallocated_stainfo_buf; -+ if ((SIZE_PTR)pstapriv->pstainfo_buf & MEM_ALIGNMENT_PADDING) -+ pstapriv->pstainfo_buf += MEM_ALIGNMENT_OFFSET - -+ ((SIZE_PTR)pstapriv->pstainfo_buf & MEM_ALIGNMENT_PADDING); -+ -+ _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->max_aid = macid_ctl->num; -+ pstapriv->rr_aid = 0; -+ pstapriv->started_aid = 1; -+ pstapriv->sta_aid = rtw_zmalloc(pstapriv->max_aid * sizeof(struct sta_info *)); -+ if (!pstapriv->sta_aid) -+ goto exit; -+ pstapriv->aid_bmp_len = AID_BMP_LEN(pstapriv->max_aid); -+ pstapriv->sta_dz_bitmap = rtw_zmalloc(pstapriv->aid_bmp_len); -+ if (!pstapriv->sta_dz_bitmap) -+ goto exit; -+ pstapriv->tim_bitmap = rtw_zmalloc(pstapriv->aid_bmp_len); -+ if (!pstapriv->tim_bitmap) -+ goto exit; -+ -+ _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; -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ pstapriv->tbtx_asoc_list_cnt = 0; -+#endif -+ -+ 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; -+ -+#if CONFIG_RTW_MACADDR_ACL -+ for (i = 0; i < RTW_ACL_PERIOD_NUM; i++) -+ rtw_macaddr_acl_init(adapter, i); -+#endif -+#endif /* CONFIG_AP_MODE */ -+ -+#if CONFIG_RTW_PRE_LINK_STA -+ rtw_pre_link_sta_ctl_init(pstapriv); -+#endif -+ -+ _rtw_spinlock_init(&pstapriv->tx_rpt_lock); -+ -+#if defined(DBG_ROAMING_TEST) || defined(CONFIG_RTW_REPEATER_SON) -+ rtw_set_rx_chk_limit(adapter,1); -+#elif defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) -+ rtw_set_rx_chk_limit(adapter,4); -+#else -+ rtw_set_rx_chk_limit(adapter,8); -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ if (ret != _SUCCESS) { -+ if (pstapriv->pallocated_stainfo_buf) -+ rtw_vmfree(pstapriv->pallocated_stainfo_buf, -+ sizeof(struct sta_info) * NUM_STA + MEM_ALIGNMENT_OFFSET); -+ #ifdef CONFIG_AP_MODE -+ if (pstapriv->sta_aid) -+ rtw_mfree(pstapriv->sta_aid, pstapriv->max_aid * sizeof(struct sta_info *)); -+ if (pstapriv->sta_dz_bitmap) -+ rtw_mfree(pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); -+ #endif -+ } -+ -+ return ret; -+} -+ -+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)); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ _rtw_spinlock_free(&(psta_xmitpriv->mgmt_q.sta_pending.lock)); -+#endif -+} -+ -+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 CONFIG_RTW_MACADDR_ACL -+ for (index = 0; index < RTW_ACL_PERIOD_NUM; index++) -+ rtw_macaddr_acl_deinit(pstapriv->padapter, index); -+#endif -+ -+#if CONFIG_RTW_PRE_LINK_STA -+ rtw_pre_link_sta_ctl_deinit(pstapriv); -+#endif -+ -+ _rtw_spinlock_free(&pstapriv->tx_rpt_lock); -+ -+ if (pstapriv->pallocated_stainfo_buf) -+ rtw_vmfree(pstapriv->pallocated_stainfo_buf, -+ sizeof(struct sta_info) * NUM_STA + MEM_ALIGNMENT_OFFSET); -+ #ifdef CONFIG_AP_MODE -+ if (pstapriv->sta_aid) -+ rtw_mfree(pstapriv->sta_aid, pstapriv->max_aid * sizeof(struct sta_info *)); -+ if (pstapriv->sta_dz_bitmap) -+ rtw_mfree(pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); -+ if (pstapriv->tim_bitmap) -+ rtw_mfree(pstapriv->tim_bitmap, pstapriv->aid_bmp_len); -+ #endif -+ } -+ -+ return _SUCCESS; -+} -+ -+ -+static void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl) -+{ -+ _adapter *padapter = preorder_ctrl->padapter; -+ -+#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) -+ rtw_init_timer(&(preorder_ctrl->reordering_ctrl_timer), padapter, rtw_reordering_ctrl_timeout_handler, preorder_ctrl); -+#endif -+} -+ -+/* struct sta_info *rtw_alloc_stainfo(_queue *pfree_sta_queue, unsigned char *hwaddr) */ -+struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, const u8 *hwaddr) -+{ -+ _irqL irqL2; -+ 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); */ -+ _rtw_init_stainfo(psta); -+ -+ psta->padapter = pstapriv->padapter; -+ -+ _rtw_memcpy(psta->cmn.mac_addr, 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_memcpy(&psta->sta_recvpriv.bmc_tid_rxseq[i], &wRxSeqInitialValue, 2); -+ _rtw_memset(&psta->sta_recvpriv.rxcache.iv[i], 0, sizeof(psta->sta_recvpriv.rxcache.iv[i])); -+ } -+ _rtw_memcpy(&psta->sta_recvpriv.nonqos_bmc_rxseq,&wRxSeqInitialValue,2); -+ _rtw_memcpy(&psta->sta_recvpriv.nonqos_rxseq,&wRxSeqInitialValue,2); -+ -+ rtw_init_timer(&psta->addba_retry_timer, psta->padapter, addba_timer_hdl, psta); -+#ifdef CONFIG_IEEE80211W -+ rtw_init_timer(&psta->dot11w_expire_timer, psta->padapter, sa_query_timer_hdl, 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->tid = i; -+ preorder_ctrl->enable = _FALSE; -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_CLEAR indicate_seq:%d\n" -+ , FUNC_ADPT_ARG(pstapriv->padapter), i, preorder_ctrl->indicate_seq); -+ #endif -+ preorder_ctrl->wend_b = 0xffff; -+ 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); -+ rtw_clear_bit(RTW_RECV_ACK_OR_TIMEOUT, &preorder_ctrl->rec_abba_rsp_ack); -+ -+ } -+ ATOMIC_SET(&psta->keytrack, 0); -+ -+ /* init for DM */ -+ psta->cmn.rssi_stat.rssi = (-1); -+ psta->cmn.rssi_stat.rssi_cck = (-1); -+ psta->cmn.rssi_stat.rssi_ofdm = (-1); -+#ifdef CONFIG_ATMEL_RC_PATCH -+ psta->flag_atmel_rc = 0; -+#endif -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ psta->tbtx_enable = _FALSE; -+#endif -+ /* init for the sequence number of received management frame */ -+ psta->RxMgmtFrameSeqNum = 0xffff; -+ _rtw_memset(&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ rtw_alloc_macid(pstapriv->padapter, psta); -+ -+ psta->tx_q_enable = 0; -+ _rtw_init_queue(&psta->tx_queue); -+ _init_workitem(&psta->tx_q_work, rtw_xmit_dequeue_callback, NULL); -+ } -+ -+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, *pdefrag_q = NULL; -+ 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; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int pending_qcnt[4]; -+ u8 is_pre_link_sta = _FALSE; -+ _list *phead, *plist; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ union recv_frame *prframe; -+ -+ if (psta == NULL) -+ goto exit; -+ -+#ifdef CONFIG_RTW_80211K -+ rm_post_event(padapter, RM_ID_FOR_ALL(psta->cmn.aid), RM_EV_cancel); -+#endif -+ -+ is_pre_link_sta = rtw_is_pre_link_sta(pstapriv, psta->cmn.mac_addr); -+ -+ if (is_pre_link_sta == _FALSE) { -+ _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); -+ } else { -+ _enter_critical_bh(&psta->lock, &irqL0); -+ psta->state = WIFI_FW_PRE_LINK; -+ _exit_critical_bh(&psta->lock, &irqL0); -+ } -+ -+ _enter_critical_bh(&psta->lock, &irqL0); -+ psta->state &= ~WIFI_ASOC_STATE; -+ _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); */ -+ -+ rtw_free_xmitframe_queue(pxmitpriv, &psta->tx_queue); -+ _rtw_deinit_queue(&psta->tx_queue); -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ rtw_free_xmitframe_queue(pxmitpriv, &psta->sleep_q); -+ psta->sleepq_len = 0; -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ rtw_free_mgmt_xmitframe_queue(pxmitpriv, &psta->mgmt_sleep_q); -+ psta->mgmt_sleepq_len = 0; -+#endif -+ -+ /* 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); */ -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ /* mgmt */ -+ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->mgmt_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->mgmt_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits + 4; -+ phwxmit->accnt -= pstaxmitpriv->mgmt_q.qcnt; -+ pstaxmitpriv->mgmt_q.qcnt = 0; -+#endif -+ -+ 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; -+#endif /* CONFIG_TDLS */ -+ -+ /* for A-MPDU Rx reordering buffer control, cancel reordering_ctrl_timer */ -+ for (i = 0; i < 16 ; i++) { -+ _irqL irqL; -+ _queue *ppending_recvframe_queue; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ rtw_clear_bit(RTW_RECV_ACK_OR_TIMEOUT, &preorder_ctrl->rec_abba_rsp_ack); -+ -+ _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); -+ -+ } -+ -+ /* CVE-2020-24586, clear defrag queue */ -+ pdefrag_q = &psta->sta_recvpriv.defrag_q; -+ enter_critical_bh(&pdefrag_q->lock); -+ phead = get_list_head(pdefrag_q); -+ 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(&pdefrag_q->lock); -+ -+ -+ if (!((psta->state & WIFI_AP_STATE) || MacAddr_isBcst(psta->cmn.mac_addr)) && is_pre_link_sta == _FALSE) -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _FALSE); -+ -+ -+ /* release mac id for non-bc/mc station, */ -+ if (is_pre_link_sta == _FALSE) -+ 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 -+ -+ if (pmlmeinfo->state == _HW_STATE_AP_) { -+ rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, psta->cmn.aid); -+ rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, psta->cmn.aid); -+ -+ /* rtw_indicate_sta_disassoc_event(padapter, psta); */ -+ -+ if ((psta->cmn.aid > 0) && (pstapriv->sta_aid[psta->cmn.aid - 1] == psta)) { -+ pstapriv->sta_aid[psta->cmn.aid - 1] = NULL; -+ psta->cmn.aid = 0; -+ } -+ } -+ -+#endif /* CONFIG_NATIVEAP_MLME */ -+ -+#if !defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && defined(CONFIG_80211N_HT) -+ psta->under_exist_checking = 0; -+#endif -+ -+#endif /* CONFIG_AP_MODE */ -+ -+ rtw_st_ctl_deinit(&psta->st_ctl); -+ -+ if (is_pre_link_sta == _FALSE) { -+ _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) { -+ if (rtw_is_pre_link_sta(pstapriv, psta->cmn.mac_addr) == _FALSE) -+ rtw_list_delete(&psta->hash_list); -+ -+ 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, const u8 *hwaddr) -+{ -+ -+ _irqL irqL; -+ -+ _list *plist, *phead; -+ -+ struct sta_info *psta = NULL; -+ -+ u32 index; -+ -+ const 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->cmn.mac_addr, 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; -+ -+ -+ psta = rtw_alloc_stainfo(pstapriv, bcast_addr); -+ -+ if (psta == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+#ifdef CONFIG_BEAMFORMING -+ psta->cmn.bf_info.g_id = 63; -+ psta->cmn.bf_info.p_aid = 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; -+ -+} -+ -+#ifdef CONFIG_AP_MODE -+u16 rtw_aid_alloc(_adapter *adapter, struct sta_info *sta) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ u16 aid, i, used_cnt = 0; -+ -+ for (i = 0; i < stapriv->max_aid; i++) { -+ aid = ((i + stapriv->started_aid - 1) % stapriv->max_aid) + 1; -+ if (stapriv->sta_aid[aid - 1] == NULL) -+ break; -+ if (++used_cnt >= stapriv->max_num_sta) -+ break; -+ } -+ -+ /* check for aid limit and assoc limit */ -+ if (i >= stapriv->max_aid || used_cnt >= stapriv->max_num_sta) -+ aid = 0; -+ -+ sta->cmn.aid = aid; -+ if (aid) { -+ stapriv->sta_aid[aid - 1] = sta; -+ if (stapriv->rr_aid) -+ stapriv->started_aid = (aid % stapriv->max_aid) + 1; -+ } -+ -+ return aid; -+} -+ -+void dump_aid_status(void *sel, _adapter *adapter) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ u8 *aid_bmp; -+ u16 i, used_cnt = 0; -+ -+ aid_bmp = rtw_zmalloc(stapriv->aid_bmp_len); -+ if (!aid_bmp) -+ return; -+ -+ for (i = 1; i <= stapriv->max_aid; i++) { -+ if (stapriv->sta_aid[i - 1]) { -+ aid_bmp[i / 8] |= BIT(i % 8); -+ ++used_cnt; -+ } -+ } -+ -+ RTW_PRINT_SEL(sel, "used_cnt:%u/%u\n", used_cnt, stapriv->max_aid); -+ RTW_MAP_DUMP_SEL(sel, "aid_map:", aid_bmp, stapriv->aid_bmp_len); -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "%-2s %-11s\n", "rr", "started_aid"); -+ RTW_PRINT_SEL(sel, "%2d %11d\n", stapriv->rr_aid, stapriv->started_aid); -+ -+ rtw_mfree(aid_bmp, stapriv->aid_bmp_len); -+} -+#endif /* CONFIG_AP_MODE */ -+ -+#if CONFIG_RTW_MACADDR_ACL -+const char *const _acl_period_str[RTW_ACL_PERIOD_NUM] = { -+ "DEV", -+ "BSS", -+}; -+ -+const char *const _acl_mode_str[RTW_ACL_MODE_MAX] = { -+ "DISABLED", -+ "ACCEPT_UNLESS_LISTED", -+ "DENY_UNLESS_LISTED", -+}; -+ -+u8 _rtw_access_ctrl(_adapter *adapter, u8 period, const 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; -+ _queue *acl_node_q; -+ -+ if (period >= RTW_ACL_PERIOD_NUM) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ acl = &stapriv->acl_list[period]; -+ acl_node_q = &acl->acl_node_q; -+ -+ if (acl->mode != RTW_ACL_MODE_ACCEPT_UNLESS_LISTED -+ && acl->mode != RTW_ACL_MODE_DENY_UNLESS_LISTED) -+ goto exit; -+ -+ _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 /* RTW_ACL_MODE_DENY_UNLESS_LISTED */ -+ res = (match == _TRUE) ? _TRUE : _FALSE; -+ -+exit: -+ return res; -+} -+ -+u8 rtw_access_ctrl(_adapter *adapter, const u8 *mac_addr) -+{ -+ int i; -+ -+ for (i = 0; i < RTW_ACL_PERIOD_NUM; i++) -+ if (_rtw_access_ctrl(adapter, i, mac_addr) == _FALSE) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+void dump_macaddr_acl(void *sel, _adapter *adapter) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl; -+ int i, j; -+ -+ for (j = 0; j < RTW_ACL_PERIOD_NUM; j++) { -+ RTW_PRINT_SEL(sel, "period:%s(%d)\n", acl_period_str(j), j); -+ -+ acl = &stapriv->acl_list[j]; -+ 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)); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ } -+} -+#endif /* CONFIG_RTW_MACADDR_ACL */ -+ -+bool rtw_is_pre_link_sta(struct sta_priv *stapriv, u8 *addr) -+{ -+#if CONFIG_RTW_PRE_LINK_STA -+ struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; -+ struct sta_info *sta = NULL; -+ u8 exist = _FALSE; -+ int i; -+ _irqL irqL; -+ -+ _enter_critical_bh(&(pre_link_sta_ctl->lock), &irqL); -+ for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) { -+ if (pre_link_sta_ctl->node[i].valid == _TRUE -+ && _rtw_memcmp(pre_link_sta_ctl->node[i].addr, addr, ETH_ALEN) == _TRUE -+ ) { -+ exist = _TRUE; -+ break; -+ } -+ } -+ _exit_critical_bh(&(pre_link_sta_ctl->lock), &irqL); -+ -+ return exist; -+#else -+ return _FALSE; -+#endif -+} -+ -+#if CONFIG_RTW_PRE_LINK_STA -+struct sta_info *rtw_pre_link_sta_add(struct sta_priv *stapriv, u8 *hwaddr) -+{ -+ struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; -+ struct pre_link_sta_node_t *node = NULL; -+ struct sta_info *sta = NULL; -+ u8 exist = _FALSE; -+ int i; -+ _irqL irqL; -+ -+ if (rtw_check_invalid_mac_address(hwaddr, _FALSE) == _TRUE) -+ goto exit; -+ -+ _enter_critical_bh(&(pre_link_sta_ctl->lock), &irqL); -+ for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) { -+ if (pre_link_sta_ctl->node[i].valid == _TRUE -+ && _rtw_memcmp(pre_link_sta_ctl->node[i].addr, hwaddr, ETH_ALEN) == _TRUE -+ ) { -+ node = &pre_link_sta_ctl->node[i]; -+ exist = _TRUE; -+ break; -+ } -+ -+ if (node == NULL && pre_link_sta_ctl->node[i].valid == _FALSE) -+ node = &pre_link_sta_ctl->node[i]; -+ } -+ -+ if (exist == _FALSE && node) { -+ _rtw_memcpy(node->addr, hwaddr, ETH_ALEN); -+ node->valid = _TRUE; -+ pre_link_sta_ctl->num++; -+ } -+ _exit_critical_bh(&(pre_link_sta_ctl->lock), &irqL); -+ -+ if (node == NULL) -+ goto exit; -+ -+ sta = rtw_get_stainfo(stapriv, hwaddr); -+ if (sta) -+ goto odm_hook; -+ -+ sta = rtw_alloc_stainfo(stapriv, hwaddr); -+ if (!sta) -+ goto exit; -+ -+ sta->state = WIFI_FW_PRE_LINK; -+ -+odm_hook: -+ rtw_hal_set_odm_var(stapriv->padapter, HAL_ODM_STA_INFO, sta, _TRUE); -+ -+exit: -+ return sta; -+} -+ -+void rtw_pre_link_sta_del(struct sta_priv *stapriv, u8 *hwaddr) -+{ -+ struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; -+ struct pre_link_sta_node_t *node = NULL; -+ struct sta_info *sta = NULL; -+ u8 exist = _FALSE; -+ int i; -+ _irqL irqL; -+ -+ if (rtw_check_invalid_mac_address(hwaddr, _FALSE) == _TRUE) -+ goto exit; -+ -+ _enter_critical_bh(&(pre_link_sta_ctl->lock), &irqL); -+ for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) { -+ if (pre_link_sta_ctl->node[i].valid == _TRUE -+ && _rtw_memcmp(pre_link_sta_ctl->node[i].addr, hwaddr, ETH_ALEN) == _TRUE -+ ) { -+ node = &pre_link_sta_ctl->node[i]; -+ exist = _TRUE; -+ break; -+ } -+ } -+ -+ if (exist == _TRUE && node) { -+ node->valid = _FALSE; -+ pre_link_sta_ctl->num--; -+ } -+ _exit_critical_bh(&(pre_link_sta_ctl->lock), &irqL); -+ -+ if (exist == _FALSE) -+ goto exit; -+ -+ sta = rtw_get_stainfo(stapriv, hwaddr); -+ if (!sta) -+ goto exit; -+ -+ if (sta->state == WIFI_FW_PRE_LINK) -+ rtw_free_stainfo(stapriv->padapter, sta); -+ -+exit: -+ return; -+} -+ -+void rtw_pre_link_sta_ctl_reset(struct sta_priv *stapriv) -+{ -+ struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; -+ struct pre_link_sta_node_t *node = NULL; -+ struct sta_info *sta = NULL; -+ int i, j = 0; -+ _irqL irqL; -+ -+ u8 addrs[RTW_PRE_LINK_STA_NUM][ETH_ALEN]; -+ -+ _rtw_memset(addrs, 0, RTW_PRE_LINK_STA_NUM * ETH_ALEN); -+ -+ _enter_critical_bh(&(pre_link_sta_ctl->lock), &irqL); -+ for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) { -+ if (pre_link_sta_ctl->node[i].valid == _FALSE) -+ continue; -+ _rtw_memcpy(&(addrs[j][0]), pre_link_sta_ctl->node[i].addr, ETH_ALEN); -+ pre_link_sta_ctl->node[i].valid = _FALSE; -+ pre_link_sta_ctl->num--; -+ j++; -+ } -+ _exit_critical_bh(&(pre_link_sta_ctl->lock), &irqL); -+ -+ for (i = 0; i < j; i++) { -+ sta = rtw_get_stainfo(stapriv, &(addrs[i][0])); -+ if (!sta) -+ continue; -+ -+ if (sta->state == WIFI_FW_PRE_LINK) -+ rtw_free_stainfo(stapriv->padapter, sta); -+ } -+} -+ -+void rtw_pre_link_sta_ctl_init(struct sta_priv *stapriv) -+{ -+ struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; -+ int i; -+ -+ _rtw_spinlock_init(&pre_link_sta_ctl->lock); -+ pre_link_sta_ctl->num = 0; -+ for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) -+ pre_link_sta_ctl->node[i].valid = _FALSE; -+} -+ -+void rtw_pre_link_sta_ctl_deinit(struct sta_priv *stapriv) -+{ -+ struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; -+ int i; -+ -+ rtw_pre_link_sta_ctl_reset(stapriv); -+ -+ _rtw_spinlock_free(&pre_link_sta_ctl->lock); -+} -+ -+void dump_pre_link_sta_ctl(void *sel, struct sta_priv *stapriv) -+{ -+ struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; -+ int i; -+ -+ RTW_PRINT_SEL(sel, "num:%d/%d\n", pre_link_sta_ctl->num, RTW_PRE_LINK_STA_NUM); -+ -+ for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) { -+ if (pre_link_sta_ctl->node[i].valid == _FALSE) -+ continue; -+ RTW_PRINT_SEL(sel, MAC_FMT"\n", MAC_ARG(pre_link_sta_ctl->node[i].addr)); -+ } -+} -+#endif /* CONFIG_RTW_PRE_LINK_STA */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_swcrypto.c b/drivers/net/wireless/rtl8821cs/core/rtw_swcrypto.c -new file mode 100644 -index 000000000..2f1c343b6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_swcrypto.c -@@ -0,0 +1,296 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#include -+#include -+#include -+ -+/** -+ * rtw_ccmp_encrypt - -+ * @key: the temporal key -+ * @hdrlen: mac header length -+ * @frame: the frame including the mac header, pn and payload -+ * @plen: payload length, i.e., length of the plain text, without PN and MIC -+ */ -+int _rtw_ccmp_encrypt(_adapter *padapter, u8 *key, u32 key_len, uint hdrlen, u8 *frame, uint plen) -+{ -+ u8 *enc = NULL; -+ size_t enc_len = 0; -+ -+ if (key_len == 16) { /* 128 bits */ -+ enc = ccmp_encrypt(padapter, key, -+ frame, -+ hdrlen + plen, -+ hdrlen, -+ (hdrlen == 26) ? (frame + hdrlen - 2) : NULL, -+ NULL, 0, &enc_len); -+ } else if (key_len == 32) { /* 256 bits */ -+ enc = ccmp_256_encrypt(padapter, key, -+ frame, -+ hdrlen + plen, -+ hdrlen, -+ (hdrlen == 26) ? (frame + hdrlen - 2) : NULL, -+ NULL, 0, &enc_len); -+ } -+ -+ if (enc == NULL) { -+ RTW_INFO("Failed to encrypt CCMP(%u) frame", key_len); -+ return _FAIL; -+ } -+ -+ /* Copy @enc back to @frame and free @enc */ -+ _rtw_memcpy(frame, enc, enc_len); -+ rtw_mfree(enc, enc_len + AES_BLOCK_SIZE); -+ -+ return _SUCCESS; -+} -+ -+ -+/** -+ * rtw_ccmp_decrypt - -+ * @key: the temporal key -+ * @hdrlen: length of the mac header -+ * @frame: the raw frame (@hdrlen + PN + enc_data + MIC) -+ * @plen: length of the frame (@hdrlen + PN + enc_data + MIC) -+ */ -+int _rtw_ccmp_decrypt(_adapter * padapter, u8 *key, u32 key_len, uint hdrlen, u8 *frame, -+ uint plen) -+{ -+ u8 *plain = NULL; -+ size_t plain_len = 0; -+ const struct ieee80211_hdr *hdr; -+ -+ hdr = (const struct ieee80211_hdr *)frame; -+ -+ if (key_len == 16) { /* 128 bits */ -+ plain = ccmp_decrypt(padapter, key, -+ hdr, -+ frame + hdrlen, /* PN + enc_data + MIC */ -+ plen - hdrlen, /* PN + enc_data + MIC */ -+ &plain_len); -+ } else if (key_len == 32) { /* 256 bits */ -+ plain = ccmp_256_decrypt(padapter, key, -+ hdr, -+ frame + hdrlen, /* PN + enc_data + MIC */ -+ plen - hdrlen, /* PN + enc_data + MIC */ -+ &plain_len); -+ } -+ -+ if (plain == NULL) { -+ RTW_INFO("Failed to decrypt CCMP(%u) frame", key_len); -+ return _FAIL; -+ } -+ -+ /* Copy @plain back to @frame and free @plain */ -+ _rtw_memcpy(frame + hdrlen + 8, plain, plain_len); -+ rtw_mfree(plain, plen - hdrlen + AES_BLOCK_SIZE); -+ -+ RTW_DBG_DUMP("ccmp_decrypt(): decrypted frame\n", -+ frame, hdrlen + 8 + plen); -+ -+ return _SUCCESS; -+} -+ -+ -+#ifdef CONFIG_RTW_MESH_AEK -+/* wrapper to ase_siv_encrypt and aes_siv_decrypt */ -+int _aes_siv_encrypt(const u8 *key, size_t key_len, -+ const u8 *pw, size_t pwlen, -+ size_t num_elem, const u8 *addr[], const size_t *len, u8 *out) -+{ -+ return aes_siv_encrypt(key, key_len, pw, pwlen, num_elem, addr, len, out); -+} -+int _aes_siv_decrypt(const u8 *key, size_t key_len, -+ const u8 *iv_crypt, size_t iv_c_len, -+ size_t num_elem, const u8 *addr[], const size_t *len, u8 *out) -+{ -+ return aes_siv_decrypt(key, key_len, iv_crypt, iv_c_len, num_elem, addr, len, out); -+} -+#endif -+ -+ -+/** -+ * _rtw_gcmp_encrypt - -+ * @key: the temporal key -+ * @hdrlen: mac header length -+ * @frame: the frame including the mac header, pn and payload -+ * @plen: payload length, i.e., length of the plain text, without PN and MIC -+ */ -+int _rtw_gcmp_encrypt(_adapter * padapter, u8 *key, u32 key_len, uint hdrlen, u8 *frame, uint plen) -+{ -+ u8 *enc = NULL; -+ size_t enc_len = 0; -+ -+ enc = gcmp_encrypt(padapter, key, key_len, -+ frame, -+ hdrlen + plen, -+ hdrlen, -+ (hdrlen == 26) ? (frame + hdrlen - 2) : NULL, -+ NULL, 0, &enc_len); -+ if (enc == NULL) { -+ RTW_INFO("Failed to encrypt GCMP frame"); -+ return _FAIL; -+ } -+ -+ /* Copy @enc back to @frame and free @enc */ -+ _rtw_memcpy(frame, enc, enc_len); -+ rtw_mfree(enc, enc_len + AES_BLOCK_SIZE); -+ -+ return _SUCCESS; -+} -+ -+ -+/** -+ * _rtw_gcmp_decrypt - -+ * @key: the temporal key -+ * @hdrlen: length of the mac header -+ * @frame: the raw frame (@hdrlen + PN + enc_data + MIC) -+ * @plen: length of the frame (@hdrlen + PN + enc_data + MIC) -+ */ -+int _rtw_gcmp_decrypt(_adapter *padapter, u8 *key, u32 key_len, uint hdrlen, u8 *frame, uint plen) -+{ -+ u8 *plain = NULL; -+ size_t plain_len = 0; -+ const struct ieee80211_hdr *hdr; -+ -+ hdr = (const struct ieee80211_hdr *)frame; -+ -+ plain = gcmp_decrypt(padapter, key, key_len, -+ hdr, -+ frame + hdrlen, /* PN + enc_data + MIC */ -+ plen - hdrlen, /* PN + enc_data + MIC */ -+ &plain_len); -+ -+ if (plain == NULL) { -+ RTW_INFO("Failed to decrypt GCMP(%u) frame", key_len); -+ return _FAIL; -+ } -+ -+ /* Copy @plain back to @frame and free @plain */ -+ _rtw_memcpy(frame + hdrlen + 8, plain, plain_len); -+ rtw_mfree(plain, plen - hdrlen + AES_BLOCK_SIZE); -+ -+ RTW_DBG_DUMP("gcmp_decipher(): decrypted frame\n", -+ frame, hdrlen + 8 + plen); -+ -+ return _SUCCESS; -+} -+ -+ -+#if defined(CONFIG_IEEE80211W) | defined(CONFIG_TDLS) -+u8 _bip_ccmp_protect(const u8 *key, size_t key_len, -+ const u8 *data, size_t data_len, u8 *mic) -+{ -+ u8 res = _SUCCESS; -+ -+ if (key_len == 16) { -+ if (omac1_aes_128(key, data, data_len, mic)) { -+ res = _FAIL; -+ RTW_ERR("%s : omac1_aes_128 fail!", __func__); -+ } -+ } else if (key_len == 32) { -+ if (omac1_aes_256(key, data, data_len, mic)) { -+ res = _FAIL; -+ RTW_ERR("%s : omac1_aes_256 fail!", __func__); -+ } -+ } else { -+ RTW_ERR("%s : key_len not match!", __func__); -+ res = _FAIL; -+ } -+ -+ return res; -+} -+ -+ -+u8 _bip_gcmp_protect(u8 *whdr_pos, size_t len, -+ const u8 *key, size_t key_len, -+ const u8 *data, size_t data_len, u8 *mic) -+{ -+ u8 res = _SUCCESS; -+ u32 mic_len = 16; -+ u8 nonce[12], *npos; -+ const u8 *gcmp_ipn; -+ -+ gcmp_ipn = whdr_pos + len - mic_len - 6; -+ -+ /* Nonce: A2 | IPN */ -+ _rtw_memcpy(nonce, get_addr2_ptr(whdr_pos), ETH_ALEN); -+ npos = nonce + ETH_ALEN; -+ *npos++ = gcmp_ipn[5]; -+ *npos++ = gcmp_ipn[4]; -+ *npos++ = gcmp_ipn[3]; -+ *npos++ = gcmp_ipn[2]; -+ *npos++ = gcmp_ipn[1]; -+ *npos++ = gcmp_ipn[0]; -+ -+ if (aes_gmac(key, key_len, nonce, sizeof(nonce), -+ data, data_len, mic)) { -+ res = _FAIL; -+ RTW_ERR("%s : aes_gmac fail!", __func__); -+ } -+ -+ return res; -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+ -+#ifdef CONFIG_TDLS -+void _tdls_generate_tpk(void *sta, const u8 *own_addr, const u8 *bssid) -+{ -+ struct sta_info *psta = (struct sta_info *)sta; -+ u8 *SNonce = psta->SNonce; -+ u8 *ANonce = psta->ANonce; -+ -+ u8 key_input[SHA256_MAC_LEN]; -+ const 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 (_rtw_memcmp2(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 = KDF-Hash-Length(TPK-Key-Input, "TDLS PMK", -+ * min(MAC_I, MAC_R) || max(MAC_I, MAC_R) || BSSID) -+ */ -+ -+ if (_rtw_memcmp2(own_addr, psta->cmn.mac_addr, ETH_ALEN) < 0) { -+ _rtw_memcpy(data, own_addr, ETH_ALEN); -+ _rtw_memcpy(data + ETH_ALEN, psta->cmn.mac_addr, ETH_ALEN); -+ } else { -+ _rtw_memcpy(data, psta->cmn.mac_addr, ETH_ALEN); -+ _rtw_memcpy(data + ETH_ALEN, own_addr, ETH_ALEN); -+ } -+ -+ _rtw_memcpy(data + 2 * ETH_ALEN, bssid, ETH_ALEN); -+ -+ sha256_prf(key_input, SHA256_MAC_LEN, "TDLS PMK", data, sizeof(data), (u8 *)&psta->tpk, sizeof(psta->tpk)); -+} -+#endif /* CONFIG_TDLS */ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_tdls.c b/drivers/net/wireless/rtl8821cs/core/rtw_tdls.c -new file mode 100644 -index 000000000..9973c17ce ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_tdls.c -@@ -0,0 +1,3523 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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]; -+ -+inline void rtw_tdls_set_link_established(_adapter *adapter, bool en) -+{ -+ adapter->tdlsinfo.link_established = en; -+ rtw_mi_update_iface_status(&(adapter->mlmepriv), 0); -+} -+ -+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; -+ -+ rtw_tdls_set_link_established(padapter, _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 -+ -+ ptdlsinfo->tdls_sctx = NULL; -+} -+ -+int rtw_init_tdls_info(_adapter *padapter) -+{ -+ int res = _SUCCESS; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ rtw_reset_tdls_info(padapter); -+ -+#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)); -+ -+} -+ -+void rtw_free_all_tdls_sta(_adapter *padapter, u8 enqueue_cmd) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ _irqL irqL; -+ _list *plist, *phead; -+ s32 index; -+ struct sta_info *psta = NULL; -+ struct sta_info *ptdls_sta[NUM_STA]; -+ u8 empty_hwaddr[ETH_ALEN] = { 0x00 }; -+ -+ _rtw_memset(ptdls_sta, 0x00, sizeof(ptdls_sta)); -+ -+ _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) -+ ptdls_sta[index] = psta; -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (index = 0; index < NUM_STA; index++) { -+ if (ptdls_sta[index]) { -+ struct TDLSoption_param tdls_param; -+ -+ psta = ptdls_sta[index]; -+ -+ RTW_INFO("Do tear down to "MAC_FMT" by enqueue_cmd = %d\n", MAC_ARG(psta->cmn.mac_addr), enqueue_cmd); -+ -+ _rtw_memcpy(&(tdls_param.addr), psta->cmn.mac_addr, ETH_ALEN); -+ tdls_param.option = TDLS_TEARDOWN_STA_NO_WAIT; -+ tdls_hdl(padapter, (unsigned char *)&(tdls_param)); -+ -+ rtw_tdls_teardown_pre_hdl(padapter, psta); -+ -+ if (enqueue_cmd == _TRUE) -+ rtw_tdls_cmd(padapter, psta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); -+ else -+ { -+ tdls_param.option = TDLS_TEARDOWN_STA_LOCALLY_POST; -+ tdls_hdl(padapter, (unsigned char *)&(tdls_param)); -+ } -+ } -+ } -+} -+ -+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_is_tdls_enabled(_adapter *padapter) -+{ -+ return padapter->registrypriv.en_tdls; -+} -+ -+void rtw_set_tdls_enable(_adapter *padapter, u8 enable) -+{ -+ padapter->registrypriv.en_tdls = enable; -+ RTW_INFO("%s: en_tdls = %d\n", __func__, rtw_is_tdls_enabled(padapter)); -+} -+ -+void rtw_enable_tdls_func(_adapter *padapter) -+{ -+ if (rtw_is_tdls_enabled(padapter) == _TRUE) -+ return; -+ -+#if 0 -+#ifdef CONFIG_MCC_MODE -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC) == _TRUE) { -+ RTW_INFO("[TDLS] MCC is running, can't enable TDLS !\n"); -+ return; -+ } -+#endif -+#endif -+ rtw_set_tdls_enable(padapter, _TRUE); -+} -+ -+void rtw_disable_tdls_func(_adapter *padapter, u8 enqueue_cmd) -+{ -+ if (rtw_is_tdls_enabled(padapter) == _FALSE) -+ return; -+ -+ rtw_free_all_tdls_sta(padapter, enqueue_cmd); -+ rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); -+ rtw_reset_tdls_info(padapter); -+ -+ rtw_set_tdls_enable(padapter, _FALSE); -+} -+ -+u8 rtw_is_tdls_sta_existed(_adapter *padapter) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ int i = 0; -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 ret = _FALSE; -+ -+ if (rtw_is_tdls_enabled(padapter) == _FALSE) -+ return _FALSE; -+ -+ _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) { -+ ret = _TRUE; -+ goto Exit; -+ } -+ } -+ } -+ -+Exit: -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ return ret; -+} -+ -+u8 rtw_tdls_is_setup_allowed(_adapter *padapter) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ if (is_client_associated_to_ap(padapter) == _FALSE) -+ return _FALSE; -+ -+ 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_ms) -+{ -+ 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++; -+ set_frame_sub_type(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_ms) -+ ret = dump_mgntframe_and_wait_ack_timeout(padapter, pmgntframe, wait_ms); -+ 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; -+ systime 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->cmn.mac_id); -+ else -+ rtw_hal_macid_wakeup(padapter, psta->cmn.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); -+ -+ 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; -+} -+ -+/* 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; -+ return; -+ } -+ -+ if (ptdls_sta->flags & WLAN_STA_HT) { -+ if (padapter->registrypriv.ht_enable == _TRUE && is_supported_ht(padapter->registrypriv.wireless_mode) ) { -+ 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 ((phtpriv->sgi_20m == _TRUE) && (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 ((phtpriv->sgi_40m == _TRUE) && (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->cmn.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); -+ -+ if (padapter->registrypriv.wifi_spec == 1) { -+ padapter->mlmepriv.htpriv.sgi_20m = _FALSE; -+ padapter->mlmepriv.htpriv.sgi_40m = _FALSE; -+ } -+ -+ rtw_restructure_ht_ie(padapter, NULL, pframe, 0, &(pattrib->pktlen), padapter->mlmeextpriv.cur_channel, NULL); -+ -+ 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 rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, tx_nss = 0; -+ u16 cur_beamform_cap = 0; -+ u8 *pcap_mcs; -+ -+ _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; -+ return; -+ } -+ -+ if (ptdls_sta->flags & WLAN_STA_VHT) { -+ if (REGSTY_IS_11AC_ENABLE(&padapter->registrypriv) -+ && is_supported_vht(padapter->registrypriv.wireless_mode) -+ && RFCTL_REG_EN_11AC(rfctl) -+ ) { -+ ptdls_sta->vhtpriv.vht_option = _TRUE; -+ ptdls_sta->cmn.ra_info.is_vht_enable = _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; -+ -+ #ifdef CONFIG_BEAMFORMING -+ /* 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; -+ ptdls_sta->cmn.bf_info.vht_beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) -+ RTW_INFO("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); -+ #endif /*CONFIG_BEAMFORMING*/ -+ -+ /* 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); -+ tx_nss = GET_HAL_TX_NSS(padapter); -+ rtw_vht_nss_to_mcsmap(tx_nss, ptdls_sta->vhtpriv.vht_mcs_map, pcap_mcs); -+ ptdls_sta->vhtpriv.vht_highest_rate = rtw_get_vht_highest_rate(ptdls_sta->vhtpriv.vht_mcs_map); -+} -+ -+void rtw_tdls_process_vht_operation(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct registry_priv *regsty = adapter_to_regsty(padapter); -+ u8 operation_bw = 0; -+ -+ if (GET_VHT_OPERATION_ELE_CHL_WIDTH(data) >= 1) { -+ -+ operation_bw = CHANNEL_WIDTH_80; -+ -+ if (hal_is_bw_support(padapter, operation_bw) && REGSTY_IS_BW_5G_SUPPORT(regsty, operation_bw) -+ && (operation_bw <= pmlmeext->cur_bwmode)) -+ ptdls_sta->cmn.bw_mode = operation_bw; -+ else -+ ptdls_sta->cmn.bw_mode = pmlmeext->cur_bwmode; -+ } else -+ ptdls_sta->cmn.bw_mode = pmlmeext->cur_bwmode; -+} -+ -+void rtw_tdls_process_vht_op_mode_notify(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) -+{ -+ 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; -+ -+ if (pvhtpriv->vht_option == _FALSE) -+ return; -+ -+ target_bw = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(data); -+ target_rxss = (GET_VHT_OPERATING_MODE_FIELD_RX_NSS(data) + 1); -+ -+ if (hal_is_bw_support(padapter, target_bw) && REGSTY_IS_BW_5G_SUPPORT(regsty, target_bw) -+ && (target_bw <= pmlmeext->cur_bwmode)) -+ ptdls_sta->cmn.bw_mode = target_bw; -+ else -+ ptdls_sta->cmn.bw_mode = pmlmeext->cur_bwmode; -+ -+ current_rxss = rtw_vht_mcsmap_to_nss(ptdls_sta->vhtpriv.vht_mcs_map); -+ if (target_rxss != current_rxss) { -+ u8 vht_mcs_map[2] = {}; -+ -+ rtw_vht_nss_to_mcsmap(target_rxss, vht_mcs_map, ptdls_sta->vhtpriv.vht_mcs_map); -+ _rtw_memcpy(ptdls_sta->vhtpriv.vht_mcs_map, vht_mcs_map, 2); -+ } -+} -+ -+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(_adapter *adapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ u8 sup_ch[30 * 2] = {0x00}, ch_set_idx = 0, sup_ch_idx = 2; -+ -+ while (ch_set_idx < rfctl->max_chan_nums && rfctl->channel_set[ch_set_idx].ChannelNum != 0) { -+ if (rfctl->channel_set[ch_set_idx].ChannelNum <= 14) { -+ /* TODO: fix 2.4G supported channel when channel doesn't start from 1 and continuous */ -+ sup_ch[0] = 1; /* First channel number */ -+ sup_ch[1] = rfctl->channel_set[ch_set_idx].ChannelNum; /* Number of channel */ -+ } else { -+ sup_ch[sup_ch_idx++] = rfctl->channel_set[ch_set_idx].ChannelNum; -+ sup_ch[sup_ch_idx++] = 1; -+ } -+ ch_set_idx++; -+ } -+ -+ 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, WLAN_EID_EXT_CAP , 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_, TDLS_FTIE_DATA_LEN, -+ (u8 *)FTIE.data, &(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(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib, u8 init) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ u8 link_id_addr[18] = {0}; -+ -+ _rtw_memcpy(link_id_addr, get_my_bssid(&(pmlmeinfo->network)), 6); -+ -+ if (init == _TRUE) { -+ _rtw_memcpy((link_id_addr + 6), pattrib->src, 6); -+ _rtw_memcpy((link_id_addr + 12), pattrib->dst, 6); -+ } else { -+ _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) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 bcn_early_case; -+ -+ if (enable == _TRUE) { -+#ifdef CONFIG_TDLS_CH_SW_V2 -+ pHalData->ch_switch_offload = _TRUE; -+#endif -+ -+#ifdef CONFIG_TDLS_CH_SW_BY_DRV -+ pHalData->ch_switch_offload = _FALSE; -+#endif -+ bcn_early_case = TDLS_BCN_ERLY_ON; -+ } -+ else { -+ pHalData->ch_switch_offload = _FALSE; -+ bcn_early_case = TDLS_BCN_ERLY_OFF; -+ } -+ -+ 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_BCN_EARLY_C2H_RPT, &enable); -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_DRV_ERLY_INT, &bcn_early_case); -+ 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); -+} -+ -+#ifndef CONFIG_TDLS_CH_SW_V2 -+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); -+} -+#endif -+ -+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()); -+ -+ /* set mac_id sleep before channel switch */ -+ rtw_hal_macid_sleep(padapter, ptdls_sta->cmn.mac_id); -+ -+#if defined(CONFIG_TDLS_CH_SW_BY_DRV) || defined(CONFIG_TDLS_CH_SW_V2) -+ set_channel_bwmode(padapter, channel, channel_offset, bwmode); -+ ret = _SUCCESS; -+#else -+ rtw_tdls_chsw_oper_init(padapter, TDLS_CH_SWITCH_OPER_OFFLOAD_TIMEOUT); -+ -+ /* 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->current_channel = center_ch; -+ pHalData->CurrentCenterFrequencyIndex1 = center_ch; -+ pHalData->current_channel_bw = 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); -+ -+ ret = _SUCCESS; -+ } else -+ RTW_INFO("[TDLS] chsw oper wait fail !!\n"); -+ } -+#endif -+ -+ if (ret == _SUCCESS) { -+ 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); -+ } -+ } -+ -+ /* set mac_id wakeup after channel switch */ -+ rtw_hal_macid_wakeup(padapter, ptdls_sta->cmn.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__); -+ -+ if (rtw_tdls_is_setup_allowed(padapter) == _FALSE) -+ goto exit; -+ -+ if (IS_MCAST(ptxmgmt->peer)) -+ goto exit; -+ -+ ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer); -+ if (ptdlsinfo->sta_maximum == _TRUE) { -+ if (ptdls_sta == NULL) -+ goto exit; -+ else if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) -+ goto exit; -+ } -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ 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; -+ } -+ ptdlsinfo->sta_cnt++; -+ } -+ -+ ptxmgmt->action_code = TDLS_SETUP_REQUEST; -+ -+ 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); -+ -+ 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, struct sta_info *ptdls_sta, 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; -+ _irqL irqL; -+ int ret = _FAIL; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_TEARDOWN; -+ -+ 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); -+ -+ if (ptxmgmt->status_code == _RSON_TDLS_TEAR_UN_RSN_) -+ _rtw_memcpy(pattrib->ra, ptxmgmt->peer, ETH_ALEN); -+ else -+ _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; -+ } -+ -+exit: -+ -+ return ret; -+} -+ -+int issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack) -+{ -+ struct sta_info *ptdls_sta = NULL; -+ int ret = _FAIL; -+ -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), ptxmgmt->peer); -+ if (ptdls_sta == NULL) { -+ RTW_INFO("No tdls_sta for tearing down\n"); -+ goto exit; -+ } -+ -+ ret = _issue_tdls_teardown(padapter, ptxmgmt, ptdls_sta, 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, ptdls_sta, wait_ack); -+ } -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); -+ rtw_tdls_cmd(padapter, ptxmgmt->peer, TDLS_TEARDOWN_STA_LOCALLY_POST); -+ } -+ -+exit: -+ 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++; -+ set_frame_sub_type(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->cmn.mac_addr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, ptdls_sta->cmn.mac_addr, 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->cmn.mac_addr, 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->cmn.mac_addr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, ptdls_sta->cmn.mac_addr, 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 rssi = 0; -+ struct tdls_txmgmt txmgmt; -+ int ret = _SUCCESS; -+ -+ if (psta) -+ rssi = psta->cmn.rssi_stat.rssi; -+ -+ _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.rx_pwdb_all; -+ } else { -+ if (ptdlsinfo->ss_record.RxPWDBAll < pattrib->phy_info.rx_pwdb_all) { -+ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); -+ ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.rx_pwdb_all; -+ } -+ } -+ } -+ } 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.rx_pwdb_all > 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; -+ } -+ } -+ } -+ -+ -+ if (pattrib->phy_info.rx_pwdb_all + TDLS_SIGNAL_THRESH >= rssi) { -+ RTW_INFO("pattrib->RxPWDBAll=%d, pdmpriv->undecorated_smoothed_pwdb=%d\n", pattrib->phy_info.rx_pwdb_all, rssi); -+ _rtw_memcpy(txmgmt.peer, psa, ETH_ALEN); -+ issue_tdls_setup_req(padapter, &txmgmt, _FALSE); -+ } -+ } -+exit: -+#endif /* CONFIG_TDLS_AUTOSETUP */ -+ -+ return ret; -+ -+} -+ -+sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ u8 *psa, *pmyid; -+ 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); -+ -+ if (ptdlsinfo->sta_maximum == _TRUE) { -+ if (ptdls_sta == NULL) -+ goto exit; -+ else if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) -+ goto exit; -+ } -+ -+ 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; -+ -+ if (ptdls_sta == NULL) { -+ ptdls_sta = rtw_alloc_stainfo(pstapriv, psa); -+ if (ptdls_sta == NULL) -+ goto exit; -+ -+ ptdlsinfo->sta_cnt++; -+ } -+ 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_: -+ if (pIE->Length <= sizeof(supportRate)) { -+ _rtw_memcpy(supportRate, pIE->data, pIE->Length); -+ supportRateNum = pIE->Length; -+ } -+ break; -+ case WLAN_EID_COUNTRY: -+ break; -+ case _EXT_SUPPORTEDRATES_IE_: -+ if ((supportRateNum + pIE->Length) <= 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; -+ if (pIE->Length <= sizeof(ptdls_sta->TDLS_RSNIE)) { -+ /* 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 WLAN_EID_EXT_CAP: -+ 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); -+ -+ /* -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 { -+ rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); -+ } -+ } -+ -+exit: -+ -+ return _SUCCESS; -+} -+ -+int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ 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); -+ -+ 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; -+ -+ _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); -+ rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); -+ 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_: -+ if (pIE->Length <= sizeof(supportRate)) { -+ _rtw_memcpy(supportRate, pIE->data, pIE->Length); -+ supportRateNum = pIE->Length; -+ } -+ break; -+ case WLAN_EID_COUNTRY: -+ break; -+ case _EXT_SUPPORTEDRATES_IE_: -+ if ((supportRateNum + pIE->Length) <= 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 WLAN_EID_EXT_CAP: -+ 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_tdls_process_vht_op_mode_notify(padapter, ptdls_sta, pIE->data, pIE->Length); -+ 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 (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__); -+ rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); -+ 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_) { -+ rtw_tdls_set_link_established(padapter, _TRUE); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) { -+ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; -+ ptdls_sta->state |= WIFI_ASOC_STATE; -+ _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->cmn.mac_addr, 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 sta_info *ptdls_sta) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ 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); -+ -+ 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; -+ -+ _rtw_memcpy(&status_code, ptr + 2, 2); -+ -+ if (status_code != 0) { -+ RTW_INFO("[%s] status_code = %d\n, free_tdls_sta", __FUNCTION__, status_code); -+ rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); -+ 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: -+ rtw_tdls_process_vht_operation(padapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+ case EID_OpModeNotification: -+ rtw_tdls_process_vht_op_mode_notify(padapter, ptdls_sta, pIE->data, pIE->Length); -+ 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)) { -+ rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ rtw_tdls_set_link_established(padapter, _TRUE); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) { -+ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; -+ ptdls_sta->state |= WIFI_ASOC_STATE; -+ _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->cmn.mac_addr, 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; -+ -+ /* 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, ETH_ALEN) == _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, struct sta_info *ptdls_sta) -+{ -+ 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; -+ _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); -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); -+ } -+ -+ 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 sta_info *ptdls_sta) -+{ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ 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)); -+ -+ txmgmt.dialog_token = *(ptr + 2); -+ issue_tdls_peer_traffic_rsp(padapter, ptdls_sta, &txmgmt); -+ /* issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->cmn.mac_addr, 0, 0, 0); */ -+ -+ 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 sta_info *ptdls_sta) -+{ -+ 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; -+ 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 sta_info *ptdls_sta) -+{ -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ 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; -+ sint parsing_length; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 4; -+ u16 j; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ 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; -+ } -+ -+ 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; -+ -+ 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); -+ } -+ -+#ifndef CONFIG_TDLS_CH_SW_V2 -+ 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->cmn.mac_addr, TDLS_CH_SW_PREPARE); -+ -+ return _FAIL; -+ } -+ } -+#endif -+ -+ /* 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); -+ -+ if (_rtw_memcmp(pchsw_info->addr, zaddr, ETH_ALEN) == _TRUE) -+ _rtw_memcpy(pchsw_info->addr, ptdls_sta->cmn.mac_addr, ETH_ALEN); -+ -+ if (ATOMIC_READ(&pchsw_info->chsw_on) == _FALSE) -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_START); -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_RESP); -+ -+ return _SUCCESS; -+} -+ -+sint On_TDLS_Ch_Switch_Rsp(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) -+{ -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ 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; -+ 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; -+ } -+ -+ /* 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->cmn.mac_addr, 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; -+ -+ _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->cmn.mac_addr, 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->cmn.mac_addr, 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; -+ u16 v16 = 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 ) */ -+ v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL -+ | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, v16); -+ 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, WIFI_ASOC_STATE) == _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 sta_info *ptdls_sta) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ 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, 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(padapter, 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) -+ && is_supported_vht(pregistrypriv->wireless_mode) -+ && RFCTL_REG_EN_11AC(rfctl) -+ ) { -+ 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 sta_info *ptdls_sta) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 k; /* for random ANonce */ -+ u8 *pftie = NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL; -+ u32 time; -+ u8 *pframe_head; -+ -+ if (pattrib->encrypt) { -+ 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, 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(padapter, 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) -+ && is_supported_vht(pregistrypriv->wireless_mode) -+ && RFCTL_REG_EN_11AC(rfctl) -+ ) { -+ 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 sta_info *ptdls_sta) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ 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; -+ -+ 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(padapter, 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) -+ && is_supported_vht(pregistrypriv->wireless_mode) -+ && RFCTL_REG_EN_11AC(rfctl) -+ ) { -+ 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 sta_info *ptdls_sta) -+{ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ 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(padapter, pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(padapter, 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(padapter, 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(padapter, 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(padapter, pframe, pattrib, _FALSE); -+ -+} -+ -+ -+void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 AC_queue = 0; -+ -+ 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(padapter, pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(padapter, 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 sta_info *ptdls_sta) -+{ -+ -+ 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); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(padapter, 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 sta_info *ptdls_sta) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ 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(padapter, pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(padapter, 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 sta_info *ptdls_sta) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ 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(padapter, pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(padapter, 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->cmn.mac_addr)); -+ ptdls_sta->TPK_count = 0; -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->cmn.mac_addr, 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->cmn.mac_addr, 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->cmn.mac_addr, 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 = NULL; -+ struct tdls_txmgmt txmgmt; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->cmn.mac_addr, ETH_ALEN); -+ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; -+ -+ if (ptdls_sta != NULL) { -+ padapter = ptdls_sta->padapter; -+ -+ RTW_INFO("[TDLS] Handshake time out\n"); -+ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA); -+ else -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY); -+ } -+} -+ -+void _tdls_pti_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = NULL; -+ struct tdls_txmgmt txmgmt; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->cmn.mac_addr, ETH_ALEN); -+ txmgmt.status_code = _RSON_TDLS_TEAR_TOOFAR_; -+ -+ if (ptdls_sta != NULL) { -+ padapter = ptdls_sta->padapter; -+ -+ 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->cmn.mac_addr)); -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA); -+ } -+ } -+} -+ -+void rtw_init_tdls_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ psta->padapter = padapter; -+ rtw_init_timer(&psta->TPK_timer, padapter, _tdls_tpk_timer_hdl, psta); -+#ifdef CONFIG_TDLS_CH_SW -+ rtw_init_timer(&psta->ch_sw_timer, padapter, _tdls_ch_switch_timer_hdl, psta); -+ rtw_init_timer(&psta->delay_timer, padapter, _tdls_delay_timer_hdl, psta); -+ rtw_init_timer(&psta->stay_on_base_chnl_timer, padapter, _tdls_stay_on_base_chnl_timer_hdl, psta); -+ rtw_init_timer(&psta->ch_sw_monitor_timer, padapter, _tdls_ch_switch_monitor_timer_hdl, psta); -+#endif -+ rtw_init_timer(&psta->handshake_timer, padapter, _tdls_handshake_timer_hdl, psta); -+ rtw_init_timer(&psta->pti_timer, padapter, _tdls_pti_timer_hdl, psta); -+} -+ -+void rtw_cancel_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); -+} -+ -+void rtw_tdls_teardown_pre_hdl(_adapter *padapter, struct sta_info *psta) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ _irqL irqL; -+ -+ rtw_cancel_tdls_timer(psta); -+ -+ _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 < MAX_ALLOWED_TDLS_STA_NUM) { -+ ptdlsinfo->sta_maximum = _FALSE; -+ _rtw_memset(&ptdlsinfo->ss_record, 0x00, sizeof(struct tdls_ss_record)); -+ } -+ -+ if (ptdlsinfo->sta_cnt == 0) -+ rtw_tdls_set_link_established(padapter, _FALSE); -+ else -+ RTW_INFO("Remain tdls sta:%02x\n", ptdlsinfo->sta_cnt); -+} -+ -+void rtw_tdls_teardown_post_hdl(_adapter *padapter, struct sta_info *psta, u8 enqueue_cmd) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ /* Clear cam */ -+ rtw_clearstakey_cmd(padapter, psta, enqueue_cmd); -+ -+ /* Update sta media status */ -+ if (enqueue_cmd) -+ rtw_sta_media_status_rpt_cmd(padapter, psta, 0); -+ else -+ rtw_sta_media_status_rpt(padapter, psta, 0); -+ -+ /* Set RCR if necessary */ -+ if (ptdlsinfo->sta_cnt == 0) { -+ if (enqueue_cmd) -+ rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); -+ else -+ rtw_hal_rcr_set_chk_bssid(padapter, MLME_TDLS_NOLINK); -+ } -+ -+ /* Free tdls sta info */ -+ rtw_free_stainfo(padapter, psta); -+} -+ -+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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_vht.c b/drivers/net/wireless/rtl8821cs/core/rtw_vht.c -new file mode 100755 -index 000000000..cd35aebdb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_vht.c -@@ -0,0 +1,1282 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#include -+#include -+ -+#ifdef CONFIG_80211AC_VHT -+const u16 _vht_max_mpdu_len[] = { -+ 3895, -+ 7991, -+ 11454, -+ 0, -+}; -+ -+const u8 _vht_sup_ch_width_set_to_bw_cap[] = { -+ BW_CAP_80M, -+ BW_CAP_80M | BW_CAP_160M, -+ BW_CAP_80M | BW_CAP_160M | BW_CAP_80_80M, -+ 0, -+}; -+ -+#ifdef CONFIG_RTW_DEBUG -+const char *const _vht_sup_ch_width_set_str[] = { -+ "80MHz", -+ "160MHz", -+ "160MHz & 80+80MHz", -+ "BW-RSVD", -+}; -+ -+void dump_vht_cap_ie_content(void *sel, const u8 *buf, u32 buf_len) -+{ -+ if (buf_len != VHT_CAP_IE_LEN) { -+ RTW_PRINT_SEL(sel, "Invalid VHT capability IE len:%d != %d\n", buf_len, VHT_CAP_IE_LEN); -+ return; -+ } -+ -+ RTW_PRINT_SEL(sel, "cap_info:%02x %02x %02x %02x: MAX_MPDU_LEN:%u %s%s%s%s%s RX-STBC:%u MAX_AMPDU_LEN:%u\n" -+ , *(buf), *(buf + 1), *(buf + 2), *(buf + 3) -+ , vht_max_mpdu_len(GET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(buf)) -+ , vht_sup_ch_width_set_str(GET_VHT_CAPABILITY_ELE_CHL_WIDTH(buf)) -+ , GET_VHT_CAPABILITY_ELE_RX_LDPC(buf) ? " RX-LDPC" : "" -+ , GET_VHT_CAPABILITY_ELE_SHORT_GI80M(buf) ? " SGI-80" : "" -+ , GET_VHT_CAPABILITY_ELE_SHORT_GI160M(buf) ? " SGI-160" : "" -+ , GET_VHT_CAPABILITY_ELE_TX_STBC(buf) ? " TX-STBC" : "" -+ , GET_VHT_CAPABILITY_ELE_RX_STBC(buf) -+ , VHT_MAX_AMPDU_LEN(GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(buf)) -+ ); -+} -+ -+void dump_vht_cap_ie(void *sel, const u8 *ie, u32 ie_len) -+{ -+ const u8 *vht_cap_ie; -+ sint vht_cap_ielen; -+ -+ vht_cap_ie = rtw_get_ie(ie, WLAN_EID_VHT_CAPABILITY, &vht_cap_ielen, ie_len); -+ if (!ie || vht_cap_ie != ie) -+ return; -+ -+ dump_vht_cap_ie_content(sel, vht_cap_ie + 2, vht_cap_ielen); -+} -+ -+const char *const _vht_op_ch_width_str[] = { -+ "20 or 40MHz", -+ "80MHz", -+ "160MHz", -+ "80+80MHz", -+ "BW-RSVD", -+}; -+ -+void dump_vht_op_ie_content(void *sel, const u8 *buf, u32 buf_len) -+{ -+ if (buf_len != VHT_OP_IE_LEN) { -+ RTW_PRINT_SEL(sel, "Invalid VHT operation IE len:%d != %d\n", buf_len, VHT_OP_IE_LEN); -+ return; -+ } -+ -+ RTW_PRINT_SEL(sel, "\tVHT Operation Info:\n"); -+ RTW_PRINT_SEL(sel, "\tChannel Width: %u\n" -+ , GET_VHT_OPERATION_ELE_CHL_WIDTH(buf)); -+ RTW_PRINT_SEL(sel, "\tCenter Frequency Channel for 80 and 160 MHz Operation: %u\n" -+ , GET_VHT_OPERATION_ELE_CENTER_FREQ1(buf)); -+ RTW_PRINT_SEL(sel, "\tCenter Frequency Channel for 80+80 MHz Operation: %u\n" -+ , GET_VHT_OPERATION_ELE_CENTER_FREQ2(buf)); -+ RTW_PRINT_SEL(sel, "\tVHT Basic MCS Set: 0x%04x\n" -+ , GET_VHT_OPERATION_ELE_BASIC_MCS_SET(buf)); -+} -+ -+void dump_vht_op_ie(void *sel, const u8 *ie, u32 ie_len) -+{ -+ const u8 *vht_op_ie; -+ sint vht_op_ielen; -+ -+ vht_op_ie = rtw_get_ie(ie, WLAN_EID_VHT_OPERATION, &vht_op_ielen, ie_len); -+ if (!ie || vht_op_ie != ie) -+ return; -+ -+ dump_vht_op_ie_content(sel, vht_op_ie + 2, vht_op_ielen); -+} -+#endif -+ -+/* 20/40/80, ShortGI, MCS Rate */ -+const u16 VHT_MCS_DATA_RATE[3][2][40] = { /* unit: 0.5M */ -+ { { -+ 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, -+ 52, 104, 156, 208, 312, 416, 468, 520, 624, 624, -+ }, /* 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, -+ 58, 116, 173, 231, 347, 462, 520, 578, 693, 693, -+ } -+ }, /* 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, -+ 108, 216, 324, 432, 648, 864, 972, 1080, 1296, 1440, -+ }, /* 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, -+ 120, 240, 360, 480, 720, 960, 1080, 1200, 1440, 1600, -+ } -+ }, /* 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, -+ 234, 468, 702, 936, 1404, 1872, 2106, 2340, 2808, 3120, -+ }, /* 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, -+ 260, 520, 780, 1040, 1560, 2080, 2340, 2600, 3120, 3467, -+ } -+ } /* 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_VHT4SS_MCS9) -+ vht_mcs_rate = MGN_VHT4SS_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 tx_nss, rx_nss; -+ u8 rf_type = 0; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ pvhtpriv->sgi_80m = 0; -+ pvhtpriv->sgi_160m = 0; -+ pvhtpriv->txop_ps = 0; -+ pvhtpriv->htc_vht = 1; -+ pvhtpriv->link_adap_cap = 0; -+ pvhtpriv->tx_ant_pattern= 0; -+ pvhtpriv->rx_ant_pattern= 0; -+ pvhtpriv->ext_nss_bw = 0; -+ -+ if (TEST_FLAG(pregistrypriv->short_gi, BIT2) && hal_chk_bw_cap(padapter, BW_CAP_80M)) -+ pvhtpriv->sgi_80m = 1; -+ -+ if (TEST_FLAG(pregistrypriv->short_gi, BIT3) && hal_chk_bw_cap(padapter, BW_CAP_160M)) -+ pvhtpriv->sgi_160m = 1; -+ -+ /* 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 *)(&pvhtpriv->rx_stbc_nss)); -+ if (pvhtpriv->rx_stbc_nss && 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 -+#ifdef RTW_BEAMFORMING_VERSION_2 -+#ifdef CONFIG_CONCURRENT_MODE -+ /* only enable beamforming in STA client mode */ -+ if (MLME_IS_STA(padapter) && !MLME_IS_GC(padapter)) -+#else -+ if ((MLME_IS_AP(padapter) && !MLME_IS_GO(padapter)) || -+ (MLME_IS_STA(padapter) && !MLME_IS_GC(padapter))) -+#endif -+#endif -+ { -+ 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; -+ -+ tx_nss = GET_HAL_TX_NSS(padapter); -+ rx_nss = GET_HAL_RX_NSS(padapter); -+ -+ /* for now, vhtpriv.vht_mcs_map comes from RX NSS */ -+ rtw_vht_nss_to_mcsmap(rx_nss, pvhtpriv->vht_mcs_map, pregistrypriv->vht_rx_mcs_map); -+ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv->vht_mcs_map); -+} -+ -+u64 rtw_vht_mcs_map_to_bitmap(u8 *mcs_map, u8 nss) -+{ -+ u8 i, j, tmp; -+ u64 bitmap = 0; -+ u8 bits_nss = nss * 2; -+ -+ for (i = j = 0; i < bits_nss; i += 2, j += 10) { -+ /* every two bits means single sptial stream */ -+ tmp = (mcs_map[i / 8] >> i) & 3; -+ -+ switch (tmp) { -+ case 2: -+ bitmap = bitmap | ((u64)0x03ff << j); -+ break; -+ case 1: -+ bitmap = bitmap | ((u64)0x01ff << j); -+ break; -+ case 0: -+ bitmap = bitmap | ((u64)0x00ff << j); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ RTW_INFO("vht_mcs_map=%02x %02x, nss=%u => bitmap=%016llx\n" -+ , mcs_map[0], mcs_map[1], nss, bitmap); -+ -+ return bitmap; -+} -+ -+#ifdef CONFIG_BEAMFORMING -+void update_sta_vht_info_apmode_bf_cap(_adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; -+ struct vht_priv *pvhtpriv_sta = &psta->vhtpriv; -+ u16 cur_beamform_cap = 0; -+ -+ /* 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); -+ } -+ -+ if (cur_beamform_cap) -+ RTW_INFO("Current STA(%d) VHT Beamforming Setting = %02X\n", psta->cmn.aid, cur_beamform_cap); -+ -+ pvhtpriv_sta->beamform_cap = cur_beamform_cap; -+ psta->cmn.bf_info.vht_beamform_cap = cur_beamform_cap; -+} -+#endif -+ -+void update_sta_vht_info_apmode(_adapter *padapter, void *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; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0; -+ s8 bw_mode = -1; -+ u8 *pcap_mcs; -+ -+ if (pvhtpriv_sta->vht_option == _FALSE) -+ return; -+ -+ if (pvhtpriv_sta->op_present) { -+ switch (GET_VHT_OPERATION_ELE_CHL_WIDTH(pvhtpriv_sta->vht_op)) { -+ case 1: /* 80MHz */ -+ case 2: /* 160MHz */ -+ case 3: /* 80+80 */ -+ bw_mode = CHANNEL_WIDTH_80; /* only support up to 80MHz for now */ -+ break; -+ } -+ } -+ -+ if (pvhtpriv_sta->notify_present) -+ bw_mode = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&pvhtpriv_sta->vht_op_mode_notify); -+ else if (MLME_IS_AP(padapter)) { -+ /* for VHT client without Operating Mode Notify IE; minimal 80MHz */ -+ if (bw_mode < CHANNEL_WIDTH_80) -+ bw_mode = CHANNEL_WIDTH_80; -+ } -+ -+ if (bw_mode != -1) -+ psta->cmn.bw_mode = bw_mode; /* update bw_mode only if get value from VHT IEs */ -+ -+ psta->cmn.ra_info.is_vht_enable = _TRUE; -+ -+ /* 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->cmn.aid, cur_ldpc_cap); -+ } -+ pvhtpriv_sta->ldpc_cap = cur_ldpc_cap; -+ -+ if (psta->cmn.bw_mode > pmlmeext->cur_bwmode) -+ psta->cmn.bw_mode = pmlmeext->cur_bwmode; -+ -+ if (psta->cmn.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->cmn.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->cmn.aid, cur_stbc_cap); -+ } -+ pvhtpriv_sta->stbc_cap = cur_stbc_cap; -+ -+#ifdef CONFIG_BEAMFORMING -+ update_sta_vht_info_apmode_bf_cap(padapter, psta); -+#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)); -+} -+ -+#ifdef ROKU_PRIVATE -+u8 VHT_get_ss_from_map(u8 *vht_mcs_map) -+{ -+ u8 i, j; -+ u8 ss = 0; -+ -+ for (i = 0; i < 2; i++) { -+ if (vht_mcs_map[i] != 0xff) { -+ for (j = 0; j < 8; j += 2) { -+ if (((vht_mcs_map[i] >> j) & 0x03) == 0x03) -+ break; -+ ss++; -+ } -+ } -+ -+ } -+ -+return ss; -+} -+ -+void VHT_caps_handler_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv_infra_ap *pvhtpriv = &pmlmepriv->vhtpriv_infra_ap; -+ u8 cur_stbc_cap_infra_ap = 0; -+ u16 cur_beamform_cap_infra_ap = 0; -+ u8 *pcap_mcs; -+ u8 *pcap_mcs_tx; -+ u8 Rx_ss = 0, Tx_ss = 0; -+ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pIE == NULL) -+ return; -+ -+ pmlmeinfo->ht_vht_received |= BIT(1); -+ -+ pvhtpriv->ldpc_cap_infra_ap = GET_VHT_CAPABILITY_ELE_RX_LDPC(pIE->data); -+ -+ if (GET_VHT_CAPABILITY_ELE_RX_STBC(pIE->data)) -+ SET_FLAG(cur_stbc_cap_infra_ap, STBC_VHT_ENABLE_RX); -+ if (GET_VHT_CAPABILITY_ELE_TX_STBC(pIE->data)) -+ SET_FLAG(cur_stbc_cap_infra_ap, STBC_VHT_ENABLE_TX); -+ pvhtpriv->stbc_cap_infra_ap = cur_stbc_cap_infra_ap; -+ -+ /*store ap info for channel bandwidth*/ -+ pvhtpriv->channel_width_infra_ap = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(pIE->data); -+ -+ /*check B11: SU Beamformer Capable and B12: SU Beamformee B19: MU Beamformer B20:MU Beamformee*/ -+ if (GET_VHT_CAPABILITY_ELE_SU_BFER(pIE->data)) -+ SET_FLAG(cur_beamform_cap_infra_ap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ if (GET_VHT_CAPABILITY_ELE_SU_BFEE(pIE->data)) -+ SET_FLAG(cur_beamform_cap_infra_ap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ if (GET_VHT_CAPABILITY_ELE_MU_BFER(pIE->data)) -+ SET_FLAG(cur_beamform_cap_infra_ap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); -+ if (GET_VHT_CAPABILITY_ELE_MU_BFEE(pIE->data)) -+ SET_FLAG(cur_beamform_cap_infra_ap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE); -+ pvhtpriv->beamform_cap_infra_ap = cur_beamform_cap_infra_ap; -+ -+ /*store information about vht_mcs_set*/ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pIE->data); -+ pcap_mcs_tx = GET_VHT_CAPABILITY_ELE_TX_MCS(pIE->data); -+ _rtw_memcpy(pvhtpriv->vht_mcs_map_infra_ap, pcap_mcs, 2); -+ _rtw_memcpy(pvhtpriv->vht_mcs_map_tx_infra_ap, pcap_mcs_tx, 2); -+ -+ Rx_ss = VHT_get_ss_from_map(pvhtpriv->vht_mcs_map_infra_ap); -+ Tx_ss = VHT_get_ss_from_map(pvhtpriv->vht_mcs_map_tx_infra_ap); -+ if (Rx_ss >= Tx_ss) { -+ pvhtpriv->number_of_streams_infra_ap = Rx_ss; -+ } else{ -+ pvhtpriv->number_of_streams_infra_ap = Tx_ss; -+ } -+ -+} -+#endif /* ROKU_PRIVATE */ -+ -+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, rx_nss = 0; -+ u16 cur_beamform_cap = 0; -+ u8 *pcap_mcs; -+ -+ 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); -+ rx_nss = GET_HAL_RX_NSS(padapter); -+ rtw_vht_nss_to_mcsmap(rx_nss, pvhtpriv->vht_mcs_map, pcap_mcs); -+ 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, void *sta) -+{ -+ struct sta_info *psta = (struct sta_info *)sta; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct registry_priv *regsty = adapter_to_regsty(padapter); -+ u8 target_bw; -+ u8 target_rxss, current_rxss; -+ u8 update_ra = _FALSE; -+ u8 tx_nss = 0; -+ -+ if (pvhtpriv->vht_option == _FALSE) -+ return; -+ -+ target_bw = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(pframe); -+ tx_nss = GET_HAL_TX_NSS(padapter); -+ target_rxss = rtw_min(tx_nss, (GET_VHT_OPERATING_MODE_FIELD_RX_NSS(pframe) + 1)); -+ -+ if (target_bw != psta->cmn.bw_mode) { -+ if (hal_is_bw_support(padapter, target_bw) -+ && REGSTY_IS_BW_5G_SUPPORT(regsty, target_bw) -+ ) { -+ update_ra = _TRUE; -+ psta->cmn.bw_mode = target_bw; -+ } -+ } -+ -+ current_rxss = rtw_vht_mcsmap_to_nss(psta->vhtpriv.vht_mcs_map); -+ if (target_rxss != current_rxss) { -+ u8 vht_mcs_map[2] = {}; -+ -+ 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_ra_info(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; -+ u32 len = 0; -+ u8 operation[5]; -+ -+ _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); -+ -+ _rtw_memcpy(operation + 3, pvhtpriv->vht_mcs_map, 2); -+ -+ 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; -+ u8 chnl_width, rx_nss; -+ -+ chnl_width = bw; -+ rx_nss = rtw_vht_mcsmap_to_nss(pvhtpriv->vht_mcs_map); -+ -+ 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_num; -+ 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; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ pcap = pvhtpriv->vht_cap; -+ _rtw_memset(pcap, 0, 32); -+ -+ /* -+ * VHT Capabilities Information field : B0 to B31 -+ */ -+ /* 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, Available RX buf size = %d bytes\n", __FUNCTION__, 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("[VHT] Declare supporting MAX MPDU len = 11454 bytes\n"); -+ } else if ((max_recvbuf_sz - rx_packet_offset) >= 7991) { -+ SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting MAX MPDU len = 7991 bytes\n"); -+ } else if ((max_recvbuf_sz - rx_packet_offset) >= 3895) { -+ SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 0); -+ RTW_INFO("[VHT] Declare supporting MAX MPDU len = 3895 bytes\n"); -+ } else -+ RTW_ERR("[VHT] Error!! Available RX buf size < 3895 bytes\n"); -+ -+ /* 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); -+ RTW_INFO("[VHT] Declare supporting 160MHz and 80+80MHz\n"); -+ } else { -+ SET_VHT_CAPABILITY_ELE_CHL_WIDTH(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting 160MHz\n"); -+ } -+ } 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); -+ RTW_INFO("[VHT] Declare supporting RX LDPC\n"); -+ } -+ -+ /* B5 ShortGI for 80MHz */ -+ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(pcap, pvhtpriv->sgi_80m ? 1 : 0); -+ if (pvhtpriv->sgi_80m) -+ RTW_INFO("[VHT] Declare supporting SGI 80MHz\n"); -+ -+ /* B6 Short GI for 160 and 80+80 MHz */ -+ SET_VHT_CAPABILITY_ELE_SHORT_GI160M(pcap, pvhtpriv->sgi_160m ? 1 : 0); -+ if (pvhtpriv->sgi_160m) { -+ RTW_INFO("[VHT] Declare supporting SGI 160MHz and 80+80MHz\n"); -+ } -+ -+ /* B7 Tx STBC */ -+ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX)) { -+ SET_VHT_CAPABILITY_ELE_TX_STBC(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting TX STBC\n"); -+ } -+ -+ /* B8 B9 B10 Rx STBC */ -+ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX)) { -+ SET_VHT_CAPABILITY_ELE_RX_STBC(pcap, pvhtpriv->rx_stbc_nss); -+ RTW_INFO("[VHT] Declare supporting %uSS RX STBC\n", pvhtpriv->rx_stbc_nss); -+ } -+ -+ #ifdef CONFIG_BEAMFORMING -+ /* B11 SU Beamformer Capable */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { -+ SET_VHT_CAPABILITY_ELE_SU_BFER(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting SU Beamformer\n"); -+ /* 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); -+ RTW_INFO("[VHT] Declare supporting MU Beamformer\n"); -+ } -+ } -+ -+ /* B12 SU Beamformee Capable */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { -+ SET_VHT_CAPABILITY_ELE_SU_BFEE(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting SU Beamformee\n"); -+ -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); -+ -+ /* IOT action suggested by Yu Chen 2017/3/3 */ -+ if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) && -+ !pvhtpriv->ap_bf_cap.is_mu_bfer && -+ pvhtpriv->ap_bf_cap.su_sound_dim == 2) -+ rf_num = (rf_num >= 2 ? 2 : rf_num); -+ -+ /* B13 14 15 Beamformee STS Capability */ -+ SET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(pcap, rf_num); -+ -+ /* B20 MU Beamformee Capable */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) { -+ SET_VHT_CAPABILITY_ELE_MU_BFEE(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting MU Beamformee\n"); -+ } -+ } -+ #endif/*CONFIG_BEAMFORMING*/ -+ -+ /* B21 VHT TXOP PS */ -+ if (pvhtpriv->txop_ps) { -+ SET_VHT_CAPABILITY_ELE_TXOP_PS(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting VHT TXOP power save\n"); -+ } -+ -+ /* B22 +HTC-VHT Capable */ -+ if (pvhtpriv->htc_vht) { -+ SET_VHT_CAPABILITY_ELE_HTC_VHT(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting VHT variant HT Control\n"); -+ } -+ -+ /* B23 24 25 Maximum A-MPDU Length Exponent */ -+ SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pcap, pvhtpriv->ampdu_len); -+ RTW_INFO("[VHT] Declare supporting RX A-MPDU Length Exponent = %u\n", pvhtpriv->ampdu_len); -+ -+ /* B26 27 VHT Link Adaptation Capable */ -+ if (pvhtpriv->link_adap_cap) { -+ SET_VHT_CAPABILITY_ELE_LINK_ADAPTION(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting link adaptation using VHT variant HT Control\n"); -+ } -+ -+ /* B28 Rx Antenna Pattern Consistency */ -+ if (pvhtpriv->rx_ant_pattern) { -+ SET_VHT_CAPABILITY_ELE_RX_ANT_PATTERN(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting RX Antenna Pattern Consistency\n"); -+ } -+ -+ /* B29 Tx Antenna Pattern Consistency */ -+ if (pvhtpriv->tx_ant_pattern) { -+ SET_VHT_CAPABILITY_ELE_TX_ANT_PATTERN(pcap, 1); -+ RTW_INFO("[VHT] Declare supporting TX Antenna Pattern Consistency\n"); -+ } -+ -+ /* B30 B31 Extended NSS BW Support */ -+ SET_VHT_CAPABILITY_ELE_EXT_NSS_BW(pcap, pvhtpriv->ext_nss_bw); -+ -+ /* -+ * Supported VHT-MCS and NSS Set : 8 bytes -+ */ -+ 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, struct country_chplan *req_chplan) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ RT_CHANNEL_INFO *chset = rfctl->channel_set; -+ u32 ielen; -+ u8 max_bw; -+ u8 oper_ch, oper_bw = CHANNEL_WIDTH_20, oper_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ u8 *out_vht_op_ie, *ht_op_ie, *vht_cap_ie, *vht_op_ie; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ -+ rtw_vht_use_default_setting(padapter); -+ -+ ht_op_ie = rtw_get_ie(in_ie + 12, WLAN_EID_HT_OPERATION, &ielen, in_len - 12); -+ if (!ht_op_ie || ielen != HT_OP_IE_LEN) -+ goto exit; -+ vht_cap_ie = rtw_get_ie(in_ie + 12, EID_VHTCapability, &ielen, in_len - 12); -+ if (!vht_cap_ie || ielen != VHT_CAP_IE_LEN) -+ goto exit; -+ vht_op_ie = rtw_get_ie(in_ie + 12, EID_VHTOperation, &ielen, in_len - 12); -+ if (!vht_op_ie || ielen != VHT_OP_IE_LEN) -+ goto exit; -+ -+ /* VHT Capabilities element */ -+ *pout_len += rtw_build_vht_cap_ie(padapter, out_ie + *pout_len); -+ -+ -+ /* VHT Operation element */ -+ out_vht_op_ie = out_ie + *pout_len; -+ rtw_set_ie(out_vht_op_ie, EID_VHTOperation, VHT_OP_IE_LEN, vht_op_ie + 2 , pout_len); -+ -+ /* get primary channel from HT_OP_IE */ -+ oper_ch = GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2); -+ -+ /* find the largest bw supported by both registry and hal */ -+ max_bw = hal_largest_bw(padapter, REGSTY_BW_5G(pregistrypriv)); -+ -+ if (max_bw >= CHANNEL_WIDTH_40) { -+ /* get bw offset form HT_OP_IE */ -+ if (GET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2)) { -+ switch (GET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2)) { -+ case SCA: -+ oper_bw = CHANNEL_WIDTH_40; -+ oper_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ case SCB: -+ oper_bw = CHANNEL_WIDTH_40; -+ oper_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ } -+ } -+ -+ if (oper_bw == CHANNEL_WIDTH_40) { -+ switch (GET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2)) { -+ case 1: /* 80MHz */ -+ case 2: /* 160MHz */ -+ case 3: /* 80+80 */ -+ oper_bw = CHANNEL_WIDTH_80; /* only support up to 80MHz for now */ -+ break; -+ } -+ -+ oper_bw = rtw_min(oper_bw, max_bw); -+ -+ /* try downgrage bw to fit in channel plan setting */ -+ while ((req_chplan && !rtw_country_chplan_is_chbw_valid(req_chplan, BAND_ON_5G, oper_ch, oper_bw, oper_offset, 1, 1, pregistrypriv)) -+ || (!req_chplan && !rtw_chset_is_chbw_valid(chset, oper_ch, oper_bw, oper_offset, 1, 1)) -+ || (IS_DFS_SLAVE_WITH_RD(rfctl) -+ && !rtw_rfctl_dfs_domain_unknown(rfctl) -+ && rtw_chset_is_chbw_non_ocp(chset, oper_ch, oper_bw, oper_offset)) -+ ) { -+ oper_bw--; -+ if (oper_bw == CHANNEL_WIDTH_20) { -+ oper_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ } -+ } -+ } -+ -+ rtw_warn_on(req_chplan && !rtw_country_chplan_is_chbw_valid(req_chplan, BAND_ON_5G, oper_ch, oper_bw, oper_offset, 1, 1, pregistrypriv)); -+ rtw_warn_on(!req_chplan && !rtw_chset_is_chbw_valid(chset, oper_ch, oper_bw, oper_offset, 1, 1)); -+ if (IS_DFS_SLAVE_WITH_RD(rfctl) && !rtw_rfctl_dfs_domain_unknown(rfctl)) -+ rtw_warn_on(rtw_chset_is_chbw_non_ocp(chset, oper_ch, oper_bw, oper_offset)); -+ -+ /* update VHT_OP_IE */ -+ if (oper_bw < CHANNEL_WIDTH_80) { -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(out_vht_op_ie + 2, 0); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(out_vht_op_ie + 2, 0); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(out_vht_op_ie + 2, 0); -+ } else if (oper_bw == CHANNEL_WIDTH_80) { -+ u8 cch = rtw_get_center_ch(oper_ch, oper_bw, oper_offset); -+ -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(out_vht_op_ie + 2, 1); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(out_vht_op_ie + 2, cch); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(out_vht_op_ie + 2, 0); -+ } else { -+ RTW_ERR(FUNC_ADPT_FMT" unsupported BW:%u\n", FUNC_ADPT_ARG(padapter), oper_bw); -+ rtw_warn_on(1); -+ } -+ -+ /* Operating Mode Notification element */ -+ *pout_len += rtw_build_vht_op_mode_notify_ie(padapter, out_ie + *pout_len, oper_bw); -+ -+ pvhtpriv->vht_option = _TRUE; -+ -+exit: -+ 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)); -+} -+ -+#ifdef CONFIG_AP_MODE -+void rtw_vht_ies_attach(_adapter *padapter, WLAN_BSSID_EX *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 cap_len, operation_len; -+ uint len = 0; -+ sint ie_len = 0; -+ u8 *p = NULL; -+ -+ p = rtw_get_ie(pnetwork->IEs + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, -+ (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) -+ return; -+ -+ rtw_vht_use_default_setting(padapter); -+ -+ /* VHT Operation mode notifiy bit in Extended IE (127) */ -+ rtw_add_ext_cap_info(pmlmepriv->ext_capab_ie_data, &(pmlmepriv->ext_capab_ie_len), OP_MODE_NOTIFICATION); -+ rtw_update_ext_cap_ie(pmlmepriv->ext_capab_ie_data, pmlmepriv->ext_capab_ie_len, pnetwork->IEs \ -+ , &(pnetwork->IELength), _BEACON_IE_OFFSET_); -+ -+ /* VHT Capabilities element */ -+ cap_len = rtw_build_vht_cap_ie(padapter, pnetwork->IEs + pnetwork->IELength); -+ pnetwork->IELength += cap_len; -+ -+ /* VHT Operation element */ -+ operation_len = rtw_build_vht_operation_ie(padapter, pnetwork->IEs + pnetwork->IELength, -+ pnetwork->Configuration.DSConfig); -+ pnetwork->IELength += operation_len; -+ -+ rtw_check_for_vht20(padapter, pnetwork->IEs + _BEACON_IE_OFFSET_, pnetwork->IELength - _BEACON_IE_OFFSET_); -+ -+ pmlmepriv->vhtpriv.vht_option = _TRUE; -+} -+ -+void rtw_vht_ies_detach(_adapter *padapter, WLAN_BSSID_EX *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ rtw_remove_ext_cap_info(pmlmepriv->ext_capab_ie_data, &(pmlmepriv->ext_capab_ie_len), OP_MODE_NOTIFICATION); -+ rtw_update_ext_cap_ie(pmlmepriv->ext_capab_ie_data, pmlmepriv->ext_capab_ie_len, pnetwork->IEs \ -+ , &(pnetwork->IELength), _BEACON_IE_OFFSET_); -+ -+ rtw_remove_bcn_ie(padapter, pnetwork, EID_VHTCapability); -+ rtw_remove_bcn_ie(padapter, pnetwork, EID_VHTOperation); -+ rtw_remove_bcn_ie(padapter, pnetwork, EID_VHTTransmitPower); -+ -+ pmlmepriv->vhtpriv.vht_option = _FALSE; -+} -+ -+void rtw_check_for_vht20(_adapter *adapter, u8 *ies, int ies_len) -+{ -+ u8 ht_ch, ht_bw, ht_offset; -+ u8 vht_ch, vht_bw, vht_offset; -+ -+ rtw_ies_get_chbw(ies, ies_len, &ht_ch, &ht_bw, &ht_offset, 1, 0); -+ rtw_ies_get_chbw(ies, ies_len, &vht_ch, &vht_bw, &vht_offset, 1, 1); -+ -+ if (ht_bw == CHANNEL_WIDTH_20 && vht_bw >= CHANNEL_WIDTH_80) { -+ u8 *vht_op_ie; -+ int vht_op_ielen; -+ -+ RTW_INFO(FUNC_ADPT_FMT" vht80 is not allowed without ht40\n", FUNC_ADPT_ARG(adapter)); -+ vht_op_ie = rtw_get_ie(ies, EID_VHTOperation, &vht_op_ielen, ies_len); -+ if (vht_op_ie && vht_op_ielen) { -+ RTW_INFO(FUNC_ADPT_FMT" switch to vht20\n", FUNC_ADPT_ARG(adapter)); -+ 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); -+ } -+ } -+} -+ -+/* We need to update the (mlmepriv->vhtpriv) */ -+void rtw_update_drv_vht_cap(_adapter *padapter, u8 *vht_cap_ie) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct vht_priv *pvhtpriv = &(pmlmepriv->vhtpriv); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ s32 ie_len = 0; -+ u32 rx_packet_offset, max_recvbuf_sz, available_mpdu_sz; -+ u8 cap_val; -+ u8 *pvht_cap; -+ -+ /* Initialize VHT capability element */ -+ rtw_vht_use_default_setting(padapter); -+ -+ RTW_INFO("Don't setting VHT capability IE from hostap, builded by driver temporarily\n"); -+ rtw_build_vht_cap_ie(padapter, vht_cap_ie); -+} -+ -+void rtw_set_vht_ext_cap(_adapter *padapter, WLAN_BSSID_EX *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct vht_priv *pvhtpriv = &(pmlmepriv->vhtpriv); -+ u32 frlen = 0; -+ u32 ie_len; -+ u32 ies_len = pnetwork->IELength - _BEACON_IE_OFFSET_; -+ u8 *ies = pnetwork->IEs + _BEACON_IE_OFFSET_; -+ u8 *pbuf; -+ -+ rtw_add_ext_cap_info(pmlmepriv->ext_capab_ie_data, &(pmlmepriv->ext_capab_ie_len), OP_MODE_NOTIFICATION); -+ rtw_update_ext_cap_ie(pmlmepriv->ext_capab_ie_data, pmlmepriv->ext_capab_ie_len, pnetwork->IEs \ -+ , &(pnetwork->IELength), _BEACON_IE_OFFSET_); -+} -+ -+void rtw_check_vht_ies(_adapter *padapter, WLAN_BSSID_EX *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct vht_priv *pvhtpriv = &(pmlmepriv->vhtpriv); -+ u32 ie_len; -+ u32 ies_len = pnetwork->IELength - _BEACON_IE_OFFSET_; -+ u8 *ies = pnetwork->IEs + _BEACON_IE_OFFSET_; -+ u8 *vht_cap_ie, *vht_op_ie; -+ -+ vht_cap_ie = rtw_get_ie(ies, EID_VHTCapability, &ie_len, ies_len); -+ vht_op_ie = rtw_get_ie(ies, EID_VHTOperation, &ie_len, ies_len); -+ -+ rtw_update_drv_vht_cap(padapter, vht_cap_ie); -+ rtw_set_vht_ext_cap(padapter, pnetwork); -+ -+ /* Backup these two VHT IEs from hostapd/wpa_supplicant for restore usage */ -+ if (vht_cap_ie != NULL) -+ _rtw_memcpy(pvhtpriv->vht_cap_ie_backup, vht_cap_ie + 2, VHT_CAP_IE_LEN); -+ -+ if (vht_op_ie != NULL) -+ _rtw_memcpy(pvhtpriv->vht_op_ie_backup, vht_op_ie + 2, VHT_OP_IE_LEN); -+ -+ /* TODO : We don't handle this IE like before, so remove it */ -+ rtw_remove_bcn_ie(padapter, pnetwork, EID_VHTTransmitPower); -+} -+ -+void rtw_reattach_vht_ies(_adapter *padapter, WLAN_BSSID_EX *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct vht_priv *pvhtpriv = &(pmlmepriv->vhtpriv); -+ u8 *vht_cap_ie = pnetwork->IEs + pnetwork->IELength; -+ u8 *vht_op_ie; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (pnetwork->IEs != NULL) { -+ vht_op_ie = rtw_set_ie(vht_cap_ie, EID_VHTCapability, VHT_CAP_IE_LEN, -+ pvhtpriv->vht_cap_ie_backup, &(pnetwork->IELength)); -+ -+ rtw_set_ie(vht_op_ie, EID_VHTOperation, VHT_OP_IE_LEN, -+ pvhtpriv->vht_op_ie_backup, &(pnetwork->IELength)); -+ -+ rtw_set_vht_ext_cap(padapter, pnetwork); -+ } -+ -+ pmlmepriv->vhtpriv.vht_option = _TRUE; -+} -+#endif /* CONFIG_AP_MODE */ -+#endif /* CONFIG_80211AC_VHT */ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_wapi.c b/drivers/net/wireless/rtl8821cs/core/rtw_wapi.c -new file mode 100644 -index 000000000..affe1c8d4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_wapi.c -@@ -0,0 +1,1313 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+#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_WAPI_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_WAPI_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_WAPI_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 = get_addr2_ptr(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 = get_addr2_ptr(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, -+ u8 *ehdr_ops -+) -+{ -+ 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 = ehdr_ops; -+ 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) { -+ WAPI_DATA(WAPI_RX, "rtw_wapi_check_for_drop() dump packet", ptr, 50); -+ -+ 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 CAM_empty_entry( -+ PADAPTER Adapter, -+ u8 ucIndex -+) -+{ -+ rtw_hal_set_hwreg(Adapter, HW_VAR_CAM_EMPTY_ENTRY, (u8 *)(&ucIndex)); -+} -+ -+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[ETH_ALEN] = {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, ETH_ALEN); -+ 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, ETH_ALEN); -+ 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, ETH_ALEN); -+ 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, ETH_ALEN); -+ 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; -+} -+ -+void rtw_wapi_set_set_encryption(_adapter *padapter, struct ieee_param *param) -+{ -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ 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 -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_wapi_sms4.c b/drivers/net/wireless/rtl8821cs/core/rtw_wapi_sms4.c -new file mode 100644 -index 000000000..4b7cf957c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_wapi_sms4.c -@@ -0,0 +1,922 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+#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 --git a/drivers/net/wireless/rtl8821cs/core/rtw_wlan_util.c b/drivers/net/wireless/rtl8821cs/core/rtw_wlan_util.c -new file mode 100755 -index 000000000..68c5ab408 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_wlan_util.c -@@ -0,0 +1,5920 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ #include -+ #define ETH_TYPE_OFFSET 12 -+ #define PROTOCOL_OFFSET 23 -+ #define IP_OFFSET 30 -+ #define IPv6_OFFSET 38 -+ #define IPv6_PROTOCOL_OFFSET 20 -+#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) -+ -+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 -+}; -+ -+extern u8 WIFI_CCKRATES[]; -+bool rtw_is_cck_rate(u8 rate) -+{ -+ int i; -+ -+ for (i = 0; i < 4; i++) -+ if ((WIFI_CCKRATES[i] & 0x7F) == (rate & 0x7F)) -+ return 1; -+ return 0; -+} -+ -+extern u8 WIFI_OFDMRATES[]; -+bool rtw_is_ofdm_rate(u8 rate) -+{ -+ int i; -+ -+ for (i = 0; i < 8; i++) -+ if ((WIFI_OFDMRATES[i] & 0x7F) == (rate & 0x7F)) -+ return 1; -+ return 0; -+} -+ -+/* test if rate is defined in rtw_basic_rate_cck */ -+bool rtw_is_basic_rate_cck(u8 rate) -+{ -+ int i; -+ -+ for (i = 0; i < 4; i++) -+ if ((rtw_basic_rate_cck[i] & 0x7F) == (rate & 0x7F)) -+ return 1; -+ return 0; -+} -+ -+/* test if rate is defined in rtw_basic_rate_ofdm */ -+bool rtw_is_basic_rate_ofdm(u8 rate) -+{ -+ int i; -+ -+ for (i = 0; i < 3; i++) -+ if ((rtw_basic_rate_ofdm[i] & 0x7F) == (rate & 0x7F)) -+ return 1; -+ return 0; -+} -+ -+/* test if rate is defined in rtw_basic_rate_mix */ -+bool rtw_is_basic_rate_mix(u8 rate) -+{ -+ int i; -+ -+ for (i = 0; i < 7; i++) -+ if ((rtw_basic_rate_mix[i] & 0x7F) == (rate & 0x7F)) -+ return 1; -+ return 0; -+} -+#ifdef CONFIG_BCN_CNT_CONFIRM_HDL -+int new_bcn_max = 3; -+#endif -+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; -+} -+ -+s8 rtw_get_sta_rx_nss(_adapter *adapter, struct sta_info *psta) -+{ -+ s8 nss = 1; -+ -+ if (!psta) -+ return nss; -+ -+ nss = GET_HAL_RX_NSS(adapter); -+ -+#ifdef CONFIG_80211N_HT -+ #ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) -+ nss = rtw_min(nss, rtw_vht_mcsmap_to_nss(psta->vhtpriv.vht_mcs_map)); -+ else -+ #endif /* CONFIG_80211AC_VHT */ -+ if (psta->htpriv.ht_option) -+ nss = rtw_min(nss, rtw_ht_mcsset_to_nss(psta->htpriv.ht_cap.supp_mcs_set)); -+#endif /*CONFIG_80211N_HT*/ -+ RTW_INFO("%s: %d ss\n", __func__, nss); -+ return nss; -+} -+ -+s8 rtw_get_sta_tx_nss(_adapter *adapter, struct sta_info *psta) -+{ -+ s8 nss = 1; -+ -+ if (!psta) -+ return nss; -+ -+ nss = GET_HAL_TX_NSS(adapter); -+ -+#ifdef CONFIG_80211N_HT -+ #ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) -+ nss = rtw_min(nss, rtw_vht_mcsmap_to_nss(psta->vhtpriv.vht_mcs_map)); -+ else -+ #endif /* CONFIG_80211AC_VHT */ -+ if (psta->htpriv.ht_option) -+ nss = rtw_min(nss, rtw_ht_mcsset_to_nss(psta->htpriv.ht_cap.supp_mcs_set)); -+#endif /*CONFIG_80211N_HT*/ -+ RTW_INFO("%s: %d SS\n", __func__, nss); -+ return nss; -+} -+ -+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]; -+ -+ if (rtw_get_oper_ch(padapter) > 14 && rate < _6M_RATE_) /*5G no support CCK rate*/ -+ continue; -+ -+ 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( -+ PADAPTER 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 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; -+} -+ -+inline systime rtw_get_on_oper_ch_time(_adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->on_oper_ch_time; -+} -+ -+inline systime 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; -+#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"); -+ } -+#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 && 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 -+ -+ rtw_odm_adaptivity_update(adapter_to_dvobj(padapter)); -+ -+#ifdef CONFIG_DFS_MASTER -+ if (new_overlap_radar_detect_ch) -+ rtw_odm_radar_detect_enable(padapter); -+ else if (ori_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); -+} -+ -+__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_is_iface_specific(macid_ctl, i, padapter)) -+ 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 invalidate_cam_all(_adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ u8 bmc_id = rtw_iface_bcmc_id_get(padapter); -+ _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); -+ -+#ifndef SEC_DEFAULT_KEY_SEARCH -+ /* for BMC data TX with force camid */ -+ if (bmc_id != INVALID_SEC_MAC_CAM_ID) { -+ rtw_sec_cam_map_set(&cam_ctl->used, bmc_id); -+ if (_rtw_camctl_chk_cap(padapter, SEC_CAP_CHK_EXTRA_SEC)) -+ rtw_sec_cam_map_set(&cam_ctl->used, bmc_id + 1); -+ } -+#endif -+ -+ _rtw_memset(dvobj->cam_cache, 0, sizeof(struct sec_cam_ent) * SEC_CAM_ENT_NUM_SW_LIMIT); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+#ifdef SEC_DEFAULT_KEY_SEARCH//!BMC TX force camid -+ /* clear default key related key search setting */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8 *)_FALSE); -+#endif -+} -+ -+void _clear_cam_entry(_adapter *padapter, u8 entry) -+{ -+ unsigned char null_sta[6] = {0}; -+ unsigned char null_key[32] = {0}; -+ -+ 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 write_cam(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) -+{ -+ if (ctrl & BIT(9)) { -+ _write_cam(adapter, id, ctrl, mac, key); -+ _write_cam(adapter, (id + 1), ctrl | BIT(5), mac, (key + 16)); -+ RTW_INFO_DUMP("key-0: ", key, 16); -+ RTW_INFO_DUMP("key-1: ", (key + 16), 16); -+ } else -+ _write_cam(adapter, id, ctrl, mac, key); -+} -+ -+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, u8 *addr, s16 kid, u8 gk, bool ext_sec) -+{ -+ 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, gk); -+ 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 */ -+#ifdef SEC_DEFAULT_KEY_SEARCH -+ 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) { -+ if (ext_sec) { -+ /* look out continue slot */ -+ if (((i + 1) < cam_ctl->num) && -+ (_rtw_sec_camid_is_used(cam_ctl, (((i + 1) + start_id) % cam_ctl->num)) == _FALSE)) -+ break; -+ else -+ continue; -+ } else -+ break; -+ } -+ } -+ -+ if (i == cam_ctl->num) { -+ RTW_PRINT(FUNC_ADPT_FMT" %s key with "MAC_FMT" id:%u no room\n" -+ , FUNC_ADPT_ARG(adapter), gk ? "group" : "pairwise", 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, u8 gk, bool ext_sec, 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) { -+ /* -+ * 1. non-STA mode WEP key -+ * 2. group TX key -+ */ -+#ifdef SEC_DEFAULT_KEY_SEARCH -+ /* static alloction to default key by key ID when concurrent is not defined */ -+ 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, addr, kid, gk, ext_sec); -+ 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 { -+ /* -+ * 1. STA mode WEP key -+ * 2. STA mode group RX key -+ * 3. sta key (pairwise, group RX) -+ */ -+ u8 *addr = sta ? sta->cmn.mac_addr : 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, addr, kid, gk, ext_sec); -+ } -+ -+ -+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); -+ if (ext_sec) -+ rtw_sec_cam_map_set(&cam_ctl->used, cam_id + 1); -+ } -+ -+ _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; -+ -+ rtw_mi_update_ap_bmc_camid(adapter, cam_id_a, cam_id_b); -+ -+ /*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++) { -+ if (_rtw_camctl_chk_cap(adapter, SEC_CAP_CHK_WRITE_CAM_NEW_RULE)) -+ _clear_cam_entry(adapter, i); -+ else -+ rtw_sec_clr_cam_ent(adapter, i); -+ } -+} -+ -+void flush_all_cam_entry(_adapter *padapter) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ 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 (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { -+#ifdef CONFIG_AP_MODE -+#ifndef SEC_DEFAULT_KEY_SEARCH -+ int cam_id = -1; -+ u8 *addr = adapter_mac_addr(padapter); -+ u8 bmc_id = rtw_iface_bcmc_id_get(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); -+ /* clear cam_ctl.used bit for data BMC TX force camid in rtw_release_macid() */ -+ if (bmc_id == INVALID_SEC_MAC_CAM_ID || cam_id != bmc_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 -+#endif /* CONFIG_AP_MODE */ -+ } -+ -+#else /*NON CONFIG_CONCURRENT_MODE*/ -+ -+ invalidate_cam_all(padapter); -+#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 -+ -+} -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+u8 rtw_is_tbtx_capabilty(u8 *p, u8 len){ -+ int i; -+ u8 tbtx_cap_ie[8] = {0x00, 0xe0, 0x4c, 0x01, 0x00, 0x00, 0x00, 0x00}; -+ -+ for (i = 0; i < len; i++) { -+ if (*(p + i) != tbtx_cap_ie[i]) -+ return _FALSE; -+ else -+ continue; -+ } -+ return _TRUE; -+} -+#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; -+#ifdef CONFIG_WMMPS_STA -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+#endif /* CONFIG_WMMPS_STA */ -+ -+ acm_mask = 0; -+ -+ if (is_supported_5g(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]); -+ } -+ -+#ifdef CONFIG_WMMPS_STA -+ /* if AP supports UAPSD function, driver must set each uapsd TID to coresponding mac register 0x693 */ -+ if (pmlmeinfo->WMM_param.QoS_info & AP_SUPPORTED_UAPSD) { -+ pqospriv->uapsd_ap_supported = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_UAPSD_TID, NULL); -+ } -+#endif /* CONFIG_WMMPS_STA */ -+ } -+} -+ -+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->cmn.bw_mode = pmlmeext->cur_bwmode; -+ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; -+ } else { -+ psta->cmn.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 */ -+} -+ -+#ifdef ROKU_PRIVATE -+void Supported_rate_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ unsigned int i; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pIE == NULL) -+ return; -+ -+ for (i = 0 ; i < pIE->Length; i++) -+ pmlmeinfo->SupportedRates_infra_ap[i] = (pIE->data[i]); -+ -+} -+ -+void Extended_Supported_rate_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ unsigned int i, j; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pIE == NULL) -+ return; -+ -+ if (pIE->Length > 0) { -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ if (pmlmeinfo->SupportedRates_infra_ap[i] == 0) -+ break; -+ } -+ for (j = 0; j < pIE->Length; j++) -+ pmlmeinfo->SupportedRates_infra_ap[i+j] = (pIE->data[j]); -+ } -+ -+} -+ -+void HT_get_ss_from_mcs_set(u8 *mcs_set, u8 *Rx_ss) -+{ -+ u8 i, j; -+ u8 r_ss = 0, t_ss = 0; -+ -+ for (i = 0; i < 4; i++) { -+ if ((mcs_set[3-i] & 0xff) != 0x00) { -+ r_ss = 4-i; -+ break; -+ } -+ } -+ -+ *Rx_ss = r_ss; -+} -+ -+void HT_caps_handler_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ unsigned int i; -+ u8 cur_stbc_cap_infra_ap = 0; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv_infra_ap *phtpriv = &pmlmepriv->htpriv_infra_ap; -+ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pIE == NULL) -+ return; -+ -+ pmlmeinfo->ht_vht_received |= BIT(0); -+ -+ /*copy MCS_SET*/ -+ for (i = 3; i < 19; i++) -+ phtpriv->MCS_set_infra_ap[i-3] = (pIE->data[i]); -+ -+ /*get number of stream from mcs set*/ -+ HT_get_ss_from_mcs_set(phtpriv->MCS_set_infra_ap, &phtpriv->Rx_ss_infra_ap); -+ -+ phtpriv->rx_highest_data_rate_infra_ap = le16_to_cpu(GET_HT_CAP_ELE_RX_HIGHEST_DATA_RATE(pIE->data)); -+ -+ phtpriv->ldpc_cap_infra_ap = GET_HT_CAP_ELE_LDPC_CAP(pIE->data); -+ -+ if (GET_HT_CAP_ELE_RX_STBC(pIE->data)) -+ SET_FLAG(cur_stbc_cap_infra_ap, STBC_HT_ENABLE_RX); -+ if (GET_HT_CAP_ELE_TX_STBC(pIE->data)) -+ SET_FLAG(cur_stbc_cap_infra_ap, STBC_HT_ENABLE_TX); -+ phtpriv->stbc_cap_infra_ap = cur_stbc_cap_infra_ap; -+ -+ /*store ap info SGI 20m 40m*/ -+ phtpriv->sgi_20m_infra_ap = GET_HT_CAP_ELE_SHORT_GI20M(pIE->data); -+ phtpriv->sgi_40m_infra_ap = GET_HT_CAP_ELE_SHORT_GI40M(pIE->data); -+ -+ /*store ap info for supported channel bandwidth*/ -+ phtpriv->channel_width_infra_ap = GET_HT_CAP_ELE_CHL_WIDTH(pIE->data); -+} -+#endif /* ROKU_PRIVATE */ -+ -+void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+#ifdef CONFIG_80211N_HT -+ unsigned int i; -+ u8 max_AMPDU_len, min_MPDU_spacing; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0, rx_nss = 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; -+#ifdef CONFIG_DISABLE_MCS13TO15 -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+#endif -+ -+ 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); -+ -+ /* 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]; -+ -+ rx_nss = GET_HAL_RX_NSS(padapter); -+ -+ switch (rx_nss) { -+ case 1: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); -+ break; -+ case 2: -+ #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 -+ #endif -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+ break; -+ case 3: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_3R); -+ break; -+ case 4: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_4R); -+ break; -+ default: -+ RTW_WARN("rf_type:%d or rx_nss:%u is not expected\n", GET_HAL_RFPATH(padapter), rx_nss); -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ /* 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); -+ 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 -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ /* Config 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_BEAMFORMEE_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_BEAMFORMER_ENABLE); -+ /* Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pIE->data) << 4); -+ } -+#else /* !RTW_BEAMFORMING_VERSION_2 */ -+ /* 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); -+ } -+#endif /* !RTW_BEAMFORMING_VERSION_2 */ -+ 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)); -+#ifdef CONFIG_80211N_HT -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); -+#endif /* CONFIG_80211N_HT */ -+#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_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->cmn.ldpc_en = VHT_LDPC_EN; -+ else -+ psta->cmn.ldpc_en = 0; -+ -+ if (TEST_FLAG(psta->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX)) -+ psta->cmn.stbc_en = VHT_STBC_EN; -+ else -+ psta->cmn.stbc_en = 0; -+ } else -+#endif /* CONFIG_80211AC_VHT */ -+ if (psta->htpriv.ht_option) { -+ if (TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX)) -+ psta->cmn.ldpc_en = HT_LDPC_EN; -+ else -+ psta->cmn.ldpc_en = 0; -+ -+ if (TEST_FLAG(psta->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) -+ psta->cmn.stbc_en = HT_STBC_EN; -+ else -+ psta->cmn.stbc_en = 0; -+ } else { -+ psta->cmn.ldpc_en = 0; -+ psta->cmn.stbc_en = 0; -+ } -+ -+#endif /* CONFIG_80211N_HT */ -+} -+ -+int check_ielen(u8 *start, uint len) -+{ -+ int left = len; -+ u8 *pos = start; -+ u8 id, elen; -+ -+ while (left >= 2) { -+ id = *pos++; -+ elen = *pos++; -+ left -= 2; -+ -+ if (elen > left) { -+ RTW_INFO("IEEE 802.11 element parse failed (id=%d elen=%d left=%lu)\n", -+ id, elen, (unsigned long) left); -+ return _FALSE; -+ } -+ if ((id == WLAN_EID_VENDOR_SPECIFIC) && (elen < 3)) -+ return _FALSE; -+ -+ left -= elen; -+ pos += elen; -+ } -+ if (left) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+int validate_beacon_len(u8 *pframe, u32 len) -+{ -+ u8 ie_offset = _BEACON_IE_OFFSET_ + sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (len < ie_offset) { -+ RTW_INFO("%s: incorrect beacon length(%d)\n", __func__, len); -+ return _FALSE; -+ } -+ -+ if (check_ielen(pframe + ie_offset, len - ie_offset) == _FALSE) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+#ifdef CONFIG_CHECK_SPECIFIC_IE_CONTENT -+u8 support_rate_ranges[] = { -+ IEEE80211_CCK_RATE_1MB, -+ IEEE80211_CCK_RATE_2MB, -+ IEEE80211_CCK_RATE_5MB, -+ IEEE80211_CCK_RATE_11MB, -+ IEEE80211_OFDM_RATE_6MB, -+ IEEE80211_OFDM_RATE_9MB, -+ IEEE80211_OFDM_RATE_12MB, -+ IEEE80211_OFDM_RATE_18MB, -+ IEEE80211_PBCC_RATE_22MB, -+ IEEE80211_FREAK_RATE_22_5MB, -+ IEEE80211_OFDM_RATE_24MB, -+ IEEE80211_OFDM_RATE_36MB, -+ IEEE80211_OFDM_RATE_48MB, -+ IEEE80211_OFDM_RATE_54MB, -+}; -+ -+inline bool match_ranges(u16 EID, u32 value) -+{ -+ int i; -+ int nr_range; -+ -+ switch (EID) { -+ case _EXT_SUPPORTEDRATES_IE_: -+ case _SUPPORTEDRATES_IE_: -+ nr_range = sizeof(support_rate_ranges)/sizeof(u8); -+ for (i = 0; i < nr_range; i++) { -+ /* clear bit7 before searching. */ -+ value &= ~BIT(7); -+ if (value == support_rate_ranges[i]) -+ return _TRUE; -+ } -+ break; -+ default: -+ break; -+ }; -+ return _FALSE; -+} -+ -+/* -+ * rtw_validate_value: validate the IE contain. -+ * -+ * Input : -+ * EID : Element ID -+ * p : IE buffer (without EID & length) -+ * len : IE length -+ * return: -+ * _TRUE : All Values are validated. -+ * _FALSE : At least one value is NOT validated. -+ */ -+bool rtw_validate_value(u16 EID, u8 *p, u16 len) -+{ -+ u8 rate; -+ u32 i, nr_val; -+ -+ switch (EID) { -+ case _EXT_SUPPORTEDRATES_IE_: -+ case _SUPPORTEDRATES_IE_: -+ nr_val = len; -+ for (i=0; iSsid.Ssid, snetwork->Ssid.SsidLength); -+} -+ -+/* -+ Get SSID if this ilegal frame(probe resp) comes from a hidden SSID AP. -+ Update the SSID to the corresponding pnetwork in scan queue. -+*/ -+void rtw_absorb_ssid_ifneed(_adapter *padapter, WLAN_BSSID_EX *bssid, u8 *pframe) -+{ -+ struct wlan_network *scanned = NULL; -+ WLAN_BSSID_EX *snetwork; -+ u8 ie_offset, *p=NULL, *next_ie=NULL, *mac = get_addr2_ptr(pframe); -+ sint ssid_len_ori; -+ u32 remain_len = 0; -+ u8 backupIE[MAX_IE_SZ]; -+ u16 subtype = get_frame_sub_type(pframe); -+ _irqL irqL; -+ -+ if (subtype == WIFI_BEACON) { -+ bssid->Reserved[0] = BSS_TYPE_BCN; -+ ie_offset = _BEACON_IE_OFFSET_; -+ } else { -+ /* FIXME : more type */ -+ if (subtype == WIFI_PROBERSP) { -+ ie_offset = _PROBERSP_IE_OFFSET_; -+ bssid->Reserved[0] = BSS_TYPE_PROB_RSP; -+ } else if (subtype == WIFI_PROBEREQ) { -+ ie_offset = _PROBEREQ_IE_OFFSET_; -+ bssid->Reserved[0] = BSS_TYPE_PROB_REQ; -+ } else { -+ bssid->Reserved[0] = BSS_TYPE_UNDEF; -+ ie_offset = _FIXED_IE_LENGTH_; -+ } -+ } -+ -+ _enter_critical_bh(&padapter->mlmepriv.scanned_queue.lock, &irqL); -+ scanned = _rtw_find_network(&padapter->mlmepriv.scanned_queue, mac); -+ if (!scanned) { -+ _exit_critical_bh(&padapter->mlmepriv.scanned_queue.lock, &irqL); -+ return; -+ } -+ -+ snetwork = &(scanned->network); -+ /* scan queue records as Hidden SSID && Input frame is NOT Hidden SSID */ -+ if (hidden_ssid_ap(snetwork) && !hidden_ssid_ap(bssid)) { -+ p = rtw_get_ie(snetwork->IEs+ie_offset, _SSID_IE_, &ssid_len_ori, snetwork->IELength-ie_offset); -+ if (!p) { -+ _exit_critical_bh(&padapter->mlmepriv.scanned_queue.lock, &irqL); -+ return; -+ } -+ next_ie = p + 2 + ssid_len_ori; -+ remain_len = snetwork->IELength - (next_ie - snetwork->IEs); -+ scanned->network.Ssid.SsidLength = bssid->Ssid.SsidLength; -+ _rtw_memcpy(scanned->network.Ssid.Ssid, bssid->Ssid.Ssid, bssid->Ssid.SsidLength); -+ -+ //update pnetwork->ssid, pnetwork->ssidlen -+ _rtw_memcpy(backupIE, next_ie, remain_len); -+ *(p+1) = bssid->Ssid.SsidLength; -+ _rtw_memcpy(p+2, bssid->Ssid.Ssid, bssid->Ssid.SsidLength); -+ _rtw_memcpy(p+2+bssid->Ssid.SsidLength, backupIE, remain_len); -+ snetwork->IELength += bssid->Ssid.SsidLength; -+ } -+ _exit_critical_bh(&padapter->mlmepriv.scanned_queue.lock, &irqL); -+} -+ -+#ifdef DBG_RX_BCN -+void rtw_debug_rx_bcn(_adapter *adapter, u8 *pframe, u32 packet_len) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *mlmeinfo = &(pmlmeext->mlmext_info); -+ u16 sn = ((struct rtw_ieee80211_hdr_3addr *)pframe)->seq_ctl >> 4; -+ u64 tsf, tsf_offset; -+ u8 dtim_cnt, dtim_period, tim_bmap, tim_pvbit; -+ -+ update_TSF(pmlmeext, pframe, packet_len); -+ tsf = pmlmeext->TSFValue; -+ tsf_offset = rtw_modular64(pmlmeext->TSFValue, (mlmeinfo->bcn_interval * 1024)); -+ -+ /*get TIM IE*/ -+ /*DTIM Count*/ -+ dtim_cnt = pmlmeext->tim[0]; -+ /*DTIM Period*/ -+ dtim_period = pmlmeext->tim[1]; -+ /*Bitmap*/ -+ tim_bmap = pmlmeext->tim[2]; -+ /*Partial VBitmap AID 0 ~ 7*/ -+ tim_pvbit = pmlmeext->tim[3]; -+ -+ RTW_INFO("[BCN] SN-%d, TSF-%lld(us), offset-%lld, bcn_interval-%d DTIM-%d[%d] bitmap-0x%02x-0x%02x\n", -+ sn, tsf, tsf_offset, mlmeinfo->bcn_interval, dtim_period, dtim_cnt, tim_bmap, tim_pvbit); -+} -+#endif -+ -+/* -+ * 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(u8 *cap_info, u32 buf_len, u8 def_ch, ADAPTER *adapter -+ , struct beacon_keys *recv_beacon) -+{ -+ int left; -+ u16 capability; -+ unsigned char *pos; -+ struct rtw_ieee802_11_elems elems; -+ -+ _rtw_memset(recv_beacon, 0, sizeof(*recv_beacon)); -+ -+ /* checking capabilities */ -+ capability = le16_to_cpu(*(unsigned short *)(cap_info)); -+ -+ /* checking IEs */ -+ left = buf_len - 2; -+ pos = cap_info + 2; -+ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed) -+ return _FALSE; -+ -+ if (elems.ht_capabilities) { -+ if (elems.ht_capabilities_len != 26) -+ return _FALSE; -+ } -+ -+ if (elems.ht_operation) { -+ if (elems.ht_operation_len != 22) -+ return _FALSE; -+ } -+ -+ if (elems.vht_capabilities) { -+ if (elems.vht_capabilities_len != 12) -+ return _FALSE; -+ } -+ -+ if (elems.vht_operation) { -+ if (elems.vht_operation_len != 5) -+ return _FALSE; -+ } -+ -+ if (rtw_ies_get_supported_rate(pos, left, recv_beacon->rate_set, &recv_beacon->rate_num) == _FAIL) -+ return _FALSE; -+ -+ if (cckratesonly_included(recv_beacon->rate_set, recv_beacon->rate_num) == _TRUE) -+ recv_beacon->proto_cap |= PROTO_CAP_11B; -+ else if (cckrates_included(recv_beacon->rate_set, recv_beacon->rate_num) == _TRUE) -+ recv_beacon->proto_cap |= PROTO_CAP_11B | PROTO_CAP_11G; -+ else -+ recv_beacon->proto_cap |= PROTO_CAP_11G; -+ -+ if (elems.ht_capabilities && elems.ht_operation) -+ recv_beacon->proto_cap |= PROTO_CAP_11N; -+ -+ if (elems.vht_capabilities && elems.vht_operation) -+ recv_beacon->proto_cap |= PROTO_CAP_11AC; -+ -+ /* check bw and channel offset */ -+ rtw_ies_get_chbw(pos, left, &recv_beacon->ch, &recv_beacon->bw, &recv_beacon->offset, 1, 1); -+ if (!recv_beacon->ch) -+ recv_beacon->ch = def_ch; -+ -+ /* 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; -+ } -+ -+ /* 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, -+ NULL, &recv_beacon->akm, NULL, NULL); -+ } -+ /* 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->akm); -+ } else if (capability & BIT(4)) -+ recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WEP; -+ -+ if (adapter) { -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ -+ if (elems.tim && elems.tim_len) { -+ #ifdef DBG_RX_BCN -+ _rtw_memcpy(pmlmeext->tim, elems.tim, 4); -+ #endif -+ pmlmeext->dtim = elems.tim[1]; -+ } -+ -+ /* checking RTW TBTX */ -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (elems.tbtx_cap && elems.tbtx_cap_len) { -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (rtw_is_tbtx_capabilty(elems.tbtx_cap, elems.tbtx_cap_len)) -+ RTW_DBG("AP support TBTX\n"); -+ } -+ #endif -+ } -+ -+ return _TRUE; -+} -+ -+int rtw_get_bcn_keys(_adapter *adapter, u8 *whdr, u32 flen, struct beacon_keys *bcn_keys) -+{ -+ return _rtw_get_bcn_keys( -+ whdr + WLAN_HDR_A3_LEN + 10 -+ , flen - WLAN_HDR_A3_LEN - 10 -+ , adapter->mlmeextpriv.cur_channel, adapter -+ , bcn_keys); -+} -+ -+int rtw_get_bcn_keys_from_bss(WLAN_BSSID_EX *bss, struct beacon_keys *bcn_keys) -+{ -+ return _rtw_get_bcn_keys( -+ bss->IEs + 10 -+ , bss->IELength - 10 -+ , bss->Configuration.DSConfig, NULL -+ , bcn_keys); -+} -+ -+int rtw_update_bcn_keys_of_network(struct wlan_network *network) -+{ -+ network->bcn_keys_valid = rtw_get_bcn_keys_from_bss(&network->network, &network->bcn_keys); -+ return network->bcn_keys_valid; -+} -+ -+void rtw_dump_bcn_keys(void *sel, struct beacon_keys *recv_beacon) -+{ -+#if defined(CONFIG_RTW_DEBUG) || defined(CONFIG_PROC_DEBUG) -+ u8 ssid[IW_ESSID_MAX_SIZE + 1]; -+ -+ _rtw_memcpy(ssid, recv_beacon->ssid, recv_beacon->ssid_len); -+ ssid[recv_beacon->ssid_len] = '\0'; -+ -+ RTW_PRINT_SEL(sel, "ssid = %s (len = %u)\n", ssid, recv_beacon->ssid_len); -+ RTW_PRINT_SEL(sel, "ch = %u,%u,%u\n" -+ , recv_beacon->ch, recv_beacon->bw, recv_beacon->offset); -+ RTW_PRINT_SEL(sel, "proto_cap = 0x%02x\n", recv_beacon->proto_cap); -+ RTW_MAP_DUMP_SEL(sel, "rate_set = " -+ , recv_beacon->rate_set, recv_beacon->rate_num); -+ RTW_PRINT_SEL(sel, "sec = %d, group = 0x%x, pair = 0x%x, akm = 0x%08x\n" -+ , recv_beacon->encryp_protocol, recv_beacon->group_cipher -+ , recv_beacon->pairwise_cipher, recv_beacon->akm); -+#endif -+} -+ -+void rtw_bcn_key_err_fix(struct beacon_keys *cur, struct beacon_keys *recv) -+{ -+ if ((recv->ch == cur->ch) && (recv->bw == cur->bw) && (recv->bw > CHANNEL_WIDTH_20)) { -+ if ((recv->offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) -+ && (cur->offset != HAL_PRIME_CHNL_OFFSET_DONT_CARE)) { -+ RTW_DBG("recv_bcn offset = %d is invalid, try to use cur_bcn offset = %d to replace it !\n", recv->offset, cur->offset); -+ recv->offset = cur->offset; -+ } -+ } -+} -+ -+bool rtw_bcn_key_compare(struct beacon_keys *cur, struct beacon_keys *recv) -+{ -+#define BCNKEY_VERIFY_PROTO_CAP 0 -+#define BCNKEY_VERIFY_WHOLE_RATE_SET 0 -+ -+ struct beacon_keys tmp; -+ bool ret = _FALSE; -+ -+ if (!rtw_is_chbw_grouped(cur->ch, cur->bw, cur->offset -+ , recv->ch, recv->bw, recv->offset)) -+ goto exit; -+ -+ _rtw_memcpy(&tmp, cur, sizeof(tmp)); -+ -+ /* check fields excluding below */ -+ tmp.ch = recv->ch; -+ tmp.bw = recv->bw; -+ tmp.offset = recv->offset; -+ if (!BCNKEY_VERIFY_PROTO_CAP) -+ tmp.proto_cap = recv->proto_cap; -+ if (!BCNKEY_VERIFY_WHOLE_RATE_SET) { -+ tmp.rate_num = recv->rate_num; -+ _rtw_memcpy(tmp.rate_set, recv->rate_set, 12); -+ } -+ -+ if (_rtw_memcmp(&tmp, recv, sizeof(*recv)) == _FALSE) -+ goto exit; -+ -+ ret = _TRUE; -+ -+exit: -+ return ret; -+} -+ -+int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) -+{ -+ u8 *pbssid = GetAddr3Ptr(pframe); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ struct wlan_network *cur_network = &(Adapter->mlmepriv.cur_network); -+ struct beacon_keys *cur_beacon = &pmlmepriv->cur_beacon_keys; -+ struct beacon_keys recv_beacon; -+ int ret = 0; -+ u8 ifbmp_m = rtw_mi_get_ap_mesh_ifbmp(Adapter); -+ u8 ifbmp_s = rtw_mi_get_ld_sta_ifbmp(Adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); -+ _adapter *pri_adapter = dvobj_get_primary_adapter(dvobj); -+ struct mlme_ext_priv *pmlmeext = &pri_adapter->mlmeextpriv; -+ -+ if (is_client_associated_to_ap(Adapter) == _FALSE) -+ goto exit_success; -+ -+ if (rtw_get_bcn_keys(Adapter, pframe, packet_len, &recv_beacon) == _FALSE) -+ goto exit_success; /* parsing failed => broken IE */ -+ -+#ifdef DBG_RX_BCN -+ rtw_debug_rx_bcn(Adapter, pframe, packet_len); -+#endif -+ -+ /* hidden ssid, replace with current beacon ssid directly */ -+ if (is_hidden_ssid(recv_beacon.ssid, recv_beacon.ssid_len)) { -+ _rtw_memcpy(recv_beacon.ssid, cur_beacon->ssid, cur_beacon->ssid_len); -+ recv_beacon.ssid_len = cur_beacon->ssid_len; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_CSA_UPDATE_BEACON)) { -+ u8 u_ch, u_offset, u_bw; -+ struct sta_info *psta = NULL; -+ -+ rtw_mi_get_ch_setting_union(Adapter, &u_ch, &u_bw, &u_offset); -+ /* RTW_INFO("u_ch=%d, recv_beacon.ch=%d\n", u_ch, recv_beacon.ch); */ -+ if (pmlmepriv->bcn_cnts_after_csa < 5) { -+ if (u_ch == recv_beacon.ch) -+ pmlmepriv->bcn_cnts_after_csa += 1; -+ goto exit_success; -+ } else -+ pmlmepriv->bcn_cnts_after_csa = 0; -+ -+ _rtw_memcpy(cur_beacon, &recv_beacon, sizeof(recv_beacon)); -+ clr_fwstate(pmlmepriv, WIFI_CSA_UPDATE_BEACON); -+ -+ /* RTW_INFO("u_ch=%d, u_bw=%d, u_offset=%d \n", u_ch, u_bw, u_offset); -+ RTW_INFO("recv_beacon.ch=%d, recv_beacon.bw=%d, recv_beacon.offset=%d \n", recv_beacon.ch, recv_beacon.bw, recv_beacon.offset); */ -+ /* rtw_dump_bcn_keys(RTW_DBGDUMP, &recv_beacon); */ -+ -+ /* RTW_INFO("_cancel_timer_async csa_timer\n"); */ -+ _cancel_timer_async(&pmlmeext->csa_timer); -+ -+ /* beacon bw/offset is different from CSA IE */ -+ if((recv_beacon.bw > u_bw) || -+ ((recv_beacon.offset != HAL_PRIME_CHNL_OFFSET_DONT_CARE) && ((u_offset != HAL_PRIME_CHNL_OFFSET_DONT_CARE)) -+ && (recv_beacon.offset != u_offset))) { -+ -+ /* update ch, bw, offset for all asoc STA ifaces */ -+ if (ifbmp_s) { -+ _adapter *iface; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface || !(ifbmp_s & BIT(iface->iface_id))) -+ continue; -+ -+ iface->mlmeextpriv.cur_channel = recv_beacon.ch; -+ iface->mlmeextpriv.cur_bwmode = recv_beacon.bw; -+ iface->mlmeextpriv.cur_ch_offset = recv_beacon.offset; -+ iface->mlmepriv.cur_network.network.Configuration.DSConfig = recv_beacon.ch; -+ } -+ } -+ -+#ifdef CONFIG_AP_MODE -+ if (ifbmp_m) { -+ rtw_change_bss_chbw_cmd(dvobj_get_primary_adapter(dvobj), 0 -+ , ifbmp_m, 0, recv_beacon.ch, REQ_BW_ORI, REQ_OFFSET_NONE); -+ } else -+#endif -+ { -+ #ifdef CONFIG_DFS_MASTER -+ rtw_dfs_rd_en_decision(dvobj_get_primary_adapter(dvobj), MLME_OPCH_SWITCH, 0); -+ #endif -+ rtw_set_chbw_cmd(Adapter, recv_beacon.ch, recv_beacon.bw, recv_beacon.offset, 0); -+ } -+ rtw_mi_get_ch_setting_union(Adapter, &u_ch, &u_bw, &u_offset); -+ -+ /* RTW_INFO("u_ch=%d, u_bw=%d, u_offset=%d \n", u_ch, u_bw, u_offset); */ -+ } else { -+ RTW_INFO("u_ch=%d, u_bw=%d, u_offset=%d, recv_beacon.ch=%d, recv_beacon.bw=%d, recv_beacon.offset=%d\n" -+ , u_ch, u_bw, u_offset, recv_beacon.ch, recv_beacon.bw, recv_beacon.offset); -+ } -+ -+ rtw_iqk_cmd(Adapter, 0); -+ psta = rtw_get_stainfo(&Adapter->stapriv, get_bssid(&Adapter->mlmepriv)); -+ if (psta) -+ rtw_dm_ra_mask_wk_cmd(Adapter, (u8 *)psta); -+ -+ RTW_INFO("csa : update beacon done, WIFI_CSA_UPDATE_BEACON is clear\n"); -+ } -+ -+#ifdef CONFIG_BCN_CNT_CONFIRM_HDL -+ if (_rtw_memcmp(&recv_beacon, cur_beacon, 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_DBG("%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(RTW_DBGDUMP, cur_beacon)); -+ } -+ -+ RTW_DBG("%s: new beacon key\n", __func__); -+ RTW_DBG_EXPR(rtw_dump_bcn_keys(RTW_DBGDUMP, &recv_beacon)); -+ -+ _rtw_memcpy(&pmlmepriv->new_beacon_keys, &recv_beacon, sizeof(recv_beacon)); -+ pmlmepriv->new_beacon_cnts = 1; -+ } else { -+ RTW_DBG("%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) -+#else -+ if (_rtw_memcmp(&recv_beacon, cur_beacon, sizeof(recv_beacon)) == _FALSE) -+#endif -+ { -+ RTW_INFO(FUNC_ADPT_FMT" new beacon occur!!\n", FUNC_ADPT_ARG(Adapter)); -+ RTW_INFO(FUNC_ADPT_FMT" cur beacon key:\n", FUNC_ADPT_ARG(Adapter)); -+ rtw_dump_bcn_keys(RTW_DBGDUMP, cur_beacon); -+ RTW_INFO(FUNC_ADPT_FMT" new beacon key:\n", FUNC_ADPT_ARG(Adapter)); -+ rtw_dump_bcn_keys(RTW_DBGDUMP, &recv_beacon); -+ -+ rtw_bcn_key_err_fix(cur_beacon, &recv_beacon); -+ -+ if (rtw_bcn_key_compare(cur_beacon, &recv_beacon) == _FALSE) -+ goto exit; -+ -+ _rtw_memcpy(cur_beacon, &recv_beacon, sizeof(recv_beacon)); -+ #ifdef CONFIG_BCN_CNT_CONFIRM_HDL -+ pmlmepriv->new_beacon_cnts = 0; -+ #endif -+ } -+ -+exit_success: -+ ret = 1; -+ -+exit: -+ return ret; -+} -+ -+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 WLAN_EID_EXT_CAP: -+ 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); -+ } -+} -+ -+#if CONFIG_DFS -+void process_csa_ie(_adapter *padapter, u8 *ies, uint ies_len) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ unsigned int i, j, countdown; -+ PNDIS_802_11_VARIABLE_IEs pIE, sub_pie; -+ u8 ch = 0, csa_ch_offset = 0, csa_ch_width = 0, csa_ch_freq_seg0 = 0, csa_ch_freq_seg1 = 0, csa_switch_cnt = 0; -+ -+ /* compare with scheduling CSA to block incoming CSA IE */ -+ if (rfctl->csa_ch || check_fwstate(pmlmepriv, WIFI_CSA_UPDATE_BEACON)) -+ return; -+ -+ for (i = 0; i + 1 < ies_len;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(ies + i); -+ -+ switch (pIE->ElementID) { -+ case WLAN_EID_CHANNEL_SWITCH: -+ ch = *(pIE->data + 1); -+ csa_switch_cnt = *(pIE->data + 2); -+ break; -+ case WLAN_EID_SECONDARY_CHANNEL_OFFSET: -+ csa_ch_offset = *(pIE->data); -+ break; -+ case WLAN_EID_WIDE_BANDWIDTH_CHANNEL_SWITCH: -+ csa_ch_width = *(pIE->data); -+ csa_ch_freq_seg0 = *(pIE->data+1); -+ csa_ch_freq_seg1 = *(pIE->data+2); -+ /* RTW_INFO("bw:%02x center_freq_0:%d center_freq_1:%d, ch=%d\n" -+ , csa_ch_width, csa_ch_freq_seg0, csa_ch_freq_seg1, ch); */ -+ break; -+ case WLAN_EID_CHANNEL_SWITCH_WRAPPER: -+ for(j=0; j + 1 < pIE->Length;) { -+ sub_pie = (PNDIS_802_11_VARIABLE_IEs)(ies + i + j + 2); -+ if(sub_pie->ElementID == WLAN_EID_WIDE_BANDWIDTH_CHANNEL_SWITCH) { -+ csa_ch_width = *(sub_pie->data); -+ csa_ch_freq_seg0 = *(sub_pie->data+1); -+ csa_ch_freq_seg1 = *(sub_pie->data+2); -+ /* RTW_INFO("2. sub_IE:%02x IE_length:%02x bw:%02x center_freq_0:%d center_freq_1:%d, ch=%d\n" -+ , sub_pie->ElementID, sub_pie->Length, csa_ch_width, csa_ch_freq_seg0, csa_ch_freq_seg1, ch); */ -+ } -+ j += (sub_pie->Length + 2); -+ } -+ break; -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ /* Doesn't support switch bandwidth/offset in the same channel for now */ -+ if (ch == rtw_mi_get_union_chan(padapter)) { -+ RTW_ERR("%s : receive the same channel from CSA IE, so ignore it\n", __func__); -+ return; -+ } -+ -+ if (ch != 0) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *pri_adapter = dvobj_get_primary_adapter(dvobj); -+ u8 ifbmp_m = rtw_mi_get_ap_mesh_ifbmp(pri_adapter); -+ -+ rfctl->csa_ch = ch; -+ rfctl->csa_switch_cnt = csa_switch_cnt; -+ rfctl->csa_ch_offset = csa_ch_offset; -+ rfctl->csa_ch_width = csa_ch_width; -+ rfctl->csa_ch_freq_seg0 = csa_ch_freq_seg0; -+ rfctl->csa_ch_freq_seg1 = csa_ch_freq_seg1; -+ -+ #ifdef CONFIG_AP_MODE -+ if(ifbmp_m) { -+ rfctl->ap_csa_en = STA_RX_CSA; -+ rfctl->ap_csa_ch = ch; -+ rfctl->ap_csa_switch_cnt = csa_switch_cnt; -+ rtw_set_ap_csa_cmd(pri_adapter); -+ } -+ #endif -+ -+ countdown = pmlmeinfo->network.Configuration.BeaconPeriod * (csa_switch_cnt+1); /* ms */ -+ RTW_INFO("csa: set countdown timer to %d ms\n", countdown); -+ _set_timer(&pri_adapter->mlmeextpriv.csa_timer, countdown); -+ -+ } -+} -+#endif /* CONFIG_DFS */ -+ -+#ifdef CONFIG_80211D -+bool rtw_iface_accept_country_ie(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ if (!(BIT(adapter->iface_id) & rfctl->country_ie_slave_en_ifbmp)) -+ return 0; -+ if (!MLME_IS_STA(adapter)) -+ return 0; -+ if (!MLME_IS_GC(adapter)) { -+ if (!(rfctl->country_ie_slave_en_role & COUNTRY_IE_SLAVE_EN_ROLE_STA)) -+ return 0; -+ } else { -+ if (!(rfctl->country_ie_slave_en_role & COUNTRY_IE_SLAVE_EN_ROLE_GC)) -+ return 0; -+ } -+ return 1; -+} -+ -+void process_country_ie(_adapter *adapter, u8 *ies, uint ies_len) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ if (rfctl->regd_src == REGD_SRC_RTK_PRIV -+ && !rtw_rfctl_is_disable_sw_channel_plan(rfctl_to_dvobj(rfctl)) -+ && !rfctl->csa_ch /* don't process country ie when under CSA processing */ -+ ) { -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ const u8 *ie = NULL; -+ sint ie_len = 0; -+ -+ if (rtw_iface_accept_country_ie(adapter)) { -+ ie = rtw_get_ie(ies, WLAN_EID_COUNTRY, &ie_len, ies_len); -+ if (ie) { -+ if (ie_len < 6) { -+ ie = NULL; -+ ie_len = 0; -+ } else -+ ie_len += 2; -+ } -+ } -+ -+ if (!mlme->recv_country_ie && !ie) -+ return; -+ if (mlme->recv_country_ie_len == ie_len -+ && _rtw_memcmp(mlme->recv_country_ie, ie, ie_len) == _TRUE) -+ return; -+ -+ if (!ie) { -+ rtw_buf_free(&mlme->recv_country_ie, &mlme->recv_country_ie_len); -+ rtw_apply_recv_country_ie_cmd(adapter, 0, 0, 0, NULL); -+ } else { -+ char ori_alpha2[2] = {0, 0}; -+ -+ if (mlme->recv_country_ie) -+ _rtw_memcpy(ori_alpha2, mlme->recv_country_ie + 2, 2); -+ -+ rtw_buf_update(&mlme->recv_country_ie, &mlme->recv_country_ie_len, ie, ie_len); -+ /* for now only country code is used */ -+ if (_rtw_memcmp(ori_alpha2, mlme->recv_country_ie + 2, 2) == _TRUE) -+ return; -+ RTW_INFO(FUNC_ADPT_FMT" country_ie alpha2 changed\n", FUNC_ADPT_ARG(adapter)); -+ rtw_apply_recv_country_ie_cmd(adapter, 0 -+ , mlme->cur_beacon_keys.ch > 14 ? BAND_ON_5G : BAND_ON_2_4G -+ , mlme->cur_beacon_keys.ch, mlme->recv_country_ie); -+ } -+ } -+} -+#endif /* CONFIG_80211D */ -+ -+enum eap_type parsing_eapol_packet(_adapter *padapter, u8 *key_payload, struct sta_info *psta, u8 trx_type) -+{ -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ struct ieee802_1x_hdr *hdr; -+ struct wpa_eapol_key *key; -+ u16 key_info, key_data_length; -+ char *trx_msg = trx_type ? "send" : "recv"; -+ enum eap_type eapol_type; -+ -+ hdr = (struct ieee802_1x_hdr *) key_payload; -+ -+ /* WPS - eapol start packet */ -+ if (hdr->type == 1 && hdr->length == 0) { -+ RTW_INFO("%s eapol start packet\n", trx_msg); -+ return EAPOL_START; -+ } -+ -+ if (hdr->type == 0) { /* WPS - eapol packet */ -+ RTW_INFO("%s eapol packet\n", trx_msg); -+ return EAPOL_PACKET; -+ } -+ -+ key = (struct wpa_eapol_key *) (hdr + 1); -+ key_info = be16_to_cpu(*((u16 *)(key->key_info))); -+ key_data_length = be16_to_cpu(*((u16 *)(key->key_data_length))); -+ -+ if (!(key_info & WPA_KEY_INFO_KEY_TYPE)) { /* WPA group key handshake */ -+ if (key_info & WPA_KEY_INFO_ACK) { -+ RTW_PRINT("%s eapol packet - WPA Group Key 1/2\n", trx_msg); -+ eapol_type = EAPOL_WPA_GROUP_KEY_1_2; -+ } else { -+ RTW_PRINT("%s eapol packet - WPA Group Key 2/2\n", trx_msg); -+ eapol_type = EAPOL_WPA_GROUP_KEY_2_2; -+ -+ /* WPA key-handshake has completed */ -+ if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPAPSK) -+ psta->state &= (~WIFI_UNDER_KEY_HANDSHAKE); -+ } -+ } else if (key_info & WPA_KEY_INFO_MIC) { -+ if (key_data_length == 0) { -+ RTW_PRINT("%s eapol packet 4/4\n", trx_msg); -+ eapol_type = EAPOL_4_4; -+ } else if (key_info & WPA_KEY_INFO_ACK) { -+ RTW_PRINT("%s eapol packet 3/4\n", trx_msg); -+ eapol_type = EAPOL_3_4; -+ } else { -+ RTW_PRINT("%s eapol packet 2/4\n", trx_msg); -+ eapol_type = EAPOL_2_4; -+ } -+ } else { -+ RTW_PRINT("%s eapol packet 1/4\n", trx_msg); -+ eapol_type = EAPOL_1_4; -+ } -+ -+ return eapol_type; -+} -+ -+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; -+ break; -+ 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; -+ break; -+ 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; -+} -+ -+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(u64 mask) -+{ -+ int i; -+ unsigned char rate_idx = 0; -+ -+ for (i = 63; i >= 0; i--) { -+ if ((mask >> i) & 0x01) { -+ rate_idx = i; -+ break; -+ } -+ } -+ -+ return rate_idx; -+} -+unsigned char get_lowest_rate_idx_ex(u64 mask, int start_bit) -+{ -+ int i; -+ unsigned char rate_idx = 0; -+ -+ for (i = start_bit; i < 64; i++) { -+ if ((mask >> i) & 0x01) { -+ rate_idx = i; -+ break; -+ } -+ } -+ -+ return rate_idx; -+} -+ -+void Update_RA_Entry(_adapter *padapter, struct sta_info *psta) -+{ -+ rtw_hal_update_ra_mask(psta); -+} -+ -+void set_sta_rate(_adapter *padapter, struct sta_info *psta) -+{ -+ /* rate adaptive */ -+ rtw_hal_update_ra_mask(psta); -+} -+ -+/* 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 */ -+ -+ _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; -+ -+ 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"); -+ } -+ } -+ } -+ -+ 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 get_assoc_AP_Vendor(char *vendor, u8 assoc_AP_vendor) -+{ -+ switch (assoc_AP_vendor) { -+ -+ case HT_IOT_PEER_UNKNOWN: -+ sprintf(vendor, "%s", "unknown"); -+ break; -+ -+ case HT_IOT_PEER_REALTEK: -+ case HT_IOT_PEER_REALTEK_92SE: -+ case HT_IOT_PEER_REALTEK_SOFTAP: -+ case HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP: -+ case HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP: -+ -+ sprintf(vendor, "%s", "Realtek"); -+ break; -+ -+ case HT_IOT_PEER_BROADCOM: -+ sprintf(vendor, "%s", "Broadcom"); -+ break; -+ -+ case HT_IOT_PEER_MARVELL: -+ sprintf(vendor, "%s", "Marvell"); -+ break; -+ -+ case HT_IOT_PEER_RALINK: -+ sprintf(vendor, "%s", "Ralink"); -+ break; -+ -+ case HT_IOT_PEER_CISCO: -+ sprintf(vendor, "%s", "Cisco"); -+ break; -+ -+ case HT_IOT_PEER_AIRGO: -+ sprintf(vendor, "%s", "Airgo"); -+ break; -+ -+ case HT_IOT_PEER_ATHEROS: -+ sprintf(vendor, "%s", "Atheros"); -+ break; -+ -+ default: -+ sprintf(vendor, "%s", "unkown"); -+ break; -+ } -+ -+} -+#ifdef CONFIG_RTS_FULL_BW -+void rtw_parse_sta_vendor_ie_8812(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len) -+{ -+ unsigned char REALTEK_OUI[] = {0x00,0xe0, 0x4c}; -+ u8 *p; -+ -+ p = rtw_get_ie_ex(tlv_ies, tlv_ies_len, WLAN_EID_VENDOR_SPECIFIC, REALTEK_OUI, 3, NULL, NULL); -+ if (!p) -+ goto exit; -+ else { -+ if(*(p+1) > 6 ) { -+ -+ if(*(p+6) != 2) -+ goto exit; -+ -+ if(*(p+8) == RT_HT_CAP_USE_JAGUAR_BCUT) -+ sta->vendor_8812 = TRUE; -+ else if (*(p+8) == RT_HT_CAP_USE_JAGUAR_CCUT) -+ sta->vendor_8812 = TRUE; -+ } -+ } -+exit: -+ return; -+} -+#endif/*CONFIG_RTS_FULL_BW*/ -+ -+#ifdef CONFIG_80211AC_VHT -+void get_vht_bf_cap(u8 *pframe, uint len, struct vht_bf_cap *bf_cap) -+{ -+ 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 EID_VHTCapability: -+ bf_cap->is_mu_bfer = GET_VHT_CAPABILITY_ELE_MU_BFER(pIE->data); -+ bf_cap->su_sound_dim = GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(pIE->data); -+ break; -+ default: -+ break; -+ } -+ i += (pIE->Length + 2); -+ } -+} -+#endif -+ -+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; -+ 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); */ -+ -+#ifndef RTW_HALMAC -+ /* HALMAC IC do not set HW_VAR_RESP_SIFS here */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_RESP_SIFS, NULL); -+#endif -+ 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, *p; -+ unsigned int ie_len; -+ int i, j; -+ -+ struct support_rate_handler support_rate_tbl[] = { -+ {IEEE80211_CCK_RATE_1MB, _FALSE, _FALSE}, -+ {IEEE80211_CCK_RATE_2MB, _FALSE, _FALSE}, -+ {IEEE80211_CCK_RATE_5MB, _FALSE, _FALSE}, -+ {IEEE80211_CCK_RATE_11MB, _FALSE, _FALSE}, -+ {IEEE80211_OFDM_RATE_6MB, _FALSE, _FALSE}, -+ {IEEE80211_OFDM_RATE_9MB, _FALSE, _FALSE}, -+ {IEEE80211_OFDM_RATE_12MB, _FALSE, _FALSE}, -+ {IEEE80211_OFDM_RATE_18MB, _FALSE, _FALSE}, -+ {IEEE80211_OFDM_RATE_24MB, _FALSE, _FALSE}, -+ {IEEE80211_OFDM_RATE_36MB, _FALSE, _FALSE}, -+ {IEEE80211_OFDM_RATE_48MB, _FALSE, _FALSE}, -+ {IEEE80211_OFDM_RATE_54MB, _FALSE, _FALSE}, -+ }; -+ -+ 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; -+ -+ /* get valid supported rates */ -+ for (i = 0; i < 12; i++) { -+ p = ie + 2; -+ for (j = 0; j < ie_len; j++) { -+ if ((*p & ~BIT(7)) == support_rate_tbl[i].rate){ -+ support_rate_tbl[i].existence = _TRUE; -+ if ((*p) & BIT(7)) -+ support_rate_tbl[i].basic = _TRUE; -+ } -+ p++; -+ } -+ } -+ -+ext_rate: -+ ie = rtw_get_ie(ies, _EXT_SUPPORTEDRATES_IE_, &ie_len, ies_len); -+ if (ie) { -+ /* get valid extended supported rates */ -+ for (i = 0; i < 12; i++) { -+ p = ie + 2; -+ for (j = 0; j < ie_len; j++) { -+ if ((*p & ~BIT(7)) == support_rate_tbl[i].rate){ -+ support_rate_tbl[i].existence = _TRUE; -+ if ((*p) & BIT(7)) -+ support_rate_tbl[i].basic = _TRUE; -+ } -+ p++; -+ } -+ } -+ } -+ -+ for (i = 0; i < 12; i++){ -+ if (support_rate_tbl[i].existence){ -+ if (support_rate_tbl[i].basic) -+ rate_set[*rate_num] = support_rate_tbl[i].rate | IEEE80211_BASIC_RATE_MASK; -+ else -+ rate_set[*rate_num] = support_rate_tbl[i].rate; -+ *rate_num += 1; -+ } -+ } -+ -+ 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; -+ 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); -+ if (padapter->fix_rx_ampdu_size != RX_AMPDU_SIZE_INVALID) -+ size = padapter->fix_rx_ampdu_size; -+ else { -+ size = rtw_rx_ampdu_size(padapter); -+ size = rtw_min(size, rx_ampdu_size_sta_limit(padapter, psta)); -+ } -+ -+ 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 rtw_process_bar_frame(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct sta_info *psta = NULL; -+ struct recv_reorder_ctrl *preorder_ctrl = NULL; -+ u8 tid = 0; -+ u16 start_seq=0; -+ -+ psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); -+ if (psta == NULL) -+ goto exit; -+ -+ tid = ((cpu_to_le16((*(u16 *)(pframe + 16))) & 0xf000) >> 12); -+ preorder_ctrl = &psta->recvreorder_ctrl[tid]; -+ start_seq = ((cpu_to_le16(*(u16 *)(pframe + 18))) >> 4); -+ preorder_ctrl->indicate_seq = start_seq; -+ -+ /* for Debug use */ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" tid=%d, start_seq=%d\n", FUNC_ADPT_ARG(padapter), tid, start_seq); -+ -+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, u8 mlme_state) -+{ -+ u8 m_state = mlme_state; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CORRECT_TSF, (u8 *)&m_state); -+} -+ -+#ifdef CONFIG_BCN_RECV_TIME -+/* calculate beacon receiving time -+ 1.RxBCNTime(CCK_1M) = [192us(preamble)] + [length of beacon(byte)*8us] + [10us] -+ 2.RxBCNTime(OFDM_6M) = [8us(S) + 8us(L) + 4us(L-SIG)] + [(length of beacon(byte)/3 + 1] *4us] + [10us] -+*/ -+inline u16 _rx_bcn_time_calculate(uint bcn_len, u8 data_rate) -+{ -+ u16 rx_bcn_time = 0;/*us*/ -+ -+ if (data_rate == DESC_RATE1M) -+ rx_bcn_time = 192 + bcn_len * 8 + 10; -+ else if(data_rate == DESC_RATE6M) -+ rx_bcn_time = 8 + 8 + 4 + (bcn_len /3 + 1) * 4 + 10; -+/* -+ else -+ RTW_ERR("%s invalid data rate(0x%02x)\n", __func__, data_rate); -+*/ -+ return rx_bcn_time; -+} -+void rtw_rx_bcn_time_update(_adapter *adapter, uint bcn_len, u8 data_rate) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ -+ pmlmeext->bcn_rx_time = _rx_bcn_time_calculate(bcn_len, data_rate); -+} -+#endif -+ -+void beacon_timing_control(_adapter *padapter) -+{ -+ rtw_hal_bcn_related_reg_setting(padapter); -+} -+ -+inline bool _rtw_macid_ctl_chk_cap(_adapter *adapter, u8 cap) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = &dvobj->macid_ctl; -+ -+ if (macid_ctl->macid_cap & cap) -+ return _TRUE; -+ return _FALSE; -+} -+ -+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); -+} -+ -+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 u8 rtw_macid_get_iface_bmp(struct macid_ctl_t *macid_ctl, u8 id) -+{ -+ int i; -+ u8 iface_bmp = 0; -+ -+ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) { -+ if (rtw_macid_is_set(&macid_ctl->if_g[i], id)) -+ iface_bmp |= BIT(i); -+ } -+ return iface_bmp; -+} -+ -+inline bool rtw_macid_is_iface_shared(struct macid_ctl_t *macid_ctl, u8 id) -+{ -+#if CONFIG_IFACE_NUMBER >= 2 -+ int i; -+ u8 iface_bmp = 0; -+ -+ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) { -+ if (rtw_macid_is_set(&macid_ctl->if_g[i], id)) { -+ if (iface_bmp) -+ return 1; -+ iface_bmp |= BIT(i); -+ } -+ } -+#endif -+ return 0; -+} -+ -+inline bool rtw_macid_is_iface_specific(struct macid_ctl_t *macid_ctl, u8 id, _adapter *adapter) -+{ -+ int i; -+ u8 iface_bmp = 0; -+ -+ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) { -+ if (rtw_macid_is_set(&macid_ctl->if_g[i], id)) { -+ if (iface_bmp || i != adapter->iface_id) -+ return 0; -+ iface_bmp |= BIT(i); -+ } -+ } -+ -+ return iface_bmp ? 1 : 0; -+} -+ -+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; -+} -+ -+/*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]; -+} -+#if defined(DBG_CONFIG_ERROR_RESET) -+void rtw_iface_bcmc_sec_cam_map_restore(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); -+ int cam_id = -1; -+ -+ cam_id = rtw_iface_bcmc_id_get(adapter); -+ if (cam_id != INVALID_SEC_MAC_CAM_ID) -+ rtw_sec_cam_map_set(&cam_ctl->used, cam_id); -+} -+#endif -+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->cmn.mac_addr, adapter_mac_addr(padapter), ETH_ALEN)) { -+ psta->cmn.mac_id = macid_ctl->num; -+ return; -+ } -+ -+ if (_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN)) { -+ is_bc_sta = _TRUE; -+ rtw_iface_bcmc_id_set(padapter, INVALID_SEC_MAC_CAM_ID); /*init default value*/ -+ } -+ -+ if (is_bc_sta -+ #ifndef SEC_DEFAULT_KEY_SEARCH -+ && (MLME_IS_STA(padapter) || MLME_IS_NULL(padapter)) -+ #endif -+ ) { -+ /* STA mode have no BMC data TX, shared with this macid */ -+ /* When non-concurrent, only one BMC data TX is used, shared with this macid */ -+ /* TODO: When concurrent, non-security BMC data TX may use this, but will not control by specific macid sleep */ -+ i = RTW_DEFAULT_MGMT_MACID; -+ goto assigned; -+ } -+ -+ _enter_critical_bh(&macid_ctl->lock, &irqL); -+ -+ for (i = last_id; i < macid_ctl->num; i++) { -+#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 */ -+ -+ #ifndef SEC_DEFAULT_KEY_SEARCH -+ /* for BMC data TX with force camid */ -+ if (is_bc_sta && rtw_sec_camid_is_used(dvobj_to_sec_camctl(dvobj), i)) -+ continue; -+ #endif -+ -+ if (!rtw_macid_is_used(macid_ctl, i)) -+ break; -+ } -+ -+ if (i < macid_ctl->num) { -+ -+ rtw_macid_map_set(used_map, i); -+ -+ #ifndef SEC_DEFAULT_KEY_SEARCH -+ /* for BMC data TX with force camid */ -+ 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); -+ if (_rtw_camctl_chk_cap(padapter, SEC_CAP_CHK_EXTRA_SEC)) -+ rtw_sec_cam_map_set(&cam_ctl->used, i + 1); -+ } -+ #endif -+ -+ 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->cmn.mac_id = macid_ctl->num; -+ RTW_ERR(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" no available macid\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->cmn.mac_addr)); -+ rtw_warn_on(1); -+ goto exit; -+ } else -+ goto assigned; -+ -+assigned: -+ psta->cmn.mac_id = i; -+ RTW_INFO(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" macid:%u\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->cmn.mac_addr), psta->cmn.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 ifbmp; -+ int i; -+ -+ if (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(padapter), ETH_ALEN)) -+ goto exit; -+ -+ if (psta->cmn.mac_id >= macid_ctl->num) { -+ RTW_WARN(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" macid:%u not valid\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1 -+ , MAC_ARG(psta->cmn.mac_addr), psta->cmn.mac_id); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (psta->cmn.mac_id == RTW_DEFAULT_MGMT_MACID) -+ goto msg; -+ -+ _enter_critical_bh(&macid_ctl->lock, &irqL); -+ -+ if (!rtw_macid_is_used(macid_ctl, psta->cmn.mac_id)) { -+ RTW_WARN(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" macid:%u not used\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1 -+ , MAC_ARG(psta->cmn.mac_addr), psta->cmn.mac_id); -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ ifbmp = rtw_macid_get_iface_bmp(macid_ctl, psta->cmn.mac_id); -+ if (!(ifbmp & BIT(padapter->iface_id))) { -+ RTW_WARN(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" macid:%u not used by self\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1 -+ , MAC_ARG(psta->cmn.mac_addr), psta->cmn.mac_id); -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN)) { -+ 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); -+ if (_rtw_camctl_chk_cap(padapter, SEC_CAP_CHK_EXTRA_SEC)) -+ rtw_sec_cam_map_clr(&cam_ctl->used, id + 1); -+ } -+ -+ rtw_iface_bcmc_id_set(padapter, INVALID_SEC_MAC_CAM_ID); -+ } -+ -+ rtw_macid_map_clr(&macid_ctl->if_g[padapter->iface_id], psta->cmn.mac_id); -+ -+ ifbmp &= ~BIT(padapter->iface_id); -+ if (!ifbmp) { /* only used by self */ -+ rtw_macid_map_clr(&macid_ctl->used, psta->cmn.mac_id); -+ rtw_macid_map_clr(&macid_ctl->bmc, psta->cmn.mac_id); -+ for (i = 0; i < 2; i++) -+ rtw_macid_map_clr(&macid_ctl->ch_g[i], psta->cmn.mac_id); -+ macid_ctl->sta[psta->cmn.mac_id] = NULL; -+ } -+ -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ -+msg: -+ RTW_INFO(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" macid:%u\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1 -+ , MAC_ARG(psta->cmn.mac_addr), psta->cmn.mac_id -+ ); -+ -+exit: -+ psta->cmn.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 u8 rtw_macid_ctl_set_h2c_msr(struct macid_ctl_t *macid_ctl, u8 id, u8 h2c_msr) -+{ -+ u8 op_num_change_bmp = 0; -+ -+ if (id >= macid_ctl->num) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (GET_H2CCMD_MSRRPT_PARM_OPMODE(&macid_ctl->h2c_msr[id]) -+ && !GET_H2CCMD_MSRRPT_PARM_OPMODE(&h2c_msr) -+ ) { -+ u8 role = GET_H2CCMD_MSRRPT_PARM_ROLE(&macid_ctl->h2c_msr[id]); -+ -+ if (role < H2C_MSR_ROLE_MAX) { -+ macid_ctl->op_num[role]--; -+ op_num_change_bmp |= BIT(role); -+ } -+ } else if (!GET_H2CCMD_MSRRPT_PARM_OPMODE(&macid_ctl->h2c_msr[id]) -+ && GET_H2CCMD_MSRRPT_PARM_OPMODE(&h2c_msr) -+ ) { -+ u8 role = GET_H2CCMD_MSRRPT_PARM_ROLE(&h2c_msr); -+ -+ if (role < H2C_MSR_ROLE_MAX) { -+ macid_ctl->op_num[role]++; -+ op_num_change_bmp |= BIT(role); -+ } -+ } -+ -+ 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])); -+ -+exit: -+ return op_num_change_bmp; -+} -+ -+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]); -+} -+ -+#ifdef CONFIG_PROTSEL_MACSLEEP -+inline void rtw_macid_ctl_init_sleep_reg(struct macid_ctl_t *macid_ctl, u16 reg_ctrl, u16 reg_info) -+{ -+ macid_ctl->reg_sleep_ctrl = reg_ctrl; -+ macid_ctl->reg_sleep_info = reg_info; -+} -+inline void rtw_macid_ctl_init_drop_reg(struct macid_ctl_t *macid_ctl, u16 reg_ctrl, u16 reg_info) -+{ -+ macid_ctl->reg_drop_ctrl = reg_ctrl; -+ macid_ctl->reg_drop_info = reg_info; -+} -+ -+#else -+inline void rtw_macid_ctl_init_sleep_reg(struct macid_ctl_t *macid_ctl, u16 m0, u16 m1, u16 m2, u16 m3) -+{ -+ macid_ctl->reg_sleep_m0 = m0; -+#if (MACID_NUM_SW_LIMIT > 32) -+ macid_ctl->reg_sleep_m1 = m1; -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ macid_ctl->reg_sleep_m2 = m2; -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ macid_ctl->reg_sleep_m3 = m3; -+#endif -+} -+ -+inline void rtw_macid_ctl_init_drop_reg(struct macid_ctl_t *macid_ctl, u16 m0, u16 m1, u16 m2, u16 m3) -+{ -+ macid_ctl->reg_drop_m0 = m0; -+#if (MACID_NUM_SW_LIMIT > 32) -+ macid_ctl->reg_drop_m1 = m1; -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ macid_ctl->reg_drop_m2 = m2; -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ macid_ctl->reg_drop_m3 = m3; -+#endif -+} -+#endif -+ -+inline void rtw_macid_ctl_init(struct macid_ctl_t *macid_ctl) -+{ -+ int i; -+ u8 id = RTW_DEFAULT_MGMT_MACID; -+ -+ rtw_macid_map_set(&macid_ctl->used, id); -+ rtw_macid_map_set(&macid_ctl->bmc, id); -+ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) -+ rtw_macid_map_set(&macid_ctl->if_g[i], id); -+ macid_ctl->sta[id] = NULL; -+ -+ _rtw_spinlock_init(&macid_ctl->lock); -+} -+ -+inline void rtw_macid_ctl_deinit(struct macid_ctl_t *macid_ctl) -+{ -+ _rtw_spinlock_free(&macid_ctl->lock); -+} -+ -+inline bool rtw_bmp_is_set(const u8 *bmp, u8 bmp_len, u8 id) -+{ -+ if (id / 8 >= bmp_len) -+ return 0; -+ -+ return bmp[id / 8] & BIT(id % 8); -+} -+ -+inline void rtw_bmp_set(u8 *bmp, u8 bmp_len, u8 id) -+{ -+ if (id / 8 < bmp_len) -+ bmp[id / 8] |= BIT(id % 8); -+} -+ -+inline void rtw_bmp_clear(u8 *bmp, u8 bmp_len, u8 id) -+{ -+ if (id / 8 < bmp_len) -+ bmp[id / 8] &= ~BIT(id % 8); -+} -+ -+inline bool rtw_bmp_not_empty(const u8 *bmp, u8 bmp_len) -+{ -+ int i; -+ -+ for (i = 0; i < bmp_len; i++) { -+ if (bmp[i]) -+ return 1; -+ } -+ -+ return 0; -+} -+ -+inline bool rtw_bmp_not_empty_exclude_bit0(const u8 *bmp, u8 bmp_len) -+{ -+ int i; -+ -+ for (i = 0; i < bmp_len; i++) { -+ if (i == 0) { -+ if (bmp[i] & 0xFE) -+ return 1; -+ } else { -+ if (bmp[i]) -+ return 1; -+ } -+ } -+ -+ return 0; -+} -+ -+#ifdef CONFIG_AP_MODE -+/* Check the id be set or not in map , if yes , return a none zero value*/ -+bool rtw_tim_map_is_set(_adapter *padapter, const u8 *map, u8 id) -+{ -+ return rtw_bmp_is_set(map, padapter->stapriv.aid_bmp_len, id); -+} -+ -+/* Set the id into map array*/ -+void rtw_tim_map_set(_adapter *padapter, u8 *map, u8 id) -+{ -+ rtw_bmp_set(map, padapter->stapriv.aid_bmp_len, id); -+} -+ -+/* Clear the id from map array*/ -+void rtw_tim_map_clear(_adapter *padapter, u8 *map, u8 id) -+{ -+ rtw_bmp_clear(map, padapter->stapriv.aid_bmp_len, id); -+} -+ -+/* Check have anyone bit be set , if yes return true*/ -+bool rtw_tim_map_anyone_be_set(_adapter *padapter, const u8 *map) -+{ -+ return rtw_bmp_not_empty(map, padapter->stapriv.aid_bmp_len); -+} -+ -+/* Check have anyone bit be set exclude bit0 , if yes return true*/ -+bool rtw_tim_map_anyone_be_set_exclude_aid0(_adapter *padapter, const u8 *map) -+{ -+ return rtw_bmp_not_empty_exclude_bit0(map, padapter->stapriv.aid_bmp_len); -+} -+#endif /* CONFIG_AP_MODE */ -+ -+#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); -+ -+ set_frame_sub_type(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; -+} -+ -+#ifdef CONFIG_WOWLAN -+bool rtw_wowlan_parser_pattern_cmd(u8 *input, char *pattern, -+ int *pattern_len, char *bit_mask) -+{ -+ char *cp = NULL; -+ size_t len = 0; -+ int pos = 0, mask_pos = 0, res = 0; -+ -+ /* To get the pattern string after "=", when we use : -+ * iwpriv wlanX pattern=XX:XX:..:XX -+ */ -+ cp = strchr(input, '='); -+ if (cp) { -+ *cp = 0; -+ cp++; -+ input = cp; -+ } -+ -+ /* To take off the newline character '\n'(0x0a) at the end of pattern string, -+ * when we use echo xxxx > /proc/xxxx -+ */ -+ cp = strchr(input, '\n'); -+ if (cp) -+ *cp = 0; -+ -+ while (input) { -+ cp = strsep((char **)(&input), ":"); -+ -+ if (bit_mask && (strcmp(cp, "-") == 0 || -+ strcmp(cp, "xx") == 0 || -+ strcmp(cp, "--") == 0)) { -+ /* skip this byte and leave mask bit unset */ -+ } else { -+ u8 hex; -+ -+ if (strlen(cp) != 2) { -+ RTW_ERR("%s:[ERROR] hex len != 2, input=[%s]\n", -+ __func__, cp); -+ goto error; -+ } -+ -+ if (hexstr2bin(cp, &hex, 1) < 0) { -+ RTW_ERR("%s:[ERROR] pattern is invalid, input=[%s]\n", -+ __func__, cp); -+ goto error; -+ } -+ -+ pattern[pos] = hex; -+ mask_pos = pos / 8; -+ if (bit_mask) -+ bit_mask[mask_pos] |= 1 << (pos % 8); -+ } -+ -+ pos++; -+ } -+ -+ (*pattern_len) = pos; -+ -+ return _TRUE; -+error: -+ return _FALSE; -+} -+ -+void rtw_wow_pattern_sw_reset(_adapter *adapter) -+{ -+ int i; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(adapter); -+ -+ if (pwrctrlpriv->default_patterns_en == _TRUE) -+ pwrctrlpriv->wowlan_pattern_idx = DEFAULT_PATTERN_NUM; -+ else -+ pwrctrlpriv->wowlan_pattern_idx = 0; -+ -+ for (i = 0 ; i < MAX_WKFM_CAM_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; -+ } -+} -+ -+u8 rtw_set_default_pattern(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ u8 index = 0; -+ 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 icmpv6_mask[7] = {0x00, 0x70, 0x10, 0x00, 0xc0, 0xc0, 0x3f}; -+ u8 multicast_mask[5] = {0x07, 0x70, 0x80, 0xc0, 0x03}; -+ -+ u8 ip_protocol[3] = {0x08, 0x00, 0x45}; -+ u8 ipv6_protocol[3] = {0x86, 0xdd, 0x60}; -+ -+ u8 *target = NULL; -+ -+ if (pwrpriv->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; -+ } -+ -+ /*TCP/ICMP unicast*/ -+ for (index = 0 ; index < DEFAULT_PATTERN_NUM ; index++) { -+ switch (index) { -+ case 0: -+ target = pwrpriv->patterns[index].content; -+ _rtw_memcpy(target, adapter_mac_addr(adapter), -+ ETH_ALEN); -+ -+ target += ETH_TYPE_OFFSET; -+ _rtw_memcpy(target, &ip_protocol, -+ sizeof(ip_protocol)); -+ -+ /* TCP */ -+ target += (PROTOCOL_OFFSET - ETH_TYPE_OFFSET); -+ _rtw_memset(target, 0x06, 1); -+ -+ target += (IP_OFFSET - PROTOCOL_OFFSET); -+ -+ _rtw_memcpy(target, pmlmeinfo->ip_addr, -+ RTW_IP_ADDR_LEN); -+ -+ _rtw_memcpy(pwrpriv->patterns[index].mask, -+ &unicast_mask, sizeof(unicast_mask)); -+ -+ pwrpriv->patterns[index].len = -+ IP_OFFSET + RTW_IP_ADDR_LEN; -+ break; -+ case 1: -+ target = pwrpriv->patterns[index].content; -+ _rtw_memcpy(target, adapter_mac_addr(adapter), -+ ETH_ALEN); -+ -+ target += ETH_TYPE_OFFSET; -+ _rtw_memcpy(target, &ip_protocol, sizeof(ip_protocol)); -+ -+ /* ICMP */ -+ target += (PROTOCOL_OFFSET - ETH_TYPE_OFFSET); -+ _rtw_memset(target, 0x01, 1); -+ -+ target += (IP_OFFSET - PROTOCOL_OFFSET); -+ _rtw_memcpy(target, pmlmeinfo->ip_addr, -+ RTW_IP_ADDR_LEN); -+ -+ _rtw_memcpy(pwrpriv->patterns[index].mask, -+ &unicast_mask, sizeof(unicast_mask)); -+ pwrpriv->patterns[index].len = -+ -+ IP_OFFSET + RTW_IP_ADDR_LEN; -+ break; -+#ifdef CONFIG_IPV6 -+ case 2: -+ if (pwrpriv->wowlan_ns_offload_en == _TRUE) { -+ target = pwrpriv->patterns[index].content; -+ target += ETH_TYPE_OFFSET; -+ -+ _rtw_memcpy(target, &ipv6_protocol, -+ sizeof(ipv6_protocol)); -+ -+ /* ICMPv6 */ -+ target += (IPv6_PROTOCOL_OFFSET - -+ ETH_TYPE_OFFSET); -+ _rtw_memset(target, 0x3a, 1); -+ -+ target += (IPv6_OFFSET - IPv6_PROTOCOL_OFFSET); -+ _rtw_memcpy(target, pmlmeinfo->ip6_addr, -+ RTW_IPv6_ADDR_LEN); -+ -+ _rtw_memcpy(pwrpriv->patterns[index].mask, -+ &icmpv6_mask, sizeof(icmpv6_mask)); -+ pwrpriv->patterns[index].len = -+ IPv6_OFFSET + RTW_IPv6_ADDR_LEN; -+ } -+ break; -+#endif /*CONFIG_IPV6*/ -+ case 3: -+ target = pwrpriv->patterns[index].content; -+ _rtw_memcpy(target, &multicast_addr, -+ sizeof(multicast_addr)); -+ -+ target += ETH_TYPE_OFFSET; -+ _rtw_memcpy(target, &ip_protocol, sizeof(ip_protocol)); -+ -+ /* UDP */ -+ target += (PROTOCOL_OFFSET - ETH_TYPE_OFFSET); -+ _rtw_memset(target, 0x11, 1); -+ -+ target += (IP_OFFSET - PROTOCOL_OFFSET); -+ _rtw_memcpy(target, &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; -+ default: -+ break; -+ } -+ } -+ return index; -+} -+ -+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_wow_pattern_sw_dump(_adapter *adapter) -+{ -+ int i = 0, total = 0; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ total = pwrpriv->wowlan_pattern_idx; -+ -+ RTW_INFO("********[RTK priv-patterns]*********\n"); -+ for (i = 0 ; i < total; i++) -+ rtw_dump_priv_pattern(adapter, i); -+} -+ -+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_) || -+ (psecpriv->dot11PrivacyAlgrthm == _CCMP_256_)) -+ AES_IV(pcur_dot11txpn, psta->dot11txpn, 0); -+ else if (psecpriv->dot11PrivacyAlgrthm == _TKIP_) -+ TKIP_IV(pcur_dot11txpn, psta->dot11txpn, 0); -+ else if ((psecpriv->dot11PrivacyAlgrthm == _GCMP_) || -+ (psecpriv->dot11PrivacyAlgrthm == _GCMP_256_)) -+ GCMP_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]); -+ } -+} -+ -+#ifdef CONFIG_WAR_OFFLOAD -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+void rtw_wow_war_mdns_dump_buf(struct seq_file *m, u8 *title, u8 *buf, u32 len) -+{ -+ u32 i; -+ -+ RTW_PRINT_SEL(m, "\t%s (%d)\n\t\t", title, len); -+ for (i = 1; i <= len; i++) -+ { -+ RTW_PRINT_SEL(m, "%2.2x-", *(buf + i - 1)); -+ if( (i%16 == 0) && (len != i) ) RTW_PRINT_SEL(m, "\n\t\t"); -+ } -+ RTW_PRINT_SEL(m, "\n\n"); -+} -+ -+void rtw_wow_war_mdns_dump_txt(struct seq_file *m, u8 *title, u8 *buf, u32 len) -+{ -+ u16 idx=1, offset=0; /* offset = the location of L in the Length.Value */ -+ -+ RTW_PRINT_SEL(m, "\t%s (%d)\n\t", title, len); -+ for (; offset < len; idx++) -+ { -+ int item_len = buf[offset]; -+ u8 item_buf[256]={0}; -+ -+ _rtw_memcpy(item_buf, (buf + offset + 1), item_len); -+ RTW_PRINT_SEL(m, "\t[%d] => %s (%d)\n\t", idx, item_buf, item_len); -+ _rtw_memset(item_buf, 0, sizeof(item_buf)); -+ offset += (1+item_len); -+ } -+ RTW_PRINT_SEL(m, "\n\n"); -+} -+ -+bool rtw_wow_war_mdns_parser_pattern(u8 *input, char *target, -+ u32 *target_len, u32 type) -+{ -+ char *cp = NULL, *end = NULL; -+ size_t len = 0; -+ int pos = 0, mask_pos = 0, res = 0; -+ u8 member[2] = {0}; -+ -+ /* reset */ -+ _rtw_memset(target, '\0', type); -+ (*target_len) = 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; -+ -+ { -+ u8 hex,idx=0, pos_in_unit_as_4bit = 0; -+ -+ strncpy(member, input, len); -+ res = sscanf(member, "%02hhx", &hex); -+ -+ target[pos] = hex; -+ -+ /* RTW_INFO("==> in; input-member = %s, hex = %x, target[%d] = %x\n", member, hex, target[pos], pos); */ -+ -+ for(idx = 0; idx<2;idx++) -+ { -+ pos_in_unit_as_4bit = pos*2 + (1-idx); -+ mask_pos = (pos_in_unit_as_4bit /8); -+ -+ if(!IsHexDigit(member[idx])) -+ { -+ RTW_ERR("%s:[ERROR] pattern is invalid!!(%c)\n",__func__, member[idx]); -+ goto error; -+ } -+ -+ /* RTW_INFO("==> in; pos = %d, pos_in_unit_as_4bit = %d, mask-pos = %d \n", pos, pos_in_unit_as_4bit, mask_pos); -+ RTW_INFO("==> in; hex(0x%02x), member(%c%c) \n", pattern[pos], member[1], member[0]); */ -+ } -+ /* RTW_INFO_DUMP("Pattern Mask: ",bit_mask, 6); */ -+ } -+ -+ pos++; -+ if (!cp) -+ break; -+ input = cp; -+ } -+ -+ (*target_len) = pos; -+ -+ return _TRUE; -+error: -+ return _FALSE; -+ -+} -+ -+static struct war_mdns_service_info default_sinfo[] = { -+/* example of default setting */ -+ RTW_MDNS_SRV_INFO("_ipp", 4, "_tcp", 4, "local", 5, 0x02, 0x77, 7200, "KM1", 3, 0), -+ RTW_MDNS_SRV_INFO("_ipps", 5, "_tcp", 4, "local", 5, 0x02, 0x77, 7200, "KM2", 3, 0), -+ RTW_MDNS_SRV_INFO("_http", 5, "_tcp", 4, "local", 5, 0x00, 0x50, 7200, "KM3", 3, 2), -+ RTW_MDNS_SRV_INFO("_privet", 7, "_tcp", 4, "local", 5, 0x00, 0x50, 7200, "KM4", 3, 3), -+ RTW_MDNS_SRV_INFO("_https", 6, "_tcp", 4, "local", 5, 0x01, 0xbb, 7200, "KM5", 3, 2), -+ RTW_MDNS_SRV_INFO("_uscan", 6, "_tcp", 4, "local", 5, 0x1f, 0x91, 7200, "KM6", 3, 4), -+ RTW_MDNS_SRV_INFO("_printer", 8, "_tcp", 4, "local", 5, 0x23, 0x8c, 7200, "KM7", 3, 1), -+ RTW_MDNS_SRV_INFO("_pdl-datastream", 15, "_tcp", 4, "local", 5, 0x23, 0x8c, 7200, "KM8", 3, 1) -+ -+}; -+ -+void rtw_wow_war_mdns_parms_reset(_adapter *adapter, u8 is_set_default) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ u8 i =0; -+ u16 offset=0; -+ u8 default_domain_name[] = "Generic"; -+ //u8 default_machine_name[] = { 0x0a, 0x5f, 0x75, 0x6e, 0x69, 0x76, 0x65, 0x72, 0x73, 0x61, 0x6c, 0x04, 0x5f, 0x73, 0x75, 0x62 }; -+ //u8 default_machine_name_len = 16; -+ u8 default_machine_name[] = { 0x0a, 0x5f, 0x75, 0x6e, 0x69, 0x76, 0x65, 0x72, 0x73, 0x61, 0x6c}; /* length : 10 name : _universal */ -+ u8 default_machine_name_len = 11; -+ -+ /* set default txt value*/ -+ char *default_txt_rsp_0_for_serive[2] = { "_ipp", "_ipps" }; -+ char *default_txt_rsp_0[25] = { -+ "txtvers=1", "qtotal=1", "usb_MFG=KONICA MINOLTA", "usb_MDL=C754Series", -+ "rp=ipp/print","priority=54","tr=Generic 35c-4", "product=DriverName", -+ "pdl=application/postscript,image/urf,application/octet-stream,image/jpeg", -+ "adminurl=http://KM00D91C.local./wcd/a_network.xml", -+ "note=Copy Room", "Transparent=T", "Binary=T", "TBCP=T", -+ "URF=V1,4,w8,SRGB24,ADOBERGB24-48,DEVW8,DEVRGB24,DEVCMYK32,RS150000000,IS19-20-21,MT1-3,OB1,PQ4,DM1,FN3-14,CP255", -+ "rfo=ipp/faxout", "Fax=T", "Scan=T", "Duplex=T", "Color=T", "air=none", -+ "Kind=document,envelope,photo", -+ "PaperMax=tabloid-A3", "UUID=6c183832-69ba-541b-baf6-6d947c144325", "TLS=1.2" -+ }; -+ -+ char *default_txt_rsp_1_for_serive[2] = { "_printer", "_pdl-datastream" }; -+ char *default_txt_rsp_1[13] = { -+ "txtvers=1", "qtotal=1", "usb_MFG=KONICA MINOLTA", "usb_MDL=C754Series", -+ "rp=print","priority=51","tr=Generic 35c-4", "product=DriverName", -+ "pdl=application/postscript", "note=Copy Room", "Transparent=T", "Binary=T", "TBCP=F" -+ }; -+ -+ char *default_txt_rsp_2_for_serive[2] = { "_http", "_https" }; -+ char *default_txt_rsp_2[1] = { -+ "Path=/" -+ }; -+ -+ char *default_txt_rsp_3_for_serive[1] = { "_privet" }; -+ char *default_txt_rsp_3[5] = { -+ "txtvers=1", "url=https://www.google.com/cloudprint", -+ "type=printer", "cs=not-configured","note=Copy Room" -+ }; -+ -+ char *default_txt_rsp_4_for_serive[1] = { "_uscan" }; -+ char *default_txt_rsp_4[11] = { -+ "txtvers=1", "vers=2.5", "adminurl=http://KM00D91C.local./wsd/a_network_airprint.xml", -+ "representation=http://KM00D91C.local./wcd/DeviceIcon_1283png", -+ "rs=eSCL", "ty=KONICA MINOLTA bishub C287", "note=japan", -+ "pdl=image/jpeg,image/tiff,application/pdf", -+ "UUID=dd5454cc-e196-5711-aa1f-35be49a6ca9f", -+ "cs=color,grayscale,binary", "is=platen,adf,duplex=T" -+ }; -+ -+ -+ /* reset ===> */ -+ -+ _rtw_memset(pwrpriv->wowlan_war_offload_mdns_domain_name, 0, MAX_MDNS_DOMAIN_NAME_LEN); -+ _rtw_memset(pwrpriv->wowlan_war_offload_mdns_mnane, 0, sizeof(pwrpriv->wowlan_war_offload_mdns_mnane)); -+ _rtw_memset(pwrpriv->wowlan_war_offload_mdns_service, 0, sizeof(pwrpriv->wowlan_war_offload_mdns_service)); -+ _rtw_memset(pwrpriv->wowlan_war_offload_mdns_txt_rsp, 0, sizeof(pwrpriv->wowlan_war_offload_mdns_txt_rsp)); -+ -+ pwrpriv->wowlan_war_offload_mdns_domain_name_len = 0; -+ pwrpriv->wowlan_war_offload_mdns_mnane_num = 0; -+ pwrpriv->wowlan_war_offload_mdns_service_info_num = 0; -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp_num = 0; -+ pwrpriv->wowlan_war_offload_mdns_para_cur_size = 0; -+ pwrpriv->wowlan_war_offload_mdns_rsp_cur_size = 0; -+ -+ /* init ===> */ -+ -+ if(is_set_default) -+ { -+ // domain_name -+ pwrpriv->wowlan_war_offload_mdns_domain_name_len = strlen(default_domain_name); -+ _rtw_memcpy(pwrpriv->wowlan_war_offload_mdns_domain_name, default_domain_name, sizeof(default_domain_name)); -+ -+ // machine name -+ pwrpriv->wowlan_war_offload_mdns_mnane_num = 1; -+ pwrpriv->wowlan_war_offload_mdns_mnane[0].name_len = default_machine_name_len; -+ _rtw_memcpy(pwrpriv->wowlan_war_offload_mdns_mnane[0].name, default_machine_name, default_machine_name_len); -+ -+ // service info -+ pwrpriv->wowlan_war_offload_mdns_service_info_num = 8; -+ _rtw_memcpy(pwrpriv->wowlan_war_offload_mdns_service, default_sinfo, sizeof(default_sinfo)); -+ -+ // type txt rsp 0~5 -+ // 0 -+ for(offset=0, i=0; i<25; i++) -+ { -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[0].txt[offset++] = strlen(default_txt_rsp_0[i]); -+ _rtw_memcpy(pwrpriv->wowlan_war_offload_mdns_txt_rsp[0].txt + offset, default_txt_rsp_0[i], strlen(default_txt_rsp_0[i])); -+ offset += strlen(default_txt_rsp_0[i]); -+ RTW_INFO("==> default_txt_rsp_0[%d]: [%s](%zu), offset(%d)\n", i, default_txt_rsp_0[i], strlen(default_txt_rsp_0[i]), offset); -+ } -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[0].txt_len = offset; -+ // RTW_INFO("==> offset = %d\n\n", offset); -+ -+ -+ // 1 -+ for(offset=0, i=0; i<13; i++) -+ { -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[1].txt[offset++] = strlen(default_txt_rsp_1[i]); -+ _rtw_memcpy(pwrpriv->wowlan_war_offload_mdns_txt_rsp[1].txt + offset, default_txt_rsp_1[i], strlen(default_txt_rsp_1[i])); -+ offset += strlen(default_txt_rsp_1[i]); -+ } -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[1].txt_len = offset; -+ // RTW_INFO("==> offset = %d\n\n", offset); -+ -+ // 2 -+ for(offset=0, i=0; i<1; i++) -+ { -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[2].txt[offset++] = strlen(default_txt_rsp_2[i]); -+ _rtw_memcpy(pwrpriv->wowlan_war_offload_mdns_txt_rsp[2].txt + offset, default_txt_rsp_2[i], strlen(default_txt_rsp_2[i])); -+ offset += strlen(default_txt_rsp_2[i]); -+ } -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[2].txt_len = offset; -+ // RTW_INFO("==> offset = %d\n\n", offset); -+ -+ // 3 -+ for(offset=0, i=0; i<5; i++) -+ { -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[3].txt[offset++] = strlen(default_txt_rsp_3[i]); -+ _rtw_memcpy(pwrpriv->wowlan_war_offload_mdns_txt_rsp[3].txt + offset, default_txt_rsp_3[i], strlen(default_txt_rsp_3[i])); -+ offset += strlen(default_txt_rsp_3[i]); -+ } -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[3].txt_len = offset; -+ // RTW_INFO("==> offset = %d\n\n", offset); -+ -+ // 4 -+ for(offset=0, i=0; i<11; i++) -+ { -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[4].txt[offset++] = strlen(default_txt_rsp_4[i]); -+ _rtw_memcpy(pwrpriv->wowlan_war_offload_mdns_txt_rsp[4].txt + offset, default_txt_rsp_4[i], strlen(default_txt_rsp_4[i])); -+ offset += strlen(default_txt_rsp_4[i]); -+ } -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp[4].txt_len = offset; -+ // RTW_INFO("==> offset = %d\n\n", offset); -+ -+ /* txt_rsp_num is always as MAX_MDNS_TXT_NUM because the input mechanism(new/append) makes the entities are not in order */ -+ pwrpriv->wowlan_war_offload_mdns_txt_rsp_num = MAX_MDNS_TXT_NUM; -+ } -+} -+ -+ -+#endif /* defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) */ -+#endif /* CONFIG_WAR_OFFLOAD */ -+#endif /* CONFIG_WOWLAN */ -+ -+inline bool _rtw_wow_chk_cap(_adapter *adapter, u8 cap) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct wow_ctl_t *wow_ctl = &dvobj->wow_ctl; -+ -+ if (wow_ctl->wow_cap & cap) -+ return _TRUE; -+ return _FALSE; -+} -+ -+#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("/data/misc/wifi/wpa_supplicant.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; -+ } else { -+ RTW_INFO("Open wpa_supplicant.conf successfully.\n"); -+ } -+ -+ 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) { -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) -+ len = kernel_read(fp, source, len, &pos); -+ #else -+ len = vfs_read(fp, source, len, &pos); -+ #endif -+ 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; -+} -+ -+#ifndef RTW_HALMAC -+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; -+ u8 band = ch <= 14 ? BAND_ON_2_4G : BAND_ON_5G; -+ 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_get_tx_power_index_ex(padapter, 0, CCK, MGN_1M, bw_mode, band, i + 1, 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; -+} -+#endif -+ -+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)); -+ #ifndef RTW_HALMAC -+ pwrctl->pscan_info = -+ (pno_scan_info_t *)rtw_zmalloc(sizeof(pno_scan_info_t)); -+ #endif -+ } -+ -+ if (pwrctl->pnlo_info == NULL || -+ #ifndef RTW_HALMAC -+ pwrctl->pscan_info == NULL || -+ #endif -+ pwrctl->pno_ssid_list == NULL) { -+ RTW_INFO("%s, ERROR: alloc memory 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); -+ -+ #ifndef RTW_HALMAC -+ /* SCAN Info */ -+ ret = rtw_dev_scan_info_set(padapter, ssid, pmlmeext->cur_channel, -+ pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ #endif -+ -+ 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; -+ } -+ #ifndef RTW_HALMAC -+ if (pwrctl->pscan_info) { -+ rtw_mfree((u8 *)pwrctl->pscan_info, sizeof(pno_scan_info_t)); -+ pwrctl->pscan_info = NULL; -+ } -+ #endif -+ -+ 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]); -+ } -+ -+ #ifndef RTW_HALMAC -+ 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); -+ } -+ #endif -+ RTW_INFO("*****************\n"); -+} -+#endif /* CONFIG_PNO_SET_DEBUG */ -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+inline void rtw_collect_bcn_info(_adapter *adapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ -+ if (!is_client_associated_to_ap(adapter)) -+ return; -+ -+ pmlmeext->cur_bcn_cnt = pmlmeext->bcn_cnt - pmlmeext->last_bcn_cnt; -+ pmlmeext->last_bcn_cnt = pmlmeext->bcn_cnt; -+ /*TODO get offset of bcn's timestamp*/ -+ /*pmlmeext->bcn_timestamp;*/ -+} -+ -+static u32 rtw_get_vht_bitrate(u8 mcs, u8 bw, u8 nss, u8 sgi) -+{ -+ static const u32 base[4][10] = { -+ { 6500000, -+ 13000000, -+ 19500000, -+ 26000000, -+ 39000000, -+ 52000000, -+ 58500000, -+ 65000000, -+ 78000000, -+ /* not in the spec, but some devices use this: */ -+ 86500000, -+ }, -+ { 13500000, -+ 27000000, -+ 40500000, -+ 54000000, -+ 81000000, -+ 108000000, -+ 121500000, -+ 135000000, -+ 162000000, -+ 180000000, -+ }, -+ { 29300000, -+ 58500000, -+ 87800000, -+ 117000000, -+ 175500000, -+ 234000000, -+ 263300000, -+ 292500000, -+ 351000000, -+ 390000000, -+ }, -+ { 58500000, -+ 117000000, -+ 175500000, -+ 234000000, -+ 351000000, -+ 468000000, -+ 526500000, -+ 585000000, -+ 702000000, -+ 780000000, -+ }, -+ }; -+ u32 bitrate; -+ int bw_idx; -+ -+ if (mcs > 9) { -+ RTW_INFO("Invalid mcs = %d\n", mcs); -+ return 0; -+ } -+ -+ if (nss > 4 || nss < 1) { -+ RTW_INFO("Now only support nss = 1, 2, 3, 4\n"); -+ } -+ -+ switch (bw) { -+ case CHANNEL_WIDTH_160: -+ bw_idx = 3; -+ break; -+ case CHANNEL_WIDTH_80: -+ bw_idx = 2; -+ break; -+ case CHANNEL_WIDTH_40: -+ bw_idx = 1; -+ break; -+ case CHANNEL_WIDTH_20: -+ bw_idx = 0; -+ break; -+ default: -+ RTW_INFO("bw = %d currently not supported\n", bw); -+ return 0; -+ } -+ -+ bitrate = base[bw_idx][mcs]; -+ bitrate *= nss; -+ -+ if (sgi) -+ bitrate = (bitrate / 9) * 10; -+ -+ /* do NOT round down here */ -+ return (bitrate + 50000) / 100000; -+} -+ -+static u32 rtw_get_ht_bitrate(u8 mcs, u8 bw, u8 sgi) -+{ -+ int modulation, streams, bitrate; -+ -+ /* the formula below does only work for MCS values smaller than 32 */ -+ if (mcs >= 32) { -+ RTW_INFO("Invalid mcs = %d\n", mcs); -+ return 0; -+ } -+ -+ if (bw > 1) { -+ RTW_INFO("Now HT only support bw = 0(20Mhz), 1(40Mhz)\n"); -+ return 0; -+ } -+ -+ modulation = mcs & 7; -+ streams = (mcs >> 3) + 1; -+ -+ bitrate = (bw == 1) ? 13500000 : 6500000; -+ -+ if (modulation < 4) -+ bitrate *= (modulation + 1); -+ else if (modulation == 4) -+ bitrate *= (modulation + 2); -+ else -+ bitrate *= (modulation + 3); -+ -+ bitrate *= streams; -+ -+ if (sgi) -+ bitrate = (bitrate / 9) * 10; -+ -+ return (bitrate + 50000) / 100000; -+} -+ -+/** -+ * @bw: 0(20Mhz), 1(40Mhz), 2(80Mhz), 3(160Mhz) -+ * @rate_idx: DESC_RATEXXXX & 0x7f -+ * @sgi: DESC_RATEXXXX >> 7 -+ * Returns: bitrate in 100kbps -+ */ -+u32 rtw_desc_rate_to_bitrate(u8 bw, u8 rate_idx, u8 sgi) -+{ -+ u32 bitrate; -+ -+ if (rate_idx <= DESC_RATE54M){ -+ u16 ofdm_rate[12] = {10, 20, 55, 110, -+ 60, 90, 120, 180, 240, 360, 480, 540}; -+ -+ bitrate = ofdm_rate[rate_idx]; -+ } else if ((DESC_RATEMCS0 <= rate_idx) && -+ (rate_idx <= DESC_RATEMCS31)) { -+ u8 mcs = rate_idx - DESC_RATEMCS0; -+ -+ bitrate = rtw_get_ht_bitrate(mcs, bw, sgi); -+ } else if ((DESC_RATEVHTSS1MCS0 <= rate_idx) && -+ (rate_idx <= DESC_RATEVHTSS4MCS9)) { -+ u8 mcs = (rate_idx - DESC_RATEVHTSS1MCS0) % 10; -+ u8 nss = ((rate_idx - DESC_RATEVHTSS1MCS0) / 10) + 1; -+ -+ bitrate = rtw_get_vht_bitrate(mcs, bw, nss, sgi); -+ } else { -+ /* TODO: 60Ghz */ -+ bitrate = 1; -+ } -+ -+ return bitrate; -+} -+ -+#ifdef CONFIG_RTW_MULTI_AP -+u8 rtw_get_ch_utilization(_adapter *adapter) -+{ -+ u16 clm = rtw_phydm_clm_ratio(adapter); -+ u16 nhm = rtw_phydm_nhm_ratio(adapter); -+ u16 ch_util; -+ -+ ch_util = clm / 3 + (2 * (nhm / 3)); -+ /* For Multi-AP, scaling 0-100 to 0-255 */ -+ ch_util = 255 * ch_util / 100; -+ -+ return (u8)ch_util; -+} -+ -+void rtw_ch_util_rpt(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ int i, j; -+ u8 i_rpts = 0; -+ u8 *ch_util; -+ u8 **bssid; -+ u8 threshold = GET_PRIMARY_ADAPTER(adapter)->ch_util_threshold; -+ u8 need_rpt = 0; -+ -+ if (threshold == 0) -+ return; -+ -+ ch_util = rtw_zmalloc(sizeof(u8) * dvobj->iface_nums); -+ if (!ch_util) -+ goto err_out; -+ bssid = (u8 **) rtw_zmalloc(sizeof(u8 *) * dvobj->iface_nums); -+ if (!bssid) -+ goto err_out1; -+ for (j = 0; j < dvobj->iface_nums; j++) { -+ *(bssid + j) = (u8 *) rtw_zmalloc(sizeof(u8) * ETH_ALEN); -+ if (!(*(bssid + j))) -+ goto err_out2; -+ } -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && MLME_IS_AP(iface)) { -+ *(ch_util + i_rpts) = rtw_get_ch_utilization(iface); -+ _rtw_memcpy(*(bssid + i_rpts), iface->mac_addr, ETH_ALEN); -+ -+ if (*(ch_util + i_rpts) > threshold) -+ need_rpt = 1; -+ -+ i_rpts++; -+ } -+ } -+ -+ if (need_rpt) -+ rtw_nlrtw_ch_util_rpt(adapter, i_rpts, ch_util, bssid); -+ -+ rtw_mfree(ch_util, sizeof(u8) * dvobj->iface_nums); -+ for (i = 0; i < dvobj->iface_nums; i++) -+ rtw_mfree(*(bssid + i), ETH_ALEN); -+ rtw_mfree(bssid, sizeof(u8 *) * dvobj->iface_nums); -+ -+ return; -+ -+err_out2: -+ for (i = 0; i < j; i++) -+ rtw_mfree(*(bssid + i), sizeof(u8) * ETH_ALEN); -+ rtw_mfree(bssid, sizeof(sizeof(u8 *) * dvobj->iface_nums)); -+err_out1: -+ rtw_mfree(ch_util, sizeof(u8) * dvobj->iface_nums); -+err_out: -+ RTW_INFO("[%s] rtw_zmalloc fail\n", __func__); -+} -+#endif -+ -+inline u8 rtw_rx_dbg_monitor_condition_chk( -+ _adapter *padapter, u8 *ip, u32 port, u8 condition) -+{ -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ u8 need_chk = _FALSE; -+ -+ if (precvpriv->ip_statistic.enabled == _FALSE) -+ goto exit; -+ -+ switch (condition) { -+ case 1: -+ if (ip && _rtw_memcmp(precvpriv->ip_statistic.ip, ip, 4)) -+ need_chk = _TRUE; -+ break; -+ case 2: -+ if (precvpriv->ip_statistic.dst_port == port) -+ need_chk = _TRUE; -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ return need_chk; -+} -+ -+void rtw_dbg_rx_iperf_udp_data_chk(_adapter *padapter, u8 *pdata) -+{ -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ struct rtw_ip_dbg_cnt_statistic *st = &(precvpriv->ip_statistic); -+ u8 iperf_start_seq, iperf_seq_offset; -+ u16 udp_data_len; -+ u32 cur_iperf_seq, end_boundary = 0xffff; -+ -+ /* no application data */ -+ udp_data_len = __be16_to_cpu(*((u16 *)(pdata + 4))); -+ if (udp_data_len < 16) -+ return; -+ -+ /* RTW_INFO_DUMP("iperf data : ", pdata, 24); */ -+ if ((st->iperf_ver & 0x7f) >= 3) { -+ iperf_seq_offset = 16; -+ iperf_start_seq = 1 ; -+ } else { -+ iperf_seq_offset = 8; -+ iperf_start_seq = 0 ; -+ } -+ -+ cur_iperf_seq = __be32_to_cpu(*((u32 *)(pdata + iperf_seq_offset))); -+ if (cur_iperf_seq >= (st->iperf_seq + end_boundary)) { -+ RTW_INFO("%s : terminate for end/abnormal of iperf pkt\n", __func__); -+ return; -+ } -+ -+ if (cur_iperf_seq >= (iudp_ip_seq_get(st) + 1)) { -+ if (cur_iperf_seq > (iudp_ip_seq_get(st) + 1)) -+ iudp_err_cnt_update(st, cur_iperf_seq); -+ iudp_ip_seq_set(st, cur_iperf_seq); -+ } else -+ iperf_out_of_order_cnt_inc(st, cur_iperf_seq); -+} -+ -+void rtw_rx_dbg_monitor_ip_statistic(_adapter *padapter, _pkt *pkt) -+{ -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ u8 *ip_hdr, frag_flag, src_ip[4], frag_drop = _FALSE; -+ u16 ip_seq, frag_offset, sport = 0 , dport = 0; -+ u32 i; -+ -+ if (pkt->protocol != __constant_htons(ETH_P_IP)) -+ return; -+ -+ /* RTW_INFO_DUMP("ip hdr :", pkt->data, 32); */ -+ ip_hdr = pkt->data; -+ if ((GET_IPV4_PROTOCOL(ip_hdr) != 0x6) && -+ (GET_IPV4_PROTOCOL(ip_hdr) != 0x11)) { -+ /* filter all non-tcp/udp packets */ -+ return; -+ } -+ -+ for (i=0; i<=3; i++) -+ src_ip[i] = *IPV4_SRC(ip_hdr + i); -+ -+ if (!rtw_rx_dbg_monitor_condition_chk(padapter, src_ip, 0, 1)) { -+ /* filter all unmatched-packets by source-ip */ -+ return; -+ } -+ -+ ip_seq = be16_to_cpu(*((u16 *)(ip_hdr + 4))); -+ frag_offset = be16_to_cpu(*((u16 *)(ip_hdr + 6))); -+ frag_flag = frag_offset >> 13; -+ frag_offset &= 0x1fff; -+ -+ /* no-fragments or 1st-fragment */ -+ if ((frag_flag & BIT(1)) || (frag_offset == 0)) { -+ sport = GET_UDP_SRC(ip_hdr + 20); -+ dport = GET_UDP_DST(ip_hdr + 20); -+ -+ if (!rtw_rx_dbg_monitor_condition_chk(padapter, NULL, dport, 2)) { -+ /* filter all unmatched-packets by destination-port */ -+ return; -+ } -+ -+ /* 1st-fragment */ -+ if (frag_flag & BIT(0)) { -+ frag_cnt_inc(&precvpriv->ip_statistic); -+ if (need_to_chk_iudp_cnt(ip_hdr, &precvpriv->ip_statistic)) { -+ if (iudp_defrag_done_get(&precvpriv->ip_statistic) == _FALSE) -+ iudp_err_cnt_inc(&precvpriv->ip_statistic, "last-frag"); -+ -+ iudp_defrag_done_set(&precvpriv->ip_statistic, _FALSE); -+ iudp_ip_seq_chk_set(&precvpriv->ip_statistic, ip_seq); -+ iudp_frag_offset_chk_set(&precvpriv->ip_statistic, frag_offset); -+ iudp_max_frag_offset_chk_set(&precvpriv->ip_statistic, frag_offset); -+ } -+ } -+ -+ ip_cnt_inc(&precvpriv->ip_statistic); -+ tcp_udp_cnt_inc(ip_hdr, &precvpriv->ip_statistic); -+ if (need_to_chk_iudp_cnt(ip_hdr, &precvpriv->ip_statistic)) -+ rtw_dbg_rx_iperf_udp_data_chk(padapter, (ip_hdr + 20)); -+ -+ } else if (((frag_flag & BIT(0)) || (frag_flag == 0)) \ -+ && (frag_offset > 0)) { -+ /* more-or-last fragment */ -+ frag_cnt_inc(&precvpriv->ip_statistic); -+ if (need_to_chk_iudp_cnt(ip_hdr, &precvpriv->ip_statistic)) { -+ /* fragment-lenth in 8byte-blocks without ip-header */ -+ iudp_frag_offset_chk_set(&precvpriv->ip_statistic, -+ (iudp_frag_offset_chk_get(&precvpriv->ip_statistic) + ((pkt->len - 20)/8))); -+ iudp_max_frag_offset_chk_set(&precvpriv->ip_statistic, -+ (iudp_max_frag_offset_chk_get(&precvpriv->ip_statistic) + ((1500 - 20)/8))); -+ -+ /* more-frag check */ -+ if (frag_flag & BIT(0)) { -+ if ((ip_seq == iudp_ip_seq_chk_get(&precvpriv->ip_statistic)) -+ && (iudp_defrag_done_get(&precvpriv->ip_statistic) == _FALSE) \ -+ && (frag_offset > iudp_frag_offset_chk_get(&precvpriv->ip_statistic))) { -+ iudp_defrag_done_set(&precvpriv->ip_statistic, _TRUE); -+ iudp_err_cnt_inc(&precvpriv->ip_statistic, "more-frag"); -+ } -+ } else { -+ if ((ip_seq == iudp_ip_seq_chk_get(&precvpriv->ip_statistic)) -+ && (iudp_defrag_done_get(&precvpriv->ip_statistic) == _FALSE)) { -+ iudp_defrag_done_set(&precvpriv->ip_statistic, _TRUE); -+ if (frag_offset > iudp_max_frag_offset_chk_get(&precvpriv->ip_statistic)) -+ iudp_err_cnt_inc(&precvpriv->ip_statistic, "more-frag"); -+ } -+ } -+ } -+ -+ tcp_udp_cnt_inc(ip_hdr, &precvpriv->ip_statistic); -+ } -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_wnm.c b/drivers/net/wireless/rtl8821cs/core/rtw_wnm.c -new file mode 100755 -index 000000000..293eb86b7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_wnm.c -@@ -0,0 +1,1098 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#ifndef RTW_WNM_DBG -+ #define RTW_WNM_DBG 0 -+#endif -+#if RTW_WNM_DBG -+ #define RTW_WNM_INFO(fmt, arg...) \ -+ RTW_INFO(fmt, arg) -+ #define RTW_WNM_DUMP(str, data, len) \ -+ RTW_INFO_DUMP(str, data, len) -+#else -+ #define RTW_WNM_INFO(fmt, arg...) do {} while (0) -+ #define RTW_WNM_DUMP(str, data, len) do {} while (0) -+#endif -+ -+#ifdef CONFIG_RTW_WNM -+ -+static u32 wnm_defualt_validity_time = 6000; -+static u32 wnm_default_disassoc_time = 5000; -+static u32 wnm_disassoc_wait_time = 500; -+ -+/* for wifi test, need more validity time to wait scan done */ -+static u32 wnm_ext_validity_time = 4000; -+ -+static void rtw_wmn_btm_cache_update(_adapter *padapter, struct btm_req_hdr *phdr) -+{ -+ struct btm_rpt_cache *pcache = &(padapter->mlmepriv.nb_info.btm_cache); -+ -+ pcache->dialog_token = phdr->dialog_token; -+ pcache->req_mode = phdr->req_mode; -+ pcache->disassoc_timer = le16_to_cpu(phdr->disassoc_timer); -+ -+ if (phdr->validity_interval > 0) -+ pcache->validity_interval = phdr->validity_interval; -+ -+ pcache->term_duration.id = phdr->term_duration.id; -+ pcache->term_duration.len = phdr->term_duration.len; -+ pcache->term_duration.tsf = le64_to_cpu(phdr->term_duration.tsf); -+ pcache->term_duration.duration = le16_to_cpu(phdr->term_duration.duration); -+ -+ RTW_WNM_INFO("%s: req_mode(0x%02x), disassoc_timer(0x%04x), " -+ "validity_interval(0x%02x %s), tsf(0x%llx), duration(0x%02x)\n", -+ __func__, pcache->req_mode, pcache->disassoc_timer, -+ pcache->validity_interval, (!phdr->validity_interval)?"default":"", -+ pcache->term_duration.tsf, -+ pcache->term_duration.duration); -+ -+ if (pcache->validity_interval > 0) { -+ pcache->validity_time = pcache->validity_interval * 100; -+ #ifdef CONFIG_RTW_MBO -+ if (rtw_mbo_wifi_logo_test(padapter)) -+ pcache->validity_time += wnm_ext_validity_time; -+ #endif -+ } -+ -+ if (pcache->disassoc_timer > 0) { -+ pcache->disassoc_time= pcache->disassoc_timer * 100; -+ #ifdef CONFIG_RTW_MBO -+ if (rtw_mbo_wifi_logo_test(padapter)) -+ pcache->disassoc_time += wnm_ext_validity_time; -+ #endif -+ } -+ -+ pcache->req_stime = rtw_get_current_time(); -+ -+ RTW_WNM_INFO("%s: validity_time=%u, disassoc_time=%u\n", -+ __func__, pcache->validity_time, pcache->disassoc_time); -+} -+ -+static u8 rtw_wnm_btm_candidate_validity(struct btm_rpt_cache *pcache, u8 flag) -+{ -+ u8 is_validity =_TRUE; -+ u32 req_validity_time = rtw_get_passing_time_ms(pcache->req_stime); -+ -+ if ((flag & BIT(0)) && (req_validity_time > pcache->validity_time)) -+ is_validity = _FALSE; -+ -+ if ((flag & BIT(1)) && (req_validity_time > pcache->disassoc_time)) -+ is_validity = _FALSE; -+ -+ RTW_WNM_INFO("%s : validity=%u, rtime=%u, vtime=%u. dtime=%u\n", -+ __func__, is_validity, req_validity_time, -+ pcache->validity_time, pcache->disassoc_time); -+ return is_validity; -+} -+ -+u8 rtw_wmn_btm_rsp_reason_decision(_adapter *padapter, u8* req_mode) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 reason = 0; -+ -+ if (!rtw_wnm_btm_diff_bss(padapter)) { -+ /* Reject - No suitable BSS transition candidates */ -+ reason = 7; -+ goto candidate_remove; -+ } -+ -+#ifdef CONFIG_RTW_80211R -+ if (rtw_ft_chk_flags(padapter, RTW_FT_BTM_ROAM)) { -+ /* Accept */ -+ reason = 0; -+ goto under_survey; -+ } -+#endif -+ -+ if (((*req_mode) & DISASSOC_IMMINENT) == 0) { -+ /* Reject - Unspecified reject reason */ -+ reason = 1; -+ goto candidate_remove; -+ } -+ -+ if (precvpriv->signal_strength_data.avg_val >= pmlmepriv->roam_rssi_threshold) { -+ reason = 1; -+ RTW_WNM_INFO("%s : Reject - under high roam rssi(%u, %u) \n", -+ __func__, precvpriv->signal_strength_data.avg_val, -+ pmlmepriv->roam_rssi_threshold); -+ goto candidate_remove; -+ } -+ -+#ifdef CONFIG_RTW_80211R -+under_survey: -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_SURVEY)) { -+ RTW_WNM_INFO("%s reject due to _FW_UNDER_SURVEY\n", __func__); -+ reason = 1; -+ } -+#endif -+ -+candidate_remove: -+ if (reason !=0) -+ rtw_wnm_reset_btm_candidate(&pmlmepriv->nb_info); -+ -+ return reason; -+} -+ -+static u32 rtw_wnm_btm_candidates_offset_get(u8* pframe) -+{ -+ u32 offset = 0; -+ -+ if (!pframe) -+ return 0; -+ -+ offset += 7; -+ -+ /* BSS Termination Duration check */ -+ if (wnm_btm_bss_term_inc(pframe)) -+ offset += 12; -+ -+ /* Session Information URL check*/ -+ if (wnm_btm_ess_disassoc_im(pframe)) { -+ /*URL length field + URL variable length*/ -+ offset = 1 + *(pframe + offset); -+ } -+ -+ RTW_WNM_INFO("%s : hdr offset=%u\n", __func__, offset); -+ return offset; -+} -+ -+static void rtw_wnm_btm_req_hdr_parsing(u8* pframe, struct btm_req_hdr *phdr) -+{ -+ u8 *pos; -+ u32 offset = 0; -+ -+ if (!pframe || !phdr) -+ return; -+ -+ _rtw_memset(phdr, 0, sizeof(struct btm_req_hdr)); -+ phdr->dialog_token = wnm_btm_dialog_token(pframe); -+ phdr->req_mode = wnm_btm_req_mode(pframe); -+ phdr->disassoc_timer = wnm_btm_disassoc_timer(pframe); -+ phdr->validity_interval = wnm_btm_valid_interval(pframe); -+ if (wnm_btm_bss_term_inc(pframe)) { -+ pos = wnm_btm_term_duration_offset(pframe); -+ if (*pos == WNM_BTM_TERM_DUR_SUBEID) { -+ phdr->term_duration.id = *pos; -+ phdr->term_duration.len = *(pos + 1); -+ phdr->term_duration.tsf = *((u64*)(pos + 2)); -+ phdr->term_duration.duration= *((u16*)(pos + 10)); -+ } else -+ RTW_WNM_INFO("%s : invaild BSS Termination Duration content!\n", __func__); -+ } -+ -+ RTW_WNM_INFO("WNM: req_mode(0x%02x), disassoc_timer(0x%04x), validity_interval(0x%02x)\n", -+ phdr->req_mode, phdr->disassoc_timer, phdr->validity_interval); -+ if (wnm_btm_bss_term_inc(pframe)) -+ RTW_WNM_INFO("WNM: tsf(0x%llx), duration(0x%4x)\n", -+ phdr->term_duration.tsf, phdr->term_duration.duration); -+} -+ -+u8 rtw_wnm_btm_reassoc_req(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct roam_nb_info *pnb = &(pmlmepriv->nb_info); -+ u8 breassoc = _FALSE; -+ -+ if (_rtw_memcmp(get_my_bssid(&(pmlmeinfo->network)), -+ pnb->roam_target_addr, ETH_ALEN)) { -+ RTW_WNM_INFO("%s : bss "MAC_FMT" found in roam_target "MAC_FMT"\n", -+ __func__, MAC_ARG(get_my_bssid(&(pmlmeinfo->network))), -+ MAC_ARG(pnb->roam_target_addr)); -+ -+ breassoc = _TRUE; -+ } -+ -+ return breassoc; -+} -+ -+void rtw_wnm_roam_scan_hdl(void *ctx) -+{ -+ _adapter *padapter = (_adapter *)ctx; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if (rtw_is_scan_deny(padapter)) -+ RTW_WNM_INFO("%s: roam scan would abort by scan_deny!\n", __func__); -+ -+#ifdef CONFIG_RTW_80211R -+ if (rtw_ft_chk_flags(padapter, RTW_FT_BTM_ROAM)) { -+ pmlmepriv->need_to_roam = _TRUE; -+ rtw_set_to_roam(padapter, padapter->registrypriv.max_roaming_times); -+ RTW_WNM_INFO("%s : enable roaming\n", __func__); -+ } -+ -+ rtw_drv_scan_by_self(padapter, RTW_AUTO_SCAN_REASON_ROAM); -+#endif -+} -+ -+static void rtw_wnm_roam_scan(_adapter *padapter) -+{ -+ struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); -+ -+ if (rtw_is_scan_deny(padapter)) { -+ _cancel_timer_ex(&pnb->roam_scan_timer); -+ _set_timer(&pnb->roam_scan_timer, 1000); -+ } else -+ rtw_wnm_roam_scan_hdl((void *)padapter); -+} -+ -+void rtw_wnm_disassoc_chk_hdl(void *ctx) -+{ -+ _adapter *padapter = (_adapter *)ctx; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct roam_nb_info *pnb = &(pmlmepriv->nb_info); -+ -+ RTW_WNM_INFO("%s : expired\n", __func__); -+ if (pnb->disassoc_waiting <= 0 ) { -+ RTW_WNM_INFO("%s : btm roam is interrupted by disassoc\n", __func__); -+ return; -+ } -+ -+ pnb->disassoc_waiting = _FALSE; -+ rtw_wnm_roam_scan(padapter); -+} -+ -+u8 rtw_wnm_try_btm_roam_imnt(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct roam_nb_info *pnb = &(pmlmepriv->nb_info); -+ struct btm_rpt_cache *pcache = &(pnb->btm_cache); -+ u8 reason = 0, flag = 0; -+ -+ if (!rtw_wnm_btm_preference_cap(padapter)) { -+ RTW_WNM_INFO("%s : no btm candidate can be used!\n", __func__); -+ return 1; -+ } -+ -+ flag = BIT(0) | BIT(1); -+ if (!rtw_wnm_btm_candidate_validity(pcache, flag)) -+ return 1; -+ -+#ifdef CONFIG_RTW_MBO -+ if (!rtw_mbo_wifi_logo_test(padapter) -+ && !(pcache->req_mode & DISASSOC_IMMINENT)) { -+ RTW_WNM_INFO("%s : non-disassoc imminet req\n", __func__); -+ return 1; -+ } -+#endif -+ -+ RTW_WNM_INFO("%s : disassoc_waiting(%d)\n", __func__, pnb->disassoc_waiting); -+ if (pnb->disassoc_waiting) { -+ _cancel_timer_ex(&pnb->disassoc_chk_timer); -+ pnb->disassoc_waiting = _FALSE; -+ rtw_wnm_roam_scan_hdl((void *)padapter); -+ } else if (!pnb->disassoc_waiting) -+ RTW_WNM_INFO("%s : waiting for btm roaming start/finish\n", __func__); -+ else -+ reason = 1; -+ -+ return reason; -+} -+ -+void rtw_wnm_process_btm_req(_adapter *padapter, u8* pframe, u32 frame_len) -+{ -+ struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); -+ struct btm_req_hdr req_hdr; -+ u8 *ptr, reason; -+ u32 elem_len, offset; -+ -+ rtw_wnm_btm_req_hdr_parsing(pframe, &req_hdr); -+ offset = rtw_wnm_btm_candidates_offset_get(pframe); -+ if (offset == 0) -+ return; -+ -+ if ((frame_len - offset) <= 15) { -+ RTW_INFO("WNM : Reject - no suitable BSS transition candidates!\n"); -+ rtw_wnm_issue_action(padapter, -+ RTW_WLAN_ACTION_WNM_BTM_RSP, 7, req_hdr.dialog_token); -+ return; -+ } -+ -+ rtw_wmn_btm_cache_update(padapter, &req_hdr); -+ -+ ptr = (pframe + offset); -+ elem_len = (frame_len - offset); -+ rtw_wnm_btm_candidates_survey(padapter, ptr, elem_len, _TRUE); -+ reason = rtw_wmn_btm_rsp_reason_decision(padapter, &pframe[3]); -+ -+#ifdef CONFIG_RTW_MBO -+ /* for wifi-test; AP2 could power-off when BTM-req received */ -+ if ((reason > 0) && (rtw_mbo_wifi_logo_test(padapter))) { -+ _rtw_memcpy(pnb->roam_target_addr, pnb->nb_rpt[0].bssid, ETH_ALEN); -+ RTW_WNM_INFO("%s : used report 0 as roam_target_addr(reason=%u)\n", -+ __func__, reason); -+ reason = 0; -+ pnb->preference_en = _TRUE; -+ pnb->nb_rpt_valid = _FALSE; -+ } -+#endif -+ -+ rtw_wnm_issue_action(padapter, -+ RTW_WLAN_ACTION_WNM_BTM_RSP, reason, req_hdr.dialog_token); -+ -+ if (reason == 0) { -+ pnb->disassoc_waiting = _TRUE; -+ _set_timer(&pnb->disassoc_chk_timer, wnm_disassoc_wait_time); -+ } -+ -+} -+ -+void rtw_wnm_reset_btm_candidate(struct roam_nb_info *pnb) -+{ -+ pnb->preference_en = _FALSE; -+ _rtw_memset(pnb->roam_target_addr, 0, ETH_ALEN); -+} -+ -+void rtw_wnm_reset_btm_cache(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct roam_nb_info *pnb = &(pmlmepriv->nb_info); -+ struct btm_rpt_cache *pcache = &(pnb->btm_cache); -+ u8 flag = 0; -+ -+ flag |= BIT(0); -+ if (rtw_wnm_btm_candidate_validity(pcache, flag)) -+ return; -+ -+ rtw_wnm_reset_btm_candidate(pnb); -+ _rtw_memset(pcache, 0, sizeof(struct btm_rpt_cache)); -+ pcache->validity_time = wnm_defualt_validity_time; -+ pcache->disassoc_time= wnm_default_disassoc_time; -+ -+#ifdef CONFIG_RTW_80211R -+ if (rtw_ft_chk_flags(padapter, RTW_FT_BTM_ROAM)) { -+ pmlmepriv->need_to_roam = _FALSE; -+ rtw_set_to_roam(padapter, 0); -+ RTW_WNM_INFO("%s : disabled roaming\n", __func__); -+ } -+#endif -+} -+ -+void rtw_wnm_reset_btm_state(_adapter *padapter) -+{ -+ struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); -+ -+ pnb->last_nb_rpt_entries = 0; -+ pnb->nb_rpt_is_same = _TRUE; -+ pnb->nb_rpt_valid = _FALSE; -+ pnb->nb_rpt_ch_list_num = 0; -+ pnb->disassoc_waiting = -1; -+ _rtw_memset(&pnb->nb_rpt, 0, sizeof(pnb->nb_rpt)); -+ _rtw_memset(&pnb->nb_rpt_ch_list, 0, sizeof(pnb->nb_rpt_ch_list)); -+ rtw_wnm_reset_btm_cache(padapter); -+} -+ -+u32 rtw_wnm_btm_rsp_candidates_sz_get( -+ _adapter *padapter, u8* pframe, u32 frame_len) -+{ -+ u32 num = 0, sz = 0; -+ u8 status; -+ u8 *ptr; -+ -+ if (!pframe || (frame_len <= 5)) -+ goto exit; -+ -+ status = wnm_btm_rsp_status(pframe); -+ if (((status != 0) && (status != 6)) || (frame_len < 23)) -+ goto exit; -+ -+ if (status == 0) -+ num = (frame_len - 5 - ETH_ALEN)/18; -+ else -+ num = (frame_len - 5)/18; -+ sz = sizeof(struct wnm_btm_cant) * num; -+exit: -+ RTW_WNM_INFO("WNM: %u candidates(sz=%u) in BTM rsp\n", num, sz); -+ return sz; -+} -+ -+void rtw_wnm_process_btm_rsp(_adapter *padapter, -+ u8* pframe, u32 frame_len, struct btm_rsp_hdr *prsp) -+{ -+ prsp->dialog_token = wnm_btm_dialog_token(pframe); -+ prsp->status = wnm_btm_rsp_status(pframe); -+ prsp->termination_delay = wnm_btm_rsp_term_delay(pframe); -+ -+ if ((pframe == NULL) || (frame_len == 0)) -+ return; -+ -+ prsp->status = *(pframe + 3); -+ prsp->termination_delay = *(pframe + 4); -+ -+ /* no Target BSSID & Candidate in frame */ -+ if (frame_len <= 5) -+ return; -+ -+ /* accept */ -+ if ((prsp->status == 0) && (frame_len >= 11)) -+ _rtw_memcpy(prsp->bssid, (pframe + 5), ETH_ALEN); -+ -+ /* STA BSS Transition Candidate List provided, -+ and at least one NB report exist */ -+ if (((prsp->status == 0) || (prsp->status == 6)) && (frame_len >= 23)) { -+ struct wnm_btm_cant cant; -+ u8 *ptr, *pend; -+ u32 idx = 0; -+ -+ ptr = pframe + 5; -+ if (prsp->status == 0) -+ ptr += ETH_ALEN; -+ -+ pend = ptr + frame_len; -+ prsp->candidates_num = 0; -+ while (ptr < pend) { -+ if (*ptr != RTW_WLAN_ACTION_WNM_NB_RPT_ELEM) -+ break; -+ _rtw_memset(&cant, 0, sizeof(cant)); -+ cant.nb_rpt.id = *ptr; -+ cant.nb_rpt.len = *(ptr + 1); -+ _rtw_memcpy(cant.nb_rpt.bssid, (ptr + 2), ETH_ALEN); -+ cant.nb_rpt.bss_info = *((u32 *)(ptr + 8)); -+ cant.nb_rpt.reg_class = *(ptr + 12); -+ cant.nb_rpt.ch_num = *(ptr + 13); -+ cant.nb_rpt.phy_type= *(ptr + 14); -+ -+ if (*(ptr + 15) == WNM_BTM_CAND_PREF_SUBEID) -+ cant.preference = *(ptr + 17); -+ ptr = ptr + cant.nb_rpt.len + 2; -+ if (prsp->pcandidates) { -+ prsp->candidates_num++; -+ _rtw_memcpy((prsp->pcandidates + sizeof(cant) * idx), &cant, sizeof(cant)); -+ } -+ -+ idx++; -+ RTW_WNM_INFO("WNM: btm rsp candidate bssid("MAC_FMT -+ ") ,bss_info(0x%04X), reg_class(0x%02X), ch(%d)," -+ " phy_type(0x%02X), preference(0x%02X)\n", -+ MAC_ARG(cant.nb_rpt.bssid), cant.nb_rpt.bss_info, -+ cant.nb_rpt.reg_class, cant.nb_rpt.ch_num, -+ cant.nb_rpt.phy_type, cant.preference); -+ if ((prsp->pcandidates) && (prsp->candidates_num > 0)) -+ RTW_WNM_DUMP("WNM candidates: ", prsp->pcandidates, -+ (sizeof(struct wnm_btm_cant) * prsp->candidates_num)); -+ } -+ } -+ -+} -+ -+void rtw_wnm_hdr_init(_adapter *padapter, -+ struct xmit_frame *pactionframe, u8 *pmac, -+ u8 action, u8 **pcontent) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *pfctrl; -+ u8 category; -+ -+ pattrib = &(pactionframe->attrib); -+ update_mgntframe_attrib(padapter, pattrib); -+ _rtw_memset(pactionframe->buf_addr, 0, (WLANHDR_OFFSET + TXDESC_OFFSET)); -+ -+ *pcontent = (u8 *)(pactionframe->buf_addr + TXDESC_OFFSET); -+ pwlanhdr = (struct rtw_ieee80211_hdr *)(*pcontent); -+ pfctrl = &(pwlanhdr->frame_ctl); -+ *(pfctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, pmac, 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++; -+ set_frame_sub_type(*pcontent, WIFI_ACTION); -+ -+ *pcontent += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ category = RTW_WLAN_CATEGORY_WNM; -+ *pcontent = rtw_set_fixed_ie(*pcontent, 1, &(category), &(pattrib->pktlen)); -+ *pcontent = rtw_set_fixed_ie(*pcontent, 1, &(action), &(pattrib->pktlen)); -+} -+ -+void rtw_wnm_build_btm_req_ies(_adapter *padapter, -+ u8 **pframe, struct pkt_attrib *pattrib, -+ struct btm_req_hdr *phdr, u8 *purl, u32 url_len, -+ u8 *pcandidates, u8 candidate_cnt) -+{ -+ int i; -+ -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ &phdr->dialog_token, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ &phdr->req_mode, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 2, -+ (u8 *)&phdr->disassoc_timer, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ &phdr->validity_interval, &(pattrib->pktlen)); -+ -+ if (phdr->req_mode & BSS_TERMINATION_INCLUDED) { -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ &phdr->term_duration.id, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ &phdr->term_duration.len, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 8, -+ (u8 *)&phdr->term_duration.tsf, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 2, -+ (u8 *)&phdr->term_duration.duration, &(pattrib->pktlen)); -+ } -+ -+ if ((purl != NULL) && (url_len > 0) && -+ (phdr->req_mode & ESS_DISASSOC_IMMINENT)) { -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ (u8 *)&url_len, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, -+ url_len, purl, &(pattrib->pktlen)); -+ } -+ -+ if ((pcandidates != NULL) && (candidate_cnt > 0)) { -+ for (i=0; inb_rpt); -+ -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ &pcandidate->nb_rpt.id, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ &pcandidate->nb_rpt.len, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, ETH_ALEN, -+ pcandidate->nb_rpt.bssid, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 4, -+ (u8 *)&pcandidate->nb_rpt.bss_info, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ &pcandidate->nb_rpt.reg_class, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ &pcandidate->nb_rpt.ch_num, &(pattrib->pktlen)); -+ *pframe = rtw_set_fixed_ie(*pframe, 1, -+ &pcandidate->nb_rpt.phy_type, &(pattrib->pktlen)); -+ *pframe = rtw_set_ie(*pframe, WNM_BTM_CAND_PREF_SUBEID, 1, -+ (u8 *)&pcandidate->preference, &(pattrib->pktlen)); -+ } -+ } -+ -+} -+ -+void rtw_wnm_issue_btm_req(_adapter *padapter, -+ u8 *pmac, struct btm_req_hdr *phdr, u8 *purl, u32 url_len, -+ u8 *pcandidates, u8 candidate_cnt) -+{ -+ struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ u8 action, *pframe, dialog_token = 0; -+ -+ if (!pmac || is_zero_mac_addr(pmac) -+ || is_broadcast_mac_addr(pmac)) -+ return ; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ return ; -+ -+ rtw_wnm_hdr_init(padapter, pmgntframe, pmac, -+ RTW_WLAN_ACTION_WNM_BTM_REQ, &pframe); -+ -+ pattrib = &(pmgntframe->attrib); -+ rtw_wnm_build_btm_req_ies(padapter, &pframe, pattrib, -+ phdr, purl, url_len, pcandidates, candidate_cnt); -+ -+ if (0) { -+ u8 *__p = (u8 *)(pmgntframe->buf_addr + TXDESC_OFFSET); -+ RTW_WNM_DUMP("WNM BTM REQ :", __p, pattrib->pktlen); -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ RTW_INFO("WNM: BSS Transition Management Request sent\n"); -+} -+ -+void rtw_wnm_issue_action(_adapter *padapter, -+ u8 action, u8 reason, u8 dialog) -+{ -+ 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; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct pkt_attrib *pattrib; -+ u8 category, termination_delay, *pframe, dialog_token = 0; -+#ifdef CONFIG_RTW_MBO -+ u8 mbo_trans_rej_res = 1; /* Unspecified reason */ -+ u8 mbo_notif_req_type ; -+#endif -+ u16 *fctrl; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == 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++; -+ set_frame_sub_type(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ category = RTW_WLAN_CATEGORY_WNM; -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ -+ switch (action) { -+ case RTW_WLAN_ACTION_WNM_BTM_QUERY: -+ dialog_token++; -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialog_token), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(reason), &(pattrib->pktlen)); -+ RTW_INFO("WNM: BSS Transition Management Query sent\n"); -+ break; -+ case RTW_WLAN_ACTION_WNM_BTM_RSP: -+ dialog_token = dialog; -+ termination_delay = 0; -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialog_token), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(reason), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(termination_delay), &(pattrib->pktlen)); -+ if (!reason && !is_zero_mac_addr(pmlmepriv->nb_info.roam_target_addr)) { -+ pframe = rtw_set_fixed_ie(pframe, 6, -+ pmlmepriv->nb_info.roam_target_addr, &(pattrib->pktlen)); -+ } -+ -+#ifdef CONFIG_RTW_MBO -+ rtw_mbo_build_trans_reject_reason_attr(padapter, -+ &pframe, pattrib, &mbo_trans_rej_res); -+#endif -+ -+ RTW_INFO("WNM: BSS Transition Management Response sent(reason:%d)\n", reason); -+ break; -+ case RTW_WLAN_ACTION_WNM_NOTIF_REQ: -+#ifdef CONFIG_RTW_MBO -+ dialog_token++; -+ mbo_notif_req_type = WLAN_EID_VENDOR_SPECIFIC; -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialog_token), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(mbo_notif_req_type), &(pattrib->pktlen)); -+ rtw_mbo_build_wnm_notification(padapter, &pframe, pattrib); -+ RTW_INFO("WNM: Notification request sent\n"); -+#endif -+ break; -+ default: -+ goto exit; -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+exit: -+ return; -+} -+ -+/* argument req_ie@cfg80211_roamed()/cfg80211_connect_result() -+ is association request IEs format. if driver used reassoc-req format, -+ RSN IE could not be parsed @supplicant process */ -+void rtw_wnm_update_reassoc_req_ie(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u32 dup_len, offset; -+ u8 *pdup; -+ -+ if (!pmlmepriv->assoc_req || !pmlmepriv->assoc_req_len) -+ return; -+ -+ /* total len is assoc req len without Current AP Field*/ -+ dup_len = pmlmepriv->assoc_req_len - ETH_ALEN; -+ -+ /* offset is a len of 80211 header + capability(2B) + listen interval(2B) */ -+ offset = sizeof(struct rtw_ieee80211_hdr_3addr) + 4; -+ -+ pdup = rtw_zmalloc(dup_len); -+ if (pdup) { -+ /* remove Current AP Field @reassoc req IE */ -+ _rtw_memcpy(pdup, pmlmepriv->assoc_req, offset); -+ _rtw_memcpy(pdup + offset, pmlmepriv->assoc_req + offset + ETH_ALEN, -+ pmlmepriv->assoc_req_len - offset); -+ rtw_buf_update(&pmlmepriv->assoc_req, -+ &pmlmepriv->assoc_req_len, pdup, dup_len); -+ rtw_mfree(pdup, dup_len); -+ } -+} -+#endif /* CONFIG_RTW_WNM */ -+ -+#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) -+void rtw_roam_nb_info_init(_adapter *padapter) -+{ -+ struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); -+ struct btm_rpt_cache *pcache = &(pnb->btm_cache); -+ -+ _rtw_memset(&pnb->nb_rpt, 0, sizeof(pnb->nb_rpt)); -+ _rtw_memset(&pnb->nb_rpt_ch_list, 0, sizeof(pnb->nb_rpt_ch_list)); -+ _rtw_memset(&pnb->roam_target_addr, 0, ETH_ALEN); -+ pnb->nb_rpt_valid = _FALSE; -+ pnb->nb_rpt_ch_list_num = 0; -+ pnb->preference_en = _FALSE; -+ pnb->nb_rpt_is_same = _TRUE; -+ pnb->last_nb_rpt_entries = 0; -+ pnb->disassoc_waiting = -1; -+#ifdef CONFIG_RTW_WNM -+ pnb->features = 0; -+ /* pnb->features |= RTW_WNM_FEATURE_BTM_REQ_EN; */ -+ -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ pnb->features |= RTW_WNM_FEATURE_BTM_REQ_EN; -+#endif -+ -+ rtw_init_timer(&pnb->roam_scan_timer, -+ padapter, rtw_wnm_roam_scan_hdl, -+ padapter); -+ rtw_init_timer(&pnb->disassoc_chk_timer, -+ padapter, rtw_wnm_disassoc_chk_hdl, -+ padapter); -+ -+ _rtw_memset(pcache, 0, sizeof(struct btm_rpt_cache)); -+ pcache->validity_time = wnm_defualt_validity_time; -+ pcache->disassoc_time= wnm_default_disassoc_time ; -+#endif -+} -+ -+u8 rtw_roam_nb_scan_list_set( -+ _adapter *padapter, struct sitesurvey_parm *pparm) -+{ -+ u8 ret = _FALSE; -+ u32 i; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct roam_nb_info *pnb = &(pmlmepriv->nb_info); -+ -+#ifdef CONFIG_RTW_80211R -+ if (!rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE) -+ && !rtw_ft_chk_flags(padapter, RTW_FT_BTM_ROAM)) -+ return ret; -+#endif -+ -+ if (!pmlmepriv->need_to_roam) -+ return ret; -+ -+ if ((!pmlmepriv->nb_info.nb_rpt_valid) || (!pnb->nb_rpt_ch_list_num)) -+ return ret; -+ -+ if (!pparm) -+ return ret; -+ -+ rtw_init_sitesurvey_parm(padapter, pparm); -+ if (rtw_roam_busy_scan(padapter, pnb)) { -+ pparm->ch_num = 1; -+ pparm->ch[pmlmepriv->ch_cnt].hw_value = -+ pnb->nb_rpt_ch_list[pmlmepriv->ch_cnt].hw_value; -+ pmlmepriv->ch_cnt++; -+ ret = _TRUE; -+ -+ RTW_WNM_INFO("%s: ch_cnt=%u, (%u)hw_value=%u\n", -+ __func__, pparm->ch_num, pmlmepriv->ch_cnt, -+ pparm->ch[pmlmepriv->ch_cnt].hw_value); -+ -+ if (pmlmepriv->ch_cnt == pnb->nb_rpt_ch_list_num) { -+ pmlmepriv->nb_info.nb_rpt_valid = _FALSE; -+ pmlmepriv->ch_cnt = 0; -+ } -+ goto set_bssid_list; -+ } -+ -+ pparm->ch_num = (pnb->nb_rpt_ch_list_num > RTW_CHANNEL_SCAN_AMOUNT)? -+ (RTW_CHANNEL_SCAN_AMOUNT):(pnb->nb_rpt_ch_list_num); -+ for (i=0; ich_num; i++) { -+ pparm->ch[i].hw_value = pnb->nb_rpt_ch_list[i].hw_value; -+ pparm->ch[i].flags = RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ } -+ -+ pmlmepriv->nb_info.nb_rpt_valid = _FALSE; -+ pmlmepriv->ch_cnt = 0; -+ ret = _TRUE; -+ -+set_bssid_list: -+ rtw_set_802_11_bssid_list_scan(padapter, pparm); -+ return ret; -+} -+ -+static u8 rtw_wnm_nb_elem_parsing( -+ u8* pdata, u32 data_len, u8 from_btm, -+ u32 *nb_rpt_num, u8 *nb_rpt_is_same, -+ struct roam_nb_info *pnb, struct wnm_btm_cant *pcandidates) -+{ -+ u8 bfound = _FALSE, ret = _SUCCESS; -+ u8 *ptr, *pend, *op; -+ u32 elem_len, subelem_len, op_len; -+ u32 i, nb_rpt_entries = 0; -+ struct nb_rpt_hdr *pie; -+ struct wnm_btm_cant *pcandidate; -+ -+ if ((!pdata) || (!pnb)) -+ return _FAIL; -+ -+ if ((from_btm) && (!pcandidates)) -+ return _FAIL; -+ -+ ptr = pdata; -+ pend = ptr + data_len; -+ elem_len = data_len; -+ subelem_len = (u32)*(pdata+1); -+ -+ for (i=0; i < RTW_MAX_NB_RPT_NUM; i++) { -+ if (((ptr + 7) > pend) || (elem_len < subelem_len)) -+ break; -+ -+ if (*ptr != RTW_WLAN_ACTION_WNM_NB_RPT_ELEM) { -+ RTW_WNM_INFO("WNM: end of data(0x%2x)!\n", *ptr); -+ break; -+ } -+ -+ pie = (struct nb_rpt_hdr *)ptr; -+ if (from_btm) { -+ op = rtw_get_ie((u8 *)(ptr+15), -+ WNM_BTM_CAND_PREF_SUBEID, -+ &op_len, (subelem_len - 15)); -+ } -+ -+ ptr = (u8 *)(ptr + subelem_len + 2); -+ elem_len -= (subelem_len +2); -+ subelem_len = *(ptr+1); -+ if (from_btm) { -+ pcandidate = (pcandidates + i); -+ _rtw_memcpy(&pcandidate->nb_rpt, pie, sizeof(struct nb_rpt_hdr)); -+ if (op && (op_len !=0)) { -+ pcandidate->preference = *(op + 2); -+ bfound = _TRUE; -+ } else -+ pcandidate->preference = 0; -+ -+ RTW_WNM_INFO("WNM: preference check bssid("MAC_FMT -+ ") ,bss_info(0x%04X), reg_class(0x%02X), ch(%d)," -+ " phy_type(0x%02X), preference(0x%02X)\n", -+ MAC_ARG(pcandidate->nb_rpt.bssid), pcandidate->nb_rpt.bss_info, -+ pcandidate->nb_rpt.reg_class, pcandidate->nb_rpt.ch_num, -+ pcandidate->nb_rpt.phy_type, pcandidate->preference); -+ } else { -+ if (_rtw_memcmp(&pnb->nb_rpt[i], pie, sizeof(struct nb_rpt_hdr)) == _FALSE) -+ *nb_rpt_is_same = _FALSE; -+ _rtw_memcpy(&pnb->nb_rpt[i], pie, sizeof(struct nb_rpt_hdr)); -+ } -+ nb_rpt_entries++; -+ } -+ -+ if (from_btm) -+ pnb->preference_en = (bfound)?_TRUE:_FALSE; -+ -+ *nb_rpt_num = nb_rpt_entries; -+ return ret; -+} -+ -+/* selection sorting based on preference value -+ * IN : nb_rpt_entries - candidate num -+ * IN/OUT : pcandidates - candidate list -+ * return : TRUE - means pcandidates is updated. -+ */ -+static u8 rtw_wnm_candidates_sorting( -+ u32 nb_rpt_entries, struct wnm_btm_cant *pcandidates) -+{ -+ u8 updated = _FALSE; -+ u32 i, j, pos; -+ struct wnm_btm_cant swap; -+ struct wnm_btm_cant *pcant_1, *pcant_2; -+ -+ if ((!nb_rpt_entries) || (!pcandidates)) -+ return updated; -+ -+ for (i=0; i < (nb_rpt_entries - 1); i++) { -+ pos = i; -+ for (j=(i + 1); j < nb_rpt_entries; j++) { -+ pcant_1 = pcandidates+pos; -+ pcant_2 = pcandidates+j; -+ if ((pcant_1->preference) < (pcant_2->preference)) -+ pos = j; -+ } -+ -+ if (pos != i) { -+ updated = _TRUE; -+ _rtw_memcpy(&swap, (pcandidates+i), sizeof(struct wnm_btm_cant)); -+ _rtw_memcpy((pcandidates+i), (pcandidates+pos), sizeof(struct wnm_btm_cant)); -+ _rtw_memcpy((pcandidates+pos), &swap, sizeof(struct wnm_btm_cant)); -+ } -+ } -+ return updated; -+} -+ -+static void rtw_wnm_nb_info_update( -+ u32 nb_rpt_entries, u8 from_btm, -+ struct roam_nb_info *pnb, struct wnm_btm_cant *pcandidates, -+ u8 *nb_rpt_is_same) -+{ -+ u8 is_found; -+ u32 i, j; -+ struct wnm_btm_cant *pcand; -+ -+ if (!pnb) -+ return; -+ -+ pnb->nb_rpt_ch_list_num = 0; -+ for (i=0; inb_rpt[i], &pcand->nb_rpt, -+ sizeof(struct nb_rpt_hdr)) == _FALSE) -+ *nb_rpt_is_same = _FALSE; -+ _rtw_memcpy(&pnb->nb_rpt[i], &pcand->nb_rpt, sizeof(struct nb_rpt_hdr)); -+ } -+ -+ RTW_WNM_INFO("WNM: bssid(" MAC_FMT -+ ") , bss_info(0x%04X), reg_class(0x%02X), ch_num(%d), phy_type(0x%02X)\n", -+ MAC_ARG(pnb->nb_rpt[i].bssid), pnb->nb_rpt[i].bss_info, -+ pnb->nb_rpt[i].reg_class, pnb->nb_rpt[i].ch_num, -+ pnb->nb_rpt[i].phy_type); -+ -+ if (pnb->nb_rpt[i].ch_num == 0) -+ continue; -+ -+ for (j=0; jnb_rpt[i].ch_num == pnb->nb_rpt_ch_list[j].hw_value) { -+ is_found = _TRUE; -+ break; -+ } -+ } -+ -+ if (!is_found) { -+ pnb->nb_rpt_ch_list[pnb->nb_rpt_ch_list_num].hw_value = pnb->nb_rpt[i].ch_num; -+ pnb->nb_rpt_ch_list_num++; -+ } -+ } -+} -+ -+static void rtw_wnm_btm_candidate_select(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); -+ struct wlan_network *pnetwork; -+ u8 bfound = _FALSE; -+ u8 ignore_currrent = _FALSE; -+ u32 i; -+ -+#ifdef CONFIG_RTW_80211R -+ if (rtw_ft_chk_flags(padapter, RTW_FT_BTM_ROAM)) -+ ignore_currrent = _TRUE; -+#endif -+ -+ for (i = 0; i < pnb->last_nb_rpt_entries; i++) { -+ if (ignore_currrent && -+ (_rtw_memcmp(pnb->nb_rpt[i].bssid,\ -+ padapter->mlmepriv.cur_network.network.MacAddress, ETH_ALEN))) { -+ RTW_WNM_INFO("WNM : ignore candidate "MAC_FMT" for it's connected(%u)!\n", -+ MAC_ARG(pnb->nb_rpt[i].bssid), i); -+ continue; -+ } -+ -+ pnetwork = rtw_find_network( -+ &(pmlmepriv->scanned_queue), -+ pnb->nb_rpt[i].bssid); -+ -+ if (pnetwork) { -+ bfound = _TRUE; -+ break; -+ } -+ } -+ -+ if (bfound) { -+ _rtw_memcpy(pnb->roam_target_addr, pnb->nb_rpt[i].bssid, ETH_ALEN); -+ RTW_INFO("WNM : select btm entry(%d) - %s("MAC_FMT", ch:%u) rssi:%d\n" -+ , i -+ , pnetwork->network.Ssid.Ssid -+ , MAC_ARG(pnetwork->network.MacAddress) -+ , pnetwork->network.Configuration.DSConfig -+ , (int)pnetwork->network.Rssi); -+ } else -+ _rtw_memset(pnb->roam_target_addr,0, ETH_ALEN); -+} -+ -+u32 rtw_wnm_btm_candidates_survey( -+ _adapter *padapter, u8* pframe, u32 elem_len, u8 from_btm) -+{ -+ struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); -+ struct wnm_btm_cant *pcandidate_list = NULL; -+ u8 nb_rpt_is_same = _TRUE; -+ u32 ret = _FAIL; -+ u32 nb_rpt_entries = 0; -+ -+ if (from_btm) { -+ u32 mlen = sizeof(struct wnm_btm_cant) * RTW_MAX_NB_RPT_NUM; -+ pcandidate_list = (struct wnm_btm_cant *)rtw_malloc(mlen); -+ if (pcandidate_list == NULL) -+ goto exit; -+ } -+ -+ /*clean the status set last time*/ -+ _rtw_memset(&pnb->nb_rpt_ch_list, 0, sizeof(pnb->nb_rpt_ch_list)); -+ pnb->nb_rpt_valid = _FALSE; -+ if (!rtw_wnm_nb_elem_parsing( -+ pframe, elem_len, from_btm, -+ &nb_rpt_entries, &nb_rpt_is_same, -+ pnb, pcandidate_list)) -+ goto exit; -+ -+ if (nb_rpt_entries != 0) { -+ if ((from_btm) && (rtw_wnm_btm_preference_cap(padapter))) -+ rtw_wnm_candidates_sorting(nb_rpt_entries, pcandidate_list); -+ -+ rtw_wnm_nb_info_update( -+ nb_rpt_entries, from_btm, -+ pnb, pcandidate_list, &nb_rpt_is_same); -+ } -+ -+ RTW_WNM_INFO("nb_rpt_is_same = %d, nb_rpt_entries = %d, last_nb_rpt_entries = %d\n", -+ nb_rpt_is_same, nb_rpt_entries, pnb->last_nb_rpt_entries); -+ if ((nb_rpt_is_same == _TRUE) && (nb_rpt_entries == pnb->last_nb_rpt_entries)) -+ pnb->nb_rpt_is_same = _TRUE; -+ else { -+ pnb->nb_rpt_is_same = _FALSE; -+ pnb->last_nb_rpt_entries = nb_rpt_entries; -+ } -+ -+ if ((from_btm) && (nb_rpt_entries != 0)) -+ rtw_wnm_btm_candidate_select(padapter); -+ -+ pnb->nb_rpt_valid = _TRUE; -+ ret = _SUCCESS; -+ -+exit: -+ if (from_btm && pcandidate_list) -+ rtw_mfree((u8 *)pcandidate_list, sizeof(struct wnm_btm_cant) * RTW_MAX_NB_RPT_NUM); -+ -+ return ret; -+} -+ -+#endif /*defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/rtw_xmit.c b/drivers/net/wireless/rtl8821cs/core/rtw_xmit.c -new file mode 100644 -index 000000000..dcd86cfa8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/rtw_xmit.c -@@ -0,0 +1,6709 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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) -+{ -+ _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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ _init_txservq(&psta_xmitpriv->mgmt_q); -+#endif -+ _rtw_init_listhead(&psta_xmitpriv->legacy_dz); -+ _rtw_init_listhead(&psta_xmitpriv->apsd); -+ -+ -+} -+ -+void rtw_init_xmit_block(_adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ _rtw_spinlock_init(&dvobj->xmit_block_lock); -+ dvobj->xmit_block = XMIT_BLOCK_NONE; -+ -+} -+void rtw_free_xmit_block(_adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ _rtw_spinlock_free(&dvobj->xmit_block_lock); -+} -+ -+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); -+ -+ /* -+ 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->mgmt_pending); -+ -+ /* _rtw_init_queue(&pxmitpriv->legacy_dz_queue); */ -+ /* _rtw_init_queue(&pxmitpriv->apsd_queue); */ -+ -+ _rtw_init_queue(&pxmitpriv->free_xmit_queue); -+#ifdef CONFIG_LAYER2_ROAMING -+ _rtw_init_queue(&pxmitpriv->rpkt_queue); -+#endif -+ -+ /* -+ 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 -+ -+#ifdef CONFIG_TX_AMSDU -+ rtw_init_timer(&(pxmitpriv->amsdu_vo_timer), padapter, -+ rtw_amsdu_vo_timeout_handler, padapter); -+ pxmitpriv->amsdu_vo_timeout = RTW_AMSDU_TIMER_UNSET; -+ -+ rtw_init_timer(&(pxmitpriv->amsdu_vi_timer), padapter, -+ rtw_amsdu_vi_timeout_handler, padapter); -+ pxmitpriv->amsdu_vi_timeout = RTW_AMSDU_TIMER_UNSET; -+ -+ rtw_init_timer(&(pxmitpriv->amsdu_be_timer), padapter, -+ rtw_amsdu_be_timeout_handler, padapter); -+ pxmitpriv->amsdu_be_timeout = RTW_AMSDU_TIMER_UNSET; -+ -+ rtw_init_timer(&(pxmitpriv->amsdu_bk_timer), padapter, -+ rtw_amsdu_bk_timeout_handler, padapter); -+ pxmitpriv->amsdu_bk_timeout = RTW_AMSDU_TIMER_UNSET; -+ -+ pxmitpriv->amsdu_debug_set_timer = 0; -+ pxmitpriv->amsdu_debug_timeout = 0; -+ pxmitpriv->amsdu_debug_coalesce_one = 0; -+ pxmitpriv->amsdu_debug_coalesce_two = 0; -+#endif -+#ifdef DBG_TXBD_DESC_DUMP -+ pxmitpriv->dump_txbd_desc = 0; -+#endif -+ rtw_init_xmit_block(padapter); -+ 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_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->mgmt_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); -+#ifdef CONFIG_LAYER2_ROAMING -+ _rtw_spinlock_free(&pxmitpriv->rpkt_queue.lock); -+#endif -+ 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 -+ rtw_free_xmit_block(padapter); -+out: -+ return; -+} -+ -+u8 rtw_get_tx_bw_mode(_adapter *adapter, struct sta_info *sta) -+{ -+ u8 bw; -+ -+ bw = sta->cmn.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, u64 *r_bmp_vht) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 fix_bw = 0xFF; -+ u16 bmp_cck_ofdm = 0; -+ u32 bmp_ht = 0; -+ u64 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_is_iface_specific(macid_ctl, i, adapter)) -+ 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*/ -+ -+ 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, u64 *r_bmp_vht) -+{ -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u16 bmp_cck_ofdm = 0; -+ u32 bmp_ht = 0; -+ u64 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_is_iface_shared(macid_ctl, i)) -+ 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_get_adapter_tx_rate_bmp(_adapter *adapter, u16 r_bmp_cck_ofdm[], u32 r_bmp_ht[], u64 r_bmp_vht[]) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 bw; -+ u16 bmp_cck_ofdm, tmp_cck_ofdm; -+ u32 bmp_ht, tmp_ht; -+ u64 bmp_vht, tmp_vht; -+ int i; -+ -+ for (bw = CHANNEL_WIDTH_20; bw <= CHANNEL_WIDTH_160; bw++) { -+ bmp_cck_ofdm = bmp_ht = bmp_vht = 0; -+ if (hal_is_bw_support(adapter, bw)) { -+ { -+ rtw_get_adapter_tx_rate_bmp_by_bw(adapter, 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) -+ r_bmp_cck_ofdm[bw] = bmp_cck_ofdm; -+ if (bw <= CHANNEL_WIDTH_40) -+ r_bmp_ht[bw] = bmp_ht; -+ if (bw <= CHANNEL_WIDTH_160) -+ r_bmp_vht[bw] = 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]; -+ u64 bmp_vht, tmp_vht, ori_bmp_vht[4]; -+ int i; -+ -+ 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; -+ } -+ -+#if CONFIG_TXPWR_LIMIT -+#ifndef DBG_HIGHEST_RATE_BMP_BW_CHANGE -+#define DBG_HIGHEST_RATE_BMP_BW_CHANGE 0 -+#endif -+ -+ if (hal_data->txpwr_limit_loaded) { -+ u8 ori_highest_ht_rate_bw_bmp; -+ u8 ori_highest_vht_rate_bw_bmp; -+ u8 highest_rate_bw; -+ u8 highest_rate_bw_bmp; -+ u8 update_ht_rs = _FALSE; -+ u8 update_vht_rs = _FALSE; -+ -+ /* 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; -+ -+ 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]); -+ } -+ if (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_64(ori_bmp_vht[highest_rate_bw]) != largest_bit_64(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%016llx=>0x%016llx\n", highest_rate_bw, ori_bmp_vht[highest_rate_bw], rf_ctl->rate_bmp_vht_by_bw[highest_rate_bw]); -+ } -+ if (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_update_txpwr_level(adapter); -+ } -+#endif /* CONFIG_TXPWR_LIMIT */ -+} -+ -+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; -+ u64 rate_bmp; -+ -+ if (!IS_VHT_RATE(rate)) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ rate_bmp = BIT_ULL(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; -+} -+ -+s16 rtw_adapter_get_oper_txpwr_max_mbm(_adapter *adapter, bool eirp) -+{ -+ s16 mbm = -100 * MBM_PDBM; -+ -+ if (MLME_IS_ASOC(adapter)) { -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ u8 ch = mlmeext->cur_channel; -+ u8 bw = mlmeext->cur_bwmode; -+ u8 offset = mlmeext->cur_ch_offset; -+ u8 cch = rtw_get_center_ch(ch, bw, offset); -+ u8 hw_rate = MRateToHwRate(mlmeext->tx_rate); -+ u16 bmp_cck_ofdm_by_bw[1] = {0}; -+ u32 bmp_ht_by_bw[2] = {0}; -+ u64 bmp_vht_by_bw[4] = {0}; -+ u16 bmp_cck_ofdm = 0; -+ u32 bmp_ht = 0; -+ u64 bmp_vht = 0; -+ int i; -+ -+ rtw_get_adapter_tx_rate_bmp(adapter, bmp_cck_ofdm_by_bw, bmp_ht_by_bw, bmp_vht_by_bw); -+ -+ bmp_cck_ofdm |= bmp_cck_ofdm_by_bw[0]; -+ for (i = 0; i < 2; i++) -+ bmp_ht |= bmp_ht_by_bw[i]; -+ for (i = 0; i < 4; i++) -+ bmp_vht |= bmp_vht_by_bw[i]; -+ -+ if (IS_LEGACY_HRATE(hw_rate)) -+ bmp_cck_ofdm |= BIT(hw_rate); -+ else if (IS_HT_HRATE(hw_rate)) -+ bmp_ht |= BIT(hw_rate - DESC_RATEMCS0); -+ else if (IS_VHT_HRATE(hw_rate)) -+ bmp_vht |= BIT_ULL(hw_rate - DESC_RATEVHTSS1MCS0); -+ -+ mbm = phy_get_txpwr_total_max_mbm(adapter -+ , bw, cch, ch, bmp_cck_ofdm, bmp_ht, bmp_vht, 0, eirp); -+ } -+ -+ return mbm; -+} -+ -+s16 rtw_rfctl_get_oper_txpwr_max_mbm(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, u8 ifbmp_mod, u8 if_op, bool eirp) -+{ -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ _adapter *adapter = dvobj_get_primary_adapter(dvobj); -+ s16 mbm = -100 * MBM_PDBM; -+ -+ if (ch) { -+ u8 cch = rtw_get_center_ch(ch, bw, offset); -+ u16 bmp_cck_ofdm = 0; -+ u32 bmp_ht = 0; -+ u64 bmp_vht = 0; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ struct mlme_ext_priv *mlmeext; -+ u8 hw_rate; -+ -+ if (!dvobj->padapters[i]) -+ continue; -+ -+ if (ifbmp_mod & BIT(i)) { -+ if (!if_op) -+ continue; -+ } else if (!MLME_IS_ASOC(dvobj->padapters[i])) -+ continue; -+ -+ mlmeext = &(dvobj->padapters[i]->mlmeextpriv); -+ hw_rate = MRateToHwRate(mlmeext->tx_rate); -+ -+ if (IS_LEGACY_HRATE(hw_rate)) -+ bmp_cck_ofdm |= BIT(hw_rate); -+ else if (IS_HT_HRATE(hw_rate)) -+ bmp_ht |= BIT(hw_rate - DESC_RATEMCS0); -+ else if (IS_VHT_HRATE(hw_rate)) -+ bmp_vht |= BIT_ULL(hw_rate - DESC_RATEVHTSS1MCS0); -+ } -+ -+ bmp_cck_ofdm |= rfctl->rate_bmp_cck_ofdm; -+ for (i = 0; i < 2; i++) -+ bmp_ht |= rfctl->rate_bmp_ht_by_bw[i]; -+ for (i = 0; i < 4; i++) -+ bmp_vht |= rfctl->rate_bmp_vht_by_bw[i]; -+ -+ mbm = phy_get_txpwr_total_max_mbm(adapter -+ , bw, cch, ch, bmp_cck_ofdm, bmp_ht, bmp_vht, 0, eirp); -+ } -+ -+ return mbm; -+} -+ -+s16 rtw_get_oper_txpwr_max_mbm(struct dvobj_priv *dvobj, bool eirp) -+{ -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ _adapter *adapter = dvobj_get_primary_adapter(dvobj); -+ s16 mbm = -100 * MBM_PDBM; -+ u8 ch = rfctl->op_ch, bw, offset; -+ -+ if (rtw_get_bw_offset_by_op_class_ch(rfctl->op_class, ch, &bw, &offset)) -+ mbm = rtw_rfctl_get_oper_txpwr_max_mbm(rfctl, ch, bw, offset, 0, 0, eirp); -+ -+ return mbm; -+} -+ -+s16 rtw_rfctl_get_reg_max_txpwr_mbm(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, bool eirp) -+{ -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ _adapter *adapter = dvobj_get_primary_adapter(dvobj); -+ s16 mbm = -100 * MBM_PDBM; -+ u8 cch = rtw_get_center_ch(ch, bw, offset); -+ u16 bmp_cck_ofdm = 0; -+ u32 bmp_ht = 0; -+ u64 bmp_vht = 0; -+ -+ if (ch <= 14) -+ bmp_cck_ofdm |= RATE_BMP_CCK; -+ -+ /* TODO: NO OFDM? */ -+ bmp_cck_ofdm |= RATE_BMP_OFDM; -+ -+#ifdef CONFIG_80211N_HT -+ if (regsty->ht_enable && is_supported_ht(regsty->wireless_mode)) { -+ switch (GET_HAL_TX_NSS(adapter)) { -+ case 1: -+ bmp_ht |= RATE_BMP_HT_1SS; -+ break; -+ case 2: -+ bmp_ht |= RATE_BMP_HT_2SS | RATE_BMP_HT_1SS; -+ break; -+ case 3: -+ bmp_ht |= RATE_BMP_HT_3SS | RATE_BMP_HT_2SS | RATE_BMP_HT_1SS; -+ break; -+ case 4: -+ bmp_ht |= RATE_BMP_HT_4SS | RATE_BMP_HT_3SS | RATE_BMP_HT_2SS | RATE_BMP_HT_1SS; -+ break; -+ default: -+ rtw_warn_on(1); -+ } -+ } -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ if (ch > 14 && REGSTY_IS_11AC_ENABLE(regsty) && is_supported_vht(regsty->wireless_mode) -+ && RFCTL_REG_EN_11AC(rfctl) -+ ) { -+ switch (GET_HAL_TX_NSS(adapter)) { -+ case 1: -+ bmp_vht |= RATE_BMP_VHT_1SS; -+ break; -+ case 2: -+ bmp_vht |= RATE_BMP_VHT_2SS | RATE_BMP_VHT_1SS; -+ break; -+ case 3: -+ bmp_vht |= RATE_BMP_VHT_3SS | RATE_BMP_VHT_2SS | RATE_BMP_VHT_1SS; -+ break; -+ case 4: -+ bmp_vht |= RATE_BMP_VHT_4SS | RATE_BMP_VHT_3SS | RATE_BMP_VHT_2SS | RATE_BMP_VHT_1SS; -+ break; -+ default: -+ rtw_warn_on(1); -+ } -+ } -+#endif -+ -+ mbm = phy_get_txpwr_total_max_mbm(adapter -+ , bw, cch, ch, bmp_cck_ofdm, bmp_ht, bmp_vht, 1, eirp); -+ -+ return mbm; -+} -+ -+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; -+} -+ -+/* This function references driver insmond parameters to decide vcs mode. */ -+/* Driver insmond parameters: rtw_vrtl_carrier_sense and rtw_vcs_type */ -+static u8 validate_vcs(_adapter *padapter, u8 mode) { -+ -+ u8 vcs_mode = NONE_VCS; -+ -+ switch(padapter->registrypriv.vrtl_carrier_sense) { -+ -+ case DISABLE_VCS: -+ vcs_mode = NONE_VCS; -+ break; -+ -+ case ENABLE_VCS: -+ vcs_mode = padapter->registrypriv.vcs_type; -+ break; -+ -+ case AUTO_VCS: -+ vcs_mode = mode; -+ break; -+ -+ default: -+ vcs_mode = NONE_VCS; -+ break; -+ } -+ -+ return vcs_mode; -+ -+} -+ -+static void update_attrib_vcs_info(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ u32 sz; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ #ifdef RTW_FORCE_CTS_TO_SELF_UNDER_LOW_RSSI -+ s8 rssi = 0; -+ struct sta_info *psta = pattrib->psta; -+ #endif -+ /* -+ 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 &WIFI_ASOC_STATE)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\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; -+ } -+ #ifdef RTW_FORCE_CTS_TO_SELF_UNDER_LOW_RSSI -+ /*RTStoCTS while let TP degree ,while enable full BW*/ -+ if (psta != NULL) { -+ rssi = psta->cmn.rssi_stat.rssi; -+ if ((rssi < 18) && (pattrib->vcs_mode == RTS_CTS)) -+ pattrib->vcs_mode = CTS_TO_SELF; -+ } -+ #endif -+ } -+ -+ pattrib->vcs_mode = validate_vcs(padapter, pattrib->vcs_mode); -+ -+ /* 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; -+ } -+ -+} -+ -+#ifdef CONFIG_WMMPS_STA -+/* -+ * update_attrib_trigger_frame_info -+ * For Station mode, if a specific TID of driver setting and an AP support uapsd function, the data -+ * frame with corresponding TID will be a trigger frame when driver is in wmm power saving mode. -+ * -+ * Arguments: -+ * @padapter: _adapter pointer. -+ * @pattrib: pkt_attrib pointer. -+ * -+ * Auther: Arvin Liu -+ * Date: 2017/06/05 -+ */ -+static void update_attrib_trigger_frame_info(_adapter *padapter, struct pkt_attrib *pattrib) { -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ u8 trigger_frame_en = 0; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ if ((pwrpriv->pwr_mode == PS_MODE_MIN) || (pwrpriv->pwr_mode == PS_MODE_MAX)) { -+ if((pqospriv->uapsd_ap_supported) && ((pqospriv->uapsd_tid & BIT(pattrib->priority)) == _TRUE)) { -+ trigger_frame_en = 1; -+ RTW_INFO("[WMMPS]"FUNC_ADPT_FMT": This is a Trigger Frame\n", FUNC_ADPT_ARG(padapter)); -+ } -+ } -+ } -+ -+ pattrib->trigger_frame = trigger_frame_en; -+} -+#endif /* CONFIG_WMMPS_STA */ -+ -+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; -+ -+ /* ht_en, init rate, ,bw, ch_offset, sgi */ -+ -+ pattrib->raid = psta->cmn.ra_info.rate_id; -+ -+ 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->cmn.ldpc_en; -+ pattrib->stbc = psta->cmn.stbc_en; -+ -+#ifdef CONFIG_80211N_HT -+ if(padapter->registrypriv.ht_enable && -+ is_supported_ht(padapter->registrypriv.wireless_mode)) { -+ 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; -+ -+ /* 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; -+ if (psta->htpriv.tx_amsdu_enable == _TRUE) -+ pattrib->amsdu_ampdu_en = _TRUE; -+ else -+ pattrib->amsdu_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; */ -+ /* } */ -+ -+#ifdef CONFIG_TDLS -+ if (pattrib->direct_link == _TRUE) { -+ psta = pattrib->ptdls_sta; -+ -+ pattrib->raid = psta->cmn.ra_info.rate_id; -+#ifdef CONFIG_80211N_HT -+ if(padapter->registrypriv.ht_enable && -+ is_supported_ht(padapter->registrypriv.wireless_mode)) { -+ 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; -+} -+ -+static s32 update_attrib_sec_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta, enum eap_type eapol_type) -+{ -+ 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->cmn.mac_id; -+ -+ /* Comment by Owen at 2020/05/19 -+ * Issue: RTK STA sends encrypted 4-way 4/4 when AP thinks the 4-way incomplete -+ * In TCL pressure test, AP may resend 4-way 3/4 with new replay counter in 2 ms. -+ * In this situation, STA sends unencrypted 4-way 4/4 with old replay counter after more -+ * than 2 ms, followed by the encrypted 4-way 4/4 with new replay counter. Because the -+ * AP only accepts unencrypted 4-way 4/4 with a new play counter, and the STA encrypts -+ * each 4-way 4/4 at this time, the 4-way handshake cannot be completed. -+ * So we modified that after STA receives unencrypted 4-way 1/4 and 4-way 3/4, -+ * 4-way 2/4 and 4-way 4/4 sent by STA in the next 100 ms are not encrypted. -+ */ -+ if (psta->ieee8021x_blocked == _TRUE || -+ ((eapol_type == EAPOL_2_4 || eapol_type == EAPOL_4_4) && -+ rtw_get_passing_time_ms(psta->resp_nonenc_eapol_key_starttime) <= 100)) { -+ -+ if (eapol_type == EAPOL_2_4 || eapol_type == EAPOL_4_4) -+ RTW_INFO("Respond unencrypted eapol key\n"); -+ -+ 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; -+ -+ case _GCMP_: -+ case _GCMP_256_: -+ -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 16; -+ -+ if (bmcast) -+ GCMP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ GCMP_IV(pattrib->iv, psta->dot11txpn, 0); -+ -+ break; -+ -+ case _CCMP_256_: -+ -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 16; -+ -+ if (bmcast) -+ GCMP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ GCMP_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 -+ , (pattrib->encrypt & _SEC_TYPE_256_) ? 32 : 16); -+ } -+ -+ -+ if (pattrib->encrypt && -+ ((padapter->securitypriv.sw_encrypt == _TRUE) || (psecuritypriv->hw_decrypted == _FALSE))) { -+ pattrib->bswenc = _TRUE; -+ } else { -+ pattrib->bswenc = _FALSE; -+ } -+ -+ pattrib->bmc_camid = padapter->securitypriv.dot118021x_bmc_cam_id; -+ -+ 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 -+ -+ if ((pattrib->encrypt) && (eapol_type == EAPOL_4_4)) -+ pattrib->bswenc = _TRUE; -+ -+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; -+} -+ -+/* refer to IEEE802.11-2016 Table R-3; Comply with IETF RFC4594 */ -+static u8 tos_to_up(u8 tos) -+{ -+ u8 up = 0; -+ u8 dscp; -+ u8 mode = CONFIG_RTW_UP_MAPPING_RULE; -+ -+ -+ /* tos precedence mapping */ -+ if (mode == 0) { -+ up = tos >> 5; -+ return up; -+ } -+ -+ /* refer to IEEE802.11-2016 Table R-3; -+ * DCSP 32(CS4) comply with IETF RFC4594 -+ */ -+ dscp = (tos >> 2); -+ -+ if ( dscp == 0 ) -+ up = 0; -+ else if ( dscp >= 1 && dscp <= 9) -+ up = 1; -+ else if ( dscp >= 10 && dscp <= 16) -+ up = 2; -+ else if ( dscp >= 17 && dscp <= 23) -+ up = 3; -+ else if ( dscp >= 24 && dscp <= 31) -+ up = 4; -+ else if ( dscp >= 33 && dscp <= 40) -+ up = 5; -+ else if ((dscp >= 41 && dscp <= 47) || (dscp == 32)) -+ up = 6; -+ else if ( dscp >= 48 && dscp <= 63) -+ up = 7; -+ -+ return up; -+} -+ -+static void set_qos(_pkt *pkt, struct pkt_attrib *pattrib) -+{ -+ s32 UserPriority = 0; -+ -+ if (!pkt) -+ goto null_pkt; -+ -+ /* get UserPriority from IP hdr */ -+ if (pattrib->ether_type == 0x0800) { -+ struct pkt_file ppktfile; -+ struct ethhdr etherhdr; -+ struct iphdr ip_hdr; -+ -+ _rtw_open_pktfile(pkt, &ppktfile); -+ _rtw_pktfile_read(&ppktfile, (unsigned char *)ðerhdr, ETH_HLEN); -+ _rtw_pktfile_read(&ppktfile, (u8 *)&ip_hdr, sizeof(ip_hdr)); -+ /* UserPriority = (ntohs(ip_hdr.tos) >> 5) & 0x3; */ -+ UserPriority = tos_to_up(ip_hdr.tos); -+ } -+ /* -+ else if (pattrib->ether_type == 0x888e) { -+ -+ -+ UserPriority = 7; -+ } -+ */ -+ -+ #ifdef CONFIG_ICMP_VOQ -+ if(pattrib->icmp_pkt==1)/*use VO queue to send icmp packet*/ -+ UserPriority = 7; -+ #endif -+ #ifdef CONFIG_IP_R_MONITOR -+ if (pattrib->ether_type == ETH_P_ARP) -+ UserPriority = 7; -+ #endif/*CONFIG_IP_R_MONITOR*/ -+ -+null_pkt: -+ pattrib->priority = UserPriority; -+ pattrib->hdrlen = XATTRIB_GET_WDS(pattrib) ? WLAN_HDR_A4_QOS_LEN : 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->cmn.mac_id; -+ pattrib->psta = psta; -+ pattrib->ack_policy = 0; -+ /* get ether_hdr_len */ -+ pattrib->pkt_hdrlen = ETH_HLEN; -+ -+ pattrib->qos_en = psta->qos_option; -+ -+ /* [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, NON_EAPOL) == _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_SEQ 0,1,2,3*/ -+inline u8 rtw_get_hwseq_no(_adapter *padapter) -+{ -+ u8 hwseq_num = 0; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) \ -+ || defined(CONFIG_RTL8723F) -+ hwseq_num = padapter->iface_id; -+ if (hwseq_num > 3) -+ hwseq_num = 3; -+ #else -+ if (!is_primary_adapter(padapter)) -+ hwseq_num = 1; -+ #endif -+#endif /* CONFIG_CONCURRENT_MODE */ -+ return hwseq_num; -+} -+#ifdef CONFIG_LPS -+#define LPS_PT_NORMAL 0 -+#define LPS_PT_SP 1/* only DHCP packets is as SPECIAL_PACKET*/ -+#define LPS_PT_ICMP 2 -+ -+/*If EAPOL , ARP , OR DHCP packet, driver must be in active mode.*/ -+static u8 _rtw_lps_chk_packet_type(struct pkt_attrib *pattrib) -+{ -+ u8 pkt_type = LPS_PT_NORMAL; /*normal data frame*/ -+ -+ #ifdef CONFIG_WAPI_SUPPORT -+ if ((pattrib->ether_type == 0x88B4) || (pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) -+ pkt_type = LPS_PT_SP; -+ #else /* !CONFIG_WAPI_SUPPORT */ -+ -+ #ifndef CONFIG_LPS_NOT_LEAVE_FOR_ICMP -+ if (pattrib->icmp_pkt == 1) -+ pkt_type = LPS_PT_ICMP; -+ else -+ #endif -+ if (pattrib->dhcp_pkt == 1) -+ pkt_type = LPS_PT_SP; -+ #endif -+ return pkt_type; -+} -+#endif -+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 mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ sint res = _SUCCESS; -+ enum eap_type eapol_type = NON_EAPOL; -+#ifdef CONFIG_LPS -+ u8 pkt_type = 0; -+#endif -+ -+ 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); -+ -+ if (MLME_STATE(padapter) & (WIFI_AP_STATE | WIFI_MESH_STATE)) /* address resolve is done for ap/mesh */ -+ goto get_sta_info; -+ -+ _rtw_memcpy(pattrib->dst, ðerhdr.h_dest, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, ðerhdr.h_source, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, adapter_mac_addr(padapter), 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); -+ 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); -+ #ifdef CONFIG_RTW_WDS -+ if (adapter_use_wds(padapter) -+ && _rtw_memcmp(pattrib->src, pattrib->ta, ETH_ALEN) == _FALSE -+ ) { -+ pattrib->wds = 1; -+ if (IS_MCAST(pattrib->dst)) -+ rtw_tx_wds_gptr_update(padapter, pattrib->src); -+ } -+ #endif -+ } -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_sta); -+ } else -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_unknown); -+ -+get_sta_info: -+ 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 & WIFI_ASOC_STATE)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_ucast_ap_link); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ #ifdef CONFIG_RTW_WDS -+ if (XATTRIB_GET_WDS(pattrib) && !(psta->flags & WLAN_STA_WDS)) -+ pattrib->wds = 0; -+ #endif -+ } -+ -+ if (!(psta->state & WIFI_ASOC_STATE)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_link); -+ RTW_INFO("%s-"ADPT_FMT" psta("MAC_FMT")->state(0x%x) != WIFI_ASOC_STATE\n", -+ __func__, ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr), 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; -+ pattrib->hipriority_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[24]; -+ -+ _rtw_pktfile_read(&pktfile, udp, 24); -+ -+ 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"); -+ } -+ } -+ -+ /* WaveAgent packet, increase priority so that the system can read data in time */ -+ if (((GET_UDP_SIG1(udp) == 0xcc) || (GET_UDP_SIG1(udp) == 0xdd)) && -+ (GET_UDP_SIG2(udp) == 0xe2)) { -+ pattrib->hipriority_pkt = 1; -+ } -+ -+ } 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) -+ eapol_type = parsing_eapol_packet(padapter, pktfile.cur_addr, psta, 1); -+#if defined (DBG_ARP_DUMP) || defined (DBG_IP_R_MONITOR) -+ else if (pattrib->ether_type == ETH_P_ARP) { -+ u8 arp[28] = {0}; -+ -+ _rtw_pktfile_read(&pktfile, arp, 28); -+ dump_arp_pkt(RTW_DBGDUMP, etherhdr.h_dest, etherhdr.h_source, arp, 1); -+ } -+#endif -+ -+ if ((pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) -+ rtw_mi_set_scan_deny(padapter, 3000); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && -+ pattrib->ether_type == ETH_P_ARP && -+ !IS_MCAST(pattrib->dst)) { -+ rtw_mi_set_scan_deny(padapter, 1000); -+ rtw_mi_scan_abort(padapter, _FALSE); /*rtw_scan_abort_no_wait*/ -+ } -+ -+#ifdef CONFIG_LPS -+ pkt_type = _rtw_lps_chk_packet_type(pattrib); -+ -+ if (pkt_type == LPS_PT_SP) {/*packet is as SPECIAL_PACKET*/ -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_active); -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SPECIAL_PACKET, 0); -+ } else if (pkt_type == LPS_PT_ICMP) -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0); -+#endif /* CONFIG_LPS */ -+ -+#ifdef CONFIG_BEAMFORMING -+ update_attrib_txbf_info(padapter, pattrib, psta); -+#endif -+ -+ /* TODO:_lock */ -+ if (update_attrib_sec_info(padapter, pattrib, psta, eapol_type) == _FAIL) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_sec); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ /* get ether_hdr_len */ -+ pattrib->pkt_hdrlen = ETH_HLEN;/* (pattrib->ether_type == 0x8100) ? (14 + 4 ): 14; */ /* vlan tag */ -+ -+ pattrib->hdrlen = XATTRIB_GET_WDS(pattrib) ? WLAN_HDR_A4_LEN : WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA_TYPE; -+ pattrib->qos_en = psta->qos_option; -+ pattrib->priority = 0; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE | WIFI_MESH_STATE -+ | WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) -+ ) { -+ if (pattrib->qos_en) { -+ set_qos(pkt, pattrib); -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) -+ rtw_mesh_tx_set_whdr_mctrl_len(pattrib->mesh_frame_mode, pattrib); -+ #endif -+ } -+ } else { -+#ifdef CONFIG_TDLS -+ if (pattrib->direct_link == _TRUE) { -+ if (pattrib->qos_en) -+ set_qos(pkt, pattrib); -+ } else -+#endif -+ { -+ if (pqospriv->qos_option) { -+ set_qos(pkt, pattrib); -+ -+ if (pmlmepriv->acm_mask != 0) -+ pattrib->priority = qos_acm(pmlmepriv->acm_mask, pattrib->priority); -+ } -+ } -+ } -+ -+ update_attrib_phy_info(padapter, pattrib, psta); -+ -+ /* RTW_INFO("%s ==> mac_id(%d)\n",__FUNCTION__,pattrib->mac_id ); */ -+ -+ pattrib->psta = psta; -+ /* TODO:_unlock */ -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (psta->isrc && psta->pid > 0) -+ pattrib->pctrl = _TRUE; -+ else -+#endif -+ pattrib->pctrl = 0; -+ -+ pattrib->ack_policy = 0; -+ -+ if (bmcast) -+ pattrib->rate = psta->init_rate; -+ -+ -+#ifdef CONFIG_WMMPS_STA -+ update_attrib_trigger_frame_info(padapter, pattrib); -+#endif /* CONFIG_WMMPS_STA */ -+ -+ /* 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 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 &WIFI_ASOC_STATE)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\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 (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_: -+ case _CCMP_256_: -+ rtw_aes_encrypt(padapter, (u8 *)pxmitframe); -+ break; -+ case _GCMP_: -+ case _GCMP_256_: -+ rtw_gcmp_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 &WIFI_ASOC_STATE)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\n", __func__, psta->state); -+ return _FAIL; -+ } -+ */ -+ -+ _rtw_memset(hdr, 0, WLANHDR_OFFSET); -+ -+ set_frame_sub_type(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 */ -+ { -+ #ifdef CONFIG_RTW_WDS -+ if (pattrib->wds) { -+ SetToDs(fctrl); -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->ta, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr4, pattrib->src, ETH_ALEN); -+ } else -+ #endif -+ { -+ /* 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)) { -+ #ifdef CONFIG_RTW_WDS -+ if (pattrib->wds) { -+ SetToDs(fctrl); -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->ta, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr4, pattrib->src, ETH_ALEN); -+ } else -+ #endif -+ { -+ /* 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; -+#ifdef CONFIG_RTW_MESH -+ } else if (check_fwstate(pmlmepriv, WIFI_MESH_STATE) == _TRUE) { -+ rtw_mesh_tx_build_whdr(padapter, pattrib, fctrl, pwlanhdr); -+ if (pattrib->qos_en) -+ qos_option = _TRUE; -+ else { -+ RTW_WARN("[%s] !qos_en in Mesh\n", __FUNCTION__); -+ res = _FAIL; -+ goto exit; -+ } -+#endif -+ } 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); -+ -+ if(pattrib->amsdu) -+ SetAMsdu(qc, pattrib->amsdu); -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ /* active: don't care, light sleep: 0, deep sleep: 1*/ -+ set_mps_lv(qc, 0); //TBD -+ -+ /* TBD: temporary set (rspi, eosp) = (0, 1) which means End MPSP */ -+ set_rspi(qc, 0); -+ SetEOSP(qc, 1); -+ -+ set_mctrl_present(qc, 1); -+ } -+#endif -+ } -+ -+ /* 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 & WIFI_ASOC_STATE)) { -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\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 -+#if 0 /* move into update_attrib_phy_info(). */ -+ /* 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; -+ } -+#endif -+ /* 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) -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ || (_rtw_queue_empty(&pxmitpriv->mgmt_pending) == _FALSE) -+#endif -+ ); -+} -+ -+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 & WIFI_ASOC_STATE)) { -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\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) -+{ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta = NULL; -+ int res = _SUCCESS; -+ -+ ptdls_sta = rtw_get_stainfo((&padapter->stapriv), pattrib->dst); -+ if (ptdls_sta == NULL) { -+ switch (ptxmgmt->action_code) { -+ case TDLS_DISCOVERY_REQUEST: -+ case TUNNELED_PROBE_REQ: -+ case TUNNELED_PROBE_RSP: -+ break; -+ default: -+ RTW_INFO("[TDLS] %s - Direct Link Peer = "MAC_FMT" not found for action = %d\n", __func__, MAC_ARG(pattrib->dst), ptxmgmt->action_code); -+ res = _FAIL; -+ goto exit; -+ } -+ } -+ -+ switch (ptxmgmt->action_code) { -+ case TDLS_SETUP_REQUEST: -+ rtw_build_tdls_setup_req_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); -+ break; -+ case TDLS_SETUP_RESPONSE: -+ rtw_build_tdls_setup_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); -+ break; -+ case TDLS_SETUP_CONFIRM: -+ rtw_build_tdls_setup_cfm_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); -+ break; -+ case TDLS_TEARDOWN: -+ rtw_build_tdls_teardown_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); -+ 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, ptdls_sta); -+ break; -+#ifdef CONFIG_TDLS_CH_SW -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ rtw_build_tdls_ch_switch_req_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); -+ break; -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ rtw_build_tdls_ch_switch_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); -+ break; -+#endif -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ rtw_build_tdls_peer_traffic_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); -+ 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; -+ } -+ -+exit: -+ 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); -+ -+ set_frame_sub_type(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->cmn.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 /* WLAN Header */ -+ + pattrib->iv_len /* IV */ -+ + XATTRIB_GET_MCTRL_LEN(pattrib) -+ + SNAP_SIZE + sizeof(u16) /* LLC */ -+ + pattrib->pktlen -+ + (pattrib->encrypt == _TKIP_ ? 8 : 0) /* MIC */ -+ + (pattrib->bswenc ? pattrib->icv_len : 0) /* ICV */ -+ ; -+ -+ return len; -+} -+ -+#ifdef CONFIG_TX_AMSDU -+s32 check_amsdu(struct xmit_frame *pxmitframe) -+{ -+ struct pkt_attrib *pattrib; -+ struct sta_info *psta = NULL; -+ s32 ret = _TRUE; -+ -+ if (!pxmitframe) -+ ret = _FALSE; -+ -+ pattrib = &pxmitframe->attrib; -+ -+ psta = rtw_get_stainfo(&pxmitframe->padapter->stapriv, &pattrib->ra[0]); -+ if (psta) { -+ if (psta->flags & WLAN_STA_AMSDU_DISABLE) -+ ret =_FALSE; -+ } -+ if (IS_MCAST(pattrib->ra)) -+ ret = _FALSE; -+ -+ if ((pattrib->ether_type == 0x888e) || -+ (pattrib->ether_type == 0x0806) || -+ (pattrib->ether_type == 0x88b4) || -+ (pattrib->dhcp_pkt == 1)) -+ ret = _FALSE; -+ -+ if ((pattrib->encrypt == _WEP40_) || -+ (pattrib->encrypt == _WEP104_) || -+ (pattrib->encrypt == _TKIP_)) -+ ret = _FALSE; -+ -+ if (!pattrib->qos_en) -+ ret = _FALSE; -+ -+ if (IS_AMSDU_AMPDU_NOT_VALID(pattrib)) -+ ret = _FALSE; -+ -+ return ret; -+} -+ -+s32 check_amsdu_tx_support(_adapter *padapter) -+{ -+ struct dvobj_priv *pdvobjpriv; -+ int tx_amsdu; -+ int tx_amsdu_rate; -+ int current_tx_rate; -+ s32 ret = _FALSE; -+ -+ pdvobjpriv = adapter_to_dvobj(padapter); -+ tx_amsdu = padapter->tx_amsdu; -+ tx_amsdu_rate = padapter->tx_amsdu_rate; -+ current_tx_rate = pdvobjpriv->traffic_stat.cur_tx_tp; -+ -+ if (tx_amsdu == 1) -+ ret = _TRUE; -+ else if (tx_amsdu == 2 && (tx_amsdu_rate == 0 || current_tx_rate > tx_amsdu_rate)) -+ ret = _TRUE; -+ else -+ ret = _FALSE; -+ -+ return ret; -+} -+ -+s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitframe, struct xmit_frame *pxmitframe_queue) -+{ -+ -+ struct pkt_file pktfile; -+ struct pkt_attrib *pattrib; -+ _pkt *pkt; -+ -+ struct pkt_file pktfile_queue; -+ struct pkt_attrib *pattrib_queue; -+ _pkt *pkt_queue; -+ -+ s32 llc_sz, mem_sz; -+ -+ s32 padding = 0; -+ -+ u8 *pframe, *mem_start; -+ u8 hw_hdr_offset; -+ -+ u16* len; -+ u8 *pbuf_start; -+ s32 res = _SUCCESS; -+ -+ 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; //for DMA -+ -+ pattrib = &pxmitframe->attrib; -+ -+ pattrib->amsdu = 1; -+ -+ 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; -+ } -+ -+ llc_sz = 0; -+ -+ pframe = mem_start; -+ -+ //SetMFrag(mem_start); -+ ClearMFrag(mem_start); -+ -+ pframe += pattrib->hdrlen; -+ -+ /* adding icv, if necessary... */ -+ if (pattrib->iv_len) { -+ _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); // queue or new? -+ -+ RTW_DBG("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; -+ } -+ -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len; -+ -+ if(pxmitframe_queue) -+ { -+ pattrib_queue = &pxmitframe_queue->attrib; -+ pkt_queue = pxmitframe_queue->pkt; -+ -+ _rtw_open_pktfile(pkt_queue, &pktfile_queue); -+ _rtw_pktfile_read(&pktfile_queue, NULL, pattrib_queue->pkt_hdrlen); -+ -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ /* mDA(6), mSA(6), len(2), mctrl */ -+ _rtw_memcpy(pframe, pattrib_queue->mda, ETH_ALEN); -+ pframe += ETH_ALEN; -+ _rtw_memcpy(pframe, pattrib_queue->msa, ETH_ALEN); -+ pframe += ETH_ALEN; -+ len = (u16*)pframe; -+ pframe += 2; -+ rtw_mesh_tx_build_mctrl(padapter, pattrib_queue, pframe); -+ pframe += XATTRIB_GET_MCTRL_LEN(pattrib_queue); -+ } else -+ #endif -+ { -+ /* 802.3 MAC Header DA(6) SA(6) Len(2)*/ -+ _rtw_memcpy(pframe, pattrib_queue->dst, ETH_ALEN); -+ pframe += ETH_ALEN; -+ _rtw_memcpy(pframe, pattrib_queue->src, ETH_ALEN); -+ pframe += ETH_ALEN; -+ len = (u16*)pframe; -+ pframe += 2; -+ } -+ -+ llc_sz = rtw_put_snap(pframe, pattrib_queue->ether_type); -+ pframe += llc_sz; -+ -+ mem_sz = _rtw_pktfile_read(&pktfile_queue, pframe, pattrib_queue->pktlen); -+ pframe += mem_sz; -+ -+ *len = htons(XATTRIB_GET_MCTRL_LEN(pattrib_queue) + llc_sz + mem_sz); -+ -+ //calc padding -+ padding = 4 - ((ETH_HLEN + XATTRIB_GET_MCTRL_LEN(pattrib_queue) + llc_sz + mem_sz) & (4-1)); -+ if(padding == 4) -+ padding = 0; -+ -+ //_rtw_memset(pframe,0xaa, padding); -+ pframe += padding; -+ -+ pattrib->last_txcmdsz += ETH_HLEN + XATTRIB_GET_MCTRL_LEN(pattrib_queue) + llc_sz + mem_sz + padding ; -+ } -+ -+ //2nd mpdu -+ -+ pkt = pxmitframe->pkt; -+ _rtw_open_pktfile(pkt, &pktfile); -+ _rtw_pktfile_read(&pktfile, NULL, pattrib->pkt_hdrlen); -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ /* mDA(6), mSA(6), len(2), mctrl */ -+ _rtw_memcpy(pframe, pattrib->mda, ETH_ALEN); -+ pframe += ETH_ALEN; -+ _rtw_memcpy(pframe, pattrib->msa, ETH_ALEN); -+ pframe += ETH_ALEN; -+ len = (u16*)pframe; -+ pframe += 2; -+ rtw_mesh_tx_build_mctrl(padapter, pattrib, pframe); -+ pframe += XATTRIB_GET_MCTRL_LEN(pattrib); -+ } else -+#endif -+ { -+ /* 802.3 MAC Header DA(6) SA(6) Len(2) */ -+ _rtw_memcpy(pframe, pattrib->dst, ETH_ALEN); -+ pframe += ETH_ALEN; -+ _rtw_memcpy(pframe, pattrib->src, ETH_ALEN); -+ pframe += ETH_ALEN; -+ len = (u16*)pframe; -+ pframe += 2; -+ } -+ -+ llc_sz = rtw_put_snap(pframe, pattrib->ether_type); -+ pframe += llc_sz; -+ -+ mem_sz = _rtw_pktfile_read(&pktfile, pframe, pattrib->pktlen); -+ -+ pframe += mem_sz; -+ -+ *len = htons(XATTRIB_GET_MCTRL_LEN(pattrib) + llc_sz + mem_sz); -+ -+ //the last ampdu has no padding -+ padding = 0; -+ -+ pattrib->nr_frags = 1; -+ -+ pattrib->last_txcmdsz += ETH_HLEN + XATTRIB_GET_MCTRL_LEN(pattrib) + llc_sz + mem_sz + padding + -+ ((pattrib->bswenc) ? pattrib->icv_len : 0) ; -+ -+ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { -+ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); -+ pframe += pattrib->icv_len; -+ } -+ -+ if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) { -+ RTW_INFO("xmitframe_addmic(padapter, pxmitframe)==_FAIL\n"); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ xmitframe_swencrypt(padapter, pxmitframe); -+ -+ update_attrib_vcs_info(padapter, pxmitframe); -+ -+exit: -+ return res; -+} -+#endif /* CONFIG_TX_AMSDU */ -+ -+/* -+ -+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 &WIFI_ASOC_STATE)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\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) { -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ rtw_mesh_tx_build_mctrl(padapter, pattrib, pframe); -+ pframe += XATTRIB_GET_MCTRL_LEN(pattrib); -+ mpdu_len -= XATTRIB_GET_MCTRL_LEN(pattrib); -+ } -+ #endif -+ -+ 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) ? (XATTRIB_GET_MCTRL_LEN(pattrib) + 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; -+} -+ -+#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) -+/* -+ * CCMP encryption for unicast robust mgmt frame and broadcast group privicy action -+ * BIP for broadcast robust mgmt frame -+ */ -+s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) -+{ -+#define DBG_MGMT_XMIT_COALESEC_DUMP 0 -+#define DBG_MGMT_XMIT_BIP_DUMP 0 -+#define DBG_MGMT_XMIT_ENC_DUMP 0 -+ -+ 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 ; -+ u8 category = 0xFF; -+ 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_cont[_MME_IE_LENGTH_ - 2]; -+ u8 mme_clen; -+ -+ _irqL irqL; -+ u32 ori_len; -+ union pn48 *pn = NULL; -+ enum security_type cipher = _NO_PRIVACY_; -+ u8 kid; -+ -+ if (pxmitframe->buf_addr == NULL) { -+ RTW_WARN(FUNC_ADPT_FMT" pxmitframe->buf_addr\n" -+ , FUNC_ADPT_ARG(padapter)); -+ return _FAIL; -+ } -+ -+ mem_start = pframe = (u8 *)(pxmitframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ subtype = get_frame_sub_type(pframe); /* bit(7)~bit(2) */ -+ -+ /* check if robust mgmt frame */ -+ if (subtype != WIFI_DEAUTH && subtype != WIFI_DISASSOC && subtype != WIFI_ACTION) -+ return _SUCCESS; -+ if (subtype == WIFI_ACTION) { -+ category = *(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ if (CATEGORY_IS_NON_ROBUST(category)) -+ return _SUCCESS; -+ } -+ if (!bmcst) { -+ if (pattrib->psta) -+ psta = pattrib->psta; -+ else -+ pattrib->psta = psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if (psta == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT" unicast sta == NULL\n", FUNC_ADPT_ARG(padapter)); -+ return _FAIL; -+ } -+ if (!(psta->flags & WLAN_STA_MFP)) { -+ /* peer is not MFP capable, no need to encrypt */ -+ return _SUCCESS; -+ } -+ if (psta->bpairwise_key_installed != _TRUE) { -+ RTW_INFO(FUNC_ADPT_FMT" PTK is not installed\n" -+ , FUNC_ADPT_ARG(padapter)); -+ return _FAIL; -+ } -+ } -+ -+ ori_len = BIP_AAD_SIZE + pattrib->pktlen + _MME_IE_LENGTH_; -+ tmp_buf = BIP_AAD = rtw_zmalloc(ori_len); -+ if (BIP_AAD == NULL) -+ return _FAIL; -+ -+ _enter_critical_bh(&padapter->security_key_mutex, &irqL); -+ -+ if (bmcst) { -+ if (subtype == WIFI_ACTION && CATEGORY_IS_GROUP_PRIVACY(category)) { -+ /* broadcast group privacy action frame */ -+ #if DBG_MGMT_XMIT_COALESEC_DUMP -+ RTW_INFO(FUNC_ADPT_FMT" broadcast gp action(%u)\n" -+ , FUNC_ADPT_ARG(padapter), category); -+ #endif -+ -+ if (pattrib->psta) -+ psta = pattrib->psta; -+ else -+ pattrib->psta = psta = rtw_get_bcmc_stainfo(padapter); -+ if (psta == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT" broadcast sta == NULL\n" -+ , FUNC_ADPT_ARG(padapter)); -+ goto xmitframe_coalesce_fail; -+ } -+ if (padapter->securitypriv.binstallGrpkey != _TRUE) { -+ RTW_INFO(FUNC_ADPT_FMT" GTK is not installed\n" -+ , FUNC_ADPT_ARG(padapter)); -+ goto xmitframe_coalesce_fail; -+ } -+ -+ pn = &psta->dot11txpn; -+ cipher = padapter->securitypriv.dot118021XGrpPrivacy; -+ kid = padapter->securitypriv.dot118021XGrpKeyid; -+ } else { -+ #ifdef CONFIG_IEEE80211W -+ /* broadcast robust mgmt frame, using BIP */ -+ int frame_body_len; -+ u8 mic[16]; -+ -+ /* IGTK key is not install ex: mesh MFP without IGTK */ -+ if (SEC_IS_BIP_KEY_INSTALLED(&padapter->securitypriv) != _TRUE) -+ goto xmitframe_coalesce_success; -+ -+ #if DBG_MGMT_XMIT_COALESEC_DUMP -+ if (subtype == WIFI_DEAUTH) -+ RTW_INFO(FUNC_ADPT_FMT" braodcast deauth\n", FUNC_ADPT_ARG(padapter)); -+ else if (subtype == WIFI_DISASSOC) -+ RTW_INFO(FUNC_ADPT_FMT" braodcast disassoc\n", FUNC_ADPT_ARG(padapter)); -+ else if (subtype == WIFI_ACTION) { -+ RTW_INFO(FUNC_ADPT_FMT" braodcast action(%u)\n" -+ , FUNC_ADPT_ARG(padapter), category); -+ } -+ #endif -+ -+ _rtw_memset(mme_cont, 0, _MME_IE_LENGTH_ - 2); -+ mme_clen = padapter->securitypriv.dot11wCipher == _BIP_CMAC_128_ ? 16 : 24; -+ -+ 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_cont[0] = padapter->securitypriv.dot11wBIPKeyid; -+ /* increase PN and apply to packet */ -+ padapter->securitypriv.dot11wBIPtxpn.val++; -+ RTW_PUT_LE64(&mme_cont[2], padapter->securitypriv.dot11wBIPtxpn.val); -+ -+ /* add MME IE with MIC all zero, MME string doesn't include element id and length */ -+ pframe = rtw_set_ie(pframe, _MME_IE_ , mme_clen , mme_cont, &(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, GetAddr1Ptr((u8 *)pwlanhdr), 18); -+ /* copy management fram body */ -+ _rtw_memcpy(BIP_AAD + BIP_AAD_SIZE, MGMT_body, frame_body_len); -+ -+ #if DBG_MGMT_XMIT_BIP_DUMP -+ /* 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 (rtw_calculate_bip_mic(padapter->securitypriv.dot11wCipher, -+ (u8 *)pwlanhdr, pattrib->pktlen, -+ padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey, -+ BIP_AAD, (BIP_AAD_SIZE + frame_body_len), mic) == _FAIL) -+ goto xmitframe_coalesce_fail; -+ -+ #if DBG_MGMT_XMIT_BIP_DUMP -+ /* 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 */ -+ if (padapter->securitypriv.dot11wCipher == _BIP_CMAC_128_) -+ _rtw_memcpy(pframe - 8, mic, 8); -+ else -+ _rtw_memcpy(pframe - 16, mic, 16); -+ -+ #if DBG_MGMT_XMIT_BIP_DUMP -+ /*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"); -+ } -+ #endif -+ -+ #endif /* CONFIG_IEEE80211W */ -+ -+ goto xmitframe_coalesce_success; -+ } -+ } -+ else { -+ /* unicast robust mgmt frame */ -+ #if DBG_MGMT_XMIT_COALESEC_DUMP -+ if (subtype == WIFI_DEAUTH) { -+ RTW_INFO(FUNC_ADPT_FMT" unicast deauth to "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(pattrib->ra)); -+ } else if (subtype == WIFI_DISASSOC) { -+ RTW_INFO(FUNC_ADPT_FMT" unicast disassoc to "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(pattrib->ra)); -+ } else if (subtype == WIFI_ACTION) { -+ RTW_INFO(FUNC_ADPT_FMT" unicast action(%u) to "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(padapter), category, MAC_ARG(pattrib->ra)); -+ } -+ #endif -+ -+ pn = &psta->dot11txpn; -+ cipher = psta->dot118021XPrivacy; -+ kid = 0; -+ -+ _rtw_memcpy(pattrib->dot118021x_UncstKey.skey -+ , psta->dot118021x_UncstKey.skey -+ , (cipher & _SEC_TYPE_256_) ? 32 : 16); -+ -+ /* To use wrong key */ -+ if (pattrib->key_type == IEEE80211W_WRONG_KEY) { -+ RTW_INFO("use wrong key\n"); -+ pattrib->dot118021x_UncstKey.skey[0] = 0xff; -+ } -+ } -+ -+ #if DBG_MGMT_XMIT_ENC_DUMP -+ /* before encrypt dump the management packet content */ -+ { -+ int i; -+ printk("Management pkt: "); -+ for(i=0; ipktlen; i++) -+ printk(" %02x ", pframe[i]); -+ printk("=======\n"); -+ } -+ #endif -+ -+ /* bakeup original management packet */ -+ _rtw_memcpy(tmp_buf, pframe, pattrib->pktlen); -+ /* move to data portion */ -+ pframe += pattrib->hdrlen; -+ -+ if (pattrib->key_type != IEEE80211W_NO_KEY) { -+ pattrib->encrypt = cipher; -+ pattrib->bswenc = _TRUE; -+ } -+ -+ /* -+ * 802.11w encrypted management packet must be: -+ * _AES_, _CCMP_256_, _GCMP_, _GCMP_256_ -+ */ -+ switch (pattrib->encrypt) { -+ case _AES_: -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 8; -+ AES_IV(pattrib->iv, (*pn), kid); -+ break; -+ case _CCMP_256_: -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 16; -+ AES_IV(pattrib->iv, (*pn), kid); -+ break; -+ case _GCMP_: -+ case _GCMP_256_: -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 16; -+ GCMP_IV(pattrib->iv, (*pn), kid); -+ 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 DBG_MGMT_XMIT_ENC_DUMP -+ /* 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 DBG_MGMT_XMIT_ENC_DUMP -+ /* 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 /* defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) */ -+ -+/* 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; -+ #if defined(CONFIG_CHECK_LEAVE_LPS) && defined(CONFIG_LPS_CHK_BY_TP) -+ if (adapter_to_pwrctl(padapter)->lps_chk_by_tp) -+ traffic_check_for_leave_lps_by_tp(padapter, _TRUE, psta); -+ #endif /* CONFIG_LPS */ -+ } -+ -+#ifdef CONFIG_CHECK_LEAVE_LPS -+ /* traffic_check_for_leave_lps(padapter, _TRUE); */ -+#endif /* CONFIG_CHECK_LEAVE_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__); -+ -+ 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, 0); -+ 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, MAX_CMDBUF_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, u16 os_qid) -+{ -+ /* -+ 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--; -+ pxframe->os_qid = os_qid; -+ } -+ -+ _exit_critical_bh(&pfree_xmit_queue->lock, &irqL); -+ -+ if (pxframe) -+ rtw_os_check_stop_queue(pxmitpriv->adapter, os_qid); -+ -+ 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); -+ -+ if (queue == &pxmitpriv->free_xmit_queue) -+ rtw_os_check_wakup_queue(padapter, pxmitframe->os_qid); -+ -+check_pkt_complete: -+ -+ if (pndis_pkt) -+ rtw_os_pkt_complete(padapter, pndis_pkt); -+ -+exit: -+ -+ -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+void rtw_free_mgmt_xmitframe_queue(struct xmit_priv *pxmitpriv, _queue *mgmt_queue) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct xmit_frame *pxmitframe; -+ -+ _enter_critical_bh(&(mgmt_queue->lock), &irqL); -+ -+ phead = get_list_head(mgmt_queue); -+ 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); -+ -+ #ifdef DBG_MGMT_QUEUE -+ RTW_INFO("%s seq_num = %u\n", __func__, pxmitframe->attrib.seqnum); -+ #endif -+ -+ rtw_free_xmitbuf_ext(pxmitpriv, pxmitframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ } -+ _exit_critical_bh(&(mgmt_queue->lock), &irqL); -+} -+ -+u8 rtw_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ struct sta_info *psta; -+ struct tx_servq *ptxservq; -+ struct pkt_attrib *pattrib = &(pxmitframe->attrib); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct hw_xmit *phwxmits = pxmitpriv->hwxmits; -+ u8 mgmt_idx = pxmitpriv->hwxmit_entry - 1; -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class); -+ -+ 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); -+ RTW_INFO("rtw_xmit_classifier: psta == NULL\n"); -+ return _FAIL; -+ } -+ -+ if (!(psta->state & WIFI_ASOC_STATE)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_fwlink); -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\n", __func__, psta->state); -+ return _FAIL; -+ } -+ -+ ptxservq = &(psta->sta_xmitpriv.mgmt_q); -+ -+ if (rtw_is_list_empty(&ptxservq->tx_pending)) -+ rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(phwxmits[mgmt_idx].sta_queue)); -+ -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&ptxservq->sta_pending)); -+ ptxservq->qcnt++; -+ phwxmits[mgmt_idx].accnt++; -+ -+ return _SUCCESS; -+} -+#endif -+ -+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; -+} -+ -+static struct xmit_frame *get_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); -+ break; -+ } -+ -+ return pxmitframe; -+} -+ -+struct xmit_frame *rtw_get_xframe(struct xmit_priv *pxmitpriv, int *num_frame) -+{ -+ _irqL irqL0; -+ _list *sta_plist, *sta_phead; -+ struct hw_xmit *phwxmit_i = pxmitpriv->hwxmits; -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ /* This function gets xmit_frame from AC queue. */ -+ /* When mgmt queue is used, AC queue index is (hwxmit_entry - 1) */ -+ sint entry = pxmitpriv->hwxmit_entry - 1; -+#else -+ sint entry = pxmitpriv->hwxmit_entry; -+#endif -+ 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]; -+ -+ inx[0] = 0; -+ inx[1] = 1; -+ inx[2] = 2; -+ inx[3] = 3; -+ -+ *num_frame = 0; -+ -+ /*No amsdu when wifi_spec on*/ -+ if (pregpriv->wifi_spec == 1) { -+ return NULL; -+ } -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ for (i = 0; i < entry; i++) { -+ phwxmit = phwxmit_i + inx[i]; -+ -+ 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; -+ -+ if(ptxservq->qcnt) -+ { -+ *num_frame = ptxservq->qcnt; -+ pxmitframe = get_one_xmitframe(pxmitpriv, phwxmit, ptxservq, pframe_queue); -+ goto exit; -+ } -+ sta_plist = get_next(sta_plist); -+ } -+ } -+ -+exit: -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ return pxmitframe; -+} -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+struct xmit_frame *rtw_dequeue_mgmt_xframe(struct xmit_priv *pxmitpriv) -+{ -+ _irqL irqL0; -+ _list *sta_plist, *sta_phead; -+ struct hw_xmit *mgmt_hwxmit; -+ struct tx_servq *ptxservq = NULL; -+ _queue *pframe_queue = NULL; -+ struct xmit_frame *pxmitframe = NULL; -+ u8 mgmt_entry = pxmitpriv->hwxmit_entry - 1; -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ /* management queue */ -+ mgmt_hwxmit = (pxmitpriv->hwxmits) + mgmt_entry; -+ -+ sta_phead = get_list_head(mgmt_hwxmit->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, mgmt_hwxmit, ptxservq, pframe_queue); -+ -+ #ifdef DBG_MGMT_QUEUE -+ RTW_INFO("%s dequeue mgmt frame (seq_num = %u) to TX\n", __func__, pxmitframe->attrib.seqnum); -+ #endif -+ -+ if (pxmitframe) { -+ mgmt_hwxmit->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); -+ -+ goto exit; -+ } -+ sta_plist = get_next(sta_plist); -+ } -+exit: -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ return pxmitframe; -+} -+#endif -+ -+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_RTW_MGMT_QUEUE -+ /* This function gets xmit_frame from AC queue. */ -+ /* When mgmt queue is used, AC queue index is (hwxmit_entry - 1) */ -+ entry--; -+#endif -+ inx[0] = 0; -+ inx[1] = 1; -+ inx[2] = 2; -+ inx[3] = 3; -+ -+ if (pregpriv->wifi_spec == 1) { -+ int j; -+#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; -+} -+ -+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; -+} -+ -+/* -+ * 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 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 & WIFI_ASOC_STATE)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_fwlink); -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\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; -+ -+ rtw_warn_on(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; -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ hwxmits[4].sta_queue = &pxmitpriv->mgmt_pending; -+#endif -+ -+} -+ -+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; -+ _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_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 */ -+ pattrib->priority = QSLT_VO; -+ } else { -+ pattrib->qsel = QSLT_BE; /* STA interface BE queue */ -+ pattrib->priority = QSLT_BE; -+ } -+ } 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 */ -+ -+ /* high priority packet */ -+ if (pattrib->hipriority_pkt) { -+ pattrib->qsel = QSLT_VO; -+ pattrib->priority = QSLT_VO; -+ } -+} -+ -+/* -+ * 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) -+{ -+ u16 frame_ctl; -+ struct ieee80211_radiotap_header rtap_hdr; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct pkt_file pktfile; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct pkt_attrib *pattrib; -+ struct xmit_frame *pmgntframe; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ unsigned char *pframe; -+ u8 dummybuf[32]; -+ int len = skb->len, rtap_len; -+ -+ -+ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); -+ -+#ifndef CONFIG_CUSTOMER_ALIBABA_GENERAL -+ if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) -+ goto fail; -+ -+ _rtw_open_pktfile((_pkt *)skb, &pktfile); -+ _rtw_pktfile_read(&pktfile, (u8 *)(&rtap_hdr), sizeof(struct ieee80211_radiotap_header)); -+ rtap_len = ieee80211_get_radiotap_len((u8 *)(&rtap_hdr)); -+ if (unlikely(rtap_hdr.it_version)) -+ goto fail; -+ -+ 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; -+ } -+ _rtw_pktfile_read(&pktfile, dummybuf, rtap_len-sizeof(struct ieee80211_radiotap_header)); -+ len = len - rtap_len; -+#endif -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ rtw_udelay_os(500); -+ goto fail; -+ } -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+// _rtw_memcpy(pframe, (void *)checking, len); -+ _rtw_pktfile_read(&pktfile, pframe, len); -+ -+ -+ /* Check DATA/MGNT frames */ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ frame_ctl = le16_to_cpu(pwlanhdr->frame_ctl); -+ if ((frame_ctl & RTW_IEEE80211_FCTL_FTYPE) == RTW_IEEE80211_FTYPE_DATA) { -+ -+ pattrib = &pmgntframe->attrib; -+ update_monitor_frame_attrib(padapter, pattrib); -+ -+ if (is_broadcast_mac_addr(pwlanhdr->addr3) || is_broadcast_mac_addr(pwlanhdr->addr1)) -+ pattrib->rate = MGN_24M; -+ -+ } else { -+ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ } -+ pattrib->retry_ctrl = _FALSE; -+ pattrib->pktlen = len; -+ 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 -+ -+/* -+ * -+ * Return _TRUE when frame has been put to queue, otherwise return _FALSE. -+ */ -+static u8 xmit_enqueue(struct _ADAPTER *a, struct xmit_frame *frame) -+{ -+ struct sta_info *sta = NULL; -+ struct pkt_attrib *attrib = NULL; -+ _irqL irqL; -+ _list *head; -+ u8 ret = _TRUE; -+ -+ -+ attrib = &frame->attrib; -+ sta = attrib->psta; -+ if (!sta) -+ return _FALSE; -+ -+ _enter_critical_bh(&sta->tx_queue.lock, &irqL); -+ -+ head = get_list_head(&sta->tx_queue); -+ -+ if ((rtw_is_list_empty(head) == _TRUE) && (!sta->tx_q_enable)) { -+ ret = _FALSE; -+ goto exit; -+ } -+ -+ rtw_list_insert_tail(&frame->list, head); -+ RTW_INFO(FUNC_ADPT_FMT ": en-queue tx pkt for macid=%d\n", -+ FUNC_ADPT_ARG(a), sta->cmn.mac_id); -+ -+exit: -+ _exit_critical_bh(&sta->tx_queue.lock, &irqL); -+ -+ return ret; -+} -+ -+static void xmit_dequeue(struct sta_info *sta) -+{ -+ struct _ADAPTER *a; -+ _irqL irqL; -+ _list *head, *list; -+ struct xmit_frame *frame; -+ -+ -+ a = sta->padapter; -+ -+ _enter_critical_bh(&sta->tx_queue.lock, &irqL); -+ -+ head = get_list_head(&sta->tx_queue); -+ -+ do { -+ if (rtw_is_list_empty(head) == _TRUE) -+ break; -+ -+ list = get_next(head); -+ rtw_list_delete(list); -+ frame = LIST_CONTAINOR(list, struct xmit_frame, list); -+ RTW_INFO(FUNC_ADPT_FMT ": de-queue tx frame of macid=%d\n", -+ FUNC_ADPT_ARG(a), sta->cmn.mac_id); -+ -+ rtw_hal_xmit(a, frame); -+ } while (1); -+ -+ _exit_critical_bh(&sta->tx_queue.lock, &irqL); -+} -+ -+void rtw_xmit_dequeue_callback(_workitem *work) -+{ -+ struct sta_info *sta; -+ -+ -+ sta = container_of(work, struct sta_info, tx_q_work); -+ xmit_dequeue(sta); -+} -+ -+void rtw_xmit_queue_set(struct sta_info *sta) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&sta->tx_queue.lock, &irqL); -+ -+ if (sta->tx_q_enable) { -+ RTW_WARN(FUNC_ADPT_FMT ": duplicated set!\n", -+ FUNC_ADPT_ARG(sta->padapter)); -+ goto exit; -+ } -+ sta->tx_q_enable = 1; -+ RTW_INFO(FUNC_ADPT_FMT ": enable queue TX for macid=%d\n", -+ FUNC_ADPT_ARG(sta->padapter), sta->cmn.mac_id); -+ -+exit: -+ _exit_critical_bh(&sta->tx_queue.lock, &irqL); -+} -+ -+void rtw_xmit_queue_clear(struct sta_info *sta) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&sta->tx_queue.lock, &irqL); -+ -+ if (!sta->tx_q_enable) { -+ RTW_WARN(FUNC_ADPT_FMT ": tx queue for macid=%d " -+ "not be enabled!\n", -+ FUNC_ADPT_ARG(sta->padapter), sta->cmn.mac_id); -+ goto exit; -+ } -+ -+ sta->tx_q_enable = 0; -+ RTW_INFO(FUNC_ADPT_FMT ": disable queue TX for macid=%d\n", -+ FUNC_ADPT_ARG(sta->padapter), sta->cmn.mac_id); -+ -+ _set_workitem(&sta->tx_q_work); -+ -+exit: -+ _exit_critical_bh(&sta->tx_queue.lock, &irqL); -+} -+ -+/* -+ * The main transmit(tx) entry post handle -+ * -+ * Return -+ * 1 enqueue -+ * 0 success, hardware will handle this xmit frame(packet) -+ * <0 fail -+ */ -+s32 rtw_xmit_posthandle(_adapter *padapter, struct xmit_frame *pxmitframe, _pkt *pkt) -+{ -+#ifdef CONFIG_AP_MODE -+ _irqL irqL0; -+#endif -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ s32 res; -+ -+ res = update_attrib(padapter, pkt, &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 = pkt; -+ -+ rtw_led_tx_control(padapter, pxmitframe->attrib.dst); -+ -+ 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 -+ -+ if (xmit_enqueue(padapter, pxmitframe) == _TRUE) -+ return 1; -+ -+ /* pre_xmitframe */ -+ if (rtw_hal_xmit(padapter, pxmitframe) == _FALSE) -+ return 1; -+ -+ return 0; -+} -+ -+/* -+ * 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, u16 os_qid) -+{ -+ static systime start = 0; -+ static u32 drop_cnt = 0; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_frame *pxmitframe = NULL; -+ s32 res; -+#ifdef CONFIG_LAYER2_ROAMING -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sk_buff *skb = (struct sk_buff *)(*ppkt); -+ _irqL irqL; -+#endif -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx); -+ -+ if (IS_CH_WAITING(adapter_to_rfctl(padapter))) -+ return -1; -+ -+ if ((rtw_linked_check(padapter) == _FALSE) -+#ifdef CONFIG_LAYER2_ROAMING -+ &&(!padapter->mlmepriv.roam_network) -+#endif -+ ) -+ return -1; -+ -+ if (start == 0) -+ start = rtw_get_current_time(); -+ -+ pxmitframe = rtw_alloc_xmitframe(pxmitpriv, os_qid); -+ -+ 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 (!adapter_use_wds(padapter) && check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE) { -+ void *br_port = NULL; -+ -+ #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ br_port = padapter->pnetdev->br_port; -+ #else -+ rcu_read_lock(); -+ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); -+ rcu_read_unlock(); -+ #endif -+ -+ if (br_port) { -+ 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 */ -+#ifdef CONFIG_LAYER2_ROAMING -+ if ((pmlmepriv->roam_network) && (skb->protocol != htons(0x888e))) { /* eapol never enqueue.*/ -+ pxmitframe->pkt = *ppkt; -+ rtw_list_delete(&pxmitframe->list); -+ _enter_critical_bh(&pxmitpriv->rpkt_queue.lock, &irqL); -+ rtw_list_insert_tail(&(pxmitframe->list), get_list_head(&(pxmitpriv->rpkt_queue))); -+ _exit_critical_bh(&pxmitpriv->rpkt_queue.lock, &irqL); -+ return 1; -+ } -+#endif -+ -+#if defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) -+ if (MLME_STATE(padapter) & (WIFI_AP_STATE | WIFI_MESH_STATE)) { -+ _list f_list; -+ -+ #ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) -+ res = rtw_mesh_addr_resolve(padapter, os_qid, pxmitframe, *ppkt, &f_list); -+ else -+ #endif -+ res = rtw_ap_addr_resolve(padapter, os_qid, pxmitframe, *ppkt, &f_list); -+ if (res == RTW_RA_RESOLVING) -+ return 1; -+ if (res == _FAIL) -+ return -1; -+ -+ #if defined(CONFIG_RTW_WDS) || CONFIG_RTW_DATA_BMC_TO_UC -+ if (!rtw_is_list_empty(&f_list)) { -+ _list *list = get_next(&f_list); -+ struct xmit_frame *fframe; -+ -+ while ((rtw_end_of_queue_search(&f_list, list)) == _FALSE) { -+ fframe = LIST_CONTAINOR(list, struct xmit_frame, list); -+ list = get_next(list); -+ rtw_list_delete(&fframe->list); -+ -+ if (res == RTW_ORI_NO_NEED && rtw_is_list_empty(&f_list)) { -+ fframe->pkt = pxmitframe->pkt; /* last frame */ -+ pxmitframe->pkt = NULL; -+ } else { -+ fframe->pkt = rtw_os_pkt_copy(*ppkt); -+ } -+ -+ if (!fframe->pkt) { -+ if (res == RTW_ORI_NO_NEED && IS_MCAST(pxmitframe->attrib.dst)) -+ res = _SUCCESS; -+ rtw_free_xmitframe(pxmitpriv, fframe); -+ continue; -+ } -+ -+ rtw_xmit_posthandle(padapter, fframe, fframe->pkt); -+ } -+ } -+ #endif -+ -+ if (res == RTW_ORI_NO_NEED) { -+ rtw_free_xmitframe(&padapter->xmitpriv, pxmitframe); -+ return 0; -+ } -+ } -+#endif /* defined(CONFIG_AP_MODE) || defined(CONFIG_RTW_MESH) */ -+ -+ pxmitframe->pkt = NULL; /* let rtw_xmit_posthandle not to free pkt inside */ -+ res = rtw_xmit_posthandle(padapter, pxmitframe, *ppkt); -+ -+ return res; -+} -+ -+#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->cmn.mac_addr, 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 (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) -+ allow = _FALSE; -+ else -+ rtw_warn_on(1); -+ -+ return allow; -+} -+ -+#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) -+#ifdef CONFIG_RTW_MGMT_QUEUE -+u8 mgmt_xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ _irqL irqL; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *psta = pattrib->psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ bool update_tim = _FALSE; -+ u8 ret = _TRUE; -+ -+ if (is_broadcast_mac_addr(pattrib->ra) || pattrib->ps_dontq) -+ return _FALSE; -+ -+ if (psta == NULL) { -+ RTW_INFO("%s, psta==NUL don't need enqueue, pattrib->ra:"MAC_FMT"\n", -+ __func__, MAC_ARG(pattrib->ra)); -+ return _FALSE; -+ } -+ -+ if (!(psta->state & WIFI_ASOC_STATE)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_link); -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\n", __func__, psta->state); -+ return _FALSE; -+ } -+ -+ _enter_critical_bh(&psta->mgmt_sleep_q.lock, &irqL); -+ -+ if (psta->state & WIFI_SLEEP_STATE && -+ rtw_tim_map_is_set(padapter, pstapriv->sta_dz_bitmap, psta->cmn.aid)) { -+ -+ rtw_list_delete(&pxmitframe->list); -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&psta->mgmt_sleep_q)); -+ psta->mgmt_sleepq_len++; -+ -+ #ifdef DBG_MGMT_QUEUE -+ RTW_INFO("%s attrib->ra:"MAC_FMT" seq_num = %u, subtype = 0x%x\n", -+ __func__, MAC_ARG(pattrib->ra), pattrib->seqnum, pattrib->subtype); -+ #endif -+ -+ if (!(rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid))) -+ update_tim = _TRUE; -+ -+ rtw_tim_map_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid); -+ -+ /* upate BCN for TIM IE */ -+ if (update_tim == _TRUE) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0, "buffer mgmt frame"); -+ -+ ret = RTW_QUEUE_MGMT; -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_ucast); -+ } -+ -+ _exit_critical_bh(&psta->mgmt_sleep_q.lock, &irqL); -+ -+ return ret; -+} -+ -+static void dequeue_mgmt_xmitframe_to_sleepq(_adapter *padapter, struct sta_info *psta, _queue *pframequeue) -+{ -+ sint ret; -+ _list *plist, *phead; -+ struct tx_servq *ptxservq; -+ struct pkt_attrib *pattrib; -+ struct xmit_frame *pxmitframe; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct hw_xmit *phwxmits = pxmitpriv->hwxmits; -+ u8 mgmt_idx = pxmitpriv->hwxmit_entry - 1; -+ -+ 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 = mgmt_xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe); -+ -+ if (ret == RTW_QUEUE_MGMT) { -+ ptxservq = &(psta->sta_xmitpriv.mgmt_q); -+ ptxservq->qcnt--; -+ phwxmits[mgmt_idx].accnt--; -+ } else { -+ /* RTW_INFO("xmitframe_enqueue_for_sleeping_sta return _FALSE\n"); */ -+ } -+ } -+} -+#endif -+ -+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; -+ 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 (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) { -+ 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 & WIFI_ASOC_STATE)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_link); -+ RTW_INFO("%s, psta->state(0x%x) != WIFI_ASOC_STATE\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 (rtw_tim_map_anyone_be_set(padapter, 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 (!(rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0))) -+ update_tim = _TRUE; -+ -+ rtw_tim_map_set(padapter, pstapriv->tim_bitmap, 0); -+ rtw_tim_map_set(padapter, pstapriv->sta_dz_bitmap, 0); -+ -+ /* RTW_INFO("enqueue, sq_len=%d\n", psta->sleepq_len); */ -+ /* RTW_INFO_DUMP("enqueue, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ -+ if (update_tim == _TRUE) { -+ if (is_broadcast_mac_addr(pattrib->ra)) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0, "buffer BC"); -+ else -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0, "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 (rtw_tim_map_is_set(padapter, pstapriv->sta_dz_bitmap, psta->cmn.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 (!(rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid))) -+ update_tim = _TRUE; -+ -+ rtw_tim_map_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid); -+ -+ /* RTW_INFO("enqueue, sq_len=%d\n", psta->sleepq_len); */ -+ /* RTW_INFO_DUMP("enqueue, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ -+ -+ if (update_tim == _TRUE) { -+ /* RTW_INFO("sleepq_len==1, update BCNTIM\n"); */ -+ /* upate BCN for TIM IE */ -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0, "buffer UC"); -+ } -+ } -+ -+ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ -+ /* if(psta->sleepq_len > (NR_XMITFRAME>>3)) */ -+ /* { */ -+ /* wakeup_sta_to_xmit(padapter, psta, ALL_FRAME); */ -+ /* } */ -+ -+ 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); -+ if (!psta_bmc) -+ rtw_warn_on(1); -+ -+ _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 */ -+ rtw_tim_map_set(padapter, pstapriv->sta_dz_bitmap, psta->cmn.aid); -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ dequeue_mgmt_xmitframe_to_sleepq(padapter, psta, &pstaxmitpriv->mgmt_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->mgmt_q.tx_pending)); -+#endif -+ -+ 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)); -+ -+ if (psta_bmc != NULL -+ #ifdef CONFIG_TDLS -+ && !(psta->tdls_sta_state & TDLS_LINKED_STATE) -+ #endif -+ ) -+ { -+ /* for BC/MC Frames */ -+ pstaxmitpriv = &psta_bmc->sta_xmitpriv; -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->vo_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->vi_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending)); -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->be_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->bk_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); -+ } -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ -+} -+ -+/** -+ * dequeue_type: decide which type of frame be dequeued -+ * UNI_BMC_DATA: unicast and broadcast/multicast data frame -+ * UNI_MGMT: unicast management frame -+ * ALL_FRAME: all frames -+ */ -+void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta, u8 dequeue_type) -+{ -+ _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; -+ -+ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ if (dequeue_type == UNI_MGMT || dequeue_type == ALL_FRAME) { -+ /* management queue */ -+ xmitframe_phead = get_list_head(&psta->mgmt_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); -+ -+ #ifdef DBG_MGMT_QUEUE -+ RTW_INFO("%s seq_num = %u, subtype = 0x%x\n", -+ __func__, pxmitframe->attrib.seqnum, pxmitframe->attrib.subtype); -+ #endif -+ -+ psta->mgmt_sleepq_len--; -+ -+ if (psta->mgmt_sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered = 1; -+ -+ rtw_hal_mgmt_xmitframe_enqueue(padapter, pxmitframe); -+ } -+ } -+#endif /* CONFIG_RTW_MGMT_QUEUE */ -+ -+ if (dequeue_type == UNI_BMC_DATA || dequeue_type == ALL_FRAME) { -+ /* AC queue */ -+ 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_RTW_MGMT_QUEUE -+ && psta->mgmt_sleepq_len == 0 -+#endif -+ ) { -+#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 (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid)) { -+ /* RTW_INFO("wakeup to xmit, qlen==0\n"); */ -+ /* RTW_INFO_DUMP("update_BCNTIM, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_mask = BIT(0); -+ } -+ -+ rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, psta->cmn.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; -+ } -+ -+ rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, psta->cmn.aid); -+ } -+ -+ if (dequeue_type == UNI_BMC_DATA || dequeue_type == ALL_FRAME) { -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ -+ /* for BC/MC Frames */ -+ if (!psta_bmc) -+ goto _exit; -+ -+ if (!(rtw_tim_map_anyone_be_set_exclude_aid0(padapter, pstapriv->sta_dz_bitmap))) { /* 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 (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0)) { -+ /* RTW_INFO("wakeup to xmit, qlen==0\n"); */ -+ /* RTW_INFO_DUMP("update_BCNTIM, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_mask |= BIT(1); -+ } -+ rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, 0); -+ rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, 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, 0, "clear UC&BMC"); -+ else if ((update_mask & BIT(1)) == BIT(1)) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0, "clear BMC"); -+ else -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0, "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 */ -+ rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, psta->cmn.aid); -+ -+ /* RTW_INFO("wakeup to xmit, qlen==0\n"); */ -+ /* RTW_INFO_DUMP("update_BCNTIM, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE, 0); -+ /* update_mask = BIT(0); */ -+ } -+ -+ } -+ -+#ifdef CONFIG_TDLS -+exit: -+#endif -+ /* _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_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; -+ -+ 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 (_TRUE == rtw_is_xmit_blocked(padapter)) -+ return pxmitbuf; -+ -+ pxmitbuf = dequeue_pending_xmitbuf_ext(pxmitpriv); -+ if (pxmitbuf == NULL && rtw_xmit_ac_blocked(padapter) != _TRUE) -+ 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; -+#ifdef RTW_XMIT_THREAD_HIGH_PRIORITY -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 9, 0)) -+ sched_set_fifo_low(current); -+#else -+ struct sched_param param = { .sched_priority = 1 }; -+ -+ sched_setscheduler(current, SCHED_FIFO, ¶m); -+#endif -+#endif /* PLATFORM_LINUX */ -+#endif /* RTW_XMIT_THREAD_HIGH_PRIORITY */ -+ -+ err = _SUCCESS; -+ padapter = (PADAPTER)context; -+ -+ thread_enter("RTW_XMIT_THREAD"); -+ -+ do { -+ err = rtw_hal_xmit_thread_handler(padapter); -+ flush_signals_thread(); -+ } while (_SUCCESS == err); -+ -+ RTW_INFO(FUNC_ADPT_FMT " Exit\n", FUNC_ADPT_ARG(padapter)); -+ -+ rtw_thread_wait_stop(); -+ -+ return 0; -+} -+#endif -+ -+#ifdef DBG_XMIT_BLOCK -+void dump_xmit_block(void *sel, _adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ RTW_PRINT_SEL(sel, "[XMIT-BLOCK] xmit_block :0x%02x\n", dvobj->xmit_block); -+ if (dvobj->xmit_block & XMIT_BLOCK_REDLMEM) -+ RTW_PRINT_SEL(sel, "Reason:%s\n", "XMIT_BLOCK_REDLMEM"); -+ if (dvobj->xmit_block & XMIT_BLOCK_SUSPEND) -+ RTW_PRINT_SEL(sel, "Reason:%s\n", "XMIT_BLOCK_SUSPEND"); -+ if (dvobj->xmit_block == XMIT_BLOCK_NONE) -+ RTW_PRINT_SEL(sel, "Reason:%s\n", "XMIT_BLOCK_NONE"); -+} -+void dump_xmit_block_info(void *sel, const char *fun_name, _adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ RTW_INFO("\n"ADPT_FMT" call %s\n", ADPT_ARG(padapter), fun_name); -+ dump_xmit_block(sel, padapter); -+} -+#define DBG_XMIT_BLOCK_DUMP(adapter) dump_xmit_block_info(RTW_DBGDUMP, __func__, adapter) -+#endif -+ -+void rtw_set_xmit_block(_adapter *padapter, enum XMIT_BLOCK_REASON reason) -+{ -+ _irqL irqL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ _enter_critical_bh(&dvobj->xmit_block_lock, &irqL); -+ dvobj->xmit_block |= reason; -+ _exit_critical_bh(&dvobj->xmit_block_lock, &irqL); -+ -+ #ifdef DBG_XMIT_BLOCK -+ DBG_XMIT_BLOCK_DUMP(padapter); -+ #endif -+} -+ -+void rtw_clr_xmit_block(_adapter *padapter, enum XMIT_BLOCK_REASON reason) -+{ -+ _irqL irqL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ _enter_critical_bh(&dvobj->xmit_block_lock, &irqL); -+ dvobj->xmit_block &= ~reason; -+ _exit_critical_bh(&dvobj->xmit_block_lock, &irqL); -+ -+ #ifdef DBG_XMIT_BLOCK -+ DBG_XMIT_BLOCK_DUMP(padapter); -+ #endif -+} -+bool rtw_is_xmit_blocked(_adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ #ifdef DBG_XMIT_BLOCK -+ DBG_XMIT_BLOCK_DUMP(padapter); -+ #endif -+ return ((dvobj->xmit_block) ? _TRUE : _FALSE); -+} -+ -+bool rtw_xmit_ac_blocked(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ bool blocked = _FALSE; -+ int i; -+#ifdef DBG_CONFIG_ERROR_DETECT -+#ifdef DBG_CONFIG_ERROR_RESET -+#ifdef CONFIG_USB_HCI -+ if (rtw_hal_sreset_inprogress(adapter) == _TRUE) { -+ blocked = _TRUE; -+ goto exit; -+ } -+#endif/* #ifdef CONFIG_USB_HCI */ -+#endif/* #ifdef DBG_CONFIG_ERROR_RESET */ -+#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ -+ -+ if (rfctl->offch_state != OFFCHS_NONE -+ #if CONFIG_DFS -+ || IS_RADAR_DETECTED(rfctl) || rfctl->csa_ch -+ #endif -+ ) { -+ blocked = _TRUE; -+ goto exit; -+ } -+ -+ 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; -+} -+ -+#ifdef CONFIG_TX_AMSDU -+void rtw_amsdu_vo_timeout_handler(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ adapter->xmitpriv.amsdu_vo_timeout = RTW_AMSDU_TIMER_TIMEOUT; -+ -+ tasklet_hi_schedule(&adapter->xmitpriv.xmit_tasklet); -+} -+ -+void rtw_amsdu_vi_timeout_handler(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ adapter->xmitpriv.amsdu_vi_timeout = RTW_AMSDU_TIMER_TIMEOUT; -+ -+ tasklet_hi_schedule(&adapter->xmitpriv.xmit_tasklet); -+} -+ -+void rtw_amsdu_be_timeout_handler(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ adapter->xmitpriv.amsdu_be_timeout = RTW_AMSDU_TIMER_TIMEOUT; -+ -+ if (printk_ratelimit()) -+ RTW_INFO("%s Timeout!\n",__FUNCTION__); -+ -+ tasklet_hi_schedule(&adapter->xmitpriv.xmit_tasklet); -+} -+ -+void rtw_amsdu_bk_timeout_handler(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ adapter->xmitpriv.amsdu_bk_timeout = RTW_AMSDU_TIMER_TIMEOUT; -+ -+ tasklet_hi_schedule(&adapter->xmitpriv.xmit_tasklet); -+} -+ -+u8 rtw_amsdu_get_timer_status(_adapter *padapter, u8 priority) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ u8 status = RTW_AMSDU_TIMER_UNSET; -+ -+ switch(priority) -+ { -+ case 1: -+ case 2: -+ status = pxmitpriv->amsdu_bk_timeout; -+ break; -+ case 4: -+ case 5: -+ status = pxmitpriv->amsdu_vi_timeout; -+ break; -+ case 6: -+ case 7: -+ status = pxmitpriv->amsdu_vo_timeout; -+ break; -+ case 0: -+ case 3: -+ default: -+ status = pxmitpriv->amsdu_be_timeout; -+ break; -+ } -+ return status; -+} -+ -+void rtw_amsdu_set_timer_status(_adapter *padapter, u8 priority, u8 status) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ switch(priority) -+ { -+ case 1: -+ case 2: -+ pxmitpriv->amsdu_bk_timeout = status; -+ break; -+ case 4: -+ case 5: -+ pxmitpriv->amsdu_vi_timeout = status; -+ break; -+ case 6: -+ case 7: -+ pxmitpriv->amsdu_vo_timeout = status; -+ break; -+ case 0: -+ case 3: -+ default: -+ pxmitpriv->amsdu_be_timeout = status; -+ break; -+ } -+} -+ -+void rtw_amsdu_set_timer(_adapter *padapter, u8 priority) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ _timer* amsdu_timer = NULL; -+ -+ switch(priority) -+ { -+ case 1: -+ case 2: -+ amsdu_timer = &pxmitpriv->amsdu_bk_timer; -+ break; -+ case 4: -+ case 5: -+ amsdu_timer = &pxmitpriv->amsdu_vi_timer; -+ break; -+ case 6: -+ case 7: -+ amsdu_timer = &pxmitpriv->amsdu_vo_timer; -+ break; -+ case 0: -+ case 3: -+ default: -+ amsdu_timer = &pxmitpriv->amsdu_be_timer; -+ break; -+ } -+ _set_timer(amsdu_timer, 1); -+} -+ -+void rtw_amsdu_cancel_timer(_adapter *padapter, u8 priority) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _timer* amsdu_timer = NULL; -+ -+ switch(priority) -+ { -+ case 1: -+ case 2: -+ amsdu_timer = &pxmitpriv->amsdu_bk_timer; -+ break; -+ case 4: -+ case 5: -+ amsdu_timer = &pxmitpriv->amsdu_vi_timer; -+ break; -+ case 6: -+ case 7: -+ amsdu_timer = &pxmitpriv->amsdu_vo_timer; -+ break; -+ case 0: -+ case 3: -+ default: -+ amsdu_timer = &pxmitpriv->amsdu_be_timer; -+ break; -+ } -+ _cancel_timer_ex(amsdu_timer); -+} -+#endif /* CONFIG_TX_AMSDU */ -+ -+#ifdef DBG_TXBD_DESC_DUMP -+static struct rtw_tx_desc_backup tx_backup[HW_QUEUE_ENTRY][TX_BAK_FRMAE_CNT]; -+static u8 backup_idx[HW_QUEUE_ENTRY]; -+ -+void rtw_tx_desc_backup(_adapter *padapter, struct xmit_frame *pxmitframe, u8 desc_size, u8 hwq) -+{ -+ u32 tmp32; -+ u8 *pxmit_buf; -+ -+ if (rtw_get_hw_init_completed(padapter) == _FALSE) -+ return; -+ -+ pxmit_buf = pxmitframe->pxmitbuf->pbuf; -+ -+ _rtw_memcpy(tx_backup[hwq][backup_idx[hwq]].tx_bak_desc, pxmit_buf, desc_size); -+ _rtw_memcpy(tx_backup[hwq][backup_idx[hwq]].tx_bak_data_hdr, pxmit_buf+desc_size, TX_BAK_DATA_LEN); -+ -+ tmp32 = rtw_read32(padapter, get_txbd_rw_reg(hwq)); -+ -+ tx_backup[hwq][backup_idx[hwq]].tx_bak_rp = (tmp32>>16)&0xfff; -+ tx_backup[hwq][backup_idx[hwq]].tx_bak_wp = tmp32&0xfff; -+ -+ tx_backup[hwq][backup_idx[hwq]].tx_desc_size = desc_size; -+ -+ backup_idx[hwq] = (backup_idx[hwq] + 1) % TX_BAK_FRMAE_CNT; -+} -+ -+void rtw_tx_desc_backup_reset(void) -+{ -+ int i, j; -+ -+ for (i = 0; i < HW_QUEUE_ENTRY; i++) { -+ for (j = 0; j < TX_BAK_FRMAE_CNT; j++) -+ _rtw_memset(&tx_backup[i][j], 0, sizeof(struct rtw_tx_desc_backup)); -+ -+ backup_idx[i] = 0; -+ } -+} -+ -+u8 rtw_get_tx_desc_backup(_adapter *padapter, u8 hwq, struct rtw_tx_desc_backup **pbak) -+{ -+ *pbak = &tx_backup[hwq][0]; -+ -+ return backup_idx[hwq]; -+} -+#endif -+ -+#ifdef CONFIG_PCI_TX_POLLING -+void rtw_tx_poll_init(_adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _timer* timer = &pxmitpriv->tx_poll_timer; -+ -+ if (!is_primary_adapter(padapter)) -+ return; -+ -+ if (timer->function != NULL) { -+ RTW_INFO("tx polling timer has been init.\n"); -+ return; -+ } -+ -+ rtw_init_timer(timer, padapter, rtw_tx_poll_timeout_handler, padapter); -+ rtw_tx_poll_timer_set(padapter, 1); -+ RTW_INFO("Tx poll timer init!\n"); -+} -+ -+void rtw_tx_poll_timeout_handler(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ rtw_tx_poll_timer_set(adapter, 1); -+ -+ if (adapter->hal_func.tx_poll_handler) -+ adapter->hal_func.tx_poll_handler(adapter); -+ else -+ RTW_WARN("hal ops: tx_poll_handler is NULL\n"); -+} -+ -+void rtw_tx_poll_timer_set(_adapter *padapter, u32 delay) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _timer* timer = NULL; -+ -+ timer = &pxmitpriv->tx_poll_timer; -+ _set_timer(timer, delay); -+} -+ -+void rtw_tx_poll_timer_cancel(_adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _timer* timer = NULL; -+ -+ if (!is_primary_adapter(padapter)) -+ return; -+ -+ timer = &pxmitpriv->tx_poll_timer; -+ _cancel_timer_ex(timer); -+ timer->function = NULL; -+ RTW_INFO("Tx poll timer cancel !\n"); -+} -+#endif /* CONFIG_PCI_TX_POLLING */ -+ -+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 */ -+ -+void rtw_hci_flush(_adapter *padapter) -+{ -+ u8 q; -+ -+ if (padapter->hal_func.hci_flush) { -+ for (q = 0; q < HW_QUEUE_ENTRY; q++) { -+ if ((q == BCN_QUEUE_INX) || (q == TXCMD_QUEUE_INX)) -+ continue; -+ -+ padapter->hal_func.hci_flush(padapter, q); -+ } -+ } -+ else -+ RTW_WARN("hal ops: hci_flush is NULL\n"); -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/wds/rtw_wds.c b/drivers/net/wireless/rtl8821cs/core/wds/rtw_wds.c -new file mode 100644 -index 000000000..fd88b1c4f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/wds/rtw_wds.c -@@ -0,0 +1,786 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_WDS_C_ -+ -+#include -+ -+#if defined(CONFIG_RTW_WDS) -+#include -+ -+#if defined(CONFIG_AP_MODE) -+ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+static void rtw_wpath_free_rcu(struct rtw_wds_path *wpath) -+{ -+ kfree_rcu(wpath, rcu); -+ rtw_mstat_update(MSTAT_TYPE_PHY, MSTAT_FREE, sizeof(struct rtw_wds_path)); -+} -+#else -+static void rtw_wpath_free_rcu_callback(rtw_rcu_head *head) -+{ -+ struct rtw_wds_path *wpath; -+ -+ wpath = container_of(head, struct rtw_wds_path, rcu); -+ rtw_mfree(wpath, sizeof(struct rtw_wds_path)); -+} -+ -+static void rtw_wpath_free_rcu(struct rtw_wds_path *wpath) -+{ -+ call_rcu(&wpath->rcu, rtw_wpath_free_rcu_callback); -+} -+#endif -+#endif /* PLATFORM_LINUX */ -+ -+static void rtw_wds_path_free_rcu(struct rtw_wds_table *tbl, struct rtw_wds_path *wpath); -+ -+static u32 rtw_wds_table_hash(const void *addr, u32 len, u32 seed) -+{ -+ /* Use last four bytes of hw addr as hash index */ -+ return jhash_1word(*(u32 *)(addr+2), seed); -+} -+ -+static const rtw_rhashtable_params rtw_wds_rht_params = { -+ .nelem_hint = 2, -+ .automatic_shrinking = true, -+ .key_len = ETH_ALEN, -+ .key_offset = offsetof(struct rtw_wds_path, dst), -+ .head_offset = offsetof(struct rtw_wds_path, rhash), -+ .hashfn = rtw_wds_table_hash, -+}; -+ -+static void rtw_wds_path_rht_free(void *ptr, void *tblptr) -+{ -+ struct rtw_wds_path *wpath = ptr; -+ struct rtw_wds_table *tbl = tblptr; -+ -+ rtw_wds_path_free_rcu(tbl, wpath); -+} -+ -+static struct rtw_wds_table *rtw_wds_table_alloc(void) -+{ -+ struct rtw_wds_table *newtbl; -+ -+ newtbl = rtw_malloc(sizeof(struct rtw_wds_table)); -+ if (!newtbl) -+ return NULL; -+ -+ return newtbl; -+} -+ -+static void rtw_wds_table_free(struct rtw_wds_table *tbl) -+{ -+ rtw_rhashtable_free_and_destroy(&tbl->rhead, -+ rtw_wds_path_rht_free, tbl); -+ rtw_mfree(tbl, sizeof(struct rtw_wds_table)); -+} -+ -+void rtw_wds_path_assign_nexthop(struct rtw_wds_path *wpath, struct sta_info *sta) -+{ -+ rtw_rcu_assign_pointer(wpath->next_hop, sta); -+} -+ -+static struct rtw_wds_path *rtw_wpath_lookup(struct rtw_wds_table *tbl, const u8 *dst) -+{ -+ struct rtw_wds_path *wpath; -+ -+ if (!tbl) -+ return NULL; -+ -+ wpath = rtw_rhashtable_lookup_fast(&tbl->rhead, dst, rtw_wds_rht_params); -+ -+ return wpath; -+} -+ -+struct rtw_wds_path *rtw_wds_path_lookup(_adapter *adapter, const u8 *dst) -+{ -+ return rtw_wpath_lookup(adapter->wds_paths, dst); -+} -+ -+static struct rtw_wds_path * -+__rtw_wds_path_lookup_by_idx(struct rtw_wds_table *tbl, int idx) -+{ -+ int i = 0, ret; -+ struct rtw_wds_path *wpath = NULL; -+ rtw_rhashtable_iter iter; -+ -+ if (!tbl) -+ return NULL; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return NULL; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto err; -+ -+ while ((wpath = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(wpath) && PTR_ERR(wpath) == -EAGAIN) -+ continue; -+ if (IS_ERR(wpath)) -+ break; -+ if (i++ == idx) -+ break; -+ } -+err: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+ -+ if (IS_ERR(wpath) || !wpath) -+ return NULL; -+ -+ return wpath; -+} -+ -+/** -+ * Locking: must be called within a read rcu section. -+ */ -+struct rtw_wds_path * -+rtw_wds_path_lookup_by_idx(_adapter *adapter, int idx) -+{ -+ return __rtw_wds_path_lookup_by_idx(adapter->wds_paths, idx); -+} -+ -+void dump_wpath(void *sel, _adapter *adapter) -+{ -+ struct rtw_wds_path *wpath; -+ int idx = 0; -+ char dst[ETH_ALEN]; -+ char next_hop[ETH_ALEN]; -+ u32 age_ms; -+ -+ RTW_PRINT_SEL(sel, "num:%d\n", ATOMIC_READ(&adapter->wds_path_num)); -+ RTW_PRINT_SEL(sel, "%-17s %-17s %-6s\n" -+ , "dst", "next_hop", "age" -+ ); -+ -+ do { -+ rtw_rcu_read_lock(); -+ -+ wpath = rtw_wds_path_lookup_by_idx(adapter, idx); -+ if (wpath) { -+ _rtw_memcpy(dst, wpath->dst, ETH_ALEN); -+ _rtw_memcpy(next_hop, wpath->next_hop->cmn.mac_addr, ETH_ALEN); -+ age_ms = rtw_get_passing_time_ms(wpath->last_update); -+ } -+ -+ rtw_rcu_read_unlock(); -+ -+ if (wpath) { -+ RTW_PRINT_SEL(sel, MAC_FMT" "MAC_FMT" %6u\n" -+ , MAC_ARG(dst), MAC_ARG(next_hop) -+ , age_ms < 999999 ? age_ms : 999999 -+ ); -+ } -+ -+ idx++; -+ } while (wpath); -+} -+ -+static -+struct rtw_wds_path *rtw_wds_path_new(_adapter *adapter, -+ const u8 *dst) -+{ -+ struct rtw_wds_path *new_wpath; -+ -+ new_wpath = rtw_zmalloc(sizeof(struct rtw_wds_path)); -+ if (!new_wpath) -+ return NULL; -+ -+ new_wpath->adapter = adapter; -+ _rtw_memcpy(new_wpath->dst, dst, ETH_ALEN); -+ new_wpath->last_update = rtw_get_current_time(); -+ -+ return new_wpath; -+} -+ -+/** -+ * Returns: 0 on success -+ * -+ * State: the initial state of the new path is set to 0 -+ */ -+struct rtw_wds_path *rtw_wds_path_add(_adapter *adapter, -+ const u8 *dst, struct sta_info *next_hop) -+{ -+ struct rtw_wds_table *tbl = adapter->wds_paths; -+ struct rtw_wds_path *wpath, *new_wpath; -+ int ret; -+ -+ if (!tbl) -+ return ERR_PTR(-ENOTSUPP); -+ -+ if (_rtw_memcmp(dst, adapter_mac_addr(adapter), ETH_ALEN) == _TRUE) -+ /* never add ourselves as neighbours */ -+ return ERR_PTR(-ENOTSUPP); -+ -+ if (IS_MCAST(dst)) -+ return ERR_PTR(-ENOTSUPP); -+ -+ if (ATOMIC_INC_UNLESS(&adapter->wds_path_num, RTW_WDS_MAX_PATHS) == 0) -+ return ERR_PTR(-ENOSPC); -+ -+ new_wpath = rtw_wds_path_new(adapter, dst); -+ if (!new_wpath) -+ return ERR_PTR(-ENOMEM); -+ -+ do { -+ ret = rtw_rhashtable_lookup_insert_fast(&tbl->rhead, -+ &new_wpath->rhash, -+ rtw_wds_rht_params); -+ -+ if (ret == -EEXIST) -+ wpath = rtw_rhashtable_lookup_fast(&tbl->rhead, -+ dst, -+ rtw_wds_rht_params); -+ -+ } while (unlikely(ret == -EEXIST && !wpath)); -+ -+ if (ret && ret != -EEXIST) -+ return ERR_PTR(ret); -+ -+ /* At this point either new_wpath was added, or we found a -+ * matching entry already in the table; in the latter case -+ * free the unnecessary new entry. -+ */ -+ if (ret == -EEXIST) { -+ rtw_mfree(new_wpath, sizeof(struct rtw_wds_path)); -+ new_wpath = wpath; -+ } -+ rtw_wds_path_assign_nexthop(new_wpath, next_hop); -+ -+ return new_wpath; -+} -+ -+static void rtw_wds_path_free_rcu(struct rtw_wds_table *tbl, -+ struct rtw_wds_path *wpath) -+{ -+ _adapter *adapter = wpath->adapter; -+ -+ ATOMIC_DEC(&adapter->wds_path_num); -+ -+ rtw_wpath_free_rcu(wpath); -+} -+ -+static void __rtw_wds_path_del(struct rtw_wds_table *tbl, struct rtw_wds_path *wpath) -+{ -+ rtw_rhashtable_remove_fast(&tbl->rhead, &wpath->rhash, rtw_wds_rht_params); -+ rtw_wds_path_free_rcu(tbl, wpath); -+} -+ -+void rtw_wds_path_flush_by_nexthop(struct sta_info *sta) -+{ -+ _adapter *adapter = sta->padapter; -+ struct rtw_wds_table *tbl = adapter->wds_paths; -+ struct rtw_wds_path *wpath; -+ rtw_rhashtable_iter iter; -+ int ret; -+ -+ if (!tbl) -+ return; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto out; -+ -+ while ((wpath = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(wpath) && PTR_ERR(wpath) == -EAGAIN) -+ continue; -+ if (IS_ERR(wpath)) -+ break; -+ -+ if (rtw_rcu_access_pointer(wpath->next_hop) == sta) -+ __rtw_wds_path_del(tbl, wpath); -+ } -+out: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+} -+ -+static void rtw_wds_table_flush_by_iface(struct rtw_wds_table *tbl) -+{ -+ struct rtw_wds_path *wpath; -+ rtw_rhashtable_iter iter; -+ int ret; -+ -+ if (!tbl) -+ return; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto out; -+ -+ while ((wpath = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(wpath) && PTR_ERR(wpath) == -EAGAIN) -+ continue; -+ if (IS_ERR(wpath)) -+ break; -+ __rtw_wds_path_del(tbl, wpath); -+ } -+out: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+} -+ -+void rtw_wds_path_flush_by_iface(_adapter *adapter) -+{ -+ rtw_wds_table_flush_by_iface(adapter->wds_paths); -+} -+ -+static int rtw_wds_table_path_del(struct rtw_wds_table *tbl, -+ const u8 *addr) -+{ -+ struct rtw_wds_path *wpath; -+ -+ if (!tbl) -+ return -ENXIO; -+ -+ rtw_rcu_read_lock(); -+ wpath = rtw_rhashtable_lookup_fast(&tbl->rhead, addr, rtw_wds_rht_params); -+ if (!wpath) { -+ rtw_rcu_read_unlock(); -+ return -ENXIO; -+ } -+ -+ __rtw_wds_path_del(tbl, wpath); -+ rtw_rcu_read_unlock(); -+ return 0; -+} -+ -+int rtw_wds_path_del(_adapter *adapter, const u8 *addr) -+{ -+ int err; -+ -+ err = rtw_wds_table_path_del(adapter->wds_paths, addr); -+ return err; -+} -+ -+int rtw_wds_pathtbl_init(_adapter *adapter) -+{ -+ struct rtw_wds_table *tbl_path; -+ int ret; -+ -+ tbl_path = rtw_wds_table_alloc(); -+ if (!tbl_path) -+ return -ENOMEM; -+ -+ rtw_rhashtable_init(&tbl_path->rhead, &rtw_wds_rht_params); -+ -+ ATOMIC_SET(&adapter->wds_path_num, 0); -+ adapter->wds_paths = tbl_path; -+ -+ return 0; -+} -+ -+static -+void rtw_wds_path_tbl_expire(_adapter *adapter, -+ struct rtw_wds_table *tbl) -+{ -+ struct rtw_wds_path *wpath; -+ rtw_rhashtable_iter iter; -+ int ret; -+ -+ if (!tbl) -+ return; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto out; -+ -+ while ((wpath = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(wpath) && PTR_ERR(wpath) == -EAGAIN) -+ continue; -+ if (IS_ERR(wpath)) -+ break; -+ if (rtw_time_after(rtw_get_current_time(), wpath->last_update + RTW_WDS_PATH_EXPIRE)) -+ __rtw_wds_path_del(tbl, wpath); -+ } -+ -+out: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+} -+ -+void rtw_wds_path_expire(_adapter *adapter) -+{ -+ rtw_wds_path_tbl_expire(adapter, adapter->wds_paths); -+} -+ -+void rtw_wds_pathtbl_unregister(_adapter *adapter) -+{ -+ if (adapter->wds_paths) { -+ rtw_wds_table_free(adapter->wds_paths); -+ adapter->wds_paths = NULL; -+ } -+} -+ -+int rtw_wds_nexthop_lookup(_adapter *adapter, const u8 *da, u8 *ra) -+{ -+ struct rtw_wds_path *wpath; -+ struct sta_info *next_hop; -+ int err = -ENOENT; -+ -+ rtw_rcu_read_lock(); -+ wpath = rtw_wds_path_lookup(adapter, da); -+ -+ if (!wpath) -+ goto endlookup; -+ -+ next_hop = rtw_rcu_dereference(wpath->next_hop); -+ if (next_hop) { -+ _rtw_memcpy(ra, next_hop->cmn.mac_addr, ETH_ALEN); -+ err = 0; -+ } -+ -+endlookup: -+ rtw_rcu_read_unlock(); -+ return err; -+} -+ -+#endif /* defined(CONFIG_AP_MODE) */ -+ -+/* WDS group adddressed proxy TX record */ -+struct rtw_wds_gptr { -+ u8 src[ETH_ALEN]; -+ systime last_update; -+ rtw_rhash_head rhash; -+ _adapter *adapter; -+ rtw_rcu_head rcu; -+}; -+ -+#define RTW_WDS_GPTR_EXPIRE (2 * HZ) -+ -+/* Maximum number of gptrs per interface */ -+#define RTW_WDS_MAX_GPTRS 1024 -+ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+static void rtw_wgptr_free_rcu(struct rtw_wds_gptr *wgptr) -+{ -+ kfree_rcu(wgptr, rcu); -+ rtw_mstat_update(MSTAT_TYPE_PHY, MSTAT_FREE, sizeof(struct rtw_wds_gptr)); -+} -+#else -+static void rtw_wgptr_free_rcu_callback(rtw_rcu_head *head) -+{ -+ struct rtw_wds_gptr *wgptr; -+ -+ wgptr = container_of(head, struct rtw_wds_gptr, rcu); -+ rtw_mfree(wgptr, sizeof(struct rtw_wds_gptr)); -+} -+ -+static void rtw_wgptr_free_rcu(struct rtw_wds_gptr *wgptr) -+{ -+ call_rcu(&wgptr->rcu, rtw_wgptr_free_rcu_callback); -+} -+#endif -+#endif /* PLATFORM_LINUX */ -+ -+static void rtw_wds_gptr_free_rcu(struct rtw_wds_gptr_table *tbl, struct rtw_wds_gptr *wgptr) -+{ -+ _adapter *adapter = wgptr->adapter; -+ -+ ATOMIC_DEC(&adapter->wds_gpt_record_num); -+ -+ rtw_wgptr_free_rcu(wgptr); -+} -+ -+static u32 rtw_wds_gptr_table_hash(const void *addr, u32 len, u32 seed) -+{ -+ /* Use last four bytes of hw addr as hash index */ -+ return jhash_1word(*(u32 *)(addr+2), seed); -+} -+ -+static const rtw_rhashtable_params rtw_wds_gptr_rht_params = { -+ .nelem_hint = 2, -+ .automatic_shrinking = true, -+ .key_len = ETH_ALEN, -+ .key_offset = offsetof(struct rtw_wds_gptr, src), -+ .head_offset = offsetof(struct rtw_wds_gptr, rhash), -+ .hashfn = rtw_wds_gptr_table_hash, -+}; -+ -+static void rtw_wds_gptr_rht_free(void *ptr, void *tblptr) -+{ -+ struct rtw_wds_gptr *wgptr = ptr; -+ struct rtw_wds_gptr_table *tbl = tblptr; -+ -+ rtw_wds_gptr_free_rcu(tbl, wgptr); -+} -+ -+static struct rtw_wds_gptr_table *rtw_wds_gptr_table_alloc(void) -+{ -+ struct rtw_wds_gptr_table *newtbl; -+ -+ newtbl = rtw_malloc(sizeof(struct rtw_wds_gptr_table)); -+ if (!newtbl) -+ return NULL; -+ -+ return newtbl; -+} -+ -+static void rtw_wds_gptr_table_free(struct rtw_wds_gptr_table *tbl) -+{ -+ rtw_rhashtable_free_and_destroy(&tbl->rhead, -+ rtw_wds_gptr_rht_free, tbl); -+ rtw_mfree(tbl, sizeof(struct rtw_wds_gptr_table)); -+} -+ -+static struct rtw_wds_gptr *rtw_wds_gptr_lookup(_adapter *adapter, const u8 *src) -+{ -+ struct rtw_wds_gptr_table *tbl = adapter->wds_gpt_records; -+ -+ if (!tbl) -+ return NULL; -+ -+ return rtw_rhashtable_lookup_fast(&tbl->rhead, src, rtw_wds_gptr_rht_params); -+} -+ -+/** -+ * Locking: must be called within a read rcu section. -+ */ -+static struct rtw_wds_gptr *rtw_wds_gptr_lookup_by_idx(_adapter *adapter, int idx) -+{ -+ int i = 0, ret; -+ struct rtw_wds_gptr_table *tbl = adapter->wds_gpt_records; -+ struct rtw_wds_gptr *wgptr = NULL; -+ rtw_rhashtable_iter iter; -+ -+ if (!tbl) -+ return NULL; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return NULL; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto err; -+ -+ while ((wgptr = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(wgptr) && PTR_ERR(wgptr) == -EAGAIN) -+ continue; -+ if (IS_ERR(wgptr)) -+ break; -+ if (i++ == idx) -+ break; -+ } -+err: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+ -+ if (IS_ERR(wgptr) || !wgptr) -+ return NULL; -+ -+ return wgptr; -+} -+ -+void dump_wgptr(void *sel, _adapter *adapter) -+{ -+ struct rtw_wds_gptr *wgptr; -+ int idx = 0; -+ char src[ETH_ALEN]; -+ u32 age_ms; -+ -+ RTW_PRINT_SEL(sel, "num:%d\n", ATOMIC_READ(&adapter->wds_gpt_record_num)); -+ RTW_PRINT_SEL(sel, "%-17s %-6s\n" -+ , "src", "age" -+ ); -+ -+ do { -+ rtw_rcu_read_lock(); -+ -+ wgptr = rtw_wds_gptr_lookup_by_idx(adapter, idx); -+ if (wgptr) { -+ _rtw_memcpy(src, wgptr->src, ETH_ALEN); -+ age_ms = rtw_get_passing_time_ms(wgptr->last_update); -+ } -+ -+ rtw_rcu_read_unlock(); -+ -+ if (wgptr) { -+ RTW_PRINT_SEL(sel, MAC_FMT" %6u\n" -+ , MAC_ARG(src) -+ , age_ms < 999999 ? age_ms : 999999 -+ ); -+ } -+ -+ idx++; -+ } while (wgptr); -+} -+ -+static struct rtw_wds_gptr *rtw_wds_gptr_new(_adapter *adapter, const u8 *src) -+{ -+ struct rtw_wds_gptr *new_wgptr; -+ -+ new_wgptr = rtw_zmalloc(sizeof(struct rtw_wds_gptr)); -+ if (!new_wgptr) -+ return NULL; -+ -+ new_wgptr->adapter = adapter; -+ _rtw_memcpy(new_wgptr->src, src, ETH_ALEN); -+ new_wgptr->last_update = rtw_get_current_time(); -+ -+ return new_wgptr; -+} -+ -+static struct rtw_wds_gptr *rtw_wds_gptr_add(_adapter *adapter, const u8 *src) -+{ -+ struct rtw_wds_gptr_table *tbl = adapter->wds_gpt_records; -+ struct rtw_wds_gptr *wgptr, *new_wgptr; -+ int ret; -+ -+ if (!tbl) -+ return ERR_PTR(-ENOTSUPP); -+ -+ if (ATOMIC_INC_UNLESS(&adapter->wds_gpt_record_num, RTW_WDS_MAX_PATHS) == 0) -+ return ERR_PTR(-ENOSPC); -+ -+ new_wgptr = rtw_wds_gptr_new(adapter, src); -+ if (!new_wgptr) -+ return ERR_PTR(-ENOMEM); -+ -+ do { -+ ret = rtw_rhashtable_lookup_insert_fast(&tbl->rhead, -+ &new_wgptr->rhash, -+ rtw_wds_gptr_rht_params); -+ -+ if (ret == -EEXIST) -+ wgptr = rtw_rhashtable_lookup_fast(&tbl->rhead, -+ src, -+ rtw_wds_gptr_rht_params); -+ -+ } while (unlikely(ret == -EEXIST && !wgptr)); -+ -+ if (ret && ret != -EEXIST) -+ return ERR_PTR(ret); -+ -+ /* At this point either new_wgptr was added, or we found a -+ * matching entry already in the table; in the latter case -+ * free the unnecessary new entry. -+ */ -+ if (ret == -EEXIST) { -+ rtw_mfree(new_wgptr, sizeof(struct rtw_wds_gptr)); -+ new_wgptr = wgptr; -+ } -+ -+ return new_wgptr; -+} -+ -+bool rtw_rx_wds_gptr_check(_adapter *adapter, const u8 *src) -+{ -+ struct rtw_wds_gptr *wgptr; -+ bool ret = 0; -+ -+ rtw_rcu_read_lock(); -+ -+ wgptr = rtw_wds_gptr_lookup(adapter, src); -+ if (wgptr) -+ ret = rtw_time_after(wgptr->last_update + RTW_WDS_GPTR_EXPIRE, rtw_get_current_time()); -+ -+ rtw_rcu_read_unlock(); -+ -+ return ret; -+} -+ -+void rtw_tx_wds_gptr_update(_adapter *adapter, const u8 *src) -+{ -+ struct rtw_wds_gptr *wgptr; -+ -+ rtw_rcu_read_lock(); -+ wgptr = rtw_wds_gptr_lookup(adapter, src); -+ if (!wgptr) -+ rtw_wds_gptr_add(adapter, src); -+ else -+ wgptr->last_update = rtw_get_current_time(); -+ rtw_rcu_read_unlock(); -+} -+ -+static void __rtw_wds_gptr_del(struct rtw_wds_gptr_table *tbl, struct rtw_wds_gptr *wgptr) -+{ -+ rtw_rhashtable_remove_fast(&tbl->rhead, &wgptr->rhash, rtw_wds_gptr_rht_params); -+ rtw_wds_gptr_free_rcu(tbl, wgptr); -+} -+ -+void rtw_wds_gptr_expire(_adapter *adapter) -+{ -+ struct rtw_wds_gptr_table *tbl = adapter->wds_gpt_records; -+ struct rtw_wds_gptr *wgptr; -+ rtw_rhashtable_iter iter; -+ int ret; -+ -+ if (!tbl) -+ return; -+ -+ ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); -+ if (ret) -+ return; -+ -+ ret = rtw_rhashtable_walk_start(&iter); -+ if (ret && ret != -EAGAIN) -+ goto out; -+ -+ while ((wgptr = rtw_rhashtable_walk_next(&iter))) { -+ if (IS_ERR(wgptr) && PTR_ERR(wgptr) == -EAGAIN) -+ continue; -+ if (IS_ERR(wgptr)) -+ break; -+ if (rtw_time_after(rtw_get_current_time(), wgptr->last_update + RTW_WDS_GPTR_EXPIRE)) -+ __rtw_wds_gptr_del(tbl, wgptr); -+ } -+ -+out: -+ rtw_rhashtable_walk_stop(&iter); -+ rtw_rhashtable_walk_exit(&iter); -+} -+ -+int rtw_wds_gptr_tbl_init(_adapter *adapter) -+{ -+ struct rtw_wds_gptr_table *tbl; -+ int ret; -+ -+ tbl = rtw_wds_gptr_table_alloc(); -+ if (!tbl) -+ return -ENOMEM; -+ -+ rtw_rhashtable_init(&tbl->rhead, &rtw_wds_gptr_rht_params); -+ -+ ATOMIC_SET(&adapter->wds_gpt_record_num, 0); -+ adapter->wds_gpt_records = tbl; -+ -+ return 0; -+} -+ -+void rtw_wds_gptr_tbl_unregister(_adapter *adapter) -+{ -+ if (adapter->wds_gpt_records) { -+ rtw_wds_gptr_table_free(adapter->wds_gpt_records); -+ adapter->wds_gpt_records = NULL; -+ } -+} -+#endif /* defined(CONFIG_RTW_WDS) */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/core/wds/rtw_wds.h b/drivers/net/wireless/rtl8821cs/core/wds/rtw_wds.h -new file mode 100644 -index 000000000..f1312c740 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/core/wds/rtw_wds.h -@@ -0,0 +1,65 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_WDS_H_ -+#define __RTW_WDS_H_ -+ -+#ifdef CONFIG_AP_MODE -+struct rtw_wds_path { -+ u8 dst[ETH_ALEN]; -+ rtw_rhash_head rhash; -+ _adapter *adapter; -+ struct sta_info __rcu *next_hop; -+ rtw_rcu_head rcu; -+ systime last_update; -+}; -+ -+struct rtw_wds_table { -+ rtw_rhashtable rhead; -+}; -+ -+#define RTW_WDS_PATH_EXPIRE (600 * HZ) -+ -+/* Maximum number of paths per interface */ -+#define RTW_WDS_MAX_PATHS 1024 -+ -+int rtw_wds_nexthop_lookup(_adapter *adapter, const u8 *da, u8 *ra); -+ -+struct rtw_wds_path *rtw_wds_path_lookup(_adapter *adapter, const u8 *dst); -+void dump_wpath(void *sel, _adapter *adapter); -+ -+void rtw_wds_path_expire(_adapter *adapter); -+ -+struct rtw_wds_path *rtw_wds_path_add(_adapter *adapter, const u8 *dst, struct sta_info *next_hop); -+void rtw_wds_path_assign_nexthop(struct rtw_wds_path *path, struct sta_info *sta); -+ -+int rtw_wds_pathtbl_init(_adapter *adapter); -+void rtw_wds_pathtbl_unregister(_adapter *adapter); -+ -+void rtw_wds_path_flush_by_nexthop(struct sta_info *sta); -+#endif /* CONFIG_AP_MODE */ -+ -+struct rtw_wds_gptr_table { -+ rtw_rhashtable rhead; -+}; -+ -+void dump_wgptr(void *sel, _adapter *adapter); -+bool rtw_rx_wds_gptr_check(_adapter *adapter, const u8 *src); -+void rtw_tx_wds_gptr_update(_adapter *adapter, const u8 *src); -+void rtw_wds_gptr_expire(_adapter *adapter); -+int rtw_wds_gptr_tbl_init(_adapter *adapter); -+void rtw_wds_gptr_tbl_unregister(_adapter *adapter); -+ -+#endif /* __RTW_WDSH_ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/HalPwrSeqCmd.c b/drivers/net/wireless/rtl8821cs/hal/HalPwrSeqCmd.c -new file mode 100644 -index 000000000..389785c2b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/HalPwrSeqCmd.c -@@ -0,0 +1,185 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+ -+/* -+ * 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; -+ u8 bHWICSupport = _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); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_PWR_CMD, &bHWICSupport); -+ if (bHWICSupport && 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 (bHWICSupport && 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 --git a/drivers/net/wireless/rtl8821cs/hal/btc/btc_basic_types.h b/drivers/net/wireless/rtl8821cs/hal/btc/btc_basic_types.h -new file mode 100644 -index 000000000..c2a27a264 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/btc/btc_basic_types.h -@@ -0,0 +1,53 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __BTC_BASIC_TYPES_H__ -+#define __BTC_BASIC_TYPES_H__ -+ -+#define IN -+#define OUT -+#define VOID void -+typedef void *PVOID; -+ -+#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* -+ -+#endif /* __BTC_BASIC_TYPES_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c1ant.c b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c1ant.c -new file mode 100644 -index 000000000..5d09299d6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c1ant.c -@@ -0,0 +1,5542 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821C_SUPPORT == 1) -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+ -+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 = 20210319; -+u32 glcoex_ver_8821c_1ant = 0x55; -+u32 glcoex_ver_btdesired_8821c_1ant = 0x53; -+u32 glcoex_ver_wldesired_8821c_1ant = 0x170011; -+ -+#if 0 -+static -+u8 halbtc8821c1ant_bt_rssi_state(struct btc_coexist *btc, u8 level_num, -+ u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ 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; -+} -+#endif -+ -+#if 0 -+static -+u8 halbtc8821c1ant_wifi_rssi_state(struct btc_coexist *btc, u8 index, -+ u8 level_num, u8 rssi_thresh, -+ u8 rssi_thresh1) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btc->btc_get(btc, 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; -+} -+#endif -+ -+static void -+halbtc8821c1ant_limited_tx(struct btc_coexist *btc, boolean force_exec, -+ boolean tx_limit_en, boolean ampdu_limit_en) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct wifi_link_info_8821c_1ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_1ant; -+ boolean wifi_under_b_mode = FALSE; -+ -+ /* Force Max Tx retry limit = 8*/ -+ if (!coex_sta->wl_tx_limit_en) { -+ coex_sta->wl_0x430_backup = btc->btc_read_4byte(btc, 0x430); -+ coex_sta->wl_0x434_backup = btc->btc_read_4byte(btc, 0x434); -+ coex_sta->wl_0x42a_backup = btc->btc_read_2byte(btc, 0x42a); -+ } -+ -+ if (!coex_sta->wl_ampdu_limit_en) -+ coex_sta->wl_0x455_backup = btc->btc_read_1byte(btc, 0x455); -+ -+ if (!force_exec && tx_limit_en == coex_sta->wl_tx_limit_en && -+ ampdu_limit_en == coex_sta->wl_ampdu_limit_en) -+ return; -+ -+ coex_sta->wl_tx_limit_en = tx_limit_en; -+ coex_sta->wl_ampdu_limit_en = ampdu_limit_en; -+ -+ if (tx_limit_en) { -+ /* Set BT polluted packet on for Tx rate adaptive not -+ * including Tx retry break by PTA, 0x45c[19] =1 -+ * Set queue life time to avoid can't reach tx retry limit -+ * if tx is always break by GNT_BT. -+ */ -+ btc->btc_write_1byte_bitmask(btc, 0x45e, 0x8, 0x1); -+ btc->btc_write_1byte_bitmask(btc, 0x426, 0xf, 0xf); -+ -+ /* Max Tx retry limit = 8*/ -+ btc->btc_write_2byte(btc, 0x42a, 0x0808); -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ /* Auto rate fallback step within 8 retry*/ -+ if (wifi_under_b_mode) { -+ btc->btc_write_4byte(btc, 0x430, 0x1000000); -+ btc->btc_write_4byte(btc, 0x434, 0x1010101); -+ } else { -+ btc->btc_write_4byte(btc, 0x430, 0x1000000); -+ btc->btc_write_4byte(btc, 0x434, 0x4030201); -+ } -+ } else { -+ /* Set BT polluted packet on for Tx rate adaptive not -+ *including Tx retry break by PTA, 0x45c[19] =1 -+ */ -+ btc->btc_write_1byte_bitmask(btc, 0x45e, 0x8, 0x0); -+ btc->btc_write_1byte_bitmask(btc, 0x426, 0xf, 0x0); -+ -+ /* Set queue life time to avoid can't reach tx retry limit -+ * if tx is always break by GNT_BT. -+ */ -+ if (wifi_link_info_ext->num_of_active_port == 1) -+ btc->btc_write_1byte_bitmask(btc, 0x426, 0xf, 0x0); -+ -+ /* Recovery Max Tx retry limit*/ -+ btc->btc_write_2byte(btc, 0x42a, coex_sta->wl_0x42a_backup); -+ btc->btc_write_4byte(btc, 0x430, coex_sta->wl_0x430_backup); -+ btc->btc_write_4byte(btc, 0x434, coex_sta->wl_0x434_backup); -+ } -+ -+ if (ampdu_limit_en) -+ btc->btc_write_1byte(btc, 0x455, 0x20); -+ else -+ btc->btc_write_1byte(btc, 0x455, coex_sta->wl_0x455_backup); -+} -+ -+static void -+halbtc8821c1ant_limited_rx(struct btc_coexist *btc, boolean force_exec, -+ boolean rej_ap_agg_pkt, boolean bt_ctrl_agg_buf_size, -+ u8 agg_buf_size) -+{ -+#if 1 -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ 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; -+ -+ if (!force_exec && -+ bt_ctrl_agg_buf_size == coex_sta->wl_rxagg_limit_en && -+ agg_buf_size == coex_sta->wl_rxagg_size) -+ return; -+ -+ coex_sta->wl_rxagg_limit_en = bt_ctrl_agg_buf_size; -+ coex_sta->wl_rxagg_size = agg_buf_size; -+ -+ /*btc->btc_set(btc, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &reject_rx_agg);*/ -+ /* decide BT control aggregation buf size or not */ -+ btc->btc_set(btc, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work -+ * when BT control Rx aggregation size -+ */ -+ btc->btc_set(btc, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btc->btc_set(btc, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+#endif -+} -+ -+static void -+halbtc8821c1ant_ccklock_action(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ u8 h2c_parameter[2] = {0}; -+ static u8 cnt; -+ boolean wifi_busy = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (bt_link_info->a2dp_exist && coex_sta->bt_ble_hid_exist) { -+ if (!coex_sta->is_no_wl_5ms_extend) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], set h2c 0x69 opcode 12 to turn off 5ms WL slot extend!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ h2c_parameter[0] = 0xc; -+ h2c_parameter[1] = 0x1; -+ btc->btc_fill_h2c(btc, 0x69, 2, h2c_parameter); -+ coex_sta->is_no_wl_5ms_extend = TRUE; -+ cnt = 0; -+ } -+ return; -+ } -+ -+ if (!coex_sta->gl_wifi_busy || -+ coex_sta->wl_iot_peer == BTC_IOT_PEER_CISCO) { -+ cnt = 0; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is not busy or CISCO AP, return!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (!coex_sta->is_no_wl_5ms_extend && coex_sta->force_lps_ctrl && -+ !coex_sta->cck_lock_ever) { -+ if (coex_sta->wl_fw_dbg_info[7] <= 5 && wifi_busy) -+ cnt++; -+ else -+ cnt = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 5ms WL slot extend cnt = %d!!\n", cnt); -+ BTC_TRACE(trace_buf); -+ -+ if (cnt == 7) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], set h2c 0x69 opcode 12 to turn off 5ms WL slot extend!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ h2c_parameter[0] = 0xc; -+ h2c_parameter[1] = 0x1; -+ btc->btc_fill_h2c(btc, 0x69, 2, h2c_parameter); -+ coex_sta->is_no_wl_5ms_extend = TRUE; -+ cnt = 0; -+ } -+ } else if (coex_sta->is_no_wl_5ms_extend && coex_sta->cck_lock) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], set h2c 0x69 opcode 12 to turn on 5ms WL slot extend!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ h2c_parameter[0] = 0xc; -+ h2c_parameter[1] = 0x0; -+ btc->btc_fill_h2c(btc, 0x69, 2, h2c_parameter); -+ coex_sta->is_no_wl_5ms_extend = FALSE; -+ } -+} -+ -+static void -+halbtc8821c1ant_ccklock_detect(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ struct wifi_link_info_8821c_1ant *link_info_ext = -+ &btc->wifi_link_info_8821c_1ant; -+ boolean is_cck_lock_rate = FALSE; -+ -+ if (coex_dm->bt_status == BTC_BTSTATUS_INQ_PAGE || -+ coex_sta->is_setup_link) -+ return; -+ -+ if (coex_sta->wl_rx_rate <= BTC_CCK_2 || -+ coex_sta->wl_rts_rx_rate <= BTC_CCK_2) -+ is_cck_lock_rate = TRUE; -+ -+ if (link_info_ext->is_connected && coex_sta->gl_wifi_busy && -+ (coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_ACL_BUSY || -+ coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_ACL_SCO_BUSY || -+ coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_SCO_BUSY)) { -+ if (is_cck_lock_rate) { -+ coex_sta->cck_lock = TRUE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], cck locking...\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_sta->cck_lock = FALSE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], cck unlock...\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } else { -+ coex_sta->cck_lock = FALSE; -+ } -+} -+ -+static void -+halbtc8821c1ant_set_tdma_timer_base(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ u16 tbtt_interval = 100; -+ u8 h2c_para[2] = {0xb, 0x1}; -+ -+ btc->btc_get(btc, BTC_GET_U2_BEACON_PERIOD, &tbtt_interval); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], tbtt_interval = %d\n", tbtt_interval); -+ BTC_TRACE(trace_buf); -+ -+ /* Add for JIRA coex-256 */ -+ if (type == 3 && tbtt_interval >= 100) { /* 50ms-slot */ -+ if (coex_sta->tdma_timer_base == 3) -+ return; -+ -+ h2c_para[1] = (tbtt_interval / 50) - 1; -+ h2c_para[1] = h2c_para[1] | 0xc0; /* 50ms-slot */ -+ coex_sta->tdma_timer_base = 3; -+ } else if (tbtt_interval < 80 && tbtt_interval > 0) { -+ if (coex_sta->tdma_timer_base == 2) -+ return; -+ h2c_para[1] = (100 / tbtt_interval); -+ -+ if (100 % tbtt_interval != 0) -+ h2c_para[1] = h2c_para[1] + 1; -+ -+ h2c_para[1] = h2c_para[1] & 0x3f; -+ coex_sta->tdma_timer_base = 2; -+ } else if (tbtt_interval >= 180) { -+ if (coex_sta->tdma_timer_base == 1) -+ return; -+ h2c_para[1] = (tbtt_interval / 100); -+ -+ if (tbtt_interval % 100 <= 80) -+ h2c_para[1] = h2c_para[1] - 1; -+ -+ h2c_para[1] = h2c_para[1] & 0x3f; -+ h2c_para[1] = h2c_para[1] | 0x80; -+ coex_sta->tdma_timer_base = 1; -+ } else { -+ if (coex_sta->tdma_timer_base == 0) -+ return; -+ h2c_para[1] = 0x1; -+ coex_sta->tdma_timer_base = 0; -+ } -+ -+ btc->btc_fill_h2c(btc, 0x69, 2, h2c_para); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s() h2c_0x69 = 0x%x\n", __func__, h2c_para[1]); -+ BTC_TRACE(trace_buf); -+} -+ -+static -+void halbtc8821c1ant_low_penalty_ra(struct btc_coexist *btc, -+ boolean force_exec, boolean low_penalty_ra, -+ u8 thres) -+{ -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ static u8 cur_thres; -+ -+ if (!force_exec) { -+ if (low_penalty_ra == coex_dm->cur_low_penalty_ra && -+ thres == cur_thres) -+ return; -+ } -+ -+ if (low_penalty_ra) -+ btc->btc_phydm_modify_RA_PCR_threshold(btc, 0, thres); -+ else -+ btc->btc_phydm_modify_RA_PCR_threshold(btc, 0, 0); -+ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ cur_thres = thres; -+} -+ -+static -+void halbtc8821c1ant_write_scbd(struct btc_coexist *btc, u16 bitpos, -+ boolean state) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ static u16 originalval = 0x8002, preval; -+ -+ if (state) -+ originalval = originalval | bitpos; -+ else -+ originalval = originalval & (~bitpos); -+ -+ coex_sta->score_board_WB = originalval; -+ -+ if (originalval != preval) { -+ preval = originalval; -+ btc->btc_write_2byte(btc, 0xaa, originalval); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s: return for nochange\n", __func__); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+static -+void halbtc8821c1ant_read_scbd(struct btc_coexist *btc, -+ u16 *score_board_val) -+{ -+ *score_board_val = (btc->btc_read_2byte(btc, 0xaa)) & 0x7fff; -+} -+ -+static -+void halbtc8821c1ant_query_bt_info(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ u8 h2c_parameter[1] = {0}; -+ -+ if (coex_sta->bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No query BT info because BT is disabled!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btc->btc_fill_h2c(btc, 0x61, 1, h2c_parameter); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WL query BT info!!\n"); -+ BTC_TRACE(trace_buf); -+} -+ -+static -+void halbtc8821c1ant_enable_gnt_to_gpio(struct btc_coexist *btc, -+ boolean isenable) -+{ -+ static u8 bit_val[5] = {0, 0, 0, 0, 0}; -+ static boolean state; -+ -+ if (!btc->dbg_mode) -+ return; -+ -+ if (state == isenable) -+ return; -+ -+ state = isenable; -+ -+ if (isenable) { -+ /* enable GNT_WL, GNT_BT to GPIO for debug */ -+ btc->btc_write_1byte_bitmask(btc, 0x73, 0x8, 0x1); -+ -+ /* store original value */ -+ /*0x66[4] */ -+ bit_val[0] = (btc->btc_read_1byte(btc, 0x66) & BIT(4)) >> 4; -+ /*0x66[8] */ -+ bit_val[1] = (btc->btc_read_1byte(btc, 0x67) & BIT(0)); -+ /*0x40[19] */ -+ bit_val[2] = (btc->btc_read_1byte(btc, 0x42) & BIT(3)) >> 3; -+ /*0x64[15] */ -+ bit_val[3] = (btc->btc_read_1byte(btc, 0x65) & BIT(7)) >> 7; -+ /*0x70[18] */ -+ bit_val[4] = (btc->btc_read_1byte(btc, 0x72) & BIT(2)) >> 2; -+ -+ /* switch GPIO Mux */ -+ /*0x66[4] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x66, BIT(4), 0x0); -+ /*0x66[8] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, BIT(0), 0x0); -+ /*0x40[19] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x42, BIT(3), 0x0); -+ /*0x64[15] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x65, BIT(7), 0x0); -+ /*0x70[18] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x72, BIT(2), 0x0); -+ } else { -+ btc->btc_write_1byte_bitmask(btc, 0x73, 0x8, 0x0); -+ -+ /* Restore original value */ -+ /* switch GPIO Mux */ -+ /*0x66[4] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x66, BIT(4), bit_val[0]); -+ /*0x66[8] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, BIT(0), bit_val[1]); -+ /*0x40[19] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x42, BIT(3), bit_val[2]); -+ /*0x64[15] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x65, BIT(7), bit_val[3]); -+ /*0x70[18] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x72, BIT(2), bit_val[4]); -+ } -+} -+ -+static -+boolean halbtc8821c1ant_monitor_bt_ctr(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp, cnt_bt_all; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u8 cnt_overhead; -+ static u32 cnt_bt_pre = 0; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ boolean is_run_coex = FALSE; -+ -+ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ -+ /* if (! (btc->btc_read_1byte(btc, 0x76e) & 0x8) ) */ -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btc->btc_read_4byte(btc, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btc->btc_read_4byte(btc, 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 */ -+ btc->btc_write_1byte(btc, 0x76e, 0xc); -+ -+ if (coex_sta->under_lps || 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)) -+ coex_sta->bt_ctr_ok = FALSE; -+ else -+ coex_sta->bt_ctr_ok = TRUE; -+ -+ if (!coex_sta->bt_ctr_ok) -+ return FALSE; -+ -+ if (coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_NCON_IDLE) { -+ if (coex_sta->high_priority_rx >= 15) { -+ if (cnt_overhead < 3) -+ cnt_overhead++; -+ if (cnt_overhead == 3) -+ coex_sta->is_hi_pri_rx_overhead = TRUE; -+ } else { -+ if (cnt_overhead > 0) -+ cnt_overhead--; -+ if (cnt_overhead == 0) -+ coex_sta->is_hi_pri_rx_overhead = FALSE; -+ } -+ } else { -+ coex_sta->is_hi_pri_rx_overhead = FALSE; -+ } -+ -+ if (coex_sta->low_priority_tx > 1150 && !coex_sta->c2h_bt_inquiry_page) -+ coex_sta->pop_event_cnt++; -+ -+ if (bt_link_info->hid_only) { -+ if (coex_sta->low_priority_tx > 100) -+ coex_sta->is_hid_low_pri_tx_overhead = true; -+ else -+ coex_sta->is_hid_low_pri_tx_overhead = false; -+ } -+ -+ cnt_bt_all = coex_sta->high_priority_tx + -+ coex_sta->high_priority_rx + -+ coex_sta->low_priority_tx + -+ coex_sta->low_priority_rx; -+ -+ if ((cnt_bt_pre > (cnt_bt_all + 50) || -+ cnt_bt_all > (cnt_bt_pre + 50)) && -+ coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_NCON_IDLE) -+ is_run_coex = TRUE; -+ -+ cnt_bt_pre = cnt_bt_all; -+ -+ return is_run_coex; -+} -+ -+static -+void halbtc8821c1ant_monitor_wifi_ctr(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ boolean wifi_busy = FALSE, wifi_scan = FALSE; -+ static u8 wl_noisy_count0, wl_noisy_count1 = 3, wl_noisy_count2; -+ u32 cnt_cck, fw_ver = 0; -+ static u8 cnt_ccklocking; -+ u8 h2c_parameter[1] = {0}; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_SCAN, &wifi_scan); -+ btc->btc_get(btc, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ -+ /* Only enable for windows in old fw version (COEX-308) -+ * because 8821cu H2C 0x69 unknown fail @ linux -+ */ -+ if (btc->chip_interface != BTC_INTF_USB || -+ (fw_ver < 0x170000 && fw_ver < 0x17000c) || -+ (fw_ver < 0x180000 && fw_ver < 0x180009) || -+ (fw_ver < 0x190000 && fw_ver < 0x190002)) { -+ /*send h2c to query WL FW dbg info */ -+ if (coex_dm->cur_ps_tdma_on) { -+ h2c_parameter[0] = 0x8; -+ btc->btc_fill_h2c(btc, 0x69, 1, h2c_parameter); -+ } -+ } -+ -+ coex_sta->crc_ok_cck = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_OK_CCK); -+ coex_sta->crc_ok_11g = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_OK_LEGACY); -+ coex_sta->crc_ok_11n = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_OK_HT); -+ coex_sta->crc_ok_11n_vht = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_OK_VHT); -+ -+ coex_sta->crc_err_cck = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_ERROR_CCK); -+ coex_sta->crc_err_11g = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_ERROR_LEGACY); -+ coex_sta->crc_err_11n = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_ERROR_HT); -+ coex_sta->crc_err_11n_vht = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_ERROR_VHT); -+ -+ /* CCK lock identification */ -+ if (coex_sta->cck_lock) -+ cnt_ccklocking++; -+ else if (cnt_ccklocking != 0) -+ cnt_ccklocking--; -+ -+ if (cnt_ccklocking >= 3) { -+ cnt_ccklocking = 3; -+ coex_sta->cck_lock_ever = TRUE; -+ } -+ -+ /* WiFi environment noisy identification */ -+ cnt_cck = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; -+ -+ if (!wifi_busy && !coex_sta->cck_lock) { -+ if (cnt_cck > 250) { -+ if (wl_noisy_count2 < 3) -+ wl_noisy_count2++; -+ -+ if (wl_noisy_count2 == 3) { -+ wl_noisy_count0 = 0; -+ wl_noisy_count1 = 0; -+ } -+ -+ } else if (cnt_cck < 100) { -+ 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; -+ } -+} -+ -+static -+void halbtc8821c1ant_monitor_bt_enable(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ static u32 bt_disable_cnt; -+ boolean bt_active = TRUE, bt_disabled = FALSE; -+ u16 u16tmp; -+ -+ /* Read BT on/off status from scoreboard[1], -+ * enable this only if BT patch support this feature -+ */ -+ halbtc8821c1ant_read_scbd(btc, &u16tmp); -+ bt_active = u16tmp & BIT(1); -+ -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = FALSE; -+ btc->btc_set(btc, BTC_SET_BL_BT_DISABLE, &bt_disabled); -+ } else { -+ bt_disable_cnt++; -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = TRUE; -+ bt_disable_cnt = 2; -+ } -+ -+ btc->btc_set(btc, 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; -+ -+ /*for win10 BT disable->enable trigger wifi scan issue */ -+ if (!coex_sta->bt_disabled) { -+ coex_sta->is_bt_reenable = TRUE; -+ coex_sta->cnt_bt_reenable = 15; -+ } else { -+ coex_sta->is_bt_reenable = FALSE; -+ coex_sta->cnt_bt_reenable = 0; -+ } -+ } -+} -+ -+static -+boolean halbtc8821c1ant_moniter_wifibt_status(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct rfe_type_8821c_1ant *rfe_type = &btc->rfe_type_8821c_1ant; -+ struct wifi_link_info_8821c_1ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_1ant; -+ static boolean pre_wifi_busy, pre_under_4way, -+ pre_bt_off, -+ pre_bt_slave, pre_hid_low_pri_tx_overhead, -+ pre_wifi_under_lps, pre_bt_setup_link, -+ pre_cck_lock, pre_cck_lock_warn; -+ static u8 pre_hid_busy_num, pre_wl_noisy_level; -+ boolean wifi_busy = FALSE, under_4way = FALSE; -+ boolean wifi_connected = FALSE; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ static u8 cnt_wifi_busytoidle; -+ u32 num_of_wifi_link = 0, wifi_link_mode = 0; -+ static u32 pre_num_of_wifi_link, pre_wifi_link_mode; -+ boolean miracast_plus_bt = FALSE; -+ u8 lna_lvl = 1; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &under_4way); -+ -+ if (wifi_busy) { -+ coex_sta->gl_wifi_busy = TRUE; -+ cnt_wifi_busytoidle = 6; -+ } else { -+ if (coex_sta->gl_wifi_busy && cnt_wifi_busytoidle > 0) -+ cnt_wifi_busytoidle--; -+ else if (cnt_wifi_busytoidle == 0) -+ coex_sta->gl_wifi_busy = FALSE; -+ } -+ -+ 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; -+ coex_sta->bt_a2dp_vendor_id = 0; -+ coex_sta->bt_a2dp_device_name = 0; -+ btc->bt_info.bt_get_fw_ver = 0; -+ return TRUE; -+ } -+ -+ num_of_wifi_link = wifi_link_info_ext->num_of_active_port; -+ -+ if (num_of_wifi_link != pre_num_of_wifi_link) { -+ pre_num_of_wifi_link = num_of_wifi_link; -+ -+ if (wifi_link_info_ext->is_p2p_connected) { -+ if (bt_link_info->bt_link_exist) -+ miracast_plus_bt = TRUE; -+ else -+ miracast_plus_bt = FALSE; -+ -+ btc->btc_set(btc, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ return TRUE; -+ } -+ -+ wifi_link_mode = btc->wifi_link_info.link_mode; -+ if (wifi_link_mode != pre_wifi_link_mode) { -+ pre_wifi_link_mode = wifi_link_mode; -+ 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 (coex_sta->wl_noisy_level != pre_wl_noisy_level) { -+ pre_wl_noisy_level = coex_sta->wl_noisy_level; -+ return TRUE; -+ } -+ if (coex_sta->under_lps != pre_wifi_under_lps) { -+ pre_wifi_under_lps = coex_sta->under_lps; -+ if (coex_sta->under_lps) -+ return TRUE; -+ } -+ if (coex_sta->cck_lock != pre_cck_lock) { -+ pre_cck_lock = coex_sta->cck_lock; -+ return TRUE; -+ } -+ if (coex_sta->cck_lock_warn != pre_cck_lock_warn) { -+ pre_cck_lock_warn = coex_sta->cck_lock_warn; -+ return TRUE; -+ } -+ } -+ -+ if (!coex_sta->bt_disabled) { -+#if 0 -+ if (coex_sta->acl_busy != pre_bt_acl_busy) { -+ pre_bt_acl_busy = coex_sta->acl_busy; -+ btc->btc_set(btc, BTC_SET_BL_BT_LNA_CONSTRAIN_LEVEL, -+ &lna_lvl); -+ return TRUE; -+ } -+#endif -+ 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; -+ } -+ -+ if (pre_hid_low_pri_tx_overhead != -+ coex_sta->is_hid_low_pri_tx_overhead) { -+ pre_hid_low_pri_tx_overhead = -+ coex_sta->is_hid_low_pri_tx_overhead; -+ return TRUE; -+ } -+ -+ if (pre_bt_setup_link != coex_sta->is_setup_link) { -+ pre_bt_setup_link = coex_sta->is_setup_link; -+ return TRUE; -+ } -+ } -+ return FALSE; -+} -+ -+static -+void halbtc8821c1ant_update_wifi_link_info(struct btc_coexist *btc, u8 reason) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct wifi_link_info_8821c_1ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_1ant; -+ struct btc_wifi_link_info wifi_link_info; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ u8 wifi_central_chnl = 0, num_of_wifi_link = 0; -+ boolean isunder5G = FALSE, ismcc25g = FALSE, isp2pconnected = FALSE; -+ u32 wifi_link_status = 0; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_link_info_ext->is_connected); -+ -+ btc->btc_get(btc, BTC_GET_U4_WIFI_LINK_STATUS, &wifi_link_status); -+ wifi_link_info_ext->port_connect_status = wifi_link_status & 0xffff; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_LINK_INFO, &wifi_link_info); -+ btc->wifi_link_info = wifi_link_info; -+ -+ btc->btc_get(btc, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifi_central_chnl); -+ coex_sta->wl_center_channel = wifi_central_chnl; -+ -+ /* Check scan/connect/special-pkt action first */ -+ switch (reason) { -+ case BT_8821C_1ANT_RSN_5GSCANSTART: -+ case BT_8821C_1ANT_RSN_5GSWITCHBAND: -+ case BT_8821C_1ANT_RSN_5GCONSTART: -+ isunder5G = TRUE; -+ break; -+ case BT_8821C_1ANT_RSN_2GSCANSTART: -+ case BT_8821C_1ANT_RSN_2GSWITCHBAND: -+ case BT_8821C_1ANT_RSN_2GCONSTART: -+ isunder5G = FALSE; -+ break; -+ case BT_8821C_1ANT_RSN_2GCONFINISH: -+ case BT_8821C_1ANT_RSN_5GCONFINISH: -+ case BT_8821C_1ANT_RSN_2GMEDIA: -+ case BT_8821C_1ANT_RSN_5GMEDIA: -+ case BT_8821C_1ANT_RSN_BTINFO: -+ case BT_8821C_1ANT_RSN_PERIODICAL: -+ case BT_8821C_1ANT_RSN_5GSPECIALPKT: -+ case BT_8821C_1ANT_RSN_2GSPECIALPKT: -+ default: -+ switch (wifi_link_info.link_mode) { -+ case BTC_LINK_5G_MCC_GO_STA: -+ case BTC_LINK_5G_MCC_GC_STA: -+ case BTC_LINK_5G_SCC_GO_STA: -+ case BTC_LINK_5G_SCC_GC_STA: -+ isunder5G = TRUE; -+ break; -+ case BTC_LINK_2G_MCC_GO_STA: -+ case BTC_LINK_2G_MCC_GC_STA: -+ case BTC_LINK_2G_SCC_GO_STA: -+ case BTC_LINK_2G_SCC_GC_STA: -+ isunder5G = FALSE; -+ break; -+ case BTC_LINK_25G_MCC_GO_STA: -+ case BTC_LINK_25G_MCC_GC_STA: -+ isunder5G = FALSE; -+ ismcc25g = TRUE; -+ break; -+ case BTC_LINK_ONLY_STA: -+ if (wifi_link_info.sta_center_channel > 14) -+ isunder5G = TRUE; -+ else -+ isunder5G = FALSE; -+ break; -+ case BTC_LINK_ONLY_GO: -+ case BTC_LINK_ONLY_GC: -+ case BTC_LINK_ONLY_AP: -+ default: -+ if (wifi_link_info.p2p_center_channel > 14) -+ isunder5G = TRUE; -+ else -+ isunder5G = FALSE; -+ -+ break; -+ } -+ break; -+ } -+ -+ wifi_link_info_ext->is_all_under_5g = isunder5G; -+ wifi_link_info_ext->is_mcc_25g = ismcc25g; -+ -+ if (wifi_link_status & WIFI_STA_CONNECTED) -+ num_of_wifi_link++; -+ -+ if (wifi_link_status & WIFI_AP_CONNECTED) -+ num_of_wifi_link++; -+ -+ if (wifi_link_status & WIFI_P2P_GO_CONNECTED) { -+ num_of_wifi_link++; -+ isp2pconnected = TRUE; -+ } -+ -+ if (wifi_link_status & WIFI_P2P_GC_CONNECTED) { -+ num_of_wifi_link++; -+ isp2pconnected = TRUE; -+ } -+ -+ wifi_link_info_ext->num_of_active_port = num_of_wifi_link; -+ wifi_link_info_ext->is_p2p_connected = isp2pconnected; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_link_info: link_mode=%d, STA_Ch=%d, P2P_Ch=%d, AnyClient_Join_Go=%d !\n", -+ btc->wifi_link_info.link_mode, -+ btc->wifi_link_info.sta_center_channel, -+ btc->wifi_link_info.p2p_center_channel, -+ btc->wifi_link_info.bany_client_join_go); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_link_info: center_ch=%d, is_all_under_5g=%d, is_mcc_25g=%d!\n", -+ coex_sta->wl_center_channel, -+ wifi_link_info_ext->is_all_under_5g, -+ wifi_link_info_ext->is_mcc_25g); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_link_info: port_connect_status=0x%x, active_port_cnt=%d, P2P_Connect=%d!\n", -+ wifi_link_info_ext->port_connect_status, -+ wifi_link_info_ext->num_of_active_port, -+ wifi_link_info_ext->is_p2p_connected); -+ BTC_TRACE(trace_buf); -+ -+ switch (reason) { -+ case BT_8821C_1ANT_RSN_2GSCANSTART: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "2GSCANSTART"); -+ break; -+ case BT_8821C_1ANT_RSN_5GSCANSTART: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "5GSCANSTART"); -+ break; -+ case BT_8821C_1ANT_RSN_SCANFINISH: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "SCANFINISH"); -+ break; -+ case BT_8821C_1ANT_RSN_2GSWITCHBAND: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "2GSWITCHBAND"); -+ break; -+ case BT_8821C_1ANT_RSN_5GSWITCHBAND: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "5GSWITCHBAND"); -+ break; -+ case BT_8821C_1ANT_RSN_2GCONSTART: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "2GCONNECTSTART"); -+ break; -+ case BT_8821C_1ANT_RSN_5GCONSTART: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "5GCONNECTSTART"); -+ break; -+ case BT_8821C_1ANT_RSN_2GCONFINISH: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", -+ "2GCONNECTFINISH"); -+ break; -+ case BT_8821C_1ANT_RSN_5GCONFINISH: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", -+ "5GCONNECTFINISH"); -+ break; -+ case BT_8821C_1ANT_RSN_2GMEDIA: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "2GMEDIASTATUS"); -+ break; -+ case BT_8821C_1ANT_RSN_5GMEDIA: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "5GMEDIASTATUS"); -+ break; -+ case BT_8821C_1ANT_RSN_MEDIADISCON: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", -+ "MEDIADISCONNECT"); -+ break; -+ case BT_8821C_1ANT_RSN_2GSPECIALPKT: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "2GSPECIALPKT"); -+ break; -+ case BT_8821C_1ANT_RSN_5GSPECIALPKT: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "5GSPECIALPKT"); -+ break; -+ case BT_8821C_1ANT_RSN_BTINFO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "BTINFO"); -+ break; -+ case BT_8821C_1ANT_RSN_PERIODICAL: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "PERIODICAL"); -+ break; -+ case BT_8821C_1ANT_RSN_PNP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "PNPNotify"); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "UNKNOWN"); -+ break; -+ } -+ -+ BTC_TRACE(trace_buf); -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (wifi_link_info_ext->is_all_under_5g || num_of_wifi_link == 0 || -+ coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_NCON_IDLE) { -+ halbtc8821c1ant_low_penalty_ra(btc, NM_EXCU, FALSE, 0); -+ halbtc8821c1ant_limited_tx(btc, NM_EXCU, FALSE, FALSE); -+ halbtc8821c1ant_limited_rx(btc, NM_EXCU, FALSE, TRUE, 64); -+ } else if (wifi_link_info_ext->num_of_active_port > 1) { -+ halbtc8821c1ant_low_penalty_ra(btc, NM_EXCU, TRUE, 30); -+ halbtc8821c1ant_limited_tx(btc, NM_EXCU, FALSE, TRUE); -+ halbtc8821c1ant_limited_rx(btc, NM_EXCU, FALSE, TRUE, 16); -+ } else { -+ halbtc8821c1ant_low_penalty_ra(btc, NM_EXCU, TRUE, 15); -+ -+ if (coex_sta->hid_exist || coex_sta->hid_pair_cnt > 0 || -+ coex_sta->sco_exist) { -+ halbtc8821c1ant_limited_tx(btc, NM_EXCU, TRUE, TRUE); -+ if (coex_sta->bt_ble_hid_exist && -+ coex_sta->wl_iot_peer != BTC_IOT_PEER_ATHEROS) -+ halbtc8821c1ant_limited_rx(btc, NM_EXCU, FALSE, -+ TRUE, 4); -+ } else { -+ halbtc8821c1ant_limited_tx(btc, NM_EXCU, TRUE, FALSE); -+ halbtc8821c1ant_limited_rx(btc, NM_EXCU, FALSE, TRUE, -+ 64); -+ } -+ -+ } -+ /* coex-276 P2P-Go beacon request can't release issue -+ * Only PCIe/USB can set 0x454[6] = 1 to solve this issue, -+ * WL SDIO/USB interface need driver support. -+ */ -+#ifdef PLATFORM_WINDOWS -+ if (btc->chip_interface != BTC_INTF_SDIO) -+ btc->btc_write_1byte_bitmask(btc, 0x454, BIT(6), 0x1); -+ else -+ btc->btc_write_1byte_bitmask(btc, 0x454, BIT(6), 0x0); -+#endif -+} -+ -+static -+void halbtc8821c1ant_update_bt_link_info(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ boolean bt_busy = FALSE, increase_scan_dev_num = FALSE; -+ u32 val = 0; -+ static u8 pre_num_of_profile, cur_num_of_profile, cnt, ble_cnt; -+ -+ if (++ble_cnt >= 3) -+ ble_cnt = 0; -+ -+ if (coex_sta->is_ble_scan_en && ble_cnt == 0) { -+ 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 = -+ btc->btc_get_ble_scan_type_from_bt(btc); -+ -+ if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) -+ coex_sta->bt_ble_scan_para[0] = -+ btc->btc_get_ble_scan_para_from_bt(btc, 0x1); -+ if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) -+ coex_sta->bt_ble_scan_para[1] = -+ btc->btc_get_ble_scan_para_from_bt(btc, 0x2); -+ if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) -+ coex_sta->bt_ble_scan_para[2] = -+ btc->btc_get_ble_scan_para_from_bt(btc, 0x4); -+ } -+ -+ coex_sta->num_of_profile = 0; -+ -+ /* set link exist status */ -+ if (!(coex_sta->bt_info_lb2 & 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->msft_mr_exist = FALSE; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = TRUE; -+ if (coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_FTP) { -+ coex_sta->pan_exist = TRUE; -+ coex_sta->num_of_profile++; -+ } else { -+ coex_sta->pan_exist = FALSE; -+ } -+ -+ if (coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_A2DP) { -+ coex_sta->a2dp_exist = TRUE; -+ coex_sta->num_of_profile++; -+ } else { -+ coex_sta->a2dp_exist = FALSE; -+ } -+ -+ if (coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_HID) { -+ coex_sta->hid_exist = TRUE; -+ coex_sta->num_of_profile++; -+ } else { -+ coex_sta->hid_exist = FALSE; -+ } -+ -+ if (coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_SCO_ESCO) { -+ coex_sta->sco_exist = TRUE; -+ coex_sta->num_of_profile++; -+ } else { -+ coex_sta->sco_exist = FALSE; -+ } -+#if 0 -+ if (coex_sta->hid_busy_num == 0 && -+ coex_sta->hid_pair_cnt > 0 && -+ coex_sta->low_priority_tx > 1000 && -+ coex_sta->low_priority_rx > 1000 && -+ !coex_sta->c2h_bt_inquiry_page) -+ coex_sta->msft_mr_exist = true; -+ else -+ coex_sta->msft_mr_exist = false; -+#endif -+ } -+ -+ 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; -+ -+ /* 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_lb2 & BT_INFO_8821C_1ANT_B_INQ_PAGE) { -+ coex_dm->bt_status = BT_8821C_1ANT_BSTATUS_INQ_PAGE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); -+ } else if (!(coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8821C_1ANT_BSTATUS_NCON_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ } else if (coex_sta->bt_info_lb2 == BT_INFO_8821C_1ANT_B_CONNECTION) { -+ /* connection exists but no busy */ -+ -+ if (coex_sta->msft_mr_exist) { -+ coex_dm->bt_status = BT_8821C_1ANT_BSTATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!\n"); -+ } else { -+ coex_dm->bt_status = BT_8821C_1ANT_BSTATUS_CON_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ } -+ } else if (((coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_SCO_ESCO) || -+ (coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_SCO_BUSY)) && -+ (coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_ACL_BUSY)) { -+ coex_dm->bt_status = BT_8821C_1ANT_BSTATUS_ACL_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); -+ } else if ((coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_SCO_ESCO) || -+ (coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8821C_1ANT_BSTATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ } else if (coex_sta->bt_info_lb2 & BT_INFO_8821C_1ANT_B_ACL_BUSY) { -+ coex_dm->bt_status = BT_8821C_1ANT_BSTATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ } else { -+ coex_dm->bt_status = BT_8821C_1ANT_BSTATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ } -+ -+ BTC_TRACE(trace_buf); -+ -+ if (coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_ACL_BUSY || -+ coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_SCO_BUSY || -+ coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_ACL_SCO_BUSY) { -+ bt_busy = TRUE; -+ increase_scan_dev_num = TRUE; -+ } else { -+ bt_busy = FALSE; -+ increase_scan_dev_num = FALSE; -+ } -+ -+ btc->btc_set(btc, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ btc->btc_set(btc, BTC_SET_BL_INC_SCAN_DEV_NUM, &increase_scan_dev_num); -+ -+ cur_num_of_profile = coex_sta->num_of_profile; -+ -+ if (cur_num_of_profile != pre_num_of_profile) -+ cnt = 2; -+ -+ if (bt_link_info->a2dp_exist && cnt > 0) { -+ cnt--; -+ if (coex_sta->bt_a2dp_vendor_id == 0 && -+ coex_sta->bt_a2dp_device_name == 0) { -+ btc->btc_get(btc, BTC_GET_U4_BT_DEVICE_INFO, &val); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), get BT DEVICE_INFO = %x\n", -+ val); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_a2dp_vendor_id = (u8)(val & 0xff); -+ coex_sta->bt_a2dp_device_name = (val & 0xffffff00) >> 8; -+ -+ btc->btc_get(btc, BTC_GET_U4_BT_A2DP_FLUSH_VAL, &val); -+ coex_sta->bt_a2dp_flush_time = val; -+ } -+ } else if (!bt_link_info->a2dp_exist) { -+ coex_sta->bt_a2dp_vendor_id = 0; -+ coex_sta->bt_a2dp_device_name = 0; -+ coex_sta->bt_a2dp_flush_time = 0; -+ } -+ -+ pre_num_of_profile = coex_sta->num_of_profile; -+} -+ -+static -+void halbtc8821c1ant_update_wifi_ch_info(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ struct wifi_link_info_8821c_1ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_1ant; -+ u8 h2c_parameter[3] = {0}, i; -+ u32 wifi_bw; -+ u8 wl_ch = 0; -+ u8 wl_5g_ch[] = {0}; -+ u8 bt_skip_ch[] = {0}; -+ u8 bt_skip_span[] = {0}; -+ -+ if (btc->manual_control) -+ return; -+ -+ btc->btc_get(btc, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (btc->stop_coex_dm || btc->wl_rf_state_off) { -+ wl_ch = 0; -+ } else if (type != BTC_MEDIA_DISCONNECT || -+ (type == BTC_MEDIA_DISCONNECT && -+ wifi_link_info_ext->num_of_active_port > 0)) { -+ if (wifi_link_info_ext->num_of_active_port == 1) { -+ if (wifi_link_info_ext->is_p2p_connected) -+ wl_ch = btc->wifi_link_info.p2p_center_channel; -+ else -+ wl_ch = btc->wifi_link_info.sta_center_channel; -+ } else { /* port > 2 */ -+ if (btc->wifi_link_info.p2p_center_channel > 14 && -+ btc->wifi_link_info.sta_center_channel > 14) -+ wl_ch = btc->wifi_link_info.p2p_center_channel; -+ else if (btc->wifi_link_info.p2p_center_channel <= 14) -+ wl_ch = btc->wifi_link_info.p2p_center_channel; -+ else if (btc->wifi_link_info.sta_center_channel <= 14) -+ wl_ch = btc->wifi_link_info.sta_center_channel; -+ } -+ } -+ -+ if (wl_ch > 0) { -+ if (wl_ch <= 14) { -+ /* no AFH notify for shared-antenna */ -+ h2c_parameter[0] = 0x0; -+ h2c_parameter[1] = 0x0; -+ h2c_parameter[2] = 0x0; -+#if 0 -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = wl_ch; -+ -+ if (wifi_bw == BTC_WIFI_BW_HT40) -+ h2c_parameter[2] = 0x36; -+ else -+ h2c_parameter[2] = 0x24; -+#endif -+ } -+ } -+ -+ /* Only send mailbox if ch info change */ -+ if (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]) { -+ -+ 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]; -+ btc->btc_fill_h2c(btc, 0x66, 3, h2c_parameter); -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], para[0:2] = 0x%x 0x%x 0x%x\n", h2c_parameter[0], -+ h2c_parameter[1], h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+} -+ -+static u32 -+halbtc8821c1ant_wait_indirect_reg_ready(struct btc_coexist *btc) -+{ -+ u32 delay_count = 0; -+ -+ /* wait for ready bit before access 0x1700 */ -+ while (1) { -+ if ((btc->btc_read_1byte(btc, 0x1703) & BIT(5)) == 0) { -+ delay_ms(10); -+ if (++delay_count >= 10) -+ break; -+ } else { -+ break; -+ } -+ } -+ -+ return delay_count; -+} -+ -+static -+u32 halbtc8821c1ant_read_indirect_reg(struct btc_coexist *btc, u16 reg_addr) -+{ -+ u32 j = 0, delay_count = 0; -+ -+ /* wait for ready bit before access 0x1700 */ -+ halbtc8821c1ant_wait_indirect_reg_ready(btc); -+ -+ btc->btc_write_4byte(btc, 0x1700, 0x800F0000 | reg_addr); -+ -+ return btc->btc_read_4byte(btc, 0x1708); -+} -+ -+static -+void halbtc8821c1ant_write_indirect_reg(struct btc_coexist *btc, u16 reg_addr, -+ u32 bit_mask, u32 reg_value) -+{ -+ u32 val, i = 0, j = 0, bitpos = 0, delay_count = 0; -+ -+ if (bit_mask == 0x0) -+ return; -+ -+ if (bit_mask == 0xffffffff) { -+ /* wait for ready bit before access 0x1700/0x1704 */ -+ halbtc8821c1ant_wait_indirect_reg_ready(btc); -+ -+ /* put write data */ -+ btc->btc_write_4byte(btc, 0x1704, reg_value); -+ -+ btc->btc_write_4byte(btc, 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_read_indirect_reg(btc, reg_addr); -+ val = (val & (~bit_mask)) | (reg_value << bitpos); -+ -+ /* wait for ready bit before access 0x1700/0x1704 */ -+ halbtc8821c1ant_wait_indirect_reg_ready(btc); -+ -+ /* put write data */ -+ btc->btc_write_4byte(btc, 0x1704, val); -+ btc->btc_write_4byte(btc, 0x1700, 0xc00F0000 | reg_addr); -+ } -+} -+ -+static -+void halbtc8821c1ant_ltecoex_enable(struct btc_coexist *btc, boolean enable) -+{ -+ u8 val; -+ -+ /* 0x38[7] */ -+ val = (enable) ? 1 : 0; -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, BIT(7), val); -+} -+ -+static -+void halbtc8821c1ant_ltecoex_table(struct btc_coexist *btc, u8 table_type, -+ u16 val) -+{ -+ 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; -+ } -+ -+ /* 0xa0[15:0] or 0xa4[15:0] */ -+ if (reg_addr != 0x0000) -+ halbtc8821c1ant_write_indirect_reg(btc, reg_addr, 0xffff, val); -+} -+ -+static -+void halbtc8821c1ant_coex_ctrl_owner(struct btc_coexist *btc, -+ boolean wifi_control) -+{ -+ u8 val; -+ -+ /* 0x70[26] */ -+ val = (wifi_control) ? 1 : 0; -+ btc->btc_write_1byte_bitmask(btc, 0x73, BIT(2), val); -+} -+ -+static void -+halbtc8821c1ant_set_gnt_bt(struct btc_coexist *btc, u8 state) -+{ -+ switch (state) { -+ case BTC_GNT_SET_SW_LOW: -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0xc000, 0x1); -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0x0c00, 0x1); -+ break; -+ case BTC_GNT_SET_SW_HIGH: -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0xc000, 0x3); -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0x0c00, 0x3); -+ break; -+ case BTC_GNT_SET_HW_PTA: -+ default: -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0xc000, 0x0); -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0x0c00, 0x0); -+ break; -+ } -+} -+ -+static void -+halbtc8821c1ant_set_gnt_wl(struct btc_coexist *btc, u8 state) -+{ -+ switch (state) { -+ case BTC_GNT_SET_SW_LOW: -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0x3000, 0x1); -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0x0300, 0x1); -+ break; -+ case BTC_GNT_SET_SW_HIGH: -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0x3000, 0x3); -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0x0300, 0x3); -+ break; -+ case BTC_GNT_SET_HW_PTA: -+ default: -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0x3000, 0x0); -+ halbtc8821c1ant_write_indirect_reg(btc, 0x38, 0x0300, 0x0); -+ break; -+ } -+} -+ -+static -+void halbtc8821c1ant_set_table(struct btc_coexist *btc, boolean force_exec, -+ u32 val0x6c0, u32 val0x6c4, u32 val0x6c8, -+ u8 val0x6cc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ -+ if (!force_exec && !coex_sta->wl_slot_toggle_change) { -+ coex_dm->cur_val0x6c0 = btc->btc_read_4byte(btc, 0x6c0); -+ coex_dm->cur_val0x6c4 = btc->btc_read_4byte(btc, 0x6c4); -+ -+ if (val0x6c0 == coex_dm->cur_val0x6c0 && -+ val0x6c4 == coex_dm->cur_val0x6c4) -+ return; -+ } -+ -+ btc->btc_write_4byte(btc, 0x6c0, val0x6c0); -+ btc->btc_write_4byte(btc, 0x6c4, val0x6c4); -+ btc->btc_write_4byte(btc, 0x6c8, val0x6c8); -+ btc->btc_write_1byte(btc, 0x6cc, val0x6cc); -+ -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+} -+ -+static -+void halbtc8821c1ant_table(struct btc_coexist *btc, boolean force_exec, u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ u32 break_table; -+ u8 select_table; -+ -+ coex_sta->coex_table_type = type; -+ -+ if (coex_sta->concurrent_rx_mode_on == TRUE) { -+ /* set WL hi-pri can break BT */ -+ break_table = 0xf0ffffff; -+ /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ -+ select_table = 0x1b; -+ } else { -+ break_table = 0xffffff; -+ select_table = 0x13; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** Table-%d **********\n", -+ coex_sta->coex_table_type); -+ BTC_TRACE(trace_buf); -+ -+ switch (type) { -+ case 0: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x55555555, -+ 0x55555555, break_table, -+ select_table); -+ break; -+ case 1: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 2: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 3: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0x6a5a5aaa, break_table, -+ select_table); -+ break; -+ case 4: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 5: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x6a5a5a5a, -+ 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 6: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x6a5a56aa, -+ 0x6a5a56aa, break_table, -+ select_table); -+ break; -+ case 7: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0xaaaa5aaa, break_table, -+ select_table); -+ break; -+ case 8: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0x6aaa6aaa, break_table, -+ select_table); -+ break; -+ case 9: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 10: -+ halbtc8821c1ant_set_table(btc, force_exec, 0xaaaaaaaa, -+ 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 11: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0x6a5a5a5a, break_table, -+ select_table); -+ break; -+ case 12: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0x5aaa5a5a, break_table, -+ select_table); -+ break; -+ case 13: -+ halbtc8821c1ant_set_table(btc, force_exec, 0xaa5555aa, -+ 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 14: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x6a5a5aaa, -+ 0x6a5a5aaa, break_table, -+ select_table); -+ break; -+ case 15: -+ halbtc8821c1ant_set_table(btc, force_exec, 0xffffffff, -+ 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 16: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x55555555, -+ 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 17: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x55555555, -+ 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 18: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x656a656a, -+ 0x656a656a, break_table, -+ select_table); -+ break; -+ case 19: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0x66555555, break_table, -+ select_table); -+ break; -+ case 20: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x6a5a5a5a, -+ 0x6a5a5a5a, break_table, -+ select_table); -+ break; -+ case 21: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0x6a5a6a5a, break_table, -+ select_table); -+ break; -+ case 22: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x56555555, -+ 0x5a5a5aaa, break_table, -+ select_table); -+ break; -+ case 23: -+ halbtc8821c1ant_set_table(btc, force_exec, 0xffffffff, -+ 0x5aaa5aaa, break_table, -+ select_table); -+ break; -+ case 24: -+ halbtc8821c1ant_set_table(btc, force_exec, 0xffffffff, -+ 0x5a5a5aaa, break_table, -+ select_table); -+ break; -+ case 25: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x66555555, -+ 0x5a5a5aaa, break_table, -+ select_table); -+ break; -+ case 26: -+ halbtc8821c1ant_set_table(btc, force_exec, 0x6a555a5a, -+ 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ default: -+ break; -+ } -+} -+ -+static void -+halbtc8821c1ant_wltoggle_table(IN struct btc_coexist *btc, -+ 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 0 -+ 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; -+ } -+#endif -+ for (i = 1; i <= 5; i++) -+ pre_h2c_parameter[i] = cur_h2c_parameter[i]; -+ -+ btc->btc_fill_h2c(btc, 0x69, 6, cur_h2c_parameter); -+} -+ -+static -+void halbtc8821c1ant_ignore_wlan_act(struct btc_coexist *btc, -+ boolean force_exec, boolean enable) -+{ -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ u8 h2c_parameter[1] = {0}; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (!force_exec) { -+ if (enable == coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ -+ if (enable) -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ -+ btc->btc_fill_h2c(btc, 0x63, 1, h2c_parameter); -+ -+ coex_dm->cur_ignore_wlan_act = enable; -+} -+ -+static -+void halbtc8821c1ant_lps_rpwm(struct btc_coexist *btc, boolean force_exec, -+ u8 lps_val, u8 rpwm_val) -+{ -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ -+ if (!force_exec) { -+ if (lps_val == coex_dm->cur_lps && -+ rpwm_val == coex_dm->cur_rpwm) -+ return; -+ } -+ -+ btc->btc_set(btc, BTC_SET_U1_LPS_VAL, &lps_val); -+ btc->btc_set(btc, BTC_SET_U1_RPWM_VAL, &rpwm_val); -+ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+} -+ -+#if 0 -+static -+void halbtc8821c1ant_multiport_tdma(struct btc_coexist *btc, u8 multi_port_mode) -+{ -+ struct btc_multi_port_tdma_info multiport_tdma_para; -+ static u8 pre_state = BTC_MULTI_PORT_TDMA_MODE_NONE; -+ -+ if (multi_port_mode == pre_state) -+ return; -+ -+ multiport_tdma_para.btc_multi_port_tdma_mode = multi_port_mode; -+ -+ switch (multi_port_mode) { -+ case BTC_MULTI_PORT_TDMA_MODE_NONE: -+ multiport_tdma_para.start_time_from_bcn = 0; -+ multiport_tdma_para.bt_time = 0; -+ break; -+ case BTC_MULTI_PORT_TDMA_MODE_2G_SCC_GO: -+ multiport_tdma_para.start_time_from_bcn = 65; -+ multiport_tdma_para.bt_time = 35; -+ break; -+ case BTC_MULTI_PORT_TDMA_MODE_2G_P2P_GO: -+ multiport_tdma_para.start_time_from_bcn = 55; -+ multiport_tdma_para.bt_time = 45; -+ break; -+ } -+ -+ btc->btc_set(btc, BTC_SET_WIFI_BT_COEX_MODE, &multiport_tdma_para); -+ -+ pre_state = multi_port_mode; -+} -+#endif -+ -+static -+void halbtc8821c1ant_tdma_check(struct btc_coexist *btc, boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; -+ -+ btc->btc_get(btc, 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 */ -+ btc->btc_fill_h2c(btc, 0x60, 5, h2c_parameter); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ btc->btc_fill_h2c(btc, 0x60, 5, h2c_parameter); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+static -+boolean halbtc8821c1ant_power_save_state(struct btc_coexist *btc, u8 ps_type, -+ u8 lps_val, u8 rpwm_val) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ boolean low_pwr_disable = FALSE, result = TRUE; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ coex_sta->force_lps_ctrl = FALSE; -+ low_pwr_disable = FALSE; -+ /* btc->btc_set(btc, BTC_SET_ACT_DISABLE_LOW_POWER, -+ * &low_pwr_disable); -+ */ -+ btc->btc_set(btc, BTC_SET_ACT_PRE_NORMAL_LPS, NULL); -+ break; -+ case BTC_PS_LPS_ON: -+ coex_sta->force_lps_ctrl = TRUE; -+ halbtc8821c1ant_tdma_check(btc, TRUE); -+ halbtc8821c1ant_lps_rpwm(btc, NM_EXCU, lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = TRUE; -+ btc->btc_set(btc, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma.*/ -+ btc->btc_set(btc, BTC_SET_ACT_ENTER_LPS, NULL); -+ break; -+ case BTC_PS_LPS_OFF: -+ coex_sta->force_lps_ctrl = TRUE; -+ halbtc8821c1ant_tdma_check(btc, FALSE); -+ result = btc->btc_set(btc, BTC_SET_ACT_LEAVE_LPS, NULL); -+ break; -+ default: -+ break; -+ } -+ -+ return result; -+} -+ -+static -+void halbtc8821c1ant_set_tdma(struct btc_coexist *btc, u8 byte1, u8 byte2, -+ u8 byte3, u8 byte4, u8 byte5) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = FALSE, result = FALSE; -+ u8 ps_type = BTC_PS_WIFI_NATIVE; -+ -+ if (byte5 & BIT(2)) -+ coex_sta->is_tdma_btautoslot = TRUE; -+ else -+ coex_sta->is_tdma_btautoslot = FALSE; -+ -+ if (btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GO && -+ btc->wifi_link_info.bhotspot && -+ btc->wifi_link_info.bany_client_join_go) -+ ap_enable = TRUE; -+ -+ if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == FW for 1Ant AP mode\n", __func__); -+ BTC_TRACE(trace_buf); -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ -+ ps_type = BTC_PS_WIFI_NATIVE; -+ halbtc8821c1ant_power_save_state(btc, ps_type, 0x0, 0x0); -+ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == Force LPS (byte1 = 0x%x)\n", -+ __func__, byte1); -+ BTC_TRACE(trace_buf); -+ -+ ps_type = BTC_PS_LPS_OFF; -+ if (!halbtc8821c1ant_power_save_state(btc, ps_type, 0x50, 0x4)) -+ result = TRUE; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == native power save (byte1 = 0x%x)\n", -+ __func__, byte1); -+ BTC_TRACE(trace_buf); -+ -+ ps_type = BTC_PS_WIFI_NATIVE; -+ halbtc8821c1ant_power_save_state(btc, ps_type, 0x0, 0x0); -+ } -+ -+ coex_sta->is_set_ps_state_fail = result; -+ -+ if (!coex_sta->is_set_ps_state_fail) { -+ 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; -+ -+ btc->btc_fill_h2c(btc, 0x60, 5, h2c_parameter); -+ -+ if (real_byte1 & BIT(2)) { -+ coex_sta->wl_slot_toggle = TRUE; -+ coex_sta->wl_slot_toggle_change = FALSE; -+ } else { -+ if (coex_sta->wl_slot_toggle) -+ coex_sta->wl_slot_toggle_change = TRUE; -+ else -+ coex_sta->wl_slot_toggle_change = FALSE; -+ coex_sta->wl_slot_toggle = FALSE; -+ } -+ } else { -+ coex_sta->cnt_set_ps_state_fail++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == Force Leave LPS Fail (cnt = %d)\n", -+ __func__, coex_sta->cnt_set_ps_state_fail); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (ps_type == BTC_PS_WIFI_NATIVE) -+ btc->btc_set(btc, BTC_SET_ACT_POST_NORMAL_LPS, NULL); -+} -+ -+static -+void halbtc8821c1ant_tdma(struct btc_coexist *btc, boolean force_exec, -+ boolean turn_on, u32 tcase) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ u8 type; -+ boolean wifi_busy; -+ -+ btc->btc_set_atomic(btc, &coex_dm->setting_tdma, TRUE); -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* tcase: bit0~7 --> tdma case index -+ * bit8 --> for 4-slot (50ms) mode -+ */ -+ if (tcase & TDMA_4SLOT)/* 4-slot (50ms) mode */ -+ halbtc8821c1ant_set_tdma_timer_base(btc, 3); -+ else -+ halbtc8821c1ant_set_tdma_timer_base(btc, 0); -+ -+ type = (u8)(tcase & 0xff); -+ -+ /* To avoid TDMA H2C fail before Last LPS enter */ -+ if (!force_exec && coex_sta->coex_run_reason != BTC_RSN_LPS) { -+ if (turn_on == coex_dm->cur_ps_tdma_on && -+ type == coex_dm->cur_ps_tdma) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Skip TDMA because no change TDMA(%s, %d)\n", -+ (coex_dm->cur_ps_tdma_on ? "on" : "off"), -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ -+ btc->btc_set_atomic(btc, &coex_dm->setting_tdma, FALSE); -+ return; -+ } -+ } -+ -+ if (!wifi_busy || -+ (coex_sta->a2dp_exist && coex_sta->bt_inq_page_remain)) -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_TDMA, -+ FALSE); -+ else -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_TDMA, -+ TRUE); -+ -+ if (turn_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ type); -+ BTC_TRACE(trace_buf); -+ -+ /* enable TBTT nterrupt */ -+ btc->btc_write_1byte_bitmask(btc, 0x550, 0x8, 0x1); -+ -+ switch (type) { -+ default: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x35, 0x03, 0x11, -+ 0x11); -+ break; -+ case 3: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x30, 0x03, 0x10, -+ 0x50); -+ break; -+ case 4: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x21, 0x03, 0x10, -+ 0x50); -+ break; -+ case 5: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x3a, 0x03, 0x11, -+ 0x11); -+ break; -+ case 6: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x20, 0x03, 0x11, -+ 0x10); -+ break; -+ case 7: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x08, 0x03, 0x10, -+ 0x54); -+ break; -+ case 8: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x08, 0x03, 0x10, -+ 0x54); -+ break; -+ case 9: -+ halbtc8821c1ant_set_tdma(btc, 0x55, 0x08, 0x03, 0x10, -+ 0x54); -+ break; -+ case 10: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x08, 0x07, 0x10, -+ 0x55); -+ break; -+ case 11: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x25, 0x03, 0x11, -+ 0x11); -+ break; -+ case 12: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x35, 0x03, 0x10, -+ 0x50); -+ break; -+ case 13: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x08, 0x07, 0x10, -+ 0x54); -+ break; -+ case 14: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x15, 0x03, 0x10, -+ 0x50); -+ break; -+ case 15: /* not use */ -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x20, 0x03, 0x10, -+ 0x50); -+ break; -+ case 16: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x08, 0x03, 0x10, -+ 0x50); -+ break; -+ case 17: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x08, 0x03, 0x11, -+ 0x14); -+ break; -+ case 18: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x30, 0x03, 0x10, -+ 0x50); -+ break; -+ case 19: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x08, 0x03, 0x11, -+ 0x11); -+ break; -+ case 20: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x10, 0x03, 0x10, -+ 0x50); -+ break; -+ case 21: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x30, 0x03, 0x11, -+ 0x10); -+ break; -+ case 22: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x25, 0x03, 0x11, -+ 0x10); -+ break; -+ case 23: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x10, 0x03, 0x11, -+ 0x10); -+ break; -+ case 24: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x08, 0x03, 0x10, -+ 0x54); -+ break; -+ case 25: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x3a, 0x03, 0x10, -+ 0x50); -+ break; -+ case 26: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x08, 0x03, 0x10, -+ 0x55); -+ break; -+ case 27: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x08, 0x03, 0x11, -+ 0x15); -+ break; -+ case 28: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x08, 0x0b, 0x10, -+ 0x54); -+ break; -+ case 32: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x35, 0x03, 0x11, -+ 0x11); -+ break; -+ case 33: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x35, 0x03, 0x11, -+ 0x10); -+ break; -+ case 34: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x3f, 0x03, 0x11, -+ 0x10); -+ break; -+ case 36: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x45, 0x03, 0x11, -+ 0x10); -+ break; -+ case 37: -+ halbtc8821c1ant_set_tdma(btc, 0x61, 0x3a, 0x03, 0x11, -+ 0x11); -+ break; -+ case 38: -+ halbtc8821c1ant_set_tdma(btc, 0x65, 0x10, 0x03, 0x11, -+ 0x11); -+ break; -+ case 39: -+ halbtc8821c1ant_set_tdma(btc, 0x55, 0x08, 0x3, 0x10, -+ 0x54); -+ break; -+ case 50: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x4a, 0x3, 0x10, -+ 0x50); -+ break; -+ case 51: -+ halbtc8821c1ant_set_tdma(btc, 0x51, 0x08, 0x3, 0x30, -+ 0x54); -+ break; -+ } -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(off, %d) **********\n", -+ type); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_TDMA, FALSE); -+ -+ /* disable PS tdma */ -+ switch (type) { -+ case 8: /* PTA Control */ -+ halbtc8821c1ant_set_tdma(btc, 0x8, 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: /* Software control, Antenna at BT side */ -+ halbtc8821c1ant_set_tdma(btc, 0x0, 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 1: /* 2-Ant, 0x778=3, antenna control -+ * by antenna diversity -+ */ -+ halbtc8821c1ant_set_tdma(btc, 0x0, 0x0, 0x0, 0x48, 0x0); -+ break; -+ } -+ } -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "change TDMA(%s, %d)\n", -+ (coex_dm->cur_ps_tdma_on ? "on" : "off"), -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ -+ btc->btc_set_atomic(btc, &coex_dm->setting_tdma, FALSE); -+} -+ -+static -+void halbtc8821c1ant_set_ant_switch(struct btc_coexist *btc, -+ boolean force_exec, u8 ctrl_type, -+ u8 pos_type) -+{ -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ struct rfe_type_8821c_1ant *rfe_type = &btc->rfe_type_8821c_1ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ boolean polarity_inverse = FALSE; -+ u8 val = 0; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ -+ if (!rfe_type->ext_ant_switch_exist) -+ return; -+ -+ if (!force_exec) { -+ if (((ctrl_type << 8) + pos_type) == -+ coex_dm->cur_ext_ant_switch_status) -+ return; -+ } -+ -+ coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; -+ -+ /* 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 -+ */ -+ if (rfe_type->ext_ant_switch_ctrl_polarity) -+ polarity_inverse = !polarity_inverse; -+ -+ /* swap control polarity if 1-Ant at Aux */ -+ if (rfe_type->ant_at_main_port == FALSE) -+ polarity_inverse = !polarity_inverse; -+ -+ switch (pos_type) { -+ default: -+ case BT_8821C_1ANT_TO_BT: -+ case BT_8821C_1ANT_TO_NOCARE: -+ case BT_8821C_1ANT_TO_WLA: -+ -+ break; -+ case BT_8821C_1ANT_TO_WLG: -+ if (!rfe_type->wlg_locate_at_btg) -+ polarity_inverse = !polarity_inverse; -+ break; -+ } -+ -+ if (board_info->ant_div_cfg) -+ ctrl_type = BT_8821C_1ANT_CTRL_BY_ANTDIV; -+ -+ -+ switch (ctrl_type) { -+ default: -+ case BT_8821C_1ANT_CTRL_BY_BBSW: -+ /* 0x4c[23] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x0); -+ /* 0x4c[24] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4f, 0x01, 0x1); -+ /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ -+ btc->btc_write_1byte_bitmask(btc, 0xcb4, 0xff, 0x77); -+ /* 0xcb4[29:28] = 2b'01 for no switch_polarity_inverse, -+ * DPDT_SEL_N =1, DPDT_SEL_P =0 -+ */ -+ val = (!polarity_inverse ? 0x1 : 0x2); -+ btc->btc_write_1byte_bitmask(btc, 0xcb7, 0x30, val); -+ break; -+ case BT_8821C_1ANT_CTRL_BY_PTA: -+ /* 0x4c[23] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x0); -+ /* 0x4c[24] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4f, 0x01, 0x1); -+ /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ -+ btc->btc_write_1byte_bitmask(btc, 0xcb4, 0xff, 0x66); -+ /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, -+ * DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 -+ */ -+ val = (!polarity_inverse ? 0x2 : 0x1); -+ btc->btc_write_1byte_bitmask(btc, 0xcb7, 0x30, val); -+ break; -+ case BT_8821C_1ANT_CTRL_BY_ANTDIV: -+ /* 0x4c[23] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x0); -+ /* 0x4c[24] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4f, 0x01, 0x1); -+ btc->btc_write_1byte_bitmask(btc, 0xcb4, 0xff, 0x88); -+ -+ /* no regval_0xcb7 setup required, because antenna switch -+ * control value by antenna diversity -+ */ -+ break; -+ case BT_8821C_1ANT_CTRL_BY_MAC: -+ /* 0x4c[23] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x1); -+ /* 0x64[0] = 1b'0 for no switch_polarity_inverse, -+ * DPDT_SEL_N =1, DPDT_SEL_P =0 -+ */ -+ val = (!polarity_inverse ? 0x0 : 0x1); -+ btc->btc_write_1byte_bitmask(btc, 0x64, 0x1, val); -+ break; -+ case BT_8821C_1ANT_CTRL_BY_FW: -+ /* 0x4c[23] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x0); -+ /* 0x4c[24] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4f, 0x01, 0x1); -+ break; -+ case BT_8821C_1ANT_CTRL_BY_BT: -+ /* 0x4c[23] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x0); -+ /* 0x4c[24] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4f, 0x01, 0x0); -+ /* no setup required, because antenna switch control value -+ * by BT vendor 0xac[1:0] -+ */ -+ break; -+ } -+ -+ /* PAPE, LNA_ON control by BT while WLAN off for current leakage issue */ -+ if (ctrl_type == BT_8821C_1ANT_CTRL_BY_BT) { -+ /* PAPE 0x64[29] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, 0x20, 0x0); -+ /* LNA_ON 0x64[28] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, 0x10, 0x0); -+ } else { -+ /* PAPE 0x64[29] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, 0x20, 0x1); -+ /* LNA_ON 0x64[28] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, 0x10, 0x1); -+ } -+} -+ -+static -+void halbtc8821c1ant_set_rfe_type(struct btc_coexist *btc) -+{ -+ struct btc_board_info *board_info = &btc->board_info; -+ struct rfe_type_8821c_1ant *rfe_type = &btc->rfe_type_8821c_1ant; -+ -+ /* the following setup should be got from Efuse in the future */ -+ rfe_type->rfe_module_type = board_info->rfe_type & 0x1f; -+ -+ rfe_type->ext_ant_switch_ctrl_polarity = 0; -+ -+ switch (rfe_type->rfe_module_type) { -+ case 0: -+ case 8: -+ default: /*2-Ant, DPDT, WLG*/ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_USE_DPDT; -+ rfe_type->wlg_locate_at_btg = FALSE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ case 1: -+ case 9: /*1-Ant, Main, WLG */ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_USE_SPDT; -+ rfe_type->wlg_locate_at_btg = FALSE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ case 2: -+ case 10: /*1-Ant, Main, BTG */ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_USE_SPDT; -+ rfe_type->wlg_locate_at_btg = TRUE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ case 3: -+ case 11: /*1-Ant, Aux, WLG */ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_USE_DPDT; -+ rfe_type->wlg_locate_at_btg = FALSE; -+ rfe_type->ant_at_main_port = FALSE; -+ break; -+ case 4: -+ case 12: /*1-Ant, Aux, BTG */ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_USE_DPDT; -+ rfe_type->wlg_locate_at_btg = TRUE; -+ rfe_type->ant_at_main_port = FALSE; -+ break; -+ case 5: -+ case 13: /*2-Ant, no switch, WLG*/ -+ rfe_type->ext_ant_switch_exist = FALSE; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_SWITCH_NONE; -+ rfe_type->wlg_locate_at_btg = FALSE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ case 6: -+ case 14: /*2-Ant, no antenna switch, WLG*/ -+ rfe_type->ext_ant_switch_exist = FALSE; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_SWITCH_NONE; -+ rfe_type->wlg_locate_at_btg = FALSE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ case 7: -+ case 15: /*2-Ant, DPDT, BTG*/ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_USE_DPDT; -+ rfe_type->wlg_locate_at_btg = TRUE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ } -+} -+ -+static -+void halbtc8821c1ant_set_ant_path(struct btc_coexist *btc, -+ u8 ant_pos_type, boolean force_exec, -+ u8 phase) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ struct rfe_type_8821c_1ant *rfe_type = &btc->rfe_type_8821c_1ant; -+ u32 cnt_bt_cal_chk = 0, u32tmp1 = 0, u32tmp2 = 0; -+ u8 u8tmp = 0, ctrl_type, pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->cur_ant_pos_type == ((ant_pos_type << 8) + phase)) -+ return; -+ } -+ -+ coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; -+ -+ if (btc->dbg_mode) { -+ u32tmp1 = btc->btc_read_4byte(btc, 0xcb4); -+ u32tmp2 = btc->btc_read_4byte(btc, 0xcbc); -+ u8tmp = btc->btc_read_1byte(btc, 0x73); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], (Before Ant Setup) 0xcb4 = 0x%x, 0xcbc = 0x%x, 0x73 = 0x%x\n", -+ u32tmp1, u32tmp2, u8tmp); -+ BTC_TRACE(trace_buf); -+ } -+ -+ switch (phase) { -+ case BT_8821C_1ANT_PHASE_POWERON: -+ -+ /* set Path control owner to BT at power-on step */ -+ halbtc8821c1ant_coex_ctrl_owner(btc, BT_8821C_1ANT_PCO_BTSIDE); -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ coex_sta->run_time_state = FALSE; -+ break; -+ case BT_8821C_1ANT_PHASE_INIT: -+ /* Disable LTE Coex Function in WiFi side ( -+ * this should be on if LTE coex is required) -+ */ -+ halbtc8821c1ant_ltecoex_enable(btc, 0x0); -+ -+ /* GNT_WL_LTE always = 1 -+ * (this should be config if LTE coex is required) -+ */ -+ halbtc8821c1ant_ltecoex_table(btc, BT_8821C_1ANT_CTT_WL_VS_LTE, -+ 0xffff); -+ -+ /* GNT_BT_LTE always = 1 -+ * (this should be config if LTE coex is required) -+ */ -+ halbtc8821c1ant_ltecoex_table(btc, 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 = btc->btc_read_1byte(btc, 0x49c); -+ cnt_bt_cal_chk++; -+ if (u8tmp & BIT(1)) { -+ 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(10); -+ } 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_coex_ctrl_owner(btc, BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW high */ -+ halbtc8821c1ant_set_gnt_bt(btc, BTC_GNT_SET_SW_HIGH); -+ /* Set GNT_WL to SW low */ -+ halbtc8821c1ant_set_gnt_wl(btc, BTC_GNT_SET_SW_LOW); -+ -+ coex_sta->run_time_state = FALSE; -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ break; -+ case BT_8821C_1ANT_PHASE_WONLY: -+ /* Disable LTE Coex Function in WiFi side -+ *(this should be on if LTE coex is required) -+ */ -+ halbtc8821c1ant_ltecoex_enable(btc, 0x0); -+ -+ /* GNT_WL_LTE always = 1 -+ *(this should be config if LTE coex is required) -+ */ -+ halbtc8821c1ant_ltecoex_table(btc, BT_8821C_1ANT_CTT_WL_VS_LTE, -+ 0xffff); -+ -+ /* GNT_BT_LTE always = 1 -+ *(this should be config if LTE coex is required) -+ */ -+ halbtc8821c1ant_ltecoex_table(btc, BT_8821C_1ANT_CTT_BT_VS_LTE, -+ 0xffff); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8821c1ant_coex_ctrl_owner(btc, BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Low */ -+ halbtc8821c1ant_set_gnt_bt(btc, BTC_GNT_SET_SW_LOW); -+ /* Set GNT_WL to SW high */ -+ halbtc8821c1ant_set_gnt_wl(btc, BTC_GNT_SET_SW_HIGH); -+ -+ coex_sta->run_time_state = FALSE; -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) -+ ant_pos_type = BTC_ANT_PATH_WIFI; -+ break; -+ case BT_8821C_1ANT_PHASE_WOFF: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8821c1ant_ltecoex_enable(btc, 0x0); -+ -+ /* set Path control owner to BT */ -+ halbtc8821c1ant_coex_ctrl_owner(btc, -+ BT_8821C_1ANT_PCO_BTSIDE); -+ -+ coex_sta->run_time_state = FALSE; -+ break; -+ case BT_8821C_1ANT_PHASE_2G: -+ while (cnt_bt_cal_chk <= 20) { -+ /* 0x49c[0]=1 WL IQK, 0x49c[1]=1 BT IQK*/ -+ u8tmp = btc->btc_read_1byte(btc, 0x49c); -+ -+ cnt_bt_cal_chk++; -+ if (u8tmp & BIT(0)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### WL is IQK (wait cnt=%d)\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(10); -+ } else if (u8tmp & BIT(1)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### BT is IQK (wait cnt=%d)\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(10); -+ } 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 owner to WL at runtime step */ -+ halbtc8821c1ant_coex_ctrl_owner(btc, BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to PTA */ -+ halbtc8821c1ant_set_gnt_bt(btc, BTC_GNT_SET_HW_PTA); -+ -+ halbtc8821c1ant_set_gnt_wl(btc, BTC_GNT_SET_HW_PTA); -+ -+ coex_sta->run_time_state = TRUE; -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) { -+ if (rfe_type->wlg_locate_at_btg) -+ ant_pos_type = BTC_ANT_PATH_WIFI; -+ else -+ ant_pos_type = BTC_ANT_PATH_PTA; -+ } -+ break; -+ case BT_8821C_1ANT_PHASE_5G: -+ -+ /* set Path control owner to WL at runtime step */ -+ halbtc8821c1ant_coex_ctrl_owner(btc, BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Hi */ -+ halbtc8821c1ant_set_gnt_bt(btc, BTC_GNT_SET_HW_PTA); -+ -+ /* Set GNT_WL to SW Hi */ -+ halbtc8821c1ant_set_gnt_wl(btc, BTC_GNT_SET_SW_HIGH); -+ -+ coex_sta->run_time_state = TRUE; -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) -+ ant_pos_type = BTC_ANT_PATH_WIFI5G; -+ break; -+ case BT_8821C_1ANT_PHASE_BTMP: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8821c1ant_ltecoex_enable(btc, 0x0); -+ -+ /* set Path control owner to WL */ -+ halbtc8821c1ant_coex_ctrl_owner(btc, BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Hi */ -+ halbtc8821c1ant_set_gnt_bt(btc, BTC_GNT_SET_SW_HIGH); -+ -+ /* Set GNT_WL to SW Lo */ -+ halbtc8821c1ant_set_gnt_wl(btc, BTC_GNT_SET_SW_LOW); -+ -+ coex_sta->run_time_state = FALSE; -+ -+ /* Set Ext Ant Switch to BT side at BT MP mode */ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ break; -+ case BT_8821C_1ANT_PHASE_ANTDET: -+ halbtc8821c1ant_coex_ctrl_owner(btc, BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to high */ -+ halbtc8821c1ant_set_gnt_bt(btc, BTC_GNT_SET_SW_HIGH); -+ /* Set GNT_WL to high */ -+ halbtc8821c1ant_set_gnt_wl(btc, BTC_GNT_SET_SW_HIGH); -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ coex_sta->run_time_state = FALSE; -+ break; -+ case BT_8821C_1ANT_PHASE_MCC: -+ /* set Path control owner to WL at runtime step */ -+ halbtc8821c1ant_coex_ctrl_owner(btc, BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to PTA */ -+ halbtc8821c1ant_set_gnt_bt(btc, BTC_GNT_SET_HW_PTA); -+ -+ halbtc8821c1ant_set_gnt_wl(btc, BTC_GNT_SET_HW_PTA); -+ -+ coex_sta->run_time_state = TRUE; -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ break; -+ } -+ -+ if (phase == BT_8821C_1ANT_PHASE_WOFF) { -+ /* Set Ext Ant Switch to BT control at wifi off step */ -+ ctrl_type = BT_8821C_1ANT_CTRL_BY_BT; -+ pos_type = BT_8821C_1ANT_TO_NOCARE; -+ } else if (phase == BT_8821C_1ANT_PHASE_MCC) { -+ ctrl_type = BT_8821C_1ANT_CTRL_BY_FW; -+ pos_type = BT_8821C_1ANT_TO_NOCARE; -+ } else { -+ switch (ant_pos_type) { -+ case BTC_ANT_PATH_WIFI: -+ ctrl_type = BT_8821C_1ANT_CTRL_BY_BBSW; -+ pos_type = BT_8821C_1ANT_TO_WLG; -+ break; -+ case BTC_ANT_PATH_WIFI5G: -+ ctrl_type = BT_8821C_1ANT_CTRL_BY_BBSW; -+ pos_type = BT_8821C_1ANT_TO_WLA; -+ break; -+ case BTC_ANT_PATH_BT: -+ ctrl_type = BT_8821C_1ANT_CTRL_BY_BBSW; -+ pos_type = BT_8821C_1ANT_TO_BT; -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ ctrl_type = BT_8821C_1ANT_CTRL_BY_PTA; -+ pos_type = BT_8821C_1ANT_TO_NOCARE; -+ break; -+ } -+ } -+ -+ halbtc8821c1ant_set_ant_switch(btc, force_exec, ctrl_type, pos_type); -+ -+ if (btc->dbg_mode) { -+ u32tmp1 = btc->btc_read_4byte(btc, 0xcbc); -+ u32tmp2 = btc->btc_read_4byte(btc, 0xcb4); -+ u8tmp = btc->btc_read_1byte(btc, 0x73); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], (After Ant Setup) 0xcb4 = 0x%x, 0xcbc = 0x%x, 0x73 = 0x%x\n", -+ u32tmp1, u32tmp2, u8tmp); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+static -+u8 halbtc8821c1ant_action_algorithm(struct btc_coexist *btc) -+{ -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ u8 algorithm = BT_8821C_1ANT_COEX_UNDEFINED; -+ u8 profile_map = 0; -+ -+ if (bt_link_info->sco_exist) -+ profile_map = profile_map | BIT(0); -+ -+ if (bt_link_info->hid_exist) -+ profile_map = profile_map | BIT(1); -+ -+ if (bt_link_info->a2dp_exist) -+ profile_map = profile_map | BIT(2); -+ -+ if (bt_link_info->pan_exist) -+ profile_map = profile_map | BIT(3); -+ -+ switch (profile_map) { -+ case 0: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_UNDEFINED; -+ break; -+ case 1: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_SCO; -+ break; -+ case 2: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_HID; -+ break; -+ case 3: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_HID; -+ break; -+ case 4: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_A2DP; -+ break; -+ case 5: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP ==> HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_HID_A2DP; -+ break; -+ case 6: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_HID_A2DP; -+ break; -+ case 7: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_HID_A2DP; -+ break; -+ case 8: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_PAN; -+ break; -+ case 9: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(EDR) ==> HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_PAN_HID; -+ break; -+ case 10: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_PAN_HID; -+ break; -+ case 11: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(EDR) ==> HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_PAN_HID; -+ break; -+ case 12: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_PAN_A2DP; -+ break; -+ case 13: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_PAN_A2DP; -+ break; -+ case 14: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR) ==> A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_PAN_A2DP; -+ break; -+ case 15: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR) ==> A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_PAN_A2DP; -+ break; -+ } -+ -+ return algorithm; -+} -+ -+static -+void halbtc8821c1ant_action_coex_all_off(struct btc_coexist *btc) -+{ -+ halbtc8821c1ant_table(btc, NM_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 0); -+} -+ -+static -+void halbtc8821c1ant_action_bt_whql_test(struct btc_coexist *btc) -+{ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ halbtc8821c1ant_table(btc, NM_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+} -+ -+static -+void halbtc8821c1ant_action_bt_relink(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ -+ if (coex_sta->gl_wifi_busy) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 4); -+ -+ if (bt_link_info->hid_only) -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, -+ 20 | TDMA_4SLOT); -+ else -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 20); -+ } else { -+ halbtc8821c1ant_table(btc, NM_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ } -+} -+ -+static -+void halbtc8821c1ant_action_bt_idle(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ -+ if (!coex_sta->gl_wifi_busy) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 4); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 32); -+ } else { /* if wl busy */ -+ /*for initiator scan on*/ -+ if (coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_NCON_IDLE) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 2); -+ if (coex_sta->bt_ble_scan_type & 0x2) -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 36); -+ else -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 34); -+ } else { -+ halbtc8821c1ant_table(btc, NM_EXCU, 3); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 33); -+ } -+ } -+} -+ -+static -+void halbtc8821c1ant_action_bt_inquiry(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ boolean wifi_connected = FALSE, wifi_busy = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (coex_sta->is_wifi_linkscan_process || -+ coex_sta->wifi_high_pri_task1 || -+ coex_sta->wifi_high_pri_task2) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt inq/page + wifi hi-pri task\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_table(btc, NM_EXCU, 2); -+ -+ if (bt_link_info->bt_link_exist) -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 23); -+ else if (coex_sta->wifi_high_pri_task1) -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 36); -+ else if (!coex_sta->bt_create_connection) -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 21); -+ else -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 6); -+ } else if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt inq/page + wifi busy\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_table(btc, NM_EXCU, 2); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 20); -+ } else if (wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt inq/page + wifi connected\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 19); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt inq/page + wifi not-connected\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_table(btc, NM_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ } -+} -+ -+static -+void halbtc8821c1ant_action_bt_sco_hid_busy(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ boolean is_bt_ctr_hi = FALSE; -+ -+ if (coex_sta->bt_ctr_ok && -+ (coex_sta->low_priority_rx + coex_sta->low_priority_tx > 360)) -+ is_bt_ctr_hi = TRUE; -+ else -+ is_bt_ctr_hi = FALSE; -+ -+ if (bt_link_info->sco_exist) { -+ if (coex_sta->is_bt_multi_link) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 25); -+ } else { -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 5); -+ } -+ } else if (coex_sta->is_hid_rcu) { -+ if (coex_sta->wl_noisy_level > 0) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 16); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 37); -+ } else { -+ halbtc8821c1ant_table(btc, NM_EXCU, 17); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 6); -+ } -+ } else { -+ /* for HID exist */ -+ if (coex_sta->bt_a2dp_active || -+ coex_sta->bt_a2dp_active_remain) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 18); -+ } else if (bt_link_info->hid_only && -+ (coex_sta->is_bt_multi_link && -+ (is_bt_ctr_hi || bt_link_info->slave_role))) { -+ if (coex_sta->gl_wifi_busy && -+ (coex_sta->wl_rx_rate <= 3 || -+ coex_sta->wl_rts_rx_rate <= 3)) -+ halbtc8821c1ant_table(btc, NM_EXCU, 8); -+ else -+ halbtc8821c1ant_table(btc, NM_EXCU, 3); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, -+ 20 | TDMA_4SLOT); -+ } else if (coex_sta->bt_418_hid_exist && -+ coex_sta->gl_wifi_busy) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 22); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 19 -+ | TDMA_4SLOT); -+ } else if (coex_sta->bt_ble_hid_exist && -+ coex_sta->gl_wifi_busy) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 22); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 6); -+ } else { -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 6); -+ } -+ } -+} -+ -+static -+void halbtc8821c1ant_action_bt_acl_busy(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ boolean wifi_busy = FALSE, wifi_turbo = FALSE, ap_enable = FALSE; -+ u32 slot_type = 0; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btc->btc_get(btc, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &ap_enable); -+ -+ if (!wifi_busy) -+ wifi_busy = coex_sta->gl_wifi_busy; -+ -+ if (coex_sta->gl_wifi_busy && coex_sta->wl_noisy_level == 0) -+ wifi_turbo = TRUE; -+ -+ if (bt_link_info->a2dp_exist && coex_sta->is_bt_a2dp_sink) { -+ if (ap_enable) { /* A2DP Sink */ -+ halbtc8821c1ant_table(btc, NM_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ } else { -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 4); -+ } -+ } else if (bt_link_info->a2dp_only) { /* A2DP */ -+ if (wifi_busy && (coex_sta->bt_ble_scan_type & 0x2)) -+ halbtc8821c1ant_table(btc, NM_EXCU, 3); -+ else -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ -+ if (coex_sta->connect_ap_period_cnt > 0 || !wifi_busy) -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, -+ 26 | TDMA_4SLOT); -+ else -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, -+ 7 | TDMA_4SLOT); -+ } 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) -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ else if (wifi_turbo) -+ halbtc8821c1ant_table(btc, NM_EXCU, 3); -+ else -+ halbtc8821c1ant_table(btc, NM_EXCU, 4); -+ -+ if (wifi_busy) -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 13); -+ else -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 14); -+ } else if (bt_link_info->hid_exist && coex_sta->is_hid_rcu && -+ bt_link_info->a2dp_exist) { -+ /* RCU + A2DP */ -+ halbtc8821c1ant_table(btc, NM_EXCU, 16); -+ -+ if (coex_sta->connect_ap_period_cnt > 0 || !wifi_busy) -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, -+ 26 | TDMA_4SLOT); -+ else -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, -+ 7 | TDMA_4SLOT); -+ } else if (bt_link_info->hid_exist && bt_link_info->a2dp_exist) { -+ /* HID+A2DP */ -+ -+ /*4-slot will not be applied when AP is CISCO*/ -+ if (coex_sta->wl_iot_peer == BTC_IOT_PEER_CISCO || -+ coex_sta->bt_ble_hid_exist) -+ slot_type = 0; -+ else -+ slot_type = TDMA_4SLOT; -+ -+ if (coex_sta->connect_ap_period_cnt > 0 || !wifi_busy) { -+ halbtc8821c1ant_table(btc, FC_EXCU, 4); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, -+ 26 | slot_type); -+ } else if (coex_sta->bt_418_hid_exist) { -+ halbtc8821c1ant_table(btc, FC_EXCU, 4); -+ halbtc8821c1ant_wltoggle_table(btc, NM_EXCU, 1, -+ 0xaa, 0x5a, 0x5a, 0x5a); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, -+ 39 | slot_type); -+ } else if (coex_sta->bt_ble_hid_exist) { -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, -+ 8 | slot_type); -+ } else { -+ halbtc8821c1ant_table(btc, FC_EXCU, 4); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, -+ 7 | slot_type); -+ } -+ } 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) -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ else if (wifi_turbo) -+ halbtc8821c1ant_table(btc, NM_EXCU, 3); -+ else -+ halbtc8821c1ant_table(btc, NM_EXCU, 4); -+ -+ if (!wifi_busy) -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 4); -+ else -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 3); -+ } else { -+ /* BT no-profile busy (0x9) */ -+ halbtc8821c1ant_table(btc, NM_EXCU, 4); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 33); -+ } -+} -+ -+static -+void halbtc8821c1ant_action_bt_mr(struct btc_coexist *btc) -+{ -+ struct wifi_link_info_8821c_1ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_1ant; -+ -+ if (!wifi_link_info_ext->is_all_under_5g) { -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ -+ halbtc8821c1ant_table(btc, NM_EXCU, 8); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 32); -+ } else { -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_5G); -+ -+ halbtc8821c1ant_table(btc, NM_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ } -+} -+ -+static -+void halbtc8821c1ant_action_wifi_under5g(struct btc_coexist *btc) -+{ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_5G); -+ halbtc8821c1ant_table(btc, NM_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+} -+ -+static -+void halbtc8821c1ant_action_wifi_only(struct btc_coexist *btc) -+{ -+ halbtc8821c1ant_table(btc, FC_EXCU, 10); -+ halbtc8821c1ant_tdma(btc, FC_EXCU, FALSE, 8); -+} -+ -+static -+void halbtc8821c1ant_action_wifi_native_lps(struct btc_coexist *btc) -+{ -+ halbtc8821c1ant_table(btc, NM_EXCU, 21); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+} -+ -+static -+void halbtc8821c1ant_action_wifi_linkscan(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ -+ if (bt_link_info->pan_exist) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 26); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 22); -+ } else if (bt_link_info->a2dp_exist) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 4); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 27); -+ } else { -+ halbtc8821c1ant_table(btc, NM_EXCU, 4); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 21); -+ } -+} -+ -+static -+void halbtc8821c1ant_action_wifi_not_connected(struct btc_coexist *btc) -+{ -+ /* tdma and coex table */ -+ halbtc8821c1ant_table(btc, NM_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, FC_EXCU, FALSE, 8); -+} -+ -+static -+void halbtc8821c1ant_action_wifi_connected(struct btc_coexist *btc) -+{ -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ -+ coex_dm->cur_algorithm = halbtc8821c1ant_action_algorithm(btc); -+ -+ if (coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_ACL_BUSY || -+ coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_ACL_SCO_BUSY) { -+ -+ if (bt_link_info->hid_only || bt_link_info->sco_exist) -+ /* HID only or SCO*/ -+ halbtc8821c1ant_action_bt_sco_hid_busy(btc); -+ else -+ halbtc8821c1ant_action_bt_acl_busy(btc); -+ -+ } else if (coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_SCO_BUSY) { -+ halbtc8821c1ant_action_bt_sco_hid_busy(btc); -+ } else { -+ halbtc8821c1ant_action_bt_idle(btc); -+ } -+} -+ -+static -+void halbtc8821c1ant_action_wifi_multiport25g(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_MCC); -+ -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_BTCQDDR, TRUE); -+ -+ if (coex_sta->is_setup_link || coex_sta->bt_relink_downcount != 0) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport25g(), BT Relink!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_table(btc, NM_EXCU, 15); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ } else if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport25g(), BT Inq-Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_table(btc, NM_EXCU, 15); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport25g(), BT idle or busy!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (coex_sta->gl_wifi_busy) { -+ if (coex_sta->wl_rx_rate <= 3 || -+ coex_sta->wl_rts_rx_rate <= 3) -+ halbtc8821c1ant_table(btc, NM_EXCU, 23); -+ else if (coex_sta->bt_418_hid_exist || -+ coex_sta->bt_ble_hid_exist) -+ halbtc8821c1ant_table(btc, NM_EXCU, 24); -+ else -+ halbtc8821c1ant_table(btc, NM_EXCU, 15); -+ } else { -+ halbtc8821c1ant_table(btc, NM_EXCU, 15); -+ } -+ -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ } -+} -+ -+static void halbtc8821c1ant_action_wifi_scc2g(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ -+ if (coex_sta->num_of_profile == 1) { -+ if (coex_sta->hid_exist || coex_sta->sco_exist) { -+ if (coex_sta->is_hid_low_pri_tx_overhead) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 4); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 50); -+ } else { -+ halbtc8821c1ant_table(btc, NM_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } -+ } else if (coex_sta->a2dp_exist) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 11); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 51); -+ } else { /* PAN or OPP */ -+ halbtc8821c1ant_table(btc, NM_EXCU, 11); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 50); -+ } -+ } else { -+ if ((coex_sta->hid_exist || coex_sta->sco_exist) && -+ coex_sta->a2dp_exist) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 51); -+ } else if (coex_sta->pan_exist && coex_sta->a2dp_exist) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 11); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 51); -+ } else { /* hid + pan */ -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 50); -+ } -+ } -+} -+ -+static -+void halbtc8821c1ant_action_wifi_multiport2g(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct btc_concurrent_setting multiport_tdma_para; -+ u32 traffic_dir; -+ -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_BTCQDDR, TRUE); -+ btc->btc_get(btc, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &traffic_dir); -+ -+ if (coex_sta->is_setup_link || coex_sta->bt_relink_downcount != 0) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport2g, BT Relink!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ -+ halbtc8821c1ant_table(btc, NM_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ } else if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport2g, BT Inq-Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ -+ halbtc8821c1ant_table(btc, NM_EXCU, 1); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, TRUE, 33); -+ } else if (coex_sta->num_of_profile == 0) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport2g, BT idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ -+ if (btc->chip_interface == BTC_INTF_PCI && -+ (btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GO || -+ btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GC)) -+ halbtc8821c1ant_table(btc, NM_EXCU, 10); -+ else -+ halbtc8821c1ant_table(btc, NM_EXCU, 19); -+ -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ } else if (coex_sta->is_wifi_linkscan_process) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport2g, WL scan!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ halbtc8821c1ant_action_wifi_linkscan(btc); -+ } else { -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ -+ switch (btc->wifi_link_info.link_mode) { -+ case BTC_LINK_2G_SCC_GC_STA: -+ case BTC_LINK_2G_SCC_GO_STA: -+ halbtc8821c1ant_action_wifi_scc2g(btc); -+ break; -+ case BTC_LINK_ONLY_GO: -+ case BTC_LINK_ONLY_GC: -+#ifdef PLATFORM_WINDOWS -+ if (btc->chip_interface == BTC_INTF_PCI && -+ coex_sta->a2dp_exist && !coex_sta->is_bt_multi_link) { -+ PADAPTER Adapter=(PADAPTER)btc->Adapter; -+ PMULTI_LINK_INFO pMultiLinkInfo = MultiportGetMultiLinkInfo(Adapter); -+ if (pMultiLinkInfo->bHotspot) { -+ halbtc8821c1ant_table(btc, NM_EXCU, 16); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, -+ TRUE, 17); -+ } else { -+ halbtc8821c1ant_table(btc, NM_EXCU, 11); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, -+ FALSE, 8); -+ } -+ } else -+#endif -+ { -+ halbtc8821c1ant_table(btc, NM_EXCU, 19); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ } -+ break; -+ -+ default: -+ halbtc8821c1ant_table(btc, NM_EXCU, 19); -+ halbtc8821c1ant_tdma(btc, NM_EXCU, FALSE, 8); -+ break; -+ } -+ } -+ } -+ -+static -+void halbtc8821c1ant_run_coex(struct btc_coexist *btc, u8 reason) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ struct wifi_link_info_8821c_1ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_1ant; -+ boolean wifi_connected = FALSE, wifi_32k = FALSE; -+ boolean scan = FALSE, link = FALSE, roam = FALSE, under_4way = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_SCAN, &scan); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_LINK, &link); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_ROAM, &roam); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &under_4way); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_LW_PWR_STATE, &wifi_32k); -+ -+ if (scan || link || roam || under_4way || -+ reason == BT_8821C_1ANT_RSN_2GSCANSTART || -+ reason == BT_8821C_1ANT_RSN_2GSWITCHBAND || -+ reason == BT_8821C_1ANT_RSN_2GCONSTART || -+ reason == BT_8821C_1ANT_RSN_2GSPECIALPKT) { -+ 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); -+ coex_sta->is_wifi_linkscan_process = TRUE; -+ } else { -+ coex_sta->is_wifi_linkscan_process = FALSE; -+ } -+ -+ /* update wifi_link_info variable */ -+ halbtc8821c1ant_update_wifi_link_info(btc, reason); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===> reason = %d\n", -+ reason); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->coex_run_reason = reason; -+ -+ if (btc->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btc->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], RunCoexistMechanism(), return for wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_lps && wifi_32k) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for wifi is under LPS-32K !!!\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 && !coex_sta->is_setup_link) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], return for freeze_coexrun_by_btinfo\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ coex_sta->coex_run_cnt++; -+ -+ if (coex_sta->msft_mr_exist && wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), microsoft MR!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_coex_mode = BT_8821C_1ANT_WLINK_BTMR; -+ halbtc8821c1ant_action_bt_mr(btc); -+ return; -+ } -+ -+ if (wifi_link_info_ext->is_all_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_coex_mode = BT_8821C_1ANT_WLINK_5G; -+ halbtc8821c1ant_action_wifi_under5g(btc); -+ return; -+ } -+ -+ if (wifi_link_info_ext->is_mcc_25g) { /* not iclude scan action */ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under mcc dual-band!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_coex_mode = BT_8821C_1ANT_WLINK_25GMPORT; -+ halbtc8821c1ant_action_wifi_multiport25g(btc); -+ return; -+ } -+ -+ if (wifi_link_info_ext->num_of_active_port > 1 || -+ (btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GO && -+ !btc->wifi_link_info.bhotspot && -+ btc->wifi_link_info.bany_client_join_go)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under scc-2g/mcc-2g/p2pGO-only!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GO) -+ coex_sta->wl_coex_mode = BT_8821C_1ANT_WLINK_2GGO; -+ else -+ coex_sta->wl_coex_mode = BT_8821C_1ANT_WLINK_2GMPORT; -+ halbtc8821c1ant_action_wifi_multiport2g(btc); -+ return; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is single-port 2G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_coex_mode = BT_8821C_1ANT_WLINK_2G1PORT; -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ -+ /*For Asus airpods 2 + HID glitch issue (COEX-303) -+ For HP LE HID + A2DP issue (COEX-291)*/ -+ if ((coex_sta->bt_a2dp_vendor_id == 0x4c && coex_sta->is_bt_multi_link) -+ || (coex_sta->bt_ble_hid_exist && bt_link_info->a2dp_exist)) -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_BTCQDDR, -+ FALSE); -+ else -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_BTCQDDR, -+ TRUE); -+ -+ -+ if (coex_sta->bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_wifi_only(btc); -+ return; -+ } -+ -+ if (coex_sta->under_lps && !coex_sta->force_lps_ctrl && -+ !coex_sta->acl_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), wifi is under LPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_wifi_native_lps(btc); -+ 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); -+ halbtc8821c1ant_action_bt_whql_test(btc); -+ return; -+ } -+ -+ if (coex_sta->is_setup_link || coex_sta->bt_relink_downcount != 0) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is re-link !!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_bt_relink(btc); -+ 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); -+ halbtc8821c1ant_action_bt_inquiry(btc); -+ return; -+ } -+ -+ if ((coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_NCON_IDLE || -+ coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_CON_IDLE) && -+ wifi_link_info_ext->is_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is idle\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_bt_idle(btc); -+ return; -+ } -+ -+ if (coex_sta->is_wifi_linkscan_process) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under linkscan process!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_wifi_linkscan(btc); -+ return; -+ } -+ -+ if (wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under connected!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_action_wifi_connected(btc); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under not-connected!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_action_wifi_not_connected(btc); -+ } -+} -+ -+static void halbtc8821c1ant_init_coex_var(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ -+ /* Reset Coex variable */ -+ btc->btc_set(btc, BTC_SET_RESET_COEX_VAR, NULL); -+ -+ coex_sta->bt_reg_vendor_ac = 0xffff; -+ coex_sta->bt_reg_vendor_ae = 0xffff; -+ -+ coex_sta->isolation_btween_wb = BT_8821C_1ANT_DEFAULT_ISOLATION; -+ btc->bt_info.bt_get_fw_ver = 0; -+} -+ -+static -+void halbtc8821c1ant_init_coex_dm(struct btc_coexist *btc) -+{ -+} -+ -+static -+void halbtc8821c1ant_init_hw_config(struct btc_coexist *btc, boolean back_up, -+ boolean wifi_only) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ u16 u16tmp1 = 0; -+ u8 i; -+ struct btc_board_info *board_info = &btc->board_info; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], %s()!\n", __func__); -+ BTC_TRACE(trace_buf); -+ -+#if 0 -+ u32tmp3 = btc->btc_read_4byte(btc, 0xcb4); -+ u32tmp1 = halbtc8821c1ant_read_indirect_reg(btc, 0x38); -+ u32tmp2 = halbtc8821c1ant_read_indirect_reg(btc, 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); -+#endif -+ -+ halbtc8821c1ant_init_coex_var(btc); -+ -+ /* 0xf0[15:12] --> kt_ver */ -+ coex_sta->kt_ver = (btc->btc_read_1byte(btc, 0xf1) & 0xf0) >> 4; -+ -+ /* enable TBTT nterrupt */ -+ btc->btc_write_1byte_bitmask(btc, 0x550, 0x8, 0x1); -+ -+ /* BT report packet sample rate */ -+ btc->btc_write_1byte(btc, 0x790, 0x5); -+ -+ /* Init 0x778 = 0x1 for 1-Ant */ -+ btc->btc_write_1byte(btc, 0x778, 0x1); -+ -+ /* Enable PTA (3-wire function form BT side) */ -+ btc->btc_write_1byte_bitmask(btc, 0x40, 0x20, 0x1); -+ btc->btc_write_1byte_bitmask(btc, 0x41, 0x02, 0x1); -+ -+ /* Enable PTA (tx/rx signal form WiFi side) */ -+ btc->btc_write_1byte_bitmask(btc, 0x4c6, 0x30, 0x1); -+ -+ /* set GNT_BT=1 for coex table select both */ -+ btc->btc_write_1byte_bitmask(btc, 0x763, 0x10, 0x1); -+ -+ /* beacon queue always hi-pri */ -+ btc->btc_write_1byte_bitmask(btc, 0x6cf, BIT(3), 0x1); -+ -+ halbtc8821c1ant_enable_gnt_to_gpio(btc, TRUE); -+ -+ /* Antenna config */ -+ if (btc->wl_rf_state_off) { -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_1ANT_PHASE_WOFF); -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_ALL, FALSE); -+ btc->stop_coex_dm = TRUE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s: RF Off\n", __func__); -+ BTC_TRACE(trace_buf); -+ } else if (wifi_only) { -+ coex_sta->concurrent_rx_mode_on = FALSE; -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_WIFI, FC_EXCU, -+ BT_8821C_1ANT_PHASE_WONLY); -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_ACTIVE | -+ BT_8821C_1ANT_SCBD_ONOFF, -+ TRUE); -+ btc->stop_coex_dm = TRUE; -+ } else { -+ coex_sta->concurrent_rx_mode_on = TRUE; -+ btc->btc_set_rf_reg(btc, BTC_RF_A, 0x1, 0x2, 0x0); -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_1ANT_PHASE_INIT); -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_ACTIVE | -+ BT_8821C_1ANT_SCBD_ONOFF, -+ TRUE); -+ btc->stop_coex_dm = FALSE; -+ } -+ -+ /* PTA parameter */ -+ halbtc8821c1ant_table(btc, FC_EXCU, 0); -+ halbtc8821c1ant_tdma(btc, FC_EXCU, FALSE, 8); -+ -+ halbtc8821c1ant_query_bt_info(btc); -+#if 0 -+ u32tmp3 = btc->btc_read_4byte(btc, 0xcb4); -+ u32tmp1 = halbtc8821c1ant_read_indirect_reg(btc, 0x38); -+ u32tmp2 = halbtc8821c1ant_read_indirect_reg(btc, 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); -+#endif -+} -+ -+void ex_halbtc8821c1ant_power_on_setting(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ u8 u8tmp = 0x0; -+ u16 u16tmp = 0x0; -+ u32 value = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Execute %s !!\n", __func__); -+ BTC_TRACE(trace_buf); -+ -+ btc->stop_coex_dm = TRUE; -+ btc->wl_rf_state_off = FALSE; -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ -+ u16tmp = btc->btc_read_2byte(btc, 0x2); -+ btc->btc_write_2byte(btc, 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) { -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ u8tmp = 1; -+ } else if (board_info->single_ant_path == 1) { -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ u8tmp = 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); -+ -+ /* Setup RF front end type */ -+ halbtc8821c1ant_set_rfe_type(btc); -+ -+ /* Set Antenna Path to BT side */ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_1ANT_PHASE_POWERON); -+ -+ halbtc8821c1ant_table(btc, FC_EXCU, 0); -+ -+ /* Save"single antenna position" info in Local register setting for -+ * FW reading, because FW may not ready at power on -+ */ -+ if (btc->chip_interface == BTC_INTF_PCI) -+ btc->btc_write_local_reg_1byte(btc, 0x3e0, u8tmp); -+ else if (btc->chip_interface == BTC_INTF_USB) -+ btc->btc_write_local_reg_1byte(btc, 0xfe08, u8tmp); -+ else if (btc->chip_interface == BTC_INTF_SDIO) -+ btc->btc_write_local_reg_1byte(btc, 0x60, u8tmp); -+ -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ halbtc8821c1ant_enable_gnt_to_gpio(btc, TRUE); -+ -+ if (btc->dbg_mode) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LTE coex Reg 0x38 (Power-On) = 0x%x\n", -+ halbtc8821c1ant_read_indirect_reg(btc, 0x38)); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MACReg 0x70/ BBReg 0xcb4 (Power-On) = 0x%x/ 0x%x\n", -+ btc->btc_read_4byte(btc, 0x70), -+ btc->btc_read_4byte(btc, 0xcb4)); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8821c1ant_pre_load_firmware(struct btc_coexist *btc) -+{ -+} -+ -+void ex_halbtc8821c1ant_init_hw_config(struct btc_coexist *btc, -+ boolean wifi_only) -+{ -+ halbtc8821c1ant_init_hw_config(btc, TRUE, wifi_only); -+} -+ -+void ex_halbtc8821c1ant_init_coex_dm(struct btc_coexist *btc) -+{ -+ btc->stop_coex_dm = FALSE; -+ btc->auto_report = TRUE; -+ btc->dbg_mode = FALSE; -+ halbtc8821c1ant_init_coex_dm(btc); -+} -+ -+void ex_halbtc8821c1ant_display_simple_coex_info(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ -+ u8 *cli_buf = btc->cli_buf; -+ u32 bt_patch_ver = 0, bt_coex_ver = 0; -+ static u8 cnt; -+ u8 * const p = &coex_sta->bt_afh_map[0]; -+ -+ if (!coex_sta->bt_disabled && -+ (coex_sta->bt_coex_supported_version == 0 || -+ coex_sta->bt_coex_supported_version == 0xffff) && -+ cnt == 0) { -+ btc->btc_get(btc, BTC_GET_U4_SUPPORTED_FEATURE, -+ &coex_sta->bt_coex_supported_feature); -+ -+ btc->btc_get(btc, BTC_GET_U4_SUPPORTED_VERSION, -+ &coex_sta->bt_coex_supported_version); -+ -+ coex_sta->bt_reg_vendor_ac = (u16)(btc->btc_get_bt_reg(btc, 3, -+ 0xac) & -+ 0xffff); -+ -+ coex_sta->bt_reg_vendor_ae = (u16)(btc->btc_get_bt_reg(btc, 3, -+ 0xae) & -+ 0xffff); -+ -+ btc->btc_get(btc, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btc->bt_info.bt_get_fw_ver = bt_patch_ver; -+ -+ if (coex_sta->num_of_profile > 0) -+ btc->btc_get_bt_afh_map_from_bt(btc, 0, p); -+ } -+ -+ if (++cnt >= 3) -+ cnt = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n _____[BT Coexist info]____"); -+ CL_PRINTF(cli_buf); -+ -+ if (btc->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 (btc->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/ %s / 0x%x", -+ "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"), -+ board_info->rfe_type); -+ CL_PRINTF(cli_buf); -+ -+ 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_8821c_1ant, glcoex_ver_8821c_1ant, -+ glcoex_ver_btdesired_8821c_1ant, -+ bt_coex_ver, -+ (bt_coex_ver == 0xff ? "Unknown" : -+ (coex_sta->bt_disabled ? "BT-disable" : -+ (bt_coex_ver >= glcoex_ver_btdesired_8821c_1ant ? -+ "Match" : "Mis-Match")))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", "BT status", -+ ((coex_sta->bt_disabled) ? ("disabled") : -+ ((coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") -+ : ((BT_8821C_1ANT_BSTATUS_NCON_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8821C_1ANT_BSTATUS_CON_IDLE == -+ coex_dm->bt_status) ? "connected-idle" : "busy"))))); -+ 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 %s", -+ "0x774(Lo-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx, -+ (bt_link_info->slave_role ? "(Slave!!)" : " ")); -+ CL_PRINTF(cli_buf); -+} -+ -+void ex_halbtc8821c1ant_display_coex_info(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ -+ u8 *cli_buf = btc->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, 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; -+ u32 phyver = 0, val = 0; -+ boolean lte_coex_on = FALSE, is_bt_reply = FALSE; -+ static u8 cnt; -+ u8 * const p = &coex_sta->bt_afh_map[0]; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info 8821C]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btc->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); -+ } else if (btc->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); -+ } else if (!coex_sta->run_time_state) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Run Time State = False]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } else if (coex_sta->freeze_coexrun_by_btinfo) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[freeze_coexrun_by_btinfo]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (!coex_sta->bt_disabled && cnt == 0) { -+ if (coex_sta->bt_coex_supported_version == 0 || -+ coex_sta->bt_coex_supported_version == 0xffff) { -+ btc->btc_get(btc, BTC_GET_U4_SUPPORTED_VERSION, -+ &coex_sta->bt_coex_supported_version); -+ -+ if (coex_sta->bt_coex_supported_version > 0 && -+ coex_sta->bt_coex_supported_version < 0xffff) -+ is_bt_reply = TRUE; -+ } else { -+ is_bt_reply = TRUE; -+ } -+ -+ if (coex_sta->num_of_profile > 0) -+ btc->btc_get_bt_afh_map_from_bt(btc, 0, p); -+ } -+ -+ if (is_bt_reply) { -+ if (coex_sta->bt_coex_supported_feature == 0) -+ btc->btc_get(btc, BTC_GET_U4_SUPPORTED_FEATURE, -+ &coex_sta->bt_coex_supported_feature); -+ -+ if (coex_sta->bt_reg_vendor_ac == 0xffff) { -+ val = btc->btc_get_bt_reg(btc, 3, 0xac); -+ coex_sta->bt_reg_vendor_ac = (u16)(val & 0xffff); -+ } -+ -+ if (coex_sta->bt_reg_vendor_ae == 0xffff) { -+ val = btc->btc_get_bt_reg(btc, 3, 0xae); -+ coex_sta->bt_reg_vendor_ae = (u16)(val & 0xffff); -+ } -+ -+ if (btc->bt_info.bt_get_fw_ver == 0) { -+ btc->btc_get(btc, BTC_GET_U4_BT_PATCH_VER, -+ &bt_patch_ver); -+ btc->bt_info.bt_get_fw_ver = bt_patch_ver; -+ } -+ } -+ -+ if (++cnt >= 3) -+ cnt = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %s/ %s / 0x%x", -+ "Ant PG Num/ Mech/ Pos/ RFE", -+ board_info->pg_ant_num, -+ (board_info->btdm_ant_num == 1 ? "Shared" : "Non-Shared"), -+ (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT -+ ? "Main" : "Aux"), -+ board_info->rfe_type); -+ CL_PRINTF(cli_buf); -+ -+ bt_patch_ver = btc->bt_info.bt_get_fw_ver; -+ btc->btc_get(btc, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ phyver = btc->btc_get_bt_phydm_version(btc); -+ 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_8821c_1ant, glcoex_ver_8821c_1ant, -+ glcoex_ver_btdesired_8821c_1ant, -+ bt_coex_ver, -+ (bt_coex_ver == 0xff ? "Unknown" : -+ (coex_sta->bt_disabled ? "BT-disable" : -+ (bt_coex_ver >= glcoex_ver_btdesired_8821c_1ant ? -+ "Match" : "Mis-Match")))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x(%s)/ 0x%x/ v%d/ %c", -+ "W_FW/ B_FW/ Phy/ Kt", fw_ver, -+ (fw_ver >= glcoex_ver_wldesired_8821c_1ant ? -+ "Match" : -+ "Mis-Match"), -+ bt_patch_ver, phyver, coex_sta->kt_ver + 65); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x (RF-Ch = %d)", -+ "AFH Map to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2], coex_sta->wl_center_channel); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btc->btc_disp_dbg_msg(btc, 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/ %ddBm/ %d/ %d", -+ "BT status/ rssi/ retryCnt/ popCnt", -+ ((coex_sta->bt_disabled) ? ("disabled") : -+ ((coex_sta->c2h_bt_inquiry_page) ? ("inquiry-page") : -+ ((coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_NCON_IDLE) -+ ? "non-connected-idle" : -+ ((coex_dm->bt_status == BT_8821C_1ANT_BSTATUS_CON_IDLE) -+ ? "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%s (multilink = %d)", -+ "Profiles", ((bt_link_info->a2dp_exist) ? -+ ((coex_sta->is_bt_a2dp_sink) ? "A2DP sink," : -+ "A2DP,") : ""), -+ ((bt_link_info->sco_exist) ? "HFP," : ""), -+ ((bt_link_info->hid_exist) ? -+ ((coex_sta->is_hid_rcu) ? "HID(RCU)" : -+ ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : -+ (coex_sta->bt_ble_hid_exist ? "HID(BLE)" : -+ "HID(2/18),"))) : ""), ((bt_link_info->pan_exist) ? -+ ((coex_sta->is_bt_opp_exist) ? "OPP," : "PAN,") : -+ ""), ((coex_sta->voice_over_HOGP) ? "Voice," : ""), -+ ((coex_sta->msft_mr_exist) ? "MR" : ""), -+ coex_sta->is_bt_multi_link); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "Profiles", -+ (coex_sta->msft_mr_exist) ? "MR" : "None"); -+ -+ CL_PRINTF(cli_buf); -+ -+ if (bt_link_info->a2dp_exist) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s/ %d/ 0x%x/ 0x%x/ %d", -+ "CQDDR/Bitpool/V_ID/D_name/Flush", -+ ((coex_sta->is_A2DP_3M) ? "On" : "Off"), -+ coex_sta->a2dp_bit_pool, -+ coex_sta->bt_a2dp_vendor_id, -+ coex_sta->bt_a2dp_device_name, -+ coex_sta->bt_a2dp_flush_time); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (bt_link_info->hid_exist) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "HID PairNum", -+ coex_sta->hid_pair_cnt); -+ 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_role_switch, -+ (coex_dm->cur_ignore_wlan_act ? "Yes" : "No"), -+ coex_sta->bt_coex_supported_feature); -+ CL_PRINTF(cli_buf); -+ -+ if (coex_sta->is_ble_scan_en) { -+ 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 %s", -+ "ReInit/ReLink/IgnWlact/Page/NameReq", -+ coex_sta->cnt_reinit, -+ coex_sta->cnt_setup_link, -+ coex_sta->cnt_ign_wlan_act, -+ coex_sta->cnt_page, -+ coex_sta->cnt_remote_name_req, -+ (coex_sta->is_setup_link ? "(Relink!!)" : "")); -+ CL_PRINTF(cli_buf); -+ -+ halbtc8821c1ant_read_scbd(btc, &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/ 0x%04x", -+ "0xae[4]/0xac[1:0]/ScBd(B->W)", u16tmp[0]); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%04x", -+ "0xae[4]/0xac[1:0]/ScBd(B->W)", -+ (int)((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_8821C_1ANT_INFO_SRC_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 (btc->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, Timer:%d)", -+ "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_sta->tdma_timer_base); -+ CL_PRINTF(cli_buf); -+ -+ switch (coex_sta->wl_coex_mode) { -+ case BT_8821C_1ANT_WLINK_2G1PORT: -+ default: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "2G-SP"); -+ break; -+ case BT_8821C_1ANT_WLINK_2GMPORT: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "2G-MP"); -+ break; -+ case BT_8821C_1ANT_WLINK_25GMPORT: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "25G-MP"); -+ break; -+ case BT_8821C_1ANT_WLINK_5G: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "5G"); -+ break; -+ case BT_8821C_1ANT_WLINK_2GGO: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "2G-P2P"); -+ break; -+ case BT_8821C_1ANT_WLINK_BTMR: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "BT-MR"); -+ break; -+ } -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btc->btc_read_4byte(btc, 0x6c0); -+ u32tmp[1] = btc->btc_read_4byte(btc, 0x6c4); -+ u32tmp[2] = btc->btc_read_4byte(btc, 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] = btc->btc_read_1byte(btc, 0x778); -+ u32tmp[0] = btc->btc_read_4byte(btc, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%04x/ %d/ %d", -+ "0x778/0x6cc/ScBd(W->B)/RunCnt/Rsn", u8tmp[0], u32tmp[0], -+ coex_sta->score_board_WB, coex_sta->coex_run_cnt, -+ coex_sta->coex_run_reason); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d/ %d", -+ "AntDiv/BtCtrlLPS/LPRA/PsFail/g_busy", -+ (board_info->ant_div_cfg ? "On" : "Off"), -+ (coex_sta->force_lps_ctrl ? "On" : "Off"), -+ (coex_dm->cur_low_penalty_ra ? "On" : "Off"), -+ coex_sta->cnt_set_ps_state_fail, -+ coex_sta->gl_wifi_busy); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", -+ "Null All/Retry/Ack/BT_Empty/BT_Late", -+ coex_sta->wl_fw_dbg_info[1], -+ coex_sta->wl_fw_dbg_info[2], -+ coex_sta->wl_fw_dbg_info[3], -+ coex_sta->wl_fw_dbg_info[4], -+ coex_sta->wl_fw_dbg_info[5]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s/ %d", -+ "cnt TDMA_Togg/LK5ms/LK5ms_off/fw", -+ coex_sta->wl_fw_dbg_info[6], coex_sta->wl_fw_dbg_info[7], -+ ((coex_sta->is_no_wl_5ms_extend) ? "Yes" : "No"), -+ coex_sta->cnt_wl_fw_notify); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8821c1ant_read_indirect_reg(btc, 0x38); -+ lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? TRUE : FALSE; -+ -+ if (lte_coex_on) { -+ u32tmp[0] = halbtc8821c1ant_read_indirect_reg(btc, 0xa0); -+ u32tmp[1] = halbtc8821c1ant_read_indirect_reg(btc, 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_read_indirect_reg(btc, 0xa8); -+ u32tmp[1] = halbtc8821c1ant_read_indirect_reg(btc, 0xac); -+ u32tmp[2] = halbtc8821c1ant_read_indirect_reg(btc, 0xb0); -+ u32tmp[3] = halbtc8821c1ant_read_indirect_reg(btc, 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] = halbtc8821c1ant_read_indirect_reg(btc, 0x38); -+ u32tmp[1] = halbtc8821c1ant_read_indirect_reg(btc, 0x54); -+ u8tmp[0] = btc->btc_read_1byte(btc, 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 (gnt_err = %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/ 0x%x", -+ "GNT_WL/GNT_BT/ RF_0x1", -+ (int)((u32tmp[1] & BIT(2)) >> 2), -+ (int)((u32tmp[1] & BIT(3)) >> 3), -+ btc->btc_get_rf_reg(btc, BTC_RF_A, 0x1, 0xfffff)); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = btc->btc_read_4byte(btc, 0xcb0); -+ u32tmp[1] = btc->btc_read_4byte(btc, 0xcb4); -+ u8tmp[0] = btc->btc_read_1byte(btc, 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] & 0x1) == 0x1 ? "(BTG)" : "(WL_A+G)")); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btc->btc_read_4byte(btc, 0x430); -+ u32tmp[1] = btc->btc_read_4byte(btc, 0x434); -+ u16tmp[0] = btc->btc_read_2byte(btc, 0x42a); -+ u8tmp[0] = btc->btc_read_1byte(btc, 0x426); -+ u8tmp[1] = btc->btc_read_1byte(btc, 0x45e); -+ u8tmp[2] = btc->btc_read_1byte(btc, 0x455); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "430/434/42a/426/45e[3]/455", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0], -+ (int)((u8tmp[1] & BIT(3)) >> 3), u8tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btc->btc_read_4byte(btc, 0x4c); -+ u8tmp[2] = btc->btc_read_1byte(btc, 0x64); -+ u8tmp[0] = btc->btc_read_1byte(btc, 0x4c6); -+ u8tmp[1] = btc->btc_read_1byte(btc, 0x40); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "4c[24:23]/64[0]/4c6[4]/40[5]", -+ (int)(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] = btc->btc_read_4byte(btc, 0x550); -+ u8tmp[0] = btc->btc_read_1byte(btc, 0x522); -+ u8tmp[1] = btc->btc_read_1byte(btc, 0x953); -+ u8tmp[2] = btc->btc_read_1byte(btc, 0xc50); -+ u8tmp[3] = btc->btc_read_1byte(btc, 0x60a); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x/ 0x%x", -+ "0x550/0x522/4-RxAGC/0xc50/0x60a", -+ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off", -+ u8tmp[2], u8tmp[3]); -+ CL_PRINTF(cli_buf); -+ -+ fa_ofdm = btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_FA_OFDM); -+ fa_cck = btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_FA_CCK); -+ cca_ofdm = btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CCA_OFDM); -+ cca_cck = btc->btc_phydm_query_PHY_counter(btc, 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); -+ -+ 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_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/11ac", -+ 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); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %s-%d/ %d (Tx macid: %d)", -+ "Rate RxD/RxRTS/TxD/TxRetry_ratio", -+ coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate, -+ (coex_sta->wl_tx_rate & 0x80 ? "SGI" : "LGI"), -+ coex_sta->wl_tx_rate & 0x7f, -+ coex_sta->wl_tx_retry_ratio, -+ coex_sta->wl_tx_macid); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %s/ %d", -+ "HiPr/ Locking/ warn/ Locked/ Noisy", -+ (coex_sta->wifi_high_pri_task1 ? "Yes" : "No"), -+ (coex_sta->cck_lock ? "Yes" : "No"), -+ (coex_sta->cck_lock_warn ? "Yes" : "No"), -+ (coex_sta->cck_lock_ever ? "Yes" : "No"), -+ coex_sta->wl_noisy_level); -+ 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 %s", -+ "0x774(Lo-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx, -+ (bt_link_info->slave_role ? "(Slave!!)" : " ")); -+ CL_PRINTF(cli_buf); -+ -+ btc->btc_disp_dbg_msg(btc, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+void ex_halbtc8821c1ant_ips_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (type == BTC_IPS_ENTER) { -+ 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_write_scbd(btc, BT_8821C_1ANT_SCBD_ACTIVE | -+ BT_8821C_1ANT_SCBD_ONOFF | -+ BT_8821C_1ANT_SCBD_SCAN | -+ BT_8821C_1ANT_SCBD_UNDERTEST, -+ FALSE); -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_1ANT_PHASE_WOFF); -+ halbtc8821c1ant_action_coex_all_off(btc); -+ } else if (type == BTC_IPS_LEAVE) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_init_hw_config(btc, FALSE, FALSE); -+ halbtc8821c1ant_init_coex_dm(btc); -+ -+ coex_sta->under_ips = FALSE; -+ } -+} -+ -+void ex_halbtc8821c1ant_lps_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (type == BTC_LPS_ENABLE) { -+ 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_ctrl == TRUE) { /* LPS No-32K */ -+ /* Write WL "Active" in Score-board for PS-TDMA */ -+ halbtc8821c1ant_write_scbd(btc, -+ BT_8821C_1ANT_SCBD_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 -+ */ -+ halbtc8821c1ant_write_scbd(btc, -+ BT_8821C_1ANT_SCBD_ACTIVE, -+ FALSE); -+ -+ halbtc8821c1ant_action_wifi_native_lps(btc); -+ } -+ } else if (type == BTC_LPS_DISABLE) { -+ 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_write_scbd(btc, BT_8821C_1ANT_SCBD_ACTIVE, -+ TRUE); -+ -+ if (!coex_sta->force_lps_ctrl) { -+ halbtc8821c1ant_query_bt_info(btc); -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_LPS); -+ } -+ } -+} -+ -+void ex_halbtc8821c1ant_scan_notify(struct btc_coexist *btc, -+ u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ boolean wifi_connected = FALSE; -+ -+ if (btc->manual_control || -+ btc->stop_coex_dm) -+ return; -+ -+ coex_sta->freeze_coexrun_by_btinfo = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); -+ -+ if (wifi_connected) -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** WL connected before SCAN\n"); -+ else -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** WL is not connected before SCAN\n"); -+ -+ BTC_TRACE(trace_buf); -+ -+ if (type != BTC_SCAN_FINISH) { -+ -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_ACTIVE | -+ BT_8821C_1ANT_SCBD_SCAN | -+ BT_8821C_1ANT_SCBD_ONOFF, -+ TRUE); -+ } -+ -+ if (type == BTC_SCAN_START_5G) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify (5G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_1ANT_PHASE_5G); -+ -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_5GSCANSTART); -+ } else if (type == BTC_SCAN_START_2G || type == BTC_SCAN_START) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (!wifi_connected) -+ coex_sta->wifi_high_pri_task2 = TRUE; -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_2GSCANSTART); -+ } else { -+ btc->btc_get(btc, 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); -+ -+ coex_sta->wifi_high_pri_task2 = FALSE; -+ -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_SCANFINISH); -+ } -+} -+ -+void ex_halbtc8821c1ant_switchband_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ coex_sta->switch_band_notify_to = type; -+ -+ 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_run_coex(btc, BT_8821C_1ANT_RSN_5GSWITCHBAND); -+ -+ } 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); -+ -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_2GSWITCHBAND); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], switchband_notify --- switch to 2G\n"); -+ BTC_TRACE(trace_buf); -+ -+ ex_halbtc8821c1ant_scan_notify(btc, BTC_SCAN_START_2G); -+ } -+ -+ coex_sta->switch_band_notify_to = BTC_NOT_SWITCH; -+} -+ -+void ex_halbtc8821c1ant_connect_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_ACTIVE | -+ BT_8821C_1ANT_SCBD_SCAN | -+ BT_8821C_1ANT_SCBD_ONOFF, -+ TRUE); -+ -+ if (type == BTC_ASSOCIATE_5G_START || -+ type == BTC_ASSOCIATE_5G_FINISH) { -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_1ANT_PHASE_5G); -+ -+ if (type == BTC_ASSOCIATE_5G_START) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify (5G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_run_coex(btc, -+ BT_8821C_1ANT_RSN_5GCONSTART); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify (5G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_run_coex(btc, -+ BT_8821C_1ANT_RSN_5GCONFINISH); -+ } -+ -+ } else if (type == BTC_ASSOCIATE_START) { -+ coex_sta->wifi_high_pri_task1 = TRUE; -+ coex_dm->arp_cnt = 0; -+ coex_sta->connect_ap_period_cnt = 2; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_2GCONSTART); -+ -+ /* 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_high_pri_task1 = FALSE; -+ coex_sta->freeze_coexrun_by_btinfo = FALSE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_2GCONFINISH); -+ } -+} -+ -+void ex_halbtc8821c1ant_media_status_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ boolean wifi_under_b_mode = FALSE; -+ u8 h2c_parameter[2] = {0}; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (type == BTC_MEDIA_CONNECT || type == BTC_MEDIA_CONNECT_5G) { -+ -+ halbtc8821c1ant_write_scbd(btc, -+ BT_8821C_1ANT_SCBD_ACTIVE | -+ BT_8821C_1ANT_SCBD_ONOFF, -+ TRUE); -+ -+ if (type == BTC_MEDIA_CONNECT_5G) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], media_status_notify --- 5G\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, -+ FC_EXCU, -+ BT_8821C_1ANT_PHASE_5G); -+ -+ halbtc8821c1ant_run_coex(btc, -+ BT_8821C_1ANT_RSN_5GMEDIA); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], media_status_notify --- 2G\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, -+ FC_EXCU, -+ BT_8821C_1ANT_PHASE_2G); -+ -+ btc->btc_get(btc, 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->btc_write_1byte_bitmask(btc, 0x6cf, BIT(4), -+ 0x0); -+ else -+ btc->btc_write_1byte_bitmask(btc, 0x6cf, BIT(4), -+ 0x1); -+ /*Leap-AP protection will reopen when connecting AP*/ -+ h2c_parameter[0] = 0xc; -+ h2c_parameter[1] = 0x0; -+ btc->btc_fill_h2c(btc, 0x69, 2, h2c_parameter); -+ coex_sta->is_no_wl_5ms_extend = FALSE; -+ -+ halbtc8821c1ant_run_coex(btc, -+ BT_8821C_1ANT_RSN_2GMEDIA); -+ } -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], media disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ btc->btc_write_1byte_bitmask(btc, 0x6cf, BIT(4), 0x0); -+ -+ coex_sta->cck_lock_ever = FALSE; -+ coex_sta->cck_lock_warn = FALSE; -+ coex_sta->cck_lock = FALSE; -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_MEDIADISCON); -+ } -+ btc->btc_get(btc, BTC_GET_U1_IOT_PEER, &coex_sta->wl_iot_peer); -+ halbtc8821c1ant_update_wifi_ch_info(btc, type); -+} -+ -+void ex_halbtc8821c1ant_specific_packet_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct coex_dm_8821c_1ant *coex_dm = &btc->coex_dm_8821c_1ant; -+ boolean under_4way = FALSE; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (type & BTC_5G_BAND) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 5g special packet notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_5GSPECIALPKT); -+ return; -+ } -+ -+ btc->btc_get(btc, 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_high_pri_task1 = TRUE; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } else if (type == BTC_PACKET_ARP) { -+ 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_high_pri_task1 = TRUE; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } -+ -+ if (coex_sta->wifi_high_pri_task1) { -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_SCAN, TRUE); -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_2GSPECIALPKT); -+ } -+} -+ -+void ex_halbtc8821c1ant_bt_info_notify(struct btc_coexist *btc, u8 *tmp_buf, -+ u8 length) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ u8 i, rsp_source = 0; -+ boolean wifi_connected = FALSE; -+ boolean wifi_busy = FALSE; -+ static boolean is_scoreboard_scan; -+ const u16 type_is_scan = BT_8821C_1ANT_SCBD_SCAN; -+ u8 type; -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_8821C_1ANT_INFO_SRC_MAX) -+ rsp_source = BT_8821C_1ANT_INFO_SRC_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ if (rsp_source == BT_8821C_1ANT_INFO_SRC_BT_RSP || -+ rsp_source == BT_8821C_1ANT_INFO_SRC_BT_ACT) { -+ if (coex_sta->bt_disabled) { -+ coex_sta->bt_disabled = FALSE; -+ coex_sta->is_bt_reenable = TRUE; -+ coex_sta->cnt_bt_reenable = 15; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT enable detected by bt_info\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (rsp_source == BT_8821C_1ANT_INFO_SRC_WIFI_FW) { -+#if 0 -+ halbtc8821c1ant_update_bt_link_info(btc); -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_BTINFO); -+#endif -+ return; -+ } -+ -+ if (length != 7) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt_info length = %d invalid!!\n", -+ length); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt_info[%d], len=%d, data=[%02x %02x %02x %02x %02x %02x]\n", -+ tmp_buf[0], length, tmp_buf[1], tmp_buf[2], tmp_buf[3], -+ tmp_buf[4], tmp_buf[5], tmp_buf[6]); -+ BTC_TRACE(trace_buf); -+ -+ for (i = 0; i < 7; i++) -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][1] == coex_sta->bt_info_lb2 && -+ coex_sta->bt_info_c2h[rsp_source][2] == coex_sta->bt_info_lb3 && -+ coex_sta->bt_info_c2h[rsp_source][3] == coex_sta->bt_info_hb0 && -+ coex_sta->bt_info_c2h[rsp_source][4] == coex_sta->bt_info_hb1 && -+ coex_sta->bt_info_c2h[rsp_source][5] == coex_sta->bt_info_hb2 && -+ coex_sta->bt_info_c2h[rsp_source][6] == coex_sta->bt_info_hb3) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Return because Btinfo duplicate!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ coex_sta->bt_info_lb2 = coex_sta->bt_info_c2h[rsp_source][1]; -+ coex_sta->bt_info_lb3 = coex_sta->bt_info_c2h[rsp_source][2]; -+ coex_sta->bt_info_hb0 = coex_sta->bt_info_c2h[rsp_source][3]; -+ coex_sta->bt_info_hb1 = coex_sta->bt_info_c2h[rsp_source][4]; -+ coex_sta->bt_info_hb2 = coex_sta->bt_info_c2h[rsp_source][5]; -+ coex_sta->bt_info_hb3 = coex_sta->bt_info_c2h[rsp_source][6]; -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ coex_sta->bt_whck_test = -+ ((coex_sta->bt_info_lb2 == 0xff) ? TRUE : FALSE); -+ -+ coex_sta->bt_create_connection = -+ ((coex_sta->bt_info_lb3 & BIT(7)) ? TRUE : FALSE); -+ -+ /* unit: %, value-100 to translate to unit: dBm */ -+ coex_sta->bt_rssi = coex_sta->bt_info_hb0 * 2 + 10; -+ -+ coex_sta->c2h_bt_remote_name_req = -+ ((coex_sta->bt_info_lb3 & BIT(5)) ? TRUE : FALSE); -+ -+ coex_sta->is_A2DP_3M = -+ ((coex_sta->bt_info_lb3 & BIT(4)) ? TRUE : FALSE); -+ -+ coex_sta->acl_busy = -+ ((coex_sta->bt_info_lb2 & BIT(3)) ? TRUE : FALSE); -+ -+ coex_sta->voice_over_HOGP = -+ ((coex_sta->bt_info_hb1 & BIT(4)) ? TRUE : FALSE); -+ -+ coex_sta->c2h_bt_inquiry_page = -+ ((coex_sta->bt_info_lb2 & BIT(2)) ? TRUE : FALSE); -+ -+ if (coex_sta->bt_inq_page_pre != coex_sta->c2h_bt_inquiry_page) { -+ coex_sta->bt_inq_page_pre = coex_sta->c2h_bt_inquiry_page; -+ coex_sta->bt_inq_page_remain = TRUE; -+ -+ if (!coex_sta->c2h_bt_inquiry_page) -+ coex_sta->bt_inq_page_downcount = 2; -+ } -+ -+ if ((coex_sta->bt_info_lb2 & 0x49) == 0x49) -+ coex_sta->a2dp_bit_pool = (coex_sta->bt_info_hb3 & 0x7f); -+ else -+ coex_sta->a2dp_bit_pool = 0; -+ -+ coex_sta->is_bt_a2dp_sink = -+ (coex_sta->bt_info_hb3 & BIT(7)) ? TRUE : FALSE; -+ -+ coex_sta->bt_retry_cnt = coex_sta->bt_info_lb3 & 0xf; -+ -+ bt_link_info->slave_role = coex_sta->bt_info_hb2 & 0x8; -+ -+ coex_sta->bt_a2dp_active = coex_sta->bt_info_hb2 & 0x4; -+ -+ /*for a2dp_active = 0 but bt pkt remain exist -> -+ * Use PS-TDMA to protect WL RX*/ -+ if (!coex_sta->bt_a2dp_active && coex_sta->bt_a2dp_active_pre) { -+ coex_sta->bt_a2dp_active_remain = TRUE; -+ coex_sta->bt_a2dp_active_downcount = 5; -+ } -+ -+ coex_sta->bt_a2dp_active_pre = coex_sta->bt_a2dp_active; -+ -+ coex_sta->hid_busy_num = (coex_sta->bt_info_hb2 & 0x30) >> 4; -+ -+ coex_sta->hid_pair_cnt = (coex_sta->bt_info_hb2 & 0xc0) >> 6; -+ -+ if (coex_sta->hid_pair_cnt > 0 && coex_sta->hid_busy_num >= 2) { -+ coex_sta->bt_418_hid_exist = TRUE; -+ } else if (coex_sta->hid_pair_cnt == 0 || -+ coex_sta->hid_busy_num == 1) { -+ coex_sta->bt_418_hid_exist = FALSE; -+ coex_sta->bt_ble_hid_exist = FALSE; -+ } -+ -+ coex_sta->is_bt_opp_exist = -+ (coex_sta->bt_info_hb2 & BIT(0)) ? TRUE : FALSE; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->c2h_bt_remote_name_req) -+ coex_sta->cnt_remote_name_req++; -+ -+ if (coex_sta->bt_info_hb1 & BIT(1)) -+ coex_sta->cnt_reinit++; -+ -+ if ((coex_sta->bt_info_hb1 & BIT(2)) || -+ (coex_sta->bt_create_connection && -+ coex_sta->wl_pnp_wakeup_downcnt > 0)) { -+ coex_sta->cnt_setup_link++; -+ coex_sta->is_setup_link = TRUE; -+ -+ if (coex_sta->is_bt_reenable) -+ coex_sta->bt_relink_downcount = 6; -+ else -+ coex_sta->bt_relink_downcount = 2; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Re-Link start in BT info!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (coex_sta->bt_info_hb1 & BIT(3)) -+ coex_sta->cnt_ign_wlan_act++; -+ -+ if (coex_sta->bt_info_hb1 & BIT(6)) -+ coex_sta->cnt_role_switch++; -+ -+ if (coex_sta->bt_info_hb1 & BIT(7)) -+ coex_sta->is_bt_multi_link = TRUE; -+ else -+ coex_sta->is_bt_multi_link = FALSE; -+ -+ if (coex_sta->bt_info_lb2 & BIT(5)) { -+ if (coex_sta->bt_info_hb1 & BIT(0)) { -+ /*BLE HID*/ -+ coex_sta->bt_ble_hid_exist = TRUE; -+ coex_sta->is_hid_rcu = FALSE; -+ } -+ } else if (coex_sta->bt_info_hb1 & BIT(0)) { -+ /*RCU*/ -+ coex_sta->is_hid_rcu = TRUE; -+ } else { -+ coex_sta->bt_ble_hid_exist = FALSE; -+ coex_sta->is_hid_rcu = FALSE; -+ } -+ -+ if (coex_sta->bt_info_hb1 & BIT(5)) -+ coex_sta->is_ble_scan_en = TRUE; -+ else -+ coex_sta->is_ble_scan_en = FALSE; -+ -+ if (coex_sta->bt_create_connection) { -+ coex_sta->cnt_page++; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (coex_sta->is_wifi_linkscan_process || -+ coex_sta->wifi_high_pri_task1 || -+ coex_sta->wifi_high_pri_task2 || wifi_busy) { -+ is_scoreboard_scan = TRUE; -+ halbtc8821c1ant_write_scbd(btc, type_is_scan, TRUE); -+ } else { -+ halbtc8821c1ant_write_scbd(btc, type_is_scan, FALSE); -+ } -+ } else { -+ if (is_scoreboard_scan) { -+ halbtc8821c1ant_write_scbd(btc, type_is_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. */ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); -+ /* Re-Init */ -+ if ((coex_sta->bt_info_hb1 & 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) -+ type = BTC_MEDIA_CONNECT; -+ else -+ type = BTC_MEDIA_DISCONNECT; -+ halbtc8821c1ant_update_wifi_ch_info(btc, type); -+ } -+ -+ /* If Ignore_WLanAct && not SetUp_Link */ -+ if ((coex_sta->bt_info_hb1 & BIT(3)) && -+ (!(coex_sta->bt_info_hb1 & 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(btc, FC_EXCU, FALSE); -+ } -+ -+ halbtc8821c1ant_update_bt_link_info(btc); -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_BTINFO); -+} -+ -+void ex_halbtc8821c1ant_wl_fwdbginfo_notify(struct btc_coexist *btc, -+ u8 *tmp_buf, u8 length) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ u8 i = 0; -+ static u8 tmp_buf_pre[10]; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi Fw Dbg info = %d %d %d %d %d %d %d %d (len = %d)\n", -+ tmp_buf[0], tmp_buf[1], tmp_buf[2], tmp_buf[3], tmp_buf[4], -+ tmp_buf[5], tmp_buf[6], tmp_buf[7], length); -+ BTC_TRACE(trace_buf); -+ -+ if (tmp_buf[0] == 0x8) { -+ for (i = 1; i <= 7; i++) { -+ coex_sta->wl_fw_dbg_info[i] = -+ (tmp_buf[i] >= tmp_buf_pre[i]) ? -+ (tmp_buf[i] - tmp_buf_pre[i]) : -+ (255 - tmp_buf_pre[i] + tmp_buf[i]); -+ -+ tmp_buf_pre[i] = tmp_buf[i]; -+ } -+ } -+ -+ coex_sta->cnt_wl_fw_notify++; -+ halbtc8821c1ant_ccklock_action(btc); -+} -+ -+void ex_halbtc8821c1ant_rx_rate_change_notify(struct btc_coexist *btc, -+ BOOLEAN is_data_frame, -+ u8 btc_rate_id) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ -+ if (is_data_frame) { -+ coex_sta->wl_rx_rate = btc_rate_id; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], rx_rate_change_notify data rate id = %d, RTS_Rate = %d\n", -+ coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_sta->wl_rts_rx_rate = btc_rate_id; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], rts_rate_change_notify RTS rate id = %d, RTS_Rate = %d\n", -+ coex_sta->wl_rts_rx_rate, coex_sta->wl_rts_rx_rate); -+ BTC_TRACE(trace_buf); -+ } -+ -+ halbtc8821c1ant_ccklock_detect(btc); -+} -+ -+void ex_halbtc8821c1ant_tx_rate_change_notify(struct btc_coexist *btc, -+ u8 tx_rate, u8 tx_retry_ratio, -+ u8 macid) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], tx_rate_change_notify Tx_Rate = %d, Tx_Retry_Ratio = %d, macid =%d\n", -+ tx_rate, tx_retry_ratio, macid); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_tx_rate = tx_rate; -+ coex_sta->wl_tx_retry_ratio = tx_retry_ratio; -+ coex_sta->wl_tx_macid = macid; -+} -+ -+void ex_halbtc8821c1ant_rf_status_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (type == BTC_RF_ON) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btc->stop_coex_dm = FALSE; -+ btc->wl_rf_state_off = FALSE; -+ } else if (type == BTC_RF_OFF) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_ACTIVE | -+ BT_8821C_1ANT_SCBD_ONOFF | -+ BT_8821C_1ANT_SCBD_SCAN | -+ BT_8821C_1ANT_SCBD_UNDERTEST, -+ FALSE); -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_1ANT_PHASE_WOFF); -+ -+ halbtc8821c1ant_action_coex_all_off(btc); -+ -+ btc->stop_coex_dm = TRUE; -+ btc->wl_rf_state_off = TRUE; -+ -+ /* must place in the last step */ -+ halbtc8821c1ant_update_wifi_ch_info(btc, BTC_MEDIA_DISCONNECT); -+ } -+} -+ -+void ex_halbtc8821c1ant_halt_notify(struct btc_coexist *btc) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_ACTIVE | -+ BT_8821C_1ANT_SCBD_ONOFF | -+ BT_8821C_1ANT_SCBD_SCAN | -+ BT_8821C_1ANT_SCBD_UNDERTEST, -+ FALSE); -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_1ANT_PHASE_WOFF); -+ -+ halbtc8821c1ant_action_coex_all_off(btc); -+ -+ btc->stop_coex_dm = TRUE; -+ -+ /* must place in the last step */ -+ halbtc8821c1ant_update_wifi_ch_info(btc, BTC_MEDIA_DISCONNECT); -+} -+ -+void ex_halbtc8821c1ant_pnp_notify(struct btc_coexist *btc, u8 pnp_state) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct wifi_link_info_8821c_1ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_1ant; -+ static u8 pre_pnp_state; -+ u8 phase; -+ -+ if (pnp_state == BTC_WIFI_PNP_SLEEP || -+ pnp_state == BTC_WIFI_PNP_SLEEP_KEEP_ANT) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_write_scbd(btc, BT_8821C_1ANT_SCBD_ACTIVE | -+ BT_8821C_1ANT_SCBD_ONOFF | -+ BT_8821C_1ANT_SCBD_SCAN | -+ BT_8821C_1ANT_SCBD_UNDERTEST, -+ FALSE); -+ -+ if (pnp_state == BTC_WIFI_PNP_SLEEP_KEEP_ANT) { -+ if (wifi_link_info_ext->is_all_under_5g) -+ phase = BT_8821C_1ANT_PHASE_5G; -+ else -+ phase = BT_8821C_1ANT_PHASE_2G; -+ } else { -+ phase = BT_8821C_1ANT_PHASE_WOFF; -+ } -+ -+ halbtc8821c1ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ phase); -+ btc->stop_coex_dm = TRUE; -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->wl_pnp_wakeup_downcnt = 3; -+ -+ /*WoWLAN*/ -+ if (pre_pnp_state == BTC_WIFI_PNP_SLEEP_KEEP_ANT || -+ pnp_state == BTC_WIFI_PNP_WOWLAN) { -+ coex_sta->run_time_state = TRUE; -+ btc->stop_coex_dm = FALSE; -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_PNP); -+ } -+ } -+ pre_pnp_state = pnp_state; -+} -+ -+void ex_halbtc8821c1ant_coex_dm_reset(struct btc_coexist *btc) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], *****************Coex DM Reset*****************\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_init_hw_config(btc, FALSE, FALSE); -+ halbtc8821c1ant_init_coex_dm(btc); -+} -+ -+void ex_halbtc8821c1ant_periodical(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_1ant *coex_sta = &btc->coex_sta_8821c_1ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ boolean wifi_busy = FALSE; -+ u16 bt_scoreboard_val = 0; -+ boolean bt_relink_finish = FALSE, is_defreeze = FALSE, -+ bt_ctr_change = FALSE; -+ static u8 freeze_cnt; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ************* Periodical *************\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (!btc->auto_report) -+ halbtc8821c1ant_query_bt_info(btc); -+ -+ bt_ctr_change = halbtc8821c1ant_monitor_bt_ctr(btc); -+ halbtc8821c1ant_monitor_wifi_ctr(btc); -+ halbtc8821c1ant_update_wifi_link_info(btc, -+ BT_8821C_1ANT_RSN_PERIODICAL); -+ halbtc8821c1ant_monitor_bt_enable(btc); -+ -+ if (coex_sta->bt_relink_downcount != 0) { -+ coex_sta->bt_relink_downcount--; -+ -+ if (coex_sta->bt_relink_downcount == 0) { -+ coex_sta->is_setup_link = FALSE; -+ bt_relink_finish = TRUE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Re-Link stop by periodical count-down!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (coex_sta->bt_inq_page_downcount != 0) { -+ coex_sta->bt_inq_page_downcount--; -+ if (coex_sta->bt_inq_page_downcount == 0) { -+ coex_sta->bt_inq_page_remain = FALSE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT inquiry-page disappear!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (coex_sta->bt_a2dp_active_downcount != 0) { -+ coex_sta->bt_a2dp_active_downcount--; -+ if (coex_sta->bt_a2dp_active_downcount == 0) { -+ coex_sta->bt_a2dp_active_remain = FALSE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT A2DP active disappear!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (coex_sta->freeze_coexrun_by_btinfo) { -+ freeze_cnt++; -+ -+ if (freeze_cnt >= 5) { -+ freeze_cnt = 0; -+ coex_sta->freeze_coexrun_by_btinfo = FALSE; -+ is_defreeze = TRUE; -+ } -+ } else { -+ freeze_cnt = 0; -+ } -+ -+ /* for 4-way, DHCP, EAPOL packet */ -+ if (coex_sta->specific_pkt_period_cnt > 0) { -+ coex_sta->specific_pkt_period_cnt--; -+ -+ if (!coex_sta->freeze_coexrun_by_btinfo && -+ coex_sta->specific_pkt_period_cnt == 0) -+ coex_sta->wifi_high_pri_task1 = FALSE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Hi-Pri Task = %s\n", -+ (coex_sta->wifi_high_pri_task1 ? "Yes" : "No")); -+ BTC_TRACE(trace_buf); -+ } -+ -+ /*for A2DP glitch during connecting AP*/ -+ if (coex_sta->connect_ap_period_cnt > 0) -+ coex_sta->connect_ap_period_cnt--; -+ -+ if (coex_sta->wl_pnp_wakeup_downcnt > 0) { -+ coex_sta->wl_pnp_wakeup_downcnt--; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wl_pnp_wakeup_downcnt = %d!!\n", -+ coex_sta->wl_pnp_wakeup_downcnt); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (coex_sta->cnt_bt_reenable > 0) { -+ coex_sta->cnt_bt_reenable--; -+ if (coex_sta->cnt_bt_reenable == 0) { -+ coex_sta->is_bt_reenable = FALSE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT renable 30s finish!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (halbtc8821c1ant_moniter_wifibt_status(btc) || bt_relink_finish || -+ coex_sta->is_set_ps_state_fail || is_defreeze || bt_ctr_change) -+ halbtc8821c1ant_run_coex(btc, BT_8821C_1ANT_RSN_PERIODICAL); -+} -+ -+/*#pragma optimize( "", off )*/ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -+ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c1ant.h b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c1ant.h -new file mode 100644 -index 000000000..2afd70ff7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c1ant.h -@@ -0,0 +1,506 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821C_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8821C 1ANT BT Co-exist definition -+ * ******************************************* */ -+#define BT_8821C_1ANT_COEX_DBG 0 -+#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 BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT 2 -+ -+#define BT_8821C_1ANT_WIFI_NOISY_THRESH 30 -+#define BT_8821C_1ANT_DEFAULT_ISOLATION 15 -+ -+enum bt_8821c_1ant_signal_state { -+ BT_8821C_1ANT_GNT_SET_TO_LOW = 0x0, -+ BT_8821C_1ANT_GNT_SET_TO_HIGH = 0x1, -+ BT_8821C_1ANT_GNT_SET_BY_HW = 0x2, -+ BT_8821C_1ANT_GNT_SET_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_8821C_1ANT_INFO_SRC_WIFI_FW = 0x0, -+ BT_8821C_1ANT_INFO_SRC_BT_RSP = 0x1, -+ BT_8821C_1ANT_INFO_SRC_BT_ACT = 0x2, -+ BT_8821C_1ANT_INFO_SRC_MAX -+}; -+ -+enum bt_8821c_1ant_bt_status { -+ BT_8821C_1ANT_BSTATUS_NCON_IDLE = 0x0, -+ BT_8821C_1ANT_BSTATUS_CON_IDLE = 0x1, -+ BT_8821C_1ANT_BSTATUS_INQ_PAGE = 0x2, -+ BT_8821C_1ANT_BSTATUS_ACL_BUSY = 0x3, -+ BT_8821C_1ANT_BSTATUS_SCO_BUSY = 0x4, -+ BT_8821C_1ANT_BSTATUS_ACL_SCO_BUSY = 0x5, -+ BT_8821C_1ANT_BSTATUS_MAX -+}; -+ -+enum bt_8821c_1ant_wifi_status { -+ BT_8821C_1ANT_WSTATUS_NCON_IDLE = 0x0, -+ BT_8821C_1ANT_WSTATUS_NCON_SCAN = 0x1, -+ BT_8821C_1ANT_WSTATUS_CON_SCAN = 0x2, -+ BT_8821C_1ANT_WSTATUS_CON_SPECPKT = 0x3, -+ BT_8821C_1ANT_WSTATUS_CON_IDLE = 0x4, -+ BT_8821C_1ANT_WSTATUS_CON_BUSY = 0x5, -+ BT_8821C_1ANT_WSTATUS_MAX -+}; -+ -+enum bt_8821c_1ant_coex_algo { -+ BT_8821C_1ANT_COEX_UNDEFINED = 0x0, -+ BT_8821C_1ANT_COEX_SCO = 0x1, -+ BT_8821C_1ANT_COEX_HID = 0x2, -+ BT_8821C_1ANT_COEX_A2DP = 0x3, -+ BT_8821C_1ANT_COEX_A2DP_PANHS = 0x4, -+ BT_8821C_1ANT_COEX_PAN = 0x5, -+ BT_8821C_1ANT_COEX_PANHS = 0x6, -+ BT_8821C_1ANT_COEX_PAN_A2DP = 0x7, -+ BT_8821C_1ANT_COEX_PAN_HID = 0x8, -+ BT_8821C_1ANT_COEX_HID_A2DP_PAN = 0x9, -+ BT_8821C_1ANT_COEX_HID_A2DP = 0xa, -+ BT_8821C_1ANT_COEX_MAX = 0xb, -+}; -+ -+enum bt_8821c_1ant_ext_ant_switch_type { -+ BT_8821C_1ANT_USE_DPDT = 0x0, -+ BT_8821C_1ANT_USE_SPDT = 0x1, -+ BT_8821C_1ANT_SWITCH_NONE = 0x2, -+ BT_8821C_1ANT_SWITCH_MAX -+}; -+ -+ -+enum bt_8821c_1ant_ext_ant_switch_ctrl_type { -+ BT_8821C_1ANT_CTRL_BY_BBSW = 0x0, -+ BT_8821C_1ANT_CTRL_BY_PTA = 0x1, -+ BT_8821C_1ANT_CTRL_BY_ANTDIV = 0x2, -+ BT_8821C_1ANT_CTRL_BY_MAC = 0x3, -+ BT_8821C_1ANT_CTRL_BY_BT = 0x4, -+ BT_8821C_1ANT_CTRL_BY_FW = 0x5, -+ BT_8821C_1ANT_CTRL_MAX -+}; -+ -+enum bt_8821c_1ant_ext_ant_switch_pos_type { -+ BT_8821C_1ANT_TO_BT = 0x0, -+ BT_8821C_1ANT_TO_WLG = 0x1, -+ BT_8821C_1ANT_TO_WLA = 0x2, -+ BT_8821C_1ANT_TO_NOCARE = 0x3, -+ BT_8821C_1ANT_TO_MAX -+}; -+ -+enum bt_8821c_1ant_phase { -+ BT_8821C_1ANT_PHASE_INIT = 0x0, -+ BT_8821C_1ANT_PHASE_WONLY = 0x1, -+ BT_8821C_1ANT_PHASE_WOFF = 0x2, -+ BT_8821C_1ANT_PHASE_2G = 0x3, -+ BT_8821C_1ANT_PHASE_5G = 0x4, -+ BT_8821C_1ANT_PHASE_BTMP = 0x5, -+ BT_8821C_1ANT_PHASE_ANTDET = 0x6, -+ BT_8821C_1ANT_PHASE_POWERON = 0x7, -+ BT_8821C_1ANT_PHASE_MCC = 0x8, -+ BT_8821C_1ANT_PHASE_MAX -+}; -+ -+enum bt_8821c_1ant_scoreboard { -+ BT_8821C_1ANT_SCBD_ACTIVE = BIT(0), -+ BT_8821C_1ANT_SCBD_ONOFF = BIT(1), -+ BT_8821C_1ANT_SCBD_SCAN = BIT(2), -+ BT_8821C_1ANT_SCBD_UNDERTEST = BIT(3), -+ BT_8821C_1ANT_SCBD_WLBUSY = BIT(6), -+ BT_8821C_1ANT_SCBD_TDMA = BIT(9), -+ BT_8821C_1ANT_SCBD_BTCQDDR = BIT(10), -+ BT_8821C_1ANT_SCBD_ALL = 0xffff -+}; -+ -+enum bt_8821c_1ant_RUNREASON { -+ BT_8821C_1ANT_RSN_2GSCANSTART = 0x0, -+ BT_8821C_1ANT_RSN_5GSCANSTART = 0x1, -+ BT_8821C_1ANT_RSN_SCANFINISH = 0x2, -+ BT_8821C_1ANT_RSN_2GSWITCHBAND = 0x3, -+ BT_8821C_1ANT_RSN_5GSWITCHBAND = 0x4, -+ BT_8821C_1ANT_RSN_2GCONSTART = 0x5, -+ BT_8821C_1ANT_RSN_5GCONSTART = 0x6, -+ BT_8821C_1ANT_RSN_2GCONFINISH = 0x7, -+ BT_8821C_1ANT_RSN_5GCONFINISH = 0x8, -+ BT_8821C_1ANT_RSN_2GMEDIA = 0x9, -+ BT_8821C_1ANT_RSN_5GMEDIA = 0xa, -+ BT_8821C_1ANT_RSN_MEDIADISCON = 0xb, -+ BT_8821C_1ANT_RSN_2GSPECIALPKT = 0xc, -+ BT_8821C_1ANT_RSN_5GSPECIALPKT = 0xd, -+ BT_8821C_1ANT_RSN_BTINFO = 0xe, -+ BT_8821C_1ANT_RSN_PERIODICAL = 0xf, -+ BT_8821C_1ANT_RSN_PNP = 0x10, -+ BT_8821C_1ANT_RSN_LPS = 0x11, -+ BT_8821C_1ANT_RSN_MAX -+}; -+ -+enum bt_8821c_1ant_WL_LINK_MODE { -+ BT_8821C_1ANT_WLINK_2G1PORT = 0x0, -+ BT_8821C_1ANT_WLINK_2GMPORT = 0x1, -+ BT_8821C_1ANT_WLINK_25GMPORT = 0x2, -+ BT_8821C_1ANT_WLINK_5G = 0x3, -+ BT_8821C_1ANT_WLINK_2GGO = 0x4, -+ BT_8821C_1ANT_WLINK_BTMR = 0x5, -+ BT_8821C_1ANT_WLINK_MAX -+}; -+ -+struct coex_dm_8821c_1ant { -+ /* hw setting */ -+ u32 cur_ant_pos_type; -+ -+ /* fw mechanism */ -+ boolean cur_ignore_wlan_act; -+ -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ boolean cur_ps_tdma_on; -+ -+ boolean cur_bt_auto_report; -+ u8 cur_lps; -+ u8 cur_rpwm; -+ -+ /* sw mechanism */ -+ boolean cur_low_penalty_ra; -+ -+ u32 cur_val0x6c0; -+ u32 cur_val0x6c4; -+ u32 cur_val0x6c8; -+ u8 cur_val0x6cc; -+ -+ /* algorithm related */ -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u32 arp_cnt; -+ -+ u32 cur_ext_ant_switch_status; -+ u32 setting_tdma; -+}; -+ -+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 msft_mr_exist; -+ boolean bt_a2dp_active; -+ 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 bt_ctr_ok; -+ boolean is_hi_pri_rx_overhead; -+ s8 bt_rssi; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ u8 bt_info_c2h[BT_8821C_1ANT_INFO_SRC_MAX][BTC_BTINFO_LENGTH_MAX]; -+ u32 bt_info_c2h_cnt[BT_8821C_1ANT_INFO_SRC_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ boolean bt_inq_page_pre; -+ boolean bt_inq_page_remain; -+ boolean c2h_bt_remote_name_req; -+ boolean c2h_bt_page; -+ boolean bt_a2dp_active_pre; -+ boolean bt_a2dp_active_remain; -+ -+ boolean wifi_high_pri_task1; -+ boolean wifi_high_pri_task2; -+ -+ u8 bt_info_lb2; -+ u8 bt_info_lb3; -+ u8 bt_info_hb0; -+ u8 bt_info_hb1; -+ u8 bt_info_hb2; -+ u8 bt_info_hb3; -+ -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ u8 bt_retry_cnt; -+ -+ 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 cck_lock_ever; -+ boolean cck_lock_warn; -+ -+ u8 coex_table_type; -+ boolean force_lps_ctrl; -+ boolean concurrent_rx_mode_on; -+ u16 score_board; -+ u8 isolation_btween_wb; /* 0~ 50 */ -+ -+ u8 a2dp_bit_pool; -+ u8 kt_ver; -+ 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; -+ boolean bt_418_hid_exist; -+ boolean bt_ble_hid_exist; -+ u8 forbidden_slot; -+ u8 hid_busy_num; -+ u8 hid_pair_cnt; -+ -+ u32 cnt_remote_name_req; -+ u32 cnt_setup_link; -+ u32 cnt_reinit; -+ u32 cnt_ign_wlan_act; -+ u32 cnt_page; -+ u32 cnt_role_switch; -+ u32 cnt_wl_fw_notify; -+ -+ u16 bt_reg_vendor_ac; -+ u16 bt_reg_vendor_ae; -+ -+ boolean is_setup_link; -+ u8 wl_noisy_level; -+ u32 gnt_error_cnt; -+ -+ u8 bt_afh_map[10]; -+ u8 bt_relink_downcount; -+ u8 bt_inq_page_downcount; -+ u8 bt_a2dp_active_downcount; -+ boolean is_tdma_btautoslot; -+ -+ u8 switch_band_notify_to; -+ -+ boolean is_hid_low_pri_tx_overhead; -+ boolean is_bt_multi_link; -+ boolean is_bt_a2dp_sink; -+ boolean is_set_ps_state_fail; -+ u8 cnt_set_ps_state_fail; -+ -+ u8 wl_fw_dbg_info[10]; -+ u8 wl_rx_rate; -+ u8 wl_tx_rate; -+ u8 wl_rts_rx_rate; -+ u8 wl_center_channel; -+ u8 wl_tx_macid; -+ u8 wl_tx_retry_ratio; -+ -+ u16 score_board_WB; -+ boolean is_hid_rcu; -+ u8 bt_a2dp_vendor_id; -+ u32 bt_a2dp_device_name; -+ u32 bt_a2dp_flush_time; -+ boolean is_ble_scan_en; -+ -+ boolean is_bt_opp_exist; -+ boolean gl_wifi_busy; -+ u8 connect_ap_period_cnt; -+ -+ boolean is_bt_reenable; -+ u8 cnt_bt_reenable; -+ boolean is_wifi_linkscan_process; -+ u8 wl_coex_mode; -+ u8 wl_pnp_wakeup_downcnt; -+ u32 coex_run_cnt; -+ boolean is_no_wl_5ms_extend; -+ -+ u16 wl_0x42a_backup; -+ u32 wl_0x430_backup; -+ u32 wl_0x434_backup; -+ u8 wl_0x455_backup; -+ -+ boolean wl_tx_limit_en; -+ boolean wl_ampdu_limit_en; -+ boolean wl_rxagg_limit_en; -+ u8 wl_rxagg_size; -+ u8 coex_run_reason; -+ -+ u8 tdma_timer_base; -+ boolean wl_slot_toggle; -+ boolean wl_slot_toggle_change; /* if toggle to no-toggle */ -+ u8 wl_iot_peer; -+}; -+ -+ -+#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; -+ /* 0:DPDT, 1:SPDT */ -+ u8 ext_ant_switch_type; -+ /* iF 0: DPDT_P=0, DPDT_N=1 => BTG to Main, WL_A+G to Aux */ -+ u8 ext_ant_switch_ctrl_polarity; -+ -+ boolean ext_band_switch_exist; -+ /* 0:DPDT, 1:SPDT */ -+ u8 ext_band_switch_type; -+ u8 ext_band_switch_ctrl_polarity; -+ boolean ant_at_main_port; -+ -+ /* If TRUE: WLG at BTG, If FALSE: WLG at WLAG */ -+ boolean wlg_locate_at_btg; -+ -+ /* If diversity on */ -+ boolean ext_ant_switch_diversity; -+}; -+ -+struct wifi_link_info_8821c_1ant { -+ u8 num_of_active_port; -+ u32 port_connect_status; -+ boolean is_all_under_5g; -+ boolean is_mcc_25g; -+ boolean is_p2p_connected; -+ boolean is_connected; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8821c1ant_power_on_setting(struct btc_coexist *btc); -+void ex_halbtc8821c1ant_pre_load_firmware(struct btc_coexist *btc); -+void ex_halbtc8821c1ant_init_hw_config(struct btc_coexist *btc, -+ boolean wifi_only); -+void ex_halbtc8821c1ant_init_coex_dm(struct btc_coexist *btc); -+void ex_halbtc8821c1ant_ips_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c1ant_lps_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c1ant_scan_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c1ant_switchband_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c1ant_connect_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c1ant_media_status_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c1ant_specific_packet_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c1ant_bt_info_notify(struct btc_coexist *btc, -+ u8 *tmp_buf, u8 length); -+void ex_halbtc8821c1ant_wl_fwdbginfo_notify(struct btc_coexist *btc, -+ u8 *tmp_buf, u8 length); -+void ex_halbtc8821c1ant_rx_rate_change_notify(struct btc_coexist *btc, -+ BOOLEAN is_data_frame, -+ u8 btc_rate_id); -+void ex_halbtc8821c1ant_tx_rate_change_notify(struct btc_coexist *btc, -+ u8 tx_rate, -+ u8 tx_retry_ratio, u8 macid); -+void ex_halbtc8821c1ant_rf_status_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c1ant_halt_notify(struct btc_coexist *btc); -+void ex_halbtc8821c1ant_pnp_notify(struct btc_coexist *btc, -+ u8 pnp_state); -+void ex_halbtc8821c1ant_coex_dm_reset(struct btc_coexist *btc); -+void ex_halbtc8821c1ant_periodical(struct btc_coexist *btc); -+void ex_halbtc8821c1ant_display_simple_coex_info(struct btc_coexist *btc); -+void ex_halbtc8821c1ant_display_coex_info(struct btc_coexist *btc); -+ -+#else -+#define ex_halbtc8821c1ant_power_on_setting(btc) -+#define ex_halbtc8821c1ant_pre_load_firmware(btc) -+#define ex_halbtc8821c1ant_init_hw_config(btc, wifi_only) -+#define ex_halbtc8821c1ant_init_coex_dm(btc) -+#define ex_halbtc8821c1ant_ips_notify(btc, type) -+#define ex_halbtc8821c1ant_lps_notify(btc, type) -+#define ex_halbtc8821c1ant_scan_notify(btc, type) -+#define ex_halbtc8821c1ant_switchband_notify(btc, type) -+#define ex_halbtc8821c1ant_connect_notify(btc, type) -+#define ex_halbtc8821c1ant_media_status_notify(btc, type) -+#define ex_halbtc8821c1ant_specific_packet_notify(btc, type) -+#define ex_halbtc8821c1ant_bt_info_notify(btc, tmp_buf, length) -+#define ex_halbtc8821c1ant_wl_fwdbginfo_notify(btc, tmp_buf, length) -+#define ex_halbtc8821c1ant_rx_rate_change_notify(btc, is_data_frame, \ -+ btc_rate_id) -+#define ex_halbtc8821c1ant_tx_rate_change_notify(btcoexist, tx_rate, \ -+ tx_retry_ratio, macid) -+#define ex_halbtc8821c1ant_rf_status_notify(btc, type) -+#define ex_halbtc8821c1ant_halt_notify(btc) -+#define ex_halbtc8821c1ant_pnp_notify(btc, pnp_state) -+#define ex_halbtc8821c1ant_coex_dm_reset(btc) -+#define ex_halbtc8821c1ant_periodical(btc) -+#define ex_halbtc8821c1ant_display_simple_coex_info(btc) -+#define ex_halbtc8821c1ant_display_coex_info(btc) -+#endif -+ -+#endif -+ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c2ant.c b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c2ant.c -new file mode 100644 -index 000000000..ed403271e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c2ant.c -@@ -0,0 +1,5659 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821C_SUPPORT == 1) -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+ -+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 = 20210319; -+u32 glcoex_ver_8821c_2ant = 0x55; -+u32 glcoex_ver_btdesired_8821c_2ant = 0x53; -+u32 glcoex_ver_wldesired_8821c_2ant = 0x170011; -+ -+static -+u8 halbtc8821c2ant_bt_rssi_state(struct btc_coexist *btc, -+ u8 *ppre_bt_rssi_state, u8 level_num, -+ u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ 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; -+} -+ -+static -+u8 halbtc8821c2ant_wifi_rssi_state(struct btc_coexist *btc, -+ u8 *pprewifi_rssi_state, -+ u8 level_num, -+ u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = *pprewifi_rssi_state; -+ -+ btc->btc_get(btc, 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; -+} -+ -+static void -+halbtc8821c2ant_limited_tx(struct btc_coexist *btc, boolean force_exec, -+ boolean tx_limit_en, boolean ampdu_limit_en) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct wifi_link_info_8821c_2ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_2ant; -+ boolean wifi_under_b_mode = FALSE; -+ -+ /* Force Max Tx retry limit = 8*/ -+ if (!coex_sta->wl_tx_limit_en) { -+ coex_sta->wl_0x430_backup = btc->btc_read_4byte(btc, 0x430); -+ coex_sta->wl_0x434_backup = btc->btc_read_4byte(btc, 0x434); -+ coex_sta->wl_0x42a_backup = btc->btc_read_2byte(btc, 0x42a); -+ } -+ -+ if (!coex_sta->wl_ampdu_limit_en) -+ coex_sta->wl_0x455_backup = btc->btc_read_1byte(btc, 0x455); -+ -+ if (!force_exec && tx_limit_en == coex_sta->wl_tx_limit_en && -+ ampdu_limit_en == coex_sta->wl_ampdu_limit_en) -+ return; -+ -+ coex_sta->wl_tx_limit_en = tx_limit_en; -+ coex_sta->wl_ampdu_limit_en = ampdu_limit_en; -+ -+ if (tx_limit_en) { -+ /* Set BT polluted packet on for Tx rate adaptive not -+ * including Tx retry break by PTA, 0x45c[19] =1 -+ * Set queue life time to avoid can't reach tx retry limit -+ * if tx is always break by GNT_BT. -+ */ -+ btc->btc_write_1byte_bitmask(btc, 0x45e, 0x8, 0x1); -+ btc->btc_write_1byte_bitmask(btc, 0x426, 0xf, 0xf); -+ -+ /* Max Tx retry limit = 8*/ -+ btc->btc_write_2byte(btc, 0x42a, 0x0808); -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ /* Auto rate fallback step within 8 retry*/ -+ if (wifi_under_b_mode) { -+ btc->btc_write_4byte(btc, 0x430, 0x1000000); -+ btc->btc_write_4byte(btc, 0x434, 0x1010101); -+ } else { -+ btc->btc_write_4byte(btc, 0x430, 0x1000000); -+ btc->btc_write_4byte(btc, 0x434, 0x4030201); -+ } -+ } else { -+ /* Set BT polluted packet on for Tx rate adaptive not -+ *including Tx retry break by PTA, 0x45c[19] =1 -+ */ -+ btc->btc_write_1byte_bitmask(btc, 0x45e, 0x8, 0x0); -+ btc->btc_write_1byte_bitmask(btc, 0x426, 0xf, 0x0); -+ -+ /* Set queue life time to avoid can't reach tx retry limit -+ * if tx is always break by GNT_BT. -+ */ -+ if (wifi_link_info_ext->num_of_active_port == 1) -+ btc->btc_write_1byte_bitmask(btc, 0x426, 0xf, 0x0); -+ -+ /* Recovery Max Tx retry limit*/ -+ btc->btc_write_2byte(btc, 0x42a, coex_sta->wl_0x42a_backup); -+ btc->btc_write_4byte(btc, 0x430, coex_sta->wl_0x430_backup); -+ btc->btc_write_4byte(btc, 0x434, coex_sta->wl_0x434_backup); -+ } -+ -+ if (ampdu_limit_en) -+ btc->btc_write_1byte(btc, 0x455, 0x20); -+ else -+ btc->btc_write_1byte(btc, 0x455, coex_sta->wl_0x455_backup); -+} -+ -+static void -+halbtc8821c2ant_limited_rx(struct btc_coexist *btc, boolean force_exec, -+ boolean rej_ap_agg_pkt, boolean bt_ctrl_agg_buf_size, -+ u8 agg_buf_size) -+{ -+#if 0 -+ struct coex_sta_8822b_2ant *coex_sta = &btc->coex_sta_8822b_2ant; -+ 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; -+ -+ if (!force_exec && -+ bt_ctrl_agg_buf_size == coex_sta->wl_rxagg_limit_en && -+ agg_buf_size == coex_sta->wl_rxagg_size) -+ return; -+ -+ coex_sta->wl_rxagg_limit_en = bt_ctrl_agg_buf_size; -+ coex_sta->wl_rxagg_size = agg_buf_size; -+ -+ /*btc->btc_set(btc, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &reject_rx_agg);*/ -+ /* decide BT control aggregation buf size or not */ -+ btc->btc_set(btc, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size*/ -+ btc->btc_set(btc, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btc->btc_set(btc, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+#endif -+} -+ -+static void -+halbtc8821c2ant_ccklock_action(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ u8 h2c_parameter[2] = {0}; -+ static u8 cnt; -+ boolean wifi_busy = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!coex_sta->gl_wifi_busy || -+ coex_sta->wl_iot_peer == BTC_IOT_PEER_CISCO) { -+ cnt = 0; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is not busy or CISCO AP, return!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (!coex_sta->is_no_wl_5ms_extend && coex_sta->force_lps_ctrl && -+ !coex_sta->cck_lock_ever) { -+ if (coex_sta->wl_fw_dbg_info[7] <= 5 && wifi_busy) -+ cnt++; -+ else -+ cnt = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 5ms WL slot extend cnt = %d!!\n", cnt); -+ BTC_TRACE(trace_buf); -+ -+ if (cnt == 7) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], set h2c 0x69 opcode 12 to turn off 5ms WL slot extend!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ h2c_parameter[0] = 0xc; -+ h2c_parameter[1] = 0x1; -+ btc->btc_fill_h2c(btc, 0x69, 2, h2c_parameter); -+ coex_sta->is_no_wl_5ms_extend = TRUE; -+ cnt = 0; -+ } -+ } else if (coex_sta->is_no_wl_5ms_extend && coex_sta->cck_lock) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], set h2c 0x69 opcode 12 to turn on 5ms WL slot extend!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ h2c_parameter[0] = 0xc; -+ h2c_parameter[1] = 0x0; -+ btc->btc_fill_h2c(btc, 0x69, 2, h2c_parameter); -+ coex_sta->is_no_wl_5ms_extend = FALSE; -+ } -+} -+ -+static void -+halbtc8821c2ant_ccklock_detect(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ struct wifi_link_info_8821c_2ant *link_info_ext = -+ &btc->wifi_link_info_8821c_2ant; -+ boolean is_cck_lock_rate = FALSE; -+ -+ if (coex_dm->bt_status == BTC_BTSTATUS_INQ_PAGE || -+ coex_sta->is_setup_link) -+ return; -+ -+ if (coex_sta->wl_rx_rate <= BTC_CCK_2 || -+ coex_sta->wl_rts_rx_rate <= BTC_CCK_2) -+ is_cck_lock_rate = TRUE; -+ -+ if (link_info_ext->is_connected && coex_sta->gl_wifi_busy && -+ (coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_ACL_BUSY || -+ coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_ACL_SCO_BUSY || -+ coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_SCO_BUSY)) { -+ if (coex_sta->wl_rx_rate == BTC_CCK_5_5 || -+ coex_sta->wl_rx_rate == BTC_OFDM_6 || -+ coex_sta->wl_rx_rate == BTC_MCS_0) { -+ coex_sta->cck_lock_warn = TRUE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], cck lock warning...\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((coex_sta->wl_rx_rate == BTC_CCK_1) || -+ (coex_sta->wl_rx_rate == BTC_CCK_2) || -+ (coex_sta->wl_rts_rx_rate == BTC_CCK_1) || -+ (coex_sta->wl_rts_rx_rate == BTC_CCK_2)) { -+ coex_sta->cck_lock = TRUE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], cck locking...\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_sta->cck_lock_warn = FALSE; -+ coex_sta->cck_lock = FALSE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], cck unlock...\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } else { -+ coex_sta->cck_lock_warn = FALSE; -+ coex_sta->cck_lock = FALSE; -+ } -+} -+ -+static void -+halbtc8821c2ant_set_tdma_timer_base(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ u16 tbtt_interval = 100; -+ u8 h2c_para[2] = {0xb, 0x1}; -+ -+ btc->btc_get(btc, BTC_GET_U2_BEACON_PERIOD, &tbtt_interval); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], tbtt_interval = %d\n", tbtt_interval); -+ BTC_TRACE(trace_buf); -+ -+ /* Add for JIRA coex-256 */ -+ if (type == 3 && tbtt_interval >= 100) { /* 50ms-slot */ -+ if (coex_sta->tdma_timer_base == 3) -+ return; -+ -+ h2c_para[1] = (tbtt_interval / 50) - 1; -+ h2c_para[1] = h2c_para[1] | 0xc0; /* 50ms-slot */ -+ coex_sta->tdma_timer_base = 3; -+ } else if (tbtt_interval < 80 && tbtt_interval > 0) { -+ if (coex_sta->tdma_timer_base == 2) -+ return; -+ h2c_para[1] = (100 / tbtt_interval); -+ -+ if (100 % tbtt_interval != 0) -+ h2c_para[1] = h2c_para[1] + 1; -+ -+ h2c_para[1] = h2c_para[1] & 0x3f; -+ coex_sta->tdma_timer_base = 2; -+ } else if (tbtt_interval >= 180) { -+ if (coex_sta->tdma_timer_base == 1) -+ return; -+ h2c_para[1] = (tbtt_interval / 100); -+ -+ if (tbtt_interval % 100 <= 80) -+ h2c_para[1] = h2c_para[1] - 1; -+ -+ h2c_para[1] = h2c_para[1] & 0x3f; -+ h2c_para[1] = h2c_para[1] | 0x80; -+ coex_sta->tdma_timer_base = 1; -+ } else { -+ if (coex_sta->tdma_timer_base == 0) -+ return; -+ h2c_para[1] = 0x1; -+ coex_sta->tdma_timer_base = 0; -+ } -+ -+ btc->btc_fill_h2c(btc, 0x69, 2, h2c_para); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s() h2c_0x69 = 0x%x\n", __func__, h2c_para[1]); -+ BTC_TRACE(trace_buf); -+} -+ -+static -+void halbtc8821c2ant_coex_switch_thres(struct btc_coexist *btc, -+ u8 isolation_measuared) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ 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; -+} -+ -+static -+void halbtc8821c2ant_low_penalty_ra(struct btc_coexist *btc, -+ boolean force_exec, boolean low_penalty_ra, -+ u8 thres) -+{ -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ static u8 cur_thres; -+ -+ if (!force_exec) { -+ if (low_penalty_ra == coex_dm->cur_low_penalty_ra && -+ thres == cur_thres) -+ return; -+ } -+ -+ if (low_penalty_ra) -+ btc->btc_phydm_modify_RA_PCR_threshold(btc, 0, thres); -+ else -+ btc->btc_phydm_modify_RA_PCR_threshold(btc, 0, 0); -+ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ cur_thres = thres; -+} -+ -+static -+void halbtc8821c2ant_set_antdiv_hwsw(struct btc_coexist *btc, -+ boolean force_exec, boolean is_hw_div) -+{ -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ static u8 pre_antdiv_type; -+ -+ coex_dm->cur_antdiv_type = ((is_hw_div) ? 1 : 0); -+ -+ if (!force_exec) { -+ if (coex_dm->cur_antdiv_type == pre_antdiv_type) -+ return; -+ } -+ -+ btc->btc_phydm_modify_antdiv_hwsw(btc, coex_dm->cur_antdiv_type); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s = %d!!\n", __func__, -+ coex_dm->cur_antdiv_type); -+ BTC_TRACE(trace_buf); -+ -+ pre_antdiv_type = coex_dm->cur_antdiv_type; -+} -+ -+static boolean -+halbtc8821c2ant_freerun_check(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ 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; -+ -+ wifi_rssi_state = -+ halbtc8821c2ant_wifi_rssi_state(btc, &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres, 0); -+ -+ bt_rssi_state = -+ halbtc8821c2ant_bt_rssi_state(btc, &pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres, 0); -+ -+ if (btc->board_info.ant_distance >= 40) -+ return TRUE; -+ -+ if (btc->board_info.ant_distance <= 5) -+ return FALSE; -+ -+ /* ant_distance = 5 ~ 40 */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state) && coex_sta->gl_wifi_busy) -+ return TRUE; -+ else -+ return FALSE; -+} -+ -+static -+void halbtc8821c2ant_write_scbd(struct btc_coexist *btc, u16 bitpos, -+ boolean state) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ static u16 originalval = 0x8002, preval; -+ -+ if (state) -+ originalval = originalval | bitpos; -+ else -+ originalval = originalval & (~bitpos); -+ -+ coex_sta->score_board_WB = originalval; -+ -+ if (originalval != preval) { -+ preval = originalval; -+ btc->btc_write_2byte(btc, 0xaa, originalval); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s: return for nochange\n", __func__); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+static -+void halbtc8821c2ant_read_scbd(struct btc_coexist *btc, u16 *score_board_val) -+{ -+ *score_board_val = (btc->btc_read_2byte(btc, 0xaa)) & 0x7fff; -+} -+ -+static -+void halbtc8821c2ant_query_bt_info(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ u8 h2c_parameter[1] = {0}; -+ -+ if (coex_sta->bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No query BT info because BT is disabled!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btc->btc_fill_h2c(btc, 0x61, 1, h2c_parameter); -+} -+ -+static -+void halbtc8821c2ant_enable_gnt_to_gpio(struct btc_coexist *btc, -+ boolean isenable) -+{ -+ static u8 bit_val[5] = {0, 0, 0, 0, 0}; -+ static boolean state; -+ -+ if (!btc->dbg_mode) -+ return; -+ -+ if (state == isenable) -+ return; -+ -+ state = isenable; -+ -+ if (isenable) { -+ /* enable GNT_WL, GNT_BT to GPIO for debug */ -+ btc->btc_write_1byte_bitmask(btc, 0x73, 0x8, 0x1); -+ -+ /* store original value */ -+ /*0x66[4] */ -+ bit_val[0] = (btc->btc_read_1byte(btc, 0x66) & BIT(4)) >> 4; -+ /*0x66[8] */ -+ bit_val[1] = (btc->btc_read_1byte(btc, 0x67) & BIT(0)); -+ /*0x40[19] */ -+ bit_val[2] = (btc->btc_read_1byte(btc, 0x42) & BIT(3)) >> 3; -+ /*0x64[15] */ -+ bit_val[3] = (btc->btc_read_1byte(btc, 0x65) & BIT(7)) >> 7; -+ /*0x70[18] */ -+ bit_val[4] = (btc->btc_read_1byte(btc, 0x72) & BIT(2)) >> 2; -+ -+ /* switch GPIO Mux */ -+ /*0x66[4] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x66, BIT(4), 0x0); -+ /*0x66[8] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, BIT(0), 0x0); -+ /*0x40[19] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x42, BIT(3), 0x0); -+ /*0x64[15] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x65, BIT(7), 0x0); -+ /*0x70[18] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x72, BIT(2), 0x0); -+ } else { -+ btc->btc_write_1byte_bitmask(btc, 0x73, 0x8, 0x0); -+ -+ /* Restore original value */ -+ /* switch GPIO Mux */ -+ /*0x66[4] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x66, BIT(4), bit_val[0]); -+ /*0x66[8] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, BIT(0), bit_val[1]); -+ /*0x40[19] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x42, BIT(3), bit_val[2]); -+ /*0x64[15] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x65, BIT(7), bit_val[3]); -+ /*0x70[18] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x72, BIT(2), bit_val[4]); -+ } -+} -+ -+static -+boolean halbtc8821c2ant_monitor_bt_ctr(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp, cnt_bt_all; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u8 cnt_overhead; -+ static u32 cnt_bt_pre = 0; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ boolean is_run_coex = FALSE; -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btc->btc_read_4byte(btc, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btc->btc_read_4byte(btc, 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 */ -+ btc->btc_write_1byte(btc, 0x76e, 0xc); -+ -+ if (coex_sta->under_lps || 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)) -+ coex_sta->bt_ctr_ok = FALSE; -+ else -+ coex_sta->bt_ctr_ok = TRUE; -+ -+ if (!coex_sta->bt_ctr_ok) -+ return FALSE; -+ -+ if (coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_NCON_IDLE) { -+ if (coex_sta->high_priority_rx >= 15) { -+ if (cnt_overhead < 3) -+ cnt_overhead++; -+ if (cnt_overhead == 3) -+ coex_sta->is_hi_pri_rx_overhead = TRUE; -+ } else { -+ if (cnt_overhead > 0) -+ cnt_overhead--; -+ if (cnt_overhead == 0) -+ coex_sta->is_hi_pri_rx_overhead = FALSE; -+ } -+ } else { -+ coex_sta->is_hi_pri_rx_overhead = FALSE; -+ } -+ -+ if (coex_sta->low_priority_tx > 1150 && -+ !coex_sta->c2h_bt_inquiry_page) -+ coex_sta->pop_event_cnt++; -+ -+ 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 (bt_link_info->hid_only) { -+ if (coex_sta->low_priority_tx > 100) -+ coex_sta->is_hid_low_pri_tx_overhead = true; -+ else -+ coex_sta->is_hid_low_pri_tx_overhead = false; -+ } -+ -+ cnt_bt_all = coex_sta->high_priority_tx + -+ coex_sta->high_priority_rx + -+ coex_sta->low_priority_tx + -+ coex_sta->low_priority_rx; -+ -+ if ((cnt_bt_pre > (cnt_bt_all + 50) || -+ cnt_bt_all > (cnt_bt_pre + 50)) && -+ coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_NCON_IDLE) -+ is_run_coex = TRUE; -+ -+ cnt_bt_pre = cnt_bt_all; -+ -+ return is_run_coex; -+} -+ -+static -+void halbtc8821c2ant_monitor_wifi_ctr(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ boolean wifi_busy = FALSE, wifi_scan = FALSE; -+ static u8 wl_noisy_count0, wl_noisy_count1 = 3, wl_noisy_count2; -+ u32 cnt_cck, fw_ver = 0; -+ static u8 cnt_ccklocking; -+ u8 h2c_parameter[1] = {0}; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_SCAN, &wifi_scan); -+ btc->btc_get(btc, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ -+ /* Only enable for windows in old fw version (COEX-308) -+ * because 8821cu H2C 0x69 unknown fail @ linux -+ */ -+ if (btc->chip_interface != BTC_INTF_USB || -+ (fw_ver < 0x170000 && fw_ver < 0x17000c) || -+ (fw_ver < 0x180000 && fw_ver < 0x180009) || -+ (fw_ver < 0x190000 && fw_ver < 0x190002)) { -+ /*send h2c to query WL FW dbg info */ -+ if (coex_dm->cur_ps_tdma_on) { -+ h2c_parameter[0] = 0x8; -+ btc->btc_fill_h2c(btc, 0x69, 1, h2c_parameter); -+ } -+ } -+ -+ coex_sta->crc_ok_cck = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_OK_CCK); -+ coex_sta->crc_ok_11g = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_OK_LEGACY); -+ coex_sta->crc_ok_11n = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_OK_HT); -+ coex_sta->crc_ok_11n_vht = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_OK_VHT); -+ -+ coex_sta->crc_err_cck = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_ERROR_CCK); -+ coex_sta->crc_err_11g = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_ERROR_LEGACY); -+ coex_sta->crc_err_11n = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_ERROR_HT); -+ coex_sta->crc_err_11n_vht = -+ btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_ERROR_VHT); -+ -+ /* CCK lock identification */ -+ if (coex_sta->cck_lock) -+ cnt_ccklocking++; -+ else if (cnt_ccklocking != 0) -+ cnt_ccklocking--; -+ -+ if (cnt_ccklocking >= 3) { -+ cnt_ccklocking = 3; -+ coex_sta->cck_lock_ever = TRUE; -+ } -+ -+ /* WiFi environment noisy identification */ -+ cnt_cck = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; -+ -+ if (!wifi_busy && !coex_sta->cck_lock) { -+ if (cnt_cck > 250) { -+ if (wl_noisy_count2 < 3) -+ wl_noisy_count2++; -+ -+ if (wl_noisy_count2 == 3) { -+ wl_noisy_count0 = 0; -+ wl_noisy_count1 = 0; -+ } -+ -+ } else if (cnt_cck < 100) { -+ 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; -+ } -+} -+ -+static -+void halbtc8821c2ant_monitor_bt_enable(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ static u32 bt_disable_cnt; -+ boolean bt_active = TRUE, bt_disabled = FALSE; -+ u16 u16tmp; -+ -+ /* Read BT on/off status from scoreboard[1], -+ * enable this only if BT patch support this feature -+ */ -+ halbtc8821c2ant_read_scbd(btc, &u16tmp); -+ -+ bt_active = u16tmp & BIT(1); -+ -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = FALSE; -+ btc->btc_set(btc, BTC_SET_BL_BT_DISABLE, &bt_disabled); -+ } else { -+ bt_disable_cnt++; -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = TRUE; -+ bt_disable_cnt = 2; -+ } -+ -+ btc->btc_set(btc, 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; -+ -+ /*for win10 BT disable->enable trigger wifi scan issue */ -+ if (!coex_sta->bt_disabled) { -+ coex_sta->is_bt_reenable = TRUE; -+ coex_sta->cnt_bt_reenable = 15; -+ } else { -+ coex_sta->is_bt_reenable = FALSE; -+ coex_sta->cnt_bt_reenable = 0; -+ } -+ } -+} -+ -+static -+boolean halbtc8821c2ant_moniter_wifibt_status(struct btc_coexist -+ *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct wifi_link_info_8821c_2ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_2ant; -+ static boolean pre_wifi_busy, pre_under_4way, -+ pre_bt_off, pre_bt_slave, pre_hid_low_pri_tx_overhead, -+ pre_wifi_under_lps, pre_bt_setup_link, -+ pre_cck_lock, pre_cck_lock_warn; -+ static u8 pre_hid_busy_num, pre_wl_noisy_level; -+ boolean wifi_busy = FALSE, under_4way = FALSE; -+ boolean wifi_connected = FALSE; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ static u8 cnt_wifi_busytoidle; -+ u32 num_of_wifi_link = 0, wifi_link_mode = 0; -+ static u32 pre_num_of_wifi_link, pre_wifi_link_mode; -+ boolean miracast_plus_bt = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &under_4way); -+ -+ if (wifi_busy) { -+ coex_sta->gl_wifi_busy = TRUE; -+ cnt_wifi_busytoidle = 6; -+ } else { -+ if (coex_sta->gl_wifi_busy && cnt_wifi_busytoidle > 0) -+ cnt_wifi_busytoidle--; -+ else if (cnt_wifi_busytoidle == 0) -+ coex_sta->gl_wifi_busy = FALSE; -+ } -+ -+ 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; -+ coex_sta->bt_a2dp_vendor_id = 0; -+ coex_sta->bt_a2dp_device_name = 0; -+ btc->bt_info.bt_get_fw_ver = 0; -+ return TRUE; -+ } -+ -+ num_of_wifi_link = wifi_link_info_ext->num_of_active_port; -+ -+ if (num_of_wifi_link != pre_num_of_wifi_link) { -+ pre_num_of_wifi_link = num_of_wifi_link; -+ -+ if (wifi_link_info_ext->is_p2p_connected) { -+ if (bt_link_info->bt_link_exist) -+ miracast_plus_bt = TRUE; -+ else -+ miracast_plus_bt = FALSE; -+ -+ btc->btc_set(btc, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ return TRUE; -+ } -+ -+ wifi_link_mode = btc->wifi_link_info.link_mode; -+ if (wifi_link_mode != pre_wifi_link_mode) { -+ pre_wifi_link_mode = wifi_link_mode; -+ 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 (coex_sta->wl_noisy_level != pre_wl_noisy_level) { -+ pre_wl_noisy_level = coex_sta->wl_noisy_level; -+ return TRUE; -+ } -+ if (coex_sta->under_lps != pre_wifi_under_lps) { -+ pre_wifi_under_lps = coex_sta->under_lps; -+ if (coex_sta->under_lps) -+ return TRUE; -+ } -+ if (coex_sta->cck_lock != pre_cck_lock) { -+ pre_cck_lock = coex_sta->cck_lock; -+ return TRUE; -+ } -+ if (coex_sta->cck_lock_warn != pre_cck_lock_warn) { -+ pre_cck_lock_warn = coex_sta->cck_lock_warn; -+ return TRUE; -+ } -+ } -+ -+ if (!coex_sta->bt_disabled) { -+#if 0 -+ if (coex_sta->acl_busy != pre_bt_acl_busy) { -+ pre_bt_acl_busy = coex_sta->acl_busy; -+ btc->btc_set(btc, BTC_SET_BL_BT_LNA_CONSTRAIN_LEVEL, -+ &lna_lvl); -+ return TRUE; -+ } -+#endif -+ 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; -+ } -+ -+ if (pre_hid_low_pri_tx_overhead != -+ coex_sta->is_hid_low_pri_tx_overhead) { -+ pre_hid_low_pri_tx_overhead = -+ coex_sta->is_hid_low_pri_tx_overhead; -+ return TRUE; -+ } -+ -+ if (pre_bt_setup_link != coex_sta->is_setup_link) { -+ pre_bt_setup_link = coex_sta->is_setup_link; -+ return TRUE; -+ } -+ } -+ -+ return FALSE; -+} -+ -+static -+void halbtc8821c2ant_update_wifi_link_info(struct btc_coexist *btc, u8 reason) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct wifi_link_info_8821c_2ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_2ant; -+ struct btc_wifi_link_info wifi_link_info; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ u8 wifi_central_chnl = 0, num_of_wifi_link = 0; -+ boolean isunder5G = FALSE, ismcc25g = FALSE, isp2pconnected = FALSE; -+ u32 wifi_link_status = 0; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_link_info_ext->is_connected); -+ -+ btc->btc_get(btc, BTC_GET_U4_WIFI_LINK_STATUS, &wifi_link_status); -+ wifi_link_info_ext->port_connect_status = wifi_link_status & 0xffff; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_LINK_INFO, &wifi_link_info); -+ btc->wifi_link_info = wifi_link_info; -+ -+ btc->btc_get(btc, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifi_central_chnl); -+ coex_sta->wl_center_channel = wifi_central_chnl; -+ -+ /* Check scan/connect/special-pkt action first */ -+ switch (reason) { -+ case BT_8821C_2ANT_RSN_5GSCANSTART: -+ case BT_8821C_2ANT_RSN_5GSWITCHBAND: -+ case BT_8821C_2ANT_RSN_5GCONSTART: -+ isunder5G = TRUE; -+ break; -+ case BT_8821C_2ANT_RSN_2GSCANSTART: -+ case BT_8821C_2ANT_RSN_2GSWITCHBAND: -+ case BT_8821C_2ANT_RSN_2GCONSTART: -+ isunder5G = FALSE; -+ break; -+ case BT_8821C_2ANT_RSN_2GCONFINISH: -+ case BT_8821C_2ANT_RSN_5GCONFINISH: -+ case BT_8821C_2ANT_RSN_2GMEDIA: -+ case BT_8821C_2ANT_RSN_5GMEDIA: -+ case BT_8821C_2ANT_RSN_BTINFO: -+ case BT_8821C_2ANT_RSN_PERIODICAL: -+ case BT_8821C_2ANT_RSN_2GSPECIALPKT: -+ case BT_8821C_2ANT_RSN_5GSPECIALPKT: -+ default: -+ switch (wifi_link_info.link_mode) { -+ case BTC_LINK_5G_MCC_GO_STA: -+ case BTC_LINK_5G_MCC_GC_STA: -+ case BTC_LINK_5G_SCC_GO_STA: -+ case BTC_LINK_5G_SCC_GC_STA: -+ isunder5G = TRUE; -+ break; -+ case BTC_LINK_2G_MCC_GO_STA: -+ case BTC_LINK_2G_MCC_GC_STA: -+ case BTC_LINK_2G_SCC_GO_STA: -+ case BTC_LINK_2G_SCC_GC_STA: -+ isunder5G = FALSE; -+ break; -+ case BTC_LINK_25G_MCC_GO_STA: -+ case BTC_LINK_25G_MCC_GC_STA: -+ isunder5G = FALSE; -+ ismcc25g = TRUE; -+ break; -+ case BTC_LINK_ONLY_STA: -+ if (wifi_link_info.sta_center_channel > 14) -+ isunder5G = TRUE; -+ else -+ isunder5G = FALSE; -+ break; -+ case BTC_LINK_ONLY_GO: -+ case BTC_LINK_ONLY_GC: -+ case BTC_LINK_ONLY_AP: -+ default: -+ if (wifi_link_info.p2p_center_channel > 14) -+ isunder5G = TRUE; -+ else -+ isunder5G = FALSE; -+ -+ break; -+ } -+ break; -+ } -+ -+ wifi_link_info_ext->is_all_under_5g = isunder5G; -+ wifi_link_info_ext->is_mcc_25g = ismcc25g; -+ -+ if (wifi_link_status & WIFI_STA_CONNECTED) -+ num_of_wifi_link++; -+ -+ if (wifi_link_status & WIFI_AP_CONNECTED) -+ num_of_wifi_link++; -+ -+ if (wifi_link_status & WIFI_P2P_GO_CONNECTED) { -+ num_of_wifi_link++; -+ isp2pconnected = TRUE; -+ } -+ -+ if (wifi_link_status & WIFI_P2P_GC_CONNECTED) { -+ num_of_wifi_link++; -+ isp2pconnected = TRUE; -+ } -+ -+ wifi_link_info_ext->num_of_active_port = num_of_wifi_link; -+ wifi_link_info_ext->is_p2p_connected = isp2pconnected; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_link_info: link_mode=%d, STA_Ch=%d, P2P_Ch=%d, AnyClient_Join_Go=%d !\n", -+ btc->wifi_link_info.link_mode, -+ btc->wifi_link_info.sta_center_channel, -+ btc->wifi_link_info.p2p_center_channel, -+ btc->wifi_link_info.bany_client_join_go); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_link_info: center_ch=%d, is_all_under_5g=%d, is_mcc_25g=%d!\n", -+ coex_sta->wl_center_channel, -+ wifi_link_info_ext->is_all_under_5g, -+ wifi_link_info_ext->is_mcc_25g); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_link_info: port_connect_status=0x%x, active_port_cnt=%d, P2P_Connect=%d!\n", -+ wifi_link_info_ext->port_connect_status, -+ wifi_link_info_ext->num_of_active_port, -+ wifi_link_info_ext->is_p2p_connected); -+ BTC_TRACE(trace_buf); -+ -+ switch (reason) { -+ case BT_8821C_2ANT_RSN_2GSCANSTART: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "2GSCANSTART"); -+ break; -+ case BT_8821C_2ANT_RSN_5GSCANSTART: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "5GSCANSTART"); -+ break; -+ case BT_8821C_2ANT_RSN_SCANFINISH: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "SCANFINISH"); -+ break; -+ case BT_8821C_2ANT_RSN_2GSWITCHBAND: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "2GSWITCHBAND"); -+ break; -+ case BT_8821C_2ANT_RSN_5GSWITCHBAND: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "5GSWITCHBAND"); -+ break; -+ case BT_8821C_2ANT_RSN_2GCONSTART: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "2GCONNECTSTART"); -+ break; -+ case BT_8821C_2ANT_RSN_5GCONSTART: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "5GCONNECTSTART"); -+ break; -+ case BT_8821C_2ANT_RSN_2GCONFINISH: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", -+ "2GCONNECTFINISH"); -+ break; -+ case BT_8821C_2ANT_RSN_5GCONFINISH: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", -+ "5GCONNECTFINISH"); -+ break; -+ case BT_8821C_2ANT_RSN_2GMEDIA: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "2GMEDIASTATUS"); -+ break; -+ case BT_8821C_2ANT_RSN_5GMEDIA: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "5GMEDIASTATUS"); -+ break; -+ case BT_8821C_2ANT_RSN_MEDIADISCON: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", -+ "MEDIADISCONNECT"); -+ break; -+ case BT_8821C_2ANT_RSN_2GSPECIALPKT: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "2GSPECIALPKT"); -+ break; -+ case BT_8821C_2ANT_RSN_5GSPECIALPKT: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "5GSPECIALPKT"); -+ break; -+ case BT_8821C_2ANT_RSN_BTINFO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "BTINFO"); -+ break; -+ case BT_8821C_2ANT_RSN_PERIODICAL: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "PERIODICAL"); -+ break; -+ case BT_8821C_2ANT_RSN_PNP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "PNPNotify"); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Update reason = %s\n", "UNKNOWN"); -+ break; -+ } -+ -+ BTC_TRACE(trace_buf); -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (wifi_link_info_ext->is_all_under_5g || num_of_wifi_link == 0 || -+ coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_NCON_IDLE) { -+ halbtc8821c2ant_low_penalty_ra(btc, NM_EXCU, FALSE, 0); -+ halbtc8821c2ant_limited_tx(btc, NM_EXCU, FALSE, FALSE); -+ halbtc8821c2ant_limited_rx(btc, NM_EXCU, FALSE, TRUE, 64); -+ } else if (wifi_link_info_ext->num_of_active_port > 1) { -+ halbtc8821c2ant_low_penalty_ra(btc, NM_EXCU, TRUE, 30); -+ halbtc8821c2ant_limited_tx(btc, NM_EXCU, FALSE, TRUE); -+ halbtc8821c2ant_limited_rx(btc, NM_EXCU, FALSE, TRUE, 16); -+ } else { -+ halbtc8821c2ant_low_penalty_ra(btc, NM_EXCU, TRUE, 15); -+ -+ if (coex_sta->hid_exist || coex_sta->hid_pair_cnt > 0 || -+ coex_sta->sco_exist) { -+ halbtc8821c2ant_limited_tx(btc, NM_EXCU, TRUE, TRUE); -+ halbtc8821c2ant_limited_rx(btc, NM_EXCU, FALSE, TRUE, -+ 16); -+ } else { -+ halbtc8821c2ant_limited_tx(btc, NM_EXCU, TRUE, FALSE); -+ halbtc8821c2ant_limited_rx(btc, NM_EXCU, FALSE, TRUE, -+ 64); -+ } -+ } -+ -+ /* coex-276 P2P-Go beacon request can't release issue -+ * Only PCIe/USB can set 0x454[6] = 1 to solve this issue, -+ * WL SDIO/USB interface need driver support. -+ */ -+#ifdef PLATFORM_WINDOWS -+ if (btc->chip_interface != BTC_INTF_SDIO) -+ btc->btc_write_1byte_bitmask(btc, 0x454, BIT(6), 0x1); -+ else -+ btc->btc_write_1byte_bitmask(btc, 0x454, BIT(6), 0x0); -+#endif -+} -+ -+static -+void halbtc8821c2ant_update_bt_link_info(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ boolean bt_busy = FALSE, increase_scan_dev_num = FALSE; -+ u32 val = 0; -+ static u8 pre_num_of_profile, cur_num_of_profile, cnt, ble_cnt; -+ -+ if (++ble_cnt >= 3) -+ ble_cnt = 0; -+ -+ if (coex_sta->is_ble_scan_en && ble_cnt == 0) { -+ 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 = -+ btc->btc_get_ble_scan_type_from_bt(btc); -+ -+ if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) -+ coex_sta->bt_ble_scan_para[0] = -+ btc->btc_get_ble_scan_para_from_bt(btc, 0x1); -+ if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) -+ coex_sta->bt_ble_scan_para[1] = -+ btc->btc_get_ble_scan_para_from_bt(btc, 0x2); -+ if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) -+ coex_sta->bt_ble_scan_para[2] = -+ btc->btc_get_ble_scan_para_from_bt(btc, 0x4); -+ } -+ -+ coex_sta->num_of_profile = 0; -+ -+ /* set link exist status */ -+ if (!(coex_sta->bt_info_lb2 & 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; -+ coex_sta->msft_mr_exist = FALSE; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = TRUE; -+ if (coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_FTP) { -+ coex_sta->pan_exist = TRUE; -+ coex_sta->num_of_profile++; -+ } else { -+ coex_sta->pan_exist = FALSE; -+ } -+ -+ if (coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_A2DP) { -+ coex_sta->a2dp_exist = TRUE; -+ coex_sta->num_of_profile++; -+ } else { -+ coex_sta->a2dp_exist = FALSE; -+ } -+ -+ if (coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_HID) { -+ coex_sta->hid_exist = TRUE; -+ coex_sta->num_of_profile++; -+ } else { -+ coex_sta->hid_exist = FALSE; -+ } -+ -+ if (coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_SCO_ESCO) { -+ coex_sta->sco_exist = TRUE; -+ coex_sta->num_of_profile++; -+ } else { -+ coex_sta->sco_exist = FALSE; -+ } -+#if 0 -+ if (coex_sta->hid_busy_num == 0 && -+ coex_sta->hid_pair_cnt > 0 && -+ coex_sta->low_priority_tx > 1000 && -+ coex_sta->low_priority_rx > 1000 && -+ !coex_sta->c2h_bt_inquiry_page) -+ coex_sta->msft_mr_exist = true; -+ else -+ coex_sta->msft_mr_exist = false; -+#endif -+ } -+ -+ 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; -+ -+ /* 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_lb2 & BT_INFO_8821C_2ANT_B_INQ_PAGE) { -+ coex_dm->bt_status = BT_8821C_2ANT_BSTATUS_INQ_PAGE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); -+ } else if (!(coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8821C_2ANT_BSTATUS_NCON_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ } else if (coex_sta->bt_info_lb2 == BT_INFO_8821C_2ANT_B_CONNECTION) { -+ /* connection exists but no busy */ -+ if (coex_sta->msft_mr_exist) { -+ coex_dm->bt_status = BT_8821C_2ANT_BSTATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!\n"); -+ } else { -+ coex_dm->bt_status = BT_8821C_2ANT_BSTATUS_CON_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ } -+ } else if (((coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_SCO_ESCO) || -+ (coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_SCO_BUSY)) && -+ (coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_ACL_BUSY)) { -+ coex_dm->bt_status = BT_8821C_2ANT_BSTATUS_ACL_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); -+ } else if ((coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_SCO_ESCO) || -+ (coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8821C_2ANT_BSTATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ } else if (coex_sta->bt_info_lb2 & BT_INFO_8821C_2ANT_B_ACL_BUSY) { -+ coex_dm->bt_status = BT_8821C_2ANT_BSTATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ } else { -+ coex_dm->bt_status = BT_8821C_2ANT_BSTATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ } -+ -+ BTC_TRACE(trace_buf); -+ -+ if (coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_ACL_BUSY || -+ coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_SCO_BUSY || -+ coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_ACL_SCO_BUSY) { -+ bt_busy = TRUE; -+ increase_scan_dev_num = TRUE; -+ } else { -+ bt_busy = FALSE; -+ increase_scan_dev_num = FALSE; -+ } -+ -+ btc->btc_set(btc, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ btc->btc_set(btc, BTC_SET_BL_INC_SCAN_DEV_NUM, &increase_scan_dev_num); -+ -+ cur_num_of_profile = coex_sta->num_of_profile; -+ -+ if (cur_num_of_profile != pre_num_of_profile) -+ cnt = 2; -+ -+ if (btc->board_info.customer_id == RT_CID_LENOVO_CHINA) { -+ if (cur_num_of_profile > 0) -+ halbtc8821c2ant_set_antdiv_hwsw(btc, NM_EXCU, TRUE); -+ else -+ halbtc8821c2ant_set_antdiv_hwsw(btc, NM_EXCU, FALSE); -+ } -+ -+ if (bt_link_info->a2dp_exist && cnt > 0) { -+ cnt--; -+ if (coex_sta->bt_a2dp_vendor_id == 0 && -+ coex_sta->bt_a2dp_device_name == 0) { -+ btc->btc_get(btc, BTC_GET_U4_BT_DEVICE_INFO, &val); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), get BT DEVICE_INFO = %x\n", -+ val); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_a2dp_vendor_id = (u8)(val & 0xff); -+ coex_sta->bt_a2dp_device_name = (val & 0xffffff00) >> 8; -+ -+ btc->btc_get(btc, BTC_GET_U4_BT_A2DP_FLUSH_VAL, &val); -+ coex_sta->bt_a2dp_flush_time = val; -+ } -+ } else if (!bt_link_info->a2dp_exist) { -+ coex_sta->bt_a2dp_vendor_id = 0; -+ coex_sta->bt_a2dp_device_name = 0; -+ coex_sta->bt_a2dp_flush_time = 0; -+ } -+ -+ pre_num_of_profile = coex_sta->num_of_profile; -+} -+ -+static -+void halbtc8821c2ant_update_wifi_ch_info(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ struct wifi_link_info_8821c_2ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_2ant; -+ u8 h2c_parameter[3] = {0}, i; -+ u32 wifi_bw; -+ u8 wl_ch = 0; -+ u8 wl_5g_ch[] = {0}; -+ u8 bt_skip_ch[] = {0}; -+ u8 bt_skip_span[] = {0}; -+ -+ if (btc->manual_control) -+ return; -+ -+ btc->btc_get(btc, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (btc->stop_coex_dm || btc->wl_rf_state_off) { -+ wl_ch = 0; -+ } else if (type != BTC_MEDIA_DISCONNECT || -+ (type == BTC_MEDIA_DISCONNECT && -+ wifi_link_info_ext->num_of_active_port > 0)) { -+ if (wifi_link_info_ext->num_of_active_port == 1) { -+ if (wifi_link_info_ext->is_p2p_connected) -+ wl_ch = btc->wifi_link_info.p2p_center_channel; -+ else -+ wl_ch = btc->wifi_link_info.sta_center_channel; -+ } else { /* port > 2 */ -+ if (btc->wifi_link_info.p2p_center_channel > 14 && -+ btc->wifi_link_info.sta_center_channel > 14) -+ wl_ch = btc->wifi_link_info.p2p_center_channel; -+ else if (btc->wifi_link_info.p2p_center_channel <= 14) -+ wl_ch = btc->wifi_link_info.p2p_center_channel; -+ else if (btc->wifi_link_info.sta_center_channel <= 14) -+ wl_ch = btc->wifi_link_info.sta_center_channel; -+ } -+ } -+ -+ if (wl_ch > 0) { -+ if (wl_ch <= 14) { -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = wl_ch; -+ -+ if (wifi_bw == BTC_WIFI_BW_HT40) -+ h2c_parameter[2] = 0x36; -+ else -+ h2c_parameter[2] = 0x24; -+ } else { /* for 5G */ -+#if 0 -+ for (i = 0; i < ARRAY_SIZE(wl_5g_ch); i++) { -+ if (wl_ch == wl_5g_ch[i]) { -+ h2c_parameter[0] = 0x3; -+ h2c_parameter[1] = bt_skip_ch[i]; -+ h2c_parameter[2] = bt_skip_span[i]; -+ break; -+ } -+ } -+#endif -+ } -+ } -+ -+ /* Only send mailbox if ch info change */ -+ if (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]) { -+ -+ 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]; -+ btc->btc_fill_h2c(btc, 0x66, 3, h2c_parameter); -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], para[0:2] = 0x%x 0x%x 0x%x\n", h2c_parameter[0], -+ h2c_parameter[1], h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+} -+ -+static -+void halbtc8821c2ant_set_wl_tx_power(struct btc_coexist *btc, -+ boolean force_exec, u8 wl_pwr_lvl) -+{ -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ -+ if (!force_exec) { -+ if (wl_pwr_lvl == coex_dm->cur_wl_pwr_lvl) -+ return; -+ } -+ -+ /* btc->btc_write_1byte_bitmask(btc, 0xc5b, 0xff, wl_pwr_lvl); */ -+ coex_dm->cur_wl_pwr_lvl = wl_pwr_lvl; -+} -+ -+static -+void halbtc8821c2ant_set_bt_tx_power(struct btc_coexist *btc, -+ boolean force_exec, u8 bt_pwr_lvl) -+{ -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ u8 h2c_parameter[1] = {0}; -+ -+ if (!force_exec) { -+ if (bt_pwr_lvl == coex_dm->cur_bt_pwr_lvl) -+ return; -+ } -+ -+ h2c_parameter[0] = 0 - bt_pwr_lvl; -+ btc->btc_fill_h2c(btc, 0x62, 1, h2c_parameter); -+ -+ coex_dm->cur_bt_pwr_lvl = bt_pwr_lvl; -+} -+ -+static u32 -+halbtc8821c2ant_wait_indirect_reg_ready(struct btc_coexist *btc) -+{ -+ u32 delay_count = 0; -+ -+ /* wait for ready bit before access 0x1700 */ -+ while (1) { -+ if ((btc->btc_read_1byte(btc, 0x1703) & BIT(5)) == 0) { -+ delay_ms(10); -+ if (++delay_count >= 10) -+ break; -+ } else { -+ break; -+ } -+ } -+ -+ return delay_count; -+} -+ -+static -+u32 halbtc8821c2ant_read_indirect_reg(struct btc_coexist *btc, u16 reg_addr) -+{ -+ u32 j = 0, delay_count = 0; -+ -+ halbtc8821c2ant_wait_indirect_reg_ready(btc); -+ -+ /* wait for ready bit before access 0x1700 */ -+ btc->btc_write_4byte(btc, 0x1700, 0x800F0000 | reg_addr); -+ -+ return btc->btc_read_4byte(btc, 0x1708); /* get read data */ -+} -+ -+static -+void halbtc8821c2ant_write_indirect_reg(struct btc_coexist *btc, u16 reg_addr, -+ u32 bit_mask, u32 reg_value) -+{ -+ u32 val, i = 0, j = 0, bitpos = 0, delay_count = 0; -+ -+ if (bit_mask == 0x0) -+ return; -+ if (bit_mask == 0xffffffff) { -+ /* wait for ready bit before access 0x1700/0x1704 */ -+ halbtc8821c2ant_wait_indirect_reg_ready(btc); -+ -+ /* put write data */ -+ btc->btc_write_4byte(btc, 0x1704, reg_value); -+ btc->btc_write_4byte(btc, 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_read_indirect_reg(btc, reg_addr); -+ val = (val & (~bit_mask)) | (reg_value << bitpos); -+ -+ /* wait for ready bit before access 0x1700/0x1704 */ -+ halbtc8821c2ant_wait_indirect_reg_ready(btc); -+ -+ /* put write data */ -+ btc->btc_write_4byte(btc, 0x1704, val); -+ btc->btc_write_4byte(btc, 0x1700, 0xc00F0000 | reg_addr); -+ } -+} -+ -+static -+void halbtc8821c2ant_ltecoex_enable(struct btc_coexist *btc, boolean enable) -+{ -+ u8 val; -+ -+ /* 0x38[7] */ -+ val = (enable) ? 1 : 0; -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, BIT(7), val); -+} -+ -+static -+void halbtc8821c2ant_ltecoex_table(struct btc_coexist *btc, u8 table_type, -+ u16 val) -+{ -+ 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; -+ } -+ -+ /* 0xa0[15:0] or 0xa4[15:0] */ -+ if (reg_addr != 0x0000) -+ halbtc8821c2ant_write_indirect_reg(btc, reg_addr, 0xffff, val); -+} -+ -+static -+void halbtc8821c2ant_coex_ctrl_owner(struct btc_coexist *btc, -+ boolean wifi_control) -+{ -+ u8 val; -+ -+ /* 0x70[26] */ -+ val = (wifi_control) ? 1 : 0; -+ btc->btc_write_1byte_bitmask(btc, 0x73, BIT(2), val); -+} -+ -+static void -+halbtc8821c2ant_set_gnt_bt(struct btc_coexist *btc, u8 state) -+{ -+ switch (state) { -+ case BTC_GNT_SET_SW_LOW: -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0xc000, 0x1); -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0x0c00, 0x1); -+ break; -+ case BTC_GNT_SET_SW_HIGH: -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0xc000, 0x3); -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0x0c00, 0x3); -+ break; -+ case BTC_GNT_SET_HW_PTA: -+ default: -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0xc000, 0x0); -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0x0c00, 0x0); -+ break; -+ } -+} -+ -+static void -+halbtc8821c2ant_set_gnt_wl(struct btc_coexist *btc, u8 state) -+{ -+ switch (state) { -+ case BTC_GNT_SET_SW_LOW: -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0x3000, 0x1); -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0x0300, 0x1); -+ break; -+ case BTC_GNT_SET_SW_HIGH: -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0x3000, 0x3); -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0x0300, 0x3); -+ break; -+ case BTC_GNT_SET_HW_PTA: -+ default: -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0x3000, 0x0); -+ halbtc8821c2ant_write_indirect_reg(btc, 0x38, 0x0300, 0x0); -+ break; -+ } -+} -+ -+static -+void halbtc8821c2ant_set_table(struct btc_coexist *btc, -+ boolean force_exec, u32 val0x6c0, -+ u32 val0x6c4, u32 val0x6c8, -+ u8 val0x6cc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ -+ if (!force_exec && !coex_sta->wl_slot_toggle_change) { -+ coex_dm->cur_val0x6c0 = btc->btc_read_4byte(btc, 0x6c0); -+ coex_dm->cur_val0x6c4 = btc->btc_read_4byte(btc, 0x6c4); -+ -+ if (val0x6c0 == coex_dm->cur_val0x6c0 && -+ val0x6c4 == coex_dm->cur_val0x6c4) -+ return; -+ } -+ -+ btc->btc_write_4byte(btc, 0x6c0, val0x6c0); -+ btc->btc_write_4byte(btc, 0x6c4, val0x6c4); -+ btc->btc_write_4byte(btc, 0x6c8, val0x6c8); -+ btc->btc_write_1byte(btc, 0x6cc, val0x6cc); -+ -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+} -+ -+void halbtc8821c2ant_table(struct btc_coexist *btc, boolean force_exec, u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ u32 break_table; -+ u8 select_table; -+ -+ coex_sta->coex_table_type = type; -+ -+ if (coex_sta->concurrent_rx_mode_on == TRUE) { -+ /* set WL hi-pri can break BT */ -+ break_table = 0xf0ffffff; -+ /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ -+ select_table = 0x1b; -+ } else { -+ break_table = 0xffffff; -+ select_table = 0x13; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** Table-%d **********\n", -+ coex_sta->coex_table_type); -+ BTC_TRACE(trace_buf); -+ -+ switch (type) { -+ case 0: -+ halbtc8821c2ant_set_table(btc, force_exec, 0xffffffff, -+ 0xffffffff, break_table, -+ select_table); -+ break; -+ case 1: -+ halbtc8821c2ant_set_table(btc, force_exec, 0x55555555, -+ 0xfafafafa, break_table, -+ select_table); -+ break; -+ case 2: -+ halbtc8821c2ant_set_table(btc, force_exec, 0x5a5a5a5a, -+ 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 3: -+ halbtc8821c2ant_set_table(btc, force_exec, 0x66555555, -+ 0x6a5a5a5a, break_table, -+ select_table); -+ break; -+ case 4: -+ halbtc8821c2ant_set_table(btc, force_exec, 0xffff55ff, -+ 0xfafafafa, break_table, -+ select_table); -+ break; -+ case 5: -+ halbtc8821c2ant_set_table(btc, force_exec, 0x55555555, -+ 0x55555555, break_table, -+ select_table); -+ break; -+ case 6: /* not use */ -+ halbtc8821c2ant_set_table(btc, force_exec, 0xaaffffaa, -+ 0x5afa5afa, break_table, -+ select_table); -+ break; -+ case 7: -+ halbtc8821c2ant_set_table(btc, force_exec, 0xaaffffaa, -+ 0xfafafafa, break_table, -+ select_table); -+ break; -+ case 8: -+ halbtc8821c2ant_set_table(btc, force_exec, 0xffff55ff, -+ 0xfafafafa, break_table, -+ select_table); -+ break; -+ case 9: -+ halbtc8821c2ant_set_table(btc, force_exec, 0x5a5a5a5a, -+ 0xaaaa5aaa, break_table, -+ select_table); -+ break; -+ case 10: -+ halbtc8821c2ant_set_table(btc, force_exec, 0xaaaaaaaa, -+ 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 11: -+ halbtc8821c2ant_set_table(btc, force_exec, 0xffffffff, -+ 0xfafafafa, break_table, -+ select_table); -+ break; -+ case 12: -+ halbtc8821c2ant_set_table(btc, force_exec, 0xffff55ff, -+ 0x5afa5afa, break_table, -+ select_table); -+ break; -+ case 14: -+ halbtc8821c2ant_set_table(btc, force_exec, 0xffff55ff, -+ 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 15: -+ halbtc8821c2ant_set_table(btc, force_exec, 0x66555555, -+ 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 18: -+ halbtc8821c2ant_set_table(btc, force_exec, 0xffff55ff, -+ 0xffff55ff, break_table, -+ select_table); -+ break; -+ default: -+ break; -+ } -+} -+ -+#if 0 -+static void -+halbtc8821c2ant_wltoggle_table(IN struct btc_coexist *btc, -+ 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 0 -+ 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; -+ } -+#endif -+ for (i = 1; i <= 5; i++) -+ pre_h2c_parameter[i] = cur_h2c_parameter[i]; -+ -+ btc->btc_fill_h2c(btc, 0x69, 6, cur_h2c_parameter); -+} -+#endif -+ -+static -+void halbtc8821c2ant_ignore_wlan_act(struct btc_coexist *btc, -+ boolean force_exec, boolean enable) -+{ -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ u8 h2c_parameter[1] = {0}; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (!force_exec) { -+ if (enable == coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ -+ if (enable) -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ -+ btc->btc_fill_h2c(btc, 0x63, 1, h2c_parameter); -+ -+ coex_dm->cur_ignore_wlan_act = enable; -+} -+ -+static -+void halbtc8821c2ant_lps_rpwm(struct btc_coexist *btc, boolean force_exec, -+ u8 lps_val, u8 rpwm_val) -+{ -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ -+ if (!force_exec) { -+ if (lps_val == coex_dm->cur_lps && -+ rpwm_val == coex_dm->cur_rpwm) -+ return; -+ } -+ -+ btc->btc_set(btc, BTC_SET_U1_LPS_VAL, &lps_val); -+ btc->btc_set(btc, BTC_SET_U1_RPWM_VAL, &rpwm_val); -+ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+} -+ -+static -+void halbtc8821c2ant_tdma_check(struct btc_coexist *btc, boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ u8 h2c_parameter[5] = {0, 0, 0, 0x40, 0}; -+ -+ btc->btc_get(btc, 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 */ -+ btc->btc_fill_h2c(btc, 0x60, 5, h2c_parameter); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ btc->btc_fill_h2c(btc, 0x60, 5, h2c_parameter); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+static -+boolean halbtc8821c2ant_power_save_state(struct btc_coexist *btc, u8 ps_type, -+ u8 lps_val, u8 rpwm_val) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ boolean low_pwr_disable = FALSE, result = TRUE; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ coex_sta->force_lps_ctrl = FALSE; -+ /* recover to original 32k low power setting */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == BTC_PS_WIFI_NATIVE\n", __func__); -+ BTC_TRACE(trace_buf); -+ -+ low_pwr_disable = FALSE; -+ /* btc->btc_set(btc, BTC_SET_ACT_DISABLE_LOW_POWER, -+ * &low_pwr_disable); -+ */ -+ btc->btc_set(btc, BTC_SET_ACT_PRE_NORMAL_LPS, NULL); -+ break; -+ case BTC_PS_LPS_ON: -+ coex_sta->force_lps_ctrl = TRUE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == BTC_PS_LPS_ON\n", __func__); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_tdma_check(btc, TRUE); -+ halbtc8821c2ant_lps_rpwm(btc, NM_EXCU, lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = TRUE; -+ btc->btc_set(btc, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma.*/ -+ btc->btc_set(btc, BTC_SET_ACT_ENTER_LPS, NULL); -+ break; -+ case BTC_PS_LPS_OFF: -+ coex_sta->force_lps_ctrl = TRUE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == BTC_PS_LPS_OFF\n", __func__); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_tdma_check(btc, FALSE); -+ result = btc->btc_set(btc, BTC_SET_ACT_LEAVE_LPS, NULL); -+ break; -+ default: -+ break; -+ } -+ -+ return result; -+} -+ -+static -+void halbtc8821c2ant_set_tdma(struct btc_coexist *btc, u8 byte1, u8 byte2, -+ u8 byte3, u8 byte4, u8 byte5) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = FALSE, result = FALSE; -+ u8 ps_type = BTC_PS_WIFI_NATIVE; -+ -+ if (byte5 & BIT(2)) -+ coex_sta->is_tdma_btautoslot = TRUE; -+ else -+ coex_sta->is_tdma_btautoslot = FALSE; -+ -+ if (btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GO && -+ btc->wifi_link_info.bhotspot && -+ btc->wifi_link_info.bany_client_join_go) -+ ap_enable = TRUE; -+ -+ if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == FW for AP mode\n", __func__); -+ BTC_TRACE(trace_buf); -+ -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ -+ ps_type = BTC_PS_WIFI_NATIVE; -+ halbtc8821c2ant_power_save_state(btc, ps_type, 0x0, 0x0); -+ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == Force LPS (byte1 = 0x%x)\n", -+ __func__, byte1); -+ BTC_TRACE(trace_buf); -+ -+ ps_type = BTC_PS_LPS_OFF; -+ if (!halbtc8821c2ant_power_save_state(btc, ps_type, 0x50, 0x4)) -+ result = TRUE; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == Native LPS (byte1 = 0x%x)\n", -+ __func__, byte1); -+ BTC_TRACE(trace_buf); -+ -+ ps_type = BTC_PS_WIFI_NATIVE; -+ halbtc8821c2ant_power_save_state(btc, ps_type, 0x0, 0x0); -+ } -+ -+ coex_sta->is_set_ps_state_fail = result; -+ -+ if (!coex_sta->is_set_ps_state_fail) { -+ 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; -+ -+ btc->btc_fill_h2c(btc, 0x60, 5, h2c_parameter); -+ -+ if (real_byte1 & BIT(2)) { -+ coex_sta->wl_slot_toggle = TRUE; -+ coex_sta->wl_slot_toggle_change = FALSE; -+ } else { -+ if (coex_sta->wl_slot_toggle) -+ coex_sta->wl_slot_toggle_change = TRUE; -+ else -+ coex_sta->wl_slot_toggle_change = FALSE; -+ coex_sta->wl_slot_toggle = FALSE; -+ } -+ } else { -+ coex_sta->cnt_set_ps_state_fail++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s == Force Leave LPS Fail (cnt = %d)\n", -+ __func__, coex_sta->cnt_set_ps_state_fail); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (ps_type == BTC_PS_WIFI_NATIVE) -+ btc->btc_set(btc, BTC_SET_ACT_POST_NORMAL_LPS, NULL); -+} -+ -+static -+void halbtc8821c2ant_tdma(struct btc_coexist *btc, -+ boolean force_exec, boolean turn_on, u32 tcase) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ u8 type; -+ boolean wifi_busy; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ btc->btc_set_atomic(btc, &coex_dm->setting_tdma, TRUE); -+ -+ /* tcase: bit0~7 --> tdma case index -+ * bit8 --> for 4-slot (50ms) mode -+ */ -+ if (tcase & TDMA_4SLOT)/* 4-slot (50ms) mode */ -+ halbtc8821c2ant_set_tdma_timer_base(btc, 3); -+ else -+ halbtc8821c2ant_set_tdma_timer_base(btc, 0); -+ -+ type = (u8)(tcase & 0xff); -+ -+ /* To avoid TDMA H2C fail before Last LPS enter */ -+ if (!force_exec && coex_sta->coex_run_reason != BTC_RSN_LPS) { -+ if (turn_on == coex_dm->cur_ps_tdma_on && -+ type == coex_dm->cur_ps_tdma) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Skip TDMA because no change TDMA(%s, %d)\n", -+ (coex_dm->cur_ps_tdma_on ? "on" : "off"), -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ -+ btc->btc_set_atomic(btc, &coex_dm->setting_tdma, FALSE); -+ return; -+ } -+ } -+ -+ if (!wifi_busy || -+ (coex_sta->a2dp_exist && coex_sta->bt_inq_page_remain)) -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_TDMA, -+ FALSE); -+ else -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_TDMA, -+ TRUE); -+ -+ if (turn_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ type); -+ BTC_TRACE(trace_buf); -+ -+ /* enable TBTT nterrupt */ -+ btc->btc_write_1byte_bitmask(btc, 0x550, 0x8, 0x1); -+ -+ switch (type) { -+ case 1: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x10, 0x03, 0x91, -+ 0x50); -+ break; -+ case 2: -+ default: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x35, 0x03, 0x11, -+ 0x11); -+ break; -+ case 3: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x30, 0x3, 0x91, -+ 0x10); -+ break; -+ case 4: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x21, 0x3, 0x91, -+ 0x10); -+ break; -+ case 5: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x25, 0x3, 0x91, -+ 0x10); -+ break; -+ case 6: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x10, 0x3, 0x91, -+ 0x10); -+ break; -+ case 7: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x20, 0x3, 0x91, -+ 0x10); -+ break; -+ case 8: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x15, 0x03, 0x11, -+ 0x11); -+ break; -+ case 10: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x30, 0x03, 0x11, -+ 0x10); -+ break; -+ case 11: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x35, 0x03, 0x11, -+ 0x10); -+ break; -+ case 12: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x35, 0x03, 0x11, -+ 0x11); -+ break; -+ case 13: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x20, 0x03, 0x11, -+ 0x10); -+ break; -+ case 14: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x20, 0x03, 0x11, -+ 0x11); -+ break; -+ case 15: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x10, 0x03, 0x11, -+ 0x10); -+ break; -+ case 16: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x10, 0x03, 0x11, -+ 0x11); -+ break; -+ case 17: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x08, 0x03, 0x11, -+ 0x14); -+ break; -+ case 21: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x30, 0x03, 0x11, -+ 0x10); -+ break; -+ case 22: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x25, 0x03, 0x11, -+ 0x10); -+ break; -+ case 23: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x10, 0x03, 0x11, -+ 0x10); -+ break; -+ case 25: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x3a, 0x3, 0x11, -+ 0x50); -+ break; -+ case 51: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x10, 0x03, 0x91, -+ 0x10); -+ break; -+ case 101: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x08, 0x03, 0x10, -+ 0x54); -+ break; -+ case 102: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x35, 0x03, 0x11, -+ 0x11); -+ break; -+ case 103: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x30, 0x3, 0x10, -+ 0x50); -+ break; -+ case 104: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x21, 0x3, 0x10, -+ 0x50); -+ break; -+ case 105: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x45, 0x3, 0x10, -+ 0x50); -+ break; -+ case 106: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x1a, 0x3, 0x10, -+ 0x50); -+ break; -+ case 107: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x08, 0x7, 0x10, -+ 0x54); -+ break; -+ case 108: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x30, 0x3, 0x10, -+ 0x50); -+ break; -+ case 109: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x08, 0x03, 0x10, -+ 0x54); -+ break; -+ case 110: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x30, 0x03, 0x10, -+ 0x50); -+ break; -+ case 111: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x25, 0x03, 0x11, -+ 0x11); -+ break; -+ case 112: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x4a, 0x3, 0x10, -+ 0x50); -+ break; -+ case 113: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x45, 0x03, 0x11, -+ 0x10); -+ break; -+ case 115: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x30, 0x03, 0x10, -+ 0x50); -+ break; -+ case 116: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x08, 0x03, 0x10, -+ 0x50); -+ break; -+ case 117: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x08, 0x03, 0x11, -+ 0x11); -+ break; -+ case 119: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x08, 0x03, 0x10, -+ 0x14); -+ break; -+ case 120: -+ halbtc8821c2ant_set_tdma(btc, 0x61, 0x08, 0x03, 0x10, -+ 0x15); -+ break; -+ case 151: -+ halbtc8821c2ant_set_tdma(btc, 0x51, 0x10, 0x03, 0x10, -+ 0x50); -+ break; -+ } -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(off, %d) **********\n", -+ type); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_TDMA, FALSE); -+ -+ /* disable PS tdma */ -+ switch (type) { -+ case 0: -+ halbtc8821c2ant_set_tdma(btc, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8821c2ant_set_tdma(btc, 0x0, 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8821c2ant_set_tdma(btc, 0x0, 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "change TDMA(%s, %d)\n", -+ (coex_dm->cur_ps_tdma_on ? "on" : "off"), -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ -+ btc->btc_set_atomic(btc, &coex_dm->setting_tdma, FALSE); -+} -+ -+static -+void halbtc8821c2ant_set_ant_switch(struct btc_coexist *btc, -+ boolean force_exec, u8 ctrl_type, -+ u8 pos_type) -+{ -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ struct rfe_type_8821c_2ant *rfe_type = &btc->rfe_type_8821c_2ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ boolean polarity_inverse = FALSE; -+ u8 val = 0; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ -+ if (!rfe_type->ext_ant_switch_exist) -+ return; -+ -+ if (!force_exec) { -+ if (((ctrl_type << 8) + pos_type) == -+ coex_dm->cur_ext_ant_switch_status) -+ return; -+ } -+ -+ coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; -+ -+ /* 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 -+ */ -+ if (rfe_type->ext_ant_switch_ctrl_polarity) -+ polarity_inverse = !polarity_inverse; -+ -+ /* swap control polarity if 1-Ant at Aux */ -+ if (rfe_type->ant_at_main_port == FALSE) -+ polarity_inverse = !polarity_inverse; -+ -+ switch (pos_type) { -+ default: -+ case BT_8821C_2ANT_TO_BT: -+ case BT_8821C_2ANT_TO_NOCARE: -+ case BT_8821C_2ANT_TO_WLA: -+ -+ break; -+ case BT_8821C_2ANT_TO_WLG: -+ if (!rfe_type->wlg_locate_at_btg) -+ polarity_inverse = !polarity_inverse; -+ -+ break; -+ } -+ -+ if (board_info->ant_div_cfg && ctrl_type == BT_8821C_2ANT_CTRL_BY_BBSW) -+ ctrl_type = BT_8821C_2ANT_CTRL_BY_ANTDIV; -+ -+ switch (ctrl_type) { -+ default: -+ case BT_8821C_2ANT_CTRL_BY_BBSW: -+ /* 0x4c[23] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x0); -+ /* 0x4c[24] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4f, 0x01, 0x1); -+ /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ -+ btc->btc_write_1byte_bitmask(btc, 0xcb4, 0xff, 0x77); -+ /* 0xcb4[29:28] = 2b'01 for no switch_polarity_inverse, -+ * DPDT_SEL_N =1, DPDT_SEL_P =0 -+ */ -+ val = (!polarity_inverse ? 0x1 : 0x2); -+ btc->btc_write_1byte_bitmask(btc, 0xcb7, 0x30, val); -+ break; -+ case BT_8821C_2ANT_CTRL_BY_PTA: -+ /* 0x4c[23] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x0); -+ /* 0x4c[24] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4f, 0x01, 0x1); -+ /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ -+ btc->btc_write_1byte_bitmask(btc, 0xcb4, 0xff, 0x66); -+ /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, -+ * DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 -+ */ -+ val = (!polarity_inverse ? 0x2 : 0x1); -+ btc->btc_write_1byte_bitmask(btc, 0xcb7, 0x30, val); -+ break; -+ case BT_8821C_2ANT_CTRL_BY_ANTDIV: -+ /* 0x4c[23] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x0); -+ /* 0x4c[24] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4f, 0x01, 0x1); -+ btc->btc_write_1byte_bitmask(btc, 0xcb4, 0xff, 0x88); -+ -+ /* no regval_0xcb7 setup required, because antenna switch -+ * control value by antenna diversity -+ */ -+ break; -+ case BT_8821C_2ANT_CTRL_BY_MAC: -+ /* 0x4c[23] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x1); -+ /* 0x64[0] = 1b'0 for no switch_polarity_inverse, -+ * DPDT_SEL_N =1, DPDT_SEL_P =0 -+ */ -+ val = (!polarity_inverse ? 0x0 : 0x1); -+ btc->btc_write_1byte_bitmask(btc, 0x64, 0x1, val); -+ break; -+ case BT_8821C_2ANT_CTRL_BY_FW: -+ /* 0x4c[23] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x0); -+ /* 0x4c[24] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4f, 0x01, 0x1); -+ break; -+ case BT_8821C_2ANT_CTRL_BY_BT: -+ /* 0x4c[23] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4e, 0x80, 0x0); -+ /* 0x4c[24] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x4f, 0x01, 0x0); -+ /* no setup required, because antenna switch control value -+ * by BT vendor 0xac[1:0] -+ */ -+ break; -+ } -+ -+ /* PAPE, LNA_ON control by BT while WLAN off -+ * for current leakage issue -+ */ -+ if (ctrl_type == BT_8821C_2ANT_CTRL_BY_BT) { -+ /* PAPE 0x64[29] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, 0x20, 0x0); -+ /* LNA_ON 0x64[28] = 0 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, 0x10, 0x0); -+ } else { -+ /* PAPE 0x64[29] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, 0x20, 0x1); -+ /* LNA_ON 0x64[28] = 1 */ -+ btc->btc_write_1byte_bitmask(btc, 0x67, 0x10, 0x1); -+ } -+} -+ -+static -+void halbtc8821c2ant_set_rfe_type(struct btc_coexist *btc) -+{ -+ struct rfe_type_8821c_2ant *rfe_type = &btc->rfe_type_8821c_2ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ -+ /* the following setup should be got from Efuse in the future */ -+ rfe_type->rfe_module_type = board_info->rfe_type & 0x1f; -+ -+ rfe_type->ext_ant_switch_ctrl_polarity = 0; -+ -+ switch (rfe_type->rfe_module_type) { -+ case 0: -+ case 8: -+ default: /*2-Ant, DPDT, WLG*/ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_2ANT_USE_DPDT; -+ rfe_type->wlg_locate_at_btg = FALSE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ case 1: -+ case 9: /*1-Ant, Main, WLG */ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_2ANT_USE_SPDT; -+ rfe_type->wlg_locate_at_btg = FALSE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ case 2: -+ case 10: /*1-Ant, Main, BTG */ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_2ANT_USE_SPDT; -+ rfe_type->wlg_locate_at_btg = TRUE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ case 3: -+ case 11: /*1-Ant, Aux, WLG */ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_2ANT_USE_DPDT; -+ rfe_type->wlg_locate_at_btg = FALSE; -+ rfe_type->ant_at_main_port = FALSE; -+ break; -+ case 4: -+ case 12: /*1-Ant, Aux, BTG */ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_2ANT_USE_DPDT; -+ rfe_type->wlg_locate_at_btg = TRUE; -+ rfe_type->ant_at_main_port = FALSE; -+ break; -+ case 5: -+ case 13: /*2-Ant, no switch, WLG*/ -+ rfe_type->ext_ant_switch_exist = FALSE; -+ rfe_type->ext_ant_switch_type = BT_8821C_2ANT_SWITCH_NONE; -+ rfe_type->wlg_locate_at_btg = FALSE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ case 6: -+ case 14: /*2-Ant, no antenna switch, WLG*/ -+ rfe_type->ext_ant_switch_exist = FALSE; -+ rfe_type->ext_ant_switch_type = BT_8821C_2ANT_SWITCH_NONE; -+ rfe_type->wlg_locate_at_btg = FALSE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ case 7: -+ case 15: /*2-Ant, DPDT, BTG*/ -+ rfe_type->ext_ant_switch_exist = TRUE; -+ rfe_type->ext_ant_switch_type = BT_8821C_2ANT_USE_DPDT; -+ rfe_type->wlg_locate_at_btg = TRUE; -+ rfe_type->ant_at_main_port = TRUE; -+ break; -+ } -+} -+ -+static -+void halbtc8821c2ant_set_ant_path(struct btc_coexist *btc, -+ u8 ant_pos_type, boolean force_exec, -+ u8 phase) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ u32 cnt_bt_cal_chk = 0, u32tmp1 = 0, u32tmp2 = 0; -+ u8 u8tmp = 0, ctrl_type, pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->cur_ant_pos_type == ((ant_pos_type << 8) + phase)) -+ return; -+ } -+ -+ coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; -+ -+ if (btc->dbg_mode) { -+ u32tmp1 = btc->btc_read_4byte(btc, 0xcb4); -+ u32tmp2 = btc->btc_read_4byte(btc, 0xcbc); -+ u8tmp = btc->btc_read_1byte(btc, 0x73); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], (Before Ant Setup) 0xcb4 = 0x%x, 0xcbc = 0x%x, 0x73 = 0x%x\n", -+ u32tmp1, u32tmp2, u8tmp); -+ BTC_TRACE(trace_buf); -+ } -+ -+ switch (phase) { -+ case BT_8821C_2ANT_PHASE_POWERON: -+ /* set Path control owner to WL at initial step */ -+ halbtc8821c2ant_coex_ctrl_owner(btc, BT_8821C_2ANT_PCO_BTSIDE); -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) { -+ 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; -+ } -+ -+ coex_sta->run_time_state = FALSE; -+ break; -+ case BT_8821C_2ANT_PHASE_INIT: -+ /* Disable LTE Coex Function in WiFi side -+ * (this should be on if LTE coex is required) -+ */ -+ halbtc8821c2ant_ltecoex_enable(btc, 0x0); -+ -+ /* GNT_WL_LTE always = 1 -+ * (this should be config if LTE coex is required) -+ */ -+ halbtc8821c2ant_ltecoex_table(btc, BT_8821C_2ANT_CTT_WL_VS_LTE, -+ 0xffff); -+ -+ /* GNT_BT_LTE always = 1 -+ * (this should be config if LTE coex is required) -+ */ -+ halbtc8821c2ant_ltecoex_table(btc, 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 = btc->btc_read_1byte(btc, 0x49c); -+ cnt_bt_cal_chk++; -+ -+ if (u8tmp & BIT(1)) { -+ 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(10); -+ } 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_coex_ctrl_owner(btc, BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW high */ -+ halbtc8821c2ant_set_gnt_bt(btc, BTC_GNT_SET_SW_HIGH); -+ /* Set GNT_WL to SW high */ -+ halbtc8821c2ant_set_gnt_wl(btc, BTC_GNT_SET_SW_HIGH); -+ -+ coex_sta->run_time_state = FALSE; -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) { -+ 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_WONLY: -+ /* Disable LTE Coex Function in WiFi side -+ * (this should be on if LTE coex is required) -+ */ -+ halbtc8821c2ant_ltecoex_enable(btc, 0x0); -+ -+ /* GNT_WL_LTE always = 1 -+ * (this should be config if LTE coex is required) -+ */ -+ halbtc8821c2ant_ltecoex_table(btc, BT_8821C_2ANT_CTT_WL_VS_LTE, -+ 0xffff); -+ -+ /* GNT_BT_LTE always = 1 -+ * (this should be config if LTE coex is required) -+ */ -+ halbtc8821c2ant_ltecoex_table(btc, BT_8821C_2ANT_CTT_BT_VS_LTE, -+ 0xffff); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8821c2ant_coex_ctrl_owner(btc, BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Low */ -+ halbtc8821c2ant_set_gnt_bt(btc, BTC_GNT_SET_SW_LOW); -+ /* Set GNT_WL to SW high */ -+ halbtc8821c2ant_set_gnt_wl(btc, BTC_GNT_SET_SW_HIGH); -+ -+ coex_sta->run_time_state = FALSE; -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) { -+ 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_WOFF: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8821c2ant_ltecoex_enable(btc, 0x0); -+ -+ /* set Path control owner to BT */ -+ halbtc8821c2ant_coex_ctrl_owner(btc, BT_8821C_2ANT_PCO_BTSIDE); -+ -+ coex_sta->run_time_state = FALSE; -+ break; -+ case BT_8821C_2ANT_PHASE_2G: -+ while (cnt_bt_cal_chk <= 20) { -+ /* 0x49c[0]=1 WL IQK, 0x49c[1]=1 BT IQK*/ -+ u8tmp = btc->btc_read_1byte(btc, 0x49c); -+ -+ cnt_bt_cal_chk++; -+ if (u8tmp & BIT(0)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### WL is IQK (wait cnt=%d)\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(10); -+ } else if (u8tmp & BIT(1)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### BT is IQK (wait cnt=%d)\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(10); -+ } 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 owner to WL at runtime step */ -+ halbtc8821c2ant_coex_ctrl_owner(btc, BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to PTA */ -+ halbtc8821c2ant_set_gnt_bt(btc, BTC_GNT_SET_HW_PTA); -+ -+ /* Set GNT_WL to PTA */ -+ halbtc8821c2ant_set_gnt_wl(btc, BTC_GNT_SET_HW_PTA); -+ -+ coex_sta->run_time_state = TRUE; -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) { -+ 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: -+ /* set Path control owner to WL at runtime step */ -+ halbtc8821c2ant_coex_ctrl_owner(btc, BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to PTA */ -+ halbtc8821c2ant_set_gnt_bt(btc, BTC_GNT_SET_HW_PTA); -+ -+ /* Set GNT_WL to SW Hi */ -+ halbtc8821c2ant_set_gnt_wl(btc, BTC_GNT_SET_SW_HIGH); -+ -+ coex_sta->run_time_state = TRUE; -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) { -+ 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_BTMP: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8821c2ant_ltecoex_enable(btc, 0x0); -+ -+ /* set Path control owner to WL */ -+ halbtc8821c2ant_coex_ctrl_owner(btc, BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Hi */ -+ halbtc8821c2ant_set_gnt_bt(btc, BTC_GNT_SET_SW_HIGH); -+ -+ /* Set GNT_WL to SW Lo */ -+ halbtc8821c2ant_set_gnt_wl(btc, BTC_GNT_SET_SW_LOW); -+ -+ coex_sta->run_time_state = FALSE; -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) { -+ 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_ANTDET: -+ halbtc8821c2ant_coex_ctrl_owner(btc, BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to high */ -+ halbtc8821c2ant_set_gnt_bt(btc, BTC_GNT_SET_SW_HIGH); -+ /* Set GNT_WL to high */ -+ halbtc8821c2ant_set_gnt_wl(btc, BTC_GNT_SET_SW_HIGH); -+ -+ if (ant_pos_type == BTC_ANT_PATH_AUTO) { -+ 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; -+ } -+ -+ coex_sta->run_time_state = FALSE; -+ break; -+ } -+ -+ if (phase == BT_8821C_2ANT_PHASE_WOFF) { -+ /* Set Ext Ant Switch to BT control at wifi off step */ -+ ctrl_type = BT_8821C_2ANT_CTRL_BY_BT; -+ pos_type = BT_8821C_2ANT_TO_NOCARE; -+ } else { -+ switch (ant_pos_type) { -+ default: -+ case BTC_ANT_WIFI_AT_MAIN: -+ ctrl_type = BT_8821C_2ANT_CTRL_BY_BBSW; -+ pos_type = BT_8821C_2ANT_TO_WLG; -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ ctrl_type = BT_8821C_2ANT_CTRL_BY_BBSW; -+ pos_type = BT_8821C_2ANT_TO_BT; -+ break; -+ case BTC_ANT_WIFI_AT_DIVERSITY: -+ ctrl_type = BT_8821C_2ANT_CTRL_BY_ANTDIV; -+ pos_type = BT_8821C_2ANT_TO_NOCARE; -+ break; -+ } -+ } -+ -+ halbtc8821c2ant_set_ant_switch(btc, force_exec, ctrl_type, pos_type); -+ -+ if (btc->dbg_mode) { -+ u32tmp1 = btc->btc_read_4byte(btc, 0xcbc); -+ u32tmp2 = btc->btc_read_4byte(btc, 0xcb4); -+ u8tmp = btc->btc_read_1byte(btc, 0x73); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], (After Ant Setup) 0xcb4 = 0x%x, 0xcbc = 0x%x, 0x73 = 0x%x\n", -+ u32tmp1, u32tmp2, u8tmp); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+static -+u8 halbtc8821c2ant_action_algorithm(struct btc_coexist *btc) -+{ -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ u8 algorithm = BT_8821C_2ANT_COEX_UNDEFINED; -+ u8 profile_map = 0; -+ -+ if (bt_link_info->sco_exist) -+ profile_map = profile_map | BIT(0); -+ -+ if (bt_link_info->hid_exist) -+ profile_map = profile_map | BIT(1); -+ -+ if (bt_link_info->a2dp_exist) -+ profile_map = profile_map | BIT(2); -+ -+ if (bt_link_info->pan_exist) -+ profile_map = profile_map | BIT(3); -+ -+ switch (profile_map) { -+ case 0: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_UNDEFINED; -+ break; -+ case 1: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_SCO; -+ break; -+ case 2: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_HID; -+ break; -+ case 3: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_HID; -+ break; -+ case 4: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_A2DP; -+ break; -+ case 5: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP ==> HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_HID_A2DP; -+ break; -+ case 6: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_HID_A2DP; -+ break; -+ case 7: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_HID_A2DP; -+ break; -+ case 8: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_PAN; -+ break; -+ case 9: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(EDR) ==> HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_PAN_HID; -+ break; -+ case 10: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_PAN_HID; -+ break; -+ case 11: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(EDR) ==> HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_PAN_HID; -+ break; -+ case 12: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_PAN_A2DP; -+ break; -+ case 13: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_PAN_A2DP; -+ break; -+ case 14: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR) ==> A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_PAN_A2DP; -+ break; -+ case 15: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR) ==> A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_PAN_A2DP; -+ break; -+ } -+ -+ return algorithm; -+} -+ -+static void halbtc8821c2ant_action_freerun(struct btc_coexist *btc) -+{ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+} -+ -+static -+void halbtc8821c2ant_action_coex_all_off(struct btc_coexist *btc) -+{ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+} -+ -+static -+void halbtc8821c2ant_action_bt_whql_test(struct btc_coexist *btc) -+{ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+} -+ -+static -+void halbtc8821c2ant_action_bt_inquiry(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ boolean wifi_connected = FALSE, wifi_busy = FALSE; -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, FC_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (coex_sta->is_wifi_linkscan_process || -+ coex_sta->wifi_high_pri_task1 || -+ coex_sta->wifi_high_pri_task2) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt inq/page + wifi hi-pri task\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ -+ if (bt_link_info->bt_link_exist) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 15); -+ else if (coex_sta->wifi_high_pri_task1) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 113); -+ else if (!coex_sta->bt_create_connection) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 10); -+ else -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 13); -+ } else if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt inq/page + wifi busy\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 151); -+ } else if (wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt inq/page + wifi connected\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 117); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt inq/page + wifi not-connected\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } -+} -+ -+static -+void halbtc8821c2ant_action_bt_relink(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ -+ if (coex_sta->gl_wifi_busy) -+ halbtc8821c2ant_table(btc, NM_EXCU, 18); -+ else -+ halbtc8821c2ant_table(btc, NM_EXCU, 5); -+ -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+} -+ -+static -+void halbtc8821c2ant_action_bt_idle(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state; -+ -+ wifi_rssi_state = -+ halbtc8821c2ant_wifi_rssi_state(btc, &prewifi_rssi_state, 2, -+ 40, 0); -+ -+ if (!coex_sta->gl_wifi_busy) { -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 14); -+ } else { /* if wl busy */ -+ if ((coex_sta->bt_ble_scan_type & 0x2) && -+ coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_NCON_IDLE) { -+ halbtc8821c2ant_table(btc, NM_EXCU, 14); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 12); -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ else -+ halbtc8821c2ant_table(btc, NM_EXCU, 3); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 12); -+ } -+ } -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, FC_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+} -+ -+static -+void halbtc8821c2ant_action_bt_mr(struct btc_coexist *btc) -+{ -+ struct wifi_link_info_8821c_2ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_2ant; -+ -+ if (!wifi_link_info_ext->is_all_under_5g) { -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_2ANT_PHASE_2G); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } else { -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_2ANT_PHASE_5G); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } -+} -+ -+static -+void halbtc8821c2ant_action_sco(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ if (coex_sta->is_bt_multi_link) { -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 25); -+ } else { -+ if (coex_sta->is_esco_mode) -+ halbtc8821c2ant_table(btc, NM_EXCU, 1); -+ else /* 2-Ant free run if SCO mode */ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 8); -+ } -+} -+ -+static -+void halbtc8821c2ant_action_hid(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ boolean wifi_busy = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ if (coex_sta->is_hid_low_pri_tx_overhead) { -+ halbtc8821c2ant_table(btc, NM_EXCU, 12); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 108); -+ } else if (coex_sta->is_hid_rcu) { -+ halbtc8821c2ant_table(btc, NM_EXCU, 12); -+ -+ if (wifi_busy) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 113); -+ else -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 111); -+ } else { -+ halbtc8821c2ant_table(btc, NM_EXCU, 12); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 111); -+ } -+} -+ -+static -+void halbtc8821c2ant_action_a2dpsink(struct btc_coexist *btc) -+{ -+ boolean ap_enable = FALSE; -+ -+ if (btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GO && -+ btc->wifi_link_info.bhotspot && -+ btc->wifi_link_info.bany_client_join_go) -+ ap_enable = TRUE; -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ if (ap_enable) { -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } else { -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 104); -+ } -+} -+ -+static -+void halbtc8821c2ant_action_a2dp(struct btc_coexist *btc) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state; -+ boolean wifi_busy = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = -+ halbtc8821c2ant_wifi_rssi_state(btc, &prewifi_rssi_state, 2, -+ 45, 0); -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ -+ if (!wifi_busy) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 120 | TDMA_4SLOT); -+ else if (BTC_RSSI_HIGH(wifi_rssi_state)) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 119 | TDMA_4SLOT); -+ else -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 101 | TDMA_4SLOT); -+} -+ -+static -+void halbtc8821c2ant_action_pan(struct btc_coexist *btc) -+{ -+ boolean wifi_busy = FALSE; -+ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = -+ halbtc8821c2ant_wifi_rssi_state(btc, &prewifi_rssi_state, 2, -+ 58, 0); -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ /* for Lenovo CPT_For_WiFi OPP test */ -+ if (btc->board_info.customer_id == RT_CID_LENOVO_CHINA && -+ BTC_RSSI_HIGH(wifi_rssi_state) && wifi_busy) { -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 103); -+ } else { -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ -+ if (wifi_busy) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 103); -+ else -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 104); -+ } -+} -+ -+static -+void halbtc8821c2ant_action_hid_a2dp(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state; -+ u32 slot_type = 0; -+ -+ wifi_rssi_state = -+ halbtc8821c2ant_wifi_rssi_state(btc, &prewifi_rssi_state, 2, -+ 45, 0); -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ /*BLE HID should use 2-slot to avoid HID lag issue (COEX-357)*/ -+ if (!coex_sta->bt_ble_hid_exist) -+ slot_type = TDMA_4SLOT; -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 12); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 119 | slot_type); -+ else -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 109 | slot_type); -+} -+ -+static -+void halbtc8821c2ant_action_pan_a2dp(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state; -+ boolean wifi_busy = FALSE; -+ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btc->btc_get(btc, BTC_GET_U1_IOT_PEER, &iot_peer); -+ -+ if (!wifi_busy) -+ wifi_busy = coex_sta->gl_wifi_busy; -+ -+ wifi_rssi_state = -+ halbtc8821c2ant_wifi_rssi_state(btc, &prewifi_rssi_state, 2, -+ 42, 0); -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ -+ /* for Lenovo coex test case */ -+ if (btc->board_info.customer_id == RT_CID_LENOVO_CHINA && -+ coex_sta->scan_ap_num <= 10 && -+ iot_peer == BTC_IOT_PEER_ATHEROS) { -+ /* for CPT_for_WiFi */ -+ if (BTC_RSSI_LOW(wifi_rssi_state)) { -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 20); -+ if (wifi_busy) { -+ halbtc8821c2ant_table(btc, NM_EXCU, 7); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 110); -+ } else { -+ halbtc8821c2ant_table(btc, NM_EXCU, 7); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 107); -+ } -+ } else { /* for CPT_for_BT */ -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 116); -+ } -+ } else { -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ -+ if (wifi_busy) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 107); -+ else -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 106); -+ } -+} -+ -+static -+void halbtc8821c2ant_action_pan_hid(struct btc_coexist *btc) -+{ -+ boolean wifi_busy = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ -+ if (wifi_busy) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 103); -+ else -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 104); -+} -+ -+static -+void halbtc8821c2ant_action_hid_a2dp_pan(struct btc_coexist *btc) -+{ -+ boolean wifi_busy = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 12); -+ -+ if (wifi_busy) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 107); -+ else -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 106); -+} -+ -+static -+void halbtc8821c2ant_action_wifi_under5g(struct btc_coexist *btc) -+{ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_2ANT_PHASE_5G); -+ /* fw all off */ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+} -+ -+static -+void halbtc8821c2ant_action_wifi_native_lps(struct btc_coexist *btc) -+{ -+ halbtc8821c2ant_table(btc, NM_EXCU, 4); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+} -+ -+static -+void halbtc8821c2ant_action_wifi_linkscan(struct btc_coexist *btc) -+{ -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, FC_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 8); -+ -+ if (bt_link_info->pan_exist) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 22); -+ else if (bt_link_info->a2dp_exist) -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 16); -+ else -+ halbtc8821c2ant_tdma(btc, NM_EXCU, TRUE, 21); -+} -+ -+static -+void halbtc8821c2ant_action_wifi_not_connected(struct btc_coexist *btc) -+{ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+} -+ -+static -+void halbtc8821c2ant_action_wifi_connected(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ -+ coex_dm->cur_algorithm = halbtc8821c2ant_action_algorithm(btc); -+ -+ if (halbtc8821c2ant_freerun_check(btc)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, Frerun().\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_freerun(btc); -+ return; -+ } -+ -+ switch (coex_dm->cur_algorithm) { -+ case BT_8821C_2ANT_COEX_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_sco(btc); -+ break; -+ case BT_8821C_2ANT_COEX_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_hid(btc); -+ break; -+ case BT_8821C_2ANT_COEX_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* for A2DP + OPP test but BTinfo is -+ * A2DP only in Lenovo test case -+ */ -+ if (coex_sta->is_bt_multi_link && coex_sta->hid_pair_cnt == 0) -+ halbtc8821c2ant_action_pan_a2dp(btc); -+ else if (coex_sta->is_bt_a2dp_sink) -+ halbtc8821c2ant_action_a2dpsink(btc); -+ else -+ halbtc8821c2ant_action_a2dp(btc); -+ break; -+ case BT_8821C_2ANT_COEX_PAN: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_pan(btc); -+ break; -+ case BT_8821C_2ANT_COEX_PAN_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_pan_a2dp(btc); -+ break; -+ case BT_8821C_2ANT_COEX_PAN_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_hid(btc); -+ break; -+ case BT_8821C_2ANT_COEX_HID_A2DP_PAN: -+ 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(btc); -+ break; -+ case BT_8821C_2ANT_COEX_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(btc); -+ 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(btc); -+ break; -+ } -+} -+ -+static -+void halbtc8821c2ant_action_wifi_multiport25g(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_BTCQDDR, TRUE); -+ -+ if (coex_sta->is_setup_link || coex_sta->bt_relink_downcount != 0) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport25g(), BT Relink!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } else if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport25g(), BT Inq-Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 11); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport25g(), BT idle or busy!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 11); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } -+} -+ -+static -+void halbtc8821c2ant_action_wifi_multiport2g(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct btc_concurrent_setting multiport_tdma_para; -+ u32 traffic_dir; -+ -+ btc->btc_get(btc, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &traffic_dir); -+ -+ halbtc8821c2ant_set_wl_tx_power(btc, NM_EXCU, 0xd8); -+ halbtc8821c2ant_set_bt_tx_power(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_BTCQDDR, TRUE); -+ -+ if (coex_sta->is_setup_link || coex_sta->bt_relink_downcount != 0) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport2g, BT Relink!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } else if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport2g, BT Inq-Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } else if (coex_sta->num_of_profile == 0) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport2g, BT idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btc->chip_interface == BTC_INTF_PCI && -+ (btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GO || -+ btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GC)) -+ halbtc8821c2ant_table(btc, NM_EXCU, 10); -+ else -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ } else if (coex_sta->is_wifi_linkscan_process) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport2g, WL scan!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_action_wifi_linkscan(btc); -+ } else { -+ switch (btc->wifi_link_info.link_mode) { -+ case BTC_LINK_ONLY_GO: -+ case BTC_LINK_ONLY_GC: -+ if (btc->chip_interface == BTC_INTF_PCI && -+ coex_sta->a2dp_exist && !coex_sta->is_bt_multi_link) -+ halbtc8821c2ant_table(btc, NM_EXCU, 10); -+ else -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi_multiport2g, Other multi-port + BT busy!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_table(btc, NM_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, NM_EXCU, FALSE, 0); -+ break; -+ } -+ } -+} -+ -+static -+void halbtc8821c2ant_run_coex(struct btc_coexist *btc, u8 reason) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ struct wifi_link_info_8821c_2ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_2ant; -+ boolean wifi_connected = FALSE, wifi_32k = FALSE; -+ boolean scan = FALSE, link = FALSE, roam = FALSE, under_4way = FALSE; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_SCAN, &scan); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_LINK, &link); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_ROAM, &roam); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &under_4way); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); -+ btc->btc_get(btc, BTC_GET_BL_WIFI_LW_PWR_STATE, &wifi_32k); -+ -+ if (scan || link || roam || under_4way || -+ reason == BT_8821C_2ANT_RSN_2GSCANSTART || -+ reason == BT_8821C_2ANT_RSN_2GSWITCHBAND || -+ reason == BT_8821C_2ANT_RSN_2GCONSTART || -+ reason == BT_8821C_2ANT_RSN_2GSPECIALPKT) { -+ 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); -+ coex_sta->is_wifi_linkscan_process = TRUE; -+ } else { -+ coex_sta->is_wifi_linkscan_process = FALSE; -+ } -+ -+ /* update wifi_link_info_ext variable */ -+ halbtc8821c2ant_update_wifi_link_info(btc, reason); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===> reason = %d\n", -+ reason); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->coex_run_reason = reason; -+ -+ if (btc->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btc->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], RunCoexistMechanism(), return for wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_lps && wifi_32k) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for wifi is under LPS-32K !!!\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 && !coex_sta->is_setup_link) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], return for freeze_coexrun_by_btinfo\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ coex_sta->coex_run_cnt++; -+ -+ if (coex_sta->msft_mr_exist && wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), microsoft MR!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_coex_mode = BT_8821C_2ANT_WLINK_BTMR; -+ halbtc8821c2ant_action_bt_mr(btc); -+ return; -+ } -+ -+ if (wifi_link_info_ext->is_all_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_coex_mode = BT_8821C_2ANT_WLINK_5G; -+ halbtc8821c2ant_action_wifi_under5g(btc); -+ return; -+ } -+ -+ if (wifi_link_info_ext->is_mcc_25g) { /* not iclude scan action */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under mcc dual-band!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_coex_mode = BT_8821C_2ANT_WLINK_25GMPORT; -+ halbtc8821c2ant_action_wifi_multiport25g(btc); -+ return; -+ } -+ -+ if (wifi_link_info_ext->num_of_active_port > 1 || -+ (btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GO && -+ !btc->wifi_link_info.bhotspot && -+ btc->wifi_link_info.bany_client_join_go)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under scc-2g/mcc-2g/p2pGO-only!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btc->wifi_link_info.link_mode == BTC_LINK_ONLY_GO) -+ coex_sta->wl_coex_mode = BT_8821C_2ANT_WLINK_2GGO; -+ else -+ coex_sta->wl_coex_mode = BT_8821C_2ANT_WLINK_2GMPORT; -+ halbtc8821c2ant_action_wifi_multiport2g(btc); -+ return; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is single-port 2G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_coex_mode = BT_8821C_2ANT_WLINK_2G1PORT; -+ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, NM_EXCU, -+ BT_8821C_2ANT_PHASE_2G); -+ -+ /*For Asus airpods 2 + HID glitch issue*/ -+ if (coex_sta->bt_a2dp_vendor_id == 0x4c && coex_sta->is_bt_multi_link) -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_BTCQDDR, -+ FALSE); -+ else -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_BTCQDDR, -+ TRUE); -+ -+ 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(btc); -+ return; -+ } -+ -+ if (coex_sta->under_lps && !coex_sta->force_lps_ctrl && -+ !coex_sta->acl_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), wifi is under LPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_wifi_native_lps(btc); -+ 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); -+ halbtc8821c2ant_action_bt_whql_test(btc); -+ return; -+ } -+ -+ if (coex_sta->is_setup_link || coex_sta->bt_relink_downcount != 0) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is re-link !!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_bt_relink(btc); -+ 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(btc); -+ return; -+ } -+ -+ if ((coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_NCON_IDLE || -+ coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_CON_IDLE) && -+ wifi_link_info_ext->is_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is idle\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_bt_idle(btc); -+ return; -+ } -+ -+ if (coex_sta->is_wifi_linkscan_process) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under linkscan process!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_wifi_linkscan(btc); -+ return; -+ } -+ -+ if (wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under connected!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_action_wifi_connected(btc); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under not-connected!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_action_wifi_not_connected(btc); -+ } -+} -+ -+static void halbtc8821c2ant_init_coex_var(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ -+ /* Reset Coex variable */ -+ btc->btc_set(btc, BTC_SET_RESET_COEX_VAR, NULL); -+ -+ coex_sta->bt_reg_vendor_ac = 0xffff; -+ coex_sta->bt_reg_vendor_ae = 0xffff; -+ -+ coex_sta->isolation_btween_wb = BT_8821C_2ANT_DEFAULT_ISOLATION; -+ btc->bt_info.bt_get_fw_ver = 0; -+} -+ -+static -+void halbtc8821c2ant_init_coex_dm(struct btc_coexist *btc) -+{ -+} -+ -+static -+void halbtc8821c2ant_init_hw_config(struct btc_coexist *btc, boolean wifi_only) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ u8 u8tmp = 0; -+ u32 vendor; -+ u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ u8 i; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], %s()!\n", __func__); -+ BTC_TRACE(trace_buf); -+ -+#if 0 -+ u32tmp3 = btc->btc_read_4byte(btc, 0xcb4); -+ u32tmp1 = halbtc8821c2ant_read_indirect_reg(btc, 0x38); -+ u32tmp2 = halbtc8821c2ant_read_indirect_reg(btc, 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); -+#endif -+ -+ halbtc8821c2ant_init_coex_var(btc); -+ -+ /* 0xf0[15:12] --> kt_ver */ -+ coex_sta->kt_ver = (btc->btc_read_1byte(btc, 0xf1) & 0xf0) >> 4; -+ -+ halbtc8821c2ant_coex_switch_thres(btc, coex_sta->isolation_btween_wb); -+ /* enable TBTT nterrupt */ -+ btc->btc_write_1byte_bitmask(btc, 0x550, 0x8, 0x1); -+ -+ /* BT report packet sample rate */ -+ btc->btc_write_1byte(btc, 0x790, 0x5); -+ -+ /* Init 0x778 = 0x1 for 2-Ant */ -+ btc->btc_write_1byte(btc, 0x778, 0x1); -+ -+ /* Enable PTA (3-wire function form BT side) */ -+ btc->btc_write_1byte_bitmask(btc, 0x40, 0x20, 0x1); -+ btc->btc_write_1byte_bitmask(btc, 0x41, 0x02, 0x1); -+ -+ /* Enable PTA (tx/rx signal form WiFi side) */ -+ btc->btc_write_1byte_bitmask(btc, 0x4c6, 0x30, 0x1); -+ -+ /* set GNT_BT=1 for coex table select both */ -+ btc->btc_write_1byte_bitmask(btc, 0x763, 0x10, 0x1); -+ -+ halbtc8821c2ant_enable_gnt_to_gpio(btc, TRUE); -+ -+ /* Enable counter statistics */ -+ /* 0x76e[3] =1, WLAN_Act control by PTA */ -+ btc->btc_write_1byte(btc, 0x76e, 0x4); -+ -+ if (btc->wl_rf_state_off) { -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_2ANT_PHASE_WOFF); -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_ALL, FALSE); -+ btc->stop_coex_dm = TRUE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s: RF Off\n", __func__); -+ BTC_TRACE(trace_buf); -+ } else if (wifi_only) { -+ coex_sta->concurrent_rx_mode_on = FALSE; -+ /* Path config */ -+ /* Set Antenna Path */ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_2ANT_PHASE_WONLY); -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_ACTIVE | -+ BT_8821C_2ANT_SCBD_ONOFF, -+ TRUE); -+ btc->stop_coex_dm = TRUE; -+ } else { -+ coex_sta->concurrent_rx_mode_on = TRUE; -+ /* btc->btc_write_1byte_bitmask(btc, 0x953, 0x2, 0x1); */ -+ -+ /* RF 0x1[1] = 0->Set GNT_WL_RF_Rx always = 1 -+ * for con-current Rx, mask Tx only -+ */ -+ btc->btc_set_rf_reg(btc, BTC_RF_A, 0x1, 0x2, 0x0); -+ -+ /* Set Antenna Path */ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_2ANT_PHASE_INIT); -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_ACTIVE | -+ BT_8821C_2ANT_SCBD_ONOFF, -+ TRUE); -+ btc->stop_coex_dm = FALSE; -+ } -+ -+ halbtc8821c2ant_table(btc, FC_EXCU, 0); -+ halbtc8821c2ant_tdma(btc, FC_EXCU, FALSE, 0); -+ -+ halbtc8821c2ant_query_bt_info(btc); -+} -+ -+void ex_halbtc8821c2ant_power_on_setting(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ u8 u8tmp = 0x0; -+ u16 u16tmp = 0x0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Execute %s !!\n", __func__); -+ BTC_TRACE(trace_buf); -+ -+ btc->stop_coex_dm = TRUE; -+ btc->wl_rf_state_off = FALSE; -+ -+ /* enable BB, REG_SYS_FUNC_EN such that -+ * we can write BB Register correctly. -+ */ -+ u16tmp = btc->btc_read_2byte(btc, 0x2); -+ btc->btc_write_2byte(btc, 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); -+ -+ /* Setup RF front end type */ -+ halbtc8821c2ant_set_rfe_type(btc); -+ -+ /* Set Antenna Path to BT side */ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_2ANT_PHASE_POWERON); -+ -+ halbtc8821c2ant_table(btc, FC_EXCU, 0); -+ -+ /* Save"single antenna position" info in Local register setting -+ * for FW reading, because FW may not ready at power on -+ */ -+ if (btc->chip_interface == BTC_INTF_PCI) -+ btc->btc_write_local_reg_1byte(btc, 0x3e0, u8tmp); -+ else if (btc->chip_interface == BTC_INTF_USB) -+ btc->btc_write_local_reg_1byte(btc, 0xfe08, u8tmp); -+ else if (btc->chip_interface == BTC_INTF_SDIO) -+ btc->btc_write_local_reg_1byte(btc, 0x60, u8tmp); -+ -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ halbtc8821c2ant_enable_gnt_to_gpio(btc, TRUE); -+ -+ if (btc->dbg_mode) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LTE coex Reg 0x38 (Power-On) = 0x%x\n", -+ halbtc8821c2ant_read_indirect_reg(btc, 0x38)); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MACReg 0x70/ BBReg 0xcb4 (Power-On) = 0x%x/ 0x%x\n", -+ btc->btc_read_4byte(btc, 0x70), -+ btc->btc_read_4byte(btc, 0xcb4)); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8821c2ant_pre_load_firmware(struct btc_coexist *btc) -+{ -+ struct btc_board_info *board_info = &btc->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 (btc->chip_interface == BTC_INTF_USB) { -+ /* fixed at S0 for USB interface */ -+ u8tmp |= 0x1; /* antenna inverse */ -+ btc->btc_write_local_reg_1byte(btc, 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 (btc->chip_interface == BTC_INTF_PCI) -+ btc->btc_write_local_reg_1byte(btc, 0x3e0, u8tmp); -+ else if (btc->chip_interface == BTC_INTF_SDIO) -+ btc->btc_write_local_reg_1byte(btc, 0x60, u8tmp); -+ } -+} -+ -+ -+void ex_halbtc8821c2ant_init_hw_config(struct btc_coexist *btc, -+ boolean wifi_only) -+{ -+ halbtc8821c2ant_init_hw_config(btc, wifi_only); -+} -+ -+void ex_halbtc8821c2ant_init_coex_dm(struct btc_coexist *btc) -+{ -+ btc->stop_coex_dm = FALSE; -+ btc->auto_report = TRUE; -+ btc->dbg_mode = FALSE; -+ halbtc8821c2ant_init_coex_dm(btc); -+} -+ -+void ex_halbtc8821c2ant_display_simple_coex_info(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ -+ u8 *cli_buf = btc->cli_buf; -+ u32 bt_patch_ver = 0, bt_coex_ver = 0; -+ static u8 cnt; -+ u8 * const p = &coex_sta->bt_afh_map[0]; -+ -+ if (!coex_sta->bt_disabled && -+ (coex_sta->bt_coex_supported_version == 0 || -+ coex_sta->bt_coex_supported_version == 0xffff) && -+ cnt == 0) { -+ btc->btc_get(btc, BTC_GET_U4_SUPPORTED_FEATURE, -+ &coex_sta->bt_coex_supported_feature); -+ -+ btc->btc_get(btc, BTC_GET_U4_SUPPORTED_VERSION, -+ &coex_sta->bt_coex_supported_version); -+ -+ coex_sta->bt_reg_vendor_ac = (u16)(btc->btc_get_bt_reg(btc, 3, -+ 0xac) & -+ 0xffff); -+ -+ coex_sta->bt_reg_vendor_ae = (u16)(btc->btc_get_bt_reg(btc, 3, -+ 0xae) & -+ 0xffff); -+ -+ btc->btc_get(btc, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btc->bt_info.bt_get_fw_ver = bt_patch_ver; -+ -+ if (coex_sta->num_of_profile > 0) -+ btc->btc_get_bt_afh_map_from_bt(btc, 0, p); -+ } -+ -+ if (++cnt >= 3) -+ cnt = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n _____[BT Coexist info]____"); -+ CL_PRINTF(cli_buf); -+ -+ if (btc->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 (btc->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/ %s / 0x%x", -+ "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"), -+ board_info->rfe_type); -+ CL_PRINTF(cli_buf); -+ -+ 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_8821c_2ant, glcoex_ver_8821c_2ant, -+ glcoex_ver_btdesired_8821c_2ant, -+ bt_coex_ver, -+ (bt_coex_ver == 0xff ? "Unknown" : -+ (coex_sta->bt_disabled ? "BT-disable" : -+ (bt_coex_ver >= glcoex_ver_btdesired_8821c_2ant ? -+ "Match" : "Mis-Match")))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", "BT status", -+ ((coex_sta->bt_disabled) ? ("disabled") : -+ ((coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") -+ : ((BT_8821C_2ANT_BSTATUS_NCON_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8821C_2ANT_BSTATUS_CON_IDLE == -+ coex_dm->bt_status) ? "connected-idle" : "busy"))))); -+ 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 %s", -+ "0x774(Lo-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx, -+ (bt_link_info->slave_role ? "(Slave!!)" : " ")); -+ CL_PRINTF(cli_buf); -+} -+ -+void ex_halbtc8821c2ant_display_coex_info(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ -+ u8 *cli_buf = btc->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; -+ u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; -+ static u8 pop_report_in_10s; -+ u32 phyver = 0, val = 0; -+ boolean lte_coex_on = FALSE, is_bt_reply = FALSE; -+ static u8 cnt; -+ u32 ratio_crc, cnt_ok, cnt_err; -+ u8 * const p = &coex_sta->bt_afh_map[0]; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info 8821C]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btc->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); -+ } else if (btc->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); -+ } else if (!coex_sta->run_time_state) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Run Time State = False]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } else if (coex_sta->freeze_coexrun_by_btinfo) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[freeze_coexrun_by_btinfo]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (!coex_sta->bt_disabled && cnt == 0) { -+ if (coex_sta->bt_coex_supported_version == 0 || -+ coex_sta->bt_coex_supported_version == 0xffff) { -+ btc->btc_get(btc, BTC_GET_U4_SUPPORTED_VERSION, -+ &coex_sta->bt_coex_supported_version); -+ -+ if (coex_sta->bt_coex_supported_version > 0 && -+ coex_sta->bt_coex_supported_version < 0xffff) -+ is_bt_reply = TRUE; -+ } else { -+ is_bt_reply = TRUE; -+ } -+ -+ if (coex_sta->num_of_profile > 0) -+ btc->btc_get_bt_afh_map_from_bt(btc, 0, p); -+ } -+ -+ if (is_bt_reply) { -+ if (coex_sta->bt_coex_supported_feature == 0) -+ btc->btc_get(btc, BTC_GET_U4_SUPPORTED_FEATURE, -+ &coex_sta->bt_coex_supported_feature); -+ -+ if (coex_sta->bt_reg_vendor_ac == 0xffff) { -+ val = btc->btc_get_bt_reg(btc, 3, 0xac); -+ coex_sta->bt_reg_vendor_ac = (u16)(val & 0xffff); -+ } -+ -+ if (coex_sta->bt_reg_vendor_ae == 0xffff) { -+ val = btc->btc_get_bt_reg(btc, 3, 0xae); -+ coex_sta->bt_reg_vendor_ae = (u16)(val & 0xffff); -+ } -+ -+ if (btc->bt_info.bt_get_fw_ver == 0) { -+ btc->btc_get(btc, BTC_GET_U4_BT_PATCH_VER, -+ &bt_patch_ver); -+ btc->bt_info.bt_get_fw_ver = bt_patch_ver; -+ } -+ } -+ -+ if (++cnt >= 3) -+ cnt = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %s/ %s / 0x%x", -+ "Ant PG Num/ Mech/ Pos/ RFE", -+ board_info->pg_ant_num, -+ (board_info->btdm_ant_num == 1 ? "Shared" : "Non-Shared"), -+ (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT -+ ? "Main" : "Aux"), -+ board_info->rfe_type); -+ CL_PRINTF(cli_buf); -+ -+ bt_patch_ver = btc->bt_info.bt_get_fw_ver; -+ btc->btc_get(btc, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ phyver = btc->btc_get_bt_phydm_version(btc); -+ 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_8821c_2ant, glcoex_ver_8821c_2ant, -+ glcoex_ver_btdesired_8821c_2ant, -+ bt_coex_ver, -+ (bt_coex_ver == 0xff ? "Unknown" : -+ (coex_sta->bt_disabled ? "BT-disable" : -+ (bt_coex_ver >= glcoex_ver_btdesired_8821c_2ant ? -+ "Match" : "Mis-Match")))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x(%s)/ 0x%x/ v%d/ %c", -+ "W_FW/ B_FW/ Phy/ Kt", fw_ver, -+ (fw_ver >= glcoex_ver_wldesired_8821c_2ant ? -+ "Match" : -+ "Mis-Match"), -+ bt_patch_ver, phyver, coex_sta->kt_ver + 65); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x (RF-Ch = %d)", -+ "AFH Map to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2], coex_sta->wl_center_channel); -+ 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); -+ btc->btc_disp_dbg_msg(btc, 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/ %ddBm/ %d/ %d", -+ "BT status/ rssi/ retryCnt/ popCnt", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry-page") -+ : ((BT_8821C_2ANT_BSTATUS_NCON_IDLE == -+ coex_dm->bt_status) ? "non-connected-idle" : -+ ((coex_dm->bt_status == BT_8821C_2ANT_BSTATUS_CON_IDLE) -+ ? "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%s (multilink = %d)", -+ "Profiles", ((bt_link_info->a2dp_exist) ? -+ ((coex_sta->is_bt_a2dp_sink) ? "A2DP sink," : -+ "A2DP,") : ""), -+ ((bt_link_info->sco_exist) ? "HFP," : ""), -+ ((bt_link_info->hid_exist) ? -+ ((coex_sta->is_hid_rcu) ? "HID(RCU)" : -+ ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : -+ (coex_sta->bt_ble_hid_exist ? "HID(BLE)" : -+ "HID(2/18),"))) : ""), ((bt_link_info->pan_exist) ? -+ ((coex_sta->is_bt_opp_exist) ? "OPP," : "PAN,") : -+ ""), ((coex_sta->voice_over_HOGP) ? "Voice," : ""), -+ ((coex_sta->msft_mr_exist) ? "MR" : ""), -+ coex_sta->is_bt_multi_link); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Profiles", -+ (coex_sta->msft_mr_exist) ? "MR" : "None"); -+ -+ CL_PRINTF(cli_buf); -+ -+ if (bt_link_info->a2dp_exist) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s/ %d/ 0x%x/ 0x%x/ %d", -+ "CQDDR/Bitpool/V_ID/D_name/Flush", -+ ((coex_sta->is_A2DP_3M) ? "On" : "Off"), -+ coex_sta->a2dp_bit_pool, -+ coex_sta->bt_a2dp_vendor_id, -+ coex_sta->bt_a2dp_device_name, -+ coex_sta->bt_a2dp_flush_time); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (bt_link_info->hid_exist) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "HID PairNum", -+ coex_sta->hid_pair_cnt); -+ 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_role_switch, -+ ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), -+ coex_sta->bt_coex_supported_feature); -+ CL_PRINTF(cli_buf); -+ -+ if (coex_sta->is_ble_scan_en) { -+ 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 %s", -+ "ReInit/ReLink/IgnWlact/Page/NameReq", coex_sta->cnt_reinit, -+ coex_sta->cnt_setup_link, coex_sta->cnt_ign_wlan_act, -+ coex_sta->cnt_page, coex_sta->cnt_remote_name_req, -+ (coex_sta->is_setup_link ? "(Relink!!)" : "")); -+ CL_PRINTF(cli_buf); -+ -+ halbtc8821c2ant_read_scbd(btc, &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/ 0x%04x", -+ "0xae[4]/0xac[1:0]/ScBd(B->W)", u16tmp[0]); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%04x", -+ "0xae[4]/0xac[1:0]/ScBd(B->W)", -+ (int)((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_8821C_2ANT_INFO_SRC_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); -+ } -+ } -+ -+ /* Sw mechanism */ -+ if (btc->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, Timer:%d)", -+ "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_sta->tdma_timer_base); -+ CL_PRINTF(cli_buf); -+ -+ switch (coex_sta->wl_coex_mode) { -+ case BT_8821C_2ANT_WLINK_2G1PORT: -+ default: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "2G-SP"); -+ break; -+ case BT_8821C_2ANT_WLINK_2GMPORT: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "2G-MP"); -+ break; -+ case BT_8821C_2ANT_WLINK_25GMPORT: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "25G-MP"); -+ break; -+ case BT_8821C_2ANT_WLINK_5G: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "5G"); -+ break; -+ case BT_8821C_2ANT_WLINK_2GGO: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "2G-P2P"); -+ break; -+ case BT_8821C_2ANT_WLINK_BTMR: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", "Coex_Mode", "BT-MR"); -+ break; -+ } -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btc->btc_read_4byte(btc, 0x6c0); -+ u32tmp[1] = btc->btc_read_4byte(btc, 0x6c4); -+ u32tmp[2] = btc->btc_read_4byte(btc, 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] = btc->btc_read_1byte(btc, 0x778); -+ u32tmp[0] = btc->btc_read_4byte(btc, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%04x/ %d/ %d", -+ "0x778/0x6cc/ScBd(W->B)/RunCnt/Rsn", u8tmp[0], u32tmp[0], -+ coex_sta->score_board_WB, coex_sta->coex_run_cnt, -+ coex_sta->coex_run_reason); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d/ %d", -+ "AntDiv/BtCtrlLPS/LPRA/PsFail/g_busy", -+ ((board_info->ant_div_cfg) ? -+ ((coex_dm->cur_antdiv_type) ? "On(Hw)" : "On(Sw)") : "Off"), -+ ((coex_sta->force_lps_ctrl) ? "On" : "Off"), -+ ((coex_dm->cur_low_penalty_ra) ? "On" : "Off"), -+ coex_sta->cnt_set_ps_state_fail, -+ coex_sta->gl_wifi_busy); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "WL_Pwr/ BT_Pwr", coex_dm->cur_wl_pwr_lvl, -+ coex_dm->cur_bt_pwr_lvl); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", -+ "Null All/Retry/Ack/BT_Empty/BT_Late", -+ coex_sta->wl_fw_dbg_info[1], -+ coex_sta->wl_fw_dbg_info[2], -+ coex_sta->wl_fw_dbg_info[3], -+ coex_sta->wl_fw_dbg_info[4], -+ coex_sta->wl_fw_dbg_info[5]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s/ %d", -+ "cnt TDMA_Togg/LK5ms/LK5ms_off/fw", -+ coex_sta->wl_fw_dbg_info[6], coex_sta->wl_fw_dbg_info[7], -+ ((coex_sta->is_no_wl_5ms_extend) ? "Yes" : "No"), -+ coex_sta->cnt_wl_fw_notify); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8821c2ant_read_indirect_reg(btc, 0x38); -+ lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? TRUE : FALSE; -+ -+ if (lte_coex_on) { -+ u32tmp[0] = halbtc8821c2ant_read_indirect_reg(btc, 0xa0); -+ u32tmp[1] = halbtc8821c2ant_read_indirect_reg(btc, 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_read_indirect_reg(btc, 0xa8); -+ u32tmp[1] = halbtc8821c2ant_read_indirect_reg(btc, 0xac); -+ u32tmp[2] = halbtc8821c2ant_read_indirect_reg(btc, 0xb0); -+ u32tmp[3] = halbtc8821c2ant_read_indirect_reg(btc, 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] = halbtc8821c2ant_read_indirect_reg(btc, 0x38); -+ u32tmp[1] = halbtc8821c2ant_read_indirect_reg(btc, 0x54); -+ u8tmp[0] = btc->btc_read_1byte(btc, 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 (gnt_err = %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/ 0x%x", -+ "GNT_WL/GNT_BT/ RF_0x1", -+ (int)((u32tmp[1] & BIT(2)) >> 2), -+ (int)((u32tmp[1] & BIT(3)) >> 3), -+ btc->btc_get_rf_reg(btc, BTC_RF_A, 0x1, 0xfffff)); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btc->btc_read_4byte(btc, 0xcb0); -+ u32tmp[1] = btc->btc_read_4byte(btc, 0xcb4); -+ u8tmp[0] = btc->btc_read_1byte(btc, 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] & 0x1) == 0x1 ? "(BTG)" : "(WL_A+G)")); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btc->btc_read_4byte(btc, 0x430); -+ u32tmp[1] = btc->btc_read_4byte(btc, 0x434); -+ u16tmp[0] = btc->btc_read_2byte(btc, 0x42a); -+ u8tmp[0] = btc->btc_read_1byte(btc, 0x426); -+ u8tmp[1] = btc->btc_read_1byte(btc, 0x45e); -+ u8tmp[2] = btc->btc_read_1byte(btc, 0x455); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "430/434/42a/426/45e[3]/455", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0], -+ (int)((u8tmp[1] & BIT(3)) >> 3), u8tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btc->btc_read_4byte(btc, 0x4c); -+ u8tmp[2] = btc->btc_read_1byte(btc, 0x64); -+ u8tmp[0] = btc->btc_read_1byte(btc, 0x4c6); -+ u8tmp[1] = btc->btc_read_1byte(btc, 0x40); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "4c[24:23]/64[0]/4c6[4]/40[5]", -+ (int)(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] = btc->btc_read_4byte(btc, 0x550); -+ u8tmp[0] = btc->btc_read_1byte(btc, 0x522); -+ u8tmp[1] = btc->btc_read_1byte(btc, 0x953); -+ u8tmp[2] = btc->btc_read_1byte(btc, 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); -+ -+ fa_ofdm = btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_FA_OFDM); -+ fa_cck = btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_FA_CCK); -+ cca_ofdm = btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CCA_OFDM); -+ cca_cck = btc->btc_phydm_query_PHY_counter(btc, 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); -+ -+ 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_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/11ac", -+ 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); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %s-%d/ %d (Tx macid: %d)", -+ "Rate RxD/RxRTS/TxD/TxRetry_ratio", -+ coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate, -+ (coex_sta->wl_tx_rate & 0x80 ? "SGI" : "LGI"), -+ coex_sta->wl_tx_rate & 0x7f, -+ coex_sta->wl_tx_retry_ratio, -+ coex_sta->wl_tx_macid); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %s/ %d", -+ "HiPr/ Locking/ warn/ Locked/ Noisy", -+ (coex_sta->wifi_high_pri_task1 ? "Yes" : "No"), -+ (coex_sta->cck_lock ? "Yes" : "No"), -+ (coex_sta->cck_lock_warn ? "Yes" : "No"), -+ (coex_sta->cck_lock_ever ? "Yes" : "No"), -+ coex_sta->wl_noisy_level); -+ 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 %s", -+ "0x774(Lo-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx, -+ (bt_link_info->slave_role ? "(Slave!!)" : " ")); -+ CL_PRINTF(cli_buf); -+ -+ btc->btc_disp_dbg_msg(btc, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+void ex_halbtc8821c2ant_ips_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (type == BTC_IPS_ENTER) { -+ 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_write_scbd(btc, BT_8821C_2ANT_SCBD_ACTIVE | -+ BT_8821C_2ANT_SCBD_ONOFF | -+ BT_8821C_2ANT_SCBD_SCAN | -+ BT_8821C_2ANT_SCBD_UNDERTEST, -+ FALSE); -+ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_2ANT_PHASE_WOFF); -+ -+ halbtc8821c2ant_action_coex_all_off(btc); -+ } else if (type == BTC_IPS_LEAVE) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = FALSE; -+ -+ halbtc8821c2ant_init_hw_config(btc, FALSE); -+ halbtc8821c2ant_init_coex_dm(btc); -+ halbtc8821c2ant_query_bt_info(btc); -+ } -+} -+ -+void ex_halbtc8821c2ant_lps_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (type == BTC_LPS_ENABLE) { -+ 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_ctrl == TRUE) { /* LPS No-32K */ -+ /* Write WL "Active" in Score-board for PS-TDMA */ -+ halbtc8821c2ant_write_scbd(btc, -+ BT_8821C_2ANT_SCBD_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 */ -+ halbtc8821c2ant_write_scbd(btc, -+ BT_8821C_2ANT_SCBD_ACTIVE, -+ FALSE); -+ -+ halbtc8821c2ant_action_wifi_native_lps(btc); -+ } -+ -+ } else if (type == BTC_LPS_DISABLE) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = FALSE; -+ -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_ACTIVE, -+ TRUE); -+ -+ if (!coex_sta->force_lps_ctrl) { -+ halbtc8821c2ant_query_bt_info(btc); -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_LPS); -+ } -+ } -+} -+ -+void ex_halbtc8821c2ant_scan_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ boolean wifi_connected = FALSE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN notify()\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); -+ -+ if (wifi_connected) -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** WL connected before SCAN\n"); -+ else -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** WL is not connected before SCAN\n"); -+ -+ BTC_TRACE(trace_buf); -+ -+ /* this can't be removed for RF off_on event, -+ * r BT would dis-connect -+ */ -+ if (type != BTC_SCAN_FINISH) { -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_ACTIVE | -+ BT_8821C_2ANT_SCBD_SCAN | -+ BT_8821C_2ANT_SCBD_ONOFF, TRUE); -+ } -+ -+ if (type == BTC_SCAN_START_5G) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify (5G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, -+ FC_EXCU, BT_8821C_2ANT_PHASE_5G); -+ -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_5GSCANSTART); -+ } else if (type == BTC_SCAN_START_2G || type == BTC_SCAN_START) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (!wifi_connected) -+ coex_sta->wifi_high_pri_task2 = TRUE; -+ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_2ANT_PHASE_2G); -+ -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_2GSCANSTART); -+ } else if (type == BTC_SCAN_FINISH) { -+ btc->btc_get(btc, 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); -+ -+ coex_sta->wifi_high_pri_task2 = FALSE; -+ -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_SCANFINISH); -+ } -+} -+ -+void ex_halbtc8821c2ant_switchband_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ coex_sta->switch_band_notify_to = type; -+ -+ 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_run_coex(btc, BT_8821C_2ANT_RSN_5GSWITCHBAND); -+ } 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); -+ -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_2GSWITCHBAND); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], switchband_notify --- switch to 2G\n"); -+ BTC_TRACE(trace_buf); -+ -+ ex_halbtc8821c2ant_scan_notify(btc, BTC_SCAN_START_2G); -+ } -+ -+ coex_sta->switch_band_notify_to = BTC_NOT_SWITCH; -+} -+ -+void ex_halbtc8821c2ant_connect_notify(struct btc_coexist *btc, -+ u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_ACTIVE | -+ BT_8821C_2ANT_SCBD_SCAN | -+ BT_8821C_2ANT_SCBD_ONOFF, TRUE); -+ -+ if (type == BTC_ASSOCIATE_5G_START || -+ type == BTC_ASSOCIATE_5G_FINISH) { -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_2ANT_PHASE_5G); -+ -+ if (type == BTC_ASSOCIATE_5G_START) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify (5G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_run_coex(btc, -+ BT_8821C_2ANT_RSN_5GCONSTART); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify (5G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_run_coex(btc, -+ BT_8821C_2ANT_RSN_5GCONFINISH); -+ } -+ } else if (type == BTC_ASSOCIATE_START) { -+ coex_sta->wifi_high_pri_task1 = TRUE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_2ANT_PHASE_2G); -+ -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_2GCONSTART); -+ -+ /* 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 (type == BTC_ASSOCIATE_FINISH) { -+ coex_sta->wifi_high_pri_task1 = FALSE; -+ coex_sta->freeze_coexrun_by_btinfo = FALSE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_2GCONFINISH); -+ } -+} -+ -+void ex_halbtc8821c2ant_media_status_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ boolean wifi_under_b_mode = FALSE; -+ u8 h2c_parameter[2] = {0}; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (type == BTC_MEDIA_CONNECT || type == BTC_MEDIA_CONNECT_5G) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_ACTIVE | -+ BT_8821C_2ANT_SCBD_ONOFF, TRUE); -+ -+ if (type == BTC_MEDIA_CONNECT_5G) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, -+ FC_EXCU, -+ BT_8821C_2ANT_PHASE_5G); -+ -+ halbtc8821c2ant_run_coex(btc, -+ BT_8821C_2ANT_RSN_5GMEDIA); -+ } else { -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, -+ FC_EXCU, -+ BT_8821C_2ANT_PHASE_2G); -+ -+ btc->btc_get(btc, 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->btc_write_1byte_bitmask(btc, 0x6cf, BIT(4), -+ 0x0); -+ else -+ btc->btc_write_1byte_bitmask(btc, 0x6cf, BIT(4), -+ 0x1); -+ -+ /*Leak-AP protection will reopen when connecting AP*/ -+ h2c_parameter[0] = 0xc; -+ h2c_parameter[1] = 0x0; -+ btc->btc_fill_h2c(btc, 0x69, 2, h2c_parameter); -+ coex_sta->is_no_wl_5ms_extend = FALSE; -+ -+ halbtc8821c2ant_run_coex(btc, -+ BT_8821C_2ANT_RSN_2GMEDIA); -+ } -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ btc->btc_write_1byte_bitmask(btc, 0x6cf, BIT(4), 0x0); -+ -+ coex_sta->cck_lock_ever = FALSE; -+ coex_sta->cck_lock_warn = FALSE; -+ coex_sta->cck_lock = FALSE; -+ -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_MEDIADISCON); -+ } -+ btc->btc_get(btc, BTC_GET_U1_IOT_PEER, &coex_sta->wl_iot_peer); -+ halbtc8821c2ant_update_wifi_ch_info(btc, type); -+} -+ -+void ex_halbtc8821c2ant_specific_packet_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct coex_dm_8821c_2ant *coex_dm = &btc->coex_dm_8821c_2ant; -+ boolean under_4way = FALSE; -+ -+ if (btc->manual_control || btc->stop_coex_dm) -+ return; -+ -+ if (type & BTC_5G_BAND) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 5g special packet notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_5GSPECIALPKT); -+ return; -+ } -+ -+ btc->btc_get(btc, 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_high_pri_task1 = TRUE; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } else if (type == BTC_PACKET_ARP) { -+ 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_high_pri_task1 = TRUE; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } -+ -+ if (coex_sta->wifi_high_pri_task1) { -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_SCAN, TRUE); -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_2GSPECIALPKT); -+ } -+} -+ -+void ex_halbtc8821c2ant_bt_info_notify(struct btc_coexist *btc, u8 *tmp_buf, -+ u8 length) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct btc_bt_link_info *bt_link_info = &btc->bt_link_info; -+ u8 i, rsp_source = 0; -+ boolean wifi_connected = FALSE; -+ boolean wifi_busy = FALSE; -+ static boolean is_scoreboard_scan; -+ const u16 type_is_scan = BT_8821C_2ANT_SCBD_SCAN; -+ u8 type; -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_8821C_2ANT_INFO_SRC_MAX) -+ rsp_source = BT_8821C_2ANT_INFO_SRC_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ if (rsp_source == BT_8821C_2ANT_INFO_SRC_BT_RSP || -+ rsp_source == BT_8821C_2ANT_INFO_SRC_BT_ACT) { -+ if (coex_sta->bt_disabled) { -+ coex_sta->bt_disabled = FALSE; -+ coex_sta->is_bt_reenable = TRUE; -+ coex_sta->cnt_bt_reenable = 15; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT enable detected by bt_info\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (rsp_source == BT_8821C_2ANT_INFO_SRC_WIFI_FW) { -+#if 0 -+ halbtc8821c2ant_update_bt_link_info(btc); -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_BTINFO); -+#endif -+ return; -+ } -+ -+ if (length != 7) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt_info length = %d invalid!!\n", -+ length); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt_info[%d], len=%d, data=[%02x %02x %02x %02x %02x %02x]\n", -+ tmp_buf[0], length, tmp_buf[1], tmp_buf[2], tmp_buf[3], -+ tmp_buf[4], tmp_buf[5], tmp_buf[6]); -+ BTC_TRACE(trace_buf); -+ -+ for (i = 0; i < 7; i++) -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][1] == coex_sta->bt_info_lb2 && -+ coex_sta->bt_info_c2h[rsp_source][2] == coex_sta->bt_info_lb3 && -+ coex_sta->bt_info_c2h[rsp_source][3] == coex_sta->bt_info_hb0 && -+ coex_sta->bt_info_c2h[rsp_source][4] == coex_sta->bt_info_hb1 && -+ coex_sta->bt_info_c2h[rsp_source][5] == coex_sta->bt_info_hb2 && -+ coex_sta->bt_info_c2h[rsp_source][6] == coex_sta->bt_info_hb3) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Return because Btinfo duplicate!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ coex_sta->bt_info_lb2 = coex_sta->bt_info_c2h[rsp_source][1]; -+ coex_sta->bt_info_lb3 = coex_sta->bt_info_c2h[rsp_source][2]; -+ coex_sta->bt_info_hb0 = coex_sta->bt_info_c2h[rsp_source][3]; -+ coex_sta->bt_info_hb1 = coex_sta->bt_info_c2h[rsp_source][4]; -+ coex_sta->bt_info_hb2 = coex_sta->bt_info_c2h[rsp_source][5]; -+ coex_sta->bt_info_hb3 = coex_sta->bt_info_c2h[rsp_source][6]; -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ coex_sta->bt_whck_test = -+ ((coex_sta->bt_info_lb2 == 0xff) ? TRUE : FALSE); -+ -+ coex_sta->bt_create_connection = -+ ((coex_sta->bt_info_lb3 & BIT(7)) ? TRUE : FALSE); -+ -+ /* unit: %, value-100 to translate to unit: dBm */ -+ coex_sta->bt_rssi = coex_sta->bt_info_hb0 * 2 + 10; -+ -+ coex_sta->c2h_bt_remote_name_req = -+ ((coex_sta->bt_info_lb3 & BIT(5)) ? TRUE : FALSE); -+ -+ coex_sta->is_A2DP_3M = -+ ((coex_sta->bt_info_lb3 & BIT(4)) ? TRUE : FALSE); -+ -+ coex_sta->acl_busy = -+ ((coex_sta->bt_info_lb2 & BIT(3)) ? TRUE : FALSE); -+ -+ coex_sta->voice_over_HOGP = -+ ((coex_sta->bt_info_hb1 & BIT(4)) ? TRUE : FALSE); -+ -+ coex_sta->c2h_bt_inquiry_page = -+ ((coex_sta->bt_info_lb2 & BIT(2)) ? TRUE : FALSE); -+ -+ if (coex_sta->bt_inq_page_pre != coex_sta->c2h_bt_inquiry_page) { -+ coex_sta->bt_inq_page_pre = coex_sta->c2h_bt_inquiry_page; -+ coex_sta->bt_inq_page_remain = TRUE; -+ -+ if (!coex_sta->c2h_bt_inquiry_page) -+ coex_sta->bt_inq_page_downcount = 2; -+ } -+ -+ if ((coex_sta->bt_info_lb2 & 0x49) == 0x49) -+ coex_sta->a2dp_bit_pool = (coex_sta->bt_info_hb3 & 0x7f); -+ else -+ coex_sta->a2dp_bit_pool = 0; -+ -+ coex_sta->is_bt_a2dp_sink = -+ (coex_sta->bt_info_hb3 & BIT(7)) ? TRUE : FALSE; -+ -+ coex_sta->bt_retry_cnt = coex_sta->bt_info_lb3 & 0xf; -+ -+ bt_link_info->slave_role = coex_sta->bt_info_hb2 & 0x8; -+ -+ coex_sta->bt_a2dp_active = coex_sta->bt_info_hb2 & 0x4; -+ -+ coex_sta->hid_busy_num = (coex_sta->bt_info_hb2 & 0x30) >> 4; -+ -+ coex_sta->hid_pair_cnt = (coex_sta->bt_info_hb2 & 0xc0) >> 6; -+ -+ if (coex_sta->hid_pair_cnt > 0 && coex_sta->hid_busy_num >= 2) { -+ coex_sta->bt_418_hid_exist = TRUE; -+ } else if (coex_sta->hid_pair_cnt == 0 || -+ coex_sta->hid_busy_num == 1) { -+ coex_sta->bt_418_hid_exist = FALSE; -+ coex_sta->bt_ble_hid_exist = FALSE; -+ } -+ -+ coex_sta->is_bt_opp_exist = -+ (coex_sta->bt_info_hb2 & BIT(0)) ? TRUE : FALSE; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->c2h_bt_remote_name_req) -+ coex_sta->cnt_remote_name_req++; -+ -+ if (coex_sta->bt_info_hb1 & BIT(1)) -+ coex_sta->cnt_reinit++; -+ -+ if ((coex_sta->bt_info_hb1 & BIT(2)) || -+ (coex_sta->bt_create_connection && -+ coex_sta->wl_pnp_wakeup_downcnt > 0)) { -+ coex_sta->cnt_setup_link++; -+ coex_sta->is_setup_link = TRUE; -+ -+ if (coex_sta->is_bt_reenable) -+ coex_sta->bt_relink_downcount = 6; -+ else -+ coex_sta->bt_relink_downcount = 2; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Re-Link start in BT info!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (coex_sta->bt_info_hb1 & BIT(3)) -+ coex_sta->cnt_ign_wlan_act++; -+ -+ if (coex_sta->bt_info_hb1 & BIT(6)) -+ coex_sta->cnt_role_switch++; -+ -+ if (coex_sta->bt_info_hb1 & BIT(7)) -+ coex_sta->is_bt_multi_link = TRUE; -+ else -+ coex_sta->is_bt_multi_link = FALSE; -+ -+ if (coex_sta->bt_info_lb2 & BIT(5)) { -+ if (coex_sta->bt_info_hb1 & BIT(0)) { -+ /*BLE HID*/ -+ coex_sta->bt_ble_hid_exist = TRUE; -+ coex_sta->is_hid_rcu = FALSE; -+ } -+ } else if (coex_sta->bt_info_hb1 & BIT(0)) { -+ /*RCU*/ -+ coex_sta->is_hid_rcu = TRUE; -+ } else { -+ coex_sta->bt_ble_hid_exist = FALSE; -+ coex_sta->is_hid_rcu = FALSE; -+ } -+ -+ if (coex_sta->bt_info_hb1 & BIT(5)) -+ coex_sta->is_ble_scan_en = TRUE; -+ else -+ coex_sta->is_ble_scan_en = FALSE; -+ -+ if (coex_sta->bt_create_connection) { -+ coex_sta->cnt_page++; -+ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (coex_sta->is_wifi_linkscan_process || -+ coex_sta->wifi_high_pri_task1 || -+ coex_sta->wifi_high_pri_task2 || wifi_busy) { -+ is_scoreboard_scan = TRUE; -+ halbtc8821c2ant_write_scbd(btc, type_is_scan, TRUE); -+ } else { -+ halbtc8821c2ant_write_scbd(btc, type_is_scan, FALSE); -+ } -+ } else { -+ if (is_scoreboard_scan) { -+ halbtc8821c2ant_write_scbd(btc, type_is_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. */ -+ btc->btc_get(btc, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); -+ /* Re-Init */ -+ if ((coex_sta->bt_info_hb1 & 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) -+ type = BTC_MEDIA_CONNECT; -+ else -+ type = BTC_MEDIA_DISCONNECT; -+ halbtc8821c2ant_update_wifi_ch_info(btc, type); -+ } -+ -+ /* If Ignore_WLanAct && not SetUp_Link */ -+ if ((coex_sta->bt_info_hb1 & BIT(3)) && -+ (!(coex_sta->bt_info_hb1 & 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(btc, FC_EXCU, FALSE); -+ } -+ -+ halbtc8821c2ant_update_bt_link_info(btc); -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_BTINFO); -+} -+ -+void ex_halbtc8821c2ant_wl_fwdbginfo_notify(struct btc_coexist *btc, -+ u8 *tmp_buf, u8 length) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ u8 i = 0; -+ static u8 tmp_buf_pre[10]; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi Fw Dbg info = %d %d %d %d %d %d %d %d (len = %d)\n", -+ tmp_buf[0], tmp_buf[1], tmp_buf[2], tmp_buf[3], tmp_buf[4], -+ tmp_buf[5], tmp_buf[6], tmp_buf[7], length); -+ BTC_TRACE(trace_buf); -+ -+ if (tmp_buf[0] == 0x8) { -+ for (i = 1; i <= 7; i++) { -+ coex_sta->wl_fw_dbg_info[i] = -+ (tmp_buf[i] >= tmp_buf_pre[i]) ? -+ (tmp_buf[i] - tmp_buf_pre[i]) : -+ (255 - tmp_buf_pre[i] + tmp_buf[i]); -+ -+ tmp_buf_pre[i] = tmp_buf[i]; -+ } -+ } -+ -+ coex_sta->cnt_wl_fw_notify++; -+ halbtc8821c2ant_ccklock_action(btc); -+} -+ -+void ex_halbtc8821c2ant_rx_rate_change_notify(struct btc_coexist *btc, -+ BOOLEAN is_data_frame, -+ u8 btc_rate_id) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ -+ if (is_data_frame) { -+ coex_sta->wl_rx_rate = btc_rate_id; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], rx_rate_change_notify data rate id = %d, RTS_Rate = %d\n", -+ coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_sta->wl_rts_rx_rate = btc_rate_id; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], rts_rate_change_notify RTS rate id = %d, RTS_Rate = %d\n", -+ coex_sta->wl_rts_rx_rate, coex_sta->wl_rts_rx_rate); -+ BTC_TRACE(trace_buf); -+ } -+ -+ halbtc8821c2ant_ccklock_detect(btc); -+} -+ -+void ex_halbtc8821c2ant_tx_rate_change_notify(struct btc_coexist *btc, -+ u8 tx_rate, u8 tx_retry_ratio, -+ u8 macid) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], tx_rate_change_notify Tx_Rate = %d, Tx_Retry_Ratio = %d, macid =%d\n", -+ tx_rate, tx_retry_ratio, macid); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_tx_rate = tx_rate; -+ coex_sta->wl_tx_retry_ratio = tx_retry_ratio; -+ coex_sta->wl_tx_macid = macid; -+} -+ -+void ex_halbtc8821c2ant_rf_status_notify(struct btc_coexist *btc, u8 type) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (type == BTC_RF_ON) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btc->stop_coex_dm = FALSE; -+ btc->wl_rf_state_off = FALSE; -+ } else if (type == BTC_RF_OFF) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_ACTIVE | -+ BT_8821C_2ANT_SCBD_ONOFF | -+ BT_8821C_2ANT_SCBD_SCAN | -+ BT_8821C_2ANT_SCBD_UNDERTEST, -+ FALSE); -+ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_2ANT_PHASE_WOFF); -+ -+ halbtc8821c2ant_action_coex_all_off(btc); -+ -+ btc->stop_coex_dm = TRUE; -+ btc->wl_rf_state_off = TRUE; -+ /* must place in the last step */ -+ halbtc8821c2ant_update_wifi_ch_info(btc, BTC_MEDIA_DISCONNECT); -+ } -+} -+ -+void ex_halbtc8821c2ant_halt_notify(struct btc_coexist *btc) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_write_scbd(btc, BT_8821C_2ANT_SCBD_ACTIVE | -+ BT_8821C_2ANT_SCBD_ONOFF | -+ BT_8821C_2ANT_SCBD_SCAN | -+ BT_8821C_2ANT_SCBD_UNDERTEST, -+ FALSE); -+ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ BT_8821C_2ANT_PHASE_WOFF); -+ -+ halbtc8821c2ant_action_coex_all_off(btc); -+ -+ btc->stop_coex_dm = TRUE; -+ -+ /* must place in the last step */ -+ halbtc8821c2ant_update_wifi_ch_info(btc, BTC_MEDIA_DISCONNECT); -+} -+ -+void ex_halbtc8821c2ant_pnp_notify(struct btc_coexist *btc, u8 pnp_state) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct wifi_link_info_8821c_2ant *wifi_link_info_ext = -+ &btc->wifi_link_info_8821c_2ant; -+ static u8 pre_pnp_state; -+ u8 phase; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (pnp_state == BTC_WIFI_PNP_SLEEP || -+ pnp_state == BTC_WIFI_PNP_SLEEP_KEEP_ANT) { -+ 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_write_scbd(btc, BT_8821C_2ANT_SCBD_ACTIVE | -+ BT_8821C_2ANT_SCBD_ONOFF | -+ BT_8821C_2ANT_SCBD_SCAN | -+ BT_8821C_2ANT_SCBD_UNDERTEST, -+ FALSE); -+ -+ if (pnp_state == BTC_WIFI_PNP_SLEEP_KEEP_ANT) { -+ if (wifi_link_info_ext->is_all_under_5g) -+ phase = BT_8821C_2ANT_PHASE_5G; -+ else -+ phase = BT_8821C_2ANT_PHASE_2G; -+ } else { -+ phase = BT_8821C_2ANT_PHASE_WOFF; -+ } -+ -+ halbtc8821c2ant_set_ant_path(btc, BTC_ANT_PATH_AUTO, FC_EXCU, -+ phase); -+ btc->stop_coex_dm = TRUE; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->wl_pnp_wakeup_downcnt = 3; -+ -+ /*WoWLAN*/ -+ if (pre_pnp_state == BTC_WIFI_PNP_SLEEP_KEEP_ANT || -+ pnp_state == BTC_WIFI_PNP_WOWLAN) { -+ coex_sta->run_time_state = TRUE; -+ btc->stop_coex_dm = FALSE; -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_PNP); -+ } -+ } -+ -+ pre_pnp_state = pnp_state; -+} -+ -+void ex_halbtc8821c2ant_periodical(struct btc_coexist *btc) -+{ -+ struct coex_sta_8821c_2ant *coex_sta = &btc->coex_sta_8821c_2ant; -+ struct btc_board_info *board_info = &btc->board_info; -+ boolean bt_relink_finish = FALSE, is_defreeze = FALSE, -+ bt_ctr_change = FALSE; -+ static u8 freeze_cnt; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ************* Periodical *************\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (!btc->auto_report) -+ halbtc8821c2ant_query_bt_info(btc); -+ -+ bt_ctr_change = halbtc8821c2ant_monitor_bt_ctr(btc); -+ halbtc8821c2ant_monitor_wifi_ctr(btc); -+ halbtc8821c2ant_update_wifi_link_info(btc, -+ BT_8821C_2ANT_RSN_PERIODICAL); -+ halbtc8821c2ant_monitor_bt_enable(btc); -+ -+ if (coex_sta->bt_relink_downcount != 0) { -+ coex_sta->bt_relink_downcount--; -+ if (coex_sta->bt_relink_downcount == 0) { -+ coex_sta->is_setup_link = FALSE; -+ bt_relink_finish = TRUE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Re-Link stop by periodical count-down!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (coex_sta->bt_inq_page_downcount != 0) { -+ coex_sta->bt_inq_page_downcount--; -+ if (coex_sta->bt_inq_page_downcount == 0) -+ coex_sta->bt_inq_page_remain = FALSE; -+ } -+ -+ if (coex_sta->freeze_coexrun_by_btinfo) { -+ freeze_cnt++; -+ -+ if (freeze_cnt >= 5) { -+ freeze_cnt = 0; -+ coex_sta->freeze_coexrun_by_btinfo = FALSE; -+ is_defreeze = TRUE; -+ } -+ } else { -+ freeze_cnt = 0; -+ } -+ -+ /* for 4-way, DHCP, EAPOL packet */ -+ if (coex_sta->specific_pkt_period_cnt > 0) { -+ coex_sta->specific_pkt_period_cnt--; -+ -+ if (!coex_sta->freeze_coexrun_by_btinfo && -+ coex_sta->specific_pkt_period_cnt == 0) -+ coex_sta->wifi_high_pri_task1 = FALSE; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Hi-Pri Task = %s\n", -+ (coex_sta->wifi_high_pri_task1 ? "Yes" : "No")); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (coex_sta->wl_pnp_wakeup_downcnt > 0) { -+ coex_sta->wl_pnp_wakeup_downcnt--; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wl_pnp_wakeup_downcnt = %d!!\n", -+ coex_sta->wl_pnp_wakeup_downcnt); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (coex_sta->cnt_bt_reenable > 0) { -+ coex_sta->cnt_bt_reenable--; -+ if (coex_sta->cnt_bt_reenable == 0) { -+ coex_sta->is_bt_reenable = FALSE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT renable 30s finish!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (halbtc8821c2ant_moniter_wifibt_status(btc) || bt_relink_finish || -+ coex_sta->is_set_ps_state_fail || is_defreeze || bt_ctr_change) -+ halbtc8821c2ant_run_coex(btc, BT_8821C_2ANT_RSN_PERIODICAL); -+} -+/*#pragma optimize( "", off )*/ -+ -+#endif -+ -+#endif /* #if (RTL8821C_SUPPORT == 1) */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c2ant.h b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c2ant.h -new file mode 100644 -index 000000000..9e79d45d8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821c2ant.h -@@ -0,0 +1,516 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821C_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8821C 2Ant BT Co-exist definition -+ * ******************************************* */ -+#define BT_8821C_2ANT_COEX_DBG 0 -+#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 -+#define BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1 80 -+#define BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES2 80 -+#define BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES2 80 -+#define BT_8821C_2ANT_DEFAULT_ISOLATION 15 -+#define BT_8821C_2ANT_WIFI_MAX_TX_POWER 15 -+#define BT_8821C_2ANT_BT_MAX_TX_POWER 3 -+#define BT_8821C_2ANT_WIFI_SIR_THRES1 -15 -+#define BT_8821C_2ANT_WIFI_SIR_THRES2 -30 -+#define BT_8821C_2ANT_BT_SIR_THRES1 -15 -+#define BT_8821C_2ANT_BT_SIR_THRES2 -30 -+ -+enum bt_8821c_2ant_signal_state { -+ BT_8821C_2ANT_GNT_SET_TO_LOW = 0x0, -+ BT_8821C_2ANT_GNT_SET_TO_HIGH = 0x1, -+ BT_8821C_2ANT_GNT_SET_BY_HW = 0x2, -+ BT_8821C_2ANT_GNT_SET_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_8821C_2ANT_INFO_SRC_WIFI_FW = 0x0, -+ BT_8821C_2ANT_INFO_SRC_BT_RSP = 0x1, -+ BT_8821C_2ANT_INFO_SRC_BT_ACT = 0x2, -+ BT_8821C_2ANT_INFO_SRC_MAX -+}; -+ -+enum bt_8821c_2ant_bt_status { -+ BT_8821C_2ANT_BSTATUS_NCON_IDLE = 0x0, -+ BT_8821C_2ANT_BSTATUS_CON_IDLE = 0x1, -+ BT_8821C_2ANT_BSTATUS_INQ_PAGE = 0x2, -+ BT_8821C_2ANT_BSTATUS_ACL_BUSY = 0x3, -+ BT_8821C_2ANT_BSTATUS_SCO_BUSY = 0x4, -+ BT_8821C_2ANT_BSTATUS_ACL_SCO_BUSY = 0x5, -+ BT_8821C_2ANT_BSTATUS_MAX -+}; -+ -+enum bt_8821c_2ant_coex_algo { -+ BT_8821C_2ANT_COEX_UNDEFINED = 0x0, -+ BT_8821C_2ANT_COEX_SCO = 0x1, -+ BT_8821C_2ANT_COEX_HID = 0x2, -+ BT_8821C_2ANT_COEX_A2DP = 0x3, -+ BT_8821C_2ANT_COEX_A2DP_PANHS = 0x4, -+ BT_8821C_2ANT_COEX_PAN = 0x5, -+ BT_8821C_2ANT_COEX_PANHS = 0x6, -+ BT_8821C_2ANT_COEX_PAN_A2DP = 0x7, -+ BT_8821C_2ANT_COEX_PAN_HID = 0x8, -+ BT_8821C_2ANT_COEX_HID_A2DP_PAN = 0x9, -+ BT_8821C_2ANT_COEX_HID_A2DP = 0xa, -+ BT_8821C_2ANT_COEX_NOPROFILEBUSY = 0xb, -+ BT_8821C_2ANT_COEX_A2DPSINK = 0xc, -+ BT_8821C_2ANT_COEX_MAX -+}; -+ -+enum bt_8821c_2ant_ext_ant_switch_type { -+ BT_8821C_2ANT_USE_DPDT = 0x0, -+ BT_8821C_2ANT_USE_SPDT = 0x1, -+ BT_8821C_2ANT_SWITCH_NONE = 0x2, -+ BT_8821C_2ANT_SWITCH_MAX -+}; -+ -+enum bt_8821c_2ant_ext_ant_switch_ctrl_type { -+ BT_8821C_2ANT_CTRL_BY_BBSW = 0x0, -+ BT_8821C_2ANT_CTRL_BY_PTA = 0x1, -+ BT_8821C_2ANT_CTRL_BY_ANTDIV = 0x2, -+ BT_8821C_2ANT_CTRL_BY_MAC = 0x3, -+ BT_8821C_2ANT_CTRL_BY_BT = 0x4, -+ BT_8821C_2ANT_CTRL_BY_FW = 0x5, -+ BT_8821C_2ANT_CTRL_MAX -+}; -+ -+enum bt_8821c_2ant_ext_ant_switch_pos_type { -+ BT_8821C_2ANT_TO_BT = 0x0, -+ BT_8821C_2ANT_TO_WLG = 0x1, -+ BT_8821C_2ANT_TO_WLA = 0x2, -+ BT_8821C_2ANT_TO_NOCARE = 0x3, -+ BT_8821C_2ANT_TO_MAX -+}; -+ -+enum bt_8821c_2ant_phase { -+ BT_8821C_2ANT_PHASE_INIT = 0x0, -+ BT_8821C_2ANT_PHASE_WONLY = 0x1, -+ BT_8821C_2ANT_PHASE_WOFF = 0x2, -+ BT_8821C_2ANT_PHASE_2G = 0x3, -+ BT_8821C_2ANT_PHASE_5G = 0x4, -+ BT_8821C_2ANT_PHASE_BTMP = 0x5, -+ BT_8821C_2ANT_PHASE_ANTDET = 0x6, -+ BT_8821C_2ANT_PHASE_POWERON = 0x7, -+ BT_8821C_2ANT_PHASE_MAX -+}; -+ -+enum bt_8821c_2ant_scoreboard { -+ BT_8821C_2ANT_SCBD_ACTIVE = BIT(0), -+ BT_8821C_2ANT_SCBD_ONOFF = BIT(1), -+ BT_8821C_2ANT_SCBD_SCAN = BIT(2), -+ BT_8821C_2ANT_SCBD_UNDERTEST = BIT(3), -+ BT_8821C_2ANT_SCBD_RXGAIN = BIT(4), -+ BT_8821C_2ANT_SCBD_WLBUSY = BIT(6), -+ BT_8821C_2ANT_SCBD_TDMA = BIT(9), -+ BT_8821C_2ANT_SCBD_BTCQDDR = BIT(10), -+ BT_8821C_2ANT_SCBD_ALL = 0xffff -+}; -+ -+enum bt_8821c_2ant_RUNREASON { -+ BT_8821C_2ANT_RSN_2GSCANSTART = 0x0, -+ BT_8821C_2ANT_RSN_5GSCANSTART = 0x1, -+ BT_8821C_2ANT_RSN_SCANFINISH = 0x2, -+ BT_8821C_2ANT_RSN_2GSWITCHBAND = 0x3, -+ BT_8821C_2ANT_RSN_5GSWITCHBAND = 0x4, -+ BT_8821C_2ANT_RSN_2GCONSTART = 0x5, -+ BT_8821C_2ANT_RSN_5GCONSTART = 0x6, -+ BT_8821C_2ANT_RSN_2GCONFINISH = 0x7, -+ BT_8821C_2ANT_RSN_5GCONFINISH = 0x8, -+ BT_8821C_2ANT_RSN_2GMEDIA = 0x9, -+ BT_8821C_2ANT_RSN_5GMEDIA = 0xa, -+ BT_8821C_2ANT_RSN_MEDIADISCON = 0xb, -+ BT_8821C_2ANT_RSN_2GSPECIALPKT = 0xc, -+ BT_8821C_2ANT_RSN_5GSPECIALPKT = 0xd, -+ BT_8821C_2ANT_RSN_BTINFO = 0xe, -+ BT_8821C_2ANT_RSN_PERIODICAL = 0xf, -+ BT_8821C_2ANT_RSN_PNP = 0x10, -+ BT_8821C_2ANT_RSN_LPS = 0x11, -+ BT_8821C_2ANT_RSN_MAX -+}; -+ -+enum bt_8821c_2ant_WL_LINK_MODE { -+ BT_8821C_2ANT_WLINK_2G1PORT = 0x0, -+ BT_8821C_2ANT_WLINK_2GMPORT = 0x1, -+ BT_8821C_2ANT_WLINK_25GMPORT = 0x2, -+ BT_8821C_2ANT_WLINK_5G = 0x3, -+ BT_8821C_2ANT_WLINK_2GGO = 0x4, -+ BT_8821C_2ANT_WLINK_BTMR = 0x5, -+ BT_8821C_2ANT_WLINK_MAX -+}; -+ -+struct coex_dm_8821c_2ant { -+ /* hw setting */ -+ u32 cur_ant_pos_type; -+ /* fw mechanism */ -+ -+ u8 cur_bt_pwr_lvl; -+ u8 cur_wl_pwr_lvl; -+ -+ boolean cur_ignore_wlan_act; -+ -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ boolean reset_tdma_adjust; -+ boolean cur_ps_tdma_on; -+ boolean cur_bt_auto_report; -+ -+ /* sw mechanism */ -+ boolean cur_low_penalty_ra; -+ -+ u32 cur_val0x6c0; -+ u32 cur_val0x6c4; -+ u32 cur_val0x6c8; -+ u8 cur_val0x6cc; -+ -+ /* algorithm related */ -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u8 cur_lps; -+ u8 cur_rpwm; -+ -+ u32 arp_cnt; -+ -+ u32 cur_ext_ant_switch_status; -+ -+ u8 cur_antdiv_type; -+ u32 setting_tdma; -+}; -+ -+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 msft_mr_exist; -+ boolean bt_a2dp_active; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ boolean bt_ctr_ok; -+ boolean is_hi_pri_rx_overhead; -+ u8 bt_rssi; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ u8 bt_info_c2h[BT_8821C_2ANT_INFO_SRC_MAX][BTC_BTINFO_LENGTH_MAX]; -+ u32 bt_info_c2h_cnt[BT_8821C_2ANT_INFO_SRC_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ boolean bt_inq_page_pre; -+ boolean bt_inq_page_remain; -+ boolean c2h_bt_remote_name_req; -+ -+ u8 bt_info_lb2; -+ u8 bt_info_lb3; -+ u8 bt_info_hb0; -+ u8 bt_info_hb1; -+ u8 bt_info_hb2; -+ u8 bt_info_hb3; -+ -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ u8 bt_retry_cnt; -+ -+ 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; -+ u32 cnt_crcok_max_in_10s; -+ -+ boolean cck_lock; -+ boolean cck_lock_ever; -+ boolean cck_lock_warn; -+ -+ u8 coex_table_type; -+ boolean force_lps_ctrl; -+ -+ u8 dis_ver_info_cnt; -+ -+ u8 a2dp_bit_pool; -+ u8 kt_ver; -+ -+ 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_high_pri_task1; -+ boolean wifi_high_pri_task2; -+ -+ 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; -+ boolean bt_418_hid_exist; -+ boolean bt_ble_hid_exist; -+ u8 forbidden_slot; -+ u8 hid_busy_num; -+ u8 hid_pair_cnt; -+ -+ u32 cnt_remote_name_req; -+ u32 cnt_setup_link; -+ u32 cnt_reinit; -+ u32 cnt_ign_wlan_act; -+ u32 cnt_page; -+ u32 cnt_role_switch; -+ u32 cnt_wl_fw_notify; -+ -+ u16 bt_reg_vendor_ac; -+ u16 bt_reg_vendor_ae; -+ -+ boolean is_setup_link; -+ u8 wl_noisy_level; -+ u32 gnt_error_cnt; -+ -+ u8 bt_afh_map[10]; -+ u8 bt_relink_downcount; -+ u8 bt_inq_page_downcount; -+ boolean is_tdma_btautoslot; -+ -+ boolean is_esco_mode; -+ u8 switch_band_notify_to; -+ -+ boolean is_hid_low_pri_tx_overhead; -+ boolean is_bt_multi_link; -+ boolean is_bt_a2dp_sink; -+ boolean is_set_ps_state_fail; -+ u8 cnt_set_ps_state_fail; -+ -+ u8 wl_fw_dbg_info[10]; -+ u8 wl_rx_rate; -+ u8 wl_tx_rate; -+ u8 wl_rts_rx_rate; -+ u8 wl_center_channel; -+ u8 wl_tx_macid; -+ u8 wl_tx_retry_ratio; -+ -+ u16 score_board_WB; -+ boolean is_hid_rcu; -+ u8 bt_a2dp_vendor_id; -+ u32 bt_a2dp_device_name; -+ u32 bt_a2dp_flush_time; -+ boolean is_ble_scan_en; -+ -+ boolean is_bt_opp_exist; -+ boolean gl_wifi_busy; -+ u8 connect_ap_period_cnt; -+ -+ boolean is_bt_reenable; -+ u8 cnt_bt_reenable; -+ boolean is_wifi_linkscan_process; -+ u8 wl_coex_mode; -+ u8 wl_pnp_wakeup_downcnt; -+ u32 coex_run_cnt; -+ boolean is_no_wl_5ms_extend; -+ -+ u16 wl_0x42a_backup; -+ u32 wl_0x430_backup; -+ u32 wl_0x434_backup; -+ u8 wl_0x455_backup; -+ -+ boolean wl_tx_limit_en; -+ boolean wl_ampdu_limit_en; -+ boolean wl_rxagg_limit_en; -+ u8 wl_rxagg_size; -+ u8 coex_run_reason; -+ -+ u8 tdma_timer_base; -+ boolean wl_slot_toggle; -+ boolean wl_slot_toggle_change; /* if toggle to no-toggle */ -+ u8 wl_iot_peer; -+}; -+ -+#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; -+ /* 0:DPDT, 1:SPDT */ -+ u8 ext_ant_switch_type; -+ /* iF 0: DPDT_P=0, DPDT_N=1 => BTG to Main, WL_A+G to Aux */ -+ u8 ext_ant_switch_ctrl_polarity; -+ -+ boolean ext_band_switch_exist; -+ /* 0:DPDT, 1:SPDT */ -+ u8 ext_band_switch_type; -+ u8 ext_band_switch_ctrl_polarity; -+ -+ boolean ant_at_main_port; -+ -+ /* If TRUE: WLG at BTG, If FALSE: WLG at WLAG */ -+ boolean wlg_locate_at_btg; -+ -+ /* If diversity on */ -+ boolean ext_ant_switch_diversity; -+}; -+ -+struct wifi_link_info_8821c_2ant { -+ u8 num_of_active_port; -+ u32 port_connect_status; -+ boolean is_all_under_5g; -+ boolean is_mcc_25g; -+ boolean is_p2p_connected; -+ boolean is_connected; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8821c2ant_power_on_setting(struct btc_coexist *btc); -+void ex_halbtc8821c2ant_pre_load_firmware(struct btc_coexist *btc); -+void ex_halbtc8821c2ant_init_hw_config(struct btc_coexist *btc, -+ boolean wifi_only); -+void ex_halbtc8821c2ant_init_coex_dm(struct btc_coexist *btc); -+void ex_halbtc8821c2ant_ips_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c2ant_lps_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c2ant_scan_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c2ant_switchband_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c2ant_connect_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c2ant_media_status_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c2ant_specific_packet_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c2ant_bt_info_notify(struct btc_coexist *btc, -+ u8 *tmp_buf, u8 length); -+void ex_halbtc8821c2ant_wl_fwdbginfo_notify(struct btc_coexist *btc, -+ u8 *tmp_buf, u8 length); -+void ex_halbtc8821c2ant_rx_rate_change_notify(struct btc_coexist *btc, -+ BOOLEAN is_data_frame, -+ u8 btc_rate_id); -+void ex_halbtc8821c2ant_tx_rate_change_notify(struct btc_coexist *btc, -+ u8 tx_rate, -+ u8 tx_retry_ratio, u8 macid); -+void ex_halbtc8821c2ant_rf_status_notify(struct btc_coexist *btc, -+ u8 type); -+void ex_halbtc8821c2ant_halt_notify(struct btc_coexist *btc); -+void ex_halbtc8821c2ant_pnp_notify(struct btc_coexist *btc, -+ u8 pnp_state); -+void ex_halbtc8821c2ant_periodical(struct btc_coexist *btc); -+void ex_halbtc8821c2ant_display_simple_coex_info(struct btc_coexist *btc); -+void ex_halbtc8821c2ant_display_coex_info(struct btc_coexist *btc); -+ -+#else -+#define ex_halbtc8821c2ant_power_on_setting(btc) -+#define ex_halbtc8821c2ant_pre_load_firmware(btc) -+#define ex_halbtc8821c2ant_init_hw_config(btc, wifi_only) -+#define ex_halbtc8821c2ant_init_coex_dm(btc) -+#define ex_halbtc8821c2ant_ips_notify(btc, type) -+#define ex_halbtc8821c2ant_lps_notify(btc, type) -+#define ex_halbtc8821c2ant_scan_notify(btc, type) -+#define ex_halbtc8821c2ant_switchband_notify(btc, type) -+#define ex_halbtc8821c2ant_connect_notify(btc, type) -+#define ex_halbtc8821c2ant_media_status_notify(btc, type) -+#define ex_halbtc8821c2ant_specific_packet_notify(btc, type) -+#define ex_halbtc8821c2ant_bt_info_notify(btc, tmp_buf, length) -+#define ex_halbtc8821c2ant_wl_fwdbginfo_notify(btc, tmp_buf, length) -+#define ex_halbtc8821c2ant_rx_rate_change_notify(btc, is_data_frame, \ -+ btc_rate_id) -+#define ex_halbtc8821c2ant_tx_rate_change_notify(btcoexist, tx_rate, \ -+ tx_retry_ratio, macid) -+#define ex_halbtc8821c2ant_rf_status_notify(btc, type) -+#define ex_halbtc8821c2ant_halt_notify(btc) -+#define ex_halbtc8821c2ant_pnp_notify(btc, pnp_state) -+#define ex_halbtc8821c2ant_periodical(btc) -+#define ex_halbtc8821c2ant_display_simple_coex_info(btc) -+#define ex_halbtc8821c2ant_display_coex_info(btc) -+#endif -+ -+#endif -+ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821cwifionly.c b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821cwifionly.c -new file mode 100755 -index 000000000..6f8e497b1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821cwifionly.c -@@ -0,0 +1,211 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" -+ -+static struct rfe_type_8821c_wifi_only gl_rfe_type_8821c_1ant; -+static struct rfe_type_8821c_wifi_only *rfe_type = &gl_rfe_type_8821c_1ant; -+ -+ -+ -+VOID hal8821c_wifi_only_switch_antenna( -+ IN struct wifi_only_cfg *pwifionlycfg, -+ IN u1Byte is_5g -+ ) -+{ -+ boolean switch_polatiry_inverse = false; -+ u8 regval_0xcb7 = 0; -+ u8 pos_type, ctrl_type; -+ -+ if (!rfe_type->ext_ant_switch_exist) -+ return; -+ -+ /* 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 */ -+ if (rfe_type->ext_ant_switch_ctrl_polarity) -+ switch_polatiry_inverse = !switch_polatiry_inverse; -+ -+ /* swap control polarity if 1-Ant at Aux */ -+ if (rfe_type->ant_at_main_port == false) -+ switch_polatiry_inverse = !switch_polatiry_inverse; -+ -+ if (is_5g) -+ pos_type = BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLA; -+ else -+ pos_type = BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLG; -+ -+ switch (pos_type) { -+ case BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLA: -+ -+ break; -+ case BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLG: -+ if (!rfe_type->wlg_Locate_at_btg) -+ switch_polatiry_inverse = !switch_polatiry_inverse; -+ break; -+ } -+ -+ if (pwifionlycfg->haldata_info.ant_div_cfg) -+ ctrl_type = BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_ANTDIV; -+ else -+ ctrl_type = BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_BBSW; -+ -+ -+ switch (ctrl_type) { -+ case BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_BBSW: -+ halwifionly_phy_set_bb_reg(pwifionlycfg, 0x4c, 0x01800000, 0x2); -+ -+ /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ -+ halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcb4, 0x000000ff, 0x77); -+ -+ 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 */ -+ halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcb4, 0x30000000, regval_0xcb7); -+ break; -+ -+ case BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: -+ halwifionly_phy_set_bb_reg(pwifionlycfg, 0x4c, 0x01800000, 0x2); -+ -+ /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ -+ halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcb4, 0x000000ff, 0x88); -+ -+ /* no regval_0xcb7 setup required, because antenna switch control value by antenna diversity */ -+ -+ break; -+ -+ } -+ -+} -+ -+ -+VOID halbtc8821c_wifi_only_set_rfe_type( -+ IN struct wifi_only_cfg *pwifionlycfg -+ ) -+{ -+ -+ /* the following setup should be got from Efuse in the future */ -+ rfe_type->rfe_module_type = (pwifionlycfg->haldata_info.rfe_type) & 0x1f; -+ -+ 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_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ -+ rfe_type->wlg_Locate_at_btg = false; -+ rfe_type->ant_at_main_port = true; -+ break; -+ case 1: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, WLG */ -+ rfe_type->wlg_Locate_at_btg = false; -+ rfe_type->ant_at_main_port = true; -+ break; -+ case 2: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, BTG */ -+ rfe_type->wlg_Locate_at_btg = true; -+ rfe_type->ant_at_main_port = true; -+ break; -+ case 3: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, WLG */ -+ rfe_type->wlg_Locate_at_btg = false; -+ rfe_type->ant_at_main_port = false; -+ break; -+ case 4: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, BTG */ -+ rfe_type->wlg_Locate_at_btg = true; -+ rfe_type->ant_at_main_port = false; -+ break; -+ case 5: -+ rfe_type->ext_ant_switch_exist = false; /*2-Ant, no antenna switch, WLG*/ -+ rfe_type->ext_ant_switch_type = -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_NONE; -+ rfe_type->wlg_Locate_at_btg = false; -+ rfe_type->ant_at_main_port = true; -+ break; -+ case 6: -+ rfe_type->ext_ant_switch_exist = false; /*2-Ant, no antenna switch, WLG*/ -+ rfe_type->ext_ant_switch_type = -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_NONE; -+ rfe_type->wlg_Locate_at_btg = false; -+ rfe_type->ant_at_main_port = true; -+ break; -+ case 7: -+ rfe_type->ext_ant_switch_exist = true; /*2-Ant, DPDT, BTG*/ -+ rfe_type->ext_ant_switch_type = -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_DPDT; -+ rfe_type->wlg_Locate_at_btg = true; -+ rfe_type->ant_at_main_port = true; -+ break; -+ } -+ -+} -+ -+ -+VOID -+ex_hal8821c_wifi_only_hw_config( -+ IN struct wifi_only_cfg *pwifionlycfg -+ ) -+{ -+ halbtc8821c_wifi_only_set_rfe_type(pwifionlycfg); -+ -+ /* set gnt_wl, gnt_bt control owner to WL*/ -+ halwifionly_phy_set_bb_reg(pwifionlycfg, 0x70, 0x4000000, 0x1); -+ -+ /*gnt_wl=1 , gnt_bt=0*/ -+ halwifionly_phy_set_bb_reg(pwifionlycfg, 0x1704, 0xffffffff, 0x7700); -+ halwifionly_phy_set_bb_reg(pwifionlycfg, 0x1700, 0xffffffff, 0xc00f0038); -+ -+ halwifionly_phy_set_bb_reg(pwifionlycfg, 0x6c0, 0xffffffff, 0xaaaaaaaa); -+ halwifionly_phy_set_bb_reg(pwifionlycfg, 0x6c4, 0xffffffff, 0xaaaaaaaa); -+} -+ -+VOID -+ex_hal8821c_wifi_only_scannotify( -+ IN struct wifi_only_cfg *pwifionlycfg, -+ IN u1Byte is_5g -+ ) -+{ -+ hal8821c_wifi_only_switch_antenna(pwifionlycfg, is_5g); -+} -+ -+VOID -+ex_hal8821c_wifi_only_switchbandnotify( -+ IN struct wifi_only_cfg *pwifionlycfg, -+ IN u1Byte is_5g -+ ) -+{ -+ hal8821c_wifi_only_switch_antenna(pwifionlycfg, is_5g); -+} -+ -+VOID -+ex_hal8821c_wifi_only_connectnotify( -+ IN struct wifi_only_cfg *pwifionlycfg, -+ IN u1Byte is_5g -+ ) -+{ -+ hal8821c_wifi_only_switch_antenna(pwifionlycfg, is_5g); -+} -+ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821cwifionly.h b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821cwifionly.h -new file mode 100755 -index 000000000..f36114cee ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/btc/halbtc8821cwifionly.h -@@ -0,0 +1,90 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HAL8821CWIFIONLYHWCFG_H -+#define __INC_HAL8821CWIFIONLYHWCFG_H -+ -+ -+struct rfe_type_8821c_wifi_only { -+ -+ 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 ant_at_main_port; -+ -+ boolean wlg_Locate_at_btg; /* If true: WLG at BTG, If false: WLG at WLAG */ -+ -+ boolean ext_ant_switch_diversity; /* If diversity on */ -+}; -+ -+enum bt_8821c_wifi_only_ext_ant_switch_type { -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_DPDT = 0x0, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_SPDT = 0x1, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_NONE = 0x2, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_MAX -+}; -+ -+enum bt_8821c_wifi_only_ext_ant_switch_ctrl_type { -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_MAX -+}; -+ -+enum bt_8821c_wifi_only_ext_ant_switch_pos_type { -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_BT = 0x0, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLG = 0x1, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLA = 0x2, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_NOCARE = 0x3, -+ BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_MAX -+}; -+ -+ -+VOID -+hal8821c_wifi_only_switch_antenna( -+ IN struct wifi_only_cfg *pwifionlycfg, -+ IN u1Byte is_5g -+ ); -+ -+VOID -+halbtc8821c_wifi_only_set_rfe_type( -+ IN struct wifi_only_cfg *pwifionlycfg -+ ); -+ -+ -+VOID -+ex_hal8821c_wifi_only_hw_config( -+ IN struct wifi_only_cfg *pwifionlycfg -+ ); -+VOID -+ex_hal8821c_wifi_only_scannotify( -+ IN struct wifi_only_cfg *pwifionlycfg, -+ IN u1Byte is_5g -+ ); -+VOID -+ex_hal8821c_wifi_only_switchbandnotify( -+ IN struct wifi_only_cfg *pwifionlycfg, -+ IN u1Byte is_5g -+ ); -+VOID -+ex_hal8821c_wifi_only_connectnotify( -+ IN struct wifi_only_cfg *pwifionlycfg, -+ IN u1Byte is_5g -+ ); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/btc/halbtcoutsrc.h b/drivers/net/wireless/rtl8821cs/hal/btc/halbtcoutsrc.h -new file mode 100644 -index 000000000..182969750 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/btc/halbtcoutsrc.h -@@ -0,0 +1,2170 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+enum { -+ BTC_CCK_1, -+ BTC_CCK_2, -+ BTC_CCK_5_5, -+ BTC_CCK_11, -+ BTC_OFDM_6, -+ BTC_OFDM_9, -+ BTC_OFDM_12, -+ BTC_OFDM_18, -+ BTC_OFDM_24, -+ BTC_OFDM_36, -+ BTC_OFDM_48, -+ BTC_OFDM_54, -+ BTC_MCS_0, -+ BTC_MCS_1, -+ BTC_MCS_2, -+ BTC_MCS_3, -+ BTC_MCS_4, -+ BTC_MCS_5, -+ BTC_MCS_6, -+ BTC_MCS_7, -+ BTC_MCS_8, -+ BTC_MCS_9, -+ BTC_MCS_10, -+ BTC_MCS_11, -+ BTC_MCS_12, -+ BTC_MCS_13, -+ BTC_MCS_14, -+ BTC_MCS_15, -+ BTC_MCS_16, -+ BTC_MCS_17, -+ BTC_MCS_18, -+ BTC_MCS_19, -+ BTC_MCS_20, -+ BTC_MCS_21, -+ BTC_MCS_22, -+ BTC_MCS_23, -+ BTC_MCS_24, -+ BTC_MCS_25, -+ BTC_MCS_26, -+ BTC_MCS_27, -+ BTC_MCS_28, -+ BTC_MCS_29, -+ BTC_MCS_30, -+ BTC_MCS_31, -+ BTC_VHT_1SS_MCS_0, -+ BTC_VHT_1SS_MCS_1, -+ BTC_VHT_1SS_MCS_2, -+ BTC_VHT_1SS_MCS_3, -+ BTC_VHT_1SS_MCS_4, -+ BTC_VHT_1SS_MCS_5, -+ BTC_VHT_1SS_MCS_6, -+ BTC_VHT_1SS_MCS_7, -+ BTC_VHT_1SS_MCS_8, -+ BTC_VHT_1SS_MCS_9, -+ BTC_VHT_2SS_MCS_0, -+ BTC_VHT_2SS_MCS_1, -+ BTC_VHT_2SS_MCS_2, -+ BTC_VHT_2SS_MCS_3, -+ BTC_VHT_2SS_MCS_4, -+ BTC_VHT_2SS_MCS_5, -+ BTC_VHT_2SS_MCS_6, -+ BTC_VHT_2SS_MCS_7, -+ BTC_VHT_2SS_MCS_8, -+ BTC_VHT_2SS_MCS_9, -+ BTC_VHT_3SS_MCS_0, -+ BTC_VHT_3SS_MCS_1, -+ BTC_VHT_3SS_MCS_2, -+ BTC_VHT_3SS_MCS_3, -+ BTC_VHT_3SS_MCS_4, -+ BTC_VHT_3SS_MCS_5, -+ BTC_VHT_3SS_MCS_6, -+ BTC_VHT_3SS_MCS_7, -+ BTC_VHT_3SS_MCS_8, -+ BTC_VHT_3SS_MCS_9, -+ BTC_VHT_4SS_MCS_0, -+ BTC_VHT_4SS_MCS_1, -+ BTC_VHT_4SS_MCS_2, -+ BTC_VHT_4SS_MCS_3, -+ BTC_VHT_4SS_MCS_4, -+ BTC_VHT_4SS_MCS_5, -+ BTC_VHT_4SS_MCS_6, -+ BTC_VHT_4SS_MCS_7, -+ BTC_VHT_4SS_MCS_8, -+ BTC_VHT_4SS_MCS_9, -+ BTC_MCS_32, -+ BTC_UNKNOWN, -+ BTC_PKT_MGNT, -+ BTC_PKT_CTRL, -+ BTC_PKT_UNKNOWN, -+ BTC_PKT_NOT_FOR_ME, -+ BTC_RATE_MAX -+}; -+ -+enum { -+ BTC_MULTIPORT_SCC, -+ BTC_MULTIPORT_MCC_DUAL_CHANNEL, -+ BTC_MULTIPORT_MCC_DUAL_BAND, -+ BTC_MULTIPORT_MAX -+}; -+ -+#define BTC_COEX_8822B_COMMON_CODE 0 -+#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 NM_EXCU FALSE -+#define FC_EXCU 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 -+ -+/* for common code request */ -+#define REG_LTE_IDR_COEX_CTRL 0x0038 -+#define REG_SYS_SDIO_CTRL 0x0070 -+#define REG_SYS_SDIO_CTRL3 0x0073 -+/* #define REG_RETRY_LIMIT 0x042a */ -+/* #define REG_DARFRC 0x0430 */ -+#define REG_DARFRCH 0x0434 -+#define REG_CCK_CHECK 0x0454 -+#define REG_AMPDU_MAX_TIME_V1 0x0455 -+#define REG_TX_HANG_CTRL 0x045E -+#define REG_LIFETIME_EN 0x0426 -+#define REG_BT_COEX_TABLE0 0x06C0 -+#define REG_BT_COEX_TABLE1 0x06C4 -+#define REG_BT_COEX_BRK_TABLE 0x06C8 -+#define REG_BT_COEX_TABLE_H 0x06CC -+#define REG_BT_ACT_STATISTICS 0x0770 -+#define REG_BT_ACT_STATISTICS_1 0x0774 -+#define REG_BT_STAT_CTRL 0x0778 -+ -+#define BIT_EN_GNT_BT_AWAKE BIT(3) -+#define BIT_EN_BCN_FUNCTION BIT(3) -+#define BIT_EN_BCN_PKT_REL BIT(6) -+#define BIT_FEN_BB_GLB_RST BIT(1) -+#define BIT_FEN_BB_RSTB BIT(0) -+ -+#define TDMA_4SLOT BIT(8) -+ -+/* for 2T2R -> 2T1R coex MIMO-PS mechanism tranlation */ -+#define BTC_2GTDD_MAX_TRY 3 /* the max retry count for 1R->2R */ -+#define BTC_2GFDD_MAX_STAY 300 /* the max stay time at 1R if 2R try-able (unit: 2s) */ -+ -+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_RTL8822B = 6, -+ BTC_CHIP_RTL8822C = 7, -+ BTC_CHIP_RTL8821C = 8, -+ BTC_CHIP_RTL8821A = 9, -+ BTC_CHIP_RTL8723D = 10, -+ BTC_CHIP_RTL8703B = 11, -+ BTC_CHIP_RTL8725A = 12, -+ BTC_CHIP_RTL8723F = 13, -+ 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 -+#define CL_STRNCAT(dst, dst_size, src, src_size) rstrncat(dst, src, src_size) -+ -+static const char *const glbt_info_src[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+#define BTC_INFO_FTP BIT(7) -+#define BTC_INFO_A2DP BIT(6) -+#define BTC_INFO_HID BIT(5) -+#define BTC_INFO_SCO_BUSY BIT(4) -+#define BTC_INFO_ACL_BUSY BIT(3) -+#define BTC_INFO_INQ_PAGE BIT(2) -+#define BTC_INFO_SCO_ESCO BIT(1) -+#define BTC_INFO_CONNECTION BIT(0) -+ -+#define BTC_BTINFO_LENGTH_MAX 10 -+ -+enum btc_gnt_setup_state { -+ BTC_GNT_SET_SW_LOW = 0x0, -+ BTC_GNT_SET_SW_HIGH = 0x1, -+ BTC_GNT_SET_HW_PTA = 0x2, -+ BTC_GNT_SET_MAX -+}; -+ -+enum btc_gnt_setup_state_2 { -+ BTC_GNT_HW_PTA = 0x0, -+ BTC_GNT_SW_LOW = 0x1, -+ BTC_GNT_SW_HIGH = 0x3, -+ BTC_GNT_MAX -+}; -+ -+enum btc_path_ctrl_owner { -+ BTC_OWNER_BT = 0x0, -+ BTC_OWNER_WL = 0x1, -+ BTC_OWNER_MAX -+}; -+ -+enum btc_gnt_ctrl_type { -+ BTC_GNT_CTRL_BY_PTA = 0x0, -+ BTC_GNT_CTRL_BY_SW = 0x1, -+ BTC_GNT_CTRL_MAX -+}; -+ -+enum btc_gnt_ctrl_block { -+ BTC_GNT_BLOCK_RFC_BB = 0x0, -+ BTC_GNT_BLOCK_RFC = 0x1, -+ BTC_GNT_BLOCK_BB = 0x2, -+ BTC_GNT_BLOCK_MAX -+}; -+ -+enum btc_lte_coex_table_type { -+ BTC_CTT_WL_VS_LTE = 0x0, -+ BTC_CTT_BT_VS_LTE = 0x1, -+ BTC_CTT_MAX -+}; -+ -+enum btc_lte_break_table_type { -+ BTC_LBTT_WL_BREAK_LTE = 0x0, -+ BTC_LBTT_BT_BREAK_LTE = 0x1, -+ BTC_LBTT_LTE_BREAK_WL = 0x2, -+ BTC_LBTT_LTE_BREAK_BT = 0x3, -+ BTC_LBTT_MAX -+}; -+ -+enum btc_btinfo_src { -+ BTC_BTINFO_SRC_WL_FW = 0x0, -+ BTC_BTINFO_SRC_BT_RSP = 0x1, -+ BTC_BTINFO_SRC_BT_ACT = 0x2, -+ BTC_BTINFO_SRC_BT_IQK = 0x3, -+ BTC_BTINFO_SRC_BT_SCBD = 0x4, -+ BTC_BTINFO_SRC_H2C60 = 0x5, -+ BTC_BTINFO_SRC_BT_PSD = 0x6, -+ BTC_BTINFO_SRC_BT_SLOT1 = 0x7, -+ BTC_BTINFO_SRC_BT_SLOT2 = 0x8, -+ BTC_BTINFO_SRC_MAX -+}; -+ -+enum btc_bt_profile { -+ BTC_BTPROFILE_NONE = 0, -+ BTC_BTPROFILE_HFP = BIT(0), -+ BTC_BTPROFILE_HID = BIT(1), -+ BTC_BTPROFILE_A2DP = BIT(2), -+ BTC_BTPROFILE_PAN = BIT(3), -+ BTC_BTPROFILE_MAX = 0xf -+}; -+ -+static const char *const bt_profile_string[] = { -+ "None", -+ "HFP", -+ "HID", -+ "HID + HFP", -+ "A2DP", -+ "A2DP + HFP", -+ "A2DP + HID", -+ "PAN + HID + HFP", -+ "PAN", -+ "PAN + HFP", -+ "PAN + HID", -+ "PAN + HID + HFP", -+ "PAN + A2DP", -+ "PAN + A2DP + HFP", -+ "PAN + A2DP + HID", -+ "PAN + A2DP + HID + HFP" -+}; -+ -+enum btc_bt_status { -+ BTC_BTSTATUS_NCON_IDLE = 0x0, -+ BTC_BTSTATUS_CON_IDLE = 0x1, -+ BTC_BTSTATUS_INQ_PAGE = 0x2, -+ BTC_BTSTATUS_ACL_BUSY = 0x3, -+ BTC_BTSTATUS_SCO_BUSY = 0x4, -+ BTC_BTSTATUS_ACL_SCO_BUSY = 0x5, -+ BTC_BTSTATUS_MAX -+}; -+ -+static const char *const bt_status_string[] = { -+ "BT Non-Connected-idle", -+ "BT Connected-idle", -+ "BT Inq-page", -+ "BT ACL-busy", -+ "BT SCO-busy", -+ "BT ACL-SCO-busy", -+ "BT Non-Defined-state" -+}; -+ -+enum btc_coex_algo { -+ BTC_COEX_NOPROFILE = 0x0, -+ BTC_COEX_HFP = 0x1, -+ BTC_COEX_HID = 0x2, -+ BTC_COEX_A2DP = 0x3, -+ BTC_COEX_PAN = 0x4, -+ BTC_COEX_A2DP_HID = 0x5, -+ BTC_COEX_A2DP_PAN = 0x6, -+ BTC_COEX_PAN_HID = 0x7, -+ BTC_COEX_A2DP_PAN_HID = 0x8, -+ BTC_COEX_MAX -+}; -+ -+static const char *const coex_algo_string[] = { -+ "No Profile", -+ "HFP", -+ "HID", -+ "A2DP", -+ "PAN", -+ "A2DP + HID", -+ "A2DP + PAN", -+ "PAN + HID", -+ "A2DP + PAN + HID" -+}; -+ -+enum btc_ext_ant_switch_type { -+ BTC_SWITCH_NONE = 0x0, -+ BTC_SWITCH_SPDT = 0x1, -+ BTC_SWITCH_SP3T = 0x2, -+ BTC_SWITCH_DPDT = 0x3, -+ BTC_SWITCH_ANTMAX -+}; -+ -+enum btc_ext_ant_switch_ctrl_type { -+ BTC_SWITCH_CTRL_BY_BBSW = 0x0, -+ BTC_SWITCH_CTRL_BY_PTA = 0x1, -+ BTC_SWITCH_CTRL_BY_ANTDIV = 0x2, -+ BTC_SWITCH_CTRL_BY_MAC = 0x3, -+ BTC_SWITCH_CTRL_BY_BT = 0x4, -+ BTC_SWITCH_CTRL_BY_FW = 0x5, -+ BTC_SWITCH_CTRL_MAX -+}; -+ -+enum btc_ext_ant_switch_pos_type { -+ BTC_SWITCH_TO_BT = 0x0, -+ BTC_SWITCH_TO_WLG = 0x1, -+ BTC_SWITCH_TO_WLA = 0x2, -+ BTC_SWITCH_TO_NOCARE = 0x3, -+ BTC_SWITCH_TO_WLG_BT = 0x4, -+ BTC_SWITCH_TO_MAX -+}; -+ -+enum btx_set_ant_phase { -+ BTC_ANT_INIT = 0x0, -+ BTC_ANT_WONLY = 0x1, -+ BTC_ANT_WOFF = 0x2, -+ BTC_ANT_2G = 0x3, -+ BTC_ANT_5G = 0x4, -+ BTC_ANT_BTMP = 0x5, -+ BTC_ANT_POWERON = 0x6, -+ BTC_ANT_2G_WL = 0x7, -+ BTC_ANT_2G_BT = 0x8, -+ BTC_ANT_MCC = 0x9, -+ BTC_ANT_2G_WLBT = 0xa, -+ BTC_ANT_2G_FREERUN = 0xb, -+ BTC_ANT_MAX -+}; -+ -+/*ADD SCOREBOARD TO FIX BT LPS 32K ISSUE WHILE WL BUSY*/ -+enum btc_wl2bt_scoreboard { -+ BTC_SCBD_ACTIVE = BIT(0), -+ BTC_SCBD_ON = BIT(1), -+ BTC_SCBD_SCAN = BIT(2), -+ BTC_SCBD_UNDERTEST = BIT(3), -+ BTC_SCBD_RXGAIN = BIT(4), -+ BTC_SCBD_WLBUSY = BIT(7), -+ BTC_SCBD_EXTFEM = BIT(8), -+ BTC_SCBD_TDMA = BIT(9), -+ BTC_SCBD_FIX2M = BIT(10), -+ BTC_SCBD_MAILBOX_DBG = BIT(14), -+ BTC_SCBD_ALL = 0xffff, -+ BTC_SCBD_ALL_32BIT = 0xffffffff -+}; -+ -+enum btc_bt2wl_scoreboard { -+ BTC_SCBD_BT_ONOFF = BIT(1), -+ BTC_SCBD_BT_LPS = BIT(7) -+}; -+enum btc_scoreboard_bit_num { -+ BTC_SCBD_16_BIT = BIT(0), -+ BTC_SCBD_32_BIT = BIT(1) -+}; -+ -+enum btc_runreason { -+ BTC_RSN_2GSCANSTART = 0x0, -+ BTC_RSN_5GSCANSTART = 0x1, -+ BTC_RSN_SCANFINISH = 0x2, -+ BTC_RSN_2GSWITCHBAND = 0x3, -+ BTC_RSN_5GSWITCHBAND = 0x4, -+ BTC_RSN_2GCONSTART = 0x5, -+ BTC_RSN_5GCONSTART = 0x6, -+ BTC_RSN_2GCONFINISH = 0x7, -+ BTC_RSN_5GCONFINISH = 0x8, -+ BTC_RSN_2GMEDIA = 0x9, -+ BTC_RSN_5GMEDIA = 0xa, -+ BTC_RSN_MEDIADISCON = 0xb, -+ BTC_RSN_2GSPECIALPKT = 0xc, -+ BTC_RSN_5GSPECIALPKT = 0xd, -+ BTC_RSN_BTINFO = 0xe, -+ BTC_RSN_PERIODICAL = 0xf, -+ BTC_RSN_PNP = 0x10, -+ BTC_RSN_LPS = 0x11, -+ BTC_RSN_TIMERUP = 0x12, -+ BTC_RSN_WLSTATUS = 0x13, -+ BTC_RSN_BTCNT = 0x14, -+ BTC_RSN_RFK = 0x15, -+ BTC_RSN_MAX -+}; -+ -+static const char *const run_reason_string[] = { -+ "2G_SCAN_START", -+ "5G_SCAN_START", -+ "SCAN_FINISH", -+ "2G_SWITCH_BAND", -+ "5G_SWITCH_BAND", -+ "2G_CONNECT_START", -+ "5G_CONNECT_START", -+ "2G_CONNECT_FINISH", -+ "5G_CONNECT_FINISH", -+ "2G_MEDIA_STATUS", -+ "5G_MEDIA_STATUS", -+ "MEDIA_DISCONNECT", -+ "2G_SPECIALPKT", -+ "5G_SPECIALPKT", -+ "BTINFO", -+ "PERIODICAL", -+ "PNPNotify", -+ "LPSNotify", -+ "TimerUp", -+ "WL_STATUS_CHANGE", -+ "BT_CNT_CHANGE", -+ "WL_RFK", -+ "Reason Max" -+}; -+ -+enum btc_wl_link_mode { -+ BTC_WLINK_2G1PORT = 0x0, -+ BTC_WLINK_2GMPORT = 0x1, -+ BTC_WLINK_25GMPORT = 0x2, -+ BTC_WLINK_5G = 0x3, -+ BTC_WLINK_2GGO = 0x4, -+ BTC_WLINK_2GGC = 0x5, -+ BTC_WLINK_BTMR = 0x6, -+ BTC_WLINK_2GFREE = 0x7, -+ BTC_WLINK_MAX -+}; -+ -+static const char *const coex_mode_string[] = { -+ "2G-SP", -+ "2G-MP", -+ "25G-MP", -+ "5G", -+ "2G-P2P-GO", -+ "2G-P2P-GC", -+ "BT-MR", -+ "2G1RFREE", -+ "unknow" -+}; -+ -+enum btc_bt_state_cnt { -+ BTC_CNT_BT_RETRY = 0x0, -+ BTC_CNT_BT_REINIT = 0x1, -+ BTC_CNT_BT_POPEVENT = 0x2, -+ BTC_CNT_BT_SETUPLINK = 0x3, -+ BTC_CNT_BT_IGNWLANACT = 0x4, -+ BTC_CNT_BT_INQ = 0x5, -+ BTC_CNT_BT_PAGE = 0x6, -+ BTC_CNT_BT_ROLESWITCH = 0x7, -+ BTC_CNT_BT_AFHUPDATE = 0x8, -+ BTC_CNT_BT_DISABLE = 0x9, -+ BTC_CNT_BT_INFOUPDATE = 0xa, -+ BTC_CNT_BT_IQK = 0xb, -+ BTC_CNT_BT_IQKFAIL = 0xc, -+ BTC_CNT_BT_TRX = 0xd, -+ BTC_CNT_BT_MAX -+}; -+ -+enum btc_wl_state_cnt { -+ BTC_CNT_WL_SCANAP = 0x0, -+ BTC_CNT_WL_ARP = 0x1, -+ BTC_CNT_WL_GNTERR = 0x2, -+ BTC_CNT_WL_PSFAIL = 0x3, -+ BTC_CNT_WL_COEXRUN = 0x4, -+ BTC_CNT_WL_COEXINFO1 = 0x5, -+ BTC_CNT_WL_COEXINFO2 = 0x6, -+ BTC_CNT_WL_AUTOSLOT_HANG = 0x7, -+ BTC_CNT_WL_NOISY0 = 0x8, -+ BTC_CNT_WL_NOISY1 = 0x9, -+ BTC_CNT_WL_NOISY2 = 0xa, -+ BTC_CNT_WL_ACTIVEPORT = 0xb, -+ BTC_CNT_WL_LEAKAP_NORX = 0xc, -+ BTC_CNT_WL_FW_NOTIFY = 0xd, -+ BTC_CNT_WL_2G_TDDTRY = 0xe, -+ BTC_CNT_WL_2G_FDDSTAY = 0xf, -+ BTC_CNT_WL_MAX -+}; -+ -+enum btc_wl_crc_cnt { -+ BTC_WLCRC_11BOK = 0x0, -+ BTC_WLCRC_11GOK = 0x1, -+ BTC_WLCRC_11NOK = 0x2, -+ BTC_WLCRC_11VHTOK = 0x3, -+ BTC_WLCRC_11BERR = 0x4, -+ BTC_WLCRC_11GERR = 0x5, -+ BTC_WLCRC_11NERR = 0x6, -+ BTC_WLCRC_11VHTERR = 0x7, -+ BTC_WLCRC_MAX -+}; -+ -+enum btc_timer_cnt { -+ BTC_TIMER_WL_STAYBUSY = 0x0, -+ BTC_TIMER_WL_COEXFREEZE = 0x1, -+ BTC_TIMER_WL_SPECPKT = 0x2, -+ BTC_TIMER_WL_CONNPKT = 0x3, -+ BTC_TIMER_WL_PNPWAKEUP = 0x4, -+ BTC_TIMER_WL_CCKLOCK = 0x5, -+ BTC_TIMER_WL_FWDBG = 0x6, -+ BTC_TIMER_BT_RELINK = 0x7, -+ BTC_TIMER_BT_REENABLE = 0x8, -+ BTC_TIMER_BT_MULTILINK = 0x9, -+ BTC_TIMER_BT_INQPAGE = 0xa, -+ BTC_TIMER_BT_A2DP_ACT = 0xb, -+ BTC_TIMER_MAX -+}; -+ -+enum btc_wl_status_change { -+ BTC_WLSTATUS_CHANGE_TOIDLE = 0x0, -+ BTC_WLSTATUS_CHANGE_TOBUSY = 0x1, -+ BTC_WLSTATUS_CHANGE_RSSI = 0x2, -+ BTC_WLSTATUS_CHANGE_LINKINFO = 0x3, -+ BTC_WLSTATUS_CHANGE_DIR = 0x4, -+ BTC_WLSTATUS_CHANGE_NOISY = 0x5, -+ BTC_WLSTATUS_CHANGE_BTCNT = 0x6, -+ BTC_WLSTATUS_CHANGE_LOCKTRY = 0x7, -+ BTC_WLSTATUS_CHANGE_MAX -+}; -+ -+enum btc_commom_chip_setup { -+ BTC_CSETUP_INIT_HW = 0x0, -+ BTC_CSETUP_ANT_SWITCH = 0x1, -+ BTC_CSETUP_GNT_FIX = 0x2, -+ BTC_CSETUP_GNT_DEBUG = 0x3, -+ BTC_CSETUP_RFE_TYPE = 0x4, -+ BTC_CSETUP_COEXINFO_HW = 0x5, -+ BTC_CSETUP_WL_TX_POWER = 0x6, -+ BTC_CSETUP_WL_RX_GAIN = 0x7, -+ BTC_CSETUP_WLAN_ACT_IPS = 0x8, -+ BTC_CSETUP_BT_CTRL_ACT = 0x9, -+ BTC_CSETUP_MAX -+}; -+ -+enum btc_indirect_reg_type { -+ BTC_INDIRECT_1700 = 0x0, -+ BTC_INDIRECT_7C0 = 0x1, -+ BTC_INDIRECT_MAX -+}; -+ -+enum btc_pstdma_type { -+ BTC_PSTDMA_FORCE_LPSOFF = 0x0, -+ BTC_PSTDMA_FORCE_LPSON = 0x1, -+ BTC_PSTDMA_MAX -+}; -+ -+enum btc_btrssi_type { -+ BTC_BTRSSI_RATIO = 0x0, -+ BTC_BTRSSI_DBM = 0x1, -+ BTC_BTRSSI_MAX -+}; -+ -+enum btc_wl_priority_mask { -+ BTC_WLPRI_RX_RSP = 2, -+ BTC_WLPRI_TX_RSP = 3, -+ BTC_WLPRI_TX_BEACON = 4, -+ BTC_WLPRI_TX_OFDM = 11, -+ BTC_WLPRI_TX_CCK = 12, -+ BTC_WLPRI_TX_BEACONQ = 27, -+ BTC_WLPRI_RX_CCK = 28, -+ BTC_WLPRI_RX_OFDM = 29, -+ BTC_WLPRI_MAX -+}; -+ -+enum btc_ext_chip_id{ -+ BTC_EXT_CHIP_NONE, -+ BTC_EXT_CHIP_RF4CE, -+ BTC_EXT_CHIP_MAX -+}; -+ -+enum btc_ext_chip_mode{ -+ BTC_EXTMODE_NORMAL, -+ BTC_EXTMODE_VOICE, -+ BTC_EXTMODE_MAX -+}; -+ -+enum btc_wl_rfk_type { -+ BTC_PWR_TRK = 0, -+ BTC_IQK = 1, -+ BTC_LCK = 2, -+ BTC_DPK = 3, -+ BTC_TXGAPK = 4, -+ BTC_RFK_TYPE_MAX -+}; -+ -+enum btc_wl_rfk_state { -+ BTC_RFK_START = 0, -+ BTC_RFK_END = 1, -+ BTC_RFK_STATE_MAX -+}; -+ -+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; -+ boolean btdm_ant_det_already_init_phydm; -+ 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; -+ u8 customerID; -+ u8 customer_id; -+ u8 ant_distance; /* WL-BT antenna space for non-shared antenna */ -+ u8 ext_chip_id; -+}; -+ -+struct btc_coex_dm { -+ boolean cur_ignore_wlan_act; -+ boolean cur_ps_tdma_on; -+ boolean cur_low_penalty_ra; -+ boolean cur_wl_rx_low_gain_en; -+ -+ u8 bt_rssi_state[4]; -+ u8 wl_rssi_state[4]; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 fw_tdma_para[5]; -+ u8 cur_lps; -+ u8 cur_rpwm; -+ u8 cur_bt_pwr_lvl; -+ u8 cur_bt_lna_lvl; -+ u8 cur_wl_pwr_lvl; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wl_chnl_info[3]; -+ u8 cur_toggle_para[6]; -+ u8 bt_slot_length1[10]; -+ u8 bt_slot_length2[10]; -+ u32 cur_ant_pos_type; -+ u32 cur_switch_status; -+ u32 setting_tdma; -+}; -+ -+struct btc_coex_sta { -+ boolean coex_freeze; -+ boolean coex_freerun; -+ boolean rf4ce_en; -+ boolean force_freerun; -+ boolean force_tdd; -+ -+ boolean bt_disabled; -+ boolean bt_disabled_pre; -+ boolean bt_link_exist; -+ boolean bt_whck_test; -+ boolean bt_inq_page; -+ boolean bt_inq_page_pre; -+ boolean bt_inq_page_remain; -+ boolean bt_inq; -+ boolean bt_page; -+ boolean bt_ble_voice; -+ boolean bt_ble_exist; -+ boolean bt_hfp_exist; -+ boolean bt_a2dp_exist; -+ boolean bt_hid_exist; -+ boolean bt_pan_exist; // PAN or OPP -+ boolean bt_opp_exist; //OPP only -+ boolean bt_msft_mr_exist; -+ boolean bt_acl_busy; -+ boolean bt_fix_2M; -+ boolean bt_setup_link; -+ boolean bt_multi_link; -+ boolean bt_multi_link_pre; -+ boolean bt_multi_link_remain; -+ boolean bt_a2dp_sink; -+ boolean bt_reenable; -+ boolean bt_ble_scan_en; -+ boolean bt_slave; -+ boolean bt_a2dp_active; -+ boolean bt_a2dp_active_pre; -+ boolean bt_a2dp_active_remain; -+ boolean bt_slave_latency; -+ boolean bt_init_scan; -+ boolean bt_418_hid_exist; -+ boolean bt_ble_hid_exist; -+ boolean bt_mesh; -+ boolean bt_ctr_ok; -+ -+ boolean wl_under_lps; -+ boolean wl_under_ips; -+ boolean wl_under_4way; -+ boolean wl_hi_pri_task1; -+ boolean wl_hi_pri_task2; -+ boolean wl_cck_lock; -+ boolean wl_cck_lock_pre; -+ boolean wl_cck_lock_ever; -+ boolean wl_force_lps_ctrl; -+ boolean wl_busy_pre; -+ boolean wl_gl_busy; -+ boolean wl_gl_busy_pre; -+ boolean wl_linkscan_proc; -+ boolean wl_mimo_ps; -+ boolean wl_cck_dead_lock_ap; -+ boolean wl_tx_limit_en; -+ boolean wl_ampdu_limit_en; -+ boolean wl_rxagg_limit_en; -+ boolean wl_connecting; -+ boolean wl_pnp_wakeup; -+ boolean wl_slot_toggle; -+ boolean wl_slot_toggle_change; /* if toggle to no-toggle */ -+ boolean wl_leak_ap; /* !is_no_wl_5ms_extend */ -+ boolean wl_blacklist_ap; -+ boolean wl_rfk; -+ -+ u8 coex_table_type; -+ u8 coex_run_reason; -+ u8 tdma_byte4_modify_pre; -+ u8 kt_ver; -+ u8 gnt_workaround_state; -+ u8 tdma_timer_base; -+ u8 bt_rssi; -+ u8 bt_profile_num; -+ u8 bt_profile_num_pre; -+ u8 bt_info_c2h[BTC_BTINFO_SRC_MAX][BTC_BTINFO_LENGTH_MAX]; -+ u8 bt_info_lb2; -+ u8 bt_info_lb3; -+ u8 bt_info_hb0; -+ u8 bt_info_hb1; -+ u8 bt_info_hb2; -+ u8 bt_info_hb3; -+ u8 bt_ble_scan_type; -+ u8 bt_afh_map[10]; -+ u8 bt_a2dp_vendor_id; -+ u8 bt_hid_pair_num; -+ u8 bt_hid_slot; -+ u8 bt_a2dp_bitpool; -+ u8 bt_iqk_state; -+ u8 bt_sut_pwr_lvl[4]; -+ u8 bt_golden_rx_shift[4]; -+ u8 bt_ext_autoslot_thres; -+ u8 ext_chip_mode; -+ -+ u8 wl_pnp_state_pre; -+ u8 wl_noisy_level; -+ u8 wl_fw_dbg_info[10]; -+ u8 wl_fw_dbg_info_pre[10]; -+ u8 wl_rx_rate; -+ u8 wl_tx_rate; -+ u8 wl_rts_rx_rate; -+ u8 wl_center_ch; -+ u8 wl_tx_macid; -+ u8 wl_tx_retry_ratio; -+ u8 wl_coex_mode; -+ u8 wl_iot_peer; -+ u8 wl_ra_thres; -+ u8 wl_ampdulen; -+ u8 wl_rxagg_size; -+ u8 wl_toggle_para[6]; -+ u8 wl_toggle_interval; -+ -+ u16 score_board_BW; -+ u32 score_board_WB; -+ u16 bt_reg_vendor_ac; -+ u16 bt_reg_vendor_ae; -+ u32 bt_reg_vendor_dac; -+ u16 bt_reg_modem_a; -+ u16 bt_reg_rf_2; -+ u16 bt_reg_rf_9; -+ u16 wl_txlimit; -+ -+ u32 score_board_BW_32bit; -+ u32 score_board_WB_32bit; -+ u32 hi_pri_tx; -+ u32 hi_pri_rx; -+ u32 lo_pri_tx; -+ u32 lo_pri_rx; -+ u32 bt_supported_feature; -+ u32 bt_supported_version; -+ u32 bt_ble_scan_para[3]; -+ u32 bt_a2dp_device_name; -+ u32 bt_a2dp_flush_time; -+ u32 wl_arfb1; -+ u32 wl_arfb2; -+ u32 wl_traffic_dir; -+ u32 wl_bw; -+ u32 cnt_bt_info_c2h[BTC_BTINFO_SRC_MAX]; -+ u32 cnt_bt[BTC_CNT_BT_MAX]; -+ u32 cnt_wl[BTC_CNT_WL_MAX]; -+ u32 cnt_timer[BTC_TIMER_MAX]; -+}; -+ -+struct btc_rfe_type { -+ boolean ant_switch_exist; -+ boolean ant_switch_diversity; /* If diversity on */ -+ boolean ant_switch_with_bt; /* If WL_2G/BT use ext-switch at shared-ant */ -+ u8 rfe_module_type; -+ u8 ant_switch_type; -+ u8 ant_switch_polarity; -+ -+ boolean band_switch_exist; -+ u8 band_switch_type; /* 0:DPDT, 1:SPDT */ -+ u8 band_switch_polarity; -+ -+ /* If TRUE: WLG at BTG, If FALSE: WLG at WLAG */ -+ boolean wlg_at_btg; -+}; -+ -+ -+struct btc_wifi_link_info_ext { -+ boolean is_all_under_5g; -+ boolean is_mcc_25g; -+ boolean is_p2p_connected; -+ boolean is_ap_mode; -+ boolean is_scan; -+ boolean is_link; -+ boolean is_roam; -+ boolean is_4way; -+ boolean is_32k; -+ boolean is_connected; -+ u8 num_of_active_port; -+ u32 port_connect_status; -+ u32 traffic_dir; -+ u32 wifi_bw; -+}; -+ -+struct btc_coex_table_para { -+ u32 bt; //0x6c0 -+ u32 wl; //0x6c4 -+}; -+ -+struct btc_tdma_para { -+ u8 para[5]; -+}; -+ -+struct btc_reg_byte_modify { -+ u32 addr; -+ u8 bitmask; -+ u8 val; -+}; -+ -+struct btc_5g_afh_map { -+ u32 wl_5g_ch; -+ u8 bt_skip_ch; -+ u8 bt_skip_span; -+}; -+ -+struct btc_rf_para { -+ u8 wl_pwr_dec_lvl; -+ u8 bt_pwr_dec_lvl; -+ boolean wl_low_gain_en; -+ u8 bt_lna_lvl; -+}; -+ -+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_25G = 0x2, -+ 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_WOWLAN = 0x3, -+ 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_FW_READY, -+ BTC_GET_BL_WIFI_CONNECTED, -+ BTC_GET_BL_WIFI_DUAL_BAND_CONNECTED, -+ BTC_GET_BL_WIFI_LINK_INFO, -+ 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, -+ BTC_GET_BL_RF4CE_CONNECTED, -+ BTC_GET_BL_WIFI_LW_PWR_STATE, -+ -+ /* 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_TRAFFIC_DIR, -+ BTC_GET_U4_WIFI_FW_VER, -+ BTC_GET_U4_WIFI_PHY_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_BT_DEVICE_INFO, -+ BTC_GET_U4_BT_FORBIDDEN_SLOT_VAL, -+ BTC_GET_U4_BT_A2DP_FLUSH_VAL, -+ 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, -+ BTC_GET_BL_WIFI_BSSID, -+ -+ /* type u2Byte */ -+ BTC_GET_U2_BEACON_PERIOD, -+ -+ /*===== 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_ENABLE_DISABLE_CHANGE, -+ 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, -+ BTC_SET_BL_BT_LNA_CONSTRAIN_LEVEL, -+ BTC_SET_BL_BT_GOLDEN_RX_RANGE, -+ -+ /* 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 mimo ps mode setting -+ BTC_SET_MIMO_PS_MODE, -+ /*===== 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_PRE_NORMAL_LPS, -+ BTC_SET_ACT_POST_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_RESET_COEX_VAR, -+ /*=================*/ -+ 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_START_5G = 0x3, -+ 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_CONNECT_5G = 0x02, -+ 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; -+ -+typedef enum _BTC_LINK_CHANGE_TYPE{ -+ BTC_LINK_CHANGE_TYPE_NONE = 0x0, -+ BTC_LINK_CHANGE_TYPE_ECSA_START = 0x1, -+ BTC_LINK_CHANGE_TYPE_ECSA_DONE = 0x2, -+ BTC_LINK_CHANGE_TYPE_MAX -+}BTC_LINK_CHANGE_TYPE,*PBTC_LINK_CHANGE_TYPE; -+ -+/* 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; -+ -+#define BTC_5G_BAND 0x80 -+ -+/*================================================== -+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; -+/*==================================================*/ -+ -+/* BTC_LINK_MODE same as WIFI_LINK_MODE */ -+typedef enum _BTC_LINK_MODE{ -+ BTC_LINK_NONE=0, -+ BTC_LINK_ONLY_GO, -+ BTC_LINK_ONLY_GC, -+ BTC_LINK_ONLY_STA, -+ BTC_LINK_ONLY_AP, -+ BTC_LINK_2G_MCC_GO_STA, -+ BTC_LINK_5G_MCC_GO_STA, -+ BTC_LINK_25G_MCC_GO_STA, -+ BTC_LINK_2G_MCC_GC_STA, -+ BTC_LINK_5G_MCC_GC_STA, -+ BTC_LINK_25G_MCC_GC_STA, -+ BTC_LINK_2G_SCC_GO_STA, -+ BTC_LINK_5G_SCC_GO_STA, -+ BTC_LINK_2G_SCC_GC_STA, -+ BTC_LINK_5G_SCC_GC_STA, -+ BTC_LINK_MAX=30 -+}BTC_LINK_MODE, *PBTC_LINK_MODE; -+ -+ -+struct btc_wifi_link_info { -+ BTC_LINK_MODE link_mode; /* LinkMode */ -+ u1Byte sta_center_channel; /* StaCenterChannel */ -+ u1Byte p2p_center_channel; /* P2PCenterChannel */ -+ BOOLEAN bany_client_join_go; -+ BOOLEAN benable_noa; -+ BOOLEAN bhotspot; -+}; -+ -+#if 0 -+typedef enum _BTC_MULTI_PORT_TDMA_MODE { -+ BTC_MULTI_PORT_TDMA_MODE_NONE=0, -+ BTC_MULTI_PORT_TDMA_MODE_2G_SCC_GO, -+ BTC_MULTI_PORT_TDMA_MODE_2G_P2P_GO, -+ BTC_MULTI_PORT_TDMA_MODE_2G_HOTSPOT_GO -+} BTC_MULTI_PORT_TDMA_MODE, *PBTC_MULTI_PORT_TDMA_MODE; -+ -+typedef struct btc_multi_port_tdma_info { -+ BTC_MULTI_PORT_TDMA_MODE btc_multi_port_tdma_mode; -+ u1Byte start_time_from_bcn; -+ u1Byte bt_time; -+} BTC_MULTI_PORT_TDMA_INFO, *PBTC_MULTI_PORT_TDMA_INFO; -+#endif -+ -+typedef enum _btc_concurrent_mode { -+ btc_concurrent_mode_none = 0, -+ btc_concurrent_mode_2g_go_miracast, -+ btc_concurrent_mode_2g_go_hotspot, -+ btc_concurrent_mode_2g_scc_go_miracast_sta, -+ btc_concurrent_mode_2g_scc_go_hotspot_sta, -+ btc_concurrent_mode_2g_gc, -+} btc_concurrent_mode, *pbtc_concurrent_mode; -+ -+struct btc_concurrent_setting { -+ btc_concurrent_mode btc_concurrent_mode; -+ u1Byte start_time_from_bcn; -+ u1Byte bt_time; -+}; -+ -+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 u4Byte -+(*BFP_BTC_R_LINDIRECT)( -+ IN PVOID pBtcContext, -+ IN u2Byte reg_addr -+ ); -+typedef u2Byte -+(*BFP_BTC_R_SCBD)( -+ IN PVOID pBtcContext, -+ IN pu2Byte score_board_val -+ ); -+typedef u4Byte -+(*BFP_BTC_R_SCBD_32BIT)( -+ IN PVOID pBtcContext, -+ IN pu4Byte score_board_val -+ ); -+typedef VOID -+(*BFP_BTC_W_SCBD)( -+ IN PVOID pBtcContext, -+ IN u2Byte bitpos, -+ IN BOOLEAN state -+ ); -+typedef VOID -+(*BFP_BTC_W_SCBD_32BIT)( -+ IN PVOID pBtcContext, -+ IN u4Byte bitpos, -+ IN BOOLEAN state -+ ); -+typedef VOID -+(*BFP_BTC_W_LINDIRECT)( -+ IN PVOID pBtcContext, -+ IN u2Byte reg_addr, -+ IN u4Byte bit_mask, -+ IN u4Byte reg_value -+ ); -+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 enum rf_path eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+typedef u4Byte -+(*BFP_BTC_GET_RF_REG)( -+ IN PVOID pBtcContext, -+ IN enum rf_path 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 u1Byte -+(*BFP_BTC_SET_TIMER) ( -+ IN PVOID pBtcContext, -+ IN u4Byte type, -+ IN u4Byte val -+ ); -+ -+typedef u4Byte -+(*BFP_BTC_SET_ATOMIC) ( -+ IN PVOID pBtcContext, -+ IN pu4Byte target, -+ IN u4Byte val -+ ); -+ -+ -+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 VOID -+(*BTC_REDUCE_WL_TX_POWER)( -+ IN PVOID pDM_Odm, -+ IN s1Byte tx_power -+ ); -+ -+typedef VOID -+(*BTC_PHYDM_MODIFY_ANTDIV_HWSW)( -+ IN PVOID pDM_Odm, -+ IN u1Byte 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; -+ u32 bt_real_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; -+}; -+ -+#ifdef CONFIG_RF4CE_COEXIST -+struct btc_rf4ce_info { -+ u8 link_state; -+}; -+#endif -+ -+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; -+ u32 cnt_rate_id_notify; -+ u32 cnt_halt_notify; -+ u32 cnt_pnp_notify; -+}; -+ -+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; -+ struct btc_wifi_link_info wifi_link_info; -+ struct btc_wifi_link_info_ext wifi_link_info_ext; -+ struct btc_coex_dm coex_dm; -+ struct btc_coex_sta coex_sta; -+ struct btc_rfe_type rfe_type; -+ const struct btc_chip_para *chip_para; -+ u8 wifi_black_bssid[6]; -+ u8 wifi_bssid[6]; -+ -+#ifdef CONFIG_RF4CE_COEXIST -+ struct btc_rf4ce_info rf4ce_info; -+#endif -+ 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]; -+ BOOLEAN dbg_mode; -+ BOOLEAN auto_report; -+ u8 chip_type; -+ BOOLEAN wl_rf_state_off; -+ -+ /* 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; -+ BFP_BTC_R_LINDIRECT btc_read_linderct; -+ BFP_BTC_W_LINDIRECT btc_write_linderct; -+ BFP_BTC_R_SCBD btc_read_scbd; -+ BFP_BTC_R_SCBD_32BIT btc_read_scbd_32bit; -+ BFP_BTC_W_SCBD btc_write_scbd; -+ BFP_BTC_W_SCBD_32BIT btc_write_scbd_32bit; -+ -+ /* 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; -+ BFP_BTC_SET_TIMER btc_set_timer; -+ BFP_BTC_SET_ATOMIC btc_set_atomic; -+ BTC_PHYDM_MODIFY_RA_PCR_THRESHLOD btc_phydm_modify_RA_PCR_threshold; -+ BTC_PHYDM_CMNINFOQUERY btc_phydm_query_PHY_counter; -+ BTC_REDUCE_WL_TX_POWER btc_reduce_wl_tx_power; -+ BTC_PHYDM_MODIFY_ANTDIV_HWSW btc_phydm_modify_antdiv_hwsw; -+ 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; -+ -+ union { -+ #ifdef CONFIG_RTL8822B -+ struct coex_dm_8822b_1ant coex_dm_8822b_1ant; -+ struct coex_dm_8822b_2ant coex_dm_8822b_2ant; -+ #endif /* 8822B */ -+ #ifdef CONFIG_RTL8821C -+ struct coex_dm_8821c_1ant coex_dm_8821c_1ant; -+ struct coex_dm_8821c_2ant coex_dm_8821c_2ant; -+ #endif /* 8821C */ -+ #ifdef CONFIG_RTL8723D -+ struct coex_dm_8723d_1ant coex_dm_8723d_1ant; -+ struct coex_dm_8723d_2ant coex_dm_8723d_2ant; -+ #endif /* 8723D */ -+ }; -+ -+ union { -+ #ifdef CONFIG_RTL8822B -+ struct coex_sta_8822b_1ant coex_sta_8822b_1ant; -+ struct coex_sta_8822b_2ant coex_sta_8822b_2ant; -+ #endif /* 8822B */ -+ #ifdef CONFIG_RTL8821C -+ struct coex_sta_8821c_1ant coex_sta_8821c_1ant; -+ struct coex_sta_8821c_2ant coex_sta_8821c_2ant; -+ #endif /* 8821C */ -+ #ifdef CONFIG_RTL8723D -+ struct coex_sta_8723d_1ant coex_sta_8723d_1ant; -+ struct coex_sta_8723d_2ant coex_sta_8723d_2ant; -+ #endif /* 8723D */ -+ }; -+ -+ union { -+ #ifdef CONFIG_RTL8822B -+ struct rfe_type_8822b_1ant rfe_type_8822b_1ant; -+ struct rfe_type_8822b_2ant rfe_type_8822b_2ant; -+ #endif /* 8822B */ -+ #ifdef CONFIG_RTL8821C -+ struct rfe_type_8821c_1ant rfe_type_8821c_1ant; -+ struct rfe_type_8821c_2ant rfe_type_8821c_2ant; -+ #endif /* 8821C */ -+ }; -+ -+ union { -+ #ifdef CONFIG_RTL8822B -+ struct wifi_link_info_8822b_1ant wifi_link_info_8822b_1ant; -+ struct wifi_link_info_8822b_2ant wifi_link_info_8822b_2ant; -+ #endif /* 8822B */ -+ #ifdef CONFIG_RTL8821C -+ struct wifi_link_info_8821c_1ant wifi_link_info_8821c_1ant; -+ struct wifi_link_info_8821c_2ant wifi_link_info_8821c_2ant; -+ #endif /* 8821C */ -+ }; -+ -+}; -+typedef struct btc_coexist *PBTC_COEXIST; -+ -+extern struct btc_coexist GLBtCoexist; -+ -+typedef void -+(*BFP_BTC_CHIP_SETUP)( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte setType -+ ); -+ -+struct btc_chip_para { -+ const char *chip_name; -+ u32 para_ver_date; -+ u32 para_ver; -+ u32 bt_desired_ver; -+ u32 wl_desired_ver; -+ boolean scbd_support; -+ u32 scbd_reg; -+ u8 scbd_bit_num; -+ boolean mailbox_support; -+ boolean lte_indirect_access; -+ boolean new_scbd10_def; /* TRUE: 1:fix 2M(8822c) */ -+ u8 indirect_type; /* 0:17xx, 1:7cx */ -+ u8 pstdma_type; /* 0: LPSoff, 1:LPSon */ -+ u8 bt_rssi_type; -+ u8 ant_isolation; -+ u8 rssi_tolerance; -+ u8 rx_path_num; -+ u8 wl_rssi_step_num; -+ const u8 *wl_rssi_step; -+ u8 bt_rssi_step_num; -+ const u8 *bt_rssi_step; -+ u8 table_sant_num; -+ const struct btc_coex_table_para *table_sant; -+ u8 table_nsant_num; -+ const struct btc_coex_table_para *table_nsant; -+ u8 tdma_sant_num; -+ const struct btc_tdma_para *tdma_sant; -+ u8 tdma_nsant_num; -+ const struct btc_tdma_para *tdma_nsant; -+ u8 wl_rf_para_tx_num; -+ const struct btc_rf_para *wl_rf_para_tx; -+ const struct btc_rf_para *wl_rf_para_rx; -+ u8 bt_afh_span_bw20; -+ u8 bt_afh_span_bw40; -+ u8 afh_5g_num; -+ const struct btc_5g_afh_map *afh_5g; -+ BFP_BTC_CHIP_SETUP chip_setup; -+}; -+ -+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 -+ ); -+u4Byte -+EXhalbtcoutsrc_CoexTimerCheck( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+u4Byte -+EXhalbtcoutsrc_WLStatusCheck( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_WlFwDbgInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtcoutsrc_rx_rate_change_notify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN is_data_frame, -+ IN u1Byte btc_rate_id -+ ); -+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_TimerNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte timer_type -+); -+VOID -+EXhalbtcoutsrc_WLStatusChangeNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte change_type -+); -+VOID -+EXhalbtcoutsrc_WL_RFK_Notify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte path, -+ IN u1Byte type, -+ IN u1Byte state -+ ); -+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 --git a/drivers/net/wireless/rtl8821cs/hal/btc/mp_precomp.h b/drivers/net/wireless/rtl8821cs/hal/btc/mp_precomp.h -new file mode 100644 -index 000000000..426454986 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/btc/mp_precomp.h -@@ -0,0 +1,168 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#include "btc_basic_types.h" -+ -+#define BT_TMP_BUF_SIZE 100 -+ -+#ifdef PLATFORM_LINUX -+#define rsprintf snprintf -+#define rstrncat(dst, src, src_size) strncat(dst, src, src_size) -+#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 -+ -+/* for wifi only mode */ -+#include "hal_btcoex_wifionly.h" -+ -+#ifdef CONFIG_BT_COEXIST -+#define BTC_BTINFO_LENGTH_MAX 10 -+ -+struct wifi_only_cfg; -+struct btc_coexist; -+ -+#ifdef CONFIG_RTL8192E -+#include "halbtc8192e1ant.h" -+#include "halbtc8192e2ant.h" -+#endif -+ -+#ifdef CONFIG_RTL8723B -+#include "halbtc8723bwifionly.h" -+#include "halbtc8723b1ant.h" -+#include "halbtc8723b2ant.h" -+#endif -+ -+#ifdef CONFIG_RTL8812A -+#include "halbtc8812a1ant.h" -+#include "halbtc8812a2ant.h" -+#endif -+ -+#ifdef CONFIG_RTL8821A -+#include "halbtc8821a1ant.h" -+#include "halbtc8821a2ant.h" -+#endif -+ -+#ifdef CONFIG_RTL8703B -+#include "halbtc8703b1ant.h" -+#endif -+ -+#ifdef CONFIG_RTL8723D -+#include "halbtc8723d1ant.h" -+#include "halbtc8723d2ant.h" -+#endif -+ -+#ifdef CONFIG_RTL8822B -+#include "halbtc8822bwifionly.h" -+#include "halbtc8822b1ant.h" -+#include "halbtc8822b2ant.h" -+#endif -+ -+#ifdef CONFIG_RTL8821C -+#include "halbtc8821cwifionly.h" -+#include "halbtc8821c1ant.h" -+#include "halbtc8821c2ant.h" -+#endif -+ -+#ifdef CONFIG_RTL8814A -+#include "halbtc8814a2ant.h" -+#endif -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+#include "halbtccommon.h" -+ -+#ifdef CONFIG_RTL8822C -+#include "halbtc8822cwifionly.h" -+#include "halbtc8822c.h" -+#endif -+ -+#ifdef CONFIG_RTL8723F -+#include "halbtc8723fwifionly.h" -+#include "halbtc8723f.h" -+#endif -+ -+#ifdef CONFIG_RTL8192F -+#include "halbtc8192f.h" -+#endif -+ -+#endif -+ -+#include "halbtcoutsrc.h" -+ -+#else /* CONFIG_BT_COEXIST */ -+ -+#ifdef CONFIG_RTL8723B -+#include "halbtc8723bwifionly.h" -+#endif -+ -+#ifdef CONFIG_RTL8822B -+#include "halbtc8822bwifionly.h" -+#endif -+ -+#ifdef CONFIG_RTL8821C -+#include "halbtc8821cwifionly.h" -+#endif -+ -+#ifdef CONFIG_RTL8822C -+#include "halbtc8822cwifionly.h" -+#endif -+ -+#ifdef CONFIG_RTL8723F -+#include "halbtc8723fwifionly.h" -+#endif -+ -+#ifdef CONFIG_RTL8814B -+#include "halbtc8814bwifionly.h" -+#endif -+ -+#endif /* CONFIG_BT_COEXIST */ -+ -+#endif /* __MP_PRECOMP_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/efuse/efuse_mask.h b/drivers/net/wireless/rtl8821cs/hal/efuse/efuse_mask.h -new file mode 100644 -index 000000000..dc4fdce2b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/efuse/efuse_mask.h -@@ -0,0 +1,188 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+ -+#ifdef CONFIG_USB_HCI -+ -+ #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_RTL8188GTV) -+ #include "rtl8188gtv/HalEfuseMask8188GTV_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8822B) -+ #include "rtl8822b/HalEfuseMask8822B_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8821C) -+ #include "rtl8821c/HalEfuseMask8821C_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8710B) -+ #include "rtl8710b/HalEfuseMask8710B_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8192F) -+ #include "rtl8192f/HalEfuseMask8192F_USB.h" -+ #endif -+ #if defined(CONFIG_RTL8822C) -+ #include "rtl8822c/HalEfuseMask8822C_USB.h" -+ #endif -+ #if defined(CONFIG_RTL8814B) -+ #include "rtl8814b/HalEfuseMask8814B_USB.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8723F) -+ #include "rtl8723f/HalEfuseMask8723F_USB.h" -+ #endif -+#endif /*CONFIG_USB_HCI*/ -+ -+#ifdef CONFIG_PCI_HCI -+ -+ #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 -+ #if defined(CONFIG_RTL8821C) -+ #include "rtl8821c/HalEfuseMask8821C_PCIE.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8192F) -+ #include "rtl8192f/HalEfuseMask8192F_PCIE.h" -+ #endif -+ #if defined(CONFIG_RTL8822C) -+ #include "rtl8822c/HalEfuseMask8822C_PCIE.h" -+ #endif -+ #if defined(CONFIG_RTL8814B) -+ #include "rtl8814b/HalEfuseMask8814B_PCIE.h" -+ #endif -+#endif /*CONFIG_PCI_HCI*/ -+#ifdef CONFIG_SDIO_HCI -+ #if defined(CONFIG_RTL8723B) -+ #include "rtl8723b/HalEfuseMask8723B_SDIO.h" -+ #endif -+ -+ #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_RTL8188GTV) -+ #include "rtl8188gtv/HalEfuseMask8188GTV_SDIO.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8723D) -+ #include "rtl8723d/HalEfuseMask8723D_SDIO.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8192E) -+ #include "rtl8192e/HalEfuseMask8192E_SDIO.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8821A) -+ #include "rtl8812a/HalEfuseMask8821A_SDIO.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8821C) -+ #include "rtl8821c/HalEfuseMask8821C_SDIO.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8822B) -+ #include "rtl8822b/HalEfuseMask8822B_SDIO.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8192F) -+ #include "rtl8192f/HalEfuseMask8192F_SDIO.h" -+ #endif -+ -+ -+ #if defined(CONFIG_RTL8822C) -+ #include "rtl8822c/HalEfuseMask8822C_SDIO.h" -+ #endif -+ -+ #if defined(CONFIG_RTL8723F) -+ #include "rtl8723f/HalEfuseMask8723F_SDIO.h" -+ #endif -+#endif /*CONFIG_SDIO_HCI*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_PCIE.c b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_PCIE.c -new file mode 100644 -index 000000000..cf15e47fe ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_PCIE.c -@@ -0,0 +1,95 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" */ -+ -+#include -+#include "HalEfuseMask8821C_PCIE.h" -+ -+ -+ -+/****************************************************************************** -+* MPCIE.TXT -+******************************************************************************/ -+ -+u8 Array_MP_8821C_MPCIE[] = { -+ 0xFF, -+ 0xF3, -+ 0xEF, -+ 0x9E, -+ 0x70, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x03, -+ 0xF7, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xF1, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ -+}; -+ -+u16 -+EFUSE_GetArrayLen_MP_8821C_MPCIE(void) -+{ -+ return sizeof(Array_MP_8821C_MPCIE) / sizeof(u8); -+} -+ -+void -+EFUSE_GetMaskArray_MP_8821C_MPCIE( -+ u8 *Array -+) -+{ -+ u16 len = EFUSE_GetArrayLen_MP_8821C_MPCIE(), i = 0; -+ -+ for (i = 0; i < len; ++i) -+ Array[i] = Array_MP_8821C_MPCIE[i]; -+} -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8821C_MPCIE( -+ u16 Offset -+) -+{ -+ int r = Offset / 16; -+ int c = (Offset % 16) / 2; -+ int result = 0; -+ -+ if (c < 4) /* Upper double word */ -+ result = (Array_MP_8821C_MPCIE[r] & (0x10 << c)); -+ else -+ result = (Array_MP_8821C_MPCIE[r] & (0x01 << (c - 4))); -+ -+ return (result > 0) ? 0 : 1; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_PCIE.h b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_PCIE.h -new file mode 100644 -index 000000000..2443e37d0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_PCIE.h -@@ -0,0 +1,34 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+ -+ -+ -+/****************************************************************************** -+* MPCIE.TXT -+******************************************************************************/ -+ -+ -+u16 -+EFUSE_GetArrayLen_MP_8821C_MPCIE(void); -+ -+void -+EFUSE_GetMaskArray_MP_8821C_MPCIE( -+ u8 *Array -+); -+ -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8821C_MPCIE(/* TC: Test Chip, MP: MP Chip */ -+ u16 Offset -+); -diff --git a/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_SDIO.c b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_SDIO.c -new file mode 100644 -index 000000000..1001ccd5f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_SDIO.c -@@ -0,0 +1,95 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" */ -+ -+#include -+#include "HalEfuseMask8821C_SDIO.h" -+ -+ -+ -+/****************************************************************************** -+* MSDIO.TXT -+******************************************************************************/ -+ -+u8 Array_MP_8821C_MSDIO[] = { -+ 0xFF, -+ 0xF3, -+ 0xEF, -+ 0x9E, -+ 0x70, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x03, -+ 0xF7, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ -+}; -+ -+u16 -+EFUSE_GetArrayLen_MP_8821C_MSDIO(void) -+{ -+ return sizeof(Array_MP_8821C_MSDIO) / sizeof(u8); -+} -+ -+void -+EFUSE_GetMaskArray_MP_8821C_MSDIO( -+ u8 *Array -+) -+{ -+ u16 len = EFUSE_GetArrayLen_MP_8821C_MSDIO(), i = 0; -+ -+ for (i = 0; i < len; ++i) -+ Array[i] = Array_MP_8821C_MSDIO[i]; -+} -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8821C_MSDIO( -+ u16 Offset -+) -+{ -+ int r = Offset / 16; -+ int c = (Offset % 16) / 2; -+ int result = 0; -+ -+ if (c < 4) /* Upper double word */ -+ result = (Array_MP_8821C_MSDIO[r] & (0x10 << c)); -+ else -+ result = (Array_MP_8821C_MSDIO[r] & (0x01 << (c - 4))); -+ -+ return (result > 0) ? 0 : 1; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_SDIO.h b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_SDIO.h -new file mode 100644 -index 000000000..a35da290a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_SDIO.h -@@ -0,0 +1,34 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+ -+ -+ -+/****************************************************************************** -+* MSDIO.TXT -+******************************************************************************/ -+ -+ -+u16 -+EFUSE_GetArrayLen_MP_8821C_MSDIO(void); -+ -+void -+EFUSE_GetMaskArray_MP_8821C_MSDIO( -+ u8 *Array -+); -+ -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8821C_MSDIO(/* TC: Test Chip, MP: MP Chip */ -+ u16 Offset -+); -diff --git a/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_USB.c b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_USB.c -new file mode 100644 -index 000000000..22b2355b4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_USB.c -@@ -0,0 +1,95 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" */ -+ -+#include -+#include "HalEfuseMask8821C_USB.h" -+ -+ -+ -+/****************************************************************************** -+* MUSB.TXT -+******************************************************************************/ -+ -+u8 Array_MP_8821C_MUSB[] = { -+ 0xFF, -+ 0xF3, -+ 0xEF, -+ 0x9E, -+ 0x70, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x03, -+ 0xF7, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xC0, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ -+}; -+ -+u16 -+EFUSE_GetArrayLen_MP_8821C_MUSB(void) -+{ -+ return sizeof(Array_MP_8821C_MUSB) / sizeof(u8); -+} -+ -+void -+EFUSE_GetMaskArray_MP_8821C_MUSB( -+ u8 *Array -+) -+{ -+ u16 len = EFUSE_GetArrayLen_MP_8821C_MUSB(), i = 0; -+ -+ for (i = 0; i < len; ++i) -+ Array[i] = Array_MP_8821C_MUSB[i]; -+} -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8821C_MUSB( -+ u16 Offset -+) -+{ -+ int r = Offset / 16; -+ int c = (Offset % 16) / 2; -+ int result = 0; -+ -+ if (c < 4) /* Upper double word */ -+ result = (Array_MP_8821C_MUSB[r] & (0x10 << c)); -+ else -+ result = (Array_MP_8821C_MUSB[r] & (0x01 << (c - 4))); -+ -+ return (result > 0) ? 0 : 1; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_USB.h b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_USB.h -new file mode 100644 -index 000000000..57f7e6878 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/efuse/rtl8821c/HalEfuseMask8821C_USB.h -@@ -0,0 +1,34 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+ -+ -+ -+/****************************************************************************** -+* MUSB.TXT -+******************************************************************************/ -+ -+ -+u16 -+EFUSE_GetArrayLen_MP_8821C_MUSB(void); -+ -+void -+EFUSE_GetMaskArray_MP_8821C_MUSB( -+ u8 *Array -+); -+ -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8821C_MUSB(/* TC: Test Chip, MP: MP Chip */ -+ u16 Offset -+); -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_btcoex.c b/drivers/net/wireless/rtl8821cs/hal/hal_btcoex.c -new file mode 100644 -index 000000000..32ef8ec74 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_btcoex.c -@@ -0,0 +1,6651 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+#ifdef CONFIG_BT_COEXIST -+ -+#include -+#include -+#include "btc/mp_precomp.h" -+ -+/* ************************************ -+ * 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", -+ "VHT80", -+ "VHT160" -+}; -+ -+const char *const GLBtcWifiFreqString[] = { -+ "2.4G", -+ "5G", -+ "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_SET_BT_TRX_MASK = 0x29, -+ 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_TYPE = 0x2d, -+ BT_OP_GET_BT_BLE_SCAN_PARA = 0x2e, -+ BT_OP_GET_BT_DEVICE_INFO = 0x30, -+ BT_OP_GET_BT_FORBIDDEN_SLOT_VAL = 0x31, -+ BT_OP_SET_BT_LANCONSTRAIN_LEVEL = 0x32, -+ BT_OP_SET_BT_TEST_MODE_VAL = 0x33, -+ 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]; -+u8 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 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 u8 halbtcoutsrc_LeaveLps(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ -+ pBtCoexist->bt_info.bt_ctrl_lps = _TRUE; -+ pBtCoexist->bt_info.bt_lps_on = _FALSE; -+ -+ return 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->hal_func.UpdateLPSStatusHandler( -+ padapter, -+ pPSC->RegLeisurePsMode, -+ pPSC->RegPowerSaveMode); -+#endif -+ } -+} -+ -+void halbtcoutsrc_Pre_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); -+ } -+} -+ -+void halbtcoutsrc_Post_NormalLps(PBTC_COEXIST pBtCoexist) -+{ -+ if (pBtCoexist->bt_info.bt_ctrl_lps) -+ pBtCoexist->bt_info.bt_ctrl_lps = _FALSE; -+} -+ -+/* -+ * 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; -+ systime 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_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 GET_HAL_DATA(padapter)->bFWReady; -+} -+ -+u8 halbtcoutsrc_IsDualBandConnected(PADAPTER padapter) -+{ -+ u8 ret = BTC_MULTIPORT_SCC; -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter) && (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC))) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ u8 band0 = mccobjpriv->iface[0]->mlmeextpriv.cur_channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; -+ u8 band1 = mccobjpriv->iface[1]->mlmeextpriv.cur_channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; -+ -+ if (band0 != band1) -+ ret = BTC_MULTIPORT_MCC_DUAL_BAND; -+ else -+ ret = BTC_MULTIPORT_MCC_DUAL_CHANNEL; -+ } -+#endif -+ -+ return ret; -+} -+ -+u8 halbtcoutsrc_IsWifiBusy(PADAPTER padapter) -+{ -+ if (rtw_mi_check_status(padapter, MI_AP_ASSOC)) -+ return _TRUE; -+ if (rtw_mi_busy_traffic_check(padapter)) -+ 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; -+} -+ -+struct btc_wifi_link_info halbtcoutsrc_getwifilinkinfo(PBTC_COEXIST pBtCoexist) -+{ -+ u8 n_assoc_iface = 0, i =0, mcc_en = _FALSE; -+ PADAPTER adapter = NULL; -+ PADAPTER iface = NULL; -+ PADAPTER sta_iface = NULL, p2p_iface = NULL, ap_iface = NULL; -+ BTC_LINK_MODE btc_link_moe = BTC_LINK_MAX; -+ struct dvobj_priv *dvobj = NULL; -+ struct mlme_ext_priv *mlmeext = NULL; -+ struct btc_wifi_link_info wifi_link_info; -+ -+ adapter = (PADAPTER)pBtCoexist->Adapter; -+ dvobj = adapter_to_dvobj(adapter); -+ n_assoc_iface = rtw_mi_get_assoc_if_num(adapter); -+ -+ /* init value */ -+ wifi_link_info.link_mode = BTC_LINK_NONE; -+ wifi_link_info.sta_center_channel = 0; -+ wifi_link_info.p2p_center_channel = 0; -+ wifi_link_info.bany_client_join_go = _FALSE; -+ wifi_link_info.benable_noa = _FALSE; -+ wifi_link_info.bhotspot = _FALSE; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ mlmeext = &iface->mlmeextpriv; -+ if (MLME_IS_GO(iface)) { -+ wifi_link_info.link_mode = BTC_LINK_ONLY_GO; -+ wifi_link_info.p2p_center_channel = -+ rtw_get_center_ch(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); -+ p2p_iface = iface; -+ if (rtw_linked_check(iface)) -+ wifi_link_info.bany_client_join_go = _TRUE; -+ } else if (MLME_IS_GC(iface)) { -+ wifi_link_info.link_mode = BTC_LINK_ONLY_GC; -+ wifi_link_info.p2p_center_channel = -+ rtw_get_center_ch(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); -+ p2p_iface = iface; -+ } else if (MLME_IS_AP(iface)) { -+ wifi_link_info.link_mode = BTC_LINK_ONLY_AP; -+ ap_iface = iface; -+ wifi_link_info.p2p_center_channel = -+ rtw_get_center_ch(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); -+ } else if (MLME_IS_STA(iface) && rtw_linked_check(iface)) { -+ wifi_link_info.link_mode = BTC_LINK_ONLY_STA; -+ wifi_link_info.sta_center_channel = -+ rtw_get_center_ch(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); -+ sta_iface = iface; -+ } -+ } -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(adapter)) { -+ if (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) -+ mcc_en = _TRUE; -+ } -+#endif/* CONFIG_MCC_MODE */ -+ -+ if (n_assoc_iface == 0) { -+ wifi_link_info.link_mode = BTC_LINK_NONE; -+ } else if (n_assoc_iface == 1) { -+ /* by pass */ -+ } else if (n_assoc_iface == 2) { -+ if (sta_iface && p2p_iface) { -+ u8 band_sta = sta_iface->mlmeextpriv.cur_channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; -+ u8 band_p2p = p2p_iface->mlmeextpriv.cur_channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; -+ if (band_sta == band_p2p) { -+ switch (band_sta) { -+ case BAND_ON_2_4G: -+ if (MLME_IS_GO(p2p_iface)) { -+ #ifdef CONFIG_MCC_MODE -+ wifi_link_info.link_mode = -+ mcc_en == _TRUE ? BTC_LINK_2G_MCC_GO_STA : BTC_LINK_2G_SCC_GO_STA; -+ #else /* !CONFIG_MCC_MODE */ -+ wifi_link_info.link_mode = BTC_LINK_2G_SCC_GO_STA; -+ #endif /* CONFIG_MCC_MODE */ -+ } else if (MLME_IS_GC(p2p_iface)) { -+ #ifdef CONFIG_MCC_MODE -+ wifi_link_info.link_mode = -+ mcc_en == _TRUE ? BTC_LINK_2G_MCC_GC_STA : BTC_LINK_2G_SCC_GC_STA; -+ #else /* !CONFIG_MCC_MODE */ -+ wifi_link_info.link_mode = BTC_LINK_2G_SCC_GC_STA; -+ #endif /* CONFIG_MCC_MODE */ -+ } -+ break; -+ case BAND_ON_5G: -+ if (MLME_IS_GO(p2p_iface)) { -+ #ifdef CONFIG_MCC_MODE -+ wifi_link_info.link_mode = -+ mcc_en == _TRUE ? BTC_LINK_5G_MCC_GO_STA : BTC_LINK_5G_SCC_GO_STA; -+ #else /* !CONFIG_MCC_MODE */ -+ wifi_link_info.link_mode = BTC_LINK_5G_SCC_GO_STA; -+ #endif /* CONFIG_MCC_MODE */ -+ } else if (MLME_IS_GC(p2p_iface)) { -+ #ifdef CONFIG_MCC_MODE -+ wifi_link_info.link_mode = -+ mcc_en == _TRUE ? BTC_LINK_5G_MCC_GC_STA : BTC_LINK_5G_SCC_GC_STA; -+ #else /* !CONFIG_MCC_MODE */ -+ wifi_link_info.link_mode = BTC_LINK_5G_SCC_GC_STA; -+ #endif /* CONFIG_MCC_MODE */ -+ } -+ break; -+ } -+ } else { -+ if (MLME_IS_GO(p2p_iface)) -+ wifi_link_info.link_mode = BTC_LINK_25G_MCC_GO_STA; -+ else if (MLME_IS_GC(p2p_iface)) -+ wifi_link_info.link_mode = BTC_LINK_25G_MCC_GC_STA; -+ } -+ } -+ -+ if (sta_iface && ap_iface) { -+ u8 band_sta = sta_iface->mlmeextpriv.cur_channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; -+ u8 band_ap = ap_iface->mlmeextpriv.cur_channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; -+ -+ if (band_sta == band_ap) { -+ switch (band_sta) { -+ case BAND_ON_2_4G: -+ #ifdef CONFIG_MCC_MODE -+ wifi_link_info.link_mode = -+ mcc_en == _TRUE ? BTC_LINK_2G_MCC_GO_STA : BTC_LINK_2G_SCC_GO_STA; -+ #else /* !CONFIG_MCC_MODE */ -+ wifi_link_info.link_mode = BTC_LINK_2G_SCC_GO_STA; -+ #endif /* CONFIG_MCC_MODE */ -+ break; -+ case BAND_ON_5G: -+ #ifdef CONFIG_MCC_MODE -+ wifi_link_info.link_mode = -+ mcc_en == _TRUE ? BTC_LINK_5G_MCC_GO_STA : BTC_LINK_5G_SCC_GO_STA; -+ #else /* !CONFIG_MCC_MODE */ -+ wifi_link_info.link_mode = BTC_LINK_5G_SCC_GO_STA; -+ #endif /* CONFIG_MCC_MODE */ -+ break; -+ } -+ } else { -+ wifi_link_info.link_mode = BTC_LINK_25G_MCC_GO_STA; -+ } -+ } -+ } else { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ RTW_ERR("%s do not support n_assoc_iface > 2 (ant_num == 1)", __func__); -+ } -+ -+ return wifi_link_info; -+} -+ -+ -+static void _btmpoper_timer_hdl(void *p) -+{ -+ if (GLBtcBtMpRptWait == _TRUE) { -+ GLBtcBtMpRptWait = _FALSE; -+ _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; -+ 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 = _TRUE; -+ GLBtcBtMpRptWiFiOK = _FALSE; -+ GLBtcBtMpRptBTOK = _FALSE; -+ 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_ex(&GLBtcBtMpOperTimer); -+ ret = BT_STATUS_H2C_FAIL; -+ goto exit; -+ } -+ -+ _rtw_down_sema(&GLBtcBtMpRptSema); -+ /* GLBtcBtMpRptWait should be _FALSE here*/ -+ -+ if (GLBtcBtMpRptWiFiOK == _FALSE) { -+ RTW_DBG("%s: Didn't get H2C Rsp Event!\n", __FUNCTION__); -+ ret = BT_STATUS_H2C_TIMTOUT; -+ goto exit; -+ } -+ if (GLBtcBtMpRptBTOK == _FALSE) { -+ 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 = le32_to_cpu(*(u32 *)GLBtcBtMpRptRsp); -+ pBtCoexist->bt_info.get_bt_fw_ver_cnt++; -+ } -+ -+ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ } else { -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ u8 dataLen = 2; -+ u8 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 */ -+ } -+ } -+ -+ return pBtCoexist->bt_info.bt_real_fw_ver; -+} -+ -+s32 halbtcoutsrc_GetWifiRssi(PADAPTER padapter) -+{ -+ return rtw_dm_get_min_rssi(padapter); -+} -+ -+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; -+} -+ -+u32 halbtcoutsrc_GetBtDeviceInfo(void *pBtcContext) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u32 ret = BT_STATUS_BT_OP_SUCCESS; -+ u32 btDeviceInfo = 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_DEVICE_INFO; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); -+ if (status == BT_STATUS_BT_OP_SUCCESS) -+ btDeviceInfo = 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 btDeviceInfo; -+} -+ -+u32 halbtcoutsrc_GetBtForbiddenSlotVal(void *pBtcContext) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u32 ret = BT_STATUS_BT_OP_SUCCESS; -+ u32 btForbiddenSlotVal = 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_FORBIDDEN_SLOT_VAL; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); -+ if (status == BT_STATUS_BT_OP_SUCCESS) -+ btForbiddenSlotVal = 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 btForbiddenSlotVal; -+} -+ -+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; -+} -+ -+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 -+ -+#ifdef CONFIG_RTL8821C -+ return RELEASE_VERSION_8821C; -+#endif -+ -+#ifdef CONFIG_RTL8192F -+ return RELEASE_VERSION_8192F; -+#endif -+ -+#ifdef CONFIG_RTL8822C -+ return RELEASE_VERSION_8822C; -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ return RELEASE_VERSION_8814A; -+#endif -+ -+#ifdef CONFIG_RTL8814B -+ return RELEASE_VERSION_8814B; -+#endif -+ -+#ifdef CONFIG_RTL8723F -+ return RELEASE_VERSION_8723F; -+#endif -+ -+} -+ -+u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ struct mlme_ext_priv *mlmeext; -+ struct btc_wifi_link_info *wifi_link_info; -+ u8 bSoftApExist, bVwifiExist; -+ u8 *pu8; -+ s32 *pS4Tmp; -+ u32 *pU4Tmp; -+ u8 *pU1Tmp; -+ u16 *pU2Tmp; -+ 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; -+ pU2Tmp = (u16*)pOutBuf; -+ wifi_link_info = (struct btc_wifi_link_info *)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_FW_READY: -+ *pu8 = halbtcoutsrc_is_fw_ready(pBtCoexist); -+ break; -+ -+ case BTC_GET_BL_WIFI_CONNECTED: -+ *pu8 = (rtw_mi_check_status(padapter, MI_LINKED)) ? _TRUE : _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_DUAL_BAND_CONNECTED: -+ *pu8 = halbtcoutsrc_IsDualBandConnected(padapter); -+ 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_UNDER_SURVEY)) ? _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_UNDER_SURVEY 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_BSSID: -+ _rtw_memcpy(pu8, get_bssid(&padapter->mlmepriv), ETH_ALEN); -+ break; -+ -+ case BTC_GET_BL_WIFI_UNDER_5G: -+ *pu8 = (pHalData->current_band_type == BAND_ON_5G) ? _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_BL_RF4CE_CONNECTED: -+#ifdef CONFIG_RF4CE_COEXIST -+ if (hal_btcoex_get_rf4ce_link_state() == 0) -+ *pu8 = FALSE; -+ else -+ *pu8 = TRUE; -+#else -+ *pu8 = FALSE; -+#endif -+ break; -+ -+ case BTC_GET_BL_WIFI_LW_PWR_STATE: -+ /* return false due to coex do not run during 32K */ -+ *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->current_channel_bw) { -+ 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] unknown bandwidth(%d)\n", pHalData->current_channel_bw); -+ *pU4Tmp = BTC_WIFI_BW_HT40; -+ break; -+ } -+ -+ } -+ break; -+ -+ case BTC_GET_U4_WIFI_TRAFFIC_DIRECTION: -+ case BTC_GET_U4_WIFI_TRAFFIC_DIR: -+ { -+ 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->firmware_version << 16; -+ *pU4Tmp |= pHalData->firmware_sub_version; -+ break; -+ -+ case BTC_GET_U4_WIFI_PHY_VER: -+ *pU4Tmp = halbtcoutsrc_GetPhydmVersion(pBtCoexist); -+ break; -+ -+ case BTC_GET_U4_WIFI_LINK_STATUS: -+ *pU4Tmp = halbtcoutsrc_GetWifiLinkStatus(pBtCoexist); -+ break; -+ case BTC_GET_BL_WIFI_LINK_INFO: -+ *wifi_link_info = halbtcoutsrc_getwifilinkinfo(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_BT_DEVICE_INFO: -+ *pU4Tmp = halbtcoutsrc_GetBtDeviceInfo(pBtCoexist); -+ break; -+ -+ case BTC_GET_U4_BT_FORBIDDEN_SLOT_VAL: -+ case BTC_GET_U4_BT_A2DP_FLUSH_VAL: -+ *pU4Tmp = halbtcoutsrc_GetBtForbiddenSlotVal(pBtCoexist); -+ break; -+ -+ case BTC_GET_U4_WIFI_IQK_TOTAL: -+ *pU4Tmp = pHalData->odmpriv.n_iqk_cnt; -+ break; -+ -+ case BTC_GET_U4_WIFI_IQK_OK: -+ *pU4Tmp = pHalData->odmpriv.n_iqk_ok_cnt; -+ break; -+ -+ case BTC_GET_U4_WIFI_IQK_FAIL: -+ *pU4Tmp = pHalData->odmpriv.n_iqk_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->current_channel; -+ 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 = (u8)BTC_ANT_TYPE_0; -+ pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_0; -+ break; -+ case 1: -+ *pU1Tmp = (u8)BTC_ANT_TYPE_1; -+ pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_1; -+ break; -+ case 2: -+ *pU1Tmp = (u8)BTC_ANT_TYPE_2; -+ pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_2; -+ break; -+ case 3: -+ *pU1Tmp = (u8)BTC_ANT_TYPE_3; -+ pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_3; -+ break; -+ case 4: -+ *pU1Tmp = (u8)BTC_ANT_TYPE_4; -+ pBtCoexist->board_info.ant_type = (u8)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; -+ -+ case BTC_GET_U2_BEACON_PERIOD: -+ *pU2Tmp = mlmeext->mlmext_info.bcn_interval; -+ break; -+ -+ default: -+ ret = _FALSE; -+ break; -+ } -+ -+ return ret; -+} -+ -+u16 halbtcoutsrc_LnaConstrainLvl(void *pBtcContext, u8 *lna_constrain_level) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u16 ret = BT_STATUS_BT_OP_SUCCESS; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { -+ _irqL irqL; -+ u8 op_code; -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ ret = _btmpoper_cmd(pBtCoexist, BT_OP_SET_BT_LANCONSTRAIN_LEVEL, 0, lna_constrain_level, 1); -+ -+ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ } else { -+ ret = BT_STATUS_NOT_IMPLEMENT; -+ RTW_INFO("%s halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == FALSE\n", __func__); -+ } -+ -+ return ret; -+} -+ -+u8 halbtcoutsrc_SetBtGoldenRxRange(void *pBtcContext, u8 profile, u8 range_shift) -+{ -+ /* wait for implementation if necessary */ -+ -+ return 0; -+} -+ -+u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ u8 *pu8; -+ u8 *pU1Tmp; -+ u16 *pU2Tmp; -+ u32 *pU4Tmp; -+ u8 ret; -+ u8 result = _TRUE; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return _FALSE; -+ -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ pu8 = (u8 *)pInBuf; -+ pU1Tmp = (u8 *)pInBuf; -+ pU2Tmp = (u16*)pInBuf; -+ pU4Tmp = (u32 *)pInBuf; -+ ret = _TRUE; -+ -+ 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_ENABLE_DISABLE_CHANGE: -+ pBtCoexist->bt_info.bt_enable_disable_change = *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: -+ result = 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_PRE_NORMAL_LPS: -+ halbtcoutsrc_Pre_NormalLps(pBtCoexist); -+ break; -+ -+ case BTC_SET_ACT_POST_NORMAL_LPS: -+ halbtcoutsrc_Post_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); -+ } -+ */ -+ 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 -+ { -+ u8 dataLen = *pU1Tmp; -+ u8 tmpBuf[BTC_TMP_BUF_SHORT]; -+ if (dataLen) -+ PlatformMoveMemory(&tmpBuf[0], pU1Tmp + 1, dataLen); -+ BT_Set8723bAnt(Adapter, dataLen, &tmpBuf[0]); -+ } -+#else -+ ret = _FALSE; -+#endif -+ break; -+ case BTC_SET_BL_BT_LNA_CONSTRAIN_LEVEL: -+ halbtcoutsrc_LnaConstrainLvl(pBtCoexist, pu8); -+ break; -+ case BTC_SET_BL_BT_GOLDEN_RX_RANGE: -+ halbtcoutsrc_SetBtGoldenRxRange(pBtCoexist, (*pU2Tmp & 0xff00) >> 8, (*pU2Tmp & 0xff)); -+ break; -+ case BTC_SET_RESET_COEX_VAR: -+ _rtw_memset(&pBtCoexist->coex_dm, 0x00, sizeof(pBtCoexist->coex_dm)); -+ _rtw_memset(&pBtCoexist->coex_sta, 0x00, sizeof(pBtCoexist->coex_sta)); -+ -+ switch(pBtCoexist->chip_type) { -+#ifdef CONFIG_RTL8822B -+ case BTC_CHIP_RTL8822B: -+ _rtw_memset(&pBtCoexist->coex_dm_8822b_1ant, 0x00, sizeof(pBtCoexist->coex_dm_8822b_1ant)); -+ _rtw_memset(&pBtCoexist->coex_dm_8822b_2ant, 0x00, sizeof(pBtCoexist->coex_dm_8822b_2ant)); -+ _rtw_memset(&pBtCoexist->coex_sta_8822b_1ant, 0x00, sizeof(pBtCoexist->coex_sta_8822b_1ant)); -+ _rtw_memset(&pBtCoexist->coex_sta_8822b_2ant, 0x00, sizeof(pBtCoexist->coex_sta_8822b_2ant)); -+ break; -+#endif -+#ifdef CONFIG_RTL8821C -+ case BTC_CHIP_RTL8821C: -+ _rtw_memset(&pBtCoexist->coex_dm_8821c_1ant, 0x00, sizeof(pBtCoexist->coex_dm_8821c_1ant)); -+ _rtw_memset(&pBtCoexist->coex_dm_8821c_2ant, 0x00, sizeof(pBtCoexist->coex_dm_8821c_2ant)); -+ _rtw_memset(&pBtCoexist->coex_sta_8821c_1ant, 0x00, sizeof(pBtCoexist->coex_sta_8821c_1ant)); -+ _rtw_memset(&pBtCoexist->coex_sta_8821c_2ant, 0x00, sizeof(pBtCoexist->coex_sta_8821c_2ant)); -+ break; -+#endif -+#ifdef CONFIG_RTL8723D -+ case BTC_CHIP_RTL8723D: -+ _rtw_memset(&pBtCoexist->coex_dm_8723d_1ant, 0x00, sizeof(pBtCoexist->coex_dm_8723d_1ant)); -+ _rtw_memset(&pBtCoexist->coex_dm_8723d_2ant, 0x00, sizeof(pBtCoexist->coex_dm_8723d_2ant)); -+ _rtw_memset(&pBtCoexist->coex_sta_8723d_1ant, 0x00, sizeof(pBtCoexist->coex_sta_8723d_1ant)); -+ _rtw_memset(&pBtCoexist->coex_sta_8723d_2ant, 0x00, sizeof(pBtCoexist->coex_sta_8723d_2ant)); -+ break; -+#endif -+ } -+ break; -+ /* ===================== */ -+ default: -+ ret = _FALSE; -+ break; -+ } -+ -+ return result; -+} -+ -+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, j; -+ u8 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; -+ u16 wifiBcnInterval = 0; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(padapter); -+ struct btc_wifi_link_info wifi_link_info; -+ -+ wifi_link_info = halbtcoutsrc_getwifilinkinfo(pBtCoexist); -+ -+ switch (wifi_link_info.link_mode) { -+ case BTC_LINK_NONE: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "None", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; -+ break; -+ case BTC_LINK_ONLY_GO: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "ONLY_GO", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; -+ break; -+ case BTC_LINK_ONLY_GC: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "ONLY_GC", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; -+ break; -+ case BTC_LINK_ONLY_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "ONLY_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; -+ break; -+ case BTC_LINK_ONLY_AP: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "ONLY_AP", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; -+ break; -+ case BTC_LINK_2G_MCC_GO_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "24G_MCC_GO_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = BTC_FREQ_2_4G; -+ break; -+ case BTC_LINK_5G_MCC_GO_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "5G_MCC_GO_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = BTC_FREQ_5G; -+ break; -+ case BTC_LINK_25G_MCC_GO_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "2BANDS_MCC_GO_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = BTC_FREQ_25G; -+ break; -+ case BTC_LINK_2G_MCC_GC_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "24G_MCC_GC_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = BTC_FREQ_2_4G; -+ break; -+ case BTC_LINK_5G_MCC_GC_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "5G_MCC_GC_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = BTC_FREQ_5G; -+ break; -+ case BTC_LINK_25G_MCC_GC_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "2BANDS_MCC_GC_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = BTC_FREQ_25G; -+ break; -+ case BTC_LINK_2G_SCC_GO_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "24G_SCC_GO_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = BTC_FREQ_2_4G; -+ break; -+ case BTC_LINK_5G_SCC_GO_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "5G_SCC_GO_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = BTC_FREQ_5G; -+ break; -+ case BTC_LINK_2G_SCC_GC_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "24G_SCC_GC_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = BTC_FREQ_2_4G; -+ break; -+ case BTC_LINK_5G_SCC_GC_STA: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "5G_SCC_GC_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = BTC_FREQ_5G; -+ break; -+ default: -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", -+ "UNKNOWN", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); -+ wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; -+ break; -+ } -+ -+ CL_PRINTF(cliBuf); -+ -+ 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/ "MAC_FMT"", "IOT Peer/BSSID", GLBtcIotPeerString[padapter->mlmeextpriv.mlmext_info.assoc_AP_vendor], MAC_ARG(get_bssid(&padapter->mlmepriv))); -+ CL_PRINTF(cliBuf); -+ } -+ -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U2_BEACON_PERIOD, &wifiBcnInterval); -+ wifiChnl = wifi_link_info.sta_center_channel; -+ wifiP2PChnl = wifi_link_info.p2p_center_channel; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dBm/ %d/ %d/ %d", "RSSI/ STA_Chnl/ P2P_Chnl/ BI", -+ wifiRssi-100, wifiChnl, wifiP2PChnl, wifiBcnInterval); -+ CL_PRINTF(cliBuf); -+ -+ 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); -+} -+ -+u32 halbtcoutsrc_WaitLIndirectReg_Ready(void *pBtcContext) -+{ -+ PBTC_COEXIST btc = (PBTC_COEXIST)pBtcContext; -+ u32 delay_count = 0, reg = 0; -+ -+ if (!btc->chip_para->lte_indirect_access) -+ return 0; -+ -+ switch (btc->chip_para->indirect_type) { -+ case BTC_INDIRECT_1700: -+ reg = 0x1703; -+ break; -+ case BTC_INDIRECT_7C0: -+ reg = 0x7C3; -+ break; -+ default: -+ return 0; -+ } -+ -+ /* wait for ready bit before access */ -+ while (1) { -+ if ((halbtcoutsrc_Read1Byte(btc, reg) & BIT(5)) == 0) { -+ rtw_mdelay_os(10); -+ if (++delay_count >= 10) -+ break; -+ } else { -+ break; -+ } -+ } -+ -+ return delay_count; -+} -+ -+u32 halbtcoutsrc_ReadLIndirectReg(void *pBtcContext, u16 reg_addr) -+{ -+ PBTC_COEXIST btc = (PBTC_COEXIST)pBtcContext; -+ u32 val = 0; -+ -+ if (!btc->chip_para->lte_indirect_access) -+ return 0; -+ -+ /* wait for ready bit before access */ -+ halbtcoutsrc_WaitLIndirectReg_Ready(btc); -+ -+ switch (btc->chip_para->indirect_type) { -+ case BTC_INDIRECT_1700: -+ halbtcoutsrc_Write4Byte(btc, 0x1700, 0x800F0000 | reg_addr); -+ val = halbtcoutsrc_Read4Byte(btc, 0x1708); /* get read data */ -+ break; -+ case BTC_INDIRECT_7C0: -+ halbtcoutsrc_Write4Byte(btc, 0x7c0, 0x800F0000 | reg_addr); -+ val = halbtcoutsrc_Read4Byte(btc, 0x7c8); /* get read data */ -+ break; -+ } -+ -+ return val; -+} -+ -+void halbtcoutsrc_WriteLIndirectReg(void *pBtcContext, u16 reg_addr, u32 bit_mask, u32 reg_value) -+{ -+ PBTC_COEXIST btc = (PBTC_COEXIST)pBtcContext; -+ u32 val, i = 0, bitpos = 0, reg0, reg1; -+ -+ if (!btc->chip_para->lte_indirect_access) -+ return; -+ -+ if (bit_mask == 0x0) -+ return; -+ -+ switch (btc->chip_para->indirect_type) { -+ case BTC_INDIRECT_1700: -+ reg0 = 0x1700; -+ reg1 = 0x1704; -+ break; -+ case BTC_INDIRECT_7C0: -+ reg0 = 0x7C0; -+ reg1 = 0x7C4; -+ break; -+ default: -+ return; -+ } -+ -+ if (bit_mask == 0xffffffff) { -+ /* wait for ready bit before access 0x1700 */ -+ halbtcoutsrc_WaitLIndirectReg_Ready(btc); -+ -+ /* put write data */ -+ halbtcoutsrc_Write4Byte(btc, reg1, reg_value); -+ halbtcoutsrc_Write4Byte(btc, reg0, 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 = halbtcoutsrc_ReadLIndirectReg(btc, reg_addr); -+ val = (val & (~bit_mask)) | (reg_value << bitpos); -+ -+ /* wait for ready bit before access 0x1700 */ -+ halbtcoutsrc_WaitLIndirectReg_Ready(btc); -+ -+ halbtcoutsrc_Write4Byte(btc, reg1, val); /* put write data */ -+ halbtcoutsrc_Write4Byte(btc, reg0, 0xc00F0000 | reg_addr); -+ } -+} -+ -+u16 halbtcoutsrc_Read_scbd(void *pBtcContext, u16* score_board_val) -+{ -+ PBTC_COEXIST btc = (PBTC_COEXIST)pBtcContext; -+ struct btc_coex_sta *coex_sta = &btc->coex_sta; -+ const struct btc_chip_para *chip_para = btc->chip_para; -+ -+ if (!chip_para->scbd_support) -+ return 0; -+ -+ *score_board_val = (btc->btc_read_2byte(btc, chip_para->scbd_reg)) -+ & 0x7fff; -+ coex_sta->score_board_BW = *score_board_val; -+ -+ return coex_sta->score_board_BW; -+} -+ -+u32 halbtcoutsrc_Read_scbd_32bit(void *pBtcContext, u32* score_board_val) -+{ -+ PBTC_COEXIST btc = (PBTC_COEXIST)pBtcContext; -+ struct btc_coex_sta *coex_sta = &btc->coex_sta; -+ const struct btc_chip_para *chip_para = btc->chip_para; -+ -+ if (!chip_para->scbd_support) -+ return 0; -+ -+ *score_board_val = (btc->btc_read_4byte(btc, chip_para->scbd_reg)) -+ & 0x7fffffff; -+ coex_sta->score_board_BW_32bit = *score_board_val; -+ -+ return coex_sta->score_board_BW_32bit; -+} -+ -+void halbtcoutsrc_Write_scbd(void *pBtcContext, u16 bitpos, u8 state) -+{ -+ PBTC_COEXIST btc = (PBTC_COEXIST)pBtcContext; -+ struct btc_coex_sta *coex_sta = &btc->coex_sta; -+ const struct btc_chip_para *chip_para = btc->chip_para; -+ u16 val = 0x2; -+ -+ if (!chip_para->scbd_support) -+ return; -+ -+ val = val | coex_sta->score_board_WB; -+ -+ /* for 8822b, Scoreboard[10]: 0: CQDDR off, 1: CQDDR on -+ * for 8822c, Scoreboard[10]: 0: CQDDR on, 1:CQDDR fix 2M -+ */ -+ if (!btc->chip_para->new_scbd10_def && (bitpos & BTC_SCBD_FIX2M)) { -+ if (state) -+ val = val & (~BTC_SCBD_FIX2M); -+ else -+ val = val | BTC_SCBD_FIX2M; -+ } else { -+ if (state) -+ val = val | bitpos; -+ else -+ val = val & (~bitpos); -+ } -+ -+ if (val != coex_sta->score_board_WB) { -+ coex_sta->score_board_WB = val; -+ val = val | 0x8000; -+ -+ btc->btc_write_2byte(btc, chip_para->scbd_reg, val); -+ -+ RTW_DBG("[BTC], write scoreboard 0x%x\n", val); -+ } else { -+ RTW_DBG("[BTC], return for nochange\n"); -+ } -+} -+ -+void halbtcoutsrc_Write_scbd_32bit(void *pBtcContext, u32 bitpos, u8 state) -+{ -+ PBTC_COEXIST btc = (PBTC_COEXIST)pBtcContext; -+ struct btc_coex_sta *coex_sta = &btc->coex_sta; -+ const struct btc_chip_para *chip_para = btc->chip_para; -+ u32 val = 0x2; -+ -+ if (!chip_para->scbd_support) -+ return; -+ -+ val = val | coex_sta->score_board_WB_32bit; -+ -+ /* for 8822b, Scoreboard[10]: 0: CQDDR off, 1: CQDDR on -+ * for 8822c, Scoreboard[10]: 0: CQDDR on, 1:CQDDR fix 2M -+ */ -+ if (!btc->chip_para->new_scbd10_def && (bitpos & BTC_SCBD_FIX2M)) { -+ if (state) -+ val = val & (~BTC_SCBD_FIX2M); -+ else -+ val = val | BTC_SCBD_FIX2M; -+ } else { -+ if (state) -+ val = val | bitpos; -+ else -+ val = val & (~bitpos); -+ } -+ -+ if (val != coex_sta->score_board_WB_32bit) { -+ coex_sta->score_board_WB_32bit = val; -+ val = val | 0x80000000; -+ -+ btc->btc_write_4byte(btc, chip_para->scbd_reg, val); -+ -+ RTW_DBG("[BTC], write scoreboard 0x%x\n", val); -+ } else { -+ RTW_DBG("[BTC], return for nochange\n"); -+ } -+} -+ -+void halbtcoutsrc_SetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ phy_set_bb_reg(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_query_bb_reg(padapter, RegAddr, BitMask); -+} -+ -+void halbtcoutsrc_SetRfReg(void *pBtcContext, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ phy_set_rf_reg(padapter, eRFPath, RegAddr, BitMask, Data); -+} -+ -+u32 halbtcoutsrc_GetRfReg(void *pBtcContext, enum rf_path eRFPath, u32 RegAddr, u32 BitMask) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return phy_query_rf_reg(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; -+ u8 btCanTx = 0; -+ BOOLEAN bStatus = FALSE; -+ -+ bStatus = NDBG_SetBtAntDetection(Adapter, txTime, btChnl, &btCanTx); -+ if (bStatus && btCanTx) -+ return _TRUE; -+ else -+ return _FALSE; -+#else -+ return _FALSE; -+#endif -+} -+ -+u8 halbtcoutsrc_SetBtTRXMASK(void *pBtcContext, u8 bt_trx_mask) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u8 bStatus = _FALSE; -+ u8 btCanTx = 0; -+ u16 ret = BT_STATUS_BT_OP_SUCCESS; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter) || IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter) -+ || IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { -+ u8 buf[3] = {0}; -+ u8 len = 0; -+ _irqL irqL; -+ u8 op_code; -+ u8 status; -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ buf[0] = bt_trx_mask; -+ len = 1; -+ } else { -+ buf[0] = (bt_trx_mask & 0x80) >> 7; -+ buf[1] = bt_trx_mask & 0x7f; -+ len = 2; -+ } -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ op_code = BT_OP_SET_BT_TRX_MASK; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, len); -+ 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; -+ } -+ -+ if (ret == BT_STATUS_BT_OP_SUCCESS) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+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; -+} -+ -+u16 halbtcoutsrc_setbttestmode(void *pBtcContext, u8 Type) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u16 ret = BT_STATUS_BT_OP_SUCCESS; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { -+ _irqL irqL; -+ u8 op_code; -+ u8 status; -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ Type = cpu_to_le32(Type); -+ op_code = BT_OP_SET_BT_TEST_MODE_VAL; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, (u8 *)&Type, 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; -+ -+} -+ -+ -+void halbtcoutsrc_FillH2cCmd(void *pBtcContext, u8 elementId, u32 cmdLen, u8 *pCmdBuffer) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ s32 ret = 0; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ ret = rtw_hal_fill_h2c_cmd(padapter, elementId, cmdLen, pCmdBuffer); -+ -+#ifdef CONFIG_RTL8192F -+ if (ret == _SUCCESS) { -+ switch (elementId) { -+ case H2C_BT_INFO: -+ case H2C_BT_IGNORE_WLANACT: -+ case H2C_WL_OPMODE: -+ case H2C_BT_MP_OPER: -+ case H2C_BT_CONTROL: -+ rtw_msleep_os(20); -+ break; -+ } -+ } -+#endif -+} -+ -+static void halbtcoutsrc_coex_offload_init(void) -+{ -+ u8 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), (u8 *)(pcol_h2c), (u32)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((void *)&gl_coex_offload.h2c_record[opcode].h2c_buf[0], (void *)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; -+ u8 AntDetVal = 0x0; -+ u8 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; -+ -+ buf[0] = scanType; -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ op_code = BT_OP_GET_BT_BLE_SCAN_PARA; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 1); -+ 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; -+} -+ -+u8 halbtcoutsrc_SetTimer(void *pBtcContext, u32 type, u32 val) -+{ -+ struct btc_coexist *pBtCoexist=(struct btc_coexist *)pBtcContext; -+ -+ if (type >= BTC_TIMER_MAX) -+ return _FALSE; -+ -+ pBtCoexist->coex_sta.cnt_timer[type] = val; -+ -+ RTW_DBG("[BTC], Set Timer: type = %d, val = %d\n", type, val); -+ -+ return _TRUE; -+} -+ -+u32 halbtcoutsrc_SetAtomic (void *btc_ctx, u32 *target, u32 val) -+{ -+ *target = val; -+ return _SUCCESS; -+} -+ -+void halbtcoutsrc_phydm_modify_AntDiv_HwSw(void *pBtcContext, u8 is_hw) -+{ -+ /* empty function since we don't need it */ -+} -+ -+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_cmn_info_query((struct dm_struct *)pBtCoexist->odm_priv, (enum phydm_info_query)info_type); -+#else -+ return 0; -+#endif -+} -+ -+void halbtcoutsrc_reduce_wl_tx_power(void *pBtcContext, s8 tx_power) -+{ -+ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA((PADAPTER)pBtCoexist->Adapter); -+ -+ /* The reduction of wl tx pwr should be processed inside the set tx pwr lvl function */ -+ if (IS_HARDWARE_TYPE_8822C(pBtCoexist->Adapter) || IS_HARDWARE_TYPE_8723F(pBtCoexist->Adapter)) -+ rtw_hal_set_tx_power_level(pBtCoexist->Adapter, pHalData->current_channel); -+} -+ -+#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 = (u8)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 = (u8)H2C_ACK_HDR_GET_H2C_CMD_ID(Buffer); -+ h2cSubCmdId = (u8)H2C_ACK_HDR_GET_H2C_SUB_CMD_ID(Buffer); -+ if (h2cCmdId == 0xff && h2cSubCmdId == 0x60) { -+ c2hAckLen = (u8)C2H_HDR_GET_LEN(Buffer); -+ if (c2hAckLen >= 8) -+ BT_CoexOffloadC2hAckCheck(Adapter, &Buffer[12], (u8)(c2hAckLen - 8)); -+ else -+ BT_CoexOffloadRecordErrC2hAck(Adapter); -+ } -+ } else if (c2hSubCmdId == C2H_SUB_CMD_ID_BT_COEX_INFO) { -+ /* coex c2h indication */ -+ c2hIndLen = (u8)C2H_HDR_GET_LEN(Buffer); -+ BT_CoexOffloadC2hIndCheck(Adapter, &Buffer[4], (u8)c2hIndLen); -+ } -+ } -+#endif -+} -+#endif -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+static void halbtcoutsrc_wl_noisy_detect(struct btc_coexist *btc) -+{ -+ struct btc_coex_sta *coex_sta = &btc->coex_sta; -+ u32 cnt_cck, ok_11b, err_11b; -+ -+ ok_11b = btc->btc_phydm_query_PHY_counter(btc, PHYDM_INFO_CRC32_OK_CCK); -+ err_11b = btc->btc_phydm_query_PHY_counter(btc, -+ PHYDM_INFO_CRC32_ERROR_CCK); -+ -+ /* WiFi environment noisy identification */ -+ cnt_cck = ok_11b + err_11b; -+ -+ if (!coex_sta->wl_gl_busy && !coex_sta->wl_cck_lock) { -+ if (cnt_cck > 250) { -+ if (coex_sta->cnt_wl[BTC_CNT_WL_NOISY2] < 5) -+ coex_sta->cnt_wl[BTC_CNT_WL_NOISY2]++; -+ -+ if (coex_sta->cnt_wl[BTC_CNT_WL_NOISY2] == 5) { -+ coex_sta->cnt_wl[BTC_CNT_WL_NOISY0] = 0; -+ coex_sta->cnt_wl[BTC_CNT_WL_NOISY1] = 0; -+ } -+ } else if (cnt_cck < 100) { -+ if (coex_sta->cnt_wl[BTC_CNT_WL_NOISY0] < 5) -+ coex_sta->cnt_wl[BTC_CNT_WL_NOISY0]++; -+ -+ if (coex_sta->cnt_wl[BTC_CNT_WL_NOISY0] == 5) { -+ coex_sta->cnt_wl[BTC_CNT_WL_NOISY1] = 0; -+ coex_sta->cnt_wl[BTC_CNT_WL_NOISY2] = 0; -+ } -+ } else { -+ if (coex_sta->cnt_wl[BTC_CNT_WL_NOISY1] < 5) -+ coex_sta->cnt_wl[BTC_CNT_WL_NOISY1]++; -+ -+ if (coex_sta->cnt_wl[BTC_CNT_WL_NOISY1] == 5) { -+ coex_sta->cnt_wl[BTC_CNT_WL_NOISY0] = 0; -+ coex_sta->cnt_wl[BTC_CNT_WL_NOISY2] = 0; -+ } -+ } -+ -+ if (coex_sta->cnt_wl[BTC_CNT_WL_NOISY2] == 5) -+ coex_sta->wl_noisy_level = 2; -+ else if (coex_sta->cnt_wl[BTC_CNT_WL_NOISY1] == 5) -+ coex_sta->wl_noisy_level = 1; -+ else -+ coex_sta->wl_noisy_level = 0; -+ -+ RTW_DBG("[BTC], wl_noisy_level = %d\n", -+ coex_sta->wl_noisy_level); -+ } -+} -+ -+static boolean halbtcoutsrc_btc_monitor_bt_ctr(struct btc_coexist *btc) -+{ -+ struct btc_coex_sta *coex_sta = &btc->coex_sta; -+ struct btc_coex_dm *coex_dm = &btc->coex_dm; -+ u32 cnt_bt_hi_pri, cnt_bt_lo_pri, cnt_bt_all; -+ boolean is_run_coex = _FALSE; -+ -+ cnt_bt_hi_pri = btc->btc_read_4byte(btc, REG_BT_ACT_STATISTICS); -+ coex_sta->hi_pri_tx = cnt_bt_hi_pri & MASKLWORD; -+ coex_sta->hi_pri_rx = (cnt_bt_hi_pri & MASKHWORD) >> 16; -+ -+ cnt_bt_lo_pri = btc->btc_read_4byte(btc, REG_BT_ACT_STATISTICS_1); -+ coex_sta->lo_pri_tx = cnt_bt_lo_pri & MASKLWORD; -+ coex_sta->lo_pri_rx = (cnt_bt_lo_pri & MASKHWORD) >> 16; -+ -+ RTW_DBG("[BTC], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ coex_sta->hi_pri_rx, coex_sta->hi_pri_tx, -+ coex_sta->lo_pri_rx, coex_sta->lo_pri_tx); -+ -+ /* reset counter */ -+ btc->btc_write_1byte(btc, 0x76e, 0xc); -+ -+ if (coex_sta->wl_under_lps || coex_sta->wl_under_ips || -+ (coex_sta->hi_pri_rx == 65535 && coex_sta->hi_pri_tx == 65535 && -+ coex_sta->lo_pri_rx == 65535 && coex_sta->lo_pri_tx == 65535)) -+ coex_sta->bt_ctr_ok = _FALSE; -+ else -+ coex_sta->bt_ctr_ok = _TRUE; -+ -+ if (!coex_sta->bt_ctr_ok) -+ return _FALSE; -+ -+ if (coex_sta->hi_pri_rx == 0 && coex_sta->hi_pri_tx == 0 && -+ coex_sta->lo_pri_rx == 0 && coex_sta->lo_pri_tx == 0) { -+ coex_sta->cnt_bt[BTC_CNT_BT_DISABLE]++; -+ -+ if (coex_sta->cnt_bt[BTC_CNT_BT_DISABLE] > 2) -+ coex_sta->cnt_bt[BTC_CNT_BT_DISABLE] = 2; -+ } else { -+ coex_sta->cnt_bt[BTC_CNT_BT_DISABLE] = 0; -+ } -+ -+ cnt_bt_all = coex_sta->hi_pri_rx + coex_sta->hi_pri_tx + -+ coex_sta->lo_pri_rx + coex_sta->lo_pri_tx; -+ -+ if ((coex_sta->cnt_bt[BTC_CNT_BT_TRX] > (cnt_bt_all + 50) || -+ cnt_bt_all > (coex_sta->cnt_bt[BTC_CNT_BT_TRX] + 50)) && -+ coex_dm->bt_status == BTC_BTSTATUS_NCON_IDLE) -+ is_run_coex = _TRUE; -+ -+ coex_sta->cnt_bt[BTC_CNT_BT_TRX] = cnt_bt_all; -+ -+ return is_run_coex; -+} -+#endif -+ -+/* ************************************ -+ * Extern functions called by other module -+ * ************************************ */ -+u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ 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 = (void *)&(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; -+ -+ /* for btc common architecture, inform chip type to coex. mechanism */ -+ if(IS_HARDWARE_TYPE_8822C(padapter)) { -+#ifdef CONFIG_RTL8822C -+ pBtCoexist->chip_type = BTC_CHIP_RTL8822C; -+ pBtCoexist->chip_para = &btc_chip_para_8822c; -+#endif -+ } -+#ifdef CONFIG_RTL8192F -+ else if (IS_HARDWARE_TYPE_8192F(padapter)) { -+ pBtCoexist->chip_type = BTC_CHIP_RTL8725A; -+ pBtCoexist->chip_para = &btc_chip_para_8192f; -+ } -+#endif -+#ifdef PLATFORM_LINUX -+#ifdef CONFIG_RTL8723F -+ else if (IS_HARDWARE_TYPE_8723F(padapter)) { -+ pBtCoexist->chip_type = BTC_CHIP_RTL8723F; -+ pBtCoexist->chip_para = &btc_chip_para_8723f; -+ } -+#endif -+#endif -+ else { -+ pBtCoexist->chip_type = BTC_CHIP_UNDEF; -+ pBtCoexist->chip_para = NULL; -+ } -+ -+ return _TRUE; -+} -+ -+void EXhalbtcoutsrc_AntInfoSetting(void *padapter) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ u8 antNum = 1, singleAntPath = 0; -+ -+ 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); -+ } -+ -+ pBtCoexist->board_info.customerID = RT_CID_DEFAULT; -+ pBtCoexist->board_info.customer_id = RT_CID_DEFAULT; -+ -+ /* 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.rfe_type = rtw_btcoex_get_pg_rfe_type((PADAPTER)padapter); -+ -+ pBtCoexist->board_info.ant_div_cfg = rtw_btcoex_get_ant_div_cfg((PADAPTER)padapter); -+ -+ pBtCoexist->board_info.ant_distance = 10; -+} -+ -+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_read_linderct = halbtcoutsrc_ReadLIndirectReg; -+ pBtCoexist->btc_write_linderct = halbtcoutsrc_WriteLIndirectReg; -+ -+ pBtCoexist->btc_read_scbd = halbtcoutsrc_Read_scbd; -+ pBtCoexist->btc_read_scbd_32bit = halbtcoutsrc_Read_scbd_32bit; -+ pBtCoexist->btc_write_scbd = halbtcoutsrc_Write_scbd; -+ pBtCoexist->btc_write_scbd_32bit = halbtcoutsrc_Write_scbd_32bit; -+ -+ 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_set_timer = halbtcoutsrc_SetTimer; -+ pBtCoexist->btc_set_atomic= halbtcoutsrc_SetAtomic; -+ 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->btc_reduce_wl_tx_power = halbtcoutsrc_reduce_wl_tx_power; -+ pBtCoexist->btc_phydm_modify_antdiv_hwsw = halbtcoutsrc_phydm_modify_AntDiv_HwSw; -+ -+ 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); -+ rtw_init_timer(&GLBtcBtMpOperTimer, padapter, _btmpoper_timer_hdl, pBtCoexist); -+ _rtw_init_sema(&GLBtcBtMpRptSema, 0); -+ GLBtcBtMpRptSeq = 0; -+ GLBtcBtMpRptStatus = 0; -+ _rtw_memset(GLBtcBtMpRptRsp, 0, C2H_MAX_SIZE); -+ GLBtcBtMpRptRspSize = 0; -+ GLBtcBtMpRptWait = _FALSE; -+ GLBtcBtMpRptWiFiOK = _FALSE; -+ GLBtcBtMpRptBTOK = _FALSE; -+ -+ 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); -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_power_on_setting(pBtCoexist); -+ -+#else -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8723B -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_power_on_setting(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ else 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821A -+ else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_power_on_setting(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_power_on_setting(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if ((IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) && (pHalData->EEPROMBluetoothCoexist == _TRUE)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_power_on_setting(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_power_on_setting(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ else 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_power_on_setting(pBtCoexist); -+ /* else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8814a1ant_power_on_setting(pBtCoexist); */ -+ } -+#endif -+ -+#endif -+} -+ -+void EXhalbtcoutsrc_PreLoadFirmware(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_pre_load_firmware++; -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8723B -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723D -+ else 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ else 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); -+ } -+#endif -+} -+ -+void EXhalbtcoutsrc_init_hw_config(PBTC_COEXIST pBtCoexist, u8 bWifiOnly) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_init_hw_config++; -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_init_hw_config(pBtCoexist, bWifiOnly); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ 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 (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } -+#endif -+ -+#endif -+} -+ -+void EXhalbtcoutsrc_init_coex_dm(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_init_coex_dm++; -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_init_coex_dm(pBtCoexist); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_init_coex_dm(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_init_coex_dm(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_init_coex_dm(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_init_coex_dm(pBtCoexist); -+ } -+#endif -+ -+#endif -+ -+ 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 (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_ips_notify(pBtCoexist, ipsType); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_ips_notify(pBtCoexist, ipsType); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_ips_notify(pBtCoexist, ipsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_ips_notify(pBtCoexist, ipsType); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_ips_notify(pBtCoexist, ipsType); -+ } -+#endif -+ -+#endif -+ /* 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 (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_lps_notify(pBtCoexist, lpsType); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_lps_notify(pBtCoexist, lpsType); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_lps_notify(pBtCoexist, lpsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_lps_notify(pBtCoexist, lpsType); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_lps_notify(pBtCoexist, lpsType); -+ } -+#endif -+ -+#endif -+} -+ -+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 (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_scan_notify(pBtCoexist, scanType); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_scan_notify(pBtCoexist, scanType); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_scan_notify(pBtCoexist, scanType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_scan_notify(pBtCoexist, scanType); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_scan_notify(pBtCoexist, scanType); -+ } -+#endif -+ -+#endif -+ -+ /* 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 assoType) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cnt_connect_notify++; -+ if (pBtCoexist->manual_control) -+ return; -+ -+ /* All notify is called in cmd thread, don't need to leave low power again -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_connect_notify(pBtCoexist, assoType); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_connect_notify(pBtCoexist, assoType); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_connect_notify(pBtCoexist, assoType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_connect_notify(pBtCoexist, assoType); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_connect_notify(pBtCoexist, assoType); -+ } -+#endif -+ -+#endif -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_media_status_notify(PBTC_COEXIST pBtCoexist, RT_MEDIA_STATUS mediaStatus) -+{ -+ u8 mStatus = BTC_MEDIA_MAX; -+ PADAPTER adapter = NULL; -+ HAL_DATA_TYPE *hal = NULL; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ if (pBtCoexist->manual_control) -+ return; -+ -+ pBtCoexist->statistics.cnt_media_status_notify++; -+ adapter = (PADAPTER)pBtCoexist->Adapter; -+ hal = GET_HAL_DATA(adapter); -+ -+ if (RT_MEDIA_CONNECT == mediaStatus) { -+ if (hal->current_band_type == BAND_ON_2_4G) -+ mStatus = BTC_MEDIA_CONNECT; -+ else if (hal->current_band_type == BAND_ON_5G) -+ mStatus = BTC_MEDIA_CONNECT_5G; -+ else { -+ mStatus = BTC_MEDIA_CONNECT; -+ RTW_ERR("%s unknow band type\n", __func__); -+ } -+ } else -+ mStatus = BTC_MEDIA_DISCONNECT; -+ -+ /* All notify is called in cmd thread, don't need to leave low power again -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_media_status_notify(pBtCoexist, mStatus); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ /* compatible for 8821A */ -+ if (mStatus == BTC_MEDIA_CONNECT_5G) -+ mStatus = BTC_MEDIA_CONNECT; -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_media_status_notify(pBtCoexist, mStatus); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ /* compatible for 8812A */ -+ if (mStatus == BTC_MEDIA_CONNECT_5G) -+ mStatus = BTC_MEDIA_CONNECT; -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ 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 (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_media_status_notify(pBtCoexist, mStatus); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_media_status_notify(pBtCoexist, mStatus); -+ } -+#endif -+ -+#endif -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_specific_packet_notify(PBTC_COEXIST pBtCoexist, u8 pktType) -+{ -+ u8 packetType; -+ PADAPTER adapter = NULL; -+ HAL_DATA_TYPE *hal = NULL; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ if (pBtCoexist->manual_control) -+ return; -+ -+ pBtCoexist->statistics.cnt_specific_packet_notify++; -+ adapter = (PADAPTER)pBtCoexist->Adapter; -+ hal = GET_HAL_DATA(adapter); -+ -+ 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; -+ } -+ -+ if (hal->current_band_type == BAND_ON_5G) -+ packetType |= BTC_5G_BAND; -+ -+ /* All notify is called in cmd thread, don't need to leave low power again -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_specific_packet_notify(pBtCoexist, packetType); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ /* compatible for 8821A */ -+ if (hal->current_band_type == BAND_ON_5G) -+ packetType &= ~BTC_5G_BAND; -+ -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_specific_packet_notify(pBtCoexist, packetType); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ /* compatible for 8812A */ -+ if (hal->current_band_type == BAND_ON_5G) -+ packetType &= ~BTC_5G_BAND; -+ -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ 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 (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_specific_packet_notify(pBtCoexist, packetType); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_specific_packet_notify(pBtCoexist, packetType); -+ } -+#endif -+ -+#endif -+ -+ /* 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 (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_bt_info_notify(pBtCoexist, tmpBuf, length); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ 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 (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } -+#endif -+ -+#endif -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_WlFwDbgInfoNotify(PBTC_COEXIST pBtCoexist, u8* tmpBuf, u8 length) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); -+#else -+ -+ if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8703B -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723D -+ else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); -+ } -+#endif -+ -+#endif -+} -+ -+void EXhalbtcoutsrc_rx_rate_change_notify(PBTC_COEXIST pBtCoexist, u8 is_data_frame, u8 btc_rate_id) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_rate_id_notify++; -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); -+#else -+ -+ if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8703B -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723D -+ else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); -+ } -+#endif -+ -+#endif -+} -+ -+void -+EXhalbtcoutsrc_RfStatusNotify( -+ PBTC_COEXIST pBtCoexist, -+ u8 type -+) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cnt_rf_status_notify++; -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_rf_status_notify(pBtCoexist, type); -+#else -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8723B -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_rf_status_notify(pBtCoexist, type); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_rf_status_notify(pBtCoexist, type); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_rf_status_notify(pBtCoexist, type); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ 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 (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_rf_status_notify(pBtCoexist, type); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_rf_status_notify(pBtCoexist, type); -+ } -+#endif -+ -+#endif -+} -+ -+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; -+ -+ pBtCoexist->statistics.cnt_halt_notify++; -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_halt_notify(pBtCoexist); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_halt_notify(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_halt_notify(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_halt_notify(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_halt_notify(pBtCoexist); -+ } -+#endif -+ -+#endif -+} -+ -+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; -+ -+ pBtCoexist->statistics.cnt_pnp_notify++; -+ -+ /* */ -+ /* 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 (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_pnp_notify(pBtCoexist, pnpState); -+#else -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8723B -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_pnp_notify(pBtCoexist, pnpState); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821A -+ else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_pnp_notify(pBtCoexist, pnpState); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_pnp_notify(pBtCoexist, pnpState); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_pnp_notify(pBtCoexist, pnpState); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_pnp_notify(pBtCoexist, pnpState); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_pnp_notify(pBtCoexist, pnpState); -+ } -+#endif -+ -+#endif -+} -+ -+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)) { -+#ifdef CONFIG_RTL8723B -+ 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; -+ } -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723D -+ 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; -+ } -+ } -+#endif -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+void EXhalbtcoutsrc_TimerNotify(PBTC_COEXIST pBtCoexist, u32 timer_type) -+{ -+ rtw_btc_ex_timerup_notify(pBtCoexist, timer_type); -+} -+ -+void EXhalbtcoutsrc_WLStatusChangeNotify(PBTC_COEXIST pBtCoexist, u32 change_type) -+{ -+ rtw_btc_ex_wl_status_change_notify(pBtCoexist, change_type); -+} -+ -+u32 EXhalbtcoutsrc_CoexTimerCheck(PBTC_COEXIST pBtCoexist) -+{ -+ u32 i, timer_map = 0; -+ -+ for (i = 0; i < BTC_TIMER_MAX; i++) { -+ if (pBtCoexist->coex_sta.cnt_timer[i] > 0) { -+ if (pBtCoexist->coex_sta.cnt_timer[i] == 1) { -+ timer_map |= BIT(i); -+ RTW_DBG("[BTC], %s(): timer_map = 0x%x\n", __func__, timer_map); -+ } -+ -+ pBtCoexist->coex_sta.cnt_timer[i]--; -+ } -+ } -+ -+ return timer_map; -+} -+ -+u32 EXhalbtcoutsrc_WLStatusCheck(PBTC_COEXIST pBtCoexist) -+{ -+ struct btc_wifi_link_info link_info; -+ struct btc_coex_sta *coex_sta = &pBtCoexist->coex_sta; -+ const struct btc_chip_para *chip_para = pBtCoexist->chip_para; -+ u32 change_map = 0; -+ static bool wl_busy_pre; -+ bool wl_busy = _FALSE, bt_ctr_change = _FALSE; -+ s32 wl_rssi; -+ u32 traffic_dir; -+ u8 i, tmp; -+ static u8 rssi_step_pre = 5, wl_noisy_level_pre = 4; -+ -+ halbtcoutsrc_wl_noisy_detect(pBtCoexist); -+ bt_ctr_change = halbtcoutsrc_btc_monitor_bt_ctr(pBtCoexist); -+ -+ /* WL busy to idle or idle to busy */ -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &wl_busy); -+ if (wl_busy != wl_busy_pre) { -+ if (wl_busy) -+ change_map |= BIT(BTC_WLSTATUS_CHANGE_TOBUSY); -+ else -+ change_map |= BIT(BTC_WLSTATUS_CHANGE_TOIDLE); -+ -+ wl_busy_pre = wl_busy; -+ } -+ -+ /* WL RSSI */ -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wl_rssi); -+ tmp = (u8)(wl_rssi & 0xff); -+ for (i = 0; i < 4; i++) { -+ if (tmp >= chip_para->wl_rssi_step[i]) -+ break; -+ } -+ -+ if (rssi_step_pre != i) { -+ rssi_step_pre = i; -+ change_map |= BIT(BTC_WLSTATUS_CHANGE_RSSI); -+ } -+ -+ /* WL Link info */ -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_LINK_INFO, &link_info); -+ if (link_info.link_mode != pBtCoexist->wifi_link_info.link_mode || -+ link_info.sta_center_channel != -+ pBtCoexist->wifi_link_info.sta_center_channel || -+ link_info.p2p_center_channel != -+ pBtCoexist->wifi_link_info.p2p_center_channel || -+ link_info.bany_client_join_go != -+ pBtCoexist->wifi_link_info.bany_client_join_go) { -+ change_map |= BIT(BTC_WLSTATUS_CHANGE_LINKINFO); -+ pBtCoexist->wifi_link_info = link_info; -+ } -+ -+ /* WL Traffic Direction */ -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIR, &traffic_dir); -+ if (wl_busy && traffic_dir != pBtCoexist->wifi_link_info_ext.traffic_dir) { -+ change_map |= BIT(BTC_WLSTATUS_CHANGE_DIR); -+ pBtCoexist->wifi_link_info_ext.traffic_dir = traffic_dir; -+ } -+ -+ /* Noisy Detect */ -+ if (coex_sta->wl_noisy_level != wl_noisy_level_pre) { -+ change_map |= BIT(BTC_WLSTATUS_CHANGE_NOISY); -+ wl_noisy_level_pre = coex_sta->wl_noisy_level; -+ } -+ -+ /* BT Counter change > 50 */ -+ if (bt_ctr_change) -+ change_map |= BIT(BTC_WLSTATUS_CHANGE_BTCNT); -+ -+ /* CCK Lock Try */ -+ if (coex_sta->wl_coex_mode == BTC_WLINK_2GFREE) -+ coex_sta->cnt_wl[BTC_CNT_WL_2G_FDDSTAY]++; -+ -+ if (coex_sta->wl_coex_mode == BTC_WLINK_2GFREE && -+ coex_sta->cnt_wl[BTC_CNT_WL_2G_FDDSTAY] > BTC_2GFDD_MAX_STAY && -+ coex_sta->cnt_wl[BTC_CNT_WL_2G_TDDTRY] < BTC_2GTDD_MAX_TRY) { -+ coex_sta->cnt_wl[BTC_CNT_WL_2G_TDDTRY]++; -+ -+ RTW_DBG("[BTC], Try 2.4G coex from FDD to TDD (FDD:%d, TRY:%d)\n", -+ coex_sta->cnt_wl[BTC_CNT_WL_2G_FDDSTAY], -+ coex_sta->cnt_wl[BTC_CNT_WL_2G_TDDTRY]); -+ -+ coex_sta->cnt_wl[BTC_CNT_WL_2G_FDDSTAY] = 0; -+ change_map |= BIT(BTC_WLSTATUS_CHANGE_LOCKTRY); -+ } -+ -+ RTW_DBG("[BTC], %s(): change_map = 0x%x\n", __func__, change_map); -+ -+ return change_map; -+} -+ -+void EXhalbtcoutsrc_status_monitor(PBTC_COEXIST pBtCoexist) -+{ -+ u32 timer_up_type = 0, wl_status_change_type = 0; -+ -+ timer_up_type = EXhalbtcoutsrc_CoexTimerCheck(pBtCoexist); -+ if (timer_up_type != 0) -+ EXhalbtcoutsrc_TimerNotify(pBtCoexist, timer_up_type); -+ -+ wl_status_change_type = EXhalbtcoutsrc_WLStatusCheck(pBtCoexist); -+ if (wl_status_change_type != 0) -+ EXhalbtcoutsrc_WLStatusChangeNotify(pBtCoexist, wl_status_change_type); -+ -+ rtw_btc_ex_periodical(pBtCoexist); -+} -+#endif -+ -+void EXhalbtcoutsrc_WL_RFK_Notify(PBTC_COEXIST pBtCoexist, u8 path, u8 type, u8 state) -+{ -+ #if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_wl_rfk_notify(pBtCoexist, path, type, state); -+ #endif -+ return; -+} -+ -+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 (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ EXhalbtcoutsrc_status_monitor(pBtCoexist); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ 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); -+ } -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_periodical(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_periodical(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_periodical(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_periodical(pBtCoexist); -+ } -+#endif -+ -+#endif -+ -+ /* 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 (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ /* rtw_btc_ex_dbg_control(pBtCoexist, opCode, opLen, pData); */ -+#else -+ -+ if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8192E -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_dbg_control(pBtCoexist, opCode, opLen, pData); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) -+ if(pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_dbg_control(pBtCoexist, opCode, opLen, pData); -+#endif -+ -+#endif -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+#if 0 -+void -+EXhalbtcoutsrc_AntennaDetection( -+ PBTC_COEXIST pBtCoexist, -+ u32 centFreq, -+ u32 offset, -+ u32 span, -+ u32 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 = NULL; -+ PBT_MGNT pBtMgnt = NULL; -+ u8 i; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ padapter = (PADAPTER)pBtCoexist->Adapter; -+ pBtMgnt = &padapter->coex_info.BtMgnt; -+ -+ 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) -+{ -+ HAL_DATA_TYPE *pHalData = NULL; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ /* To prevent the racing with IPS enter */ -+ halbtcoutsrc_EnterPwrLock(pBtCoexist); -+ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ pHalData = GET_HAL_DATA((PADAPTER)pBtCoexist->Adapter); -+ -+ if (pHalData->EEPROMBluetoothCoexist == _TRUE) -+ rtw_btc_ex_display_coex_info(pBtCoexist); -+#else -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8821A -+ 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); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8723B -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_display_coex_info(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_display_coex_info(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_display_coex_info(pBtCoexist); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_display_coex_info(pBtCoexist); -+ } -+#endif -+ -+#endif -+ -+ 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)) { -+#ifdef CONFIG_RTL8723B -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_display_ant_detection(pBtCoexist); -+#endif -+ } -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void ex_halbtcoutsrc_pta_off_on_notify(PBTC_COEXIST pBtCoexist, u8 bBTON) -+{ -+ if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8812A -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_pta_off_on_notify(pBtCoexist, (bBTON == _TRUE) ? BTC_BT_ON : BTC_BT_OFF); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_pta_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; -+} -+ -+#ifdef CONFIG_RF4CE_COEXIST -+void EXhalbtcoutsrc_set_rf4ce_link_state(u8 state) -+{ -+ GLBtCoexist.rf4ce_info.link_state = state; -+} -+ -+u8 EXhalbtcoutsrc_get_rf4ce_link_state(void) -+{ -+ return GLBtCoexist.rf4ce_info.link_state; -+} -+#endif -+ -+void EXhalbtcoutsrc_switchband_notify(struct btc_coexist *pBtCoexist, u8 type) -+{ -+ if(!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ if(pBtCoexist->manual_control) -+ return; -+ -+ /* Driver should guarantee that the HW status isn't in low power mode */ -+ /* halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) -+ rtw_btc_ex_switchband_notify(pBtCoexist, type); -+#else -+ -+ if(IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+#ifdef CONFIG_RTL8822B -+ if(pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_switchband_notify(pBtCoexist, type); -+ else if(pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8822b2ant_switchband_notify(pBtCoexist, type); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8821C -+ 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); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8814a2ant_switchband_notify(pBtCoexist, type); -+ } -+#endif -+ -+#endif -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+u8 EXhalbtcoutsrc_rate_id_to_btc_rate_id(u8 rate_id) -+{ -+ u8 btc_rate_id = BTC_UNKNOWN; -+ -+ switch (rate_id) { -+ /* CCK rates */ -+ case DESC_RATE1M: -+ btc_rate_id = BTC_CCK_1; -+ break; -+ case DESC_RATE2M: -+ btc_rate_id = BTC_CCK_2; -+ break; -+ case DESC_RATE5_5M: -+ btc_rate_id = BTC_CCK_5_5; -+ break; -+ case DESC_RATE11M: -+ btc_rate_id = BTC_CCK_11; -+ break; -+ -+ /* OFDM rates */ -+ case DESC_RATE6M: -+ btc_rate_id = BTC_OFDM_6; -+ break; -+ case DESC_RATE9M: -+ btc_rate_id = BTC_OFDM_9; -+ break; -+ case DESC_RATE12M: -+ btc_rate_id = BTC_OFDM_12; -+ break; -+ case DESC_RATE18M: -+ btc_rate_id = BTC_OFDM_18; -+ break; -+ case DESC_RATE24M: -+ btc_rate_id = BTC_OFDM_24; -+ break; -+ case DESC_RATE36M: -+ btc_rate_id = BTC_OFDM_36; -+ break; -+ case DESC_RATE48M: -+ btc_rate_id = BTC_OFDM_48; -+ break; -+ case DESC_RATE54M: -+ btc_rate_id = BTC_OFDM_54; -+ break; -+ -+ /* MCS rates */ -+ case DESC_RATEMCS0: -+ btc_rate_id = BTC_MCS_0; -+ break; -+ case DESC_RATEMCS1: -+ btc_rate_id = BTC_MCS_1; -+ break; -+ case DESC_RATEMCS2: -+ btc_rate_id = BTC_MCS_2; -+ break; -+ case DESC_RATEMCS3: -+ btc_rate_id = BTC_MCS_3; -+ break; -+ case DESC_RATEMCS4: -+ btc_rate_id = BTC_MCS_4; -+ break; -+ case DESC_RATEMCS5: -+ btc_rate_id = BTC_MCS_5; -+ break; -+ case DESC_RATEMCS6: -+ btc_rate_id = BTC_MCS_6; -+ break; -+ case DESC_RATEMCS7: -+ btc_rate_id = BTC_MCS_7; -+ break; -+ case DESC_RATEMCS8: -+ btc_rate_id = BTC_MCS_8; -+ break; -+ case DESC_RATEMCS9: -+ btc_rate_id = BTC_MCS_9; -+ break; -+ case DESC_RATEMCS10: -+ btc_rate_id = BTC_MCS_10; -+ break; -+ case DESC_RATEMCS11: -+ btc_rate_id = BTC_MCS_11; -+ break; -+ case DESC_RATEMCS12: -+ btc_rate_id = BTC_MCS_12; -+ break; -+ case DESC_RATEMCS13: -+ btc_rate_id = BTC_MCS_13; -+ break; -+ case DESC_RATEMCS14: -+ btc_rate_id = BTC_MCS_14; -+ break; -+ case DESC_RATEMCS15: -+ btc_rate_id = BTC_MCS_15; -+ break; -+ case DESC_RATEMCS16: -+ btc_rate_id = BTC_MCS_16; -+ break; -+ case DESC_RATEMCS17: -+ btc_rate_id = BTC_MCS_17; -+ break; -+ case DESC_RATEMCS18: -+ btc_rate_id = BTC_MCS_18; -+ break; -+ case DESC_RATEMCS19: -+ btc_rate_id = BTC_MCS_19; -+ break; -+ case DESC_RATEMCS20: -+ btc_rate_id = BTC_MCS_20; -+ break; -+ case DESC_RATEMCS21: -+ btc_rate_id = BTC_MCS_21; -+ break; -+ case DESC_RATEMCS22: -+ btc_rate_id = BTC_MCS_22; -+ break; -+ case DESC_RATEMCS23: -+ btc_rate_id = BTC_MCS_23; -+ break; -+ case DESC_RATEMCS24: -+ btc_rate_id = BTC_MCS_24; -+ break; -+ case DESC_RATEMCS25: -+ btc_rate_id = BTC_MCS_25; -+ break; -+ case DESC_RATEMCS26: -+ btc_rate_id = BTC_MCS_26; -+ break; -+ case DESC_RATEMCS27: -+ btc_rate_id = BTC_MCS_27; -+ break; -+ case DESC_RATEMCS28: -+ btc_rate_id = BTC_MCS_28; -+ break; -+ case DESC_RATEMCS29: -+ btc_rate_id = BTC_MCS_29; -+ break; -+ case DESC_RATEMCS30: -+ btc_rate_id = BTC_MCS_30; -+ break; -+ case DESC_RATEMCS31: -+ btc_rate_id = BTC_MCS_31; -+ break; -+ -+ case DESC_RATEVHTSS1MCS0: -+ btc_rate_id = BTC_VHT_1SS_MCS_0; -+ break; -+ case DESC_RATEVHTSS1MCS1: -+ btc_rate_id = BTC_VHT_1SS_MCS_1; -+ break; -+ case DESC_RATEVHTSS1MCS2: -+ btc_rate_id = BTC_VHT_1SS_MCS_2; -+ break; -+ case DESC_RATEVHTSS1MCS3: -+ btc_rate_id = BTC_VHT_1SS_MCS_3; -+ break; -+ case DESC_RATEVHTSS1MCS4: -+ btc_rate_id = BTC_VHT_1SS_MCS_4; -+ break; -+ case DESC_RATEVHTSS1MCS5: -+ btc_rate_id = BTC_VHT_1SS_MCS_5; -+ break; -+ case DESC_RATEVHTSS1MCS6: -+ btc_rate_id = BTC_VHT_1SS_MCS_6; -+ break; -+ case DESC_RATEVHTSS1MCS7: -+ btc_rate_id = BTC_VHT_1SS_MCS_7; -+ break; -+ case DESC_RATEVHTSS1MCS8: -+ btc_rate_id = BTC_VHT_1SS_MCS_8; -+ break; -+ case DESC_RATEVHTSS1MCS9: -+ btc_rate_id = BTC_VHT_1SS_MCS_9; -+ break; -+ -+ case DESC_RATEVHTSS2MCS0: -+ btc_rate_id = BTC_VHT_2SS_MCS_0; -+ break; -+ case DESC_RATEVHTSS2MCS1: -+ btc_rate_id = BTC_VHT_2SS_MCS_1; -+ break; -+ case DESC_RATEVHTSS2MCS2: -+ btc_rate_id = BTC_VHT_2SS_MCS_2; -+ break; -+ case DESC_RATEVHTSS2MCS3: -+ btc_rate_id = BTC_VHT_2SS_MCS_3; -+ break; -+ case DESC_RATEVHTSS2MCS4: -+ btc_rate_id = BTC_VHT_2SS_MCS_4; -+ break; -+ case DESC_RATEVHTSS2MCS5: -+ btc_rate_id = BTC_VHT_2SS_MCS_5; -+ break; -+ case DESC_RATEVHTSS2MCS6: -+ btc_rate_id = BTC_VHT_2SS_MCS_6; -+ break; -+ case DESC_RATEVHTSS2MCS7: -+ btc_rate_id = BTC_VHT_2SS_MCS_7; -+ break; -+ case DESC_RATEVHTSS2MCS8: -+ btc_rate_id = BTC_VHT_2SS_MCS_8; -+ break; -+ case DESC_RATEVHTSS2MCS9: -+ btc_rate_id = BTC_VHT_2SS_MCS_9; -+ break; -+ -+ case DESC_RATEVHTSS3MCS0: -+ btc_rate_id = BTC_VHT_3SS_MCS_0; -+ break; -+ case DESC_RATEVHTSS3MCS1: -+ btc_rate_id = BTC_VHT_3SS_MCS_1; -+ break; -+ case DESC_RATEVHTSS3MCS2: -+ btc_rate_id = BTC_VHT_3SS_MCS_2; -+ break; -+ case DESC_RATEVHTSS3MCS3: -+ btc_rate_id = BTC_VHT_3SS_MCS_3; -+ break; -+ case DESC_RATEVHTSS3MCS4: -+ btc_rate_id = BTC_VHT_3SS_MCS_4; -+ break; -+ case DESC_RATEVHTSS3MCS5: -+ btc_rate_id = BTC_VHT_3SS_MCS_5; -+ break; -+ case DESC_RATEVHTSS3MCS6: -+ btc_rate_id = BTC_VHT_3SS_MCS_6; -+ break; -+ case DESC_RATEVHTSS3MCS7: -+ btc_rate_id = BTC_VHT_3SS_MCS_7; -+ break; -+ case DESC_RATEVHTSS3MCS8: -+ btc_rate_id = BTC_VHT_3SS_MCS_8; -+ break; -+ case DESC_RATEVHTSS3MCS9: -+ btc_rate_id = BTC_VHT_3SS_MCS_9; -+ break; -+ -+ case DESC_RATEVHTSS4MCS0: -+ btc_rate_id = BTC_VHT_4SS_MCS_0; -+ break; -+ case DESC_RATEVHTSS4MCS1: -+ btc_rate_id = BTC_VHT_4SS_MCS_1; -+ break; -+ case DESC_RATEVHTSS4MCS2: -+ btc_rate_id = BTC_VHT_4SS_MCS_2; -+ break; -+ case DESC_RATEVHTSS4MCS3: -+ btc_rate_id = BTC_VHT_4SS_MCS_3; -+ break; -+ case DESC_RATEVHTSS4MCS4: -+ btc_rate_id = BTC_VHT_4SS_MCS_4; -+ break; -+ case DESC_RATEVHTSS4MCS5: -+ btc_rate_id = BTC_VHT_4SS_MCS_5; -+ break; -+ case DESC_RATEVHTSS4MCS6: -+ btc_rate_id = BTC_VHT_4SS_MCS_6; -+ break; -+ case DESC_RATEVHTSS4MCS7: -+ btc_rate_id = BTC_VHT_4SS_MCS_7; -+ break; -+ case DESC_RATEVHTSS4MCS8: -+ btc_rate_id = BTC_VHT_4SS_MCS_8; -+ break; -+ case DESC_RATEVHTSS4MCS9: -+ btc_rate_id = BTC_VHT_4SS_MCS_9; -+ break; -+ } -+ -+ return btc_rate_id; -+} -+ -+/* -+ * 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)); -+ -+ ret = EXhalbtcoutsrc_InitlizeVariables((void *)padapter); -+ -+ return ret; -+} -+ -+void hal_btcoex_PowerOnSetting(PADAPTER padapter) -+{ -+ EXhalbtcoutsrc_PowerOnSetting(&GLBtCoexist); -+} -+ -+void hal_btcoex_AntInfoSetting(PADAPTER padapter) -+{ -+ 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)); -+ -+ EXhalbtcoutsrc_AntInfoSetting(padapter); -+} -+ -+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) -+ || IS_HARDWARE_TYPE_8822C(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) -+{ -+ u8 assoType = 0; -+ u8 is_5g_band = _FALSE; -+ -+ is_5g_band = (padapter->mlmeextpriv.cur_channel > 14) ? _TRUE : _FALSE; -+ -+ if (action == _TRUE) { -+ if (is_5g_band == _TRUE) -+ assoType = BTC_ASSOCIATE_5G_START; -+ else -+ assoType = BTC_ASSOCIATE_START; -+ } -+ else { -+ if (is_5g_band == _TRUE) -+ assoType = BTC_ASSOCIATE_5G_FINISH; -+ else -+ assoType = BTC_ASSOCIATE_FINISH; -+ } -+ -+ EXhalbtcoutsrc_connect_notify(&GLBtCoexist, assoType); -+} -+ -+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_WLRFKNotify(PADAPTER padapter, u8 path, u8 type, u8 state) -+{ -+ EXhalbtcoutsrc_WL_RFK_Notify(&GLBtCoexist, path, type, 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 == _FALSE) -+ 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 = _TRUE; -+ break; -+ -+ case C2H_TRIG_BY_BT_FW: -+ GLBtcBtMpRptBTOK = _TRUE; -+ -+ status = tmpBuf[1] & 0xF; -+ len = length - 3; -+ seq = tmpBuf[2] >> 4; -+ -+ GLBtcBtMpRptSeq = seq; -+ GLBtcBtMpRptStatus = status; -+ _rtw_memcpy(GLBtcBtMpRptRsp, tmpBuf + 3, len); -+ GLBtcBtMpRptRspSize = len; -+ -+ break; -+ -+ default: -+ return; -+ } -+ -+ if ((GLBtcBtMpRptWiFiOK == _TRUE) && (GLBtcBtMpRptBTOK == _TRUE)) { -+ GLBtcBtMpRptWait = _FALSE; -+ _cancel_timer_ex(&GLBtcBtMpOperTimer); -+ _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: -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ /* re-download FW after resume, inform WL FW port number */ -+ rtw_hal_set_wifi_btc_port_id_cmd(GLBtCoexist.Adapter); -+#endif -+ 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; -+} -+ -+void hal_btcoex_set_policy_control(PADAPTER padapter, u8 btc_policy) -+{ -+ switch (btc_policy) { -+ case BTCOEX_POLICY_CONTROL_AUTO: -+ GLBtCoexist.coex_sta.force_freerun = _FALSE; -+ GLBtCoexist.coex_sta.force_tdd = _FALSE; -+ break; -+ case BTCOEX_POLICY_CONTROL_FORCE_FREERUN: -+ GLBtCoexist.coex_sta.force_freerun = _TRUE; -+ GLBtCoexist.coex_sta.force_tdd = _FALSE; -+ break; -+ case BTCOEX_POLICY_CONTROL_FORCE_TDMA: -+ GLBtCoexist.coex_sta.force_freerun = _FALSE; -+ GLBtCoexist.coex_sta.force_tdd = _TRUE; -+ break; -+ } -+} -+ -+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; -+} -+ -+u8 hal_btcoex_query_reduced_wl_pwr_lvl(PADAPTER padapter) -+{ -+ return GLBtCoexist.coex_dm.cur_wl_pwr_lvl; -+} -+ -+void hal_btcoex_set_reduced_wl_pwr_lvl(PADAPTER padapter, u8 val) -+{ -+ GLBtCoexist.coex_dm.cur_wl_pwr_lvl = val; -+} -+ -+void hal_btcoex_do_reduce_wl_pwr_lvl(PADAPTER padapter) -+{ -+ halbtcoutsrc_reduce_wl_tx_power(&GLBtCoexist, 0); -+} -+ -+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_pta_off_on_notify(PADAPTER padapter, u8 bBTON) -+{ -+ ex_halbtcoutsrc_pta_off_on_notify(&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 = (u8)BTC_ANT_TYPE_0; -+ break; -+ case 1: -+ pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_1; -+ break; -+ case 2: -+ pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_2; -+ break; -+ case 3: -+ pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_3; -+ break; -+ case 4: -+ pBtCoexist->board_info.ant_type = (u8)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((void *)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( -+ PADAPTER Adapter, -+ 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); -+} -+ -+#ifdef CONFIG_RF4CE_COEXIST -+void hal_btcoex_set_rf4ce_link_state(u8 state) -+{ -+ EXhalbtcoutsrc_set_rf4ce_link_state(state); -+} -+ -+u8 hal_btcoex_get_rf4ce_link_state(void) -+{ -+ return EXhalbtcoutsrc_get_rf4ce_link_state(); -+} -+#endif /* CONFIG_RF4CE_COEXIST */ -+ -+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; -+ } -+} -+ -+void hal_btcoex_WlFwDbgInfoNotify(PADAPTER padapter, u8* tmpBuf, u8 length) -+{ -+ EXhalbtcoutsrc_WlFwDbgInfoNotify(&GLBtCoexist, tmpBuf, length); -+} -+ -+void hal_btcoex_rx_rate_change_notify(PADAPTER padapter, u8 is_data_frame, u8 rate_id) -+{ -+ EXhalbtcoutsrc_rx_rate_change_notify(&GLBtCoexist, is_data_frame, EXhalbtcoutsrc_rate_id_to_btc_rate_id(rate_id)); -+} -+ -+u16 hal_btcoex_btset_testode(PADAPTER padapter, u8 type) -+{ -+ u16 ret = 0; -+ -+ halbtcoutsrc_LeaveLowPower(&GLBtCoexist); -+ -+ ret = halbtcoutsrc_setbttestmode(&GLBtCoexist, type); -+ -+ halbtcoutsrc_NormalLowPower(&GLBtCoexist); -+ -+ return ret; -+} -+ -+#endif /* CONFIG_BT_COEXIST */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_btcoex_wifionly.c b/drivers/net/wireless/rtl8821cs/hal/hal_btcoex_wifionly.c -new file mode 100644 -index 000000000..a9ef07f14 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_btcoex_wifionly.c -@@ -0,0 +1,279 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#if (CONFIG_BTCOEX_SUPPORT_WIFI_ONLY_CFG == 1) -+ -+#include "btc/mp_precomp.h" -+ -+struct wifi_only_cfg GLBtCoexistWifiOnly; -+ -+void halwifionly_write1byte(void *pwifionlyContext, u32 RegAddr, u8 Data) -+{ -+ struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; -+ PADAPTER Adapter = pwifionlycfg->Adapter; -+ -+ rtw_write8(Adapter, RegAddr, Data); -+} -+ -+void halwifionly_write2byte(void *pwifionlyContext, u32 RegAddr, u16 Data) -+{ -+ struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; -+ PADAPTER Adapter = pwifionlycfg->Adapter; -+ -+ rtw_write16(Adapter, RegAddr, Data); -+} -+ -+void halwifionly_write4byte(void *pwifionlyContext, u32 RegAddr, u32 Data) -+{ -+ struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; -+ PADAPTER Adapter = pwifionlycfg->Adapter; -+ -+ rtw_write32(Adapter, RegAddr, Data); -+} -+ -+u8 halwifionly_read1byte(void *pwifionlyContext, u32 RegAddr) -+{ -+ struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; -+ PADAPTER Adapter = pwifionlycfg->Adapter; -+ -+ return rtw_read8(Adapter, RegAddr); -+} -+ -+u16 halwifionly_read2byte(void * pwifionlyContext, u32 RegAddr) -+{ -+ struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; -+ PADAPTER Adapter = pwifionlycfg->Adapter; -+ -+ return rtw_read16(Adapter, RegAddr); -+} -+ -+u32 halwifionly_read4byte(void *pwifionlyContext, u32 RegAddr) -+{ -+ struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; -+ PADAPTER Adapter = pwifionlycfg->Adapter; -+ -+ return rtw_read32(Adapter, RegAddr); -+} -+ -+void halwifionly_bitmaskwrite1byte(void *pwifionlyContext, u32 regAddr, u8 bitMask, u8 data) -+{ -+ u8 originalValue, bitShift = 0; -+ u8 i; -+ -+ struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; -+ PADAPTER Adapter = pwifionlycfg->Adapter; -+ -+ if (bitMask != 0xff) { -+ originalValue = rtw_read8(Adapter, regAddr); -+ for (i = 0; i <= 7; i++) { -+ if ((bitMask >> i) & 0x1) -+ break; -+ } -+ bitShift = i; -+ data = ((originalValue) & (~bitMask)) | (((data << bitShift)) & bitMask); -+ } -+ rtw_write8(Adapter, regAddr, data); -+} -+ -+void halwifionly_phy_set_rf_reg(void *pwifionlyContext, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; -+ PADAPTER Adapter = pwifionlycfg->Adapter; -+ -+ phy_set_rf_reg(Adapter, eRFPath, RegAddr, BitMask, Data); -+} -+ -+void halwifionly_phy_set_bb_reg(void *pwifionlyContext, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; -+ PADAPTER Adapter = pwifionlycfg->Adapter; -+ -+ phy_set_bb_reg(Adapter, RegAddr, BitMask, Data); -+} -+ -+void hal_btcoex_wifionly_switchband_notify(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 is_5g = _FALSE; -+ -+ if (pHalData->current_band_type == BAND_ON_5G) -+ is_5g = _TRUE; -+ -+ if (IS_HARDWARE_TYPE_8822B(padapter)) { -+#ifdef CONFIG_RTL8822B -+ ex_hal8822b_wifi_only_switchbandnotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8821C -+ else if (IS_HARDWARE_TYPE_8821C(padapter)) -+ ex_hal8821c_wifi_only_switchbandnotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ -+#ifdef CONFIG_RTL8822C -+ else if (IS_HARDWARE_TYPE_8822C(padapter)) -+ ex_hal8822c_wifi_only_switchbandnotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ -+#ifdef CONFIG_RTL8814B -+ else if (IS_HARDWARE_TYPE_8814B(padapter)) -+ ex_hal8814b_wifi_only_switchbandnotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ -+#ifdef CONFIG_RTL8723F -+ else if (IS_HARDWARE_TYPE_8723F(padapter)) -+ ex_hal8723f_wifi_only_switchbandnotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+} -+ -+void hal_btcoex_wifionly_scan_notify(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 is_5g = _FALSE; -+ -+ if (pHalData->current_band_type == BAND_ON_5G) -+ is_5g = _TRUE; -+ -+ if (IS_HARDWARE_TYPE_8822B(padapter)) { -+#ifdef CONFIG_RTL8822B -+ ex_hal8822b_wifi_only_scannotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8821C -+ else if (IS_HARDWARE_TYPE_8821C(padapter)) -+ ex_hal8821c_wifi_only_scannotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ -+#ifdef CONFIG_RTL8822C -+ else if (IS_HARDWARE_TYPE_8822C(padapter)) -+ ex_hal8822c_wifi_only_scannotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ -+#ifdef CONFIG_RTL8814B -+ else if (IS_HARDWARE_TYPE_8814B(padapter)) -+ ex_hal8814b_wifi_only_scannotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+} -+ -+void hal_btcoex_wifionly_connect_notify(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 is_5g = _FALSE; -+ -+ if (pHalData->current_band_type == BAND_ON_5G) -+ is_5g = _TRUE; -+ -+ if (IS_HARDWARE_TYPE_8822B(padapter)) { -+#ifdef CONFIG_RTL8822B -+ ex_hal8822b_wifi_only_connectnotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8821C -+ else if (IS_HARDWARE_TYPE_8821C(padapter)) -+ ex_hal8821c_wifi_only_connectnotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ -+#ifdef CONFIG_RTL8822C -+ else if (IS_HARDWARE_TYPE_8822C(padapter)) -+ ex_hal8822c_wifi_only_connectnotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ -+#ifdef CONFIG_RTL8814B -+ else if (IS_HARDWARE_TYPE_8814B(padapter)) -+ ex_hal8814b_wifi_only_connectnotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+ -+#ifdef CONFIG_RTL8723F -+ else if (IS_HARDWARE_TYPE_8723F(padapter)) -+ ex_hal8723f_wifi_only_connectnotify(&GLBtCoexistWifiOnly, is_5g); -+#endif -+} -+ -+void hal_btcoex_wifionly_hw_config(PADAPTER padapter) -+{ -+ struct wifi_only_cfg *pwifionlycfg = &GLBtCoexistWifiOnly; -+ -+ if (IS_HARDWARE_TYPE_8723B(padapter)) { -+#ifdef CONFIG_RTL8723B -+ ex_hal8723b_wifi_only_hw_config(pwifionlycfg); -+#endif -+ } -+ -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(padapter)) -+ ex_hal8822b_wifi_only_hw_config(pwifionlycfg); -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ else if (IS_HARDWARE_TYPE_8821C(padapter)) -+ ex_hal8821c_wifi_only_hw_config(pwifionlycfg); -+#endif -+ -+#ifdef CONFIG_RTL8822C -+ else if (IS_HARDWARE_TYPE_8822C(padapter)) -+ ex_hal8822c_wifi_only_hw_config(pwifionlycfg); -+#endif -+ -+#ifdef CONFIG_RTL8814B -+ else if (IS_HARDWARE_TYPE_8814B(padapter)) -+ ex_hal8814b_wifi_only_hw_config(pwifionlycfg); -+#endif -+ -+#ifdef CONFIG_RTL8723F -+ else if (IS_HARDWARE_TYPE_8723F(padapter)) -+ ex_hal8723f_wifi_only_hw_config(pwifionlycfg); -+#endif -+} -+ -+void hal_btcoex_wifionly_initlizevariables(PADAPTER padapter) -+{ -+ struct wifi_only_cfg *pwifionlycfg = &GLBtCoexistWifiOnly; -+ struct wifi_only_haldata *pwifionly_haldata = &pwifionlycfg->haldata_info; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ _rtw_memset(&GLBtCoexistWifiOnly, 0, sizeof(GLBtCoexistWifiOnly)); -+ -+ pwifionlycfg->Adapter = padapter; -+ -+#ifdef CONFIG_PCI_HCI -+ pwifionlycfg->chip_interface = WIFIONLY_INTF_PCI; -+#elif defined(CONFIG_USB_HCI) -+ pwifionlycfg->chip_interface = WIFIONLY_INTF_USB; -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pwifionlycfg->chip_interface = WIFIONLY_INTF_SDIO; -+#else -+ pwifionlycfg->chip_interface = WIFIONLY_INTF_UNKNOWN; -+#endif -+ -+ pwifionly_haldata->customer_id = CUSTOMER_NORMAL; -+} -+ -+void hal_btcoex_wifionly_AntInfoSetting(PADAPTER padapter) -+{ -+ struct wifi_only_cfg *pwifionlycfg = &GLBtCoexistWifiOnly; -+ struct wifi_only_haldata *pwifionly_haldata = &pwifionlycfg->haldata_info; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ pwifionly_haldata->efuse_pg_antnum = pHalData->EEPROMBluetoothAntNum; -+ pwifionly_haldata->efuse_pg_antpath = pHalData->ant_path; -+ pwifionly_haldata->rfe_type = pHalData->rfe_type; -+ pwifionly_haldata->ant_div_cfg = pHalData->AntDivCfg; -+} -+ -+#endif -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_com.c b/drivers/net/wireless/rtl8821cs/hal/hal_com.c -new file mode 100755 -index 000000000..b0de6b5f9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_com.c -@@ -0,0 +1,16921 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" -+ -+#ifdef RTW_HALMAC -+#include "../../hal/hal_halmac.h" -+#endif -+ -+void rtw_dump_fw_info(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = NULL; -+ -+ if (!adapter) -+ return; -+ -+ hal_data = GET_HAL_DATA(adapter); -+ if (hal_data->bFWReady) -+ RTW_PRINT_SEL(sel, "FW VER -%d.%d\n", hal_data->firmware_version, hal_data->firmware_sub_version); -+ else -+ RTW_PRINT_SEL(sel, "FW not ready\n"); -+} -+ -+bool rsvd_page_cache_update_all(struct rsvd_page_cache_t *cache, u8 loc -+ , u8 txdesc_len, u32 page_size, u8 *info, u32 info_len) -+{ -+ u8 page_num; -+ bool modified = 0; -+ bool loc_mod = 0, size_mod = 0, page_num_mod = 0; -+ -+ page_num = info_len ? (u8)PageNum(txdesc_len + info_len, page_size) : 0; -+ if (!info_len) -+ loc = 0; -+ -+ if (cache->loc != loc) { -+ RTW_INFO("%s %s loc change (%u -> %u)\n" -+ , __func__, cache->name, cache->loc, loc); -+ loc_mod = 1; -+ } -+ if (cache->size != info_len) { -+ RTW_INFO("%s %s size change (%u -> %u)\n" -+ , __func__, cache->name, cache->size, info_len); -+ size_mod = 1; -+ } -+ if (cache->page_num != page_num) { -+ RTW_INFO("%s %s page_num change (%u -> %u)\n" -+ , __func__, cache->name, cache->page_num, page_num); -+ page_num_mod = 1; -+ } -+ -+ if (info && info_len) { -+ if (cache->data) { -+ if (cache->size == info_len) { -+ if (_rtw_memcmp(cache->data, info, info_len) != _TRUE) { -+ RTW_INFO("%s %s data change\n", __func__, cache->name); -+ modified = 1; -+ } -+ } else -+ rsvd_page_cache_free_data(cache); -+ } -+ -+ if (!cache->data) { -+ cache->data = rtw_malloc(info_len); -+ if (!cache->data) { -+ RTW_ERR("%s %s alloc data with size(%u) fail\n" -+ , __func__, cache->name, info_len); -+ rtw_warn_on(1); -+ } else { -+ RTW_INFO("%s %s alloc data with size(%u)\n" -+ , __func__, cache->name, info_len); -+ } -+ modified = 1; -+ } -+ -+ if (cache->data && modified) -+ _rtw_memcpy(cache->data, info, info_len); -+ } else { -+ if (cache->data && size_mod) -+ rsvd_page_cache_free_data(cache); -+ } -+ -+ cache->loc = loc; -+ cache->page_num = page_num; -+ cache->size = info_len; -+ -+ return modified | loc_mod | size_mod | page_num_mod; -+} -+ -+bool rsvd_page_cache_update_data(struct rsvd_page_cache_t *cache, u8 *info, u32 info_len) -+{ -+ bool modified = 0; -+ -+ if (!info || !info_len) { -+ RTW_WARN("%s %s invalid input(info:%p, info_len:%u)\n" -+ , __func__, cache->name, info, info_len); -+ goto exit; -+ } -+ -+ if (!cache->loc || !cache->page_num || !cache->size) { -+ RTW_ERR("%s %s layout not ready(loc:%u, page_num:%u, size:%u)\n" -+ , __func__, cache->name, cache->loc, cache->page_num, cache->size); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (cache->size != info_len) { -+ RTW_ERR("%s %s size(%u) differ with info_len(%u)\n" -+ , __func__, cache->name, cache->size, info_len); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (!cache->data) { -+ cache->data = rtw_zmalloc(cache->size); -+ if (!cache->data) { -+ RTW_ERR("%s %s alloc data with size(%u) fail\n" -+ , __func__, cache->name, cache->size); -+ rtw_warn_on(1); -+ goto exit; -+ } else { -+ RTW_INFO("%s %s alloc data with size(%u)\n" -+ , __func__, cache->name, info_len); -+ } -+ modified = 1; -+ } -+ -+ if (_rtw_memcmp(cache->data, info, cache->size) == _FALSE) { -+ RTW_INFO("%s %s data change\n", __func__, cache->name); -+ _rtw_memcpy(cache->data, info, cache->size); -+ modified = 1; -+ } -+ -+exit: -+ return modified; -+} -+ -+void rsvd_page_cache_free_data(struct rsvd_page_cache_t *cache) -+{ -+ if (cache->data) { -+ rtw_mfree(cache->data, cache->size); -+ cache->data = NULL; -+ } -+} -+ -+void rsvd_page_cache_free(struct rsvd_page_cache_t *cache) -+{ -+ cache->loc = 0; -+ cache->page_num = 0; -+ rsvd_page_cache_free_data(cache); -+ cache->size = 0; -+} -+ -+/* #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 (!MLME_IS_STA(adapter)) -+ 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_8188GTV(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8188GTV_"); -+ 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 if (IS_8710B_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8710B_"); -+ else if (IS_8192F_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8192F_"); -+ else if (IS_8822C_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8822C_"); -+ else if (IS_8814B_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8814B_"); -+ else if (IS_8723F_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8723F_"); -+ else -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_UNKNOWN_"); -+ -+ cnt += sprintf((buf + cnt), "%s", IS_NORMAL_CHIP(ChipVersion) ? "" : "T_"); -+ -+ if (IS_CHIP_VENDOR_TSMC(ChipVersion)) -+ cnt += sprintf((buf + cnt), "%s", "T"); -+ else if (IS_CHIP_VENDOR_UMC(ChipVersion)) -+ cnt += sprintf((buf + cnt), "%s", "U"); -+ else if (IS_CHIP_VENDOR_SMIC(ChipVersion)) -+ cnt += sprintf((buf + cnt), "%s", "S"); -+ -+ if (IS_A_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "1_"); -+ else if (IS_B_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "2_"); -+ else if (IS_C_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "3_"); -+ else if (IS_D_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "4_"); -+ else if (IS_E_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "5_"); -+ else if (IS_F_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "6_"); -+ else if (IS_I_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "9_"); -+ else if (IS_J_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "10_"); -+ else if (IS_K_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "11_"); -+ else -+ cnt += sprintf((buf + cnt), "UNKNOWN_Cv(%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); -+} -+ -+u8 rtw_hal_get_port(_adapter *adapter) -+{ -+ u8 hw_port = get_hw_port(adapter); -+#ifdef CONFIG_CLIENT_PORT_CFG -+ u8 clt_port = get_clt_port(adapter); -+ -+ if (clt_port) -+ hw_port = clt_port; -+ -+#ifdef DBG_HW_PORT -+ if (MLME_IS_STA(adapter) && (adapter->client_id != MAX_CLIENT_PORT_NUM)) { -+ if(hw_port == CLT_PORT_INVALID) { -+ RTW_ERR(ADPT_FMT" @@@@@ Client port == 0 @@@@@\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ } -+ } -+ #ifdef CONFIG_AP_MODE -+ else if (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { -+ if (hw_port != HW_PORT0) { -+ RTW_ERR(ADPT_FMT" @@@@@ AP / MESH port != 0 @@@@@\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ } -+ } -+ #endif -+ if (0) -+ RTW_INFO(ADPT_FMT" - HP:%d,CP:%d\n", ADPT_ARG(adapter), get_hw_port(adapter), get_clt_port(adapter)); -+#endif /*DBG_HW_PORT*/ -+ -+#endif/*CONFIG_CLIENT_PORT_CFG*/ -+ -+ return hw_port; -+} -+ -+#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) -+ * AutoLoadFail efuse autoload fail or not -+ * -+ */ -+void hal_com_config_channel_plan( -+ PADAPTER padapter, -+ const char *hw_alpha2, -+ u8 hw_chplan, -+ u8 hw_chplan_6g, -+ BOOLEAN AutoLoadFail -+) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ u8 force_hw_chplan = _FALSE; -+ -+ /* -+ * autoload fail, by pass all hw settings -+ */ -+ if (AutoLoadFail == _TRUE) { -+ hw_alpha2 = NULL; -+ hw_chplan = RTW_CHPLAN_UNSPECIFIED; -+ goto init; -+ } -+ -+ /* -+ * treat {0xFF, 0xFF} as unspecified -+ */ -+ if (hw_alpha2 && strncmp(hw_alpha2, "\xFF\xFF", 2) == 0) -+ hw_alpha2 = NULL; -+ -+ /* -+ * treat 0xFF as invalid value, bypass hw_chplan & force_hw_chplan parsing -+ * and check hw setting with only country code -+ */ -+ if (hw_chplan == 0xFF) { -+ hw_chplan = RTW_CHPLAN_UNSPECIFIED; -+ goto init; -+ } -+ -+#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); -+ -+init: -+ rtw_rfctl_decide_init_chplan(adapter_to_rfctl(padapter), hw_alpha2, hw_chplan, hw_chplan_6g, force_hw_chplan); -+} -+ -+BOOLEAN -+HAL_IsLegalChannel( -+ PADAPTER Adapter, -+ u32 Channel -+) -+{ -+ BOOLEAN bLegalChannel = _TRUE; -+ -+ if (Channel > 14) { -+ if (is_supported_5g(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; -+} -+ -+static const u8 _MRateToHwRate[MGN_UNKNOWN] = { -+ [MGN_1M] = DESC_RATE1M, -+ [MGN_2M] = DESC_RATE2M, -+ [MGN_5_5M] = DESC_RATE5_5M, -+ [MGN_11M] = DESC_RATE11M, -+ [MGN_6M] = DESC_RATE6M, -+ [MGN_9M] = DESC_RATE9M, -+ [MGN_12M] = DESC_RATE12M, -+ [MGN_18M] = DESC_RATE18M, -+ [MGN_24M] = DESC_RATE24M, -+ [MGN_36M] = DESC_RATE36M, -+ [MGN_48M] = DESC_RATE48M, -+ [MGN_54M] = DESC_RATE54M, -+ [MGN_MCS0] = DESC_RATEMCS0, -+ [MGN_MCS1] = DESC_RATEMCS1, -+ [MGN_MCS2] = DESC_RATEMCS2, -+ [MGN_MCS3] = DESC_RATEMCS3, -+ [MGN_MCS4] = DESC_RATEMCS4, -+ [MGN_MCS5] = DESC_RATEMCS5, -+ [MGN_MCS6] = DESC_RATEMCS6, -+ [MGN_MCS7] = DESC_RATEMCS7, -+ [MGN_MCS8] = DESC_RATEMCS8, -+ [MGN_MCS9] = DESC_RATEMCS9, -+ [MGN_MCS10] = DESC_RATEMCS10, -+ [MGN_MCS11] = DESC_RATEMCS11, -+ [MGN_MCS12] = DESC_RATEMCS12, -+ [MGN_MCS13] = DESC_RATEMCS13, -+ [MGN_MCS14] = DESC_RATEMCS14, -+ [MGN_MCS15] = DESC_RATEMCS15, -+ [MGN_MCS16] = DESC_RATEMCS16, -+ [MGN_MCS17] = DESC_RATEMCS17, -+ [MGN_MCS18] = DESC_RATEMCS18, -+ [MGN_MCS19] = DESC_RATEMCS19, -+ [MGN_MCS20] = DESC_RATEMCS20, -+ [MGN_MCS21] = DESC_RATEMCS21, -+ [MGN_MCS22] = DESC_RATEMCS22, -+ [MGN_MCS23] = DESC_RATEMCS23, -+ [MGN_MCS24] = DESC_RATEMCS24, -+ [MGN_MCS25] = DESC_RATEMCS25, -+ [MGN_MCS26] = DESC_RATEMCS26, -+ [MGN_MCS27] = DESC_RATEMCS27, -+ [MGN_MCS28] = DESC_RATEMCS28, -+ [MGN_MCS29] = DESC_RATEMCS29, -+ [MGN_MCS30] = DESC_RATEMCS30, -+ [MGN_MCS31] = DESC_RATEMCS31, -+ [MGN_VHT1SS_MCS0] = DESC_RATEVHTSS1MCS0, -+ [MGN_VHT1SS_MCS1] = DESC_RATEVHTSS1MCS1, -+ [MGN_VHT1SS_MCS2] = DESC_RATEVHTSS1MCS2, -+ [MGN_VHT1SS_MCS3] = DESC_RATEVHTSS1MCS3, -+ [MGN_VHT1SS_MCS4] = DESC_RATEVHTSS1MCS4, -+ [MGN_VHT1SS_MCS5] = DESC_RATEVHTSS1MCS5, -+ [MGN_VHT1SS_MCS6] = DESC_RATEVHTSS1MCS6, -+ [MGN_VHT1SS_MCS7] = DESC_RATEVHTSS1MCS7, -+ [MGN_VHT1SS_MCS8] = DESC_RATEVHTSS1MCS8, -+ [MGN_VHT1SS_MCS9] = DESC_RATEVHTSS1MCS9, -+ [MGN_VHT2SS_MCS0] = DESC_RATEVHTSS2MCS0, -+ [MGN_VHT2SS_MCS1] = DESC_RATEVHTSS2MCS1, -+ [MGN_VHT2SS_MCS2] = DESC_RATEVHTSS2MCS2, -+ [MGN_VHT2SS_MCS3] = DESC_RATEVHTSS2MCS3, -+ [MGN_VHT2SS_MCS4] = DESC_RATEVHTSS2MCS4, -+ [MGN_VHT2SS_MCS5] = DESC_RATEVHTSS2MCS5, -+ [MGN_VHT2SS_MCS6] = DESC_RATEVHTSS2MCS6, -+ [MGN_VHT2SS_MCS7] = DESC_RATEVHTSS2MCS7, -+ [MGN_VHT2SS_MCS8] = DESC_RATEVHTSS2MCS8, -+ [MGN_VHT2SS_MCS9] = DESC_RATEVHTSS2MCS9, -+ [MGN_VHT3SS_MCS0] = DESC_RATEVHTSS3MCS0, -+ [MGN_VHT3SS_MCS1] = DESC_RATEVHTSS3MCS1, -+ [MGN_VHT3SS_MCS2] = DESC_RATEVHTSS3MCS2, -+ [MGN_VHT3SS_MCS3] = DESC_RATEVHTSS3MCS3, -+ [MGN_VHT3SS_MCS4] = DESC_RATEVHTSS3MCS4, -+ [MGN_VHT3SS_MCS5] = DESC_RATEVHTSS3MCS5, -+ [MGN_VHT3SS_MCS6] = DESC_RATEVHTSS3MCS6, -+ [MGN_VHT3SS_MCS7] = DESC_RATEVHTSS3MCS7, -+ [MGN_VHT3SS_MCS8] = DESC_RATEVHTSS3MCS8, -+ [MGN_VHT3SS_MCS9] = DESC_RATEVHTSS3MCS9, -+ [MGN_VHT4SS_MCS0] = DESC_RATEVHTSS4MCS0, -+ [MGN_VHT4SS_MCS1] = DESC_RATEVHTSS4MCS1, -+ [MGN_VHT4SS_MCS2] = DESC_RATEVHTSS4MCS2, -+ [MGN_VHT4SS_MCS3] = DESC_RATEVHTSS4MCS3, -+ [MGN_VHT4SS_MCS4] = DESC_RATEVHTSS4MCS4, -+ [MGN_VHT4SS_MCS5] = DESC_RATEVHTSS4MCS5, -+ [MGN_VHT4SS_MCS6] = DESC_RATEVHTSS4MCS6, -+ [MGN_VHT4SS_MCS7] = DESC_RATEVHTSS4MCS7, -+ [MGN_VHT4SS_MCS8] = DESC_RATEVHTSS4MCS8, -+ [MGN_VHT4SS_MCS9] = DESC_RATEVHTSS4MCS9, -+}; -+ -+u8 MRateToHwRate(enum MGN_RATE rate) -+{ -+ u8 hw_rate = DESC_RATE1M; /* default value, also is zero */ -+ -+ if (rate < MGN_UNKNOWN) -+ hw_rate = _MRateToHwRate[rate]; -+ -+ if (rate != MGN_1M && hw_rate == DESC_RATE1M) -+ RTW_WARN("Invalid rate 0x%x in %s\n", rate, __FUNCTION__); -+ -+ return hw_rate; -+} -+ -+const char * const _HDATA_RATE[DESC_RATE_NUM + 1] = { -+ [DESC_RATE1M] = "CCK_1M", -+ [DESC_RATE2M] = "CCK_2M", -+ [DESC_RATE5_5M] = "CCK5_5M", -+ [DESC_RATE11M] = "CCK_11M", -+ [DESC_RATE6M] = "OFDM_6M", -+ [DESC_RATE9M] = "OFDM_9M", -+ [DESC_RATE12M] = "OFDM_12M", -+ [DESC_RATE18M] = "OFDM_18M", -+ [DESC_RATE24M] = "OFDM_24M", -+ [DESC_RATE36M] = "OFDM_36M", -+ [DESC_RATE48M] = "OFDM_48M", -+ [DESC_RATE54M] = "OFDM_54M", -+ [DESC_RATEMCS0] = "MCS0", -+ [DESC_RATEMCS1] = "MCS1", -+ [DESC_RATEMCS2] = "MCS2", -+ [DESC_RATEMCS3] = "MCS3", -+ [DESC_RATEMCS4] = "MCS4", -+ [DESC_RATEMCS5] = "MCS5", -+ [DESC_RATEMCS6] = "MCS6", -+ [DESC_RATEMCS7] = "MCS7", -+ [DESC_RATEMCS8] = "MCS8", -+ [DESC_RATEMCS9] = "MCS9", -+ [DESC_RATEMCS10] = "MCS10", -+ [DESC_RATEMCS11] = "MCS11", -+ [DESC_RATEMCS12] = "MCS12", -+ [DESC_RATEMCS13] = "MCS13", -+ [DESC_RATEMCS14] = "MCS14", -+ [DESC_RATEMCS15] = "MCS15", -+ [DESC_RATEMCS16] = "MCS16", -+ [DESC_RATEMCS17] = "MCS17", -+ [DESC_RATEMCS18] = "MCS18", -+ [DESC_RATEMCS19] = "MCS19", -+ [DESC_RATEMCS20] = "MCS20", -+ [DESC_RATEMCS21] = "MCS21", -+ [DESC_RATEMCS22] = "MCS22", -+ [DESC_RATEMCS23] = "MCS23", -+ [DESC_RATEMCS24] = "MCS24", -+ [DESC_RATEMCS25] = "MCS25", -+ [DESC_RATEMCS26] = "MCS26", -+ [DESC_RATEMCS27] = "MCS27", -+ [DESC_RATEMCS28] = "MCS28", -+ [DESC_RATEMCS29] = "MCS29", -+ [DESC_RATEMCS30] = "MCS30", -+ [DESC_RATEMCS31] = "MCS31", -+ [DESC_RATEVHTSS1MCS0] = "VHT1SMCS0", -+ [DESC_RATEVHTSS1MCS1] = "VHT1SMCS1", -+ [DESC_RATEVHTSS1MCS2] = "VHT1SMCS2", -+ [DESC_RATEVHTSS1MCS3] = "VHT1SMCS3", -+ [DESC_RATEVHTSS1MCS4] = "VHT1SMCS4", -+ [DESC_RATEVHTSS1MCS5] = "VHT1SMCS5", -+ [DESC_RATEVHTSS1MCS6] = "VHT1SMCS6", -+ [DESC_RATEVHTSS1MCS7] = "VHT1SMCS7", -+ [DESC_RATEVHTSS1MCS8] = "VHT1SMCS8", -+ [DESC_RATEVHTSS1MCS9] = "VHT1SMCS9", -+ [DESC_RATEVHTSS2MCS0] = "VHT2SMCS0", -+ [DESC_RATEVHTSS2MCS1] = "VHT2SMCS1", -+ [DESC_RATEVHTSS2MCS2] = "VHT2SMCS2", -+ [DESC_RATEVHTSS2MCS3] = "VHT2SMCS3", -+ [DESC_RATEVHTSS2MCS4] = "VHT2SMCS4", -+ [DESC_RATEVHTSS2MCS5] = "VHT2SMCS5", -+ [DESC_RATEVHTSS2MCS6] = "VHT2SMCS6", -+ [DESC_RATEVHTSS2MCS7] = "VHT2SMCS7", -+ [DESC_RATEVHTSS2MCS8] = "VHT2SMCS8", -+ [DESC_RATEVHTSS2MCS9] = "VHT2SMCS9", -+ [DESC_RATEVHTSS3MCS0] = "VHT3SMCS0", -+ [DESC_RATEVHTSS3MCS1] = "VHT3SMCS1", -+ [DESC_RATEVHTSS3MCS2] = "VHT3SMCS2", -+ [DESC_RATEVHTSS3MCS3] = "VHT3SMCS3", -+ [DESC_RATEVHTSS3MCS4] = "VHT3SMCS4", -+ [DESC_RATEVHTSS3MCS5] = "VHT3SMCS5", -+ [DESC_RATEVHTSS3MCS6] = "VHT3SMCS6", -+ [DESC_RATEVHTSS3MCS7] = "VHT3SMCS7", -+ [DESC_RATEVHTSS3MCS8] = "VHT3SMCS8", -+ [DESC_RATEVHTSS3MCS9] = "VHT3SMCS9", -+ [DESC_RATEVHTSS4MCS0] = "VHT4SMCS0", -+ [DESC_RATEVHTSS4MCS1] = "VHT4SMCS1", -+ [DESC_RATEVHTSS4MCS2] = "VHT4SMCS2", -+ [DESC_RATEVHTSS4MCS3] = "VHT4SMCS3", -+ [DESC_RATEVHTSS4MCS4] = "VHT4SMCS4", -+ [DESC_RATEVHTSS4MCS5] = "VHT4SMCS5", -+ [DESC_RATEVHTSS4MCS6] = "VHT4SMCS6", -+ [DESC_RATEVHTSS4MCS7] = "VHT4SMCS7", -+ [DESC_RATEVHTSS4MCS8] = "VHT4SMCS8", -+ [DESC_RATEVHTSS4MCS9] = "VHT4SMCS9", -+ [DESC_RATE_NUM] = "UNKNOWN", -+}; -+ -+static const u8 _hw_rate_to_m_rate[DESC_RATE_NUM] = { -+ [DESC_RATE1M] = MGN_1M, -+ [DESC_RATE2M] = MGN_2M, -+ [DESC_RATE5_5M] = MGN_5_5M, -+ [DESC_RATE11M] = MGN_11M, -+ [DESC_RATE6M] = MGN_6M, -+ [DESC_RATE9M] = MGN_9M, -+ [DESC_RATE12M] = MGN_12M, -+ [DESC_RATE18M] = MGN_18M, -+ [DESC_RATE24M] = MGN_24M, -+ [DESC_RATE36M] = MGN_36M, -+ [DESC_RATE48M] = MGN_48M, -+ [DESC_RATE54M] = MGN_54M, -+ [DESC_RATEMCS0] = MGN_MCS0, -+ [DESC_RATEMCS1] = MGN_MCS1, -+ [DESC_RATEMCS2] = MGN_MCS2, -+ [DESC_RATEMCS3] = MGN_MCS3, -+ [DESC_RATEMCS4] = MGN_MCS4, -+ [DESC_RATEMCS5] = MGN_MCS5, -+ [DESC_RATEMCS6] = MGN_MCS6, -+ [DESC_RATEMCS7] = MGN_MCS7, -+ [DESC_RATEMCS8] = MGN_MCS8, -+ [DESC_RATEMCS9] = MGN_MCS9, -+ [DESC_RATEMCS10] = MGN_MCS10, -+ [DESC_RATEMCS11] = MGN_MCS11, -+ [DESC_RATEMCS12] = MGN_MCS12, -+ [DESC_RATEMCS13] = MGN_MCS13, -+ [DESC_RATEMCS14] = MGN_MCS14, -+ [DESC_RATEMCS15] = MGN_MCS15, -+ [DESC_RATEMCS16] = MGN_MCS16, -+ [DESC_RATEMCS17] = MGN_MCS17, -+ [DESC_RATEMCS18] = MGN_MCS18, -+ [DESC_RATEMCS19] = MGN_MCS19, -+ [DESC_RATEMCS20] = MGN_MCS20, -+ [DESC_RATEMCS21] = MGN_MCS21, -+ [DESC_RATEMCS22] = MGN_MCS22, -+ [DESC_RATEMCS23] = MGN_MCS23, -+ [DESC_RATEMCS24] = MGN_MCS24, -+ [DESC_RATEMCS25] = MGN_MCS25, -+ [DESC_RATEMCS26] = MGN_MCS26, -+ [DESC_RATEMCS27] = MGN_MCS27, -+ [DESC_RATEMCS28] = MGN_MCS28, -+ [DESC_RATEMCS29] = MGN_MCS29, -+ [DESC_RATEMCS30] = MGN_MCS30, -+ [DESC_RATEMCS31] = MGN_MCS31, -+ [DESC_RATEVHTSS1MCS0] = MGN_VHT1SS_MCS0, -+ [DESC_RATEVHTSS1MCS1] = MGN_VHT1SS_MCS1, -+ [DESC_RATEVHTSS1MCS2] = MGN_VHT1SS_MCS2, -+ [DESC_RATEVHTSS1MCS3] = MGN_VHT1SS_MCS3, -+ [DESC_RATEVHTSS1MCS4] = MGN_VHT1SS_MCS4, -+ [DESC_RATEVHTSS1MCS5] = MGN_VHT1SS_MCS5, -+ [DESC_RATEVHTSS1MCS6] = MGN_VHT1SS_MCS6, -+ [DESC_RATEVHTSS1MCS7] = MGN_VHT1SS_MCS7, -+ [DESC_RATEVHTSS1MCS8] = MGN_VHT1SS_MCS8, -+ [DESC_RATEVHTSS1MCS9] = MGN_VHT1SS_MCS9, -+ [DESC_RATEVHTSS2MCS0] = MGN_VHT2SS_MCS0, -+ [DESC_RATEVHTSS2MCS1] = MGN_VHT2SS_MCS1, -+ [DESC_RATEVHTSS2MCS2] = MGN_VHT2SS_MCS2, -+ [DESC_RATEVHTSS2MCS3] = MGN_VHT2SS_MCS3, -+ [DESC_RATEVHTSS2MCS4] = MGN_VHT2SS_MCS4, -+ [DESC_RATEVHTSS2MCS5] = MGN_VHT2SS_MCS5, -+ [DESC_RATEVHTSS2MCS6] = MGN_VHT2SS_MCS6, -+ [DESC_RATEVHTSS2MCS7] = MGN_VHT2SS_MCS7, -+ [DESC_RATEVHTSS2MCS8] = MGN_VHT2SS_MCS8, -+ [DESC_RATEVHTSS2MCS9] = MGN_VHT2SS_MCS9, -+ [DESC_RATEVHTSS3MCS0] = MGN_VHT3SS_MCS0, -+ [DESC_RATEVHTSS3MCS1] = MGN_VHT3SS_MCS1, -+ [DESC_RATEVHTSS3MCS2] = MGN_VHT3SS_MCS2, -+ [DESC_RATEVHTSS3MCS3] = MGN_VHT3SS_MCS3, -+ [DESC_RATEVHTSS3MCS4] = MGN_VHT3SS_MCS4, -+ [DESC_RATEVHTSS3MCS5] = MGN_VHT3SS_MCS5, -+ [DESC_RATEVHTSS3MCS6] = MGN_VHT3SS_MCS6, -+ [DESC_RATEVHTSS3MCS7] = MGN_VHT3SS_MCS7, -+ [DESC_RATEVHTSS3MCS8] = MGN_VHT3SS_MCS8, -+ [DESC_RATEVHTSS3MCS9] = MGN_VHT3SS_MCS9, -+ [DESC_RATEVHTSS4MCS0] = MGN_VHT4SS_MCS0, -+ [DESC_RATEVHTSS4MCS1] = MGN_VHT4SS_MCS1, -+ [DESC_RATEVHTSS4MCS2] = MGN_VHT4SS_MCS2, -+ [DESC_RATEVHTSS4MCS3] = MGN_VHT4SS_MCS3, -+ [DESC_RATEVHTSS4MCS4] = MGN_VHT4SS_MCS4, -+ [DESC_RATEVHTSS4MCS5] = MGN_VHT4SS_MCS5, -+ [DESC_RATEVHTSS4MCS6] = MGN_VHT4SS_MCS6, -+ [DESC_RATEVHTSS4MCS7] = MGN_VHT4SS_MCS7, -+ [DESC_RATEVHTSS4MCS8] = MGN_VHT4SS_MCS8, -+ [DESC_RATEVHTSS4MCS9] = MGN_VHT4SS_MCS9, -+}; -+ -+u8 hw_rate_to_m_rate(u8 hw_rate) -+{ -+ u8 rate = MGN_1M; /* default value */ -+ -+ if (hw_rate < DESC_RATE_NUM) -+ rate = _hw_rate_to_m_rate[hw_rate]; -+ else -+ RTW_WARN("Invalid hw_rate 0x%x in %s\n", hw_rate, __FUNCTION__); -+ -+ return rate; -+} -+ -+#ifdef CONFIG_RTW_DEBUG -+void dump_hw_rate_map_test(void *sel) -+{ -+ RATE_SECTION rs; -+ u8 hw_rate; -+ enum MGN_RATE m_rate; -+ int i; -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ for (i = 0; i < rates_by_sections[rs].rate_num; i++) { -+ hw_rate = MRateToHwRate(rates_by_sections[rs].rates[i]); -+ RTW_PRINT_SEL(sel, "m_rate:%s(%d) to hw_rate:%s(%d)\n" -+ , MGN_RATE_STR(rates_by_sections[rs].rates[i]), rates_by_sections[rs].rates[i] -+ , HDATA_RATE(hw_rate), hw_rate -+ ); -+ } -+ if (rs == HT_4SS) { /* show MCS32 after MCS31 */ -+ hw_rate = MRateToHwRate(MGN_MCS32); -+ RTW_PRINT_SEL(sel, "m_rate:%s(%d) to hw_rate:%s(%d)\n" -+ , MGN_RATE_STR(MGN_MCS32), MGN_MCS32 -+ , HDATA_RATE(hw_rate), hw_rate -+ ); -+ } -+ } -+ hw_rate = MRateToHwRate(MGN_UNKNOWN); -+ RTW_PRINT_SEL(sel, "m_rate:%s(%d) to hw_rate:%s(%d)\n" -+ , MGN_RATE_STR(MGN_UNKNOWN), MGN_UNKNOWN -+ , HDATA_RATE(hw_rate), hw_rate -+ ); -+ -+ for (i = DESC_RATE1M; i <= DESC_RATE_NUM; i++) { -+ m_rate = hw_rate_to_m_rate(i); -+ RTW_PRINT_SEL(sel, "hw_rate:%s(%d) to m_rate:%s(%d)\n" -+ , HDATA_RATE(i), i -+ , MGN_RATE_STR(m_rate), m_rate -+ ); -+ } -+} -+#endif /* CONFIG_RTW_DEBUG */ -+ -+void HalSetBrateCfg( -+ PADAPTER 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( -+ 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( -+ PADAPTER pAdapter, -+ 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( -+ PADAPTER pAdapter, -+ 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 */ -+ } -+ -+} -+#if 0 -+static void _FourOutPipeMapping( -+ PADAPTER pAdapter, -+ 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 */ -+ } -+ -+} -+#endif -+BOOLEAN -+Hal_MappingOutPipe( -+ PADAPTER pAdapter, -+ 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: -+ case 5: -+ case 6: -+ _ThreeOutPipeMapping(pAdapter, bWIFICfg); -+ break; -+ case 1: -+ _OneOutPipeMapping(pAdapter); -+ break; -+ default: -+ result = _FALSE; -+ break; -+ } -+ -+ return result; -+ -+} -+ -+void rtw_hal_reqtxrpt(_adapter *padapter, u8 macid) -+{ -+ if (padapter->hal_func.reqtxrpt) -+ padapter->hal_func.reqtxrpt(padapter, macid); -+} -+ -+int rtw_get_sta_tx_stat(_adapter *adapter, u8 mac_id, u8 *macaddr) -+{ -+ struct sta_priv *pstapriv_primary = &(GET_PRIMARY_ADAPTER(adapter))->stapriv; -+ struct submit_ctx gotc2h; -+ u8 cmd_ret; -+ int ret = _SUCCESS; -+ -+ if (!adapter->hal_func.reqtxrpt) { -+ RTW_INFO("Not support.\n"); -+ ret = RTW_NOT_SUPPORT; -+ goto exit; -+ } -+ -+ if (pstapriv_primary->gotc2h != NULL) { -+ RTW_INFO("sta tx stat is processing.\n"); -+ ret = RTW_BUSY; -+ goto exit; -+ } -+ -+ rtw_sctx_init(&gotc2h, 60); -+ pstapriv_primary->gotc2h = &gotc2h; -+ _rtw_memcpy(pstapriv_primary->c2h_sta_mac, macaddr, ETH_ALEN); -+ pstapriv_primary->c2h_adapter_id = adapter->iface_id; -+ -+ cmd_ret = rtw_reqtxrpt_cmd(adapter, mac_id); -+ if (cmd_ret != _SUCCESS) { -+ RTW_WARN("rtw_reqtxrpt_cmd fail\n"); -+ ret = _FAIL; -+ } else -+ rtw_sctx_wait(&gotc2h, __func__); -+ -+ enter_critical_bh(&pstapriv_primary->tx_rpt_lock); -+ pstapriv_primary->gotc2h = NULL; -+ exit_critical_bh(&pstapriv_primary->tx_rpt_lock); -+ -+ if (cmd_ret == _SUCCESS && gotc2h.status != RTW_SCTX_DONE_SUCCESS) { -+ RTW_WARN("wait for C2H timeout, operation abort!!\n"); -+ ret = _FAIL; -+ } -+ -+ _rtw_memset(pstapriv_primary->c2h_sta_mac, 0, ETH_ALEN); -+ pstapriv_primary->c2h_adapter_id = CONFIG_IFACE_NUMBER; -+ -+exit: -+ return ret; -+} -+ -+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 -+ rtw_mi_hal_dump_macaddr(sel, adapter); -+#endif -+} -+ -+/** -+ * rtw_hal_set_hw_macaddr() - Set HW MAC address -+ * @adapter: struct PADAPTER -+ * @mac_addr: 6-bytes mac address -+ * -+ * Set Wifi Mac address by writing to the relative HW registers, -+ * -+ */ -+void rtw_hal_set_hw_macaddr(PADAPTER adapter, u8 *mac_addr) -+{ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_hal_change_macaddr_mbid(adapter, mac_addr); -+#else -+ rtw_hal_set_hwreg(adapter, HW_VAR_MAC_ADDR, mac_addr); -+#endif -+#ifdef CONFIG_RTW_DEBUG -+ rtw_hal_dump_macaddr(RTW_DBGDUMP, adapter); -+#endif -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+} -+ -+#ifdef RTW_HALMAC -+void rtw_hal_hw_port_enable(_adapter *adapter) -+{ -+#if 1 -+ u8 port_enable = _TRUE; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_PORT_CFG, &port_enable); -+#else -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct rtw_halmac_bcn_ctrl bcn_ctrl; -+ -+ _rtw_memset(&bcn_ctrl, 0, sizeof(struct rtw_halmac_bcn_ctrl)); -+ bcn_ctrl.enable_bcn = 1; -+ bcn_ctrl.rx_bssid_fit = 1; -+ bcn_ctrl.rxbcn_rpt = 1; -+ -+ /*rtw_halmac_get_bcn_ctrl(struct dvobj_priv *d, enum _hw_port hwport, -+ struct rtw_halmac_bcn_ctrl *bcn_ctrl)*/ -+ if (rtw_halmac_set_bcn_ctrl(dvobj, get_hw_port(adapter), &bcn_ctrl) == -1) { -+ RTW_ERR(ADPT_FMT" - hw port(%d) enable fail!!\n", ADPT_ARG(adapter), get_hw_port(adapter)); -+ rtw_warn_on(1); -+ } -+#endif -+} -+void rtw_hal_hw_port_disable(_adapter *adapter) -+{ -+ u8 port_enable = _FALSE; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_PORT_CFG, &port_enable); -+} -+ -+void rtw_restore_hw_port_cfg(_adapter *adapter) -+{ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ -+#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_hw_port_enable(iface); -+ } -+#endif -+} -+#endif -+ -+void rtw_mi_set_mac_addr(_adapter *adapter) -+{ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_mi_set_mbid_cam(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_hwreg(iface, HW_VAR_MAC_ADDR, adapter_mac_addr(iface)); -+ } -+#endif -+ if (0) -+ 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->antenna_test = _FALSE; -+ pHalData->RegIQKFWOffload = regsty->iqk_fw_offload; -+ pHalData->ch_switch_offload = regsty->ch_switch_offload; -+ pHalData->multi_ch_switch_mode = 0; -+#ifdef RTW_REDUCE_SCAN_SWITCH_CH_TIME -+ if (pHalData->ch_switch_offload == 0) -+ pHalData->ch_switch_offload = 1; -+#endif -+} -+ -+#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: ", 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->hal_func.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__); -+} -+ -+#ifdef CONFIG_FW_OFFLOAD_SET_TXPWR_IDX -+void c2h_txpwr_idx_offload_done(_adapter *adapter, u8 *data, u8 len) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct submit_ctx *sctx = &hal_data->txpwr_idx_offload_sctx; -+ -+ if (0) -+ RTW_INFO("txpwr_idx offload finish in %dms\n", rtw_get_passing_time_ms(sctx->submit_time)); -+ rtw_sctx_done(&sctx); -+} -+ -+int c2h_txpwr_idx_offload_wait(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct submit_ctx *sctx = &hal_data->txpwr_idx_offload_sctx; -+ -+ return rtw_sctx_wait(sctx, __func__); -+} -+#endif -+ -+#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_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); -+ enum rf_type rf_type; -+ u8 tx_path_num, rx_path_num; -+ int ret = _FAIL; -+ -+ 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 ss_num = 4; -+ 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); -+ 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("ant_num:0x%x\n", ant_num); -+ RTW_PRINT("protocol:0x%x\n", protocol); -+ RTW_PRINT("nic:0x%x\n", nic); -+ } -+ -+#if defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) -+ if (IS_8822C_SERIES(hal_data->version_id) || IS_8814B_SERIES(hal_data->version_id)) { -+ #define GET_C2H_MAC_HIDDEN_RPT_SS_NUM(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 3, 2) -+ ss_num = GET_C2H_MAC_HIDDEN_RPT_SS_NUM(data); -+ -+ if (DBG_C2H_MAC_HIDDEN_RPT_HANDLE) -+ RTW_PRINT("ss_num:0x%x\n", ss_num); -+ -+ if (ss_num == 0x03) -+ ss_num = 4; -+ } -+#endif -+ -+#if defined(CONFIG_RTL8822C) -+ if (IS_8822C_SERIES(hal_data->version_id)) { -+ if (ant_num == 1) -+ hal_spec->rf_reg_trx_path_bmp = 0x22; /* 1T1R pathB */ -+ if (hw_stype == 0xE) -+ hal_spec->max_tx_cnt = rtw_min(hal_spec->max_tx_cnt, 1); /* limit 1TX only */ -+ } -+#endif -+ hal_data->PackageType = package_type; -+ hal_spec->hci_type = hci_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->proto_cap &= mac_hidden_proto_to_hal_proto_cap(protocol); -+ -+ rf_type = rtw_chip_rftype_to_hal_rftype(adapter, 0); -+ if (!RF_TYPE_VALID(rf_type)) { -+ RTW_ERR("%s rtw_chip_rftype_to_hal_rftype failed\n", __func__); -+ goto exit; -+ } -+ hal_spec->rf_reg_path_avail_num = rtw_min(hal_spec->rf_reg_path_num, ant_num); -+ tx_path_num = rtw_min(rf_type_to_rf_tx_cnt(rf_type), hal_spec->rf_reg_path_avail_num); -+ rx_path_num = rtw_min(rf_type_to_rf_rx_cnt(rf_type), hal_spec->rf_reg_path_avail_num); -+ hal_spec->rf_reg_trx_path_bmp = rtw_restrict_trx_path_bmp_by_trx_num_lmt( -+ hal_spec->rf_reg_trx_path_bmp, tx_path_num, rx_path_num, &tx_path_num, &rx_path_num); -+ if (!hal_spec->rf_reg_trx_path_bmp) { -+ RTW_ERR("%s rtw_restrict_trx_path_bmp_by_trx_num_lmt(0x%x, %u, %u) failed\n" -+ , __func__, hal_spec->rf_reg_trx_path_bmp, tx_path_num, rx_path_num); -+ goto exit; -+ } -+ hal_spec->rf_reg_path_avail_num = rtw_max(tx_path_num, rx_path_num); -+ -+ /* -+ * RF TX path num >= max_tx_cnt >= tx_nss_num -+ * ex: RF TX path num(4) >= max_tx_cnt(2) >= tx_nss_num(1) -+ * Select at most 2 out of 4 TX RF path to do 1SS 2TX -+ */ -+ hal_spec->max_tx_cnt = rtw_min(hal_spec->max_tx_cnt, tx_path_num); -+ hal_spec->tx_nss_num = rtw_min(hal_spec->tx_nss_num, hal_spec->max_tx_cnt); -+ hal_spec->tx_nss_num = rtw_min(hal_spec->tx_nss_num, ss_num); -+ -+ hal_spec->rx_nss_num = rtw_min(hal_spec->rx_nss_num, rx_path_num); -+ hal_spec->rx_nss_num = rtw_min(hal_spec->rx_nss_num, ss_num); -+ -+ 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); -+ 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)); -+ } -+ -+ #if defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) -+ if (IS_8188F(hal_data->version_id) || IS_8188GTV(hal_data->version_id)) { -+ #define GET_C2H_MAC_HIDDEN_RPT_IRV(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 0, 0, 4) -+ u8 irv = GET_C2H_MAC_HIDDEN_RPT_IRV(data); -+ -+ if (DBG_C2H_MAC_HIDDEN_RPT_HANDLE) -+ RTW_PRINT("irv:0x%x\n", irv); -+ -+ if(irv != 0xf) -+ hal_data->version_id.CUTVersion = irv; -+ } -+ #endif -+ -+ #if defined(CONFIG_8723F) -+ if (IS_8723F_SERIES(hal_data->version_id)) { -+ #define GET_C2H_MAC_HIDDEN_RPT_BT_SUPPORT(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 4, 0, 1) -+ #define GET_C2H_MAC_HIDDEN_RPT_5G_SUPPORT(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 4, 1, 1) -+ -+ struct hal_spec_t *hal_spec; -+ u8 bt_support = GET_C2H_MAC_HIDDEN_RPT_BT_SUPPORT(data); -+ u8 band_5g_support = GET_C2H_MAC_HIDDEN_RPT_5G_SUPPORT(data); -+ -+ hal_spec = GET_HAL_SPEC(adapter); -+ -+ if (DBG_C2H_MAC_HIDDEN_RPT_HANDLE) { -+ RTW_PRINT("bt support:%u\n", bt_support); -+ RTW_PRINT("band 5g support:%u\n", band_5g_support); -+ } -+ -+ hal_spec->rfpath_num_5g = (band_5g_support ? hal_spec->rfpath_num_5g : 0); -+ if(!band_5g_support) -+ hal_spec->band_cap &= ~BAND_CAP_5G; -+ -+ hal_data->EEPROMBluetoothCoexist = bt_support; -+ /* 0 : solo module, 1 : combo module */ -+ hal_data->InterfaceSel = bt_support; -+ } -+ #endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int hal_read_mac_hidden_rpt(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ int ret = _FAIL; -+ int ret_fwdl; -+ u8 mac_hidden_rpt[MAC_HIDDEN_RPT_LEN + MAC_HIDDEN_RPT_2_LEN] = {0}; -+ systime 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 */ -+ pHalData->not_xmitframe_fw_dl = 1; -+ ret_fwdl = rtw_hal_fw_dl(adapter, _FALSE); -+ pHalData->not_xmitframe_fw_dl = 0; -+ 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; -+ -+#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) -+{ -+ 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 */ -+ -+#ifdef RTW_PER_CMD_SUPPORT_FW -+#define H2C_REQ_PER_RPT_LEN 5 -+#define SET_H2CCMD_REQ_PER_RPT_GROUP_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_H2CCMD_REQ_PER_RPT_RPT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_H2CCMD_REQ_PER_RPT_MACID_BMAP(__pH2CCmd, __Value) SET_BITS_TO_LE_4BYTE(__pH2CCmd + 1, 0, 32, __Value) -+ -+u8 rtw_hal_set_req_per_rpt_cmd(_adapter *adapter, u8 group_macid, -+ u8 rpt_type, u32 macid_bitmap) -+{ -+ u8 ret = _FAIL; -+ u8 cmd_buf[H2C_REQ_PER_RPT_LEN] = {0}; -+ -+ SET_H2CCMD_REQ_PER_RPT_GROUP_MACID(cmd_buf, group_macid); -+ SET_H2CCMD_REQ_PER_RPT_RPT_TYPE(cmd_buf, rpt_type); -+ SET_H2CCMD_REQ_PER_RPT_MACID_BMAP(cmd_buf, macid_bitmap); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_REQ_PER_RPT, -+ H2C_REQ_PER_RPT_LEN, -+ cmd_buf); -+ return ret; -+} -+ -+#define GET_C2H_PER_RATE_RPT_TYPE0_MACID0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)), 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE0_PER0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 1, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE0_RATE0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 2, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE0_BW0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 3, 0, 2) -+#define GET_C2H_PER_RATE_RPT_TYPE0_TOTAL_PKT0(_data) LE_BITS_TO_2BYTE(((u8 *)(_data)) + 4, 0, 16) -+#define GET_C2H_PER_RATE_RPT_TYPE0_MACID1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE0_PER1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 7, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE0_RATE1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 8, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE0_BW1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 9, 0, 2) -+#define GET_C2H_PER_RATE_RPT_TYPE0_TOTAL_PKT1(_data) LE_BITS_TO_2BYTE(((u8 *)(_data)) + 10, 0, 16) -+ -+#define GET_C2H_PER_RATE_RPT_TYPE1_MACID0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)), 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE1_PER0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 1, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE1_RATE0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 2, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE1_BW0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 3, 0, 2) -+#define GET_C2H_PER_RATE_RPT_TYPE1_MACID1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 4, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE1_PER1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 5, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE1_RATE1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE1_BW1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 7, 0, 2) -+#define GET_C2H_PER_RATE_RPT_TYPE1_MACID2(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 8, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE1_PER2(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 9, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE1_RATE2(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 10, 0, 8) -+#define GET_C2H_PER_RATE_RPT_TYPE1_BW2(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 11, 0, 2) -+ -+static void per_rate_rpt_update(_adapter *adapter, u8 mac_id, -+ u8 per, u8 rate, -+ u8 bw, u8 total_pkt) -+{ -+#ifdef CONFIG_RTW_MESH -+ rtw_ieee80211s_update_metric(adapter, mac_id, -+ per, rate, -+ bw, total_pkt); -+#endif -+} -+ -+int c2h_per_rate_rpt_hdl(_adapter *adapter, u8 *data, u8 len) -+{ -+ /* Now only consider type0, since it covers all params in type1 -+ * type0: mac_id, per, rate, bw, total_pkt -+ * type1: mac_id, per, rate, bw -+ */ -+ u8 mac_id[2] = {0}, per[2] = {0}, rate[2] = {0}, bw[2] = {0}; -+ u16 total_pkt[2] = {0}; -+ int ret = _FAIL, i, macid_cnt = 0; -+ -+ /* type0: -+ * 1 macid includes 6 bytes info + 1 byte 0xff -+ * 2 macid includes 2*6 bytes info -+ */ -+ if (!(len == 7 || len == 12)) { -+ RTW_WARN("%s len(%u) != 7 or 12\n", __FUNCTION__, len); -+ goto exit; -+ } -+ -+ macid_cnt++; -+ mac_id[0] = GET_C2H_PER_RATE_RPT_TYPE0_MACID0(data); -+ per[0] = GET_C2H_PER_RATE_RPT_TYPE0_PER0(data); -+ rate[0] = GET_C2H_PER_RATE_RPT_TYPE0_RATE0(data); -+ bw[0] = GET_C2H_PER_RATE_RPT_TYPE0_BW0(data); -+ total_pkt[0] = GET_C2H_PER_RATE_RPT_TYPE0_TOTAL_PKT0(data); -+ -+ mac_id[1] = GET_C2H_PER_RATE_RPT_TYPE0_MACID1(data); -+ /* 0xff means no report anymore */ -+ if (mac_id[1] == 0xff) -+ goto update_per; -+ if (len != 12) { -+ RTW_WARN("%s incorrect format\n", __FUNCTION__); -+ goto exit; -+ } -+ macid_cnt++; -+ per[1] = GET_C2H_PER_RATE_RPT_TYPE0_PER1(data); -+ rate[1] = GET_C2H_PER_RATE_RPT_TYPE0_RATE1(data); -+ bw[1] = GET_C2H_PER_RATE_RPT_TYPE0_BW1(data); -+ total_pkt[1] = GET_C2H_PER_RATE_RPT_TYPE0_TOTAL_PKT1(data); -+ -+update_per: -+ for (i = 0; i < macid_cnt; i++) { -+ RTW_DBG("[%s] type0 rpt[%d]: macid = %u, per = %u, " -+ "rate = %u, bw = %u, total_pkt = %u\n", -+ __FUNCTION__, i, mac_id[i], per[i], -+ rate[i], bw[i], total_pkt[i]); -+ per_rate_rpt_update(adapter, mac_id[i], -+ per[i], rate[i], -+ bw[i], total_pkt[i]); -+ } -+ ret = _SUCCESS; -+exit: -+ return ret; -+} -+#endif /* RTW_PER_CMD_SUPPORT_FW */ -+ -+#ifdef CONFIG_LPS_ACK -+#define GET_C2H_LPS_STATUS_RPT_GET_ACTION(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)), 0, 8) -+#define GET_C2H_LPS_STATUS_RPT_GET_STATUS_CODE(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 1, 0, 8) -+#define DBG_LPS_STATUS_RPT 0 -+ -+int c2h_lps_status_rpt(PADAPTER adapter, u8 *data, u8 len) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct submit_ctx *lps_sctx = &pwrpriv->lps_ack_sctx; -+ u8 action = 0; -+ s8 status_code = 0; -+ int ret = _FAIL; -+ -+ if (len < LPS_STATUS_RPT_LEN) { -+ RTW_WARN("%s len(%u) < %d\n", __func__, len, LPS_STATUS_RPT_LEN); -+ goto exit; -+ } -+ -+ action = GET_C2H_LPS_STATUS_RPT_GET_ACTION(data); -+ status_code = GET_C2H_LPS_STATUS_RPT_GET_STATUS_CODE(data); -+ -+ /* action=0: report force leave null data status */ -+ /* action=1: report Rf on status when receiving a SetPwrMode H2C with PwrState = RFON */ -+ switch (action) { -+ case 0: -+ /* status code 0: success, 1: no ack, 2: timeout, 3: cancel */ -+ case 1: -+ /* status code 0: FW has already turn to RFON */ -+ pwrpriv->lps_ack_status = status_code; -+ -+ if (DBG_LPS_STATUS_RPT) -+ RTW_INFO("=== [C2H LPS Action(%d)] LPS Status Code:%d ===\n", action, status_code); -+ -+ break; -+ default: -+ RTW_INFO("UnKnown Action(%d) for C2H LPS RPT\n", action); -+ break; -+ } -+ -+ rtw_sctx_done(&lps_sctx); -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_LPS_ACK */ -+ -+void rtw_hal_update_sta_wset(_adapter *adapter, struct sta_info *psta) -+{ -+ u8 w_set = 0; -+ -+ if (psta->wireless_mode & WIRELESS_11B) -+ w_set |= WIRELESS_CCK; -+ -+ if ((psta->wireless_mode & WIRELESS_11G) || (psta->wireless_mode & WIRELESS_11A)) -+ w_set |= WIRELESS_OFDM; -+ -+ if ((psta->wireless_mode & WIRELESS_11_24N) || (psta->wireless_mode & WIRELESS_11_5N)) -+ w_set |= WIRELESS_HT; -+ -+ if (psta->wireless_mode & WIRELESS_11AC) -+ w_set |= WIRELESS_VHT; -+ -+ psta->cmn.support_wireless_set = w_set; -+} -+ -+void rtw_hal_update_sta_mimo_type(_adapter *adapter, struct sta_info *psta) -+{ -+ s8 tx_nss, rx_nss; -+ -+ tx_nss = rtw_get_sta_tx_nss(adapter, psta); -+ rx_nss = rtw_get_sta_rx_nss(adapter, psta); -+ if ((tx_nss == 1) && (rx_nss == 1)) -+ psta->cmn.mimo_type = RF_1T1R; -+ else if ((tx_nss == 1) && (rx_nss == 2)) -+ psta->cmn.mimo_type = RF_1T2R; -+ else if ((tx_nss == 2) && (rx_nss == 2)) -+ psta->cmn.mimo_type = RF_2T2R; -+ else if ((tx_nss == 2) && (rx_nss == 3)) -+ psta->cmn.mimo_type = RF_2T3R; -+ else if ((tx_nss == 2) && (rx_nss == 4)) -+ psta->cmn.mimo_type = RF_2T4R; -+ else if ((tx_nss == 3) && (rx_nss == 3)) -+ psta->cmn.mimo_type = RF_3T3R; -+ else if ((tx_nss == 3) && (rx_nss == 4)) -+ psta->cmn.mimo_type = RF_3T4R; -+ else if ((tx_nss == 4) && (rx_nss == 4)) -+ psta->cmn.mimo_type = RF_4T4R; -+ else -+ rtw_warn_on(1); -+ -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+ rtw_ctrl_txss_update_mimo_type(adapter, psta); -+#endif -+ -+ RTW_INFO("STA - MAC_ID:%d, Tx - %d SS, Rx - %d SS\n", -+ psta->cmn.mac_id, tx_nss, rx_nss); -+} -+ -+void rtw_hal_update_sta_smps_cap(_adapter *adapter, struct sta_info *psta) -+{ -+ /*Spatial Multiplexing Power Save*/ -+#if 0 -+ if (check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { -+ #ifdef CONFIG_80211N_HT -+ if (psta->htpriv.ht_option) { -+ if (psta->htpriv.smps_cap == 0) -+ psta->cmn.sm_ps = SM_PS_STATIC; -+ else if (psta->htpriv.smps_cap == 1) -+ psta->cmn.sm_ps = SM_PS_DYNAMIC; -+ else -+ psta->cmn.sm_ps = SM_PS_DISABLE; -+ } -+ #endif /* CONFIG_80211N_HT */ -+ } else -+#endif -+ psta->cmn.sm_ps = SM_PS_DISABLE; -+ -+ RTW_INFO("STA - MAC_ID:%d, SM_PS %d\n", -+ psta->cmn.mac_id, psta->cmn.sm_ps); -+} -+ -+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, tx_nss; -+ u64 tx_ra_bitmap = 0, tmp64=0; -+ -+ if (psta == NULL) -+ return; -+ -+ /* 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 -+if (padapter->registrypriv.ht_enable && is_supported_ht(padapter->registrypriv.wireless_mode)) { -+ tx_nss = GET_HAL_TX_NSS(padapter); -+#ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) { -+ /* AC mode ra_bitmap */ -+ tx_ra_bitmap |= (rtw_vht_mcs_map_to_bitmap(psta->vhtpriv.vht_mcs_map, tx_nss) << 12); -+ } else -+#endif /* CONFIG_80211AC_VHT */ -+ if (psta->htpriv.ht_option) { -+ /* n mode ra_bitmap */ -+ -+ /* 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*/ -+ tx_nss = rtw_min(tx_nss, 1); -+ } -+ } -+ -+ tmp64 = rtw_ht_mcs_set_to_bitmap(psta->htpriv.ht_cap.supp_mcs_set, tx_nss); -+ tx_ra_bitmap |= (tmp64 << 12); -+ } -+} -+#endif /* CONFIG_80211N_HT */ -+ psta->cmn.ra_info.ramask = tx_ra_bitmap; -+ psta->init_rate = get_highest_rate_idx(tx_ra_bitmap) & 0x3f; -+} -+ -+void rtw_hal_update_sta_ra_info(PADAPTER padapter, struct sta_info *psta) -+{ -+ rtw_hal_update_sta_mimo_type(padapter, psta); -+ rtw_hal_update_sta_smps_cap(padapter, psta); -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+} -+ -+#ifndef CONFIG_HAS_HW_VAR_BCN_CTRL_ADDR -+static u32 hw_bcn_ctrl_addr(_adapter *adapter, u8 hw_port) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ if (hw_port >= hal_spec->port_num) { -+ RTW_ERR(FUNC_ADPT_FMT" HW Port(%d) invalid\n", FUNC_ADPT_ARG(adapter), hw_port); -+ rtw_warn_on(1); -+ return 0; -+ } -+ -+ switch (hw_port) { -+ case HW_PORT0: -+ return REG_BCN_CTRL; -+ case HW_PORT1: -+ return REG_BCN_CTRL_1; -+ } -+ -+ return 0; -+} -+#endif -+ -+static void rtw_hal_get_msr(_adapter *adapter, u8 *net_type) -+{ -+#ifdef RTW_HALMAC -+ rtw_halmac_get_network_type(adapter_to_dvobj(adapter), -+ adapter->hw_port, net_type); -+#else /* !RTW_HALMAC */ -+ 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) -+ 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)*/ -+ default: -+ RTW_INFO("[WARN] "ADPT_FMT"- invalid hw port -%d\n", -+ ADPT_ARG(adapter), adapter->hw_port); -+ rtw_warn_on(1); -+ break; -+ } -+#endif /* !RTW_HALMAC */ -+} -+ -+#if defined(CONFIG_MI_WITH_MBSSID_CAM) && defined(CONFIG_MBSSID_CAM) /*For 2 hw ports - 88E/92E/8812/8821/8723B*/ -+static u8 rtw_hal_net_type_decision(_adapter *adapter, u8 net_type) -+{ -+ if ((adapter->hw_port == HW_PORT0) && (rtw_get_mbid_cam_entry_num(adapter))) { -+ if (net_type != _HW_STATE_NOLINK_) -+ return _HW_STATE_AP_; -+ } -+ return net_type; -+} -+#endif -+static void rtw_hal_set_msr(_adapter *adapter, u8 net_type) -+{ -+#ifdef RTW_HALMAC -+ #if defined(CONFIG_MI_WITH_MBSSID_CAM) && defined(CONFIG_MBSSID_CAM) -+ net_type = rtw_hal_net_type_decision(adapter, net_type); -+ #endif -+ rtw_halmac_set_network_type(adapter_to_dvobj(adapter), -+ adapter->hw_port, net_type); -+#else /* !RTW_HALMAC */ -+ u8 val8 = 0; -+ -+ switch (adapter->hw_port) { -+ case HW_PORT0: -+ #if defined(CONFIG_MI_WITH_MBSSID_CAM) && defined(CONFIG_MBSSID_CAM) -+ net_type = rtw_hal_net_type_decision(adapter, net_type); -+ #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) -+ 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 */ -+ default: -+ RTW_INFO("[WARN] "ADPT_FMT"- invalid hw port -%d\n", -+ ADPT_ARG(adapter), adapter->hw_port); -+ rtw_warn_on(1); -+ break; -+ } -+#endif /* !RTW_HALMAC */ -+} -+ -+#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; -+ systime 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; -+ systime 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) -+{ -+ 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, addr1 = 0; -+ u32 wdata, wdata1 = 0; -+ -+ /* 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; -+ -+#if defined(CONFIG_RTL8192F) -+ if(j == 1) { -+ wdata1 = wdata; -+ addr1 = addr; -+ continue; -+ } -+#endif -+ -+ rtw_sec_write_cam(adapter, addr, wdata); -+ } -+ -+#if defined(CONFIG_RTL8192F) -+ rtw_sec_write_cam(adapter, addr1, wdata1); -+#endif -+} -+ -+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 (INVALID_CAM_ID != rtw_mbid_cam_search_by_macaddr(adapter, mac_addr)) -+ goto exit; -+ -+ 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); -+ } -+ -+ _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 (MLME_IS_STA(iface)) -+ _RTW_PRINT_SEL(sel, "ROLE:%s\n", "STA"); -+ else if (MLME_IS_AP(iface)) -+ _RTW_PRINT_SEL(sel, "ROLE:%s\n", "AP"); -+ else if (MLME_IS_MESH(iface)) -+ _RTW_PRINT_SEL(sel, "ROLE:%s\n", "MESH"); -+ 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); -+} -+*/ -+ -+void rtw_ap_set_mbid_num(_adapter *adapter, u8 ap_num) -+{ -+ rtw_write8(adapter, REG_MBID_NUM, -+ ((rtw_read8(adapter, REG_MBID_NUM) & 0xF8) | ((ap_num -1) & 0x07))); -+ -+} -+void rtw_mbid_cam_enable(_adapter *adapter) -+{ -+ /*enable MBSSID*/ -+ rtw_hal_rcr_add(adapter, RCR_ENMBID); -+} -+void rtw_mi_set_mbid_cam(_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)); -+ } -+ } -+ rtw_mbid_cam_enable(adapter); -+} -+#endif /*CONFIG_MBSSID_CAM*/ -+ -+#ifdef CONFIG_FW_HANDLE_TXBCN -+#define H2C_BCN_OFFLOAD_LEN 1 -+ -+#define SET_H2CCMD_BCN_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_BCN_ROOT_TBTT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_BCN_VAP1_TBTT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_BCN_VAP2_TBTT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_H2CCMD_BCN_VAP3_TBTT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_H2CCMD_BCN_VAP4_TBTT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+ -+void rtw_hal_set_fw_ap_bcn_offload_cmd(_adapter *adapter, bool fw_bcn_en, u8 tbtt_rpt_map) -+{ -+ u8 fw_bcn_offload[1] = {0}; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ if (fw_bcn_en) -+ SET_H2CCMD_BCN_OFFLOAD_EN(fw_bcn_offload, 1); -+ -+ if (tbtt_rpt_map & BIT(0)) -+ SET_H2CCMD_BCN_ROOT_TBTT_RPT(fw_bcn_offload, 1); -+ if (tbtt_rpt_map & BIT(1)) -+ SET_H2CCMD_BCN_VAP1_TBTT_RPT(fw_bcn_offload, 1); -+ if (tbtt_rpt_map & BIT(2)) -+ SET_H2CCMD_BCN_VAP2_TBTT_RPT(fw_bcn_offload, 1); -+ if (tbtt_rpt_map & BIT(3)) -+ SET_H2CCMD_BCN_VAP3_TBTT_RPT(fw_bcn_offload, 1); -+ -+ dvobj->vap_tbtt_rpt_map = tbtt_rpt_map; -+ dvobj->fw_bcn_offload = fw_bcn_en; -+ RTW_INFO("[FW BCN] Offload : %s\n", (dvobj->fw_bcn_offload) ? "EN" : "DIS"); -+ RTW_INFO("[FW BCN] TBTT RPT map : 0x%02x\n", dvobj->vap_tbtt_rpt_map); -+ -+ rtw_hal_fill_h2c_cmd(adapter, H2C_FW_BCN_OFFLOAD, -+ H2C_BCN_OFFLOAD_LEN, fw_bcn_offload); -+} -+ -+void rtw_hal_set_bcn_rsvdpage_loc_cmd(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 ret, vap_id; -+ u32 page_size = 0; -+ u8 bcn_rsvdpage[H2C_BCN_RSVDPAGE_LEN] = {0}; -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&page_size); -+ #if 1 -+ for (vap_id = 0; vap_id < CONFIG_LIMITED_AP_NUM; vap_id++) { -+ if (dvobj->vap_map & BIT(vap_id)) -+ bcn_rsvdpage[vap_id] = vap_id * (MAX_BEACON_LEN / page_size); -+ } -+ #else -+#define SET_H2CCMD_BCN_RSVDPAGE_LOC_ROOT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 8, __Value) -+#define SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 8, __Value) -+#define SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 8, __Value) -+#define SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP4(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 8, __Value) -+ -+ if (dvobj->vap_map & BIT(0)) -+ SET_H2CCMD_BCN_RSVDPAGE_LOC_ROOT(bcn_rsvdpage, 0); -+ if (dvobj->vap_map & BIT(1)) -+ SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP1(bcn_rsvdpage, -+ 1 * (MAX_BEACON_LEN / page_size)); -+ if (dvobj->vap_map & BIT(2)) -+ SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP2(bcn_rsvdpage, -+ 2 * (MAX_BEACON_LEN / page_size)); -+ if (dvobj->vap_map & BIT(3)) -+ SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP3(bcn_rsvdpage, -+ 3 * (MAX_BEACON_LEN / page_size)); -+ if (dvobj->vap_map & BIT(4)) -+ SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP4(bcn_rsvdpage, -+ 4 * (MAX_BEACON_LEN / page_size)); -+ #endif -+ if (1) { -+ RTW_INFO("[BCN_LOC] vap_map : 0x%02x\n", dvobj->vap_map); -+ RTW_INFO("[BCN_LOC] page_size :%d, @bcn_page_num :%d\n" -+ , page_size, (MAX_BEACON_LEN / page_size)); -+ RTW_INFO("[BCN_LOC] root ap : 0x%02x\n", *bcn_rsvdpage); -+ RTW_INFO("[BCN_LOC] vap_1 : 0x%02x\n", *(bcn_rsvdpage + 1)); -+ RTW_INFO("[BCN_LOC] vap_2 : 0x%02x\n", *(bcn_rsvdpage + 2)); -+ RTW_INFO("[BCN_LOC] vap_3 : 0x%02x\n", *(bcn_rsvdpage + 3)); -+ RTW_INFO("[BCN_LOC] vap_4 : 0x%02x\n", *(bcn_rsvdpage + 4)); -+ } -+ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_BCN_RSVDPAGE, -+ H2C_BCN_RSVDPAGE_LEN, bcn_rsvdpage); -+} -+ -+void rtw_ap_multi_bcn_cfg(_adapter *adapter) -+{ -+ u8 dft_bcn_space = DEFAULT_BCN_INTERVAL; -+ u8 sub_bcn_space = (DEFAULT_BCN_INTERVAL / CONFIG_LIMITED_AP_NUM); -+ -+ /*enable to rx data frame*/ -+ rtw_write16(adapter, REG_RXFLTMAP2, 0xFFFF); -+ -+ /*Disable Port0's beacon function*/ -+ rtw_write8(adapter, REG_BCN_CTRL, rtw_read8(adapter, REG_BCN_CTRL) & ~BIT_EN_BCN_FUNCTION); -+ /*Reset Port0's TSF*/ -+ rtw_write8(adapter, REG_DUAL_TSF_RST, BIT_TSFTR_RST); -+ -+ rtw_ap_set_mbid_num(adapter, CONFIG_LIMITED_AP_NUM); -+ -+ /*BCN space & BCN sub-space 0x554[15:0] = 0x64,0x5BC[23:16] = 0x21*/ -+ rtw_halmac_set_bcn_interval(adapter_to_dvobj(adapter), HW_PORT0, dft_bcn_space); -+ rtw_write8(adapter, REG_MBSSID_BCN_SPACE3 + 2, sub_bcn_space); -+ -+ #if 0 /*setting in hw_var_set_opmode_mbid - ResumeTxBeacon*/ -+ /*BCN hold time 0x540[19:8] = 0x80*/ -+ rtw_write8(adapter, REG_TBTT_PROHIBIT + 1, TBTT_PROHIBIT_HOLD_TIME & 0xFF); -+ rtw_write8(adapter, REG_TBTT_PROHIBIT + 2, -+ (rtw_read8(adapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME >> 8)); -+ #endif -+ -+ /*ATIM window -0x55A = 0x32, reg 0x570 = 0x32, reg 0x5A0 = 0x32 */ -+ rtw_write8(adapter, REG_ATIMWND, 0x32); -+ rtw_write8(adapter, REG_ATIMWND1_V1, 0x32); -+ rtw_write8(adapter, REG_ATIMWND2, 0x32); -+ rtw_write8(adapter, REG_ATIMWND3, 0x32); -+ /* -+ rtw_write8(adapter, REG_ATIMWND4, 0x32); -+ rtw_write8(adapter, REG_ATIMWND5, 0x32); -+ rtw_write8(adapter, REG_ATIMWND6, 0x32); -+ rtw_write8(adapter, REG_ATIMWND7, 0x32);*/ -+ -+ /*no limit setting - 0x5A7 = 0xFF - Packet in Hi Queue Tx immediately*/ -+ rtw_write8(adapter, REG_HIQ_NO_LMT_EN, 0xFF); -+ -+ /*Mask all beacon*/ -+ rtw_write8(adapter, REG_MBSSID_CTRL, 0); -+ -+ /*BCN invalid bit setting 0x454[6] = 1*/ -+ /*rtw_write8(adapter, REG_CCK_CHECK, rtw_read8(adapter, REG_CCK_CHECK) | BIT_EN_BCN_PKT_REL);*/ -+ -+ /*Enable Port0's beacon function*/ -+ rtw_write8(adapter, REG_BCN_CTRL, -+ rtw_read8(adapter, REG_BCN_CTRL) | BIT_DIS_RX_BSSID_FIT | BIT_P0_EN_TXBCN_RPT | BIT_DIS_TSF_UDT | BIT_EN_BCN_FUNCTION); -+ -+ /* Enable HW seq for BCN -+ * 0x4FC[0]: EN_HWSEQ / 0x4FC[1]: EN_HWSEQEXT */ -+ #ifdef CONFIG_RTL8822B -+ if (IS_HARDWARE_TYPE_8822B(adapter)) -+ rtw_write8(adapter, REG_DUMMY_PAGE4_V1_8822B, 0x01); -+ #endif -+ -+ #ifdef CONFIG_RTL8822C -+ if (IS_HARDWARE_TYPE_8822C(adapter)) -+ rtw_write8(adapter, REG_DUMMY_PAGE4_V1_8822C, 0x01); -+ #endif -+} -+static void _rtw_mbid_bcn_cfg(_adapter *adapter, bool mbcnq_en, u8 mbcnq_id) -+{ -+ if (mbcnq_id >= CONFIG_LIMITED_AP_NUM) { -+ RTW_ERR(FUNC_ADPT_FMT"- mbid bcnq_id(%d) invalid\n", FUNC_ADPT_ARG(adapter), mbcnq_id); -+ rtw_warn_on(1); -+ } -+ -+ if (mbcnq_en) { -+ rtw_write8(adapter, REG_MBSSID_CTRL, -+ rtw_read8(adapter, REG_MBSSID_CTRL) | BIT(mbcnq_id)); -+ RTW_INFO(FUNC_ADPT_FMT"- mbid bcnq_id(%d) enabled\n", FUNC_ADPT_ARG(adapter), mbcnq_id); -+ } else { -+ rtw_write8(adapter, REG_MBSSID_CTRL, -+ rtw_read8(adapter, REG_MBSSID_CTRL) & (~BIT(mbcnq_id))); -+ RTW_INFO(FUNC_ADPT_FMT"- mbid bcnq_id(%d) disabled\n", FUNC_ADPT_ARG(adapter), mbcnq_id); -+ } -+} -+/*#define CONFIG_FW_TBTT_RPT*/ -+void rtw_ap_mbid_bcn_en(_adapter *adapter, u8 ap_id) -+{ -+ RTW_INFO(FUNC_ADPT_FMT"- ap_id(%d)\n", FUNC_ADPT_ARG(adapter), ap_id); -+ -+ #ifdef CONFIG_FW_TBTT_RPT -+ if (rtw_ap_get_nums(adapter) >= 1) { -+ u8 tbtt_rpt_map = adapter_to_dvobj(adapter)->vap_tbtt_rpt_map; -+ -+ rtw_hal_set_fw_ap_bcn_offload_cmd(adapter, _TRUE, -+ tbtt_rpt_map | BIT(ap_id));/*H2C-0xBA*/ -+ } -+ #else -+ if (rtw_ap_get_nums(adapter) == 1) -+ rtw_hal_set_fw_ap_bcn_offload_cmd(adapter, _TRUE, 0);/*H2C-0xBA*/ -+ #endif -+ -+ rtw_hal_set_bcn_rsvdpage_loc_cmd(adapter);/*H2C-0x09*/ -+ -+ _rtw_mbid_bcn_cfg(adapter, _TRUE, ap_id); -+} -+void rtw_ap_mbid_bcn_dis(_adapter *adapter, u8 ap_id) -+{ -+ RTW_INFO(FUNC_ADPT_FMT"- ap_id(%d)\n", FUNC_ADPT_ARG(adapter), ap_id); -+ _rtw_mbid_bcn_cfg(adapter, _FALSE, ap_id); -+ -+ if (rtw_ap_get_nums(adapter) == 0) -+ rtw_hal_set_fw_ap_bcn_offload_cmd(adapter, _FALSE, 0); -+ #ifdef CONFIG_FW_TBTT_RPT -+ else if (rtw_ap_get_nums(adapter) >= 1) { -+ u8 tbtt_rpt_map = adapter_to_dvobj(adapter)->vap_tbtt_rpt_map; -+ -+ rtw_hal_set_fw_ap_bcn_offload_cmd(adapter, _TRUE, -+ tbtt_rpt_map & ~BIT(ap_id));/*H2C-0xBA*/ -+ } -+ #endif -+} -+#endif -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+void rtw_ap_multi_bcn_cfg(_adapter *adapter) -+{ -+ #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) -+ rtw_write8(adapter, REG_BCN_CTRL, DIS_TSF_UDT); -+ #else -+ rtw_write8(adapter, REG_BCN_CTRL, DIS_TSF_UDT | DIS_BCNQ_SUB); -+ #endif -+ /*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, 0x0c); /* 12ms */ -+ -+ #ifndef CONFIG_HW_P0_TSF_SYNC -+ #ifdef CONFIG_RTL8192F -+ rtw_write16(adapter, REG_TSFTR_SYN_OFFSET, 0x640);/*unit:32us*/ -+ #else/*not CONFIG_RTL8192F*/ -+ rtw_write16(adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ -+ #endif -+ #endif -+ -+ /*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)*/ -+ #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) -+ rtw_write8(adapter, REG_BCN_CTRL, BIT_DIS_RX_BSSID_FIT | BIT_P0_EN_TXBCN_RPT | BIT_DIS_TSF_UDT |BIT_EN_BCN_FUNCTION); -+ #else -+ rtw_write8(adapter, REG_BCN_CTRL, (DIS_TSF_UDT | EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); -+ #endif -+ #ifdef CONFIG_BCN_XMIT_PROTECT -+ rtw_write8(adapter, REG_CCK_CHECK, rtw_read8(adapter, REG_CCK_CHECK) | BIT_EN_BCN_PKT_REL); -+ #endif -+ -+ 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)); -+ -+ /* Enable HW seq for BCN -+ * 0x4FC[0]: EN_HWSEQ / 0x4FC[1]: EN_HWSEQEXT */ -+ #ifdef CONFIG_RTL8822B -+ if (IS_HARDWARE_TYPE_8822B(adapter)) -+ rtw_write8(adapter, REG_DUMMY_PAGE4_V1_8822B, 0x01); -+ #endif -+ -+ #ifdef CONFIG_RTL8822C -+ if (IS_HARDWARE_TYPE_8822C(adapter)) -+ rtw_write8(adapter, REG_DUMMY_PAGE4_V1_8822C, 0x01); -+ #endif -+} -+#endif -+ -+#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); -+ RTW_INFO("%s "ADPT_FMT"- mbid(%d) mac_addr ="MAC_FMT"\n", __func__, -+ ADPT_ARG(adapter), entry_id, MAC_ARG(mac_addr)); -+ } -+ } -+#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); -+} -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+u16 rtw_hal_bcn_interval_adjust(_adapter *adapter, u16 bcn_interval) -+{ -+ if (adapter_to_dvobj(adapter)->inter_bcn_space != bcn_interval) -+ return adapter_to_dvobj(adapter)->inter_bcn_space; -+ else -+ return bcn_interval; -+} -+#endif/*CONFIG_SWTIMER_BASED_TXBCN*/ -+ -+#else -+ -+#ifndef RTW_HALMAC -+static u32 _get_macaddr_reg(enum _hw_port hwport) -+{ -+ u32 reg_macaddr = REG_MACID; -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (hwport == HW_PORT1) -+ reg_macaddr = REG_MACID1; -+ #if defined(CONFIG_RTL8814A) -+ else if (hwport == HW_PORT2) -+ reg_macaddr = REG_MACID2; -+ else if (hwport == HW_PORT3) -+ reg_macaddr = REG_MACID3; -+ else if (hwport == HW_PORT4) -+ reg_macaddr = REG_MACID4; -+ #endif /*CONFIG_RTL8814A*/ -+ #endif /*CONFIG_CONCURRENT_MODE*/ -+ -+ return reg_macaddr; -+} -+#endif /*!RTW_HALMAC*/ -+ -+static void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *mac_addr) -+{ -+ enum _hw_port hwport; -+ -+ if (mac_addr == NULL) -+ return; -+ hwport = get_hw_port(adapter); -+ -+ RTW_INFO("%s "ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", __func__, -+ ADPT_ARG(adapter), hwport, MAC_ARG(mac_addr)); -+ -+#ifdef RTW_HALMAC /*8822B ~ 8814B*/ -+ rtw_halmac_set_mac_address(adapter_to_dvobj(adapter), hwport, mac_addr); -+#else /* !RTW_HALMAC */ -+ { -+ u8 idx = 0; -+ u32 reg_macaddr = _get_macaddr_reg(hwport); -+ -+ for (idx = 0; idx < ETH_ALEN; idx++) -+ rtw_write8(GET_PRIMARY_ADAPTER(adapter), (reg_macaddr + idx), mac_addr[idx]); -+ } -+#endif /* !RTW_HALMAC */ -+} -+ -+static void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr) -+{ -+ enum _hw_port hwport; -+ -+ if (mac_addr == NULL) -+ return; -+ hwport = get_hw_port(adapter); -+ -+ _rtw_memset(mac_addr, 0, ETH_ALEN); -+#ifdef RTW_HALMAC /*8822B ~ 8814B*/ -+ rtw_halmac_get_mac_address(adapter_to_dvobj(adapter), hwport, mac_addr); -+#else /* !RTW_HALMAC */ -+ { -+ u8 idx = 0; -+ u32 reg_macaddr = _get_macaddr_reg(hwport); -+ -+ for (idx = 0; idx < ETH_ALEN; idx++) -+ mac_addr[idx] = rtw_read8(GET_PRIMARY_ADAPTER(adapter), (reg_macaddr + idx)); -+ } -+#endif /* !RTW_HALMAC */ -+ -+ RTW_DBG("%s "ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", __func__, -+ ADPT_ARG(adapter), hwport, MAC_ARG(mac_addr)); -+} -+#endif/*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ -+ -+#ifndef RTW_HALMAC -+static u32 _get_bssid_reg(enum _hw_port hw_port) -+{ -+ u32 reg_bssid = REG_BSSID; -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (hw_port == HW_PORT1) -+ reg_bssid = REG_BSSID1; -+ #if defined(CONFIG_RTL8814A) -+ else if (hw_port == HW_PORT2) -+ reg_bssid = REG_BSSID2; -+ else if (hw_port == HW_PORT3) -+ reg_bssid = REG_BSSID3; -+ else if (hw_port == HW_PORT4) -+ reg_bssid = REG_BSSID4; -+ #endif /*CONFIG_RTL8814A*/ -+ #endif /*CONFIG_CONCURRENT_MODE*/ -+ -+ return reg_bssid; -+} -+#endif /*!RTW_HALMAC*/ -+static void rtw_hal_set_bssid(_adapter *adapter, u8 *val) -+{ -+ enum _hw_port hw_port = rtw_hal_get_port(adapter); -+#ifdef RTW_HALMAC -+ -+ rtw_halmac_set_bssid(adapter_to_dvobj(adapter), hw_port, val); -+#else /* !RTW_HALMAC */ -+ u8 idx = 0; -+ u32 reg_bssid = _get_bssid_reg(hw_port); -+ -+ for (idx = 0 ; idx < ETH_ALEN; idx++) -+ rtw_write8(adapter, (reg_bssid + idx), val[idx]); -+#endif /* !RTW_HALMAC */ -+ -+ RTW_INFO("%s "ADPT_FMT"- hw port -%d BSSID: "MAC_FMT"\n", -+ __func__, ADPT_ARG(adapter), hw_port, MAC_ARG(val)); -+} -+ -+#ifndef CONFIG_MI_WITH_MBSSID_CAM -+static void rtw_hal_set_tsf_update(_adapter *adapter, u8 en) -+{ -+ u32 addr = 0; -+ u8 val8; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_BCN_CTRL_ADDR, (u8 *)&addr); -+ if (addr) { -+ rtw_enter_protsel_port(adapter, get_hw_port(adapter)); -+ val8 = rtw_read8(adapter, addr); -+ if (en && (val8 & DIS_TSF_UDT)) { -+ rtw_write8(adapter, addr, val8 & ~DIS_TSF_UDT); -+ #ifdef DBG_TSF_UPDATE -+ RTW_INFO("port%u("ADPT_FMT") enable TSF update\n", adapter->hw_port, ADPT_ARG(adapter)); -+ #endif -+ } -+ if (!en && !(val8 & DIS_TSF_UDT)) { -+ rtw_write8(adapter, addr, val8 | DIS_TSF_UDT); -+ #ifdef DBG_TSF_UPDATE -+ RTW_INFO("port%u("ADPT_FMT") disable TSF update\n", adapter->hw_port, ADPT_ARG(adapter)); -+ #endif -+ } -+ rtw_leave_protsel_port(adapter); -+ } else { -+ RTW_WARN("unknown port%d("ADPT_FMT") %s TSF update\n" -+ , adapter->hw_port, ADPT_ARG(adapter), en ? "enable" : "disable"); -+ rtw_warn_on(1); -+ } -+} -+#endif /*CONFIG_MI_WITH_MBSSID_CAM*/ -+static void rtw_hal_set_hw_update_tsf(PADAPTER padapter) -+{ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ -+#else -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (!pmlmeext->en_hw_update_tsf) -+ return; -+ -+ /* check RCR */ -+ if (!rtw_hal_rcr_check(padapter, RCR_CBSSID_BCN)) -+ return; -+ -+ if (pmlmeext->tsf_update_required) { -+ pmlmeext->tsf_update_pause_stime = 0; -+ rtw_hal_set_tsf_update(padapter, 1); -+ } -+ -+ pmlmeext->en_hw_update_tsf = 0; -+#endif -+} -+ -+void rtw_iface_enable_tsf_update(_adapter *adapter) -+{ -+ adapter->mlmeextpriv.tsf_update_pause_stime = 0; -+ adapter->mlmeextpriv.tsf_update_required = 1; -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ -+#else -+ rtw_hal_set_tsf_update(adapter, 1); -+#endif -+} -+ -+void rtw_iface_disable_tsf_update(_adapter *adapter) -+{ -+ adapter->mlmeextpriv.tsf_update_required = 0; -+ adapter->mlmeextpriv.tsf_update_pause_stime = 0; -+ adapter->mlmeextpriv.en_hw_update_tsf = 0; -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ -+#else -+ rtw_hal_set_tsf_update(adapter, 0); -+#endif -+} -+ -+static void rtw_hal_tsf_update_pause(_adapter *adapter) -+{ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ -+#else -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ rtw_hal_set_tsf_update(iface, 0); -+ if (iface->mlmeextpriv.tsf_update_required) { -+ iface->mlmeextpriv.tsf_update_pause_stime = rtw_get_current_time(); -+ if (!iface->mlmeextpriv.tsf_update_pause_stime) -+ iface->mlmeextpriv.tsf_update_pause_stime++; -+ } -+ iface->mlmeextpriv.en_hw_update_tsf = 0; -+ } -+#endif -+} -+ -+static void rtw_hal_tsf_update_restore(_adapter *adapter) -+{ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ -+#else -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ if (iface->mlmeextpriv.tsf_update_required) { -+ /* enable HW TSF update when recive beacon*/ -+ iface->mlmeextpriv.en_hw_update_tsf = 1; -+ #ifdef DBG_TSF_UPDATE -+ RTW_INFO("port%d("ADPT_FMT") enabling TSF update...\n" -+ , iface->hw_port, ADPT_ARG(iface)); -+ #endif -+ } -+ } -+#endif -+} -+ -+void rtw_hal_periodic_tsf_update_chk(_adapter *adapter) -+{ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ -+#else -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ int i; -+ u32 restore_ms = 0; -+ -+ if (dvobj->periodic_tsf_update_etime) { -+ if (rtw_time_after(rtw_get_current_time(), dvobj->periodic_tsf_update_etime)) { -+ /* end for restore status */ -+ dvobj->periodic_tsf_update_etime = 0; -+ rtw_hal_rcr_set_chk_bssid(adapter, MLME_ACTION_NONE); -+ } -+ return; -+ } -+ -+ if (dvobj->rf_ctl.offch_state != OFFCHS_NONE) -+ return; -+ -+ /* -+ * all required ifaces can switch to restore status together -+ * loop all pause iface to get largest restore time required -+ */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (mlmeext->tsf_update_required -+ && mlmeext->tsf_update_pause_stime -+ && rtw_get_passing_time_ms(mlmeext->tsf_update_pause_stime) -+ > mlmeext->mlmext_info.bcn_interval * mlmeext->tsf_update_pause_factor -+ ) { -+ if (restore_ms < mlmeext->mlmext_info.bcn_interval * mlmeext->tsf_update_restore_factor) -+ restore_ms = mlmeext->mlmext_info.bcn_interval * mlmeext->tsf_update_restore_factor; -+ } -+ } -+ -+ if (!restore_ms) -+ return; -+ -+ dvobj->periodic_tsf_update_etime = rtw_get_current_time() + rtw_ms_to_systime(restore_ms); -+ if (!dvobj->periodic_tsf_update_etime) -+ dvobj->periodic_tsf_update_etime++; -+ -+ rtw_hal_rcr_set_chk_bssid(adapter, MLME_ACTION_NONE); -+ -+ /* set timer to end restore status */ -+ _set_timer(&dvobj->periodic_tsf_update_end_timer, restore_ms); -+#endif -+} -+ -+void rtw_hal_periodic_tsf_update_end_timer_hdl(void *ctx) -+{ -+ struct dvobj_priv *dvobj = (struct dvobj_priv *)ctx; -+ -+ if (dev_is_surprise_removed(dvobj) || dev_is_drv_stopped(dvobj)) -+ return; -+ -+ rtw_periodic_tsf_update_end_cmd(dvobj_get_primary_adapter(dvobj)); -+} -+ -+static inline u8 hw_var_rcr_config(_adapter *adapter, u32 rcr) -+{ -+ int err; -+ -+#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL -+ rcr = RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_APWRMGT | RCR_ADF | RCR_AMF | RCR_APP_PHYST_RXFF | RCR_APP_MIC | RCR_APP_ICV; -+#endif -+ err = rtw_write32(adapter, REG_RCR, rcr); -+ if (err == _SUCCESS) -+ GET_HAL_DATA(adapter)->ReceiveConfig = rcr; -+ return err; -+} -+ -+static inline u8 hw_var_rcr_get(_adapter *adapter, u32 *rcr) -+{ -+ u32 v32; -+ -+ v32 = rtw_read32(adapter, REG_RCR); -+ if (rcr) -+ *rcr = v32; -+ GET_HAL_DATA(adapter)->ReceiveConfig = v32; -+ return _SUCCESS; -+} -+ -+/* only check SW RCR variable */ -+inline u8 rtw_hal_rcr_check(_adapter *adapter, u32 check_bit) -+{ -+ PHAL_DATA_TYPE hal; -+ u32 rcr; -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ rcr = hal->ReceiveConfig; -+ if ((rcr & check_bit) == check_bit) -+ return 1; -+ -+ return 0; -+} -+ -+inline u8 rtw_hal_rcr_add(_adapter *adapter, u32 add) -+{ -+ PHAL_DATA_TYPE hal; -+ u32 rcr; -+ u8 ret = _SUCCESS; -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); -+ rcr |= add; -+ if (rcr != hal->ReceiveConfig) -+ ret = rtw_hal_set_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); -+ -+ return ret; -+} -+ -+inline u8 rtw_hal_rcr_clear(_adapter *adapter, u32 clear) -+{ -+ PHAL_DATA_TYPE hal; -+ u32 rcr; -+ u8 ret = _SUCCESS; -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); -+ rcr &= ~clear; -+ if (rcr != hal->ReceiveConfig) -+ ret = rtw_hal_set_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); -+ -+ return ret; -+} -+ -+void rtw_hal_rcr_set_chk_bssid(_adapter *adapter, u8 self_action) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u32 rcr, rcr_new; -+#if !defined(CONFIG_MI_WITH_MBSSID_CAM) || defined(CONFIG_CLIENT_PORT_CFG) || defined(CONFIG_RTW_MULTI_AP) -+ struct mi_state mstate, mstate_s; -+#endif -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); -+ rcr_new = rcr; -+ -+#if !defined(CONFIG_MI_WITH_MBSSID_CAM) || defined(CONFIG_CLIENT_PORT_CFG) || defined(CONFIG_RTW_MULTI_AP) -+ rtw_mi_status_no_self(adapter, &mstate); -+ rtw_mi_status_no_others(adapter, &mstate_s); -+ -+ /* only adjust parameters interested */ -+ switch (self_action) { -+ case MLME_SCAN_ENTER: -+ mstate_s.scan_num = 1; -+ mstate_s.scan_enter_num = 1; -+ break; -+ case MLME_SCAN_DONE: -+ mstate_s.scan_enter_num = 0; -+ break; -+ case MLME_STA_CONNECTING: -+ mstate_s.lg_sta_num = 1; -+ mstate_s.ld_sta_num = 0; -+ break; -+ case MLME_STA_CONNECTED: -+ mstate_s.lg_sta_num = 0; -+ mstate_s.ld_sta_num = 1; -+ break; -+ case MLME_STA_DISCONNECTED: -+ mstate_s.lg_sta_num = 0; -+ mstate_s.ld_sta_num = 0; -+ break; -+#ifdef CONFIG_TDLS -+ case MLME_TDLS_LINKED: -+ mstate_s.ld_tdls_num = 1; -+ break; -+ case MLME_TDLS_NOLINK: -+ mstate_s.ld_tdls_num = 0; -+ break; -+#endif -+#ifdef CONFIG_AP_MODE -+ case MLME_AP_STARTED: -+ mstate_s.ap_num = 1; -+ break; -+ case MLME_AP_STOPPED: -+ mstate_s.ap_num = 0; -+ mstate_s.ld_ap_num = 0; -+ break; -+#endif -+#ifdef CONFIG_RTW_MESH -+ case MLME_MESH_STARTED: -+ mstate_s.mesh_num = 1; -+ break; -+ case MLME_MESH_STOPPED: -+ mstate_s.mesh_num = 0; -+ mstate_s.ld_mesh_num = 0; -+ break; -+#endif -+ case MLME_ACTION_NONE: -+ case MLME_ADHOC_STARTED: -+ /* caller without effect of decision */ -+ break; -+ default: -+ rtw_warn_on(1); -+ }; -+ -+ rtw_mi_status_merge(&mstate, &mstate_s); -+#endif /* !defined(CONFIG_MI_WITH_MBSSID_CAM) || defined(CONFIG_CLIENT_PORT_CFG) || defined(CONFIG_RTW_MULTI_AP) */ -+ -+#if defined(CONFIG_MI_WITH_MBSSID_CAM) && !defined(CONFIG_CLIENT_PORT_CFG) -+ rcr_new &= ~(RCR_CBSSID_BCN | RCR_CBSSID_DATA); -+#else -+ if (MSTATE_AP_NUM(&mstate) || MSTATE_MESH_NUM(&mstate) || MSTATE_TDLS_LD_NUM(&mstate) -+ #ifdef CONFIG_FIND_BEST_CHANNEL -+ || MSTATE_SCAN_ENTER_NUM(&mstate) -+ #endif -+ || hal_data->in_cta_test -+ ) -+ rcr_new &= ~RCR_CBSSID_DATA; -+ else -+ rcr_new |= RCR_CBSSID_DATA; -+ -+ if (MSTATE_SCAN_ENTER_NUM(&mstate) || hal_data->in_cta_test) -+ rcr_new &= ~RCR_CBSSID_BCN; -+ else if (MSTATE_STA_LG_NUM(&mstate) -+ || adapter_to_dvobj(adapter)->periodic_tsf_update_etime -+ ) -+ rcr_new |= RCR_CBSSID_BCN; -+ else if ((MSTATE_AP_NUM(&mstate) && adapter->registrypriv.wifi_spec) /* for 11n Logo 4.2.31/4.2.32 */ -+ || MSTATE_MESH_NUM(&mstate) -+ ) -+ rcr_new &= ~RCR_CBSSID_BCN; -+ else -+ rcr_new |= RCR_CBSSID_BCN; -+ -+ #ifdef CONFIG_CLIENT_PORT_CFG -+ if (get_clt_num(adapter) > MAX_CLIENT_PORT_NUM) -+ rcr_new &= ~RCR_CBSSID_BCN; -+ #endif -+#endif /* CONFIG_MI_WITH_MBSSID_CAM */ -+ -+#ifdef CONFIG_RTW_MULTI_AP -+ if (MSTATE_AP_NUM(&mstate) -+ && rtw_unassoc_sta_src_chk(adapter, UNASOC_STA_SRC_RX_NMY_UC) -+ ) { -+ rcr_new |= RCR_AAP; -+ } else -+ rcr_new &= ~RCR_AAP; -+#endif -+ -+ if (rcr == rcr_new) -+ return; -+ -+ if (!hal_spec->rx_tsf_filter -+ && (rcr & RCR_CBSSID_BCN) && !(rcr_new & RCR_CBSSID_BCN)) -+ rtw_hal_tsf_update_pause(adapter); -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr_new); -+ -+ if (!hal_spec->rx_tsf_filter -+ && !(rcr & RCR_CBSSID_BCN) && (rcr_new & RCR_CBSSID_BCN) -+ && self_action != MLME_STA_CONNECTING) -+ rtw_hal_tsf_update_restore(adapter); -+} -+ -+void rtw_hal_rcr_set_chk_bssid_act_non(_adapter *adapter) -+{ -+ rtw_hal_rcr_set_chk_bssid(adapter, MLME_ACTION_NONE); -+} -+ -+static void hw_var_set_rcr_am(_adapter *adapter, u8 enable) -+{ -+ u32 rcr = RCR_AM; -+ -+ if (enable) -+ rtw_hal_rcr_add(adapter, rcr); -+ else -+ rtw_hal_rcr_clear(adapter, rcr); -+} -+ -+static void hw_var_set_bcn_interval(_adapter *adapter, u16 interval) -+{ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+ interval = rtw_hal_bcn_interval_adjust(adapter, interval); -+#endif -+ -+#ifdef RTW_HALMAC -+ rtw_halmac_set_bcn_interval(adapter_to_dvobj(adapter), adapter->hw_port, interval); -+#else -+ rtw_write16(adapter, REG_MBSSID_BCN_SPACE, interval); -+#endif -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ { -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+ RTW_INFO("%s==> bcn_interval:%d, eraly_int:%d\n", __func__, interval, interval >> 1); -+ rtw_write8(adapter, REG_DRVERLYINT, interval >> 1); -+ } -+ } -+#endif -+} -+ -+#if CONFIG_TX_AC_LIFETIME -+const char *const _tx_aclt_conf_str[] = { -+ "DEFAULT", -+ "AP_M2U", -+ "MESH", -+ "INVALID", -+}; -+ -+void dump_tx_aclt_force_val(void *sel, struct dvobj_priv *dvobj) -+{ -+#define TX_ACLT_FORCE_MSG_LEN 64 -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(dvobj_get_primary_adapter(dvobj)); -+ struct tx_aclt_conf_t *conf = &dvobj->tx_aclt_force_val; -+ char buf[TX_ACLT_FORCE_MSG_LEN]; -+ int cnt = 0; -+ -+ RTW_PRINT_SEL(sel, "unit:%uus, maximum:%uus\n" -+ , hal_spec->tx_aclt_unit_factor * 32 -+ , 0xFFFF * hal_spec->tx_aclt_unit_factor * 32); -+ -+ RTW_PRINT_SEL(sel, "%-5s %-12s %-12s\n", "en", "vo_vi(us)", "be_bk(us)"); -+ RTW_PRINT_SEL(sel, " 0x%02x %12u %12u\n" -+ , conf->en -+ , conf->vo_vi * hal_spec->tx_aclt_unit_factor * 32 -+ , conf->be_bk * hal_spec->tx_aclt_unit_factor * 32 -+ ); -+ -+ cnt += snprintf(buf + cnt, TX_ACLT_FORCE_MSG_LEN - cnt - 1, "%5s", conf->en == 0xFF ? "AUTO" : "FORCE"); -+ if (cnt >= TX_ACLT_FORCE_MSG_LEN - 1) -+ goto exit; -+ -+ if (conf->vo_vi) -+ cnt += snprintf(buf + cnt, TX_ACLT_FORCE_MSG_LEN - cnt - 1, " FORCE:0x%04x", conf->vo_vi); -+ else -+ cnt += snprintf(buf + cnt, TX_ACLT_FORCE_MSG_LEN - cnt - 1, " AUTO"); -+ if (cnt >= TX_ACLT_FORCE_MSG_LEN - 1) -+ goto exit; -+ -+ -+ if (conf->be_bk) -+ cnt += snprintf(buf + cnt, TX_ACLT_FORCE_MSG_LEN - cnt - 1, " FORCE:0x%04x", conf->be_bk); -+ else -+ cnt += snprintf(buf + cnt, TX_ACLT_FORCE_MSG_LEN - cnt - 1, " AUTO"); -+ if (cnt >= TX_ACLT_FORCE_MSG_LEN - 1) -+ goto exit; -+ -+ RTW_PRINT_SEL(sel, "%s\n", buf); -+ -+exit: -+ return; -+} -+ -+void rtw_hal_set_tx_aclt_force_val(_adapter *adapter, struct tx_aclt_conf_t *input, u8 arg_num) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct tx_aclt_conf_t *conf = &dvobj->tx_aclt_force_val; -+ -+ if (arg_num >= 1) { -+ if (input->en == 0xFF) -+ conf->en = input->en; -+ else -+ conf->en = input->en & 0xF; -+ } -+ if (arg_num >= 2) { -+ conf->vo_vi = input->vo_vi / (hal_spec->tx_aclt_unit_factor * 32); -+ if (conf->vo_vi > 0xFFFF) -+ conf->vo_vi = 0xFFFF; -+ } -+ if (arg_num >= 3) { -+ conf->be_bk = input->be_bk / (hal_spec->tx_aclt_unit_factor * 32); -+ if (conf->be_bk > 0xFFFF) -+ conf->be_bk = 0xFFFF; -+ } -+} -+ -+void dump_tx_aclt_confs(void *sel, struct dvobj_priv *dvobj) -+{ -+#define TX_ACLT_CONF_MSG_LEN 32 -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(dvobj_get_primary_adapter(dvobj)); -+ struct tx_aclt_conf_t *conf; -+ char buf[TX_ACLT_CONF_MSG_LEN]; -+ int cnt; -+ int i; -+ -+ RTW_PRINT_SEL(sel, "unit:%uus, maximum:%uus\n" -+ , hal_spec->tx_aclt_unit_factor * 32 -+ , 0xFFFF * hal_spec->tx_aclt_unit_factor * 32); -+ -+ RTW_PRINT_SEL(sel, "%-7s %-1s %-3s %-9s %-9s %-10s %-10s\n" -+ , "name", "#", "en", "vo_vi(us)", "be_bk(us)", "vo_vi(reg)", "be_bk(reg)"); -+ -+ for (i = 0; i < TX_ACLT_CONF_NUM; i++) { -+ conf = &dvobj->tx_aclt_confs[i]; -+ cnt = 0; -+ -+ if (conf->vo_vi) -+ cnt += snprintf(buf + cnt, TX_ACLT_CONF_MSG_LEN - cnt - 1, " 0x%04x", conf->vo_vi); -+ else -+ cnt += snprintf(buf + cnt, TX_ACLT_CONF_MSG_LEN - cnt - 1, " N/A"); -+ if (cnt >= TX_ACLT_CONF_MSG_LEN - 1) -+ continue; -+ -+ if (conf->be_bk) -+ cnt += snprintf(buf + cnt, TX_ACLT_CONF_MSG_LEN - cnt - 1, " 0x%04x", conf->be_bk); -+ else -+ cnt += snprintf(buf + cnt, TX_ACLT_CONF_MSG_LEN - cnt - 1, " N/A"); -+ if (cnt >= TX_ACLT_CONF_MSG_LEN - 1) -+ continue; -+ -+ RTW_PRINT_SEL(sel, "%7s %1u 0x%x %9u %9u%s\n" -+ , tx_aclt_conf_str(i), i -+ , conf->en -+ , conf->vo_vi * hal_spec->tx_aclt_unit_factor * 32 -+ , conf->be_bk * hal_spec->tx_aclt_unit_factor * 32 -+ , buf -+ ); -+ } -+} -+ -+void rtw_hal_set_tx_aclt_conf(_adapter *adapter, u8 conf_idx, struct tx_aclt_conf_t *input, u8 arg_num) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct tx_aclt_conf_t *conf; -+ -+ if (conf_idx >= TX_ACLT_CONF_NUM) -+ return; -+ -+ conf = &dvobj->tx_aclt_confs[conf_idx]; -+ -+ if (arg_num >= 1) { -+ if (input->en != 0xFF) -+ conf->en = input->en & 0xF; -+ } -+ if (arg_num >= 2) { -+ conf->vo_vi = input->vo_vi / (hal_spec->tx_aclt_unit_factor * 32); -+ if (conf->vo_vi > 0xFFFF) -+ conf->vo_vi = 0xFFFF; -+ } -+ if (arg_num >= 3) { -+ conf->be_bk = input->be_bk / (hal_spec->tx_aclt_unit_factor * 32); -+ if (conf->be_bk > 0xFFFF) -+ conf->be_bk = 0xFFFF; -+ } -+} -+ -+void rtw_hal_update_tx_aclt(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); -+ u8 lt_en = 0, lt_en_ori; -+ u16 lt_vo_vi = 0xFFFF, lt_be_bk = 0xFFFF; -+ u32 lt, lt_ori; -+ struct tx_aclt_conf_t *conf; -+ int i; -+#ifdef CONFIG_AP_MODE -+#if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ _adapter *iface; -+ u8 ap_m2u_num = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ if (MLME_IS_AP(iface) -+ && ((iface->b2u_flags_ap_src & RTW_AP_B2U_IP_MCAST) -+ || (iface->b2u_flags_ap_fwd & RTW_AP_B2U_IP_MCAST)) -+ ) -+ ap_m2u_num++; -+ } -+#endif -+#endif /* CONFIG_AP_MODE */ -+ -+ lt_en_ori = rtw_read8(adapter, REG_LIFETIME_EN); -+ lt_ori = rtw_read32(adapter, REG_PKT_LIFE_TIME); -+ -+ for (i = 0; i < TX_ACLT_CONF_NUM; i++) { -+ if (!(dvobj->tx_aclt_flags & BIT(i))) -+ continue; -+ -+ conf = &dvobj->tx_aclt_confs[i]; -+ -+ if (i == TX_ACLT_CONF_DEFAULT) { -+ /* first and default status, assign directly */ -+ lt_en = conf->en; -+ if (conf->vo_vi) -+ lt_vo_vi = conf->vo_vi; -+ if (conf->be_bk) -+ lt_be_bk = conf->be_bk; -+ } -+ #ifdef CONFIG_AP_MODE -+ #if CONFIG_RTW_AP_DATA_BMC_TO_UC || defined(CONFIG_RTW_MESH) -+ else if (0 -+ #if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ || (i == TX_ACLT_CONF_AP_M2U -+ && ap_m2u_num -+ && macid_ctl->op_num[H2C_MSR_ROLE_STA] /* having AP mode with STA connected */) -+ #endif -+ #ifdef CONFIG_RTW_MESH -+ || (i == TX_ACLT_CONF_MESH -+ && macid_ctl->op_num[H2C_MSR_ROLE_MESH] > 1 /* implies only 1 MESH mode supported */) -+ #endif -+ ) { -+ /* long term status, OR en and MIN lifetime */ -+ lt_en |= conf->en; -+ if (conf->vo_vi && lt_vo_vi > conf->vo_vi) -+ lt_vo_vi = conf->vo_vi; -+ if (conf->be_bk && lt_be_bk > conf->be_bk) -+ lt_be_bk = conf->be_bk; -+ } -+ #endif -+ #endif /* CONFIG_AP_MODE */ -+ } -+ -+ if (dvobj->tx_aclt_force_val.en != 0xFF) -+ lt_en = dvobj->tx_aclt_force_val.en; -+ if (dvobj->tx_aclt_force_val.vo_vi) -+ lt_vo_vi = dvobj->tx_aclt_force_val.vo_vi; -+ if (dvobj->tx_aclt_force_val.be_bk) -+ lt_be_bk = dvobj->tx_aclt_force_val.be_bk; -+ -+ lt_en = (lt_en_ori & 0xF0) | (lt_en & 0x0F); -+ lt = (lt_be_bk << 16) | lt_vo_vi; -+ -+ if (0) -+ RTW_INFO("lt_en:0x%x(0x%x), lt:0x%08x(0x%08x)\n", lt_en, lt_en_ori, lt, lt_ori); -+ -+ if (lt_en != lt_en_ori) -+ rtw_write8(adapter, REG_LIFETIME_EN, lt_en); -+ if (lt != lt_ori) -+ rtw_write32(adapter, REG_PKT_LIFE_TIME, lt); -+} -+#endif /* CONFIG_TX_AC_LIFETIME */ -+ -+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]; -+#if defined(CONFIG_RTL8192F) -+ u16 wlan_act_mask_ctrl = 0; -+ u16 en_port_mask = EN_PORT_0_FUNCTION | EN_PORT_1_FUNCTION; -+#endif -+ -+ 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); -+#if defined(CONFIG_RTL8192F) -+ wlan_act_mask_ctrl = rtw_read16(adapter, REG_WLAN_ACT_MASK_CTRL_1); -+#endif -+ -+ 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" -+#if defined(CONFIG_RTL8192F) -+ "wlan_act_mask_ctrl:0x%02x\n" -+#endif -+ "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 -+#if defined(CONFIG_RTL8192F) -+ , wlan_act_mask_ctrl -+#endif -+ , *((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); -+ -+#if defined(CONFIG_RTL8192F) -+ rtw_write16(adapter, REG_WLAN_ACT_MASK_CTRL_1, wlan_act_mask_ctrl & ~en_port_mask); -+#endif -+ -+ /* 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 defined(CONFIG_RTL8192F) -+ /* if the setting of port0 and port1 are the same, it does not need to switch port setting*/ -+ if(((wlan_act_mask_ctrl & en_port_mask) != 0) && ((wlan_act_mask_ctrl & en_port_mask) -+ != (EN_PORT_0_FUNCTION | EN_PORT_1_FUNCTION))) -+ wlan_act_mask_ctrl ^= en_port_mask; -+ rtw_write16(adapter, REG_WLAN_ACT_MASK_CTRL_1, wlan_act_mask_ctrl); -+#endif -+ -+ 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); -+#if defined(CONFIG_RTL8192F) -+ wlan_act_mask_ctrl = rtw_read16(adapter, REG_WLAN_ACT_MASK_CTRL_1); -+#endif -+ -+ 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" -+#if defined(CONFIG_RTL8192F) -+ "wlan_act_mask_ctrl:0x%02x\n" -+#endif -+ "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 -+#if defined(CONFIG_RTL8192F) -+ , wlan_act_mask_ctrl -+#endif -+ , *((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", -+ "MESH", -+ "INVALID", -+}; -+ -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+s32 rtw_hal_set_default_port_id_cmd(_adapter *adapter, u8 mac_id) -+{ -+ s32 ret = _SUCCESS; -+ u8 parm[H2C_DEFAULT_PORT_ID_LEN] = {0}; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 port_id = rtw_hal_get_port(adapter); -+ -+ if ((dvobj->dft.port_id == port_id) && (dvobj->dft.mac_id == mac_id)) -+ return ret; -+ -+ SET_H2CCMD_DFTPID_PORT_ID(parm, port_id); -+ SET_H2CCMD_DFTPID_MAC_ID(parm, mac_id); -+ -+ RTW_DBG_DUMP("DFT port id parm:", parm, H2C_DEFAULT_PORT_ID_LEN); -+ RTW_INFO("%s ("ADPT_FMT") port_id :%d, mad_id:%d\n", -+ __func__, ADPT_ARG(adapter), port_id, mac_id); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_DEFAULT_PORT_ID, H2C_DEFAULT_PORT_ID_LEN, parm); -+ dvobj->dft.port_id = port_id; -+ dvobj->dft.mac_id = mac_id; -+ -+ return ret; -+} -+s32 rtw_set_default_port_id(_adapter *adapter) -+{ -+ s32 ret = _SUCCESS; -+ struct sta_info *psta; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ if (is_client_associated_to_ap(adapter)) { -+ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); -+ if (psta) -+ ret = rtw_hal_set_default_port_id_cmd(adapter, psta->cmn.mac_id); -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ -+ } else { -+ } -+ -+ return ret; -+} -+s32 rtw_set_ps_rsvd_page(_adapter *adapter) -+{ -+ s32 ret = _SUCCESS; -+ u16 media_status_rpt = RT_MEDIA_CONNECT; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ -+ if (adapter->iface_id == pwrctl->fw_psmode_iface_id) -+ return ret; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, -+ (u8 *)&media_status_rpt); -+ -+ return ret; -+} -+ -+#if 0 -+_adapter * _rtw_search_dp_iface(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ _adapter *target_iface = NULL; -+ int i; -+ u8 sta_num = 0, tdls_num = 0, ap_num = 0, mesh_num = 0, adhoc_num = 0; -+ u8 p2p_go_num = 0, p2p_gc_num = 0; -+ _adapter *sta_ifs[8]; -+ _adapter *ap_ifs[8]; -+ _adapter *mesh_ifs[8]; -+ _adapter *gc_ifs[8]; -+ _adapter *go_ifs[8]; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ if (check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ sta_ifs[sta_num++] = iface; -+ -+ #ifdef CONFIG_TDLS -+ if (iface->tdlsinfo.link_established == _TRUE) -+ tdls_num++; -+ #endif -+ #ifdef CONFIG_P2P -+ if (MLME_IS_GC(iface)) -+ gc_ifs[p2p_gc_num++] = iface; -+ #endif -+ } -+#ifdef CONFIG_AP_MODE -+ } else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE ) { -+ if (check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ ap_ifs[ap_num++] = iface; -+ #ifdef CONFIG_P2P -+ if (MLME_IS_GO(iface)) -+ go_ifs[p2p_go_num++] = iface; -+ #endif -+ } -+#endif -+ } else if (check_fwstate(&iface->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) == _TRUE -+ && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE -+ ) { -+ adhoc_num++; -+ -+#ifdef CONFIG_RTW_MESH -+ } else if (check_fwstate(&iface->mlmepriv, WIFI_MESH_STATE) == _TRUE -+ && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE -+ ) { -+ mesh_ifs[mesh_num++] = iface; -+#endif -+ } -+ } -+ -+ if (p2p_gc_num) { -+ target_iface = gc_ifs[0]; -+ } -+ else if (sta_num) { -+ if(sta_num == 1) { -+ target_iface = sta_ifs[0]; -+ } else if (sta_num >= 2) { -+ /*TODO get target_iface by timestamp*/ -+ target_iface = sta_ifs[0]; -+ } -+ } else if (ap_num) { -+ target_iface = ap_ifs[0]; -+ } -+ -+ RTW_INFO("[IFS_ASSOC_STATUS] - STA :%d", sta_num); -+ RTW_INFO("[IFS_ASSOC_STATUS] - TDLS :%d", tdls_num); -+ RTW_INFO("[IFS_ASSOC_STATUS] - AP:%d", ap_num); -+ RTW_INFO("[IFS_ASSOC_STATUS] - MESH :%d", mesh_num); -+ RTW_INFO("[IFS_ASSOC_STATUS] - ADHOC :%d", adhoc_num); -+ RTW_INFO("[IFS_ASSOC_STATUS] - P2P-GC :%d", p2p_gc_num); -+ RTW_INFO("[IFS_ASSOC_STATUS] - P2P-GO :%d", p2p_go_num); -+ -+ if (target_iface) -+ RTW_INFO("%s => target_iface ("ADPT_FMT")\n", -+ __func__, ADPT_ARG(target_iface)); -+ else -+ RTW_INFO("%s => target_iface NULL\n", __func__); -+ -+ return target_iface; -+} -+ -+void rtw_search_default_port(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *adp_iface = NULL; -+#ifdef CONFIG_WOWLAN -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ -+ if (pwrpriv->wowlan_mode == _TRUE) { -+ adp_iface = adapter; -+ goto exit; -+ } -+#endif -+ adp_iface = _rtw_search_dp_iface(adapter); -+ -+exit : -+ if ((adp_iface != NULL) && (MLME_IS_STA(adp_iface))) -+ rtw_set_default_port_id(adp_iface); -+ else -+ rtw_hal_set_default_port_id_cmd(adapter, 0); -+ -+ if (1) { -+ _adapter *tmp_adp; -+ -+ tmp_adp = (adp_iface) ? adp_iface : adapter; -+ -+ RTW_INFO("%s ("ADPT_FMT")=> hw_port :%d, default_port(%d)\n", -+ __func__, ADPT_ARG(adapter), get_hw_port(tmp_adp), get_dft_portid(tmp_adp)); -+ } -+} -+#endif -+#endif /*CONFIG_FW_MULTI_PORT_SUPPORT*/ -+ -+#ifdef CONFIG_P2P_PS -+#ifdef RTW_HALMAC -+void rtw_set_p2p_ps_offload_cmd(_adapter *adapter, u8 p2p_ps_state) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta; -+ HAL_P2P_PS_PARA p2p_ps_para; -+ int status = -1; -+ u8 i; -+ u8 hw_port = rtw_hal_get_port(adapter); -+ -+ _rtw_memset(&p2p_ps_para, 0, sizeof(HAL_P2P_PS_PARA)); -+ _rtw_memcpy((&p2p_ps_para) , &hal->p2p_ps_offload , sizeof(hal->p2p_ps_offload)); -+ -+ (&p2p_ps_para)->p2p_port_id = hw_port; -+ (&p2p_ps_para)->p2p_group = 0; -+ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); -+ if (psta) { -+ (&p2p_ps_para)->p2p_macid = psta->cmn.mac_id; -+ } else { -+ if (p2p_ps_state != P2P_PS_DISABLE) { -+ RTW_ERR("%s , psta was NULL\n", __func__); -+ return; -+ } -+ } -+ -+ -+ switch (p2p_ps_state) { -+ case P2P_PS_DISABLE: -+ RTW_INFO("P2P_PS_DISABLE\n"); -+ _rtw_memset(&p2p_ps_para , 0, sizeof(HAL_P2P_PS_PARA)); -+ break; -+ -+ case P2P_PS_ENABLE: -+ RTW_INFO("P2P_PS_ENABLE\n"); -+ /* update CTWindow value. */ -+ if (pwdinfo->ctwindow > 0) { -+ (&p2p_ps_para)->ctwindow_en = 1; -+ (&p2p_ps_para)->ctwindow_length = pwdinfo->ctwindow; -+ /*RTW_INFO("%s , ctwindow_length = %d\n" , __func__ , (&p2p_ps_para)->ctwindow_length);*/ -+ } -+ -+ -+ if ((pwdinfo->opp_ps == 1) || (pwdinfo->noa_num > 0)) { -+ (&p2p_ps_para)->offload_en = 1; -+ if (pwdinfo->role == P2P_ROLE_GO) { -+ (&p2p_ps_para)->role = 1; -+ (&p2p_ps_para)->all_sta_sleep = 0; -+ } else -+ (&p2p_ps_para)->role = 0; -+ -+ (&p2p_ps_para)->discovery = 0; -+ } -+ /* hw only support 2 set of NoA */ -+ for (i = 0; i < pwdinfo->noa_num; i++) { -+ /* To control the register setting for which NOA */ -+ (&p2p_ps_para)->noa_sel = i; -+ (&p2p_ps_para)->noa_en = 1; -+ (&p2p_ps_para)->disable_close_rf = 0; -+#ifdef CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(adapter, WIFI_ASOC_STATE)) -+#endif /* CONFIG_CONCURRENT_MODE */ -+ (&p2p_ps_para)->disable_close_rf = 1; -+#endif /* CONFIG_P2P_PS_NOA_USE_MACID_SLEEP */ -+ /* config P2P NoA Descriptor Register */ -+ /* config NOA duration */ -+ (&p2p_ps_para)->noa_duration_para = pwdinfo->noa_duration[i]; -+ /* config NOA interval */ -+ (&p2p_ps_para)->noa_interval_para = pwdinfo->noa_interval[i]; -+ /* config NOA start time */ -+ (&p2p_ps_para)->noa_start_time_para = pwdinfo->noa_start_time[i]; -+ /* config NOA count */ -+ (&p2p_ps_para)->noa_count_para = pwdinfo->noa_count[i]; -+ /*RTW_INFO("%s , noa_duration_para = %d , noa_interval_para = %d , noa_start_time_para = %d , noa_count_para = %d\n" , __func__ , -+ (&p2p_ps_para)->noa_duration_para , (&p2p_ps_para)->noa_interval_para , -+ (&p2p_ps_para)->noa_start_time_para , (&p2p_ps_para)->noa_count_para);*/ -+ status = rtw_halmac_p2pps(adapter_to_dvobj(adapter) , (&p2p_ps_para)); -+ if (status == -1) -+ RTW_ERR("%s , rtw_halmac_p2pps fail\n", __func__); -+ } -+ -+ break; -+ -+ case P2P_PS_SCAN: -+ /*This feature FW not ready 20161116 YiWei*/ -+ return; -+ /* -+ RTW_INFO("P2P_PS_SCAN\n"); -+ (&p2p_ps_para)->discovery = 1; -+ (&p2p_ps_para)->ctwindow_length = pwdinfo->ctwindow; -+ (&p2p_ps_para)->noa_duration_para = pwdinfo->noa_duration[0]; -+ (&p2p_ps_para)->noa_interval_para = pwdinfo->noa_interval[0]; -+ (&p2p_ps_para)->noa_start_time_para = pwdinfo->noa_start_time[0]; -+ (&p2p_ps_para)->noa_count_para = pwdinfo->noa_count[0]; -+ */ -+ break; -+ -+ case P2P_PS_SCAN_DONE: -+ /*This feature FW not ready 20161116 YiWei*/ -+ return; -+ /* -+ RTW_INFO("P2P_PS_SCAN_DONE\n"); -+ (&p2p_ps_para)->discovery = 0; -+ pwdinfo->p2p_ps_state = P2P_PS_ENABLE; -+ (&p2p_ps_para)->ctwindow_length = pwdinfo->ctwindow; -+ (&p2p_ps_para)->noa_duration_para = pwdinfo->noa_duration[0]; -+ (&p2p_ps_para)->noa_interval_para = pwdinfo->noa_interval[0]; -+ (&p2p_ps_para)->noa_start_time_para = pwdinfo->noa_start_time[0]; -+ (&p2p_ps_para)->noa_count_para = pwdinfo->noa_count[0]; -+ */ -+ break; -+ -+ default: -+ break; -+ } -+ -+ if (p2p_ps_state != P2P_PS_ENABLE || (&p2p_ps_para)->noa_en == 0) { -+ status = rtw_halmac_p2pps(adapter_to_dvobj(adapter) , (&p2p_ps_para)); -+ if (status == -1) -+ RTW_ERR("%s , rtw_halmac_p2pps fail\n", __func__); -+ } -+ _rtw_memcpy(&hal->p2p_ps_offload , (&p2p_ps_para) , sizeof(hal->p2p_ps_offload)); -+ -+} -+#endif /* RTW_HALMAC */ -+#endif /* CONFIG_P2P */ -+ -+#if defined(CONFIG_RTL8822C) && defined(CONFIG_SUPPORT_DYNAMIC_TXPWR) -+static void _rtw_hal_dtp_macid_set( -+ _adapter *padapter, u8 opmode, u8 mac_id) -+{ -+ struct macid_ctl_t *macid_ctl = &(padapter->dvobj->macid_ctl); -+ struct sta_info *psta; -+ u8 h2c_cmd[H2C_FW_CRC5_SEARCH_LEN] = {0}; -+ u8 mac_addr[ETH_ALEN] = {0}; -+ -+ if (opmode) { -+ psta = macid_ctl->sta[mac_id]; -+ if (psta) -+ _rtw_memcpy(mac_addr, psta->cmn.mac_addr, ETH_ALEN); -+ -+ if (rtw_check_invalid_mac_address(mac_addr, _FALSE)) -+ return; -+ } -+ /* else DON'T CARE H2C_FW_CRC5_SEARCH mac addr in disconnected case */ -+ -+ if (rtw_get_chip_type(padapter) == RTL8822C) { -+ SET_H2CCMD_FW_CRC5_SEARCH_EN(h2c_cmd, opmode); -+ SET_H2CCMD_FW_CRC5_SEARCH_MACID(h2c_cmd, mac_id); -+ SET_H2CCMD_FW_CRC5_SEARCH_MAC(&h2c_cmd[1], mac_addr); -+ if (rtw_hal_fill_h2c_cmd(padapter, H2C_FW_CRC5_SEARCH, -+ H2C_FW_CRC5_SEARCH_LEN, h2c_cmd) != _SUCCESS) -+ RTW_WARN("%s : set h2c - 0x%02x fail!\n", __func__, H2C_FW_CRC5_SEARCH); -+ } -+} -+ -+static void rtw_hal_dtp_macid_set(_adapter *padapter, u8 opmode, -+ bool macid_ind, u8 mac_id, u8 macid_end) -+{ -+ int i; -+ -+ if (macid_ind == 0) { -+ _rtw_hal_dtp_macid_set(padapter, opmode, mac_id); -+ } else { -+ for (i = mac_id; i <= macid_end; i++) -+ _rtw_hal_dtp_macid_set(padapter, opmode, i); -+ } -+} -+#endif -+ -+/* -+* 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; -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ u8 hw_port = rtw_hal_get_port(adapter); -+#endif -+ u8 op_num_change_bmp = 0; -+ -+#if defined(CONFIG_RTL8822C) && defined(CONFIG_SUPPORT_DYNAMIC_TXPWR) -+ rtw_hal_dtp_macid_set(adapter, opmode, macid_ind, macid, macid_end); -+#endif -+ -+ 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); -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ SET_H2CCMD_MSRRPT_PARM_PORT_NUM(parm, hw_port); -+#endif -+ RTW_DBG_DUMP("MediaStatusRpt parm:", parm, H2C_MEDIA_STATUS_RPT_LEN); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_MEDIA_STATUS_RPT, H2C_MEDIA_STATUS_RPT_LEN, parm); -+ if (ret != _SUCCESS) -+ goto exit; -+ -+#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++) { -+ op_num_change_bmp |= 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 CONFIG_TX_AC_LIFETIME -+ if (op_num_change_bmp) -+ rtw_hal_update_tx_aclt(adapter); -+#endif -+ -+ 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) -+{ -+ 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_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->version_id) || IS_8192F_SERIES(pHalData->version_id) -+ || IS_8822B_SERIES(pHalData->version_id) || IS_8821C_SERIES(pHalData->version_id) -+ || IS_8822C_SERIES(pHalData->version_id)) -+ 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) -+ #if defined(CONFIG_RTL8821A) && defined(CONFIG_SDIO_HCI) -+ /* 8821A's LED2 circuit(used by HW_LED strategy) needs enable WL GPIO control of GPIO[14:13], can't disable */ -+ && (!IS_HW_LED_STRATEGY(rtw_led_get_strategy(padapter)) || enable) -+ #endif -+ ) -+ 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 defined(CONFIG_RTL8192F) -+ rtw_hal_set_hwreg(padapter, HW_VAR_WOW_OUTPUT_GPIO, (u8 *)(&outputval)); -+#else -+ 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_input_gpio(_adapter *padapter, u8 index) -+{ -+#if defined(CONFIG_RTL8192F) -+ rtw_hal_set_hwreg(padapter, HW_VAR_WOW_INPUT_GPIO, (u8 *)(&index)); -+#else -+ 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)); -+ -+ } 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)); -+ } else -+ RTW_INFO("%s: invalid GPIO%d\n", __func__, index); -+#endif -+} -+ -+#endif -+ -+void rtw_hal_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 ret = 0; -+#ifdef CONFIG_WOWLAN -+ u8 u1H2CAoacRsvdPageParm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; -+ -+ RTW_INFO("%s: RWC: %d ArpRsp: %d NbrAdv: %d LocNDPInfo: %d\n", -+ __func__, rsvdpageloc->LocRemoteCtrlInfo, -+ rsvdpageloc->LocArpRsp, rsvdpageloc->LocNbrAdv, -+ rsvdpageloc->LocNDPInfo); -+ RTW_INFO("%s:GtkRsp: %d GtkInfo: %d ProbeReq: %d NetworkList: %d\n", -+ __func__, rsvdpageloc->LocGTKRsp, rsvdpageloc->LocGTKInfo, -+ rsvdpageloc->LocProbeReq, rsvdpageloc->LocNetList); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) { -+ 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_NDP_INFO(u1H2CAoacRsvdPageParm, -+ rsvdpageloc->LocNDPInfo); -+#ifdef CONFIG_GTK_OL -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKRsp); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKInfo); -+ 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_INFO("AOAC Report=%d\n", rsvdpageloc->LocAOACReport); -+ _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; -+ } -+#if defined(CONFIG_PNO_SUPPORT) && !defined(RTW_HALMAC) -+ 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 /* defined(CONFIG_PNO_SUPPORT) && !defined(RTW_HALMAC) */ -+#endif /* CONFIG_WOWLAN */ -+} -+ -+#ifdef DBG_FW_DEBUG_MSG_PKT -+void rtw_hal_set_fw_dbg_msg_pkt_rsvd_page_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ struct hal_ops *pHalFunc = &padapter->hal_func; -+ u8 u1H2C_fw_dbg_msg_pkt_parm[H2C_FW_DBG_MSG_PKT_LEN] = {0}; -+ u8 ret = 0; -+ -+ -+ RTW_INFO("RsvdPageLoc: loc_fw_dbg_msg_pkt =%d\n", rsvdpageloc->loc_fw_dbg_msg_pkt); -+ -+ SET_H2CCMD_FW_DBG_MSG_PKT_EN(u1H2C_fw_dbg_msg_pkt_parm, 1); -+ SET_H2CCMD_RSVDPAGE_LOC_FW_DBG_MSG_PKT(u1H2C_fw_dbg_msg_pkt_parm, rsvdpageloc->loc_fw_dbg_msg_pkt); -+ ret = rtw_hal_fill_h2c_cmd(padapter, -+ H2C_FW_DBG_MSG_PKT, -+ H2C_FW_DBG_MSG_PKT_LEN, -+ u1H2C_fw_dbg_msg_pkt_parm); -+ -+} -+#endif /*DBG_FW_DEBUG_MSG_PKT*/ -+ -+/*#define DBG_GET_RSVD_PAGE*/ -+int rtw_hal_get_rsvd_page(_adapter *adapter, u32 page_offset, -+ u32 page_num, u8 *buffer, u32 buffer_size) -+{ -+ u32 addr = 0, size = 0, count = 0; -+ u32 page_size = 0, data_low = 0, data_high = 0; -+ u16 txbndy = 0, offset = 0; -+ u8 i = 0; -+ bool rst = _FALSE; -+ -+#ifdef DBG_LA_MODE -+ struct registry_priv *registry_par = &adapter->registrypriv; -+ -+ if(registry_par->la_mode_en == 1) { -+ RTW_INFO("%s LA debug mode can't dump rsvd pg \n", __func__); -+ return rst; -+ } -+#endif -+ 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; -+ } -+#ifdef RTW_HALMAC -+ if (rtw_halmac_dump_fifo(adapter_to_dvobj(adapter), 2, addr, size, buffer) < 0) -+ rst = _FALSE; -+ else -+ rst = _TRUE; -+#else -+ txbndy = rtw_read8(adapter, REG_TDECTRL + 1); -+ -+ offset = (txbndy + page_offset) * page_size / 8; -+ count = (buffer_size / 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); -+ rst = _TRUE; -+#endif /*RTW_HALMAC*/ -+ -+#ifdef DBG_GET_RSVD_PAGE -+ RTW_INFO("%s [page_offset:%d , page_num:%d][start_addr:0x%04x , size:%d]\n", -+ __func__, page_offset, page_num, addr, size); -+ RTW_INFO_DUMP("\n", buffer, size); -+ RTW_INFO(" ==================================================\n"); -+#endif -+ return rst; -+} -+ -+void rtw_dump_rsvd_page(void *sel, _adapter *adapter, u8 page_offset, u8 page_num) -+{ -+#if defined(CONFIG_RTW_DEBUG) || defined(CONFIG_PROC_DEBUG) -+ u32 page_size = 0; -+ u8 *buffer = NULL; -+ u32 buf_size = 0; -+ -+ if (page_num == 0) -+ return; -+ -+ RTW_PRINT_SEL(sel, "======= RSVD PAGE DUMP =======\n"); -+ RTW_PRINT_SEL(sel, "page_offset:%d, page_num:%d\n", page_offset, page_num); -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); -+ if (page_size) { -+ buf_size = page_size * page_num; -+ buffer = rtw_zvmalloc(buf_size); -+ -+ if (buffer) { -+ rtw_hal_get_rsvd_page(adapter, page_offset, page_num, buffer, buf_size); -+ RTW_DUMP_SEL(sel, buffer, buf_size); -+ rtw_vmfree(buffer, buf_size); -+ } else -+ RTW_PRINT_SEL(sel, "ERROR - rsvd_buf mem allocate failed\n"); -+ } else -+ RTW_PRINT_SEL(sel, "ERROR - Tx page size is zero ??\n"); -+ -+ RTW_PRINT_SEL(sel, "==========================\n"); -+#endif -+} -+ -+#ifdef CONFIG_SUPPORT_FIFO_DUMP -+void rtw_dump_fifo(void *sel, _adapter *adapter, u8 fifo_sel, u32 fifo_addr, u32 fifo_size) -+{ -+ u8 *buffer = NULL; -+ u32 buff_size = 0; -+ static const char * const fifo_sel_str[] = { -+ "TX", "RX", "RSVD_PAGE", "REPORT", "LLT", "RXBUF_FW" -+ }; -+ -+ if (fifo_sel > 5) { -+ RTW_ERR("fifo_sel:%d invalid\n", fifo_sel); -+ return; -+ } -+ -+ RTW_PRINT_SEL(sel, "========= FIFO DUMP =========\n"); -+ RTW_PRINT_SEL(sel, "%s FIFO DUMP [start_addr:0x%04x , size:%d]\n", fifo_sel_str[fifo_sel], fifo_addr, fifo_size); -+ -+ if (fifo_size) { -+ buff_size = RND4(fifo_size); -+ buffer = rtw_zvmalloc(buff_size); -+ if (buffer == NULL) -+ buff_size = 0; -+ } -+ -+ rtw_halmac_dump_fifo(adapter_to_dvobj(adapter), fifo_sel, fifo_addr, buff_size, buffer); -+ -+ if (buffer) { -+ RTW_DUMP_SEL(sel, buffer, fifo_size); -+ rtw_vmfree(buffer, buff_size); -+ } -+ -+ RTW_PRINT_SEL(sel, "==========================\n"); -+} -+#endif -+ -+#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))); -+} -+#if defined(CONFIG_RTL8188E) -+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)); -+} -+#endif -+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, (u32)(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; -+ 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 { -+ res = RecvOnePkt(adapter); -+ 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 + 2); -+ -+ RTW_PRINT("Stop RX DMA failed......\n"); -+#if defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) -+ RTW_PRINT("%s, RXPKT_NUM: 0x%04x\n", -+ __func__, rtw_read16(adapter, REG_RXPKTNUM)); -+#else -+ RTW_PRINT("%s, RXPKT_NUM: 0x%02x\n", -+ __func__, ((tmp & 0xFF00) >> 8)); -+#endif -+ 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) -+#ifndef RTW_HALMAC -+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 -+#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 (for 8051), WOW enable successful. -+ * If 0x1C7 == 0 (for 3081), WOW enable successful. -+ * _FALSE means to check disable, if 0x690 & bit1 (for 8051), WOW disable fail. -+ * If 0x120 & bit16 || 0x284 & bit18 (for 3081), WOW disable fail. -+ */ -+static u8 rtw_hal_check_wow_ctrl(_adapter *adapter, u8 chk_type) -+{ -+ u32 fe1_imr = 0xFF, rxpkt_num = 0xFF; -+ u8 mstatus = 0; -+ u8 reason = 0xFF; -+ u8 trycnt = 25; -+ u8 res = _FALSE; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR2(adapter) || IS_HARDWARE_TYPE_JAGUAR3(adapter)) { -+ if (chk_type) { -+ reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); -+ RTW_INFO("%s reason:0x%02x\n", __func__, reason); -+ -+ while (reason && trycnt > 1) { -+ reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); -+ RTW_PRINT("Loop index: %d :0x%02x\n", -+ trycnt, reason); -+ trycnt--; -+ rtw_msleep_os(20); -+ } -+ if (!reason) -+ res = _TRUE; -+ else -+ res = _FALSE; -+ } else { -+ /* Wait FW to cleare 0x120 bit16, 0x284 bit18 to 0 */ -+ fe1_imr = rtw_read32(adapter, REG_FE1IMR); /* RxDone IMR for 3081 */ -+ rxpkt_num = rtw_read32(adapter, REG_RXPKT_NUM); /* Release RXDMA */ -+ RTW_PRINT("%s REG_FE1IMR (reg120): 0x%x, REG_RXPKT_NUM(reg284): 0x%x\n", __func__, fe1_imr, rxpkt_num); -+ -+ while (((fe1_imr & BIT_FS_RXDONE_INT_EN) || (rxpkt_num & BIT_RW_RELEASE_EN)) && trycnt > 1) { -+ rtw_msleep_os(20); -+ fe1_imr = rtw_read32(adapter, REG_FE1IMR); -+ rxpkt_num = rtw_read32(adapter, REG_RXPKT_NUM); -+ RTW_PRINT("Loop index: %d :0x%x, 0x%x\n", -+ trycnt, fe1_imr, rxpkt_num); -+ trycnt--; -+ } -+ -+ if ((fe1_imr & BIT_FS_RXDONE_INT_EN) || (rxpkt_num & BIT_RW_RELEASE_EN)) -+ res = _FALSE; -+ else -+ res = _TRUE; -+ } -+ } else { -+ 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; -+} -+ -+#if defined(CONFIG_PNO_SUPPORT) && !defined(RTW_HALMAC) -+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 (!MLME_IS_STA(adapter)) -+ 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_id = 0, offset = 0, i = 0, sz = 0, aoac_rpt_ver = 0, has_rekey = _FALSE; -+ u64 replay_count = 0, tmp_iv_hdr = 0, pkt_pn = 0; -+ -+ if (!MLME_IS_STA(adapter)) -+ 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_id = paoac_rpt->key_index; -+ aoac_rpt_ver = paoac_rpt->version_info; -+ -+ if (aoac_rpt_ver == 0) { -+ /* initial verison */ -+ if (gtk_id == 5) -+ has_rekey = _FALSE; -+ else -+ has_rekey = _TRUE; -+ } else if (aoac_rpt_ver >= 1) { -+ /* Add krack patch */ -+ if (gtk_id == 5) -+ RTW_WARN("%s FW check iv fail\n", __func__); -+ -+ if (aoac_rpt_ver == 1) -+ RTW_WARN("%s aoac report version should be update to v2\n", __func__); -+ -+ /* Fix key id mismatch */ -+ if (aoac_rpt_ver == 2) -+ has_rekey = paoac_rpt->rekey_ok == 1 ? _TRUE : _FALSE; -+ } -+ -+ if (has_rekey == _FALSE) { -+ RTW_INFO("%s no rekey event happened.\n", __func__); -+ } else if (has_rekey == _TRUE) { -+ 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_id, -+ NULL, NULL, get_key); -+ rtw_clean_hw_dk_cam(adapter); -+ -+ if (_rtw_camid_is_gk(adapter, gtk_id)) { -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ _rtw_memcpy(&dvobj->cam_cache[gtk_id].key, -+ get_key, 16); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ } else { -+ struct setkey_parm parm_gtk; -+ -+ parm_gtk.algorithm = paoac_rpt->security_type; -+ parm_gtk.keyid = gtk_id; -+ _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_id; -+ _rtw_memcpy(&psecuritypriv->dot118021XGrpKey[gtk_id], -+ 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_id], -+ &(paoac_rpt->group_key[offset]), -+ RTW_TKIP_MIC_LEN); -+ -+ offset = RTW_KEK_LEN; -+ _rtw_memcpy( -+ &psecuritypriv->dot118021XGrprxmickey[gtk_id], -+ &(paoac_rpt->group_key[offset]), -+ RTW_TKIP_MIC_LEN); -+ } -+ RTW_PRINT("GTK (%d) "KEY_FMT"\n", gtk_id, -+ KEY_ARG(psecuritypriv->dot118021XGrpKey[gtk_id].skey)); -+ } -+ -+ /* Update broadcast RX IV */ -+ if (psecuritypriv->dot118021XGrpPrivacy == _AES_) { -+ sz = sizeof(psecuritypriv->iv_seq[0]); -+ for (i = 0 ; i < 4 ; i++) { -+ _rtw_memcpy(&tmp_iv_hdr, paoac_rpt->rxgtk_iv[i], sz); -+ tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); -+ pkt_pn = CCMPH_2_PN(tmp_iv_hdr); -+ _rtw_memcpy(psecuritypriv->iv_seq[i], &pkt_pn, sz); -+ } -+ } -+ -+ 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 /*CONFIG_GTK_OL*/ -+ -+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; -+ int i = 0; -+ -+ 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->security_type); -+ RTW_INFO("[AOAC-RPT] wow_pattern_idx - %d\n", -+ paoac_rpt->wow_pattern_idx); -+ RTW_INFO("[AOAC-RPT] version_info - %d\n", paoac_rpt->version_info); -+ RTW_INFO("[AOAC-RPT] rekey_ok - %d\n", paoac_rpt->rekey_ok); -+ RTW_INFO_DUMP("[AOAC-RPT] RX PTK IV-", paoac_rpt->rxptk_iv, 8); -+ RTW_INFO_DUMP("[AOAC-RPT] RX GTK[0] IV-", paoac_rpt->rxgtk_iv[0], 8); -+ RTW_INFO_DUMP("[AOAC-RPT] RX GTK[1] IV-", paoac_rpt->rxgtk_iv[1], 8); -+ RTW_INFO_DUMP("[AOAC-RPT] RX GTK[2] IV-", paoac_rpt->rxgtk_iv[2], 8); -+ RTW_INFO_DUMP("[AOAC-RPT] RX GTK[3] IV-", paoac_rpt->rxgtk_iv[3], 8); -+} -+ -+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 (buffer == NULL) { -+ 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) -+{ -+ struct security_priv *psecpriv = &adapter->securitypriv; -+ u8 sz = sizeof (psecpriv->iv_seq); -+ -+ rtw_hal_update_tx_iv(adapter); -+#ifdef CONFIG_GTK_OL -+ if (psecpriv->binstallKCK_KEK == _TRUE && -+ (psecpriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK || _rtw_wow_chk_cap(adapter, WOW_CAP_TKIP_OL))) -+ rtw_hal_update_gtk_offload_info(adapter); -+#else -+ _rtw_memset(psecpriv->iv_seq, 0, sz); -+#endif -+} -+#ifdef CONFIG_CUSTOM_PULSE -+static u8 rtw_hal_set_gpio_custom_cmd(_adapter *adapter, u8 enable) -+{ -+ u8 H2CGpioCustomParm[H2C_GPIO_CUSTOM_LEN] = {0}; -+ u8 customid = 0x2, special_wakeup_reason = RX_MAGIC_PKT, custom_for_wakeup_reason=0x1; -+ u8 ret = _FAIL; -+ -+ RTW_INFO("%s(): enable = %d\n", __func__, enable); -+ -+ if(enable) { -+ SET_H2CCMD_CUSTOMERID(H2CGpioCustomParm, customid); -+ SET_H2CCMD_SPECIAL_WAKE_REASON(H2CGpioCustomParm, special_wakeup_reason); -+ SET_H2CCMD_CUSTOM_WAKE_REASON(H2CGpioCustomParm, custom_for_wakeup_reason); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_GPIO_CUSTOM, -+ H2C_GPIO_CUSTOM_LEN, -+ H2CGpioCustomParm); -+ RTW_DBG("%s(): H2C_cmd=%x, cmd=%02x, %02x, %02x\n", __func__, H2C_GPIO_CUSTOM, -+ H2CGpioCustomParm[0], H2CGpioCustomParm[1], H2CGpioCustomParm[2]); -+ } -+ -+ return ret; -+} -+#endif /* CONFIG_CUSTOM_PULSE */ -+static u8 rtw_hal_set_keep_alive_cmd(_adapter *adapter, u8 enable, u8 pkt_type) -+{ -+ u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_CTRL_LEN] = {0}; -+ u8 adopt = 1, check_period = 5; -+ u8 ret = _FAIL; -+ u8 hw_port = rtw_hal_get_port(adapter); -+ -+ 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); -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ SET_H2CCMD_KEEPALIVE_PARM_PORT_NUM(u1H2CKeepAliveParm, hw_port); -+ RTW_INFO("%s(): enable = %d, port = %d\n", __func__, enable, hw_port); -+#else -+ RTW_INFO("%s(): enable = %d\n", __func__, enable); -+#endif -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_KEEP_ALIVE, -+ H2C_KEEP_ALIVE_CTRL_LEN, -+ u1H2CKeepAliveParm); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+static u8 rtw_hal_set_keep_alive_pattern_cmd(PADAPTER adapter, u8 enable) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_PATTERN_LEN] = {0}; -+ u8 ret = _FAIL; -+ int i; -+ -+ /* If keep alive pattern is set, FW will use pattern for keep alive action */ -+ if(enable == 0 || (pwrctl->wowlan_keep_alive_mode == wow_keep_alive_pattern_disable)) { -+ SET_H2CCMD_UDP_KEEP_ALIVE_EN(u1H2CKeepAliveParm, _FALSE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_ACK_PATTERN_EN(u1H2CKeepAliveParm, _FALSE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_WAKE_EN(u1H2CKeepAliveParm, _FALSE); -+ return ret; -+ } -+ /*step1:set keep alive period*/ -+ SET_H2CCMD_UDP_KEEP_ALIVE_PERIOD_LOW_BIT(u1H2CKeepAliveParm, pwrctl->wowlan_keep_alive_period & 0x00FF); -+ SET_H2CCMD_UDP_KEEP_ALIVE_PERIOD_HI_BIT(u1H2CKeepAliveParm, ((pwrctl->wowlan_keep_alive_period & 0xFF00)>> 8)); -+ -+ if (pwrctl->wowlan_keep_alive_mode == wow_keep_alive_pattern_tx) { -+ SET_H2CCMD_UDP_KEEP_ALIVE_EN(u1H2CKeepAliveParm, _TRUE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_ACK_PATTERN_EN(u1H2CKeepAliveParm, _FALSE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_WAKE_EN(u1H2CKeepAliveParm, _FALSE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_PACKET_LOC(u1H2CKeepAliveParm, pwrctl->keep_alive_pattern_loc); -+ goto exit; -+ } -+ if (pwrctl->wowlan_keep_alive_mode == wow_keep_alive_pattern_trx) { -+ SET_H2CCMD_UDP_KEEP_ALIVE_EN(u1H2CKeepAliveParm, _TRUE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_ACK_PATTERN_EN(u1H2CKeepAliveParm, _TRUE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_WAKE_EN(u1H2CKeepAliveParm, _FALSE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_PACKET_LOC(u1H2CKeepAliveParm, pwrctl->keep_alive_pattern_loc); -+ SET_H2CCMD_UDP_KEEP_ALIVE_ACK_PATTERN_idx(u1H2CKeepAliveParm, pwrctl->wowlan_keep_alive_ack_index); -+ SET_H2CCMD_UDP_KEEP_ALIVE_RETRY_INTERVAL(u1H2CKeepAliveParm, pwrctl->wowlan_keep_alive_retry_interval); -+ SET_H2CCMD_UDP_KEEP_ALIVE_RETRY_LIMIT(u1H2CKeepAliveParm, pwrctl->wowlan_keep_alive_retry_counter); -+ goto exit; -+ } -+ if (pwrctl->wowlan_keep_alive_mode == wow_keep_alive_pattern_trx_with_ack) { -+ SET_H2CCMD_UDP_KEEP_ALIVE_EN(u1H2CKeepAliveParm, _TRUE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_ACK_PATTERN_EN(u1H2CKeepAliveParm, _TRUE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_WAKE_EN(u1H2CKeepAliveParm, _TRUE); -+ SET_H2CCMD_UDP_KEEP_ALIVE_PACKET_LOC(u1H2CKeepAliveParm, pwrctl->keep_alive_pattern_loc); -+ SET_H2CCMD_UDP_KEEP_ALIVE_ACK_PATTERN_idx(u1H2CKeepAliveParm, pwrctl->wowlan_keep_alive_ack_index); -+ SET_H2CCMD_UDP_KEEP_ALIVE_WAKE_PATTERN_idx(u1H2CKeepAliveParm, pwrctl->wowlan_wake_pattern_index); -+ SET_H2CCMD_UDP_KEEP_ALIVE_RETRY_INTERVAL(u1H2CKeepAliveParm, pwrctl->wowlan_keep_alive_retry_interval); -+ SET_H2CCMD_UDP_KEEP_ALIVE_RETRY_LIMIT(u1H2CKeepAliveParm, pwrctl->wowlan_keep_alive_retry_counter); -+ goto exit; -+ } -+exit: -+ for(i=0; iregistrypriv; -+ u8 hw_port = rtw_hal_get_port(adapter); -+ -+ SET_H2CCMD_DISCONDECISION_PARM_ENABLE(u1H2CDisconDecisionParm, enable); -+ SET_H2CCMD_DISCONDECISION_PARM_ADOPT(u1H2CDisconDecisionParm, adopt); -+ if (!(pregistry->wakeup_event & BIT(2))) -+ SET_H2CCMD_DISCONDECISION_PARM_DISCONNECT_EN(u1H2CDisconDecisionParm, adopt); -+ SET_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(u1H2CDisconDecisionParm, check_period); -+ SET_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(u1H2CDisconDecisionParm, trypkt_num); -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ SET_H2CCMD_DISCONDECISION_PORT_NUM(u1H2CDisconDecisionParm, hw_port); -+ RTW_INFO("%s(): enable = %d, port = %d\n", __func__, enable, hw_port); -+#else -+ RTW_INFO("%s(): enable = %d\n", __func__, enable); -+#endif -+ -+ 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 registry_priv *registry_par = &adapter->registrypriv; -+ struct security_priv *psecpriv = &adapter->securitypriv; -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ u8 u1H2CWoWlanCtrlParm[H2C_WOWLAN_LEN] = {0}; -+ u8 discont_wake = 0, gpionum = 0, gpio_dur = 0, no_wake = 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_DIS_UPHY -+ u8 dis_uphy = 0, dis_uphy_unit = 0, dis_uphy_time = 0; -+#endif /* CONFIG_DIS_UPHY */ -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ gpio_high_active = ppwrpriv->is_high_active; -+ gpionum = ppwrpriv->wowlan_gpio_index; -+ sdio_wakeup_enable = 0; -+#endif /* CONFIG_GPIO_WAKEUP */ -+ -+ if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && -+ !check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) -+ no_wake = 1; -+ -+ if (!ppwrpriv->wowlan_pno_enable && -+ registry_par->wakeup_event & BIT(0) && !no_wake) -+ magic_pkt = enable; -+ -+ if (registry_par->wakeup_event & BIT(2) && !no_wake) -+ discont_wake = enable; -+ -+ 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); -+ if(!no_wake) -+ 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 -+ if (psecpriv->binstallKCK_KEK == _TRUE && -+ (psecpriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK || _rtw_wow_chk_cap(adapter, WOW_CAP_TKIP_OL))) -+ SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, 0); -+ else -+ 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); -+ -+#ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE -+ if (enable) -+ SET_H2CCMD_WOWLAN_GPIO_INPUT_EN(u1H2CWoWlanCtrlParm, 1); -+#endif -+ -+#ifdef CONFIG_DIS_UPHY -+ if (enable) { -+ dis_uphy = 1; -+ /* time unit: 0 -> ms, 1 -> 256 ms*/ -+ dis_uphy_unit = 1; -+ dis_uphy_time = 0x4; -+ } -+ -+ SET_H2CCMD_WOWLAN_DISABLE_UPHY(u1H2CWoWlanCtrlParm, dis_uphy); -+ SET_H2CCMD_WOWLAN_UNIT_FOR_UPHY_DISABLE(u1H2CWoWlanCtrlParm, dis_uphy_unit); -+ SET_H2CCMD_WOWLAN_TIME_FOR_UPHY_DISABLE(u1H2CWoWlanCtrlParm, dis_uphy_time); -+ if (ppwrpriv->hst2dev_high_active == 1) -+ SET_H2CCMD_WOWLAN_RISE_HST2DEV(u1H2CWoWlanCtrlParm, 1); -+#ifdef CONFIG_RTW_ONE_PIN_GPIO -+ SET_H2CCMD_WOWLAN_GPIO_INPUT_EN(u1H2CWoWlanCtrlParm, 1); -+ SET_H2CCMD_WOWLAN_DEV2HST_EN(u1H2CWoWlanCtrlParm, 1); -+ SET_H2CCMD_WOWLAN_HST2DEV_EN(u1H2CWoWlanCtrlParm, 0); -+#else -+ SET_H2CCMD_WOWLAN_HST2DEV_EN(u1H2CWoWlanCtrlParm, 1); -+#endif /* CONFIG_RTW_ONE_PIN_GPIO */ -+#endif /* CONFIG_DIS_UPHY */ -+ -+ -+ 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 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, no_wake = 0; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ RTW_INFO("%s(): enable=%d\n", __func__, enable); -+ -+ if(pregistrypriv->suspend_type == FW_IPS_DISABLE_BBRF && -+ !check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) -+ no_wake = 1; -+ if(no_wake) { -+ SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( -+ u1H2CRemoteWakeCtrlParm, enable); -+ } else { -+ if (!ppwrpriv->wowlan_pno_enable) { -+ SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( -+ u1H2CRemoteWakeCtrlParm, enable); -+ #ifdef CONFIG_GTK_OL -+ if (psecuritypriv->binstallKCK_KEK == _TRUE && -+ (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK || _rtw_wow_chk_cap(adapter, WOW_CAP_TKIP_OL))) { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 1); -+ } else { -+ RTW_INFO("no kck kek\n"); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 0); -+ } -+ #endif /* CONFIG_GTK_OL */ -+ -+ #ifdef CONFIG_IPV6 -+ if (ppwrpriv->wowlan_ns_offload_en == _TRUE) { -+ RTW_INFO("enable NS offload\n"); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_NDP_OFFLOAD_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); -+ #endif /*CONFIG_IPV6*/ -+#if 0 /* replaced by WOWLAN pattern match */ -+ #ifdef CONFIG_RTL8192F -+ if (IS_HARDWARE_TYPE_8192F(adapter)){ -+ SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN( -+ u1H2CRemoteWakeCtrlParm, enable); -+ } -+ #endif /* CONFIG_RTL8192F */ -+#endif -+ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) { -+#ifdef CONFIG_GTK_OL -+ if(_rtw_wow_chk_cap(adapter, WOW_CAP_TKIP_OL)) -+ SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, enable); -+#endif /* CONFIG_GTK_OL */ -+ if (IS_HARDWARE_TYPE_8188E(adapter) || -+ IS_HARDWARE_TYPE_8812(adapter)) { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 0); -+ } -+ } -+ -+ if (0) { -+ /* ARP wake up case */ -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 1); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( -+ u1H2CRemoteWakeCtrlParm, 1); -+ } else if (pregistrypriv->wakeup_event) { -+ /* ARP no wake up case */ -+ if ((psecuritypriv->dot11PrivacyAlgrthm == _AES_) || -+ (psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_)) { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 1); -+ } -+ #ifdef CONFIG_GTK_OL -+ else if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_ && -+ _rtw_wow_chk_cap(adapter, WOW_CAP_TKIP_OL)) { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 1); -+ } -+ #endif -+ } else { -+ /* ARP no wake up and no ARP response case */ -+ } -+ -+ 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; -+} -+ -+#ifdef CONFIG_WAR_OFFLOAD -+static u8 rtw_hal_set_war_offload_ctrl_cmd(_adapter *adapter, u8 enable) -+{ -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ u8 u1H2CWarOffloadParm[H2C_WAR_OFFLOAD_LEN] = {0}; -+ u8 ret = _FAIL; -+ -+ RTW_INFO("%s(): enable=%d\n", __func__, enable); -+ -+ if (_TRUE == ppwrpriv->wowlan_war_offload_mode) { -+ SET_H2CCMD_WAR_CFG_EN(u1H2CWarOffloadParm, enable); -+ SET_H2CCMD_WAR_CFG_ARP_RSP_EN(u1H2CWarOffloadParm, 1); -+ -+#ifdef CONFIG_OFFLOAD_MDNS_V4 -+ if (WAR_MDNS_V4_RSP_EN & ppwrpriv->wowlan_war_offload_ctrl) { -+ SET_H2CCMD_WAR_CFG_MDNSV4_RSP_EN(u1H2CWarOffloadParm, 1); -+ } -+ if (WAR_MDNS_V4_WAKEUP_EN& ppwrpriv->wowlan_war_offload_ctrl) { -+ SET_H2CCMD_WAR_CFG_MDNSV4_WAKE_EN(u1H2CWarOffloadParm, 1); -+ } -+#endif /* CONFIG_OFFLOAD_MDNS_V4 */ -+ -+#ifdef CONFIG_OFFLOAD_MDNS_V6 -+ if (WAR_MDNS_V6_RSP_EN & ppwrpriv->wowlan_war_offload_ctrl) { -+ SET_H2CCMD_WAR_CFG_MDNSV6_RSP_EN(u1H2CWarOffloadParm, 1); -+ } -+ if (WAR_MDNS_V6_WAKEUP_EN & ppwrpriv->wowlan_war_offload_ctrl) { -+ SET_H2CCMD_WAR_CFG_MDNSV6_WAKE_EN(u1H2CWarOffloadParm, 1); -+ } -+#endif /* CONFIG_OFFLOAD_MDNS_V6 */ -+ -+ } -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_WAR_OFFLOAD, -+ H2C_WAR_OFFLOAD_LEN, -+ u1H2CWarOffloadParm); -+ return ret; -+} -+ -+static u8 rtw_hal_set_war_offload_parm(_adapter *adapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ u8 u1H2CWarOfldParm[H2C_WAROFLD_RSVDPAGE1_LEN] = {0}; -+ u8 ret = _FAIL; -+ -+ SET_H2CCMD_WAROFLD_RSVDPAGE1_LOC_PARM(u1H2CWarOfldParm, rsvdpageloc->LocIpParm); -+ RTW_INFO("%s(): LocIpParm = %d\n", __func__, rsvdpageloc->LocIpParm); -+ -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_WAROFLD_RSVDPAGE1, -+ H2C_WAROFLD_RSVDPAGE1_LEN, -+ u1H2CWarOfldParm); -+ -+ return ret; -+} -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+ -+ -+static u8 rtw_hal_set_global_info_cmd(_adapter *adapter, u8 group_alg, u8 pairwise_alg) -+{ -+ 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); -+ u8 ret = _FAIL; -+#ifndef RTW_HALMAC -+ u8 u1H2CScanOffloadInfoParm[H2C_SCAN_OFFLOAD_CTRL_LEN] = {0}; -+ -+ 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); -+#else -+ u8 u1H2CNLOINFOInfoParm[H2C_NLO_INFO_LEN] = {0}; -+ -+ RTW_INFO("%s: loc_nlo_info: %d enable %d\n", __func__, -+ rsvdpageloc->LocPNOInfo, enable); -+ -+ SET_H2CCMD_NLO_FUN_EN(u1H2CNLOINFOInfoParm, enable); -+#ifdef CONFIG_LPS_LCLK -+ // TODO(Owen): Controlled by wowlan lps level -+ /* This H2C bit requires driver leave LCLK in rtw_resume_process_wow() */ -+ SET_H2CCMD_NLO_PS_32K(u1H2CNLOINFOInfoParm, enable); -+#endif -+ SET_H2CCMD_NLO_LOC_NLO_INFO(u1H2CNLOINFOInfoParm, rsvdpageloc->LocPNOInfo); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_NLO_INFO, -+ H2C_NLO_INFO_LEN, -+ u1H2CNLOINFOInfoParm); -+#endif -+ 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 registry_priv *pregistry = &padapter->registrypriv; -+ u8 pkt_type = 0, no_wake = 0; -+ -+ if(pregistry->suspend_type == FW_IPS_DISABLE_BBRF && -+ !check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) -+ no_wake = 1; -+ -+ RTW_PRINT("+%s()+: enable=%d\n", __func__, enable); -+ -+ rtw_hal_set_wowlan_ctrl_cmd(padapter, enable, _FALSE); -+ -+ if (enable) { -+ if(!no_wake) -+ rtw_hal_set_global_info_cmd(padapter, -+ psecpriv->dot118021XGrpPrivacy, -+ psecpriv->dot11PrivacyAlgrthm); -+ -+ if (!(ppwrpriv->wowlan_pno_enable)) { -+ if (!no_wake) -+ 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 */ -+ if(!no_wake) { -+ #ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ rtw_hal_set_keep_alive_pattern_cmd(padapter,enable); -+ #endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ rtw_hal_set_keep_alive_cmd(padapter, enable, pkt_type); -+ } -+ } -+#if defined(CONFIG_PNO_SUPPORT) && !defined(RTW_HALMAC) -+ rtw_hal_check_pno_enabled(padapter); -+#endif /* defined(CONFIG_PNO_SUPPORT) && !defined(RTW_HALMAC) */ -+#ifdef CONFIG_WAR_OFFLOAD -+ rtw_hal_set_war_offload_ctrl_cmd(padapter, enable); -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+ } 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 -+ } -+#ifdef CONFIG_CUSTOM_PULSE -+ rtw_hal_set_gpio_custom_cmd(padapter, enable); -+#endif /* CONFIG_CUSTOM_PULSE */ -+ 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 pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ -+ 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 = ppwrpriv->wowlan_gpio_index; -+ 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) -+{ -+ 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) -+{ -+ 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->hal_func; -+ 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 security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct sta_info *psta = NULL; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+#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; -+#ifdef CONFIG_GPIO_WAKEUP -+ u8 val8 = 0; -+#endif -+ -+ 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 defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(padapter)) -+ rtw_hal_disable_tx_report(padapter); -+ #endif -+ /* 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 -+#ifdef CONFIG_RTW_ONE_PIN_GPIO -+ rtw_hal_switch_gpio_wl_ctrl(padapter, pwrpriv->wowlan_gpio_index, _TRUE); -+ rtw_hal_set_input_gpio(padapter, pwrpriv->wowlan_gpio_index); -+#else -+#ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE -+ if (pwrctrlpriv->is_high_active == 0) -+ rtw_hal_set_input_gpio(padapter, pwrpriv->wowlan_gpio_index); -+ else -+ rtw_hal_set_output_gpio(padapter, pwrpriv->wowlan_gpio_index, -+ GPIO_OUTPUT_LOW); -+#else -+ val8 = (pwrpriv->is_high_active == 0) ? 1 : 0; -+ rtw_hal_set_output_gpio(padapter, pwrpriv->wowlan_gpio_index, val8); -+ rtw_hal_switch_gpio_wl_ctrl(padapter, pwrpriv->wowlan_gpio_index, _TRUE); -+ RTW_INFO("%s: set GPIO_%d to OUTPUT %s state in ap wow suspend and %s_ACTIVE.\n", -+ __func__, pwrpriv->wowlan_gpio_index, -+ pwrpriv->wowlan_gpio_output_state ? "HIGH" : "LOW", -+ pwrpriv->is_high_active ? "HIGI" : "LOW"); -+#endif /* CONFIG_WAKEUP_GPIO_INPUT_MODE */ -+#endif /* CONFIG_RTW_ONE_PIN_GPIO */ -+#endif /* CONFIG_GPIO_WAKEUP */ -+ -+ /* 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); -+#endif -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+ /* Invoid SE0 reset signal during suspending*/ -+ rtw_write8(padapter, REG_RSV_CTRL, 0x20); -+ if (IS_8188F(pHalData->version_id) == FALSE -+ && IS_8188GTV(pHalData->version_id) == FALSE) -+ rtw_write8(padapter, REG_RSV_CTRL, 0x60); -+#endif -+} -+ -+static void rtw_hal_ap_wow_disable(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+#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; -+ -+ 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 defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(padapter)) -+ rtw_hal_enable_tx_report(padapter); -+ #endif -+ -+ rtw_hal_force_enable_rxdma(padapter); -+ -+ rtw_hal_fw_dl(padapter, _FALSE); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#ifdef CONFIG_RTW_ONE_PIN_GPIO -+ rtw_hal_set_input_gpio(padapter, pwrctl->wowlan_gpio_index); -+#else -+#ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE -+ if (pwrctl->is_high_active == 0) -+ rtw_hal_set_input_gpio(padapter, pwrctl->wowlan_gpio_index); -+ else -+ rtw_hal_set_output_gpio(padapter, pwrctl->wowlan_gpio_index -+ , GPIO_OUTPUT_LOW); -+#else -+ rtw_hal_set_output_gpio(padapter, pwrctl->wowlan_gpio_index, -+ pwrctl->wowlan_gpio_output_state); -+ RTW_INFO("%s: set GPIO_%d to OUTPUT %s state in ap wow resume and %s_ACTIVE.\n", -+ __func__, pwrctl->wowlan_gpio_index, -+ pwrctl->wowlan_gpio_output_state ? "HIGH" : "LOW", -+ pwrctl->is_high_active ? "HIGI" : "LOW"); -+#endif /*CONFIG_WAKEUP_GPIO_INPUT_MODE*/ -+#endif /* CONFIG_RTW_ONE_PIN_GPIO */ -+#endif /* CONFIG_GPIO_WAKEUP */ -+ 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++; */ -+ set_frame_sub_type(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 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 -+ -+ /* 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); -+ set_frame_sub_type(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 */ -+ -+ /* 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) -+{ -+ struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); -+ 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); -+ set_frame_sub_type(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)ch_list->reg_classes -+ + get_reg_classes_full_count(ch_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, WIFI_ASOC_STATE)) -+ *(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 -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < ch_list->reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < ch_list->reg_class[j].channels; i++) -+ p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; -+ } -+ } -+ -+ /* 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); -+ set_frame_sub_type(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) { -+ struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); -+ -+ 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)ch_list->reg_classes -+ + get_reg_classes_full_count(ch_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 -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < ch_list->reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = ch_list->reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < ch_list->reg_class[j].channels; i++) -+ p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; -+ } -+ } -+ } -+#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); -+ set_frame_sub_type(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->hal_func; -+ 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->hal_func; -+ 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 */ -+ -+void rtw_hal_construct_beacon(_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); -+ 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++; */ -+ set_frame_sub_type(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; -+ -+#if 0 -+ /* 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: -+#endif -+ -+ if ((pktlen + TXDESC_SIZE) > MAX_BEACON_LEN) { -+ RTW_ERR("beacon frame too large ,len(%d,%d)\n", -+ (pktlen + TXDESC_SIZE), MAX_BEACON_LEN); -+ rtw_warn_on(1); -+ 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); -+ set_frame_sub_type(pframe, WIFI_PSPOLL); -+ -+ /* AID. */ -+ set_duration(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; -+} -+ -+ -+#ifdef DBG_FW_DEBUG_MSG_PKT -+void rtw_hal_construct_fw_dbg_msg_pkt( -+ 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); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ -+ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ -+ -+ 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(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ -+ set_frame_sub_type(pframe, WIFI_DATA); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ *plength = pktlen; -+} -+#endif /*DBG_FW_DEBUG_MSG_PKT*/ -+ -+void rtw_hal_construct_NullFunctionData( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength, -+ 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); -+ u8 *sta_addr = NULL; -+ u8 bssid[ETH_ALEN] = {0}; -+ -+ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ if (bForcePowerSave) -+ SetPwrMgt(fctrl); -+ -+ sta_addr = get_my_bssid(&pmlmeinfo->network); -+ if (NULL == sta_addr) { -+ _rtw_memcpy(bssid, adapter_mac_addr(padapter), ETH_ALEN); -+ sta_addr = bssid; -+ } -+ -+ 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, sta_addr, ETH_ALEN); -+ break; -+ case Ndis802_11APMode: -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, sta_addr, 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, sta_addr, 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); -+ set_duration(pwlanhdr, 0); -+ -+ if (bQoS == _TRUE) { -+ struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; -+ -+ set_frame_sub_type(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 { -+ set_frame_sub_type(pframe, WIFI_DATA_NULL); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ } -+ -+ *pLength = pktlen; -+} -+ -+void rtw_hal_construct_ProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, -+ BOOLEAN bHideSSID) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u8 *mac, *bssid, *sta_addr; -+ 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; -+ sta_addr = get_my_bssid(&pmlmeinfo->network); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ _rtw_memcpy(pwlanhdr->addr1, sta_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ set_frame_sub_type(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 -+static void rtw_hal_append_tkip_mic(PADAPTER padapter, -+ u8 *pframe, u32 offset) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct mic_data micdata; -+ struct sta_info *psta = NULL; -+ int res = 0; -+ -+ u8 *payload = (u8 *)(pframe + offset); -+ -+ u8 mic[8]; -+ u8 priority[4] = {0x0}; -+ u8 null_key[16] = {0x0}; -+ -+ RTW_INFO("%s(): Add MIC, offset: %d\n", __func__, offset); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, -+ get_my_bssid(&(pmlmeinfo->network))); -+ if (psta != NULL) { -+ res = _rtw_memcmp(&psta->dot11tkiptxmickey.skey[0], -+ null_key, 16); -+ if (res == _TRUE) -+ RTW_INFO("%s(): STA dot11tkiptxmickey==0\n", __func__); -+ 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])); -+ -+ payload += 36; -+ -+ _rtw_memcpy(payload, &(mic[0]), 8); -+} -+/* -+ * 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 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, arp_offset = 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); -+ /* set_frame_sub_type(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); -+ set_duration(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. */ -+ /* ------------------------------------------------------------------------- */ -+ arp_offset = *pLength; -+ pARPRspPkt = (u8 *)(pframe + arp_offset); -+ payload = pARPRspPkt; /* Get Payload pointer */ -+ /* LLC header */ -+ _rtw_memcpy(pARPRspPkt, ARPLLCHeader, 8); -+ *pLength += 8; -+ -+ /* ARP element */ -+ pARPRspPkt += 8; -+ SET_ARP_HTYPE(pARPRspPkt, 1); -+ SET_ARP_PTYPE(pARPRspPkt, ETH_P_IP); /* IP protocol */ -+ SET_ARP_HLEN(pARPRspPkt, ETH_ALEN); -+ SET_ARP_PLEN(pARPRspPkt, RTW_IP_ADDR_LEN); -+ SET_ARP_OPER(pARPRspPkt, 2); /* ARP response */ -+ SET_ARP_SENDER_MAC_ADDR(pARPRspPkt, adapter_mac_addr(padapter)); -+ SET_ARP_SENDER_IP_ADDR(pARPRspPkt, pIPAddress); -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ if (!is_zero_mac_addr(pmlmepriv->gw_mac_addr)) { -+ SET_ARP_TARGET_MAC_ADDR(pARPRspPkt, pmlmepriv->gw_mac_addr); -+ SET_ARP_TARGET_IP_ADDR(pARPRspPkt, pmlmepriv->gw_ip); -+ } else -+#endif -+ { -+ SET_ARP_TARGET_MAC_ADDR(pARPRspPkt, -+ get_my_bssid(&(pmlmeinfo->network))); -+ SET_ARP_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_) { -+ if (IS_HARDWARE_TYPE_8188E(padapter) || -+ IS_HARDWARE_TYPE_8812(padapter)) { -+ rtw_hal_append_tkip_mic(padapter, pframe, arp_offset); -+ } -+ *pLength += 8; -+ } -+} -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+/* -+ * Description: -+ * Construct the Keep Alive packet to support specific Keep Alive packet. -+ * */ -+static void rtw_hal_construct_keepalive( PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength -+){ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ 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 pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ static u8 LLCHeader[6] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00}; -+ u8 *pKeepAlivePkt = pframe; -+ /* for TKIP Cal MIC */ -+ u8 *payload = pframe; -+ u8 EncryptionHeadOverhead = 0, frame_offset = 0; -+ int i; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ RTW_INFO("%s======>\n", __func__); -+ -+ -+ /* ------------------------------------------------------------------------- */ -+ /* MAC Header. */ -+ /* ------------------------------------------------------------------------- */ -+ SetFrameType(fctrl, WIFI_DATA); -+ /* set_frame_sub_type(fctrl, 0); */ -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pwrpriv->keep_alive_pattern+6, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3,pwrpriv->keep_alive_pattern, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ set_duration(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. */ -+ /* ------------------------------------------------------------------------- */ -+ frame_offset = *pLength; -+ pKeepAlivePkt = (u8 *)(pframe + frame_offset); -+ payload = pKeepAlivePkt; /* Get Payload pointer */ -+ /* LLC header */ -+ _rtw_memcpy(pKeepAlivePkt, LLCHeader, 6); -+ *pLength += 6; -+ -+ /*From protocol type*/ -+ pKeepAlivePkt+=6; -+ -+ _rtw_memcpy(pKeepAlivePkt,pwrpriv->keep_alive_pattern+12,pwrpriv->keep_alive_pattern_len-12); -+ -+ *pLength+=pwrpriv->keep_alive_pattern_len-12; -+ -+ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) { -+ *pLength += 8; -+ } -+ -+ /* for debug -+ for (i=0; i< (*pLength) ;i++) { -+ RTW_INFO("KA_Pkt[0x%x]=x%0x", i,pKeepAlivePkt[i]); -+ if((i%8) == 7) -+ RTW_INFO("\n"); -+ } -+ */ -+ -+ RTW_INFO("%s <======\n", __func__); -+} -+ -+#endif/*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ -+#ifdef CONFIG_IPV6 -+/* -+ * Description: Neighbor Discovery Offload. -+ */ -+static void rtw_hal_construct_na_message(_adapter *padapter, -+ u8 *pframe, u32 *pLength) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr = NULL; -+ 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; -+ -+ u32 pktlen = 0; -+ u16 *fctrl = NULL; -+ -+ u8 ns_hdr[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x86, 0xDD}; -+ u8 ipv6_info[4] = {0x60, 0x00, 0x00, 0x00}; -+ u8 ipv6_contx[4] = {0x00, 0x20, 0x3a, 0xff}; -+ u8 icmpv6_hdr[8] = {0x88, 0x00, 0x00, 0x00, 0x60, 0x00, 0x00, 0x00}; -+ u8 val8 = 0; -+ -+ u8 *p_na_msg = pframe; -+ /* for TKIP Cal MIC */ -+ u8 *payload = pframe; -+ u8 EncryptionHeadOverhead = 0, na_msg_offset = 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); -+ 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); -+ set_duration(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. */ -+ /* ------------------------------------------------------------------------- */ -+ na_msg_offset = *pLength; -+ p_na_msg = (u8 *)(pframe + na_msg_offset); -+ payload = p_na_msg; /* Get Payload pointer */ -+ -+ /* LLC header */ -+ val8 = sizeof(ns_hdr); -+ _rtw_memcpy(p_na_msg, ns_hdr, val8); -+ *pLength += val8; -+ p_na_msg += val8; -+ -+ /* IPv6 Header */ -+ /* 1 . Information (4 bytes): 0x60 0x00 0x00 0x00 */ -+ val8 = sizeof(ipv6_info); -+ _rtw_memcpy(p_na_msg, ipv6_info, val8); -+ *pLength += val8; -+ p_na_msg += val8; -+ -+ /* 2 . playload : 0x00 0x20 , NextProt : 0x3a (ICMPv6) HopLim : 0xff */ -+ val8 = sizeof(ipv6_contx); -+ _rtw_memcpy(p_na_msg, ipv6_contx, val8); -+ *pLength += val8; -+ p_na_msg += val8; -+ -+ /* 3 . SA : 16 bytes , DA : 16 bytes ( Fw will filled ) */ -+ _rtw_memset(&(p_na_msg[*pLength]), 0, 32); -+ *pLength += 32; -+ p_na_msg += 32; -+ -+ /* ICMPv6 */ -+ /* 1. Type : 0x88 (NA) -+ * 2. Code : 0x00 -+ * 3. ChechSum : 0x00 0x00 (RSvd) -+ * 4. NAFlag: 0x60 0x00 0x00 0x00 ( Solicited , Override) -+ */ -+ val8 = sizeof(icmpv6_hdr); -+ _rtw_memcpy(p_na_msg, icmpv6_hdr, val8); -+ *pLength += val8; -+ p_na_msg += val8; -+ -+ /* TA: 16 bytes*/ -+ _rtw_memset(&(p_na_msg[*pLength]), 0, 16); -+ *pLength += 16; -+ p_na_msg += 16; -+ -+ /* ICMPv6 Target Link Layer Address */ -+ p_na_msg[0] = 0x02; /* type */ -+ p_na_msg[1] = 0x01; /* len 1 unit of 8 octes */ -+ *pLength += 2; -+ p_na_msg += 2; -+ -+ _rtw_memset(&(p_na_msg[*pLength]), 0, 6); -+ *pLength += 6; -+ p_na_msg += 6; -+ -+ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) { -+ if (IS_HARDWARE_TYPE_8188E(padapter) || -+ IS_HARDWARE_TYPE_8812(padapter)) { -+ rtw_hal_append_tkip_mic(padapter, pframe, -+ na_msg_offset); -+ } -+ *pLength += 8; -+ } -+} -+/* -+ * Description: Neighbor Discovery Protocol Information. -+ */ -+static void rtw_hal_construct_ndp_info(_adapter *padapter, -+ u8 *pframe, u32 *pLength) -+{ -+ struct mlme_ext_priv *pmlmeext = NULL; -+ struct mlme_ext_info *pmlmeinfo = NULL; -+ struct rtw_ndp_info ndp_info; -+ u8 *pndp_info = pframe; -+ u8 len = sizeof(struct rtw_ndp_info); -+ -+ RTW_INFO("%s: len: %d\n", __func__, len); -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ _rtw_memset(pframe, 0, len); -+ _rtw_memset(&ndp_info, 0, len); -+ -+ ndp_info.enable = 1; -+ ndp_info.check_remote_ip = 0; -+ ndp_info.num_of_target_ip = 1; -+ -+ _rtw_memcpy(&ndp_info.target_link_addr, adapter_mac_addr(padapter), -+ ETH_ALEN); -+ _rtw_memcpy(&ndp_info.target_ipv6_addr, pmlmeinfo->ip6_addr, -+ RTW_IPv6_ADDR_LEN); -+ -+ _rtw_memcpy(pndp_info, &ndp_info, len); -+} -+#endif /* CONFIG_IPV6 */ -+ -+#ifdef CONFIG_PNO_SUPPORT -+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); -+ set_frame_sub_type(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; -+#ifdef RTW_HALMAC -+ /* Pattern check for 3081 ICs */ -+ _rtw_memset(pPnoInfoPkt, 0xA5A5A5A5, 4); -+ pPnoInfoPkt += 12; -+#else -+ _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; -+#endif -+ _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; -+ -+#ifdef RTW_HALMAC -+ /* SSID is located at 72th byte in NLO info Page for ICs that have HAMMAC */ -+ *pLength += 72; -+ pPnoInfoPkt = pframe + 72; -+#else -+ /* SSID is located at 128th Byte in NLO info Page for ICs that don't have HAMMAC */ -+ *pLength += 128; -+ pPnoInfoPkt = pframe + 128; -+#endif -+ 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; -+ } -+} -+ -+#ifndef RTW_HALMAC -+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 /* !RTW_HALMAC */ -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+#ifdef CONFIG_WAR_OFFLOAD -+#ifdef CONFIG_OFFLOAD_MDNS_V4 -+ -+/* -+ * Description: -+ * Construct the MDNS V4 response packet to support MDNS offload. -+ * -+ */ -+static void rtw_hal_construct_mdns_rsp_v4( -+ 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 ICMPLLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x08, 0x00}; -+ u8 mulicast_ipv4_addr[4] = {0xe0, 0x00, 0x00, 0xfb}; -+ u8 mulicast_mac_addr_for_mdns[6] = {0x01, 0x00, 0x5e, 0x00, 0x00, 0xfb}; -+ u8 *pMdnsRspPkt = pframe; -+ /* for TKIP Cal MIC */ -+ u8 EncryptionHeadOverhead = 0, mdns_offset = 0; -+ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ /* ------------------------------------------------------------------------- */ -+ /* MAC Header. */ -+ /* ------------------------------------------------------------------------- */ -+ SetFrameType(fctrl, WIFI_DATA); -+ /* set_frame_sub_type(fctrl, 0); */ -+ SetToDs(fctrl); -+ //_rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _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, mulicast_mac_addr_for_mdns, ETH_ALEN ); -+ -+ SetSeqNum(pwlanhdr, 0); -+ set_duration(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. */ -+ /* ------------------------------------------------------------------------- */ -+ mdns_offset = *pLength; -+ pMdnsRspPkt = (u8 *)(pframe + mdns_offset); -+ /* LLC header */ -+ _rtw_memcpy(pMdnsRspPkt, ICMPLLCHeader, 8); -+ *pLength += 8; -+ -+ /* IP element */ -+ pMdnsRspPkt += 8; -+ SET_IPHDR_VERSION(pMdnsRspPkt, 0x45); -+ SET_IPHDR_DSCP(pMdnsRspPkt, 0); -+ SET_IPHDR_TOTAL_LEN(pMdnsRspPkt, 0); // filled by fw -+ SET_IPHDR_IDENTIFIER(pMdnsRspPkt, 0); // filled by fw -+ SET_IPHDR_FLAGS(pMdnsRspPkt, 0x40); -+ SET_IPHDR_FRAG_OFFSET(pMdnsRspPkt, 0); -+ SET_IPHDR_TTL(pMdnsRspPkt, 0x40); -+ SET_IPHDR_PROTOCOL(pMdnsRspPkt, 0x11); // ICMP-UDP -+ SET_IPHDR_HDR_CHECKSUM(pMdnsRspPkt, 0); // filled by fw -+ SET_IPHDR_SRC_IP_ADDR(pMdnsRspPkt, pIPAddress); -+ SET_IPHDR_DST_IP_ADDR(pMdnsRspPkt, mulicast_ipv4_addr); // filled by fw -+ -+ *pLength += 20; -+ -+ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) { -+ if (IS_HARDWARE_TYPE_8188E(padapter) || -+ IS_HARDWARE_TYPE_8812(padapter)) { -+ rtw_hal_append_tkip_mic(padapter, pframe, mdns_offset); -+ } -+ *pLength += 8; -+ } -+ -+ /* UDP element */ -+ pMdnsRspPkt += 20; -+ SET_UDP_SRC_PORT(pMdnsRspPkt, 0xe914); // MDNS -+ SET_UDP_DST_PORT(pMdnsRspPkt, 0xe914); // MDNS -+ SET_UDP_LEN(pMdnsRspPkt, 0); // filled by fw -+ SET_UDP_CHECKSUM(pMdnsRspPkt, 0); // filled by fw -+ *pLength += 8; -+ -+ /* MDNS Header */ -+ pMdnsRspPkt += 8; -+ SET_MDNS_HDR_FLAG(pMdnsRspPkt, 0x84); -+ *pLength += 12; -+ -+} -+ -+#endif /* CONFIG_OFFLOAD_MDNS_V4 */ -+ -+#ifdef CONFIG_OFFLOAD_MDNS_V6 -+ -+/* -+ * Description: -+ * Construct the MDNS response V6 packet to support MDNS offload. -+ * -+ */ -+static void rtw_hal_construct_mdns_rsp_v6( -+ 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 ICMPLLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x86, 0xDD}; -+ u8 mulicast_ipv6_addr[16] = {0xff, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfb}; -+ u8 mulicast_mac_addr_for_mdns[6] = {0x33, 0x33, 0x00, 0x00, 0x00, 0xfb}; /* could be revise by fw */ -+ u8 *pMdnsRspPkt = pframe; -+ /* for TKIP Cal MIC */ -+ u8 EncryptionHeadOverhead = 0, mdns_offset = 0; -+ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ -+ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ /* ------------------------------------------------------------------------- */ -+ /* MAC Header. */ -+ /* ------------------------------------------------------------------------- */ -+ SetFrameType(fctrl, WIFI_DATA); -+ /* set_frame_sub_type(fctrl, 0); */ -+ SetToDs(fctrl); -+ //_rtw_memcpy(pwlanhdr->addr1, mulicast_mac_addr_for_mdns, ETH_ALEN); -+ _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); -+ _rtw_memcpy(pwlanhdr->addr3, mulicast_mac_addr_for_mdns, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ set_duration(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; -+ SetPrivacy(fctrl); -+ } -+ -+ /* ------------------------------------------------------------------------- */ -+ /* Frame Body. */ -+ /* ------------------------------------------------------------------------- */ -+ mdns_offset = *pLength; -+ pMdnsRspPkt = (u8 *)(pframe + mdns_offset); -+ /* LLC header */ -+ _rtw_memcpy(pMdnsRspPkt, ICMPLLCHeader, 8); -+ *pLength += 8; -+ -+ /* ICMP element */ -+ pMdnsRspPkt += 8; -+ SET_IPHDRV6_VERSION(pMdnsRspPkt, 0x06); -+ SET_IPHDRV6_PAYLOAD_LENGTH(pMdnsRspPkt, 0); // filled by fw -+ SET_IPHDRV6_NEXT_HEADER(pMdnsRspPkt, 0x3A); -+ SET_IPHDRV6_HOP_LIMIT(pMdnsRspPkt, 0xFF); -+ SET_IPHDRV6_SRC_IP_ADDR(pMdnsRspPkt, pIPAddress); // filled by fw -+ SET_IPHDRV6_DST_IP_ADDR(pMdnsRspPkt, mulicast_ipv6_addr); // filled by fw -+ -+ *pLength += 40; -+ -+ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) { -+ if (IS_HARDWARE_TYPE_8188E(padapter) || -+ IS_HARDWARE_TYPE_8812(padapter)) { -+ rtw_hal_append_tkip_mic(padapter, pframe, mdns_offset); -+ } -+ *pLength += 8; -+ } -+ -+ /* UDP element */ -+ pMdnsRspPkt += 40; -+ SET_UDP_SRC_PORT(pMdnsRspPkt, 0xe914); // SNMP -+ SET_UDP_DST_PORT(pMdnsRspPkt, 0xe914); // SNMP -+ SET_UDP_LEN(pMdnsRspPkt, 0); // filled by fw -+ SET_UDP_CHECKSUM(pMdnsRspPkt, 0); // filled by fw -+ *pLength += 8; -+ -+ /* MDNS Header */ -+ pMdnsRspPkt += 8; -+ SET_MDNS_HDR_FLAG(pMdnsRspPkt, 0x84); -+ *pLength += 12; -+ -+} -+ -+#endif /* CONFIG_OFFLOAD_MDNS_V6 */ -+#endif -+ -+#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; -+ /* 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); -+ /* set_frame_sub_type(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); -+ set_duration(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; -+ -+ /* 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; -+ -+ if (psecuritypriv->dot118021XGrpPrivacy == _TKIP_) -+ *pLength += 8; -+} -+#endif /* CONFIG_GTK_OL */ -+ -+#define PN_2_CCMPH(ch,key_id) ((ch) & 0x000000000000ffff) \ -+ | (((ch) & 0x0000ffffffff0000) << 16) \ -+ | (((key_id) << 30)) \ -+ | BIT(29) -+static void rtw_hal_construct_remote_control_info(_adapter *adapter, -+ u8 *pframe, u32 *pLength) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ struct sta_info *psta; -+ struct stainfo_rxcache *prxcache; -+ u8 cur_dot11rxiv[8], id = 0, tid_id = 0, i = 0; -+ size_t sz = 0, total = 0; -+ u64 ccmp_hdr = 0, tmp_key = 0; -+ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ -+ if (psta == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ prxcache = &psta->sta_recvpriv.rxcache; -+ sz = sizeof(cur_dot11rxiv); -+ -+ /* 3 SEC IV * 1 page */ -+ rtw_get_sec_iv(adapter, cur_dot11rxiv, -+ get_my_bssid(&pmlmeinfo->network)); -+ -+ _rtw_memcpy(pframe, cur_dot11rxiv, sz); -+ *pLength += sz; -+ pframe += sz; -+ -+ _rtw_memset(&cur_dot11rxiv, 0, sz); -+ -+ if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) { -+ id = psecuritypriv->dot118021XGrpKeyid; -+ tid_id = prxcache->last_tid; -+ REMOTE_INFO_CTRL_SET_VALD_EN(cur_dot11rxiv, 0xdd); -+ REMOTE_INFO_CTRL_SET_PTK_EN(cur_dot11rxiv, 1); -+ REMOTE_INFO_CTRL_SET_GTK_EN(cur_dot11rxiv, 1); -+ REMOTE_INFO_CTRL_SET_GTK_IDX(cur_dot11rxiv, id); -+ _rtw_memcpy(pframe, cur_dot11rxiv, sz); -+ *pLength += sz; -+ pframe += sz; -+ -+ _rtw_memcpy(pframe, prxcache->iv[tid_id], sz); -+ *pLength += sz; -+ pframe += sz; -+ -+ total = sizeof(psecuritypriv->iv_seq); -+ total /= sizeof(psecuritypriv->iv_seq[0]); -+ -+ for (i = 0 ; i < total ; i ++) { -+ ccmp_hdr = -+ le64_to_cpu(*(u64*)psecuritypriv->iv_seq[i]); -+ _rtw_memset(&cur_dot11rxiv, 0, sz); -+ if (ccmp_hdr != 0) { -+ tmp_key = i; -+ ccmp_hdr = PN_2_CCMPH(ccmp_hdr, tmp_key); -+ *(u64*)cur_dot11rxiv = cpu_to_le64(ccmp_hdr); -+ _rtw_memcpy(pframe, cur_dot11rxiv, sz); -+ } -+ *pLength += sz; -+ pframe += sz; -+ } -+ } -+} -+ -+static void rtw_hal_gate_bb(_adapter *adapter, bool stop) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ u8 i = 0, val8 = 0, empty = _FAIL; -+ -+ if (stop) { -+ /* checking TX queue status */ -+ for (i = 0 ; i < 5 ; i++) { -+ rtw_hal_get_hwreg(adapter, HW_VAR_CHK_MGQ_CPU_EMPTY, &empty); -+ if (empty) { -+ break; -+ } else { -+ RTW_WARN("%s: MGQ_CPU is busy(%d)!\n", -+ __func__, i); -+ rtw_mdelay_os(10); -+ } -+ } -+ -+ if (val8 == 5) -+ RTW_ERR("%s: Polling MGQ_CPU empty fail!\n", __func__); -+ -+ /* 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 u8 rtw_hal_wow_pattern_generate(_adapter *adapter, u8 idx, struct rtl_wow_pattern *pwow_pattern) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ u8 *pattern; -+ u8 len = 0; -+ u8 *mask; -+ -+ 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 mask_len = 0; -+ u8 mac_addr[ETH_ALEN] = {0}; -+ u16 count = 0; -+ int i; -+ -+ if (pwrctl->wowlan_pattern_idx > MAX_WKFM_CAM_NUM) { -+ RTW_INFO("%s pattern_idx is more than MAX_FMC_NUM: %d\n", -+ __func__, MAX_WKFM_CAM_NUM); -+ return _FAIL; -+ } -+ -+ pattern = pwrctl->patterns[idx].content; -+ len = pwrctl->patterns[idx].len; -+ mask = pwrctl->patterns[idx].mask; -+ -+ _rtw_memcpy(mac_addr, adapter_mac_addr(adapter), ETH_ALEN); -+ _rtw_memset(pwow_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) -+ pwow_pattern->type = PATTERN_BROADCAST; -+ else if (memcmp(pattern, multicast_addr1, 2) == 0) -+ pwow_pattern->type = PATTERN_MULTICAST; -+ else if (memcmp(pattern, multicast_addr2, 3) == 0) -+ pwow_pattern->type = PATTERN_MULTICAST; -+ else if (memcmp(pattern, mac_addr, ETH_ALEN) == 0) -+ pwow_pattern->type = PATTERN_UNICAST; -+ else -+ pwow_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++) { -+ pwow_pattern->mask[i] = mask_hw[i * 4]; -+ pwow_pattern->mask[i] |= (mask_hw[i * 4 + 1] << 8); -+ pwow_pattern->mask[i] |= (mask_hw[i * 4 + 2] << 16); -+ pwow_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++; -+ } -+ } -+ -+ pwow_pattern->crc = rtw_calc_crc(content, count); -+ -+ if (pwow_pattern->crc != 0) { -+ if (pwow_pattern->type == PATTERN_INVALID) -+ pwow_pattern->type = PATTERN_VALID; -+ } -+ -+ return _SUCCESS; -+} -+ -+void rtw_dump_wow_pattern(void *sel, struct rtl_wow_pattern *pwow_pattern, u8 idx) -+{ -+ int j; -+ -+ RTW_PRINT_SEL(sel, "=======WOW CAM-ID[%d]=======\n", idx); -+ RTW_PRINT_SEL(sel, "[WOW CAM] type:%d\n", pwow_pattern->type); -+ RTW_PRINT_SEL(sel, "[WOW CAM] crc:0x%04x\n", pwow_pattern->crc); -+ for (j = 0; j < 4; j++) -+ RTW_PRINT_SEL(sel, "[WOW CAM] Mask:0x%08x\n", pwow_pattern->mask[j]); -+} -+/*bit definition of pattern match format*/ -+#define WOW_VALID_BIT BIT31 -+#ifndef CONFIG_WOW_PATTERN_IN_TXFIFO -+#define WOW_BC_BIT BIT26 -+#define WOW_MC_BIT BIT25 -+#define WOW_UC_BIT BIT24 -+#else -+#define WOW_BC_BIT BIT18 -+#define WOW_UC_BIT BIT17 -+#define WOW_MC_BIT BIT16 -+#endif /*CONFIG_WOW_PATTERN_IN_TXFIFO*/ -+ -+#ifndef CONFIG_WOW_PATTERN_HW_CAM -+#ifndef CONFIG_WOW_PATTERN_IN_TXFIFO -+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))); -+ } -+} -+#endif /* CONFIG_WOW_PATTERN_IN_TXFIFO*/ -+#ifndef CONFIG_WOW_PATTERN_IN_TXFIFO -+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_CAM_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_CAM_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 = WOW_VALID_BIT; -+ else if (context->type == PATTERN_BROADCAST) -+ data = WOW_VALID_BIT | WOW_BC_BIT; -+ else if (context->type == PATTERN_MULTICAST) -+ data = WOW_VALID_BIT | WOW_MC_BIT; -+ else if (context->type == PATTERN_UNICAST) -+ data = WOW_VALID_BIT | WOW_UC_BIT; -+ -+ 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_fill_pattern(_adapter *adapter) -+{ -+ int i = 0, total = 0, index; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct rtl_wow_pattern wow_pattern; -+ -+ total = pwrpriv->wowlan_pattern_idx; -+ -+ if (total > MAX_WKFM_CAM_NUM) -+ total = MAX_WKFM_CAM_NUM; -+ -+ for (i = 0 ; i < total ; i++) { -+ if (_SUCCESS == rtw_hal_wow_pattern_generate(adapter, i, &wow_pattern)) { -+ -+ index = i; -+ if (!pwrpriv->bInSuspend) -+ index += 2; -+ rtw_dump_wow_pattern(RTW_DBGDUMP, &wow_pattern, i); -+ if (rtw_write_to_frame_mask(adapter, index, &wow_pattern) == _FALSE) -+ RTW_INFO("%s: ERROR!! idx: %d write_to_frame_mask_cam fail\n", __func__, i); -+ } -+ -+ } -+ rtw_write8(adapter, REG_WKFMCAM_NUM, total); -+ -+} -+#else /* CONFIG_WOW_PATTERN_IN_TXFIFO */ -+bool rtw_read_from_frame_mask(_adapter *adapter, u8 idx) -+{ -+ u32 data_l = 0, data_h = 0, page_sz = 0; -+ u16 tx_page_start, tx_buf_ptr = 0; -+ u16 cam_start_offset = 0; -+ u16 ctrl_l = 0, ctrl_h = 0; -+ u8 count = 0, tmp = 0, last_entry = 0; -+ int i = 0; -+ bool res = _TRUE; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ u32 buffer[WKFMCAM_ADDR_NUM]; -+ -+ -+ if (idx > MAX_WKFM_CAM_NUM) { -+ RTW_INFO("[Error]: %s, pattern index is out of range\n", -+ __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&page_sz); -+ if (page_sz == 0) { -+ RTW_INFO("[Error]: %s, page_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_BUFFER_LAST_ENTRY, (u8 *)&last_entry); -+ if (last_entry == 0) { -+ RTW_INFO("[Error]: %s, last entry of tx buffer is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ -+ if(_rtw_wow_chk_cap(adapter, WOW_CAP_HALMAC_ACCESS_PATTERN_IN_TXFIFO)) { -+ /* 8723F cannot indirect access tx fifo -+ * rtw_halmac_dump_fifo(dvobj, fifo_sel, fifo_addr, buf_sz, buf) -+ */ -+ #ifdef RTW_HALMAC -+ rtw_halmac_dump_fifo(adapter_to_dvobj(adapter), -+ 2, -+ (pwrctl->pattern_rsvd_page_loc * page_sz) + (idx * WKFMCAM_ADDR_NUM * 4), -+ WKFMCAM_ADDR_NUM*4, (u8*)buffer); -+ #endif -+ -+ for (i = 0; i < (WKFMCAM_ADDR_NUM / 2); i++) { -+ RTW_INFO("[%d]: %08x %08x\n", i, *(buffer + i*2), *(buffer + i*2 + 1)); -+ } -+ } else { -+ /* use the last 2 pages for wow pattern e.g. 0xfe and 0xff */ -+ tx_page_start = last_entry - 1; -+ cam_start_offset = tx_page_start * page_sz / 8; -+ ctrl_l = 0x0; -+ ctrl_h = 0x0; -+ -+ /* Enable TX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, TXPKT_BUF_SELECT); -+ -+ /* Read the WKFM CAM */ -+ for (i = 0; i < (WKFMCAM_ADDR_NUM / 2); i++) { -+ /* -+ * Set Tx packet buffer offset. -+ * TxBufer pointer increases 1, we can access 8 bytes in Tx packet buffer. -+ * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE -+ * TxBufer 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 -+ */ -+ tx_buf_ptr = -+ (cam_start_offset + idx * WKFMCAM_SIZE + i * 8) >> 3; -+ rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, tx_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_read32(adapter, REG_PKTBUF_DBG_CTRL) & BIT23; -+ 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 tx_page_start = 0, page_sz = 0; -+ u16 tx_buf_ptr = 0; -+ u16 cam_start_offset = 0; -+ u32 data_l = 0, data_h = 0; -+ u8 count = 0, tmp = 0, last_entry = 0; -+ int res = 0, i = 0; -+ -+ if (idx > MAX_WKFM_CAM_NUM) { -+ RTW_INFO("[Error]: %s, pattern index is out of range\n", -+ __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&page_sz); -+ if (page_sz == 0) { -+ RTW_INFO("[Error]: %s, page_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_BUFFER_LAST_ENTRY, (u8 *)&last_entry); -+ if (last_entry == 0) { -+ RTW_INFO("[Error]: %s, last entry of tx buffer is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ /* use the last 2 pages for wow pattern e.g. 0xfe and 0xff */ -+ tx_page_start = last_entry - 1; -+ cam_start_offset = tx_page_start * page_sz / 8; -+ -+ /* Write the PATTERN location to BIT_TXBUF_WKCAM_OFFSET */ -+ rtw_write8(adapter, REG_TXBUF_WKCAM_OFFSET, cam_start_offset & 0xFF); -+ rtw_write8(adapter, REG_TXBUF_WKCAM_OFFSET + 1, (cam_start_offset >> 8) & 0xFF); -+ /* Enable TX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, TXPKT_BUF_SELECT); -+ -+ /* Write the WKFM CAM */ -+ for (i = 0; i < WKFMCAM_ADDR_NUM / 2; i++) { -+ /* -+ * Set Tx packet buffer offset. -+ * TxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. -+ * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE -+ * TxBufer 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 -+ */ -+ tx_buf_ptr = cam_start_offset + ((idx * WKFMCAM_SIZE + i * 8) >> 3); -+ -+ if (i == 0) { -+ if (context->type == PATTERN_VALID) -+ data_l = WOW_VALID_BIT; -+ else if (context->type == PATTERN_BROADCAST) -+ data_l = WOW_VALID_BIT | WOW_BC_BIT; -+ else if (context->type == PATTERN_MULTICAST) -+ data_l = WOW_VALID_BIT | WOW_MC_BIT; -+ else if (context->type == PATTERN_UNICAST) -+ data_l = WOW_VALID_BIT | WOW_UC_BIT; -+ -+ if (context->crc != 0) -+ data_l |= context->crc; -+ -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data_l); -+ } else { -+ data_l = context->mask[i * 2 - 2]; -+ data_h = context->mask[i * 2 - 1]; -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data_l); -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data_h); -+ } -+ -+ rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, (tx_buf_ptr & 0x1FFF) | BIT23 | (0xff <<24)); -+ count = 0; -+ do { -+ tmp = rtw_read32(adapter, REG_PKTBUF_DBG_CTRL) & BIT23; -+ rtw_udelay_os(2); -+ count++; -+ } while (tmp && count < 100); -+ -+ if (count >= 100) { -+ res = _FALSE; -+ RTW_INFO("%s write failed\n", __func__); -+ } else { -+ res = _TRUE; -+ RTW_INFO("%s write OK\n", __func__); -+ } -+ } -+ -+ /* Disable TX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, DISABLE_TRXPKT_BUF_ACCESS); -+ return res; -+} -+bool rtw_write_to_frame_mask_buf(_adapter *adapter, u8 idx, -+ struct rtl_wow_pattern *context, char *pattern_info, u32 *ppattern_info_len) -+{ -+ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ u32 page_sz = 0; -+ int res = _FALSE, i = 0; -+ u32 tmp_pattern_buf[6] = {0}; -+ -+ if (pattern_info == NULL) { -+ RTW_ERR("[Error]: %s, pattern info is NULL\n", __func__); -+ } -+ if (idx > MAX_WKFM_CAM_NUM) { -+ RTW_ERR("[Error]: %s, pattern index is out of range\n", -+ __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&page_sz); -+ if (page_sz == 0) { -+ RTW_ERR("[Error]: %s, page_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ /* Fill WKFM */ -+ for (i = 0; i < WKFMCAM_ADDR_NUM / 2; i++) { -+ if (i == 0) { -+ if (context->type == PATTERN_VALID) -+ tmp_pattern_buf[0] = WOW_VALID_BIT; -+ else if (context->type == PATTERN_BROADCAST) -+ tmp_pattern_buf[0] = WOW_VALID_BIT | WOW_BC_BIT; -+ else if (context->type == PATTERN_MULTICAST) -+ tmp_pattern_buf[0] = WOW_VALID_BIT | WOW_MC_BIT; -+ else if (context->type == PATTERN_UNICAST) -+ tmp_pattern_buf[0] = WOW_VALID_BIT | WOW_UC_BIT; -+ -+ if (context->crc != 0) -+ tmp_pattern_buf[0] |= context->crc; -+ /* pattern[1] is reserved in pattern format, dont care. */ -+ -+ } else { -+ tmp_pattern_buf[i * 2] = context->mask[i * 2 - 2]; -+ tmp_pattern_buf[i * 2 + 1] = context->mask[i * 2 - 1]; -+ } -+ } -+ -+ -+ /* put pattern to pattern_buf */ -+ _rtw_memcpy((pattern_info + idx * WKFMCAM_SIZE) , tmp_pattern_buf, WKFMCAM_SIZE); -+ *ppattern_info_len += WKFMCAM_SIZE; -+ #ifdef CONFIG_WOW_PATTERN_IN_TXFIFO_DBG -+ RTW_INFO("\nidx : %u pattern_info_len : %u\n", idx, *ppattern_info_len); -+ RTW_INFO_DUMP("", (pattern_info + idx * WKFMCAM_SIZE), WKFMCAM_SIZE); -+ #endif -+ res = _TRUE; -+ -+ -+ return res; -+} -+#endif /* CONFIG_WOW_PATTERN_IN_TXFIFO */ -+ -+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; -+ /* pattern in tx fifo do not need clear to zero*/ -+ -+ rtw_write8(adapter, REG_WKFMCAM_NUM, 0); -+} -+#if 0 -+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_CAM_NUM) { -+ RTW_INFO("%s pattern_idx is more than MAX_FMC_NUM: %d\n", -+ __func__, MAX_WKFM_CAM_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; -+} -+#endif -+#else /*CONFIG_WOW_PATTERN_HW_CAM*/ -+ -+#define WOW_CAM_ACCESS_TIMEOUT_MS 200 -+static u32 _rtw_wow_pattern_read_cam(_adapter *adapter, u8 addr) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ _mutex *mutex = &pwrpriv->wowlan_pattern_cam_mutex; -+ -+ u32 rdata = 0; -+ u32 cnt = 0; -+ systime start = 0; -+ u8 timeout = 0; -+ u8 rst = _FALSE; -+ -+ _enter_critical_mutex(mutex, NULL); -+ -+ rtw_write32(adapter, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1 | BIT_WKFCAM_ADDR_V2(addr)); -+ -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(adapter)) -+ break; -+ -+ cnt++; -+ if (0 == (rtw_read32(adapter, REG_WKFMCAM_CMD) & BIT_WKFCAM_POLLING_V1)) { -+ rst = _SUCCESS; -+ break; -+ } -+ if (rtw_get_passing_time_ms(start) > WOW_CAM_ACCESS_TIMEOUT_MS) { -+ timeout = 1; -+ break; -+ } -+ } -+ -+ rdata = rtw_read32(adapter, REG_WKFMCAM_RWD); -+ -+ _exit_critical_mutex(mutex, NULL); -+ -+ /*RTW_INFO("%s ==> addr:0x%02x , rdata:0x%08x\n", __func__, addr, rdata);*/ -+ -+ if (timeout) -+ RTW_ERR(FUNC_ADPT_FMT" failed due to polling timeout\n", FUNC_ADPT_ARG(adapter)); -+ -+ return rdata; -+} -+void rtw_wow_pattern_read_cam_ent(_adapter *adapter, u8 id, struct rtl_wow_pattern *context) -+{ -+ int i; -+ u32 rdata; -+ -+ _rtw_memset(context, 0, sizeof(struct rtl_wow_pattern)); -+ -+ for (i = 4; i >= 0; i--) { -+ rdata = _rtw_wow_pattern_read_cam(adapter, (id << 3) | i); -+ -+ switch (i) { -+ case 4: -+ if (rdata & WOW_BC_BIT) -+ context->type = PATTERN_BROADCAST; -+ else if (rdata & WOW_MC_BIT) -+ context->type = PATTERN_MULTICAST; -+ else if (rdata & WOW_UC_BIT) -+ context->type = PATTERN_UNICAST; -+ else -+ context->type = PATTERN_INVALID; -+ -+ context->crc = rdata & 0xFFFF; -+ break; -+ default: -+ _rtw_memcpy(&context->mask[i], (u8 *)(&rdata), 4); -+ break; -+ } -+ } -+} -+ -+static void _rtw_wow_pattern_write_cam(_adapter *adapter, u8 addr, u32 wdata) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ _mutex *mutex = &pwrpriv->wowlan_pattern_cam_mutex; -+ u32 cnt = 0; -+ systime start = 0, end = 0; -+ u8 timeout = 0; -+ -+ /*RTW_INFO("%s ==> addr:0x%02x , wdata:0x%08x\n", __func__, addr, wdata);*/ -+ _enter_critical_mutex(mutex, NULL); -+ -+ rtw_write32(adapter, REG_WKFMCAM_RWD, wdata); -+ rtw_write32(adapter, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1 | BIT_WKFCAM_WE | BIT_WKFCAM_ADDR_V2(addr)); -+ -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(adapter)) -+ break; -+ -+ cnt++; -+ if (0 == (rtw_read32(adapter, REG_WKFMCAM_CMD) & BIT_WKFCAM_POLLING_V1)) -+ break; -+ -+ if (rtw_get_passing_time_ms(start) > WOW_CAM_ACCESS_TIMEOUT_MS) { -+ timeout = 1; -+ break; -+ } -+ } -+ end = rtw_get_current_time(); -+ -+ _exit_critical_mutex(mutex, NULL); -+ -+ if (timeout) { -+ RTW_ERR(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_wow_pattern_write_cam_ent(_adapter *adapter, u8 id, struct rtl_wow_pattern *context) -+{ -+ int j; -+ u8 addr; -+ u32 wdata = 0; -+ -+ for (j = 4; j >= 0; j--) { -+ switch (j) { -+ case 4: -+ wdata = context->crc; -+ -+ if (PATTERN_BROADCAST == context->type) -+ wdata |= WOW_BC_BIT; -+ if (PATTERN_MULTICAST == context->type) -+ wdata |= WOW_MC_BIT; -+ if (PATTERN_UNICAST == context->type) -+ wdata |= WOW_UC_BIT; -+ if (PATTERN_INVALID != context->type) -+ wdata |= WOW_VALID_BIT; -+ break; -+ default: -+ wdata = context->mask[j]; -+ break; -+ } -+ -+ addr = (id << 3) + j; -+ -+ _rtw_wow_pattern_write_cam(adapter, addr, wdata); -+ } -+} -+ -+static u8 _rtw_wow_pattern_clean_cam(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ _mutex *mutex = &pwrpriv->wowlan_pattern_cam_mutex; -+ u32 cnt = 0; -+ systime start = 0; -+ u8 timeout = 0; -+ u8 rst = _FAIL; -+ -+ _enter_critical_mutex(mutex, NULL); -+ rtw_write32(adapter, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1 | BIT_WKFCAM_CLR_V1); -+ -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(adapter)) -+ break; -+ -+ cnt++; -+ if (0 == (rtw_read32(adapter, REG_WKFMCAM_CMD) & BIT_WKFCAM_POLLING_V1)) { -+ rst = _SUCCESS; -+ break; -+ } -+ if (rtw_get_passing_time_ms(start) > WOW_CAM_ACCESS_TIMEOUT_MS) { -+ timeout = 1; -+ break; -+ } -+ } -+ _exit_critical_mutex(mutex, NULL); -+ -+ if (timeout) -+ RTW_ERR(FUNC_ADPT_FMT" falied ,polling timeout\n", FUNC_ADPT_ARG(adapter)); -+ -+ return rst; -+} -+ -+void rtw_clean_pattern(_adapter *adapter) -+{ -+ if (_FAIL == _rtw_wow_pattern_clean_cam(adapter)) -+ RTW_ERR("rtw_clean_pattern failed\n"); -+} -+void rtw_fill_pattern(_adapter *adapter) -+{ -+ int i = 0, total = 0; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct rtl_wow_pattern wow_pattern; -+ -+ total = pwrpriv->wowlan_pattern_idx; -+ -+ if (total > MAX_WKFM_CAM_NUM) -+ total = MAX_WKFM_CAM_NUM; -+ -+ for (i = 0 ; i < total ; i++) { -+ if (_SUCCESS == rtw_hal_wow_pattern_generate(adapter, i, &wow_pattern)) { -+ rtw_dump_wow_pattern(RTW_DBGDUMP, &wow_pattern, i); -+ rtw_wow_pattern_write_cam_ent(adapter, i, &wow_pattern); -+ } -+ } -+} -+ -+#endif -+void rtw_wow_pattern_cam_dump(_adapter *adapter) -+{ -+ -+#ifndef CONFIG_WOW_PATTERN_HW_CAM -+ int i = 0, total = 0; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ total = pwrpriv->wowlan_pattern_idx; -+ -+ if (total > MAX_WKFM_CAM_NUM) -+ total = MAX_WKFM_CAM_NUM; -+ -+ for (i = 0 ; i < total; i++) { -+ RTW_INFO("=======[%d]=======\n", i); -+ rtw_read_from_frame_mask(adapter, i); -+ } -+#else -+ struct rtl_wow_pattern context; -+ int i; -+ -+ for (i = 0 ; i < MAX_WKFM_CAM_NUM; i++) { -+ rtw_wow_pattern_read_cam_ent(adapter, i, &context); -+ rtw_dump_wow_pattern(RTW_DBGDUMP, &context, i); -+ } -+ -+#endif -+} -+ -+ -+static void rtw_hal_dl_pattern(_adapter *adapter, u8 mode) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ -+ switch (mode) { -+ case 0: -+ rtw_clean_pattern(adapter); -+ RTW_INFO("%s: total patterns: %d\n", __func__, pwrpriv->wowlan_pattern_idx); -+ break; -+ case 1: -+ #if defined(CONFIG_WOW_PATTERN_IN_TXFIFO) -+ RTW_INFO("%s Patterns have been downloaded in rsvd pages\n", __func__); -+ #else -+ rtw_set_default_pattern(adapter); -+ rtw_fill_pattern(adapter); -+ RTW_INFO("%s: pattern total: %d downloaded\n", __func__, pwrpriv->wowlan_pattern_idx); -+ #endif -+ break; -+ case 2: -+ rtw_clean_pattern(adapter); -+ rtw_wow_pattern_sw_reset(adapter); -+ 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 registry_priv *registry_par = &adapter->registrypriv; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ int res; -+ u16 media_status_rpt; -+ u8 no_wake = 0, i; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+#ifdef CONFIG_GPIO_WAKEUP -+ u8 val8 = 0; -+#endif -+ -+#ifdef CONFIG_LPS_PG -+ u8 lps_pg_hdl_id = 0; -+#endif -+ -+ -+ -+ if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && -+ !check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) -+ no_wake = 1; -+ -+ RTW_PRINT(FUNC_ADPT_FMT " WOWLAN_ENABLE\n", FUNC_ADPT_ARG(adapter)); -+ rtw_hal_gate_bb(adapter, _TRUE); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ /* Start Usb TxDMA */ -+ if(iface) { -+ RTW_INFO(ADPT_FMT "enable TX\n", ADPT_ARG(iface)); -+ RTW_ENABLE_FUNC(iface, DF_TX_BIT); -+ } -+ } -+ -+#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); -+ -+ rtw_hal_fw_dl(adapter, _TRUE); -+ if(no_wake) -+ media_status_rpt = RT_MEDIA_DISCONNECT; -+ else -+ media_status_rpt = RT_MEDIA_CONNECT; -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, -+ (u8 *)&media_status_rpt); -+ -+ /* RX DMA stop */ -+ #if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(adapter)) -+ rtw_hal_disable_tx_report(adapter); -+ #endif -+ -+ res = rtw_hal_pause_rx_dma(adapter); -+ if (res == _FAIL) -+ RTW_PRINT("[WARNING] pause RX DMA fail\n"); -+ -+ #ifndef CONFIG_WOW_PATTERN_HW_CAM -+ /* Reconfig RX_FF Boundary */ -+ #ifndef CONFIG_WOW_PATTERN_IN_TXFIFO -+ rtw_hal_set_wow_rxff_boundary(adapter, _TRUE); -+ #endif /*CONFIG_WOW_PATTERN_IN_TXFIFO*/ -+ #endif -+ -+ /* redownload wow pattern */ -+ if(!no_wake) -+ rtw_hal_dl_pattern(adapter, 1); -+ -+ if (!pwrctl->wowlan_pno_enable) { -+ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); -+ -+ if (psta != NULL) { -+ #ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ adapter_to_dvobj(adapter)->dft.port_id = 0xFF; -+ adapter_to_dvobj(adapter)->dft.mac_id = 0xFF; -+ rtw_hal_set_default_port_id_cmd(adapter, psta->cmn.mac_id); -+ #endif -+ if(!no_wake) -+ rtw_sta_media_status_rpt(adapter, psta, 1); -+ } -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ else { -+ if(registry_par->suspend_type == FW_IPS_WRC) { -+ adapter_to_dvobj(adapter)->dft.port_id = 0xFF; -+ adapter_to_dvobj(adapter)->dft.mac_id = 0xFF; -+ rtw_hal_set_default_port_id_cmd(adapter, 0); -+ } -+ } -+#endif /* CONFIG_FW_MULTI_PORT_SUPPORT */ -+ } -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ else { -+ rtw_hal_set_default_port_id_cmd(adapter, 0); -+ } -+#endif /* CONFIG_FW_MULTI_PORT_SUPPORT */ -+ -+#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 -+#ifdef CONFIG_RTW_ONE_PIN_GPIO -+ rtw_hal_switch_gpio_wl_ctrl(adapter, pwrctl->wowlan_gpio_index, _TRUE); -+ rtw_hal_set_input_gpio(adapter, pwrctl->wowlan_gpio_index); -+#else -+#ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE -+ if (pwrctl->is_high_active == 0) -+ rtw_hal_set_input_gpio(adapter, pwrctl->wowlan_gpio_index); -+ else -+ rtw_hal_set_output_gpio(adapter, pwrctl->wowlan_gpio_index, -+ GPIO_OUTPUT_LOW); -+#else -+ val8 = (pwrctl->is_high_active == 0) ? 1 : 0; -+ rtw_hal_set_output_gpio(adapter, pwrctl->wowlan_gpio_index, val8); -+ rtw_hal_switch_gpio_wl_ctrl(adapter, pwrctl->wowlan_gpio_index, _TRUE); -+ RTW_INFO("%s: set GPIO_%d to OUTPUT %s state in wow suspend and %s_ACTIVE.\n", -+ __func__, pwrctl->wowlan_gpio_index, -+ pwrctl->wowlan_gpio_output_state ? "HIGH" : "LOW", -+ pwrctl->is_high_active ? "HIGI" : "LOW"); -+#endif /* CONFIG_WAKEUP_GPIO_INPUT_MODE */ -+#endif /* CONFIG_RTW_ONE_PIN_GPIO */ -+#endif /* CONFIG_GPIO_WAKEUP */ -+ /* 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); -+ -+#if defined(RTW_HALMAC) && defined(CONFIG_PNO_SUPPORT) -+ if(pwrctl->wowlan_pno_enable) -+ rtw_halmac_pno_scanoffload(adapter->dvobj, 1); -+#endif -+ -+#ifdef CONFIG_GTK_OL_DBG -+ dump_sec_cam(RTW_DBGDUMP, adapter); -+ dump_sec_cam_cache(RTW_DBGDUMP, adapter); -+#endif -+ -+#ifdef CONFIG_LPS_PG -+ if (pwrctl->lps_level == LPS_PG) { -+ lps_pg_hdl_id = LPS_PG_INFO_CFG; -+ rtw_hal_set_hwreg(adapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); -+ } -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ /* free adapter's resource */ -+ rtw_mi_intf_stop(adapter); -+ -+#endif -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+ /* Invoid SE0 reset signal during suspending*/ -+ rtw_write8(adapter, REG_RSV_CTRL, 0x20); -+ if (IS_8188F(pHalData->version_id) == FALSE -+ && IS_8188GTV(pHalData->version_id) == FALSE) -+ rtw_write8(adapter, REG_RSV_CTRL, 0x60); -+#endif -+ -+ rtw_hal_gate_bb(adapter, _FALSE); -+} -+ -+#define DBG_WAKEUP_REASON -+#ifdef DBG_WAKEUP_REASON -+void _dbg_wake_up_reason_string(_adapter *adapter, const char *srt_res) -+{ -+ RTW_INFO(ADPT_FMT "- wake up reason - %s\n", ADPT_ARG(adapter), srt_res); -+} -+void _dbg_rtw_wake_up_reason(_adapter *adapter, u8 reason) -+{ -+ if (RX_PAIRWISEKEY == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx pairwise key"); -+ else if (RX_GTK == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx GTK"); -+ else if (RX_FOURWAY_HANDSHAKE == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx four way handshake"); -+ else if (RX_DISASSOC == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx disassoc"); -+ else if (RX_DEAUTH == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx deauth"); -+ else if (RX_ARP_REQUEST == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx ARP request"); -+ else if (FW_DECISION_DISCONNECT == reason) -+ _dbg_wake_up_reason_string(adapter, "FW detect disconnect"); -+ else if (RX_MAGIC_PKT == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx magic packet"); -+ else if (RX_UNICAST_PKT == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx unicast packet"); -+ else if (RX_PATTERN_PKT == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx pattern packet"); -+ else if (RX_PNO == reason) -+ _dbg_wake_up_reason_string(adapter, "RX PNO"); -+ else if (RTD3_SSID_MATCH == reason) -+ _dbg_wake_up_reason_string(adapter, "RTD3 SSID match"); -+ else if (RX_REALWOW_V2_WAKEUP_PKT == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx real WOW V2 wakeup packet"); -+ else if (RX_REALWOW_V2_ACK_LOST == reason) -+ _dbg_wake_up_reason_string(adapter, "Rx real WOW V2 ack lost"); -+ else if (ENABLE_FAIL_DMA_IDLE == reason) -+ _dbg_wake_up_reason_string(adapter, "enable fail DMA idle"); -+ else if (ENABLE_FAIL_DMA_PAUSE == reason) -+ _dbg_wake_up_reason_string(adapter, "enable fail DMA pause"); -+ else if (AP_OFFLOAD_WAKEUP == reason) -+ _dbg_wake_up_reason_string(adapter, "AP offload wakeup"); -+ else if (CLK_32K_UNLOCK == reason) -+ _dbg_wake_up_reason_string(adapter, "clk 32k unlock"); -+ else if (RTIME_FAIL_DMA_IDLE == reason) -+ _dbg_wake_up_reason_string(adapter, "RTIME fail DMA idle"); -+ else if (CLK_32K_LOCK == reason) -+ _dbg_wake_up_reason_string(adapter, "clk 32k lock"); -+ #ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ else if (WOW_KEEPALIVE_ACK_TIMEOUT == reason) -+ _dbg_wake_up_reason_string(adapter, "rx keep alive ack timeout"); -+ else if (WOW_KEEPALIVE_WAKE == reason) -+ _dbg_wake_up_reason_string(adapter, "rx keep alive wake pattern"); -+ #endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ else -+ _dbg_wake_up_reason_string(adapter, "unknown reasoen"); -+} -+#endif -+ -+static void rtw_hal_wow_disable(_adapter *adapter) -+{ -+ int i; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ struct registry_priv *registry_par = &adapter->registrypriv; -+ int res; -+ u16 media_status_rpt; -+ -+ RTW_PRINT("%s, WOWLAN_DISABLE\n", __func__); -+ -+ if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && !check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) { -+ RTW_INFO("FW_IPS_DISABLE_BBRF resume\n"); -+ return; -+ } -+ -+ 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 defined(RTW_HALMAC) && defined(CONFIG_PNO_SUPPORT) -+ else { -+ rtw_halmac_pno_scanoffload(adapter->dvobj, 0); -+ } -+#endif -+ -+ if (0) { -+ RTW_INFO("0x630:0x%02x\n", rtw_read8(adapter, 0x630)); -+ RTW_INFO("0x631:0x%02x\n", rtw_read8(adapter, 0x631)); -+ RTW_INFO("0x634:0x%02x\n", rtw_read8(adapter, 0x634)); -+ RTW_INFO("0x1c7:0x%02x\n", rtw_read8(adapter, 0x1c7)); -+ } -+ -+ pwrctl->wowlan_wake_reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); -+ -+ RTW_PRINT("wakeup_reason: 0x%02x\n", -+ pwrctl->wowlan_wake_reason); -+ #ifdef DBG_WAKEUP_REASON -+ _dbg_rtw_wake_up_reason(adapter, pwrctl->wowlan_wake_reason); -+ #endif -+ -+ rtw_hal_set_fw_wow_related_cmd(adapter, 0); -+ -+ res = rtw_hal_check_wow_ctrl(adapter, _FALSE); -+ -+ #if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(adapter)) -+ rtw_hal_enable_tx_report(adapter); -+ #endif -+ -+ if ((pwrctl->wowlan_wake_reason != RX_DISASSOC) && -+ (pwrctl->wowlan_wake_reason != RX_DEAUTH) && -+ (pwrctl->wowlan_wake_reason != FW_DECISION_DISCONNECT) && -+ (pwrctl->wowlan_wake_reason != NO_WAKE_RX_PAIRWISEKEY) && -+ (pwrctl->wowlan_wake_reason != NO_WAKE_RX_GTK) && -+ (pwrctl->wowlan_wake_reason != NO_WAKE_RX_DISASSOC) && -+ (pwrctl->wowlan_wake_reason != NO_WAKE_RX_DEAUTH) && -+ (pwrctl->wowlan_wake_reason != NO_WAKE_RX_EAPREQ_IDENTIFY)) { -+ rtw_hal_get_aoac_rpt(adapter); -+ rtw_hal_update_sw_security_info(adapter); -+ } -+ -+ 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); -+ -+ #ifndef CONFIG_WOW_PATTERN_HW_CAM -+ /* config RXFF boundary to original */ -+ #ifndef CONFIG_WOW_PATTERN_IN_TXFIFO -+ rtw_hal_set_wow_rxff_boundary(adapter, _FALSE); -+ #endif /*CONFIG_WOW_PATTERN_IN_TXFIFO*/ -+ #endif -+ rtw_hal_release_rx_dma(adapter); -+ -+ rtw_hal_fw_dl(adapter, _FALSE); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ -+#ifdef CONFIG_RTW_ONE_PIN_GPIO -+ rtw_hal_set_input_gpio(adapter, pwrctl->wowlan_gpio_index); -+#else -+#ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE -+ if (pwrctl->is_high_active == 0) -+ rtw_hal_set_input_gpio(adapter, pwrctl->wowlan_gpio_index); -+ else -+ rtw_hal_set_output_gpio(adapter, pwrctl->wowlan_gpio_index, -+ GPIO_OUTPUT_LOW); -+#else -+ rtw_hal_set_output_gpio(adapter, pwrctl->wowlan_gpio_index -+ , pwrctl->wowlan_gpio_output_state); -+ RTW_INFO("%s: set GPIO_%d to OUTPUT %s state in wow resume and %s_ACTIVE.\n", -+ __func__, pwrctl->wowlan_gpio_index, -+ pwrctl->wowlan_gpio_output_state ? "HIGH" : "LOW", -+ pwrctl->is_high_active ? "HIGI" : "LOW"); -+#endif /* CONFIG_WAKEUP_GPIO_INPUT_MODE */ -+#endif /* CONFIG_RTW_ONE_PIN_GPIO */ -+#endif /* CONFIG_GPIO_WAKEUP */ -+ 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) { -+ #ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ adapter_to_dvobj(adapter)->dft.port_id = 0xFF; -+ adapter_to_dvobj(adapter)->dft.mac_id = 0xFF; -+ rtw_hal_set_default_port_id_cmd(adapter, psta->cmn.mac_id); -+ #endif -+ rtw_sta_media_status_rpt(adapter, psta, 1); -+ } -+ } -+ -+ if (psta != NULL) { -+ RTW_PRINT("rtw_set_bit RTW_RECV_REORDER_WOW\n"); -+ for (i = 0; i < TID_NUM; i++) { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ rtw_set_bit(RTW_RECV_REORDER_WOW, -+ &preorder_ctrl->rec_abba_rsp_ack); -+ } -+ } -+ -+ rtw_hal_gate_bb(adapter, _FALSE); -+} -+#if defined(CONFIG_WOW_PATTERN_IN_TXFIFO) -+static void rtw_hal_construct_pattern_info( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength -+) -+{ -+ -+ u32 pattern_info_len = 0; -+ int i = 0, total = 0, index; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct rtl_wow_pattern wow_pattern; -+ u32 page_sz = 0; -+ -+ total = pwrpriv->wowlan_pattern_idx; -+ -+ if (total > MAX_WKFM_CAM_NUM) -+ total = MAX_WKFM_CAM_NUM; -+ -+ /* Generate default pattern */ -+ rtw_set_default_pattern(padapter); -+ -+ /* Convert pattern to WKFM_CAM pattern */ -+ for (i = 0 ; i < total ; i++) { -+ if (_SUCCESS == rtw_hal_wow_pattern_generate(padapter, i, &wow_pattern)) { -+ -+ index = i; -+ if (!pwrpriv->bInSuspend) -+ index += 2; -+ #ifdef CONFIG_WOW_PATTERN_IN_TXFIFO_DBG -+ rtw_dump_wow_pattern(RTW_DBGDUMP, &wow_pattern, i); -+ #endif -+ -+ if (rtw_write_to_frame_mask_buf(padapter, index, &wow_pattern, -+ pframe, &pattern_info_len) == _FALSE) -+ RTW_INFO("%s: ERROR!! idx: %d write_to_frame_mask_cam fail\n", __func__, i); -+ } -+ } -+ *pLength = pattern_info_len; -+ -+ -+} -+#endif /* CONFIG_WOW_PATTERN_IN_TXFIFO */ -+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 ProbeReqLength = 0, ns_len = 0, rc_len = 0; -+ u8 CurtPktPageNum = 0; -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ u32 keep_alive_len=0; -+ int i; -+#endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN */ -+#ifdef CONFIG_WAR_OFFLOAD -+ u16 tmp_idx = 0; -+ u32 buf_len = 0; -+#endif -+ -+#ifdef CONFIG_GTK_OL -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta; -+ struct security_priv *psecpriv = &adapter->securitypriv; -+ 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 */ -+#ifdef CONFIG_WOW_PATTERN_IN_TXFIFO -+ u32 PatternLen = 0; -+ u32 cam_start_offset = 0; -+ u32 reg_cam_start_offset_val = 0; -+#endif /* CONFIG_WOW_PATTERN_IN_TXFIFO */ -+ -+ pmlmeext = &adapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ if (pwrctl->wowlan_pno_enable == _FALSE) { -+ /* ARP RSP * 1 page */ -+ -+ rsvd_page_loc->LocArpRsp = *page_num; -+ -+ RTW_INFO("LocArpRsp: %d\n", rsvd_page_loc->LocArpRsp); -+ -+#ifdef CONFIG_WAR_OFFLOAD -+ if ((0 != pwrctl->wowlan_war_offload_ipv4.ip_addr[0]) && -+ (_FALSE == _rtw_memcmp(&pwrctl->wowlan_war_offload_ipv4.ip_addr[0], pmlmeinfo->ip_addr, 4))) { -+ _rtw_memcpy(pmlmeinfo->ip_addr, &pwrctl->wowlan_war_offload_ipv4.ip_addr[0], 4); -+ RTW_INFO("Update IP(%d.%d.%d.%d) to arp rsvd page\n", -+ pmlmeinfo->ip_addr[0], pmlmeinfo->ip_addr[1], -+ pmlmeinfo->ip_addr[2], pmlmeinfo->ip_addr[3]); -+ } -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+ -+ rtw_hal_construct_ARPRsp(adapter, &pframe[index], -+ &ARPLength, pmlmeinfo->ip_addr); -+ -+ 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); -+ RSVD_PAGE_CFG("WOW-ARPRsp", CurtPktPageNum, *page_num, 0); -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ /* Keep Alive * ? page*/ -+ if(pwrctl->keep_alive_pattern_len){ -+ rsvd_page_loc->LocKeepAlive = *page_num; -+ pwrctl->keep_alive_pattern_loc = rsvd_page_loc->LocKeepAlive; -+ RTW_INFO("pwrctl->keep_alive_pattern_loc: %d\n", pwrctl->keep_alive_pattern_loc); -+ rtw_hal_construct_keepalive(adapter,&pframe[index],&keep_alive_len); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &pframe[index - tx_desc], -+ keep_alive_len, _FALSE, _FALSE, _TRUE); -+ CurtPktPageNum = (u8)PageNum(tx_desc + keep_alive_len, page_size); -+ *page_num += CurtPktPageNum; -+ index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("WOW-KeepAlive:", CurtPktPageNum, *page_num, 0); -+ } -+#endif /* CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ -+#ifdef CONFIG_IPV6 -+ /* 2 NS offload and NDP Info*/ -+ if (pwrctl->wowlan_ns_offload_en == _TRUE) { -+ rsvd_page_loc->LocNbrAdv = *page_num; -+ RTW_INFO("LocNbrAdv: %d\n", rsvd_page_loc->LocNbrAdv); -+ rtw_hal_construct_na_message(adapter, -+ &pframe[index], &ns_len); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &pframe[index - tx_desc], -+ ns_len, _FALSE, -+ _FALSE, _TRUE); -+ CurtPktPageNum = (u8)PageNum(tx_desc + ns_len, -+ page_size); -+ *page_num += CurtPktPageNum; -+ index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("WOW-NbrAdv", CurtPktPageNum, *page_num, 0); -+ -+ rsvd_page_loc->LocNDPInfo = *page_num; -+ RTW_INFO("LocNDPInfo: %d\n", -+ rsvd_page_loc->LocNDPInfo); -+ -+ rtw_hal_construct_ndp_info(adapter, -+ &pframe[index - tx_desc], -+ &ns_len); -+ CurtPktPageNum = -+ (u8)PageNum(tx_desc + ns_len, page_size); -+ *page_num += CurtPktPageNum; -+ index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("WOW-NDPInfo", CurtPktPageNum, *page_num, 0); -+ -+ } -+#endif /*CONFIG_IPV6*/ -+ /* 3 Remote Control Info. * 1 page */ -+ rsvd_page_loc->LocRemoteCtrlInfo = *page_num; -+ RTW_INFO("LocRemoteCtrlInfo: %d\n", rsvd_page_loc->LocRemoteCtrlInfo); -+ rtw_hal_construct_remote_control_info(adapter, -+ &pframe[index - tx_desc], -+ &rc_len); -+ CurtPktPageNum = (u8)PageNum(rc_len, page_size); -+ *page_num += CurtPktPageNum; -+ *total_pkt_len = index + rc_len; -+ RSVD_PAGE_CFG("WOW-RCI", CurtPktPageNum, *page_num, *total_pkt_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; -+ RTW_INFO("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); -+ 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 -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("WOW-GTKInfo", CurtPktPageNum, *page_num, 0); -+ -+ /* 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 < GTKLength + 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 + GTKLength)); -+#endif -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + GTKLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("WOW-GTKRsp", CurtPktPageNum, *page_num, 0); -+ -+ /* below page is empty for GTK extension memory */ -+ /* 3(11) GTK EXT MEM */ -+ rsvd_page_loc->LocGTKEXTMEM = *page_num; -+ RTW_INFO("LocGTKEXTMEM: %d\n", rsvd_page_loc->LocGTKEXTMEM); -+ CurtPktPageNum = 2; -+ -+ if (page_size >= 256) -+ CurtPktPageNum = 1; -+ -+ *page_num += CurtPktPageNum; -+ /* extension memory for FW */ -+ *total_pkt_len = index + (page_size * CurtPktPageNum); -+ RSVD_PAGE_CFG("WOW-GTKEXTMEM", CurtPktPageNum, *page_num, *total_pkt_len); -+#endif /* CONFIG_GTK_OL */ -+ -+ index += (CurtPktPageNum * page_size); -+ -+#ifdef CONFIG_WAR_OFFLOAD -+ if(_TRUE == pwrctl->wowlan_war_offload_mode) { -+ u8 zero_ary[16] = {0x00}; -+ u8 war_tmp_cnt = 0; -+ -+ /* Reserve 2 page for Ip parameters */ -+ /* First page -+ | Byte 15 -----------Byte 0 | -+ | IP-4 | IP-3 | IP-2 | IP-1 | -+ | location of each feature | mac addr | -+ | NetBIOS name | -+ | location of each feature | -+ Second page -+ | IPv6 - 1 | -+ | IPv6 - 2 | -+ | IPv6 - 3 | -+ | IPv6 - 4 | -+ | IPv6 - 5 | -+ | IPv6 - 6 | -+ | IPv6 - 7 | -+ | IPv6 - 8 | -+ */ -+ -+ /* location of each feature : Byte 22 ~ Byte 31 -+ * Byte22 : location of SNMP RX -+ * Byte23 : location of SNMP V4 -+ * Byte24 : location of SNMP V6 -+ * Byte25 : location of MDNS Param -+ * Byte26 : location of MDNS V4 -+ * Byte27 : location of MDNS V6 -+ * Byte28 : location of SSDP pattern -+ * Byte29 : location of WSD pattern -+ * Byte30 : location of SLP pattern -+ * Byte31 : location of LLMNR -+ */ -+ -+ /* ipv4 : 4 */ -+ if (0 == pwrctl->wowlan_war_offload_ipv4.ip_addr[0]) -+ _rtw_memcpy(&pwrctl->wowlan_war_offload_ipv4.ip_addr[0], pmlmeinfo->ip_addr, 4); -+ for(war_tmp_cnt=0; war_tmp_cnt<4 ;war_tmp_cnt++) -+ _rtw_memcpy(pframe + index - tx_desc + (war_tmp_cnt*4), &pwrctl->wowlan_war_offload_ipv4.ip_addr[war_tmp_cnt], 4); -+ -+ if (is_zero_mac_addr(pwrctl->wowlan_war_offload_mac)) { -+ _rtw_memcpy(pwrctl->wowlan_war_offload_mac, adapter_mac_addr(adapter), 6); -+ } -+ _rtw_memcpy(pframe + index + 16 - tx_desc, pwrctl->wowlan_war_offload_mac, 6); -+ -+ -+ /* ipv6 : 8 */ -+ if (_TRUE == _rtw_memcmp(pwrctl->wowlan_war_offload_ipv6.ipv6_addr[0], zero_ary, RTW_IPv6_ADDR_LEN)) -+ _rtw_memcpy(pwrctl->wowlan_war_offload_ipv6.ipv6_addr[0], pmlmeinfo->ip6_addr, RTW_IPv6_ADDR_LEN); -+ -+ for(war_tmp_cnt=0; war_tmp_cnt<8 ;war_tmp_cnt++) -+ _rtw_memcpy(pframe + index + page_size - tx_desc + (war_tmp_cnt*16), pwrctl->wowlan_war_offload_ipv6.ipv6_addr[war_tmp_cnt], 16); -+ -+ rsvd_page_loc->LocIpParm = *page_num; -+ -+ tmp_idx = index; -+ CurtPktPageNum = 2; -+ *page_num += CurtPktPageNum; -+ *total_pkt_len = index + (page_size * CurtPktPageNum); -+ index += (CurtPktPageNum * page_size); -+ -+ -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+ if ( (WAR_MDNS_V4_RSP_EN & pwrctl->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V6_RSP_EN & pwrctl->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V4_WAKEUP_EN & pwrctl->wowlan_war_offload_ctrl) || -+ (WAR_MDNS_V6_WAKEUP_EN & pwrctl->wowlan_war_offload_ctrl)) { -+ -+ struct war_mdns_service_info *psinfo = pwrctl->wowlan_war_offload_mdns_service; -+ u8 txt_in_ptr[31]={ 0xc0, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0x00, 0x13, 0x09, 0x74, 0x78, 0x74, 0x76, 0x65, 0x72, 0x73, -+ 0x3d, 0x31, 0x08, 0x71, 0x74, 0x6f, 0x74, 0x61, 0x6c, 0x3d, 0x31}; -+ u16 mdns_offset = index - tx_desc; -+ u8 i = 0; -+ -+ rsvd_page_loc->LocMdnsPara = *page_num; -+ RTW_INFO("LocMdnsPara : %d\n", rsvd_page_loc->LocMdnsPara); -+ -+ /* 1. service info */ -+ pframe[mdns_offset] = 0x01; // TLV(T) -+ mdns_offset += 1; -+ _rtw_memcpy(pframe + mdns_offset, &pwrctl->wowlan_war_offload_mdns_service_info_num, 1); -+ mdns_offset += 1; -+ -+ for(i=0; iwowlan_war_offload_mdns_service_info_num ;i++) -+ { -+ u16 srv_rsp_len = 0; -+ -+ // 1.1 : construct service name string -+ // : length of total service name string (service+transport+domain) -+ pframe[mdns_offset] = psinfo[i].service_len + psinfo[i].transport_len + psinfo[i].domain_len + 4; -+ mdns_offset += 1; -+ -+ // : service name -+ pframe[mdns_offset] = psinfo[i].service_len; -+ mdns_offset += 1; -+ _rtw_memcpy(pframe + mdns_offset, &psinfo[i].service, psinfo[i].service_len); -+ mdns_offset += psinfo[i].service_len; -+ -+ // : transport name -+ pframe[mdns_offset] = psinfo[i].transport_len; -+ mdns_offset += 1; -+ _rtw_memcpy(pframe + mdns_offset, &psinfo[i].transport, psinfo[i].transport_len); -+ mdns_offset += psinfo[i].transport_len; -+ -+ // : domain name -+ pframe[mdns_offset] = psinfo[i].domain_len; -+ mdns_offset += 1; -+ _rtw_memcpy(pframe + mdns_offset, &psinfo[i].domain, psinfo[i].domain_len); -+ mdns_offset += psinfo[i].domain_len; -+ -+ // : delimiter -+ mdns_offset += 1; -+ -+ // 1.2 : construct type srv rsp -+ pframe[mdns_offset] = psinfo[i].target_len + 19; // length -+ pframe[mdns_offset + 2] = 0x21; // rsp type (srv) -+ pframe[mdns_offset + 4] = 0x01; // cache flush + class -+ _rtw_memcpy(pframe + mdns_offset + 5, &psinfo[i].ttl, 4); // ttl -+ pframe[mdns_offset + 5] = (u8) ( (psinfo[i].ttl & 0xff000000) >> 24); // ttl - byte0 -+ pframe[mdns_offset + 6] = (u8) ( (psinfo[i].ttl & 0x00ff0000) >> 16); // ttl - byte1 -+ pframe[mdns_offset + 7] = (u8) ( (psinfo[i].ttl & 0x0000ff00) >> 8 ); // ttl - byte2 -+ pframe[mdns_offset + 8] = (u8) (psinfo[i].ttl & 0x000000ff); // ttl - byte3 -+ pframe[mdns_offset + 10] = psinfo[i].target_len + 9; // data length -+ _rtw_memcpy(pframe + mdns_offset + 15, &psinfo[i].port, 2); // port -+ _rtw_memcpy(pframe + mdns_offset + 17, &psinfo[i].target_len, 1); // target len -+ _rtw_memcpy(pframe + mdns_offset + 18, &psinfo[i].target, psinfo[i].target_len); // target -+ pframe[mdns_offset + 18 + psinfo[i].target_len] = 0xc0; // message compresion, offset will be filled by fw. -+ mdns_offset += (1 + psinfo[i].target_len + 19); -+ -+ // 1.3 : set the idx of txt rsp -+ pframe[mdns_offset] = psinfo[i].txt_rsp_idx; -+ mdns_offset += 1; -+ } -+ -+ /* 2. machine name */ -+ pframe[mdns_offset] = 0x02; // TLV(T) -+ mdns_offset += 1; -+ _rtw_memcpy(pframe + mdns_offset, &pwrctl->wowlan_war_offload_mdns_mnane_num, 1); // NUM -+ mdns_offset += 1; -+ -+ for(i=0; iwowlan_war_offload_mdns_mnane_num; i++) -+ { -+ pframe[mdns_offset] = pwrctl->wowlan_war_offload_mdns_mnane[i].name_len; -+ _rtw_memcpy(pframe + mdns_offset + 1, pwrctl->wowlan_war_offload_mdns_mnane[i].name, -+ pwrctl->wowlan_war_offload_mdns_mnane[i].name_len); // machine name -+ mdns_offset += (1+pwrctl->wowlan_war_offload_mdns_mnane[i].name_len); -+ } -+ -+ /* 3. A rsp */ -+ pframe[mdns_offset] = 0x03; // TLV(T) -+ pframe[mdns_offset + 1] = 14; // TLV(L) -+ pframe[mdns_offset + 3] = 0x01; // rsp type (a) -+ pframe[mdns_offset + 5] = 0x01; // cache flush + class -+ pframe[mdns_offset + 9] = 0xf0; // ttl (240 sec) -+ pframe[mdns_offset + 11] = 4; // length of ipv4 addr. -+ _rtw_memcpy(pframe + mdns_offset + 12, &pwrctl->wowlan_war_offload_ipv4.ip_addr[0], 4); -+ mdns_offset += (2 + 14); -+ -+ /* 4. AAAA rsp */ -+ pframe[mdns_offset] = 0x04; // TLV(T) -+ pframe[mdns_offset + 1] = 26; // TLV(L) -+ pframe[mdns_offset + 3] = 0x1c; // rsp type (aaaa) -+ pframe[mdns_offset + 5] = 0x01; // cache flush + class -+ pframe[mdns_offset + 9] = 0xf0; // ttl (240 sec) -+ pframe[mdns_offset + 11] = 16; // length of ipv6 addr. -+ _rtw_memcpy(pframe + mdns_offset + 12, &pwrctl->wowlan_war_offload_ipv6.ipv6_addr[0], 16); -+ mdns_offset += (2 + 26); -+ -+ /* 5. PTR rsp */ -+ pframe[mdns_offset] = 0x05; // TLV(T) -+ pframe[mdns_offset + 1] = 13 + pwrctl->wowlan_war_offload_mdns_domain_name_len; // TLV(L) -+ pframe[mdns_offset + 3] = 0x0c; // rsp type (aaaa) -+ pframe[mdns_offset + 5] = 0x01; // cache flush + class -+ pframe[mdns_offset + 8] = 0x1c; // ttl -+ pframe[mdns_offset + 9] = 0x20; // ttl (7200 sec) -+ pframe[mdns_offset + 11] = 3 + pwrctl->wowlan_war_offload_mdns_domain_name_len; // data length -+ pframe[mdns_offset + 12] = pwrctl->wowlan_war_offload_mdns_domain_name_len; // domain name length -+ _rtw_memcpy(pframe + mdns_offset + 13, &pwrctl->wowlan_war_offload_mdns_domain_name, -+ pwrctl->wowlan_war_offload_mdns_domain_name_len); -+ pframe[mdns_offset + 13 + pwrctl->wowlan_war_offload_mdns_domain_name_len] = 0xc0; // message compression -+ mdns_offset += (2 + 13 + pwrctl->wowlan_war_offload_mdns_domain_name_len); -+ -+ /* 6. TXT in PTR rsp */ -+ pframe[mdns_offset] = 0x06; // TLV(T) -+ pframe[mdns_offset + 1] = 31; // TLV(L) -+ _rtw_memcpy(pframe + mdns_offset + 2, &txt_in_ptr, 31); -+ mdns_offset += (2 + 31); -+ -+ /* 7. TXT rsp */ -+ pframe[mdns_offset] = 0x07; // TLV(T) -+ mdns_offset += 1; -+ _rtw_memcpy(pframe + mdns_offset, &pwrctl->wowlan_war_offload_mdns_txt_rsp_num, 1); // NUM -+ mdns_offset += 1; -+ -+ for(i=0; iwowlan_war_offload_mdns_txt_rsp_num; i++) -+ { -+ u16 txt_rsp_len = pwrctl->wowlan_war_offload_mdns_txt_rsp[i].txt_len; -+ -+ if(pwrctl->wowlan_war_offload_mdns_txt_rsp[i].txt_len==0) -+ { -+ _rtw_memcpy(pframe + mdns_offset, &txt_rsp_len, 2); -+ mdns_offset += ( 2 + txt_rsp_len ); -+ continue; -+ } -+ -+ txt_rsp_len += 10; -+ _rtw_memcpy(pframe + mdns_offset, &txt_rsp_len, 2); -+ pframe[mdns_offset + 3] = 0x10; // rsp type (txt) -+ pframe[mdns_offset + 5] = 0x01; // cache flush + class -+ pframe[mdns_offset + 8] = 0x1c; // ttl -+ pframe[mdns_offset + 9] = 0x20; // ttl (7200 sec) -+ pframe[mdns_offset + 10] = (u8) ((pwrctl->wowlan_war_offload_mdns_txt_rsp[i].txt_len & 0xff00) >> 8); -+ pframe[mdns_offset + 11] = (u8) (pwrctl->wowlan_war_offload_mdns_txt_rsp[i].txt_len & 0x00ff); -+ _rtw_memcpy(pframe + mdns_offset + 12, &pwrctl->wowlan_war_offload_mdns_txt_rsp[i].txt, -+ pwrctl->wowlan_war_offload_mdns_txt_rsp[i].txt_len); -+ mdns_offset += ( 2 + txt_rsp_len ); -+ } -+ -+ CurtPktPageNum = (u8)PageNum(mdns_offset - index, page_size)+1; -+ *page_num += CurtPktPageNum; -+ *total_pkt_len = index + (page_size * CurtPktPageNum); -+ index += (CurtPktPageNum * page_size); -+ } -+#endif /* defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) */ -+ -+#ifdef CONFIG_OFFLOAD_MDNS_V4 -+ if (WAR_MDNS_V4_RSP_EN & pwrctl->wowlan_war_offload_ctrl) { -+ rsvd_page_loc->LocMdnsv4 = *page_num; -+ RTW_INFO("LocMdnsv4: %d\n", rsvd_page_loc->LocMdnsv4); -+ -+ rtw_hal_construct_mdns_rsp_v4(adapter, &pframe[index], &buf_len, pmlmeinfo->ip_addr); -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], buf_len, _FALSE, _FALSE, _TRUE); -+ CurtPktPageNum = 16; -+ *page_num += CurtPktPageNum; -+ index += (CurtPktPageNum * page_size); -+ } -+#endif /* CONFIG_OFFLOAD_MDNS_V4 */ -+ -+#ifdef CONFIG_OFFLOAD_MDNS_V6 -+ if (WAR_MDNS_V6_RSP_EN & pwrctl->wowlan_war_offload_ctrl) { -+ rsvd_page_loc->LocMdnsv6 = *page_num; -+ RTW_INFO("LocMdnsv6: %d\n", rsvd_page_loc->LocMdnsv6); -+ -+ rtw_hal_construct_mdns_rsp_v6(adapter, &pframe[index], &buf_len, pmlmeinfo->ip_addr); -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], buf_len, _FALSE, _FALSE, _TRUE); -+ CurtPktPageNum = 16; -+ *page_num += CurtPktPageNum; -+ index += (CurtPktPageNum * page_size); -+ } -+#endif /* CONFIG_OFFLOAD_MDNS_V6 */ -+ -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+ *(pframe+tmp_idx+25-tx_desc) = rsvd_page_loc->LocMdnsPara; -+ *(pframe+tmp_idx+26-tx_desc) = rsvd_page_loc->LocMdnsv4; -+ *(pframe+tmp_idx+27-tx_desc) = rsvd_page_loc->LocMdnsv6; -+#endif /* defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) */ -+ -+ } -+ //rtw_dump_rsvd_page(RTW_DBGDUMP, adapter, rsvd_page_loc->LocIpParm, 46); -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+#if defined(CONFIG_WOW_PATTERN_IN_TXFIFO) -+ /* pattern_rsvd_page_loc will be used by rtw_read_from_frame_mask() */ -+ pwrctl->pattern_rsvd_page_loc = *page_num; -+ RTW_INFO("LocPatternInfo: %d\n", pwrctl->pattern_rsvd_page_loc); -+ rtw_hal_construct_pattern_info(adapter, -+ &pframe[index - tx_desc], -+ &PatternLen); -+ -+ /* Set cam_start_offset to REG_TXBUF_WKCAM_OFFSET -+ * Cam address(TxBufer pointer) access 8 bytes at a time -+ */ -+ -+ // Get rsvd page start page number + pattern located page -+ cam_start_offset = rtw_read8(adapter, REG_BCNQ_BDNY) + *page_num; -+ cam_start_offset *= page_size; -+ cam_start_offset /= 8; -+ -+ reg_cam_start_offset_val = rtw_read32(adapter, REG_TXBUF_WKCAM_OFFSET); -+ reg_cam_start_offset_val &= ~(WKCAM_OFFSET_BIT_MASK << WKCAM_OFFSET_BIT_MASK_OFFSET); -+ reg_cam_start_offset_val |= (cam_start_offset << WKCAM_OFFSET_BIT_MASK_OFFSET); -+ rtw_write32(adapter, REG_TXBUF_WKCAM_OFFSET, reg_cam_start_offset_val); -+ -+ /* Set pattern number to REG_WKFMCAM_NUM */ -+ rtw_write8(adapter, REG_WKFMCAM_NUM, PatternLen / WKFMCAM_SIZE); -+ -+ CurtPktPageNum = (u8)PageNum(PatternLen, page_size); -+ *page_num += CurtPktPageNum; -+ index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("WOW-PatternInfo", CurtPktPageNum, *page_num, index); -+ -+#endif /* CONFIG_WOW_PATTERN_IN_TXFIFO */ -+ -+ /*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); -+ RSVD_PAGE_CFG("WOW-AOAC", 1, *page_num, *total_pkt_len); -+ -+ -+ } else { -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrctl->wowlan_in_resume == _FALSE && -+ pwrctl->pno_inited == _TRUE) { -+#ifndef RTW_HALMAC -+ /* 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); -+ RSVD_PAGE_CFG("WOW-ProbeReq", CurtPktPageNum, *page_num, 0); -+ -+ /* 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; -+ -+ index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("WOW-ScanInfo", CurtPktPageNum, *page_num, *total_pkt_len); -+#endif -+ /* 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); -+ RSVD_PAGE_CFG("WOW-ProbeReq", CurtPktPageNum, *page_num, 0); -+ } -+ -+ /* 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; -+ *total_pkt_len = index + PNOLength; -+ index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("WOW-PNOInfo", CurtPktPageNum, *page_num, 0); -+ } -+#endif /* CONFIG_PNO_SUPPORT */ -+ } -+} -+#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); -+ RSVD_PAGE_CFG("WOW-P2P-Beacon", CurtPktPageNum, *page_num, 0); -+ -+ /* 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); -+ RSVD_PAGE_CFG("WOW-P2P-ProbeRsp", CurtPktPageNum, *page_num, 0); -+ -+ /* 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); -+ RSVD_PAGE_CFG("WOW-P2P-NegoRsp", CurtPktPageNum, *page_num, 0); -+ -+ /* 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); -+ RSVD_PAGE_CFG("WOW-P2P-InviteRsp", CurtPktPageNum, *page_num, 0); -+ -+ /* 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; -+ RSVD_PAGE_CFG("WOW-P2P-PDR", CurtPktPageNum, *page_num, *total_pkt_len); -+ -+ index += (CurtPktPageNum * page_size); -+ -+ -+} -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+#ifdef CONFIG_LPS_PG -+#ifndef DBG_LPSPG_INFO_DUMP -+#define DBG_LPSPG_INFO_DUMP 1 -+#endif -+ -+#include "hal_halmac.h" -+ -+#ifdef CONFIG_RTL8822C -+static int rtw_lps_pg_set_dpk_info_rsvd_page(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct dm_struct *dm = adapter_to_phydm(adapter); -+ struct rsvd_page_cache_t *cache = &pwrpriv->lpspg_dpk_info; -+ u8 *info = NULL; -+ u32 info_len; -+ int ret = _FAIL; -+ -+ /* get length */ -+ halrf_dpk_info_rsvd_page(dm, NULL, &info_len); -+ if (!info_len) { -+ RTW_ERR("get %s length fail\n", cache->name); -+ goto exit; -+ } -+ -+ /* allocate buf */ -+ info = rtw_zmalloc(info_len); -+ if (!info) { -+ RTW_ERR("alloc %s buffer fail(len=%d)\n", cache->name, info_len); -+ goto exit; -+ } -+ -+ /* get content */ -+ halrf_dpk_info_rsvd_page(dm, info, NULL); -+ -+ if (rsvd_page_cache_update_data(cache, info, info_len)) { -+ -+ #if (DBG_LPSPG_INFO_DUMP >= 1) -+ RTW_INFO_DUMP(cache->name, info, info_len); -+ #endif -+ -+ ret = rtw_halmac_download_rsvd_page(dvobj, cache->loc, info, info_len); -+ ret = !ret ? _SUCCESS : _FAIL; -+ if (ret != _SUCCESS) { -+ RTW_ERR("download %s rsvd page to offset:%u fail\n", cache->name, cache->loc); -+ goto free_mem; -+ } -+ -+ #if (DBG_LPSPG_INFO_DUMP >= 2) -+ RTW_INFO("get %s from rsvd page offset:%d\n", cache->name, cache->loc); -+ rtw_dump_rsvd_page(RTW_DBGDUMP, adapter, cache->loc, cache->page_num); -+ #endif -+ } -+ -+free_mem: -+ rtw_mfree(info, info_len); -+ -+exit: -+ return ret; -+} -+ -+static int rtw_lps_pg_set_iqk_info_rsvd_page(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct dm_struct *dm = adapter_to_phydm(adapter); -+ struct rsvd_page_cache_t *cache = &pwrpriv->lpspg_iqk_info; -+ u8 *info = NULL; -+ u32 info_len = 0; -+ int ret = _FAIL; -+ -+ if (hal_data->RegIQKFWOffload) { -+ rsvd_page_cache_free_data(cache); -+ ret = _SUCCESS; -+ goto exit; -+ } -+ -+ /* get length */ -+ halrf_iqk_info_rsvd_page(dm, NULL, &info_len); -+ if (!info_len) { -+ RTW_ERR("get %s length fail\n", cache->name); -+ goto exit; -+ } -+ -+ /* allocate buf */ -+ info = rtw_zmalloc(info_len); -+ if (!info) { -+ RTW_ERR("alloc %s buffer fail(len=%d)\n", cache->name, info_len); -+ goto exit; -+ } -+ -+ /* get content */ -+ halrf_iqk_info_rsvd_page(dm, info, NULL); -+ -+ if (rsvd_page_cache_update_data(cache, info, info_len)) { -+ -+ #if (DBG_LPSPG_INFO_DUMP >= 1) -+ RTW_INFO_DUMP(cache->name, info, info_len); -+ #endif -+ -+ ret = rtw_halmac_download_rsvd_page(dvobj, cache->loc, info, info_len); -+ ret = !ret ? _SUCCESS : _FAIL; -+ if (ret != _SUCCESS) { -+ RTW_ERR("download %s rsvd page to offset:%u fail\n", cache->name, cache->loc); -+ goto free_mem; -+ } -+ -+ #if (DBG_LPSPG_INFO_DUMP >= 2) -+ RTW_INFO("get %s from rsvd page offset:%d\n", cache->name, cache->loc); -+ rtw_dump_rsvd_page(RTW_DBGDUMP, adapter, cache->loc, cache->page_num); -+ #endif -+ } -+ -+free_mem: -+ rtw_mfree(info, info_len); -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_RTL8822C */ -+ -+static void rtw_hal_build_lps_pg_info_rsvd_page(struct dvobj_priv *dvobj, _adapter *ld_sta_iface, u8 *buf, u32 *buf_size) -+{ -+#define LPS_PG_INFO_RSVD_LEN 16 -+ -+ if (buf) { -+ _adapter *adapter = dvobj_get_primary_adapter(dvobj); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct sta_info *psta; -+#ifdef CONFIG_MBSSID_CAM -+ u8 cam_id = INVALID_CAM_ID; -+#endif -+ u8 *psec_cam_id = buf + 8; -+ u8 sec_cam_num = 0; -+ u8 drv_rsvdpage_num = 0; -+ -+ if (ld_sta_iface) { -+ psta = rtw_get_stainfo(&ld_sta_iface->stapriv, get_bssid(&ld_sta_iface->mlmepriv)); -+ if (!psta) { -+ RTW_ERR("%s [ERROR] sta is NULL\n", __func__); -+ rtw_warn_on(1); -+ goto size_chk; -+ } -+ /*Byte 0 - used macid*/ -+ LPSPG_RSVD_PAGE_SET_MACID(buf, psta->cmn.mac_id); -+ RTW_INFO("[LPSPG-INFO] mac_id:%d\n", psta->cmn.mac_id); -+ } -+ -+#ifdef CONFIG_MBSSID_CAM -+ /*Byte 1 - used BSSID CAM entry*/ -+ cam_id = rtw_mbid_cam_search_by_ifaceid(adapter, adapter->iface_id); -+ if (cam_id != INVALID_CAM_ID) -+ LPSPG_RSVD_PAGE_SET_MBSSCAMID(buf, cam_id); -+ RTW_INFO("[LPSPG-INFO] mbss_cam_id:%d\n", cam_id); -+#endif -+ -+#ifdef CONFIG_WOWLAN /*&& pattern match cam used*/ -+ /*Btye 2 - Max used Pattern Match CAM entry*/ -+ if (pwrpriv->wowlan_mode == _TRUE -+ && ld_sta_iface && check_fwstate(&ld_sta_iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ LPSPG_RSVD_PAGE_SET_PMC_NUM(buf, pwrpriv->wowlan_pattern_idx); -+ RTW_INFO("[LPSPG-INFO] Max Pattern Match CAM entry :%d\n", pwrpriv->wowlan_pattern_idx); -+ } -+#endif -+#ifdef CONFIG_BEAMFORMING /*&& MU BF*/ -+ /*Btye 3 - Max MU rate table Group ID*/ -+ LPSPG_RSVD_PAGE_SET_MU_RAID_GID(buf, 0); -+ RTW_INFO("[LPSPG-INFO] Max MU rate table Group ID :%d\n", 0); -+#endif -+ -+ /*Btye 8 ~15 - used Security CAM entry */ -+ sec_cam_num = rtw_get_sec_camid(adapter, 8, psec_cam_id); -+ -+ /*Btye 4 - used Security CAM entry number*/ -+ if (sec_cam_num < 8) -+ LPSPG_RSVD_PAGE_SET_SEC_CAM_NUM(buf, sec_cam_num); -+ RTW_INFO("[LPSPG-INFO] Security CAM entry number :%d\n", sec_cam_num); -+ -+ /*Btye 5 - Txbuf used page number for fw offload*/ -+ if (pwrpriv->wowlan_mode == _TRUE || pwrpriv->wowlan_ap_mode == _TRUE) -+ drv_rsvdpage_num = rtw_hal_get_txbuff_rsvd_page_num(adapter, _TRUE); -+ else -+ drv_rsvdpage_num = rtw_hal_get_txbuff_rsvd_page_num(adapter, _FALSE); -+ LPSPG_RSVD_PAGE_SET_DRV_RSVDPAGE_NUM(buf, drv_rsvdpage_num); -+ RTW_INFO("[LPSPG-INFO] DRV's rsvd page numbers :%d\n", drv_rsvdpage_num); -+ } -+ -+size_chk: -+ if (buf_size) -+ *buf_size = LPS_PG_INFO_RSVD_LEN; -+} -+ -+static int rtw_hal_set_lps_pg_info_rsvd_page(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct rsvd_page_cache_t *cache = &pwrpriv->lpspg_info; -+ u8 *info = NULL; -+ u32 info_len = 0; -+ int ret = _FAIL; -+ -+ /* get length */ -+ rtw_hal_build_lps_pg_info_rsvd_page(dvobj, adapter, NULL, &info_len); -+ if (!info_len) { -+ RTW_ERR("get %s length fail\n", cache->name); -+ goto exit; -+ } -+ -+ /* allocate buf */ -+ info = rtw_zmalloc(info_len); -+ if (!info) { -+ RTW_ERR("alloc %s buffer fail(len=%d)\n", cache->name, info_len); -+ goto exit; -+ } -+ -+ /* get content */ -+ rtw_hal_build_lps_pg_info_rsvd_page(dvobj, adapter, info, NULL); -+ -+ if (rsvd_page_cache_update_data(cache, info, info_len)) { -+ -+ #if (DBG_LPSPG_INFO_DUMP >= 1) -+ RTW_INFO_DUMP(cache->name, info, info_len); -+ #endif -+ -+ ret = rtw_halmac_download_rsvd_page(dvobj, cache->loc, info, info_len); -+ ret = !ret ? _SUCCESS : _FAIL; -+ if (ret != _SUCCESS) { -+ RTW_ERR("download %s rsvd page to offset:%u fail\n", cache->name, cache->loc); -+ goto free_mem; -+ } -+ -+ #if (DBG_LPSPG_INFO_DUMP >= 2) -+ RTW_INFO("get %s from rsvd page offset:%d\n", cache->name, cache->loc); -+ rtw_dump_rsvd_page(RTW_DBGDUMP, adapter, cache->loc, cache->page_num); -+ #endif -+ } -+ -+free_mem: -+ rtw_mfree(info, info_len); -+ -+exit: -+ return ret; -+} -+ -+static void rtw_lps_pg_set_rsvd_page(_adapter *adapter, u8 *frame, u16 *index -+ , u8 txdesc_size, u32 page_size, u8 *total_page_num -+ , bool is_wow_mode, _adapter *ld_sta_iface, bool only_get_page_num) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct rsvd_page_cache_t *cache; -+ bool rsvd = 1; -+ u8 *pos; -+ u32 len; -+ -+ if (is_wow_mode) { -+ /* lps_level will not change when enter wow_mode */ -+ if (pwrctl->lps_level != LPS_PG) -+ rsvd = 0; -+ } else { -+ if (!only_get_page_num && !ld_sta_iface) -+ rsvd = 0; -+ } -+ -+ pos = only_get_page_num ? NULL : frame + *index; -+ -+#ifdef CONFIG_RTL8822C -+ if (IS_8822C_SERIES(hal_data->version_id)) { -+ /* LPSPG_DPK_INFO */ -+ cache = &pwrctl->lpspg_dpk_info; -+ if (rsvd) { -+ if (pwrctl->lps_level != LPS_PG) -+ pos = NULL; -+ len = 0; -+ halrf_dpk_info_rsvd_page(adapter_to_phydm(adapter), pos, &len); -+ #if (DBG_LPSPG_INFO_DUMP >= 1) -+ if (pos) -+ RTW_INFO_DUMP(cache->name, pos, len); -+ #endif -+ rsvd_page_cache_update_all(cache, *total_page_num, txdesc_size, page_size, pos, len); -+ *total_page_num += cache->page_num; -+ *index += page_size * cache->page_num; -+ pos = only_get_page_num ? NULL : frame + *index; -+ RSVD_PAGE_CFG(cache->name, cache->page_num, *total_page_num, *index); -+ } else -+ rsvd_page_cache_free(cache); -+ -+ /* LPSPG_IQK_INFO */ -+ cache = &pwrctl->lpspg_iqk_info; -+ if (rsvd -+ /* RegIQKFWOffload will not change when enter wow_mode */ -+ && !(is_wow_mode && hal_data->RegIQKFWOffload) -+ ) { -+ if (pwrctl->lps_level != LPS_PG || hal_data->RegIQKFWOffload) -+ pos = NULL; -+ len = 0; -+ halrf_iqk_info_rsvd_page(adapter_to_phydm(adapter), pos, &len); -+ #if (DBG_LPSPG_INFO_DUMP >= 1) -+ if (pos) -+ RTW_INFO_DUMP(cache->name, pos, len); -+ #endif -+ rsvd_page_cache_update_all(cache, *total_page_num, txdesc_size, page_size, pos, len); -+ *total_page_num += cache->page_num; -+ *index += page_size * cache->page_num; -+ pos = only_get_page_num ? NULL : frame + *index; -+ RSVD_PAGE_CFG(cache->name, cache->page_num, *total_page_num, *index); -+ } else -+ rsvd_page_cache_free(cache); -+ } -+#endif -+ -+ /* LPSPG_INFO */ -+ cache = &pwrctl->lpspg_info; -+ if (rsvd) { -+ if (pwrctl->lps_level != LPS_PG) -+ pos = NULL; -+ rtw_hal_build_lps_pg_info_rsvd_page(adapter_to_dvobj(adapter), ld_sta_iface, pos, &len); -+ #if (DBG_LPSPG_INFO_DUMP >= 1) -+ if (pos) -+ RTW_INFO_DUMP(cache->name, pos, len); -+ #endif -+ rsvd_page_cache_update_all(cache, *total_page_num, txdesc_size, page_size, pos, len); -+ *total_page_num += cache->page_num; -+ *index += page_size * cache->page_num; -+ pos = only_get_page_num ? NULL : frame + *index; -+ RSVD_PAGE_CFG(cache->name, cache->page_num, *total_page_num, *index); -+ } else -+ rsvd_page_cache_free(cache); -+} -+ -+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; -+ -+ 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 -+ -+#if defined(CONFIG_WOWLAN) && defined(CONFIG_WOW_PATTERN_HW_CAM) -+ if (pwrpriv->wowlan_mode == _TRUE && -+ check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _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_info.loc); -+ -+#ifdef CONFIG_RTL8822C -+ if (pwrpriv->bFwCurrentInPSMode == _FALSE) { -+ SET_H2CCMD_LPSPG_DPK_INFO_LOC(lpspg_info, pwrpriv->lpspg_dpk_info.loc); -+ if (!GET_HAL_DATA(adapter)->RegIQKFWOffload) -+ SET_H2CCMD_LPSPG_IQK_INFO_LOC(lpspg_info, pwrpriv->lpspg_iqk_info.loc); -+ } else { -+ SET_H2CCMD_LPSPG_DPK_INFO_LOC(lpspg_info, 0); -+ if (!GET_HAL_DATA(adapter)->RegIQKFWOffload) -+ SET_H2CCMD_LPSPG_IQK_INFO_LOC(lpspg_info, 0); -+ } -+#endif -+ -+#if (DBG_LPSPG_INFO_DUMP >= 1) -+ RTW_INFO_DUMP("H2C_LPS_PG_INFO: ", lpspg_info, H2C_LPS_PG_INFO_LEN); -+#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_info.loc == 0) { -+ RTW_ERR("%s lpspg_info.loc = 0\n", __func__); -+ rtw_warn_on(1); -+ return ret; -+ } -+ #ifdef CONFIG_RTL8822C -+ rtw_lps_pg_set_dpk_info_rsvd_page(adapter); -+ rtw_lps_pg_set_iqk_info_rsvd_page(adapter); -+ #endif -+ rtw_hal_set_lps_pg_info_rsvd_page(adapter); -+ -+ ret = rtw_hal_set_lps_pg_info_cmd(adapter); -+ -+ return ret; -+} -+ -+void rtw_hal_lps_pg_rssi_lv_decide(_adapter *adapter, struct sta_info *sta) -+{ -+#if 0 -+ if (sta->cmn.ra_info.rssi_level >= 4) -+ sta->lps_pg_rssi_lv = 3; /*RSSI High - 1SS_VHT_MCS7*/ -+ else if (sta->cmn.ra_info.rssi_level >= 2) -+ sta->lps_pg_rssi_lv = 2; /*RSSI Middle - 1SS_VHT_MCS3*/ -+ else -+ sta->lps_pg_rssi_lv = 1; /*RSSI Lower - Lowest_rate*/ -+#else -+ sta->lps_pg_rssi_lv = 0; -+#endif -+ RTW_INFO("%s mac-id:%d, rssi:%d, rssi_level:%d, lps_pg_rssi_lv:%d\n", -+ __func__, sta->cmn.mac_id, sta->cmn.rssi_stat.rssi, sta->cmn.ra_info.rssi_level, sta->lps_pg_rssi_lv); -+} -+ -+void rtw_hal_lps_pg_handler(_adapter *adapter, enum lps_pg_hdl_id hdl_id) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *sta; -+ -+ sta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); -+ -+ switch (hdl_id) { -+ case LPS_PG_INFO_CFG: -+ rtw_hal_set_lps_pg_info(adapter); -+ break; -+ case LPS_PG_REDLEMEM: -+ if (IS_8822C_SERIES(GET_HAL_DATA(adapter)->version_id)) -+ break; -+ -+ /*set xmit_block*/ -+ rtw_set_xmit_block(adapter, XMIT_BLOCK_REDLMEM); -+ if (_FAIL == rtw_hal_fw_mem_dl(adapter, FW_EMEM)) -+ rtw_warn_on(1); -+ /*clearn xmit_block*/ -+ rtw_clr_xmit_block(adapter, XMIT_BLOCK_REDLMEM); -+ break; -+ case LPS_PG_PHYDM_DIS:/*Disable RA and PT by H2C*/ -+ if (IS_8822C_SERIES(GET_HAL_DATA(adapter)->version_id)) -+ break; -+ -+ if (sta) -+ rtw_phydm_lps_pg_hdl(adapter, sta, _TRUE); -+ break; -+ case LPS_PG_PHYDM_EN:/*Enable RA and PT by H2C*/ -+ if (IS_8822C_SERIES(GET_HAL_DATA(adapter)->version_id)) -+ break; -+ -+ if (sta) { -+ rtw_hal_lps_pg_rssi_lv_decide(adapter, sta); -+ rtw_phydm_lps_pg_hdl(adapter, sta, _FALSE); -+ sta->lps_pg_rssi_lv = 0; -+ } -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+#endif /*CONFIG_LPS_PG*/ -+ -+static u8 _rtw_mi_assoc_if_num(_adapter *adapter) -+{ -+ u8 mi_iface_num = 0; -+ -+ if (0) { -+ RTW_INFO("[IFS_ASSOC_STATUS] - STA :%d", DEV_STA_LD_NUM(adapter_to_dvobj(adapter))); -+ RTW_INFO("[IFS_ASSOC_STATUS] - AP:%d", DEV_AP_NUM(adapter_to_dvobj(adapter))); -+ RTW_INFO("[IFS_ASSOC_STATUS] - AP starting :%d", DEV_AP_STARTING_NUM(adapter_to_dvobj(adapter))); -+ RTW_INFO("[IFS_ASSOC_STATUS] - MESH :%d", DEV_MESH_NUM(adapter_to_dvobj(adapter))); -+ RTW_INFO("[IFS_ASSOC_STATUS] - ADHOC :%d", DEV_ADHOC_NUM(adapter_to_dvobj(adapter))); -+ /*RTW_INFO("[IFS_ASSOC_STATUS] - P2P-GC :%d", DEV_P2P_GC_NUM(adapter_to_dvobj(adapter)));*/ -+ /*RTW_INFO("[IFS_ASSOC_STATUS] - P2P-GO :%d", DEV_P2P_GO_NUM(adapter_to_dvobj(adapter)));*/ -+ } -+ -+ mi_iface_num = (DEV_STA_LD_NUM(adapter_to_dvobj(adapter)) + -+ DEV_AP_NUM(adapter_to_dvobj(adapter)) + -+ DEV_AP_STARTING_NUM(adapter_to_dvobj(adapter))); -+ return mi_iface_num; -+} -+#ifdef CONFIG_CONCURRENT_MODE -+static _adapter *_rtw_search_sta_iface(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface = NULL; -+ _adapter *sta_iface = NULL; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ if (check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ sta_iface = iface; -+ break; -+ } -+ } -+ } -+ return sta_iface; -+} -+#if defined(CONFIG_AP_MODE) && defined(CONFIG_BT_COEXIST) -+static _adapter *_rtw_search_ap_iface(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface = NULL; -+ _adapter *ap_iface = NULL; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE ) { -+ ap_iface = iface; -+ break; -+ } -+ } -+ return ap_iface; -+} -+#endif/*CONFIG_AP_MODE*/ -+#endif/*CONFIG_CONCURRENT_MODE*/ -+ -+#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA -+void rtw_hal_set_pathb_phase(_adapter *adapter, u8 phase_idx) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; -+ -+ return phydm_pathb_q_matrix_rotate(pDM_Odm, phase_idx); -+} -+#endif -+ -+/* -+ * 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. -+ * page_num - The amount of reserved page which driver need. -+ * If this is not NULL, this function doesn't real download reserved -+ * page, but just count the number of reserved page. -+ * -+ * 2009.10.15 by tynli. -+ * 2017.06.20 modified by Lucas. -+ * -+ * Page Size = 128: 8188e, 8723a/b, 8192c/d, -+ * Page Size = 256: 8192e, 8821a -+ * Page Size = 512: 8812a -+ */ -+ -+/*#define DBG_DUMP_SET_RSVD_PAGE*/ -+static void _rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished, u8 *page_num) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct xmit_frame *pcmdframe = NULL; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv; -+ struct pwrctrl_priv *pwrctl; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ 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; -+ struct registry_priv *registry_par = &adapter->registrypriv; -+ -+#ifdef DBG_FW_DEBUG_MSG_PKT -+ u32 fw_dbg_msg_pkt_len = 0; -+#endif /*DBG_FW_DEBUG_MSG_PKT*/ -+ -+#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 */ -+ u8 nr_assoc_if; -+ -+ _adapter *sta_iface = NULL; -+ _adapter *ap_iface = NULL; -+ -+ bool is_wow_mode = _FALSE; -+ -+ pHalData = GET_HAL_DATA(adapter); -+#ifdef DBG_CONFIG_ERROR_DETECT -+ psrtpriv = &pHalData->srestpriv; -+#endif -+ pxmitpriv = &adapter->xmitpriv; -+ pwrctl = adapter_to_pwrctl(adapter); -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&PageSize); -+ -+ if (PageSize == 0) { -+ RTW_ERR("[Error]: %s, PageSize is zero!!\n", __func__); -+ return; -+ } -+ nr_assoc_if = _rtw_mi_assoc_if_num(adapter); -+ -+ if ((pwrctl->wowlan_mode == _TRUE && pwrctl->wowlan_in_resume == _FALSE) || -+ pwrctl->wowlan_ap_mode == _TRUE || -+ pwrctl->wowlan_p2p_mode == _TRUE) -+ is_wow_mode = _TRUE; -+ -+ /*page_num for init time to get rsvd page number*/ -+ /* Prepare ReservedPagePacket */ -+ if (page_num) { -+ ReservedPagePacket = rtw_zmalloc(MAX_CMDBUF_SZ); -+ if (!ReservedPagePacket) { -+ RTW_WARN("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); -+ *page_num = 0xFF; -+ return; -+ } -+ RTW_INFO(FUNC_ADPT_FMT" Get [ %s ] RsvdPageNUm ==>\n", -+ FUNC_ADPT_ARG(adapter), (is_wow_mode) ? "WOW" : "NOR"); -+ -+ } else { -+ if (is_wow_mode) -+ RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _TRUE); -+ else -+ RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _FALSE); -+ -+ RTW_INFO(FUNC_ADPT_FMT" PageSize: %d, [ %s ]-RsvdPageNUm: %d\n", -+ FUNC_ADPT_ARG(adapter), PageSize, (is_wow_mode) ? "WOW" : "NOR", RsvdPageNum); -+ -+ MaxRsvdPageBufSize = RsvdPageNum * PageSize; -+ if (MaxRsvdPageBufSize > MAX_CMDBUF_SZ) { -+ RTW_ERR("%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_ERR("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); -+ return; -+ } -+ -+ ReservedPagePacket = pcmdframe->buf_addr; -+ } -+ -+ _rtw_memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); -+ -+ BufIndex = TxDescOffset; -+ -+ /*======== beacon content =======*/ -+ 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. -+ */ -+ BeaconLength = MAX_BEACON_LEN - TxDescLen; -+ CurtPktPageNum = (u8)PageNum((TxDescLen + BeaconLength), PageSize); -+ -+#if defined(CONFIG_FW_HANDLE_TXBCN) || defined(CONFIG_PORT_BASED_TXBCN) -+ CurtPktPageNum = CurtPktPageNum * CONFIG_LIMITED_AP_NUM; -+#endif -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum * PageSize); -+ -+ RSVD_PAGE_CFG("Beacon", CurtPktPageNum, TotalPageNum, TotalPacketLen); -+ -+ /*======== probe response content ========*/ -+ if (pwrctl->wowlan_ap_mode == _TRUE) {/*WOW mode*/ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (nr_assoc_if >= 2) -+ RTW_ERR("Not support > 2 net-interface in WOW\n"); -+ #endif -+ /* (4) probe response*/ -+ RsvdPageLoc.LocProbeRsp = TotalPageNum; -+ rtw_hal_construct_ProbeRsp( -+ adapter, &ReservedPagePacket[BufIndex], -+ &ProbeRspLength, -+ _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); -+ RSVD_PAGE_CFG("ProbeRsp", CurtPktPageNum, TotalPageNum, TotalPacketLen); -+ goto download_page; -+ } -+ -+ /*======== ps-poll content * 1 page ========*/ -+ sta_iface = adapter; -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (!MLME_IS_STA(sta_iface) && DEV_STA_LD_NUM(adapter_to_dvobj(sta_iface))) { -+ sta_iface = _rtw_search_sta_iface(adapter); -+ RTW_INFO("get ("ADPT_FMT") to create PS-Poll/Null/QosNull\n", ADPT_ARG(sta_iface)); -+ } -+ #endif -+ -+ if (MLME_IS_STA(sta_iface) || (nr_assoc_if == 0)) { -+ RsvdPageLoc.LocPsPoll = TotalPageNum; -+ RTW_INFO("LocPsPoll: %d\n", RsvdPageLoc.LocPsPoll); -+ rtw_hal_construct_PSPoll(sta_iface, -+ &ReservedPagePacket[BufIndex], &PSPollLength); -+ rtw_hal_fill_fake_txdesc(sta_iface, -+ &ReservedPagePacket[BufIndex - TxDescLen], -+ PSPollLength, _TRUE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum((TxDescLen + PSPollLength), PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum * PageSize); -+ RSVD_PAGE_CFG("PSPoll", CurtPktPageNum, TotalPageNum, TotalPacketLen); -+ } -+ -+#ifdef CONFIG_MCC_MODE -+ /*======== MCC * n page ======== */ -+ if (MCC_EN(adapter)) {/*Normal mode*/ -+ dl_mcc_page = rtw_hal_dl_mcc_fw_rsvd_page(adapter, ReservedPagePacket, -+ &BufIndex, TxDescLen, PageSize, &TotalPageNum, &RsvdPageLoc, page_num); -+ } else { -+ dl_mcc_page = _FAIL; -+ } -+ -+ if (dl_mcc_page == _FAIL) -+#endif /* CONFIG_MCC_MODE */ -+ { /*======== null data * 1 page ======== */ -+ if (MLME_IS_STA(sta_iface) || (nr_assoc_if == 0)) { -+ RsvdPageLoc.LocNullData = TotalPageNum; -+ RTW_INFO("LocNullData: %d\n", RsvdPageLoc.LocNullData); -+ rtw_hal_construct_NullFunctionData( -+ sta_iface, -+ &ReservedPagePacket[BufIndex], -+ &NullDataLength, -+ _FALSE, 0, 0, _FALSE); -+ rtw_hal_fill_fake_txdesc(sta_iface, -+ &ReservedPagePacket[BufIndex - TxDescLen], -+ NullDataLength, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(TxDescLen + NullDataLength, PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum * PageSize); -+ RSVD_PAGE_CFG("NullData", CurtPktPageNum, TotalPageNum, TotalPacketLen); -+ } -+ } -+ -+ /*======== Qos null data * 1 page ======== */ -+ if (pwrctl->wowlan_mode == _FALSE || -+ pwrctl->wowlan_in_resume == _TRUE) {/*Normal mode*/ -+ if (MLME_IS_STA(sta_iface) || (nr_assoc_if == 0)) { -+ RsvdPageLoc.LocQosNull = TotalPageNum; -+ RTW_INFO("LocQosNull: %d\n", RsvdPageLoc.LocQosNull); -+ rtw_hal_construct_NullFunctionData(sta_iface, -+ &ReservedPagePacket[BufIndex], -+ &QosNullLength, -+ _TRUE, 0, 0, _FALSE); -+ rtw_hal_fill_fake_txdesc(sta_iface, -+ &ReservedPagePacket[BufIndex - TxDescLen], -+ QosNullLength, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(TxDescLen + QosNullLength, -+ PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum * PageSize); -+ RSVD_PAGE_CFG("QosNull", CurtPktPageNum, TotalPageNum, TotalPacketLen); -+ } -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ /*======== BT Qos null data * 1 page ======== */ -+ if (pwrctl->wowlan_mode == _FALSE || -+ pwrctl->wowlan_in_resume == _TRUE) {/*Normal mode*/ -+ -+ ap_iface = adapter; -+ #if defined (CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+ if (!MLME_IS_AP(ap_iface) && DEV_AP_NUM(adapter_to_dvobj(ap_iface))) { /*DEV_AP_STARTING_NUM*/ -+ ap_iface = _rtw_search_ap_iface(adapter); -+ RTW_INFO("get ("ADPT_FMT") to create BTQoSNull\n", ADPT_ARG(ap_iface)); -+ } -+ #endif -+ -+ if (MLME_IS_AP(ap_iface) || (nr_assoc_if == 0)) { -+ RsvdPageLoc.LocBTQosNull = TotalPageNum; -+ -+ RTW_INFO("LocBTQosNull: %d\n", RsvdPageLoc.LocBTQosNull); -+ -+ rtw_hal_construct_NullFunctionData(ap_iface, -+ &ReservedPagePacket[BufIndex], -+ &BTQosNullLength, -+ _TRUE, 0, 0, _FALSE); -+ -+ rtw_hal_fill_fake_txdesc(ap_iface, -+ &ReservedPagePacket[BufIndex - TxDescLen], -+ BTQosNullLength, _FALSE, _TRUE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(TxDescLen + BTQosNullLength, -+ PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ BufIndex += (CurtPktPageNum * PageSize); -+ -+ RSVD_PAGE_CFG("BTQosNull", CurtPktPageNum, TotalPageNum, TotalPacketLen); -+ } -+ } -+#endif /* CONFIG_BT_COEXIT */ -+ -+ TotalPacketLen = BufIndex; -+ -+#ifdef DBG_FW_DEBUG_MSG_PKT -+ /*======== FW DEBUG MSG * n page ======== */ -+ RsvdPageLoc.loc_fw_dbg_msg_pkt = TotalPageNum; -+ RTW_INFO("loc_fw_dbg_msg_pkt: %d\n", RsvdPageLoc.loc_fw_dbg_msg_pkt); -+ rtw_hal_construct_fw_dbg_msg_pkt( -+ adapter, -+ &ReservedPagePacket[BufIndex], -+ &fw_dbg_msg_pkt_len); -+ -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex - TxDescLen], -+ fw_dbg_msg_pkt_len, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(TxDescLen + fw_dbg_msg_pkt_len, PageSize); -+ -+ if (CurtPktPageNum < 2) -+ CurtPktPageNum = 2; /*Need at least 2 rsvd page*/ -+ TotalPageNum += CurtPktPageNum; -+ -+ TotalPacketLen = BufIndex + fw_dbg_msg_pkt_len; -+ BufIndex += (CurtPktPageNum * PageSize); -+#endif /*DBG_FW_DEBUG_MSG_PKT*/ -+ -+#ifdef CONFIG_LPS_PG -+ rtw_lps_pg_set_rsvd_page(adapter, ReservedPagePacket, &BufIndex -+ , TxDescLen, PageSize, &TotalPageNum, is_wow_mode -+ , (sta_iface && MLME_IS_STA(sta_iface) && MLME_IS_ASOC(sta_iface)) ? sta_iface : NULL -+ , page_num ? 1 : 0 -+ ); -+ TotalPacketLen = BufIndex; -+#endif -+ -+#ifdef CONFIG_WOWLAN -+ /*======== WOW * n page ======== */ -+ 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); -+#ifdef CONFIG_WAR_OFFLOAD -+ rtw_hal_set_war_offload_parm(adapter, &RsvdPageLoc); -+#endif /* CONFIG_WAR_OFFLOAD */ -+ } -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+ /*======== P2P WOW * n page ======== */ -+ if (_TRUE == pwrctl->wowlan_p2p_mode) {/*WOW mode*/ -+ rtw_hal_set_p2p_wow_fw_rsvd_page(adapter, ReservedPagePacket, -+ BufIndex, TxDescLen, PageSize, -+ &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); -+ } -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+ /*Note: BufIndex already add a TxDescOffset offset in first Beacon page -+ * The "TotalPacketLen" is calculate by BufIndex. -+ * We need to decrease TxDescOffset before doing length check. by yiwei -+ */ -+ TotalPacketLen = TotalPacketLen - TxDescOffset; -+ -+download_page: -+ if (page_num) { -+ *page_num = TotalPageNum; -+ rtw_mfree(ReservedPagePacket, MAX_CMDBUF_SZ); -+ ReservedPagePacket = NULL; -+ RTW_INFO(FUNC_ADPT_FMT" Get [ %s ] RsvdPageNUm <==\n", -+ FUNC_ADPT_ARG(adapter), (is_wow_mode) ? "WOW" : "NOR"); -+ return; -+ } -+ -+ /* 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_ERR("%s : 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; -+ pattrib->last_txcmdsz = TotalPacketLen; -+#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); -+#ifdef DBG_DUMP_SET_RSVD_PAGE -+ RTW_INFO(" ==================================================\n"); -+ RTW_INFO_DUMP("\n", ReservedPagePacket, TotalPacketLen); -+ RTW_INFO(" ==================================================\n"); -+#endif -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) -+ || MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)){ -+ rtw_hal_set_FwRsvdPage_cmd(adapter, &RsvdPageLoc); -+#ifdef DBG_FW_DEBUG_MSG_PKT -+ rtw_hal_set_fw_dbg_msg_pkt_rsvd_page_cmd(adapter, &RsvdPageLoc); -+#endif /*DBG_FW_DEBUG_MSG_PKT*/ -+#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); -+} -+ -+void rtw_hal_set_fw_rsvd_page(struct _ADAPTER *adapter, bool finished) -+{ -+#ifdef CONFIG_AP_MODE -+ if (finished) -+ rtw_mi_tx_beacon_hdl(adapter); -+ else -+#endif -+ _rtw_hal_set_fw_rsvd_page(adapter, finished, NULL); -+} -+ -+static u8 rtw_hal_set_fw_bcn_early_c2h_rpt_cmd(struct _ADAPTER *adapter, u8 enable) -+{ -+ u8 u1H2CSetPwrMode[H2C_PWRMODE_LEN] = {0}; -+ u8 ret = _FAIL; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ if (ATOMIC_READ(&adapter->tdlsinfo.chsw_info.chsw_on) == _TRUE) -+ { -+ SET_H2CCMD_PWRMODE_PARM_RLBM(u1H2CSetPwrMode, 1); -+ SET_H2CCMD_PWRMODE_PARM_SMART_PS(u1H2CSetPwrMode, 0); -+ } -+#endif -+#endif -+ -+ SET_H2CCMD_PWRMODE_PARM_MODE(u1H2CSetPwrMode, 0); -+ SET_H2CCMD_PWRMODE_PARM_PWR_STATE(u1H2CSetPwrMode, 0x0C); -+ SET_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(u1H2CSetPwrMode, enable); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_SET_PWR_MODE, -+ H2C_PWRMODE_LEN, -+ u1H2CSetPwrMode); -+ -+ RTW_PRINT("-%s()-\n", __func__); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+u8 rtw_hal_set_ap_bcn_imr_cmd(struct _ADAPTER *adapter, u8 enable) -+{ -+ u8 ap_port_id; -+ u8 ret = _FAIL; -+ -+ if (!MLME_IS_AP(adapter)) -+ goto exit; -+ -+ ap_port_id = get_hw_port(adapter); -+ if (ap_port_id != HW_PORT0) { -+ RTW_WARN("AP mode should use port0\n"); -+ goto exit; -+ } -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_SET_AP_BCN_IMR, -+ H2C_AP_BCN_MIR_LEN, -+ &enable); -+ -+ RTW_INFO(FUNC_ADPT_FMT" : AP mode %s beacon early IMR\n", -+ FUNC_ADPT_ARG(adapter), enable ? "enable" : "disable"); -+exit: -+ return ret; -+} -+#endif -+ -+/** -+ * rtw_hal_get_rsvd_page_num() - Get needed reserved page number -+ * @adapter: struct _ADAPTER* -+ * -+ * Caculate needed reserved page number. -+ * In different state would get different number, for example normal mode and -+ * WOW mode would need different reserved page size. -+ * -+ * Return the number of reserved page which driver need. -+ */ -+u8 rtw_hal_get_rsvd_page_num(struct _ADAPTER *adapter) -+{ -+ u8 num = 0; -+ -+ -+ _rtw_hal_set_fw_rsvd_page(adapter, _FALSE, &num); -+ -+ return num; -+} -+ -+#ifndef CONFIG_HAS_HW_VAR_BCN_FUNC -+static void hw_var_set_bcn_func(_adapter *adapter, u8 enable) -+{ -+ u32 bcn_ctrl_reg; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (adapter->hw_port == HW_PORT1) -+ bcn_ctrl_reg = REG_BCN_CTRL_1; -+ else -+#endif -+ bcn_ctrl_reg = REG_BCN_CTRL; -+ -+ if (enable) -+ rtw_write8(adapter, bcn_ctrl_reg, (EN_BCN_FUNCTION | EN_TXBCN_RPT)); -+ 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); -+ } -+ -+#ifdef CONFIG_RTL8192F -+ if (IS_HARDWARE_TYPE_8192F(adapter)) { -+ u16 val16, val16_ori; -+ -+ val16_ori = val16 = rtw_read16(adapter, REG_WLAN_ACT_MASK_CTRL_1); -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (adapter->hw_port == HW_PORT1) { -+ if (enable) -+ val16 |= EN_PORT_1_FUNCTION; -+ else -+ val16 &= ~EN_PORT_1_FUNCTION; -+ } else -+ #endif -+ { -+ if (enable) -+ val16 |= EN_PORT_0_FUNCTION; -+ else -+ val16 &= ~EN_PORT_0_FUNCTION; -+ -+ #ifdef CONFIG_BT_COEXIST -+ if (GET_HAL_DATA(adapter)->EEPROMBluetoothCoexist == 1) -+ val16 |= EN_PORT_0_FUNCTION; -+ #endif -+ } -+ -+ if (val16 != val16_ori) -+ rtw_write16(adapter, REG_WLAN_ACT_MASK_CTRL_1, val16); -+ } -+#endif -+} -+#endif -+ -+#ifndef CONFIG_HAS_HW_VAR_MLME_DISCONNECT -+static void hw_var_set_mlme_disconnect(_adapter *adapter) -+{ -+ u8 val8; -+ -+ /* reject all data frames */ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(adapter, MI_LINKED) == _FALSE) -+#endif -+ rtw_write16(adapter, REG_RXFLTMAP2, 0x0000); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (adapter->hw_port == HW_PORT1) { -+ /* reset TSF1 */ -+ rtw_write8(adapter, REG_DUAL_TSF_RST, BIT(1)); -+ -+ /* disable update TSF1 */ -+ rtw_iface_disable_tsf_update(adapter); -+ -+ if (!IS_HARDWARE_TYPE_8723D(adapter) -+ && !IS_HARDWARE_TYPE_8192F(adapter) -+ && !IS_HARDWARE_TYPE_8710B(adapter) -+ ) { -+ /* disable Port1's beacon function */ -+ val8 = rtw_read8(adapter, REG_BCN_CTRL_1); -+ val8 &= ~EN_BCN_FUNCTION; -+ rtw_write8(adapter, REG_BCN_CTRL_1, val8); -+ } -+ } else -+#endif -+ { -+ /* reset TSF */ -+ rtw_write8(adapter, REG_DUAL_TSF_RST, BIT(0)); -+ -+ /* disable update TSF */ -+ rtw_iface_disable_tsf_update(adapter); -+ } -+} -+#endif -+ -+static void hw_var_set_mlme_sitesurvey(_adapter *adapter, u8 enable) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u16 value_rxfltmap2; -+ -+#ifdef DBG_IFACE_STATUS -+ DBG_IFACE_STATUS_DUMP(adapter); -+#endif -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ /* Receive all data frames */ -+ value_rxfltmap2 = 0xFFFF; -+#else -+ /* not to receive data frame */ -+ value_rxfltmap2 = 0; -+#endif -+ -+ if (enable) { /* 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(adapter, REG_RXFLTMAP2, value_rxfltmap2); -+ -+ rtw_hal_rcr_set_chk_bssid(adapter, MLME_SCAN_ENTER); -+ -+ /* Save orignal RRSR setting, only 8812 set RRSR after set ch/bw/band */ -+ #if defined (CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ hal_data->RegRRSR = rtw_read32(adapter, REG_RRSR); -+ hal_data->RegRRSR &= 0x000FFFFF; -+ #endif -+ -+ #if defined(CONFIG_BEAMFORMING) && (defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A)) -+ if (IS_8812_SERIES(hal_data->version_id) || IS_8821_SERIES(hal_data->version_id)) { -+ /* set 718[1:0]=2'b00 to avoid BF scan hang */ -+ hal_data->backup_snd_ptcl_ctrl = rtw_read8(adapter, REG_SND_PTCL_CTRL_8812A); -+ rtw_write8(adapter, REG_SND_PTCL_CTRL_8812A, (hal_data->backup_snd_ptcl_ctrl & 0xfc)); -+ } -+ #endif -+ -+ if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) -+ StopTxBeacon(adapter); -+ } 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(adapter, WIFI_ASOC_STATE | WIFI_AP_STATE | WIFI_MESH_STATE)) { -+ /* enable to rx data frame */ -+ rtw_write16(adapter, REG_RXFLTMAP2, 0xFFFF); -+ } -+ -+ rtw_hal_rcr_set_chk_bssid(adapter, MLME_SCAN_DONE); -+ -+ /* Restore orignal RRSR setting,only 8812 set RRSR after set ch/bw/band */ -+ #if defined (CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ rtw_phydm_set_rrsr(adapter, hal_data->RegRRSR, TRUE); -+ #endif -+ -+ #if defined(CONFIG_BEAMFORMING) && (defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A)) -+ if (IS_8812_SERIES(hal_data->version_id) || IS_8821_SERIES(hal_data->version_id)) { -+ /* Restore orignal 0x718 setting*/ -+ rtw_write8(adapter, REG_SND_PTCL_CTRL_8812A, hal_data->backup_snd_ptcl_ctrl); -+ } -+ #endif -+ -+ #ifdef CONFIG_AP_MODE -+ if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) { -+ ResumeTxBeacon(adapter); -+ rtw_mi_tx_beacon_hdl(adapter); -+ } -+ #endif -+ } -+} -+ -+#ifndef CONFIG_HAS_HW_VAR_MLME_JOIN -+static void hw_var_set_mlme_join(_adapter *adapter, u8 type) -+{ -+ u8 val8; -+ u16 val16; -+ u32 val32; -+ u8 RetryLimit = RL_VAL_STA; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (type == 0) { -+ /* prepare to join */ -+ if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) -+ StopTxBeacon(adapter); -+ -+ /* enable to rx data frame.Accept all data frame */ -+ rtw_write16(adapter, REG_RXFLTMAP2, 0xFFFF); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ RetryLimit = (hal_data->CustomerID == RT_CID_CCX) ? RL_VAL_AP : RL_VAL_STA; -+ else /* Ad-hoc Mode */ -+ RetryLimit = RL_VAL_AP; -+ -+ rtw_iface_enable_tsf_update(adapter); -+ -+ } else if (type == 1) { -+ /* joinbss_event call back when join res < 0 */ -+ if (rtw_mi_check_status(adapter, MI_LINKED) == _FALSE) -+ rtw_write16(adapter, REG_RXFLTMAP2, 0x00); -+ -+ rtw_iface_disable_tsf_update(adapter); -+ -+ if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) { -+ ResumeTxBeacon(adapter); -+ -+ /* reset TSF 1/2 after ResumeTxBeacon */ -+ rtw_write8(adapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); -+ } -+ -+ } else if (type == 2) { -+ /* sta add event call back */ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { -+ /* fixed beacon issue for 8191su........... */ -+ rtw_write8(adapter, 0x542 , 0x02); -+ RetryLimit = RL_VAL_AP; -+ } -+ -+ if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) { -+ ResumeTxBeacon(adapter); -+ -+ /* reset TSF 1/2 after ResumeTxBeacon */ -+ rtw_write8(adapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); -+ } -+ } -+ -+ val16 = BIT_SRL(RetryLimit) | BIT_LRL(RetryLimit); -+ rtw_write16(adapter, REG_RETRY_LIMIT, val16); -+#else /* !CONFIG_CONCURRENT_MODE */ -+ if (type == 0) { /* prepare to join */ -+ /* enable to rx data frame.Accept all data frame */ -+ rtw_write16(adapter, REG_RXFLTMAP2, 0xFFFF); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ RetryLimit = (hal_data->CustomerID == RT_CID_CCX) ? RL_VAL_AP : RL_VAL_STA; -+ else /* Ad-hoc Mode */ -+ RetryLimit = RL_VAL_AP; -+ -+ rtw_iface_enable_tsf_update(adapter); -+ -+ } else if (type == 1) { /* joinbss_event call back when join res < 0 */ -+ rtw_write16(adapter, REG_RXFLTMAP2, 0x00); -+ -+ rtw_iface_disable_tsf_update(adapter); -+ -+ } else if (type == 2) { /* sta add event call back */ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) -+ RetryLimit = RL_VAL_AP; -+ } -+ -+ val16 = BIT_SRL(RetryLimit) | BIT_LRL(RetryLimit); -+ rtw_write16(adapter, REG_RETRY_LIMIT, val16); -+#endif /* !CONFIG_CONCURRENT_MODE */ -+} -+#endif -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+static int rtw_hal_h2c_reset_tsf(_adapter *adapter, u8 reset_port) -+{ -+ u8 buf[2]; -+ int ret; -+ -+ if (reset_port == HW_PORT0) { -+ buf[0] = 0x1; -+ buf[1] = 0; -+ } else { -+ buf[0] = 0x0; -+ buf[1] = 0x1; -+ } -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_RESET_TSF, 2, buf); -+ -+ return ret; -+} -+ -+int rtw_hal_reset_tsf(_adapter *adapter, u8 reset_port) -+{ -+ u8 reset_cnt_before = 0, reset_cnt_after = 0, loop_cnt = 0; -+ u32 reg_reset_tsf_cnt = (reset_port == HW_PORT0) ? -+ REG_FW_RESET_TSF_CNT_0 : REG_FW_RESET_TSF_CNT_1; -+ int ret; -+ -+ /* site survey will cause reset tsf fail */ -+ rtw_mi_buddy_scan_abort(adapter, _FALSE); -+ reset_cnt_after = reset_cnt_before = rtw_read8(adapter, reg_reset_tsf_cnt); -+ ret = rtw_hal_h2c_reset_tsf(adapter, reset_port); -+ if (ret != _SUCCESS) -+ return ret; -+ -+ 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 : _SUCCESS; -+} -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+ -+#ifndef CONFIG_HAS_HW_VAR_CORRECT_TSF -+#ifdef CONFIG_HW_P0_TSF_SYNC -+#ifdef CONFIG_CONCURRENT_MODE -+static void hw_port0_tsf_sync_sel(_adapter *adapter, u8 benable, u8 hw_port, u16 tr_offset) -+{ -+ u8 val8; -+ u8 client_id = 0; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(adapter) && (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC))) { -+ RTW_INFO("[MCC] do not set HW TSF sync\n"); -+ return; -+ } -+#endif -+ /* check if port0 is already synced */ -+ if (benable && dvobj->p0_tsf.sync_port != MAX_HW_PORT && dvobj->p0_tsf.sync_port == hw_port) { -+ RTW_WARN(FUNC_ADPT_FMT ": port0 already enable TSF sync(%d)\n", -+ FUNC_ADPT_ARG(adapter), dvobj->p0_tsf.sync_port); -+ return; -+ } -+ -+ /* check if port0 already disable sync */ -+ if (!benable && dvobj->p0_tsf.sync_port == MAX_HW_PORT) { -+ RTW_WARN(FUNC_ADPT_FMT ": port0 already disable TSF sync\n", FUNC_ADPT_ARG(adapter)); -+ return; -+ } -+ -+ /* check if port0 sync to port0 */ -+ if (benable && hw_port == HW_PORT0) { -+ RTW_ERR(FUNC_ADPT_FMT ": hw_port is port0 under enable\n", FUNC_ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ /*0x5B4 [6:4] :SYNC_CLI_SEL - The selector for the CLINT port of sync tsft source for port 0*/ -+ /* Bit[5:4] : 0 for clint0, 1 for clint1, 2 for clint2, 3 for clint3. -+ Bit6 : 1= enable sync to port 0. 0=disable sync to port 0.*/ -+ -+ val8 = rtw_read8(adapter, REG_TIMER0_SRC_SEL); -+ -+ if (benable) { -+ /*Disable Port0's beacon function*/ -+ rtw_write8(adapter, REG_BCN_CTRL, rtw_read8(adapter, REG_BCN_CTRL) & ~BIT_EN_BCN_FUNCTION); -+ -+ /*Reg 0x518[15:0]: TSFTR_SYN_OFFSET*/ -+ if (tr_offset) -+ rtw_write16(adapter, REG_TSFTR_SYN_OFFSET, tr_offset); -+ -+ /*reg 0x577[6]=1*/ /*auto sync by tbtt*/ -+ rtw_write8(adapter, REG_MISC_CTRL, rtw_read8(adapter, REG_MISC_CTRL) | BIT_AUTO_SYNC_BY_TBTT); -+ -+ if (HW_PORT1 == hw_port) -+ client_id = 0; -+ else if (HW_PORT2 == hw_port) -+ client_id = 1; -+ else if (HW_PORT3 == hw_port) -+ client_id = 2; -+ else if (HW_PORT4 == hw_port) -+ client_id = 3; -+ -+ val8 &= 0x8F; -+ val8 |= (BIT(6) | (client_id << 4)); -+ -+ dvobj->p0_tsf.sync_port = hw_port; -+ dvobj->p0_tsf.offset = tr_offset; -+ rtw_write8(adapter, REG_TIMER0_SRC_SEL, val8); -+ -+ /*Enable Port0's beacon function*/ -+ rtw_write8(adapter, REG_BCN_CTRL, rtw_read8(adapter, REG_BCN_CTRL) | BIT_EN_BCN_FUNCTION); -+ RTW_INFO("%s Port_%d TSF sync to P0, timer offset :%d\n", __func__, hw_port, tr_offset); -+ } else { -+ val8 &= ~BIT(6); -+ -+ dvobj->p0_tsf.sync_port = MAX_HW_PORT; -+ dvobj->p0_tsf.offset = 0; -+ rtw_write8(adapter, REG_TIMER0_SRC_SEL, val8); -+ RTW_INFO("%s P0 TSF sync disable\n", __func__); -+ } -+} -+static _adapter * _search_ld_sta(_adapter *adapter, u8 include_self) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 i; -+ _adapter *iface = NULL; -+ -+ if (rtw_mi_get_assoced_sta_num(adapter) == 0) { -+ RTW_ERR("STA_LD_NUM == 0\n"); -+ rtw_warn_on(1); -+ } -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ if (include_self == _FALSE && adapter == iface) -+ continue; -+ if (is_client_associated_to_ap(iface)) -+ break; -+ } -+ if (iface) -+ RTW_INFO("search STA iface -"ADPT_FMT"\n", ADPT_ARG(iface)); -+ return iface; -+} -+#endif /*CONFIG_CONCURRENT_MODE*/ -+/*Correct port0's TSF*/ -+/*#define DBG_P0_TSF_SYNC*/ -+void hw_var_set_correct_tsf(PADAPTER adapter, u8 mlme_state) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ _adapter *sta_if = NULL; -+ u8 hw_port; -+ -+ RTW_INFO(FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(adapter)); -+ #ifdef DBG_P0_TSF_SYNC -+ RTW_INFO("[TSF_SYNC] AP_NUM = %d\n", rtw_mi_get_ap_num(adapter)); -+ RTW_INFO("[TSF_SYNC] MESH_NUM = %d\n", rtw_mi_get_mesh_num(adapter)); -+ RTW_INFO("[TSF_SYNC] LD_STA_NUM = %d\n", rtw_mi_get_assoced_sta_num(adapter)); -+ if (dvobj->p0_tsf.sync_port == MAX_HW_PORT) -+ RTW_INFO("[TSF_SYNC] org p0 sync port = N/A\n"); -+ else -+ RTW_INFO("[TSF_SYNC] org p0 sync port = %d\n", dvobj->p0_tsf.sync_port); -+ RTW_INFO("[TSF_SYNC] timer offset = %d\n", dvobj->p0_tsf.offset); -+ #endif -+ switch (mlme_state) { -+ case MLME_STA_CONNECTED : -+ { -+ hw_port = rtw_hal_get_port(adapter); -+ -+ if (!MLME_IS_STA(adapter)) { -+ RTW_ERR("STA CON state,but iface("ADPT_FMT") is not STA\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ } -+ -+ if ((dvobj->p0_tsf.sync_port != MAX_HW_PORT) && (hw_port == HW_PORT0)) { -+ RTW_ERR(ADPT_FMT" is STA with P0 connected => DIS P0_TSF_SYNC\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ hw_port0_tsf_sync_sel(adapter, _FALSE, 0, 0); -+ } -+ -+ if ((dvobj->p0_tsf.sync_port == MAX_HW_PORT) && -+ (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter))) { -+ hw_port0_tsf_sync_sel(adapter, _TRUE, hw_port, 50);/*timer offset 50ms*/ -+ #ifdef DBG_P0_TSF_SYNC -+ RTW_INFO("[TSF_SYNC] STA_LINKED => EN P0_TSF_SYNC\n"); -+ #endif -+ } -+ } -+ break; -+ case MLME_STA_DISCONNECTED : -+ { -+ hw_port = rtw_hal_get_port(adapter); -+ -+ if (!MLME_IS_STA(adapter)) { -+ RTW_ERR("STA DIS_CON state,but iface("ADPT_FMT") is not STA\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ } -+ -+ if (dvobj->p0_tsf.sync_port == hw_port) { -+ if (rtw_mi_get_assoced_sta_num(adapter) >= 2) { -+ /* search next appropriate sta*/ -+ sta_if = _search_ld_sta(adapter, _FALSE); -+ if (sta_if) { -+ hw_port = rtw_hal_get_port(sta_if); -+ hw_port0_tsf_sync_sel(adapter, _TRUE, hw_port, 50);/*timer offset 50ms*/ -+ #ifdef DBG_P0_TSF_SYNC -+ RTW_INFO("[TSF_SYNC] STA_DIS_CON => CHANGE P0_TSF_SYNC\n"); -+ #endif -+ } -+ } else if (rtw_mi_get_assoced_sta_num(adapter) == 1) { -+ hw_port0_tsf_sync_sel(adapter, _FALSE, 0, 0); -+ #ifdef DBG_P0_TSF_SYNC -+ RTW_INFO("[TSF_SYNC] STA_DIS_CON => DIS P0_TSF_SYNC\n"); -+ #endif -+ } -+ } -+ } -+ break; -+#ifdef CONFIG_AP_MODE -+ case MLME_AP_STARTED : -+ case MLME_MESH_STARTED : -+ { -+ if (!(MLME_IS_AP(adapter) || MLME_IS_MESH(adapter))) { -+ RTW_ERR("AP START state,but iface("ADPT_FMT") is not AP\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ } -+ -+ if ((dvobj->p0_tsf.sync_port == MAX_HW_PORT) && -+ rtw_mi_get_assoced_sta_num(adapter)) { -+ /* get port of sta */ -+ sta_if = _search_ld_sta(adapter, _FALSE); -+ if (sta_if) { -+ hw_port = rtw_hal_get_port(sta_if); -+ hw_port0_tsf_sync_sel(adapter, _TRUE, hw_port, 50);/*timer offset 50ms*/ -+ #ifdef DBG_P0_TSF_SYNC -+ RTW_INFO("[TSF_SYNC] AP_START => EN P0_TSF_SYNC\n"); -+ #endif -+ } -+ } -+ } -+ break; -+ case MLME_AP_STOPPED : -+ case MLME_MESH_STOPPED : -+ { -+ if (!(MLME_IS_AP(adapter) || MLME_IS_MESH(adapter))) { -+ RTW_ERR("AP START state,but iface("ADPT_FMT") is not AP\n", ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ } -+ /*stop ap mode*/ -+ if ((rtw_mi_get_ap_num(adapter) + rtw_mi_get_mesh_num(adapter) == 1) && -+ (dvobj->p0_tsf.sync_port != MAX_HW_PORT)) { -+ hw_port0_tsf_sync_sel(adapter, _FALSE, 0, 0); -+ #ifdef DBG_P0_TSF_SYNC -+ RTW_INFO("[TSF_SYNC] AP_STOP => DIS P0_TSF_SYNC\n"); -+ #endif -+ } -+ } -+ break; -+#endif /* CONFIG_AP_MODE */ -+ default : -+ RTW_ERR(FUNC_ADPT_FMT" unknow state(0x%02x)\n", FUNC_ADPT_ARG(adapter), mlme_state); -+ break; -+ } -+ -+ /*#ifdef DBG_P0_TSF_SYNC*/ -+ #if 1 -+ if (dvobj->p0_tsf.sync_port == MAX_HW_PORT) -+ RTW_INFO("[TSF_SYNC] p0 sync port = N/A\n"); -+ else -+ RTW_INFO("[TSF_SYNC] p0 sync port = %d\n", dvobj->p0_tsf.sync_port); -+ RTW_INFO("[TSF_SYNC] timer offset = %d\n", dvobj->p0_tsf.offset); -+ #endif -+#endif /*CONFIG_CONCURRENT_MODE*/ -+} -+ -+#else /*! CONFIG_HW_P0_TSF_SYNC*/ -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+static void hw_var_set_correct_tsf(_adapter *adapter, u8 mlme_state) -+{ -+ /*do nothing*/ -+} -+#else /* !CONFIG_MI_WITH_MBSSID_CAM*/ -+static 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)); -+#if defined(CONFIG_RTL8192F) -+ rtw_write16(padapter, REG_WLAN_ACT_MASK_CTRL_1, rtw_read16(padapter, -+ REG_WLAN_ACT_MASK_CTRL_1) & ~EN_PORT_0_FUNCTION); -+#endif -+ -+ 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); -+#if defined(CONFIG_RTL8192F) -+ rtw_write16(padapter, REG_WLAN_ACT_MASK_CTRL_1, rtw_read16(padapter, -+ REG_WLAN_ACT_MASK_CTRL_1) | EN_PORT_0_FUNCTION); -+#endif -+ } 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)); -+#if defined(CONFIG_RTL8192F) -+ rtw_write16(padapter, REG_WLAN_ACT_MASK_CTRL_1, rtw_read16(padapter, -+ REG_WLAN_ACT_MASK_CTRL_1) & ~EN_PORT_1_FUNCTION); -+#endif -+ -+ 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); -+#if defined(CONFIG_RTL8192F) -+ rtw_write16(padapter, REG_WLAN_ACT_MASK_CTRL_1, rtw_read16(padapter, -+ REG_WLAN_ACT_MASK_CTRL_1) | EN_PORT_1_FUNCTION); -+#endif -+ } else -+ RTW_INFO("%s-[WARN] "ADPT_FMT" invalid hw_port:%d\n", __func__, ADPT_ARG(padapter), hw_port); -+} -+static void hw_var_set_correct_tsf(_adapter *adapter, u8 mlme_state) -+{ -+ u64 tsf; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info); -+ -+ tsf = mlmeext->TSFValue - rtw_modular64(mlmeext->TSFValue, (mlmeinfo->bcn_interval * 1024)) - 1024; /*us*/ -+ -+ if ((mlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE -+ || (mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) -+ StopTxBeacon(adapter); -+ -+ rtw_hal_correct_tsf(adapter, adapter->hw_port, tsf); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ /* Update buddy port's TSF if it is SoftAP/Mesh for beacon TX issue! */ -+ if ((mlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE -+ && (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) -+ ) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int i; -+ _adapter *iface; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ if (iface == adapter) -+ continue; -+ -+ #ifdef CONFIG_AP_MODE -+ if ((MLME_IS_AP(iface) || MLME_IS_MESH(iface)) -+ && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE -+ ) { -+ rtw_hal_correct_tsf(iface, iface->hw_port, tsf); -+ #ifdef CONFIG_TSF_RESET_OFFLOAD -+ if (rtw_hal_reset_tsf(iface, iface->hw_port) == _FAIL) -+ RTW_INFO("%s-[ERROR] "ADPT_FMT" Reset port%d TSF fail\n" -+ , __func__, ADPT_ARG(iface), iface->hw_port); -+ #endif /* CONFIG_TSF_RESET_OFFLOAD*/ -+ #ifdef CONFIG_TSF_SYNC -+ if(iface->hw_port == HW_PORT0) -+ rtw_write8(iface, REG_DUAL_TSF_RST, rtw_read8(iface, REG_DUAL_TSF_RST) | BIT(2)); -+ else if(iface->hw_port == HW_PORT1) -+ rtw_write8(iface, REG_DUAL_TSF_RST, rtw_read8(iface, REG_DUAL_TSF_RST) | BIT(3)); -+ #endif -+ } -+ #endif /* CONFIG_AP_MODE */ -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ if ((mlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE -+ || (mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) -+ ResumeTxBeacon(adapter); -+} -+#endif /*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ -+#endif /*#ifdef CONFIG_HW_P0_TSF_SYNC*/ -+#endif /*#ifndef CONFIG_HAS_HW_VAR_CORRECT_TSF*/ -+ -+u64 rtw_hal_get_tsftr_by_port(_adapter *adapter, u8 port) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u64 tsftr = 0; -+ -+ if (port >= hal_spec->port_num) { -+ RTW_ERR("%s invalid port(%d) \n", __func__, port); -+ goto exit; -+ } -+ -+ switch (rtw_get_chip_type(adapter)) { -+#if defined(CONFIG_RTL8814B) -+ case RTL8814B: -+ { -+ u8 val8; -+ -+ /* 0x1500[6:4] - BIT_BCN_TIMER_SEL_FWRD_V1 */ -+ val8 = rtw_read8(adapter, REG_PORT_CTRL_SEL); -+ val8 &= ~0x70; -+ val8 |= port << 4; -+ rtw_write8(adapter, REG_PORT_CTRL_SEL, val8); -+ -+ tsftr = rtw_read32(adapter, REG_TSFTR_HIGH); -+ tsftr = tsftr << 32; -+ tsftr |= rtw_read32(adapter, REG_TSFTR_LOW); -+ -+ break; -+ } -+#endif -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) -+ case RTL8814A: -+ case RTL8822B: -+ case RTL8821C: -+ case RTL8822C: -+ { -+ u8 val8; -+ -+ /* 0x554[30:28] - BIT_BCN_TIMER_SEL_FWRD */ -+ val8 = rtw_read8(adapter, REG_MBSSID_BCN_SPACE + 3); -+ val8 &= 0x8F; -+ val8 |= port << 4; -+ rtw_write8(adapter, REG_MBSSID_BCN_SPACE + 3, val8); -+ -+ tsftr = rtw_read32(adapter, REG_TSFTR + 4); -+ tsftr = tsftr << 32; -+ tsftr |= rtw_read32(adapter, REG_TSFTR); -+ -+ break; -+ } -+#endif -+#if defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) \ -+ || defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8192F) \ -+ || defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || defined(CONFIG_RTL8723D) \ -+ || defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) \ -+ || defined(CONFIG_RTL8710B) -+ case RTL8188E: -+ case RTL8188F: -+ case RTL8188GTV: -+ case RTL8192E: -+ case RTL8192F: -+ case RTL8723B: -+ case RTL8703B: -+ case RTL8723D: -+ case RTL8812: -+ case RTL8821: -+ case RTL8710B: -+ { -+ u32 addr; -+ -+ if (port == HW_PORT0) -+ addr = REG_TSFTR; -+ else if (port == HW_PORT1) -+ addr = REG_TSFTR1; -+ else { -+ RTW_ERR("%s unknown port(%d) \n", __func__, port); -+ goto exit; -+ } -+ -+ tsftr = rtw_read32(adapter, addr + 4); -+ tsftr = tsftr << 32; -+ tsftr |= rtw_read32(adapter, addr); -+ -+ break; -+ } -+#endif -+ default: -+ RTW_ERR("%s unknow chip type\n", __func__); -+ } -+ -+exit: -+ return tsftr; -+} -+ -+#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->rfe_type); -+ -+ return rtw_hal_fill_h2c_cmd(padapter, H2C_CHNL_SWITCH_OPER_OFFLOAD, sizeof(ch_sw_h2c_buf), ch_sw_h2c_buf); -+} -+#endif -+#endif -+ -+#ifdef CONFIG_WMMPS_STA -+void rtw_hal_update_uapsd_tid(_adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ -+ /* write complement of pqospriv->uapsd_tid to mac register 0x693 because -+ it's designed for "0" represents "enable" and "1" represents "disable" */ -+ rtw_write8(adapter, REG_WMMPS_UAPSD_TID, (u8)(~pqospriv->uapsd_tid)); -+} -+#endif /* CONFIG_WMMPS_STA */ -+ -+#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) -+/* For multi-port support, driver needs to inform the port ID to FW for btc operations */ -+s32 rtw_hal_set_wifi_btc_port_id_cmd(_adapter *adapter) -+{ -+ u8 h2c_buf[H2C_BTC_WL_PORT_ID_LEN] = {0}; -+ u8 hw_port = rtw_hal_get_port(adapter); -+ -+ SET_H2CCMD_BTC_WL_PORT_ID(h2c_buf, hw_port); -+ RTW_INFO("%s ("ADPT_FMT") - hw_port :%d\n", __func__, ADPT_ARG(adapter), hw_port); -+ return rtw_hal_fill_h2c_cmd(adapter, H2C_BTC_WL_PORT_ID, H2C_BTC_WL_PORT_ID_LEN, h2c_buf); -+} -+#endif -+ -+#define LPS_ACTIVE_TIMEOUT 50 /*number of times*/ -+void rtw_lps_state_chk(_adapter *adapter, u8 ps_mode) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta = NULL; -+ u8 ps_ready = _FALSE; -+ s8 leave_wait_count = LPS_ACTIVE_TIMEOUT; -+ -+ if (ps_mode == PS_MODE_ACTIVE) { -+#ifdef CONFIG_LPS_ACK -+ if (rtw_sctx_wait(&pwrpriv->lps_ack_sctx, __func__)) { -+ if (pwrpriv->lps_ack_status > 0) { -+ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); -+ if (psta != NULL) { -+ if(issue_nulldata(adapter, psta->cmn.mac_addr, PS_MODE_ACTIVE, 3, 1) == _FAIL) -+ RTW_INFO(FUNC_ADPT_FMT" LPS state sync not yet finished.\n", FUNC_ADPT_ARG(adapter)); -+ } -+ } -+ } else { -+ RTW_WARN("LPS sctx query timeout, operation abort!!\n"); -+ return; -+ } -+ pwrpriv->lps_ack_status = -1; -+#else -+ do { -+ if ((rtw_read8(adapter, REG_TCR) & BIT_PWRBIT_OW_EN) == 0) { -+ ps_ready = _TRUE; -+ break; -+ } -+ rtw_msleep_os(1); -+ } while (leave_wait_count--); -+ -+ if (ps_ready == _FALSE) { -+ RTW_WARN(FUNC_ADPT_FMT" Power Bit Control is still in HW!\n", FUNC_ADPT_ARG(adapter)); -+ return; -+ } -+#endif /* CONFIG_LPS_ACK */ -+ } -+ } -+ -+void rtw_var_set_basic_rate(PADAPTER padapter, u8 *val) { -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ 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); -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ u16 rrsr_5g_force_mask = (RRSR_6M); -+ u16 rrsr_5g_allow_mask = (RRSR_OFDM_RATES); -+ #endif -+ u32 temp_RRSR; -+ -+ HalSetBrateCfg(padapter, val, &BrateCfg); -+ input_b = BrateCfg; -+ -+ /* apply force and allow mask */ -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ if (pHalData->current_band_type != BAND_ON_2_4G) { -+ BrateCfg |= rrsr_5g_force_mask; -+ BrateCfg &= rrsr_5g_allow_mask; -+ } else -+ #endif -+ { /* 2.4G */ -+ 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; -+ -+#ifdef CONFIG_NARROWBAND_SUPPORTING -+ if ((padapter->registrypriv.rtw_nb_config == RTW_NB_CONFIG_WIDTH_10) -+ || (padapter->registrypriv.rtw_nb_config == RTW_NB_CONFIG_WIDTH_5)) { -+ BrateCfg &= ~RRSR_CCK_RATES; -+ BrateCfg |= RRSR_6M; -+ } -+#endif -+ pHalData->BasicRateSet = BrateCfg; -+ -+ RTW_INFO("HW_VAR_BASIC_RATE: %#x->%#x->%#x\n", input_b, masked, ioted); -+ -+ /* Set RRSR rate table. */ -+ temp_RRSR = rtw_read32(padapter, REG_RRSR); -+ temp_RRSR &=0xFFFF0000; -+ temp_RRSR |=BrateCfg; -+ rtw_phydm_set_rrsr(padapter, temp_RRSR, TRUE); -+ -+ rtw_write8(padapter, REG_RRSR + 2, rtw_read8(padapter, REG_RRSR + 2) & 0xf0); -+ -+ #if defined(CONFIG_RTL8188E) -+ rtw_hal_set_hwreg(padapter, HW_VAR_INIT_RTS_RATE, (u8 *)&BrateCfg); -+ #endif -+} -+ -+u8 SetHwReg(_adapter *adapter, u8 variable, u8 *val) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 ret = _SUCCESS; -+ -+ switch (variable) { -+ case HW_VAR_MEDIA_STATUS: { -+ u8 net_type = *((u8 *)val); -+ -+ rtw_hal_set_msr(adapter, net_type); -+ } -+ break; -+ case HW_VAR_DO_IQK: -+ if (*val) -+ hal_data->bNeedIQK = _TRUE; -+ else -+ hal_data->bNeedIQK = _FALSE; -+ 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; -+ case HW_VAR_RCR: -+ ret = hw_var_rcr_config(adapter, *((u32 *)val)); -+ break; -+ case HW_VAR_ON_RCR_AM: -+ hw_var_set_rcr_am(adapter, 1); -+ break; -+ case HW_VAR_OFF_RCR_AM: -+ hw_var_set_rcr_am(adapter, 0); -+ break; -+ case HW_VAR_BEACON_INTERVAL: -+ hw_var_set_bcn_interval(adapter, *(u16 *)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_hal_rcr_add(adapter, RCR_ENMBID); -+ else -+ rtw_hal_rcr_clear(adapter, RCR_ENMBID); -+ 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->version_id; -+ -+ 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)*/ -+ -+#ifndef CONFIG_HAS_HW_VAR_BCN_FUNC -+ case HW_VAR_BCN_FUNC: -+ hw_var_set_bcn_func(adapter, *val); -+ break; -+#endif -+ -+#ifndef CONFIG_HAS_HW_VAR_MLME_DISCONNECT -+ case HW_VAR_MLME_DISCONNECT: -+ hw_var_set_mlme_disconnect(adapter); -+ break; -+#endif -+ -+ case HW_VAR_MLME_SITESURVEY: -+ hw_var_set_mlme_sitesurvey(adapter, *val); -+ #ifdef CONFIG_BT_COEXIST -+ if (hal_data->EEPROMBluetoothCoexist == 1) -+ rtw_btcoex_ScanNotify(adapter, *val ? _TRUE : _FALSE); -+ #endif -+ break; -+ -+#ifndef CONFIG_HAS_HW_VAR_MLME_JOIN -+ case HW_VAR_MLME_JOIN: -+ hw_var_set_mlme_join(adapter, *val); -+ break; -+#endif -+ -+ case HW_VAR_EN_HW_UPDATE_TSF: -+ rtw_hal_set_hw_update_tsf(adapter); -+ break; -+#ifndef CONFIG_HAS_HW_VAR_CORRECT_TSF -+ case HW_VAR_CORRECT_TSF: -+ hw_var_set_correct_tsf(adapter, *val); -+ break; -+#endif -+ -+#if defined(CONFIG_HW_P0_TSF_SYNC) && defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_MCC_MODE) -+ case HW_VAR_TSF_AUTO_SYNC: -+ if (*val == _TRUE) -+ hw_port0_tsf_sync_sel(adapter, _TRUE, adapter->hw_port, 50); -+ else -+ hw_port0_tsf_sync_sel(adapter, _FALSE, adapter->hw_port, 50); -+ break; -+#endif -+ case HW_VAR_APFM_ON_MAC: -+ hal_data->bMacPwrCtrlOn = *val; -+ RTW_INFO("%s: bMacPwrCtrlOn=%d\n", __func__, hal_data->bMacPwrCtrlOn); -+ break; -+#ifdef CONFIG_WMMPS_STA -+ case HW_VAR_UAPSD_TID: -+ rtw_hal_update_uapsd_tid(adapter); -+ break; -+#endif /* CONFIG_WMMPS_STA */ -+#ifdef CONFIG_LPS_PG -+ case HW_VAR_LPS_PG_HANDLE: -+ rtw_hal_lps_pg_handler(adapter, *val); -+ break; -+#endif -+#ifdef CONFIG_LPS_LCLK_WD_TIMER -+ case HW_VAR_DM_IN_LPS_LCLK: -+ rtw_phydm_wd_lps_lclk_hdl(adapter); -+ break; -+#endif -+ case HW_VAR_ENABLE_RX_BAR: -+ if (*val == _TRUE) { -+ /* enable RX BAR */ -+ u16 val16 = rtw_read16(adapter, REG_RXFLTMAP1); -+ -+ val16 |= BIT(8); -+ rtw_write16(adapter, REG_RXFLTMAP1, val16); -+ } else { -+ /* disable RX BAR */ -+ u16 val16 = rtw_read16(adapter, REG_RXFLTMAP1); -+ -+ val16 &= (~BIT(8)); -+ rtw_write16(adapter, REG_RXFLTMAP1, val16); -+ } -+ RTW_INFO("[HW_VAR_ENABLE_RX_BAR] 0x%02X=0x%02X\n", -+ REG_RXFLTMAP1, rtw_read16(adapter, REG_RXFLTMAP1)); -+ break; -+ case HW_VAR_HCI_SUS_STATE: -+ hal_data->hci_sus_state = *(u8 *)val; -+ RTW_INFO("%s: hci_sus_state=%u\n", __func__, hal_data->hci_sus_state); -+ break; -+#if defined(CONFIG_AP_MODE) && defined(CONFIG_FW_HANDLE_TXBCN) && defined(CONFIG_SUPPORT_MULTI_BCN) -+ case HW_VAR_BCN_HEAD_SEL: -+ { -+ u8 vap_id = *(u8 *)val; -+ -+ if ((vap_id >= CONFIG_LIMITED_AP_NUM) && (vap_id != 0xFF)) { -+ RTW_ERR(ADPT_FMT " vap_id(%d:%d) is invalid\n", ADPT_ARG(adapter),vap_id, adapter->vap_id); -+ rtw_warn_on(1); -+ } -+ if (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { -+ u16 drv_pg_bndy = 0, bcn_addr = 0; -+ u32 page_size = 0; -+ -+ /*rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_BOUNDARY, &drv_pg_bndy);*/ -+ rtw_halmac_get_rsvd_drv_pg_bndy(adapter_to_dvobj(adapter), &drv_pg_bndy); -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&page_size); -+ -+ if (vap_id != 0xFF) -+ bcn_addr = drv_pg_bndy + (vap_id * (MAX_BEACON_LEN / page_size)); -+ else -+ bcn_addr = drv_pg_bndy; -+ RTW_INFO(ADPT_FMT" vap_id(%d) change BCN HEAD to 0x%04x\n", -+ ADPT_ARG(adapter), vap_id, bcn_addr); -+ rtw_write16(adapter, REG_FIFOPAGE_CTRL_2, -+ (bcn_addr & BIT_MASK_BCN_HEAD_1_V1) | BIT_BCN_VALID_V1); -+ } -+ } -+ break; -+#endif -+ case HW_VAR_LPS_STATE_CHK : -+ rtw_lps_state_chk(adapter, *(u8 *)val); -+ break; -+ -+#ifdef CONFIG_RTS_FULL_BW -+ case HW_VAR_SET_RTS_BW: -+ { -+ #ifdef RTW_HALMAC -+ rtw_halmac_set_rts_full_bw(adapter_to_dvobj(adapter), (*val)); -+ #else -+ u8 temp; -+ if(*val) -+ temp = (( rtw_read8(adapter, REG_INIRTS_RATE_SEL)) | BIT5 ); -+ else -+ temp = (( rtw_read8(adapter, REG_INIRTS_RATE_SEL)) & (~BIT5)); -+ rtw_write8(adapter, REG_INIRTS_RATE_SEL, temp); -+ /*RTW_INFO("HW_VAR_SET_RTS_BW val=%u REG480=0x%x\n", *val, rtw_read8(adapter, REG_INIRTS_RATE_SEL));*/ -+ #endif -+ } -+ break; -+#endif/*CONFIG_RTS_FULL_BW*/ -+#if defined(CONFIG_PCI_HCI) -+ case HW_VAR_ENSWBCN: -+ if (*val == _TRUE) { -+ rtw_write8(adapter, REG_CR + 1, -+ rtw_read8(adapter, REG_CR + 1) | BIT(0)); -+ } else -+ rtw_write8(adapter, REG_CR + 1, -+ rtw_read8(adapter, REG_CR + 1) & ~BIT(0)); -+ break; -+#endif -+ case HW_VAR_BCN_EARLY_C2H_RPT: -+ rtw_hal_set_fw_bcn_early_c2h_rpt_cmd(adapter, *(u8 *)val); -+ break; -+ default: -+ if (0) -+ RTW_PRINT(FUNC_ADPT_FMT" variable(%d) not defined!\n", -+ FUNC_ADPT_ARG(adapter), variable); -+ ret = _FAIL; -+ break; -+ } -+ -+ return ret; -+} -+ -+void GetHwReg(_adapter *adapter, u8 variable, u8 *val) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u64 val64; -+ -+ -+ switch (variable) { -+ case HW_VAR_MAC_ADDR: -+ #ifndef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_hal_get_macaddr_port(adapter, val); -+ #endif -+ break; -+ case HW_VAR_BASIC_RATE: -+ *((u16 *)val) = hal_data->BasicRateSet; -+ 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; -+ case HW_VAR_RCR: -+ hw_var_rcr_get(adapter, (u32 *)val); -+ break; -+ case HW_VAR_FWLPS_RF_ON: -+ /* When we halt NIC, we should check if FW LPS is leave. */ -+ if (rtw_is_surprise_removed(adapter) -+ || (adapter_to_pwrctl(adapter)->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 { -+ u32 rcr = 0; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); -+ if (rcr & (RCR_UC_MD_EN | RCR_BC_MD_EN | RCR_TIM_PARSER_EN)) -+ *val = _FALSE; -+ else -+ *val = _TRUE; -+ } -+ break; -+ -+ case HW_VAR_HCI_SUS_STATE: -+ *((u8 *)val) = hal_data->hci_sus_state; -+ break; -+ -+#ifndef CONFIG_HAS_HW_VAR_BCN_CTRL_ADDR -+ case HW_VAR_BCN_CTRL_ADDR: -+ *((u32 *)val) = hw_bcn_ctrl_addr(adapter, adapter->hw_port); -+ break; -+#endif -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ case HW_VAR_CAM_EMPTY_ENTRY: { -+ u8 ucIndex = *((u8 *)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); -+ 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(adapter, REG_CAMWRITE, ulContent); /* delay_ms(40); */ -+ rtw_write32(adapter, REG_CAMCMD, ulCommand); /* delay_ms(40); */ -+ } -+ } -+#endif -+ -+ default: -+ if (0) -+ RTW_PRINT(FUNC_ADPT_FMT" variable(%d) not defined!\n", -+ FUNC_ADPT_ARG(adapter), variable); -+ break; -+ } -+ -+} -+ -+static u32 _get_page_size(struct _ADAPTER *a) -+{ -+#ifdef RTW_HALMAC -+ struct dvobj_priv *d; -+ u32 size = 0; -+ int err = 0; -+ -+ -+ d = adapter_to_dvobj(a); -+ -+ err = rtw_halmac_get_page_size(d, &size); -+ if (!err) -+ return size; -+ -+ RTW_WARN(FUNC_ADPT_FMT ": Fail to get Page size!!(err=%d)\n", -+ FUNC_ADPT_ARG(a), err); -+#endif /* RTW_HALMAC */ -+ -+ return PAGE_SIZE_128; -+} -+ -+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; -+ 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; -+ -+} -+#ifdef RTW_BEAMFORMING_VERSION_2 -+void rtw_hal_beamforming_config_csirate(PADAPTER adapter) -+{ -+ struct dm_struct *p_dm_odm; -+ struct beamforming_info *bf_info; -+ u8 fix_rate_enable = 0; -+ u8 new_csi_rate_idx; -+ u8 rrsr_54_en; -+ u32 temp_rrsr; -+ -+ /* Acting as BFee */ -+ if (IS_BEAMFORMEE(adapter)) { -+ #if 0 -+ /* Do not enable now because it will affect MU performance and CTS/BA rate. 2016.07.19. by tynli. [PCIE-1660] */ -+ if (IS_HARDWARE_TYPE_8821C(Adapter)) -+ FixRateEnable = 1; /* Support after 8821C */ -+ #endif -+ -+ p_dm_odm = adapter_to_phydm(adapter); -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ rtw_halmac_bf_cfg_csi_rate(adapter_to_dvobj(adapter), -+ p_dm_odm->rssi_min, -+ bf_info->cur_csi_rpt_rate, -+ fix_rate_enable, &new_csi_rate_idx, &rrsr_54_en); -+ -+ temp_rrsr = rtw_read32(adapter, REG_RRSR); -+ if (rrsr_54_en == 1) -+ temp_rrsr |= RRSR_54M; -+ else if (rrsr_54_en == 0) -+ temp_rrsr &= ~RRSR_54M; -+ rtw_phydm_set_rrsr(adapter, temp_rrsr, FALSE); -+ -+ if (new_csi_rate_idx != bf_info->cur_csi_rpt_rate) -+ bf_info->cur_csi_rpt_rate = new_csi_rate_idx; -+ } -+} -+#endif -+#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->cmn.rssi_stat.rssi; -+ } -+ 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_TX_PAGE_SIZE: -+ *((u32 *)value) = _get_page_size(adapter); -+ break; -+ case HAL_DEF_TX_STBC: -+ #ifdef CONFIG_ALPHA_SMART_ANTENNA -+ *(u8 *)value = 0; -+ #else -+ *(u8 *)value = hal_data->max_tx_cnt > 1 ? 1 : 0; -+ #endif -+ 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; -+} -+ -+/* -+ * 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. -+ * */ -+BOOLEAN -+GetHexValueFromString( -+ char *szStr, -+ u32 *pu4bVal, -+ 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( -+ 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); -+ } -+ -+ if (*szScan < '0' || *szScan > '9') -+ return _FALSE; -+ -+ /* Parse each digit. */ -+ do { -+ (*pInteger) *= 10; -+ *pInteger += (*szScan - '0'); -+ -+ ++szScan; -+ ++(*pu4bMove); -+ -+ if (*szScan == '.') { -+ ++szScan; -+ ++(*pu4bMove); -+ -+ if (*szScan < '0' || *szScan > '9') -+ return _FALSE; -+ -+ *pFraction += (*szScan - '0') * 10; -+ ++szScan; -+ ++(*pu4bMove); -+ -+ if (*szScan >= '0' && *szScan <= '9') { -+ *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( -+ char *szStr -+) -+{ -+ if (*szStr == '/' && *(szStr + 1) == '/') -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+BOOLEAN -+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 on in the while loop */ -+BOOLEAN -+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); -+ c = In[(*Start)++]; -+ while (c != RightQualifier && c != '\0') -+ c = In[(*Start)++]; -+ -+ if (c == '\0') -+ return _FALSE; -+ -+ 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->version_id) || -+ IS_8188F(pHalData->version_id) || -+ IS_8188GTV(pHalData->version_id) || -+ IS_8812_SERIES(pHalData->version_id) || -+ IS_8821_SERIES(pHalData->version_id) || -+ IS_8723B_SERIES(pHalData->version_id) || -+ IS_8192E(pHalData->version_id) || -+ IS_8703B_SERIES(pHalData->version_id) || -+ IS_8723D_SERIES(pHalData->version_id) || -+ IS_8192F_SERIES(pHalData->version_id) || -+ IS_8822C_SERIES(pHalData->version_id)) { -+ 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; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(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 < hal_spec->rf_reg_path_num; rf_path++) { -+ if (!(GET_HAL_RX_PATH_BMP(padapter) & BIT(rf_path))) -+ continue; -+ 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; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(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 < hal_spec->rf_reg_path_num; rf_path++) { -+ if (!(GET_HAL_RX_PATH_BMP(padapter) & BIT(rf_path))) -+ continue; -+ _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) -+{ -+#define DBG_RX_DFRAME_RAW_DATA_UC 0 -+#define DBG_RX_DFRAME_RAW_DATA_BMC 1 -+#define DBG_RX_DFRAME_RAW_DATA_TYPES 2 -+ -+ _irqL irqL; -+ u8 isCCKrate, rf_path; -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ struct sta_recv_dframe_info *psta_dframe_info; -+ int i, j; -+ _list *plist, *phead; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 null_addr[ETH_ALEN] = {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) { -+ if ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) -+ && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) != _TRUE) -+ && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(padapter), ETH_ALEN) != _TRUE)) { -+ -+ RTW_PRINT_SEL(sel, "==============================\n"); -+ RTW_PRINT_SEL(sel, "macaddr =" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); -+ -+ for (j = 0; j < DBG_RX_DFRAME_RAW_DATA_TYPES; j++) { -+ if (j == DBG_RX_DFRAME_RAW_DATA_UC) { -+ psta_dframe_info = &psta->sta_dframe_info; -+ RTW_PRINT_SEL(sel, "\n"); -+ RTW_PRINT_SEL(sel, "Unicast:\n"); -+ } else if (j == DBG_RX_DFRAME_RAW_DATA_BMC) { -+ psta_dframe_info = &psta->sta_dframe_info_bmc; -+ RTW_PRINT_SEL(sel, "\n"); -+ RTW_PRINT_SEL(sel, "Broadcast/Multicast:\n"); -+ } -+ -+ isCCKrate = (psta_dframe_info->sta_data_rate <= DESC_RATE11M) ? TRUE : FALSE; -+ -+ RTW_PRINT_SEL(sel, "BW=%s, sgi =%d\n", ch_width_str(psta_dframe_info->sta_bw_mode), 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 < hal_spec->rf_reg_path_num; rf_path++) { -+ if (!(GET_HAL_RX_PATH_BMP(padapter) & BIT(rf_path))) -+ continue; -+ 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); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct sta_info *psta = prframe->u.hdr.psta; -+ struct phydm_phyinfo_struct *p_phy_info = &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 = p_phy_info->rx_pwdb_all; -+ psample_pkt_rssi->pwr_all = p_phy_info->recv_signal_power; -+ -+ for (rf_path = 0; rf_path < hal_spec->rf_reg_path_num; rf_path++) { -+ psample_pkt_rssi->mimo_signal_strength[rf_path] = p_phy_info->rx_mimo_signal_strength[rf_path]; -+ psample_pkt_rssi->mimo_signal_quality[rf_path] = p_phy_info->rx_mimo_signal_quality[rf_path]; -+ if (!isCCKrate) { -+ psample_pkt_rssi->ofdm_pwr[rf_path] = p_phy_info->rx_pwr[rf_path]; -+ psample_pkt_rssi->ofdm_snr[rf_path] = p_phy_info->rx_snr[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) { -+ if (IS_MCAST(get_ra(get_recvframe_data(prframe)))) -+ psta_dframe_info = &psta->sta_dframe_info_bmc; -+ else -+ psta_dframe_info = &psta->sta_dframe_info; -+ /*RTW_INFO("=>%s psta->cmn.mac_addr="MAC_FMT" !\n", -+ __FUNCTION__, MAC_ARG(psta->cmn.mac_addr));*/ -+ if ((_rtw_memcmp(psta->cmn.mac_addr, 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 < hal_spec->rf_reg_path_num; rf_path++) { -+ -+ psta_dframe_info->sta_mimo_signal_strength[rf_path] = (p_phy_info->rx_mimo_signal_strength[rf_path]);/*Percentage to dbm*/ -+ -+ if (!isCCKrate) { -+ psta_dframe_info->sta_ofdm_snr[rf_path] = p_phy_info->rx_snr[rf_path]; -+ psta_dframe_info->sta_RxPwr[rf_path] = p_phy_info->rx_pwr[rf_path]; -+ } -+ } -+ } -+ } -+ } -+#endif -+ } -+ -+} -+ -+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_RTL8188GTV -+ case RTL8188GTV: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8188GTVU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8188GTVS; -+ 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 */ -+ -+#ifdef CONFIG_RTL8710B -+ case RTL8710B: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8710B; -+ break; -+#endif -+ -+#ifdef CONFIG_RTL8192F -+ case RTL8192F: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8192FU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8192FS; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8192FE; -+ break; -+#endif /* CONFIG_RTL8192F */ -+ -+#ifdef CONFIG_RTL8822C -+ case RTL8822C: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8822CU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8822CS; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8822CE; -+ break; -+#endif /* CONFIG_RTL8822C */ -+ -+#ifdef CONFIG_RTL8814B -+ case RTL8814B: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8814BU; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8814BE; -+ break; -+#endif /* CONFIG_RTL8814B */ -+ -+#ifdef CONFIG_RTL8723F -+ case RTL8723F: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8723FU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8723FS; -+ break; -+#endif /* CONFIG_RTL8723F */ -+ } -+ -+ 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 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; -+ } -+ -+#ifdef CONFIG_RTW_DEBUG -+ if (hal_data->efuse_file_status == EFUSE_FILE_LOADED) -+ RTW_MAP_DUMP_SEL(RTW_DBGDUMP, "EFUSE FILE", hal_data->efuse_eeprom_data, mapsize); -+ else { -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mp_mode_check(padapter) && GET_EFUSE_UPDATE_ON(padapter)) -+ RTW_MAP_DUMP_SEL(RTW_DBGDUMP, "FAKE EFUSE", hal_data->efuse_eeprom_data, mapsize); -+ else -+#endif -+ RTW_MAP_DUMP_SEL(RTW_DBGDUMP, "HW EFUSE", hal_data->efuse_eeprom_data, mapsize); -+ } -+#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; -+#ifdef CONFIG_MP_INCLUDED -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+#endif -+ -+ 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; -+ } -+#ifdef CONFIG_MP_INCLUDED -+ if (pmp_priv->efuse_update_file == _TRUE && (rtw_mp_mode_check(padapter))) { -+ RTW_INFO("%s, eFuse read from file :%s\n", __func__, pmp_priv->efuse_file_path); -+ ret = rtw_read_efuse_from_file(pmp_priv->efuse_file_path, hal_data->efuse_eeprom_data, maplen); -+ pmp_priv->efuse_update_file = _FALSE; -+ } else -+#endif -+ { -+ 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 defined(CONFIG_RTL8822B) && defined(CONFIG_USB_HCI) -+ u8 ft_mac_addr[ETH_ALEN] = {0x00, 0xff, 0xff, 0xff, 0xff, 0xff}; /* FT USB2 for 8822B */ -+#endif -+ -+ 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; -+ } -+ -+#if defined(CONFIG_RTL8822B) && defined(CONFIG_USB_HCI) -+ if (_rtw_memcmp(hw_addr, ft_mac_addr, ETH_ALEN)) -+ hw_addr[0] = 0xff; -+#endif -+ -+ /* 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; -+ u32 ArrayLen = sizeof(Array_kfreemap) / sizeof(u32); -+ u32 *Array = Array_kfreemap; -+ u32 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 == 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 == RF_PATH_A) ? (RF_PATH_A) : (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_set_rf_reg(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); -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 cur_wireless_mode = WIRELESS_INVALID; -+ -+#ifdef CONFIG_USB_RX_AGGREGATION -+ if (!registry_par->dynamic_agg_enable) -+ return; -+ -+#ifdef RTW_HALMAC -+ if (IS_HARDWARE_TYPE_8822BU(padapter) || IS_HARDWARE_TYPE_8821CU(padapter) -+ || IS_HARDWARE_TYPE_8822CU(padapter) || IS_HARDWARE_TYPE_8814BU(padapter) -+ || IS_HARDWARE_TYPE_8723FU(padapter)) -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, NULL); -+#else /* !RTW_HALMAC */ -+ 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, WIFI_ASOC_STATE) == _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 /* RTW_HALMAC */ -+#endif /* CONFIG_USB_RX_AGGREGATION */ -+ -+} -+ -+/* bus-agg check for SoftAP mode */ -+inline u8 rtw_hal_busagg_qsel_check(_adapter *padapter, u8 pre_qsel, u8 next_qsel) -+{ -+#ifdef CONFIG_AP_MODE -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 chk_rst = _SUCCESS; -+ -+ if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) -+ 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; -+#else -+ return _SUCCESS; -+#endif /* CONFIG_AP_MODE */ -+} -+ -+#ifdef CONFIG_WOWLAN -+/* -+ * 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)); -+ } -+} -+#endif -+ -+#ifdef CONFIG_GPIO_API -+u8 rtw_hal_get_gpio(_adapter *adapter, u8 gpio_num) -+{ -+ u8 value = 0; -+ u8 direction = 0; -+ u32 gpio_pin_input_val = REG_GPIO_PIN_CTRL; -+ u32 gpio_pin_output_val = REG_GPIO_PIN_CTRL + 1; -+ u32 gpio_pin_output_en = 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_pin_input_val = REG_GPIO_PIN_CTRL_2; -+ gpio_pin_output_val = REG_GPIO_PIN_CTRL_2 + 1; -+ gpio_pin_output_en = REG_GPIO_PIN_CTRL_2 + 2; -+ gpio_num_to_set = gpio_num - 8; -+ } -+ -+ /* Read GPIO Direction */ -+ direction = (rtw_read8(adapter, gpio_pin_output_en) & BIT(gpio_num_to_set)) >> gpio_num_to_set; -+ -+ /* According the direction to read register value */ -+ if (direction) -+ value = (rtw_read8(adapter, gpio_pin_output_val) & BIT(gpio_num_to_set)) >> gpio_num_to_set; -+ else -+ value = (rtw_read8(adapter, gpio_pin_input_val) & BIT(gpio_num_to_set)) >> gpio_num_to_set; -+ -+ 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_pin_output_val = REG_GPIO_PIN_CTRL + 1; -+ u32 gpio_pin_output_en = 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_pin_output_val = REG_GPIO_PIN_CTRL_2 + 1; -+ gpio_pin_output_en = REG_GPIO_PIN_CTRL_2 + 2; -+ gpio_num_to_set = gpio_num - 8; -+ } -+ -+ /* Read GPIO direction */ -+ direction = (rtw_read8(adapter, gpio_pin_output_en) & BIT(gpio_num_to_set)) >> gpio_num_to_set; -+ -+ /* If GPIO is output direction, setting value. */ -+ if (direction) { -+ if (isHigh) -+ rtw_write8(adapter, gpio_pin_output_val, rtw_read8(adapter, gpio_pin_output_val) | BIT(gpio_num_to_set)); -+ else -+ rtw_write8(adapter, gpio_pin_output_val, rtw_read8(adapter, gpio_pin_output_val) & ~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->current_channel, pHalData->current_channel_bw); -+ 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_set_mac_reg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ -+ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x3); -+ mac_cck_ok = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x0); -+ mac_ofdm_ok = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x6); -+ mac_ht_ok = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ mac_vht_ok = 0; -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x0); -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT26, 0x1); -+ mac_vht_ok = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0]*/ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ -+ } -+ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x4); -+ mac_cck_err = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x1); -+ mac_ofdm_err = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x7); -+ mac_ht_err = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ mac_vht_err = 0; -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x1); -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT26, 0x1); -+ mac_vht_err = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0]*/ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ -+ } -+ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x5); -+ mac_cck_fa = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x2); -+ mac_ofdm_fa = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x9); -+ mac_ht_fa = phy_query_mac_reg(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) || -+ IS_HARDWARE_TYPE_8188GTV(padapter) || -+ IS_HARDWARE_TYPE_8192F(padapter) || -+ IS_HARDWARE_TYPE_8822C(padapter)) -+ phy_set_mac_reg(padapter, REG_RCR, BIT19, 0x1); -+ -+ /* reset mac counter */ -+ phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT27, 0x1); -+ phy_set_mac_reg(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_query_bb_reg(padapter, 0xF04, 0x3FFF); /* [13:0] */ -+ ofdmok = phy_query_bb_reg(padapter, 0xF14, 0x3FFF); /* [13:0] */ -+ htok = phy_query_bb_reg(padapter, 0xF10, 0x3FFF); /* [13:0] */ -+ vht_ok = phy_query_bb_reg(padapter, 0xF0C, 0x3FFF); /* [13:0] */ -+ cckcrc = phy_query_bb_reg(padapter, 0xF04, 0x3FFF0000); /* [29:16] */ -+ ofdmcrc = phy_query_bb_reg(padapter, 0xF14, 0x3FFF0000); /* [29:16] */ -+ htcrc = phy_query_bb_reg(padapter, 0xF10, 0x3FFF0000); /* [29:16] */ -+ vht_err = phy_query_bb_reg(padapter, 0xF0C, 0x3FFF0000); /* [29:16] */ -+ CCK_FA = phy_query_bb_reg(padapter, 0xA5C, bMaskLWord); -+ OFDM_FA = phy_query_bb_reg(padapter, 0xF48, bMaskLWord); -+ } else if(IS_HARDWARE_TYPE_JAGUAR3(padapter)){ -+ cckok = phy_query_bb_reg(padapter, 0x2c04, 0xffff); -+ ofdmok = phy_query_bb_reg(padapter, 0x2c14, 0xffff); -+ htok = phy_query_bb_reg(padapter, 0x2c10, 0xffff); -+ vht_ok = phy_query_bb_reg(padapter, 0x2c0c, 0xffff); -+ cckcrc = phy_query_bb_reg(padapter, 0x2c04, 0xffff0000); -+ ofdmcrc = phy_query_bb_reg(padapter, 0x2c14, 0xffff0000); -+ htcrc = phy_query_bb_reg(padapter, 0x2c10, 0xffff0000); -+ vht_err = phy_query_bb_reg(padapter, 0x2c0c, 0xffff0000); -+ CCK_FA = phy_query_bb_reg(padapter, 0x1a5c, bMaskLWord); -+ OFDM_FA = phy_query_bb_reg(padapter, 0x2d00, bMaskLWord) - phy_query_bb_reg(padapter, 0x2de0, bMaskLWord); -+ } else if(IS_HARDWARE_TYPE_JAGUAR3_11N(padapter)){ -+ cckok = phy_query_bb_reg(padapter, 0x2aac, 0xffff); -+ ofdmok = phy_query_bb_reg(padapter, 0x2c14, 0xffff); -+ htok = phy_query_bb_reg(padapter, 0x2c10, 0xffff); -+ cckcrc = phy_query_bb_reg(padapter, 0x2aac, 0xffff0000); -+ ofdmcrc = phy_query_bb_reg(padapter, 0x2c14, 0xffff0000); -+ htcrc = phy_query_bb_reg(padapter, 0x2c10, 0xffff0000); -+ CCK_FA = phy_query_bb_reg(padapter, 0x2aa8, 0xffff0000) + phy_query_bb_reg(padapter, 0x2aa8, 0x0000ffff); -+ OFDM_FA = phy_query_bb_reg(padapter, 0x2d00, bMaskLWord) - phy_query_bb_reg(padapter, 0x2de0, bMaskLWord); -+ } else { -+ cckok = phy_query_bb_reg(padapter, 0xF88, bMaskDWord); -+ ofdmok = phy_query_bb_reg(padapter, 0xF94, bMaskLWord); -+ htok = phy_query_bb_reg(padapter, 0xF90, bMaskLWord); -+ vht_ok = 0; -+ cckcrc = phy_query_bb_reg(padapter, 0xF84, bMaskDWord); -+ ofdmcrc = phy_query_bb_reg(padapter, 0xF94, bMaskHWord); -+ htcrc = phy_query_bb_reg(padapter, 0xF90, bMaskHWord); -+ vht_err = 0; -+ OFDM_FA = phy_query_bb_reg(padapter, 0xCF0, bMaskLWord) + phy_query_bb_reg(padapter, 0xCF0, bMaskHWord) + -+ phy_query_bb_reg(padapter, 0xDA0, bMaskHWord) + phy_query_bb_reg(padapter, 0xDA4, bMaskLWord) + -+ phy_query_bb_reg(padapter, 0xDA4, bMaskHWord) + phy_query_bb_reg(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_set_bb_reg(padapter, 0xB58, BIT0, 0x1); -+ phy_set_bb_reg(padapter, 0xB58, BIT0, 0x0); -+ } else if(IS_HARDWARE_TYPE_JAGUAR3(padapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(padapter)) { -+ phy_set_bb_reg(padapter, 0x1EB4, BIT25, 0x1); -+ phy_set_bb_reg(padapter, 0x1EB4, BIT25, 0x0); -+ } else { -+ phy_set_bb_reg(padapter, 0xF14, BIT16, 0x1); -+ phy_set_bb_reg(padapter, 0xF14, BIT16, 0x0); -+ } -+} -+ -+void rtw_reset_phy_rx_counters(_adapter *padapter) -+{ -+ /* reset phy counter */ -+ if (IS_HARDWARE_TYPE_JAGUAR3(padapter)) { -+ /* reset CCK FA counter */ -+ phy_set_bb_reg(padapter, 0x1a2c, BIT(15) | BIT(14), 0); -+ phy_set_bb_reg(padapter, 0x1a2c, BIT(15) | BIT(14), 2); -+ -+ /* reset CCK CCA counter */ -+ phy_set_bb_reg(padapter, 0x1a2c, BIT(13) | BIT(12), 0); -+ phy_set_bb_reg(padapter, 0x1a2c, BIT(13) | BIT(12), 2); -+ rtw_reset_phy_trx_ok_counters(padapter); -+ -+ } else if (IS_HARDWARE_TYPE_JAGUAR3_11N(padapter)) { -+ /* reset CCK FA and CCK CCA counter */ -+ phy_set_bb_reg(padapter, 0x2a44, BIT21, 0); -+ phy_set_bb_reg(padapter, 0x2a44, BIT21, 1); -+ rtw_reset_phy_trx_ok_counters(padapter); -+ -+ } else if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { -+ rtw_reset_phy_trx_ok_counters(padapter); -+ -+ phy_set_bb_reg(padapter, 0x9A4, BIT17, 0x1);/* reset OFDA FA counter */ -+ phy_set_bb_reg(padapter, 0x9A4, BIT17, 0x0); -+ -+ phy_set_bb_reg(padapter, 0xA2C, BIT15, 0x0);/* reset CCK FA counter */ -+ phy_set_bb_reg(padapter, 0xA2C, BIT15, 0x1); -+ } else { -+ phy_set_bb_reg(padapter, 0xF14, BIT16, 0x1); -+ rtw_msleep_os(10); -+ phy_set_bb_reg(padapter, 0xF14, BIT16, 0x0); -+ -+ phy_set_bb_reg(padapter, 0xD00, BIT27, 0x1);/* reset OFDA FA counter */ -+ phy_set_bb_reg(padapter, 0xC0C, BIT31, 0x1);/* reset OFDA FA counter */ -+ phy_set_bb_reg(padapter, 0xD00, BIT27, 0x0); -+ phy_set_bb_reg(padapter, 0xC0C, BIT31, 0x0); -+ -+ phy_set_bb_reg(padapter, 0xA2C, BIT15, 0x0);/* reset CCK FA counter */ -+ phy_set_bb_reg(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 -+u8 rtw_get_current_tx_sgi(_adapter *padapter, struct sta_info *psta) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ u8 curr_tx_sgi = 0; -+ struct ra_sta_info *ra_info; -+ -+ if (!psta) -+ return curr_tx_sgi; -+ -+ if (padapter->fix_rate == 0xff) { -+#if defined(CONFIG_RTL8188E) -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+ curr_tx_sgi = hal_data->odmpriv.ra_info[psta->cmn.mac_id].rate_sgi; -+#endif /* (RATE_ADAPTIVE_SUPPORT == 1)*/ -+#else -+ ra_info = &psta->cmn.ra_info; -+ curr_tx_sgi = ((ra_info->curr_tx_rate) & 0x80) >> 7; -+#endif -+ } else { -+ curr_tx_sgi = ((padapter->fix_rate) & 0x80) >> 7; -+ } -+ -+ return curr_tx_sgi; -+} -+ -+u8 rtw_get_current_tx_rate(_adapter *padapter, struct sta_info *psta) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ u8 rate_id = 0; -+ struct ra_sta_info *ra_info; -+ -+ if (!psta) -+ return rate_id; -+ -+ if (padapter->fix_rate == 0xff) { -+#if defined(CONFIG_RTL8188E) -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+ rate_id = hal_data->odmpriv.ra_info[psta->cmn.mac_id].decision_rate; -+#endif /* (RATE_ADAPTIVE_SUPPORT == 1)*/ -+#else -+ ra_info = &psta->cmn.ra_info; -+ rate_id = ra_info->curr_tx_rate & 0x7f; -+#endif -+ } else { -+ rate_id = padapter->fix_rate & 0x7f; -+ } -+ -+ 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; -+ break; -+ case HT_IOT_PEER_REALTEK: -+ /* rtw_write16(padapter, 0x4cc, 0xffff); */ -+ /* rtw_write16(padapter, 0x546, 0x01c0); */ -+ break; -+ default: -+ pmlmeinfo->turboMode_cts2self = 0; -+ pmlmeinfo->turboMode_rtsen = 1; -+ break; -+ } -+ -+} -+#ifdef CONFIG_RTS_FULL_BW -+/* -+8188E: not support full RTS BW feature(mac REG no define 480[5]) -+*/ -+void rtw_set_rts_bw(_adapter *padapter) { -+ int i; -+ u8 enable = 1; -+ bool connect_to_8812 = _FALSE; -+ 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 sta_info *station = NULL; -+ -+ for (i = 0; i < macid_ctl->num; i++) { -+ if (rtw_macid_is_used(macid_ctl, i)) { -+ -+ station = NULL; -+ station = macid_ctl->sta[i]; -+ if(station) { -+ -+ _adapter *sta_adapter =station->padapter; -+ struct mlme_ext_priv *pmlmeext = &(sta_adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ( pmlmeinfo->state != WIFI_FW_NULL_STATE) { -+ if(_rtw_memcmp(macid_ctl->sta[i]->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) { -+ if ( macid_ctl->sta[i]->vendor_8812) { -+ connect_to_8812 = _TRUE; -+ enable = 0; -+ } -+ } -+ } -+ } -+ } -+ -+ if(connect_to_8812) -+ break; -+ } -+ -+ RTW_INFO("%s connect_to_8812=%d,enable=%u\n", __FUNCTION__,connect_to_8812,enable); -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RTS_BW, &enable); -+} -+#endif/*CONFIG_RTS_FULL_BW*/ -+ -+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_RTL8188GTV -+ case RTL8188GTV: -+ init_hal_spec_8188gtv(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 -+#ifdef CONFIG_RTL8710B -+ case RTL8710B: -+ init_hal_spec_8710b(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8192F -+ case RTL8192F: -+ init_hal_spec_8192f(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8822C -+ case RTL8822C: -+ rtl8822c_init_hal_spec(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8814B -+ case RTL8814B: -+ rtl8814b_init_hal_spec(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8723F -+ case RTL8723F: -+ rtl8723f_init_hal_spec(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, "macid_cap:%u\n", hal_spec->macid_cap); -+ 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, "rf_reg_path_num:%u\n", hal_spec->rf_reg_path_num); -+ RTW_PRINT_SEL(sel, "rf_reg_path_avail_num:%u\n", hal_spec->rf_reg_path_avail_num); -+ RTW_PRINT_SEL(sel, "rf_reg_trx_path_bmp:0x%02x\n", hal_spec->rf_reg_trx_path_bmp); -+ RTW_PRINT_SEL(sel, "max_tx_cnt:%u\n", hal_spec->max_tx_cnt); -+ -+ RTW_PRINT_SEL(sel, "tx_nss_num:%u\n", hal_spec->tx_nss_num); -+ RTW_PRINT_SEL(sel, "rx_nss_num:%u\n", hal_spec->rx_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, "txgi_max:%u\n", hal_spec->txgi_max); -+ RTW_PRINT_SEL(sel, "txgi_pdbm:%u\n", hal_spec->txgi_pdbm); -+ -+ 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"); -+ -+#if CONFIG_TX_AC_LIFETIME -+ RTW_PRINT_SEL(sel, "tx_aclt_unit_factor:%u (unit:%uus)\n" -+ , hal_spec->tx_aclt_unit_factor, hal_spec->tx_aclt_unit_factor * 32); -+#endif -+ -+ RTW_PRINT_SEL(sel, "rx_tsf_filter:%u\n", hal_spec->rx_tsf_filter); -+ -+ RTW_PRINT_SEL(sel, "pg_txpwr_saddr:0x%X\n", hal_spec->pg_txpwr_saddr); -+ RTW_PRINT_SEL(sel, "pg_txgi_diff_factor:%u\n", hal_spec->pg_txgi_diff_factor); -+} -+ -+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; -+} -+inline bool hal_is_mimo_support(_adapter *adapter) -+{ -+ if ((GET_HAL_TX_NSS(adapter) == 1) && -+ (GET_HAL_RX_NSS(adapter) == 1)) -+ return 0; -+ return 1; -+} -+ -+/* -+* hal_largest_bw - starting from in_bw, get largest bw supported by HAL -+* @adapter: -+* @in_bw: starting bw, value of enum channel_width -+* -+* Returns: value of enum 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; -+} -+ -+#ifndef CONFIG_HAS_TX_BEACON_PAUSE -+void ResumeTxBeacon(_adapter *padapter) -+{ -+ RTW_DBG("ResumeTxBeacon\n"); -+ #ifdef CONFIG_STOP_RESUME_BCN_BY_TXPAUSE -+ rtw_write8(padapter, REG_TXPAUSE, -+ rtw_read8(padapter, REG_TXPAUSE) & (~BIT6)); -+ #else -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, -+ rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2) | BIT(6)); -+ #endif -+ -+#ifdef RTW_HALMAC -+ /* Add this for driver using HALMAC because driver doesn't have setup time init by self */ -+ /* TBTT setup time */ -+ rtw_write8(padapter, REG_TBTT_PROHIBIT, TBTT_PROHIBIT_SETUP_TIME); -+#endif -+ /* TBTT hold time: 0x540[19:8] */ -+#ifdef CONFIG_NARROWBAND_SUPPORTING -+ if (padapter->registrypriv.rtw_nb_config == RTW_NB_CONFIG_WIDTH_10) -+ rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, 0xc8); -+ else -+#endif -+ rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, TBTT_PROHIBIT_HOLD_TIME & 0xFF); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, -+ (rtw_read8(padapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME >> 8)); -+} -+ -+void StopTxBeacon(_adapter *padapter) -+{ -+ RTW_DBG("StopTxBeacon\n"); -+ #ifdef CONFIG_STOP_RESUME_BCN_BY_TXPAUSE -+ rtw_write8(padapter, REG_TXPAUSE, -+ rtw_read8(padapter, REG_TXPAUSE) | BIT6); -+ #else -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, -+ rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2) & (~BIT6)); -+ #endif -+ -+ /* TBTT hold time: 0x540[19:8] */ -+ rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, TBTT_PROHIBIT_HOLD_TIME_STOP_BCN & 0xFF); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, -+ (rtw_read8(padapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME_STOP_BCN >> 8)); -+} -+#endif /* CONFIG_HAS_TX_BEACON_PAUSE */ -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM /*HW port0 - MBSS*/ -+ -+#ifdef CONFIG_CLIENT_PORT_CFG -+const u8 _clt_port_id[MAX_CLIENT_PORT_NUM] = { -+ CLT_PORT0, -+ CLT_PORT1, -+ CLT_PORT2, -+ CLT_PORT3 -+}; -+ -+void rtw_clt_port_init(struct clt_port_t *cltp) -+{ -+ cltp->bmp = 0; -+ cltp->num = 0; -+ _rtw_spinlock_init(&cltp->lock); -+} -+void rtw_clt_port_deinit(struct clt_port_t *cltp) -+{ -+ _rtw_spinlock_free(&cltp->lock); -+} -+static void _hw_client_port_alloc(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct clt_port_t *cltp = &dvobj->clt_port; -+ _irqL irql; -+ int i; -+ -+ #if 0 -+ if (cltp->num > MAX_CLIENT_PORT_NUM) { -+ RTW_ERR(ADPT_FMT" cann't alloc client (%d)\n", ADPT_ARG(adapter), cltp->num); -+ rtw_warn_on(1); -+ return; -+ } -+ #endif -+ -+ if (adapter->client_id != MAX_CLIENT_PORT_NUM) { -+ RTW_INFO(ADPT_FMT" client_id %d has allocated port:%d\n", -+ ADPT_ARG(adapter), adapter->client_id, adapter->client_port); -+ return; -+ } -+ _enter_critical_bh(&cltp->lock, &irql); -+ for (i = 0; i < MAX_CLIENT_PORT_NUM; i++) { -+ if (!(cltp->bmp & BIT(i))) -+ break; -+ } -+ -+ if (i < MAX_CLIENT_PORT_NUM) { -+ adapter->client_id = i; -+ cltp->bmp |= BIT(i); -+ adapter->client_port = _clt_port_id[i]; -+ } -+ cltp->num++; -+ _exit_critical_bh(&cltp->lock, &irql); -+ RTW_INFO("%s("ADPT_FMT")id:%d, port:%d clt_num:%d\n", -+ __func__, ADPT_ARG(adapter), adapter->client_id, adapter->client_port, cltp->num); -+} -+static void _hw_client_port_free(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct clt_port_t *cltp = &dvobj->clt_port; -+ _irqL irql; -+ -+ #if 0 -+ if (adapter->client_id >= MAX_CLIENT_PORT_NUM) { -+ RTW_ERR(ADPT_FMT" client_id %d is invalid\n", ADPT_ARG(adapter), adapter->client_id); -+ /*rtw_warn_on(1);*/ -+ } -+ #endif -+ -+ RTW_INFO("%s ("ADPT_FMT") id:%d, port:%d clt_num:%d\n", -+ __func__, ADPT_ARG(adapter), adapter->client_id, adapter->client_port, cltp->num); -+ -+ _enter_critical_bh(&cltp->lock, &irql); -+ if (adapter->client_id != MAX_CLIENT_PORT_NUM) { -+ cltp->bmp &= ~ BIT(adapter->client_id); -+ adapter->client_id = MAX_CLIENT_PORT_NUM; -+ adapter->client_port = CLT_PORT_INVALID; -+ } -+ cltp->num--; -+ if (cltp->num < 0) -+ cltp->num = 0; -+ _exit_critical_bh(&cltp->lock, &irql); -+} -+void rtw_hw_client_port_allocate(_adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ if (hal_spec->port_num != 5) -+ return; -+ -+ _hw_client_port_alloc(adapter); -+} -+void rtw_hw_client_port_release(_adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ if (hal_spec->port_num != 5) -+ return; -+ -+ _hw_client_port_free(adapter); -+} -+#endif /*CONFIG_CLIENT_PORT_CFG*/ -+ -+void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode) -+{ -+ RTW_INFO("%s()-"ADPT_FMT" mode = %d\n", __func__, ADPT_ARG(Adapter), mode); -+ -+ rtw_hal_rcr_set_chk_bssid(Adapter, MLME_ACTION_NONE); -+ -+ /* set net_type */ -+ Set_MSR(Adapter, mode); -+ -+ if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { -+ if (!rtw_mi_get_ap_num(Adapter) && !rtw_mi_get_mesh_num(Adapter)) -+ StopTxBeacon(Adapter); -+ } else if (mode == _HW_STATE_ADHOC_) -+ ResumeTxBeacon(Adapter); -+ else if (mode == _HW_STATE_AP_) -+ /* enable rx ps-poll */ -+ rtw_write16(Adapter, REG_RXFLTMAP1, rtw_read16(Adapter, REG_RXFLTMAP1) | BIT_CTRLFLT10EN); -+ -+ /* enable rx data frame */ -+ rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); -+ -+#ifdef CONFIG_CLIENT_PORT_CFG -+ if (mode == _HW_STATE_STATION_) -+ rtw_hw_client_port_allocate(Adapter); -+ else -+ rtw_hw_client_port_release(Adapter); -+#endif -+#if defined(CONFIG_RTL8192F) -+ rtw_write16(Adapter, REG_WLAN_ACT_MASK_CTRL_1, rtw_read16(Adapter, -+ REG_WLAN_ACT_MASK_CTRL_1) | EN_PORT_0_FUNCTION); -+#endif -+} -+#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 -+ -+#ifdef CONFIG_PROC_DEBUG -+#ifdef CONFIG_PHY_CAPABILITY_QUERY -+void rtw_dump_phy_cap_by_phydmapi(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ struct phy_spec_t *phy_spec = &pHalData->phy_spec; -+ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] TRx Capability : 0x%08x\n", phy_spec->trx_cap); -+ RTW_PRINT_SEL(sel, "[PHY SPEC] Tx Stream Num Index : %d\n", (phy_spec->trx_cap >> 24) & 0xFF); /*Tx Stream Num Index [31:24]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] Rx Stream Num Index : %d\n", (phy_spec->trx_cap >> 16) & 0xFF); /*Rx Stream Num Index [23:16]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] Tx Path Num Index : %d\n", (phy_spec->trx_cap >> 8) & 0xFF);/*Tx Path Num Index [15:8]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] Rx Path Num Index : %d\n\n", (phy_spec->trx_cap & 0xFF));/*Rx Path Num Index [7:0]*/ -+ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] STBC Capability : 0x%08x\n", phy_spec->stbc_cap); -+ RTW_PRINT_SEL(sel, "[PHY SPEC] VHT STBC Tx : %s\n", ((phy_spec->stbc_cap >> 24) & 0xFF) ? "Supported" : "N/A"); /*VHT STBC Tx [31:24]*/ -+ /*VHT STBC Rx [23:16] -+ 0 = not support -+ 1 = support for 1 spatial stream -+ 2 = support for 1 or 2 spatial streams -+ 3 = support for 1 or 2 or 3 spatial streams -+ 4 = support for 1 or 2 or 3 or 4 spatial streams*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] VHT STBC Rx :%d\n", ((phy_spec->stbc_cap >> 16) & 0xFF)); -+ RTW_PRINT_SEL(sel, "[PHY SPEC] HT STBC Tx : %s\n", ((phy_spec->stbc_cap >> 8) & 0xFF) ? "Supported" : "N/A"); /*HT STBC Tx [15:8]*/ -+ /*HT STBC Rx [7:0] -+ 0 = not support -+ 1 = support for 1 spatial stream -+ 2 = support for 1 or 2 spatial streams -+ 3 = support for 1 or 2 or 3 spatial streams*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] HT STBC Rx : %d\n\n", (phy_spec->stbc_cap & 0xFF)); -+ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] LDPC Capability : 0x%08x\n", phy_spec->ldpc_cap); -+ RTW_PRINT_SEL(sel, "[PHY SPEC] VHT LDPC Tx : %s\n", ((phy_spec->ldpc_cap >> 24) & 0xFF) ? "Supported" : "N/A"); /*VHT LDPC Tx [31:24]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] VHT LDPC Rx : %s\n", ((phy_spec->ldpc_cap >> 16) & 0xFF) ? "Supported" : "N/A"); /*VHT LDPC Rx [23:16]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] HT LDPC Tx : %s\n", ((phy_spec->ldpc_cap >> 8) & 0xFF) ? "Supported" : "N/A"); /*HT LDPC Tx [15:8]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] HT LDPC Rx : %s\n\n", (phy_spec->ldpc_cap & 0xFF) ? "Supported" : "N/A"); /*HT LDPC Rx [7:0]*/ -+ #ifdef CONFIG_BEAMFORMING -+ RTW_PRINT_SEL(sel, "[PHY SPEC] TxBF Capability : 0x%08x\n", phy_spec->txbf_cap); -+ RTW_PRINT_SEL(sel, "[PHY SPEC] VHT MU Bfer : %s\n", ((phy_spec->txbf_cap >> 28) & 0xF) ? "Supported" : "N/A"); /*VHT MU Bfer [31:28]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] VHT MU Bfee : %s\n", ((phy_spec->txbf_cap >> 24) & 0xF) ? "Supported" : "N/A"); /*VHT MU Bfee [27:24]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] VHT SU Bfer : %s\n", ((phy_spec->txbf_cap >> 20) & 0xF) ? "Supported" : "N/A"); /*VHT SU Bfer [23:20]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] VHT SU Bfee : %s\n", ((phy_spec->txbf_cap >> 16) & 0xF) ? "Supported" : "N/A"); /*VHT SU Bfee [19:16]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] HT Bfer : %s\n", ((phy_spec->txbf_cap >> 4) & 0xF) ? "Supported" : "N/A"); /*HT Bfer [7:4]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] HT Bfee : %s\n\n", (phy_spec->txbf_cap & 0xF) ? "Supported" : "N/A"); /*HT Bfee [3:0]*/ -+ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] TxBF parameter : 0x%08x\n", phy_spec->txbf_param); -+ RTW_PRINT_SEL(sel, "[PHY SPEC] VHT Sounding Dim : %d\n", (phy_spec->txbf_param >> 24) & 0xFF); /*VHT Sounding Dim [31:24]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] VHT Steering Ant : %d\n", (phy_spec->txbf_param >> 16) & 0xFF); /*VHT Steering Ant [23:16]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] HT Sounding Dim : %d\n", (phy_spec->txbf_param >> 8) & 0xFF); /*HT Sounding Dim [15:8]*/ -+ RTW_PRINT_SEL(sel, "[PHY SPEC] HT Steering Ant : %d\n", phy_spec->txbf_param & 0xFF); /*HT Steering Ant [7:0]*/ -+ #endif -+} -+#else -+void rtw_dump_phy_cap_by_hal(void *sel, _adapter *adapter) -+{ -+ u8 phy_cap = _FALSE; -+ -+ /* STBC */ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_STBC, (u8 *)&phy_cap); -+ RTW_PRINT_SEL(sel, "[HAL] STBC Tx : %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); -+ -+ phy_cap = _FALSE; -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_STBC, (u8 *)&phy_cap); -+ RTW_PRINT_SEL(sel, "[HAL] STBC Rx : %s\n\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); -+ -+ /* LDPC support */ -+ phy_cap = _FALSE; -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_LDPC, (u8 *)&phy_cap); -+ RTW_PRINT_SEL(sel, "[HAL] LDPC Tx : %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); -+ -+ phy_cap = _FALSE; -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_LDPC, (u8 *)&phy_cap); -+ RTW_PRINT_SEL(sel, "[HAL] LDPC Rx : %s\n\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); -+ -+ #ifdef CONFIG_BEAMFORMING -+ phy_cap = _FALSE; -+ rtw_hal_get_def_var(adapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&phy_cap); -+ RTW_PRINT_SEL(sel, "[HAL] Beamformer: %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); -+ -+ phy_cap = _FALSE; -+ rtw_hal_get_def_var(adapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&phy_cap); -+ RTW_PRINT_SEL(sel, "[HAL] Beamformee: %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); -+ -+ phy_cap = _FALSE; -+ rtw_hal_get_def_var(adapter, HAL_DEF_VHT_MU_BEAMFORMER, &phy_cap); -+ RTW_PRINT_SEL(sel, "[HAL] VHT MU Beamformer: %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); -+ -+ phy_cap = _FALSE; -+ rtw_hal_get_def_var(adapter, HAL_DEF_VHT_MU_BEAMFORMEE, &phy_cap); -+ RTW_PRINT_SEL(sel, "[HAL] VHT MU Beamformee: %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); -+ #endif -+} -+#endif -+void rtw_dump_phy_cap(void *sel, _adapter *adapter) -+{ -+ RTW_PRINT_SEL(sel, "\n ======== PHY Capability ========\n"); -+#ifdef CONFIG_PHY_CAPABILITY_QUERY -+ rtw_dump_phy_cap_by_phydmapi(sel, adapter); -+#else -+ rtw_dump_phy_cap_by_hal(sel, adapter); -+#endif -+} -+#endif -+ -+inline s16 translate_dbm_to_percentage(s16 signal) -+{ -+ if ((signal <= -100) || (signal >= 20)) -+ return 0; -+ else if (signal >= 0) -+ return 100; -+ else -+ return 100 + signal; -+} -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+#ifdef CONFIG_BCN_RECOVERY -+#define REG_CPU_MGQ_INFO 0x041C -+#define BIT_BCN_POLL BIT(28) -+u8 rtw_ap_bcn_recovery(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ -+ if (hal_data->issue_bcn_fail >= 2) { -+ RTW_ERR("%s ISSUE BCN Fail\n", __func__); -+ rtw_write8(padapter, REG_CPU_MGQ_INFO + 3, 0x10); -+ hal_data->issue_bcn_fail = 0; -+ } -+ return _SUCCESS; -+} -+#endif /*CONFIG_BCN_RECOVERY*/ -+ -+#ifdef CONFIG_BCN_XMIT_PROTECT -+u8 rtw_ap_bcn_queue_empty_check(_adapter *padapter, u32 txbcn_timer_ms) -+{ -+ u32 start_time = rtw_get_current_time(); -+ u8 bcn_queue_empty = _FALSE; -+ -+ do { -+ if (rtw_read16(padapter, REG_TXPKT_EMPTY) & BIT(11)) { -+ bcn_queue_empty = _TRUE; -+ break; -+ } -+ } while (rtw_get_passing_time_ms(start_time) <= (txbcn_timer_ms + 10)); -+ -+ if (bcn_queue_empty == _FALSE) -+ RTW_ERR("%s BCN queue not empty\n", __func__); -+ -+ return bcn_queue_empty; -+} -+#endif /*CONFIG_BCN_XMIT_PROTECT*/ -+#endif /*CONFIG_SWTIMER_BASED_TXBCN*/ -+ -+/** -+ * rtw_hal_get_trx_path() - Get RF path related information -+ * @d: struct dvobj_priv* -+ * @type: RF type, nTnR -+ * @tx: Tx path -+ * @rx: Rx path -+ * -+ * Get RF type, TX path and RX path information. -+ */ -+void rtw_hal_get_trx_path(struct dvobj_priv *d, enum rf_type *type, -+ enum bb_path *tx, enum bb_path *rx) -+{ -+ struct _ADAPTER *a = dvobj_get_primary_adapter(d); -+ enum rf_type t = GET_HAL_RFPATH(a); -+ -+ if (type) -+ *type = t; -+ -+ if (tx || rx) { -+ u8 tx_bmp = GET_HAL_TX_PATH_BMP(a); -+ u8 rx_bmp = GET_HAL_RX_PATH_BMP(a); -+ -+ if (!tx_bmp && !rx_bmp) -+ rf_type_to_default_trx_bmp(t, tx, rx); -+ else { -+ if (tx) -+ *tx = GET_HAL_TX_PATH_BMP(a); -+ if (rx) -+ *rx = GET_HAL_RX_PATH_BMP(a); -+ } -+ } -+} -+ -+#ifdef RTW_CHANNEL_SWITCH_OFFLOAD -+void rtw_hal_switch_chnl_and_set_bw_offload(_adapter *adapter, u8 central_ch, u8 pri_ch_idx, u8 bw) -+{ -+ u8 h2c[H2C_SINGLE_CHANNELSWITCH_V2_LEN] = {0}; -+ PHAL_DATA_TYPE hal; -+ struct submit_ctx *chsw_sctx; -+ -+ hal = GET_HAL_DATA(adapter); -+ chsw_sctx = &hal->chsw_sctx; -+ -+ SET_H2CCMD_SINGLE_CH_SWITCH_V2_CENTRAL_CH_NUM(h2c, central_ch); -+ SET_H2CCMD_SINGLE_CH_SWITCH_V2_PRIMARY_CH_IDX(h2c, pri_ch_idx); -+ SET_H2CCMD_SINGLE_CH_SWITCH_V2_BW(h2c, bw); -+ SET_H2CCMD_SINGLE_CH_SWITCH_V2_IQK_UPDATE_EN(h2c, 1); -+ -+ rtw_sctx_init(chsw_sctx, 10); -+ rtw_hal_fill_h2c_cmd(adapter, H2C_SINGLE_CHANNELSWITCH_V2, H2C_SINGLE_CHANNELSWITCH_V2_LEN, h2c); -+ rtw_sctx_wait(chsw_sctx, __func__); -+} -+#endif /* RTW_CHANNEL_SWITCH_OFFLOAD */ -+ -+u8 phy_get_capable_tx_num(_adapter *adapter, enum MGN_RATE rate) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 tx_num = 0; -+ -+ if (IS_1T_RATE(rate)) -+ tx_num = hal_data->txpath_cap_num_nss[0]; -+ else if (IS_2T_RATE(rate)) -+ tx_num = hal_data->txpath_cap_num_nss[1]; -+ else if (IS_3T_RATE(rate)) -+ tx_num = hal_data->txpath_cap_num_nss[2]; -+ else if (IS_4T_RATE(rate)) -+ tx_num = hal_data->txpath_cap_num_nss[3]; -+ else -+ rtw_warn_on(1); -+ -+ return tx_num == 0 ? RF_1TX : tx_num - 1; -+} -+ -+u8 phy_get_current_tx_num(_adapter *adapter, enum MGN_RATE rate) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 tx_num = 0; -+ -+ if (IS_1T_RATE(rate)) -+ tx_num = hal_data->txpath_num_nss[0]; -+ else if (IS_2T_RATE(rate)) -+ tx_num = hal_data->txpath_num_nss[1]; -+ else if (IS_3T_RATE(rate)) -+ tx_num = hal_data->txpath_num_nss[2]; -+ else if (IS_4T_RATE(rate)) -+ tx_num = hal_data->txpath_num_nss[3]; -+ else -+ rtw_warn_on(1); -+ -+ return tx_num == 0 ? RF_1TX : tx_num - 1; -+} -+ -+#ifdef CONFIG_RTL8812A -+u8 * rtw_hal_set_8812a_vendor_ie(_adapter *padapter , u8 *pframe ,uint *frlen ) { -+ int vender_len = 7; -+ unsigned char vendor_info[vender_len]; -+ unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c}; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if( !IS_HARDWARE_TYPE_8812(padapter) ) -+ return pframe; -+ -+ _rtw_memset(vendor_info,0,vender_len); -+ _rtw_memcpy(vendor_info, REALTEK_OUI, 3); -+ vendor_info[4] =2; -+ if(pHalData->version_id.CUTVersion > B_CUT_VERSION ) -+ vendor_info[6] = RT_HT_CAP_USE_JAGUAR_CCUT; -+ else -+ vendor_info[6] = RT_HT_CAP_USE_JAGUAR_BCUT; -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_,vender_len,vendor_info , frlen); -+ -+ return pframe; -+} -+#endif /*CONFIG_RTL8812A*/ -+ -+static inline void rtw_enter_protsel(struct protsel *protsel, u32 sel) -+{ -+ int refcnt; -+ -+ _enter_critical_mutex(&protsel->mutex, NULL); -+ -+ refcnt = ATOMIC_INC_RETURN(&protsel->refcnt); -+ -+ WARN_ON(refcnt > 1 && protsel->sel != sel); -+ -+ protsel->sel = sel; -+ -+ _exit_critical_mutex(&protsel->mutex, NULL); -+} -+ -+static inline void rtw_leave_protsel(struct protsel *protsel) -+{ -+ int refcnt; -+ -+ _enter_critical_mutex(&protsel->mutex, NULL); -+ -+ refcnt = ATOMIC_DEC_RETURN(&protsel->refcnt); -+ -+ _exit_critical_mutex(&protsel->mutex, NULL); -+ -+ WARN_ON(refcnt < 0); -+} -+ -+static inline bool rtw_assert_protsel(struct protsel *protsel) -+{ -+ int refcnt = ATOMIC_READ(&protsel->refcnt); -+ -+ if (refcnt > 0) -+ return true; -+ -+ return false; -+} -+ -+#ifdef CONFIG_PROTSEL_PORT -+void rtw_enter_protsel_port(_adapter *padapter, u8 port_sel) -+{ -+ u8 val8; -+ -+ rtw_enter_protsel(&padapter->dvobj->protsel_port, port_sel); -+ -+ val8 = rtw_read8(padapter, REG_PORT_CTRL_SEL); -+ val8 &= ~BIT_MASK_PORT_CTRL_SEL; -+ val8 |= BIT_PORT_CTRL_SEL(port_sel); -+ rtw_write8(padapter, REG_PORT_CTRL_SEL, val8); -+} -+ -+bool rtw_assert_protsel_port(_adapter *padapter, u32 addr, u8 len) -+{ -+ if (!padapter->bup) /* don't assert before IF up */ -+ return true; -+ -+ return rtw_assert_protsel(&padapter->dvobj->protsel_port); -+} -+ -+void rtw_leave_protsel_port(_adapter *padapter) -+{ -+ rtw_leave_protsel(&padapter->dvobj->protsel_port); -+} -+#endif -+ -+#ifdef CONFIG_PROTSEL_ATIMDTIM -+void rtw_enter_protsel_atimdtim(_adapter *padapter, u8 port_sel) -+{ -+ /* 0~15 is for port 0 MBSSID setting -+ * 16 is for port 1 setting -+ * 17 is for port 2 setting -+ * 18 is for port 3 setting -+ * 19 is for port 4 setting -+ */ -+ u8 val8; -+ -+ if (port_sel >= 1 && port_sel <= 4) -+ port_sel += 15; -+ -+ rtw_enter_protsel(&padapter->dvobj->protsel_atimdtim, port_sel); -+ -+ val8 = rtw_read8(padapter, REG_ATIM_DTIM_CTRL_SEL); -+ val8 &= ~BIT_MASK_ATIM_DTIM_SEL; -+ val8 |= BIT_ATIM_DTIM_SEL(port_sel); -+ rtw_write8(padapter, REG_ATIM_DTIM_CTRL_SEL, val8); -+} -+ -+bool rtw_assert_protsel_atimdtim(_adapter *padapter, u32 addr, u8 len) -+{ -+ return rtw_assert_protsel(&padapter->dvobj->protsel_atimdtim); -+} -+ -+void rtw_leave_protsel_atimdtim(_adapter *padapter) -+{ -+ rtw_leave_protsel(&padapter->dvobj->protsel_atimdtim); -+} -+#endif -+ -+#ifdef CONFIG_PROTSEL_MACSLEEP -+void rtw_enter_protsel_macsleep(_adapter *padapter, u8 sel) -+{ -+ u32 val32; -+ -+ rtw_enter_protsel(&padapter->dvobj->protsel_macsleep, sel); -+ -+ val32 = rtw_read32(padapter, REG_MACID_SLEEP_CTRL); -+ val32 &= ~BIT_MASK_MACID_SLEEP_SEL; -+ val32 |= BIT_MACID_SLEEP_SEL(sel); -+ rtw_write32(padapter, REG_MACID_SLEEP_CTRL, val32); -+} -+ -+bool rtw_assert_protsel_macsleep(_adapter *padapter, u32 addr, u8 len) -+{ -+ return rtw_assert_protsel(&padapter->dvobj->protsel_macsleep); -+} -+ -+void rtw_leave_protsel_macsleep(_adapter *padapter) -+{ -+ rtw_leave_protsel(&padapter->dvobj->protsel_macsleep); -+} -+#endif -+ -+void rtw_hal_bcn_early_rpt_c2h_handler(_adapter *padapter) -+{ -+ if(0) -+ RTW_INFO("Recv Bcn Early report!!\n"); -+ -+#ifdef CONFIG_AP_MODE -+ rtw_mi_update_csa(padapter); -+#endif -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ if (ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on) == _TRUE) -+ rtw_tdls_ch_sw_back_to_base_chnl(padapter); -+#endif -+#endif -+} -+ -+#ifndef RTW_HALMAC -+void rtw_hal_init_sifs_backup(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ hal_data->init_reg_0x428 = rtw_read16(adapter, 0x428); -+ hal_data->init_reg_0x514 = rtw_read32(adapter, 0x514); -+ hal_data->init_reg_0x63a = rtw_read16(adapter, 0x63a); -+ hal_data->init_reg_0x63c = rtw_read32(adapter, 0x63c); -+ -+#ifndef RTW_SIFS_INIT_CHK -+#define RTW_SIFS_INIT_CHK 1 -+#endif -+ -+#if RTW_SIFS_INIT_CHK -+/* -+the expected initial values: -+0x428[15:0]=0x100A -+0x514[31:0]=0x0E0A0E0A -+0x63A[15:0]=0x100A -+0x63C[31:0]=0x0E0E0A0A -+*/ -+#define INIT_REG_0x428 0x100A -+#define INIT_REG_0x514 0x0E0A0E0A -+#define INIT_REG_0x63A 0x100A -+#define INIT_REG_0x63C 0x0E0E0A0A -+ -+ if (hal_data->init_reg_0x428 != INIT_REG_0x428) { -+ RTW_WARN("init_reg_0x428:0x%04x != 0x%04x\n", hal_data->init_reg_0x428, INIT_REG_0x428); -+ #if RTW_SIFS_INIT_CHK > 1 -+ hal_data->init_reg_0x428 = INIT_REG_0x428; -+ rtw_write16(adapter, 0x428, hal_data->init_reg_0x428); -+ #endif -+ } -+ if (hal_data->init_reg_0x514 != INIT_REG_0x514) { -+ RTW_WARN("init_reg_0x514:0x%08x != 0x%08x\n", hal_data->init_reg_0x514, INIT_REG_0x514); -+ #if RTW_SIFS_INIT_CHK > 1 -+ hal_data->init_reg_0x514 = INIT_REG_0x514; -+ rtw_write32(adapter, 0x514, hal_data->init_reg_0x514); -+ #endif -+ } -+ if (hal_data->init_reg_0x63a != INIT_REG_0x63A) { -+ RTW_WARN("init_reg_0x63a:0x%04x != 0x%04x\n", hal_data->init_reg_0x63a, INIT_REG_0x63A); -+ #if RTW_SIFS_INIT_CHK > 1 -+ hal_data->init_reg_0x63a = INIT_REG_0x63A; -+ rtw_write16(adapter, 0x63a, hal_data->init_reg_0x63a); -+ #endif -+ } -+ if (hal_data->init_reg_0x63c != INIT_REG_0x63C) { -+ RTW_WARN("init_reg_0x63c:0x%08x != 0x%08x\n", hal_data->init_reg_0x63c, INIT_REG_0x63C); -+ #if RTW_SIFS_INIT_CHK > 1 -+ hal_data->init_reg_0x63c = INIT_REG_0x63C; -+ rtw_write32(adapter, 0x63c, hal_data->init_reg_0x63c); -+ #endif -+ } -+#endif -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_com_c2h.h b/drivers/net/wireless/rtl8821cs/hal/hal_com_c2h.h -new file mode 100644 -index 000000000..b9aa9ffc7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_com_c2h.h -@@ -0,0 +1,142 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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_AP_REQ_TXRPT = 0x04, -+ C2H_FW_SCAN_COMPLETE = 0x7, -+ C2H_BT_INFO = 0x09, -+ C2H_BT_MP_INFO = 0x0B, -+ C2H_RA_RPT = 0x0C, -+ C2H_SPC_STAT = 0x0D, -+ 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_WLAN_INFO = 0x27, -+#ifdef RTW_PER_CMD_SUPPORT_FW -+ C2H_PER_RATE_RPT = 0x2c, -+#endif -+ C2H_LPS_STATUS_RPT = 0x32, -+ C2H_SET_TXPWR_FINISH = 0x70, -+ 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); -+#else -+#define hal_read_mac_hidden_rpt(adapter) _SUCCESS -+#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 */ -+ -+#ifdef RTW_PER_CMD_SUPPORT_FW -+/* C2H_PER_RATE_RPT, 0x2c */ -+int c2h_per_rate_rpt_hdl(_adapter *adapter, u8 *data, u8 len); -+#endif -+ -+#ifdef CONFIG_LPS_ACK -+/* C2H_LPS_STATUS_RPT, 0x32 */ -+#define LPS_STATUS_RPT_LEN 2 -+int c2h_lps_status_rpt(PADAPTER adapter, u8 *data, u8 len); -+#endif /* CONFIG_LPS_ACK */ -+ -+#ifdef CONFIG_FW_OFFLOAD_SET_TXPWR_IDX -+/* C2H_SET_TXPWR_FINISH, 0x70 */ -+#define SET_TXPWR_FINISH_LEN 1 -+void c2h_txpwr_idx_offload_done(_adapter *adapter, u8 *data, u8 len); -+int c2h_txpwr_idx_offload_wait(_adapter *adapter); -+#endif -+ -+void rtw_hal_bcn_early_rpt_c2h_handler(_adapter *adapter); -+ -+#endif /* __COMMON_C2H_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_com_phycfg.c b/drivers/net/wireless/rtl8821cs/hal/hal_com_phycfg.c -new file mode 100644 -index 000000000..c4bbd86bf ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_com_phycfg.c -@@ -0,0 +1,6316 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#define PG_TXPWR_1PATH_BYTE_NUM_2G 18 -+#define PG_TXPWR_BASE_BYTE_NUM_2G 11 -+ -+#define PG_TXPWR_1PATH_BYTE_NUM_5G 24 -+#define PG_TXPWR_BASE_BYTE_NUM_5G 14 -+ -+#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(hal_spec, _base) ((_base) > hal_spec->txgi_max) -+#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_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)]) -+ -+const char *const _txpwr_pg_mode_str[] = { -+ "PWR_IDX", -+ "TSSI_OFFSET", -+ "UNKNOWN", -+}; -+ -+static const 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, -+}; -+ -+#ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX -+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; -+ -+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; -+ -+#ifndef DBG_PG_TXPWR_READ -+#define DBG_PG_TXPWR_READ 0 -+#endif -+ -+#if DBG_PG_TXPWR_READ -+static 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"); -+} -+ -+static 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"); -+} -+#endif /* DBG_PG_TXPWR_READ */ -+ -+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_RTL8188GTV -+static const struct map_t rtl8188gtv_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_RTL8710B -+static const struct map_t rtl8710b_pg_txpwr_def_info = -+ MAP_ENT(0xC8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x20, 12, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x20) -+ ); -+#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_RTL8822C -+static const struct map_t rtl8822c_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 82, -+ 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0x00, 0xFF, 0xFF, -+ 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, -+ 0x02, 0x00, 0xFF, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, -+ 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, -+ 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0xFF, 0xFF, 0x00, 0xFF, -+ 0x00, 0x00) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8723F -+static const struct map_t rtl8723f_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 82, -+ 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0x00, 0xFF, 0xFF, -+ 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, -+ 0x02, 0x00, 0xFF, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, -+ 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, -+ 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0xFF, 0xFF, 0x00, 0xFF, -+ 0x00, 0x00) -+ ); -+#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 -+ -+#ifdef CONFIG_RTL8192F/*use 8192F default,no document*/ -+static const struct map_t rtl8192f_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_RTL8814B -+static const struct map_t rtl8814b_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 168, -+ 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 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, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, -+ 0x28, 0x28, 0x28, 0x28, 0x28, 0x02, 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) -+ ); -+#endif -+ -+#ifdef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+ #ifdef CONFIG_RTL8723F -+ #define EEPROM_TX_PWR_CALIBRATE_RATE EEPROM_TX_PWR_CALIBRATE_RATE_8723F -+ #endif -+ #ifdef CONFIG_RTL8814B -+ #define EEPROM_TX_PWR_CALIBRATE_RATE EEPROM_TX_PWR_CALIBRATE_RATE_8814B -+ #endif -+ #ifdef CONFIG_RTL8822C -+ #define EEPROM_TX_PWR_CALIBRATE_RATE EEPROM_TX_PWR_CALIBRATE_RATE_8822C -+ #endif -+#endif /* CONFIG_TXPWR_PG_WITH_TSSI_OFFSET */ -+ -+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_RTL8188GTV -+ case RTL8188GTV: -+ map = &rtl8188gtv_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 -+#ifdef CONFIG_RTL8710B -+ case RTL8710B: -+ map = &rtl8710b_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8192F -+ case RTL8192F: -+ map = &rtl8192f_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8822C -+ case RTL8822C: -+ map = &rtl8822c_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8814B -+ case RTL8814B: -+ map = &rtl8814b_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8723F -+ case RTL8723F: -+ map = &rtl8723f_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) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ 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(hal_spec, pwr_info->IndexCCK_Base[path][group]) -+ || IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group])) -+ return _FAIL; -+ } -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ if (tx_idx + 1 > hal_data->max_tx_cnt) -+ 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) -+{ -+#if CONFIG_IEEE80211_BAND_5GHZ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ 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(hal_spec, pwr_info->IndexBW40_Base[path][group])) -+ return _FAIL; -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ if (tx_idx + 1 > hal_data->max_tx_cnt) -+ 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) -+{ -+#if 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) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ 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(hal_spec, tmp_base) -+ && IS_PG_TXPWR_BASE_INVALID(hal_spec, 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(hal_spec, tmp_base) -+ && IS_PG_TXPWR_BASE_INVALID(hal_spec, 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)) { -+ 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) && tx_idx + 1 <= hal_data->max_tx_cnt) { -+ 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) && tx_idx + 1 <= hal_data->max_tx_cnt) { -+ 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) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ 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 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; -+ } -+ -+#if 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(hal_spec, tmp_base) -+ && IS_PG_TXPWR_BASE_INVALID(hal_spec, 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)) { -+ 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) && tx_idx + 1 <= hal_data->max_tx_cnt) { -+ 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_data->max_tx_cnt > 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_data->max_tx_cnt > 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_data->max_tx_cnt > 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) && tx_idx + 1 <= hal_data->max_tx_cnt) { -+ 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 /* 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 = hal_spec->pg_txpwr_saddr; -+ -+ 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); -+ #endif -+ -+ return; -+} -+#endif /* CONFIG_TXPWR_PG_WITH_PWR_IDX */ -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ -+#define EFUSE_POWER_INDEX_INVALID 0xFF -+ -+static u8 _check_phy_efuse_tx_power_info_valid(u8 *pg_data, int chk_len, u16 pg_offset) -+{ -+ int ff_cnt = 0; -+ int i; -+ -+ for (i = 0; i < chk_len; i++) { -+ if (*(pg_data + pg_offset + i) == 0xFF) -+ ff_cnt++; -+ } -+ -+ if (ff_cnt == 0) -+ return _TRUE; -+ else if (ff_cnt == chk_len) -+ return _FALSE; -+ else -+ return EFUSE_POWER_INDEX_INVALID; -+} -+ -+int check_phy_efuse_tx_power_info_valid(_adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 *pg_data = hal_data->efuse_eeprom_data; -+ u16 pg_offset = hal_spec->pg_txpwr_saddr; -+ u8 path; -+ u8 valid_2g_path_bmp = 0; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ u8 valid_5g_path_bmp = 0; -+#endif -+ -+#ifdef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+ u8 tpt_mode = (pg_data[EEPROM_TX_PWR_CALIBRATE_RATE] & 0xF0) >> 4; -+#endif -+ -+#ifdef CONFIG_MP_INCLUDED -+ struct mp_priv *pmp_priv = &adapter->mppriv; -+ -+ -+ if (pmp_priv->efuse_update_file == _TRUE && (rtw_mp_mode_check(adapter))) { -+ RTW_INFO("%s: To use efuse_update_file !!!\n", __func__); -+ return _FALSE; -+ } -+#endif -+ -+#ifdef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+ if (tpt_mode >= 4 && tpt_mode <= 7) { /* 4~7: TSSI */ -+ RTW_INFO("%s: tpt_mode is TSSI, skip check\n", __func__); -+ return _TRUE; -+ } -+#endif -+ -+ /* NOTE: TSSI offset use the same layout as TXPWR base */ -+ -+ for (path = 0; path < MAX_RF_PATH; path++) { -+ u8 ret = _FALSE; -+ -+ if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) -+ break; -+ -+ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { -+ ret = _check_phy_efuse_tx_power_info_valid(pg_data, PG_TXPWR_BASE_BYTE_NUM_2G, pg_offset); -+ if (ret == _TRUE) -+ valid_2g_path_bmp |= BIT(path); -+ else if (ret == EFUSE_POWER_INDEX_INVALID) -+ return _FALSE; -+ } -+ pg_offset += PG_TXPWR_1PATH_BYTE_NUM_2G; -+ -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) { -+ ret = _check_phy_efuse_tx_power_info_valid(pg_data, PG_TXPWR_BASE_BYTE_NUM_5G, pg_offset); -+ if (ret == _TRUE) -+ valid_5g_path_bmp |= BIT(path); -+ else if (ret == EFUSE_POWER_INDEX_INVALID) -+ return _FALSE; -+ } -+ #endif -+ pg_offset += PG_TXPWR_1PATH_BYTE_NUM_5G; -+ } -+ -+ if ((hal_chk_band_cap(adapter, BAND_CAP_2G) && valid_2g_path_bmp) -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ || (hal_chk_band_cap(adapter, BAND_CAP_5G) && valid_5g_path_bmp) -+ #endif -+ ) -+ return _TRUE; -+ -+ return _FALSE; -+} -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+ -+#ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX -+void hal_load_txpwr_info(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 max_tx_cnt = hal_data->max_tx_cnt; -+ u8 *pg_data = hal_data->efuse_eeprom_data; -+ TxPowerInfo24G *pwr_info_2g = NULL; -+ TxPowerInfo5G *pwr_info_5g = NULL; -+ u8 rfpath, ch_idx, group, tx_idx; -+ -+ if (hal_chk_band_cap(adapter, BAND_CAP_2G)) -+ pwr_info_2g = rtw_vmalloc(sizeof(TxPowerInfo24G)); -+#if CONFIG_IEEE80211_BAND_5GHZ -+ if (hal_chk_band_cap(adapter, BAND_CAP_5G)) -+ pwr_info_5g = rtw_vmalloc(sizeof(TxPowerInfo5G)); -+#endif -+ -+ /* 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 + 1 > max_tx_cnt) -+ break; -+ -+ hal_data->CCK_24G_Diff[rfpath][tx_idx] = pwr_info_2g->CCK_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; -+ hal_data->OFDM_24G_Diff[rfpath][tx_idx] = pwr_info_2g->OFDM_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; -+ hal_data->BW20_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW20_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; -+ hal_data->BW40_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW40_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; -+ } -+bypass_2g: -+ ; -+ -+#if 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 + 1 > max_tx_cnt) -+ break; -+ -+ hal_data->OFDM_5G_Diff[rfpath][tx_idx] = pwr_info_5g->OFDM_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; -+ hal_data->BW20_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW20_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; -+ hal_data->BW40_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW40_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; -+ hal_data->BW80_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW80_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; -+ } -+bypass_5g: -+ ; -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ } -+ -+ if (pwr_info_2g) -+ rtw_vmfree(pwr_info_2g, sizeof(TxPowerInfo24G)); -+ if (pwr_info_5g) -+ rtw_vmfree(pwr_info_5g, sizeof(TxPowerInfo5G)); -+} -+ -+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, "%3d ", 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, "%3u ", 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, "%3d ", 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, "%3u ", 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) -+{ -+#if 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 */ -+} -+#endif /* CONFIG_TXPWR_PG_WITH_PWR_IDX */ -+ -+/* -+* rtw_regsty_get_target_tx_power - -+* -+* Return dBm or -1 for undefined -+*/ -+s8 rtw_regsty_get_target_tx_power( -+ PADAPTER Adapter, -+ u8 Band, -+ u8 RfPath, -+ 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 -+ #if 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 -+ #if 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]; -+#if 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); -+ 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 + 1 > GET_HAL_TX_NSS(adapter)) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(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_get_target_txpwr - -+* -+* Return value in unit of TX Gain Index -+*/ -+u8 phy_get_target_txpwr( -+ PADAPTER Adapter, -+ u8 Band, -+ u8 RfPath, -+ 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\n", __func__ -+ , RateSection, Band, RfPath); -+ return 0; -+ } -+ -+ if (Band == BAND_ON_2_4G) -+ value = pHalData->target_txpwr_2g[RfPath][RateSection]; -+ else if (Band == BAND_ON_5G) -+ value = pHalData->target_txpwr_5g[RfPath][RateSection - 1]; -+ -+ return value; -+} -+ -+static void phy_set_target_txpwr( -+ PADAPTER Adapter, -+ u8 Band, -+ u8 RfPath, -+ RATE_SECTION RateSection, -+ 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\n", __func__ -+ , RateSection, (Band == BAND_ON_2_4G) ? "2.4" : "5", RfPath); -+ return; -+ } -+ -+ if (Band == BAND_ON_2_4G) -+ pHalData->target_txpwr_2g[RfPath][RateSection] = Value; -+ else /* BAND_ON_5G */ -+ pHalData->target_txpwr_5g[RfPath][RateSection - 1] = Value; -+} -+ -+static inline BOOLEAN phy_is_txpwr_by_rate_undefined_of_band_path(_adapter *adapter, u8 band, u8 path) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 rate_idx = 0; -+ -+ for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) { -+ if (hal_data->TxPwrByRate[band][path][rate_idx] != hal_spec->txgi_max) -+ goto exit; -+ } -+ -+exit: -+ return rate_idx >= TX_PWR_BY_RATE_NUM_RATE ? _TRUE : _FALSE; -+} -+ -+static inline void phy_txpwr_by_rate_duplicate_band_path(_adapter *adapter, u8 band, u8 s_path, u8 t_path) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 rate_idx = 0; -+ -+ for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) -+ hal_data->TxPwrByRate[band][t_path][rate_idx] = hal_data->TxPwrByRate[band][s_path][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); -+ } -+ } -+ } -+} -+ -+static s8 _phy_get_txpwr_by_rate(_adapter *adapter -+ , BAND_TYPE band, enum rf_path rfpath, enum MGN_RATE rate); -+ -+void phy_store_target_tx_power(PADAPTER pAdapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter); -+ struct registry_priv *regsty = adapter_to_regsty(pAdapter); -+ -+ u8 band, path, rs, tx_num, base; -+ -+ 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 + 1 > GET_HAL_TX_NSS(pAdapter)) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) -+ continue; -+ -+ if (regsty->target_tx_pwr_valid == _TRUE) -+ base = hal_spec->txgi_pdbm * rtw_regsty_get_target_tx_power(pAdapter, band, path, rs); -+ else -+ base = _phy_get_txpwr_by_rate(pAdapter, band, path, rate_sec_base[rs]); -+ phy_set_target_txpwr(pAdapter, band, path, rs, base); -+ } -+ } -+ } -+} -+ -+static u8 get_val_from_dhex(u32 dhex, u8 i) -+{ -+ return (((dhex >> (i * 8 + 4)) & 0xF)) * 10 + ((dhex >> (i * 8)) & 0xF); -+} -+ -+static u8 get_val_from_hex(u32 hex, u8 i) -+{ -+ return (hex >> (i * 8)) & 0xFF; -+} -+ -+void -+PHY_GetRateValuesOfTxPowerByRate( -+ PADAPTER pAdapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Value, -+ u8 *Rate, -+ s8 *PwrByRateVal, -+ u8 *RateNum -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ u8 i = 0; -+ u8 (*get_val)(u32, u8); -+ -+ if (pDM_Odm->phy_reg_pg_version == 1) -+ get_val = get_val_from_dhex; -+ else -+ get_val = get_val_from_hex; -+ -+ 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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_CCK1_Mcs32: -+ Rate[0] = MGN_1M; -+ PwrByRateVal[0] = (s8)get_val(Value, 1); -+ *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)get_val(Value, i); -+ *RateNum = 3; -+ } else if (BitMask == 0x000000ff) { -+ Rate[0] = MGN_11M; -+ PwrByRateVal[0] = (s8)get_val(Value, 0); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *RateNum = 4; -+ break; -+ -+ case 0x3a24: /* HT MCS24-27 */ -+ Rate[0] = MGN_MCS24; -+ Rate[1] = MGN_MCS25; -+ Rate[2] = MGN_MCS26; -+ Rate[3] = MGN_MCS27; -+ for (i = 0; i < 4; ++i) -+ PwrByRateVal[i] = (s8)get_val(Value, i); -+ *RateNum = 4; -+ break; -+ -+ case 0x3a28: /* HT MCS28-31 */ -+ Rate[0] = MGN_MCS28; -+ Rate[1] = MGN_MCS29; -+ Rate[2] = MGN_MCS30; -+ Rate[3] = MGN_MCS31; -+ for (i = 0; i < 4; ++i) -+ PwrByRateVal[i] = (s8)get_val(Value, i); -+ *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)get_val(Value, i); -+ *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)get_val(Value, i); -+ *RateNum = 4; -+ break; -+ -+ case 0xCE8: -+ case 0xEE8: -+ case 0x18E8: -+ case 0x1aE8: -+ case 0x3a48: -+ Rate[0] = MGN_VHT3SS_MCS8; -+ Rate[1] = MGN_VHT3SS_MCS9; -+ Rate[2] = MGN_VHT4SS_MCS0; -+ Rate[3] = MGN_VHT4SS_MCS1; -+ for (i = 0; i < 4; ++i) -+ PwrByRateVal[i] = (s8)get_val(Value, i); -+ *RateNum = 4; -+ break; -+ -+ case 0x3a4c: -+ Rate[0] = MGN_VHT4SS_MCS2; -+ Rate[1] = MGN_VHT4SS_MCS3; -+ Rate[2] = MGN_VHT4SS_MCS4; -+ Rate[3] = MGN_VHT4SS_MCS5; -+ for (i = 0; i < 4; ++i) -+ PwrByRateVal[i] = (s8)get_val(Value, i); -+ *RateNum = 4; -+ break; -+ -+ case 0x3a50: -+ Rate[0] = MGN_VHT4SS_MCS6; -+ Rate[1] = MGN_VHT4SS_MCS7; -+ Rate[2] = MGN_VHT4SS_MCS8; -+ Rate[3] = MGN_VHT4SS_MCS9; -+ for (i = 0; i < 4; ++i) -+ PwrByRateVal[i] = (s8)get_val(Value, i); -+ *RateNum = 4; -+ break; -+ -+ default: -+ RTW_PRINT("Invalid RegAddr 0x%x in %s()\n", RegAddr, __func__); -+ break; -+ }; -+} -+ -+void -+PHY_StoreTxPowerByRateNew( -+ PADAPTER pAdapter, -+ u32 Band, -+ u32 RfPath, -+ u32 RegAddr, -+ u32 BitMask, -+ 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 > RF_PATH_D) { -+ RTW_PRINT("Invalid RfPath %d\n", RfPath); -+ return; -+ } -+ -+ for (i = 0; i < rateNum; ++i) { -+ u8 rate_idx = phy_get_rate_idx_of_txpwr_by_rate(rates[i]); -+ -+ pHalData->TxPwrByRate[Band][RfPath][rate_idx] = PwrByRateVal[i]; -+ } -+} -+ -+void -+PHY_InitTxPowerByRate( -+ PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter); -+ u8 band = 0, rfPath = 0, rate = 0; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) -+ for (rfPath = 0; rfPath < TX_PWR_BY_RATE_NUM_RF; ++rfPath) -+ for (rate = 0; rate < TX_PWR_BY_RATE_NUM_RATE; ++rate) -+ pHalData->TxPwrByRate[band][rfPath][rate] = hal_spec->txgi_max; -+} -+ -+void -+phy_store_tx_power_by_rate( -+ PADAPTER pAdapter, -+ u32 Band, -+ u32 RfPath, -+ u32 TxNum, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ -+ if (pDM_Odm->phy_reg_pg_version > 0) -+ PHY_StoreTxPowerByRateNew(pAdapter, Band, RfPath, RegAddr, BitMask, Data); -+ else -+ RTW_INFO("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->phy_reg_pg_version); -+ -+} -+ -+/* -+ * This function must be called if the value in the PHY_REG_PG.txt(or header) -+ * is exact dBm values -+ */ -+void -+PHY_TxPowerByRateConfiguration( -+ PADAPTER pAdapter -+) -+{ -+ phy_txpwr_by_rate_chk_for_path_dup(pAdapter); -+ phy_store_target_tx_power(pAdapter); -+} -+ -+#ifdef CONFIG_FW_OFFLOAD_SET_TXPWR_IDX -+extern bool phy_set_txpwr_idx_offload(_adapter *adapter); -+#endif -+ -+void -+phy_set_tx_power_index_by_rate_section( -+ PADAPTER pAdapter, -+ enum rf_path RFPath, -+ u8 Channel, -+ u8 rs -+) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(pAdapter); -+ u8 band = hal_data->current_band_type; -+ u8 bw = hal_data->current_channel_bw; -+ u32 powerIndex = 0; -+ int i = 0; -+ -+ if (rs >= RATE_SECTION_NUM) { -+ RTW_INFO("Invalid RateSection %d in %s", rs, __func__); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (rs == CCK && bw != BAND_ON_2_4G) -+ goto exit; -+ -+ for (i = 0; i < rates_by_sections[rs].rate_num; ++i) { -+#if DBG_TX_POWER_IDX -+ struct txpwr_idx_comp tic; -+ -+ powerIndex = rtw_hal_get_tx_power_index(pAdapter, RFPath -+ , rs, rates_by_sections[rs].rates[i], bw, band, Channel, 0, &tic); -+ dump_tx_power_index_inline(RTW_DBGDUMP, pAdapter, RFPath, bw, Channel -+ , rates_by_sections[rs].rates[i], powerIndex, &tic); -+#else -+ powerIndex = phy_get_tx_power_index_ex(pAdapter, RFPath -+ , rs, rates_by_sections[rs].rates[i], bw, band, Channel, 0); -+#endif -+ PHY_SetTxPowerIndex(pAdapter, powerIndex, RFPath, rates_by_sections[rs].rates[i]); -+ } -+ -+#ifdef CONFIG_FW_OFFLOAD_SET_TXPWR_IDX -+ if (!hal_data->set_entire_txpwr -+ && phy_set_txpwr_idx_offload(pAdapter)) -+ rtw_hal_set_txpwr_done(pAdapter); -+#endif -+ -+exit: -+ return; -+} -+ -+bool phy_get_ch_idx(u8 ch, u8 *ch_idx) -+{ -+ u8 i = 0; -+ BOOLEAN bIn24G = _TRUE; -+ -+ if (ch > 0 && ch <= 14) { -+ bIn24G = _TRUE; -+ *ch_idx = ch - 1; -+ } else { -+ bIn24G = _FALSE; -+ -+ for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) { -+ if (center_ch_5g_all[i] == ch) { -+ *ch_idx = i; -+ break; -+ } -+ } -+ } -+ -+ return bIn24G; -+} -+ -+bool phy_chk_ch_setting_consistency(_adapter *adapter, u8 ch) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 ch_idx = 0xFF; -+ u8 ret = _FAIL; -+ -+ phy_get_ch_idx(ch, &ch_idx); -+ if (ch_idx == 0xFF) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (ch != hal_data->current_channel) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (ch <= 14) { -+ if (hal_data->current_band_type != BAND_ON_2_4G) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ if (hal_data->current_channel_bw > CHANNEL_WIDTH_40) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ } -+ if (ch > 14) { -+ if (hal_data->current_band_type != BAND_ON_5G) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ if (hal_data->current_channel_bw > CHANNEL_WIDTH_160) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ } -+ -+ ret = _SUCCESS; -+ -+exit: -+ if (ret != _SUCCESS) -+ RTW_WARN("ch:%u, hal band:%u, ch:%u, bw:%u\n", ch -+ , hal_data->current_band_type, hal_data->current_channel, hal_data->current_channel_bw); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX -+u8 phy_get_pg_txpwr_idx(_adapter *pAdapter -+ , enum rf_path RFPath, RATE_SECTION rs, u8 ntx_idx -+ , enum channel_width BandWidth, u8 band, u8 Channel) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ u8 i; -+ u8 txPower = 0; -+ u8 chnlIdx = (Channel - 1); -+ -+ if (HAL_IsLegalChannel(pAdapter, Channel) == _FALSE) { -+ chnlIdx = 0; -+ RTW_INFO("Illegal channel!!\n"); -+ } -+ -+ phy_get_ch_idx(Channel, &chnlIdx); -+ -+ if (0) -+ RTW_INFO("[%s] Channel Index: %d\n", band_str(band), chnlIdx); -+ -+ if (band == BAND_ON_2_4G) { -+ if (IS_CCK_RATE_SECTION(rs)) { -+ /* CCK-nTX */ -+ txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx]; -+ txPower += pHalData->CCK_24G_Diff[RFPath][RF_1TX]; -+ if (ntx_idx >= RF_2TX) -+ txPower += pHalData->CCK_24G_Diff[RFPath][RF_2TX]; -+ if (ntx_idx >= RF_3TX) -+ txPower += pHalData->CCK_24G_Diff[RFPath][RF_3TX]; -+ if (ntx_idx >= RF_4TX) -+ txPower += pHalData->CCK_24G_Diff[RFPath][RF_4TX]; -+ goto exit; -+ } -+ -+ txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx]; -+ -+ /* OFDM-nTX */ -+ if (IS_OFDM_RATE_SECTION(rs)) { -+ txPower += pHalData->OFDM_24G_Diff[RFPath][RF_1TX]; -+ if (ntx_idx >= RF_2TX) -+ txPower += pHalData->OFDM_24G_Diff[RFPath][RF_2TX]; -+ if (ntx_idx >= RF_3TX) -+ txPower += pHalData->OFDM_24G_Diff[RFPath][RF_3TX]; -+ if (ntx_idx >= RF_4TX) -+ txPower += pHalData->OFDM_24G_Diff[RFPath][RF_4TX]; -+ goto exit; -+ } -+ -+ /* BW20-nS */ -+ if (BandWidth == CHANNEL_WIDTH_20) { -+ txPower += pHalData->BW20_24G_Diff[RFPath][RF_1TX]; -+ if (rate_section_to_tx_num(rs) >= RF_2TX) -+ txPower += pHalData->BW20_24G_Diff[RFPath][RF_2TX]; -+ if (rate_section_to_tx_num(rs) >= RF_3TX) -+ txPower += pHalData->BW20_24G_Diff[RFPath][RF_3TX]; -+ if (rate_section_to_tx_num(rs) >= RF_4TX) -+ txPower += pHalData->BW20_24G_Diff[RFPath][RF_4TX]; -+ goto exit; -+ } -+ -+ /* BW40-nS */ -+ if (BandWidth == CHANNEL_WIDTH_40 -+ /* Willis suggest adopt BW 40M power index while in BW 80 mode */ -+ || BandWidth == CHANNEL_WIDTH_80 -+ ) { -+ txPower += pHalData->BW40_24G_Diff[RFPath][RF_1TX]; -+ if (rate_section_to_tx_num(rs) >= RF_2TX) -+ txPower += pHalData->BW40_24G_Diff[RFPath][RF_2TX]; -+ if (rate_section_to_tx_num(rs) >= RF_3TX) -+ txPower += pHalData->BW40_24G_Diff[RFPath][RF_3TX]; -+ if (rate_section_to_tx_num(rs) >= RF_4TX) -+ txPower += pHalData->BW40_24G_Diff[RFPath][RF_4TX]; -+ goto exit; -+ } -+ } -+#if CONFIG_IEEE80211_BAND_5GHZ -+ else if (band == BAND_ON_5G) { -+ if (IS_CCK_RATE_SECTION(rs)) { -+ RTW_WARN("===>%s: INVALID, CCK on 5G\n", __func__); -+ goto exit; -+ } -+ -+ txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx]; -+ -+ /* OFDM-nTX */ -+ if (IS_OFDM_RATE_SECTION(rs)) { -+ txPower += pHalData->OFDM_5G_Diff[RFPath][RF_1TX]; -+ if (ntx_idx >= RF_2TX) -+ txPower += pHalData->OFDM_5G_Diff[RFPath][RF_2TX]; -+ if (ntx_idx >= RF_3TX) -+ txPower += pHalData->OFDM_5G_Diff[RFPath][RF_3TX]; -+ if (ntx_idx >= RF_4TX) -+ txPower += pHalData->OFDM_5G_Diff[RFPath][RF_4TX]; -+ goto exit; -+ } -+ -+ /* BW20-nS */ -+ if (BandWidth == CHANNEL_WIDTH_20) { -+ txPower += pHalData->BW20_5G_Diff[RFPath][RF_1TX]; -+ if (rate_section_to_tx_num(rs) >= RF_2TX) -+ txPower += pHalData->BW20_5G_Diff[RFPath][RF_2TX]; -+ if (rate_section_to_tx_num(rs) >= RF_3TX) -+ txPower += pHalData->BW20_5G_Diff[RFPath][RF_3TX]; -+ if (rate_section_to_tx_num(rs) >= RF_4TX) -+ txPower += pHalData->BW20_5G_Diff[RFPath][RF_4TX]; -+ goto exit; -+ } -+ -+ /* BW40-nS */ -+ if (BandWidth == CHANNEL_WIDTH_40) { -+ txPower += pHalData->BW40_5G_Diff[RFPath][RF_1TX]; -+ if (rate_section_to_tx_num(rs) >= RF_2TX) -+ txPower += pHalData->BW40_5G_Diff[RFPath][RF_2TX]; -+ if (rate_section_to_tx_num(rs) >= RF_3TX) -+ txPower += pHalData->BW40_5G_Diff[RFPath][RF_3TX]; -+ if (rate_section_to_tx_num(rs) >= RF_4TX) -+ txPower += pHalData->BW40_5G_Diff[RFPath][RF_4TX]; -+ goto exit; -+ } -+ -+ /* BW80-nS */ -+ if (BandWidth == CHANNEL_WIDTH_80) { -+ /* get 80MHz cch index */ -+ for (i = 0; i < CENTER_CH_5G_80M_NUM; ++i) { -+ if (center_ch_5g_80m[i] == Channel) { -+ chnlIdx = i; -+ break; -+ } -+ } -+ if (i >= CENTER_CH_5G_80M_NUM) { -+ #ifdef CONFIG_MP_INCLUDED -+ if (rtw_mp_mode_check(pAdapter) == _FALSE) -+ #endif -+ rtw_warn_on(1); -+ txPower = 0; -+ goto exit; -+ } -+ -+ txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx]; -+ -+ txPower += + pHalData->BW80_5G_Diff[RFPath][RF_1TX]; -+ if (rate_section_to_tx_num(rs) >= RF_2TX) -+ txPower += pHalData->BW80_5G_Diff[RFPath][RF_2TX]; -+ if (rate_section_to_tx_num(rs) >= RF_3TX) -+ txPower += pHalData->BW80_5G_Diff[RFPath][RF_3TX]; -+ if (rate_section_to_tx_num(rs) >= RF_4TX) -+ txPower += pHalData->BW80_5G_Diff[RFPath][RF_4TX]; -+ goto exit; -+ } -+ -+ /* TODO: BW160-nS */ -+ rtw_warn_on(1); -+ } -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ -+exit: -+ return txPower; -+} -+#endif /* CONFIG_TXPWR_PG_WITH_PWR_IDX */ -+ -+s8 -+PHY_GetTxPowerTrackingOffset( -+ PADAPTER pAdapter, -+ enum rf_path RFPath, -+ u8 Rate -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ s8 offset = 0; -+ -+ if (pDM_Odm->rf_calibrate_info.txpowertrack_control == _FALSE) -+ return offset; -+ -+ if ((Rate == MGN_1M) || (Rate == MGN_2M) || (Rate == MGN_5_5M) || (Rate == MGN_11M)) { -+ offset = pDM_Odm->rf_calibrate_info.remnant_cck_swing_idx; -+ /*RTW_INFO("+Remnant_CCKSwingIdx = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_CCKSwingIdx);*/ -+ } else { -+ offset = pDM_Odm->rf_calibrate_info.remnant_ofdm_swing_idx[RFPath]; -+ /*RTW_INFO("+Remanant_OFDMSwingIdx[RFPath %u][Rate 0x%x] = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath]); */ -+ -+ } -+ -+ return offset; -+} -+ -+static const u8 _phy_get_rate_idx_of_txpwr_by_rate[MGN_UNKNOWN] = { -+ [MGN_1M] = 0, -+ [MGN_2M] = 1, -+ [MGN_5_5M] = 2, -+ [MGN_11M] = 3, -+ [MGN_6M] = 4, -+ [MGN_9M] = 5, -+ [MGN_12M] = 6, -+ [MGN_18M] = 7, -+ [MGN_24M] = 8, -+ [MGN_36M] = 9, -+ [MGN_48M] = 10, -+ [MGN_54M] = 11, -+ [MGN_MCS0] = 12, -+ [MGN_MCS1] = 13, -+ [MGN_MCS2] = 14, -+ [MGN_MCS3] = 15, -+ [MGN_MCS4] = 16, -+ [MGN_MCS5] = 17, -+ [MGN_MCS6] = 18, -+ [MGN_MCS7] = 19, -+ [MGN_MCS8] = 20, -+ [MGN_MCS9] = 21, -+ [MGN_MCS10] = 22, -+ [MGN_MCS11] = 23, -+ [MGN_MCS12] = 24, -+ [MGN_MCS13] = 25, -+ [MGN_MCS14] = 26, -+ [MGN_MCS15] = 27, -+ [MGN_MCS16] = 28, -+ [MGN_MCS17] = 29, -+ [MGN_MCS18] = 30, -+ [MGN_MCS19] = 31, -+ [MGN_MCS20] = 32, -+ [MGN_MCS21] = 33, -+ [MGN_MCS22] = 34, -+ [MGN_MCS23] = 35, -+ [MGN_MCS24] = 36, -+ [MGN_MCS25] = 37, -+ [MGN_MCS26] = 38, -+ [MGN_MCS27] = 39, -+ [MGN_MCS28] = 40, -+ [MGN_MCS29] = 41, -+ [MGN_MCS30] = 42, -+ [MGN_MCS31] = 43, -+ [MGN_VHT1SS_MCS0] = 44, -+ [MGN_VHT1SS_MCS1] = 45, -+ [MGN_VHT1SS_MCS2] = 46, -+ [MGN_VHT1SS_MCS3] = 47, -+ [MGN_VHT1SS_MCS4] = 48, -+ [MGN_VHT1SS_MCS5] = 49, -+ [MGN_VHT1SS_MCS6] = 50, -+ [MGN_VHT1SS_MCS7] = 51, -+ [MGN_VHT1SS_MCS8] = 52, -+ [MGN_VHT1SS_MCS9] = 53, -+ [MGN_VHT2SS_MCS0] = 54, -+ [MGN_VHT2SS_MCS1] = 55, -+ [MGN_VHT2SS_MCS2] = 56, -+ [MGN_VHT2SS_MCS3] = 57, -+ [MGN_VHT2SS_MCS4] = 58, -+ [MGN_VHT2SS_MCS5] = 59, -+ [MGN_VHT2SS_MCS6] = 60, -+ [MGN_VHT2SS_MCS7] = 61, -+ [MGN_VHT2SS_MCS8] = 62, -+ [MGN_VHT2SS_MCS9] = 63, -+ [MGN_VHT3SS_MCS0] = 64, -+ [MGN_VHT3SS_MCS1] = 65, -+ [MGN_VHT3SS_MCS2] = 66, -+ [MGN_VHT3SS_MCS3] = 67, -+ [MGN_VHT3SS_MCS4] = 68, -+ [MGN_VHT3SS_MCS5] = 69, -+ [MGN_VHT3SS_MCS6] = 70, -+ [MGN_VHT3SS_MCS7] = 71, -+ [MGN_VHT3SS_MCS8] = 72, -+ [MGN_VHT3SS_MCS9] = 73, -+ [MGN_VHT4SS_MCS0] = 74, -+ [MGN_VHT4SS_MCS1] = 75, -+ [MGN_VHT4SS_MCS2] = 76, -+ [MGN_VHT4SS_MCS3] = 77, -+ [MGN_VHT4SS_MCS4] = 78, -+ [MGN_VHT4SS_MCS5] = 79, -+ [MGN_VHT4SS_MCS6] = 80, -+ [MGN_VHT4SS_MCS7] = 81, -+ [MGN_VHT4SS_MCS8] = 82, -+ [MGN_VHT4SS_MCS9] = 83, -+}; -+ -+/*The same as MRateToHwRate in hal_com.c*/ -+u8 phy_get_rate_idx_of_txpwr_by_rate(enum MGN_RATE rate) -+{ -+ u8 index = 0; -+ -+ if (rate < MGN_UNKNOWN) -+ index = _phy_get_rate_idx_of_txpwr_by_rate[rate]; -+ -+ if (rate != MGN_1M && index == 0) -+ RTW_WARN("Invalid rate 0x%x in %s\n", rate, __FUNCTION__); -+ -+ return index; -+} -+ -+static s8 _phy_get_txpwr_by_rate(_adapter *adapter -+ , BAND_TYPE band, enum rf_path rfpath, enum MGN_RATE rate) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ s8 value = 0; -+ u8 rate_idx = phy_get_rate_idx_of_txpwr_by_rate(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 > RF_PATH_D) { -+ RTW_INFO("Invalid RfPath %d in %s\n", rfpath, __func__); -+ goto exit; -+ } -+ if (rate_idx >= TX_PWR_BY_RATE_NUM_RATE) { -+ RTW_INFO("Invalid RateIndex %d in %s\n", rate_idx, __func__); -+ goto exit; -+ } -+ -+ value = pHalData->TxPwrByRate[band][rfpath][rate_idx]; -+ -+exit: -+ return value; -+} -+ -+/* -+* Return value in unit of TX Gain Index -+*/ -+s8 phy_get_txpwr_by_rate(_adapter *adapter -+ , BAND_TYPE band, enum rf_path rfpath, RATE_SECTION rs, enum MGN_RATE rate) -+{ -+ if (phy_is_tx_power_by_rate_needed(adapter)) -+ return _phy_get_txpwr_by_rate(adapter, band, rfpath, rate); -+ return phy_get_target_txpwr(adapter, band, rfpath, rs); -+} -+ -+/* get txpowr in mBm for single path */ -+s16 phy_get_txpwr_by_rate_single_mbm(_adapter *adapter -+ , BAND_TYPE band, enum rf_path rfpath, RATE_SECTION rs, enum MGN_RATE rate, bool eirp) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ s16 val; -+ -+ val = phy_get_txpwr_by_rate(adapter, band, rfpath, rs, rate); -+ if (val == hal_spec->txgi_max) -+ val = UNSPECIFIED_MBM; -+ else { -+ val = (val * MBM_PDBM) / hal_spec->txgi_pdbm; -+ if (eirp) -+ val += rfctl->antenna_gain; -+ } -+ -+ return val; -+} -+ -+/* get txpowr in mBm with effect of N-TX */ -+s16 phy_get_txpwr_by_rate_total_mbm(_adapter *adapter -+ , BAND_TYPE band, RATE_SECTION rs, enum MGN_RATE rate, bool cap, bool eirp) -+{ -+ s16 val; -+ u8 tx_num; -+ -+ if (cap) -+ tx_num = phy_get_capable_tx_num(adapter, rate) + 1; -+ else -+ tx_num = phy_get_current_tx_num(adapter, rate) + 1; -+ -+ /* assume all path have same txpower target */ -+ val = phy_get_txpwr_by_rate_single_mbm(adapter, band, RF_PATH_A, rs, rate, eirp); -+ if (val != UNSPECIFIED_MBM) -+ val += mb_of_ntx(tx_num); -+ -+ return val; -+} -+ -+static s16 _phy_get_txpwr_by_rate_max_mbm(_adapter *adapter, BAND_TYPE band, s8 rfpath, bool cap, bool eirp) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 tx_num; -+ RATE_SECTION rs; -+ int i; -+ s16 max = UNSPECIFIED_MBM, mbm; -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ tx_num = rate_section_to_tx_num(rs); -+ if (tx_num + 1 > hal_data->tx_nss) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ continue; -+ -+ for (i = 0; i < rates_by_sections[rs].rate_num; i++) { -+ if (rfpath < 0) /* total */ -+ mbm = phy_get_txpwr_by_rate_total_mbm(adapter, band, rs, rates_by_sections[rs].rates[i], cap, eirp); -+ else -+ mbm = phy_get_txpwr_by_rate_single_mbm(adapter, band, rfpath, rs, rates_by_sections[rs].rates[i], eirp); -+ if (mbm == UNSPECIFIED_MBM) -+ continue; -+ if (max == UNSPECIFIED_MBM || mbm > max) -+ max = mbm; -+ } -+ } -+ -+ return max; -+} -+ -+/* get txpowr in mBm for single path */ -+s16 phy_get_txpwr_by_rate_single_max_mbm(_adapter *adapter, BAND_TYPE band, enum rf_path rfpath, bool eirp) -+{ -+ return _phy_get_txpwr_by_rate_max_mbm(adapter, band, rfpath, 0 /* single don't care */, eirp); -+} -+ -+/* get txpowr in mBm with effect of N-TX */ -+s16 phy_get_txpwr_by_rate_total_max_mbm(_adapter *adapter, BAND_TYPE band, bool cap, bool eirp) -+{ -+ return _phy_get_txpwr_by_rate_max_mbm(adapter, band, -1, cap, eirp); -+} -+ -+u8 phy_check_under_survey_ch(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ u8 ret = _FALSE; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ mlmeext = &iface->mlmeextpriv; -+ -+ /* check scan state */ -+ if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE -+ && mlmeext_scan_state(mlmeext) != SCAN_COMPLETE -+ && mlmeext_scan_state(mlmeext) != SCAN_BACKING_OP) { -+ ret = _TRUE; -+ } else if (mlmeext_scan_state(mlmeext) == SCAN_BACKING_OP -+ && !mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_TX_RESUME)) { -+ ret = _TRUE; -+ } -+ } -+ -+ return ret; -+} -+ -+void -+phy_set_tx_power_level_by_path( -+ PADAPTER Adapter, -+ u8 channel, -+ u8 path -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ BOOLEAN bIsIn24G = (pHalData->current_band_type == BAND_ON_2_4G); -+ u8 under_survey_ch = phy_check_under_survey_ch(Adapter); -+ -+ -+ /* if ( pMgntInfo->RegNByteAccess == 0 ) */ -+ { -+ if (bIsIn24G) -+ phy_set_tx_power_index_by_rate_section(Adapter, path, channel, CCK); -+ -+ phy_set_tx_power_index_by_rate_section(Adapter, path, channel, OFDM); -+ -+ if (!under_survey_ch) { -+ phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS0_MCS7); -+ -+ if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) -+ phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9); -+ -+ if (pHalData->tx_nss >= 2) { -+ phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS8_MCS15); -+ -+ if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) -+ phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9); -+ -+ if (IS_HARDWARE_TYPE_8814A(Adapter)) { -+ phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS16_MCS23); -+ phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_3SSMCS0_3SSMCS9); -+ } -+ } -+ } -+ } -+} -+ -+#if CONFIG_TXPWR_LIMIT -+const char *const _txpwr_lmt_rs_str[] = { -+ "CCK", -+ "OFDM", -+ "HT", -+ "VHT", -+ "UNKNOWN", -+}; -+ -+static s8 -+phy_GetChannelIndexOfTxPowerLimit( -+ u8 Band, -+ 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_txpwr_ww_lmt_value(_adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ if (hal_spec->txgi_max == 63) -+ return -63; -+ else if (hal_spec->txgi_max == 127) -+ return -128; -+ -+ rtw_warn_on(1); -+ return -128; -+} -+ -+/* -+* return txpwr limit in unit of TX Gain Index -+* hsl_spec->txgi_max is returned when NO limit -+*/ -+s8 phy_get_txpwr_lmt( -+ PADAPTER Adapter, -+ const char *lmt_name, -+ BAND_TYPE Band, -+ enum channel_width bw, -+ u8 tlrs, -+ u8 ntx_idx, -+ u8 cch, -+ u8 lock -+) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(Adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(Adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); -+ struct txpwr_lmt_ent *ent = NULL; -+ _irqL irqL; -+ _list *cur, *head; -+ s8 ch_idx; -+ u8 is_ww_regd = 0; -+ s8 ww_lmt_val = phy_txpwr_ww_lmt_value(Adapter); -+ s8 lmt = hal_spec->txgi_max; -+ -+ if ((Adapter->registrypriv.RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory != 1) || -+ Adapter->registrypriv.RegEnableTxPowerLimit == 0) -+ goto exit; -+ -+ 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 (Band == BAND_ON_5G && tlrs == TXPWR_LMT_RS_CCK) { -+ RTW_ERR("5G has no CCK\n"); -+ goto exit; -+ } -+ -+ if (lock) -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ if (!lmt_name) { /* no name specified, use currnet */ -+ if (Band < BAND_MAX) -+ lmt_name = rfctl->txpwr_lmt_name[Band]; -+ else { -+ rtw_warn_on(1); -+ goto release_lock; -+ } -+ } -+ -+ if (rfctl->txpwr_lmt_num == 0 -+ || lmt_name == NULL -+ || strcmp(lmt_name, txpwr_lmt_str(TXPWR_LMT_NONE)) == 0) -+ goto release_lock; -+ -+ if (strcmp(lmt_name, txpwr_lmt_str(TXPWR_LMT_WW)) == 0) -+ is_ww_regd = 1; -+ -+ if (!is_ww_regd) { -+ ent = _rtw_txpwr_lmt_get_by_name(rfctl, lmt_name); -+ if (!ent) -+ goto release_lock; -+ } -+ -+ ch_idx = phy_GetChannelIndexOfTxPowerLimit(Band, cch); -+ if (ch_idx == -1) -+ goto release_lock; -+ -+ if (Band == BAND_ON_2_4G) { -+ if (!is_ww_regd) { -+ lmt = ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx]; -+ if (lmt != ww_lmt_val) -+ goto release_lock; -+ } -+ -+ /* search for min value for WW regd or WW limit */ -+ lmt = hal_spec->txgi_max; -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ if (ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx] != ww_lmt_val) -+ lmt = rtw_min(lmt, ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx]); -+ } -+ } -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ else if (Band == BAND_ON_5G) { -+ if (!is_ww_regd) { -+ lmt = ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx]; -+ if (lmt != ww_lmt_val) -+ goto release_lock; -+ } -+ -+ /* search for min value for WW regd or WW limit */ -+ lmt = hal_spec->txgi_max; -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ if (ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx] != ww_lmt_val) -+ lmt = rtw_min(lmt, ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx]); -+ } -+ } -+ #endif -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ else if (Band == BAND_ON_6G) { -+ rtw_warn_on(1); -+ } -+ #endif -+ -+release_lock: -+ if (lock) -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+exit: -+ return lmt; -+} -+ -+/* -+* return txpwr limit diff value to target of its rate section in unit of TX Gain Index -+* hal_spec->txgi_max is returned when NO limit -+*/ -+inline s8 phy_get_txpwr_lmt_diff(_adapter *adapter -+ , const char *lmt_name -+ , BAND_TYPE band, enum channel_width bw -+ , u8 rfpath, u8 rs, u8 tlrs, u8 ntx_idx, u8 cch, u8 lock -+) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ s8 lmt = phy_get_txpwr_lmt(adapter, lmt_name, band, bw, tlrs, ntx_idx, cch, lock); -+ -+ if (lmt != hal_spec->txgi_max) { -+ /* return diff value */ -+ lmt = lmt - phy_get_target_txpwr(adapter, band, rfpath, rs); -+ } -+ -+ return lmt; -+} -+ -+/* -+* May search for secondary channels for max/min limit -+* @opch: used to specify operating channel position to get -+* cch of every bandwidths which differ from current hal_data.cch20, 40, 80... -+* -+* return txpwr limit in unit of TX Gain Index -+* hsl_spec->txgi_max is returned when NO limit -+*/ -+s8 phy_get_txpwr_lmt_sub_chs(_adapter *adapter -+ , const char *lmt_name -+ , BAND_TYPE band, enum channel_width bw -+ , u8 rfpath, u8 rate, u8 ntx_idx, u8 cch, u8 opch, bool reg_max) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ BOOLEAN no_sc = _FALSE; -+ u8 cch_20 = hal_data->cch_20, cch_40 = hal_data->cch_40, cch_80 = hal_data->cch_80; -+ s8 tlrs = -1; -+ s8 lmt = hal_spec->txgi_max; -+ u8 tmp_cch = 0; -+ u8 tmp_bw; -+ u8 bw_bmp = 0; -+ s8 final_lmt = reg_max ? 0 : hal_spec->txgi_max; -+ u8 final_bw = CHANNEL_WIDTH_MAX, final_cch = cch; -+ _irqL irqL; -+ -+ if ((adapter->registrypriv.RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory != 1) || -+ adapter->registrypriv.RegEnableTxPowerLimit == 0 -+ ) { -+ final_lmt = hal_spec->txgi_max; -+ goto exit; -+ } -+ -+#ifdef CONFIG_MP_INCLUDED -+ /* MP mode channel don't use secondary channel */ -+ if (rtw_mp_mode_check(adapter) == _TRUE) -+ no_sc = _TRUE; -+#endif -+ if (IS_CCK_RATE(rate)) -+ tlrs = TXPWR_LMT_RS_CCK; -+ else if (IS_OFDM_RATE(rate)) -+ tlrs = TXPWR_LMT_RS_OFDM; -+ else if (IS_HT_RATE(rate)) -+ tlrs = TXPWR_LMT_RS_HT; -+ else if (IS_VHT_RATE(rate)) -+ tlrs = TXPWR_LMT_RS_VHT; -+ else { -+ RTW_ERR("%s invalid rate 0x%x\n", __func__, rate); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (no_sc == _TRUE) { -+ /* use the input center channel and bandwidth directly */ -+ tmp_cch = cch; -+ bw_bmp = ch_width_to_bw_cap(bw); -+ } else { -+ /* decide center channel of each bandwidth */ -+ if (opch != 0) { -+ cch_80 = bw == CHANNEL_WIDTH_80 ? cch : 0; -+ cch_40 = bw == CHANNEL_WIDTH_40 ? cch : 0; -+ cch_20 = bw == CHANNEL_WIDTH_20 ? cch : 0; -+ if (cch_80 != 0) -+ cch_40 = rtw_get_scch_by_cch_opch(cch_80, CHANNEL_WIDTH_80, opch); -+ if (cch_40 != 0) -+ cch_20 = rtw_get_scch_by_cch_opch(cch_40, CHANNEL_WIDTH_40, opch); -+ } -+ -+ /* -+ * reg_max: -+ * get valid full bandwidth bmp up to @bw -+ * -+ * !reg_max: -+ * find the possible tx bandwidth bmp for this rate -+ * if no possible tx bandwidth bmp, select valid bandwidth bmp up to @bw -+ */ -+ if (tlrs == TXPWR_LMT_RS_CCK || tlrs == TXPWR_LMT_RS_OFDM) -+ bw_bmp = BW_CAP_20M; /* CCK, OFDM only BW 20M */ -+ else if (tlrs == TXPWR_LMT_RS_HT) { -+ if (reg_max) -+ bw_bmp = ch_width_to_bw_cap(bw > CHANNEL_WIDTH_40 ? CHANNEL_WIDTH_40 + 1 : bw + 1) - 1; -+ else { -+ bw_bmp = rtw_get_tx_bw_bmp_of_ht_rate(dvobj, rate, bw); -+ if (bw_bmp == 0) -+ bw_bmp = ch_width_to_bw_cap(bw > CHANNEL_WIDTH_40 ? CHANNEL_WIDTH_40 : bw); -+ } -+ } else if (tlrs == TXPWR_LMT_RS_VHT) { -+ if (reg_max) -+ bw_bmp = ch_width_to_bw_cap(bw > CHANNEL_WIDTH_160 ? CHANNEL_WIDTH_160 + 1 : bw + 1) - 1; -+ else { -+ bw_bmp = rtw_get_tx_bw_bmp_of_vht_rate(dvobj, rate, bw); -+ if (bw_bmp == 0) -+ bw_bmp = ch_width_to_bw_cap(bw > CHANNEL_WIDTH_160 ? CHANNEL_WIDTH_160 : bw); -+ } -+ } else -+ rtw_warn_on(1); -+ } -+ -+ if (bw_bmp == 0) -+ goto exit; -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ /* loop for each possible tx bandwidth to find final limit */ -+ for (tmp_bw = CHANNEL_WIDTH_20; tmp_bw <= bw; tmp_bw++) { -+ if (!(ch_width_to_bw_cap(tmp_bw) & bw_bmp)) -+ continue; -+ -+ if (no_sc == _FALSE) { -+ /* get center channel for each bandwidth */ -+ if (tmp_bw == CHANNEL_WIDTH_20) -+ tmp_cch = cch_20; -+ else if (tmp_bw == CHANNEL_WIDTH_40) -+ tmp_cch = cch_40; -+ else if (tmp_bw == CHANNEL_WIDTH_80) -+ tmp_cch = cch_80; -+ else { -+ tmp_cch = 0; -+ rtw_warn_on(1); -+ } -+ } -+ -+ lmt = phy_get_txpwr_lmt(adapter, lmt_name, band, tmp_bw, tlrs, ntx_idx, tmp_cch, 0); -+ -+ if (final_lmt > lmt) { -+ if (reg_max) -+ continue; -+ } else if (final_lmt < lmt) { -+ if (!reg_max) -+ continue; -+ } else { /* equal */ -+ if (final_bw == bw) -+ continue; -+ } -+ -+ final_lmt = lmt; -+ final_cch = tmp_cch; -+ final_bw = tmp_bw; -+ } -+ -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+ if (0) { -+ if (final_bw != bw && (IS_HT_RATE(rate) || IS_VHT_RATE(rate))) -+ RTW_INFO("%s final_lmt: %s ch%u -> %s ch%u\n" -+ , MGN_RATE_STR(rate) -+ , ch_width_str(bw), cch -+ , ch_width_str(final_bw), final_cch); -+ } -+ -+exit: -+ return final_lmt; -+} -+ -+static void phy_txpwr_lmt_cck_ofdm_mt_chk(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ struct txpwr_lmt_ent *ent; -+ _list *cur, *head; -+ u8 channel, tlrs, ntx_idx; -+ -+ rfctl->txpwr_lmt_2g_cck_ofdm_state = 0; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ rfctl->txpwr_lmt_5g_cck_ofdm_state = 0; -+#endif -+ -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ -+ /* check 2G CCK, OFDM state*/ -+ for (tlrs = TXPWR_LMT_RS_CCK; tlrs <= TXPWR_LMT_RS_OFDM; tlrs++) { -+ for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { -+ for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) { -+ if (ent->lmt_2g[CHANNEL_WIDTH_20][tlrs][channel][ntx_idx] != hal_spec->txgi_max) { -+ if (tlrs == TXPWR_LMT_RS_CCK) -+ rfctl->txpwr_lmt_2g_cck_ofdm_state |= TXPWR_LMT_HAS_CCK_1T << ntx_idx; -+ else -+ rfctl->txpwr_lmt_2g_cck_ofdm_state |= TXPWR_LMT_HAS_OFDM_1T << ntx_idx; -+ break; -+ } -+ } -+ } -+ } -+ -+ /* if 2G OFDM multi-TX is not defined, reference HT20 */ -+ for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) { -+ for (ntx_idx = RF_2TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { -+ if (rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx)) -+ continue; -+ ent->lmt_2g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM][channel][ntx_idx] = -+ ent->lmt_2g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_HT][channel][ntx_idx]; -+ } -+ } -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+ /* check 5G OFDM state*/ -+ for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { -+ for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { -+ if (ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM - 1][channel][ntx_idx] != hal_spec->txgi_max) { -+ rfctl->txpwr_lmt_5g_cck_ofdm_state |= TXPWR_LMT_HAS_OFDM_1T << ntx_idx; -+ break; -+ } -+ } -+ } -+ -+ for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { -+ for (ntx_idx = RF_2TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { -+ if (rfctl->txpwr_lmt_5g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx)) -+ continue; -+ /* if 5G OFDM multi-TX is not defined, reference HT20 */ -+ ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM - 1][channel][ntx_idx] = -+ ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_HT - 1][channel][ntx_idx]; -+ } -+ } -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ } -+} -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+static void phy_txpwr_lmt_cross_ref_ht_vht(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ struct txpwr_lmt_ent *ent; -+ _list *cur, *head; -+ u8 bw, channel, tlrs, ref_tlrs, ntx_idx; -+ 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; -+ -+ rfctl->txpwr_lmt_5g_20_40_ref = 0; -+ -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ -+ for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) { -+ -+ for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { -+ -+ for (tlrs = TXPWR_LMT_RS_HT; tlrs < TXPWR_LMT_RS_NUM; ++tlrs) { -+ -+ /* 5G 20M 40M VHT and HT can cross reference */ -+ if (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40) { -+ if (tlrs == TXPWR_LMT_RS_HT) -+ ref_tlrs = TXPWR_LMT_RS_VHT; -+ else if (tlrs == TXPWR_LMT_RS_VHT) -+ ref_tlrs = TXPWR_LMT_RS_HT; -+ else -+ continue; -+ -+ for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { -+ -+ if (ent->lmt_5g[bw][ref_tlrs - 1][channel][ntx_idx] == hal_spec->txgi_max) -+ continue; -+ -+ if (tlrs == TXPWR_LMT_RS_HT) -+ ht_has_ref_5g_20_40++; -+ else if (tlrs == TXPWR_LMT_RS_VHT) -+ vht_has_ref_5g_20_40++; -+ else -+ continue; -+ -+ if (ent->lmt_5g[bw][tlrs - 1][channel][ntx_idx] != hal_spec->txgi_max) -+ continue; -+ -+ if (tlrs == TXPWR_LMT_RS_HT && ref_tlrs == TXPWR_LMT_RS_VHT) -+ ht_ref_vht_5g_20_40++; -+ else if (tlrs == TXPWR_LMT_RS_VHT && ref_tlrs == TXPWR_LMT_RS_HT) -+ vht_ref_ht_5g_20_40++; -+ -+ if (0) -+ RTW_INFO("reg:%s, bw:%u, ch:%u, %s-%uT ref %s-%uT\n" -+ , ent->name, bw, channel -+ , txpwr_lmt_rs_str(tlrs), ntx_idx + 1 -+ , txpwr_lmt_rs_str(ref_tlrs), ntx_idx + 1); -+ -+ ent->lmt_5g[bw][tlrs - 1][channel][ntx_idx] = -+ ent->lmt_5g[bw][ref_tlrs - 1][channel][ntx_idx]; -+ } -+ } -+ -+ } -+ } -+ } -+ } -+ -+ 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_ht_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) -+ rfctl->txpwr_lmt_5g_20_40_ref |= TXPWR_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) -+ rfctl->txpwr_lmt_5g_20_40_ref |= TXPWR_LMT_REF_VHT_FROM_HT; -+} -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ -+#ifndef DBG_TXPWR_LMT_BAND_CHK -+#define DBG_TXPWR_LMT_BAND_CHK 0 -+#endif -+ -+#if DBG_TXPWR_LMT_BAND_CHK -+/* check if larger bandwidth limit is less than smaller bandwidth for HT & VHT rate */ -+void phy_txpwr_limit_bandwidth_chk(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 band, bw, path, tlrs, ntx_idx, cch, offset, scch; -+ u8 ch_num, n, i; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ if (!hal_is_band_support(adapter, band)) -+ continue; -+ -+ for (bw = CHANNEL_WIDTH_40; bw <= CHANNEL_WIDTH_80; bw++) { -+ if (bw >= CHANNEL_WIDTH_160) -+ continue; -+ if (band == BAND_ON_2_4G && bw >= CHANNEL_WIDTH_80) -+ continue; -+ -+ if (band == BAND_ON_2_4G) -+ ch_num = center_chs_2g_num(bw); -+ else -+ ch_num = center_chs_5g_num(bw); -+ -+ if (ch_num == 0) { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ for (tlrs = TXPWR_LMT_RS_HT; tlrs < TXPWR_LMT_RS_NUM; tlrs++) { -+ -+ if (band == BAND_ON_2_4G && tlrs == TXPWR_LMT_RS_VHT) -+ continue; -+ if (band == BAND_ON_5G && tlrs == TXPWR_LMT_RS_CCK) -+ continue; -+ if (bw > CHANNEL_WIDTH_20 && (tlrs == TXPWR_LMT_RS_CCK || tlrs == TXPWR_LMT_RS_OFDM)) -+ continue; -+ if (bw > CHANNEL_WIDTH_40 && tlrs == TXPWR_LMT_RS_HT) -+ continue; -+ if (tlrs == TXPWR_LMT_RS_VHT && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ continue; -+ -+ for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { -+ struct txpwr_lmt_ent *ent; -+ _list *cur, *head; -+ -+ if (ntx_idx + 1 > hal_data->max_tx_cnt) -+ continue; -+ -+ /* bypass CCK multi-TX is not defined */ -+ if (tlrs == TXPWR_LMT_RS_CCK && ntx_idx > RF_1TX) { -+ if (band == BAND_ON_2_4G -+ && !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_CCK_1T << ntx_idx))) -+ continue; -+ } -+ -+ /* bypass OFDM multi-TX is not defined */ -+ if (tlrs == TXPWR_LMT_RS_OFDM && ntx_idx > RF_1TX) { -+ if (band == BAND_ON_2_4G -+ && !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))) -+ continue; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ if (band == BAND_ON_5G -+ && !(rfctl->txpwr_lmt_5g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))) -+ continue; -+ #endif -+ } -+ -+ /* bypass 5G 20M, 40M pure reference */ -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ if (band == BAND_ON_5G && (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40)) { -+ if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_HT_FROM_VHT) { -+ if (tlrs == TXPWR_LMT_RS_HT) -+ continue; -+ } else if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_VHT_FROM_HT) { -+ if (tlrs == TXPWR_LMT_RS_VHT && bw <= CHANNEL_WIDTH_40) -+ continue; -+ } -+ } -+ #endif -+ -+ for (n = 0; n < ch_num; n++) { -+ u8 cch_by_bw[3]; -+ u8 offset_by_bw; /* bitmap, 0 for lower, 1 for upper */ -+ u8 bw_pos; -+ s8 lmt[3]; -+ -+ if (band == BAND_ON_2_4G) -+ cch = center_chs_2g(bw, n); -+ else -+ cch = center_chs_5g(bw, n); -+ -+ if (cch == 0) { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ _rtw_memset(cch_by_bw, 0, 3); -+ cch_by_bw[bw] = cch; -+ offset_by_bw = 0x01; -+ -+ do { -+ for (bw_pos = bw; bw_pos >= CHANNEL_WIDTH_40; bw_pos--) -+ cch_by_bw[bw_pos - 1] = rtw_get_scch_by_cch_offset(cch_by_bw[bw_pos], bw_pos, offset_by_bw & BIT(bw_pos) ? HAL_PRIME_CHNL_OFFSET_UPPER : HAL_PRIME_CHNL_OFFSET_LOWER); -+ -+ head = &rfctl->txpwr_lmt_list; -+ cur = get_next(head); -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); -+ cur = get_next(cur); -+ -+ for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) -+ lmt[bw_pos] = phy_get_txpwr_lmt(adapter, ent->name, band, bw_pos, tlrs, ntx_idx, cch_by_bw[bw_pos], 0); -+ -+ for (bw_pos = bw; bw_pos > CHANNEL_WIDTH_20; bw_pos--) -+ if (lmt[bw_pos] > lmt[bw_pos - 1]) -+ break; -+ if (bw_pos == CHANNEL_WIDTH_20) -+ continue; -+ -+ RTW_PRINT_SEL(RTW_DBGDUMP, "[%s][%s][%s][%uT][%-4s] cch:" -+ , band_str(band) -+ , ch_width_str(bw) -+ , txpwr_lmt_rs_str(tlrs) -+ , ntx_idx + 1 -+ , ent->name -+ ); -+ for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "%03u ", cch_by_bw[bw_pos]); -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "limit:"); -+ for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) { -+ if (lmt[bw_pos] == hal_spec->txgi_max) -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "N/A "); -+ else if (lmt[bw_pos] > -hal_spec->txgi_pdbm && lmt[bw_pos] < 0) /* -1 < value < 0 */ -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "-0.%d", (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); -+ else if (lmt[bw_pos] % hal_spec->txgi_pdbm) -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d.%d ", lmt[bw_pos] / hal_spec->txgi_pdbm, (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); -+ else -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d ", lmt[bw_pos] / hal_spec->txgi_pdbm); -+ } -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); -+ } -+ for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) -+ lmt[bw_pos] = phy_get_txpwr_lmt(adapter, txpwr_lmt_str(TXPWR_LMT_WW), band, bw_pos, tlrs, ntx_idx, cch_by_bw[bw_pos], 0); -+ -+ for (bw_pos = bw; bw_pos > CHANNEL_WIDTH_20; bw_pos--) -+ if (lmt[bw_pos] > lmt[bw_pos - 1]) -+ break; -+ if (bw_pos != CHANNEL_WIDTH_20) { -+ RTW_PRINT_SEL(RTW_DBGDUMP, "[%s][%s][%s][%uT][%-4s] cch:" -+ , band_str(band) -+ , ch_width_str(bw) -+ , txpwr_lmt_rs_str(tlrs) -+ , ntx_idx + 1 -+ , txpwr_lmt_str(TXPWR_LMT_WW) -+ ); -+ for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "%03u ", cch_by_bw[bw_pos]); -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "limit:"); -+ for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) { -+ if (lmt[bw_pos] == hal_spec->txgi_max) -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "N/A "); -+ else if (lmt[bw_pos] > -hal_spec->txgi_pdbm && lmt[bw_pos] < 0) /* -1 < value < 0 */ -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "-0.%d", (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); -+ else if (lmt[bw_pos] % hal_spec->txgi_pdbm) -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d.%d ", lmt[bw_pos] / hal_spec->txgi_pdbm, (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); -+ else -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d ", lmt[bw_pos] / hal_spec->txgi_pdbm); -+ } -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); -+ } -+ -+ offset_by_bw += 2; -+ if (offset_by_bw & BIT(bw + 1)) -+ break; -+ } while (1); /* loop for all ch combinations */ -+ } /* loop for center channels */ -+ } /* loop fo each ntx_idx */ -+ } /* loop for tlrs */ -+ } /* loop for bandwidth */ -+ } /* loop for band */ -+} -+#endif /* DBG_TXPWR_LMT_BAND_CHK */ -+ -+static void phy_txpwr_lmt_post_hdl(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ _irqL irqL; -+ -+ _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+ if (IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ phy_txpwr_lmt_cross_ref_ht_vht(adapter); -+#endif -+ phy_txpwr_lmt_cck_ofdm_mt_chk(adapter); -+ -+#if DBG_TXPWR_LMT_BAND_CHK -+ phy_txpwr_limit_bandwidth_chk(adapter); -+#endif -+ -+ _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -+} -+ -+BOOLEAN -+GetS1ByteIntegerFromStringInDecimal( -+ char *str, -+ s8 *val -+) -+{ -+ u8 negative = 0; -+ u16 i = 0; -+ -+ *val = 0; -+ -+ while (str[i] != '\0') { -+ if (i == 0 && (str[i] == '+' || str[i] == '-')) { -+ if (str[i] == '-') -+ negative = 1; -+ } else if (str[i] >= '0' && str[i] <= '9') { -+ *val *= 10; -+ *val += (str[i] - '0'); -+ } else -+ return _FALSE; -+ ++i; -+ } -+ -+ if (negative) -+ *val = -*val; -+ -+ return _TRUE; -+} -+#endif /* CONFIG_TXPWR_LIMIT */ -+ -+/* -+* phy_set_tx_power_limit - Parsing TX power limit from phydm array, called by odm_ConfigBB_TXPWR_LMT_XXX in phydm -+*/ -+void -+phy_set_tx_power_limit( -+ struct dm_struct *pDM_Odm, -+ u8 *lmt_name, -+ u8 *Band, -+ u8 *Bandwidth, -+ u8 *RateSection, -+ u8 *ntx, -+ u8 *Channel, -+ u8 *PowerLimit -+) -+{ -+#if CONFIG_TXPWR_LIMIT -+ PADAPTER Adapter = pDM_Odm->adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); -+ u8 band = 0, bandwidth = 0, tlrs = 0, channel; -+ u8 ntx_idx; -+ s8 powerLimit = 0, prevPowerLimit, channelIndex; -+ s8 ww_lmt_val = phy_txpwr_ww_lmt_value(Adapter); -+ -+ if (0) -+ RTW_INFO("Index of power limit table [lmt_name %s][band %s][bw %s][rate section %s][ntx %s][chnl %s][val %s]\n" -+ , lmt_name, Band, Bandwidth, RateSection, ntx, Channel, PowerLimit); -+ -+ if (GetU1ByteIntegerFromStringInDecimal((char *)Channel, &channel) == _FALSE -+ || GetS1ByteIntegerFromStringInDecimal((char *)PowerLimit, &powerLimit) == _FALSE -+ ) { -+ RTW_PRINT("Illegal index of power limit table [ch %s][val %s]\n", Channel, PowerLimit); -+ return; -+ } -+ -+ if (powerLimit != ww_lmt_val) { -+ if (powerLimit < -hal_spec->txgi_max || powerLimit > hal_spec->txgi_max) -+ RTW_PRINT("Illegal power limit value [ch %s][val %s]\n", Channel, PowerLimit); -+ -+ if (powerLimit > hal_spec->txgi_max) -+ powerLimit = hal_spec->txgi_max; -+ else if (powerLimit < -hal_spec->txgi_max) -+ powerLimit = ww_lmt_val + 1; -+ } -+ -+ if (strncmp(RateSection, "CCK", 3) == 0) -+ tlrs = TXPWR_LMT_RS_CCK; -+ else if (strncmp(RateSection, "OFDM", 4) == 0) -+ tlrs = TXPWR_LMT_RS_OFDM; -+ else if (strncmp(RateSection, "HT", 2) == 0) -+ tlrs = TXPWR_LMT_RS_HT; -+ else if (strncmp(RateSection, "VHT", 3) == 0) -+ tlrs = TXPWR_LMT_RS_VHT; -+ else { -+ RTW_PRINT("Wrong rate section:%s\n", RateSection); -+ return; -+ } -+ -+ if (strncmp(ntx, "1T", 2) == 0) -+ ntx_idx = RF_1TX; -+ else if (strncmp(ntx, "2T", 2) == 0) -+ ntx_idx = RF_2TX; -+ else if (strncmp(ntx, "3T", 2) == 0) -+ ntx_idx = RF_3TX; -+ else if (strncmp(ntx, "4T", 2) == 0) -+ ntx_idx = RF_4TX; -+ else { -+ RTW_PRINT("Wrong tx num:%s\n", ntx); -+ return; -+ } -+ -+ if (strncmp(Bandwidth, "20M", 3) == 0) -+ bandwidth = CHANNEL_WIDTH_20; -+ else if (strncmp(Bandwidth, "40M", 3) == 0) -+ bandwidth = CHANNEL_WIDTH_40; -+ else if (strncmp(Bandwidth, "80M", 3) == 0) -+ bandwidth = CHANNEL_WIDTH_80; -+ else if (strncmp(Bandwidth, "160M", 4) == 0) -+ bandwidth = CHANNEL_WIDTH_160; -+ else { -+ RTW_PRINT("unknown bandwidth: %s\n", Bandwidth); -+ return; -+ } -+ -+ if (strncmp(Band, "2.4G", 4) == 0) { -+ band = BAND_ON_2_4G; -+ 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; -+ } -+ -+ rtw_txpwr_lmt_add(adapter_to_rfctl(Adapter), lmt_name, band, bandwidth, tlrs, ntx_idx, channelIndex, powerLimit); -+ } -+#if CONFIG_IEEE80211_BAND_5GHZ -+ else if (strncmp(Band, "5G", 2) == 0) { -+ band = BAND_ON_5G; -+ channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, channel); -+ -+ if (channelIndex == -1) { -+ RTW_PRINT("unsupported channel: %d at 5G\n", channel); -+ return; -+ } -+ -+ rtw_txpwr_lmt_add(adapter_to_rfctl(Adapter), lmt_name, band, bandwidth, tlrs, ntx_idx, channelIndex, powerLimit); -+ } -+#endif -+ else { -+ RTW_PRINT("unknown/unsupported band:%s\n", Band); -+ return; -+ } -+#endif -+} -+ -+void -+phy_set_tx_power_limit_ex( -+ struct dm_struct *pDM_Odm, -+ u8 phydm_id, -+ u8 Band, -+ u8 Bandwidth, -+ u8 RateSection, -+ u8 ntx, -+ u8 channel, -+ s8 powerLimit -+) -+{ -+#if CONFIG_TXPWR_LIMIT -+ PADAPTER Adapter = pDM_Odm->adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); -+ u8 lmt_id; -+ u8 band = 0, bandwidth = 0, tlrs = 0; -+ u8 ntx_idx; -+ s8 prevPowerLimit, channelIndex; -+ s8 ww_lmt_val = phy_txpwr_ww_lmt_value(Adapter); -+ -+ if (0) -+ RTW_INFO("Index of power limit table [phydm_id %d][band %d][bw %d][rate section %d][ntx %d][chnl %d][val %d]\n" -+ , phydm_id, Band, Bandwidth, RateSection, ntx, channel, powerLimit); -+ -+ if (powerLimit != ww_lmt_val) { -+ if (powerLimit < -hal_spec->txgi_max || powerLimit > hal_spec->txgi_max) -+ RTW_PRINT("Illegal power limit value [ch %d][val %d]\n", channel, powerLimit); -+ -+ if (powerLimit > hal_spec->txgi_max) -+ powerLimit = hal_spec->txgi_max; -+ else if (powerLimit < -hal_spec->txgi_max) -+ powerLimit = ww_lmt_val + 1; -+ } -+ -+ switch (phydm_id) { -+ case PW_LMT_REGU_FCC: -+ lmt_id = TXPWR_LMT_FCC; -+ break; -+ case PW_LMT_REGU_ETSI: -+ lmt_id = TXPWR_LMT_ETSI; -+ break; -+ case PW_LMT_REGU_MKK: -+ lmt_id = TXPWR_LMT_MKK; -+ break; -+ case PW_LMT_REGU_IC: -+ lmt_id = TXPWR_LMT_IC; -+ break; -+ case PW_LMT_REGU_KCC: -+ lmt_id = TXPWR_LMT_KCC; -+ break; -+ case PW_LMT_REGU_ACMA: -+ lmt_id = TXPWR_LMT_ACMA; -+ break; -+ case PW_LMT_REGU_CHILE: -+ lmt_id = TXPWR_LMT_CHILE; -+ break; -+ case PW_LMT_REGU_UKRAINE: -+ lmt_id = TXPWR_LMT_UKRAINE; -+ break; -+ case PW_LMT_REGU_MEXICO: -+ lmt_id = TXPWR_LMT_MEXICO; -+ break; -+ case PW_LMT_REGU_CN: -+ lmt_id = TXPWR_LMT_CN; -+ break; -+ case PW_LMT_REGU_WW13: -+ default: -+ RTW_PRINT("Wrong phydm_id:%d\n", phydm_id); -+ return; -+ } -+ -+ switch (RateSection) { -+ case PW_LMT_RS_CCK: -+ tlrs = TXPWR_LMT_RS_CCK; -+ break; -+ case PW_LMT_RS_OFDM: -+ tlrs = TXPWR_LMT_RS_OFDM; -+ break; -+ case PW_LMT_RS_HT: -+ tlrs = TXPWR_LMT_RS_HT; -+ break; -+ case PW_LMT_RS_VHT: -+ tlrs = TXPWR_LMT_RS_VHT; -+ break; -+ default: -+ RTW_PRINT("Wrong rate section:%d\n", RateSection); -+ return; -+ } -+ -+ switch (ntx) { -+ case PW_LMT_PH_1T: -+ ntx_idx = RF_1TX; -+ break; -+ case PW_LMT_PH_2T: -+ ntx_idx = RF_2TX; -+ break; -+ case PW_LMT_PH_3T: -+ ntx_idx = RF_3TX; -+ break; -+ case PW_LMT_PH_4T: -+ ntx_idx = RF_4TX; -+ break; -+ default: -+ RTW_PRINT("Wrong tx num:%d\n", ntx); -+ return; -+ } -+ -+ switch (Bandwidth) { -+ case PW_LMT_BW_20M: -+ bandwidth = CHANNEL_WIDTH_20; -+ break; -+ case PW_LMT_BW_40M: -+ bandwidth = CHANNEL_WIDTH_40; -+ break; -+ case PW_LMT_BW_80M: -+ bandwidth = CHANNEL_WIDTH_80; -+ break; -+ case PW_LMT_BW_160M: -+ bandwidth = CHANNEL_WIDTH_160; -+ break; -+ default: -+ RTW_PRINT("unknown bandwidth: %d\n", Bandwidth); -+ return; -+ } -+ -+ if (Band == PW_LMT_BAND_2_4G) { -+ band = BAND_ON_2_4G; -+ 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", ch_width_str(bandwidth)); -+ return; -+ } -+ -+ rtw_txpwr_lmt_add(adapter_to_rfctl(Adapter), txpwr_lmt_str(lmt_id), band, bandwidth, tlrs, ntx_idx, channelIndex, powerLimit); -+ } -+#if CONFIG_IEEE80211_BAND_5GHZ -+ else if (Band == PW_LMT_BAND_5G) { -+ band = BAND_ON_5G; -+ channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, channel); -+ -+ if (channelIndex == -1) { -+ RTW_PRINT("unsupported channel: %d at 5G\n", channel); -+ return; -+ } -+ -+ rtw_txpwr_lmt_add(adapter_to_rfctl(Adapter), txpwr_lmt_str(lmt_id), band, bandwidth, tlrs, ntx_idx, channelIndex, powerLimit); -+ } -+#endif -+ else { -+ RTW_PRINT("unknown/unsupported band:%d\n", Band); -+ return; -+ } -+#endif -+} -+ -+u8 phy_get_tx_power_index_ex(_adapter *adapter -+ , enum rf_path rfpath, RATE_SECTION rs, enum MGN_RATE rate -+ , enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch) -+{ -+ return rtw_hal_get_tx_power_index(adapter, rfpath, rs, rate, bw, band, cch, opch, NULL); -+} -+ -+u8 phy_get_tx_power_index( -+ PADAPTER pAdapter, -+ enum rf_path RFPath, -+ u8 Rate, -+ enum channel_width BandWidth, -+ u8 Channel -+) -+{ -+ RATE_SECTION rs = mgn_rate_to_rs(Rate); -+ BAND_TYPE band = Channel <= 14 ? BAND_ON_2_4G : BAND_ON_5G; -+ -+ return rtw_hal_get_tx_power_index(pAdapter, RFPath, rs, Rate, BandWidth, band, Channel, 0, NULL); -+} -+ -+void -+PHY_SetTxPowerIndex( -+ PADAPTER pAdapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+) -+{ -+ rtw_hal_set_tx_power_index(pAdapter, PowerIndex, RFPath, Rate); -+} -+ -+void dump_tx_power_index_inline(void *sel, _adapter *adapter, u8 rfpath, enum channel_width bw, u8 cch, enum MGN_RATE rate, u8 pwr_idx, struct txpwr_idx_comp *tic) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ if (tic->utarget == hal_spec->txgi_max) { -+ RTW_PRINT_SEL(sel, "TXPWR: [%c][%s]cch:%u, %s %uT, idx:%u(0x%02x) = base(%d) + min((byr(%d) + btc(%d) + extra(%d)), rlmt(%d), lmt(%d), ulmt(%d)) + tpc(%d) + tpt(%d) + dpd(%d)\n" -+ , rf_path_char(rfpath), ch_width_str(bw), cch -+ , MGN_RATE_STR(rate), tic->ntx_idx + 1 -+ , pwr_idx, pwr_idx, tic->base -+ , tic->by_rate, tic->btc, tic->extra, tic->rlimit, tic->limit, tic->ulimit -+ , tic->tpc -+ , tic->tpt, tic->dpd); -+ } else { -+ RTW_PRINT_SEL(sel, "TXPWR: [%c][%s]cch:%u, %s %uT, idx:%u(0x%02x) = base(%d) + min(utgt(%d), rlmt(%d), lmt(%d), ulmt(%d)) + tpc(%d) + tpt(%d) + dpd(%d)\n" -+ , rf_path_char(rfpath), ch_width_str(bw), cch -+ , MGN_RATE_STR(rate), tic->ntx_idx + 1 -+ , pwr_idx, pwr_idx, tic->base -+ , tic->utarget, tic->rlimit, tic->limit, tic->ulimit -+ , tic->tpc -+ , tic->tpt, tic->dpd); -+ } -+} -+ -+#ifdef CONFIG_PROC_DEBUG -+void dump_tx_power_idx_value(void *sel, _adapter *adapter, u8 rfpath, enum MGN_RATE rate, u8 pwr_idx, struct txpwr_idx_comp *tic) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ char tmp_str[8]; -+ -+ txpwr_idx_get_dbm_str(tic->target, hal_spec->txgi_max, hal_spec->txgi_pdbm, 0, tmp_str, 8); -+ -+ if (tic->utarget == hal_spec->txgi_max) { -+ RTW_PRINT_SEL(sel, "%4c %9s %uT %s %3u(0x%02x)" -+ " %4d ((%4d %3d %5d) %4d %4d %4d) %3d %3d %3d\n" -+ , rf_path_char(rfpath), MGN_RATE_STR(rate), tic->ntx_idx + 1 -+ , tmp_str, pwr_idx, pwr_idx -+ , tic->base, tic->by_rate, tic->btc, tic->extra, tic->rlimit, tic->limit, tic->ulimit -+ , tic->tpc -+ , tic->tpt, tic->dpd); -+ } else { -+ RTW_PRINT_SEL(sel, "%4c %9s %uT %s %3u(0x%02x)" -+ " %4d (%4d %4d %4d %4d) %3d %3d %3d\n" -+ , rf_path_char(rfpath), MGN_RATE_STR(rate), tic->ntx_idx + 1 -+ , tmp_str, pwr_idx, pwr_idx -+ , tic->base, tic->utarget, tic->rlimit, tic->limit, tic->ulimit -+ , tic->tpc -+ , tic->tpt, tic->dpd); -+ } -+} -+ -+void dump_tx_power_idx_title(void *sel, _adapter *adapter, enum channel_width bw, u8 cch, u8 opch) -+{ -+ u8 cch_20, cch_40, cch_80; -+ -+ cch_80 = bw == CHANNEL_WIDTH_80 ? cch : 0; -+ cch_40 = bw == CHANNEL_WIDTH_40 ? cch : 0; -+ cch_20 = bw == CHANNEL_WIDTH_20 ? cch : 0; -+ if (cch_80 != 0) -+ cch_40 = rtw_get_scch_by_cch_opch(cch_80, CHANNEL_WIDTH_80, opch); -+ if (cch_40 != 0) -+ cch_20 = rtw_get_scch_by_cch_opch(cch_40, CHANNEL_WIDTH_40, opch); -+ -+ RTW_PRINT_SEL(sel, "%s", ch_width_str(bw)); -+ if (bw >= CHANNEL_WIDTH_80) -+ _RTW_PRINT_SEL(sel, ", cch80:%u", cch_80); -+ if (bw >= CHANNEL_WIDTH_40) -+ _RTW_PRINT_SEL(sel, ", cch40:%u", cch_40); -+ _RTW_PRINT_SEL(sel, ", cch20:%u\n", cch_20); -+ -+ if (!phy_is_txpwr_user_target_specified(adapter)) { -+ RTW_PRINT_SEL(sel, "%-4s %-9s %2s %-6s %-3s%6s" -+ " = %-4s + min((%-4s + %-3s + %-5s), %-4s, %-4s, %-4s) + %-3s + %-3s + %-3s\n" -+ , "path", "rate", "", "dBm", "idx", "" -+ , "base", "byr", "btc", "extra", "rlmt", "lmt", "ulmt" -+ , "tpc" -+ , "tpt", "dpd"); -+ } else { -+ RTW_PRINT_SEL(sel, "%-4s %-9s %2s %-6s %-3s%6s" -+ " = %-4s + min(%-4s, %-4s, %-4s, %-4s) + %-3s + %-3s + %-3s\n" -+ , "path", "rate", "", "dBm", "idx", "" -+ , "base", "utgt", "rlmt", "lmt", "ulmt" -+ , "tpc" -+ , "tpt", "dpd"); -+ } -+} -+ -+void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath -+ , RATE_SECTION rs, enum channel_width bw, u8 cch, u8 opch) -+{ -+ 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 = cch > 14 ? BAND_ON_5G : BAND_ON_2_4G; -+ -+ 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 + 1 > hal_data->tx_nss) -+ return; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ return; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ return; -+ -+ for (i = 0; i < rates_by_sections[rs].rate_num; i++) { -+ power_idx = rtw_hal_get_tx_power_index(adapter, rfpath, rs, rates_by_sections[rs].rates[i], bw, band, cch, opch, &tic); -+ dump_tx_power_idx_value(sel, adapter, rfpath, rates_by_sections[rs].rates[i], power_idx, &tic); -+ } -+} -+ -+void dump_tx_power_idx(void *sel, _adapter *adapter, enum channel_width bw, u8 cch, u8 opch) -+{ -+ u8 rfpath, rs; -+ -+ dump_tx_power_idx_title(sel, adapter, bw, cch, opch); -+ 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, bw, cch, opch); -+} -+ -+void dump_txpwr_total_dbm_value(void *sel, _adapter *adapter, enum MGN_RATE rate, u8 ntx_idx -+ , s16 target, s16 byr, s16 btc, s16 extra, s16 rlmt, s16 lmt, s16 ulmt, s16 tpc) -+{ -+ char target_str[8]; -+ char byr_str[8]; -+ char btc_str[8]; -+ char extra_str[8]; -+ char rlmt_str[8]; -+ char lmt_str[8]; -+ char ulmt_str[8]; -+ char tpc_str[8]; -+ -+ txpwr_mbm_get_dbm_str(target, 0, target_str, 8); -+ txpwr_mbm_get_dbm_str(byr, 0, byr_str, 8); -+ txpwr_mbm_get_dbm_str(btc, 0, btc_str, 8); -+ txpwr_mbm_get_dbm_str(extra, 0, extra_str, 8); -+ txpwr_mbm_get_dbm_str(rlmt, 0, rlmt_str, 8); -+ txpwr_mbm_get_dbm_str(lmt, 0, lmt_str, 8); -+ txpwr_mbm_get_dbm_str(ulmt, 0, ulmt_str, 8); -+ txpwr_mbm_get_dbm_str(tpc, 0, tpc_str, 8); -+ -+ RTW_PRINT_SEL(sel, "%9s %uT %s = ((%s %s %s), %s, %s, %s) %s\n" -+ , MGN_RATE_STR(rate), ntx_idx + 1 -+ , target_str, byr_str, btc_str, extra_str, rlmt_str, lmt_str, ulmt_str, tpc_str); -+} -+ -+void dump_txpwr_total_dbm_value_utgt(void *sel, _adapter *adapter, enum MGN_RATE rate, u8 ntx_idx -+ , s16 target, s16 utgt, s16 rlmt, s16 lmt, s16 ulmt, s16 tpc) -+{ -+ char target_str[8]; -+ char utgt_str[8]; -+ char rlmt_str[8]; -+ char lmt_str[8]; -+ char ulmt_str[8]; -+ char tpc_str[8]; -+ -+ txpwr_mbm_get_dbm_str(target, 0, target_str, 8); -+ txpwr_mbm_get_dbm_str(utgt, 0, utgt_str, 8); -+ txpwr_mbm_get_dbm_str(rlmt, 0, rlmt_str, 8); -+ txpwr_mbm_get_dbm_str(lmt, 0, lmt_str, 8); -+ txpwr_mbm_get_dbm_str(ulmt, 0, ulmt_str, 8); -+ txpwr_mbm_get_dbm_str(tpc, 0, tpc_str, 8); -+ -+ RTW_PRINT_SEL(sel, "%9s %uT %s = (%s, %s, %s, %s) %s\n" -+ , MGN_RATE_STR(rate), ntx_idx + 1 -+ , target_str, utgt_str, rlmt_str, lmt_str, ulmt_str, tpc_str); -+} -+ -+void dump_txpwr_total_dbm_title(void *sel, _adapter *adapter, enum channel_width bw, u8 cch, u8 opch) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ char antenna_gain_str[8]; -+ u8 cch_20, cch_40, cch_80; -+ -+ txpwr_mbm_get_dbm_str(rfctl->antenna_gain, 0, antenna_gain_str, 8); -+ RTW_PRINT_SEL(sel, "antenna_gain:%s\n", antenna_gain_str); -+ -+ cch_80 = bw == CHANNEL_WIDTH_80 ? cch : 0; -+ cch_40 = bw == CHANNEL_WIDTH_40 ? cch : 0; -+ cch_20 = bw == CHANNEL_WIDTH_20 ? cch : 0; -+ if (cch_80 != 0) -+ cch_40 = rtw_get_scch_by_cch_opch(cch_80, CHANNEL_WIDTH_80, opch); -+ if (cch_40 != 0) -+ cch_20 = rtw_get_scch_by_cch_opch(cch_40, CHANNEL_WIDTH_40, opch); -+ -+ RTW_PRINT_SEL(sel, "%s", ch_width_str(bw)); -+ if (bw >= CHANNEL_WIDTH_80) -+ _RTW_PRINT_SEL(sel, ", cch80:%u", cch_80); -+ if (bw >= CHANNEL_WIDTH_40) -+ _RTW_PRINT_SEL(sel, ", cch40:%u", cch_40); -+ _RTW_PRINT_SEL(sel, ", cch20:%u\n", cch_20); -+ -+ if (!phy_is_txpwr_user_target_specified(adapter)) { -+ RTW_PRINT_SEL(sel, "%-9s %2s %-6s = min((%-6s + %-6s + %-6s), %-6s, %-6s, %-6s) + %-6s\n" -+ , "rate", "", "target", "byr", "btc", "extra", "rlmt", "lmt", "ulmt", "tpc"); -+ } else { -+ RTW_PRINT_SEL(sel, "%-9s %2s %-6s = min(%-6s, %-6s, %-6s, %-6s) + %-6s\n" -+ , "rate", "", "target", "utgt", "rlmt", "lmt", "ulmt", "tpc"); -+ } -+} -+ -+void dump_txpwr_total_dbm_by_rs(void *sel, _adapter *adapter, u8 rs, enum channel_width bw, u8 cch, u8 opch) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 i; -+ u8 band = cch > 14 ? BAND_ON_5G : BAND_ON_2_4G; -+ -+ if (rs >= RATE_SECTION_NUM) -+ return; -+ -+ if (rate_section_to_tx_num(rs) + 1 > hal_data->tx_nss) -+ return; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ return; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ return; -+ -+ for (i = 0; i < rates_by_sections[rs].rate_num; i++) { -+ struct txpwr_idx_comp tic; -+ s16 target, byr, tpc, btc, extra, utgt, rlmt, lmt, ulmt; -+ u8 tx_num; -+ -+ target = phy_get_txpwr_total_mbm(adapter, rs, rates_by_sections[rs].rates[i], bw, cch, opch, 0, 0, &tic); -+ tx_num = tic.ntx_idx + 1; -+ if (tic.rlimit == hal_spec->txgi_max) -+ rlmt = UNSPECIFIED_MBM; -+ else -+ rlmt = ((tic.rlimit * MBM_PDBM) / hal_spec->txgi_pdbm) + mb_of_ntx(tx_num); -+ if (tic.limit == hal_spec->txgi_max) -+ lmt = UNSPECIFIED_MBM; -+ else -+ lmt = ((tic.limit * MBM_PDBM) / hal_spec->txgi_pdbm) + mb_of_ntx(tx_num); -+ if (tic.ulimit == hal_spec->txgi_max) -+ ulmt = UNSPECIFIED_MBM; -+ else -+ ulmt = ((tic.ulimit * MBM_PDBM) / hal_spec->txgi_pdbm) + mb_of_ntx(tx_num); -+ tpc = (tic.tpc * MBM_PDBM) / hal_spec->txgi_pdbm; -+ -+ if (tic.utarget == hal_spec->txgi_max) { -+ byr = ((tic.by_rate * MBM_PDBM) / hal_spec->txgi_pdbm) + mb_of_ntx(tx_num); -+ btc = (tic.btc * MBM_PDBM) / hal_spec->txgi_pdbm; -+ extra = (tic.extra * MBM_PDBM) / hal_spec->txgi_pdbm; -+ dump_txpwr_total_dbm_value(sel, adapter, rates_by_sections[rs].rates[i], tic.ntx_idx -+ , target, byr, btc, extra, rlmt, lmt, ulmt, tpc); -+ } else { -+ utgt = ((tic.utarget * MBM_PDBM) / hal_spec->txgi_pdbm) + mb_of_ntx(tx_num); -+ dump_txpwr_total_dbm_value_utgt(sel, adapter, rates_by_sections[rs].rates[i], tic.ntx_idx -+ , target, utgt, rlmt, lmt, ulmt, tpc); -+ } -+ } -+} -+ -+/* dump txpowr in dBm with effect of N-TX */ -+void dump_txpwr_total_dbm(void *sel, _adapter *adapter, enum channel_width bw, u8 cch, u8 opch) -+{ -+ u8 rs; -+ -+ dump_txpwr_total_dbm_title(sel, adapter, bw, cch, opch); -+ for (rs = CCK; rs < RATE_SECTION_NUM; rs++) -+ dump_txpwr_total_dbm_by_rs(sel, adapter, rs, bw, cch, opch); -+} -+#endif -+ -+bool phy_is_tx_power_limit_needed(_adapter *adapter) -+{ -+#if CONFIG_TXPWR_LIMIT -+ 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; -+#endif -+ -+ 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); -+ 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_config_bb_with_header_file(&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.phy_reg_pg_value_type != 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; -+} -+ -+#if CONFIG_TXPWR_LIMIT -+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)); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ int ret = _FAIL; -+ -+ hal_data->txpwr_limit_loaded = 0; -+ rtw_regd_exc_list_free(rfctl); -+ rtw_txpwr_lmt_list_free(rfctl); -+ -+ 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 (odm_config_rf_with_header_file(&hal_data->odmpriv, CONFIG_RF_TXPWR_LMT, RF_PATH_A) == HAL_STATUS_SUCCESS) { -+ 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_txpwr_lmt_post_hdl(adapter); -+ rtw_txpwr_init_regd(rfctl); -+ hal_data->txpwr_limit_loaded = 1; -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_TXPWR_LIMIT */ -+ -+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 */ -+ if (phy_is_tx_power_by_rate_needed(adapter) -+ || regsty->target_tx_pwr_valid != _TRUE /* need target tx power from by rate table */ -+ ) -+ phy_load_tx_power_by_rate(adapter, chk_file); -+ -+ /* power limit */ -+#if CONFIG_TXPWR_LIMIT -+ if (phy_is_tx_power_limit_needed(adapter)) -+ phy_load_tx_power_limit(adapter, chk_file); -+#endif -+} -+ -+inline void phy_reload_tx_power_ext_info(_adapter *adapter) -+{ -+ phy_load_tx_power_ext_info(adapter, 1); -+ op_class_pref_apply_regulatory(adapter, REG_TXPWR_CHANGE); -+} -+ -+inline void phy_reload_default_tx_power_ext_info(_adapter *adapter) -+{ -+ phy_load_tx_power_ext_info(adapter, 0); -+ op_class_pref_apply_regulatory(adapter, REG_TXPWR_CHANGE); -+} -+ -+#ifdef CONFIG_PROC_DEBUG -+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); -+ -+ RTW_PRINT_SEL(sel, "txpwr_pg_mode: %s\n", txpwr_pg_mode_str(hal_data->txpwr_pg_mode)); -+ -+ if (regsty->target_tx_pwr_valid == _TRUE) -+ RTW_PRINT_SEL(sel, "target_tx_power: from registry\n"); -+ else if (hal_data->txpwr_by_rate_loaded) -+ 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 + 1 > hal_data->tx_nss) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ continue; -+ -+ target = phy_get_target_txpwr(adapter, band, path, rs); -+ -+ if (target % hal_spec->txgi_pdbm) { -+ _RTW_PRINT_SEL(sel, "%7s: %2d.%d\n", rate_section_str(rs) -+ , target / hal_spec->txgi_pdbm, (target % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); -+ } else { -+ _RTW_PRINT_SEL(sel, "%7s: %5d\n", rate_section_str(rs) -+ , target / hal_spec->txgi_pdbm); -+ } -+ } -+ } -+ } -+ -+ 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; -+ -+ 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 + 1 > hal_data->tx_nss) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ continue; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ max_rate_num = 10; -+ else -+ max_rate_num = 8; -+ rate_num = rate_section_rate_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 = phy_get_txpwr_by_rate(adapter, band, path, rs, rates_by_sections[rs].rates[n]); -+ if (by_rate % hal_spec->txgi_pdbm) { -+ _RTW_PRINT_SEL(sel, "%2d.%d ", by_rate / hal_spec->txgi_pdbm -+ , (by_rate % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); -+ } else -+ _RTW_PRINT_SEL(sel, "%5d ", by_rate / hal_spec->txgi_pdbm); -+ } -+ for (n = 0; n < max_rate_num - rate_num; n++) -+ _RTW_PRINT_SEL(sel, "%5s ", ""); -+ -+ _RTW_PRINT_SEL(sel, "|"); -+ -+ /* dump power by rate in offset */ -+ for (n = rate_num - 1; n >= 0; n--) { -+ by_rate = phy_get_txpwr_by_rate(adapter, band, path, rs, rates_by_sections[rs].rates[n]); -+ base = phy_get_target_txpwr(adapter, band, path, rs); -+ _RTW_PRINT_SEL(sel, "%3d ", by_rate - base); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ } -+ } -+ } -+} -+#endif -+/* -+ * 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( -+ PADAPTER Adapter, -+ 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_readable_file_sz_chk(rtw_phy_para_file_path, -+ MAX_PARA_FILE_BUF_LEN) == _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( -+ PADAPTER Adapter, -+ char *pFileName, -+ 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_readable_file_sz_chk(rtw_phy_para_file_path, -+ MAX_PARA_FILE_BUF_LEN) == _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_set_bb_reg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); -+ -+ if (u4bRegOffset == 0xa24) -+ pHalData->odmpriv.rf_calibrate_info.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'; -+ } -+} -+ -+#ifndef DBG_TXPWR_BY_RATE_FILE_PARSE -+#define DBG_TXPWR_BY_RATE_FILE_PARSE 0 -+#endif -+ -+int -+phy_ParseBBPgParaFile( -+ PADAPTER Adapter, -+ char *buffer -+) -+{ -+ int rtStatus = _FAIL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegMask; -+ u32 u4bMove; -+ BOOLEAN firstLine = _TRUE; -+ u8 tx_num = 0; -+ u8 band = 0, rf_path = 0; -+ -+ 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 (strncmp(szLine, "#[v1]", 5) == 0 -+ || strncmp(szLine, "#[v2]", 5) == 0) -+ pHalData->odmpriv.phy_reg_pg_version = szLine[3] - '0'; -+ else { -+ RTW_ERR("The format in PHY_REG_PG are invalid %s\n", szLine); -+ goto exit; -+ } -+ -+ if (strncmp(szLine + 5, "[Exact]#", 8) == 0) { -+ pHalData->odmpriv.phy_reg_pg_value_type = PHY_REG_PG_EXACT_VALUE; -+ firstLine = _FALSE; -+ continue; -+ } else { -+ RTW_ERR("The values in PHY_REG_PG are invalid %s\n", szLine); -+ goto exit; -+ } -+ } -+ -+ if (pHalData->odmpriv.phy_reg_pg_version > 0) { -+ u32 index = 0; -+ -+ if (strncmp(szLine, "0xffff", 6) == 0) -+ break; -+ -+ if (strncmp(szLine, "#[END]#", 7)) { -+ /* load the table label info */ -+ if (szLine[0] == '#') { -+ index = 0; -+ if (strncmp(szLine, "#[2.4G]", 7) == 0) { -+ band = BAND_ON_2_4G; -+ index += 8; -+ } else if (strncmp(szLine, "#[5G]", 5) == 0) { -+ band = BAND_ON_5G; -+ index += 6; -+ } else { -+ RTW_ERR("Invalid band %s in PHY_REG_PG.txt\n", szLine); -+ goto exit; -+ } -+ -+ rf_path = szLine[index] - 'A'; -+ if (DBG_TXPWR_BY_RATE_FILE_PARSE) -+ 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_ERR("Invalid row in PHY_REG_PG.txt '%c'(%d)\n", szLine[1], szLine[1]); -+ goto exit; -+ } -+ -+ while (szLine[index] != ']') -+ ++index; -+ ++index;/* skip ] */ -+ -+ /* Get 2nd hex value as register offset. */ -+ szLine += index; -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) -+ szLine += u4bMove; -+ else -+ goto exit; -+ -+ /* Get 2nd hex value as register mask. */ -+ if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove)) -+ szLine += u4bMove; -+ else -+ goto exit; -+ -+ if (pHalData->odmpriv.phy_reg_pg_value_type == PHY_REG_PG_EXACT_VALUE) { -+ u32 combineValue = 0; -+ u8 integer = 0, fraction = 0; -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ goto exit; -+ -+ integer *= hal_spec->txgi_pdbm; -+ integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; -+ if (pHalData->odmpriv.phy_reg_pg_version == 1) -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ else -+ combineValue |= integer; -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ goto exit; -+ -+ integer *= hal_spec->txgi_pdbm; -+ integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; -+ combineValue <<= 8; -+ if (pHalData->odmpriv.phy_reg_pg_version == 1) -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ else -+ combineValue |= integer; -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ goto exit; -+ -+ integer *= hal_spec->txgi_pdbm; -+ integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; -+ combineValue <<= 8; -+ if (pHalData->odmpriv.phy_reg_pg_version == 1) -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ else -+ combineValue |= integer; -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ goto exit; -+ -+ integer *= hal_spec->txgi_pdbm; -+ integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; -+ combineValue <<= 8; -+ if (pHalData->odmpriv.phy_reg_pg_version == 1) -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ else -+ combineValue |= integer; -+ -+ phy_store_tx_power_by_rate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, combineValue); -+ -+ if (DBG_TXPWR_BY_RATE_FILE_PARSE) -+ RTW_INFO("addr:0x%3x mask:0x%08x %dTx = 0x%08x\n", u4bRegOffset, u4bRegMask, tx_num + 1, combineValue); -+ } -+ } -+ } -+ } -+ } -+ } -+ -+ rtStatus = _SUCCESS; -+ -+exit: -+ RTW_INFO("%s return %d\n", __func__, rtStatus); -+ return rtStatus; -+} -+ -+int -+phy_ConfigBBWithPgParaFile( -+ PADAPTER Adapter, -+ 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_readable_file_sz_chk(rtw_phy_para_file_path, -+ MAX_PARA_FILE_BUF_LEN) == _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); */ -+ rtStatus = 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( -+ PADAPTER Adapter, -+ 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_readable_file_sz_chk(rtw_phy_para_file_path, -+ MAX_PARA_FILE_BUF_LEN) == _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_set_bb_reg(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( -+ PADAPTER Adapter, -+ char *pFileName, -+ enum rf_path 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 RF_PATH_A: -+ pBuf = pHalData->rf_radio_a; -+ pBufLen = &pHalData->rf_radio_a_len; -+ break; -+ case 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_readable_file_sz_chk(rtw_phy_para_file_path, -+ MAX_PARA_FILE_BUF_LEN) == _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 RF_PATH_A: -+ pHalData->rf_radio_a = pBuf; -+ break; -+ case RF_PATH_B: -+ pHalData->rf_radio_b = pBuf; -+ break; -+ default: -+ RTW_INFO("Unknown RF path!! %d\r\n", eRFPath); -+ 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_set_rf_reg(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); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); -+ 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->delta_swing_table_idx_2g_cck_a_p, j); -+ else if (STR_EQUAL_2G("2G", "A", "-", "CCK")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n, j); -+ else if (STR_EQUAL_2G("2G", "B", "+", "CCK")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p, j); -+ else if (STR_EQUAL_2G("2G", "B", "-", "CCK")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n, j); -+ else if (STR_EQUAL_2G("2G", "A", "+", "ALL")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2ga_p, j); -+ else if (STR_EQUAL_2G("2G", "A", "-", "ALL")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2ga_n, j); -+ else if (STR_EQUAL_2G("2G", "B", "+", "ALL")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2gb_p, j); -+ else if (STR_EQUAL_2G("2G", "B", "-", "ALL")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2gb_n, j); -+ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "0")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[0], j); -+ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "0")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[0], j); -+ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "0")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[0], j); -+ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "0")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[0], j); -+ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "1")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[1], j); -+ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "1")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[1], j); -+ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "1")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[1], j); -+ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "1")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[1], j); -+ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "2")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[2], j); -+ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "2")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[2], j); -+ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "2")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[2], j); -+ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "2")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[2], j); -+ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "3")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[3], j); -+ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "3")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[3], j); -+ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "3")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[3], j); -+ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "3")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[3], j); -+ else -+ RTW_INFO("===>initDeltaSwingIndexTables(): The input is invalid!!\n"); -+} -+ -+int -+PHY_ConfigRFWithTxPwrTrackParaFile( -+ PADAPTER Adapter, -+ char *pFileName -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ 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; -+ -+ _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_readable_file_sz_chk(rtw_phy_para_file_path, -+ MAX_PARA_FILE_BUF_LEN) == _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->delta_swing_table_idx_2ga_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2ga_p[i]); -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2ga_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2ga_n[i]); -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2gb_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2gb_p[i]); -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2gb_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2gb_n[i]); -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_p[i]); -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n[i]); -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p[i]); -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n[i]); -+ -+ for (j = 0; j < 3; ++j) { -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5ga_p[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5ga_p[j][i]); -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5ga_n[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5ga_n[j][i]); -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5gb_p[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5gb_p[j][i]); -+ RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5gb_n[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5gb_n[j][i]); -+ } -+ } -+#endif -+ return rtStatus; -+} -+ -+#if CONFIG_TXPWR_LIMIT -+ -+#ifndef DBG_TXPWR_LMT_FILE_PARSE -+#define DBG_TXPWR_LMT_FILE_PARSE 0 -+#endif -+ -+#define PARSE_RET_NO_HDL 0 -+#define PARSE_RET_SUCCESS 1 -+#define PARSE_RET_FAIL 2 -+ -+/* -+* @@Ver=2.0 -+* or -+* @@DomainCode=0x28, Regulation=C6 -+* or -+* @@CountryCode=GB, Regulation=C7 -+*/ -+static u8 parse_reg_exc_config(_adapter *adapter, char *szLine) -+{ -+#define VER_PREFIX "Ver=" -+#define DOMAIN_PREFIX "DomainCode=0x" -+#define COUNTRY_PREFIX "CountryCode=" -+#define REG_PREFIX "Regulation=" -+ -+ const u8 ver_prefix_len = strlen(VER_PREFIX); -+ const u8 domain_prefix_len = strlen(DOMAIN_PREFIX); -+ const u8 country_prefix_len = strlen(COUNTRY_PREFIX); -+ const u8 reg_prefix_len = strlen(REG_PREFIX); -+ u32 i, i_val_s, i_val_e; -+ u32 j; -+ u8 domain = 0xFF; -+ char *country = NULL; -+ u8 parse_reg = 0; -+ -+ if (szLine[0] != '@' || szLine[1] != '@') -+ return PARSE_RET_NO_HDL; -+ -+ i = 2; -+ if (strncmp(szLine + i, VER_PREFIX, ver_prefix_len) == 0) -+ ; /* nothing to do */ -+ else if (strncmp(szLine + i, DOMAIN_PREFIX, domain_prefix_len) == 0) { -+ /* get string after domain prefix to ',' */ -+ i += domain_prefix_len; -+ i_val_s = i; -+ while (szLine[i] != ',') { -+ if (szLine[i] == '\0') -+ return PARSE_RET_FAIL; -+ i++; -+ } -+ i_val_e = i; -+ -+ /* check if all hex */ -+ for (j = i_val_s; j < i_val_e; j++) -+ if (IsHexDigit(szLine[j]) == _FALSE) -+ return PARSE_RET_FAIL; -+ -+ /* get value from hex string */ -+ if (sscanf(szLine + i_val_s, "%hhx", &domain) != 1) -+ return PARSE_RET_FAIL; -+ -+ parse_reg = 1; -+ } else if (strncmp(szLine + i, COUNTRY_PREFIX, country_prefix_len) == 0) { -+ /* get string after country prefix to ',' */ -+ i += country_prefix_len; -+ i_val_s = i; -+ while (szLine[i] != ',') { -+ if (szLine[i] == '\0') -+ return PARSE_RET_FAIL; -+ i++; -+ } -+ i_val_e = i; -+ -+ if (i_val_e - i_val_s != 2) -+ return PARSE_RET_FAIL; -+ -+ /* check if all alpha */ -+ for (j = i_val_s; j < i_val_e; j++) -+ if (is_alpha(szLine[j]) == _FALSE) -+ return PARSE_RET_FAIL; -+ -+ country = szLine + i_val_s; -+ -+ parse_reg = 1; -+ -+ } else -+ return PARSE_RET_FAIL; -+ -+ if (parse_reg) { -+ /* move to 'R' */ -+ while (szLine[i] != 'R') { -+ if (szLine[i] == '\0') -+ return PARSE_RET_FAIL; -+ i++; -+ } -+ -+ /* check if matching regulation prefix */ -+ if (strncmp(szLine + i, REG_PREFIX, reg_prefix_len) != 0) -+ return PARSE_RET_FAIL; -+ -+ /* get string after regulation prefix ending with space */ -+ i += reg_prefix_len; -+ i_val_s = i; -+ while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0') -+ i++; -+ -+ if (i == i_val_s) -+ return PARSE_RET_FAIL; -+ -+ rtw_regd_exc_add_with_nlen(adapter_to_rfctl(adapter), country, domain, szLine + i_val_s, i - i_val_s); -+ } -+ -+ return PARSE_RET_SUCCESS; -+} -+ -+static int -+phy_ParsePowerLimitTableFile( -+ PADAPTER Adapter, -+ char *buffer -+) -+{ -+#define LD_STAGE_EXC_MAPPING 0 -+#define LD_STAGE_TAB_DEFINE 1 -+#define LD_STAGE_TAB_START 2 -+#define LD_STAGE_COLUMN_DEFINE 3 -+#define LD_STAGE_CH_ROW 4 -+ -+ int rtStatus = _FAIL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); -+ struct dm_struct *pDM_Odm = &(pHalData->odmpriv); -+ u8 loadingStage = LD_STAGE_EXC_MAPPING; -+ u32 i = 0, forCnt = 0; -+ char *szLine, *ptmp; -+ char band[10], bandwidth[10], rateSection[10], ntx[10], colNumBuf[10]; -+ char **lmt_names = NULL; -+ u8 colNum = 0; -+ -+ 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)) -+ continue; -+ -+ if (loadingStage == LD_STAGE_EXC_MAPPING) { -+ if (szLine[0] == '#' || szLine[1] == '#') { -+ loadingStage = LD_STAGE_TAB_DEFINE; -+ if (DBG_TXPWR_LMT_FILE_PARSE) -+ dump_regd_exc_list(RTW_DBGDUMP, adapter_to_rfctl(Adapter)); -+ } else { -+ if (parse_reg_exc_config(Adapter, szLine) == PARSE_RET_FAIL) { -+ RTW_ERR("Fail to parse regulation exception ruls!\n"); -+ goto exit; -+ } -+ continue; -+ } -+ } -+ -+ if (loadingStage == LD_STAGE_TAB_DEFINE) { -+ /* read "## 2.4G, 20M, 1T, CCK" */ -+ 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 */ -+ _rtw_memset((void *) band, 0, 10); -+ _rtw_memset((void *) bandwidth, 0, 10); -+ _rtw_memset((void *) ntx, 0, 10); -+ _rtw_memset((void *) rateSection, 0, 10); -+ if (!ParseQualifiedString(szLine, &i, band, ' ', ',')) { -+ RTW_ERR("Fail to parse band!\n"); -+ goto exit; -+ } -+ if (!ParseQualifiedString(szLine, &i, bandwidth, ' ', ',')) { -+ RTW_ERR("Fail to parse bandwidth!\n"); -+ goto exit; -+ } -+ if (!ParseQualifiedString(szLine, &i, ntx, ' ', ',')) { -+ RTW_ERR("Fail to parse ntx!\n"); -+ goto exit; -+ } -+ if (!ParseQualifiedString(szLine, &i, rateSection, ' ', ',')) { -+ RTW_ERR("Fail to parse rate!\n"); -+ goto exit; -+ } -+ -+ loadingStage = LD_STAGE_TAB_START; -+ } else if (loadingStage == LD_STAGE_TAB_START) { -+ /* read "## START" */ -+ if (szLine[0] != '#' || szLine[1] != '#') -+ continue; -+ -+ /* skip the space */ -+ i = 2; -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ if (strncmp((u8 *)(szLine + i), "START", 5)) { -+ RTW_ERR("Missing \"## START\" label\n"); -+ goto exit; -+ } -+ -+ loadingStage = LD_STAGE_COLUMN_DEFINE; -+ } else if (loadingStage == LD_STAGE_COLUMN_DEFINE) { -+ /* read "## #5# FCC ETSI MKK IC KCC" */ -+ if (szLine[0] != '#' || szLine[1] != '#') -+ continue; -+ -+ /* skip the space */ -+ i = 2; -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ _rtw_memset((void *) colNumBuf, 0, 10); -+ if (!ParseQualifiedString(szLine, &i, colNumBuf, '#', '#')) { -+ RTW_ERR("Fail to parse column number!\n"); -+ goto exit; -+ } -+ if (!GetU1ByteIntegerFromStringInDecimal(colNumBuf, &colNum)) { -+ RTW_ERR("Column number \"%s\" is not unsigned decimal\n", colNumBuf); -+ goto exit; -+ } -+ if (colNum == 0) { -+ RTW_ERR("Column number is 0\n"); -+ goto exit; -+ } -+ -+ if (DBG_TXPWR_LMT_FILE_PARSE) -+ RTW_PRINT("[%s][%s][%s][%s] column num:%d\n", band, bandwidth, rateSection, ntx, colNum); -+ -+ lmt_names = (char **)rtw_zmalloc(sizeof(char *) * colNum); -+ if (!lmt_names) { -+ RTW_ERR("lmt_names alloc fail\n"); -+ goto exit; -+ } -+ -+ for (forCnt = 0; forCnt < colNum; ++forCnt) { -+ u32 i_ns; -+ -+ /* skip the space */ -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ i++; -+ i_ns = i; -+ -+ while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0') -+ i++; -+ -+ lmt_names[forCnt] = (char *)rtw_malloc(i - i_ns + 1); -+ if (!lmt_names[forCnt]) { -+ RTW_ERR("lmt_name alloc fail\n"); -+ goto exit; -+ } -+ -+ _rtw_memcpy(lmt_names[forCnt], szLine + i_ns, i - i_ns); -+ lmt_names[forCnt][i - i_ns] = '\0'; -+ } -+ -+ if (DBG_TXPWR_LMT_FILE_PARSE) { -+ RTW_PRINT("column name:"); -+ for (forCnt = 0; forCnt < colNum; ++forCnt) -+ _RTW_PRINT(" %s", lmt_names[forCnt]); -+ _RTW_PRINT("\n"); -+ } -+ -+ loadingStage = LD_STAGE_CH_ROW; -+ } else if (loadingStage == LD_STAGE_CH_ROW) { -+ 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 (strncmp((u8 *)(szLine + i), "END", 3) == 0) { -+ loadingStage = LD_STAGE_TAB_DEFINE; -+ if (lmt_names) { -+ for (forCnt = 0; forCnt < colNum; ++forCnt) { -+ if (lmt_names[forCnt]) { -+ rtw_mfree(lmt_names[forCnt], strlen(lmt_names[forCnt]) + 1); -+ lmt_names[forCnt] = NULL; -+ } -+ } -+ rtw_mfree((u8 *)lmt_names, sizeof(char *) * colNum); -+ lmt_names = NULL; -+ } -+ colNum = 0; -+ continue; -+ } else { -+ RTW_ERR("Missing \"## END\" label\n"); -+ goto exit; -+ } -+ } -+ -+ if ((szLine[0] != 'c' && szLine[0] != 'C') || -+ (szLine[1] != 'h' && szLine[1] != 'H') -+ ) { -+ RTW_WARN("Wrong channel prefix: '%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 */ -+ _rtw_memset((void *) powerLimit, 0, 10); -+ -+ if (szLine[i] == 'W' && szLine[i + 1] == 'W') { -+ /* -+ * case "WW" assign special ww value -+ * means to get minimal limit in other regulations at same channel -+ */ -+ s8 ww_value = phy_txpwr_ww_lmt_value(Adapter); -+ -+ sprintf(powerLimit, "%d", ww_value); -+ i += 2; -+ -+ } else if (szLine[i] == 'N' && szLine[i + 1] == 'A') { -+ /* -+ * case "NA" assign max txgi value -+ * means no limitation -+ */ -+ sprintf(powerLimit, "%d", hal_spec->txgi_max); -+ i += 2; -+ -+ } else if ((szLine[i] >= '0' && szLine[i] <= '9') || szLine[i] == '.' -+ || szLine[i] == '+' || szLine[i] == '-' -+ ){ -+ /* case of dBm value */ -+ u8 integer = 0, fraction = 0, negative = 0; -+ u32 u4bMove; -+ s8 lmt = 0; -+ -+ if (szLine[i] == '+' || szLine[i] == '-') { -+ if (szLine[i] == '-') -+ negative = 1; -+ i++; -+ } -+ -+ if (GetFractionValueFromString(&szLine[i], &integer, &fraction, &u4bMove)) -+ i += u4bMove; -+ else { -+ RTW_ERR("Limit \"%s\" is not valid decimal\n", &szLine[i]); -+ goto exit; -+ } -+ -+ /* transform to string of value in unit of txgi */ -+ lmt = integer * hal_spec->txgi_pdbm + ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; -+ if (negative) -+ lmt = -lmt; -+ sprintf(powerLimit, "%d", lmt); -+ -+ } else { -+ RTW_ERR("Wrong limit expression \"%c%c\"(%d, %d)\n" -+ , szLine[i], szLine[i + 1], szLine[i], szLine[i + 1]); -+ goto exit; -+ } -+ -+ /* store the power limit value */ -+ phy_set_tx_power_limit(pDM_Odm, (u8 *)lmt_names[forCnt], (u8 *)band, -+ (u8 *)bandwidth, (u8 *)rateSection, (u8 *)ntx, (u8 *)channel, (u8 *)powerLimit); -+ -+ } -+ } -+ } -+ -+ rtStatus = _SUCCESS; -+ -+exit: -+ if (lmt_names) { -+ for (forCnt = 0; forCnt < colNum; ++forCnt) { -+ if (lmt_names[forCnt]) { -+ rtw_mfree(lmt_names[forCnt], strlen(lmt_names[forCnt]) + 1); -+ lmt_names[forCnt] = NULL; -+ } -+ } -+ rtw_mfree((u8 *)lmt_names, sizeof(char *) * colNum); -+ lmt_names = NULL; -+ } -+ -+ RTW_INFO("%s return %d\n", __func__, rtStatus); -+ return rtStatus; -+} -+ -+int -+PHY_ConfigRFWithPowerLimitTableParaFile( -+ PADAPTER Adapter, -+ 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_readable_file_sz_chk(rtw_phy_para_file_path, -+ MAX_PARA_FILE_BUF_LEN) == _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; -+} -+#endif /* CONFIG_TXPWR_LIMIT */ -+ -+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 -+ -+/* -+* TX power limit of regulatory without HAL consideration -+* Return value in unit of TX Gain Index -+* hal_spec.txgi_max means unspecified -+*/ -+s8 phy_get_txpwr_regd_lmt(_adapter *adapter, struct hal_spec_t *hal_spec, u8 cch, enum channel_width bw, u8 ntx_idx) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ s16 total_mbm = UNSPECIFIED_MBM; -+ s8 lmt; -+ -+ if ((adapter->registrypriv.RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory != 1) || -+ adapter->registrypriv.RegEnableTxPowerLimit == 0) -+ goto exit; -+ -+#ifdef CONFIG_REGD_SRC_FROM_OS -+ if (rfctl->regd_src == REGD_SRC_OS) -+ total_mbm = rtw_os_get_total_txpwr_regd_lmt_mbm(adapter, cch, bw); -+#endif -+ -+exit: -+ if (total_mbm != UNSPECIFIED_MBM) -+ lmt = (total_mbm - mb_of_ntx(ntx_idx + 1) - rfctl->antenna_gain) * hal_spec->txgi_pdbm / MBM_PDBM; -+ else -+ lmt = hal_spec->txgi_max; -+ -+ return lmt; -+} -+ -+/* -+* check if user specified mbm is valid -+*/ -+bool phy_is_txpwr_user_mbm_valid(_adapter *adapter, s16 mbm) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ /* 1T upper bound check */ -+ if (hal_spec->txgi_max <= mbm * hal_spec->txgi_pdbm / MBM_PDBM) -+ return 0; -+ -+ return 1; -+} -+ -+bool phy_is_txpwr_user_target_specified(_adapter *adapter) -+{ -+ s16 total_mbm = UNSPECIFIED_MBM; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ total_mbm = rtw_cfg80211_dev_get_total_txpwr_target_mbm(adapter_to_dvobj(adapter)); -+#endif -+ -+ return total_mbm != UNSPECIFIED_MBM; -+} -+ -+/* -+* Return value in unit of TX Gain Index -+* hal_spec.txgi_max means unspecified -+*/ -+s8 phy_get_txpwr_user_target(_adapter *adapter, struct hal_spec_t *hal_spec, u8 ntx_idx) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ s16 total_mbm = UNSPECIFIED_MBM; -+ s8 target; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ total_mbm = rtw_cfg80211_dev_get_total_txpwr_target_mbm(adapter_to_dvobj(adapter)); -+#endif -+ if (total_mbm != UNSPECIFIED_MBM) -+ target = (total_mbm - mb_of_ntx(ntx_idx + 1) - rfctl->antenna_gain) * hal_spec->txgi_pdbm / MBM_PDBM; -+ else -+ target = hal_spec->txgi_max; -+ -+ return target; -+} -+ -+/* -+* Return value in unit of TX Gain Index -+* hal_spec.txgi_max means unspecified -+*/ -+s8 phy_get_txpwr_user_lmt(_adapter *adapter, struct hal_spec_t *hal_spec, u8 ntx_idx) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ s16 total_mbm = UNSPECIFIED_MBM; -+ s8 lmt; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ total_mbm = rtw_cfg80211_dev_get_total_txpwr_lmt_mbm(adapter_to_dvobj(adapter)); -+#endif -+ if (total_mbm != UNSPECIFIED_MBM) -+ lmt = (total_mbm - mb_of_ntx(ntx_idx + 1) - rfctl->antenna_gain) * hal_spec->txgi_pdbm / MBM_PDBM; -+ else -+ lmt = hal_spec->txgi_max; -+ -+ return lmt; -+} -+ -+/* -+* Return value in unit of TX Gain Index -+* 0 means unspecified -+*/ -+s8 phy_get_txpwr_tpc(_adapter *adapter, struct hal_spec_t *hal_spec) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ u16 cnst = 0; -+ -+ if (rfctl->tpc_mode == TPC_MODE_MANUAL) -+ cnst = rfctl->tpc_manual_constraint * hal_spec->txgi_pdbm / MBM_PDBM; -+ -+ return -cnst; -+} -+ -+void dump_txpwr_tpc_settings(void *sel, _adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ if (rfctl->tpc_mode == TPC_MODE_DISABLE) -+ RTW_PRINT_SEL(sel, "mode:DISABLE(%d)\n", rfctl->tpc_mode); -+ else if (rfctl->tpc_mode == TPC_MODE_MANUAL) { -+ RTW_PRINT_SEL(sel, "mode:MANUAL(%d)\n", rfctl->tpc_mode); -+ RTW_PRINT_SEL(sel, "constraint:%d (mB)\n", rfctl->tpc_manual_constraint); -+ } -+} -+ -+void dump_txpwr_antenna_gain(void *sel, _adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ RTW_PRINT_SEL(sel, "%d (mBi)\n", rfctl->antenna_gain); -+} -+ -+/* -+* Return value in unit of TX Gain Index -+*/ -+s8 phy_get_txpwr_target(_adapter *adapter, u8 rfpath, RATE_SECTION rs, u8 rate, u8 ntx_idx -+ , enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch, bool reg_max, struct txpwr_idx_comp *tic) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ s8 target, by_rate = 0, btc_diff = 0, extra = 0; -+ s8 lmt, rlmt, utgt, ulmt; -+ s8 tpc = 0; -+ -+ rlmt = lmt = utgt = ulmt = hal_spec->txgi_max; -+ -+ if (band != BAND_ON_2_4G && IS_CCK_RATE(rate)) -+ goto exit; -+ -+ if (!reg_max) { -+ utgt = phy_get_txpwr_user_target(adapter, hal_spec, ntx_idx); -+ if (utgt != hal_spec->txgi_max) -+ goto get_lmt; -+ } -+ -+#ifdef CONFIG_RTL8812A -+ if (IS_HARDWARE_TYPE_8812(adapter) -+ && phy_get_txpwr_target_skip_by_rate_8812a(adapter, rate)) -+ by_rate = phy_get_target_txpwr(adapter, band, rfpath, rs); -+ else -+#endif -+ by_rate = phy_get_txpwr_by_rate(adapter, band, rfpath, rs, rate); -+ if (by_rate == hal_spec->txgi_max) -+ by_rate = 0; -+ -+#ifdef CONFIG_BT_COEXIST -+ if (!reg_max) { -+ if (hal_data->EEPROMBluetoothCoexist == _TRUE) -+ btc_diff = -(rtw_btcoex_query_reduced_wl_pwr_lvl(adapter) * hal_spec->txgi_pdbm); -+ } -+#endif -+ -+ extra = rtw_hal_get_txpwr_target_extra_bias(adapter, rfpath, rs, rate, bw, band, cch); -+ -+get_lmt: -+ rlmt = phy_get_txpwr_regd_lmt(adapter, hal_spec, cch, bw, ntx_idx); -+ lmt = phy_get_txpwr_lmt_sub_chs(adapter, NULL, band, bw, rfpath, rate, ntx_idx, cch, opch, reg_max); -+ if (!reg_max) -+ ulmt = phy_get_txpwr_user_lmt(adapter, hal_spec, ntx_idx); -+ /* TODO: limit from outer source, ex: 11d */ -+ -+ if (!reg_max) -+ tpc = phy_get_txpwr_tpc(adapter, hal_spec); -+ -+exit: -+ if (utgt != hal_spec->txgi_max) -+ target = utgt; -+ else -+ target = by_rate + btc_diff + extra; -+ -+ if (target > rlmt) -+ target = rlmt; -+ if (target > lmt) -+ target = lmt; -+ if (target > ulmt) -+ target = ulmt; -+ -+ target += tpc; -+ -+ if (tic) { -+ tic->target = target; -+ if (utgt == hal_spec->txgi_max) { -+ tic->by_rate = by_rate; -+ tic->btc = btc_diff; -+ tic->extra = extra; -+ } -+ tic->utarget = utgt; -+ tic->rlimit = rlmt; -+ tic->limit = lmt; -+ tic->ulimit = ulmt; -+ tic->tpc = tpc; -+ } -+ -+ return target; -+} -+ -+/* TODO: common dpd_diff getting API from phydm */ -+#ifdef CONFIG_RTL8822C -+#include "./rtl8822c/rtl8822c.h" -+#endif -+ -+/* -+* Return in unit of TX Gain Index -+*/ -+s8 phy_get_txpwr_amends(_adapter *adapter, u8 rfpath, RATE_SECTION rs, u8 rate, u8 ntx_idx -+ , enum channel_width bw, BAND_TYPE band, u8 cch, struct txpwr_idx_comp *tic) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ s8 tpt_diff = 0, dpd_diff = 0, val = 0; -+ -+ if (band != BAND_ON_2_4G && IS_CCK_RATE(rate)) -+ goto exit; -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter) || IS_HARDWARE_TYPE_8188F(adapter) || IS_HARDWARE_TYPE_8188GTV(adapter) -+ || IS_HARDWARE_TYPE_8192E(adapter) || IS_HARDWARE_TYPE_8192F(adapter) -+ || IS_HARDWARE_TYPE_8723B(adapter) || IS_HARDWARE_TYPE_8703B(adapter) || IS_HARDWARE_TYPE_8723D(adapter) -+ || IS_HARDWARE_TYPE_8710B(adapter) -+ || IS_HARDWARE_TYPE_8821(adapter) || IS_HARDWARE_TYPE_8812(adapter) -+ ) -+ tpt_diff = PHY_GetTxPowerTrackingOffset(adapter, rfpath, rate); -+ -+#ifdef CONFIG_RTL8822C -+ if (IS_HARDWARE_TYPE_8822C(adapter)) -+ dpd_diff = -(rtl8822c_get_dis_dpd_by_rate_diff(adapter, rate) * hal_spec->txgi_pdbm); -+#endif -+ -+exit: -+ if (tic) { -+ tic->tpt = tpt_diff; -+ tic->dpd = dpd_diff; -+ } -+ -+ return tpt_diff + dpd_diff; -+} -+ -+#ifdef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+s8 phy_get_tssi_txpwr_by_rate_ref(_adapter *adapter, enum rf_path path -+ , enum channel_width bw, u8 cch, u8 opch) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 ntx_idx = phy_get_current_tx_num(adapter, MGN_MCS7); -+ BAND_TYPE band = cch > 14 ? BAND_ON_5G : BAND_ON_2_4G; -+ s8 pwr_idx; -+ -+ pwr_idx = phy_get_txpwr_target(adapter, path, HT_1SS, MGN_MCS7 -+ , ntx_idx, bw, band, cch, opch, 0, NULL); -+ pwr_idx += phy_get_txpwr_amends(adapter, path, HT_1SS, MGN_MCS7 -+ , ntx_idx, bw, band, cch, NULL); -+ -+ return pwr_idx; -+} -+#endif -+ -+/* -+ * Rteurn tx power index for rate -+ */ -+u8 hal_com_get_txpwr_idx(_adapter *adapter, enum rf_path rfpath -+ , RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch -+ , struct txpwr_idx_comp *tic) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ s16 power_idx = 0; -+ s8 base = 0; -+ s8 rate_target, rate_amends; -+ u8 ntx_idx = phy_get_current_tx_num(adapter, rate); -+ -+ /* target */ -+ rate_target = phy_get_txpwr_target(adapter, rfpath, rs, rate, ntx_idx, bw, band, cch, opch, 0, tic); -+ -+ /* amends */ -+ rate_amends = phy_get_txpwr_amends(adapter, rfpath, rs, rate, ntx_idx, bw, band, cch, tic); -+ -+ switch (hal->txpwr_pg_mode) { -+#ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ case TXPWR_PG_WITH_PWR_IDX: { -+ /* -+ * power index = -+ * 1. pg base (per rate section) + -+ * 2. target diff (per rate) to target of its rate section + -+ * 3. amends diff (per rate) -+ */ -+ u8 rs_target; -+ -+ base = phy_get_pg_txpwr_idx(adapter, rfpath, rs, ntx_idx, bw, band, cch); -+ rs_target = phy_get_target_txpwr(adapter, band, rfpath, rs); -+ power_idx = base + (rate_target - rs_target) + (rate_amends); -+ -+ if (tic) { -+ if (tic->utarget == hal_spec->txgi_max) -+ tic->by_rate -= rs_target; -+ else -+ tic->utarget -= rs_target; -+ if (tic->rlimit != hal_spec->txgi_max) -+ tic->rlimit -= rs_target; -+ if (tic->limit != hal_spec->txgi_max) -+ tic->limit -= rs_target; -+ if (tic->ulimit != hal_spec->txgi_max) -+ tic->ulimit -= rs_target; -+ } -+ } -+ break; -+#endif -+#ifdef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+ case TXPWR_PG_WITH_TSSI_OFFSET: { -+ /* -+ * power index = -+ * 1. base (fixed) + -+ * 2. target (per rate) + -+ * 3. amends diff (per rate) -+ * base is selected that power index of MCS7 == halrf_get_tssi_codeword_for_txindex() -+ */ -+#if defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) -+ s8 mcs7_idx; -+ -+ mcs7_idx = phy_get_tssi_txpwr_by_rate_ref(adapter, rfpath, bw, cch, opch); -+ base = halrf_get_tssi_codeword_for_txindex(adapter_to_phydm(adapter)) - mcs7_idx; -+ power_idx = base + rate_target + rate_amends; -+#else -+ base = 0; -+ power_idx = rate_target + rate_amends; -+#endif -+ } -+ break; -+#endif -+ } -+ -+ if (tic) { -+ tic->ntx_idx = ntx_idx; -+ tic->base = base; -+ } -+ -+ if (power_idx < 0) -+ power_idx = 0; -+ else if (power_idx > hal_spec->txgi_max) -+ power_idx = hal_spec->txgi_max; -+ -+#if defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8812A) -+ if ((IS_HARDWARE_TYPE_8821(adapter) || IS_HARDWARE_TYPE_8812(adapter)) -+ && power_idx % 2 == 1 && !IS_NORMAL_CHIP(hal->version_id)) -+ --power_idx; -+#endif -+ -+ return power_idx; -+} -+ -+static s16 phy_get_txpwr_mbm(_adapter *adapter, u8 rfpath, RATE_SECTION rs, u8 rate -+ , enum channel_width bw, u8 cch, u8 opch, bool total, bool reg_max, bool eirp, struct txpwr_idx_comp *tic) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ BAND_TYPE band = cch <= 14 ? BAND_ON_2_4G : BAND_ON_5G; -+ u8 ntx_idx_max, ntx_idx, i; -+ s16 val, max = UNSPECIFIED_MBM; -+ -+ if (reg_max) { -+ ntx_idx_max = phy_get_capable_tx_num(adapter, rate); -+ ntx_idx = rate_section_to_tx_num(rs); -+ if (ntx_idx > ntx_idx_max) { -+ rtw_warn_on(1); -+ return 0; -+ } -+ } else -+ ntx_idx_max = ntx_idx = phy_get_current_tx_num(adapter, rate); -+ -+ for (i = 0; ntx_idx + i <= ntx_idx_max; i++) { -+ val = phy_get_txpwr_target(adapter, rfpath, rs, rate, ntx_idx, bw, band, cch, opch, reg_max, tic); -+ val = (val * MBM_PDBM) / hal_spec->txgi_pdbm; -+ if (total) -+ val += mb_of_ntx(ntx_idx + 1); -+ if (eirp) -+ val += rfctl->antenna_gain; -+ -+ if (max == UNSPECIFIED_MBM || max < val) -+ max = val; -+ } -+ -+ if (tic) -+ tic->ntx_idx = ntx_idx; -+ -+ if (max == UNSPECIFIED_MBM) { -+ rtw_warn_on(1); -+ max = 0; -+ } -+ return max; -+} -+ -+/* get txpowr in mBm for single path */ -+s16 phy_get_txpwr_single_mbm(_adapter *adapter, u8 rfpath, RATE_SECTION rs, u8 rate -+ , enum channel_width bw, u8 cch, u8 opch, bool reg_max, bool eirp, struct txpwr_idx_comp *tic) -+{ -+ return phy_get_txpwr_mbm(adapter, rfpath, rs, rate, bw, cch, opch, 0, reg_max, eirp, tic); -+} -+ -+/* get txpowr in mBm with effect of N-TX */ -+s16 phy_get_txpwr_total_mbm(_adapter *adapter, RATE_SECTION rs, u8 rate -+ , enum channel_width bw, u8 cch, u8 opch, bool reg_max, bool eirp, struct txpwr_idx_comp *tic) -+{ -+ /* assume all path have same txpower target */ -+ return phy_get_txpwr_mbm(adapter, RF_PATH_A, rs, rate, bw, cch, opch, 1, reg_max, eirp, tic); -+} -+ -+static s16 _phy_get_txpwr_max_mbm(_adapter *adapter, s8 rfpath -+ , enum channel_width bw, u8 cch, u8 opch, u16 bmp_cck_ofdm, u32 bmp_ht, u64 bmp_vht, bool reg_max, bool eirp) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ BAND_TYPE band = cch <= 14 ? BAND_ON_2_4G : BAND_ON_5G; -+ u8 tx_num; -+ RATE_SECTION rs; -+ u8 hw_rate; -+ int i; -+ s16 max = UNSPECIFIED_MBM, mbm; -+ -+ if (0) -+ RTW_INFO("cck_ofdm:0x%04x, ht:0x%08x, vht:0x%016llx\n", bmp_cck_ofdm, bmp_ht, bmp_vht); -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ tx_num = rate_section_to_tx_num(rs); -+ if (tx_num + 1 > hal_data->tx_nss) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) -+ continue; -+ -+ for (i = 0; i < rates_by_sections[rs].rate_num; i++) { -+ hw_rate = MRateToHwRate(rates_by_sections[rs].rates[i]); -+ if (IS_LEGACY_HRATE(hw_rate)) { -+ if (!(bmp_cck_ofdm & BIT(hw_rate))) -+ continue; -+ } else if (IS_HT_HRATE(hw_rate)) { -+ if (!(bmp_ht & BIT(hw_rate - DESC_RATEMCS0))) -+ continue; -+ } else if (IS_VHT_HRATE(hw_rate)) { -+ if (!(bmp_vht & BIT_ULL(hw_rate - DESC_RATEVHTSS1MCS0))) -+ continue; -+ } -+ -+ if (rfpath < 0) /* total */ -+ mbm = phy_get_txpwr_total_mbm(adapter, rs, rates_by_sections[rs].rates[i], bw, cch, opch, reg_max, eirp, NULL); -+ else -+ mbm = phy_get_txpwr_single_mbm(adapter, rfpath, rs, rates_by_sections[rs].rates[i], bw, cch, opch, reg_max, eirp, NULL); -+ -+ if (max == UNSPECIFIED_MBM || mbm > max) -+ max = mbm; -+ } -+ } -+ -+ return max; -+} -+ -+s16 phy_get_txpwr_single_max_mbm(_adapter *adapter, u8 rfpath -+ , enum channel_width bw, u8 cch, u8 opch, u16 bmp_cck_ofdm, u32 bmp_ht, u64 bmp_vht, bool reg_max, bool eirp) -+{ -+ return _phy_get_txpwr_max_mbm(adapter, rfpath, bw, cch, opch, bmp_cck_ofdm, bmp_ht, bmp_vht, reg_max, eirp); -+} -+ -+s16 phy_get_txpwr_total_max_mbm(_adapter *adapter -+ , enum channel_width bw, u8 cch, u8 opch, u16 bmp_cck_ofdm, u32 bmp_ht, u64 bmp_vht, bool reg_max, bool eirp) -+{ -+ return _phy_get_txpwr_max_mbm(adapter, -1, bw, cch, opch, bmp_cck_ofdm, bmp_ht, bmp_vht, reg_max, eirp); -+} -+ -+s8 -+phy_get_tx_power_final_absolute_value(_adapter *adapter, u8 rfpath, u8 rate, -+ enum channel_width bw, u8 cch) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ RATE_SECTION rs = mgn_rate_to_rs(rate); -+ BAND_TYPE band = cch <= 14 ? BAND_ON_2_4G : BAND_ON_5G; -+ s8 val; -+ -+ val = phy_get_txpwr_target(adapter, rfpath -+ , rs, rate, phy_get_current_tx_num(adapter, rate), bw, band, cch, 0, 0, NULL); -+ -+ val /= hal_spec->txgi_pdbm; -+ -+ return val; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_dm.c b/drivers/net/wireless/rtl8821cs/hal/hal_dm.c -new file mode 100644 -index 000000000..550200870 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_dm.c -@@ -0,0 +1,1962 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2014 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+/* A mapping from HalData to ODM. */ -+enum odm_board_type boardType(u8 InterfaceSel) -+{ -+ enum odm_board_type 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 rtw_hal_update_iqk_fw_offload_cap(_adapter *adapter) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); -+ -+ if (hal->RegIQKFWOffload) { -+ rtw_sctx_init(&hal->iqk_sctx, 0); -+ phydm_fwoffload_ability_init(p_dm_odm, PHYDM_RF_IQK_OFFLOAD); -+ } else -+ phydm_fwoffload_ability_clear(p_dm_odm, PHYDM_RF_IQK_OFFLOAD); -+ -+ RTW_INFO("IQK FW offload:%s\n", hal->RegIQKFWOffload ? "enable" : "disable"); -+ -+ if (rtw_mi_check_status(adapter, MI_LINKED)) { -+ #ifdef CONFIG_LPS -+ LPS_Leave(adapter, "SWITCH_IQK_OFFLOAD"); -+ #endif -+ halrf_iqk_trigger(p_dm_odm, _FALSE); -+ } -+} -+ -+#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1) \ -+ || (RTL8723F_SUPPORT == 1)) -+void rtw_phydm_iqk_trigger(_adapter *adapter) -+{ -+ struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); -+ u8 clear = _TRUE; -+ u8 segment = _FALSE; -+ u8 rfk_forbidden = _FALSE; -+ -+ halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); -+#if (RTL8822C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8723F_SUPPORT == 1) -+ /* halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_IQK_SEGMENT, segment); to do */ -+ halrf_rf_k_connect_trigger(p_dm_odm, _TRUE, SEGMENT_FREE); -+#else -+ /*segment = _rtw_phydm_iqk_segment_chk(adapter);*/ -+ halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_IQK_SEGMENT, segment); -+ halrf_segment_iqk_trigger(p_dm_odm, clear, segment); -+#endif -+} -+#endif -+ -+void rtw_phydm_iqk_trigger_all(_adapter *adapter) -+{ -+ struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); -+ u8 clear = _TRUE; -+ u8 segment = _FALSE; -+ u8 rfk_forbidden = _FALSE; -+ -+#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1) \ -+ || (RTL8723F_SUPPORT == 1)) -+ halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); -+#if (RTL8822C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8723F_SUPPORT == 1) -+ /* halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_IQK_SEGMENT, segment); to do */ -+ halrf_rf_k_connect_trigger(p_dm_odm, _TRUE, SEGMENT_FREE); -+#else -+ /*segment = _rtw_phydm_iqk_segment_chk(adapter);*/ -+ halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_IQK_SEGMENT, segment); -+ halrf_segment_iqk_trigger(p_dm_odm, clear, segment); -+#endif /* (RTL8822C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) (RTL8723F_SUPPORT == 1) */ -+#else -+ halrf_iqk_trigger(p_dm_odm, _FALSE); -+#endif /* ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1)) -+ (RTL8723F_SUPPORT == 1) */ -+} -+ -+void rtw_phydm_iqk_trigger_dbg(_adapter *adapter, bool recovery, bool clear, bool segment) -+{ -+ struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); -+ -+#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1)) -+ halrf_segment_iqk_trigger(p_dm_odm, clear, segment); -+#else -+ halrf_iqk_trigger(p_dm_odm, recovery); -+#endif -+} -+void rtw_phydm_lck_trigger(_adapter *adapter) -+{ -+ struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); -+ -+ halrf_lck_trigger(p_dm_odm); -+} -+ -+void rtw_hal_phydm_cal_trigger(_adapter *adapter) -+{ -+ struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ rtw_phydm_iqk_trigger_all(adapter); -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+} -+ -+#ifdef CONFIG_DBG_RF_CAL -+void rtw_hal_iqk_test(_adapter *adapter, bool recovery, bool clear, bool segment) -+{ -+ struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ rtw_phydm_ability_backup(adapter); -+ rtw_phydm_func_disable_all(adapter); -+ -+ halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_ABILITY, HAL_RF_IQK); -+ -+ rtw_phydm_iqk_trigger_dbg(adapter, recovery, clear, segment); -+ rtw_phydm_ability_restore(adapter); -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+} -+ -+void rtw_hal_lck_test(_adapter *adapter) -+{ -+ struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ rtw_phydm_ability_backup(adapter); -+ rtw_phydm_func_disable_all(adapter); -+ -+ halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_ABILITY, HAL_RF_LCK); -+ -+ rtw_phydm_lck_trigger(adapter); -+ -+ rtw_phydm_ability_restore(adapter); -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+} -+#endif -+ -+#ifdef CONFIG_FW_OFFLOAD_PARAM_INIT -+void rtw_hal_update_param_init_fw_offload_cap(_adapter *adapter) -+{ -+ struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); -+ -+ if (adapter->registrypriv.fw_param_init) -+ phydm_fwoffload_ability_init(p_dm_odm, PHYDM_PHY_PARAM_OFFLOAD); -+ else -+ phydm_fwoffload_ability_clear(p_dm_odm, PHYDM_PHY_PARAM_OFFLOAD); -+ -+ RTW_INFO("Init-Parameter FW offload:%s\n", adapter->registrypriv.fw_param_init ? "enable" : "disable"); -+} -+#endif -+ -+void record_ra_info(void *p_dm_void, u8 macid, struct cmn_sta_info *p_sta, u64 ra_mask) -+{ -+ struct dm_struct *p_dm = (struct dm_struct *)p_dm_void; -+ _adapter *adapter = p_dm->adapter; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ -+ if (p_sta) { -+ rtw_macid_ctl_set_bw(macid_ctl, macid, p_sta->ra_info.ra_bw_mode); -+ rtw_macid_ctl_set_vht_en(macid_ctl, macid, p_sta->ra_info.is_vht_enable); -+ rtw_macid_ctl_set_rate_bmp0(macid_ctl, macid, ra_mask); -+ rtw_macid_ctl_set_rate_bmp1(macid_ctl, macid, ra_mask >> 32); -+ -+ rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); -+ } -+} -+ -+#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR -+void rtw_phydm_fill_desc_dpt(void *dm, u8 *desc, u8 dpt_lv) -+{ -+ struct dm_struct *p_dm = (struct dm_struct *)dm; -+ _adapter *adapter = p_dm->adapter; -+ -+ switch (rtw_get_chip_type(adapter)) { -+/* -+ #ifdef CONFIG_RTL8188F -+ case RTL8188F: -+ break; -+ #endif -+ -+ #ifdef CONFIG_RTL8723B -+ case RTL8723B : -+ break; -+ #endif -+ -+ #ifdef CONFIG_RTL8703B -+ case RTL8703B : -+ break; -+ #endif -+ -+ #ifdef CONFIG_RTL8812A -+ case RTL8812 : -+ break; -+ #endif -+ -+ #ifdef CONFIG_RTL8821A -+ case RTL8821: -+ break; -+ #endif -+ -+ #ifdef CONFIG_RTL8814A -+ case RTL8814A : -+ break; -+ #endif -+ -+ #ifdef CONFIG_RTL8192F -+ case RTL8192F : -+ break; -+ #endif -+*/ -+/* -+ #ifdef CONFIG_RTL8192E -+ case RTL8192E : -+ SET_TX_DESC_TX_POWER_0_PSET_92E(desc, dpt_lv); -+ break; -+ #endif -+*/ -+ #ifdef CONFIG_RTL8822B -+ case RTL8822B : -+ SET_TX_DESC_TXPWR_OFSET_8822B(desc, dpt_lv); -+ break; -+ #endif -+ -+ #ifdef CONFIG_RTL8821C -+ case RTL8821C : -+ SET_TX_DESC_TXPWR_OFSET_8821C(desc, dpt_lv); -+ break; -+ #endif -+ -+ default : -+ RTW_ERR("%s IC not support dynamic tx power\n", __func__); -+ break; -+ } -+} -+void rtw_phydm_set_dyntxpwr(_adapter *adapter, u8 *desc, u8 mac_id) -+{ -+ struct dm_struct *dm = adapter_to_phydm(adapter); -+ -+ odm_set_dyntxpwr(dm, desc, mac_id); -+} -+#endif -+ -+#ifdef CONFIG_TDMADIG -+void rtw_phydm_tdmadig(_adapter *adapter, u8 state) -+{ -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct dm_struct *dm = adapter_to_phydm(adapter); -+ u8 tdma_dig_en; -+ -+ switch (state) { -+ case TDMADIG_INIT: -+ phydm_tdma_dig_para_upd(dm, ENABLE_TDMA, pregistrypriv->tdmadig_en); -+ phydm_tdma_dig_para_upd(dm, MODE_DECISION, pregistrypriv->tdmadig_mode); -+ break; -+ case TDMADIG_NON_INIT: -+ if(pregistrypriv->tdmadig_dynamic) { -+ if(pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE) -+ tdma_dig_en = 0; -+ else -+ tdma_dig_en = pregistrypriv->tdmadig_en; -+ phydm_tdma_dig_para_upd(dm, ENABLE_TDMA, tdma_dig_en); -+ } -+ break; -+ default: -+ break; -+ -+ } -+} -+#endif/*CONFIG_TDMADIG*/ -+void rtw_phydm_ops_func_init(struct dm_struct *p_phydm) -+{ -+ struct ra_table *p_ra_t = &p_phydm->dm_ra_table; -+ -+ p_ra_t->record_ra_info = record_ra_info; -+ #ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR -+ p_phydm->fill_desc_dyntxpwr = rtw_phydm_fill_desc_dpt; -+ #endif -+} -+void rtw_phydm_priv_init(_adapter *adapter) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ struct dm_struct *phydm = &(hal->odmpriv); -+ -+ phydm->adapter = adapter; -+ odm_cmn_info_init(phydm, ODM_CMNINFO_PLATFORM, ODM_CE); -+} -+ -+void Init_ODM_ComInfo(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ struct dm_struct *pDM_Odm = &(pHalData->odmpriv); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ int i; -+ -+ /*phydm_op_mode could be change for different scenarios: ex: SoftAP - PHYDM_BALANCE_MODE*/ -+ pHalData->phydm_op_mode = PHYDM_PERFORMANCE_MODE;/*Service one device*/ -+ rtw_odm_init_ic_type(adapter); -+ -+ if (rtw_get_intf_type(adapter) == RTW_GSPI) -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_INTERFACE, ODM_ITRF_SDIO); -+ else -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_INTERFACE, rtw_get_intf_type(adapter)); -+ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_MP_TEST_CHIP, IS_NORMAL_CHIP(pHalData->version_id)); -+ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_PATCH_ID, pHalData->CustomerID); -+ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_BWIFI_TEST, adapter->registrypriv.wifi_spec); -+ -+#ifdef CONFIG_ADVANCE_OTA -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_ADVANCE_OTA, adapter->registrypriv.adv_ota); -+#endif -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, pHalData->rf_type); -+ -+ { -+ /* 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_cmn_info_init(pDM_Odm, ODM_CMNINFO_EXT_LNA, 1); -+ } -+ if (pHalData->external_lna_5g != 0) { -+ odm_board_type |= ODM_BOARD_EXT_LNA_5G; -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_5G_EXT_LNA, 1); -+ } -+ if (pHalData->ExternalPA_2G != 0) { -+ odm_board_type |= ODM_BOARD_EXT_PA; -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_EXT_PA, 1); -+ } -+ if (pHalData->external_pa_5g != 0) { -+ odm_board_type |= ODM_BOARD_EXT_PA_5G; -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_5G_EXT_PA, 1); -+ } -+ if (pHalData->EEPROMBluetoothCoexist) -+ odm_board_type |= ODM_BOARD_BT; -+ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_BOARD_TYPE, odm_board_type); -+ /* 1 ============== End of BoardType ============== */ -+ } -+ -+#ifdef CONFIG_DFS_MASTER -+ rtw_odm_update_dfs_region(dvobj); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_DFS_MASTER_ENABLE, &(adapter_to_rfctl(adapter)->radar_detect_enabled)); -+#endif -+ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_GPA, pHalData->TypeGPA); -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_APA, pHalData->TypeAPA); -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_GLNA, pHalData->TypeGLNA); -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_ALNA, pHalData->TypeALNA); -+ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->rfe_type); -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_X_CAP_SETTING, pHalData->crystal_cap); -+ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_EXT_TRSW, 0); -+ -+ /*Add by YuChen for kfree init*/ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_REGRFKFREEENABLE, adapter->registrypriv.RegPwrTrimEnable); -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RFKFREEENABLE, pHalData->RfKFreeEnable); -+ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_BE_FIX_TX_ANT, pHalData->b_fix_tx_ant); -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH, pHalData->with_extenal_ant_switch); -+ -+ /* (8822B) efuse 0x3D7 & 0x3D8 for TX PA bias */ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_EFUSE0X3D7, pHalData->efuse0x3d7); -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_EFUSE0X3D8, pHalData->efuse0x3d8); -+ -+ /* waiting for PhyDMV034 support*/ -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_MANUAL_SUPPORTABILITY, &(adapter->registrypriv.phydm_ability)); -+ -+ /*Add by YuChen for adaptivity init*/ -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_ADAPTIVITY, &rfctl->adaptivity_en); -+ phydm_adaptivity_info_init(pDM_Odm, PHYDM_ADAPINFO_TH_L2H_INI, adapter->registrypriv.adaptivity_th_l2h_ini); -+ phydm_adaptivity_info_init(pDM_Odm, PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, adapter->registrypriv.adaptivity_th_edcca_hl_diff); -+ rtw_odm_adaptivity_update(dvobj); -+ -+ /*halrf info init*/ -+ halrf_cmn_info_init(pDM_Odm, HALRF_CMNINFO_EEPROM_THERMAL_VALUE, pHalData->eeprom_thermal_meter); -+ halrf_cmn_info_init(pDM_Odm, HALRF_CMNINFO_PWT_TYPE, 0); -+ halrf_cmn_info_init(pDM_Odm, HALRF_CMNINFO_MP_POWER_TRACKING_TYPE, pHalData->txpwr_pg_mode); -+ -+ if (rtw_odm_adaptivity_needed(adapter) == _TRUE) -+ rtw_odm_adaptivity_config_msg(RTW_DBGDUMP, adapter); -+ -+#ifdef CONFIG_IQK_PA_OFF -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_IQKPAOFF, 1); -+#endif -+ rtw_hal_update_iqk_fw_offload_cap(adapter); -+ #ifdef CONFIG_FW_OFFLOAD_PARAM_INIT -+ rtw_hal_update_param_init_fw_offload_cap(adapter); -+ #endif -+ -+ /* Pointer reference */ -+ /*Antenna diversity relative parameters*/ -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_ANT_DIV, &(pHalData->AntDivCfg)); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_MP_MODE, &(adapter->registrypriv.mp_mode)); -+ -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BB_OPERATION_MODE, &(pHalData->phydm_op_mode)); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_TX_UNI, &(dvobj->traffic_stat.tx_bytes)); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_RX_UNI, &(dvobj->traffic_stat.rx_bytes)); -+ -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BAND, &(pHalData->current_band_type)); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_FORCED_RATE, &(pHalData->ForcedDataRate)); -+ -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_SEC_CHNL_OFFSET, &(pHalData->nCur40MhzPrimeSC)); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_SEC_MODE, &(adapter->securitypriv.dot11PrivacyAlgrthm)); -+#ifdef CONFIG_NARROWBAND_SUPPORTING -+ if ((adapter->registrypriv.rtw_nb_config == RTW_NB_CONFIG_WIDTH_10) -+ || (adapter->registrypriv.rtw_nb_config == RTW_NB_CONFIG_WIDTH_5)) { -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BW, &(adapter->registrypriv.rtw_nb_config)); -+ } -+ else -+#endif -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BW, &(pHalData->current_channel_bw)); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_CHNL, &(pHalData->current_channel)); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_NET_CLOSED, &(adapter->net_closed)); -+ -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_SCAN, &(pHalData->bScanInProcess)); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_POWER_SAVING, &(pwrctl->bpower_saving)); -+ /*Add by Yuchen for phydm beamforming*/ -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_TX_TP, &(dvobj->traffic_stat.cur_tx_tp)); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_RX_TP, &(dvobj->traffic_stat.cur_rx_tp)); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_ANT_TEST, &(pHalData->antenna_test)); -+#ifdef CONFIG_RTL8723B -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_IS1ANTENNA, &pHalData->EEPROMBluetoothAntNum); -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_RFDEFAULTPATH, &pHalData->ant_path); -+#endif /*CONFIG_RTL8723B*/ -+#ifdef CONFIG_USB_HCI -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_HUBUSBMODE, &(dvobj->usb_speed)); -+#endif -+ -+#ifdef CONFIG_DYNAMIC_SOML -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_ADAPTIVE_SOML, &(adapter->registrypriv.dyn_soml_en)); -+#endif -+#ifdef CONFIG_RTW_PATH_DIV -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_PATH_DIV, &(adapter->registrypriv.path_div)); -+#endif -+ odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_FCS_MODE, &(pHalData->multi_ch_switch_mode)); -+ -+ /*halrf info hook*/ -+ /* waiting for PhyDMV034 support*/ -+ halrf_cmn_info_hook(pDM_Odm, HALRF_CMNINFO_MANUAL_RF_SUPPORTABILITY, &(adapter->registrypriv.halrf_ability)); -+#ifdef CONFIG_MP_INCLUDED -+ halrf_cmn_info_hook(pDM_Odm, HALRF_CMNINFO_CON_TX, &(adapter->mppriv.mpt_ctx.is_start_cont_tx)); -+ halrf_cmn_info_hook(pDM_Odm, HALRF_CMNINFO_SINGLE_TONE, &(adapter->mppriv.mpt_ctx.is_single_tone)); -+ halrf_cmn_info_hook(pDM_Odm, HALRF_CMNINFO_CARRIER_SUPPRESSION, &(adapter->mppriv.mpt_ctx.is_carrier_suppression)); -+ halrf_cmn_info_hook(pDM_Odm, HALRF_CMNINFO_MP_RATE_INDEX, &(adapter->mppriv.mpt_ctx.mpt_rate_index)); -+#endif/*CONFIG_MP_INCLUDED*/ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) -+ phydm_cmn_sta_info_hook(pDM_Odm, i, NULL); -+ -+ rtw_phydm_ops_func_init(pDM_Odm); -+ phydm_dm_early_init(pDM_Odm); -+ /* TODO */ -+ /* odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BT_OPERATION, _FALSE); */ -+ /* odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BT_DISABLE_EDCA, _FALSE); */ -+} -+ -+ -+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}; -+ -+static u32 edca_setting_dl_g_mode[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}; -+ -+ -+struct turbo_edca_setting{ -+ u32 edca_ul; /* uplink, tx */ -+ u32 edca_dl; /* downlink, rx */ -+}; -+ -+#define TURBO_EDCA_ENT(UL, DL) {UL, DL} -+ -+#if 0 -+#define TURBO_EDCA_MODE_NUM 18 -+static struct turbo_edca_setting rtw_turbo_edca[TURBO_EDCA_MODE_NUM] = { -+ TURBO_EDCA_ENT(0xa42b, 0xa42b), /* mode 0 */ -+ TURBO_EDCA_ENT(0x431c, 0x431c), /* mode 1 */ -+ TURBO_EDCA_ENT(0x4319, 0x4319), /* mode 2 */ -+ -+ TURBO_EDCA_ENT(0x5ea42b, 0x5ea42b), /* mode 3 */ -+ TURBO_EDCA_ENT(0x5e431c, 0x5e431c), /* mode 4 */ -+ TURBO_EDCA_ENT(0x5e4319, 0x5e4319), /* mode 5 */ -+ -+ TURBO_EDCA_ENT(0x6ea42b, 0x6ea42b), /* mode 6 */ -+ TURBO_EDCA_ENT(0x6e431c, 0x6e431c), /* mode 7 */ -+ TURBO_EDCA_ENT(0x6e4319, 0x6e4319), /* mode 8 */ -+ -+ TURBO_EDCA_ENT(0x5ea42b, 0xa42b), /* mode 9 */ -+ TURBO_EDCA_ENT(0x5e431c, 0x431c), /* mode 10 */ -+ TURBO_EDCA_ENT(0x5e4319, 0x4319), /* mode 11 */ -+ -+ TURBO_EDCA_ENT(0x6ea42b, 0xa42b), /* mode 12 */ -+ TURBO_EDCA_ENT(0x6e431c, 0x431c), /* mode 13 */ -+ TURBO_EDCA_ENT(0x6e4319, 0x4319), /* mode 14 */ -+ -+ TURBO_EDCA_ENT(0x431c, 0x5e431c), /* mode 15 */ -+ -+ TURBO_EDCA_ENT(0xa42b, 0x5ea42b), /* mode 16 */ -+ -+ TURBO_EDCA_ENT(0x138642b, 0x431c), /* mode 17 */ -+}; -+#else -+#define TURBO_EDCA_MODE_NUM 8 -+static struct turbo_edca_setting rtw_turbo_edca[TURBO_EDCA_MODE_NUM] = { -+ /* { UL, DL } */ -+ TURBO_EDCA_ENT(0x5e431c, 0x431c), /* mode 0 */ -+ -+ TURBO_EDCA_ENT(0x431c, 0x431c), /* mode 1 */ -+ -+ TURBO_EDCA_ENT(0x5e431c, 0x5e431c), /* mode 2 */ -+ -+ TURBO_EDCA_ENT(0x5ea42b, 0x5ea42b), /* mode 3 */ -+ -+ TURBO_EDCA_ENT(0x5ea42b, 0x431c), /* mode 4 */ -+ -+ TURBO_EDCA_ENT(0x6ea42b, 0x6ea42b), /* mode 5 */ -+ -+ TURBO_EDCA_ENT(0xa42b, 0xa42b), /* mode 6 */ -+ -+ TURBO_EDCA_ENT(0x5e431c, 0xa42b), /* mode 7 */ -+}; -+#endif -+ -+void rtw_hal_turbo_edca(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct dvobj_priv *dvobj = 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); -+ -+ /* Parameter suggested by Scott */ -+#if 0 -+ u32 EDCA_BE_UL = edca_setting_UL[p_mgnt_info->iot_peer]; -+ u32 EDCA_BE_DL = edca_setting_DL[p_mgnt_info->iot_peer]; -+#endif -+ u32 EDCA_BE_UL = 0x5ea42b; -+ u32 EDCA_BE_DL = 0x00a42b; -+ u8 ic_type = rtw_get_chip_type(adapter); -+ -+ u8 iot_peer = 0; -+ u8 wireless_mode = 0xFF; /* invalid value */ -+ u8 traffic_index; -+ u32 edca_param; -+ u64 cur_tx_bytes = 0; -+ u64 cur_rx_bytes = 0; -+ u8 bbtchange = _TRUE; -+ u8 is_bias_on_rx = _FALSE; -+ u8 is_linked = _FALSE; -+ u8 interface_type; -+ -+ if (hal_data->dis_turboedca == 1) -+ return; -+ -+ if (rtw_mi_check_status(adapter, MI_ASSOC)) -+ is_linked = _TRUE; -+ -+ if (is_linked != _TRUE) { -+ precvpriv->is_any_non_be_pkts = _FALSE; -+ return; -+ } -+ -+ if ((pregpriv->wifi_spec == 1)) { /* || (pmlmeinfo->HT_enable == 0)) */ -+ precvpriv->is_any_non_be_pkts = _FALSE; -+ return; -+ } -+ -+ interface_type = rtw_get_intf_type(adapter); -+ wireless_mode = pmlmeext->cur_wireless_mode; -+ -+ iot_peer = pmlmeinfo->assoc_AP_vendor; -+ -+ if (iot_peer >= HT_IOT_PEER_MAX) { -+ precvpriv->is_any_non_be_pkts = _FALSE; -+ return; -+ } -+ -+ if (ic_type == RTL8188E) { -+ if ((iot_peer == HT_IOT_PEER_RALINK) || (iot_peer == HT_IOT_PEER_ATHEROS)) -+ is_bias_on_rx = _TRUE; -+ } -+ -+ /* Check if the status needs to be changed. */ -+ if ((bbtchange) || (!precvpriv->is_any_non_be_pkts)) { -+ cur_tx_bytes = dvobj->traffic_stat.cur_tx_bytes; -+ cur_rx_bytes = dvobj->traffic_stat.cur_rx_bytes; -+ -+ /* traffic, TX or RX */ -+ if (is_bias_on_rx) { -+ if (cur_tx_bytes > (cur_rx_bytes << 2)) { -+ /* Uplink TP is present. */ -+ traffic_index = UP_LINK; -+ } else { -+ /* Balance TP is present. */ -+ traffic_index = DOWN_LINK; -+ } -+ } else { -+ if (cur_rx_bytes > (cur_tx_bytes << 2)) { -+ /* Downlink TP is present. */ -+ traffic_index = DOWN_LINK; -+ } else { -+ /* Balance TP is present. */ -+ traffic_index = UP_LINK; -+ } -+ } -+#if 0 -+ if ((p_dm_odm->dm_edca_table.prv_traffic_idx != traffic_index) -+ || (!p_dm_odm->dm_edca_table.is_current_turbo_edca)) -+#endif -+ { -+ if (interface_type == RTW_PCIE) { -+ EDCA_BE_UL = 0x6ea42b; -+ EDCA_BE_DL = 0x6ea42b; -+ } -+ -+ /* 92D txop can't be set to 0x3e for cisco1250 */ -+ if ((iot_peer == HT_IOT_PEER_CISCO) && (wireless_mode == ODM_WM_N24G)) { -+ EDCA_BE_DL = edca_setting_DL[iot_peer]; -+ EDCA_BE_UL = edca_setting_UL[iot_peer]; -+ } -+ /* merge from 92s_92c_merge temp*/ -+ else if ((iot_peer == HT_IOT_PEER_CISCO) && ((wireless_mode == ODM_WM_G) || (wireless_mode == (ODM_WM_B | ODM_WM_G)) || (wireless_mode == ODM_WM_A) || (wireless_mode == ODM_WM_B))) -+ EDCA_BE_DL = edca_setting_dl_g_mode[iot_peer]; -+ else if ((iot_peer == HT_IOT_PEER_AIRGO) && ((wireless_mode == ODM_WM_G) || (wireless_mode == 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.*/ -+ /* Suggested by SD3 Wilson for ASUS TP issue.*/ -+ EDCA_BE_DL = edca_setting_DL[iot_peer]; -+ } -+ -+ if ((ic_type == RTL8812) || (ic_type == RTL8821) || (ic_type == RTL8192E) || (ic_type == RTL8192F)) { /* add 8812AU/8812AE */ -+ EDCA_BE_UL = 0x5ea42b; -+ EDCA_BE_DL = 0x5ea42b; -+ -+ RTW_DBG("8812A: EDCA_BE_UL=0x%x EDCA_BE_DL =0x%x\n", EDCA_BE_UL, EDCA_BE_DL); -+ } -+ -+ if (interface_type == RTW_PCIE && -+ ((ic_type == RTL8822B) -+ || (ic_type == RTL8822C) -+ || (ic_type == RTL8814A) || (ic_type == RTL8814B))) { -+ EDCA_BE_UL = 0x6ea42b; -+ EDCA_BE_DL = 0x6ea42b; -+ } -+ -+ if ((ic_type == RTL8822B) -+ && (interface_type == RTW_SDIO)) -+ EDCA_BE_DL = 0x00431c; -+ -+#ifdef CONFIG_RTW_TPT_MODE -+ if ( dvobj->tpt_mode > 0 ) { -+ EDCA_BE_UL = dvobj->edca_be_ul; -+ EDCA_BE_DL = dvobj->edca_be_dl; -+ } -+#endif /* CONFIG_RTW_TPT_MODE */ -+ -+ /* keep this condition at last check */ -+ if (hal_data->dis_turboedca == 2) { -+ -+ if (hal_data->edca_param_mode < TURBO_EDCA_MODE_NUM) { -+ -+ struct turbo_edca_setting param; -+ -+ param = rtw_turbo_edca[hal_data->edca_param_mode]; -+ -+ EDCA_BE_UL = param.edca_ul; -+ EDCA_BE_DL = param.edca_dl; -+ -+ } else { -+ -+ EDCA_BE_UL = hal_data->edca_param_mode; -+ EDCA_BE_DL = hal_data->edca_param_mode; -+ } -+ } -+ -+ if (traffic_index == DOWN_LINK) -+ edca_param = EDCA_BE_DL; -+ else -+ edca_param = EDCA_BE_UL; -+ -+#ifdef CONFIG_EXTEND_LOWRATE_TXOP -+#define TXOP_CCK1M 0x01A6 -+#define TXOP_CCK2M 0x00E6 -+#define TXOP_CCK5M 0x006B -+#define TXOP_OFD6M 0x0066 -+#define TXOP_MCS6M 0x0061 -+{ -+ struct sta_info *psta; -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 mac_id, role, current_rate_id; -+ -+ /* search all used & connect2AP macid */ -+ for (mac_id = 0; mac_id < macid_ctl->num; mac_id++) { -+ if (rtw_macid_is_used(macid_ctl, mac_id)) { -+ role = GET_H2CCMD_MSRRPT_PARM_ROLE(&(macid_ctl->h2c_msr[mac_id])); -+ if (role != H2C_MSR_ROLE_AP) -+ continue; -+ -+ psta = macid_ctl->sta[mac_id]; -+ current_rate_id = rtw_get_current_tx_rate(adapter, psta); -+ /* Check init tx_rate==1M and set 0x508[31:16]==0x019B(unit 32us) if it is */ -+ switch (current_rate_id) { -+ case DESC_RATE1M: -+ edca_param &= 0x0000FFFF; -+ edca_param |= (TXOP_CCK1M<<16); -+ break; -+ case DESC_RATE2M: -+ edca_param &= 0x0000FFFF; -+ edca_param |= (TXOP_CCK2M<<16); -+ break; -+ case DESC_RATE5_5M: -+ edca_param &= 0x0000FFFF; -+ edca_param |= (TXOP_CCK5M<<16); -+ break; -+ case DESC_RATE6M: -+ edca_param &= 0x0000FFFF; -+ edca_param |= (TXOP_OFD6M<<16); -+ break; -+ case DESC_RATEMCS0: -+ edca_param &= 0x0000FFFF; -+ edca_param |= (TXOP_MCS6M<<16); -+ break; -+ default: -+ break; -+ } -+ } -+ } -+} -+#endif /* CONFIG_EXTEND_LOWRATE_TXOP */ -+ -+#ifdef CONFIG_RTW_CUSTOMIZE_BEEDCA -+ edca_param = CONFIG_RTW_CUSTOMIZE_BEEDCA; -+#endif -+ -+ if ( edca_param != hal_data->ac_param_be) { -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_AC_PARAM_BE, (u8 *)(&edca_param)); -+ -+ RTW_INFO("Turbo EDCA =0x%x\n", edca_param); -+ } -+ -+ hal_data->prv_traffic_idx = traffic_index; -+ } -+ -+ hal_data->is_turbo_edca = _TRUE; -+ } else { -+ /* */ -+ /* Turn Off EDCA turbo here. */ -+ /* Restore original EDCA according to the declaration of AP. */ -+ /* */ -+ if (hal_data->is_turbo_edca) { -+ edca_param = hal_data->ac_param_be; -+ rtw_hal_set_hwreg(adapter, HW_VAR_AC_PARAM_BE, (u8 *)(&edca_param)); -+ hal_data->is_turbo_edca = _FALSE; -+ } -+ } -+ -+} -+ -+s8 rtw_dm_get_min_rssi(_adapter *adapter) -+{ -+ struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); -+ struct sta_info *sta; -+ s8 min_rssi = 127, rssi; -+ int i; -+ -+ for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { -+ sta = macid_ctl->sta[i]; -+ if (!sta || !GET_H2CCMD_MSRRPT_PARM_OPMODE(macid_ctl->h2c_msr + i) -+ || is_broadcast_mac_addr(sta->cmn.mac_addr)) -+ continue; -+ rssi = sta->cmn.rssi_stat.rssi; -+ if (rssi >= 0 && min_rssi > rssi) -+ min_rssi = rssi; -+ } -+ -+ return min_rssi == 127 ? 0 : min_rssi; -+} -+ -+s8 rtw_phydm_get_min_rssi(_adapter *adapter) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ s8 rssi_min = 0; -+ -+ rssi_min = phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_RSSI_MIN); -+ return rssi_min; -+} -+ -+u8 rtw_phydm_get_cur_igi(_adapter *adapter) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ u8 cur_igi = 0; -+ -+ cur_igi = phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CURR_IGI); -+ return cur_igi; -+} -+ -+bool rtw_phydm_get_edcca_flag(_adapter *adapter) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ bool cur_edcca_flag = 0; -+ -+ cur_edcca_flag = phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_EDCCA_FLAG); -+ return cur_edcca_flag; -+} -+ -+u32 rtw_phydm_get_phy_cnt(_adapter *adapter, enum phy_cnt cnt) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ -+ if (cnt == FA_OFDM) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_FA_OFDM); -+ else if (cnt == FA_CCK) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_FA_CCK); -+ else if (cnt == FA_TOTAL) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_FA_TOTAL); -+ else if (cnt == CCA_OFDM) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CCA_OFDM); -+ else if (cnt == CCA_CCK) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CCA_CCK); -+ else if (cnt == CCA_ALL) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CCA_ALL); -+ else if (cnt == CRC32_OK_VHT) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_OK_VHT); -+ else if (cnt == CRC32_OK_HT) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_OK_HT); -+ else if (cnt == CRC32_OK_LEGACY) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_OK_LEGACY); -+ else if (cnt == CRC32_OK_CCK) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_OK_CCK); -+ else if (cnt == CRC32_ERROR_VHT) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_ERROR_VHT); -+ else if (cnt == CRC32_ERROR_HT) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_ERROR_HT); -+ else if (cnt == CRC32_ERROR_LEGACY) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_ERROR_LEGACY); -+ else if (cnt == CRC32_ERROR_CCK) -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_ERROR_CCK); -+ else -+ return 0; -+} -+ -+u8 rtw_phydm_is_iqk_in_progress(_adapter *adapter) -+{ -+ u8 rts = _FALSE; -+ struct dm_struct *podmpriv = adapter_to_phydm(adapter); -+ -+ odm_acquire_spin_lock(podmpriv, RT_IQK_SPINLOCK); -+ if (podmpriv->rf_calibrate_info.is_iqk_in_progress == _TRUE) { -+ RTW_ERR("IQK InProgress\n"); -+ rts = _TRUE; -+ } -+ odm_release_spin_lock(podmpriv, RT_IQK_SPINLOCK); -+ -+ return rts; -+} -+ -+void SetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ void *pValue1, -+ BOOLEAN bSet) -+{ -+ struct dm_struct *podmpriv = adapter_to_phydm(Adapter); -+ /* _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->cmn.mac_id); -+ psta->cmn.dm_ctrl = STA_DM_CTRL_ACTIVE; -+ phydm_cmn_sta_info_hook(podmpriv, psta->cmn.mac_id, &(psta->cmn)); -+ } else { -+ RTW_INFO("### Clean STA_(%d) info ###\n", psta->cmn.mac_id); -+ /* _enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ -+ psta->cmn.dm_ctrl = 0; -+ phydm_cmn_sta_info_hook(podmpriv, psta->cmn.mac_id, NULL); -+ -+ /* _exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ -+ } -+ } -+ break; -+ case HAL_ODM_P2P_STATE: -+ odm_cmn_info_update(podmpriv, ODM_CMNINFO_WIFI_DIRECT, bSet); -+ break; -+ case HAL_ODM_WIFI_DISPLAY_STATE: -+ odm_cmn_info_update(podmpriv, ODM_CMNINFO_WIFI_DISPLAY, bSet); -+ break; -+ 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->backup_ig_value);*/ -+ odm_pause_dig(podmpriv, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, rx_gain); -+ } else { -+ /*pDigTable->backup_ig_value = pDigTable->cur_ig_value;*/ -+ /*odm_write_dig(podmpriv,rx_gain);*/ -+ odm_pause_dig(podmpriv, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, rx_gain); -+ } -+ } -+ break; -+ case HAL_ODM_RX_INFO_DUMP: { -+ u8 cur_igi = 0; -+ s8 rssi_min; -+ void *sel; -+ -+ sel = pValue1; -+ cur_igi = rtw_phydm_get_cur_igi(Adapter); -+ rssi_min = rtw_phydm_get_min_rssi(Adapter); -+ -+ _RTW_PRINT_SEL(sel, "============ Rx Info dump ===================\n"); -+ _RTW_PRINT_SEL(sel, "is_linked = %d, rssi_min = %d(%%)(%d(%%)), current_igi = 0x%x\n" -+ , podmpriv->is_linked, rssi_min, rtw_dm_get_min_rssi(Adapter), cur_igi); -+ _RTW_PRINT_SEL(sel, "cnt_cck_fail = %d, cnt_ofdm_fail = %d, Total False Alarm = %d\n", -+ rtw_phydm_get_phy_cnt(Adapter, FA_CCK), -+ rtw_phydm_get_phy_cnt(Adapter, FA_OFDM), -+ rtw_phydm_get_phy_cnt(Adapter, FA_TOTAL)); -+ -+ if (podmpriv->is_linked) { -+ _RTW_PRINT_SEL(sel, "rx_rate = %s", HDATA_RATE(podmpriv->rx_rate)); -+ if (IS_HARDWARE_TYPE_8814A(Adapter)) -+ _RTW_PRINT_SEL(sel, " rssi_a = %d(%%), rssi_b = %d(%%), rssi_c = %d(%%), rssi_d = %d(%%)\n", -+ podmpriv->rssi_a, podmpriv->rssi_b, podmpriv->rssi_c, podmpriv->rssi_d); -+ else -+ _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_ANTENNA_DIVERSITY -+ case HAL_ODM_ANTDIV_SELECT: { -+ u8 antenna = (*(u8 *)pValue1); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ /*switch antenna*/ -+ odm_update_rx_idle_ant(&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, -+ void *pValue1, -+ void *pValue2) -+{ -+ struct dm_struct *podmpriv = adapter_to_phydm(Adapter); -+ -+ switch (eVariable) { -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ case HAL_ODM_ANTDIV_SELECT: { -+ struct phydm_fat_struct *pDM_FatTable = &podmpriv->dm_fat_table; -+ *((u8 *)pValue1) = pDM_FatTable->rx_idle_ant; -+ } -+ break; -+#endif -+ case HAL_ODM_INITIAL_GAIN: -+ *((u8 *)pValue1) = rtw_phydm_get_cur_igi(Adapter); -+ break; -+ default: -+ break; -+ } -+} -+ -+#ifdef RTW_HALMAC -+#include "../hal_halmac.h" -+#endif -+bool rtw_phydm_rfe_ctrl_gpio( -+ _adapter *adapter, -+ u8 gpio_num -+) -+{ -+ #ifdef RTW_HALMAC -+ if(rtw_halmac_rfe_ctrl_cfg(adapter_to_dvobj(adapter), gpio_num)) -+ return _TRUE; -+ else -+ #endif/*RTW_HALMAC*/ -+ return _FALSE; -+} -+ -+enum hal_status -+rtw_phydm_fw_iqk( -+ struct dm_struct *p_dm_odm, -+ u8 clear, -+ u8 segment -+) -+{ -+ #ifdef RTW_HALMAC -+ struct _ADAPTER *adapter = p_dm_odm->adapter; -+ -+ if (rtw_halmac_iqk(adapter_to_dvobj(adapter), clear, segment) == 0) -+ return HAL_STATUS_SUCCESS; -+ #endif -+ return HAL_STATUS_FAILURE; -+} -+ -+enum hal_status -+rtw_phydm_cfg_phy_para( -+ struct dm_struct *p_dm_odm, -+ enum phydm_halmac_param config_type, -+ u32 offset, -+ u32 data, -+ u32 mask, -+ enum rf_path e_rf_path, -+ u32 delay_time) -+{ -+ #ifdef RTW_HALMAC -+ struct _ADAPTER *adapter = p_dm_odm->adapter; -+ struct rtw_phy_parameter para; -+ -+ switch (config_type) { -+ case PHYDM_HALMAC_CMD_MAC_W8: -+ para.cmd = 0; /* MAC register */ -+ para.data.mac.offset = offset; -+ para.data.mac.value = data; -+ para.data.mac.msk = mask; -+ para.data.mac.msk_en = (mask) ? 1 : 0; -+ para.data.mac.size = 1; -+ break; -+ case PHYDM_HALMAC_CMD_MAC_W16: -+ para.cmd = 0; /* MAC register */ -+ para.data.mac.offset = offset; -+ para.data.mac.value = data; -+ para.data.mac.msk = mask; -+ para.data.mac.msk_en = (mask) ? 1 : 0; -+ para.data.mac.size = 2; -+ break; -+ case PHYDM_HALMAC_CMD_MAC_W32: -+ para.cmd = 0; /* MAC register */ -+ para.data.mac.offset = offset; -+ para.data.mac.value = data; -+ para.data.mac.msk = mask; -+ para.data.mac.msk_en = (mask) ? 1 : 0; -+ para.data.mac.size = 4; -+ break; -+ case PHYDM_HALMAC_CMD_BB_W8: -+ para.cmd = 1; /* BB register */ -+ para.data.bb.offset = offset; -+ para.data.bb.value = data; -+ para.data.bb.msk = mask; -+ para.data.bb.msk_en = (mask) ? 1 : 0; -+ para.data.bb.size = 1; -+ break; -+ case PHYDM_HALMAC_CMD_BB_W16: -+ para.cmd = 1; /* BB register */ -+ para.data.bb.offset = offset; -+ para.data.bb.value = data; -+ para.data.bb.msk = mask; -+ para.data.bb.msk_en = (mask) ? 1 : 0; -+ para.data.bb.size = 2; -+ break; -+ case PHYDM_HALMAC_CMD_BB_W32: -+ para.cmd = 1; /* BB register */ -+ para.data.bb.offset = offset; -+ para.data.bb.value = data; -+ para.data.bb.msk = mask; -+ para.data.bb.msk_en = (mask) ? 1 : 0; -+ para.data.bb.size = 4; -+ break; -+ case PHYDM_HALMAC_CMD_RF_W: -+ para.cmd = 2; /* RF register */ -+ para.data.rf.offset = offset; -+ para.data.rf.value = data; -+ para.data.rf.msk = mask; -+ para.data.rf.msk_en = (mask) ? 1 : 0; -+ if (e_rf_path == RF_PATH_A) -+ para.data.rf.path = 0; -+ else if (e_rf_path == RF_PATH_B) -+ para.data.rf.path = 1; -+ else if (e_rf_path == RF_PATH_C) -+ para.data.rf.path = 2; -+ else if (e_rf_path == RF_PATH_D) -+ para.data.rf.path = 3; -+ else -+ para.data.rf.path = 0; -+ break; -+ case PHYDM_HALMAC_CMD_DELAY_US: -+ para.cmd = 3; /* Delay */ -+ para.data.delay.unit = 0; /* microsecond */ -+ para.data.delay.value = delay_time; -+ break; -+ case PHYDM_HALMAC_CMD_DELAY_MS: -+ para.cmd = 3; /* Delay */ -+ para.data.delay.unit = 1; /* millisecond */ -+ para.data.delay.value = delay_time; -+ break; -+ case PHYDM_HALMAC_CMD_END: -+ para.cmd = 0xFF; /* End command */ -+ break; -+ default: -+ return HAL_STATUS_FAILURE; -+ } -+ -+ if (rtw_halmac_cfg_phy_para(adapter_to_dvobj(adapter), ¶)) -+ return HAL_STATUS_FAILURE; -+ #endif /*RTW_HALMAC*/ -+ return HAL_STATUS_SUCCESS; -+} -+ -+ -+#ifdef CONFIG_LPS_LCLK_WD_TIMER -+void rtw_phydm_wd_lps_lclk_hdl(_adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta = NULL; -+ bool is_linked = _FALSE; -+ -+ if (!rtw_is_hw_init_completed(adapter)) -+ return; -+ -+ if (rtw_mi_check_status(adapter, MI_ASSOC)) -+ is_linked = _TRUE; -+ -+ if (is_linked == _FALSE) -+ return; -+ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) -+ return; -+ -+ odm_cmn_info_update(&pHalData->odmpriv, ODM_CMNINFO_LINK, is_linked); -+ -+ phydm_watchdog_lps_32k(&pHalData->odmpriv); -+ -+#ifdef CONFIG_LPS_PG -+ if (pwrpriv->lps_level == LPS_PG) { -+ if (rtw_hal_set_lps_pg_info_cmd(adapter) == _FAIL) -+ RTW_INFO(FUNC_ADPT_FMT": Send PG H2C command Fail! \n", -+ FUNC_ADPT_ARG(adapter)); -+ } -+#endif /* CONFIG_LPS_PG */ -+} -+ -+void rtw_phydm_watchdog_in_lps_lclk(_adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ u8 cur_igi = 0; -+ s8 min_rssi = 0; -+ -+ if (!rtw_is_hw_init_completed(adapter)) -+ return; -+ -+ cur_igi = rtw_phydm_get_cur_igi(adapter); -+ min_rssi = rtw_dm_get_min_rssi(adapter); -+ /*RTW_INFO("%s "ADPT_FMT" cur_ig_value=%d, min_rssi = %d\n", __func__, ADPT_ARG(adapter), cur_igi, min_rssi);*/ -+ -+ if (min_rssi <= 0) -+ return; -+ -+ if ((cur_igi > min_rssi + 5) || -+ (cur_igi < min_rssi - 5)) { -+#ifdef CONFIG_LPS -+ rtw_dm_in_lps_wk_cmd(adapter); -+#endif -+ } -+} -+#endif /*CONFIG_LPS_LCLK_WD_TIMER*/ -+ -+void dump_sta_traffic(void *sel, _adapter *adapter, struct sta_info *psta) -+{ -+ struct ra_sta_info *ra_info; -+ u8 curr_sgi = _FALSE; -+ u32 tx_tp_mbips, rx_tp_mbips, bi_tp_mbips; -+ -+ if (!psta) -+ return; -+ RTW_PRINT_SEL(sel, "\n"); -+ RTW_PRINT_SEL(sel, "====== mac_id : %d [" MAC_FMT "] ======\n", -+ psta->cmn.mac_id, MAC_ARG(psta->cmn.mac_addr)); -+ -+ if (is_client_associated_to_ap(psta->padapter)) -+ RTW_PRINT_SEL(sel, "BCN counts : %d (per-%d second), DTIM Period:%d\n", -+ rtw_get_bcn_cnt(psta->padapter) / 2, 1, rtw_get_bcn_dtim_period(psta->padapter)); -+ -+ ra_info = &psta->cmn.ra_info; -+ curr_sgi = rtw_get_current_tx_sgi(adapter, psta); -+ RTW_PRINT_SEL(sel, "tx_rate : %s(%s) rx_rate : %s, rx_rate_bmc : %s, rssi : %d %%\n" -+ , HDATA_RATE(rtw_get_current_tx_rate(adapter, psta)), (curr_sgi) ? "S" : "L" -+ , HDATA_RATE((psta->curr_rx_rate & 0x7F)), HDATA_RATE((psta->curr_rx_rate_bmc & 0x7F)), psta->cmn.rssi_stat.rssi -+ ); -+ -+ if (0) { -+ RTW_PRINT_SEL(sel, "tx_bytes:%llu(%llu - %llu)\n" -+ , psta->sta_stats.tx_bytes - psta->sta_stats.last_tx_bytes -+ , psta->sta_stats.tx_bytes, psta->sta_stats.last_tx_bytes -+ ); -+ RTW_PRINT_SEL(sel, "rx_uc_bytes:%llu(%llu - %llu)\n" -+ , sta_rx_uc_bytes(psta) - sta_last_rx_uc_bytes(psta) -+ , sta_rx_uc_bytes(psta), sta_last_rx_uc_bytes(psta) -+ ); -+ RTW_PRINT_SEL(sel, "rx_mc_bytes:%llu(%llu - %llu)\n" -+ , psta->sta_stats.rx_mc_bytes - psta->sta_stats.last_rx_mc_bytes -+ , psta->sta_stats.rx_mc_bytes, psta->sta_stats.last_rx_mc_bytes -+ ); -+ RTW_PRINT_SEL(sel, "rx_bc_bytes:%llu(%llu - %llu)\n" -+ , psta->sta_stats.rx_bc_bytes - psta->sta_stats.last_rx_bc_bytes -+ , psta->sta_stats.rx_bc_bytes, psta->sta_stats.last_rx_bc_bytes -+ ); -+ } -+ -+ _RTW_PRINT_SEL(sel, "RTW: [TP] "); -+ tx_tp_mbips = psta->sta_stats.tx_tp_kbits >> 10; -+ rx_tp_mbips = psta->sta_stats.rx_tp_kbits >> 10; -+ bi_tp_mbips = tx_tp_mbips + rx_tp_mbips; -+ -+ if (tx_tp_mbips) -+ _RTW_PRINT_SEL(sel, "Tx : %d(Mbps) ", tx_tp_mbips); -+ else -+ _RTW_PRINT_SEL(sel, "Tx : %d(Kbps) ", psta->sta_stats.tx_tp_kbits); -+ -+ if (rx_tp_mbips) -+ _RTW_PRINT_SEL(sel, "Rx : %d(Mbps) ", rx_tp_mbips); -+ else -+ _RTW_PRINT_SEL(sel, "Rx : %d(Kbps) ", psta->sta_stats.rx_tp_kbits); -+ -+ if (bi_tp_mbips) -+ _RTW_PRINT_SEL(sel, "Total : %d(Mbps)\n", bi_tp_mbips); -+ else -+ _RTW_PRINT_SEL(sel, "Total : %d(Kbps)\n", psta->sta_stats.tx_tp_kbits + psta->sta_stats.rx_tp_kbits); -+ -+ -+ _RTW_PRINT_SEL(sel, "RTW: [Smooth TP] "); -+ tx_tp_mbips = psta->sta_stats.smooth_tx_tp_kbits >> 10; -+ rx_tp_mbips = psta->sta_stats.smooth_rx_tp_kbits >> 10; -+ bi_tp_mbips = tx_tp_mbips + rx_tp_mbips; -+ if (tx_tp_mbips) -+ _RTW_PRINT_SEL(sel, "Tx : %d(Mbps) ", tx_tp_mbips); -+ else -+ _RTW_PRINT_SEL(sel, "Tx : %d(Kbps) ", psta->sta_stats.smooth_tx_tp_kbits); -+ -+ if (rx_tp_mbips) -+ _RTW_PRINT_SEL(sel, "Rx : %d(Mbps) ", rx_tp_mbips); -+ else -+ _RTW_PRINT_SEL(sel, "Rx : %d(Kbps) ", psta->sta_stats.smooth_rx_tp_kbits); -+ -+ if (bi_tp_mbips) -+ _RTW_PRINT_SEL(sel, "Total : %d(Mbps)\n", bi_tp_mbips); -+ else -+ _RTW_PRINT_SEL(sel, "Total : %d(Kbps)\n", psta->sta_stats.smooth_tx_tp_kbits + psta->sta_stats.rx_tp_kbits); -+ -+ #if 0 -+ RTW_PRINT_SEL(sel, "Moving-AVG TP {Tx,Rx,Total} = { %d , %d , %d } Mbps\n\n", -+ (psta->cmn.tx_moving_average_tp << 3), (psta->cmn.rx_moving_average_tp << 3), -+ (psta->cmn.tx_moving_average_tp + psta->cmn.rx_moving_average_tp) << 3); -+ #endif -+} -+ -+void dump_sta_info(void *sel, struct sta_info *psta) -+{ -+ struct ra_sta_info *ra_info; -+ u8 curr_tx_sgi = _FALSE; -+ u8 curr_tx_rate = 0; -+ -+ if (!psta) -+ return; -+ -+ ra_info = &psta->cmn.ra_info; -+ -+ RTW_PRINT_SEL(sel, "============ STA [" MAC_FMT "] ===================\n", -+ MAC_ARG(psta->cmn.mac_addr)); -+ RTW_PRINT_SEL(sel, "mac_id : %d\n", psta->cmn.mac_id); -+ RTW_PRINT_SEL(sel, "wireless_mode : 0x%02x\n", psta->wireless_mode); -+ RTW_PRINT_SEL(sel, "mimo_type : %d\n", psta->cmn.mimo_type); -+ RTW_PRINT_SEL(sel, "static smps : %s\n", (psta->cmn.sm_ps == SM_PS_STATIC) ? "Y" : "N"); -+ RTW_PRINT_SEL(sel, "bw_mode : %s, ra_bw_mode : %s\n", -+ ch_width_str(psta->cmn.bw_mode), ch_width_str(ra_info->ra_bw_mode)); -+ RTW_PRINT_SEL(sel, "rate_id : %d\n", ra_info->rate_id); -+ RTW_PRINT_SEL(sel, "rssi : %d (%%), rssi_level : %d\n", psta->cmn.rssi_stat.rssi, ra_info->rssi_level); -+ RTW_PRINT_SEL(sel, "is_support_sgi : %s, is_vht_enable : %s\n", -+ (ra_info->is_support_sgi) ? "Y" : "N", (ra_info->is_vht_enable) ? "Y" : "N"); -+ RTW_PRINT_SEL(sel, "disable_ra : %s, disable_pt : %s\n", -+ (ra_info->disable_ra) ? "Y" : "N", (ra_info->disable_pt) ? "Y" : "N"); -+ RTW_PRINT_SEL(sel, "is_noisy : %s\n", (ra_info->is_noisy) ? "Y" : "N"); -+ RTW_PRINT_SEL(sel, "txrx_state : %d\n", ra_info->txrx_state);/*0: uplink, 1:downlink, 2:bi-direction*/ -+ -+ curr_tx_sgi = rtw_get_current_tx_sgi(psta->padapter, psta); -+ curr_tx_rate = rtw_get_current_tx_rate(psta->padapter, psta); -+ RTW_PRINT_SEL(sel, "curr_tx_rate : %s (%s)\n", -+ HDATA_RATE(curr_tx_rate), (curr_tx_sgi) ? "S" : "L"); -+ RTW_PRINT_SEL(sel, "curr_tx_bw : %s\n", ch_width_str(ra_info->curr_tx_bw)); -+ RTW_PRINT_SEL(sel, "curr_retry_ratio : %d\n", ra_info->curr_retry_ratio); -+ RTW_PRINT_SEL(sel, "ra_mask : 0x%016llx\n\n", ra_info->ramask); -+} -+ -+void rtw_phydm_ra_registed(_adapter *adapter, struct sta_info *psta) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ -+ if (psta == NULL) { -+ RTW_ERR(FUNC_ADPT_FMT" sta is NULL\n", FUNC_ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ if (psta->cmn.mac_id >= macid_ctl->num) -+ return; -+ -+ phydm_ra_registed(&hal_data->odmpriv, psta->cmn.mac_id, psta->cmn.rssi_stat.rssi); -+ dump_sta_info(RTW_DBGDUMP, psta); -+} -+ -+static void init_phydm_info(_adapter *adapter) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ struct dm_struct *phydm = &(hal_data->odmpriv); -+ -+ odm_cmn_info_init(phydm, ODM_CMNINFO_FW_VER, hal_data->firmware_version); -+ odm_cmn_info_init(phydm, ODM_CMNINFO_FW_SUB_VER, hal_data->firmware_sub_version); -+} -+ -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+void rtw_phydm_trx_cfg(_adapter *adapter, bool tx_1ss) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ enum bb_path txpath = BB_PATH_AB; -+ enum bb_path rxpath = BB_PATH_AB; -+ /*is_2tx = _FALSE for 8822B, or BB_PATH_AUTO for PATH_DIVERSITY for 8822B*/ -+ enum bb_path txpath_1ss = BB_PATH_A; -+ -+ rtw_hal_get_trx_path(adapter_to_dvobj(adapter), NULL, &txpath, &rxpath); -+ txpath = (tx_1ss) ? BB_PATH_A : txpath; -+ -+ if (phydm_api_trx_mode(adapter_to_phydm(adapter), txpath, rxpath, txpath_1ss) == FALSE) -+ RTW_ERR("%s failed\n", __func__); -+} -+#endif -+ -+u8 rtw_hal_runtime_trx_path_decision(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ enum bb_path txpath; -+ enum bb_path rxpath; -+ int i; -+ u8 rst = _FAIL; -+ -+ rtw_hal_get_trx_path(adapter_to_dvobj(adapter), NULL, &txpath, &rxpath); -+ if (!txpath) { -+ RTW_ERR("%s tx_path_bmp is empty\n", __func__); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ if (!rxpath) { -+ RTW_ERR("%s rx_path_bmp is empty\n", __func__); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ tx_path_nss_set_default(hal_data->txpath_nss, hal_data->txpath_num_nss -+ , GET_HAL_TX_PATH_BMP(adapter)); -+ -+#if defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8822B) ||defined(CONFIG_RTL8822C) -+{ -+ enum bb_path txpath_1ss; -+ -+ if (txpath == BB_PATH_AB) { -+ switch (hal_data->max_tx_cnt) { -+ case 2: -+ #ifdef CONFIG_RTW_TX_NPATH_EN -+ if (adapter->registrypriv.tx_npath == 1) -+ txpath_1ss = BB_PATH_AB; -+ else -+ #endif -+ #ifdef CONFIG_RTW_PATH_DIV -+ if (adapter->registrypriv.path_div == 1) /* path diversity, support 2sts TX */ -+ txpath_1ss = BB_PATH_AUTO; -+ else -+ #endif -+ txpath_1ss = BB_PATH_A; -+ break; -+ case 1: -+ #ifdef CONFIG_RTW_PATH_DIV -+ if (adapter->registrypriv.path_div == 1) /* path diversity, no support 2sts TX */ -+ txpath = txpath_1ss = BB_PATH_AUTO; -+ else -+ #endif -+ txpath = txpath_1ss = BB_PATH_A; -+ break; -+ default: -+ RTW_ERR("%s invalid max_tx_cnt:%u\n", __func__ -+ , hal_data->max_tx_cnt); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ } else -+ txpath_1ss = txpath; -+ -+ if (hal_data->txpath_nss[0] != txpath_1ss) { -+ hal_data->txpath_nss[0] = txpath_1ss; -+ if (txpath_1ss == BB_PATH_AUTO) -+ hal_data->txpath_num_nss[0] = 1; -+ else { -+ hal_data->txpath_num_nss[0] = 0; -+ for (i = 0; i < RF_PATH_MAX; i++) { -+ if (txpath_1ss & BIT(i)) -+ hal_data->txpath_num_nss[0]++; -+ } -+ } -+ } -+} -+#elif defined(CONFIG_RTL8814B) -+{ -+ /* 8814B is always full-TX */ -+ tx_path_nss_set_full_tx(hal_data->txpath_nss, hal_data->txpath_num_nss, txpath); -+} -+#elif defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8192E) -+{ -+ #ifdef CONFIG_RTW_TX_NPATH_EN -+ if (adapter->registrypriv.tx_npath == 1) -+ tx_path_nss_set_full_tx(hal_data->txpath_nss, hal_data->txpath_num_nss, txpath); -+ #endif -+} -+#endif -+ -+ hal_data->txpath = txpath; -+ hal_data->rxpath = rxpath; -+ dump_hal_runtime_trx_mode(RTW_DBGDUMP, adapter); -+ rst = _SUCCESS; -+ -+exit: -+ return rst; -+} -+ -+/* -+* trx_mode init - 8822B / 8822C / 8192F -+* 1ssNTx - 8192E / 8812A / 8822B / 8822C / 8192F -+* Path-diversity - 8822B / 8822C / 8192F -+* PHYDM API - phydm_api_trx_mode -+*/ -+static u8 rtw_phydm_config_trx_path(_adapter *adapter) -+{ -+ u8 rst = _SUCCESS; -+ -+#if defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8822B) ||defined(CONFIG_RTL8822C) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ enum bb_path txpath = hal_data->txpath; -+ enum bb_path rxpath = hal_data->rxpath; -+ enum bb_path txpath_1ss = hal_data->txpath_nss[0]; -+ -+ if (phydm_api_trx_mode(adapter_to_phydm(adapter), txpath, rxpath, txpath_1ss) == FALSE) { -+ RTW_ERR("%s txpath=0x%x, rxpath=0x%x, txpath_1ss=0x%x fail\n", __func__ -+ , txpath, rxpath, txpath_1ss); -+ rtw_warn_on(1); -+ rst = _FAIL; -+ } -+} -+#elif defined(CONFIG_RTL8814B) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ enum bb_path txpath = hal_data->txpath; -+ enum bb_path rxpath = hal_data->rxpath; -+ -+ if (txpath == BB_PATH_ABCD && rxpath == BB_PATH_ABCD) -+ rst = config_phydm_trx_mode_8814b(adapter_to_phydm(adapter), txpath, rxpath); -+ else -+ rst = config_phydm_trx_mode_ext_8814b(adapter_to_phydm(adapter), txpath, -+ rxpath, -+ txpath, txpath, txpath); -+ if (rst == FALSE) { -+ RTW_ERR("%s txpath=0x%x, rxpath=0x%x fail\n", __func__ -+ , txpath, rxpath); -+ rtw_warn_on(1); -+ rst = _FAIL; -+ } -+} -+#elif defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8192E) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ if (hal_data->txpath_num_nss[0] == 2) -+ phydm_tx_2path(adapter_to_phydm(adapter)); -+} -+#endif -+ -+ return rst; -+} -+ -+void rtw_phydm_init(_adapter *adapter) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ struct dm_struct *phydm = &(hal_data->odmpriv); -+ -+ rtw_phydm_config_trx_path(adapter); -+ init_phydm_info(adapter); -+ hal_data->phydm_init_result = odm_dm_init(phydm); -+ -+#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA -+ phydm_pathb_q_matrix_rotate_en(phydm); -+#endif -+} -+ -+bool rtw_phydm_set_crystal_cap(_adapter *adapter, u8 crystal_cap) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ struct dm_struct *phydm = &(hal_data->odmpriv); -+ -+ return phydm_set_crystal_cap_reg(phydm, crystal_cap); -+} -+ -+#ifdef CONFIG_LPS_PG -+/* -+static void _lps_pg_state_update(_adapter *adapter) -+{ -+ u8 is_in_lpspg = _FALSE; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta = NULL; -+ -+ if ((pwrpriv->lps_level == LPS_PG) && (pwrpriv->pwr_mode != PS_MODE_ACTIVE) && (pwrpriv->rpwm <= PS_STATE_S2)) -+ is_in_lpspg = _TRUE; -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ -+ if (psta) -+ psta->cmn.ra_info.disable_ra = (is_in_lpspg) ? _TRUE : _FALSE; -+} -+*/ -+void rtw_phydm_lps_pg_hdl(_adapter *adapter, struct sta_info *sta, bool in_lpspg) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ /*u8 rate_id;*/ -+ -+ if(sta == NULL) { -+ RTW_ERR("%s sta is null\n", __func__); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ if (in_lpspg) { -+ sta->cmn.ra_info.disable_ra = _TRUE; -+ sta->cmn.ra_info.disable_pt = _TRUE; -+ /*TODO : DRV fix tx rate*/ -+ /*rate_id = phydm_get_rate_from_rssi_lv(phydm, sta->cmn.mac_id);*/ -+ } else { -+ sta->cmn.ra_info.disable_ra = _FALSE; -+ sta->cmn.ra_info.disable_pt = _FALSE; -+ } -+ -+ rtw_phydm_ra_registed(adapter, sta); -+} -+#endif -+ -+/*#define DBG_PHYDM_STATE_CHK*/ -+ -+ -+static u8 _rtw_phydm_rfk_condition_check(_adapter *adapter, u8 is_scaning, u8 ifs_linked) -+{ -+ u8 rfk_allowed = _TRUE; -+ -+ #ifdef CONFIG_SKIP_RFK_IN_DM -+ rfk_allowed = _FALSE; -+ if (0) -+ RTW_ERR("[RFK-CHK] RF-K not allowed due to CONFIG_SKIP_RFK_IN_DM\n"); -+ return rfk_allowed; -+ #endif -+ -+ #ifdef CONFIG_MCC_MODE -+ /*not in MCC State*/ -+ if (MCC_EN(adapter) && -+ rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { -+ rfk_allowed = _FALSE; -+ if (0) -+ RTW_INFO("[RFK-CHK] RF-K not allowed due to doing MCC\n"); -+ return rfk_allowed; -+ } -+ #endif -+ -+ #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) -+ -+ #endif -+ -+ if (ifs_linked) { -+ if (is_scaning) { -+ rfk_allowed = _FALSE; -+ RTW_DBG("[RFK-CHK] RF-K not allowed due to ifaces under site-survey\n"); -+ } -+ else { -+ rfk_allowed = rtw_mi_stayin_union_ch_chk(adapter) ? _TRUE : _FALSE; -+ if (rfk_allowed == _FALSE) -+ RTW_ERR("[RFK-CHK] RF-K not allowed due to ld_iface not stayin union ch\n"); -+ } -+ } -+ -+ return rfk_allowed; -+} -+ -+#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1)) -+static u8 _rtw_phydm_iqk_segment_chk(_adapter *adapter, u8 ifs_linked) -+{ -+ u8 iqk_sgt = _FALSE; -+ -+#if 0 -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ if (ifs_linked && (dvobj->traffic_stat.cur_tx_tp > 2 || dvobj->traffic_stat.cur_rx_tp > 2)) -+ rst = _TRUE; -+#else -+ if (ifs_linked) -+ iqk_sgt = _TRUE; -+#endif -+ return iqk_sgt; -+} -+#endif -+ -+/*check the tx low rate while unlinked to any AP;for pwr tracking */ -+static u8 _rtw_phydm_pwr_tracking_rate_check(_adapter *adapter) -+{ -+ int i; -+ _adapter *iface; -+ u8 if_tx_rate = 0xFF; -+ u8 tx_rate = 0xFF; -+ struct mlme_ext_priv *pmlmeext = NULL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ pmlmeext = &(iface->mlmeextpriv); -+ if ((iface) && rtw_is_adapter_up(iface)) { -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_role(&(iface)->wdinfo, P2P_ROLE_DISABLE)) -+ if_tx_rate = IEEE80211_OFDM_RATE_6MB; -+ else -+#endif -+ if_tx_rate = pmlmeext->tx_rate; -+ -+ if (if_tx_rate < tx_rate) { -+ /*5G limit ofdm rate*/ -+ if (pHalData->current_channel > 14) { -+ if (!IS_CCK_RATE(if_tx_rate)) -+ tx_rate = if_tx_rate; -+ } else { -+ tx_rate = if_tx_rate; -+ } -+ } -+ RTW_DBG("%s i=%d if_tx_rate =0x%x\n", __func__, i, if_tx_rate); -+ } -+ } -+ -+ /*suggest by RF James,unlinked setting ofdm rate*/ -+ if (tx_rate == 0xFF) -+ tx_rate = IEEE80211_OFDM_RATE_6MB; -+ -+ RTW_DBG("%s tx_low_rate (unlinked to any AP)=0x%x\n", __func__, tx_rate); -+ return tx_rate; -+} -+ -+#ifdef CONFIG_DYNAMIC_SOML -+void rtw_dyn_soml_byte_update(_adapter *adapter, u8 data_rate, u32 size) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ -+ phydm_soml_bytes_acq(phydm, data_rate, size); -+} -+ -+void rtw_dyn_soml_para_set(_adapter *adapter, u8 train_num, u8 intvl, -+ u8 period, u8 delay) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ -+ phydm_adaptive_soml_para_set(phydm, train_num, intvl, period, delay); -+ RTW_INFO("%s.\n", __func__); -+} -+ -+void rtw_dyn_soml_config(_adapter *adapter) -+{ -+ RTW_INFO("%s.\n", __func__); -+ -+ if (adapter->registrypriv.dyn_soml_en == 1) { -+ /* Must after phydm_adaptive_soml_init() */ -+ rtw_hal_set_hwreg(adapter , HW_VAR_SET_SOML_PARAM , NULL); -+ RTW_INFO("dyn_soml_en = 1\n"); -+ } else { -+ if (adapter->registrypriv.dyn_soml_en == 2) { -+ rtw_dyn_soml_para_set(adapter, -+ adapter->registrypriv.dyn_soml_train_num, -+ adapter->registrypriv.dyn_soml_interval, -+ adapter->registrypriv.dyn_soml_period, -+ adapter->registrypriv.dyn_soml_delay); -+ RTW_INFO("dyn_soml_en = 2\n"); -+ RTW_INFO("dyn_soml_en, param = %d, %d, %d, %d\n", -+ adapter->registrypriv.dyn_soml_train_num, -+ adapter->registrypriv.dyn_soml_interval, -+ adapter->registrypriv.dyn_soml_period, -+ adapter->registrypriv.dyn_soml_delay); -+ } else if (adapter->registrypriv.dyn_soml_en == 0) { -+ RTW_INFO("dyn_soml_en = 0\n"); -+ } else -+ RTW_ERR("%s, wrong setting: dyn_soml_en = %d\n", __func__, -+ adapter->registrypriv.dyn_soml_en); -+ } -+} -+#endif -+ -+void rtw_phydm_set_rrsr(_adapter *adapter, u32 rrsr_value, bool write_rrsr) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ u32 temp_rrsr =0xFFFFFFFF; -+ -+ if (adapter->registrypriv.set_rrsr_value != 0xFFFFFFFF) -+ temp_rrsr = adapter->registrypriv.set_rrsr_value; -+ else -+ temp_rrsr = rrsr_value; -+ -+ odm_cmn_info_update(phydm, ODM_CMNINFO_RRSR_VAL, temp_rrsr); -+ if(write_rrsr) -+ phydm_rrsr_set_register(phydm, temp_rrsr); -+} -+void rtw_phydm_dyn_rrsr_en(_adapter *adapter, bool en_rrsr) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ -+ phydm_rrsr_en(phydm, en_rrsr); -+} -+void rtw_phydm_read_efuse(_adapter *adapter) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ struct dm_struct *phydm = &(hal_data->odmpriv); -+ -+ /*PHYDM API - thermal trim*/ -+ phydm_get_thermal_trim_offset(phydm); -+ /*PHYDM API - power trim*/ -+ phydm_get_power_trim_offset(phydm); -+} -+ -+#ifdef CONFIG_LPS_PWR_TRACKING -+void rtw_phydm_pwr_tracking_directly(_adapter *adapter) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ u8 rfk_forbidden = _TRUE; -+ u8 is_linked = _FALSE; -+ -+ if (rtw_mi_check_status(adapter, MI_ASSOC)) -+ is_linked = _TRUE; -+ -+ rfk_forbidden = (_rtw_phydm_rfk_condition_check(adapter, hal_data->bScanInProcess, is_linked) == _TRUE) ? _FALSE : _TRUE; -+ halrf_cmn_info_set(&hal_data->odmpriv, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); -+ -+ odm_txpowertracking_direct_ce(&hal_data->odmpriv); -+} -+#endif -+ -+void rtw_phydm_update_ap_vendor_ie(_adapter *adapter) -+{ -+ u8 i; -+ _adapter *iface; -+ struct mlme_ext_priv *pmlmeext ; -+ struct mlme_ext_info *pmlmeinfo ; -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ bool HUAWEI_HWID = FALSE; -+ bool ATHEROS_HWID = FALSE; -+ -+ for (i = 0; i < dvobj->iface_nums; i++){ -+ iface = dvobj->padapters[i]; -+ if (iface!= NULL) { -+ pmlmeext = &(iface->mlmeextpriv); -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ if( pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_ATHEROS){ -+ HUAWEI_HWID = TRUE; -+ ATHEROS_HWID = TRUE; -+ goto exit; -+ } -+ } -+ } -+ -+exit: -+ RTW_INFO("%s ODM_CMNINFO_HUAWEI_HWID:%d ATHEROS_HWID:%d\n", __func__, HUAWEI_HWID, ATHEROS_HWID); -+ odm_cmn_info_update(phydm, ODM_CMNINFO_HUAWEI_HWID, HUAWEI_HWID); -+ odm_cmn_info_update(phydm, ODM_CMNINFO_ATHEROS_HWID, ATHEROS_HWID); -+} -+ -+void rtw_phydm_watchdog(_adapter *adapter, bool in_lps) -+{ -+ u8 bLinked = _FALSE; -+ u8 bsta_state = _FALSE; -+ u8 bBtDisabled = _TRUE; -+ u8 rfk_forbidden = _FALSE; -+ #if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1)) -+ u8 segment_iqk = _FALSE; -+ #endif -+ u8 tx_unlinked_low_rate = 0xFF; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ -+ if (!rtw_is_hw_init_completed(adapter)) { -+ RTW_DBG("%s skip due to hw_init_completed == FALSE\n", __func__); -+ return; -+ } -+ if (rtw_mi_check_fwstate(adapter, WIFI_UNDER_SURVEY)) -+ pHalData->bScanInProcess = _TRUE; -+ else -+ pHalData->bScanInProcess = _FALSE; -+ -+ if (rtw_mi_check_status(adapter, MI_ASSOC)) { -+ bLinked = _TRUE; -+ if (rtw_mi_check_status(adapter, MI_STA_LINKED)) -+ bsta_state = _TRUE; -+ } -+ -+ odm_cmn_info_update(&pHalData->odmpriv, ODM_CMNINFO_LINK, bLinked); -+ odm_cmn_info_update(&pHalData->odmpriv, ODM_CMNINFO_STATION_STATE, bsta_state); -+ -+ #ifdef CONFIG_BT_COEXIST -+ bBtDisabled = rtw_btcoex_IsBtDisabled(adapter); -+ odm_cmn_info_update(&pHalData->odmpriv, ODM_CMNINFO_BT_ENABLED, -+ (bBtDisabled == _TRUE) ? _FALSE : _TRUE); -+ #else -+ odm_cmn_info_update(&pHalData->odmpriv, ODM_CMNINFO_BT_ENABLED, _FALSE); -+ #endif /* CONFIG_BT_COEXIST */ -+ -+ rfk_forbidden = (_rtw_phydm_rfk_condition_check(adapter, pHalData->bScanInProcess, bLinked) == _TRUE) ? _FALSE : _TRUE; -+ halrf_cmn_info_set(&pHalData->odmpriv, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); -+ -+ #if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1)) -+ segment_iqk = _rtw_phydm_iqk_segment_chk(adapter, bLinked); -+ halrf_cmn_info_set(&pHalData->odmpriv, HALRF_CMNINFO_IQK_SEGMENT, segment_iqk); -+ #endif -+ #ifdef DBG_PHYDM_STATE_CHK -+ RTW_INFO("%s rfk_forbidden = %s, segment_iqk = %s\n", -+ __func__, (rfk_forbidden) ? "Y" : "N", (segment_iqk) ? "Y" : "N"); -+ #endif -+ -+ if (bLinked == _FALSE) { -+ tx_unlinked_low_rate = _rtw_phydm_pwr_tracking_rate_check(adapter); -+ halrf_cmn_info_set(&pHalData->odmpriv, HALRF_CMNINFO_RATE_INDEX, tx_unlinked_low_rate); -+ } -+ -+ /*if (!rtw_mi_stayin_union_band_chk(adapter)) { -+ #ifdef DBG_PHYDM_STATE_CHK -+ RTW_ERR("Not stay in union band, skip phydm\n"); -+ #endif -+ goto _exit; -+ }*/ -+ -+ #ifdef CONFIG_TDMADIG -+ rtw_phydm_tdmadig(adapter, TDMADIG_NON_INIT); -+ #endif/*CONFIG_TDMADIG*/ -+ -+ if (in_lps) -+ phydm_watchdog_lps(&pHalData->odmpriv); -+ else -+ phydm_watchdog(&pHalData->odmpriv); -+ -+ #ifdef CONFIG_RTW_ACS -+ rtw_acs_update_current_info(adapter); -+ #endif -+ -+ return; -+} -+ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_dm.h b/drivers/net/wireless/rtl8821cs/hal/hal_dm.h -new file mode 100644 -index 000000000..e7bb76969 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_dm.h -@@ -0,0 +1,122 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_DM_H__ -+#define __HAL_DM_H__ -+ -+#define adapter_to_phydm(adapter) (&(GET_HAL_DATA(adapter)->odmpriv)) -+#define dvobj_to_phydm(dvobj) adapter_to_phydm(dvobj_get_primary_adapter(dvobj)) -+#ifdef CONFIG_TDMADIG -+void rtw_phydm_tdmadig(_adapter *adapter, u8 state); -+#endif -+void rtw_phydm_priv_init(_adapter *adapter); -+void Init_ODM_ComInfo(_adapter *adapter); -+void rtw_phydm_init(_adapter *adapter); -+ -+void rtw_hal_turbo_edca(_adapter *adapter); -+u8 rtw_phydm_is_iqk_in_progress(_adapter *adapter); -+ -+void GetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ void *pValue1, -+ void *pValue2); -+void SetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ void *pValue1, -+ BOOLEAN bSet); -+ -+void rtw_phydm_ra_registed(_adapter *adapter, struct sta_info *psta); -+ -+#ifdef CONFIG_DYNAMIC_SOML -+void rtw_dyn_soml_byte_update(_adapter *adapter, u8 data_rate, u32 size); -+void rtw_dyn_soml_para_set(_adapter *adapter, u8 train_num, u8 intvl, -+ u8 period, u8 delay); -+void rtw_dyn_soml_config(_adapter *adapter); -+#endif -+void rtw_phydm_set_rrsr(_adapter *adapter, u32 rrsr_value, bool write_rrsr); -+void rtw_phydm_dyn_rrsr_en(_adapter *adapter, bool en_rrsr); -+void rtw_phydm_update_ap_vendor_ie(_adapter *adapter); -+void rtw_phydm_watchdog(_adapter *adapter, bool in_lps); -+ -+void rtw_hal_update_iqk_fw_offload_cap(_adapter *adapter); -+void dump_sta_info(void *sel, struct sta_info *psta); -+void dump_sta_traffic(void *sel, _adapter *adapter, struct sta_info *psta); -+ -+void rtw_hal_phydm_cal_trigger(_adapter *adapter); -+#ifdef CONFIG_DBG_RF_CAL -+void rtw_hal_iqk_test(_adapter *adapter, bool recovery, bool clear, bool segment); -+void rtw_hal_lck_test(_adapter *adapter); -+#endif -+ -+s8 rtw_dm_get_min_rssi(_adapter *adapter); -+s8 rtw_phydm_get_min_rssi(_adapter *adapter); -+u8 rtw_phydm_get_cur_igi(_adapter *adapter); -+bool rtw_phydm_get_edcca_flag(_adapter *adapter); -+ -+ -+#ifdef CONFIG_LPS_LCLK_WD_TIMER -+extern void phydm_rssi_monitor_check(void *p_dm_void); -+ -+void rtw_phydm_wd_lps_lclk_hdl(_adapter *adapter); -+void rtw_phydm_watchdog_in_lps_lclk(_adapter *adapter); -+#endif -+#ifdef CONFIG_TDMADIG -+enum rtw_tdmadig_state{ -+ TDMADIG_INIT, -+ TDMADIG_NON_INIT, -+}; -+#endif -+enum phy_cnt { -+ FA_OFDM, -+ FA_CCK, -+ FA_TOTAL, -+ CCA_OFDM, -+ CCA_CCK, -+ CCA_ALL, -+ CRC32_OK_VHT, -+ CRC32_OK_HT, -+ CRC32_OK_LEGACY, -+ CRC32_OK_CCK, -+ CRC32_ERROR_VHT, -+ CRC32_ERROR_HT, -+ CRC32_ERROR_LEGACY, -+ CRC32_ERROR_CCK, -+}; -+u32 rtw_phydm_get_phy_cnt(_adapter *adapter, enum phy_cnt cnt); -+#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1) \ -+ || (RTL8723F_SUPPORT == 1)) -+void rtw_phydm_iqk_trigger(_adapter *adapter); -+#endif -+void rtw_phydm_read_efuse(_adapter *adapter); -+bool rtw_phydm_set_crystal_cap(_adapter *adapter, u8 crystal_cap); -+ -+#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR -+void rtw_phydm_set_dyntxpwr(_adapter *adapter, u8 *desc, u8 mac_id); -+#endif -+ -+#ifdef CONFIG_LPS_PG -+void rtw_phydm_lps_pg_hdl(_adapter *adapter, struct sta_info *sta, bool in_lpspg); -+#endif -+#ifdef CONFIG_LPS_PWR_TRACKING -+void rtw_phydm_pwr_tracking_directly(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+void rtw_phydm_trx_cfg(_adapter *adapter, bool tx_1ss); -+#endif -+u8 rtw_hal_runtime_trx_path_decision(_adapter *adapter); -+bool rtw_phydm_rfe_ctrl_gpio(_adapter *adapter, u8 gpio_num); -+#endif /* __HAL_DM_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_dm_acs.c b/drivers/net/wireless/rtl8821cs/hal/hal_dm_acs.c -new file mode 100644 -index 000000000..0fa341463 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_dm_acs.c -@@ -0,0 +1,607 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2014 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+ -+#if defined(CONFIG_RTW_ACS) || defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+static void _rtw_bss_nums_count(_adapter *adapter, u8 *pbss_nums) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ _list *plist, *phead; -+ _irqL irqL; -+ int chan_idx = -1; -+ -+ if (pbss_nums == NULL) { -+ RTW_ERR("%s pbss_nums is null pointer\n", __func__); -+ return; -+ } -+ _rtw_memset(pbss_nums, 0, MAX_CHANNEL_NUM); -+ -+ _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 (!pnetwork) -+ break; -+ chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), pnetwork->network.Configuration.DSConfig); -+ if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { -+ RTW_ERR("%s can't get chan_idx(CH:%d)\n", -+ __func__, pnetwork->network.Configuration.DSConfig); -+ chan_idx = 0; -+ } -+ /*if (pnetwork->network.Reserved[0] != BSS_TYPE_PROB_REQ)*/ -+ -+ pbss_nums[chan_idx]++; -+ -+ plist = get_next(plist); -+ } -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+} -+ -+u8 rtw_get_ch_num_by_idx(_adapter *adapter, u8 idx) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ RT_CHANNEL_INFO *pch_set = rfctl->channel_set; -+ u8 max_chan_nums = rfctl->max_chan_nums; -+ -+ if (idx >= max_chan_nums) -+ return 0; -+ return pch_set[idx].ChannelNum; -+} -+#endif /*defined(CONFIG_RTW_ACS) || defined(CONFIG_BACKGROUND_NOISE_MONITOR)*/ -+ -+ -+#ifdef CONFIG_RTW_ACS -+void rtw_acs_version_dump(void *sel, _adapter *adapter) -+{ -+ _RTW_PRINT_SEL(sel, "RTK_ACS VER_%d\n", RTK_ACS_VERSION); -+} -+u8 rtw_phydm_clm_ratio(_adapter *adapter) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CLM_RATIO); -+} -+u8 rtw_phydm_nhm_ratio(_adapter *adapter) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_NHM_ENV_RATIO); -+} -+ -+u8 rtw_phydm_nhm_noise_pwr(_adapter *adapter) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ -+ return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_NHM_PWR); -+} -+ -+void rtw_acs_reset(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct auto_chan_sel *pacs = &hal_data->acs; -+ -+ _rtw_memset(pacs, 0, sizeof(struct auto_chan_sel)); -+ #ifdef CONFIG_RTW_ACS_DBG -+ rtw_acs_adv_reset(adapter); -+ #endif /*CONFIG_RTW_ACS_DBG*/ -+} -+ -+#ifdef CONFIG_RTW_ACS_DBG -+u8 rtw_is_acs_igi_valid(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct auto_chan_sel *pacs = &hal_data->acs; -+ -+ if ((pacs->igi) && ((pacs->igi >= 0x1E) || (pacs->igi < 0x60))) -+ return _TRUE; -+ -+ return _FALSE; -+} -+void rtw_acs_adv_setting(_adapter *adapter, RT_SCAN_TYPE scan_type, u16 scan_time, u8 igi, u8 bw) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct auto_chan_sel *pacs = &hal_data->acs; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ pacs->scan_type = scan_type; -+ pacs->scan_time = scan_time; -+ pacs->igi = igi; -+ pacs->bw = bw; -+ RTW_INFO("[ACS] ADV setting - scan_type:%c, ch_ms:%d(ms), igi:0x%02x, bw:%d\n", -+ pacs->scan_type ? 'A' : 'P', pacs->scan_time, pacs->igi, pacs->bw); -+} -+void rtw_acs_adv_reset(_adapter *adapter) -+{ -+ rtw_acs_adv_setting(adapter, SCAN_ACTIVE, 0, 0, 0); -+} -+#endif /*CONFIG_RTW_ACS_DBG*/ -+ -+void rtw_acs_trigger(_adapter *adapter, u16 scan_time_ms, u8 scan_chan, enum NHM_PID pid) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+#if (RTK_ACS_VERSION == 3) -+ struct clm_para_info clm_para; -+ struct nhm_para_info nhm_para; -+ struct env_trig_rpt trig_rpt; -+ -+ scan_time_ms -= 10; -+ -+ init_acs_clm(clm_para, scan_time_ms); -+ -+ if (pid == NHM_PID_IEEE_11K_HIGH) -+ init_11K_high_nhm(nhm_para, scan_time_ms); -+ else if (pid == NHM_PID_IEEE_11K_LOW) -+ init_11K_low_nhm(nhm_para, scan_time_ms); -+ else -+ init_acs_nhm(nhm_para, scan_time_ms); -+ -+ hal_data->acs.trig_rst = phydm_env_mntr_trigger(phydm, &nhm_para, &clm_para, &trig_rpt); -+ if (hal_data->acs.trig_rst == (NHM_SUCCESS | CLM_SUCCESS)) { -+ hal_data->acs.trig_rpt.clm_rpt_stamp = trig_rpt.clm_rpt_stamp; -+ hal_data->acs.trig_rpt.nhm_rpt_stamp = trig_rpt.nhm_rpt_stamp; -+ /*RTW_INFO("[ACS] trigger success (rst = 0x%02x, clm_stamp:%d, nhm_stamp:%d)\n", -+ hal_data->acs.trig_rst, hal_data->acs.trig_rpt.clm_rpt_stamp, hal_data->acs.trig_rpt.nhm_rpt_stamp);*/ -+ } else -+ RTW_ERR("[ACS] trigger failed (rst = 0x%02x)\n", hal_data->acs.trig_rst); -+#else -+ phydm_ccx_monitor_trigger(phydm, scan_time_ms); -+#endif -+ -+ hal_data->acs.trigger_ch = scan_chan; -+ hal_data->acs.triggered = _TRUE; -+ -+ #ifdef CONFIG_RTW_ACS_DBG -+ RTW_INFO("[ACS] Trigger CH:%d, Times:%d\n", hal_data->acs.trigger_ch, scan_time_ms); -+ #endif -+} -+void rtw_acs_get_rst(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ int chan_idx = -1; -+ u8 cur_chan = hal_data->acs.trigger_ch; -+ -+ if (cur_chan == 0) -+ return; -+ -+ if (!hal_data->acs.triggered) -+ return; -+ -+ chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), cur_chan); -+ if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { -+ RTW_ERR("[ACS] %s can't get chan_idx(CH:%d)\n", __func__, cur_chan); -+ return; -+ } -+#if (RTK_ACS_VERSION == 3) -+ if (!(hal_data->acs.trig_rst == (NHM_SUCCESS | CLM_SUCCESS))) { -+ RTW_ERR("[ACS] get_rst return, due to acs trigger failed\n"); -+ return; -+ } -+ -+ { -+ struct env_mntr_rpt rpt = {0}; -+ u8 rst; -+ -+ rst = phydm_env_mntr_result(phydm, &rpt); -+ if ((rst == (NHM_SUCCESS | CLM_SUCCESS)) && -+ (rpt.clm_rpt_stamp == hal_data->acs.trig_rpt.clm_rpt_stamp) && -+ (rpt.nhm_rpt_stamp == hal_data->acs.trig_rpt.nhm_rpt_stamp)){ -+ hal_data->acs.clm_ratio[chan_idx] = rpt.clm_ratio; -+ hal_data->acs.nhm_ratio[chan_idx] = rpt.nhm_env_ratio; -+ hal_data->acs.env_mntr_rpt[chan_idx] = (rpt.nhm_noise_pwr -100); -+ _rtw_memcpy(&hal_data->acs.nhm[chan_idx][0], rpt.nhm_result, NHM_RPT_NUM); -+ -+ /*RTW_INFO("[ACS] get_rst success (rst = 0x%02x, clm_stamp:%d:%d, nhm_stamp:%d:%d)\n", -+ rst, -+ hal_data->acs.trig_rpt.clm_rpt_stamp, rpt.clm_rpt_stamp, -+ hal_data->acs.trig_rpt.nhm_rpt_stamp, rpt.nhm_rpt_stamp);*/ -+ } else { -+ RTW_ERR("[ACS] get_rst failed (rst = 0x%02x, clm_stamp:%d:%d, nhm_stamp:%d:%d)\n", -+ rst, -+ hal_data->acs.trig_rpt.clm_rpt_stamp, rpt.clm_rpt_stamp, -+ hal_data->acs.trig_rpt.nhm_rpt_stamp, rpt.nhm_rpt_stamp); -+ } -+ } -+ -+#else -+ phydm_ccx_monitor_result(phydm); -+ -+ hal_data->acs.clm_ratio[chan_idx] = rtw_phydm_clm_ratio(adapter); -+ hal_data->acs.nhm_ratio[chan_idx] = rtw_phydm_nhm_ratio(adapter); -+#endif -+ hal_data->acs.triggered = _FALSE; -+ #ifdef CONFIG_RTW_ACS_DBG -+ RTW_INFO("[ACS] Result CH:%d, CLM:%d NHM:%d\n", -+ cur_chan, hal_data->acs.clm_ratio[chan_idx], hal_data->acs.nhm_ratio[chan_idx]); -+ RTW_INFO("[ACS] Result NHM(dBm):%d\n", -+ hal_data->acs.env_mntr_rpt[chan_idx] ); -+ #endif -+} -+ -+void _rtw_phydm_acs_select_best_chan(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ u8 ch_idx; -+ u8 ch_idx_24g = 0xFF, ch_idx_5g = 0xFF; -+ u8 min_itf_24g = 0xFF, min_itf_5g = 0xFF; -+ u8 *pbss_nums = hal_data->acs.bss_nums; -+ u8 *pclm_ratio = hal_data->acs.clm_ratio; -+ u8 *pnhm_ratio = hal_data->acs.nhm_ratio; -+ u8 *pinterference_time = hal_data->acs.interference_time; -+ u8 max_chan_nums = rfctl->max_chan_nums; -+ -+ for (ch_idx = 0; ch_idx < max_chan_nums; ch_idx++) { -+ if (pbss_nums[ch_idx]) -+ pinterference_time[ch_idx] = (pclm_ratio[ch_idx] / 2) + (pnhm_ratio[ch_idx] / 2); -+ else -+ pinterference_time[ch_idx] = (pclm_ratio[ch_idx] / 3) + ((pnhm_ratio[ch_idx] * 2) / 3); -+ -+ if (rtw_get_ch_num_by_idx(adapter, ch_idx) < 14) { -+ if (pinterference_time[ch_idx] < min_itf_24g) { -+ min_itf_24g = pinterference_time[ch_idx]; -+ ch_idx_24g = ch_idx; -+ } -+ } else { -+ if (pinterference_time[ch_idx] < min_itf_5g) { -+ min_itf_5g = pinterference_time[ch_idx]; -+ ch_idx_5g = ch_idx; -+ } -+ } -+ } -+ if (ch_idx_24g != 0xFF) -+ hal_data->acs.best_chan_24g = rtw_get_ch_num_by_idx(adapter, ch_idx_24g); -+ -+ if (ch_idx_5g != 0xFF) -+ hal_data->acs.best_chan_5g = rtw_get_ch_num_by_idx(adapter, ch_idx_5g); -+ -+ hal_data->acs.trigger_ch = 0; -+} -+ -+void rtw_acs_info_dump(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ u8 max_chan_nums = rfctl->max_chan_nums; -+ u8 ch_idx, ch_num; -+ -+ _RTW_PRINT_SEL(sel, "========== ACS (VER-%d) ==========\n", RTK_ACS_VERSION); -+ _RTW_PRINT_SEL(sel, "Best 24G Channel:%d\n", hal_data->acs.best_chan_24g); -+ _RTW_PRINT_SEL(sel, "Best 5G Channel:%d\n\n", hal_data->acs.best_chan_5g); -+ -+ #ifdef CONFIG_RTW_ACS_DBG -+ _RTW_PRINT_SEL(sel, "Advanced setting - scan_type:%c, ch_ms:%d(ms), igi:0x%02x, bw:%d\n", -+ hal_data->acs.scan_type ? 'A' : 'P', hal_data->acs.scan_time, hal_data->acs.igi, hal_data->acs.bw); -+ -+ _RTW_PRINT_SEL(sel, "BW 20MHz\n"); -+ _RTW_PRINT_SEL(sel, "%5s %3s %3s %3s(%%) %3s(%%) %3s\n", -+ "Index", "CH", "BSS", "CLM", "NHM", "ITF"); -+ -+ for (ch_idx = 0; ch_idx < max_chan_nums; ch_idx++) { -+ ch_num = rtw_get_ch_num_by_idx(adapter, ch_idx); -+ _RTW_PRINT_SEL(sel, "%5d %3d %3d %6d %6d %3d\n", -+ ch_idx, ch_num, hal_data->acs.bss_nums[ch_idx], -+ hal_data->acs.clm_ratio[ch_idx], -+ hal_data->acs.nhm_ratio[ch_idx], -+ hal_data->acs.interference_time[ch_idx]); -+ } -+ #endif -+} -+void rtw_acs_select_best_chan(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ _rtw_bss_nums_count(adapter, hal_data->acs.bss_nums); -+ _rtw_phydm_acs_select_best_chan(adapter); -+ rtw_acs_info_dump(RTW_DBGDUMP, adapter); -+} -+ -+void rtw_acs_start(_adapter *adapter) -+{ -+ rtw_acs_reset(adapter); -+ if (GET_ACS_STATE(adapter) != ACS_ENABLE) -+ SET_ACS_STATE(adapter, ACS_ENABLE); -+} -+void rtw_acs_stop(_adapter *adapter) -+{ -+ SET_ACS_STATE(adapter, ACS_DISABLE); -+} -+ -+ -+u8 rtw_acs_get_clm_ratio_by_ch_num(_adapter *adapter, u8 chan) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int chan_idx = -1; -+ -+ chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), chan); -+ if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { -+ RTW_ERR("[ACS] Get CLM fail, can't get chan_idx(CH:%d)\n", chan); -+ return 0; -+ } -+ -+ return hal_data->acs.clm_ratio[chan_idx]; -+} -+u8 rtw_acs_get_clm_ratio_by_ch_idx(_adapter *adapter, u8 ch_idx) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ if (ch_idx >= MAX_CHANNEL_NUM) { -+ RTW_ERR("%s [ACS] ch_idx(%d) is invalid\n", __func__, ch_idx); -+ return 0; -+ } -+ -+ return hal_data->acs.clm_ratio[ch_idx]; -+} -+u8 rtw_acs_get_nhm_ratio_by_ch_num(_adapter *adapter, u8 chan) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int chan_idx = -1; -+ -+ chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), chan); -+ if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { -+ RTW_ERR("[ACS] Get NHM fail, can't get chan_idx(CH:%d)\n", chan); -+ return 0; -+ } -+ -+ return hal_data->acs.nhm_ratio[chan_idx]; -+} -+u8 rtw_acs_get_nhm_noise_pwr_by_ch_idx(_adapter *adapter, u8 ch_idx) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ if (ch_idx >= MAX_CHANNEL_NUM) { -+ RTW_ERR("%s [ACS] ch_idx(%d) is invalid\n", __func__, ch_idx); -+ return 0; -+ } -+ -+ return hal_data->acs.env_mntr_rpt[ch_idx]; -+} -+ -+u8 rtw_acs_get_num_ratio_by_ch_idx(_adapter *adapter, u8 ch_idx) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ if (ch_idx >= MAX_CHANNEL_NUM) { -+ RTW_ERR("%s [ACS] ch_idx(%d) is invalid\n", __func__, ch_idx); -+ return 0; -+ } -+ -+ return hal_data->acs.nhm_ratio[ch_idx]; -+} -+void rtw_acs_chan_info_dump(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ u8 max_chan_nums = rfctl->max_chan_nums; -+ u8 ch_idx, ch_num; -+ u8 utilization; -+ -+ _RTW_PRINT_SEL(sel, "BW 20MHz\n"); -+ _RTW_PRINT_SEL(sel, "%5s %3s %7s(%%) %12s(%%) %11s(%%) %9s(%%) %8s(%%)\n", -+ "Index", "CH", "Quality", "Availability", "Utilization", -+ "WIFI Util", "Interference Util"); -+ -+ for (ch_idx = 0; ch_idx < max_chan_nums; ch_idx++) { -+ ch_num = rtw_get_ch_num_by_idx(adapter, ch_idx); -+ utilization = hal_data->acs.clm_ratio[ch_idx] + hal_data->acs.nhm_ratio[ch_idx]; -+ _RTW_PRINT_SEL(sel, "%5d %3d %7d %12d %12d %12d %12d\n", -+ ch_idx, ch_num, -+ (100-hal_data->acs.interference_time[ch_idx]), -+ (100-utilization), -+ utilization, -+ hal_data->acs.clm_ratio[ch_idx], -+ hal_data->acs.nhm_ratio[ch_idx]); -+ } -+} -+void rtw_acs_current_info_dump(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 ch, cen_ch, bw, offset; -+ -+ _RTW_PRINT_SEL(sel, "========== ACS (VER-%d) ==========\n", RTK_ACS_VERSION); -+ -+ ch = rtw_get_oper_ch(adapter); -+ bw = rtw_get_oper_bw(adapter); -+ offset = rtw_get_oper_choffset(adapter); -+ -+ _RTW_PRINT_SEL(sel, "Current Channel:%d\n", ch); -+ if ((bw == CHANNEL_WIDTH_80) ||(bw == CHANNEL_WIDTH_40)) { -+ cen_ch = rtw_get_center_ch(ch, bw, offset); -+ _RTW_PRINT_SEL(sel, "Center Channel:%d\n", cen_ch); -+ } -+ -+ _RTW_PRINT_SEL(sel, "Current BW %s\n", ch_width_str(bw)); -+ if (0) -+ _RTW_PRINT_SEL(sel, "Current IGI 0x%02x\n", rtw_phydm_get_cur_igi(adapter)); -+ _RTW_PRINT_SEL(sel, "CLM:%d, NHM:%d\n\n", -+ hal_data->acs.cur_ch_clm_ratio, hal_data->acs.cur_ch_nhm_ratio); -+} -+ -+void rtw_acs_update_current_info(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ hal_data->acs.cur_ch_clm_ratio = rtw_phydm_clm_ratio(adapter); -+ hal_data->acs.cur_ch_nhm_ratio = rtw_phydm_nhm_ratio(adapter); -+ -+ #ifdef CONFIG_RTW_ACS_DBG -+ rtw_acs_current_info_dump(RTW_DBGDUMP, adapter); -+ #endif -+} -+/* -+rsni -+para1:rcpi=>RSSI in dbm -+para2:anpi=>nhm in dbm -+range:0~255 -+255: is not available (defined by 802.11k spec) -+ -+*/ -+u8 rtw_acs_get_rsni(_adapter *adapter, s8 rcpi, u8 ch) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 rsni = 255; -+ s8 anpi = 0; -+ int chan_idx = -1; -+ -+ if(ch == 0) -+ goto exit; -+ -+ chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), ch); -+ if(chan_idx == -1) -+ goto exit; -+ -+ anpi = rtw_acs_get_nhm_noise_pwr_by_ch_idx(adapter, chan_idx); -+ if((rcpi != 0) && (anpi != 0)) -+ rsni = phydm_env_mntr_get_802_11_k_rsni(phydm, rcpi, anpi); -+ RTW_DBG("[ACS][RSNI]ch=%d chan_idx=%d RSNI=%u RSSI=%d NHM=%d\n", ch, chan_idx, rsni,rcpi, anpi); -+exit: -+ return rsni; -+} -+#endif /*CONFIG_RTW_ACS*/ -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+void rtw_noise_monitor_version_dump(void *sel, _adapter *adapter) -+{ -+ _RTW_PRINT_SEL(sel, "RTK_NOISE_MONITOR VER_%d\n", RTK_NOISE_MONITOR_VERSION); -+} -+void rtw_nm_enable(_adapter *adapter) -+{ -+ SET_NM_STATE(adapter, NM_ENABLE); -+} -+void rtw_nm_disable(_adapter *adapter) -+{ -+ SET_NM_STATE(adapter, NM_DISABLE); -+} -+void rtw_noise_info_dump(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ u8 max_chan_nums = rfctl->max_chan_nums; -+ u8 ch_idx, ch_num; -+ -+ _RTW_PRINT_SEL(sel, "========== NM (VER-%d) ==========\n", RTK_NOISE_MONITOR_VERSION); -+ -+ _RTW_PRINT_SEL(sel, "%5s %3s %3s %10s", "Index", "CH", "BSS", "Noise(dBm)\n"); -+ -+ _rtw_bss_nums_count(adapter, hal_data->nm.bss_nums); -+ -+ for (ch_idx = 0; ch_idx < max_chan_nums; ch_idx++) { -+ ch_num = rtw_get_ch_num_by_idx(adapter, ch_idx); -+ _RTW_PRINT_SEL(sel, "%5d %3d %3d %10d\n", -+ ch_idx, ch_num, hal_data->nm.bss_nums[ch_idx], -+ hal_data->nm.noise[ch_idx]); -+ } -+} -+ -+void rtw_noise_measure(_adapter *adapter, u8 chan, u8 is_pause_dig, u8 igi_value, u32 max_time) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct dm_struct *phydm = &hal_data->odmpriv; -+ int chan_idx = -1; -+ s16 noise = 0; -+ -+ #ifdef DBG_NOISE_MONITOR -+ RTW_INFO("[NM] chan(%d)-PauseDIG:%s, IGIValue:0x%02x, max_time:%d (ms)\n", -+ chan, (is_pause_dig) ? "Y" : "N", igi_value, max_time); -+ #endif -+ -+ chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), chan); -+ if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { -+ RTW_ERR("[NM] Get noise fail, can't get chan_idx(CH:%d)\n", chan); -+ return; -+ } -+ noise = odm_inband_noise_monitor(phydm, is_pause_dig, igi_value, max_time); /*dBm*/ -+ -+ hal_data->nm.noise[chan_idx] = noise; -+ -+ #ifdef DBG_NOISE_MONITOR -+ RTW_INFO("[NM] %s chan_%d, noise = %d (dBm)\n", __func__, chan, hal_data->nm.noise[chan_idx]); -+ -+ RTW_INFO("[NM] noise_a = %d, noise_b = %d noise_all:%d\n", -+ phydm->noise_level.noise[RF_PATH_A], -+ phydm->noise_level.noise[RF_PATH_B], -+ phydm->noise_level.noise_all); -+ #endif /*DBG_NOISE_MONITOR*/ -+} -+ -+s16 rtw_noise_query_by_chan_num(_adapter *adapter, u8 chan) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ s16 noise = 0; -+ int chan_idx = -1; -+ -+ chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), chan); -+ if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { -+ RTW_ERR("[NM] Get noise fail, can't get chan_idx(CH:%d)\n", chan); -+ return noise; -+ } -+ noise = hal_data->nm.noise[chan_idx]; -+ -+ #ifdef DBG_NOISE_MONITOR -+ RTW_INFO("[NM] %s chan_%d, noise = %d (dBm)\n", __func__, chan, noise); -+ #endif/*DBG_NOISE_MONITOR*/ -+ return noise; -+} -+s16 rtw_noise_query_by_chan_idx(_adapter *adapter, u8 ch_idx) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ s16 noise = 0; -+ -+ if (ch_idx >= MAX_CHANNEL_NUM) { -+ RTW_ERR("[NM] %s ch_idx(%d) is invalid\n", __func__, ch_idx); -+ return noise; -+ } -+ noise = hal_data->nm.noise[ch_idx]; -+ -+ #ifdef DBG_NOISE_MONITOR -+ RTW_INFO("[NM] %s ch_idx %d, noise = %d (dBm)\n", __func__, ch_idx, noise); -+ #endif/*DBG_NOISE_MONITOR*/ -+ return noise; -+} -+ -+s16 rtw_noise_measure_curchan(_adapter *padapter) -+{ -+ s16 noise = 0; -+ u8 igi_value = 0x1E; -+ u32 max_time = 100;/* ms */ -+ u8 is_pause_dig = _TRUE; -+ u8 cur_chan = rtw_get_oper_ch(padapter); -+ -+ if (rtw_linked_check(padapter) == _FALSE) -+ return noise; -+ -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); -+ rtw_noise_measure(padapter, cur_chan, is_pause_dig, igi_value, max_time); -+ noise = rtw_noise_query_by_chan_num(padapter, cur_chan); -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ -+ return noise; -+} -+#endif /*CONFIG_BACKGROUND_NOISE_MONITOR*/ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_dm_acs.h b/drivers/net/wireless/rtl8821cs/hal/hal_dm_acs.h -new file mode 100644 -index 000000000..f9620011b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_dm_acs.h -@@ -0,0 +1,173 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_DM_ACS_H__ -+#define __HAL_DM_ACS_H__ -+#ifdef CONFIG_RTW_ACS -+#define RTK_ACS_VERSION 3 -+ -+#if (RTK_ACS_VERSION == 3) -+enum NHM_PID { -+ NHM_PID_ACS, -+ NHM_PID_IEEE_11K_HIGH, -+ NHM_PID_IEEE_11K_LOW, -+}; -+ -+#define init_clm_param(clm, app, lv, time) \ -+ do {\ -+ clm.clm_app = app;\ -+ clm.clm_lv = lv;\ -+ clm.mntr_time = time;\ -+ } while (0) -+ -+#define init_nhm_param(nhm, txon, cca, cnt_opt, app, lv, time) \ -+ do {\ -+ nhm.incld_txon = txon;\ -+ nhm.incld_cca = cca;\ -+ nhm.div_opt = cnt_opt;\ -+ nhm.nhm_app = app;\ -+ nhm.nhm_lv = lv;\ -+ nhm.mntr_time = time;\ -+ } while (0) -+ -+ -+#define init_acs_clm(clm, time) \ -+ init_clm_param(clm, CLM_ACS, CLM_LV_2, time) -+ -+#define init_acs_nhm(nhm, time) \ -+ init_nhm_param(nhm, NHM_EXCLUDE_TXON, NHM_EXCLUDE_CCA, NHM_CNT_ALL, NHM_ACS, NHM_LV_2, time) -+ -+#define init_11K_high_nhm(nhm, time) \ -+ init_nhm_param(nhm, NHM_EXCLUDE_TXON, NHM_EXCLUDE_CCA, NHM_CNT_ALL, IEEE_11K_HIGH, NHM_LV_2, time) -+ -+#define init_11K_low_nhm(nhm, time) \ -+ init_nhm_param(nhm, NHM_EXCLUDE_TXON, NHM_EXCLUDE_CCA, NHM_CNT_ALL, IEEE_11K_LOW, NHM_LV_2, time) -+ -+ -+#endif /*(RTK_ACS_VERSION == 3)*/ -+void rtw_acs_version_dump(void *sel, _adapter *adapter); -+extern void phydm_ccx_monitor_trigger(void *p_dm_void, u16 monitor_time); -+extern void phydm_ccx_monitor_result(void *p_dm_void); -+ -+#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 IS_ACS_ENABLE(padapter) ((GET_ACS_STATE(padapter) == ACS_ENABLE) ? _TRUE : _FALSE) -+ -+enum ACS_STATE { -+ ACS_DISABLE, -+ ACS_ENABLE, -+}; -+ -+#define ACS_BW_20M BIT(0) -+#define ACS_BW_40M BIT(1) -+#define ACS_BW_80M BIT(2) -+#define ACS_BW_160M BIT(3) -+ -+struct auto_chan_sel { -+ ATOMIC_T state; -+ u8 trigger_ch; -+ bool triggered; -+ u8 clm_ratio[MAX_CHANNEL_NUM]; -+ u8 nhm_ratio[MAX_CHANNEL_NUM]; -+ s8 env_mntr_rpt[MAX_CHANNEL_NUM]; /*unit:dbm*/ -+ #if (RTK_ACS_VERSION == 3) -+ u8 nhm[MAX_CHANNEL_NUM][NHM_RPT_NUM]; -+ #endif -+ u8 bss_nums[MAX_CHANNEL_NUM]; -+ u8 interference_time[MAX_CHANNEL_NUM]; -+ u8 cur_ch_clm_ratio; -+ u8 cur_ch_nhm_ratio; -+ u8 best_chan_5g; -+ u8 best_chan_24g; -+ -+ #if (RTK_ACS_VERSION == 3) -+ u8 trig_rst; -+ struct env_trig_rpt trig_rpt; -+ #endif -+ -+ #ifdef CONFIG_RTW_ACS_DBG -+ RT_SCAN_TYPE scan_type; -+ u16 scan_time; -+ u8 igi; -+ u8 bw; -+ #endif -+}; -+ -+#define rtw_acs_get_best_chan_24g(adapter) (GET_HAL_DATA(adapter)->acs.best_chan_24g) -+#define rtw_acs_get_best_chan_5g(adapter) (GET_HAL_DATA(adapter)->acs.best_chan_5g) -+ -+#ifdef CONFIG_RTW_ACS_DBG -+#define rtw_is_acs_passiv_scan(adapter) (((GET_HAL_DATA(adapter)->acs.scan_type) == SCAN_PASSIVE) ? _TRUE : _FALSE) -+ -+#define rtw_acs_get_adv_st(adapter) (GET_HAL_DATA(adapter)->acs.scan_time) -+#define rtw_is_acs_st_valid(adapter) ((GET_HAL_DATA(adapter)->acs.scan_time) ? _TRUE : _FALSE) -+ -+#define rtw_acs_get_adv_igi(adapter) (GET_HAL_DATA(adapter)->acs.igi) -+u8 rtw_is_acs_igi_valid(_adapter *adapter); -+ -+#define rtw_acs_get_adv_bw(adapter) (GET_HAL_DATA(adapter)->acs.bw) -+ -+void rtw_acs_adv_setting(_adapter *adapter, RT_SCAN_TYPE scan_type, u16 scan_time, u8 igi, u8 bw); -+void rtw_acs_adv_reset(_adapter *adapter); -+#endif -+ -+u8 rtw_acs_get_clm_ratio_by_ch_num(_adapter *adapter, u8 chan); -+u8 rtw_acs_get_clm_ratio_by_ch_idx(_adapter *adapter, u8 ch_idx); -+u8 rtw_acs_get_nhm_ratio_by_ch_num(_adapter *adapter, u8 chan); -+u8 rtw_acs_get_nhm_noise_pwr_by_ch_idx(_adapter *adapter, u8 ch_idx); -+u8 rtw_acs_get_num_ratio_by_ch_idx(_adapter *adapter, u8 ch_idx); -+ -+u8 rtw_phydm_clm_ratio(_adapter *adapter); -+u8 rtw_phydm_nhm_ratio(_adapter *adapter); -+u8 rtw_phydm_nhm_noise_pwr(_adapter *adapter); -+ -+void rtw_acs_reset(_adapter *adapter); -+void rtw_acs_trigger(_adapter *adapter, u16 scan_time_ms, u8 scan_chan, enum NHM_PID pid); -+void rtw_acs_get_rst(_adapter *adapter); -+void rtw_acs_select_best_chan(_adapter *adapter); -+void rtw_acs_info_dump(void *sel, _adapter *adapter); -+void rtw_acs_update_current_info(_adapter *adapter); -+void rtw_acs_chan_info_dump(void *sel, _adapter *adapter); -+void rtw_acs_current_info_dump(void *sel, _adapter *adapter); -+ -+void rtw_acs_start(_adapter *adapter); -+void rtw_acs_stop(_adapter *adapter); -+u8 rtw_acs_get_rsni(_adapter *adapter, s8 rcpi, u8 ch); -+#endif /*CONFIG_RTW_ACS*/ -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+#define RTK_NOISE_MONITOR_VERSION 3 -+#define GET_NM_STATE(padapter) (ATOMIC_READ(&GET_HAL_DATA(padapter)->nm.state)) -+#define SET_NM_STATE(padapter, set_state) (ATOMIC_SET(&GET_HAL_DATA(padapter)->nm.state, set_state)) -+#define IS_NM_ENABLE(padapter) ((GET_NM_STATE(padapter) == NM_ENABLE) ? _TRUE : _FALSE) -+ -+enum NM_STATE { -+ NM_DISABLE, -+ NM_ENABLE, -+}; -+ -+struct noise_monitor { -+ ATOMIC_T state; -+ s16 noise[MAX_CHANNEL_NUM]; -+ u8 bss_nums[MAX_CHANNEL_NUM]; -+}; -+void rtw_nm_enable(_adapter *adapter); -+void rtw_nm_disable(_adapter *adapter); -+void rtw_noise_measure(_adapter *adapter, u8 chan, u8 is_pause_dig, u8 igi_value, u32 max_time); -+s16 rtw_noise_query_by_chan_num(_adapter *adapter, u8 chan); -+s16 rtw_noise_query_by_chan_idx(_adapter *adapter, u8 ch_idx); -+s16 rtw_noise_measure_curchan(_adapter *padapter); -+void rtw_noise_info_dump(void *sel, _adapter *adapter); -+#endif -+#endif /* __HAL_DM_ACS_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_halmac.c b/drivers/net/wireless/rtl8821cs/hal/hal_halmac.c -new file mode 100644 -index 000000000..2aa4b31db ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_halmac.c -@@ -0,0 +1,5942 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_C_ -+ -+#include /* PADAPTER, struct dvobj_priv, SDIO_ERR_VAL8 and etc. */ -+#include /* efuse, PHAL_DATA_TYPE and etc. */ -+#include "hal_halmac.h" /* dvobj_to_halmac() and ect. */ -+ -+/* -+ * HALMAC take return value 0 for fail and 1 for success to replace -+ * _FALSE/_TRUE after V1_04_09 -+ */ -+#define RTW_HALMAC_FAIL 0 -+#define RTW_HALMAC_SUCCESS 1 -+ -+#define DEFAULT_INDICATOR_TIMELMT 1000 /* ms */ -+#define MSG_PREFIX "[HALMAC]" -+ -+#define RTW_HALMAC_DLFW_MEM_NO_STOP_TX -+#define RTW_HALMAC_FILTER_DRV_C2H /* Block C2H owner=driver */ -+ -+/* -+ * Driver API for HALMAC operations -+ */ -+ -+#ifdef CONFIG_SDIO_HCI -+#include -+ -+static u8 _halmac_mac_reg_page0_chk(const char *func, struct dvobj_priv *dvobj, u32 offset) -+{ -+#if defined(CONFIG_IO_CHECK_IN_ANA_LOW_CLK) && defined(CONFIG_LPS_LCLK) -+ struct pwrctrl_priv *pwrpriv = &dvobj->pwrctl_priv; -+ u32 mac_reg_offset = 0; -+ -+ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) -+ return _TRUE; -+ -+ if (pwrpriv->lps_level == LPS_NORMAL) -+ return _TRUE; -+ -+ if (pwrpriv->rpwm >= PS_STATE_S2) -+ return _TRUE; -+ -+ if (offset & (WLAN_IOREG_DEVICE_ID << 13)) { /*WLAN_IOREG_OFFSET*/ -+ mac_reg_offset = offset & HALMAC_WLAN_MAC_REG_MSK; -+ if (mac_reg_offset < 0x100) { -+ RTW_ERR(FUNC_ADPT_FMT -+ "access MAC REG -0x%04x in PS-mode:0x%02x (rpwm:0x%02x, lps_level:0x%02x)\n", -+ FUNC_ADPT_ARG(dvobj_get_primary_adapter(dvobj)), mac_reg_offset, -+ pwrpriv->pwr_mode, pwrpriv->rpwm, pwrpriv->lps_level); -+ rtw_warn_on(1); -+ return _FALSE; -+ } -+ } -+#endif -+ return _TRUE; -+} -+ -+static u8 _halmac_sdio_cmd52_read(void *p, u32 offset) -+{ -+ struct dvobj_priv *d; -+ u8 val; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ _halmac_mac_reg_page0_chk(__func__, d, offset); -+ ret = rtw_sdio_read_cmd52(d, offset, &val, 1); -+ if (_FAIL == ret) { -+ RTW_ERR("%s: 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; -+ _halmac_mac_reg_page0_chk(__func__, d, offset); -+ ret = rtw_sdio_write_cmd52(d, offset, &val, 1); -+ if (_FAIL == ret) -+ RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); -+} -+ -+static u8 _halmac_sdio_reg_read_8(void *p, u32 offset) -+{ -+ struct dvobj_priv *d; -+ u8 *pbuf; -+ u8 val; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ val = SDIO_ERR_VAL8; -+ _halmac_mac_reg_page0_chk(__func__, d, offset); -+ pbuf = rtw_zmalloc(1); -+ if (!pbuf) -+ return val; -+ -+ ret = rtw_sdio_read_cmd53(d, offset, pbuf, 1); -+ if (ret == _FAIL) { -+ RTW_ERR("%s: 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; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ val = SDIO_ERR_VAL16; -+ _halmac_mac_reg_page0_chk(__func__, d, offset); -+ pbuf = rtw_zmalloc(2); -+ if (!pbuf) -+ return val; -+ -+ ret = rtw_sdio_read_cmd53(d, offset, pbuf, 2); -+ if (ret == _FAIL) { -+ RTW_ERR("%s: 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; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ val = SDIO_ERR_VAL32; -+ _halmac_mac_reg_page0_chk(__func__, d, offset); -+ pbuf = rtw_zmalloc(4); -+ if (!pbuf) -+ return val; -+ -+ ret = rtw_sdio_read_cmd53(d, offset, pbuf, 4); -+ if (ret == _FAIL) { -+ RTW_ERR("%s: 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; -+ u8 *pbuf; -+ u8 ret; -+ u8 rst = RTW_HALMAC_FAIL; -+ u32 sdio_read_size; -+ -+ -+ if (!data) -+ return rst; -+ -+ sdio_read_size = RND4(size); -+ sdio_read_size = rtw_sdio_cmd53_align_size(d, sdio_read_size); -+ -+ pbuf = rtw_zmalloc(sdio_read_size); -+ if (!pbuf) -+ return rst; -+ -+ ret = rtw_sdio_read_cmd53(d, offset, pbuf, sdio_read_size); -+ if (ret == _FAIL) { -+ RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ _rtw_memcpy(data, pbuf, size); -+ rst = RTW_HALMAC_SUCCESS; -+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; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ _halmac_mac_reg_page0_chk(__func__, d, offset); -+ pbuf = rtw_zmalloc(1); -+ if (!pbuf) -+ return; -+ _rtw_memcpy(pbuf, &val, 1); -+ -+ ret = rtw_sdio_write_cmd53(d, offset, pbuf, 1); -+ if (ret == _FAIL) -+ RTW_ERR("%s: 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; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ _halmac_mac_reg_page0_chk(__func__, d, offset); -+ val = cpu_to_le16(val); -+ pbuf = rtw_zmalloc(2); -+ if (!pbuf) -+ return; -+ _rtw_memcpy(pbuf, &val, 2); -+ -+ ret = rtw_sdio_write_cmd53(d, offset, pbuf, 2); -+ if (ret == _FAIL) -+ RTW_ERR("%s: 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; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ _halmac_mac_reg_page0_chk(__func__, d, offset); -+ val = cpu_to_le32(val); -+ pbuf = rtw_zmalloc(4); -+ if (!pbuf) -+ return; -+ _rtw_memcpy(pbuf, &val, 4); -+ -+ ret = rtw_sdio_write_cmd53(d, offset, pbuf, 4); -+ if (ret == _FAIL) -+ RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); -+ -+ rtw_mfree(pbuf, 4); -+} -+ -+static u8 _halmac_sdio_read_cia(void *p, u32 offset) -+{ -+ struct dvobj_priv *d; -+ u8 data = 0; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ -+ ret = rtw_sdio_f0_read(d, offset, &data, 1); -+ if (ret == _FAIL) -+ RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); -+ -+ return data; -+} -+ -+#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 = dvobj_get_primary_adapter(d); -+ -+ 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 = dvobj_get_primary_adapter(d); -+ -+ 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 = dvobj_get_primary_adapter(d); -+ -+ 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 = dvobj_get_primary_adapter(d); -+ -+ err = _rtw_write8(adapter, offset, val); -+ if (err == _FAIL) -+ RTW_ERR("%s: 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 = dvobj_get_primary_adapter(d); -+ -+ err = _rtw_write16(adapter, offset, val); -+ if (err == _FAIL) -+ RTW_ERR("%s: 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 = dvobj_get_primary_adapter(d); -+ -+ err = _rtw_write32(adapter, offset, val); -+ if (err == _FAIL) -+ RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); -+} -+#endif /* !CONFIG_SDIO_HCI */ -+ -+#ifdef DBG_IO -+static void _halmac_reg_read_monitor(void *p, u32 addr, u32 len, u32 val -+ , const char *caller, const u32 line) -+{ -+ struct dvobj_priv *d = (struct dvobj_priv *)p; -+ _adapter *adapter = dvobj_get_primary_adapter(d); -+ -+ dbg_rtw_reg_read_monitor(adapter, addr, len, val, caller, line); -+} -+ -+static void _halmac_reg_write_monitor(void *p, u32 addr, u32 len, u32 val -+ , const char *caller, const u32 line) -+{ -+ struct dvobj_priv *d = (struct dvobj_priv *)p; -+ _adapter *adapter = dvobj_get_primary_adapter(d); -+ -+ dbg_rtw_reg_write_monitor(adapter, addr, len, val, caller, line); -+} -+#endif -+ -+static u8 _halmac_mfree(void *p, void *buffer, u32 size) -+{ -+ rtw_mfree(buffer, size); -+ return RTW_HALMAC_SUCCESS; -+} -+ -+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 RTW_HALMAC_SUCCESS; -+} -+ -+static u8 _halmac_memset(void *p, void *addr, u8 value, u32 size) -+{ -+ _rtw_memset(addr, value, size); -+ return RTW_HALMAC_SUCCESS; -+} -+ -+static void _halmac_udelay(void *p, u32 us) -+{ -+ /* Most hardware polling wait time < 50us) */ -+ if (us <= 50) -+ rtw_udelay_os(us); -+ else if (us <= 1000) -+ rtw_usleep_os(us); -+ else -+ rtw_msleep_os(RTW_DIV_ROUND_UP(us, 1000)); -+} -+ -+static u8 _halmac_mutex_init(void *p, HALMAC_MUTEX *pMutex) -+{ -+ _rtw_mutex_init(pMutex); -+ return RTW_HALMAC_SUCCESS; -+} -+ -+static u8 _halmac_mutex_deinit(void *p, HALMAC_MUTEX *pMutex) -+{ -+ _rtw_mutex_free(pMutex); -+ return RTW_HALMAC_SUCCESS; -+} -+ -+static u8 _halmac_mutex_lock(void *p, HALMAC_MUTEX *pMutex) -+{ -+ int err; -+ -+ err = _enter_critical_mutex(pMutex, NULL); -+ if (err) -+ return RTW_HALMAC_FAIL; -+ -+ return RTW_HALMAC_SUCCESS; -+} -+ -+static u8 _halmac_mutex_unlock(void *p, HALMAC_MUTEX *pMutex) -+{ -+ _exit_critical_mutex(pMutex, NULL); -+ return RTW_HALMAC_SUCCESS; -+} -+ -+#ifndef CONFIG_SDIO_HCI -+#define DBG_MSG_FILTER -+#endif -+ -+#ifdef DBG_MSG_FILTER -+static u8 is_msg_allowed(uint drv_lv, u8 msg_lv) -+{ -+ switch (drv_lv) { -+ case _DRV_NONE_: -+ return _FALSE; -+ -+ case _DRV_ALWAYS_: -+ if (msg_lv > HALMAC_DBG_ALWAYS) -+ return _FALSE; -+ break; -+ case _DRV_ERR_: -+ if (msg_lv > HALMAC_DBG_ERR) -+ return _FALSE; -+ break; -+ case _DRV_WARNING_: -+ if (msg_lv > HALMAC_DBG_WARN) -+ return _FALSE; -+ break; -+ case _DRV_INFO_: -+ if (msg_lv >= HALMAC_DBG_TRACE) -+ return _FALSE; -+ break; -+ } -+ -+ return _TRUE; -+} -+#endif /* DBG_MSG_FILTER */ -+ -+static u8 _halmac_msg_print(void *p, u32 msg_type, u8 msg_level, s8 *fmt, ...) -+{ -+#define MSG_LEN 100 -+ va_list args; -+ u8 str[MSG_LEN] = {0}; -+#ifdef DBG_MSG_FILTER -+ uint drv_level = _DRV_NONE_; -+#endif -+ int err; -+ u8 ret = RTW_HALMAC_SUCCESS; -+ -+ -+#ifdef DBG_MSG_FILTER -+#ifdef CONFIG_RTW_DEBUG -+ drv_level = rtw_drv_log_level; -+#endif -+ if (is_msg_allowed(drv_level, msg_level) == _FALSE) -+ return ret; -+#endif -+ -+ str[0] = '\n'; -+ va_start(args, fmt); -+ err = vsnprintf(str, MSG_LEN, fmt, args); -+ va_end(args); -+ -+ /* An output error is encountered */ -+ if (err < 0) -+ return RTW_HALMAC_FAIL; -+ /* Output may be truncated due to size limit */ -+ if ((err == (MSG_LEN - 1)) && (str[MSG_LEN - 2] != '\n')) -+ ret = RTW_HALMAC_FAIL; -+ -+ if (msg_level == HALMAC_DBG_ALWAYS) -+ RTW_PRINT(MSG_PREFIX "%s", str); -+ else 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 ret; -+} -+ -+static u8 _halmac_buff_print(void *p, u32 msg_type, u8 msg_level, s8 *buf, u32 size) -+{ -+ if (msg_level <= HALMAC_DBG_WARN) -+ RTW_INFO_DUMP(MSG_PREFIX, buf, size); -+ else -+ RTW_DBG_DUMP(MSG_PREFIX, buf, size); -+ -+ return RTW_HALMAC_SUCCESS; -+} -+ -+ -+const char *const RTW_HALMAC_FEATURE_NAME[] = { -+ "HALMAC_FEATURE_CFG_PARA", -+ "HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE", -+ "HALMAC_FEATURE_DUMP_LOGICAL_EFUSE", -+ "HALMAC_FEATURE_DUMP_LOGICAL_EFUSE_MASK", -+ "HALMAC_FEATURE_UPDATE_PACKET", -+ "HALMAC_FEATURE_SEND_SCAN_PACKET", -+ "HALMAC_FEATURE_DROP_SCAN_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_FW_SNDING", -+ "HALMAC_FEATURE_DPK", -+ "HALMAC_FEATURE_ALL" -+}; -+ -+static inline u8 is_valid_id_status(enum halmac_feature_id id, enum halmac_cmd_process_status status) -+{ -+ switch (id) { -+ case HALMAC_FEATURE_CFG_PARA: -+ RTW_DBG("%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]); -+ if (status != HALMAC_CMD_PROCESS_DONE) -+ RTW_INFO("%s: id(%d) unspecified status(%d)!\n", -+ __FUNCTION__, id, status); -+ 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]); -+ if ((status != HALMAC_CMD_PROCESS_DONE) && (status != HALMAC_CMD_PROCESS_RCVD)) -+ RTW_INFO("%s: id(%d) unspecified status(%d)!\n", -+ __FUNCTION__, id, status); -+ if (status == HALMAC_CMD_PROCESS_DONE) -+ return _FALSE; -+ 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_FW_SNDING: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ case HALMAC_FEATURE_DPK: -+ if (status == HALMAC_CMD_PROCESS_RCVD) -+ return _FALSE; -+ if ((status != HALMAC_CMD_PROCESS_DONE) -+ && (status != HALMAC_CMD_PROCESS_ERROR)) -+ RTW_WARN("%s: %s unexpected status(0x%x)!\n", -+ __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id], -+ status); -+ break; -+ case HALMAC_FEATURE_ALL: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ default: -+ RTW_ERR("%s: unknown feature id(%d)\n", __FUNCTION__, id); -+ return _FALSE; -+ } -+ -+ return _TRUE; -+} -+ -+static int init_halmac_event_with_waittime(struct dvobj_priv *d, enum 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_WARN("%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, enum 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, enum 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, enum halmac_feature_id id) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ struct submit_ctx *sctx; -+ int status; -+ int ret; -+ -+ -+ sctx = d->hmpriv.indicator[id].sctx; -+ if (!sctx) -+ return -1; -+ -+ ret = rtw_sctx_wait(sctx, RTW_HALMAC_FEATURE_NAME[id]); -+ status = sctx->status; -+ free_halmac_event(d, id); -+ if (_SUCCESS == ret) -+ return 0; -+ -+ /* If no one change sctx->status, it is timeout case */ -+ if (status == 0) -+ status = RTW_SCTX_DONE_TIMEOUT; -+ RTW_ERR("%s: id(%d, %s) status=0x%x ! Reset HALMAC state!\n", -+ __FUNCTION__, id, RTW_HALMAC_FEATURE_NAME[id], status); -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ api->halmac_reset_feature(mac, id); -+ -+ return -1; -+} -+ -+/* -+ * Return: -+ * Always return RTW_HALMAC_SUCCESS, HALMAC don't care the return value. -+ */ -+static u8 _halmac_event_indication(void *p, enum halmac_feature_id feature_id, -+ enum 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 = dvobj_get_primary_adapter(d); -+ hal = GET_HAL_DATA(adapter); -+ tbl = d->hmpriv.indicator; -+ -+ /* Filter(Skip) middle status indication */ -+ 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_WARN("%s: id(%d, %s) is not waiting!!\n", __FUNCTION__, -+ feature_id, RTW_HALMAC_FEATURE_NAME[feature_id]); -+ goto exit; -+ } -+ sctx = indicator->sctx; -+ -+ if (HALMAC_CMD_PROCESS_ERROR == process_status) { -+ RTW_ERR("%s: id(%d, %s) Something wrong!!\n", __FUNCTION__, -+ feature_id, RTW_HALMAC_FEATURE_NAME[feature_id]); -+ if ((size == 1) && buf) -+ RTW_ERR("%s: error code=0x%x\n", __FUNCTION__, *buf); -+ rtw_sctx_done_err(&sctx, RTW_SCTX_DONE_UNKNOWN); -+ goto exit; -+ } -+ -+ if (size > indicator->buf_size) { -+ RTW_WARN("%s: id(%d, %s) buffer is not enough(%d<%d), " -+ "and data will be truncated!\n", -+ __FUNCTION__, -+ feature_id, RTW_HALMAC_FEATURE_NAME[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 RTW_HALMAC_SUCCESS; -+} -+ -+struct 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, -+ .SDIO_CMD52_CIA_READ = _halmac_sdio_read_cia, -+#endif /* CONFIG_SDIO_HCI */ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_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_PCI_HCI */ -+ -+#ifdef DBG_IO -+ .READ_MONITOR = _halmac_reg_read_monitor, -+ .WRITE_MONITOR = _halmac_reg_write_monitor, -+#endif -+ -+ /* 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_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); -+} -+ -+static void _read_register(struct dvobj_priv *d, u32 addr, u32 cnt, u8 *buf) -+{ -+#if 1 -+ struct _ADAPTER *a; -+ u32 i, n; -+ u16 val16; -+ u32 val32; -+ -+ -+ a = dvobj_get_primary_adapter(d); -+ -+ i = addr & 0x3; -+ /* Handle address not start from 4 bytes alignment case */ -+ if (i) { -+ val32 = cpu_to_le32(rtw_read32(a, addr & ~0x3)); -+ n = 4 - i; -+ _rtw_memcpy(buf, ((u8 *)&val32) + i, n); -+ i = n; -+ cnt -= n; -+ } -+ -+ while (cnt) { -+ if (cnt >= 4) -+ n = 4; -+ else if (cnt >= 2) -+ n = 2; -+ else -+ n = 1; -+ cnt -= n; -+ -+ switch (n) { -+ case 1: -+ buf[i] = rtw_read8(a, addr+i); -+ i++; -+ break; -+ case 2: -+ val16 = cpu_to_le16(rtw_read16(a, addr+i)); -+ _rtw_memcpy(&buf[i], &val16, 2); -+ i += 2; -+ break; -+ case 4: -+ val32 = cpu_to_le32(rtw_read32(a, addr+i)); -+ _rtw_memcpy(&buf[i], &val32, 4); -+ i += 4; -+ break; -+ } -+ } -+#else -+ struct _ADAPTER *a; -+ u32 i; -+ -+ -+ a = dvobj_get_primary_adapter(d); -+ for (i = 0; i < cnt; i++) -+ buf[i] = rtw_read8(a, addr + i); -+#endif -+} -+ -+#ifdef CONFIG_SDIO_HCI -+static int _sdio_read_local(struct dvobj_priv *d, u32 addr, u32 cnt, u8 *buf) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ -+ -+ if (buf == NULL) -+ return -1; -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_reg_sdio_cmd53_read_n(mac, addr, cnt, buf); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: addr=0x%08x cnt=%d err=%d\n", -+ __FUNCTION__, addr, cnt, status); -+ return -1; -+ } -+ -+ return 0; -+} -+#endif /* CONFIG_SDIO_HCI */ -+ -+void rtw_halmac_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem) -+{ -+ struct dvobj_priv *d; -+ -+ -+ if (pmem == NULL) { -+ RTW_ERR("pmem is NULL\n"); -+ return; -+ } -+ -+ d = pintfhdl->pintf_dev; -+ -+#ifdef CONFIG_SDIO_HCI -+ if (addr & 0xFFFF0000) { -+ int err = 0; -+ -+ err = _sdio_read_local(d, addr, cnt, pmem); -+ if (!err) -+ return; -+ } -+#endif /* CONFIG_SDIO_HCI */ -+ -+ _read_register(d, addr, cnt, pmem); -+} -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 rtw_halmac_iread8(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_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 /* CONFIG_SDIO_INDIRECT_ACCESS */ -+ -+int rtw_halmac_write8(struct intf_hdl *pintfhdl, u32 addr, u8 value) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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_write_rsvd_page_size(struct dvobj_priv *d) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ u32 size = 0; -+ struct halmac_ofld_func_info ofld_info; -+ enum halmac_ret_status status; -+ int err = 0; -+ -+ -+#ifdef CONFIG_USB_HCI -+ /* for USB do not exceed MAX_CMDBUF_SZ */ -+ size = 0x1000; -+#elif defined(CONFIG_PCI_HCI) -+ size = MAX_CMDBUF_SZ - TXDESC_OFFSET; -+#elif defined(CONFIG_SDIO_HCI) -+ size = 0x7000; /* 28KB */ -+#else -+ /* Use HALMAC default setting and don't call any function */ -+ return 0; -+#endif -+#if 0 /* Fail to pass coverity DEADCODE check */ -+ /* If size==0, use HALMAC default setting and don't call any function */ -+ if (!size) -+ return 0; -+#endif -+ err = rtw_halmac_set_max_dl_fw_size(d, size); -+ if (err) { -+ RTW_ERR("%s: Fail to set max download fw size!\n", __FUNCTION__); -+ return -1; -+ } -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ _rtw_memset(&ofld_info, 0, sizeof(ofld_info)); -+ ofld_info.halmac_malloc_max_sz = 0xFFFFFFFF; -+ ofld_info.rsvd_pg_drv_buf_max_sz = size; -+ status = api->halmac_ofld_func_cfg(mac, &ofld_info); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: Fail to config offload parameters!\n", __FUNCTION__); -+ return -1; -+ } -+ -+ return 0; -+} -+ -+static int init_priv(struct halmacpriv *priv) -+{ -+ struct halmac_indicator *indicator; -+ u32 count, size; -+ -+ -+ if (priv->indicator) -+ RTW_WARN("%s: HALMAC private data is not CLEAR!\n", __FUNCTION__); -+ 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_WARN("%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); -+ } -+} -+ -+#ifdef CONFIG_SDIO_HCI -+static enum halmac_sdio_spec_ver _sdio_ver_drv2halmac(struct dvobj_priv *d) -+{ -+ bool v3; -+ enum halmac_sdio_spec_ver ver; -+ -+ -+ v3 = rtw_is_sdio30(dvobj_get_primary_adapter(d)); -+ if (v3) -+ ver = HALMAC_SDIO_SPEC_VER_3_00; -+ else -+ ver = HALMAC_SDIO_SPEC_VER_2_00; -+ -+ return ver; -+} -+#endif /* CONFIG_SDIO_HCI */ -+ -+void rtw_halmac_get_version(char *str, u32 len) -+{ -+ enum halmac_ret_status status; -+ struct halmac_ver ver; -+ -+ -+ status = halmac_get_version(&ver); -+ if (status != HALMAC_RET_SUCCESS) -+ return; -+ -+ rtw_sprintf(str, len, "V%d_%02d_%02d_%02d", -+ ver.major_ver, ver.prototype_ver, ver.minor_ver, HALMAC_PATCH_VER); -+} -+ -+int rtw_halmac_init_adapter(struct dvobj_priv *d, struct halmac_platform_api *pf_api) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_interface intf; -+ enum halmac_intf_phy_platform pltfm = HALMAC_INTF_PHY_PLATFORM_ALL; -+ enum halmac_ret_status status; -+ int err = 0; -+#ifdef CONFIG_SDIO_HCI -+ struct halmac_sdio_hw_info info; -+#endif /* CONFIG_SDIO_HCI */ -+ -+ -+ halmac = dvobj_to_halmac(d); -+ if (halmac) { -+ RTW_WARN("%s: initialize already completed!\n", __FUNCTION__); -+ goto error; -+ } -+ -+ err = init_priv(&d->hmpriv); -+ if (err) -+ goto error; -+ -+#ifdef CONFIG_SDIO_HCI -+ intf = HALMAC_INTERFACE_SDIO; -+#elif defined(CONFIG_USB_HCI) -+ intf = HALMAC_INTERFACE_USB; -+#elif defined(CONFIG_PCI_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_ERR("%s: halmac_init_adapter fail!(status=%d)\n", __FUNCTION__, status); -+ err = -1; -+ if (halmac) -+ goto deinit; -+ goto free; -+ } -+ -+ dvobj_set_halmac(d, halmac); -+ -+ status = api->halmac_interface_integration_tuning(halmac); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: halmac_interface_integration_tuning fail!(status=%d)\n", __FUNCTION__, status); -+ err = -1; -+ goto deinit; -+ } -+ -+#ifdef CONFIG_PLATFORM_RTK1319 -+ pltfm = HALMAC_INTF_PHY_PLATFORM_DHC; -+#endif /* CONFIG_PLATFORM_RTK1319 */ -+ status = api->halmac_phy_cfg(halmac, pltfm); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: halmac_phy_cfg fail! (platform=%d, status=%d)\n", -+ __FUNCTION__, pltfm, status); -+ err = -1; -+ goto deinit; -+ } -+ -+ init_write_rsvd_page_size(d); -+ -+#ifdef CONFIG_SDIO_HCI -+ _rtw_memset(&info, 0, sizeof(info)); -+ info.spec_ver = _sdio_ver_drv2halmac(d); -+ /* Convert clock speed unit to MHz from Hz */ -+ info.clock_speed = RTW_DIV_ROUND_UP(rtw_sdio_get_clock(d), 1000000); -+ info.block_size = rtw_sdio_get_block_size(d); -+ if (d->hmpriv.sdio_io_indir == 2) -+ info.io_indir_flag = 0; -+ else -+ info.io_indir_flag = 1; /* Default enable indirect I/O */ -+ RTW_DBG("%s: SDIO ver=%u clock=%uMHz blk_size=%u bytes, io_indir=%u\n", -+ __FUNCTION__, info.spec_ver+2, info.clock_speed, -+ info.block_size, info.io_indir_flag); -+ status = api->halmac_sdio_hw_info(halmac, &info); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: halmac_sdio_hw_info fail!(status=%d)\n", -+ __FUNCTION__, status); -+ err = -1; -+ goto deinit; -+ } -+#endif /* CONFIG_SDIO_HCI */ -+ -+ return 0; -+ -+deinit: -+ status = halmac_deinit_adapter(halmac); -+ dvobj_set_halmac(d, NULL); -+ if (status != HALMAC_RET_SUCCESS) -+ RTW_ERR("%s: halmac_deinit_adapter fail!(status=%d)\n", -+ __FUNCTION__, status); -+ -+free: -+ deinit_priv(&d->hmpriv); -+ -+error: -+ return err; -+} -+ -+int rtw_halmac_deinit_adapter(struct dvobj_priv *d) -+{ -+ struct halmac_adapter *halmac; -+ enum halmac_ret_status status; -+ int err = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ if (halmac) { -+ status = halmac_deinit_adapter(halmac); -+ dvobj_set_halmac(d, NULL); -+ if (status != HALMAC_RET_SUCCESS) -+ err = -1; -+ } -+ -+ deinit_priv(&d->hmpriv); -+ -+ return err; -+} -+ -+static inline enum halmac_portid _hw_port_drv2halmac(enum _hw_port hwport) -+{ -+ enum halmac_portid port = HALMAC_PORTID_NUM; -+ -+ -+ switch (hwport) { -+ case HW_PORT0: -+ port = HALMAC_PORTID0; -+ break; -+ case HW_PORT1: -+ port = HALMAC_PORTID1; -+ break; -+ case HW_PORT2: -+ port = HALMAC_PORTID2; -+ break; -+ case HW_PORT3: -+ port = HALMAC_PORTID3; -+ break; -+ case HW_PORT4: -+ port = HALMAC_PORTID4; -+ break; -+ default: -+ break; -+ } -+ -+ return port; -+} -+ -+static enum halmac_network_type_select _network_type_drv2halmac(u8 type) -+{ -+ enum halmac_network_type_select network = HALMAC_NETWORK_UNDEFINE; -+ -+ -+ switch (type) { -+ case _HW_STATE_NOLINK_: -+ case _HW_STATE_MONITOR_: -+ network = HALMAC_NETWORK_NO_LINK; -+ break; -+ -+ case _HW_STATE_ADHOC_: -+ network = HALMAC_NETWORK_ADHOC; -+ break; -+ -+ case _HW_STATE_STATION_: -+ network = HALMAC_NETWORK_INFRASTRUCTURE; -+ break; -+ -+ case _HW_STATE_AP_: -+ network = HALMAC_NETWORK_AP; -+ break; -+ } -+ -+ return network; -+} -+ -+static u8 _network_type_halmac2drv(enum halmac_network_type_select network) -+{ -+ u8 type = _HW_STATE_NOLINK_; -+ -+ -+ switch (network) { -+ case HALMAC_NETWORK_NO_LINK: -+ case HALMAC_NETWORK_UNDEFINE: -+ type = _HW_STATE_NOLINK_; -+ break; -+ -+ case HALMAC_NETWORK_ADHOC: -+ type = _HW_STATE_ADHOC_; -+ break; -+ -+ case HALMAC_NETWORK_INFRASTRUCTURE: -+ type = _HW_STATE_STATION_; -+ break; -+ -+ case HALMAC_NETWORK_AP: -+ type = _HW_STATE_AP_; -+ break; -+ } -+ -+ return type; -+} -+ -+static void _beacon_ctrl_halmac2drv(struct halmac_bcn_ctrl *ctrl, -+ struct rtw_halmac_bcn_ctrl *drv_ctrl) -+{ -+ drv_ctrl->rx_bssid_fit = ctrl->dis_rx_bssid_fit ? 0 : 1; -+ drv_ctrl->txbcn_rpt = ctrl->en_txbcn_rpt ? 1 : 0; -+ drv_ctrl->tsf_update = ctrl->dis_tsf_udt ? 0 : 1; -+ drv_ctrl->enable_bcn = ctrl->en_bcn ? 1 : 0; -+ drv_ctrl->rxbcn_rpt = ctrl->en_rxbcn_rpt ? 1 : 0; -+ drv_ctrl->p2p_ctwin = ctrl->en_p2p_ctwin ? 1 : 0; -+ drv_ctrl->p2p_bcn_area = ctrl->en_p2p_bcn_area ? 1 : 0; -+} -+ -+static void _beacon_ctrl_drv2halmac(struct rtw_halmac_bcn_ctrl *drv_ctrl, -+ struct halmac_bcn_ctrl *ctrl) -+{ -+ ctrl->dis_rx_bssid_fit = drv_ctrl->rx_bssid_fit ? 0 : 1; -+ ctrl->en_txbcn_rpt = drv_ctrl->txbcn_rpt ? 1 : 0; -+ ctrl->dis_tsf_udt = drv_ctrl->tsf_update ? 0 : 1; -+ ctrl->en_bcn = drv_ctrl->enable_bcn ? 1 : 0; -+ ctrl->en_rxbcn_rpt = drv_ctrl->rxbcn_rpt ? 1 : 0; -+ ctrl->en_p2p_ctwin = drv_ctrl->p2p_ctwin ? 1 : 0; -+ ctrl->en_p2p_bcn_area = drv_ctrl->p2p_bcn_area ? 1 : 0; -+} -+ -+int rtw_halmac_get_hw_value(struct dvobj_priv *d, enum halmac_hw_id hw_id, void *pvalue) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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; -+} -+ -+/** -+ * rtw_halmac_get_tx_fifo_size() - TX FIFO size -+ * @d: struct dvobj_priv* -+ * @size: TX FIFO size, unit is byte. -+ * -+ * Get TX FIFO size(byte) from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_tx_fifo_size(struct dvobj_priv *d, u32 *size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_TXFIFO_SIZE, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *size = val; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_get_rx_fifo_size() - RX FIFO size -+ * @d: struct dvobj_priv* -+ * @size: RX FIFO size, unit is byte -+ * -+ * Get RX FIFO size(byte) from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_rx_fifo_size(struct dvobj_priv *d, u32 *size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_RXFIFO_SIZE, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *size = val; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_get_rsvd_drv_pg_bndy() - Reserve page boundary of driver -+ * @d: struct dvobj_priv* -+ * @size: Page size, unit is byte -+ * -+ * Get reserve page boundary of driver from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *d, u16 *bndy) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u16 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_RSVD_PG_BNDY, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *bndy = val; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_get_page_size() - Page size -+ * @d: struct dvobj_priv* -+ * @size: Page size, unit is byte -+ * -+ * Get TX/RX page size(byte) from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_page_size(struct dvobj_priv *d, u32 *size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_PAGE_SIZE, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *size = val; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_get_tx_agg_align_size() - TX aggregation align size -+ * @d: struct dvobj_priv* -+ * @size: TX aggregation align size, unit is byte -+ * -+ * Get TX aggregation align size(byte) from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_tx_agg_align_size(struct dvobj_priv *d, u16 *size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u16 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_TX_AGG_ALIGN_SIZE, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *size = val; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_get_rx_agg_align_size() - RX aggregation align size -+ * @d: struct dvobj_priv* -+ * @size: RX aggregation align size, unit is byte -+ * -+ * Get RX aggregation align size(byte) from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_rx_agg_align_size(struct dvobj_priv *d, u8 *size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u8 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_RX_AGG_ALIGN_SIZE, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *size = val; -+ -+ return 0; -+} -+ -+/* -+ * 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. -+ * -+ * Return: -+ * 0 Success -+ * other Fail -+ */ -+int rtw_halmac_get_rx_drv_info_sz(struct dvobj_priv *d, u8 *sz) -+{ -+ enum halmac_ret_status status; -+ struct halmac_adapter *halmac = dvobj_to_halmac(d); -+ struct halmac_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; -+} -+ -+/** -+ * rtw_halmac_get_tx_desc_size() - TX descriptor size -+ * @d: struct dvobj_priv* -+ * @size: TX descriptor size, unit is byte. -+ * -+ * Get TX descriptor size(byte) from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_tx_desc_size(struct dvobj_priv *d, u32 *size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_TX_DESC_SIZE, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *size = val; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_get_rx_desc_size() - RX descriptor size -+ * @d: struct dvobj_priv* -+ * @size: RX descriptor size, unit is byte. -+ * -+ * Get RX descriptor size(byte) from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_rx_desc_size(struct dvobj_priv *d, u32 *size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_RX_DESC_SIZE, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *size = val; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_get_tx_dma_ch_map() - Get TX DMA channel Map for tx desc -+ * @d: struct dvobj_priv* -+ * @dma_ch_map: return map of QSEL to DMA channel -+ * @map_size: size of dma_ch_map -+ * Suggest size to be last valid QSEL(QSLT_CMD)+1 or full QSLT -+ * size(0x20) -+ * -+ * 8814B would need this to get mapping of QSEL to DMA channel for TX desc. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_tx_dma_ch_map(struct dvobj_priv *d, u8 *dma_ch_map, u8 map_size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ struct halmac_rqpn_ch_map map; -+ enum halmac_dma_ch channel = HALMAC_DMA_CH_UNDEFINE; -+ u8 qsel; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_RQPN_CH_MAPPING, &map); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ for (qsel = 0; qsel < map_size; qsel++) { -+ switch (qsel) { -+ /*case QSLT_VO:*/ -+ case 0x06: -+ case 0x07: -+ channel = map.dma_map_vo; -+ break; -+ /*case QSLT_VI:*/ -+ case 0x04: -+ case 0x05: -+ channel = map.dma_map_vi; -+ break; -+ /*case QSLT_BE:*/ -+ case 0x00: -+ case 0x03: -+ channel = map.dma_map_be; -+ break; -+ /*case QSLT_BK:*/ -+ case 0x01: -+ case 0x02: -+ channel = map.dma_map_bk; -+ break; -+ /*case QSLT_BEACON:*/ -+ case 0x10: -+ channel = HALMAC_DMA_CH_BCN; -+ break; -+ /*case QSLT_HIGH:*/ -+ case 0x11: -+ channel = map.dma_map_hi; -+ break; -+ /*case QSLT_MGNT:*/ -+ case 0x12: -+ channel = map.dma_map_mg; -+ break; -+ /*case QSLT_CMD:*/ -+ case 0x13: -+ channel = HALMAC_DMA_CH_H2C; -+ break; -+ default: -+ /*RTW_ERR("%s: invalid qsel=0x%x\n", __FUNCTION__, qsel);*/ -+ channel = HALMAC_DMA_CH_UNDEFINE; -+ break; -+ } -+ dma_ch_map[qsel] = (u8)channel; -+ } -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_get_fw_max_size() - Firmware MAX size -+ * @d: struct dvobj_priv* -+ * @size: MAX Firmware size, unit is byte. -+ * -+ * Get Firmware MAX size(byte) from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+static int rtw_halmac_get_fw_max_size(struct dvobj_priv *d, u32 *size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_FW_MAX_SIZE, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *size = val; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_get_ori_h2c_size() - Original H2C MAX size -+ * @d: struct dvobj_priv* -+ * @size: H2C MAX size, unit is byte. -+ * -+ * Get original H2C MAX size(byte) from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_ori_h2c_size(struct dvobj_priv *d, u32 *size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_ORI_H2C_SIZE, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *size = val; -+ -+ return 0; -+} -+ -+int rtw_halmac_get_oqt_size(struct dvobj_priv *d, u8 *size) -+{ -+ enum halmac_ret_status status; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ u8 val; -+ -+ -+ if (!size) -+ return -1; -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_AC_OQT_SIZE, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *size = val; -+ return 0; -+} -+ -+int rtw_halmac_get_ac_queue_number(struct dvobj_priv *d, u8 *num) -+{ -+ enum halmac_ret_status status; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ u8 val; -+ -+ -+ if (!num) -+ return -1; -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_AC_QUEUE_NUM, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *num = val; -+ return 0; -+} -+ -+/** -+ * rtw_halmac_get_mac_address() - Get MAC address of specific port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * @addr: buffer for storing MAC address -+ * -+ * Get MAC address of specific port from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ union halmac_wlan_addr hwa; -+ enum halmac_ret_status status; -+ int err = -1; -+ -+ -+ if (!addr) -+ goto out; -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ port = _hw_port_drv2halmac(hwport); -+ _rtw_memset(&hwa, 0, sizeof(hwa)); -+ -+ status = api->halmac_get_mac_addr(halmac, port, &hwa); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ _rtw_memcpy(addr, hwa.addr, 6); -+ -+ err = 0; -+out: -+ return err; -+} -+ -+/** -+ * rtw_halmac_get_network_type() - Get network type of specific port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * @type: buffer to put network type (_HW_STATE_*) -+ * -+ * Get network type of specific port from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_network_type(struct dvobj_priv *d, enum _hw_port hwport, u8 *type) -+{ -+#if 0 -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ enum halmac_network_type_select network; -+ enum halmac_ret_status status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ port = _hw_port_drv2halmac(hwport); -+ network = HALMAC_NETWORK_UNDEFINE; -+ -+ status = api->halmac_get_net_type(halmac, port, &network); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ *type = _network_type_halmac2drv(network); -+ -+ err = 0; -+out: -+ return err; -+#else -+ struct _ADAPTER *a; -+ enum halmac_portid port; -+ enum halmac_network_type_select network; -+ u32 val; -+ int err = -1; -+ -+ -+ a = dvobj_get_primary_adapter(d); -+ port = _hw_port_drv2halmac(hwport); -+ network = HALMAC_NETWORK_UNDEFINE; -+ -+ switch (port) { -+ case HALMAC_PORTID0: -+ val = rtw_read32(a, REG_CR); -+ network = BIT_GET_NETYPE0(val); -+ break; -+ -+ case HALMAC_PORTID1: -+ val = rtw_read32(a, REG_CR); -+ network = BIT_GET_NETYPE1(val); -+ break; -+ -+ case HALMAC_PORTID2: -+ val = rtw_read32(a, REG_CR_EXT); -+ network = BIT_GET_NETYPE2(val); -+ break; -+ -+ case HALMAC_PORTID3: -+ val = rtw_read32(a, REG_CR_EXT); -+ network = BIT_GET_NETYPE3(val); -+ break; -+ -+ case HALMAC_PORTID4: -+ val = rtw_read32(a, REG_CR_EXT); -+ network = BIT_GET_NETYPE4(val); -+ break; -+ -+ default: -+ goto out; -+ } -+ -+ *type = _network_type_halmac2drv(network); -+ -+ err = 0; -+out: -+ return err; -+#endif -+} -+ -+/** -+ * rtw_halmac_get_bcn_ctrl() - Get beacon control setting of specific port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * @bcn_ctrl: setting of beacon control -+ * -+ * Get beacon control setting of specific port from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_get_bcn_ctrl(struct dvobj_priv *d, enum _hw_port hwport, -+ struct rtw_halmac_bcn_ctrl *bcn_ctrl) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ struct halmac_bcn_ctrl ctrl; -+ enum halmac_ret_status status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ port = _hw_port_drv2halmac(hwport); -+ _rtw_memset(&ctrl, 0, sizeof(ctrl)); -+ -+ status = api->halmac_rw_bcn_ctrl(halmac, port, 0, &ctrl); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ _beacon_ctrl_halmac2drv(&ctrl, bcn_ctrl); -+ -+ 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, enum halmac_drv_info info) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum 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: -+ /* Sync driver RCR cache with register setting */ -+ rtw_hal_get_hwreg(dvobj_get_primary_adapter(d), HW_VAR_RCR, NULL); -+ -+ return err; -+} -+ -+/** -+ * rtw_halmac_set_max_dl_fw_size() - Set the MAX download firmware size -+ * @d: struct dvobj_priv* -+ * @size: the max download firmware size in one I/O -+ * -+ * Set the max download firmware size in one I/O. -+ * Please also consider the max size of the callback function "SEND_RSVD_PAGE" -+ * could accept, because download firmware would call "SEND_RSVD_PAGE" to send -+ * firmware to IC. -+ * -+ * If the value of "size" is not even, it would be rounded down to nearest -+ * even, and 0 and 1 are both invalid value. -+ * -+ * Return 0 for setting OK, otherwise fail. -+ */ -+int rtw_halmac_set_max_dl_fw_size(struct dvobj_priv *d, u32 size) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ -+ -+ if (!size || (size == 1)) -+ return -1; -+ -+ mac = dvobj_to_halmac(d); -+ if (!mac) { -+ RTW_ERR("%s: HALMAC is not ready!!\n", __FUNCTION__); -+ return -1; -+ } -+ api = HALMAC_GET_API(mac); -+ -+ size &= ~1; /* round down to even */ -+ status = api->halmac_cfg_max_dl_size(mac, size); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_WARN("%s: Fail to cfg_max_dl_size(%d), err=%d!!\n", -+ __FUNCTION__, size, status); -+ return -1; -+ } -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_set_mac_address() - Set mac address of specific port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * @addr: mac address -+ * -+ * Set self mac address of specific port to HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_set_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ union halmac_wlan_addr hwa; -+ enum 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.addr, addr, 6); -+ -+ status = api->halmac_cfg_mac_addr(halmac, port, &hwa); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+/** -+ * rtw_halmac_set_bssid() - Set BSSID of specific port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * @addr: BSSID, mac address of AP -+ * -+ * Set BSSID of specific port to HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_set_bssid(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ union halmac_wlan_addr hwa; -+ enum 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.addr, addr, 6); -+ status = api->halmac_cfg_bssid(halmac, port, &hwa); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+/** -+ * rtw_halmac_set_tx_address() - Set transmitter address of specific port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * @addr: transmitter address -+ * -+ * Set transmitter address of specific port to HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_set_tx_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ union halmac_wlan_addr hwa; -+ enum 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.addr, addr, 6); -+ -+ status = api->halmac_cfg_transmitter_addr(halmac, port, &hwa); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+/** -+ * rtw_halmac_set_network_type() - Set network type of specific port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * @type: network type (_HW_STATE_*) -+ * -+ * Set network type of specific port to HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_set_network_type(struct dvobj_priv *d, enum _hw_port hwport, u8 type) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ enum halmac_network_type_select network; -+ enum halmac_ret_status status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ port = _hw_port_drv2halmac(hwport); -+ network = _network_type_drv2halmac(type); -+ -+ status = api->halmac_cfg_net_type(halmac, port, network); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+/** -+ * rtw_halmac_reset_tsf() - Reset TSF timer of specific port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * -+ * Notice HALMAC to reset timing synchronization function(TSF) timer of -+ * specific port. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_reset_tsf(struct dvobj_priv *d, enum _hw_port hwport) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ enum halmac_ret_status status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ port = _hw_port_drv2halmac(hwport); -+ -+ status = api->halmac_cfg_tsf_rst(halmac, port); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+/** -+ * rtw_halmac_set_bcn_interval() - Set beacon interval of each port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * @space: beacon interval, unit is ms -+ * -+ * Set beacon interval of specific port to HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_set_bcn_interval(struct dvobj_priv *d, enum _hw_port hwport, -+ u32 interval) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ enum halmac_ret_status status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ port = _hw_port_drv2halmac(hwport); -+ -+ status = api->halmac_cfg_bcn_space(halmac, port, interval); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+/** -+ * rtw_halmac_set_bcn_ctrl() - Set beacon control setting of each port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * @bcn_ctrl: setting of beacon control -+ * -+ * Set beacon control setting of specific port to HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_set_bcn_ctrl(struct dvobj_priv *d, enum _hw_port hwport, -+ struct rtw_halmac_bcn_ctrl *bcn_ctrl) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ struct halmac_bcn_ctrl ctrl; -+ enum halmac_ret_status status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ port = _hw_port_drv2halmac(hwport); -+ _rtw_memset(&ctrl, 0, sizeof(ctrl)); -+ _beacon_ctrl_drv2halmac(bcn_ctrl, &ctrl); -+ -+ status = api->halmac_rw_bcn_ctrl(halmac, port, 1, &ctrl); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+/** -+ * rtw_halmac_set_aid() - Set association identifier(AID) of specific port -+ * @d: struct dvobj_priv* -+ * @hwport: port -+ * @aid: Association identifier -+ * -+ * Set association identifier(AID) of specific port to HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_set_aid(struct dvobj_priv *d, enum _hw_port hwport, u16 aid) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_portid port; -+ enum halmac_ret_status status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ port = _hw_port_drv2halmac(hwport); -+ -+#if 0 -+ status = api->halmac_cfg_aid(halmac, port, aid); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+#else -+{ -+ struct _ADAPTER *a; -+ u32 addr; -+ u16 val; -+ -+ a = dvobj_get_primary_adapter(d); -+ -+ switch (port) { -+ case 0: -+ addr = REG_BCN_PSR_RPT; -+ val = rtw_read16(a, addr); -+ val = BIT_SET_PS_AID_0(val, aid); -+ rtw_write16(a, addr, val); -+ break; -+ -+ case 1: -+ addr = REG_BCN_PSR_RPT1; -+ val = rtw_read16(a, addr); -+ val = BIT_SET_PS_AID_1(val, aid); -+ rtw_write16(a, addr, val); -+ break; -+ -+ case 2: -+ addr = REG_BCN_PSR_RPT2; -+ val = rtw_read16(a, addr); -+ val = BIT_SET_PS_AID_2(val, aid); -+ rtw_write16(a, addr, val); -+ break; -+ -+ case 3: -+ addr = REG_BCN_PSR_RPT3; -+ val = rtw_read16(a, addr); -+ val = BIT_SET_PS_AID_3(val, aid); -+ rtw_write16(a, addr, val); -+ break; -+ -+ case 4: -+ addr = REG_BCN_PSR_RPT4; -+ val = rtw_read16(a, addr); -+ val = BIT_SET_PS_AID_4(val, aid); -+ rtw_write16(a, addr, val); -+ break; -+ -+ default: -+ goto out; -+ } -+} -+#endif -+ -+ err = 0; -+out: -+ return err; -+} -+ -+int rtw_halmac_set_bandwidth(struct dvobj_priv *d, u8 channel, u8 pri_ch_idx, u8 bw) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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; -+} -+ -+/** -+ * rtw_halmac_set_edca() - config edca parameter -+ * @d: struct dvobj_priv* -+ * @queue: XMIT_[VO/VI/BE/BK]_QUEUE -+ * @aifs: Arbitration inter-frame space(AIFS) -+ * @cw: Contention window(CW) -+ * @txop: MAX Transmit Opportunity(TXOP) -+ * -+ * Return: 0 if process OK, otherwise -1. -+ */ -+int rtw_halmac_set_edca(struct dvobj_priv *d, u8 queue, u8 aifs, u8 cw, u16 txop) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_acq_id ac; -+ struct halmac_edca_para edca; -+ enum halmac_ret_status status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ switch (queue) { -+ case XMIT_VO_QUEUE: -+ ac = HALMAC_ACQ_ID_VO; -+ break; -+ case XMIT_VI_QUEUE: -+ ac = HALMAC_ACQ_ID_VI; -+ break; -+ case XMIT_BE_QUEUE: -+ ac = HALMAC_ACQ_ID_BE; -+ break; -+ case XMIT_BK_QUEUE: -+ ac = HALMAC_ACQ_ID_BK; -+ break; -+ default: -+ return -1; -+ } -+ -+ edca.aifs = aifs; -+ edca.cw = cw; -+ edca.txop_limit = txop; -+ -+ status = api->halmac_cfg_edca_para(mac, ac, &edca); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_set_rts_full_bw() - Send RTS to all covered channels -+ * @d: struct dvobj_priv* -+ * @enable: _TRUE(enable), _FALSE(disable) -+ * -+ * Hradware will duplicate RTS packet to all channels which are covered in used -+ * bandwidth. -+ * -+ * Return 0 if process OK, otherwise -1. -+ */ -+int rtw_halmac_set_rts_full_bw(struct dvobj_priv *d, u8 enable) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u8 full; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ full = (enable == _TRUE) ? 1 : 0; -+ -+ status = api->halmac_set_hw_value(mac, HALMAC_HW_RTS_FULL_BW, &full); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ return 0; -+} -+ -+#ifdef RTW_HALMAC_DBG_POWER_SWITCH -+static void _dump_mac_reg(struct dvobj_priv *d, u32 start, u32 end) -+{ -+ struct _ADAPTER *adapter; -+ int i, j = 1; -+ -+ -+ adapter = dvobj_get_primary_adapter(d); -+ for (i = start; i < end; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT("0x%04x", i); -+ _RTW_PRINT(" 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT("\n"); -+ } -+} -+ -+void dump_dbg_val(struct _ADAPTER *a, u32 reg) -+{ -+ u32 v32; -+ -+ -+ rtw_write8(a, 0x3A, reg); -+ v32 = rtw_read32(a, 0xC0); -+ RTW_PRINT("0x3A = %02x, 0xC0 = 0x%08x\n",reg, v32); -+} -+ -+#ifdef CONFIG_PCI_HCI -+static void _dump_pcie_cfg_space(struct dvobj_priv *d) -+{ -+ struct _ADAPTER *padapter = dvobj_get_primary_adapter(d); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ struct pci_dev *bridge_pdev = pdev->bus->self; -+ -+ u32 tmp[4] = { 0 }; -+ u32 i, j; -+ -+ RTW_PRINT("\n***** PCI Device Configuration Space *****\n\n"); -+ -+ for(i = 0; i < 0x100; i += 0x10) -+ { -+ for (j = 0 ; j < 4 ; j++) -+ pci_read_config_dword(pdev, i + j * 4, tmp+j); -+ -+ RTW_PRINT("%03x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", -+ i, tmp[0] & 0xFF, (tmp[0] >> 8) & 0xFF, (tmp[0] >> 16) & 0xFF, (tmp[0] >> 24) & 0xFF, -+ tmp[1] & 0xFF, (tmp[1] >> 8) & 0xFF, (tmp[1] >> 16) & 0xFF, (tmp[1] >> 24) & 0xFF, -+ tmp[2] & 0xFF, (tmp[2] >> 8) & 0xFF, (tmp[2] >> 16) & 0xFF, (tmp[2] >> 24) & 0xFF, -+ tmp[3] & 0xFF, (tmp[3] >> 8) & 0xFF, (tmp[3] >> 16) & 0xFF, (tmp[3] >> 24) & 0xFF); -+ } -+ -+ RTW_PRINT("\n***** PCI Host Device Configuration Space*****\n\n"); -+ -+ for(i = 0; i < 0x100; i += 0x10) -+ { -+ for (j = 0 ; j < 4 ; j++) -+ pci_read_config_dword(bridge_pdev, i + j * 4, tmp+j); -+ -+ RTW_PRINT("%03x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", -+ i, tmp[0] & 0xFF, (tmp[0] >> 8) & 0xFF, (tmp[0] >> 16) & 0xFF, (tmp[0] >> 24) & 0xFF, -+ tmp[1] & 0xFF, (tmp[1] >> 8) & 0xFF, (tmp[1] >> 16) & 0xFF, (tmp[1] >> 24) & 0xFF, -+ tmp[2] & 0xFF, (tmp[2] >> 8) & 0xFF, (tmp[2] >> 16) & 0xFF, (tmp[2] >> 24) & 0xFF, -+ tmp[3] & 0xFF, (tmp[3] >> 8) & 0xFF, (tmp[3] >> 16) & 0xFF, (tmp[3] >> 24) & 0xFF); -+ } -+} -+#endif -+ -+static void _dump_mac_reg_for_power_switch(struct dvobj_priv *d, -+ const char* caller, char* desc) -+{ -+ struct _ADAPTER *a; -+ u8 v8; -+ -+ -+ RTW_PRINT("%s: %s\n", caller, desc); -+ RTW_PRINT("======= MAC REG =======\n"); -+ /* page 0/1 */ -+ _dump_mac_reg(d, 0x0, 0x200); -+ _dump_mac_reg(d, 0x300, 0x400); /* also dump page 3 */ -+ -+ /* dump debug register */ -+ a = dvobj_get_primary_adapter(d); -+ -+#ifdef CONFIG_PCI_HCI -+ _dump_pcie_cfg_space(d); -+ -+ v8 = rtw_read8(a, 0xF6) | 0x01; -+ rtw_write8(a, 0xF6, v8); -+ RTW_PRINT("0xF6 = %02x\n", v8); -+ -+ dump_dbg_val(a, 0x63); -+ dump_dbg_val(a, 0x64); -+ dump_dbg_val(a, 0x68); -+ dump_dbg_val(a, 0x69); -+ dump_dbg_val(a, 0x6a); -+ dump_dbg_val(a, 0x6b); -+ dump_dbg_val(a, 0x71); -+ dump_dbg_val(a, 0x72); -+#endif -+} -+ -+static enum halmac_ret_status _power_switch(struct halmac_adapter *halmac, -+ struct halmac_api *api, -+ enum halmac_mac_power pwr) -+{ -+ enum halmac_ret_status status; -+ char desc[80] = {0}; -+ -+ -+ rtw_sprintf(desc, 80, "before calling power %s", -+ (pwr==HALMAC_MAC_POWER_ON)?"on":"off"); -+ _dump_mac_reg_for_power_switch((struct dvobj_priv *)halmac->drv_adapter, -+ __FUNCTION__, desc); -+ -+ status = api->halmac_mac_power_switch(halmac, pwr); -+ RTW_PRINT("%s: status=%d\n", __FUNCTION__, status); -+ -+ rtw_sprintf(desc, 80, "after calling power %s", -+ (pwr==HALMAC_MAC_POWER_ON)?"on":"off"); -+ _dump_mac_reg_for_power_switch((struct dvobj_priv *)halmac->drv_adapter, -+ __FUNCTION__, desc); -+ -+ return status; -+} -+#else /* !RTW_HALMAC_DBG_POWER_SWITCH */ -+#define _power_switch(mac, api, pwr) (api)->halmac_mac_power_switch(mac, pwr) -+#endif /* !RTW_HALMAC_DBG_POWER_SWITCH */ -+ -+/* -+ * Description: -+ * Power on device hardware. -+ * [Notice!] If device's power state is on before, -+ * it would be power off first and turn on power again. -+ * -+ * Return: -+ * 0 power on success -+ * -1 power on fail -+ * -2 power state unchange -+ */ -+int rtw_halmac_poweron(struct dvobj_priv *d) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ int err = -1; -+#if defined(CONFIG_PCI_HCI) && defined(CONFIG_RTL8822B) -+ struct _ADAPTER *a; -+ u8 v8; -+ u32 addr; -+ -+ a = dvobj_get_primary_adapter(d); -+#endif -+ -+ 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; -+ -+#ifdef CONFIG_SDIO_HCI -+ status = api->halmac_sdio_cmd53_4byte(halmac, HALMAC_SDIO_CMD53_4BYTE_MODE_RW); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+#endif /* CONFIG_SDIO_HCI */ -+ -+#if defined(CONFIG_PCI_HCI) && defined(CONFIG_RTL8822B) -+ addr = 0x3F3; -+ v8 = rtw_read8(a, addr); -+ RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v8); -+ /* are we in pcie debug mode? */ -+ if (!(v8 & BIT(2))) { -+ RTW_PRINT("%s: Enable pcie debug mode\n", __FUNCTION__); -+ v8 |= BIT(2); -+ v8 = rtw_write8(a, addr, v8); -+ } -+#endif -+ -+ status = _power_switch(halmac, api, HALMAC_MAC_POWER_ON); -+ if (HALMAC_RET_PWR_UNCHANGE == status) { -+ -+#if defined(CONFIG_PCI_HCI) && defined(CONFIG_RTL8822B) -+ addr = 0x3F3; -+ v8 = rtw_read8(a, addr); -+ RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v8); -+ -+ /* are we in pcie debug mode? */ -+ if (!(v8 & BIT(2))) { -+ RTW_PRINT("%s: Enable pcie debug mode\n", __FUNCTION__); -+ v8 |= BIT(2); -+ v8 = rtw_write8(a, addr, v8); -+ } else if (v8 & BIT(0)) { -+ /* DMA stuck */ -+ addr = 0x1350; -+ v8 = rtw_read8(a, addr); -+ RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v8); -+ RTW_PRINT("%s: recover DMA stuck\n", __FUNCTION__); -+ v8 |= BIT(6); -+ v8 = rtw_write8(a, addr, v8); -+ RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v8); -+ } -+#endif -+ /* -+ * Work around for warm reboot but device not power off, -+ * but it would also fall into this case when auto power on is enabled. -+ */ -+#ifdef CONFIG_NARROWBAND_SUPPORTING -+ { -+ struct registry_priv *regsty = dvobj_to_regsty(d); -+ u32 bw_type; -+ -+ if (regsty->rtw_nb_config == RTW_NB_CONFIG_WIDTH_10) -+ bw_type = HALMAC_BW_10; -+ else if (regsty->rtw_nb_config == RTW_NB_CONFIG_WIDTH_5) -+ bw_type = HALMAC_BW_5; -+ else -+ bw_type = HALMAC_BW_20; -+ -+ api->halmac_set_hw_value(dvobj_to_halmac(d), HALMAC_HW_BANDWIDTH, &bw_type); -+ } -+#endif -+ _power_switch(halmac, api, HALMAC_MAC_POWER_OFF); -+ status = _power_switch(halmac, api, HALMAC_MAC_POWER_ON); -+ RTW_WARN("%s: Power state abnormal, try to recover...%s\n", -+ __FUNCTION__, (HALMAC_RET_SUCCESS == status)?"OK":"FAIL!"); -+ } -+ if (HALMAC_RET_SUCCESS != status) { -+ if (HALMAC_RET_PWR_UNCHANGE == status) -+ err = -2; -+ goto out; -+ } -+ -+ status = api->halmac_init_system_cfg(halmac); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+/* -+ * Description: -+ * Power off device hardware. -+ * -+ * Return: -+ * 0 Power off success -+ * -1 Power off fail -+ */ -+int rtw_halmac_poweroff(struct dvobj_priv *d) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ if (!halmac) -+ goto out; -+ -+ api = HALMAC_GET_API(halmac); -+ -+ status = _power_switch(halmac, api, HALMAC_MAC_POWER_OFF); -+ if ((HALMAC_RET_SUCCESS != status) -+ && (HALMAC_RET_PWR_UNCHANGE != status)) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+static inline enum 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 enum halmac_rx_fifo_expanding_mode _rtw_get_trx_share_mode(struct _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, struct _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 enum halmac_drv_rsvd_pg_num _rsvd_page_num_drv2halmac(u16 num) -+{ -+ if (num <= 8) -+ return HALMAC_RSVD_PG_NUM8; -+ if (num <= 16) -+ return HALMAC_RSVD_PG_NUM16; -+ if (num <= 24) -+ return HALMAC_RSVD_PG_NUM24; -+ if (num <= 32) -+ return HALMAC_RSVD_PG_NUM32; -+ if (num <= 64) -+ return HALMAC_RSVD_PG_NUM64; -+ if (num <= 128) -+ return HALMAC_RSVD_PG_NUM128; -+ -+ if (num > 256) -+ RTW_WARN("%s: Fail to allocate RSVD page(%d)!!" -+ " The MAX RSVD page number is 256...\n", -+ __FUNCTION__, num); -+ -+ return HALMAC_RSVD_PG_NUM256; -+} -+ -+static u16 _rsvd_page_num_halmac2drv(enum halmac_drv_rsvd_pg_num rsvd_page_number) -+{ -+ u16 num = 0; -+ -+ -+ switch (rsvd_page_number) { -+ case HALMAC_RSVD_PG_NUM8: -+ num = 8; -+ break; -+ -+ case HALMAC_RSVD_PG_NUM16: -+ num = 16; -+ break; -+ -+ case HALMAC_RSVD_PG_NUM24: -+ num = 24; -+ break; -+ -+ case HALMAC_RSVD_PG_NUM32: -+ num = 32; -+ break; -+ -+ case HALMAC_RSVD_PG_NUM64: -+ num = 64; -+ break; -+ -+ case HALMAC_RSVD_PG_NUM128: -+ num = 128; -+ break; -+ -+ case HALMAC_RSVD_PG_NUM256: -+ num = 256; -+ break; -+ } -+ -+ return num; -+} -+ -+static enum halmac_trx_mode _choose_trx_mode(struct dvobj_priv *d) -+{ -+ PADAPTER p; -+ -+ -+ p = dvobj_get_primary_adapter(d); -+ -+ if (p->registrypriv.wifi_spec) -+ return HALMAC_TRX_MODE_WMM; -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+ if (_rtw_get_trx_share_mode(p)) -+ return HALMAC_TRX_MODE_TRXSHARE; -+#endif -+ -+ return HALMAC_TRX_MODE_NORMAL; -+} -+ -+static inline enum halmac_rf_type _rf_type_drv2halmac(enum rf_type rf_drv) -+{ -+ enum halmac_rf_type rf_mac; -+ -+ -+ switch (rf_drv) { -+ case RF_1T1R: -+ rf_mac = HALMAC_RF_1T1R; -+ break; -+ case RF_1T2R: -+ rf_mac = HALMAC_RF_1T2R; -+ break; -+ case RF_2T2R: -+ rf_mac = HALMAC_RF_2T2R; -+ break; -+ case RF_2T3R: -+ rf_mac = HALMAC_RF_2T3R; -+ break; -+ case RF_2T4R: -+ rf_mac = HALMAC_RF_2T4R; -+ 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_MAX_TYPE; -+ RTW_ERR("%s: Invalid RF type(0x%x)!\n", __FUNCTION__, rf_drv); -+ break; -+ } -+ -+ return rf_mac; -+} -+ -+static inline enum rf_type _rf_type_halmac2drv(enum halmac_rf_type rf_mac) -+{ -+ enum rf_type rf_drv; -+ -+ -+ switch (rf_mac) { -+ case HALMAC_RF_1T2R: -+ rf_drv = RF_1T2R; -+ break; -+ case HALMAC_RF_2T4R: -+ rf_drv = RF_2T4R; -+ break; -+ case HALMAC_RF_2T2R: -+ case HALMAC_RF_2T2R_GREEN: -+ rf_drv = RF_2T2R; -+ break; -+ case HALMAC_RF_2T3R: -+ rf_drv = RF_2T3R; -+ break; -+ case HALMAC_RF_1T1R: -+ rf_drv = RF_1T1R; -+ break; -+ case HALMAC_RF_3T3R: -+ rf_drv = RF_3T3R; -+ break; -+ case HALMAC_RF_3T4R: -+ rf_drv = RF_3T4R; -+ break; -+ case HALMAC_RF_4T4R: -+ rf_drv = RF_4T4R; -+ break; -+ default: -+ rf_drv = RF_TYPE_MAX; -+ RTW_ERR("%s: Invalid RF type(0x%x)!\n", __FUNCTION__, rf_mac); -+ break; -+ } -+ -+ return rf_drv; -+} -+ -+static enum odm_cut_version _cut_version_drv2phydm( -+ enum tag_HAL_Cut_Version_Definition cut_drv) -+{ -+ enum odm_cut_version cut_phydm = ODM_CUT_A; -+ u32 diff; -+ -+ -+ if (cut_drv > K_CUT_VERSION) -+ RTW_WARN("%s: unknown cut_ver=%d !!\n", __FUNCTION__, cut_drv); -+ -+ diff = cut_drv - A_CUT_VERSION; -+ cut_phydm += diff; -+ -+ return cut_phydm; -+} -+ -+static int _send_general_info_by_reg(struct dvobj_priv *d, -+ struct halmac_general_info *info) -+{ -+ struct _ADAPTER *a; -+ struct hal_com_data *hal; -+ enum tag_HAL_Cut_Version_Definition cut_drv; -+ enum rf_type rftype; -+ enum odm_cut_version cut_phydm; -+ u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0}; -+ -+ -+ a = dvobj_get_primary_adapter(d); -+ hal = GET_HAL_DATA(a); -+ rftype = _rf_type_halmac2drv(info->rf_type); -+ cut_drv = GET_CVID_CUT_VERSION(hal->version_id); -+ cut_phydm = _cut_version_drv2phydm(cut_drv); -+ -+#define CLASS_GENERAL_INFO_REG 0x02 -+#define CMD_ID_GENERAL_INFO_REG 0x0C -+#define GENERAL_INFO_REG_SET_CMD_ID(buf, v) SET_BITS_TO_LE_4BYTE(buf, 0, 5, v) -+#define GENERAL_INFO_REG_SET_CLASS(buf, v) SET_BITS_TO_LE_4BYTE(buf, 5, 3, v) -+#define GENERAL_INFO_REG_SET_RFE_TYPE(buf, v) SET_BITS_TO_LE_4BYTE(buf, 8, 8, v) -+#define GENERAL_INFO_REG_SET_RF_TYPE(buf, v) SET_BITS_TO_LE_4BYTE(buf, 16, 8, v) -+#define GENERAL_INFO_REG_SET_CUT_VERSION(buf, v) SET_BITS_TO_LE_4BYTE(buf, 24, 8, v) -+#define GENERAL_INFO_REG_SET_RX_ANT_STATUS(buf, v) SET_BITS_TO_LE_1BYTE(buf+4, 0, 4, v) -+#define GENERAL_INFO_REG_SET_TX_ANT_STATUS(buf, v) SET_BITS_TO_LE_1BYTE(buf+4, 4, 4, v) -+ -+ GENERAL_INFO_REG_SET_CMD_ID(h2c, CMD_ID_GENERAL_INFO_REG); -+ GENERAL_INFO_REG_SET_CLASS(h2c, CLASS_GENERAL_INFO_REG); -+ GENERAL_INFO_REG_SET_RFE_TYPE(h2c, info->rfe_type); -+ GENERAL_INFO_REG_SET_RF_TYPE(h2c, rftype); -+ GENERAL_INFO_REG_SET_CUT_VERSION(h2c, cut_phydm); -+ GENERAL_INFO_REG_SET_RX_ANT_STATUS(h2c, info->rx_ant_status); -+ GENERAL_INFO_REG_SET_TX_ANT_STATUS(h2c, info->tx_ant_status); -+ -+ return rtw_halmac_send_h2c(d, h2c); -+} -+ -+static int _send_general_info(struct dvobj_priv *d) -+{ -+ struct _ADAPTER *adapter; -+ struct hal_com_data *hal; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ struct halmac_general_info info; -+ enum halmac_ret_status status; -+ enum rf_type rf = RF_1T1R; -+ enum bb_path txpath = BB_PATH_A; -+ enum bb_path rxpath = BB_PATH_A; -+ int err; -+ -+ -+ adapter = dvobj_get_primary_adapter(d); -+ 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->rfe_type; -+ rtw_hal_get_trx_path(d, &rf, &txpath, &rxpath); -+ info.rf_type = _rf_type_drv2halmac(rf); -+ info.tx_ant_status = (u8)txpath; -+ info.rx_ant_status = (u8)rxpath; -+ info.ext_pa = 0; /* 2.4G or 5G? format not known */ -+ info.package_type = hal->PackageType; -+ info.mp_mode = adapter->registrypriv.mp_mode; -+ -+ 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__); -+ fallthrough; -+ default: -+ return -1; -+ } -+ -+ err = _send_general_info_by_reg(d, &info); -+ if (err) { -+ RTW_ERR("%s: Fail to send general info by register!\n", -+ __FUNCTION__); -+ return -1; -+ } -+ -+ return 0; -+} -+ -+static int _cfg_drv_rsvd_pg_num(struct dvobj_priv *d) -+{ -+ struct _ADAPTER *a; -+ struct hal_com_data *hal; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_drv_rsvd_pg_num rsvd_page_number; -+ enum halmac_ret_status status; -+ u16 drv_rsvd_num; -+ int ret = 0; -+ -+ -+ a = dvobj_get_primary_adapter(d); -+ hal = GET_HAL_DATA(a); -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ drv_rsvd_num = rtw_hal_get_rsvd_page_num(a); -+ rsvd_page_number = _rsvd_page_num_drv2halmac(drv_rsvd_num); -+ status = api->halmac_cfg_drv_rsvd_pg_num(halmac, rsvd_page_number); -+ if (status != HALMAC_RET_SUCCESS) { -+ ret = -1; -+ goto exit; -+ } -+ hal->drv_rsvd_page_number = _rsvd_page_num_halmac2drv(rsvd_page_number); -+ -+exit: -+#ifndef DBG_RSVD_PAGE_CFG -+ if (drv_rsvd_num != _rsvd_page_num_halmac2drv(rsvd_page_number)) -+#endif -+ RTW_INFO("%s: request %d pages => halmac %d pages %s\n" -+ , __FUNCTION__, drv_rsvd_num, _rsvd_page_num_halmac2drv(rsvd_page_number) -+ , ret ? "fail" : "success"); -+ -+ return ret; -+} -+ -+static void _debug_dlfw_fail(struct dvobj_priv *d) -+{ -+ struct _ADAPTER *a; -+ u32 addr; -+ u32 v32, i, n; -+ -+ -+ a = dvobj_get_primary_adapter(d); -+ -+ /* read 0x80[15:0], 0x10F8[31:0] once */ -+ addr = 0x80; -+ v32 = rtw_read16(a, addr); -+ RTW_PRINT("%s: 0x%X = 0x%04x\n", __FUNCTION__, addr, v32); -+ -+ addr = 0x10F8; -+ v32 = rtw_read32(a, addr); -+ RTW_PRINT("%s: 0x%X = 0x%08x\n", __FUNCTION__, addr, v32); -+ -+ /* read 0x10FC[31:0], 5 times */ -+ addr = 0x10FC; -+ n = 5; -+ for (i = 0; i < n; i++) { -+ v32 = rtw_read32(a, addr); -+ RTW_PRINT("%s: 0x%X = 0x%08x (%u/%u)\n", -+ __FUNCTION__, addr, v32, i, n); -+ } -+ -+ /* -+ * write 0x3A[7:0]=0x28 and 0xF6[7:0]=0x01 -+ * and then read 0xC0[31:0] 5 times -+ */ -+ addr = 0x3A; -+ v32 = 0x28; -+ rtw_write8(a, addr, (u8)v32); -+ v32 = rtw_read8(a, addr); -+ RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v32); -+ -+ addr = 0xF6; -+ v32 = 0x1; -+ rtw_write8(a, addr, (u8)v32); -+ v32 = rtw_read8(a, addr); -+ RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v32); -+ -+ addr = 0xC0; -+ n = 5; -+ for (i = 0; i < n; i++) { -+ v32 = rtw_read32(a, addr); -+ RTW_PRINT("%s: 0x%X = 0x%08x (%u/%u)\n", -+ __FUNCTION__, addr, v32, i, n); -+ } -+ -+ mac_reg_dump(NULL, a); -+#ifdef CONFIG_SDIO_HCI -+ RTW_PRINT("======= SDIO Local REG =======\n"); -+ sdio_local_reg_dump(NULL, a); -+ RTW_PRINT("======= SDIO CCCR REG =======\n"); -+ sd_f0_reg_dump(NULL, a); -+#endif /* CONFIG_SDIO_HCI */ -+ -+ /* read 0x80 after 10 secs */ -+ rtw_msleep_os(10000); -+ addr = 0x80; -+ v32 = rtw_read16(a, addr); -+ RTW_PRINT("%s: 0x%X = 0x%04x (after 10 secs)\n", -+ __FUNCTION__, addr, v32); -+} -+ -+static enum halmac_ret_status _enter_cpu_sleep_mode(struct dvobj_priv *d) -+{ -+ struct hal_com_data *hal; -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ -+ -+ hal = GET_HAL_DATA(dvobj_get_primary_adapter(d)); -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+#ifdef CONFIG_RTL8822B -+ /* Support after firmware version 21 */ -+ if (hal->firmware_version < 21) -+ return HALMAC_RET_NOT_SUPPORT; -+#elif defined(CONFIG_RTL8821C) -+ /* Support after firmware version 13.6 or 16 */ -+ if (hal->firmware_version == 13) { -+ if (hal->firmware_sub_version < 6) -+ return HALMAC_RET_NOT_SUPPORT; -+ } else if (hal->firmware_version < 16) { -+ return HALMAC_RET_NOT_SUPPORT; -+ } -+#endif -+ -+ return api->halmac_enter_cpu_sleep_mode(mac); -+} -+ -+/* -+ * _cpu_sleep() - Let IC CPU enter sleep mode -+ * @d: struct dvobj_priv* -+ * @timeout: time limit of wait, unit is ms -+ * 0 for no limit -+ * -+ * Return 0 for CPU in sleep mode, otherwise fail to enter sleep mode. -+ * Error codes definition are as follow: -+ * -1 HALMAC enter sleep return fail -+ * -2 HALMAC get CPU mode return fail -+ * -110 timeout -+ */ -+static int _cpu_sleep(struct dvobj_priv *d, u32 timeout) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ enum halmac_wlcpu_mode mode = HALMAC_WLCPU_UNDEFINE; -+ systime start_t; -+ s32 period = 0; -+ u32 cnt = 0; -+ int err = 0; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ start_t = rtw_get_current_time(); -+ -+ status = _enter_cpu_sleep_mode(d); -+ if (status != HALMAC_RET_SUCCESS) { -+ if (status != HALMAC_RET_NOT_SUPPORT) -+ err = -1; -+ goto exit; -+ } -+ -+ do { -+ cnt++; -+ -+ mode = HALMAC_WLCPU_UNDEFINE; -+ status = api->halmac_get_cpu_mode(mac, &mode); -+ -+ period = rtw_get_passing_time_ms(start_t); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ err = -2; -+ break; -+ } -+ if (mode == HALMAC_WLCPU_SLEEP) -+ break; -+ if (period > timeout) { -+ err = -110; -+ break; -+ } -+ -+ rtw_msleep_os(1); -+ } while (1); -+ -+exit: -+ if (err) -+ RTW_ERR("%s: Fail to enter sleep mode! (%d, %d)\n", -+ __FUNCTION__, status, mode); -+ -+ RTW_INFO("%s: Cost %dms to polling %u times. (err=%d)\n", -+ __FUNCTION__, period, cnt, err); -+ -+ return err; -+} -+ -+static void _init_trx_cfg_drv(struct dvobj_priv *d) -+{ -+#ifdef CONFIG_PCI_HCI -+ rtw_hal_irp_reset(dvobj_get_primary_adapter(d)); -+#endif -+} -+ -+/* -+ * Description: -+ * Downlaod Firmware Flow -+ * -+ * Parameters: -+ * d pointer of struct dvobj_priv -+ * fw firmware array -+ * fwsize firmware size -+ * re_dl re-download firmware or not -+ * 0: run in init hal flow, not re-download -+ * 1: it is a stand alone operation, not in init hal flow -+ * -+ * Return: -+ * 0 Success -+ * others Fail -+ */ -+static int download_fw(struct dvobj_priv *d, u8 *fw, u32 fwsize, u8 re_dl) -+{ -+ PHAL_DATA_TYPE hal; -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ struct halmac_fw_version fw_vesion; -+ enum halmac_ret_status status; -+ int err = 0; -+ -+ -+ hal = GET_HAL_DATA(dvobj_get_primary_adapter(d)); -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ if ((!fw) || (!fwsize)) -+ return -1; -+ -+ /* 1. Driver Stop Tx */ -+ /* ToDo */ -+ -+ /* 2. Driver Check Tx FIFO is empty */ -+ err = rtw_halmac_txfifo_wait_empty(d, 2000); /* wait 2s */ -+ if (err) { -+ err = -1; -+ goto resume_tx; -+ } -+ -+ /* 3. Config MAX download size */ -+ /* -+ * Already done in rtw_halmac_init_adapter() or -+ * somewhere calling rtw_halmac_set_max_dl_fw_size(). -+ */ -+ -+ if (re_dl) { -+ /* 4. Enter IC CPU sleep mode */ -+ err = _cpu_sleep(d, 2000); -+ if (err) { -+ RTW_ERR("%s: IC CPU fail to enter sleep mode!(%d)\n", -+ __FUNCTION__, err); -+ /* skip this error */ -+ err = 0; -+ } -+ } -+ -+ /* 5. Download Firmware */ -+ status = api->halmac_download_firmware(mac, fw, fwsize); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: download firmware FAIL! status=0x%02x\n", -+ __FUNCTION__, status); -+ _debug_dlfw_fail(d); -+ err = -1; -+ goto resume_tx; -+ } -+ -+ /* 5.1. (Driver) Reset driver variables if needed */ -+ hal->LastHMEBoxNum = 0; -+ -+ /* 5.2. (Driver) Get FW version */ -+ status = api->halmac_get_fw_version(mac, &fw_vesion); -+ if (status == HALMAC_RET_SUCCESS) { -+ hal->firmware_version = fw_vesion.version; -+ hal->firmware_sub_version = fw_vesion.sub_version; -+ hal->firmware_size = fwsize; -+ } -+ -+resume_tx: -+ /* 6. Driver resume TX if needed */ -+ /* ToDo */ -+ -+ if (err) -+ goto exit; -+ -+ if (re_dl) { -+ enum halmac_trx_mode mode; -+ -+ /* 7. Change reserved page size */ -+ err = _cfg_drv_rsvd_pg_num(d); -+ if (err) -+ return -1; -+ -+ /* 8. Init TRX Configuration */ -+ mode = _choose_trx_mode(d); -+ status = api->halmac_init_trx_cfg(mac, mode); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ _init_trx_cfg_drv(d); -+ -+ /* 9. Config RX Aggregation */ -+ err = rtw_halmac_rx_agg_switch(d, _TRUE); -+ if (err) -+ return -1; -+ -+ /* 10. Send General Info */ -+ err = _send_general_info(d); -+ if (err) -+ return -1; -+ } -+ -+exit: -+ return err; -+} -+ -+static int init_mac_flow(struct dvobj_priv *d) -+{ -+ PADAPTER p; -+ struct hal_com_data *hal; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_drv_rsvd_pg_num rsvd_page_number; -+ union halmac_wlan_addr hwa; -+ enum halmac_trx_mode trx_mode; -+ enum halmac_ret_status status; -+ u8 drv_rsvd_num; -+ u8 nettype; -+ int err, err_ret = -1; -+ -+ -+ p = dvobj_get_primary_adapter(d); -+ hal = GET_HAL_DATA(p); -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+ status = api->halmac_cfg_rxff_expand_mode(halmac, -+ _rtw_get_trx_share_mode(p)); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+#endif -+ -+#ifdef DBG_LA_MODE -+ if (dvobj_to_regsty(d)->la_mode_en) { -+ status = api->halmac_cfg_la_mode(halmac, HALMAC_LA_MODE_PARTIAL); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: Fail to enable LA mode!\n", __FUNCTION__); -+ goto out; -+ } -+ RTW_PRINT("%s: Enable LA mode OK.\n", __FUNCTION__); -+ } -+#endif -+ -+ err = _cfg_drv_rsvd_pg_num(d); -+ if (err) -+ goto out; -+ -+#ifdef CONFIG_USB_HCI -+ status = api->halmac_set_bulkout_num(halmac, d->RtNumOutPipes); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+#endif /* CONFIG_USB_HCI */ -+ -+ trx_mode = _choose_trx_mode(d); -+ status = api->halmac_init_mac_cfg(halmac, trx_mode); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ /* Driver insert flow: Sync driver setting with register */ -+ /* Sync driver RCR cache with register setting */ -+ rtw_hal_get_hwreg(dvobj_get_primary_adapter(d), HW_VAR_RCR, NULL); -+ -+#ifdef CONFIG_RTS_FULL_BW -+ err = rtw_halmac_set_rts_full_bw(d, _TRUE); -+ if (err) -+ RTW_WARN("%s: Fail to set RTS FULL BW mode\n", __FUNCTION__); -+#else -+ err = rtw_halmac_set_rts_full_bw(d, _FALSE); -+ if (err) -+ RTW_WARN("%s: Fail to disable RTS FULL BW mode\n", __FUNCTION__); -+#endif /* CONFIG_RTS_FULL_BW */ -+ -+ _init_trx_cfg_drv(d); -+ /* Driver inser flow end */ -+ -+ err = rtw_halmac_rx_agg_switch(d, _TRUE); -+ if (err) -+ goto out; -+ -+ nettype = dvobj_to_regsty(d)->wireless_mode; -+ if (is_supported_vht(nettype) == _TRUE) -+ status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_AC); -+ else if (is_supported_ht(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; -+ -+ err_ret = 0; -+out: -+ return err_ret; -+} -+ -+static int _drv_enable_trx(struct dvobj_priv *d) -+{ -+ struct _ADAPTER *adapter; -+ u32 status; -+ -+ -+ adapter = dvobj_get_primary_adapter(d); -+ if (adapter->bup == _FALSE) { -+#ifdef CONFIG_NEW_NETDEV_HDL -+ status = rtw_mi_start_drv_threads(adapter); -+#else -+ status = rtw_start_drv_threads(adapter); -+#endif -+ if (status == _FAIL) { -+ RTW_ERR("%s: Start threads Failed!\n", __FUNCTION__); -+ return -1; -+ } -+ } -+ -+ rtw_intf_start(adapter); -+ -+ return 0; -+} -+ -+/* -+ * Notices: -+ * Make sure following information -+ * 1. GET_HAL_RFPATH -+ * 2. GET_HAL_DATA(dvobj_get_primary_adapter(d))->rfe_type -+ * 3. GET_HAL_DATA(dvobj_get_primary_adapter(d))->PackageType -+ * 4. dvobj_get_primary_adapter(d)->registrypriv.mp_mode -+ * are all ready before calling this function. -+ */ -+static int _halmac_init_hal(struct dvobj_priv *d, u8 *fw, u32 fwsize) -+{ -+ PADAPTER adapter; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 ok; -+ u8 fw_ok = _FALSE; -+ int err, err_ret = -1; -+ -+ -+ adapter = dvobj_get_primary_adapter(d); -+ 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 (_FAIL == ok) -+ goto out; -+ -+ /* StatePowerOn */ -+ -+ /* DownloadFW */ -+ if (fw && fwsize) { -+ err = download_fw(d, fw, fwsize, 0); -+ if (err) -+ goto out; -+ fw_ok = _TRUE; -+ } -+ -+ /* InitMACFlow */ -+ err = init_mac_flow(d); -+ if (err) -+ goto out; -+ -+ /* Driver insert flow: Enable TR/RX */ -+ err = _drv_enable_trx(d); -+ if (err) -+ goto out; -+ -+ /* halmac_send_general_info */ -+ if (_TRUE == fw_ok) { -+ err = _send_general_info(d); -+ if (err) -+ goto out; -+ } -+ -+ /* 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 following information -+ * 1. GET_HAL_RFPATH -+ * 2. GET_HAL_DATA(dvobj_get_primary_adapter(d))->rfe_type -+ * 3. GET_HAL_DATA(dvobj_get_primary_adapter(d))->PackageType -+ * 4. dvobj_get_primary_adapter(d)->registrypriv.mp_mode -+ * are all ready 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 following information -+ * 1. GET_HAL_RFPATH -+ * 2. GET_HAL_DATA(dvobj_get_primary_adapter(d))->rfe_type -+ * 3. GET_HAL_DATA(dvobj_get_primary_adapter(d))->PackageType -+ * 4. dvobj_get_primary_adapter(d)->registrypriv.mp_mode -+ * are all ready before calling this function. -+ */ -+int rtw_halmac_init_hal_fw_file(struct dvobj_priv *d, u8 *fwpath) -+{ -+ u8 *fw = NULL; -+ u32 fwmaxsize = 0, size = 0; -+ int err = 0; -+ -+ -+ err = rtw_halmac_get_fw_max_size(d, &fwmaxsize); -+ if (err) { -+ RTW_ERR("%s: Fail to get Firmware MAX size(err=%d)\n", __FUNCTION__, err); -+ return -1; -+ } -+ -+ 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; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ int err = -1; -+ -+ -+ adapter = dvobj_get_primary_adapter(d); -+ 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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; -+} -+ -+static u8 rtw_halmac_txfifo_is_empty(struct dvobj_priv *d) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 chk_num = 10; -+ u8 rst = _FALSE; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_txfifo_is_empty(mac, chk_num); -+ if (status == HALMAC_RET_SUCCESS) -+ rst = _TRUE; -+ -+ return rst; -+} -+ -+/** -+ * rtw_halmac_txfifo_wait_empty() - Wait TX FIFO to be emtpy -+ * @d: struct dvobj_priv* -+ * @timeout: time limit of wait, unit is ms -+ * 0 for no limit -+ * -+ * Wait TX FIFO to be emtpy. -+ * -+ * Return 0 for TX FIFO is empty, otherwise not empty. -+ */ -+int rtw_halmac_txfifo_wait_empty(struct dvobj_priv *d, u32 timeout) -+{ -+ struct _ADAPTER *a; -+ u8 empty = _FALSE; -+ u32 cnt = 0; -+ systime start_time = 0; -+ u32 pass_time; /* ms */ -+ -+ -+ a = dvobj_get_primary_adapter(d); -+ start_time = rtw_get_current_time(); -+ -+ do { -+ cnt++; -+ empty = rtw_halmac_txfifo_is_empty(d); -+ if (empty == _TRUE) -+ break; -+ -+ if (timeout) { -+ pass_time = rtw_get_passing_time_ms(start_time); -+ if (pass_time > timeout) -+ break; -+ } -+ if (RTW_CANNOT_IO(a)) { -+ RTW_WARN("%s: Interrupted by I/O forbiden!\n", __FUNCTION__); -+ break; -+ } -+ -+ rtw_msleep_os(2); -+ } while (1); -+ -+ if (empty == _FALSE) { -+#ifdef CONFIG_RTW_DEBUG -+ u16 dbg_reg[] = {0x210, 0x230, 0x234, 0x238, 0x23C, 0x240, -+ 0x418, 0x10FC, 0x10F8, 0x11F4, 0x11F8}; -+ u8 i; -+ u32 val; -+ -+ if (!RTW_CANNOT_IO(a)) { -+ for (i = 0; i < ARRAY_SIZE(dbg_reg); i++) { -+ val = rtw_read32(a, dbg_reg[i]); -+ RTW_ERR("REG_%X:0x%08x\n", dbg_reg[i], val); -+ } -+ } -+#endif /* CONFIG_RTW_DEBUG */ -+ -+ RTW_ERR("%s: Fail to wait txfifo empty!(cnt=%d)\n", -+ __FUNCTION__, cnt); -+ return -1; -+ } -+ -+ return 0; -+} -+ -+static enum halmac_dlfw_mem _fw_mem_drv2halmac(enum fw_mem mem, u8 tx_stop) -+{ -+ enum halmac_dlfw_mem mem_halmac = HALMAC_DLFW_MEM_UNDEFINE; -+ -+ -+ switch (mem) { -+ case FW_EMEM: -+ if (tx_stop == _FALSE) -+ mem_halmac = HALMAC_DLFW_MEM_EMEM_RSVD_PG; -+ else -+ mem_halmac = HALMAC_DLFW_MEM_EMEM; -+ break; -+ -+ case FW_IMEM: -+ case FW_DMEM: -+ mem_halmac = HALMAC_DLFW_MEM_UNDEFINE; -+ break; -+ } -+ -+ return mem_halmac; -+} -+ -+int rtw_halmac_dlfw_mem(struct dvobj_priv *d, u8 *fw, u32 fwsize, enum fw_mem mem) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ enum halmac_dlfw_mem dlfw_mem; -+ u8 tx_stop = _FALSE; -+ u32 chk_timeout = 2000; /* unit: ms */ -+ int err = 0; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ if ((!fw) || (!fwsize)) -+ return -1; -+ -+#ifndef RTW_HALMAC_DLFW_MEM_NO_STOP_TX -+ /* 1. Driver Stop Tx */ -+ /* ToDo */ -+ -+ /* 2. Driver Check Tx FIFO is empty */ -+ err = rtw_halmac_txfifo_wait_empty(d, chk_timeout); -+ if (err) -+ tx_stop = _FALSE; -+ else -+ tx_stop = _TRUE; -+#endif /* !RTW_HALMAC_DLFW_MEM_NO_STOP_TX */ -+ -+ /* 3. Download Firmware MEM */ -+ dlfw_mem = _fw_mem_drv2halmac(mem, tx_stop); -+ if (dlfw_mem == HALMAC_DLFW_MEM_UNDEFINE) { -+ err = -1; -+ goto resume_tx; -+ } -+ status = api->halmac_free_download_firmware(mac, dlfw_mem, fw, fwsize); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: halmac_free_download_firmware fail(err=0x%x)\n", -+ __FUNCTION__, status); -+ err = -1; -+ goto resume_tx; -+ } -+ -+resume_tx: -+#ifndef RTW_HALMAC_DLFW_MEM_NO_STOP_TX -+ /* 4. Driver resume TX if needed */ -+ /* ToDo */ -+#endif /* !RTW_HALMAC_DLFW_MEM_NO_STOP_TX */ -+ -+ return err; -+} -+ -+int rtw_halmac_dlfw_mem_from_file(struct dvobj_priv *d, u8 *fwpath, enum fw_mem mem) -+{ -+ u8 *fw = NULL; -+ u32 fwmaxsize = 0, size = 0; -+ int err = 0; -+ -+ -+ err = rtw_halmac_get_fw_max_size(d, &fwmaxsize); -+ if (err) { -+ RTW_ERR("%s: Fail to get Firmware MAX size(err=%d)\n", __FUNCTION__, err); -+ return -1; -+ } -+ -+ fw = rtw_zmalloc(fwmaxsize); -+ if (!fw) -+ return -1; -+ -+ size = rtw_retrieve_from_file(fwpath, fw, fwmaxsize); -+ if (size) -+ err = rtw_halmac_dlfw_mem(d, fw, size, mem); -+ else -+ err = -1; -+ -+ rtw_mfree(fw, fwmaxsize); -+ /*fw = NULL;*/ -+ -+ return err; -+} -+ -+/* -+ * Return: -+ * 0 Success -+ * -22 Invalid arguemnt -+ */ -+int rtw_halmac_dlfw(struct dvobj_priv *d, u8 *fw, u32 fwsize) -+{ -+ PADAPTER adapter; -+ enum halmac_ret_status status; -+ u32 ok; -+ int err, err_ret = -1; -+ -+ -+ if (!fw || !fwsize) -+ return -22; -+ -+ adapter = dvobj_get_primary_adapter(d); -+ -+ /* re-download firmware */ -+ if (rtw_is_hw_init_completed(adapter)) -+ return download_fw(d, fw, fwsize, 1); -+ -+ /* Download firmware before hal init */ -+ /* Power on, download firmware and init mac */ -+ ok = rtw_hal_power_on(adapter); -+ if (_FAIL == ok) -+ goto out; -+ -+ err = download_fw(d, fw, fwsize, 0); -+ if (err) { -+ err_ret = err; -+ goto out; -+ } -+ -+ err = init_mac_flow(d); -+ if (err) -+ goto out; -+ -+ err = _send_general_info(d); -+ if (err) -+ goto out; -+ -+ err_ret = 0; -+ -+out: -+ return err_ret; -+} -+ -+int rtw_halmac_dlfw_from_file(struct dvobj_priv *d, u8 *fwpath) -+{ -+ u8 *fw = NULL; -+ u32 fwmaxsize = 0, size = 0; -+ int err = 0; -+ -+ -+ err = rtw_halmac_get_fw_max_size(d, &fwmaxsize); -+ if (err) { -+ RTW_ERR("%s: Fail to get Firmware MAX size(err=%d)\n", __FUNCTION__, err); -+ return -1; -+ } -+ -+ 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; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u8 on; -+ -+ -+ adapter = dvobj_get_primary_adapter(d); -+ halmac = dvobj_to_halmac(d); -+ if (!halmac) -+ return -1; -+ api = HALMAC_GET_API(halmac); -+ on = (enable == _TRUE) ? 1 : 0; -+ -+ status = api->halmac_set_hw_value(halmac, HALMAC_HW_EN_BB_RF, &on); -+ 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; -+ -+ 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--)); -+ -+ if (_FALSE == read_down) -+ RTW_WARN("%s, reg_1cc(%x), msg_box(%d)...\n", __func__, rtw_read8(adapter, REG_HMETFR), msgbox_num); -+ -+ return read_down; -+} -+ -+/** -+ * rtw_halmac_send_h2c() - Send H2C to firmware -+ * @d: struct dvobj_priv* -+ * @h2c: H2C data buffer, suppose to be 8 bytes -+ * -+ * Send H2C to firmware by message box register(0x1D0~0x1D3 & 0x1F0~0x1F3). -+ * -+ * Assume firmware be ready to accept H2C here, please check -+ * (hal->bFWReady == _TRUE) before call this function or make sure firmware is -+ * ready. -+ * -+ * Return: 0 if process OK, otherwise fail to send this H2C. -+ */ -+int rtw_halmac_send_h2c(struct dvobj_priv *d, u8 *h2c) -+{ -+ PADAPTER adapter = dvobj_get_primary_adapter(d); -+ 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; -+ int err = -1; -+ -+ -+ if (!h2c) { -+ RTW_WARN("%s: pbuf is NULL\n", __FUNCTION__); -+ return err; -+ } -+ -+ if (rtw_is_surprise_removed(adapter)) { -+ RTW_WARN("%s: surprise removed\n", __FUNCTION__); -+ return err; -+ } -+ -+ _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_WARN(" fw read cmd failed...\n"); -+#ifdef DBG_CONFIG_ERROR_DETECT -+ hal->srestpriv.self_dect_fw = _TRUE; -+ hal->srestpriv.self_dect_fw_cnt++; -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ 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; -+ err = 0; -+ -+#ifdef DBG_H2C_CONTENT -+ RTW_INFO_DUMP("[H2C] - ", h2c, RTW_HALMAC_H2C_MAX_SIZE); -+#endif -+exit: -+ _exit_critical_mutex(&d->h2c_fwcmd_mutex, NULL); -+ return err; -+} -+ -+/** -+ * rtw_halmac_c2h_handle() - Handle C2H for HALMAC -+ * @d: struct dvobj_priv* -+ * @c2h: Full C2H packet, including RX description and payload -+ * @size: Size(byte) of c2h -+ * -+ * Send C2H packet to HALMAC to process C2H packets, and the expected C2H ID is -+ * 0xFF. This function won't have any I/O, so caller doesn't have to call it in -+ * I/O safe place(ex. command thread). -+ * -+ * Please sure doesn't call this function in the same thread as someone is -+ * waiting HALMAC C2H ack, otherwise there is a deadlock happen. -+ * -+ * Return: 0 if process OK, otherwise no action for this C2H. -+ */ -+int rtw_halmac_c2h_handle(struct dvobj_priv *d, u8 *c2h, u32 size) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+#ifdef RTW_HALMAC_FILTER_DRV_C2H -+ u32 desc_size = 0; -+ u8 *c2h_data; -+ u8 sub; -+#endif /* RTW_HALMAC_FILTER_DRV_C2H */ -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+#ifdef RTW_HALMAC_FILTER_DRV_C2H -+ status = api->halmac_get_hw_value(mac, HALMAC_HW_RX_DESC_SIZE, -+ &desc_size); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: fail to get rx desc size!\n", __FUNCTION__); -+ goto skip_filter; -+ } -+ -+ c2h_data = c2h + desc_size; -+ sub = C2H_HDR_GET_C2H_SUB_CMD_ID(c2h_data); -+ switch (sub) { -+ case C2H_SUB_CMD_ID_C2H_PKT_FTM_DBG: -+ case C2H_SUB_CMD_ID_C2H_PKT_FTM_2_DBG: -+ case C2H_SUB_CMD_ID_C2H_PKT_FTM_3_DBG: -+ case C2H_SUB_CMD_ID_C2H_PKT_FTM_4_DBG: -+ case C2H_SUB_CMD_ID_FTMACKRPT_HDL_DBG: -+ case C2H_SUB_CMD_ID_FTMC2H_RPT: -+ case C2H_SUB_CMD_ID_DRVFTMC2H_RPT: -+ case C2H_SUB_CMD_ID_C2H_PKT_FTM_5_DBG: -+ case C2H_SUB_CMD_ID_CCX_RPT: -+ case C2H_SUB_CMD_ID_C2H_PKT_NAN_RPT: -+ case C2H_SUB_CMD_ID_C2H_PKT_ATM_RPT: -+ case C2H_SUB_CMD_ID_C2H_PKT_SCC_CSA_RPT: -+ case C2H_SUB_CMD_ID_C2H_PKT_FW_STATUS_NOTIFY: -+ case C2H_SUB_CMD_ID_C2H_PKT_FTMSESSION_END: -+ case C2H_SUB_CMD_ID_C2H_PKT_DETECT_THERMAL: -+ case C2H_SUB_CMD_ID_FW_FWCTRL_RPT: -+ case C2H_SUB_CMD_ID_SCAN_CH_NOTIFY: -+ case C2H_SUB_CMD_ID_FW_TBTT_RPT: -+ case C2H_SUB_CMD_ID_BCN_OFFLOAD: -+ case C2H_SUB_CMD_ID_FW_DBG_MSG: -+ RTW_PRINT("%s: unhandled C2H, id=0xFF subid=0x%x len=%u\n", -+ __FUNCTION__, sub, C2H_HDR_GET_LEN(c2h_data)); -+ RTW_PRINT_DUMP("C2H: ", c2h_data, size - desc_size); -+ return 0; -+ } -+ -+skip_filter: -+#endif /* RTW_HALMAC_FILTER_DRV_C2H */ -+ -+ status = api->halmac_get_c2h_info(mac, c2h, size); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_get_available_efuse_size(struct dvobj_priv *d, u32 *size) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 val; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_get_efuse_available_size(mac, &val); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ *size = val; -+ return 0; -+} -+ -+int rtw_halmac_get_physical_efuse_size(struct dvobj_priv *d, u32 *size) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ enum 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_DRV); -+ 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u8 v; -+ u32 i; -+ u8 *efuse = NULL; -+ u32 size = 0; -+ int err = 0; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ if (api->halmac_read_efuse) { -+ 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; -+ } -+ } else { -+ err = rtw_halmac_get_physical_efuse_size(d, &size); -+ if (err) -+ return -1; -+ -+ efuse = rtw_zmalloc(size); -+ if (!efuse) -+ return -1; -+ -+ err = rtw_halmac_read_physical_efuse_map(d, efuse, size); -+ if (err) -+ err = -1; -+ else -+ _rtw_memcpy(data, efuse + offset, cnt); -+ -+ rtw_mfree(efuse, size); -+ } -+ -+ return err; -+} -+ -+int rtw_halmac_write_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u32 i; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ if (api->halmac_write_efuse == NULL) -+ return -1; -+ -+ 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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, u8 *maskmap, u32 masksize) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ enum 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_DRV); -+ if (HALMAC_RET_SUCCESS != status) { -+ free_halmac_event(d, id); -+ return -1; -+ } -+ -+ ret = wait_halmac_event(d, id); -+ if (ret) -+ return -1; -+ -+ if (maskmap && masksize) { -+ struct halmac_pg_efuse_info pginfo; -+ -+ pginfo.efuse_map = map; -+ pginfo.efuse_map_size = size; -+ pginfo.efuse_mask = maskmap; -+ pginfo.efuse_mask_size = masksize; -+ -+ status = api->halmac_mask_logical_efuse(mac, &pginfo); -+ if (status != HALMAC_RET_SUCCESS) -+ RTW_WARN("%s: mask logical efuse FAIL!\n", __FUNCTION__); -+ } -+ -+ return 0; -+} -+ -+int rtw_halmac_write_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size, u8 *maskmap, u32 masksize) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ struct halmac_pg_efuse_info pginfo; -+ enum halmac_ret_status status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ pginfo.efuse_map = map; -+ pginfo.efuse_map_size = size; -+ pginfo.efuse_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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ 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 enum hal_fifo_sel _fifo_sel_drv2halmac(u8 fifo_sel) -+{ -+ switch (fifo_sel) { -+ case 0: -+ return HAL_FIFO_SEL_TX; -+ case 1: -+ return HAL_FIFO_SEL_RX; -+ case 2: -+ return HAL_FIFO_SEL_RSVD_PAGE; -+ case 3: -+ return HAL_FIFO_SEL_REPORT; -+ case 4: -+ return HAL_FIFO_SEL_LLT; -+ case 5: -+ return HAL_FIFO_SEL_RXBUF_FW; -+ } -+ -+ return HAL_FIFO_SEL_RSVD_PAGE; -+} -+ -+/*#define CONFIG_HALMAC_FIFO_DUMP*/ -+int rtw_halmac_dump_fifo(struct dvobj_priv *d, u8 fifo_sel, u32 addr, u32 size, u8 *buffer) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum hal_fifo_sel halmac_fifo_sel; -+ enum halmac_ret_status status; -+ u8 *pfifo_map = NULL; -+ u32 fifo_size = 0; -+ s8 ret = 0;/* 0:success, -1:error */ -+ u8 mem_created = _FALSE; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ if ((size != 0) && (buffer == NULL)) -+ return -1; -+ -+ halmac_fifo_sel = _fifo_sel_drv2halmac(fifo_sel); -+ -+ if ((size) && (buffer)) { -+ pfifo_map = buffer; -+ fifo_size = size; -+ } else { -+ fifo_size = api->halmac_get_fifo_size(mac, halmac_fifo_sel); -+ -+ if (fifo_size) -+ pfifo_map = rtw_zvmalloc(fifo_size); -+ if (pfifo_map == NULL) -+ return -1; -+ mem_created = _TRUE; -+ } -+ -+ status = api->halmac_dump_fifo(mac, halmac_fifo_sel, addr, fifo_size, pfifo_map); -+ if (HALMAC_RET_SUCCESS != status) { -+ ret = -1; -+ goto _exit; -+ } -+ -+#ifdef CONFIG_HALMAC_FIFO_DUMP -+ { -+ static const char * const fifo_sel_str[] = { -+ "TX", "RX", "RSVD_PAGE", "REPORT", "LLT", "RXBUF_FW" -+ }; -+ -+ RTW_INFO("%s FIFO DUMP [start_addr:0x%04x , size:%d]\n", fifo_sel_str[halmac_fifo_sel], addr, fifo_size); -+ RTW_INFO_DUMP("\n", pfifo_map, fifo_size); -+ RTW_INFO(" ==================================================\n"); -+ } -+#endif /* CONFIG_HALMAC_FIFO_DUMP */ -+ -+_exit: -+ if ((mem_created == _TRUE) && pfifo_map) -+ rtw_vmfree(pfifo_map, fifo_size); -+ -+ return ret; -+} -+ -+/* -+ * rtw_halmac_rx_agg_switch() - Switch RX aggregation function and setting -+ * @d struct dvobj_priv * -+ * @enable _FALSE/_TRUE for disable/enable RX aggregation function -+ * -+ * This function could help to on/off bus RX aggregation function, and is only -+ * useful for SDIO and USB interface. Although only "enable" flag is brough in, -+ * some setting would be taken from other places, and they are from: -+ * [DMA aggregation] -+ * struct hal_com_data.rxagg_dma_size -+ * struct hal_com_data.rxagg_dma_timeout -+ * [USB aggregation] (only use for USB interface) -+ * struct hal_com_data.rxagg_usb_size -+ * struct hal_com_data.rxagg_usb_timeout -+ * If above values of size and timeout are both 0 means driver would not -+ * control the threshold setting and leave it to HALMAC handle. -+ * -+ * From HALMAC V1_04_04, driver force the size threshold be hard limit, and the -+ * rx size can not exceed the setting. -+ * -+ * Return 0 for success, otherwise fail. -+ */ -+int rtw_halmac_rx_agg_switch(struct dvobj_priv *d, u8 enable) -+{ -+ struct _ADAPTER *adapter; -+ struct hal_com_data *hal; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ struct halmac_rxagg_cfg rxaggcfg; -+ enum halmac_ret_status status; -+ -+ -+ adapter = dvobj_get_primary_adapter(d); -+ hal = GET_HAL_DATA(adapter); -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ _rtw_memset((void *)&rxaggcfg, 0, sizeof(rxaggcfg)); -+ rxaggcfg.mode = HALMAC_RX_AGG_MODE_NONE; -+ /* -+ * Always enable size limit to avoid rx size exceed -+ * driver defined size. -+ */ -+ rxaggcfg.threshold.size_limit_en = 1; -+ -+#ifdef RTW_RX_AGGREGATION -+ if (_TRUE == enable) { -+#ifdef CONFIG_SDIO_HCI -+ rxaggcfg.mode = HALMAC_RX_AGG_MODE_DMA; -+ rxaggcfg.threshold.drv_define = 0; -+ 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; -+ RTW_INFO("%s: RX aggregation threshold: " -+ "timeout=%u size=%u\n", -+ __FUNCTION__, -+ hal->rxagg_dma_timeout, -+ hal->rxagg_dma_size); -+ } -+#elif defined(CONFIG_USB_HCI) -+ 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 */ -+ } -+#endif /* RTW_RX_AGGREGATION */ -+ -+ status = api->halmac_cfg_rx_aggregation(halmac, &rxaggcfg); -+ 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) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_adapter *halmac = dvobj_to_halmac(dvobj); -+ struct halmac_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; -+} -+ -+/* -+ * Description -+ * Fill following spec info from HALMAC API: -+ * sec_cam_ent_num -+ * -+ * Return -+ * 0 Success -+ * others Fail -+ */ -+int rtw_halmac_fill_hal_spec(struct dvobj_priv *dvobj, struct hal_spec_t *spec) -+{ -+ enum halmac_ret_status status; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ u8 cam = 0; /* Security Cam Entry Number */ -+ -+ -+ halmac = dvobj_to_halmac(dvobj); -+ api = HALMAC_GET_API(halmac); -+ -+ /* Prepare data from HALMAC */ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_CAM_ENTRY_NUM, &cam); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ /* Fill data to hal_spec_t */ -+ spec->sec_cam_ent_num = cam; -+ -+ return 0; -+} -+ -+int rtw_halmac_p2pps(struct dvobj_priv *dvobj, struct hal_p2p_ps_para *pp2p_ps_para) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_adapter *halmac = dvobj_to_halmac(dvobj); -+ struct halmac_api *api = HALMAC_GET_API(halmac); -+ struct halmac_p2pps halmac_p2p_ps; -+ -+ (&halmac_p2p_ps)->offload_en = pp2p_ps_para->offload_en; -+ (&halmac_p2p_ps)->role = pp2p_ps_para->role; -+ (&halmac_p2p_ps)->ctwindow_en = pp2p_ps_para->ctwindow_en; -+ (&halmac_p2p_ps)->noa_en = pp2p_ps_para->noa_en; -+ (&halmac_p2p_ps)->noa_sel = pp2p_ps_para->noa_sel; -+ (&halmac_p2p_ps)->all_sta_sleep = pp2p_ps_para->all_sta_sleep; -+ (&halmac_p2p_ps)->discovery = pp2p_ps_para->discovery; -+ (&halmac_p2p_ps)->disable_close_rf = pp2p_ps_para->disable_close_rf; -+ (&halmac_p2p_ps)->p2p_port_id = _hw_port_drv2halmac(pp2p_ps_para->p2p_port_id); -+ (&halmac_p2p_ps)->p2p_group = pp2p_ps_para->p2p_group; -+ (&halmac_p2p_ps)->p2p_macid = pp2p_ps_para->p2p_macid; -+ (&halmac_p2p_ps)->ctwindow_length = pp2p_ps_para->ctwindow_length; -+ (&halmac_p2p_ps)->noa_duration_para = pp2p_ps_para->noa_duration_para; -+ (&halmac_p2p_ps)->noa_interval_para = pp2p_ps_para->noa_interval_para; -+ (&halmac_p2p_ps)->noa_start_time_para = pp2p_ps_para->noa_start_time_para; -+ (&halmac_p2p_ps)->noa_count_para = pp2p_ps_para->noa_count_para; -+ -+ status = api->halmac_p2pps(halmac, (&halmac_p2p_ps)); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+ -+} -+ -+/** -+ * rtw_halmac_iqk() - Run IQ Calibration -+ * @d: struct dvobj_priv* -+ * @clear: IQK parameters -+ * @segment: IQK parameters -+ * -+ * Process IQ Calibration(IQK). -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_iqk(struct dvobj_priv *d, u8 clear, u8 segment) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ enum halmac_feature_id id; -+ struct halmac_iqk_para para; -+ int ret; -+ u8 retry = 3; -+ u8 delay = 1; /* ms */ -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ id = HALMAC_FEATURE_IQK; -+ -+ ret = init_halmac_event(d, id, NULL, 0); -+ if (ret) -+ return -1; -+ -+ para.clear = clear; -+ para.segment_iqk = segment; -+ -+ do { -+ status = api->halmac_start_iqk(mac, ¶); -+ if (status != HALMAC_RET_BUSY_STATE) -+ break; -+ RTW_WARN("%s: Fail to start IQK, status is BUSY! retry=%d\n", __FUNCTION__, retry); -+ if (!retry) -+ break; -+ retry--; -+ rtw_msleep_os(delay); -+ } while (1); -+ if (status != HALMAC_RET_SUCCESS) { -+ free_halmac_event(d, id); -+ return -1; -+ } -+ -+ ret = wait_halmac_event(d, id); -+ if (ret) -+ return -1; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_dpk() - Run DP Calibration -+ * @d: struct dvobj_priv* -+ * @buf: buffer for store return value -+ * @bufsz: size of buffer -+ * -+ * Process DP Calibration(DPK). -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_dpk(struct dvobj_priv *d, u8 *buf, u32 bufsz) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ enum halmac_feature_id id; -+ int ret; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ id = HALMAC_FEATURE_DPK; -+ -+ ret = init_halmac_event(d, id, buf, bufsz); -+ if (ret) -+ return -1; -+ -+ status = api->halmac_start_dpk(mac); -+ if (status != HALMAC_RET_SUCCESS) { -+ free_halmac_event(d, id); -+ RTW_ERR("%s: Fail to start DPK (0x%x)!\n", -+ __FUNCTION__, status); -+ return -1; -+ } -+ -+ ret = wait_halmac_event(d, id); -+ if (ret) -+ return -1; -+ -+ return 0; -+} -+ -+static inline u32 _phy_parameter_val_drv2halmac(u32 val, u8 msk_en, u32 msk) -+{ -+ if (!msk_en) -+ return val; -+ -+ return (val << bitshift(msk)); -+} -+ -+static int _phy_parameter_drv2halmac(struct rtw_phy_parameter *para, struct halmac_phy_parameter_info *info) -+{ -+ if (!para || !info) -+ return -1; -+ -+ _rtw_memset(info, 0, sizeof(*info)); -+ -+ switch (para->cmd) { -+ case 0: -+ /* MAC register */ -+ switch (para->data.mac.size) { -+ case 1: -+ info->cmd_id = HALMAC_PARAMETER_CMD_MAC_W8; -+ break; -+ case 2: -+ info->cmd_id = HALMAC_PARAMETER_CMD_MAC_W16; -+ break; -+ default: -+ info->cmd_id = HALMAC_PARAMETER_CMD_MAC_W32; -+ break; -+ } -+ info->content.MAC_REG_W.value = _phy_parameter_val_drv2halmac( -+ para->data.mac.value, -+ para->data.mac.msk_en, -+ para->data.mac.msk); -+ info->content.MAC_REG_W.msk = para->data.mac.msk; -+ info->content.MAC_REG_W.offset = para->data.mac.offset; -+ info->content.MAC_REG_W.msk_en = para->data.mac.msk_en; -+ break; -+ -+ case 1: -+ /* BB register */ -+ switch (para->data.bb.size) { -+ case 1: -+ info->cmd_id = HALMAC_PARAMETER_CMD_BB_W8; -+ break; -+ case 2: -+ info->cmd_id = HALMAC_PARAMETER_CMD_BB_W16; -+ break; -+ default: -+ info->cmd_id = HALMAC_PARAMETER_CMD_BB_W32; -+ break; -+ } -+ info->content.BB_REG_W.value = _phy_parameter_val_drv2halmac( -+ para->data.bb.value, -+ para->data.bb.msk_en, -+ para->data.bb.msk); -+ info->content.BB_REG_W.msk = para->data.bb.msk; -+ info->content.BB_REG_W.offset = para->data.bb.offset; -+ info->content.BB_REG_W.msk_en = para->data.bb.msk_en; -+ break; -+ -+ case 2: -+ /* RF register */ -+ info->cmd_id = HALMAC_PARAMETER_CMD_RF_W; -+ info->content.RF_REG_W.value = _phy_parameter_val_drv2halmac( -+ para->data.rf.value, -+ para->data.rf.msk_en, -+ para->data.rf.msk); -+ info->content.RF_REG_W.msk = para->data.rf.msk; -+ info->content.RF_REG_W.offset = para->data.rf.offset; -+ info->content.RF_REG_W.msk_en = para->data.rf.msk_en; -+ info->content.RF_REG_W.rf_path = para->data.rf.path; -+ break; -+ -+ case 3: -+ /* Delay register */ -+ if (para->data.delay.unit == 0) -+ info->cmd_id = HALMAC_PARAMETER_CMD_DELAY_US; -+ else -+ info->cmd_id = HALMAC_PARAMETER_CMD_DELAY_MS; -+ info->content.DELAY_TIME.delay_time = para->data.delay.value; -+ break; -+ -+ case 0xFF: -+ /* Latest(End) command */ -+ info->cmd_id = HALMAC_PARAMETER_CMD_END; -+ break; -+ -+ default: -+ return -1; -+ } -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_cfg_phy_para() - Register(Phy parameter) configuration -+ * @d: struct dvobj_priv* -+ * @para: phy parameter -+ * -+ * Configure registers by firmware using H2C/C2H mechanism. -+ * The latest command should be para->cmd==0xFF(End command) to finish all -+ * processes. -+ * -+ * Return: 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_cfg_phy_para(struct dvobj_priv *d, struct rtw_phy_parameter *para) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ enum halmac_feature_id id; -+ struct halmac_phy_parameter_info info; -+ u8 full_fifo; -+ int err, ret; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ id = HALMAC_FEATURE_CFG_PARA; -+ full_fifo = 1; /* ToDo: How to deciede? */ -+ ret = 0; -+ -+ err = _phy_parameter_drv2halmac(para, &info); -+ if (err) -+ return -1; -+ -+ err = init_halmac_event(d, id, NULL, 0); -+ if (err) -+ return -1; -+ -+ status = api->halmac_cfg_parameter(mac, &info, full_fifo); -+ if (info.cmd_id == HALMAC_PARAMETER_CMD_END) { -+ if (status == HALMAC_RET_SUCCESS) { -+ err = wait_halmac_event(d, id); -+ if (err) -+ ret = -1; -+ } else { -+ free_halmac_event(d, id); -+ ret = -1; -+ RTW_ERR("%s: Fail to send END of cfg parameter, status is 0x%x!\n", __FUNCTION__, status); -+ } -+ } else { -+ if (status == HALMAC_RET_PARA_SENDING) { -+ err = wait_halmac_event(d, id); -+ if (err) -+ ret = -1; -+ } else { -+ free_halmac_event(d, id); -+ if (status != HALMAC_RET_SUCCESS) { -+ ret = -1; -+ RTW_ERR("%s: Fail to cfg parameter, status is 0x%x!\n", __FUNCTION__, status); -+ } -+ } -+ } -+ -+ return ret; -+} -+ -+static enum halmac_wlled_mode _led_mode_drv2halmac(u8 drv_mode) -+{ -+ enum halmac_wlled_mode halmac_mode; -+ -+ -+ switch (drv_mode) { -+ case 1: -+ halmac_mode = HALMAC_WLLED_MODE_TX; -+ break; -+ case 2: -+ halmac_mode = HALMAC_WLLED_MODE_RX; -+ break; -+ case 3: -+ halmac_mode = HALMAC_WLLED_MODE_SW_CTRL; -+ break; -+ case 0: -+ default: -+ halmac_mode = HALMAC_WLLED_MODE_TRX; -+ break; -+ } -+ -+ return halmac_mode; -+} -+ -+/** -+ * rtw_halmac_led_cfg() - Configure Hardware LED Mode -+ * @d: struct dvobj_priv* -+ * @enable: enable or disable LED function -+ * 0: disable -+ * 1: enable -+ * @mode: WLan LED mode (valid when enable==1) -+ * 0: Blink when TX(transmit packet) and RX(receive packet) -+ * 1: Blink when TX only -+ * 2: Blink when RX only -+ * 3: Software control -+ * -+ * Configure hardware WLan LED mode. -+ * If want to change LED mode after enabled, need to disable LED first and -+ * enable again to set new mode. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_led_cfg(struct dvobj_priv *d, u8 enable, u8 mode) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_wlled_mode led_mode; -+ enum halmac_ret_status status; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ if (enable) { -+ status = api->halmac_pinmux_set_func(halmac, -+ HALMAC_GPIO_FUNC_WL_LED); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: pinmux set fail!(0x%x)\n", -+ __FUNCTION__, status); -+ return -1; -+ } -+ -+ led_mode = _led_mode_drv2halmac(mode); -+ status = api->halmac_pinmux_wl_led_mode(halmac, led_mode); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: mode set fail!(0x%x)\n", -+ __FUNCTION__, status); -+ return -1; -+ } -+ } else { -+ /* Change LED to software control and turn off */ -+ api->halmac_pinmux_wl_led_mode(halmac, -+ HALMAC_WLLED_MODE_SW_CTRL); -+ api->halmac_pinmux_wl_led_sw_ctrl(halmac, 0); -+ -+ status = api->halmac_pinmux_free_func(halmac, -+ HALMAC_GPIO_FUNC_WL_LED); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: pinmux free fail!(0x%x)\n", -+ __FUNCTION__, status); -+ return -1; -+ } -+ } -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_led_switch() - Turn Hardware LED on/off -+ * @d: struct dvobj_priv* -+ * @on: LED light or not -+ * 0: Off -+ * 1: On(Light) -+ * -+ * Turn Hardware WLan LED On/Off. -+ * Before use this function, user should call rtw_halmac_led_ctrl() to switch -+ * mode to "software control(3)" first, otherwise control would fail. -+ * The interval between on and off must be longer than 1 ms, or the LED would -+ * keep light or dark only. -+ * Ex. Turn off LED at first, turn on after 0.5ms and turn off again after -+ * 0.5ms. The LED during this flow will only keep dark, and miss the turn on -+ * operation between two turn off operations. -+ */ -+void rtw_halmac_led_switch(struct dvobj_priv *d, u8 on) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ api->halmac_pinmux_wl_led_sw_ctrl(halmac, on); -+} -+ -+static int _gpio_cfg(struct dvobj_priv *d, enum halmac_gpio_func gpio, u8 enable) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ if (enable) { -+ status = api->halmac_pinmux_set_func(halmac, gpio); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: pinmux set GPIO(%d) fail!(0x%x)\n", -+ __FUNCTION__, gpio, status); -+ return -1; -+ } -+ } else { -+ status = api->halmac_pinmux_free_func(halmac, gpio); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: pinmux free GPIO(%d) fail!(0x%x)\n", -+ __FUNCTION__, gpio, status); -+ return -1; -+ } -+ } -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_bt_wake_cfg() - Configure BT wake host function -+ * @d: struct dvobj_priv* -+ * @enable: enable or disable BT wake host function -+ * 0: disable -+ * 1: enable -+ * -+ * Configure pinmux to allow BT to control BT wake host pin. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_bt_wake_cfg(struct dvobj_priv *d, u8 enable) -+{ -+ return _gpio_cfg(d, HALMAC_GPIO_FUNC_BT_HOST_WAKE1, enable); -+} -+ -+static enum halmac_gpio_func _gpio_to_func_for_rfe_ctrl(u8 gpio) -+{ -+ enum halmac_gpio_func f = HALMAC_GPIO_FUNC_UNDEFINE; -+ -+ -+#ifdef CONFIG_RTL8822C -+ switch (gpio) { -+ case 1: -+ f = HALMAC_GPIO_FUNC_ANTSWB; -+ break; -+ case 2: -+ f = HALMAC_GPIO_FUNC_S1_TRSW; -+ break; -+ case 3: -+ f = HALMAC_GPIO_FUNC_S0_TRSW; -+ break; -+ case 6: -+ f = HALMAC_GPIO_FUNC_S0_PAPE; -+ break; -+ case 7: -+ f = HALMAC_GPIO_FUNC_S0_TRSWB; -+ break; -+ case 13: -+ f = HALMAC_GPIO_FUNC_ANTSW; -+ break; -+ } -+#endif /* CONFIG_RTL8822C */ -+ -+ return f; -+} -+ -+/** -+ * rtw_halmac_rfe_ctrl_cfg() - Configure RFE control GPIO -+ * @d: struct dvobj_priv* -+ * @gpio: gpio number -+ * -+ * Configure pinmux to enable RFE control GPIO. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_rfe_ctrl_cfg(struct dvobj_priv *d, u8 gpio) -+{ -+ enum halmac_gpio_func f; -+ -+ -+ f = _gpio_to_func_for_rfe_ctrl(gpio); -+ if (f == HALMAC_GPIO_FUNC_UNDEFINE) -+ return -1; -+ return _gpio_cfg(d, f, 1); -+} -+ -+#ifdef CONFIG_PNO_SUPPORT -+/** -+ * _halmac_scanoffload() - Switch channel by firmware during scanning -+ * @d: struct dvobj_priv* -+ * @enable: 1: enable, 0: disable -+ * @nlo: 1: nlo mode (no c2h event), 0: normal mode -+ * @ssid: ssid of probe request -+ * @ssid_len: ssid length -+ * -+ * Switch Channel and Send Porbe Request Offloaded by FW -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+static int _halmac_scanoffload(struct dvobj_priv *d, u32 enable, u8 nlo, -+ u8 *ssid, u8 ssid_len) -+{ -+ struct _ADAPTER *adapter; -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ struct halmac_ch_info ch_info; -+ struct halmac_ch_switch_option cs_option; -+ struct mlme_ext_priv *pmlmeext; -+ enum halmac_feature_id id_update, id_ch_sw; -+ struct halmac_indicator *indicator, *tbl; -+ -+ int err = 0; -+ u8 probereq[64]; -+ u32 len = 0; -+ int i = 0; -+ struct pno_ssid pnossid; -+ struct rf_ctl_t *rfctl = NULL; -+ struct _RT_CHANNEL_INFO *ch_set; -+ -+ -+ tbl = d->hmpriv.indicator; -+ adapter = dvobj_get_primary_adapter(d); -+ mac = dvobj_to_halmac(d); -+ if (!mac) -+ return -1; -+ api = HALMAC_GET_API(mac); -+ id_update = HALMAC_FEATURE_UPDATE_PACKET; -+ id_ch_sw = HALMAC_FEATURE_CHANNEL_SWITCH; -+ pmlmeext = &(adapter->mlmeextpriv); -+ rfctl = adapter_to_rfctl(adapter); -+ ch_set = rfctl->channel_set; -+ -+ RTW_INFO("%s: %s scanoffload, mode: %s\n", -+ __FUNCTION__, enable?"Enable":"Disable", -+ nlo?"PNO/NLO":"Normal"); -+ -+ if (enable) { -+ _rtw_memset(probereq, 0, sizeof(probereq)); -+ -+ _rtw_memset(&pnossid, 0, sizeof(pnossid)); -+ if (ssid) { -+ if (ssid_len > sizeof(pnossid.SSID)) { -+ RTW_ERR("%s: SSID length(%d) is too long(>%d)!!\n", -+ __FUNCTION__, ssid_len, WLAN_SSID_MAXLEN); -+ return -1; -+ } -+ -+ pnossid.SSID_len = ssid_len; -+ _rtw_memcpy(pnossid.SSID, ssid, ssid_len); -+ } -+ -+ rtw_hal_construct_ProbeReq(adapter, probereq, &len, &pnossid); -+ -+ if (!nlo) { -+ err = init_halmac_event(d, id_update, NULL, 0); -+ if (err) -+ return -1; -+ } -+ -+ status = api->halmac_update_packet(mac, HALMAC_PACKET_PROBE_REQ, -+ probereq, len); -+ if (status != HALMAC_RET_SUCCESS) { -+ if (!nlo) -+ free_halmac_event(d, id_update); -+ RTW_ERR("%s: halmac_update_packet FAIL(%d)!!\n", -+ __FUNCTION__, status); -+ return -1; -+ } -+ -+ if (!nlo) { -+ err = wait_halmac_event(d, id_update); -+ if (err) -+ RTW_ERR("%s: wait update packet FAIL(%d)!!\n", -+ __FUNCTION__, err); -+ } -+ -+ api->halmac_clear_ch_info(mac); -+ -+ for (i = 0; i < rfctl->max_chan_nums && ch_set[i].ChannelNum != 0; i++) { -+ _rtw_memset(&ch_info, 0, sizeof(ch_info)); -+ ch_info.extra_info = 0; -+ ch_info.channel = ch_set[i].ChannelNum; -+ ch_info.bw = HALMAC_BW_20; -+ ch_info.pri_ch_idx = HALMAC_CH_IDX_1; -+ ch_info.action_id = HALMAC_CS_ACTIVE_SCAN; -+ ch_info.timeout = 1; -+ status = api->halmac_add_ch_info(mac, &ch_info); -+ if (status != HALMAC_RET_SUCCESS) { -+ RTW_ERR("%s: add_ch_info FAIL(%d)!!\n", -+ __FUNCTION__, status); -+ return -1; -+ } -+ } -+ -+ /* set channel switch option */ -+ _rtw_memset(&cs_option, 0, sizeof(cs_option)); -+ cs_option.dest_bw = HALMAC_BW_20; -+ cs_option.periodic_option = HALMAC_CS_PERIODIC_2_PHASE; -+ cs_option.dest_pri_ch_idx = HALMAC_CH_IDX_UNDEFINE; -+ cs_option.tsf_low = 0; -+ cs_option.switch_en = 1; -+ cs_option.dest_ch_en = 1; -+ cs_option.absolute_time_en = 0; -+ cs_option.dest_ch = 1; -+ -+ cs_option.normal_period = 5; -+ cs_option.normal_period_sel = 0; -+ cs_option.normal_cycle = 10; -+ -+ cs_option.phase_2_period = 1; -+ cs_option.phase_2_period_sel = 1; -+ -+ /* nlo is for wow fw, 1: no c2h response */ -+ cs_option.nlo_en = nlo; -+ -+ if (!nlo) { -+ err = init_halmac_event(d, id_ch_sw, NULL, 0); -+ if (err) -+ return -1; -+ } -+ -+ status = api->halmac_ctrl_ch_switch(mac, &cs_option); -+ if (status != HALMAC_RET_SUCCESS) { -+ if (!nlo) -+ free_halmac_event(d, id_ch_sw); -+ RTW_ERR("%s: halmac_ctrl_ch_switch FAIL(%d)!!\n", -+ __FUNCTION__, status); -+ return -1; -+ } -+ -+ if (!nlo) { -+ err = wait_halmac_event(d, id_ch_sw); -+ if (err) -+ RTW_ERR("%s: wait ctrl_ch_switch FAIL(%d)!!\n", -+ __FUNCTION__, err); -+ } -+ } else { -+ api->halmac_clear_ch_info(mac); -+ -+ _rtw_memset(&cs_option, 0, sizeof(cs_option)); -+ cs_option.switch_en = 0; -+ -+ if (!nlo) { -+ err = init_halmac_event(d, id_ch_sw, NULL, 0); -+ if (err) -+ return -1; -+ } -+ -+ status = api->halmac_ctrl_ch_switch(mac, &cs_option); -+ if (status != HALMAC_RET_SUCCESS) { -+ if (!nlo) -+ free_halmac_event(d, id_ch_sw); -+ RTW_ERR("%s: halmac_ctrl_ch_switch FAIL(%d)!!\n", -+ __FUNCTION__, status); -+ return -1; -+ } -+ -+ if (!nlo) { -+ err = wait_halmac_event(d, id_ch_sw); -+ if (err) -+ RTW_ERR("%s: wait ctrl_ch_switch FAIL(%d)!!\n", -+ __FUNCTION__, err); -+ } -+ } -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_pno_scanoffload() - Control firmware scan AP function for PNO -+ * @d: struct dvobj_priv* -+ * @enable: 1: enable, 0: disable -+ * -+ * Switch firmware scan AP function for PNO(prefer network offload) or -+ * NLO(network list offload). -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_pno_scanoffload(struct dvobj_priv *d, u32 enable) -+{ -+ return _halmac_scanoffload(d, enable, 1, NULL, 0); -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+#ifdef CONFIG_SDIO_HCI -+ -+/** -+ * rtw_halmac_preinit_sdio_io_indirect() - Enable indirect I/O or not -+ * @d: struct dvobj_priv* -+ * @enable: true: enable, false: disable -+ * -+ * Enable register access using direct I/O or indirect. This function should be -+ * called before rtw_halmac_init_adapter(), and the life cycle is the same as -+ * driver until removing driver. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_preinit_sdio_io_indirect(struct dvobj_priv *d, bool enable) -+{ -+ struct halmac_adapter *halmac; -+ struct halmacpriv *priv; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ if (halmac) { -+ RTW_WARN("%s: illegal operation! " -+ "preinit function only could be called before init!\n", -+ __FUNCTION__); -+ return -1; -+ } -+ -+ priv = &d->hmpriv; -+ priv->sdio_io_indir = (enable ? 1 : 2); -+ -+ return 0; -+} -+ -+/* -+ * Description: -+ * Update queue allocated page number to driver -+ * -+ * Parameter: -+ * d pointer to struct dvobj_priv of driver -+ * -+ * Return: -+ * 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; -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ struct halmac_rqpn_map rqpn; -+ enum halmac_dma_mapping dmaqueue; -+ struct halmac_txff_allocation fifosize; -+ enum halmac_ret_status status; -+ u8 i; -+ -+ -+ adapter = dvobj_get_primary_adapter(d); -+ 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 -+ * -+ * Return: -+ * 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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); -+} -+ -+int rtw_halmac_sdio_set_tx_format(struct dvobj_priv *d, enum halmac_sdio_tx_format format) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_set_hw_value(mac, HALMAC_HW_SDIO_TX_FORMAT, &format); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ return 0; -+} -+#endif /* CONFIG_SDIO_HCI */ -+ -+#ifdef CONFIG_USB_HCI -+u8 rtw_halmac_usb_get_bulkout_id(struct dvobj_priv *d, u8 *buf, u32 size) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum 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; -+} -+ -+/** -+ * rtw_halmac_usb_get_txagg_desc_num() - MAX descriptor number in one bulk for TX -+ * @d: struct dvobj_priv* -+ * @size: TX FIFO size, unit is byte. -+ * -+ * Get MAX descriptor number in one bulk out from HALMAC. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_usb_get_txagg_desc_num(struct dvobj_priv *d, u8 *num) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ u8 val = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_USB_TXAGG_DESC_NUM, &val); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *num = val; -+ -+ return 0; -+} -+ -+static inline enum halmac_usb_mode _usb_mode_drv2halmac(enum RTW_USB_SPEED usb_mode) -+{ -+ enum 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) -+{ -+ PADAPTER adapter; -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ enum halmac_usb_mode halmac_usb_mode; -+ -+ adapter = dvobj_get_primary_adapter(d); -+ 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 */ -+ -+#ifdef CONFIG_BEAMFORMING -+#ifdef RTW_BEAMFORMING_VERSION_2 -+int rtw_halmac_bf_add_mu_bfer(struct dvobj_priv *d, u16 paid, u16 csi_para, -+ u16 my_aid, enum halmac_csi_seg_len sel, u8 *addr) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ struct halmac_mu_bfer_init_para param; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ _rtw_memset(¶m, 0, sizeof(param)); -+ param.paid = paid; -+ param.csi_para = csi_para; -+ param.my_aid = my_aid; -+ param.csi_length_sel = sel; -+ _rtw_memcpy(param.bfer_address.addr, addr, 6); -+ -+ status = api->halmac_mu_bfer_entry_init(mac, ¶m); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_bf_del_mu_bfer(struct dvobj_priv *d) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_mu_bfer_entry_del(mac); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+} -+ -+ -+int rtw_halmac_bf_cfg_sounding(struct dvobj_priv *d, -+ enum halmac_snd_role role, enum halmac_data_rate rate) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_cfg_sounding(mac, role, rate); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_bf_del_sounding(struct dvobj_priv *d, -+ enum halmac_snd_role role) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_del_sounding(mac, role); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+} -+ -+/** -+ * rtw_halmac_bf_cfg_csi_rate() - Config data rate for CSI report frame by RSSI -+ * @d: struct dvobj_priv* -+ * @rssi: RSSI vlaue, unit is percentage (0~100). -+ * @current_rate: Current CSI frame rate -+ * Valid value example -+ * 0 CCK 1M -+ * 3 CCK 11M -+ * 4 OFDM 6M -+ * and so on -+ * @fixrate_en: Enable to fix CSI frame in VHT rate, otherwise legacy OFDM rate. -+ * The value "0" for disable, otheriwse enable. -+ * @new_rate: Return new data rate, and value range is the same as -+ * current_rate -+ * @bmp_ofdm54: Return to suggest enabling OFDM 54M for CSI report frame or not, -+ * The valid values and meanings are: -+ * 0x00 disable -+ * 0x01 enable -+ * 0xFF Keep current setting -+ * -+ * According RSSI to config data rate for CSI report frame of Beamforming. -+ * -+ * Return 0 for OK, otherwise fail. -+ */ -+int rtw_halmac_bf_cfg_csi_rate(struct dvobj_priv *d, u8 rssi, -+ u8 current_rate, u8 fixrate_en, u8 *new_rate, -+ u8 *bmp_ofdm54) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_cfg_csi_rate(mac, -+ rssi, current_rate, fixrate_en, new_rate, -+ bmp_ofdm54); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_bf_cfg_mu_mimo(struct dvobj_priv *d, enum halmac_snd_role role, -+ u8 *sounding_sts, u16 grouping_bitmap, u8 mu_tx_en, -+ u32 *given_gid_tab, u32 *given_user_pos) -+{ -+ struct halmac_adapter *mac; -+ struct halmac_api *api; -+ enum halmac_ret_status status; -+ struct halmac_cfg_mumimo_para param; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ _rtw_memset(¶m, 0, sizeof(param)); -+ -+ param.role = role; -+ param.grouping_bitmap = grouping_bitmap; -+ param.mu_tx_en = mu_tx_en; -+ -+ if (sounding_sts) -+ _rtw_memcpy(param.sounding_sts, sounding_sts, 6); -+ -+ if (given_gid_tab) -+ _rtw_memcpy(param.given_gid_tab, given_gid_tab, 8); -+ -+ if (given_user_pos) -+ _rtw_memcpy(param.given_user_pos, given_user_pos, 16); -+ -+ status = api->halmac_cfg_mumimo(mac, ¶m); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+} -+ -+#endif /* RTW_BEAMFORMING_VERSION_2 */ -+#endif /* CONFIG_BEAMFORMING */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_halmac.h b/drivers/net/wireless/rtl8821cs/hal/hal_halmac.h -new file mode 100644 -index 000000000..416141390 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_halmac.h -@@ -0,0 +1,256 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2021 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_H_ -+#define _HAL_HALMAC_H_ -+ -+#include /* adapter_to_dvobj(), struct intf_hdl and etc. */ -+#include /* struct hal_spec_t */ -+#ifdef CONFIG_HALMAC_RS -+#include "halmac-rs/halmac_api.h" /* struct halmac_adapter* and etc. */ -+#else /* !CONFIG_HALMAC_RS */ -+#include "halmac/halmac_api.h" /* struct halmac_adapter* and etc. */ -+#endif /* !CONFIG_HALMAC_RS */ -+ -+/* HALMAC Definition for Driver */ -+#define RTW_HALMAC_H2C_MAX_SIZE 8 -+#define RTW_HALMAC_BA_SSN_RPT_SIZE 4 -+ -+#define dvobj_set_halmac(d, mac) ((d)->halmac = (mac)) -+#define dvobj_to_halmac(d) ((struct halmac_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; -+ -+union rtw_phy_para_data { -+ struct _mac { -+ u32 value; /* value to be set in bit mask(msk) */ -+ u32 msk; /* bit mask */ -+ u16 offset; /* address */ -+ u8 msk_en; /* 0/1 for msk invalid/valid */ -+ u8 size; /* Unit is bytes, and value should be 1/2/4 */ -+ } mac; -+ struct _bb { -+ u32 value; -+ u32 msk; -+ u16 offset; -+ u8 msk_en; -+ u8 size; -+ } bb; -+ struct _rf { -+ u32 value; -+ u32 msk; -+ u8 offset; -+ u8 msk_en; -+ /* -+ * 0: path A -+ * 1: path B -+ * 2: path C -+ * 3: path D -+ */ -+ u8 path; -+ } rf; -+ struct _delay { -+ /* -+ * 0: microsecond (us) -+ * 1: millisecond (ms) -+ */ -+ u8 unit; -+ u16 value; -+ } delay; -+}; -+ -+struct rtw_phy_parameter { -+ /* -+ * 0: MAC register -+ * 1: BB register -+ * 2: RF register -+ * 3: Delay -+ * 0xFF: Latest(End) command -+ */ -+ u8 cmd; -+ union rtw_phy_para_data data; -+}; -+ -+struct rtw_halmac_bcn_ctrl { -+ u8 rx_bssid_fit:1; /* 0:HW handle beacon, 1:ignore */ -+ u8 txbcn_rpt:1; /* Enable TXBCN report in ad hoc and AP mode */ -+ u8 tsf_update:1; /* Update TSF when beacon or probe response */ -+ u8 enable_bcn:1; /* Enable beacon related functions */ -+ u8 rxbcn_rpt:1; /* Enable RXBCNOK report */ -+ u8 p2p_ctwin:1; /* Enable P2P CTN WINDOWS function */ -+ u8 p2p_bcn_area:1; /* Enable P2P BCN area on function */ -+}; -+ -+extern struct 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 /* CONFIG_SDIO_INDIRECT_ACCESS */ -+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); -+ -+/* Software Information */ -+void rtw_halmac_get_version(char *str, u32 len); -+ -+/* Software setting before Initialization */ -+int rtw_halmac_preinit_sdio_io_indirect(struct dvobj_priv *d, bool enable); -+ -+/* Software Initialization */ -+int rtw_halmac_init_adapter(struct dvobj_priv *d, struct halmac_platform_api *pf_api); -+int rtw_halmac_deinit_adapter(struct dvobj_priv *); -+ -+/* Get operations */ -+int rtw_halmac_get_hw_value(struct dvobj_priv *d, enum halmac_hw_id hw_id, void *pvalue); -+int rtw_halmac_get_tx_fifo_size(struct dvobj_priv *d, u32 *size); -+int rtw_halmac_get_rx_fifo_size(struct dvobj_priv *d, u32 *size); -+int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *d, u16 *bndy); -+int rtw_halmac_get_page_size(struct dvobj_priv *d, u32 *size); -+int rtw_halmac_get_tx_agg_align_size(struct dvobj_priv *d, u16 *size); -+int rtw_halmac_get_rx_agg_align_size(struct dvobj_priv *d, u8 *size); -+int rtw_halmac_get_rx_drv_info_sz(struct dvobj_priv *, u8 *sz); -+int rtw_halmac_get_tx_desc_size(struct dvobj_priv *d, u32 *size); -+int rtw_halmac_get_rx_desc_size(struct dvobj_priv *d, u32 *size); -+int rtw_halmac_get_tx_dma_ch_map(struct dvobj_priv *d, u8 *dma_ch_map, u8 map_size); -+int rtw_halmac_get_ori_h2c_size(struct dvobj_priv *d, u32 *size); -+int rtw_halmac_get_oqt_size(struct dvobj_priv *d, u8 *size); -+int rtw_halmac_get_ac_queue_number(struct dvobj_priv *d, u8 *num); -+int rtw_halmac_get_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); -+int rtw_halmac_get_network_type(struct dvobj_priv *d, enum _hw_port hwport, u8 *type); -+int rtw_halmac_get_bcn_ctrl(struct dvobj_priv *d, enum _hw_port hwport, struct rtw_halmac_bcn_ctrl *bcn_ctrl); -+/*int rtw_halmac_get_wow_reason(struct dvobj_priv *, u8 *reason);*/ -+ -+/* Set operations */ -+int rtw_halmac_config_rx_info(struct dvobj_priv *d, enum halmac_drv_info info); -+int rtw_halmac_set_max_dl_fw_size(struct dvobj_priv *d, u32 size); -+int rtw_halmac_set_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); -+int rtw_halmac_set_bssid(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); -+int rtw_halmac_set_tx_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); -+int rtw_halmac_set_network_type(struct dvobj_priv *d, enum _hw_port hwport, u8 type); -+int rtw_halmac_reset_tsf(struct dvobj_priv *d, enum _hw_port hwport); -+int rtw_halmac_set_bcn_interval(struct dvobj_priv *d, enum _hw_port hwport, u32 space); -+int rtw_halmac_set_bcn_ctrl(struct dvobj_priv *d, enum _hw_port hwport, struct rtw_halmac_bcn_ctrl *bcn_ctrl); -+int rtw_halmac_set_aid(struct dvobj_priv *d, enum _hw_port hwport, u16 aid); -+int rtw_halmac_set_bandwidth(struct dvobj_priv *d, u8 channel, u8 pri_ch_idx, u8 bw); -+int rtw_halmac_set_edca(struct dvobj_priv *d, u8 queue, u8 aifs, u8 cw, u16 txop); -+int rtw_halmac_set_rts_full_bw(struct dvobj_priv *d, u8 enable); -+ -+/* Functions */ -+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_txfifo_wait_empty(struct dvobj_priv *d, u32 timeout); -+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_dlfw_mem(struct dvobj_priv *d, u8 *fw, u32 fwsize, enum fw_mem mem); -+int rtw_halmac_dlfw_mem_from_file(struct dvobj_priv *d, u8 *fwpath, enum fw_mem mem); -+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); -+ -+/* eFuse */ -+int rtw_halmac_get_available_efuse_size(struct dvobj_priv *d, 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, u8 *maskmap, u32 masksize); -+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_dump_fifo(struct dvobj_priv *d, u8 fifo_sel, u32 addr, u32 size, u8 *buffer); -+int rtw_halmac_rx_agg_switch(struct dvobj_priv *, u8 enable); -+ -+/* Specific function APIs*/ -+int rtw_halmac_download_rsvd_page(struct dvobj_priv *dvobj, u8 pg_offset, u8 *pbuf, u32 size); -+int rtw_halmac_fill_hal_spec(struct dvobj_priv *, struct hal_spec_t *); -+int rtw_halmac_p2pps(struct dvobj_priv *dvobj, PHAL_P2P_PS_PARA pp2p_ps_para); -+int rtw_halmac_iqk(struct dvobj_priv *d, u8 clear, u8 segment); -+int rtw_halmac_dpk(struct dvobj_priv *d, u8 *buf, u32 bufsz); -+int rtw_halmac_cfg_phy_para(struct dvobj_priv *d, struct rtw_phy_parameter *para); -+int rtw_halmac_led_cfg(struct dvobj_priv *d, u8 enable, u8 mode); -+void rtw_halmac_led_switch(struct dvobj_priv *d, u8 on); -+int rtw_halmac_bt_wake_cfg(struct dvobj_priv *d, u8 enable); -+int rtw_halmac_rfe_ctrl_cfg(struct dvobj_priv *d, u8 gpio); -+#ifdef CONFIG_PNO_SUPPORT -+int rtw_halmac_pno_scanoffload(struct dvobj_priv *d, u32 enable); -+#endif -+ -+#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); -+int rtw_halmac_sdio_set_tx_format(struct dvobj_priv *d, enum halmac_sdio_tx_format format); -+#endif /* CONFIG_SDIO_HCI */ -+ -+#ifdef CONFIG_USB_HCI -+u8 rtw_halmac_usb_get_bulkout_id(struct dvobj_priv *, u8 *buf, u32 size); -+int rtw_halmac_usb_get_txagg_desc_num(struct dvobj_priv *d, u8 *num); -+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 -+ -+#ifdef CONFIG_BEAMFORMING -+#ifdef RTW_BEAMFORMING_VERSION_2 -+int rtw_halmac_bf_add_mu_bfer(struct dvobj_priv *d, u16 paid, u16 csi_para, -+ u16 my_aid, enum halmac_csi_seg_len sel, u8 *addr); -+int rtw_halmac_bf_del_mu_bfer(struct dvobj_priv *d); -+ -+int rtw_halmac_bf_cfg_sounding(struct dvobj_priv *d, enum halmac_snd_role role, -+ enum halmac_data_rate rate); -+int rtw_halmac_bf_del_sounding(struct dvobj_priv *d, enum halmac_snd_role role); -+ -+int rtw_halmac_bf_cfg_csi_rate(struct dvobj_priv *d, u8 rssi, u8 current_rate, -+ u8 fixrate_en, u8 *new_rate, u8 *bmp_ofdm54); -+ -+int rtw_halmac_bf_cfg_mu_mimo(struct dvobj_priv *d, enum halmac_snd_role role, -+ u8 *sounding_sts, u16 grouping_bitmap, u8 mu_tx_en, -+ u32 *given_gid_tab, u32 *given_user_pos); -+#define rtw_halmac_bf_cfg_mu_bfee(d, gid_tab, user_pos) \ -+ rtw_halmac_bf_cfg_mu_mimo(d, HAL_BFEE, NULL, 0, 0, gid_tab, user_pos) -+ -+#endif /* RTW_BEAMFORMING_VERSION_2 */ -+#endif /* CONFIG_BEAMFORMING */ -+ -+#endif /* _HAL_HALMAC_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_hci/hal_sdio.c b/drivers/net/wireless/rtl8821cs/hal/hal_hci/hal_sdio.c -new file mode 100644 -index 000000000..3e8be28d0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_hci/hal_sdio.c -@@ -0,0 +1,885 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#ifndef RTW_HALMAC -+const char *_sdio_tx_queue_str[] = { -+ "H", -+ "M", -+ "L", -+}; -+ -+static void dump_mac_page0(PADAPTER padapter) -+{ -+ char str_out[128]; -+ char str_val[8]; -+ char *p = NULL; -+ int index = 0, i = 0; -+ u8 val8 = 0, len = 0; -+ -+ RTW_ERR("Dump MAC Page0 register:\n"); -+ for (index = 0 ; index < 0x100 ; index += 16) { -+ p = &str_out[0]; -+ len = snprintf(str_val, sizeof(str_val), -+ "0x%02x: ", index); -+ strncpy(str_out, str_val, len); -+ p += len; -+ -+ for (i = 0 ; i < 16 ; i++) { -+ len = snprintf(str_val, sizeof(str_val), "%02x ", -+ rtw_read8(padapter, index + i)); -+ strncpy(p, str_val, len); -+ p += len; -+ } -+ RTW_INFO("%s\n", str_out); -+ _rtw_memset(&str_out, '\0', sizeof(str_out)); -+ } -+} -+ -+/* -+ * Description: -+ * Call this function to make sure power on successfully -+ * -+ * Return: -+ * _SUCCESS enable success -+ * _FAIL enable fail -+ */ -+bool sdio_power_on_check(PADAPTER padapter) { -+ u32 val_offset0, val_offset1, val_offset2, val_offset3; -+ u32 val_mix = 0; -+ u32 res = 0; -+ bool ret = _FAIL; -+ int index = 0; -+ -+ val_offset0 = rtw_read8(padapter, REG_CR); -+ val_offset1 = rtw_read8(padapter, REG_CR + 1); -+ val_offset2 = rtw_read8(padapter, REG_CR + 2); -+ val_offset3 = rtw_read8(padapter, REG_CR + 3); -+ -+ if (val_offset0 == 0xEA || val_offset1 == 0xEA || -+ val_offset2 == 0xEA || val_offset3 == 0xEA) { -+ RTW_INFO("%s: power on fail, do Power on again\n", __func__); -+ return ret; -+ } -+ -+ val_mix = val_offset3 << 24 | val_mix; -+ val_mix = val_offset2 << 16 | val_mix; -+ val_mix = val_offset1 << 8 | val_mix; -+ val_mix = val_offset0 | val_mix; -+ -+ res = rtw_read32(padapter, REG_CR); -+ -+ RTW_INFO("%s: val_mix:0x%08x, res:0x%08x\n", __func__, val_mix, res); -+ -+ while (index < 100) { -+ if (res == val_mix) { -+ RTW_INFO("%s: 0x100 the result of cmd52 and cmd53 is the same.\n", __func__); -+ ret = _SUCCESS; -+ break; -+ } else { -+ RTW_INFO("%s: 0x100 cmd52 and cmd53 is not the same(index:%d).\n", __func__, index); -+ res = rtw_read32(padapter, REG_CR); -+ index++; -+ ret = _FAIL; -+ } -+ } -+ -+ if (ret) { -+ index = 0; -+ while (index < 100) { -+ rtw_write32(padapter, 0x1B8, 0x12345678); -+ res = rtw_read32(padapter, 0x1B8); -+ if (res == 0x12345678) { -+ RTW_INFO("%s: 0x1B8 test Pass.\n", __func__); -+ ret = _SUCCESS; -+ break; -+ } else { -+ index++; -+ RTW_INFO("%s: 0x1B8 test Fail(index: %d).\n", __func__, index); -+ ret = _FAIL; -+ } -+ } -+ } else -+ RTW_INFO("%s: fail at cmd52, cmd53.\n", __func__); -+ -+ if (ret == _FAIL) -+ dump_mac_page0(padapter); -+ -+ return ret; -+} -+ -+u8 rtw_hal_sdio_max_txoqt_free_space(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (pHalData->SdioTxOQTMaxFreeSpace < 8) -+ pHalData->SdioTxOQTMaxFreeSpace = 8; -+ -+ return pHalData->SdioTxOQTMaxFreeSpace; -+} -+ -+u8 rtw_hal_sdio_query_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum) -+{ -+ HAL_DATA_TYPE *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(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 DedicatedPgNum = 0; -+ u8 RequiredPublicFreePgNum = 0; -+ /* _irqL irql; */ -+ -+ /* _enter_critical_bh(&pHalData->SdioTxFIFOFreePageLock, &irql); */ -+ -+ 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; -+ } -+ -+ /* _exit_critical_bh(&pHalData->SdioTxFIFOFreePageLock, &irql); */ -+} -+ -+void rtw_hal_set_sdio_tx_max_length(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ, u8 div_num) -+{ -+ HAL_DATA_TYPE *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) / div_num) * page_size; -+ lenNQ = ((numNQ + numPubQ) / div_num) * page_size; -+ lenLQ = ((numLQ + numPubQ) / div_num) * 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; -+ #ifdef DBG_TX_FREE_PAGE -+ RTW_INFO("rtw_hal_set_sdio_tx_max_length div_num :%u numHQ=%u numNQ=%u numLQ=%u numPubQ=%u\n",div_num ,numHQ,numNQ,numLQ,numPubQ); -+ RTW_INFO("pHalData->sdio_tx_max_len[HI_QUEUE_IDX] :%u\n",pHalData->sdio_tx_max_len[HI_QUEUE_IDX] ); -+ RTW_INFO("pHalData->sdio_tx_max_len[MID_QUEUE_IDX] :%u\n",pHalData->sdio_tx_max_len[MID_QUEUE_IDX] ); -+ RTW_INFO("rtw_hal_set_sdio_tx_max_length pHalData->sdio_tx_max_len[LOW_QUEUE_IDX] :%u\n",pHalData->sdio_tx_max_len[LOW_QUEUE_IDX] ); -+ #endif -+} -+ -+u32 rtw_hal_get_sdio_tx_max_length(PADAPTER padapter, u8 queue_idx) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ HAL_DATA_TYPE *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; -+} -+ -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+#if defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) ||defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8192F)|| defined(CONFIG_RTL8723D) -+void rtw_hal_sdio_avail_page_threshold_init(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ hal_data->sdio_avail_int_en_q = 0xFF; -+ rtw_write32(adapter, REG_TQPNT1, 0xFFFFFFFF); -+ rtw_write32(adapter, REG_TQPNT2, 0xFFFFFFFF); -+ #ifdef CONFIG_RTL8192F -+ rtw_write32(adapter, REG_TQPNT3_V1_8192F, 0xFFFFFFFF); -+ #endif -+} -+ -+void rtw_hal_sdio_avail_page_threshold_en(_adapter *adapter, u8 qidx, u8 page) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ if (hal_data->sdio_avail_int_en_q != qidx) { -+ u32 page_size; -+ u32 tx_max_len; -+ u32 threshold_reg[] = {REG_TQPNT1, REG_TQPNT1 + 2, REG_TQPNT2, REG_TQPNT2 + 2}; /* H, M, L, E */ -+ u8 dw_shift[] = {0, 16, 0, 16}; /* H, M, L, E */ -+ u32 threshold = 0; -+ -+ /* use same low-high threshold as page num from tx_max_len */ -+ if(dvobj->tx_aval_int_thr_mode == 0) /*default setting by requirement*/ -+ threshold = page; -+ else if (dvobj->tx_aval_int_thr_mode == 1 && dvobj->tx_aval_int_thr_value) -+ threshold = dvobj->tx_aval_int_thr_value; -+ else { -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); -+ tx_max_len = hal_data->sdio_tx_max_len[qidx]; -+ threshold = PageNum(tx_max_len, page_size); -+ } -+ threshold |= (threshold) << 8; -+ -+ if (hal_data->sdio_avail_int_en_q == 0xFF) -+ rtw_write16(adapter, threshold_reg[qidx], threshold); -+ else if (hal_data->sdio_avail_int_en_q >> 1 == qidx >> 1) {/* same dword */ -+ rtw_write16(adapter, threshold_reg[hal_data->sdio_avail_int_en_q], 0); -+ rtw_write32(adapter, threshold_reg[qidx & 0xFE] -+ , (0xFFFF << dw_shift[hal_data->sdio_avail_int_en_q]) | (threshold << dw_shift[qidx])); -+ } else { -+ rtw_write16(adapter, threshold_reg[hal_data->sdio_avail_int_en_q], 0); -+ rtw_write16(adapter, threshold_reg[hal_data->sdio_avail_int_en_q], 0xFFFF); -+ rtw_write16(adapter, threshold_reg[qidx], threshold); -+ } -+ -+ hal_data->sdio_avail_int_en_q = qidx; -+ -+ #ifdef DBG_TX_FREE_PAGE -+ RTW_INFO("DWQP enable avail page threshold %s:%u-%u\n", sdio_tx_queue_str(qidx) -+ , threshold & 0xFF, threshold >> 8); -+ #endif -+ } -+} -+#endif -+#endif /* CONFIG_SDIO_TX_ENABLE_AVAL_INT */ -+ -+#ifdef CONFIG_FW_C2H_REG -+void sd_c2h_hisr_hdl(_adapter *adapter) -+{ -+ u8 c2h_evt[C2H_REG_LEN] = {0}; -+ u8 id, seq, plen; -+ u8 *payload; -+ -+ if (rtw_hal_c2h_evt_read(adapter, c2h_evt) != _SUCCESS) -+ goto exit; -+ -+ if (rtw_hal_c2h_reg_hdr_parse(adapter, c2h_evt, &id, &seq, &plen, &payload) != _SUCCESS) -+ goto exit; -+ -+ if (rtw_hal_c2h_id_handle_directly(adapter, id, seq, plen, payload)) { -+ /* Handle directly */ -+ rtw_hal_c2h_handler(adapter, id, seq, plen, payload); -+ goto exit; -+ } -+ -+ if (rtw_c2h_reg_wk_cmd(adapter, c2h_evt) != _SUCCESS) -+ RTW_ERR("%s rtw_c2h_reg_wk_cmd fail\n", __func__); -+ -+exit: -+ return; -+} -+#endif -+ -+#ifdef CONFIG_SDIO_CHK_HCI_RESUME -+ -+#ifndef SDIO_HCI_RESUME_PWR_RDY_TIMEOUT_MS -+ #define SDIO_HCI_RESUME_PWR_RDY_TIMEOUT_MS 200 -+#endif -+#ifndef DBG_SDIO_CHK_HCI_RESUME -+ #define DBG_SDIO_CHK_HCI_RESUME 0 -+#endif -+ -+bool sdio_chk_hci_resume(struct intf_hdl *pintfhdl) -+{ -+ _adapter *adapter = pintfhdl->padapter; -+ u8 hci_sus_state; -+ u8 sus_ctl, sus_ctl_ori = 0xEA; -+ u8 do_leave = 0; -+ systime start = 0, end = 0; -+ u32 poll_cnt = 0; -+ u8 timeout = 0; -+ u8 sr = 0; -+ s32 err = 0; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_HCI_SUS_STATE, &hci_sus_state); -+ if (hci_sus_state == HCI_SUS_LEAVE || hci_sus_state == HCI_SUS_ERR) -+ goto no_hdl; -+ -+ err = sd_cmd52_read(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_HSUS_CTRL), 1, &sus_ctl); -+ if (err) -+ goto exit; -+ sus_ctl_ori = sus_ctl; -+ -+ if ((sus_ctl & HCI_RESUME_PWR_RDY) && !(sus_ctl & HCI_SUS_CTRL)) -+ goto exit; -+ -+ if (sus_ctl & HCI_SUS_CTRL) { -+ sus_ctl &= ~(HCI_SUS_CTRL); -+ err = sd_cmd52_write(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_HSUS_CTRL), 1, &sus_ctl); -+ if (err) -+ goto exit; -+ } -+ -+ do_leave = 1; -+ -+ /* polling for HCI_RESUME_PWR_RDY && !HCI_SUS_CTRL */ -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(adapter)) { -+ sr = 1; -+ break; -+ } -+ -+ err = sd_cmd52_read(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_HSUS_CTRL), 1, &sus_ctl); -+ poll_cnt++; -+ -+ if (!err && (sus_ctl & HCI_RESUME_PWR_RDY) && !(sus_ctl & HCI_SUS_CTRL)) -+ break; -+ -+ if (rtw_get_passing_time_ms(start) > SDIO_HCI_RESUME_PWR_RDY_TIMEOUT_MS) { -+ timeout = 1; -+ break; -+ } -+ } -+ end = rtw_get_current_time(); -+ -+exit: -+ -+ if (DBG_SDIO_CHK_HCI_RESUME) { -+ RTW_INFO(FUNC_ADPT_FMT" hci_sus_state:%u, sus_ctl:0x%02x(0x%02x), do_leave:%u, to:%u, err:%u\n" -+ , FUNC_ADPT_ARG(adapter), hci_sus_state, sus_ctl, sus_ctl_ori, do_leave, timeout, err); -+ if (start != 0 || end != 0) { -+ RTW_INFO(FUNC_ADPT_FMT" polling %d ms, cnt:%u\n" -+ , FUNC_ADPT_ARG(adapter), rtw_get_time_interval_ms(start, end), poll_cnt); -+ } -+ } -+ -+ if (timeout) { -+ RTW_ERR(FUNC_ADPT_FMT" timeout(err:%d) sus_ctl:0x%02x\n" -+ , FUNC_ADPT_ARG(adapter), err, sus_ctl); -+ } else if (err) { -+ RTW_ERR(FUNC_ADPT_FMT" err:%d\n" -+ , FUNC_ADPT_ARG(adapter), err); -+ } -+ -+no_hdl: -+ return do_leave ? _TRUE : _FALSE; -+} -+ -+void sdio_chk_hci_suspend(struct intf_hdl *pintfhdl) -+{ -+#define SDIO_CHK_HCI_SUSPEND_POLLING 0 -+ -+ _adapter *adapter = pintfhdl->padapter; -+ u8 hci_sus_state; -+ u8 sus_ctl, sus_ctl_ori = 0xEA; -+ systime start = 0, end = 0; -+ u32 poll_cnt = 0; -+ u8 timeout = 0; -+ u8 sr = 0; -+ s32 err = 0; -+ u8 device_id; -+ u16 offset; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_HCI_SUS_STATE, &hci_sus_state); -+ if (hci_sus_state == HCI_SUS_LEAVE || hci_sus_state == HCI_SUS_LEAVING || hci_sus_state == HCI_SUS_ERR) -+ goto no_hdl; -+ -+ err = sd_cmd52_read(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_HSUS_CTRL), 1, &sus_ctl); -+ if (err) -+ goto exit; -+ sus_ctl_ori = sus_ctl; -+ -+ if (!(sus_ctl & HCI_RESUME_PWR_RDY)) -+ goto exit; -+ -+ sus_ctl |= HCI_SUS_CTRL; -+ err = sd_cmd52_write(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_HSUS_CTRL), 1, &sus_ctl); -+ if (err) -+ goto exit; -+ -+#if SDIO_CHK_HCI_SUSPEND_POLLING -+ /* polling for HCI_RESUME_PWR_RDY cleared */ -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(adapter)) { -+ sr = 1; -+ break; -+ } -+ -+ err = sd_cmd52_read(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_HSUS_CTRL), 1, &sus_ctl); -+ poll_cnt++; -+ -+ if (!err && !(sus_ctl & HCI_RESUME_PWR_RDY)) -+ break; -+ -+ if (rtw_get_passing_time_ms(start) > SDIO_HCI_RESUME_PWR_RDY_TIMEOUT_MS) { -+ timeout = 1; -+ break; -+ } -+ } -+ end = rtw_get_current_time(); -+#endif /* SDIO_CHK_HCI_SUSPEND_POLLING */ -+ -+exit: -+ -+ if (DBG_SDIO_CHK_HCI_RESUME) { -+ RTW_INFO(FUNC_ADPT_FMT" hci_sus_state:%u, sus_ctl:0x%02x(0x%02x), to:%u, err:%u\n" -+ , FUNC_ADPT_ARG(adapter), hci_sus_state, sus_ctl, sus_ctl_ori, timeout, err); -+ if (start != 0 || end != 0) { -+ RTW_INFO(FUNC_ADPT_FMT" polling %d ms, cnt:%u\n" -+ , FUNC_ADPT_ARG(adapter), rtw_get_time_interval_ms(start, end), poll_cnt); -+ } -+ } -+ -+#if SDIO_CHK_HCI_SUSPEND_POLLING -+ if (timeout) { -+ RTW_ERR(FUNC_ADPT_FMT" timeout(err:%d) sus_ctl:0x%02x\n" -+ , FUNC_ADPT_ARG(adapter), err, sus_ctl); -+ } else -+#endif -+ if (err) { -+ RTW_ERR(FUNC_ADPT_FMT" err:%d\n" -+ , FUNC_ADPT_ARG(adapter), err); -+ } -+ -+no_hdl: -+ return; -+} -+#endif /* CONFIG_SDIO_CHK_HCI_RESUME */ -+ -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ -+/* program indirect access register in sdio local to read/write page0 registers */ -+#ifndef INDIRECT_ACCESS_TIMEOUT_MS -+ #define INDIRECT_ACCESS_TIMEOUT_MS 200 -+#endif -+#ifndef DBG_SDIO_INDIRECT_ACCESS -+ #define DBG_SDIO_INDIRECT_ACCESS 0 -+#endif -+ -+s32 sdio_iread(PADAPTER padapter, u32 addr, u8 size, u8 *v) -+{ -+ struct intf_hdl *pintfhdl = &padapter->iopriv.intf; -+ _mutex *mutex = &adapter_to_dvobj(padapter)->sd_indirect_access_mutex; -+ -+ u8 val[4] = {0}; -+ u8 cmd[4] = {0}; /* mapping to indirect access register, little endien */ -+ systime start = 0, end = 0; -+ u8 timeout = 0; -+ u8 sr = 0; -+ s32 err = 0; -+ -+ if (size == 1) -+ SET_INDIRECT_REG_SIZE_1BYTE(cmd); -+ else if (size == 2) -+ SET_INDIRECT_REG_SIZE_2BYTE(cmd); -+ else if (size == 4) -+ SET_INDIRECT_REG_SIZE_4BYTE(cmd); -+ -+ SET_INDIRECT_REG_ADDR(cmd, addr); -+ -+ /* acquire indirect access lock */ -+ _enter_critical_mutex(mutex, NULL); -+ -+ if (DBG_SDIO_INDIRECT_ACCESS) -+ RTW_INFO(FUNC_ADPT_FMT" cmd:%02x %02x %02x %02x\n", FUNC_ADPT_ARG(padapter), cmd[0], cmd[1], cmd[2], cmd[3]); -+ -+ err = sd_cmd52_write(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_INDIRECT_REG_CFG), 3, cmd); -+ if (err) -+ goto exit; -+ -+ /* trigger */ -+ SET_INDIRECT_REG_READ(cmd); -+ -+ if (DBG_SDIO_INDIRECT_ACCESS) -+ RTW_INFO(FUNC_ADPT_FMT" cmd:%02x %02x %02x %02x\n", FUNC_ADPT_ARG(padapter), cmd[0], cmd[1], cmd[2], cmd[3]); -+ -+ err = sd_cmd52_write(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_INDIRECT_REG_CFG + 2), 1, cmd + 2); -+ if (err) -+ goto exit; -+ -+ /* polling for indirect access done */ -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(padapter)) { -+ sr = 1; -+ break; -+ } -+ -+ err = sd_cmd52_read(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_INDIRECT_REG_CFG + 2), 1, cmd + 2); -+ -+ if (!err && GET_INDIRECT_REG_RDY(cmd)) -+ break; -+ -+ if (rtw_get_passing_time_ms(start) > INDIRECT_ACCESS_TIMEOUT_MS) { -+ timeout = 1; -+ break; -+ } -+ } -+ end = rtw_get_current_time(); -+ -+ if (timeout || sr) -+ goto exit; -+ -+ /* read result */ -+ err = sd_cmd52_read(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_INDIRECT_REG_DATA), size, val); -+ if (size == 2) -+ *((u16 *)(val)) = le16_to_cpu(*((u16 *)(val))); -+ else if (size == 4) -+ *((u32 *)(val)) = le32_to_cpu(*((u32 *)(val))); -+ -+ if (DBG_SDIO_INDIRECT_ACCESS) { -+ if (size == 1) -+ RTW_INFO(FUNC_ADPT_FMT" val:0x%02x\n", FUNC_ADPT_ARG(padapter), *((u8 *)(val))); -+ else if (size == 2) -+ RTW_INFO(FUNC_ADPT_FMT" val:0x%04x\n", FUNC_ADPT_ARG(padapter), *((u16 *)(val))); -+ else if (size == 4) -+ RTW_INFO(FUNC_ADPT_FMT" val:0x%08x\n", FUNC_ADPT_ARG(padapter), *((u32 *)(val))); -+ } -+ -+exit: -+ /* release indirect access lock */ -+ _exit_critical_mutex(mutex, NULL); -+ -+ if (DBG_SDIO_INDIRECT_ACCESS) { -+ RTW_INFO(FUNC_ADPT_FMT" addr:0x%0x size:%u, cmd:%02x %02x %02x %02x, to:%u, err:%u\n" -+ , FUNC_ADPT_ARG(padapter), addr, size, cmd[0], cmd[1], cmd[2], cmd[3], timeout, err); -+ if (start != 0 || end != 0) { -+ RTW_INFO(FUNC_ADPT_FMT" polling %d ms\n" -+ , FUNC_ADPT_ARG(padapter), rtw_get_time_interval_ms(start, end)); -+ } -+ } -+ -+ if (timeout) { -+ RTW_ERR(FUNC_ADPT_FMT" addr:0x%0x timeout(err:%d), cmd\n" -+ , FUNC_ADPT_ARG(padapter), addr, err); -+ if (!err) -+ err = -1; /* just for return value */ -+ } else if (err) { -+ RTW_ERR(FUNC_ADPT_FMT" addr:0x%0x err:%d\n" -+ , FUNC_ADPT_ARG(padapter), addr, err); -+ } else if (sr) { -+ /* just for return value */ -+ err = -1; -+ } -+ -+ if (!err && !timeout && !sr) -+ _rtw_memcpy(v, val, size); -+ -+ return err; -+} -+ -+s32 sdio_iwrite(PADAPTER padapter, u32 addr, u8 size, u8 *v) -+{ -+ struct intf_hdl *pintfhdl = &padapter->iopriv.intf; -+ _mutex *mutex = &adapter_to_dvobj(padapter)->sd_indirect_access_mutex; -+ -+ u8 val[4] = {0}; -+ u8 cmd[4] = {0}; /* mapping to indirect access register, little endien */ -+ systime start = 0, end = 0; -+ u8 timeout = 0; -+ u8 sr = 0; -+ s32 err = 0; -+ -+ if (size == 1) -+ SET_INDIRECT_REG_SIZE_1BYTE(cmd); -+ else if (size == 2) -+ SET_INDIRECT_REG_SIZE_2BYTE(cmd); -+ else if (size == 4) -+ SET_INDIRECT_REG_SIZE_4BYTE(cmd); -+ -+ SET_INDIRECT_REG_ADDR(cmd, addr); -+ -+ /* acquire indirect access lock */ -+ _enter_critical_mutex(mutex, NULL); -+ -+ if (DBG_SDIO_INDIRECT_ACCESS) -+ RTW_INFO(FUNC_ADPT_FMT" cmd:%02x %02x %02x %02x\n", FUNC_ADPT_ARG(padapter), cmd[0], cmd[1], cmd[2], cmd[3]); -+ -+ err = sd_cmd52_write(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_INDIRECT_REG_CFG), 3, cmd); -+ if (err) -+ goto exit; -+ -+ /* data to write */ -+ _rtw_memcpy(val, v, size); -+ -+ if (DBG_SDIO_INDIRECT_ACCESS) { -+ if (size == 1) -+ RTW_INFO(FUNC_ADPT_FMT" val:0x%02x\n", FUNC_ADPT_ARG(padapter), *((u8 *)(val))); -+ else if (size == 2) -+ RTW_INFO(FUNC_ADPT_FMT" val:0x%04x\n", FUNC_ADPT_ARG(padapter), *((u16 *)(val))); -+ else if (size == 4) -+ RTW_INFO(FUNC_ADPT_FMT" val:0x%08x\n", FUNC_ADPT_ARG(padapter), *((u32 *)(val))); -+ } -+ -+ if (size == 2) -+ *((u16 *)(val)) = cpu_to_le16(*((u16 *)(val))); -+ else if (size == 4) -+ *((u32 *)(val)) = cpu_to_le32(*((u32 *)(val))); -+ -+ err = sd_cmd52_write(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_INDIRECT_REG_DATA), size, val); -+ if (err) -+ goto exit; -+ -+ /* trigger */ -+ SET_INDIRECT_REG_WRITE(cmd); -+ -+ if (DBG_SDIO_INDIRECT_ACCESS) -+ RTW_INFO(FUNC_ADPT_FMT" cmd:%02x %02x %02x %02x\n", FUNC_ADPT_ARG(padapter), cmd[0], cmd[1], cmd[2], cmd[3]); -+ -+ err = sd_cmd52_write(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_INDIRECT_REG_CFG + 2), 1, cmd + 2); -+ if (err) -+ goto exit; -+ -+ /* polling for indirect access done */ -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(padapter)) { -+ sr = 1; -+ break; -+ } -+ -+ err = sd_cmd52_read(pintfhdl, SDIO_LOCAL_CMD_ADDR(SDIO_REG_INDIRECT_REG_CFG + 2), 1, cmd + 2); -+ -+ if (!err && GET_INDIRECT_REG_RDY(cmd)) -+ break; -+ -+ if (rtw_get_passing_time_ms(start) > INDIRECT_ACCESS_TIMEOUT_MS) { -+ timeout = 1; -+ break; -+ } -+ } -+ end = rtw_get_current_time(); -+ -+ if (timeout || sr) -+ goto exit; -+ -+exit: -+ /* release indirect access lock */ -+ _exit_critical_mutex(mutex, NULL); -+ -+ if (DBG_SDIO_INDIRECT_ACCESS) { -+ RTW_INFO(FUNC_ADPT_FMT" addr:0x%0x size:%u, cmd:%02x %02x %02x %02x, to:%u, err:%u\n" -+ , FUNC_ADPT_ARG(padapter), addr, size, cmd[0], cmd[1], cmd[2], cmd[3], timeout, err); -+ if (start != 0 || end != 0) { -+ RTW_INFO(FUNC_ADPT_FMT" polling %d ms\n" -+ , FUNC_ADPT_ARG(padapter), rtw_get_time_interval_ms(start, end)); -+ } -+ } -+ -+ if (timeout) { -+ RTW_ERR(FUNC_ADPT_FMT" addr:0x%0x timeout(err:%d), cmd\n" -+ , FUNC_ADPT_ARG(padapter), addr, err); -+ if (!err) -+ err = -1; /* just for return value */ -+ } else if (err) { -+ RTW_ERR(FUNC_ADPT_FMT" addr:0x%0x err:%d\n" -+ , FUNC_ADPT_ARG(padapter), addr, err); -+ } else if (sr) { -+ /* just for return value */ -+ err = -1; -+ } -+ -+ return err; -+} -+ -+u8 sdio_iread8(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u8 val; -+ -+ if (sdio_iread(pintfhdl->padapter, addr, 1, (u8 *)&val) != 0) -+ val = SDIO_ERR_VAL8; -+ -+ return val; -+} -+ -+u16 sdio_iread16(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u16 val; -+ -+ if (sdio_iread(pintfhdl->padapter, addr, 2, (u8 *)&val) != 0) -+ val = SDIO_ERR_VAL16; -+ -+ return val; -+} -+ -+u32 sdio_iread32(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u32 val; -+ -+ if (sdio_iread(pintfhdl->padapter, addr, 4, (u8 *)&val) != 0) -+ val = SDIO_ERR_VAL32; -+ -+ return val; -+} -+ -+s32 sdio_iwrite8(struct intf_hdl *pintfhdl, u32 addr, u8 val) -+{ -+ return sdio_iwrite(pintfhdl->padapter, addr, 1, (u8 *)&val); -+} -+ -+s32 sdio_iwrite16(struct intf_hdl *pintfhdl, u32 addr, u16 val) -+{ -+ return sdio_iwrite(pintfhdl->padapter, addr, 2, (u8 *)&val); -+} -+ -+s32 sdio_iwrite32(struct intf_hdl *pintfhdl, u32 addr, u32 val) -+{ -+ return sdio_iwrite(pintfhdl->padapter, addr, 4, (u8 *)&val); -+} -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+u32 cmd53_4byte_alignment(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u32 addr_rdr; -+ u32 value; -+ -+ value = 0; -+ addr_rdr = addr % 4; -+ -+ if (addr_rdr) { -+ u8 shift_bit; -+ -+ shift_bit = addr_rdr * 8; -+ value = (sd_read32(pintfhdl, (addr - addr_rdr), NULL)) >> shift_bit; -+ } else -+ value = sd_read32(pintfhdl, addr, NULL); -+ -+ return value; -+} -+ -+#endif /* !RTW_HALMAC */ -+ -+#ifndef CONFIG_SDIO_TX_TASKLET -+#ifdef SDIO_FREE_XMIT_BUF_SEMA -+void _rtw_sdio_free_xmitbuf_sema_up(struct xmit_priv *xmit) -+{ -+ _rtw_up_sema(&xmit->sdio_free_xmitbuf_sema); -+} -+ -+void _rtw_sdio_free_xmitbuf_sema_down(struct xmit_priv *xmit) -+{ -+ _rtw_down_sema(&xmit->sdio_free_xmitbuf_sema); -+} -+ -+#ifdef DBG_SDIO_FREE_XMIT_BUF_SEMA -+void dbg_rtw_sdio_free_xmitbuf_sema_up(struct xmit_priv *xmit, const char *caller) -+{ -+ /* just for debug usage only, pleae take care for the different of count implementaton */ -+ RTW_INFO("%s("ADPT_FMT") before up sdio_free_xmitbuf_sema, count:%u\n" -+ , caller, ADPT_ARG(xmit->adapter), xmit->sdio_free_xmitbuf_sema.count); -+ _rtw_sdio_free_xmitbuf_sema_up(xmit); -+} -+ -+void dbg_rtw_sdio_free_xmitbuf_sema_down(struct xmit_priv *xmit, const char *caller) -+{ -+ /* just for debug usage only, pleae take care for the different of count implementaton */ -+ RTW_INFO("%s("ADPT_FMT") before down sdio_free_xmitbuf_sema, count:%u\n" -+ , caller, ADPT_ARG(xmit->adapter), xmit->sdio_free_xmitbuf_sema.count); -+ _rtw_sdio_free_xmitbuf_sema_down(xmit); -+} -+#endif /* DBG_SDIO_FREE_XMIT_BUF_SEMA */ -+ -+#endif /* SDIO_FREE_XMIT_BUF_SEMA */ -+#endif /* !CONFIG_SDIO_TX_TASKLET */ -+ -+s32 sdio_initrecvbuf(struct recv_buf *recvbuf, _adapter *adapter) -+{ -+ _rtw_init_listhead(&recvbuf->list); -+#ifdef PLATFORM_WINDOWS -+ _rtw_spinlock_init(&recvbuf->recvbuf_lock); -+#endif -+ recvbuf->adapter = adapter; -+ -+ return _SUCCESS; -+} -+ -+void sdio_freerecvbuf(struct recv_buf *recvbuf) -+{ -+#ifdef PLATFORM_WINDOWS -+ _rtw_spinlock_free(&recvbuf->recvbuf_lock); -+#endif -+} -+ -+#ifdef CONFIG_SDIO_RECVBUF_PWAIT -+void dump_recvbuf_pwait_conf(void *sel, struct recv_priv *recvpriv) -+{ -+ struct rtw_pwait_conf *conf = &recvpriv->recvbuf_pwait.conf; -+ -+ RTW_PRINT_SEL(sel, "%-4s %-10s %-10s\n" -+ , "type", "time", "cnt_lmt"); -+ RTW_PRINT_SEL(sel, "%4s %10d %10d\n" -+ , rtw_pwait_type_str(conf->type), conf->wait_time, conf->wait_cnt_lmt); -+} -+ -+#ifdef CONFIG_SDIO_RECVBUF_PWAIT_RUNTIME_ADJUST -+int recvbuf_pwait_config_req(struct recv_priv *recvpriv, enum rtw_pwait_type type, s32 time, s32 cnt_lmt) -+{ -+ struct recv_buf *rbuf; -+ struct rtw_pwait_conf *conf; -+ int ret = _FAIL; -+ -+ rbuf = rtw_malloc(sizeof(*rbuf) + sizeof(struct rtw_pwait_conf)); -+ if (!rbuf) -+ goto exit; -+ -+ sdio_initrecvbuf(rbuf, recvpriv->adapter); -+ rbuf->type = RBUF_TYPE_PWAIT_ADJ; -+ rbuf->pbuf = ((u8*)rbuf) + sizeof(*rbuf); -+ conf = (struct rtw_pwait_conf *)rbuf->pbuf; -+ conf->type = type; -+ conf->wait_time = time; -+ conf->wait_cnt_lmt = cnt_lmt; -+ -+ ret = rtw_enqueue_recvbuf(rbuf, &recvpriv->free_recv_buf_queue); -+ if (0 && ret == _SUCCESS) { -+ RTW_INFO("request recvbuf_pwait with type=%s time=%d cnt_lmt=%d\n" -+ , rtw_pwait_type_str(type), time, cnt_lmt); -+ } -+ -+exit: -+ return ret; -+} -+ -+int recvbuf_pwait_config_hdl(struct recv_priv *recvpriv, struct recv_buf *rbuf) -+{ -+ struct rtw_pwait_conf *conf = (struct rtw_pwait_conf *)rbuf->pbuf; -+ int ret = rtw_pwctx_config(&recvpriv->recvbuf_pwait, conf->type, conf->wait_time, conf->wait_cnt_lmt); -+ -+ if (0 && ret == _SUCCESS) { -+ RTW_INFO("config recvbuf_pwait with type=%s time=%d cnt_lmt=%d\n" -+ , rtw_pwait_type_str(conf->type), conf->wait_time, conf->wait_cnt_lmt); -+ } -+ sdio_freerecvbuf(rbuf); -+ rtw_mfree(rbuf, sizeof(*rbuf) + sizeof(*conf)); -+ -+ return ret; -+} -+#endif /* CONFIG_SDIO_RECVBUF_PWAIT_RUNTIME_ADJUST */ -+#endif /* CONFIG_SDIO_RECVBUF_PWAIT */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_hci/hal_sdio_coex.c b/drivers/net/wireless/rtl8821cs/hal/hal_hci/hal_sdio_coex.c -new file mode 100644 -index 000000000..564e4089a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_hci/hal_sdio_coex.c -@@ -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 -+#include /* HAL_DATA_TYPE */ -+ -+#ifdef CONFIG_SDIO_MULTI_FUNCTION_COEX -+ -+int rtw_sdio_multi_state = SDIO_MULTI_WIFI; -+EXPORT_SYMBOL(rtw_sdio_multi_state); -+ -+bool ex_hal_sdio_multi_if_bus_available(PADAPTER adapter) -+{ -+ return rtw_sdio_multi_state == SDIO_MULTI_WIFI; -+} -+ -+#endif /* CONFIG_SDIO_MULTI_FUNCTION_COEX */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_intf.c b/drivers/net/wireless/rtl8821cs/hal/hal_intf.c -new file mode 100644 -index 000000000..22033a68e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_intf.c -@@ -0,0 +1,2367 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+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_RTL8188F, -+ ODM_RTL8822B, -+ ODM_RTL8723D, -+ ODM_RTL8821C, -+ ODM_RTL8710B, -+ ODM_RTL8192F, -+ ODM_RTL8822C, -+ ODM_RTL8814B, -+ ODM_RTL8723F, -+ 0, -+}; -+ -+void rtw_hal_chip_configure(_adapter *padapter) -+{ -+ padapter->hal_func.intf_chip_configure(padapter); -+} -+ -+/* -+ * Description: -+ * Read chip internal ROM data -+ * -+ * Return: -+ * _SUCCESS success -+ * _FAIL fail -+ */ -+u8 rtw_hal_read_chip_info(_adapter *padapter) -+{ -+ u8 rtn = _SUCCESS; -+ u8 hci_type = rtw_get_intf_type(padapter); -+ systime 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); -+ -+ rtn = padapter->hal_func.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)); -+ -+ return rtn; -+} -+ -+void rtw_hal_read_chip_version(_adapter *padapter) -+{ -+ padapter->hal_func.read_chip_version(padapter); -+ rtw_odm_init_ic_type(padapter); -+} -+ -+static void rtw_init_wireless_mode(_adapter *padapter) -+{ -+ u8 proto_wireless_mode = 0; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ if(hal_spec->proto_cap & PROTO_CAP_11B) -+ proto_wireless_mode |= WIRELESS_11B; -+ -+ if(hal_spec->proto_cap & PROTO_CAP_11G) -+ proto_wireless_mode |= WIRELESS_11G; -+ -+ if(hal_spec->band_cap & BAND_CAP_5G) -+ proto_wireless_mode |= WIRELESS_11A; -+ -+#ifdef CONFIG_80211N_HT -+ if(hal_spec->proto_cap & PROTO_CAP_11N) { -+ -+ if(hal_spec->band_cap & BAND_CAP_2G) -+ proto_wireless_mode |= WIRELESS_11_24N; -+ if(hal_spec->band_cap & BAND_CAP_5G) -+ proto_wireless_mode |= WIRELESS_11_5N; -+ } -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ if(hal_spec->proto_cap & PROTO_CAP_11AC) -+ proto_wireless_mode |= WIRELESS_11AC; -+#endif -+ padapter->registrypriv.wireless_mode &= proto_wireless_mode; -+} -+ -+void rtw_hal_def_value_init(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ /*init fw_psmode_iface_id*/ -+ adapter_to_pwrctl(padapter)->fw_psmode_iface_id = 0xff; -+ /*wireless_mode*/ -+ rtw_init_wireless_mode(padapter); -+ padapter->hal_func.init_default_value(padapter); -+ -+ rtw_init_hal_com_default_value(padapter); -+ -+ #ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ adapter_to_dvobj(padapter)->dft.port_id = 0xFF; -+ adapter_to_dvobj(padapter)->dft.mac_id = 0xFF; -+ #endif -+ #ifdef CONFIG_HW_P0_TSF_SYNC -+ adapter_to_dvobj(padapter)->p0_tsf.sync_port = MAX_HW_PORT; -+ adapter_to_dvobj(padapter)->p0_tsf.offset = 0; -+ #endif -+ -+ GET_HAL_DATA(padapter)->rx_tsf_addr_filter_config = 0; -+ } -+} -+ -+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; -+ } -+ rtw_phydm_priv_init(padapter); -+ } -+ 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->hal_func.dm_init(padapter); -+ -+ _rtw_spinlock_init(&pHalData->IQKSpinLock); -+ -+ #ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ if (pHalData->txpwr_pg_mode == TXPWR_PG_WITH_PWR_IDX) -+ hal_load_txpwr_info(padapter); -+ #endif -+ 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->hal_func.dm_deinit(padapter); -+ -+ _rtw_spinlock_free(&pHalData->IQKSpinLock); -+ } -+} -+ -+enum rf_type rtw_chip_rftype_to_hal_rftype(_adapter *adapter, u8 limit) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ u8 tx_num = 0, rx_num = 0; -+ -+ /*get RF PATH from version_id.RF_TYPE */ -+ if (IS_1T1R(hal_data->version_id)) { -+ tx_num = 1; -+ rx_num = 1; -+ } else if (IS_1T2R(hal_data->version_id)) { -+ tx_num = 1; -+ rx_num = 2; -+ } else if (IS_2T2R(hal_data->version_id)) { -+ tx_num = 2; -+ rx_num = 2; -+ } else if (IS_2T3R(hal_data->version_id)) { -+ tx_num = 2; -+ rx_num = 3; -+ } else if (IS_2T4R(hal_data->version_id)) { -+ tx_num = 2; -+ rx_num = 4; -+ } else if (IS_3T3R(hal_data->version_id)) { -+ tx_num = 3; -+ rx_num = 3; -+ } else if (IS_3T4R(hal_data->version_id)) { -+ tx_num = 3; -+ rx_num = 4; -+ } else if (IS_4T4R(hal_data->version_id)) { -+ tx_num = 4; -+ rx_num = 4; -+ } -+ -+ if (limit) { -+ tx_num = rtw_min(tx_num, limit); -+ rx_num = rtw_min(rx_num, limit); -+ } -+ -+ return trx_num_to_rf_type(tx_num, rx_num); -+} -+ -+void dump_hal_runtime_trx_mode(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regpriv = &adapter->registrypriv; -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ int i; -+ -+ RTW_PRINT_SEL(sel, "txpath=0x%x, rxpath=0x%x\n", hal_data->txpath, hal_data->rxpath); -+ for (i = 0; i < hal_data->tx_nss; i++) -+ RTW_PRINT_SEL(sel, "txpath_%uss:0x%x, num:%u\n" -+ , i + 1, hal_data->txpath_nss[i] -+ , hal_data->txpath_num_nss[i]); -+} -+ -+void dump_hal_trx_mode(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regpriv = &adapter->registrypriv; -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ int i; -+ -+ RTW_PRINT_SEL(sel, "trx_path_bmp:0x%02x(%s), NumTotalRFPath:%u, max_tx_cnt:%u\n" -+ , hal_data->trx_path_bmp -+ , rf_type_to_rfpath_str(hal_data->rf_type) -+ , hal_data->NumTotalRFPath -+ , hal_data->max_tx_cnt -+ ); -+ RTW_PRINT_SEL(sel, "tx_nss:%u, rx_nss:%u\n" -+ , hal_data->tx_nss, hal_data->rx_nss); -+ for (i = 0; i < hal_data->tx_nss; i++) -+ RTW_PRINT_SEL(sel, "txpath_cap_num_%uss:%u\n" -+ , i + 1, hal_data->txpath_cap_num_nss[i]); -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ dump_hal_runtime_trx_mode(sel, adapter); -+} -+ -+void _dump_rf_path(void *sel, _adapter *adapter) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ -+ RTW_PRINT_SEL(sel, "[RF_PATH] ver_id.RF_TYPE:%s\n" -+ , rf_type_to_rfpath_str(rtw_chip_rftype_to_hal_rftype(adapter, 0))); -+ RTW_PRINT_SEL(sel, "[RF_PATH] HALSPEC's rf_reg_trx_path_bmp:0x%02x, rf_reg_path_avail_num:%u, max_tx_cnt:%u\n" -+ , hal_spec->rf_reg_trx_path_bmp, hal_spec->rf_reg_path_avail_num, hal_spec->max_tx_cnt); -+ RTW_PRINT_SEL(sel, "[RF_PATH] PG's trx_path_bmp:0x%02x, max_tx_cnt:%u\n" -+ , hal_data->eeprom_trx_path_bmp, hal_data->eeprom_max_tx_cnt); -+ RTW_PRINT_SEL(sel, "[RF_PATH] Registry's trx_path_bmp:0x%02x, tx_path_lmt:%u, rx_path_lmt:%u\n" -+ , regsty->trx_path_bmp, regsty->tx_path_lmt, regsty->rx_path_lmt); -+ RTW_PRINT_SEL(sel, "[RF_PATH] HALDATA's trx_path_bmp:0x%02x, max_tx_cnt:%u\n" -+ , hal_data->trx_path_bmp, hal_data->max_tx_cnt); -+ RTW_PRINT_SEL(sel, "[RF_PATH] HALDATA's rf_type:%s, NumTotalRFPath:%d\n" -+ , rf_type_to_rfpath_str(hal_data->rf_type), hal_data->NumTotalRFPath); -+} -+ -+#ifdef CONFIG_RTL8814A -+extern enum rf_type rtl8814a_rfpath_decision(_adapter *adapter); -+#endif -+ -+u8 rtw_hal_rfpath_init(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+#ifdef CONFIG_RTL8814A -+if (IS_HARDWARE_TYPE_8814A(adapter)) { -+ enum bb_path tx_bmp, rx_bmp; -+ hal_data->rf_type = rtl8814a_rfpath_decision(adapter); -+ rf_type_to_default_trx_bmp(hal_data->rf_type, &tx_bmp, &rx_bmp); -+ hal_data->trx_path_bmp = (tx_bmp << 4) | rx_bmp; -+ hal_data->NumTotalRFPath = 4; -+ hal_data->max_tx_cnt = hal_spec->max_tx_cnt; -+ hal_data->max_tx_cnt = rtw_min(hal_data->max_tx_cnt, rf_type_to_rf_tx_cnt(hal_data->rf_type)); -+} else -+#endif -+{ -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ u8 trx_path_bmp; -+ u8 tx_path_num; -+ u8 rx_path_num; -+ int i; -+ -+ trx_path_bmp = hal_spec->rf_reg_trx_path_bmp; -+ -+ if (regsty->trx_path_bmp != 0x00) { -+ /* restrict trx_path_bmp with regsty.trx_path_bmp */ -+ trx_path_bmp &= regsty->trx_path_bmp; -+ if (!trx_path_bmp) { -+ RTW_ERR("%s hal_spec.rf_reg_trx_path_bmp:0x%02x, regsty->trx_path_bmp:0x%02x no intersection\n" -+ , __func__, hal_spec->rf_reg_trx_path_bmp, regsty->trx_path_bmp); -+ return _FAIL; -+ } -+ } else if (hal_data->eeprom_trx_path_bmp != 0x00) { -+ /* restrict trx_path_bmp with eeprom_trx_path_bmp */ -+ trx_path_bmp &= hal_data->eeprom_trx_path_bmp; -+ if (!trx_path_bmp) { -+ RTW_ERR("%s hal_spec.rf_reg_trx_path_bmp:0x%02x, hal_data->eeprom_trx_path_bmp:0x%02x no intersection\n" -+ , __func__, hal_spec->rf_reg_trx_path_bmp, hal_data->eeprom_trx_path_bmp); -+ return _FAIL; -+ } -+ } -+ -+ /* restrict trx_path_bmp with TX and RX num limit */ -+ trx_path_bmp = rtw_restrict_trx_path_bmp_by_trx_num_lmt(trx_path_bmp -+ , regsty->tx_path_lmt, regsty->rx_path_lmt, &tx_path_num, &rx_path_num); -+ if (!trx_path_bmp) { -+ RTW_ERR("%s rtw_restrict_trx_path_bmp_by_trx_num_lmt(0x%02x, %u, %u) failed\n" -+ , __func__, trx_path_bmp, regsty->tx_path_lmt, regsty->rx_path_lmt); -+ return _FAIL; -+ } -+ hal_data->trx_path_bmp = trx_path_bmp; -+ hal_data->rf_type = trx_bmp_to_rf_type((trx_path_bmp & 0xF0) >> 4, trx_path_bmp & 0x0F); -+ hal_data->NumTotalRFPath = rtw_max(tx_path_num, rx_path_num); -+ -+ hal_data->max_tx_cnt = hal_spec->max_tx_cnt; -+ hal_data->max_tx_cnt = rtw_min(hal_data->max_tx_cnt, tx_path_num); -+ if (hal_data->eeprom_max_tx_cnt) -+ hal_data->max_tx_cnt = rtw_min(hal_data->max_tx_cnt, hal_data->eeprom_max_tx_cnt); -+ -+ if (1) -+ _dump_rf_path(RTW_DBGDUMP, adapter); -+} -+ -+ RTW_INFO("%s trx_path_bmp:0x%02x(%s), NumTotalRFPath:%u, max_tx_cnt:%u\n" -+ , __func__ -+ , hal_data->trx_path_bmp -+ , rf_type_to_rfpath_str(hal_data->rf_type) -+ , hal_data->NumTotalRFPath -+ , hal_data->max_tx_cnt); -+ -+ return _SUCCESS; -+} -+ -+void _dump_trx_nss(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regpriv = &adapter->registrypriv; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ RTW_PRINT_SEL(sel, "[TRX_Nss] HALSPEC - tx_nss:%d, rx_nss:%d\n", hal_spec->tx_nss_num, hal_spec->rx_nss_num); -+ RTW_PRINT_SEL(sel, "[TRX_Nss] Registry - tx_nss:%d, rx_nss:%d\n", regpriv->tx_nss, regpriv->rx_nss); -+ RTW_PRINT_SEL(sel, "[TRX_Nss] HALDATA - tx_nss:%d, rx_nss:%d\n", GET_HAL_TX_NSS(adapter), GET_HAL_RX_NSS(adapter)); -+ -+} -+#define NSS_VALID(nss) (nss > 0) -+ -+u8 rtw_hal_trxnss_init(_adapter *adapter) -+{ -+ struct registry_priv *regpriv = &adapter->registrypriv; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ enum rf_type rf_path = GET_HAL_RFPATH(adapter); -+ int i; -+ -+ hal_data->tx_nss = hal_spec->tx_nss_num; -+ hal_data->rx_nss = hal_spec->rx_nss_num; -+ -+ if (NSS_VALID(regpriv->tx_nss)) -+ hal_data->tx_nss = rtw_min(hal_data->tx_nss, regpriv->tx_nss); -+ hal_data->tx_nss = rtw_min(hal_data->tx_nss, hal_data->max_tx_cnt); -+ if (NSS_VALID(regpriv->rx_nss)) -+ hal_data->rx_nss = rtw_min(hal_data->rx_nss, regpriv->rx_nss); -+ hal_data->rx_nss = rtw_min(hal_data->rx_nss, rf_type_to_rf_rx_cnt(rf_path)); -+ -+ for (i = 0; i < 4; i++) { -+ if (hal_data->tx_nss < i + 1) -+ break; -+ -+ if (IS_HARDWARE_TYPE_8814B(adapter) /* 8814B is always full-TX */ -+ #ifdef CONFIG_RTW_TX_NPATH_EN -+ /* these IC is capable of full-TX when macro defined */ -+ || IS_HARDWARE_TYPE_8192E(adapter) || IS_HARDWARE_TYPE_8192F(adapter) -+ || IS_HARDWARE_TYPE_8812(adapter) || IS_HARDWARE_TYPE_8822B(adapter) -+ || IS_HARDWARE_TYPE_8822C(adapter) -+ #endif -+ ) -+ hal_data->txpath_cap_num_nss[i] = hal_data->max_tx_cnt; -+ else -+ hal_data->txpath_cap_num_nss[i] = i + 1; -+ } -+ -+ if (1) -+ _dump_trx_nss(RTW_DBGDUMP, adapter); -+ -+ RTW_INFO("%s tx_nss:%u, rx_nss:%u\n", __func__ -+ , hal_data->tx_nss, hal_data->rx_nss); -+ -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_RTW_SW_LED -+void rtw_hal_sw_led_init(_adapter *padapter) -+{ -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ -+ if (ledpriv->bRegUseLed == _FALSE) -+ return; -+ -+ if (!is_primary_adapter(padapter)) -+ return; -+ -+ if (padapter->hal_func.InitSwLeds) { -+ padapter->hal_func.InitSwLeds(padapter); -+ rtw_led_set_ctl_en_mask_primary(padapter); -+ rtw_led_set_iface_en(padapter, 1); -+ } -+} -+ -+void rtw_hal_sw_led_deinit(_adapter *padapter) -+{ -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ -+ if (ledpriv->bRegUseLed == _FALSE) -+ return; -+ -+ if (!is_primary_adapter(padapter)) -+ return; -+ -+ if (padapter->hal_func.DeInitSwLeds) -+ padapter->hal_func.DeInitSwLeds(padapter); -+} -+#endif -+ -+u32 rtw_hal_power_on(_adapter *padapter) -+{ -+ u32 ret = 0; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ ret = padapter->hal_func.hal_power_on(padapter); -+ -+#ifdef CONFIG_BT_COEXIST -+ if ((ret == _SUCCESS) && (pHalData->EEPROMBluetoothCoexist == _TRUE)) -+ 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); -+ _rtw_memset(macid_ctl->op_num, 0, H2C_MSR_ROLE_MAX); -+ -+#ifdef CONFIG_LPS_1T1R -+ GET_HAL_DATA(padapter)->lps_1t1r = 0; -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_PowerOffSetting(padapter); -+#endif -+ -+ padapter->hal_func.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; -+#ifdef CONFIG_AP_MODE -+ else if (fw_state & WIFI_AP_STATE) -+ networkType = Ndis802_11APMode; -+#endif -+#ifdef CONFIG_RTW_MESH -+ else if (fw_state & WIFI_MESH_STATE) -+ networkType = Ndis802_11_mesh; -+#endif -+ else -+ return; -+ -+ rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_DIRECTLY); -+} -+ -+#ifdef CONFIG_NEW_NETDEV_HDL -+uint rtw_hal_iface_init(_adapter *adapter) -+{ -+ uint status = _SUCCESS; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_MAC_ADDR, adapter_mac_addr(adapter)); -+ #ifdef RTW_HALMAC -+ rtw_hal_hw_port_enable(adapter); -+ #endif -+ rtw_sec_restore_wep_key(adapter); -+ rtw_hal_init_opmode(adapter); -+ rtw_hal_start_thread(adapter); -+ return status; -+} -+uint rtw_hal_init(_adapter *padapter) -+{ -+ uint status = _SUCCESS; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ halrf_set_rfsupportability(adapter_to_phydm(padapter)); -+ -+ status = padapter->hal_func.hal_init(padapter); -+ -+ if(pHalData ->phydm_init_result) { -+ -+ status = _FAIL; -+ RTW_ERR("%s phydm init fail reason=%u \n", -+ __func__, -+ pHalData ->phydm_init_result); -+ } -+ -+ if (status == _SUCCESS) { -+ rtw_set_hw_init_completed(padapter, _TRUE); -+ if (padapter->registrypriv.notch_filter == 1) -+ rtw_hal_notch_filter(padapter, 1); -+ rtw_led_control(padapter, LED_CTL_POWER_ON); -+ init_hw_mlme_ext(padapter); -+ #ifdef CONFIG_RF_POWER_TRIM -+ rtw_bb_rf_gain_offset(padapter); -+ #endif /*CONFIG_RF_POWER_TRIM*/ -+ GET_PRIMARY_ADAPTER(padapter)->bup = _TRUE; /*temporary*/ -+ #ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_mi_set_mbid_cam(padapter); -+ #endif -+ #ifdef CONFIG_SUPPORT_MULTI_BCN -+ rtw_ap_multi_bcn_cfg(padapter); -+ #endif -+ #if (RTL8822B_SUPPORT == 1) || (RTL8192F_SUPPORT == 1) -+ #ifdef CONFIG_DYNAMIC_SOML -+ rtw_dyn_soml_config(padapter); -+ #endif -+ #endif -+ #ifdef CONFIG_TDMADIG -+ rtw_phydm_tdmadig(padapter, TDMADIG_INIT); -+ #endif/*CONFIG_TDMADIG*/ -+ rtw_phydm_dyn_rrsr_en(padapter,padapter->registrypriv.en_dyn_rrsr); -+ #ifdef RTW_HALMAC -+ RTW_INFO("%s: padapter->registrypriv.set_rrsr_value=0x%x\n", __func__,padapter->registrypriv.set_rrsr_value); -+ if(padapter->registrypriv.set_rrsr_value != 0xFFFFFFFF) -+ rtw_phydm_set_rrsr(padapter, padapter->registrypriv.set_rrsr_value, TRUE); -+ #endif -+ } else { -+ rtw_set_hw_init_completed(padapter, _FALSE); -+ RTW_ERR("%s: hal_init fail\n", __func__); -+ } -+ return status; -+} -+#else -+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; -+ -+ halrf_set_rfsupportability(adapter_to_phydm(padapter)); -+ -+ status = padapter->hal_func.hal_init(padapter); -+ -+ if(pHalData ->phydm_init_result) { -+ -+ status = _FAIL; -+ RTW_ERR("%s phydm init fail reason=%u \n", -+ __func__, -+ pHalData->phydm_init_result); -+ } -+ -+ if (status == _SUCCESS) { -+ rtw_set_hw_init_completed(padapter, _TRUE); -+ rtw_mi_set_mac_addr(padapter);/*set mac addr of all ifaces*/ -+ #ifdef RTW_HALMAC -+ rtw_restore_hw_port_cfg(padapter); -+ #endif -+ 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*/ -+ -+ #ifdef CONFIG_SUPPORT_MULTI_BCN -+ rtw_ap_multi_bcn_cfg(padapter); -+ #endif -+ -+#if (RTL8822B_SUPPORT == 1) || (RTL8192F_SUPPORT == 1) -+#ifdef CONFIG_DYNAMIC_SOML -+ rtw_dyn_soml_config(padapter); -+#endif -+#endif -+ #ifdef CONFIG_TDMADIG -+ rtw_phydm_tdmadig(padapter, TDMADIG_INIT); -+ #endif/*CONFIG_TDMADIG*/ -+ -+ rtw_phydm_dyn_rrsr_en(padapter,padapter->registrypriv.en_dyn_rrsr); -+ #ifdef RTW_HALMAC -+ RTW_INFO("%s: padapter->registrypriv.set_rrsr_value=0x%x\n", __func__,padapter->registrypriv.set_rrsr_value); -+ if(padapter->registrypriv.set_rrsr_value != 0xFFFFFFFF) -+ rtw_phydm_set_rrsr(padapter, padapter->registrypriv.set_rrsr_value, TRUE); -+ #endif -+ -+ } else { -+ rtw_set_hw_init_completed(padapter, _FALSE); -+ RTW_ERR("%s: fail\n", __func__); -+ } -+ -+ -+ return status; -+ -+} -+#endif -+ -+uint rtw_hal_deinit(_adapter *padapter) -+{ -+ uint status = _SUCCESS; -+ -+ status = padapter->hal_func.hal_deinit(padapter); -+ -+ if (status == _SUCCESS) { -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ rtw_set_hw_init_completed(padapter, _FALSE); -+ } else -+ RTW_INFO("\n rtw_hal_deinit: hal_init fail\n"); -+ -+ -+ return status; -+} -+ -+u8 rtw_hal_set_hwreg(_adapter *padapter, u8 variable, u8 *val) -+{ -+ return padapter->hal_func.set_hw_reg_handler(padapter, variable, val); -+} -+ -+void rtw_hal_get_hwreg(_adapter *padapter, u8 variable, u8 *val) -+{ -+ padapter->hal_func.GetHwRegHandler(padapter, variable, val); -+} -+ -+u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *pValue) -+{ -+ return padapter->hal_func.SetHalDefVarHandler(padapter, eVariable, pValue); -+} -+u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *pValue) -+{ -+ return padapter->hal_func.get_hal_def_var_handler(padapter, eVariable, pValue); -+} -+ -+void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, BOOLEAN bSet) -+{ -+ padapter->hal_func.SetHalODMVarHandler(padapter, eVariable, pValue1, bSet); -+} -+void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, void *pValue2) -+{ -+ padapter->hal_func.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->hal_func.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->hal_func.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->hal_func.check_ips_status) -+ val = padapter->hal_func.check_ips_status(padapter); -+ else -+ RTW_INFO("%s: hal_func.check_ips_status is NULL!\n", __FUNCTION__); -+ -+ return val; -+} -+ -+s32 rtw_hal_fw_dl(_adapter *padapter, u8 wowlan) -+{ -+ s32 ret; -+ -+ ret = padapter->hal_func.fw_dl(padapter, wowlan); -+ -+#ifdef CONFIG_LPS_1T1R -+ GET_HAL_DATA(padapter)->lps_1t1r = 0; -+#endif -+ -+ return ret; -+} -+ -+#ifdef RTW_HALMAC -+s32 rtw_hal_fw_mem_dl(_adapter *padapter, enum fw_mem mem) -+{ -+ systime dlfw_start_time = rtw_get_current_time(); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ s32 rst = _FALSE; -+ -+ rst = padapter->hal_func.fw_mem_dl(padapter, mem); -+ RTW_INFO("%s in %dms\n", __func__, rtw_get_passing_time_ms(dlfw_start_time)); -+ -+ if (rst == _FALSE) -+ pdbgpriv->dbg_fw_mem_dl_error_cnt++; -+ if (1) -+ RTW_INFO("%s dbg_fw_mem_dl_error_cnt:%d\n", __func__, pdbgpriv->dbg_fw_mem_dl_error_cnt); -+ return rst; -+} -+#endif -+ -+#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->hal_func.clear_interrupt(padapter); -+#endif -+} -+#endif -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+u32 rtw_hal_inirp_init(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) -+ return padapter->hal_func.inirp_init(padapter); -+ return _SUCCESS; -+} -+u32 rtw_hal_inirp_deinit(_adapter *padapter) -+{ -+ -+ if (is_primary_adapter(padapter)) -+ return padapter->hal_func.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->hal_func.irp_reset(GET_PRIMARY_ADAPTER(padapter)); -+} -+ -+void rtw_hal_pci_dbi_write(_adapter *padapter, u16 addr, u8 data) -+{ -+ u16 cmd[2]; -+ -+ cmd[0] = addr; -+ cmd[1] = data; -+ -+ padapter->hal_func.set_hw_reg_handler(padapter, HW_VAR_DBI, (u8 *) cmd); -+} -+ -+u8 rtw_hal_pci_dbi_read(_adapter *padapter, u16 addr) -+{ -+ padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_DBI, (u8 *)(&addr)); -+ -+ return (u8)addr; -+} -+ -+void rtw_hal_pci_mdio_write(_adapter *padapter, u8 addr, u16 data) -+{ -+ u16 cmd[2]; -+ -+ cmd[0] = (u16)addr; -+ cmd[1] = data; -+ -+ padapter->hal_func.set_hw_reg_handler(padapter, HW_VAR_MDIO, (u8 *) cmd); -+} -+ -+u16 rtw_hal_pci_mdio_read(_adapter *padapter, u8 addr) -+{ -+ padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_MDIO, &addr); -+ -+ return (u8)addr; -+} -+ -+u8 rtw_hal_pci_l1off_nic_support(_adapter *padapter) -+{ -+ u8 l1off; -+ -+ padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_L1OFF_NIC_SUPPORT, &l1off); -+ return l1off; -+} -+ -+u8 rtw_hal_pci_l1off_capability(_adapter *padapter) -+{ -+ u8 l1off; -+ -+ padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_L1OFF_CAPABILITY, &l1off); -+ return l1off; -+} -+ -+ -+#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->hal_func.interface_ps_func) -+ return padapter->hal_func.interface_ps_func(padapter, efunc_id, val); -+ return _FAIL; -+} -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+s32 rtw_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ return padapter->hal_func.hal_mgmt_xmitframe_enqueue(padapter, pxmitframe); -+} -+#endif -+ -+s32 rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ return padapter->hal_func.hal_xmitframe_enqueue(padapter, pxmitframe); -+} -+ -+s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ return padapter->hal_func.hal_xmit(padapter, pxmitframe); -+} -+ -+/* -+ * [IMPORTANT] This function would be run in interrupt context. -+ */ -+s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ _irqL irqL; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+#endif -+ s32 ret = _FAIL; -+ -+ update_mgntframe_attrib_addr(padapter, pmgntframe); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ update_mgntframe_subtype(padapter, pmgntframe); -+#endif -+ -+#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) -+ if ((!MLME_IS_MESH(padapter) && SEC_IS_BIP_KEY_INSTALLED(&padapter->securitypriv) == _TRUE) -+ #ifdef CONFIG_RTW_MESH -+ || (MLME_IS_MESH(padapter) && padapter->mesh_info.mesh_auth_id) -+ #endif -+ ) -+ rtw_mgmt_xmitframe_coalesce(padapter, pmgntframe->pkt, pmgntframe); -+#endif -+ -+#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ ret = mgmt_xmitframe_enqueue_for_sleeping_sta(padapter, pmgntframe); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ #ifdef DBG_MGMT_QUEUE -+ if (ret == _TRUE) -+ RTW_INFO("%s doesn't be queued, dattrib->ra:"MAC_FMT" seq_num = %u, subtype = 0x%x\n", -+ __func__, MAC_ARG(pmgntframe->attrib.ra), pmgntframe->attrib.seqnum, pmgntframe->attrib.subtype); -+ #endif -+ -+ if (ret == RTW_QUEUE_MGMT) -+ return ret; -+ } -+#endif -+#endif -+ -+ ret = padapter->hal_func.mgnt_xmit(padapter, pmgntframe); -+ return ret; -+} -+ -+s32 rtw_hal_init_xmit_priv(_adapter *padapter) -+{ -+ return padapter->hal_func.init_xmit_priv(padapter); -+} -+void rtw_hal_free_xmit_priv(_adapter *padapter) -+{ -+ padapter->hal_func.free_xmit_priv(padapter); -+} -+ -+s32 rtw_hal_init_recv_priv(_adapter *padapter) -+{ -+ return padapter->hal_func.init_recv_priv(padapter); -+} -+void rtw_hal_free_recv_priv(_adapter *padapter) -+{ -+ padapter->hal_func.free_recv_priv(padapter); -+} -+ -+void rtw_sta_ra_registed(_adapter *padapter, struct sta_info *psta) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ -+ if (psta == NULL) { -+ RTW_ERR(FUNC_ADPT_FMT" sta is NULL\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return; -+ } -+ -+#ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { -+ if (psta->cmn.aid > padapter->stapriv.max_aid) { -+ RTW_ERR("station aid %d exceed the max number\n", psta->cmn.aid); -+ rtw_warn_on(1); -+ return; -+ } -+ rtw_ap_update_sta_ra_info(padapter, psta); -+ } -+#endif -+ -+ psta->cmn.ra_info.ra_bw_mode = rtw_get_tx_bw_mode(padapter, psta); -+ /*set correct initial date rate for each mac_id */ -+ hal_data->INIDATA_RATE[psta->cmn.mac_id] = psta->init_rate; -+ -+ rtw_phydm_ra_registed(padapter, psta); -+} -+ -+void rtw_hal_update_ra_mask(struct sta_info *psta) -+{ -+ _adapter *padapter; -+ -+ if (!psta) -+ return; -+ -+ padapter = psta->padapter; -+ rtw_sta_ra_registed(padapter, psta); -+} -+ -+/* 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->hal_func.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->hal_func.cancel_thread(padapter); -+ -+#endif -+#endif -+} -+ -+u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ if (padapter->hal_func.read_bbreg) -+ data = padapter->hal_func.read_bbreg(padapter, RegAddr, BitMask); -+ return data; -+} -+void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if (padapter->hal_func.write_bbreg) -+ padapter->hal_func.write_bbreg(padapter, RegAddr, BitMask, Data); -+} -+ -+u32 rtw_hal_read_rfreg(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ -+ if (padapter->hal_func.read_rfreg) { -+ data = padapter->hal_func.read_rfreg(padapter, eRFPath, RegAddr, BitMask); -+ -+ #ifdef DBG_IO -+ if (match_rf_read_sniff_ranges(padapter, 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); -+ } -+ #endif -+ } -+ -+ return data; -+} -+ -+void rtw_hal_write_rfreg(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if (padapter->hal_func.write_rfreg) { -+ -+ #ifdef DBG_IO -+ if (match_rf_write_sniff_ranges(padapter, 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); -+ } -+ #endif -+ -+ padapter->hal_func.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 -+ } -+} -+ -+#ifdef CONFIG_SYSON_INDIRECT_ACCESS -+u32 rtw_hal_read_syson_reg(PADAPTER padapter, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ if (padapter->hal_func.read_syson_reg) -+ data = padapter->hal_func.read_syson_reg(padapter, RegAddr, BitMask); -+ -+ return data; -+} -+ -+void rtw_hal_write_syson_reg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if (padapter->hal_func.write_syson_reg) -+ padapter->hal_func.write_syson_reg(padapter, RegAddr, BitMask, Data); -+} -+#endif -+ -+#if defined(CONFIG_PCI_HCI) -+s32 rtw_hal_interrupt_handler(_adapter *padapter) -+{ -+ s32 ret = _FAIL; -+ ret = padapter->hal_func.interrupt_handler(padapter); -+ return ret; -+} -+ -+void rtw_hal_unmap_beacon_icf(_adapter *padapter) -+{ -+ padapter->hal_func.unmap_beacon_icf(padapter); -+} -+#endif -+#if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) -+void rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf) -+{ -+ padapter->hal_func.interrupt_handler(padapter, pkt_len, pbuf); -+} -+#endif -+ -+void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, enum channel_width Bandwidth, u8 Offset40, u8 Offset80) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ /*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; -+ -+ if (rtw_phydm_is_iqk_in_progress(padapter)) -+ RTW_ERR("%s, %d, IQK may race condition\n", __func__, __LINE__); -+ -+#ifdef CONFIG_MP_INCLUDED -+ /* MP mode channel don't use secondary channel */ -+ if (rtw_mp_mode_check(padapter) == _FALSE) -+#endif -+ { -+ #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->hal_func.set_chnl_bw_handler(padapter, channel, Bandwidth, Offset40, Offset80); -+} -+ -+void rtw_hal_dm_watchdog(_adapter *padapter) -+{ -+ -+ rtw_hal_turbo_edca(padapter); -+ padapter->hal_func.hal_dm_watchdog(padapter); -+} -+ -+#ifdef CONFIG_LPS_LCLK_WD_TIMER -+void rtw_hal_dm_watchdog_in_lps(_adapter *padapter) -+{ -+#if defined(CONFIG_CONCURRENT_MODE) -+#ifndef CONFIG_FW_MULTI_PORT_SUPPORT -+ if (padapter->hw_port != HW_PORT0) -+ return; -+#endif -+#endif -+ -+ if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) -+ rtw_phydm_watchdog_in_lps_lclk(padapter);/* this function caller is in interrupt context */ -+} -+#endif /*CONFIG_LPS_LCLK_WD_TIMER*/ -+ -+void rtw_hal_bcn_related_reg_setting(_adapter *padapter) -+{ -+ padapter->hal_func.SetBeaconRelatedRegistersHandler(padapter); -+} -+ -+#ifdef CONFIG_HOSTAPD_MLME -+s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) -+{ -+ if (padapter->hal_func.hostap_mgnt_xmit_entry) -+ return padapter->hal_func.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->hal_func.sreset_init_value(padapter); -+} -+void rtw_hal_sreset_reset(_adapter *padapter) -+{ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ padapter->hal_func.silentreset(padapter); -+} -+ -+void rtw_hal_sreset_reset_value(_adapter *padapter) -+{ -+ padapter->hal_func.sreset_reset_value(padapter); -+} -+ -+void rtw_hal_sreset_xmit_status_check(_adapter *padapter) -+{ -+ padapter->hal_func.sreset_xmit_status_check(padapter); -+} -+void rtw_hal_sreset_linked_status_check(_adapter *padapter) -+{ -+ padapter->hal_func.sreset_linked_status_check(padapter); -+} -+u8 rtw_hal_sreset_get_wifi_status(_adapter *padapter) -+{ -+ return padapter->hal_func.sreset_get_wifi_status(padapter); -+} -+ -+bool rtw_hal_sreset_inprogress(_adapter *padapter) -+{ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ return padapter->hal_func.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_waiting_ms, u32 bndy_cnt) -+{ -+ if (adapter->hal_func.IOL_exec_cmds_sync) -+ return adapter->hal_func.IOL_exec_cmds_sync(adapter, xmit_frame, max_waiting_ms, bndy_cnt); -+ return _FAIL; -+} -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+s32 rtw_hal_xmit_thread_handler(_adapter *padapter) -+{ -+ return padapter->hal_func.xmit_thread_handler(padapter); -+} -+#endif -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+s32 rtw_hal_recv_hdl(_adapter *adapter) -+{ -+ return adapter->hal_func.recv_hdl(adapter); -+} -+#endif -+ -+void rtw_hal_notch_filter(_adapter *adapter, bool enable) -+{ -+ if (adapter->hal_func.hal_notch_filter) -+ adapter->hal_func.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); -+ 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); -+ 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); -+ 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); -+ 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) -+{ -+ u8 sub_id = 0; -+ s32 ret = _SUCCESS; -+ -+ switch (id) { -+ 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_DBG_DUMP("C2H_MAILBOX_STATUS: ", payload, plen); -+ break; -+ case C2H_WLAN_INFO: -+ rtw_btcoex_WlFwDbgInfoNotify(adapter, 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: -+#ifndef CONFIG_TDLS_CH_SW_V2 -+ rtw_tdls_chsw_oper_done(adapter); -+#endif -+ break; -+#endif -+ -+ case C2H_BCN_EARLY_RPT: -+ rtw_hal_bcn_early_rpt_c2h_handler(adapter); -+ break; -+ -+#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 -+#ifdef RTW_PER_CMD_SUPPORT_FW -+ case C2H_PER_RATE_RPT: -+ c2h_per_rate_rpt_hdl(adapter, payload, plen); -+ break; -+#endif -+#ifdef CONFIG_LPS_ACK -+ case C2H_LPS_STATUS_RPT: -+ c2h_lps_status_rpt(adapter, payload, plen); -+ break; -+#endif -+#ifdef CONFIG_FW_OFFLOAD_SET_TXPWR_IDX -+ case C2H_SET_TXPWR_FINISH: -+ c2h_txpwr_idx_offload_done(adapter, payload, plen); -+ break; -+#endif -+ case C2H_EXTEND: -+ sub_id = payload[0]; -+ /* no handle, goto default */ -+ fallthrough; -+ default: -+ if (phydm_c2H_content_parsing(adapter_to_phydm(adapter), id, plen, payload) != TRUE) -+ ret = _FAIL; -+ break; -+ } -+ -+ 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->hal_func.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: -+ case C2H_AP_REQ_TXRPT: -+ case C2H_SPC_STAT: -+ case C2H_SET_TXPWR_FINISH: -+ return _TRUE; -+ default: -+ return _FALSE; -+ } -+} -+#endif /* !RTW_HALMAC */ -+ -+#ifdef CONFIG_PROTSEL_MACSLEEP -+static s32 _rtw_hal_macid_sleep(_adapter *adapter, u8 macid, u8 sleep) -+{ -+ struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); -+ u16 reg_sleep_info = macid_ctl->reg_sleep_info; -+ u16 reg_sleep_ctrl = macid_ctl->reg_sleep_ctrl; -+ const u32 sel_mask_sel = BIT(0) | BIT(1) | BIT(2); -+ u8 bit_shift; -+ u32 val32; -+ s32 ret = _FAIL; -+ -+ if (macid >= macid_ctl->num) { -+ RTW_ERR(ADPT_FMT" %s invalid macid(%u)\n" -+ , ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" , macid); -+ goto exit; -+ } -+ -+ if (macid < 32) { -+ bit_shift = macid; -+ #if (MACID_NUM_SW_LIMIT > 32) -+ } else if (macid < 64) { -+ bit_shift = macid - 32; -+ #endif -+ #if (MACID_NUM_SW_LIMIT > 64) -+ } else if (macid < 96) { -+ bit_shift = macid - 64; -+ #endif -+ #if (MACID_NUM_SW_LIMIT > 96) -+ } else if (macid < 128) { -+ bit_shift = macid - 96; -+ #endif -+ } else { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (!reg_sleep_ctrl || !reg_sleep_info) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ val32 = rtw_read32(adapter, reg_sleep_ctrl); -+ val32 = (val32 &~sel_mask_sel) | ((macid / 32) & sel_mask_sel); -+ rtw_write32(adapter, reg_sleep_ctrl, val32); -+ -+ val32 = rtw_read32(adapter, reg_sleep_info); -+ RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x\n" -+ , ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" -+ , macid, reg_sleep_info, val32); -+ -+ ret = _SUCCESS; -+ -+ if (sleep) { -+ if (val32 & BIT(bit_shift)) -+ goto exit; -+ val32 |= BIT(bit_shift); -+ } else { -+ if (!(val32 & BIT(bit_shift))) -+ goto exit; -+ val32 &= ~BIT(bit_shift); -+ } -+ -+ rtw_write32(adapter, reg_sleep_info, val32); -+ -+exit: -+ return ret; -+} -+#else -+static s32 _rtw_hal_macid_sleep(_adapter *adapter, u8 macid, u8 sleep) -+{ -+ struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); -+ u16 reg_sleep; -+ u8 bit_shift; -+ u32 val32; -+ s32 ret = _FAIL; -+ -+ if (macid >= macid_ctl->num) { -+ RTW_ERR(ADPT_FMT" %s invalid macid(%u)\n" -+ , ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" , macid); -+ goto exit; -+ } -+ -+ if (macid < 32) { -+ reg_sleep = macid_ctl->reg_sleep_m0; -+ bit_shift = macid; -+ #if (MACID_NUM_SW_LIMIT > 32) -+ } else if (macid < 64) { -+ reg_sleep = macid_ctl->reg_sleep_m1; -+ bit_shift = macid - 32; -+ #endif -+ #if (MACID_NUM_SW_LIMIT > 64) -+ } else if (macid < 96) { -+ reg_sleep = macid_ctl->reg_sleep_m2; -+ bit_shift = macid - 64; -+ #endif -+ #if (MACID_NUM_SW_LIMIT > 96) -+ } else if (macid < 128) { -+ reg_sleep = macid_ctl->reg_sleep_m3; -+ bit_shift = macid - 96; -+ #endif -+ } else { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (!reg_sleep) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ val32 = rtw_read32(adapter, reg_sleep); -+ RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x\n" -+ , ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" -+ , macid, reg_sleep, val32); -+ -+ ret = _SUCCESS; -+ -+ if (sleep) { -+ if (val32 & BIT(bit_shift)) -+ goto exit; -+ val32 |= BIT(bit_shift); -+ } else { -+ if (!(val32 & BIT(bit_shift))) -+ goto exit; -+ val32 &= ~BIT(bit_shift); -+ } -+ -+ rtw_write32(adapter, reg_sleep, val32); -+ -+exit: -+ return ret; -+} -+#endif -+ -+inline s32 rtw_hal_macid_sleep(_adapter *adapter, u8 macid) -+{ -+ return _rtw_hal_macid_sleep(adapter, macid, 1); -+} -+ -+inline s32 rtw_hal_macid_wakeup(_adapter *adapter, u8 macid) -+{ -+ return _rtw_hal_macid_sleep(adapter, macid, 0); -+} -+ -+#ifdef CONFIG_PROTSEL_MACSLEEP -+static s32 _rtw_hal_macid_bmp_sleep(_adapter *adapter, struct macid_bmp *bmp, u8 sleep) -+{ -+ struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); -+ u16 reg_sleep_info = macid_ctl->reg_sleep_info; -+ u16 reg_sleep_ctrl = macid_ctl->reg_sleep_ctrl; -+ const u32 sel_mask_sel = BIT(0) | BIT(1) | BIT(2); -+ u32 m; -+ u8 mid = 0; -+ u32 val32; -+ -+ do { -+ if (mid == 0) { -+ m = bmp->m0; -+ #if (MACID_NUM_SW_LIMIT > 32) -+ } else if (mid == 1) { -+ m = bmp->m1; -+ #endif -+ #if (MACID_NUM_SW_LIMIT > 64) -+ } else if (mid == 2) { -+ m = bmp->m2; -+ #endif -+ #if (MACID_NUM_SW_LIMIT > 96) -+ } else if (mid == 3) { -+ m = bmp->m3; -+ #endif -+ } else { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ if (m == 0) -+ goto move_next; -+ -+ if (!reg_sleep_ctrl || !reg_sleep_info) { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ val32 = rtw_read32(adapter, reg_sleep_ctrl); -+ val32 = (val32 &~sel_mask_sel) | (mid & sel_mask_sel); -+ rtw_write32(adapter, reg_sleep_ctrl, val32); -+ -+ val32 = rtw_read32(adapter, reg_sleep_info); -+ RTW_INFO(ADPT_FMT" %s m%u=0x%08x, ori reg_0x%03x=0x%08x\n" -+ , ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" -+ , mid, m, reg_sleep_info, val32); -+ -+ if (sleep) { -+ if ((val32 & m) == m) -+ goto move_next; -+ val32 |= m; -+ } else { -+ if ((val32 & m) == 0) -+ goto move_next; -+ val32 &= ~m; -+ } -+ -+ rtw_write32(adapter, reg_sleep_info, val32); -+ -+move_next: -+ mid++; -+ } while (mid * 32 < MACID_NUM_SW_LIMIT); -+ -+ return _SUCCESS; -+} -+#else -+static s32 _rtw_hal_macid_bmp_sleep(_adapter *adapter, struct macid_bmp *bmp, u8 sleep) -+{ -+ struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); -+ u16 reg_sleep; -+ u32 m; -+ u8 mid = 0; -+ u32 val32; -+ -+ do { -+ if (mid == 0) { -+ m = bmp->m0; -+ reg_sleep = macid_ctl->reg_sleep_m0; -+ #if (MACID_NUM_SW_LIMIT > 32) -+ } else if (mid == 1) { -+ m = bmp->m1; -+ reg_sleep = macid_ctl->reg_sleep_m1; -+ #endif -+ #if (MACID_NUM_SW_LIMIT > 64) -+ } else if (mid == 2) { -+ m = bmp->m2; -+ reg_sleep = macid_ctl->reg_sleep_m2; -+ #endif -+ #if (MACID_NUM_SW_LIMIT > 96) -+ } else if (mid == 3) { -+ m = bmp->m3; -+ reg_sleep = macid_ctl->reg_sleep_m3; -+ #endif -+ } else { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ if (m == 0) -+ goto move_next; -+ -+ if (!reg_sleep) { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ val32 = rtw_read32(adapter, reg_sleep); -+ RTW_INFO(ADPT_FMT" %s m%u=0x%08x, ori reg_0x%03x=0x%08x\n" -+ , ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" -+ , mid, m, reg_sleep, val32); -+ -+ if (sleep) { -+ if ((val32 & m) == m) -+ goto move_next; -+ val32 |= m; -+ } else { -+ if ((val32 & m) == 0) -+ goto move_next; -+ val32 &= ~m; -+ } -+ -+ rtw_write32(adapter, reg_sleep, val32); -+ -+move_next: -+ mid++; -+ } while (mid * 32 < MACID_NUM_SW_LIMIT); -+ -+ return _SUCCESS; -+} -+#endif -+ -+inline s32 rtw_hal_macid_sleep_all_used(_adapter *adapter) -+{ -+ struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); -+ -+ return _rtw_hal_macid_bmp_sleep(adapter, &macid_ctl->used, 1); -+} -+ -+inline s32 rtw_hal_macid_wakeup_all_used(_adapter *adapter) -+{ -+ struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); -+ -+ return _rtw_hal_macid_bmp_sleep(adapter, &macid_ctl->used, 0); -+} -+ -+static s32 _rtw_hal_macid_drop(_adapter *adapter, u8 macid, u8 drop) -+{ -+ struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); -+#ifndef CONFIG_PROTSEL_MACSLEEP -+ u16 reg_drop = 0; -+#else -+ u16 reg_drop_info = macid_ctl->reg_drop_info; -+ u16 reg_drop_ctrl = macid_ctl->reg_drop_ctrl; -+ const u32 sel_mask_sel = BIT(0) | BIT(1) | BIT(2); -+#endif /* CONFIG_PROTSEL_MACSLEEP */ -+ u8 bit_shift; -+ u32 val32; -+ s32 ret = _FAIL; -+/* some IC doesn't have this register */ -+#ifndef REG_PKT_BUFF_ACCESS_CTRL -+#define REG_PKT_BUFF_ACCESS_CTRL 0 -+#endif -+ -+ if (macid >= macid_ctl->num) { -+ RTW_ERR(ADPT_FMT" %s invalid macid(%u)\n" -+ , ADPT_ARG(adapter), drop ? "drop" : "undrop" , macid); -+ goto exit; -+ } -+ -+ if(_rtw_macid_ctl_chk_cap(adapter, MACID_DROP)) { -+ if (macid < 32) { -+#ifndef CONFIG_PROTSEL_MACSLEEP -+ reg_drop = macid_ctl->reg_drop_m0; -+#endif /* CONFIG_PROTSEL_MACSLEEP */ -+ bit_shift = macid; -+ #if (MACID_NUM_SW_LIMIT > 32) -+ } else if (macid < 64) { -+#ifndef CONFIG_PROTSEL_MACSLEEP -+ reg_drop = macid_ctl->reg_drop_m1; -+#endif /* CONFIG_PROTSEL_MACSLEEP */ -+ bit_shift = macid - 32; -+ #endif -+ #if (MACID_NUM_SW_LIMIT > 64) -+ } else if (macid < 96) { -+#ifndef CONFIG_PROTSEL_MACSLEEP -+ reg_drop = macid_ctl->reg_drop_m2; -+#endif /* CONFIG_PROTSEL_MACSLEEP */ -+ bit_shift = macid - 64; -+ #endif -+ #if (MACID_NUM_SW_LIMIT > 96) -+ } else if (macid < 128) { -+#ifndef CONFIG_PROTSEL_MACSLEEP -+ reg_drop = macid_ctl->reg_drop_m3; -+#endif /* CONFIG_PROTSEL_MACSLEEP */ -+ bit_shift = macid - 96; -+ #endif -+ } else { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+#ifndef CONFIG_PROTSEL_MACSLEEP -+ if (!reg_drop) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ val32 = rtw_read32(adapter, reg_drop); -+ /*RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x \n" -+ , ADPT_ARG(adapter), drop ? "drop" : "undrop" -+ , macid, reg_drop, val32);*/ -+#else -+ if (!reg_drop_ctrl || !reg_drop_info) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ val32 = rtw_read32(adapter, reg_drop_ctrl); -+ val32 = (val32 &~sel_mask_sel) | ((macid / 32) & sel_mask_sel); -+ rtw_write32(adapter, reg_drop_ctrl, val32); -+ -+ val32 = rtw_read32(adapter, reg_drop_info); -+ /*RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x\n" -+ , ADPT_ARG(adapter), drop ? "drop" : "undrop" -+ , macid, reg_drop_info, val32);*/ -+#endif /* CONFIG_PROTSEL_MACSLEEP */ -+ ret = _SUCCESS; -+ -+ if (drop) { -+ if (val32 & BIT(bit_shift)) -+ goto exit; -+ val32 |= BIT(bit_shift); -+ } else { -+ if (!(val32 & BIT(bit_shift))) -+ goto exit; -+ val32 &= ~BIT(bit_shift); -+ } -+ -+#ifndef CONFIG_PROTSEL_MACSLEEP -+ rtw_write32(adapter, reg_drop, val32); -+ RTW_INFO(ADPT_FMT" %s macid=%d, done reg_0x%03x=0x%08x\n" -+ , ADPT_ARG(adapter), drop ? "drop" : "undrop" -+ , macid, reg_drop, val32); -+#else -+ rtw_write32(adapter, reg_drop_info, val32); -+ RTW_INFO(ADPT_FMT" %s macid=%d, done reg_0x%03x=0x%08x\n" -+ , ADPT_ARG(adapter), drop ? "drop" : "undrop" -+ , macid, reg_drop_info, val32); -+#endif /* CONFIG_PROTSEL_MACSLEEP */ -+ -+ -+ } else if(_rtw_macid_ctl_chk_cap(adapter, MACID_DROP_INDIRECT)) { -+ u16 start_addr = macid_ctl->macid_txrpt/8; -+ u32 txrpt_h4b = 0; -+ u8 i; -+ -+ /* each address means 1 byte */ -+ start_addr += macid*(macid_ctl->macid_txrpt_pgsz/8); -+ /* select tx report buffer */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, TXREPORT_BUF_SELECT); -+ /* set tx report buffer start address for reading */ -+ rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, start_addr); -+ txrpt_h4b = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); -+ /* OFFSET5 BIT2 is BIT10 of high 4 bytes */ -+ if (drop) { -+ if (txrpt_h4b & BIT(10)) -+ goto exit; -+ txrpt_h4b |= BIT(10); -+ } else { -+ if (!(txrpt_h4b & BIT(10))) -+ goto exit; -+ txrpt_h4b &= ~BIT(10); -+ } -+ /* set to macid drop field */ -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, txrpt_h4b); -+ /* 0x20800000 only write BIT10 of tx report buf */ -+ rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, 0x20800000 | start_addr); -+#if 0 /* some ICs doesn't clear the write done bit */ -+ /* checking TX queue status */ -+ for (i = 0 ; i < 50 ; i++) { -+ txrpt_h4b = rtw_read32(adapter, REG_PKTBUF_DBG_CTRL); -+ if (txrpt_h4b & BIT(23)) { -+ RTW_INFO("%s: wait to write TX RTP buf (%d)!\n", __func__, i); -+ rtw_mdelay_os(10); -+ } else { -+ RTW_INFO("%s: wait to write TX RTP buf done (%d)!\n", __func__, i); -+ break; -+ } -+ } -+#endif -+ rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, start_addr); -+ RTW_INFO("start_addr=%x, data_H:%08x, data_L:%08x, macid=%d, txrpt_h4b=%x\n", start_addr -+ ,rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H), rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L), macid, txrpt_h4b); -+ } else { -+ RTW_INFO("There is no definition for camctl cap , please correct it\n"); -+ } -+exit: -+ return ret; -+} -+ -+inline s32 rtw_hal_macid_drop(_adapter *adapter, u8 macid) -+{ -+ return _rtw_hal_macid_drop(adapter, macid, 1); -+} -+ -+inline s32 rtw_hal_macid_undrop(_adapter *adapter, u8 macid) -+{ -+ return _rtw_hal_macid_drop(adapter, macid, 0); -+} -+ -+s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) -+{ -+ _adapter *pri_adapter = GET_PRIMARY_ADAPTER(padapter); -+ -+ if (GET_HAL_DATA(pri_adapter)->bFWReady == _TRUE) -+ return padapter->hal_func.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->hal_func.fill_fake_txdesc(padapter, pDesc, BufferLen, IsPsPoll, IsBTQosNull, bDataFrame); -+ -+} -+ -+u8 rtw_hal_get_txbuff_rsvd_page_num(_adapter *adapter, bool wowlan) -+{ -+ u8 num = 0; -+ -+ -+ if (adapter->hal_func.hal_get_tx_buff_rsvd_page_num) { -+ num = adapter->hal_func.hal_get_tx_buff_rsvd_page_num(adapter, wowlan); -+ } else { -+#ifdef RTW_HALMAC -+ num = GET_HAL_DATA(adapter)->drv_rsvd_page_number; -+#endif /* RTW_HALMAC */ -+ } -+ -+ return num; -+} -+ -+#ifdef CONFIG_GPIO_API -+void rtw_hal_update_hisr_hsisr_ind(_adapter *padapter, u32 flag) -+{ -+ if (padapter->hal_func.update_hisr_hsisr_ind) -+ padapter->hal_func.update_hisr_hsisr_ind(padapter, flag); -+} -+ -+int rtw_hal_gpio_func_check(_adapter *padapter, u8 gpio_num) -+{ -+ int ret = _SUCCESS; -+ -+ if (padapter->hal_func.hal_gpio_func_check) -+ ret = padapter->hal_func.hal_gpio_func_check(padapter, gpio_num); -+ -+ return ret; -+} -+ -+void rtw_hal_gpio_multi_func_reset(_adapter *padapter, u8 gpio_num) -+{ -+ if (padapter->hal_func.hal_gpio_multi_func_reset) -+ padapter->hal_func.hal_gpio_multi_func_reset(padapter, gpio_num); -+} -+#endif -+ -+#ifdef CONFIG_FW_CORRECT_BCN -+void rtw_hal_fw_correct_bcn(_adapter *padapter) -+{ -+ if (padapter->hal_func.fw_correct_bcn) -+ padapter->hal_func.fw_correct_bcn(padapter); -+} -+#endif -+ -+void rtw_hal_set_tx_power_level(_adapter *adapter, u8 channel) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ if (phy_chk_ch_setting_consistency(adapter, channel) != _SUCCESS) -+ return; -+ -+ hal_data->set_entire_txpwr = 1; -+ -+ adapter->hal_func.set_tx_power_level_handler(adapter, channel); -+ rtw_hal_set_txpwr_done(adapter); -+ -+ hal_data->set_entire_txpwr = 0; -+} -+ -+void rtw_hal_update_txpwr_level(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int i; -+#endif -+ -+ rtw_hal_set_tx_power_level(adapter, hal_data->current_channel); -+ rtw_rfctl_update_op_mode(adapter_to_rfctl(adapter), 0, 0); -+ -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ struct mlme_priv *mlme; -+ -+ if (!dvobj->padapters[i]) -+ continue; -+ if (!CHK_MLME_STATE(dvobj->padapters[i], WIFI_AP_STATE | WIFI_MESH_STATE) -+ || !MLME_IS_ASOC(dvobj->padapters[i]) || MLME_IS_OPCH_SW(dvobj->padapters[i])) -+ continue; -+ if (dvobj->padapters[i]->mlmeextpriv.bstart_bss != _TRUE) -+ continue; -+ -+ mlme = &(dvobj->padapters[i]->mlmepriv); -+ if (MLME_ACTIVE_TPC_REPORT(mlme)) -+ update_beacon(dvobj->padapters[i], WLAN_EID_TPC_REPORT, NULL, 1, 0); -+ } -+#endif -+} -+ -+void rtw_hal_set_txpwr_done(_adapter *adapter) -+{ -+ if (adapter->hal_func.set_txpwr_done) -+ adapter->hal_func.set_txpwr_done(adapter); -+} -+ -+void rtw_hal_set_tx_power_index(_adapter *adapter, u32 powerindex -+ , enum rf_path rfpath, u8 rate) -+{ -+ adapter->hal_func.set_tx_power_index_handler(adapter, powerindex, rfpath, rate); -+} -+ -+u8 rtw_hal_get_tx_power_index(_adapter *adapter, enum rf_path rfpath -+ , RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch -+ , struct txpwr_idx_comp *tic) -+{ -+ return adapter->hal_func.get_tx_power_index_handler(adapter, rfpath -+ , rs, rate, bw, band, cch, opch, tic); -+} -+ -+s8 rtw_hal_get_txpwr_target_extra_bias(_adapter *adapter, enum rf_path rfpath -+ , RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch) -+{ -+ s8 val = 0; -+ -+ if (adapter->hal_func.get_txpwr_target_extra_bias) { -+ val = adapter->hal_func.get_txpwr_target_extra_bias(adapter -+ , rfpath, rs, rate, bw, band, cch); -+ } -+ -+ return val; -+} -+ -+#ifdef RTW_HALMAC -+/* -+ * Description: -+ * Initialize MAC registers -+ * -+ * Return: -+ * _TRUE success -+ * _FALSE fail -+ */ -+u8 rtw_hal_init_mac_register(PADAPTER adapter) -+{ -+ return adapter->hal_func.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->hal_func.init_phy(adapter); -+} -+#endif /* RTW_HALMAC */ -+ -+#ifdef CONFIG_RFKILL_POLL -+bool rtw_hal_rfkill_poll(_adapter *adapter, u8 *valid) -+{ -+ bool ret; -+ -+ if (adapter->hal_func.hal_radio_onoff_check) -+ ret = adapter->hal_func.hal_radio_onoff_check(adapter, valid); -+ else { -+ *valid = 0; -+ ret = _FALSE; -+ } -+ return ret; -+} -+#endif -+ -+#define rtw_hal_error_msg(ops_fun) \ -+ RTW_PRINT("### %s - Error : Please hook hal_func.%s ###\n", __FUNCTION__, ops_fun) -+ -+u8 rtw_hal_ops_check(_adapter *padapter) -+{ -+ u8 ret = _SUCCESS; -+#if 1 -+ /*** initialize section ***/ -+ if (NULL == padapter->hal_func.read_chip_version) { -+ rtw_hal_error_msg("read_chip_version"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.init_default_value) { -+ rtw_hal_error_msg("init_default_value"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.intf_chip_configure) { -+ rtw_hal_error_msg("intf_chip_configure"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.read_adapter_info) { -+ rtw_hal_error_msg("read_adapter_info"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->hal_func.hal_power_on) { -+ rtw_hal_error_msg("hal_power_on"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.hal_power_off) { -+ rtw_hal_error_msg("hal_power_off"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->hal_func.hal_init) { -+ rtw_hal_error_msg("hal_init"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.hal_deinit) { -+ rtw_hal_error_msg("hal_deinit"); -+ ret = _FAIL; -+ } -+ -+ /*** xmit section ***/ -+ if (NULL == padapter->hal_func.init_xmit_priv) { -+ rtw_hal_error_msg("init_xmit_priv"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.free_xmit_priv) { -+ rtw_hal_error_msg("free_xmit_priv"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.hal_xmit) { -+ rtw_hal_error_msg("hal_xmit"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.mgnt_xmit) { -+ rtw_hal_error_msg("mgnt_xmit"); -+ ret = _FAIL; -+ } -+#ifdef CONFIG_XMIT_THREAD_MODE -+ if (NULL == padapter->hal_func.xmit_thread_handler) { -+ rtw_hal_error_msg("xmit_thread_handler"); -+ ret = _FAIL; -+ } -+#endif -+ if (NULL == padapter->hal_func.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->hal_func.run_thread) { -+ rtw_hal_error_msg("run_thread"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.cancel_thread) { -+ rtw_hal_error_msg("cancel_thread"); -+ ret = _FAIL; -+ } -+#endif -+#endif -+ -+ /*** recv section ***/ -+ if (NULL == padapter->hal_func.init_recv_priv) { -+ rtw_hal_error_msg("init_recv_priv"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.free_recv_priv) { -+ rtw_hal_error_msg("free_recv_priv"); -+ ret = _FAIL; -+ } -+#ifdef CONFIG_RECV_THREAD_MODE -+ if (NULL == padapter->hal_func.recv_hdl) { -+ rtw_hal_error_msg("recv_hdl"); -+ ret = _FAIL; -+ } -+#endif -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+ if (NULL == padapter->hal_func.inirp_init) { -+ rtw_hal_error_msg("inirp_init"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.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->hal_func.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->hal_func.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->hal_func.enable_interrupt) { -+ rtw_hal_error_msg("enable_interrupt"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.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->hal_func.dm_init) { -+ rtw_hal_error_msg("dm_init"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.dm_deinit) { -+ rtw_hal_error_msg("dm_deinit"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.hal_dm_watchdog) { -+ rtw_hal_error_msg("hal_dm_watchdog"); -+ ret = _FAIL; -+ } -+ -+ /*** xxx section ***/ -+ if (NULL == padapter->hal_func.set_chnl_bw_handler) { -+ rtw_hal_error_msg("set_chnl_bw_handler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->hal_func.set_hw_reg_handler) { -+ rtw_hal_error_msg("set_hw_reg_handler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.GetHwRegHandler) { -+ rtw_hal_error_msg("GetHwRegHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.get_hal_def_var_handler) { -+ rtw_hal_error_msg("get_hal_def_var_handler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.SetHalDefVarHandler) { -+ rtw_hal_error_msg("SetHalDefVarHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.GetHalODMVarHandler) { -+ rtw_hal_error_msg("GetHalODMVarHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.SetHalODMVarHandler) { -+ rtw_hal_error_msg("SetHalODMVarHandler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->hal_func.SetBeaconRelatedRegistersHandler) { -+ rtw_hal_error_msg("SetBeaconRelatedRegistersHandler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->hal_func.fill_h2c_cmd) { -+ rtw_hal_error_msg("fill_h2c_cmd"); -+ ret = _FAIL; -+ } -+ -+#ifdef RTW_HALMAC -+ if (NULL == padapter->hal_func.hal_mac_c2h_handler) { -+ rtw_hal_error_msg("hal_mac_c2h_handler"); -+ ret = _FAIL; -+ } -+#elif !defined(CONFIG_RTL8188E) -+ if (NULL == padapter->hal_func.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->hal_func.fill_fake_txdesc) { -+ rtw_hal_error_msg("fill_fake_txdesc"); -+ ret = _FAIL; -+ } -+#endif -+ -+#ifndef RTW_HALMAC -+ if (NULL == padapter->hal_func.hal_get_tx_buff_rsvd_page_num) { -+ rtw_hal_error_msg("hal_get_tx_buff_rsvd_page_num"); -+ ret = _FAIL; -+ } -+#endif /* !RTW_HALMAC */ -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ if (NULL == padapter->hal_func.clear_interrupt) { -+ rtw_hal_error_msg("clear_interrupt"); -+ ret = _FAIL; -+ } -+#endif -+#endif /* CONFIG_WOWLAN */ -+ -+ if (NULL == padapter->hal_func.fw_dl) { -+ rtw_hal_error_msg("fw_dl"); -+ ret = _FAIL; -+ } -+ -+ #ifdef CONFIG_FW_CORRECT_BCN -+ if (IS_HARDWARE_TYPE_8814A(padapter) -+ && NULL == padapter->hal_func.fw_correct_bcn) { -+ rtw_hal_error_msg("fw_correct_bcn"); -+ ret = _FAIL; -+ } -+ #endif -+ -+ if (!padapter->hal_func.set_tx_power_level_handler) { -+ rtw_hal_error_msg("set_tx_power_level_handler"); -+ ret = _FAIL; -+ } -+ if (!padapter->hal_func.set_tx_power_index_handler) { -+ rtw_hal_error_msg("set_tx_power_index_handler"); -+ ret = _FAIL; -+ } -+ if (!padapter->hal_func.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->hal_func.sreset_init_value) { -+ rtw_hal_error_msg("sreset_init_value"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.sreset_reset_value) { -+ rtw_hal_error_msg("sreset_reset_value"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.silentreset) { -+ rtw_hal_error_msg("silentreset"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.sreset_xmit_status_check) { -+ rtw_hal_error_msg("sreset_xmit_status_check"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.sreset_linked_status_check) { -+ rtw_hal_error_msg("sreset_linked_status_check"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.sreset_get_wifi_status) { -+ rtw_hal_error_msg("sreset_get_wifi_status"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.sreset_inprogress) { -+ rtw_hal_error_msg("sreset_inprogress"); -+ ret = _FAIL; -+ } -+#endif /* #ifdef DBG_CONFIG_ERROR_DETECT */ -+ -+#ifdef RTW_HALMAC -+ if (NULL == padapter->hal_func.init_mac_register) { -+ rtw_hal_error_msg("init_mac_register"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->hal_func.init_phy) { -+ rtw_hal_error_msg("init_phy"); -+ ret = _FAIL; -+ } -+#endif /* RTW_HALMAC */ -+ -+#ifdef CONFIG_RFKILL_POLL -+ if (padapter->hal_func.hal_radio_onoff_check == NULL) { -+ rtw_hal_error_msg("hal_radio_onoff_check"); -+ ret = _FAIL; -+ } -+#endif -+#endif -+ return ret; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_mcc.c b/drivers/net/wireless/rtl8821cs/hal/hal_mcc.c -new file mode 100644 -index 000000000..904321817 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_mcc.c -@@ -0,0 +1,4078 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+#ifdef CONFIG_MCC_MODE -+#define _HAL_MCC_C_ -+ -+#include /* PADAPTER */ -+#include /* mcc structure */ -+#include /* HAL_DATA */ -+#include /* power control */ -+ -+/* use for AP/GO + STA/GC case */ -+#define MCC_DURATION_IDX 0 /* druration for station side */ -+#define MCC_TSF_SYNC_OFFSET_IDX 1 -+#define MCC_START_TIME_OFFSET_IDX 2 -+#define MCC_INTERVAL_IDX 3 -+#define MCC_GUARD_OFFSET0_IDX 4 -+#define MCC_GUARD_OFFSET1_IDX 5 -+#define MCC_STOP_THRESHOLD 6 -+#define TU 1024 /* 1 TU equals 1024 microseconds */ -+/* druration, TSF sync offset, start time offset, interval (unit:TU (1024 microseconds))*/ -+u8 mcc_switch_channel_policy_table[][7]={ -+ {20, 50, 40, 100, 0, 0, 30}, -+ {80, 50, 10, 100, 0, 0, 30}, -+ {36, 50, 32, 100, 0, 0, 30}, -+ {30, 50, 35, 100, 0, 0, 30}, -+}; -+ -+const int mcc_max_policy_num = sizeof(mcc_switch_channel_policy_table) /sizeof(u8) /7; -+ -+static void dump_iqk_val_table(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ struct hal_iqk_reg_backup *iqk_reg_backup = pHalData->iqk_reg_backup; -+ u8 total_rf_path = hal_spec->rf_reg_path_num; -+ u8 rf_path_idx = 0; -+ u8 backup_chan_idx = 0; -+ u8 backup_reg_idx = 0; -+ -+#ifdef CONFIG_MCC_MODE_V2 -+#else -+ -+ RTW_INFO("=============dump IQK backup table================\n"); -+ for (backup_chan_idx = 0; backup_chan_idx < MAX_IQK_INFO_BACKUP_CHNL_NUM; backup_chan_idx++) { -+ for (rf_path_idx = 0; rf_path_idx < total_rf_path; rf_path_idx++) { -+ for(backup_reg_idx = 0; backup_reg_idx < MAX_IQK_INFO_BACKUP_REG_NUM; backup_reg_idx++) { -+ RTW_INFO("ch:%d. bw:%d. rf path:%d. reg[%d] = 0x%02x \n" -+ , iqk_reg_backup[backup_chan_idx].central_chnl -+ , iqk_reg_backup[backup_chan_idx].bw_mode -+ , rf_path_idx -+ , backup_reg_idx -+ , iqk_reg_backup[backup_chan_idx].reg_backup[rf_path_idx][backup_reg_idx] -+ ); -+ } -+ } -+ } -+ RTW_INFO("=============================================\n"); -+ -+#endif -+} -+ -+static void rtw_hal_mcc_build_p2p_noa_attr(PADAPTER padapter, u8 *ie, u32 *ie_len) -+{ -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ u8 p2p_noa_attr_ie[MAX_P2P_IE_LEN] = {0x00}; -+ u32 p2p_noa_attr_len = 0; -+ u8 noa_desc_num = 1; -+ u8 opp_ps = 0; /* Disable OppPS */ -+ u8 noa_count = 255; -+ u32 noa_duration; -+ u32 noa_interval; -+ u8 noa_index = 0; -+ u8 mcc_policy_idx = 0; -+ -+ mcc_policy_idx = pmccobjpriv->policy_index; -+ noa_duration = mcc_switch_channel_policy_table[mcc_policy_idx][MCC_DURATION_IDX] * TU; -+ noa_interval = mcc_switch_channel_policy_table[mcc_policy_idx][MCC_INTERVAL_IDX] * TU; -+ -+ /* P2P OUI(4 bytes) */ -+ _rtw_memcpy(p2p_noa_attr_ie, P2P_OUI, 4); -+ p2p_noa_attr_len = p2p_noa_attr_len + 4; -+ -+ /* attrute ID(1 byte) */ -+ p2p_noa_attr_ie[p2p_noa_attr_len] = P2P_ATTR_NOA; -+ p2p_noa_attr_len = p2p_noa_attr_len + 1; -+ -+ /* attrute length(2 bytes) length = noa_desc_num*13 + 2 */ -+ RTW_PUT_LE16(p2p_noa_attr_ie + p2p_noa_attr_len, (noa_desc_num * 13 + 2)); -+ p2p_noa_attr_len = p2p_noa_attr_len + 2; -+ -+ /* Index (1 byte) */ -+ p2p_noa_attr_ie[p2p_noa_attr_len] = noa_index; -+ p2p_noa_attr_len = p2p_noa_attr_len + 1; -+ -+ /* CTWindow and OppPS Parameters (1 byte) */ -+ p2p_noa_attr_ie[p2p_noa_attr_len] = opp_ps; -+ p2p_noa_attr_len = p2p_noa_attr_len+ 1; -+ -+ /* NoA Count (1 byte) */ -+ p2p_noa_attr_ie[p2p_noa_attr_len] = noa_count; -+ p2p_noa_attr_len = p2p_noa_attr_len + 1; -+ -+ /* NoA Duration (4 bytes) unit: microseconds */ -+ RTW_PUT_LE32(p2p_noa_attr_ie + p2p_noa_attr_len, noa_duration); -+ p2p_noa_attr_len = p2p_noa_attr_len + 4; -+ -+ /* NoA Interval (4 bytes) unit: microseconds */ -+ RTW_PUT_LE32(p2p_noa_attr_ie + p2p_noa_attr_len, noa_interval); -+ p2p_noa_attr_len = p2p_noa_attr_len + 4; -+ -+ /* NoA Start Time (4 bytes) unit: microseconds */ -+ RTW_PUT_LE32(p2p_noa_attr_ie + p2p_noa_attr_len, pmccadapriv->noa_start_time); -+ if (0) -+ RTW_INFO("indxe:%d, start_time=0x%02x:0x%02x:0x%02x:0x%02x\n" -+ , noa_index -+ , p2p_noa_attr_ie[p2p_noa_attr_len] -+ , p2p_noa_attr_ie[p2p_noa_attr_len + 1] -+ , p2p_noa_attr_ie[p2p_noa_attr_len + 2] -+ , p2p_noa_attr_ie[p2p_noa_attr_len + 3]); -+ -+ p2p_noa_attr_len = p2p_noa_attr_len + 4; -+ rtw_set_ie(ie, _VENDOR_SPECIFIC_IE_, p2p_noa_attr_len, (u8 *)p2p_noa_attr_ie, ie_len); -+} -+ -+ -+/** -+ * rtw_hal_mcc_update_go_p2p_ie - update go p2p ie(add NoA attribute) -+ * @padapter: the adapter to be update go p2p ie -+ */ -+static void rtw_hal_mcc_update_go_p2p_ie(PADAPTER padapter) -+{ -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ struct mcc_obj_priv *mccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ u8 *pos = NULL; -+ -+ -+ /* no noa attribute, build it */ -+ if (pmccadapriv->p2p_go_noa_ie_len == 0) -+ rtw_hal_mcc_build_p2p_noa_attr(padapter, pmccadapriv->p2p_go_noa_ie, &pmccadapriv->p2p_go_noa_ie_len); -+ else { -+ /* has noa attribut, modify it */ -+ u32 noa_duration = 0; -+ -+ /* update index */ -+ pos = pmccadapriv->p2p_go_noa_ie + pmccadapriv->p2p_go_noa_ie_len - 15; -+ /* 0~255 */ -+ (*pos) = ((*pos) + 1) % 256; -+ if (0) -+ RTW_INFO("indxe:%d\n", (*pos)); -+ -+ -+ /* update duration */ -+ noa_duration = mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_DURATION_IDX] * TU; -+ pos = pmccadapriv->p2p_go_noa_ie + pmccadapriv->p2p_go_noa_ie_len - 12; -+ RTW_PUT_LE32(pos, noa_duration); -+ -+ /* update start time */ -+ pos = pmccadapriv->p2p_go_noa_ie + pmccadapriv->p2p_go_noa_ie_len - 4; -+ RTW_PUT_LE32(pos, pmccadapriv->noa_start_time); -+ if (0) -+ RTW_INFO("start_time=0x%02x:0x%02x:0x%02x:0x%02x\n" -+ , ((u8*)(pos))[0] -+ , ((u8*)(pos))[1] -+ , ((u8*)(pos))[2] -+ , ((u8*)(pos))[3]); -+ -+ } -+ -+ if (0) { -+ RTW_INFO("p2p_go_noa_ie_len:%d\n", pmccadapriv->p2p_go_noa_ie_len); -+ RTW_INFO_DUMP("\n", pmccadapriv->p2p_go_noa_ie, pmccadapriv->p2p_go_noa_ie_len); -+ } -+ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, P2P_OUI, _TRUE, 0); -+} -+ -+/** -+ * rtw_hal_mcc_remove_go_p2p_ie - remove go p2p ie(add NoA attribute) -+ * @padapter: the adapter to be update go p2p ie -+ */ -+static void rtw_hal_mcc_remove_go_p2p_ie(PADAPTER padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ -+ /* chech has noa ie or not */ -+ if (pmccadapriv->p2p_go_noa_ie_len == 0) -+ return; -+ -+ pmccadapriv->p2p_go_noa_ie_len = 0; -+ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, P2P_OUI, _TRUE, 0); -+} -+ -+/* restore IQK value for all interface */ -+void rtw_hal_mcc_restore_iqk_val(PADAPTER padapter) -+{ -+ u8 take_care_iqk = _FALSE; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ u8 i = 0; -+ -+ 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)) { -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ if (mccadapriv->role == MCC_ROLE_MAX) -+ continue; -+ -+ rtw_hal_ch_sw_iqk_info_restore(iface, CH_SW_USE_CASE_MCC); -+ } -+ } -+ -+ if (0) -+ dump_iqk_val_table(padapter); -+} -+ -+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_mcc_update_policy_table(PADAPTER adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ u8 mcc_duration = mccobjpriv->duration; -+ s8 mcc_policy_idx = mccobjpriv->policy_index; -+ u8 interval = mcc_switch_channel_policy_table[mcc_policy_idx][MCC_INTERVAL_IDX]; -+ u8 new_mcc_duration_time = 0; -+ u8 new_starttime_offset = 0; -+ -+ /* convert % to ms */ -+ new_mcc_duration_time = mcc_duration * interval / 100; -+ -+ /* start time offset = (interval - duration time)/2 */ -+ new_starttime_offset = (interval - new_mcc_duration_time) >> 1; -+ -+ /* update modified parameters */ -+ mcc_switch_channel_policy_table[mcc_policy_idx][MCC_DURATION_IDX] -+ = new_mcc_duration_time; -+ -+ mcc_switch_channel_policy_table[mcc_policy_idx][MCC_START_TIME_OFFSET_IDX] -+ = new_starttime_offset; -+ -+ -+} -+ -+static void rtw_hal_config_mcc_switch_channel_setting(PADAPTER padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ u8 mcc_duration = 0; -+ s8 mcc_policy_idx = 0; -+ -+ mcc_policy_idx = registry_par->rtw_mcc_policy_table_idx; -+ mcc_duration = mccobjpriv->duration; -+ -+ if (mcc_policy_idx < 0 || mcc_policy_idx >= mcc_max_policy_num) { -+ mccobjpriv->policy_index = 0; -+ RTW_INFO("[MCC] can't find table(%d), use default policy(%d)\n", -+ mcc_policy_idx, mccobjpriv->policy_index); -+ } else -+ mccobjpriv->policy_index = mcc_policy_idx; -+ -+ /* convert % to time */ -+ if (mcc_duration != 0) -+ rtw_hal_mcc_update_policy_table(padapter); -+ -+ RTW_INFO("[MCC] policy(%d): %d,%d,%d,%d,%d,%d\n" -+ , mccobjpriv->policy_index -+ , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_DURATION_IDX] -+ , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_TSF_SYNC_OFFSET_IDX] -+ , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_START_TIME_OFFSET_IDX] -+ , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_INTERVAL_IDX] -+ , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_GUARD_OFFSET0_IDX] -+ , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_GUARD_OFFSET1_IDX]); -+ -+} -+ -+static void rtw_hal_mcc_assign_tx_threshold(PADAPTER padapter) -+{ -+ struct registry_priv *preg = &padapter->registrypriv; -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ switch (pmccadapriv->role) { -+ case MCC_ROLE_STA: -+ case MCC_ROLE_GC: -+ 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; -+ } -+ break; -+ case MCC_ROLE_AP: -+ case MCC_ROLE_GO: -+ 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; -+ } -+ break; -+ default: -+ RTW_INFO(FUNC_ADPT_FMT": unknown role = %d\n" -+ , FUNC_ADPT_ARG(padapter), pmccadapriv->role); -+ break; -+ } -+} -+ -+#ifdef CONFIG_MCC_PHYDM_OFFLOAD -+static void mcc_cfg_phdym_rf_ch (_adapter *adapter) -+{ -+ struct mcc_adapter_priv *mccadapriv = &adapter->mcc_adapterpriv; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); -+ struct dm_struct *dm = &hal->odmpriv; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ u8 order = 0; -+ -+ set_channel_bwmode(adapter, mlmeext->cur_channel, mlmeext->cur_ch_offset, mlmeext->cur_bwmode); -+ order = mccadapriv->order; -+ mcc_dm->mcc_rf_ch[order] = phy_query_rf_reg(adapter, RF_PATH_A, 0x18, 0x03ff); -+} -+ -+static void mcc_cfg_phdym_update_macid (_adapter *adapter, u8 add, u8 mac_id) -+{ -+ struct mcc_adapter_priv *mccadapriv = &adapter->mcc_adapterpriv; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); -+ struct dm_struct *dm = &hal->odmpriv; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ u8 order = 0, i = 0; -+ -+ order = mccadapriv->order; -+ if (add) { -+ for (i = 0; i < NUM_STA; i++) { -+ if (mcc_dm->sta_macid[order][i] == 0xff) { -+ mcc_dm->sta_macid[order][i] = mac_id; -+ break; -+ } -+ } -+ } else { -+ for (i = 0; i < NUM_STA; i++) { -+ if (mcc_dm->sta_macid[order][i] == mac_id) { -+ mcc_dm->sta_macid[order][i] = 0xff; -+ break; -+ } -+ } -+ } -+ -+ -+} -+ -+static void mcc_cfg_phdym_start(_adapter *adapter, u8 start) -+{ -+ struct dvobj_priv *dvobj; -+ struct mcc_obj_priv *mccobjpriv; -+ HAL_DATA_TYPE *hal; -+ struct dm_struct *dm; -+ struct _phydm_mcc_dm_ *mcc_dm; -+ u8 rfk_forbidden = _TRUE; -+ u8 i = 0, j = 0; -+ -+ dvobj = adapter_to_dvobj(adapter); -+ mccobjpriv = adapter_to_mccobjpriv(adapter); -+ hal = GET_HAL_DATA(adapter); -+ dm = &hal->odmpriv; -+ mcc_dm = &dm->mcc_dm; -+ -+ if (start) { -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ mcc_dm->mcc_status = mccobjpriv->mcc_phydm_offload; -+ #endif -+ -+ rfk_forbidden = _TRUE; -+ halrf_cmn_info_set(dm, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); -+ } else { -+ rfk_forbidden = _FALSE; -+ halrf_cmn_info_set(dm, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); -+ -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ for(i = 0; i < MAX_MCC_NUM; i ++) { -+ for(j = 0; j < NUM_STA; j ++) { -+ if (mcc_dm->sta_macid[i][j] != 0xff) -+ /* clear all used value for mcc stop */ -+ /* do nothing for mcc start due to phydm will init to 0xff */ -+ mcc_dm->sta_macid[i][j] = 0xff; -+ } -+ mcc_dm->mcc_rf_ch[i] = 0xff; -+ } -+ mcc_dm->mcc_status = 0; -+ #endif -+ } -+} -+ -+static void mcc_cfg_phdym_dump(_adapter *adapter, void *sel) -+{ -+ HAL_DATA_TYPE *hal; -+ struct dm_struct *dm; -+ struct _phydm_mcc_dm_ *mcc_dm; -+ u8 rfk_forbidden = _TRUE; -+ u8 i = 0, j = 0; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ dm = &hal->odmpriv; -+ mcc_dm = &dm->mcc_dm; -+ -+ rfk_forbidden = halrf_cmn_info_get(dm, HALRF_CMNINFO_RFK_FORBIDDEN); -+ RTW_PRINT_SEL(sel, "dump mcc dm info\n"); -+ RTW_PRINT_SEL(sel, "mcc_status=%d\n", mcc_dm->mcc_status); -+ RTW_PRINT_SEL(sel, "rfk_forbidden=%d\n", rfk_forbidden); -+ for(i = 0; i < MAX_MCC_NUM; i ++) { -+ -+ if (mcc_dm->mcc_rf_ch[i] != 0xff) -+ RTW_PRINT_SEL(sel, "mcc_dm->mcc_rf_ch[%d] = 0x%02x\n", i, mcc_dm->mcc_rf_ch[i]); -+ -+ for(j = 0; j < NUM_STA; j ++) { -+ if (mcc_dm->sta_macid[i][j] != 0xff) -+ RTW_PRINT_SEL(sel, "mcc_dm->sta_macid[%d][%d] = %d\n", i, j, mcc_dm->sta_macid[i][j]); -+ } -+ } -+} -+ -+static void mcc_cfg_phdym_offload(_adapter *adapter, u8 enable) -+{ -+ struct mcc_obj_priv *mccobjpriv = adapter_to_mccobjpriv(adapter); -+ _adapter *iface = NULL; -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ HAL_DATA_TYPE *hal = NULL; -+ struct dm_struct *dm = NULL; -+ struct _phydm_mcc_dm_ *mcc_dm = NULL; -+ struct sta_priv *stapriv = NULL; -+ struct sta_info *sta = NULL; -+ struct wlan_network *cur_network = NULL; -+ _irqL irqL; -+ _list *head = NULL, *list = NULL; -+ u8 i = 0; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ dm = &hal->odmpriv; -+ mcc_dm = &dm->mcc_dm; -+ -+ /* due to phydm will rst related date, driver must set related data */ -+ if (enable) { -+ for (i = 0; i < MAX_MCC_NUM; i++) { -+ iface = mccobjpriv->iface[i]; -+ if (!iface) -+ continue; -+ stapriv = &iface->stapriv; -+ mccadapriv = &iface->mcc_adapterpriv; -+ switch (mccadapriv->role) { -+ case MCC_ROLE_STA: -+ case MCC_ROLE_GC: -+ cur_network = &iface->mlmepriv.cur_network; -+ sta = rtw_get_stainfo(stapriv, cur_network->network.MacAddress); -+ if (sta) -+ mcc_cfg_phdym_update_macid(iface, _TRUE, sta->cmn.mac_id); -+ break; -+ case MCC_ROLE_AP: -+ case MCC_ROLE_GO: -+ _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ -+ head = &stapriv->asoc_list; -+ list = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, list)) == _FALSE) { -+ sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); -+ list = get_next(list); -+ mcc_cfg_phdym_update_macid(iface, _TRUE, sta->cmn.mac_id); -+ } -+ -+ _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); -+ break; -+ default: -+ RTW_INFO("Unknown role\n"); -+ rtw_warn_on(1); -+ break; -+ } -+ -+ } -+ } -+ -+ mcc_dm->mcc_status = enable; -+} -+ -+static void rtw_hal_mcc_cfg_phydm (_adapter *adapter, enum mcc_cfg_phydm_ops ops, void *data) -+{ -+ switch (ops) { -+ case MCC_CFG_PHYDM_OFFLOAD: -+ mcc_cfg_phdym_offload(adapter, *(u8 *)data); -+ break; -+ case MCC_CFG_PHYDM_RF_CH: -+ mcc_cfg_phdym_rf_ch(adapter); -+ break; -+ case MCC_CFG_PHYDM_ADD_CLIENT: -+ mcc_cfg_phdym_update_macid(adapter, _TRUE, *(u8 *)data); -+ break; -+ case MCC_CFG_PHYDM_REMOVE_CLIENT: -+ mcc_cfg_phdym_update_macid(adapter, _FALSE, *(u8 *)data); -+ break; -+ case MCC_CFG_PHYDM_START: -+ mcc_cfg_phdym_start(adapter, _TRUE); -+ break; -+ case MCC_CFG_PHYDM_STOP: -+ mcc_cfg_phdym_start(adapter, _FALSE); -+ break; -+ case MCC_CFG_PHYDM_DUMP: -+ mcc_cfg_phdym_dump(adapter, data); -+ break; -+ case MCC_CFG_PHYDM_MAX: -+ default: -+ RTW_ERR("[MCC] rtw_hal_mcc_cfg_phydm ops error (%d)\n", ops); -+ break; -+ -+ } -+} -+#endif -+ -+static void rtw_hal_config_mcc_role_setting(PADAPTER padapter, u8 order) -+{ -+ 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_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; -+ _irqL irqL; -+ _list *phead =NULL, *plist = NULL; -+ u8 policy_index = 0; -+ u8 mcc_duration = 0; -+ u8 mcc_interval = 0; -+ u8 starting_ap_num = DEV_AP_STARTING_NUM(pdvobjpriv); -+ u8 ap_num = DEV_AP_NUM(pdvobjpriv); -+ -+ policy_index = pmccobjpriv->policy_index; -+ mcc_duration = mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_DURATION_IDX] -+ - mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_GUARD_OFFSET0_IDX] -+ - mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_GUARD_OFFSET1_IDX]; -+ mcc_interval = mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_INTERVAL_IDX]; -+ -+ if (starting_ap_num == 0 && ap_num == 0) { -+ pmccadapriv->order = order; -+ -+ if (pmccadapriv->order == 0) { -+ /* setting is smiliar to GO/AP */ -+ /* pmccadapriv->mcc_duration = mcc_interval - mcc_duration;*/ -+ pmccadapriv->mgmt_queue_macid = MCC_ROLE_SOFTAP_GO_MGMT_QUEUE_MACID; -+ } else if (pmccadapriv->order == 1) { -+ /* pmccadapriv->mcc_duration = mcc_duration; */ -+ pmccadapriv->mgmt_queue_macid = MCC_ROLE_STA_GC_MGMT_QUEUE_MACID; -+ } else { -+ RTW_INFO("[MCC] not support >= 3 interface\n"); -+ rtw_warn_on(1); -+ } -+ -+ rtw_hal_mcc_assign_tx_threshold(padapter); -+ -+ 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->cmn.mac_id) | BIT(pmccadapriv->mgmt_queue_macid); -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_ADD_CLIENT, &psta->cmn.mac_id); -+ #endif -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT":AP/GO station info is NULL\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ } -+ } else { -+ /* 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 = mcc_duration; -+ -+ rtw_hal_mcc_assign_tx_threshold(padapter); -+ /* 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->cmn.mac_id) | BIT(pmccadapriv->mgmt_queue_macid); -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_ADD_CLIENT, &psta->cmn.mac_id); -+ #endif -+ } 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; -+ /* total druation value equals interval */ -+ pmccadapriv->mcc_duration = mcc_interval - mcc_duration; -+ pmccadapriv->p2p_go_noa_ie_len = 0; /* not NoA attribute at init time */ -+ -+ rtw_hal_mcc_assign_tx_threshold(padapter); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ pmccadapriv->mcc_macid_bitmap = 0; -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ pmccadapriv->mcc_macid_bitmap |= BIT(psta->cmn.mac_id); -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_ADD_CLIENT, &psta->cmn.mac_id); -+ #endif -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ psta = rtw_get_bcmc_stainfo(padapter); -+ -+ if (psta != NULL) -+ pmccadapriv->mgmt_queue_macid = psta->cmn.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 |= BIT(pmccadapriv->mgmt_queue_macid); -+ break; -+ default: -+ RTW_INFO("Unknown role\n"); -+ rtw_warn_on(1); -+ break; -+ } -+ -+ } -+ -+ /* setting Null data parameters */ -+ if (pmccadapriv->role == MCC_ROLE_STA) { -+ pmccadapriv->null_early = 3; -+ pmccadapriv->null_rty_num= 5; -+ } else if (pmccadapriv->role == MCC_ROLE_GC) { -+ pmccadapriv->null_early = 2; -+ pmccadapriv->null_rty_num= 5; -+ } else { -+ pmccadapriv->null_early = 0; -+ pmccadapriv->null_rty_num= 0; -+ } -+ -+ RTW_INFO("********* "FUNC_ADPT_FMT" *********\n", FUNC_ADPT_ARG(padapter)); -+ RTW_INFO("order:%d\n", pmccadapriv->order); -+ RTW_INFO("role:%d\n", pmccadapriv->role); -+ RTW_INFO("mcc duration:%d\n", pmccadapriv->mcc_duration); -+ RTW_INFO("null_early:%d\n", pmccadapriv->null_early); -+ RTW_INFO("null_rty_num:%d\n", pmccadapriv->null_rty_num); -+ RTW_INFO("mgmt queue macid:%d\n", pmccadapriv->mgmt_queue_macid); -+ RTW_INFO("bitmap:0x%02x\n", pmccadapriv->mcc_macid_bitmap); -+ RTW_INFO("target tx bytes:%d\n", pmccadapriv->mcc_target_tx_bytes_to_port); -+ RTW_INFO("**********************************\n"); -+ -+ pmccobjpriv->iface[pmccadapriv->order] = padapter; -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_RF_CH, NULL); -+ #endif -+ -+} -+ -+static void rtw_hal_mcc_rqt_tsf(PADAPTER padapter, u64 *out_tsf) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ PADAPTER order0_iface = NULL; -+ PADAPTER order1_iface = NULL; -+ struct submit_ctx *tsf_req_sctx = NULL; -+ enum _hw_port tsfx = MAX_HW_PORT; -+ enum _hw_port tsfy = MAX_HW_PORT; -+ u8 cmd[H2C_MCC_RQT_TSF_LEN] = {0}; -+ -+ _enter_critical_mutex(&mccobjpriv->mcc_tsf_req_mutex, NULL); -+ -+ order0_iface = mccobjpriv->iface[0]; -+ order1_iface = mccobjpriv->iface[1]; -+ -+ tsf_req_sctx = &mccobjpriv->mcc_tsf_req_sctx; -+ rtw_sctx_init(tsf_req_sctx, MCC_EXPIRE_TIME); -+ mccobjpriv->mcc_tsf_req_sctx_order = 0; -+ tsfx = rtw_hal_get_port(order0_iface); -+ tsfy = rtw_hal_get_port(order1_iface); -+ -+ SET_H2CCMD_MCC_RQT_TSFX(cmd, tsfx); -+ SET_H2CCMD_MCC_RQT_TSFY(cmd, tsfy); -+ -+ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_RQT_TSF, H2C_MCC_RQT_TSF_LEN, cmd); -+ -+ if (!rtw_sctx_wait(tsf_req_sctx, __func__)) -+ RTW_INFO(FUNC_ADPT_FMT": wait for mcc tsf req C2H time out\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (tsf_req_sctx->status == RTW_SCTX_DONE_SUCCESS && out_tsf != NULL) { -+ out_tsf[0] = order0_iface->mcc_adapterpriv.tsf; -+ out_tsf[1] = order1_iface->mcc_adapterpriv.tsf; -+ } -+ -+ -+ _exit_critical_mutex(&mccobjpriv->mcc_tsf_req_mutex, NULL); -+} -+ -+static u8 rtw_hal_mcc_check_start_time_is_valid(PADAPTER padapter, u8 case_num, -+ u32 tsfdiff, s8 *upper_bound_0, s8 *lower_bound_0, s8 *upper_bound_1, s8 *lower_bound_1) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ u8 duration_0 = 0, duration_1 = 0; -+ s8 final_upper_bound = 0, final_lower_bound = 0; -+ u8 intersection = _FALSE; -+ u8 min_start_time = 5; -+ u8 max_start_time = 95; -+ -+ duration_0 = mccobjpriv->iface[0]->mcc_adapterpriv.mcc_duration; -+ duration_1 = mccobjpriv->iface[1]->mcc_adapterpriv.mcc_duration; -+ -+ switch(case_num) { -+ case 1: -+ *upper_bound_0 = tsfdiff; -+ *lower_bound_0 = tsfdiff - duration_1; -+ *upper_bound_1 = 150 - duration_1; -+ *lower_bound_1= 0; -+ break; -+ case 2: -+ *upper_bound_0 = tsfdiff + 100; -+ *lower_bound_0 = tsfdiff + 100 - duration_1; -+ *upper_bound_1 = 150 - duration_1; -+ *lower_bound_1= 0; -+ break; -+ case 3: -+ *upper_bound_0 = tsfdiff + 50; -+ *lower_bound_0 = tsfdiff + 50 - duration_1; -+ *upper_bound_1 = 150 - duration_1; -+ *lower_bound_1= 0; -+ break; -+ case 4: -+ *upper_bound_0 = tsfdiff; -+ *lower_bound_0 = tsfdiff - duration_1; -+ *upper_bound_1 = 150 - duration_1; -+ *lower_bound_1= 0; -+ break; -+ case 5: -+ *upper_bound_0 = 200 - tsfdiff; -+ *lower_bound_0 = 200 - tsfdiff - duration_1; -+ *upper_bound_1 = 150 - duration_1; -+ *lower_bound_1= 0; -+ break; -+ case 6: -+ *upper_bound_0 = tsfdiff - 50; -+ *lower_bound_0 = tsfdiff - 50 - duration_1; -+ *upper_bound_1 = 150 - duration_1; -+ *lower_bound_1= 0; -+ break; -+ default: -+ RTW_ERR("[MCC] %s: error case number(%d\n)", __func__, case_num); -+ } -+ -+ -+ /* check Intersection or not */ -+ if ((*lower_bound_1 >= *upper_bound_0) || -+ (*lower_bound_0 >= *upper_bound_1)) -+ intersection = _FALSE; -+ else -+ intersection = _TRUE; -+ -+ if (intersection) { -+ if (*upper_bound_0 > *upper_bound_1) -+ final_upper_bound = *upper_bound_1; -+ else -+ final_upper_bound = *upper_bound_0; -+ -+ if (*lower_bound_0 > *lower_bound_1) -+ final_lower_bound = *lower_bound_0; -+ else -+ final_lower_bound = *lower_bound_1; -+ -+ mccobjpriv->start_time = (final_lower_bound + final_upper_bound) / 2; -+ -+ /* check start time less than 5ms, request by Pablo@SD1 */ -+ if (mccobjpriv->start_time <= min_start_time) { -+ mccobjpriv->start_time = 6; -+ if (mccobjpriv->start_time < final_lower_bound && mccobjpriv->start_time > final_upper_bound) { -+ intersection = _FALSE; -+ goto exit; -+ } -+ } -+ -+ /* check start time less than 95ms */ -+ if (mccobjpriv->start_time >= max_start_time) { -+ mccobjpriv->start_time = 90; -+ if (mccobjpriv->start_time < final_lower_bound && mccobjpriv->start_time > final_upper_bound) { -+ intersection = _FALSE; -+ goto exit; -+ } -+ } -+ } -+ -+exit: -+ return intersection; -+} -+ -+static void rtw_hal_mcc_decide_duration(PADAPTER padapter) -+{ -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ struct mcc_adapter_priv *mccadapriv = NULL, *mccadapriv_order0 = NULL, *mccadapriv_order1 = NULL; -+ _adapter *iface = NULL, *iface_order0 = NULL, *iface_order1 = NULL; -+ u8 duration = 0, i = 0, duration_time; -+ u8 mcc_interval = 150; -+ -+ iface_order0 = mccobjpriv->iface[0]; -+ iface_order1 = mccobjpriv->iface[1]; -+ mccadapriv_order0 = &iface_order0->mcc_adapterpriv; -+ mccadapriv_order1 = &iface_order1->mcc_adapterpriv; -+ -+ if (mccobjpriv->duration == 0) { -+ /* default */ -+ duration = 30;/*(%)*/ -+ RTW_INFO("%s: mccobjpriv->duration=0, use default value(%d)\n", -+ __FUNCTION__, duration); -+ } else { -+ duration = mccobjpriv->duration;/*(%)*/ -+ RTW_INFO("%s: mccobjpriv->duration=%d\n", -+ __FUNCTION__, duration); -+ } -+ -+ mccobjpriv->interval = mcc_interval; -+ mccobjpriv->mcc_stop_threshold = 2000 * 4 / 300 - 6; -+ /* convert % to ms, for primary adapter */ -+ duration_time = mccobjpriv->interval * duration / 100; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ -+ if (!iface) -+ continue; -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ if (mccadapriv->role == MCC_ROLE_MAX) -+ continue; -+ -+ if (is_primary_adapter(iface)) -+ mccadapriv->mcc_duration = duration_time; -+ else -+ mccadapriv->mcc_duration = mccobjpriv->interval - duration_time; -+ } -+ -+ RTW_INFO("[MCC]" FUNC_ADPT_FMT " order 0 duration=%d\n", FUNC_ADPT_ARG(iface_order0), mccadapriv_order0->mcc_duration); -+ RTW_INFO("[MCC]" FUNC_ADPT_FMT " order 1 duration=%d\n", FUNC_ADPT_ARG(iface_order1), mccadapriv_order1->mcc_duration); -+} -+ -+static u8 rtw_hal_mcc_update_timing_parameters(PADAPTER padapter, u8 force_update) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ u8 need_update = _FALSE; -+ u8 starting_ap_num = DEV_AP_STARTING_NUM(dvobj); -+ u8 ap_num = DEV_AP_NUM(dvobj); -+ -+ -+ /* for STA+STA, modify policy table */ -+ if (starting_ap_num == 0 && ap_num == 0) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ struct mcc_adapter_priv *pmccadapriv = NULL; -+ _adapter *iface = NULL; -+ u64 tsf[MAX_MCC_NUM] = {0}; -+ u64 tsf0 = 0, tsf1 = 0; -+ u32 beaconperiod_0 = 0, beaconperiod_1 = 0, tsfdiff = 0; -+ s8 upper_bound_0 = 0, lower_bound_0 = 0; -+ s8 upper_bound_1 = 0, lower_bound_1 = 0; -+ u8 valid = _FALSE; -+ u8 case_num = 1; -+ u8 i = 0; -+ -+ /* query TSF */ -+ rtw_hal_mcc_rqt_tsf(padapter, tsf); -+ -+ /* selecet policy table according TSF diff */ -+ tsf0 = tsf[0]; -+ beaconperiod_0 = pmccobjpriv->iface[0]->mlmepriv.cur_network.network.Configuration.BeaconPeriod; -+ tsf0 = rtw_modular64(tsf0, (beaconperiod_0 * TU)); -+ -+ tsf1 = tsf[1]; -+ beaconperiod_1 = pmccobjpriv->iface[1]->mlmepriv.cur_network.network.Configuration.BeaconPeriod; -+ tsf1 = rtw_modular64(tsf1, (beaconperiod_1 * TU)); -+ -+ if (tsf0 > tsf1) -+ tsfdiff = tsf0- tsf1; -+ else -+ tsfdiff = (tsf0 + beaconperiod_0 * TU) - tsf1; -+ -+ /* convert to ms */ -+ tsfdiff = (tsfdiff / TU); -+ -+ /* force update*/ -+ if (force_update) { -+ RTW_INFO("orig TSF0:%lld, orig TSF1:%lld\n", -+ pmccobjpriv->iface[0]->mcc_adapterpriv.tsf, pmccobjpriv->iface[1]->mcc_adapterpriv.tsf); -+ RTW_INFO("tsf0:%lld, tsf1:%lld\n", tsf0, tsf1); -+ RTW_INFO("%s: force=%d, last_tsfdiff=%d, tsfdiff=%d, THRESHOLD=%d\n", -+ __func__, force_update, pmccobjpriv->last_tsfdiff, tsfdiff, MCC_UPDATE_PARAMETER_THRESHOLD); -+ pmccobjpriv->last_tsfdiff = tsfdiff; -+ need_update = _TRUE; -+ } else { -+ if (pmccobjpriv->last_tsfdiff > tsfdiff) { -+ /* last tsfdiff - current tsfdiff > THRESHOLD, update parameters */ -+ if (pmccobjpriv->last_tsfdiff > (tsfdiff + MCC_UPDATE_PARAMETER_THRESHOLD)) { -+ RTW_INFO("orig TSF0:%lld, orig TSF1:%lld\n", -+ pmccobjpriv->iface[0]->mcc_adapterpriv.tsf, pmccobjpriv->iface[1]->mcc_adapterpriv.tsf); -+ RTW_INFO("tsf0:%lld, tsf1:%lld\n", tsf0, tsf1); -+ RTW_INFO("%s: force=%d, last_tsfdiff=%d, tsfdiff=%d, THRESHOLD=%d\n", -+ __func__, force_update, pmccobjpriv->last_tsfdiff, tsfdiff, MCC_UPDATE_PARAMETER_THRESHOLD); -+ -+ pmccobjpriv->last_tsfdiff = tsfdiff; -+ need_update = _TRUE; -+ } else { -+ need_update = _FALSE; -+ } -+ } else if (tsfdiff > pmccobjpriv->last_tsfdiff){ -+ /* current tsfdiff - last tsfdiff > THRESHOLD, update parameters */ -+ if (tsfdiff > (pmccobjpriv->last_tsfdiff + MCC_UPDATE_PARAMETER_THRESHOLD)) { -+ RTW_INFO("orig TSF0:%lld, orig TSF1:%lld\n", -+ pmccobjpriv->iface[0]->mcc_adapterpriv.tsf, pmccobjpriv->iface[1]->mcc_adapterpriv.tsf); -+ RTW_INFO("tsf0:%lld, tsf1:%lld\n", tsf0, tsf1); -+ RTW_INFO("%s: force=%d, last_tsfdiff=%d, tsfdiff=%d, THRESHOLD=%d\n", -+ __func__, force_update, pmccobjpriv->last_tsfdiff, tsfdiff, MCC_UPDATE_PARAMETER_THRESHOLD); -+ -+ pmccobjpriv->last_tsfdiff = tsfdiff; -+ need_update = _TRUE; -+ } else { -+ need_update = _FALSE; -+ } -+ } else { -+ need_update = _FALSE; -+ } -+ } -+ -+ if (need_update == _FALSE) -+ goto exit; -+ -+ rtw_hal_mcc_decide_duration(padapter); -+ -+ if (tsfdiff <= 50) { -+ -+ /* RX TBTT 0 */ -+ case_num = 1; -+ valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, -+ &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); -+ -+ if (valid) -+ goto valid_result; -+ -+ /* RX TBTT 1 */ -+ case_num = 2; -+ valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, -+ &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); -+ -+ if (valid) -+ goto valid_result; -+ -+ /* RX TBTT 2 */ -+ case_num = 3; -+ valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, -+ &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); -+ -+ if (valid) -+ goto valid_result; -+ -+ if (valid == _FALSE) { -+ RTW_INFO("[MCC] do not find fit start time\n"); -+ RTW_INFO("[MCC] tsfdiff:%d, duration:%d(%c), interval:%d\n", -+ tsfdiff, pmccobjpriv->duration, 37, pmccobjpriv->interval); -+ -+ } -+ -+ } else { -+ -+ /* RX TBTT 0 */ -+ case_num = 4; -+ valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, -+ &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); -+ -+ if (valid) -+ goto valid_result; -+ -+ -+ /* RX TBTT 1 */ -+ case_num = 5; -+ valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, -+ &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); -+ -+ if (valid) -+ goto valid_result; -+ -+ -+ /* RX TBTT 2 */ -+ case_num = 6; -+ valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, -+ &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); -+ -+ if (valid) -+ goto valid_result; -+ -+ if (valid == _FALSE) { -+ RTW_INFO("[MCC] do not find fit start time\n"); -+ RTW_INFO("[MCC] tsfdiff:%d, duration:%d(%c), interval:%d\n", -+ tsfdiff, pmccobjpriv->duration, 37, pmccobjpriv->interval); -+ } -+ } -+ -+ -+ -+ valid_result: -+ RTW_INFO("********************\n"); -+ RTW_INFO("%s: case_num:%d, start time:%d\n", -+ __func__, case_num, pmccobjpriv->start_time); -+ RTW_INFO("%s: upper_bound_0:%d, lower_bound_0:%d\n", -+ __func__, upper_bound_0, lower_bound_0); -+ RTW_INFO("%s: upper_bound_1:%d, lower_bound_1:%d\n", -+ __func__, upper_bound_1, lower_bound_1); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ pmccadapriv = &iface->mcc_adapterpriv; -+ pmccadapriv = &iface->mcc_adapterpriv; -+ if (pmccadapriv->role == MCC_ROLE_MAX) -+ continue; -+#if 0 -+ if (pmccadapriv->order == 0) { -+ pmccadapriv->mcc_duration = mcc_duration; -+ } else if (pmccadapriv->order == 1) { -+ pmccadapriv->mcc_duration = mcc_interval - mcc_duration; -+ } else { -+ RTW_INFO("[MCC] not support >= 3 interface\n"); -+ rtw_warn_on(1); -+ } -+#endif -+ RTW_INFO("********************\n"); -+ RTW_INFO(FUNC_ADPT_FMT": order:%d, role:%d\n", -+ FUNC_ADPT_ARG(iface), pmccadapriv->order, pmccadapriv->role); -+ RTW_INFO(FUNC_ADPT_FMT": mcc duration:%d, target tx bytes:%d\n", -+ FUNC_ADPT_ARG(iface), pmccadapriv->mcc_duration, pmccadapriv->mcc_target_tx_bytes_to_port); -+ RTW_INFO(FUNC_ADPT_FMT": mgmt queue macid:%d, bitmap:0x%02x\n", -+ FUNC_ADPT_ARG(iface), pmccadapriv->mgmt_queue_macid, pmccadapriv->mcc_macid_bitmap); -+ RTW_INFO("********************\n"); -+ } -+ -+ } -+exit: -+ return need_update; -+} -+ -+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; -+ u8 order = 1; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ pmccadapriv = &iface->mcc_adapterpriv; -+ pwdinfo = &iface->wdinfo; -+ -+ 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)) { -+ if (MLME_IS_LINKING(iface) || MLME_IS_ASOC(iface)) -+ pmccadapriv->role = MCC_ROLE_STA; -+ else { -+ /* bypass non-linked/non-linking interface */ -+ RTW_INFO(FUNC_ADPT_FMT" mlme state:0x%2x\n", -+ FUNC_ADPT_ARG(iface), MLME_STATE(iface)); -+ continue; -+ } -+ } else { -+ /* bypass non-linked/non-linking interface */ -+ RTW_INFO(FUNC_ADPT_FMT" P2P Role:%d, mlme state:0x%2x\n", -+ FUNC_ADPT_ARG(iface), pwdinfo->role, MLME_STATE(iface)); -+ continue; -+ } -+ -+ if (padapter == iface) { -+ /* current adapter is order 0 */ -+ rtw_hal_config_mcc_role_setting(iface, 0); -+ } else { -+ rtw_hal_config_mcc_role_setting(iface, order); -+ order ++; -+ } -+ } -+ -+ rtw_hal_mcc_update_timing_parameters(padapter, _TRUE); -+ -+ return ret; -+} -+ -+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*/ -+ set_frame_sub_type(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; -+} -+ -+/* avoid wrong information for power limit */ -+void rtw_hal_mcc_upadate_chnl_bw(_adapter *padapter, u8 ch, u8 ch_offset, u8 bw, u8 print) -+{ -+ -+ u8 center_ch, chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(padapter); -+ u8 cch_160, cch_80, cch_40, cch_20; -+ -+ center_ch = rtw_get_center_ch(ch, bw, ch_offset); -+ -+ if (bw == CHANNEL_WIDTH_80) { -+ if (center_ch > ch) -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else if (center_ch < ch) -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ /* set Channel */ -+ /* saved channel/bw info */ -+ rtw_set_oper_ch(padapter, ch); -+ rtw_set_oper_bw(padapter, bw); -+ rtw_set_oper_choffset(padapter, ch_offset); -+ -+ cch_80 = bw == CHANNEL_WIDTH_80 ? center_ch : 0; -+ cch_40 = bw == CHANNEL_WIDTH_40 ? center_ch : 0; -+ cch_20 = bw == CHANNEL_WIDTH_20 ? center_ch : 0; -+ -+ if (cch_80 != 0) -+ cch_40 = rtw_get_scch_by_cch_offset(cch_80, CHANNEL_WIDTH_80, chnl_offset80); -+ if (cch_40 != 0) -+ cch_20 = rtw_get_scch_by_cch_offset(cch_40, CHANNEL_WIDTH_40, ch_offset); -+ -+ -+ hal->cch_80 = cch_80; -+ hal->cch_40 = cch_40; -+ hal->cch_20 = cch_20; -+ hal->current_channel = center_ch; -+ hal->CurrentCenterFrequencyIndex1 = center_ch; -+ hal->current_channel_bw = bw; -+ hal->nCur40MhzPrimeSC = ch_offset; -+ hal->nCur80MhzPrimeSC = chnl_offset80; -+ hal->current_band_type = ch > 14 ? BAND_ON_5G:BAND_ON_2_4G; -+ -+ if (print) { -+ RTW_INFO(FUNC_ADPT_FMT" cch:%u, %s, offset40:%u, offset80:%u (%u, %u, %u), band:%s\n" -+ , FUNC_ADPT_ARG(padapter), center_ch, ch_width_str(bw) -+ , ch_offset, chnl_offset80 -+ , hal->cch_80, hal->cch_40, hal->cch_20 -+ , band_str(hal->current_band_type)); -+ } -+} -+ -+u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index, -+ u8 tx_desc, u32 page_size, u8 *total_page_num, RSVDPAGE_LOC *rsvd_page_loc, u8 *page_num) -+{ -+ 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; -+ struct hal_com_data *hal = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ struct mcc_adapter_priv *mccadapriv = NULL; -+#if defined(CONFIG_RTL8822C) -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ struct txagc_table_8822c tab; -+ u8 agc_buff[2][NUM_RATE_AC_2SS]; /* tatol 0x40 rate index for PATH A/B */ -+#endif -+ -+ u8 ret = _SUCCESS, i = 0, j =0, order = 0, CurtPktPageNum = 0; -+ u8 *start = NULL; -+ u8 path = RF_PATH_A; -+ -+ if (page_num) { -+#ifdef CONFIG_MCC_MODE_V2 -+ if (!hal->RegIQKFWOffload) -+ RTW_WARN("[MCC] must enable FW IQK for New IC\n"); -+#endif /* CONFIG_MCC_MODE_V2 */ -+ *total_page_num += (2 * MAX_MCC_NUM+ 1); -+ RTW_INFO("[MCC] allocate mcc rsvd page num = %d\n", *total_page_num); -+ goto exit; -+ } -+ -+ /* 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; -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ if (mccadapriv->role == MCC_ROLE_MAX) -+ continue; -+ -+ order = mccadapriv->order; -+ pmccobjpriv->mcc_loc_rsvd_paga[order] = *total_page_num; -+ -+ switch (mccadapriv->role) { -+ case MCC_ROLE_STA: -+ case MCC_ROLE_GC: -+ /* Build NULL DATA */ -+ RTW_INFO("LocNull(order:%d): %d\n" -+ , order, pmccobjpriv->mcc_loc_rsvd_paga[order]); -+ len = 0; -+ -+ rtw_hal_construct_NullFunctionData(iface -+ , &pframe[*index], &len, _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); -+ *total_page_num += CurtPktPageNum; -+ *index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("LocNull", CurtPktPageNum, *total_page_num, *index); -+ break; -+ case MCC_ROLE_AP: -+ /* Bulid CTS */ -+ RTW_INFO("LocCTS(order:%d): %d\n" -+ , order, pmccobjpriv->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); -+ *total_page_num += CurtPktPageNum; -+ *index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("LocCTS", CurtPktPageNum, *total_page_num, *index); -+ break; -+ case MCC_ROLE_GO: -+ /* To DO */ -+ break; -+ default: -+ RTW_INFO(FUNC_ADPT_FMT": unknown role = %d\n" -+ , FUNC_ADPT_ARG(iface), mccadapriv->role); -+ break; -+ } -+ } -+ -+ for (i = 0; i < MAX_MCC_NUM; i++) { -+ u8 center_ch = 0, ch = 0, bw = 0, bw_offset = 0; -+ BAND_TYPE band = BAND_MAX; -+ u8 power_index = 0; -+ u8 rate_array_sz = 0; -+ u8 *rates = NULL; -+ u8 rate = 0; -+ u8 shift = 0; -+ u32 power_index_4bytes = 0; -+ u8 total_rate = 0; -+ u8 *total_rate_offset = NULL; -+ -+ iface = pmccobjpriv->iface[i]; -+ pmlmeext = &iface->mlmeextpriv; -+ ch = pmlmeext->cur_channel; -+ bw = pmlmeext->cur_bwmode; -+ bw_offset = pmlmeext->cur_ch_offset; -+ center_ch = rtw_get_center_ch(ch, bw, bw_offset); -+ band = center_ch <= 14 ? BAND_ON_2_4G : BAND_ON_5G; -+ rtw_hal_mcc_upadate_chnl_bw(iface, ch, bw_offset, bw, _TRUE); -+ -+ start = &pframe[*index - tx_desc]; -+ _rtw_memset(start, 0, page_size); -+ pmccobjpriv->mcc_pwr_idx_rsvd_page[i] = *total_page_num; -+ RTW_INFO(ADPT_FMT" order:%d, pwr_idx_rsvd_page location[%d]: %d\n", -+ ADPT_ARG(iface), mccadapriv->order, -+ i, pmccobjpriv->mcc_pwr_idx_rsvd_page[i]); -+ -+ total_rate_offset = start; -+#if !defined(CONFIG_RTL8822C) -+ for (path = RF_PATH_A; path < hal_spec->rf_reg_path_num; ++path) { -+ total_rate = 0; -+ /* PATH A for 0~63 byte, PATH B for 64~127 byte*/ -+ if (path == RF_PATH_A) -+ start = total_rate_offset + 1; -+ else if (path == RF_PATH_B) -+ start = total_rate_offset + 64; -+ else { -+ RTW_INFO("[MCC] %s: unknow RF PATH(%d)\n", __func__, path); -+ break; -+ } -+ -+ /* CCK */ -+ if (ch <= 14) { -+ rate_array_sz = rates_by_sections[CCK].rate_num; -+ rates = rates_by_sections[CCK].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, CCK, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ -+ shift = rate % 4; -+ if (shift == 0) { -+ *start = rate; -+ start++; -+ total_rate++; -+ -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ #endif -+ } -+ -+ *start = power_index; -+ start++; -+ -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ -+ -+ shift = rate % 4; -+ power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); -+ if (shift == 3) { -+ rate = rate - 3; -+ RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); -+ power_index_4bytes = 0; -+ total_rate++; -+ } -+ #endif -+ -+ } -+ } -+ -+ /* OFDM */ -+ rate_array_sz = rates_by_sections[OFDM].rate_num; -+ rates = rates_by_sections[OFDM].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, OFDM, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ -+ shift = rate % 4; -+ if (shift == 0) { -+ *start = rate; -+ start++; -+ total_rate++; -+ -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ #endif -+ -+ } -+ -+ *start = power_index; -+ start++; -+ -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ -+ shift = rate % 4; -+ power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); -+ if (shift == 3) { -+ rate = rate - 3; -+ RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); -+ power_index_4bytes = 0; -+ total_rate++; -+ } -+ #endif -+ } -+ -+ /* HT_MCS0_MCS7 */ -+ rate_array_sz = rates_by_sections[HT_MCS0_MCS7].rate_num; -+ rates = rates_by_sections[HT_MCS0_MCS7].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, HT_1SS, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ -+ shift = rate % 4; -+ if (shift == 0) { -+ *start = rate; -+ start++; -+ total_rate++; -+ -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ #endif -+ -+ } -+ -+ *start = power_index; -+ start++; -+ -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ -+ shift = rate % 4; -+ power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); -+ if (shift == 3) { -+ rate = rate - 3; -+ RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); -+ power_index_4bytes = 0; -+ total_rate++; -+ } -+ #endif -+ } -+ -+ /* HT_MCS8_MCS15 */ -+ rate_array_sz = rates_by_sections[HT_MCS8_MCS15].rate_num; -+ rates = rates_by_sections[HT_MCS8_MCS15].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, HT_2SS, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ -+ shift = rate % 4; -+ if (shift == 0) { -+ *start = rate; -+ start++; -+ total_rate++; -+ -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ #endif -+ } -+ -+ *start = power_index; -+ start++; -+ -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ -+ shift = rate % 4; -+ power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); -+ if (shift == 3) { -+ rate = rate - 3; -+ RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); -+ power_index_4bytes = 0; -+ total_rate++; -+ } -+ #endif -+ } -+ -+ /* VHT_1SSMCS0_1SSMCS9 */ -+ rate_array_sz = rates_by_sections[VHT_1SSMCS0_1SSMCS9].rate_num; -+ rates = rates_by_sections[VHT_1SSMCS0_1SSMCS9].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, VHT_1SS, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ -+ shift = rate % 4; -+ if (shift == 0) { -+ *start = rate; -+ start++; -+ total_rate++; -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:0x%02x\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ #endif -+ } -+ *start = power_index; -+ start++; -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ -+ shift = rate % 4; -+ power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); -+ if (shift == 3) { -+ rate = rate - 3; -+ RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); -+ power_index_4bytes = 0; -+ total_rate++; -+ } -+ #endif -+ } -+ -+ /* VHT_2SSMCS0_2SSMCS9 */ -+ rate_array_sz = rates_by_sections[VHT_2SSMCS0_2SSMCS9].rate_num; -+ rates = rates_by_sections[VHT_2SSMCS0_2SSMCS9].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, VHT_2SS, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ -+ shift = rate % 4; -+ if (shift == 0) { -+ *start = rate; -+ start++; -+ total_rate++; -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ #endif -+ } -+ *start = power_index; -+ start++; -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", -+ ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), -+ center_ch, MGN_RATE_STR(rates[j]), power_index); -+ -+ shift = rate % 4; -+ power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); -+ if (shift == 3) { -+ rate = rate - 3; -+ RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); -+ power_index_4bytes = 0; -+ total_rate++; -+ } -+ #endif -+ } -+ -+ } -+ /* total rate store in offset 0 */ -+ *total_rate_offset = total_rate; -+ -+#ifdef DBG_PWR_IDX_RSVD_PAGE -+ RTW_INFO("total_rate=%d\n", total_rate); -+ RTW_INFO(" ======================="ADPT_FMT"===========================\n", ADPT_ARG(iface)); -+ RTW_INFO_DUMP("\n", total_rate_offset, 128); -+ RTW_INFO(" ==================================================\n"); -+#endif -+ -+ CurtPktPageNum = 1; -+ *total_page_num += CurtPktPageNum; -+ *index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("mcc_pwr_idx_rsvd_page", CurtPktPageNum, *total_page_num, *index); -+#else /* 8822C */ -+ for (path = RF_PATH_A; path < hal_spec->rf_reg_path_num; ++path) { -+ /* CCK */ -+ if (ch <= 14) { -+ rate_array_sz = rates_by_sections[CCK].rate_num; -+ rates = rates_by_sections[CCK].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, CCK, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ agc_buff[path][rate] = power_index; -+ } -+ } -+ -+ /* OFDM */ -+ rate_array_sz = rates_by_sections[OFDM].rate_num; -+ rates = rates_by_sections[OFDM].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, OFDM, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ agc_buff[path][rate] = power_index; -+ } -+ /* HT */ -+ rate_array_sz = rates_by_sections[HT_MCS0_MCS7].rate_num; -+ rates = rates_by_sections[HT_MCS0_MCS7].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, HT_1SS, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ agc_buff[path][rate] = power_index; -+ } -+ -+ rate_array_sz = rates_by_sections[HT_MCS8_MCS15].rate_num; -+ rates = rates_by_sections[HT_MCS8_MCS15].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, HT_2SS, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ agc_buff[path][rate] = power_index; -+ } -+ /* VHT */ -+ rate_array_sz = rates_by_sections[VHT_1SSMCS0_1SSMCS9].rate_num; -+ rates = rates_by_sections[VHT_1SSMCS0_1SSMCS9].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, VHT_1SS, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ agc_buff[path][rate] = power_index; -+ } -+ -+ rate_array_sz = rates_by_sections[VHT_2SSMCS0_2SSMCS9].rate_num; -+ rates = rates_by_sections[VHT_2SSMCS0_2SSMCS9].rates; -+ for (j = 0; j < rate_array_sz; ++j) { -+ power_index = phy_get_tx_power_index_ex(iface, path, VHT_2SS, rates[j], bw, band, center_ch, ch); -+ rate = phy_get_rate_idx_of_txpwr_by_rate(rates[j]); -+ agc_buff[path][rate] = power_index; -+ } -+ } -+ phydm_get_txagc_ref_and_diff_8822c(phydm, agc_buff, NUM_RATE_AC_2SS, &tab); -+ *start = tab.ref_pow_cck[0]; -+ start++; -+ *start = tab.ref_pow_cck[1]; -+ start++; -+ *start = tab.ref_pow_ofdm[0]; -+ start++; -+ *start = tab.ref_pow_ofdm[1]; -+ start++; -+ _rtw_memcpy(start, tab.diff_t, sizeof(tab.diff_t)); -+ CurtPktPageNum = 1; -+ *total_page_num += CurtPktPageNum; -+ *index += (CurtPktPageNum * page_size); -+ RSVD_PAGE_CFG("mcc_pwr_idx_rsvd_page", CurtPktPageNum, *total_page_num, *index); -+ #ifdef DBG_PWR_IDX_RSVD_PAGE -+ if (1) { -+ u8 path_idx; -+ for (path_idx = 0; path_idx < 2; path_idx++) { -+ for (j = 0; j < NUM_RATE_AC_2SS; j++) -+ RTW_INFO("agc_buff[%d][%d]=%x\n", i, j, agc_buff[i][j]); -+ } -+ RTW_INFO("tab->ref_pow_cck[0]=%x\n", tab.ref_pow_cck[0]); -+ RTW_INFO("tab->ref_pow_cck[1]=%x\n", tab.ref_pow_cck[1]); -+ RTW_INFO("tab->ref_pow_ofdm[0]=%x\n", tab.ref_pow_ofdm[0]); -+ RTW_INFO("tab->ref_pow_ofdm[1]=%x\n", tab.ref_pow_ofdm[1]); -+ RTW_INFO_DUMP("diff_t ", tab.diff_t, NUM_RATE_AC_2SS); -+ RTW_INFO_DUMP("tab ", (u8 *)&tab, sizeof(tab)); -+ } -+ #endif -+ -+#endif -+ } -+ -+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)); -+ -+#ifdef CONFIG_AP_MODE -+ /* Re-Download beacon */ -+ for (i = 0; i < MAX_MCC_NUM; i++) { -+ iface = pmccobjpriv->iface[i]; -+ if (iface == NULL) -+ continue; -+ -+ pmccadapriv = &iface->mcc_adapterpriv; -+ -+ if (pmccadapriv->role == MCC_ROLE_AP -+ || pmccadapriv->role == MCC_ROLE_GO) { -+ tx_beacon_hdl(iface, NULL); -+ } -+ } -+#endif -+} -+ -+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 hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ -+ SET_H2CCMD_MCC_PWRIDX_OFFLOAD_EN(cmd, _TRUE); -+ SET_H2CCMD_MCC_PWRIDX_OFFLOAD_RFNUM(cmd, hal_spec->rf_reg_path_num); -+ for (order = 0; order < MAX_MCC_NUM; order++) { -+ iface = pmccobjpriv->iface[i]; -+ -+ SET_H2CCMD_MCC_RSVDPAGE_LOC((cmd + order), pmccobjpriv->mcc_loc_rsvd_paga[order]); -+ SET_H2CCMD_MCC_PWRIDX_RSVDPAGE_LOC ((cmd + order), pmccobjpriv->mcc_pwr_idx_rsvd_page[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_time_setting_cmd(PADAPTER padapter) -+{ -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ u8 cmd[H2C_MCC_TIME_SETTING_LEN] = {0}; -+ u8 fw_eable = 1; -+ u8 swchannel_early_time = MCC_SWCH_FW_EARLY_TIME; -+ u8 starting_ap_num = DEV_AP_STARTING_NUM(dvobj); -+ u8 ap_num = DEV_AP_NUM(dvobj); -+ -+ if (starting_ap_num == 0 && ap_num == 0) -+ /* For STA+GC/STA+STA, TSF of GC/STA does not need to sync from TSF of other STA/GC */ -+ fw_eable = 0; -+ else -+ /* Only for STA+GO/STA+AP, TSF of AP/GO need to sync from TSF of STA */ -+ fw_eable = 1; -+ -+ if (fw_eable == 1) { -+ PADAPTER order0_iface = NULL; -+ PADAPTER order1_iface = NULL; -+ u8 policy_idx = mccobjpriv->policy_index; -+ u8 tsf_sync_offset = mcc_switch_channel_policy_table[policy_idx][MCC_TSF_SYNC_OFFSET_IDX]; -+ u8 start_time_offset = mcc_switch_channel_policy_table[policy_idx][MCC_START_TIME_OFFSET_IDX]; -+ u8 interval = mcc_switch_channel_policy_table[policy_idx][MCC_INTERVAL_IDX]; -+ u8 guard_offset0 = mcc_switch_channel_policy_table[policy_idx][MCC_GUARD_OFFSET0_IDX]; -+ u8 guard_offset1 = mcc_switch_channel_policy_table[policy_idx][MCC_GUARD_OFFSET1_IDX]; -+ enum _hw_port tsf_bsae_port = MAX_HW_PORT; -+ enum _hw_port tsf_sync_port = MAX_HW_PORT; -+ order0_iface = mccobjpriv->iface[0]; -+ order1_iface = mccobjpriv->iface[1]; -+ -+ tsf_bsae_port = rtw_hal_get_port(order1_iface); -+ tsf_sync_port = rtw_hal_get_port(order0_iface); -+ -+ /* FW set enable */ -+ SET_H2CCMD_MCC_TIME_SETTING_FW_EN(cmd, fw_eable); -+ /* TSF Sync offset */ -+ SET_H2CCMD_MCC_TIME_SETTING_TSF_SYNC_OFFSET(cmd, tsf_sync_offset); -+ /* start time offset */ -+ SET_H2CCMD_MCC_TIME_SETTING_START_TIME(cmd, (start_time_offset + guard_offset0)); -+ /* interval */ -+ SET_H2CCMD_MCC_TIME_SETTING_INTERVAL(cmd, interval); -+ /* Early time to inform driver by C2H before switch channel */ -+ SET_H2CCMD_MCC_TIME_SETTING_EARLY_SWITCH_RPT(cmd, swchannel_early_time); -+ /* Port0 sync from Port1, not support multi-port */ -+ SET_H2CCMD_MCC_TIME_SETTING_ORDER_BASE(cmd, tsf_bsae_port); -+ SET_H2CCMD_MCC_TIME_SETTING_ORDER_SYNC(cmd, tsf_sync_port); -+ } else { -+ /* start time offset */ -+ SET_H2CCMD_MCC_TIME_SETTING_START_TIME(cmd, mccobjpriv->start_time); -+ /* interval */ -+ SET_H2CCMD_MCC_TIME_SETTING_INTERVAL(cmd, mccobjpriv->interval); -+ /* Early time to inform driver by C2H before switch channel */ -+ SET_H2CCMD_MCC_TIME_SETTING_EARLY_SWITCH_RPT(cmd, swchannel_early_time); -+ } -+ -+#ifdef CONFIG_MCC_MODE_DEBUG -+ { -+ u8 i = 0; -+ -+ RTW_INFO("=========================\n"); -+ RTW_INFO("NoA:\n"); -+ for (i = 0; i < H2C_MCC_TIME_SETTING_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_TIME_SETTING, H2C_MCC_TIME_SETTING_LEN, cmd); -+} -+ -+#ifndef CONFIG_MCC_MODE_V2 -+static void rtw_hal_set_mcc_IQK_offload_cmd(PADAPTER padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ 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; -+ u8 total_rf_path = GET_HAL_SPEC(padapter)->rf_reg_path_num; -+ u8 rf_path_idx = 0, last_order = MAX_MCC_NUM - 1, last_rf_path_index = total_rf_path - 1; -+ -+ /* by order, last order & last_rf_path_index must set ready bit = 1 */ -+ for (i = 0; i < MAX_MCC_NUM; i++) { -+ iface = pmccobjpriv->iface[i]; -+ if (iface == NULL) -+ continue; -+ -+ pmccadapriv = &iface->mcc_adapterpriv; -+ order = pmccadapriv->order; -+ -+ for (rf_path_idx = 0; rf_path_idx < total_rf_path; rf_path_idx ++) { -+ -+ _rtw_memset(cmd, 0, H2C_MCC_IQK_PARAM_LEN); -+ TX_X = pmccadapriv->mcc_iqk_arr[rf_path_idx].TX_X & 0x7ff;/* [10:0] */ -+ TX_Y = pmccadapriv->mcc_iqk_arr[rf_path_idx].TX_Y & 0x7ff;/* [10:0] */ -+ RX_X = pmccadapriv->mcc_iqk_arr[rf_path_idx].RX_X & 0x3ff;/* [9:0] */ -+ RX_Y = pmccadapriv->mcc_iqk_arr[rf_path_idx].RX_Y & 0x3ff;/* [9:0] */ -+ -+ /* ready or not */ -+ if (order == last_order && rf_path_idx == last_rf_path_index) -+ bready = 1; -+ else -+ bready = 0; -+ -+ SET_H2CCMD_MCC_IQK_READY(cmd, bready); -+ SET_H2CCMD_MCC_IQK_ORDER(cmd, order); -+ SET_H2CCMD_MCC_IQK_PATH(cmd, rf_path_idx); -+ -+ /* 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); -+ } -+ } -+} -+#endif -+ -+ -+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; -+ if (pmccadapriv->role == MCC_ROLE_MAX) -+ continue; -+ -+ 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++) -+ printk("0x%x ", cmd[i]); -+ printk("\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); -+} -+ -+#ifdef CONFIG_MCC_MODE_V2 -+static u8 get_pri_ch_idx_by_adapter(u8 center_ch, u8 channel, u8 bw, u8 ch_offset40) -+{ -+ u8 pri_ch_idx = 0, chnl_offset80 = 0; -+ -+ if (bw == 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; -+ } -+ -+ if (bw == CHANNEL_WIDTH_80) { -+ /* primary channel is at lower subband of 80MHz & 40MHz */ -+ if ((ch_offset40 == HAL_PRIME_CHNL_OFFSET_LOWER) && (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ pri_ch_idx = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ /* primary channel is at lower subband of 80MHz & upper subband of 40MHz */ -+ else if ((ch_offset40 == HAL_PRIME_CHNL_OFFSET_UPPER) && (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ pri_ch_idx = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ /* primary channel is at upper subband of 80MHz & lower subband of 40MHz */ -+ else if ((ch_offset40 == HAL_PRIME_CHNL_OFFSET_LOWER) && (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ pri_ch_idx = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ /* primary channel is at upper subband of 80MHz & upper subband of 40MHz */ -+ else if ((ch_offset40 == HAL_PRIME_CHNL_OFFSET_UPPER) && (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ pri_ch_idx = VHT_DATA_SC_20_UPPERST_OF_80MHZ; -+ else { -+ if (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_LOWER) -+ pri_ch_idx = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_UPPER) -+ pri_ch_idx = VHT_DATA_SC_40_UPPER_OF_80MHZ; -+ else -+ RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); -+ } -+ } else if (bw == CHANNEL_WIDTH_40) { -+ /* primary channel is at upper subband of 40MHz */ -+ if (ch_offset40== HAL_PRIME_CHNL_OFFSET_UPPER) -+ pri_ch_idx = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ /* primary channel is at lower subband of 40MHz */ -+ else if (ch_offset40 == HAL_PRIME_CHNL_OFFSET_LOWER) -+ pri_ch_idx = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else -+ RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); -+ } -+ -+ return pri_ch_idx; -+} -+ -+static void rtw_hal_set_mcc_ctrl_cmd_v2(PADAPTER padapter, u8 stop) -+{ -+ u8 cmd[H2C_MCC_CTRL_LEN] = {0}, i = 0; -+ u8 order = 0, totalnum = 0; -+ u8 center_ch = 0, pri_ch_idx = 0, bw = 0; -+ u8 duration = 0, role = 0, incurch = 0, rfetype = 0, distxnull = 0, c2hrpt = 0; -+ u8 dis_sw_retry = 0, null_early_time=2, tsfx = 0, update_parm = 0; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ struct mlme_ext_priv *pmlmeext = NULL; -+ struct mlme_ext_info *pmlmeinfo = NULL; -+ _adapter *iface = NULL; -+ -+ RTW_INFO(FUNC_ADPT_FMT": stop=%d\n", FUNC_ADPT_ARG(padapter), stop); -+ -+ for (i = 0; i < MAX_MCC_NUM; i++) { -+ iface = pmccobjpriv->iface[i]; -+ if (iface == NULL) -+ continue; -+ -+ if (stop) { -+ if (iface != padapter) -+ continue; -+ } -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ order = mccadapriv->order; -+ -+ if (!stop) -+ totalnum = MAX_MCC_NUM; -+ else -+ totalnum = 0xff; /* 0xff means stop */ -+ -+ pmlmeext = &iface->mlmeextpriv; -+ center_ch = rtw_get_center_ch(pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ pri_ch_idx = get_pri_ch_idx_by_adapter(center_ch, pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ bw = pmlmeext->cur_bwmode; -+ duration = mccadapriv->mcc_duration; -+ role = mccadapriv->role; -+ -+ incurch = _FALSE; -+ dis_sw_retry = _TRUE; -+ -+ /* 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: -+ set_channel_bwmode(iface, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ distxnull = MCC_ENABLE_TX_NULL; -+ break; -+ case MCC_ROLE_STA: -+ distxnull = MCC_ENABLE_TX_NULL; -+ break; -+ } -+ -+ null_early_time = mccadapriv->null_early; -+ -+ c2hrpt = MCC_C2H_REPORT_ALL_STATUS; -+ tsfx = rtw_hal_get_port(iface); -+ update_parm = 0; -+ -+ SET_H2CCMD_MCC_CTRL_V2_ORDER(cmd, order); -+ SET_H2CCMD_MCC_CTRL_V2_TOTALNUM(cmd, totalnum); -+ SET_H2CCMD_MCC_CTRL_V2_CENTRAL_CH(cmd, center_ch); -+ SET_H2CCMD_MCC_CTRL_V2_PRIMARY_CH(cmd, pri_ch_idx); -+ SET_H2CCMD_MCC_CTRL_V2_BW(cmd, bw); -+ SET_H2CCMD_MCC_CTRL_V2_DURATION(cmd, duration); -+ SET_H2CCMD_MCC_CTRL_V2_ROLE(cmd, role); -+ SET_H2CCMD_MCC_CTRL_V2_INCURCH(cmd, incurch); -+ SET_H2CCMD_MCC_CTRL_V2_DIS_SW_RETRY(cmd, dis_sw_retry); -+ SET_H2CCMD_MCC_CTRL_V2_DISTXNULL(cmd, distxnull); -+ SET_H2CCMD_MCC_CTRL_V2_C2HRPT(cmd, c2hrpt); -+ SET_H2CCMD_MCC_CTRL_V2_TSFX(cmd, tsfx); -+ SET_H2CCMD_MCC_CTRL_V2_NULL_EARLY(cmd, null_early_time); -+ SET_H2CCMD_MCC_CTRL_V2_UPDATE_PARM(cmd, update_parm); -+ -+#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_CTRL_V2, H2C_MCC_CTRL_LEN, cmd); -+ } -+} -+ -+#else -+static void rtw_hal_set_mcc_ctrl_cmd_v1(PADAPTER padapter, u8 stop) -+{ -+ u8 cmd[H2C_MCC_CTRL_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 mcc_adapter_priv *mccadapriv = NULL; -+ 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 < MAX_MCC_NUM; i++) { -+ iface = pmccobjpriv->iface[i]; -+ if (iface == NULL) -+ continue; -+ -+ if (stop) { -+ if (iface != padapter) -+ continue; -+ } -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ order = mccadapriv->order; -+ -+ if (!stop) -+ totalnum = MAX_MCC_NUM; -+ 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 = mccadapriv->mcc_duration; -+ role = mccadapriv->role; -+ -+ incurch = _FALSE; -+ -+ if (IS_HARDWARE_TYPE_8812(padapter)) -+ rfetype = pHalData->rfe_type; /* 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_CTRL_ORDER(cmd, order); -+ SET_H2CCMD_MCC_CTRL_TOTALNUM(cmd, totalnum); -+ SET_H2CCMD_MCC_CTRL_CHIDX(cmd, chidx); -+ SET_H2CCMD_MCC_CTRL_BW(cmd, bw); -+ SET_H2CCMD_MCC_CTRL_BW40SC(cmd, bw40sc); -+ SET_H2CCMD_MCC_CTRL_BW80SC(cmd, bw80sc); -+ SET_H2CCMD_MCC_CTRL_DURATION(cmd, duration); -+ SET_H2CCMD_MCC_CTRL_ROLE(cmd, role); -+ SET_H2CCMD_MCC_CTRL_INCURCH(cmd, incurch); -+ SET_H2CCMD_MCC_CTRL_RFETYPE(cmd, rfetype); -+ SET_H2CCMD_MCC_CTRL_DISTXNULL(cmd, distxnull); -+ SET_H2CCMD_MCC_CTRL_C2HRPT(cmd, c2hrpt); -+ SET_H2CCMD_MCC_CTRL_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_CTRL, H2C_MCC_CTRL_LEN, cmd); -+ } -+} -+#endif -+ -+static void rtw_hal_set_mcc_ctrl_cmd(PADAPTER padapter, u8 stop) -+{ -+ #ifdef CONFIG_MCC_MODE_V2 -+ /* new cmd 0x17 */ -+ rtw_hal_set_mcc_ctrl_cmd_v2(padapter, stop); -+ #else -+ /* old cmd 0x18 */ -+ rtw_hal_set_mcc_ctrl_cmd_v1(padapter, stop); -+ #endif -+} -+ -+static u8 check_mcc_support(PADAPTER adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 sta_linked_num = DEV_STA_LD_NUM(dvobj); -+ u8 starting_ap_num = DEV_AP_STARTING_NUM(dvobj); -+ u8 ap_num = DEV_AP_NUM(dvobj); -+ u8 ret = _FAIL; -+ -+ RTW_INFO("[MCC] sta_linked_num=%d, starting_ap_num=%d,ap_num=%d\n", -+ sta_linked_num, starting_ap_num, ap_num); -+ -+ /* case for sta + sta case */ -+ if (sta_linked_num == MAX_MCC_NUM) { -+ ret = _SUCCESS; -+ goto exit; -+ } -+ -+ /* case for starting AP + linked sta */ -+ if ((starting_ap_num + sta_linked_num) == MAX_MCC_NUM) { -+ ret = _SUCCESS; -+ goto exit; -+ } -+ -+ /* case for started AP + linked sta */ -+ if ((ap_num + sta_linked_num) == MAX_MCC_NUM) { -+ ret = _SUCCESS; -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+static void rtw_hal_mcc_start_prehdl(PADAPTER padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ u8 i = 1; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ mccadapriv->role = MCC_ROLE_MAX; -+ } -+ -+#ifdef CONFIG_RTL8822C -+ if (IS_HARDWARE_TYPE_8822C(padapter)) { -+ HAL_DATA_TYPE *hal = GET_HAL_DATA(padapter); -+ struct dm_struct *dm = &hal->odmpriv; -+ -+ odm_cmn_info_update(dm, ODM_CMNINFO_IS_DOWNLOAD_FW, hal->bFWReady); -+ } -+#endif -+} -+ -+static u8 rtw_hal_set_mcc_start_setting(PADAPTER padapter, u8 status) -+{ -+ u8 ret = _SUCCESS, enable_tsf_auto_sync = _FALSE; -+ 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 (check_mcc_support(padapter) == _FAIL) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ rtw_hal_mcc_start_prehdl(padapter); -+ -+ /* configure mcc switch channel setting */ -+ rtw_hal_config_mcc_switch_channel_setting(padapter); -+ -+ 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 time setting */ -+ rtw_hal_set_mcc_time_setting_cmd(padapter); -+ -+#ifndef CONFIG_MCC_MODE_V2 -+ /* IQK value offload */ -+ rtw_hal_set_mcc_IQK_offload_cmd(padapter); -+#endif -+ -+ /* set mac id to fw */ -+ rtw_hal_set_mcc_macid_cmd(padapter); -+#ifdef CONFIG_HW_P0_TSF_SYNC -+ if (dvobj->p0_tsf.sync_port != MAX_HW_PORT ) { -+ /* disable tsf auto sync */ -+ RTW_INFO("[MCC] disable HW TSF sync\n"); -+ rtw_hal_set_hwreg(padapter, HW_VAR_TSF_AUTO_SYNC, &enable_tsf_auto_sync); -+ } else { -+ RTW_INFO("[MCC] already disable HW TSF sync\n"); -+ } -+#endif -+ /* set mcc parameter */ -+ rtw_hal_set_mcc_ctrl_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); -+ struct mcc_obj_priv *mccobjpriv = &dvobj->mcc_objpriv; -+ _adapter *iface = NULL; -+ struct mcc_adapter_priv *mccadapriv = 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 < MAX_MCC_NUM; i++) { -+ iface = mccobjpriv->iface[i]; -+ if (iface == NULL) -+ continue; -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ -+ /* use other interface to set cmd */ -+ if (iface != padapter) { -+ rtw_hal_set_mcc_ctrl_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); -+ struct mcc_obj_priv *mccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ _adapter *iface = NULL; -+ PHAL_DATA_TYPE hal; -+ u8 i = 0; -+ u8 enable_rx_bar = _FALSE; -+ -+ hal = GET_HAL_DATA(padapter); -+ -+ for (i = 0; i < MAX_MCC_NUM; i++) { -+ iface = mccobjpriv->iface[i]; -+ if (iface == NULL) -+ continue; -+ -+ /* release network queue */ -+ rtw_netif_wake_queue(iface->pnetdev); -+ mccadapriv = &iface->mcc_adapterpriv; -+ mccadapriv->mcc_tx_bytes_from_kernel = 0; -+ mccadapriv->mcc_last_tx_bytes_from_kernel = 0; -+ mccadapriv->mcc_tx_bytes_to_port = 0; -+ -+ if (mccadapriv->role == MCC_ROLE_GO) -+ rtw_hal_mcc_remove_go_p2p_ie(iface); -+ -+#ifdef CONFIG_TDLS -+ if (MLME_IS_STA(iface)) { -+ if (mccadapriv->backup_tdls_en) { -+ rtw_enable_tdls_func(iface); -+ RTW_INFO("%s: Disable MCC, Enable TDLS\n", __func__); -+ mccadapriv->backup_tdls_en = _FALSE; -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ -+ mccadapriv->role = MCC_ROLE_MAX; -+ mccobjpriv->iface[i] = NULL; -+ } -+ -+ /* force switch channel */ -+ hal->current_channel = 0; -+ hal->current_channel_bw = CHANNEL_WIDTH_MAX; -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_STOP, NULL); -+ #endif -+ -+#ifdef CONFIG_RTL8822C -+ if (IS_HARDWARE_TYPE_8822C(padapter)) { -+ HAL_DATA_TYPE *hal = GET_HAL_DATA(padapter); -+ struct dm_struct *dm = &hal->odmpriv; -+ -+ odm_cmn_info_update(dm, ODM_CMNINFO_IS_DOWNLOAD_FW, _FALSE); -+ } -+#endif -+} -+ -+static void rtw_hal_mcc_start_posthdl(PADAPTER padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *mccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ _adapter *iface = NULL; -+ u8 i = 0, order = 0; -+ u8 enable_rx_bar = _TRUE; -+ -+ for (i = 0; i < MAX_MCC_NUM; i++) { -+ iface = mccobjpriv->iface[i]; -+ if (iface == NULL) -+ continue; -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ if (mccadapriv->role == MCC_ROLE_MAX) -+ continue; -+ -+ mccadapriv->mcc_tx_bytes_from_kernel = 0; -+ mccadapriv->mcc_last_tx_bytes_from_kernel = 0; -+ mccadapriv->mcc_tx_bytes_to_port = 0; -+ -+#ifdef CONFIG_TDLS -+ if (MLME_IS_STA(iface)) { -+ if (rtw_is_tdls_enabled(iface)) { -+ mccadapriv->backup_tdls_en = _TRUE; -+ rtw_disable_tdls_func(iface, _TRUE); -+ RTW_INFO("%s: Enable MCC, Disable TDLS\n", __func__); -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ } -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_START, NULL); -+ #endif -+} -+ -+/* -+ * 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; -+ systime 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) { -+ /* 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_status_hdl(padapter, status); -+ 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_status_hdl(padapter, status); -+ rtw_hal_mcc_stop_posthdl(padapter); -+ } -+ } -+ -+exit: -+ /* 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 = &(pdvobjpriv->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 (iface == NULL) -+ continue; -+ -+ 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; -+ } -+ } -+ -+ if (cur_iface == NULL || next_iface == NULL) { -+ RTW_ERR("cur_iface=%p,next_iface=%p\n", cur_iface, next_iface); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ /* 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); -+ } -+} -+ -+static void rtw_hal_mcc_update_noa_start_time_hdl(PADAPTER padapter, u8 buflen, u8 *tmpBuf) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(pdvobjpriv->mcc_objpriv); -+ struct mcc_adapter_priv *pmccadapriv = NULL; -+ PADAPTER iface = NULL; -+ u8 i = 0; -+ u8 policy_idx = pmccobjpriv->policy_index; -+ u8 noa_tsf_sync_offset = mcc_switch_channel_policy_table[policy_idx][MCC_TSF_SYNC_OFFSET_IDX]; -+ u8 noa_start_time_offset = mcc_switch_channel_policy_table[policy_idx][MCC_START_TIME_OFFSET_IDX]; -+ -+ for (i = 0; i < pdvobjpriv->iface_nums; i++) { -+ iface = pdvobjpriv->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ pmccadapriv = &iface->mcc_adapterpriv; -+ if (pmccadapriv->role == MCC_ROLE_MAX) -+ continue; -+ -+ /* GO & channel match */ -+ if (pmccadapriv->role == MCC_ROLE_GO) { -+ /* convert GO TBTT from FW to noa_start_time(TU convert to mircosecond) */ -+ pmccadapriv->noa_start_time = RTW_GET_LE32(tmpBuf + 2) + noa_start_time_offset * TU; -+ -+ if (0) { -+ RTW_INFO("TBTT:0x%02x\n", RTW_GET_LE32(tmpBuf + 2)); -+ RTW_INFO("noa_tsf_sync_offset:%d, noa_start_time_offset:%d\n", noa_tsf_sync_offset, noa_start_time_offset); -+ RTW_INFO(FUNC_ADPT_FMT"buf=0x%02x:0x%02x:0x%02x:0x%02x, noa_start_time=0x%02x\n" -+ , FUNC_ADPT_ARG(iface) -+ , tmpBuf[2] -+ , tmpBuf[3] -+ , tmpBuf[4] -+ , tmpBuf[5] -+ ,pmccadapriv->noa_start_time); -+ } -+ -+ rtw_hal_mcc_update_go_p2p_ie(iface); -+ -+ break; -+ } -+ } -+ -+} -+ -+static u8 mcc_get_reg_hdl(PADAPTER adapter, const u8 *val) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ _adapter *cur_iface = NULL; -+ u8 ret = _SUCCESS; -+ u8 cur_order = 0; -+ #ifdef CONFIG_RTL8822C -+ u16 dbg_reg[DBG_MCC_REG_NUM] = {0x4d4,0x522,0x1d70}; -+ #else -+ u16 dbg_reg[DBG_MCC_REG_NUM] = {0x4d4,0x522,0xc50,0xe50}; -+ #endif -+ u16 dbg_rf_reg[DBG_MCC_RF_REG_NUM] = {0x18}; -+ u8 i; -+ u32 reg_val; -+ u8 path = 0, path_nums = 0; -+ -+ if (!rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (!val) -+ cur_order = 0xff; -+ else -+ cur_order = *val; -+ -+ if (cur_order >= MAX_MCC_NUM && cur_order != 0xff) { -+ RTW_ERR("%s: cur_order=%d\n", __func__, cur_order); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ path_nums = hal_spec->rf_reg_path_num; -+ if (cur_order == 0xff) -+ cur_iface = adapter; -+ else -+ cur_iface = mccobjpriv->iface[cur_order]; -+ -+ if (!cur_iface) { -+ RTW_ERR("%s: cur_iface = NULL, cur_order=%d\n", __func__, cur_order); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ _enter_critical_mutex(&mccobjpriv->mcc_dbg_reg_mutex, NULL); -+ if (!RTW_CANNOT_IO(adapter)) { -+ /* RTW_INFO("=================================\n"); -+ RTW_INFO(ADPT_FMT": cur_order:%d\n", ADPT_ARG(cur_iface), cur_order); */ -+ -+ for (i = 0; i < ARRAY_SIZE(dbg_reg); i++) { -+ reg_val = rtw_read32(adapter, dbg_reg[i]); -+ mccobjpriv->dbg_reg[i] = dbg_reg[i]; -+ mccobjpriv->dbg_reg_val[i] = reg_val; -+ /* RTW_PRINT("REG_%X:0x%08x\n", dbg_reg[i], reg_val); */ -+ } -+ for (i = 0; i < ARRAY_SIZE(dbg_rf_reg); i++) { -+ for (path = 0; path < path_nums; path++) { -+ reg_val = rtw_hal_read_rfreg(adapter, path, dbg_rf_reg[i], 0xffffffff); -+ /* RTW_PRINT("RF_PATH_%d_REG_%X:0x%08x\n", -+ path, dbg_rf_reg[i], reg_val); */ -+ mccobjpriv->dbg_rf_reg[i] = dbg_rf_reg[i]; -+ mccobjpriv->dbg_rf_reg_val[i][path] = reg_val; -+ } -+ } -+ } -+ _exit_critical_mutex(&mccobjpriv->mcc_dbg_reg_mutex, NULL); -+ -+exit: -+ return ret; -+} -+ -+static u8 mcc_get_reg_cmd(_adapter *adapter, u8 cur_order) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 *mcc_cur_order = NULL; -+ u8 res = _SUCCESS; -+ -+ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == 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 *)cmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ mcc_cur_order = rtw_zmalloc(sizeof(u8)); -+ if (mcc_cur_order == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = MCC_CMD_WK_CID; -+ pdrvextra_cmd_parm->type = MCC_GET_DBG_REG_WK_CID; -+ pdrvextra_cmd_parm->size = 1; -+ pdrvextra_cmd_parm->pbuf = mcc_cur_order; -+ -+ _rtw_memcpy(mcc_cur_order, &cur_order, 1); -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, CMD_SET_DRV_EXTRA); -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ -+exit: -+ return res; -+} -+ -+static void rtw_hal_mcc_rpt_tsf_hdl(PADAPTER padapter, u8 buflen, u8 *tmpBuf) -+{ -+ struct dvobj_priv *dvobjpriv = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *mccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ struct submit_ctx *mcc_tsf_req_sctx = &mccobjpriv->mcc_tsf_req_sctx; -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ _adapter *iface = NULL; -+ u8 order = 0; -+ -+ order = mccobjpriv->mcc_tsf_req_sctx_order; -+ iface = mccobjpriv->iface[order]; -+ mccadapriv = &iface->mcc_adapterpriv; -+ mccadapriv->tsf = RTW_GET_LE64(tmpBuf + 2); -+ -+ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" TSF(order:%d):0x%02llx\n", FUNC_ADPT_ARG(iface), mccadapriv->order, mccadapriv->tsf); -+ -+ if (mccadapriv->order == (MAX_MCC_NUM - 1)) -+ rtw_sctx_done(&mcc_tsf_req_sctx); -+ else -+ mccobjpriv->mcc_tsf_req_sctx_order ++; -+ -+} -+ -+/** -+ * 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; -+ _adapter *cur_adapter = NULL; -+ u8 cur_ch = 0, cur_bw = 0, cur_ch_offset = 0; -+ _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; -+ } -+ -+ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ pmccobjpriv->mcc_c2h_status = tmpBuf[0]; -+ pmccobjpriv->current_order = tmpBuf[1]; -+ cur_adapter = pmccobjpriv->iface[pmccobjpriv->current_order]; -+ cur_ch = cur_adapter->mlmeextpriv.cur_channel; -+ cur_bw = cur_adapter->mlmeextpriv.cur_bwmode; -+ cur_ch_offset = cur_adapter->mlmeextpriv.cur_ch_offset; -+ rtw_set_oper_ch(cur_adapter, cur_ch); -+ rtw_set_oper_bw(cur_adapter, cur_bw); -+ rtw_set_oper_choffset(cur_adapter, cur_ch_offset); -+ _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ -+ if (0) -+ RTW_INFO("%d,order:%d,TSF:0x%llx\n", tmpBuf[0], tmpBuf[1], RTW_GET_LE64(tmpBuf + 2)); -+ -+ switch (pmccobjpriv->mcc_c2h_status) { -+ case MCC_RPT_SUCCESS: -+ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ pmccobjpriv->cur_mcc_success_cnt++; -+ rtw_hal_mcc_upadate_chnl_bw(cur_adapter, cur_ch, cur_ch_offset, cur_bw, _FALSE); -+ mcc_get_reg_cmd(padapter, pmccobjpriv->current_order); -+ _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\n"); -+ pmccobjpriv->mcc_c2h_status = MCC_RPT_STOPMCC; -+ rtw_hal_mcc_upadate_chnl_bw(cur_adapter, cur_ch, cur_ch_offset, cur_bw, _TRUE); -+ 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\n"); -+ rtw_sctx_done(&mcc_sctx); -+ break; -+ case MCC_RPT_SWICH_CHANNEL_NOTIFY: -+ rtw_hal_mcc_sw_ch_fw_notify_hdl(padapter); -+ break; -+ case MCC_RPT_UPDATE_NOA_START_TIME: -+ rtw_hal_mcc_update_noa_start_time_hdl(padapter, buflen, tmpBuf); -+ break; -+ case MCC_RPT_TSF: -+ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ rtw_hal_mcc_rpt_tsf_hdl(padapter, buflen, tmpBuf); -+ _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ break; -+ default: -+ /* RTW_INFO("[MCC] Other MCC status(%d)\n", pmccobjpriv->mcc_c2h_status); */ -+ break; -+ } -+} -+ -+void rtw_hal_mcc_update_parameter(PADAPTER padapter, u8 force_update) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ u8 cmd[H2C_MCC_TIME_SETTING_LEN] = {0}; -+ u8 swchannel_early_time = MCC_SWCH_FW_EARLY_TIME; -+ u8 ap_num = DEV_AP_NUM(dvobj); -+ -+ if (ap_num == 0) { -+ u8 need_update = _FALSE; -+ u8 start_time_offset = 0, interval = 0, duration = 0; -+ -+ need_update = rtw_hal_mcc_update_timing_parameters(padapter, force_update); -+ -+ if (need_update == _FALSE) -+ return; -+ -+ start_time_offset = mccobjpriv->start_time; -+ interval = mccobjpriv->interval; -+ duration = mccobjpriv->iface[0]->mcc_adapterpriv.mcc_duration; -+ -+ SET_H2CCMD_MCC_TIME_SETTING_START_TIME(cmd, start_time_offset); -+ SET_H2CCMD_MCC_TIME_SETTING_INTERVAL(cmd, interval); -+ SET_H2CCMD_MCC_TIME_SETTING_EARLY_SWITCH_RPT(cmd, swchannel_early_time); -+ SET_H2CCMD_MCC_TIME_SETTING_UPDATE(cmd, _TRUE); -+ SET_H2CCMD_MCC_TIME_SETTING_ORDER0_DURATION(cmd, duration); -+ } else { -+ PADAPTER order0_iface = NULL; -+ PADAPTER order1_iface = NULL; -+ u8 policy_idx = mccobjpriv->policy_index; -+ u8 duration = mcc_switch_channel_policy_table[policy_idx][MCC_DURATION_IDX]; -+ u8 tsf_sync_offset = mcc_switch_channel_policy_table[policy_idx][MCC_TSF_SYNC_OFFSET_IDX]; -+ u8 start_time_offset = mcc_switch_channel_policy_table[policy_idx][MCC_START_TIME_OFFSET_IDX]; -+ u8 interval = mcc_switch_channel_policy_table[policy_idx][MCC_INTERVAL_IDX]; -+ u8 guard_offset0 = mcc_switch_channel_policy_table[policy_idx][MCC_GUARD_OFFSET0_IDX]; -+ u8 guard_offset1 = mcc_switch_channel_policy_table[policy_idx][MCC_GUARD_OFFSET1_IDX]; -+ u8 order0_duration = 0; -+ u8 i = 0; -+ enum _hw_port tsf_bsae_port = MAX_HW_PORT; -+ enum _hw_port tsf_sync_port = MAX_HW_PORT; -+ -+ RTW_INFO("%s: policy_idx=%d\n", __func__, policy_idx); -+ -+ order0_iface = mccobjpriv->iface[0]; -+ order1_iface = mccobjpriv->iface[1]; -+ -+ /* GO/AP is order 0, GC/STA is order 1 */ -+ order0_duration = order0_iface->mcc_adapterpriv.mcc_duration = interval - duration; -+ order0_iface->mcc_adapterpriv.mcc_duration = duration; -+ -+ tsf_bsae_port = rtw_hal_get_port(order1_iface); -+ tsf_sync_port = rtw_hal_get_port(order0_iface); -+ -+ /* update IE */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ PADAPTER iface = NULL; -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ if (mccadapriv->role == MCC_ROLE_MAX) -+ continue; -+ -+ if (mccadapriv->role == MCC_ROLE_GO) -+ rtw_hal_mcc_update_go_p2p_ie(iface); -+ } -+ -+ /* update H2C cmd */ -+ /* FW set enable */ -+ SET_H2CCMD_MCC_TIME_SETTING_FW_EN(cmd, _TRUE); -+ /* TSF Sync offset */ -+ SET_H2CCMD_MCC_TIME_SETTING_TSF_SYNC_OFFSET(cmd, tsf_sync_offset); -+ /* start time offset */ -+ SET_H2CCMD_MCC_TIME_SETTING_START_TIME(cmd, (start_time_offset + guard_offset0)); -+ /* interval */ -+ SET_H2CCMD_MCC_TIME_SETTING_INTERVAL(cmd, interval); -+ /* Early time to inform driver by C2H before switch channel */ -+ SET_H2CCMD_MCC_TIME_SETTING_EARLY_SWITCH_RPT(cmd, swchannel_early_time); -+ /* Port0 sync from Port1, not support multi-port */ -+ SET_H2CCMD_MCC_TIME_SETTING_ORDER_BASE(cmd, tsf_bsae_port); -+ SET_H2CCMD_MCC_TIME_SETTING_ORDER_SYNC(cmd, tsf_sync_port); -+ SET_H2CCMD_MCC_TIME_SETTING_UPDATE(cmd, _TRUE); -+ SET_H2CCMD_MCC_TIME_SETTING_ORDER0_DURATION(cmd, order0_duration); -+ } -+ -+ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_TIME_SETTING, H2C_MCC_TIME_SETTING_LEN, cmd); -+} -+ -+/** -+ * 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); -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ _adapter *iface = NULL; -+ u8 cur_cnt = 0, prev_cnt = 0, diff_cnt = 0, check_ret = _FAIL, threshold = 0; -+ u8 policy_idx = pmccobjpriv->policy_index; -+ u8 noa_enable = _FALSE; -+ u8 i = 0; -+ _irqL irqL; -+ u8 ap_num = DEV_AP_NUM(dvobj); -+ -+/* #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)) { -+ -+ /* check noa enable or not */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ if (mccadapriv->role == MCC_ROLE_MAX) -+ continue; -+ -+ if (iface->wdinfo.p2p_ps_mode == P2P_PS_NOA) { -+ noa_enable = _TRUE; -+ break; -+ } -+ } -+ -+ if (!noa_enable && ap_num == 0) -+ rtw_hal_mcc_update_parameter(padapter, _FALSE); -+ -+ threshold = pmccobjpriv->mcc_stop_threshold; -+ -+ 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 < threshold) { -+ 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, back_op = _FALSE; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ struct mlme_ext_priv *mlmeext = NULL; -+ _adapter *iface = NULL; -+ -+ if (!MCC_EN(padapter)) -+ goto exit; -+ -+ if (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) -+ goto exit; -+ -+ /* disable PS_ANNC & TX_RESUME for all interface */ -+ /* ToDo: TX_RESUME by interface in SCAN_BACKING_OP */ -+ mlmeext = &padapter->mlmeextpriv; -+ -+ flags = mlmeext_scan_backop_flags(mlmeext); -+ if (mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_PS_ANNC)) -+ flags &= ~SS_BACKOP_PS_ANNC; -+ -+ if (mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_TX_RESUME)) -+ flags &= ~SS_BACKOP_TX_RESUME; -+ -+ mlmeext_assign_scan_backop_flags(mlmeext, flags); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (MLME_IS_GO(iface) || MLME_IS_AP(iface)) -+ back_op = _TRUE; -+ else if (MLME_IS_GC(iface) && (iface != padapter)) -+ /* switch to another linked interface(GO) to receive beacon to avoid no beacon disconnect */ -+ back_op = _TRUE; -+ else if (MLME_IS_STA(iface) && MLME_IS_ASOC(iface) && (iface != padapter)) -+ /* switch to another linked interface(STA) to receive beacon to avoid no beacon disconnect */ -+ back_op = _TRUE; -+ else { -+ /* bypass non-linked/non-linking interface/scan interface */ -+ continue; -+ } -+ -+ if (back_op) { -+ *ch = mlmeext->cur_channel; -+ *bw = mlmeext->cur_bwmode; -+ *offset = mlmeext->cur_ch_offset; -+ need_ch_setting_union = _FALSE; -+ } -+ } -+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; -+} -+ -+static void rtw_hal_mcc_assign_scan_flag(PADAPTER padapter, u8 scan_done) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ _adapter *iface = NULL; -+ struct mlme_ext_priv *pmlmeext = NULL; -+ u8 i = 0, flags; -+ -+ if (!MCC_EN(padapter)) -+ return; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ mccadapriv = &iface->mcc_adapterpriv; -+ if (mccadapriv->role == MCC_ROLE_MAX) -+ continue; -+ -+ pmlmeext = &iface->mlmeextpriv; -+ if (is_client_associated_to_ap(iface)) { -+ flags = mlmeext_scan_backop_flags_sta(pmlmeext); -+ if (scan_done) { -+ if (mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN)) { -+ flags &= ~SS_BACKOP_EN; -+ mlmeext_assign_scan_backop_flags_sta(pmlmeext, flags); -+ } -+ } else { -+ if (!mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN)) { -+ flags |= SS_BACKOP_EN; -+ mlmeext_assign_scan_backop_flags_sta(pmlmeext, flags); -+ } -+ } -+ -+ } -+ } -+} -+ -+/** -+ * 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); -+ rtw_hal_mcc_assign_scan_flag(padapter, 0); -+ } -+ } -+ _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)) { -+ rtw_hal_mcc_assign_scan_flag(padapter, 1); -+ 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_restore_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); -+ -+ if (ret == _FAIL) { /* MCC Start fail, AP/GO switch to buddy's channel */ -+ u8 ch_to_set = 0, bw_to_set, offset_to_set; -+ -+ rtw_hal_set_mcc_status(padapter, MCC_STATUS_NEED_MCC | MCC_STATUS_DOING_MCC); -+ rtw_hal_set_mcc_setting_disconnect(padapter); -+ if (rtw_mi_get_ch_setting_union_no_self( -+ padapter, &ch_to_set, &bw_to_set, -+ &offset_to_set) != 0) { -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(padapter); -+ u8 doiqk = _TRUE; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, &doiqk); -+ hal->current_channel = 0; -+ hal->current_channel_bw = CHANNEL_WIDTH_MAX; -+ set_channel_bwmode(padapter, ch_to_set, offset_to_set, bw_to_set); -+ doiqk = _FALSE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, &doiqk); -+ } -+ } -+ } -+ } -+ -+ 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_restore_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); -+ -+ if (ret == _FAIL) { /* MCC Start Fail, then disconenct client join */ -+ rtw_hal_set_mcc_status(padapter, MCC_STATUS_NEED_MCC | MCC_STATUS_DOING_MCC); -+ rtw_disassoc_cmd(padapter, 0, RTW_CMDF_DIRECTLY); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ rtw_free_assoc_resources(padapter, _TRUE); -+ rtw_free_network_queue(padapter, _TRUE); -+ } -+ } -+ } -+ } -+ -+ 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; -+ -+ /* issue null data to other interface connected to AP */ -+ rtw_hal_mcc_issue_null_data(padapter, chbw_allow, _TRUE); -+ -+ *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), MCC_EN(padapter) -+ , *ch, *bw, *offset); -+ ret = _SUCCESS; -+ } -+ } -+ -+ return ret; -+} -+ -+static void rtw_hal_mcc_dump_noa_content(void *sel, PADAPTER padapter) -+{ -+ struct mcc_adapter_priv *pmccadapriv = NULL; -+ u8 *pos = NULL; -+ pmccadapriv = &padapter->mcc_adapterpriv; -+ /* last position for NoA attribute */ -+ pos = pmccadapriv->p2p_go_noa_ie + pmccadapriv->p2p_go_noa_ie_len; -+ -+ -+ RTW_PRINT_SEL(sel, "\nStart to dump NoA Content\n"); -+ RTW_PRINT_SEL(sel, "NoA Counts:%d\n", *(pos - 13)); -+ RTW_PRINT_SEL(sel, "NoA Duration(TU):%d\n", (RTW_GET_LE32(pos - 12))/TU); -+ RTW_PRINT_SEL(sel, "NoA Interval(TU):%d\n", (RTW_GET_LE32(pos - 8))/TU); -+ RTW_PRINT_SEL(sel, "NoA Start time(microseconds):0x%02x\n", RTW_GET_LE32(pos - 4)); -+ RTW_PRINT_SEL(sel, "End to dump NoA Content\n"); -+} -+ -+static void mcc_dump_dbg_reg(void *sel, _adapter *adapter) -+{ -+ struct mcc_obj_priv *mccobjpriv = adapter_to_mccobjpriv(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 i,j; -+ _irqL irqL; -+ -+ _enter_critical_bh(&mccobjpriv->mcc_lock, &irqL); -+ RTW_PRINT_SEL(sel, "current order=%d\n", mccobjpriv->current_order); -+ _exit_critical_bh(&mccobjpriv->mcc_lock, &irqL); -+ -+ _enter_critical_mutex(&mccobjpriv->mcc_dbg_reg_mutex, NULL); -+ for (i = 0; i < ARRAY_SIZE(mccobjpriv->dbg_reg); i++) -+ RTW_PRINT_SEL(sel, "REG_0x%X:0x%08x\n", mccobjpriv->dbg_reg[i], mccobjpriv->dbg_reg_val[i]); -+ -+ for (i = 0; i < ARRAY_SIZE(mccobjpriv->dbg_rf_reg); i++) { -+ for (j = 0; j < hal_spec->rf_reg_path_num; j++) -+ RTW_PRINT_SEL(sel, "RF_PATH_%d_REG_0x%X:0x%08x\n", -+ j, mccobjpriv->dbg_rf_reg[i], mccobjpriv->dbg_rf_reg_val[i][j]); -+ } -+ _exit_critical_mutex(&mccobjpriv->mcc_dbg_reg_mutex, NULL); -+} -+ -+ -+void rtw_hal_dump_mcc_info(void *sel, struct dvobj_priv *dvobj) -+{ -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ struct mcc_adapter_priv *mccadapriv = NULL; -+ _adapter *iface = NULL, *pri_adapter = NULL; -+ struct registry_priv *regpriv = NULL; -+ HAL_DATA_TYPE *hal = NULL; -+ u8 i = 0, j = 0; -+ u64 tsf[MAX_MCC_NUM] = {0}; -+ -+ /* regpriv is common for all adapter */ -+ pri_adapter = dvobj_get_primary_adapter(dvobj); -+ hal = GET_HAL_DATA(pri_adapter); -+ -+ RTW_PRINT_SEL(sel, "**********************************************\n"); -+ RTW_PRINT_SEL(sel, "en_mcc:%d\n", MCC_EN(pri_adapter)); -+ RTW_PRINT_SEL(sel, "primary adapter("ADPT_FMT") duration:%d%c\n", -+ ADPT_ARG(dvobj_get_primary_adapter(dvobj)), mccobjpriv->duration, 37); -+ RTW_PRINT_SEL(sel, "runtime duration:%s\n", mccobjpriv->enable_runtime_duration ? "enable":"disable"); -+ RTW_PRINT_SEL(sel, "phydm offload:%s\n", mccobjpriv->mcc_phydm_offload ? "enable":"disable"); -+ -+ if (rtw_hal_check_mcc_status(pri_adapter, MCC_STATUS_DOING_MCC)) { -+ rtw_hal_mcc_rqt_tsf(pri_adapter, tsf); -+ -+ for (i = 0; i < MAX_MCC_NUM; i++) { -+ iface = mccobjpriv->iface[i]; -+ if (!iface) -+ continue; -+ -+ regpriv = &iface->registrypriv; -+ mccadapriv = &iface->mcc_adapterpriv; -+ -+ if (mccadapriv) { -+ u8 p2p_ps_mode = iface->wdinfo.p2p_ps_mode; -+ -+ 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", mccadapriv->order); -+ RTW_PRINT_SEL(sel, "duration:%d\n", mccadapriv->mcc_duration); -+ RTW_PRINT_SEL(sel, "target tx bytes:%d\n", mccadapriv->mcc_target_tx_bytes_to_port); -+ RTW_PRINT_SEL(sel, "current TP:%d\n", mccadapriv->mcc_tp); -+ RTW_PRINT_SEL(sel, "mgmt queue macid:%d\n", mccadapriv->mgmt_queue_macid); -+ RTW_PRINT_SEL(sel, "macid bitmap:0x%02x\n", mccadapriv->mcc_macid_bitmap); -+ RTW_PRINT_SEL(sel, "P2P NoA:%s\n\n", p2p_ps_mode == P2P_PS_NOA ? "enable":"disable"); -+ RTW_PRINT_SEL(sel, "registry data:\n"); -+ 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, "HW TSF=0x%llx\n", tsf[mccadapriv->order]); -+ if (MLME_IS_GO(iface)) -+ rtw_hal_mcc_dump_noa_content(sel, iface); -+ RTW_PRINT_SEL(sel, "**********************************************\n"); -+ } -+ } -+ -+ mcc_dump_dbg_reg(sel, pri_adapter); -+ } -+ -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ RTW_PRINT_SEL(sel, "@@@@@@@@@@@@@@@@@@@@\n"); -+ rtw_hal_mcc_cfg_phydm(pri_adapter, MCC_CFG_PHYDM_DUMP, sel); -+ RTW_PRINT_SEL(sel, "@@@@@@@@@@@@@@@@@@@@\n"); -+ #endif -+ -+ RTW_PRINT_SEL(sel, "------------------------------------------\n"); -+ RTW_PRINT_SEL(sel, "policy index:%d\n", mccobjpriv->policy_index); -+ 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; -+ systime start = rtw_get_current_time(); -+ u8 i = 0; -+ -+ if (!MCC_EN(padapter)) -+ return; -+ -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) -+ return; -+ -+ if (chbw_allow == _TRUE) -+ return; -+ -+ 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; -+ struct mlme_ext_info *mlmeextinfo = &mlmeext->mlmext_info; -+ u8 ch = mlmeext->cur_channel; -+ u8 bw = mlmeext->cur_bwmode; -+ u8 offset = mlmeext->cur_ch_offset; -+ struct sta_info *sta = rtw_get_stainfo(&iface->stapriv, get_my_bssid(&(mlmeextinfo->network))); -+ -+ if (!sta) -+ continue; -+ -+ set_channel_bwmode(iface, ch, offset, bw); -+ -+ if (ps_mode) -+ rtw_hal_macid_sleep(iface, sta->cmn.mac_id); -+ else -+ rtw_hal_macid_wakeup(iface, sta->cmn.mac_id); -+ -+ issue_nulldata(iface, NULL, ps_mode, 3, 50); -+ } -+ } -+ RTW_INFO("%s(%d ms)\n", __func__, rtw_get_passing_time_ms(start)); -+} -+ -+u8 *rtw_hal_mcc_append_go_p2p_ie(PADAPTER padapter, u8 *pframe, u32 *len) -+{ -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ -+ if (!MCC_EN(padapter)) -+ return pframe; -+ -+ if (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) -+ return pframe; -+ -+ if (pmccadapriv->p2p_go_noa_ie_len == 0) -+ return pframe; -+ -+ _rtw_memcpy(pframe, pmccadapriv->p2p_go_noa_ie, pmccadapriv->p2p_go_noa_ie_len); -+ *len = *len + pmccadapriv->p2p_go_noa_ie_len; -+ -+ return pframe + pmccadapriv->p2p_go_noa_ie_len; -+} -+ -+void rtw_hal_dump_mcc_policy_table(void *sel) -+{ -+ u8 idx = 0; -+ RTW_PRINT_SEL(sel, "duration\t,tsf sync offset\t,start time offset\t,interval\t,guard offset0\t,guard offset1\n"); -+ -+ for (idx = 0; idx < mcc_max_policy_num; idx ++) { -+ RTW_PRINT_SEL(sel, "%d\t\t,%d\t\t\t,%d\t\t\t,%d\t\t,%d\t\t,%d\n" -+ , mcc_switch_channel_policy_table[idx][MCC_DURATION_IDX] -+ , mcc_switch_channel_policy_table[idx][MCC_TSF_SYNC_OFFSET_IDX] -+ , mcc_switch_channel_policy_table[idx][MCC_START_TIME_OFFSET_IDX] -+ , mcc_switch_channel_policy_table[idx][MCC_INTERVAL_IDX] -+ , mcc_switch_channel_policy_table[idx][MCC_GUARD_OFFSET0_IDX] -+ , mcc_switch_channel_policy_table[idx][MCC_GUARD_OFFSET1_IDX]); -+ } -+} -+ -+void rtw_hal_mcc_update_macid_bitmap(PADAPTER padapter, int mac_id, u8 add) -+{ -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ -+ if (!MCC_EN(padapter)) -+ return; -+ -+ if (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) -+ return; -+ -+ if (pmccadapriv->role == MCC_ROLE_GC || pmccadapriv->role == MCC_ROLE_STA) -+ return; -+ -+ if (mac_id < 0) { -+ RTW_WARN("%s: mac_id < 0(%d)\n", __func__, mac_id); -+ return; -+ } -+ -+ RTW_INFO(ADPT_FMT" %s macid=%d, ori mcc_macid_bitmap=0x%08x\n" -+ , ADPT_ARG(padapter), add ? "add" : "clear" -+ , mac_id, pmccadapriv->mcc_macid_bitmap); -+ -+ if (add) { -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_ADD_CLIENT, &mac_id); -+ #endif -+ pmccadapriv->mcc_macid_bitmap |= BIT(mac_id); -+ } else { -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_REMOVE_CLIENT, &mac_id); -+ #endif -+ pmccadapriv->mcc_macid_bitmap &= ~(BIT(mac_id)); -+ } -+ rtw_hal_set_mcc_macid_cmd(padapter); -+} -+ -+void rtw_hal_mcc_process_noa(PADAPTER padapter) -+{ -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ -+ if (!MCC_EN(padapter)) -+ return; -+ -+ if (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) -+ return; -+ -+ if (!MLME_IS_GC(padapter)) -+ return; -+ -+ switch(pwdinfo->p2p_ps_mode) { -+ case P2P_PS_NONE: -+ RTW_INFO("[MCC] Disable NoA under MCC\n"); -+ rtw_hal_mcc_update_parameter(padapter, _TRUE); -+ break; -+ case P2P_PS_NOA: -+ RTW_INFO("[MCC] Enable NoA under MCC\n"); -+ break; -+ default: -+ break; -+ -+ } -+} -+ -+void rtw_hal_mcc_parameter_init(PADAPTER padapter) -+{ -+ if (!padapter->registrypriv.en_mcc) -+ return; -+ -+ if (is_primary_adapter(padapter)) { -+ SET_MCC_EN_FLAG(padapter, padapter->registrypriv.en_mcc); -+ SET_MCC_DURATION(padapter, padapter->registrypriv.rtw_mcc_duration); -+ SET_MCC_RUNTIME_DURATION(padapter, padapter->registrypriv.rtw_mcc_enable_runtime_duration); -+ SET_MCC_PHYDM_OFFLOAD(padapter, padapter->registrypriv.rtw_mcc_phydm_offload); -+ } -+} -+ -+ -+static u8 set_mcc_duration_hdl(PADAPTER adapter, const u8 *val) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); -+ _adapter *iface = NULL; -+ u8 duration = 50; -+ u8 ret = _SUCCESS, noa_enable = _FALSE, i = 0; -+ enum mcc_duration_setting type; -+ -+ if (!mccobjpriv->enable_runtime_duration) -+ goto exit; -+ -+#ifdef CONFIG_P2P_PS -+ /* check noa enable or not */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface->wdinfo.p2p_ps_mode == P2P_PS_NOA) { -+ noa_enable = _TRUE; -+ break; -+ } -+ } -+#endif /* CONFIG_P2P_PS */ -+ -+ type = val[0]; -+ duration = val[1]; -+ -+ if (type == MCC_DURATION_MAPPING) { -+ switch (duration) { -+ /* 0 = fair scheduling */ -+ case 0: -+ mccobjpriv->duration= 40; -+ mccobjpriv->policy_index = 2; -+ mccobjpriv->mchan_sched_mode = MCC_FAIR_SCHEDULE; -+ break; -+ /* 1 = favor STA */ -+ case 1: -+ mccobjpriv->duration= 70; -+ mccobjpriv->policy_index = 1; -+ mccobjpriv->mchan_sched_mode = MCC_FAVOR_STA; -+ break; -+ /* 2 = favor P2P*/ -+ case 2: -+ default: -+ mccobjpriv->duration= 30; -+ mccobjpriv->policy_index = 0; -+ mccobjpriv->mchan_sched_mode = MCC_FAVOR_P2P; -+ break; -+ } -+ } else { -+ mccobjpriv->duration = duration; -+ rtw_hal_mcc_update_policy_table(adapter); -+ } -+ -+ /* only update sw parameter under MCC -+ it will be force update during */ -+ if (noa_enable) -+ goto exit; -+ -+ if (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) -+ rtw_hal_mcc_update_parameter(adapter, _TRUE); -+exit: -+ return ret; -+} -+ -+u8 rtw_set_mcc_duration_cmd(_adapter *adapter, u8 type, u8 val) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 *buf = NULL; -+ u8 sz = 2; -+ u8 res = _SUCCESS; -+ -+ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == 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 *)cmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ buf = rtw_zmalloc(sizeof(u8) * sz); -+ if (buf == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = MCC_CMD_WK_CID; -+ pdrvextra_cmd_parm->type = MCC_SET_DURATION_WK_CID; -+ pdrvextra_cmd_parm->size = sz; -+ pdrvextra_cmd_parm->pbuf = buf; -+ -+ _rtw_memcpy(buf, &type, 1); -+ _rtw_memcpy(buf + 1, &val, 1); -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, CMD_SET_DRV_EXTRA); -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ -+exit: -+ return res; -+} -+ -+#ifdef CONFIG_MCC_PHYDM_OFFLOAD -+static u8 mcc_phydm_offload_enable_hdl(_adapter *adapter, const u8 *val) -+{ -+ struct mcc_obj_priv *mccobjpriv = adapter_to_mccobjpriv(adapter); -+ u8 ret = _SUCCESS; -+ u8 enable = *val; -+ -+ /*only modify driver parameter during non-mcc status */ -+ if (!rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { -+ mccobjpriv->mcc_phydm_offload = enable; -+ } else { -+ /*modify both driver & phydm parameter during mcc status */ -+ mccobjpriv->mcc_phydm_offload = enable; -+ rtw_hal_mcc_cfg_phydm(adapter, MCC_CFG_PHYDM_OFFLOAD, &mccobjpriv->mcc_phydm_offload); -+ } -+ -+ RTW_INFO("[MCC] phydm offload enable hdl(%d)\n", mccobjpriv->mcc_phydm_offload); -+ -+ return ret; -+} -+ -+u8 rtw_set_mcc_phydm_offload_enable_cmd(_adapter *adapter, u8 enable, u8 enqueue) -+{ -+ u8 res = _SUCCESS; -+ -+ if (enqueue) { -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 *mcc_phydm_offload_enable = NULL; -+ -+ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == 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 *)cmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ mcc_phydm_offload_enable = rtw_zmalloc(sizeof(u8)); -+ if (mcc_phydm_offload_enable == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = MCC_CMD_WK_CID; -+ pdrvextra_cmd_parm->type = MCC_SET_PHYDM_OFFLOAD_WK_CID; -+ pdrvextra_cmd_parm->size = 1; -+ pdrvextra_cmd_parm->pbuf = mcc_phydm_offload_enable; -+ -+ _rtw_memcpy(mcc_phydm_offload_enable, &enable, 1); -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, CMD_SET_DRV_EXTRA); -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ } else { -+ mcc_phydm_offload_enable_hdl(adapter, &enable); -+ } -+ -+exit: -+ return res; -+} -+#endif -+ -+u8 rtw_mcc_cmd_hdl(_adapter *adapter, u8 type, const u8 *val) -+{ -+ struct mcc_obj_priv *mccobjpriv = adapter_to_mccobjpriv(adapter); -+ u8 ret = _SUCCESS; -+ -+ switch (type) { -+ case MCC_SET_DURATION_WK_CID: -+ set_mcc_duration_hdl(adapter, val); -+ break; -+ case MCC_GET_DBG_REG_WK_CID: -+ mcc_get_reg_hdl(adapter, val); -+ break; -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ case MCC_SET_PHYDM_OFFLOAD_WK_CID: -+ mcc_phydm_offload_enable_hdl(adapter, val); -+ break; -+ #endif -+ default: -+ RTW_ERR("[MCC] rtw_mcc_cmd_hdl fail(%d)\n", type); -+ break; -+ } -+ -+ -+ -+ return ret; -+} -+ -+#endif /* CONFIG_MCC_MODE */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_mp.c b/drivers/net/wireless/rtl8821cs/hal/hal_mp.c -new file mode 100755 -index 000000000..3a98afecd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_mp.c -@@ -0,0 +1,2703 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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_RTL8710B -+ #include -+ #endif -+ #ifdef CONFIG_RTL8188F -+ #include -+ #endif -+ #ifdef CONFIG_RTL8188GTV -+ #include -+ #endif -+ #ifdef CONFIG_RTL8192F -+ #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) -+{ -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ u8 ChannelToSw = pMptCtx->MptChannelToSw; -+ u32 ulRateIdx = pMptCtx->mpt_rate_index; -+ u32 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 = (u8)phy_query_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); -+ pMptCtx->backup0x52_RF_B = (u8)phy_query_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0); -+ -+ if ((PlatformEFIORead4Byte(pAdapter, 0xF4) & BIT29) == BIT29) { -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, 0xB); -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0, 0xB); -+ } else { -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, 0xD); -+ phy_set_rf_reg(pAdapter, 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_set_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ -+ } else { -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ -+ } -+ } else if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_A); -+ phy_set_rf_reg(pAdapter, 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); -+ struct dm_struct *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->rf_calibrate_info.txpowertrack_control = _TRUE; -+ else -+ pDM_Odm->rf_calibrate_info.txpowertrack_control = _FALSE; -+ -+ return _SUCCESS; -+} -+ -+void hal_mpt_GetPowerTracking(PADAPTER padapter, u8 *enable) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_struct *pDM_Odm = &(pHalData->odmpriv); -+ -+ -+ *enable = pDM_Odm->rf_calibrate_info.txpowertrack_control; -+} -+ -+ -+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.mpt_ctx); -+ u8 u1Channel = pHalData->current_channel; -+ u32 ulRateIdx = pMptCtx->mpt_rate_index; -+ u8 DataRate = 0xFF; -+ -+ /* 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) || IS_HARDWARE_TYPE_8192F(Adapter) || IS_HARDWARE_TYPE_8822C(Adapter)) -+ return; -+ -+ DataRate = mpt_to_mgnt_rate(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_set_bb_reg(Adapter, rCCK0_TxFilter2, bMaskHWord, 0); -+ phy_set_bb_reg(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_set_bb_reg(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_set_bb_reg(Adapter, rCCK0_TxFilter2, bMaskDWord, 0x0000B81C); -+ phy_set_bb_reg(Adapter, rCCK0_DebugPort, bMaskDWord, 0x00000000); -+ phy_set_bb_reg(Adapter, 0xAAC, bMaskDWord, 0x00003667); -+ } else { -+ for (i = 0 ; i < 3 ; ++i) { -+ phy_set_bb_reg(Adapter, -+ pHalData->RegForRecover[i].offset, -+ bMaskDWord, -+ pHalData->RegForRecover[i].value); -+ } -+ } -+ } else if (IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8188GTV(Adapter)) { -+ /* get current cck swing value and check 0xa22 & 0xa23 later to match the table.*/ -+ CurrCCKSwingVal = read_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord); -+ CCKSwingIndex = 20; /* default index */ -+ -+ 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_88F; i++) { -+ if (((CurrCCKSwingVal & 0xff) == (u32)cck_swing_table_ch1_ch13_88f[i][0]) && -+ (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)cck_swing_table_ch1_ch13_88f[i][1])) { -+ CCKSwingIndex = i; -+ break; -+ } -+ } -+ write_bbreg(Adapter, 0xa22, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][0]); -+ write_bbreg(Adapter, 0xa23, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][1]); -+ write_bbreg(Adapter, 0xa24, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][2]); -+ write_bbreg(Adapter, 0xa25, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][3]); -+ write_bbreg(Adapter, 0xa26, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][4]); -+ write_bbreg(Adapter, 0xa27, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][5]); -+ write_bbreg(Adapter, 0xa28, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][6]); -+ write_bbreg(Adapter, 0xa29, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][7]); -+ write_bbreg(Adapter, 0xa9a, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][8]); -+ write_bbreg(Adapter, 0xa9b, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][9]); -+ write_bbreg(Adapter, 0xa9c, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][10]); -+ write_bbreg(Adapter, 0xa9d, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][11]); -+ write_bbreg(Adapter, 0xaa0, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][12]); -+ write_bbreg(Adapter, 0xaa1, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][13]); -+ write_bbreg(Adapter, 0xaa2, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][14]); -+ write_bbreg(Adapter, 0xaa3, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][15]); -+ RTW_INFO("%s , cck_swing_table_ch1_ch13_88f[%d]\n", __func__, CCKSwingIndex); -+ } else { -+ for (i = 0; i < CCK_TABLE_SIZE_88F; i++) { -+ if (((CurrCCKSwingVal & 0xff) == (u32)cck_swing_table_ch14_88f[i][0]) && -+ (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)cck_swing_table_ch14_88f[i][1])) { -+ CCKSwingIndex = i; -+ break; -+ } -+ } -+ write_bbreg(Adapter, 0xa22, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][0]); -+ write_bbreg(Adapter, 0xa23, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][1]); -+ write_bbreg(Adapter, 0xa24, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][2]); -+ write_bbreg(Adapter, 0xa25, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][3]); -+ write_bbreg(Adapter, 0xa26, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][4]); -+ write_bbreg(Adapter, 0xa27, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][5]); -+ write_bbreg(Adapter, 0xa28, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][6]); -+ write_bbreg(Adapter, 0xa29, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][7]); -+ write_bbreg(Adapter, 0xa9a, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][8]); -+ write_bbreg(Adapter, 0xa9b, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][9]); -+ write_bbreg(Adapter, 0xa9c, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][10]); -+ write_bbreg(Adapter, 0xa9d, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][11]); -+ write_bbreg(Adapter, 0xaa0, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][12]); -+ write_bbreg(Adapter, 0xaa1, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][13]); -+ write_bbreg(Adapter, 0xaa2, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][14]); -+ write_bbreg(Adapter, 0xaa3, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][15]); -+ RTW_INFO("%s , cck_swing_table_ch14_88f[%d]\n", __func__, CCKSwingIndex); -+ } -+ } 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)cck_swing_table_ch1_ch13[i][0]) && -+ (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)cck_swing_table_ch1_ch13[i][1])) { -+ CCKSwingIndex = i; -+ break; -+ } -+ } -+ -+ /*Write 0xa22 0xa23*/ -+ TempVal = cck_swing_table_ch1_ch13[CCKSwingIndex][0] + -+ (cck_swing_table_ch1_ch13[CCKSwingIndex][1] << 8); -+ -+ -+ /*Write 0xa24 ~ 0xa27*/ -+ TempVal2 = 0; -+ TempVal2 = cck_swing_table_ch1_ch13[CCKSwingIndex][2] + -+ (cck_swing_table_ch1_ch13[CCKSwingIndex][3] << 8) + -+ (cck_swing_table_ch1_ch13[CCKSwingIndex][4] << 16) + -+ (cck_swing_table_ch1_ch13[CCKSwingIndex][5] << 24); -+ -+ /*Write 0xa28 0xa29*/ -+ TempVal3 = 0; -+ TempVal3 = cck_swing_table_ch1_ch13[CCKSwingIndex][6] + -+ (cck_swing_table_ch1_ch13[CCKSwingIndex][7] << 8); -+ } else { -+ for (i = 0; i < CCK_TABLE_SIZE; i++) { -+ if (((CurrCCKSwingVal & 0xff) == (u32)cck_swing_table_ch14[i][0]) && -+ (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)cck_swing_table_ch14[i][1])) { -+ CCKSwingIndex = i; -+ break; -+ } -+ } -+ -+ /*Write 0xa22 0xa23*/ -+ TempVal = cck_swing_table_ch14[CCKSwingIndex][0] + -+ (cck_swing_table_ch14[CCKSwingIndex][1] << 8); -+ -+ /*Write 0xa24 ~ 0xa27*/ -+ TempVal2 = 0; -+ TempVal2 = cck_swing_table_ch14[CCKSwingIndex][2] + -+ (cck_swing_table_ch14[CCKSwingIndex][3] << 8) + -+ (cck_swing_table_ch14[CCKSwingIndex][4] << 16) + -+ (cck_swing_table_ch14[CCKSwingIndex][5] << 24); -+ -+ /*Write 0xa28 0xa29*/ -+ TempVal3 = 0; -+ TempVal3 = cck_swing_table_ch14[CCKSwingIndex][6] + -+ (cck_swing_table_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) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ u8 channel = pmp->channel; -+ u8 bandwidth = pmp->bandwidth; -+ -+ hal_mpt_SwitchRfSetting(pAdapter); -+ -+ pHalData->bSwChnl = _TRUE; -+ pHalData->bSetChnlBW = _TRUE; -+ -+ if (bandwidth == 2) { -+ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, HAL_PRIME_CHNL_OFFSET_LOWER, HAL_PRIME_CHNL_OFFSET_UPPER); -+ } else if (bandwidth == 1) { -+ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, HAL_PRIME_CHNL_OFFSET_UPPER, 0); -+ } else -+ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, pmp->prime_channel_offset, 0); -+ -+ hal_mpt_CCKTxPowerAdjust(pAdapter, pHalData->bCCKinCH14); -+ rtw_btcoex_wifionly_scan_notify(pAdapter); -+ -+} -+ -+/* -+ * 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; -+ -+ if (bandwidth == 2) { -+ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, HAL_PRIME_CHNL_OFFSET_LOWER, HAL_PRIME_CHNL_OFFSET_UPPER); -+ } else if (bandwidth == 1) { -+ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, HAL_PRIME_CHNL_OFFSET_UPPER, 0); -+ } else -+ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, pmp->prime_channel_offset, 0); -+ -+ hal_mpt_SwitchRfSetting(pAdapter); -+ rtw_btcoex_wifionly_scan_notify(pAdapter); -+ -+} -+ -+void mpt_SetTxPower_Old(PADAPTER pAdapter, MPT_TXPWR_DEF Rate, u8 *pTxPower) -+{ -+ switch (Rate) { -+ case MPT_CCK: { -+ u32 TxAGC = 0, pwr = 0; -+ -+ pwr = pTxPower[RF_PATH_A]; -+ if (pwr < 0x3f) { -+ TxAGC = (pwr << 16) | (pwr << 8) | (pwr); -+ phy_set_bb_reg(pAdapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pTxPower[RF_PATH_A]); -+ phy_set_bb_reg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, TxAGC); -+ } -+ pwr = pTxPower[RF_PATH_B]; -+ if (pwr < 0x3f) { -+ TxAGC = (pwr << 16) | (pwr << 8) | (pwr); -+ phy_set_bb_reg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte0, pTxPower[RF_PATH_B]); -+ phy_set_bb_reg(pAdapter, rTxAGC_B_CCK1_55_Mcs32, 0xffffff00, TxAGC); -+ } -+ } -+ break; -+ -+ case MPT_OFDM_AND_HT: { -+ u32 TxAGC = 0; -+ u8 pwr = 0; -+ -+ 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_set_bb_reg(pAdapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); -+ phy_set_bb_reg(pAdapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); -+ phy_set_bb_reg(pAdapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ phy_set_bb_reg(pAdapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ phy_set_bb_reg(pAdapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ phy_set_bb_reg(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_set_bb_reg(pAdapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); -+ phy_set_bb_reg(pAdapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); -+ phy_set_bb_reg(pAdapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ phy_set_bb_reg(pAdapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ phy_set_bb_reg(pAdapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ phy_set_bb_reg(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, -+ u8 *pTxPower -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ u8 path = 0 , i = 0, MaxRate = MGN_6M; -+ u8 StartPath = RF_PATH_A, EndPath = RF_PATH_B; -+ u8 tx_nss = 2; -+ -+ if (IS_HARDWARE_TYPE_8814A(pAdapter) || IS_HARDWARE_TYPE_8814B(pAdapter)) { -+ EndPath = RF_PATH_D; -+ tx_nss = 4; -+ } else if (IS_HARDWARE_TYPE_8188F(pAdapter) || IS_HARDWARE_TYPE_8188GTV(pAdapter) -+ || IS_HARDWARE_TYPE_8723D(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter) || IS_HARDWARE_TYPE_8723F(pAdapter)) { -+ EndPath = RF_PATH_A; -+ tx_nss = 1; -+ } -+ -+ switch (Rate) { -+ case MPT_CCK: { -+ u8 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: { -+ u8 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: { -+ u8 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 (tx_nss == 4) -+ MaxRate = MGN_MCS31; -+ else if (tx_nss == 3) -+ MaxRate = MGN_MCS23; -+ else if (tx_nss == 2) -+ 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: { -+ u8 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 (tx_nss == 4) -+ MaxRate = MGN_VHT4SS_MCS9; -+ else if (tx_nss == 3) -+ MaxRate = MGN_VHT3SS_MCS9; -+ else if (tx_nss == 2) -+ 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.mpt_ctx); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ -+ if (pHalData->rf_chip < RF_CHIP_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) || -+ IS_HARDWARE_TYPE_8188GTV(pAdapter) -+ ) { -+ -+ 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 { -+ -+ mpt_SetTxPower(pAdapter, MPT_CCK, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower(pAdapter, MPT_OFDM, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower(pAdapter, MPT_HT, pMptCtx->TxPwrLevel); -+ if(IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) { -+ RTW_INFO("===> MPT_ProSetTxPower: Jaguar/Jaguar2\n"); -+ mpt_SetTxPower(pAdapter, MPT_VHT, pMptCtx->TxPwrLevel); -+ } -+ } -+ -+ rtw_hal_set_txpwr_done(pAdapter); -+ } else -+ RTW_INFO("RFChipID < RF_CHIP_MAX, the RF chip is not supported - %d\n", pHalData->rf_chip); -+ -+ odm_clear_txpowertracking_state(pDM_Odm); -+} -+ -+void hal_mpt_SetDataRate(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ u32 DataRate; -+ -+ DataRate = mpt_to_mgnt_rate(pMptCtx->mpt_rate_index); -+ -+ hal_mpt_SwitchRfSetting(pAdapter); -+ -+ hal_mpt_CCKTxPowerAdjust(pAdapter, pHalData->bCCKinCH14); -+#ifdef CONFIG_RTL8723B -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+ if (IS_CCK_RATE(DataRate)) { -+ if (pMptCtx->mpt_rf_path == RF_PATH_A) -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, 0xF, 0x6); -+ else -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x71, 0xF, 0x6); -+ } else { -+ if (pMptCtx->mpt_rf_path == RF_PATH_A) -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, 0xF, 0xE); -+ else -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x71, 0xF, 0xE); -+ } -+ } -+ -+ if ((IS_HARDWARE_TYPE_8723BS(pAdapter) && -+ ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)))) { -+ if (pMptCtx->mpt_rf_path == RF_PATH_A) -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, 0xF, 0xE); -+ else -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x71, 0xF, 0xE); -+ } -+#endif -+} -+ -+u32 hal_mpt_tssi_turn_target_power(PADAPTER padapter, s16 power_offset, u8 path) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_struct *pdm = &pHalData->odmpriv; -+ u32 pout = 0; -+ -+#ifdef CONFIG_RTL8723F -+ pout = halrf_tssi_turn_target_power(pdm, power_offset, path); -+#endif -+ RTW_INFO("%s()===> pout %d\n", __func__, pout); -+ -+ return pout; -+} -+ -+void hal_mpt_tssi_set_power_offset(PADAPTER padapter, s16 power_offset, u8 path) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_struct *pdm = &pHalData->odmpriv; -+ -+#ifdef CONFIG_RTL8723F -+ halrf_tssi_set_power_offset(pdm, power_offset, path); -+#endif -+ RTW_INFO("%s()===> path%d = %d\n", __func__, path, power_offset); -+ -+ return; -+} -+ -+#define RF_PATH_AB 22 -+ -+#ifdef CONFIG_RTL8814A -+void mpt_ToggleIG_8814A(PADAPTER pAdapter) -+{ -+ u8 Path; -+ u32 IGReg = rA_IGI_Jaguar, IGvalue = 0; -+ -+ for (Path = 0; Path <= RF_PATH_D; Path++) { -+ switch (Path) { -+ case RF_PATH_B: -+ IGReg = rB_IGI_Jaguar; -+ break; -+ case RF_PATH_C: -+ IGReg = rC_IGI_Jaguar2; -+ break; -+ case RF_PATH_D: -+ IGReg = rD_IGI_Jaguar2; -+ break; -+ default: -+ IGReg = rA_IGI_Jaguar; -+ break; -+ } -+ -+ IGvalue = phy_query_bb_reg(pAdapter, IGReg, bMaskByte0); -+ phy_set_bb_reg(pAdapter, IGReg, bMaskByte0, IGvalue + 2); -+ phy_set_bb_reg(pAdapter, IGReg, bMaskByte0, IGvalue); -+ } -+} -+ -+void mpt_SetRFPath_8814A(PADAPTER pAdapter) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.mpt_ctx; -+ R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ -+ R_ANTENNA_SELECT_CCK *p_cck_txrx; -+ u8 ForcedDataRate = mpt_to_mgnt_rate(pMptCtx->mpt_rate_index); -+ /*/PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pMgntInfo);*/ -+ /*/PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pMgntInfo);*/ -+ -+ u32 ulAntennaTx = pHalData->antenna_tx_path; -+ u32 ulAntennaRx = pHalData->AntennaRxPath; -+ u8 NssforRate = MgntQuery_NssTxRate(ForcedDataRate); -+ -+ if (NssforRate == RF_3TX) { -+ RTW_INFO("===> SetAntenna 3T Rate ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_BCD: -+ pMptCtx->mpt_rf_path = RF_PATH_BCD; -+ /*pHalData->ValidTxPath = 0x0e;*/ -+ phy_set_bb_reg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x90e); /*/ 0x940[27:16]=12'b0010_0100_0111*/ -+ break; -+ -+ case ANTENNA_ABC: -+ default: -+ pMptCtx->mpt_rf_path = RF_PATH_ABC; -+ /*pHalData->ValidTxPath = 0x0d;*/ -+ phy_set_bb_reg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x247); /*/ 0x940[27:16]=12'b0010_0100_0111*/ -+ break; -+ } -+ -+ } else { /*/if(NssforRate == RF_1TX)*/ -+ RTW_INFO("===> SetAntenna for 1T/2T Rate, ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); -+ switch (ulAntennaTx) { -+ case ANTENNA_BCD: -+ pMptCtx->mpt_rf_path = RF_PATH_BCD; -+ /*pHalData->ValidTxPath = 0x0e;*/ -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x7); -+ phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0xe); -+ phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0xe); -+ break; -+ -+ case ANTENNA_BC: -+ pMptCtx->mpt_rf_path = RF_PATH_BC; -+ /*pHalData->ValidTxPath = 0x06;*/ -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x6); -+ phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0x6); -+ phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0x6); -+ break; -+ case ANTENNA_B: -+ pMptCtx->mpt_rf_path = RF_PATH_B; -+ /*pHalData->ValidTxPath = 0x02;*/ -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x4); /*/ 0xa07[7:4] = 4'b0100*/ -+ phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x002); /*/ 0x93C[31:20]=12'b0000_0000_0010*/ -+ phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0x2); /* 0x80C[7:4] = 4'b0010*/ -+ break; -+ -+ case ANTENNA_C: -+ pMptCtx->mpt_rf_path = RF_PATH_C; -+ /*pHalData->ValidTxPath = 0x04;*/ -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x2); /*/ 0xa07[7:4] = 4'b0010*/ -+ phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x004); /*/ 0x93C[31:20]=12'b0000_0000_0100*/ -+ phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0x4); /*/ 0x80C[7:4] = 4'b0100*/ -+ break; -+ -+ case ANTENNA_D: -+ pMptCtx->mpt_rf_path = RF_PATH_D; -+ /*pHalData->ValidTxPath = 0x08;*/ -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x1); /*/ 0xa07[7:4] = 4'b0001*/ -+ phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x008); /*/ 0x93C[31:20]=12'b0000_0000_1000*/ -+ phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0x8); /*/ 0x80C[7:4] = 4'b1000*/ -+ break; -+ -+ case ANTENNA_A: -+ default: -+ pMptCtx->mpt_rf_path = RF_PATH_A; -+ /*pHalData->ValidTxPath = 0x01;*/ -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x8); /*/ 0xa07[7:4] = 4'b1000*/ -+ phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x001); /*/ 0x93C[31:20]=12'b0000_0000_0001*/ -+ phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0x1); /*/ 0x80C[7:4] = 4'b0001*/ -+ break; -+ } -+ } -+ -+ switch (ulAntennaRx) { -+ case ANTENNA_A: -+ /*pHalData->ValidRxPath = 0x01;*/ -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x0); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_B: -+ /*pHalData->ValidRxPath = 0x02;*/ -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x1); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_C: -+ /*pHalData->ValidRxPath = 0x04;*/ -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x44); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x2); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_D: -+ /*pHalData->ValidRxPath = 0x08;*/ -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x88); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x3); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ -+ /*/ CCA related PD_delay_th*/ -+ phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_BC: -+ /*pHalData->ValidRxPath = 0x06;*/ -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x66); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_CD: -+ /*pHalData->ValidRxPath = 0x0C;*/ -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xcc); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0xB); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ -+ /*/ CCA related PD_delay_th*/ -+ phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_BCD: -+ /*pHalData->ValidRxPath = 0x0e;*/ -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xee); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, Rx mode*/ -+ /*/ CCA related PD_delay_th*/ -+ phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); -+ break; -+ -+ case ANTENNA_ABCD: -+ /*pHalData->ValidRxPath = 0x0f;*/ -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xff); -+ phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x1); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ -+ /*/ CCA related PD_delay_th*/ -+ phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); -+ phy_set_bb_reg(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) \ -+ || defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) || defined(CONFIG_RTL8723F) -+void -+mpt_SetSingleTone_8814A( -+ PADAPTER pAdapter, -+ BOOLEAN bSingleTone, -+ BOOLEAN bEnPMacTx) -+{ -+ -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ u8 StartPath = RF_PATH_A, EndPath = RF_PATH_A, path; -+ static u32 regIG0 = 0, regIG1 = 0, regIG2 = 0, regIG3 = 0; -+ -+ if (bSingleTone) { -+ regIG0 = phy_query_bb_reg(pAdapter, rA_TxScale_Jaguar, bMaskDWord); /*/ 0xC1C[31:21]*/ -+ regIG1 = phy_query_bb_reg(pAdapter, rB_TxScale_Jaguar, bMaskDWord); /*/ 0xE1C[31:21]*/ -+ regIG2 = phy_query_bb_reg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord); /*/ 0x181C[31:21]*/ -+ regIG3 = phy_query_bb_reg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord); /*/ 0x1A1C[31:21]*/ -+ -+ switch (pMptCtx->mpt_rf_path) { -+ case RF_PATH_A: -+ case RF_PATH_B: -+ case RF_PATH_C: -+ case RF_PATH_D: -+ StartPath = pMptCtx->mpt_rf_path; -+ EndPath = pMptCtx->mpt_rf_path; -+ break; -+ case RF_PATH_AB: -+ EndPath = RF_PATH_B; -+ break; -+ case RF_PATH_BC: -+ StartPath = RF_PATH_B; -+ EndPath = RF_PATH_C; -+ break; -+ case RF_PATH_ABC: -+ EndPath = RF_PATH_C; -+ break; -+ case RF_PATH_BCD: -+ StartPath = RF_PATH_B; -+ EndPath = RF_PATH_D; -+ break; -+ case RF_PATH_ABCD: -+ EndPath = RF_PATH_D; -+ break; -+ } -+ -+ if (bEnPMacTx == FALSE) { -+ hal_mpt_SetContinuousTx(pAdapter, _TRUE); -+ issue_nulldata(pAdapter, NULL, 1, 3, 500); -+ } -+ -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); /*/ Disable CCA*/ -+ -+ for (path = StartPath; path <= EndPath; path++) { -+ phy_set_rf_reg(pAdapter, path, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ -+ phy_set_rf_reg(pAdapter, path, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ -+ -+ phy_set_rf_reg(pAdapter, path, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ } -+ -+ phy_set_bb_reg(pAdapter, rA_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xC1C[31:21]*/ -+ phy_set_bb_reg(pAdapter, rB_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xE1C[31:21]*/ -+ phy_set_bb_reg(pAdapter, rC_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x181C[31:21]*/ -+ phy_set_bb_reg(pAdapter, rD_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x1A1C[31:21]*/ -+ } else { -+ switch (pMptCtx->mpt_rf_path) { -+ case RF_PATH_A: -+ case RF_PATH_B: -+ case RF_PATH_C: -+ case RF_PATH_D: -+ StartPath = pMptCtx->mpt_rf_path; -+ EndPath = pMptCtx->mpt_rf_path; -+ break; -+ case RF_PATH_AB: -+ EndPath = RF_PATH_B; -+ break; -+ case RF_PATH_BC: -+ StartPath = RF_PATH_B; -+ EndPath = RF_PATH_C; -+ break; -+ case RF_PATH_ABC: -+ EndPath = RF_PATH_C; -+ break; -+ case RF_PATH_BCD: -+ StartPath = RF_PATH_B; -+ EndPath = RF_PATH_D; -+ break; -+ case RF_PATH_ABCD: -+ EndPath = RF_PATH_D; -+ break; -+ } -+ for (path = StartPath; path <= EndPath; path++) -+ phy_set_rf_reg(pAdapter, path, lna_low_gain_3, BIT1, 0x0); /* RF LO disabled */ -+ -+ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); /* Enable CCA*/ -+ -+ if (bEnPMacTx == FALSE) { -+ if (IS_HARDWARE_TYPE_JAGUAR3(pAdapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) { -+#ifdef PHYDM_MP_SUPPORT -+ phydm_stop_ofdm_cont_tx(pAdapter); -+ pMptCtx->bCckContTx = FALSE; -+ pMptCtx->bOfdmContTx = FALSE; -+#endif -+ } else -+ hal_mpt_SetContinuousTx(pAdapter, _FALSE); -+ } -+ -+ phy_set_bb_reg(pAdapter, rA_TxScale_Jaguar, bMaskDWord, regIG0); /* 0xC1C[31:21]*/ -+ phy_set_bb_reg(pAdapter, rB_TxScale_Jaguar, bMaskDWord, regIG1); /* 0xE1C[31:21]*/ -+ phy_set_bb_reg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord, regIG2); /* 0x181C[31:21]*/ -+ phy_set_bb_reg(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.mpt_ctx; -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ u8 channel = pmp->channel; -+ u8 bandwidth = pmp->bandwidth; -+ u8 eLNA_2g = pHalData->ExternalLNA_2G; -+ u32 ulAntennaTx, ulAntennaRx; -+ u32 reg0xC50 = 0; -+ -+ ulAntennaTx = pHalData->antenna_tx_path; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_A: -+ pMptCtx->mpt_rf_path = RF_PATH_A; -+ phy_set_bb_reg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x1111); -+ if (pHalData->rfe_type == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) -+ phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); -+ break; -+ case ANTENNA_B: -+ pMptCtx->mpt_rf_path = RF_PATH_B; -+ phy_set_bb_reg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x2222); -+ if (pHalData->rfe_type == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) -+ phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x1); -+ break; -+ case ANTENNA_AB: -+ pMptCtx->mpt_rf_path = RF_PATH_AB; -+ phy_set_bb_reg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x3333); -+ if (pHalData->rfe_type == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) -+ phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); -+ break; -+ default: -+ pMptCtx->mpt_rf_path = RF_PATH_AB; -+ RTW_INFO("Unknown Tx antenna.\n"); -+ break; -+ } -+ -+ switch (ulAntennaRx) { -+ case ANTENNA_A: -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ phy_set_rf_reg(pAdapter, 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_query_bb_reg(pAdapter, rA_IGI_Jaguar, bMaskByte0); -+ phy_set_bb_reg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50 + 2); -+ phy_set_bb_reg(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_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x02); -+ } else -+ /* 0x830[3:1]=3'b100 */ -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); -+ } else -+ /* 0x830[3:1]=3'b100 for 5G */ -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); -+ } -+ break; -+ case ANTENNA_B: -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1);/*/ RF_A_0x0[19:16] = 1, Standby mode */ -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x1); -+ phy_set_rf_reg(pAdapter, 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_query_bb_reg(pAdapter, rB_IGI_Jaguar, bMaskByte0); -+ phy_set_bb_reg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50 + 2); -+ phy_set_bb_reg(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_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x02); -+ } else -+ /* 0x830[3:1]=3'b100 */ -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); -+ } else -+ /* 0x830[3:1]=3'b100 for 5G */ -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); -+ } -+ break; -+ case ANTENNA_AB: -+ phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x33); -+ phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, Rx mode*/ -+ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ /* set PWED_TH for BB Yn user guide R29 */ -+ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); -+ break; -+ default: -+ RTW_INFO("Unknown Rx antenna.\n"); -+ break; -+ } -+ -+ if (pHalData->rfe_type == 5 || pHalData->rfe_type == 1) { -+ if (ulAntennaTx == ANTENNA_A || ulAntennaTx == ANTENNA_AB) { -+ /* WiFi */ -+ phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, BIT(1) | BIT(0), 0x2); -+ phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, BIT(9) | BIT(8), 0x3); -+ } else { -+ /* BT */ -+ phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, BIT(1) | BIT(0), 0x1); -+ phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, BIT(9) | BIT(8), 0x3); -+ } -+ } -+} -+#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.mpt_ctx); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); -+ u8 i; -+ -+ ulAntennaTx = pHalData->antenna_tx_path; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ if (pHalData->rf_chip >= RF_CHIP_MAX) { -+ RTW_INFO("This RF chip ID is not supported\n"); -+ return; -+ } -+ -+ switch (pAdapter->mppriv.antenna_tx) { -+ case ANTENNA_A: { /*/ Actually path S1 (Wi-Fi)*/ -+ pMptCtx->mpt_rf_path = RF_PATH_A; -+ phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x0); -+ phy_set_bb_reg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ -+ -+ for (i = 0; i < 3; ++i) { -+ u32 offset = pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_A][i][0]; -+ u32 data = pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_A][i][1]; -+ -+ if (offset != 0) { -+ phy_set_bb_reg(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) { -+ u32 offset = pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_A][i][0]; -+ u32 data = pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_A][i][1]; -+ -+ if (offset != 0) { -+ phy_set_bb_reg(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)*/ -+ u32 offset; -+ u32 data; -+ -+ pMptCtx->mpt_rf_path = RF_PATH_B; -+ phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x5); -+ phy_set_bb_reg(pAdapter, 0xB2C, BIT31, 0x1); /*/ AGC Table Sel.*/ -+ -+ for (i = 0; i < 3; ++i) { -+ /*/ <20130603, Kordan> Because BB suppors only 1T1R, we restore IQC to S1 instead of S0.*/ -+ offset = pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_A][i][0]; -+ data = pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_B][i][1]; -+ if (pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_B][i][0] != 0) { -+ phy_set_bb_reg(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->rx_iqc_8723b[RF_PATH_A][i][0]; -+ data = pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_B][i][1]; -+ if (pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_B][i][0] != 0) { -+ phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); -+ RTW_INFO("Switch to S0 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ } -+ break; -+ default: -+ pMptCtx->mpt_rf_path = RF_PATH_AB; -+ break; -+ } -+} -+#endif -+ -+#ifdef CONFIG_RTL8703B -+void mpt_SetRFPath_8703B(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u32 ulAntennaTx, ulAntennaRx; -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); -+ u8 i; -+ -+ ulAntennaTx = pHalData->antenna_tx_path; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ if (pHalData->rf_chip >= RF_CHIP_MAX) { -+ RTW_INFO("This RF chip ID is not supported\n"); -+ return; -+ } -+ -+ switch (pAdapter->mppriv.antenna_tx) { -+ case ANTENNA_A: { /* Actually path S1 (Wi-Fi) */ -+ pMptCtx->mpt_rf_path = RF_PATH_A; -+ phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x0); -+ phy_set_bb_reg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ -+ -+ for (i = 0; i < 3; ++i) { -+ u32 offset = pRFCalibrateInfo->tx_iqc_8703b[i][0]; -+ u32 data = pRFCalibrateInfo->tx_iqc_8703b[i][1]; -+ -+ if (offset != 0) { -+ phy_set_bb_reg(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) { -+ u32 offset = pRFCalibrateInfo->rx_iqc_8703b[i][0]; -+ u32 data = pRFCalibrateInfo->rx_iqc_8703b[i][1]; -+ -+ if (offset != 0) { -+ phy_set_bb_reg(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->mpt_rf_path = RF_PATH_B; -+ phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x5); -+ phy_set_bb_reg(pAdapter, 0xB2C, BIT31, 0x1); /* AGC Table Sel */ -+ -+ for (i = 0; i < 3; ++i) { -+ u32 offset = pRFCalibrateInfo->tx_iqc_8703b[i][0]; -+ u32 data = pRFCalibrateInfo->tx_iqc_8703b[i][1]; -+ -+ if (pRFCalibrateInfo->tx_iqc_8703b[i][0] != 0) { -+ phy_set_bb_reg(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) { -+ u32 offset = pRFCalibrateInfo->rx_iqc_8703b[i][0]; -+ u32 data = pRFCalibrateInfo->rx_iqc_8703b[i][1]; -+ -+ if (pRFCalibrateInfo->rx_iqc_8703b[i][0] != 0) { -+ phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); -+ RTW_INFO("Switch to S0 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ } -+ break; -+ default: -+ pMptCtx->mpt_rf_path = RF_PATH_AB; -+ break; -+ } -+ -+} -+#endif -+ -+#ifdef CONFIG_RTL8723D -+void mpt_SetRFPath_8723D(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 p = 0, i = 0; -+ u32 ulAntennaTx, ulAntennaRx, offset = 0, data = 0, val32 = 0; -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); -+ -+ ulAntennaTx = pHalData->antenna_tx_path; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ if (pHalData->rf_chip >= RF_CHIP_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->mpt_rf_path = RF_PATH_A; -+ phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0); -+ } -+ break; -+ /* Actually path S0 (BT) */ -+ case ANTENNA_B: { -+ pMptCtx->mpt_rf_path = RF_PATH_B; -+ phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0xA); -+ -+ } -+ break; -+ default: -+ pMptCtx->mpt_rf_path = RF_PATH_AB; -+ break; -+ } -+} -+#endif -+ -+void mpt_SetRFPath_819X(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ u32 ulAntennaTx, ulAntennaRx; -+ 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; -+ -+ ulAntennaTx = pHalData->antenna_tx_path; -+ 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_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); -+ phy_set_bb_reg(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_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); -+ phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 1); -+ phy_set_bb_reg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0); -+ phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); -+ phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 0); -+ } -+ } -+ pMptCtx->mpt_rf_path = 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_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 1); -+ phy_set_bb_reg(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_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 1); -+ phy_set_bb_reg(pAdapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0); -+ phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); -+ /*/phy_set_bb_reg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ -+ phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 0); -+ phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); -+ } -+ } -+ pMptCtx->mpt_rf_path = 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_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); -+ phy_set_bb_reg(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_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); -+ -+ phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); -+ /*/phy_set_bb_reg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ -+ phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); -+ phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); -+ } -+ } -+ pMptCtx->mpt_rf_path = 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_set_bb_reg(pAdapter, rFPGA1_TxInfo, 0x7fffffff, r_ant_select_ofdm_val); /*/OFDM Tx*/ -+ phy_set_bb_reg(pAdapter, rFPGA0_TxInfo, 0x0000000f, r_ofdm_tx_en_val); /*/OFDM Tx*/ -+ phy_set_bb_reg(pAdapter, rOFDM0_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ phy_set_bb_reg(pAdapter, rOFDM1_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) { -+ phy_set_bb_reg(pAdapter, rOFDM0_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ phy_set_bb_reg(pAdapter, rOFDM1_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ } -+ phy_set_bb_reg(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 */ -+ -+#ifdef CONFIG_RTL8192F -+ -+void mpt_set_rfpath_8192f(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ -+ u16 ForcedDataRate = mpt_to_mgnt_rate(pMptCtx->mpt_rate_index); -+ u8 NssforRate, odmNssforRate; -+ u32 ulAntennaTx, ulAntennaRx; -+ enum bb_path RxAntToPhyDm; -+ enum bb_path TxAntToPhyDm; -+ -+ ulAntennaTx = pHalData->antenna_tx_path; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ NssforRate = MgntQuery_NssTxRate(ForcedDataRate); -+ -+ if (pHalData->rf_chip >= RF_TYPE_MAX) -+ RTW_INFO("This RF chip ID is not supported\n"); -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_A: -+ pMptCtx->mpt_rf_path = RF_PATH_A; -+ TxAntToPhyDm = BB_PATH_A; -+ break; -+ case ANTENNA_B: -+ pMptCtx->mpt_rf_path = RF_PATH_B; -+ TxAntToPhyDm = BB_PATH_B; -+ break; -+ case ANTENNA_AB: -+ pMptCtx->mpt_rf_path = RF_PATH_AB; -+ TxAntToPhyDm = (BB_PATH_A|BB_PATH_B); -+ break; -+ default: -+ pMptCtx->mpt_rf_path = RF_PATH_AB; -+ TxAntToPhyDm = (BB_PATH_A|BB_PATH_B); -+ break; -+ } -+ -+ switch (ulAntennaRx) { -+ case ANTENNA_A: -+ RxAntToPhyDm = BB_PATH_A; -+ break; -+ case ANTENNA_B: -+ RxAntToPhyDm = BB_PATH_B; -+ break; -+ case ANTENNA_AB: -+ RxAntToPhyDm = (BB_PATH_A|BB_PATH_B); -+ break; -+ default: -+ RxAntToPhyDm = (BB_PATH_A|BB_PATH_B); -+ break; -+ } -+ -+ phydm_api_trx_mode(GET_PDM_ODM(pAdapter), TxAntToPhyDm, RxAntToPhyDm, TxAntToPhyDm); -+ -+} -+ -+#endif -+ -+void hal_mpt_SetAntenna(PADAPTER pAdapter) -+{ -+ PHAL_DATA_TYPE hal; -+ ANTENNA_PATH anttx; -+ enum bb_path bb_tx = 0; -+ -+ -+ hal = GET_HAL_DATA(pAdapter); -+ anttx = hal->antenna_tx_path; -+ -+ switch (anttx) { -+ case ANTENNA_A: -+ bb_tx = BB_PATH_A; -+ break; -+ case ANTENNA_B: -+ bb_tx = BB_PATH_B; -+ break; -+ case ANTENNA_C: -+ bb_tx = BB_PATH_C; -+ break; -+ case ANTENNA_D: -+ bb_tx = BB_PATH_D; -+ break; -+ case ANTENNA_AB: -+ bb_tx = BB_PATH_AB; -+ break; -+ case ANTENNA_AC: -+ bb_tx = BB_PATH_AC; -+ break; -+ case ANTENNA_AD: -+ bb_tx = BB_PATH_AD; -+ break; -+ case ANTENNA_BC: -+ bb_tx = BB_PATH_BC; -+ break; -+ case ANTENNA_BD: -+ bb_tx = BB_PATH_BD; -+ break; -+ case ANTENNA_CD: -+ bb_tx = BB_PATH_CD; -+ break; -+ case ANTENNA_ABC: -+ bb_tx = BB_PATH_ABC; -+ break; -+ case ANTENNA_BCD: -+ bb_tx = BB_PATH_BCD; -+ break; -+ case ANTENNA_ABD: -+ bb_tx = BB_PATH_ABD; -+ break; -+ case ANTENNA_ACD: -+ bb_tx = BB_PATH_ACD; -+ break; -+ case ANTENNA_ABCD: -+ bb_tx = BB_PATH_ABCD; -+ break; -+ default: -+ bb_tx = BB_PATH_A; -+ break; -+ } -+ tx_path_nss_set_full_tx(hal->txpath_nss, hal->txpath_num_nss, bb_tx); -+ RTW_INFO("%s ,ant idx %d, tx path_num_nss = %d\n", __func__, anttx, hal->txpath_num_nss[0]); -+ -+#ifdef CONFIG_RTL8723F -+ if (IS_HARDWARE_TYPE_8723F(pAdapter)) { -+ rtl8723f_mp_config_rfpath(pAdapter); -+ return; -+ } -+#endif -+#ifdef CONFIG_RTL8822C -+ if (IS_HARDWARE_TYPE_8822C(pAdapter)) { -+ rtl8822c_mp_config_rfpath(pAdapter); -+ return; -+ } -+#endif -+#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 -+ -+#ifdef CONFIG_RTL8192F -+ if (IS_HARDWARE_TYPE_8192F(pAdapter)) { -+ mpt_set_rfpath_8192f(pAdapter); -+ return; -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814B -+ if (IS_HARDWARE_TYPE_8814B(pAdapter)) { -+ rtl8814b_mp_config_rfpath(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; -+ -+ pHalData->eeprom_thermal_meter = target_ther; -+ -+ return _SUCCESS; -+} -+ -+ -+void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter) -+{ -+ if (IS_HARDWARE_TYPE_JAGUAR3(pAdapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) { -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x42, BIT19, 0x1); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x42, BIT19, 0x0); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x42, BIT19, 0x1); -+ } else -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x42, BIT17 | BIT16, 0x03); -+ -+} -+ -+ -+u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter, u8 rf_path) -+ -+{ -+ struct dm_struct *p_dm_odm = adapter_to_phydm(pAdapter); -+ -+ u32 ThermalValue = 0; -+ s32 thermal_value_temp = 0; -+ s8 thermal_offset = 0; -+ u32 thermal_reg_mask = 0; -+ -+ if (IS_8822C_SERIES(GET_HAL_DATA(pAdapter)->version_id) || IS_8723F_SERIES(GET_HAL_DATA(pAdapter)->version_id)) -+ thermal_reg_mask = 0x007e; /*0x42: RF Reg[6:1], 35332(themal K & bias k & power trim) & 35325(tssi )*/ -+ else -+ thermal_reg_mask = 0xfc00; /*0x42: RF Reg[15:10]*/ -+ -+ ThermalValue = (u8)phy_query_rf_reg(pAdapter, rf_path, 0x42, thermal_reg_mask); -+ -+ thermal_offset = phydm_get_thermal_offset(p_dm_odm); -+ -+ thermal_value_temp = ThermalValue + thermal_offset; -+ -+ if (thermal_value_temp > 63) -+ ThermalValue = 63; -+ else if (thermal_value_temp < 0) -+ ThermalValue = 0; -+ else -+ ThermalValue = thermal_value_temp; -+ -+ return (u8)ThermalValue; -+} -+ -+ -+void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 rfpath, 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, rfpath); -+#endif -+ -+} -+ -+ -+void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ pAdapter->mppriv.mpt_ctx.bSingleCarrier = bStart; -+ -+ if (bStart) {/*/ Start Single Carrier.*/ -+ /*/ Start Single Carrier.*/ -+ /*/ 1. if OFDM block on?*/ -+ if (!phy_query_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) -+ phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1); /*set OFDM block on*/ -+ -+ /*/ 2. set CCK test mode off, set to CCK normal mode*/ -+ phy_set_bb_reg(pAdapter, rCCK0_System, bCCKBBMode, 0); -+ -+ /*/ 3. turn on scramble setting*/ -+ phy_set_bb_reg(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) || defined(CONFIG_RTL8723F) -+ if (IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) -+ phy_set_bb_reg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_SingleCarrier); -+ else -+#endif /* CONFIG_RTL8812A || CONFIG_RTL8821A || CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ -+ phy_set_bb_reg(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) || defined(CONFIG_RTL8723F) -+ if (IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)|| IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) -+ phy_set_bb_reg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); -+ else -+#endif /* CONFIG_RTL8812A || CONFIG_RTL8821A || CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ -+ phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); -+ -+ rtw_msleep_os(10); -+ /*/BB Reset*/ -+ phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ phy_set_bb_reg(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.mpt_ctx); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ u32 ulAntennaTx = pHalData->antenna_tx_path; -+ static u32 regRF = 0, regBB0 = 0, regBB1 = 0, regBB2 = 0, regBB3 = 0; -+ u8 rfPath; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR3(pAdapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) { -+#ifdef PHYDM_MP_SUPPORT -+#ifdef CONFIG_RTL8814B -+ if(pHalData->current_channel_bw == CHANNEL_WIDTH_80_80) -+ { -+ /* @Tx mode: RF0x00[19:16]=4'b0010 */ -+ config_phydm_write_rf_syn_8814b(pDM_Odm, RF_SYN0, RF_0x0, 0xF0000, 0x2); -+ /* @Lowest RF gain index: RF_0x0[4:0] = 0*/ -+ config_phydm_write_rf_syn_8814b(pDM_Odm, RF_SYN0, RF_0x0, 0x1F, 0x0); -+ /* @RF LO enabled */ -+ config_phydm_write_rf_syn_8814b(pDM_Odm, RF_SYN0, RF_0x58, BIT(1), 0x1); -+ /* @SYN1 */ -+ config_phydm_write_rf_syn_8814b(pDM_Odm, RF_SYN1, RF_0x0, 0xF0000, 0x2); -+ config_phydm_write_rf_syn_8814b(pDM_Odm, RF_SYN1, RF_0x0, 0x1F, 0x0); -+ config_phydm_write_rf_syn_8814b(pDM_Odm, RF_SYN1, RF_0x58, BIT(1), 0x1); -+ } -+#endif -+ phydm_mp_set_single_tone(pDM_Odm, bStart, pMptCtx->mpt_rf_path); -+#endif -+ return; -+ } -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_B: -+ rfPath = RF_PATH_B; -+ break; -+ case ANTENNA_C: -+ rfPath = RF_PATH_C; -+ break; -+ case ANTENNA_D: -+ rfPath = RF_PATH_D; -+ break; -+ case ANTENNA_A: -+ default: -+ rfPath = RF_PATH_A; -+ break; -+ } -+ -+ pAdapter->mppriv.mpt_ctx.is_single_tone = 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_query_rf_reg(pAdapter, rfPath, lna_low_gain_3, bRFRegOffsetMask); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x0); -+ phy_set_bb_reg(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_set_mac_reg(pAdapter, 0x88C, 0xF00000, 0xF); -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x1); /*/ RF LO disabled*/ -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ -+ } else if (IS_HARDWARE_TYPE_8192F(pAdapter)) { /* USB need to do RF LO disable first, PCIE isn't required to follow this order.*/ -+ #ifdef CONFIG_RTL8192F -+ phy_set_mac_reg(pAdapter, REG_LEDCFG0_8192F, BIT23, 0x1); -+ phy_set_mac_reg(pAdapter, REG_LEDCFG0_8192F, BIT26, 0x1); -+ phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT7, 0x1); -+ phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT1, 0x1); -+ phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT0, 0x1); -+ phy_set_mac_reg(pAdapter, REG_AFE_CTRL_4_8192F, BIT16, 0x1); -+ phy_set_bb_reg(pAdapter, 0x88C, 0xF00000, 0xF); -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, 0x57, BIT1, 0x1); /* RF LO disabled*/ -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x2); /* Tx mode*/ -+#endif -+ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+ if (pMptCtx->mpt_rf_path == RF_PATH_A) { -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x56, 0xF, 0x1); /*/ RF LO enabled*/ -+ } else { -+ /*/ S0/S1 both use PATH A to configure*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x76, 0xF, 0x1); /*/ RF LO enabled*/ -+ } -+ } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+ if (pMptCtx->mpt_rf_path == RF_PATH_A) { -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x2); /* Tx mode */ -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x53, 0xF000, 0x1); /* RF LO enabled */ -+ } -+ } else if (IS_HARDWARE_TYPE_8188F(pAdapter) || IS_HARDWARE_TYPE_8188GTV(pAdapter)) { -+ /*Set BB REG 88C: Prevent SingleTone Fail*/ -+ phy_set_bb_reg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xF); -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x1); -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x2); -+ -+ } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { -+ if (pMptCtx->mpt_rf_path == RF_PATH_A) { -+ phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, BIT16, 0x0); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x53, BIT0, 0x1); -+ } else {/* S0/S1 both use PATH A to configure */ -+ phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, BIT16, 0x0); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x63, BIT0, 0x1); -+ } -+ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8822B(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) { -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ u8 p = RF_PATH_A; -+ -+ regRF = phy_query_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, bRFRegOffsetMask); -+ regBB0 = phy_query_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord); -+ regBB1 = phy_query_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord); -+ regBB2 = phy_query_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskDWord); -+ regBB3 = phy_query_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskDWord); -+ -+ phy_set_bb_reg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x0); /*/ Disable CCK and OFDM*/ -+ -+ if (pMptCtx->mpt_rf_path == RF_PATH_AB) { -+ for (p = RF_PATH_A; p <= RF_PATH_B; ++p) { -+ phy_set_rf_reg(pAdapter, p, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ -+ phy_set_rf_reg(pAdapter, p, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ -+ phy_set_rf_reg(pAdapter, p, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ } -+ } else { -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ -+#ifdef CONFIG_RTL8821C -+ if (IS_HARDWARE_TYPE_8821C(pAdapter) && pDM_Odm->current_rf_set_8821c == SWITCH_TO_BTG) -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, 0x75, BIT16, 0x1); /* RF LO (for BTG) enabled */ -+ else -+#endif -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ } -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) { -+ phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord, 0x77777777); /* 0xCB0=0x77777777*/ -+ phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord, 0x77777777); /* 0xEB0=0x77777777*/ -+ phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskLWord, 0x7777); /* 0xCB4[15:0] = 0x7777*/ -+ phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskLWord, 0x7777); /* 0xEB4[15:0] = 0x7777*/ -+ phy_set_bb_reg(pAdapter, rA_RFE_Inverse_Jaguar, 0xFFF, 0xb); /* 0xCBC[23:16] = 0x12*/ -+ phy_set_bb_reg(pAdapter, rB_RFE_Inverse_Jaguar, 0xFFF, 0x830); /* 0xEBC[23:16] = 0x12*/ -+ } else if (IS_HARDWARE_TYPE_8821C(pAdapter)) { -+ phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar, 0xF0F0, 0x707); /* 0xCB0[[15:12, 7:4] = 0x707*/ -+ -+ if (pHalData->external_pa_5g) -+ { -+ phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xA00000, 0x1); /* 0xCB4[23, 21] = 0x1*/ -+ } -+ else if (pHalData->ExternalPA_2G) -+ { -+ phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xA00000, 0x1); /* 0xCB4[23, 21] = 0x1*/ -+ } -+ } else { -+ phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ -+ phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ -+ -+ if (pHalData->external_pa_5g) { -+ phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x12); /*/ 0xCB4[23:16] = 0x12*/ -+ phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x12); /*/ 0xEB4[23:16] = 0x12*/ -+ } else if (pHalData->ExternalPA_2G) { -+ phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x11); /*/ 0xCB4[23:16] = 0x11*/ -+ phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x11); /*/ 0xEB4[23:16] = 0x11*/ -+ } -+ } -+#endif -+ } -+#if defined(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_set_bb_reg(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_set_rf_reg(pAdapter, RF_PATH_A, lna_low_gain_3, bRFRegOffsetMask, regRF); -+ phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x1); -+ phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x1); -+ } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x3);/*/ Tx mode*/ -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x0);/*/ RF LO disabled */ -+ /*/ RESTORE MAC REG 88C: Enable RF Functions*/ -+ phy_set_mac_reg(pAdapter, 0x88C, 0xF00000, 0x0); -+ } else if (IS_HARDWARE_TYPE_8192F(pAdapter)){ -+#ifdef CONFIG_RTL8192F -+ phy_set_mac_reg(pAdapter, REG_LEDCFG0_8192F, BIT23, 0x0); -+ phy_set_mac_reg(pAdapter, REG_LEDCFG0_8192F, BIT26, 0x0); -+ phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT7, 0x0); -+ phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT1, 0x0); -+ phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT0, 0x0); -+ phy_set_mac_reg(pAdapter, REG_AFE_CTRL_4_8192F, BIT16, 0x0); -+ phy_set_bb_reg(pAdapter, 0x88C, 0xF00000, 0x0); -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, 0x57, BIT1, 0x0); /* RF LO disabled*/ -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x3); /* Rx mode*/ -+#endif -+ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+ if (pMptCtx->mpt_rf_path == RF_PATH_A) { -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x56, 0xF, 0x0); /*/ RF LO disabled*/ -+ } else { -+ /*/ S0/S1 both use PATH A to configure*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x76, 0xF, 0x0); /*/ RF LO disabled*/ -+ } -+ } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+ if (pMptCtx->mpt_rf_path == RF_PATH_A) { -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x3); /* Rx mode */ -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x53, 0xF000, 0x0); /* RF LO disabled */ -+ } -+ } else if (IS_HARDWARE_TYPE_8188F(pAdapter) || IS_HARDWARE_TYPE_8188GTV(pAdapter)) { -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x3); /*Tx mode*/ -+ phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x0); /*RF LO disabled*/ -+ /*Set BB REG 88C: Prevent SingleTone Fail*/ -+ phy_set_bb_reg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xc); -+ } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { -+ if (pMptCtx->mpt_rf_path == RF_PATH_A) { -+ phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, BIT16, 0x1); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x53, BIT0, 0x0); -+ } else { /* S0/S1 both use PATH A to configure */ -+ phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, BIT16, 0x1); -+ phy_set_rf_reg(pAdapter, RF_PATH_A, 0x63, BIT0, 0x0); -+ } -+ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8822B(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) { -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ u8 p = RF_PATH_A; -+ -+ phy_set_bb_reg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x3); /*/ Disable CCK and OFDM*/ -+ -+ if (pMptCtx->mpt_rf_path == RF_PATH_AB) { -+ for (p = RF_PATH_A; p <= RF_PATH_B; ++p) { -+ phy_set_rf_reg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); -+ phy_set_rf_reg(pAdapter, p, lna_low_gain_3, BIT1, 0x0); /*/ RF LO disabled*/ -+ } -+ } else { -+ p = pMptCtx->mpt_rf_path; -+ phy_set_rf_reg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); -+ -+ if (IS_HARDWARE_TYPE_8821C(pAdapter)) -+ phy_set_rf_reg(pAdapter, p, 0x75, BIT16, 0x0); /* RF LO (for BTG) disabled */ -+ -+ phy_set_rf_reg(pAdapter, p, lna_low_gain_3, BIT1, 0x0); /*/ RF LO disabled*/ -+ } -+ -+ phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord, regBB0); -+ phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord, regBB1); -+ phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskDWord, regBB2); -+ phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskDWord, regBB3); -+ -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) { -+ RTW_INFO("Restore RFE control Pin cbc\n"); -+ phy_set_bb_reg(pAdapter, rA_RFE_Inverse_Jaguar, 0xfff, 0x0); -+ phy_set_bb_reg(pAdapter, rB_RFE_Inverse_Jaguar, 0xfff, 0x0); -+ } -+#endif -+ } -+#if defined(CONFIG_RTL8814A) -+ else if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ mpt_SetSingleTone_8814A(pAdapter, FALSE, FALSE); -+ -+ else/*/ Turn off all test modes.*/ -+ phy_set_bb_reg(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) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct dm_struct *pdm_odm = &pHalData->odmpriv; -+ u8 Rate; -+ -+ pAdapter->mppriv.mpt_ctx.is_carrier_suppression = bStart; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR3(pAdapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) { -+#ifdef PHYDM_MP_SUPPORT -+ phydm_mp_set_carrier_supp(pdm_odm, bStart, pAdapter->mppriv.rateidx); -+#endif -+ return; -+ } -+ -+ 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_ALL(pAdapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) -+ phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); /* rSingleTone_ContTx_Jaguar*/ -+ else -+ phy_set_bb_reg(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"); -+} -+ -+u32 hal_mpt_query_phytxok(PADAPTER pAdapter) -+{ -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u16 count = 0; -+ -+#ifdef PHYDM_MP_SUPPORT -+ struct dm_struct *dm = (struct dm_struct *)&pHalData->odmpriv; -+ struct phydm_mp *mp = &dm->dm_mp_table; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR3(pAdapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) { -+ phydm_mp_get_tx_ok(&pHalData->odmpriv, pAdapter->mppriv.rateidx); -+ count = mp->tx_phy_ok_cnt; -+ -+ } else -+#endif -+ { -+ -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) -+ count = phy_query_bb_reg(pAdapter, 0xF50, bMaskLWord); /* [15:0]*/ -+ else -+ count = phy_query_bb_reg(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; -+ -+} -+ -+static void mpt_StopCckContTx( -+ PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ u8 u1bReg; -+ -+ pMptCtx->bCckContTx = FALSE; -+ pMptCtx->bOfdmContTx = FALSE; -+ -+ phy_set_bb_reg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*normal mode*/ -+ phy_set_bb_reg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) { -+ phy_set_bb_reg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 2b00*/ -+ phy_set_bb_reg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ -+ -+ phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 0); -+ phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter2, BIT14, 0); -+ phy_set_bb_reg(pAdapter, 0x0B34, BIT14, 0); -+ } -+ -+ /*BB Reset*/ -+ phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter) -+ && !IS_HARDWARE_TYPE_8723D(pAdapter) && !IS_HARDWARE_TYPE_8192F(pAdapter) -+ && !IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ } -+ -+ if (IS_HARDWARE_TYPE_8188E(pAdapter) || IS_HARDWARE_TYPE_8723B(pAdapter) || -+ IS_HARDWARE_TYPE_8703B(pAdapter) || IS_HARDWARE_TYPE_8188F(pAdapter) || -+ IS_HARDWARE_TYPE_8723D(pAdapter) || IS_HARDWARE_TYPE_8192F(pAdapter) || -+ IS_HARDWARE_TYPE_8821C(pAdapter) || IS_HARDWARE_TYPE_8188GTV(pAdapter)) { -+ phy_set_bb_reg(pAdapter, 0xA70, BIT(14), bDisable);/* patch Count CCK adjust Rate*/ -+ } -+ -+} /* mpt_StopCckContTx */ -+ -+ -+static void mpt_StopOfdmContTx( -+ PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); -+ u8 u1bReg; -+ u32 data; -+ -+ pMptCtx->bCckContTx = FALSE; -+ pMptCtx->bOfdmContTx = FALSE; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) -+ phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); -+ else -+ phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); -+ -+ rtw_mdelay_os(10); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)){ -+ phy_set_bb_reg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 0*/ -+ phy_set_bb_reg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ -+ } -+ -+ /*BB Reset*/ -+ phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter) -+ && !IS_HARDWARE_TYPE_8723D(pAdapter) && !IS_HARDWARE_TYPE_8192F(pAdapter) -+ && !IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ phy_set_bb_reg(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.mpt_ctx); -+ u32 cckrate; -+ -+ /* 1. if CCK block on */ -+ if (!phy_query_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn)) -+ phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn, 1);/*set CCK block on*/ -+ -+ /*Turn Off All Test Mode*/ -+ if (IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) -+ phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); -+ else -+ phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); -+ -+ cckrate = pAdapter->mppriv.rateidx; -+ -+ phy_set_bb_reg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); -+ -+ phy_set_bb_reg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*transmit mode*/ -+ phy_set_bb_reg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) { -+ phy_set_bb_reg(pAdapter, 0xa14, 0x300, 0x3); /* 0xa15[1:0] = 11 force cck rxiq = 0*/ -+ phy_set_bb_reg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1 force ofdm rxiq = ofdm txiq*/ -+ phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 1); -+ phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter2, BIT14, 1); -+ phy_set_bb_reg(pAdapter, 0x0B34, BIT14, 1); -+ } -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter) -+ && !IS_HARDWARE_TYPE_8723D(pAdapter) && !IS_HARDWARE_TYPE_8192F(pAdapter) -+ && !IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ } -+ -+ if (IS_HARDWARE_TYPE_8188E(pAdapter) || IS_HARDWARE_TYPE_8723B(pAdapter) || -+ IS_HARDWARE_TYPE_8703B(pAdapter) || IS_HARDWARE_TYPE_8188F(pAdapter) || -+ IS_HARDWARE_TYPE_8723D(pAdapter) || IS_HARDWARE_TYPE_8192F(pAdapter) || -+ IS_HARDWARE_TYPE_8821C(pAdapter) || IS_HARDWARE_TYPE_8188GTV(pAdapter)) { -+ if (pAdapter->mppriv.rateidx == MPT_RATE_1M) /* patch Count CCK adjust Rate*/ -+ phy_set_bb_reg(pAdapter, 0xA70, BIT(14), bDisable); -+ else -+ phy_set_bb_reg(pAdapter, 0xA70, BIT(14), bEnable); -+ } -+ -+ 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.mpt_ctx); -+ -+ /* 1. if OFDM block on?*/ -+ if (!phy_query_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) -+ phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1);/*set OFDM block on*/ -+ -+ /* 2. set CCK test mode off, set to CCK normal mode*/ -+ phy_set_bb_reg(pAdapter, rCCK0_System, bCCKBBMode, 0); -+ -+ /* 3. turn on scramble setting*/ -+ phy_set_bb_reg(pAdapter, rCCK0_System, bCCKScramble, 1); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) { -+ phy_set_bb_reg(pAdapter, 0xa14, 0x300, 0x3); /* 0xa15[1:0] = 2b'11*/ -+ phy_set_bb_reg(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_ALL(pAdapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter)) -+ phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ContinuousTx); -+ else -+ phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ContinuousTx); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR3_11N(pAdapter) -+ && !IS_HARDWARE_TYPE_8723D(pAdapter) && !IS_HARDWARE_TYPE_8192F(pAdapter) -+ && !IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ } -+ -+ pMptCtx->bCckContTx = FALSE; -+ pMptCtx->bOfdmContTx = TRUE; -+} /* mpt_StartOfdmContTx */ -+ -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) \ -+ || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) \ -+ || defined(CONFIG_RTL8723F) -+#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT -+static void mpt_convert_phydm_txinfo_for_jaguar3( -+ RT_PMAC_TX_INFO *pMacTxInfo, struct phydm_pmac_info *phydmtxinfo) -+{ -+ phydmtxinfo->en_pmac_tx = pMacTxInfo->bEnPMacTx; -+ phydmtxinfo->mode = pMacTxInfo->Mode; -+ phydmtxinfo->tx_rate = MRateToHwRate(mpt_to_mgnt_rate(pMacTxInfo->TX_RATE)); -+ phydmtxinfo->tx_sc = pMacTxInfo->TX_SC; -+ phydmtxinfo->is_short_preamble = pMacTxInfo->bSPreamble; -+ phydmtxinfo->ndp_sound = pMacTxInfo->NDP_sound; -+ phydmtxinfo->bw = pMacTxInfo->BandWidth; -+ phydmtxinfo->m_stbc = pMacTxInfo->m_STBC; -+ phydmtxinfo->packet_period = pMacTxInfo->PacketPeriod; -+ phydmtxinfo->packet_count = pMacTxInfo->PacketCount; -+ phydmtxinfo->packet_pattern = pMacTxInfo->PacketPattern; -+ phydmtxinfo->sfd = pMacTxInfo->SFD; -+ phydmtxinfo->signal_field = pMacTxInfo->SignalField; -+ phydmtxinfo->service_field = pMacTxInfo->ServiceField; -+ phydmtxinfo->length = pMacTxInfo->LENGTH; -+#if defined(CONFIG_RTL8723F) -+ if (IS_MPT_CCK_RATE(pMacTxInfo->TX_RATE)) -+ phydmtxinfo->service_field_bit2= 0x1; -+ phydmtxinfo->packet_length = pMacTxInfo->PacketLength; -+#endif -+ _rtw_memcpy(&phydmtxinfo->crc16,pMacTxInfo->CRC16, 2); -+ _rtw_memcpy(&phydmtxinfo->lsig , pMacTxInfo->LSIG,3); -+ _rtw_memcpy(&phydmtxinfo->ht_sig , pMacTxInfo->HT_SIG,6); -+ _rtw_memcpy(&phydmtxinfo->vht_sig_a , pMacTxInfo->VHT_SIG_A,6); -+ _rtw_memcpy(&phydmtxinfo->vht_sig_b , pMacTxInfo->VHT_SIG_B,4); -+ phydmtxinfo->vht_sig_b_crc = pMacTxInfo->VHT_SIG_B_CRC; -+ _rtw_memcpy(&phydmtxinfo->vht_delimiter,pMacTxInfo->VHT_Delimiter,4); -+} -+#endif -+ -+/* for HW TX mode */ -+u8 mpt_ProSetPMacTx(PADAPTER Adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); -+ struct mp_priv *pmppriv = &Adapter->mppriv; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); -+ RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; -+ struct dm_struct *p_dm_odm; -+ u32 u4bTmp; -+ u8 status = _TRUE; -+ -+ p_dm_odm = &pHalData->odmpriv; -+ -+#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); -+ dbg_print("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, ETH_ALEN); -+ PRINT_DATA("Dest Address", PMacTxInfo.MacAddress, ETH_ALEN); -+#endif -+ if (pmppriv->pktInterval != 0) -+ PMacTxInfo.PacketPeriod = pmppriv->pktInterval; -+ -+ if (pmppriv->tx.count != 0) -+ PMacTxInfo.PacketCount = pmppriv->tx.count; -+ -+ RTW_INFO("SGI %d bSPreamble %d bSTBC %d bLDPC %d NDP_sound %d\n", PMacTxInfo.bSGI, PMacTxInfo.bSPreamble, PMacTxInfo.bSTBC, PMacTxInfo.bLDPC, PMacTxInfo.NDP_sound); -+ RTW_INFO("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 (hal_spec->tx_nss_num < 2 && MPT_IS_2SS_RATE(PMacTxInfo.TX_RATE)) -+ return _FALSE; -+ if (hal_spec->tx_nss_num < 3 && MPT_IS_3SS_RATE(PMacTxInfo.TX_RATE)) -+ return _FALSE; -+ if (hal_spec->tx_nss_num < 4 && MPT_IS_4SS_RATE(PMacTxInfo.TX_RATE)) -+ return _FALSE; -+ if (!is_supported_vht(Adapter->registrypriv.wireless_mode) && MPT_IS_VHT_RATE(PMacTxInfo.TX_RATE)) -+ return _FALSE; -+ if (!is_supported_ht(Adapter->registrypriv.wireless_mode) && MPT_IS_HT_RATE(PMacTxInfo.TX_RATE)) -+ return _FALSE; -+ -+ if (PMacTxInfo.BandWidth == 1 && hal_chk_bw_cap(Adapter, BW_CAP_40M)) -+ PMacTxInfo.BandWidth = CHANNEL_WIDTH_40; -+ else if (PMacTxInfo.BandWidth == 2 && hal_chk_bw_cap(Adapter, BW_CAP_80M)) -+ PMacTxInfo.BandWidth = CHANNEL_WIDTH_80; -+ else -+ PMacTxInfo.BandWidth = CHANNEL_WIDTH_20; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR3(Adapter) || IS_HARDWARE_TYPE_JAGUAR3_11N(Adapter)) { -+#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT -+ struct phydm_pmac_info phydm_mactxinfo; -+ -+ if (PMacTxInfo.bEnPMacTx == TRUE) { -+ pMptCtx->HWTxmode = PMacTxInfo.Mode; -+ pMptCtx->mpt_rate_index = PMacTxInfo.TX_RATE; -+ if (PMacTxInfo.Mode != PACKETS_TX) -+ hal_mpt_SetTxPower(Adapter); -+ } else { -+ PMacTxInfo.Mode = pMptCtx->HWTxmode; -+ PMacTxInfo.TX_RATE = pMptCtx->mpt_rate_index; -+ pMptCtx->HWTxmode = TEST_NONE; -+ } -+ if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) { -+ phydm_mp_set_single_tone(p_dm_odm, PMacTxInfo.bEnPMacTx ,pMptCtx->mpt_rf_path); -+ RTW_INFO("To set Tx mode OFDM_Single_Tone_TX\n"); -+ return status; -+ } -+ -+ if (PMacTxInfo.Mode == CCK_Carrier_Suppression_TX) { -+ phydm_mp_set_carrier_supp(p_dm_odm, PMacTxInfo.bEnPMacTx ,PMacTxInfo.TX_RATE); -+ -+ RTW_INFO("To set Tx mode CCK_Carrier_Suppression_TX\n"); -+ return status; -+ } -+ -+ mpt_convert_phydm_txinfo_for_jaguar3(&PMacTxInfo, &phydm_mactxinfo); -+ phydm_set_pmac_tx(p_dm_odm, &phydm_mactxinfo, pMptCtx->mpt_rf_path); -+#endif -+ return status; -+ } -+ -+ if (PMacTxInfo.bEnPMacTx == FALSE) { -+ if (pMptCtx->HWTxmode == CONTINUOUS_TX) { -+ phy_set_bb_reg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ -+ if (IS_MPT_CCK_RATE(pMptCtx->mpt_rate_index)) -+ mpt_StopCckContTx(Adapter); -+ else -+ mpt_StopOfdmContTx(Adapter); -+ } else if (IS_MPT_CCK_RATE(pMptCtx->mpt_rate_index)) { -+ u4bTmp = phy_query_bb_reg(Adapter, 0xf50, bMaskLWord); -+ phy_set_bb_reg(Adapter, 0xb1c, bMaskLWord, u4bTmp + 50); -+ phy_set_bb_reg(Adapter, 0xb04, 0xf, 2); /*TX Stop*/ -+ } else -+ phy_set_bb_reg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ -+ -+ if (pMptCtx->HWTxmode == OFDM_Single_Tone_TX) { -+ /* Stop HW TX -> Stop Continuous TX -> Stop RF Setting*/ -+ if (IS_MPT_CCK_RATE(pMptCtx->mpt_rate_index)) -+ mpt_StopCckContTx(Adapter); -+ else -+ mpt_StopOfdmContTx(Adapter); -+ -+ mpt_SetSingleTone_8814A(Adapter, FALSE, TRUE); -+ } -+ pMptCtx->HWTxmode = TEST_NONE; -+ return status; -+ } -+ -+ pMptCtx->mpt_rate_index = PMacTxInfo.TX_RATE; -+ -+ if (PMacTxInfo.Mode == CONTINUOUS_TX) { -+ pMptCtx->HWTxmode = CONTINUOUS_TX; -+ PMacTxInfo.PacketCount = 1; -+ -+ hal_mpt_SetTxPower(Adapter); -+ -+ 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 */ -+ pMptCtx->HWTxmode = OFDM_Single_Tone_TX; -+ PMacTxInfo.PacketCount = 1; -+ -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) -+ mpt_StartCckContTx(Adapter); -+ else -+ mpt_StartOfdmContTx(Adapter); -+ } else if (PMacTxInfo.Mode == PACKETS_TX) { -+ pMptCtx->HWTxmode = 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_set_bb_reg(Adapter, 0xb1c, bMaskDWord, u4bTmp); -+ /* 0xb40 7:0 SIGNAL 15:8 SERVICE 31:16 LENGTH*/ -+ u4bTmp = PMacTxInfo.SignalField | (PMacTxInfo.ServiceField << 8) | (PMacTxInfo.LENGTH << 16); -+ phy_set_bb_reg(Adapter, 0xb40, bMaskDWord, u4bTmp); -+ u4bTmp = PMacTxInfo.CRC16[0] | (PMacTxInfo.CRC16[1] << 8); -+ phy_set_bb_reg(Adapter, 0xb44, bMaskLWord, u4bTmp); -+ -+ if (PMacTxInfo.bSPreamble) -+ phy_set_bb_reg(Adapter, 0xb0c, BIT27, 0); -+ else -+ phy_set_bb_reg(Adapter, 0xb0c, BIT27, 1); -+ } else { -+ phy_set_bb_reg(Adapter, 0xb18, 0xfffff, PMacTxInfo.PacketCount); -+ -+ u4bTmp = PMacTxInfo.LSIG[0] | ((PMacTxInfo.LSIG[1]) << 8) | ((PMacTxInfo.LSIG[2]) << 16) | ((PMacTxInfo.PacketPattern) << 24); -+ phy_set_bb_reg(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_set_bb_reg(Adapter, 0xb0c, bMaskDWord, u4bTmp); -+ u4bTmp = PMacTxInfo.HT_SIG[3] | ((PMacTxInfo.HT_SIG[4]) << 8) | ((PMacTxInfo.HT_SIG[5]) << 16); -+ phy_set_bb_reg(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_set_bb_reg(Adapter, 0xb0c, bMaskDWord, u4bTmp); -+ u4bTmp = PMacTxInfo.VHT_SIG_A[3] | ((PMacTxInfo.VHT_SIG_A[4]) << 8) | ((PMacTxInfo.VHT_SIG_A[5]) << 16); -+ phy_set_bb_reg(Adapter, 0xb10, 0xffffff, u4bTmp); -+ -+ _rtw_memcpy(&u4bTmp, PMacTxInfo.VHT_SIG_B, 4); -+ phy_set_bb_reg(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_set_bb_reg(Adapter, 0xb20, bMaskDWord, u4bTmp); -+ -+ _rtw_memcpy(&u4bTmp, PMacTxInfo.VHT_Delimiter, 4); -+ phy_set_bb_reg(Adapter, 0xb24, bMaskDWord, u4bTmp); -+ -+ /* 0xb28 - 0xb34 24 byte Probe Request MAC Header*/ -+ /*& Duration & Frame control*/ -+ phy_set_bb_reg(Adapter, 0xb28, bMaskDWord, 0x00000040); -+ -+ /* Address1 [0:3]*/ -+ u4bTmp = PMacTxInfo.MacAddress[0] | (PMacTxInfo.MacAddress[1] << 8) | (PMacTxInfo.MacAddress[2] << 16) | (PMacTxInfo.MacAddress[3] << 24); -+ phy_set_bb_reg(Adapter, 0xb2C, bMaskDWord, u4bTmp); -+ -+ /* Address3 [3:0]*/ -+ phy_set_bb_reg(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_set_bb_reg(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_set_bb_reg(Adapter, 0xb34, bMaskDWord, u4bTmp); -+ -+ /* Sequence Control & Address3 [5:4]*/ -+ /*u4bTmp = PMacTxInfo.MacAddress[4]|(PMacTxInfo.MacAddress[5] << 8) ;*/ -+ /*phy_set_bb_reg(Adapter, 0xb38, bMaskDWord, u4bTmp);*/ -+ } else { -+ phy_set_bb_reg(Adapter, 0xb20, bMaskDWord, PMacTxInfo.PacketPeriod); /* for TX interval*/ -+ /* & Duration & Frame control */ -+ phy_set_bb_reg(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_set_bb_reg(Adapter, 0xb28, bMaskDWord, u4bTmp); -+ -+ /* Address3 [3:0]*/ -+ phy_set_bb_reg(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_set_bb_reg(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_set_bb_reg(Adapter, 0xb30, bMaskDWord, u4bTmp); -+ -+ /* Sequence Control & Address3 [5:4]*/ -+ u4bTmp = PMacTxInfo.MacAddress[4] | (PMacTxInfo.MacAddress[5] << 8); -+ phy_set_bb_reg(Adapter, 0xb38, bMaskDWord, u4bTmp); -+ } -+ -+ phy_set_bb_reg(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_set_bb_reg(Adapter, 0xb4c, 0x1ff, u4bTmp); -+ -+ if (IS_HARDWARE_TYPE_JAGUAR2(Adapter)) { -+ u32 offset = 0xb44; -+ -+ if (IS_MPT_OFDM_RATE(PMacTxInfo.TX_RATE)) -+ phy_set_bb_reg(Adapter, offset, 0xc0000000, 0); -+ else if (IS_MPT_HT_RATE(PMacTxInfo.TX_RATE)) -+ phy_set_bb_reg(Adapter, offset, 0xc0000000, 1); -+ else if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) -+ phy_set_bb_reg(Adapter, offset, 0xc0000000, 2); -+ -+ } else if(IS_HARDWARE_TYPE_JAGUAR(Adapter)) { -+ u32 offset = 0xb4c; -+ -+ if(IS_MPT_OFDM_RATE(PMacTxInfo.TX_RATE)) -+ phy_set_bb_reg(Adapter, offset, 0xc0000000, 0); -+ else if(IS_MPT_HT_RATE(PMacTxInfo.TX_RATE)) -+ phy_set_bb_reg(Adapter, offset, 0xc0000000, 1); -+ else if(IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) -+ phy_set_bb_reg(Adapter, offset, 0xc0000000, 2); -+ } -+ -+ phy_set_bb_reg(Adapter, 0xb00, BIT8, 1); /* Turn on PMAC*/ -+ /* phy_set_bb_reg(Adapter, 0xb04, 0xf, 2); */ /* TX Stop */ -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { -+ phy_set_bb_reg(Adapter, 0xb04, 0xf, 8); /*TX CCK ON*/ -+ phy_set_bb_reg(Adapter, 0xA84, BIT31, 0); -+ } else -+ phy_set_bb_reg(Adapter, 0xb04, 0xf, 4); /* TX Ofdm ON */ -+ -+ if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) -+ mpt_SetSingleTone_8814A(Adapter, TRUE, TRUE); -+ -+ return status; -+} -+ -+#endif -+ -+void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ u8 Rate; -+ -+ RTW_INFO("SetContinuousTx: rate:%d\n", pAdapter->mppriv.rateidx); -+ Rate = HwRateToMPTRate(pAdapter->mppriv.rateidx); -+ pAdapter->mppriv.mpt_ctx.is_start_cont_tx = bStart; -+ -+ if (Rate <= MPT_RATE_11M) { -+ if (bStart) -+ mpt_StartCckContTx(pAdapter); -+ else -+ mpt_StopCckContTx(pAdapter); -+ -+ } else if (Rate >= MPT_RATE_6M) { -+ if (bStart) -+ mpt_StartOfdmContTx(pAdapter); -+ else -+ mpt_StopOfdmContTx(pAdapter); -+ } -+} -+ -+void mpt_trigger_tssi_tracking(PADAPTER pAdapter, u8 rf_path) -+{ -+#ifdef CONFIG_RTL8814B -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ -+ halrf_do_tssi_8814b(pDM_Odm, rf_path); -+#endif -+} -+ -+#endif /* CONFIG_MP_INCLUDE*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/hal_phy.c b/drivers/net/wireless/rtl8821cs/hal/hal_phy.c -new file mode 100644 -index 000000000..cf5cb3b54 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/hal_phy.c -@@ -0,0 +1,257 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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; -+} -+ -+ -+#ifdef CONFIG_RF_SHADOW_RW -+/* ******************************************************************************** -+ * Constant. -+ * ******************************************************************************** -+ * 2008/11/20 MH For Debug only, RF */ -+static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; -+ -+/* -+ * ==> 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, -+ enum rf_path eRFPath, -+ u32 Offset) -+{ -+ return RF_Shadow[eRFPath][Offset].Value; -+ -+} /* PHY_RFShadowRead */ -+ -+ -+void -+PHY_RFShadowWrite( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 Offset, -+ u32 Data) -+{ -+ RF_Shadow[eRFPath][Offset].Value = (Data & bRFRegOffsetMask); -+ RF_Shadow[eRFPath][Offset].Driver_Write = _TRUE; -+ -+} /* PHY_RFShadowWrite */ -+ -+ -+BOOLEAN -+PHY_RFShadowCompare( -+ PADAPTER Adapter, -+ enum rf_path 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; -+ } -+ return RF_Shadow[eRFPath][Offset].ErrorOrNot ; -+ } -+ return _FALSE; -+} /* PHY_RFShadowCompare */ -+ -+ -+void -+PHY_RFShadowRecorver( -+ PADAPTER Adapter, -+ enum rf_path 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); -+ } -+ } -+ -+} /* PHY_RFShadowRecorver */ -+ -+ -+void -+PHY_RFShadowCompareAll( -+ PADAPTER Adapter) -+{ -+ enum rf_path eRFPath = RF_PATH_A; -+ 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) -+{ -+ enum rf_path eRFPath = RF_PATH_A; -+ 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, -+ enum rf_path eRFPath, -+ u32 Offset, -+ u8 Type) -+{ -+ /* Set True or False!!! */ -+ RF_Shadow[eRFPath][Offset].Compare = Type; -+ -+} /* PHY_RFShadowCompareFlagSet */ -+ -+ -+void -+PHY_RFShadowRecorverFlagSet( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 Offset, -+ u8 Type) -+{ -+ /* Set True or False!!! */ -+ RF_Shadow[eRFPath][Offset].Recorver = Type; -+ -+} /* PHY_RFShadowRecorverFlagSet */ -+ -+ -+void -+PHY_RFShadowCompareFlagSetAll( -+ PADAPTER Adapter) -+{ -+ enum rf_path eRFPath = RF_PATH_A; -+ 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) -+{ -+ enum rf_path eRFPath = RF_PATH_A; -+ 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) -+{ -+ enum rf_path eRFPath = RF_PATH_A; -+ 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 */ -+#endif /*CONFIG_RF_SHADOW_RW*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_2_platform.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_2_platform.h -new file mode 100644 -index 000000000..5ba8591b8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_2_platform.h -@@ -0,0 +1,93 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2018 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_2_PLATFORM_H_ -+#define _HALMAC_2_PLATFORM_H_ -+ -+/*[Driver] always set BUILD_TEST =0*/ -+#define BUILD_TEST 0 -+ -+#if BUILD_TEST -+#include "../Platform/App/Test/halmac_2_platformapi.h" -+#else -+/*[Driver] use their own header files*/ -+#include /* for basic_types.h and osdep_service.h */ -+#include /* u8, u16, u32 and etc.*/ -+#include /* __BIG_ENDIAN, __LITTLE_ENDIAN, _sema, _mutex */ -+#endif -+ -+/*[Driver] provide the define of NULL, u8, u16, u32*/ -+#ifndef NULL -+#define NULL ((void *)0) -+#endif -+ -+#define HALMAC_INLINE inline -+ -+/* -+ * Ignore following typedef because Linux already have these -+ * u8, u16, u32, s8, s16, s32 -+ * __le16, __le32, __be16, __be32 -+ */ -+ -+#define HALMAC_PLATFORM_LITTLE_ENDIAN 1 -+#define HALMAC_PLATFORM_BIG_ENDIAN 0 -+ -+/* Note : Named HALMAC_PLATFORM_LITTLE_ENDIAN / HALMAC_PLATFORM_BIG_ENDIAN -+ * is not mandatory. But Little endian must be '1'. Big endian must be '0' -+ */ -+/*[Driver] config the system endian*/ -+#ifdef __LITTLE_ENDIAN -+#define HALMAC_SYSTEM_ENDIAN HALMAC_PLATFORM_LITTLE_ENDIAN -+#else /* !__LITTLE_ENDIAN */ -+#define HALMAC_SYSTEM_ENDIAN HALMAC_PLATFORM_BIG_ENDIAN -+#endif /* !__LITTLE_ENDIAN */ -+ -+/*[Driver] config if the operating platform*/ -+#define HALMAC_PLATFORM_WINDOWS 0 -+#define HALMAC_PLATFORM_LINUX 1 -+#define HALMAC_PLATFORM_AP 0 -+/*[Driver] must set HALMAC_PLATFORM_TESTPROGRAM = 0*/ -+#define HALMAC_PLATFORM_TESTPROGRAM 0 -+ -+/*[Driver] config if enable the dbg msg or notl*/ -+#define HALMAC_DBG_MSG_ENABLE 1 -+ -+#define HALMAC_MSG_LEVEL_TRACE 3 -+#define HALMAC_MSG_LEVEL_WARNING 2 -+#define HALMAC_MSG_LEVEL_ERR 1 -+#define HALMAC_MSG_LEVEL_NO_LOG 0 -+/*[Driver] config halmac msg level -+ * Use HALMAC_MSG_LEVEL_XXXX -+ */ -+#define HALMAC_MSG_LEVEL HALMAC_MSG_LEVEL_TRACE -+ -+#ifdef DBG_IO -+#define HALMAC_DBG_MONITOR_IO 1 -+#else -+#define HALMAC_DBG_MONITOR_IO 0 -+#endif /*DBG_IO*/ -+ -+/*[Driver] define the Rx FIFO expanding mode packet size unit for 8821C and 8822B */ -+/*Should be 8 Byte alignment*/ -+#define HALMAC_RX_FIFO_EXPANDING_MODE_PKT_SIZE 80 /*Bytes*/ -+ -+#define HALMAC_USE_TYPEDEF 0 -+ -+/*[Driver] provide the type mutex*/ -+/* Mutex type */ -+typedef _mutex HALMAC_MUTEX; -+ -+#endif /* _HALMAC_2_PLATFORM_H_ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_8821c_cfg.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_8821c_cfg.h -new file mode 100644 -index 000000000..629d4dfdd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_8821c_cfg.h -@@ -0,0 +1,66 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_8821C_CFG_H_ -+#define _HALMAC_8821C_CFG_H_ -+ -+#include "../../halmac_hw_cfg.h" -+#include "../halmac_88xx_cfg.h" -+ -+#if HALMAC_8821C_SUPPORT -+ -+#define TX_FIFO_SIZE_8821C 65536 -+#define RX_FIFO_SIZE_8821C 16384 -+#define TRX_SHARE_SIZE_8821C 32768 -+ -+#define RX_DESC_DUMMY_SIZE_8821C 72 /* 8 * 9 Bytes */ -+#define RX_FIFO_EXPANDING_MODE_PKT_SIZE_MAX_8821C 80 /* 8 Byte alignment*/ -+ -+/* should be 8 Byte alignment*/ -+#if (HALMAC_RX_FIFO_EXPANDING_MODE_PKT_SIZE <= \ -+ RX_FIFO_EXPANDING_MODE_PKT_SIZE_MAX_8821C) -+#define RX_FIFO_EXPANDING_UNIT_8821C (RX_DESC_SIZE_88XX + \ -+ RX_DESC_DUMMY_SIZE_8821C + HALMAC_RX_FIFO_EXPANDING_MODE_PKT_SIZE) -+#else -+#define RX_FIFO_EXPANDING_UNIT_8821C (RX_DESC_SIZE_88XX + \ -+ RX_DESC_DUMMY_SIZE_8821C + RX_FIFO_EXPANDING_MODE_PKT_SIZE_MAX_8821C) -+#endif -+ -+#define TX_FIFO_SIZE_LA_8821C (TX_FIFO_SIZE_8821C >> 1) -+#define TX_FIFO_SIZE_RX_EXPAND_1BLK_8821C \ -+ (TX_FIFO_SIZE_8821C - TRX_SHARE_SIZE_8821C) -+#define RX_FIFO_SIZE_RX_EXPAND_1BLK_8821C \ -+ ((((RX_FIFO_EXPANDING_UNIT_8821C << 8) - 1) >> 10) << 10) -+ -+#define EFUSE_SIZE_8821C 512 -+#define EEPROM_SIZE_8821C 512 -+#define BT_EFUSE_SIZE_8821C 128 -+#define PRTCT_EFUSE_SIZE_8821C 96 -+ -+#define SEC_CAM_NUM_8821C 64 -+ -+#define OQT_ENTRY_AC_8821C 32 -+#define OQT_ENTRY_NOAC_8821C 32 -+#define MACID_MAX_8821C 128 -+ -+#define WLAN_FW_IRAM_MAX_SIZE_8821C 65536 -+#define WLAN_FW_DRAM_MAX_SIZE_8821C 49152 -+#define WLAN_FW_ERAM_MAX_SIZE_8821C 49152 -+#define WLAN_FW_MAX_SIZE_8821C (WLAN_FW_IRAM_MAX_SIZE_8821C + \ -+ WLAN_FW_DRAM_MAX_SIZE_8821C + WLAN_FW_ERAM_MAX_SIZE_8821C) -+ -+#endif /* HALMAC_8821C_SUPPORT */ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_cfg_wmac_8821c.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_cfg_wmac_8821c.c -new file mode 100644 -index 000000000..08ae7a2c8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_cfg_wmac_8821c.c -@@ -0,0 +1,145 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_cfg_wmac_8821c.h" -+#include "halmac_8821c_cfg.h" -+ -+#if HALMAC_8821C_SUPPORT -+ -+/** -+ * cfg_drv_info_8821c() - config driver info -+ * @adapter : the adapter of halmac -+ * @drv_info : driver information selection -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_drv_info_8821c(struct halmac_adapter *adapter, -+ enum halmac_drv_info drv_info) -+{ -+ u8 drv_info_size = 0; -+ u8 phy_status_en = 0; -+ u8 sniffer_en = 0; -+ u8 plcp_hdr_en = 0; -+ u8 value8; -+ u32 value32; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ PLTFM_MSG_TRACE("[TRACE]drv info = %d\n", drv_info); -+ -+ switch (drv_info) { -+ case HALMAC_DRV_INFO_NONE: -+ drv_info_size = 0; -+ phy_status_en = 0; -+ sniffer_en = 0; -+ plcp_hdr_en = 0; -+ break; -+ case HALMAC_DRV_INFO_PHY_STATUS: -+ drv_info_size = 4; -+ phy_status_en = 1; -+ sniffer_en = 0; -+ plcp_hdr_en = 0; -+ break; -+ case HALMAC_DRV_INFO_PHY_SNIFFER: -+ drv_info_size = 5; /* phy status 4byte, sniffer info 1byte */ -+ phy_status_en = 1; -+ sniffer_en = 1; -+ plcp_hdr_en = 0; -+ break; -+ case HALMAC_DRV_INFO_PHY_PLCP: -+ drv_info_size = 6; /* phy status 4byte, plcp header 2byte */ -+ phy_status_en = 1; -+ sniffer_en = 0; -+ plcp_hdr_en = 1; -+ break; -+ default: -+ return HALMAC_RET_SW_CASE_NOT_SUPPORT; -+ } -+ -+ if (adapter->txff_alloc.rx_fifo_exp_mode != -+ HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE) -+ drv_info_size = RX_DESC_DUMMY_SIZE_8821C >> 3; -+ -+ HALMAC_REG_W8(REG_RX_DRVINFO_SZ, drv_info_size); -+ -+ value8 = HALMAC_REG_R8(REG_TRXFF_BNDY + 1); -+ value8 &= 0xF0; -+ /* For rxdesc len = 0 issue */ -+ value8 |= 0xF; -+ HALMAC_REG_W8(REG_TRXFF_BNDY + 1, value8); -+ -+ adapter->drv_info_size = drv_info_size; -+ -+ value32 = HALMAC_REG_R32(REG_RCR); -+ value32 = (value32 & (~BIT_APP_PHYSTS)); -+ if (phy_status_en == 1) -+ value32 = value32 | BIT_APP_PHYSTS; -+ HALMAC_REG_W32(REG_RCR, value32); -+ -+ value32 = HALMAC_REG_R32(REG_WMAC_OPTION_FUNCTION + 4); -+ value32 = (value32 & (~(BIT(8) | BIT(9)))); -+ if (sniffer_en == 1) -+ value32 = value32 | BIT(9); -+ if (plcp_hdr_en == 1) -+ value32 = value32 | BIT(8); -+ HALMAC_REG_W32(REG_WMAC_OPTION_FUNCTION + 4, value32); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * init_low_pwr_8821c() - config WMAC register -+ * @adapter -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+init_low_pwr_8821c(struct halmac_adapter *adapter) -+{ -+ return HALMAC_RET_SUCCESS; -+} -+ -+void -+cfg_rx_ignore_8821c(struct halmac_adapter *adapter, -+ struct halmac_mac_rx_ignore_cfg *cfg) -+{ -+} -+ -+enum halmac_ret_status -+cfg_ampdu_8821c(struct halmac_adapter *adapter, -+ struct halmac_ampdu_config *cfg) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (cfg->ht_max_len != cfg->vht_max_len) { -+ PLTFM_MSG_ERR("[ERR]max len ht != vht!!\n"); -+ return HALMAC_RET_PARA_NOT_SUPPORT; -+ } -+ -+ HALMAC_REG_W8(REG_PROT_MODE_CTRL + 2, cfg->max_agg_num); -+ HALMAC_REG_W8(REG_PROT_MODE_CTRL + 3, cfg->max_agg_num); -+ -+ if (cfg->max_len_en == 1) -+ HALMAC_REG_W32(REG_AMPDU_MAX_LENGTH, cfg->ht_max_len); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+#endif /* HALMAC_8821C_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_cfg_wmac_8821c.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_cfg_wmac_8821c.h -new file mode 100644 -index 000000000..2e0d6b913 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_cfg_wmac_8821c.h -@@ -0,0 +1,40 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_CFG_WMAC_8821C_H_ -+#define _HALMAC_CFG_WMAC_8821C_H_ -+ -+#include "../../halmac_api.h" -+ -+#if HALMAC_8821C_SUPPORT -+ -+enum halmac_ret_status -+cfg_drv_info_8821c(struct halmac_adapter *adapter, -+ enum halmac_drv_info drv_info); -+ -+enum halmac_ret_status -+init_low_pwr_8821c(struct halmac_adapter *adapter); -+ -+void -+cfg_rx_ignore_8821c(struct halmac_adapter *adapter, -+ struct halmac_mac_rx_ignore_cfg *cfg); -+ -+enum halmac_ret_status -+cfg_ampdu_8821c(struct halmac_adapter *adapter, -+ struct halmac_ampdu_config *cfg); -+ -+#endif/* HALMAC_8821C_SUPPORT */ -+ -+#endif/* _HALMAC_CFG_WMAC_8821C_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_common_8821c.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_common_8821c.c -new file mode 100644 -index 000000000..701d298f7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_common_8821c.c -@@ -0,0 +1,182 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_8821c_cfg.h" -+#include "halmac_common_8821c.h" -+#include "../halmac_common_88xx.h" -+#include "halmac_cfg_wmac_8821c.h" -+#if HALMAC_PCIE_SUPPORT -+#include "halmac_pcie_8821c.h" -+#endif -+ -+#if HALMAC_8821C_SUPPORT -+ -+static void -+cfg_ldo25_8821c(struct halmac_adapter *adapter, u8 enable); -+ -+/** -+ * get_hw_value_8821c() -get hw config value -+ * @adapter : the adapter of halmac -+ * @hw_id : hw id for driver to query -+ * @value : hw value, reference table to get data type -+ * Author : KaiYuan Chang / Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_hw_value_8821c(struct halmac_adapter *adapter, enum halmac_hw_id hw_id, -+ void *value) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (!value) { -+ PLTFM_MSG_ERR("[ERR]null pointer\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ -+ if (get_hw_value_88xx(adapter, hw_id, value) == HALMAC_RET_SUCCESS) -+ return HALMAC_RET_SUCCESS; -+ -+ switch (hw_id) { -+ case HALMAC_HW_FW_MAX_SIZE: -+ *(u32 *)value = WLAN_FW_MAX_SIZE_8821C; -+ break; -+ case HALMAC_HW_SDIO_INT_LAT: -+ break; -+ case HALMAC_HW_SDIO_CLK_CNT: -+ break; -+ default: -+ return HALMAC_RET_PARA_NOT_SUPPORT; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * set_hw_value_8821c() -set hw config value -+ * @adapter : the adapter of halmac -+ * @hw_id : hw id for driver to config -+ * @value : hw value, reference table to get data type -+ * Author : KaiYuan Chang / Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+set_hw_value_8821c(struct halmac_adapter *adapter, enum halmac_hw_id hw_id, -+ void *value) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (!value) { -+ PLTFM_MSG_ERR("[ERR]null pointer\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ -+ if (set_hw_value_88xx(adapter, hw_id, value) == HALMAC_RET_SUCCESS) -+ return HALMAC_RET_SUCCESS; -+ -+ switch (hw_id) { -+ case HALMAC_HW_AMPDU_CONFIG: -+ status = cfg_ampdu_8821c(adapter, -+ (struct halmac_ampdu_config *)value); -+ break; -+ case HALMAC_HW_SDIO_TX_FORMAT: -+ break; -+ case HALMAC_HW_RXGCK_FIFO: -+ break; -+ case HALMAC_HW_RX_IGNORE: -+ break; -+ case HALMAC_HW_LDO25_EN: -+ cfg_ldo25_8821c(adapter, *(u8 *)value); -+ break; -+#if HALMAC_PCIE_SUPPORT -+ case HALMAC_HW_PCIE_REF_AUTOK: -+ if (adapter->intf != HALMAC_INTERFACE_PCIE) -+ return HALMAC_RET_WRONG_INTF; -+ status = auto_refclk_cal_8821c_pcie(adapter); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ break; -+#endif -+ case HALMAC_HW_SDIO_WT_EN: -+ break; -+ case HALMAC_HW_SDIO_CLK_MONITOR: -+ break; -+ default: -+ return HALMAC_RET_PARA_NOT_SUPPORT; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return status; -+} -+ -+/** -+ * halmac_fill_txdesc_check_sum_88xx() - fill in tx desc check sum -+ * @adapter : the adapter of halmac -+ * @txdesc : tx desc packet -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+fill_txdesc_check_sum_8821c(struct halmac_adapter *adapter, u8 *txdesc) -+{ -+ __le16 chksum = 0; -+ __le16 *data; -+ u32 i; -+ -+ if (!txdesc) { -+ PLTFM_MSG_ERR("[ERR]null pointer\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ -+ if (adapter->tx_desc_checksum != 1) -+ PLTFM_MSG_TRACE("[TRACE]chksum disable\n"); -+ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, 0x0000); -+ -+ data = (__le16 *)(txdesc); -+ -+ /* HW clculates only 32byte */ -+ for (i = 0; i < 8; i++) -+ chksum ^= (*(data + 2 * i) ^ *(data + (2 * i + 1))); -+ -+ /* *(data + 2 * i) & *(data + (2 * i + 1) have endain issue*/ -+ /* Process eniadn issue after checksum calculation */ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, rtk_le16_to_cpu(chksum)); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static void -+cfg_ldo25_8821c(struct halmac_adapter *adapter, u8 enable) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ value8 = HALMAC_REG_R8(REG_LDO_EFUSE_CTRL + 3); -+ -+ if (enable == 1) -+ HALMAC_REG_W8(REG_LDO_EFUSE_CTRL + 3, (u8)(value8 | BIT(7))); -+ else -+ HALMAC_REG_W8(REG_LDO_EFUSE_CTRL + 3, (u8)(value8 & ~BIT(7))); -+} -+ -+#endif /* HALMAC_8821C_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_common_8821c.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_common_8821c.h -new file mode 100644 -index 000000000..2f22a2a0e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_common_8821c.h -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_COMMON_8821C_H_ -+#define _HALMAC_COMMON_8821C_H_ -+ -+#include "../../halmac_api.h" -+ -+#if HALMAC_8821C_SUPPORT -+ -+enum halmac_ret_status -+get_hw_value_8821c(struct halmac_adapter *adapter, enum halmac_hw_id hw_id, -+ void *value); -+ -+enum halmac_ret_status -+set_hw_value_8821c(struct halmac_adapter *adapter, enum halmac_hw_id hw_id, -+ void *value); -+ -+enum halmac_ret_status -+fill_txdesc_check_sum_8821c(struct halmac_adapter *adapter, u8 *txdesc); -+ -+#endif/* HALMAC_8821C_SUPPORT */ -+ -+#endif/* _HALMAC_COMMON_8821C_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_gpio_8821c.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_gpio_8821c.c -new file mode 100644 -index 000000000..f552d8cc8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_gpio_8821c.c -@@ -0,0 +1,1056 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_gpio_8821c.h" -+#include "../halmac_gpio_88xx.h" -+ -+#if HALMAC_8821C_SUPPORT -+ -+/* P_LED0 definition */ -+#define GPIO0_BT_GPIO0_8821C \ -+ {HALMAC_BT_GPIO, HALMAC_GPIO0, HALMAC_GPIO_IN_OUT, \ -+ 0x66, BIT(2), BIT(2)} -+#define GPIO0_BT_GPIO0_8821C \ -+ {HALMAC_BT_GPIO, HALMAC_GPIO0, HALMAC_GPIO_IN_OUT, \ -+ 0x66, BIT(2), BIT(2)} -+#define GPIO0_BT_ACT_8821C \ -+ {HALMAC_BT_PTA, HALMAC_GPIO0, HALMAC_GPIO_IN_OUT, \ -+ 0x41, BIT(1), 0} -+#define GPIO0_WL_ACT_8821C \ -+ {HALMAC_WL_PTA, HALMAC_GPIO0, HALMAC_GPIO_IN_OUT, \ -+ 0x41, BIT(2), BIT(2)} -+#define GPIO0_WLMAC_DBG_GPIO0_8821C \ -+ {HALMAC_WLMAC_DBG, HALMAC_GPIO0, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0)} -+#define GPIO0_WLPHY_DBG_GPIO0_8821C \ -+ {HALMAC_WLPHY_DBG, HALMAC_GPIO0, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(1)} -+#define GPIO0_BT_DBG_GPIO0_8821C \ -+ {HALMAC_BT_DBG, HALMAC_GPIO0, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0) | BIT(1)} -+#define GPIO0_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO0, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO1 definition */ -+#define GPIO1_BT_GPIO1_8821C \ -+ {HALMAC_BT_GPIO, HALMAC_GPIO1, HALMAC_GPIO_IN_OUT, \ -+ 0x66, BIT(2), BIT(2)} -+#define GPIO1_BT_3DD_SYNC_A_8821C \ -+ {HALMAC_BT_3DDLS_A, HALMAC_GPIO1, HALMAC_GPIO_IN, \ -+ 0x66, BIT(2), BIT(2)} -+#define GPIO1_WL_CK_8821C \ -+ {HALMAC_BT_PTA, HALMAC_GPIO1, HALMAC_GPIO_OUT, \ -+ 0x41, BIT(1), 0} -+#define GPIO1_BT_CK_8821C \ -+ {HALMAC_WL_PTA, HALMAC_GPIO1, HALMAC_GPIO_OUT, \ -+ 0x41, BIT(2), BIT(2)} -+#define GPIO1_WLMAC_DBG_GPIO1_8821C \ -+ {HALMAC_WLMAC_DBG, HALMAC_GPIO1, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0)} -+#define GPIO1_WLPHY_DBG_GPIO1_8821C \ -+ {HALMAC_WLPHY_DBG, HALMAC_GPIO1, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(1)} -+#define GPIO1_BT_DBG_GPIO1_8821C \ -+ {HALMAC_BT_DBG, HALMAC_GPIO1, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0) | BIT(1)} -+#define GPIO1_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO1, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO2 definition */ -+#define GPIO2_BT_GPIO2_8821C \ -+ {HALMAC_BT_GPIO, HALMAC_GPIO2, HALMAC_GPIO_IN_OUT, \ -+ 0x66, BIT(2), BIT(2)} -+#define GPIO2_WL_STATE_8821C \ -+ {HALMAC_BT_PTA, HALMAC_GPIO2, HALMAC_GPIO_OUT, \ -+ 0x41, BIT(1), 0} -+#define GPIO2_BT_STATE_8821C \ -+ {HALMAC_WL_PTA, HALMAC_GPIO2, HALMAC_GPIO_OUT, \ -+ 0x41, BIT(2), BIT(2)} -+#define GPIO2_WLMAC_DBG_GPIO2_8821C \ -+ {HALMAC_WLMAC_DBG, HALMAC_GPIO2, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0)} -+#define GPIO2_WLPHY_DBG_GPIO2_8821C \ -+ {HALMAC_WLPHY_DBG, HALMAC_GPIO2, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(1)} -+#define GPIO2_BT_DBG_GPIO2_8821C \ -+ {HALMAC_BT_DBG, HALMAC_GPIO2, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0) | BIT(1)} -+#define GPIO2_RFE_CTRL_5_8821C \ -+ {HALMAC_WLPHY_RFE_CTRL2GPIO, HALMAC_GPIO2, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(2), BIT(2)} -+#define GPIO2_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO2, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO3 definition */ -+#define GPIO3_BT_GPIO3_8821C \ -+ {HALMAC_BT_GPIO, HALMAC_GPIO3, HALMAC_GPIO_IN_OUT, \ -+ 0x66, BIT(2), BIT(2)} -+#define GPIO3_WL_PRI_8821C \ -+ {HALMAC_BT_PTA, HALMAC_GPIO3, HALMAC_GPIO_OUT, \ -+ 0x41, BIT(1), 0} -+#define GPIO3_BT_PRI_8821C \ -+ {HALMAC_WL_PTA, HALMAC_GPIO3, HALMAC_GPIO_OUT, \ -+ 0x41, BIT(2), BIT(2)} -+#define GPIO3_WLMAC_DBG_GPIO3_8821C \ -+ {HALMAC_WLMAC_DBG, HALMAC_GPIO3, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0)} -+#define GPIO3_WLPHY_DBG_GPIO3_8821C \ -+ {HALMAC_WLPHY_DBG, HALMAC_GPIO3, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(1)} -+#define GPIO3_BT_DBG_GPIO3_8821C \ -+ {HALMAC_BT_DBG, HALMAC_GPIO3, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0) | BIT(1)} -+#define GPIO3_RFE_CTRL_4_8821C \ -+ {HALMAC_WLPHY_RFE_CTRL2GPIO, HALMAC_GPIO3, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(2), BIT(2)} -+#define GPIO3_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO3, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO4 definition */ -+#define GPIO4_BT_SPI_D0_8821C \ -+ {HALMAC_BT_SFLASH, HALMAC_GPIO4, HALMAC_GPIO_IN_OUT, \ -+ 0x66, BIT(4), BIT(4)} -+#define GPIO4_WL_SPI_D0_8821C \ -+ {HALMAC_WL_SFLASH, HALMAC_GPIO4, HALMAC_GPIO_IN_OUT, \ -+ 0x42, BIT(3), BIT(3)} -+#define GPIO4_SDIO_INT_8821C \ -+ {HALMAC_SDIO_INT, HALMAC_GPIO4, HALMAC_GPIO_OUT, \ -+ 0x72, BIT(2), BIT(2)} -+#define GPIO4_JTAG_TRST_8821C \ -+ {HALMAC_JTAG, HALMAC_GPIO4, HALMAC_GPIO_IN, \ -+ 0x67, BIT(0), BIT(0)} -+#define GPIO4_DBG_GNT_WL_8821C \ -+ {HALMAC_DBG_GNT_WL_BT, HALMAC_GPIO4, HALMAC_GPIO_OUT, \ -+ 0x73, BIT(3), BIT(3)} -+#define GPIO4_WLMAC_DBG_GPIO4_8821C \ -+ {HALMAC_WLMAC_DBG, HALMAC_GPIO4, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0)} -+#define GPIO4_WLPHY_DBG_GPIO4_8821C \ -+ {HALMAC_WLPHY_DBG, HALMAC_GPIO4, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(1)} -+#define GPIO4_BT_DBG_GPIO4_8821C \ -+ {HALMAC_BT_DBG, HALMAC_GPIO4, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0) | BIT(1)} -+#define GPIO4_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO4, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO5 definition */ -+#define GPIO5_BT_SPI_D1_8821C \ -+ {HALMAC_BT_SFLASH, HALMAC_GPIO5, HALMAC_GPIO_IN_OUT, \ -+ 0x66, BIT(4), BIT(4)} -+#define GPIO5_WL_SPI_D1_8821C \ -+ {HALMAC_WL_SFLASH, HALMAC_GPIO5, HALMAC_GPIO_IN_OUT, \ -+ 0x42, BIT(3), BIT(3)} -+#define GPIO5_JTAG_TDI_8821C \ -+ {HALMAC_JTAG, HALMAC_GPIO5, HALMAC_GPIO_IN, \ -+ 0x67, BIT(0), BIT(0)} -+#define GPIO5_DBG_GNT_BT_8821C \ -+ {HALMAC_DBG_GNT_WL_BT, HALMAC_GPIO5, HALMAC_GPIO_OUT, \ -+ 0x73, BIT(3), BIT(3)} -+#define GPIO5_WLMAC_DBG_GPIO5_8821C \ -+ {HALMAC_WLMAC_DBG, HALMAC_GPIO5, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0)} -+#define GPIO5_WLPHY_DBG_GPIO5_8821C \ -+ {HALMAC_WLPHY_DBG, HALMAC_GPIO5, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(1)} -+#define GPIO5_BT_DBG_GPIO5_8821C \ -+ {HALMAC_BT_DBG, HALMAC_GPIO5, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0) | BIT(1)} -+#define GPIO5_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO5, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO6 definition */ -+#define GPIO6_BT_SPI_D2_8821C \ -+ {HALMAC_BT_SFLASH, HALMAC_GPIO6, HALMAC_GPIO_IN_OUT, \ -+ 0x66, BIT(4), BIT(4)} -+#define GPIO6_WL_SPI_D2_8821C \ -+ {HALMAC_WL_SFLASH, HALMAC_GPIO6, HALMAC_GPIO_IN_OUT, \ -+ 0x42, BIT(3), BIT(3)} -+#define GPIO6_EEDO_8821C \ -+ {HALMAC_EEPROM, HALMAC_GPIO6, HALMAC_GPIO_IN, \ -+ 0x40, BIT(4), BIT(4)} -+#define GPIO6_JTAG_TDO_8821C \ -+ {HALMAC_JTAG, HALMAC_GPIO6, HALMAC_GPIO_OUT, \ -+ 0x67, BIT(0), BIT(0)} -+#define GPIO6_BT_3DD_SYNC_B_8821C \ -+ {HALMAC_BT_3DDLS_B, HALMAC_GPIO6, HALMAC_GPIO_IN, \ -+ 0x67, BIT(1), BIT(1)} -+#define GPIO6_BT_GPIO18_8821C \ -+ {HALMAC_BT_GPIO, HALMAC_GPIO6, HALMAC_GPIO_IN_OUT, \ -+ 0x67, BIT(1), BIT(1)} -+#define GPIO6_SIN_8821C \ -+ {HALMAC_WL_UART, HALMAC_GPIO6, HALMAC_GPIO_IN, \ -+ 0x41, BIT(0), BIT(0)} -+#define GPIO6_WLMAC_DBG_GPIO6_8821C \ -+ {HALMAC_WLMAC_DBG, HALMAC_GPIO6, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0)} -+#define GPIO6_WLPHY_DBG_GPIO6_8821C \ -+ {HALMAC_WLPHY_DBG, HALMAC_GPIO6, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(1)} -+#define GPIO6_BT_DBG_GPIO6_8821C \ -+ {HALMAC_BT_DBG, HALMAC_GPIO6, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0) | BIT(1)} -+#define GPIO6_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO6, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO7 definition */ -+#define GPIO7_BT_SPI_D3_8821C \ -+ {HALMAC_BT_SFLASH, HALMAC_GPIO7, HALMAC_GPIO_IN_OUT, \ -+ 0x66, BIT(4), BIT(4)} -+#define GPIO7_WL_SPI_D3_8821C \ -+ {HALMAC_WL_SFLASH, HALMAC_GPIO7, HALMAC_GPIO_IN_OUT, \ -+ 0x42, BIT(3), BIT(3)} -+#define GPIO7_EEDI_8821C \ -+ {HALMAC_EEPROM, HALMAC_GPIO7, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(4), BIT(4)} -+#define GPIO7_JTAG_TMS_8821C \ -+ {HALMAC_JTAG, HALMAC_GPIO7, HALMAC_GPIO_IN, \ -+ 0x67, BIT(0), BIT(0)} -+#define GPIO7_BT_GPIO16_8821C \ -+ {HALMAC_BT_GPIO, HALMAC_GPIO7, HALMAC_GPIO_IN_OUT, \ -+ 0x67, BIT(2), BIT(2)} -+#define GPIO7_SOUT_8821C \ -+ {HALMAC_WL_UART, HALMAC_GPIO7, HALMAC_GPIO_OUT, \ -+ 0x41, BIT(0), BIT(0)} -+#define GPIO7_WLMAC_DBG_GPIO7_8821C \ -+ {HALMAC_WLMAC_DBG, HALMAC_GPIO7, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0)} -+#define GPIO7_WLPHY_DBG_GPIO7_8821C \ -+ {HALMAC_WLPHY_DBG, HALMAC_GPIO7, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(1)} -+#define GPIO7_BT_DBG_GPIO7_8821C \ -+ {HALMAC_BT_DBG, HALMAC_GPIO7, HALMAC_GPIO_OUT, \ -+ 0x40, BIT(1) | BIT(0), BIT(0) | BIT(1)} -+#define GPIO7_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO7, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO8 definition */ -+#define GPIO8_WL_EXT_WOL_8821C \ -+ {HALMAC_WL_HW_EXTWOL, HALMAC_GPIO8, HALMAC_GPIO_IN, \ -+ 0x4a, BIT(0) | BIT(1), BIT(0) | BIT(1)} -+#define GPIO8_WL_LED_8821C \ -+ {HALMAC_WL_LED, HALMAC_GPIO8, HALMAC_GPIO_OUT, \ -+ 0x4e, BIT(5), BIT(5)} -+#define GPIO8_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO8, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO9 definition */ -+#define GPIO9_DIS_WL_N_8821C \ -+ {HALMAC_WL_HWPDN, HALMAC_GPIO9, HALMAC_GPIO_IN, \ -+ 0x68, BIT(3) | BIT(0), BIT(3) | BIT(0)} -+#define GPIO9_WL_EXT_WOL_8821C \ -+ {HALMAC_WL_HW_EXTWOL, HALMAC_GPIO9, HALMAC_GPIO_IN, \ -+ 0x4a, BIT(0) | BIT(1), BIT(0)} -+#define GPIO9_USCTS0_8821C \ -+ {HALMAC_UART0, HALMAC_GPIO9, HALMAC_GPIO_IN, \ -+ 0x66, BIT(6), BIT(6)} -+#define GPIO9_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO9, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO10 definition */ -+#define GPIO10_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO10, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO11 definition */ -+#define GPIO11_DIS_BT_N_8821C \ -+ {HALMAC_BT_HWPDN, HALMAC_GPIO11, HALMAC_GPIO_IN, \ -+ 0x6a, BIT(0), BIT(0)} -+#define GPIO11_USOUT0_8821C \ -+ {HALMAC_UART0, HALMAC_GPIO11, HALMAC_GPIO_OUT, \ -+ 0x66, BIT(6), BIT(6)} -+#define GPIO11_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO11, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO12 definition */ -+#define GPIO12_USIN0_8821C \ -+ {HALMAC_UART0, HALMAC_GPIO12, HALMAC_GPIO_IN, \ -+ 0x66, BIT(6), BIT(6)} -+#define GPIO12_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO12, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO13 definition */ -+#define GPIO13_BT_WAKE_8821C \ -+ {HALMAC_GPIO13_14_WL_CTRL_EN, HALMAC_GPIO13, HALMAC_GPIO_IN, \ -+ 0x4e, BIT(6), BIT(6)} -+#define GPIO13_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO13, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO14 definition */ -+#define GPIO14_UART_WAKE_8821C \ -+ {HALMAC_GPIO13_14_WL_CTRL_EN, HALMAC_GPIO14, HALMAC_GPIO_OUT, \ -+ 0x4e, BIT(6), BIT(6)} -+#define GPIO14_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO14, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+/* GPIO15 definition */ -+#define GPIO15_EXT_XTAL_8821C \ -+ {HALMAC_EXT_XTAL, HALMAC_GPIO15, HALMAC_GPIO_OUT, \ -+ 0x66, BIT(7), BIT(7)} -+#define GPIO15_SW_IO_8821C \ -+ {HALMAC_SW_IO, HALMAC_GPIO15, HALMAC_GPIO_IN_OUT, \ -+ 0x40, BIT(1) | BIT(0), 0} -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO0_8821C[] = { -+ GPIO0_BT_GPIO0_8821C, -+ GPIO0_BT_ACT_8821C, -+ GPIO0_WL_ACT_8821C, -+ GPIO0_WLMAC_DBG_GPIO0_8821C, -+ GPIO0_WLPHY_DBG_GPIO0_8821C, -+ GPIO0_BT_DBG_GPIO0_8821C, -+ GPIO0_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO1_8821C[] = { -+ GPIO1_BT_GPIO1_8821C, -+ GPIO1_BT_3DD_SYNC_A_8821C, -+ GPIO1_WL_CK_8821C, -+ GPIO1_BT_CK_8821C, -+ GPIO1_WLMAC_DBG_GPIO1_8821C, -+ GPIO1_WLPHY_DBG_GPIO1_8821C, -+ GPIO1_BT_DBG_GPIO1_8821C, -+ GPIO1_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO2_8821C[] = { -+ GPIO2_BT_GPIO2_8821C, -+ GPIO2_WL_STATE_8821C, -+ GPIO2_BT_STATE_8821C, -+ GPIO2_WLMAC_DBG_GPIO2_8821C, -+ GPIO2_WLPHY_DBG_GPIO2_8821C, -+ GPIO2_BT_DBG_GPIO2_8821C, -+ GPIO2_RFE_CTRL_5_8821C, -+ GPIO2_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO3_8821C[] = { -+ GPIO3_BT_GPIO3_8821C, -+ GPIO3_WL_PRI_8821C, -+ GPIO3_BT_PRI_8821C, -+ GPIO3_WLMAC_DBG_GPIO3_8821C, -+ GPIO3_WLPHY_DBG_GPIO3_8821C, -+ GPIO3_BT_DBG_GPIO3_8821C, -+ GPIO3_RFE_CTRL_4_8821C, -+ GPIO3_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO4_8821C[] = { -+ GPIO4_BT_SPI_D0_8821C, -+ GPIO4_WL_SPI_D0_8821C, -+ GPIO4_SDIO_INT_8821C, -+ GPIO4_JTAG_TRST_8821C, -+ GPIO4_DBG_GNT_WL_8821C, -+ GPIO4_WLMAC_DBG_GPIO4_8821C, -+ GPIO4_WLPHY_DBG_GPIO4_8821C, -+ GPIO4_BT_DBG_GPIO4_8821C, -+ GPIO4_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO5_8821C[] = { -+ GPIO5_BT_SPI_D1_8821C, -+ GPIO5_WL_SPI_D1_8821C, -+ GPIO5_JTAG_TDI_8821C, -+ GPIO5_DBG_GNT_BT_8821C, -+ GPIO5_WLMAC_DBG_GPIO5_8821C, -+ GPIO5_WLPHY_DBG_GPIO5_8821C, -+ GPIO5_BT_DBG_GPIO5_8821C, -+ GPIO5_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO6_8821C[] = { -+ GPIO6_BT_SPI_D2_8821C, -+ GPIO6_WL_SPI_D2_8821C, -+ GPIO6_EEDO_8821C, -+ GPIO6_JTAG_TDO_8821C, -+ GPIO6_BT_3DD_SYNC_B_8821C, -+ GPIO6_BT_GPIO18_8821C, -+ GPIO6_SIN_8821C, -+ GPIO6_WLMAC_DBG_GPIO6_8821C, -+ GPIO6_WLPHY_DBG_GPIO6_8821C, -+ GPIO6_BT_DBG_GPIO6_8821C, -+ GPIO6_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO7_8821C[] = { -+ GPIO7_BT_SPI_D3_8821C, -+ GPIO7_WL_SPI_D3_8821C, -+ GPIO7_EEDI_8821C, -+ GPIO7_JTAG_TMS_8821C, -+ GPIO7_BT_GPIO16_8821C, -+ GPIO7_SOUT_8821C, -+ GPIO7_WLMAC_DBG_GPIO7_8821C, -+ GPIO7_WLPHY_DBG_GPIO7_8821C, -+ GPIO7_BT_DBG_GPIO7_8821C, -+ GPIO7_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO8_8821C[] = { -+ GPIO8_WL_EXT_WOL_8821C, -+ GPIO8_WL_LED_8821C, -+ GPIO8_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO9_8821C[] = { -+ GPIO9_DIS_WL_N_8821C, -+ GPIO9_WL_EXT_WOL_8821C, -+ GPIO9_USCTS0_8821C, -+ GPIO9_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO10_8821C[] = { -+ GPIO10_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO11_8821C[] = { -+ GPIO11_DIS_BT_N_8821C, -+ GPIO11_USOUT0_8821C, -+ GPIO11_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO12_8821C[] = { -+ GPIO12_USIN0_8821C, -+ GPIO12_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO13_8821C[] = { -+ GPIO13_BT_WAKE_8821C, -+ GPIO13_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO14_8821C[] = { -+ GPIO14_UART_WAKE_8821C, -+ GPIO14_SW_IO_8821C -+}; -+ -+static const struct halmac_gpio_pimux_list PINMUX_LIST_GPIO15_8821C[] = { -+ GPIO15_EXT_XTAL_8821C, -+ GPIO15_SW_IO_8821C -+}; -+ -+static enum halmac_ret_status -+get_pinmux_list_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func, -+ const struct halmac_gpio_pimux_list **list, -+ u32 *list_size, u32 *gpio_id); -+ -+static enum halmac_ret_status -+chk_pinmux_valid_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func); -+ -+static enum halmac_ret_status -+pinmux_switch_8821c(struct halmac_adapter *adapter, -+ const struct halmac_gpio_pimux_list *list, u32 size, -+ u32 gpio_id, enum halmac_gpio_func gpio_func); -+ -+static enum halmac_ret_status -+pinmux_record_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func, u8 val); -+/** -+ * pinmux_get_func_8821c() -get current gpio status -+ * @adapter : the adapter of halmac -+ * @gpio_func : gpio function -+ * @enable : function is enable(1) or disable(0) -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+pinmux_get_func_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func, u8 *enable) -+{ -+ u32 list_size; -+ u32 cur_func; -+ u32 gpio_id; -+ enum halmac_ret_status status; -+ const struct halmac_gpio_pimux_list *list = NULL; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ status = get_pinmux_list_8821c(adapter, gpio_func, &list, &list_size, -+ &gpio_id); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ status = pinmux_parser_88xx(adapter, list, list_size, gpio_id, -+ &cur_func); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ switch (gpio_func) { -+ case HALMAC_GPIO_FUNC_WL_LED: -+ *enable = (cur_func == HALMAC_WL_LED) ? 1 : 0; -+ break; -+ case HALMAC_GPIO_FUNC_SDIO_INT: -+ *enable = (cur_func == HALMAC_SDIO_INT) ? 1 : 0; -+ break; -+ case HALMAC_GPIO_FUNC_BT_HOST_WAKE1: -+ case HALMAC_GPIO_FUNC_BT_DEV_WAKE1: -+ *enable = (cur_func == HALMAC_GPIO13_14_WL_CTRL_EN) ? 1 : 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_0: -+ case HALMAC_GPIO_FUNC_SW_IO_1: -+ case HALMAC_GPIO_FUNC_SW_IO_2: -+ case HALMAC_GPIO_FUNC_SW_IO_3: -+ case HALMAC_GPIO_FUNC_SW_IO_4: -+ case HALMAC_GPIO_FUNC_SW_IO_5: -+ case HALMAC_GPIO_FUNC_SW_IO_6: -+ case HALMAC_GPIO_FUNC_SW_IO_7: -+ case HALMAC_GPIO_FUNC_SW_IO_8: -+ case HALMAC_GPIO_FUNC_SW_IO_9: -+ case HALMAC_GPIO_FUNC_SW_IO_10: -+ case HALMAC_GPIO_FUNC_SW_IO_11: -+ case HALMAC_GPIO_FUNC_SW_IO_12: -+ case HALMAC_GPIO_FUNC_SW_IO_13: -+ case HALMAC_GPIO_FUNC_SW_IO_14: -+ case HALMAC_GPIO_FUNC_SW_IO_15: -+ *enable = (cur_func == HALMAC_SW_IO) ? 1 : 0; -+ break; -+ case HALMAC_GPIO_FUNC_S0_PAPE: -+ case HALMAC_GPIO_FUNC_S0_TRSW: -+ case HALMAC_GPIO_FUNC_S0_TRSWB: -+ case HALMAC_GPIO_FUNC_S1_PAPE: -+ case HALMAC_GPIO_FUNC_S1_TRSW: -+ case HALMAC_GPIO_FUNC_S1_TRSWB: -+ *enable = 0; -+ return HALMAC_RET_PINMUX_NOT_SUPPORT; -+ default: -+ *enable = 0; -+ return HALMAC_RET_GET_PINMUX_ERR; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * pinmux_set_func_8821c() -set gpio function -+ * @adapter : the adapter of halmac -+ * @gpio_func : gpio function -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+pinmux_set_func_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func) -+{ -+ u32 list_size; -+ u32 gpio_id; -+ enum halmac_ret_status status; -+ const struct halmac_gpio_pimux_list *list = NULL; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ PLTFM_MSG_TRACE("[TRACE]func name : %d\n", gpio_func); -+ -+ status = chk_pinmux_valid_8821c(adapter, gpio_func); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ status = get_pinmux_list_8821c(adapter, gpio_func, &list, &list_size, -+ &gpio_id); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ status = pinmux_switch_8821c(adapter, list, list_size, gpio_id, -+ gpio_func); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ status = pinmux_record_8821c(adapter, gpio_func, 1); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * pinmux_free_func_8821c() -free locked gpio function -+ * @adapter : the adapter of halmac -+ * @gpio_func : gpio function -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+pinmux_free_func_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func) -+{ -+ struct halmac_pinmux_info *info = &adapter->pinmux_info; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ switch (gpio_func) { -+ case HALMAC_GPIO_FUNC_SW_IO_0: -+ info->sw_io_0 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_1: -+ info->sw_io_1 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_2: -+ info->sw_io_2 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_3: -+ info->sw_io_3 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_4: -+ case HALMAC_GPIO_FUNC_SDIO_INT: -+ info->sw_io_4 = 0; -+ info->sdio_int = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_5: -+ info->sw_io_5 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_6: -+ info->sw_io_6 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_7: -+ info->sw_io_7 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_8: -+ case HALMAC_GPIO_FUNC_WL_LED: -+ info->sw_io_8 = 0; -+ info->wl_led = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_9: -+ info->sw_io_9 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_10: -+ info->sw_io_10 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_11: -+ info->sw_io_11 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_12: -+ info->sw_io_12 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_13: -+ case HALMAC_GPIO_FUNC_BT_DEV_WAKE1: -+ info->bt_dev_wake = 0; -+ info->sw_io_13 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_14: -+ case HALMAC_GPIO_FUNC_BT_HOST_WAKE1: -+ info->bt_host_wake = 0; -+ info->sw_io_14 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_15: -+ info->sw_io_15 = 0; -+ break; -+ case HALMAC_GPIO_FUNC_S0_PAPE: -+ case HALMAC_GPIO_FUNC_S0_TRSW: -+ case HALMAC_GPIO_FUNC_S0_TRSWB: -+ case HALMAC_GPIO_FUNC_S1_PAPE: -+ case HALMAC_GPIO_FUNC_S1_TRSW: -+ case HALMAC_GPIO_FUNC_S1_TRSWB: -+ return HALMAC_RET_PINMUX_NOT_SUPPORT; -+ default: -+ return HALMAC_RET_SWITCH_CASE_ERROR; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]func : %X\n", gpio_func); -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_pinmux_list_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func, -+ const struct halmac_gpio_pimux_list **list, -+ u32 *list_size, u32 *gpio_id) -+{ -+ switch (gpio_func) { -+ case HALMAC_GPIO_FUNC_SW_IO_0: -+ *list = PINMUX_LIST_GPIO0_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO0_8821C); -+ *gpio_id = HALMAC_GPIO0; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_1: -+ *list = PINMUX_LIST_GPIO1_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO1_8821C); -+ *gpio_id = HALMAC_GPIO1; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_2: -+ *list = PINMUX_LIST_GPIO2_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO2_8821C); -+ *gpio_id = HALMAC_GPIO2; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_3: -+ *list = PINMUX_LIST_GPIO3_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO3_8821C); -+ *gpio_id = HALMAC_GPIO3; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_4: -+ case HALMAC_GPIO_FUNC_SDIO_INT: -+ *list = PINMUX_LIST_GPIO4_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO4_8821C); -+ *gpio_id = HALMAC_GPIO4; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_5: -+ *list = PINMUX_LIST_GPIO5_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO5_8821C); -+ *gpio_id = HALMAC_GPIO5; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_6: -+ *list = PINMUX_LIST_GPIO6_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO6_8821C); -+ *gpio_id = HALMAC_GPIO6; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_7: -+ *list = PINMUX_LIST_GPIO7_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO7_8821C); -+ *gpio_id = HALMAC_GPIO7; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_8: -+ case HALMAC_GPIO_FUNC_WL_LED: -+ *list = PINMUX_LIST_GPIO8_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO8_8821C); -+ *gpio_id = HALMAC_GPIO8; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_9: -+ *list = PINMUX_LIST_GPIO9_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO9_8821C); -+ *gpio_id = HALMAC_GPIO9; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_10: -+ *list = PINMUX_LIST_GPIO10_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO10_8821C); -+ *gpio_id = HALMAC_GPIO10; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_11: -+ *list = PINMUX_LIST_GPIO11_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO11_8821C); -+ *gpio_id = HALMAC_GPIO11; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_12: -+ *list = PINMUX_LIST_GPIO12_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO12_8821C); -+ *gpio_id = HALMAC_GPIO12; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_13: -+ case HALMAC_GPIO_FUNC_BT_DEV_WAKE1: -+ *list = PINMUX_LIST_GPIO13_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO13_8821C); -+ *gpio_id = HALMAC_GPIO13; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_14: -+ case HALMAC_GPIO_FUNC_BT_HOST_WAKE1: -+ *list = PINMUX_LIST_GPIO14_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO14_8821C); -+ *gpio_id = HALMAC_GPIO14; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_15: -+ *list = PINMUX_LIST_GPIO15_8821C; -+ *list_size = ARRAY_SIZE(PINMUX_LIST_GPIO15_8821C); -+ *gpio_id = HALMAC_GPIO15; -+ break; -+ default: -+ return HALMAC_RET_SWITCH_CASE_ERROR; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+chk_pinmux_valid_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func) -+{ -+ struct halmac_pinmux_info *info = &adapter->pinmux_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ switch (gpio_func) { -+ case HALMAC_GPIO_FUNC_SW_IO_0: -+ if (info->sw_io_0 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_1: -+ if (info->sw_io_1 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_2: -+ if (info->sw_io_2 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_3: -+ if (info->sw_io_3 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_4: -+ case HALMAC_GPIO_FUNC_SDIO_INT: -+ if (info->sw_io_4 == 1 || info->sdio_int == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_5: -+ if (info->sw_io_5 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_6: -+ if (info->sw_io_6 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_7: -+ if (info->sw_io_7 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_8: -+ if (info->sw_io_8 == 1 || info->wl_led == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_WL_LED: -+ if (info->sw_io_8 == 1 || info->wl_led == 1 || -+ info->bt_dev_wake == 1 || info->bt_host_wake == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_9: -+ if (info->sw_io_9 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_10: -+ if (info->sw_io_10 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_11: -+ if (info->sw_io_11 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_12: -+ if (info->sw_io_12 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_13: -+ if (info->sw_io_13 == 1 || info->bt_dev_wake == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_BT_DEV_WAKE1: -+ if (info->sw_io_13 == 1 || info->bt_dev_wake == 1 || -+ info->wl_led == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_14: -+ if (info->sw_io_14 == 1 || info->bt_host_wake == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_BT_HOST_WAKE1: -+ if (info->sw_io_14 == 1 || info->bt_host_wake == 1 || -+ info->wl_led == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_15: -+ if (info->sw_io_15 == 1) -+ status = HALMAC_RET_PINMUX_USED; -+ break; -+ case HALMAC_GPIO_FUNC_S0_PAPE: -+ case HALMAC_GPIO_FUNC_S0_TRSW: -+ case HALMAC_GPIO_FUNC_S0_TRSWB: -+ case HALMAC_GPIO_FUNC_S1_PAPE: -+ case HALMAC_GPIO_FUNC_S1_TRSW: -+ case HALMAC_GPIO_FUNC_S1_TRSWB: -+ return HALMAC_RET_PINMUX_NOT_SUPPORT; -+ default: -+ return HALMAC_RET_SWITCH_CASE_ERROR; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]chk_pinmux_valid func : %X status : %X\n", -+ gpio_func, status); -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+pinmux_switch_8821c(struct halmac_adapter *adapter, -+ const struct halmac_gpio_pimux_list *list, u32 size, -+ u32 gpio_id, enum halmac_gpio_func gpio_func) -+{ -+ u32 i; -+ u8 value8; -+ u16 switch_func; -+ const struct halmac_gpio_pimux_list *cur_list = list; -+ enum halmac_gpio_cfg_state *state; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ state = &adapter->halmac_state.gpio_cfg_state; -+ -+ if (*state == HALMAC_GPIO_CFG_STATE_BUSY) -+ return HALMAC_RET_BUSY_STATE; -+ -+ switch (gpio_func) { -+ case HALMAC_GPIO_FUNC_WL_LED: -+ switch_func = HALMAC_WL_LED; -+ break; -+ case HALMAC_GPIO_FUNC_SDIO_INT: -+ switch_func = HALMAC_SDIO_INT; -+ break; -+ case HALMAC_GPIO_FUNC_BT_HOST_WAKE1: -+ case HALMAC_GPIO_FUNC_BT_DEV_WAKE1: -+ switch_func = HALMAC_GPIO13_14_WL_CTRL_EN; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_0: -+ case HALMAC_GPIO_FUNC_SW_IO_1: -+ case HALMAC_GPIO_FUNC_SW_IO_2: -+ case HALMAC_GPIO_FUNC_SW_IO_3: -+ case HALMAC_GPIO_FUNC_SW_IO_4: -+ case HALMAC_GPIO_FUNC_SW_IO_5: -+ case HALMAC_GPIO_FUNC_SW_IO_6: -+ case HALMAC_GPIO_FUNC_SW_IO_7: -+ case HALMAC_GPIO_FUNC_SW_IO_8: -+ case HALMAC_GPIO_FUNC_SW_IO_9: -+ case HALMAC_GPIO_FUNC_SW_IO_10: -+ case HALMAC_GPIO_FUNC_SW_IO_11: -+ case HALMAC_GPIO_FUNC_SW_IO_12: -+ case HALMAC_GPIO_FUNC_SW_IO_13: -+ case HALMAC_GPIO_FUNC_SW_IO_14: -+ case HALMAC_GPIO_FUNC_SW_IO_15: -+ switch_func = HALMAC_SW_IO; -+ break; -+ default: -+ return HALMAC_RET_SWITCH_CASE_ERROR; -+ } -+ -+ for (i = 0; i < size; i++) { -+ if (gpio_id != cur_list->id) { -+ PLTFM_MSG_ERR("[ERR]offset:%X, value:%X, func:%X\n", -+ cur_list->offset, cur_list->value, -+ cur_list->func); -+ PLTFM_MSG_ERR("[ERR]id1 : %X, id2 : %X\n", -+ gpio_id, cur_list->id); -+ return HALMAC_RET_GET_PINMUX_ERR; -+ } -+ -+ if (switch_func == cur_list->func) -+ break; -+ -+ cur_list++; -+ } -+ -+ if (i == size) { -+ PLTFM_MSG_ERR("[ERR]gpio func error:%X %X\n", -+ gpio_id, cur_list->id); -+ return HALMAC_RET_GET_PINMUX_ERR; -+ } -+ -+ *state = HALMAC_GPIO_CFG_STATE_BUSY; -+ -+ cur_list = list; -+ for (i = 0; i < size; i++) { -+ value8 = HALMAC_REG_R8(cur_list->offset); -+ value8 &= ~(cur_list->msk); -+ -+ if (switch_func == cur_list->func) { -+ value8 |= (cur_list->value & cur_list->msk); -+ HALMAC_REG_W8(cur_list->offset, value8); -+ break; -+ } -+ -+ value8 |= (~cur_list->value & cur_list->msk); -+ HALMAC_REG_W8(cur_list->offset, value8); -+ -+ cur_list++; -+ } -+ -+ *state = HALMAC_GPIO_CFG_STATE_IDLE; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+pinmux_record_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func, u8 val) -+{ -+ switch (gpio_func) { -+ case HALMAC_GPIO_FUNC_WL_LED: -+ adapter->pinmux_info.wl_led = val; -+ break; -+ case HALMAC_GPIO_FUNC_SDIO_INT: -+ adapter->pinmux_info.sdio_int = val; -+ break; -+ case HALMAC_GPIO_FUNC_BT_HOST_WAKE1: -+ adapter->pinmux_info.bt_host_wake = val; -+ break; -+ case HALMAC_GPIO_FUNC_BT_DEV_WAKE1: -+ adapter->pinmux_info.bt_dev_wake = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_0: -+ adapter->pinmux_info.sw_io_0 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_1: -+ adapter->pinmux_info.sw_io_1 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_2: -+ adapter->pinmux_info.sw_io_2 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_3: -+ adapter->pinmux_info.sw_io_3 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_4: -+ adapter->pinmux_info.sw_io_4 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_5: -+ adapter->pinmux_info.sw_io_5 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_6: -+ adapter->pinmux_info.sw_io_6 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_7: -+ adapter->pinmux_info.sw_io_7 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_8: -+ adapter->pinmux_info.sw_io_8 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_9: -+ adapter->pinmux_info.sw_io_9 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_10: -+ adapter->pinmux_info.sw_io_10 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_11: -+ adapter->pinmux_info.sw_io_11 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_12: -+ adapter->pinmux_info.sw_io_12 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_13: -+ adapter->pinmux_info.sw_io_13 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_14: -+ adapter->pinmux_info.sw_io_14 = val; -+ break; -+ case HALMAC_GPIO_FUNC_SW_IO_15: -+ adapter->pinmux_info.sw_io_15 = val; -+ break; -+ default: -+ return HALMAC_RET_GET_PINMUX_ERR; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+#endif /* HALMAC_8821C_SUPPORT */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_gpio_8821c.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_gpio_8821c.h -new file mode 100644 -index 000000000..6c9ac478b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_gpio_8821c.h -@@ -0,0 +1,37 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_GPIO_8821C_H_ -+#define _HALMAC_GPIO_8821C_H_ -+ -+#include "../../halmac_api.h" -+ -+#if HALMAC_8821C_SUPPORT -+ -+enum halmac_ret_status -+pinmux_get_func_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func, u8 *enable); -+ -+enum halmac_ret_status -+pinmux_set_func_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func); -+ -+enum halmac_ret_status -+pinmux_free_func_8821c(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func); -+ -+#endif /* HALMAC_8821C_SUPPORT */ -+ -+#endif/* _HALMAC_GPIO_8821C_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_init_8821c.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_init_8821c.c -new file mode 100644 -index 000000000..4c832cccc ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_init_8821c.c -@@ -0,0 +1,1031 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_init_8821c.h" -+#include "halmac_8821c_cfg.h" -+#if HALMAC_PCIE_SUPPORT -+#include "halmac_pcie_8821c.h" -+#endif -+#if HALMAC_SDIO_SUPPORT -+#include "halmac_sdio_8821c.h" -+#include "../halmac_sdio_88xx.h" -+#endif -+#if HALMAC_USB_SUPPORT -+#include "halmac_usb_8821c.h" -+#endif -+#include "halmac_gpio_8821c.h" -+#include "halmac_common_8821c.h" -+#include "halmac_cfg_wmac_8821c.h" -+#include "../halmac_common_88xx.h" -+#include "../halmac_init_88xx.h" -+ -+#if HALMAC_8821C_SUPPORT -+ -+#define SYS_FUNC_EN 0xD8 -+ -+#define RSVD_PG_DRV_NUM 16 -+#define RSVD_PG_H2C_EXTRAINFO_NUM 24 -+#define RSVD_PG_H2C_STATICINFO_NUM 8 -+#define RSVD_PG_H2CQ_NUM 8 -+#define RSVD_PG_CPU_INSTRUCTION_NUM 0 -+#define RSVD_PG_FW_TXBUF_NUM 4 -+#define RSVD_PG_CSIBUF_NUM 0 -+#define RSVD_PG_DLLB_NUM (TX_FIFO_SIZE_8821C / 3 >> \ -+ TX_PAGE_SIZE_SHIFT_88XX) -+ -+#define MAC_TRX_ENABLE (BIT_HCI_TXDMA_EN | BIT_HCI_RXDMA_EN | BIT_TXDMA_EN | \ -+ BIT_RXDMA_EN | BIT_PROTOCOL_EN | BIT_SCHEDULE_EN | \ -+ BIT_MACTXEN | BIT_MACRXEN) -+ -+#define BLK_DESC_NUM 0x3 -+ -+#define WLAN_SLOT_TIME 0x09 -+#define WLAN_PIFS_TIME 0x19 -+#define WLAN_SIFS_CCK_CONT_TX 0xA -+#define WLAN_SIFS_OFDM_CONT_TX 0xE -+#define WLAN_SIFS_CCK_TRX 0x10 -+#define WLAN_SIFS_OFDM_TRX 0x10 -+#define WLAN_VO_TXOP_LIMIT 0x186 /* unit : 32us */ -+#define WLAN_VI_TXOP_LIMIT 0x3BC /* unit : 32us */ -+#define WLAN_RDG_NAV 0x05 -+#define WLAN_TXOP_NAV 0x1B -+#define WLAN_CCK_RX_TSF 0x30 -+#define WLAN_OFDM_RX_TSF 0x30 -+#define WLAN_TBTT_PROHIBIT 0x04 /* unit : 32us */ -+#define WLAN_TBTT_HOLD_TIME 0x064 /* unit : 32us */ -+#define WLAN_DRV_EARLY_INT 0x04 -+#define WLAN_BCN_DMA_TIME 0x02 -+#define WLAN_ACK_TO_CCK 0x40 -+ -+#define WLAN_RX_FILTER0 0x0FFFFFFF -+#define WLAN_RX_FILTER2 0xFFFF -+#define WLAN_RCR_CFG 0xE400220E -+#define WLAN_RXPKT_MAX_SZ 12288 -+#define WLAN_RXPKT_MAX_SZ_512 (WLAN_RXPKT_MAX_SZ >> 9) -+ -+#define WLAN_AMPDU_MAX_TIME 0x70 -+#define WLAN_RTS_LEN_TH 0xFF -+#define WLAN_RTS_TX_TIME_TH 0x08 -+#define WLAN_MAX_AGG_PKT_LIMIT 0x10 -+#define WLAN_RTS_MAX_AGG_PKT_LIMIT 0x10 -+#define WLAN_MAX_AGG_PKT_LIMIT_SDIO 0x2B -+#define WLAN_RTS_MAX_AGG_PKT_LIMIT_SDIO 0x2B -+#define WLAN_PRE_TXCNT_TIME_TH 0x1E4 -+#define WALN_FAST_EDCA_VO_TH 0x06 -+#define WLAN_FAST_EDCA_VI_TH 0x06 -+#define WLAN_FAST_EDCA_BE_TH 0x06 -+#define WLAN_FAST_EDCA_BK_TH 0x06 -+#define WLAN_BAR_RETRY_LIMIT 0x01 -+#define WLAN_RA_TRY_RATE_AGG_LIMIT 0x08 -+ -+#define WLAN_TX_FUNC_CFG1 0x30 -+#define WLAN_TX_FUNC_CFG2 0x30 -+#define WLAN_MAC_OPT_NORM_FUNC1 0x98 -+#define WLAN_MAC_OPT_LB_FUNC1 0x80 -+#define WLAN_MAC_OPT_FUNC2 0x30810041 -+ -+#define WLAN_SIFS_CFG (WLAN_SIFS_CCK_CONT_TX | \ -+ (WLAN_SIFS_OFDM_CONT_TX << BIT_SHIFT_SIFS_OFDM_CTX) | \ -+ (WLAN_SIFS_CCK_TRX << BIT_SHIFT_SIFS_CCK_TRX) | \ -+ (WLAN_SIFS_OFDM_TRX << BIT_SHIFT_SIFS_OFDM_TRX)) -+ -+#define WLAN_TBTT_TIME (WLAN_TBTT_PROHIBIT |\ -+ (WLAN_TBTT_HOLD_TIME << BIT_SHIFT_TBTT_HOLD_TIME_AP)) -+ -+#define WLAN_NAV_CFG (WLAN_RDG_NAV | (WLAN_TXOP_NAV << 16)) -+#define WLAN_RX_TSF_CFG (WLAN_CCK_RX_TSF | (WLAN_OFDM_RX_TSF) << 8) -+ -+#if HALMAC_PLATFORM_WINDOWS -+/*SDIO RQPN Mapping for Windows, extra queue is not implemented in Driver code*/ -+static struct halmac_rqpn HALMAC_RQPN_SDIO_8821C[] = { -+ /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */ -+ {HALMAC_TRX_MODE_NORMAL, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_TRXSHARE, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_WMM, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_P2P, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_LOOPBACK, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+}; -+#else -+/*SDIO RQPN Mapping*/ -+static struct halmac_rqpn HALMAC_RQPN_SDIO_8821C[] = { -+ /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */ -+ {HALMAC_TRX_MODE_NORMAL, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_TRXSHARE, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_WMM, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_P2P, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_LOOPBACK, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+}; -+#endif -+ -+/*PCIE RQPN Mapping*/ -+static struct halmac_rqpn HALMAC_RQPN_PCIE_8821C[] = { -+ /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */ -+ {HALMAC_TRX_MODE_NORMAL, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_TRXSHARE, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_WMM, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_P2P, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_LOOPBACK, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+}; -+ -+/*USB 2 Bulkout RQPN Mapping*/ -+static struct halmac_rqpn HALMAC_RQPN_2BULKOUT_8821C[] = { -+ /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */ -+ {HALMAC_TRX_MODE_NORMAL, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_TRXSHARE, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_WMM, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_P2P, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_LOOPBACK, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+}; -+ -+/*USB 3 Bulkout RQPN Mapping*/ -+static struct halmac_rqpn HALMAC_RQPN_3BULKOUT_8821C[] = { -+ /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */ -+ {HALMAC_TRX_MODE_NORMAL, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_TRXSHARE, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_WMM, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_P2P, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_LQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_LOOPBACK, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_LQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_LQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_HQ}, -+}; -+ -+/*USB 4 Bulkout RQPN Mapping*/ -+static struct halmac_rqpn HALMAC_RQPN_4BULKOUT_8821C[] = { -+ /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */ -+ {HALMAC_TRX_MODE_NORMAL, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_TRXSHARE, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_WMM, -+ HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_NQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_P2P, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_LOOPBACK, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, -+ HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, -+ HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ}, -+}; -+ -+#if HALMAC_PLATFORM_WINDOWS -+/*SDIO Page Number*/ -+static struct halmac_pg_num HALMAC_PG_NUM_SDIO_8821C[] = { -+ /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */ -+ {HALMAC_TRX_MODE_NORMAL, 16, 16, 16, 0, 1}, -+ {HALMAC_TRX_MODE_TRXSHARE, 8, 8, 8, 0, 1}, -+ {HALMAC_TRX_MODE_WMM, 16, 16, 16, 0, 1}, -+ {HALMAC_TRX_MODE_P2P, 16, 16, 16, 0, 1}, -+ {HALMAC_TRX_MODE_LOOPBACK, 16, 16, 16, 0, 1}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, 16, 16, 16, 0, 1}, -+}; -+#else -+/*SDIO Page Number*/ -+static struct halmac_pg_num HALMAC_PG_NUM_SDIO_8821C[] = { -+ /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */ -+ {HALMAC_TRX_MODE_NORMAL, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_TRXSHARE, 8, 8, 8, 8, 1}, -+ {HALMAC_TRX_MODE_WMM, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_P2P, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_LOOPBACK, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, 16, 16, 16, 14, 1}, -+}; -+#endif -+ -+/*PCIE Page Number*/ -+static struct halmac_pg_num HALMAC_PG_NUM_PCIE_8821C[] = { -+ /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */ -+ {HALMAC_TRX_MODE_NORMAL, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_TRXSHARE, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_WMM, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_P2P, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_LOOPBACK, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, 16, 16, 16, 14, 1}, -+}; -+ -+/*USB 2 Bulkout Page Number*/ -+static struct halmac_pg_num HALMAC_PG_NUM_2BULKOUT_8821C[] = { -+ /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */ -+ {HALMAC_TRX_MODE_NORMAL, 16, 16, 0, 0, 1}, -+ {HALMAC_TRX_MODE_TRXSHARE, 16, 16, 0, 0, 1}, -+ {HALMAC_TRX_MODE_WMM, 16, 16, 0, 0, 1}, -+ {HALMAC_TRX_MODE_P2P, 16, 16, 0, 0, 1}, -+ {HALMAC_TRX_MODE_LOOPBACK, 16, 16, 0, 0, 1}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, 16, 16, 0, 0, 1}, -+}; -+ -+/*USB 3 Bulkout Page Number*/ -+static struct halmac_pg_num HALMAC_PG_NUM_3BULKOUT_8821C[] = { -+ /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */ -+ {HALMAC_TRX_MODE_NORMAL, 16, 16, 16, 0, 1}, -+ {HALMAC_TRX_MODE_TRXSHARE, 16, 16, 16, 0, 1}, -+ {HALMAC_TRX_MODE_WMM, 16, 16, 16, 0, 1}, -+ {HALMAC_TRX_MODE_P2P, 16, 16, 16, 0, 1}, -+ {HALMAC_TRX_MODE_LOOPBACK, 16, 16, 16, 0, 1}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, 16, 16, 16, 0, 1}, -+}; -+ -+/*USB 4 Bulkout Page Number*/ -+static struct halmac_pg_num HALMAC_PG_NUM_4BULKOUT_8821C[] = { -+ /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */ -+ {HALMAC_TRX_MODE_NORMAL, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_TRXSHARE, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_WMM, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_P2P, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_LOOPBACK, 16, 16, 16, 14, 1}, -+ {HALMAC_TRX_MODE_DELAY_LOOPBACK, 16, 16, 16, 14, 1}, -+}; -+ -+static enum halmac_ret_status -+txdma_queue_mapping_8821c(struct halmac_adapter *adapter, -+ enum halmac_trx_mode mode); -+ -+static enum halmac_ret_status -+priority_queue_cfg_8821c(struct halmac_adapter *adapter, -+ enum halmac_trx_mode mode); -+ -+static enum halmac_ret_status -+set_trx_fifo_info_8821c(struct halmac_adapter *adapter, -+ enum halmac_trx_mode mode); -+ -+enum halmac_ret_status -+mount_api_8821c(struct halmac_adapter *adapter) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ adapter->chip_id = HALMAC_CHIP_ID_8821C; -+ adapter->hw_cfg_info.efuse_size = EFUSE_SIZE_8821C; -+ adapter->hw_cfg_info.eeprom_size = EEPROM_SIZE_8821C; -+ adapter->hw_cfg_info.bt_efuse_size = BT_EFUSE_SIZE_8821C; -+ adapter->hw_cfg_info.prtct_efuse_size = PRTCT_EFUSE_SIZE_8821C; -+ adapter->hw_cfg_info.cam_entry_num = SEC_CAM_NUM_8821C; -+ adapter->hw_cfg_info.tx_fifo_size = TX_FIFO_SIZE_8821C; -+ adapter->hw_cfg_info.rx_fifo_size = RX_FIFO_SIZE_8821C; -+ adapter->hw_cfg_info.ac_oqt_size = OQT_ENTRY_AC_8821C; -+ adapter->hw_cfg_info.non_ac_oqt_size = OQT_ENTRY_NOAC_8821C; -+ adapter->hw_cfg_info.usb_txagg_num = BLK_DESC_NUM; -+ adapter->txff_alloc.rsvd_drv_pg_num = RSVD_PG_DRV_NUM; -+ -+ api->halmac_init_trx_cfg = init_trx_cfg_8821c; -+ api->halmac_init_system_cfg = init_system_cfg_8821c; -+ api->halmac_init_protocol_cfg = init_protocol_cfg_8821c; -+ api->halmac_init_h2c = init_h2c_8821c; -+ api->halmac_pinmux_get_func = pinmux_get_func_8821c; -+ api->halmac_pinmux_set_func = pinmux_set_func_8821c; -+ api->halmac_pinmux_free_func = pinmux_free_func_8821c; -+ api->halmac_get_hw_value = get_hw_value_8821c; -+ api->halmac_set_hw_value = set_hw_value_8821c; -+ api->halmac_cfg_drv_info = cfg_drv_info_8821c; -+ api->halmac_fill_txdesc_checksum = fill_txdesc_check_sum_8821c; -+ api->halmac_init_low_pwr = init_low_pwr_8821c; -+ api->halmac_pre_init_system_cfg = pre_init_system_cfg_8821c; -+ -+ api->halmac_init_wmac_cfg = init_wmac_cfg_8821c; -+ api->halmac_init_edca_cfg = init_edca_cfg_8821c; -+ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+#if HALMAC_SDIO_SUPPORT -+ api->halmac_init_interface_cfg = init_sdio_cfg_8821c; -+ api->halmac_init_sdio_cfg = init_sdio_cfg_8821c; -+ api->halmac_mac_power_switch = mac_pwr_switch_sdio_8821c; -+ api->halmac_phy_cfg = phy_cfg_sdio_8821c; -+ api->halmac_pcie_switch = pcie_switch_sdio_8821c; -+ api->halmac_interface_integration_tuning = intf_tun_sdio_8821c; -+ api->halmac_tx_allowed_sdio = tx_allowed_sdio_8821c; -+ api->halmac_get_sdio_tx_addr = get_sdio_tx_addr_8821c; -+ api->halmac_reg_read_8 = reg_r8_sdio_8821c; -+ api->halmac_reg_write_8 = reg_w8_sdio_8821c; -+ api->halmac_reg_read_16 = reg_r16_sdio_8821c; -+ api->halmac_reg_write_16 = reg_w16_sdio_8821c; -+ api->halmac_reg_read_32 = reg_r32_sdio_8821c; -+ api->halmac_reg_write_32 = reg_w32_sdio_8821c; -+ -+ adapter->sdio_fs.macid_map_size = MACID_MAX_8821C * 2; -+ if (!adapter->sdio_fs.macid_map) { -+ adapter->sdio_fs.macid_map = -+ (u8 *)PLTFM_MALLOC(adapter->sdio_fs.macid_map_size); -+ if (!adapter->sdio_fs.macid_map) -+ PLTFM_MSG_ERR("[ERR]mac id map malloc!!\n"); -+ } -+#endif -+ } else if (adapter->intf == HALMAC_INTERFACE_USB) { -+#if HALMAC_USB_SUPPORT -+ api->halmac_mac_power_switch = mac_pwr_switch_usb_8821c; -+ api->halmac_phy_cfg = phy_cfg_usb_8821c; -+ api->halmac_pcie_switch = pcie_switch_usb_8821c; -+ api->halmac_interface_integration_tuning = intf_tun_usb_8821c; -+#endif -+ } else if (adapter->intf == HALMAC_INTERFACE_PCIE) { -+#if HALMAC_PCIE_SUPPORT -+ api->halmac_mac_power_switch = mac_pwr_switch_pcie_8821c; -+ api->halmac_phy_cfg = phy_cfg_pcie_8821c; -+ api->halmac_pcie_switch = pcie_switch_8821c; -+ api->halmac_interface_integration_tuning = intf_tun_pcie_8821c; -+ api->halmac_cfgspc_set_pcie = cfgspc_set_pcie_8821c; -+#endif -+ } else { -+ PLTFM_MSG_ERR("[ERR]Undefined IC\n"); -+ return HALMAC_RET_CHIP_NOT_SUPPORT; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * init_trx_cfg_8821c() - config trx dma register -+ * @adapter : the adapter of halmac -+ * @mode : trx mode selection -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+init_trx_cfg_8821c(struct halmac_adapter *adapter, enum halmac_trx_mode mode) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ u8 en_fwff; -+ u16 value16; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ adapter->trx_mode = mode; -+ -+ status = txdma_queue_mapping_8821c(adapter, mode); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]queue mapping\n"); -+ return status; -+ } -+ -+ en_fwff = HALMAC_REG_R8(REG_WMAC_FWPKT_CR) & BIT_FWEN; -+ if (en_fwff) { -+ HALMAC_REG_W8_CLR(REG_WMAC_FWPKT_CR, BIT_FWEN); -+ if (fwff_is_empty_88xx(adapter) != HALMAC_RET_SUCCESS) -+ PLTFM_MSG_ERR("[ERR]fwff is not empty\n"); -+ } -+ value8 = 0; -+ HALMAC_REG_W8(REG_CR, value8); -+ value16 = HALMAC_REG_R16(REG_FWFF_PKT_INFO); -+ HALMAC_REG_W16(REG_FWFF_CTRL, value16); -+ -+ value8 = MAC_TRX_ENABLE; -+ HALMAC_REG_W8(REG_CR, value8); -+ if (en_fwff) -+ HALMAC_REG_W8_SET(REG_WMAC_FWPKT_CR, BIT_FWEN); -+ -+ HALMAC_REG_W32(REG_H2CQ_CSR, BIT(31)); -+ -+ status = priority_queue_cfg_8821c(adapter, mode); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]priority queue cfg\n"); -+ return status; -+ } -+ -+ if (adapter->txff_alloc.rx_fifo_exp_mode != -+ HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE) -+ HALMAC_REG_W8(REG_RX_DRVINFO_SZ, RX_DESC_DUMMY_SIZE_8821C >> 3); -+ -+ status = init_h2c_8821c(adapter); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]init h2cq!\n"); -+ return status; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+txdma_queue_mapping_8821c(struct halmac_adapter *adapter, -+ enum halmac_trx_mode mode) -+{ -+ u16 value16; -+ struct halmac_rqpn *cur_rqpn_sel = NULL; -+ enum halmac_ret_status status; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+ cur_rqpn_sel = HALMAC_RQPN_SDIO_8821C; -+ } else if (adapter->intf == HALMAC_INTERFACE_PCIE) { -+ cur_rqpn_sel = HALMAC_RQPN_PCIE_8821C; -+ } else if (adapter->intf == HALMAC_INTERFACE_USB) { -+ if (adapter->bulkout_num == 2) { -+ cur_rqpn_sel = HALMAC_RQPN_2BULKOUT_8821C; -+ } else if (adapter->bulkout_num == 3) { -+ cur_rqpn_sel = HALMAC_RQPN_3BULKOUT_8821C; -+ } else if (adapter->bulkout_num == 4) { -+ cur_rqpn_sel = HALMAC_RQPN_4BULKOUT_8821C; -+ } else { -+ PLTFM_MSG_ERR("[ERR]invalid intf\n"); -+ return HALMAC_RET_NOT_SUPPORT; -+ } -+ } else { -+ return HALMAC_RET_NOT_SUPPORT; -+ } -+ -+ status = rqpn_parser_88xx(adapter, mode, cur_rqpn_sel); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ value16 = 0; -+ value16 |= BIT_TXDMA_HIQ_MAP(adapter->pq_map[HALMAC_PQ_MAP_HI]); -+ value16 |= BIT_TXDMA_MGQ_MAP(adapter->pq_map[HALMAC_PQ_MAP_MG]); -+ value16 |= BIT_TXDMA_BKQ_MAP(adapter->pq_map[HALMAC_PQ_MAP_BK]); -+ value16 |= BIT_TXDMA_BEQ_MAP(adapter->pq_map[HALMAC_PQ_MAP_BE]); -+ value16 |= BIT_TXDMA_VIQ_MAP(adapter->pq_map[HALMAC_PQ_MAP_VI]); -+ value16 |= BIT_TXDMA_VOQ_MAP(adapter->pq_map[HALMAC_PQ_MAP_VO]); -+ HALMAC_REG_W16(REG_TXDMA_PQ_MAP, value16); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+priority_queue_cfg_8821c(struct halmac_adapter *adapter, -+ enum halmac_trx_mode mode) -+{ -+ u8 transfer_mode = 0; -+ u8 value8; -+ u32 cnt; -+ struct halmac_txff_allocation *txff_info = &adapter->txff_alloc; -+ enum halmac_ret_status status; -+ struct halmac_pg_num *cur_pg_num = NULL; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ status = set_trx_fifo_info_8821c(adapter, mode); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]set trx fifo!!\n"); -+ return status; -+ } -+ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+ cur_pg_num = HALMAC_PG_NUM_SDIO_8821C; -+ } else if (adapter->intf == HALMAC_INTERFACE_PCIE) { -+ cur_pg_num = HALMAC_PG_NUM_PCIE_8821C; -+ } else if (adapter->intf == HALMAC_INTERFACE_USB) { -+ if (adapter->bulkout_num == 2) { -+ cur_pg_num = HALMAC_PG_NUM_2BULKOUT_8821C; -+ } else if (adapter->bulkout_num == 3) { -+ cur_pg_num = HALMAC_PG_NUM_3BULKOUT_8821C; -+ } else if (adapter->bulkout_num == 4) { -+ cur_pg_num = HALMAC_PG_NUM_4BULKOUT_8821C; -+ } else { -+ PLTFM_MSG_ERR("[ERR]invalid intf\n"); -+ return HALMAC_RET_NOT_SUPPORT; -+ } -+ } else { -+ return HALMAC_RET_NOT_SUPPORT; -+ } -+ -+ status = pg_num_parser_88xx(adapter, mode, cur_pg_num); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ PLTFM_MSG_TRACE("[TRACE]Set FIFO page\n"); -+ -+ HALMAC_REG_W16(REG_FIFOPAGE_INFO_1, txff_info->high_queue_pg_num); -+ HALMAC_REG_W16(REG_FIFOPAGE_INFO_2, txff_info->low_queue_pg_num); -+ HALMAC_REG_W16(REG_FIFOPAGE_INFO_3, txff_info->normal_queue_pg_num); -+ HALMAC_REG_W16(REG_FIFOPAGE_INFO_4, txff_info->extra_queue_pg_num); -+ HALMAC_REG_W16(REG_FIFOPAGE_INFO_5, txff_info->pub_queue_pg_num); -+ HALMAC_REG_W32_SET(REG_RQPN_CTRL_2, BIT(31)); -+ -+ adapter->sdio_fs.hiq_pg_num = txff_info->high_queue_pg_num; -+ adapter->sdio_fs.miq_pg_num = txff_info->normal_queue_pg_num; -+ adapter->sdio_fs.lowq_pg_num = txff_info->low_queue_pg_num; -+ adapter->sdio_fs.pubq_pg_num = txff_info->pub_queue_pg_num; -+ adapter->sdio_fs.exq_pg_num = txff_info->extra_queue_pg_num; -+ -+ HALMAC_REG_W16(REG_FIFOPAGE_CTRL_2, txff_info->rsvd_boundary); -+ HALMAC_REG_W8_SET(REG_FWHW_TXQ_CTRL + 2, BIT(4)); -+ -+ /*20170411 Soar*/ -+ /* SDIO sometimes use two CMD52 to do HALMAC_REG_W16 */ -+ /* and may cause a mismatch between HW status and Reg value. */ -+ /* A patch is to write high byte first, suggested by Argis */ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+ value8 = (u8)(txff_info->rsvd_boundary >> 8 & 0xFF); -+ HALMAC_REG_W8(REG_BCNQ_BDNY_V1 + 1, value8); -+ value8 = (u8)(txff_info->rsvd_boundary & 0xFF); -+ HALMAC_REG_W8(REG_BCNQ_BDNY_V1, value8); -+ } else { -+ HALMAC_REG_W16(REG_BCNQ_BDNY_V1, txff_info->rsvd_boundary); -+ } -+ -+ HALMAC_REG_W16(REG_FIFOPAGE_CTRL_2 + 2, txff_info->rsvd_boundary); -+ -+ /*20170411 Soar*/ -+ /* SDIO sometimes use two CMD52 to do HALMAC_REG_W16 */ -+ /* and may cause a mismatch between HW status and Reg value. */ -+ /* A patch is to write high byte first, suggested by Argis */ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+ value8 = (u8)(txff_info->rsvd_boundary >> 8 & 0xFF); -+ HALMAC_REG_W8(REG_BCNQ1_BDNY_V1 + 1, value8); -+ value8 = (u8)(txff_info->rsvd_boundary & 0xFF); -+ HALMAC_REG_W8(REG_BCNQ1_BDNY_V1, value8); -+ } else { -+ HALMAC_REG_W16(REG_BCNQ1_BDNY_V1, txff_info->rsvd_boundary); -+ } -+ -+ HALMAC_REG_W32(REG_RXFF_BNDY, -+ adapter->hw_cfg_info.rx_fifo_size - -+ C2H_PKT_BUF_88XX - 1); -+ -+ if (adapter->intf == HALMAC_INTERFACE_USB) { -+ value8 = HALMAC_REG_R8(REG_AUTO_LLT_V1); -+ value8 &= ~(BIT_MASK_BLK_DESC_NUM << BIT_SHIFT_BLK_DESC_NUM); -+ value8 |= (BLK_DESC_NUM << BIT_SHIFT_BLK_DESC_NUM); -+ HALMAC_REG_W8(REG_AUTO_LLT_V1, value8); -+ -+ HALMAC_REG_W8(REG_AUTO_LLT_V1 + 3, BLK_DESC_NUM); -+ HALMAC_REG_W8_SET(REG_TXDMA_OFFSET_CHK + 1, BIT(1)); -+ } -+ -+ HALMAC_REG_W8_SET(REG_AUTO_LLT_V1, BIT_AUTO_INIT_LLT_V1); -+ cnt = 1000; -+ while (HALMAC_REG_R8(REG_AUTO_LLT_V1) & BIT_AUTO_INIT_LLT_V1) { -+ cnt--; -+ if (cnt == 0) -+ return HALMAC_RET_INIT_LLT_FAIL; -+ } -+ -+ if (mode == HALMAC_TRX_MODE_DELAY_LOOPBACK) { -+ transfer_mode = HALMAC_TRNSFER_LOOPBACK_DELAY; -+ HALMAC_REG_W16(REG_WMAC_LBK_BUF_HD_V1, -+ adapter->txff_alloc.rsvd_boundary); -+ } else if (mode == HALMAC_TRX_MODE_LOOPBACK) { -+ transfer_mode = HALMAC_TRNSFER_LOOPBACK_DIRECT; -+ } else { -+ transfer_mode = HALMAC_TRNSFER_NORMAL; -+ } -+ -+ adapter->hw_cfg_info.trx_mode = transfer_mode; -+ HALMAC_REG_W8(REG_CR + 3, (u8)transfer_mode); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+set_trx_fifo_info_8821c(struct halmac_adapter *adapter, -+ enum halmac_trx_mode mode) -+{ -+ u16 cur_pg_addr; -+ u32 txff_size = TX_FIFO_SIZE_8821C; -+ u32 rxff_size = RX_FIFO_SIZE_8821C; -+ struct halmac_txff_allocation *info = &adapter->txff_alloc; -+ -+ if (info->rx_fifo_exp_mode == HALMAC_RX_FIFO_EXPANDING_MODE_1_BLOCK) { -+ txff_size = TX_FIFO_SIZE_RX_EXPAND_1BLK_8821C; -+ rxff_size = RX_FIFO_SIZE_RX_EXPAND_1BLK_8821C; -+ } -+ -+ if (info->la_mode != HALMAC_LA_MODE_DISABLE) { -+ txff_size = TX_FIFO_SIZE_LA_8821C; -+ rxff_size = RX_FIFO_SIZE_8821C; -+ } -+ -+ adapter->hw_cfg_info.tx_fifo_size = txff_size; -+ adapter->hw_cfg_info.rx_fifo_size = rxff_size; -+ info->tx_fifo_pg_num = (u16)(txff_size >> TX_PAGE_SIZE_SHIFT_88XX); -+ -+ info->rsvd_pg_num = info->rsvd_drv_pg_num + -+ RSVD_PG_H2C_EXTRAINFO_NUM + -+ RSVD_PG_H2C_STATICINFO_NUM + -+ RSVD_PG_H2CQ_NUM + -+ RSVD_PG_CPU_INSTRUCTION_NUM + -+ RSVD_PG_FW_TXBUF_NUM + -+ RSVD_PG_CSIBUF_NUM; -+ -+ if (mode == HALMAC_TRX_MODE_DELAY_LOOPBACK) -+ info->rsvd_pg_num += RSVD_PG_DLLB_NUM; -+ -+ if (info->rsvd_pg_num > info->tx_fifo_pg_num) -+ return HALMAC_RET_CFG_TXFIFO_PAGE_FAIL; -+ -+ info->acq_pg_num = info->tx_fifo_pg_num - info->rsvd_pg_num; -+ info->rsvd_boundary = info->tx_fifo_pg_num - info->rsvd_pg_num; -+ -+ cur_pg_addr = info->tx_fifo_pg_num; -+ cur_pg_addr -= RSVD_PG_CSIBUF_NUM; -+ info->rsvd_csibuf_addr = cur_pg_addr; -+ cur_pg_addr -= RSVD_PG_FW_TXBUF_NUM; -+ info->rsvd_fw_txbuf_addr = cur_pg_addr; -+ cur_pg_addr -= RSVD_PG_CPU_INSTRUCTION_NUM; -+ info->rsvd_cpu_instr_addr = cur_pg_addr; -+ cur_pg_addr -= RSVD_PG_H2CQ_NUM; -+ info->rsvd_h2cq_addr = cur_pg_addr; -+ cur_pg_addr -= RSVD_PG_H2C_STATICINFO_NUM; -+ info->rsvd_h2c_sta_info_addr = cur_pg_addr; -+ cur_pg_addr -= RSVD_PG_H2C_EXTRAINFO_NUM; -+ info->rsvd_h2c_info_addr = cur_pg_addr; -+ cur_pg_addr -= info->rsvd_drv_pg_num; -+ info->rsvd_drv_addr = cur_pg_addr; -+ -+ if (mode == HALMAC_TRX_MODE_DELAY_LOOPBACK) -+ info->rsvd_drv_addr -= RSVD_PG_DLLB_NUM; -+ -+ if (info->rsvd_boundary != info->rsvd_drv_addr) -+ return HALMAC_RET_CFG_TXFIFO_PAGE_FAIL; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * init_system_cfg_8821c() - init system config -+ * @adapter : the adapter of halmac -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+init_system_cfg_8821c(struct halmac_adapter *adapter) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u32 tmp = 0; -+ u32 value32; -+ enum halmac_ret_status status; -+ u8 hwval; -+ u8 value8; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (adapter->intf == HALMAC_INTERFACE_PCIE) { -+ hwval = 1; -+ status = set_hw_value_8821c(adapter, HALMAC_HW_PCIE_REF_AUTOK, -+ &hwval); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ } -+ -+ value32 = HALMAC_REG_R32(REG_CPU_DMEM_CON) | BIT_WL_PLATFORM_RST; -+ HALMAC_REG_W32(REG_CPU_DMEM_CON, value32); -+ -+ value8 = HALMAC_REG_R8(REG_SYS_FUNC_EN + 1) | SYS_FUNC_EN; -+ HALMAC_REG_W8(REG_SYS_FUNC_EN + 1, value8); -+ -+ /*disable boot-from-flash for driver's DL FW*/ -+ tmp = HALMAC_REG_R32(REG_MCUFW_CTRL); -+ if (tmp & BIT_BOOT_FSPI_EN) { -+ HALMAC_REG_W32(REG_MCUFW_CTRL, tmp & (~BIT_BOOT_FSPI_EN)); -+ value32 = HALMAC_REG_R32(REG_GPIO_MUXCFG) & (~BIT_FSPI_EN); -+ HALMAC_REG_W32(REG_GPIO_MUXCFG, value32); -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * init_protocol_cfg_8821c() - config protocol register -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+init_protocol_cfg_8821c(struct halmac_adapter *adapter) -+{ -+ u16 pre_txcnt; -+ u32 max_agg_num; -+ u32 max_rts_agg_num; -+ u32 value32; -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ HALMAC_REG_W8(REG_AMPDU_MAX_TIME_V1, WLAN_AMPDU_MAX_TIME); -+ HALMAC_REG_W8_SET(REG_TX_HANG_CTRL, BIT_EN_EOF_V1); -+ -+ pre_txcnt = WLAN_PRE_TXCNT_TIME_TH | BIT_EN_PRECNT; -+ HALMAC_REG_W8(REG_PRECNT_CTRL, (u8)(pre_txcnt & 0xFF)); -+ HALMAC_REG_W8(REG_PRECNT_CTRL + 1, (u8)(pre_txcnt >> 8)); -+ -+ max_agg_num = WLAN_MAX_AGG_PKT_LIMIT; -+ max_rts_agg_num = WLAN_RTS_MAX_AGG_PKT_LIMIT; -+ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+ max_agg_num = WLAN_MAX_AGG_PKT_LIMIT_SDIO; -+ max_rts_agg_num = WLAN_RTS_MAX_AGG_PKT_LIMIT_SDIO; -+ } -+ -+ value32 = WLAN_RTS_LEN_TH | (WLAN_RTS_TX_TIME_TH << 8) | -+ (max_agg_num << 16) | (max_rts_agg_num << 24); -+ HALMAC_REG_W32(REG_PROT_MODE_CTRL, value32); -+ -+ HALMAC_REG_W16(REG_BAR_MODE_CTRL + 2, -+ WLAN_BAR_RETRY_LIMIT | WLAN_RA_TRY_RATE_AGG_LIMIT << 8); -+ -+ HALMAC_REG_W8(REG_FAST_EDCA_VOVI_SETTING, WALN_FAST_EDCA_VO_TH); -+ HALMAC_REG_W8(REG_FAST_EDCA_VOVI_SETTING + 2, WLAN_FAST_EDCA_VI_TH); -+ HALMAC_REG_W8(REG_FAST_EDCA_BEBK_SETTING, WLAN_FAST_EDCA_BE_TH); -+ HALMAC_REG_W8(REG_FAST_EDCA_BEBK_SETTING + 2, WLAN_FAST_EDCA_BK_TH); -+ -+ value8 = HALMAC_REG_R8(REG_INIRTS_RATE_SEL); -+ HALMAC_REG_W8(REG_INIRTS_RATE_SEL, value8 | BIT(5)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * init_h2c_8821c() - config h2c packet buffer -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+init_h2c_8821c(struct halmac_adapter *adapter) -+{ -+ u8 value8; -+ u32 value32; -+ u32 h2cq_addr; -+ u32 h2cq_size; -+ struct halmac_txff_allocation *txff_info = &adapter->txff_alloc; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ h2cq_addr = txff_info->rsvd_h2cq_addr << TX_PAGE_SIZE_SHIFT_88XX; -+ h2cq_size = RSVD_PG_H2CQ_NUM << TX_PAGE_SIZE_SHIFT_88XX; -+ -+ value32 = HALMAC_REG_R32(REG_H2C_HEAD); -+ value32 = (value32 & 0xFFFC0000) | h2cq_addr; -+ HALMAC_REG_W32(REG_H2C_HEAD, value32); -+ -+ value32 = HALMAC_REG_R32(REG_H2C_READ_ADDR); -+ value32 = (value32 & 0xFFFC0000) | h2cq_addr; -+ HALMAC_REG_W32(REG_H2C_READ_ADDR, value32); -+ -+ value32 = HALMAC_REG_R32(REG_H2C_TAIL); -+ value32 &= 0xFFFC0000; -+ value32 |= (h2cq_addr + h2cq_size); -+ HALMAC_REG_W32(REG_H2C_TAIL, value32); -+ -+ value8 = HALMAC_REG_R8(REG_H2C_INFO); -+ value8 = (u8)((value8 & 0xFC) | 0x01); -+ HALMAC_REG_W8(REG_H2C_INFO, value8); -+ -+ value8 = HALMAC_REG_R8(REG_H2C_INFO); -+ value8 = (u8)((value8 & 0xFB) | 0x04); -+ HALMAC_REG_W8(REG_H2C_INFO, value8); -+ -+ value8 = HALMAC_REG_R8(REG_TXDMA_OFFSET_CHK + 1); -+ value8 = (u8)((value8 & 0x7f) | 0x80); -+ HALMAC_REG_W8(REG_TXDMA_OFFSET_CHK + 1, value8); -+ -+ adapter->h2c_info.buf_size = h2cq_size; -+ get_h2c_buf_free_space_88xx(adapter); -+ -+ if (adapter->h2c_info.buf_size != adapter->h2c_info.buf_fs) { -+ PLTFM_MSG_ERR("[ERR]get h2c free space error!\n"); -+ return HALMAC_RET_GET_H2C_SPACE_ERR; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]h2c fs : %d\n", adapter->h2c_info.buf_fs); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * init_edca_cfg_8821c() - init EDCA config -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+init_edca_cfg_8821c(struct halmac_adapter *adapter) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ /* Init SYNC_CLI_SEL : reg 0x5B4[6:4] = 0 */ -+ HALMAC_REG_W8_CLR(REG_TIMER0_SRC_SEL, BIT(4) | BIT(5) | BIT(6)); -+ -+ /* Clear TX pause */ -+ HALMAC_REG_W16(REG_TXPAUSE, 0x0000); -+ -+ HALMAC_REG_W8(REG_SLOT, WLAN_SLOT_TIME); -+ HALMAC_REG_W8(REG_PIFS, WLAN_PIFS_TIME); -+ HALMAC_REG_W32(REG_SIFS, WLAN_SIFS_CFG); -+ -+ HALMAC_REG_W16(REG_EDCA_VO_PARAM + 2, WLAN_VO_TXOP_LIMIT); -+ HALMAC_REG_W16(REG_EDCA_VI_PARAM + 2, WLAN_VI_TXOP_LIMIT); -+ -+ HALMAC_REG_W32(REG_RD_NAV_NXT, WLAN_NAV_CFG); -+ HALMAC_REG_W16(REG_RXTSF_OFFSET_CCK, WLAN_RX_TSF_CFG); -+ -+ /* Set beacon cotnrol - enable TSF and other related functions */ -+ HALMAC_REG_W8(REG_BCN_CTRL, (u8)(HALMAC_REG_R8(REG_BCN_CTRL) | -+ BIT_EN_BCN_FUNCTION)); -+ -+ /* Set send beacon related registers */ -+ HALMAC_REG_W32(REG_TBTT_PROHIBIT, WLAN_TBTT_TIME); -+ HALMAC_REG_W8(REG_DRVERLYINT, WLAN_DRV_EARLY_INT); -+ HALMAC_REG_W8(REG_BCNDMATIM, WLAN_BCN_DMA_TIME); -+ -+ HALMAC_REG_W8_CLR(REG_TX_PTCL_CTRL + 1, BIT(4)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * init_wmac_cfg_8821c() - init wmac config -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+init_wmac_cfg_8821c(struct halmac_adapter *adapter) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ HALMAC_REG_W32(REG_RXFLTMAP0, WLAN_RX_FILTER0); -+ HALMAC_REG_W16(REG_RXFLTMAP2, WLAN_RX_FILTER2); -+ -+ HALMAC_REG_W32(REG_RCR, WLAN_RCR_CFG); -+ -+ HALMAC_REG_W8(REG_RX_PKT_LIMIT, WLAN_RXPKT_MAX_SZ_512); -+ -+ HALMAC_REG_W8(REG_TCR + 2, WLAN_TX_FUNC_CFG2); -+ HALMAC_REG_W8(REG_TCR + 1, WLAN_TX_FUNC_CFG1); -+ -+ HALMAC_REG_W8(REG_ACKTO_CCK, WLAN_ACK_TO_CCK); -+ -+ HALMAC_REG_W8_SET(REG_WMAC_TRXPTCL_CTL_H, BIT_EN_TXCTS_IN_RXNAV_V1); -+ -+ HALMAC_REG_W8_SET(REG_SND_PTCL_CTRL, BIT_R_DISABLE_CHECK_VHTSIGB_CRC); -+ -+ HALMAC_REG_W32(REG_WMAC_OPTION_FUNCTION_2, WLAN_MAC_OPT_FUNC2); -+ -+ if (adapter->hw_cfg_info.trx_mode == HALMAC_TRNSFER_NORMAL) -+ value8 = WLAN_MAC_OPT_NORM_FUNC1; -+ else -+ value8 = WLAN_MAC_OPT_LB_FUNC1; -+ -+ HALMAC_REG_W8(REG_WMAC_OPTION_FUNCTION + 4, value8); -+ -+ status = api->halmac_init_low_pwr(adapter); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * pre_init_system_cfg_8821c() - pre-init system config -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+pre_init_system_cfg_8821c(struct halmac_adapter *adapter) -+{ -+ u32 value32; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u8 enable_bb; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ HALMAC_REG_W8(REG_RSV_CTRL, 0); -+ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+#if HALMAC_SDIO_SUPPORT -+ if (leave_sdio_suspend_88xx(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_SDIO_LEAVE_SUSPEND_FAIL; -+#endif -+ } else if (adapter->intf == HALMAC_INTERFACE_USB) { -+#if HALMAC_USB_SUPPORT -+ if (HALMAC_REG_R8(REG_SYS_CFG2 + 3) == 0x20) -+ HALMAC_REG_W8(0xFE5B, HALMAC_REG_R8(0xFE5B) | BIT(4)); -+#endif -+ } else if (adapter->intf == HALMAC_INTERFACE_PCIE) { -+#if HALMAC_PCIE_SUPPORT -+ /* For PCIE power on fail issue */ -+ HALMAC_REG_W8(REG_HCI_OPT_CTRL + 1, -+ HALMAC_REG_R8(REG_HCI_OPT_CTRL + 1) | BIT(0)); -+#endif -+ } -+ -+ /* Config PIN Mux */ -+ value32 = HALMAC_REG_R32(REG_PAD_CTRL1); -+ value32 = value32 & (~(BIT(28) | BIT(29))); -+ value32 = value32 | BIT(28) | BIT(29); -+ HALMAC_REG_W32(REG_PAD_CTRL1, value32); -+ -+ value32 = HALMAC_REG_R32(REG_LED_CFG); -+ value32 = value32 & (~(BIT(25) | BIT(26))); -+ HALMAC_REG_W32(REG_LED_CFG, value32); -+ -+ value32 = HALMAC_REG_R32(REG_GPIO_MUXCFG); -+ value32 = value32 & (~(BIT(2))); -+ value32 = value32 | BIT(2); -+ HALMAC_REG_W32(REG_GPIO_MUXCFG, value32); -+ -+ enable_bb = 0; -+ set_hw_value_88xx(adapter, HALMAC_HW_EN_BB_RF, &enable_bb); -+ -+ if (HALMAC_REG_R8(REG_SYS_CFG1 + 2) & BIT(4)) { -+ PLTFM_MSG_ERR("[ERR]test mode!!\n"); -+ return HALMAC_RET_WLAN_MODE_FAIL; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+#endif /* HALMAC_8821C_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_init_8821c.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_init_8821c.h -new file mode 100644 -index 000000000..d37c90018 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_init_8821c.h -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_INIT_8821C_H_ -+#define _HALMAC_INIT_8821C_H_ -+ -+#include "../../halmac_api.h" -+ -+#if HALMAC_8821C_SUPPORT -+ -+enum halmac_ret_status -+mount_api_8821c(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+init_trx_cfg_8821c(struct halmac_adapter *adapter, enum halmac_trx_mode mode); -+ -+enum halmac_ret_status -+init_system_cfg_8821c(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+init_protocol_cfg_8821c(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+init_h2c_8821c(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+init_edca_cfg_8821c(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+init_wmac_cfg_8821c(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+pre_init_system_cfg_8821c(struct halmac_adapter *adapter); -+ -+#endif /* HALMAC_8821C_SUPPORT */ -+ -+#endif/* _HALMAC_INIT_8821C_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_phy_8821c.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_phy_8821c.c -new file mode 100644 -index 000000000..e03e5073e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_phy_8821c.c -@@ -0,0 +1,76 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "../../halmac_type.h" -+#if HALMAC_USB_SUPPORT -+#include "halmac_usb_8821c.h" -+#endif -+#if HALMAC_PCIE_SUPPORT -+#include "halmac_pcie_8821c.h" -+#endif -+ -+/** -+ * ============ip sel item list============ -+ * HALMAC_IP_INTF_PHY -+ * USB2 : usb2 phy, 1byte value -+ * USB3 : usb3 phy, 2byte value -+ * PCIE1 : pcie gen1 mdio, 2byte value -+ * PCIE2 : pcie gen2 mdio, 2byte value -+ * HALMAC_IP_SEL_MAC -+ * USB2, USB3, PCIE1, PCIE2 : mac ip, 1byte value -+ * HALMAC_IP_PCIE_DBI -+ * USB2 USB3 : none -+ * PCIE1, PCIE2 : pcie dbi, 1byte value -+ */ -+ -+#if HALMAC_8821C_SUPPORT -+ -+struct halmac_intf_phy_para usb2_phy_param_8821c[] = { -+ /* {offset, value, ip sel, cut mask, platform mask} */ -+ {0xFFFF, 0x00, -+ HALMAC_IP_INTF_PHY, -+ HALMAC_INTF_PHY_CUT_ALL, -+ HALMAC_INTF_PHY_PLATFORM_FOR_ALL}, -+}; -+ -+struct halmac_intf_phy_para usb3_phy_param_8821c[] = { -+ /* {offset, value, cut mask, platform mask} */ -+ {0xFFFF, 0x0000, -+ HALMAC_IP_INTF_PHY, -+ HALMAC_INTF_PHY_CUT_ALL, -+ HALMAC_INTF_PHY_PLATFORM_FOR_ALL}, -+}; -+ -+struct halmac_intf_phy_para pcie_gen1_phy_param_8821c[] = { -+ /* {offset, value, ip sel, cut mask, platform mask} */ -+ {0x0009, 0x6380, -+ HALMAC_IP_INTF_PHY, -+ HALMAC_INTF_PHY_CUT_ALL, -+ HALMAC_INTF_PHY_PLATFORM_FOR_ALL}, -+ {0xFFFF, 0x0000, -+ HALMAC_IP_INTF_PHY, -+ HALMAC_INTF_PHY_CUT_ALL, -+ HALMAC_INTF_PHY_PLATFORM_FOR_ALL}, -+}; -+ -+struct halmac_intf_phy_para pcie_gen2_phy_param_8821c[] = { -+ /* {offset, value, ip sel, cut mask, platform mask} */ -+ {0xFFFF, 0x0000, -+ HALMAC_IP_INTF_PHY, -+ HALMAC_INTF_PHY_CUT_ALL, -+ HALMAC_INTF_PHY_PLATFORM_FOR_ALL}, -+}; -+ -+#endif /* HALMAC_8821C_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_pwr_seq_8821c.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_pwr_seq_8821c.c -new file mode 100644 -index 000000000..5a578fc03 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_pwr_seq_8821c.c -@@ -0,0 +1,905 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_pwr_seq_8821c.h" -+ -+#if HALMAC_8821C_SUPPORT -+ -+static struct halmac_wlan_pwr_cfg TRANS_CARDDIS_TO_CARDEMU_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0086, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_WRITE, BIT(0), 0}, -+ {0x0086, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_POLLING, BIT(1), BIT(1)}, -+ {0x004A, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), 0}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(3) | BIT(4) | BIT(7), 0}, -+ {0x0300, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0}, -+ {0x0301, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0}, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+static struct halmac_wlan_pwr_cfg TRANS_CARDEMU_TO_ACT_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0020, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK | HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0x0001, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK | HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_DELAY, 1, HALMAC_PWR_DELAY_MS}, -+ {0x0000, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK | HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(5), 0}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, (BIT(4) | BIT(3) | BIT(2)), 0}, -+ {0x0075, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0x0006, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, BIT(1), BIT(1)}, -+ {0x0075, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), 0 }, -+ {0x0006, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(7), 0 }, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, (BIT(4) | BIT(3)), 0}, -+ {0x10C3, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, BIT(0), 0}, -+ {0x0020, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(3), BIT(3)}, -+ {0x0074, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(5), BIT(5)}, -+ {0x0022, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0}, -+ {0x0062, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, (BIT(7) | BIT(6) | BIT(5)), -+ (BIT(7) | BIT(6) | BIT(5))}, -+ {0x0061, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, (BIT(7) | BIT(6) | BIT(5)), 0}, -+ {0x007C, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0 }, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+static struct halmac_wlan_pwr_cfg TRANS_ACT_TO_CARDEMU_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0093, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xC4}, -+ {0x001F, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0}, -+ {0x0049, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0}, -+ {0x0006, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0}, -+ {0x10C3, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), 0}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), BIT(1)}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, BIT(1), 0}, -+ {0x0020, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(3), 0}, -+ {0x0000, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK | HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(5), BIT(5)}, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+static struct halmac_wlan_pwr_cfg TRANS_CARDEMU_TO_CARDDIS_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0007, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK | HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x20}, -+ {0x0067, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(5), 0}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(2), BIT(2)}, -+ {0x004A, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), 0}, -+ {0x0067, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(5), 0 }, -+ {0x0067, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(4), 0 }, -+ {0x004F, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), 0 }, -+ {0x0067, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0 }, -+ {0x0046, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(6), BIT(6) }, -+ {0x0067, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(2), 0 }, -+ {0x0046, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(7), BIT(7) }, -+ {0x0062, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(4), BIT(4) }, -+ {0x0081, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(7) | BIT(6), 0}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK | HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3)}, -+ {0x0086, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0x0086, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_POLLING, BIT(1), 0}, -+ {0x0090, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK | HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0}, -+ {0x0044, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0}, -+ {0x0040, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x90}, -+ {0x0041, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x00}, -+ {0x0042, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x04}, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+/* Card Enable Array */ -+struct halmac_wlan_pwr_cfg *card_en_flow_8821c[] = { -+ TRANS_CARDDIS_TO_CARDEMU_8821C, -+ TRANS_CARDEMU_TO_ACT_8821C, -+ NULL -+}; -+ -+/* Card Disable Array */ -+struct halmac_wlan_pwr_cfg *card_dis_flow_8821c[] = { -+ TRANS_ACT_TO_CARDEMU_8821C, -+ TRANS_CARDEMU_TO_CARDDIS_8821C, -+ NULL -+}; -+ -+#if HALMAC_PLATFORM_TESTPROGRAM -+ -+static struct halmac_wlan_pwr_cfg TRANS_CARDEMU_TO_SUS_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(4) | BIT(3), (BIT(4) | BIT(3))}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK | HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3)}, -+ {0x0007, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x20}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3) | BIT(4)}, -+ {0x0086, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0x0086, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_POLLING, BIT(1), 0}, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+static struct halmac_wlan_pwr_cfg TRANS_SUS_TO_CARDEMU_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(3) | BIT(7), 0}, -+ {0x0086, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_WRITE, BIT(0), 0}, -+ {0x0086, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_POLLING, BIT(1), BIT(1)}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(3) | BIT(4), 0}, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+static struct halmac_wlan_pwr_cfg TRANS_CARDEMU_TO_PDN_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0007, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK | HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x20}, -+ {0x0006, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), 0}, -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(7), BIT(7)}, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+static struct halmac_wlan_pwr_cfg TRANS_PDN_TO_CARDEMU_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0005, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(7), 0}, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+static struct halmac_wlan_pwr_cfg TRANS_ACT_TO_LPS_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0101, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(2), BIT(2)}, -+ {0x0199, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(3), BIT(3)}, -+ {0x019B, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(7), BIT(7)}, -+ {0x1138, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0) | BIT(1), BIT(0) | BIT(1)}, -+ {0x0194, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0x0093, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xD6}, -+ {0x0092, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x60}, -+ {0x0093, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x93}, -+ {0x0092, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x60}, -+ {0x0093, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x2}, -+ {0x0092, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x60}, -+ {0x0090, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), BIT(1)}, -+ {0x0301, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xFF}, -+ {0x0522, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xFF}, -+ {0x05F8, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, 0xFF, 0}, -+ {0x05F9, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, 0xFF, 0}, -+ {0x05FA, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, 0xFF, 0}, -+ {0x05FB, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, 0xFF, 0}, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), 0}, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_DELAY, 0, HALMAC_PWR_DELAY_US}, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0}, -+ {0x0100, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x3F}, -+ {0x0101, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0}, -+ {0x0553, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(5), BIT(5)}, -+ {0x0008, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(4), BIT(4)}, -+ {0x0109, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, BIT(7), BIT(7)}, -+ {0x0090, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+static struct halmac_wlan_pwr_cfg TRANS_ACT_TO_DEEP_LPS_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0101, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(2), BIT(2)}, -+ {0x0199, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(3), BIT(3)}, -+ {0x019B, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(7), BIT(7)}, -+ {0x1138, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0) | BIT(1), BIT(0) | BIT(1)}, -+ {0x0194, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0x0093, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xD4}, -+ {0x0092, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x20}, -+ {0x0093, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x91}, -+ {0x0092, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x20}, -+ {0x0093, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x0}, -+ {0x0092, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x20}, -+ {0x0090, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), BIT(1)}, -+ {0x0301, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xFF}, -+ {0x0522, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xFF}, -+ {0x05F8, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, 0xFF, 0}, -+ {0x05F9, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, 0xFF, 0}, -+ {0x05FA, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, 0xFF, 0}, -+ {0x05FB, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, 0xFF, 0}, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), 0}, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_DELAY, 0, HALMAC_PWR_DELAY_US}, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0}, -+ {0x0100, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x3F}, -+ {0x0101, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0}, -+ {0x0553, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(5), BIT(5)}, -+ {0x0008, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(4), BIT(4)}, -+ {0x0109, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, BIT(7), BIT(7)}, -+ {0x0090, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(0), BIT(0)}, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+static struct halmac_wlan_pwr_cfg TRANS_LPS_TO_ACT_8821C[] = { -+ /* { offset, cut_msk, interface_msk, base|cmd, msk, value } */ -+ {0x0080, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_WRITE, BIT(7), BIT(7)}, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_DELAY, 0, HALMAC_PWR_DELAY_MS}, -+ {0x0080, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_SDIO_MSK, -+ HALMAC_PWR_ADDR_SDIO, -+ HALMAC_PWR_CMD_WRITE, BIT(7), 0}, -+ {0xFE58, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x84}, -+ {0xFE58, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_USB_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x04}, -+ {0x03D9, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(7), BIT(7)}, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_DELAY, 0, HALMAC_PWR_DELAY_MS}, -+ {0x03D9, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_PCI_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(7), 0}, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_DELAY, 0, HALMAC_PWR_DELAY_MS}, -+ {0x0008, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(4), 0}, -+ {0x0109, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_POLLING, BIT(7), 0}, -+ {0x0101, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), BIT(1)}, -+ {0x0100, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xFF }, -+ {0x0002, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1) | BIT(0), BIT(1) | BIT(0)}, -+ {0x0522, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0}, -+ {0x113C, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0x03}, -+ {0x0124, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xFF}, -+ {0x0125, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xFF}, -+ {0x0126, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xFF}, -+ {0x0127, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, 0xFF, 0xFF}, -+ {0x0090, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(1), 0}, -+ {0x0101, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ HALMAC_PWR_ADDR_MAC, -+ HALMAC_PWR_CMD_WRITE, BIT(2), 0}, -+ {0xFFFF, -+ HALMAC_PWR_CUT_ALL_MSK, -+ HALMAC_PWR_INTF_ALL_MSK, -+ 0, -+ HALMAC_PWR_CMD_END, 0, 0}, -+}; -+ -+/* Suspend Array */ -+struct halmac_wlan_pwr_cfg *suspend_flow_8821c[] = { -+ TRANS_ACT_TO_CARDEMU_8821C, -+ TRANS_CARDEMU_TO_SUS_8821C, -+ NULL -+}; -+ -+/* Resume Array */ -+struct halmac_wlan_pwr_cfg *resume_flow_8821c[] = { -+ TRANS_SUS_TO_CARDEMU_8821C, -+ TRANS_CARDEMU_TO_ACT_8821C, -+ NULL -+}; -+ -+/* HWPDN Array - HW behavior */ -+struct halmac_wlan_pwr_cfg *hwpdn_flow_8821c[] = { -+ NULL -+}; -+ -+/* Enter LPS - FW behavior */ -+struct halmac_wlan_pwr_cfg *enter_lps_flow_8821c[] = { -+ TRANS_ACT_TO_LPS_8821C, -+ NULL -+}; -+ -+/* Enter Deep LPS - FW behavior */ -+struct halmac_wlan_pwr_cfg *enter_dlps_flow_8821c[] = { -+ TRANS_ACT_TO_DEEP_LPS_8821C, -+ NULL -+}; -+ -+/* Leave LPS -FW behavior */ -+struct halmac_wlan_pwr_cfg *leave_lps_flow_8821c[] = { -+ TRANS_LPS_TO_ACT_8821C, -+ NULL -+}; -+ -+#endif -+ -+#endif /* HALMAC_8821C_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_pwr_seq_8821c.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_pwr_seq_8821c.h -new file mode 100644 -index 000000000..96b8e17f7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_pwr_seq_8821c.h -@@ -0,0 +1,37 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 HALMAC_POWER_SEQUENCE_8821C -+#define HALMAC_POWER_SEQUENCE_8821C -+ -+#include "../../halmac_pwr_seq_cmd.h" -+#include "../../halmac_hw_cfg.h" -+ -+#if HALMAC_8821C_SUPPORT -+ -+#define HALMAC_8821C_PWR_SEQ_VER "V23" -+ -+extern struct halmac_wlan_pwr_cfg *card_dis_flow_8821c[]; -+extern struct halmac_wlan_pwr_cfg *card_en_flow_8821c[]; -+extern struct halmac_wlan_pwr_cfg *suspend_flow_8821c[]; -+extern struct halmac_wlan_pwr_cfg *resume_flow_8821c[]; -+extern struct halmac_wlan_pwr_cfg *hwpdn_flow_8821c[]; -+extern struct halmac_wlan_pwr_cfg *enter_lps_flow_8821c[]; -+extern struct halmac_wlan_pwr_cfg *enter_dlps_flow_8821c[]; -+extern struct halmac_wlan_pwr_cfg *leave_lps_flow_8821c[]; -+ -+#endif /* HALMAC_8821C_SUPPORT */ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_sdio_8821c.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_sdio_8821c.c -new file mode 100644 -index 000000000..3141e29e1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_sdio_8821c.c -@@ -0,0 +1,1019 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_sdio_8821c.h" -+#include "halmac_pwr_seq_8821c.h" -+#include "../halmac_init_88xx.h" -+#include "../halmac_common_88xx.h" -+#include "../halmac_sdio_88xx.h" -+ -+#if (HALMAC_8821C_SUPPORT && HALMAC_SDIO_SUPPORT) -+ -+#define WLAN_ACQ_NUM_MAX 8 -+ -+static enum halmac_ret_status -+chk_oqt_8821c(struct halmac_adapter *adapter, u32 tx_agg_num, u8 *buf, -+ u8 macid_cnt); -+ -+static enum halmac_ret_status -+update_oqt_free_space_8821c(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+update_sdio_free_page_8821c(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+chk_qsel_8821c(struct halmac_adapter *adapter, u8 qsel_first, u8 *pkt, -+ u8 *macid_cnt); -+ -+static enum halmac_ret_status -+chk_dma_mapping_8821c(struct halmac_adapter *adapter, u16 **cur_fs, -+ u8 qsel_first); -+ -+static enum halmac_ret_status -+chk_rqd_page_num_8821c(struct halmac_adapter *adapter, u8 *buf, u32 *rqd_pg_num, -+ u16 **cur_fs, u8 *macid_cnt, u32 tx_agg_num); -+ -+/** -+ * init_sdio_cfg_8821c() - init SDIO -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+init_sdio_cfg_8821c(struct halmac_adapter *adapter) -+{ -+ u32 value32; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (adapter->intf != HALMAC_INTERFACE_SDIO) -+ return HALMAC_RET_WRONG_INTF; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ HALMAC_REG_R32(REG_SDIO_FREE_TXPG); -+ -+ value32 = HALMAC_REG_R32(REG_SDIO_TX_CTRL) & 0xFFFF; -+ value32 &= ~(BIT_CMD_ERR_STOP_INT_EN | BIT_EN_MASK_TIMER | -+ BIT_EN_RXDMA_MASK_INT); -+ HALMAC_REG_W32(REG_SDIO_TX_CTRL, value32); -+ -+ HALMAC_REG_W8_SET(REG_SDIO_BUS_CTRL, BIT_EN_RPT_TXCRC); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * mac_pwr_switch_sdio_8821c() - switch mac power -+ * @adapter : the adapter of halmac -+ * @pwr : power state -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+mac_pwr_switch_sdio_8821c(struct halmac_adapter *adapter, -+ enum halmac_mac_power pwr) -+{ -+ u8 value8; -+ u8 rpwm; -+ u32 imr_backup; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]halmac_mac_power_switch_88xx_sdio pwr\n"); -+ PLTFM_MSG_TRACE("[TRACE]%x\n", pwr); -+ PLTFM_MSG_TRACE("[TRACE]8821C pwr seq ver = %s\n", -+ HALMAC_8821C_PWR_SEQ_VER); -+ -+ adapter->rpwm = HALMAC_REG_R8(REG_SDIO_HRPWM1); -+ -+ /* Check FW still exist or not */ -+ if (HALMAC_REG_R16(REG_MCUFW_CTRL) == 0xC078) { -+ /* Leave 32K */ -+ rpwm = (u8)((adapter->rpwm ^ BIT(7)) & 0x80); -+ HALMAC_REG_W8(REG_SDIO_HRPWM1, rpwm); -+ } -+ -+ value8 = HALMAC_REG_R8(REG_CR); -+ if (value8 == 0xEA) -+ adapter->halmac_state.mac_pwr = HALMAC_MAC_POWER_OFF; -+ else -+ adapter->halmac_state.mac_pwr = HALMAC_MAC_POWER_ON; -+ -+ /*Check if power switch is needed*/ -+ if (pwr == HALMAC_MAC_POWER_ON && -+ adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_ON) { -+ PLTFM_MSG_WARN("[WARN]power state unchange!!\n"); -+ return HALMAC_RET_PWR_UNCHANGE; -+ } -+ -+ imr_backup = HALMAC_REG_R32(REG_SDIO_HIMR); -+ HALMAC_REG_W32(REG_SDIO_HIMR, 0); -+ -+ if (pwr == HALMAC_MAC_POWER_OFF) { -+ adapter->pwr_off_flow_flag = 1; -+ if (pwr_seq_parser_88xx(adapter, card_dis_flow_8821c) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]Handle power off cmd error\n"); -+ HALMAC_REG_W32(REG_SDIO_HIMR, imr_backup); -+ return HALMAC_RET_POWER_OFF_FAIL; -+ } -+ -+ adapter->halmac_state.mac_pwr = HALMAC_MAC_POWER_OFF; -+ adapter->halmac_state.dlfw_state = HALMAC_DLFW_NONE; -+ adapter->pwr_off_flow_flag = 0; -+ init_adapter_dynamic_param_88xx(adapter); -+ } else { -+ if (pwr_seq_parser_88xx(adapter, card_en_flow_8821c) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]Handle power on cmd error\n"); -+ HALMAC_REG_W32(REG_SDIO_HIMR, imr_backup); -+ return HALMAC_RET_POWER_ON_FAIL; -+ } -+ -+ adapter->halmac_state.mac_pwr = HALMAC_MAC_POWER_ON; -+ } -+ -+ HALMAC_REG_W32(REG_SDIO_HIMR, imr_backup); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * halmac_tx_allowed_sdio_88xx() - check tx status -+ * @adapter : the adapter of halmac -+ * @buf : tx packet, include txdesc -+ * @size : tx packet size, include txdesc -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+tx_allowed_sdio_8821c(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u16 *cur_fs = NULL; -+ u32 cnt; -+ u32 tx_agg_num; -+ u32 rqd_pg_num = 0; -+ u8 macid_cnt = 0; -+ struct halmac_sdio_free_space *fs_info = &adapter->sdio_fs; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_qsel qsel; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (!fs_info->macid_map) { -+ PLTFM_MSG_ERR("[ERR]halmac allocate Macid_map Fail!!\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ -+ PLTFM_MEMSET(fs_info->macid_map, 0x00, fs_info->macid_map_size); -+ -+ tx_agg_num = GET_TX_DESC_DMA_TXAGG_NUM(buf); -+ tx_agg_num = (tx_agg_num == 0) ? 1 : tx_agg_num; -+ -+ status = chk_rqd_page_num_8821c(adapter, buf, &rqd_pg_num, &cur_fs, -+ &macid_cnt, tx_agg_num); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ qsel = (enum halmac_qsel)GET_TX_DESC_QSEL(buf); -+ if (qsel == HALMAC_QSEL_BCN || qsel == HALMAC_QSEL_CMD) -+ return HALMAC_RET_SUCCESS; -+ -+ cnt = 10; -+ do { -+ if ((u32)(*cur_fs + fs_info->pubq_pg_num) > rqd_pg_num) { -+ status = chk_oqt_8821c(adapter, tx_agg_num, buf, -+ macid_cnt); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_WARN("[WARN]oqt buffer full!!\n"); -+ return status; -+ } -+ -+ if (*cur_fs >= rqd_pg_num) { -+ *cur_fs -= (u16)rqd_pg_num; -+ } else { -+ fs_info->pubq_pg_num -= -+ (u16)(rqd_pg_num - *cur_fs); -+ *cur_fs = 0; -+ } -+ -+ break; -+ } -+ -+ update_sdio_free_page_8821c(adapter); -+ -+ cnt--; -+ if (cnt == 0) -+ return HALMAC_RET_FREE_SPACE_NOT_ENOUGH; -+ } while (1); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * halmac_reg_read_8_sdio_88xx() - read 1byte register -+ * @adapter : the adapter of halmac -+ * @offset : register offset -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+u8 -+reg_r8_sdio_8821c(struct halmac_adapter *adapter, u32 offset) -+{ -+ u8 value8; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (adapter->sdio_hw_info.io_indir_flag == 0) { -+ if (0 == (offset & 0xFFFF0000)) -+ offset |= WLAN_IOREG_OFFSET; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ value8 = PLTFM_SDIO_CMD52_R(offset); -+ } else { -+ if ((offset & 0xFFFF0000) == 0) { -+ value8 = (u8)r_indir_sdio_88xx(adapter, offset, -+ HALMAC_IO_BYTE); -+ } else { -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ value8 = PLTFM_SDIO_CMD52_R(offset); -+ } -+ } -+ -+ return value8; -+} -+ -+/** -+ * halmac_reg_write_8_sdio_88xx() - write 1byte register -+ * @adapter : the adapter of halmac -+ * @offset : register offset -+ * @value : register value -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+reg_w8_sdio_8821c(struct halmac_adapter *adapter, u32 offset, u8 value) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_sdio_cmd53_4byte_mode cmd53_4byte = -+ adapter->sdio_cmd53_4byte; -+ -+ if (adapter->sdio_hw_info.io_indir_flag == 0) { -+ if (0 == (offset & 0xFFFF0000)) -+ offset |= WLAN_IOREG_OFFSET; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ PLTFM_SDIO_CMD52_W(offset, value); -+ } else { -+ if ((offset & 0xFFFF0000) == 0) { -+ w_indir_sdio_88xx(adapter, offset, value, -+ HALMAC_IO_BYTE); -+ } else { -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ PLTFM_SDIO_CMD52_W(offset, value); -+ } -+ } -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * halmac_reg_read_16_sdio_88xx() - read 2byte register -+ * @adapter : the adapter of halmac -+ * @offset : register offset -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+u16 -+reg_r16_sdio_8821c(struct halmac_adapter *adapter, u32 offset) -+{ -+ u32 offset_old = 0; -+ enum halmac_sdio_cmd53_4byte_mode cmd53_4byte = -+ adapter->sdio_cmd53_4byte; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ union { -+ __le16 word; -+ u8 byte[2]; -+ } val = { 0x0000 }; -+ -+ if (adapter->sdio_hw_info.io_indir_flag == 0) { -+ offset_old = offset; -+ -+ if ((offset & 0xFFFF0000) == 0) -+ offset |= WLAN_IOREG_OFFSET; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF || -+ ((offset & (2 - 1)) != 0) || -+ cmd53_4byte == HALMAC_SDIO_CMD53_4BYTE_MODE_RW || -+ cmd53_4byte == HALMAC_SDIO_CMD53_4BYTE_MODE_R || -+ (adapter->sdio_hw_info.io_hi_speed_flag != 0 && -+ (offset_old & 0xffffef00) == 0x00000000)) { -+ val.byte[0] = PLTFM_SDIO_CMD52_R(offset); -+ val.byte[1] = PLTFM_SDIO_CMD52_R(offset + 1); -+ -+ return rtk_le16_to_cpu(val.word); -+ } -+ -+ return PLTFM_SDIO_CMD53_R16(offset); -+ } -+ -+ if ((offset & 0xFFFF0000) == 0) -+ return (u16)r_indir_sdio_88xx(adapter, offset, HALMAC_IO_WORD); -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF || -+ ((offset & (2 - 1)) != 0) || -+ cmd53_4byte == HALMAC_SDIO_CMD53_4BYTE_MODE_RW || -+ cmd53_4byte == HALMAC_SDIO_CMD53_4BYTE_MODE_R) { -+ val.byte[0] = PLTFM_SDIO_CMD52_R(offset); -+ val.byte[1] = PLTFM_SDIO_CMD52_R(offset + 1); -+ -+ return rtk_le16_to_cpu(val.word); -+ } -+ -+ return PLTFM_SDIO_CMD53_R16(offset); -+} -+ -+/** -+ * halmac_reg_write_16_sdio_88xx() - write 2byte register -+ * @adapter : the adapter of halmac -+ * @offset : register offset -+ * @value : register value -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+reg_w16_sdio_8821c(struct halmac_adapter *adapter, u32 offset, u16 val) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_sdio_cmd53_4byte_mode cmd53_4byte = -+ adapter->sdio_cmd53_4byte; -+ -+ if (adapter->sdio_hw_info.io_indir_flag == 0) { -+ if (0 == (offset & 0xFFFF0000)) -+ offset |= WLAN_IOREG_OFFSET; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF || -+ ((offset & (2 - 1)) != 0) || -+ cmd53_4byte == HALMAC_SDIO_CMD53_4BYTE_MODE_RW || -+ cmd53_4byte == HALMAC_SDIO_CMD53_4BYTE_MODE_W) { -+ PLTFM_SDIO_CMD52_W(offset, (u8)(val & 0xFF)); -+ PLTFM_SDIO_CMD52_W(offset + 1, -+ (u8)((val & 0xFF00) >> 8)); -+ } else { -+ PLTFM_SDIO_CMD53_W16(offset, val); -+ } -+ } else { -+ if ((offset & 0xFFFF0000) == 0) { -+ status = w_indir_sdio_88xx(adapter, offset, val, -+ HALMAC_IO_WORD); -+ return status; -+ } -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF || -+ ((offset & (2 - 1)) != 0) || -+ cmd53_4byte == HALMAC_SDIO_CMD53_4BYTE_MODE_RW || -+ cmd53_4byte == HALMAC_SDIO_CMD53_4BYTE_MODE_W) { -+ PLTFM_SDIO_CMD52_W(offset, (u8)(val & 0xFF)); -+ PLTFM_SDIO_CMD52_W(offset + 1, -+ (u8)((val & 0xFF00) >> 8)); -+ } else { -+ PLTFM_SDIO_CMD53_W16(offset, val); -+ } -+ } -+ return status; -+} -+ -+/** -+ * halmac_reg_read_32_sdio_88xx() - read 4byte register -+ * @adapter : the adapter of halmac -+ * @offset : register offset -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+u32 -+reg_r32_sdio_8821c(struct halmac_adapter *adapter, u32 offset) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ u32 offset_old = 0; -+ union { -+ __le32 dword; -+ u8 byte[4]; -+ } val = { 0x00000000 }; -+ -+ if (adapter->sdio_hw_info.io_indir_flag == 0) { -+ offset_old = offset; -+ if (0 == (offset & 0xFFFF0000)) -+ offset |= WLAN_IOREG_OFFSET; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF || -+ (offset & (4 - 1)) != 0 || -+ (adapter->sdio_hw_info.io_hi_speed_flag != 0 && -+ (offset_old & 0xffffef00) == 0x00000000)) { -+ val.byte[0] = PLTFM_SDIO_CMD52_R(offset); -+ val.byte[1] = PLTFM_SDIO_CMD52_R(offset + 1); -+ val.byte[2] = PLTFM_SDIO_CMD52_R(offset + 2); -+ val.byte[3] = PLTFM_SDIO_CMD52_R(offset + 3); -+ -+ return rtk_le32_to_cpu(val.dword); -+ } -+ -+ return PLTFM_SDIO_CMD53_R32(offset); -+ } -+ -+ if ((offset & 0xFFFF0000) == 0) -+ return r_indir_sdio_88xx(adapter, offset, HALMAC_IO_DWORD); -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF || -+ (offset & (4 - 1)) != 0) { -+ val.byte[0] = PLTFM_SDIO_CMD52_R(offset); -+ val.byte[1] = PLTFM_SDIO_CMD52_R(offset + 1); -+ val.byte[2] = PLTFM_SDIO_CMD52_R(offset + 2); -+ val.byte[3] = PLTFM_SDIO_CMD52_R(offset + 3); -+ -+ return rtk_le32_to_cpu(val.dword); -+ } -+ -+ return PLTFM_SDIO_CMD53_R32(offset); -+} -+ -+/** -+ * halmac_reg_write_32_sdio_88xx() - write 4byte register -+ * @adapter : the adapter of halmac -+ * @offset : register offset -+ * @value : register value -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+reg_w32_sdio_8821c(struct halmac_adapter *adapter, u32 offset, u32 val) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (adapter->sdio_hw_info.io_indir_flag == 0) { -+ if ((offset & 0xFFFF0000) == 0) -+ offset |= WLAN_IOREG_OFFSET; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF || -+ (offset & (4 - 1)) != 0) { -+ PLTFM_SDIO_CMD52_W(offset, (u8)(val & 0xFF)); -+ PLTFM_SDIO_CMD52_W(offset + 1, -+ (u8)((val >> 8) & 0xFF)); -+ PLTFM_SDIO_CMD52_W(offset + 2, -+ (u8)((val >> 16) & 0xFF)); -+ PLTFM_SDIO_CMD52_W(offset + 3, -+ (u8)((val >> 24) & 0xFF)); -+ } else { -+ PLTFM_SDIO_CMD53_W32(offset, val); -+ } -+ } else { -+ if ((offset & 0xFFFF0000) == 0) { -+ status = w_indir_sdio_88xx(adapter, offset, val, -+ HALMAC_IO_DWORD); -+ return status; -+ } -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF || -+ (offset & (4 - 1)) != 0) { -+ PLTFM_SDIO_CMD52_W(offset, (u8)(val & 0xFF)); -+ PLTFM_SDIO_CMD52_W(offset + 1, -+ (u8)((val >> 8) & 0xFF)); -+ PLTFM_SDIO_CMD52_W(offset + 2, -+ (u8)((val >> 16) & 0xFF)); -+ PLTFM_SDIO_CMD52_W(offset + 3, -+ (u8)((val >> 24) & 0xFF)); -+ } else { -+ PLTFM_SDIO_CMD53_W32(offset, val); -+ } -+ } -+ return status; -+} -+ -+static enum halmac_ret_status -+chk_oqt_8821c(struct halmac_adapter *adapter, u32 tx_agg_num, u8 *buf, -+ u8 macid_cnt) -+{ -+ u32 cnt = 10; -+ struct halmac_sdio_free_space *fs_info = &adapter->sdio_fs; -+ -+ /*S0, S1 are not allowed to use, 0x4E4[0] should be 0. Soar 20160323*/ -+ /*no need to check non_ac_oqt_number*/ -+ /*HI and MGQ blocked will cause protocal issue before H_OQT being full*/ -+ switch ((enum halmac_qsel)GET_TX_DESC_QSEL(buf)) { -+ case HALMAC_QSEL_VO: -+ case HALMAC_QSEL_VO_V2: -+ case HALMAC_QSEL_VI: -+ case HALMAC_QSEL_VI_V2: -+ case HALMAC_QSEL_BE: -+ case HALMAC_QSEL_BE_V2: -+ case HALMAC_QSEL_BK: -+ case HALMAC_QSEL_BK_V2: -+ if (macid_cnt > WLAN_ACQ_NUM_MAX && -+ tx_agg_num > OQT_ENTRY_AC_8821C) { -+ PLTFM_MSG_WARN("[WARN]txagg num %d > oqt entry\n", -+ tx_agg_num); -+ PLTFM_MSG_WARN("[WARN]macid cnt %d > acq max\n", -+ macid_cnt); -+ } -+ -+ cnt = 10; -+ do { -+ if (fs_info->ac_empty >= macid_cnt) { -+ fs_info->ac_empty -= macid_cnt; -+ break; -+ } -+ -+ if (fs_info->ac_oqt_num >= tx_agg_num) { -+ fs_info->ac_empty = 0; -+ fs_info->ac_oqt_num -= (u8)tx_agg_num; -+ break; -+ } -+ -+ update_oqt_free_space_8821c(adapter); -+ -+ cnt--; -+ if (cnt == 0) -+ return HALMAC_RET_OQT_NOT_ENOUGH; -+ } while (1); -+ break; -+ case HALMAC_QSEL_MGNT: -+ case HALMAC_QSEL_HIGH: -+ if (tx_agg_num > OQT_ENTRY_NOAC_8821C) -+ PLTFM_MSG_WARN("[WARN]tx_agg_num %d > oqt entry\n", -+ tx_agg_num); -+ cnt = 10; -+ do { -+ if (fs_info->non_ac_oqt_num >= tx_agg_num) { -+ fs_info->non_ac_oqt_num -= (u8)tx_agg_num; -+ break; -+ } -+ -+ update_oqt_free_space_8821c(adapter); -+ -+ cnt--; -+ if (cnt == 0) -+ return HALMAC_RET_OQT_NOT_ENOUGH; -+ } while (1); -+ break; -+ default: -+ break; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+update_oqt_free_space_8821c(struct halmac_adapter *adapter) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ struct halmac_sdio_free_space *fs_info = &adapter->sdio_fs; -+ u8 value; -+ u32 oqt_free_page; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ oqt_free_page = HALMAC_REG_R32(REG_SDIO_OQT_FREE_TXPG_V1); -+ fs_info->ac_oqt_num = (u8)BIT_GET_AC_OQT_FREEPG_V1(oqt_free_page); -+ fs_info->non_ac_oqt_num = (u8)BIT_GET_NOAC_OQT_FREEPG_V1(oqt_free_page); -+ fs_info->ac_empty = 0; -+ if (fs_info->ac_oqt_num == OQT_ENTRY_AC_8821C) { -+ value = HALMAC_REG_R8(REG_TXPKT_EMPTY); -+ while (value > 0) { -+ value = value & (value - 1); -+ fs_info->ac_empty++; -+ }; -+ } else { -+ PLTFM_MSG_TRACE("[TRACE]free_space->ac_oqt_num %d != %d\n", -+ fs_info->ac_oqt_num, OQT_ENTRY_AC_8821C); -+ } -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+update_sdio_free_page_8821c(struct halmac_adapter *adapter) -+{ -+ u32 free_page = 0; -+ u32 free_page2 = 0; -+ u32 free_page3 = 0; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ struct halmac_sdio_free_space *fs_info = &adapter->sdio_fs; -+ u8 data[12] = {0}; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ HALMAC_REG_SDIO_RN(REG_SDIO_FREE_TXPG, 12, data); -+ -+ free_page = rtk_le32_to_cpu(*(__le32 *)(data + 0)); -+ free_page2 = rtk_le32_to_cpu(*(__le32 *)(data + 4)); -+ free_page3 = rtk_le32_to_cpu(*(__le32 *)(data + 8)); -+ -+ fs_info->hiq_pg_num = (u16)BIT_GET_HIQ_FREEPG_V1(free_page); -+ fs_info->miq_pg_num = (u16)BIT_GET_MID_FREEPG_V1(free_page); -+ fs_info->lowq_pg_num = (u16)BIT_GET_LOW_FREEPG_V1(free_page2); -+ fs_info->pubq_pg_num = (u16)BIT_GET_PUB_FREEPG_V1(free_page2); -+ fs_info->exq_pg_num = (u16)BIT_GET_EXQ_FREEPG_V1(free_page3); -+ fs_info->ac_oqt_num = (u8)BIT_GET_AC_OQT_FREEPG_V1(free_page3); -+ fs_info->non_ac_oqt_num = (u8)BIT_GET_NOAC_OQT_FREEPG_V1(free_page3); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * phy_cfg_sdio_8821c() - phy config -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+phy_cfg_sdio_8821c(struct halmac_adapter *adapter, -+ enum halmac_intf_phy_platform pltfm) -+{ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * halmac_pcie_switch_8821c() - pcie gen1/gen2 switch -+ * @adapter : the adapter of halmac -+ * @cfg : gen1/gen2 selection -+ * Author : KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+pcie_switch_sdio_8821c(struct halmac_adapter *adapter, -+ enum halmac_pcie_cfg cfg) -+{ -+ return HALMAC_RET_NOT_SUPPORT; -+} -+ -+/** -+ * intf_tun_sdio_8821c() - sdio interface fine tuning -+ * @adapter : the adapter of halmac -+ * Author : Ivan -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+intf_tun_sdio_8821c(struct halmac_adapter *adapter) -+{ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * halmac_get_sdio_tx_addr_sdio_88xx() - get CMD53 addr for the TX packet -+ * @adapter : the adapter of halmac -+ * @buf : tx packet, include txdesc -+ * @size : tx packet size -+ * @cmd53_addr : cmd53 addr value -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_sdio_tx_addr_8821c(struct halmac_adapter *adapter, u8 *buf, u32 size, -+ u32 *cmd53_addr) -+{ -+ u32 len_unit4; -+ enum halmac_qsel queue_sel; -+ enum halmac_dma_mapping dma_mapping; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (!buf) { -+ PLTFM_MSG_ERR("[ERR]buf is NULL!!\n"); -+ return HALMAC_RET_DATA_BUF_NULL; -+ } -+ -+ if (size == 0) { -+ PLTFM_MSG_ERR("[ERR]size is 0!!\n"); -+ return HALMAC_RET_DATA_SIZE_INCORRECT; -+ } -+ -+ queue_sel = (enum halmac_qsel)GET_TX_DESC_QSEL(buf); -+ -+ switch (queue_sel) { -+ case HALMAC_QSEL_VO: -+ case HALMAC_QSEL_VO_V2: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_VO]; -+ break; -+ case HALMAC_QSEL_VI: -+ case HALMAC_QSEL_VI_V2: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_VI]; -+ break; -+ case HALMAC_QSEL_BE: -+ case HALMAC_QSEL_BE_V2: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_BE]; -+ break; -+ case HALMAC_QSEL_BK: -+ case HALMAC_QSEL_BK_V2: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_BK]; -+ break; -+ case HALMAC_QSEL_MGNT: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_MG]; -+ break; -+ case HALMAC_QSEL_HIGH: -+ case HALMAC_QSEL_BCN: -+ case HALMAC_QSEL_CMD: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_HI]; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]Qsel is out of range\n"); -+ return HALMAC_RET_QSEL_INCORRECT; -+ } -+ -+ len_unit4 = (size >> 2) + ((size & (4 - 1)) ? 1 : 0); -+ -+ switch (dma_mapping) { -+ case HALMAC_DMA_MAPPING_HIGH: -+ *cmd53_addr = HALMAC_SDIO_CMD_ADDR_TXFF_HIGH; -+ break; -+ case HALMAC_DMA_MAPPING_NORMAL: -+ *cmd53_addr = HALMAC_SDIO_CMD_ADDR_TXFF_NORMAL; -+ break; -+ case HALMAC_DMA_MAPPING_LOW: -+ *cmd53_addr = HALMAC_SDIO_CMD_ADDR_TXFF_LOW; -+ break; -+ case HALMAC_DMA_MAPPING_EXTRA: -+ *cmd53_addr = HALMAC_SDIO_CMD_ADDR_TXFF_EXTRA; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]DmaMapping is out of range\n"); -+ return HALMAC_RET_DMA_MAP_INCORRECT; -+ } -+ -+ *cmd53_addr = (*cmd53_addr << 13) | -+ (len_unit4 & HALMAC_SDIO_4BYTE_LEN_MASK); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+chk_qsel_8821c(struct halmac_adapter *adapter, u8 qsel_first, u8 *pkt, -+ u8 *macid_cnt) -+{ -+ u8 flag = 0; -+ u8 qsel_now; -+ u8 macid; -+ struct halmac_sdio_free_space *fs_info = &adapter->sdio_fs; -+ -+ macid = (u8)GET_TX_DESC_MACID(pkt); -+ qsel_now = (u8)GET_TX_DESC_QSEL(pkt); -+ if (qsel_first == qsel_now) { -+ if (*(fs_info->macid_map + macid) == 0) { -+ *(fs_info->macid_map + macid) = 1; -+ (*macid_cnt)++; -+ } -+ } else { -+ switch ((enum halmac_qsel)qsel_now) { -+ case HALMAC_QSEL_VO: -+ if ((enum halmac_qsel)qsel_first != HALMAC_QSEL_VO_V2) -+ flag = 1; -+ break; -+ case HALMAC_QSEL_VO_V2: -+ if ((enum halmac_qsel)qsel_first != HALMAC_QSEL_VO) -+ flag = 1; -+ break; -+ case HALMAC_QSEL_VI: -+ if ((enum halmac_qsel)qsel_first != HALMAC_QSEL_VI_V2) -+ flag = 1; -+ break; -+ case HALMAC_QSEL_VI_V2: -+ if ((enum halmac_qsel)qsel_first != HALMAC_QSEL_VI) -+ flag = 1; -+ break; -+ case HALMAC_QSEL_BE: -+ if ((enum halmac_qsel)qsel_first != HALMAC_QSEL_BE_V2) -+ flag = 1; -+ break; -+ case HALMAC_QSEL_BE_V2: -+ if ((enum halmac_qsel)qsel_first != HALMAC_QSEL_BE) -+ flag = 1; -+ break; -+ case HALMAC_QSEL_BK: -+ if ((enum halmac_qsel)qsel_first != HALMAC_QSEL_BK_V2) -+ flag = 1; -+ break; -+ case HALMAC_QSEL_BK_V2: -+ if ((enum halmac_qsel)qsel_first != HALMAC_QSEL_BK) -+ flag = 1; -+ break; -+ case HALMAC_QSEL_MGNT: -+ case HALMAC_QSEL_HIGH: -+ case HALMAC_QSEL_BCN: -+ case HALMAC_QSEL_CMD: -+ flag = 1; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]Qsel is out of range\n"); -+ return HALMAC_RET_QSEL_INCORRECT; -+ } -+ if (flag == 1) { -+ PLTFM_MSG_ERR("[ERR]Multi-Qsel is not allowed\n"); -+ PLTFM_MSG_ERR("[ERR]qsel = %d, %d\n", -+ qsel_first, qsel_now); -+ return HALMAC_RET_QSEL_INCORRECT; -+ } -+ if (*(fs_info->macid_map + macid + MACID_MAX_8821C) == 0) { -+ *(fs_info->macid_map + macid + MACID_MAX_8821C) = 1; -+ (*macid_cnt)++; -+ } -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+chk_dma_mapping_8821c(struct halmac_adapter *adapter, u16 **cur_fs, -+ u8 qsel_first) -+{ -+ enum halmac_dma_mapping dma_mapping; -+ -+ switch ((enum halmac_qsel)qsel_first) { -+ case HALMAC_QSEL_VO: -+ case HALMAC_QSEL_VO_V2: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_VO]; -+ break; -+ case HALMAC_QSEL_VI: -+ case HALMAC_QSEL_VI_V2: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_VI]; -+ break; -+ case HALMAC_QSEL_BE: -+ case HALMAC_QSEL_BE_V2: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_BE]; -+ break; -+ case HALMAC_QSEL_BK: -+ case HALMAC_QSEL_BK_V2: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_BK]; -+ break; -+ case HALMAC_QSEL_MGNT: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_MG]; -+ break; -+ case HALMAC_QSEL_HIGH: -+ dma_mapping = adapter->pq_map[HALMAC_PQ_MAP_HI]; -+ break; -+ case HALMAC_QSEL_BCN: -+ case HALMAC_QSEL_CMD: -+ *cur_fs = &adapter->sdio_fs.hiq_pg_num; -+ return HALMAC_RET_SUCCESS; -+ default: -+ PLTFM_MSG_ERR("[ERR]Qsel is out of range: %d\n", qsel_first); -+ return HALMAC_RET_QSEL_INCORRECT; -+ } -+ -+ switch (dma_mapping) { -+ case HALMAC_DMA_MAPPING_HIGH: -+ *cur_fs = &adapter->sdio_fs.hiq_pg_num; -+ break; -+ case HALMAC_DMA_MAPPING_NORMAL: -+ *cur_fs = &adapter->sdio_fs.miq_pg_num; -+ break; -+ case HALMAC_DMA_MAPPING_LOW: -+ *cur_fs = &adapter->sdio_fs.lowq_pg_num; -+ break; -+ case HALMAC_DMA_MAPPING_EXTRA: -+ *cur_fs = &adapter->sdio_fs.exq_pg_num; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]DmaMapping is out of range\n"); -+ return HALMAC_RET_DMA_MAP_INCORRECT; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+chk_rqd_page_num_8821c(struct halmac_adapter *adapter, u8 *buf, u32 *rqd_pg_num, -+ u16 **cur_fs, u8 *macid_cnt, u32 tx_agg_num) -+{ -+ u8 *pkt; -+ u8 qsel_first; -+ u32 i; -+ u32 pkt_size; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ pkt = buf; -+ -+ qsel_first = (u8)GET_TX_DESC_QSEL(pkt); -+ -+ status = chk_dma_mapping_8821c(adapter, cur_fs, qsel_first); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ for (i = 0; i < tx_agg_num; i++) { -+ /*QSEL parser*/ -+ status = chk_qsel_8821c(adapter, qsel_first, pkt, macid_cnt); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ /*Page number parser*/ -+ pkt_size = GET_TX_DESC_TXPKTSIZE(pkt) + GET_TX_DESC_OFFSET(pkt); -+ *rqd_pg_num += (pkt_size >> TX_PAGE_SIZE_SHIFT_88XX) + -+ ((pkt_size & (TX_PAGE_SIZE_88XX - 1)) ? 1 : 0); -+ -+ pkt += HALMAC_ALIGN(GET_TX_DESC_TXPKTSIZE(pkt) + -+ (GET_TX_DESC_PKT_OFFSET(pkt) << 3) + -+ TX_DESC_SIZE_88XX, 8); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+#endif /* HALMAC_8821C_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_sdio_8821c.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_sdio_8821c.h -new file mode 100644 -index 000000000..6f4e0e6b9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_8821c/halmac_sdio_8821c.h -@@ -0,0 +1,69 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_SDIO_8821C_H_ -+#define _HALMAC_SDIO_8821C_H_ -+ -+#include "../../halmac_api.h" -+#include "halmac_8821c_cfg.h" -+ -+#if (HALMAC_8821C_SUPPORT && HALMAC_SDIO_SUPPORT) -+ -+enum halmac_ret_status -+init_sdio_cfg_8821c(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+mac_pwr_switch_sdio_8821c(struct halmac_adapter *adapter, -+ enum halmac_mac_power pwr); -+ -+enum halmac_ret_status -+tx_allowed_sdio_8821c(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+u8 -+reg_r8_sdio_8821c(struct halmac_adapter *adapter, u32 offset); -+ -+enum halmac_ret_status -+reg_w8_sdio_8821c(struct halmac_adapter *adapter, u32 offset, u8 value); -+ -+u16 -+reg_r16_sdio_8821c(struct halmac_adapter *adapter, u32 offset); -+ -+enum halmac_ret_status -+reg_w16_sdio_8821c(struct halmac_adapter *adapter, u32 offset, u16 val); -+ -+u32 -+reg_r32_sdio_8821c(struct halmac_adapter *adapter, u32 offset); -+ -+enum halmac_ret_status -+reg_w32_sdio_8821c(struct halmac_adapter *adapter, u32 offset, u32 val); -+ -+enum halmac_ret_status -+phy_cfg_sdio_8821c(struct halmac_adapter *adapter, -+ enum halmac_intf_phy_platform pltfm); -+ -+enum halmac_ret_status -+pcie_switch_sdio_8821c(struct halmac_adapter *adapter, -+ enum halmac_pcie_cfg cfg); -+ -+enum halmac_ret_status -+intf_tun_sdio_8821c(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+get_sdio_tx_addr_8821c(struct halmac_adapter *adapter, u8 *buf, u32 size, -+ u32 *cmd53_addr); -+ -+#endif /* HALMAC_8821C_SUPPORT */ -+ -+#endif/* _HALMAC_SDIO_8821C_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_88xx_cfg.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_88xx_cfg.h -new file mode 100644 -index 000000000..814e865ac ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_88xx_cfg.h -@@ -0,0 +1,44 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_88XX_CFG_H_ -+#define _HALMAC_88XX_CFG_H_ -+ -+#include "../halmac_api.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+#define TX_PAGE_SIZE_88XX 128 -+#define TX_PAGE_SIZE_SHIFT_88XX 7 /* 128 = 2^7 */ -+#define TX_ALIGN_SIZE_88XX 8 -+#define SDIO_TX_MAX_SIZE_88XX 31744 -+#define RX_BUF_FW_88XX 12288 -+ -+#define TX_DESC_SIZE_88XX 48 -+#define RX_DESC_SIZE_88XX 24 -+ -+#define H2C_PKT_SIZE_88XX 32 /* Only support 32 byte packet now */ -+#define H2C_PKT_HDR_SIZE_88XX 8 -+#define C2H_DATA_OFFSET_88XX 10 -+#define C2H_PKT_BUF_88XX 256 -+ -+/* HW memory address */ -+#define OCPBASE_TXBUF_88XX 0x18780000 -+#define OCPBASE_DMEM_88XX 0x00200000 -+#define OCPBASE_EMEM_88XX 0x00100000 -+ -+#endif /* HALMAC_88XX_SUPPORT */ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_bb_rf_88xx.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_bb_rf_88xx.c -new file mode 100644 -index 000000000..245f424be ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_bb_rf_88xx.c -@@ -0,0 +1,571 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_bb_rf_88xx.h" -+#include "halmac_88xx_cfg.h" -+#include "halmac_common_88xx.h" -+#include "halmac_init_88xx.h" -+ -+#if HALMAC_88XX_SUPPORT -+/** -+ * start_dpk_88xx() -trigger FW DPK -+ * @adapter : the adapter of halmac -+ * Author : Yong-Ching Lin/KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+start_dpk_88xx(struct halmac_adapter *adapter) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.dpk_state.proc_status; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (adapter->fw_ver.h2c_version < 15) -+ return HALMAC_RET_FW_NO_SUPPORT; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_TRACE("[TRACE]Wait event(dpk)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_DPK; -+ hdr_info.content_size = 1; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ adapter->halmac_state.dpk_state.seq_num = seq_num; -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c pkt fail!!\n"); -+ reset_ofld_feature_88xx(adapter, HALMAC_FEATURE_DPK); -+ return status; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * start_iqk_88xx() -trigger FW IQK -+ * @adapter : the adapter of halmac -+ * @param : IQK parameter -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+start_iqk_88xx(struct halmac_adapter *adapter, struct halmac_iqk_para *param) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.iqk_state.proc_status; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_TRACE("[TRACE]Wait event(iqk)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ IQK_SET_CLEAR(h2c_buf, param->clear); -+ IQK_SET_SEGMENT_IQK(h2c_buf, param->segment_iqk); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_IQK; -+ hdr_info.content_size = 1; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ adapter->halmac_state.iqk_state.seq_num = seq_num; -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c pkt fail!!\n"); -+ reset_ofld_feature_88xx(adapter, HALMAC_FEATURE_IQK); -+ return status; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * ctrl_pwr_tracking_88xx() -trigger FW power tracking -+ * @adapter : the adapter of halmac -+ * @opt : power tracking option -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+ctrl_pwr_tracking_88xx(struct halmac_adapter *adapter, -+ struct halmac_pwr_tracking_option *opt) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_h2c_header_info hdr_info; -+ struct halmac_pwr_tracking_para *param; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.pwr_trk_state.proc_status; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_TRACE("[TRACE]Wait event(pwr tracking)...\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ PWR_TRK_SET_TYPE(h2c_buf, opt->type); -+ PWR_TRK_SET_BBSWING_INDEX(h2c_buf, opt->bbswing_index); -+ -+ param = &opt->pwr_tracking_para[HALMAC_RF_PATH_A]; -+ PWR_TRK_SET_ENABLE_A(h2c_buf, param->enable); -+ PWR_TRK_SET_TX_PWR_INDEX_A(h2c_buf, param->tx_pwr_index); -+ PWR_TRK_SET_TSSI_VALUE_A(h2c_buf, param->tssi_value); -+ PWR_TRK_SET_OFFSET_VALUE_A(h2c_buf, param->pwr_tracking_offset_value); -+ -+ param = &opt->pwr_tracking_para[HALMAC_RF_PATH_B]; -+ PWR_TRK_SET_ENABLE_B(h2c_buf, param->enable); -+ PWR_TRK_SET_TX_PWR_INDEX_B(h2c_buf, param->tx_pwr_index); -+ PWR_TRK_SET_TSSI_VALUE_B(h2c_buf, param->tssi_value); -+ PWR_TRK_SET_OFFSET_VALUE_B(h2c_buf, param->pwr_tracking_offset_value); -+ -+ param = &opt->pwr_tracking_para[HALMAC_RF_PATH_C]; -+ PWR_TRK_SET_ENABLE_C(h2c_buf, param->enable); -+ PWR_TRK_SET_TX_PWR_INDEX_C(h2c_buf, param->tx_pwr_index); -+ PWR_TRK_SET_TSSI_VALUE_C(h2c_buf, param->tssi_value); -+ PWR_TRK_SET_OFFSET_VALUE_C(h2c_buf, param->pwr_tracking_offset_value); -+ -+ param = &opt->pwr_tracking_para[HALMAC_RF_PATH_D]; -+ PWR_TRK_SET_ENABLE_D(h2c_buf, param->enable); -+ PWR_TRK_SET_TX_PWR_INDEX_D(h2c_buf, param->tx_pwr_index); -+ PWR_TRK_SET_TSSI_VALUE_D(h2c_buf, param->tssi_value); -+ PWR_TRK_SET_OFFSET_VALUE_D(h2c_buf, param->pwr_tracking_offset_value); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_PWR_TRK; -+ hdr_info.content_size = 20; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ adapter->halmac_state.pwr_trk_state.seq_num = seq_num; -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c pkt fail!!\n"); -+ reset_ofld_feature_88xx(adapter, HALMAC_FEATURE_POWER_TRACKING); -+ return status; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_iqk_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status) -+{ -+ *proc_status = adapter->halmac_state.iqk_state.proc_status; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_dpk_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status, u8 *data, -+ u32 *size) -+{ -+ struct halmac_dpk_state *state = &adapter->halmac_state.dpk_state; -+ -+ *proc_status = adapter->halmac_state.dpk_state.proc_status; -+ -+ if (!data) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (!size) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_DONE) { -+ if (*size < state->data_size) { -+ *size = state->data_size; -+ return HALMAC_RET_BUFFER_TOO_SMALL; -+ } -+ -+ *size = state->data_size; -+ PLTFM_MEMCPY(data, state->data, *size); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_pwr_trk_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status) -+{ -+ *proc_status = adapter->halmac_state.pwr_trk_state.proc_status; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_psd_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status, u8 *data, -+ u32 *size) -+{ -+ struct halmac_psd_state *state = &adapter->halmac_state.psd_state; -+ -+ *proc_status = state->proc_status; -+ -+ if (!data) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (!size) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_DONE) { -+ if (*size < state->data_size) { -+ *size = state->data_size; -+ return HALMAC_RET_BUFFER_TOO_SMALL; -+ } -+ -+ *size = state->data_size; -+ PLTFM_MEMCPY(data, state->data, *size); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * psd_88xx() - trigger fw psd -+ * @adapter : the adapter of halmac -+ * @start_psd : start PSD -+ * @end_psd : end PSD -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+psd_88xx(struct halmac_adapter *adapter, u16 start_psd, u16 end_psd) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.psd_state.proc_status; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_TRACE("[TRACE]Wait event(psd)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (adapter->halmac_state.psd_state.data) { -+ PLTFM_FREE(adapter->halmac_state.psd_state.data, -+ adapter->halmac_state.psd_state.data_size); -+ adapter->halmac_state.psd_state.data = (u8 *)NULL; -+ } -+ -+ adapter->halmac_state.psd_state.data_size = 0; -+ adapter->halmac_state.psd_state.seg_size = 0; -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ PSD_SET_START_PSD(h2c_buf, start_psd); -+ PSD_SET_END_PSD(h2c_buf, end_psd); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_PSD; -+ hdr_info.content_size = 4; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c pkt fail!!\n"); -+ reset_ofld_feature_88xx(adapter, HALMAC_FEATURE_PSD); -+ return status; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_h2c_ack_iqk_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seq_num; -+ u8 fw_rc; -+ struct halmac_iqk_state *state = &adapter->halmac_state.iqk_state; -+ enum halmac_cmd_process_status proc_status; -+ -+ seq_num = (u8)H2C_ACK_HDR_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ state->fw_rc = fw_rc; -+ -+ if ((enum halmac_h2c_return_code)fw_rc == HALMAC_H2C_RETURN_SUCCESS) { -+ proc_status = HALMAC_CMD_PROCESS_DONE; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_IQK, proc_status, NULL, 0); -+ } else { -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_IQK, proc_status, &fw_rc, 1); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_h2c_ack_dpk_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seq_num; -+ u8 fw_rc; -+ struct halmac_dpk_state *state = &adapter->halmac_state.dpk_state; -+ enum halmac_cmd_process_status proc_status; -+ -+ seq_num = (u8)H2C_ACK_HDR_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ state->fw_rc = fw_rc; -+ -+ if ((enum halmac_h2c_return_code)fw_rc == HALMAC_H2C_RETURN_SUCCESS) { -+ proc_status = HALMAC_CMD_PROCESS_RCVD; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_DPK, proc_status, NULL, 0); -+ } else { -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_DPK, proc_status, &fw_rc, 1); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_dpk_data_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seq_num; -+ u8 seg_id; -+ u8 seg_size; -+ u16 total_size; -+ enum halmac_cmd_process_status proc_status; -+ struct halmac_dpk_state *state = &adapter->halmac_state.dpk_state; -+ -+ seq_num = (u8)DPK_DATA_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_RCVD) { -+ PLTFM_MSG_ERR("[ERR]not receive dpk ack\n"); -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ } -+ -+ total_size = (u16)DPK_DATA_GET_TOTAL_SIZE(buf); -+ seg_id = (u8)DPK_DATA_GET_SEGMENT_ID(buf); -+ seg_size = (u8)DPK_DATA_GET_SEGMENT_SIZE(buf); -+ state->data_size = total_size; -+ -+ if (!state->data) { -+ state->data = (u8 *)PLTFM_MALLOC(state->data_size); -+ if (!state->data) { -+ PLTFM_MSG_ERR("[ERR]malloc fail!!\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ } -+ -+ if (seg_id == 0) -+ state->seg_size = seg_size; -+ -+ PLTFM_MEMCPY(state->data + seg_id * state->seg_size, -+ buf + C2H_DATA_OFFSET_88XX, seg_size); -+ -+ if (DPK_DATA_GET_END_SEGMENT(buf) == 0) -+ return HALMAC_RET_SUCCESS; -+ -+ proc_status = HALMAC_CMD_PROCESS_DONE; -+ state->proc_status = proc_status; -+ -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_DPK, state->proc_status, state->data, -+ state->data_size); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_h2c_ack_pwr_trk_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seq_num; -+ u8 fw_rc; -+ struct halmac_pwr_tracking_state *state; -+ enum halmac_cmd_process_status proc_status; -+ -+ state = &adapter->halmac_state.pwr_trk_state; -+ -+ seq_num = (u8)H2C_ACK_HDR_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ state->fw_rc = fw_rc; -+ -+ if ((enum halmac_h2c_return_code)fw_rc == HALMAC_H2C_RETURN_SUCCESS) { -+ proc_status = HALMAC_CMD_PROCESS_DONE; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_POWER_TRACKING, proc_status, -+ NULL, 0); -+ } else { -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_POWER_TRACKING, proc_status, -+ &fw_rc, 1); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_psd_data_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seg_id; -+ u8 seg_size; -+ u8 seq_num; -+ u16 total_size; -+ enum halmac_cmd_process_status proc_status; -+ struct halmac_psd_state *state = &adapter->halmac_state.psd_state; -+ -+ seq_num = (u8)PSD_DATA_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ total_size = (u16)PSD_DATA_GET_TOTAL_SIZE(buf); -+ seg_id = (u8)PSD_DATA_GET_SEGMENT_ID(buf); -+ seg_size = (u8)PSD_DATA_GET_SEGMENT_SIZE(buf); -+ state->data_size = total_size; -+ -+ if (!state->data) -+ state->data = (u8 *)PLTFM_MALLOC(state->data_size); -+ -+ if (seg_id == 0) -+ state->seg_size = seg_size; -+ -+ PLTFM_MEMCPY(state->data + seg_id * state->seg_size, -+ buf + C2H_DATA_OFFSET_88XX, seg_size); -+ -+ if (PSD_DATA_GET_END_SEGMENT(buf) == 0) -+ return HALMAC_RET_SUCCESS; -+ -+ proc_status = HALMAC_CMD_PROCESS_DONE; -+ state->proc_status = proc_status; -+ -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_PSD, proc_status, state->data, -+ state->data_size); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+#endif /* HALMAC_88XX_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_bb_rf_88xx.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_bb_rf_88xx.h -new file mode 100644 -index 000000000..1aa23868a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_bb_rf_88xx.h -@@ -0,0 +1,71 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_BB_RF_88XX_H_ -+#define _HALMAC_BB_RF_88XX_H_ -+ -+#include "../halmac_api.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+enum halmac_ret_status -+start_iqk_88xx(struct halmac_adapter *adapter, struct halmac_iqk_para *param); -+ -+enum halmac_ret_status -+ctrl_pwr_tracking_88xx(struct halmac_adapter *adapter, -+ struct halmac_pwr_tracking_option *opt); -+ -+enum halmac_ret_status -+get_iqk_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status); -+ -+enum halmac_ret_status -+get_pwr_trk_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status); -+ -+enum halmac_ret_status -+get_psd_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status, u8 *data, -+ u32 *size); -+ -+enum halmac_ret_status -+psd_88xx(struct halmac_adapter *adapter, u16 start_psd, u16 end_psd); -+ -+enum halmac_ret_status -+get_h2c_ack_iqk_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+enum halmac_ret_status -+get_h2c_ack_pwr_trk_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+enum halmac_ret_status -+get_psd_data_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+enum halmac_ret_status -+start_dpk_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+get_h2c_ack_dpk_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+enum halmac_ret_status -+get_dpk_data_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+enum halmac_ret_status -+get_dpk_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status, u8 *data, -+ u32 *size); -+ -+#endif /* HALMAC_88XX_SUPPORT */ -+ -+#endif/* _HALMAC_BB_RF_88XX_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_cfg_wmac_88xx.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_cfg_wmac_88xx.c -new file mode 100644 -index 000000000..053a552d5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_cfg_wmac_88xx.c -@@ -0,0 +1,1210 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_cfg_wmac_88xx.h" -+#include "halmac_88xx_cfg.h" -+#include "halmac_efuse_88xx.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+#define MAC_CLK_SPEED 80 /* 80M */ -+#define EFUSE_PCB_INFO_OFFSET 0xCA -+ -+enum mac_clock_hw_def { -+ MAC_CLK_HW_DEF_80M = 0, -+ MAC_CLK_HW_DEF_40M = 1, -+ MAC_CLK_HW_DEF_20M = 2, -+}; -+ -+static enum halmac_ret_status -+board_rf_fine_tune_88xx(struct halmac_adapter *adapter); -+ -+/** -+ * cfg_mac_addr_88xx() - config mac address -+ * @adapter : the adapter of halmac -+ * @port : 0 for port0, 1 for port1, 2 for port2, 3 for port3, 4 for port4 -+ * @addr : mac address -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_mac_addr_88xx(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr) -+{ -+ u32 offset; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (port >= HALMAC_PORTID_NUM) { -+ PLTFM_MSG_ERR("[ERR]port index >= 5\n"); -+ return HALMAC_RET_PORT_NOT_SUPPORT; -+ } -+ -+ switch (port) { -+ case HALMAC_PORTID0: -+ offset = REG_MACID; -+ break; -+ case HALMAC_PORTID1: -+ offset = REG_MACID1; -+ break; -+ case HALMAC_PORTID2: -+ offset = REG_MACID2; -+ break; -+ case HALMAC_PORTID3: -+ offset = REG_MACID3; -+ break; -+ case HALMAC_PORTID4: -+ offset = REG_MACID4; -+ break; -+ default: -+ return HALMAC_RET_PORT_NOT_SUPPORT; -+ } -+ -+ HALMAC_REG_W32(offset, rtk_le32_to_cpu(addr->addr_l_h.low)); -+ HALMAC_REG_W16(offset + 4, rtk_le16_to_cpu(addr->addr_l_h.high)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_bssid_88xx() - config BSSID -+ * @adapter : the adapter of halmac -+ * @port : 0 for port0, 1 for port1, 2 for port2, 3 for port3, 4 for port4 -+ * @addr : bssid -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_bssid_88xx(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr) -+{ -+ u32 offset; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (port >= HALMAC_PORTID_NUM) { -+ PLTFM_MSG_ERR("[ERR]port index > 5\n"); -+ return HALMAC_RET_PORT_NOT_SUPPORT; -+ } -+ -+ switch (port) { -+ case HALMAC_PORTID0: -+ offset = REG_BSSID; -+ break; -+ case HALMAC_PORTID1: -+ offset = REG_BSSID1; -+ break; -+ case HALMAC_PORTID2: -+ offset = REG_BSSID2; -+ break; -+ case HALMAC_PORTID3: -+ offset = REG_BSSID3; -+ break; -+ case HALMAC_PORTID4: -+ offset = REG_BSSID4; -+ break; -+ default: -+ return HALMAC_RET_PORT_NOT_SUPPORT; -+ } -+ -+ HALMAC_REG_W32(offset, rtk_le32_to_cpu(addr->addr_l_h.low)); -+ HALMAC_REG_W16(offset + 4, rtk_le16_to_cpu(addr->addr_l_h.high)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_transmitter_addr_88xx() - config transmitter address -+ * @adapter : the adapter of halmac -+ * @port : 0 for port0, 1 for port1, 2 for port2, 3 for port3, 4 for port4 -+ * @addr : -+ * Author : Alan -+ * Return : enum halmac_ret_status -+ */ -+enum halmac_ret_status -+cfg_transmitter_addr_88xx(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr) -+{ -+ u32 offset; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (port >= HALMAC_PORTID_NUM) { -+ PLTFM_MSG_ERR("[ERR]port index > 5\n"); -+ return HALMAC_RET_PORT_NOT_SUPPORT; -+ } -+ -+ switch (port) { -+ case HALMAC_PORTID0: -+ offset = REG_TRANSMIT_ADDRSS_0; -+ break; -+ case HALMAC_PORTID1: -+ offset = REG_TRANSMIT_ADDRSS_1; -+ break; -+ case HALMAC_PORTID2: -+ offset = REG_TRANSMIT_ADDRSS_2; -+ break; -+ case HALMAC_PORTID3: -+ offset = REG_TRANSMIT_ADDRSS_3; -+ break; -+ case HALMAC_PORTID4: -+ offset = REG_TRANSMIT_ADDRSS_4; -+ break; -+ default: -+ return HALMAC_RET_PORT_NOT_SUPPORT; -+ } -+ -+ HALMAC_REG_W32(offset, rtk_le32_to_cpu(addr->addr_l_h.low)); -+ HALMAC_REG_W16(offset + 4, rtk_le16_to_cpu(addr->addr_l_h.high)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_net_type_88xx() - config network type -+ * @adapter : the adapter of halmac -+ * @port : 0 for port0, 1 for port1, 2 for port2, 3 for port3, 4 for port4 -+ * @addr : mac address -+ * Author : Alan -+ * Return : enum halmac_ret_status -+ */ -+enum halmac_ret_status -+cfg_net_type_88xx(struct halmac_adapter *adapter, u8 port, -+ enum halmac_network_type_select net_type) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u8 value8 = 0; -+ u8 net_type_tmp = 0; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (net_type == HALMAC_NETWORK_AP) { -+ if (port >= HALMAC_PORTID1) { -+ PLTFM_MSG_ERR("[ERR]AP port > 1\n"); -+ return HALMAC_RET_PORT_NOT_SUPPORT; -+ } -+ } -+ -+ switch (port) { -+ case HALMAC_PORTID0: -+ net_type_tmp = net_type; -+ value8 = ((HALMAC_REG_R8(REG_CR + 2) & 0xFC) | net_type_tmp); -+ HALMAC_REG_W8(REG_CR + 2, value8); -+ break; -+ case HALMAC_PORTID1: -+ net_type_tmp = (net_type << 2); -+ value8 = ((HALMAC_REG_R8(REG_CR + 2) & 0xF3) | net_type_tmp); -+ HALMAC_REG_W8(REG_CR + 2, value8); -+ break; -+ case HALMAC_PORTID2: -+ net_type_tmp = net_type; -+ value8 = ((HALMAC_REG_R8(REG_CR_EXT) & 0xFC) | net_type_tmp); -+ HALMAC_REG_W8(REG_CR_EXT, value8); -+ break; -+ case HALMAC_PORTID3: -+ net_type_tmp = (net_type << 2); -+ value8 = ((HALMAC_REG_R8(REG_CR_EXT) & 0xF3) | net_type_tmp); -+ HALMAC_REG_W8(REG_CR_EXT, value8); -+ break; -+ case HALMAC_PORTID4: -+ net_type_tmp = (net_type << 4); -+ value8 = ((HALMAC_REG_R8(REG_CR_EXT) & 0xCF) | net_type_tmp); -+ HALMAC_REG_W8(REG_CR_EXT, value8); -+ break; -+ default: -+ break; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_tsf_rst_88xx() - tsf reset -+ * @adapter : the adapter of halmac -+ * @port : 0 for port0, 1 for port1, 2 for port2, 3 for port3, 4 for port4 -+ * Author : Alan -+ * Return : enum halmac_ret_status -+ */ -+enum halmac_ret_status -+cfg_tsf_rst_88xx(struct halmac_adapter *adapter, u8 port) -+{ -+ u8 tsf_rst = 0; -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ switch (port) { -+ case HALMAC_PORTID0: -+ tsf_rst = BIT_TSFTR_RST; -+ break; -+ case HALMAC_PORTID1: -+ tsf_rst = BIT_TSFTR_CLI0_RST; -+ break; -+ case HALMAC_PORTID2: -+ tsf_rst = BIT_TSFTR_CLI1_RST; -+ break; -+ case HALMAC_PORTID3: -+ tsf_rst = BIT_TSFTR_CLI2_RST; -+ break; -+ case HALMAC_PORTID4: -+ tsf_rst = BIT_TSFTR_CLI3_RST; -+ break; -+ default: -+ break; -+ } -+ -+ value8 = HALMAC_REG_R8(REG_DUAL_TSF_RST); -+ HALMAC_REG_W8(REG_DUAL_TSF_RST, value8 | tsf_rst); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_bcn_space_88xx() - config beacon space -+ * @adapter : the adapter of halmac -+ * @port : 0 for port0, 1 for port1, 2 for port2, 3 for port3, 4 for port4 -+ * @bcn_space : beacon space -+ * Author : Alan -+ * Return : enum halmac_ret_status -+ */ -+enum halmac_ret_status -+cfg_bcn_space_88xx(struct halmac_adapter *adapter, u8 port, u32 bcn_space) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u16 bcn_space_real = 0; -+ u16 value16 = 0; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ bcn_space_real = ((u16)bcn_space); -+ -+ switch (port) { -+ case HALMAC_PORTID0: -+ HALMAC_REG_W16(REG_MBSSID_BCN_SPACE, bcn_space_real); -+ break; -+ case HALMAC_PORTID1: -+ value16 = HALMAC_REG_R16(REG_MBSSID_BCN_SPACE + 2) & 0xF000; -+ value16 |= bcn_space_real; -+ HALMAC_REG_W16(REG_MBSSID_BCN_SPACE + 2, value16); -+ break; -+ case HALMAC_PORTID2: -+ value16 = HALMAC_REG_R16(REG_MBSSID_BCN_SPACE2) & 0xF000; -+ value16 |= bcn_space_real; -+ HALMAC_REG_W16(REG_MBSSID_BCN_SPACE2, value16); -+ break; -+ case HALMAC_PORTID3: -+ value16 = HALMAC_REG_R16(REG_MBSSID_BCN_SPACE2 + 2) & 0xF000; -+ value16 |= bcn_space_real; -+ HALMAC_REG_W16(REG_MBSSID_BCN_SPACE2 + 2, value16); -+ break; -+ case HALMAC_PORTID4: -+ value16 = HALMAC_REG_R16(REG_MBSSID_BCN_SPACE3) & 0xF000; -+ value16 |= bcn_space_real; -+ HALMAC_REG_W16(REG_MBSSID_BCN_SPACE3, value16); -+ break; -+ default: -+ break; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * rw_bcn_ctrl_88xx() - r/w beacon control -+ * @adapter : the adapter of halmac -+ * @port : 0 for port0, 1 for port1, 2 for port2, 3 for port3, 4 for port4 -+ * @write_en : 1->write beacon function 0->read beacon function -+ * @pBcn_ctrl : beacon control info -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ */ -+enum halmac_ret_status -+rw_bcn_ctrl_88xx(struct halmac_adapter *adapter, u8 port, u8 write_en, -+ struct halmac_bcn_ctrl *ctrl) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u8 ctrl_value = 0; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (write_en) { -+ if (ctrl->dis_rx_bssid_fit == 1) -+ ctrl_value |= BIT_DIS_RX_BSSID_FIT; -+ -+ if (ctrl->en_txbcn_rpt == 1) -+ ctrl_value |= BIT_P0_EN_TXBCN_RPT; -+ -+ if (ctrl->dis_tsf_udt == 1) -+ ctrl_value |= BIT_DIS_TSF_UDT; -+ -+ if (ctrl->en_bcn == 1) -+ ctrl_value |= BIT_EN_BCN_FUNCTION; -+ -+ if (ctrl->en_rxbcn_rpt == 1) -+ ctrl_value |= BIT_P0_EN_RXBCN_RPT; -+ -+ if (ctrl->en_p2p_ctwin == 1) -+ ctrl_value |= BIT_EN_P2P_CTWINDOW; -+ -+ if (ctrl->en_p2p_bcn_area == 1) -+ ctrl_value |= BIT_EN_P2P_BCNQ_AREA; -+ -+ switch (port) { -+ case HALMAC_PORTID0: -+ HALMAC_REG_W8(REG_BCN_CTRL, ctrl_value); -+ break; -+ case HALMAC_PORTID1: -+ HALMAC_REG_W8(REG_BCN_CTRL_CLINT0, ctrl_value); -+ break; -+ case HALMAC_PORTID2: -+ HALMAC_REG_W8(REG_BCN_CTRL_CLINT1, ctrl_value); -+ break; -+ case HALMAC_PORTID3: -+ HALMAC_REG_W8(REG_BCN_CTRL_CLINT2, ctrl_value); -+ break; -+ case HALMAC_PORTID4: -+ HALMAC_REG_W8(REG_BCN_CTRL_CLINT3, ctrl_value); -+ break; -+ default: -+ break; -+ } -+ -+ } else { -+ switch (port) { -+ case HALMAC_PORTID0: -+ ctrl_value = HALMAC_REG_R8(REG_BCN_CTRL); -+ break; -+ case HALMAC_PORTID1: -+ ctrl_value = HALMAC_REG_R8(REG_BCN_CTRL_CLINT0); -+ break; -+ case HALMAC_PORTID2: -+ ctrl_value = HALMAC_REG_R8(REG_BCN_CTRL_CLINT1); -+ break; -+ case HALMAC_PORTID3: -+ ctrl_value = HALMAC_REG_R8(REG_BCN_CTRL_CLINT2); -+ break; -+ case HALMAC_PORTID4: -+ ctrl_value = HALMAC_REG_R8(REG_BCN_CTRL_CLINT3); -+ break; -+ default: -+ break; -+ } -+ -+ if (ctrl_value & BIT_EN_P2P_BCNQ_AREA) -+ ctrl->en_p2p_bcn_area = 1; -+ else -+ ctrl->en_p2p_bcn_area = 0; -+ -+ if (ctrl_value & BIT_EN_P2P_CTWINDOW) -+ ctrl->en_p2p_ctwin = 1; -+ else -+ ctrl->en_p2p_ctwin = 0; -+ -+ if (ctrl_value & BIT_P0_EN_RXBCN_RPT) -+ ctrl->en_rxbcn_rpt = 1; -+ else -+ ctrl->en_rxbcn_rpt = 0; -+ -+ if (ctrl_value & BIT_EN_BCN_FUNCTION) -+ ctrl->en_bcn = 1; -+ else -+ ctrl->en_bcn = 0; -+ -+ if (ctrl_value & BIT_DIS_TSF_UDT) -+ ctrl->dis_tsf_udt = 1; -+ else -+ ctrl->dis_tsf_udt = 0; -+ -+ if (ctrl_value & BIT_P0_EN_TXBCN_RPT) -+ ctrl->en_txbcn_rpt = 1; -+ else -+ ctrl->en_txbcn_rpt = 0; -+ -+ if (ctrl_value & BIT_DIS_RX_BSSID_FIT) -+ ctrl->dis_rx_bssid_fit = 1; -+ else -+ ctrl->dis_rx_bssid_fit = 0; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_multicast_addr_88xx() - config multicast address -+ * @adapter : the adapter of halmac -+ * @addr : multicast address -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_multicast_addr_88xx(struct halmac_adapter *adapter, -+ union halmac_wlan_addr *addr) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ HALMAC_REG_W32(REG_MAR, rtk_le32_to_cpu(addr->addr_l_h.low)); -+ HALMAC_REG_W16(REG_MAR + 4, rtk_le16_to_cpu(addr->addr_l_h.high)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_operation_mode_88xx() - config operation mode -+ * @adapter : the adapter of halmac -+ * @mode : 802.11 standard(b/g/n/ac) -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_operation_mode_88xx(struct halmac_adapter *adapter, -+ enum halmac_wireless_mode mode) -+{ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_ch_bw_88xx() - config channel & bandwidth -+ * @adapter : the adapter of halmac -+ * @ch : WLAN channel, support 2.4G & 5G -+ * @idx : primary channel index, idx1, idx2, idx3, idx4 -+ * @bw : band width, 20, 40, 80, 160, 5 ,10 -+ * Author : KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_ch_bw_88xx(struct halmac_adapter *adapter, u8 ch, -+ enum halmac_pri_ch_idx idx, enum halmac_bw bw) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ cfg_pri_ch_idx_88xx(adapter, idx); -+ cfg_bw_88xx(adapter, bw); -+ cfg_ch_88xx(adapter, ch); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+cfg_ch_88xx(struct halmac_adapter *adapter, u8 ch) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ value8 = HALMAC_REG_R8(REG_CCK_CHECK); -+ value8 = value8 & (~(BIT(7))); -+ -+ if (ch > 35) -+ value8 = value8 | BIT(7); -+ -+ HALMAC_REG_W8(REG_CCK_CHECK, value8); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+cfg_pri_ch_idx_88xx(struct halmac_adapter *adapter, enum halmac_pri_ch_idx idx) -+{ -+ u8 txsc40 = 0, txsc20 = 0; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ txsc20 = idx; -+ if (txsc20 == HALMAC_CH_IDX_1 || txsc20 == HALMAC_CH_IDX_3) -+ txsc40 = 9; -+ else -+ txsc40 = 10; -+ -+ HALMAC_REG_W8(REG_DATA_SC, BIT_TXSC_20M(txsc20) | BIT_TXSC_40M(txsc40)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_bw_88xx() - config bandwidth -+ * @adapter : the adapter of halmac -+ * @bw : band width, 20, 40, 80, 160, 5 ,10 -+ * Author : KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_bw_88xx(struct halmac_adapter *adapter, enum halmac_bw bw) -+{ -+ u32 value32; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ value32 = HALMAC_REG_R32(REG_WMAC_TRXPTCL_CTL); -+ value32 = value32 & (~(BIT(7) | BIT(8))); -+ -+ switch (bw) { -+ case HALMAC_BW_80: -+ value32 = value32 | BIT(8); -+ break; -+ case HALMAC_BW_40: -+ value32 = value32 | BIT(7); -+ break; -+ case HALMAC_BW_20: -+ case HALMAC_BW_10: -+ case HALMAC_BW_5: -+ break; -+ default: -+ break; -+ } -+ -+ HALMAC_REG_W32(REG_WMAC_TRXPTCL_CTL, value32); -+ -+ cfg_mac_clk_88xx(adapter); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+void -+cfg_txfifo_lt_88xx(struct halmac_adapter *adapter, -+ struct halmac_txfifo_lifetime_cfg *cfg) -+{ -+ u8 value8; -+ u32 value32; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (cfg->enable == 1) { -+ value8 = HALMAC_REG_R8(REG_LIFETIME_EN); -+ value8 = value8 | BIT(0) | BIT(1) | BIT(2) | BIT(3); -+ HALMAC_REG_W8(REG_LIFETIME_EN, value8); -+ -+ value32 = (cfg->lifetime) >> 8; -+ value32 = value32 + (value32 << 16); -+ HALMAC_REG_W32(REG_PKT_LIFE_TIME, value32); -+ } else { -+ value8 = HALMAC_REG_R8(REG_LIFETIME_EN); -+ value8 = value8 & (~(BIT(0) | BIT(1) | BIT(2) | BIT(3))); -+ HALMAC_REG_W8(REG_LIFETIME_EN, value8); -+ } -+} -+ -+enum halmac_ret_status -+enable_bb_rf_88xx(struct halmac_adapter *adapter, u8 enable) -+{ -+ u8 value8; -+ u32 value32; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (enable == 1) { -+ status = board_rf_fine_tune_88xx(adapter); -+ value8 = HALMAC_REG_R8(REG_SYS_FUNC_EN); -+ value8 = value8 | BIT(0) | BIT(1); -+ HALMAC_REG_W8(REG_SYS_FUNC_EN, value8); -+ -+ value8 = HALMAC_REG_R8(REG_RF_CTRL); -+ value8 = value8 | BIT(0) | BIT(1) | BIT(2); -+ HALMAC_REG_W8(REG_RF_CTRL, value8); -+ -+ value32 = HALMAC_REG_R32(REG_WLRF1); -+ value32 = value32 | BIT(24) | BIT(25) | BIT(26); -+ HALMAC_REG_W32(REG_WLRF1, value32); -+ } else { -+ value8 = HALMAC_REG_R8(REG_SYS_FUNC_EN); -+ value8 = value8 & (~(BIT(0) | BIT(1))); -+ HALMAC_REG_W8(REG_SYS_FUNC_EN, value8); -+ -+ value8 = HALMAC_REG_R8(REG_RF_CTRL); -+ value8 = value8 & (~(BIT(0) | BIT(1) | BIT(2))); -+ HALMAC_REG_W8(REG_RF_CTRL, value8); -+ -+ value32 = HALMAC_REG_R32(REG_WLRF1); -+ value32 = value32 & (~(BIT(24) | BIT(25) | BIT(26))); -+ HALMAC_REG_W32(REG_WLRF1, value32); -+ } -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+board_rf_fine_tune_88xx(struct halmac_adapter *adapter) -+{ -+ u8 *map = NULL; -+ u32 size = adapter->hw_cfg_info.eeprom_size; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822B) { -+ if (!adapter->efuse_map_valid || !adapter->efuse_map) { -+ PLTFM_MSG_ERR("[ERR]efuse map invalid!!\n"); -+ return HALMAC_RET_EFUSE_R_FAIL; -+ } -+ -+ map = (u8 *)PLTFM_MALLOC(size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ -+ PLTFM_MEMSET(map, 0xFF, size); -+ -+ if (eeprom_parser_88xx(adapter, adapter->efuse_map, map) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, size); -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ -+ /* Fine-tune XTAL voltage for 2L PCB board */ -+ if (*(map + EFUSE_PCB_INFO_OFFSET) == 0x0C) -+ HALMAC_REG_W8_SET(REG_AFE_CTRL1 + 1, BIT(1)); -+ -+ PLTFM_FREE(map, size); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+void -+cfg_mac_clk_88xx(struct halmac_adapter *adapter) -+{ -+ u32 value32; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ value32 = HALMAC_REG_R32(REG_AFE_CTRL1) & ~(BIT(20) | BIT(21)); -+ value32 |= (MAC_CLK_HW_DEF_80M << BIT_SHIFT_MAC_CLK_SEL); -+ HALMAC_REG_W32(REG_AFE_CTRL1, value32); -+ -+ HALMAC_REG_W8(REG_USTIME_TSF, MAC_CLK_SPEED); -+ HALMAC_REG_W8(REG_USTIME_EDCA, MAC_CLK_SPEED); -+} -+ -+/** -+ * cfg_la_mode_88xx() - config la mode -+ * @adapter : the adapter of halmac -+ * @mode : -+ * disable : no TXFF space reserved for LA debug -+ * partial : partial TXFF space is reserved for LA debug -+ * full : all TXFF space is reserved for LA debug -+ * Author : KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_la_mode_88xx(struct halmac_adapter *adapter, enum halmac_la_mode mode) -+{ -+ if (adapter->api_registry.la_mode_en == 0) -+ return HALMAC_RET_NOT_SUPPORT; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ adapter->txff_alloc.la_mode = mode; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_rxfifo_expand_mode_88xx() - rx fifo expanding -+ * @adapter : the adapter of halmac -+ * @mode : -+ * disable : normal mode -+ * 1 block : Rx FIFO + 1 FIFO block; Tx fifo - 1 FIFO block -+ * 2 block : Rx FIFO + 2 FIFO block; Tx fifo - 2 FIFO block -+ * 3 block : Rx FIFO + 3 FIFO block; Tx fifo - 3 FIFO block -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_rxfifo_expand_mode_88xx(struct halmac_adapter *adapter, -+ enum halmac_rx_fifo_expanding_mode mode) -+{ -+ if (adapter->api_registry.rx_exp_en == 0) -+ return HALMAC_RET_NOT_SUPPORT; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ adapter->txff_alloc.rx_fifo_exp_mode = mode; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+config_security_88xx(struct halmac_adapter *adapter, -+ struct halmac_security_setting *setting) -+{ -+ u8 sec_cfg; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ HALMAC_REG_W16_SET(REG_CR, BIT_MAC_SEC_EN); -+ -+ if (setting->compare_keyid == 1) { -+ HALMAC_REG_W8_SET(REG_SECCFG + 1, BIT(0)); -+ adapter->hw_cfg_info.chk_security_keyid = 1; -+ } else { -+ adapter->hw_cfg_info.chk_security_keyid = 0; -+ } -+ -+ sec_cfg = HALMAC_REG_R8(REG_SECCFG); -+ -+ /* BC/MC uses default key */ -+ /* cam entry 0~3, kei id = 0 -> entry0, kei id = 1 -> entry1... */ -+ sec_cfg |= (BIT_TXBCUSEDK | BIT_RXBCUSEDK); -+ -+ if (setting->tx_encryption == 1) -+ sec_cfg |= BIT_TXENC; -+ else -+ sec_cfg &= ~BIT_TXENC; -+ -+ if (setting->rx_decryption == 1) -+ sec_cfg |= BIT_RXDEC; -+ else -+ sec_cfg &= ~BIT_RXDEC; -+ -+ HALMAC_REG_W8(REG_SECCFG, sec_cfg); -+ -+ if (setting->bip_enable == 1) { -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822B) -+ return HALMAC_RET_BIP_NO_SUPPORT; -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ sec_cfg = HALMAC_REG_R8(REG_WSEC_OPTION + 2); -+ -+ if (setting->tx_encryption == 1) -+ sec_cfg |= (BIT(3) | BIT(5)); -+ else -+ sec_cfg &= ~(BIT(3) | BIT(5)); -+ -+ if (setting->rx_decryption == 1) -+ sec_cfg |= (BIT(4) | BIT(6)); -+ else -+ sec_cfg &= ~(BIT(4) | BIT(6)); -+ -+ HALMAC_REG_W8(REG_WSEC_OPTION + 2, sec_cfg); -+#endif -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+u8 -+get_used_cam_entry_num_88xx(struct halmac_adapter *adapter, -+ enum hal_security_type sec_type) -+{ -+ u8 entry_num; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ switch (sec_type) { -+ case HAL_SECURITY_TYPE_WEP40: -+ case HAL_SECURITY_TYPE_WEP104: -+ case HAL_SECURITY_TYPE_TKIP: -+ case HAL_SECURITY_TYPE_AES128: -+ case HAL_SECURITY_TYPE_GCMP128: -+ case HAL_SECURITY_TYPE_GCMSMS4: -+ case HAL_SECURITY_TYPE_BIP: -+ entry_num = 1; -+ break; -+ case HAL_SECURITY_TYPE_WAPI: -+ case HAL_SECURITY_TYPE_AES256: -+ case HAL_SECURITY_TYPE_GCMP256: -+ entry_num = 2; -+ break; -+ default: -+ entry_num = 0; -+ break; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return entry_num; -+} -+ -+enum halmac_ret_status -+write_cam_88xx(struct halmac_adapter *adapter, u32 idx, -+ struct halmac_cam_entry_info *info) -+{ -+ u32 i; -+ u32 cmd = 0x80010000; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ struct halmac_cam_entry_format *fmt = NULL; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (idx >= adapter->hw_cfg_info.cam_entry_num) -+ return HALMAC_RET_ENTRY_INDEX_ERROR; -+ -+ if (info->key_id > 3) -+ return HALMAC_RET_FAIL; -+ -+ fmt = (struct halmac_cam_entry_format *)PLTFM_MALLOC(sizeof(*fmt)); -+ if (!fmt) -+ return HALMAC_RET_NULL_POINTER; -+ PLTFM_MEMSET(fmt, 0x00, sizeof(*fmt)); -+ -+ if (adapter->hw_cfg_info.chk_security_keyid == 1) -+ fmt->key_id = info->key_id; -+ fmt->valid = info->valid; -+ PLTFM_MEMCPY(fmt->mac_address, info->mac_address, 6); -+ PLTFM_MEMCPY(fmt->key, info->key, 16); -+ -+ switch (info->security_type) { -+ case HAL_SECURITY_TYPE_NONE: -+ fmt->type = 0; -+ break; -+ case HAL_SECURITY_TYPE_WEP40: -+ fmt->type = 1; -+ break; -+ case HAL_SECURITY_TYPE_WEP104: -+ fmt->type = 5; -+ break; -+ case HAL_SECURITY_TYPE_TKIP: -+ fmt->type = 2; -+ break; -+ case HAL_SECURITY_TYPE_AES128: -+ fmt->type = 4; -+ break; -+ case HAL_SECURITY_TYPE_WAPI: -+ fmt->type = 6; -+ break; -+ case HAL_SECURITY_TYPE_AES256: -+ fmt->type = 4; -+ fmt->ext_sectype = 1; -+ break; -+ case HAL_SECURITY_TYPE_GCMP128: -+ fmt->type = 7; -+ break; -+ case HAL_SECURITY_TYPE_GCMP256: -+ case HAL_SECURITY_TYPE_GCMSMS4: -+ fmt->type = 7; -+ fmt->ext_sectype = 1; -+ break; -+ case HAL_SECURITY_TYPE_BIP: -+ fmt->type = (info->unicast == 1) ? 4 : 0; -+ fmt->mgnt = 1; -+ fmt->grp = (info->unicast == 1) ? 0 : 1; -+ break; -+ default: -+ PLTFM_FREE(fmt, sizeof(*fmt)); -+ return HALMAC_RET_FAIL; -+ } -+ -+ for (i = 0; i < 8; i++) { -+ HALMAC_REG_W32(REG_CAMWRITE, *((u32 *)fmt + i)); -+ HALMAC_REG_W32(REG_CAMCMD, cmd | ((idx << 3) + i)); -+ } -+ -+ if (info->security_type == HAL_SECURITY_TYPE_WAPI || -+ info->security_type == HAL_SECURITY_TYPE_AES256 || -+ info->security_type == HAL_SECURITY_TYPE_GCMP256 || -+ info->security_type == HAL_SECURITY_TYPE_GCMSMS4) { -+ fmt->mic = 1; -+ PLTFM_MEMCPY(fmt->key, info->key_ext, 16); -+ idx++; -+ for (i = 0; i < 8; i++) { -+ HALMAC_REG_W32(REG_CAMWRITE, *((u32 *)fmt + i)); -+ HALMAC_REG_W32(REG_CAMCMD, cmd | ((idx << 3) + i)); -+ } -+ } -+ -+ PLTFM_FREE(fmt, sizeof(*fmt)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+read_cam_entry_88xx(struct halmac_adapter *adapter, u32 idx, -+ struct halmac_cam_entry_format *content) -+{ -+ u32 i; -+ u32 cmd = 0x80000000; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (idx >= adapter->hw_cfg_info.cam_entry_num) -+ return HALMAC_RET_ENTRY_INDEX_ERROR; -+ -+ for (i = 0; i < 8; i++) { -+ HALMAC_REG_W32(REG_CAMCMD, cmd | ((idx << 3) + i)); -+ *((u32 *)content + i) = HALMAC_REG_R32(REG_CAMREAD); -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+clear_cam_entry_88xx(struct halmac_adapter *adapter, u32 idx) -+{ -+ u32 i; -+ u32 cmd = 0x80010000; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ struct halmac_cam_entry_format *fmt = NULL; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (idx >= adapter->hw_cfg_info.cam_entry_num) -+ return HALMAC_RET_ENTRY_INDEX_ERROR; -+ -+ fmt = (struct halmac_cam_entry_format *)PLTFM_MALLOC(sizeof(*fmt)); -+ if (!fmt) -+ return HALMAC_RET_NULL_POINTER; -+ PLTFM_MEMSET(fmt, 0x00, sizeof(*fmt)); -+ -+ for (i = 0; i < 8; i++) { -+ HALMAC_REG_W32(REG_CAMWRITE, *((u32 *)fmt + i)); -+ HALMAC_REG_W32(REG_CAMCMD, cmd | ((idx << 3) + i)); -+ } -+ -+ PLTFM_FREE(fmt, sizeof(*fmt)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+void -+rx_shift_88xx(struct halmac_adapter *adapter, u8 enable) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ value8 = HALMAC_REG_R8(REG_TXDMA_PQ_MAP); -+ -+ if (enable == 1) -+ HALMAC_REG_W8(REG_TXDMA_PQ_MAP, value8 | BIT(1)); -+ else -+ HALMAC_REG_W8(REG_TXDMA_PQ_MAP, value8 & ~(BIT(1))); -+} -+ -+/** -+ * cfg_edca_para_88xx() - config edca parameter -+ * @adapter : the adapter of halmac -+ * @acq_id : VO/VI/BE/BK -+ * @param : aifs, cw, txop limit -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_edca_para_88xx(struct halmac_adapter *adapter, enum halmac_acq_id acq_id, -+ struct halmac_edca_para *param) -+{ -+ u32 offset; -+ u32 value32; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ switch (acq_id) { -+ case HALMAC_ACQ_ID_VO: -+ offset = REG_EDCA_VO_PARAM; -+ break; -+ case HALMAC_ACQ_ID_VI: -+ offset = REG_EDCA_VI_PARAM; -+ break; -+ case HALMAC_ACQ_ID_BE: -+ offset = REG_EDCA_BE_PARAM; -+ break; -+ case HALMAC_ACQ_ID_BK: -+ offset = REG_EDCA_BK_PARAM; -+ break; -+ default: -+ return HALMAC_RET_SWITCH_CASE_ERROR; -+ } -+ -+ param->txop_limit &= 0x7FF; -+ value32 = (param->aifs) | (param->cw << 8) | (param->txop_limit << 16); -+ -+ HALMAC_REG_W32(offset, value32); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+void -+rx_clk_gate_88xx(struct halmac_adapter *adapter, u8 enable) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ value8 = HALMAC_REG_R8(REG_RCR + 2); -+ -+ if (enable == 1) -+ HALMAC_REG_W8(REG_RCR + 2, value8 & ~(BIT(3))); -+ else -+ HALMAC_REG_W8(REG_RCR + 2, value8 | BIT(3)); -+} -+ -+enum halmac_ret_status -+rx_cut_amsdu_cfg_88xx(struct halmac_adapter *adapter, -+ struct halmac_cut_amsdu_cfg *cfg) -+{ -+ return HALMAC_RET_NOT_SUPPORT; -+} -+ -+enum halmac_ret_status -+fast_edca_cfg_88xx(struct halmac_adapter *adapter, -+ struct halmac_fast_edca_cfg *cfg) -+{ -+ u16 value16; -+ u32 offset; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ switch (cfg->acq_id) { -+ case HALMAC_ACQ_ID_VO: -+ offset = REG_FAST_EDCA_VOVI_SETTING; -+ break; -+ case HALMAC_ACQ_ID_VI: -+ offset = REG_FAST_EDCA_VOVI_SETTING + 2; -+ break; -+ case HALMAC_ACQ_ID_BE: -+ offset = REG_FAST_EDCA_BEBK_SETTING; -+ break; -+ case HALMAC_ACQ_ID_BK: -+ offset = REG_FAST_EDCA_BEBK_SETTING + 2; -+ break; -+ default: -+ return HALMAC_RET_SWITCH_CASE_ERROR; -+ } -+ -+ value16 = HALMAC_REG_R16(offset); -+ value16 &= 0xFF; -+ value16 = value16 | (cfg->queue_to << 8); -+ -+ HALMAC_REG_W16(offset, value16); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * get_mac_addr_88xx() - get mac address -+ * @adapter : the adapter of halmac -+ * @port : 0 for port0, 1 for port1, 2 for port2, 3 for port3, 4 for port4 -+ * @addr : mac address -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_mac_addr_88xx(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr) -+{ -+ u16 mac_addr_h; -+ u32 mac_addr_l; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (port >= HALMAC_PORTID_NUM) { -+ PLTFM_MSG_ERR("[ERR]port index >= 5\n"); -+ return HALMAC_RET_PORT_NOT_SUPPORT; -+ } -+ -+ switch (port) { -+ case HALMAC_PORTID0: -+ mac_addr_l = HALMAC_REG_R32(REG_MACID); -+ mac_addr_h = HALMAC_REG_R16(REG_MACID + 4); -+ break; -+ case HALMAC_PORTID1: -+ mac_addr_l = HALMAC_REG_R32(REG_MACID1); -+ mac_addr_h = HALMAC_REG_R16(REG_MACID1 + 4); -+ break; -+ case HALMAC_PORTID2: -+ mac_addr_l = HALMAC_REG_R32(REG_MACID2); -+ mac_addr_h = HALMAC_REG_R16(REG_MACID2 + 4); -+ break; -+ case HALMAC_PORTID3: -+ mac_addr_l = HALMAC_REG_R32(REG_MACID3); -+ mac_addr_h = HALMAC_REG_R16(REG_MACID3 + 4); -+ break; -+ case HALMAC_PORTID4: -+ mac_addr_l = HALMAC_REG_R32(REG_MACID4); -+ mac_addr_h = HALMAC_REG_R16(REG_MACID4 + 4); -+ break; -+ default: -+ return HALMAC_RET_PORT_NOT_SUPPORT; -+ } -+ -+ addr->addr_l_h.low = rtk_cpu_to_le32(mac_addr_l); -+ addr->addr_l_h.high = rtk_cpu_to_le16(mac_addr_h); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+void -+rts_full_bw_88xx(struct halmac_adapter *adapter, u8 enable) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ value8 = HALMAC_REG_R8(REG_INIRTS_RATE_SEL); -+ -+ if (enable == 1) -+ HALMAC_REG_W8(REG_INIRTS_RATE_SEL, value8 | BIT(5)); -+ else -+ HALMAC_REG_W8(REG_INIRTS_RATE_SEL, value8 & ~(BIT(5))); -+} -+ -+#endif /* HALMAC_88XX_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_cfg_wmac_88xx.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_cfg_wmac_88xx.h -new file mode 100644 -index 000000000..ac46d8cca ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_cfg_wmac_88xx.h -@@ -0,0 +1,133 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_CFG_WMAC_88XX_H_ -+#define _HALMAC_CFG_WMAC_88XX_H_ -+ -+#include "../halmac_api.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+enum halmac_ret_status -+cfg_mac_addr_88xx(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr); -+ -+enum halmac_ret_status -+cfg_bssid_88xx(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr); -+ -+enum halmac_ret_status -+cfg_transmitter_addr_88xx(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr); -+ -+enum halmac_ret_status -+cfg_net_type_88xx(struct halmac_adapter *adapter, u8 port, -+ enum halmac_network_type_select net_type); -+ -+enum halmac_ret_status -+cfg_tsf_rst_88xx(struct halmac_adapter *adapter, u8 port); -+ -+enum halmac_ret_status -+cfg_bcn_space_88xx(struct halmac_adapter *adapter, u8 port, u32 bcn_space); -+ -+enum halmac_ret_status -+rw_bcn_ctrl_88xx(struct halmac_adapter *adapter, u8 port, u8 write_en, -+ struct halmac_bcn_ctrl *ctrl); -+ -+enum halmac_ret_status -+cfg_multicast_addr_88xx(struct halmac_adapter *adapter, -+ union halmac_wlan_addr *addr); -+ -+enum halmac_ret_status -+cfg_operation_mode_88xx(struct halmac_adapter *adapter, -+ enum halmac_wireless_mode mode); -+ -+enum halmac_ret_status -+cfg_ch_bw_88xx(struct halmac_adapter *adapter, u8 ch, -+ enum halmac_pri_ch_idx idx, enum halmac_bw bw); -+ -+enum halmac_ret_status -+cfg_ch_88xx(struct halmac_adapter *adapter, u8 ch); -+ -+enum halmac_ret_status -+cfg_pri_ch_idx_88xx(struct halmac_adapter *adapter, enum halmac_pri_ch_idx idx); -+ -+enum halmac_ret_status -+cfg_bw_88xx(struct halmac_adapter *adapter, enum halmac_bw bw); -+ -+void -+cfg_txfifo_lt_88xx(struct halmac_adapter *adapter, -+ struct halmac_txfifo_lifetime_cfg *cfg); -+ -+enum halmac_ret_status -+enable_bb_rf_88xx(struct halmac_adapter *adapter, u8 enable); -+ -+enum halmac_ret_status -+cfg_la_mode_88xx(struct halmac_adapter *adapter, enum halmac_la_mode mode); -+ -+enum halmac_ret_status -+cfg_rxfifo_expand_mode_88xx(struct halmac_adapter *adapter, -+ enum halmac_rx_fifo_expanding_mode mode); -+ -+enum halmac_ret_status -+config_security_88xx(struct halmac_adapter *adapter, -+ struct halmac_security_setting *setting); -+ -+u8 -+get_used_cam_entry_num_88xx(struct halmac_adapter *adapter, -+ enum hal_security_type sec_type); -+ -+enum halmac_ret_status -+write_cam_88xx(struct halmac_adapter *adapter, u32 idx, -+ struct halmac_cam_entry_info *info); -+ -+enum halmac_ret_status -+read_cam_entry_88xx(struct halmac_adapter *adapter, u32 idx, -+ struct halmac_cam_entry_format *content); -+ -+enum halmac_ret_status -+clear_cam_entry_88xx(struct halmac_adapter *adapter, u32 idx); -+ -+void -+rx_shift_88xx(struct halmac_adapter *adapter, u8 enable); -+ -+enum halmac_ret_status -+cfg_edca_para_88xx(struct halmac_adapter *adapter, enum halmac_acq_id acq_id, -+ struct halmac_edca_para *param); -+ -+void -+rx_clk_gate_88xx(struct halmac_adapter *adapter, u8 enable); -+ -+enum halmac_ret_status -+rx_cut_amsdu_cfg_88xx(struct halmac_adapter *adapter, -+ struct halmac_cut_amsdu_cfg *cfg); -+ -+enum halmac_ret_status -+fast_edca_cfg_88xx(struct halmac_adapter *adapter, -+ struct halmac_fast_edca_cfg *cfg); -+ -+enum halmac_ret_status -+get_mac_addr_88xx(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr); -+ -+void -+rts_full_bw_88xx(struct halmac_adapter *adapter, u8 enable); -+ -+void -+cfg_mac_clk_88xx(struct halmac_adapter *adapter); -+ -+#endif/* HALMAC_88XX_SUPPORT */ -+ -+#endif/* _HALMAC_CFG_WMAC_88XX_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_common_88xx.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_common_88xx.c -new file mode 100644 -index 000000000..885be219c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_common_88xx.c -@@ -0,0 +1,3453 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_common_88xx.h" -+#include "halmac_88xx_cfg.h" -+#include "halmac_init_88xx.h" -+#include "halmac_cfg_wmac_88xx.h" -+#include "halmac_efuse_88xx.h" -+#include "halmac_bb_rf_88xx.h" -+#if HALMAC_USB_SUPPORT -+#include "halmac_usb_88xx.h" -+#endif -+#if HALMAC_SDIO_SUPPORT -+#include "halmac_sdio_88xx.h" -+#endif -+#if HALMAC_PCIE_SUPPORT -+#include "halmac_pcie_88xx.h" -+#endif -+#include "halmac_mimo_88xx.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+#define CFG_PARAM_H2C_INFO_SIZE 12 -+#define ORIGINAL_H2C_CMD_SIZE 8 -+ -+#define WLHDR_PROT_VER 0 -+ -+#define WLHDR_TYPE_MGMT 0 -+#define WLHDR_TYPE_CTRL 1 -+#define WLHDR_TYPE_DATA 2 -+ -+/* mgmt frame */ -+#define WLHDR_SUB_TYPE_ASSOC_REQ 0 -+#define WLHDR_SUB_TYPE_ASSOC_RSPNS 1 -+#define WLHDR_SUB_TYPE_REASSOC_REQ 2 -+#define WLHDR_SUB_TYPE_REASSOC_RSPNS 3 -+#define WLHDR_SUB_TYPE_PROBE_REQ 4 -+#define WLHDR_SUB_TYPE_PROBE_RSPNS 5 -+#define WLHDR_SUB_TYPE_BCN 8 -+#define WLHDR_SUB_TYPE_DISASSOC 10 -+#define WLHDR_SUB_TYPE_AUTH 11 -+#define WLHDR_SUB_TYPE_DEAUTH 12 -+#define WLHDR_SUB_TYPE_ACTION 13 -+#define WLHDR_SUB_TYPE_ACTION_NOACK 14 -+ -+/* ctrl frame */ -+#define WLHDR_SUB_TYPE_BF_RPT_POLL 4 -+#define WLHDR_SUB_TYPE_NDPA 5 -+ -+/* data frame */ -+#define WLHDR_SUB_TYPE_DATA 0 -+#define WLHDR_SUB_TYPE_NULL 4 -+#define WLHDR_SUB_TYPE_QOS_DATA 8 -+#define WLHDR_SUB_TYPE_QOS_NULL 12 -+ -+#define LTECOEX_ACCESS_CTRL REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1 -+ -+struct wlhdr_frame_ctrl { -+ u16 protocol:2; -+ u16 type:2; -+ u16 sub_type:4; -+ u16 to_ds:1; -+ u16 from_ds:1; -+ u16 more_frag:1; -+ u16 retry:1; -+ u16 pwr_mgmt:1; -+ u16 more_data:1; -+ u16 protect_frame:1; -+ u16 order:1; -+}; -+ -+static enum halmac_ret_status -+parse_c2h_pkt_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+static enum halmac_ret_status -+get_c2h_dbg_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+static enum halmac_ret_status -+get_h2c_ack_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+static enum halmac_ret_status -+get_scan_ch_notify_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+static enum halmac_ret_status -+get_scan_rpt_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+static enum halmac_ret_status -+get_h2c_ack_cfg_param_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+static enum halmac_ret_status -+get_h2c_ack_update_pkt_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+static enum halmac_ret_status -+get_h2c_ack_send_scan_pkt_88xx(struct halmac_adapter *adapter, u8 *buf, -+ u32 size); -+ -+static enum halmac_ret_status -+get_h2c_ack_drop_scan_pkt_88xx(struct halmac_adapter *adapter, u8 *buf, -+ u32 size); -+ -+static enum halmac_ret_status -+get_h2c_ack_update_datapkt_88xx(struct halmac_adapter *adapter, u8 *buf, -+ u32 size); -+ -+static enum halmac_ret_status -+get_h2c_ack_run_datapkt_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+static enum halmac_ret_status -+get_h2c_ack_ch_switch_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+static enum halmac_ret_status -+malloc_cfg_param_buf_88xx(struct halmac_adapter *adapter, u8 full_fifo); -+ -+static enum halmac_cmd_construct_state -+cfg_param_cmd_cnstr_state_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+proc_cfg_param_88xx(struct halmac_adapter *adapter, -+ struct halmac_phy_parameter_info *param, u8 full_fifo); -+ -+static enum halmac_ret_status -+send_cfg_param_h2c_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+cnv_cfg_param_state_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_construct_state dest_state); -+ -+static enum halmac_ret_status -+add_param_buf_88xx(struct halmac_adapter *adapter, -+ struct halmac_phy_parameter_info *param, u8 *buf, -+ u8 *end_cmd); -+ -+static enum halmac_ret_status -+gen_cfg_param_h2c_88xx(struct halmac_adapter *adapter, u8 *buff); -+ -+static enum halmac_ret_status -+send_h2c_update_packet_88xx(struct halmac_adapter *adapter, -+ enum halmac_packet_id pkt_id, u8 *pkt, u32 size); -+ -+static enum halmac_ret_status -+send_h2c_send_scan_packet_88xx(struct halmac_adapter *adapter, -+ u8 index, u8 *pkt, u32 size); -+ -+static enum halmac_ret_status -+send_h2c_drop_scan_packet_88xx(struct halmac_adapter *adapter, -+ struct halmac_drop_pkt_option *option); -+ -+static enum halmac_ret_status -+send_bt_coex_cmd_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size, -+ u8 ack); -+ -+static enum halmac_ret_status -+read_buf_88xx(struct halmac_adapter *adapter, u32 offset, u32 size, -+ enum hal_fifo_sel sel, u8 *data); -+ -+static enum halmac_cmd_construct_state -+scan_cmd_cnstr_state_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+cnv_scan_state_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_construct_state dest_state); -+ -+static enum halmac_ret_status -+proc_ctrl_ch_switch_88xx(struct halmac_adapter *adapter, -+ struct halmac_ch_switch_option *opt); -+ -+static enum halmac_ret_status -+proc_p2pps_88xx(struct halmac_adapter *adapter, struct halmac_p2pps *info); -+ -+static enum halmac_ret_status -+get_cfg_param_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status); -+ -+static enum halmac_ret_status -+get_ch_switch_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status); -+ -+static enum halmac_ret_status -+get_update_packet_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status); -+ -+static enum halmac_ret_status -+get_send_scan_packet_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status); -+ -+static enum halmac_ret_status -+get_drop_scan_packet_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status); -+ -+static enum halmac_ret_status -+pwr_sub_seq_parser_88xx(struct halmac_adapter *adapter, u8 cut, u8 intf, -+ struct halmac_wlan_pwr_cfg *cmd); -+ -+static void -+pwr_state_88xx(struct halmac_adapter *adapter, enum halmac_mac_power *state); -+ -+static enum halmac_ret_status -+pwr_cmd_polling_88xx(struct halmac_adapter *adapter, -+ struct halmac_wlan_pwr_cfg *cmd); -+ -+static void -+get_pq_mapping_88xx(struct halmac_adapter *adapter, -+ struct halmac_rqpn_map *mapping); -+ -+static void -+dump_reg_sdio_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+wlhdr_valid_88xx(struct halmac_adapter *adapter, u8 *buf); -+ -+static u8 -+wlhdr_mgmt_valid_88xx(struct halmac_adapter *adapter, -+ struct wlhdr_frame_ctrl *wlhdr); -+ -+static u8 -+wlhdr_ctrl_valid_88xx(struct halmac_adapter *adapter, -+ struct wlhdr_frame_ctrl *wlhdr); -+ -+static u8 -+wlhdr_data_valid_88xx(struct halmac_adapter *adapter, -+ struct wlhdr_frame_ctrl *wlhdr); -+ -+static void -+dump_reg_88xx(struct halmac_adapter *adapter); -+ -+static u8 -+packet_in_nlo_88xx(struct halmac_adapter *adapter, -+ enum halmac_packet_id pkt_id); -+ -+static enum halmac_packet_id -+get_real_pkt_id_88xx(struct halmac_adapter *adapter, -+ enum halmac_packet_id pkt_id); -+ -+static u32 -+get_update_packet_page_size(struct halmac_adapter *adapter, u32 size); -+ -+/** -+ * ofld_func_cfg_88xx() - config offload function -+ * @adapter : the adapter of halmac -+ * @info : offload function information -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+ofld_func_cfg_88xx(struct halmac_adapter *adapter, -+ struct halmac_ofld_func_info *info) -+{ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO && -+ info->rsvd_pg_drv_buf_max_sz > SDIO_TX_MAX_SIZE_88XX) -+ return HALMAC_RET_FAIL; -+ -+ adapter->pltfm_info.malloc_size = info->halmac_malloc_max_sz; -+ adapter->pltfm_info.rsvd_pg_size = info->rsvd_pg_drv_buf_max_sz; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * dl_drv_rsvd_page_88xx() - download packet to rsvd page -+ * @adapter : the adapter of halmac -+ * @pg_offset : page offset of driver's rsvd page -+ * @halmac_buf : data to be downloaded, tx_desc is not included -+ * @halmac_size : data size to be downloaded -+ * Author : KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+dl_drv_rsvd_page_88xx(struct halmac_adapter *adapter, u8 pg_offset, u8 *buf, -+ u32 size) -+{ -+ enum halmac_ret_status status; -+ u32 pg_size; -+ u32 pg_num = 0; -+ u16 pg_addr = 0; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ pg_size = adapter->hw_cfg_info.page_size; -+ pg_num = size / pg_size + ((size & (pg_size - 1)) ? 1 : 0); -+ if (pg_offset + pg_num > adapter->txff_alloc.rsvd_drv_pg_num) { -+ PLTFM_MSG_ERR("[ERR] pkt overflow!!\n"); -+ return HALMAC_RET_DRV_DL_ERR; -+ } -+ -+ pg_addr = adapter->txff_alloc.rsvd_drv_addr + pg_offset; -+ -+ status = dl_rsvd_page_88xx(adapter, pg_addr, buf, size); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dl rsvd page fail!!\n"); -+ return status; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+dl_rsvd_page_88xx(struct halmac_adapter *adapter, u16 pg_addr, u8 *buf, -+ u32 size) -+{ -+ u8 restore[2]; -+ u8 value8; -+ u16 rsvd_pg_head; -+ u32 cnt; -+ enum halmac_rsvd_pg_state *state = &adapter->halmac_state.rsvd_pg_state; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (size == 0) { -+ PLTFM_MSG_TRACE("[TRACE]pkt size = 0\n"); -+ return HALMAC_RET_ZERO_LEN_RSVD_PACKET; -+ } -+ -+ if (*state == HALMAC_RSVD_PG_STATE_BUSY) -+ return HALMAC_RET_BUSY_STATE; -+ -+ *state = HALMAC_RSVD_PG_STATE_BUSY; -+ -+ pg_addr &= BIT_MASK_BCN_HEAD_1_V1; -+ HALMAC_REG_W16(REG_FIFOPAGE_CTRL_2, (u16)(pg_addr | BIT(15))); -+ -+ value8 = HALMAC_REG_R8(REG_CR + 1); -+ restore[0] = value8; -+ value8 = (u8)(value8 | BIT(0)); -+ HALMAC_REG_W8(REG_CR + 1, value8); -+ -+ value8 = HALMAC_REG_R8(REG_FWHW_TXQ_CTRL + 2); -+ restore[1] = value8; -+ value8 = (u8)(value8 & ~(BIT(6))); -+ HALMAC_REG_W8(REG_FWHW_TXQ_CTRL + 2, value8); -+ -+ if (PLTFM_SEND_RSVD_PAGE(buf, size) == 0) { -+ PLTFM_MSG_ERR("[ERR]send rvsd pg(pltfm)!!\n"); -+ status = HALMAC_RET_DL_RSVD_PAGE_FAIL; -+ goto DL_RSVD_PG_END; -+ } -+ -+ cnt = 1000; -+ while (!(HALMAC_REG_R8(REG_FIFOPAGE_CTRL_2 + 1) & BIT(7))) { -+ PLTFM_DELAY_US(10); -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]bcn valid!!\n"); -+ status = HALMAC_RET_POLLING_BCN_VALID_FAIL; -+ break; -+ } -+ } -+DL_RSVD_PG_END: -+ rsvd_pg_head = adapter->txff_alloc.rsvd_boundary; -+ HALMAC_REG_W16(REG_FIFOPAGE_CTRL_2, rsvd_pg_head | BIT(15)); -+ HALMAC_REG_W8(REG_FWHW_TXQ_CTRL + 2, restore[1]); -+ HALMAC_REG_W8(REG_CR + 1, restore[0]); -+ -+ *state = HALMAC_RSVD_PG_STATE_IDLE; -+ -+ return status; -+} -+ -+enum halmac_ret_status -+get_hw_value_88xx(struct halmac_adapter *adapter, enum halmac_hw_id hw_id, -+ void *value) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ switch (hw_id) { -+ case HALMAC_HW_RQPN_MAPPING: -+ get_pq_mapping_88xx(adapter, (struct halmac_rqpn_map *)value); -+ break; -+ case HALMAC_HW_EFUSE_SIZE: -+ *(u32 *)value = adapter->hw_cfg_info.efuse_size; -+ break; -+ case HALMAC_HW_EEPROM_SIZE: -+ *(u32 *)value = adapter->hw_cfg_info.eeprom_size; -+ break; -+ case HALMAC_HW_BT_BANK_EFUSE_SIZE: -+ *(u32 *)value = adapter->hw_cfg_info.bt_efuse_size; -+ break; -+ case HALMAC_HW_BT_BANK1_EFUSE_SIZE: -+ case HALMAC_HW_BT_BANK2_EFUSE_SIZE: -+ *(u32 *)value = 0; -+ break; -+ case HALMAC_HW_TXFIFO_SIZE: -+ *(u32 *)value = adapter->hw_cfg_info.tx_fifo_size; -+ break; -+ case HALMAC_HW_RXFIFO_SIZE: -+ *(u32 *)value = adapter->hw_cfg_info.rx_fifo_size; -+ break; -+ case HALMAC_HW_RSVD_PG_BNDY: -+ *(u16 *)value = adapter->txff_alloc.rsvd_drv_addr; -+ break; -+ case HALMAC_HW_CAM_ENTRY_NUM: -+ *(u8 *)value = adapter->hw_cfg_info.cam_entry_num; -+ break; -+ case HALMAC_HW_WLAN_EFUSE_AVAILABLE_SIZE: -+ get_efuse_available_size_88xx(adapter, (u32 *)value); -+ break; -+ case HALMAC_HW_IC_VERSION: -+ *(u8 *)value = adapter->chip_ver; -+ break; -+ case HALMAC_HW_PAGE_SIZE: -+ *(u32 *)value = adapter->hw_cfg_info.page_size; -+ break; -+ case HALMAC_HW_TX_AGG_ALIGN_SIZE: -+ *(u16 *)value = adapter->hw_cfg_info.tx_align_size; -+ break; -+ case HALMAC_HW_RX_AGG_ALIGN_SIZE: -+ *(u8 *)value = 8; -+ break; -+ case HALMAC_HW_DRV_INFO_SIZE: -+ *(u8 *)value = adapter->drv_info_size; -+ break; -+ case HALMAC_HW_TXFF_ALLOCATION: -+ PLTFM_MEMCPY(value, &adapter->txff_alloc, -+ sizeof(struct halmac_txff_allocation)); -+ break; -+ case HALMAC_HW_RSVD_EFUSE_SIZE: -+ *(u32 *)value = get_rsvd_efuse_size_88xx(adapter); -+ break; -+ case HALMAC_HW_FW_HDR_SIZE: -+ *(u32 *)value = WLAN_FW_HDR_SIZE; -+ break; -+ case HALMAC_HW_TX_DESC_SIZE: -+ *(u32 *)value = adapter->hw_cfg_info.txdesc_size; -+ break; -+ case HALMAC_HW_RX_DESC_SIZE: -+ *(u32 *)value = adapter->hw_cfg_info.rxdesc_size; -+ break; -+ case HALMAC_HW_ORI_H2C_SIZE: -+ *(u32 *)value = ORIGINAL_H2C_CMD_SIZE; -+ break; -+ case HALMAC_HW_RSVD_DRV_PGNUM: -+ *(u16 *)value = adapter->txff_alloc.rsvd_drv_pg_num; -+ break; -+ case HALMAC_HW_TX_PAGE_SIZE: -+ *(u16 *)value = TX_PAGE_SIZE_88XX; -+ break; -+ case HALMAC_HW_USB_TXAGG_DESC_NUM: -+ *(u8 *)value = adapter->hw_cfg_info.usb_txagg_num; -+ break; -+ case HALMAC_HW_AC_OQT_SIZE: -+ *(u8 *)value = adapter->hw_cfg_info.ac_oqt_size; -+ break; -+ case HALMAC_HW_NON_AC_OQT_SIZE: -+ *(u8 *)value = adapter->hw_cfg_info.non_ac_oqt_size; -+ break; -+ case HALMAC_HW_AC_QUEUE_NUM: -+ *(u8 *)value = adapter->hw_cfg_info.acq_num; -+ break; -+ case HALMAC_HW_PWR_STATE: -+ pwr_state_88xx(adapter, (enum halmac_mac_power *)value); -+ break; -+ default: -+ return HALMAC_RET_PARA_NOT_SUPPORT; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static void -+get_pq_mapping_88xx(struct halmac_adapter *adapter, -+ struct halmac_rqpn_map *mapping) -+{ -+ mapping->dma_map_vo = adapter->pq_map[HALMAC_PQ_MAP_VO]; -+ mapping->dma_map_vi = adapter->pq_map[HALMAC_PQ_MAP_VI]; -+ mapping->dma_map_be = adapter->pq_map[HALMAC_PQ_MAP_BE]; -+ mapping->dma_map_bk = adapter->pq_map[HALMAC_PQ_MAP_BK]; -+ mapping->dma_map_mg = adapter->pq_map[HALMAC_PQ_MAP_MG]; -+ mapping->dma_map_hi = adapter->pq_map[HALMAC_PQ_MAP_HI]; -+} -+ -+/** -+ * set_hw_value_88xx() -set hw config value -+ * @adapter : the adapter of halmac -+ * @hw_id : hw id for driver to config -+ * @value : hw value, reference table to get data type -+ * Author : KaiYuan Chang / Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+set_hw_value_88xx(struct halmac_adapter *adapter, enum halmac_hw_id hw_id, -+ void *value) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+#if HALMAC_SDIO_SUPPORT -+ struct halmac_tx_page_threshold_info *th_info; -+#endif -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (!value) { -+ PLTFM_MSG_ERR("[ERR]null ptr-set hw value\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ -+ switch (hw_id) { -+#if HALMAC_USB_SUPPORT -+ case HALMAC_HW_USB_MODE: -+ status = set_usb_mode_88xx(adapter, -+ *(enum halmac_usb_mode *)value); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ break; -+#endif -+ case HALMAC_HW_BANDWIDTH: -+ cfg_bw_88xx(adapter, *(enum halmac_bw *)value); -+ break; -+ case HALMAC_HW_CHANNEL: -+ cfg_ch_88xx(adapter, *(u8 *)value); -+ break; -+ case HALMAC_HW_PRI_CHANNEL_IDX: -+ cfg_pri_ch_idx_88xx(adapter, *(enum halmac_pri_ch_idx *)value); -+ break; -+ case HALMAC_HW_EN_BB_RF: -+ status = enable_bb_rf_88xx(adapter, *(u8 *)value); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ break; -+#if HALMAC_SDIO_SUPPORT -+ case HALMAC_HW_SDIO_TX_PAGE_THRESHOLD: -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+ th_info = (struct halmac_tx_page_threshold_info *)value; -+ cfg_sdio_tx_page_threshold_88xx(adapter, th_info); -+ } else { -+ return HALMAC_RET_FAIL; -+ } -+ break; -+#endif -+ case HALMAC_HW_RX_SHIFT: -+ rx_shift_88xx(adapter, *(u8 *)value); -+ break; -+ case HALMAC_HW_TXDESC_CHECKSUM: -+ tx_desc_chksum_88xx(adapter, *(u8 *)value); -+ break; -+ case HALMAC_HW_RX_CLK_GATE: -+ rx_clk_gate_88xx(adapter, *(u8 *)value); -+ break; -+ case HALMAC_HW_FAST_EDCA: -+ fast_edca_cfg_88xx(adapter, -+ (struct halmac_fast_edca_cfg *)value); -+ break; -+ case HALMAC_HW_RTS_FULL_BW: -+ rts_full_bw_88xx(adapter, *(u8 *)value); -+ break; -+ case HALMAC_HW_FREE_CNT_EN: -+ HALMAC_REG_W8_SET(REG_MISC_CTRL, BIT_EN_FREECNT); -+ break; -+ case HALMAC_HW_TXFIFO_LIFETIME: -+ cfg_txfifo_lt_88xx(adapter, -+ (struct halmac_txfifo_lifetime_cfg *)value); -+ break; -+ default: -+ return HALMAC_RET_PARA_NOT_SUPPORT; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * get_watcher_88xx() -get watcher value -+ * @adapter : the adapter of halmac -+ * @sel : id for driver to config -+ * @value : value, reference table to get data type -+ * Author : -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_watcher_88xx(struct halmac_adapter *adapter, enum halmac_watcher_sel sel, -+ void *value) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (!value) { -+ PLTFM_MSG_ERR("[ERR]null ptr-set hw value\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ -+ switch (sel) { -+ case HALMAC_WATCHER_SDIO_RN_FOOL_PROOFING: -+ *(u32 *)value = adapter->watcher.get_watcher.sdio_rn_not_align; -+ break; -+ default: -+ return HALMAC_RET_PARA_NOT_SUPPORT; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+set_h2c_pkt_hdr_88xx(struct halmac_adapter *adapter, u8 *hdr, -+ struct halmac_h2c_header_info *info, u16 *seq_num) -+{ -+ u16 total_size; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s!!\n", __func__); -+ -+ total_size = H2C_PKT_HDR_SIZE_88XX + info->content_size; -+ FW_OFFLOAD_H2C_SET_TOTAL_LEN(hdr, total_size); -+ FW_OFFLOAD_H2C_SET_SUB_CMD_ID(hdr, info->sub_cmd_id); -+ -+ FW_OFFLOAD_H2C_SET_CATEGORY(hdr, 0x01); -+ FW_OFFLOAD_H2C_SET_CMD_ID(hdr, 0xFF); -+ -+ PLTFM_MUTEX_LOCK(&adapter->h2c_seq_mutex); -+ FW_OFFLOAD_H2C_SET_SEQ_NUM(hdr, adapter->h2c_info.seq_num); -+ *seq_num = adapter->h2c_info.seq_num; -+ (adapter->h2c_info.seq_num)++; -+ PLTFM_MUTEX_UNLOCK(&adapter->h2c_seq_mutex); -+ -+ if (info->ack == 1) -+ FW_OFFLOAD_H2C_SET_ACK(hdr, 1); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+send_h2c_pkt_88xx(struct halmac_adapter *adapter, u8 *pkt) -+{ -+ u32 cnt = 100; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ while (adapter->h2c_info.buf_fs <= H2C_PKT_SIZE_88XX) { -+ get_h2c_buf_free_space_88xx(adapter); -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]h2c free space!!\n"); -+ return HALMAC_RET_H2C_SPACE_FULL; -+ } -+ } -+ -+ cnt = 100; -+ do { -+ if (PLTFM_SEND_H2C_PKT(pkt, H2C_PKT_SIZE_88XX) == 1) -+ break; -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]pltfm - sned h2c pkt!!\n"); -+ return HALMAC_RET_SEND_H2C_FAIL; -+ } -+ PLTFM_DELAY_US(5); -+ -+ } while (1); -+ -+ adapter->h2c_info.buf_fs -= H2C_PKT_SIZE_88XX; -+ -+ return status; -+} -+ -+enum halmac_ret_status -+get_h2c_buf_free_space_88xx(struct halmac_adapter *adapter) -+{ -+ u32 hw_wptr; -+ u32 fw_rptr; -+ struct halmac_h2c_info *info = &adapter->h2c_info; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ hw_wptr = HALMAC_REG_R32(REG_H2C_PKT_WRITEADDR) & 0x3FFFF; -+ fw_rptr = HALMAC_REG_R32(REG_H2C_PKT_READADDR) & 0x3FFFF; -+ -+ if (hw_wptr >= fw_rptr) -+ info->buf_fs = info->buf_size - (hw_wptr - fw_rptr); -+ else -+ info->buf_fs = fw_rptr - hw_wptr; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * get_c2h_info_88xx() - process halmac C2H packet -+ * @adapter : the adapter of halmac -+ * @buf : RX Packet pointer -+ * @size : RX Packet size -+ * -+ * Note : Don't use any IO or DELAY in this API -+ * -+ * Author : KaiYuan Chang/Ivan Lin -+ * -+ * Used to process c2h packet info from RX path. After receiving the packet, -+ * user need to call this api and pass the packet pointer. -+ * -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_c2h_info_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (GET_RX_DESC_C2H(buf) == 1) { -+ PLTFM_MSG_TRACE("[TRACE]Parse c2h pkt\n"); -+ -+ status = parse_c2h_pkt_88xx(adapter, buf, size); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]Parse c2h pkt\n"); -+ return status; -+ } -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+parse_c2h_pkt_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 cmd_id; -+ u8 sub_cmd_id; -+ u8 *c2h_pkt = buf + adapter->hw_cfg_info.rxdesc_size; -+ u32 c2h_size = size - adapter->hw_cfg_info.rxdesc_size; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ cmd_id = (u8)C2H_HDR_GET_CMD_ID(c2h_pkt); -+ -+ if (cmd_id != 0xFF) { -+ PLTFM_MSG_TRACE("[TRACE]Not 0xFF cmd!!\n"); -+ return HALMAC_RET_C2H_NOT_HANDLED; -+ } -+ -+ sub_cmd_id = (u8)C2H_HDR_GET_C2H_SUB_CMD_ID(c2h_pkt); -+ -+ switch (sub_cmd_id) { -+ case C2H_SUB_CMD_ID_C2H_DBG: -+ status = get_c2h_dbg_88xx(adapter, c2h_pkt, c2h_size); -+ break; -+ case C2H_SUB_CMD_ID_H2C_ACK_HDR: -+ status = get_h2c_ack_88xx(adapter, c2h_pkt, c2h_size); -+ break; -+ case C2H_SUB_CMD_ID_BT_COEX_INFO: -+ status = HALMAC_RET_C2H_NOT_HANDLED; -+ break; -+ case C2H_SUB_CMD_ID_SCAN_STATUS_RPT: -+ status = get_scan_rpt_88xx(adapter, c2h_pkt, c2h_size); -+ break; -+ case C2H_SUB_CMD_ID_PSD_DATA: -+ status = get_psd_data_88xx(adapter, c2h_pkt, c2h_size); -+ break; -+ case C2H_SUB_CMD_ID_EFUSE_DATA: -+ status = get_efuse_data_88xx(adapter, c2h_pkt, c2h_size); -+ break; -+ case C2H_SUB_CMD_ID_SCAN_CH_NOTIFY: -+ status = get_scan_ch_notify_88xx(adapter, c2h_pkt, c2h_size); -+ break; -+ case C2H_SUB_CMD_ID_DPK_DATA: -+ status = get_dpk_data_88xx(adapter, c2h_pkt, c2h_size); -+ break; -+ default: -+ PLTFM_MSG_WARN("[WARN]Sub cmd id!!\n"); -+ status = HALMAC_RET_C2H_NOT_HANDLED; -+ break; -+ } -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+get_c2h_dbg_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 i; -+ u8 next_msg = 0; -+ u8 cur_msg = 0; -+ u8 msg_len = 0; -+ char *c2h_buf = (char *)NULL; -+ u8 content_len = 0; -+ u8 seq_num = 0; -+ -+ content_len = (u8)C2H_HDR_GET_LEN((u8 *)buf); -+ -+ if (content_len > C2H_DBG_CONTENT_MAX_LENGTH) { -+ PLTFM_MSG_ERR("[ERR]c2h size > max len!\n"); -+ return HALMAC_RET_C2H_NOT_HANDLED; -+ } -+ -+ for (i = 0; i < content_len; i++) { -+ if (*(buf + C2H_DBG_HDR_LEN + i) == '\n') { -+ if ((*(buf + C2H_DBG_HDR_LEN + i + 1) == '\0') || -+ (*(buf + C2H_DBG_HDR_LEN + i + 1) == 0xff)) { -+ next_msg = C2H_DBG_HDR_LEN + i + 1; -+ goto _ENDFOUND; -+ } -+ } -+ } -+ -+_ENDFOUND: -+ msg_len = next_msg - C2H_DBG_HDR_LEN; -+ -+ c2h_buf = (char *)PLTFM_MALLOC(msg_len); -+ if (!c2h_buf) -+ return HALMAC_RET_MALLOC_FAIL; -+ -+ PLTFM_MEMCPY(c2h_buf, buf + C2H_DBG_HDR_LEN, msg_len); -+ -+ seq_num = (u8)(*(c2h_buf)); -+ *(c2h_buf + msg_len - 1) = '\0'; -+ PLTFM_MSG_ALWAYS("[RTKFW, SEQ=%d]: %s\n", -+ seq_num, (char *)(c2h_buf + 1)); -+ PLTFM_FREE(c2h_buf, msg_len); -+ -+ while (*(buf + next_msg) != '\0') { -+ cur_msg = next_msg; -+ -+ msg_len = (u8)(*(buf + cur_msg + 3)) - 1; -+ next_msg += C2H_DBG_HDR_LEN + msg_len; -+ -+ c2h_buf = (char *)PLTFM_MALLOC(msg_len); -+ if (!c2h_buf) -+ return HALMAC_RET_MALLOC_FAIL; -+ -+ PLTFM_MEMCPY(c2h_buf, buf + cur_msg + C2H_DBG_HDR_LEN, msg_len); -+ *(c2h_buf + msg_len - 1) = '\0'; -+ seq_num = (u8)(*(c2h_buf)); -+ PLTFM_MSG_ALWAYS("[RTKFW, SEQ=%d]: %s\n", -+ seq_num, (char *)(c2h_buf + 1)); -+ PLTFM_FREE(c2h_buf, msg_len); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_h2c_ack_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 cmd_id; -+ u8 sub_cmd_id; -+ u8 fw_rc; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]Ack for C2H!!\n"); -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ if (HALMAC_H2C_RETURN_SUCCESS != (enum halmac_h2c_return_code)fw_rc) -+ PLTFM_MSG_TRACE("[TRACE]fw rc = %d\n", fw_rc); -+ -+ cmd_id = (u8)H2C_ACK_HDR_GET_H2C_CMD_ID(buf); -+ -+ if (cmd_id != 0xFF) { -+ PLTFM_MSG_ERR("[ERR]h2c ack cmd id!!\n"); -+ return HALMAC_RET_C2H_NOT_HANDLED; -+ } -+ -+ sub_cmd_id = (u8)H2C_ACK_HDR_GET_H2C_SUB_CMD_ID(buf); -+ -+ switch (sub_cmd_id) { -+ case H2C_SUB_CMD_ID_DUMP_PHYSICAL_EFUSE_ACK: -+ status = get_h2c_ack_phy_efuse_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_CFG_PARAM_ACK: -+ status = get_h2c_ack_cfg_param_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_UPDATE_PKT_ACK: -+ status = get_h2c_ack_update_pkt_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_SEND_SCAN_PKT_ACK: -+ status = get_h2c_ack_send_scan_pkt_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_DROP_SCAN_PKT_ACK: -+ status = get_h2c_ack_drop_scan_pkt_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_UPDATE_DATAPACK_ACK: -+ status = get_h2c_ack_update_datapkt_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_RUN_DATAPACK_ACK: -+ status = get_h2c_ack_run_datapkt_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_CH_SWITCH_ACK: -+ status = get_h2c_ack_ch_switch_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_IQK_ACK: -+ status = get_h2c_ack_iqk_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_PWR_TRK_ACK: -+ status = get_h2c_ack_pwr_trk_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_PSD_ACK: -+ break; -+ case H2C_SUB_CMD_ID_FW_SNDING_ACK: -+ status = get_h2c_ack_fw_snding_88xx(adapter, buf, size); -+ break; -+ case H2C_SUB_CMD_ID_DPK_ACK: -+ status = get_h2c_ack_dpk_88xx(adapter, buf, size); -+ break; -+ default: -+ status = HALMAC_RET_C2H_NOT_HANDLED; -+ break; -+ } -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+get_scan_ch_notify_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ struct halmac_scan_rpt_info *scan_rpt_info = &adapter->scan_rpt_info; -+ -+ PLTFM_MSG_TRACE("[TRACE]scan mode:%d\n", adapter->ch_sw_info.scan_mode); -+ -+ if (adapter->ch_sw_info.scan_mode == 1) { -+ if (scan_rpt_info->avl_buf_size < 12) { -+ PLTFM_MSG_ERR("[ERR]ch_notify buffer full!!\n"); -+ return HALMAC_RET_CH_SW_NO_BUF; -+ } -+ -+ SCAN_CH_NOTIFY_SET_CH_NUM(scan_rpt_info->buf_wptr, -+ (u8)SCAN_CH_NOTIFY_GET_CH_NUM(buf)); -+ SCAN_CH_NOTIFY_SET_NOTIFY_ID(scan_rpt_info->buf_wptr, -+ SCAN_CH_NOTIFY_GET_NOTIFY_ID(buf)); -+ SCAN_CH_NOTIFY_SET_STATUS(scan_rpt_info->buf_wptr, -+ (u8)SCAN_CH_NOTIFY_GET_STATUS(buf)); -+ SCAN_CH_NOTIFY_SET_TSF_0(scan_rpt_info->buf_wptr, -+ (u8)SCAN_CH_NOTIFY_GET_TSF_0(buf)); -+ SCAN_CH_NOTIFY_SET_TSF_1(scan_rpt_info->buf_wptr, -+ (u8)SCAN_CH_NOTIFY_GET_TSF_1(buf)); -+ SCAN_CH_NOTIFY_SET_TSF_2(scan_rpt_info->buf_wptr, -+ (u8)SCAN_CH_NOTIFY_GET_TSF_2(buf)); -+ SCAN_CH_NOTIFY_SET_TSF_3(scan_rpt_info->buf_wptr, -+ (u8)SCAN_CH_NOTIFY_GET_TSF_3(buf)); -+ SCAN_CH_NOTIFY_SET_TSF_4(scan_rpt_info->buf_wptr, -+ (u8)SCAN_CH_NOTIFY_GET_TSF_4(buf)); -+ SCAN_CH_NOTIFY_SET_TSF_5(scan_rpt_info->buf_wptr, -+ (u8)SCAN_CH_NOTIFY_GET_TSF_5(buf)); -+ SCAN_CH_NOTIFY_SET_TSF_6(scan_rpt_info->buf_wptr, -+ (u8)SCAN_CH_NOTIFY_GET_TSF_6(buf)); -+ SCAN_CH_NOTIFY_SET_TSF_7(scan_rpt_info->buf_wptr, -+ (u8)SCAN_CH_NOTIFY_GET_TSF_7(buf)); -+ -+ scan_rpt_info->avl_buf_size = scan_rpt_info->avl_buf_size - 12; -+ scan_rpt_info->total_size = scan_rpt_info->total_size + 12; -+ scan_rpt_info->buf_wptr = scan_rpt_info->buf_wptr + 12; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_scan_rpt_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 fw_rc; -+ enum halmac_cmd_process_status proc_status; -+ struct halmac_scan_rpt_info *scan_rpt_info = &adapter->scan_rpt_info; -+ -+ fw_rc = (u8)SCAN_STATUS_RPT_GET_H2C_RETURN_CODE(buf); -+ proc_status = (HALMAC_H2C_RETURN_SUCCESS == -+ (enum halmac_h2c_return_code)fw_rc) ? -+ HALMAC_CMD_PROCESS_DONE : HALMAC_CMD_PROCESS_ERROR; -+ -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_CHANNEL_SWITCH, proc_status, NULL, 0); -+ -+ adapter->halmac_state.scan_state.proc_status = proc_status; -+ -+ if (adapter->ch_sw_info.scan_mode == 1) { -+ scan_rpt_info->rpt_tsf_low = -+ ((SCAN_STATUS_RPT_GET_TSF_3(buf) << 24) | -+ (SCAN_STATUS_RPT_GET_TSF_2(buf) << 16) | -+ (SCAN_STATUS_RPT_GET_TSF_1(buf) << 8) | -+ (SCAN_STATUS_RPT_GET_TSF_0(buf))); -+ scan_rpt_info->rpt_tsf_high = -+ ((SCAN_STATUS_RPT_GET_TSF_7(buf) << 24) | -+ (SCAN_STATUS_RPT_GET_TSF_6(buf) << 16) | -+ (SCAN_STATUS_RPT_GET_TSF_5(buf) << 8) | -+ (SCAN_STATUS_RPT_GET_TSF_4(buf))); -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]scan : %X\n", proc_status); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_h2c_ack_cfg_param_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seq_num; -+ u8 fw_rc; -+ u32 offset_accum; -+ u32 value_accum; -+ struct halmac_cfg_param_state *state = -+ &adapter->halmac_state.cfg_param_state; -+ enum halmac_cmd_process_status proc_status = -+ HALMAC_CMD_PROCESS_UNDEFINE; -+ -+ seq_num = (u8)H2C_ACK_HDR_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ state->fw_rc = fw_rc; -+ offset_accum = CFG_PARAM_ACK_GET_OFFSET_ACCUMULATION(buf); -+ value_accum = CFG_PARAM_ACK_GET_VALUE_ACCUMULATION(buf); -+ -+ if (offset_accum != adapter->cfg_param_info.offset_accum || -+ value_accum != adapter->cfg_param_info.value_accum) { -+ PLTFM_MSG_ERR("[ERR][C2H]offset_accu : %x, value_accu : %xn", -+ offset_accum, value_accum); -+ PLTFM_MSG_ERR("[ERR][Ada]offset_accu : %x, value_accu : %x\n", -+ adapter->cfg_param_info.offset_accum, -+ adapter->cfg_param_info.value_accum); -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ } -+ -+ if ((enum halmac_h2c_return_code)fw_rc == HALMAC_H2C_RETURN_SUCCESS && -+ proc_status != HALMAC_CMD_PROCESS_ERROR) { -+ proc_status = HALMAC_CMD_PROCESS_DONE; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_CFG_PARA, proc_status, NULL, 0); -+ } else { -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_CFG_PARA, proc_status, -+ &fw_rc, 1); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_h2c_ack_update_pkt_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seq_num; -+ u8 fw_rc; -+ struct halmac_update_pkt_state *state = -+ &adapter->halmac_state.update_pkt_state; -+ enum halmac_cmd_process_status proc_status; -+ -+ seq_num = (u8)H2C_ACK_HDR_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ state->fw_rc = fw_rc; -+ -+ if (HALMAC_H2C_RETURN_SUCCESS == (enum halmac_h2c_return_code)fw_rc) { -+ proc_status = HALMAC_CMD_PROCESS_DONE; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_UPDATE_PACKET, proc_status, -+ NULL, 0); -+ } else { -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_UPDATE_PACKET, proc_status, -+ &state->fw_rc, 1); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_h2c_ack_send_scan_pkt_88xx(struct halmac_adapter *adapter, -+ u8 *buf, u32 size) -+{ -+ u8 seq_num; -+ u8 fw_rc; -+ struct halmac_scan_pkt_state *state = -+ &adapter->halmac_state.scan_pkt_state; -+ enum halmac_cmd_process_status proc_status; -+ -+ seq_num = (u8)H2C_ACK_HDR_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ state->fw_rc = fw_rc; -+ -+ if (HALMAC_H2C_RETURN_SUCCESS == (enum halmac_h2c_return_code)fw_rc) { -+ proc_status = HALMAC_CMD_PROCESS_DONE; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_SEND_SCAN_PACKET, proc_status, -+ NULL, 0); -+ } else { -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_SEND_SCAN_PACKET, proc_status, -+ &state->fw_rc, 1); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_h2c_ack_drop_scan_pkt_88xx(struct halmac_adapter *adapter, -+ u8 *buf, u32 size) -+{ -+ u8 seq_num; -+ u8 fw_rc; -+ struct halmac_drop_pkt_state *state = -+ &adapter->halmac_state.drop_pkt_state; -+ enum halmac_cmd_process_status proc_status; -+ -+ seq_num = (u8)H2C_ACK_HDR_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ state->fw_rc = fw_rc; -+ -+ if (HALMAC_H2C_RETURN_SUCCESS == (enum halmac_h2c_return_code)fw_rc) { -+ proc_status = HALMAC_CMD_PROCESS_DONE; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_DROP_SCAN_PACKET, proc_status, -+ NULL, 0); -+ } else { -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_DROP_SCAN_PACKET, proc_status, -+ &state->fw_rc, 1); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_h2c_ack_update_datapkt_88xx(struct halmac_adapter *adapter, u8 *buf, -+ u32 size) -+{ -+ return HALMAC_RET_NOT_SUPPORT; -+} -+ -+static enum halmac_ret_status -+get_h2c_ack_run_datapkt_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ return HALMAC_RET_NOT_SUPPORT; -+} -+ -+static enum halmac_ret_status -+get_h2c_ack_ch_switch_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seq_num; -+ u8 fw_rc; -+ struct halmac_scan_state *state = &adapter->halmac_state.scan_state; -+ struct halmac_scan_rpt_info *scan_rpt_info = &adapter->scan_rpt_info; -+ enum halmac_cmd_process_status proc_status; -+ -+ seq_num = (u8)H2C_ACK_HDR_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ state->fw_rc = fw_rc; -+ -+ if (adapter->ch_sw_info.scan_mode == 1) { -+ scan_rpt_info->ack_tsf_low = -+ ((CH_SWITCH_ACK_GET_TSF_3(buf) << 24) | -+ (CH_SWITCH_ACK_GET_TSF_2(buf) << 16) | -+ (CH_SWITCH_ACK_GET_TSF_1(buf) << 8) | -+ (CH_SWITCH_ACK_GET_TSF_0(buf))); -+ scan_rpt_info->ack_tsf_high = -+ ((CH_SWITCH_ACK_GET_TSF_7(buf) << 24) | -+ (CH_SWITCH_ACK_GET_TSF_6(buf) << 16) | -+ (CH_SWITCH_ACK_GET_TSF_5(buf) << 8) | -+ (CH_SWITCH_ACK_GET_TSF_4(buf))); -+ } -+ -+ if ((enum halmac_h2c_return_code)fw_rc == HALMAC_H2C_RETURN_SUCCESS) { -+ proc_status = HALMAC_CMD_PROCESS_RCVD; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_CHANNEL_SWITCH, proc_status, -+ NULL, 0); -+ } else { -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_CHANNEL_SWITCH, proc_status, -+ &fw_rc, 1); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * mac_debug_88xx_v1() - read some registers for debug -+ * @adapter -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ */ -+enum halmac_ret_status -+mac_debug_88xx(struct halmac_adapter *adapter) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) -+ dump_reg_sdio_88xx(adapter); -+ else -+ dump_reg_88xx(adapter); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static void -+dump_reg_sdio_88xx(struct halmac_adapter *adapter) -+{ -+ u8 tmp8; -+ u32 i; -+ -+ /* Dump CCCR, it needs new platform api */ -+ -+ /*Dump SDIO Local Register, use CMD52*/ -+ for (i = 0x10250000; i < 0x102500ff; i++) { -+ tmp8 = PLTFM_SDIO_CMD52_R(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-sdio[%x]=%x\n", i, tmp8); -+ } -+ -+ /*Dump MAC Register*/ -+ for (i = 0x0000; i < 0x17ff; i++) { -+ tmp8 = PLTFM_SDIO_CMD52_R(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-mac[%x]=%x\n", i, tmp8); -+ } -+ -+ tmp8 = PLTFM_SDIO_CMD52_R(REG_SDIO_CRC_ERR_IDX); -+ if (tmp8) -+ PLTFM_MSG_ERR("[ERR]sdio crc=%x\n", tmp8); -+ -+ /*Check RX Fifo status*/ -+ i = REG_RXFF_PTR_V1; -+ tmp8 = PLTFM_SDIO_CMD52_R(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-mac[%x]=%x\n", i, tmp8); -+ i = REG_RXFF_WTR_V1; -+ tmp8 = PLTFM_SDIO_CMD52_R(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-mac[%x]=%x\n", i, tmp8); -+ i = REG_RXFF_PTR_V1; -+ tmp8 = PLTFM_SDIO_CMD52_R(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-mac[%x]=%x\n", i, tmp8); -+ i = REG_RXFF_WTR_V1; -+ tmp8 = PLTFM_SDIO_CMD52_R(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-mac[%x]=%x\n", i, tmp8); -+} -+ -+static void -+dump_reg_88xx(struct halmac_adapter *adapter) -+{ -+ u32 tmp32; -+ u32 i; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ /*Dump MAC Register*/ -+ for (i = 0x0000; i < 0x17fc; i += 4) { -+ tmp32 = HALMAC_REG_R32(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-mac[%x]=%x\n", i, tmp32); -+ } -+ -+ /*Check RX Fifo status*/ -+ i = REG_RXFF_PTR_V1; -+ tmp32 = HALMAC_REG_R32(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-mac[%x]=%x\n", i, tmp32); -+ i = REG_RXFF_WTR_V1; -+ tmp32 = HALMAC_REG_R32(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-mac[%x]=%x\n", i, tmp32); -+ i = REG_RXFF_PTR_V1; -+ tmp32 = HALMAC_REG_R32(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-mac[%x]=%x\n", i, tmp32); -+ i = REG_RXFF_WTR_V1; -+ tmp32 = HALMAC_REG_R32(i); -+ PLTFM_MSG_TRACE("[TRACE]dbg-mac[%x]=%x\n", i, tmp32); -+} -+ -+/** -+ * cfg_parameter_88xx() - config parameter by FW -+ * @adapter : the adapter of halmac -+ * @info : cmd id, content -+ * @full_fifo : parameter information -+ * -+ * If msk_en = 1, the format of array is {reg_info, mask, value}. -+ * If msk_en =_FAUSE, the format of array is {reg_info, value} -+ * The format of reg_info is -+ * reg_info[31]=rf_reg, 0: MAC_BB reg, 1: RF reg -+ * reg_info[27:24]=rf_path, 0: path_A, 1: path_B -+ * if rf_reg=0(MAC_BB reg), rf_path is meaningless. -+ * ref_info[15:0]=offset -+ * -+ * Example: msk_en = 0 -+ * {0x8100000a, 0x00001122} -+ * =>Set RF register, path_B, offset 0xA to 0x00001122 -+ * {0x00000824, 0x11224433} -+ * =>Set MAC_BB register, offset 0x800 to 0x11224433 -+ * -+ * Note : full fifo mode only for init flow -+ * -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_parameter_88xx(struct halmac_adapter *adapter, -+ struct halmac_phy_parameter_info *info, u8 full_fifo) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ enum halmac_cmd_construct_state cmd_state; -+ -+ proc_status = &adapter->halmac_state.cfg_param_state.proc_status; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (adapter->fw_ver.h2c_version < 4) -+ return HALMAC_RET_FW_NO_SUPPORT; -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_TRACE("[TRACE]Wait event(para)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ cmd_state = cfg_param_cmd_cnstr_state_88xx(adapter); -+ if (cmd_state != HALMAC_CMD_CNSTR_IDLE && -+ cmd_state != HALMAC_CMD_CNSTR_CNSTR) { -+ PLTFM_MSG_TRACE("[TRACE]Not idle(para)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ *proc_status = HALMAC_CMD_PROCESS_IDLE; -+ -+ status = proc_cfg_param_88xx(adapter, info, full_fifo); -+ -+ if (status != HALMAC_RET_SUCCESS && status != HALMAC_RET_PARA_SENDING) { -+ PLTFM_MSG_ERR("[ERR]send param h2c\n"); -+ return status; -+ } -+ -+ return status; -+} -+ -+static enum halmac_cmd_construct_state -+cfg_param_cmd_cnstr_state_88xx(struct halmac_adapter *adapter) -+{ -+ return adapter->halmac_state.cfg_param_state.cmd_cnstr_state; -+} -+ -+static enum halmac_ret_status -+proc_cfg_param_88xx(struct halmac_adapter *adapter, -+ struct halmac_phy_parameter_info *param, u8 full_fifo) -+{ -+ u8 end_cmd = 0; -+ u32 rsvd_size; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_cfg_param_info *info = &adapter->cfg_param_info; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.cfg_param_state.proc_status; -+ -+ status = malloc_cfg_param_buf_88xx(adapter, full_fifo); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ if (cnv_cfg_param_state_88xx(adapter, HALMAC_CMD_CNSTR_CNSTR) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(info->buf, info->buf_size); -+ info->buf = NULL; -+ info->buf_wptr = NULL; -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ add_param_buf_88xx(adapter, param, info->buf_wptr, &end_cmd); -+ if (param->cmd_id != HALMAC_PARAMETER_CMD_END) { -+ info->num++; -+ info->buf_wptr += CFG_PARAM_H2C_INFO_SIZE; -+ info->avl_buf_size -= CFG_PARAM_H2C_INFO_SIZE; -+ } -+ -+ rsvd_size = info->avl_buf_size - adapter->hw_cfg_info.txdesc_size; -+ if (rsvd_size > CFG_PARAM_H2C_INFO_SIZE && end_cmd == 0) -+ return HALMAC_RET_SUCCESS; -+ -+ if (info->num == 0) { -+ PLTFM_FREE(info->buf, info->buf_size); -+ info->buf = NULL; -+ info->buf_wptr = NULL; -+ PLTFM_MSG_TRACE("[TRACE]param num = 0!!\n"); -+ -+ *proc_status = HALMAC_CMD_PROCESS_DONE; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_CFG_PARA, *proc_status, NULL, 0); -+ -+ reset_ofld_feature_88xx(adapter, HALMAC_FEATURE_CFG_PARA); -+ -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ status = send_cfg_param_h2c_88xx(adapter); -+ if (status != HALMAC_RET_SUCCESS) { -+ if (info->buf) { -+ PLTFM_FREE(info->buf, info->buf_size); -+ info->buf = NULL; -+ info->buf_wptr = NULL; -+ } -+ return status; -+ } -+ -+ if (end_cmd == 0) { -+ PLTFM_MSG_TRACE("[TRACE]send h2c-buf full\n"); -+ return HALMAC_RET_PARA_SENDING; -+ } -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+send_cfg_param_h2c_88xx(struct halmac_adapter *adapter) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 pg_addr; -+ u16 seq_num = 0; -+ u32 info_size; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_cfg_param_info *info = &adapter->cfg_param_info; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.cfg_param_state.proc_status; -+ -+ if (cnv_cfg_param_state_88xx(adapter, HALMAC_CMD_CNSTR_H2C_SENT) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ if (info->full_fifo_mode == 1) -+ pg_addr = 0; -+ else -+ pg_addr = adapter->txff_alloc.rsvd_h2c_info_addr; -+ -+ info_size = info->num * CFG_PARAM_H2C_INFO_SIZE; -+ -+ status = dl_rsvd_page_88xx(adapter, pg_addr, info->buf, info_size); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dl rsvd pg!!\n"); -+ goto CFG_PARAM_H2C_FAIL; -+ } -+ -+ gen_cfg_param_h2c_88xx(adapter, h2c_buf); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_CFG_PARAM; -+ hdr_info.content_size = 4; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ adapter->halmac_state.cfg_param_state.seq_num = seq_num; -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ reset_ofld_feature_88xx(adapter, HALMAC_FEATURE_CFG_PARA); -+ } -+ -+CFG_PARAM_H2C_FAIL: -+ PLTFM_FREE(info->buf, info->buf_size); -+ info->buf = NULL; -+ info->buf_wptr = NULL; -+ -+ if (cnv_cfg_param_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+cnv_cfg_param_state_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_construct_state dest_state) -+{ -+ enum halmac_cmd_construct_state *state; -+ -+ state = &adapter->halmac_state.cfg_param_state.cmd_cnstr_state; -+ -+ if ((*state != HALMAC_CMD_CNSTR_IDLE) && -+ (*state != HALMAC_CMD_CNSTR_CNSTR) && -+ (*state != HALMAC_CMD_CNSTR_H2C_SENT)) -+ return HALMAC_RET_ERROR_STATE; -+ -+ if (dest_state == HALMAC_CMD_CNSTR_IDLE) { -+ if (*state == HALMAC_CMD_CNSTR_CNSTR) -+ return HALMAC_RET_ERROR_STATE; -+ } else if (dest_state == HALMAC_CMD_CNSTR_CNSTR) { -+ if (*state == HALMAC_CMD_CNSTR_H2C_SENT) -+ return HALMAC_RET_ERROR_STATE; -+ } else if (dest_state == HALMAC_CMD_CNSTR_H2C_SENT) { -+ if ((*state == HALMAC_CMD_CNSTR_IDLE) || -+ (*state == HALMAC_CMD_CNSTR_H2C_SENT)) -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ *state = dest_state; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+add_param_buf_88xx(struct halmac_adapter *adapter, -+ struct halmac_phy_parameter_info *param, u8 *buf, -+ u8 *end_cmd) -+{ -+ struct halmac_cfg_param_info *info = &adapter->cfg_param_info; -+ union halmac_parameter_content *content = ¶m->content; -+ -+ *end_cmd = 0; -+ -+ PARAM_INFO_SET_LEN(buf, CFG_PARAM_H2C_INFO_SIZE); -+ PARAM_INFO_SET_IO_CMD(buf, param->cmd_id); -+ -+ switch (param->cmd_id) { -+ case HALMAC_PARAMETER_CMD_BB_W8: -+ case HALMAC_PARAMETER_CMD_BB_W16: -+ case HALMAC_PARAMETER_CMD_BB_W32: -+ case HALMAC_PARAMETER_CMD_MAC_W8: -+ case HALMAC_PARAMETER_CMD_MAC_W16: -+ case HALMAC_PARAMETER_CMD_MAC_W32: -+ PARAM_INFO_SET_IO_ADDR(buf, content->MAC_REG_W.offset); -+ PARAM_INFO_SET_DATA(buf, content->MAC_REG_W.value); -+ PARAM_INFO_SET_MASK(buf, content->MAC_REG_W.msk); -+ PARAM_INFO_SET_MSK_EN(buf, content->MAC_REG_W.msk_en); -+ info->value_accum += content->MAC_REG_W.value; -+ info->offset_accum += content->MAC_REG_W.offset; -+ break; -+ case HALMAC_PARAMETER_CMD_RF_W: -+ /*In rf register, the address is only 1 byte*/ -+ PARAM_INFO_SET_RF_ADDR(buf, content->RF_REG_W.offset); -+ PARAM_INFO_SET_RF_PATH(buf, content->RF_REG_W.rf_path); -+ PARAM_INFO_SET_DATA(buf, content->RF_REG_W.value); -+ PARAM_INFO_SET_MASK(buf, content->RF_REG_W.msk); -+ PARAM_INFO_SET_MSK_EN(buf, content->RF_REG_W.msk_en); -+ info->value_accum += content->RF_REG_W.value; -+ info->offset_accum += (content->RF_REG_W.offset + -+ (content->RF_REG_W.rf_path << 8)); -+ break; -+ case HALMAC_PARAMETER_CMD_DELAY_US: -+ case HALMAC_PARAMETER_CMD_DELAY_MS: -+ PARAM_INFO_SET_DELAY_VAL(buf, content->DELAY_TIME.delay_time); -+ break; -+ case HALMAC_PARAMETER_CMD_END: -+ *end_cmd = 1; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]cmd id!!\n"); -+ break; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+gen_cfg_param_h2c_88xx(struct halmac_adapter *adapter, u8 *buff) -+{ -+ struct halmac_cfg_param_info *info = &adapter->cfg_param_info; -+ u16 h2c_info_addr = adapter->txff_alloc.rsvd_h2c_info_addr; -+ u16 rsvd_pg_addr = adapter->txff_alloc.rsvd_boundary; -+ -+ CFG_PARAM_SET_NUM(buff, info->num); -+ -+ if (info->full_fifo_mode == 1) { -+ CFG_PARAM_SET_INIT_CASE(buff, 0x1); -+ CFG_PARAM_SET_LOC(buff, 0); -+ } else { -+ CFG_PARAM_SET_INIT_CASE(buff, 0x0); -+ CFG_PARAM_SET_LOC(buff, h2c_info_addr - rsvd_pg_addr); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+malloc_cfg_param_buf_88xx(struct halmac_adapter *adapter, u8 full_fifo) -+{ -+ struct halmac_cfg_param_info *info = &adapter->cfg_param_info; -+ struct halmac_pltfm_cfg_info *pltfm_info = &adapter->pltfm_info; -+ -+ if (info->buf) -+ return HALMAC_RET_SUCCESS; -+ -+ if (full_fifo == 1) -+ info->buf_size = pltfm_info->malloc_size; -+ else -+ info->buf_size = CFG_PARAM_RSVDPG_SIZE; -+ -+ if (info->buf_size > pltfm_info->rsvd_pg_size) -+ info->buf_size = pltfm_info->rsvd_pg_size; -+ -+ info->buf = smart_malloc_88xx(adapter, info->buf_size, &info->buf_size); -+ if (info->buf) { -+ PLTFM_MEMSET(info->buf, 0x00, info->buf_size); -+ info->full_fifo_mode = full_fifo; -+ info->buf_wptr = info->buf; -+ info->num = 0; -+ info->avl_buf_size = info->buf_size; -+ info->value_accum = 0; -+ info->offset_accum = 0; -+ } else { -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * update_packet_88xx() - send specific packet to FW -+ * @adapter : the adapter of halmac -+ * @pkt_id : packet id, to know the purpose of this packet -+ * @pkt : packet -+ * @size : packet size -+ * -+ * Note : TX_DESC is not included in the pkt -+ * -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+update_packet_88xx(struct halmac_adapter *adapter, enum halmac_packet_id pkt_id, -+ u8 *pkt, u32 size) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status = -+ &adapter->halmac_state.update_pkt_state.proc_status; -+ u8 *used_page = &adapter->halmac_state.update_pkt_state.used_page; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (adapter->fw_ver.h2c_version < 4) -+ return HALMAC_RET_FW_NO_SUPPORT; -+ -+ if (size > UPDATE_PKT_RSVDPG_SIZE) -+ return HALMAC_RET_RSVD_PG_OVERFLOW_FAIL; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_TRACE("[TRACE]Wait event(upd)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ status = send_h2c_update_packet_88xx(adapter, pkt_id, pkt, size); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ PLTFM_MSG_ERR("[ERR]pkt id : %X!!\n", pkt_id); -+ return status; -+ } -+ -+ *used_page = (u8)get_update_packet_page_size(adapter, size); -+ -+ if (packet_in_nlo_88xx(adapter, pkt_id)) { -+ *proc_status = HALMAC_CMD_PROCESS_DONE; -+ adapter->nlo_flag = 1; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+send_h2c_update_packet_88xx(struct halmac_adapter *adapter, -+ enum halmac_packet_id pkt_id, u8 *pkt, u32 size) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ u16 pg_addr = adapter->txff_alloc.rsvd_h2c_info_addr; -+ u16 pg_offset; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_packet_id real_pkt_id; -+ -+ status = dl_rsvd_page_88xx(adapter, pg_addr, pkt, size); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dl rsvd pg!!\n"); -+ return status; -+ } -+ -+ real_pkt_id = get_real_pkt_id_88xx(adapter, pkt_id); -+ pg_offset = pg_addr - adapter->txff_alloc.rsvd_boundary; -+ UPDATE_PKT_SET_SIZE(h2c_buf, size + adapter->hw_cfg_info.txdesc_size); -+ UPDATE_PKT_SET_ID(h2c_buf, real_pkt_id); -+ UPDATE_PKT_SET_LOC(h2c_buf, pg_offset); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_UPDATE_PKT; -+ hdr_info.content_size = 4; -+ if (packet_in_nlo_88xx(adapter, pkt_id)) -+ hdr_info.ack = 0; -+ else -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ adapter->halmac_state.update_pkt_state.seq_num = seq_num; -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ reset_ofld_feature_88xx(adapter, HALMAC_FEATURE_UPDATE_PACKET); -+ return status; -+ } -+ -+ return status; -+} -+ -+enum halmac_ret_status -+send_scan_packet_88xx(struct halmac_adapter *adapter, u8 index, -+ u8 *pkt, u32 size) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status = -+ &adapter->halmac_state.scan_pkt_state.proc_status; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (adapter->fw_ver.h2c_version < 13) -+ return HALMAC_RET_FW_NO_SUPPORT; -+ -+ if (size > UPDATE_PKT_RSVDPG_SIZE) -+ return HALMAC_RET_RSVD_PG_OVERFLOW_FAIL; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_TRACE("[TRACE]Wait event(send_scan)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ status = send_h2c_send_scan_packet_88xx(adapter, index, pkt, size); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+send_h2c_send_scan_packet_88xx(struct halmac_adapter *adapter, -+ u8 index, u8 *pkt, u32 size) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ u16 pg_addr = adapter->txff_alloc.rsvd_h2c_info_addr; -+ u16 pg_offset; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ status = dl_rsvd_page_88xx(adapter, pg_addr, pkt, size); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dl rsvd pg!!\n"); -+ return status; -+ } -+ -+ pg_offset = pg_addr - adapter->txff_alloc.rsvd_boundary; -+ SEND_SCAN_PKT_SET_SIZE(h2c_buf, size + -+ adapter->hw_cfg_info.txdesc_size); -+ SEND_SCAN_PKT_SET_INDEX(h2c_buf, index); -+ SEND_SCAN_PKT_SET_LOC(h2c_buf, pg_offset); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_SEND_SCAN_PKT; -+ hdr_info.content_size = 8; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ adapter->halmac_state.scan_pkt_state.seq_num = seq_num; -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ reset_ofld_feature_88xx(adapter, -+ HALMAC_FEATURE_SEND_SCAN_PACKET); -+ return status; -+ } -+ -+ return status; -+} -+ -+enum halmac_ret_status -+drop_scan_packet_88xx(struct halmac_adapter *adapter, -+ struct halmac_drop_pkt_option *option) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status = -+ &adapter->halmac_state.drop_pkt_state.proc_status; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (adapter->fw_ver.h2c_version < 13) -+ return HALMAC_RET_FW_NO_SUPPORT; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_TRACE("[TRACE]Wait event(drop_scan)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ status = send_h2c_drop_scan_packet_88xx(adapter, option); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+send_h2c_drop_scan_packet_88xx(struct halmac_adapter *adapter, -+ struct halmac_drop_pkt_option *option) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s\n", __func__); -+ -+ DROP_SCAN_PKT_SET_DROP_ALL(h2c_buf, option->drop_all); -+ DROP_SCAN_PKT_SET_DROP_SINGLE(h2c_buf, option->drop_single); -+ DROP_SCAN_PKT_SET_DROP_IDX(h2c_buf, option->drop_index); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_DROP_SCAN_PKT; -+ hdr_info.content_size = 8; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ adapter->halmac_state.drop_pkt_state.seq_num = seq_num; -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ reset_ofld_feature_88xx(adapter, -+ HALMAC_FEATURE_DROP_SCAN_PACKET); -+ return status; -+ } -+ -+ return status; -+} -+ -+enum halmac_ret_status -+bcn_ie_filter_88xx(struct halmac_adapter *adapter, -+ struct halmac_bcn_ie_info *info) -+{ -+ return HALMAC_RET_NOT_SUPPORT; -+} -+ -+enum halmac_ret_status -+update_datapack_88xx(struct halmac_adapter *adapter, -+ enum halmac_data_type data_type, -+ struct halmac_phy_parameter_info *info) -+{ -+ return HALMAC_RET_NOT_SUPPORT; -+} -+ -+enum halmac_ret_status -+run_datapack_88xx(struct halmac_adapter *adapter, -+ enum halmac_data_type data_type) -+{ -+ return HALMAC_RET_NOT_SUPPORT; -+} -+ -+enum halmac_ret_status -+send_bt_coex_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size, u8 ack) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ status = send_bt_coex_cmd_88xx(adapter, buf, size, ack); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]bt coex cmd!!\n"); -+ return status; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+send_bt_coex_cmd_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size, -+ u8 ack) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ PLTFM_MEMCPY(h2c_buf + 8, buf, size); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_BT_COEX; -+ hdr_info.content_size = (u16)size; -+ hdr_info.ack = ack; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ return status; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * dump_fifo_88xx() - dump fifo data -+ * @adapter : the adapter of halmac -+ * @sel : FIFO selection -+ * @start_addr : start address of selected FIFO -+ * @size : dump size of selected FIFO -+ * @data : FIFO data -+ * -+ * Note : before dump fifo, user need to call halmac_get_fifo_size to -+ * get fifo size. Then input this size to halmac_dump_fifo. -+ * -+ * Author : Ivan Lin/KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+dump_fifo_88xx(struct halmac_adapter *adapter, enum hal_fifo_sel sel, -+ u32 start_addr, u32 size, u8 *data) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ u8 tmp8; -+ u8 enable; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (sel == HAL_FIFO_SEL_TX && -+ (start_addr + size) > adapter->hw_cfg_info.tx_fifo_size) { -+ PLTFM_MSG_ERR("[ERR]size overflow!!\n"); -+ return HALMAC_RET_DUMP_FIFOSIZE_INCORRECT; -+ } -+ -+ if (sel == HAL_FIFO_SEL_RX && -+ (start_addr + size) > adapter->hw_cfg_info.rx_fifo_size) { -+ PLTFM_MSG_ERR("[ERR]size overflow!!\n"); -+ return HALMAC_RET_DUMP_FIFOSIZE_INCORRECT; -+ } -+ -+ if ((size & (4 - 1)) != 0) { -+ PLTFM_MSG_ERR("[ERR]not 4byte alignment!!\n"); -+ return HALMAC_RET_DUMP_FIFOSIZE_INCORRECT; -+ } -+ -+ if (!data) -+ return HALMAC_RET_NULL_POINTER; -+ -+ tmp8 = HALMAC_REG_R8(REG_RCR + 2); -+ enable = 0; -+ status = api->halmac_set_hw_value(adapter, HALMAC_HW_RX_CLK_GATE, -+ &enable); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = read_buf_88xx(adapter, start_addr, size, sel, data); -+ -+ HALMAC_REG_W8(REG_RCR + 2, tmp8); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]read buf!!\n"); -+ return status; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+read_buf_88xx(struct halmac_adapter *adapter, u32 offset, u32 size, -+ enum hal_fifo_sel sel, u8 *data) -+{ -+ u32 start_pg; -+ u32 value32; -+ u32 i; -+ u32 residue; -+ u32 cnt = 0; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (sel == HAL_FIFO_SEL_RSVD_PAGE) -+ offset += (adapter->txff_alloc.rsvd_boundary << -+ TX_PAGE_SIZE_SHIFT_88XX); -+ -+ start_pg = offset >> 12; -+ residue = offset & (4096 - 1); -+ -+ if (sel == HAL_FIFO_SEL_TX || sel == HAL_FIFO_SEL_RSVD_PAGE) -+ start_pg += 0x780; -+ else if (sel == HAL_FIFO_SEL_RX) -+ start_pg += 0x700; -+ else if (sel == HAL_FIFO_SEL_REPORT) -+ start_pg += 0x660; -+ else if (sel == HAL_FIFO_SEL_LLT) -+ start_pg += 0x650; -+ else if (sel == HAL_FIFO_SEL_RXBUF_FW) -+ start_pg += 0x680; -+ else -+ return HALMAC_RET_NOT_SUPPORT; -+ -+ value32 = HALMAC_REG_R16(REG_PKTBUF_DBG_CTRL) & 0xF000; -+ -+ do { -+ HALMAC_REG_W16(REG_PKTBUF_DBG_CTRL, (u16)(start_pg | value32)); -+ -+ for (i = 0x8000 + residue; i <= 0x8FFF; i += 4) { -+ *(u32 *)(data + cnt) = HALMAC_REG_R32(i); -+ *(u32 *)(data + cnt) = -+ rtk_le32_to_cpu(*(u32 *)(data + cnt)); -+ cnt += 4; -+ if (size == cnt) -+ goto HALMAC_BUF_READ_OK; -+ } -+ -+ residue = 0; -+ start_pg++; -+ } while (1); -+ -+HALMAC_BUF_READ_OK: -+ HALMAC_REG_W16(REG_PKTBUF_DBG_CTRL, (u16)value32); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * get_fifo_size_88xx() - get fifo size -+ * @adapter : the adapter of halmac -+ * @sel : FIFO selection -+ * Author : Ivan Lin/KaiYuan Chang -+ * Return : u32 -+ * More details of status code can be found in prototype document -+ */ -+u32 -+get_fifo_size_88xx(struct halmac_adapter *adapter, enum hal_fifo_sel sel) -+{ -+ u32 size = 0; -+ -+ if (sel == HAL_FIFO_SEL_TX) -+ size = adapter->hw_cfg_info.tx_fifo_size; -+ else if (sel == HAL_FIFO_SEL_RX) -+ size = adapter->hw_cfg_info.rx_fifo_size; -+ else if (sel == HAL_FIFO_SEL_RSVD_PAGE) -+ size = adapter->hw_cfg_info.tx_fifo_size - -+ (adapter->txff_alloc.rsvd_boundary << -+ TX_PAGE_SIZE_SHIFT_88XX); -+ else if (sel == HAL_FIFO_SEL_REPORT) -+ size = 65536; -+ else if (sel == HAL_FIFO_SEL_LLT) -+ size = 65536; -+ else if (sel == HAL_FIFO_SEL_RXBUF_FW) -+ size = RX_BUF_FW_88XX; -+ -+ return size; -+} -+ -+enum halmac_ret_status -+set_h2c_header_88xx(struct halmac_adapter *adapter, u8 *hdr, u16 *seq, u8 ack) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s!!\n", __func__); -+ -+ H2C_CMD_HEADER_SET_CATEGORY(hdr, 0x00); -+ H2C_CMD_HEADER_SET_TOTAL_LEN(hdr, 16); -+ -+ PLTFM_MUTEX_LOCK(&adapter->h2c_seq_mutex); -+ H2C_CMD_HEADER_SET_SEQ_NUM(hdr, adapter->h2c_info.seq_num); -+ *seq = adapter->h2c_info.seq_num; -+ (adapter->h2c_info.seq_num)++; -+ PLTFM_MUTEX_UNLOCK(&adapter->h2c_seq_mutex); -+ -+ if (ack == 1) -+ H2C_CMD_HEADER_SET_ACK(hdr, 1); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * add_ch_info_88xx() -add channel information -+ * @adapter : the adapter of halmac -+ * @info : channel information -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+add_ch_info_88xx(struct halmac_adapter *adapter, struct halmac_ch_info *info) -+{ -+ struct halmac_ch_sw_info *ch_sw_info = &adapter->ch_sw_info; -+ enum halmac_cmd_construct_state state; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (adapter->halmac_state.dlfw_state != HALMAC_GEN_INFO_SENT) { -+ PLTFM_MSG_ERR("[ERR]gen info\n"); -+ return HALMAC_RET_GEN_INFO_NOT_SENT; -+ } -+ -+ state = scan_cmd_cnstr_state_88xx(adapter); -+ if (state != HALMAC_CMD_CNSTR_BUF_CLR && -+ state != HALMAC_CMD_CNSTR_CNSTR) { -+ PLTFM_MSG_WARN("[WARN]cmd state (scan)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ if (!ch_sw_info->buf) { -+ ch_sw_info->buf = (u8 *)PLTFM_MALLOC(SCAN_INFO_RSVDPG_SIZE); -+ if (!ch_sw_info->buf) -+ return HALMAC_RET_NULL_POINTER; -+ ch_sw_info->buf_wptr = ch_sw_info->buf; -+ ch_sw_info->buf_size = SCAN_INFO_RSVDPG_SIZE; -+ ch_sw_info->avl_buf_size = SCAN_INFO_RSVDPG_SIZE; -+ ch_sw_info->total_size = 0; -+ ch_sw_info->extra_info_en = 0; -+ ch_sw_info->ch_num = 0; -+ } -+ -+ if (ch_sw_info->extra_info_en == 1) { -+ PLTFM_MSG_ERR("[ERR]extra info = 1!!\n"); -+ return HALMAC_RET_CH_SW_SEQ_WRONG; -+ } -+ -+ if (ch_sw_info->avl_buf_size < 4) { -+ PLTFM_MSG_ERR("[ERR]buf full!!\n"); -+ return HALMAC_RET_CH_SW_NO_BUF; -+ } -+ -+ if (cnv_scan_state_88xx(adapter, HALMAC_CMD_CNSTR_CNSTR) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ CH_INFO_SET_CH(ch_sw_info->buf_wptr, info->channel); -+ CH_INFO_SET_PRI_CH_IDX(ch_sw_info->buf_wptr, info->pri_ch_idx); -+ CH_INFO_SET_BW(ch_sw_info->buf_wptr, info->bw); -+ CH_INFO_SET_TIMEOUT(ch_sw_info->buf_wptr, info->timeout); -+ CH_INFO_SET_ACTION_ID(ch_sw_info->buf_wptr, info->action_id); -+ CH_INFO_SET_EXTRA_INFO(ch_sw_info->buf_wptr, info->extra_info); -+ -+ ch_sw_info->avl_buf_size = ch_sw_info->avl_buf_size - 4; -+ ch_sw_info->total_size = ch_sw_info->total_size + 4; -+ ch_sw_info->ch_num++; -+ ch_sw_info->extra_info_en = info->extra_info; -+ ch_sw_info->buf_wptr = ch_sw_info->buf_wptr + 4; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_cmd_construct_state -+scan_cmd_cnstr_state_88xx(struct halmac_adapter *adapter) -+{ -+ return adapter->halmac_state.scan_state.cmd_cnstr_state; -+} -+ -+static enum halmac_ret_status -+cnv_scan_state_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_construct_state dest_state) -+{ -+ enum halmac_cmd_construct_state *state; -+ -+ state = &adapter->halmac_state.scan_state.cmd_cnstr_state; -+ -+ if (dest_state == HALMAC_CMD_CNSTR_IDLE) { -+ if ((*state == HALMAC_CMD_CNSTR_BUF_CLR) || -+ (*state == HALMAC_CMD_CNSTR_CNSTR)) -+ return HALMAC_RET_ERROR_STATE; -+ } else if (dest_state == HALMAC_CMD_CNSTR_BUF_CLR) { -+ if (*state == HALMAC_CMD_CNSTR_H2C_SENT) -+ return HALMAC_RET_ERROR_STATE; -+ } else if (dest_state == HALMAC_CMD_CNSTR_CNSTR) { -+ if ((*state == HALMAC_CMD_CNSTR_IDLE) || -+ (*state == HALMAC_CMD_CNSTR_H2C_SENT)) -+ return HALMAC_RET_ERROR_STATE; -+ } else if (dest_state == HALMAC_CMD_CNSTR_H2C_SENT) { -+ if ((*state != HALMAC_CMD_CNSTR_CNSTR) && -+ (*state != HALMAC_CMD_CNSTR_BUF_CLR)) -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ *state = dest_state; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * add_extra_ch_info_88xx() -add extra channel information -+ * @adapter : the adapter of halmac -+ * @info : extra channel information -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+add_extra_ch_info_88xx(struct halmac_adapter *adapter, -+ struct halmac_ch_extra_info *info) -+{ -+ struct halmac_ch_sw_info *ch_sw_info = &adapter->ch_sw_info; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (!ch_sw_info->buf) { -+ PLTFM_MSG_ERR("[ERR]buf = null!!\n"); -+ return HALMAC_RET_CH_SW_SEQ_WRONG; -+ } -+ -+ if (ch_sw_info->extra_info_en == 0) { -+ PLTFM_MSG_ERR("[ERR]extra info = 0!!\n"); -+ return HALMAC_RET_CH_SW_SEQ_WRONG; -+ } -+ -+ if (ch_sw_info->avl_buf_size < (u32)(info->extra_info_size + 2)) { -+ PLTFM_MSG_ERR("[ERR]no available buffer!!\n"); -+ return HALMAC_RET_CH_SW_NO_BUF; -+ } -+ -+ if (scan_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_CNSTR) { -+ PLTFM_MSG_WARN("[WARN]cmd state (ex scan)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ if (cnv_scan_state_88xx(adapter, HALMAC_CMD_CNSTR_CNSTR) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ CH_EXTRA_INFO_SET_ID(ch_sw_info->buf_wptr, info->extra_action_id); -+ CH_EXTRA_INFO_SET_INFO(ch_sw_info->buf_wptr, info->extra_info); -+ CH_EXTRA_INFO_SET_SIZE(ch_sw_info->buf_wptr, info->extra_info_size); -+ PLTFM_MEMCPY(ch_sw_info->buf_wptr + 2, info->extra_info_data, -+ info->extra_info_size); -+ -+ ch_sw_info->avl_buf_size -= (2 + info->extra_info_size); -+ ch_sw_info->total_size += (2 + info->extra_info_size); -+ ch_sw_info->extra_info_en = info->extra_info; -+ ch_sw_info->buf_wptr += (2 + info->extra_info_size); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * ctrl_ch_switch_88xx() -send channel switch cmd -+ * @adapter : the adapter of halmac -+ * @opt : channel switch config -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+ctrl_ch_switch_88xx(struct halmac_adapter *adapter, -+ struct halmac_ch_switch_option *opt) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_construct_state state; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.scan_state.proc_status; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (adapter->fw_ver.h2c_version < 4) -+ return HALMAC_RET_FW_NO_SUPPORT; -+ -+ if (adapter->ch_sw_info.total_size + -+ (adapter->halmac_state.update_pkt_state.used_page << -+ TX_PAGE_SIZE_SHIFT_88XX) > -+ (u32)adapter->txff_alloc.rsvd_pg_num << TX_PAGE_SIZE_SHIFT_88XX) -+ return HALMAC_RET_RSVD_PG_OVERFLOW_FAIL; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (opt->switch_en == 0) -+ *proc_status = HALMAC_CMD_PROCESS_IDLE; -+ -+ if ((*proc_status == HALMAC_CMD_PROCESS_SENDING) || -+ (*proc_status == HALMAC_CMD_PROCESS_RCVD)) { -+ PLTFM_MSG_TRACE("[TRACE]Wait event(scan)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ state = scan_cmd_cnstr_state_88xx(adapter); -+ if (opt->switch_en == 1) { -+ if (state != HALMAC_CMD_CNSTR_CNSTR) { -+ PLTFM_MSG_ERR("[ERR]state(en = 1)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ } else { -+ if (state != HALMAC_CMD_CNSTR_BUF_CLR) { -+ PLTFM_MSG_ERR("[ERR]state(en = 0)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ } -+ -+ status = proc_ctrl_ch_switch_88xx(adapter, opt); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]ctrl ch sw!!\n"); -+ return status; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+proc_ctrl_ch_switch_88xx(struct halmac_adapter *adapter, -+ struct halmac_ch_switch_option *opt) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ u16 pg_addr = adapter->txff_alloc.rsvd_h2c_info_addr; -+ struct halmac_h2c_header_info hdr_info; -+ struct halmac_scan_rpt_info *scan_rpt_info = &adapter->scan_rpt_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.scan_state.proc_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (adapter->halmac_state.update_pkt_state.used_page > 0 && -+ opt->nlo_en == 1 && adapter->nlo_flag != 1) -+ PLTFM_MSG_WARN("[WARN]probe req is NOT nlo pkt!!\n"); -+ -+ if (cnv_scan_state_88xx(adapter, HALMAC_CMD_CNSTR_H2C_SENT) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ if (opt->switch_en != 0) { -+ pg_addr += adapter->halmac_state.update_pkt_state.used_page; -+ status = dl_rsvd_page_88xx(adapter, pg_addr, -+ adapter->ch_sw_info.buf, -+ adapter->ch_sw_info.total_size); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dl rsvd pg!!\n"); -+ return status; -+ } -+ adapter->halmac_state.update_pkt_state.used_page = 0; -+ } -+ -+ CH_SWITCH_SET_START(h2c_buf, opt->switch_en); -+ CH_SWITCH_SET_CH_NUM(h2c_buf, adapter->ch_sw_info.ch_num); -+ CH_SWITCH_SET_INFO_LOC(h2c_buf, -+ pg_addr - adapter->txff_alloc.rsvd_boundary); -+ CH_SWITCH_SET_DEST_CH_EN(h2c_buf, opt->dest_ch_en); -+ CH_SWITCH_SET_DEST_CH(h2c_buf, opt->dest_ch); -+ CH_SWITCH_SET_PRI_CH_IDX(h2c_buf, opt->dest_pri_ch_idx); -+ CH_SWITCH_SET_ABSOLUTE_TIME(h2c_buf, opt->absolute_time_en); -+ CH_SWITCH_SET_TSF_LOW(h2c_buf, opt->tsf_low); -+ CH_SWITCH_SET_PERIODIC_OPT(h2c_buf, opt->periodic_option); -+ CH_SWITCH_SET_NORMAL_CYCLE(h2c_buf, opt->normal_cycle); -+ CH_SWITCH_SET_NORMAL_PERIOD(h2c_buf, opt->normal_period); -+ CH_SWITCH_SET_SLOW_PERIOD(h2c_buf, opt->phase_2_period); -+ CH_SWITCH_SET_NORMAL_PERIOD_SEL(h2c_buf, opt->normal_period_sel); -+ CH_SWITCH_SET_SLOW_PERIOD_SEL(h2c_buf, opt->phase_2_period_sel); -+ CH_SWITCH_SET_SCAN_MODE(h2c_buf, opt->scan_mode_en); -+ CH_SWITCH_SET_INFO_SIZE(h2c_buf, adapter->ch_sw_info.total_size); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_CH_SWITCH; -+ hdr_info.content_size = 20; -+ if (opt->nlo_en == 1) -+ hdr_info.ack = 0; -+ else -+ hdr_info.ack = 1; -+ -+ if (opt->scan_mode_en == 1) { -+ adapter->ch_sw_info.scan_mode = 1; -+ if (!scan_rpt_info->buf) { -+ scan_rpt_info->buf = -+ (u8 *)PLTFM_MALLOC(SCAN_INFO_RSVDPG_SIZE); -+ if (!scan_rpt_info->buf) -+ return HALMAC_RET_NULL_POINTER; -+ } else { -+ PLTFM_MEMSET(scan_rpt_info->buf, 0, -+ SCAN_INFO_RSVDPG_SIZE); -+ } -+ scan_rpt_info->buf_wptr = scan_rpt_info->buf; -+ scan_rpt_info->buf_size = SCAN_INFO_RSVDPG_SIZE; -+ scan_rpt_info->avl_buf_size = SCAN_INFO_RSVDPG_SIZE; -+ scan_rpt_info->total_size = 0; -+ scan_rpt_info->ack_tsf_high = 0; -+ scan_rpt_info->ack_tsf_low = 0; -+ scan_rpt_info->rpt_tsf_high = 0; -+ scan_rpt_info->rpt_tsf_low = 0; -+ } else { -+ adapter->ch_sw_info.scan_mode = 0; -+ if (!scan_rpt_info->buf) -+ PLTFM_FREE(scan_rpt_info->buf, scan_rpt_info->buf_size); -+ scan_rpt_info->buf_wptr = NULL; -+ scan_rpt_info->buf_size = 0; -+ scan_rpt_info->avl_buf_size = 0; -+ scan_rpt_info->total_size = 0; -+ } -+ -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ adapter->halmac_state.scan_state.seq_num = seq_num; -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ reset_ofld_feature_88xx(adapter, HALMAC_FEATURE_CHANNEL_SWITCH); -+ } -+ PLTFM_FREE(adapter->ch_sw_info.buf, adapter->ch_sw_info.buf_size); -+ adapter->ch_sw_info.buf = NULL; -+ adapter->ch_sw_info.buf_wptr = NULL; -+ adapter->ch_sw_info.extra_info_en = 0; -+ adapter->ch_sw_info.buf_size = 0; -+ adapter->ch_sw_info.avl_buf_size = 0; -+ adapter->ch_sw_info.total_size = 0; -+ adapter->ch_sw_info.ch_num = 0; -+ -+ if (cnv_scan_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ adapter->nlo_flag = 0; -+ -+ return status; -+} -+ -+/** -+ * clear_ch_info_88xx() -clear channel information -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+clear_ch_info_88xx(struct halmac_adapter *adapter) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (scan_cmd_cnstr_state_88xx(adapter) == HALMAC_CMD_CNSTR_H2C_SENT) { -+ PLTFM_MSG_WARN("[WARN]state(clear)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ if (cnv_scan_state_88xx(adapter, HALMAC_CMD_CNSTR_BUF_CLR) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_FREE(adapter->ch_sw_info.buf, adapter->ch_sw_info.buf_size); -+ adapter->ch_sw_info.buf = NULL; -+ adapter->ch_sw_info.buf_wptr = NULL; -+ adapter->ch_sw_info.extra_info_en = 0; -+ adapter->ch_sw_info.buf_size = 0; -+ adapter->ch_sw_info.avl_buf_size = 0; -+ adapter->ch_sw_info.total_size = 0; -+ adapter->ch_sw_info.ch_num = 0; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * chk_txdesc_88xx() -check if the tx packet format is incorrect -+ * @adapter : the adapter of halmac -+ * @buf : tx Packet buffer, tx desc is included -+ * @size : tx packet size -+ * Author : KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+chk_txdesc_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u32 mac_clk = 0; -+ u8 value8; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (GET_TX_DESC_BMC(buf) == 1 && GET_TX_DESC_AGG_EN(buf) == 1) -+ PLTFM_MSG_ERR("[ERR]txdesc - agg + bmc\n"); -+ -+ if (size < (GET_TX_DESC_TXPKTSIZE(buf) + -+ adapter->hw_cfg_info.txdesc_size + -+ (GET_TX_DESC_PKT_OFFSET(buf) << 3))) { -+ PLTFM_MSG_ERR("[ERR]txdesc - total size\n"); -+ status = HALMAC_RET_TXDESC_SET_FAIL; -+ } -+ -+ if (wlhdr_valid_88xx(adapter, buf) != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]wlhdr\n"); -+ status = HALMAC_RET_WLHDR_FAIL; -+ } -+ -+ if (GET_TX_DESC_AMSDU_PAD_EN(buf) != 0) { -+ PLTFM_MSG_ERR("[ERR]txdesc - amsdu_pad\n"); -+ status = HALMAC_RET_TXDESC_SET_FAIL; -+ } -+ -+ if (GET_TX_DESC_USE_MAX_TIME_EN(buf) == 1) { -+ value8 = (u8)GET_TX_DESC_AMPDU_MAX_TIME(buf); -+ if (value8 > HALMAC_REG_R8(REG_AMPDU_MAX_TIME_V1)) { -+ PLTFM_MSG_ERR("[ERR]txdesc - ampdu_max_time\n"); -+ status = HALMAC_RET_TXDESC_SET_FAIL; -+ } -+ } -+ -+ switch (BIT_GET_MAC_CLK_SEL(HALMAC_REG_R32(REG_AFE_CTRL1))) { -+ case 0x0: -+ mac_clk = 80; -+ break; -+ case 0x1: -+ mac_clk = 40; -+ break; -+ case 0x2: -+ mac_clk = 20; -+ break; -+ case 0x3: -+ mac_clk = 10; -+ break; -+ } -+ -+ PLTFM_MSG_ALWAYS("MAC clock : 0x%XM\n", mac_clk); -+ PLTFM_MSG_ALWAYS("mac agg en : 0x%X\n", GET_TX_DESC_AGG_EN(buf)); -+ PLTFM_MSG_ALWAYS("mac agg num : 0x%X\n", GET_TX_DESC_MAX_AGG_NUM(buf)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+wlhdr_valid_88xx(struct halmac_adapter *adapter, u8 *buf) -+{ -+ u32 txdesc_size = adapter->hw_cfg_info.txdesc_size + -+ GET_TX_DESC_PKT_OFFSET(buf); -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct wlhdr_frame_ctrl *wlhdr; -+ -+ wlhdr = (struct wlhdr_frame_ctrl *)(buf + txdesc_size); -+ -+ if (wlhdr->protocol != WLHDR_PROT_VER) { -+ PLTFM_MSG_ERR("[ERR]prot ver!!\n"); -+ return HALMAC_RET_WLHDR_FAIL; -+ } -+ -+ switch (wlhdr->type) { -+ case WLHDR_TYPE_MGMT: -+ if (wlhdr_mgmt_valid_88xx(adapter, wlhdr) != 1) -+ status = HALMAC_RET_WLHDR_FAIL; -+ break; -+ case WLHDR_TYPE_CTRL: -+ if (wlhdr_ctrl_valid_88xx(adapter, wlhdr) != 1) -+ status = HALMAC_RET_WLHDR_FAIL; -+ break; -+ case WLHDR_TYPE_DATA: -+ if (wlhdr_data_valid_88xx(adapter, wlhdr) != 1) -+ status = HALMAC_RET_WLHDR_FAIL; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]undefined type!!\n"); -+ status = HALMAC_RET_WLHDR_FAIL; -+ break; -+ } -+ -+ return status; -+} -+ -+static u8 -+wlhdr_mgmt_valid_88xx(struct halmac_adapter *adapter, -+ struct wlhdr_frame_ctrl *wlhdr) -+{ -+ u8 state; -+ -+ switch (wlhdr->sub_type) { -+ case WLHDR_SUB_TYPE_ASSOC_REQ: -+ case WLHDR_SUB_TYPE_ASSOC_RSPNS: -+ case WLHDR_SUB_TYPE_REASSOC_REQ: -+ case WLHDR_SUB_TYPE_REASSOC_RSPNS: -+ case WLHDR_SUB_TYPE_PROBE_REQ: -+ case WLHDR_SUB_TYPE_PROBE_RSPNS: -+ case WLHDR_SUB_TYPE_BCN: -+ case WLHDR_SUB_TYPE_DISASSOC: -+ case WLHDR_SUB_TYPE_AUTH: -+ case WLHDR_SUB_TYPE_DEAUTH: -+ case WLHDR_SUB_TYPE_ACTION: -+ case WLHDR_SUB_TYPE_ACTION_NOACK: -+ state = 1; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]mgmt invalid!!\n"); -+ state = 0; -+ break; -+ } -+ -+ return state; -+} -+ -+static u8 -+wlhdr_ctrl_valid_88xx(struct halmac_adapter *adapter, -+ struct wlhdr_frame_ctrl *wlhdr) -+{ -+ u8 state; -+ -+ switch (wlhdr->sub_type) { -+ case WLHDR_SUB_TYPE_BF_RPT_POLL: -+ case WLHDR_SUB_TYPE_NDPA: -+ state = 1; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]ctrl invalid!!\n"); -+ state = 0; -+ break; -+ } -+ -+ return state; -+} -+ -+static u8 -+wlhdr_data_valid_88xx(struct halmac_adapter *adapter, -+ struct wlhdr_frame_ctrl *wlhdr) -+{ -+ u8 state; -+ -+ switch (wlhdr->sub_type) { -+ case WLHDR_SUB_TYPE_DATA: -+ case WLHDR_SUB_TYPE_NULL: -+ case WLHDR_SUB_TYPE_QOS_DATA: -+ case WLHDR_SUB_TYPE_QOS_NULL: -+ state = 1; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]data invalid!!\n"); -+ state = 0; -+ break; -+ } -+ -+ return state; -+} -+ -+/** -+ * get_version_88xx() - get HALMAC version -+ * @ver : return version of major, prototype and minor information -+ * Author : KaiYuan Chang / Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_version_88xx(struct halmac_adapter *adapter, struct halmac_ver *ver) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ ver->major_ver = (u8)HALMAC_MAJOR_VER; -+ ver->prototype_ver = (u8)HALMAC_PROTOTYPE_VER; -+ ver->minor_ver = (u8)HALMAC_MINOR_VER; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+p2pps_88xx(struct halmac_adapter *adapter, struct halmac_p2pps *info) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (adapter->fw_ver.h2c_version < 6) -+ return HALMAC_RET_FW_NO_SUPPORT; -+ -+ status = proc_p2pps_88xx(adapter, info); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]p2pps!!\n"); -+ return status; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+proc_p2pps_88xx(struct halmac_adapter *adapter, struct halmac_p2pps *info) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ P2PPS_SET_OFFLOAD_EN(h2c_buf, info->offload_en); -+ P2PPS_SET_ROLE(h2c_buf, info->role); -+ P2PPS_SET_CTWINDOW_EN(h2c_buf, info->ctwindow_en); -+ P2PPS_SET_NOA_EN(h2c_buf, info->noa_en); -+ P2PPS_SET_NOA_SEL(h2c_buf, info->noa_sel); -+ P2PPS_SET_ALLSTASLEEP(h2c_buf, info->all_sta_sleep); -+ P2PPS_SET_DISCOVERY(h2c_buf, info->discovery); -+ P2PPS_SET_DISABLE_CLOSERF(h2c_buf, info->disable_close_rf); -+ P2PPS_SET_P2P_PORT_ID(h2c_buf, info->p2p_port_id); -+ P2PPS_SET_P2P_GROUP(h2c_buf, info->p2p_group); -+ P2PPS_SET_P2P_MACID(h2c_buf, info->p2p_macid); -+ -+ P2PPS_SET_CTWINDOW_LENGTH(h2c_buf, info->ctwindow_length); -+ -+ P2PPS_SET_NOA_DURATION_PARA(h2c_buf, info->noa_duration_para); -+ P2PPS_SET_NOA_INTERVAL_PARA(h2c_buf, info->noa_interval_para); -+ P2PPS_SET_NOA_START_TIME_PARA(h2c_buf, info->noa_start_time_para); -+ P2PPS_SET_NOA_COUNT_PARA(h2c_buf, info->noa_count_para); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_P2PPS; -+ hdr_info.content_size = 24; -+ hdr_info.ack = 0; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ -+ return status; -+} -+ -+/** -+ * query_status_88xx() -query the offload feature status -+ * @adapter : the adapter of halmac -+ * @feature_id : feature_id -+ * @proc_status : feature_status -+ * @data : data buffer -+ * @size : data size -+ * -+ * Note : -+ * If user wants to know the data size, user can allocate zero -+ * size buffer first. If this size less than the data size, halmac -+ * will return HALMAC_RET_BUFFER_TOO_SMALL. User need to -+ * re-allocate data buffer with correct data size. -+ * -+ * Author : Ivan Lin/KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+query_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_feature_id feature_id, -+ enum halmac_cmd_process_status *proc_status, u8 *data, -+ u32 *size) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (!proc_status) -+ return HALMAC_RET_NULL_POINTER; -+ -+ switch (feature_id) { -+ case HALMAC_FEATURE_CFG_PARA: -+ status = get_cfg_param_status_88xx(adapter, proc_status); -+ break; -+ case HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE: -+ status = get_dump_phy_efuse_status_88xx(adapter, proc_status, -+ data, size); -+ break; -+ case HALMAC_FEATURE_DUMP_LOGICAL_EFUSE: -+ status = get_dump_log_efuse_status_88xx(adapter, proc_status, -+ data, size); -+ break; -+ case HALMAC_FEATURE_DUMP_LOGICAL_EFUSE_MASK: -+ status = get_dump_log_efuse_mask_status_88xx(adapter, -+ proc_status, -+ data, size); -+ break; -+ case HALMAC_FEATURE_CHANNEL_SWITCH: -+ status = get_ch_switch_status_88xx(adapter, proc_status); -+ break; -+ case HALMAC_FEATURE_UPDATE_PACKET: -+ status = get_update_packet_status_88xx(adapter, proc_status); -+ break; -+ case HALMAC_FEATURE_SEND_SCAN_PACKET: -+ status = get_send_scan_packet_status_88xx(adapter, proc_status); -+ break; -+ case HALMAC_FEATURE_DROP_SCAN_PACKET: -+ status = get_drop_scan_packet_status_88xx(adapter, proc_status); -+ break; -+ case HALMAC_FEATURE_IQK: -+ status = get_iqk_status_88xx(adapter, proc_status); -+ break; -+ case HALMAC_FEATURE_POWER_TRACKING: -+ status = get_pwr_trk_status_88xx(adapter, proc_status); -+ break; -+ case HALMAC_FEATURE_PSD: -+ status = get_psd_status_88xx(adapter, proc_status, data, size); -+ break; -+ case HALMAC_FEATURE_FW_SNDING: -+ status = get_fw_snding_status_88xx(adapter, proc_status); -+ break; -+ case HALMAC_FEATURE_DPK: -+ status = get_dpk_status_88xx(adapter, proc_status, data, size); -+ break; -+ default: -+ return HALMAC_RET_INVALID_FEATURE_ID; -+ } -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+get_cfg_param_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status) -+{ -+ *proc_status = adapter->halmac_state.cfg_param_state.proc_status; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_ch_switch_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status) -+{ -+ *proc_status = adapter->halmac_state.scan_state.proc_status; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_update_packet_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status) -+{ -+ *proc_status = adapter->halmac_state.update_pkt_state.proc_status; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_send_scan_packet_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status) -+{ -+ *proc_status = adapter->halmac_state.scan_pkt_state.proc_status; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_drop_scan_packet_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status) -+{ -+ *proc_status = adapter->halmac_state.drop_pkt_state.proc_status; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_drv_rsvd_pg_num_88xx() -config reserved page number for driver -+ * @adapter : the adapter of halmac -+ * @pg_num : page number -+ * Author : KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_drv_rsvd_pg_num_88xx(struct halmac_adapter *adapter, -+ enum halmac_drv_rsvd_pg_num pg_num) -+{ -+ if (adapter->api_registry.cfg_drv_rsvd_pg_en == 0) -+ return HALMAC_RET_NOT_SUPPORT; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ PLTFM_MSG_TRACE("[TRACE]pg_num = %d\n", pg_num); -+ -+ switch (pg_num) { -+ case HALMAC_RSVD_PG_NUM8: -+ adapter->txff_alloc.rsvd_drv_pg_num = 8; -+ break; -+ case HALMAC_RSVD_PG_NUM16: -+ adapter->txff_alloc.rsvd_drv_pg_num = 16; -+ break; -+ case HALMAC_RSVD_PG_NUM24: -+ adapter->txff_alloc.rsvd_drv_pg_num = 24; -+ break; -+ case HALMAC_RSVD_PG_NUM32: -+ adapter->txff_alloc.rsvd_drv_pg_num = 32; -+ break; -+ case HALMAC_RSVD_PG_NUM64: -+ adapter->txff_alloc.rsvd_drv_pg_num = 64; -+ break; -+ case HALMAC_RSVD_PG_NUM128: -+ adapter->txff_alloc.rsvd_drv_pg_num = 128; -+ break; -+ case HALMAC_RSVD_PG_NUM256: -+ adapter->txff_alloc.rsvd_drv_pg_num = 256; -+ break; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * (debug API)h2c_lb_88xx() - send h2c loopback packet -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+h2c_lb_88xx(struct halmac_adapter *adapter) -+{ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+pwr_seq_parser_88xx(struct halmac_adapter *adapter, -+ struct halmac_wlan_pwr_cfg **cmd_seq) -+{ -+ u8 cut; -+ u8 intf; -+ u32 idx = 0; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_wlan_pwr_cfg *cmd; -+ -+ switch (adapter->chip_ver) { -+ case HALMAC_CHIP_VER_A_CUT: -+ cut = HALMAC_PWR_CUT_A_MSK; -+ break; -+ case HALMAC_CHIP_VER_B_CUT: -+ cut = HALMAC_PWR_CUT_B_MSK; -+ break; -+ case HALMAC_CHIP_VER_C_CUT: -+ cut = HALMAC_PWR_CUT_C_MSK; -+ break; -+ case HALMAC_CHIP_VER_D_CUT: -+ cut = HALMAC_PWR_CUT_D_MSK; -+ break; -+ case HALMAC_CHIP_VER_E_CUT: -+ cut = HALMAC_PWR_CUT_E_MSK; -+ break; -+ case HALMAC_CHIP_VER_F_CUT: -+ cut = HALMAC_PWR_CUT_F_MSK; -+ break; -+ case HALMAC_CHIP_VER_TEST: -+ cut = HALMAC_PWR_CUT_TESTCHIP_MSK; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]chip info!!\n"); -+ return HALMAC_RET_SWITCH_CASE_ERROR; -+ } -+ -+ switch (adapter->intf) { -+ case HALMAC_INTERFACE_PCIE: -+ case HALMAC_INTERFACE_AXI: -+ intf = HALMAC_PWR_INTF_PCI_MSK; -+ break; -+ case HALMAC_INTERFACE_USB: -+ intf = HALMAC_PWR_INTF_USB_MSK; -+ break; -+ case HALMAC_INTERFACE_SDIO: -+ intf = HALMAC_PWR_INTF_SDIO_MSK; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]interface!!\n"); -+ return HALMAC_RET_SWITCH_CASE_ERROR; -+ } -+ -+ do { -+ cmd = cmd_seq[idx]; -+ -+ if (!cmd) -+ break; -+ -+ status = pwr_sub_seq_parser_88xx(adapter, cut, intf, cmd); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]pwr sub seq!!\n"); -+ return status; -+ } -+ -+ idx++; -+ } while (1); -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+pwr_sub_seq_parser_88xx(struct halmac_adapter *adapter, u8 cut, u8 intf, -+ struct halmac_wlan_pwr_cfg *cmd) -+{ -+ u8 value; -+ u32 offset; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ do { -+ if ((cmd->interface_msk & intf) && (cmd->cut_msk & cut)) { -+ switch (cmd->cmd) { -+ case HALMAC_PWR_CMD_WRITE: -+ offset = cmd->offset; -+ -+ if (cmd->base == HALMAC_PWR_ADDR_SDIO) -+ offset |= SDIO_LOCAL_OFFSET; -+ -+ value = HALMAC_REG_R8(offset); -+ value = (u8)(value & (u8)(~(cmd->msk))); -+ value = (u8)(value | (cmd->value & cmd->msk)); -+ -+ HALMAC_REG_W8(offset, value); -+ break; -+ case HALMAC_PWR_CMD_POLLING: -+ if (pwr_cmd_polling_88xx(adapter, cmd) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_PWRSEQ_POLLING_FAIL; -+ break; -+ case HALMAC_PWR_CMD_DELAY: -+ if (cmd->value == HALMAC_PWR_DELAY_US) -+ PLTFM_DELAY_US(cmd->offset); -+ else -+ PLTFM_DELAY_US(1000 * cmd->offset); -+ break; -+ case HALMAC_PWR_CMD_READ: -+ break; -+ case HALMAC_PWR_CMD_END: -+ return HALMAC_RET_SUCCESS; -+ default: -+ return HALMAC_RET_PWRSEQ_CMD_INCORRECT; -+ } -+ } -+ cmd++; -+ } while (1); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+pwr_cmd_polling_88xx(struct halmac_adapter *adapter, -+ struct halmac_wlan_pwr_cfg *cmd) -+{ -+ u8 value; -+ u8 flg; -+ u8 poll_bit; -+ u32 offset; -+ u32 cnt; -+ static u32 stats; -+ enum halmac_interface intf; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ poll_bit = 0; -+ cnt = HALMAC_PWR_POLLING_CNT; -+ flg = 0; -+ intf = adapter->intf; -+ -+ if (cmd->base == HALMAC_PWR_ADDR_SDIO) -+ offset = cmd->offset | SDIO_LOCAL_OFFSET; -+ else -+ offset = cmd->offset; -+ -+ do { -+ cnt--; -+ value = HALMAC_REG_R8(offset); -+ value = (u8)(value & cmd->msk); -+ -+ if (value == (cmd->value & cmd->msk)) { -+ poll_bit = 1; -+ } else { -+ if (cnt == 0) { -+ if (intf == HALMAC_INTERFACE_PCIE && flg == 0) { -+ /* PCIE + USB package */ -+ /* power bit polling timeout issue */ -+ stats++; -+ PLTFM_MSG_WARN("[WARN]PCIE stats:%d\n", -+ stats); -+ value = HALMAC_REG_R8(REG_SYS_PW_CTRL); -+ value |= BIT(3); -+ HALMAC_REG_W8(REG_SYS_PW_CTRL, value); -+ value &= ~BIT(3); -+ HALMAC_REG_W8(REG_SYS_PW_CTRL, value); -+ poll_bit = 0; -+ cnt = HALMAC_PWR_POLLING_CNT; -+ flg = 1; -+ } else { -+ PLTFM_MSG_ERR("[ERR]polling to!!\n"); -+ PLTFM_MSG_ERR("[ERR]cmd offset:%X\n", -+ cmd->offset); -+ PLTFM_MSG_ERR("[ERR]cmd value:%X\n", -+ cmd->value); -+ PLTFM_MSG_ERR("[ERR]cmd msk:%X\n", -+ cmd->msk); -+ PLTFM_MSG_ERR("[ERR]offset = %X\n", -+ offset); -+ PLTFM_MSG_ERR("[ERR]value = %X\n", -+ value); -+ return HALMAC_RET_PWRSEQ_POLLING_FAIL; -+ } -+ } else { -+ PLTFM_DELAY_US(50); -+ } -+ } -+ } while (!poll_bit); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+parse_intf_phy_88xx(struct halmac_adapter *adapter, -+ struct halmac_intf_phy_para *param, -+ enum halmac_intf_phy_platform pltfm, -+ enum hal_intf_phy intf_phy) -+{ -+ u16 value; -+ u16 cur_cut; -+ u16 offset; -+ u16 ip_sel; -+ struct halmac_intf_phy_para *cur_param; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status result = HALMAC_RET_SUCCESS; -+ -+ switch (adapter->chip_ver) { -+ case HALMAC_CHIP_VER_A_CUT: -+ cur_cut = (u16)HALMAC_INTF_PHY_CUT_A; -+ break; -+ case HALMAC_CHIP_VER_B_CUT: -+ cur_cut = (u16)HALMAC_INTF_PHY_CUT_B; -+ break; -+ case HALMAC_CHIP_VER_C_CUT: -+ cur_cut = (u16)HALMAC_INTF_PHY_CUT_C; -+ break; -+ case HALMAC_CHIP_VER_D_CUT: -+ cur_cut = (u16)HALMAC_INTF_PHY_CUT_D; -+ break; -+ case HALMAC_CHIP_VER_E_CUT: -+ cur_cut = (u16)HALMAC_INTF_PHY_CUT_E; -+ break; -+ case HALMAC_CHIP_VER_F_CUT: -+ cur_cut = (u16)HALMAC_INTF_PHY_CUT_F; -+ break; -+ case HALMAC_CHIP_VER_TEST: -+ cur_cut = (u16)HALMAC_INTF_PHY_CUT_TESTCHIP; -+ break; -+ default: -+ return HALMAC_RET_FAIL; -+ } -+ -+ cur_param = param; -+ -+ do { -+ if ((cur_param->cut & cur_cut) && -+ (cur_param->plaform & (u16)pltfm)) { -+ offset = cur_param->offset; -+ value = cur_param->value; -+ ip_sel = cur_param->ip_sel; -+ -+ if (offset == 0xFFFF) -+ break; -+ -+ if (ip_sel == HALMAC_IP_SEL_MAC) { -+ HALMAC_REG_W8((u32)offset, (u8)value); -+ } else if (intf_phy == HAL_INTF_PHY_USB2 || -+ intf_phy == HAL_INTF_PHY_USB3) { -+#if HALMAC_USB_SUPPORT -+ if (offset > 0x100) -+ usb_page_switch_88xx(adapter, -+ intf_phy, -+ 1); -+ else -+ usb_page_switch_88xx(adapter, -+ intf_phy, -+ 0); -+ offset = offset & 0xFF; -+ result = usbphy_write_88xx(adapter, (u8)offset, -+ value, intf_phy); -+ if (result != HALMAC_RET_SUCCESS) -+ PLTFM_MSG_ERR("[ERR]usb phy!!\n"); -+#endif -+ } else if (intf_phy == HAL_INTF_PHY_PCIE_GEN1 || -+ intf_phy == HAL_INTF_PHY_PCIE_GEN2) { -+#if HALMAC_PCIE_SUPPORT -+ if (ip_sel == HALMAC_IP_INTF_PHY) -+ result = mdio_write_88xx(adapter, -+ (u8)offset, -+ value, -+ intf_phy); -+ else -+ result = dbi_w8_88xx(adapter, offset, -+ (u8)value); -+ if (result != HALMAC_RET_SUCCESS) -+ PLTFM_MSG_ERR("[ERR]mdio/dbi!!\n"); -+#endif -+ } else { -+ PLTFM_MSG_ERR("[ERR]intf phy sel!!\n"); -+ } -+ } -+ cur_param++; -+ } while (1); -+ -+ return result; -+} -+ -+/** -+ * txfifo_is_empty_88xx() -check if txfifo is empty -+ * @adapter : the adapter of halmac -+ * @chk_num : check number -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+txfifo_is_empty_88xx(struct halmac_adapter *adapter, u32 chk_num) -+{ -+ u32 cnt; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ cnt = (chk_num <= 10) ? 10 : chk_num; -+ do { -+ if (HALMAC_REG_R8(REG_TXPKT_EMPTY) != 0xFF) -+ return HALMAC_RET_TXFIFO_NO_EMPTY; -+ -+ if ((HALMAC_REG_R8(REG_TXPKT_EMPTY + 1) & 0x06) != 0x06) -+ return HALMAC_RET_TXFIFO_NO_EMPTY; -+ cnt--; -+ -+ } while (cnt != 0); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * (internal use) -+ * smart_malloc_88xx() - adapt malloc size -+ * @adapter : the adapter of halmac -+ * @size : expected malloc size -+ * @pNew_size : real malloc size -+ * Author : Ivan Lin -+ * Return : address pointer -+ */ -+u8* -+smart_malloc_88xx(struct halmac_adapter *adapter, u32 size, u32 *new_size) -+{ -+ u8 retry_num; -+ u8 *malloc_buf = NULL; -+ -+ for (retry_num = 0; retry_num < 5; retry_num++) { -+ malloc_buf = (u8 *)PLTFM_MALLOC(size); -+ -+ if (malloc_buf) { -+ *new_size = size; -+ return malloc_buf; -+ } -+ -+ size = size >> 1; -+ -+ if (size == 0) -+ break; -+ } -+ -+ PLTFM_MSG_ERR("[ERR]adptive malloc!!\n"); -+ -+ return NULL; -+} -+ -+/** -+ * (internal use) -+ * ltecoex_reg_read_88xx() - read ltecoex register -+ * @adapter : the adapter of halmac -+ * @offset : offset -+ * @pValue : value -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ */ -+enum halmac_ret_status -+ltecoex_reg_read_88xx(struct halmac_adapter *adapter, u16 offset, u32 *value) -+{ -+ u32 cnt; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ cnt = 10000; -+ while ((HALMAC_REG_R8(LTECOEX_ACCESS_CTRL + 3) & BIT(5)) == 0) { -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]lte ready(R)\n"); -+ return HALMAC_RET_LTECOEX_READY_FAIL; -+ } -+ cnt--; -+ PLTFM_DELAY_US(50); -+ } -+ -+ HALMAC_REG_W32(LTECOEX_ACCESS_CTRL, 0x800F0000 | offset); -+ *value = HALMAC_REG_R32(REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * (internal use) -+ * ltecoex_reg_write_88xx() - write ltecoex register -+ * @adapter : the adapter of halmac -+ * @offset : offset -+ * @value : value -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ */ -+enum halmac_ret_status -+ltecoex_reg_write_88xx(struct halmac_adapter *adapter, u16 offset, u32 value) -+{ -+ u32 cnt; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ cnt = 10000; -+ while ((HALMAC_REG_R8(LTECOEX_ACCESS_CTRL + 3) & BIT(5)) == 0) { -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]lte ready(W)\n"); -+ return HALMAC_RET_LTECOEX_READY_FAIL; -+ } -+ cnt--; -+ PLTFM_DELAY_US(50); -+ } -+ -+ HALMAC_REG_W32(REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1, value); -+ HALMAC_REG_W32(LTECOEX_ACCESS_CTRL, 0xC00F0000 | offset); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static void -+pwr_state_88xx(struct halmac_adapter *adapter, enum halmac_mac_power *state) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if ((HALMAC_REG_R8(REG_SYS_FUNC_EN + 1) & BIT(3)) == 0) -+ *state = HALMAC_MAC_POWER_OFF; -+ else -+ *state = HALMAC_MAC_POWER_ON; -+} -+ -+static u8 -+packet_in_nlo_88xx(struct halmac_adapter *adapter, -+ enum halmac_packet_id pkt_id) -+{ -+ enum halmac_packet_id nlo_pkt = HALMAC_PACKET_PROBE_REQ_NLO; -+ -+ if (pkt_id >= nlo_pkt) -+ return 1; -+ else -+ return 0; -+} -+ -+static enum halmac_packet_id -+get_real_pkt_id_88xx(struct halmac_adapter *adapter, -+ enum halmac_packet_id pkt_id) -+{ -+ enum halmac_packet_id real_pkt_id; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ switch (pkt_id) { -+ case HALMAC_PACKET_PROBE_REQ_NLO: -+ real_pkt_id = HALMAC_PACKET_PROBE_REQ; -+ break; -+ case HALMAC_PACKET_SYNC_BCN_NLO: -+ real_pkt_id = HALMAC_PACKET_SYNC_BCN; -+ break; -+ case HALMAC_PACKET_DISCOVERY_BCN_NLO: -+ real_pkt_id = HALMAC_PACKET_DISCOVERY_BCN; -+ break; -+ default: -+ real_pkt_id = pkt_id; -+ } -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ return real_pkt_id; -+} -+ -+static u32 -+get_update_packet_page_size(struct halmac_adapter *adapter, u32 size) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u32 txdesc_size; -+ u32 total; -+ -+ api->halmac_get_hw_value(adapter, HALMAC_HW_TX_DESC_SIZE, &txdesc_size); -+ -+ total = size + txdesc_size; -+ return (total & 0x7f) > 0 ? -+ (total >> TX_PAGE_SIZE_SHIFT_88XX) + 1 : -+ total >> TX_PAGE_SIZE_SHIFT_88XX; -+} -+ -+#endif /* HALMAC_88XX_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_common_88xx.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_common_88xx.h -new file mode 100644 -index 000000000..c641dd7e0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_common_88xx.h -@@ -0,0 +1,167 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_COMMON_88XX_H_ -+#define _HALMAC_COMMON_88XX_H_ -+ -+#include "../halmac_api.h" -+#include "../halmac_pwr_seq_cmd.h" -+#include "../halmac_gpio_cmd.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+enum halmac_ret_status -+ofld_func_cfg_88xx(struct halmac_adapter *adapter, -+ struct halmac_ofld_func_info *info); -+ -+enum halmac_ret_status -+dl_drv_rsvd_page_88xx(struct halmac_adapter *adapter, u8 pg_offset, u8 *buf, -+ u32 size); -+ -+enum halmac_ret_status -+dl_rsvd_page_88xx(struct halmac_adapter *adapter, u16 pg_addr, u8 *buf, -+ u32 size); -+ -+enum halmac_ret_status -+get_hw_value_88xx(struct halmac_adapter *adapter, enum halmac_hw_id hw_id, -+ void *value); -+ -+enum halmac_ret_status -+set_hw_value_88xx(struct halmac_adapter *adapter, enum halmac_hw_id hw_id, -+ void *value); -+ -+enum halmac_ret_status -+get_watcher_88xx(struct halmac_adapter *adapter, enum halmac_watcher_sel sel, -+ void *value); -+ -+enum halmac_ret_status -+set_h2c_pkt_hdr_88xx(struct halmac_adapter *adapter, u8 *hdr, -+ struct halmac_h2c_header_info *info, u16 *seq_num); -+ -+enum halmac_ret_status -+send_h2c_pkt_88xx(struct halmac_adapter *adapter, u8 *pkt); -+ -+enum halmac_ret_status -+get_h2c_buf_free_space_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+get_c2h_info_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+enum halmac_ret_status -+mac_debug_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+cfg_parameter_88xx(struct halmac_adapter *adapter, -+ struct halmac_phy_parameter_info *info, u8 full_fifo); -+ -+enum halmac_ret_status -+update_packet_88xx(struct halmac_adapter *adapter, enum halmac_packet_id pkt_id, -+ u8 *pkt, u32 size); -+ -+enum halmac_ret_status -+send_scan_packet_88xx(struct halmac_adapter *adapter, u8 index, -+ u8 *pkt, u32 size); -+ -+enum halmac_ret_status -+drop_scan_packet_88xx(struct halmac_adapter *adapter, -+ struct halmac_drop_pkt_option *option); -+ -+enum halmac_ret_status -+bcn_ie_filter_88xx(struct halmac_adapter *adapter, -+ struct halmac_bcn_ie_info *info); -+ -+enum halmac_ret_status -+update_datapack_88xx(struct halmac_adapter *adapter, -+ enum halmac_data_type data_type, -+ struct halmac_phy_parameter_info *info); -+ -+enum halmac_ret_status -+run_datapack_88xx(struct halmac_adapter *adapter, -+ enum halmac_data_type data_type); -+ -+enum halmac_ret_status -+send_bt_coex_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size, u8 ack); -+ -+enum halmac_ret_status -+dump_fifo_88xx(struct halmac_adapter *adapter, enum hal_fifo_sel sel, -+ u32 start_addr, u32 size, u8 *data); -+ -+u32 -+get_fifo_size_88xx(struct halmac_adapter *adapter, enum hal_fifo_sel sel); -+ -+enum halmac_ret_status -+set_h2c_header_88xx(struct halmac_adapter *adapter, u8 *hdr, u16 *seq, u8 ack); -+ -+enum halmac_ret_status -+add_ch_info_88xx(struct halmac_adapter *adapter, struct halmac_ch_info *info); -+ -+enum halmac_ret_status -+add_extra_ch_info_88xx(struct halmac_adapter *adapter, -+ struct halmac_ch_extra_info *info); -+ -+enum halmac_ret_status -+ctrl_ch_switch_88xx(struct halmac_adapter *adapter, -+ struct halmac_ch_switch_option *opt); -+ -+enum halmac_ret_status -+clear_ch_info_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+chk_txdesc_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+enum halmac_ret_status -+get_version_88xx(struct halmac_adapter *adapter, struct halmac_ver *ver); -+ -+enum halmac_ret_status -+p2pps_88xx(struct halmac_adapter *adapter, struct halmac_p2pps *info); -+ -+enum halmac_ret_status -+query_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_feature_id feature_id, -+ enum halmac_cmd_process_status *proc_status, u8 *data, -+ u32 *size); -+ -+enum halmac_ret_status -+cfg_drv_rsvd_pg_num_88xx(struct halmac_adapter *adapter, -+ enum halmac_drv_rsvd_pg_num pg_num); -+ -+enum halmac_ret_status -+h2c_lb_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+pwr_seq_parser_88xx(struct halmac_adapter *adapter, -+ struct halmac_wlan_pwr_cfg **cmd_seq); -+ -+enum halmac_ret_status -+parse_intf_phy_88xx(struct halmac_adapter *adapter, -+ struct halmac_intf_phy_para *param, -+ enum halmac_intf_phy_platform pltfm, -+ enum hal_intf_phy intf_phy); -+ -+enum halmac_ret_status -+txfifo_is_empty_88xx(struct halmac_adapter *adapter, u32 chk_num); -+ -+u8* -+smart_malloc_88xx(struct halmac_adapter *adapter, u32 size, u32 *new_size); -+ -+enum halmac_ret_status -+ltecoex_reg_read_88xx(struct halmac_adapter *adapter, u16 offset, u32 *value); -+ -+enum halmac_ret_status -+ltecoex_reg_write_88xx(struct halmac_adapter *adapter, u16 offset, u32 value); -+ -+#endif/* HALMAC_88XX_SUPPORT */ -+ -+#endif/* _HALMAC_COMMON_88XX_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_efuse_88xx.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_efuse_88xx.c -new file mode 100644 -index 000000000..184c2df5f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_efuse_88xx.c -@@ -0,0 +1,3073 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_efuse_88xx.h" -+#include "halmac_88xx_cfg.h" -+#include "halmac_common_88xx.h" -+#include "halmac_init_88xx.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+#define RSVD_EFUSE_SIZE 16 -+#define RSVD_CS_EFUSE_SIZE 24 -+#define FEATURE_DUMP_PHY_EFUSE HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE -+#define FEATURE_DUMP_LOG_EFUSE HALMAC_FEATURE_DUMP_LOGICAL_EFUSE -+#define FEATURE_DUMP_LOG_EFUSE_MASK HALMAC_FEATURE_DUMP_LOGICAL_EFUSE_MASK -+ -+#define SUPER_USB_ZONE0_START 0x150 -+#define SUPER_USB_ZONE0_END 0x199 -+#define SUPER_USB_ZONE1_START 0x200 -+#define SUPER_USB_ZONE1_END 0x217 -+#define SUPER_USB_RE_PG_CK_ZONE0_START 0x15D -+#define SUPER_USB_RE_PG_CK_ZONE0_END 0x164 -+ -+static u8 bt_switch = 0; -+ -+static enum halmac_cmd_construct_state -+efuse_cmd_cnstr_state_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+proc_dump_efuse_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg); -+ -+static enum halmac_ret_status -+read_hw_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u32 size, -+ u8 *map); -+ -+static enum halmac_ret_status -+read_log_efuse_map_88xx(struct halmac_adapter *adapter, u8 *map); -+ -+static enum halmac_ret_status -+proc_pg_efuse_by_map_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, -+ enum halmac_efuse_read_cfg cfg); -+ -+static enum halmac_ret_status -+dump_efuse_fw_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+dump_efuse_drv_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+proc_write_log_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u8 value); -+ -+static enum halmac_ret_status -+proc_write_log_efuse_word_88xx(struct halmac_adapter *adapter, u32 offset, -+ u16 value); -+ -+static enum halmac_ret_status -+update_eeprom_mask_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 *updated_mask); -+ -+static enum halmac_ret_status -+check_efuse_enough_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 *updated_mask); -+ -+static enum halmac_ret_status -+pg_extend_efuse_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 word_en, -+ u8 pre_word_en, u32 eeprom_offset); -+ -+static enum halmac_ret_status -+proc_pg_efuse_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 word_en, -+ u8 pre_word_en, u32 eeprom_offset); -+ -+static enum halmac_ret_status -+pg_super_usb_efuse_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 word_en, -+ u8 pre_word_en, u32 eeprom_offset); -+ -+static enum halmac_ret_status -+program_efuse_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 *updated_mask); -+ -+static void -+mask_eeprom_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info); -+ -+static enum halmac_ret_status -+proc_gen_super_usb_map_88xx(struct halmac_adapter *adapter, u8 *drv_map, -+ u8 *updated_map, u8 *updated_mask); -+ -+static enum halmac_ret_status -+super_usb_efuse_parser_88xx(struct halmac_adapter *adapter, u8 *phy_map, -+ u8 *log_map, u8 *log_mask); -+ -+static enum halmac_ret_status -+super_usb_chk_88xx(struct halmac_adapter *adapter, u8 *super_usb); -+ -+static enum halmac_ret_status -+log_efuse_re_pg_chk_88xx(struct halmac_adapter *adapter, u8 *efuse_mask, -+ u32 addr, u8 *re_pg); -+ -+static enum halmac_ret_status -+super_usb_fmt_chk_88xx(struct halmac_adapter *adapter, u8 *re_pg); -+ -+static enum halmac_ret_status -+super_usb_re_pg_chk_88xx(struct halmac_adapter *adapter, u8 *phy_map, -+ u8 *re_pg); -+ -+/** -+ * dump_efuse_map_88xx() - dump "physical" efuse map -+ * @adapter : the adapter of halmac -+ * @cfg : dump efuse method -+ * Author : Ivan Lin/KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+dump_efuse_map_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg) -+{ -+ u8 *map = NULL; -+ u8 *efuse_map; -+ u32 efuse_size = adapter->hw_cfg_info.efuse_size; -+ u32 prtct_efuse_size = adapter->hw_cfg_info.prtct_efuse_size; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ if (cfg == HALMAC_EFUSE_R_FW && -+ halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ PLTFM_MSG_TRACE("[TRACE]cfg = %d\n", cfg); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) -+ PLTFM_MSG_ERR("[ERR]Dump efuse in suspend\n"); -+ -+ *proc_status = HALMAC_CMD_PROCESS_IDLE; -+ adapter->evnt.phy_efuse_map = 1; -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank!!\n"); -+ return status; -+ } -+ -+ status = proc_dump_efuse_88xx(adapter, cfg); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dump efuse!!\n"); -+ return status; -+ } -+ -+ if (adapter->efuse_map_valid == 1) { -+ *proc_status = HALMAC_CMD_PROCESS_DONE; -+ efuse_map = adapter->efuse_map; -+ -+ map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc!!\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, efuse_size); -+ PLTFM_MUTEX_LOCK(&adapter->efuse_mutex); -+#if HALMAC_PLATFORM_WINDOWS -+ PLTFM_MEMCPY(map, efuse_map, efuse_size); -+#else -+ PLTFM_MEMCPY(map, efuse_map, efuse_size - prtct_efuse_size); -+ PLTFM_MEMCPY(map + efuse_size - prtct_efuse_size + -+ RSVD_CS_EFUSE_SIZE, -+ efuse_map + efuse_size - prtct_efuse_size + -+ RSVD_CS_EFUSE_SIZE, -+ prtct_efuse_size - RSVD_EFUSE_SIZE - -+ RSVD_CS_EFUSE_SIZE); -+#endif -+ PLTFM_MUTEX_UNLOCK(&adapter->efuse_mutex); -+ -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE, -+ *proc_status, map, efuse_size); -+ adapter->evnt.phy_efuse_map = 0; -+ -+ PLTFM_FREE(map, efuse_size); -+ } -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * dump_efuse_map_bt_88xx() - dump "BT physical" efuse map -+ * @adapter : the adapter of halmac -+ * @bank : bt efuse bank -+ * @size : bt efuse map size. get from halmac_get_efuse_size API -+ * @map : bt efuse map -+ * Author : Soar / Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+dump_efuse_map_bt_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_bank bank, u32 size, u8 *map) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (adapter->hw_cfg_info.bt_efuse_size != size) -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ -+ if (bank >= HALMAC_EFUSE_BANK_MAX || bank == HALMAC_EFUSE_BANK_WIFI) { -+ PLTFM_MSG_ERR("[ERR]Undefined BT bank\n"); -+ return HALMAC_RET_EFUSE_BANK_INCORRECT; -+ } -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, bank); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank!!\n"); -+ return status; -+ } -+ bt_switch = 1; -+ -+ status = read_hw_efuse_88xx(adapter, 0, size, map); -+ if (status != HALMAC_RET_SUCCESS) { -+ bt_switch = 0; -+ PLTFM_MSG_ERR("[ERR]read hw efuse\n"); -+ return status; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ bt_switch = 0; -+ PLTFM_MSG_ERR("[ERR]switch efuse bank!!\n"); -+ return status; -+ } -+ bt_switch = 0; -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * write_efuse_bt_88xx() - write "BT physical" efuse offset -+ * @adapter : the adapter of halmac -+ * @offset : offset -+ * @value : Write value -+ * @map : bt efuse map -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+write_efuse_bt_88xx(struct halmac_adapter *adapter, u32 offset, u8 value, -+ enum halmac_efuse_bank bank) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ if (offset >= adapter->hw_cfg_info.efuse_size) { -+ PLTFM_MSG_ERR("[ERR]Offset is too large\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (bank > HALMAC_EFUSE_BANK_MAX || bank == HALMAC_EFUSE_BANK_WIFI) { -+ PLTFM_MSG_ERR("[ERR]Undefined BT bank\n"); -+ return HALMAC_RET_EFUSE_BANK_INCORRECT; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, bank); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank!!\n"); -+ return status; -+ } -+ bt_switch = 1; -+ -+ status = write_hw_efuse_88xx(adapter, offset, value); -+ if (status != HALMAC_RET_SUCCESS) { -+ bt_switch = 0; -+ PLTFM_MSG_ERR("[ERR]write efuse\n"); -+ return status; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ bt_switch = 0; -+ PLTFM_MSG_ERR("[ERR]switch efuse bank!!\n"); -+ return status; -+ } -+ bt_switch = 0; -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * read_efuse_bt_88xx() - read "BT physical" efuse offset -+ * @adapter : the adapter of halmac -+ * @offset : offset -+ * @value : 1 byte efuse value -+ * @bank : efuse bank -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+read_efuse_bt_88xx(struct halmac_adapter *adapter, u32 offset, u8 *value, -+ enum halmac_efuse_bank bank) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ if (offset >= adapter->hw_cfg_info.efuse_size) { -+ PLTFM_MSG_ERR("[ERR]Offset is too large\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (bank > HALMAC_EFUSE_BANK_MAX || bank == HALMAC_EFUSE_BANK_WIFI) { -+ PLTFM_MSG_ERR("[ERR]Undefined BT bank\n"); -+ return HALMAC_RET_EFUSE_BANK_INCORRECT; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, bank); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank\n"); -+ return status; -+ } -+ bt_switch = 1; -+ -+ status = read_efuse_88xx(adapter, offset, 1, value); -+ if (status != HALMAC_RET_SUCCESS) { -+ bt_switch = 0; -+ PLTFM_MSG_ERR("[ERR]read efuse\n"); -+ return status; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ bt_switch = 0; -+ PLTFM_MSG_ERR("[ERR]switch efuse bank!!\n"); -+ return status; -+ } -+ bt_switch = 0; -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_efuse_auto_check_88xx() - check efuse after writing it -+ * @adapter : the adapter of halmac -+ * @enable : 1, enable efuse auto check. others, disable -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_efuse_auto_check_88xx(struct halmac_adapter *adapter, u8 enable) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ adapter->efuse_auto_check_en = enable; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * get_efuse_available_size_88xx() - get efuse available size -+ * @adapter : the adapter of halmac -+ * @size : physical efuse available size -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_efuse_available_size_88xx(struct halmac_adapter *adapter, u32 *size) -+{ -+ enum halmac_ret_status status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ status = dump_log_efuse_map_88xx(adapter, HALMAC_EFUSE_R_DRV); -+ -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ *size = adapter->hw_cfg_info.efuse_size - -+ adapter->hw_cfg_info.prtct_efuse_size - adapter->efuse_end; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * get_efuse_size_88xx() - get "physical" efuse size -+ * @adapter : the adapter of halmac -+ * @size : physical efuse size -+ * Author : Ivan Lin/KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_efuse_size_88xx(struct halmac_adapter *adapter, u32 *size) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ *size = adapter->hw_cfg_info.efuse_size; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * get_log_efuse_size_88xx() - get "logical" efuse size -+ * @adapter : the adapter of halmac -+ * @size : logical efuse size -+ * Author : Ivan Lin/KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_log_efuse_size_88xx(struct halmac_adapter *adapter, u32 *size) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ *size = adapter->hw_cfg_info.eeprom_size; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * dump_log_efuse_map_88xx() - dump "logical" efuse map -+ * @adapter : the adapter of halmac -+ * @cfg : dump efuse method -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+dump_log_efuse_map_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg) -+{ -+ u8 *map = NULL; -+ u32 size = adapter->hw_cfg_info.eeprom_size; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ if (cfg == HALMAC_EFUSE_R_FW && -+ halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ PLTFM_MSG_TRACE("[TRACE]cfg = %d\n", cfg); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) -+ PLTFM_MSG_ERR("[ERR]Dump efuse in suspend\n"); -+ -+ *proc_status = HALMAC_CMD_PROCESS_IDLE; -+ adapter->evnt.log_efuse_map = 1; -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank\n"); -+ return status; -+ } -+ -+ status = proc_dump_efuse_88xx(adapter, cfg); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dump efuse\n"); -+ return status; -+ } -+ -+ if (adapter->efuse_map_valid == 1) { -+ *proc_status = HALMAC_CMD_PROCESS_DONE; -+ -+ map = (u8 *)PLTFM_MALLOC(size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, size); -+ -+ if (eeprom_parser_88xx(adapter, adapter->efuse_map, map) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, size); -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_DUMP_LOGICAL_EFUSE, -+ *proc_status, map, size); -+ adapter->evnt.log_efuse_map = 0; -+ -+ PLTFM_FREE(map, size); -+ } -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+dump_log_efuse_mask_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg) -+{ -+ u8 *map = NULL; -+ u32 size = adapter->hw_cfg_info.eeprom_size; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ if (cfg == HALMAC_EFUSE_R_FW && -+ halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ PLTFM_MSG_TRACE("[TRACE]cfg = %d\n", cfg); -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) -+ PLTFM_MSG_ERR("[ERR]Dump efuse in suspend\n"); -+ -+ *proc_status = HALMAC_CMD_PROCESS_IDLE; -+ adapter->evnt.log_efuse_mask = 1; -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank\n"); -+ return status; -+ } -+ -+ status = proc_dump_efuse_88xx(adapter, cfg); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dump efuse\n"); -+ return status; -+ } -+ -+ if (adapter->efuse_map_valid == 1) { -+ *proc_status = HALMAC_CMD_PROCESS_DONE; -+ -+ map = (u8 *)PLTFM_MALLOC(size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, size); -+ -+ if (eeprom_mask_parser_88xx(adapter, adapter->efuse_map, map) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, size); -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_DUMP_LOGICAL_EFUSE_MASK, -+ *proc_status, map, size); -+ adapter->evnt.log_efuse_mask = 0; -+ -+ PLTFM_FREE(map, size); -+ } -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * read_logical_efuse_88xx() - read logical efuse map 1 byte -+ * @adapter : the adapter of halmac -+ * @offset : offset -+ * @value : 1 byte efuse value -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+read_logical_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u8 *value) -+{ -+ u8 *map = NULL; -+ u32 size = adapter->hw_cfg_info.eeprom_size; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (offset >= size) { -+ PLTFM_MSG_ERR("[ERR]Offset is too large\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank\n"); -+ return status; -+ } -+ -+ map = (u8 *)PLTFM_MALLOC(size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, size); -+ -+ status = read_log_efuse_map_88xx(adapter, map); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]read logical efuse\n"); -+ PLTFM_FREE(map, size); -+ return status; -+ } -+ -+ *value = *(map + offset); -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, size); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ PLTFM_FREE(map, size); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * write_log_efuse_88xx() - write "logical" efuse offset -+ * @adapter : the adapter of halmac -+ * @offset : offset -+ * @value : value -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+write_log_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u8 value) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (offset >= adapter->hw_cfg_info.eeprom_size) { -+ PLTFM_MSG_ERR("[ERR]Offset is too large\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank\n"); -+ return status; -+ } -+ -+ status = proc_write_log_efuse_88xx(adapter, offset, value); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write logical efuse\n"); -+ return status; -+ } -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * write_log_efuse_word_88xx() - write "logical" efuse offset word -+ * @adapter : the adapter of halmac -+ * @offset : offset -+ * @value : value -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+write_log_efuse_word_88xx(struct halmac_adapter *adapter, u32 offset, u16 value) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (offset >= adapter->hw_cfg_info.eeprom_size) { -+ PLTFM_MSG_ERR("[ERR]Offset is too large\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank\n"); -+ return status; -+ } -+ -+ status = proc_write_log_efuse_word_88xx(adapter, offset, value); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write logical efuse\n"); -+ return status; -+ } -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * pg_efuse_by_map_88xx() - pg logical efuse by map -+ * @adapter : the adapter of halmac -+ * @info : efuse map information -+ * @cfg : dump efuse method -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+pg_efuse_by_map_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, -+ enum halmac_efuse_read_cfg cfg) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (info->efuse_map_size != adapter->hw_cfg_info.eeprom_size) { -+ PLTFM_MSG_ERR("[ERR]map size error\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if ((info->efuse_map_size & 0xF) > 0) { -+ PLTFM_MSG_ERR("[ERR]not multiple of 16\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (info->efuse_mask_size != info->efuse_map_size >> 4) { -+ PLTFM_MSG_ERR("[ERR]mask size error\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (!info->efuse_map) { -+ PLTFM_MSG_ERR("[ERR]map is NULL\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ -+ if (!info->efuse_mask) { -+ PLTFM_MSG_ERR("[ERR]mask is NULL\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank\n"); -+ return status; -+ } -+ -+ status = proc_pg_efuse_by_map_88xx(adapter, info, cfg); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]pg efuse\n"); -+ return status; -+ } -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * mask_log_efuse_88xx() - mask logical efuse -+ * @adapter : the adapter of halmac -+ * @info : efuse map information -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+mask_log_efuse_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (info->efuse_map_size != adapter->hw_cfg_info.eeprom_size) { -+ PLTFM_MSG_ERR("[ERR]map size error\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if ((info->efuse_map_size & 0xF) > 0) { -+ PLTFM_MSG_ERR("[ERR]not multiple of 16\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (info->efuse_mask_size != info->efuse_map_size >> 4) { -+ PLTFM_MSG_ERR("[ERR]mask size error\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (!info->efuse_map) { -+ PLTFM_MSG_ERR("[ERR]map is NULL\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ -+ if (!info->efuse_mask) { -+ PLTFM_MSG_ERR("[ERR]mask is NULL\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ -+ mask_eeprom_88xx(adapter, info); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_cmd_construct_state -+efuse_cmd_cnstr_state_88xx(struct halmac_adapter *adapter) -+{ -+ return adapter->halmac_state.efuse_state.cmd_cnstr_state; -+} -+ -+enum halmac_ret_status -+switch_efuse_bank_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_bank bank) -+{ -+ u8 reg_value; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (!bt_switch) { -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_BUSY) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ reg_value = HALMAC_REG_R8(REG_LDO_EFUSE_CTRL + 1); -+ -+ if (bank == (reg_value & (BIT(0) | BIT(1)))) -+ return HALMAC_RET_SUCCESS; -+ -+ reg_value &= ~(BIT(0) | BIT(1)); -+ reg_value |= bank; -+ HALMAC_REG_W8(REG_LDO_EFUSE_CTRL + 1, reg_value); -+ -+ reg_value = HALMAC_REG_R8(REG_LDO_EFUSE_CTRL + 1); -+ if ((reg_value & (BIT(0) | BIT(1))) != bank) -+ return HALMAC_RET_SWITCH_EFUSE_BANK_FAIL; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+proc_dump_efuse_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg) -+{ -+ u32 h2c_init; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_H2C_SENT) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ if (cfg == HALMAC_EFUSE_R_AUTO) { -+ h2c_init = HALMAC_REG_R32(REG_H2C_PKT_READADDR); -+ if (adapter->halmac_state.dlfw_state == HALMAC_DLFW_NONE || -+ h2c_init == 0) -+ status = dump_efuse_drv_88xx(adapter); -+ else -+ status = dump_efuse_fw_88xx(adapter); -+ } else if (cfg == HALMAC_EFUSE_R_FW) { -+ status = dump_efuse_fw_88xx(adapter); -+ } else { -+ status = dump_efuse_drv_88xx(adapter); -+ } -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dump efsue drv/fw\n"); -+ return status; -+ } -+ -+ return status; -+} -+ -+enum halmac_ret_status -+cnv_efuse_state_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_construct_state dest_state) -+{ -+ struct halmac_efuse_state *state = &adapter->halmac_state.efuse_state; -+ -+ if (state->cmd_cnstr_state != HALMAC_CMD_CNSTR_IDLE && -+ state->cmd_cnstr_state != HALMAC_CMD_CNSTR_BUSY && -+ state->cmd_cnstr_state != HALMAC_CMD_CNSTR_H2C_SENT) -+ return HALMAC_RET_ERROR_STATE; -+ -+ if (state->cmd_cnstr_state == dest_state) -+ return HALMAC_RET_ERROR_STATE; -+ -+ if (dest_state == HALMAC_CMD_CNSTR_BUSY) { -+ if (state->cmd_cnstr_state == HALMAC_CMD_CNSTR_H2C_SENT) -+ return HALMAC_RET_ERROR_STATE; -+ } else if (dest_state == HALMAC_CMD_CNSTR_H2C_SENT) { -+ if (state->cmd_cnstr_state == HALMAC_CMD_CNSTR_IDLE) -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ state->cmd_cnstr_state = dest_state; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+read_hw_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u32 size, -+ u8 *map) -+{ -+ u8 enable; -+ u32 value32; -+ u32 addr; -+ u32 tmp32; -+ u32 cnt; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ /* Read efuse no need 2.5V LDO */ -+ enable = 0; -+ status = api->halmac_set_hw_value(adapter, HALMAC_HW_LDO25_EN, &enable); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dis ldo25\n"); -+ return status; -+ } -+ value32 = HALMAC_REG_R32(REG_EFUSE_CTRL); -+ -+ for (addr = offset; addr < offset + size; addr++) { -+ value32 &= ~(BIT_MASK_EF_DATA | BITS_EF_ADDR); -+ value32 |= ((addr & BIT_MASK_EF_ADDR) << BIT_SHIFT_EF_ADDR); -+ HALMAC_REG_W32(REG_EFUSE_CTRL, value32 & (~BIT_EF_FLAG)); -+ -+ cnt = 1000000; -+ do { -+ PLTFM_DELAY_US(1); -+ tmp32 = HALMAC_REG_R32(REG_EFUSE_CTRL); -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]read\n"); -+ return HALMAC_RET_EFUSE_R_FAIL; -+ } -+ } while ((tmp32 & BIT_EF_FLAG) == 0); -+ -+ *(map + addr - offset) = (u8)(tmp32 & BIT_MASK_EF_DATA); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+write_hw_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u8 value) -+{ -+ const u8 unlock_code = 0x69; -+ u8 value_read = 0; -+ u8 enable; -+ u32 value32; -+ u32 tmp32; -+ u32 cnt; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MUTEX_LOCK(&adapter->efuse_mutex); -+ adapter->efuse_map_valid = 0; -+ PLTFM_MUTEX_UNLOCK(&adapter->efuse_mutex); -+ -+ HALMAC_REG_W8(REG_PMC_DBG_CTRL2 + 3, unlock_code); -+ -+ /* Enable 2.5V LDO */ -+ enable = 1; -+ status = api->halmac_set_hw_value(adapter, HALMAC_HW_LDO25_EN, &enable); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]en ldo25\n"); -+ return status; -+ } -+ -+ value32 = HALMAC_REG_R32(REG_EFUSE_CTRL); -+ value32 &= ~(BIT_MASK_EF_DATA | BITS_EF_ADDR); -+ value32 = value32 | ((offset & BIT_MASK_EF_ADDR) << BIT_SHIFT_EF_ADDR) | -+ (value & BIT_MASK_EF_DATA); -+ HALMAC_REG_W32(REG_EFUSE_CTRL, value32 | BIT_EF_FLAG); -+ -+ cnt = 1000000; -+ do { -+ PLTFM_DELAY_US(1); -+ tmp32 = HALMAC_REG_R32(REG_EFUSE_CTRL); -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]write!!\n"); -+ return HALMAC_RET_EFUSE_W_FAIL; -+ } -+ } while (BIT_EF_FLAG == (tmp32 & BIT_EF_FLAG)); -+ -+ HALMAC_REG_W8(REG_PMC_DBG_CTRL2 + 3, 0x00); -+ -+ /* Disable 2.5V LDO */ -+ enable = 0; -+ status = api->halmac_set_hw_value(adapter, HALMAC_HW_LDO25_EN, &enable); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dis ldo25\n"); -+ return status; -+ } -+ -+ if (adapter->efuse_auto_check_en == 1) { -+ if (read_hw_efuse_88xx(adapter, offset, 1, &value_read) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_EFUSE_R_FAIL; -+ if (value_read != value) { -+ PLTFM_MSG_ERR("[ERR]efuse compare\n"); -+ return HALMAC_RET_EFUSE_W_FAIL; -+ } -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+eeprom_parser_88xx(struct halmac_adapter *adapter, u8 *phy_map, u8 *log_map) -+{ -+ u8 i; -+ u8 value8; -+ u8 blk_idx; -+ u8 word_en; -+ u8 valid; -+ u8 hdr; -+ u8 hdr2 = 0; -+ u32 eeprom_idx; -+ u32 efuse_idx = 0; -+ u32 prtct_efuse_size = adapter->hw_cfg_info.prtct_efuse_size; -+ struct halmac_hw_cfg_info *hw_info = &adapter->hw_cfg_info; -+ -+ PLTFM_MEMSET(log_map, 0xFF, hw_info->eeprom_size); -+ -+ do { -+ value8 = *(phy_map + efuse_idx); -+ hdr = value8; -+ -+ if ((hdr & 0x1f) == 0x0f) { -+ efuse_idx++; -+ value8 = *(phy_map + efuse_idx); -+ hdr2 = value8; -+ if (hdr2 == 0xff) -+ break; -+ blk_idx = ((hdr2 & 0xF0) >> 1) | ((hdr >> 5) & 0x07); -+ word_en = hdr2 & 0x0F; -+ } else { -+ blk_idx = (hdr & 0xF0) >> 4; -+ word_en = hdr & 0x0F; -+ } -+ -+ if (hdr == 0xff) -+ break; -+ -+ efuse_idx++; -+ -+ if (efuse_idx >= hw_info->efuse_size - prtct_efuse_size - 1) -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ -+ for (i = 0; i < 4; i++) { -+ valid = (u8)((~(word_en >> i)) & BIT(0)); -+ if (valid == 1) { -+ eeprom_idx = (blk_idx << 3) + (i << 1); -+ -+ if ((eeprom_idx + 1) > hw_info->eeprom_size) { -+ PLTFM_MSG_ERR("[ERR]efuse idx:0x%X\n", -+ efuse_idx - 1); -+ -+ PLTFM_MSG_ERR("[ERR]read hdr:0x%X\n", -+ hdr); -+ -+ PLTFM_MSG_ERR("[ERR]rad hdr2:0x%X\n", -+ hdr2); -+ -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ -+ value8 = *(phy_map + efuse_idx); -+ *(log_map + eeprom_idx) = value8; -+ -+ eeprom_idx++; -+ efuse_idx++; -+ -+ if (efuse_idx > hw_info->efuse_size - -+ prtct_efuse_size - 1) -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ -+ value8 = *(phy_map + efuse_idx); -+ *(log_map + eeprom_idx) = value8; -+ -+ efuse_idx++; -+ -+ if (efuse_idx > hw_info->efuse_size - -+ prtct_efuse_size) -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ } -+ } while (1); -+ -+ adapter->efuse_end = efuse_idx; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+eeprom_mask_parser_88xx(struct halmac_adapter *adapter, u8 *phy_map, -+ u8 *log_mask) -+{ -+ u8 i; -+ u8 value8; -+ u8 blk_idx; -+ u8 word_en; -+ u8 valid; -+ u8 hdr; -+ u8 hdr2 = 0; -+ u32 eeprom_idx; -+ u32 efuse_idx = 0; -+ u32 prtct_efuse_size = adapter->hw_cfg_info.prtct_efuse_size; -+ struct halmac_hw_cfg_info *hw_info = &adapter->hw_cfg_info; -+ -+ PLTFM_MEMSET(log_mask, 0xFF, hw_info->eeprom_size); -+ -+ do { -+ value8 = *(phy_map + efuse_idx); -+ hdr = value8; -+ -+ if ((hdr & 0x1f) == 0x0f) { -+ efuse_idx++; -+ value8 = *(phy_map + efuse_idx); -+ hdr2 = value8; -+ if (hdr2 == 0xff) -+ break; -+ blk_idx = ((hdr2 & 0xF0) >> 1) | ((hdr >> 5) & 0x07); -+ word_en = hdr2 & 0x0F; -+ } else { -+ blk_idx = (hdr & 0xF0) >> 4; -+ word_en = hdr & 0x0F; -+ } -+ -+ if (hdr == 0xff) -+ break; -+ -+ efuse_idx++; -+ -+ if (efuse_idx >= hw_info->efuse_size - prtct_efuse_size - 1) -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ -+ for (i = 0; i < 4; i++) { -+ valid = (u8)((~(word_en >> i)) & BIT(0)); -+ if (valid == 1) { -+ eeprom_idx = (blk_idx << 3) + (i << 1); -+ -+ if ((eeprom_idx + 1) > hw_info->eeprom_size) { -+ PLTFM_MSG_ERR("[ERR]efuse idx:0x%X\n", -+ efuse_idx - 1); -+ -+ PLTFM_MSG_ERR("[ERR]read hdr:0x%X\n", -+ hdr); -+ -+ PLTFM_MSG_ERR("[ERR]read hdr2:0x%X\n", -+ hdr2); -+ -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ -+ *(log_mask + eeprom_idx) = 0x00; -+ -+ eeprom_idx++; -+ efuse_idx++; -+ -+ if (efuse_idx > hw_info->efuse_size - -+ prtct_efuse_size - 1) -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ -+ *(log_mask + eeprom_idx) = 0x00; -+ -+ efuse_idx++; -+ -+ if (efuse_idx > hw_info->efuse_size - -+ prtct_efuse_size) -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ } -+ } while (1); -+ -+ adapter->efuse_end = efuse_idx; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+read_log_efuse_map_88xx(struct halmac_adapter *adapter, u8 *map) -+{ -+ u8 *local_map = NULL; -+ u32 efuse_size; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (adapter->efuse_map_valid == 0) { -+ efuse_size = adapter->hw_cfg_info.efuse_size; -+ -+ local_map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!local_map) { -+ PLTFM_MSG_ERR("[ERR]local map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ -+ status = read_efuse_88xx(adapter, 0, efuse_size, local_map); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]read efuse\n"); -+ PLTFM_FREE(local_map, efuse_size); -+ return status; -+ } -+ -+ if (!adapter->efuse_map) { -+ adapter->efuse_map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!adapter->efuse_map) { -+ PLTFM_MSG_ERR("[ERR]malloc adapter map\n"); -+ PLTFM_FREE(local_map, efuse_size); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ } -+ -+ PLTFM_MUTEX_LOCK(&adapter->efuse_mutex); -+ PLTFM_MEMCPY(adapter->efuse_map, local_map, efuse_size); -+ adapter->efuse_map_valid = 1; -+ PLTFM_MUTEX_UNLOCK(&adapter->efuse_mutex); -+ -+ PLTFM_FREE(local_map, efuse_size); -+ } -+ -+ if (eeprom_parser_88xx(adapter, adapter->efuse_map, map) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+proc_pg_efuse_by_map_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, -+ enum halmac_efuse_read_cfg cfg) -+{ -+ u8 *updated_mask = NULL; -+ u8 *updated_map = NULL; -+ u32 map_size = adapter->hw_cfg_info.eeprom_size; -+ u32 mask_size = adapter->hw_cfg_info.eeprom_size >> 4; -+ u8 super_usb; -+ struct halmac_pg_efuse_info local_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ status = super_usb_chk_88xx(adapter, &super_usb); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]super_usb_chk\n"); -+ return status; -+ } -+ -+ updated_mask = (u8 *)PLTFM_MALLOC(mask_size); -+ if (!updated_mask) { -+ PLTFM_MSG_ERR("[ERR]malloc updated mask\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(updated_mask, 0x00, mask_size); -+ -+ status = update_eeprom_mask_88xx(adapter, info, updated_mask); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]update eeprom mask\n"); -+ PLTFM_FREE(updated_mask, mask_size); -+ return status; -+ } -+ -+ if (super_usb) { -+ updated_map = (u8 *)PLTFM_MALLOC(map_size); -+ if (!updated_map) { -+ PLTFM_MSG_ERR("[ERR]malloc updated map\n"); -+ PLTFM_FREE(updated_mask, mask_size); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(updated_map, 0xFF, map_size); -+ -+ status = proc_gen_super_usb_map_88xx(adapter, info->efuse_map, -+ updated_map, updated_mask); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]gen eeprom mask/map\n"); -+ PLTFM_FREE(updated_mask, mask_size); -+ PLTFM_FREE(updated_map, map_size); -+ return status; -+ } -+ -+ local_info.efuse_map = updated_map; -+ local_info.efuse_mask = updated_mask; -+ local_info.efuse_map_size = map_size; -+ local_info.efuse_mask_size = mask_size; -+ } -+ -+ if (super_usb) -+ status = check_efuse_enough_88xx(adapter, &local_info, -+ updated_mask); -+ else -+ status = check_efuse_enough_88xx(adapter, info, updated_mask); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]chk efuse enough\n"); -+ PLTFM_FREE(updated_mask, mask_size); -+ if (super_usb) -+ PLTFM_FREE(updated_map, map_size); -+ return status; -+ } -+ -+ if (super_usb) -+ status = program_efuse_88xx(adapter, &local_info, updated_mask); -+ else -+ status = program_efuse_88xx(adapter, info, updated_mask); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]pg efuse\n"); -+ PLTFM_FREE(updated_mask, mask_size); -+ if (super_usb) -+ PLTFM_FREE(updated_map, map_size); -+ return status; -+ } -+ -+ PLTFM_FREE(updated_mask, mask_size); -+ if (super_usb) -+ PLTFM_FREE(updated_map, map_size); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+dump_efuse_drv_88xx(struct halmac_adapter *adapter) -+{ -+ u8 *map = NULL; -+ u32 efuse_size = adapter->hw_cfg_info.efuse_size; -+ -+ if (!adapter->efuse_map) { -+ adapter->efuse_map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!adapter->efuse_map) { -+ PLTFM_MSG_ERR("[ERR]malloc adapter map!!\n"); -+ reset_ofld_feature_88xx(adapter, -+ FEATURE_DUMP_PHY_EFUSE); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ } -+ -+ if (adapter->efuse_map_valid == 0) { -+ map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ -+ if (read_hw_efuse_88xx(adapter, 0, efuse_size, map) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, efuse_size); -+ return HALMAC_RET_EFUSE_R_FAIL; -+ } -+ -+ PLTFM_MUTEX_LOCK(&adapter->efuse_mutex); -+ PLTFM_MEMCPY(adapter->efuse_map, map, efuse_size); -+ adapter->efuse_map_valid = 1; -+ PLTFM_MUTEX_UNLOCK(&adapter->efuse_mutex); -+ -+ PLTFM_FREE(map, efuse_size); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+dump_efuse_fw_88xx(struct halmac_adapter *adapter) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ u32 efuse_size = adapter->hw_cfg_info.efuse_size; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_DUMP_PHYSICAL_EFUSE; -+ hdr_info.content_size = 0; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ adapter->halmac_state.efuse_state.seq_num = seq_num; -+ -+ if (!adapter->efuse_map) { -+ adapter->efuse_map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!adapter->efuse_map) { -+ PLTFM_MSG_ERR("[ERR]malloc adapter map\n"); -+ reset_ofld_feature_88xx(adapter, -+ FEATURE_DUMP_PHY_EFUSE); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ } -+ -+ if (adapter->efuse_map_valid == 0) { -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c pkt\n"); -+ reset_ofld_feature_88xx(adapter, -+ FEATURE_DUMP_PHY_EFUSE); -+ return status; -+ } -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+proc_write_log_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u8 value) -+{ -+ u8 byte1; -+ u8 byte2; -+ u8 blk; -+ u8 blk_idx; -+ u8 hdr; -+ u8 hdr2; -+ u8 *map = NULL; -+ u32 eeprom_size = adapter->hw_cfg_info.eeprom_size; -+ u32 prtct_efuse_size = adapter->hw_cfg_info.prtct_efuse_size; -+ u32 end; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ map = (u8 *)PLTFM_MALLOC(eeprom_size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, eeprom_size); -+ -+ status = read_log_efuse_map_88xx(adapter, map); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]read logical efuse\n"); -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ if (*(map + offset) != value) { -+ end = adapter->efuse_end; -+ blk = (u8)(offset >> 3); -+ blk_idx = (u8)((offset & (8 - 1)) >> 1); -+ -+ if (offset > 0x7f) { -+ hdr = (((blk & 0x07) << 5) & 0xE0) | 0x0F; -+ hdr2 = (u8)(((blk & 0x78) << 1) + -+ ((0x1 << blk_idx) ^ 0x0F)); -+ } else { -+ hdr = (u8)((blk << 4) + ((0x01 << blk_idx) ^ 0x0F)); -+ } -+ -+ if ((offset & 1) == 0) { -+ byte1 = value; -+ byte2 = *(map + offset + 1); -+ } else { -+ byte1 = *(map + offset - 1); -+ byte2 = value; -+ } -+ -+ if (offset > 0x7f) { -+ if (adapter->hw_cfg_info.efuse_size <= -+ 4 + prtct_efuse_size + end) { -+ PLTFM_FREE(map, eeprom_size); -+ return HALMAC_RET_EFUSE_NOT_ENOUGH; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end, hdr); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end + 1, hdr2); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end + 2, byte1); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end + 3, byte2); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ } else { -+ if (adapter->hw_cfg_info.efuse_size <= -+ 3 + prtct_efuse_size + end) { -+ PLTFM_FREE(map, eeprom_size); -+ return HALMAC_RET_EFUSE_NOT_ENOUGH; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end, hdr); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end + 1, byte1); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end + 2, byte2); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ } -+ } -+ -+ PLTFM_FREE(map, eeprom_size); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+proc_write_log_efuse_word_88xx(struct halmac_adapter *adapter, u32 offset, -+ u16 value) -+{ -+ u8 byte1; -+ u8 byte2; -+ u8 blk; -+ u8 blk_idx; -+ u8 hdr; -+ u8 hdr2; -+ u8 *map = NULL; -+ u32 eeprom_size = adapter->hw_cfg_info.eeprom_size; -+ u32 prtct_efuse_size = adapter->hw_cfg_info.prtct_efuse_size; -+ u32 end; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ map = (u8 *)PLTFM_MALLOC(eeprom_size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, eeprom_size); -+ -+ status = read_log_efuse_map_88xx(adapter, map); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]read logical efuse\n"); -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ end = adapter->efuse_end; -+ blk = (u8)(offset >> 3); -+ blk_idx = (u8)((offset & (8 - 1)) >> 1); -+ -+ if (offset > 0x7f) { -+ hdr = (((blk & 0x07) << 5) & 0xE0) | 0x0F; -+ hdr2 = (u8)(((blk & 0x78) << 1) + -+ ((0x1 << blk_idx) ^ 0x0F)); -+ } else { -+ hdr = (u8)((blk << 4) + ((0x01 << blk_idx) ^ 0x0F)); -+ } -+ -+ if ((offset & 1) == 0) { -+ byte1 = (u8)(value & 0xFF); -+ byte2 = (u8)((value >> 8) & 0xFF); -+ } else { -+ PLTFM_FREE(map, eeprom_size); -+ return HALMAC_RET_ADR_NOT_ALIGN; -+ } -+ -+ if (offset > 0x7f) { -+ if (adapter->hw_cfg_info.efuse_size <= -+ 4 + prtct_efuse_size + end) { -+ PLTFM_FREE(map, eeprom_size); -+ return HALMAC_RET_EFUSE_NOT_ENOUGH; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end, hdr); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end + 1, hdr2); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end + 2, byte1); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end + 3, byte2); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ } else { -+ if (adapter->hw_cfg_info.efuse_size <= -+ 3 + prtct_efuse_size + end) { -+ PLTFM_FREE(map, eeprom_size); -+ return HALMAC_RET_EFUSE_NOT_ENOUGH; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end, hdr); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end + 1, byte1); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, end + 2, byte2); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ } -+ -+ PLTFM_FREE(map, eeprom_size); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+read_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u32 size, u8 *map) -+{ -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_NULL_POINTER; -+ } -+ -+ if (adapter->efuse_map_valid == 1) { -+ PLTFM_MEMCPY(map, adapter->efuse_map + offset, size); -+ } else { -+ if (read_hw_efuse_88xx(adapter, offset, size, map) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_EFUSE_R_FAIL; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+update_eeprom_mask_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 *updated_mask) -+{ -+ u8 *map = NULL; -+ u8 clr_bit = 0; -+ u32 eeprom_size = adapter->hw_cfg_info.eeprom_size; -+ u8 *map_pg; -+ u8 *efuse_mask; -+ u16 i; -+ u16 j; -+ u16 map_offset; -+ u16 mask_offset; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ map = (u8 *)PLTFM_MALLOC(eeprom_size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, eeprom_size); -+ -+ PLTFM_MEMSET(updated_mask, 0x00, info->efuse_mask_size); -+ -+ status = read_log_efuse_map_88xx(adapter, map); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return status; -+ } -+ -+ map_pg = info->efuse_map; -+ efuse_mask = info->efuse_mask; -+ -+ for (i = 0; i < info->efuse_mask_size; i++) -+ *(updated_mask + i) = *(efuse_mask + i); -+ -+ for (i = 0; i < info->efuse_map_size; i += 16) { -+ for (j = 0; j < 16; j += 2) { -+ map_offset = i + j; -+ mask_offset = i >> 4; -+ if (*(u16 *)(map_pg + map_offset) == -+ *(u16 *)(map + map_offset)) { -+ switch (j) { -+ case 0: -+ clr_bit = BIT(4); -+ break; -+ case 2: -+ clr_bit = BIT(5); -+ break; -+ case 4: -+ clr_bit = BIT(6); -+ break; -+ case 6: -+ clr_bit = BIT(7); -+ break; -+ case 8: -+ clr_bit = BIT(0); -+ break; -+ case 10: -+ clr_bit = BIT(1); -+ break; -+ case 12: -+ clr_bit = BIT(2); -+ break; -+ case 14: -+ clr_bit = BIT(3); -+ break; -+ default: -+ break; -+ } -+ *(updated_mask + mask_offset) &= ~clr_bit; -+ } -+ } -+ } -+ -+ PLTFM_FREE(map, eeprom_size); -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+check_efuse_enough_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 *updated_mask) -+{ -+ u8 pre_word_en; -+ u16 i; -+ u16 j; -+ u32 eeprom_offset; -+ u32 pg_num = 0; -+ u8 super_usb; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ status = super_usb_chk_88xx(adapter, &super_usb); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]super_usb_chk\n"); -+ return status; -+ } -+ -+ for (i = 0; i < info->efuse_map_size; i = i + 8) { -+ eeprom_offset = i; -+ -+ if ((eeprom_offset & 7) > 0) -+ pre_word_en = (*(updated_mask + (i >> 4)) & 0x0F); -+ else -+ pre_word_en = (*(updated_mask + (i >> 4)) >> 4); -+ -+ if (pre_word_en > 0) { -+ if (super_usb && -+ ((eeprom_offset >= SUPER_USB_ZONE0_START && -+ eeprom_offset <= SUPER_USB_ZONE0_END) || -+ (eeprom_offset >= SUPER_USB_ZONE1_START && -+ eeprom_offset <= SUPER_USB_ZONE1_END))) { -+ for (j = 0; j < 4; j++) { -+ if (((pre_word_en >> j) & 0x1) > 0) -+ pg_num += 4; -+ } -+ } else { -+ if (eeprom_offset > 0x7f) -+ pg_num += 2; -+ else -+ pg_num++; -+ -+ for (j = 0; j < 4; j++) { -+ if (((pre_word_en >> j) & 0x1) > 0) -+ pg_num += 2; -+ } -+ } -+ } -+ } -+ -+ if (adapter->hw_cfg_info.efuse_size <= -+ (pg_num + adapter->hw_cfg_info.prtct_efuse_size + -+ adapter->efuse_end)) -+ return HALMAC_RET_EFUSE_NOT_ENOUGH; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+pg_extend_efuse_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 word_en, -+ u8 pre_word_en, u32 eeprom_offset) -+{ -+ u8 blk; -+ u8 hdr; -+ u8 hdr2; -+ u16 i; -+ u32 efuse_end; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ efuse_end = adapter->efuse_end; -+ -+ blk = (u8)(eeprom_offset >> 3); -+ hdr = (((blk & 0x07) << 5) & 0xE0) | 0x0F; -+ hdr2 = (u8)(((blk & 0x78) << 1) + word_en); -+ -+ status = write_hw_efuse_88xx(adapter, efuse_end, hdr); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse\n"); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, efuse_end + 1, hdr2); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse(+1)\n"); -+ return status; -+ } -+ -+ efuse_end = efuse_end + 2; -+ for (i = 0; i < 4; i++) { -+ if (((pre_word_en >> i) & 0x1) > 0) { -+ status = write_hw_efuse_88xx(adapter, efuse_end, -+ *(info->efuse_map + -+ eeprom_offset + -+ (i << 1))); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse(<<1)\n"); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, efuse_end + 1, -+ *(info->efuse_map + -+ eeprom_offset + (i << 1) -+ + 1)); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse(<<1)+1\n"); -+ return status; -+ } -+ efuse_end = efuse_end + 2; -+ } -+ } -+ adapter->efuse_end = efuse_end; -+ return status; -+} -+ -+static enum halmac_ret_status -+proc_pg_efuse_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 word_en, -+ u8 pre_word_en, u32 eeprom_offset) -+{ -+ u8 blk; -+ u8 hdr; -+ u16 i; -+ u32 efuse_end; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ efuse_end = adapter->efuse_end; -+ -+ blk = (u8)(eeprom_offset >> 3); -+ hdr = (u8)((blk << 4) + word_en); -+ -+ status = write_hw_efuse_88xx(adapter, efuse_end, hdr); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse\n"); -+ return status; -+ } -+ efuse_end = efuse_end + 1; -+ for (i = 0; i < 4; i++) { -+ if (((pre_word_en >> i) & 0x1) > 0) { -+ status = write_hw_efuse_88xx(adapter, efuse_end, -+ *(info->efuse_map + -+ eeprom_offset + -+ (i << 1))); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse(<<1)\n"); -+ return status; -+ } -+ status = write_hw_efuse_88xx(adapter, efuse_end + 1, -+ *(info->efuse_map + -+ eeprom_offset + (i << 1) -+ + 1)); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse(<<1)+1\n"); -+ return status; -+ } -+ efuse_end = efuse_end + 2; -+ } -+ } -+ adapter->efuse_end = efuse_end; -+ return status; -+} -+ -+static enum halmac_ret_status -+pg_super_usb_efuse_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 word_en, -+ u8 pre_word_en, u32 eeprom_offset) -+{ -+ u8 blk; -+ u8 hdr; -+ u8 hdr2; -+ u16 i; -+ u32 efuse_end; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ efuse_end = adapter->efuse_end; -+ -+ blk = (u8)(eeprom_offset >> 3); -+ hdr = (((blk & 0x07) << 5) & 0xE0) | 0x0F; -+ -+ for (i = 0; i < 4; i++) { -+ hdr = (((blk & 0x07) << 5) & 0xE0) | 0x0F; -+ if (((pre_word_en >> i) & 0x1) > 0) { -+ hdr2 = (u8)(((blk & 0x78) << 1) + -+ ((pre_word_en & BIT(i)) ^ 0x0F)); -+ -+ status = write_hw_efuse_88xx(adapter, efuse_end, hdr); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse\n"); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, efuse_end + 1, -+ hdr2); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse(+1)\n"); -+ return status; -+ } -+ -+ efuse_end = efuse_end + 2; -+ -+ status = write_hw_efuse_88xx(adapter, efuse_end, -+ *(info->efuse_map + -+ eeprom_offset + -+ (i << 1))); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse(<<1)\n"); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, efuse_end + 1, -+ *(info->efuse_map + -+ eeprom_offset + (i << 1) -+ + 1)); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write efuse(<<1)+1\n"); -+ return status; -+ } -+ efuse_end = efuse_end + 2; -+ } -+ } -+ adapter->efuse_end = efuse_end; -+ return status; -+} -+ -+static enum halmac_ret_status -+program_efuse_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, u8 *updated_mask) -+{ -+ u8 pre_word_en; -+ u8 word_en; -+ u16 i; -+ u32 eeprom_offset; -+ u8 super_usb; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ status = super_usb_chk_88xx(adapter, &super_usb); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]super_usb_chk\n"); -+ return status; -+ } -+ -+ for (i = 0; i < info->efuse_map_size; i = i + 8) { -+ eeprom_offset = i; -+ -+ if (((eeprom_offset >> 3) & 1) > 0) { -+ pre_word_en = (*(updated_mask + (i >> 4)) & 0x0F); -+ word_en = pre_word_en ^ 0x0F; -+ } else { -+ pre_word_en = (*(updated_mask + (i >> 4)) >> 4); -+ word_en = pre_word_en ^ 0x0F; -+ } -+ -+ if (pre_word_en > 0) { -+ if (super_usb && -+ ((eeprom_offset >= SUPER_USB_ZONE0_START && -+ eeprom_offset <= SUPER_USB_ZONE0_END) || -+ (eeprom_offset >= SUPER_USB_ZONE1_START && -+ eeprom_offset <= SUPER_USB_ZONE1_END))) { -+ status = pg_super_usb_efuse_88xx(adapter, info, -+ word_en, -+ pre_word_en, -+ eeprom_offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]super usb efuse\n"); -+ return status; -+ } -+ } else if (eeprom_offset > 0x7f) { -+ status = pg_extend_efuse_88xx(adapter, info, -+ word_en, -+ pre_word_en, -+ eeprom_offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]extend efuse\n"); -+ return status; -+ } -+ } else { -+ status = proc_pg_efuse_88xx(adapter, info, -+ word_en, -+ pre_word_en, -+ eeprom_offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]extend efuse"); -+ return status; -+ } -+ } -+ } -+ } -+ -+ return status; -+} -+ -+static void -+mask_eeprom_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info) -+{ -+ u8 pre_word_en; -+ u8 *updated_mask; -+ u8 *efuse_map; -+ u16 i; -+ u16 j; -+ u32 offset; -+ -+ updated_mask = info->efuse_mask; -+ efuse_map = info->efuse_map; -+ -+ for (i = 0; i < info->efuse_map_size; i = i + 8) { -+ offset = i; -+ -+ if (((offset >> 3) & 1) > 0) -+ pre_word_en = (*(updated_mask + (i >> 4)) & 0x0F); -+ else -+ pre_word_en = (*(updated_mask + (i >> 4)) >> 4); -+ -+ for (j = 0; j < 4; j++) { -+ if (((pre_word_en >> j) & 0x1) == 0) { -+ *(efuse_map + offset + (j << 1)) = 0xFF; -+ *(efuse_map + offset + (j << 1) + 1) = 0xFF; -+ } -+ } -+ } -+} -+ -+enum halmac_ret_status -+get_efuse_data_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seg_id; -+ u8 seg_size; -+ u8 seq_num; -+ u8 fw_rc; -+ u8 *map = NULL; -+ u32 eeprom_size = adapter->hw_cfg_info.eeprom_size; -+ struct halmac_efuse_state *state = &adapter->halmac_state.efuse_state; -+ enum halmac_cmd_process_status proc_status; -+ -+ seq_num = (u8)EFUSE_DATA_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ seg_id = (u8)EFUSE_DATA_GET_SEGMENT_ID(buf); -+ seg_size = (u8)EFUSE_DATA_GET_SEGMENT_SIZE(buf); -+ if (seg_id == 0) -+ adapter->efuse_seg_size = seg_size; -+ -+ map = (u8 *)PLTFM_MALLOC(eeprom_size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, eeprom_size); -+ -+ PLTFM_MUTEX_LOCK(&adapter->efuse_mutex); -+ PLTFM_MEMCPY(adapter->efuse_map + seg_id * adapter->efuse_seg_size, -+ buf + C2H_DATA_OFFSET_88XX, seg_size); -+ PLTFM_MUTEX_UNLOCK(&adapter->efuse_mutex); -+ -+ if (EFUSE_DATA_GET_END_SEGMENT(buf) == 0) { -+ PLTFM_FREE(map, eeprom_size); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = state->fw_rc; -+ -+ if ((enum halmac_h2c_return_code)fw_rc == HALMAC_H2C_RETURN_SUCCESS) { -+ proc_status = HALMAC_CMD_PROCESS_DONE; -+ state->proc_status = proc_status; -+ -+ PLTFM_MUTEX_LOCK(&adapter->efuse_mutex); -+ adapter->efuse_map_valid = 1; -+ PLTFM_MUTEX_UNLOCK(&adapter->efuse_mutex); -+ -+ if (adapter->evnt.phy_efuse_map == 1) { -+ PLTFM_EVENT_SIG(FEATURE_DUMP_PHY_EFUSE, -+ proc_status, adapter->efuse_map, -+ adapter->hw_cfg_info.efuse_size); -+ adapter->evnt.phy_efuse_map = 0; -+ } -+ -+ if (adapter->evnt.log_efuse_map == 1) { -+ if (eeprom_parser_88xx(adapter, adapter->efuse_map, -+ map) != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ PLTFM_EVENT_SIG(FEATURE_DUMP_LOG_EFUSE, proc_status, -+ map, eeprom_size); -+ adapter->evnt.log_efuse_map = 0; -+ } -+ -+ if (adapter->evnt.log_efuse_mask == 1) { -+ if (eeprom_mask_parser_88xx(adapter, adapter->efuse_map, -+ map) -+ != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ PLTFM_EVENT_SIG(FEATURE_DUMP_LOG_EFUSE_MASK, -+ proc_status, map, eeprom_size); -+ adapter->evnt.log_efuse_mask = 0; -+ } -+ -+ } else { -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ state->proc_status = proc_status; -+ -+ if (adapter->evnt.phy_efuse_map == 1) { -+ PLTFM_EVENT_SIG(FEATURE_DUMP_PHY_EFUSE, proc_status, -+ &state->fw_rc, 1); -+ adapter->evnt.phy_efuse_map = 0; -+ } -+ -+ if (adapter->evnt.log_efuse_map == 1) { -+ PLTFM_EVENT_SIG(FEATURE_DUMP_LOG_EFUSE, proc_status, -+ &state->fw_rc, 1); -+ adapter->evnt.log_efuse_map = 0; -+ } -+ -+ if (adapter->evnt.log_efuse_mask == 1) { -+ PLTFM_EVENT_SIG(FEATURE_DUMP_LOG_EFUSE_MASK, -+ proc_status, &state->fw_rc, 1); -+ adapter->evnt.log_efuse_mask = 0; -+ } -+ } -+ -+ PLTFM_FREE(map, eeprom_size); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_dump_phy_efuse_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status, -+ u8 *data, u32 *size) -+{ -+ u8 *map = NULL; -+ u32 efuse_size = adapter->hw_cfg_info.efuse_size; -+ u32 prtct_efuse_size = adapter->hw_cfg_info.prtct_efuse_size; -+ struct halmac_efuse_state *state = &adapter->halmac_state.efuse_state; -+ -+ *proc_status = state->proc_status; -+ -+ if (!data) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (!size) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_DONE) { -+ if (*size < efuse_size) { -+ *size = efuse_size; -+ return HALMAC_RET_BUFFER_TOO_SMALL; -+ } -+ -+ *size = efuse_size; -+ -+ map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, efuse_size); -+ PLTFM_MUTEX_LOCK(&adapter->efuse_mutex); -+#if HALMAC_PLATFORM_WINDOWS -+ PLTFM_MEMCPY(map, adapter->efuse_map, efuse_size); -+#else -+ PLTFM_MEMCPY(map, adapter->efuse_map, -+ efuse_size - prtct_efuse_size); -+ PLTFM_MEMCPY(map + efuse_size - prtct_efuse_size + -+ RSVD_CS_EFUSE_SIZE, -+ adapter->efuse_map + efuse_size - -+ prtct_efuse_size + RSVD_CS_EFUSE_SIZE, -+ prtct_efuse_size - RSVD_EFUSE_SIZE - -+ RSVD_CS_EFUSE_SIZE); -+#endif -+ PLTFM_MUTEX_UNLOCK(&adapter->efuse_mutex); -+ -+ PLTFM_MEMCPY(data, map, *size); -+ -+ PLTFM_FREE(map, efuse_size); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_dump_log_efuse_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status, -+ u8 *data, u32 *size) -+{ -+ u8 *map = NULL; -+ u32 eeprom_size = adapter->hw_cfg_info.eeprom_size; -+ struct halmac_efuse_state *state = &adapter->halmac_state.efuse_state; -+ -+ *proc_status = state->proc_status; -+ -+ if (!data) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (!size) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_DONE) { -+ if (*size < eeprom_size) { -+ *size = eeprom_size; -+ return HALMAC_RET_BUFFER_TOO_SMALL; -+ } -+ -+ *size = eeprom_size; -+ -+ map = (u8 *)PLTFM_MALLOC(eeprom_size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, eeprom_size); -+ -+ if (eeprom_parser_88xx(adapter, adapter->efuse_map, map) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ -+ PLTFM_MEMCPY(data, map, *size); -+ -+ PLTFM_FREE(map, eeprom_size); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_dump_log_efuse_mask_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status, -+ u8 *data, u32 *size) -+{ -+ u8 *map = NULL; -+ u32 eeprom_size = adapter->hw_cfg_info.eeprom_size; -+ struct halmac_efuse_state *state = &adapter->halmac_state.efuse_state; -+ -+ *proc_status = state->proc_status; -+ -+ if (!data) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (!size) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_DONE) { -+ if (*size < eeprom_size) { -+ *size = eeprom_size; -+ return HALMAC_RET_BUFFER_TOO_SMALL; -+ } -+ -+ *size = eeprom_size; -+ -+ map = (u8 *)PLTFM_MALLOC(eeprom_size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, eeprom_size); -+ -+ if (eeprom_mask_parser_88xx(adapter, adapter->efuse_map, map) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, eeprom_size); -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ -+ PLTFM_MEMCPY(data, map, *size); -+ -+ PLTFM_FREE(map, eeprom_size); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_h2c_ack_phy_efuse_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seq_num = 0; -+ u8 fw_rc; -+ struct halmac_efuse_state *state = &adapter->halmac_state.efuse_state; -+ -+ seq_num = (u8)H2C_ACK_HDR_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch : h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not cmd sending\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ state->fw_rc = fw_rc; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+u32 -+get_rsvd_efuse_size_88xx(struct halmac_adapter *adapter) -+{ -+ return adapter->hw_cfg_info.prtct_efuse_size; -+} -+ -+/** -+ * write_wifi_phy_efuse_88xx() - write wifi physical efuse -+ * @adapter : the adapter of halmac -+ * @offset : the efuse offset to be written -+ * @value : the value to be written -+ * Author : Yong-Ching Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+write_wifi_phy_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u8 value) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (offset >= adapter->hw_cfg_info.efuse_size) { -+ PLTFM_MSG_ERR("[ERR]Offset is too large\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank\n"); -+ return status; -+ } -+ -+ status = write_hw_efuse_88xx(adapter, offset, value); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]write physical efuse\n"); -+ return status; -+ } -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * read_wifi_phy_efuse_88xx() - read wifi physical efuse -+ * @adapter : the adapter of halmac -+ * @offset : the efuse offset to be read -+ * @size : the length to be read -+ * @value : pointer to the pre-allocated space where -+ the efuse content is to be copied -+ * Author : Yong-Ching Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+read_wifi_phy_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u32 size, -+ u8 *value) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_cmd_process_status *proc_status; -+ -+ proc_status = &adapter->halmac_state.efuse_state.proc_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (offset >= adapter->hw_cfg_info.efuse_size || -+ offset + size >= adapter->hw_cfg_info.efuse_size) { -+ PLTFM_MSG_ERR("[ERR] Wrong efuse index\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_WARN("[WARN]Wait event(efuse)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (efuse_cmd_cnstr_state_88xx(adapter) != HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_WARN("[WARN]Not idle(efuse)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ status = switch_efuse_bank_88xx(adapter, HALMAC_EFUSE_BANK_WIFI); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]switch efuse bank\n"); -+ return status; -+ } -+ -+ status = read_hw_efuse_88xx(adapter, offset, size, value); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]read hw efuse\n"); -+ return status; -+ } -+ -+ if (cnv_efuse_state_88xx(adapter, HALMAC_CMD_CNSTR_IDLE) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+proc_gen_super_usb_map_88xx(struct halmac_adapter *adapter, u8 *drv_map, -+ u8 *updated_map, u8 *updated_mask) -+{ -+ u8 *local_map = NULL; -+ u8 *super_usb_map = NULL; -+ u8 *super_usb_mask = NULL; -+ u8 mask_val_0; -+ u8 mask_val_1; -+ u32 efuse_size; -+ u32 i; -+ u32 j; -+ u32 val32; -+ u32 map_size = adapter->hw_cfg_info.eeprom_size; -+ u32 mask_size = adapter->hw_cfg_info.eeprom_size >> 4; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (adapter->efuse_map_valid == 0) { -+ efuse_size = adapter->hw_cfg_info.efuse_size; -+ -+ local_map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!local_map) { -+ PLTFM_MSG_ERR("[ERR]local map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ -+ status = read_efuse_88xx(adapter, 0, efuse_size, local_map); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]read efuse\n"); -+ PLTFM_FREE(local_map, efuse_size); -+ return status; -+ } -+ -+ if (!adapter->efuse_map) { -+ adapter->efuse_map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!adapter->efuse_map) { -+ PLTFM_MSG_ERR("[ERR]malloc adapter map\n"); -+ PLTFM_FREE(local_map, efuse_size); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ } -+ -+ PLTFM_MUTEX_LOCK(&adapter->efuse_mutex); -+ PLTFM_MEMCPY(adapter->efuse_map, local_map, efuse_size); -+ adapter->efuse_map_valid = 1; -+ PLTFM_MUTEX_UNLOCK(&adapter->efuse_mutex); -+ -+ PLTFM_FREE(local_map, efuse_size); -+ } -+ -+ super_usb_mask = (u8 *)PLTFM_MALLOC(mask_size); -+ if (!super_usb_mask) { -+ PLTFM_MSG_ERR("[ERR]malloc updated mask\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(super_usb_mask, 0x00, mask_size); -+ -+ super_usb_map = (u8 *)PLTFM_MALLOC(map_size); -+ if (!super_usb_map) { -+ PLTFM_MSG_ERR("[ERR]malloc updated map\n"); -+ PLTFM_FREE(super_usb_mask, mask_size); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(super_usb_map, 0xFF, map_size); -+ -+ status = super_usb_efuse_parser_88xx(adapter, adapter->efuse_map, -+ super_usb_map, super_usb_mask); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(super_usb_mask, mask_size); -+ PLTFM_FREE(super_usb_map, map_size); -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ -+ for (i = 0; i < map_size; i = i + 16) { -+ mask_val_0 = *(updated_mask + (i >> 4)); -+ mask_val_1 = *(super_usb_mask + (i >> 4)); -+ if (mask_val_0 || mask_val_1) { -+ for (j = 0; j < 4; j++) { -+ val32 = i + (j << 1); -+ if (mask_val_0 & BIT(j + 4)) { -+ *(updated_map + val32) = -+ *(drv_map + val32); -+ *(updated_map + val32 + 1) = -+ *(drv_map + val32 + 1); -+ } else if (mask_val_1 & BIT(j + 4)) { -+ *(updated_map + val32) = -+ *(super_usb_map + val32); -+ *(updated_map + val32 + 1) = -+ *(super_usb_map + val32 + 1); -+ } -+ } -+ for (j = 0; j < 4; j++) { -+ val32 = i + (j << 1); -+ if (mask_val_0 & BIT(j)) { -+ *(updated_map + val32 + 8) = -+ *(drv_map + val32 + 8); -+ *(updated_map + val32 + 9) = -+ *(drv_map + val32 + 9); -+ } else if (mask_val_1 & BIT(j)) { -+ *(updated_map + val32 + 8) = -+ *(super_usb_map + val32 + 8); -+ *(updated_map + val32 + 9) = -+ *(super_usb_map + val32 + 9); -+ } -+ } -+ *(updated_mask + (i >> 4)) |= mask_val_1; -+ } -+ } -+ -+ PLTFM_FREE(super_usb_mask, mask_size); -+ PLTFM_FREE(super_usb_map, map_size); -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+super_usb_efuse_parser_88xx(struct halmac_adapter *adapter, u8 *phy_map, -+ u8 *log_map, u8 *log_mask) -+{ -+ u8 i; -+ u8 value8; -+ u8 blk_idx; -+ u8 word_en; -+ u8 valid; -+ u8 hdr; -+ u8 hdr2 = 0; -+ u8 usb_addr; -+ u32 eeprom_idx; -+ u32 efuse_idx = 0; -+ u32 start_offset; -+ u32 prtct_efuse_size = adapter->hw_cfg_info.prtct_efuse_size; -+ struct halmac_hw_cfg_info *hw_info = &adapter->hw_cfg_info; -+ -+ do { -+ value8 = *(phy_map + efuse_idx); -+ hdr = value8; -+ -+ if ((hdr & 0x1f) == 0x0f) { -+ efuse_idx++; -+ value8 = *(phy_map + efuse_idx); -+ hdr2 = value8; -+ if (hdr2 == 0xff) -+ break; -+ blk_idx = ((hdr2 & 0xF0) >> 1) | ((hdr >> 5) & 0x07); -+ word_en = hdr2 & 0x0F; -+ } else { -+ blk_idx = (hdr & 0xF0) >> 4; -+ word_en = hdr & 0x0F; -+ } -+ -+ if (hdr == 0xff) -+ break; -+ -+ efuse_idx++; -+ -+ if (efuse_idx >= hw_info->efuse_size - prtct_efuse_size - 1) -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ -+ for (i = 0; i < 4; i++) { -+ valid = (u8)((~(word_en >> i)) & BIT(0)); -+ if (valid == 1) { -+ eeprom_idx = (blk_idx << 3) + (i << 1); -+ -+ if ((eeprom_idx + 1) > hw_info->eeprom_size) { -+ PLTFM_MSG_ERR("[ERR]efuse idx:0x%X\n", -+ efuse_idx - 1); -+ -+ PLTFM_MSG_ERR("[ERR]read hdr:0x%X\n", -+ hdr); -+ -+ PLTFM_MSG_ERR("[ERR]rad hdr2:0x%X\n", -+ hdr2); -+ -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ -+ value8 = *(phy_map + efuse_idx); -+ *(log_map + eeprom_idx) = value8; -+ -+ eeprom_idx++; -+ efuse_idx++; -+ -+ if (efuse_idx > hw_info->efuse_size - -+ prtct_efuse_size - 1) -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ -+ value8 = *(phy_map + efuse_idx); -+ *(log_map + eeprom_idx) = value8; -+ -+ efuse_idx++; -+ -+ if (efuse_idx > hw_info->efuse_size - -+ prtct_efuse_size) -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ } -+ -+ start_offset = blk_idx << 3; -+ if ((start_offset >= SUPER_USB_ZONE0_START && -+ start_offset <= SUPER_USB_ZONE0_END) || -+ (start_offset >= SUPER_USB_ZONE1_START && -+ start_offset <= SUPER_USB_ZONE1_END)) -+ usb_addr = 1; -+ else -+ usb_addr = 0; -+ if (usb_addr) { -+ if (word_en != 0xE && word_en != 0xD && -+ word_en != 0xB && word_en != 0x7) { -+ if (blk_idx & 1) -+ *(log_mask + (blk_idx >> 1)) |= -+ ~word_en & 0x0F; -+ else -+ *(log_mask + (blk_idx >> 1)) |= -+ ~(word_en << 4) & 0xF0; -+ } else { -+ if (blk_idx & 1) -+ *(log_mask + (blk_idx >> 1)) &= -+ word_en | 0xF0; -+ else -+ *(log_mask + (blk_idx >> 1)) &= -+ (word_en << 4) | 0x0F; -+ } -+ } -+ } while (1); -+ -+ adapter->efuse_end = efuse_idx; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+super_usb_chk_88xx(struct halmac_adapter *adapter, u8 *super_usb) -+{ -+ u8 *local_map = NULL; -+ u32 efuse_size; -+ u8 re_pg; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822C && -+ (adapter->intf == HALMAC_INTERFACE_PCIE || -+ adapter->intf == HALMAC_INTERFACE_USB)) { -+ *super_usb = 1; -+ } else { -+ *super_usb = 0; -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (adapter->efuse_map_valid == 0) { -+ efuse_size = adapter->hw_cfg_info.efuse_size; -+ -+ local_map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!local_map) { -+ PLTFM_MSG_ERR("[ERR]local map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ -+ status = read_efuse_88xx(adapter, 0, efuse_size, local_map); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]read efuse\n"); -+ PLTFM_FREE(local_map, efuse_size); -+ return status; -+ } -+ -+ if (!adapter->efuse_map) { -+ adapter->efuse_map = (u8 *)PLTFM_MALLOC(efuse_size); -+ if (!adapter->efuse_map) { -+ PLTFM_MSG_ERR("[ERR]malloc adapter map\n"); -+ PLTFM_FREE(local_map, efuse_size); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ } -+ -+ PLTFM_MUTEX_LOCK(&adapter->efuse_mutex); -+ PLTFM_MEMCPY(adapter->efuse_map, local_map, efuse_size); -+ adapter->efuse_map_valid = 1; -+ PLTFM_MUTEX_UNLOCK(&adapter->efuse_mutex); -+ -+ PLTFM_FREE(local_map, efuse_size); -+ } -+ -+ status = super_usb_re_pg_chk_88xx(adapter, adapter->efuse_map, &re_pg); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ if (re_pg) { -+ status = super_usb_fmt_chk_88xx(adapter, &re_pg); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ if (re_pg == 1) { -+ *super_usb = 0; -+ return HALMAC_RET_SUCCESS; -+ } -+ } -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+log_efuse_re_pg_chk_88xx(struct halmac_adapter *adapter, u8 *efuse_mask, -+ u32 addr, u8 *re_pg) -+{ -+ u32 size = adapter->hw_cfg_info.eeprom_size; -+ u8 mask_val; -+ u8 mask_offset; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (addr >= size) { -+ PLTFM_MSG_ERR("[ERR]Offset is too large\n"); -+ return HALMAC_RET_EFUSE_SIZE_INCORRECT; -+ } -+ -+ mask_val = *(efuse_mask + (addr >> 4)); -+ if (addr & 0x8) -+ mask_offset = BIT((addr & 0x7) >> 1); -+ else -+ mask_offset = BIT((addr & 0x7) >> 1) << 4; -+ -+ if (mask_val & mask_offset) -+ *re_pg = 1; -+ else -+ *re_pg = 0; -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+super_usb_fmt_chk_88xx(struct halmac_adapter *adapter, u8 *re_pg) -+{ -+ u32 map_size = adapter->hw_cfg_info.eeprom_size; -+ u32 mask_size = adapter->hw_cfg_info.eeprom_size >> 4; -+ u32 addr; -+ u8 *super_usb_map = NULL; -+ u8 *super_usb_mask = NULL; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ super_usb_mask = (u8 *)PLTFM_MALLOC(mask_size); -+ if (!super_usb_mask) { -+ PLTFM_MSG_ERR("[ERR]malloc updated mask\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(super_usb_mask, 0x00, mask_size); -+ -+ super_usb_map = (u8 *)PLTFM_MALLOC(map_size); -+ if (!super_usb_map) { -+ PLTFM_MSG_ERR("[ERR]malloc updated map\n"); -+ PLTFM_FREE(super_usb_mask, mask_size); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(super_usb_map, 0xFF, map_size); -+ -+ status = super_usb_efuse_parser_88xx(adapter, adapter->efuse_map, -+ super_usb_map, super_usb_mask); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(super_usb_mask, mask_size); -+ PLTFM_FREE(super_usb_map, map_size); -+ return HALMAC_RET_EEPROM_PARSING_FAIL; -+ } -+ -+ for (addr = SUPER_USB_ZONE0_START; -+ addr <= SUPER_USB_ZONE0_END; addr++) { -+ status = log_efuse_re_pg_chk_88xx(adapter, super_usb_mask, addr, -+ re_pg); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(super_usb_mask, mask_size); -+ PLTFM_FREE(super_usb_map, map_size); -+ return status; -+ } -+ if (*re_pg == 1) { -+ PLTFM_FREE(super_usb_mask, mask_size); -+ PLTFM_FREE(super_usb_map, map_size); -+ return status; -+ } -+ } -+ -+ for (addr = SUPER_USB_ZONE1_START; -+ addr <= SUPER_USB_ZONE1_END; addr++) { -+ status = log_efuse_re_pg_chk_88xx(adapter, super_usb_mask, addr, -+ re_pg); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(super_usb_mask, mask_size); -+ PLTFM_FREE(super_usb_map, map_size); -+ return status; -+ } -+ if (*re_pg == 1) { -+ PLTFM_FREE(super_usb_mask, mask_size); -+ PLTFM_FREE(super_usb_map, map_size); -+ return status; -+ } -+ } -+ -+ *re_pg = 0; -+ -+ PLTFM_FREE(super_usb_mask, mask_size); -+ PLTFM_FREE(super_usb_map, map_size); -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+super_usb_re_pg_chk_88xx(struct halmac_adapter *adapter, u8 *phy_map, u8 *re_pg) -+{ -+ u32 size = adapter->hw_cfg_info.eeprom_size; -+ u32 addr; -+ u8 *map = NULL; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ map = (u8 *)PLTFM_MALLOC(size); -+ if (!map) { -+ PLTFM_MSG_ERR("[ERR]malloc map\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(map, 0xFF, size); -+ -+ status = eeprom_mask_parser_88xx(adapter, phy_map, map); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(map, size); -+ return status; -+ } -+ -+ for (addr = SUPER_USB_RE_PG_CK_ZONE0_START; -+ addr <= SUPER_USB_RE_PG_CK_ZONE0_END; addr++) { -+ if (*(map + addr) != 0xFF) { -+ PLTFM_FREE(map, size); -+ *re_pg = 1; -+ return status; -+ } -+ } -+ -+ *re_pg = 0; -+ -+ PLTFM_FREE(map, size); -+ -+ return status; -+} -+#endif /* HALMAC_88XX_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_efuse_88xx.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_efuse_88xx.h -new file mode 100644 -index 000000000..0e20f2b01 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_efuse_88xx.h -@@ -0,0 +1,131 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_EFUSE_88XX_H_ -+#define _HALMAC_EFUSE_88XX_H_ -+ -+#include "../halmac_api.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+enum halmac_ret_status -+dump_efuse_map_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg); -+ -+enum halmac_ret_status -+eeprom_parser_88xx(struct halmac_adapter *adapter, u8 *phy_map, u8 *log_map); -+ -+enum halmac_ret_status -+eeprom_mask_parser_88xx(struct halmac_adapter *adapter, u8 *phy_map, -+ u8 *log_mask); -+ -+enum halmac_ret_status -+dump_efuse_map_bt_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_bank bank, u32 size, u8 *map); -+ -+enum halmac_ret_status -+write_efuse_bt_88xx(struct halmac_adapter *adapter, u32 offset, u8 value, -+ enum halmac_efuse_bank bank); -+ -+enum halmac_ret_status -+read_efuse_bt_88xx(struct halmac_adapter *adapter, u32 offset, u8 *value, -+ enum halmac_efuse_bank bank); -+ -+enum halmac_ret_status -+cfg_efuse_auto_check_88xx(struct halmac_adapter *adapter, u8 enable); -+ -+enum halmac_ret_status -+get_efuse_available_size_88xx(struct halmac_adapter *adapter, u32 *size); -+ -+enum halmac_ret_status -+get_efuse_size_88xx(struct halmac_adapter *adapter, u32 *size); -+ -+enum halmac_ret_status -+get_log_efuse_size_88xx(struct halmac_adapter *adapter, u32 *size); -+ -+enum halmac_ret_status -+dump_log_efuse_map_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg); -+enum halmac_ret_status -+dump_log_efuse_mask_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg); -+ -+enum halmac_ret_status -+read_logical_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u8 *value); -+ -+enum halmac_ret_status -+write_log_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u8 value); -+ -+enum halmac_ret_status -+write_log_efuse_word_88xx(struct halmac_adapter *adapter, u32 offset, -+ u16 value); -+ -+enum halmac_ret_status -+pg_efuse_by_map_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, -+ enum halmac_efuse_read_cfg cfg); -+ -+enum halmac_ret_status -+mask_log_efuse_88xx(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info); -+ -+enum halmac_ret_status -+read_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u32 size, u8 *map); -+ -+enum halmac_ret_status -+write_hw_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u8 value); -+ -+enum halmac_ret_status -+switch_efuse_bank_88xx(struct halmac_adapter *adapter, -+ enum halmac_efuse_bank bank); -+ -+enum halmac_ret_status -+get_efuse_data_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+enum halmac_ret_status -+cnv_efuse_state_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_construct_state dest_state); -+ -+enum halmac_ret_status -+get_dump_phy_efuse_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status, -+ u8 *data, u32 *size); -+ -+enum halmac_ret_status -+get_dump_log_efuse_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status, -+ u8 *data, u32 *size); -+ -+enum halmac_ret_status -+get_dump_log_efuse_mask_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status, -+ u8 *data, u32 *size); -+ -+enum halmac_ret_status -+get_h2c_ack_phy_efuse_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+u32 -+get_rsvd_efuse_size_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+write_wifi_phy_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u8 value); -+ -+enum halmac_ret_status -+read_wifi_phy_efuse_88xx(struct halmac_adapter *adapter, u32 offset, u32 size, -+ u8 *value); -+ -+#endif /* HALMAC_88XX_SUPPORT */ -+ -+#endif/* _HALMAC_EFUSE_88XX_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_flash_88xx.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_flash_88xx.c -new file mode 100644 -index 000000000..cfdf006b5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_flash_88xx.c -@@ -0,0 +1,343 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_flash_88xx.h" -+#include "halmac_88xx_cfg.h" -+#include "halmac_common_88xx.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+/** -+ * download_flash_88xx() -download firmware to flash -+ * @adapter : the adapter of halmac -+ * @fw_bin : pointer to fw -+ * @size : fw size -+ * @rom_addr : flash start address where fw should be download -+ * Author : Pablo Chiu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+download_flash_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size, -+ u32 rom_addr) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status rc; -+ struct halmac_h2c_header_info hdr_info; -+ u8 value8; -+ u8 restore[3]; -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = {0}; -+ u16 seq_num = 0; -+ u16 h2c_info_offset; -+ u32 pkt_size; -+ u32 mem_offset; -+ u32 cnt; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ value8 = HALMAC_REG_R8(REG_CR + 1); -+ restore[0] = value8; -+ value8 = (u8)(value8 | BIT(0)); -+ HALMAC_REG_W8(REG_CR + 1, value8); -+ -+ value8 = HALMAC_REG_R8(REG_BCN_CTRL); -+ restore[1] = value8; -+ value8 = (u8)((value8 & ~(BIT(3))) | BIT(4)); -+ HALMAC_REG_W8(REG_BCN_CTRL, value8); -+ -+ value8 = HALMAC_REG_R8(REG_FWHW_TXQ_CTRL + 2); -+ restore[2] = value8; -+ value8 = (u8)(value8 & ~(BIT(6))); -+ HALMAC_REG_W8(REG_FWHW_TXQ_CTRL + 2, value8); -+ -+ /* Download FW to Flash flow */ -+ h2c_info_offset = adapter->txff_alloc.rsvd_h2c_info_addr - -+ adapter->txff_alloc.rsvd_boundary; -+ mem_offset = 0; -+ -+ while (size != 0) { -+ if (size >= (DL_FLASH_RSVDPG_SIZE - 48)) -+ pkt_size = DL_FLASH_RSVDPG_SIZE - 48; -+ else -+ pkt_size = size; -+ -+ rc = dl_rsvd_page_88xx(adapter, -+ adapter->txff_alloc.rsvd_h2c_info_addr, -+ fw_bin + mem_offset, pkt_size); -+ if (rc != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dl rsvd pg!!\n"); -+ return rc; -+ } -+ -+ DOWNLOAD_FLASH_SET_SPI_CMD(h2c_buf, 0x02); -+ DOWNLOAD_FLASH_SET_LOCATION(h2c_buf, h2c_info_offset); -+ DOWNLOAD_FLASH_SET_SIZE(h2c_buf, pkt_size); -+ DOWNLOAD_FLASH_SET_START_ADDR(h2c_buf, rom_addr); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_DOWNLOAD_FLASH; -+ hdr_info.content_size = 20; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ rc = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (rc != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ return rc; -+ } -+ -+ value8 = HALMAC_REG_R8(REG_MCUTST_I); -+ value8 |= BIT(0); -+ HALMAC_REG_W8(REG_MCUTST_I, value8); -+ -+ rom_addr += pkt_size; -+ mem_offset += pkt_size; -+ size -= pkt_size; -+ -+ cnt = 1000; -+ while (((HALMAC_REG_R8(REG_MCUTST_I)) & BIT(0)) != 0) { -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]dl flash!!\n"); -+ return HALMAC_RET_DLFW_FAIL; -+ } -+ cnt--; -+ PLTFM_DELAY_US(1000); -+ } -+ } -+ -+ HALMAC_REG_W8(REG_FWHW_TXQ_CTRL + 2, restore[2]); -+ HALMAC_REG_W8(REG_BCN_CTRL, restore[1]); -+ HALMAC_REG_W8(REG_CR + 1, restore[0]); -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * read_flash_88xx() -read data from flash -+ * @adapter : the adapter of halmac -+ * @addr : flash start address where fw should be read -+ * Author : Pablo Chiu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+read_flash_88xx(struct halmac_adapter *adapter, u32 addr, u32 length, u8 *data) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status status; -+ struct halmac_h2c_header_info hdr_info; -+ u8 value8; -+ u8 restore[3]; -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = {0}; -+ u16 seq_num = 0; -+ u16 h2c_pg_addr = adapter->txff_alloc.rsvd_h2c_info_addr; -+ u16 rsvd_pg_addr = adapter->txff_alloc.rsvd_boundary; -+ u16 h2c_info_addr; -+ u32 cnt; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ value8 = HALMAC_REG_R8(REG_CR + 1); -+ restore[0] = value8; -+ value8 = (u8)(value8 | BIT(0)); -+ HALMAC_REG_W8(REG_CR + 1, value8); -+ -+ value8 = HALMAC_REG_R8(REG_BCN_CTRL); -+ restore[1] = value8; -+ value8 = (u8)((value8 & ~(BIT(3))) | BIT(4)); -+ HALMAC_REG_W8(REG_BCN_CTRL, value8); -+ -+ value8 = HALMAC_REG_R8(REG_FWHW_TXQ_CTRL + 2); -+ restore[2] = value8; -+ value8 = (u8)(value8 & ~(BIT(6))); -+ HALMAC_REG_W8(REG_FWHW_TXQ_CTRL + 2, value8); -+ -+ HALMAC_REG_W16(REG_FIFOPAGE_CTRL_2, h2c_pg_addr); -+ value8 = HALMAC_REG_R8(REG_MCUTST_I); -+ value8 |= BIT(0); -+ HALMAC_REG_W8(REG_MCUTST_I, value8); -+ -+ /* Construct H2C Content */ -+ DOWNLOAD_FLASH_SET_SPI_CMD(h2c_buf, 0x03); -+ DOWNLOAD_FLASH_SET_LOCATION(h2c_buf, h2c_pg_addr - rsvd_pg_addr); -+ DOWNLOAD_FLASH_SET_SIZE(h2c_buf, length); -+ DOWNLOAD_FLASH_SET_START_ADDR(h2c_buf, addr); -+ -+ /* Fill in H2C Header */ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_DOWNLOAD_FLASH; -+ hdr_info.content_size = 16; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ /* Send H2C Cmd Packet */ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ return status; -+ } -+ -+ cnt = 5000; -+ while (((HALMAC_REG_R8(REG_MCUTST_I)) & BIT(0)) != 0) { -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]read flash!!\n"); -+ return HALMAC_RET_FAIL; -+ } -+ cnt--; -+ PLTFM_DELAY_US(1000); -+ } -+ -+ HALMAC_REG_W8_CLR(REG_MCUTST_I, BIT(0)); -+ -+ HALMAC_REG_W16(REG_FIFOPAGE_CTRL_2, rsvd_pg_addr); -+ HALMAC_REG_W8(REG_FWHW_TXQ_CTRL + 2, restore[2]); -+ HALMAC_REG_W8(REG_BCN_CTRL, restore[1]); -+ HALMAC_REG_W8(REG_CR + 1, restore[0]); -+ -+ h2c_info_addr = h2c_pg_addr << TX_PAGE_SIZE_SHIFT_88XX; -+ status = dump_fifo_88xx(adapter, HAL_FIFO_SEL_TX, h2c_info_addr, -+ length, data); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dump fifo!!\n"); -+ return status; -+ } -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * erase_flash_88xx() -erase flash data -+ * @adapter : the adapter of halmac -+ * @erase_cmd : erase command -+ * @addr : flash start address where fw should be erased -+ * Author : Pablo Chiu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+erase_flash_88xx(struct halmac_adapter *adapter, u8 erase_cmd, u32 addr) -+{ -+ enum halmac_ret_status status; -+ struct halmac_h2c_header_info hdr_info; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u8 value8; -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = {0}; -+ u16 seq_num = 0; -+ u32 cnt; -+ -+ /* Construct H2C Content */ -+ DOWNLOAD_FLASH_SET_SPI_CMD(h2c_buf, erase_cmd); -+ DOWNLOAD_FLASH_SET_LOCATION(h2c_buf, 0); -+ DOWNLOAD_FLASH_SET_START_ADDR(h2c_buf, addr); -+ DOWNLOAD_FLASH_SET_SIZE(h2c_buf, 0); -+ -+ value8 = HALMAC_REG_R8(REG_MCUTST_I); -+ value8 |= BIT(0); -+ HALMAC_REG_W8(REG_MCUTST_I, value8); -+ -+ /* Fill in H2C Header */ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_DOWNLOAD_FLASH; -+ hdr_info.content_size = 16; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ /* Send H2C Cmd Packet */ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ -+ cnt = 5000; -+ while (((HALMAC_REG_R8(REG_MCUTST_I)) & BIT(0)) != 0 && cnt != 0) { -+ PLTFM_DELAY_US(1000); -+ cnt--; -+ } -+ -+ if (cnt == 0) -+ return HALMAC_RET_FAIL; -+ else -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * check_flash_88xx() -check flash data -+ * @adapter : the adapter of halmac -+ * @fw_bin : pointer to fw -+ * @size : fw size -+ * @addr : flash start address where fw should be checked -+ * Author : Pablo Chiu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+check_flash_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size, -+ u32 addr) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u8 value8; -+ u16 i; -+ u16 residue; -+ u16 pg_addr; -+ u32 pkt_size; -+ u32 start_page; -+ u32 cnt; -+ u8 *data; -+ -+ pg_addr = adapter->txff_alloc.rsvd_h2c_info_addr; -+ -+ data = (u8 *)PLTFM_MALLOC(4096); -+ -+ while (size != 0) { -+ start_page = ((pg_addr << 7) >> 12) + 0x780; -+ residue = (pg_addr << 7) & (4096 - 1); -+ -+ if (size >= DL_FLASH_RSVDPG_SIZE) -+ pkt_size = DL_FLASH_RSVDPG_SIZE; -+ else -+ pkt_size = size; -+ -+ read_flash_88xx(adapter, addr, 4096, data); -+ -+ cnt = 0; -+ while (cnt < pkt_size) { -+ HALMAC_REG_W16(REG_PKTBUF_DBG_CTRL, (u16)(start_page)); -+ for (i = 0x8000 + residue; i <= 0x8FFF; i++) { -+ value8 = HALMAC_REG_R8(i); -+ if (*fw_bin != value8) { -+ PLTFM_MSG_ERR("[ERR]check flash!!\n"); -+ PLTFM_FREE(data, 4096); -+ return HALMAC_RET_FAIL; -+ } -+ -+ fw_bin++; -+ cnt++; -+ if (cnt == pkt_size) -+ break; -+ } -+ residue = 0; -+ start_page++; -+ } -+ addr += pkt_size; -+ size -= pkt_size; -+ } -+ -+ PLTFM_FREE(data, 4096); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+#endif /* HALMAC_88XX_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_flash_88xx.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_flash_88xx.h -new file mode 100644 -index 000000000..1f0abd1e0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_flash_88xx.h -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_FLASH_88XX_H_ -+#define _HALMAC_FLASH_88XX_H_ -+ -+#include "../halmac_api.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+enum halmac_ret_status -+download_flash_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size, -+ u32 rom_addr); -+ -+enum halmac_ret_status -+read_flash_88xx(struct halmac_adapter *adapter, u32 addr, u32 length, u8 *data); -+ -+enum halmac_ret_status -+erase_flash_88xx(struct halmac_adapter *adapter, u8 erase_cmd, u32 addr); -+ -+enum halmac_ret_status -+check_flash_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size, -+ u32 addr); -+ -+#endif /* HALMAC_88XX_SUPPORT */ -+ -+#endif/* _HALMAC_FLASH_88XX_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_fw_88xx.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_fw_88xx.c -new file mode 100644 -index 000000000..d170be733 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_fw_88xx.c -@@ -0,0 +1,1217 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_fw_88xx.h" -+#include "halmac_88xx_cfg.h" -+#include "halmac_common_88xx.h" -+#include "halmac_init_88xx.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+#define DLFW_RESTORE_REG_NUM 6 -+#define ILLEGAL_KEY_GROUP 0xFAAAAA00 -+ -+/* Max dlfw size can not over 31K, due to SDIO HW limitation */ -+#define DLFW_PKT_SIZE_LIMIT 31744 -+ -+#define ID_INFORM_DLEMEM_RDY 0x80 -+#define ID_INFORM_ENETR_CPU_SLEEP 0x20 -+#define ID_CHECK_DLEMEM_RDY 0x80 -+#define ID_CHECK_ENETR_CPU_SLEEP 0x05 -+ -+#define FW_STATUS_CHK_FATAL (BIT(1) | BIT(20)) -+#define FW_STATUS_CHK_ERR (BIT(4) | BIT(5) | BIT(6) | BIT(7) | BIT(8) | \ -+ BIT(9) | BIT(12) | BIT(14) | BIT(15) | \ -+ BIT(16) | BIT(17) | BIT(18) | BIT(19) | \ -+ BIT(21) | BIT(22) | BIT(25)) -+#define FW_STATUS_CHK_WARN ~(FW_STATUS_CHK_FATAL | FW_STATUS_CHK_ERR) -+ -+struct halmac_backup_info { -+ u32 mac_register; -+ u32 value; -+ u8 length; -+}; -+ -+static enum halmac_ret_status -+update_fw_info_88xx(struct halmac_adapter *adapter, u8 *fw_bin); -+ -+static void -+restore_mac_reg_88xx(struct halmac_adapter *adapter, -+ struct halmac_backup_info *info, u32 num); -+ -+static enum halmac_ret_status -+dlfw_to_mem_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 src, u32 dest, -+ u32 size); -+ -+static enum halmac_ret_status -+dlfw_end_flow_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+free_dl_fw_end_flow_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+send_fwpkt_88xx(struct halmac_adapter *adapter, u16 pg_addr, u8 *fw_bin, -+ u32 size); -+ -+static enum halmac_ret_status -+iddma_dlfw_88xx(struct halmac_adapter *adapter, u32 src, u32 dest, u32 len, -+ u8 first); -+ -+static enum halmac_ret_status -+iddma_en_88xx(struct halmac_adapter *adapter, u32 src, u32 dest, u32 ctrl); -+ -+static enum halmac_ret_status -+check_fw_chksum_88xx(struct halmac_adapter *adapter, u32 mem_addr); -+ -+static void -+fw_fatal_status_debug_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+start_dlfw_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size, -+ u32 dl_addr, u8 emem_only); -+ -+static enum halmac_ret_status -+chk_fw_size_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size); -+ -+static void -+chk_h2c_ver_88xx(struct halmac_adapter *adapter, u8 *fw_bin); -+ -+static void -+wlan_cpu_en_88xx(struct halmac_adapter *adapter, u8 enable); -+ -+static void -+pltfm_reset_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+proc_send_general_info_88xx(struct halmac_adapter *adapter, -+ struct halmac_general_info *info); -+ -+static enum halmac_ret_status -+proc_send_phydm_info_88xx(struct halmac_adapter *adapter, -+ struct halmac_general_info *info); -+ -+/** -+ * download_firmware_88xx() - download Firmware -+ * @adapter : the adapter of halmac -+ * @fw_bin : firmware bin -+ * @size : firmware size -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+download_firmware_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size) -+{ -+ u8 value8; -+ u32 bckp_idx = 0; -+ u32 lte_coex_backup = 0; -+ struct halmac_backup_info bckp[DLFW_RESTORE_REG_NUM]; -+ enum halmac_ret_status status; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) -+ return HALMAC_RET_POWER_STATE_INVALID; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ status = chk_fw_size_88xx(adapter, fw_bin, size); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ chk_h2c_ver_88xx(adapter, fw_bin); -+ -+ if (adapter->halmac_state.wlcpu_mode == HALMAC_WLCPU_ENTER_SLEEP) -+ PLTFM_MSG_WARN("[WARN]Enter Sleep..zZZ\n"); -+ -+ adapter->halmac_state.dlfw_state = HALMAC_DLFW_NONE; -+ -+ status = ltecoex_reg_read_88xx(adapter, 0x38, <e_coex_backup); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ wlan_cpu_en_88xx(adapter, 0); -+ -+ /* set HIQ to hi priority */ -+ bckp[bckp_idx].length = 1; -+ bckp[bckp_idx].mac_register = REG_TXDMA_PQ_MAP + 1; -+ bckp[bckp_idx].value = HALMAC_REG_R8(REG_TXDMA_PQ_MAP + 1); -+ bckp_idx++; -+ value8 = HALMAC_DMA_MAPPING_HIGH << 6; -+ HALMAC_REG_W8(REG_TXDMA_PQ_MAP + 1, value8); -+ -+ /* DLFW only use HIQ, map HIQ to hi priority */ -+ adapter->pq_map[HALMAC_PQ_MAP_HI] = HALMAC_DMA_MAPPING_HIGH; -+ bckp[bckp_idx].length = 1; -+ bckp[bckp_idx].mac_register = REG_CR; -+ bckp[bckp_idx].value = HALMAC_REG_R8(REG_CR); -+ bckp_idx++; -+ bckp[bckp_idx].length = 4; -+ bckp[bckp_idx].mac_register = REG_H2CQ_CSR; -+ bckp[bckp_idx].value = BIT(31); -+ bckp_idx++; -+ value8 = BIT_HCI_TXDMA_EN | BIT_TXDMA_EN; -+ HALMAC_REG_W8(REG_CR, value8); -+ HALMAC_REG_W32(REG_H2CQ_CSR, BIT(31)); -+ -+ /* Config hi priority queue and public priority queue page number */ -+ bckp[bckp_idx].length = 2; -+ bckp[bckp_idx].mac_register = REG_FIFOPAGE_INFO_1; -+ bckp[bckp_idx].value = HALMAC_REG_R16(REG_FIFOPAGE_INFO_1); -+ bckp_idx++; -+ bckp[bckp_idx].length = 4; -+ bckp[bckp_idx].mac_register = REG_RQPN_CTRL_2; -+ bckp[bckp_idx].value = HALMAC_REG_R32(REG_RQPN_CTRL_2) | BIT(31); -+ bckp_idx++; -+ HALMAC_REG_W16(REG_FIFOPAGE_INFO_1, 0x200); -+ HALMAC_REG_W32(REG_RQPN_CTRL_2, bckp[bckp_idx - 1].value); -+ -+ /* Disable beacon related functions */ -+ value8 = HALMAC_REG_R8(REG_BCN_CTRL); -+ bckp[bckp_idx].length = 1; -+ bckp[bckp_idx].mac_register = REG_BCN_CTRL; -+ bckp[bckp_idx].value = value8; -+ bckp_idx++; -+ value8 = (u8)((value8 & (~BIT(3))) | BIT(4)); -+ HALMAC_REG_W8(REG_BCN_CTRL, value8); -+ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) -+ HALMAC_REG_R32(REG_SDIO_FREE_TXPG); -+ -+ pltfm_reset_88xx(adapter); -+ -+ status = start_dlfw_88xx(adapter, fw_bin, size, 0, 0); -+ -+ restore_mac_reg_88xx(adapter, bckp, DLFW_RESTORE_REG_NUM); -+ -+ if (status != HALMAC_RET_SUCCESS) -+ goto DLFW_FAIL; -+ -+ status = dlfw_end_flow_88xx(adapter); -+ if (status != HALMAC_RET_SUCCESS) -+ goto DLFW_FAIL; -+ -+ status = ltecoex_reg_write_88xx(adapter, 0x38, lte_coex_backup); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ adapter->halmac_state.dlfw_state = HALMAC_DLFW_DONE; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+ -+DLFW_FAIL: -+ -+ /* Disable FWDL_EN */ -+ value8 = HALMAC_REG_R8(REG_MCUFW_CTRL); -+ value8 &= ~BIT(0); -+ HALMAC_REG_W8(REG_MCUFW_CTRL, value8); -+ -+ value8 = HALMAC_REG_R8(REG_SYS_FUNC_EN + 1); -+ value8 |= BIT(2); -+ HALMAC_REG_W8(REG_SYS_FUNC_EN + 1, value8); -+ -+ if (ltecoex_reg_write_88xx(adapter, 0x38, lte_coex_backup) != -+ HALMAC_RET_SUCCESS) -+ return HALMAC_RET_LTECOEX_READY_FAIL; -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+start_dlfw_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size, -+ u32 dl_addr, u8 emem_only) -+{ -+ u8 *cur_fw; -+ u16 value16; -+ u32 imem_size; -+ u32 dmem_size; -+ u32 emem_size = 0; -+ u32 addr; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status status; -+ -+ dmem_size = -+ rtk_le32_to_cpu(*((__le32 *)(fw_bin + WLAN_FW_HDR_DMEM_SIZE))); -+ imem_size = -+ rtk_le32_to_cpu(*((__le32 *)(fw_bin + WLAN_FW_HDR_IMEM_SIZE))); -+ if (0 != ((*(fw_bin + WLAN_FW_HDR_MEM_USAGE)) & BIT(4))) -+ emem_size = -+ rtk_le32_to_cpu(*((__le32 *)(fw_bin + WLAN_FW_HDR_EMEM_SIZE))); -+ -+ dmem_size += WLAN_FW_HDR_CHKSUM_SIZE; -+ imem_size += WLAN_FW_HDR_CHKSUM_SIZE; -+ if (emem_size != 0) -+ emem_size += WLAN_FW_HDR_CHKSUM_SIZE; -+ -+ if (emem_only == 1) { -+ if (!emem_size) -+ return HALMAC_RET_SUCCESS; -+ goto DLFW_EMEM; -+ } -+ -+ value16 = (u16)(HALMAC_REG_R16(REG_MCUFW_CTRL) & 0x3800); -+ value16 |= BIT(0); -+ HALMAC_REG_W16(REG_MCUFW_CTRL, value16); -+ -+ cur_fw = fw_bin + WLAN_FW_HDR_SIZE; -+ addr = rtk_le32_to_cpu(*((__le32 *)(fw_bin + WLAN_FW_HDR_DMEM_ADDR))); -+ addr &= ~BIT(31); -+ status = dlfw_to_mem_88xx(adapter, cur_fw, 0, addr, dmem_size); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ cur_fw = fw_bin + WLAN_FW_HDR_SIZE + dmem_size; -+ addr = rtk_le32_to_cpu(*((__le32 *)(fw_bin + WLAN_FW_HDR_IMEM_ADDR))); -+ addr &= ~BIT(31); -+ status = dlfw_to_mem_88xx(adapter, cur_fw, 0, addr, imem_size); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+DLFW_EMEM: -+ if (emem_size) { -+ cur_fw = fw_bin + WLAN_FW_HDR_SIZE + -+ dmem_size + imem_size; -+ addr = rtk_le32_to_cpu(*((__le32 *)(fw_bin + -+ WLAN_FW_HDR_EMEM_ADDR))); -+ addr &= ~BIT(31); -+ status = dlfw_to_mem_88xx(adapter, cur_fw, dl_addr << 7, addr, -+ emem_size); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ if (emem_only == 1) -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ update_fw_info_88xx(adapter, fw_bin); -+ init_ofld_feature_state_machine_88xx(adapter); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static void -+chk_h2c_ver_88xx(struct halmac_adapter *adapter, u8 *fw_bin) -+{ -+ u16 halmac_h2c_ver; -+ u16 fw_h2c_ver; -+ -+ fw_h2c_ver = rtk_le16_to_cpu(*((__le16 *)(fw_bin + -+ WLAN_FW_HDR_H2C_FMT_VER))); -+ halmac_h2c_ver = H2C_FORMAT_VERSION; -+ -+ PLTFM_MSG_TRACE("[TRACE]halmac h2c ver = %x, fw h2c ver = %x!!\n", -+ halmac_h2c_ver, fw_h2c_ver); -+} -+ -+static enum halmac_ret_status -+chk_fw_size_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size) -+{ -+ u32 imem_size; -+ u32 dmem_size; -+ u32 emem_size = 0; -+ u32 real_size; -+ -+ if (size < WLAN_FW_HDR_SIZE) { -+ PLTFM_MSG_ERR("[ERR]FW size error!\n"); -+ return HALMAC_RET_FW_SIZE_ERR; -+ } -+ -+ dmem_size = -+ rtk_le32_to_cpu(*((__le32 *)(fw_bin + WLAN_FW_HDR_DMEM_SIZE))); -+ imem_size = -+ rtk_le32_to_cpu(*((__le32 *)(fw_bin + WLAN_FW_HDR_IMEM_SIZE))); -+ if (0 != ((*(fw_bin + WLAN_FW_HDR_MEM_USAGE)) & BIT(4))) -+ emem_size = -+ rtk_le32_to_cpu(*((__le32 *)(fw_bin + WLAN_FW_HDR_EMEM_SIZE))); -+ -+ dmem_size += WLAN_FW_HDR_CHKSUM_SIZE; -+ imem_size += WLAN_FW_HDR_CHKSUM_SIZE; -+ if (emem_size != 0) -+ emem_size += WLAN_FW_HDR_CHKSUM_SIZE; -+ -+ real_size = WLAN_FW_HDR_SIZE + dmem_size + imem_size + emem_size; -+ if (size != real_size) { -+ PLTFM_MSG_ERR("[ERR]size != real size!\n"); -+ return HALMAC_RET_FW_SIZE_ERR; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static void -+wlan_cpu_en_88xx(struct halmac_adapter *adapter, u8 enable) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (enable == 1) { -+ /* cpu io interface enable or disable */ -+ value8 = HALMAC_REG_R8(REG_RSV_CTRL + 1); -+ value8 |= BIT(0); -+ HALMAC_REG_W8(REG_RSV_CTRL + 1, value8); -+ -+ /* cpu enable or disable */ -+ value8 = HALMAC_REG_R8(REG_SYS_FUNC_EN + 1); -+ value8 |= BIT(2); -+ HALMAC_REG_W8(REG_SYS_FUNC_EN + 1, value8); -+ -+ } else { -+ /* cpu enable or disable */ -+ value8 = HALMAC_REG_R8(REG_SYS_FUNC_EN + 1); -+ value8 &= ~BIT(2); -+ HALMAC_REG_W8(REG_SYS_FUNC_EN + 1, value8); -+ -+ /* cpu io interface enable or disable */ -+ value8 = HALMAC_REG_R8(REG_RSV_CTRL + 1); -+ value8 &= ~BIT(0); -+ HALMAC_REG_W8(REG_RSV_CTRL + 1, value8); -+ } -+} -+ -+static void -+pltfm_reset_88xx(struct halmac_adapter *adapter) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ value8 = HALMAC_REG_R8(REG_CPU_DMEM_CON + 2) & ~BIT(0); -+ HALMAC_REG_W8(REG_CPU_DMEM_CON + 2, value8); -+ -+ /* For 8822B & 8821C clock sync issue */ -+ if (adapter->chip_id == HALMAC_CHIP_ID_8821C || -+ adapter->chip_id == HALMAC_CHIP_ID_8822B) { -+ value8 = HALMAC_REG_R8(REG_SYS_CLK_CTRL + 1) & ~BIT(6); -+ HALMAC_REG_W8(REG_SYS_CLK_CTRL + 1, value8); -+ } -+ -+ value8 = HALMAC_REG_R8(REG_CPU_DMEM_CON + 2) | BIT(0); -+ HALMAC_REG_W8(REG_CPU_DMEM_CON + 2, value8); -+ -+ if (adapter->chip_id == HALMAC_CHIP_ID_8821C || -+ adapter->chip_id == HALMAC_CHIP_ID_8822B) { -+ value8 = HALMAC_REG_R8(REG_SYS_CLK_CTRL + 1) | BIT(6); -+ HALMAC_REG_W8(REG_SYS_CLK_CTRL + 1, value8); -+ } -+} -+ -+/** -+ * free_download_firmware_88xx() - download specific memory firmware -+ * @adapter -+ * @mem_sel : memory selection -+ * @fw_bin : firmware bin -+ * @size : firmware size -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ */ -+enum halmac_ret_status -+free_download_firmware_88xx(struct halmac_adapter *adapter, -+ enum halmac_dlfw_mem mem_sel, u8 *fw_bin, u32 size) -+{ -+ u8 tx_pause_bckp; -+ u32 dl_addr; -+ u32 dlfw_size_bckp; -+ enum halmac_ret_status status; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ status = chk_fw_size_88xx(adapter, fw_bin, size); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ if (((*(fw_bin + WLAN_FW_HDR_MEM_USAGE)) & BIT(4)) == 0) -+ return HALMAC_RET_SUCCESS; -+ -+ dlfw_size_bckp = adapter->dlfw_pkt_size; -+ if (mem_sel == HALMAC_DLFW_MEM_EMEM) { -+ dl_addr = 0; -+ } else { -+ dl_addr = adapter->txff_alloc.rsvd_h2c_info_addr; -+ adapter->dlfw_pkt_size = (dlfw_size_bckp > DLFW_RSVDPG_SIZE) ? -+ DLFW_RSVDPG_SIZE : dlfw_size_bckp; -+ } -+ -+ tx_pause_bckp = HALMAC_REG_R8(REG_TXPAUSE); -+ HALMAC_REG_W8(REG_TXPAUSE, tx_pause_bckp | BIT(7)); -+ -+ status = start_dlfw_88xx(adapter, fw_bin, size, dl_addr, 1); -+ if (status != HALMAC_RET_SUCCESS) -+ goto DL_FREE_FW_END; -+ -+ status = free_dl_fw_end_flow_88xx(adapter); -+ -+DL_FREE_FW_END: -+ HALMAC_REG_W8(REG_TXPAUSE, tx_pause_bckp); -+ adapter->dlfw_pkt_size = dlfw_size_bckp; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return status; -+} -+ -+/** -+ * reset_wifi_fw_88xx() - reset wifi fw -+ * @adapter : the adapter of halmac -+ * Author : LIN YONG-CHING -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+reset_wifi_fw_88xx(struct halmac_adapter *adapter) -+{ -+ enum halmac_ret_status status; -+ u32 lte_coex_backup = 0; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ status = ltecoex_reg_read_88xx(adapter, 0x38, <e_coex_backup); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ wlan_cpu_en_88xx(adapter, 0); -+ pltfm_reset_88xx(adapter); -+ init_ofld_feature_state_machine_88xx(adapter); -+ wlan_cpu_en_88xx(adapter, 1); -+ -+ status = ltecoex_reg_write_88xx(adapter, 0x38, lte_coex_backup); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * get_fw_version_88xx() - get FW version -+ * @adapter : the adapter of halmac -+ * @ver : fw version info -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_fw_version_88xx(struct halmac_adapter *adapter, -+ struct halmac_fw_version *ver) -+{ -+ struct halmac_fw_version *info = &adapter->fw_ver; -+ -+ if (!ver) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (adapter->halmac_state.dlfw_state == HALMAC_DLFW_NONE) -+ return HALMAC_RET_NO_DLFW; -+ -+ ver->version = info->version; -+ ver->sub_version = info->sub_version; -+ ver->sub_index = info->sub_index; -+ ver->h2c_version = info->h2c_version; -+ ver->build_time.month = info->build_time.month; -+ ver->build_time.date = info->build_time.date; -+ ver->build_time.hour = info->build_time.hour; -+ ver->build_time.min = info->build_time.min; -+ ver->build_time.year = info->build_time.year; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+update_fw_info_88xx(struct halmac_adapter *adapter, u8 *fw_bin) -+{ -+ struct halmac_fw_version *info = &adapter->fw_ver; -+ -+ info->version = -+ rtk_le16_to_cpu(*((__le16 *)(fw_bin + WLAN_FW_HDR_VERSION))); -+ info->sub_version = *(fw_bin + WLAN_FW_HDR_SUBVERSION); -+ info->sub_index = *(fw_bin + WLAN_FW_HDR_SUBINDEX); -+ info->h2c_version = rtk_le16_to_cpu(*((__le16 *)(fw_bin + -+ WLAN_FW_HDR_H2C_FMT_VER))); -+ info->build_time.month = *(fw_bin + WLAN_FW_HDR_MONTH); -+ info->build_time.date = *(fw_bin + WLAN_FW_HDR_DATE); -+ info->build_time.hour = *(fw_bin + WLAN_FW_HDR_HOUR); -+ info->build_time.min = *(fw_bin + WLAN_FW_HDR_MIN); -+ info->build_time.year = -+ rtk_le16_to_cpu(*((__le16 *)(fw_bin + WLAN_FW_HDR_YEAR))); -+ -+ PLTFM_MSG_TRACE("[TRACE]=== FW info ===\n"); -+ PLTFM_MSG_TRACE("[TRACE]ver : %X\n", info->version); -+ PLTFM_MSG_TRACE("[TRACE]sub-ver : %X\n", -+ info->sub_version); -+ PLTFM_MSG_TRACE("[TRACE]sub-idx : %X\n", -+ info->sub_index); -+ PLTFM_MSG_TRACE("[TRACE]build : %d/%d/%d %d:%d\n", -+ info->build_time.year, info->build_time.month, -+ info->build_time.date, info->build_time.hour, -+ info->build_time.min); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+dlfw_to_mem_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 src, u32 dest, -+ u32 size) -+{ -+ u8 first_part; -+ u32 mem_offset; -+ u32 residue_size; -+ u32 pkt_size; -+ enum halmac_ret_status status; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ mem_offset = 0; -+ first_part = 1; -+ residue_size = size; -+ -+ HALMAC_REG_W32_SET(REG_DDMA_CH0CTRL, BIT_DDMACH0_RESET_CHKSUM_STS); -+ -+ while (residue_size != 0) { -+ if (residue_size >= adapter->dlfw_pkt_size) -+ pkt_size = adapter->dlfw_pkt_size; -+ else -+ pkt_size = residue_size; -+ -+ status = send_fwpkt_88xx(adapter, (u16)(src >> 7), -+ fw_bin + mem_offset, pkt_size); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send fw pkt!!\n"); -+ return status; -+ } -+ -+ status = iddma_dlfw_88xx(adapter, -+ OCPBASE_TXBUF_88XX + -+ src + adapter->hw_cfg_info.txdesc_size, -+ dest + mem_offset, pkt_size, -+ first_part); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]iddma dlfw!!\n"); -+ return status; -+ } -+ -+ first_part = 0; -+ mem_offset += pkt_size; -+ residue_size -= pkt_size; -+ } -+ -+ status = check_fw_chksum_88xx(adapter, dest); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]chk fw chksum!!\n"); -+ return status; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static void -+restore_mac_reg_88xx(struct halmac_adapter *adapter, -+ struct halmac_backup_info *info, u32 num) -+{ -+ u8 len; -+ u32 i; -+ u32 reg; -+ u32 value; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ struct halmac_backup_info *curr_info = info; -+ -+ for (i = 0; i < num; i++) { -+ reg = curr_info->mac_register; -+ value = curr_info->value; -+ len = curr_info->length; -+ -+ if (len == 1) -+ HALMAC_REG_W8(reg, (u8)value); -+ else if (len == 2) -+ HALMAC_REG_W16(reg, (u16)value); -+ else if (len == 4) -+ HALMAC_REG_W32(reg, value); -+ -+ curr_info++; -+ } -+} -+ -+static enum halmac_ret_status -+dlfw_end_flow_88xx(struct halmac_adapter *adapter) -+{ -+ u16 fw_ctrl; -+ u32 cnt; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ HALMAC_REG_W32(REG_TXDMA_STATUS, BIT(2)); -+ -+ /* Check IMEM & DMEM checksum is OK or not */ -+ fw_ctrl = HALMAC_REG_R16(REG_MCUFW_CTRL); -+ if ((fw_ctrl & 0x50) != 0x50) -+ return HALMAC_RET_IDMEM_CHKSUM_FAIL; -+ -+ HALMAC_REG_W16(REG_MCUFW_CTRL, (fw_ctrl | BIT_FW_DW_RDY) & ~BIT(0)); -+ -+ wlan_cpu_en_88xx(adapter, 1); -+ PLTFM_MSG_TRACE("[TRACE]Dlfw OK, enable CPU\n"); -+ -+ cnt = 5000; -+ while (HALMAC_REG_R16(REG_MCUFW_CTRL) != 0xC078) { -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]Check 0x80 = 0xC078 fail\n"); -+ if ((HALMAC_REG_R32(REG_FW_DBG7) & 0xFFFFFF00) == -+ ILLEGAL_KEY_GROUP) { -+ PLTFM_MSG_ERR("[ERR]Key!!\n"); -+ return HALMAC_RET_ILLEGAL_KEY_FAIL; -+ } -+ return HALMAC_RET_FW_READY_CHK_FAIL; -+ } -+ cnt--; -+ PLTFM_DELAY_US(50); -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]0x80=0xC078, cnt=%d\n", cnt); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+free_dl_fw_end_flow_88xx(struct halmac_adapter *adapter) -+{ -+ u32 cnt; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ cnt = 100; -+ while (HALMAC_REG_R8(REG_HMETFR + 3) != 0) { -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]0x1CF != 0\n"); -+ return HALMAC_RET_DLFW_FAIL; -+ } -+ PLTFM_DELAY_US(50); -+ } -+ -+ HALMAC_REG_W8(REG_HMETFR + 3, ID_INFORM_DLEMEM_RDY); -+ -+ cnt = 10000; -+ while (HALMAC_REG_R8(REG_MCU_TST_CFG) != ID_CHECK_DLEMEM_RDY) { -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]0x84 != 0x80\n"); -+ return HALMAC_RET_DLFW_FAIL; -+ } -+ PLTFM_DELAY_US(50); -+ } -+ -+ HALMAC_REG_W8(REG_MCU_TST_CFG, 0); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+send_fwpkt_88xx(struct halmac_adapter *adapter, u16 pg_addr, u8 *fw_bin, -+ u32 size) -+{ -+ u8 *fw_add_dum = NULL; -+ enum halmac_ret_status status; -+ -+ if (adapter->intf == HALMAC_INTERFACE_USB && -+ !((size + TX_DESC_SIZE_88XX) & (512 - 1))) { -+ fw_add_dum = (u8 *)PLTFM_MALLOC(size + 1); -+ if (!fw_add_dum) { -+ PLTFM_MSG_ERR("[ERR]fw bin malloc!!\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ -+ PLTFM_MEMCPY(fw_add_dum, fw_bin, size); -+ -+ status = dl_rsvd_page_88xx(adapter, pg_addr, -+ fw_add_dum, size + 1); -+ if (status != HALMAC_RET_SUCCESS) -+ PLTFM_MSG_ERR("[ERR]dl rsvd page - dum!!\n"); -+ -+ PLTFM_FREE(fw_add_dum, size + 1); -+ -+ return status; -+ } -+ -+ status = dl_rsvd_page_88xx(adapter, pg_addr, fw_bin, size); -+ if (status != HALMAC_RET_SUCCESS) -+ PLTFM_MSG_ERR("[ERR]dl rsvd page!!\n"); -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+iddma_dlfw_88xx(struct halmac_adapter *adapter, u32 src, u32 dest, u32 len, -+ u8 first) -+{ -+ u32 cnt; -+ u32 ch0_ctrl = (u32)(BIT_DDMACH0_CHKSUM_EN | BIT_DDMACH0_OWN); -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ cnt = HALMC_DDMA_POLLING_COUNT; -+ while (HALMAC_REG_R32(REG_DDMA_CH0CTRL) & BIT_DDMACH0_OWN) { -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]ch0 ready!!\n"); -+ return HALMAC_RET_DDMA_FAIL; -+ } -+ } -+ -+ ch0_ctrl |= (len & BIT_MASK_DDMACH0_DLEN); -+ if (first == 0) -+ ch0_ctrl |= BIT_DDMACH0_CHKSUM_CONT; -+ -+ if (iddma_en_88xx(adapter, src, dest, ch0_ctrl) != -+ HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]iddma en!!\n"); -+ return HALMAC_RET_DDMA_FAIL; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+iddma_en_88xx(struct halmac_adapter *adapter, u32 src, u32 dest, u32 ctrl) -+{ -+ u32 cnt = HALMC_DDMA_POLLING_COUNT; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ HALMAC_REG_W32(REG_DDMA_CH0SA, src); -+ HALMAC_REG_W32(REG_DDMA_CH0DA, dest); -+ HALMAC_REG_W32(REG_DDMA_CH0CTRL, ctrl); -+ -+ while (HALMAC_REG_R32(REG_DDMA_CH0CTRL) & BIT_DDMACH0_OWN) { -+ cnt--; -+ if (cnt == 0) -+ return HALMAC_RET_DDMA_FAIL; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+check_fw_chksum_88xx(struct halmac_adapter *adapter, u32 mem_addr) -+{ -+ u8 fw_ctrl; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ fw_ctrl = HALMAC_REG_R8(REG_MCUFW_CTRL); -+ -+ if (HALMAC_REG_R32(REG_DDMA_CH0CTRL) & BIT_DDMACH0_CHKSUM_STS) { -+ if (mem_addr < OCPBASE_DMEM_88XX) { -+ fw_ctrl |= BIT_IMEM_DW_OK; -+ fw_ctrl &= ~BIT_IMEM_CHKSUM_OK; -+ HALMAC_REG_W8(REG_MCUFW_CTRL, fw_ctrl); -+ } else { -+ fw_ctrl |= BIT_DMEM_DW_OK; -+ fw_ctrl &= ~BIT_DMEM_CHKSUM_OK; -+ HALMAC_REG_W8(REG_MCUFW_CTRL, fw_ctrl); -+ } -+ -+ PLTFM_MSG_ERR("[ERR]fw chksum!!\n"); -+ -+ return HALMAC_RET_FW_CHECKSUM_FAIL; -+ } -+ -+ if (mem_addr < OCPBASE_DMEM_88XX) { -+ fw_ctrl |= (BIT_IMEM_DW_OK | BIT_IMEM_CHKSUM_OK); -+ HALMAC_REG_W8(REG_MCUFW_CTRL, fw_ctrl); -+ } else { -+ fw_ctrl |= (BIT_DMEM_DW_OK | BIT_DMEM_CHKSUM_OK); -+ HALMAC_REG_W8(REG_MCUFW_CTRL, fw_ctrl); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * check_fw_status_88xx() -check fw status -+ * @adapter : the adapter of halmac -+ * @status : fw status -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+check_fw_status_88xx(struct halmac_adapter *adapter, u8 *fw_status) -+{ -+ u32 cnt; -+ u32 fw_dbg6; -+ u32 fw_pc; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ *fw_status = 1; -+ -+ fw_dbg6 = HALMAC_REG_R32(REG_FW_DBG6); -+ -+ if (fw_dbg6 != 0) { -+ PLTFM_MSG_ERR("[ERR]REG_FW_DBG6 !=0\n"); -+ if ((fw_dbg6 & FW_STATUS_CHK_WARN) != 0) -+ PLTFM_MSG_WARN("[WARN]fw status(warn):%X\n", fw_dbg6); -+ -+ if ((fw_dbg6 & FW_STATUS_CHK_ERR) != 0) -+ PLTFM_MSG_ERR("[ERR]fw status(err):%X\n", fw_dbg6); -+ -+ if ((fw_dbg6 & FW_STATUS_CHK_FATAL) != 0) { -+ PLTFM_MSG_ERR("[ERR]fw status(fatal):%X\n", fw_dbg6); -+ fw_fatal_status_debug_88xx(adapter); -+ *fw_status = 0; -+ return status; -+ } -+ } -+ -+ fw_pc = HALMAC_REG_R32(REG_FW_DBG7); -+ cnt = 10; -+ while (HALMAC_REG_R32(REG_FW_DBG7) == fw_pc) { -+ cnt--; -+ if (cnt == 0) -+ break; -+ } -+ -+ if (cnt == 0) { -+ cnt = 200; -+ while (HALMAC_REG_R32(REG_FW_DBG7) == fw_pc) { -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]fw pc\n"); -+ *fw_status = 0; -+ return status; -+ } -+ PLTFM_DELAY_US(50); -+ } -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return status; -+} -+ -+static void -+fw_fatal_status_debug_88xx(struct halmac_adapter *adapter) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_ERR("[ERR]0x%X = %X\n", -+ REG_FW_DBG6, HALMAC_REG_R32(REG_FW_DBG6)); -+ -+ PLTFM_MSG_ERR("[ERR]0x%X = %X\n", -+ REG_ARFR5, HALMAC_REG_R32(REG_ARFR5)); -+ -+ PLTFM_MSG_ERR("[ERR]0x%X = %X\n", -+ REG_MCUTST_I, HALMAC_REG_R32(REG_MCUTST_I)); -+} -+ -+enum halmac_ret_status -+dump_fw_dmem_88xx(struct halmac_adapter *adapter, u8 *dmem, u32 *size) -+{ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_max_dl_size_88xx() - config max download FW size -+ * @adapter : the adapter of halmac -+ * @size : max download fw size -+ * -+ * Halmac uses this setting to set max packet size for -+ * download FW. -+ * If user has not called this API, halmac use default -+ * setting for download FW -+ * Note1 : size need multiple of 2 -+ * Note2 : max size is 31K -+ * -+ * Author : Ivan Lin/KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_max_dl_size_88xx(struct halmac_adapter *adapter, u32 size) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (size > DLFW_PKT_SIZE_LIMIT) { -+ PLTFM_MSG_ERR("[ERR]size > max dl size!\n"); -+ return HALMAC_RET_CFG_DLFW_SIZE_FAIL; -+ } -+ -+ if ((size & (2 - 1)) != 0) { -+ PLTFM_MSG_ERR("[ERR]not multiple of 2!\n"); -+ return HALMAC_RET_CFG_DLFW_SIZE_FAIL; -+ } -+ -+ adapter->dlfw_pkt_size = size; -+ -+ PLTFM_MSG_TRACE("[TRACE]Cfg max size:%X\n", size); -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * enter_cpu_sleep_mode_88xx() -wlan cpu enter sleep mode -+ * @adapter : the adapter of halmac -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+enter_cpu_sleep_mode_88xx(struct halmac_adapter *adapter) -+{ -+ u32 cnt; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_wlcpu_mode *cur_mode = &adapter->halmac_state.wlcpu_mode; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (*cur_mode != HALMAC_WLCPU_ACTIVE) -+ return HALMAC_RET_ERROR_STATE; -+ -+ cnt = 100; -+ while (HALMAC_REG_R8(REG_HMETFR + 3) != 0) { -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]0x1CF != 0\n"); -+ return HALMAC_RET_STATE_INCORRECT; -+ } -+ PLTFM_DELAY_US(50); -+ } -+ -+ HALMAC_REG_W8(REG_HMETFR + 3, ID_INFORM_ENETR_CPU_SLEEP); -+ -+ *cur_mode = HALMAC_WLCPU_ENTER_SLEEP; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * get_cpu_mode_88xx() -get wlcpu mode -+ * @adapter : the adapter of halmac -+ * @mode : cpu mode -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_cpu_mode_88xx(struct halmac_adapter *adapter, -+ enum halmac_wlcpu_mode *mode) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_wlcpu_mode *cur_mode = &adapter->halmac_state.wlcpu_mode; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (*cur_mode == HALMAC_WLCPU_ACTIVE) { -+ *mode = HALMAC_WLCPU_ACTIVE; -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (*cur_mode == HALMAC_WLCPU_SLEEP) { -+ *mode = HALMAC_WLCPU_SLEEP; -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (HALMAC_REG_R8(REG_MCU_TST_CFG) == ID_CHECK_ENETR_CPU_SLEEP) { -+ *mode = HALMAC_WLCPU_SLEEP; -+ *cur_mode = HALMAC_WLCPU_SLEEP; -+ HALMAC_REG_W8(REG_MCU_TST_CFG, 0); -+ } else { -+ *mode = HALMAC_WLCPU_ENTER_SLEEP; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * send_general_info_88xx() -send general information to FW -+ * @adapter : the adapter of halmac -+ * @info : general information -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+send_general_info_88xx(struct halmac_adapter *adapter, -+ struct halmac_general_info *info) -+{ -+ u8 h2cq_ele[4] = {0}; -+ u32 h2cq_addr; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ u8 cnt; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (adapter->fw_ver.h2c_version < 4) -+ return HALMAC_RET_FW_NO_SUPPORT; -+ -+ if (adapter->fw_ver.h2c_version < 14) -+ PLTFM_MSG_WARN("[WARN]the H2C ver. does not match halmac\n"); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (adapter->halmac_state.dlfw_state == HALMAC_DLFW_NONE) { -+ PLTFM_MSG_ERR("[ERR]no dl fw!!\n"); -+ return HALMAC_RET_NO_DLFW; -+ } -+ -+ status = proc_send_general_info_88xx(adapter, info); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send gen info!!\n"); -+ return status; -+ } -+ -+ status = proc_send_phydm_info_88xx(adapter, info); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send phydm info\n"); -+ return status; -+ } -+ -+ h2cq_addr = adapter->txff_alloc.rsvd_h2cq_addr; -+ h2cq_addr <<= TX_PAGE_SIZE_SHIFT_88XX; -+ -+ cnt = 100; -+ do { -+ status = dump_fifo_88xx(adapter, HAL_FIFO_SEL_TX, -+ h2cq_addr, 4, h2cq_ele); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dump h2cq!!\n"); -+ return status; -+ } -+ -+ if ((h2cq_ele[0] & 0x7F) == 0x01 && h2cq_ele[1] == 0xFF) -+ break; -+ -+ cnt--; -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]h2cq compare!!\n"); -+ return HALMAC_RET_SEND_H2C_FAIL; -+ } -+ PLTFM_DELAY_US(5); -+ } while (1); -+ -+ if (adapter->halmac_state.dlfw_state == HALMAC_DLFW_DONE) -+ adapter->halmac_state.dlfw_state = HALMAC_GEN_INFO_SENT; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+proc_send_general_info_88xx(struct halmac_adapter *adapter, -+ struct halmac_general_info *info) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s\n", __func__); -+ -+ GENERAL_INFO_SET_FW_TX_BOUNDARY(h2c_buf, -+ adapter->txff_alloc.rsvd_fw_txbuf_addr - -+ adapter->txff_alloc.rsvd_boundary); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_GENERAL_INFO; -+ hdr_info.content_size = 4; -+ hdr_info.ack = 0; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ -+ return status; -+} -+ -+static enum halmac_ret_status -+proc_send_phydm_info_88xx(struct halmac_adapter *adapter, -+ struct halmac_general_info *info) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s\n", __func__); -+ -+ PHYDM_INFO_SET_REF_TYPE(h2c_buf, info->rfe_type); -+ PHYDM_INFO_SET_RF_TYPE(h2c_buf, info->rf_type); -+ PHYDM_INFO_SET_CUT_VER(h2c_buf, adapter->chip_ver); -+ PHYDM_INFO_SET_RX_ANT_STATUS(h2c_buf, info->rx_ant_status); -+ PHYDM_INFO_SET_TX_ANT_STATUS(h2c_buf, info->tx_ant_status); -+ PHYDM_INFO_SET_EXT_PA(h2c_buf, info->ext_pa); -+ PHYDM_INFO_SET_PACKAGE_TYPE(h2c_buf, info->package_type); -+ PHYDM_INFO_SET_MP_MODE(h2c_buf, info->mp_mode); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_PHYDM_INFO; -+ hdr_info.content_size = 8; -+ hdr_info.ack = 0; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ -+ return status; -+} -+ -+/** -+ * drv_fwctrl_88xx() - send drv-defined h2c pkt -+ * @adapter : the adapter of halmac -+ * @payload : no include offload pkt h2c header -+ * @size : no include offload pkt h2c header -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+drv_fwctrl_88xx(struct halmac_adapter *adapter, u8 *payload, u32 size, u8 ack) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num = 0; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (!payload) -+ return HALMAC_RET_DATA_BUF_NULL; -+ -+ if (size > H2C_PKT_SIZE_88XX - H2C_PKT_HDR_SIZE_88XX) -+ return HALMAC_RET_DATA_SIZE_INCORRECT; -+ -+ PLTFM_MEMCPY(h2c_buf + H2C_PKT_HDR_SIZE_88XX, payload, size); -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_FW_FWCTRL; -+ hdr_info.content_size = (u16)size; -+ hdr_info.ack = ack; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ -+ if (status != HALMAC_RET_SUCCESS) -+ PLTFM_MSG_ERR("[ERR]send h2c!!\n"); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return status; -+} -+ -+#endif /* HALMAC_88XX_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_fw_88xx.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_fw_88xx.h -new file mode 100644 -index 000000000..67f4b2c24 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_fw_88xx.h -@@ -0,0 +1,64 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_FW_88XX_H_ -+#define _HALMAC_FW_88XX_H_ -+ -+#include "../halmac_api.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+#define HALMC_DDMA_POLLING_COUNT 1000 -+ -+enum halmac_ret_status -+download_firmware_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size); -+ -+enum halmac_ret_status -+free_download_firmware_88xx(struct halmac_adapter *adapter, -+ enum halmac_dlfw_mem mem_sel, u8 *fw_bin, u32 size); -+ -+enum halmac_ret_status -+reset_wifi_fw_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+get_fw_version_88xx(struct halmac_adapter *adapter, -+ struct halmac_fw_version *ver); -+ -+enum halmac_ret_status -+check_fw_status_88xx(struct halmac_adapter *adapter, u8 *fw_status); -+ -+enum halmac_ret_status -+dump_fw_dmem_88xx(struct halmac_adapter *adapter, u8 *dmem, u32 *size); -+ -+enum halmac_ret_status -+cfg_max_dl_size_88xx(struct halmac_adapter *adapter, u32 size); -+ -+enum halmac_ret_status -+enter_cpu_sleep_mode_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+get_cpu_mode_88xx(struct halmac_adapter *adapter, -+ enum halmac_wlcpu_mode *mode); -+ -+enum halmac_ret_status -+send_general_info_88xx(struct halmac_adapter *adapter, -+ struct halmac_general_info *info); -+ -+enum halmac_ret_status -+drv_fwctrl_88xx(struct halmac_adapter *adapter, u8 *payload, u32 size, u8 ack); -+ -+#endif /* HALMAC_88XX_SUPPORT */ -+ -+#endif/* _HALMAC_FW_88XX_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_gpio_88xx.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_gpio_88xx.c -new file mode 100644 -index 000000000..7edc16f1e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_gpio_88xx.c -@@ -0,0 +1,270 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_gpio_88xx.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+/** -+ * pinmux_wl_led_mode_88xx() -control wlan led gpio function -+ * @adapter : the adapter of halmac -+ * @mode : wlan led mode -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+pinmux_wl_led_mode_88xx(struct halmac_adapter *adapter, -+ enum halmac_wlled_mode mode) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ value8 = HALMAC_REG_R8(REG_LED_CFG + 2); -+ value8 &= ~(BIT(6)); -+ value8 |= BIT(3); -+ value8 &= ~(BIT(0) | BIT(1) | BIT(2)); -+ -+ switch (mode) { -+ case HALMAC_WLLED_MODE_TRX: -+ value8 |= 2; -+ break; -+ case HALMAC_WLLED_MODE_TX: -+ value8 |= 4; -+ break; -+ case HALMAC_WLLED_MODE_RX: -+ value8 |= 6; -+ break; -+ case HALMAC_WLLED_MODE_SW_CTRL: -+ value8 |= 0; -+ break; -+ default: -+ return HALMAC_RET_SWITCH_CASE_ERROR; -+ } -+ -+ HALMAC_REG_W8(REG_LED_CFG + 2, value8); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * pinmux_wl_led_sw_ctrl_88xx() -control wlan led on/off -+ * @adapter : the adapter of halmac -+ * @on : on(1), off(0) -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+void -+pinmux_wl_led_sw_ctrl_88xx(struct halmac_adapter *adapter, u8 on) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ value8 = HALMAC_REG_R8(REG_LED_CFG + 2); -+ value8 = (on == 0) ? value8 | BIT(3) : value8 & ~(BIT(3)); -+ -+ HALMAC_REG_W8(REG_LED_CFG + 2, value8); -+} -+ -+/** -+ * pinmux_sdio_int_polarity_88xx() -control sdio int polarity -+ * @adapter : the adapter of halmac -+ * @low_active : low active(1), high active(0) -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+void -+pinmux_sdio_int_polarity_88xx(struct halmac_adapter *adapter, u8 low_active) -+{ -+ u8 value8; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ value8 = HALMAC_REG_R8(REG_SYS_SDIO_CTRL + 2); -+ value8 = (low_active == 0) ? value8 | BIT(3) : value8 & ~(BIT(3)); -+ -+ HALMAC_REG_W8(REG_SYS_SDIO_CTRL + 2, value8); -+} -+ -+/** -+ * pinmux_gpio_mode_88xx() -control gpio io mode -+ * @adapter : the adapter of halmac -+ * @gpio_id : gpio0~15(0~15) -+ * @output : output(1), input(0) -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+pinmux_gpio_mode_88xx(struct halmac_adapter *adapter, u8 gpio_id, u8 output) -+{ -+ u16 value16; -+ u8 in_out; -+ u32 offset; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (gpio_id <= 7) -+ offset = REG_GPIO_PIN_CTRL + 2; -+ else if (gpio_id >= 8 && gpio_id <= 15) -+ offset = REG_GPIO_EXT_CTRL + 2; -+ else -+ return HALMAC_RET_WRONG_GPIO; -+ -+ in_out = (output == 0) ? 0 : 1; -+ gpio_id &= (8 - 1); -+ -+ value16 = HALMAC_REG_R16(offset); -+ value16 &= ~((1 << gpio_id) | (1 << gpio_id << 8)); -+ value16 |= (in_out << gpio_id); -+ HALMAC_REG_W16(offset, value16); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * pinmux_gpio_output_88xx() -control gpio output high/low -+ * @adapter : the adapter of halmac -+ * @gpio_id : gpio0~15(0~15) -+ * @high : high(1), low(0) -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+pinmux_gpio_output_88xx(struct halmac_adapter *adapter, u8 gpio_id, u8 high) -+{ -+ u8 value8; -+ u8 hi_low; -+ u32 offset; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (gpio_id <= 7) -+ offset = REG_GPIO_PIN_CTRL + 1; -+ else if (gpio_id >= 8 && gpio_id <= 15) -+ offset = REG_GPIO_EXT_CTRL + 1; -+ else -+ return HALMAC_RET_WRONG_GPIO; -+ -+ hi_low = (high == 0) ? 0 : 1; -+ gpio_id &= (8 - 1); -+ -+ value8 = HALMAC_REG_R8(offset); -+ value8 &= ~(1 << gpio_id); -+ value8 |= (hi_low << gpio_id); -+ HALMAC_REG_W8(offset, value8); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * halmac_pinmux_status_88xx() -get current gpio status(high/low) -+ * @adapter : the adapter of halmac -+ * @pin_id : 0~15(0~15) -+ * @phigh : high(1), low(0) -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+pinmux_pin_status_88xx(struct halmac_adapter *adapter, u8 pin_id, u8 *high) -+{ -+ u8 value8; -+ u32 offset; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (pin_id <= 7) -+ offset = REG_GPIO_PIN_CTRL; -+ else if (pin_id >= 8 && pin_id <= 15) -+ offset = REG_GPIO_EXT_CTRL; -+ else -+ return HALMAC_RET_WRONG_GPIO; -+ -+ pin_id &= (8 - 1); -+ -+ value8 = HALMAC_REG_R8(offset); -+ *high = (value8 & (1 << pin_id)) >> pin_id; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+pinmux_parser_88xx(struct halmac_adapter *adapter, -+ const struct halmac_gpio_pimux_list *list, u32 size, -+ u32 gpio_id, u32 *cur_func) -+{ -+ u32 i; -+ u8 value8; -+ const struct halmac_gpio_pimux_list *cur_list = list; -+ enum halmac_gpio_cfg_state *state; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ state = &adapter->halmac_state.gpio_cfg_state; -+ -+ if (*state == HALMAC_GPIO_CFG_STATE_BUSY) -+ return HALMAC_RET_BUSY_STATE; -+ -+ *state = HALMAC_GPIO_CFG_STATE_BUSY; -+ -+ for (i = 0; i < size; i++) { -+ if (gpio_id != cur_list->id) { -+ PLTFM_MSG_ERR("[ERR]offset:%X, value:%X, func:%X\n", -+ cur_list->offset, cur_list->value, -+ cur_list->func); -+ PLTFM_MSG_ERR("[ERR]id1 : %X, id2 : %X\n", -+ gpio_id, cur_list->id); -+ *state = HALMAC_GPIO_CFG_STATE_IDLE; -+ return HALMAC_RET_GET_PINMUX_ERR; -+ } -+ value8 = HALMAC_REG_R8(cur_list->offset); -+ value8 &= cur_list->msk; -+ if (value8 == cur_list->value) { -+ *cur_func = cur_list->func; -+ break; -+ } -+ cur_list++; -+ } -+ -+ switch (*cur_func) { -+ case HALMAC_BT_DPDT_SEL: -+ *cur_func = (HALMAC_REG_R8(REG_LED_CFG + 3) & BIT(0)) ? -+ HALMAC_WL_DPDT_SEL : HALMAC_BT_DPDT_SEL; -+ break; -+ case HALMAC_BT_PAPE_SEL: -+ *cur_func = (HALMAC_REG_R8(REG_PAD_CTRL1 + 3) & BIT(5)) ? -+ HALMAC_WL_PAPE_SEL : HALMAC_BT_PAPE_SEL; -+ break; -+ case HALMAC_BT_LNAON_SEL: -+ *cur_func = (HALMAC_REG_R8(REG_PAD_CTRL1 + 3) & BIT(4)) ? -+ HALMAC_WL_LNAON_SEL : HALMAC_BT_LNAON_SEL; -+ break; -+ default: -+ break; -+ } -+ -+ *state = HALMAC_GPIO_CFG_STATE_IDLE; -+ -+ if (i == size) -+ return HALMAC_RET_GET_PINMUX_ERR; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+#endif /* HALMAC_88XX_SUPPORT */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_gpio_88xx.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_gpio_88xx.h -new file mode 100644 -index 000000000..fbd5abe6b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_gpio_88xx.h -@@ -0,0 +1,50 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_GPIO_88XX_H_ -+#define _HALMAC_GPIO_88XX_H_ -+ -+#include "../halmac_api.h" -+#include "../halmac_gpio_cmd.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+enum halmac_ret_status -+pinmux_wl_led_mode_88xx(struct halmac_adapter *adapter, -+ enum halmac_wlled_mode mode); -+ -+void -+pinmux_wl_led_sw_ctrl_88xx(struct halmac_adapter *adapter, u8 on); -+ -+void -+pinmux_sdio_int_polarity_88xx(struct halmac_adapter *adapter, u8 low_active); -+ -+enum halmac_ret_status -+pinmux_gpio_mode_88xx(struct halmac_adapter *adapter, u8 gpio_id, u8 output); -+ -+enum halmac_ret_status -+pinmux_gpio_output_88xx(struct halmac_adapter *adapter, u8 gpio_id, u8 high); -+ -+enum halmac_ret_status -+pinmux_pin_status_88xx(struct halmac_adapter *adapter, u8 pin_id, u8 *high); -+ -+enum halmac_ret_status -+pinmux_parser_88xx(struct halmac_adapter *adapter, -+ const struct halmac_gpio_pimux_list *list, u32 size, -+ u32 gpio_id, u32 *cur_func); -+ -+#endif /* HALMAC_88XX_SUPPORT */ -+ -+#endif/* _HALMAC_GPIO_88XX_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_init_88xx.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_init_88xx.c -new file mode 100644 -index 000000000..1cdd0e1f4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_init_88xx.c -@@ -0,0 +1,915 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_init_88xx.h" -+#include "halmac_88xx_cfg.h" -+#include "halmac_fw_88xx.h" -+#include "halmac_common_88xx.h" -+#include "halmac_cfg_wmac_88xx.h" -+#include "halmac_efuse_88xx.h" -+#include "halmac_mimo_88xx.h" -+#include "halmac_bb_rf_88xx.h" -+#if HALMAC_SDIO_SUPPORT -+#include "halmac_sdio_88xx.h" -+#endif -+#if HALMAC_USB_SUPPORT -+#include "halmac_usb_88xx.h" -+#endif -+#if HALMAC_PCIE_SUPPORT -+#include "halmac_pcie_88xx.h" -+#endif -+#include "halmac_gpio_88xx.h" -+#include "halmac_flash_88xx.h" -+ -+#if HALMAC_8822B_SUPPORT -+#include "halmac_8822b/halmac_init_8822b.h" -+#endif -+ -+#if HALMAC_8821C_SUPPORT -+#include "halmac_8821c/halmac_init_8821c.h" -+#endif -+ -+#if HALMAC_8822C_SUPPORT -+#include "halmac_8822c/halmac_init_8822c.h" -+#endif -+ -+#if HALMAC_8812F_SUPPORT -+#include "halmac_8812f/halmac_init_8812f.h" -+#endif -+ -+#if HALMAC_PLATFORM_TESTPROGRAM -+#include "halmisc_api_88xx.h" -+#endif -+ -+#if HALMAC_88XX_SUPPORT -+ -+#define PLTFM_INFO_MALLOC_MAX_SIZE 16384 -+#define PLTFM_INFO_RSVD_PG_SIZE 16384 -+#define DLFW_PKT_MAX_SIZE 8192 /* need multiple of 2 */ -+ -+static void -+init_state_machine_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+verify_io_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+verify_send_rsvd_page_88xx(struct halmac_adapter *adapter); -+ -+void -+init_adapter_param_88xx(struct halmac_adapter *adapter) -+{ -+ adapter->api_registry.rx_exp_en = 1; -+ adapter->api_registry.la_mode_en = 1; -+ adapter->api_registry.cfg_drv_rsvd_pg_en = 1; -+ adapter->api_registry.sdio_cmd53_4byte_en = 1; -+ -+ adapter->efuse_map = (u8 *)NULL; -+ adapter->efuse_map_valid = 0; -+ adapter->efuse_end = 0; -+ -+ adapter->dlfw_pkt_size = DLFW_PKT_MAX_SIZE; -+ adapter->pltfm_info.malloc_size = PLTFM_INFO_MALLOC_MAX_SIZE; -+ adapter->pltfm_info.rsvd_pg_size = PLTFM_INFO_RSVD_PG_SIZE; -+ -+ adapter->cfg_param_info.buf = NULL; -+ adapter->cfg_param_info.buf_wptr = NULL; -+ adapter->cfg_param_info.num = 0; -+ adapter->cfg_param_info.full_fifo_mode = 0; -+ adapter->cfg_param_info.buf_size = 0; -+ adapter->cfg_param_info.avl_buf_size = 0; -+ adapter->cfg_param_info.offset_accum = 0; -+ adapter->cfg_param_info.value_accum = 0; -+ -+ adapter->ch_sw_info.buf = NULL; -+ adapter->ch_sw_info.buf_wptr = NULL; -+ adapter->ch_sw_info.extra_info_en = 0; -+ adapter->ch_sw_info.buf_size = 0; -+ adapter->ch_sw_info.avl_buf_size = 0; -+ adapter->ch_sw_info.total_size = 0; -+ adapter->ch_sw_info.ch_num = 0; -+ -+ adapter->drv_info_size = 0; -+ adapter->tx_desc_transfer = 0; -+ -+ adapter->txff_alloc.tx_fifo_pg_num = 0; -+ adapter->txff_alloc.acq_pg_num = 0; -+ adapter->txff_alloc.rsvd_boundary = 0; -+ adapter->txff_alloc.rsvd_drv_addr = 0; -+ adapter->txff_alloc.rsvd_h2c_info_addr = 0; -+ adapter->txff_alloc.rsvd_h2cq_addr = 0; -+ adapter->txff_alloc.rsvd_cpu_instr_addr = 0; -+ adapter->txff_alloc.rsvd_fw_txbuf_addr = 0; -+ adapter->txff_alloc.pub_queue_pg_num = 0; -+ adapter->txff_alloc.high_queue_pg_num = 0; -+ adapter->txff_alloc.low_queue_pg_num = 0; -+ adapter->txff_alloc.normal_queue_pg_num = 0; -+ adapter->txff_alloc.extra_queue_pg_num = 0; -+ -+ adapter->txff_alloc.la_mode = HALMAC_LA_MODE_DISABLE; -+ adapter->txff_alloc.rx_fifo_exp_mode = -+ HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE; -+ -+ adapter->hw_cfg_info.chk_security_keyid = 0; -+ adapter->hw_cfg_info.acq_num = 8; -+ adapter->hw_cfg_info.page_size = TX_PAGE_SIZE_88XX; -+ adapter->hw_cfg_info.tx_align_size = TX_ALIGN_SIZE_88XX; -+ adapter->hw_cfg_info.txdesc_size = TX_DESC_SIZE_88XX; -+ adapter->hw_cfg_info.rxdesc_size = RX_DESC_SIZE_88XX; -+ adapter->hw_cfg_info.rx_desc_fifo_size = 0; -+ -+ adapter->sdio_cmd53_4byte = HALMAC_SDIO_CMD53_4BYTE_MODE_DISABLE; -+ adapter->sdio_hw_info.io_hi_speed_flag = 0; -+ adapter->sdio_hw_info.io_indir_flag = 1; -+ adapter->sdio_hw_info.io_warn_flag = 0; -+ adapter->sdio_hw_info.spec_ver = HALMAC_SDIO_SPEC_VER_2_00; -+ adapter->sdio_hw_info.clock_speed = 50; -+ adapter->sdio_hw_info.block_size = 512; -+ adapter->sdio_hw_info.tx_seq = 1; -+ adapter->sdio_fs.macid_map = (u8 *)NULL; -+ -+ adapter->watcher.get_watcher.sdio_rn_not_align = 0; -+ -+ adapter->pinmux_info.wl_led = 0; -+ adapter->pinmux_info.sdio_int = 0; -+ adapter->pinmux_info.sw_io_0 = 0; -+ adapter->pinmux_info.sw_io_1 = 0; -+ adapter->pinmux_info.sw_io_2 = 0; -+ adapter->pinmux_info.sw_io_3 = 0; -+ adapter->pinmux_info.sw_io_4 = 0; -+ adapter->pinmux_info.sw_io_5 = 0; -+ adapter->pinmux_info.sw_io_6 = 0; -+ adapter->pinmux_info.sw_io_7 = 0; -+ adapter->pinmux_info.sw_io_8 = 0; -+ adapter->pinmux_info.sw_io_9 = 0; -+ adapter->pinmux_info.sw_io_10 = 0; -+ adapter->pinmux_info.sw_io_11 = 0; -+ adapter->pinmux_info.sw_io_12 = 0; -+ adapter->pinmux_info.sw_io_13 = 0; -+ adapter->pinmux_info.sw_io_14 = 0; -+ adapter->pinmux_info.sw_io_15 = 0; -+ -+ adapter->pcie_refautok_en = 1; -+ adapter->pwr_off_flow_flag = 0; -+ -+ adapter->rx_ignore_info.hdr_chk_mask = 1; -+ adapter->rx_ignore_info.fcs_chk_mask = 1; -+ adapter->rx_ignore_info.hdr_chk_en = 0; -+ adapter->rx_ignore_info.fcs_chk_en = 0; -+ adapter->rx_ignore_info.cck_rst_en = 0; -+ adapter->rx_ignore_info.fcs_chk_thr = HALMAC_PSF_FCS_CHK_THR_28; -+ -+ init_adapter_dynamic_param_88xx(adapter); -+ init_state_machine_88xx(adapter); -+} -+ -+void -+init_adapter_dynamic_param_88xx(struct halmac_adapter *adapter) -+{ -+ adapter->h2c_info.seq_num = 0; -+ adapter->h2c_info.buf_fs = 0; -+} -+ -+enum halmac_ret_status -+mount_api_88xx(struct halmac_adapter *adapter) -+{ -+ struct halmac_api *api = NULL; -+ -+ adapter->halmac_api = -+ (struct halmac_api *)PLTFM_MALLOC(sizeof(struct halmac_api)); -+ if (!adapter->halmac_api) -+ return HALMAC_RET_MALLOC_FAIL; -+ -+ api = (struct halmac_api *)adapter->halmac_api; -+ -+ api->halmac_read_efuse = NULL; -+ api->halmac_write_efuse = NULL; -+ -+ /* Mount function pointer */ -+ api->halmac_register_api = register_api_88xx; -+ api->halmac_download_firmware = download_firmware_88xx; -+ api->halmac_free_download_firmware = free_download_firmware_88xx; -+ api->halmac_reset_wifi_fw = reset_wifi_fw_88xx; -+ api->halmac_get_fw_version = get_fw_version_88xx; -+ api->halmac_cfg_mac_addr = cfg_mac_addr_88xx; -+ api->halmac_cfg_bssid = cfg_bssid_88xx; -+ api->halmac_cfg_transmitter_addr = cfg_transmitter_addr_88xx; -+ api->halmac_cfg_net_type = cfg_net_type_88xx; -+ api->halmac_cfg_tsf_rst = cfg_tsf_rst_88xx; -+ api->halmac_cfg_bcn_space = cfg_bcn_space_88xx; -+ api->halmac_rw_bcn_ctrl = rw_bcn_ctrl_88xx; -+ api->halmac_cfg_multicast_addr = cfg_multicast_addr_88xx; -+ api->halmac_cfg_operation_mode = cfg_operation_mode_88xx; -+ api->halmac_cfg_ch_bw = cfg_ch_bw_88xx; -+ api->halmac_cfg_bw = cfg_bw_88xx; -+ api->halmac_init_mac_cfg = init_mac_cfg_88xx; -+ api->halmac_dump_efuse_map = dump_efuse_map_88xx; -+ api->halmac_dump_efuse_map_bt = dump_efuse_map_bt_88xx; -+ api->halmac_write_efuse_bt = write_efuse_bt_88xx; -+ api->halmac_read_efuse_bt = read_efuse_bt_88xx; -+ api->halmac_cfg_efuse_auto_check = cfg_efuse_auto_check_88xx; -+ api->halmac_dump_logical_efuse_map = dump_log_efuse_map_88xx; -+ api->halmac_dump_logical_efuse_mask = dump_log_efuse_mask_88xx; -+ api->halmac_pg_efuse_by_map = pg_efuse_by_map_88xx; -+ api->halmac_mask_logical_efuse = mask_log_efuse_88xx; -+ api->halmac_get_efuse_size = get_efuse_size_88xx; -+ api->halmac_get_efuse_available_size = get_efuse_available_size_88xx; -+ api->halmac_get_c2h_info = get_c2h_info_88xx; -+ -+ api->halmac_get_logical_efuse_size = get_log_efuse_size_88xx; -+ -+ api->halmac_write_logical_efuse = write_log_efuse_88xx; -+ api->halmac_write_logical_efuse_word = write_log_efuse_word_88xx; -+ api->halmac_read_logical_efuse = read_logical_efuse_88xx; -+ -+ api->halmac_write_wifi_phy_efuse = write_wifi_phy_efuse_88xx; -+ api->halmac_read_wifi_phy_efuse = read_wifi_phy_efuse_88xx; -+ -+ api->halmac_ofld_func_cfg = ofld_func_cfg_88xx; -+ api->halmac_h2c_lb = h2c_lb_88xx; -+ api->halmac_debug = mac_debug_88xx; -+ api->halmac_cfg_parameter = cfg_parameter_88xx; -+ api->halmac_update_datapack = update_datapack_88xx; -+ api->halmac_run_datapack = run_datapack_88xx; -+ api->halmac_send_bt_coex = send_bt_coex_88xx; -+ api->halmac_verify_platform_api = verify_platform_api_88xx; -+ api->halmac_update_packet = update_packet_88xx; -+ api->halmac_bcn_ie_filter = bcn_ie_filter_88xx; -+ api->halmac_cfg_txbf = cfg_txbf_88xx; -+ api->halmac_cfg_mumimo = cfg_mumimo_88xx; -+ api->halmac_cfg_sounding = cfg_sounding_88xx; -+ api->halmac_del_sounding = del_sounding_88xx; -+ api->halmac_su_bfer_entry_init = su_bfer_entry_init_88xx; -+ api->halmac_su_bfee_entry_init = su_bfee_entry_init_88xx; -+ api->halmac_mu_bfer_entry_init = mu_bfer_entry_init_88xx; -+ api->halmac_mu_bfee_entry_init = mu_bfee_entry_init_88xx; -+ api->halmac_su_bfer_entry_del = su_bfer_entry_del_88xx; -+ api->halmac_su_bfee_entry_del = su_bfee_entry_del_88xx; -+ api->halmac_mu_bfer_entry_del = mu_bfer_entry_del_88xx; -+ api->halmac_mu_bfee_entry_del = mu_bfee_entry_del_88xx; -+ -+ api->halmac_add_ch_info = add_ch_info_88xx; -+ api->halmac_add_extra_ch_info = add_extra_ch_info_88xx; -+ api->halmac_ctrl_ch_switch = ctrl_ch_switch_88xx; -+ api->halmac_p2pps = p2pps_88xx; -+ api->halmac_clear_ch_info = clear_ch_info_88xx; -+ api->halmac_send_general_info = send_general_info_88xx; -+ api->halmac_send_scan_packet = send_scan_packet_88xx; -+ api->halmac_drop_scan_packet = drop_scan_packet_88xx; -+ -+ api->halmac_start_iqk = start_iqk_88xx; -+ api->halmac_start_dpk = start_dpk_88xx; -+ api->halmac_ctrl_pwr_tracking = ctrl_pwr_tracking_88xx; -+ api->halmac_psd = psd_88xx; -+ api->halmac_cfg_la_mode = cfg_la_mode_88xx; -+ api->halmac_cfg_rxff_expand_mode = cfg_rxfifo_expand_mode_88xx; -+ -+ api->halmac_config_security = config_security_88xx; -+ api->halmac_get_used_cam_entry_num = get_used_cam_entry_num_88xx; -+ api->halmac_read_cam_entry = read_cam_entry_88xx; -+ api->halmac_write_cam = write_cam_88xx; -+ api->halmac_clear_cam_entry = clear_cam_entry_88xx; -+ -+ api->halmac_cfg_drv_rsvd_pg_num = cfg_drv_rsvd_pg_num_88xx; -+ api->halmac_get_chip_version = get_version_88xx; -+ -+ api->halmac_query_status = query_status_88xx; -+ api->halmac_reset_feature = reset_ofld_feature_88xx; -+ api->halmac_check_fw_status = check_fw_status_88xx; -+ api->halmac_dump_fw_dmem = dump_fw_dmem_88xx; -+ api->halmac_cfg_max_dl_size = cfg_max_dl_size_88xx; -+ -+ api->halmac_dump_fifo = dump_fifo_88xx; -+ api->halmac_get_fifo_size = get_fifo_size_88xx; -+ -+ api->halmac_chk_txdesc = chk_txdesc_88xx; -+ api->halmac_dl_drv_rsvd_page = dl_drv_rsvd_page_88xx; -+ api->halmac_cfg_csi_rate = cfg_csi_rate_88xx; -+ -+ api->halmac_txfifo_is_empty = txfifo_is_empty_88xx; -+ api->halmac_download_flash = download_flash_88xx; -+ api->halmac_read_flash = read_flash_88xx; -+ api->halmac_erase_flash = erase_flash_88xx; -+ api->halmac_check_flash = check_flash_88xx; -+ api->halmac_cfg_edca_para = cfg_edca_para_88xx; -+ api->halmac_pinmux_wl_led_mode = pinmux_wl_led_mode_88xx; -+ api->halmac_pinmux_wl_led_sw_ctrl = pinmux_wl_led_sw_ctrl_88xx; -+ api->halmac_pinmux_sdio_int_polarity = pinmux_sdio_int_polarity_88xx; -+ api->halmac_pinmux_gpio_mode = pinmux_gpio_mode_88xx; -+ api->halmac_pinmux_gpio_output = pinmux_gpio_output_88xx; -+ api->halmac_pinmux_pin_status = pinmux_pin_status_88xx; -+ -+ api->halmac_rx_cut_amsdu_cfg = rx_cut_amsdu_cfg_88xx; -+ api->halmac_fw_snding = fw_snding_88xx; -+ api->halmac_get_mac_addr = get_mac_addr_88xx; -+ -+ api->halmac_enter_cpu_sleep_mode = enter_cpu_sleep_mode_88xx; -+ api->halmac_get_cpu_mode = get_cpu_mode_88xx; -+ api->halmac_drv_fwctrl = drv_fwctrl_88xx; -+ api->halmac_get_watcher = get_watcher_88xx; -+ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+#if HALMAC_SDIO_SUPPORT -+ api->halmac_deinit_sdio_cfg = deinit_sdio_cfg_88xx; -+ api->halmac_cfg_rx_aggregation = cfg_sdio_rx_agg_88xx; -+ api->halmac_deinit_interface_cfg = deinit_sdio_cfg_88xx; -+ api->halmac_cfg_tx_agg_align = cfg_txagg_sdio_align_88xx; -+ api->halmac_set_bulkout_num = set_sdio_bulkout_num_88xx; -+ api->halmac_get_usb_bulkout_id = get_sdio_bulkout_id_88xx; -+ api->halmac_reg_read_indirect_32 = sdio_indirect_reg_r32_88xx; -+ api->halmac_reg_sdio_cmd53_read_n = sdio_reg_rn_88xx; -+ api->halmac_sdio_cmd53_4byte = sdio_cmd53_4byte_88xx; -+ api->halmac_sdio_hw_info = sdio_hw_info_88xx; -+ api->halmac_en_ref_autok_pcie = en_ref_autok_sdio_88xx; -+ -+#endif -+ } else if (adapter->intf == HALMAC_INTERFACE_USB) { -+#if HALMAC_USB_SUPPORT -+ api->halmac_init_usb_cfg = init_usb_cfg_88xx; -+ api->halmac_deinit_usb_cfg = deinit_usb_cfg_88xx; -+ api->halmac_cfg_rx_aggregation = cfg_usb_rx_agg_88xx; -+ api->halmac_init_interface_cfg = init_usb_cfg_88xx; -+ api->halmac_deinit_interface_cfg = deinit_usb_cfg_88xx; -+ api->halmac_cfg_tx_agg_align = cfg_txagg_usb_align_88xx; -+ api->halmac_tx_allowed_sdio = tx_allowed_usb_88xx; -+ api->halmac_set_bulkout_num = set_usb_bulkout_num_88xx; -+ api->halmac_get_sdio_tx_addr = get_usb_tx_addr_88xx; -+ api->halmac_get_usb_bulkout_id = get_usb_bulkout_id_88xx; -+ api->halmac_reg_read_8 = reg_r8_usb_88xx; -+ api->halmac_reg_write_8 = reg_w8_usb_88xx; -+ api->halmac_reg_read_16 = reg_r16_usb_88xx; -+ api->halmac_reg_write_16 = reg_w16_usb_88xx; -+ api->halmac_reg_read_32 = reg_r32_usb_88xx; -+ api->halmac_reg_write_32 = reg_w32_usb_88xx; -+ api->halmac_reg_read_indirect_32 = usb_indirect_reg_r32_88xx; -+ api->halmac_reg_sdio_cmd53_read_n = usb_reg_rn_88xx; -+ api->halmac_en_ref_autok_pcie = en_ref_autok_usb_88xx; -+#endif -+ } else if (adapter->intf == HALMAC_INTERFACE_PCIE) { -+#if HALMAC_PCIE_SUPPORT -+ api->halmac_init_pcie_cfg = init_pcie_cfg_88xx; -+ api->halmac_deinit_pcie_cfg = deinit_pcie_cfg_88xx; -+ api->halmac_cfg_rx_aggregation = cfg_pcie_rx_agg_88xx; -+ api->halmac_init_interface_cfg = init_pcie_cfg_88xx; -+ api->halmac_deinit_interface_cfg = deinit_pcie_cfg_88xx; -+ api->halmac_cfg_tx_agg_align = cfg_txagg_pcie_align_88xx; -+ api->halmac_tx_allowed_sdio = tx_allowed_pcie_88xx; -+ api->halmac_set_bulkout_num = set_pcie_bulkout_num_88xx; -+ api->halmac_get_sdio_tx_addr = get_pcie_tx_addr_88xx; -+ api->halmac_get_usb_bulkout_id = get_pcie_bulkout_id_88xx; -+ api->halmac_reg_read_8 = reg_r8_pcie_88xx; -+ api->halmac_reg_write_8 = reg_w8_pcie_88xx; -+ api->halmac_reg_read_16 = reg_r16_pcie_88xx; -+ api->halmac_reg_write_16 = reg_w16_pcie_88xx; -+ api->halmac_reg_read_32 = reg_r32_pcie_88xx; -+ api->halmac_reg_write_32 = reg_w32_pcie_88xx; -+ api->halmac_reg_read_indirect_32 = pcie_indirect_reg_r32_88xx; -+ api->halmac_reg_sdio_cmd53_read_n = pcie_reg_rn_88xx; -+ api->halmac_en_ref_autok_pcie = en_ref_autok_pcie_88xx; -+#endif -+ } else { -+ PLTFM_MSG_ERR("[ERR]Set halmac io function Error!!\n"); -+ } -+ -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822B) { -+#if HALMAC_8822B_SUPPORT -+ mount_api_8822b(adapter); -+#endif -+ } else if (adapter->chip_id == HALMAC_CHIP_ID_8821C) { -+#if HALMAC_8821C_SUPPORT -+ mount_api_8821c(adapter); -+#endif -+ } else if (adapter->chip_id == HALMAC_CHIP_ID_8822C) { -+#if HALMAC_8822C_SUPPORT -+ mount_api_8822c(adapter); -+#endif -+ } else if (adapter->chip_id == HALMAC_CHIP_ID_8812F) { -+#if HALMAC_8812F_SUPPORT -+ mount_api_8812f(adapter); -+#endif -+ } else { -+ PLTFM_MSG_ERR("[ERR]Chip ID undefine!!\n"); -+ return HALMAC_RET_CHIP_NOT_SUPPORT; -+ } -+ -+#if HALMAC_PLATFORM_TESTPROGRAM -+ halmac_mount_misc_api_88xx(adapter); -+#endif -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static void -+init_state_machine_88xx(struct halmac_adapter *adapter) -+{ -+ struct halmac_state *state = &adapter->halmac_state; -+ -+ init_ofld_feature_state_machine_88xx(adapter); -+ -+ state->api_state = HALMAC_API_STATE_INIT; -+ -+ state->dlfw_state = HALMAC_DLFW_NONE; -+ state->mac_pwr = HALMAC_MAC_POWER_OFF; -+ state->gpio_cfg_state = HALMAC_GPIO_CFG_STATE_IDLE; -+ state->rsvd_pg_state = HALMAC_RSVD_PG_STATE_IDLE; -+} -+ -+void -+init_ofld_feature_state_machine_88xx(struct halmac_adapter *adapter) -+{ -+ struct halmac_state *state = &adapter->halmac_state; -+ -+ state->efuse_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ state->efuse_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->efuse_state.seq_num = adapter->h2c_info.seq_num; -+ -+ state->cfg_param_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ state->cfg_param_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->cfg_param_state.seq_num = adapter->h2c_info.seq_num; -+ -+ state->scan_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ state->scan_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->scan_state.seq_num = adapter->h2c_info.seq_num; -+ -+ state->update_pkt_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->update_pkt_state.seq_num = adapter->h2c_info.seq_num; -+ -+ state->iqk_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->iqk_state.seq_num = adapter->h2c_info.seq_num; -+ -+ state->pwr_trk_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->pwr_trk_state.seq_num = adapter->h2c_info.seq_num; -+ -+ state->psd_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->psd_state.seq_num = adapter->h2c_info.seq_num; -+ state->psd_state.data_size = 0; -+ state->psd_state.seg_size = 0; -+ state->psd_state.data = NULL; -+ -+ state->fw_snding_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ state->fw_snding_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->fw_snding_state.seq_num = adapter->h2c_info.seq_num; -+ -+ state->wlcpu_mode = HALMAC_WLCPU_ACTIVE; -+} -+ -+/** -+ * register_api_88xx() - register feature list -+ * @adapter -+ * @registry : feature list, 1->enable 0->disable -+ * Author : Ivan Lin -+ * -+ * Default is enable all api registry -+ * -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+register_api_88xx(struct halmac_adapter *adapter, -+ struct halmac_api_registry *registry) -+{ -+ if (!registry) -+ return HALMAC_RET_NULL_POINTER; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ PLTFM_MEMCPY(&adapter->api_registry, registry, sizeof(*registry)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * init_mac_cfg_88xx() - config page1~page7 register -+ * @adapter : the adapter of halmac -+ * @mode : trx mode -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+init_mac_cfg_88xx(struct halmac_adapter *adapter, enum halmac_trx_mode mode) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ status = api->halmac_init_trx_cfg(adapter, mode); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]init trx %x\n", status); -+ return status; -+ } -+ -+ status = api->halmac_init_protocol_cfg(adapter); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]init ptcl %x\n", status); -+ return status; -+ } -+ -+ status = api->halmac_init_edca_cfg(adapter); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]init edca %x\n", status); -+ return status; -+ } -+ -+ status = api->halmac_init_wmac_cfg(adapter); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]init wmac %x\n", status); -+ return status; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return status; -+} -+ -+/** -+ * reset_ofld_feature_88xx() -reset async api cmd status -+ * @adapter : the adapter of halmac -+ * @feature_id : feature_id -+ * Author : Ivan Lin/KaiYuan Chang -+ * Return : enum halmac_ret_status. -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+reset_ofld_feature_88xx(struct halmac_adapter *adapter, -+ enum halmac_feature_id feature_id) -+{ -+ struct halmac_state *state = &adapter->halmac_state; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ switch (feature_id) { -+ case HALMAC_FEATURE_CFG_PARA: -+ state->cfg_param_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->cfg_param_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ break; -+ case HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE: -+ case HALMAC_FEATURE_DUMP_LOGICAL_EFUSE: -+ case HALMAC_FEATURE_DUMP_LOGICAL_EFUSE_MASK: -+ state->efuse_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->efuse_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ break; -+ case HALMAC_FEATURE_CHANNEL_SWITCH: -+ state->scan_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->scan_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ break; -+ case HALMAC_FEATURE_UPDATE_PACKET: -+ state->update_pkt_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ break; -+ case HALMAC_FEATURE_SEND_SCAN_PACKET: -+ state->scan_pkt_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ break; -+ case HALMAC_FEATURE_DROP_SCAN_PACKET: -+ state->drop_pkt_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ break; -+ case HALMAC_FEATURE_IQK: -+ state->iqk_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ break; -+ case HALMAC_FEATURE_POWER_TRACKING: -+ state->pwr_trk_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ break; -+ case HALMAC_FEATURE_PSD: -+ state->psd_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ break; -+ case HALMAC_FEATURE_FW_SNDING: -+ state->fw_snding_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->fw_snding_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ break; -+ case HALMAC_FEATURE_DPK: -+ state->dpk_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ break; -+ case HALMAC_FEATURE_ALL: -+ state->cfg_param_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->cfg_param_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ state->efuse_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->efuse_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ state->scan_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->scan_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ state->update_pkt_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->scan_pkt_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->drop_pkt_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->iqk_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->pwr_trk_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->psd_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->fw_snding_state.proc_status = HALMAC_CMD_PROCESS_IDLE; -+ state->fw_snding_state.cmd_cnstr_state = HALMAC_CMD_CNSTR_IDLE; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]invalid feature id\n"); -+ return HALMAC_RET_INVALID_FEATURE_ID; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * (debug API)verify_platform_api_88xx() - verify platform api -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+verify_platform_api_88xx(struct halmac_adapter *adapter) -+{ -+ enum halmac_ret_status ret_status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ ret_status = verify_io_88xx(adapter); -+ -+ if (ret_status != HALMAC_RET_SUCCESS) -+ return ret_status; -+ -+ if (adapter->txff_alloc.la_mode != HALMAC_LA_MODE_FULL) -+ ret_status = verify_send_rsvd_page_88xx(adapter); -+ -+ if (ret_status != HALMAC_RET_SUCCESS) -+ return ret_status; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return ret_status; -+} -+ -+void -+tx_desc_chksum_88xx(struct halmac_adapter *adapter, u8 enable) -+{ -+ u16 value16; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ adapter->tx_desc_checksum = enable; -+ -+ value16 = HALMAC_REG_R16(REG_TXDMA_OFFSET_CHK); -+ if (enable == 1) -+ HALMAC_REG_W16(REG_TXDMA_OFFSET_CHK, value16 | BIT(13)); -+ else -+ HALMAC_REG_W16(REG_TXDMA_OFFSET_CHK, value16 & ~BIT(13)); -+} -+ -+static enum halmac_ret_status -+verify_io_88xx(struct halmac_adapter *adapter) -+{ -+ u8 value8; -+ u8 wvalue8; -+ u32 value32; -+ u32 value32_2; -+ u32 wvalue32; -+ u32 offset; -+ enum halmac_ret_status ret_status = HALMAC_RET_SUCCESS; -+ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+#if HALMAC_SDIO_SUPPORT -+ offset = REG_PAGE5_DUMMY; -+ if (0 == (offset & 0xFFFF0000)) -+ offset |= WLAN_IOREG_OFFSET; -+ -+ ret_status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ -+ /* Verify CMD52 R/W */ -+ wvalue8 = 0xab; -+ PLTFM_SDIO_CMD52_W(offset, wvalue8); -+ -+ value8 = PLTFM_SDIO_CMD52_R(offset); -+ -+ if (value8 != wvalue8) { -+ PLTFM_MSG_ERR("[ERR]cmd52 r/w\n"); -+ ret_status = HALMAC_RET_PLATFORM_API_INCORRECT; -+ } -+ -+ /* Verify CMD53 R/W */ -+ PLTFM_SDIO_CMD52_W(offset, 0xaa); -+ PLTFM_SDIO_CMD52_W(offset + 1, 0xbb); -+ PLTFM_SDIO_CMD52_W(offset + 2, 0xcc); -+ PLTFM_SDIO_CMD52_W(offset + 3, 0xdd); -+ -+ value32 = PLTFM_SDIO_CMD53_R32(offset); -+ -+ if (value32 != 0xddccbbaa) { -+ PLTFM_MSG_ERR("[ERR]cmd53 r\n"); -+ ret_status = HALMAC_RET_PLATFORM_API_INCORRECT; -+ } -+ -+ wvalue32 = 0x11223344; -+ PLTFM_SDIO_CMD53_W32(offset, wvalue32); -+ -+ value32 = PLTFM_SDIO_CMD53_R32(offset); -+ -+ if (value32 != wvalue32) { -+ PLTFM_MSG_ERR("[ERR]cmd53 w\n"); -+ ret_status = HALMAC_RET_PLATFORM_API_INCORRECT; -+ } -+ -+ /* value32 should be 0x33441122 */ -+ value32 = PLTFM_SDIO_CMD53_R32(offset + 2); -+ -+ wvalue32 = 0x11225566; -+ PLTFM_SDIO_CMD53_W32(offset, wvalue32); -+ -+ /* value32 should be 0x55661122 */ -+ value32_2 = PLTFM_SDIO_CMD53_R32(offset + 2); -+ if (value32_2 == value32) { -+ PLTFM_MSG_ERR("[ERR]cmd52 is used\n"); -+ ret_status = HALMAC_RET_PLATFORM_API_INCORRECT; -+ } -+#else -+ return HALMAC_RET_WRONG_INTF; -+#endif -+ } else { -+ wvalue32 = 0x77665511; -+ PLTFM_REG_W32(REG_PAGE5_DUMMY, wvalue32); -+ -+ value32 = PLTFM_REG_R32(REG_PAGE5_DUMMY); -+ if (value32 != wvalue32) { -+ PLTFM_MSG_ERR("[ERR]reg rw\n"); -+ ret_status = HALMAC_RET_PLATFORM_API_INCORRECT; -+ } -+ } -+ -+ return ret_status; -+} -+ -+static enum halmac_ret_status -+verify_send_rsvd_page_88xx(struct halmac_adapter *adapter) -+{ -+ u8 txdesc_size = adapter->hw_cfg_info.txdesc_size; -+ u8 *rsvd_buf = NULL; -+ u8 *rsvd_page = NULL; -+ u32 i; -+ u32 pkt_size = 64; -+ u32 payload = 0xab; -+ enum halmac_ret_status ret_status = HALMAC_RET_SUCCESS; -+ -+ rsvd_buf = (u8 *)PLTFM_MALLOC(pkt_size); -+ -+ if (!rsvd_buf) { -+ PLTFM_MSG_ERR("[ERR]rsvd buf malloc!!\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ -+ PLTFM_MEMSET(rsvd_buf, (u8)payload, pkt_size); -+ -+ ret_status = dl_rsvd_page_88xx(adapter, -+ adapter->txff_alloc.rsvd_boundary, -+ rsvd_buf, pkt_size); -+ if (ret_status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(rsvd_buf, pkt_size); -+ return ret_status; -+ } -+ -+ rsvd_page = (u8 *)PLTFM_MALLOC(pkt_size + txdesc_size); -+ -+ if (!rsvd_page) { -+ PLTFM_MSG_ERR("[ERR]rsvd page malloc!!\n"); -+ PLTFM_FREE(rsvd_buf, pkt_size); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ -+ PLTFM_MEMSET(rsvd_page, 0x00, pkt_size + txdesc_size); -+ -+ ret_status = dump_fifo_88xx(adapter, HAL_FIFO_SEL_RSVD_PAGE, 0, -+ pkt_size + txdesc_size, rsvd_page); -+ -+ if (ret_status != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(rsvd_buf, pkt_size); -+ PLTFM_FREE(rsvd_page, pkt_size + txdesc_size); -+ return ret_status; -+ } -+ -+ for (i = 0; i < pkt_size; i++) { -+ if (*(rsvd_buf + i) != *(rsvd_page + (i + txdesc_size))) { -+ PLTFM_MSG_ERR("[ERR]Compare RSVD page Fail\n"); -+ ret_status = HALMAC_RET_PLATFORM_API_INCORRECT; -+ } -+ } -+ -+ PLTFM_FREE(rsvd_buf, pkt_size); -+ PLTFM_FREE(rsvd_page, pkt_size + txdesc_size); -+ -+ return ret_status; -+} -+ -+enum halmac_ret_status -+pg_num_parser_88xx(struct halmac_adapter *adapter, enum halmac_trx_mode mode, -+ struct halmac_pg_num *tbl) -+{ -+ u8 flag; -+ u16 hpq_num = 0; -+ u16 lpq_num = 0; -+ u16 npq_num = 0; -+ u16 gapq_num = 0; -+ u16 expq_num = 0; -+ u16 pubq_num = 0; -+ u32 i = 0; -+ -+ flag = 0; -+ for (i = 0; i < HALMAC_TRX_MODE_MAX; i++) { -+ if (mode == tbl[i].mode) { -+ hpq_num = tbl[i].hq_num; -+ lpq_num = tbl[i].lq_num; -+ npq_num = tbl[i].nq_num; -+ expq_num = tbl[i].exq_num; -+ gapq_num = tbl[i].gap_num; -+ pubq_num = adapter->txff_alloc.acq_pg_num - hpq_num - -+ lpq_num - npq_num - expq_num - gapq_num; -+ flag = 1; -+ PLTFM_MSG_TRACE("[TRACE]%s done\n", __func__); -+ break; -+ } -+ } -+ -+ if (flag == 0) { -+ PLTFM_MSG_ERR("[ERR]trx mode!!\n"); -+ return HALMAC_RET_TRX_MODE_NOT_SUPPORT; -+ } -+ -+ if (adapter->txff_alloc.acq_pg_num < -+ hpq_num + lpq_num + npq_num + expq_num + gapq_num) { -+ PLTFM_MSG_ERR("[ERR]acqnum = %d\n", -+ adapter->txff_alloc.acq_pg_num); -+ PLTFM_MSG_ERR("[ERR]hpq_num = %d\n", hpq_num); -+ PLTFM_MSG_ERR("[ERR]LPQ_num = %d\n", lpq_num); -+ PLTFM_MSG_ERR("[ERR]npq_num = %d\n", npq_num); -+ PLTFM_MSG_ERR("[ERR]EPQ_num = %d\n", expq_num); -+ PLTFM_MSG_ERR("[ERR]gapq_num = %d\n", gapq_num); -+ return HALMAC_RET_CFG_TXFIFO_PAGE_FAIL; -+ } -+ -+ adapter->txff_alloc.high_queue_pg_num = hpq_num; -+ adapter->txff_alloc.low_queue_pg_num = lpq_num; -+ adapter->txff_alloc.normal_queue_pg_num = npq_num; -+ adapter->txff_alloc.extra_queue_pg_num = expq_num; -+ adapter->txff_alloc.pub_queue_pg_num = pubq_num; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+rqpn_parser_88xx(struct halmac_adapter *adapter, enum halmac_trx_mode mode, -+ struct halmac_rqpn *tbl) -+{ -+ u8 flag; -+ u32 i; -+ -+ flag = 0; -+ for (i = 0; i < HALMAC_TRX_MODE_MAX; i++) { -+ if (mode == tbl[i].mode) { -+ adapter->pq_map[HALMAC_PQ_MAP_VO] = tbl[i].dma_map_vo; -+ adapter->pq_map[HALMAC_PQ_MAP_VI] = tbl[i].dma_map_vi; -+ adapter->pq_map[HALMAC_PQ_MAP_BE] = tbl[i].dma_map_be; -+ adapter->pq_map[HALMAC_PQ_MAP_BK] = tbl[i].dma_map_bk; -+ adapter->pq_map[HALMAC_PQ_MAP_MG] = tbl[i].dma_map_mg; -+ adapter->pq_map[HALMAC_PQ_MAP_HI] = tbl[i].dma_map_hi; -+ flag = 1; -+ PLTFM_MSG_TRACE("[TRACE]%s done\n", __func__); -+ break; -+ } -+ } -+ -+ if (flag == 0) { -+ PLTFM_MSG_ERR("[ERR]trx mdoe!!\n"); -+ return HALMAC_RET_TRX_MODE_NOT_SUPPORT; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+fwff_is_empty_88xx(struct halmac_adapter *adapter) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u32 cnt; -+ -+ cnt = 5000; -+ while (HALMAC_REG_R16(REG_FWFF_CTRL) != -+ HALMAC_REG_R16(REG_FWFF_PKT_INFO)) { -+ if (cnt == 0) { -+ PLTFM_MSG_ERR("[ERR]polling fwff empty fail\n"); -+ return HALMAC_RET_FWFF_NO_EMPTY; -+ } -+ cnt--; -+ PLTFM_DELAY_US(50); -+ } -+ return HALMAC_RET_SUCCESS; -+} -+ -+#endif /* HALMAC_88XX_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_init_88xx.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_init_88xx.h -new file mode 100644 -index 000000000..108bb2ed6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_init_88xx.h -@@ -0,0 +1,65 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_INIT_88XX_H_ -+#define _HALMAC_INIT_88XX_H_ -+ -+#include "../halmac_api.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+enum halmac_ret_status -+register_api_88xx(struct halmac_adapter *adapter, -+ struct halmac_api_registry *registry); -+ -+void -+init_adapter_param_88xx(struct halmac_adapter *adapter); -+ -+void -+init_adapter_dynamic_param_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+mount_api_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+init_mac_cfg_88xx(struct halmac_adapter *adapter, enum halmac_trx_mode mode); -+ -+enum halmac_ret_status -+reset_ofld_feature_88xx(struct halmac_adapter *adapter, -+ enum halmac_feature_id feature_id); -+ -+enum halmac_ret_status -+verify_platform_api_88xx(struct halmac_adapter *adapter); -+ -+void -+tx_desc_chksum_88xx(struct halmac_adapter *adapter, u8 enable); -+ -+enum halmac_ret_status -+pg_num_parser_88xx(struct halmac_adapter *adapter, enum halmac_trx_mode mode, -+ struct halmac_pg_num *tbl); -+ -+enum halmac_ret_status -+rqpn_parser_88xx(struct halmac_adapter *adapter, enum halmac_trx_mode mode, -+ struct halmac_rqpn *tbl); -+ -+void -+init_ofld_feature_state_machine_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+fwff_is_empty_88xx(struct halmac_adapter *adapter); -+ -+#endif /* HALMAC_88XX_SUPPORT */ -+ -+#endif/* _HALMAC_INIT_88XX_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_mimo_88xx.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_mimo_88xx.c -new file mode 100644 -index 000000000..a13016d21 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_mimo_88xx.c -@@ -0,0 +1,891 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_mimo_88xx.h" -+#include "halmac_88xx_cfg.h" -+#include "halmac_common_88xx.h" -+#include "halmac_init_88xx.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+#define TXBF_CTRL_CFG (BIT_R_ENABLE_NDPA | BIT_USE_NDPA_PARAMETER | \ -+ BIT_R_EN_NDPA_INT | BIT_DIS_NDP_BFEN) -+#define CSI_RATE_MAP 0x55 -+ -+static void -+cfg_mu_bfee_88xx(struct halmac_adapter *adapter, -+ struct halmac_cfg_mumimo_para *param); -+ -+static void -+cfg_mu_bfer_88xx(struct halmac_adapter *adapter, -+ struct halmac_cfg_mumimo_para *param); -+ -+static enum halmac_cmd_construct_state -+fw_snding_cmd_cnstr_state_88xx(struct halmac_adapter *adapter); -+ -+static enum halmac_ret_status -+cnv_fw_snding_state_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_construct_state dest_state); -+ -+static u8 -+snding_pkt_chk_88xx(struct halmac_adapter *adapter, u8 *pkt); -+ -+/** -+ * cfg_txbf_88xx() - enable/disable specific user's txbf -+ * @adapter : the adapter of halmac -+ * @userid : su bfee userid = 0 or 1 to apply TXBF -+ * @bw : the sounding bandwidth -+ * @txbf_en : 0: disable TXBF, 1: enable TXBF -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_txbf_88xx(struct halmac_adapter *adapter, u8 userid, enum halmac_bw bw, -+ u8 txbf_en) -+{ -+ u16 tmp42c = 0; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (txbf_en) { -+ switch (bw) { -+ case HALMAC_BW_80: -+ tmp42c |= BIT_R_TXBF0_80M; -+ /* fall through */ -+ case HALMAC_BW_40: -+ tmp42c |= BIT_R_TXBF0_40M; -+ /* fall through */ -+ case HALMAC_BW_20: -+ tmp42c |= BIT_R_TXBF0_20M; -+ break; -+ default: -+ return HALMAC_RET_INVALID_SOUNDING_SETTING; -+ } -+ } -+ -+ switch (userid) { -+ case 0: -+ tmp42c |= HALMAC_REG_R16(REG_TXBF_CTRL) & -+ ~(BIT_R_TXBF0_20M | BIT_R_TXBF0_40M | BIT_R_TXBF0_80M); -+ HALMAC_REG_W16(REG_TXBF_CTRL, tmp42c); -+ break; -+ case 1: -+ tmp42c |= HALMAC_REG_R16(REG_TXBF_CTRL + 2) & -+ ~(BIT_R_TXBF0_20M | BIT_R_TXBF0_40M | BIT_R_TXBF0_80M); -+ HALMAC_REG_W16(REG_TXBF_CTRL + 2, tmp42c); -+ break; -+ default: -+ return HALMAC_RET_INVALID_SOUNDING_SETTING; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_mumimo_88xx() -config mumimo -+ * @adapter : the adapter of halmac -+ * @param : parameters to configure MU PPDU Tx/Rx -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_mumimo_88xx(struct halmac_adapter *adapter, -+ struct halmac_cfg_mumimo_para *param) -+{ -+ if (param->role == HAL_BFEE) -+ cfg_mu_bfee_88xx(adapter, param); -+ else -+ cfg_mu_bfer_88xx(adapter, param); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static void -+cfg_mu_bfee_88xx(struct halmac_adapter *adapter, -+ struct halmac_cfg_mumimo_para *param) -+{ -+ u8 mu_tbl_sel; -+ u8 tmp14c0; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ tmp14c0 = HALMAC_REG_R8(REG_MU_TX_CTL) & ~BIT_MASK_R_MU_TABLE_VALID; -+ HALMAC_REG_W8(REG_MU_TX_CTL, (tmp14c0 | BIT(0) | BIT(1)) & ~(BIT(7))); -+ -+ /*config GID valid table and user position table*/ -+ mu_tbl_sel = HALMAC_REG_R8(REG_MU_TX_CTL + 1) & 0xF8; -+ -+ HALMAC_REG_W8(REG_MU_TX_CTL + 1, mu_tbl_sel); -+ HALMAC_REG_W32(REG_MU_STA_GID_VLD, param->given_gid_tab[0]); -+ HALMAC_REG_W32(REG_MU_STA_USER_POS_INFO, param->given_user_pos[0]); -+ HALMAC_REG_W32(REG_MU_STA_USER_POS_INFO + 4, param->given_user_pos[1]); -+ -+ HALMAC_REG_W8(REG_MU_TX_CTL + 1, mu_tbl_sel | 1); -+ HALMAC_REG_W32(REG_MU_STA_GID_VLD, param->given_gid_tab[1]); -+ HALMAC_REG_W32(REG_MU_STA_USER_POS_INFO, param->given_user_pos[2]); -+ HALMAC_REG_W32(REG_MU_STA_USER_POS_INFO + 4, param->given_user_pos[3]); -+} -+ -+static void -+cfg_mu_bfer_88xx(struct halmac_adapter *adapter, -+ struct halmac_cfg_mumimo_para *param) -+{ -+ u8 i; -+ u8 idx; -+ u8 id0; -+ u8 id1; -+ u8 gid; -+ u8 mu_tbl_sel; -+ u8 mu_tbl_valid = 0; -+ u32 gid_valid[6] = {0}; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ if (param->mu_tx_en == 0) { -+ HALMAC_REG_W8(REG_MU_TX_CTL, -+ HALMAC_REG_R8(REG_MU_TX_CTL) & ~(BIT(7))); -+ return; -+ } -+ -+ for (idx = 0; idx < 15; idx++) { -+ if (idx < 5) { -+ /*grouping_bitmap bit0~4, MU_STA0 with MUSTA1~5*/ -+ id0 = 0; -+ id1 = (u8)(idx + 1); -+ } else if (idx < 9) { -+ /*grouping_bitmap bit5~8, MU_STA1 with MUSTA2~5*/ -+ id0 = 1; -+ id1 = (u8)(idx - 3); -+ } else if (idx < 12) { -+ /*grouping_bitmap bit9~11, MU_STA2 with MUSTA3~5*/ -+ id0 = 2; -+ id1 = (u8)(idx - 6); -+ } else if (idx < 14) { -+ /*grouping_bitmap bit12~13, MU_STA3 with MUSTA4~5*/ -+ id0 = 3; -+ id1 = (u8)(idx - 8); -+ } else { -+ /*grouping_bitmap bit14, MU_STA4 with MUSTA5*/ -+ id0 = 4; -+ id1 = (u8)(idx - 9); -+ } -+ if (param->grouping_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)); -+ } -+ } -+ -+ /*set MU STA GID valid TABLE*/ -+ mu_tbl_sel = HALMAC_REG_R8(REG_MU_TX_CTL + 1) & 0xF8; -+ for (idx = 0; idx < 6; idx++) { -+ HALMAC_REG_W8(REG_MU_TX_CTL + 1, idx | mu_tbl_sel); -+ HALMAC_REG_W32(REG_MU_STA_GID_VLD, gid_valid[idx]); -+ } -+ -+ /*To validate the sounding successful MU STA and enable MU TX*/ -+ for (i = 0; i < 6; i++) { -+ if (param->sounding_sts[i] == 1) -+ mu_tbl_valid |= BIT(i); -+ } -+ HALMAC_REG_W8(REG_MU_TX_CTL, mu_tbl_valid | BIT(7)); -+} -+ -+/** -+ * cfg_sounding_88xx() - configure general sounding -+ * @adapter : the adapter of halmac -+ * @role : driver's role, BFer or BFee -+ * @rate : set ndpa tx rate if driver is BFer, -+ * or set csi response rate if driver is BFee -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_sounding_88xx(struct halmac_adapter *adapter, enum halmac_snd_role role, -+ enum halmac_data_rate rate) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u32 tmp6dc = 0; -+ u8 csi_rsc = 0x0; -+ -+ /*use ndpa rx rate to decide csi rate*/ -+ tmp6dc = HALMAC_REG_R32(REG_BBPSF_CTRL) | BIT_WMAC_USE_NDPARATE -+ | (csi_rsc << 13); -+ -+ switch (role) { -+ case HAL_BFER: -+ HALMAC_REG_W32_SET(REG_TXBF_CTRL, TXBF_CTRL_CFG); -+ HALMAC_REG_W8(REG_NDPA_RATE, rate); -+ HALMAC_REG_W8(REG_SND_PTCL_CTRL + 1, 0x2 | BIT(7)); -+ HALMAC_REG_W8(REG_SND_PTCL_CTRL + 2, 0x2); -+ break; -+ case HAL_BFEE: -+ HALMAC_REG_W8(REG_SND_PTCL_CTRL, 0xDB); -+ HALMAC_REG_W8(REG_SND_PTCL_CTRL + 3, 0x3A); -+ HALMAC_REG_W8_CLR(REG_RXFLTMAP1, BIT(4)); -+ HALMAC_REG_W8_CLR(REG_RXFLTMAP4, BIT(4)); -+ #if (HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822C) -+ HALMAC_REG_W32(REG_CSI_RRSR, -+ BIT_CSI_RRSC_BITMAP(CSI_RATE_MAP) | -+ BIT_OFDM_LEN_TH(0)); -+ else if (adapter->chip_id == HALMAC_CHIP_ID_8812F) -+ HALMAC_REG_W32(REG_CSI_RRSR, -+ BIT_CSI_RRSC_BITMAP(CSI_RATE_MAP) | -+ BIT_OFDM_LEN_TH(3)); -+ #endif -+ break; -+ default: -+ return HALMAC_RET_INVALID_SOUNDING_SETTING; -+ } -+ -+ /*AP mode set tx gid to 63*/ -+ /*STA mode set tx gid to 0*/ -+ if (BIT_GET_NETYPE0(HALMAC_REG_R32(REG_CR)) == 0x3) -+ HALMAC_REG_W32(REG_BBPSF_CTRL, tmp6dc | BIT(12)); -+ else -+ HALMAC_REG_W32(REG_BBPSF_CTRL, tmp6dc & ~(BIT(12))); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * del_sounding_88xx() - reset general sounding -+ * @adapter : the adapter of halmac -+ * @role : driver's role, BFer or BFee -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+del_sounding_88xx(struct halmac_adapter *adapter, enum halmac_snd_role role) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ switch (role) { -+ case HAL_BFER: -+ HALMAC_REG_W8(REG_TXBF_CTRL + 3, 0); -+ break; -+ case HAL_BFEE: -+ HALMAC_REG_W8(REG_SND_PTCL_CTRL, 0); -+ break; -+ default: -+ return HALMAC_RET_INVALID_SOUNDING_SETTING; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * su_bfee_entry_init_88xx() - config SU beamformee's registers -+ * @adapter : the adapter of halmac -+ * @userid : SU bfee userid = 0 or 1 to be added -+ * @paid : partial AID of this bfee -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+su_bfee_entry_init_88xx(struct halmac_adapter *adapter, u8 userid, u16 paid) -+{ -+ u16 tmp42c = 0; -+ u16 tmp168x = 0; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ switch (userid) { -+ case 0: -+ tmp42c = HALMAC_REG_R16(REG_TXBF_CTRL) & -+ ~(BIT_MASK_R_TXBF0_AID | BIT_R_TXBF0_20M | -+ BIT_R_TXBF0_40M | BIT_R_TXBF0_80M); -+ HALMAC_REG_W16(REG_TXBF_CTRL, tmp42c | paid); -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMEE_SEL, paid); -+ #if HALMAC_8822C_SUPPORT -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822C) -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMEE_SEL, paid | BIT(9)); -+ #endif -+ break; -+ case 1: -+ tmp42c = HALMAC_REG_R16(REG_TXBF_CTRL + 2) & -+ ~(BIT_MASK_R_TXBF1_AID | BIT_R_TXBF0_20M | -+ BIT_R_TXBF0_40M | BIT_R_TXBF0_80M); -+ HALMAC_REG_W16(REG_TXBF_CTRL + 2, tmp42c | paid); -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMEE_SEL + 2, paid | BIT(9)); -+ break; -+ case 2: -+ tmp168x = HALMAC_REG_R16(REG_WMAC_ASSOCIATED_MU_BFMEE2); -+ tmp168x = BIT_CLEAR_WMAC_MU_BFEE2_AID(tmp168x); -+ tmp168x |= (paid | BIT(9)); -+ HALMAC_REG_W16(REG_WMAC_ASSOCIATED_MU_BFMEE2, tmp168x); -+ break; -+ case 3: -+ tmp168x = HALMAC_REG_R16(REG_WMAC_ASSOCIATED_MU_BFMEE3); -+ tmp168x = BIT_CLEAR_WMAC_MU_BFEE3_AID(tmp168x); -+ tmp168x |= (paid | BIT(9)); -+ HALMAC_REG_W16(REG_WMAC_ASSOCIATED_MU_BFMEE3, tmp168x); -+ break; -+ case 4: -+ tmp168x = HALMAC_REG_R16(REG_WMAC_ASSOCIATED_MU_BFMEE4); -+ tmp168x = BIT_CLEAR_WMAC_MU_BFEE4_AID(tmp168x); -+ tmp168x |= (paid | BIT(9)); -+ HALMAC_REG_W16(REG_WMAC_ASSOCIATED_MU_BFMEE4, tmp168x); -+ break; -+ case 5: -+ tmp168x = HALMAC_REG_R16(REG_WMAC_ASSOCIATED_MU_BFMEE5); -+ tmp168x = BIT_CLEAR_WMAC_MU_BFEE5_AID(tmp168x); -+ tmp168x |= (paid | BIT(9)); -+ HALMAC_REG_W16(REG_WMAC_ASSOCIATED_MU_BFMEE5, tmp168x); -+ break; -+ default: -+ return HALMAC_RET_INVALID_SOUNDING_SETTING; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * su_bfee_entry_init_88xx() - config SU beamformer's registers -+ * @adapter : the adapter of halmac -+ * @param : parameters to configure SU BFER entry -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+su_bfer_entry_init_88xx(struct halmac_adapter *adapter, -+ struct halmac_su_bfer_init_para *param) -+{ -+ u16 mac_addr_h; -+ u32 mac_addr_l; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ mac_addr_l = rtk_le32_to_cpu(param->bfer_address.addr_l_h.low); -+ mac_addr_h = rtk_le16_to_cpu(param->bfer_address.addr_l_h.high); -+ -+ switch (param->userid) { -+ case 0: -+ HALMAC_REG_W32(REG_ASSOCIATED_BFMER0_INFO, mac_addr_l); -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMER0_INFO + 4, mac_addr_h); -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMER0_INFO + 6, param->paid); -+ HALMAC_REG_W16(REG_TX_CSI_RPT_PARAM_BW20, param->csi_para); -+ break; -+ case 1: -+ HALMAC_REG_W32(REG_ASSOCIATED_BFMER1_INFO, mac_addr_l); -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMER1_INFO + 4, mac_addr_h); -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMER1_INFO + 6, param->paid); -+ HALMAC_REG_W16(REG_TX_CSI_RPT_PARAM_BW20 + 2, param->csi_para); -+ break; -+ default: -+ return HALMAC_RET_INVALID_SOUNDING_SETTING; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * mu_bfee_entry_init_88xx() - config MU beamformee's registers -+ * @adapter : the adapter of halmac -+ * @param : parameters to configure MU BFEE entry -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+mu_bfee_entry_init_88xx(struct halmac_adapter *adapter, -+ struct halmac_mu_bfee_init_para *param) -+{ -+ u16 tmp168x = 0; -+ u16 tmp14c0; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ tmp168x |= param->paid | BIT(9); -+ HALMAC_REG_W16((0x1680 + param->userid * 2), tmp168x); -+ -+ tmp14c0 = HALMAC_REG_R16(REG_MU_TX_CTL) & ~(BIT(8) | BIT(9) | BIT(10)); -+ HALMAC_REG_W16(REG_MU_TX_CTL, tmp14c0 | ((param->userid - 2) << 8)); -+ HALMAC_REG_W32(REG_MU_STA_GID_VLD, 0); -+ HALMAC_REG_W32(REG_MU_STA_USER_POS_INFO, param->user_position_l); -+ HALMAC_REG_W32(REG_MU_STA_USER_POS_INFO + 4, param->user_position_h); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * mu_bfer_entry_init_88xx() - config MU beamformer's registers -+ * @adapter : the adapter of halmac -+ * @param : parameters to configure MU BFER entry -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+mu_bfer_entry_init_88xx(struct halmac_adapter *adapter, -+ struct halmac_mu_bfer_init_para *param) -+{ -+ u16 tmp1680 = 0; -+ u16 mac_addr_h; -+ u32 mac_addr_l; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ mac_addr_l = rtk_le32_to_cpu(param->bfer_address.addr_l_h.low); -+ mac_addr_h = rtk_le16_to_cpu(param->bfer_address.addr_l_h.high); -+ -+ HALMAC_REG_W32(REG_ASSOCIATED_BFMER0_INFO, mac_addr_l); -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMER0_INFO + 4, mac_addr_h); -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMER0_INFO + 6, param->paid); -+ HALMAC_REG_W16(REG_TX_CSI_RPT_PARAM_BW20, param->csi_para); -+ -+ tmp1680 = HALMAC_REG_R16(0x1680) & 0xC000; -+ tmp1680 |= param->my_aid | (param->csi_length_sel << 12); -+ HALMAC_REG_W16(0x1680, tmp1680); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * su_bfee_entry_del_88xx() - reset SU beamformee's registers -+ * @adapter : the adapter of halmac -+ * @userid : the SU BFee userid to be deleted -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+su_bfee_entry_del_88xx(struct halmac_adapter *adapter, u8 userid) -+{ -+ u16 value16; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ switch (userid) { -+ case 0: -+ value16 = HALMAC_REG_R16(REG_TXBF_CTRL); -+ value16 &= ~(BIT_MASK_R_TXBF0_AID | BIT_R_TXBF0_20M | -+ BIT_R_TXBF0_40M | BIT_R_TXBF0_80M); -+ HALMAC_REG_W16(REG_TXBF_CTRL, value16); -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMEE_SEL, 0); -+ break; -+ case 1: -+ value16 = HALMAC_REG_R16(REG_TXBF_CTRL + 2); -+ value16 &= ~(BIT_MASK_R_TXBF1_AID | BIT_R_TXBF0_20M | -+ BIT_R_TXBF0_40M | BIT_R_TXBF0_80M); -+ HALMAC_REG_W16(REG_TXBF_CTRL + 2, value16); -+ HALMAC_REG_W16(REG_ASSOCIATED_BFMEE_SEL + 2, 0); -+ break; -+ case 2: -+ HALMAC_REG_W16(REG_WMAC_ASSOCIATED_MU_BFMEE2, 0); -+ break; -+ case 3: -+ HALMAC_REG_W16(REG_WMAC_ASSOCIATED_MU_BFMEE3, 0); -+ break; -+ case 4: -+ HALMAC_REG_W16(REG_WMAC_ASSOCIATED_MU_BFMEE4, 0); -+ break; -+ case 5: -+ HALMAC_REG_W16(REG_WMAC_ASSOCIATED_MU_BFMEE5, 0); -+ break; -+ default: -+ return HALMAC_RET_INVALID_SOUNDING_SETTING; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * su_bfee_entry_del_88xx() - reset SU beamformer's registers -+ * @adapter : the adapter of halmac -+ * @userid : the SU BFer userid to be deleted -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+su_bfer_entry_del_88xx(struct halmac_adapter *adapter, u8 userid) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ switch (userid) { -+ case 0: -+ HALMAC_REG_W32(REG_ASSOCIATED_BFMER0_INFO, 0); -+ HALMAC_REG_W32(REG_ASSOCIATED_BFMER0_INFO + 4, 0); -+ break; -+ case 1: -+ HALMAC_REG_W32(REG_ASSOCIATED_BFMER1_INFO, 0); -+ HALMAC_REG_W32(REG_ASSOCIATED_BFMER1_INFO + 4, 0); -+ break; -+ default: -+ return HALMAC_RET_INVALID_SOUNDING_SETTING; -+ } -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * mu_bfee_entry_del_88xx() - reset MU beamformee's registers -+ * @adapter : the adapter of halmac -+ * @userid : the MU STA userid to be deleted -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+mu_bfee_entry_del_88xx(struct halmac_adapter *adapter, u8 userid) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ HALMAC_REG_W16(0x1680 + userid * 2, 0); -+ HALMAC_REG_W8_CLR(REG_MU_TX_CTL, BIT(userid - 2)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * mu_bfer_entry_del_88xx() -reset MU beamformer's registers -+ * @adapter : the adapter of halmac -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+mu_bfer_entry_del_88xx(struct halmac_adapter *adapter) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ HALMAC_REG_W32(REG_ASSOCIATED_BFMER0_INFO, 0); -+ HALMAC_REG_W32(REG_ASSOCIATED_BFMER0_INFO + 4, 0); -+ HALMAC_REG_W16(0x1680, 0); -+ HALMAC_REG_W8(REG_MU_TX_CTL, 0); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_csi_rate_88xx() - config CSI frame Tx rate -+ * @adapter : the adapter of halmac -+ * @rssi : rssi in decimal value -+ * @cur_rate : current CSI frame rate -+ * @fixrate_en : enable to fix CSI frame in VHT rate, otherwise legacy OFDM rate -+ * @new_rate : API returns the final CSI frame rate -+ * Author : chunchu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_csi_rate_88xx(struct halmac_adapter *adapter, u8 rssi, u8 cur_rate, -+ u8 fixrate_en, u8 *new_rate, u8 *bmp_ofdm54) -+{ -+ u32 csi_cfg; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ *bmp_ofdm54 = 0xFF; -+ -+#if HALMAC_8821C_SUPPORT -+ if (adapter->chip_id == HALMAC_CHIP_ID_8821C && fixrate_en) { -+ csi_cfg = HALMAC_REG_R32(REG_BBPSF_CTRL) & ~BITS_WMAC_CSI_RATE; -+ HALMAC_REG_W32(REG_BBPSF_CTRL, -+ csi_cfg | BIT_CSI_FORCE_RATE_EN | -+ BIT_CSI_RSC(1) | -+ BIT_WMAC_CSI_RATE(HALMAC_VHT_NSS1_MCS3)); -+ *new_rate = HALMAC_VHT_NSS1_MCS3; -+ return HALMAC_RET_SUCCESS; -+ } -+ csi_cfg = HALMAC_REG_R32(REG_BBPSF_CTRL) & ~BITS_WMAC_CSI_RATE & -+ ~BIT_CSI_FORCE_RATE_EN; -+#else -+ csi_cfg = HALMAC_REG_R32(REG_BBPSF_CTRL) & ~BITS_WMAC_CSI_RATE; -+#endif -+ -+#if (HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822C || -+ adapter->chip_id == HALMAC_CHIP_ID_8812F) -+ HALMAC_REG_W32_SET(REG_BBPSF_CTRL, BIT(15)); -+#endif -+ -+ if (rssi >= 40) { -+ if (cur_rate != HALMAC_OFDM54) { -+ csi_cfg |= BIT_WMAC_CSI_RATE(HALMAC_OFDM54); -+ HALMAC_REG_W32(REG_BBPSF_CTRL, csi_cfg); -+ *bmp_ofdm54 = 1; -+ } -+ *new_rate = HALMAC_OFDM54; -+ } else { -+ if (cur_rate != HALMAC_OFDM24) { -+ csi_cfg |= BIT_WMAC_CSI_RATE(HALMAC_OFDM24); -+ HALMAC_REG_W32(REG_BBPSF_CTRL, csi_cfg); -+ *bmp_ofdm54 = 0; -+ } -+ *new_rate = HALMAC_OFDM24; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * fw_snding_88xx() - fw sounding control -+ * @adapter : the adapter of halmac -+ * @su_info : -+ * su0_en : enable/disable fw sounding -+ * su0_ndpa_pkt : ndpa pkt, shall include txdesc -+ * su0_pkt_sz : ndpa pkt size, shall include txdesc -+ * @mu_info : currently not in use, input NULL is acceptable -+ * @period : sounding period, unit is 5ms -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+fw_snding_88xx(struct halmac_adapter *adapter, -+ struct halmac_su_snding_info *su_info, -+ struct halmac_mu_snding_info *mu_info, u8 period) -+{ -+ u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 }; -+ u16 seq_num; -+ u16 snding_info_addr; -+ struct halmac_h2c_header_info hdr_info; -+ enum halmac_cmd_process_status *proc_status; -+ enum halmac_ret_status status; -+ -+ proc_status = &adapter->halmac_state.fw_snding_state.proc_status; -+ -+ if (adapter->chip_id == HALMAC_CHIP_ID_8821C) -+ return HALMAC_RET_NOT_SUPPORT; -+ -+ if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_NO_DLFW; -+ -+ if (adapter->fw_ver.h2c_version < 9) -+ return HALMAC_RET_FW_NO_SUPPORT; -+ -+ if (*proc_status == HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_TRACE("[TRACE]Wait event(snd)\n"); -+ return HALMAC_RET_BUSY_STATE; -+ } -+ -+ if (su_info->su0_en == 1) { -+ if (!su_info->su0_ndpa_pkt) -+ return HALMAC_RET_NULL_POINTER; -+ -+ if (su_info->su0_pkt_sz > (u32)SU0_SNDING_PKT_RSVDPG_SIZE - -+ adapter->hw_cfg_info.txdesc_size) -+ return HALMAC_RET_DATA_SIZE_INCORRECT; -+ -+ if (!snding_pkt_chk_88xx(adapter, su_info->su0_ndpa_pkt)) -+ return HALMAC_RET_TXDESC_SET_FAIL; -+ -+ if (fw_snding_cmd_cnstr_state_88xx(adapter) != -+ HALMAC_CMD_CNSTR_IDLE) { -+ PLTFM_MSG_ERR("[ERR]Not idle(snd)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ snding_info_addr = adapter->txff_alloc.rsvd_h2c_sta_info_addr + -+ SU0_SNDING_PKT_OFFSET; -+ status = dl_rsvd_page_88xx(adapter, snding_info_addr, -+ su_info->su0_ndpa_pkt, -+ su_info->su0_pkt_sz); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]dl rsvd page\n"); -+ return status; -+ } -+ -+ FW_SNDING_SET_SU0(h2c_buf, 1); -+ FW_SNDING_SET_PERIOD(h2c_buf, period); -+ FW_SNDING_SET_NDPA0_HEAD_PG(h2c_buf, snding_info_addr - -+ adapter->txff_alloc.rsvd_boundary); -+ } else { -+ if (fw_snding_cmd_cnstr_state_88xx(adapter) != -+ HALMAC_CMD_CNSTR_BUSY) { -+ PLTFM_MSG_ERR("[ERR]Not snd(snd)\n"); -+ return HALMAC_RET_ERROR_STATE; -+ } -+ FW_SNDING_SET_SU0(h2c_buf, 0); -+ } -+ -+ *proc_status = HALMAC_CMD_PROCESS_SENDING; -+ -+ hdr_info.sub_cmd_id = SUB_CMD_ID_FW_SNDING; -+ hdr_info.content_size = 8; -+ hdr_info.ack = 1; -+ set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num); -+ adapter->halmac_state.fw_snding_state.seq_num = seq_num; -+ -+ status = send_h2c_pkt_88xx(adapter, h2c_buf); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]send h2c\n"); -+ reset_ofld_feature_88xx(adapter, HALMAC_FEATURE_FW_SNDING); -+ return status; -+ } -+ -+ if (cnv_fw_snding_state_88xx(adapter, su_info->su0_en == 1 ? -+ HALMAC_CMD_CNSTR_BUSY : -+ HALMAC_CMD_CNSTR_IDLE) -+ != HALMAC_RET_SUCCESS) -+ return HALMAC_RET_ERROR_STATE; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static u8 -+snding_pkt_chk_88xx(struct halmac_adapter *adapter, u8 *pkt) -+{ -+ u8 data_rate; -+ -+ if (GET_TX_DESC_NDPA(pkt) == 0) { -+ PLTFM_MSG_ERR("[ERR]txdesc ndpa = 0\n"); -+ return 0; -+ } -+ -+ data_rate = (u8)GET_TX_DESC_DATARATE(pkt); -+ if (!(data_rate >= HALMAC_VHT_NSS2_MCS0 && -+ data_rate <= HALMAC_VHT_NSS2_MCS9)) { -+ if (!(data_rate >= HALMAC_MCS8 && data_rate <= HALMAC_MCS15)) { -+ PLTFM_MSG_ERR("[ERR]txdesc rate\n"); -+ return 0; -+ } -+ } -+ -+ if (GET_TX_DESC_NAVUSEHDR(pkt) == 0) { -+ PLTFM_MSG_ERR("[ERR]txdesc navusehdr = 0\n"); -+ return 0; -+ } -+ -+ if (GET_TX_DESC_USE_RATE(pkt) == 0) { -+ PLTFM_MSG_ERR("[ERR]txdesc userate = 0\n"); -+ return 0; -+ } -+ -+ return 1; -+} -+ -+static enum halmac_cmd_construct_state -+fw_snding_cmd_cnstr_state_88xx(struct halmac_adapter *adapter) -+{ -+ return adapter->halmac_state.fw_snding_state.cmd_cnstr_state; -+} -+ -+enum halmac_ret_status -+get_h2c_ack_fw_snding_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size) -+{ -+ u8 seq_num = 0; -+ u8 fw_rc; -+ struct halmac_fw_snding_state *state; -+ enum halmac_cmd_process_status proc_status; -+ -+ state = &adapter->halmac_state.fw_snding_state; -+ -+ seq_num = (u8)H2C_ACK_HDR_GET_H2C_SEQ(buf); -+ PLTFM_MSG_TRACE("[TRACE]Seq num:h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ if (seq_num != state->seq_num) { -+ PLTFM_MSG_ERR("[ERR]Seq num mismatch:h2c->%d c2h->%d\n", -+ state->seq_num, seq_num); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ if (state->proc_status != HALMAC_CMD_PROCESS_SENDING) { -+ PLTFM_MSG_ERR("[ERR]not sending(snd)\n"); -+ return HALMAC_RET_SUCCESS; -+ } -+ -+ fw_rc = (u8)H2C_ACK_HDR_GET_H2C_RETURN_CODE(buf); -+ state->fw_rc = fw_rc; -+ -+ if ((enum halmac_h2c_return_code)fw_rc == HALMAC_H2C_RETURN_SUCCESS) { -+ proc_status = HALMAC_CMD_PROCESS_DONE; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_FW_SNDING, proc_status, -+ NULL, 0); -+ } else { -+ proc_status = HALMAC_CMD_PROCESS_ERROR; -+ state->proc_status = proc_status; -+ PLTFM_EVENT_SIG(HALMAC_FEATURE_FW_SNDING, proc_status, -+ &fw_rc, 1); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+get_fw_snding_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status) -+{ -+ *proc_status = adapter->halmac_state.fw_snding_state.proc_status; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+cnv_fw_snding_state_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_construct_state dest_state) -+{ -+ struct halmac_fw_snding_state *state; -+ -+ state = &adapter->halmac_state.fw_snding_state; -+ -+ if (state->cmd_cnstr_state != HALMAC_CMD_CNSTR_IDLE && -+ state->cmd_cnstr_state != HALMAC_CMD_CNSTR_BUSY) -+ return HALMAC_RET_ERROR_STATE; -+ -+ if (dest_state == HALMAC_CMD_CNSTR_IDLE) { -+ if (state->cmd_cnstr_state == HALMAC_CMD_CNSTR_IDLE) -+ return HALMAC_RET_ERROR_STATE; -+ } else if (dest_state == HALMAC_CMD_CNSTR_BUSY) { -+ if (state->cmd_cnstr_state == HALMAC_CMD_CNSTR_BUSY) -+ return HALMAC_RET_ERROR_STATE; -+ } -+ -+ state->cmd_cnstr_state = dest_state; -+ -+ return HALMAC_RET_SUCCESS; -+} -+#endif /* HALMAC_88XX_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_mimo_88xx.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_mimo_88xx.h -new file mode 100644 -index 000000000..5b66b100d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_mimo_88xx.h -@@ -0,0 +1,83 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_MIMO_88XX_H_ -+#define _HALMAC_MIMO_88XX_H_ -+ -+#include "../halmac_api.h" -+ -+#if HALMAC_88XX_SUPPORT -+ -+enum halmac_ret_status -+cfg_txbf_88xx(struct halmac_adapter *adapter, u8 userid, enum halmac_bw bw, -+ u8 txbf_en); -+ -+enum halmac_ret_status -+cfg_mumimo_88xx(struct halmac_adapter *adapter, -+ struct halmac_cfg_mumimo_para *param); -+ -+enum halmac_ret_status -+cfg_sounding_88xx(struct halmac_adapter *adapter, enum halmac_snd_role role, -+ enum halmac_data_rate rate); -+ -+enum halmac_ret_status -+del_sounding_88xx(struct halmac_adapter *adapter, enum halmac_snd_role role); -+ -+enum halmac_ret_status -+su_bfee_entry_init_88xx(struct halmac_adapter *adapter, u8 userid, u16 paid); -+ -+enum halmac_ret_status -+su_bfer_entry_init_88xx(struct halmac_adapter *adapter, -+ struct halmac_su_bfer_init_para *param); -+ -+enum halmac_ret_status -+mu_bfee_entry_init_88xx(struct halmac_adapter *adapter, -+ struct halmac_mu_bfee_init_para *param); -+ -+enum halmac_ret_status -+mu_bfer_entry_init_88xx(struct halmac_adapter *adapter, -+ struct halmac_mu_bfer_init_para *param); -+ -+enum halmac_ret_status -+su_bfee_entry_del_88xx(struct halmac_adapter *adapter, u8 userid); -+ -+enum halmac_ret_status -+su_bfer_entry_del_88xx(struct halmac_adapter *adapter, u8 userid); -+ -+enum halmac_ret_status -+mu_bfee_entry_del_88xx(struct halmac_adapter *adapter, u8 userid); -+ -+enum halmac_ret_status -+mu_bfer_entry_del_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+cfg_csi_rate_88xx(struct halmac_adapter *adapter, u8 rssi, u8 cur_rate, -+ u8 fixrate_en, u8 *new_rate, u8 *bmp_ofdm54); -+ -+enum halmac_ret_status -+fw_snding_88xx(struct halmac_adapter *adapter, -+ struct halmac_su_snding_info *su_info, -+ struct halmac_mu_snding_info *mu_info, u8 period); -+ -+enum halmac_ret_status -+get_h2c_ack_fw_snding_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ -+enum halmac_ret_status -+get_fw_snding_status_88xx(struct halmac_adapter *adapter, -+ enum halmac_cmd_process_status *proc_status); -+ -+#endif /* HALMAC_88XX_SUPPORT */ -+ -+#endif/* _HALMAC_MIMO_88XX_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_sdio_88xx.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_sdio_88xx.c -new file mode 100644 -index 000000000..ead9d79fe ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_sdio_88xx.c -@@ -0,0 +1,902 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_sdio_88xx.h" -+#include "halmac_88xx_cfg.h" -+ -+#if (HALMAC_88XX_SUPPORT && HALMAC_SDIO_SUPPORT) -+ -+/* define the SDIO Bus CLK threshold */ -+/* for avoiding CMD53 fails that result from SDIO CLK sync to ana_clk fail */ -+#define SDIO_CLK_HIGH_SPEED_TH 50 /* 50MHz */ -+#define SDIO_CLK_SPEED_MAX 208 /* 208MHz */ -+ -+/*only for r_indir_sdio_88xx !!, Soar 20171222*/ -+static u8 -+r_indir_cmd52_88xx(struct halmac_adapter *adapter, u32 offset); -+ -+/*only for r_indir_sdio_88xx !!, Soar 20171222*/ -+static u32 -+r_indir_cmd53_88xx(struct halmac_adapter *adapter, u32 offset); -+ -+/*only for r_indir_sdio_88xx !!, Soar 20171222*/ -+static u32 -+r8_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr); -+ -+/*only for r_indir_sdio_88xx !!, Soar 20171222*/ -+static u32 -+r16_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr); -+ -+/*only for r_indir_sdio_88xx !!, Soar 20171222*/ -+static u32 -+r32_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr); -+ -+/*only for w_indir_sdio_88xx !!, Soar 20171222*/ -+static enum halmac_ret_status -+w_indir_cmd52_88xx(struct halmac_adapter *adapter, u32 adr, u32 val, -+ enum halmac_io_size size); -+ -+/*only for w_indir_sdio_88xx !!, Soar 20171222*/ -+static enum halmac_ret_status -+w_indir_cmd53_88xx(struct halmac_adapter *adapter, u32 adr, u32 val, -+ enum halmac_io_size size); -+ -+/*only for w_indir_sdio_88xx !!, Soar 20171222*/ -+static enum halmac_ret_status -+w8_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr, u32 val); -+ -+/*only for w_indir_sdio_88xx !!, Soar 20171222*/ -+static enum halmac_ret_status -+w16_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr, u32 val); -+ -+/*only for w_indir_sdio_88xx !!, Soar 20171222*/ -+static enum halmac_ret_status -+w32_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr, u32 val); -+ -+/** -+ * init_sdio_cfg_88xx() - init SDIO -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+init_sdio_cfg_88xx(struct halmac_adapter *adapter) -+{ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * deinit_sdio_cfg_88xx() - deinit SDIO -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+deinit_sdio_cfg_88xx(struct halmac_adapter *adapter) -+{ -+ if (adapter->intf != HALMAC_INTERFACE_SDIO) -+ return HALMAC_RET_WRONG_INTF; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_sdio_rx_agg_88xx() - config rx aggregation -+ * @adapter : the adapter of halmac -+ * @halmac_rx_agg_mode -+ * Author : KaiYuan Chang/Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_sdio_rx_agg_88xx(struct halmac_adapter *adapter, -+ struct halmac_rxagg_cfg *cfg) -+{ -+ u8 value8; -+ u8 size; -+ u8 timeout; -+ u8 agg_enable; -+ u32 value32; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ agg_enable = HALMAC_REG_R8(REG_TXDMA_PQ_MAP); -+ -+ switch (cfg->mode) { -+ case HALMAC_RX_AGG_MODE_NONE: -+ agg_enable &= ~(BIT_RXDMA_AGG_EN); -+ break; -+ case HALMAC_RX_AGG_MODE_DMA: -+ case HALMAC_RX_AGG_MODE_USB: -+ agg_enable |= BIT_RXDMA_AGG_EN; -+ break; -+ default: -+ PLTFM_MSG_ERR("[ERR]unsupported mode\n"); -+ agg_enable &= ~BIT_RXDMA_AGG_EN; -+ break; -+ } -+ -+ if (cfg->threshold.drv_define == 0) { -+ size = 0xFF; -+ timeout = 0x01; -+ } else { -+ size = cfg->threshold.size; -+ timeout = cfg->threshold.timeout; -+ } -+ -+ value32 = HALMAC_REG_R32(REG_RXDMA_AGG_PG_TH); -+ if (cfg->threshold.size_limit_en == 0) -+ HALMAC_REG_W32(REG_RXDMA_AGG_PG_TH, value32 & ~BIT_EN_PRE_CALC); -+ else -+ HALMAC_REG_W32(REG_RXDMA_AGG_PG_TH, value32 | BIT_EN_PRE_CALC); -+ -+ HALMAC_REG_W8(REG_TXDMA_PQ_MAP, agg_enable); -+ HALMAC_REG_W16(REG_RXDMA_AGG_PG_TH, -+ (u16)(size | (timeout << BIT_SHIFT_DMA_AGG_TO_V1))); -+ -+ value8 = HALMAC_REG_R8(REG_RXDMA_MODE); -+ if (0 != (agg_enable & BIT_RXDMA_AGG_EN)) -+ HALMAC_REG_W8(REG_RXDMA_MODE, value8 | BIT_DMA_MODE); -+ else -+ HALMAC_REG_W8(REG_RXDMA_MODE, value8 & ~(BIT_DMA_MODE)); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * sdio_reg_rn_88xx() - read n byte register -+ * @adapter : the adapter of halmac -+ * @offset : register offset -+ * @halmac_size : register value size -+ * @value : register value -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+sdio_reg_rn_88xx(struct halmac_adapter *adapter, u32 offset, u32 size, -+ u8 *value) -+{ -+ u8 *r_val = NULL; -+ u32 r_size = size; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ enum halmac_sdio_cmd53_4byte_mode cmd53_4byte = -+ adapter->sdio_cmd53_4byte; -+ -+ if (0 == (offset & 0xFFFF0000)) { -+ PLTFM_MSG_ERR("[ERR]offset 0x%x\n", offset); -+ return HALMAC_RET_FAIL; -+ } -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, &offset); -+ if (status != HALMAC_RET_SUCCESS) { -+ PLTFM_MSG_ERR("[ERR]convert offset\n"); -+ return status; -+ } -+ -+ if (adapter->pwr_off_flow_flag == 1 || -+ adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) { -+ PLTFM_MSG_ERR("[ERR]power off\n"); -+ return HALMAC_RET_FAIL; -+ } -+ -+ if ((cmd53_4byte == HALMAC_SDIO_CMD53_4BYTE_MODE_RW || -+ cmd53_4byte == HALMAC_SDIO_CMD53_4BYTE_MODE_R) && -+ (size & 0x03) != 0) { -+ if (adapter->sdio_hw_info.io_warn_flag == 1) { -+ PLTFM_MSG_WARN("[WARN]reg_rn !align,addr 0x%x,siz %d\n", -+ offset, size); -+ adapter->watcher.get_watcher.sdio_rn_not_align++; -+ } -+ r_size = size - (size & 0x03) + 4; -+ r_val = (u8 *)PLTFM_MALLOC(r_size); -+ if (!r_val) { -+ PLTFM_MSG_ERR("[ERR]malloc!!\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ PLTFM_MEMSET(r_val, 0x00, r_size); -+ PLTFM_SDIO_CMD53_RN(offset, r_size, r_val); -+ PLTFM_MEMCPY(value, r_val, size); -+ PLTFM_FREE(r_val, r_size); -+ } else { -+ PLTFM_SDIO_CMD53_RN(offset, size, value); -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * cfg_txagg_sdio_align_88xx() -config sdio bus tx agg alignment -+ * @adapter : the adapter of halmac -+ * @enable : function enable(1)/disable(0) -+ * @align_size : sdio bus tx agg alignment size (2^n, n = 3~11) -+ * Author : Soar Tu -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+cfg_txagg_sdio_align_88xx(struct halmac_adapter *adapter, u8 enable, -+ u16 align_size) -+{ -+ u8 i; -+ u8 flag = 0; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822B) -+ return HALMAC_RET_NOT_SUPPORT; -+ -+ if ((align_size & 0xF000) != 0) { -+ PLTFM_MSG_ERR("[ERR]out of range\n"); -+ return HALMAC_RET_FAIL; -+ } -+ -+ for (i = 3; i <= 11; i++) { -+ if (align_size == 1 << i) { -+ flag = 1; -+ break; -+ } -+ } -+ -+ if (flag == 0) { -+ PLTFM_MSG_ERR("[ERR]not 2^3 ~ 2^11\n"); -+ return HALMAC_RET_FAIL; -+ } -+ -+ adapter->hw_cfg_info.tx_align_size = align_size; -+ -+ if (enable) -+ HALMAC_REG_W16(REG_RQPN_CTRL_2, 0x8000 | align_size); -+ else -+ HALMAC_REG_W16(REG_RQPN_CTRL_2, align_size); -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * sdio_indirect_reg_r32_88xx() - read MAC reg by SDIO reg -+ * @adapter : the adapter of halmac -+ * @offset : register offset -+ * Author : Soar -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+u32 -+sdio_indirect_reg_r32_88xx(struct halmac_adapter *adapter, u32 offset) -+{ -+ return r_indir_sdio_88xx(adapter, offset, HALMAC_IO_DWORD); -+} -+ -+/** -+ * set_sdio_bulkout_num_88xx() - inform bulk-out num -+ * @adapter : the adapter of halmac -+ * @bulkout_num : usb bulk-out number -+ * Author : KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+set_sdio_bulkout_num_88xx(struct halmac_adapter *adapter, u8 num) -+{ -+ return HALMAC_RET_NOT_SUPPORT; -+} -+ -+/** -+ * get_sdio_bulkout_id_88xx() - get bulk out id for the TX packet -+ * @adapter : the adapter of halmac -+ * @halmac_buf : tx packet, include txdesc -+ * @halmac_size : tx packet size -+ * @bulkout_id : usb bulk-out id -+ * Author : KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+get_sdio_bulkout_id_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size, -+ u8 *id) -+{ -+ return HALMAC_RET_NOT_SUPPORT; -+} -+ -+/** -+ * sdio_cmd53_4byte_88xx() - cmd53 only for 4byte len register IO -+ * @adapter : the adapter of halmac -+ * @enable : 1->CMD53 only use in 4byte reg, 0 : No limitation -+ * Author : Ivan Lin/KaiYuan Chang -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+sdio_cmd53_4byte_88xx(struct halmac_adapter *adapter, -+ enum halmac_sdio_cmd53_4byte_mode mode) -+{ -+ if (adapter->intf != HALMAC_INTERFACE_SDIO) -+ return HALMAC_RET_WRONG_INTF; -+ -+ if (adapter->api_registry.sdio_cmd53_4byte_en == 0) -+ return HALMAC_RET_NOT_SUPPORT; -+ -+ adapter->sdio_cmd53_4byte = mode; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * sdio_hw_info_88xx() - info sdio hw info -+ * @adapter : the adapter of halmac -+ * @HALMAC_SDIO_CMD53_4BYTE_MODE : -+ * clock_speed : sdio bus clock. Unit -> MHz -+ * spec_ver : sdio spec version -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+sdio_hw_info_88xx(struct halmac_adapter *adapter, -+ struct halmac_sdio_hw_info *info) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (adapter->intf != HALMAC_INTERFACE_SDIO) -+ return HALMAC_RET_WRONG_INTF; -+ -+ PLTFM_MSG_TRACE("[TRACE]SDIO clock:%d, spec:%d\n", -+ info->clock_speed, info->spec_ver); -+ -+ if (info->clock_speed > SDIO_CLK_SPEED_MAX) -+ return HALMAC_RET_SDIO_CLOCK_ERR; -+ -+ if (info->clock_speed > SDIO_CLK_HIGH_SPEED_TH) -+ adapter->sdio_hw_info.io_hi_speed_flag = 1; -+ -+ adapter->sdio_hw_info.io_indir_flag = info->io_indir_flag; -+ if (info->clock_speed > SDIO_CLK_HIGH_SPEED_TH && -+ adapter->sdio_hw_info.io_indir_flag == 0) -+ PLTFM_MSG_WARN("[WARN]SDIO clock:%d, indir access is better\n", -+ info->clock_speed); -+ -+ adapter->sdio_hw_info.clock_speed = info->clock_speed; -+ adapter->sdio_hw_info.spec_ver = info->spec_ver; -+ adapter->sdio_hw_info.block_size = info->block_size; -+ -+ /*SW*/ -+ adapter->sdio_hw_info.io_warn_flag = info->io_warn_flag; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+void -+cfg_sdio_tx_page_threshold_88xx(struct halmac_adapter *adapter, -+ struct halmac_tx_page_threshold_info *info) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u32 threshold = info->threshold; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ if (info->enable == 1) { -+ threshold = BIT(31) | threshold; -+ PLTFM_MSG_TRACE("[TRACE]enable\n"); -+ } else { -+ threshold = ~(BIT(31)) & threshold; -+ PLTFM_MSG_TRACE("[TRACE]disable\n"); -+ } -+ -+ switch (info->dma_queue_sel) { -+ case HALMAC_MAP2_HQ: -+ HALMAC_REG_W32(REG_TQPNT1, threshold); -+ break; -+ case HALMAC_MAP2_NQ: -+ HALMAC_REG_W32(REG_TQPNT2, threshold); -+ break; -+ case HALMAC_MAP2_LQ: -+ HALMAC_REG_W32(REG_TQPNT3, threshold); -+ break; -+ case HALMAC_MAP2_EXQ: -+ HALMAC_REG_W32(REG_TQPNT4, threshold); -+ break; -+ default: -+ break; -+ } -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+} -+ -+enum halmac_ret_status -+cnv_to_sdio_bus_offset_88xx(struct halmac_adapter *adapter, u32 *offset) -+{ -+ switch ((*offset) & 0xFFFF0000) { -+ case WLAN_IOREG_OFFSET: -+ *offset &= HALMAC_WLAN_MAC_REG_MSK; -+ *offset |= HALMAC_SDIO_CMD_ADDR_MAC_REG << 13; -+ break; -+ case SDIO_LOCAL_OFFSET: -+ *offset &= HALMAC_SDIO_LOCAL_MSK; -+ *offset |= HALMAC_SDIO_CMD_ADDR_SDIO_REG << 13; -+ break; -+ default: -+ *offset = 0xFFFFFFFF; -+ PLTFM_MSG_ERR("[ERR]base address!!\n"); -+ return HALMAC_RET_CONVERT_SDIO_OFFSET_FAIL; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+enum halmac_ret_status -+leave_sdio_suspend_88xx(struct halmac_adapter *adapter) -+{ -+ u8 value8; -+ u32 cnt; -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ value8 = HALMAC_REG_R8(REG_SDIO_HSUS_CTRL); -+ HALMAC_REG_W8(REG_SDIO_HSUS_CTRL, value8 & ~(BIT(0))); -+ -+ cnt = 10000; -+ while (!(HALMAC_REG_R8(REG_SDIO_HSUS_CTRL) & 0x02)) { -+ cnt--; -+ if (cnt == 0) -+ return HALMAC_RET_SDIO_LEAVE_SUSPEND_FAIL; -+ } -+ -+ value8 = HALMAC_REG_R8(REG_HCI_OPT_CTRL + 2); -+ if (adapter->sdio_hw_info.spec_ver == HALMAC_SDIO_SPEC_VER_3_00) -+ HALMAC_REG_W8(REG_HCI_OPT_CTRL + 2, value8 | BIT(2)); -+ else -+ HALMAC_REG_W8(REG_HCI_OPT_CTRL + 2, value8 & ~(BIT(2))); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/*only for r_indir_sdio_88xx !!, Soar 20171222*/ -+static u8 -+r_indir_cmd52_88xx(struct halmac_adapter *adapter, u32 offset) -+{ -+ u8 value8, tmp, cnt = 50; -+ u32 reg_cfg = REG_SDIO_INDIRECT_REG_CFG; -+ u32 reg_data = REG_SDIO_INDIRECT_REG_DATA; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, ®_cfg); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = cnv_to_sdio_bus_offset_88xx(adapter, ®_data); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ PLTFM_SDIO_CMD52_W(reg_cfg, (u8)offset); -+ PLTFM_SDIO_CMD52_W(reg_cfg + 1, (u8)(offset >> 8)); -+ PLTFM_SDIO_CMD52_W(reg_cfg + 2, (u8)(BIT(3) | BIT(4))); -+ -+ do { -+ tmp = PLTFM_SDIO_CMD52_R(reg_cfg + 2); -+ cnt--; -+ } while (((tmp & BIT(4)) == 0) && (cnt > 0)); -+ -+ if (((tmp & BIT(4)) == 0) && cnt == 0) -+ PLTFM_MSG_ERR("[ERR]sdio indirect CMD52 read\n"); -+ -+ value8 = PLTFM_SDIO_CMD52_R(reg_data); -+ -+ return value8; -+} -+ -+/*only for r_indir_sdio_88xx !!, Soar 20171222*/ -+static u32 -+r_indir_cmd53_88xx(struct halmac_adapter *adapter, u32 offset) -+{ -+ u8 cnt = 50; -+ u8 value[8]; -+ u32 reg_cfg = REG_SDIO_INDIRECT_REG_CFG; -+ u32 reg_data = REG_SDIO_INDIRECT_REG_DATA; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ union { -+ __le32 dword; -+ u8 byte[4]; -+ } value32 = { 0x00000000 }; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, ®_cfg); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = cnv_to_sdio_bus_offset_88xx(adapter, ®_data); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ PLTFM_SDIO_CMD53_W32(reg_cfg, offset | BIT(19) | BIT(20)); -+ -+ do { -+ PLTFM_SDIO_CMD53_RN(reg_cfg + 2, sizeof(value), value); -+ cnt--; -+ } while (((value[0] & BIT(4)) == 0) && (cnt > 0)); -+ -+ if (((value[0] & BIT(4)) == 0) && cnt == 0) -+ PLTFM_MSG_ERR("[ERR]sdio indirect CMD53 read\n"); -+ -+ value32.byte[0] = value[2]; -+ value32.byte[1] = value[3]; -+ value32.byte[2] = value[4]; -+ value32.byte[3] = value[5]; -+ -+ return rtk_le32_to_cpu(value32.dword); -+} -+ -+/*only for r_indir_sdio_88xx !!, Soar 20171222*/ -+static u32 -+r8_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr) -+{ -+ union { -+ __le32 dword; -+ u8 byte[4]; -+ } val = { 0x00000000 }; -+ -+ if (adapter->pwr_off_flow_flag == 1 || -+ adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) { -+ val.byte[0] = r_indir_cmd52_88xx(adapter, adr); -+ return rtk_le32_to_cpu(val.dword); -+ } -+ -+ return r_indir_cmd53_88xx(adapter, adr); -+} -+ -+/*only for r_indir_sdio_88xx !!, Soar 20171222*/ -+static u32 -+r16_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr) -+{ -+ u32 reg_data = REG_SDIO_INDIRECT_REG_DATA; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ union { -+ __le32 dword; -+ u8 byte[4]; -+ } val = { 0x00000000 }; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, ®_data); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) { -+ if (0 != (adr & (2 - 1))) { -+ val.byte[0] = r_indir_cmd52_88xx(adapter, adr); -+ val.byte[1] = r_indir_cmd52_88xx(adapter, adr + 1); -+ } else { -+ val.byte[0] = r_indir_cmd52_88xx(adapter, adr); -+ val.byte[1] = PLTFM_SDIO_CMD52_R(reg_data + 1); -+ } -+ -+ return rtk_le32_to_cpu(val.dword); -+ } -+ -+ if (0 != (adr & (2 - 1))) { -+ val.byte[0] = (u8)r_indir_cmd53_88xx(adapter, adr); -+ val.byte[1] = (u8)r_indir_cmd53_88xx(adapter, adr + 1); -+ -+ return rtk_le32_to_cpu(val.dword); -+ } -+ -+ return r_indir_cmd53_88xx(adapter, adr); -+} -+ -+/*only for r_indir_sdio_88xx !!, Soar 20171222*/ -+static u32 -+r32_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr) -+{ -+ u32 reg_data = REG_SDIO_INDIRECT_REG_DATA; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ union { -+ __le32 dword; -+ u8 byte[4]; -+ } val = { 0x00000000 }; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, ®_data); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) { -+ if (0 != (adr & (4 - 1))) { -+ val.byte[0] = r_indir_cmd52_88xx(adapter, adr); -+ val.byte[1] = r_indir_cmd52_88xx(adapter, adr + 1); -+ val.byte[2] = r_indir_cmd52_88xx(adapter, adr + 2); -+ val.byte[3] = r_indir_cmd52_88xx(adapter, adr + 3); -+ } else { -+ val.byte[0] = r_indir_cmd52_88xx(adapter, adr); -+ val.byte[1] = PLTFM_SDIO_CMD52_R(reg_data + 1); -+ val.byte[2] = PLTFM_SDIO_CMD52_R(reg_data + 2); -+ val.byte[3] = PLTFM_SDIO_CMD52_R(reg_data + 3); -+ } -+ -+ return rtk_le32_to_cpu(val.dword); -+ } -+ -+ if (0 != (adr & (4 - 1))) { -+ val.byte[0] = (u8)r_indir_cmd53_88xx(adapter, adr); -+ val.byte[1] = (u8)r_indir_cmd53_88xx(adapter, adr + 1); -+ val.byte[2] = (u8)r_indir_cmd53_88xx(adapter, adr + 2); -+ val.byte[3] = (u8)r_indir_cmd53_88xx(adapter, adr + 3); -+ -+ return rtk_le32_to_cpu(val.dword); -+ } -+ -+ return r_indir_cmd53_88xx(adapter, adr); -+} -+ -+u32 -+r_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr, -+ enum halmac_io_size size) -+{ -+ u32 value32 = 0; -+ -+ PLTFM_MUTEX_LOCK(&adapter->sdio_indir_mutex); -+ -+ switch (size) { -+ case HALMAC_IO_BYTE: -+ value32 = r8_indir_sdio_88xx(adapter, adr); -+ break; -+ case HALMAC_IO_WORD: -+ value32 = r16_indir_sdio_88xx(adapter, adr); -+ break; -+ case HALMAC_IO_DWORD: -+ value32 = r32_indir_sdio_88xx(adapter, adr); -+ break; -+ default: -+ break; -+ } -+ -+ PLTFM_MUTEX_UNLOCK(&adapter->sdio_indir_mutex); -+ -+ return value32; -+} -+ -+/*only for w_indir_sdio_88xx !!, Soar 20171222*/ -+static enum halmac_ret_status -+w_indir_cmd52_88xx(struct halmac_adapter *adapter, u32 adr, u32 val, -+ enum halmac_io_size size) -+{ -+ u8 tmp, cnt = 50; -+ u32 reg_cfg = REG_SDIO_INDIRECT_REG_CFG; -+ u32 reg_data = REG_SDIO_INDIRECT_REG_DATA; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, ®_cfg); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = cnv_to_sdio_bus_offset_88xx(adapter, ®_data); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ PLTFM_SDIO_CMD52_W(reg_cfg, (u8)adr); -+ PLTFM_SDIO_CMD52_W(reg_cfg + 1, (u8)(adr >> 8)); -+ switch (size) { -+ case HALMAC_IO_BYTE: -+ PLTFM_SDIO_CMD52_W(reg_data, (u8)val); -+ PLTFM_SDIO_CMD52_W(reg_cfg + 2, (u8)(BIT(2) | BIT(4))); -+ break; -+ case HALMAC_IO_WORD: -+ PLTFM_SDIO_CMD52_W(reg_data, (u8)val); -+ PLTFM_SDIO_CMD52_W(reg_data + 1, (u8)(val >> 8)); -+ PLTFM_SDIO_CMD52_W(reg_cfg + 2, -+ (u8)(BIT(0) | BIT(2) | BIT(4))); -+ break; -+ case HALMAC_IO_DWORD: -+ PLTFM_SDIO_CMD52_W(reg_data, (u8)val); -+ PLTFM_SDIO_CMD52_W(reg_data + 1, (u8)(val >> 8)); -+ PLTFM_SDIO_CMD52_W(reg_data + 2, (u8)(val >> 16)); -+ PLTFM_SDIO_CMD52_W(reg_data + 3, (u8)(val >> 24)); -+ PLTFM_SDIO_CMD52_W(reg_cfg + 2, -+ (u8)(BIT(1) | BIT(2) | BIT(4))); -+ break; -+ default: -+ break; -+ } -+ -+ do { -+ tmp = PLTFM_SDIO_CMD52_R(reg_cfg + 2); -+ cnt--; -+ } while (((tmp & BIT(4)) == 0) && (cnt > 0)); -+ -+ if (((tmp & BIT(4)) == 0) && cnt == 0) -+ PLTFM_MSG_ERR("[ERR]sdio indirect CMD52 write\n"); -+ -+ return status; -+} -+ -+/*only for w_indir_sdio_88xx !!, Soar 20171222*/ -+static enum halmac_ret_status -+w_indir_cmd53_88xx(struct halmac_adapter *adapter, u32 adr, u32 val, -+ enum halmac_io_size size) -+{ -+ u8 tmp, cnt = 50; -+ u32 reg_cfg = REG_SDIO_INDIRECT_REG_CFG; -+ u32 reg_data = REG_SDIO_INDIRECT_REG_DATA; -+ u32 value32 = 0; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ status = cnv_to_sdio_bus_offset_88xx(adapter, ®_cfg); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = cnv_to_sdio_bus_offset_88xx(adapter, ®_data); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ switch (size) { -+ case HALMAC_IO_BYTE: -+ value32 = adr | BIT(18) | BIT(20); -+ break; -+ case HALMAC_IO_WORD: -+ value32 = adr | BIT(16) | BIT(18) | BIT(20); -+ break; -+ case HALMAC_IO_DWORD: -+ value32 = adr | BIT(17) | BIT(18) | BIT(20); -+ break; -+ default: -+ return HALMAC_RET_FAIL; -+ } -+ -+ PLTFM_SDIO_CMD53_W32(reg_data, val); -+ PLTFM_SDIO_CMD53_W32(reg_cfg, value32); -+ -+ do { -+ tmp = PLTFM_SDIO_CMD52_R(reg_cfg + 2); -+ cnt--; -+ } while (((tmp & BIT(4)) == 0) && (cnt > 0)); -+ -+ if (((tmp & BIT(4)) == 0) && cnt == 0) -+ PLTFM_MSG_ERR("[ERR]sdio indirect CMD53 read\n"); -+ -+ return status; -+} -+ -+/*only for w_indir_sdio_88xx !!, Soar 20171222*/ -+static enum halmac_ret_status -+w8_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr, u32 val) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (adapter->pwr_off_flow_flag == 1 || -+ adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) -+ status = w_indir_cmd52_88xx(adapter, adr, val, HALMAC_IO_BYTE); -+ else -+ status = w_indir_cmd53_88xx(adapter, adr, val, HALMAC_IO_BYTE); -+ return status; -+} -+ -+/*only for w_indir_sdio_88xx !!, Soar 20171222*/ -+static enum halmac_ret_status -+w16_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr, u32 val) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) { -+ if (0 != (adr & (2 - 1))) { -+ status = w_indir_cmd52_88xx(adapter, adr, val, -+ HALMAC_IO_BYTE); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = w_indir_cmd52_88xx(adapter, adr + 1, val >> 8, -+ HALMAC_IO_BYTE); -+ } else { -+ status = w_indir_cmd52_88xx(adapter, adr, val, -+ HALMAC_IO_WORD); -+ } -+ } else { -+ if (0 != (adr & (2 - 1))) { -+ status = w_indir_cmd53_88xx(adapter, adr, val, -+ HALMAC_IO_BYTE); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = w_indir_cmd53_88xx(adapter, adr + 1, val >> 8, -+ HALMAC_IO_BYTE); -+ } else { -+ status = w_indir_cmd53_88xx(adapter, adr, val, -+ HALMAC_IO_WORD); -+ } -+ } -+ return status; -+} -+ -+/*only for w_indir_sdio_88xx !!, Soar 20171222*/ -+static enum halmac_ret_status -+w32_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr, u32 val) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF) { -+ if (0 != (adr & (4 - 1))) { -+ status = w_indir_cmd52_88xx(adapter, adr, val, -+ HALMAC_IO_BYTE); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = w_indir_cmd52_88xx(adapter, adr + 1, val >> 8, -+ HALMAC_IO_BYTE); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = w_indir_cmd52_88xx(adapter, adr + 2, val >> 16, -+ HALMAC_IO_BYTE); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = w_indir_cmd52_88xx(adapter, adr + 3, val >> 24, -+ HALMAC_IO_BYTE); -+ } else { -+ status = w_indir_cmd52_88xx(adapter, adr, val, -+ HALMAC_IO_DWORD); -+ } -+ } else { -+ if (0 != (adr & (4 - 1))) { -+ status = w_indir_cmd53_88xx(adapter, adr, val, -+ HALMAC_IO_BYTE); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = w_indir_cmd53_88xx(adapter, adr + 1, val >> 8, -+ HALMAC_IO_BYTE); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = w_indir_cmd53_88xx(adapter, adr + 2, val >> 16, -+ HALMAC_IO_BYTE); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = w_indir_cmd53_88xx(adapter, adr + 3, val >> 24, -+ HALMAC_IO_BYTE); -+ } else { -+ status = w_indir_cmd53_88xx(adapter, adr, val, -+ HALMAC_IO_DWORD); -+ } -+ } -+ return status; -+} -+ -+enum halmac_ret_status -+w_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr, u32 val, -+ enum halmac_io_size size) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ PLTFM_MUTEX_LOCK(&adapter->sdio_indir_mutex); -+ -+ switch (size) { -+ case HALMAC_IO_BYTE: -+ status = w8_indir_sdio_88xx(adapter, adr, val); -+ break; -+ case HALMAC_IO_WORD: -+ status = w16_indir_sdio_88xx(adapter, adr, val); -+ break; -+ case HALMAC_IO_DWORD: -+ status = w32_indir_sdio_88xx(adapter, adr, val); -+ break; -+ default: -+ break; -+ } -+ -+ PLTFM_MUTEX_UNLOCK(&adapter->sdio_indir_mutex); -+ -+ return status; -+} -+ -+enum halmac_ret_status -+en_ref_autok_sdio_88xx(struct halmac_adapter *adapter, u8 en) -+{ -+ return HALMAC_RET_NOT_SUPPORT; -+} -+#endif /* HALMAC_88XX_SUPPORT */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_sdio_88xx.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_sdio_88xx.h -new file mode 100644 -index 000000000..10029fdc8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_88xx/halmac_sdio_88xx.h -@@ -0,0 +1,82 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_SDIO_88XX_H_ -+#define _HALMAC_SDIO_88XX_H_ -+ -+#include "../halmac_api.h" -+ -+#if (HALMAC_88XX_SUPPORT && HALMAC_SDIO_SUPPORT) -+ -+enum halmac_ret_status -+init_sdio_cfg_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+deinit_sdio_cfg_88xx(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+cfg_sdio_rx_agg_88xx(struct halmac_adapter *adapter, -+ struct halmac_rxagg_cfg *cfg); -+ -+enum halmac_ret_status -+cfg_txagg_sdio_align_88xx(struct halmac_adapter *adapter, u8 enable, -+ u16 align_size); -+ -+u32 -+sdio_indirect_reg_r32_88xx(struct halmac_adapter *adapter, u32 offset); -+ -+enum halmac_ret_status -+sdio_reg_rn_88xx(struct halmac_adapter *adapter, u32 offset, u32 size, -+ u8 *value); -+ -+enum halmac_ret_status -+set_sdio_bulkout_num_88xx(struct halmac_adapter *adapter, u8 num); -+ -+enum halmac_ret_status -+get_sdio_bulkout_id_88xx(struct halmac_adapter *adapter, u8 *buf, u32 size, -+ u8 *id); -+ -+enum halmac_ret_status -+sdio_cmd53_4byte_88xx(struct halmac_adapter *adapter, -+ enum halmac_sdio_cmd53_4byte_mode mode); -+ -+enum halmac_ret_status -+sdio_hw_info_88xx(struct halmac_adapter *adapter, -+ struct halmac_sdio_hw_info *info); -+ -+void -+cfg_sdio_tx_page_threshold_88xx(struct halmac_adapter *adapter, -+ struct halmac_tx_page_threshold_info *info); -+ -+enum halmac_ret_status -+cnv_to_sdio_bus_offset_88xx(struct halmac_adapter *adapter, u32 *offset); -+ -+enum halmac_ret_status -+leave_sdio_suspend_88xx(struct halmac_adapter *adapter); -+ -+u32 -+r_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr, -+ enum halmac_io_size size); -+ -+enum halmac_ret_status -+w_indir_sdio_88xx(struct halmac_adapter *adapter, u32 adr, u32 val, -+ enum halmac_io_size size); -+ -+enum halmac_ret_status -+en_ref_autok_sdio_88xx(struct halmac_adapter *adapter, u8 en); -+ -+#endif /* HALMAC_88XX_SUPPORT */ -+ -+#endif/* _HALMAC_SDIO_88XX_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_api.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_api.c -new file mode 100644 -index 000000000..d6f531d33 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_api.c -@@ -0,0 +1,640 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_type.h" -+#include "halmac_api.h" -+ -+#if (HALMAC_PLATFORM_WINDOWS) -+ -+#if HALMAC_8822B_SUPPORT -+#include "halmac_88xx/halmac_init_win8822b.h" -+#endif -+ -+#if HALMAC_8821C_SUPPORT -+#include "halmac_88xx/halmac_init_win8821c.h" -+#endif -+ -+#if HALMAC_8814B_SUPPORT -+#include "halmac_88xx_v1/halmac_init_win8814b_v1.h" -+#endif -+ -+#if HALMAC_8822C_SUPPORT -+#include "halmac_88xx/halmac_init_win8822c.h" -+#endif -+ -+#if HALMAC_8812F_SUPPORT -+#include "halmac_88xx/halmac_init_win8812f.h" -+#endif -+ -+#else -+ -+#if HALMAC_88XX_SUPPORT -+#include "halmac_88xx/halmac_init_88xx.h" -+#endif -+#if HALMAC_88XX_V1_SUPPORT -+#include "halmac_88xx_v1/halmac_init_88xx_v1.h" -+#if defined(HALMAC_DATA_CPU_EN) -+#include "halmac_88xxd_v1/halmac_init_88xxd_v1.h" -+#endif -+#endif -+ -+#endif -+ -+enum chip_id_hw_def { -+ CHIP_ID_HW_DEF_8723A = 0x01, -+ CHIP_ID_HW_DEF_8188E = 0x02, -+ CHIP_ID_HW_DEF_8881A = 0x03, -+ CHIP_ID_HW_DEF_8812A = 0x04, -+ CHIP_ID_HW_DEF_8821A = 0x05, -+ CHIP_ID_HW_DEF_8723B = 0x06, -+ CHIP_ID_HW_DEF_8192E = 0x07, -+ CHIP_ID_HW_DEF_8814A = 0x08, -+ CHIP_ID_HW_DEF_8821C = 0x09, -+ CHIP_ID_HW_DEF_8822B = 0x0A, -+ CHIP_ID_HW_DEF_8703B = 0x0B, -+ CHIP_ID_HW_DEF_8188F = 0x0C, -+ CHIP_ID_HW_DEF_8192F = 0x0D, -+ CHIP_ID_HW_DEF_8197F = 0x0E, -+ CHIP_ID_HW_DEF_8723D = 0x0F, -+ CHIP_ID_HW_DEF_8814B = 0x11, -+ CHIP_ID_HW_DEF_8822C = 0x13, -+ CHIP_ID_HW_DEF_8812F = 0x14, -+ CHIP_ID_HW_DEF_UNDEFINE = 0x7F, -+ CHIP_ID_HW_DEF_PS = 0xEA, -+}; -+ -+static enum halmac_ret_status -+chk_pltfm_api(void *drv_adapter, enum halmac_interface intf, -+ struct halmac_platform_api *pltfm_api); -+ -+static enum halmac_ret_status -+get_chip_info(void *drv_adapter, struct halmac_platform_api *pltfm_api, -+ enum halmac_interface intf, struct halmac_adapter *adapter); -+ -+static u8 -+pltfm_reg_r8_sdio(void *drv_adapter, struct halmac_platform_api *pltfm_api, -+ u32 offset); -+ -+static enum halmac_ret_status -+pltfm_reg_w8_sdio(void *drv_adapter, struct halmac_platform_api *pltfm_api, -+ u32 offset, u8 data); -+ -+static u8 -+pltfm_reg_r_indir_sdio(void *drv_adapter, struct halmac_platform_api *pltfm_api, -+ u32 offset); -+ -+static enum halmac_ret_status -+cnv_to_sdio_bus_offset(u32 *offset); -+ -+/** -+ * halmac_init_adapter() - init halmac_adapter -+ * @drv_adapter : the adapter of caller -+ * @pltfm_api : the platform APIs which is used in halmac -+ * @intf : bus interface -+ * @halmac_adapter : the adapter of halmac -+ * @halmac_api : the function pointer of APIs -+ * Author : KaiYuan Chang / Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+halmac_init_adapter(void *drv_adapter, struct halmac_platform_api *pltfm_api, -+ enum halmac_interface intf, -+ struct halmac_adapter **halmac_adapter, -+ struct halmac_api **halmac_api) -+{ -+ struct halmac_adapter *adapter = NULL; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ u8 *buf = NULL; -+ -+ union { -+ u32 i; -+ u8 x[4]; -+ } ENDIAN_CHECK = { 0x01000000 }; -+ -+ status = chk_pltfm_api(drv_adapter, intf, pltfm_api); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, HALMAC_DBG_ALWAYS, -+ HALMAC_SVN_VER "\n" -+ "HALMAC_MAJOR_VER = %d\n" -+ "HALMAC_PROTOTYPE_VER = %d\n" -+ "HALMAC_MINOR_VER = %d\n" -+ "HALMAC_PATCH_VER = %d\n", -+ HALMAC_MAJOR_VER, HALMAC_PROTOTYPE_VER, -+ HALMAC_MINOR_VER, HALMAC_PATCH_VER); -+ -+ if (ENDIAN_CHECK.x[0] == HALMAC_SYSTEM_ENDIAN) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, -+ "[ERR]Endian setting err!!\n"); -+ return HALMAC_RET_ENDIAN_ERR; -+ } -+ -+ buf = (u8 *)pltfm_api->RTL_MALLOC(drv_adapter, sizeof(*adapter)); -+ -+ if (!buf) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, -+ "[ERR]Malloc HAL adapter err!!\n"); -+ return HALMAC_RET_MALLOC_FAIL; -+ } -+ pltfm_api->RTL_MEMSET(drv_adapter, buf, 0x00, sizeof(*adapter)); -+ adapter = (struct halmac_adapter *)buf; -+ -+ *halmac_adapter = adapter; -+ -+ adapter->pltfm_api = pltfm_api; -+ adapter->drv_adapter = drv_adapter; -+ intf = (intf == HALMAC_INTERFACE_AXI) ? HALMAC_INTERFACE_PCIE : intf; -+ adapter->intf = intf; -+ -+ if (get_chip_info(drv_adapter, pltfm_api, intf, adapter) -+ != HALMAC_RET_SUCCESS) { -+ PLTFM_FREE(*halmac_adapter, sizeof(**halmac_adapter)); -+ *halmac_adapter = NULL; -+ return HALMAC_RET_CHIP_NOT_SUPPORT; -+ } -+ -+ PLTFM_MUTEX_INIT(&adapter->efuse_mutex); -+ PLTFM_MUTEX_INIT(&adapter->h2c_seq_mutex); -+ PLTFM_MUTEX_INIT(&adapter->sdio_indir_mutex); -+ -+#if (HALMAC_PLATFORM_WINDOWS == 0) -+ -+#if HALMAC_88XX_SUPPORT -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822B || -+ adapter->chip_id == HALMAC_CHIP_ID_8821C || -+ adapter->chip_id == HALMAC_CHIP_ID_8822C || -+ adapter->chip_id == HALMAC_CHIP_ID_8812F) { -+ init_adapter_param_88xx(adapter); -+ status = mount_api_88xx(adapter); -+ } -+#endif -+ -+#if HALMAC_88XX_V1_SUPPORT -+ if (adapter->chip_id == HALMAC_CHIP_ID_8814B) { -+ init_adapter_param_88xx_v1(adapter); -+ status = mount_api_88xx_v1(adapter); -+ } -+#if defined(HALMAC_DATA_CPU_EN) -+ if (adapter->chip_id == HALMAC_CHIP_ID_8814B) { -+ init_adapter_param_88xxd_v1(adapter); -+ status = mount_api_88xxd_v1(adapter); -+ } -+#endif -+#endif -+ -+#else -+ -+#if HALMAC_8822B_SUPPORT -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822B) { -+ init_adapter_param_win8822b(adapter); -+ status = mount_api_win8822b(adapter); -+ } -+#endif -+ -+#if HALMAC_8821C_SUPPORT -+ if (adapter->chip_id == HALMAC_CHIP_ID_8821C) { -+ init_adapter_param_win8821c(adapter); -+ status = mount_api_win8821c(adapter); -+ } -+#endif -+ -+#if HALMAC_8814B_SUPPORT -+ if (adapter->chip_id == HALMAC_CHIP_ID_8814B) { -+ init_adapter_param_win8814b_v1(adapter); -+ status = mount_api_win8814b_v1(adapter); -+ } -+#endif -+ -+#if HALMAC_8822C_SUPPORT -+ if (adapter->chip_id == HALMAC_CHIP_ID_8822C) { -+ init_adapter_param_win8822c(adapter); -+ status = mount_api_win8822c(adapter); -+ } -+#endif -+ -+#if HALMAC_8812F_SUPPORT -+ if (adapter->chip_id == HALMAC_CHIP_ID_8812F) { -+ init_adapter_param_win8812f(adapter); -+ status = mount_api_win8812f(adapter); -+ } -+#endif -+ -+#endif -+ *halmac_api = (struct halmac_api *)adapter->halmac_api; -+ -+#if HALMAC_DBG_MONITOR_IO -+ mount_api_dbg(adapter); -+#endif -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return status; -+} -+ -+/** -+ * halmac_halt_api() - stop halmac_api action -+ * @adapter : the adapter of halmac -+ * Author : Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+halmac_halt_api(struct halmac_adapter *adapter) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ adapter->halmac_state.api_state = HALMAC_API_STATE_HALT; -+ -+ PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * halmac_deinit_adapter() - deinit halmac adapter -+ * @adapter : the adapter of halmac -+ * Author : KaiYuan Chang / Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+halmac_deinit_adapter(struct halmac_adapter *adapter) -+{ -+ PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__); -+ -+ PLTFM_MUTEX_DEINIT(&adapter->efuse_mutex); -+ PLTFM_MUTEX_DEINIT(&adapter->h2c_seq_mutex); -+ PLTFM_MUTEX_DEINIT(&adapter->sdio_indir_mutex); -+ -+ if (adapter->efuse_map) { -+ PLTFM_FREE(adapter->efuse_map, adapter->hw_cfg_info.efuse_size); -+ adapter->efuse_map = (u8 *)NULL; -+ } -+ -+ if (adapter->sdio_fs.macid_map) { -+ PLTFM_FREE(adapter->sdio_fs.macid_map, -+ adapter->sdio_fs.macid_map_size); -+ adapter->sdio_fs.macid_map = (u8 *)NULL; -+ } -+ -+ if (adapter->halmac_state.psd_state.data) { -+ PLTFM_FREE(adapter->halmac_state.psd_state.data, -+ adapter->halmac_state.psd_state.data_size); -+ adapter->halmac_state.psd_state.data = (u8 *)NULL; -+ } -+ -+ if (adapter->halmac_api) { -+ PLTFM_FREE(adapter->halmac_api, sizeof(struct halmac_api)); -+ adapter->halmac_api = NULL; -+ } -+ -+ PLTFM_FREE(adapter, sizeof(*adapter)); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+chk_pltfm_api(void *drv_adapter, enum halmac_interface intf, -+ struct halmac_platform_api *pltfm_api) -+{ -+ if (!pltfm_api) -+ return HALMAC_RET_PLATFORM_API_NULL; -+ -+ if (!pltfm_api->MSG_PRINT) -+ return HALMAC_RET_PLATFORM_API_NULL; -+ -+ if (intf == HALMAC_INTERFACE_SDIO) { -+ if (!pltfm_api->SDIO_CMD52_READ) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio-r\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->SDIO_CMD53_READ_8) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio-r8\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->SDIO_CMD53_READ_16) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio-r16\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->SDIO_CMD53_READ_32) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio-r32\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->SDIO_CMD53_READ_N) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio-rn\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->SDIO_CMD52_WRITE) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio-w\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->SDIO_CMD53_WRITE_8) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio-w8\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->SDIO_CMD53_WRITE_16) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio-w16\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->SDIO_CMD53_WRITE_32) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio-w32\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->SDIO_CMD52_CIA_READ) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio-cia\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ } -+ -+ if (intf == HALMAC_INTERFACE_USB || intf == HALMAC_INTERFACE_PCIE) { -+ if (!pltfm_api->REG_READ_8) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]reg-r8\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->REG_READ_16) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]reg-r16\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->REG_READ_32) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]reg-r32\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->REG_WRITE_8) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]reg-w8\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->REG_WRITE_16) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]reg-w16\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->REG_WRITE_32) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]reg-w32\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ } -+ -+ if (!pltfm_api->RTL_FREE) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]mem-free\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ -+ if (!pltfm_api->RTL_MALLOC) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]mem-malloc\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->RTL_MEMCPY) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]mem-cpy\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->RTL_MEMSET) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]mem-set\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->RTL_DELAY_US) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]time-delay\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ -+ if (!pltfm_api->MUTEX_INIT) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]mutex-init\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->MUTEX_DEINIT) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]mutex-deinit\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->MUTEX_LOCK) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]mutex-lock\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->MUTEX_UNLOCK) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]mutex-unlock\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->EVENT_INDICATION) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]event-indication\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+#if HALMAC_DBG_MONITOR_IO -+ if (!pltfm_api->READ_MONITOR) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]read-monitor\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+ if (!pltfm_api->WRITE_MONITOR) { -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]write-monitor\n"); -+ return HALMAC_RET_PLATFORM_API_NULL; -+ } -+#endif -+ return HALMAC_RET_SUCCESS; -+} -+ -+/** -+ * halmac_get_version() - get HALMAC version -+ * @version : return version of major, prototype and minor information -+ * Author : KaiYuan Chang / Ivan Lin -+ * Return : enum halmac_ret_status -+ * More details of status code can be found in prototype document -+ */ -+enum halmac_ret_status -+halmac_get_version(struct halmac_ver *version) -+{ -+ version->major_ver = (u8)HALMAC_MAJOR_VER; -+ version->prototype_ver = (u8)HALMAC_PROTOTYPE_VER; -+ version->minor_ver = (u8)HALMAC_MINOR_VER; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static enum halmac_ret_status -+get_chip_info(void *drv_adapter, struct halmac_platform_api *pltfm_api, -+ enum halmac_interface intf, struct halmac_adapter *adapter) -+{ -+ u8 chip_id; -+ u8 chip_ver; -+ u32 cnt; -+ -+ if (adapter->intf == HALMAC_INTERFACE_SDIO) { -+ pltfm_reg_w8_sdio(drv_adapter, pltfm_api, REG_SDIO_HSUS_CTRL, -+ pltfm_reg_r8_sdio(drv_adapter, pltfm_api, -+ REG_SDIO_HSUS_CTRL) & -+ ~(BIT(0))); -+ -+ cnt = 10000; -+ while (!(pltfm_reg_r8_sdio(drv_adapter, pltfm_api, -+ REG_SDIO_HSUS_CTRL) & BIT(1))) { -+ cnt--; -+ if (cnt == 0) -+ return HALMAC_RET_SDIO_LEAVE_SUSPEND_FAIL; -+ } -+ -+ chip_id = pltfm_reg_r_indir_sdio(drv_adapter, pltfm_api, -+ REG_SYS_CFG2); -+ chip_ver = pltfm_reg_r_indir_sdio(drv_adapter, pltfm_api, -+ REG_SYS_CFG1 + 1) >> 4; -+ } else { -+ chip_id = pltfm_api->REG_READ_8(drv_adapter, REG_SYS_CFG2); -+ chip_ver = pltfm_api->REG_READ_8(drv_adapter, -+ REG_SYS_CFG1 + 1) >> 4; -+ } -+ -+ adapter->chip_ver = (enum halmac_chip_ver)chip_ver; -+ -+ if (chip_id == CHIP_ID_HW_DEF_8822B) { -+ adapter->chip_id = HALMAC_CHIP_ID_8822B; -+ } else if (chip_id == CHIP_ID_HW_DEF_8821C) { -+ adapter->chip_id = HALMAC_CHIP_ID_8821C; -+ } else if (chip_id == CHIP_ID_HW_DEF_8814B) { -+ adapter->chip_id = HALMAC_CHIP_ID_8814B; -+ } else if (chip_id == CHIP_ID_HW_DEF_8197F) { -+ adapter->chip_id = HALMAC_CHIP_ID_8197F; -+ } else if (chip_id == CHIP_ID_HW_DEF_8822C) { -+ adapter->chip_id = HALMAC_CHIP_ID_8822C; -+ } else if (chip_id == CHIP_ID_HW_DEF_8812F) { -+ adapter->chip_id = HALMAC_CHIP_ID_8812F; -+ } else { -+ adapter->chip_id = HALMAC_CHIP_ID_UNDEFINE; -+ PLTFM_MSG_ERR("[ERR]Chip id is undefined\n"); -+ return HALMAC_RET_CHIP_NOT_SUPPORT; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static u8 -+pltfm_reg_r8_sdio(void *drv_adapter, struct halmac_platform_api *pltfm_api, -+ u32 offset) -+{ -+ u8 value8; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (0 == (offset & 0xFFFF0000)) -+ offset |= WLAN_IOREG_OFFSET; -+ -+ status = cnv_to_sdio_bus_offset(&offset); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ value8 = pltfm_api->SDIO_CMD52_READ(drv_adapter, offset); -+ -+ return value8; -+} -+ -+static enum halmac_ret_status -+pltfm_reg_w8_sdio(void *drv_adapter, struct halmac_platform_api *pltfm_api, -+ u32 offset, u8 data) -+{ -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ if (0 == (offset & 0xFFFF0000)) -+ offset |= WLAN_IOREG_OFFSET; -+ -+ status = cnv_to_sdio_bus_offset(&offset); -+ -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ pltfm_api->SDIO_CMD52_WRITE(drv_adapter, offset, data); -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+static u8 -+pltfm_reg_r_indir_sdio(void *drv_adapter, struct halmac_platform_api *pltfm_api, -+ u32 offset) -+{ -+ u8 value8, tmp, cnt = 50; -+ u32 reg_cfg = REG_SDIO_INDIRECT_REG_CFG; -+ u32 reg_data = REG_SDIO_INDIRECT_REG_DATA; -+ enum halmac_ret_status status = HALMAC_RET_SUCCESS; -+ -+ status = cnv_to_sdio_bus_offset(®_cfg); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ status = cnv_to_sdio_bus_offset(®_data); -+ if (status != HALMAC_RET_SUCCESS) -+ return status; -+ -+ pltfm_api->SDIO_CMD52_WRITE(drv_adapter, reg_cfg, (u8)offset); -+ pltfm_api->SDIO_CMD52_WRITE(drv_adapter, reg_cfg + 1, -+ (u8)(offset >> 8)); -+ pltfm_api->SDIO_CMD52_WRITE(drv_adapter, reg_cfg + 2, -+ (u8)(BIT(3) | BIT(4))); -+ -+ do { -+ tmp = pltfm_api->SDIO_CMD52_READ(drv_adapter, reg_cfg + 2); -+ cnt--; -+ } while (((tmp & BIT(4)) == 0) && (cnt > 0)); -+ -+ if (((cnt & BIT(4)) == 0) && cnt == 0) -+ pltfm_api->MSG_PRINT(drv_adapter, HALMAC_MSG_INIT, -+ HALMAC_DBG_ERR, "[ERR]sdio indir read\n"); -+ -+ value8 = pltfm_api->SDIO_CMD52_READ(drv_adapter, reg_data); -+ -+ return value8; -+} -+ -+/*Note: copy from cnv_to_sdio_bus_offset_88xx*/ -+static enum halmac_ret_status -+cnv_to_sdio_bus_offset(u32 *offset) -+{ -+ switch ((*offset) & 0xFFFF0000) { -+ case WLAN_IOREG_OFFSET: -+ *offset &= HALMAC_WLAN_MAC_REG_MSK; -+ *offset |= HALMAC_SDIO_CMD_ADDR_MAC_REG << 13; -+ break; -+ case SDIO_LOCAL_OFFSET: -+ *offset &= HALMAC_SDIO_LOCAL_MSK; -+ *offset |= HALMAC_SDIO_CMD_ADDR_SDIO_REG << 13; -+ break; -+ default: -+ *offset = 0xFFFFFFFF; -+ return HALMAC_RET_CONVERT_SDIO_OFFSET_FAIL; -+ } -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_api.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_api.h -new file mode 100644 -index 000000000..3c1b864ae ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_api.h -@@ -0,0 +1,128 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_API_H_ -+#define _HALMAC_API_H_ -+ -+#define HALMAC_SVN_VER "55772M" -+ -+#define HALMAC_MAJOR_VER 1 -+#define HALMAC_PROTOTYPE_VER 6 -+#define HALMAC_MINOR_VER 6 -+#define HALMAC_PATCH_VER 23 -+ -+#define HALMAC_88XX_SUPPORT (HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define HALMAC_88XX_V1_SUPPORT HALMAC_8814B_SUPPORT -+ -+#include "halmac_2_platform.h" -+#include "halmac_type.h" -+#include "halmac_hw_cfg.h" -+#include "halmac_usb_reg.h" -+#include "halmac_sdio_reg.h" -+#include "halmac_pcie_reg.h" -+#include "halmac_bit2.h" -+#include "halmac_reg2.h" -+ -+#if HALMAC_PLATFORM_TESTPROGRAM -+#include "halmac_type_testprogram.h" -+#endif -+ -+#ifndef HALMAC_USE_TYPEDEF -+#define HALMAC_USE_TYPEDEF 1 -+#endif -+ -+#if HALMAC_USE_TYPEDEF -+#include "halmac_typedef.h" -+#endif -+ -+#if HALMAC_8822B_SUPPORT -+#include "halmac_reg_8822b.h" -+#include "halmac_bit_8822b.h" -+#endif -+ -+#if HALMAC_8821C_SUPPORT -+#include "halmac_reg_8821c.h" -+#include "halmac_bit_8821c.h" -+#endif -+ -+#if HALMAC_8814B_SUPPORT -+#include "halmac_reg_8814b.h" -+#include "halmac_bit_8814b.h" -+#endif -+ -+#if HALMAC_8822C_SUPPORT -+#include "halmac_reg_8822c.h" -+#include "halmac_bit_8822c.h" -+#endif -+ -+#if HALMAC_8812F_SUPPORT -+#include "halmac_reg_8812f.h" -+#include "halmac_bit_8812f.h" -+#endif -+ -+#if (HALMAC_PLATFORM_WINDOWS || HALMAC_PLATFORM_LINUX) -+#include "halmac_tx_desc_nic.h" -+#include "halmac_tx_desc_buffer_nic.h" -+#include "halmac_tx_desc_ie_nic.h" -+#include "halmac_rx_desc_nic.h" -+#include "halmac_tx_bd_nic.h" -+#include "halmac_rx_bd_nic.h" -+#include "halmac_fw_offload_c2h_nic.h" -+#include "halmac_fw_offload_h2c_nic.h" -+#include "halmac_h2c_extra_info_nic.h" -+#include "halmac_original_c2h_nic.h" -+#include "halmac_original_h2c_nic.h" -+#endif -+ -+#if (HALMAC_PLATFORM_AP) -+#include "halmac_rx_desc_ap.h" -+#include "halmac_tx_desc_ap.h" -+#include "halmac_tx_desc_buffer_ap.h" -+#include "halmac_tx_desc_ie_ap.h" -+#include "halmac_fw_offload_c2h_ap.h" -+#include "halmac_fw_offload_h2c_ap.h" -+#include "halmac_h2c_extra_info_ap.h" -+#include "halmac_original_c2h_ap.h" -+#include "halmac_original_h2c_ap.h" -+#endif -+ -+#if HALMAC_DBG_MONITOR_IO -+#include "halmac_dbg.h" -+#endif -+#include "halmac_tx_desc_chip.h" -+#include "halmac_rx_desc_chip.h" -+#include "halmac_tx_desc_buffer_chip.h" -+#include "halmac_tx_desc_ie_chip.h" -+ -+enum halmac_ret_status -+halmac_init_adapter(void *drv_adapter, struct halmac_platform_api *pltfm_api, -+ enum halmac_interface intf, -+ struct halmac_adapter **halmac_adapter, -+ struct halmac_api **halmac_api); -+ -+enum halmac_ret_status -+halmac_deinit_adapter(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+halmac_halt_api(struct halmac_adapter *adapter); -+ -+enum halmac_ret_status -+halmac_get_version(struct halmac_ver *version); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit2.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit2.h -new file mode 100644 -index 000000000..29f757b08 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit2.h -@@ -0,0 +1,75139 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL_WLAN_BITDEF_H__ -+#define __RTL_WLAN_BITDEF_H__ -+ -+#include "halmac_hw_cfg.h" -+ -+#define CPU_OPT_WIDTH 0x1F -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define BIT_WRITE_ENABLE BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define BIT_MEM_RMV_SIGN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define BIT_SHIFT_LLTE_RWM 30 -+#define BIT_MASK_LLTE_RWM 0x3 -+#define BIT_LLTE_RWM(x) (((x) & BIT_MASK_LLTE_RWM) << BIT_SHIFT_LLTE_RWM) -+#define BITS_LLTE_RWM (BIT_MASK_LLTE_RWM << BIT_SHIFT_LLTE_RWM) -+#define BIT_CLEAR_LLTE_RWM(x) ((x) & (~BITS_LLTE_RWM)) -+#define BIT_GET_LLTE_RWM(x) (((x) >> BIT_SHIFT_LLTE_RWM) & BIT_MASK_LLTE_RWM) -+#define BIT_SET_LLTE_RWM(x, v) (BIT_CLEAR_LLTE_RWM(x) | BIT_LLTE_RWM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define BIT_MEM_RMV_2PRF1 BIT(29) -+#define BIT_MEM_RMV_2PRF0 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_SHIFT_GTAB_ID 28 -+#define BIT_MASK_GTAB_ID 0x7 -+#define BIT_GTAB_ID(x) (((x) & BIT_MASK_GTAB_ID) << BIT_SHIFT_GTAB_ID) -+#define BITS_GTAB_ID (BIT_MASK_GTAB_ID << BIT_SHIFT_GTAB_ID) -+#define BIT_CLEAR_GTAB_ID(x) ((x) & (~BITS_GTAB_ID)) -+#define BIT_GET_GTAB_ID(x) (((x) >> BIT_SHIFT_GTAB_ID) & BIT_MASK_GTAB_ID) -+#define BIT_SET_GTAB_ID(x, v) (BIT_CLEAR_GTAB_ID(x) | BIT_GTAB_ID(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define BIT_MULRW BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define BIT_MEM_RMV_1PRF1 BIT(27) -+#define BIT_MEM_RMV_1PRF0 BIT(26) -+#define BIT_MEM_RMV_1PSR BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define BIT_SHIFT_MBIDCAM_ADDR 24 -+#define BIT_MASK_MBIDCAM_ADDR 0x1f -+#define BIT_MBIDCAM_ADDR(x) \ -+ (((x) & BIT_MASK_MBIDCAM_ADDR) << BIT_SHIFT_MBIDCAM_ADDR) -+#define BITS_MBIDCAM_ADDR (BIT_MASK_MBIDCAM_ADDR << BIT_SHIFT_MBIDCAM_ADDR) -+#define BIT_CLEAR_MBIDCAM_ADDR(x) ((x) & (~BITS_MBIDCAM_ADDR)) -+#define BIT_GET_MBIDCAM_ADDR(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_ADDR) & BIT_MASK_MBIDCAM_ADDR) -+#define BIT_SET_MBIDCAM_ADDR(x, v) \ -+ (BIT_CLEAR_MBIDCAM_ADDR(x) | BIT_MBIDCAM_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define BIT_MEM_RMV_ROM BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define BIT_CPRST BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define BIT_CTS_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define BIT_SHIFT_R_OFDM_LEN_V1 16 -+#define BIT_MASK_R_OFDM_LEN_V1 0xffff -+#define BIT_R_OFDM_LEN_V1(x) \ -+ (((x) & BIT_MASK_R_OFDM_LEN_V1) << BIT_SHIFT_R_OFDM_LEN_V1) -+#define BITS_R_OFDM_LEN_V1 (BIT_MASK_R_OFDM_LEN_V1 << BIT_SHIFT_R_OFDM_LEN_V1) -+#define BIT_CLEAR_R_OFDM_LEN_V1(x) ((x) & (~BITS_R_OFDM_LEN_V1)) -+#define BIT_GET_R_OFDM_LEN_V1(x) \ -+ (((x) >> BIT_SHIFT_R_OFDM_LEN_V1) & BIT_MASK_R_OFDM_LEN_V1) -+#define BIT_SET_R_OFDM_LEN_V1(x, v) \ -+ (BIT_CLEAR_R_OFDM_LEN_V1(x) | BIT_R_OFDM_LEN_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_SHIFT_COUNTER_BASE 16 -+#define BIT_MASK_COUNTER_BASE 0x1fff -+#define BIT_COUNTER_BASE(x) \ -+ (((x) & BIT_MASK_COUNTER_BASE) << BIT_SHIFT_COUNTER_BASE) -+#define BITS_COUNTER_BASE (BIT_MASK_COUNTER_BASE << BIT_SHIFT_COUNTER_BASE) -+#define BIT_CLEAR_COUNTER_BASE(x) ((x) & (~BITS_COUNTER_BASE)) -+#define BIT_GET_COUNTER_BASE(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_BASE) & BIT_MASK_COUNTER_BASE) -+#define BIT_SET_COUNTER_BASE(x, v) \ -+ (BIT_CLEAR_COUNTER_BASE(x) | BIT_COUNTER_BASE(v)) -+ -+#define BIT_SHIFT_AGG_VALUE2 16 -+#define BIT_MASK_AGG_VALUE2 0x7f -+#define BIT_AGG_VALUE2(x) (((x) & BIT_MASK_AGG_VALUE2) << BIT_SHIFT_AGG_VALUE2) -+#define BITS_AGG_VALUE2 (BIT_MASK_AGG_VALUE2 << BIT_SHIFT_AGG_VALUE2) -+#define BIT_CLEAR_AGG_VALUE2(x) ((x) & (~BITS_AGG_VALUE2)) -+#define BIT_GET_AGG_VALUE2(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE2) & BIT_MASK_AGG_VALUE2) -+#define BIT_SET_AGG_VALUE2(x, v) (BIT_CLEAR_AGG_VALUE2(x) | BIT_AGG_VALUE2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_WMAC_SRCH_FIFOFULL BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_SHIFT_XTAL_DRV_RF1 13 -+#define BIT_MASK_XTAL_DRV_RF1 0x3 -+#define BIT_XTAL_DRV_RF1(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF1) << BIT_SHIFT_XTAL_DRV_RF1) -+#define BITS_XTAL_DRV_RF1 (BIT_MASK_XTAL_DRV_RF1 << BIT_SHIFT_XTAL_DRV_RF1) -+#define BIT_CLEAR_XTAL_DRV_RF1(x) ((x) & (~BITS_XTAL_DRV_RF1)) -+#define BIT_GET_XTAL_DRV_RF1(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF1) & BIT_MASK_XTAL_DRV_RF1) -+#define BIT_SET_XTAL_DRV_RF1(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF1(x) | BIT_XTAL_DRV_RF1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define BIT_DISABLE_B0 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define BIT_ATIMEND BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_SHIFT_GTAB_ID_V1 12 -+#define BIT_MASK_GTAB_ID_V1 0x7 -+#define BIT_GTAB_ID_V1(x) (((x) & BIT_MASK_GTAB_ID_V1) << BIT_SHIFT_GTAB_ID_V1) -+#define BITS_GTAB_ID_V1 (BIT_MASK_GTAB_ID_V1 << BIT_SHIFT_GTAB_ID_V1) -+#define BIT_CLEAR_GTAB_ID_V1(x) ((x) & (~BITS_GTAB_ID_V1)) -+#define BIT_GET_GTAB_ID_V1(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1) & BIT_MASK_GTAB_ID_V1) -+#define BIT_SET_GTAB_ID_V1(x, v) (BIT_CLEAR_GTAB_ID_V1(x) | BIT_GTAB_ID_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define BIT_SHIFT_WATCH_DOG_RECORD_V1 10 -+#define BIT_MASK_WATCH_DOG_RECORD_V1 0x3fff -+#define BIT_WATCH_DOG_RECORD_V1(x) \ -+ (((x) & BIT_MASK_WATCH_DOG_RECORD_V1) << BIT_SHIFT_WATCH_DOG_RECORD_V1) -+#define BITS_WATCH_DOG_RECORD_V1 \ -+ (BIT_MASK_WATCH_DOG_RECORD_V1 << BIT_SHIFT_WATCH_DOG_RECORD_V1) -+#define BIT_CLEAR_WATCH_DOG_RECORD_V1(x) ((x) & (~BITS_WATCH_DOG_RECORD_V1)) -+#define BIT_GET_WATCH_DOG_RECORD_V1(x) \ -+ (((x) >> BIT_SHIFT_WATCH_DOG_RECORD_V1) & BIT_MASK_WATCH_DOG_RECORD_V1) -+#define BIT_SET_WATCH_DOG_RECORD_V1(x, v) \ -+ (BIT_CLEAR_WATCH_DOG_RECORD_V1(x) | BIT_WATCH_DOG_RECORD_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+#define BIT_R_SYM_CTRL_SPS_PWMFREQ BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define BIT_R_8051_SPD BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define BIT_R_IO_TIMEOUT_FLAG_V1 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_EN_RTS_REQ BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define BIT_EN_WATCH_DOG_V1 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_EN_EDCA_REQ BIT(8) -+ -+#define BIT_SHIFT_AGG_VALUE1 8 -+#define BIT_MASK_AGG_VALUE1 0x7f -+#define BIT_AGG_VALUE1(x) (((x) & BIT_MASK_AGG_VALUE1) << BIT_SHIFT_AGG_VALUE1) -+#define BITS_AGG_VALUE1 (BIT_MASK_AGG_VALUE1 << BIT_SHIFT_AGG_VALUE1) -+#define BIT_CLEAR_AGG_VALUE1(x) ((x) & (~BITS_AGG_VALUE1)) -+#define BIT_GET_AGG_VALUE1(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE1) & BIT_MASK_AGG_VALUE1) -+#define BIT_SET_AGG_VALUE1(x, v) (BIT_CLEAR_AGG_VALUE1(x) | BIT_AGG_VALUE1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_DIS_TXDMA_PRE BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define BIT_RAM_DL_SEL BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_EN_PTCL_REQ BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_DIS_RXDMA_PRE BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_EN_SCH_REQ BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_CLR_HGQ_REQ_BLOCK BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_SHIFT_I2C_M_BUS_GNT_FW 4 -+#define BIT_MASK_I2C_M_BUS_GNT_FW 0x7 -+#define BIT_I2C_M_BUS_GNT_FW(x) \ -+ (((x) & BIT_MASK_I2C_M_BUS_GNT_FW) << BIT_SHIFT_I2C_M_BUS_GNT_FW) -+#define BITS_I2C_M_BUS_GNT_FW \ -+ (BIT_MASK_I2C_M_BUS_GNT_FW << BIT_SHIFT_I2C_M_BUS_GNT_FW) -+#define BIT_CLEAR_I2C_M_BUS_GNT_FW(x) ((x) & (~BITS_I2C_M_BUS_GNT_FW)) -+#define BIT_GET_I2C_M_BUS_GNT_FW(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_BUS_GNT_FW) & BIT_MASK_I2C_M_BUS_GNT_FW) -+#define BIT_SET_I2C_M_BUS_GNT_FW(x, v) \ -+ (BIT_CLEAR_I2C_M_BUS_GNT_FW(x) | BIT_I2C_M_BUS_GNT_FW(v)) -+ -+#define BIT_I2C_M_GNT_FW BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_TXFLAG_EXIT_L1_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_DATA_FW_STS_FILTER BIT(2) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+#define BIT_OPTION_DIS_XTAL_BG BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define BIT_EN_RXDMA_ALIGN_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_SHIFT_I2C_M_SPEED 1 -+#define BIT_MASK_I2C_M_SPEED 0x3 -+#define BIT_I2C_M_SPEED(x) \ -+ (((x) & BIT_MASK_I2C_M_SPEED) << BIT_SHIFT_I2C_M_SPEED) -+#define BITS_I2C_M_SPEED (BIT_MASK_I2C_M_SPEED << BIT_SHIFT_I2C_M_SPEED) -+#define BIT_CLEAR_I2C_M_SPEED(x) ((x) & (~BITS_I2C_M_SPEED)) -+#define BIT_GET_I2C_M_SPEED(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_SPEED) & BIT_MASK_I2C_M_SPEED) -+#define BIT_SET_I2C_M_SPEED(x, v) \ -+ (BIT_CLEAR_I2C_M_SPEED(x) | BIT_I2C_M_SPEED(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_CTRL_FW_STS_FILTER BIT(1) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+#define BIT_AFE_MBIAS BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+#define BIT_SHIFT_MDIO_REG_ADDR 0 -+#define BIT_MASK_MDIO_REG_ADDR 0x1f -+#define BIT_MDIO_REG_ADDR(x) \ -+ (((x) & BIT_MASK_MDIO_REG_ADDR) << BIT_SHIFT_MDIO_REG_ADDR) -+#define BITS_MDIO_REG_ADDR (BIT_MASK_MDIO_REG_ADDR << BIT_SHIFT_MDIO_REG_ADDR) -+#define BIT_CLEAR_MDIO_REG_ADDR(x) ((x) & (~BITS_MDIO_REG_ADDR)) -+#define BIT_GET_MDIO_REG_ADDR(x) \ -+ (((x) >> BIT_SHIFT_MDIO_REG_ADDR) & BIT_MASK_MDIO_REG_ADDR) -+#define BIT_SET_MDIO_REG_ADDR(x, v) \ -+ (BIT_CLEAR_MDIO_REG_ADDR(x) | BIT_MDIO_REG_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define BIT_EN_TXDMA_ALIGN_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_SHIFT_RXFF0_BNDY_V2 0 -+#define BIT_MASK_RXFF0_BNDY_V2 0x3ffff -+#define BIT_RXFF0_BNDY_V2(x) \ -+ (((x) & BIT_MASK_RXFF0_BNDY_V2) << BIT_SHIFT_RXFF0_BNDY_V2) -+#define BITS_RXFF0_BNDY_V2 (BIT_MASK_RXFF0_BNDY_V2 << BIT_SHIFT_RXFF0_BNDY_V2) -+#define BIT_CLEAR_RXFF0_BNDY_V2(x) ((x) & (~BITS_RXFF0_BNDY_V2)) -+#define BIT_GET_RXFF0_BNDY_V2(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_BNDY_V2) & BIT_MASK_RXFF0_BNDY_V2) -+#define BIT_SET_RXFF0_BNDY_V2(x, v) \ -+ (BIT_CLEAR_RXFF0_BNDY_V2(x) | BIT_RXFF0_BNDY_V2(v)) -+ -+#define BIT_SHIFT_RXFF0_RDPTR_V2 0 -+#define BIT_MASK_RXFF0_RDPTR_V2 0x3ffff -+#define BIT_RXFF0_RDPTR_V2(x) \ -+ (((x) & BIT_MASK_RXFF0_RDPTR_V2) << BIT_SHIFT_RXFF0_RDPTR_V2) -+#define BITS_RXFF0_RDPTR_V2 \ -+ (BIT_MASK_RXFF0_RDPTR_V2 << BIT_SHIFT_RXFF0_RDPTR_V2) -+#define BIT_CLEAR_RXFF0_RDPTR_V2(x) ((x) & (~BITS_RXFF0_RDPTR_V2)) -+#define BIT_GET_RXFF0_RDPTR_V2(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_RDPTR_V2) & BIT_MASK_RXFF0_RDPTR_V2) -+#define BIT_SET_RXFF0_RDPTR_V2(x, v) \ -+ (BIT_CLEAR_RXFF0_RDPTR_V2(x) | BIT_RXFF0_RDPTR_V2(v)) -+ -+#define BIT_SHIFT_RXFF0_WTPTR_V2 0 -+#define BIT_MASK_RXFF0_WTPTR_V2 0x3ffff -+#define BIT_RXFF0_WTPTR_V2(x) \ -+ (((x) & BIT_MASK_RXFF0_WTPTR_V2) << BIT_SHIFT_RXFF0_WTPTR_V2) -+#define BITS_RXFF0_WTPTR_V2 \ -+ (BIT_MASK_RXFF0_WTPTR_V2 << BIT_SHIFT_RXFF0_WTPTR_V2) -+#define BIT_CLEAR_RXFF0_WTPTR_V2(x) ((x) & (~BITS_RXFF0_WTPTR_V2)) -+#define BIT_GET_RXFF0_WTPTR_V2(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_WTPTR_V2) & BIT_MASK_RXFF0_WTPTR_V2) -+#define BIT_SET_RXFF0_WTPTR_V2(x, v) \ -+ (BIT_CLEAR_RXFF0_WTPTR_V2(x) | BIT_RXFF0_WTPTR_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_SHIFT_AGG_VALUE0 0 -+#define BIT_MASK_AGG_VALUE0 0x7f -+#define BIT_AGG_VALUE0(x) (((x) & BIT_MASK_AGG_VALUE0) << BIT_SHIFT_AGG_VALUE0) -+#define BITS_AGG_VALUE0 (BIT_MASK_AGG_VALUE0 << BIT_SHIFT_AGG_VALUE0) -+#define BIT_CLEAR_AGG_VALUE0(x) ((x) & (~BITS_AGG_VALUE0)) -+#define BIT_GET_AGG_VALUE0(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE0) & BIT_MASK_AGG_VALUE0) -+#define BIT_SET_AGG_VALUE0(x, v) (BIT_CLEAR_AGG_VALUE0(x) | BIT_AGG_VALUE0(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_SHIFT_BW_CFG 0 -+#define BIT_MASK_BW_CFG 0x3 -+#define BIT_BW_CFG(x) (((x) & BIT_MASK_BW_CFG) << BIT_SHIFT_BW_CFG) -+#define BITS_BW_CFG (BIT_MASK_BW_CFG << BIT_SHIFT_BW_CFG) -+#define BIT_CLEAR_BW_CFG(x) ((x) & (~BITS_BW_CFG)) -+#define BIT_GET_BW_CFG(x) (((x) >> BIT_SHIFT_BW_CFG) & BIT_MASK_BW_CFG) -+#define BIT_SET_BW_CFG(x, v) (BIT_CLEAR_BW_CFG(x) | BIT_BW_CFG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_I2C_M_UNLOCK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define BIT_MGNT_FW_STS_FILTER BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define BIT_ISO_MD2PP BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_SHIFT_SDIO_INT_TIMEOUT 16 -+#define BIT_MASK_SDIO_INT_TIMEOUT 0xffff -+#define BIT_SDIO_INT_TIMEOUT(x) \ -+ (((x) & BIT_MASK_SDIO_INT_TIMEOUT) << BIT_SHIFT_SDIO_INT_TIMEOUT) -+#define BITS_SDIO_INT_TIMEOUT \ -+ (BIT_MASK_SDIO_INT_TIMEOUT << BIT_SHIFT_SDIO_INT_TIMEOUT) -+#define BIT_CLEAR_SDIO_INT_TIMEOUT(x) ((x) & (~BITS_SDIO_INT_TIMEOUT)) -+#define BIT_GET_SDIO_INT_TIMEOUT(x) \ -+ (((x) >> BIT_SHIFT_SDIO_INT_TIMEOUT) & BIT_MASK_SDIO_INT_TIMEOUT) -+#define BIT_SET_SDIO_INT_TIMEOUT(x, v) \ -+ (BIT_CLEAR_SDIO_INT_TIMEOUT(x) | BIT_SDIO_INT_TIMEOUT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_PWC_EV12V BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_PWC_ON2EF BIT(15) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_IO_ERR_STATUS BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_PWC_EBCOEB BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_PWC_EV25V BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_PWC_EV2EF BIT(14) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_CMD53_W_MIX BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_PA33V_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_CMD53_TX_FORMAT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_PA12V_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_CMD53_R_TIMEOUT_MASK BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_PC_A15V BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_UA33V_EN BIT(11) -+#define BIT_UA12V_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_SHIFT_CMD53_R_TIMEOUT_UNIT 10 -+#define BIT_MASK_CMD53_R_TIMEOUT_UNIT 0x3 -+#define BIT_CMD53_R_TIMEOUT_UNIT(x) \ -+ (((x) & BIT_MASK_CMD53_R_TIMEOUT_UNIT) \ -+ << BIT_SHIFT_CMD53_R_TIMEOUT_UNIT) -+#define BITS_CMD53_R_TIMEOUT_UNIT \ -+ (BIT_MASK_CMD53_R_TIMEOUT_UNIT << BIT_SHIFT_CMD53_R_TIMEOUT_UNIT) -+#define BIT_CLEAR_CMD53_R_TIMEOUT_UNIT(x) ((x) & (~BITS_CMD53_R_TIMEOUT_UNIT)) -+#define BIT_GET_CMD53_R_TIMEOUT_UNIT(x) \ -+ (((x) >> BIT_SHIFT_CMD53_R_TIMEOUT_UNIT) & \ -+ BIT_MASK_CMD53_R_TIMEOUT_UNIT) -+#define BIT_SET_CMD53_R_TIMEOUT_UNIT(x, v) \ -+ (BIT_CLEAR_CMD53_R_TIMEOUT_UNIT(x) | BIT_CMD53_R_TIMEOUT_UNIT(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_AFE_OUTPUT_SIGNAL BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_RFDIO BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_REPLY_ERRCRC_IN_DATA BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_EB2CORE BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_EF2PP BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_EN_CMD53_OVERLAP BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_DIOE BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_EXTIO BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_REPLY_ERR_IN_R5 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_DIOP BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_WLPON2PP BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_R18A_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_IP2MAC_WA2PP BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_WA2PP BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_SDIO_CMD_FORCE_VLD BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_PD2CORE BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_PD2PP BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_INIT_CMD_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_PA2PCIE BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_PA2PD BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_RXINT_READ_MASK_DIS BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_EN_32K_TRANS BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_UD2CORE BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_UD2PP BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_EN_RXDMA_MASK_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_HD2CORE BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_UA2USB BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_UA2UD BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_EN_MASK_TIMER BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_WD2PP BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_ISO_CTRL (Offset 0x0000) */ -+ -+#define BIT_ISO_WL2PP BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TX_CTRL (Offset 0x10250000) */ -+ -+#define BIT_CMD_ERR_STOP_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_FEN_MREGEN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_FEN_HWPDN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_AIP_PD12_N BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_EN_25_1 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_FEN_ELDR BIT(12) -+#define BIT_FEN_DCORE BIT(11) -+#define BIT_FEN_CPUEN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_FEN_DIOE BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_FEN_EXTIO BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_FEN_PCIED BIT(8) -+#define BIT_FEN_PPLL BIT(7) -+#define BIT_FEN_PCIEA BIT(6) -+#define BIT_FEN_DIO_PCIE BIT(5) -+#define BIT_FEN_USBD BIT(4) -+#define BIT_FEN_UPLL BIT(3) -+#define BIT_FEN_USBA BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_FEN_BB_GLB_RSTN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_FEN_WLPHYGLB BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_FEN_BBRSTB BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_FUNC_EN (Offset 0x0002) */ -+ -+#define BIT_FEN_WLPHYFUN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SOP_EABM BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SKP_ALD BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SOP_ACKF BIT(30) -+#define BIT_SOP_ERCK BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SOP_ESWR BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SOP_AFEP BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SOP_PWMM BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SOP_EPWM BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SOP_EECK BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_PMC_RATIO_BIT2 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SOP_ANA_CLK_DIVISION_2 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_ROP_ENXT BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SOP_EXTL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_PMC_RATIO_BIT1 BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_CHIPOFF_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SYM_OP_RING_12M BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_DIS_USB3_SUS_ALD BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_ROP_SWPR BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_DIS_HW_LPLDM BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SOP_ALD BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_OPT_SWRST_WLMCU BIT(19) -+#define BIT_RDY_SYSPWR BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_EN_WLON BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_APDM_HPDN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_PMC_RATIO_BIT0 BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_HSUS BIT(14) -+#define BIT_PDN_SEL BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_AFSM_PCIE_SUS_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_AFSM_WLSUS_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_APFM_SWLPS BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_APFM_SWLPS_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_APFM_OFFMAC BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_HW_AUTO_CTRL_EXT_SWR BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_APFN_ONMAC BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_USE_INTERNAL_SWR_AND_LDO BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_CHIP_PDN_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_BT_SUSEN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_RDY_MACDIS BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_PD_RF BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_RING_CLK_12M_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_CMD11_VOL_SWITCH (Offset 0x10250004) */ -+ -+#define BIT_SHIFT_CMD11_SEQ_END_DELAY 4 -+#define BIT_MASK_CMD11_SEQ_END_DELAY 0xf -+#define BIT_CMD11_SEQ_END_DELAY(x) \ -+ (((x) & BIT_MASK_CMD11_SEQ_END_DELAY) << BIT_SHIFT_CMD11_SEQ_END_DELAY) -+#define BITS_CMD11_SEQ_END_DELAY \ -+ (BIT_MASK_CMD11_SEQ_END_DELAY << BIT_SHIFT_CMD11_SEQ_END_DELAY) -+#define BIT_CLEAR_CMD11_SEQ_END_DELAY(x) ((x) & (~BITS_CMD11_SEQ_END_DELAY)) -+#define BIT_GET_CMD11_SEQ_END_DELAY(x) \ -+ (((x) >> BIT_SHIFT_CMD11_SEQ_END_DELAY) & BIT_MASK_CMD11_SEQ_END_DELAY) -+#define BIT_SET_CMD11_SEQ_END_DELAY(x, v) \ -+ (BIT_CLEAR_CMD11_SEQ_END_DELAY(x) | BIT_CMD11_SEQ_END_DELAY(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_ENPDN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_PFM_WOWL BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_SW_WAKE BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_PFM_LDKP BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_WL_HCI_ALD BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_ANA_CLK_DIVISION_2 BIT(1) -+ -+#define BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL 1 -+#define BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL 0x7 -+#define BIT_CMD11_SEQ_SAMPLE_INTERVAL(x) \ -+ (((x) & BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL) \ -+ << BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL) -+#define BITS_CMD11_SEQ_SAMPLE_INTERVAL \ -+ (BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL \ -+ << BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL) -+#define BIT_CLEAR_CMD11_SEQ_SAMPLE_INTERVAL(x) \ -+ ((x) & (~BITS_CMD11_SEQ_SAMPLE_INTERVAL)) -+#define BIT_GET_CMD11_SEQ_SAMPLE_INTERVAL(x) \ -+ (((x) >> BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL) & \ -+ BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL) -+#define BIT_SET_CMD11_SEQ_SAMPLE_INTERVAL(x, v) \ -+ (BIT_CLEAR_CMD11_SEQ_SAMPLE_INTERVAL(x) | \ -+ BIT_CMD11_SEQ_SAMPLE_INTERVAL(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_PFM_ALDN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_PW_CTRL (Offset 0x0004) */ -+ -+#define BIT_PFM_LDALL BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_CMD11_VOL_SWITCH (Offset 0x10250004) */ -+ -+#define BIT_CMD11_SEQ_EN BIT(0) -+ -+/* 2 REG_SDIO_CTRL (Offset 0x10250005) */ -+ -+#define BIT_SIG_OUT_PH BIT(0) -+ -+/* 2 REG_SDIO_DRIVING (Offset 0x10250006) */ -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_D 12 -+#define BIT_MASK_SDIO_DRV_TYPE_D 0xf -+#define BIT_SDIO_DRV_TYPE_D(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_D) << BIT_SHIFT_SDIO_DRV_TYPE_D) -+#define BITS_SDIO_DRV_TYPE_D \ -+ (BIT_MASK_SDIO_DRV_TYPE_D << BIT_SHIFT_SDIO_DRV_TYPE_D) -+#define BIT_CLEAR_SDIO_DRV_TYPE_D(x) ((x) & (~BITS_SDIO_DRV_TYPE_D)) -+#define BIT_GET_SDIO_DRV_TYPE_D(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_D) & BIT_MASK_SDIO_DRV_TYPE_D) -+#define BIT_SET_SDIO_DRV_TYPE_D(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_D(x) | BIT_SDIO_DRV_TYPE_D(v)) -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_C 8 -+#define BIT_MASK_SDIO_DRV_TYPE_C 0xf -+#define BIT_SDIO_DRV_TYPE_C(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_C) << BIT_SHIFT_SDIO_DRV_TYPE_C) -+#define BITS_SDIO_DRV_TYPE_C \ -+ (BIT_MASK_SDIO_DRV_TYPE_C << BIT_SHIFT_SDIO_DRV_TYPE_C) -+#define BIT_CLEAR_SDIO_DRV_TYPE_C(x) ((x) & (~BITS_SDIO_DRV_TYPE_C)) -+#define BIT_GET_SDIO_DRV_TYPE_C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_C) & BIT_MASK_SDIO_DRV_TYPE_C) -+#define BIT_SET_SDIO_DRV_TYPE_C(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_C(x) | BIT_SDIO_DRV_TYPE_C(v)) -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_B 4 -+#define BIT_MASK_SDIO_DRV_TYPE_B 0xf -+#define BIT_SDIO_DRV_TYPE_B(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_B) << BIT_SHIFT_SDIO_DRV_TYPE_B) -+#define BITS_SDIO_DRV_TYPE_B \ -+ (BIT_MASK_SDIO_DRV_TYPE_B << BIT_SHIFT_SDIO_DRV_TYPE_B) -+#define BIT_CLEAR_SDIO_DRV_TYPE_B(x) ((x) & (~BITS_SDIO_DRV_TYPE_B)) -+#define BIT_GET_SDIO_DRV_TYPE_B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_B) & BIT_MASK_SDIO_DRV_TYPE_B) -+#define BIT_SET_SDIO_DRV_TYPE_B(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_B(x) | BIT_SDIO_DRV_TYPE_B(v)) -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_A 0 -+#define BIT_MASK_SDIO_DRV_TYPE_A 0xf -+#define BIT_SDIO_DRV_TYPE_A(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_A) << BIT_SHIFT_SDIO_DRV_TYPE_A) -+#define BITS_SDIO_DRV_TYPE_A \ -+ (BIT_MASK_SDIO_DRV_TYPE_A << BIT_SHIFT_SDIO_DRV_TYPE_A) -+#define BIT_CLEAR_SDIO_DRV_TYPE_A(x) ((x) & (~BITS_SDIO_DRV_TYPE_A)) -+#define BIT_GET_SDIO_DRV_TYPE_A(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_A) & BIT_MASK_SDIO_DRV_TYPE_A) -+#define BIT_SET_SDIO_DRV_TYPE_A(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_A(x) | BIT_SDIO_DRV_TYPE_A(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_CPHY_LDO_CL_EN BIT(19) -+#define BIT_CPHY_LDO_OK BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_LDO_DUMMY BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_ANA_CLK_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_DATA_CPU_CLK_EN BIT(15) -+#define BIT_DATA_CPU_PWC BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_CPU_CLK_EN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_SYMREG_CLK_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_RING_CLK_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_HCI_CLK_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_SYS_CLK_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_MAC_CLK_EN BIT(11) -+#define BIT_SEC_CLK_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_CTRL_SPS_PWM_FREQ BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_PHY_SSC_RSTB BIT(9) -+#define BIT_EXT_32K_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_EXT32K_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_DISABLE_OPEN_SPS_LDO BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_WL_CLK_TEST BIT(7) -+#define BIT_OP_SPS_PWM_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_SHIFT_MAC_CLK_SEL_V1 6 -+#define BIT_MASK_MAC_CLK_SEL_V1 0x3 -+#define BIT_MAC_CLK_SEL_V1(x) \ -+ (((x) & BIT_MASK_MAC_CLK_SEL_V1) << BIT_SHIFT_MAC_CLK_SEL_V1) -+#define BITS_MAC_CLK_SEL_V1 \ -+ (BIT_MASK_MAC_CLK_SEL_V1 << BIT_SHIFT_MAC_CLK_SEL_V1) -+#define BIT_CLEAR_MAC_CLK_SEL_V1(x) ((x) & (~BITS_MAC_CLK_SEL_V1)) -+#define BIT_GET_MAC_CLK_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_MAC_CLK_SEL_V1) & BIT_MASK_MAC_CLK_SEL_V1) -+#define BIT_SET_MAC_CLK_SEL_V1(x, v) \ -+ (BIT_CLEAR_MAC_CLK_SEL_V1(x) | BIT_MAC_CLK_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_LOADER_CLK_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_POW_PC_LDO3 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_MACSLP BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_POW_PC_LDO2 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_WAKEPAD_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_ENB_LDO_DIODE_L BIT(3) -+#define BIT_POW_PC_LDO1 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_ROMD16V_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_AFE_BGEN_PCIE_OP BIT(2) -+#define BIT_POW_PC_LDO0 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_CKANA8M_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_CKANA12M_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_ANA8M_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_CNTD16V_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_MONITOR (Offset 0x10250008) */ -+ -+#define BIT_SHIFT_SDIO_INT_START 0 -+#define BIT_MASK_SDIO_INT_START 0xffffffffL -+#define BIT_SDIO_INT_START(x) \ -+ (((x) & BIT_MASK_SDIO_INT_START) << BIT_SHIFT_SDIO_INT_START) -+#define BITS_SDIO_INT_START \ -+ (BIT_MASK_SDIO_INT_START << BIT_SHIFT_SDIO_INT_START) -+#define BIT_CLEAR_SDIO_INT_START(x) ((x) & (~BITS_SDIO_INT_START)) -+#define BIT_GET_SDIO_INT_START(x) \ -+ (((x) >> BIT_SHIFT_SDIO_INT_START) & BIT_MASK_SDIO_INT_START) -+#define BIT_SET_SDIO_INT_START(x, v) \ -+ (BIT_CLEAR_SDIO_INT_START(x) | BIT_SDIO_INT_START(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CLK_CTRL (Offset 0x0008) */ -+ -+#define BIT_POW_POWER_CUT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_EEPROM_CTRL (Offset 0x000A) */ -+ -+#define BIT_SHIFT_VPDIDX 8 -+#define BIT_MASK_VPDIDX 0xff -+#define BIT_VPDIDX(x) (((x) & BIT_MASK_VPDIDX) << BIT_SHIFT_VPDIDX) -+#define BITS_VPDIDX (BIT_MASK_VPDIDX << BIT_SHIFT_VPDIDX) -+#define BIT_CLEAR_VPDIDX(x) ((x) & (~BITS_VPDIDX)) -+#define BIT_GET_VPDIDX(x) (((x) >> BIT_SHIFT_VPDIDX) & BIT_MASK_VPDIDX) -+#define BIT_SET_VPDIDX(x, v) (BIT_CLEAR_VPDIDX(x) | BIT_VPDIDX(v)) -+ -+#define BIT_SHIFT_EEM1_0 6 -+#define BIT_MASK_EEM1_0 0x3 -+#define BIT_EEM1_0(x) (((x) & BIT_MASK_EEM1_0) << BIT_SHIFT_EEM1_0) -+#define BITS_EEM1_0 (BIT_MASK_EEM1_0 << BIT_SHIFT_EEM1_0) -+#define BIT_CLEAR_EEM1_0(x) ((x) & (~BITS_EEM1_0)) -+#define BIT_GET_EEM1_0(x) (((x) >> BIT_SHIFT_EEM1_0) & BIT_MASK_EEM1_0) -+#define BIT_SET_EEM1_0(x, v) (BIT_CLEAR_EEM1_0(x) | BIT_EEM1_0(v)) -+ -+#define BIT_AUTOLOAD_SUS BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_EEPROM_CTRL (Offset 0x000A) */ -+ -+#define BIT_EERPOMSEL BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_EEPROM_CTRL (Offset 0x000A) */ -+ -+#define BIT_EEPROMSEL BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_EEPROM_CTRL (Offset 0x000A) */ -+ -+#define BIT_EECS_V1 BIT(3) -+#define BIT_EESK_V1 BIT(2) -+#define BIT_EEDI_V1 BIT(1) -+#define BIT_EEDO_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_MONITOR_2 (Offset 0x1025000C) */ -+ -+#define BIT_CMD53_WT_EN BIT(23) -+ -+#define BIT_SHIFT_SDIO_CLK_MONITOR 21 -+#define BIT_MASK_SDIO_CLK_MONITOR 0x3 -+#define BIT_SDIO_CLK_MONITOR(x) \ -+ (((x) & BIT_MASK_SDIO_CLK_MONITOR) << BIT_SHIFT_SDIO_CLK_MONITOR) -+#define BITS_SDIO_CLK_MONITOR \ -+ (BIT_MASK_SDIO_CLK_MONITOR << BIT_SHIFT_SDIO_CLK_MONITOR) -+#define BIT_CLEAR_SDIO_CLK_MONITOR(x) ((x) & (~BITS_SDIO_CLK_MONITOR)) -+#define BIT_GET_SDIO_CLK_MONITOR(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CLK_MONITOR) & BIT_MASK_SDIO_CLK_MONITOR) -+#define BIT_SET_SDIO_CLK_MONITOR(x, v) \ -+ (BIT_CLEAR_SDIO_CLK_MONITOR(x) | BIT_SDIO_CLK_MONITOR(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_EE_VPD (Offset 0x000C) */ -+ -+#define BIT_SHIFT_VPD_DATA 0 -+#define BIT_MASK_VPD_DATA 0xffffffffL -+#define BIT_VPD_DATA(x) (((x) & BIT_MASK_VPD_DATA) << BIT_SHIFT_VPD_DATA) -+#define BITS_VPD_DATA (BIT_MASK_VPD_DATA << BIT_SHIFT_VPD_DATA) -+#define BIT_CLEAR_VPD_DATA(x) ((x) & (~BITS_VPD_DATA)) -+#define BIT_GET_VPD_DATA(x) (((x) >> BIT_SHIFT_VPD_DATA) & BIT_MASK_VPD_DATA) -+#define BIT_SET_VPD_DATA(x, v) (BIT_CLEAR_VPD_DATA(x) | BIT_VPD_DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_MONITOR_2 (Offset 0x1025000C) */ -+ -+#define BIT_SHIFT_SDIO_CLK_CNT 0 -+#define BIT_MASK_SDIO_CLK_CNT 0x1fffff -+#define BIT_SDIO_CLK_CNT(x) \ -+ (((x) & BIT_MASK_SDIO_CLK_CNT) << BIT_SHIFT_SDIO_CLK_CNT) -+#define BITS_SDIO_CLK_CNT (BIT_MASK_SDIO_CLK_CNT << BIT_SHIFT_SDIO_CLK_CNT) -+#define BIT_CLEAR_SDIO_CLK_CNT(x) ((x) & (~BITS_SDIO_CLK_CNT)) -+#define BIT_GET_SDIO_CLK_CNT(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CLK_CNT) & BIT_MASK_SDIO_CLK_CNT) -+#define BIT_SET_SDIO_CLK_CNT(x, v) \ -+ (BIT_CLEAR_SDIO_CLK_CNT(x) | BIT_SDIO_CLK_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_EE_VPD (Offset 0x000C) */ -+ -+#define BIT_SHIFT_VDP_DATA 0 -+#define BIT_MASK_VDP_DATA 0xffffffffL -+#define BIT_VDP_DATA(x) (((x) & BIT_MASK_VDP_DATA) << BIT_SHIFT_VDP_DATA) -+#define BITS_VDP_DATA (BIT_MASK_VDP_DATA << BIT_SHIFT_VDP_DATA) -+#define BIT_CLEAR_VDP_DATA(x) ((x) & (~BITS_VDP_DATA)) -+#define BIT_GET_VDP_DATA(x) (((x) >> BIT_SHIFT_VDP_DATA) & BIT_MASK_VDP_DATA) -+#define BIT_SET_VDP_DATA(x, v) (BIT_CLEAR_VDP_DATA(x) | BIT_VDP_DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SW18_C2_BIT0 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_C2_L_BIT0 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_R1_L1_V1 30 -+#define BIT_MASK_R1_L1_V1 0x3 -+#define BIT_R1_L1_V1(x) (((x) & BIT_MASK_R1_L1_V1) << BIT_SHIFT_R1_L1_V1) -+#define BITS_R1_L1_V1 (BIT_MASK_R1_L1_V1 << BIT_SHIFT_R1_L1_V1) -+#define BIT_CLEAR_R1_L1_V1(x) ((x) & (~BITS_R1_L1_V1)) -+#define BIT_GET_R1_L1_V1(x) (((x) >> BIT_SHIFT_R1_L1_V1) & BIT_MASK_R1_L1_V1) -+#define BIT_SET_R1_L1_V1(x, v) (BIT_CLEAR_R1_L1_V1(x) | BIT_R1_L1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_SW18_C1 29 -+#define BIT_MASK_SW18_C1 0x3 -+#define BIT_SW18_C1(x) (((x) & BIT_MASK_SW18_C1) << BIT_SHIFT_SW18_C1) -+#define BITS_SW18_C1 (BIT_MASK_SW18_C1 << BIT_SHIFT_SW18_C1) -+#define BIT_CLEAR_SW18_C1(x) ((x) & (~BITS_SW18_C1)) -+#define BIT_GET_SW18_C1(x) (((x) >> BIT_SHIFT_SW18_C1) & BIT_MASK_SW18_C1) -+#define BIT_SET_SW18_C1(x, v) (BIT_CLEAR_SW18_C1(x) | BIT_SW18_C1(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_C1_L 29 -+#define BIT_MASK_C1_L 0x3 -+#define BIT_C1_L(x) (((x) & BIT_MASK_C1_L) << BIT_SHIFT_C1_L) -+#define BITS_C1_L (BIT_MASK_C1_L << BIT_SHIFT_C1_L) -+#define BIT_CLEAR_C1_L(x) ((x) & (~BITS_C1_L)) -+#define BIT_GET_C1_L(x) (((x) >> BIT_SHIFT_C1_L) & BIT_MASK_C1_L) -+#define BIT_SET_C1_L(x, v) (BIT_CLEAR_C1_L(x) | BIT_C1_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_C3_L1_V1 28 -+#define BIT_MASK_C3_L1_V1 0x3 -+#define BIT_C3_L1_V1(x) (((x) & BIT_MASK_C3_L1_V1) << BIT_SHIFT_C3_L1_V1) -+#define BITS_C3_L1_V1 (BIT_MASK_C3_L1_V1 << BIT_SHIFT_C3_L1_V1) -+#define BIT_CLEAR_C3_L1_V1(x) ((x) & (~BITS_C3_L1_V1)) -+#define BIT_GET_C3_L1_V1(x) (((x) >> BIT_SHIFT_C3_L1_V1) & BIT_MASK_C3_L1_V1) -+#define BIT_SET_C3_L1_V1(x, v) (BIT_CLEAR_C3_L1_V1(x) | BIT_C3_L1_V1(v)) -+ -+#define BIT_SHIFT_C2_L1_V1 26 -+#define BIT_MASK_C2_L1_V1 0x3 -+#define BIT_C2_L1_V1(x) (((x) & BIT_MASK_C2_L1_V1) << BIT_SHIFT_C2_L1_V1) -+#define BITS_C2_L1_V1 (BIT_MASK_C2_L1_V1 << BIT_SHIFT_C2_L1_V1) -+#define BIT_CLEAR_C2_L1_V1(x) ((x) & (~BITS_C2_L1_V1)) -+#define BIT_GET_C2_L1_V1(x) (((x) >> BIT_SHIFT_C2_L1_V1) & BIT_MASK_C2_L1_V1) -+#define BIT_SET_C2_L1_V1(x, v) (BIT_CLEAR_C2_L1_V1(x) | BIT_C2_L1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_REG_FREQ_L 25 -+#define BIT_MASK_REG_FREQ_L 0x7 -+#define BIT_REG_FREQ_L(x) (((x) & BIT_MASK_REG_FREQ_L) << BIT_SHIFT_REG_FREQ_L) -+#define BITS_REG_FREQ_L (BIT_MASK_REG_FREQ_L << BIT_SHIFT_REG_FREQ_L) -+#define BIT_CLEAR_REG_FREQ_L(x) ((x) & (~BITS_REG_FREQ_L)) -+#define BIT_GET_REG_FREQ_L(x) \ -+ (((x) >> BIT_SHIFT_REG_FREQ_L) & BIT_MASK_REG_FREQ_L) -+#define BIT_SET_REG_FREQ_L(x, v) (BIT_CLEAR_REG_FREQ_L(x) | BIT_REG_FREQ_L(v)) -+ -+#define BIT_REG_EN_DUTY BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_C1_L1_V1 24 -+#define BIT_MASK_C1_L1_V1 0x3 -+#define BIT_C1_L1_V1(x) (((x) & BIT_MASK_C1_L1_V1) << BIT_SHIFT_C1_L1_V1) -+#define BITS_C1_L1_V1 (BIT_MASK_C1_L1_V1 << BIT_SHIFT_C1_L1_V1) -+#define BIT_CLEAR_C1_L1_V1(x) ((x) & (~BITS_C1_L1_V1)) -+#define BIT_GET_C1_L1_V1(x) (((x) >> BIT_SHIFT_C1_L1_V1) & BIT_MASK_C1_L1_V1) -+#define BIT_SET_C1_L1_V1(x, v) (BIT_CLEAR_C1_L1_V1(x) | BIT_C1_L1_V1(v)) -+ -+#define BIT_REG_TYPE_L_V3 BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_REG_MODE 22 -+#define BIT_MASK_REG_MODE 0x3 -+#define BIT_REG_MODE(x) (((x) & BIT_MASK_REG_MODE) << BIT_SHIFT_REG_MODE) -+#define BITS_REG_MODE (BIT_MASK_REG_MODE << BIT_SHIFT_REG_MODE) -+#define BIT_CLEAR_REG_MODE(x) ((x) & (~BITS_REG_MODE)) -+#define BIT_GET_REG_MODE(x) (((x) >> BIT_SHIFT_REG_MODE) & BIT_MASK_REG_MODE) -+#define BIT_SET_REG_MODE(x, v) (BIT_CLEAR_REG_MODE(x) | BIT_REG_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_FPWM_L1_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_REG_EN_SP BIT(21) -+#define BIT_REG_AUTO_L BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SW18_SELD_BIT0 BIT(19) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_V15ADJ_L1 19 -+#define BIT_MASK_V15ADJ_L1 0x7 -+#define BIT_V15ADJ_L1(x) (((x) & BIT_MASK_V15ADJ_L1) << BIT_SHIFT_V15ADJ_L1) -+#define BITS_V15ADJ_L1 (BIT_MASK_V15ADJ_L1 << BIT_SHIFT_V15ADJ_L1) -+#define BIT_CLEAR_V15ADJ_L1(x) ((x) & (~BITS_V15ADJ_L1)) -+#define BIT_GET_V15ADJ_L1(x) (((x) >> BIT_SHIFT_V15ADJ_L1) & BIT_MASK_V15ADJ_L1) -+#define BIT_SET_V15ADJ_L1(x, v) (BIT_CLEAR_V15ADJ_L1(x) | BIT_V15ADJ_L1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SW18_POWOCP BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_IN_L1 16 -+#define BIT_MASK_IN_L1 0x7 -+#define BIT_IN_L1(x) (((x) & BIT_MASK_IN_L1) << BIT_SHIFT_IN_L1) -+#define BITS_IN_L1 (BIT_MASK_IN_L1 << BIT_SHIFT_IN_L1) -+#define BIT_CLEAR_IN_L1(x) ((x) & (~BITS_IN_L1)) -+#define BIT_GET_IN_L1(x) (((x) >> BIT_SHIFT_IN_L1) & BIT_MASK_IN_L1) -+#define BIT_SET_IN_L1(x, v) (BIT_CLEAR_IN_L1(x) | BIT_IN_L1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_SW18_OCP 15 -+#define BIT_MASK_SW18_OCP 0x7 -+#define BIT_SW18_OCP(x) (((x) & BIT_MASK_SW18_OCP) << BIT_SHIFT_SW18_OCP) -+#define BITS_SW18_OCP (BIT_MASK_SW18_OCP << BIT_SHIFT_SW18_OCP) -+#define BIT_CLEAR_SW18_OCP(x) ((x) & (~BITS_SW18_OCP)) -+#define BIT_GET_SW18_OCP(x) (((x) >> BIT_SHIFT_SW18_OCP) & BIT_MASK_SW18_OCP) -+#define BIT_SET_SW18_OCP(x, v) (BIT_CLEAR_SW18_OCP(x) | BIT_SW18_OCP(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_OCP_L1 15 -+#define BIT_MASK_OCP_L1 0x7 -+#define BIT_OCP_L1(x) (((x) & BIT_MASK_OCP_L1) << BIT_SHIFT_OCP_L1) -+#define BITS_OCP_L1 (BIT_MASK_OCP_L1 << BIT_SHIFT_OCP_L1) -+#define BIT_CLEAR_OCP_L1(x) ((x) & (~BITS_OCP_L1)) -+#define BIT_GET_OCP_L1(x) (((x) >> BIT_SHIFT_OCP_L1) & BIT_MASK_OCP_L1) -+#define BIT_SET_OCP_L1(x, v) (BIT_CLEAR_OCP_L1(x) | BIT_OCP_L1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_STD_L1 14 -+#define BIT_MASK_STD_L1 0x3 -+#define BIT_STD_L1(x) (((x) & BIT_MASK_STD_L1) << BIT_SHIFT_STD_L1) -+#define BITS_STD_L1 (BIT_MASK_STD_L1 << BIT_SHIFT_STD_L1) -+#define BIT_CLEAR_STD_L1(x) ((x) & (~BITS_STD_L1)) -+#define BIT_GET_STD_L1(x) (((x) >> BIT_SHIFT_STD_L1) & BIT_MASK_STD_L1) -+#define BIT_SET_STD_L1(x, v) (BIT_CLEAR_STD_L1(x) | BIT_STD_L1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_CF_L_BIT0_TO_1 13 -+#define BIT_MASK_CF_L_BIT0_TO_1 0x3 -+#define BIT_CF_L_BIT0_TO_1(x) \ -+ (((x) & BIT_MASK_CF_L_BIT0_TO_1) << BIT_SHIFT_CF_L_BIT0_TO_1) -+#define BITS_CF_L_BIT0_TO_1 \ -+ (BIT_MASK_CF_L_BIT0_TO_1 << BIT_SHIFT_CF_L_BIT0_TO_1) -+#define BIT_CLEAR_CF_L_BIT0_TO_1(x) ((x) & (~BITS_CF_L_BIT0_TO_1)) -+#define BIT_GET_CF_L_BIT0_TO_1(x) \ -+ (((x) >> BIT_SHIFT_CF_L_BIT0_TO_1) & BIT_MASK_CF_L_BIT0_TO_1) -+#define BIT_SET_CF_L_BIT0_TO_1(x, v) \ -+ (BIT_CLEAR_CF_L_BIT0_TO_1(x) | BIT_CF_L_BIT0_TO_1(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_CF_L 13 -+#define BIT_MASK_CF_L 0x3 -+#define BIT_CF_L(x) (((x) & BIT_MASK_CF_L) << BIT_SHIFT_CF_L) -+#define BITS_CF_L (BIT_MASK_CF_L << BIT_SHIFT_CF_L) -+#define BIT_CLEAR_CF_L(x) ((x) & (~BITS_CF_L)) -+#define BIT_GET_CF_L(x) (((x) >> BIT_SHIFT_CF_L) & BIT_MASK_CF_L) -+#define BIT_SET_CF_L(x, v) (BIT_CLEAR_CF_L(x) | BIT_CF_L(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SW18_FPWM BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SPS_FPWM BIT(11) -+#define BIT_WL_CTRL_SPS_PWMFREQ BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SHIFT_VOL_L1 10 -+#define BIT_MASK_VOL_L1 0xf -+#define BIT_VOL_L1(x) (((x) & BIT_MASK_VOL_L1) << BIT_SHIFT_VOL_L1) -+#define BITS_VOL_L1 (BIT_MASK_VOL_L1 << BIT_SHIFT_VOL_L1) -+#define BIT_CLEAR_VOL_L1(x) ((x) & (~BITS_VOL_L1)) -+#define BIT_GET_VOL_L1(x) (((x) >> BIT_SHIFT_VOL_L1) & BIT_MASK_VOL_L1) -+#define BIT_SET_VOL_L1(x, v) (BIT_CLEAR_VOL_L1(x) | BIT_VOL_L1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SW18_SWEN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SPS_SWEN BIT(9) -+#define BIT_HALF_L BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SW18_LDEN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_SPS_LDEN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_MAC_ID_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_WL_CTRL_XTAL_CADJ BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_LDO11_EN BIT(6) -+#define BIT_AFE_P3_PC BIT(5) -+#define BIT_AFE_P2_PC BIT(4) -+#define BIT_AFE_P1_PC BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_AFE_MBEN_PCIE_OPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_AFE_P0_PC BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_AFE_MBEN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_SDIO_CTRL_2 (Offset 0x10250010) */ -+ -+#define BIT_SDIO_CLK_SMT_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL1 (Offset 0x0010) */ -+ -+#define BIT_AFE_BGEN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_SDIO_CTRL_2 (Offset 0x10250010) */ -+ -+#define BIT_SDIO_DATA_SMT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_POW_ZCD_L BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_CRCERR_MSK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_IO_READY_SIGNAL_ERR_MSK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_ENABLE_ZCDOUT_L BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_AUTOZCD_L BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_HSISR3_IND_MSK BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_TX_CRC__MSK BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_HSISR2_IND_MSK BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_REG_DELAY 28 -+#define BIT_MASK_REG_DELAY 0x3 -+#define BIT_REG_DELAY(x) (((x) & BIT_MASK_REG_DELAY) << BIT_SHIFT_REG_DELAY) -+#define BITS_REG_DELAY (BIT_MASK_REG_DELAY << BIT_SHIFT_REG_DELAY) -+#define BIT_CLEAR_REG_DELAY(x) ((x) & (~BITS_REG_DELAY)) -+#define BIT_GET_REG_DELAY(x) (((x) >> BIT_SHIFT_REG_DELAY) & BIT_MASK_REG_DELAY) -+#define BIT_SET_REG_DELAY(x, v) (BIT_CLEAR_REG_DELAY(x) | BIT_REG_DELAY(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_HEISR_IND_MSK BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_CTWEND_MSK BIT(27) -+#define BIT_SDIO_ATIMEND_E_MSK BIT(26) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIIO_ATIMEND_MSK BIT(25) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_ATIMEND_MSK BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_SW18_V15ADJ 24 -+#define BIT_MASK_SW18_V15ADJ 0x7 -+#define BIT_SW18_V15ADJ(x) \ -+ (((x) & BIT_MASK_SW18_V15ADJ) << BIT_SHIFT_SW18_V15ADJ) -+#define BITS_SW18_V15ADJ (BIT_MASK_SW18_V15ADJ << BIT_SHIFT_SW18_V15ADJ) -+#define BIT_CLEAR_SW18_V15ADJ(x) ((x) & (~BITS_SW18_V15ADJ)) -+#define BIT_GET_SW18_V15ADJ(x) \ -+ (((x) >> BIT_SHIFT_SW18_V15ADJ) & BIT_MASK_SW18_V15ADJ) -+#define BIT_SET_SW18_V15ADJ(x, v) \ -+ (BIT_CLEAR_SW18_V15ADJ(x) | BIT_SW18_V15ADJ(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_V15ADJ_L1_V1 24 -+#define BIT_MASK_V15ADJ_L1_V1 0x7 -+#define BIT_V15ADJ_L1_V1(x) \ -+ (((x) & BIT_MASK_V15ADJ_L1_V1) << BIT_SHIFT_V15ADJ_L1_V1) -+#define BITS_V15ADJ_L1_V1 (BIT_MASK_V15ADJ_L1_V1 << BIT_SHIFT_V15ADJ_L1_V1) -+#define BIT_CLEAR_V15ADJ_L1_V1(x) ((x) & (~BITS_V15ADJ_L1_V1)) -+#define BIT_GET_V15ADJ_L1_V1(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L1_V1) & BIT_MASK_V15ADJ_L1_V1) -+#define BIT_SET_V15ADJ_L1_V1(x, v) \ -+ (BIT_CLEAR_V15ADJ_L1_V1(x) | BIT_V15ADJ_L1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_OCPINT_MSK BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_OCPSL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_PSTIMEOUT_MSK BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_REG_LDOF_L_V1 BIT(23) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_GTINT4_MSK BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_PARSW_DUMMY BIT(22) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_GTINT3_MSK BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_CLAMP_MAX_DUTY BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_SW18_VOL 20 -+#define BIT_MASK_SW18_VOL 0xf -+#define BIT_SW18_VOL(x) (((x) & BIT_MASK_SW18_VOL) << BIT_SHIFT_SW18_VOL) -+#define BITS_SW18_VOL (BIT_MASK_SW18_VOL << BIT_SHIFT_SW18_VOL) -+#define BIT_CLEAR_SW18_VOL(x) ((x) & (~BITS_SW18_VOL)) -+#define BIT_GET_SW18_VOL(x) (((x) >> BIT_SHIFT_SW18_VOL) & BIT_MASK_SW18_VOL) -+#define BIT_SET_SW18_VOL(x, v) (BIT_CLEAR_SW18_VOL(x) | BIT_SW18_VOL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_VOL_L1_V1 20 -+#define BIT_MASK_VOL_L1_V1 0xf -+#define BIT_VOL_L1_V1(x) (((x) & BIT_MASK_VOL_L1_V1) << BIT_SHIFT_VOL_L1_V1) -+#define BITS_VOL_L1_V1 (BIT_MASK_VOL_L1_V1 << BIT_SHIFT_VOL_L1_V1) -+#define BIT_CLEAR_VOL_L1_V1(x) ((x) & (~BITS_VOL_L1_V1)) -+#define BIT_GET_VOL_L1_V1(x) (((x) >> BIT_SHIFT_VOL_L1_V1) & BIT_MASK_VOL_L1_V1) -+#define BIT_SET_VOL_L1_V1(x, v) (BIT_CLEAR_VOL_L1_V1(x) | BIT_VOL_L1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_HSISR_IND_MSK BIT(20) -+#define BIT_SDIO_CPWM2_MSK BIT(19) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_TBOX_L1_V1 19 -+#define BIT_MASK_TBOX_L1_V1 0x3 -+#define BIT_TBOX_L1_V1(x) (((x) & BIT_MASK_TBOX_L1_V1) << BIT_SHIFT_TBOX_L1_V1) -+#define BITS_TBOX_L1_V1 (BIT_MASK_TBOX_L1_V1 << BIT_SHIFT_TBOX_L1_V1) -+#define BIT_CLEAR_TBOX_L1_V1(x) ((x) & (~BITS_TBOX_L1_V1)) -+#define BIT_GET_TBOX_L1_V1(x) \ -+ (((x) >> BIT_SHIFT_TBOX_L1_V1) & BIT_MASK_TBOX_L1_V1) -+#define BIT_SET_TBOX_L1_V1(x, v) (BIT_CLEAR_TBOX_L1_V1(x) | BIT_TBOX_L1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_CPWM1_MSK BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_SW18_IN 17 -+#define BIT_MASK_SW18_IN 0x7 -+#define BIT_SW18_IN(x) (((x) & BIT_MASK_SW18_IN) << BIT_SHIFT_SW18_IN) -+#define BITS_SW18_IN (BIT_MASK_SW18_IN << BIT_SHIFT_SW18_IN) -+#define BIT_CLEAR_SW18_IN(x) ((x) & (~BITS_SW18_IN)) -+#define BIT_GET_SW18_IN(x) (((x) >> BIT_SHIFT_SW18_IN) & BIT_MASK_SW18_IN) -+#define BIT_SET_SW18_IN(x, v) (BIT_CLEAR_SW18_IN(x) | BIT_SW18_IN(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_IN_L1_V1 17 -+#define BIT_MASK_IN_L1_V1 0x7 -+#define BIT_IN_L1_V1(x) (((x) & BIT_MASK_IN_L1_V1) << BIT_SHIFT_IN_L1_V1) -+#define BITS_IN_L1_V1 (BIT_MASK_IN_L1_V1 << BIT_SHIFT_IN_L1_V1) -+#define BIT_CLEAR_IN_L1_V1(x) ((x) & (~BITS_IN_L1_V1)) -+#define BIT_GET_IN_L1_V1(x) (((x) >> BIT_SHIFT_IN_L1_V1) & BIT_MASK_IN_L1_V1) -+#define BIT_SET_IN_L1_V1(x, v) (BIT_CLEAR_IN_L1_V1(x) | BIT_IN_L1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_C2HCMD_INT_MSK BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_REG_DELAY_V3 17 -+#define BIT_MASK_REG_DELAY_V3 0x3 -+#define BIT_REG_DELAY_V3(x) \ -+ (((x) & BIT_MASK_REG_DELAY_V3) << BIT_SHIFT_REG_DELAY_V3) -+#define BITS_REG_DELAY_V3 (BIT_MASK_REG_DELAY_V3 << BIT_SHIFT_REG_DELAY_V3) -+#define BIT_CLEAR_REG_DELAY_V3(x) ((x) & (~BITS_REG_DELAY_V3)) -+#define BIT_GET_REG_DELAY_V3(x) \ -+ (((x) >> BIT_SHIFT_REG_DELAY_V3) & BIT_MASK_REG_DELAY_V3) -+#define BIT_SET_REG_DELAY_V3(x, v) \ -+ (BIT_CLEAR_REG_DELAY_V3(x) | BIT_REG_DELAY_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_BCNERLY_INT_MSK BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_REG_CLAMP_D_L_V2 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_SW18_TBOX 15 -+#define BIT_MASK_SW18_TBOX 0x3 -+#define BIT_SW18_TBOX(x) (((x) & BIT_MASK_SW18_TBOX) << BIT_SHIFT_SW18_TBOX) -+#define BITS_SW18_TBOX (BIT_MASK_SW18_TBOX << BIT_SHIFT_SW18_TBOX) -+#define BIT_CLEAR_SW18_TBOX(x) ((x) & (~BITS_SW18_TBOX)) -+#define BIT_GET_SW18_TBOX(x) (((x) >> BIT_SHIFT_SW18_TBOX) & BIT_MASK_SW18_TBOX) -+#define BIT_SET_SW18_TBOX(x, v) (BIT_CLEAR_SW18_TBOX(x) | BIT_SW18_TBOX(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_REG_BYPASS_L_V3 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_TBOX_L1 15 -+#define BIT_MASK_TBOX_L1 0x3 -+#define BIT_TBOX_L1(x) (((x) & BIT_MASK_TBOX_L1) << BIT_SHIFT_TBOX_L1) -+#define BITS_TBOX_L1 (BIT_MASK_TBOX_L1 << BIT_SHIFT_TBOX_L1) -+#define BIT_CLEAR_TBOX_L1(x) ((x) & (~BITS_TBOX_L1)) -+#define BIT_GET_TBOX_L1(x) (((x) >> BIT_SHIFT_TBOX_L1) & BIT_MASK_TBOX_L1) -+#define BIT_SET_TBOX_L1(x, v) (BIT_CLEAR_TBOX_L1(x) | BIT_TBOX_L1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_ENABLE_ZCDOUT_L_V3 BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SW18_SEL BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_POW_ZCD_L_V3 BIT(13) -+#define BIT_AREN_L1_V1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_SW18_STD 11 -+#define BIT_MASK_SW18_STD 0x3 -+#define BIT_SW18_STD(x) (((x) & BIT_MASK_SW18_STD) << BIT_SHIFT_SW18_STD) -+#define BITS_SW18_STD (BIT_MASK_SW18_STD << BIT_SHIFT_SW18_STD) -+#define BIT_CLEAR_SW18_STD(x) ((x) & (~BITS_SW18_STD)) -+#define BIT_GET_SW18_STD(x) (((x) >> BIT_SHIFT_SW18_STD) & BIT_MASK_SW18_STD) -+#define BIT_SET_SW18_STD(x, v) (BIT_CLEAR_SW18_STD(x) | BIT_SW18_STD(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SW18_SD BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SW18_AREN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_OCP_V3 9 -+#define BIT_MASK_OCP_V3 0x7 -+#define BIT_OCP_V3(x) (((x) & BIT_MASK_OCP_V3) << BIT_SHIFT_OCP_V3) -+#define BITS_OCP_V3 (BIT_MASK_OCP_V3 << BIT_SHIFT_OCP_V3) -+#define BIT_CLEAR_OCP_V3(x) ((x) & (~BITS_OCP_V3)) -+#define BIT_GET_OCP_V3(x) (((x) >> BIT_SHIFT_OCP_V3) & BIT_MASK_OCP_V3) -+#define BIT_SET_OCP_V3(x, v) (BIT_CLEAR_OCP_V3(x) | BIT_OCP_V3(v)) -+ -+#define BIT_POWOCP_V3 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_BT_INT_MASK BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_SW18_R3 7 -+#define BIT_MASK_SW18_R3 0x3 -+#define BIT_SW18_R3(x) (((x) & BIT_MASK_SW18_R3) << BIT_SHIFT_SW18_R3) -+#define BITS_SW18_R3 (BIT_MASK_SW18_R3 << BIT_SHIFT_SW18_R3) -+#define BIT_CLEAR_SW18_R3(x) ((x) & (~BITS_SW18_R3)) -+#define BIT_GET_SW18_R3(x) (((x) >> BIT_SHIFT_SW18_R3) & BIT_MASK_SW18_R3) -+#define BIT_SET_SW18_R3(x, v) (BIT_CLEAR_SW18_R3(x) | BIT_SW18_R3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_TXBCNERR_MSK BIT(7) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_R3_L 7 -+#define BIT_MASK_R3_L 0x3 -+#define BIT_R3_L(x) (((x) & BIT_MASK_R3_L) << BIT_SHIFT_R3_L) -+#define BITS_R3_L (BIT_MASK_R3_L << BIT_SHIFT_R3_L) -+#define BIT_CLEAR_R3_L(x) ((x) & (~BITS_R3_L)) -+#define BIT_GET_R3_L(x) (((x) >> BIT_SHIFT_R3_L) & BIT_MASK_R3_L) -+#define BIT_SET_R3_L(x, v) (BIT_CLEAR_R3_L(x) | BIT_R3_L(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_TXBCNOK_MSK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_CF_L_V3 6 -+#define BIT_MASK_CF_L_V3 0x3 -+#define BIT_CF_L_V3(x) (((x) & BIT_MASK_CF_L_V3) << BIT_SHIFT_CF_L_V3) -+#define BITS_CF_L_V3 (BIT_MASK_CF_L_V3 << BIT_SHIFT_CF_L_V3) -+#define BIT_CLEAR_CF_L_V3(x) ((x) & (~BITS_CF_L_V3)) -+#define BIT_GET_CF_L_V3(x) (((x) >> BIT_SHIFT_CF_L_V3) & BIT_MASK_CF_L_V3) -+#define BIT_SET_CF_L_V3(x, v) (BIT_CLEAR_CF_L_V3(x) | BIT_CF_L_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_SW18_R2 5 -+#define BIT_MASK_SW18_R2 0x3 -+#define BIT_SW18_R2(x) (((x) & BIT_MASK_SW18_R2) << BIT_SHIFT_SW18_R2) -+#define BITS_SW18_R2 (BIT_MASK_SW18_R2 << BIT_SHIFT_SW18_R2) -+#define BIT_CLEAR_SW18_R2(x) ((x) & (~BITS_SW18_R2)) -+#define BIT_GET_SW18_R2(x) (((x) >> BIT_SHIFT_SW18_R2) & BIT_MASK_SW18_R2) -+#define BIT_SET_SW18_R2(x, v) (BIT_CLEAR_SW18_R2(x) | BIT_SW18_R2(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_RXFOVW_MSK BIT(5) -+#define BIT_SDIO_TXFOVW_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_CFC_L_BIT0_TO_1_V1 4 -+#define BIT_MASK_CFC_L_BIT0_TO_1_V1 0x3 -+#define BIT_CFC_L_BIT0_TO_1_V1(x) \ -+ (((x) & BIT_MASK_CFC_L_BIT0_TO_1_V1) << BIT_SHIFT_CFC_L_BIT0_TO_1_V1) -+#define BITS_CFC_L_BIT0_TO_1_V1 \ -+ (BIT_MASK_CFC_L_BIT0_TO_1_V1 << BIT_SHIFT_CFC_L_BIT0_TO_1_V1) -+#define BIT_CLEAR_CFC_L_BIT0_TO_1_V1(x) ((x) & (~BITS_CFC_L_BIT0_TO_1_V1)) -+#define BIT_GET_CFC_L_BIT0_TO_1_V1(x) \ -+ (((x) >> BIT_SHIFT_CFC_L_BIT0_TO_1_V1) & BIT_MASK_CFC_L_BIT0_TO_1_V1) -+#define BIT_SET_CFC_L_BIT0_TO_1_V1(x, v) \ -+ (BIT_CLEAR_CFC_L_BIT0_TO_1_V1(x) | BIT_CFC_L_BIT0_TO_1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_SW18_R1 3 -+#define BIT_MASK_SW18_R1 0x3 -+#define BIT_SW18_R1(x) (((x) & BIT_MASK_SW18_R1) << BIT_SHIFT_SW18_R1) -+#define BITS_SW18_R1 (BIT_MASK_SW18_R1 << BIT_SHIFT_SW18_R1) -+#define BIT_CLEAR_SW18_R1(x) ((x) & (~BITS_SW18_R1)) -+#define BIT_GET_SW18_R1(x) (((x) >> BIT_SHIFT_SW18_R1) & BIT_MASK_SW18_R1) -+#define BIT_SET_SW18_R1(x, v) (BIT_CLEAR_SW18_R1(x) | BIT_SW18_R1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_RXERR_MSK BIT(3) -+#define BIT_SDIO_TXERR_MSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_R3_L1_V1 2 -+#define BIT_MASK_R3_L1_V1 0x3 -+#define BIT_R3_L1_V1(x) (((x) & BIT_MASK_R3_L1_V1) << BIT_SHIFT_R3_L1_V1) -+#define BITS_R3_L1_V1 (BIT_MASK_R3_L1_V1 << BIT_SHIFT_R3_L1_V1) -+#define BIT_CLEAR_R3_L1_V1(x) ((x) & (~BITS_R3_L1_V1)) -+#define BIT_GET_R3_L1_V1(x) (((x) >> BIT_SHIFT_R3_L1_V1) & BIT_MASK_R3_L1_V1) -+#define BIT_SET_R3_L1_V1(x, v) (BIT_CLEAR_R3_L1_V1(x) | BIT_R3_L1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_SW18_C3 1 -+#define BIT_MASK_SW18_C3 0x3 -+#define BIT_SW18_C3(x) (((x) & BIT_MASK_SW18_C3) << BIT_SHIFT_SW18_C3) -+#define BITS_SW18_C3 (BIT_MASK_SW18_C3 << BIT_SHIFT_SW18_C3) -+#define BIT_CLEAR_SW18_C3(x) ((x) & (~BITS_SW18_C3)) -+#define BIT_GET_SW18_C3(x) (((x) >> BIT_SHIFT_SW18_C3) & BIT_MASK_SW18_C3) -+#define BIT_SET_SW18_C3(x, v) (BIT_CLEAR_SW18_C3(x) | BIT_SW18_C3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_SDIO_AVAL_MSK BIT(1) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_C3_L_C3 1 -+#define BIT_MASK_C3_L_C3 0x3 -+#define BIT_C3_L_C3(x) (((x) & BIT_MASK_C3_L_C3) << BIT_SHIFT_C3_L_C3) -+#define BITS_C3_L_C3 (BIT_MASK_C3_L_C3 << BIT_SHIFT_C3_L_C3) -+#define BIT_CLEAR_C3_L_C3(x) ((x) & (~BITS_C3_L_C3)) -+#define BIT_GET_C3_L_C3(x) (((x) >> BIT_SHIFT_C3_L_C3) & BIT_MASK_C3_L_C3) -+#define BIT_SET_C3_L_C3(x, v) (BIT_CLEAR_C3_L_C3(x) | BIT_C3_L_C3(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SW18_C2_BIT1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HIMR (Offset 0x10250014) */ -+ -+#define BIT_RX_REQUEST_MSK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_SHIFT_R2_L1_V1 0 -+#define BIT_MASK_R2_L1_V1 0x3 -+#define BIT_R2_L1_V1(x) (((x) & BIT_MASK_R2_L1_V1) << BIT_SHIFT_R2_L1_V1) -+#define BITS_R2_L1_V1 (BIT_MASK_R2_L1_V1 << BIT_SHIFT_R2_L1_V1) -+#define BIT_CLEAR_R2_L1_V1(x) ((x) & (~BITS_R2_L1_V1)) -+#define BIT_GET_R2_L1_V1(x) (((x) >> BIT_SHIFT_R2_L1_V1) & BIT_MASK_R2_L1_V1) -+#define BIT_SET_R2_L1_V1(x, v) (BIT_CLEAR_R2_L1_V1(x) | BIT_R2_L1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL2 (Offset 0x0014) */ -+ -+#define BIT_C2_L_BIT1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL3 (Offset 0x0018) */ -+ -+#define BIT_SPS18_OCP_DIS BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HISR (Offset 0x10250018) */ -+ -+#define BIT_SDIO_CRCERR BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SDIO_HISR (Offset 0x10250018) */ -+ -+#define BIT_IO_READY_SIGNAL_ERR BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HISR (Offset 0x10250018) */ -+ -+#define BIT_SDIO_HSISR3_IND BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SDIO_HISR (Offset 0x10250018) */ -+ -+#define BIT_TX_CRC BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HISR (Offset 0x10250018) */ -+ -+#define BIT_SDIO_HSISR2_IND BIT(29) -+#define BIT_SDIO_HEISR_IND BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HISR (Offset 0x10250018) */ -+ -+#define BIT_SDIO_CTWEND BIT(27) -+#define BIT_SDIO_ATIMEND_E BIT(26) -+#define BIT_SDIO_ATIMEND BIT(25) -+#define BIT_SDIO_OCPINT BIT(24) -+#define BIT_SDIO_PSTIMEOUT BIT(23) -+#define BIT_SDIO_GTINT4 BIT(22) -+#define BIT_SDIO_GTINT3 BIT(21) -+#define BIT_SDIO_HSISR_IND BIT(20) -+#define BIT_SDIO_CPWM2 BIT(19) -+#define BIT_SDIO_CPWM1 BIT(18) -+#define BIT_SDIO_C2HCMD_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL3 (Offset 0x0018) */ -+ -+#define BIT_SHIFT_SPS18_OCP_TH 16 -+#define BIT_MASK_SPS18_OCP_TH 0x7fff -+#define BIT_SPS18_OCP_TH(x) \ -+ (((x) & BIT_MASK_SPS18_OCP_TH) << BIT_SHIFT_SPS18_OCP_TH) -+#define BITS_SPS18_OCP_TH (BIT_MASK_SPS18_OCP_TH << BIT_SHIFT_SPS18_OCP_TH) -+#define BIT_CLEAR_SPS18_OCP_TH(x) ((x) & (~BITS_SPS18_OCP_TH)) -+#define BIT_GET_SPS18_OCP_TH(x) \ -+ (((x) >> BIT_SHIFT_SPS18_OCP_TH) & BIT_MASK_SPS18_OCP_TH) -+#define BIT_SET_SPS18_OCP_TH(x, v) \ -+ (BIT_CLEAR_SPS18_OCP_TH(x) | BIT_SPS18_OCP_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HISR (Offset 0x10250018) */ -+ -+#define BIT_SDIO_BCNERLY_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HISR (Offset 0x10250018) */ -+ -+#define BIT_BT_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HISR (Offset 0x10250018) */ -+ -+#define BIT_SDIO_TXBCNERR BIT(7) -+#define BIT_SDIO_TXBCNOK BIT(6) -+#define BIT_SDIO_RXFOVW BIT(5) -+#define BIT_SDIO_TXFOVW BIT(4) -+#define BIT_SDIO_RXERR BIT(3) -+#define BIT_SDIO_TXERR BIT(2) -+#define BIT_SDIO_AVAL BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SWR_CTRL3 (Offset 0x0018) */ -+ -+#define BIT_SHIFT_OCP_WINDOW 0 -+#define BIT_MASK_OCP_WINDOW 0xffff -+#define BIT_OCP_WINDOW(x) (((x) & BIT_MASK_OCP_WINDOW) << BIT_SHIFT_OCP_WINDOW) -+#define BITS_OCP_WINDOW (BIT_MASK_OCP_WINDOW << BIT_SHIFT_OCP_WINDOW) -+#define BIT_CLEAR_OCP_WINDOW(x) ((x) & (~BITS_OCP_WINDOW)) -+#define BIT_GET_OCP_WINDOW(x) \ -+ (((x) >> BIT_SHIFT_OCP_WINDOW) & BIT_MASK_OCP_WINDOW) -+#define BIT_SET_OCP_WINDOW(x, v) (BIT_CLEAR_OCP_WINDOW(x) | BIT_OCP_WINDOW(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HISR (Offset 0x10250018) */ -+ -+#define BIT_RX_REQUEST BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_HREG_DBG BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_SHIFT_HREG_DBG_V1 12 -+#define BIT_MASK_HREG_DBG_V1 0xfff -+#define BIT_HREG_DBG_V1(x) \ -+ (((x) & BIT_MASK_HREG_DBG_V1) << BIT_SHIFT_HREG_DBG_V1) -+#define BITS_HREG_DBG_V1 (BIT_MASK_HREG_DBG_V1 << BIT_SHIFT_HREG_DBG_V1) -+#define BIT_CLEAR_HREG_DBG_V1(x) ((x) & (~BITS_HREG_DBG_V1)) -+#define BIT_GET_HREG_DBG_V1(x) \ -+ (((x) >> BIT_SHIFT_HREG_DBG_V1) & BIT_MASK_HREG_DBG_V1) -+#define BIT_SET_HREG_DBG_V1(x, v) \ -+ (BIT_CLEAR_HREG_DBG_V1(x) | BIT_HREG_DBG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_MCU_RST BIT(11) -+#define BIT_WLOCK_90 BIT(10) -+#define BIT_WLOCK_70 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_WLMCUIOIF BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_WLOCK_78 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_LOCK_ALL_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_R_DIS_PRST BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_R_DIS_PRST_1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_WLOCK_1C_B6 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_R_DIS_PRST_0 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RSV_CTRL (Offset 0x001C) */ -+ -+#define BIT_WLOCK_40 BIT(4) -+#define BIT_WLOCK_08 BIT(3) -+#define BIT_WLOCK_04 BIT(2) -+#define BIT_WLOCK_00 BIT(1) -+#define BIT_WLOCK_ALL BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_RX_REQ_LEN (Offset 0x1025001C) */ -+ -+#define BIT_SHIFT_RX_REQ_LEN_V1 0 -+#define BIT_MASK_RX_REQ_LEN_V1 0x3ffff -+#define BIT_RX_REQ_LEN_V1(x) \ -+ (((x) & BIT_MASK_RX_REQ_LEN_V1) << BIT_SHIFT_RX_REQ_LEN_V1) -+#define BITS_RX_REQ_LEN_V1 (BIT_MASK_RX_REQ_LEN_V1 << BIT_SHIFT_RX_REQ_LEN_V1) -+#define BIT_CLEAR_RX_REQ_LEN_V1(x) ((x) & (~BITS_RX_REQ_LEN_V1)) -+#define BIT_GET_RX_REQ_LEN_V1(x) \ -+ (((x) >> BIT_SHIFT_RX_REQ_LEN_V1) & BIT_MASK_RX_REQ_LEN_V1) -+#define BIT_SET_RX_REQ_LEN_V1(x, v) \ -+ (BIT_CLEAR_RX_REQ_LEN_V1(x) | BIT_RX_REQ_LEN_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RF_CTRL (Offset 0x001F) */ -+ -+#define BIT_S0_RFC_WO_0 BIT(7) -+#define BIT_S0_RFC_WT_0 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RF_CTRL (Offset 0x001F) */ -+ -+#define BIT_RF_SDMRSTB BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RF0_CTRL (Offset 0x001F) */ -+ -+#define BIT_RF0_SDMRSTB BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RF_CTRL (Offset 0x001F) */ -+ -+#define BIT_RF_RSTB BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RF0_CTRL (Offset 0x001F) */ -+ -+#define BIT_RF0_RSTB BIT(1) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RF_CTRL (Offset 0x001F) */ -+ -+#define BIT_S0_RFC_RSTB BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RF_CTRL (Offset 0x001F) */ -+ -+#define BIT_RF_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RF0_CTRL (Offset 0x001F) */ -+ -+#define BIT_RF0_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_FREE_TXPG_SEQ_V1 (Offset 0x1025001F) */ -+ -+#define BIT_SHIFT_FREE_TXPG_SEQ 0 -+#define BIT_MASK_FREE_TXPG_SEQ 0xff -+#define BIT_FREE_TXPG_SEQ(x) \ -+ (((x) & BIT_MASK_FREE_TXPG_SEQ) << BIT_SHIFT_FREE_TXPG_SEQ) -+#define BITS_FREE_TXPG_SEQ (BIT_MASK_FREE_TXPG_SEQ << BIT_SHIFT_FREE_TXPG_SEQ) -+#define BIT_CLEAR_FREE_TXPG_SEQ(x) ((x) & (~BITS_FREE_TXPG_SEQ)) -+#define BIT_GET_FREE_TXPG_SEQ(x) \ -+ (((x) >> BIT_SHIFT_FREE_TXPG_SEQ) & BIT_MASK_FREE_TXPG_SEQ) -+#define BIT_SET_FREE_TXPG_SEQ(x, v) \ -+ (BIT_CLEAR_FREE_TXPG_SEQ(x) | BIT_FREE_TXPG_SEQ(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLPON_EMEM1_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_LPLDH12_RSV1 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLPON_EMEM0_EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_LPLDH12_RSV0 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_SHIFT_LPLDH12_RSV 29 -+#define BIT_MASK_LPLDH12_RSV 0x7 -+#define BIT_LPLDH12_RSV(x) \ -+ (((x) & BIT_MASK_LPLDH12_RSV) << BIT_SHIFT_LPLDH12_RSV) -+#define BITS_LPLDH12_RSV (BIT_MASK_LPLDH12_RSV << BIT_SHIFT_LPLDH12_RSV) -+#define BIT_CLEAR_LPLDH12_RSV(x) ((x) & (~BITS_LPLDH12_RSV)) -+#define BIT_GET_LPLDH12_RSV(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_RSV) & BIT_MASK_LPLDH12_RSV) -+#define BIT_SET_LPLDH12_RSV(x, v) \ -+ (BIT_CLEAR_LPLDH12_RSV(x) | BIT_LPLDH12_RSV(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_LPLDH12_SLP BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLPOFF_P4EN BIT(28) -+#define BIT_R_SYM_WLPOFF_P3EN BIT(27) -+#define BIT_R_SYM_WLPOFF_P2EN BIT(26) -+#define BIT_R_SYM_WLPOFF_P1EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_SHIFT_LPLDH12_VADJ 24 -+#define BIT_MASK_LPLDH12_VADJ 0xf -+#define BIT_LPLDH12_VADJ(x) \ -+ (((x) & BIT_MASK_LPLDH12_VADJ) << BIT_SHIFT_LPLDH12_VADJ) -+#define BITS_LPLDH12_VADJ (BIT_MASK_LPLDH12_VADJ << BIT_SHIFT_LPLDH12_VADJ) -+#define BIT_CLEAR_LPLDH12_VADJ(x) ((x) & (~BITS_LPLDH12_VADJ)) -+#define BIT_GET_LPLDH12_VADJ(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_VADJ) & BIT_MASK_LPLDH12_VADJ) -+#define BIT_SET_LPLDH12_VADJ(x, v) \ -+ (BIT_CLEAR_LPLDH12_VADJ(x) | BIT_LPLDH12_VADJ(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLPOFF_EN BIT(24) -+#define BIT_R_SYM_WLPON_P3EN BIT(21) -+#define BIT_R_SYM_WLPON_P2EN BIT(20) -+#define BIT_R_SYM_WLPON_P1EN BIT(19) -+#define BIT_R_SYM_WLPON_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_PCIE_CALIB_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_LDH12_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_FREE_TXPG (Offset 0x10250020) */ -+ -+#define BIT_SHIFT_MID_FREEPG_V1 16 -+#define BIT_MASK_MID_FREEPG_V1 0xfff -+#define BIT_MID_FREEPG_V1(x) \ -+ (((x) & BIT_MASK_MID_FREEPG_V1) << BIT_SHIFT_MID_FREEPG_V1) -+#define BITS_MID_FREEPG_V1 (BIT_MASK_MID_FREEPG_V1 << BIT_SHIFT_MID_FREEPG_V1) -+#define BIT_CLEAR_MID_FREEPG_V1(x) ((x) & (~BITS_MID_FREEPG_V1)) -+#define BIT_GET_MID_FREEPG_V1(x) \ -+ (((x) >> BIT_SHIFT_MID_FREEPG_V1) & BIT_MASK_MID_FREEPG_V1) -+#define BIT_SET_MID_FREEPG_V1(x, v) \ -+ (BIT_CLEAR_MID_FREEPG_V1(x) | BIT_MID_FREEPG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_LDOV12D_STBY BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_BB_POWER_CUT_CTRL_BY_BB BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_WLBBOFF_BIG_PWC_EN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_SHIFT_XTAL_GM_REP_V8 13 -+#define BIT_MASK_XTAL_GM_REP_V8 0x3 -+#define BIT_XTAL_GM_REP_V8(x) \ -+ (((x) & BIT_MASK_XTAL_GM_REP_V8) << BIT_SHIFT_XTAL_GM_REP_V8) -+#define BITS_XTAL_GM_REP_V8 \ -+ (BIT_MASK_XTAL_GM_REP_V8 << BIT_SHIFT_XTAL_GM_REP_V8) -+#define BIT_CLEAR_XTAL_GM_REP_V8(x) ((x) & (~BITS_XTAL_GM_REP_V8)) -+#define BIT_GET_XTAL_GM_REP_V8(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GM_REP_V8) & BIT_MASK_XTAL_GM_REP_V8) -+#define BIT_SET_XTAL_GM_REP_V8(x, v) \ -+ (BIT_CLEAR_XTAL_GM_REP_V8(x) | BIT_XTAL_GM_REP_V8(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_WLBBOFF_SMALL_PWC_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_POW_REGU_P3 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_WLMACOFF_BIG_PWC_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_POW_REGU_P2 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_WLPON_PWC_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_POW_REGU_P1 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_MEM_DS_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLBBOFF1_P4_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_LDOV12W_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLBBOFF1_P3_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_SHIFT_ANAPAR_RFC2 8 -+#define BIT_MASK_ANAPAR_RFC2 0xff -+#define BIT_ANAPAR_RFC2(x) \ -+ (((x) & BIT_MASK_ANAPAR_RFC2) << BIT_SHIFT_ANAPAR_RFC2) -+#define BITS_ANAPAR_RFC2 (BIT_MASK_ANAPAR_RFC2 << BIT_SHIFT_ANAPAR_RFC2) -+#define BIT_CLEAR_ANAPAR_RFC2(x) ((x) & (~BITS_ANAPAR_RFC2)) -+#define BIT_GET_ANAPAR_RFC2(x) \ -+ (((x) >> BIT_SHIFT_ANAPAR_RFC2) & BIT_MASK_ANAPAR_RFC2) -+#define BIT_SET_ANAPAR_RFC2(x, v) \ -+ (BIT_CLEAR_ANAPAR_RFC2(x) | BIT_ANAPAR_RFC2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_EX_XTAL_DRV_DIGI BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLBBOFF1_P2_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_EX_XTAL_DRV_USB BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLBBOFF1_P1_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_EX_XTAL_DRV_AFE BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_SHIFT_LDA12_VOADJ 4 -+#define BIT_MASK_LDA12_VOADJ 0xf -+#define BIT_LDA12_VOADJ(x) \ -+ (((x) & BIT_MASK_LDA12_VOADJ) << BIT_SHIFT_LDA12_VOADJ) -+#define BITS_LDA12_VOADJ (BIT_MASK_LDA12_VOADJ << BIT_SHIFT_LDA12_VOADJ) -+#define BIT_CLEAR_LDA12_VOADJ(x) ((x) & (~BITS_LDA12_VOADJ)) -+#define BIT_GET_LDA12_VOADJ(x) \ -+ (((x) >> BIT_SHIFT_LDA12_VOADJ) & BIT_MASK_LDA12_VOADJ) -+#define BIT_SET_LDA12_VOADJ(x, v) \ -+ (BIT_CLEAR_LDA12_VOADJ(x) | BIT_LDA12_VOADJ(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_EX_XTAL_DRV_RF2 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLBBOFF_P4_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_REG_VOS BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_EX_XTAL_DRV_RF1 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLBBOFF_P3_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_POW_REGU_P0 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLBBOFF_P2_EN BIT(2) -+#define BIT_R_SYM_WLBBOFF_P1_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_LDA12_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_POW_PLL_LDO BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_FREE_TXPG (Offset 0x10250020) */ -+ -+#define BIT_SHIFT_HIQ_FREEPG_V1 0 -+#define BIT_MASK_HIQ_FREEPG_V1 0xfff -+#define BIT_HIQ_FREEPG_V1(x) \ -+ (((x) & BIT_MASK_HIQ_FREEPG_V1) << BIT_SHIFT_HIQ_FREEPG_V1) -+#define BITS_HIQ_FREEPG_V1 (BIT_MASK_HIQ_FREEPG_V1 << BIT_SHIFT_HIQ_FREEPG_V1) -+#define BIT_CLEAR_HIQ_FREEPG_V1(x) ((x) & (~BITS_HIQ_FREEPG_V1)) -+#define BIT_GET_HIQ_FREEPG_V1(x) \ -+ (((x) >> BIT_SHIFT_HIQ_FREEPG_V1) & BIT_MASK_HIQ_FREEPG_V1) -+#define BIT_SET_HIQ_FREEPG_V1(x, v) \ -+ (BIT_CLEAR_HIQ_FREEPG_V1(x) | BIT_HIQ_FREEPG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_R_SYM_WLBBOFF_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_LDO_CTRL (Offset 0x0020) */ -+ -+#define BIT_SHIFT_ANAPAR_RFC1 0 -+#define BIT_MASK_ANAPAR_RFC1 0xff -+#define BIT_ANAPAR_RFC1(x) \ -+ (((x) & BIT_MASK_ANAPAR_RFC1) << BIT_SHIFT_ANAPAR_RFC1) -+#define BITS_ANAPAR_RFC1 (BIT_MASK_ANAPAR_RFC1 << BIT_SHIFT_ANAPAR_RFC1) -+#define BIT_CLEAR_ANAPAR_RFC1(x) ((x) & (~BITS_ANAPAR_RFC1)) -+#define BIT_GET_ANAPAR_RFC1(x) \ -+ (((x) >> BIT_SHIFT_ANAPAR_RFC1) & BIT_MASK_ANAPAR_RFC1) -+#define BIT_SET_ANAPAR_RFC1(x, v) \ -+ (BIT_CLEAR_ANAPAR_RFC1(x) | BIT_ANAPAR_RFC1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_AGPIO_GPE BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XQSEL_V3 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_REG_CC 30 -+#define BIT_MASK_REG_CC 0x3 -+#define BIT_REG_CC(x) (((x) & BIT_MASK_REG_CC) << BIT_SHIFT_REG_CC) -+#define BITS_REG_CC (BIT_MASK_REG_CC << BIT_SHIFT_REG_CC) -+#define BIT_CLEAR_REG_CC(x) ((x) & (~BITS_REG_CC)) -+#define BIT_GET_REG_CC(x) (((x) >> BIT_SHIFT_REG_CC) & BIT_MASK_REG_CC) -+#define BIT_SET_REG_CC(x, v) (BIT_CLEAR_REG_CC(x) | BIT_REG_CC(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_CKDELAY_AFE_V1 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_CKDLY_DIG BIT(28) -+#define BIT_CKDLY_USB BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_GPIO_V1 27 -+#define BIT_MASK_XTAL_GPIO_V1 0x7 -+#define BIT_XTAL_GPIO_V1(x) \ -+ (((x) & BIT_MASK_XTAL_GPIO_V1) << BIT_SHIFT_XTAL_GPIO_V1) -+#define BITS_XTAL_GPIO_V1 (BIT_MASK_XTAL_GPIO_V1 << BIT_SHIFT_XTAL_GPIO_V1) -+#define BIT_CLEAR_XTAL_GPIO_V1(x) ((x) & (~BITS_XTAL_GPIO_V1)) -+#define BIT_GET_XTAL_GPIO_V1(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GPIO_V1) & BIT_MASK_XTAL_GPIO_V1) -+#define BIT_SET_XTAL_GPIO_V1(x, v) \ -+ (BIT_CLEAR_XTAL_GPIO_V1(x) | BIT_XTAL_GPIO_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_CKDLY_AFE BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_CAP_XI 25 -+#define BIT_MASK_XTAL_CAP_XI 0x3f -+#define BIT_XTAL_CAP_XI(x) \ -+ (((x) & BIT_MASK_XTAL_CAP_XI) << BIT_SHIFT_XTAL_CAP_XI) -+#define BITS_XTAL_CAP_XI (BIT_MASK_XTAL_CAP_XI << BIT_SHIFT_XTAL_CAP_XI) -+#define BIT_CLEAR_XTAL_CAP_XI(x) ((x) & (~BITS_XTAL_CAP_XI)) -+#define BIT_GET_XTAL_CAP_XI(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CAP_XI) & BIT_MASK_XTAL_CAP_XI) -+#define BIT_SET_XTAL_CAP_XI(x, v) \ -+ (BIT_CLEAR_XTAL_CAP_XI(x) | BIT_XTAL_CAP_XI(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_DIG_DRV_1_TO_0 25 -+#define BIT_MASK_XTAL_DIG_DRV_1_TO_0 0x3 -+#define BIT_XTAL_DIG_DRV_1_TO_0(x) \ -+ (((x) & BIT_MASK_XTAL_DIG_DRV_1_TO_0) << BIT_SHIFT_XTAL_DIG_DRV_1_TO_0) -+#define BITS_XTAL_DIG_DRV_1_TO_0 \ -+ (BIT_MASK_XTAL_DIG_DRV_1_TO_0 << BIT_SHIFT_XTAL_DIG_DRV_1_TO_0) -+#define BIT_CLEAR_XTAL_DIG_DRV_1_TO_0(x) ((x) & (~BITS_XTAL_DIG_DRV_1_TO_0)) -+#define BIT_GET_XTAL_DIG_DRV_1_TO_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DIG_DRV_1_TO_0) & BIT_MASK_XTAL_DIG_DRV_1_TO_0) -+#define BIT_SET_XTAL_DIG_DRV_1_TO_0(x, v) \ -+ (BIT_CLEAR_XTAL_DIG_DRV_1_TO_0(x) | BIT_XTAL_DIG_DRV_1_TO_0(v)) -+ -+#define BIT_XTAL_GDIG BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_GPIO 23 -+#define BIT_MASK_XTAL_GPIO 0x7 -+#define BIT_XTAL_GPIO(x) (((x) & BIT_MASK_XTAL_GPIO) << BIT_SHIFT_XTAL_GPIO) -+#define BITS_XTAL_GPIO (BIT_MASK_XTAL_GPIO << BIT_SHIFT_XTAL_GPIO) -+#define BIT_CLEAR_XTAL_GPIO(x) ((x) & (~BITS_XTAL_GPIO)) -+#define BIT_GET_XTAL_GPIO(x) (((x) >> BIT_SHIFT_XTAL_GPIO) & BIT_MASK_XTAL_GPIO) -+#define BIT_SET_XTAL_GPIO(x, v) (BIT_CLEAR_XTAL_GPIO(x) | BIT_XTAL_GPIO(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_DRV_DIGI 23 -+#define BIT_MASK_XTAL_DRV_DIGI 0x3 -+#define BIT_XTAL_DRV_DIGI(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_DIGI) << BIT_SHIFT_XTAL_DRV_DIGI) -+#define BITS_XTAL_DRV_DIGI (BIT_MASK_XTAL_DRV_DIGI << BIT_SHIFT_XTAL_DRV_DIGI) -+#define BIT_CLEAR_XTAL_DRV_DIGI(x) ((x) & (~BITS_XTAL_DRV_DIGI)) -+#define BIT_GET_XTAL_DRV_DIGI(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_DIGI) & BIT_MASK_XTAL_DRV_DIGI) -+#define BIT_SET_XTAL_DRV_DIGI(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_DIGI(x) | BIT_XTAL_DRV_DIGI(v)) -+ -+#define BIT_XTAL_DRV_USB_BIT1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_DRV_RF_LATCH_V2 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_RDRV_RF2_1_TO_0 22 -+#define BIT_MASK_XTAL_RDRV_RF2_1_TO_0 0x3 -+#define BIT_XTAL_RDRV_RF2_1_TO_0(x) \ -+ (((x) & BIT_MASK_XTAL_RDRV_RF2_1_TO_0) \ -+ << BIT_SHIFT_XTAL_RDRV_RF2_1_TO_0) -+#define BITS_XTAL_RDRV_RF2_1_TO_0 \ -+ (BIT_MASK_XTAL_RDRV_RF2_1_TO_0 << BIT_SHIFT_XTAL_RDRV_RF2_1_TO_0) -+#define BIT_CLEAR_XTAL_RDRV_RF2_1_TO_0(x) ((x) & (~BITS_XTAL_RDRV_RF2_1_TO_0)) -+#define BIT_GET_XTAL_RDRV_RF2_1_TO_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_RDRV_RF2_1_TO_0) & \ -+ BIT_MASK_XTAL_RDRV_RF2_1_TO_0) -+#define BIT_SET_XTAL_RDRV_RF2_1_TO_0(x, v) \ -+ (BIT_CLEAR_XTAL_RDRV_RF2_1_TO_0(x) | BIT_XTAL_RDRV_RF2_1_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_GMN_4 BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_MAC_CLK_SEL 20 -+#define BIT_MASK_MAC_CLK_SEL 0x3 -+#define BIT_MAC_CLK_SEL(x) \ -+ (((x) & BIT_MASK_MAC_CLK_SEL) << BIT_SHIFT_MAC_CLK_SEL) -+#define BITS_MAC_CLK_SEL (BIT_MASK_MAC_CLK_SEL << BIT_SHIFT_MAC_CLK_SEL) -+#define BIT_CLEAR_MAC_CLK_SEL(x) ((x) & (~BITS_MAC_CLK_SEL)) -+#define BIT_GET_MAC_CLK_SEL(x) \ -+ (((x) >> BIT_SHIFT_MAC_CLK_SEL) & BIT_MASK_MAC_CLK_SEL) -+#define BIT_SET_MAC_CLK_SEL(x, v) \ -+ (BIT_CLEAR_MAC_CLK_SEL(x) | BIT_MAC_CLK_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_DRV_USB_BIT0 BIT(19) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_RDRV_1_TO_0 19 -+#define BIT_MASK_XTAL_RDRV_1_TO_0 0x3 -+#define BIT_XTAL_RDRV_1_TO_0(x) \ -+ (((x) & BIT_MASK_XTAL_RDRV_1_TO_0) << BIT_SHIFT_XTAL_RDRV_1_TO_0) -+#define BITS_XTAL_RDRV_1_TO_0 \ -+ (BIT_MASK_XTAL_RDRV_1_TO_0 << BIT_SHIFT_XTAL_RDRV_1_TO_0) -+#define BIT_CLEAR_XTAL_RDRV_1_TO_0(x) ((x) & (~BITS_XTAL_RDRV_1_TO_0)) -+#define BIT_GET_XTAL_RDRV_1_TO_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_RDRV_1_TO_0) & BIT_MASK_XTAL_RDRV_1_TO_0) -+#define BIT_SET_XTAL_RDRV_1_TO_0(x, v) \ -+ (BIT_CLEAR_XTAL_RDRV_1_TO_0(x) | BIT_XTAL_RDRV_1_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_DIG_DRV 18 -+#define BIT_MASK_XTAL_DIG_DRV 0x3 -+#define BIT_XTAL_DIG_DRV(x) \ -+ (((x) & BIT_MASK_XTAL_DIG_DRV) << BIT_SHIFT_XTAL_DIG_DRV) -+#define BITS_XTAL_DIG_DRV (BIT_MASK_XTAL_DIG_DRV << BIT_SHIFT_XTAL_DIG_DRV) -+#define BIT_CLEAR_XTAL_DIG_DRV(x) ((x) & (~BITS_XTAL_DIG_DRV)) -+#define BIT_GET_XTAL_DIG_DRV(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DIG_DRV) & BIT_MASK_XTAL_DIG_DRV) -+#define BIT_SET_XTAL_DIG_DRV(x, v) \ -+ (BIT_CLEAR_XTAL_DIG_DRV(x) | BIT_XTAL_DIG_DRV(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_GMP_4 BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_GATE_DIG BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_DRV_AFE 17 -+#define BIT_MASK_XTAL_DRV_AFE 0x3 -+#define BIT_XTAL_DRV_AFE(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_AFE) << BIT_SHIFT_XTAL_DRV_AFE) -+#define BITS_XTAL_DRV_AFE (BIT_MASK_XTAL_DRV_AFE << BIT_SHIFT_XTAL_DRV_AFE) -+#define BIT_CLEAR_XTAL_DRV_AFE(x) ((x) & (~BITS_XTAL_DRV_AFE)) -+#define BIT_GET_XTAL_DRV_AFE(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_AFE) & BIT_MASK_XTAL_DRV_AFE) -+#define BIT_SET_XTAL_DRV_AFE(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_AFE(x) | BIT_XTAL_DRV_AFE(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_FREE_TXPG2 (Offset 0x10250024) */ -+ -+#define BIT_SHIFT_PUB_FREEPG_V1 16 -+#define BIT_MASK_PUB_FREEPG_V1 0xfff -+#define BIT_PUB_FREEPG_V1(x) \ -+ (((x) & BIT_MASK_PUB_FREEPG_V1) << BIT_SHIFT_PUB_FREEPG_V1) -+#define BITS_PUB_FREEPG_V1 (BIT_MASK_PUB_FREEPG_V1 << BIT_SHIFT_PUB_FREEPG_V1) -+#define BIT_CLEAR_PUB_FREEPG_V1(x) ((x) & (~BITS_PUB_FREEPG_V1)) -+#define BIT_GET_PUB_FREEPG_V1(x) \ -+ (((x) >> BIT_SHIFT_PUB_FREEPG_V1) & BIT_MASK_PUB_FREEPG_V1) -+#define BIT_SET_PUB_FREEPG_V1(x, v) \ -+ (BIT_CLEAR_PUB_FREEPG_V1(x) | BIT_PUB_FREEPG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_ADRV_1_TO_0 16 -+#define BIT_MASK_XTAL_ADRV_1_TO_0 0x3 -+#define BIT_XTAL_ADRV_1_TO_0(x) \ -+ (((x) & BIT_MASK_XTAL_ADRV_1_TO_0) << BIT_SHIFT_XTAL_ADRV_1_TO_0) -+#define BITS_XTAL_ADRV_1_TO_0 \ -+ (BIT_MASK_XTAL_ADRV_1_TO_0 << BIT_SHIFT_XTAL_ADRV_1_TO_0) -+#define BIT_CLEAR_XTAL_ADRV_1_TO_0(x) ((x) & (~BITS_XTAL_ADRV_1_TO_0)) -+#define BIT_GET_XTAL_ADRV_1_TO_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_ADRV_1_TO_0) & BIT_MASK_XTAL_ADRV_1_TO_0) -+#define BIT_SET_XTAL_ADRV_1_TO_0(x, v) \ -+ (BIT_CLEAR_XTAL_ADRV_1_TO_0(x) | BIT_XTAL_ADRV_1_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_RF_DRV 15 -+#define BIT_MASK_XTAL_RF_DRV 0x3 -+#define BIT_XTAL_RF_DRV(x) \ -+ (((x) & BIT_MASK_XTAL_RF_DRV) << BIT_SHIFT_XTAL_RF_DRV) -+#define BITS_XTAL_RF_DRV (BIT_MASK_XTAL_RF_DRV << BIT_SHIFT_XTAL_RF_DRV) -+#define BIT_CLEAR_XTAL_RF_DRV(x) ((x) & (~BITS_XTAL_RF_DRV)) -+#define BIT_GET_XTAL_RF_DRV(x) \ -+ (((x) >> BIT_SHIFT_XTAL_RF_DRV) & BIT_MASK_XTAL_RF_DRV) -+#define BIT_SET_XTAL_RF_DRV(x, v) \ -+ (BIT_CLEAR_XTAL_RF_DRV(x) | BIT_XTAL_RF_DRV(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_DRV_RF2 15 -+#define BIT_MASK_XTAL_DRV_RF2 0x3 -+#define BIT_XTAL_DRV_RF2(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF2) << BIT_SHIFT_XTAL_DRV_RF2) -+#define BITS_XTAL_DRV_RF2 (BIT_MASK_XTAL_DRV_RF2 << BIT_SHIFT_XTAL_DRV_RF2) -+#define BIT_CLEAR_XTAL_DRV_RF2(x) ((x) & (~BITS_XTAL_DRV_RF2)) -+#define BIT_GET_XTAL_DRV_RF2(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF2) & BIT_MASK_XTAL_DRV_RF2) -+#define BIT_SET_XTAL_DRV_RF2(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF2(x) | BIT_XTAL_DRV_RF2(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_GAFE BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_RF_GATE BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_DDRV_1_TO_0 13 -+#define BIT_MASK_XTAL_DDRV_1_TO_0 0x3 -+#define BIT_XTAL_DDRV_1_TO_0(x) \ -+ (((x) & BIT_MASK_XTAL_DDRV_1_TO_0) << BIT_SHIFT_XTAL_DDRV_1_TO_0) -+#define BITS_XTAL_DDRV_1_TO_0 \ -+ (BIT_MASK_XTAL_DDRV_1_TO_0 << BIT_SHIFT_XTAL_DDRV_1_TO_0) -+#define BIT_CLEAR_XTAL_DDRV_1_TO_0(x) ((x) & (~BITS_XTAL_DDRV_1_TO_0)) -+#define BIT_GET_XTAL_DDRV_1_TO_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DDRV_1_TO_0) & BIT_MASK_XTAL_DDRV_1_TO_0) -+#define BIT_SET_XTAL_DDRV_1_TO_0(x, v) \ -+ (BIT_CLEAR_XTAL_DDRV_1_TO_0(x) | BIT_XTAL_DDRV_1_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_AFE_DRV 12 -+#define BIT_MASK_XTAL_AFE_DRV 0x3 -+#define BIT_XTAL_AFE_DRV(x) \ -+ (((x) & BIT_MASK_XTAL_AFE_DRV) << BIT_SHIFT_XTAL_AFE_DRV) -+#define BITS_XTAL_AFE_DRV (BIT_MASK_XTAL_AFE_DRV << BIT_SHIFT_XTAL_AFE_DRV) -+#define BIT_CLEAR_XTAL_AFE_DRV(x) ((x) & (~BITS_XTAL_AFE_DRV)) -+#define BIT_GET_XTAL_AFE_DRV(x) \ -+ (((x) >> BIT_SHIFT_XTAL_AFE_DRV) & BIT_MASK_XTAL_AFE_DRV) -+#define BIT_SET_XTAL_AFE_DRV(x, v) \ -+ (BIT_CLEAR_XTAL_AFE_DRV(x) | BIT_XTAL_AFE_DRV(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_DELAY_DIGI BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_GUSB BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_GATE_AFE BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_DELAY_USB BIT(11) -+#define BIT_XTAL_DELAY_AFE BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_USB_DRV 9 -+#define BIT_MASK_XTAL_USB_DRV 0x3 -+#define BIT_XTAL_USB_DRV(x) \ -+ (((x) & BIT_MASK_XTAL_USB_DRV) << BIT_SHIFT_XTAL_USB_DRV) -+#define BITS_XTAL_USB_DRV (BIT_MASK_XTAL_USB_DRV << BIT_SHIFT_XTAL_USB_DRV) -+#define BIT_CLEAR_XTAL_USB_DRV(x) ((x) & (~BITS_XTAL_USB_DRV)) -+#define BIT_GET_XTAL_USB_DRV(x) \ -+ (((x) >> BIT_SHIFT_XTAL_USB_DRV) & BIT_MASK_XTAL_USB_DRV) -+#define BIT_SET_XTAL_USB_DRV(x, v) \ -+ (BIT_CLEAR_XTAL_USB_DRV(x) | BIT_XTAL_USB_DRV(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_LP_V1 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_GATE_USB BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_GM_SEP_V1 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_GMN_3_TO_0 8 -+#define BIT_MASK_XTAL_GMN_3_TO_0 0xf -+#define BIT_XTAL_GMN_3_TO_0(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_3_TO_0) << BIT_SHIFT_XTAL_GMN_3_TO_0) -+#define BITS_XTAL_GMN_3_TO_0 \ -+ (BIT_MASK_XTAL_GMN_3_TO_0 << BIT_SHIFT_XTAL_GMN_3_TO_0) -+#define BIT_CLEAR_XTAL_GMN_3_TO_0(x) ((x) & (~BITS_XTAL_GMN_3_TO_0)) -+#define BIT_GET_XTAL_GMN_3_TO_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_3_TO_0) & BIT_MASK_XTAL_GMN_3_TO_0) -+#define BIT_SET_XTAL_GMN_3_TO_0(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_3_TO_0(x) | BIT_XTAL_GMN_3_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_LDO_VREF_V1 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_LDO_VREF 7 -+#define BIT_MASK_XTAL_LDO_VREF 0x7 -+#define BIT_XTAL_LDO_VREF(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_VREF) << BIT_SHIFT_XTAL_LDO_VREF) -+#define BITS_XTAL_LDO_VREF (BIT_MASK_XTAL_LDO_VREF << BIT_SHIFT_XTAL_LDO_VREF) -+#define BIT_CLEAR_XTAL_LDO_VREF(x) ((x) & (~BITS_XTAL_LDO_VREF)) -+#define BIT_GET_XTAL_LDO_VREF(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_VREF) & BIT_MASK_XTAL_LDO_VREF) -+#define BIT_SET_XTAL_LDO_VREF(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_VREF(x) | BIT_XTAL_LDO_VREF(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_XQSEL_RF BIT(6) -+#define BIT_XTAL_XQSEL BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_GMP 4 -+#define BIT_MASK_XTAL_GMP 0xf -+#define BIT_XTAL_GMP(x) (((x) & BIT_MASK_XTAL_GMP) << BIT_SHIFT_XTAL_GMP) -+#define BITS_XTAL_GMP (BIT_MASK_XTAL_GMP << BIT_SHIFT_XTAL_GMP) -+#define BIT_CLEAR_XTAL_GMP(x) ((x) & (~BITS_XTAL_GMP)) -+#define BIT_GET_XTAL_GMP(x) (((x) >> BIT_SHIFT_XTAL_GMP) & BIT_MASK_XTAL_GMP) -+#define BIT_SET_XTAL_GMP(x, v) (BIT_CLEAR_XTAL_GMP(x) | BIT_XTAL_GMP(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_GMP_3_TO_0 4 -+#define BIT_MASK_XTAL_GMP_3_TO_0 0xf -+#define BIT_XTAL_GMP_3_TO_0(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_3_TO_0) << BIT_SHIFT_XTAL_GMP_3_TO_0) -+#define BITS_XTAL_GMP_3_TO_0 \ -+ (BIT_MASK_XTAL_GMP_3_TO_0 << BIT_SHIFT_XTAL_GMP_3_TO_0) -+#define BIT_CLEAR_XTAL_GMP_3_TO_0(x) ((x) & (~BITS_XTAL_GMP_3_TO_0)) -+#define BIT_GET_XTAL_GMP_3_TO_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_3_TO_0) & BIT_MASK_XTAL_GMP_3_TO_0) -+#define BIT_SET_XTAL_GMP_3_TO_0(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_3_TO_0(x) | BIT_XTAL_GMP_3_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_GMN_V2 3 -+#define BIT_MASK_XTAL_GMN_V2 0x3 -+#define BIT_XTAL_GMN_V2(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_V2) << BIT_SHIFT_XTAL_GMN_V2) -+#define BITS_XTAL_GMN_V2 (BIT_MASK_XTAL_GMN_V2 << BIT_SHIFT_XTAL_GMN_V2) -+#define BIT_CLEAR_XTAL_GMN_V2(x) ((x) & (~BITS_XTAL_GMN_V2)) -+#define BIT_GET_XTAL_GMN_V2(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_V2) & BIT_MASK_XTAL_GMN_V2) -+#define BIT_SET_XTAL_GMN_V2(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_V2(x) | BIT_XTAL_GMN_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_GMN_V1 3 -+#define BIT_MASK_XTAL_GMN_V1 0x3 -+#define BIT_XTAL_GMN_V1(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_V1) << BIT_SHIFT_XTAL_GMN_V1) -+#define BITS_XTAL_GMN_V1 (BIT_MASK_XTAL_GMN_V1 << BIT_SHIFT_XTAL_GMN_V1) -+#define BIT_CLEAR_XTAL_GMN_V1(x) ((x) & (~BITS_XTAL_GMN_V1)) -+#define BIT_GET_XTAL_GMN_V1(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_V1) & BIT_MASK_XTAL_GMN_V1) -+#define BIT_SET_XTAL_GMN_V1(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_V1(x) | BIT_XTAL_GMN_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_LDO_VCM 2 -+#define BIT_MASK_XTAL_LDO_VCM 0x3 -+#define BIT_XTAL_LDO_VCM(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_VCM) << BIT_SHIFT_XTAL_LDO_VCM) -+#define BITS_XTAL_LDO_VCM (BIT_MASK_XTAL_LDO_VCM << BIT_SHIFT_XTAL_LDO_VCM) -+#define BIT_CLEAR_XTAL_LDO_VCM(x) ((x) & (~BITS_XTAL_LDO_VCM)) -+#define BIT_GET_XTAL_LDO_VCM(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_VCM) & BIT_MASK_XTAL_LDO_VCM) -+#define BIT_SET_XTAL_LDO_VCM(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_VCM(x) | BIT_XTAL_LDO_VCM(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_DRV_LDO_VCM_1_TO_0 2 -+#define BIT_MASK_DRV_LDO_VCM_1_TO_0 0x3 -+#define BIT_DRV_LDO_VCM_1_TO_0(x) \ -+ (((x) & BIT_MASK_DRV_LDO_VCM_1_TO_0) << BIT_SHIFT_DRV_LDO_VCM_1_TO_0) -+#define BITS_DRV_LDO_VCM_1_TO_0 \ -+ (BIT_MASK_DRV_LDO_VCM_1_TO_0 << BIT_SHIFT_DRV_LDO_VCM_1_TO_0) -+#define BIT_CLEAR_DRV_LDO_VCM_1_TO_0(x) ((x) & (~BITS_DRV_LDO_VCM_1_TO_0)) -+#define BIT_GET_DRV_LDO_VCM_1_TO_0(x) \ -+ (((x) >> BIT_SHIFT_DRV_LDO_VCM_1_TO_0) & BIT_MASK_DRV_LDO_VCM_1_TO_0) -+#define BIT_SET_DRV_LDO_VCM_1_TO_0(x, v) \ -+ (BIT_CLEAR_DRV_LDO_VCM_1_TO_0(x) | BIT_DRV_LDO_VCM_1_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_DUMMY BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_GMP_V2 1 -+#define BIT_MASK_XTAL_GMP_V2 0x3 -+#define BIT_XTAL_GMP_V2(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_V2) << BIT_SHIFT_XTAL_GMP_V2) -+#define BITS_XTAL_GMP_V2 (BIT_MASK_XTAL_GMP_V2 << BIT_SHIFT_XTAL_GMP_V2) -+#define BIT_CLEAR_XTAL_GMP_V2(x) ((x) & (~BITS_XTAL_GMP_V2)) -+#define BIT_GET_XTAL_GMP_V2(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_V2) & BIT_MASK_XTAL_GMP_V2) -+#define BIT_SET_XTAL_GMP_V2(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_V2(x) | BIT_XTAL_GMP_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_SHIFT_XTAL_GMP_V1 1 -+#define BIT_MASK_XTAL_GMP_V1 0x3 -+#define BIT_XTAL_GMP_V1(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_V1) << BIT_SHIFT_XTAL_GMP_V1) -+#define BITS_XTAL_GMP_V1 (BIT_MASK_XTAL_GMP_V1 << BIT_SHIFT_XTAL_GMP_V1) -+#define BIT_CLEAR_XTAL_GMP_V1(x) ((x) & (~BITS_XTAL_GMP_V1)) -+#define BIT_GET_XTAL_GMP_V1(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_V1) & BIT_MASK_XTAL_GMP_V1) -+#define BIT_SET_XTAL_GMP_V1(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_V1(x) | BIT_XTAL_GMP_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XQSEL_RF_INITIAL_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL1 (Offset 0x0024) */ -+ -+#define BIT_XTAL_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_FREE_TXPG2 (Offset 0x10250024) */ -+ -+#define BIT_SHIFT_LOW_FREEPG_V1 0 -+#define BIT_MASK_LOW_FREEPG_V1 0xfff -+#define BIT_LOW_FREEPG_V1(x) \ -+ (((x) & BIT_MASK_LOW_FREEPG_V1) << BIT_SHIFT_LOW_FREEPG_V1) -+#define BITS_LOW_FREEPG_V1 (BIT_MASK_LOW_FREEPG_V1 << BIT_SHIFT_LOW_FREEPG_V1) -+#define BIT_CLEAR_LOW_FREEPG_V1(x) ((x) & (~BITS_LOW_FREEPG_V1)) -+#define BIT_GET_LOW_FREEPG_V1(x) \ -+ (((x) >> BIT_SHIFT_LOW_FREEPG_V1) & BIT_MASK_LOW_FREEPG_V1) -+#define BIT_SET_LOW_FREEPG_V1(x, v) \ -+ (BIT_CLEAR_LOW_FREEPG_V1(x) | BIT_LOW_FREEPG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_REG_C3_V4 30 -+#define BIT_MASK_REG_C3_V4 0x3 -+#define BIT_REG_C3_V4(x) (((x) & BIT_MASK_REG_C3_V4) << BIT_SHIFT_REG_C3_V4) -+#define BITS_REG_C3_V4 (BIT_MASK_REG_C3_V4 << BIT_SHIFT_REG_C3_V4) -+#define BIT_CLEAR_REG_C3_V4(x) ((x) & (~BITS_REG_C3_V4)) -+#define BIT_GET_REG_C3_V4(x) (((x) >> BIT_SHIFT_REG_C3_V4) & BIT_MASK_REG_C3_V4) -+#define BIT_SET_REG_C3_V4(x, v) (BIT_CLEAR_REG_C3_V4(x) | BIT_REG_C3_V4(v)) -+ -+#define BIT_REG_CP_BIT1 BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_XTAL_GMN 28 -+#define BIT_MASK_XTAL_GMN 0xf -+#define BIT_XTAL_GMN(x) (((x) & BIT_MASK_XTAL_GMN) << BIT_SHIFT_XTAL_GMN) -+#define BITS_XTAL_GMN (BIT_MASK_XTAL_GMN << BIT_SHIFT_XTAL_GMN) -+#define BIT_CLEAR_XTAL_GMN(x) ((x) & (~BITS_XTAL_GMN)) -+#define BIT_GET_XTAL_GMN(x) (((x) >> BIT_SHIFT_XTAL_GMN) & BIT_MASK_XTAL_GMN) -+#define BIT_SET_XTAL_GMN(x, v) (BIT_CLEAR_XTAL_GMN(x) | BIT_XTAL_GMN(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_IOOFFSET_3_TO_0 28 -+#define BIT_MASK_IOOFFSET_3_TO_0 0xf -+#define BIT_IOOFFSET_3_TO_0(x) \ -+ (((x) & BIT_MASK_IOOFFSET_3_TO_0) << BIT_SHIFT_IOOFFSET_3_TO_0) -+#define BITS_IOOFFSET_3_TO_0 \ -+ (BIT_MASK_IOOFFSET_3_TO_0 << BIT_SHIFT_IOOFFSET_3_TO_0) -+#define BIT_CLEAR_IOOFFSET_3_TO_0(x) ((x) & (~BITS_IOOFFSET_3_TO_0)) -+#define BIT_GET_IOOFFSET_3_TO_0(x) \ -+ (((x) >> BIT_SHIFT_IOOFFSET_3_TO_0) & BIT_MASK_IOOFFSET_3_TO_0) -+#define BIT_SET_IOOFFSET_3_TO_0(x, v) \ -+ (BIT_CLEAR_IOOFFSET_3_TO_0(x) | BIT_IOOFFSET_3_TO_0(v)) -+ -+#define BIT_REG_FREF_SEL_BIT3_V1 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_REG_VO_AD 26 -+#define BIT_MASK_REG_VO_AD 0x3 -+#define BIT_REG_VO_AD(x) (((x) & BIT_MASK_REG_VO_AD) << BIT_SHIFT_REG_VO_AD) -+#define BITS_REG_VO_AD (BIT_MASK_REG_VO_AD << BIT_SHIFT_REG_VO_AD) -+#define BIT_CLEAR_REG_VO_AD(x) ((x) & (~BITS_REG_VO_AD)) -+#define BIT_GET_REG_VO_AD(x) (((x) >> BIT_SHIFT_REG_VO_AD) & BIT_MASK_REG_VO_AD) -+#define BIT_SET_REG_VO_AD(x, v) (BIT_CLEAR_REG_VO_AD(x) | BIT_REG_VO_AD(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_RS_SET 26 -+#define BIT_MASK_RS_SET 0x7 -+#define BIT_RS_SET(x) (((x) & BIT_MASK_RS_SET) << BIT_SHIFT_RS_SET) -+#define BITS_RS_SET (BIT_MASK_RS_SET << BIT_SHIFT_RS_SET) -+#define BIT_CLEAR_RS_SET(x) ((x) & (~BITS_RS_SET)) -+#define BIT_GET_RS_SET(x) (((x) >> BIT_SHIFT_RS_SET) & BIT_MASK_RS_SET) -+#define BIT_SET_RS_SET(x, v) (BIT_CLEAR_RS_SET(x) | BIT_RS_SET(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_RS_SET_V2 26 -+#define BIT_MASK_RS_SET_V2 0x7 -+#define BIT_RS_SET_V2(x) (((x) & BIT_MASK_RS_SET_V2) << BIT_SHIFT_RS_SET_V2) -+#define BITS_RS_SET_V2 (BIT_MASK_RS_SET_V2 << BIT_SHIFT_RS_SET_V2) -+#define BIT_CLEAR_RS_SET_V2(x) ((x) & (~BITS_RS_SET_V2)) -+#define BIT_GET_RS_SET_V2(x) (((x) >> BIT_SHIFT_RS_SET_V2) & BIT_MASK_RS_SET_V2) -+#define BIT_SET_RS_SET_V2(x, v) (BIT_CLEAR_RS_SET_V2(x) | BIT_RS_SET_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_REG_RS_V4 26 -+#define BIT_MASK_REG_RS_V4 0x7 -+#define BIT_REG_RS_V4(x) (((x) & BIT_MASK_REG_RS_V4) << BIT_SHIFT_REG_RS_V4) -+#define BITS_REG_RS_V4 (BIT_MASK_REG_RS_V4 << BIT_SHIFT_REG_RS_V4) -+#define BIT_CLEAR_REG_RS_V4(x) ((x) & (~BITS_REG_RS_V4)) -+#define BIT_GET_REG_RS_V4(x) (((x) >> BIT_SHIFT_REG_RS_V4) & BIT_MASK_REG_RS_V4) -+#define BIT_SET_REG_RS_V4(x, v) (BIT_CLEAR_REG_RS_V4(x) | BIT_REG_RS_V4(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_V12ADJ_V1 25 -+#define BIT_MASK_V12ADJ_V1 0x3 -+#define BIT_V12ADJ_V1(x) (((x) & BIT_MASK_V12ADJ_V1) << BIT_SHIFT_V12ADJ_V1) -+#define BITS_V12ADJ_V1 (BIT_MASK_V12ADJ_V1 << BIT_SHIFT_V12ADJ_V1) -+#define BIT_CLEAR_V12ADJ_V1(x) ((x) & (~BITS_V12ADJ_V1)) -+#define BIT_GET_V12ADJ_V1(x) (((x) >> BIT_SHIFT_V12ADJ_V1) & BIT_MASK_V12ADJ_V1) -+#define BIT_SET_V12ADJ_V1(x, v) (BIT_CLEAR_V12ADJ_V1(x) | BIT_V12ADJ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_OQT_FREE_TXPG_V1 (Offset 0x10250028) */ -+ -+#define BIT_SHIFT_NOAC_OQT_FREEPG_V1 24 -+#define BIT_MASK_NOAC_OQT_FREEPG_V1 0xff -+#define BIT_NOAC_OQT_FREEPG_V1(x) \ -+ (((x) & BIT_MASK_NOAC_OQT_FREEPG_V1) << BIT_SHIFT_NOAC_OQT_FREEPG_V1) -+#define BITS_NOAC_OQT_FREEPG_V1 \ -+ (BIT_MASK_NOAC_OQT_FREEPG_V1 << BIT_SHIFT_NOAC_OQT_FREEPG_V1) -+#define BIT_CLEAR_NOAC_OQT_FREEPG_V1(x) ((x) & (~BITS_NOAC_OQT_FREEPG_V1)) -+#define BIT_GET_NOAC_OQT_FREEPG_V1(x) \ -+ (((x) >> BIT_SHIFT_NOAC_OQT_FREEPG_V1) & BIT_MASK_NOAC_OQT_FREEPG_V1) -+#define BIT_SET_NOAC_OQT_FREEPG_V1(x, v) \ -+ (BIT_CLEAR_NOAC_OQT_FREEPG_V1(x) | BIT_NOAC_OQT_FREEPG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_PS_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_REG__CS 24 -+#define BIT_MASK_REG__CS 0x3 -+#define BIT_REG__CS(x) (((x) & BIT_MASK_REG__CS) << BIT_SHIFT_REG__CS) -+#define BITS_REG__CS (BIT_MASK_REG__CS << BIT_SHIFT_REG__CS) -+#define BIT_CLEAR_REG__CS(x) ((x) & (~BITS_REG__CS)) -+#define BIT_GET_REG__CS(x) (((x) >> BIT_SHIFT_REG__CS) & BIT_MASK_REG__CS) -+#define BIT_SET_REG__CS(x, v) (BIT_CLEAR_REG__CS(x) | BIT_REG__CS(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_EN_CK320M_V1 BIT(23) -+#define BIT_AGPIO BIT(22) -+#define BIT_REG_EDGE_SEL_V1 BIT(21) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_REG_CP_OFFSET 21 -+#define BIT_MASK_REG_CP_OFFSET 0x7 -+#define BIT_REG_CP_OFFSET(x) \ -+ (((x) & BIT_MASK_REG_CP_OFFSET) << BIT_SHIFT_REG_CP_OFFSET) -+#define BITS_REG_CP_OFFSET (BIT_MASK_REG_CP_OFFSET << BIT_SHIFT_REG_CP_OFFSET) -+#define BIT_CLEAR_REG_CP_OFFSET(x) ((x) & (~BITS_REG_CP_OFFSET)) -+#define BIT_GET_REG_CP_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_OFFSET) & BIT_MASK_REG_CP_OFFSET) -+#define BIT_SET_REG_CP_OFFSET(x, v) \ -+ (BIT_CLEAR_REG_CP_OFFSET(x) | BIT_REG_CP_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_REG_VCO_BIAS_0 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_CP_BIAS 18 -+#define BIT_MASK_CP_BIAS 0x7 -+#define BIT_CP_BIAS(x) (((x) & BIT_MASK_CP_BIAS) << BIT_SHIFT_CP_BIAS) -+#define BITS_CP_BIAS (BIT_MASK_CP_BIAS << BIT_SHIFT_CP_BIAS) -+#define BIT_CLEAR_CP_BIAS(x) ((x) & (~BITS_CP_BIAS)) -+#define BIT_GET_CP_BIAS(x) (((x) >> BIT_SHIFT_CP_BIAS) & BIT_MASK_CP_BIAS) -+#define BIT_SET_CP_BIAS(x, v) (BIT_CLEAR_CP_BIAS(x) | BIT_CP_BIAS(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_CP_BIAS_V2 18 -+#define BIT_MASK_CP_BIAS_V2 0x7 -+#define BIT_CP_BIAS_V2(x) (((x) & BIT_MASK_CP_BIAS_V2) << BIT_SHIFT_CP_BIAS_V2) -+#define BITS_CP_BIAS_V2 (BIT_MASK_CP_BIAS_V2 << BIT_SHIFT_CP_BIAS_V2) -+#define BIT_CLEAR_CP_BIAS_V2(x) ((x) & (~BITS_CP_BIAS_V2)) -+#define BIT_GET_CP_BIAS_V2(x) \ -+ (((x) >> BIT_SHIFT_CP_BIAS_V2) & BIT_MASK_CP_BIAS_V2) -+#define BIT_SET_CP_BIAS_V2(x, v) (BIT_CLEAR_CP_BIAS_V2(x) | BIT_CP_BIAS_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_REG_PLLBIAS_2_TO_0_V1 17 -+#define BIT_MASK_REG_PLLBIAS_2_TO_0_V1 0x7 -+#define BIT_REG_PLLBIAS_2_TO_0_V1(x) \ -+ (((x) & BIT_MASK_REG_PLLBIAS_2_TO_0_V1) \ -+ << BIT_SHIFT_REG_PLLBIAS_2_TO_0_V1) -+#define BITS_REG_PLLBIAS_2_TO_0_V1 \ -+ (BIT_MASK_REG_PLLBIAS_2_TO_0_V1 << BIT_SHIFT_REG_PLLBIAS_2_TO_0_V1) -+#define BIT_CLEAR_REG_PLLBIAS_2_TO_0_V1(x) ((x) & (~BITS_REG_PLLBIAS_2_TO_0_V1)) -+#define BIT_GET_REG_PLLBIAS_2_TO_0_V1(x) \ -+ (((x) >> BIT_SHIFT_REG_PLLBIAS_2_TO_0_V1) & \ -+ BIT_MASK_REG_PLLBIAS_2_TO_0_V1) -+#define BIT_SET_REG_PLLBIAS_2_TO_0_V1(x, v) \ -+ (BIT_CLEAR_REG_PLLBIAS_2_TO_0_V1(x) | BIT_REG_PLLBIAS_2_TO_0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_REG_IDOUBLE_V2 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_FREF_SEL BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_OQT_FREE_TXPG_V1 (Offset 0x10250028) */ -+ -+#define BIT_SHIFT_AC_OQT_FREEPG_V1 16 -+#define BIT_MASK_AC_OQT_FREEPG_V1 0xff -+#define BIT_AC_OQT_FREEPG_V1(x) \ -+ (((x) & BIT_MASK_AC_OQT_FREEPG_V1) << BIT_SHIFT_AC_OQT_FREEPG_V1) -+#define BITS_AC_OQT_FREEPG_V1 \ -+ (BIT_MASK_AC_OQT_FREEPG_V1 << BIT_SHIFT_AC_OQT_FREEPG_V1) -+#define BIT_CLEAR_AC_OQT_FREEPG_V1(x) ((x) & (~BITS_AC_OQT_FREEPG_V1)) -+#define BIT_GET_AC_OQT_FREEPG_V1(x) \ -+ (((x) >> BIT_SHIFT_AC_OQT_FREEPG_V1) & BIT_MASK_AC_OQT_FREEPG_V1) -+#define BIT_SET_AC_OQT_FREEPG_V1(x, v) \ -+ (BIT_CLEAR_AC_OQT_FREEPG_V1(x) | BIT_AC_OQT_FREEPG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_REG_IDOUBLE_V1 BIT(16) -+ -+#define BIT_SHIFT_AC_OQT__FREEPG_V1 16 -+#define BIT_MASK_AC_OQT__FREEPG_V1 0xff -+#define BIT_AC_OQT__FREEPG_V1(x) \ -+ (((x) & BIT_MASK_AC_OQT__FREEPG_V1) << BIT_SHIFT_AC_OQT__FREEPG_V1) -+#define BITS_AC_OQT__FREEPG_V1 \ -+ (BIT_MASK_AC_OQT__FREEPG_V1 << BIT_SHIFT_AC_OQT__FREEPG_V1) -+#define BIT_CLEAR_AC_OQT__FREEPG_V1(x) ((x) & (~BITS_AC_OQT__FREEPG_V1)) -+#define BIT_GET_AC_OQT__FREEPG_V1(x) \ -+ (((x) >> BIT_SHIFT_AC_OQT__FREEPG_V1) & BIT_MASK_AC_OQT__FREEPG_V1) -+#define BIT_SET_AC_OQT__FREEPG_V1(x, v) \ -+ (BIT_CLEAR_AC_OQT__FREEPG_V1(x) | BIT_AC_OQT__FREEPG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_EN_SYN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_REG_KVCO_V1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_APLL_320_GATEB BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_MCCO 14 -+#define BIT_MASK_MCCO 0x3 -+#define BIT_MCCO(x) (((x) & BIT_MASK_MCCO) << BIT_SHIFT_MCCO) -+#define BITS_MCCO (BIT_MASK_MCCO << BIT_SHIFT_MCCO) -+#define BIT_CLEAR_MCCO(x) ((x) & (~BITS_MCCO)) -+#define BIT_GET_MCCO(x) (((x) >> BIT_SHIFT_MCCO) & BIT_MASK_MCCO) -+#define BIT_SET_MCCO(x, v) (BIT_CLEAR_MCCO(x) | BIT_MCCO(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_MCCO_V2 14 -+#define BIT_MASK_MCCO_V2 0x3 -+#define BIT_MCCO_V2(x) (((x) & BIT_MASK_MCCO_V2) << BIT_SHIFT_MCCO_V2) -+#define BITS_MCCO_V2 (BIT_MASK_MCCO_V2 << BIT_SHIFT_MCCO_V2) -+#define BIT_CLEAR_MCCO_V2(x) ((x) & (~BITS_MCCO_V2)) -+#define BIT_GET_MCCO_V2(x) (((x) >> BIT_SHIFT_MCCO_V2) & BIT_MASK_MCCO_V2) -+#define BIT_SET_MCCO_V2(x, v) (BIT_CLEAR_MCCO_V2(x) | BIT_MCCO_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_REG_VCO_BIAS_1_V1 BIT(14) -+#define BIT_REG_DOGB_V1 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_CK320_EN 12 -+#define BIT_MASK_CK320_EN 0x3 -+#define BIT_CK320_EN(x) (((x) & BIT_MASK_CK320_EN) << BIT_SHIFT_CK320_EN) -+#define BITS_CK320_EN (BIT_MASK_CK320_EN << BIT_SHIFT_CK320_EN) -+#define BIT_CLEAR_CK320_EN(x) ((x) & (~BITS_CK320_EN)) -+#define BIT_GET_CK320_EN(x) (((x) >> BIT_SHIFT_CK320_EN) & BIT_MASK_CK320_EN) -+#define BIT_SET_CK320_EN(x, v) (BIT_CLEAR_CK320_EN(x) | BIT_CK320_EN(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_REG_LDO_SEL 12 -+#define BIT_MASK_REG_LDO_SEL 0x3 -+#define BIT_REG_LDO_SEL(x) \ -+ (((x) & BIT_MASK_REG_LDO_SEL) << BIT_SHIFT_REG_LDO_SEL) -+#define BITS_REG_LDO_SEL (BIT_MASK_REG_LDO_SEL << BIT_SHIFT_REG_LDO_SEL) -+#define BIT_CLEAR_REG_LDO_SEL(x) ((x) & (~BITS_REG_LDO_SEL)) -+#define BIT_GET_REG_LDO_SEL(x) \ -+ (((x) >> BIT_SHIFT_REG_LDO_SEL) & BIT_MASK_REG_LDO_SEL) -+#define BIT_SET_REG_LDO_SEL(x, v) \ -+ (BIT_CLEAR_REG_LDO_SEL(x) | BIT_REG_LDO_SEL(v)) -+ -+#define BIT_REG_KVCO_V2 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_AGPIO_GPO BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_APLL_BIAS 8 -+#define BIT_MASK_APLL_BIAS 0x7 -+#define BIT_APLL_BIAS(x) (((x) & BIT_MASK_APLL_BIAS) << BIT_SHIFT_APLL_BIAS) -+#define BITS_APLL_BIAS (BIT_MASK_APLL_BIAS << BIT_SHIFT_APLL_BIAS) -+#define BIT_CLEAR_APLL_BIAS(x) ((x) & (~BITS_APLL_BIAS)) -+#define BIT_GET_APLL_BIAS(x) (((x) >> BIT_SHIFT_APLL_BIAS) & BIT_MASK_APLL_BIAS) -+#define BIT_SET_APLL_BIAS(x, v) (BIT_CLEAR_APLL_BIAS(x) | BIT_APLL_BIAS(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_AGPIO_DRV 7 -+#define BIT_MASK_AGPIO_DRV 0x3 -+#define BIT_AGPIO_DRV(x) (((x) & BIT_MASK_AGPIO_DRV) << BIT_SHIFT_AGPIO_DRV) -+#define BITS_AGPIO_DRV (BIT_MASK_AGPIO_DRV << BIT_SHIFT_AGPIO_DRV) -+#define BIT_CLEAR_AGPIO_DRV(x) ((x) & (~BITS_AGPIO_DRV)) -+#define BIT_GET_AGPIO_DRV(x) (((x) >> BIT_SHIFT_AGPIO_DRV) & BIT_MASK_AGPIO_DRV) -+#define BIT_SET_AGPIO_DRV(x, v) (BIT_CLEAR_AGPIO_DRV(x) | BIT_AGPIO_DRV(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_REG_V15_3_TO_0_V1 7 -+#define BIT_MASK_REG_V15_3_TO_0_V1 0xf -+#define BIT_REG_V15_3_TO_0_V1(x) \ -+ (((x) & BIT_MASK_REG_V15_3_TO_0_V1) << BIT_SHIFT_REG_V15_3_TO_0_V1) -+#define BITS_REG_V15_3_TO_0_V1 \ -+ (BIT_MASK_REG_V15_3_TO_0_V1 << BIT_SHIFT_REG_V15_3_TO_0_V1) -+#define BIT_CLEAR_REG_V15_3_TO_0_V1(x) ((x) & (~BITS_REG_V15_3_TO_0_V1)) -+#define BIT_GET_REG_V15_3_TO_0_V1(x) \ -+ (((x) >> BIT_SHIFT_REG_V15_3_TO_0_V1) & BIT_MASK_REG_V15_3_TO_0_V1) -+#define BIT_SET_REG_V15_3_TO_0_V1(x, v) \ -+ (BIT_CLEAR_REG_V15_3_TO_0_V1(x) | BIT_REG_V15_3_TO_0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_APLL_KVCO BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_REG_SEL_LDO_PC BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_APLL_WDOGB BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_REG_CC_1_TO_0_V1 4 -+#define BIT_MASK_REG_CC_1_TO_0_V1 0x3 -+#define BIT_REG_CC_1_TO_0_V1(x) \ -+ (((x) & BIT_MASK_REG_CC_1_TO_0_V1) << BIT_SHIFT_REG_CC_1_TO_0_V1) -+#define BITS_REG_CC_1_TO_0_V1 \ -+ (BIT_MASK_REG_CC_1_TO_0_V1 << BIT_SHIFT_REG_CC_1_TO_0_V1) -+#define BIT_CLEAR_REG_CC_1_TO_0_V1(x) ((x) & (~BITS_REG_CC_1_TO_0_V1)) -+#define BIT_GET_REG_CC_1_TO_0_V1(x) \ -+ (((x) >> BIT_SHIFT_REG_CC_1_TO_0_V1) & BIT_MASK_REG_CC_1_TO_0_V1) -+#define BIT_SET_REG_CC_1_TO_0_V1(x, v) \ -+ (BIT_CLEAR_REG_CC_1_TO_0_V1(x) | BIT_REG_CC_1_TO_0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_APLL_EDGE_SEL BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_CKDELAY_USB_V1 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_APLL_FREF_SEL_BIT0 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_POW_MAC (Offset 0x0028) */ -+ -+#define BIT_POW_LDO15 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_CKDELAY_DIG_V1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_SHIFT_XTAL_CAP_XO 1 -+#define BIT_MASK_XTAL_CAP_XO 0x3f -+#define BIT_XTAL_CAP_XO(x) \ -+ (((x) & BIT_MASK_XTAL_CAP_XO) << BIT_SHIFT_XTAL_CAP_XO) -+#define BITS_XTAL_CAP_XO (BIT_MASK_XTAL_CAP_XO << BIT_SHIFT_XTAL_CAP_XO) -+#define BIT_CLEAR_XTAL_CAP_XO(x) ((x) & (~BITS_XTAL_CAP_XO)) -+#define BIT_GET_XTAL_CAP_XO(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CAP_XO) & BIT_MASK_XTAL_CAP_XO) -+#define BIT_SET_XTAL_CAP_XO(x, v) \ -+ (BIT_CLEAR_XTAL_CAP_XO(x) | BIT_XTAL_CAP_XO(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_POW_MAC (Offset 0x0028) */ -+ -+#define BIT_POW_SW BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_MPLL_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_APLL_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL2 (Offset 0x0028) */ -+ -+#define BIT_POW_PLL BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_OQT_FREE_TXPG_V1 (Offset 0x10250028) */ -+ -+#define BIT_SHIFT_EXQ_FREEPG_V1 0 -+#define BIT_MASK_EXQ_FREEPG_V1 0xfff -+#define BIT_EXQ_FREEPG_V1(x) \ -+ (((x) & BIT_MASK_EXQ_FREEPG_V1) << BIT_SHIFT_EXQ_FREEPG_V1) -+#define BITS_EXQ_FREEPG_V1 (BIT_MASK_EXQ_FREEPG_V1 << BIT_SHIFT_EXQ_FREEPG_V1) -+#define BIT_CLEAR_EXQ_FREEPG_V1(x) ((x) & (~BITS_EXQ_FREEPG_V1)) -+#define BIT_GET_EXQ_FREEPG_V1(x) \ -+ (((x) >> BIT_SHIFT_EXQ_FREEPG_V1) & BIT_MASK_EXQ_FREEPG_V1) -+#define BIT_SET_EXQ_FREEPG_V1(x, v) \ -+ (BIT_CLEAR_EXQ_FREEPG_V1(x) | BIT_EXQ_FREEPG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_POW_MAC (Offset 0x0028) */ -+ -+#define BIT_POW_LDO14 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SDIO_OQT_FREE_TXPG_V1 (Offset 0x10250028) */ -+ -+#define BIT_SHIFT_EXQ__FREEPG_V1 0 -+#define BIT_MASK_EXQ__FREEPG_V1 0xfff -+#define BIT_EXQ__FREEPG_V1(x) \ -+ (((x) & BIT_MASK_EXQ__FREEPG_V1) << BIT_SHIFT_EXQ__FREEPG_V1) -+#define BITS_EXQ__FREEPG_V1 \ -+ (BIT_MASK_EXQ__FREEPG_V1 << BIT_SHIFT_EXQ__FREEPG_V1) -+#define BIT_CLEAR_EXQ__FREEPG_V1(x) ((x) & (~BITS_EXQ__FREEPG_V1)) -+#define BIT_GET_EXQ__FREEPG_V1(x) \ -+ (((x) >> BIT_SHIFT_EXQ__FREEPG_V1) & BIT_MASK_EXQ__FREEPG_V1) -+#define BIT_SET_EXQ__FREEPG_V1(x, v) \ -+ (BIT_CLEAR_EXQ__FREEPG_V1(x) | BIT_EXQ__FREEPG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARLDO_POW_MAC (Offset 0x0029) */ -+ -+#define BIT_LDOE25_POW_L BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_POW_MAC (Offset 0x002A) */ -+ -+#define BIT_REG_STANDBY_L BIT(19) -+#define BIT_PD_REGU_L BIT(18) -+#define BIT_EN_PC_BT_L BIT(17) -+ -+#define BIT_SHIFT_REG_LDOADJ_L 13 -+#define BIT_MASK_REG_LDOADJ_L 0xf -+#define BIT_REG_LDOADJ_L(x) \ -+ (((x) & BIT_MASK_REG_LDOADJ_L) << BIT_SHIFT_REG_LDOADJ_L) -+#define BITS_REG_LDOADJ_L (BIT_MASK_REG_LDOADJ_L << BIT_SHIFT_REG_LDOADJ_L) -+#define BIT_CLEAR_REG_LDOADJ_L(x) ((x) & (~BITS_REG_LDOADJ_L)) -+#define BIT_GET_REG_LDOADJ_L(x) \ -+ (((x) >> BIT_SHIFT_REG_LDOADJ_L) & BIT_MASK_REG_LDOADJ_L) -+#define BIT_SET_REG_LDOADJ_L(x, v) \ -+ (BIT_CLEAR_REG_LDOADJ_L(x) | BIT_REG_LDOADJ_L(v)) -+ -+#define BIT_CK12M_EN BIT(11) -+#define BIT_CK12M_SEL BIT(10) -+#define BIT_EN_25_L BIT(9) -+#define BIT_EN_SLEEP BIT(8) -+#define BIT_DUMMY_V4 BIT(7) -+#define BIT_DUMMY_V3 BIT(6) -+#define BIT_DUMMY_V2 BIT(5) -+#define BIT_DUMMY_V1 BIT(4) -+ -+#define BIT_SHIFT_LDOH12_V12ADJ_L 4 -+#define BIT_MASK_LDOH12_V12ADJ_L 0xf -+#define BIT_LDOH12_V12ADJ_L(x) \ -+ (((x) & BIT_MASK_LDOH12_V12ADJ_L) << BIT_SHIFT_LDOH12_V12ADJ_L) -+#define BITS_LDOH12_V12ADJ_L \ -+ (BIT_MASK_LDOH12_V12ADJ_L << BIT_SHIFT_LDOH12_V12ADJ_L) -+#define BIT_CLEAR_LDOH12_V12ADJ_L(x) ((x) & (~BITS_LDOH12_V12ADJ_L)) -+#define BIT_GET_LDOH12_V12ADJ_L(x) \ -+ (((x) >> BIT_SHIFT_LDOH12_V12ADJ_L) & BIT_MASK_LDOH12_V12ADJ_L) -+#define BIT_SET_LDOH12_V12ADJ_L(x, v) \ -+ (BIT_CLEAR_LDOH12_V12ADJ_L(x) | BIT_LDOH12_V12ADJ_L(v)) -+ -+#define BIT_POW_PC_LDO_PORT1 BIT(3) -+#define BIT_POW_PC_LDO_PORT0 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_POW_MAC (Offset 0x002A) */ -+ -+#define BIT_POW_PLL_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_POW_MAC (Offset 0x002A) */ -+ -+#define BIT_POW_POWER_CUT_POW_LDO BIT(0) -+ -+#define BIT_SHIFT_LDOE25_V12ADJ_L_V1 0 -+#define BIT_MASK_LDOE25_V12ADJ_L_V1 0xf -+#define BIT_LDOE25_V12ADJ_L_V1(x) \ -+ (((x) & BIT_MASK_LDOE25_V12ADJ_L_V1) << BIT_SHIFT_LDOE25_V12ADJ_L_V1) -+#define BITS_LDOE25_V12ADJ_L_V1 \ -+ (BIT_MASK_LDOE25_V12ADJ_L_V1 << BIT_SHIFT_LDOE25_V12ADJ_L_V1) -+#define BIT_CLEAR_LDOE25_V12ADJ_L_V1(x) ((x) & (~BITS_LDOE25_V12ADJ_L_V1)) -+#define BIT_GET_LDOE25_V12ADJ_L_V1(x) \ -+ (((x) >> BIT_SHIFT_LDOE25_V12ADJ_L_V1) & BIT_MASK_LDOE25_V12ADJ_L_V1) -+#define BIT_SET_LDOE25_V12ADJ_L_V1(x, v) \ -+ (BIT_CLEAR_LDOE25_V12ADJ_L_V1(x) | BIT_LDOE25_V12ADJ_L_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_POW_XTAL (Offset 0x002B) */ -+ -+#define BIT_PSTIMER_2 BIT(31) -+#define BIT_PSTIMER_1 BIT(30) -+#define BIT_PSTIMER_0 BIT(29) -+#define BIT_TXDMA_START_INT BIT(23) -+#define BIT_TXDMA_STOP_INT BIT(22) -+#define BIT_HISR7_IND BIT(21) -+#define BIT_HISR6_IND BIT(19) -+#define BIT_HISR5_IND BIT(18) -+#define BIT_HISR4_IND BIT(17) -+#define BIT_HISR3_IND BIT(14) -+#define BIT_HISR2_IND BIT(13) -+#define BIT_POW_XTAL BIT(1) -+#define BIT_POW_BG BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_XTAL_RF2_DRV 30 -+#define BIT_MASK_XTAL_RF2_DRV 0x3 -+#define BIT_XTAL_RF2_DRV(x) \ -+ (((x) & BIT_MASK_XTAL_RF2_DRV) << BIT_SHIFT_XTAL_RF2_DRV) -+#define BITS_XTAL_RF2_DRV (BIT_MASK_XTAL_RF2_DRV << BIT_SHIFT_XTAL_RF2_DRV) -+#define BIT_CLEAR_XTAL_RF2_DRV(x) ((x) & (~BITS_XTAL_RF2_DRV)) -+#define BIT_GET_XTAL_RF2_DRV(x) \ -+ (((x) >> BIT_SHIFT_XTAL_RF2_DRV) & BIT_MASK_XTAL_RF2_DRV) -+#define BIT_SET_XTAL_RF2_DRV(x, v) \ -+ (BIT_CLEAR_XTAL_RF2_DRV(x) | BIT_XTAL_RF2_DRV(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_REG_REF_SEL_V3 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_XTAL_GMN_BIT4 BIT(29) -+#define BIT_XTAL_GMP_BIT4 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_XQSEL BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_FREF_SEL_2_TO_0 27 -+#define BIT_MASK_REG_FREF_SEL_2_TO_0 0x7 -+#define BIT_REG_FREF_SEL_2_TO_0(x) \ -+ (((x) & BIT_MASK_REG_FREF_SEL_2_TO_0) << BIT_SHIFT_REG_FREF_SEL_2_TO_0) -+#define BITS_REG_FREF_SEL_2_TO_0 \ -+ (BIT_MASK_REG_FREF_SEL_2_TO_0 << BIT_SHIFT_REG_FREF_SEL_2_TO_0) -+#define BIT_CLEAR_REG_FREF_SEL_2_TO_0(x) ((x) & (~BITS_REG_FREF_SEL_2_TO_0)) -+#define BIT_GET_REG_FREF_SEL_2_TO_0(x) \ -+ (((x) >> BIT_SHIFT_REG_FREF_SEL_2_TO_0) & BIT_MASK_REG_FREF_SEL_2_TO_0) -+#define BIT_SET_REG_FREF_SEL_2_TO_0(x, v) \ -+ (BIT_CLEAR_REG_FREF_SEL_2_TO_0(x) | BIT_REG_FREF_SEL_2_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_XQSEL_BIT0 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_APLL_DUMMY BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_XTAL_CADJ_XOUT_5_TO_0_V1 21 -+#define BIT_MASK_XTAL_CADJ_XOUT_5_TO_0_V1 0x3f -+#define BIT_XTAL_CADJ_XOUT_5_TO_0_V1(x) \ -+ (((x) & BIT_MASK_XTAL_CADJ_XOUT_5_TO_0_V1) \ -+ << BIT_SHIFT_XTAL_CADJ_XOUT_5_TO_0_V1) -+#define BITS_XTAL_CADJ_XOUT_5_TO_0_V1 \ -+ (BIT_MASK_XTAL_CADJ_XOUT_5_TO_0_V1 \ -+ << BIT_SHIFT_XTAL_CADJ_XOUT_5_TO_0_V1) -+#define BIT_CLEAR_XTAL_CADJ_XOUT_5_TO_0_V1(x) \ -+ ((x) & (~BITS_XTAL_CADJ_XOUT_5_TO_0_V1)) -+#define BIT_GET_XTAL_CADJ_XOUT_5_TO_0_V1(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CADJ_XOUT_5_TO_0_V1) & \ -+ BIT_MASK_XTAL_CADJ_XOUT_5_TO_0_V1) -+#define BIT_SET_XTAL_CADJ_XOUT_5_TO_0_V1(x, v) \ -+ (BIT_CLEAR_XTAL_CADJ_XOUT_5_TO_0_V1(x) | \ -+ BIT_XTAL_CADJ_XOUT_5_TO_0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_XTAL_CADJ_XOUT 18 -+#define BIT_MASK_XTAL_CADJ_XOUT 0x3f -+#define BIT_XTAL_CADJ_XOUT(x) \ -+ (((x) & BIT_MASK_XTAL_CADJ_XOUT) << BIT_SHIFT_XTAL_CADJ_XOUT) -+#define BITS_XTAL_CADJ_XOUT \ -+ (BIT_MASK_XTAL_CADJ_XOUT << BIT_SHIFT_XTAL_CADJ_XOUT) -+#define BIT_CLEAR_XTAL_CADJ_XOUT(x) ((x) & (~BITS_XTAL_CADJ_XOUT)) -+#define BIT_GET_XTAL_CADJ_XOUT(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CADJ_XOUT) & BIT_MASK_XTAL_CADJ_XOUT) -+#define BIT_SET_XTAL_CADJ_XOUT(x, v) \ -+ (BIT_CLEAR_XTAL_CADJ_XOUT(x) | BIT_XTAL_CADJ_XOUT(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_XTAL_CADJ_XIN_V2 15 -+#define BIT_MASK_XTAL_CADJ_XIN_V2 0x3f -+#define BIT_XTAL_CADJ_XIN_V2(x) \ -+ (((x) & BIT_MASK_XTAL_CADJ_XIN_V2) << BIT_SHIFT_XTAL_CADJ_XIN_V2) -+#define BITS_XTAL_CADJ_XIN_V2 \ -+ (BIT_MASK_XTAL_CADJ_XIN_V2 << BIT_SHIFT_XTAL_CADJ_XIN_V2) -+#define BIT_CLEAR_XTAL_CADJ_XIN_V2(x) ((x) & (~BITS_XTAL_CADJ_XIN_V2)) -+#define BIT_GET_XTAL_CADJ_XIN_V2(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CADJ_XIN_V2) & BIT_MASK_XTAL_CADJ_XIN_V2) -+#define BIT_SET_XTAL_CADJ_XIN_V2(x, v) \ -+ (BIT_CLEAR_XTAL_CADJ_XIN_V2(x) | BIT_XTAL_CADJ_XIN_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_XTAL_CADJ_XIN 12 -+#define BIT_MASK_XTAL_CADJ_XIN 0x3f -+#define BIT_XTAL_CADJ_XIN(x) \ -+ (((x) & BIT_MASK_XTAL_CADJ_XIN) << BIT_SHIFT_XTAL_CADJ_XIN) -+#define BITS_XTAL_CADJ_XIN (BIT_MASK_XTAL_CADJ_XIN << BIT_SHIFT_XTAL_CADJ_XIN) -+#define BIT_CLEAR_XTAL_CADJ_XIN(x) ((x) & (~BITS_XTAL_CADJ_XIN)) -+#define BIT_GET_XTAL_CADJ_XIN(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CADJ_XIN) & BIT_MASK_XTAL_CADJ_XIN) -+#define BIT_SET_XTAL_CADJ_XIN(x, v) \ -+ (BIT_CLEAR_XTAL_CADJ_XIN(x) | BIT_XTAL_CADJ_XIN(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_RS_V3 12 -+#define BIT_MASK_REG_RS_V3 0x7 -+#define BIT_REG_RS_V3(x) (((x) & BIT_MASK_REG_RS_V3) << BIT_SHIFT_REG_RS_V3) -+#define BITS_REG_RS_V3 (BIT_MASK_REG_RS_V3 << BIT_SHIFT_REG_RS_V3) -+#define BIT_CLEAR_REG_RS_V3(x) ((x) & (~BITS_REG_RS_V3)) -+#define BIT_GET_REG_RS_V3(x) (((x) >> BIT_SHIFT_REG_RS_V3) & BIT_MASK_REG_RS_V3) -+#define BIT_SET_REG_RS_V3(x, v) (BIT_CLEAR_REG_RS_V3(x) | BIT_REG_RS_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_BCNQ_EMPTY BIT(11) -+#define BIT_SDIO_HQQ_EMPTY BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_RS 9 -+#define BIT_MASK_REG_RS 0x7 -+#define BIT_REG_RS(x) (((x) & BIT_MASK_REG_RS) << BIT_SHIFT_REG_RS) -+#define BITS_REG_RS (BIT_MASK_REG_RS << BIT_SHIFT_REG_RS) -+#define BIT_CLEAR_REG_RS(x) ((x) & (~BITS_REG_RS)) -+#define BIT_GET_REG_RS(x) (((x) >> BIT_SHIFT_REG_RS) & BIT_MASK_REG_RS) -+#define BIT_SET_REG_RS(x, v) (BIT_CLEAR_REG_RS(x) | BIT_REG_RS(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_MQQ_EMPTY BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_R3_V3 9 -+#define BIT_MASK_REG_R3_V3 0x7 -+#define BIT_REG_R3_V3(x) (((x) & BIT_MASK_REG_R3_V3) << BIT_SHIFT_REG_R3_V3) -+#define BITS_REG_R3_V3 (BIT_MASK_REG_R3_V3 << BIT_SHIFT_REG_R3_V3) -+#define BIT_CLEAR_REG_R3_V3(x) ((x) & (~BITS_REG_R3_V3)) -+#define BIT_GET_REG_R3_V3(x) (((x) >> BIT_SHIFT_REG_R3_V3) & BIT_MASK_REG_R3_V3) -+#define BIT_SET_REG_R3_V3(x, v) (BIT_CLEAR_REG_R3_V3(x) | BIT_REG_R3_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_MGQ_CPU_EMPTY BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_PS_V2 7 -+#define BIT_MASK_PS_V2 0x7 -+#define BIT_PS_V2(x) (((x) & BIT_MASK_PS_V2) << BIT_SHIFT_PS_V2) -+#define BITS_PS_V2 (BIT_MASK_PS_V2 << BIT_SHIFT_PS_V2) -+#define BIT_CLEAR_PS_V2(x) ((x) & (~BITS_PS_V2)) -+#define BIT_GET_PS_V2(x) (((x) >> BIT_SHIFT_PS_V2) & BIT_MASK_PS_V2) -+#define BIT_SET_PS_V2(x, v) (BIT_CLEAR_PS_V2(x) | BIT_PS_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_AC7Q_EMPTY BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_CS_V3 7 -+#define BIT_MASK_REG_CS_V3 0x3 -+#define BIT_REG_CS_V3(x) (((x) & BIT_MASK_REG_CS_V3) << BIT_SHIFT_REG_CS_V3) -+#define BITS_REG_CS_V3 (BIT_MASK_REG_CS_V3 << BIT_SHIFT_REG_CS_V3) -+#define BIT_CLEAR_REG_CS_V3(x) ((x) & (~BITS_REG_CS_V3)) -+#define BIT_GET_REG_CS_V3(x) (((x) >> BIT_SHIFT_REG_CS_V3) & BIT_MASK_REG_CS_V3) -+#define BIT_SET_REG_CS_V3(x, v) (BIT_CLEAR_REG_CS_V3(x) | BIT_REG_CS_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_PS 7 -+#define BIT_MASK_PS 0x7 -+#define BIT_PS(x) (((x) & BIT_MASK_PS) << BIT_SHIFT_PS) -+#define BITS_PS (BIT_MASK_PS << BIT_SHIFT_PS) -+#define BIT_CLEAR_PS(x) ((x) & (~BITS_PS)) -+#define BIT_GET_PS(x) (((x) >> BIT_SHIFT_PS) & BIT_MASK_PS) -+#define BIT_SET_PS(x, v) (BIT_CLEAR_PS(x) | BIT_PS(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_R3 6 -+#define BIT_MASK_REG_R3 0x7 -+#define BIT_REG_R3(x) (((x) & BIT_MASK_REG_R3) << BIT_SHIFT_REG_R3) -+#define BITS_REG_R3 (BIT_MASK_REG_R3 << BIT_SHIFT_REG_R3) -+#define BIT_CLEAR_REG_R3(x) ((x) & (~BITS_REG_R3)) -+#define BIT_GET_REG_R3(x) (((x) >> BIT_SHIFT_REG_R3) & BIT_MASK_REG_R3) -+#define BIT_SET_REG_R3(x, v) (BIT_CLEAR_REG_R3(x) | BIT_REG_R3(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_PSEN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_AC6Q_EMPTY BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_DOGENB BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_AC5Q_EMPTY BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_CP_V3 5 -+#define BIT_MASK_REG_CP_V3 0x3 -+#define BIT_REG_CP_V3(x) (((x) & BIT_MASK_REG_CP_V3) << BIT_SHIFT_REG_CP_V3) -+#define BITS_REG_CP_V3 (BIT_MASK_REG_CP_V3 << BIT_SHIFT_REG_CP_V3) -+#define BIT_CLEAR_REG_CP_V3(x) ((x) & (~BITS_REG_CP_V3)) -+#define BIT_GET_REG_CP_V3(x) (((x) >> BIT_SHIFT_REG_CP_V3) & BIT_MASK_REG_CP_V3) -+#define BIT_SET_REG_CP_V3(x, v) (BIT_CLEAR_REG_CP_V3(x) | BIT_REG_CP_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_CS 4 -+#define BIT_MASK_REG_CS 0x3 -+#define BIT_REG_CS(x) (((x) & BIT_MASK_REG_CS) << BIT_SHIFT_REG_CS) -+#define BITS_REG_CS (BIT_MASK_REG_CS << BIT_SHIFT_REG_CS) -+#define BIT_CLEAR_REG_CS(x) ((x) & (~BITS_REG_CS)) -+#define BIT_GET_REG_CS(x) (((x) >> BIT_SHIFT_REG_CS) & BIT_MASK_REG_CS) -+#define BIT_SET_REG_CS(x, v) (BIT_CLEAR_REG_CS(x) | BIT_REG_CS(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_AC4Q_EMPTY BIT(4) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_REG_MBIAS BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_AC3Q_EMPTY BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_C3_V3 3 -+#define BIT_MASK_REG_C3_V3 0x3 -+#define BIT_REG_C3_V3(x) (((x) & BIT_MASK_REG_C3_V3) << BIT_SHIFT_REG_C3_V3) -+#define BITS_REG_C3_V3 (BIT_MASK_REG_C3_V3 << BIT_SHIFT_REG_C3_V3) -+#define BIT_CLEAR_REG_C3_V3(x) ((x) & (~BITS_REG_C3_V3)) -+#define BIT_GET_REG_C3_V3(x) (((x) >> BIT_SHIFT_REG_C3_V3) & BIT_MASK_REG_C3_V3) -+#define BIT_SET_REG_C3_V3(x, v) (BIT_CLEAR_REG_C3_V3(x) | BIT_REG_C3_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_CP 2 -+#define BIT_MASK_REG_CP 0x3 -+#define BIT_REG_CP(x) (((x) & BIT_MASK_REG_CP) << BIT_SHIFT_REG_CP) -+#define BITS_REG_CP (BIT_MASK_REG_CP << BIT_SHIFT_REG_CP) -+#define BIT_CLEAR_REG_CP(x) ((x) & (~BITS_REG_CP)) -+#define BIT_GET_REG_CP(x) (((x) >> BIT_SHIFT_REG_CP) & BIT_MASK_REG_CP) -+#define BIT_SET_REG_CP(x, v) (BIT_CLEAR_REG_CP(x) | BIT_REG_CP(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_AC2Q_EMPTY BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_REG_320_SEL_V3 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_AC1Q_EMPTY BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_EN_SYN_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_R3_V4 1 -+#define BIT_MASK_REG_R3_V4 0x7 -+#define BIT_REG_R3_V4(x) (((x) & BIT_MASK_REG_R3_V4) << BIT_SHIFT_REG_R3_V4) -+#define BITS_REG_R3_V4 (BIT_MASK_REG_R3_V4 << BIT_SHIFT_REG_R3_V4) -+#define BIT_CLEAR_REG_R3_V4(x) ((x) & (~BITS_REG_R3_V4)) -+#define BIT_GET_REG_R3_V4(x) (((x) >> BIT_SHIFT_REG_R3_V4) & BIT_MASK_REG_R3_V4) -+#define BIT_SET_REG_R3_V4(x, v) (BIT_CLEAR_REG_R3_V4(x) | BIT_REG_R3_V4(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_SHIFT_REG_C3 0 -+#define BIT_MASK_REG_C3 0x3 -+#define BIT_REG_C3(x) (((x) & BIT_MASK_REG_C3) << BIT_SHIFT_REG_C3) -+#define BITS_REG_C3 (BIT_MASK_REG_C3 << BIT_SHIFT_REG_C3) -+#define BIT_CLEAR_REG_C3(x) ((x) & (~BITS_REG_C3)) -+#define BIT_GET_REG_C3(x) (((x) >> BIT_SHIFT_REG_C3) & BIT_MASK_REG_C3) -+#define BIT_SET_REG_C3(x, v) (BIT_CLEAR_REG_C3(x) | BIT_REG_C3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY (Offset 0x1025002C) */ -+ -+#define BIT_SDIO_AC0Q_EMPTY BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_IOOFFSET_BIT4 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL3 (Offset 0x002C) */ -+ -+#define BIT_REG_CP_BIT0 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_EFUSE_CTRL (Offset 0x0030) */ -+ -+#define BIT_EF_FLAG BIT(31) -+ -+#define BIT_SHIFT_EF_PGPD 28 -+#define BIT_MASK_EF_PGPD 0x7 -+#define BIT_EF_PGPD(x) (((x) & BIT_MASK_EF_PGPD) << BIT_SHIFT_EF_PGPD) -+#define BITS_EF_PGPD (BIT_MASK_EF_PGPD << BIT_SHIFT_EF_PGPD) -+#define BIT_CLEAR_EF_PGPD(x) ((x) & (~BITS_EF_PGPD)) -+#define BIT_GET_EF_PGPD(x) (((x) >> BIT_SHIFT_EF_PGPD) & BIT_MASK_EF_PGPD) -+#define BIT_SET_EF_PGPD(x, v) (BIT_CLEAR_EF_PGPD(x) | BIT_EF_PGPD(v)) -+ -+#define BIT_SHIFT_EF_RDT 24 -+#define BIT_MASK_EF_RDT 0xf -+#define BIT_EF_RDT(x) (((x) & BIT_MASK_EF_RDT) << BIT_SHIFT_EF_RDT) -+#define BITS_EF_RDT (BIT_MASK_EF_RDT << BIT_SHIFT_EF_RDT) -+#define BIT_CLEAR_EF_RDT(x) ((x) & (~BITS_EF_RDT)) -+#define BIT_GET_EF_RDT(x) (((x) >> BIT_SHIFT_EF_RDT) & BIT_MASK_EF_RDT) -+#define BIT_SET_EF_RDT(x, v) (BIT_CLEAR_EF_RDT(x) | BIT_EF_RDT(v)) -+ -+#define BIT_SHIFT_EF_PGTS 20 -+#define BIT_MASK_EF_PGTS 0xf -+#define BIT_EF_PGTS(x) (((x) & BIT_MASK_EF_PGTS) << BIT_SHIFT_EF_PGTS) -+#define BITS_EF_PGTS (BIT_MASK_EF_PGTS << BIT_SHIFT_EF_PGTS) -+#define BIT_CLEAR_EF_PGTS(x) ((x) & (~BITS_EF_PGTS)) -+#define BIT_GET_EF_PGTS(x) (((x) >> BIT_SHIFT_EF_PGTS) & BIT_MASK_EF_PGTS) -+#define BIT_SET_EF_PGTS(x, v) (BIT_CLEAR_EF_PGTS(x) | BIT_EF_PGTS(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_EFUSE_CTRL (Offset 0x0030) */ -+ -+#define BIT_EF_PDWN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_EFUSE_CTRL (Offset 0x0030) */ -+ -+#define BIT_EF_ALDEN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HTSFR_INFO (Offset 0x10250030) */ -+ -+#define BIT_SHIFT_HTSFR1 16 -+#define BIT_MASK_HTSFR1 0xffff -+#define BIT_HTSFR1(x) (((x) & BIT_MASK_HTSFR1) << BIT_SHIFT_HTSFR1) -+#define BITS_HTSFR1 (BIT_MASK_HTSFR1 << BIT_SHIFT_HTSFR1) -+#define BIT_CLEAR_HTSFR1(x) ((x) & (~BITS_HTSFR1)) -+#define BIT_GET_HTSFR1(x) (((x) >> BIT_SHIFT_HTSFR1) & BIT_MASK_HTSFR1) -+#define BIT_SET_HTSFR1(x, v) (BIT_CLEAR_HTSFR1(x) | BIT_HTSFR1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_EFUSE_CTRL (Offset 0x0030) */ -+ -+#define BIT_SHIFT_EF_ADDR 8 -+#define BIT_MASK_EF_ADDR 0x3ff -+#define BIT_EF_ADDR(x) (((x) & BIT_MASK_EF_ADDR) << BIT_SHIFT_EF_ADDR) -+#define BITS_EF_ADDR (BIT_MASK_EF_ADDR << BIT_SHIFT_EF_ADDR) -+#define BIT_CLEAR_EF_ADDR(x) ((x) & (~BITS_EF_ADDR)) -+#define BIT_GET_EF_ADDR(x) (((x) >> BIT_SHIFT_EF_ADDR) & BIT_MASK_EF_ADDR) -+#define BIT_SET_EF_ADDR(x, v) (BIT_CLEAR_EF_ADDR(x) | BIT_EF_ADDR(v)) -+ -+#define BIT_SHIFT_EF_DATA 0 -+#define BIT_MASK_EF_DATA 0xff -+#define BIT_EF_DATA(x) (((x) & BIT_MASK_EF_DATA) << BIT_SHIFT_EF_DATA) -+#define BITS_EF_DATA (BIT_MASK_EF_DATA << BIT_SHIFT_EF_DATA) -+#define BIT_CLEAR_EF_DATA(x) ((x) & (~BITS_EF_DATA)) -+#define BIT_GET_EF_DATA(x) (((x) >> BIT_SHIFT_EF_DATA) & BIT_MASK_EF_DATA) -+#define BIT_SET_EF_DATA(x, v) (BIT_CLEAR_EF_DATA(x) | BIT_EF_DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HTSFR_INFO (Offset 0x10250030) */ -+ -+#define BIT_SHIFT_HTSFR0 0 -+#define BIT_MASK_HTSFR0 0xffff -+#define BIT_HTSFR0(x) (((x) & BIT_MASK_HTSFR0) << BIT_SHIFT_HTSFR0) -+#define BITS_HTSFR0 (BIT_MASK_HTSFR0 << BIT_SHIFT_HTSFR0) -+#define BIT_CLEAR_HTSFR0(x) ((x) & (~BITS_HTSFR0)) -+#define BIT_GET_HTSFR0(x) (((x) >> BIT_SHIFT_HTSFR0) & BIT_MASK_HTSFR0) -+#define BIT_SET_HTSFR0(x, v) (BIT_CLEAR_HTSFR0(x) | BIT_HTSFR0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_LDOE25_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_SHIFT_LDOE25_VADJ_BIT0_TO_2 28 -+#define BIT_MASK_LDOE25_VADJ_BIT0_TO_2 0x7 -+#define BIT_LDOE25_VADJ_BIT0_TO_2(x) \ -+ (((x) & BIT_MASK_LDOE25_VADJ_BIT0_TO_2) \ -+ << BIT_SHIFT_LDOE25_VADJ_BIT0_TO_2) -+#define BITS_LDOE25_VADJ_BIT0_TO_2 \ -+ (BIT_MASK_LDOE25_VADJ_BIT0_TO_2 << BIT_SHIFT_LDOE25_VADJ_BIT0_TO_2) -+#define BIT_CLEAR_LDOE25_VADJ_BIT0_TO_2(x) ((x) & (~BITS_LDOE25_VADJ_BIT0_TO_2)) -+#define BIT_GET_LDOE25_VADJ_BIT0_TO_2(x) \ -+ (((x) >> BIT_SHIFT_LDOE25_VADJ_BIT0_TO_2) & \ -+ BIT_MASK_LDOE25_VADJ_BIT0_TO_2) -+#define BIT_SET_LDOE25_VADJ_BIT0_TO_2(x, v) \ -+ (BIT_CLEAR_LDOE25_VADJ_BIT0_TO_2(x) | BIT_LDOE25_VADJ_BIT0_TO_2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_SHIFT_LDOE25_V12ADJ_L_LOW 28 -+#define BIT_MASK_LDOE25_V12ADJ_L_LOW 0x7 -+#define BIT_LDOE25_V12ADJ_L_LOW(x) \ -+ (((x) & BIT_MASK_LDOE25_V12ADJ_L_LOW) << BIT_SHIFT_LDOE25_V12ADJ_L_LOW) -+#define BITS_LDOE25_V12ADJ_L_LOW \ -+ (BIT_MASK_LDOE25_V12ADJ_L_LOW << BIT_SHIFT_LDOE25_V12ADJ_L_LOW) -+#define BIT_CLEAR_LDOE25_V12ADJ_L_LOW(x) ((x) & (~BITS_LDOE25_V12ADJ_L_LOW)) -+#define BIT_GET_LDOE25_V12ADJ_L_LOW(x) \ -+ (((x) >> BIT_SHIFT_LDOE25_V12ADJ_L_LOW) & BIT_MASK_LDOE25_V12ADJ_L_LOW) -+#define BIT_SET_LDOE25_V12ADJ_L_LOW(x, v) \ -+ (BIT_CLEAR_LDOE25_V12ADJ_L_LOW(x) | BIT_LDOE25_V12ADJ_L_LOW(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_LDOE25_VADJ_BIT3 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_LDOE25_V12ADJ_L_HIGH BIT(27) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_SHIFT_LDOE25_V12ADJ_L 27 -+#define BIT_MASK_LDOE25_V12ADJ_L 0xf -+#define BIT_LDOE25_V12ADJ_L(x) \ -+ (((x) & BIT_MASK_LDOE25_V12ADJ_L) << BIT_SHIFT_LDOE25_V12ADJ_L) -+#define BITS_LDOE25_V12ADJ_L \ -+ (BIT_MASK_LDOE25_V12ADJ_L << BIT_SHIFT_LDOE25_V12ADJ_L) -+#define BIT_CLEAR_LDOE25_V12ADJ_L(x) ((x) & (~BITS_LDOE25_V12ADJ_L)) -+#define BIT_GET_LDOE25_V12ADJ_L(x) \ -+ (((x) >> BIT_SHIFT_LDOE25_V12ADJ_L) & BIT_MASK_LDOE25_V12ADJ_L) -+#define BIT_SET_LDOE25_V12ADJ_L(x, v) \ -+ (BIT_CLEAR_LDOE25_V12ADJ_L(x) | BIT_LDOE25_V12ADJ_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_SHIFT_LDOE25_VADJ_3_TO_0 27 -+#define BIT_MASK_LDOE25_VADJ_3_TO_0 0xf -+#define BIT_LDOE25_VADJ_3_TO_0(x) \ -+ (((x) & BIT_MASK_LDOE25_VADJ_3_TO_0) << BIT_SHIFT_LDOE25_VADJ_3_TO_0) -+#define BITS_LDOE25_VADJ_3_TO_0 \ -+ (BIT_MASK_LDOE25_VADJ_3_TO_0 << BIT_SHIFT_LDOE25_VADJ_3_TO_0) -+#define BIT_CLEAR_LDOE25_VADJ_3_TO_0(x) ((x) & (~BITS_LDOE25_VADJ_3_TO_0)) -+#define BIT_GET_LDOE25_VADJ_3_TO_0(x) \ -+ (((x) >> BIT_SHIFT_LDOE25_VADJ_3_TO_0) & BIT_MASK_LDOE25_VADJ_3_TO_0) -+#define BIT_SET_LDOE25_VADJ_3_TO_0(x, v) \ -+ (BIT_CLEAR_LDOE25_VADJ_3_TO_0(x) | BIT_LDOE25_VADJ_3_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_EFCRES_SEL BIT(26) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_EF_CRES_SEL BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_EF_CSER BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_SHIFT_EF_SCAN_START 16 -+#define BIT_MASK_EF_SCAN_START 0x1ff -+#define BIT_EF_SCAN_START(x) \ -+ (((x) & BIT_MASK_EF_SCAN_START) << BIT_SHIFT_EF_SCAN_START) -+#define BITS_EF_SCAN_START (BIT_MASK_EF_SCAN_START << BIT_SHIFT_EF_SCAN_START) -+#define BIT_CLEAR_EF_SCAN_START(x) ((x) & (~BITS_EF_SCAN_START)) -+#define BIT_GET_EF_SCAN_START(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_START) & BIT_MASK_EF_SCAN_START) -+#define BIT_SET_EF_SCAN_START(x, v) \ -+ (BIT_CLEAR_EF_SCAN_START(x) | BIT_EF_SCAN_START(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_SHIFT_EF_SCAN_START_V1 16 -+#define BIT_MASK_EF_SCAN_START_V1 0x3ff -+#define BIT_EF_SCAN_START_V1(x) \ -+ (((x) & BIT_MASK_EF_SCAN_START_V1) << BIT_SHIFT_EF_SCAN_START_V1) -+#define BITS_EF_SCAN_START_V1 \ -+ (BIT_MASK_EF_SCAN_START_V1 << BIT_SHIFT_EF_SCAN_START_V1) -+#define BIT_CLEAR_EF_SCAN_START_V1(x) ((x) & (~BITS_EF_SCAN_START_V1)) -+#define BIT_GET_EF_SCAN_START_V1(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_START_V1) & BIT_MASK_EF_SCAN_START_V1) -+#define BIT_SET_EF_SCAN_START_V1(x, v) \ -+ (BIT_CLEAR_EF_SCAN_START_V1(x) | BIT_EF_SCAN_START_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_SHIFT_EF_SCAN_END 12 -+#define BIT_MASK_EF_SCAN_END 0xf -+#define BIT_EF_SCAN_END(x) \ -+ (((x) & BIT_MASK_EF_SCAN_END) << BIT_SHIFT_EF_SCAN_END) -+#define BITS_EF_SCAN_END (BIT_MASK_EF_SCAN_END << BIT_SHIFT_EF_SCAN_END) -+#define BIT_CLEAR_EF_SCAN_END(x) ((x) & (~BITS_EF_SCAN_END)) -+#define BIT_GET_EF_SCAN_END(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_END) & BIT_MASK_EF_SCAN_END) -+#define BIT_SET_EF_SCAN_END(x, v) \ -+ (BIT_CLEAR_EF_SCAN_END(x) | BIT_EF_SCAN_END(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_EF_FORCE_PGMEN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_EF_PD_DIS BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_SCAN_EN BIT(11) -+#define BIT_SW_PG_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_SHIFT_EF_CELL_SEL 8 -+#define BIT_MASK_EF_CELL_SEL 0x3 -+#define BIT_EF_CELL_SEL(x) \ -+ (((x) & BIT_MASK_EF_CELL_SEL) << BIT_SHIFT_EF_CELL_SEL) -+#define BITS_EF_CELL_SEL (BIT_MASK_EF_CELL_SEL << BIT_SHIFT_EF_CELL_SEL) -+#define BIT_CLEAR_EF_CELL_SEL(x) ((x) & (~BITS_EF_CELL_SEL)) -+#define BIT_GET_EF_CELL_SEL(x) \ -+ (((x) >> BIT_SHIFT_EF_CELL_SEL) & BIT_MASK_EF_CELL_SEL) -+#define BIT_SET_EF_CELL_SEL(x, v) \ -+ (BIT_CLEAR_EF_CELL_SEL(x) | BIT_EF_CELL_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_EFUSE_CTRL (Offset 0x0034) */ -+ -+#define BIT_EF_TRPT BIT(7) -+ -+#define BIT_SHIFT_EF_TTHD 0 -+#define BIT_MASK_EF_TTHD 0x7f -+#define BIT_EF_TTHD(x) (((x) & BIT_MASK_EF_TTHD) << BIT_SHIFT_EF_TTHD) -+#define BITS_EF_TTHD (BIT_MASK_EF_TTHD << BIT_SHIFT_EF_TTHD) -+#define BIT_CLEAR_EF_TTHD(x) ((x) & (~BITS_EF_TTHD)) -+#define BIT_GET_EF_TTHD(x) (((x) >> BIT_SHIFT_EF_TTHD) & BIT_MASK_EF_TTHD) -+#define BIT_SET_EF_TTHD(x, v) (BIT_CLEAR_EF_TTHD(x) | BIT_EF_TTHD(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_UPHY_BG_ON_OPT 30 -+#define BIT_MASK_UPHY_BG_ON_OPT 0x3 -+#define BIT_UPHY_BG_ON_OPT(x) \ -+ (((x) & BIT_MASK_UPHY_BG_ON_OPT) << BIT_SHIFT_UPHY_BG_ON_OPT) -+#define BITS_UPHY_BG_ON_OPT \ -+ (BIT_MASK_UPHY_BG_ON_OPT << BIT_SHIFT_UPHY_BG_ON_OPT) -+#define BIT_CLEAR_UPHY_BG_ON_OPT(x) ((x) & (~BITS_UPHY_BG_ON_OPT)) -+#define BIT_GET_UPHY_BG_ON_OPT(x) \ -+ (((x) >> BIT_SHIFT_UPHY_BG_ON_OPT) & BIT_MASK_UPHY_BG_ON_OPT) -+#define BIT_SET_UPHY_BG_ON_OPT(x, v) \ -+ (BIT_CLEAR_UPHY_BG_ON_OPT(x) | BIT_UPHY_BG_ON_OPT(v)) -+ -+#define BIT_UPHY_BG_ON_USB2 BIT(29) -+#define BIT_UPHY_BG_ON_PCIE BIT(28) -+#define BIT_VD33IO_LEFT_SHD_N_ BIT(27) -+#define BIT_VDIO_RIGHT1_SHD_N_ BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_AFE_USB_CURRENT_SEL 26 -+#define BIT_MASK_AFE_USB_CURRENT_SEL 0x7 -+#define BIT_AFE_USB_CURRENT_SEL(x) \ -+ (((x) & BIT_MASK_AFE_USB_CURRENT_SEL) << BIT_SHIFT_AFE_USB_CURRENT_SEL) -+#define BITS_AFE_USB_CURRENT_SEL \ -+ (BIT_MASK_AFE_USB_CURRENT_SEL << BIT_SHIFT_AFE_USB_CURRENT_SEL) -+#define BIT_CLEAR_AFE_USB_CURRENT_SEL(x) ((x) & (~BITS_AFE_USB_CURRENT_SEL)) -+#define BIT_GET_AFE_USB_CURRENT_SEL(x) \ -+ (((x) >> BIT_SHIFT_AFE_USB_CURRENT_SEL) & BIT_MASK_AFE_USB_CURRENT_SEL) -+#define BIT_SET_AFE_USB_CURRENT_SEL(x, v) \ -+ (BIT_CLEAR_AFE_USB_CURRENT_SEL(x) | BIT_AFE_USB_CURRENT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_VDIO_RIGHT0_SHD_N_ BIT(25) -+#define BIT_DIS_LPS_WT_PDNSUS BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_AFE_USB_PATH_SEL 24 -+#define BIT_MASK_AFE_USB_PATH_SEL 0x3 -+#define BIT_AFE_USB_PATH_SEL(x) \ -+ (((x) & BIT_MASK_AFE_USB_PATH_SEL) << BIT_SHIFT_AFE_USB_PATH_SEL) -+#define BITS_AFE_USB_PATH_SEL \ -+ (BIT_MASK_AFE_USB_PATH_SEL << BIT_SHIFT_AFE_USB_PATH_SEL) -+#define BIT_CLEAR_AFE_USB_PATH_SEL(x) ((x) & (~BITS_AFE_USB_PATH_SEL)) -+#define BIT_GET_AFE_USB_PATH_SEL(x) \ -+ (((x) >> BIT_SHIFT_AFE_USB_PATH_SEL) & BIT_MASK_AFE_USB_PATH_SEL) -+#define BIT_SET_AFE_USB_PATH_SEL(x, v) \ -+ (BIT_CLEAR_AFE_USB_PATH_SEL(x) | BIT_AFE_USB_PATH_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_DBG_SEL_V1 16 -+#define BIT_MASK_DBG_SEL_V1 0xff -+#define BIT_DBG_SEL_V1(x) (((x) & BIT_MASK_DBG_SEL_V1) << BIT_SHIFT_DBG_SEL_V1) -+#define BITS_DBG_SEL_V1 (BIT_MASK_DBG_SEL_V1 << BIT_SHIFT_DBG_SEL_V1) -+#define BIT_CLEAR_DBG_SEL_V1(x) ((x) & (~BITS_DBG_SEL_V1)) -+#define BIT_GET_DBG_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_V1) & BIT_MASK_DBG_SEL_V1) -+#define BIT_SET_DBG_SEL_V1(x, v) (BIT_CLEAR_DBG_SEL_V1(x) | BIT_DBG_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_CLK_REQ_INPUT BIT(15) -+#define BIT_USB_XTAL_CLK_SEL BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_DBG_SEL_BYTE 14 -+#define BIT_MASK_DBG_SEL_BYTE 0x3 -+#define BIT_DBG_SEL_BYTE(x) \ -+ (((x) & BIT_MASK_DBG_SEL_BYTE) << BIT_SHIFT_DBG_SEL_BYTE) -+#define BITS_DBG_SEL_BYTE (BIT_MASK_DBG_SEL_BYTE << BIT_SHIFT_DBG_SEL_BYTE) -+#define BIT_CLEAR_DBG_SEL_BYTE(x) ((x) & (~BITS_DBG_SEL_BYTE)) -+#define BIT_GET_DBG_SEL_BYTE(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_BYTE) & BIT_MASK_DBG_SEL_BYTE) -+#define BIT_SET_DBG_SEL_BYTE(x, v) \ -+ (BIT_CLEAR_DBG_SEL_BYTE(x) | BIT_DBG_SEL_BYTE(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_USB_REG_XTAL_SEL BIT(14) -+#define BIT_SYSON_BTIO1POW_PAD_E2 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_SYSON_SPS0_STD_L1 12 -+#define BIT_MASK_SYSON_SPS0_STD_L1 0x3 -+#define BIT_SYSON_SPS0_STD_L1(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0_STD_L1) << BIT_SHIFT_SYSON_SPS0_STD_L1) -+#define BITS_SYSON_SPS0_STD_L1 \ -+ (BIT_MASK_SYSON_SPS0_STD_L1 << BIT_SHIFT_SYSON_SPS0_STD_L1) -+#define BIT_CLEAR_SYSON_SPS0_STD_L1(x) ((x) & (~BITS_SYSON_SPS0_STD_L1)) -+#define BIT_GET_SYSON_SPS0_STD_L1(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0_STD_L1) & BIT_MASK_SYSON_SPS0_STD_L1) -+#define BIT_SET_SYSON_SPS0_STD_L1(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0_STD_L1(x) | BIT_SYSON_SPS0_STD_L1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_STD_L1_V1 12 -+#define BIT_MASK_STD_L1_V1 0x3 -+#define BIT_STD_L1_V1(x) (((x) & BIT_MASK_STD_L1_V1) << BIT_SHIFT_STD_L1_V1) -+#define BITS_STD_L1_V1 (BIT_MASK_STD_L1_V1 << BIT_SHIFT_STD_L1_V1) -+#define BIT_CLEAR_STD_L1_V1(x) ((x) & (~BITS_STD_L1_V1)) -+#define BIT_GET_STD_L1_V1(x) (((x) >> BIT_SHIFT_STD_L1_V1) & BIT_MASK_STD_L1_V1) -+#define BIT_SET_STD_L1_V1(x, v) (BIT_CLEAR_STD_L1_V1(x) | BIT_STD_L1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SYSON_BTIOPOW_PAD_E2 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_SYSON_LDOA12V_WT 12 -+#define BIT_MASK_SYSON_LDOA12V_WT 0x3 -+#define BIT_SYSON_LDOA12V_WT(x) \ -+ (((x) & BIT_MASK_SYSON_LDOA12V_WT) << BIT_SHIFT_SYSON_LDOA12V_WT) -+#define BITS_SYSON_LDOA12V_WT \ -+ (BIT_MASK_SYSON_LDOA12V_WT << BIT_SHIFT_SYSON_LDOA12V_WT) -+#define BIT_CLEAR_SYSON_LDOA12V_WT(x) ((x) & (~BITS_SYSON_LDOA12V_WT)) -+#define BIT_GET_SYSON_LDOA12V_WT(x) \ -+ (((x) >> BIT_SHIFT_SYSON_LDOA12V_WT) & BIT_MASK_SYSON_LDOA12V_WT) -+#define BIT_SET_SYSON_LDOA12V_WT(x, v) \ -+ (BIT_CLEAR_SYSON_LDOA12V_WT(x) | BIT_SYSON_LDOA12V_WT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SYSON_DBG_PAD_E2 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SYSON_SDIOPOW_PAD_E2 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SYSON_LED_PAD_E2 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SYSON_GPEE_PAD_E2 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SYSON_GPEE_PAD_E2_V33 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SYSON_PCI_PAD_E2 BIT(8) -+ -+#define BIT_SHIFT_MATCH_CNT 8 -+#define BIT_MASK_MATCH_CNT 0xff -+#define BIT_MATCH_CNT(x) (((x) & BIT_MASK_MATCH_CNT) << BIT_SHIFT_MATCH_CNT) -+#define BITS_MATCH_CNT (BIT_MASK_MATCH_CNT << BIT_SHIFT_MATCH_CNT) -+#define BIT_CLEAR_MATCH_CNT(x) ((x) & (~BITS_MATCH_CNT)) -+#define BIT_GET_MATCH_CNT(x) (((x) >> BIT_SHIFT_MATCH_CNT) & BIT_MASK_MATCH_CNT) -+#define BIT_SET_MATCH_CNT(x, v) (BIT_CLEAR_MATCH_CNT(x) | BIT_MATCH_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_AUTO_SW_LDO_VOL_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_AUTO_SW_LDO_VOL_EN_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_ADJ_LDO_VOLT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_SYSON_LDOHCI12_WT 6 -+#define BIT_MASK_SYSON_LDOHCI12_WT 0x3 -+#define BIT_SYSON_LDOHCI12_WT(x) \ -+ (((x) & BIT_MASK_SYSON_LDOHCI12_WT) << BIT_SHIFT_SYSON_LDOHCI12_WT) -+#define BITS_SYSON_LDOHCI12_WT \ -+ (BIT_MASK_SYSON_LDOHCI12_WT << BIT_SHIFT_SYSON_LDOHCI12_WT) -+#define BIT_CLEAR_SYSON_LDOHCI12_WT(x) ((x) & (~BITS_SYSON_LDOHCI12_WT)) -+#define BIT_GET_SYSON_LDOHCI12_WT(x) \ -+ (((x) >> BIT_SHIFT_SYSON_LDOHCI12_WT) & BIT_MASK_SYSON_LDOHCI12_WT) -+#define BIT_SET_SYSON_LDOHCI12_WT(x, v) \ -+ (BIT_CLEAR_SYSON_LDOHCI12_WT(x) | BIT_SYSON_LDOHCI12_WT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_SYSON_SPS0WWV_WT 4 -+#define BIT_MASK_SYSON_SPS0WWV_WT 0x3 -+#define BIT_SYSON_SPS0WWV_WT(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0WWV_WT) << BIT_SHIFT_SYSON_SPS0WWV_WT) -+#define BITS_SYSON_SPS0WWV_WT \ -+ (BIT_MASK_SYSON_SPS0WWV_WT << BIT_SHIFT_SYSON_SPS0WWV_WT) -+#define BIT_CLEAR_SYSON_SPS0WWV_WT(x) ((x) & (~BITS_SYSON_SPS0WWV_WT)) -+#define BIT_GET_SYSON_SPS0WWV_WT(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0WWV_WT) & BIT_MASK_SYSON_SPS0WWV_WT) -+#define BIT_SET_SYSON_SPS0WWV_WT(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0WWV_WT(x) | BIT_SYSON_SPS0WWV_WT(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_SYSON_SPS0SPS_WT 4 -+#define BIT_MASK_SYSON_SPS0SPS_WT 0x3 -+#define BIT_SYSON_SPS0SPS_WT(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0SPS_WT) << BIT_SHIFT_SYSON_SPS0SPS_WT) -+#define BITS_SYSON_SPS0SPS_WT \ -+ (BIT_MASK_SYSON_SPS0SPS_WT << BIT_SHIFT_SYSON_SPS0SPS_WT) -+#define BIT_CLEAR_SYSON_SPS0SPS_WT(x) ((x) & (~BITS_SYSON_SPS0SPS_WT)) -+#define BIT_GET_SYSON_SPS0SPS_WT(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0SPS_WT) & BIT_MASK_SYSON_SPS0SPS_WT) -+#define BIT_SET_SYSON_SPS0SPS_WT(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0SPS_WT(x) | BIT_SYSON_SPS0SPS_WT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_SYSON_SPS0LDO_WT 2 -+#define BIT_MASK_SYSON_SPS0LDO_WT 0x3 -+#define BIT_SYSON_SPS0LDO_WT(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0LDO_WT) << BIT_SHIFT_SYSON_SPS0LDO_WT) -+#define BITS_SYSON_SPS0LDO_WT \ -+ (BIT_MASK_SYSON_SPS0LDO_WT << BIT_SHIFT_SYSON_SPS0LDO_WT) -+#define BIT_CLEAR_SYSON_SPS0LDO_WT(x) ((x) & (~BITS_SYSON_SPS0LDO_WT)) -+#define BIT_GET_SYSON_SPS0LDO_WT(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0LDO_WT) & BIT_MASK_SYSON_SPS0LDO_WT) -+#define BIT_SET_SYSON_SPS0LDO_WT(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0LDO_WT(x) | BIT_SYSON_SPS0LDO_WT(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_SYSON_SPS11VLDO_WT 2 -+#define BIT_MASK_SYSON_SPS11VLDO_WT 0x3 -+#define BIT_SYSON_SPS11VLDO_WT(x) \ -+ (((x) & BIT_MASK_SYSON_SPS11VLDO_WT) << BIT_SHIFT_SYSON_SPS11VLDO_WT) -+#define BITS_SYSON_SPS11VLDO_WT \ -+ (BIT_MASK_SYSON_SPS11VLDO_WT << BIT_SHIFT_SYSON_SPS11VLDO_WT) -+#define BIT_CLEAR_SYSON_SPS11VLDO_WT(x) ((x) & (~BITS_SYSON_SPS11VLDO_WT)) -+#define BIT_GET_SYSON_SPS11VLDO_WT(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS11VLDO_WT) & BIT_MASK_SYSON_SPS11VLDO_WT) -+#define BIT_SET_SYSON_SPS11VLDO_WT(x, v) \ -+ (BIT_CLEAR_SYSON_SPS11VLDO_WT(x) | BIT_SYSON_SPS11VLDO_WT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PWR_OPTION_CTRL (Offset 0x0038) */ -+ -+#define BIT_SHIFT_SYSON_RCLK_SCALE 0 -+#define BIT_MASK_SYSON_RCLK_SCALE 0x3 -+#define BIT_SYSON_RCLK_SCALE(x) \ -+ (((x) & BIT_MASK_SYSON_RCLK_SCALE) << BIT_SHIFT_SYSON_RCLK_SCALE) -+#define BITS_SYSON_RCLK_SCALE \ -+ (BIT_MASK_SYSON_RCLK_SCALE << BIT_SHIFT_SYSON_RCLK_SCALE) -+#define BIT_CLEAR_SYSON_RCLK_SCALE(x) ((x) & (~BITS_SYSON_RCLK_SCALE)) -+#define BIT_GET_SYSON_RCLK_SCALE(x) \ -+ (((x) >> BIT_SHIFT_SYSON_RCLK_SCALE) & BIT_MASK_SYSON_RCLK_SCALE) -+#define BIT_SET_SYSON_RCLK_SCALE(x, v) \ -+ (BIT_CLEAR_SYSON_RCLK_SCALE(x) | BIT_SYSON_RCLK_SCALE(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HCPWM1_V2 (Offset 0x10250038) */ -+ -+#define BIT_CUR_PS BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CAL_TIMER (Offset 0x003C) */ -+ -+#define BIT_SHIFT_CAL_SCAL 0 -+#define BIT_MASK_CAL_SCAL 0xff -+#define BIT_CAL_SCAL(x) (((x) & BIT_MASK_CAL_SCAL) << BIT_SHIFT_CAL_SCAL) -+#define BITS_CAL_SCAL (BIT_MASK_CAL_SCAL << BIT_SHIFT_CAL_SCAL) -+#define BIT_CLEAR_CAL_SCAL(x) ((x) & (~BITS_CAL_SCAL)) -+#define BIT_GET_CAL_SCAL(x) (((x) >> BIT_SHIFT_CAL_SCAL) & BIT_MASK_CAL_SCAL) -+#define BIT_SET_CAL_SCAL(x, v) (BIT_CLEAR_CAL_SCAL(x) | BIT_CAL_SCAL(v)) -+ -+/* 2 REG_ACLK_MON (Offset 0x003E) */ -+ -+#define BIT_SHIFT_RCLK_MON 5 -+#define BIT_MASK_RCLK_MON 0x7ff -+#define BIT_RCLK_MON(x) (((x) & BIT_MASK_RCLK_MON) << BIT_SHIFT_RCLK_MON) -+#define BITS_RCLK_MON (BIT_MASK_RCLK_MON << BIT_SHIFT_RCLK_MON) -+#define BIT_CLEAR_RCLK_MON(x) ((x) & (~BITS_RCLK_MON)) -+#define BIT_GET_RCLK_MON(x) (((x) >> BIT_SHIFT_RCLK_MON) & BIT_MASK_RCLK_MON) -+#define BIT_SET_RCLK_MON(x, v) (BIT_CLEAR_RCLK_MON(x) | BIT_RCLK_MON(v)) -+ -+#define BIT_CAL_EN BIT(4) -+ -+#define BIT_SHIFT_DPSTU 2 -+#define BIT_MASK_DPSTU 0x3 -+#define BIT_DPSTU(x) (((x) & BIT_MASK_DPSTU) << BIT_SHIFT_DPSTU) -+#define BITS_DPSTU (BIT_MASK_DPSTU << BIT_SHIFT_DPSTU) -+#define BIT_CLEAR_DPSTU(x) ((x) & (~BITS_DPSTU)) -+#define BIT_GET_DPSTU(x) (((x) >> BIT_SHIFT_DPSTU) & BIT_MASK_DPSTU) -+#define BIT_SET_DPSTU(x, v) (BIT_CLEAR_DPSTU(x) | BIT_DPSTU(v)) -+ -+#define BIT_SUS_16X BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ACLK_MON (Offset 0x003E) */ -+ -+#define BIT_RSM_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG_2 (Offset 0x003F) */ -+ -+#define BIT_SOUT_GPIO8 BIT(7) -+#define BIT_SOUT_GPIO5 BIT(6) -+#define BIT_RFE_CTRL_5_GPIO14_V1 BIT(5) -+#define BIT_RFE_CTRL_10_GPIO13_V1 BIT(4) -+#define BIT_RFE_CTRL_11_GPIO4_V1 BIT(3) -+#define BIT_RFE_CTRL_5_GPIO14 BIT(2) -+#define BIT_RFE_CTRL_10_GPIO13 BIT(1) -+#define BIT_RFE_CTRL_11_GPIO4 BIT(0) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_RFE_CTRL_3_GPIO12 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PAD_D_PAPE_2G_E BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_BT_RFE_CTRL_5_GPIO12 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PAD_D_PAPE_5G_E BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_SIC_LOWEST_PRIORITY_V1 BIT(29) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_S0_TRSW_GPIO12 BIT(29) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PAD_D_TRSW_E BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_SIC_PRI_LOWEST BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_SIC_LOWEST_PRIORITY BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_RFE_CTRL_9_GPIO13 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PAD_D_TRSWB_E BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WL_DSS_RSTN BIT(27) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_RFE_CTRL_9_GPIO12 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PAD_D_PAPE_2G_O BIT(27) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WL_DSS_EN_CLK BIT(26) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_RFE_CTRL_8_GPIO4 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PAD_D_PAPE_5G_O BIT(26) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_BT_RFE_CTRL_1_GPIO13 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PAD_D_TRSW_O BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_SHIFT_PIN_USECASE 24 -+#define BIT_MASK_PIN_USECASE 0xf -+#define BIT_PIN_USECASE(x) \ -+ (((x) & BIT_MASK_PIN_USECASE) << BIT_SHIFT_PIN_USECASE) -+#define BITS_PIN_USECASE (BIT_MASK_PIN_USECASE << BIT_SHIFT_PIN_USECASE) -+#define BIT_CLEAR_PIN_USECASE(x) ((x) & (~BITS_PIN_USECASE)) -+#define BIT_GET_PIN_USECASE(x) \ -+ (((x) >> BIT_SHIFT_PIN_USECASE) & BIT_MASK_PIN_USECASE) -+#define BIT_SET_PIN_USECASE(x, v) \ -+ (BIT_CLEAR_PIN_USECASE(x) | BIT_PIN_USECASE(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_SHIFT_PIN_USECASE_V1 24 -+#define BIT_MASK_PIN_USECASE_V1 0x1f -+#define BIT_PIN_USECASE_V1(x) \ -+ (((x) & BIT_MASK_PIN_USECASE_V1) << BIT_SHIFT_PIN_USECASE_V1) -+#define BITS_PIN_USECASE_V1 \ -+ (BIT_MASK_PIN_USECASE_V1 << BIT_SHIFT_PIN_USECASE_V1) -+#define BIT_CLEAR_PIN_USECASE_V1(x) ((x) & (~BITS_PIN_USECASE_V1)) -+#define BIT_GET_PIN_USECASE_V1(x) \ -+ (((x) >> BIT_SHIFT_PIN_USECASE_V1) & BIT_MASK_PIN_USECASE_V1) -+#define BIT_SET_PIN_USECASE_V1(x, v) \ -+ (BIT_CLEAR_PIN_USECASE_V1(x) | BIT_PIN_USECASE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_BT_RFE_CTRL_1_GPIO12 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PAD_D_TRSWB_O BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EN_DATACPU_GPIO2 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_BT_RFE_CTRL_0_GPIO4 BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EN_A_ANTSEL BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EN_DATACPU_GPIO BIT(23) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_ANTSW_GPIO13 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EN_A_ANTSELB BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EN_DATACPU_UART BIT(22) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_ANTSW_GPIO12 BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EN_D_PAPE_2G BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_DATACPU_FSPI_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_INDIRECT_REG_CFG (Offset 0x10250040) */ -+ -+#define BIT_INDIRECT_REG_RDY BIT(20) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_ANTSWB_GPIO4 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EN_D_PAPE_5G BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EN_GPIO8_UART_OUT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_FSPI_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_SW_IO_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_INDIRECT_REG_CFG (Offset 0x10250040) */ -+ -+#define BIT_INDIRECT_REG_R BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WL_RTS_EXT_32K_SEL BIT(18) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_INDIRECT_REG_CFG (Offset 0x10250040) */ -+ -+#define BIT_INDIRECT_REG_W BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_CKOUT33_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WLBT_DPDT_SEL_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_XTAL_OUT_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WLGP_SPI_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WLGP_CKOUT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_INDIRECT_REG_CFG (Offset 0x10250040) */ -+ -+#define BIT_SHIFT_INDIRECT_REG_SIZE 16 -+#define BIT_MASK_INDIRECT_REG_SIZE 0x3 -+#define BIT_INDIRECT_REG_SIZE(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_SIZE) << BIT_SHIFT_INDIRECT_REG_SIZE) -+#define BITS_INDIRECT_REG_SIZE \ -+ (BIT_MASK_INDIRECT_REG_SIZE << BIT_SHIFT_INDIRECT_REG_SIZE) -+#define BIT_CLEAR_INDIRECT_REG_SIZE(x) ((x) & (~BITS_INDIRECT_REG_SIZE)) -+#define BIT_GET_INDIRECT_REG_SIZE(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_SIZE) & BIT_MASK_INDIRECT_REG_SIZE) -+#define BIT_SET_INDIRECT_REG_SIZE(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_SIZE(x) | BIT_INDIRECT_REG_SIZE(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WLBT_LNAON_SEL_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_SIC_LBK BIT(15) -+#define BIT_ENHTP BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PHY_TEST_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WLPHY_DBG_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_BT_AOD_GPIO3 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_SIC_23 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_ENSIC BIT(12) -+#define BIT_SIC_SWRST BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PO_WIFI_PTA_PINS BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_ENPMAC BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_ENBTCMD BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_COEX_MBOX BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_BTCOEX_MBOX_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_PO_BT_PTA_PINS BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_BTCMD_OUT_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_ENUART BIT(8) -+ -+#define BIT_SHIFT_BTMODE 6 -+#define BIT_MASK_BTMODE 0x3 -+#define BIT_BTMODE(x) (((x) & BIT_MASK_BTMODE) << BIT_SHIFT_BTMODE) -+#define BITS_BTMODE (BIT_MASK_BTMODE << BIT_SHIFT_BTMODE) -+#define BIT_CLEAR_BTMODE(x) ((x) & (~BITS_BTMODE)) -+#define BIT_GET_BTMODE(x) (((x) >> BIT_SHIFT_BTMODE) & BIT_MASK_BTMODE) -+#define BIT_SET_BTMODE(x, v) (BIT_CLEAR_BTMODE(x) | BIT_BTMODE(v)) -+ -+#define BIT_ENBT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_GEN1GEN2_SWITCH BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EROM_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_ENUARTTX BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WLRFE_6_7_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WLRFE_12_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EN_D_TRSW BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_WLRFE_4_5_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_SPDT_SEL BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_EN_D_TRSWB BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_MUXCFG (Offset 0x0040) */ -+ -+#define BIT_SHIFT_GPIOSEL 0 -+#define BIT_MASK_GPIOSEL 0x3 -+#define BIT_GPIOSEL(x) (((x) & BIT_MASK_GPIOSEL) << BIT_SHIFT_GPIOSEL) -+#define BITS_GPIOSEL (BIT_MASK_GPIOSEL << BIT_SHIFT_GPIOSEL) -+#define BIT_CLEAR_GPIOSEL(x) ((x) & (~BITS_GPIOSEL)) -+#define BIT_GET_GPIOSEL(x) (((x) >> BIT_SHIFT_GPIOSEL) & BIT_MASK_GPIOSEL) -+#define BIT_SET_GPIOSEL(x, v) (BIT_CLEAR_GPIOSEL(x) | BIT_GPIOSEL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_INDIRECT_REG_CFG (Offset 0x10250040) */ -+ -+#define BIT_SHIFT_INDIRECT_REG_ADDR 0 -+#define BIT_MASK_INDIRECT_REG_ADDR 0xffff -+#define BIT_INDIRECT_REG_ADDR(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_ADDR) << BIT_SHIFT_INDIRECT_REG_ADDR) -+#define BITS_INDIRECT_REG_ADDR \ -+ (BIT_MASK_INDIRECT_REG_ADDR << BIT_SHIFT_INDIRECT_REG_ADDR) -+#define BIT_CLEAR_INDIRECT_REG_ADDR(x) ((x) & (~BITS_INDIRECT_REG_ADDR)) -+#define BIT_GET_INDIRECT_REG_ADDR(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_ADDR) & BIT_MASK_INDIRECT_REG_ADDR) -+#define BIT_SET_INDIRECT_REG_ADDR(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_ADDR(x) | BIT_INDIRECT_REG_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_PIN_CTRL (Offset 0x0044) */ -+ -+#define BIT_SHIFT_GPIO_MOD_7_TO_0 24 -+#define BIT_MASK_GPIO_MOD_7_TO_0 0xff -+#define BIT_GPIO_MOD_7_TO_0(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_7_TO_0) << BIT_SHIFT_GPIO_MOD_7_TO_0) -+#define BITS_GPIO_MOD_7_TO_0 \ -+ (BIT_MASK_GPIO_MOD_7_TO_0 << BIT_SHIFT_GPIO_MOD_7_TO_0) -+#define BIT_CLEAR_GPIO_MOD_7_TO_0(x) ((x) & (~BITS_GPIO_MOD_7_TO_0)) -+#define BIT_GET_GPIO_MOD_7_TO_0(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_7_TO_0) & BIT_MASK_GPIO_MOD_7_TO_0) -+#define BIT_SET_GPIO_MOD_7_TO_0(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_7_TO_0(x) | BIT_GPIO_MOD_7_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_GPIO_PIN_CTRL (Offset 0x0044) */ -+ -+#define BIT_SHIFT_WLGP1_SWIOMOD 24 -+#define BIT_MASK_WLGP1_SWIOMOD 0xff -+#define BIT_WLGP1_SWIOMOD(x) \ -+ (((x) & BIT_MASK_WLGP1_SWIOMOD) << BIT_SHIFT_WLGP1_SWIOMOD) -+#define BITS_WLGP1_SWIOMOD (BIT_MASK_WLGP1_SWIOMOD << BIT_SHIFT_WLGP1_SWIOMOD) -+#define BIT_CLEAR_WLGP1_SWIOMOD(x) ((x) & (~BITS_WLGP1_SWIOMOD)) -+#define BIT_GET_WLGP1_SWIOMOD(x) \ -+ (((x) >> BIT_SHIFT_WLGP1_SWIOMOD) & BIT_MASK_WLGP1_SWIOMOD) -+#define BIT_SET_WLGP1_SWIOMOD(x, v) \ -+ (BIT_CLEAR_WLGP1_SWIOMOD(x) | BIT_WLGP1_SWIOMOD(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_PIN_CTRL (Offset 0x0044) */ -+ -+#define BIT_SHIFT_GPIO_IO_SEL_7_TO_0 16 -+#define BIT_MASK_GPIO_IO_SEL_7_TO_0 0xff -+#define BIT_GPIO_IO_SEL_7_TO_0(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_7_TO_0) << BIT_SHIFT_GPIO_IO_SEL_7_TO_0) -+#define BITS_GPIO_IO_SEL_7_TO_0 \ -+ (BIT_MASK_GPIO_IO_SEL_7_TO_0 << BIT_SHIFT_GPIO_IO_SEL_7_TO_0) -+#define BIT_CLEAR_GPIO_IO_SEL_7_TO_0(x) ((x) & (~BITS_GPIO_IO_SEL_7_TO_0)) -+#define BIT_GET_GPIO_IO_SEL_7_TO_0(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_7_TO_0) & BIT_MASK_GPIO_IO_SEL_7_TO_0) -+#define BIT_SET_GPIO_IO_SEL_7_TO_0(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_7_TO_0(x) | BIT_GPIO_IO_SEL_7_TO_0(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_7_TO_0 8 -+#define BIT_MASK_GPIO_OUT_7_TO_0 0xff -+#define BIT_GPIO_OUT_7_TO_0(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_7_TO_0) << BIT_SHIFT_GPIO_OUT_7_TO_0) -+#define BITS_GPIO_OUT_7_TO_0 \ -+ (BIT_MASK_GPIO_OUT_7_TO_0 << BIT_SHIFT_GPIO_OUT_7_TO_0) -+#define BIT_CLEAR_GPIO_OUT_7_TO_0(x) ((x) & (~BITS_GPIO_OUT_7_TO_0)) -+#define BIT_GET_GPIO_OUT_7_TO_0(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_7_TO_0) & BIT_MASK_GPIO_OUT_7_TO_0) -+#define BIT_SET_GPIO_OUT_7_TO_0(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_7_TO_0(x) | BIT_GPIO_OUT_7_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_PIN_CTRL (Offset 0x0044) */ -+ -+#define BIT_SHIFT_GPIO_IN_7_TO_0 0 -+#define BIT_MASK_GPIO_IN_7_TO_0 0xff -+#define BIT_GPIO_IN_7_TO_0(x) \ -+ (((x) & BIT_MASK_GPIO_IN_7_TO_0) << BIT_SHIFT_GPIO_IN_7_TO_0) -+#define BITS_GPIO_IN_7_TO_0 \ -+ (BIT_MASK_GPIO_IN_7_TO_0 << BIT_SHIFT_GPIO_IN_7_TO_0) -+#define BIT_CLEAR_GPIO_IN_7_TO_0(x) ((x) & (~BITS_GPIO_IN_7_TO_0)) -+#define BIT_GET_GPIO_IN_7_TO_0(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_7_TO_0) & BIT_MASK_GPIO_IN_7_TO_0) -+#define BIT_SET_GPIO_IN_7_TO_0(x, v) \ -+ (BIT_CLEAR_GPIO_IN_7_TO_0(x) | BIT_GPIO_IN_7_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_INDIRECT_REG_DATA (Offset 0x10250044) */ -+ -+#define BIT_SHIFT_INDIRECT_REG_DATA 0 -+#define BIT_MASK_INDIRECT_REG_DATA 0xffffffffL -+#define BIT_INDIRECT_REG_DATA(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_DATA) << BIT_SHIFT_INDIRECT_REG_DATA) -+#define BITS_INDIRECT_REG_DATA \ -+ (BIT_MASK_INDIRECT_REG_DATA << BIT_SHIFT_INDIRECT_REG_DATA) -+#define BIT_CLEAR_INDIRECT_REG_DATA(x) ((x) & (~BITS_INDIRECT_REG_DATA)) -+#define BIT_GET_INDIRECT_REG_DATA(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_DATA) & BIT_MASK_INDIRECT_REG_DATA) -+#define BIT_SET_INDIRECT_REG_DATA(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_DATA(x) | BIT_INDIRECT_REG_DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_SHIFT_MUXDBG_SEL 30 -+#define BIT_MASK_MUXDBG_SEL 0x3 -+#define BIT_MUXDBG_SEL(x) (((x) & BIT_MASK_MUXDBG_SEL) << BIT_SHIFT_MUXDBG_SEL) -+#define BITS_MUXDBG_SEL (BIT_MASK_MUXDBG_SEL << BIT_SHIFT_MUXDBG_SEL) -+#define BIT_CLEAR_MUXDBG_SEL(x) ((x) & (~BITS_MUXDBG_SEL)) -+#define BIT_GET_MUXDBG_SEL(x) \ -+ (((x) >> BIT_SHIFT_MUXDBG_SEL) & BIT_MASK_MUXDBG_SEL) -+#define BIT_SET_MUXDBG_SEL(x, v) (BIT_CLEAR_MUXDBG_SEL(x) | BIT_MUXDBG_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_PCI_LPS_LDACT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_SHIFT_MUXDBG_SEL2 28 -+#define BIT_MASK_MUXDBG_SEL2 0x3 -+#define BIT_MUXDBG_SEL2(x) \ -+ (((x) & BIT_MASK_MUXDBG_SEL2) << BIT_SHIFT_MUXDBG_SEL2) -+#define BITS_MUXDBG_SEL2 (BIT_MASK_MUXDBG_SEL2 << BIT_SHIFT_MUXDBG_SEL2) -+#define BIT_CLEAR_MUXDBG_SEL2(x) ((x) & (~BITS_MUXDBG_SEL2)) -+#define BIT_GET_MUXDBG_SEL2(x) \ -+ (((x) >> BIT_SHIFT_MUXDBG_SEL2) & BIT_MASK_MUXDBG_SEL2) -+#define BIT_SET_MUXDBG_SEL2(x, v) \ -+ (BIT_CLEAR_MUXDBG_SEL2(x) | BIT_MUXDBG_SEL2(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_GPIO_EXT_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_EXTWOL1_SEL BIT(19) -+#define BIT_EXTWOL1_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_EXTWOL0_SEL BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_BT_EXTWOL_DIS BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_EXTWOL_SEL BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_EXTWOL0_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_EXTWOL_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_SHIFT_GPIO_EXT_WOL_V1 16 -+#define BIT_MASK_GPIO_EXT_WOL_V1 0xf -+#define BIT_GPIO_EXT_WOL_V1(x) \ -+ (((x) & BIT_MASK_GPIO_EXT_WOL_V1) << BIT_SHIFT_GPIO_EXT_WOL_V1) -+#define BITS_GPIO_EXT_WOL_V1 \ -+ (BIT_MASK_GPIO_EXT_WOL_V1 << BIT_SHIFT_GPIO_EXT_WOL_V1) -+#define BIT_CLEAR_GPIO_EXT_WOL_V1(x) ((x) & (~BITS_GPIO_EXT_WOL_V1)) -+#define BIT_GET_GPIO_EXT_WOL_V1(x) \ -+ (((x) >> BIT_SHIFT_GPIO_EXT_WOL_V1) & BIT_MASK_GPIO_EXT_WOL_V1) -+#define BIT_SET_GPIO_EXT_WOL_V1(x, v) \ -+ (BIT_CLEAR_GPIO_EXT_WOL_V1(x) | BIT_GPIO_EXT_WOL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_INTM (Offset 0x0048) */ -+ -+#define BIT_GPIOF_INT_MD BIT(15) -+#define BIT_GPIOE_INT_MD BIT(14) -+#define BIT_GPIOD_INT_MD BIT(13) -+#define BIT_GPIOC_INT_MD BIT(12) -+#define BIT_GPIOB_INT_MD BIT(11) -+#define BIT_GPIOA_INT_MD BIT(10) -+#define BIT_GPIO9_INT_MD BIT(9) -+#define BIT_GPIO8_INT_MD BIT(8) -+#define BIT_GPIO7_INT_MD BIT(7) -+#define BIT_GPIO6_INT_MD BIT(6) -+#define BIT_GPIO5_INT_MD BIT(5) -+#define BIT_GPIO4_INT_MD BIT(4) -+#define BIT_GPIO3_INT_MD BIT(3) -+#define BIT_GPIO2_INT_MD BIT(2) -+#define BIT_GPIO1_INT_MD BIT(1) -+#define BIT_GPIO0_INT_MD BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_MAILBOX_1WIRE_GPIO_CFG BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_PAD_ANTSEL_I BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_ANT_SEL7_EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_BT_RF_GPIO_CFG BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_PAD_ANTSELB_I BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_ANT_SEL46_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_BT_SDIO_INT_GPIO_CFG BIT(29) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_PAD_D_PAPE_2G_I BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_ANT_SEL3_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_MAILBOX_3WIRE_GPIO_CFG BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_PAD_D_PAPE_5G_I BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_TRSW_SEL_EN BIT(27) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_WLBT_PAPE_SEL_EN BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_PAD_D_TRSW_I BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_GPIO3_WL_CTRL_EN BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_PAPE1_SEL_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_LNAON_SEL_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_PAD_D_TRSWB_I BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_PAPE0_SEL_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_PAPE_SEL_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_DWH_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_ANTSEL2_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_ANT01_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_DPDT_WLBT_SEL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_DHW_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_RFE_ANT_EXT_SEL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_ANTSEL_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_DPDT_SEL_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_GPIO13_14_WL_CTRL_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_SW_SPDT_SEL BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_LED2DIS_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_TRXIQ_DBG_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_LED2DIS BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_LED0_GPIO_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_LED2EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_LED2PL BIT(20) -+#define BIT_LED2SV BIT(19) -+ -+#define BIT_SHIFT_LED2CM 16 -+#define BIT_MASK_LED2CM 0x7 -+#define BIT_LED2CM(x) (((x) & BIT_MASK_LED2CM) << BIT_SHIFT_LED2CM) -+#define BITS_LED2CM (BIT_MASK_LED2CM << BIT_SHIFT_LED2CM) -+#define BIT_CLEAR_LED2CM(x) ((x) & (~BITS_LED2CM)) -+#define BIT_GET_LED2CM(x) (((x) >> BIT_SHIFT_LED2CM) & BIT_MASK_LED2CM) -+#define BIT_SET_LED2CM(x, v) (BIT_CLEAR_LED2CM(x) | BIT_LED2CM(v)) -+ -+#define BIT_LED1DIS BIT(15) -+#define BIT_LED1PL BIT(12) -+#define BIT_LED1SV BIT(11) -+ -+#define BIT_SHIFT_LED1CM 8 -+#define BIT_MASK_LED1CM 0x7 -+#define BIT_LED1CM(x) (((x) & BIT_MASK_LED1CM) << BIT_SHIFT_LED1CM) -+#define BITS_LED1CM (BIT_MASK_LED1CM << BIT_SHIFT_LED1CM) -+#define BIT_CLEAR_LED1CM(x) ((x) & (~BITS_LED1CM)) -+#define BIT_GET_LED1CM(x) (((x) >> BIT_SHIFT_LED1CM) & BIT_MASK_LED1CM) -+#define BIT_SET_LED1CM(x, v) (BIT_CLEAR_LED1CM(x) | BIT_LED1CM(v)) -+ -+#define BIT_LED0DIS BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_SHIFT_AFE_LDO_SWR_CHECK 5 -+#define BIT_MASK_AFE_LDO_SWR_CHECK 0x3 -+#define BIT_AFE_LDO_SWR_CHECK(x) \ -+ (((x) & BIT_MASK_AFE_LDO_SWR_CHECK) << BIT_SHIFT_AFE_LDO_SWR_CHECK) -+#define BITS_AFE_LDO_SWR_CHECK \ -+ (BIT_MASK_AFE_LDO_SWR_CHECK << BIT_SHIFT_AFE_LDO_SWR_CHECK) -+#define BIT_CLEAR_AFE_LDO_SWR_CHECK(x) ((x) & (~BITS_AFE_LDO_SWR_CHECK)) -+#define BIT_GET_AFE_LDO_SWR_CHECK(x) \ -+ (((x) >> BIT_SHIFT_AFE_LDO_SWR_CHECK) & BIT_MASK_AFE_LDO_SWR_CHECK) -+#define BIT_SET_AFE_LDO_SWR_CHECK(x, v) \ -+ (BIT_CLEAR_AFE_LDO_SWR_CHECK(x) | BIT_AFE_LDO_SWR_CHECK(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+ -+#define BIT_LED0PL BIT(4) -+#define BIT_LED0SV BIT(3) -+ -+#define BIT_SHIFT_LED0CM 0 -+#define BIT_MASK_LED0CM 0x7 -+#define BIT_LED0CM(x) (((x) & BIT_MASK_LED0CM) << BIT_SHIFT_LED0CM) -+#define BITS_LED0CM (BIT_MASK_LED0CM << BIT_SHIFT_LED0CM) -+#define BIT_CLEAR_LED0CM(x) ((x) & (~BITS_LED0CM)) -+#define BIT_GET_LED0CM(x) (((x) >> BIT_SHIFT_LED0CM) & BIT_MASK_LED0CM) -+#define BIT_SET_LED0CM(x, v) (BIT_CLEAR_LED0CM(x) | BIT_LED0CM(v)) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_PDNINT_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_NFC_INT_PAD_EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_SPS_OCP_INT_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_SW_SPS_OCP_INT_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_PWMERR_INT_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_PWM_HW_ERR_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIOF_INT_EN BIT(27) -+#define BIT_FS_GPIOE_INT_EN BIT(26) -+#define BIT_FS_GPIOD_INT_EN BIT(25) -+#define BIT_FS_GPIOC_INT_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_ACT2RECOVERY_INT_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIOB_INT_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_PCIE_GEN12_SWITCH_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIOA_INT_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_HCI_SUS_EN_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO9_INT_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_HCI_RES_EN_V1 BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO8_INT_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_HCI_RESET_EN_V1 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO7_INT_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_32K_LEAVE_SETTING_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO6_INT_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_32K_ENTER_SETTING_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO5_INT_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_SIE_LPM_RSM_EN_V1 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO4_INT_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_SIE_LPM_ACT_EN_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO3_INT_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIOF_INT_EN_V1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO2_INT_EN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIOE_INT_EN_V1 BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO1_INT_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIOD_INT_EN_V1 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO0_INT_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIOC_INT_EN_V1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_HCI_SUS_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIOB_INT_EN_V1 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_HCI_RES_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIOA_INT_EN_V1 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_HCI_RESET_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO9_INT_EN_V1 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_AXI_EXCEPT_FINT_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_USB_SCSI_CMD_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO8_INT_EN_V1 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_BTON_STS_UPDATE_MSK_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO7_INT_EN_V1 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_ACT2RECOVERY_INT_EN_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO6_INT_EN_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_TRPC_TO_INT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO5_INT_EN_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_RPC_O_T_INT_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_HCI_TXDMA_REQ_HIMR BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO4_INT_EN_V1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_32K_LEAVE_SETTING_MAK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO3_INT_EN_V1 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_32K_ENTER_SETTING_MAK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO2_INT_EN_V1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_USB_LPMRSM_MSK BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO1_INT_EN_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_USB_LPMINT_MSK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSIMR (Offset 0x0050) */ -+ -+#define BIT_FS_GPIO0_INT_EN_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_PDNINT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_SPS_OCP_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_SW_SPS_OCP_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_PWMERR_INT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_PWM_HW_ERR BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIOF_INT BIT(27) -+#define BIT_FS_GPIOE_INT BIT(26) -+#define BIT_FS_GPIOD_INT BIT(25) -+#define BIT_FS_GPIOC_INT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_ACT2RECOVERY_INT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIOB_INT BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_PCIE_GEN12_SWITCH BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIOA_INT BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_HCI_SUS_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO9_INT BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_HCI_RES_V1 BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO8_INT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_HCI_RESET_V1 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO7_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_32K_LEAVE_SETTING BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO6_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_32K_ENTER_SETTING BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO5_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_SIE_LPM_RSM_V1 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO4_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_SIE_LPM_ACT_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO3_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIOF_INT_V1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO2_INT BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIOE_INT_V1 BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO1_INT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIOD_INT_V1 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO0_INT BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIOC_INT_V1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_HCI_SUS_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIOB_INT_V1 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_HCI_RES_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIOA_INT_V1 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_HCI_RESET_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO9_INT_V1 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_AXI_EXCEPT_FINT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_USB_SCSI_CMD_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO8_INT_V1 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_BTON_STS_UPDATE_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO7_INT_V1 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_WINTINI_RDY BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_ACT2RECOVERY_INT_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_ACT2RECOVERY BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO6_INT_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_TRPC_TO_INT_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO5_INT_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_RPC_O_T_INT_INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_HCI_TXDMA_REQ_HISR BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO4_INT_V1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_32K_LEAVE_SETTING_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO3_INT_V1 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_32K_ENTER_SETTING_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO2_INT_V1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_USB_LPMRSM_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO1_INT_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_USB_LPMINT_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FSISR (Offset 0x0054) */ -+ -+#define BIT_FS_GPIO0_INT_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_GPIOF_INT_EN BIT(31) -+#define BIT_GPIOE_INT_EN BIT(30) -+#define BIT_GPIOD_INT_EN BIT(29) -+#define BIT_GPIOC_INT_EN BIT(28) -+#define BIT_GPIOB_INT_EN BIT(27) -+#define BIT_GPIOA_INT_EN BIT(26) -+#define BIT_GPIO9_INT_EN BIT(25) -+#define BIT_GPIO8_INT_EN BIT(24) -+#define BIT_GPIO7_INT_EN BIT(23) -+#define BIT_GPIO6_INT_EN BIT(22) -+#define BIT_GPIO5_INT_EN BIT(21) -+#define BIT_GPIO4_INT_EN BIT(20) -+#define BIT_GPIO3_INT_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_GPIO2_INT_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_GPIO2_INT_EN_V1 BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_GPIO1_INT_EN BIT(17) -+#define BIT_GPIO0_INT_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_AXI_EXCEPT_HINT_EN BIT(9) -+#define BIT_PDNINT_EN_V2 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_PDNINT_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_PDNINT_EN_V1 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_PDN_INT_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_RON_INT_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_RON_INT_EN_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_SPS_OCP_INT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_SPS_OCP_INT_EN_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_GPIO15_0_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HSIMR (Offset 0x0058) */ -+ -+#define BIT_GPIO15_0_INT_EN_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_GPIOF_INT BIT(31) -+#define BIT_GPIOE_INT BIT(30) -+#define BIT_GPIOD_INT BIT(29) -+#define BIT_GPIOC_INT BIT(28) -+#define BIT_GPIOB_INT BIT(27) -+#define BIT_GPIOA_INT BIT(26) -+#define BIT_GPIO9_INT BIT(25) -+#define BIT_GPIO8_INT BIT(24) -+#define BIT_GPIO7_INT BIT(23) -+#define BIT_GPIO6_INT BIT(22) -+#define BIT_GPIO5_INT BIT(21) -+#define BIT_GPIO4_INT BIT(20) -+#define BIT_GPIO3_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_GPIO2_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_GPIO2_INT_V1 BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_GPIO1_INT BIT(17) -+#define BIT_GPIO0_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_AXI_EXCEPT_HINT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_PDNINT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_PDNINT_V1 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_PDN_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_RON_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_RON_INT_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_SPS_OCP_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_SPS_OCP_INT_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_GPIO15_0_INT BIT(0) -+#define BIT_MCUFWDL_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HSISR (Offset 0x005C) */ -+ -+#define BIT_GPIO15_0_INT_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_EXT_CTRL (Offset 0x0060) */ -+ -+#define BIT_SHIFT_GPIO_MOD_15_TO_8 24 -+#define BIT_MASK_GPIO_MOD_15_TO_8 0xff -+#define BIT_GPIO_MOD_15_TO_8(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_15_TO_8) << BIT_SHIFT_GPIO_MOD_15_TO_8) -+#define BITS_GPIO_MOD_15_TO_8 \ -+ (BIT_MASK_GPIO_MOD_15_TO_8 << BIT_SHIFT_GPIO_MOD_15_TO_8) -+#define BIT_CLEAR_GPIO_MOD_15_TO_8(x) ((x) & (~BITS_GPIO_MOD_15_TO_8)) -+#define BIT_GET_GPIO_MOD_15_TO_8(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_15_TO_8) & BIT_MASK_GPIO_MOD_15_TO_8) -+#define BIT_SET_GPIO_MOD_15_TO_8(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_15_TO_8(x) | BIT_GPIO_MOD_15_TO_8(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_EXT_CTRL (Offset 0x0060) */ -+ -+#define BIT_ROM_DLEN BIT(19) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_15_TO_8 16 -+#define BIT_MASK_GPIO_IO_SEL_15_TO_8 0xff -+#define BIT_GPIO_IO_SEL_15_TO_8(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_15_TO_8) << BIT_SHIFT_GPIO_IO_SEL_15_TO_8) -+#define BITS_GPIO_IO_SEL_15_TO_8 \ -+ (BIT_MASK_GPIO_IO_SEL_15_TO_8 << BIT_SHIFT_GPIO_IO_SEL_15_TO_8) -+#define BIT_CLEAR_GPIO_IO_SEL_15_TO_8(x) ((x) & (~BITS_GPIO_IO_SEL_15_TO_8)) -+#define BIT_GET_GPIO_IO_SEL_15_TO_8(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_15_TO_8) & BIT_MASK_GPIO_IO_SEL_15_TO_8) -+#define BIT_SET_GPIO_IO_SEL_15_TO_8(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_15_TO_8(x) | BIT_GPIO_IO_SEL_15_TO_8(v)) -+ -+#define BIT_SHIFT_ROM_PGE 16 -+#define BIT_MASK_ROM_PGE 0x7 -+#define BIT_ROM_PGE(x) (((x) & BIT_MASK_ROM_PGE) << BIT_SHIFT_ROM_PGE) -+#define BITS_ROM_PGE (BIT_MASK_ROM_PGE << BIT_SHIFT_ROM_PGE) -+#define BIT_CLEAR_ROM_PGE(x) ((x) & (~BITS_ROM_PGE)) -+#define BIT_GET_ROM_PGE(x) (((x) >> BIT_SHIFT_ROM_PGE) & BIT_MASK_ROM_PGE) -+#define BIT_SET_ROM_PGE(x, v) (BIT_CLEAR_ROM_PGE(x) | BIT_ROM_PGE(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_15_TO_8 8 -+#define BIT_MASK_GPIO_OUT_15_TO_8 0xff -+#define BIT_GPIO_OUT_15_TO_8(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_15_TO_8) << BIT_SHIFT_GPIO_OUT_15_TO_8) -+#define BITS_GPIO_OUT_15_TO_8 \ -+ (BIT_MASK_GPIO_OUT_15_TO_8 << BIT_SHIFT_GPIO_OUT_15_TO_8) -+#define BIT_CLEAR_GPIO_OUT_15_TO_8(x) ((x) & (~BITS_GPIO_OUT_15_TO_8)) -+#define BIT_GET_GPIO_OUT_15_TO_8(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_15_TO_8) & BIT_MASK_GPIO_OUT_15_TO_8) -+#define BIT_SET_GPIO_OUT_15_TO_8(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_15_TO_8(x) | BIT_GPIO_OUT_15_TO_8(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_EXT_CTRL (Offset 0x0060) */ -+ -+#define BIT_SHIFT_GPIO_IN_15_TO_8 0 -+#define BIT_MASK_GPIO_IN_15_TO_8 0xff -+#define BIT_GPIO_IN_15_TO_8(x) \ -+ (((x) & BIT_MASK_GPIO_IN_15_TO_8) << BIT_SHIFT_GPIO_IN_15_TO_8) -+#define BITS_GPIO_IN_15_TO_8 \ -+ (BIT_MASK_GPIO_IN_15_TO_8 << BIT_SHIFT_GPIO_IN_15_TO_8) -+#define BIT_CLEAR_GPIO_IN_15_TO_8(x) ((x) & (~BITS_GPIO_IN_15_TO_8)) -+#define BIT_GET_GPIO_IN_15_TO_8(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_15_TO_8) & BIT_MASK_GPIO_IN_15_TO_8) -+#define BIT_SET_GPIO_IN_15_TO_8(x, v) \ -+ (BIT_CLEAR_GPIO_IN_15_TO_8(x) | BIT_GPIO_IN_15_TO_8(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_H2C (Offset 0x10250060) */ -+ -+#define BIT_SHIFT_SDIO_H2C_MSG 0 -+#define BIT_MASK_SDIO_H2C_MSG 0xffffffffL -+#define BIT_SDIO_H2C_MSG(x) \ -+ (((x) & BIT_MASK_SDIO_H2C_MSG) << BIT_SHIFT_SDIO_H2C_MSG) -+#define BITS_SDIO_H2C_MSG (BIT_MASK_SDIO_H2C_MSG << BIT_SHIFT_SDIO_H2C_MSG) -+#define BIT_CLEAR_SDIO_H2C_MSG(x) ((x) & (~BITS_SDIO_H2C_MSG)) -+#define BIT_GET_SDIO_H2C_MSG(x) \ -+ (((x) >> BIT_SHIFT_SDIO_H2C_MSG) & BIT_MASK_SDIO_H2C_MSG) -+#define BIT_SET_SDIO_H2C_MSG(x, v) \ -+ (BIT_CLEAR_SDIO_H2C_MSG(x) | BIT_SDIO_H2C_MSG(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_DATA_CPU_JTAG BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAPE_WLBT_SEL BIT(29) -+#define BIT_LNAON_WLBT_SEL BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BDEN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BT_BQB_GPIO_SEL BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BTGP_GPG3_FEN BIT(26) -+#define BIT_BTGP_GPG2_FEN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BTGP_JTAG_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BB2PP_ISO BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_XTAL_CLK_EXTARNAL_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BTBRI_UART_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BTGP_UART0_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BTGP_UART1_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BTCOEX_PU BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BTGP_SPI_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_EEPROM_SEL_PD BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BTGP_GPIO_E2 BIT(19) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_TST_MOD_PD BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BTGP_GPIO_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BOOT_FLUSH_PD BIT(18) -+#define BIT_USB_XTAL_SEL1_PD BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SHIFT_BTGP_GPIO_SL 16 -+#define BIT_MASK_BTGP_GPIO_SL 0x3 -+#define BIT_BTGP_GPIO_SL(x) \ -+ (((x) & BIT_MASK_BTGP_GPIO_SL) << BIT_SHIFT_BTGP_GPIO_SL) -+#define BITS_BTGP_GPIO_SL (BIT_MASK_BTGP_GPIO_SL << BIT_SHIFT_BTGP_GPIO_SL) -+#define BIT_CLEAR_BTGP_GPIO_SL(x) ((x) & (~BITS_BTGP_GPIO_SL)) -+#define BIT_GET_BTGP_GPIO_SL(x) \ -+ (((x) >> BIT_SHIFT_BTGP_GPIO_SL) & BIT_MASK_BTGP_GPIO_SL) -+#define BIT_SET_BTGP_GPIO_SL(x, v) \ -+ (BIT_CLEAR_BTGP_GPIO_SL(x) | BIT_BTGP_GPIO_SL(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_USB_XTAL_SEL0_PD BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_HST_WKE_DEV_SL BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_BTSUSB_PL BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_WL_JTAG BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAD_SDIO_SR BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_GPIO14_OUTPUT_PL BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_DEVWHOST_POLARITY BIT(13) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_GPIO15_OUTPUT_PL BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_HOST_WAKE_PAD_PULL_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_HOST_WAKE_DEV_PLL_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_HOST_WAKE_PAD_SL BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_TRSW_3 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_HOST_WAKE_DEV_POLARITY BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAD_TRSW_SR BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAD_LNAON_SR BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_TRSW_2 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAD_TRSW_E2 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAD_LNAON_E2 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_TRSW_1 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_A_ANTSEL_SR BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_TRSW_P_SEL_DATA BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_LNAON_G_SEL_DATA BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_TRSW_0 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_A_ANTSEL_E2 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_TRSW_N_SEL_DATA BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_LNAON_A_SEL_DATA BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_PAPE_3 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_D_PAPE_2G_SR BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAD_PAPE_SR BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_PAPE_2 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_D_PAPE_5G_SR BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAD_PAPE_E2 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_PAPE_1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_D_TRSW_SR BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_PAPE_1_SEL_DATA BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_PAPE_G_SEL_DATA BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_PAPE_0 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_D_TRSWB_SR BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_PAPE_0_SEL_DATA BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_PAPE_A_SEL_DATA BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_ANTSEL_3 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_D_PAPE_2G_E2 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_ANTSEL_2_SEL_DATA BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAD_DPDT_SR BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_ANTSEL_2 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_D_PAPE_5G_E2 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_ANTSEL_N_SEL_DATA BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAD_DPDT_PAD_E2 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_ANTSEL_1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_D_TRSW_E2 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_PAD_DPDT_E2 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_ANTSEL_P_SEL_DATA BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_DPDT_SEL_DATA BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_SW_ANTSEL_0 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_C2H (Offset 0x10250064) */ -+ -+#define BIT_SHIFT_SDIO_C2H_MSG 0 -+#define BIT_MASK_SDIO_C2H_MSG 0xffffffffL -+#define BIT_SDIO_C2H_MSG(x) \ -+ (((x) & BIT_MASK_SDIO_C2H_MSG) << BIT_SHIFT_SDIO_C2H_MSG) -+#define BITS_SDIO_C2H_MSG (BIT_MASK_SDIO_C2H_MSG << BIT_SHIFT_SDIO_C2H_MSG) -+#define BIT_CLEAR_SDIO_C2H_MSG(x) ((x) & (~BITS_SDIO_C2H_MSG)) -+#define BIT_GET_SDIO_C2H_MSG(x) \ -+ (((x) >> BIT_SHIFT_SDIO_C2H_MSG) & BIT_MASK_SDIO_C2H_MSG) -+#define BIT_SET_SDIO_C2H_MSG(x, v) \ -+ (BIT_CLEAR_SDIO_C2H_MSG(x) | BIT_SDIO_C2H_MSG(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL1 (Offset 0x0064) */ -+ -+#define BIT_D_TRSWB_E2 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_ISO_BD2PP BIT(31) -+#define BIT_LDOV12B_EN BIT(30) -+#define BIT_CKEN_BTGPS BIT(29) -+#define BIT_FEN_BTGPS BIT(28) -+#define BIT_BTCPU_BOOTSEL BIT(27) -+#define BIT_SPI_SPEEDUP BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_LPS_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_LDO_MODE BIT(25) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_SUS BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_DEVWAKE_PAD_TYPE_SEL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_CLKREQ_PAD_PL BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_CLKREQ_PAD_TYPE_SEL BIT(23) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_CKSL_BZSLP BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_EN_CPL_TIMEOUT_PS BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_WAKE_HST_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BTGP_WAKE_HST_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_ISO_BTPON2PP BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_REG_TXDMA_FAIL_PS BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_WAKE_BT_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BTGP_WAKE_BT_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BTCOEX_CMD BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_EN_BT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BTGP_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_UART_INTF BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_EN_HWENTR_L1 BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_SUSN_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BTGP_SUS_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_HWROF_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_S3_RF_HW_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_EN_ADV_CLKGATE BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_FUNC_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_S2_RF_HW_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_HWPDN_SL BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_S1_RF_HW_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_DISN_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_HWPDEN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_S0_RF_HW_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_PDN_PULL_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_WL_PDN_PULL_EN BIT(14) -+#define BIT_EXTERNAL_REQUEST_PL BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_GPIO0_2_3_PULL_LOW_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_ISO_BA2PP BIT(11) -+#define BIT_BT_AFE_LDO_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_PDN_PIN_SEL BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_GPIO11_PULL_LOW_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_AFE_PLL_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_GPIO4_PULL_LOW_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_DIG_CLK_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_WAKE_HST_SL BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BT_WAKE_HST_PL BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_ASSERT_SPS_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_UART_BRIDGE BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_WAKE_BT_SL BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_WAKE_BT_PL BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_WLAN_32K_SEL BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_MASK_CHIPEN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_OSC32K_CTRL_SEL BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_WL_DRV_EXIST_IDX BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_ASSERT_RF_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_DOP_EHPAD BIT(4) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_BIT_DOP_EHPAD BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_WL_HWROF_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_SDIO_PAD_SHUTDOWNB BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_WL_FUNC_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_SDIO_CLK_SMT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WL_BT_PWR_CTRL (Offset 0x0068) */ -+ -+#define BIT_WL_HWPDN_SL BIT(1) -+#define BIT_WL_HWPDN_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SDM_DEBUG (Offset 0x006C) */ -+ -+#define BIT_SHIFT_F0N 23 -+#define BIT_MASK_F0N 0x7 -+#define BIT_F0N(x) (((x) & BIT_MASK_F0N) << BIT_SHIFT_F0N) -+#define BITS_F0N (BIT_MASK_F0N << BIT_SHIFT_F0N) -+#define BIT_CLEAR_F0N(x) ((x) & (~BITS_F0N)) -+#define BIT_GET_F0N(x) (((x) >> BIT_SHIFT_F0N) & BIT_MASK_F0N) -+#define BIT_SET_F0N(x, v) (BIT_CLEAR_F0N(x) | BIT_F0N(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SDM_DEBUG (Offset 0x006C) */ -+ -+#define BIT_BT_WAKE_DEV_EN_V1 BIT(19) -+#define BIT_BT_WAKE_HST_EN_V1 BIT(18) -+#define BIT_BT_WAKE_HST_PL_V1 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GSSR (Offset 0x006C) */ -+ -+#define BIT_SHIFT_GPIO_15_TO_0_VAL 16 -+#define BIT_MASK_GPIO_15_TO_0_VAL 0xffff -+#define BIT_GPIO_15_TO_0_VAL(x) \ -+ (((x) & BIT_MASK_GPIO_15_TO_0_VAL) << BIT_SHIFT_GPIO_15_TO_0_VAL) -+#define BITS_GPIO_15_TO_0_VAL \ -+ (BIT_MASK_GPIO_15_TO_0_VAL << BIT_SHIFT_GPIO_15_TO_0_VAL) -+#define BIT_CLEAR_GPIO_15_TO_0_VAL(x) ((x) & (~BITS_GPIO_15_TO_0_VAL)) -+#define BIT_GET_GPIO_15_TO_0_VAL(x) \ -+ (((x) >> BIT_SHIFT_GPIO_15_TO_0_VAL) & BIT_MASK_GPIO_15_TO_0_VAL) -+#define BIT_SET_GPIO_15_TO_0_VAL(x, v) \ -+ (BIT_CLEAR_GPIO_15_TO_0_VAL(x) | BIT_GPIO_15_TO_0_VAL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SDM_DEBUG (Offset 0x006C) */ -+ -+#define BIT_BT_CLKREQ_EN_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SDM_DEBUG (Offset 0x006C) */ -+ -+#define BIT_SHIFT_F0F 10 -+#define BIT_MASK_F0F 0x1fff -+#define BIT_F0F(x) (((x) & BIT_MASK_F0F) << BIT_SHIFT_F0F) -+#define BITS_F0F (BIT_MASK_F0F << BIT_SHIFT_F0F) -+#define BIT_CLEAR_F0F(x) ((x) & (~BITS_F0F)) -+#define BIT_GET_F0F(x) (((x) >> BIT_SHIFT_F0F) & BIT_MASK_F0F) -+#define BIT_SET_F0F(x, v) (BIT_CLEAR_F0F(x) | BIT_F0F(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDM_DEBUG (Offset 0x006C) */ -+ -+#define BIT_GPIO_IE_V18 BIT(10) -+#define BIT_PCIE_IE_V18 BIT(9) -+#define BIT_UART_IE_V18 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SDM_DEBUG (Offset 0x006C) */ -+ -+#define BIT_SHIFT_DIVN 4 -+#define BIT_MASK_DIVN 0x3f -+#define BIT_DIVN(x) (((x) & BIT_MASK_DIVN) << BIT_SHIFT_DIVN) -+#define BITS_DIVN (BIT_MASK_DIVN << BIT_SHIFT_DIVN) -+#define BIT_CLEAR_DIVN(x) ((x) & (~BITS_DIVN)) -+#define BIT_GET_DIVN(x) (((x) >> BIT_SHIFT_DIVN) & BIT_MASK_DIVN) -+#define BIT_SET_DIVN(x, v) (BIT_CLEAR_DIVN(x) | BIT_DIVN(v)) -+ -+#define BIT_SHIFT_BB_DBG_SEL_AFE_SDM 0 -+#define BIT_MASK_BB_DBG_SEL_AFE_SDM 0xf -+#define BIT_BB_DBG_SEL_AFE_SDM(x) \ -+ (((x) & BIT_MASK_BB_DBG_SEL_AFE_SDM) << BIT_SHIFT_BB_DBG_SEL_AFE_SDM) -+#define BITS_BB_DBG_SEL_AFE_SDM \ -+ (BIT_MASK_BB_DBG_SEL_AFE_SDM << BIT_SHIFT_BB_DBG_SEL_AFE_SDM) -+#define BIT_CLEAR_BB_DBG_SEL_AFE_SDM(x) ((x) & (~BITS_BB_DBG_SEL_AFE_SDM)) -+#define BIT_GET_BB_DBG_SEL_AFE_SDM(x) \ -+ (((x) >> BIT_SHIFT_BB_DBG_SEL_AFE_SDM) & BIT_MASK_BB_DBG_SEL_AFE_SDM) -+#define BIT_SET_BB_DBG_SEL_AFE_SDM(x, v) \ -+ (BIT_CLEAR_BB_DBG_SEL_AFE_SDM(x) | BIT_BB_DBG_SEL_AFE_SDM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDM_DEBUG (Offset 0x006C) */ -+ -+#define BIT_SHIFT_WLCLK_PHASE 0 -+#define BIT_MASK_WLCLK_PHASE 0x1f -+#define BIT_WLCLK_PHASE(x) \ -+ (((x) & BIT_MASK_WLCLK_PHASE) << BIT_SHIFT_WLCLK_PHASE) -+#define BITS_WLCLK_PHASE (BIT_MASK_WLCLK_PHASE << BIT_SHIFT_WLCLK_PHASE) -+#define BIT_CLEAR_WLCLK_PHASE(x) ((x) & (~BITS_WLCLK_PHASE)) -+#define BIT_GET_WLCLK_PHASE(x) \ -+ (((x) >> BIT_SHIFT_WLCLK_PHASE) & BIT_MASK_WLCLK_PHASE) -+#define BIT_SET_WLCLK_PHASE(x, v) \ -+ (BIT_CLEAR_WLCLK_PHASE(x) | BIT_WLCLK_PHASE(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_GSSR (Offset 0x006C) */ -+ -+#define BIT_SHIFT_GPIO_15_TO_0_EN 0 -+#define BIT_MASK_GPIO_15_TO_0_EN 0xffff -+#define BIT_GPIO_15_TO_0_EN(x) \ -+ (((x) & BIT_MASK_GPIO_15_TO_0_EN) << BIT_SHIFT_GPIO_15_TO_0_EN) -+#define BITS_GPIO_15_TO_0_EN \ -+ (BIT_MASK_GPIO_15_TO_0_EN << BIT_SHIFT_GPIO_15_TO_0_EN) -+#define BIT_CLEAR_GPIO_15_TO_0_EN(x) ((x) & (~BITS_GPIO_15_TO_0_EN)) -+#define BIT_GET_GPIO_15_TO_0_EN(x) \ -+ (((x) >> BIT_SHIFT_GPIO_15_TO_0_EN) & BIT_MASK_GPIO_15_TO_0_EN) -+#define BIT_SET_GPIO_15_TO_0_EN(x, v) \ -+ (BIT_CLEAR_GPIO_15_TO_0_EN(x) | BIT_GPIO_15_TO_0_EN(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_FORCE_RST_PCIE_APHY BIT(30) -+#define BIT_FORCE_OFF_EPC BIT(29) -+#define BIT_PTA_3W_MODE BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_BBRSTB_STANDBY_V1 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_DBG_GNT_WL_BT BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_AFE_PORT3_ISO BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_LTE_MUX_CTRL_PATH BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_AFE_PORT2_ISO BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_LTE_COEX_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_LTE_COEX_UART BIT(25) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_AFE_PORT1_ISO BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_3W_LTE_GPIO_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_3W_LTE_WL_GPIO BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_AFE_PORT0_ISO BIT(24) -+#define BIT_USB_PWR_OFF_SEL BIT(23) -+#define BIT_USB_HOST_PWR_OFF_EN_V1 BIT(22) -+#define BIT_SYM_LPS_BLOCK_EN_V1 BIT(21) -+#define BIT_USB_LPM_ACT_EN_V1 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_SDIO_INT_POLARITY BIT(19) -+#define BIT_SDIO_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_SDIO_OFF_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_SDIO_OFF_EN_V1 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_SDIO_ON_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_SDIO_ON_EN_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_PCIE_FORCE_PWR_NGAT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_DIS_U3MB_INU2 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_PCIE_CALIB_EN_V1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_USB3_MDIO_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_PAGE3_AUXCLK_GATE BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_USB3_BG_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_PCIE_WAIT_TIMEOUT_EVENT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_USB3_MB_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_PCIE_WAIT_TIME BIT(9) -+#define BIT_MPCIE_REFCLK_XTAL_SEL BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_SHIFT_USB3_CK_MD 8 -+#define BIT_MASK_USB3_CK_MD 0x3 -+#define BIT_USB3_CK_MD(x) (((x) & BIT_MASK_USB3_CK_MD) << BIT_SHIFT_USB3_CK_MD) -+#define BITS_USB3_CK_MD (BIT_MASK_USB3_CK_MD << BIT_SHIFT_USB3_CK_MD) -+#define BIT_CLEAR_USB3_CK_MD(x) ((x) & (~BITS_USB3_CK_MD)) -+#define BIT_GET_USB3_CK_MD(x) \ -+ (((x) >> BIT_SHIFT_USB3_CK_MD) & BIT_MASK_USB3_CK_MD) -+#define BIT_SET_USB3_CK_MD(x, v) (BIT_CLEAR_USB3_CK_MD(x) | BIT_USB3_CK_MD(v)) -+ -+#define BIT_USB3_CKBUF BIT(7) -+#define BIT_USB3_IBX_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_BT_CLKREQ_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_BT_CTRL_USB_PWR_BACKDOOR BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_U3_MB_MASK BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_USB_D_STATE_HOLD BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_U3_BG_MASK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_SHIFT_USB_CKREF_CML_R 4 -+#define BIT_MASK_USB_CKREF_CML_R 0x3 -+#define BIT_USB_CKREF_CML_R(x) \ -+ (((x) & BIT_MASK_USB_CKREF_CML_R) << BIT_SHIFT_USB_CKREF_CML_R) -+#define BITS_USB_CKREF_CML_R \ -+ (BIT_MASK_USB_CKREF_CML_R << BIT_SHIFT_USB_CKREF_CML_R) -+#define BIT_CLEAR_USB_CKREF_CML_R(x) ((x) & (~BITS_USB_CKREF_CML_R)) -+#define BIT_GET_USB_CKREF_CML_R(x) \ -+ (((x) >> BIT_SHIFT_USB_CKREF_CML_R) & BIT_MASK_USB_CKREF_CML_R) -+#define BIT_SET_USB_CKREF_CML_R(x, v) \ -+ (BIT_CLEAR_USB_CKREF_CML_R(x) | BIT_USB_CKREF_CML_R(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_REG_FORCE_DP BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_DIS_USB3_MB_POLLING BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_BTGP_CLKREQ_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_REG_DP_MODE BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_PDN_MASK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_SHIFT_USB_CKREF_D2S_I 2 -+#define BIT_MASK_USB_CKREF_D2S_I 0x3 -+#define BIT_USB_CKREF_D2S_I(x) \ -+ (((x) & BIT_MASK_USB_CKREF_D2S_I) << BIT_SHIFT_USB_CKREF_D2S_I) -+#define BITS_USB_CKREF_D2S_I \ -+ (BIT_MASK_USB_CKREF_D2S_I << BIT_SHIFT_USB_CKREF_D2S_I) -+#define BIT_CLEAR_USB_CKREF_D2S_I(x) ((x) & (~BITS_USB_CKREF_D2S_I)) -+#define BIT_GET_USB_CKREF_D2S_I(x) \ -+ (((x) >> BIT_SHIFT_USB_CKREF_D2S_I) & BIT_MASK_USB_CKREF_D2S_I) -+#define BIT_SET_USB_CKREF_D2S_I(x, v) \ -+ (BIT_CLEAR_USB_CKREF_D2S_I(x) | BIT_USB_CKREF_D2S_I(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_USB_INSTALL_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_RES_USB_MASS_STORAGE_DESC BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_NO_PDN_CHIPOFF BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_USB_BT_CLKSEL BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_USB_WAIT_TIME BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CLKR (Offset 0x0070) */ -+ -+#define BIT_PDN_HCOUNT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_SDIO_CTRL (Offset 0x0070) */ -+ -+#define BIT_SHIFT_SI_AUTHORIZATION 0 -+#define BIT_MASK_SI_AUTHORIZATION 0xff -+#define BIT_SI_AUTHORIZATION(x) \ -+ (((x) & BIT_MASK_SI_AUTHORIZATION) << BIT_SHIFT_SI_AUTHORIZATION) -+#define BITS_SI_AUTHORIZATION \ -+ (BIT_MASK_SI_AUTHORIZATION << BIT_SHIFT_SI_AUTHORIZATION) -+#define BIT_CLEAR_SI_AUTHORIZATION(x) ((x) & (~BITS_SI_AUTHORIZATION)) -+#define BIT_GET_SI_AUTHORIZATION(x) \ -+ (((x) >> BIT_SHIFT_SI_AUTHORIZATION) & BIT_MASK_SI_AUTHORIZATION) -+#define BIT_SET_SI_AUTHORIZATION(x, v) \ -+ (BIT_CLEAR_SI_AUTHORIZATION(x) | BIT_SI_AUTHORIZATION(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SHIFT_HCI_RATIO 30 -+#define BIT_MASK_HCI_RATIO 0x3 -+#define BIT_HCI_RATIO(x) (((x) & BIT_MASK_HCI_RATIO) << BIT_SHIFT_HCI_RATIO) -+#define BITS_HCI_RATIO (BIT_MASK_HCI_RATIO << BIT_SHIFT_HCI_RATIO) -+#define BIT_CLEAR_HCI_RATIO(x) ((x) & (~BITS_HCI_RATIO)) -+#define BIT_GET_HCI_RATIO(x) (((x) >> BIT_SHIFT_HCI_RATIO) & BIT_MASK_HCI_RATIO) -+#define BIT_SET_HCI_RATIO(x, v) (BIT_CLEAR_HCI_RATIO(x) | BIT_HCI_RATIO(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SHIFT_TSFT_SEL 29 -+#define BIT_MASK_TSFT_SEL 0x7 -+#define BIT_TSFT_SEL(x) (((x) & BIT_MASK_TSFT_SEL) << BIT_SHIFT_TSFT_SEL) -+#define BITS_TSFT_SEL (BIT_MASK_TSFT_SEL << BIT_SHIFT_TSFT_SEL) -+#define BIT_CLEAR_TSFT_SEL(x) ((x) & (~BITS_TSFT_SEL)) -+#define BIT_GET_TSFT_SEL(x) (((x) >> BIT_SHIFT_TSFT_SEL) & BIT_MASK_TSFT_SEL) -+#define BIT_SET_TSFT_SEL(x, v) (BIT_CLEAR_TSFT_SEL(x) | BIT_TSFT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SHIFT_WAIT_HPOW_TIME 28 -+#define BIT_MASK_WAIT_HPOW_TIME 0x3 -+#define BIT_WAIT_HPOW_TIME(x) \ -+ (((x) & BIT_MASK_WAIT_HPOW_TIME) << BIT_SHIFT_WAIT_HPOW_TIME) -+#define BITS_WAIT_HPOW_TIME \ -+ (BIT_MASK_WAIT_HPOW_TIME << BIT_SHIFT_WAIT_HPOW_TIME) -+#define BIT_CLEAR_WAIT_HPOW_TIME(x) ((x) & (~BITS_WAIT_HPOW_TIME)) -+#define BIT_GET_WAIT_HPOW_TIME(x) \ -+ (((x) >> BIT_SHIFT_WAIT_HPOW_TIME) & BIT_MASK_WAIT_HPOW_TIME) -+#define BIT_SET_WAIT_HPOW_TIME(x, v) \ -+ (BIT_CLEAR_WAIT_HPOW_TIME(x) | BIT_WAIT_HPOW_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SHIFT_XTAL_SEL_0_V1 28 -+#define BIT_MASK_XTAL_SEL_0_V1 0xf -+#define BIT_XTAL_SEL_0_V1(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_0_V1) << BIT_SHIFT_XTAL_SEL_0_V1) -+#define BITS_XTAL_SEL_0_V1 (BIT_MASK_XTAL_SEL_0_V1 << BIT_SHIFT_XTAL_SEL_0_V1) -+#define BIT_CLEAR_XTAL_SEL_0_V1(x) ((x) & (~BITS_XTAL_SEL_0_V1)) -+#define BIT_GET_XTAL_SEL_0_V1(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_0_V1) & BIT_MASK_XTAL_SEL_0_V1) -+#define BIT_SET_XTAL_SEL_0_V1(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_0_V1(x) | BIT_XTAL_SEL_0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_TSFT_BAND_SEL BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_PCIE_HPOW_OPT2 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_ISO_RFC2RF_3 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_PCIE_HPOW_OPT1 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_ISO_RFC2RF_2 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_PCIE_HPOW_OPT0 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SHIFT_RPWM 24 -+#define BIT_MASK_RPWM 0xff -+#define BIT_RPWM(x) (((x) & BIT_MASK_RPWM) << BIT_SHIFT_RPWM) -+#define BITS_RPWM (BIT_MASK_RPWM << BIT_SHIFT_RPWM) -+#define BIT_CLEAR_RPWM(x) ((x) & (~BITS_RPWM)) -+#define BIT_GET_RPWM(x) (((x) >> BIT_SHIFT_RPWM) & BIT_MASK_RPWM) -+#define BIT_SET_RPWM(x, v) (BIT_CLEAR_RPWM(x) | BIT_RPWM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_PCIE_EPC_ISO BIT(24) -+#define BIT_PCIE_EPC_OPT BIT(23) -+#define BIT_PCIE_SUS_OPT BIT(22) -+#define BIT_PCIE_L1OF_OPT BIT(21) -+#define BIT_PCIE_L1OF_LDOA BIT(20) -+#define BIT_USB_SUS_LDOA BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SDIO_PAD_E5 BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_USB_HOST_PWR_OFF_SEL BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_R_FORCE_CLK_U3 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_USB_HOST_PWR_OFF_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_R_USB2_AUTOLOAD BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SYM_LPS_BLOCK_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_FORCE_U2CK BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_USB_LPM_ACT_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_FORCE_CLK BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_USB_LPM_NY BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_IBX_EN_VALUE BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_U2_FORCE BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_USB_SUS_DIS BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_IB_EN_VALUE BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_U3_FORCE BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_EN_LW_PWR BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SHIFT_SDIO_PAD_E 5 -+#define BIT_MASK_SDIO_PAD_E 0x7 -+#define BIT_SDIO_PAD_E(x) (((x) & BIT_MASK_SDIO_PAD_E) << BIT_SHIFT_SDIO_PAD_E) -+#define BITS_SDIO_PAD_E (BIT_MASK_SDIO_PAD_E << BIT_SHIFT_SDIO_PAD_E) -+#define BIT_CLEAR_SDIO_PAD_E(x) ((x) & (~BITS_SDIO_PAD_E)) -+#define BIT_GET_SDIO_PAD_E(x) \ -+ (((x) >> BIT_SHIFT_SDIO_PAD_E) & BIT_MASK_SDIO_PAD_E) -+#define BIT_SET_SDIO_PAD_E(x, v) (BIT_CLEAR_SDIO_PAD_E(x) | BIT_SDIO_PAD_E(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_EN_REGU BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_USB_LPPLL_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_FORCED_IB_EN BIT(4) -+#define BIT_EN_PC BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SDIO_H3L1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_PERST_SYNC_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_USB1_1_USB2_0_DECISION BIT(3) -+#define BIT_EN_REGBG BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_ROP_SW15 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_REG_BG_LPF BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SHIFT_USB23_SW_MODE 2 -+#define BIT_MASK_USB23_SW_MODE 0x3 -+#define BIT_USB23_SW_MODE(x) \ -+ (((x) & BIT_MASK_USB23_SW_MODE) << BIT_SHIFT_USB23_SW_MODE) -+#define BITS_USB23_SW_MODE (BIT_MASK_USB23_SW_MODE << BIT_SHIFT_USB23_SW_MODE) -+#define BIT_CLEAR_USB23_SW_MODE(x) ((x) & (~BITS_USB23_SW_MODE)) -+#define BIT_GET_USB23_SW_MODE(x) \ -+ (((x) >> BIT_SHIFT_USB23_SW_MODE) & BIT_MASK_USB23_SW_MODE) -+#define BIT_SET_USB23_SW_MODE(x, v) \ -+ (BIT_CLEAR_USB23_SW_MODE(x) | BIT_USB23_SW_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_PCI_CKRDY_OPT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_PCLK_VLD_SEL BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_PCI_VAUX_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_SHIFT_REG_BG 0 -+#define BIT_MASK_REG_BG 0x3 -+#define BIT_REG_BG(x) (((x) & BIT_MASK_REG_BG) << BIT_SHIFT_REG_BG) -+#define BITS_REG_BG (BIT_MASK_REG_BG << BIT_SHIFT_REG_BG) -+#define BIT_CLEAR_REG_BG(x) ((x) & (~BITS_REG_BG)) -+#define BIT_GET_REG_BG(x) (((x) >> BIT_SHIFT_REG_BG) & BIT_MASK_REG_BG) -+#define BIT_SET_REG_BG(x, v) (BIT_CLEAR_REG_BG(x) | BIT_REG_BG(v)) -+ -+#define BIT_SHIFT_REG_VADJ 0 -+#define BIT_MASK_REG_VADJ 0xf -+#define BIT_REG_VADJ(x) (((x) & BIT_MASK_REG_VADJ) << BIT_SHIFT_REG_VADJ) -+#define BITS_REG_VADJ (BIT_MASK_REG_VADJ << BIT_SHIFT_REG_VADJ) -+#define BIT_CLEAR_REG_VADJ(x) ((x) & (~BITS_REG_VADJ)) -+#define BIT_GET_REG_VADJ(x) (((x) >> BIT_SHIFT_REG_VADJ) & BIT_MASK_REG_VADJ) -+#define BIT_SET_REG_VADJ(x, v) (BIT_CLEAR_REG_VADJ(x) | BIT_REG_VADJ(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_OPT_CTRL (Offset 0x0074) */ -+ -+#define BIT_VAUX_EN BIT(0) -+ -+/* 2 REG_AFE_XTAL_CTRL_EXT (Offset 0x0078) */ -+ -+#define BIT_SDM_ORDER BIT(30) -+#define BIT_XTAL_DRV_RF_LATCH_V1 BIT(29) -+#define BIT_XTAL_VDD_SEL_V1 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_XTAL_DRV_RF_LATCH BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_XTAL_CTRL_EXT (Offset 0x0078) */ -+ -+#define BIT_XQSEL_RF_AWAKE_V1 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_XTAL_VDD_SEL BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_RF1_SDMRSTB BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_XTAL_CTRL_EXT (Offset 0x0078) */ -+ -+#define BIT_GATED_XTAL_OK0_V1 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_XQSEL_RF BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_RF1_RSTB BIT(25) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_XQSEL_RF_AWAKE BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_XQSEL_RF_INITIAL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_RF1_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_XQSEL_BIT1 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_REG_VREF_SEL BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_DITHER_SDM_BIT3 BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_XTAL_CTRL_EXT (Offset 0x0078) */ -+ -+#define BIT_SHIFT_F0N_2_TO_0 23 -+#define BIT_MASK_F0N_2_TO_0 0x7 -+#define BIT_F0N_2_TO_0(x) (((x) & BIT_MASK_F0N_2_TO_0) << BIT_SHIFT_F0N_2_TO_0) -+#define BITS_F0N_2_TO_0 (BIT_MASK_F0N_2_TO_0 << BIT_SHIFT_F0N_2_TO_0) -+#define BIT_CLEAR_F0N_2_TO_0(x) ((x) & (~BITS_F0N_2_TO_0)) -+#define BIT_GET_F0N_2_TO_0(x) \ -+ (((x) >> BIT_SHIFT_F0N_2_TO_0) & BIT_MASK_F0N_2_TO_0) -+#define BIT_SET_F0N_2_TO_0(x, v) (BIT_CLEAR_F0N_2_TO_0(x) | BIT_F0N_2_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_REG_LPFEN BIT(22) -+#define BIT_REG_KVCO BIT(21) -+#define BIT_XTAL_DRV_AGPIO_BIT1 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_SHIFT_XTAL_LDO 20 -+#define BIT_MASK_XTAL_LDO 0x7 -+#define BIT_XTAL_LDO(x) (((x) & BIT_MASK_XTAL_LDO) << BIT_SHIFT_XTAL_LDO) -+#define BITS_XTAL_LDO (BIT_MASK_XTAL_LDO << BIT_SHIFT_XTAL_LDO) -+#define BIT_CLEAR_XTAL_LDO(x) ((x) & (~BITS_XTAL_LDO)) -+#define BIT_GET_XTAL_LDO(x) (((x) >> BIT_SHIFT_XTAL_LDO) & BIT_MASK_XTAL_LDO) -+#define BIT_SET_XTAL_LDO(x, v) (BIT_CLEAR_XTAL_LDO(x) | BIT_XTAL_LDO(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_XTAL_DRV_AGPIO_BIT0 BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_XTAL_GRF2 BIT(18) -+#define BIT_REG_REF_SEL BIT(17) -+#define BIT_REG_320_SEL BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_ADC_CK_SYNC_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_EN_SYM BIT(15) -+ -+#define BIT_SHIFT_IOFFSET 10 -+#define BIT_MASK_IOFFSET 0x1f -+#define BIT_IOFFSET(x) (((x) & BIT_MASK_IOFFSET) << BIT_SHIFT_IOFFSET) -+#define BITS_IOFFSET (BIT_MASK_IOFFSET << BIT_SHIFT_IOFFSET) -+#define BIT_CLEAR_IOFFSET(x) ((x) & (~BITS_IOFFSET)) -+#define BIT_GET_IOFFSET(x) (((x) >> BIT_SHIFT_IOFFSET) & BIT_MASK_IOFFSET) -+#define BIT_SET_IOFFSET(x, v) (BIT_CLEAR_IOFFSET(x) | BIT_IOFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_RF2_SDMRSTB BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_XTAL_CTRL_EXT (Offset 0x0078) */ -+ -+#define BIT_SHIFT_F0F_12_TO_0 10 -+#define BIT_MASK_F0F_12_TO_0 0x1fff -+#define BIT_F0F_12_TO_0(x) \ -+ (((x) & BIT_MASK_F0F_12_TO_0) << BIT_SHIFT_F0F_12_TO_0) -+#define BITS_F0F_12_TO_0 (BIT_MASK_F0F_12_TO_0 << BIT_SHIFT_F0F_12_TO_0) -+#define BIT_CLEAR_F0F_12_TO_0(x) ((x) & (~BITS_F0F_12_TO_0)) -+#define BIT_GET_F0F_12_TO_0(x) \ -+ (((x) >> BIT_SHIFT_F0F_12_TO_0) & BIT_MASK_F0F_12_TO_0) -+#define BIT_SET_F0F_12_TO_0(x, v) \ -+ (BIT_CLEAR_F0F_12_TO_0(x) | BIT_F0F_12_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_RF2_RSTB BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_SHIFT_APLL_FREF_SEL_BIT_2_TO_1 8 -+#define BIT_MASK_APLL_FREF_SEL_BIT_2_TO_1 0x3 -+#define BIT_APLL_FREF_SEL_BIT_2_TO_1(x) \ -+ (((x) & BIT_MASK_APLL_FREF_SEL_BIT_2_TO_1) \ -+ << BIT_SHIFT_APLL_FREF_SEL_BIT_2_TO_1) -+#define BITS_APLL_FREF_SEL_BIT_2_TO_1 \ -+ (BIT_MASK_APLL_FREF_SEL_BIT_2_TO_1 \ -+ << BIT_SHIFT_APLL_FREF_SEL_BIT_2_TO_1) -+#define BIT_CLEAR_APLL_FREF_SEL_BIT_2_TO_1(x) \ -+ ((x) & (~BITS_APLL_FREF_SEL_BIT_2_TO_1)) -+#define BIT_GET_APLL_FREF_SEL_BIT_2_TO_1(x) \ -+ (((x) >> BIT_SHIFT_APLL_FREF_SEL_BIT_2_TO_1) & \ -+ BIT_MASK_APLL_FREF_SEL_BIT_2_TO_1) -+#define BIT_SET_APLL_FREF_SEL_BIT_2_TO_1(x, v) \ -+ (BIT_CLEAR_APLL_FREF_SEL_BIT_2_TO_1(x) | \ -+ BIT_APLL_FREF_SEL_BIT_2_TO_1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_RF2_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_APLL_FREF_SEL_BIT3 BIT(7) -+ -+#define BIT_SHIFT_APLL_LDO_V12ADJ 5 -+#define BIT_MASK_APLL_LDO_V12ADJ 0x3 -+#define BIT_APLL_LDO_V12ADJ(x) \ -+ (((x) & BIT_MASK_APLL_LDO_V12ADJ) << BIT_SHIFT_APLL_LDO_V12ADJ) -+#define BITS_APLL_LDO_V12ADJ \ -+ (BIT_MASK_APLL_LDO_V12ADJ << BIT_SHIFT_APLL_LDO_V12ADJ) -+#define BIT_CLEAR_APLL_LDO_V12ADJ(x) ((x) & (~BITS_APLL_LDO_V12ADJ)) -+#define BIT_GET_APLL_LDO_V12ADJ(x) \ -+ (((x) >> BIT_SHIFT_APLL_LDO_V12ADJ) & BIT_MASK_APLL_LDO_V12ADJ) -+#define BIT_SET_APLL_LDO_V12ADJ(x, v) \ -+ (BIT_CLEAR_APLL_LDO_V12ADJ(x) | BIT_APLL_LDO_V12ADJ(v)) -+ -+#define BIT_APLL_160_GATEB BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_XTAL_CTRL_EXT (Offset 0x0078) */ -+ -+#define BIT_SHIFT_DIVN_5_TO_0 4 -+#define BIT_MASK_DIVN_5_TO_0 0x3f -+#define BIT_DIVN_5_TO_0(x) \ -+ (((x) & BIT_MASK_DIVN_5_TO_0) << BIT_SHIFT_DIVN_5_TO_0) -+#define BITS_DIVN_5_TO_0 (BIT_MASK_DIVN_5_TO_0 << BIT_SHIFT_DIVN_5_TO_0) -+#define BIT_CLEAR_DIVN_5_TO_0(x) ((x) & (~BITS_DIVN_5_TO_0)) -+#define BIT_GET_DIVN_5_TO_0(x) \ -+ (((x) >> BIT_SHIFT_DIVN_5_TO_0) & BIT_MASK_DIVN_5_TO_0) -+#define BIT_SET_DIVN_5_TO_0(x, v) \ -+ (BIT_CLEAR_DIVN_5_TO_0(x) | BIT_DIVN_5_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_AFE_DUMMY BIT(3) -+#define BIT_REG_IDOUBLE BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_RF3_SDMRSTB BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_REG_VCO_BIAS_BIT0 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_RF3_RSTB BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_REG_VCO_BIAS_BIT1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL4 (Offset 0x0078) */ -+ -+#define BIT_RF3_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_AFE_XTAL_CTRL_EXT (Offset 0x0078) */ -+ -+#define BIT_SHIFT_BB_DBG_SEL_AFE_SDM_3_TO_0 0 -+#define BIT_MASK_BB_DBG_SEL_AFE_SDM_3_TO_0 0xf -+#define BIT_BB_DBG_SEL_AFE_SDM_3_TO_0(x) \ -+ (((x) & BIT_MASK_BB_DBG_SEL_AFE_SDM_3_TO_0) \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_3_TO_0) -+#define BITS_BB_DBG_SEL_AFE_SDM_3_TO_0 \ -+ (BIT_MASK_BB_DBG_SEL_AFE_SDM_3_TO_0 \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_3_TO_0) -+#define BIT_CLEAR_BB_DBG_SEL_AFE_SDM_3_TO_0(x) \ -+ ((x) & (~BITS_BB_DBG_SEL_AFE_SDM_3_TO_0)) -+#define BIT_GET_BB_DBG_SEL_AFE_SDM_3_TO_0(x) \ -+ (((x) >> BIT_SHIFT_BB_DBG_SEL_AFE_SDM_3_TO_0) & \ -+ BIT_MASK_BB_DBG_SEL_AFE_SDM_3_TO_0) -+#define BIT_SET_BB_DBG_SEL_AFE_SDM_3_TO_0(x, v) \ -+ (BIT_CLEAR_BB_DBG_SEL_AFE_SDM_3_TO_0(x) | \ -+ BIT_BB_DBG_SEL_AFE_SDM_3_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SPS_EN_DIODE BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_EXT_SWR_CTRL_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_REF_FREF_EDGE BIT(29) -+#define BIT_REG_VREF_SEL_V1 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_ZCD_HW_AUTO_EN BIT(27) -+#define BIT_ZCD_REGSEL BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_CP_OFFSET_4_TO_0 23 -+#define BIT_MASK_REG_CP_OFFSET_4_TO_0 0x1f -+#define BIT_REG_CP_OFFSET_4_TO_0(x) \ -+ (((x) & BIT_MASK_REG_CP_OFFSET_4_TO_0) \ -+ << BIT_SHIFT_REG_CP_OFFSET_4_TO_0) -+#define BITS_REG_CP_OFFSET_4_TO_0 \ -+ (BIT_MASK_REG_CP_OFFSET_4_TO_0 << BIT_SHIFT_REG_CP_OFFSET_4_TO_0) -+#define BIT_CLEAR_REG_CP_OFFSET_4_TO_0(x) ((x) & (~BITS_REG_CP_OFFSET_4_TO_0)) -+#define BIT_GET_REG_CP_OFFSET_4_TO_0(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_OFFSET_4_TO_0) & \ -+ BIT_MASK_REG_CP_OFFSET_4_TO_0) -+#define BIT_SET_REG_CP_OFFSET_4_TO_0(x, v) \ -+ (BIT_CLEAR_REG_CP_OFFSET_4_TO_0(x) | BIT_REG_CP_OFFSET_4_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_AUTO_ZCD_IN_CODE 21 -+#define BIT_MASK_AUTO_ZCD_IN_CODE 0x1f -+#define BIT_AUTO_ZCD_IN_CODE(x) \ -+ (((x) & BIT_MASK_AUTO_ZCD_IN_CODE) << BIT_SHIFT_AUTO_ZCD_IN_CODE) -+#define BITS_AUTO_ZCD_IN_CODE \ -+ (BIT_MASK_AUTO_ZCD_IN_CODE << BIT_SHIFT_AUTO_ZCD_IN_CODE) -+#define BIT_CLEAR_AUTO_ZCD_IN_CODE(x) ((x) & (~BITS_AUTO_ZCD_IN_CODE)) -+#define BIT_GET_AUTO_ZCD_IN_CODE(x) \ -+ (((x) >> BIT_SHIFT_AUTO_ZCD_IN_CODE) & BIT_MASK_AUTO_ZCD_IN_CODE) -+#define BIT_SET_AUTO_ZCD_IN_CODE(x, v) \ -+ (BIT_CLEAR_AUTO_ZCD_IN_CODE(x) | BIT_AUTO_ZCD_IN_CODE(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_RS_SET_2_TO_0 20 -+#define BIT_MASK_REG_RS_SET_2_TO_0 0x7 -+#define BIT_REG_RS_SET_2_TO_0(x) \ -+ (((x) & BIT_MASK_REG_RS_SET_2_TO_0) << BIT_SHIFT_REG_RS_SET_2_TO_0) -+#define BITS_REG_RS_SET_2_TO_0 \ -+ (BIT_MASK_REG_RS_SET_2_TO_0 << BIT_SHIFT_REG_RS_SET_2_TO_0) -+#define BIT_CLEAR_REG_RS_SET_2_TO_0(x) ((x) & (~BITS_REG_RS_SET_2_TO_0)) -+#define BIT_GET_REG_RS_SET_2_TO_0(x) \ -+ (((x) >> BIT_SHIFT_REG_RS_SET_2_TO_0) & BIT_MASK_REG_RS_SET_2_TO_0) -+#define BIT_SET_REG_RS_SET_2_TO_0(x, v) \ -+ (BIT_CLEAR_REG_RS_SET_2_TO_0(x) | BIT_REG_RS_SET_2_TO_0(v)) -+ -+#define BIT_SHIFT_REG_CS_SET_1_TO_0 18 -+#define BIT_MASK_REG_CS_SET_1_TO_0 0x3 -+#define BIT_REG_CS_SET_1_TO_0(x) \ -+ (((x) & BIT_MASK_REG_CS_SET_1_TO_0) << BIT_SHIFT_REG_CS_SET_1_TO_0) -+#define BITS_REG_CS_SET_1_TO_0 \ -+ (BIT_MASK_REG_CS_SET_1_TO_0 << BIT_SHIFT_REG_CS_SET_1_TO_0) -+#define BIT_CLEAR_REG_CS_SET_1_TO_0(x) ((x) & (~BITS_REG_CS_SET_1_TO_0)) -+#define BIT_GET_REG_CS_SET_1_TO_0(x) \ -+ (((x) >> BIT_SHIFT_REG_CS_SET_1_TO_0) & BIT_MASK_REG_CS_SET_1_TO_0) -+#define BIT_SET_REG_CS_SET_1_TO_0(x, v) \ -+ (BIT_CLEAR_REG_CS_SET_1_TO_0(x) | BIT_REG_CS_SET_1_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_ZCD_CODE_IN_L 16 -+#define BIT_MASK_ZCD_CODE_IN_L 0x1f -+#define BIT_ZCD_CODE_IN_L(x) \ -+ (((x) & BIT_MASK_ZCD_CODE_IN_L) << BIT_SHIFT_ZCD_CODE_IN_L) -+#define BITS_ZCD_CODE_IN_L (BIT_MASK_ZCD_CODE_IN_L << BIT_SHIFT_ZCD_CODE_IN_L) -+#define BIT_CLEAR_ZCD_CODE_IN_L(x) ((x) & (~BITS_ZCD_CODE_IN_L)) -+#define BIT_GET_ZCD_CODE_IN_L(x) \ -+ (((x) >> BIT_SHIFT_ZCD_CODE_IN_L) & BIT_MASK_ZCD_CODE_IN_L) -+#define BIT_SET_ZCD_CODE_IN_L(x, v) \ -+ (BIT_CLEAR_ZCD_CODE_IN_L(x) | BIT_ZCD_CODE_IN_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_CP_SET_1_TO_0 16 -+#define BIT_MASK_REG_CP_SET_1_TO_0 0x3 -+#define BIT_REG_CP_SET_1_TO_0(x) \ -+ (((x) & BIT_MASK_REG_CP_SET_1_TO_0) << BIT_SHIFT_REG_CP_SET_1_TO_0) -+#define BITS_REG_CP_SET_1_TO_0 \ -+ (BIT_MASK_REG_CP_SET_1_TO_0 << BIT_SHIFT_REG_CP_SET_1_TO_0) -+#define BIT_CLEAR_REG_CP_SET_1_TO_0(x) ((x) & (~BITS_REG_CP_SET_1_TO_0)) -+#define BIT_GET_REG_CP_SET_1_TO_0(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_SET_1_TO_0) & BIT_MASK_REG_CP_SET_1_TO_0) -+#define BIT_SET_REG_CP_SET_1_TO_0(x, v) \ -+ (BIT_CLEAR_REG_CP_SET_1_TO_0(x) | BIT_REG_CP_SET_1_TO_0(v)) -+ -+#define BIT_LPFEN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_LDO_HV5_DUMMY 14 -+#define BIT_MASK_LDO_HV5_DUMMY 0x3 -+#define BIT_LDO_HV5_DUMMY(x) \ -+ (((x) & BIT_MASK_LDO_HV5_DUMMY) << BIT_SHIFT_LDO_HV5_DUMMY) -+#define BITS_LDO_HV5_DUMMY (BIT_MASK_LDO_HV5_DUMMY << BIT_SHIFT_LDO_HV5_DUMMY) -+#define BIT_CLEAR_LDO_HV5_DUMMY(x) ((x) & (~BITS_LDO_HV5_DUMMY)) -+#define BIT_GET_LDO_HV5_DUMMY(x) \ -+ (((x) >> BIT_SHIFT_LDO_HV5_DUMMY) & BIT_MASK_LDO_HV5_DUMMY) -+#define BIT_SET_LDO_HV5_DUMMY(x, v) \ -+ (BIT_CLEAR_LDO_HV5_DUMMY(x) | BIT_LDO_HV5_DUMMY(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_REG_DOGENB BIT(14) -+#define BIT_REG_TEST_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_VTUNE33 12 -+#define BIT_MASK_REG_VTUNE33 0x3 -+#define BIT_REG_VTUNE33(x) \ -+ (((x) & BIT_MASK_REG_VTUNE33) << BIT_SHIFT_REG_VTUNE33) -+#define BITS_REG_VTUNE33 (BIT_MASK_REG_VTUNE33 << BIT_SHIFT_REG_VTUNE33) -+#define BIT_CLEAR_REG_VTUNE33(x) ((x) & (~BITS_REG_VTUNE33)) -+#define BIT_GET_REG_VTUNE33(x) \ -+ (((x) >> BIT_SHIFT_REG_VTUNE33) & BIT_MASK_REG_VTUNE33) -+#define BIT_SET_REG_VTUNE33(x, v) \ -+ (BIT_CLEAR_REG_VTUNE33(x) | BIT_REG_VTUNE33(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1 12 -+#define BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1 0x3 -+#define BIT_REG_VTUNE33_BIT0_TO_BIT1(x) \ -+ (((x) & BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1) \ -+ << BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1) -+#define BITS_REG_VTUNE33_BIT0_TO_BIT1 \ -+ (BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1 \ -+ << BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1) -+#define BIT_CLEAR_REG_VTUNE33_BIT0_TO_BIT1(x) \ -+ ((x) & (~BITS_REG_VTUNE33_BIT0_TO_BIT1)) -+#define BIT_GET_REG_VTUNE33_BIT0_TO_BIT1(x) \ -+ (((x) >> BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1) & \ -+ BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1) -+#define BIT_SET_REG_VTUNE33_BIT0_TO_BIT1(x, v) \ -+ (BIT_CLEAR_REG_VTUNE33_BIT0_TO_BIT1(x) | \ -+ BIT_REG_VTUNE33_BIT0_TO_BIT1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_STANDBY33 10 -+#define BIT_MASK_REG_STANDBY33 0x3 -+#define BIT_REG_STANDBY33(x) \ -+ (((x) & BIT_MASK_REG_STANDBY33) << BIT_SHIFT_REG_STANDBY33) -+#define BITS_REG_STANDBY33 (BIT_MASK_REG_STANDBY33 << BIT_SHIFT_REG_STANDBY33) -+#define BIT_CLEAR_REG_STANDBY33(x) ((x) & (~BITS_REG_STANDBY33)) -+#define BIT_GET_REG_STANDBY33(x) \ -+ (((x) >> BIT_SHIFT_REG_STANDBY33) & BIT_MASK_REG_STANDBY33) -+#define BIT_SET_REG_STANDBY33(x, v) \ -+ (BIT_CLEAR_REG_STANDBY33(x) | BIT_REG_STANDBY33(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1 10 -+#define BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1 0x3 -+#define BIT_REG_STANDBY33_BIT0_TO_BIT1(x) \ -+ (((x) & BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1) \ -+ << BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1) -+#define BITS_REG_STANDBY33_BIT0_TO_BIT1 \ -+ (BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1 \ -+ << BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1) -+#define BIT_CLEAR_REG_STANDBY33_BIT0_TO_BIT1(x) \ -+ ((x) & (~BITS_REG_STANDBY33_BIT0_TO_BIT1)) -+#define BIT_GET_REG_STANDBY33_BIT0_TO_BIT1(x) \ -+ (((x) >> BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1) & \ -+ BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1) -+#define BIT_SET_REG_STANDBY33_BIT0_TO_BIT1(x, v) \ -+ (BIT_CLEAR_REG_STANDBY33_BIT0_TO_BIT1(x) | \ -+ BIT_REG_STANDBY33_BIT0_TO_BIT1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_LOAD33 8 -+#define BIT_MASK_REG_LOAD33 0x3 -+#define BIT_REG_LOAD33(x) (((x) & BIT_MASK_REG_LOAD33) << BIT_SHIFT_REG_LOAD33) -+#define BITS_REG_LOAD33 (BIT_MASK_REG_LOAD33 << BIT_SHIFT_REG_LOAD33) -+#define BIT_CLEAR_REG_LOAD33(x) ((x) & (~BITS_REG_LOAD33)) -+#define BIT_GET_REG_LOAD33(x) \ -+ (((x) >> BIT_SHIFT_REG_LOAD33) & BIT_MASK_REG_LOAD33) -+#define BIT_SET_REG_LOAD33(x, v) (BIT_CLEAR_REG_LOAD33(x) | BIT_REG_LOAD33(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1 8 -+#define BIT_MASK_REG_LOAD33_BIT0_TO_BIT1 0x3 -+#define BIT_REG_LOAD33_BIT0_TO_BIT1(x) \ -+ (((x) & BIT_MASK_REG_LOAD33_BIT0_TO_BIT1) \ -+ << BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1) -+#define BITS_REG_LOAD33_BIT0_TO_BIT1 \ -+ (BIT_MASK_REG_LOAD33_BIT0_TO_BIT1 << BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1) -+#define BIT_CLEAR_REG_LOAD33_BIT0_TO_BIT1(x) \ -+ ((x) & (~BITS_REG_LOAD33_BIT0_TO_BIT1)) -+#define BIT_GET_REG_LOAD33_BIT0_TO_BIT1(x) \ -+ (((x) >> BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1) & \ -+ BIT_MASK_REG_LOAD33_BIT0_TO_BIT1) -+#define BIT_SET_REG_LOAD33_BIT0_TO_BIT1(x, v) \ -+ (BIT_CLEAR_REG_LOAD33_BIT0_TO_BIT1(x) | BIT_REG_LOAD33_BIT0_TO_BIT1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_DIV_SEL 8 -+#define BIT_MASK_REG_DIV_SEL 0x1f -+#define BIT_REG_DIV_SEL(x) \ -+ (((x) & BIT_MASK_REG_DIV_SEL) << BIT_SHIFT_REG_DIV_SEL) -+#define BITS_REG_DIV_SEL (BIT_MASK_REG_DIV_SEL << BIT_SHIFT_REG_DIV_SEL) -+#define BIT_CLEAR_REG_DIV_SEL(x) ((x) & (~BITS_REG_DIV_SEL)) -+#define BIT_GET_REG_DIV_SEL(x) \ -+ (((x) >> BIT_SHIFT_REG_DIV_SEL) & BIT_MASK_REG_DIV_SEL) -+#define BIT_SET_REG_DIV_SEL(x, v) \ -+ (BIT_CLEAR_REG_DIV_SEL(x) | BIT_REG_DIV_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_REG_BYPASS_L BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_EN_CK200M BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_REG_LDOF_L BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_REG_OCPS_L BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_KVCO_200M_1_TO_0 5 -+#define BIT_MASK_REG_KVCO_200M_1_TO_0 0x3 -+#define BIT_REG_KVCO_200M_1_TO_0(x) \ -+ (((x) & BIT_MASK_REG_KVCO_200M_1_TO_0) \ -+ << BIT_SHIFT_REG_KVCO_200M_1_TO_0) -+#define BITS_REG_KVCO_200M_1_TO_0 \ -+ (BIT_MASK_REG_KVCO_200M_1_TO_0 << BIT_SHIFT_REG_KVCO_200M_1_TO_0) -+#define BIT_CLEAR_REG_KVCO_200M_1_TO_0(x) ((x) & (~BITS_REG_KVCO_200M_1_TO_0)) -+#define BIT_GET_REG_KVCO_200M_1_TO_0(x) \ -+ (((x) >> BIT_SHIFT_REG_KVCO_200M_1_TO_0) & \ -+ BIT_MASK_REG_KVCO_200M_1_TO_0) -+#define BIT_SET_REG_KVCO_200M_1_TO_0(x, v) \ -+ (BIT_CLEAR_REG_KVCO_200M_1_TO_0(x) | BIT_REG_KVCO_200M_1_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_REG_TYPE_L_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_ARENB_L BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_REG_CP_BIAS_200M_2_TO_0 2 -+#define BIT_MASK_REG_CP_BIAS_200M_2_TO_0 0x7 -+#define BIT_REG_CP_BIAS_200M_2_TO_0(x) \ -+ (((x) & BIT_MASK_REG_CP_BIAS_200M_2_TO_0) \ -+ << BIT_SHIFT_REG_CP_BIAS_200M_2_TO_0) -+#define BITS_REG_CP_BIAS_200M_2_TO_0 \ -+ (BIT_MASK_REG_CP_BIAS_200M_2_TO_0 << BIT_SHIFT_REG_CP_BIAS_200M_2_TO_0) -+#define BIT_CLEAR_REG_CP_BIAS_200M_2_TO_0(x) \ -+ ((x) & (~BITS_REG_CP_BIAS_200M_2_TO_0)) -+#define BIT_GET_REG_CP_BIAS_200M_2_TO_0(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_BIAS_200M_2_TO_0) & \ -+ BIT_MASK_REG_CP_BIAS_200M_2_TO_0) -+#define BIT_SET_REG_CP_BIAS_200M_2_TO_0(x, v) \ -+ (BIT_CLEAR_REG_CP_BIAS_200M_2_TO_0(x) | BIT_REG_CP_BIAS_200M_2_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_CFC_L_BIT_1_TO_0 1 -+#define BIT_MASK_CFC_L_BIT_1_TO_0 0x3 -+#define BIT_CFC_L_BIT_1_TO_0(x) \ -+ (((x) & BIT_MASK_CFC_L_BIT_1_TO_0) << BIT_SHIFT_CFC_L_BIT_1_TO_0) -+#define BITS_CFC_L_BIT_1_TO_0 \ -+ (BIT_MASK_CFC_L_BIT_1_TO_0 << BIT_SHIFT_CFC_L_BIT_1_TO_0) -+#define BIT_CLEAR_CFC_L_BIT_1_TO_0(x) ((x) & (~BITS_CFC_L_BIT_1_TO_0)) -+#define BIT_GET_CFC_L_BIT_1_TO_0(x) \ -+ (((x) >> BIT_SHIFT_CFC_L_BIT_1_TO_0) & BIT_MASK_CFC_L_BIT_1_TO_0) -+#define BIT_SET_CFC_L_BIT_1_TO_0(x, v) \ -+ (BIT_CLEAR_CFC_L_BIT_1_TO_0(x) | BIT_CFC_L_BIT_1_TO_0(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_SHIFT_CFC_L 1 -+#define BIT_MASK_CFC_L 0x3 -+#define BIT_CFC_L(x) (((x) & BIT_MASK_CFC_L) << BIT_SHIFT_CFC_L) -+#define BITS_CFC_L (BIT_MASK_CFC_L << BIT_SHIFT_CFC_L) -+#define BIT_CLEAR_CFC_L(x) ((x) & (~BITS_CFC_L)) -+#define BIT_GET_CFC_L(x) (((x) >> BIT_SHIFT_CFC_L) & BIT_MASK_CFC_L) -+#define BIT_SET_CFC_L(x, v) (BIT_CLEAR_CFC_L(x) | BIT_CFC_L(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_REG_TYPE_L BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_XCK_OUT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LDO_SWR_CTRL (Offset 0x007C) */ -+ -+#define BIT_REG_OCPS_L_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCUSUS_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_ANA_PORT_EN BIT(22) -+#define BIT_MAC_PORT_EN BIT(21) -+#define BIT_BOOT_FSPI_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_SHIFT_MCUROM_DL 16 -+#define BIT_MASK_MCUROM_DL 0xf -+#define BIT_MCUROM_DL(x) (((x) & BIT_MASK_MCUROM_DL) << BIT_SHIFT_MCUROM_DL) -+#define BITS_MCUROM_DL (BIT_MASK_MCUROM_DL << BIT_SHIFT_MCUROM_DL) -+#define BIT_CLEAR_MCUROM_DL(x) ((x) & (~BITS_MCUROM_DL)) -+#define BIT_GET_MCUROM_DL(x) (((x) >> BIT_SHIFT_MCUROM_DL) & BIT_MASK_MCUROM_DL) -+#define BIT_SET_MCUROM_DL(x, v) (BIT_CLEAR_MCUROM_DL(x) | BIT_MCUROM_DL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_FW_INIT_RDY BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_SHIFT_MCUFWDL_DMA_2KB_SEL 14 -+#define BIT_MASK_MCUFWDL_DMA_2KB_SEL 0x3 -+#define BIT_MCUFWDL_DMA_2KB_SEL(x) \ -+ (((x) & BIT_MASK_MCUFWDL_DMA_2KB_SEL) << BIT_SHIFT_MCUFWDL_DMA_2KB_SEL) -+#define BITS_MCUFWDL_DMA_2KB_SEL \ -+ (BIT_MASK_MCUFWDL_DMA_2KB_SEL << BIT_SHIFT_MCUFWDL_DMA_2KB_SEL) -+#define BIT_CLEAR_MCUFWDL_DMA_2KB_SEL(x) ((x) & (~BITS_MCUFWDL_DMA_2KB_SEL)) -+#define BIT_GET_MCUFWDL_DMA_2KB_SEL(x) \ -+ (((x) >> BIT_SHIFT_MCUFWDL_DMA_2KB_SEL) & BIT_MASK_MCUFWDL_DMA_2KB_SEL) -+#define BIT_SET_MCUFWDL_DMA_2KB_SEL(x, v) \ -+ (BIT_CLEAR_MCUFWDL_DMA_2KB_SEL(x) | BIT_MCUFWDL_DMA_2KB_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_FW_DW_RDY BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_8051FW_CTRL (Offset 0x0080) */ -+ -+#define BIT_FWDL_RSVDPAGE_RDY BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_SHIFT_CPU_CLK_SEL 12 -+#define BIT_MASK_CPU_CLK_SEL 0x3 -+#define BIT_CPU_CLK_SEL(x) \ -+ (((x) & BIT_MASK_CPU_CLK_SEL) << BIT_SHIFT_CPU_CLK_SEL) -+#define BITS_CPU_CLK_SEL (BIT_MASK_CPU_CLK_SEL << BIT_SHIFT_CPU_CLK_SEL) -+#define BIT_CLEAR_CPU_CLK_SEL(x) ((x) & (~BITS_CPU_CLK_SEL)) -+#define BIT_GET_CPU_CLK_SEL(x) \ -+ (((x) >> BIT_SHIFT_CPU_CLK_SEL) & BIT_MASK_CPU_CLK_SEL) -+#define BIT_SET_CPU_CLK_SEL(x, v) \ -+ (BIT_CLEAR_CPU_CLK_SEL(x) | BIT_CPU_CLK_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_8051FW_CTRL (Offset 0x0080) */ -+ -+#define BIT_R_8051_ROMDLFW_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCUFWDL_DMA_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_CCLK_CHG_MASK BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_8051FW_CTRL (Offset 0x0080) */ -+ -+#define BIT_R_8051_INIT_RDY BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCUINI_WROMRDY BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_FW_INIT_RDY_V1 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_EMEM__TXBUF_CHKSUM_OK BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_EMEM_TXBUF_CHKSUM_OK BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCUTXA_SPD BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_EMEM_TXBUF_DW_RDY BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_8051FW_CTRL (Offset 0x0080) */ -+ -+#define BIT_R_8051_GAT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCUCLK_TEN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCU_CLK_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_EMEM_CHKSUM_OK BIT(8) -+#define BIT_EMEM_DW_OK BIT(7) -+#define BIT_TOGGLE BIT(7) -+#define BIT_DMEM_CHKSUM_OK BIT(6) -+#define BIT_ACK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_8051FW_CTRL (Offset 0x0080) */ -+ -+#define BIT_RFINI_RDY BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCUINI_WRFCRDY BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_RF_INIT_RDY BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_DMEM_DW_OK BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_8051FW_CTRL (Offset 0x0080) */ -+ -+#define BIT_BBINI_RDY BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCUINI_WPHYRDY BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_BB_INIT_RDY BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_IMEM_CHKSUM_OK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_8051FW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MACINI_RDY BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCUINI_WMACRDY BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MAC_INIT_RDY BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_IMEM_DW_OK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_8051FW_CTRL (Offset 0x0080) */ -+ -+#define BIT_FWDL_CHK_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_IMEM_BOOT_LOAD_CHKSUM_OK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_8051FW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCUFWDL_RDY BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_IMEM_BOOT_LOAD_DW_OK BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MCUFW_CTRL (Offset 0x0080) */ -+ -+#define BIT_MCU_FWDL_RDY BIT(1) -+#define BIT_MCU_FWDL_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HRPWM1 (Offset 0x10250080) */ -+ -+#define BIT_REQ_PS BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MCU_TST_CFG (Offset 0x0084) */ -+ -+#define BIT_SHIFT_8051CODE_OFS 16 -+#define BIT_MASK_8051CODE_OFS 0xffff -+#define BIT_8051CODE_OFS(x) \ -+ (((x) & BIT_MASK_8051CODE_OFS) << BIT_SHIFT_8051CODE_OFS) -+#define BITS_8051CODE_OFS (BIT_MASK_8051CODE_OFS << BIT_SHIFT_8051CODE_OFS) -+#define BIT_CLEAR_8051CODE_OFS(x) ((x) & (~BITS_8051CODE_OFS)) -+#define BIT_GET_8051CODE_OFS(x) \ -+ (((x) >> BIT_SHIFT_8051CODE_OFS) & BIT_MASK_8051CODE_OFS) -+#define BIT_SET_8051CODE_OFS(x, v) \ -+ (BIT_CLEAR_8051CODE_OFS(x) | BIT_8051CODE_OFS(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MCU_TST_CFG (Offset 0x0084) */ -+ -+#define BIT_SHIFT_LBKTST 0 -+#define BIT_MASK_LBKTST 0xffff -+#define BIT_LBKTST(x) (((x) & BIT_MASK_LBKTST) << BIT_SHIFT_LBKTST) -+#define BITS_LBKTST (BIT_MASK_LBKTST << BIT_SHIFT_LBKTST) -+#define BIT_CLEAR_LBKTST(x) ((x) & (~BITS_LBKTST)) -+#define BIT_GET_LBKTST(x) (((x) >> BIT_SHIFT_LBKTST) & BIT_MASK_LBKTST) -+#define BIT_SET_LBKTST(x, v) (BIT_CLEAR_LBKTST(x) | BIT_LBKTST(v)) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MCU_TST_CFG (Offset 0x0084) */ -+ -+#define BIT_SHIFT_C2H_MSG 0 -+#define BIT_MASK_C2H_MSG 0xffff -+#define BIT_C2H_MSG(x) (((x) & BIT_MASK_C2H_MSG) << BIT_SHIFT_C2H_MSG) -+#define BITS_C2H_MSG (BIT_MASK_C2H_MSG << BIT_SHIFT_C2H_MSG) -+#define BIT_CLEAR_C2H_MSG(x) ((x) & (~BITS_C2H_MSG)) -+#define BIT_GET_C2H_MSG(x) (((x) >> BIT_SHIFT_C2H_MSG) & BIT_MASK_C2H_MSG) -+#define BIT_SET_C2H_MSG(x, v) (BIT_CLEAR_C2H_MSG(x) | BIT_C2H_MSG(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_BUS_CTRL (Offset 0x10250085) */ -+ -+#define BIT_INT_MASK_DIS BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_BUS_CTRL (Offset 0x10250085) */ -+ -+#define BIT_PAD_CLK_XHGE_EN BIT(3) -+#define BIT_INTER_CLK_EN BIT(2) -+#define BIT_EN_RPT_TXCRC BIT(1) -+#define BIT_DIS_RXDMA_STS BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_SDIO_HSUS_CTRL (Offset 0x10250086) */ -+ -+#define BIT_SPI_PHASE BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HSUS_CTRL (Offset 0x10250086) */ -+ -+#define BIT_INTR_CTRL BIT(4) -+#define BIT_SDIO_VOLTAGE BIT(3) -+#define BIT_BYPASS_INIT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HSUS_CTRL (Offset 0x10250086) */ -+ -+#define BIT_HCI_RESUME_RDY BIT(1) -+#define BIT_HCI_SUS_REQ BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HMEBOX_E0_E1 (Offset 0x0088) */ -+ -+#define BIT_SHIFT_HOST_MSG_E1 16 -+#define BIT_MASK_HOST_MSG_E1 0xffff -+#define BIT_HOST_MSG_E1(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E1) << BIT_SHIFT_HOST_MSG_E1) -+#define BITS_HOST_MSG_E1 (BIT_MASK_HOST_MSG_E1 << BIT_SHIFT_HOST_MSG_E1) -+#define BIT_CLEAR_HOST_MSG_E1(x) ((x) & (~BITS_HOST_MSG_E1)) -+#define BIT_GET_HOST_MSG_E1(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E1) & BIT_MASK_HOST_MSG_E1) -+#define BIT_SET_HOST_MSG_E1(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E1(x) | BIT_HOST_MSG_E1(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E0 0 -+#define BIT_MASK_HOST_MSG_E0 0xffff -+#define BIT_HOST_MSG_E0(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E0) << BIT_SHIFT_HOST_MSG_E0) -+#define BITS_HOST_MSG_E0 (BIT_MASK_HOST_MSG_E0 << BIT_SHIFT_HOST_MSG_E0) -+#define BIT_CLEAR_HOST_MSG_E0(x) ((x) & (~BITS_HOST_MSG_E0)) -+#define BIT_GET_HOST_MSG_E0(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E0) & BIT_MASK_HOST_MSG_E0) -+#define BIT_SET_HOST_MSG_E0(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E0(x) | BIT_HOST_MSG_E0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_RESPONSE_TIMER (Offset 0x10250088) */ -+ -+#define BIT_SHIFT_CMDIN_2RESP_TIMER 0 -+#define BIT_MASK_CMDIN_2RESP_TIMER 0xffff -+#define BIT_CMDIN_2RESP_TIMER(x) \ -+ (((x) & BIT_MASK_CMDIN_2RESP_TIMER) << BIT_SHIFT_CMDIN_2RESP_TIMER) -+#define BITS_CMDIN_2RESP_TIMER \ -+ (BIT_MASK_CMDIN_2RESP_TIMER << BIT_SHIFT_CMDIN_2RESP_TIMER) -+#define BIT_CLEAR_CMDIN_2RESP_TIMER(x) ((x) & (~BITS_CMDIN_2RESP_TIMER)) -+#define BIT_GET_CMDIN_2RESP_TIMER(x) \ -+ (((x) >> BIT_SHIFT_CMDIN_2RESP_TIMER) & BIT_MASK_CMDIN_2RESP_TIMER) -+#define BIT_SET_CMDIN_2RESP_TIMER(x, v) \ -+ (BIT_CLEAR_CMDIN_2RESP_TIMER(x) | BIT_CMDIN_2RESP_TIMER(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SDIO_CMD_CRC (Offset 0x1025008A) */ -+ -+#define BIT_SHIFT_SDIO_CMD_CRC 1 -+#define BIT_MASK_SDIO_CMD_CRC 0x7f -+#define BIT_SDIO_CMD_CRC(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_CRC) << BIT_SHIFT_SDIO_CMD_CRC) -+#define BITS_SDIO_CMD_CRC (BIT_MASK_SDIO_CMD_CRC << BIT_SHIFT_SDIO_CMD_CRC) -+#define BIT_CLEAR_SDIO_CMD_CRC(x) ((x) & (~BITS_SDIO_CMD_CRC)) -+#define BIT_GET_SDIO_CMD_CRC(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_CRC) & BIT_MASK_SDIO_CMD_CRC) -+#define BIT_SET_SDIO_CMD_CRC(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_CRC(x) | BIT_SDIO_CMD_CRC(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_CMD_CRC (Offset 0x1025008A) */ -+ -+#define BIT_SHIFT_SDIO_CMD_CRC_V1 0 -+#define BIT_MASK_SDIO_CMD_CRC_V1 0xff -+#define BIT_SDIO_CMD_CRC_V1(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_CRC_V1) << BIT_SHIFT_SDIO_CMD_CRC_V1) -+#define BITS_SDIO_CMD_CRC_V1 \ -+ (BIT_MASK_SDIO_CMD_CRC_V1 << BIT_SHIFT_SDIO_CMD_CRC_V1) -+#define BIT_CLEAR_SDIO_CMD_CRC_V1(x) ((x) & (~BITS_SDIO_CMD_CRC_V1)) -+#define BIT_GET_SDIO_CMD_CRC_V1(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_CRC_V1) & BIT_MASK_SDIO_CMD_CRC_V1) -+#define BIT_SET_SDIO_CMD_CRC_V1(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_CRC_V1(x) | BIT_SDIO_CMD_CRC_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SDIO_CMD_CRC (Offset 0x1025008A) */ -+ -+#define BIT_SDIO_CMD_E_BIT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HMEBOX_E2_E3 (Offset 0x008C) */ -+ -+#define BIT_SHIFT_HOST_MSG_E3 16 -+#define BIT_MASK_HOST_MSG_E3 0xffff -+#define BIT_HOST_MSG_E3(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E3) << BIT_SHIFT_HOST_MSG_E3) -+#define BITS_HOST_MSG_E3 (BIT_MASK_HOST_MSG_E3 << BIT_SHIFT_HOST_MSG_E3) -+#define BIT_CLEAR_HOST_MSG_E3(x) ((x) & (~BITS_HOST_MSG_E3)) -+#define BIT_GET_HOST_MSG_E3(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E3) & BIT_MASK_HOST_MSG_E3) -+#define BIT_SET_HOST_MSG_E3(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E3(x) | BIT_HOST_MSG_E3(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E2 0 -+#define BIT_MASK_HOST_MSG_E2 0xffff -+#define BIT_HOST_MSG_E2(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E2) << BIT_SHIFT_HOST_MSG_E2) -+#define BITS_HOST_MSG_E2 (BIT_MASK_HOST_MSG_E2 << BIT_SHIFT_HOST_MSG_E2) -+#define BIT_CLEAR_HOST_MSG_E2(x) ((x) & (~BITS_HOST_MSG_E2)) -+#define BIT_GET_HOST_MSG_E2(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E2) & BIT_MASK_HOST_MSG_E2) -+#define BIT_SET_HOST_MSG_E2(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E2(x) | BIT_HOST_MSG_E2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_EABM BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_ACKF BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_TXFIFO_TH_INT BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_DLDM BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_NODS BIT(29) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_AFEP BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_ESWR BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_LPS_DIS_SW BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_PWMM BIT(27) -+#define BIT_WLLPSOP_EECK BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_WLPON BIT(25) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_WLMACOFF BIT(25) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_ELDO BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_EXTAL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WL_SYNPON_VOLTSPDN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_LPS_BB_REG_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_LOP_SKIP BIT(22) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_WLBBOFF BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_LPS_BB_PWR_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_LOP_MEMDS BIT(21) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_WLMEM_DS BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_LPS_BB_GLB_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WLLPSOP_LDO_WAIT_TIME BIT(20) -+#define BIT_WLLPSOP_ANA_CLK_DIVISION_2 BIT(19) -+#define BIT_AFE_BCN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_SUS_DIS_SW BIT(15) -+#define BIT_SUS_SKP_PAGE0_ALD BIT(14) -+#define BIT_SUS_LDO_SLEEP BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_SHIFT_LPLDH12_VADJ_STEP_DN 12 -+#define BIT_MASK_LPLDH12_VADJ_STEP_DN 0xf -+#define BIT_LPLDH12_VADJ_STEP_DN(x) \ -+ (((x) & BIT_MASK_LPLDH12_VADJ_STEP_DN) \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN) -+#define BITS_LPLDH12_VADJ_STEP_DN \ -+ (BIT_MASK_LPLDH12_VADJ_STEP_DN << BIT_SHIFT_LPLDH12_VADJ_STEP_DN) -+#define BIT_CLEAR_LPLDH12_VADJ_STEP_DN(x) ((x) & (~BITS_LPLDH12_VADJ_STEP_DN)) -+#define BIT_GET_LPLDH12_VADJ_STEP_DN(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_VADJ_STEP_DN) & \ -+ BIT_MASK_LPLDH12_VADJ_STEP_DN) -+#define BIT_SET_LPLDH12_VADJ_STEP_DN(x, v) \ -+ (BIT_CLEAR_LPLDH12_VADJ_STEP_DN(x) | BIT_LPLDH12_VADJ_STEP_DN(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_PFM_EN_ZCD BIT(12) -+#define BIT_KEEP_RFC_EN BIT(11) -+#define BIT_MACON_NO_RFCISO_RELEASE BIT(10) -+#define BIT_MACON_NO_AFEPORT_PWR BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_SHIFT_V15ADJ_L1_STEP_DN 8 -+#define BIT_MASK_V15ADJ_L1_STEP_DN 0x7 -+#define BIT_V15ADJ_L1_STEP_DN(x) \ -+ (((x) & BIT_MASK_V15ADJ_L1_STEP_DN) << BIT_SHIFT_V15ADJ_L1_STEP_DN) -+#define BITS_V15ADJ_L1_STEP_DN \ -+ (BIT_MASK_V15ADJ_L1_STEP_DN << BIT_SHIFT_V15ADJ_L1_STEP_DN) -+#define BIT_CLEAR_V15ADJ_L1_STEP_DN(x) ((x) & (~BITS_V15ADJ_L1_STEP_DN)) -+#define BIT_GET_V15ADJ_L1_STEP_DN(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L1_STEP_DN) & BIT_MASK_V15ADJ_L1_STEP_DN) -+#define BIT_SET_V15ADJ_L1_STEP_DN(x, v) \ -+ (BIT_CLEAR_V15ADJ_L1_STEP_DN(x) | BIT_V15ADJ_L1_STEP_DN(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_SHIFT_V15ADJ_L1_STEP_DN_V1 8 -+#define BIT_MASK_V15ADJ_L1_STEP_DN_V1 0xf -+#define BIT_V15ADJ_L1_STEP_DN_V1(x) \ -+ (((x) & BIT_MASK_V15ADJ_L1_STEP_DN_V1) \ -+ << BIT_SHIFT_V15ADJ_L1_STEP_DN_V1) -+#define BITS_V15ADJ_L1_STEP_DN_V1 \ -+ (BIT_MASK_V15ADJ_L1_STEP_DN_V1 << BIT_SHIFT_V15ADJ_L1_STEP_DN_V1) -+#define BIT_CLEAR_V15ADJ_L1_STEP_DN_V1(x) ((x) & (~BITS_V15ADJ_L1_STEP_DN_V1)) -+#define BIT_GET_V15ADJ_L1_STEP_DN_V1(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L1_STEP_DN_V1) & \ -+ BIT_MASK_V15ADJ_L1_STEP_DN_V1) -+#define BIT_SET_V15ADJ_L1_STEP_DN_V1(x, v) \ -+ (BIT_CLEAR_V15ADJ_L1_STEP_DN_V1(x) | BIT_V15ADJ_L1_STEP_DN_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_MACON_NO_CPU_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_LD_B15V_EN BIT(7) -+#define BIT_LPRX_BCN_EN BIT(5) -+#define BIT_LBN BIT(4) -+#define BIT_LXSPS_UNUSED BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_FORCE_LEAVE_LPS BIT(3) -+#define BIT_SW_AFE_MODE BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_REGU_32K_CLK_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HSISR (Offset 0x10250090) */ -+ -+#define BIT_DRV_WLAN_INT_CLR BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WLLPS_CTRL (Offset 0x0090) */ -+ -+#define BIT_WL_LPS_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HSISR (Offset 0x10250090) */ -+ -+#define BIT_DRV_WLAN_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_HSIMR (Offset 0x10250091) */ -+ -+#define BIT_HISR_MASK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL5 (Offset 0x0094) */ -+ -+#define BIT_BB_DBG_SEL_AFE_SDM_V3 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL5 (Offset 0x0094) */ -+ -+#define BIT_BB_DBG_SEL_AFE_SDM_BIT0 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL5 (Offset 0x0094) */ -+ -+#define BIT_ORDER_SDM BIT(30) -+#define BIT_RFE_SEL_SDM BIT(29) -+ -+#define BIT_SHIFT_REF_SEL 25 -+#define BIT_MASK_REF_SEL 0xf -+#define BIT_REF_SEL(x) (((x) & BIT_MASK_REF_SEL) << BIT_SHIFT_REF_SEL) -+#define BITS_REF_SEL (BIT_MASK_REF_SEL << BIT_SHIFT_REF_SEL) -+#define BIT_CLEAR_REF_SEL(x) ((x) & (~BITS_REF_SEL)) -+#define BIT_GET_REF_SEL(x) (((x) >> BIT_SHIFT_REF_SEL) & BIT_MASK_REF_SEL) -+#define BIT_SET_REF_SEL(x, v) (BIT_CLEAR_REF_SEL(x) | BIT_REF_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL5 (Offset 0x0094) */ -+ -+#define BIT_SHIFT_F0F_SDM_V2 12 -+#define BIT_MASK_F0F_SDM_V2 0x1fff -+#define BIT_F0F_SDM_V2(x) (((x) & BIT_MASK_F0F_SDM_V2) << BIT_SHIFT_F0F_SDM_V2) -+#define BITS_F0F_SDM_V2 (BIT_MASK_F0F_SDM_V2 << BIT_SHIFT_F0F_SDM_V2) -+#define BIT_CLEAR_F0F_SDM_V2(x) ((x) & (~BITS_F0F_SDM_V2)) -+#define BIT_GET_F0F_SDM_V2(x) \ -+ (((x) >> BIT_SHIFT_F0F_SDM_V2) & BIT_MASK_F0F_SDM_V2) -+#define BIT_SET_F0F_SDM_V2(x, v) (BIT_CLEAR_F0F_SDM_V2(x) | BIT_F0F_SDM_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL5 (Offset 0x0094) */ -+ -+#define BIT_SHIFT_F0F_SDM 12 -+#define BIT_MASK_F0F_SDM 0x1fff -+#define BIT_F0F_SDM(x) (((x) & BIT_MASK_F0F_SDM) << BIT_SHIFT_F0F_SDM) -+#define BITS_F0F_SDM (BIT_MASK_F0F_SDM << BIT_SHIFT_F0F_SDM) -+#define BIT_CLEAR_F0F_SDM(x) ((x) & (~BITS_F0F_SDM)) -+#define BIT_GET_F0F_SDM(x) (((x) >> BIT_SHIFT_F0F_SDM) & BIT_MASK_F0F_SDM) -+#define BIT_SET_F0F_SDM(x, v) (BIT_CLEAR_F0F_SDM(x) | BIT_F0F_SDM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL5 (Offset 0x0094) */ -+ -+#define BIT_SHIFT_F0N_SDM_V2 9 -+#define BIT_MASK_F0N_SDM_V2 0x7 -+#define BIT_F0N_SDM_V2(x) (((x) & BIT_MASK_F0N_SDM_V2) << BIT_SHIFT_F0N_SDM_V2) -+#define BITS_F0N_SDM_V2 (BIT_MASK_F0N_SDM_V2 << BIT_SHIFT_F0N_SDM_V2) -+#define BIT_CLEAR_F0N_SDM_V2(x) ((x) & (~BITS_F0N_SDM_V2)) -+#define BIT_GET_F0N_SDM_V2(x) \ -+ (((x) >> BIT_SHIFT_F0N_SDM_V2) & BIT_MASK_F0N_SDM_V2) -+#define BIT_SET_F0N_SDM_V2(x, v) (BIT_CLEAR_F0N_SDM_V2(x) | BIT_F0N_SDM_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL5 (Offset 0x0094) */ -+ -+#define BIT_SHIFT_F0N_SDM 9 -+#define BIT_MASK_F0N_SDM 0x7 -+#define BIT_F0N_SDM(x) (((x) & BIT_MASK_F0N_SDM) << BIT_SHIFT_F0N_SDM) -+#define BITS_F0N_SDM (BIT_MASK_F0N_SDM << BIT_SHIFT_F0N_SDM) -+#define BIT_CLEAR_F0N_SDM(x) ((x) & (~BITS_F0N_SDM)) -+#define BIT_GET_F0N_SDM(x) (((x) >> BIT_SHIFT_F0N_SDM) & BIT_MASK_F0N_SDM) -+#define BIT_SET_F0N_SDM(x, v) (BIT_CLEAR_F0N_SDM(x) | BIT_F0N_SDM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL5 (Offset 0x0094) */ -+ -+#define BIT_SHIFT_DIVN_SDM_V2 3 -+#define BIT_MASK_DIVN_SDM_V2 0x3f -+#define BIT_DIVN_SDM_V2(x) \ -+ (((x) & BIT_MASK_DIVN_SDM_V2) << BIT_SHIFT_DIVN_SDM_V2) -+#define BITS_DIVN_SDM_V2 (BIT_MASK_DIVN_SDM_V2 << BIT_SHIFT_DIVN_SDM_V2) -+#define BIT_CLEAR_DIVN_SDM_V2(x) ((x) & (~BITS_DIVN_SDM_V2)) -+#define BIT_GET_DIVN_SDM_V2(x) \ -+ (((x) >> BIT_SHIFT_DIVN_SDM_V2) & BIT_MASK_DIVN_SDM_V2) -+#define BIT_SET_DIVN_SDM_V2(x, v) \ -+ (BIT_CLEAR_DIVN_SDM_V2(x) | BIT_DIVN_SDM_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL5 (Offset 0x0094) */ -+ -+#define BIT_SHIFT_DIVN_SDM 3 -+#define BIT_MASK_DIVN_SDM 0x3f -+#define BIT_DIVN_SDM(x) (((x) & BIT_MASK_DIVN_SDM) << BIT_SHIFT_DIVN_SDM) -+#define BITS_DIVN_SDM (BIT_MASK_DIVN_SDM << BIT_SHIFT_DIVN_SDM) -+#define BIT_CLEAR_DIVN_SDM(x) ((x) & (~BITS_DIVN_SDM)) -+#define BIT_GET_DIVN_SDM(x) (((x) >> BIT_SHIFT_DIVN_SDM) & BIT_MASK_DIVN_SDM) -+#define BIT_SET_DIVN_SDM(x, v) (BIT_CLEAR_DIVN_SDM(x) | BIT_DIVN_SDM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL5 (Offset 0x0094) */ -+ -+#define BIT_SHIFT_DITHER_SDM_V2 0 -+#define BIT_MASK_DITHER_SDM_V2 0x7 -+#define BIT_DITHER_SDM_V2(x) \ -+ (((x) & BIT_MASK_DITHER_SDM_V2) << BIT_SHIFT_DITHER_SDM_V2) -+#define BITS_DITHER_SDM_V2 (BIT_MASK_DITHER_SDM_V2 << BIT_SHIFT_DITHER_SDM_V2) -+#define BIT_CLEAR_DITHER_SDM_V2(x) ((x) & (~BITS_DITHER_SDM_V2)) -+#define BIT_GET_DITHER_SDM_V2(x) \ -+ (((x) >> BIT_SHIFT_DITHER_SDM_V2) & BIT_MASK_DITHER_SDM_V2) -+#define BIT_SET_DITHER_SDM_V2(x, v) \ -+ (BIT_CLEAR_DITHER_SDM_V2(x) | BIT_DITHER_SDM_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GPIO_DEBOUNCE_CTRL (Offset 0x0098) */ -+ -+#define BIT_WLGP_DBC1EN BIT(15) -+ -+#define BIT_SHIFT_WLGP_DBC1 8 -+#define BIT_MASK_WLGP_DBC1 0xf -+#define BIT_WLGP_DBC1(x) (((x) & BIT_MASK_WLGP_DBC1) << BIT_SHIFT_WLGP_DBC1) -+#define BITS_WLGP_DBC1 (BIT_MASK_WLGP_DBC1 << BIT_SHIFT_WLGP_DBC1) -+#define BIT_CLEAR_WLGP_DBC1(x) ((x) & (~BITS_WLGP_DBC1)) -+#define BIT_GET_WLGP_DBC1(x) (((x) >> BIT_SHIFT_WLGP_DBC1) & BIT_MASK_WLGP_DBC1) -+#define BIT_SET_WLGP_DBC1(x, v) (BIT_CLEAR_WLGP_DBC1(x) | BIT_WLGP_DBC1(v)) -+ -+#define BIT_WLGP_DBC0EN BIT(7) -+ -+#define BIT_SHIFT_WLGP_DBC0 0 -+#define BIT_MASK_WLGP_DBC0 0xf -+#define BIT_WLGP_DBC0(x) (((x) & BIT_MASK_WLGP_DBC0) << BIT_SHIFT_WLGP_DBC0) -+#define BITS_WLGP_DBC0 (BIT_MASK_WLGP_DBC0 << BIT_SHIFT_WLGP_DBC0) -+#define BIT_CLEAR_WLGP_DBC0(x) ((x) & (~BITS_WLGP_DBC0)) -+#define BIT_GET_WLGP_DBC0(x) (((x) >> BIT_SHIFT_WLGP_DBC0) & BIT_MASK_WLGP_DBC0) -+#define BIT_SET_WLGP_DBC0(x, v) (BIT_CLEAR_WLGP_DBC0(x) | BIT_WLGP_DBC0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RPWM2 (Offset 0x009C) */ -+ -+#define BIT_SHIFT_RPWM2 16 -+#define BIT_MASK_RPWM2 0xffff -+#define BIT_RPWM2(x) (((x) & BIT_MASK_RPWM2) << BIT_SHIFT_RPWM2) -+#define BITS_RPWM2 (BIT_MASK_RPWM2 << BIT_SHIFT_RPWM2) -+#define BIT_CLEAR_RPWM2(x) ((x) & (~BITS_RPWM2)) -+#define BIT_GET_RPWM2(x) (((x) >> BIT_SHIFT_RPWM2) & BIT_MASK_RPWM2) -+#define BIT_SET_RPWM2(x, v) (BIT_CLEAR_RPWM2(x) | BIT_RPWM2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYSON_FSM_MON (Offset 0x00A0) */ -+ -+#define BIT_SHIFT_FSM_MON_SEL 24 -+#define BIT_MASK_FSM_MON_SEL 0x7 -+#define BIT_FSM_MON_SEL(x) \ -+ (((x) & BIT_MASK_FSM_MON_SEL) << BIT_SHIFT_FSM_MON_SEL) -+#define BITS_FSM_MON_SEL (BIT_MASK_FSM_MON_SEL << BIT_SHIFT_FSM_MON_SEL) -+#define BIT_CLEAR_FSM_MON_SEL(x) ((x) & (~BITS_FSM_MON_SEL)) -+#define BIT_GET_FSM_MON_SEL(x) \ -+ (((x) >> BIT_SHIFT_FSM_MON_SEL) & BIT_MASK_FSM_MON_SEL) -+#define BIT_SET_FSM_MON_SEL(x, v) \ -+ (BIT_CLEAR_FSM_MON_SEL(x) | BIT_FSM_MON_SEL(v)) -+ -+#define BIT_DOP_ELDO BIT(23) -+#define BIT_FSM_MON_UPD BIT(15) -+ -+#define BIT_SHIFT_FSM_PAR 0 -+#define BIT_MASK_FSM_PAR 0x7fff -+#define BIT_FSM_PAR(x) (((x) & BIT_MASK_FSM_PAR) << BIT_SHIFT_FSM_PAR) -+#define BITS_FSM_PAR (BIT_MASK_FSM_PAR << BIT_SHIFT_FSM_PAR) -+#define BIT_CLEAR_FSM_PAR(x) ((x) & (~BITS_FSM_PAR)) -+#define BIT_GET_FSM_PAR(x) (((x) >> BIT_SHIFT_FSM_PAR) & BIT_MASK_FSM_PAR) -+#define BIT_SET_FSM_PAR(x, v) (BIT_CLEAR_FSM_PAR(x) | BIT_FSM_PAR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL6 (Offset 0x00A4) */ -+ -+#define BIT_SHIFT_TSFT_SEL_V1 0 -+#define BIT_MASK_TSFT_SEL_V1 0x7 -+#define BIT_TSFT_SEL_V1(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_V1) << BIT_SHIFT_TSFT_SEL_V1) -+#define BITS_TSFT_SEL_V1 (BIT_MASK_TSFT_SEL_V1 << BIT_SHIFT_TSFT_SEL_V1) -+#define BIT_CLEAR_TSFT_SEL_V1(x) ((x) & (~BITS_TSFT_SEL_V1)) -+#define BIT_GET_TSFT_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_V1) & BIT_MASK_TSFT_SEL_V1) -+#define BIT_SET_TSFT_SEL_V1(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_V1(x) | BIT_TSFT_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL6 (Offset 0x00A4) */ -+ -+#define BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1 0 -+#define BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1 0x7 -+#define BIT_BB_DBG_SEL_AFE_SDM_BIT3_1(x) \ -+ (((x) & BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1) \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1) -+#define BITS_BB_DBG_SEL_AFE_SDM_BIT3_1 \ -+ (BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1 \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1) -+#define BIT_CLEAR_BB_DBG_SEL_AFE_SDM_BIT3_1(x) \ -+ ((x) & (~BITS_BB_DBG_SEL_AFE_SDM_BIT3_1)) -+#define BIT_GET_BB_DBG_SEL_AFE_SDM_BIT3_1(x) \ -+ (((x) >> BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1) & \ -+ BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1) -+#define BIT_SET_BB_DBG_SEL_AFE_SDM_BIT3_1(x, v) \ -+ (BIT_CLEAR_BB_DBG_SEL_AFE_SDM_BIT3_1(x) | \ -+ BIT_BB_DBG_SEL_AFE_SDM_BIT3_1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL1 (Offset 0x00A8) */ -+ -+#define BIT_BT_INT_EN BIT(31) -+ -+#define BIT_SHIFT_RD_WR_WIFI_BT_INFO 16 -+#define BIT_MASK_RD_WR_WIFI_BT_INFO 0x7fff -+#define BIT_RD_WR_WIFI_BT_INFO(x) \ -+ (((x) & BIT_MASK_RD_WR_WIFI_BT_INFO) << BIT_SHIFT_RD_WR_WIFI_BT_INFO) -+#define BITS_RD_WR_WIFI_BT_INFO \ -+ (BIT_MASK_RD_WR_WIFI_BT_INFO << BIT_SHIFT_RD_WR_WIFI_BT_INFO) -+#define BIT_CLEAR_RD_WR_WIFI_BT_INFO(x) ((x) & (~BITS_RD_WR_WIFI_BT_INFO)) -+#define BIT_GET_RD_WR_WIFI_BT_INFO(x) \ -+ (((x) >> BIT_SHIFT_RD_WR_WIFI_BT_INFO) & BIT_MASK_RD_WR_WIFI_BT_INFO) -+#define BIT_SET_RD_WR_WIFI_BT_INFO(x, v) \ -+ (BIT_CLEAR_RD_WR_WIFI_BT_INFO(x) | BIT_RD_WR_WIFI_BT_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL1 (Offset 0x00A8) */ -+ -+#define BIT_PMC_WR_OVF BIT(8) -+ -+#define BIT_SHIFT_WLPMC_ERRINT 0 -+#define BIT_MASK_WLPMC_ERRINT 0xff -+#define BIT_WLPMC_ERRINT(x) \ -+ (((x) & BIT_MASK_WLPMC_ERRINT) << BIT_SHIFT_WLPMC_ERRINT) -+#define BITS_WLPMC_ERRINT (BIT_MASK_WLPMC_ERRINT << BIT_SHIFT_WLPMC_ERRINT) -+#define BIT_CLEAR_WLPMC_ERRINT(x) ((x) & (~BITS_WLPMC_ERRINT)) -+#define BIT_GET_WLPMC_ERRINT(x) \ -+ (((x) >> BIT_SHIFT_WLPMC_ERRINT) & BIT_MASK_WLPMC_ERRINT) -+#define BIT_SET_WLPMC_ERRINT(x, v) \ -+ (BIT_CLEAR_WLPMC_ERRINT(x) | BIT_WLPMC_ERRINT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL7 (Offset 0x00AC) */ -+ -+#define BIT_SHIFT_SEL_V 30 -+#define BIT_MASK_SEL_V 0x3 -+#define BIT_SEL_V(x) (((x) & BIT_MASK_SEL_V) << BIT_SHIFT_SEL_V) -+#define BITS_SEL_V (BIT_MASK_SEL_V << BIT_SHIFT_SEL_V) -+#define BIT_CLEAR_SEL_V(x) ((x) & (~BITS_SEL_V)) -+#define BIT_GET_SEL_V(x) (((x) >> BIT_SHIFT_SEL_V) & BIT_MASK_SEL_V) -+#define BIT_SET_SEL_V(x, v) (BIT_CLEAR_SEL_V(x) | BIT_SEL_V(v)) -+ -+#define BIT_SEL_LDO_PC BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL7 (Offset 0x00AC) */ -+ -+#define BIT_SHIFT_CK_MON_SEL 26 -+#define BIT_MASK_CK_MON_SEL 0x7 -+#define BIT_CK_MON_SEL(x) (((x) & BIT_MASK_CK_MON_SEL) << BIT_SHIFT_CK_MON_SEL) -+#define BITS_CK_MON_SEL (BIT_MASK_CK_MON_SEL << BIT_SHIFT_CK_MON_SEL) -+#define BIT_CLEAR_CK_MON_SEL(x) ((x) & (~BITS_CK_MON_SEL)) -+#define BIT_GET_CK_MON_SEL(x) \ -+ (((x) >> BIT_SHIFT_CK_MON_SEL) & BIT_MASK_CK_MON_SEL) -+#define BIT_SET_CK_MON_SEL(x, v) (BIT_CLEAR_CK_MON_SEL(x) | BIT_CK_MON_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL7 (Offset 0x00AC) */ -+ -+#define BIT_SHIFT_CK_MON_SEL_V2 26 -+#define BIT_MASK_CK_MON_SEL_V2 0x7 -+#define BIT_CK_MON_SEL_V2(x) \ -+ (((x) & BIT_MASK_CK_MON_SEL_V2) << BIT_SHIFT_CK_MON_SEL_V2) -+#define BITS_CK_MON_SEL_V2 (BIT_MASK_CK_MON_SEL_V2 << BIT_SHIFT_CK_MON_SEL_V2) -+#define BIT_CLEAR_CK_MON_SEL_V2(x) ((x) & (~BITS_CK_MON_SEL_V2)) -+#define BIT_GET_CK_MON_SEL_V2(x) \ -+ (((x) >> BIT_SHIFT_CK_MON_SEL_V2) & BIT_MASK_CK_MON_SEL_V2) -+#define BIT_SET_CK_MON_SEL_V2(x, v) \ -+ (BIT_CLEAR_CK_MON_SEL_V2(x) | BIT_CK_MON_SEL_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL7 (Offset 0x00AC) */ -+ -+#define BIT_CK_MON_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL7 (Offset 0x00AC) */ -+ -+#define BIT_WL_DSS_SPEED_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL7 (Offset 0x00AC) */ -+ -+#define BIT_FREF_EDGE BIT(24) -+#define BIT_CK320M_EN BIT(23) -+#define BIT_CK_5M_EN BIT(22) -+#define BIT_TESTEN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL7 (Offset 0x00AC) */ -+ -+#define BIT_LD_B12V_EN_V1 BIT(7) -+ -+#define BIT_SHIFT_WL_DSS_COUNT_OUT 0 -+#define BIT_MASK_WL_DSS_COUNT_OUT 0xfffff -+#define BIT_WL_DSS_COUNT_OUT(x) \ -+ (((x) & BIT_MASK_WL_DSS_COUNT_OUT) << BIT_SHIFT_WL_DSS_COUNT_OUT) -+#define BITS_WL_DSS_COUNT_OUT \ -+ (BIT_MASK_WL_DSS_COUNT_OUT << BIT_SHIFT_WL_DSS_COUNT_OUT) -+#define BIT_CLEAR_WL_DSS_COUNT_OUT(x) ((x) & (~BITS_WL_DSS_COUNT_OUT)) -+#define BIT_GET_WL_DSS_COUNT_OUT(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_COUNT_OUT) & BIT_MASK_WL_DSS_COUNT_OUT) -+#define BIT_SET_WL_DSS_COUNT_OUT(x, v) \ -+ (BIT_CLEAR_WL_DSS_COUNT_OUT(x) | BIT_WL_DSS_COUNT_OUT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_TIMEOUT_INTERRUPT2_MASK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_PSTIMER_2_MSK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_TIMEOUT_INTERRUTP1_MASK BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_PSTIMER_1_MSK BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_PSTIMEOUT_MSK BIT(29) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_PSTIMER_0_MSK BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_GTINT4_MSK BIT(28) -+#define BIT_GTINT4 BIT(28) -+#define BIT_GTINT3_MSK BIT(27) -+#define BIT_GTINT3 BIT(27) -+#define BIT_TXBCN0ERR_MSK BIT(26) -+#define BIT_TXBCN0ERR BIT(26) -+#define BIT_TXBCN0OK_MSK BIT(25) -+#define BIT_TXBCN0OK BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_MSK BIT(24) -+#define BIT_TSF_BIT32_TOGGLE BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_TXDMA_START_INT_MSK BIT(23) -+#define BIT_TXDMA_STOP_INT_MSK BIT(22) -+#define BIT_HISR7_IND_MSK BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_BCNDMAINT0_MSK BIT(20) -+#define BIT_BCNDMAINT0 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR6_IND_MSK BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR5_MSK BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR5_IND_MSK BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR4_MSK BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR4_IND_MSK BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_BCNDERR0_MSK BIT(16) -+#define BIT_BCNDERR0 BIT(16) -+#define BIT_HSISR_IND_ON_INT_MSK BIT(15) -+#define BIT_HSISR_IND_ON_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_BCNDMAINT_E_MSK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR3_IND_INT_MSK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR3_IND_MSK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR2_IND_INT_MSK BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR2_IND_MSK BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_CTWEND_MSK BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR1_IND_MSK BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HISR1_IND_INT_MSK BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_C2HCMD_MSK BIT(10) -+#define BIT_C2HCMD BIT(10) -+#define BIT_CPWM2_MSK BIT(9) -+#define BIT_CPWM2 BIT(9) -+#define BIT_CPWM_MSK BIT(8) -+#define BIT_CPWM BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_HIGHDOK_MSK BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_TXDMAOK_CHANNEL15_MSK BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_MGTDOK_MSK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_TXDMAOK_CHANNEL14_MSK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_BKDOK_MSK BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_TXDMAOK_CHANNEL3_MSK BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_BEDOK_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_TXDMAOK_CHANNEL2_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_VIDOK_MSK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_TXDMAOK_CHANNEL1_MSK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_VODOK_MSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_TXDMAOK_CHANNEL0_MSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR0 (Offset 0x00B0) */ -+ -+#define BIT_RDU_MSK BIT(1) -+#define BIT_RDU BIT(1) -+#define BIT_RXOK_MSK BIT(0) -+#define BIT_RXOK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HISR0 (Offset 0x00B4) */ -+ -+#define BIT_PSTIMEOUT2 BIT(31) -+#define BIT_PSTIMEOUT1 BIT(30) -+#define BIT_PSTIMEOUT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR0 (Offset 0x00B4) */ -+ -+#define BIT_HISR5_IND_INT BIT(18) -+#define BIT_HISR4_IND_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HISR0 (Offset 0x00B4) */ -+ -+#define BIT_BCNDMAINT_E BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_HISR0 (Offset 0x00B4) */ -+ -+#define BIT_HISR3_IND_INT BIT(14) -+#define BIT_HISR2_IND_INT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HISR0 (Offset 0x00B4) */ -+ -+#define BIT_CTWEND BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HISR0 (Offset 0x00B4) */ -+ -+#define BIT_HISR1_IND_INT BIT(11) -+#define BIT_HIGHDOK BIT(7) -+#define BIT_MGTDOK BIT(6) -+#define BIT_BKDOK BIT(5) -+#define BIT_BEDOK BIT(4) -+#define BIT_VIDOK BIT(3) -+#define BIT_VODOK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_PRETXERR_HANDLE_MSK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_PRE_TX_ERR_INT_MSK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BTON_STS_UPDATE_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BTON_STS_UPDATE_MSK BIT(29) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BTON_STS_UPDATE_MASK BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_MCU_ERR_MASK BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT7 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT7_MSK BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT7__MSK BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT6 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT6_MSK BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT6__MSK BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT5 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT5_MSK BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT5__MSK BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT4 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT4_MSK BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT4__MSK BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BCNDMAINT3_MSK BIT(23) -+#define BIT_BCNDMAINT3 BIT(23) -+#define BIT_BCNDMAINT2_MSK BIT(22) -+#define BIT_BCNDMAINT2 BIT(22) -+#define BIT_BCNDMAINT1_MSK BIT(21) -+#define BIT_BCNDMAINT1 BIT(21) -+#define BIT_BCNDERR7_MSK BIT(20) -+#define BIT_BCNDERR7 BIT(20) -+#define BIT_BCNDERR6_MSK BIT(19) -+#define BIT_BCNDERR6 BIT(19) -+#define BIT_BCNDERR5_MSK BIT(18) -+#define BIT_BCNDERR5 BIT(18) -+#define BIT_BCNDERR4_MSK BIT(17) -+#define BIT_BCNDERR4 BIT(17) -+#define BIT_BCNDERR3_MSK BIT(16) -+#define BIT_BCNDERR3 BIT(16) -+#define BIT_BCNDERR2_MSK BIT(15) -+#define BIT_BCNDERR2 BIT(15) -+#define BIT_BCNDERR1_MSK BIT(14) -+#define BIT_BCNDERR1 BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_ATIMEND_E_MSK BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_ATIMEND_MSK BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_ATIMEND__MSK BIT(12) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_ATIMEND_E_V1_MSK BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_TXERR_MSK BIT(11) -+#define BIT_TXERR_INT BIT(11) -+#define BIT_RXERR_MSK BIT(10) -+#define BIT_RXERR_INT BIT(10) -+#define BIT_TXFOVW_MSK BIT(9) -+#define BIT_TXFOVW BIT(9) -+#define BIT_FOVW_MSK BIT(8) -+#define BIT_FOVW BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_CPU_MGQ_EARLY_INT_MSK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_CPU_MGQ_TXDONE_MSK BIT(5) -+#define BIT_CPU_MGQ_TXDONE BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_PS_TIMER_C_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_PSTIMER_5_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_PS_TIMER_B_MSK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_PSTIMER_4_MSK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_PS_TIMER_A_MSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_PSTIMER_3_MSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_CPUMGQ_TX_TIMER_MSK BIT(1) -+#define BIT_CPUMGQ_TX_TIMER BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR1 (Offset 0x00B8) */ -+ -+#define BIT_BB_STOPRX_INT_MSK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR1 (Offset 0x00BC) */ -+ -+#define BIT_PRETXERR_HANDLE_INT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HISR1 (Offset 0x00BC) */ -+ -+#define BIT_MCU_ERR BIT(28) -+#define BIT_ATIMEND_E BIT(13) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_HISR1 (Offset 0x00BC) */ -+ -+#define BIT_ATIMEND_E_V1_INT BIT(12) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HISR1 (Offset 0x00BC) */ -+ -+#define BIT_PS_TIMER_C BIT(4) -+#define BIT_PS_TIMER_B BIT(3) -+#define BIT_PS_TIMER_A BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR1 (Offset 0x00BC) */ -+ -+#define BIT_SHIFT_SYS_PINMUX_EN 0 -+#define BIT_MASK_SYS_PINMUX_EN 0xfffffff -+#define BIT_SYS_PINMUX_EN(x) \ -+ (((x) & BIT_MASK_SYS_PINMUX_EN) << BIT_SHIFT_SYS_PINMUX_EN) -+#define BITS_SYS_PINMUX_EN (BIT_MASK_SYS_PINMUX_EN << BIT_SHIFT_SYS_PINMUX_EN) -+#define BIT_CLEAR_SYS_PINMUX_EN(x) ((x) & (~BITS_SYS_PINMUX_EN)) -+#define BIT_GET_SYS_PINMUX_EN(x) \ -+ (((x) >> BIT_SHIFT_SYS_PINMUX_EN) & BIT_MASK_SYS_PINMUX_EN) -+#define BIT_SET_SYS_PINMUX_EN(x, v) \ -+ (BIT_CLEAR_SYS_PINMUX_EN(x) | BIT_SYS_PINMUX_EN(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SDIO_ERR_RPT (Offset 0x102500C0) */ -+ -+#define BIT_HR_FF_OVF BIT(6) -+#define BIT_HR_FF_UDN BIT(5) -+#define BIT_TXDMA_BUSY_ERR BIT(4) -+#define BIT_TXDMA_VLD_ERR BIT(3) -+#define BIT_QSEL_UNKNOWN_ERR BIT(2) -+#define BIT_QSEL_MIS_ERR BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DBG_PORT_SEL (Offset 0x00C0) */ -+ -+#define BIT_SHIFT_DEBUG_ST 0 -+#define BIT_MASK_DEBUG_ST 0xffffffffL -+#define BIT_DEBUG_ST(x) (((x) & BIT_MASK_DEBUG_ST) << BIT_SHIFT_DEBUG_ST) -+#define BITS_DEBUG_ST (BIT_MASK_DEBUG_ST << BIT_SHIFT_DEBUG_ST) -+#define BIT_CLEAR_DEBUG_ST(x) ((x) & (~BITS_DEBUG_ST)) -+#define BIT_GET_DEBUG_ST(x) (((x) >> BIT_SHIFT_DEBUG_ST) & BIT_MASK_DEBUG_ST) -+#define BIT_SET_DEBUG_ST(x, v) (BIT_CLEAR_DEBUG_ST(x) | BIT_DEBUG_ST(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_DIOERR_RPT (Offset 0x102500C0) */ -+ -+#define BIT_SDIO_PAGE_ERR BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SDIO_ERR_RPT (Offset 0x102500C0) */ -+ -+#define BIT_SDIO_OVERRD_ERR BIT(0) -+ -+#define BIT_SHIFT_SDIO_DATA_REPLY_TIME 0 -+#define BIT_MASK_SDIO_DATA_REPLY_TIME 0x7 -+#define BIT_SDIO_DATA_REPLY_TIME(x) \ -+ (((x) & BIT_MASK_SDIO_DATA_REPLY_TIME) \ -+ << BIT_SHIFT_SDIO_DATA_REPLY_TIME) -+#define BITS_SDIO_DATA_REPLY_TIME \ -+ (BIT_MASK_SDIO_DATA_REPLY_TIME << BIT_SHIFT_SDIO_DATA_REPLY_TIME) -+#define BIT_CLEAR_SDIO_DATA_REPLY_TIME(x) ((x) & (~BITS_SDIO_DATA_REPLY_TIME)) -+#define BIT_GET_SDIO_DATA_REPLY_TIME(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DATA_REPLY_TIME) & \ -+ BIT_MASK_SDIO_DATA_REPLY_TIME) -+#define BIT_SET_SDIO_DATA_REPLY_TIME(x, v) \ -+ (BIT_CLEAR_SDIO_DATA_REPLY_TIME(x) | BIT_SDIO_DATA_REPLY_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_CMD_ERRCNT (Offset 0x102500C2) */ -+ -+#define BIT_SHIFT_CMD_CRC_ERR_CNT 0 -+#define BIT_MASK_CMD_CRC_ERR_CNT 0xff -+#define BIT_CMD_CRC_ERR_CNT(x) \ -+ (((x) & BIT_MASK_CMD_CRC_ERR_CNT) << BIT_SHIFT_CMD_CRC_ERR_CNT) -+#define BITS_CMD_CRC_ERR_CNT \ -+ (BIT_MASK_CMD_CRC_ERR_CNT << BIT_SHIFT_CMD_CRC_ERR_CNT) -+#define BIT_CLEAR_CMD_CRC_ERR_CNT(x) ((x) & (~BITS_CMD_CRC_ERR_CNT)) -+#define BIT_GET_CMD_CRC_ERR_CNT(x) \ -+ (((x) >> BIT_SHIFT_CMD_CRC_ERR_CNT) & BIT_MASK_CMD_CRC_ERR_CNT) -+#define BIT_SET_CMD_CRC_ERR_CNT(x, v) \ -+ (BIT_CLEAR_CMD_CRC_ERR_CNT(x) | BIT_CMD_CRC_ERR_CNT(v)) -+ -+/* 2 REG_SDIO_DATA_ERRCNT (Offset 0x102500C3) */ -+ -+#define BIT_SHIFT_DATA_CRC_ERR_CNT 0 -+#define BIT_MASK_DATA_CRC_ERR_CNT 0xff -+#define BIT_DATA_CRC_ERR_CNT(x) \ -+ (((x) & BIT_MASK_DATA_CRC_ERR_CNT) << BIT_SHIFT_DATA_CRC_ERR_CNT) -+#define BITS_DATA_CRC_ERR_CNT \ -+ (BIT_MASK_DATA_CRC_ERR_CNT << BIT_SHIFT_DATA_CRC_ERR_CNT) -+#define BIT_CLEAR_DATA_CRC_ERR_CNT(x) ((x) & (~BITS_DATA_CRC_ERR_CNT)) -+#define BIT_GET_DATA_CRC_ERR_CNT(x) \ -+ (((x) >> BIT_SHIFT_DATA_CRC_ERR_CNT) & BIT_MASK_DATA_CRC_ERR_CNT) -+#define BIT_SET_DATA_CRC_ERR_CNT(x, v) \ -+ (BIT_CLEAR_DATA_CRC_ERR_CNT(x) | BIT_DATA_CRC_ERR_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_MAC_SOP BIT(25) -+#define BIT_LDO11_ST_EXT BIT(24) -+#define BIT_ANTSELB_S2 BIT(23) -+#define BIT_ANTSELB_S1 BIT(22) -+#define BIT_ANTSEL_S3 BIT(21) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_USB3_USB2_TRANSITION BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_ANTSEL_S2 BIT(20) -+#define BIT_ANTSEL_S1 BIT(19) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_SHIFT_USB23_SW_MODE_V1 18 -+#define BIT_MASK_USB23_SW_MODE_V1 0x3 -+#define BIT_USB23_SW_MODE_V1(x) \ -+ (((x) & BIT_MASK_USB23_SW_MODE_V1) << BIT_SHIFT_USB23_SW_MODE_V1) -+#define BITS_USB23_SW_MODE_V1 \ -+ (BIT_MASK_USB23_SW_MODE_V1 << BIT_SHIFT_USB23_SW_MODE_V1) -+#define BIT_CLEAR_USB23_SW_MODE_V1(x) ((x) & (~BITS_USB23_SW_MODE_V1)) -+#define BIT_GET_USB23_SW_MODE_V1(x) \ -+ (((x) >> BIT_SHIFT_USB23_SW_MODE_V1) & BIT_MASK_USB23_SW_MODE_V1) -+#define BIT_SET_USB23_SW_MODE_V1(x, v) \ -+ (BIT_CLEAR_USB23_SW_MODE_V1(x) | BIT_USB23_SW_MODE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_FCSN_PU BIT(18) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_NO_PDN_CHIPOFF_V1 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_KEEP_PAD BIT(17) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_RSM_EN_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_PAD_ALD_SKP BIT(16) -+#define BIT_PAD_A_ANTSEL_E BIT(11) -+#define BIT_PAD_A_ANTSELB_E BIT(10) -+#define BIT_PAD_A_ANTSEL_O BIT(9) -+#define BIT_PAD_A_ANTSELB_O BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_LD_B12V_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_B15V_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EESK_IOSEL BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EECS_IOSEL_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EESK_DATA_O BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EECS_DATA_O_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EESK_DATA_I BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EECS_DATA_I_V1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EECS_IOSEL BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EESK_IOSEL_V1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EECS_DATA_O BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EESK_DATA_O_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EECS_DATA_I BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PAD_CTRL2 (Offset 0x00C4) */ -+ -+#define BIT_EESK_DATA_I_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_CMD_ERR_CONTENT (Offset 0x102500C4) */ -+ -+#define BIT_SHIFT_SDIO_CMD_ERR_CONTENT 0 -+#define BIT_MASK_SDIO_CMD_ERR_CONTENT 0xffffffffffL -+#define BIT_SDIO_CMD_ERR_CONTENT(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_ERR_CONTENT) \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT) -+#define BITS_SDIO_CMD_ERR_CONTENT \ -+ (BIT_MASK_SDIO_CMD_ERR_CONTENT << BIT_SHIFT_SDIO_CMD_ERR_CONTENT) -+#define BIT_CLEAR_SDIO_CMD_ERR_CONTENT(x) ((x) & (~BITS_SDIO_CMD_ERR_CONTENT)) -+#define BIT_GET_SDIO_CMD_ERR_CONTENT(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_ERR_CONTENT) & \ -+ BIT_MASK_SDIO_CMD_ERR_CONTENT) -+#define BIT_SET_SDIO_CMD_ERR_CONTENT(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_ERR_CONTENT(x) | BIT_SDIO_CMD_ERR_CONTENT(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_MEM_RMC (Offset 0x00C8) */ -+ -+#define BIT_SHIFT_MEM_RME_WL_V2 4 -+#define BIT_MASK_MEM_RME_WL_V2 0x3f -+#define BIT_MEM_RME_WL_V2(x) \ -+ (((x) & BIT_MASK_MEM_RME_WL_V2) << BIT_SHIFT_MEM_RME_WL_V2) -+#define BITS_MEM_RME_WL_V2 (BIT_MASK_MEM_RME_WL_V2 << BIT_SHIFT_MEM_RME_WL_V2) -+#define BIT_CLEAR_MEM_RME_WL_V2(x) ((x) & (~BITS_MEM_RME_WL_V2)) -+#define BIT_GET_MEM_RME_WL_V2(x) \ -+ (((x) >> BIT_SHIFT_MEM_RME_WL_V2) & BIT_MASK_MEM_RME_WL_V2) -+#define BIT_SET_MEM_RME_WL_V2(x, v) \ -+ (BIT_CLEAR_MEM_RME_WL_V2(x) | BIT_MEM_RME_WL_V2(v)) -+ -+#define BIT_SHIFT_MEM_RME_HCI_V2 0 -+#define BIT_MASK_MEM_RME_HCI_V2 0x1f -+#define BIT_MEM_RME_HCI_V2(x) \ -+ (((x) & BIT_MASK_MEM_RME_HCI_V2) << BIT_SHIFT_MEM_RME_HCI_V2) -+#define BITS_MEM_RME_HCI_V2 \ -+ (BIT_MASK_MEM_RME_HCI_V2 << BIT_SHIFT_MEM_RME_HCI_V2) -+#define BIT_CLEAR_MEM_RME_HCI_V2(x) ((x) & (~BITS_MEM_RME_HCI_V2)) -+#define BIT_GET_MEM_RME_HCI_V2(x) \ -+ (((x) >> BIT_SHIFT_MEM_RME_HCI_V2) & BIT_MASK_MEM_RME_HCI_V2) -+#define BIT_SET_MEM_RME_HCI_V2(x, v) \ -+ (BIT_CLEAR_MEM_RME_HCI_V2(x) | BIT_MEM_RME_HCI_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_CRC_ERR_IDX (Offset 0x102500C9) */ -+ -+#define BIT_D3_CRC_ERR BIT(4) -+#define BIT_D2_CRC_ERR BIT(3) -+#define BIT_D1_CRC_ERR BIT(2) -+#define BIT_D0_CRC_ERR BIT(1) -+#define BIT_CMD_CRC_ERR BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_DATA_CRC (Offset 0x102500CA) */ -+ -+#define BIT_SHIFT_SDIO_DATA_CRC 0 -+#define BIT_MASK_SDIO_DATA_CRC 0xffff -+#define BIT_SDIO_DATA_CRC(x) \ -+ (((x) & BIT_MASK_SDIO_DATA_CRC) << BIT_SHIFT_SDIO_DATA_CRC) -+#define BITS_SDIO_DATA_CRC (BIT_MASK_SDIO_DATA_CRC << BIT_SHIFT_SDIO_DATA_CRC) -+#define BIT_CLEAR_SDIO_DATA_CRC(x) ((x) & (~BITS_SDIO_DATA_CRC)) -+#define BIT_GET_SDIO_DATA_CRC(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DATA_CRC) & BIT_MASK_SDIO_DATA_CRC) -+#define BIT_SET_SDIO_DATA_CRC(x, v) \ -+ (BIT_CLEAR_SDIO_DATA_CRC(x) | BIT_SDIO_DATA_CRC(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_SHIFT_EFUSE_BURN_GNT 24 -+#define BIT_MASK_EFUSE_BURN_GNT 0xff -+#define BIT_EFUSE_BURN_GNT(x) \ -+ (((x) & BIT_MASK_EFUSE_BURN_GNT) << BIT_SHIFT_EFUSE_BURN_GNT) -+#define BITS_EFUSE_BURN_GNT \ -+ (BIT_MASK_EFUSE_BURN_GNT << BIT_SHIFT_EFUSE_BURN_GNT) -+#define BIT_CLEAR_EFUSE_BURN_GNT(x) ((x) & (~BITS_EFUSE_BURN_GNT)) -+#define BIT_GET_EFUSE_BURN_GNT(x) \ -+ (((x) >> BIT_SHIFT_EFUSE_BURN_GNT) & BIT_MASK_EFUSE_BURN_GNT) -+#define BIT_SET_EFUSE_BURN_GNT(x, v) \ -+ (BIT_CLEAR_EFUSE_BURN_GNT(x) | BIT_EFUSE_BURN_GNT(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_SHIFT_EFUSE_PG_PWD 24 -+#define BIT_MASK_EFUSE_PG_PWD 0xff -+#define BIT_EFUSE_PG_PWD(x) \ -+ (((x) & BIT_MASK_EFUSE_PG_PWD) << BIT_SHIFT_EFUSE_PG_PWD) -+#define BITS_EFUSE_PG_PWD (BIT_MASK_EFUSE_PG_PWD << BIT_SHIFT_EFUSE_PG_PWD) -+#define BIT_CLEAR_EFUSE_PG_PWD(x) ((x) & (~BITS_EFUSE_PG_PWD)) -+#define BIT_GET_EFUSE_PG_PWD(x) \ -+ (((x) >> BIT_SHIFT_EFUSE_PG_PWD) & BIT_MASK_EFUSE_PG_PWD) -+#define BIT_SET_EFUSE_PG_PWD(x, v) \ -+ (BIT_CLEAR_EFUSE_PG_PWD(x) | BIT_EFUSE_PG_PWD(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_MEM_TEST1 BIT(17) -+#define BIT_MEM_LS BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_DBG_READ_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_STOP_WL_PMC BIT(9) -+#define BIT_STOP_SYM_PMC BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_SHIFT_EDATA1_V1 8 -+#define BIT_MASK_EDATA1_V1 0xff -+#define BIT_EDATA1_V1(x) (((x) & BIT_MASK_EDATA1_V1) << BIT_SHIFT_EDATA1_V1) -+#define BITS_EDATA1_V1 (BIT_MASK_EDATA1_V1 << BIT_SHIFT_EDATA1_V1) -+#define BIT_CLEAR_EDATA1_V1(x) ((x) & (~BITS_EDATA1_V1)) -+#define BIT_GET_EDATA1_V1(x) (((x) >> BIT_SHIFT_EDATA1_V1) & BIT_MASK_EDATA1_V1) -+#define BIT_SET_EDATA1_V1(x, v) (BIT_CLEAR_EDATA1_V1(x) | BIT_EDATA1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_BT_ACCESS_WL_PAGE0 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_REG_RST_WLPMC BIT(5) -+#define BIT_REG_RST_PD12N BIT(4) -+#define BIT_SYSON_DIS_WLREG_WRMSK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_SYM_LPS_STATUS BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_SYSON_DIS_PMCREG_WRMSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_SYM_HCI_TXDMA_BUSY BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TRANS_FIFO_STATUS (Offset 0x102500CC) */ -+ -+#define BIT_TRANS_FIFO_UNDERFLOW BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_SHIFT_SYSON_REG_ARB 0 -+#define BIT_MASK_SYSON_REG_ARB 0x3 -+#define BIT_SYSON_REG_ARB(x) \ -+ (((x) & BIT_MASK_SYSON_REG_ARB) << BIT_SHIFT_SYSON_REG_ARB) -+#define BITS_SYSON_REG_ARB (BIT_MASK_SYSON_REG_ARB << BIT_SHIFT_SYSON_REG_ARB) -+#define BIT_CLEAR_SYSON_REG_ARB(x) ((x) & (~BITS_SYSON_REG_ARB)) -+#define BIT_GET_SYSON_REG_ARB(x) \ -+ (((x) >> BIT_SHIFT_SYSON_REG_ARB) & BIT_MASK_SYSON_REG_ARB) -+#define BIT_SET_SYSON_REG_ARB(x, v) \ -+ (BIT_CLEAR_SYSON_REG_ARB(x) | BIT_SYSON_REG_ARB(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SDIO_TRANS_FIFO_STATUS (Offset 0x102500CC) */ -+ -+#define BIT_TRANS_FIFO_OVERFLOW BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PMC_DBG_CTRL2 (Offset 0x00CC) */ -+ -+#define BIT_SHIFT_EDATA0_V1 0 -+#define BIT_MASK_EDATA0_V1 0xff -+#define BIT_EDATA0_V1(x) (((x) & BIT_MASK_EDATA0_V1) << BIT_SHIFT_EDATA0_V1) -+#define BITS_EDATA0_V1 (BIT_MASK_EDATA0_V1 << BIT_SHIFT_EDATA0_V1) -+#define BIT_CLEAR_EDATA0_V1(x) ((x) & (~BITS_EDATA0_V1)) -+#define BIT_GET_EDATA0_V1(x) (((x) >> BIT_SHIFT_EDATA0_V1) & BIT_MASK_EDATA0_V1) -+#define BIT_SET_EDATA0_V1(x, v) (BIT_CLEAR_EDATA0_V1(x) | BIT_EDATA0_V1(v)) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_SCAN_PLL_BYPASS BIT(30) -+#define BIT_DRF_BIST_FAIL_V1 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_USB_DIS BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_DRF_BIST_READY_V1 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_PCI_DIS BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_FAIL_V1 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_BT_DIS BIT(25) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_READY_V1 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_WL_DIS BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_START_PAUSE_V1 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_SHIFT_BIST_RPT_SEL_V1 20 -+#define BIT_MASK_BIST_RPT_SEL_V1 0xf -+#define BIT_BIST_RPT_SEL_V1(x) \ -+ (((x) & BIT_MASK_BIST_RPT_SEL_V1) << BIT_SHIFT_BIST_RPT_SEL_V1) -+#define BITS_BIST_RPT_SEL_V1 \ -+ (BIT_MASK_BIST_RPT_SEL_V1 << BIT_SHIFT_BIST_RPT_SEL_V1) -+#define BIT_CLEAR_BIST_RPT_SEL_V1(x) ((x) & (~BITS_BIST_RPT_SEL_V1)) -+#define BIT_GET_BIST_RPT_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_BIST_RPT_SEL_V1) & BIT_MASK_BIST_RPT_SEL_V1) -+#define BIT_SET_BIST_RPT_SEL_V1(x, v) \ -+ (BIT_CLEAR_BIST_RPT_SEL_V1(x) | BIT_BIST_RPT_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_SHIFT_BIST_RPT_SEL 16 -+#define BIT_MASK_BIST_RPT_SEL 0xf -+#define BIT_BIST_RPT_SEL(x) \ -+ (((x) & BIT_MASK_BIST_RPT_SEL) << BIT_SHIFT_BIST_RPT_SEL) -+#define BITS_BIST_RPT_SEL (BIT_MASK_BIST_RPT_SEL << BIT_SHIFT_BIST_RPT_SEL) -+#define BIT_CLEAR_BIST_RPT_SEL(x) ((x) & (~BITS_BIST_RPT_SEL)) -+#define BIT_GET_BIST_RPT_SEL(x) \ -+ (((x) >> BIT_SHIFT_BIST_RPT_SEL) & BIT_MASK_BIST_RPT_SEL) -+#define BIT_SET_BIST_RPT_SEL(x, v) \ -+ (BIT_CLEAR_BIST_RPT_SEL(x) | BIT_BIST_RPT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_SHIFT_MBIST_RSTNI 8 -+#define BIT_MASK_MBIST_RSTNI 0x3ff -+#define BIT_MBIST_RSTNI(x) \ -+ (((x) & BIT_MASK_MBIST_RSTNI) << BIT_SHIFT_MBIST_RSTNI) -+#define BITS_MBIST_RSTNI (BIT_MASK_MBIST_RSTNI << BIT_SHIFT_MBIST_RSTNI) -+#define BIT_CLEAR_MBIST_RSTNI(x) ((x) & (~BITS_MBIST_RSTNI)) -+#define BIT_GET_MBIST_RSTNI(x) \ -+ (((x) >> BIT_SHIFT_MBIST_RSTNI) & BIT_MASK_MBIST_RSTNI) -+#define BIT_SET_MBIST_RSTNI(x, v) \ -+ (BIT_CLEAR_MBIST_RSTNI(x) | BIT_MBIST_RSTNI(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BISD_MODE BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_RESUME_PS_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_RESUME_PS BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_RESUME_V1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_RESUME BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_DRF BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_NORMAL BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_SHIFT_BIST_MODE 2 -+#define BIT_MASK_BIST_MODE 0x3 -+#define BIT_BIST_MODE(x) (((x) & BIT_MASK_BIST_MODE) << BIT_SHIFT_BIST_MODE) -+#define BITS_BIST_MODE (BIT_MASK_BIST_MODE << BIT_SHIFT_BIST_MODE) -+#define BIT_CLEAR_BIST_MODE(x) ((x) & (~BITS_BIST_MODE)) -+#define BIT_GET_BIST_MODE(x) (((x) >> BIT_SHIFT_BIST_MODE) & BIT_MASK_BIST_MODE) -+#define BIT_SET_BIST_MODE(x, v) (BIT_CLEAR_BIST_MODE(x) | BIT_BIST_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_RSTN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_SYM_HCI_TADMA_ALLOW BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_BIST_CLK_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_BIST_CTRL (Offset 0x00D0) */ -+ -+#define BIT_SYM_FW_CTL_HCI_TXDMA_EN BIT(0) -+ -+#define BIT_SHIFT_TDE_H2C_RD_ADDR 0 -+#define BIT_MASK_TDE_H2C_RD_ADDR 0x3ffff -+#define BIT_TDE_H2C_RD_ADDR(x) \ -+ (((x) & BIT_MASK_TDE_H2C_RD_ADDR) << BIT_SHIFT_TDE_H2C_RD_ADDR) -+#define BITS_TDE_H2C_RD_ADDR \ -+ (BIT_MASK_TDE_H2C_RD_ADDR << BIT_SHIFT_TDE_H2C_RD_ADDR) -+#define BIT_CLEAR_TDE_H2C_RD_ADDR(x) ((x) & (~BITS_TDE_H2C_RD_ADDR)) -+#define BIT_GET_TDE_H2C_RD_ADDR(x) \ -+ (((x) >> BIT_SHIFT_TDE_H2C_RD_ADDR) & BIT_MASK_TDE_H2C_RD_ADDR) -+#define BIT_SET_TDE_H2C_RD_ADDR(x, v) \ -+ (BIT_CLEAR_TDE_H2C_RD_ADDR(x) | BIT_TDE_H2C_RD_ADDR(v)) -+ -+#define BIT_SHIFT_TDE_H2C_WR_ADDR 0 -+#define BIT_MASK_TDE_H2C_WR_ADDR 0x3ffff -+#define BIT_TDE_H2C_WR_ADDR(x) \ -+ (((x) & BIT_MASK_TDE_H2C_WR_ADDR) << BIT_SHIFT_TDE_H2C_WR_ADDR) -+#define BITS_TDE_H2C_WR_ADDR \ -+ (BIT_MASK_TDE_H2C_WR_ADDR << BIT_SHIFT_TDE_H2C_WR_ADDR) -+#define BIT_CLEAR_TDE_H2C_WR_ADDR(x) ((x) & (~BITS_TDE_H2C_WR_ADDR)) -+#define BIT_GET_TDE_H2C_WR_ADDR(x) \ -+ (((x) >> BIT_SHIFT_TDE_H2C_WR_ADDR) & BIT_MASK_TDE_H2C_WR_ADDR) -+#define BIT_SET_TDE_H2C_WR_ADDR(x, v) \ -+ (BIT_CLEAR_TDE_H2C_WR_ADDR(x) | BIT_TDE_H2C_WR_ADDR(v)) -+ -+#define BIT_SHIFT_BCAM_CTRL 0 -+#define BIT_MASK_BCAM_CTRL 0xffffffffL -+#define BIT_BCAM_CTRL(x) (((x) & BIT_MASK_BCAM_CTRL) << BIT_SHIFT_BCAM_CTRL) -+#define BITS_BCAM_CTRL (BIT_MASK_BCAM_CTRL << BIT_SHIFT_BCAM_CTRL) -+#define BIT_CLEAR_BCAM_CTRL(x) ((x) & (~BITS_BCAM_CTRL)) -+#define BIT_GET_BCAM_CTRL(x) (((x) >> BIT_SHIFT_BCAM_CTRL) & BIT_MASK_BCAM_CTRL) -+#define BIT_SET_BCAM_CTRL(x, v) (BIT_CLEAR_BCAM_CTRL(x) | BIT_BCAM_CTRL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BIST_RPT (Offset 0x00D4) */ -+ -+#define BIT_SHIFT_MBIST_REPORT 0 -+#define BIT_MASK_MBIST_REPORT 0xffffffffL -+#define BIT_MBIST_REPORT(x) \ -+ (((x) & BIT_MASK_MBIST_REPORT) << BIT_SHIFT_MBIST_REPORT) -+#define BITS_MBIST_REPORT (BIT_MASK_MBIST_REPORT << BIT_SHIFT_MBIST_REPORT) -+#define BIT_CLEAR_MBIST_REPORT(x) ((x) & (~BITS_MBIST_REPORT)) -+#define BIT_GET_MBIST_REPORT(x) \ -+ (((x) >> BIT_SHIFT_MBIST_REPORT) & BIT_MASK_MBIST_REPORT) -+#define BIT_SET_MBIST_REPORT(x, v) \ -+ (BIT_CLEAR_MBIST_REPORT(x) | BIT_MBIST_REPORT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_RMV_SIGN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_UMEM_RME BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_RMV_2PRF1 BIT(29) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_2PRF1_RMV BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_RMV_2PRF0 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_BT_SPRAM 28 -+#define BIT_MASK_BT_SPRAM 0x3 -+#define BIT_BT_SPRAM(x) (((x) & BIT_MASK_BT_SPRAM) << BIT_SHIFT_BT_SPRAM) -+#define BITS_BT_SPRAM (BIT_MASK_BT_SPRAM << BIT_SHIFT_BT_SPRAM) -+#define BIT_CLEAR_BT_SPRAM(x) ((x) & (~BITS_BT_SPRAM)) -+#define BIT_GET_BT_SPRAM(x) (((x) >> BIT_SHIFT_BT_SPRAM) & BIT_MASK_BT_SPRAM) -+#define BIT_SET_BT_SPRAM(x, v) (BIT_CLEAR_BT_SPRAM(x) | BIT_BT_SPRAM(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_2PRF0_RMV BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_RMV_1PRF1 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_1PRF1_RMV BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_RMV_1PRF0 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_1PRF0_RMV BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_RMV_1PSR BIT(25) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_1PSR_RMV BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_RMV_ROM BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_BT_ROM 24 -+#define BIT_MASK_BT_ROM 0xf -+#define BIT_BT_ROM(x) (((x) & BIT_MASK_BT_ROM) << BIT_SHIFT_BT_ROM) -+#define BITS_BT_ROM (BIT_MASK_BT_ROM << BIT_SHIFT_BT_ROM) -+#define BIT_CLEAR_BT_ROM(x) ((x) & (~BITS_BT_ROM)) -+#define BIT_GET_BT_ROM(x) (((x) >> BIT_SHIFT_BT_ROM) & BIT_MASK_BT_ROM) -+#define BIT_SET_BT_ROM(x, v) (BIT_CLEAR_BT_ROM(x) | BIT_BT_ROM(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_ROM_RMV BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_MEM_RMV1_2PRF1 BIT(19) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_2PRF1_RMV1 BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_MEM_RMV1_2PRF0 BIT(18) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_2PRF0_RMV1 BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_MEM_RMV1_1PRF1 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_1PRF1_RMV1 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_MEM_RMV1_1PRF0 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_1PRF0_RMV1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_MEM_RMV1_1PSR BIT(15) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_1PSR_RMV1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_MEM_RMV1_ROM BIT(14) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_ROM_RMV1 BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_PCI_DPRAM 10 -+#define BIT_MASK_PCI_DPRAM 0x3 -+#define BIT_PCI_DPRAM(x) (((x) & BIT_MASK_PCI_DPRAM) << BIT_SHIFT_PCI_DPRAM) -+#define BITS_PCI_DPRAM (BIT_MASK_PCI_DPRAM << BIT_SHIFT_PCI_DPRAM) -+#define BIT_CLEAR_PCI_DPRAM(x) ((x) & (~BITS_PCI_DPRAM)) -+#define BIT_GET_PCI_DPRAM(x) (((x) >> BIT_SHIFT_PCI_DPRAM) & BIT_MASK_PCI_DPRAM) -+#define BIT_SET_PCI_DPRAM(x, v) (BIT_CLEAR_PCI_DPRAM(x) | BIT_PCI_DPRAM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_MEM_RME_BT 8 -+#define BIT_MASK_MEM_RME_BT 0xf -+#define BIT_MEM_RME_BT(x) (((x) & BIT_MASK_MEM_RME_BT) << BIT_SHIFT_MEM_RME_BT) -+#define BITS_MEM_RME_BT (BIT_MASK_MEM_RME_BT << BIT_SHIFT_MEM_RME_BT) -+#define BIT_CLEAR_MEM_RME_BT(x) ((x) & (~BITS_MEM_RME_BT)) -+#define BIT_GET_MEM_RME_BT(x) \ -+ (((x) >> BIT_SHIFT_MEM_RME_BT) & BIT_MASK_MEM_RME_BT) -+#define BIT_SET_MEM_RME_BT(x, v) (BIT_CLEAR_MEM_RME_BT(x) | BIT_MEM_RME_BT(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_PCI_SPRAM 8 -+#define BIT_MASK_PCI_SPRAM 0x3 -+#define BIT_PCI_SPRAM(x) (((x) & BIT_MASK_PCI_SPRAM) << BIT_SHIFT_PCI_SPRAM) -+#define BITS_PCI_SPRAM (BIT_MASK_PCI_SPRAM << BIT_SHIFT_PCI_SPRAM) -+#define BIT_CLEAR_PCI_SPRAM(x) ((x) & (~BITS_PCI_SPRAM)) -+#define BIT_GET_PCI_SPRAM(x) (((x) >> BIT_SHIFT_PCI_SPRAM) & BIT_MASK_PCI_SPRAM) -+#define BIT_SET_PCI_SPRAM(x, v) (BIT_CLEAR_PCI_SPRAM(x) | BIT_PCI_SPRAM(v)) -+ -+#define BIT_SHIFT_USB_SPRAM 6 -+#define BIT_MASK_USB_SPRAM 0x3 -+#define BIT_USB_SPRAM(x) (((x) & BIT_MASK_USB_SPRAM) << BIT_SHIFT_USB_SPRAM) -+#define BITS_USB_SPRAM (BIT_MASK_USB_SPRAM << BIT_SHIFT_USB_SPRAM) -+#define BIT_CLEAR_USB_SPRAM(x) ((x) & (~BITS_USB_SPRAM)) -+#define BIT_GET_USB_SPRAM(x) (((x) >> BIT_SHIFT_USB_SPRAM) & BIT_MASK_USB_SPRAM) -+#define BIT_SET_USB_SPRAM(x, v) (BIT_CLEAR_USB_SPRAM(x) | BIT_USB_SPRAM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_MEM_RME_WL 4 -+#define BIT_MASK_MEM_RME_WL 0xf -+#define BIT_MEM_RME_WL(x) (((x) & BIT_MASK_MEM_RME_WL) << BIT_SHIFT_MEM_RME_WL) -+#define BITS_MEM_RME_WL (BIT_MASK_MEM_RME_WL << BIT_SHIFT_MEM_RME_WL) -+#define BIT_CLEAR_MEM_RME_WL(x) ((x) & (~BITS_MEM_RME_WL)) -+#define BIT_GET_MEM_RME_WL(x) \ -+ (((x) >> BIT_SHIFT_MEM_RME_WL) & BIT_MASK_MEM_RME_WL) -+#define BIT_SET_MEM_RME_WL(x, v) (BIT_CLEAR_MEM_RME_WL(x) | BIT_MEM_RME_WL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_USB_SPRF 4 -+#define BIT_MASK_USB_SPRF 0x3 -+#define BIT_USB_SPRF(x) (((x) & BIT_MASK_USB_SPRF) << BIT_SHIFT_USB_SPRF) -+#define BITS_USB_SPRF (BIT_MASK_USB_SPRF << BIT_SHIFT_USB_SPRF) -+#define BIT_CLEAR_USB_SPRF(x) ((x) & (~BITS_USB_SPRF)) -+#define BIT_GET_USB_SPRF(x) (((x) >> BIT_SHIFT_USB_SPRF) & BIT_MASK_USB_SPRF) -+#define BIT_SET_USB_SPRF(x, v) (BIT_CLEAR_USB_SPRF(x) | BIT_USB_SPRF(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_WL_RME 4 -+#define BIT_MASK_WL_RME 0xf -+#define BIT_WL_RME(x) (((x) & BIT_MASK_WL_RME) << BIT_SHIFT_WL_RME) -+#define BITS_WL_RME (BIT_MASK_WL_RME << BIT_SHIFT_WL_RME) -+#define BIT_CLEAR_WL_RME(x) ((x) & (~BITS_WL_RME)) -+#define BIT_GET_WL_RME(x) (((x) >> BIT_SHIFT_WL_RME) & BIT_MASK_WL_RME) -+#define BIT_SET_WL_RME(x, v) (BIT_CLEAR_WL_RME(x) | BIT_WL_RME(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_MEM_RME_HCI 0 -+#define BIT_MASK_MEM_RME_HCI 0xf -+#define BIT_MEM_RME_HCI(x) \ -+ (((x) & BIT_MASK_MEM_RME_HCI) << BIT_SHIFT_MEM_RME_HCI) -+#define BITS_MEM_RME_HCI (BIT_MASK_MEM_RME_HCI << BIT_SHIFT_MEM_RME_HCI) -+#define BIT_CLEAR_MEM_RME_HCI(x) ((x) & (~BITS_MEM_RME_HCI)) -+#define BIT_GET_MEM_RME_HCI(x) \ -+ (((x) >> BIT_SHIFT_MEM_RME_HCI) & BIT_MASK_MEM_RME_HCI) -+#define BIT_SET_MEM_RME_HCI(x, v) \ -+ (BIT_CLEAR_MEM_RME_HCI(x) | BIT_MEM_RME_HCI(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_MCU_ROM 0 -+#define BIT_MASK_MCU_ROM 0xf -+#define BIT_MCU_ROM(x) (((x) & BIT_MASK_MCU_ROM) << BIT_SHIFT_MCU_ROM) -+#define BITS_MCU_ROM (BIT_MASK_MCU_ROM << BIT_SHIFT_MCU_ROM) -+#define BIT_CLEAR_MCU_ROM(x) ((x) & (~BITS_MCU_ROM)) -+#define BIT_GET_MCU_ROM(x) (((x) >> BIT_SHIFT_MCU_ROM) & BIT_MASK_MCU_ROM) -+#define BIT_SET_MCU_ROM(x, v) (BIT_CLEAR_MCU_ROM(x) | BIT_MCU_ROM(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_HCI_RME 0 -+#define BIT_MASK_HCI_RME 0xf -+#define BIT_HCI_RME(x) (((x) & BIT_MASK_HCI_RME) << BIT_SHIFT_HCI_RME) -+#define BITS_HCI_RME (BIT_MASK_HCI_RME << BIT_SHIFT_HCI_RME) -+#define BIT_CLEAR_HCI_RME(x) ((x) & (~BITS_HCI_RME)) -+#define BIT_GET_HCI_RME(x) (((x) >> BIT_SHIFT_HCI_RME) & BIT_MASK_HCI_RME) -+#define BIT_SET_HCI_RME(x, v) (BIT_CLEAR_HCI_RME(x) | BIT_HCI_RME(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_MEM_CTRL (Offset 0x00D8) */ -+ -+#define BIT_SHIFT_BIST_ROM 0 -+#define BIT_MASK_BIST_ROM 0xffffffffL -+#define BIT_BIST_ROM(x) (((x) & BIT_MASK_BIST_ROM) << BIT_SHIFT_BIST_ROM) -+#define BITS_BIST_ROM (BIT_MASK_BIST_ROM << BIT_SHIFT_BIST_ROM) -+#define BIT_CLEAR_BIST_ROM(x) ((x) & (~BITS_BIST_ROM)) -+#define BIT_GET_BIST_ROM(x) (((x) >> BIT_SHIFT_BIST_ROM) & BIT_MASK_BIST_ROM) -+#define BIT_SET_BIST_ROM(x, v) (BIT_CLEAR_BIST_ROM(x) | BIT_BIST_ROM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL8 (Offset 0x00DC) */ -+ -+#define BIT_SHIFT_BB_DBG_SEL_AFE_SDM_V4 26 -+#define BIT_MASK_BB_DBG_SEL_AFE_SDM_V4 0x7 -+#define BIT_BB_DBG_SEL_AFE_SDM_V4(x) \ -+ (((x) & BIT_MASK_BB_DBG_SEL_AFE_SDM_V4) \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_V4) -+#define BITS_BB_DBG_SEL_AFE_SDM_V4 \ -+ (BIT_MASK_BB_DBG_SEL_AFE_SDM_V4 << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_V4) -+#define BIT_CLEAR_BB_DBG_SEL_AFE_SDM_V4(x) ((x) & (~BITS_BB_DBG_SEL_AFE_SDM_V4)) -+#define BIT_GET_BB_DBG_SEL_AFE_SDM_V4(x) \ -+ (((x) >> BIT_SHIFT_BB_DBG_SEL_AFE_SDM_V4) & \ -+ BIT_MASK_BB_DBG_SEL_AFE_SDM_V4) -+#define BIT_SET_BB_DBG_SEL_AFE_SDM_V4(x, v) \ -+ (BIT_CLEAR_BB_DBG_SEL_AFE_SDM_V4(x) | BIT_BB_DBG_SEL_AFE_SDM_V4(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL8 (Offset 0x00DC) */ -+ -+#define BIT_SYN_AGPIO BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYN_RFC_CTRL (Offset 0x00DC) */ -+ -+#define BIT_SHIFT_SYN_RF1_CTRL 8 -+#define BIT_MASK_SYN_RF1_CTRL 0xff -+#define BIT_SYN_RF1_CTRL(x) \ -+ (((x) & BIT_MASK_SYN_RF1_CTRL) << BIT_SHIFT_SYN_RF1_CTRL) -+#define BITS_SYN_RF1_CTRL (BIT_MASK_SYN_RF1_CTRL << BIT_SHIFT_SYN_RF1_CTRL) -+#define BIT_CLEAR_SYN_RF1_CTRL(x) ((x) & (~BITS_SYN_RF1_CTRL)) -+#define BIT_GET_SYN_RF1_CTRL(x) \ -+ (((x) >> BIT_SHIFT_SYN_RF1_CTRL) & BIT_MASK_SYN_RF1_CTRL) -+#define BIT_SET_SYN_RF1_CTRL(x, v) \ -+ (BIT_CLEAR_SYN_RF1_CTRL(x) | BIT_SYN_RF1_CTRL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL8 (Offset 0x00DC) */ -+ -+#define BIT_SHIFT_XTAL_GM_REP 6 -+#define BIT_MASK_XTAL_GM_REP 0x3 -+#define BIT_XTAL_GM_REP(x) \ -+ (((x) & BIT_MASK_XTAL_GM_REP) << BIT_SHIFT_XTAL_GM_REP) -+#define BITS_XTAL_GM_REP (BIT_MASK_XTAL_GM_REP << BIT_SHIFT_XTAL_GM_REP) -+#define BIT_CLEAR_XTAL_GM_REP(x) ((x) & (~BITS_XTAL_GM_REP)) -+#define BIT_GET_XTAL_GM_REP(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GM_REP) & BIT_MASK_XTAL_GM_REP) -+#define BIT_SET_XTAL_GM_REP(x, v) \ -+ (BIT_CLEAR_XTAL_GM_REP(x) | BIT_XTAL_GM_REP(v)) -+ -+#define BIT_XTAL_DRV_RF_LATCH_V5 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL8 (Offset 0x00DC) */ -+ -+#define BIT_XTAL_LP BIT(4) -+#define BIT_XTAL_GM_SEP BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AFE_CTRL8 (Offset 0x00DC) */ -+ -+#define BIT_SHIFT_XTAL_SEL_TOK_V2 0 -+#define BIT_MASK_XTAL_SEL_TOK_V2 0x7 -+#define BIT_XTAL_SEL_TOK_V2(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_TOK_V2) << BIT_SHIFT_XTAL_SEL_TOK_V2) -+#define BITS_XTAL_SEL_TOK_V2 \ -+ (BIT_MASK_XTAL_SEL_TOK_V2 << BIT_SHIFT_XTAL_SEL_TOK_V2) -+#define BIT_CLEAR_XTAL_SEL_TOK_V2(x) ((x) & (~BITS_XTAL_SEL_TOK_V2)) -+#define BIT_GET_XTAL_SEL_TOK_V2(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_TOK_V2) & BIT_MASK_XTAL_SEL_TOK_V2) -+#define BIT_SET_XTAL_SEL_TOK_V2(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_TOK_V2(x) | BIT_XTAL_SEL_TOK_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WLAN_DBG (Offset 0x00DC) */ -+ -+#define BIT_SHIFT_WLAN_DBG 0 -+#define BIT_MASK_WLAN_DBG 0xffffffffL -+#define BIT_WLAN_DBG(x) (((x) & BIT_MASK_WLAN_DBG) << BIT_SHIFT_WLAN_DBG) -+#define BITS_WLAN_DBG (BIT_MASK_WLAN_DBG << BIT_SHIFT_WLAN_DBG) -+#define BIT_CLEAR_WLAN_DBG(x) ((x) & (~BITS_WLAN_DBG)) -+#define BIT_GET_WLAN_DBG(x) (((x) >> BIT_SHIFT_WLAN_DBG) & BIT_MASK_WLAN_DBG) -+#define BIT_SET_WLAN_DBG(x, v) (BIT_CLEAR_WLAN_DBG(x) | BIT_WLAN_DBG(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYN_RFC_CTRL (Offset 0x00DC) */ -+ -+#define BIT_SHIFT_SYN_RF0_CTRL 0 -+#define BIT_MASK_SYN_RF0_CTRL 0xff -+#define BIT_SYN_RF0_CTRL(x) \ -+ (((x) & BIT_MASK_SYN_RF0_CTRL) << BIT_SHIFT_SYN_RF0_CTRL) -+#define BITS_SYN_RF0_CTRL (BIT_MASK_SYN_RF0_CTRL << BIT_SHIFT_SYN_RF0_CTRL) -+#define BIT_CLEAR_SYN_RF0_CTRL(x) ((x) & (~BITS_SYN_RF0_CTRL)) -+#define BIT_GET_SYN_RF0_CTRL(x) \ -+ (((x) >> BIT_SHIFT_SYN_RF0_CTRL) & BIT_MASK_SYN_RF0_CTRL) -+#define BIT_SET_SYN_RF0_CTRL(x, v) \ -+ (BIT_CLEAR_SYN_RF0_CTRL(x) | BIT_SYN_RF0_CTRL(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AFE_CTRL8 (Offset 0x00DC) */ -+ -+#define BIT_SHIFT_XTAL_SEL_TOK 0 -+#define BIT_MASK_XTAL_SEL_TOK 0x7 -+#define BIT_XTAL_SEL_TOK(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_TOK) << BIT_SHIFT_XTAL_SEL_TOK) -+#define BITS_XTAL_SEL_TOK (BIT_MASK_XTAL_SEL_TOK << BIT_SHIFT_XTAL_SEL_TOK) -+#define BIT_CLEAR_XTAL_SEL_TOK(x) ((x) & (~BITS_XTAL_SEL_TOK)) -+#define BIT_GET_XTAL_SEL_TOK(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_TOK) & BIT_MASK_XTAL_SEL_TOK) -+#define BIT_SET_XTAL_SEL_TOK(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_TOK(x) | BIT_XTAL_SEL_TOK(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_RD_SEL BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_CPU_REG_SEL BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_USB_SIE_INTF_WE_V1 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_USB3_REG_SEL BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_USB_SIE_INTF_BYIOREG_V1 BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_SHIFT_USB_SIE_EN 28 -+#define BIT_MASK_USB_SIE_EN 0x3 -+#define BIT_USB_SIE_EN(x) (((x) & BIT_MASK_USB_SIE_EN) << BIT_SHIFT_USB_SIE_EN) -+#define BITS_USB_SIE_EN (BIT_MASK_USB_SIE_EN << BIT_SHIFT_USB_SIE_EN) -+#define BIT_CLEAR_USB_SIE_EN(x) ((x) & (~BITS_USB_SIE_EN)) -+#define BIT_GET_USB_SIE_EN(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_EN) & BIT_MASK_USB_SIE_EN) -+#define BIT_SET_USB_SIE_EN(x, v) (BIT_CLEAR_USB_SIE_EN(x) | BIT_USB_SIE_EN(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_USB_SIE_SELECT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_USB_SIE_INTF_WE BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_USB_SIE_INTF_BYIOREG BIT(24) -+ -+#define BIT_SHIFT_USB_SIE_INTF_ADDR 16 -+#define BIT_MASK_USB_SIE_INTF_ADDR 0xff -+#define BIT_USB_SIE_INTF_ADDR(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_ADDR) << BIT_SHIFT_USB_SIE_INTF_ADDR) -+#define BITS_USB_SIE_INTF_ADDR \ -+ (BIT_MASK_USB_SIE_INTF_ADDR << BIT_SHIFT_USB_SIE_INTF_ADDR) -+#define BIT_CLEAR_USB_SIE_INTF_ADDR(x) ((x) & (~BITS_USB_SIE_INTF_ADDR)) -+#define BIT_GET_USB_SIE_INTF_ADDR(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_ADDR) & BIT_MASK_USB_SIE_INTF_ADDR) -+#define BIT_SET_USB_SIE_INTF_ADDR(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_ADDR(x) | BIT_USB_SIE_INTF_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_SHIFT_USB_SIE_INTF_ADDR_V1 16 -+#define BIT_MASK_USB_SIE_INTF_ADDR_V1 0x1ff -+#define BIT_USB_SIE_INTF_ADDR_V1(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_ADDR_V1) \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1) -+#define BITS_USB_SIE_INTF_ADDR_V1 \ -+ (BIT_MASK_USB_SIE_INTF_ADDR_V1 << BIT_SHIFT_USB_SIE_INTF_ADDR_V1) -+#define BIT_CLEAR_USB_SIE_INTF_ADDR_V1(x) ((x) & (~BITS_USB_SIE_INTF_ADDR_V1)) -+#define BIT_GET_USB_SIE_INTF_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_ADDR_V1) & \ -+ BIT_MASK_USB_SIE_INTF_ADDR_V1) -+#define BIT_SET_USB_SIE_INTF_ADDR_V1(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_ADDR_V1(x) | BIT_USB_SIE_INTF_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_SHIFT_USB_SIE_INTF_RD 8 -+#define BIT_MASK_USB_SIE_INTF_RD 0xff -+#define BIT_USB_SIE_INTF_RD(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_RD) << BIT_SHIFT_USB_SIE_INTF_RD) -+#define BITS_USB_SIE_INTF_RD \ -+ (BIT_MASK_USB_SIE_INTF_RD << BIT_SHIFT_USB_SIE_INTF_RD) -+#define BIT_CLEAR_USB_SIE_INTF_RD(x) ((x) & (~BITS_USB_SIE_INTF_RD)) -+#define BIT_GET_USB_SIE_INTF_RD(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_RD) & BIT_MASK_USB_SIE_INTF_RD) -+#define BIT_SET_USB_SIE_INTF_RD(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_RD(x) | BIT_USB_SIE_INTF_RD(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_SHIFT_NPQ_AVAL_PG 8 -+#define BIT_MASK_NPQ_AVAL_PG 0xff -+#define BIT_NPQ_AVAL_PG(x) \ -+ (((x) & BIT_MASK_NPQ_AVAL_PG) << BIT_SHIFT_NPQ_AVAL_PG) -+#define BITS_NPQ_AVAL_PG (BIT_MASK_NPQ_AVAL_PG << BIT_SHIFT_NPQ_AVAL_PG) -+#define BIT_CLEAR_NPQ_AVAL_PG(x) ((x) & (~BITS_NPQ_AVAL_PG)) -+#define BIT_GET_NPQ_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_NPQ_AVAL_PG) & BIT_MASK_NPQ_AVAL_PG) -+#define BIT_SET_NPQ_AVAL_PG(x, v) \ -+ (BIT_CLEAR_NPQ_AVAL_PG(x) | BIT_NPQ_AVAL_PG(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_USB_SIE_INTF (Offset 0x00E0) */ -+ -+#define BIT_SHIFT_USB_SIE_INTF_WD 0 -+#define BIT_MASK_USB_SIE_INTF_WD 0xff -+#define BIT_USB_SIE_INTF_WD(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_WD) << BIT_SHIFT_USB_SIE_INTF_WD) -+#define BITS_USB_SIE_INTF_WD \ -+ (BIT_MASK_USB_SIE_INTF_WD << BIT_SHIFT_USB_SIE_INTF_WD) -+#define BIT_CLEAR_USB_SIE_INTF_WD(x) ((x) & (~BITS_USB_SIE_INTF_WD)) -+#define BIT_GET_USB_SIE_INTF_WD(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_WD) & BIT_MASK_USB_SIE_INTF_WD) -+#define BIT_SET_USB_SIE_INTF_WD(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_WD(x) | BIT_USB_SIE_INTF_WD(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PCIE_MIO_INTF (Offset 0x00E4) */ -+ -+#define BIT_PCIE_MIO_EXIT_L1 BIT(19) -+#define BIT_PCIE_MIO_EXT BIT(18) -+#define BIT_PCIE_MIO_ACK BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PCIE_MIO_INTF (Offset 0x00E4) */ -+ -+#define BIT_PCIE_MIO_RIO BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_MIO_INTF (Offset 0x00E4) */ -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_PAGE 16 -+#define BIT_MASK_PCIE_MIO_ADDR_PAGE 0x3 -+#define BIT_PCIE_MIO_ADDR_PAGE(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_PAGE) << BIT_SHIFT_PCIE_MIO_ADDR_PAGE) -+#define BITS_PCIE_MIO_ADDR_PAGE \ -+ (BIT_MASK_PCIE_MIO_ADDR_PAGE << BIT_SHIFT_PCIE_MIO_ADDR_PAGE) -+#define BIT_CLEAR_PCIE_MIO_ADDR_PAGE(x) ((x) & (~BITS_PCIE_MIO_ADDR_PAGE)) -+#define BIT_GET_PCIE_MIO_ADDR_PAGE(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_PAGE) & BIT_MASK_PCIE_MIO_ADDR_PAGE) -+#define BIT_SET_PCIE_MIO_ADDR_PAGE(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_PAGE(x) | BIT_PCIE_MIO_ADDR_PAGE(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PCIE_MIO_INTF (Offset 0x00E4) */ -+ -+#define BIT_PCIE_MIO_IOREG BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PCIE_MIO_INTF (Offset 0x00E4) */ -+ -+#define BIT_PCIE_MIO_BYIOREG BIT(13) -+#define BIT_PCIE_MIO_RE BIT(12) -+ -+#define BIT_SHIFT_PCIE_MIO_WE 8 -+#define BIT_MASK_PCIE_MIO_WE 0xf -+#define BIT_PCIE_MIO_WE(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_WE) << BIT_SHIFT_PCIE_MIO_WE) -+#define BITS_PCIE_MIO_WE (BIT_MASK_PCIE_MIO_WE << BIT_SHIFT_PCIE_MIO_WE) -+#define BIT_CLEAR_PCIE_MIO_WE(x) ((x) & (~BITS_PCIE_MIO_WE)) -+#define BIT_GET_PCIE_MIO_WE(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_WE) & BIT_MASK_PCIE_MIO_WE) -+#define BIT_SET_PCIE_MIO_WE(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_WE(x) | BIT_PCIE_MIO_WE(v)) -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR 0 -+#define BIT_MASK_PCIE_MIO_ADDR 0xff -+#define BIT_PCIE_MIO_ADDR(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR) << BIT_SHIFT_PCIE_MIO_ADDR) -+#define BITS_PCIE_MIO_ADDR (BIT_MASK_PCIE_MIO_ADDR << BIT_SHIFT_PCIE_MIO_ADDR) -+#define BIT_CLEAR_PCIE_MIO_ADDR(x) ((x) & (~BITS_PCIE_MIO_ADDR)) -+#define BIT_GET_PCIE_MIO_ADDR(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR) & BIT_MASK_PCIE_MIO_ADDR) -+#define BIT_SET_PCIE_MIO_ADDR(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR(x) | BIT_PCIE_MIO_ADDR(v)) -+ -+/* 2 REG_PCIE_MIO_INTD (Offset 0x00E8) */ -+ -+#define BIT_SHIFT_PCIE_MIO_DATA 0 -+#define BIT_MASK_PCIE_MIO_DATA 0xffffffffL -+#define BIT_PCIE_MIO_DATA(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_DATA) << BIT_SHIFT_PCIE_MIO_DATA) -+#define BITS_PCIE_MIO_DATA (BIT_MASK_PCIE_MIO_DATA << BIT_SHIFT_PCIE_MIO_DATA) -+#define BIT_CLEAR_PCIE_MIO_DATA(x) ((x) & (~BITS_PCIE_MIO_DATA)) -+#define BIT_GET_PCIE_MIO_DATA(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_DATA) & BIT_MASK_PCIE_MIO_DATA) -+#define BIT_SET_PCIE_MIO_DATA(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_DATA(x) | BIT_PCIE_MIO_DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HPON_FSM (Offset 0x00EC) */ -+ -+#define BIT_SUSPEND_V1 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_S1_RFC_WO_0 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HPON_FSM (Offset 0x00EC) */ -+ -+#define BIT_FSM_RESUME_V1 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_S1_RFC_WT_0 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HPON_FSM (Offset 0x00EC) */ -+ -+#define BIT_HOST_RESUME_SYNC_V1 BIT(29) -+#define BIT_CHIP_PDNB_V1 BIT(28) -+ -+#define BIT_SHIFT_FSM_SUSPEND_V1 25 -+#define BIT_MASK_FSM_SUSPEND_V1 0x7 -+#define BIT_FSM_SUSPEND_V1(x) \ -+ (((x) & BIT_MASK_FSM_SUSPEND_V1) << BIT_SHIFT_FSM_SUSPEND_V1) -+#define BITS_FSM_SUSPEND_V1 \ -+ (BIT_MASK_FSM_SUSPEND_V1 << BIT_SHIFT_FSM_SUSPEND_V1) -+#define BIT_CLEAR_FSM_SUSPEND_V1(x) ((x) & (~BITS_FSM_SUSPEND_V1)) -+#define BIT_GET_FSM_SUSPEND_V1(x) \ -+ (((x) >> BIT_SHIFT_FSM_SUSPEND_V1) & BIT_MASK_FSM_SUSPEND_V1) -+#define BIT_SET_FSM_SUSPEND_V1(x, v) \ -+ (BIT_CLEAR_FSM_SUSPEND_V1(x) | BIT_FSM_SUSPEND_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_SHIFT_XTAL_SEL 25 -+#define BIT_MASK_XTAL_SEL 0x3 -+#define BIT_XTAL_SEL(x) (((x) & BIT_MASK_XTAL_SEL) << BIT_SHIFT_XTAL_SEL) -+#define BITS_XTAL_SEL (BIT_MASK_XTAL_SEL << BIT_SHIFT_XTAL_SEL) -+#define BIT_CLEAR_XTAL_SEL(x) ((x) & (~BITS_XTAL_SEL)) -+#define BIT_GET_XTAL_SEL(x) (((x) >> BIT_SHIFT_XTAL_SEL) & BIT_MASK_XTAL_SEL) -+#define BIT_SET_XTAL_SEL(x, v) (BIT_CLEAR_XTAL_SEL(x) | BIT_XTAL_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_S1_RFC_RSTB BIT(25) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_SHIFT_WLRF1_CTRL 24 -+#define BIT_MASK_WLRF1_CTRL 0xff -+#define BIT_WLRF1_CTRL(x) (((x) & BIT_MASK_WLRF1_CTRL) << BIT_SHIFT_WLRF1_CTRL) -+#define BITS_WLRF1_CTRL (BIT_MASK_WLRF1_CTRL << BIT_SHIFT_WLRF1_CTRL) -+#define BIT_CLEAR_WLRF1_CTRL(x) ((x) & (~BITS_WLRF1_CTRL)) -+#define BIT_GET_WLRF1_CTRL(x) \ -+ (((x) >> BIT_SHIFT_WLRF1_CTRL) & BIT_MASK_WLRF1_CTRL) -+#define BIT_SET_WLRF1_CTRL(x, v) (BIT_CLEAR_WLRF1_CTRL(x) | BIT_WLRF1_CTRL(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HPON_FSM (Offset 0x00EC) */ -+ -+#define BIT_PMC_ALD_V1 BIT(24) -+ -+#define BIT_SHIFT_HCI_SEL_1 22 -+#define BIT_MASK_HCI_SEL_1 0x3 -+#define BIT_HCI_SEL_1(x) (((x) & BIT_MASK_HCI_SEL_1) << BIT_SHIFT_HCI_SEL_1) -+#define BITS_HCI_SEL_1 (BIT_MASK_HCI_SEL_1 << BIT_SHIFT_HCI_SEL_1) -+#define BIT_CLEAR_HCI_SEL_1(x) ((x) & (~BITS_HCI_SEL_1)) -+#define BIT_GET_HCI_SEL_1(x) (((x) >> BIT_SHIFT_HCI_SEL_1) & BIT_MASK_HCI_SEL_1) -+#define BIT_SET_HCI_SEL_1(x, v) (BIT_CLEAR_HCI_SEL_1(x) | BIT_HCI_SEL_1(v)) -+ -+#define BIT_LOAD_DONE_V1 BIT(21) -+#define BIT_CNT_MATCH BIT(20) -+#define BIT_TIMEUP_V1 BIT(19) -+#define BIT_SPS_12V_VLD BIT(18) -+#define BIT_PCIERST_V1 BIT(17) -+#define BIT_HOST_CLK_VLD BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_SHIFT_WLRF2_CTRL 16 -+#define BIT_MASK_WLRF2_CTRL 0xff -+#define BIT_WLRF2_CTRL(x) (((x) & BIT_MASK_WLRF2_CTRL) << BIT_SHIFT_WLRF2_CTRL) -+#define BITS_WLRF2_CTRL (BIT_MASK_WLRF2_CTRL << BIT_SHIFT_WLRF2_CTRL) -+#define BIT_CLEAR_WLRF2_CTRL(x) ((x) & (~BITS_WLRF2_CTRL)) -+#define BIT_GET_WLRF2_CTRL(x) \ -+ (((x) >> BIT_SHIFT_WLRF2_CTRL) & BIT_MASK_WLRF2_CTRL) -+#define BIT_SET_WLRF2_CTRL(x, v) (BIT_CLEAR_WLRF2_CTRL(x) | BIT_WLRF2_CTRL(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HPON_FSM (Offset 0x00EC) */ -+ -+#define BIT_PMC_WR_V1 BIT(15) -+#define BIT_PMC_DATA_V1 BIT(14) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_XTAL_PEAKDET_OUT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HPON_FSM (Offset 0x00EC) */ -+ -+#define BIT_SHIFT_PMC_ADDR_V1 8 -+#define BIT_MASK_PMC_ADDR_V1 0x3f -+#define BIT_PMC_ADDR_V1(x) \ -+ (((x) & BIT_MASK_PMC_ADDR_V1) << BIT_SHIFT_PMC_ADDR_V1) -+#define BITS_PMC_ADDR_V1 (BIT_MASK_PMC_ADDR_V1 << BIT_SHIFT_PMC_ADDR_V1) -+#define BIT_CLEAR_PMC_ADDR_V1(x) ((x) & (~BITS_PMC_ADDR_V1)) -+#define BIT_GET_PMC_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_PMC_ADDR_V1) & BIT_MASK_PMC_ADDR_V1) -+#define BIT_SET_PMC_ADDR_V1(x, v) \ -+ (BIT_CLEAR_PMC_ADDR_V1(x) | BIT_PMC_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_SHIFT_WLRF3_CTRL 8 -+#define BIT_MASK_WLRF3_CTRL 0xff -+#define BIT_WLRF3_CTRL(x) (((x) & BIT_MASK_WLRF3_CTRL) << BIT_SHIFT_WLRF3_CTRL) -+#define BITS_WLRF3_CTRL (BIT_MASK_WLRF3_CTRL << BIT_SHIFT_WLRF3_CTRL) -+#define BIT_CLEAR_WLRF3_CTRL(x) ((x) & (~BITS_WLRF3_CTRL)) -+#define BIT_GET_WLRF3_CTRL(x) \ -+ (((x) >> BIT_SHIFT_WLRF3_CTRL) & BIT_MASK_WLRF3_CTRL) -+#define BIT_SET_WLRF3_CTRL(x, v) (BIT_CLEAR_WLRF3_CTRL(x) | BIT_WLRF3_CTRL(v)) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_XAAC_BUSY BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HPON_FSM (Offset 0x00EC) */ -+ -+#define BIT_PMC_COUNT_EN_V1 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_XAAC_READY_V1 BIT(7) -+ -+#define BIT_SHIFT_XAAC_PK_SEL 5 -+#define BIT_MASK_XAAC_PK_SEL 0x3 -+#define BIT_XAAC_PK_SEL(x) \ -+ (((x) & BIT_MASK_XAAC_PK_SEL) << BIT_SHIFT_XAAC_PK_SEL) -+#define BITS_XAAC_PK_SEL (BIT_MASK_XAAC_PK_SEL << BIT_SHIFT_XAAC_PK_SEL) -+#define BIT_CLEAR_XAAC_PK_SEL(x) ((x) & (~BITS_XAAC_PK_SEL)) -+#define BIT_GET_XAAC_PK_SEL(x) \ -+ (((x) >> BIT_SHIFT_XAAC_PK_SEL) & BIT_MASK_XAAC_PK_SEL) -+#define BIT_SET_XAAC_PK_SEL(x, v) \ -+ (BIT_CLEAR_XAAC_PK_SEL(x) | BIT_XAAC_PK_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HPON_FSM (Offset 0x00EC) */ -+ -+#define BIT_SHIFT_FSM_STATE_V1 0 -+#define BIT_MASK_FSM_STATE_V1 0x7f -+#define BIT_FSM_STATE_V1(x) \ -+ (((x) & BIT_MASK_FSM_STATE_V1) << BIT_SHIFT_FSM_STATE_V1) -+#define BITS_FSM_STATE_V1 (BIT_MASK_FSM_STATE_V1 << BIT_SHIFT_FSM_STATE_V1) -+#define BIT_CLEAR_FSM_STATE_V1(x) ((x) & (~BITS_FSM_STATE_V1)) -+#define BIT_GET_FSM_STATE_V1(x) \ -+ (((x) >> BIT_SHIFT_FSM_STATE_V1) & BIT_MASK_FSM_STATE_V1) -+#define BIT_SET_FSM_STATE_V1(x, v) \ -+ (BIT_CLEAR_FSM_STATE_V1(x) | BIT_FSM_STATE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLRF1 (Offset 0x00EC) */ -+ -+#define BIT_SHIFT_XTAL_GM_OUT 0 -+#define BIT_MASK_XTAL_GM_OUT 0x1f -+#define BIT_XTAL_GM_OUT(x) \ -+ (((x) & BIT_MASK_XTAL_GM_OUT) << BIT_SHIFT_XTAL_GM_OUT) -+#define BITS_XTAL_GM_OUT (BIT_MASK_XTAL_GM_OUT << BIT_SHIFT_XTAL_GM_OUT) -+#define BIT_CLEAR_XTAL_GM_OUT(x) ((x) & (~BITS_XTAL_GM_OUT)) -+#define BIT_GET_XTAL_GM_OUT(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GM_OUT) & BIT_MASK_XTAL_GM_OUT) -+#define BIT_SET_XTAL_GM_OUT(x, v) \ -+ (BIT_CLEAR_XTAL_GM_OUT(x) | BIT_XTAL_GM_OUT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_SHIFT_TRP_ICFG 28 -+#define BIT_MASK_TRP_ICFG 0xf -+#define BIT_TRP_ICFG(x) (((x) & BIT_MASK_TRP_ICFG) << BIT_SHIFT_TRP_ICFG) -+#define BITS_TRP_ICFG (BIT_MASK_TRP_ICFG << BIT_SHIFT_TRP_ICFG) -+#define BIT_CLEAR_TRP_ICFG(x) ((x) & (~BITS_TRP_ICFG)) -+#define BIT_GET_TRP_ICFG(x) (((x) >> BIT_SHIFT_TRP_ICFG) & BIT_MASK_TRP_ICFG) -+#define BIT_SET_TRP_ICFG(x, v) (BIT_CLEAR_TRP_ICFG(x) | BIT_TRP_ICFG(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_RF_TYPE_ID BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_BD_HCI_SEL BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_LDO_VLD BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_SHIFT_BD_HCI_SEL_V1 26 -+#define BIT_MASK_BD_HCI_SEL_V1 0x3 -+#define BIT_BD_HCI_SEL_V1(x) \ -+ (((x) & BIT_MASK_BD_HCI_SEL_V1) << BIT_SHIFT_BD_HCI_SEL_V1) -+#define BITS_BD_HCI_SEL_V1 (BIT_MASK_BD_HCI_SEL_V1 << BIT_SHIFT_BD_HCI_SEL_V1) -+#define BIT_CLEAR_BD_HCI_SEL_V1(x) ((x) & (~BITS_BD_HCI_SEL_V1)) -+#define BIT_GET_BD_HCI_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_BD_HCI_SEL_V1) & BIT_MASK_BD_HCI_SEL_V1) -+#define BIT_SET_BD_HCI_SEL_V1(x, v) \ -+ (BIT_CLEAR_BD_HCI_SEL_V1(x) | BIT_BD_HCI_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_BD_PKG_SEL BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_SPSLDO_SEL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_INTERNAL_EXTERNAL_SWR BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_LDO_SPS_SEL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_RTL_ID BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_PAD_HWPD_IDN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_DIS_WL BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_TESTMODE BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_SHIFT_PSC_TESTCFG 20 -+#define BIT_MASK_PSC_TESTCFG 0x3 -+#define BIT_PSC_TESTCFG(x) \ -+ (((x) & BIT_MASK_PSC_TESTCFG) << BIT_SHIFT_PSC_TESTCFG) -+#define BITS_PSC_TESTCFG (BIT_MASK_PSC_TESTCFG << BIT_SHIFT_PSC_TESTCFG) -+#define BIT_CLEAR_PSC_TESTCFG(x) ((x) & (~BITS_PSC_TESTCFG)) -+#define BIT_GET_PSC_TESTCFG(x) \ -+ (((x) >> BIT_SHIFT_PSC_TESTCFG) & BIT_MASK_PSC_TESTCFG) -+#define BIT_SET_PSC_TESTCFG(x, v) \ -+ (BIT_CLEAR_PSC_TESTCFG(x) | BIT_PSC_TESTCFG(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_SHIFT_VENDOR_ID 16 -+#define BIT_MASK_VENDOR_ID 0xf -+#define BIT_VENDOR_ID(x) (((x) & BIT_MASK_VENDOR_ID) << BIT_SHIFT_VENDOR_ID) -+#define BITS_VENDOR_ID (BIT_MASK_VENDOR_ID << BIT_SHIFT_VENDOR_ID) -+#define BIT_CLEAR_VENDOR_ID(x) ((x) & (~BITS_VENDOR_ID)) -+#define BIT_GET_VENDOR_ID(x) (((x) >> BIT_SHIFT_VENDOR_ID) & BIT_MASK_VENDOR_ID) -+#define BIT_SET_VENDOR_ID(x, v) (BIT_CLEAR_VENDOR_ID(x) | BIT_VENDOR_ID(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_SHIFT_CHIP_VER_V2 16 -+#define BIT_MASK_CHIP_VER_V2 0xf -+#define BIT_CHIP_VER_V2(x) \ -+ (((x) & BIT_MASK_CHIP_VER_V2) << BIT_SHIFT_CHIP_VER_V2) -+#define BITS_CHIP_VER_V2 (BIT_MASK_CHIP_VER_V2 << BIT_SHIFT_CHIP_VER_V2) -+#define BIT_CLEAR_CHIP_VER_V2(x) ((x) & (~BITS_CHIP_VER_V2)) -+#define BIT_GET_CHIP_VER_V2(x) \ -+ (((x) >> BIT_SHIFT_CHIP_VER_V2) & BIT_MASK_CHIP_VER_V2) -+#define BIT_SET_CHIP_VER_V2(x, v) \ -+ (BIT_CLEAR_CHIP_VER_V2(x) | BIT_CHIP_VER_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_SHIFT_CHIP_VER 12 -+#define BIT_MASK_CHIP_VER 0xf -+#define BIT_CHIP_VER(x) (((x) & BIT_MASK_CHIP_VER) << BIT_SHIFT_CHIP_VER) -+#define BITS_CHIP_VER (BIT_MASK_CHIP_VER << BIT_SHIFT_CHIP_VER) -+#define BIT_CLEAR_CHIP_VER(x) ((x) & (~BITS_CHIP_VER)) -+#define BIT_GET_CHIP_VER(x) (((x) >> BIT_SHIFT_CHIP_VER) & BIT_MASK_CHIP_VER) -+#define BIT_SET_CHIP_VER(x, v) (BIT_CLEAR_CHIP_VER(x) | BIT_CHIP_VER(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_TST_MODE_SEL BIT(11) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_BD_MAC3 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_IC_MACPHY_MODE BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_BD_MAC1 BIT(10) -+#define BIT_BD_MAC2 BIT(9) -+#define BIT_SIC_IDLE BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_SW_OFFLOAD_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_OCP_SHUTDN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_OCP_SHUTDN_1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_V15_VLD BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_V12_VLD BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_PCIRSTB BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_PCLK_VLD BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_PCLK_VLD_1 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_UCLK_VLD BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_ACLK_VLD BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_M200CLK_VLD_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG1 (Offset 0x00F0) */ -+ -+#define BIT_XCLK_VLD BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SYM_OSC32K_OUTSEL BIT(31) -+#define BIT_BTGP_WAKE_BT_LOC_BIT0 BIT(31) -+ -+#define BIT_SHIFT_SYM_SEC_CLKSEL 30 -+#define BIT_MASK_SYM_SEC_CLKSEL 0x3 -+#define BIT_SYM_SEC_CLKSEL(x) \ -+ (((x) & BIT_MASK_SYM_SEC_CLKSEL) << BIT_SHIFT_SYM_SEC_CLKSEL) -+#define BITS_SYM_SEC_CLKSEL \ -+ (BIT_MASK_SYM_SEC_CLKSEL << BIT_SHIFT_SYM_SEC_CLKSEL) -+#define BIT_CLEAR_SYM_SEC_CLKSEL(x) ((x) & (~BITS_SYM_SEC_CLKSEL)) -+#define BIT_GET_SYM_SEC_CLKSEL(x) \ -+ (((x) >> BIT_SHIFT_SYM_SEC_CLKSEL) & BIT_MASK_SYM_SEC_CLKSEL) -+#define BIT_SET_SYM_SEC_CLKSEL(x, v) \ -+ (BIT_CLEAR_SYM_SEC_CLKSEL(x) | BIT_SYM_SEC_CLKSEL(v)) -+ -+#define BIT_SHIFT_WL_GPIO_SEL 30 -+#define BIT_MASK_WL_GPIO_SEL 0x3 -+#define BIT_WL_GPIO_SEL(x) \ -+ (((x) & BIT_MASK_WL_GPIO_SEL) << BIT_SHIFT_WL_GPIO_SEL) -+#define BITS_WL_GPIO_SEL (BIT_MASK_WL_GPIO_SEL << BIT_SHIFT_WL_GPIO_SEL) -+#define BIT_CLEAR_WL_GPIO_SEL(x) ((x) & (~BITS_WL_GPIO_SEL)) -+#define BIT_GET_WL_GPIO_SEL(x) \ -+ (((x) >> BIT_SHIFT_WL_GPIO_SEL) & BIT_MASK_WL_GPIO_SEL) -+#define BIT_SET_WL_GPIO_SEL(x, v) \ -+ (BIT_CLEAR_WL_GPIO_SEL(x) | BIT_WL_GPIO_SEL(v)) -+ -+#define BIT_SHIFT_BT_MCM_CTRL_LOC 29 -+#define BIT_MASK_BT_MCM_CTRL_LOC 0x3 -+#define BIT_BT_MCM_CTRL_LOC(x) \ -+ (((x) & BIT_MASK_BT_MCM_CTRL_LOC) << BIT_SHIFT_BT_MCM_CTRL_LOC) -+#define BITS_BT_MCM_CTRL_LOC \ -+ (BIT_MASK_BT_MCM_CTRL_LOC << BIT_SHIFT_BT_MCM_CTRL_LOC) -+#define BIT_CLEAR_BT_MCM_CTRL_LOC(x) ((x) & (~BITS_BT_MCM_CTRL_LOC)) -+#define BIT_GET_BT_MCM_CTRL_LOC(x) \ -+ (((x) >> BIT_SHIFT_BT_MCM_CTRL_LOC) & BIT_MASK_BT_MCM_CTRL_LOC) -+#define BIT_SET_BT_MCM_CTRL_LOC(x, v) \ -+ (BIT_CLEAR_BT_MCM_CTRL_LOC(x) | BIT_BT_MCM_CTRL_LOC(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_RF_RL_ID 28 -+#define BIT_MASK_RF_RL_ID 0xf -+#define BIT_RF_RL_ID(x) (((x) & BIT_MASK_RF_RL_ID) << BIT_SHIFT_RF_RL_ID) -+#define BITS_RF_RL_ID (BIT_MASK_RF_RL_ID << BIT_SHIFT_RF_RL_ID) -+#define BIT_CLEAR_RF_RL_ID(x) ((x) & (~BITS_RF_RL_ID)) -+#define BIT_GET_RF_RL_ID(x) (((x) >> BIT_SHIFT_RF_RL_ID) & BIT_MASK_RF_RL_ID) -+#define BIT_SET_RF_RL_ID(x, v) (BIT_CLEAR_RF_RL_ID(x) | BIT_RF_RL_ID(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_SYM_MAC_CLKSEL 28 -+#define BIT_MASK_SYM_MAC_CLKSEL 0x3 -+#define BIT_SYM_MAC_CLKSEL(x) \ -+ (((x) & BIT_MASK_SYM_MAC_CLKSEL) << BIT_SHIFT_SYM_MAC_CLKSEL) -+#define BITS_SYM_MAC_CLKSEL \ -+ (BIT_MASK_SYM_MAC_CLKSEL << BIT_SHIFT_SYM_MAC_CLKSEL) -+#define BIT_CLEAR_SYM_MAC_CLKSEL(x) ((x) & (~BITS_SYM_MAC_CLKSEL)) -+#define BIT_GET_SYM_MAC_CLKSEL(x) \ -+ (((x) >> BIT_SHIFT_SYM_MAC_CLKSEL) & BIT_MASK_SYM_MAC_CLKSEL) -+#define BIT_SET_SYM_MAC_CLKSEL(x, v) \ -+ (BIT_CLEAR_SYM_MAC_CLKSEL(x) | BIT_SYM_MAC_CLKSEL(v)) -+ -+#define BIT_SHIFT_SW_DPDT_LOC 27 -+#define BIT_MASK_SW_DPDT_LOC 0x3 -+#define BIT_SW_DPDT_LOC(x) \ -+ (((x) & BIT_MASK_SW_DPDT_LOC) << BIT_SHIFT_SW_DPDT_LOC) -+#define BITS_SW_DPDT_LOC (BIT_MASK_SW_DPDT_LOC << BIT_SHIFT_SW_DPDT_LOC) -+#define BIT_CLEAR_SW_DPDT_LOC(x) ((x) & (~BITS_SW_DPDT_LOC)) -+#define BIT_GET_SW_DPDT_LOC(x) \ -+ (((x) >> BIT_SHIFT_SW_DPDT_LOC) & BIT_MASK_SW_DPDT_LOC) -+#define BIT_SET_SW_DPDT_LOC(x, v) \ -+ (BIT_CLEAR_SW_DPDT_LOC(x) | BIT_SW_DPDT_LOC(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_U3_CLK_VLD BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_WLGP_HW_DIS_LOC_BIT0 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_PRST_VLD_V1 BIT(26) -+#define BIT_PDN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_PKG_SEL 24 -+#define BIT_MASK_PKG_SEL 0x3 -+#define BIT_PKG_SEL(x) (((x) & BIT_MASK_PKG_SEL) << BIT_SHIFT_PKG_SEL) -+#define BITS_PKG_SEL (BIT_MASK_PKG_SEL << BIT_SHIFT_PKG_SEL) -+#define BIT_CLEAR_PKG_SEL(x) ((x) & (~BITS_PKG_SEL)) -+#define BIT_GET_PKG_SEL(x) (((x) >> BIT_SHIFT_PKG_SEL) & BIT_MASK_PKG_SEL) -+#define BIT_SET_PKG_SEL(x, v) (BIT_CLEAR_PKG_SEL(x) | BIT_PKG_SEL(v)) -+ -+#define BIT_SHIFT_SYM_OSC32K_RCAL 24 -+#define BIT_MASK_SYM_OSC32K_RCAL 0x3f -+#define BIT_SYM_OSC32K_RCAL(x) \ -+ (((x) & BIT_MASK_SYM_OSC32K_RCAL) << BIT_SHIFT_SYM_OSC32K_RCAL) -+#define BITS_SYM_OSC32K_RCAL \ -+ (BIT_MASK_SYM_OSC32K_RCAL << BIT_SHIFT_SYM_OSC32K_RCAL) -+#define BIT_CLEAR_SYM_OSC32K_RCAL(x) ((x) & (~BITS_SYM_OSC32K_RCAL)) -+#define BIT_GET_SYM_OSC32K_RCAL(x) \ -+ (((x) >> BIT_SHIFT_SYM_OSC32K_RCAL) & BIT_MASK_SYM_OSC32K_RCAL) -+#define BIT_SET_SYM_OSC32K_RCAL(x, v) \ -+ (BIT_CLEAR_SYM_OSC32K_RCAL(x) | BIT_SYM_OSC32K_RCAL(v)) -+ -+#define BIT_SHIFT_SW_GPIO_B_PD 24 -+#define BIT_MASK_SW_GPIO_B_PD 0xff -+#define BIT_SW_GPIO_B_PD(x) \ -+ (((x) & BIT_MASK_SW_GPIO_B_PD) << BIT_SHIFT_SW_GPIO_B_PD) -+#define BITS_SW_GPIO_B_PD (BIT_MASK_SW_GPIO_B_PD << BIT_SHIFT_SW_GPIO_B_PD) -+#define BIT_CLEAR_SW_GPIO_B_PD(x) ((x) & (~BITS_SW_GPIO_B_PD)) -+#define BIT_GET_SW_GPIO_B_PD(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_B_PD) & BIT_MASK_SW_GPIO_B_PD) -+#define BIT_SET_SW_GPIO_B_PD(x, v) \ -+ (BIT_CLEAR_SW_GPIO_B_PD(x) | BIT_SW_GPIO_B_PD(v)) -+ -+#define BIT_SHIFT_SW_GPIO_B_IN 24 -+#define BIT_MASK_SW_GPIO_B_IN 0xff -+#define BIT_SW_GPIO_B_IN(x) \ -+ (((x) & BIT_MASK_SW_GPIO_B_IN) << BIT_SHIFT_SW_GPIO_B_IN) -+#define BITS_SW_GPIO_B_IN (BIT_MASK_SW_GPIO_B_IN << BIT_SHIFT_SW_GPIO_B_IN) -+#define BIT_CLEAR_SW_GPIO_B_IN(x) ((x) & (~BITS_SW_GPIO_B_IN)) -+#define BIT_GET_SW_GPIO_B_IN(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_B_IN) & BIT_MASK_SW_GPIO_B_IN) -+#define BIT_SET_SW_GPIO_B_IN(x, v) \ -+ (BIT_CLEAR_SW_GPIO_B_IN(x) | BIT_SW_GPIO_B_IN(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_OCP_SHUTDN_V1 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_ANT_SEL_01_LOC 23 -+#define BIT_MASK_ANT_SEL_01_LOC 0x7 -+#define BIT_ANT_SEL_01_LOC(x) \ -+ (((x) & BIT_MASK_ANT_SEL_01_LOC) << BIT_SHIFT_ANT_SEL_01_LOC) -+#define BITS_ANT_SEL_01_LOC \ -+ (BIT_MASK_ANT_SEL_01_LOC << BIT_SHIFT_ANT_SEL_01_LOC) -+#define BIT_CLEAR_ANT_SEL_01_LOC(x) ((x) & (~BITS_ANT_SEL_01_LOC)) -+#define BIT_GET_ANT_SEL_01_LOC(x) \ -+ (((x) >> BIT_SHIFT_ANT_SEL_01_LOC) & BIT_MASK_ANT_SEL_01_LOC) -+#define BIT_SET_ANT_SEL_01_LOC(x, v) \ -+ (BIT_CLEAR_ANT_SEL_01_LOC(x) | BIT_ANT_SEL_01_LOC(v)) -+ -+#define BIT_SHIFT_AUTOLOADABLE_AT_1FC 23 -+#define BIT_MASK_AUTOLOADABLE_AT_1FC 0x3f -+#define BIT_AUTOLOADABLE_AT_1FC(x) \ -+ (((x) & BIT_MASK_AUTOLOADABLE_AT_1FC) << BIT_SHIFT_AUTOLOADABLE_AT_1FC) -+#define BITS_AUTOLOADABLE_AT_1FC \ -+ (BIT_MASK_AUTOLOADABLE_AT_1FC << BIT_SHIFT_AUTOLOADABLE_AT_1FC) -+#define BIT_CLEAR_AUTOLOADABLE_AT_1FC(x) ((x) & (~BITS_AUTOLOADABLE_AT_1FC)) -+#define BIT_GET_AUTOLOADABLE_AT_1FC(x) \ -+ (((x) >> BIT_SHIFT_AUTOLOADABLE_AT_1FC) & BIT_MASK_AUTOLOADABLE_AT_1FC) -+#define BIT_SET_AUTOLOADABLE_AT_1FC(x, v) \ -+ (BIT_CLEAR_AUTOLOADABLE_AT_1FC(x) | BIT_AUTOLOADABLE_AT_1FC(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_PCLK_VLD_V1 BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_BT_DISN_EN_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_U2_CLK_VLD BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_ANT_SEL_23_LOC 21 -+#define BIT_MASK_ANT_SEL_23_LOC 0x3 -+#define BIT_ANT_SEL_23_LOC(x) \ -+ (((x) & BIT_MASK_ANT_SEL_23_LOC) << BIT_SHIFT_ANT_SEL_23_LOC) -+#define BITS_ANT_SEL_23_LOC \ -+ (BIT_MASK_ANT_SEL_23_LOC << BIT_SHIFT_ANT_SEL_23_LOC) -+#define BIT_CLEAR_ANT_SEL_23_LOC(x) ((x) & (~BITS_ANT_SEL_23_LOC)) -+#define BIT_GET_ANT_SEL_23_LOC(x) \ -+ (((x) >> BIT_SHIFT_ANT_SEL_23_LOC) & BIT_MASK_ANT_SEL_23_LOC) -+#define BIT_SET_ANT_SEL_23_LOC(x, v) \ -+ (BIT_CLEAR_ANT_SEL_23_LOC(x) | BIT_ANT_SEL_23_LOC(v)) -+ -+#define BIT_BT_SUSN_LOC BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_PLL_CLK_VLD BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_SW_ICFG 20 -+#define BIT_MASK_SW_ICFG 0xf -+#define BIT_SW_ICFG(x) (((x) & BIT_MASK_SW_ICFG) << BIT_SHIFT_SW_ICFG) -+#define BITS_SW_ICFG (BIT_MASK_SW_ICFG << BIT_SHIFT_SW_ICFG) -+#define BIT_CLEAR_SW_ICFG(x) ((x) & (~BITS_SW_ICFG)) -+#define BIT_GET_SW_ICFG(x) (((x) >> BIT_SHIFT_SW_ICFG) & BIT_MASK_SW_ICFG) -+#define BIT_SET_SW_ICFG(x, v) (BIT_CLEAR_SW_ICFG(x) | BIT_SW_ICFG(v)) -+ -+#define BIT_SYM_CONF_BYTE_ENB BIT(20) -+#define BIT_WLBB_RFE_LED1 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_XCK_VLD BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_HPHY_ICFG BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_EXTCK32K_LOC 19 -+#define BIT_MASK_EXTCK32K_LOC 0x3 -+#define BIT_EXTCK32K_LOC(x) \ -+ (((x) & BIT_MASK_EXTCK32K_LOC) << BIT_SHIFT_EXTCK32K_LOC) -+#define BITS_EXTCK32K_LOC (BIT_MASK_EXTCK32K_LOC << BIT_SHIFT_EXTCK32K_LOC) -+#define BIT_CLEAR_EXTCK32K_LOC(x) ((x) & (~BITS_EXTCK32K_LOC)) -+#define BIT_GET_EXTCK32K_LOC(x) \ -+ (((x) >> BIT_SHIFT_EXTCK32K_LOC) & BIT_MASK_EXTCK32K_LOC) -+#define BIT_SET_EXTCK32K_LOC(x, v) \ -+ (BIT_CLEAR_EXTCK32K_LOC(x) | BIT_EXTCK32K_LOC(v)) -+ -+#define BIT_WLGP_LED1_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_CK200M_VLD BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_BT_COEX_MBOX_LOC BIT(18) -+#define BIT_WLGP_ANT23_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_HCI_SEL_EMBEDDED BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_BTEN_TRAP BIT(18) -+#define BIT_PKG_EN_V1 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_SEL_0XC0 16 -+#define BIT_MASK_SEL_0XC0 0x3 -+#define BIT_SEL_0XC0(x) (((x) & BIT_MASK_SEL_0XC0) << BIT_SHIFT_SEL_0XC0) -+#define BITS_SEL_0XC0 (BIT_MASK_SEL_0XC0 << BIT_SHIFT_SEL_0XC0) -+#define BIT_CLEAR_SEL_0XC0(x) ((x) & (~BITS_SEL_0XC0)) -+#define BIT_GET_SEL_0XC0(x) (((x) >> BIT_SHIFT_SEL_0XC0) & BIT_MASK_SEL_0XC0) -+#define BIT_SET_SEL_0XC0(x, v) (BIT_CLEAR_SEL_0XC0(x) | BIT_SEL_0XC0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SYM_MCUFWDL_DDMA_EN BIT(16) -+#define BIT_SYM_SPIC_BOOT_ADDR_CMP BIT(16) -+ -+#define BIT_SHIFT_SYM_OSC32K_CLKGEN0 16 -+#define BIT_MASK_SYM_OSC32K_CLKGEN0 0xff -+#define BIT_SYM_OSC32K_CLKGEN0(x) \ -+ (((x) & BIT_MASK_SYM_OSC32K_CLKGEN0) << BIT_SHIFT_SYM_OSC32K_CLKGEN0) -+#define BITS_SYM_OSC32K_CLKGEN0 \ -+ (BIT_MASK_SYM_OSC32K_CLKGEN0 << BIT_SHIFT_SYM_OSC32K_CLKGEN0) -+#define BIT_CLEAR_SYM_OSC32K_CLKGEN0(x) ((x) & (~BITS_SYM_OSC32K_CLKGEN0)) -+#define BIT_GET_SYM_OSC32K_CLKGEN0(x) \ -+ (((x) >> BIT_SHIFT_SYM_OSC32K_CLKGEN0) & BIT_MASK_SYM_OSC32K_CLKGEN0) -+#define BIT_SET_SYM_OSC32K_CLKGEN0(x, v) \ -+ (BIT_CLEAR_SYM_OSC32K_CLKGEN0(x) | BIT_SYM_OSC32K_CLKGEN0(v)) -+ -+#define BIT_SHIFT_CRC16_RESULT 16 -+#define BIT_MASK_CRC16_RESULT 0xffff -+#define BIT_CRC16_RESULT(x) \ -+ (((x) & BIT_MASK_CRC16_RESULT) << BIT_SHIFT_CRC16_RESULT) -+#define BITS_CRC16_RESULT (BIT_MASK_CRC16_RESULT << BIT_SHIFT_CRC16_RESULT) -+#define BIT_CLEAR_CRC16_RESULT(x) ((x) & (~BITS_CRC16_RESULT)) -+#define BIT_GET_CRC16_RESULT(x) \ -+ (((x) >> BIT_SHIFT_CRC16_RESULT) & BIT_MASK_CRC16_RESULT) -+#define BIT_SET_CRC16_RESULT(x, v) \ -+ (BIT_CLEAR_CRC16_RESULT(x) | BIT_CRC16_RESULT(v)) -+ -+#define BIT_SHIFT_BTGP_LEDIO_LOC 16 -+#define BIT_MASK_BTGP_LEDIO_LOC 0x3 -+#define BIT_BTGP_LEDIO_LOC(x) \ -+ (((x) & BIT_MASK_BTGP_LEDIO_LOC) << BIT_SHIFT_BTGP_LEDIO_LOC) -+#define BITS_BTGP_LEDIO_LOC \ -+ (BIT_MASK_BTGP_LEDIO_LOC << BIT_SHIFT_BTGP_LEDIO_LOC) -+#define BIT_CLEAR_BTGP_LEDIO_LOC(x) ((x) & (~BITS_BTGP_LEDIO_LOC)) -+#define BIT_GET_BTGP_LEDIO_LOC(x) \ -+ (((x) >> BIT_SHIFT_BTGP_LEDIO_LOC) & BIT_MASK_BTGP_LEDIO_LOC) -+#define BIT_SET_BTGP_LEDIO_LOC(x, v) \ -+ (BIT_CLEAR_BTGP_LEDIO_LOC(x) | BIT_BTGP_LEDIO_LOC(v)) -+ -+#define BIT_SHIFT_FEM_EN 16 -+#define BIT_MASK_FEM_EN 0x3 -+#define BIT_FEM_EN(x) (((x) & BIT_MASK_FEM_EN) << BIT_SHIFT_FEM_EN) -+#define BITS_FEM_EN (BIT_MASK_FEM_EN << BIT_SHIFT_FEM_EN) -+#define BIT_CLEAR_FEM_EN(x) ((x) & (~BITS_FEM_EN)) -+#define BIT_GET_FEM_EN(x) (((x) >> BIT_SHIFT_FEM_EN) & BIT_MASK_FEM_EN) -+#define BIT_SET_FEM_EN(x, v) (BIT_CLEAR_FEM_EN(x) | BIT_FEM_EN(v)) -+ -+#define BIT_SHIFT_SW_GPIO_B_PU 16 -+#define BIT_MASK_SW_GPIO_B_PU 0xff -+#define BIT_SW_GPIO_B_PU(x) \ -+ (((x) & BIT_MASK_SW_GPIO_B_PU) << BIT_SHIFT_SW_GPIO_B_PU) -+#define BITS_SW_GPIO_B_PU (BIT_MASK_SW_GPIO_B_PU << BIT_SHIFT_SW_GPIO_B_PU) -+#define BIT_CLEAR_SW_GPIO_B_PU(x) ((x) & (~BITS_SW_GPIO_B_PU)) -+#define BIT_GET_SW_GPIO_B_PU(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_B_PU) & BIT_MASK_SW_GPIO_B_PU) -+#define BIT_SET_SW_GPIO_B_PU(x, v) \ -+ (BIT_CLEAR_SW_GPIO_B_PU(x) | BIT_SW_GPIO_B_PU(v)) -+ -+#define BIT_SHIFT_SYM_INT_PERIODIC 16 -+#define BIT_MASK_SYM_INT_PERIODIC 0x3ff -+#define BIT_SYM_INT_PERIODIC(x) \ -+ (((x) & BIT_MASK_SYM_INT_PERIODIC) << BIT_SHIFT_SYM_INT_PERIODIC) -+#define BITS_SYM_INT_PERIODIC \ -+ (BIT_MASK_SYM_INT_PERIODIC << BIT_SHIFT_SYM_INT_PERIODIC) -+#define BIT_CLEAR_SYM_INT_PERIODIC(x) ((x) & (~BITS_SYM_INT_PERIODIC)) -+#define BIT_GET_SYM_INT_PERIODIC(x) \ -+ (((x) >> BIT_SHIFT_SYM_INT_PERIODIC) & BIT_MASK_SYM_INT_PERIODIC) -+#define BIT_SET_SYM_INT_PERIODIC(x, v) \ -+ (BIT_CLEAR_SYM_INT_PERIODIC(x) | BIT_SYM_INT_PERIODIC(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_TRAP_LDO_SPS_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_IDV_DPDTSEL_P BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_MACRDY BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_LTE_COEX_UART_LOC 14 -+#define BIT_MASK_LTE_COEX_UART_LOC 0x3 -+#define BIT_LTE_COEX_UART_LOC(x) \ -+ (((x) & BIT_MASK_LTE_COEX_UART_LOC) << BIT_SHIFT_LTE_COEX_UART_LOC) -+#define BITS_LTE_COEX_UART_LOC \ -+ (BIT_MASK_LTE_COEX_UART_LOC << BIT_SHIFT_LTE_COEX_UART_LOC) -+#define BIT_CLEAR_LTE_COEX_UART_LOC(x) ((x) & (~BITS_LTE_COEX_UART_LOC)) -+#define BIT_GET_LTE_COEX_UART_LOC(x) \ -+ (((x) >> BIT_SHIFT_LTE_COEX_UART_LOC) & BIT_MASK_LTE_COEX_UART_LOC) -+#define BIT_SET_LTE_COEX_UART_LOC(x, v) \ -+ (BIT_CLEAR_LTE_COEX_UART_LOC(x) | BIT_LTE_COEX_UART_LOC(v)) -+ -+#define BIT_IDV_DPDTSEL_N BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_12V_VLD BIT(14) -+#define BIT_U3PHY_RST BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_SYM_LDOA12V_WT 12 -+#define BIT_MASK_SYM_LDOA12V_WT 0x3 -+#define BIT_SYM_LDOA12V_WT(x) \ -+ (((x) & BIT_MASK_SYM_LDOA12V_WT) << BIT_SHIFT_SYM_LDOA12V_WT) -+#define BITS_SYM_LDOA12V_WT \ -+ (BIT_MASK_SYM_LDOA12V_WT << BIT_SHIFT_SYM_LDOA12V_WT) -+#define BIT_CLEAR_SYM_LDOA12V_WT(x) ((x) & (~BITS_SYM_LDOA12V_WT)) -+#define BIT_GET_SYM_LDOA12V_WT(x) \ -+ (((x) >> BIT_SHIFT_SYM_LDOA12V_WT) & BIT_MASK_SYM_LDOA12V_WT) -+#define BIT_SET_SYM_LDOA12V_WT(x, v) \ -+ (BIT_CLEAR_SYM_LDOA12V_WT(x) | BIT_SYM_LDOA12V_WT(v)) -+ -+#define BIT_SHIFT_SYM_OSC32K_TEMP_COMP 12 -+#define BIT_MASK_SYM_OSC32K_TEMP_COMP 0xf -+#define BIT_SYM_OSC32K_TEMP_COMP(x) \ -+ (((x) & BIT_MASK_SYM_OSC32K_TEMP_COMP) \ -+ << BIT_SHIFT_SYM_OSC32K_TEMP_COMP) -+#define BITS_SYM_OSC32K_TEMP_COMP \ -+ (BIT_MASK_SYM_OSC32K_TEMP_COMP << BIT_SHIFT_SYM_OSC32K_TEMP_COMP) -+#define BIT_CLEAR_SYM_OSC32K_TEMP_COMP(x) ((x) & (~BITS_SYM_OSC32K_TEMP_COMP)) -+#define BIT_GET_SYM_OSC32K_TEMP_COMP(x) \ -+ (((x) >> BIT_SHIFT_SYM_OSC32K_TEMP_COMP) & \ -+ BIT_MASK_SYM_OSC32K_TEMP_COMP) -+#define BIT_SET_SYM_OSC32K_TEMP_COMP(x, v) \ -+ (BIT_CLEAR_SYM_OSC32K_TEMP_COMP(x) | BIT_SYM_OSC32K_TEMP_COMP(v)) -+ -+#define BIT_SHIFT_LTE_3W_LOC 12 -+#define BIT_MASK_LTE_3W_LOC 0x3 -+#define BIT_LTE_3W_LOC(x) (((x) & BIT_MASK_LTE_3W_LOC) << BIT_SHIFT_LTE_3W_LOC) -+#define BITS_LTE_3W_LOC (BIT_MASK_LTE_3W_LOC << BIT_SHIFT_LTE_3W_LOC) -+#define BIT_CLEAR_LTE_3W_LOC(x) ((x) & (~BITS_LTE_3W_LOC)) -+#define BIT_GET_LTE_3W_LOC(x) \ -+ (((x) >> BIT_SHIFT_LTE_3W_LOC) & BIT_MASK_LTE_3W_LOC) -+#define BIT_SET_LTE_3W_LOC(x, v) (BIT_CLEAR_LTE_3W_LOC(x) | BIT_LTE_3W_LOC(v)) -+ -+#define BIT_SHIFT_HW_EXTWOL_LOC 12 -+#define BIT_MASK_HW_EXTWOL_LOC 0x3 -+#define BIT_HW_EXTWOL_LOC(x) \ -+ (((x) & BIT_MASK_HW_EXTWOL_LOC) << BIT_SHIFT_HW_EXTWOL_LOC) -+#define BITS_HW_EXTWOL_LOC (BIT_MASK_HW_EXTWOL_LOC << BIT_SHIFT_HW_EXTWOL_LOC) -+#define BIT_CLEAR_HW_EXTWOL_LOC(x) ((x) & (~BITS_HW_EXTWOL_LOC)) -+#define BIT_GET_HW_EXTWOL_LOC(x) \ -+ (((x) >> BIT_SHIFT_HW_EXTWOL_LOC) & BIT_MASK_HW_EXTWOL_LOC) -+#define BIT_SET_HW_EXTWOL_LOC(x, v) \ -+ (BIT_CLEAR_HW_EXTWOL_LOC(x) | BIT_HW_EXTWOL_LOC(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_HCI_SEL_V4 12 -+#define BIT_MASK_HCI_SEL_V4 0x3 -+#define BIT_HCI_SEL_V4(x) (((x) & BIT_MASK_HCI_SEL_V4) << BIT_SHIFT_HCI_SEL_V4) -+#define BITS_HCI_SEL_V4 (BIT_MASK_HCI_SEL_V4 << BIT_SHIFT_HCI_SEL_V4) -+#define BIT_CLEAR_HCI_SEL_V4(x) ((x) & (~BITS_HCI_SEL_V4)) -+#define BIT_GET_HCI_SEL_V4(x) \ -+ (((x) >> BIT_SHIFT_HCI_SEL_V4) & BIT_MASK_HCI_SEL_V4) -+#define BIT_SET_HCI_SEL_V4(x, v) (BIT_CLEAR_HCI_SEL_V4(x) | BIT_HCI_SEL_V4(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_USB2_SEL_V1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_HCI_SEL_V3 12 -+#define BIT_MASK_HCI_SEL_V3 0x7 -+#define BIT_HCI_SEL_V3(x) (((x) & BIT_MASK_HCI_SEL_V3) << BIT_SHIFT_HCI_SEL_V3) -+#define BITS_HCI_SEL_V3 (BIT_MASK_HCI_SEL_V3 << BIT_SHIFT_HCI_SEL_V3) -+#define BIT_CLEAR_HCI_SEL_V3(x) ((x) & (~BITS_HCI_SEL_V3)) -+#define BIT_GET_HCI_SEL_V3(x) \ -+ (((x) >> BIT_SHIFT_HCI_SEL_V3) & BIT_MASK_HCI_SEL_V3) -+#define BIT_SET_HCI_SEL_V3(x, v) (BIT_CLEAR_HCI_SEL_V3(x) | BIT_HCI_SEL_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SIC_LOC BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_USB_OPERATION_MODE BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_BTGP_WAKE_LOC 10 -+#define BIT_MASK_BTGP_WAKE_LOC 0x3 -+#define BIT_BTGP_WAKE_LOC(x) \ -+ (((x) & BIT_MASK_BTGP_WAKE_LOC) << BIT_SHIFT_BTGP_WAKE_LOC) -+#define BITS_BTGP_WAKE_LOC (BIT_MASK_BTGP_WAKE_LOC << BIT_SHIFT_BTGP_WAKE_LOC) -+#define BIT_CLEAR_BTGP_WAKE_LOC(x) ((x) & (~BITS_BTGP_WAKE_LOC)) -+#define BIT_GET_BTGP_WAKE_LOC(x) \ -+ (((x) >> BIT_SHIFT_BTGP_WAKE_LOC) & BIT_MASK_BTGP_WAKE_LOC) -+#define BIT_SET_BTGP_WAKE_LOC(x, v) \ -+ (BIT_CLEAR_BTGP_WAKE_LOC(x) | BIT_BTGP_WAKE_LOC(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_BT_PDN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_WLMAC_DBG_LOC 9 -+#define BIT_MASK_WLMAC_DBG_LOC 0x3 -+#define BIT_WLMAC_DBG_LOC(x) \ -+ (((x) & BIT_MASK_WLMAC_DBG_LOC) << BIT_SHIFT_WLMAC_DBG_LOC) -+#define BITS_WLMAC_DBG_LOC (BIT_MASK_WLMAC_DBG_LOC << BIT_SHIFT_WLMAC_DBG_LOC) -+#define BIT_CLEAR_WLMAC_DBG_LOC(x) ((x) & (~BITS_WLMAC_DBG_LOC)) -+#define BIT_GET_WLMAC_DBG_LOC(x) \ -+ (((x) >> BIT_SHIFT_WLMAC_DBG_LOC) & BIT_MASK_WLMAC_DBG_LOC) -+#define BIT_SET_WLMAC_DBG_LOC(x, v) \ -+ (BIT_CLEAR_WLMAC_DBG_LOC(x) | BIT_WLMAC_DBG_LOC(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_AUTO_WLPON BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SYM_MCU_CLK_DIV2 BIT(8) -+ -+#define BIT_SHIFT_SYM_OSC32K_LDO_V18ADJ 8 -+#define BIT_MASK_SYM_OSC32K_LDO_V18ADJ 0xf -+#define BIT_SYM_OSC32K_LDO_V18ADJ(x) \ -+ (((x) & BIT_MASK_SYM_OSC32K_LDO_V18ADJ) \ -+ << BIT_SHIFT_SYM_OSC32K_LDO_V18ADJ) -+#define BITS_SYM_OSC32K_LDO_V18ADJ \ -+ (BIT_MASK_SYM_OSC32K_LDO_V18ADJ << BIT_SHIFT_SYM_OSC32K_LDO_V18ADJ) -+#define BIT_CLEAR_SYM_OSC32K_LDO_V18ADJ(x) ((x) & (~BITS_SYM_OSC32K_LDO_V18ADJ)) -+#define BIT_GET_SYM_OSC32K_LDO_V18ADJ(x) \ -+ (((x) >> BIT_SHIFT_SYM_OSC32K_LDO_V18ADJ) & \ -+ BIT_MASK_SYM_OSC32K_LDO_V18ADJ) -+#define BIT_SET_SYM_OSC32K_LDO_V18ADJ(x, v) \ -+ (BIT_CLEAR_SYM_OSC32K_LDO_V18ADJ(x) | BIT_SYM_OSC32K_LDO_V18ADJ(v)) -+ -+#define BIT_SHIFT_HOST_WAKE_WL_LOC 8 -+#define BIT_MASK_HOST_WAKE_WL_LOC 0x3 -+#define BIT_HOST_WAKE_WL_LOC(x) \ -+ (((x) & BIT_MASK_HOST_WAKE_WL_LOC) << BIT_SHIFT_HOST_WAKE_WL_LOC) -+#define BITS_HOST_WAKE_WL_LOC \ -+ (BIT_MASK_HOST_WAKE_WL_LOC << BIT_SHIFT_HOST_WAKE_WL_LOC) -+#define BIT_CLEAR_HOST_WAKE_WL_LOC(x) ((x) & (~BITS_HOST_WAKE_WL_LOC)) -+#define BIT_GET_HOST_WAKE_WL_LOC(x) \ -+ (((x) >> BIT_SHIFT_HOST_WAKE_WL_LOC) & BIT_MASK_HOST_WAKE_WL_LOC) -+#define BIT_SET_HOST_WAKE_WL_LOC(x, v) \ -+ (BIT_CLEAR_HOST_WAKE_WL_LOC(x) | BIT_HOST_WAKE_WL_LOC(v)) -+ -+#define BIT_SHIFT_SW_GPIO_B_OE2 8 -+#define BIT_MASK_SW_GPIO_B_OE2 0xff -+#define BIT_SW_GPIO_B_OE2(x) \ -+ (((x) & BIT_MASK_SW_GPIO_B_OE2) << BIT_SHIFT_SW_GPIO_B_OE2) -+#define BITS_SW_GPIO_B_OE2 (BIT_MASK_SW_GPIO_B_OE2 << BIT_SHIFT_SW_GPIO_B_OE2) -+#define BIT_CLEAR_SW_GPIO_B_OE2(x) ((x) & (~BITS_SW_GPIO_B_OE2)) -+#define BIT_GET_SW_GPIO_B_OE2(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_B_OE2) & BIT_MASK_SW_GPIO_B_OE2) -+#define BIT_SET_SW_GPIO_B_OE2(x, v) \ -+ (BIT_CLEAR_SW_GPIO_B_OE2(x) | BIT_SW_GPIO_B_OE2(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_TRAP_ICFG 8 -+#define BIT_MASK_TRAP_ICFG 0xf -+#define BIT_TRAP_ICFG(x) (((x) & BIT_MASK_TRAP_ICFG) << BIT_SHIFT_TRAP_ICFG) -+#define BITS_TRAP_ICFG (BIT_MASK_TRAP_ICFG << BIT_SHIFT_TRAP_ICFG) -+#define BIT_CLEAR_TRAP_ICFG(x) ((x) & (~BITS_TRAP_ICFG)) -+#define BIT_GET_TRAP_ICFG(x) (((x) >> BIT_SHIFT_TRAP_ICFG) & BIT_MASK_TRAP_ICFG) -+#define BIT_SET_TRAP_ICFG(x, v) (BIT_CLEAR_TRAP_ICFG(x) | BIT_TRAP_ICFG(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_WL_MODE BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SPI_FLASH_LOC BIT(7) -+ -+#define BIT_SHIFT_WLPHY_DBG_LOC 7 -+#define BIT_MASK_WLPHY_DBG_LOC 0x3 -+#define BIT_WLPHY_DBG_LOC(x) \ -+ (((x) & BIT_MASK_WLPHY_DBG_LOC) << BIT_SHIFT_WLPHY_DBG_LOC) -+#define BITS_WLPHY_DBG_LOC (BIT_MASK_WLPHY_DBG_LOC << BIT_SHIFT_WLPHY_DBG_LOC) -+#define BIT_CLEAR_WLPHY_DBG_LOC(x) ((x) & (~BITS_WLPHY_DBG_LOC)) -+#define BIT_GET_WLPHY_DBG_LOC(x) \ -+ (((x) >> BIT_SHIFT_WLPHY_DBG_LOC) & BIT_MASK_WLPHY_DBG_LOC) -+#define BIT_SET_WLPHY_DBG_LOC(x, v) \ -+ (BIT_CLEAR_WLPHY_DBG_LOC(x) | BIT_WLPHY_DBG_LOC(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_WLAN_ID BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_PKG_SEL_HCI BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_SYM_OSC32K_COMP_LOAD_CUR 6 -+#define BIT_MASK_SYM_OSC32K_COMP_LOAD_CUR 0x3 -+#define BIT_SYM_OSC32K_COMP_LOAD_CUR(x) \ -+ (((x) & BIT_MASK_SYM_OSC32K_COMP_LOAD_CUR) \ -+ << BIT_SHIFT_SYM_OSC32K_COMP_LOAD_CUR) -+#define BITS_SYM_OSC32K_COMP_LOAD_CUR \ -+ (BIT_MASK_SYM_OSC32K_COMP_LOAD_CUR \ -+ << BIT_SHIFT_SYM_OSC32K_COMP_LOAD_CUR) -+#define BIT_CLEAR_SYM_OSC32K_COMP_LOAD_CUR(x) \ -+ ((x) & (~BITS_SYM_OSC32K_COMP_LOAD_CUR)) -+#define BIT_GET_SYM_OSC32K_COMP_LOAD_CUR(x) \ -+ (((x) >> BIT_SHIFT_SYM_OSC32K_COMP_LOAD_CUR) & \ -+ BIT_MASK_SYM_OSC32K_COMP_LOAD_CUR) -+#define BIT_SET_SYM_OSC32K_COMP_LOAD_CUR(x, v) \ -+ (BIT_CLEAR_SYM_OSC32K_COMP_LOAD_CUR(x) | \ -+ BIT_SYM_OSC32K_COMP_LOAD_CUR(v)) -+ -+#define BIT_WLGP_HW_DIS_LOC_BIT1 BIT(6) -+#define BIT_XTAL_CKOUT_LOC BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_ALDN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_XTAL_CLKREQ_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_BTCOEX_CMDEN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_HCI_SEL 4 -+#define BIT_MASK_HCI_SEL 0x3 -+#define BIT_HCI_SEL(x) (((x) & BIT_MASK_HCI_SEL) << BIT_SHIFT_HCI_SEL) -+#define BITS_HCI_SEL (BIT_MASK_HCI_SEL << BIT_SHIFT_HCI_SEL) -+#define BIT_CLEAR_HCI_SEL(x) ((x) & (~BITS_HCI_SEL)) -+#define BIT_GET_HCI_SEL(x) (((x) >> BIT_SHIFT_HCI_SEL) & BIT_MASK_HCI_SEL) -+#define BIT_SET_HCI_SEL(x, v) (BIT_CLEAR_HCI_SEL(x) | BIT_HCI_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SYM_BOOT_SEL BIT(4) -+ -+#define BIT_SHIFT_SYM_OSC32K_COMP_LATCH_CUR 4 -+#define BIT_MASK_SYM_OSC32K_COMP_LATCH_CUR 0x3 -+#define BIT_SYM_OSC32K_COMP_LATCH_CUR(x) \ -+ (((x) & BIT_MASK_SYM_OSC32K_COMP_LATCH_CUR) \ -+ << BIT_SHIFT_SYM_OSC32K_COMP_LATCH_CUR) -+#define BITS_SYM_OSC32K_COMP_LATCH_CUR \ -+ (BIT_MASK_SYM_OSC32K_COMP_LATCH_CUR \ -+ << BIT_SHIFT_SYM_OSC32K_COMP_LATCH_CUR) -+#define BIT_CLEAR_SYM_OSC32K_COMP_LATCH_CUR(x) \ -+ ((x) & (~BITS_SYM_OSC32K_COMP_LATCH_CUR)) -+#define BIT_GET_SYM_OSC32K_COMP_LATCH_CUR(x) \ -+ (((x) >> BIT_SHIFT_SYM_OSC32K_COMP_LATCH_CUR) & \ -+ BIT_MASK_SYM_OSC32K_COMP_LATCH_CUR) -+#define BIT_SET_SYM_OSC32K_COMP_LATCH_CUR(x, v) \ -+ (BIT_CLEAR_SYM_OSC32K_COMP_LATCH_CUR(x) | \ -+ BIT_SYM_OSC32K_COMP_LATCH_CUR(v)) -+ -+#define BIT_SHIFT_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY 4 -+#define BIT_MASK_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY 0x3ff -+#define BIT_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY(x) \ -+ (((x) & BIT_MASK_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY) \ -+ << BIT_SHIFT_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY) -+#define BITS_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY \ -+ (BIT_MASK_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY \ -+ << BIT_SHIFT_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY) -+#define BIT_CLEAR_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY(x) \ -+ ((x) & (~BITS_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY)) -+#define BIT_GET_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY(x) \ -+ (((x) >> BIT_SHIFT_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY) & \ -+ BIT_MASK_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY) -+#define BIT_SET_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY(x, v) \ -+ (BIT_CLEAR_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY(x) | \ -+ BIT_CRC16_CHECK_MAXIMUM_ADDRESS_BOUNDARY(v)) -+ -+#define BIT_HOST_WAKE_WL_EN BIT(4) -+ -+#define BIT_SHIFT_XTAL_CLKREQ_LOC 4 -+#define BIT_MASK_XTAL_CLKREQ_LOC 0x3 -+#define BIT_XTAL_CLKREQ_LOC(x) \ -+ (((x) & BIT_MASK_XTAL_CLKREQ_LOC) << BIT_SHIFT_XTAL_CLKREQ_LOC) -+#define BITS_XTAL_CLKREQ_LOC \ -+ (BIT_MASK_XTAL_CLKREQ_LOC << BIT_SHIFT_XTAL_CLKREQ_LOC) -+#define BIT_CLEAR_XTAL_CLKREQ_LOC(x) ((x) & (~BITS_XTAL_CLKREQ_LOC)) -+#define BIT_GET_XTAL_CLKREQ_LOC(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CLKREQ_LOC) & BIT_MASK_XTAL_CLKREQ_LOC) -+#define BIT_SET_XTAL_CLKREQ_LOC(x, v) \ -+ (BIT_CLEAR_XTAL_CLKREQ_LOC(x) | BIT_XTAL_CLKREQ_LOC(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_BT_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_BTGP_MCM_UART_EN BIT(3) -+#define BIT_WLGP_UART_LOC BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_PAD_HCI_SEL_V2 3 -+#define BIT_MASK_PAD_HCI_SEL_V2 0x3 -+#define BIT_PAD_HCI_SEL_V2(x) \ -+ (((x) & BIT_MASK_PAD_HCI_SEL_V2) << BIT_SHIFT_PAD_HCI_SEL_V2) -+#define BITS_PAD_HCI_SEL_V2 \ -+ (BIT_MASK_PAD_HCI_SEL_V2 << BIT_SHIFT_PAD_HCI_SEL_V2) -+#define BIT_CLEAR_PAD_HCI_SEL_V2(x) ((x) & (~BITS_PAD_HCI_SEL_V2)) -+#define BIT_GET_PAD_HCI_SEL_V2(x) \ -+ (((x) >> BIT_SHIFT_PAD_HCI_SEL_V2) & BIT_MASK_PAD_HCI_SEL_V2) -+#define BIT_SET_PAD_HCI_SEL_V2(x, v) \ -+ (BIT_CLEAR_PAD_HCI_SEL_V2(x) | BIT_PAD_HCI_SEL_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_PAD_HCI_SEL_V1 3 -+#define BIT_MASK_PAD_HCI_SEL_V1 0x7 -+#define BIT_PAD_HCI_SEL_V1(x) \ -+ (((x) & BIT_MASK_PAD_HCI_SEL_V1) << BIT_SHIFT_PAD_HCI_SEL_V1) -+#define BITS_PAD_HCI_SEL_V1 \ -+ (BIT_MASK_PAD_HCI_SEL_V1 << BIT_SHIFT_PAD_HCI_SEL_V1) -+#define BIT_CLEAR_PAD_HCI_SEL_V1(x) ((x) & (~BITS_PAD_HCI_SEL_V1)) -+#define BIT_GET_PAD_HCI_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_PAD_HCI_SEL_V1) & BIT_MASK_PAD_HCI_SEL_V1) -+#define BIT_SET_PAD_HCI_SEL_V1(x, v) \ -+ (BIT_CLEAR_PAD_HCI_SEL_V1(x) | BIT_PAD_HCI_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_PAD_HCI_SEL 2 -+#define BIT_MASK_PAD_HCI_SEL 0x3 -+#define BIT_PAD_HCI_SEL(x) \ -+ (((x) & BIT_MASK_PAD_HCI_SEL) << BIT_SHIFT_PAD_HCI_SEL) -+#define BITS_PAD_HCI_SEL (BIT_MASK_PAD_HCI_SEL << BIT_SHIFT_PAD_HCI_SEL) -+#define BIT_CLEAR_PAD_HCI_SEL(x) ((x) & (~BITS_PAD_HCI_SEL)) -+#define BIT_GET_PAD_HCI_SEL(x) \ -+ (((x) >> BIT_SHIFT_PAD_HCI_SEL) & BIT_MASK_PAD_HCI_SEL) -+#define BIT_SET_PAD_HCI_SEL(x, v) \ -+ (BIT_CLEAR_PAD_HCI_SEL(x) | BIT_PAD_HCI_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_SYM_OSC32K_COMP_GM_CUR 2 -+#define BIT_MASK_SYM_OSC32K_COMP_GM_CUR 0x3 -+#define BIT_SYM_OSC32K_COMP_GM_CUR(x) \ -+ (((x) & BIT_MASK_SYM_OSC32K_COMP_GM_CUR) \ -+ << BIT_SHIFT_SYM_OSC32K_COMP_GM_CUR) -+#define BITS_SYM_OSC32K_COMP_GM_CUR \ -+ (BIT_MASK_SYM_OSC32K_COMP_GM_CUR << BIT_SHIFT_SYM_OSC32K_COMP_GM_CUR) -+#define BIT_CLEAR_SYM_OSC32K_COMP_GM_CUR(x) \ -+ ((x) & (~BITS_SYM_OSC32K_COMP_GM_CUR)) -+#define BIT_GET_SYM_OSC32K_COMP_GM_CUR(x) \ -+ (((x) >> BIT_SHIFT_SYM_OSC32K_COMP_GM_CUR) & \ -+ BIT_MASK_SYM_OSC32K_COMP_GM_CUR) -+#define BIT_SET_SYM_OSC32K_COMP_GM_CUR(x, v) \ -+ (BIT_CLEAR_SYM_OSC32K_COMP_GM_CUR(x) | BIT_SYM_OSC32K_COMP_GM_CUR(v)) -+ -+#define BIT_WLGP_MCM_COEXFEN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_HCI_SEL_V2 2 -+#define BIT_MASK_HCI_SEL_V2 0x3 -+#define BIT_HCI_SEL_V2(x) (((x) & BIT_MASK_HCI_SEL_V2) << BIT_SHIFT_HCI_SEL_V2) -+#define BITS_HCI_SEL_V2 (BIT_MASK_HCI_SEL_V2 << BIT_SHIFT_HCI_SEL_V2) -+#define BIT_CLEAR_HCI_SEL_V2(x) ((x) & (~BITS_HCI_SEL_V2)) -+#define BIT_GET_HCI_SEL_V2(x) \ -+ (((x) >> BIT_SHIFT_HCI_SEL_V2) & BIT_MASK_HCI_SEL_V2) -+#define BIT_SET_HCI_SEL_V2(x, v) (BIT_CLEAR_HCI_SEL_V2(x) | BIT_HCI_SEL_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_BT_COEX_MCM_MBOX BIT(1) -+ -+#define BIT_SHIFT_BTGP_WAKE_HST_LOC 1 -+#define BIT_MASK_BTGP_WAKE_HST_LOC 0x3 -+#define BIT_BTGP_WAKE_HST_LOC(x) \ -+ (((x) & BIT_MASK_BTGP_WAKE_HST_LOC) << BIT_SHIFT_BTGP_WAKE_HST_LOC) -+#define BITS_BTGP_WAKE_HST_LOC \ -+ (BIT_MASK_BTGP_WAKE_HST_LOC << BIT_SHIFT_BTGP_WAKE_HST_LOC) -+#define BIT_CLEAR_BTGP_WAKE_HST_LOC(x) ((x) & (~BITS_BTGP_WAKE_HST_LOC)) -+#define BIT_GET_BTGP_WAKE_HST_LOC(x) \ -+ (((x) >> BIT_SHIFT_BTGP_WAKE_HST_LOC) & BIT_MASK_BTGP_WAKE_HST_LOC) -+#define BIT_SET_BTGP_WAKE_HST_LOC(x, v) \ -+ (BIT_CLEAR_BTGP_WAKE_HST_LOC(x) | BIT_BTGP_WAKE_HST_LOC(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_TST_MOD_SEL BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_EFS_HCI_SEL 0 -+#define BIT_MASK_EFS_HCI_SEL 0x3 -+#define BIT_EFS_HCI_SEL(x) \ -+ (((x) & BIT_MASK_EFS_HCI_SEL) << BIT_SHIFT_EFS_HCI_SEL) -+#define BITS_EFS_HCI_SEL (BIT_MASK_EFS_HCI_SEL << BIT_SHIFT_EFS_HCI_SEL) -+#define BIT_CLEAR_EFS_HCI_SEL(x) ((x) & (~BITS_EFS_HCI_SEL)) -+#define BIT_GET_EFS_HCI_SEL(x) \ -+ (((x) >> BIT_SHIFT_EFS_HCI_SEL) & BIT_MASK_EFS_HCI_SEL) -+#define BIT_SET_EFS_HCI_SEL(x, v) \ -+ (BIT_CLEAR_EFS_HCI_SEL(x) | BIT_EFS_HCI_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SYM_BOOT_CFG BIT(0) -+ -+#define BIT_SHIFT_SYM_SPIC_BOOT_EXT_ADDR 0 -+#define BIT_MASK_SYM_SPIC_BOOT_EXT_ADDR 0xffff -+#define BIT_SYM_SPIC_BOOT_EXT_ADDR(x) \ -+ (((x) & BIT_MASK_SYM_SPIC_BOOT_EXT_ADDR) \ -+ << BIT_SHIFT_SYM_SPIC_BOOT_EXT_ADDR) -+#define BITS_SYM_SPIC_BOOT_EXT_ADDR \ -+ (BIT_MASK_SYM_SPIC_BOOT_EXT_ADDR << BIT_SHIFT_SYM_SPIC_BOOT_EXT_ADDR) -+#define BIT_CLEAR_SYM_SPIC_BOOT_EXT_ADDR(x) \ -+ ((x) & (~BITS_SYM_SPIC_BOOT_EXT_ADDR)) -+#define BIT_GET_SYM_SPIC_BOOT_EXT_ADDR(x) \ -+ (((x) >> BIT_SHIFT_SYM_SPIC_BOOT_EXT_ADDR) & \ -+ BIT_MASK_SYM_SPIC_BOOT_EXT_ADDR) -+#define BIT_SET_SYM_SPIC_BOOT_EXT_ADDR(x, v) \ -+ (BIT_CLEAR_SYM_SPIC_BOOT_EXT_ADDR(x) | BIT_SYM_SPIC_BOOT_EXT_ADDR(v)) -+ -+#define BIT_SHIFT_SYM_OSC32K_FREQSEL 0 -+#define BIT_MASK_SYM_OSC32K_FREQSEL 0x3 -+#define BIT_SYM_OSC32K_FREQSEL(x) \ -+ (((x) & BIT_MASK_SYM_OSC32K_FREQSEL) << BIT_SHIFT_SYM_OSC32K_FREQSEL) -+#define BITS_SYM_OSC32K_FREQSEL \ -+ (BIT_MASK_SYM_OSC32K_FREQSEL << BIT_SHIFT_SYM_OSC32K_FREQSEL) -+#define BIT_CLEAR_SYM_OSC32K_FREQSEL(x) ((x) & (~BITS_SYM_OSC32K_FREQSEL)) -+#define BIT_GET_SYM_OSC32K_FREQSEL(x) \ -+ (((x) >> BIT_SHIFT_SYM_OSC32K_FREQSEL) & BIT_MASK_SYM_OSC32K_FREQSEL) -+#define BIT_SET_SYM_OSC32K_FREQSEL(x, v) \ -+ (BIT_CLEAR_SYM_OSC32K_FREQSEL(x) | BIT_SYM_OSC32K_FREQSEL(v)) -+ -+#define BIT_CRC16_CHECK_ENABLE BIT(0) -+#define BIT_SW_GPIO_FUNC BIT(0) -+#define BIT_BTGP_WAKE_BT_LOC BIT(0) -+ -+#define BIT_SHIFT_SW_GPIO_A_OUT 0 -+#define BIT_MASK_SW_GPIO_A_OUT 0xffffffffL -+#define BIT_SW_GPIO_A_OUT(x) \ -+ (((x) & BIT_MASK_SW_GPIO_A_OUT) << BIT_SHIFT_SW_GPIO_A_OUT) -+#define BITS_SW_GPIO_A_OUT (BIT_MASK_SW_GPIO_A_OUT << BIT_SHIFT_SW_GPIO_A_OUT) -+#define BIT_CLEAR_SW_GPIO_A_OUT(x) ((x) & (~BITS_SW_GPIO_A_OUT)) -+#define BIT_GET_SW_GPIO_A_OUT(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_A_OUT) & BIT_MASK_SW_GPIO_A_OUT) -+#define BIT_SET_SW_GPIO_A_OUT(x, v) \ -+ (BIT_CLEAR_SW_GPIO_A_OUT(x) | BIT_SW_GPIO_A_OUT(v)) -+ -+#define BIT_SHIFT_SW_GPIO_A_OEN 0 -+#define BIT_MASK_SW_GPIO_A_OEN 0xffffffffL -+#define BIT_SW_GPIO_A_OEN(x) \ -+ (((x) & BIT_MASK_SW_GPIO_A_OEN) << BIT_SHIFT_SW_GPIO_A_OEN) -+#define BITS_SW_GPIO_A_OEN (BIT_MASK_SW_GPIO_A_OEN << BIT_SHIFT_SW_GPIO_A_OEN) -+#define BIT_CLEAR_SW_GPIO_A_OEN(x) ((x) & (~BITS_SW_GPIO_A_OEN)) -+#define BIT_GET_SW_GPIO_A_OEN(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_A_OEN) & BIT_MASK_SW_GPIO_A_OEN) -+#define BIT_SET_SW_GPIO_A_OEN(x, v) \ -+ (BIT_CLEAR_SW_GPIO_A_OEN(x) | BIT_SW_GPIO_A_OEN(v)) -+ -+#define BIT_SHIFT_SW_GPIO_A_OE2 0 -+#define BIT_MASK_SW_GPIO_A_OE2 0xffffffffL -+#define BIT_SW_GPIO_A_OE2(x) \ -+ (((x) & BIT_MASK_SW_GPIO_A_OE2) << BIT_SHIFT_SW_GPIO_A_OE2) -+#define BITS_SW_GPIO_A_OE2 (BIT_MASK_SW_GPIO_A_OE2 << BIT_SHIFT_SW_GPIO_A_OE2) -+#define BIT_CLEAR_SW_GPIO_A_OE2(x) ((x) & (~BITS_SW_GPIO_A_OE2)) -+#define BIT_GET_SW_GPIO_A_OE2(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_A_OE2) & BIT_MASK_SW_GPIO_A_OE2) -+#define BIT_SET_SW_GPIO_A_OE2(x, v) \ -+ (BIT_CLEAR_SW_GPIO_A_OE2(x) | BIT_SW_GPIO_A_OE2(v)) -+ -+#define BIT_SHIFT_SW_GPIO_A_PU 0 -+#define BIT_MASK_SW_GPIO_A_PU 0xffffffffL -+#define BIT_SW_GPIO_A_PU(x) \ -+ (((x) & BIT_MASK_SW_GPIO_A_PU) << BIT_SHIFT_SW_GPIO_A_PU) -+#define BITS_SW_GPIO_A_PU (BIT_MASK_SW_GPIO_A_PU << BIT_SHIFT_SW_GPIO_A_PU) -+#define BIT_CLEAR_SW_GPIO_A_PU(x) ((x) & (~BITS_SW_GPIO_A_PU)) -+#define BIT_GET_SW_GPIO_A_PU(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_A_PU) & BIT_MASK_SW_GPIO_A_PU) -+#define BIT_SET_SW_GPIO_A_PU(x, v) \ -+ (BIT_CLEAR_SW_GPIO_A_PU(x) | BIT_SW_GPIO_A_PU(v)) -+ -+#define BIT_SHIFT_SW_GPIO_A_PD 0 -+#define BIT_MASK_SW_GPIO_A_PD 0xffffffffL -+#define BIT_SW_GPIO_A_PD(x) \ -+ (((x) & BIT_MASK_SW_GPIO_A_PD) << BIT_SHIFT_SW_GPIO_A_PD) -+#define BITS_SW_GPIO_A_PD (BIT_MASK_SW_GPIO_A_PD << BIT_SHIFT_SW_GPIO_A_PD) -+#define BIT_CLEAR_SW_GPIO_A_PD(x) ((x) & (~BITS_SW_GPIO_A_PD)) -+#define BIT_GET_SW_GPIO_A_PD(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_A_PD) & BIT_MASK_SW_GPIO_A_PD) -+#define BIT_SET_SW_GPIO_A_PD(x, v) \ -+ (BIT_CLEAR_SW_GPIO_A_PD(x) | BIT_SW_GPIO_A_PD(v)) -+ -+#define BIT_SHIFT_SW_GPIO_A_IN 0 -+#define BIT_MASK_SW_GPIO_A_IN 0xffffffffL -+#define BIT_SW_GPIO_A_IN(x) \ -+ (((x) & BIT_MASK_SW_GPIO_A_IN) << BIT_SHIFT_SW_GPIO_A_IN) -+#define BITS_SW_GPIO_A_IN (BIT_MASK_SW_GPIO_A_IN << BIT_SHIFT_SW_GPIO_A_IN) -+#define BIT_CLEAR_SW_GPIO_A_IN(x) ((x) & (~BITS_SW_GPIO_A_IN)) -+#define BIT_GET_SW_GPIO_A_IN(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_A_IN) & BIT_MASK_SW_GPIO_A_IN) -+#define BIT_SET_SW_GPIO_A_IN(x, v) \ -+ (BIT_CLEAR_SW_GPIO_A_IN(x) | BIT_SW_GPIO_A_IN(v)) -+ -+#define BIT_SHIFT_SW_GPIO_B_OEN 0 -+#define BIT_MASK_SW_GPIO_B_OEN 0xff -+#define BIT_SW_GPIO_B_OEN(x) \ -+ (((x) & BIT_MASK_SW_GPIO_B_OEN) << BIT_SHIFT_SW_GPIO_B_OEN) -+#define BITS_SW_GPIO_B_OEN (BIT_MASK_SW_GPIO_B_OEN << BIT_SHIFT_SW_GPIO_B_OEN) -+#define BIT_CLEAR_SW_GPIO_B_OEN(x) ((x) & (~BITS_SW_GPIO_B_OEN)) -+#define BIT_GET_SW_GPIO_B_OEN(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_B_OEN) & BIT_MASK_SW_GPIO_B_OEN) -+#define BIT_SET_SW_GPIO_B_OEN(x, v) \ -+ (BIT_CLEAR_SW_GPIO_B_OEN(x) | BIT_SW_GPIO_B_OEN(v)) -+ -+#define BIT_SHIFT_SW_GPIO_B_OUT 0 -+#define BIT_MASK_SW_GPIO_B_OUT 0xff -+#define BIT_SW_GPIO_B_OUT(x) \ -+ (((x) & BIT_MASK_SW_GPIO_B_OUT) << BIT_SHIFT_SW_GPIO_B_OUT) -+#define BITS_SW_GPIO_B_OUT (BIT_MASK_SW_GPIO_B_OUT << BIT_SHIFT_SW_GPIO_B_OUT) -+#define BIT_CLEAR_SW_GPIO_B_OUT(x) ((x) & (~BITS_SW_GPIO_B_OUT)) -+#define BIT_GET_SW_GPIO_B_OUT(x) \ -+ (((x) >> BIT_SHIFT_SW_GPIO_B_OUT) & BIT_MASK_SW_GPIO_B_OUT) -+#define BIT_SET_SW_GPIO_B_OUT(x, v) \ -+ (BIT_CLEAR_SW_GPIO_B_OUT(x) | BIT_SW_GPIO_B_OUT(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_SHIFT_EFS_HCI_SEL_V1 0 -+#define BIT_MASK_EFS_HCI_SEL_V1 0x7 -+#define BIT_EFS_HCI_SEL_V1(x) \ -+ (((x) & BIT_MASK_EFS_HCI_SEL_V1) << BIT_SHIFT_EFS_HCI_SEL_V1) -+#define BITS_EFS_HCI_SEL_V1 \ -+ (BIT_MASK_EFS_HCI_SEL_V1 << BIT_SHIFT_EFS_HCI_SEL_V1) -+#define BIT_CLEAR_EFS_HCI_SEL_V1(x) ((x) & (~BITS_EFS_HCI_SEL_V1)) -+#define BIT_GET_EFS_HCI_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_EFS_HCI_SEL_V1) & BIT_MASK_EFS_HCI_SEL_V1) -+#define BIT_SET_EFS_HCI_SEL_V1(x, v) \ -+ (BIT_CLEAR_EFS_HCI_SEL_V1(x) | BIT_EFS_HCI_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_STATUS1 (Offset 0x00F4) */ -+ -+#define BIT_PAD_HWPDB BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_STATUS2 (Offset 0x00F8) */ -+ -+#define BIT_HIOE_ON_TIMEOUT BIT(23) -+#define BIT_SIC_ON_TIMEOUT BIT(22) -+#define BIT_CPU_ON_TIMEOUT BIT(21) -+#define BIT_HCI_ON_TIMEOUT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_STATUS2 (Offset 0x00F8) */ -+ -+#define BIT_SIO_ALDN BIT(19) -+#define BIT_USB_ALDN BIT(18) -+#define BIT_PCI_ALDN BIT(17) -+#define BIT_SYS_ALDN BIT(16) -+ -+#define BIT_SHIFT_EPVID1 8 -+#define BIT_MASK_EPVID1 0xff -+#define BIT_EPVID1(x) (((x) & BIT_MASK_EPVID1) << BIT_SHIFT_EPVID1) -+#define BITS_EPVID1 (BIT_MASK_EPVID1 << BIT_SHIFT_EPVID1) -+#define BIT_CLEAR_EPVID1(x) ((x) & (~BITS_EPVID1)) -+#define BIT_GET_EPVID1(x) (((x) >> BIT_SHIFT_EPVID1) & BIT_MASK_EPVID1) -+#define BIT_SET_EPVID1(x, v) (BIT_CLEAR_EPVID1(x) | BIT_EPVID1(v)) -+ -+#define BIT_SHIFT_EPVID0 0 -+#define BIT_MASK_EPVID0 0xff -+#define BIT_EPVID0(x) (((x) & BIT_MASK_EPVID0) << BIT_SHIFT_EPVID0) -+#define BITS_EPVID0 (BIT_MASK_EPVID0 << BIT_SHIFT_EPVID0) -+#define BIT_CLEAR_EPVID0(x) ((x) & (~BITS_EPVID0)) -+#define BIT_GET_EPVID0(x) (((x) >> BIT_SHIFT_EPVID0) & BIT_MASK_EPVID0) -+#define BIT_SET_EPVID0(x, v) (BIT_CLEAR_EPVID0(x) | BIT_EPVID0(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_USB2_SEL_1 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_USB2_SEL BIT(31) -+#define BIT_FEN_WLMAC_OFF BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_USB3PHY_RST BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_U3PHY_RST_V1 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_U3_TERM_DET BIT(29) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_U3_TERM_DETECT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_USB23_DBG_SEL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_HCI_SEL_EMBEDDED BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_ISO_BB2PP BIT(7) -+#define BIT_ISO_DENG2PP BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_SHIFT_HW_ID 0 -+#define BIT_MASK_HW_ID 0xff -+#define BIT_HW_ID(x) (((x) & BIT_MASK_HW_ID) << BIT_SHIFT_HW_ID) -+#define BITS_HW_ID (BIT_MASK_HW_ID << BIT_SHIFT_HW_ID) -+#define BIT_CLEAR_HW_ID(x) ((x) & (~BITS_HW_ID)) -+#define BIT_GET_HW_ID(x) (((x) >> BIT_SHIFT_HW_ID) & BIT_MASK_HW_ID) -+#define BIT_SET_HW_ID(x, v) (BIT_CLEAR_HW_ID(x) | BIT_HW_ID(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG2 (Offset 0x00FC) */ -+ -+#define BIT_SHIFT_CHIPID 0 -+#define BIT_MASK_CHIPID 0xff -+#define BIT_CHIPID(x) (((x) & BIT_MASK_CHIPID) << BIT_SHIFT_CHIPID) -+#define BITS_CHIPID (BIT_MASK_CHIPID << BIT_SHIFT_CHIPID) -+#define BIT_CLEAR_CHIPID(x) ((x) & (~BITS_CHIPID)) -+#define BIT_GET_CHIPID(x) (((x) >> BIT_SHIFT_CHIPID) & BIT_MASK_CHIPID) -+#define BIT_SET_CHIPID(x, v) (BIT_CLEAR_CHIPID(x) | BIT_CHIPID(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CR (Offset 0x0100) */ -+ -+#define BIT_BIST_H32BIT_SEL BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CR (Offset 0x0100) */ -+ -+#define BIT_MACIO_TIMEOUT_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CR (Offset 0x0100) */ -+ -+#define BIT_SHIFT_LBMODE 24 -+#define BIT_MASK_LBMODE 0x1f -+#define BIT_LBMODE(x) (((x) & BIT_MASK_LBMODE) << BIT_SHIFT_LBMODE) -+#define BITS_LBMODE (BIT_MASK_LBMODE << BIT_SHIFT_LBMODE) -+#define BIT_CLEAR_LBMODE(x) ((x) & (~BITS_LBMODE)) -+#define BIT_GET_LBMODE(x) (((x) >> BIT_SHIFT_LBMODE) & BIT_MASK_LBMODE) -+#define BIT_SET_LBMODE(x, v) (BIT_CLEAR_LBMODE(x) | BIT_LBMODE(v)) -+ -+#define BIT_SHIFT_NETYPE1 18 -+#define BIT_MASK_NETYPE1 0x3 -+#define BIT_NETYPE1(x) (((x) & BIT_MASK_NETYPE1) << BIT_SHIFT_NETYPE1) -+#define BITS_NETYPE1 (BIT_MASK_NETYPE1 << BIT_SHIFT_NETYPE1) -+#define BIT_CLEAR_NETYPE1(x) ((x) & (~BITS_NETYPE1)) -+#define BIT_GET_NETYPE1(x) (((x) >> BIT_SHIFT_NETYPE1) & BIT_MASK_NETYPE1) -+#define BIT_SET_NETYPE1(x, v) (BIT_CLEAR_NETYPE1(x) | BIT_NETYPE1(v)) -+ -+#define BIT_SHIFT_NETYPE0 16 -+#define BIT_MASK_NETYPE0 0x3 -+#define BIT_NETYPE0(x) (((x) & BIT_MASK_NETYPE0) << BIT_SHIFT_NETYPE0) -+#define BITS_NETYPE0 (BIT_MASK_NETYPE0 << BIT_SHIFT_NETYPE0) -+#define BIT_CLEAR_NETYPE0(x) ((x) & (~BITS_NETYPE0)) -+#define BIT_GET_NETYPE0(x) (((x) >> BIT_SHIFT_NETYPE0) & BIT_MASK_NETYPE0) -+#define BIT_SET_NETYPE0(x, v) (BIT_CLEAR_NETYPE0(x) | BIT_NETYPE0(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_CR (Offset 0x0100) */ -+ -+#define BIT_STAT_FUNC_RST BIT(13) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CR (Offset 0x0100) */ -+ -+#define BIT_COUNTER_STS_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CR (Offset 0x0100) */ -+ -+#define BIT_PTA_I2C_MBOX_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CR (Offset 0x0100) */ -+ -+#define BIT_I2C_MAILBOX_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CR (Offset 0x0100) */ -+ -+#define BIT_SHCUT_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CR (Offset 0x0100) */ -+ -+#define BIT_32K_CAL_TMR_EN BIT(10) -+#define BIT_MAC_SEC_EN BIT(9) -+#define BIT_ENSWBCN BIT(8) -+#define BIT_MACRXEN BIT(7) -+#define BIT_MACTXEN BIT(6) -+#define BIT_SCHEDULE_EN BIT(5) -+#define BIT_PROTOCOL_EN BIT(4) -+#define BIT_RXDMA_EN BIT(3) -+#define BIT_TXDMA_EN BIT(2) -+#define BIT_HCI_RXDMA_EN BIT(1) -+#define BIT_HCI_TXDMA_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PG_SIZE (Offset 0x0104) */ -+ -+#define BIT_SHIFT_DBG_FIFO_SEL 16 -+#define BIT_MASK_DBG_FIFO_SEL 0xff -+#define BIT_DBG_FIFO_SEL(x) \ -+ (((x) & BIT_MASK_DBG_FIFO_SEL) << BIT_SHIFT_DBG_FIFO_SEL) -+#define BITS_DBG_FIFO_SEL (BIT_MASK_DBG_FIFO_SEL << BIT_SHIFT_DBG_FIFO_SEL) -+#define BIT_CLEAR_DBG_FIFO_SEL(x) ((x) & (~BITS_DBG_FIFO_SEL)) -+#define BIT_GET_DBG_FIFO_SEL(x) \ -+ (((x) >> BIT_SHIFT_DBG_FIFO_SEL) & BIT_MASK_DBG_FIFO_SEL) -+#define BIT_SET_DBG_FIFO_SEL(x, v) \ -+ (BIT_CLEAR_DBG_FIFO_SEL(x) | BIT_DBG_FIFO_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PKT_BUFF_ACCESS_CTRL (Offset 0x0106) */ -+ -+#define BIT_SHIFT_PKT_BUFF_ACCESS_CTRL 0 -+#define BIT_MASK_PKT_BUFF_ACCESS_CTRL 0xff -+#define BIT_PKT_BUFF_ACCESS_CTRL(x) \ -+ (((x) & BIT_MASK_PKT_BUFF_ACCESS_CTRL) \ -+ << BIT_SHIFT_PKT_BUFF_ACCESS_CTRL) -+#define BITS_PKT_BUFF_ACCESS_CTRL \ -+ (BIT_MASK_PKT_BUFF_ACCESS_CTRL << BIT_SHIFT_PKT_BUFF_ACCESS_CTRL) -+#define BIT_CLEAR_PKT_BUFF_ACCESS_CTRL(x) ((x) & (~BITS_PKT_BUFF_ACCESS_CTRL)) -+#define BIT_GET_PKT_BUFF_ACCESS_CTRL(x) \ -+ (((x) >> BIT_SHIFT_PKT_BUFF_ACCESS_CTRL) & \ -+ BIT_MASK_PKT_BUFF_ACCESS_CTRL) -+#define BIT_SET_PKT_BUFF_ACCESS_CTRL(x, v) \ -+ (BIT_CLEAR_PKT_BUFF_ACCESS_CTRL(x) | BIT_PKT_BUFF_ACCESS_CTRL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSF_CLK_STATE (Offset 0x0108) */ -+ -+#define BIT_RXPKTBUF_DBG BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TSF_CLK_STATE (Offset 0x0108) */ -+ -+#define BIT_TSF_CLK_IDX BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSF_CLK_STATE (Offset 0x0108) */ -+ -+#define BIT_TSF_CLK_STABLE BIT(15) -+ -+#define BIT_SHIFT_PKTBUF_DBG_ADDR 0 -+#define BIT_MASK_PKTBUF_DBG_ADDR 0x1fff -+#define BIT_PKTBUF_DBG_ADDR(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_ADDR) << BIT_SHIFT_PKTBUF_DBG_ADDR) -+#define BITS_PKTBUF_DBG_ADDR \ -+ (BIT_MASK_PKTBUF_DBG_ADDR << BIT_SHIFT_PKTBUF_DBG_ADDR) -+#define BIT_CLEAR_PKTBUF_DBG_ADDR(x) ((x) & (~BITS_PKTBUF_DBG_ADDR)) -+#define BIT_GET_PKTBUF_DBG_ADDR(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_ADDR) & BIT_MASK_PKTBUF_DBG_ADDR) -+#define BIT_SET_PKTBUF_DBG_ADDR(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_ADDR(x) | BIT_PKTBUF_DBG_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_CSI_BW_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_HIQ_MAP_V1 19 -+#define BIT_MASK_TXDMA_HIQ_MAP_V1 0x7 -+#define BIT_TXDMA_HIQ_MAP_V1(x) \ -+ (((x) & BIT_MASK_TXDMA_HIQ_MAP_V1) << BIT_SHIFT_TXDMA_HIQ_MAP_V1) -+#define BITS_TXDMA_HIQ_MAP_V1 \ -+ (BIT_MASK_TXDMA_HIQ_MAP_V1 << BIT_SHIFT_TXDMA_HIQ_MAP_V1) -+#define BIT_CLEAR_TXDMA_HIQ_MAP_V1(x) ((x) & (~BITS_TXDMA_HIQ_MAP_V1)) -+#define BIT_GET_TXDMA_HIQ_MAP_V1(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_HIQ_MAP_V1) & BIT_MASK_TXDMA_HIQ_MAP_V1) -+#define BIT_SET_TXDMA_HIQ_MAP_V1(x, v) \ -+ (BIT_CLEAR_TXDMA_HIQ_MAP_V1(x) | BIT_TXDMA_HIQ_MAP_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_CMQ_MAP 16 -+#define BIT_MASK_TXDMA_CMQ_MAP 0x3 -+#define BIT_TXDMA_CMQ_MAP(x) \ -+ (((x) & BIT_MASK_TXDMA_CMQ_MAP) << BIT_SHIFT_TXDMA_CMQ_MAP) -+#define BITS_TXDMA_CMQ_MAP (BIT_MASK_TXDMA_CMQ_MAP << BIT_SHIFT_TXDMA_CMQ_MAP) -+#define BIT_CLEAR_TXDMA_CMQ_MAP(x) ((x) & (~BITS_TXDMA_CMQ_MAP)) -+#define BIT_GET_TXDMA_CMQ_MAP(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_CMQ_MAP) & BIT_MASK_TXDMA_CMQ_MAP) -+#define BIT_SET_TXDMA_CMQ_MAP(x, v) \ -+ (BIT_CLEAR_TXDMA_CMQ_MAP(x) | BIT_TXDMA_CMQ_MAP(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_MGQ_MAP_V1 16 -+#define BIT_MASK_TXDMA_MGQ_MAP_V1 0x7 -+#define BIT_TXDMA_MGQ_MAP_V1(x) \ -+ (((x) & BIT_MASK_TXDMA_MGQ_MAP_V1) << BIT_SHIFT_TXDMA_MGQ_MAP_V1) -+#define BITS_TXDMA_MGQ_MAP_V1 \ -+ (BIT_MASK_TXDMA_MGQ_MAP_V1 << BIT_SHIFT_TXDMA_MGQ_MAP_V1) -+#define BIT_CLEAR_TXDMA_MGQ_MAP_V1(x) ((x) & (~BITS_TXDMA_MGQ_MAP_V1)) -+#define BIT_GET_TXDMA_MGQ_MAP_V1(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_MGQ_MAP_V1) & BIT_MASK_TXDMA_MGQ_MAP_V1) -+#define BIT_SET_TXDMA_MGQ_MAP_V1(x, v) \ -+ (BIT_CLEAR_TXDMA_MGQ_MAP_V1(x) | BIT_TXDMA_MGQ_MAP_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_H2C_MAP 16 -+#define BIT_MASK_TXDMA_H2C_MAP 0x3 -+#define BIT_TXDMA_H2C_MAP(x) \ -+ (((x) & BIT_MASK_TXDMA_H2C_MAP) << BIT_SHIFT_TXDMA_H2C_MAP) -+#define BITS_TXDMA_H2C_MAP (BIT_MASK_TXDMA_H2C_MAP << BIT_SHIFT_TXDMA_H2C_MAP) -+#define BIT_CLEAR_TXDMA_H2C_MAP(x) ((x) & (~BITS_TXDMA_H2C_MAP)) -+#define BIT_GET_TXDMA_H2C_MAP(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_H2C_MAP) & BIT_MASK_TXDMA_H2C_MAP) -+#define BIT_SET_TXDMA_H2C_MAP(x, v) \ -+ (BIT_CLEAR_TXDMA_H2C_MAP(x) | BIT_TXDMA_H2C_MAP(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_HIQ_MAP 14 -+#define BIT_MASK_TXDMA_HIQ_MAP 0x3 -+#define BIT_TXDMA_HIQ_MAP(x) \ -+ (((x) & BIT_MASK_TXDMA_HIQ_MAP) << BIT_SHIFT_TXDMA_HIQ_MAP) -+#define BITS_TXDMA_HIQ_MAP (BIT_MASK_TXDMA_HIQ_MAP << BIT_SHIFT_TXDMA_HIQ_MAP) -+#define BIT_CLEAR_TXDMA_HIQ_MAP(x) ((x) & (~BITS_TXDMA_HIQ_MAP)) -+#define BIT_GET_TXDMA_HIQ_MAP(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_HIQ_MAP) & BIT_MASK_TXDMA_HIQ_MAP) -+#define BIT_SET_TXDMA_HIQ_MAP(x, v) \ -+ (BIT_CLEAR_TXDMA_HIQ_MAP(x) | BIT_TXDMA_HIQ_MAP(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_BKQ_MAP_V1 13 -+#define BIT_MASK_TXDMA_BKQ_MAP_V1 0x7 -+#define BIT_TXDMA_BKQ_MAP_V1(x) \ -+ (((x) & BIT_MASK_TXDMA_BKQ_MAP_V1) << BIT_SHIFT_TXDMA_BKQ_MAP_V1) -+#define BITS_TXDMA_BKQ_MAP_V1 \ -+ (BIT_MASK_TXDMA_BKQ_MAP_V1 << BIT_SHIFT_TXDMA_BKQ_MAP_V1) -+#define BIT_CLEAR_TXDMA_BKQ_MAP_V1(x) ((x) & (~BITS_TXDMA_BKQ_MAP_V1)) -+#define BIT_GET_TXDMA_BKQ_MAP_V1(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BKQ_MAP_V1) & BIT_MASK_TXDMA_BKQ_MAP_V1) -+#define BIT_SET_TXDMA_BKQ_MAP_V1(x, v) \ -+ (BIT_CLEAR_TXDMA_BKQ_MAP_V1(x) | BIT_TXDMA_BKQ_MAP_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_MGQ_MAP 12 -+#define BIT_MASK_TXDMA_MGQ_MAP 0x3 -+#define BIT_TXDMA_MGQ_MAP(x) \ -+ (((x) & BIT_MASK_TXDMA_MGQ_MAP) << BIT_SHIFT_TXDMA_MGQ_MAP) -+#define BITS_TXDMA_MGQ_MAP (BIT_MASK_TXDMA_MGQ_MAP << BIT_SHIFT_TXDMA_MGQ_MAP) -+#define BIT_CLEAR_TXDMA_MGQ_MAP(x) ((x) & (~BITS_TXDMA_MGQ_MAP)) -+#define BIT_GET_TXDMA_MGQ_MAP(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_MGQ_MAP) & BIT_MASK_TXDMA_MGQ_MAP) -+#define BIT_SET_TXDMA_MGQ_MAP(x, v) \ -+ (BIT_CLEAR_TXDMA_MGQ_MAP(x) | BIT_TXDMA_MGQ_MAP(v)) -+ -+#define BIT_SHIFT_TXDMA_BKQ_MAP 10 -+#define BIT_MASK_TXDMA_BKQ_MAP 0x3 -+#define BIT_TXDMA_BKQ_MAP(x) \ -+ (((x) & BIT_MASK_TXDMA_BKQ_MAP) << BIT_SHIFT_TXDMA_BKQ_MAP) -+#define BITS_TXDMA_BKQ_MAP (BIT_MASK_TXDMA_BKQ_MAP << BIT_SHIFT_TXDMA_BKQ_MAP) -+#define BIT_CLEAR_TXDMA_BKQ_MAP(x) ((x) & (~BITS_TXDMA_BKQ_MAP)) -+#define BIT_GET_TXDMA_BKQ_MAP(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BKQ_MAP) & BIT_MASK_TXDMA_BKQ_MAP) -+#define BIT_SET_TXDMA_BKQ_MAP(x, v) \ -+ (BIT_CLEAR_TXDMA_BKQ_MAP(x) | BIT_TXDMA_BKQ_MAP(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_BEQ_MAP_V1 10 -+#define BIT_MASK_TXDMA_BEQ_MAP_V1 0x7 -+#define BIT_TXDMA_BEQ_MAP_V1(x) \ -+ (((x) & BIT_MASK_TXDMA_BEQ_MAP_V1) << BIT_SHIFT_TXDMA_BEQ_MAP_V1) -+#define BITS_TXDMA_BEQ_MAP_V1 \ -+ (BIT_MASK_TXDMA_BEQ_MAP_V1 << BIT_SHIFT_TXDMA_BEQ_MAP_V1) -+#define BIT_CLEAR_TXDMA_BEQ_MAP_V1(x) ((x) & (~BITS_TXDMA_BEQ_MAP_V1)) -+#define BIT_GET_TXDMA_BEQ_MAP_V1(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BEQ_MAP_V1) & BIT_MASK_TXDMA_BEQ_MAP_V1) -+#define BIT_SET_TXDMA_BEQ_MAP_V1(x, v) \ -+ (BIT_CLEAR_TXDMA_BEQ_MAP_V1(x) | BIT_TXDMA_BEQ_MAP_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_BEQ_MAP 8 -+#define BIT_MASK_TXDMA_BEQ_MAP 0x3 -+#define BIT_TXDMA_BEQ_MAP(x) \ -+ (((x) & BIT_MASK_TXDMA_BEQ_MAP) << BIT_SHIFT_TXDMA_BEQ_MAP) -+#define BITS_TXDMA_BEQ_MAP (BIT_MASK_TXDMA_BEQ_MAP << BIT_SHIFT_TXDMA_BEQ_MAP) -+#define BIT_CLEAR_TXDMA_BEQ_MAP(x) ((x) & (~BITS_TXDMA_BEQ_MAP)) -+#define BIT_GET_TXDMA_BEQ_MAP(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BEQ_MAP) & BIT_MASK_TXDMA_BEQ_MAP) -+#define BIT_SET_TXDMA_BEQ_MAP(x, v) \ -+ (BIT_CLEAR_TXDMA_BEQ_MAP(x) | BIT_TXDMA_BEQ_MAP(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_VIQ_MAP_V1 7 -+#define BIT_MASK_TXDMA_VIQ_MAP_V1 0x7 -+#define BIT_TXDMA_VIQ_MAP_V1(x) \ -+ (((x) & BIT_MASK_TXDMA_VIQ_MAP_V1) << BIT_SHIFT_TXDMA_VIQ_MAP_V1) -+#define BITS_TXDMA_VIQ_MAP_V1 \ -+ (BIT_MASK_TXDMA_VIQ_MAP_V1 << BIT_SHIFT_TXDMA_VIQ_MAP_V1) -+#define BIT_CLEAR_TXDMA_VIQ_MAP_V1(x) ((x) & (~BITS_TXDMA_VIQ_MAP_V1)) -+#define BIT_GET_TXDMA_VIQ_MAP_V1(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VIQ_MAP_V1) & BIT_MASK_TXDMA_VIQ_MAP_V1) -+#define BIT_SET_TXDMA_VIQ_MAP_V1(x, v) \ -+ (BIT_CLEAR_TXDMA_VIQ_MAP_V1(x) | BIT_TXDMA_VIQ_MAP_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_VIQ_MAP 6 -+#define BIT_MASK_TXDMA_VIQ_MAP 0x3 -+#define BIT_TXDMA_VIQ_MAP(x) \ -+ (((x) & BIT_MASK_TXDMA_VIQ_MAP) << BIT_SHIFT_TXDMA_VIQ_MAP) -+#define BITS_TXDMA_VIQ_MAP (BIT_MASK_TXDMA_VIQ_MAP << BIT_SHIFT_TXDMA_VIQ_MAP) -+#define BIT_CLEAR_TXDMA_VIQ_MAP(x) ((x) & (~BITS_TXDMA_VIQ_MAP)) -+#define BIT_GET_TXDMA_VIQ_MAP(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VIQ_MAP) & BIT_MASK_TXDMA_VIQ_MAP) -+#define BIT_SET_TXDMA_VIQ_MAP(x, v) \ -+ (BIT_CLEAR_TXDMA_VIQ_MAP(x) | BIT_TXDMA_VIQ_MAP(v)) -+ -+#define BIT_SHIFT_TXDMA_VOQ_MAP 4 -+#define BIT_MASK_TXDMA_VOQ_MAP 0x3 -+#define BIT_TXDMA_VOQ_MAP(x) \ -+ (((x) & BIT_MASK_TXDMA_VOQ_MAP) << BIT_SHIFT_TXDMA_VOQ_MAP) -+#define BITS_TXDMA_VOQ_MAP (BIT_MASK_TXDMA_VOQ_MAP << BIT_SHIFT_TXDMA_VOQ_MAP) -+#define BIT_CLEAR_TXDMA_VOQ_MAP(x) ((x) & (~BITS_TXDMA_VOQ_MAP)) -+#define BIT_GET_TXDMA_VOQ_MAP(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VOQ_MAP) & BIT_MASK_TXDMA_VOQ_MAP) -+#define BIT_SET_TXDMA_VOQ_MAP(x, v) \ -+ (BIT_CLEAR_TXDMA_VOQ_MAP(x) | BIT_TXDMA_VOQ_MAP(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_SHIFT_TXDMA_VOQ_MAP_V1 4 -+#define BIT_MASK_TXDMA_VOQ_MAP_V1 0x7 -+#define BIT_TXDMA_VOQ_MAP_V1(x) \ -+ (((x) & BIT_MASK_TXDMA_VOQ_MAP_V1) << BIT_SHIFT_TXDMA_VOQ_MAP_V1) -+#define BITS_TXDMA_VOQ_MAP_V1 \ -+ (BIT_MASK_TXDMA_VOQ_MAP_V1 << BIT_SHIFT_TXDMA_VOQ_MAP_V1) -+#define BIT_CLEAR_TXDMA_VOQ_MAP_V1(x) ((x) & (~BITS_TXDMA_VOQ_MAP_V1)) -+#define BIT_GET_TXDMA_VOQ_MAP_V1(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VOQ_MAP_V1) & BIT_MASK_TXDMA_VOQ_MAP_V1) -+#define BIT_SET_TXDMA_VOQ_MAP_V1(x, v) \ -+ (BIT_CLEAR_TXDMA_VOQ_MAP_V1(x) | BIT_TXDMA_VOQ_MAP_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_TXDMA_BW_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_PQ_MAP (Offset 0x010C) */ -+ -+#define BIT_RXDMA_AGG_EN BIT(2) -+#define BIT_RXSHFT_EN BIT(1) -+#define BIT_RXDMA_ARBBW_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_TRXFF_BNDY (Offset 0x0114) */ -+ -+#define BIT_SHIFT_RXFFOVFL_RSV_V1 28 -+#define BIT_MASK_RXFFOVFL_RSV_V1 0xf -+#define BIT_RXFFOVFL_RSV_V1(x) \ -+ (((x) & BIT_MASK_RXFFOVFL_RSV_V1) << BIT_SHIFT_RXFFOVFL_RSV_V1) -+#define BITS_RXFFOVFL_RSV_V1 \ -+ (BIT_MASK_RXFFOVFL_RSV_V1 << BIT_SHIFT_RXFFOVFL_RSV_V1) -+#define BIT_CLEAR_RXFFOVFL_RSV_V1(x) ((x) & (~BITS_RXFFOVFL_RSV_V1)) -+#define BIT_GET_RXFFOVFL_RSV_V1(x) \ -+ (((x) >> BIT_SHIFT_RXFFOVFL_RSV_V1) & BIT_MASK_RXFFOVFL_RSV_V1) -+#define BIT_SET_RXFFOVFL_RSV_V1(x, v) \ -+ (BIT_CLEAR_RXFFOVFL_RSV_V1(x) | BIT_RXFFOVFL_RSV_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TRXFF_BNDY (Offset 0x0114) */ -+ -+#define BIT_SHIFT_RXFF0_BNDY 16 -+#define BIT_MASK_RXFF0_BNDY 0xffff -+#define BIT_RXFF0_BNDY(x) (((x) & BIT_MASK_RXFF0_BNDY) << BIT_SHIFT_RXFF0_BNDY) -+#define BITS_RXFF0_BNDY (BIT_MASK_RXFF0_BNDY << BIT_SHIFT_RXFF0_BNDY) -+#define BIT_CLEAR_RXFF0_BNDY(x) ((x) & (~BITS_RXFF0_BNDY)) -+#define BIT_GET_RXFF0_BNDY(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_BNDY) & BIT_MASK_RXFF0_BNDY) -+#define BIT_SET_RXFF0_BNDY(x, v) (BIT_CLEAR_RXFF0_BNDY(x) | BIT_RXFF0_BNDY(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TRXFF_BNDY (Offset 0x0114) */ -+ -+#define BIT_SHIFT_FWFFOVFL_RSV 16 -+#define BIT_MASK_FWFFOVFL_RSV 0xf -+#define BIT_FWFFOVFL_RSV(x) \ -+ (((x) & BIT_MASK_FWFFOVFL_RSV) << BIT_SHIFT_FWFFOVFL_RSV) -+#define BITS_FWFFOVFL_RSV (BIT_MASK_FWFFOVFL_RSV << BIT_SHIFT_FWFFOVFL_RSV) -+#define BIT_CLEAR_FWFFOVFL_RSV(x) ((x) & (~BITS_FWFFOVFL_RSV)) -+#define BIT_GET_FWFFOVFL_RSV(x) \ -+ (((x) >> BIT_SHIFT_FWFFOVFL_RSV) & BIT_MASK_FWFFOVFL_RSV) -+#define BIT_SET_FWFFOVFL_RSV(x, v) \ -+ (BIT_CLEAR_FWFFOVFL_RSV(x) | BIT_FWFFOVFL_RSV(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TRXFF_BNDY (Offset 0x0114) */ -+ -+#define BIT_SHIFT_RXFFOVFL_RSV 8 -+#define BIT_MASK_RXFFOVFL_RSV 0xf -+#define BIT_RXFFOVFL_RSV(x) \ -+ (((x) & BIT_MASK_RXFFOVFL_RSV) << BIT_SHIFT_RXFFOVFL_RSV) -+#define BITS_RXFFOVFL_RSV (BIT_MASK_RXFFOVFL_RSV << BIT_SHIFT_RXFFOVFL_RSV) -+#define BIT_CLEAR_RXFFOVFL_RSV(x) ((x) & (~BITS_RXFFOVFL_RSV)) -+#define BIT_GET_RXFFOVFL_RSV(x) \ -+ (((x) >> BIT_SHIFT_RXFFOVFL_RSV) & BIT_MASK_RXFFOVFL_RSV) -+#define BIT_SET_RXFFOVFL_RSV(x, v) \ -+ (BIT_CLEAR_RXFFOVFL_RSV(x) | BIT_RXFFOVFL_RSV(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TRXFF_BNDY (Offset 0x0114) */ -+ -+#define BIT_SHIFT_RXFFOVFL_RSV_V2 8 -+#define BIT_MASK_RXFFOVFL_RSV_V2 0xf -+#define BIT_RXFFOVFL_RSV_V2(x) \ -+ (((x) & BIT_MASK_RXFFOVFL_RSV_V2) << BIT_SHIFT_RXFFOVFL_RSV_V2) -+#define BITS_RXFFOVFL_RSV_V2 \ -+ (BIT_MASK_RXFFOVFL_RSV_V2 << BIT_SHIFT_RXFFOVFL_RSV_V2) -+#define BIT_CLEAR_RXFFOVFL_RSV_V2(x) ((x) & (~BITS_RXFFOVFL_RSV_V2)) -+#define BIT_GET_RXFFOVFL_RSV_V2(x) \ -+ (((x) >> BIT_SHIFT_RXFFOVFL_RSV_V2) & BIT_MASK_RXFFOVFL_RSV_V2) -+#define BIT_SET_RXFFOVFL_RSV_V2(x, v) \ -+ (BIT_CLEAR_RXFFOVFL_RSV_V2(x) | BIT_RXFFOVFL_RSV_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_TRXFF_BNDY (Offset 0x0114) */ -+ -+#define BIT_SHIFT_RXFF0_BNDY_V1 8 -+#define BIT_MASK_RXFF0_BNDY_V1 0x3ffff -+#define BIT_RXFF0_BNDY_V1(x) \ -+ (((x) & BIT_MASK_RXFF0_BNDY_V1) << BIT_SHIFT_RXFF0_BNDY_V1) -+#define BITS_RXFF0_BNDY_V1 (BIT_MASK_RXFF0_BNDY_V1 << BIT_SHIFT_RXFF0_BNDY_V1) -+#define BIT_CLEAR_RXFF0_BNDY_V1(x) ((x) & (~BITS_RXFF0_BNDY_V1)) -+#define BIT_GET_RXFF0_BNDY_V1(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_BNDY_V1) & BIT_MASK_RXFF0_BNDY_V1) -+#define BIT_SET_RXFF0_BNDY_V1(x, v) \ -+ (BIT_CLEAR_RXFF0_BNDY_V1(x) | BIT_RXFF0_BNDY_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TRXFF_BNDY (Offset 0x0114) */ -+ -+#define BIT_SHIFT_TXPKTBUF_PGBNDY 0 -+#define BIT_MASK_TXPKTBUF_PGBNDY 0xff -+#define BIT_TXPKTBUF_PGBNDY(x) \ -+ (((x) & BIT_MASK_TXPKTBUF_PGBNDY) << BIT_SHIFT_TXPKTBUF_PGBNDY) -+#define BITS_TXPKTBUF_PGBNDY \ -+ (BIT_MASK_TXPKTBUF_PGBNDY << BIT_SHIFT_TXPKTBUF_PGBNDY) -+#define BIT_CLEAR_TXPKTBUF_PGBNDY(x) ((x) & (~BITS_TXPKTBUF_PGBNDY)) -+#define BIT_GET_TXPKTBUF_PGBNDY(x) \ -+ (((x) >> BIT_SHIFT_TXPKTBUF_PGBNDY) & BIT_MASK_TXPKTBUF_PGBNDY) -+#define BIT_SET_TXPKTBUF_PGBNDY(x, v) \ -+ (BIT_CLEAR_TXPKTBUF_PGBNDY(x) | BIT_TXPKTBUF_PGBNDY(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTA_I2C_MBOX (Offset 0x0118) */ -+ -+#define BIT_SHIFT_RESP_TXPOWER 18 -+#define BIT_MASK_RESP_TXPOWER 0x7 -+#define BIT_RESP_TXPOWER(x) \ -+ (((x) & BIT_MASK_RESP_TXPOWER) << BIT_SHIFT_RESP_TXPOWER) -+#define BITS_RESP_TXPOWER (BIT_MASK_RESP_TXPOWER << BIT_SHIFT_RESP_TXPOWER) -+#define BIT_CLEAR_RESP_TXPOWER(x) ((x) & (~BITS_RESP_TXPOWER)) -+#define BIT_GET_RESP_TXPOWER(x) \ -+ (((x) >> BIT_SHIFT_RESP_TXPOWER) & BIT_MASK_RESP_TXPOWER) -+#define BIT_SET_RESP_TXPOWER(x, v) \ -+ (BIT_CLEAR_RESP_TXPOWER(x) | BIT_RESP_TXPOWER(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_FF_STATUS (Offset 0x0118) */ -+ -+#define BIT_SHIFT_RXFF0_RDPTR_V1 13 -+#define BIT_MASK_RXFF0_RDPTR_V1 0x3ffff -+#define BIT_RXFF0_RDPTR_V1(x) \ -+ (((x) & BIT_MASK_RXFF0_RDPTR_V1) << BIT_SHIFT_RXFF0_RDPTR_V1) -+#define BITS_RXFF0_RDPTR_V1 \ -+ (BIT_MASK_RXFF0_RDPTR_V1 << BIT_SHIFT_RXFF0_RDPTR_V1) -+#define BIT_CLEAR_RXFF0_RDPTR_V1(x) ((x) & (~BITS_RXFF0_RDPTR_V1)) -+#define BIT_GET_RXFF0_RDPTR_V1(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_RDPTR_V1) & BIT_MASK_RXFF0_RDPTR_V1) -+#define BIT_SET_RXFF0_RDPTR_V1(x, v) \ -+ (BIT_CLEAR_RXFF0_RDPTR_V1(x) | BIT_RXFF0_RDPTR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTA_I2C_MBOX (Offset 0x0118) */ -+ -+#define BIT_SHIFT_I2C_M_STATUS 8 -+#define BIT_MASK_I2C_M_STATUS 0xf -+#define BIT_I2C_M_STATUS(x) \ -+ (((x) & BIT_MASK_I2C_M_STATUS) << BIT_SHIFT_I2C_M_STATUS) -+#define BITS_I2C_M_STATUS (BIT_MASK_I2C_M_STATUS << BIT_SHIFT_I2C_M_STATUS) -+#define BIT_CLEAR_I2C_M_STATUS(x) ((x) & (~BITS_I2C_M_STATUS)) -+#define BIT_GET_I2C_M_STATUS(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_STATUS) & BIT_MASK_I2C_M_STATUS) -+#define BIT_SET_I2C_M_STATUS(x, v) \ -+ (BIT_CLEAR_I2C_M_STATUS(x) | BIT_I2C_M_STATUS(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTA_I2C_MBOX (Offset 0x0118) */ -+ -+#define BIT_SHIFT_I2C_M_BUS_GNT 4 -+#define BIT_MASK_I2C_M_BUS_GNT 0x7 -+#define BIT_I2C_M_BUS_GNT(x) \ -+ (((x) & BIT_MASK_I2C_M_BUS_GNT) << BIT_SHIFT_I2C_M_BUS_GNT) -+#define BITS_I2C_M_BUS_GNT (BIT_MASK_I2C_M_BUS_GNT << BIT_SHIFT_I2C_M_BUS_GNT) -+#define BIT_CLEAR_I2C_M_BUS_GNT(x) ((x) & (~BITS_I2C_M_BUS_GNT)) -+#define BIT_GET_I2C_M_BUS_GNT(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_BUS_GNT) & BIT_MASK_I2C_M_BUS_GNT) -+#define BIT_SET_I2C_M_BUS_GNT(x, v) \ -+ (BIT_CLEAR_I2C_M_BUS_GNT(x) | BIT_I2C_M_BUS_GNT(v)) -+ -+#define BIT_I2C_GNT_FW BIT(3) -+ -+#define BIT_SHIFT_I2C_DATA_RATE 1 -+#define BIT_MASK_I2C_DATA_RATE 0x3 -+#define BIT_I2C_DATA_RATE(x) \ -+ (((x) & BIT_MASK_I2C_DATA_RATE) << BIT_SHIFT_I2C_DATA_RATE) -+#define BITS_I2C_DATA_RATE (BIT_MASK_I2C_DATA_RATE << BIT_SHIFT_I2C_DATA_RATE) -+#define BIT_CLEAR_I2C_DATA_RATE(x) ((x) & (~BITS_I2C_DATA_RATE)) -+#define BIT_GET_I2C_DATA_RATE(x) \ -+ (((x) >> BIT_SHIFT_I2C_DATA_RATE) & BIT_MASK_I2C_DATA_RATE) -+#define BIT_SET_I2C_DATA_RATE(x, v) \ -+ (BIT_CLEAR_I2C_DATA_RATE(x) | BIT_I2C_DATA_RATE(v)) -+ -+#define BIT_I2C_SW_CONTROL_UNLOCK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_FF_STATUS (Offset 0x0118) */ -+ -+#define BIT_SHIFT_RXFF0_WTPTR_V1 0 -+#define BIT_MASK_RXFF0_WTPTR_V1 0x3ffff -+#define BIT_RXFF0_WTPTR_V1(x) \ -+ (((x) & BIT_MASK_RXFF0_WTPTR_V1) << BIT_SHIFT_RXFF0_WTPTR_V1) -+#define BITS_RXFF0_WTPTR_V1 \ -+ (BIT_MASK_RXFF0_WTPTR_V1 << BIT_SHIFT_RXFF0_WTPTR_V1) -+#define BIT_CLEAR_RXFF0_WTPTR_V1(x) ((x) & (~BITS_RXFF0_WTPTR_V1)) -+#define BIT_GET_RXFF0_WTPTR_V1(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_WTPTR_V1) & BIT_MASK_RXFF0_WTPTR_V1) -+#define BIT_SET_RXFF0_WTPTR_V1(x, v) \ -+ (BIT_CLEAR_RXFF0_WTPTR_V1(x) | BIT_RXFF0_WTPTR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXFF_PTR (Offset 0x011C) */ -+ -+#define BIT_SHIFT_RXFF0_RDPTR 16 -+#define BIT_MASK_RXFF0_RDPTR 0xffff -+#define BIT_RXFF0_RDPTR(x) \ -+ (((x) & BIT_MASK_RXFF0_RDPTR) << BIT_SHIFT_RXFF0_RDPTR) -+#define BITS_RXFF0_RDPTR (BIT_MASK_RXFF0_RDPTR << BIT_SHIFT_RXFF0_RDPTR) -+#define BIT_CLEAR_RXFF0_RDPTR(x) ((x) & (~BITS_RXFF0_RDPTR)) -+#define BIT_GET_RXFF0_RDPTR(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_RDPTR) & BIT_MASK_RXFF0_RDPTR) -+#define BIT_SET_RXFF0_RDPTR(x, v) \ -+ (BIT_CLEAR_RXFF0_RDPTR(x) | BIT_RXFF0_RDPTR(v)) -+ -+#define BIT_SHIFT_RXFF0_WTPTR 0 -+#define BIT_MASK_RXFF0_WTPTR 0xffff -+#define BIT_RXFF0_WTPTR(x) \ -+ (((x) & BIT_MASK_RXFF0_WTPTR) << BIT_SHIFT_RXFF0_WTPTR) -+#define BITS_RXFF0_WTPTR (BIT_MASK_RXFF0_WTPTR << BIT_SHIFT_RXFF0_WTPTR) -+#define BIT_CLEAR_RXFF0_WTPTR(x) ((x) & (~BITS_RXFF0_WTPTR)) -+#define BIT_GET_RXFF0_WTPTR(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_WTPTR) & BIT_MASK_RXFF0_WTPTR) -+#define BIT_SET_RXFF0_WTPTR(x, v) \ -+ (BIT_CLEAR_RXFF0_WTPTR(x) | BIT_RXFF0_WTPTR(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_H2C_OK_INT_MSK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_SW_PLL_LEAVE_32K_INT_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_CPUMGQ_DROP_BY_HOLD_TIME_INT_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_H2C_CMD_FULL_INT_MSK BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_FWFF_FULL_INT_EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FWFF_FULL_INT_EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_PWR_INT_127_MSK_V1 BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_BB_STOP_RX_INT_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_BB_STOP_RX_INT_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_PWR_INT_126_MSK BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RXDMA2_DONE_INT_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_PWR_INT_125TO96_MSK BIT(27) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RXDONE3_INT_EN BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_PWR_INT_95TO64_MSK_V1 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RXDONE2_INT_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_PWR_INT_63TO32_MSK_V1 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RX_BCN_P4_INT_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_PWR_INT_31TO0_MSK_V1 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RX_BCN_P3_INT_EN BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_EN BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_BF0_TIMEOUT_INT_MSK BIT(21) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RX_BCN_P0_INT_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_BF1_TIMEOUT_INT_MSK BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RX_UMD0_INT_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_EVTQ_TXDONE_INT_MSK BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RX_UMD1_INT_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_EVTQ_START_INT_MSK BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RX_BMD0_INT_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_TXBCN2_OK_INT_MSK BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RX_BMD1_INT_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_TXBCN2_ERR_INT_MSK BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RXDONE_INT_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_DWWIN_END_INT_MSK BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_WWLAN_INT_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_BCN2_EARLY_INT_MSK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_SOUND_DONE_INT_EN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_TBTT1_INT_MSK BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_LP_STBY_INT_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_PSTIMERB_INT_MSK BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_TRL_MTR_INT_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_PSTIMERA_INT_MSK BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_BF1_PRETO_INT_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_P2P_RFOFF_EARLY_INT_MSK BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_BF0_PRETO_INT_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_MACID_RELEASE_INT_MSK BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_PTCL_RELEASE_MACID_INT_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_NANRPT_DONE_INT_MSK BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_PRETXERR_HANDLE_FSIMR BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_PRETX_ERRHLD_INT_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_PRETX_ERRHLD_INT_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_FTM_PTT_INT_MSK_V1 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_GTRD_INT_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_RXFTMREQ_OK_INT_MSK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_LTE_COEX_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_RXFTM_INT_MSK_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_WLACTOFF_INT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_TXFTM_INT_MSK_V1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_WLACTON_INT_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_LTECOEX_INT_MSK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_BTCMD_INT_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_REG_MAILBOX_TO_I2C_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_MAILBOX_INT_MSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_REG_MAILBOX_TO_I2C_INT_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_TRPC_TO_INT_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_FLC_DRUTO_INT_MSK BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_TRPC_TO_INT_EN_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_BIT_RPC_O_T_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEIMR (Offset 0x0120) */ -+ -+#define BIT_FLC_PKTTH_INT_MSK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1IMR (Offset 0x0120) */ -+ -+#define BIT_FS_RPC_O_T_INT_EN_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_H2C_OK_INT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_SW_PLL_LEAVE_32K_INT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_CPUMGQ_DROP_BY_HOLD_TIME_INT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_H2C_CMD_FULL_INT BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_FS_FWFF_FULL_INT BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FWFF_FULL_INT BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_PWR_INT_127_V2 BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_BB_STOP_RX_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_BB_STOP_RX_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_PWR_INT_126 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RXDMA2_DONE_INT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_PWR_INT_125TO96 BIT(27) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RXDONE3_INT BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RXDONE3_INT_INT BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_PWR_INT_95TO64_V1 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RXDONE2_INT BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_PWR_INT_63TO32_V1 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RX_BCN_P4_INT BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_PWR_INT_31TO0_V1 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RX_BCN_P3_INT BIT(24) -+#define BIT_FS_RX_BCN_P2_INT BIT(23) -+#define BIT_FS_RX_BCN_P1_INT BIT(22) -+#define BIT_FS_RX_BCN_P0_INT BIT(21) -+#define BIT_FS_RX_UMD0_INT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_EVTQ_TXDONE_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RX_UMD1_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_EVTQ_START_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RX_BMD0_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_TXBCN2_OK_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RX_BMD1_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_TXBCN2_ERR_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RXDONE_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_DWWIN_END_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_WWLAN_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_BCN2_EARLY_INT BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_SOUND_DONE_INT BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_TBTT1_INT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_LP_STBY_INT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_PSTIMERB_INT BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_TRL_MTR_INT BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_PSTIMERA_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_BF1_PRETO_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_P2P_RFOFF_EARLY_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_BF0_PRETO_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_MACID_RELEASE_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_PTCL_RELEASE_MACID_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_NANRPT_DONE_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_PRETXERR_HANDLE_FSISR BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_PRETX_ERRHLD_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_PRETX_ERRHLD_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_FTM_PTT_INT_V1 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_SND_RDY_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_RXFTMREQ_OK_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_LTE_COEX_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_RXFTM_INT_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_WLACTOFF_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_TXFTM_INT_V1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_WLACTON_INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_LTECOEX_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_BCN_RX_INT_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_BT_CMD_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_MAILBOX_TO_I2C BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_MAILBOX_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_MAILBOX_TO_I2C_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_TRPC_TO_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_FLC_DRUTO_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_TRPC_TO_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_RPC_O_T_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FEISR (Offset 0x0124) */ -+ -+#define BIT_FLC_PKTTH_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE1ISR (Offset 0x0124) */ -+ -+#define BIT_FS_RPC_O_T_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CPWM (Offset 0x012C) */ -+ -+#define BIT_CPWM_TOGGLING BIT(31) -+ -+#define BIT_SHIFT_CPWM_MOD 24 -+#define BIT_MASK_CPWM_MOD 0x7f -+#define BIT_CPWM_MOD(x) (((x) & BIT_MASK_CPWM_MOD) << BIT_SHIFT_CPWM_MOD) -+#define BITS_CPWM_MOD (BIT_MASK_CPWM_MOD << BIT_SHIFT_CPWM_MOD) -+#define BIT_CLEAR_CPWM_MOD(x) ((x) & (~BITS_CPWM_MOD)) -+#define BIT_GET_CPWM_MOD(x) (((x) >> BIT_SHIFT_CPWM_MOD) & BIT_MASK_CPWM_MOD) -+#define BIT_SET_CPWM_MOD(x, v) (BIT_CLEAR_CPWM_MOD(x) | BIT_CPWM_MOD(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_PCIE_BCNDMAERR_INT_MSK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNOK_MB7_INT_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_SOUND_DONE_MSK BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_SOUND_DONE_INT_MSK BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNOK_MB6_INT_EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TRY_DONE_MSK BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TRY_DONE_INT_MSK BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNOK_MB5_INT_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXRPT_CNT_FULL_MSK BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXRPT_CNT_FULL_INT_MSK BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNOK_MB4_INT_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_WLACTOFF_INT_EN BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_WLACTOFF_INT_MSK BIT(27) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNOK_MB3_INT_EN BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_WLACTON_INT_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_WLACTON_INT_MSK BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNOK_MB2_INT_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXPKTIN_INT_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXPKTIN_INT_MSK BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNOK_MB1_INT_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXBCNOK_MSK BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXBCNOK_INT_MSK BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNOK_MB0_INT_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXBCNERR_MSK BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXBCNERR_INT_MSK BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNERR_MB7_INT_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_RX_UMD0_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_RX_UMD0_INT_MSK BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNERR_MB6_INT_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_RX_UMD1_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_RX_UMD1_INT_MSK BIT(21) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNERR_MB5_INT_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_RX_BMD0_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_RX_BMD0_INT_MSK BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNERR_MB4_INT_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_RX_BMD1_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_RX_BMD1_INT_MSK BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNERR_MB3_INT_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCN_RX_INT_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCN_RX_INT_INT_MSK BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNERR_MB2_INT_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TBTTINT_MSK BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TBTTINT_INT_MSK BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNERR_MB1_INT_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNERLY_MSK BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNERLY_INT_MSK BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXBCNERR_MB0_INT_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA7_MSK BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA7_INT_MSK BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_CPUMGN_POLLED_PKT_DONE_INT_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_CPU_MGQ_TXDONE_INT_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA6_MSK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA6_INT_MSK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_SIFS_OVERSPEC_INT_EN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA5_MSK BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA5_INT_MSK BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA4_MSK BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA4_INT_MSK BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_MGNTQFF_TO_INT_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA3_MSK BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA3_INT_MSK BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_DDMA1_LP_INT_ENBIT_CPUMGN_POLLED_PKT_BUSY_ERR_INT_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_CPUMGQ_ERR_INT_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_DDMA1_LP_INT_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA2_MSK BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA2_INT_MSK BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_DDMA1_HP_INT_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA1_MSK BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA1_INT_MSK BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_DDMA0_LP_INT_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA0_MSK BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_BCNDMA0_INT_MSK BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_DDMA0_HP_INT_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_LP_STBY_MSK BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_LP_STBY_INT_MSK BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TRXRPT_INT_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_CTWENDINT_MSK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_CTWENDINT_INT_MSK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_C2H_W_READY_INT_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_HRCV_MSK BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_HRCV_INT_MSK BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_HRCV_INT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_H2CCMD_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_H2CCMD_INT_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_H2CCMD_INT_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_RXDONE_MSK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_RXDONE_INT_MSK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXPKTIN_INT_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_ERRORHDL_MSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_ERRORHDL_INT_MSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_ERRORHDL_INT_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXCCX_MSK_FW BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXCCX_INT_MSK BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXCCX_INT_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXCLOSE_MSK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_TXCLOSE_INT_MSK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWIMR (Offset 0x0130) */ -+ -+#define BIT_FS_TXCLOSE_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_PCIE_BCNDMAERR_INT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNOK_MB7_INT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_SOUND_DONE_INT BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNOK_MB6_INT BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_TRY_DONE_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNOK_MB5_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_TXRPT_CNT_FULL_INT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNOK_MB4_INT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_WLACTOFF_INT BIT(27) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNOK_MB3_INT BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_WLACTON_INT BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNOK_MB2_INT BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_TXPKTIN_INT BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNOK_MB1_INT BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_TXBCNOK_INT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNOK_MB0_INT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_TXBCNERR_INT BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNERR_MB7_INT BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_RX_UMD0_INT BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNERR_MB6_INT BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_RX_UMD1_INT BIT(21) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNERR_MB5_INT BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_RX_BMD0_INT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNERR_MB4_INT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_RX_BMD1_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNERR_MB3_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_BCN_RX_INT_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNERR_MB2_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_TBTTINT_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNERR_MB1_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_BCNERLY_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXBCNERR_MB0_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_BCNDMA7_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_CPUMGN_POLLED_PKT_DONE_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_CPU_MGQ_TXDONE_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_BCNDMA6_INT BIT(14) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_SIFS_OVERSPEC_INT BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_BCNDMA5_INT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_BCNDMA4_INT BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_MGNTQFF_TO_INT BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_BCNDMA3_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_DDMA1_LP_INTBIT_CPUMGN_POLLED_PKT_BUSY_ERR_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_CPUMGQ_ERR_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_DDMA1_LP_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_BCNDMA2_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_DDMA1_HP_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FWCMD_PKTIN_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_BCNDMA1_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_DDMA0_LP_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_BCNDMA0_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_DDMA0_HP_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_LP_STBY_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TRXRPT_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_CTWENDINT_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_C2H_W_READY_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_HRCV_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_HRCV_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_H2CCMD_INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_H2CCMD_INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_RXDONE_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXPKTIN_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_ERRORHDL_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_ERRORHDL_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_TXCCX_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXCCX_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_TXCLOSE_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWISR (Offset 0x0134) */ -+ -+#define BIT_FS_TXCLOSE_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_GTINT6_MSK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_GT6INT_MSK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TX_NULL1_INT_MSK BIT(30) -+#define BIT_TX_NULL0_INT_MSK BIT(29) -+#define BIT_MTI_BCNIVLEAR_INT_MSK BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_ATIMINT_MSK BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_ATIM_INT_MSK BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_WWLAN_INT_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_WWLAN_INT_MSK BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_C2H_W_READY_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_C2H_W_READY_MSK BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TRL_MTR_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TRL_MTR_INT_MSK BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_CLR_PS_STATUS_MSK BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_PS_TIMER_C_EARLY_INT_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_RETRIEVE_BUFFERED_MSK BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_RETRIEVE_BUFFERED_INT_MSK BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_PS_TIMER_B_EARLY_INT_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_RPWMINT2_MSK BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_RPWM2INT_MSK BIT(21) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_PS_TIMER_A_EARLY_INT_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TSF_BIT32_TOGGLE_MSK_V1 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TSF_BIT32_TOGGLE_INT_MSK BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TRIGGER_PKT_MSK BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_PS_TIMER_C_INT_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FW_BTCMD_INTMSK BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FW_BTCMD_INT_MSK BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_PS_TIMER_B_INT_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_P2P_RFOFF_INTMSK BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_P2P_RFOFF_INT_MSK BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_PS_TIMER_A_INT_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_P2P_RFON_INTMSK BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_P2P_RFON_INT_MSK BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_CPUMGQ_TX_TIMER_INT_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TXBCN1ERR_MSK BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TX_BCN1ERR_INT_MSK BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_PS_TIMEOUT2_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TXBCN1OK_MSK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TX_BCN1OK_INT_MSK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_PS_TIMEOUT1_EN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FT_ATIMEND_EMSK BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FT_ATIMEND_E_MSK BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_PS_TIMEOUT0_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_BCNDMAINT_EMSK BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_BCNDMAINT_E_MSK_V1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT12_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_GTINT5_MSK BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_GT5INT_MSK BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT11_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_EOSP_INT_MSK BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT10_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_RX_BCN_E_MSK BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_RX_BCN_E_INT_MSK BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT9_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_RPWM_INT_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_RPWMINT_MSK BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT8_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_PSTIMER_MSK BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_PSTIMER_INT_MSK BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT7_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TIMEOUT1_MSK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TIMEOUT1_INT_MSK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT6_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TIMEOUT0_MSK BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_TIMEOUT0_INT_MSK BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT5_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FT_GTINT4_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FT_GT4INT_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT4_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FT_GTINT3_MSK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FT_GT3INT_MSK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT3_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_GTINT2_MSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_GT2INT_MSK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT2_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_GTINT1_MSK BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_GT1INT_MSK BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT1_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_GTINT0_MSK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_GT0INT_MSK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTIMR (Offset 0x0138) */ -+ -+#define BIT_FS_GTINT0_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_GT6INT BIT(31) -+#define BIT_TX_NULL1_INT BIT(30) -+#define BIT_TX_NULL0_INT BIT(29) -+#define BIT_MTI_BCNIVLEAR_INT BIT(28) -+#define BIT_ATIM_INT BIT(27) -+#define BIT_WWLAN_INT BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_5_EARLY__INT BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_C2H_W_READY BIT(25) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_4_EARLY__INT BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_TRL_MTR_INT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_3_EARLY__INT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_CLR_PS_STATUS BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_C_EARLY__INT BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_2_EARLY__INT BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_RETRIEVE_BUFFERED_INT BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_B_EARLY__INT BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_1_EARLY__INT BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_RPWM2INT BIT(21) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_A_EARLY__INT BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_0_EARLY__INT BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_TSF_BIT32_TOGGLE_INT_V1 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_TRIGGER_PKT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_C_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_5_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FW_BTCMD_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_B_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_4_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_P2P_RFOFF_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_A_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_3_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_P2P_RFON_INT BIT(16) -+ -+#define BIT_SHIFT_LLTINI_PDATA 16 -+#define BIT_MASK_LLTINI_PDATA 0xff -+#define BIT_LLTINI_PDATA(x) \ -+ (((x) & BIT_MASK_LLTINI_PDATA) << BIT_SHIFT_LLTINI_PDATA) -+#define BITS_LLTINI_PDATA (BIT_MASK_LLTINI_PDATA << BIT_SHIFT_LLTINI_PDATA) -+#define BIT_CLEAR_LLTINI_PDATA(x) ((x) & (~BITS_LLTINI_PDATA)) -+#define BIT_GET_LLTINI_PDATA(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_PDATA) & BIT_MASK_LLTINI_PDATA) -+#define BIT_SET_LLTINI_PDATA(x, v) \ -+ (BIT_CLEAR_LLTINI_PDATA(x) | BIT_LLTINI_PDATA(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_CPUMGQ_TX_TIMER_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_TX_BCN1ERR_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_PS_TIMEOUT2_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_2_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_TX_BCN1OK_INT BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_PS_TIMEOUT1_INT BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_1_INT BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FT_ATIMEND_E BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_PS_TIMEOUT0_INT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PS_TIMER_0_INT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_BCNDMAINT_E_V1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT12_INT BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_GT5INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT11_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_EOSP_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT10_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_RX_BCN_E_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT9_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_RPWMINT BIT(8) -+ -+#define BIT_SHIFT_LLTINI_ADDR 8 -+#define BIT_MASK_LLTINI_ADDR 0xff -+#define BIT_LLTINI_ADDR(x) \ -+ (((x) & BIT_MASK_LLTINI_ADDR) << BIT_SHIFT_LLTINI_ADDR) -+#define BITS_LLTINI_ADDR (BIT_MASK_LLTINI_ADDR << BIT_SHIFT_LLTINI_ADDR) -+#define BIT_CLEAR_LLTINI_ADDR(x) ((x) & (~BITS_LLTINI_ADDR)) -+#define BIT_GET_LLTINI_ADDR(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_ADDR) & BIT_MASK_LLTINI_ADDR) -+#define BIT_SET_LLTINI_ADDR(x, v) \ -+ (BIT_CLEAR_LLTINI_ADDR(x) | BIT_LLTINI_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT8_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_PSTIMER_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT7_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_TIMEOUT1_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT6_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_TIMEOUT0_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT5_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FT_GT4INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT4_INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FT_GT3INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT3_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_GT2INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT2_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_GT1INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT1_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_GT0INT BIT(0) -+ -+#define BIT_SHIFT_LLTINI_HDATA 0 -+#define BIT_MASK_LLTINI_HDATA 0xff -+#define BIT_LLTINI_HDATA(x) \ -+ (((x) & BIT_MASK_LLTINI_HDATA) << BIT_SHIFT_LLTINI_HDATA) -+#define BITS_LLTINI_HDATA (BIT_MASK_LLTINI_HDATA << BIT_SHIFT_LLTINI_HDATA) -+#define BIT_CLEAR_LLTINI_HDATA(x) ((x) & (~BITS_LLTINI_HDATA)) -+#define BIT_GET_LLTINI_HDATA(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_HDATA) & BIT_MASK_LLTINI_HDATA) -+#define BIT_SET_LLTINI_HDATA(x, v) \ -+ (BIT_CLEAR_LLTINI_HDATA(x) | BIT_LLTINI_HDATA(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTISR (Offset 0x013C) */ -+ -+#define BIT_FS_GTINT0_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PKTBUF_DBG_CTRL (Offset 0x0140) */ -+ -+#define BIT_SHIFT_PKTBUF_WRITE_EN 24 -+#define BIT_MASK_PKTBUF_WRITE_EN 0xff -+#define BIT_PKTBUF_WRITE_EN(x) \ -+ (((x) & BIT_MASK_PKTBUF_WRITE_EN) << BIT_SHIFT_PKTBUF_WRITE_EN) -+#define BITS_PKTBUF_WRITE_EN \ -+ (BIT_MASK_PKTBUF_WRITE_EN << BIT_SHIFT_PKTBUF_WRITE_EN) -+#define BIT_CLEAR_PKTBUF_WRITE_EN(x) ((x) & (~BITS_PKTBUF_WRITE_EN)) -+#define BIT_GET_PKTBUF_WRITE_EN(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_WRITE_EN) & BIT_MASK_PKTBUF_WRITE_EN) -+#define BIT_SET_PKTBUF_WRITE_EN(x, v) \ -+ (BIT_CLEAR_PKTBUF_WRITE_EN(x) | BIT_PKTBUF_WRITE_EN(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PKTBUF_DBG_CTRL (Offset 0x0140) */ -+ -+#define BIT_TXPKT_BUF_READ_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PKTBUF_DBG_CTRL (Offset 0x0140) */ -+ -+#define BIT_TXPKTBUF_DBG BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PKTBUF_DBG_CTRL (Offset 0x0140) */ -+ -+#define BIT_TXRPTBUF_DBG BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PKTBUF_DBG_CTRL (Offset 0x0140) */ -+ -+#define BIT_TXRPT_BUF_READ_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PKTBUF_DBG_CTRL (Offset 0x0140) */ -+ -+#define BIT_TXRPTBUF_DBG_V2 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PKTBUF_DBG_CTRL (Offset 0x0140) */ -+ -+#define BIT_TXPKTBUF_DBG_V2 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PKTBUF_DBG_CTRL (Offset 0x0140) */ -+ -+#define BIT_RXPKT_BUF_READ_EN BIT(16) -+ -+#define BIT_SHIFT_PKTBUF_ADDR 0 -+#define BIT_MASK_PKTBUF_ADDR 0x1fff -+#define BIT_PKTBUF_ADDR(x) \ -+ (((x) & BIT_MASK_PKTBUF_ADDR) << BIT_SHIFT_PKTBUF_ADDR) -+#define BITS_PKTBUF_ADDR (BIT_MASK_PKTBUF_ADDR << BIT_SHIFT_PKTBUF_ADDR) -+#define BIT_CLEAR_PKTBUF_ADDR(x) ((x) & (~BITS_PKTBUF_ADDR)) -+#define BIT_GET_PKTBUF_ADDR(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_ADDR) & BIT_MASK_PKTBUF_ADDR) -+#define BIT_SET_PKTBUF_ADDR(x, v) \ -+ (BIT_CLEAR_PKTBUF_ADDR(x) | BIT_PKTBUF_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PKTBUF_DBG_DATA_L (Offset 0x0144) */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_L 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_L 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_L(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_L) << BIT_SHIFT_PKTBUF_DBG_DATA_L) -+#define BITS_PKTBUF_DBG_DATA_L \ -+ (BIT_MASK_PKTBUF_DBG_DATA_L << BIT_SHIFT_PKTBUF_DBG_DATA_L) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_L(x) ((x) & (~BITS_PKTBUF_DBG_DATA_L)) -+#define BIT_GET_PKTBUF_DBG_DATA_L(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_L) & BIT_MASK_PKTBUF_DBG_DATA_L) -+#define BIT_SET_PKTBUF_DBG_DATA_L(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_L(x) | BIT_PKTBUF_DBG_DATA_L(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_H (Offset 0x0148) */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_H 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_H 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_H(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_H) << BIT_SHIFT_PKTBUF_DBG_DATA_H) -+#define BITS_PKTBUF_DBG_DATA_H \ -+ (BIT_MASK_PKTBUF_DBG_DATA_H << BIT_SHIFT_PKTBUF_DBG_DATA_H) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_H(x) ((x) & (~BITS_PKTBUF_DBG_DATA_H)) -+#define BIT_GET_PKTBUF_DBG_DATA_H(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_H) & BIT_MASK_PKTBUF_DBG_DATA_H) -+#define BIT_SET_PKTBUF_DBG_DATA_H(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_H(x) | BIT_PKTBUF_DBG_DATA_H(v)) -+ -+/* 2 REG_CPWM2 (Offset 0x014C) */ -+ -+#define BIT_SHIFT_L0S_TO_RCVY_NUM 16 -+#define BIT_MASK_L0S_TO_RCVY_NUM 0xff -+#define BIT_L0S_TO_RCVY_NUM(x) \ -+ (((x) & BIT_MASK_L0S_TO_RCVY_NUM) << BIT_SHIFT_L0S_TO_RCVY_NUM) -+#define BITS_L0S_TO_RCVY_NUM \ -+ (BIT_MASK_L0S_TO_RCVY_NUM << BIT_SHIFT_L0S_TO_RCVY_NUM) -+#define BIT_CLEAR_L0S_TO_RCVY_NUM(x) ((x) & (~BITS_L0S_TO_RCVY_NUM)) -+#define BIT_GET_L0S_TO_RCVY_NUM(x) \ -+ (((x) >> BIT_SHIFT_L0S_TO_RCVY_NUM) & BIT_MASK_L0S_TO_RCVY_NUM) -+#define BIT_SET_L0S_TO_RCVY_NUM(x, v) \ -+ (BIT_CLEAR_L0S_TO_RCVY_NUM(x) | BIT_L0S_TO_RCVY_NUM(v)) -+ -+#define BIT_CPWM2_TOGGLING BIT(15) -+ -+#define BIT_SHIFT_CPWM2_MOD 0 -+#define BIT_MASK_CPWM2_MOD 0x7fff -+#define BIT_CPWM2_MOD(x) (((x) & BIT_MASK_CPWM2_MOD) << BIT_SHIFT_CPWM2_MOD) -+#define BITS_CPWM2_MOD (BIT_MASK_CPWM2_MOD << BIT_SHIFT_CPWM2_MOD) -+#define BIT_CLEAR_CPWM2_MOD(x) ((x) & (~BITS_CPWM2_MOD)) -+#define BIT_GET_CPWM2_MOD(x) (((x) >> BIT_SHIFT_CPWM2_MOD) & BIT_MASK_CPWM2_MOD) -+#define BIT_SET_CPWM2_MOD(x, v) (BIT_CLEAR_CPWM2_MOD(x) | BIT_CPWM2_MOD(v)) -+ -+/* 2 REG_TC0_CTRL (Offset 0x0150) */ -+ -+#define BIT_TC0INT_EN BIT(26) -+#define BIT_TC0MODE BIT(25) -+#define BIT_TC0EN BIT(24) -+ -+#define BIT_SHIFT_TC0DATA 0 -+#define BIT_MASK_TC0DATA 0xffffff -+#define BIT_TC0DATA(x) (((x) & BIT_MASK_TC0DATA) << BIT_SHIFT_TC0DATA) -+#define BITS_TC0DATA (BIT_MASK_TC0DATA << BIT_SHIFT_TC0DATA) -+#define BIT_CLEAR_TC0DATA(x) ((x) & (~BITS_TC0DATA)) -+#define BIT_GET_TC0DATA(x) (((x) >> BIT_SHIFT_TC0DATA) & BIT_MASK_TC0DATA) -+#define BIT_SET_TC0DATA(x, v) (BIT_CLEAR_TC0DATA(x) | BIT_TC0DATA(v)) -+ -+/* 2 REG_TC1_CTRL (Offset 0x0154) */ -+ -+#define BIT_TC1INT_EN BIT(26) -+#define BIT_TC1MODE BIT(25) -+#define BIT_TC1EN BIT(24) -+ -+#define BIT_SHIFT_TC1DATA 0 -+#define BIT_MASK_TC1DATA 0xffffff -+#define BIT_TC1DATA(x) (((x) & BIT_MASK_TC1DATA) << BIT_SHIFT_TC1DATA) -+#define BITS_TC1DATA (BIT_MASK_TC1DATA << BIT_SHIFT_TC1DATA) -+#define BIT_CLEAR_TC1DATA(x) ((x) & (~BITS_TC1DATA)) -+#define BIT_GET_TC1DATA(x) (((x) >> BIT_SHIFT_TC1DATA) & BIT_MASK_TC1DATA) -+#define BIT_SET_TC1DATA(x, v) (BIT_CLEAR_TC1DATA(x) | BIT_TC1DATA(v)) -+ -+/* 2 REG_TC2_CTRL (Offset 0x0158) */ -+ -+#define BIT_TC2INT_EN BIT(26) -+#define BIT_TC2MODE BIT(25) -+#define BIT_TC2EN BIT(24) -+ -+#define BIT_SHIFT_TC2DATA 0 -+#define BIT_MASK_TC2DATA 0xffffff -+#define BIT_TC2DATA(x) (((x) & BIT_MASK_TC2DATA) << BIT_SHIFT_TC2DATA) -+#define BITS_TC2DATA (BIT_MASK_TC2DATA << BIT_SHIFT_TC2DATA) -+#define BIT_CLEAR_TC2DATA(x) ((x) & (~BITS_TC2DATA)) -+#define BIT_GET_TC2DATA(x) (((x) >> BIT_SHIFT_TC2DATA) & BIT_MASK_TC2DATA) -+#define BIT_SET_TC2DATA(x, v) (BIT_CLEAR_TC2DATA(x) | BIT_TC2DATA(v)) -+ -+/* 2 REG_TC3_CTRL (Offset 0x015C) */ -+ -+#define BIT_TC3INT_EN BIT(26) -+#define BIT_TC3MODE BIT(25) -+#define BIT_TC3EN BIT(24) -+ -+#define BIT_SHIFT_TC3DATA 0 -+#define BIT_MASK_TC3DATA 0xffffff -+#define BIT_TC3DATA(x) (((x) & BIT_MASK_TC3DATA) << BIT_SHIFT_TC3DATA) -+#define BITS_TC3DATA (BIT_MASK_TC3DATA << BIT_SHIFT_TC3DATA) -+#define BIT_CLEAR_TC3DATA(x) ((x) & (~BITS_TC3DATA)) -+#define BIT_GET_TC3DATA(x) (((x) >> BIT_SHIFT_TC3DATA) & BIT_MASK_TC3DATA) -+#define BIT_SET_TC3DATA(x, v) (BIT_CLEAR_TC3DATA(x) | BIT_TC3DATA(v)) -+ -+/* 2 REG_TC4_CTRL (Offset 0x0160) */ -+ -+#define BIT_TC4INT_EN BIT(26) -+#define BIT_TC4MODE BIT(25) -+#define BIT_TC4EN BIT(24) -+ -+#define BIT_SHIFT_TC4DATA 0 -+#define BIT_MASK_TC4DATA 0xffffff -+#define BIT_TC4DATA(x) (((x) & BIT_MASK_TC4DATA) << BIT_SHIFT_TC4DATA) -+#define BITS_TC4DATA (BIT_MASK_TC4DATA << BIT_SHIFT_TC4DATA) -+#define BIT_CLEAR_TC4DATA(x) ((x) & (~BITS_TC4DATA)) -+#define BIT_GET_TC4DATA(x) (((x) >> BIT_SHIFT_TC4DATA) & BIT_MASK_TC4DATA) -+#define BIT_SET_TC4DATA(x, v) (BIT_CLEAR_TC4DATA(x) | BIT_TC4DATA(v)) -+ -+/* 2 REG_TCUNIT_BASE (Offset 0x0164) */ -+ -+#define BIT_SHIFT_TCUNIT_BASE 0 -+#define BIT_MASK_TCUNIT_BASE 0x3fff -+#define BIT_TCUNIT_BASE(x) \ -+ (((x) & BIT_MASK_TCUNIT_BASE) << BIT_SHIFT_TCUNIT_BASE) -+#define BITS_TCUNIT_BASE (BIT_MASK_TCUNIT_BASE << BIT_SHIFT_TCUNIT_BASE) -+#define BIT_CLEAR_TCUNIT_BASE(x) ((x) & (~BITS_TCUNIT_BASE)) -+#define BIT_GET_TCUNIT_BASE(x) \ -+ (((x) >> BIT_SHIFT_TCUNIT_BASE) & BIT_MASK_TCUNIT_BASE) -+#define BIT_SET_TCUNIT_BASE(x, v) \ -+ (BIT_CLEAR_TCUNIT_BASE(x) | BIT_TCUNIT_BASE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TC5_CTRL (Offset 0x0168) */ -+ -+#define BIT_TC50INT_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TC5_CTRL (Offset 0x0168) */ -+ -+#define BIT_TC5INT_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TC5_CTRL (Offset 0x0168) */ -+ -+#define BIT_TC5MODE BIT(25) -+#define BIT_TC5EN BIT(24) -+ -+#define BIT_SHIFT_TC5DATA 0 -+#define BIT_MASK_TC5DATA 0xffffff -+#define BIT_TC5DATA(x) (((x) & BIT_MASK_TC5DATA) << BIT_SHIFT_TC5DATA) -+#define BITS_TC5DATA (BIT_MASK_TC5DATA << BIT_SHIFT_TC5DATA) -+#define BIT_CLEAR_TC5DATA(x) ((x) & (~BITS_TC5DATA)) -+#define BIT_GET_TC5DATA(x) (((x) >> BIT_SHIFT_TC5DATA) & BIT_MASK_TC5DATA) -+#define BIT_SET_TC5DATA(x, v) (BIT_CLEAR_TC5DATA(x) | BIT_TC5DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TC6_CTRL (Offset 0x016C) */ -+ -+#define BIT_TC60INT_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TC6_CTRL (Offset 0x016C) */ -+ -+#define BIT_TC6INT_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TC6_CTRL (Offset 0x016C) */ -+ -+#define BIT_TC6MODE BIT(25) -+#define BIT_TC6EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TC6_CTRL (Offset 0x016C) */ -+ -+#define BIT_SHIFT_SEQNUM_MID 16 -+#define BIT_MASK_SEQNUM_MID 0xffff -+#define BIT_SEQNUM_MID(x) (((x) & BIT_MASK_SEQNUM_MID) << BIT_SHIFT_SEQNUM_MID) -+#define BITS_SEQNUM_MID (BIT_MASK_SEQNUM_MID << BIT_SHIFT_SEQNUM_MID) -+#define BIT_CLEAR_SEQNUM_MID(x) ((x) & (~BITS_SEQNUM_MID)) -+#define BIT_GET_SEQNUM_MID(x) \ -+ (((x) >> BIT_SHIFT_SEQNUM_MID) & BIT_MASK_SEQNUM_MID) -+#define BIT_SET_SEQNUM_MID(x, v) (BIT_CLEAR_SEQNUM_MID(x) | BIT_SEQNUM_MID(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TC6_CTRL (Offset 0x016C) */ -+ -+#define BIT_SHIFT_TC6DATA 0 -+#define BIT_MASK_TC6DATA 0xffffff -+#define BIT_TC6DATA(x) (((x) & BIT_MASK_TC6DATA) << BIT_SHIFT_TC6DATA) -+#define BITS_TC6DATA (BIT_MASK_TC6DATA << BIT_SHIFT_TC6DATA) -+#define BIT_CLEAR_TC6DATA(x) ((x) & (~BITS_TC6DATA)) -+#define BIT_GET_TC6DATA(x) (((x) >> BIT_SHIFT_TC6DATA) & BIT_MASK_TC6DATA) -+#define BIT_SET_TC6DATA(x, v) (BIT_CLEAR_TC6DATA(x) | BIT_TC6DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MBIST_DRF_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_WLON_MBIST_DRF_FAIL 30 -+#define BIT_MASK_WLON_MBIST_DRF_FAIL 0x3 -+#define BIT_WLON_MBIST_DRF_FAIL(x) \ -+ (((x) & BIT_MASK_WLON_MBIST_DRF_FAIL) << BIT_SHIFT_WLON_MBIST_DRF_FAIL) -+#define BITS_WLON_MBIST_DRF_FAIL \ -+ (BIT_MASK_WLON_MBIST_DRF_FAIL << BIT_SHIFT_WLON_MBIST_DRF_FAIL) -+#define BIT_CLEAR_WLON_MBIST_DRF_FAIL(x) ((x) & (~BITS_WLON_MBIST_DRF_FAIL)) -+#define BIT_GET_WLON_MBIST_DRF_FAIL(x) \ -+ (((x) >> BIT_SHIFT_WLON_MBIST_DRF_FAIL) & BIT_MASK_WLON_MBIST_DRF_FAIL) -+#define BIT_SET_WLON_MBIST_DRF_FAIL(x, v) \ -+ (BIT_CLEAR_WLON_MBIST_DRF_FAIL(x) | BIT_WLON_MBIST_DRF_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_8051_MBIST_FAIL 26 -+#define BIT_MASK_8051_MBIST_FAIL 0x7 -+#define BIT_8051_MBIST_FAIL(x) \ -+ (((x) & BIT_MASK_8051_MBIST_FAIL) << BIT_SHIFT_8051_MBIST_FAIL) -+#define BITS_8051_MBIST_FAIL \ -+ (BIT_MASK_8051_MBIST_FAIL << BIT_SHIFT_8051_MBIST_FAIL) -+#define BIT_CLEAR_8051_MBIST_FAIL(x) ((x) & (~BITS_8051_MBIST_FAIL)) -+#define BIT_GET_8051_MBIST_FAIL(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_FAIL) & BIT_MASK_8051_MBIST_FAIL) -+#define BIT_SET_8051_MBIST_FAIL(x, v) \ -+ (BIT_CLEAR_8051_MBIST_FAIL(x) | BIT_8051_MBIST_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIST_DRF_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_8051_MBIST_DRF_FAIL 26 -+#define BIT_MASK_8051_MBIST_DRF_FAIL 0x3f -+#define BIT_8051_MBIST_DRF_FAIL(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DRF_FAIL) << BIT_SHIFT_8051_MBIST_DRF_FAIL) -+#define BITS_8051_MBIST_DRF_FAIL \ -+ (BIT_MASK_8051_MBIST_DRF_FAIL << BIT_SHIFT_8051_MBIST_DRF_FAIL) -+#define BIT_CLEAR_8051_MBIST_DRF_FAIL(x) ((x) & (~BITS_8051_MBIST_DRF_FAIL)) -+#define BIT_GET_8051_MBIST_DRF_FAIL(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DRF_FAIL) & BIT_MASK_8051_MBIST_DRF_FAIL) -+#define BIT_SET_8051_MBIST_DRF_FAIL(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DRF_FAIL(x) | BIT_8051_MBIST_DRF_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_USB_MBIST_FAIL 24 -+#define BIT_MASK_USB_MBIST_FAIL 0x3 -+#define BIT_USB_MBIST_FAIL(x) \ -+ (((x) & BIT_MASK_USB_MBIST_FAIL) << BIT_SHIFT_USB_MBIST_FAIL) -+#define BITS_USB_MBIST_FAIL \ -+ (BIT_MASK_USB_MBIST_FAIL << BIT_SHIFT_USB_MBIST_FAIL) -+#define BIT_CLEAR_USB_MBIST_FAIL(x) ((x) & (~BITS_USB_MBIST_FAIL)) -+#define BIT_GET_USB_MBIST_FAIL(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_FAIL) & BIT_MASK_USB_MBIST_FAIL) -+#define BIT_SET_USB_MBIST_FAIL(x, v) \ -+ (BIT_CLEAR_USB_MBIST_FAIL(x) | BIT_USB_MBIST_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIST_DRF_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_USB_MBIST_DRF_FAIL 24 -+#define BIT_MASK_USB_MBIST_DRF_FAIL 0x3 -+#define BIT_USB_MBIST_DRF_FAIL(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DRF_FAIL) << BIT_SHIFT_USB_MBIST_DRF_FAIL) -+#define BITS_USB_MBIST_DRF_FAIL \ -+ (BIT_MASK_USB_MBIST_DRF_FAIL << BIT_SHIFT_USB_MBIST_DRF_FAIL) -+#define BIT_CLEAR_USB_MBIST_DRF_FAIL(x) ((x) & (~BITS_USB_MBIST_DRF_FAIL)) -+#define BIT_GET_USB_MBIST_DRF_FAIL(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DRF_FAIL) & BIT_MASK_USB_MBIST_DRF_FAIL) -+#define BIT_SET_USB_MBIST_DRF_FAIL(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DRF_FAIL(x) | BIT_USB_MBIST_DRF_FAIL(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DRF_FAIL 18 -+#define BIT_MASK_PCIE_MBIST_DRF_FAIL 0x3f -+#define BIT_PCIE_MBIST_DRF_FAIL(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DRF_FAIL) << BIT_SHIFT_PCIE_MBIST_DRF_FAIL) -+#define BITS_PCIE_MBIST_DRF_FAIL \ -+ (BIT_MASK_PCIE_MBIST_DRF_FAIL << BIT_SHIFT_PCIE_MBIST_DRF_FAIL) -+#define BIT_CLEAR_PCIE_MBIST_DRF_FAIL(x) ((x) & (~BITS_PCIE_MBIST_DRF_FAIL)) -+#define BIT_GET_PCIE_MBIST_DRF_FAIL(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DRF_FAIL) & BIT_MASK_PCIE_MBIST_DRF_FAIL) -+#define BIT_SET_PCIE_MBIST_DRF_FAIL(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DRF_FAIL(x) | BIT_PCIE_MBIST_DRF_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_PCIE_MBIST_FAIL 16 -+#define BIT_MASK_PCIE_MBIST_FAIL 0x3f -+#define BIT_PCIE_MBIST_FAIL(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_FAIL) << BIT_SHIFT_PCIE_MBIST_FAIL) -+#define BITS_PCIE_MBIST_FAIL \ -+ (BIT_MASK_PCIE_MBIST_FAIL << BIT_SHIFT_PCIE_MBIST_FAIL) -+#define BIT_CLEAR_PCIE_MBIST_FAIL(x) ((x) & (~BITS_PCIE_MBIST_FAIL)) -+#define BIT_GET_PCIE_MBIST_FAIL(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_FAIL) & BIT_MASK_PCIE_MBIST_FAIL) -+#define BIT_SET_PCIE_MBIST_FAIL(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_FAIL(x) | BIT_PCIE_MBIST_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MBIST_DRF_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_WLOFF_MBIST_DRF_FAIL 16 -+#define BIT_MASK_WLOFF_MBIST_DRF_FAIL 0x3fff -+#define BIT_WLOFF_MBIST_DRF_FAIL(x) \ -+ (((x) & BIT_MASK_WLOFF_MBIST_DRF_FAIL) \ -+ << BIT_SHIFT_WLOFF_MBIST_DRF_FAIL) -+#define BITS_WLOFF_MBIST_DRF_FAIL \ -+ (BIT_MASK_WLOFF_MBIST_DRF_FAIL << BIT_SHIFT_WLOFF_MBIST_DRF_FAIL) -+#define BIT_CLEAR_WLOFF_MBIST_DRF_FAIL(x) ((x) & (~BITS_WLOFF_MBIST_DRF_FAIL)) -+#define BIT_GET_WLOFF_MBIST_DRF_FAIL(x) \ -+ (((x) >> BIT_SHIFT_WLOFF_MBIST_DRF_FAIL) & \ -+ BIT_MASK_WLOFF_MBIST_DRF_FAIL) -+#define BIT_SET_WLOFF_MBIST_DRF_FAIL(x, v) \ -+ (BIT_CLEAR_WLOFF_MBIST_DRF_FAIL(x) | BIT_WLOFF_MBIST_DRF_FAIL(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DRF_FAIL_V1 11 -+#define BIT_MASK_PCIE_MBIST_DRF_FAIL_V1 0x1f -+#define BIT_PCIE_MBIST_DRF_FAIL_V1(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DRF_FAIL_V1) \ -+ << BIT_SHIFT_PCIE_MBIST_DRF_FAIL_V1) -+#define BITS_PCIE_MBIST_DRF_FAIL_V1 \ -+ (BIT_MASK_PCIE_MBIST_DRF_FAIL_V1 << BIT_SHIFT_PCIE_MBIST_DRF_FAIL_V1) -+#define BIT_CLEAR_PCIE_MBIST_DRF_FAIL_V1(x) \ -+ ((x) & (~BITS_PCIE_MBIST_DRF_FAIL_V1)) -+#define BIT_GET_PCIE_MBIST_DRF_FAIL_V1(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DRF_FAIL_V1) & \ -+ BIT_MASK_PCIE_MBIST_DRF_FAIL_V1) -+#define BIT_SET_PCIE_MBIST_DRF_FAIL_V1(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DRF_FAIL_V1(x) | BIT_PCIE_MBIST_DRF_FAIL_V1(v)) -+ -+#define BIT_SHIFT_USB_MBIST_DRF_FAIL_V1 4 -+#define BIT_MASK_USB_MBIST_DRF_FAIL_V1 0x7f -+#define BIT_USB_MBIST_DRF_FAIL_V1(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DRF_FAIL_V1) \ -+ << BIT_SHIFT_USB_MBIST_DRF_FAIL_V1) -+#define BITS_USB_MBIST_DRF_FAIL_V1 \ -+ (BIT_MASK_USB_MBIST_DRF_FAIL_V1 << BIT_SHIFT_USB_MBIST_DRF_FAIL_V1) -+#define BIT_CLEAR_USB_MBIST_DRF_FAIL_V1(x) ((x) & (~BITS_USB_MBIST_DRF_FAIL_V1)) -+#define BIT_GET_USB_MBIST_DRF_FAIL_V1(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DRF_FAIL_V1) & \ -+ BIT_MASK_USB_MBIST_DRF_FAIL_V1) -+#define BIT_SET_USB_MBIST_DRF_FAIL_V1(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DRF_FAIL_V1(x) | BIT_USB_MBIST_DRF_FAIL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_MAC_MBIST_FAIL 0 -+#define BIT_MASK_MAC_MBIST_FAIL 0xfff -+#define BIT_MAC_MBIST_FAIL(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_FAIL) << BIT_SHIFT_MAC_MBIST_FAIL) -+#define BITS_MAC_MBIST_FAIL \ -+ (BIT_MASK_MAC_MBIST_FAIL << BIT_SHIFT_MAC_MBIST_FAIL) -+#define BIT_CLEAR_MAC_MBIST_FAIL(x) ((x) & (~BITS_MAC_MBIST_FAIL)) -+#define BIT_GET_MAC_MBIST_FAIL(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_FAIL) & BIT_MASK_MAC_MBIST_FAIL) -+#define BIT_SET_MAC_MBIST_FAIL(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_FAIL(x) | BIT_MAC_MBIST_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MBIST_DRF_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_USB_WLON_MBIST_DRF_FAIL 0 -+#define BIT_MASK_USB_WLON_MBIST_DRF_FAIL 0xf -+#define BIT_USB_WLON_MBIST_DRF_FAIL(x) \ -+ (((x) & BIT_MASK_USB_WLON_MBIST_DRF_FAIL) \ -+ << BIT_SHIFT_USB_WLON_MBIST_DRF_FAIL) -+#define BITS_USB_WLON_MBIST_DRF_FAIL \ -+ (BIT_MASK_USB_WLON_MBIST_DRF_FAIL << BIT_SHIFT_USB_WLON_MBIST_DRF_FAIL) -+#define BIT_CLEAR_USB_WLON_MBIST_DRF_FAIL(x) \ -+ ((x) & (~BITS_USB_WLON_MBIST_DRF_FAIL)) -+#define BIT_GET_USB_WLON_MBIST_DRF_FAIL(x) \ -+ (((x) >> BIT_SHIFT_USB_WLON_MBIST_DRF_FAIL) & \ -+ BIT_MASK_USB_WLON_MBIST_DRF_FAIL) -+#define BIT_SET_USB_WLON_MBIST_DRF_FAIL(x, v) \ -+ (BIT_CLEAR_USB_WLON_MBIST_DRF_FAIL(x) | BIT_USB_WLON_MBIST_DRF_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MBIST_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_MAC_MBIST_FAIL_DRF 0 -+#define BIT_MASK_MAC_MBIST_FAIL_DRF 0x3ffff -+#define BIT_MAC_MBIST_FAIL_DRF(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_FAIL_DRF) << BIT_SHIFT_MAC_MBIST_FAIL_DRF) -+#define BITS_MAC_MBIST_FAIL_DRF \ -+ (BIT_MASK_MAC_MBIST_FAIL_DRF << BIT_SHIFT_MAC_MBIST_FAIL_DRF) -+#define BIT_CLEAR_MAC_MBIST_FAIL_DRF(x) ((x) & (~BITS_MAC_MBIST_FAIL_DRF)) -+#define BIT_GET_MAC_MBIST_FAIL_DRF(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_FAIL_DRF) & BIT_MASK_MAC_MBIST_FAIL_DRF) -+#define BIT_SET_MAC_MBIST_FAIL_DRF(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_FAIL_DRF(x) | BIT_MAC_MBIST_FAIL_DRF(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_MBIST_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_MAC_MBIST_FAIL_DRF_V1 0 -+#define BIT_MASK_MAC_MBIST_FAIL_DRF_V1 0x7ffff -+#define BIT_MAC_MBIST_FAIL_DRF_V1(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_FAIL_DRF_V1) \ -+ << BIT_SHIFT_MAC_MBIST_FAIL_DRF_V1) -+#define BITS_MAC_MBIST_FAIL_DRF_V1 \ -+ (BIT_MASK_MAC_MBIST_FAIL_DRF_V1 << BIT_SHIFT_MAC_MBIST_FAIL_DRF_V1) -+#define BIT_CLEAR_MAC_MBIST_FAIL_DRF_V1(x) ((x) & (~BITS_MAC_MBIST_FAIL_DRF_V1)) -+#define BIT_GET_MAC_MBIST_FAIL_DRF_V1(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_FAIL_DRF_V1) & \ -+ BIT_MASK_MAC_MBIST_FAIL_DRF_V1) -+#define BIT_SET_MAC_MBIST_FAIL_DRF_V1(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_FAIL_DRF_V1(x) | BIT_MAC_MBIST_FAIL_DRF_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIST_DRF_FAIL (Offset 0x0170) */ -+ -+#define BIT_SHIFT_MAC_MBIST_DRF_FAIL 0 -+#define BIT_MASK_MAC_MBIST_DRF_FAIL 0x3ffff -+#define BIT_MAC_MBIST_DRF_FAIL(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DRF_FAIL) << BIT_SHIFT_MAC_MBIST_DRF_FAIL) -+#define BITS_MAC_MBIST_DRF_FAIL \ -+ (BIT_MASK_MAC_MBIST_DRF_FAIL << BIT_SHIFT_MAC_MBIST_DRF_FAIL) -+#define BIT_CLEAR_MAC_MBIST_DRF_FAIL(x) ((x) & (~BITS_MAC_MBIST_DRF_FAIL)) -+#define BIT_GET_MAC_MBIST_DRF_FAIL(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DRF_FAIL) & BIT_MASK_MAC_MBIST_DRF_FAIL) -+#define BIT_SET_MAC_MBIST_DRF_FAIL(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DRF_FAIL(x) | BIT_MAC_MBIST_DRF_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_START_PAUSE (Offset 0x0174) */ -+ -+#define BIT_SHIFT_8051_MBIST_START_PAUSE 26 -+#define BIT_MASK_8051_MBIST_START_PAUSE 0x7 -+#define BIT_8051_MBIST_START_PAUSE(x) \ -+ (((x) & BIT_MASK_8051_MBIST_START_PAUSE) \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE) -+#define BITS_8051_MBIST_START_PAUSE \ -+ (BIT_MASK_8051_MBIST_START_PAUSE << BIT_SHIFT_8051_MBIST_START_PAUSE) -+#define BIT_CLEAR_8051_MBIST_START_PAUSE(x) \ -+ ((x) & (~BITS_8051_MBIST_START_PAUSE)) -+#define BIT_GET_8051_MBIST_START_PAUSE(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_START_PAUSE) & \ -+ BIT_MASK_8051_MBIST_START_PAUSE) -+#define BIT_SET_8051_MBIST_START_PAUSE(x, v) \ -+ (BIT_CLEAR_8051_MBIST_START_PAUSE(x) | BIT_8051_MBIST_START_PAUSE(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIST_START_PAUSE (Offset 0x0174) */ -+ -+#define BIT_SHIFT_8051_MBIST_START_PAUSE_V1 26 -+#define BIT_MASK_8051_MBIST_START_PAUSE_V1 0x3f -+#define BIT_8051_MBIST_START_PAUSE_V1(x) \ -+ (((x) & BIT_MASK_8051_MBIST_START_PAUSE_V1) \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_V1) -+#define BITS_8051_MBIST_START_PAUSE_V1 \ -+ (BIT_MASK_8051_MBIST_START_PAUSE_V1 \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_V1) -+#define BIT_CLEAR_8051_MBIST_START_PAUSE_V1(x) \ -+ ((x) & (~BITS_8051_MBIST_START_PAUSE_V1)) -+#define BIT_GET_8051_MBIST_START_PAUSE_V1(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_START_PAUSE_V1) & \ -+ BIT_MASK_8051_MBIST_START_PAUSE_V1) -+#define BIT_SET_8051_MBIST_START_PAUSE_V1(x, v) \ -+ (BIT_CLEAR_8051_MBIST_START_PAUSE_V1(x) | \ -+ BIT_8051_MBIST_START_PAUSE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_START_PAUSE (Offset 0x0174) */ -+ -+#define BIT_SHIFT_USB_MBIST_START_PAUSE 24 -+#define BIT_MASK_USB_MBIST_START_PAUSE 0x3 -+#define BIT_USB_MBIST_START_PAUSE(x) \ -+ (((x) & BIT_MASK_USB_MBIST_START_PAUSE) \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE) -+#define BITS_USB_MBIST_START_PAUSE \ -+ (BIT_MASK_USB_MBIST_START_PAUSE << BIT_SHIFT_USB_MBIST_START_PAUSE) -+#define BIT_CLEAR_USB_MBIST_START_PAUSE(x) ((x) & (~BITS_USB_MBIST_START_PAUSE)) -+#define BIT_GET_USB_MBIST_START_PAUSE(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_START_PAUSE) & \ -+ BIT_MASK_USB_MBIST_START_PAUSE) -+#define BIT_SET_USB_MBIST_START_PAUSE(x, v) \ -+ (BIT_CLEAR_USB_MBIST_START_PAUSE(x) | BIT_USB_MBIST_START_PAUSE(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIST_START_PAUSE (Offset 0x0174) */ -+ -+#define BIT_SHIFT_USB_MBIST_START_PAUSE_V1 24 -+#define BIT_MASK_USB_MBIST_START_PAUSE_V1 0x3 -+#define BIT_USB_MBIST_START_PAUSE_V1(x) \ -+ (((x) & BIT_MASK_USB_MBIST_START_PAUSE_V1) \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_V1) -+#define BITS_USB_MBIST_START_PAUSE_V1 \ -+ (BIT_MASK_USB_MBIST_START_PAUSE_V1 \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_V1) -+#define BIT_CLEAR_USB_MBIST_START_PAUSE_V1(x) \ -+ ((x) & (~BITS_USB_MBIST_START_PAUSE_V1)) -+#define BIT_GET_USB_MBIST_START_PAUSE_V1(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_START_PAUSE_V1) & \ -+ BIT_MASK_USB_MBIST_START_PAUSE_V1) -+#define BIT_SET_USB_MBIST_START_PAUSE_V1(x, v) \ -+ (BIT_CLEAR_USB_MBIST_START_PAUSE_V1(x) | \ -+ BIT_USB_MBIST_START_PAUSE_V1(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1 18 -+#define BIT_MASK_PCIE_MBIST_START_PAUSE_V1 0x3f -+#define BIT_PCIE_MBIST_START_PAUSE_V1(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_START_PAUSE_V1) \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1) -+#define BITS_PCIE_MBIST_START_PAUSE_V1 \ -+ (BIT_MASK_PCIE_MBIST_START_PAUSE_V1 \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1) -+#define BIT_CLEAR_PCIE_MBIST_START_PAUSE_V1(x) \ -+ ((x) & (~BITS_PCIE_MBIST_START_PAUSE_V1)) -+#define BIT_GET_PCIE_MBIST_START_PAUSE_V1(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1) & \ -+ BIT_MASK_PCIE_MBIST_START_PAUSE_V1) -+#define BIT_SET_PCIE_MBIST_START_PAUSE_V1(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_START_PAUSE_V1(x) | \ -+ BIT_PCIE_MBIST_START_PAUSE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_START_PAUSE (Offset 0x0174) */ -+ -+#define BIT_SHIFT_PCIE_MBIST_START_PAUSE 16 -+#define BIT_MASK_PCIE_MBIST_START_PAUSE 0x3f -+#define BIT_PCIE_MBIST_START_PAUSE(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_START_PAUSE) \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE) -+#define BITS_PCIE_MBIST_START_PAUSE \ -+ (BIT_MASK_PCIE_MBIST_START_PAUSE << BIT_SHIFT_PCIE_MBIST_START_PAUSE) -+#define BIT_CLEAR_PCIE_MBIST_START_PAUSE(x) \ -+ ((x) & (~BITS_PCIE_MBIST_START_PAUSE)) -+#define BIT_GET_PCIE_MBIST_START_PAUSE(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_START_PAUSE) & \ -+ BIT_MASK_PCIE_MBIST_START_PAUSE) -+#define BIT_SET_PCIE_MBIST_START_PAUSE(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_START_PAUSE(x) | BIT_PCIE_MBIST_START_PAUSE(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MBIST_START_PAUSE (Offset 0x0174) */ -+ -+#define BIT_SHIFT_WLON_MBIST_START_PAUSE_V1 9 -+#define BIT_MASK_WLON_MBIST_START_PAUSE_V1 0x3 -+#define BIT_WLON_MBIST_START_PAUSE_V1(x) \ -+ (((x) & BIT_MASK_WLON_MBIST_START_PAUSE_V1) \ -+ << BIT_SHIFT_WLON_MBIST_START_PAUSE_V1) -+#define BITS_WLON_MBIST_START_PAUSE_V1 \ -+ (BIT_MASK_WLON_MBIST_START_PAUSE_V1 \ -+ << BIT_SHIFT_WLON_MBIST_START_PAUSE_V1) -+#define BIT_CLEAR_WLON_MBIST_START_PAUSE_V1(x) \ -+ ((x) & (~BITS_WLON_MBIST_START_PAUSE_V1)) -+#define BIT_GET_WLON_MBIST_START_PAUSE_V1(x) \ -+ (((x) >> BIT_SHIFT_WLON_MBIST_START_PAUSE_V1) & \ -+ BIT_MASK_WLON_MBIST_START_PAUSE_V1) -+#define BIT_SET_WLON_MBIST_START_PAUSE_V1(x, v) \ -+ (BIT_CLEAR_WLON_MBIST_START_PAUSE_V1(x) | \ -+ BIT_WLON_MBIST_START_PAUSE_V1(v)) -+ -+#define BIT_SHIFT_WLOFF_MBIST_START_PAUSE_V1 4 -+#define BIT_MASK_WLOFF_MBIST_START_PAUSE_V1 0x1f -+#define BIT_WLOFF_MBIST_START_PAUSE_V1(x) \ -+ (((x) & BIT_MASK_WLOFF_MBIST_START_PAUSE_V1) \ -+ << BIT_SHIFT_WLOFF_MBIST_START_PAUSE_V1) -+#define BITS_WLOFF_MBIST_START_PAUSE_V1 \ -+ (BIT_MASK_WLOFF_MBIST_START_PAUSE_V1 \ -+ << BIT_SHIFT_WLOFF_MBIST_START_PAUSE_V1) -+#define BIT_CLEAR_WLOFF_MBIST_START_PAUSE_V1(x) \ -+ ((x) & (~BITS_WLOFF_MBIST_START_PAUSE_V1)) -+#define BIT_GET_WLOFF_MBIST_START_PAUSE_V1(x) \ -+ (((x) >> BIT_SHIFT_WLOFF_MBIST_START_PAUSE_V1) & \ -+ BIT_MASK_WLOFF_MBIST_START_PAUSE_V1) -+#define BIT_SET_WLOFF_MBIST_START_PAUSE_V1(x, v) \ -+ (BIT_CLEAR_WLOFF_MBIST_START_PAUSE_V1(x) | \ -+ BIT_WLOFF_MBIST_START_PAUSE_V1(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_START_PAUSE_V2 2 -+#define BIT_MASK_PCIE_MBIST_START_PAUSE_V2 0x3 -+#define BIT_PCIE_MBIST_START_PAUSE_V2(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_START_PAUSE_V2) \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_V2) -+#define BITS_PCIE_MBIST_START_PAUSE_V2 \ -+ (BIT_MASK_PCIE_MBIST_START_PAUSE_V2 \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_V2) -+#define BIT_CLEAR_PCIE_MBIST_START_PAUSE_V2(x) \ -+ ((x) & (~BITS_PCIE_MBIST_START_PAUSE_V2)) -+#define BIT_GET_PCIE_MBIST_START_PAUSE_V2(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_START_PAUSE_V2) & \ -+ BIT_MASK_PCIE_MBIST_START_PAUSE_V2) -+#define BIT_SET_PCIE_MBIST_START_PAUSE_V2(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_START_PAUSE_V2(x) | \ -+ BIT_PCIE_MBIST_START_PAUSE_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_START_PAUSE (Offset 0x0174) */ -+ -+#define BIT_SHIFT_MAC_MBIST_START_PAUSE 0 -+#define BIT_MASK_MAC_MBIST_START_PAUSE 0xfff -+#define BIT_MAC_MBIST_START_PAUSE(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_START_PAUSE) \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE) -+#define BITS_MAC_MBIST_START_PAUSE \ -+ (BIT_MASK_MAC_MBIST_START_PAUSE << BIT_SHIFT_MAC_MBIST_START_PAUSE) -+#define BIT_CLEAR_MAC_MBIST_START_PAUSE(x) ((x) & (~BITS_MAC_MBIST_START_PAUSE)) -+#define BIT_GET_MAC_MBIST_START_PAUSE(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_START_PAUSE) & \ -+ BIT_MASK_MAC_MBIST_START_PAUSE) -+#define BIT_SET_MAC_MBIST_START_PAUSE(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_START_PAUSE(x) | BIT_MAC_MBIST_START_PAUSE(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MBIST_START_PAUSE (Offset 0x0174) */ -+ -+#define BIT_SHIFT_USB_MBIST_START_PAUSE_V2 0 -+#define BIT_MASK_USB_MBIST_START_PAUSE_V2 0x3 -+#define BIT_USB_MBIST_START_PAUSE_V2(x) \ -+ (((x) & BIT_MASK_USB_MBIST_START_PAUSE_V2) \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_V2) -+#define BITS_USB_MBIST_START_PAUSE_V2 \ -+ (BIT_MASK_USB_MBIST_START_PAUSE_V2 \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_V2) -+#define BIT_CLEAR_USB_MBIST_START_PAUSE_V2(x) \ -+ ((x) & (~BITS_USB_MBIST_START_PAUSE_V2)) -+#define BIT_GET_USB_MBIST_START_PAUSE_V2(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_START_PAUSE_V2) & \ -+ BIT_MASK_USB_MBIST_START_PAUSE_V2) -+#define BIT_SET_USB_MBIST_START_PAUSE_V2(x, v) \ -+ (BIT_CLEAR_USB_MBIST_START_PAUSE_V2(x) | \ -+ BIT_USB_MBIST_START_PAUSE_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIST_START_PAUSE (Offset 0x0174) */ -+ -+#define BIT_SHIFT_MAC_MBIST_START_PAUSE_V1 0 -+#define BIT_MASK_MAC_MBIST_START_PAUSE_V1 0x3ffff -+#define BIT_MAC_MBIST_START_PAUSE_V1(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_START_PAUSE_V1) \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V1) -+#define BITS_MAC_MBIST_START_PAUSE_V1 \ -+ (BIT_MASK_MAC_MBIST_START_PAUSE_V1 \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V1) -+#define BIT_CLEAR_MAC_MBIST_START_PAUSE_V1(x) \ -+ ((x) & (~BITS_MAC_MBIST_START_PAUSE_V1)) -+#define BIT_GET_MAC_MBIST_START_PAUSE_V1(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_START_PAUSE_V1) & \ -+ BIT_MASK_MAC_MBIST_START_PAUSE_V1) -+#define BIT_SET_MAC_MBIST_START_PAUSE_V1(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_START_PAUSE_V1(x) | \ -+ BIT_MAC_MBIST_START_PAUSE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_MBIST_START_PAUSE (Offset 0x0174) */ -+ -+#define BIT_SHIFT_MAC_MBIST_START_PAUSE_V2 0 -+#define BIT_MASK_MAC_MBIST_START_PAUSE_V2 0x1ff -+#define BIT_MAC_MBIST_START_PAUSE_V2(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_START_PAUSE_V2) \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V2) -+#define BITS_MAC_MBIST_START_PAUSE_V2 \ -+ (BIT_MASK_MAC_MBIST_START_PAUSE_V2 \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V2) -+#define BIT_CLEAR_MAC_MBIST_START_PAUSE_V2(x) \ -+ ((x) & (~BITS_MAC_MBIST_START_PAUSE_V2)) -+#define BIT_GET_MAC_MBIST_START_PAUSE_V2(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_START_PAUSE_V2) & \ -+ BIT_MASK_MAC_MBIST_START_PAUSE_V2) -+#define BIT_SET_MAC_MBIST_START_PAUSE_V2(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_START_PAUSE_V2(x) | \ -+ BIT_MAC_MBIST_START_PAUSE_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_DONE (Offset 0x0178) */ -+ -+#define BIT_SHIFT_8051_MBIST_DONE 26 -+#define BIT_MASK_8051_MBIST_DONE 0x7 -+#define BIT_8051_MBIST_DONE(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DONE) << BIT_SHIFT_8051_MBIST_DONE) -+#define BITS_8051_MBIST_DONE \ -+ (BIT_MASK_8051_MBIST_DONE << BIT_SHIFT_8051_MBIST_DONE) -+#define BIT_CLEAR_8051_MBIST_DONE(x) ((x) & (~BITS_8051_MBIST_DONE)) -+#define BIT_GET_8051_MBIST_DONE(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DONE) & BIT_MASK_8051_MBIST_DONE) -+#define BIT_SET_8051_MBIST_DONE(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DONE(x) | BIT_8051_MBIST_DONE(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIST_DONE (Offset 0x0178) */ -+ -+#define BIT_SHIFT_8051_MBIST_DONE_V1 26 -+#define BIT_MASK_8051_MBIST_DONE_V1 0x3f -+#define BIT_8051_MBIST_DONE_V1(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DONE_V1) << BIT_SHIFT_8051_MBIST_DONE_V1) -+#define BITS_8051_MBIST_DONE_V1 \ -+ (BIT_MASK_8051_MBIST_DONE_V1 << BIT_SHIFT_8051_MBIST_DONE_V1) -+#define BIT_CLEAR_8051_MBIST_DONE_V1(x) ((x) & (~BITS_8051_MBIST_DONE_V1)) -+#define BIT_GET_8051_MBIST_DONE_V1(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DONE_V1) & BIT_MASK_8051_MBIST_DONE_V1) -+#define BIT_SET_8051_MBIST_DONE_V1(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DONE_V1(x) | BIT_8051_MBIST_DONE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_DONE (Offset 0x0178) */ -+ -+#define BIT_SHIFT_USB_MBIST_DONE 24 -+#define BIT_MASK_USB_MBIST_DONE 0x3 -+#define BIT_USB_MBIST_DONE(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DONE) << BIT_SHIFT_USB_MBIST_DONE) -+#define BITS_USB_MBIST_DONE \ -+ (BIT_MASK_USB_MBIST_DONE << BIT_SHIFT_USB_MBIST_DONE) -+#define BIT_CLEAR_USB_MBIST_DONE(x) ((x) & (~BITS_USB_MBIST_DONE)) -+#define BIT_GET_USB_MBIST_DONE(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DONE) & BIT_MASK_USB_MBIST_DONE) -+#define BIT_SET_USB_MBIST_DONE(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DONE(x) | BIT_USB_MBIST_DONE(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIST_DONE (Offset 0x0178) */ -+ -+#define BIT_SHIFT_USB_MBIST_DONE_V1 24 -+#define BIT_MASK_USB_MBIST_DONE_V1 0x3 -+#define BIT_USB_MBIST_DONE_V1(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DONE_V1) << BIT_SHIFT_USB_MBIST_DONE_V1) -+#define BITS_USB_MBIST_DONE_V1 \ -+ (BIT_MASK_USB_MBIST_DONE_V1 << BIT_SHIFT_USB_MBIST_DONE_V1) -+#define BIT_CLEAR_USB_MBIST_DONE_V1(x) ((x) & (~BITS_USB_MBIST_DONE_V1)) -+#define BIT_GET_USB_MBIST_DONE_V1(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DONE_V1) & BIT_MASK_USB_MBIST_DONE_V1) -+#define BIT_SET_USB_MBIST_DONE_V1(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DONE_V1(x) | BIT_USB_MBIST_DONE_V1(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DONE_V1 18 -+#define BIT_MASK_PCIE_MBIST_DONE_V1 0x3f -+#define BIT_PCIE_MBIST_DONE_V1(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DONE_V1) << BIT_SHIFT_PCIE_MBIST_DONE_V1) -+#define BITS_PCIE_MBIST_DONE_V1 \ -+ (BIT_MASK_PCIE_MBIST_DONE_V1 << BIT_SHIFT_PCIE_MBIST_DONE_V1) -+#define BIT_CLEAR_PCIE_MBIST_DONE_V1(x) ((x) & (~BITS_PCIE_MBIST_DONE_V1)) -+#define BIT_GET_PCIE_MBIST_DONE_V1(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DONE_V1) & BIT_MASK_PCIE_MBIST_DONE_V1) -+#define BIT_SET_PCIE_MBIST_DONE_V1(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DONE_V1(x) | BIT_PCIE_MBIST_DONE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_DONE (Offset 0x0178) */ -+ -+#define BIT_SHIFT_PCIE_MBIST_DONE 16 -+#define BIT_MASK_PCIE_MBIST_DONE 0x3f -+#define BIT_PCIE_MBIST_DONE(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DONE) << BIT_SHIFT_PCIE_MBIST_DONE) -+#define BITS_PCIE_MBIST_DONE \ -+ (BIT_MASK_PCIE_MBIST_DONE << BIT_SHIFT_PCIE_MBIST_DONE) -+#define BIT_CLEAR_PCIE_MBIST_DONE(x) ((x) & (~BITS_PCIE_MBIST_DONE)) -+#define BIT_GET_PCIE_MBIST_DONE(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DONE) & BIT_MASK_PCIE_MBIST_DONE) -+#define BIT_SET_PCIE_MBIST_DONE(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DONE(x) | BIT_PCIE_MBIST_DONE(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MBIST_DONE (Offset 0x0178) */ -+ -+#define BIT_SHIFT_WLON_MBIST_DONE_V1 9 -+#define BIT_MASK_WLON_MBIST_DONE_V1 0x3 -+#define BIT_WLON_MBIST_DONE_V1(x) \ -+ (((x) & BIT_MASK_WLON_MBIST_DONE_V1) << BIT_SHIFT_WLON_MBIST_DONE_V1) -+#define BITS_WLON_MBIST_DONE_V1 \ -+ (BIT_MASK_WLON_MBIST_DONE_V1 << BIT_SHIFT_WLON_MBIST_DONE_V1) -+#define BIT_CLEAR_WLON_MBIST_DONE_V1(x) ((x) & (~BITS_WLON_MBIST_DONE_V1)) -+#define BIT_GET_WLON_MBIST_DONE_V1(x) \ -+ (((x) >> BIT_SHIFT_WLON_MBIST_DONE_V1) & BIT_MASK_WLON_MBIST_DONE_V1) -+#define BIT_SET_WLON_MBIST_DONE_V1(x, v) \ -+ (BIT_CLEAR_WLON_MBIST_DONE_V1(x) | BIT_WLON_MBIST_DONE_V1(v)) -+ -+#define BIT_SHIFT_WLOFF_MBIST_DONE_V1 4 -+#define BIT_MASK_WLOFF_MBIST_DONE_V1 0x1f -+#define BIT_WLOFF_MBIST_DONE_V1(x) \ -+ (((x) & BIT_MASK_WLOFF_MBIST_DONE_V1) << BIT_SHIFT_WLOFF_MBIST_DONE_V1) -+#define BITS_WLOFF_MBIST_DONE_V1 \ -+ (BIT_MASK_WLOFF_MBIST_DONE_V1 << BIT_SHIFT_WLOFF_MBIST_DONE_V1) -+#define BIT_CLEAR_WLOFF_MBIST_DONE_V1(x) ((x) & (~BITS_WLOFF_MBIST_DONE_V1)) -+#define BIT_GET_WLOFF_MBIST_DONE_V1(x) \ -+ (((x) >> BIT_SHIFT_WLOFF_MBIST_DONE_V1) & BIT_MASK_WLOFF_MBIST_DONE_V1) -+#define BIT_SET_WLOFF_MBIST_DONE_V1(x, v) \ -+ (BIT_CLEAR_WLOFF_MBIST_DONE_V1(x) | BIT_WLOFF_MBIST_DONE_V1(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DONE_V2 2 -+#define BIT_MASK_PCIE_MBIST_DONE_V2 0x3 -+#define BIT_PCIE_MBIST_DONE_V2(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DONE_V2) << BIT_SHIFT_PCIE_MBIST_DONE_V2) -+#define BITS_PCIE_MBIST_DONE_V2 \ -+ (BIT_MASK_PCIE_MBIST_DONE_V2 << BIT_SHIFT_PCIE_MBIST_DONE_V2) -+#define BIT_CLEAR_PCIE_MBIST_DONE_V2(x) ((x) & (~BITS_PCIE_MBIST_DONE_V2)) -+#define BIT_GET_PCIE_MBIST_DONE_V2(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DONE_V2) & BIT_MASK_PCIE_MBIST_DONE_V2) -+#define BIT_SET_PCIE_MBIST_DONE_V2(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DONE_V2(x) | BIT_PCIE_MBIST_DONE_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_DONE (Offset 0x0178) */ -+ -+#define BIT_SHIFT_MAC_MBIST_DONE 0 -+#define BIT_MASK_MAC_MBIST_DONE 0xfff -+#define BIT_MAC_MBIST_DONE(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DONE) << BIT_SHIFT_MAC_MBIST_DONE) -+#define BITS_MAC_MBIST_DONE \ -+ (BIT_MASK_MAC_MBIST_DONE << BIT_SHIFT_MAC_MBIST_DONE) -+#define BIT_CLEAR_MAC_MBIST_DONE(x) ((x) & (~BITS_MAC_MBIST_DONE)) -+#define BIT_GET_MAC_MBIST_DONE(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DONE) & BIT_MASK_MAC_MBIST_DONE) -+#define BIT_SET_MAC_MBIST_DONE(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DONE(x) | BIT_MAC_MBIST_DONE(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MBIST_DONE (Offset 0x0178) */ -+ -+#define BIT_SHIFT_USB_MBIST_DONE_V2 0 -+#define BIT_MASK_USB_MBIST_DONE_V2 0x3 -+#define BIT_USB_MBIST_DONE_V2(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DONE_V2) << BIT_SHIFT_USB_MBIST_DONE_V2) -+#define BITS_USB_MBIST_DONE_V2 \ -+ (BIT_MASK_USB_MBIST_DONE_V2 << BIT_SHIFT_USB_MBIST_DONE_V2) -+#define BIT_CLEAR_USB_MBIST_DONE_V2(x) ((x) & (~BITS_USB_MBIST_DONE_V2)) -+#define BIT_GET_USB_MBIST_DONE_V2(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DONE_V2) & BIT_MASK_USB_MBIST_DONE_V2) -+#define BIT_SET_USB_MBIST_DONE_V2(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DONE_V2(x) | BIT_USB_MBIST_DONE_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIST_DONE (Offset 0x0178) */ -+ -+#define BIT_SHIFT_MAC_MBIST_DONE_V1 0 -+#define BIT_MASK_MAC_MBIST_DONE_V1 0x3ffff -+#define BIT_MAC_MBIST_DONE_V1(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DONE_V1) << BIT_SHIFT_MAC_MBIST_DONE_V1) -+#define BITS_MAC_MBIST_DONE_V1 \ -+ (BIT_MASK_MAC_MBIST_DONE_V1 << BIT_SHIFT_MAC_MBIST_DONE_V1) -+#define BIT_CLEAR_MAC_MBIST_DONE_V1(x) ((x) & (~BITS_MAC_MBIST_DONE_V1)) -+#define BIT_GET_MAC_MBIST_DONE_V1(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DONE_V1) & BIT_MASK_MAC_MBIST_DONE_V1) -+#define BIT_SET_MAC_MBIST_DONE_V1(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DONE_V1(x) | BIT_MAC_MBIST_DONE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_MBIST_DONE (Offset 0x0178) */ -+ -+#define BIT_SHIFT_MAC_MBIST_DONE_V2 0 -+#define BIT_MASK_MAC_MBIST_DONE_V2 0x1ff -+#define BIT_MAC_MBIST_DONE_V2(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DONE_V2) << BIT_SHIFT_MAC_MBIST_DONE_V2) -+#define BITS_MAC_MBIST_DONE_V2 \ -+ (BIT_MASK_MAC_MBIST_DONE_V2 << BIT_SHIFT_MAC_MBIST_DONE_V2) -+#define BIT_CLEAR_MAC_MBIST_DONE_V2(x) ((x) & (~BITS_MAC_MBIST_DONE_V2)) -+#define BIT_GET_MAC_MBIST_DONE_V2(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DONE_V2) & BIT_MASK_MAC_MBIST_DONE_V2) -+#define BIT_SET_MAC_MBIST_DONE_V2(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DONE_V2(x) | BIT_MAC_MBIST_DONE_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MBIST_NRML_FAIL (Offset 0x017C) */ -+ -+#define BIT_SHIFT_WLON_MBIST_NRML_FAIL 30 -+#define BIT_MASK_WLON_MBIST_NRML_FAIL 0x3 -+#define BIT_WLON_MBIST_NRML_FAIL(x) \ -+ (((x) & BIT_MASK_WLON_MBIST_NRML_FAIL) \ -+ << BIT_SHIFT_WLON_MBIST_NRML_FAIL) -+#define BITS_WLON_MBIST_NRML_FAIL \ -+ (BIT_MASK_WLON_MBIST_NRML_FAIL << BIT_SHIFT_WLON_MBIST_NRML_FAIL) -+#define BIT_CLEAR_WLON_MBIST_NRML_FAIL(x) ((x) & (~BITS_WLON_MBIST_NRML_FAIL)) -+#define BIT_GET_WLON_MBIST_NRML_FAIL(x) \ -+ (((x) >> BIT_SHIFT_WLON_MBIST_NRML_FAIL) & \ -+ BIT_MASK_WLON_MBIST_NRML_FAIL) -+#define BIT_SET_WLON_MBIST_NRML_FAIL(x, v) \ -+ (BIT_CLEAR_WLON_MBIST_NRML_FAIL(x) | BIT_WLON_MBIST_NRML_FAIL(v)) -+ -+#define BIT_SHIFT_WLOFF_MBIST_NRML_FAIL 16 -+#define BIT_MASK_WLOFF_MBIST_NRML_FAIL 0x3fff -+#define BIT_WLOFF_MBIST_NRML_FAIL(x) \ -+ (((x) & BIT_MASK_WLOFF_MBIST_NRML_FAIL) \ -+ << BIT_SHIFT_WLOFF_MBIST_NRML_FAIL) -+#define BITS_WLOFF_MBIST_NRML_FAIL \ -+ (BIT_MASK_WLOFF_MBIST_NRML_FAIL << BIT_SHIFT_WLOFF_MBIST_NRML_FAIL) -+#define BIT_CLEAR_WLOFF_MBIST_NRML_FAIL(x) ((x) & (~BITS_WLOFF_MBIST_NRML_FAIL)) -+#define BIT_GET_WLOFF_MBIST_NRML_FAIL(x) \ -+ (((x) >> BIT_SHIFT_WLOFF_MBIST_NRML_FAIL) & \ -+ BIT_MASK_WLOFF_MBIST_NRML_FAIL) -+#define BIT_SET_WLOFF_MBIST_NRML_FAIL(x, v) \ -+ (BIT_CLEAR_WLOFF_MBIST_NRML_FAIL(x) | BIT_WLOFF_MBIST_NRML_FAIL(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_NRML_FAIL 11 -+#define BIT_MASK_PCIE_MBIST_NRML_FAIL 0x1f -+#define BIT_PCIE_MBIST_NRML_FAIL(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_NRML_FAIL) \ -+ << BIT_SHIFT_PCIE_MBIST_NRML_FAIL) -+#define BITS_PCIE_MBIST_NRML_FAIL \ -+ (BIT_MASK_PCIE_MBIST_NRML_FAIL << BIT_SHIFT_PCIE_MBIST_NRML_FAIL) -+#define BIT_CLEAR_PCIE_MBIST_NRML_FAIL(x) ((x) & (~BITS_PCIE_MBIST_NRML_FAIL)) -+#define BIT_GET_PCIE_MBIST_NRML_FAIL(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_NRML_FAIL) & \ -+ BIT_MASK_PCIE_MBIST_NRML_FAIL) -+#define BIT_SET_PCIE_MBIST_NRML_FAIL(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_NRML_FAIL(x) | BIT_PCIE_MBIST_NRML_FAIL(v)) -+ -+#define BIT_SHIFT_USB_MBIST_NRML_FAIL 4 -+#define BIT_MASK_USB_MBIST_NRML_FAIL 0x7f -+#define BIT_USB_MBIST_NRML_FAIL(x) \ -+ (((x) & BIT_MASK_USB_MBIST_NRML_FAIL) << BIT_SHIFT_USB_MBIST_NRML_FAIL) -+#define BITS_USB_MBIST_NRML_FAIL \ -+ (BIT_MASK_USB_MBIST_NRML_FAIL << BIT_SHIFT_USB_MBIST_NRML_FAIL) -+#define BIT_CLEAR_USB_MBIST_NRML_FAIL(x) ((x) & (~BITS_USB_MBIST_NRML_FAIL)) -+#define BIT_GET_USB_MBIST_NRML_FAIL(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_NRML_FAIL) & BIT_MASK_USB_MBIST_NRML_FAIL) -+#define BIT_SET_USB_MBIST_NRML_FAIL(x, v) \ -+ (BIT_CLEAR_USB_MBIST_NRML_FAIL(x) | BIT_USB_MBIST_NRML_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIST_ROM_CRC_DATA (Offset 0x017C) */ -+ -+#define BIT_SHIFT_MBIST_ROM_CRC_DATA 0 -+#define BIT_MASK_MBIST_ROM_CRC_DATA 0xffffffffL -+#define BIT_MBIST_ROM_CRC_DATA(x) \ -+ (((x) & BIT_MASK_MBIST_ROM_CRC_DATA) << BIT_SHIFT_MBIST_ROM_CRC_DATA) -+#define BITS_MBIST_ROM_CRC_DATA \ -+ (BIT_MASK_MBIST_ROM_CRC_DATA << BIT_SHIFT_MBIST_ROM_CRC_DATA) -+#define BIT_CLEAR_MBIST_ROM_CRC_DATA(x) ((x) & (~BITS_MBIST_ROM_CRC_DATA)) -+#define BIT_GET_MBIST_ROM_CRC_DATA(x) \ -+ (((x) >> BIT_SHIFT_MBIST_ROM_CRC_DATA) & BIT_MASK_MBIST_ROM_CRC_DATA) -+#define BIT_SET_MBIST_ROM_CRC_DATA(x, v) \ -+ (BIT_CLEAR_MBIST_ROM_CRC_DATA(x) | BIT_MBIST_ROM_CRC_DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MBIST_NRML_FAIL (Offset 0x017C) */ -+ -+#define BIT_SHIFT_USB_WLON_MBIST_NRML_FAIL 0 -+#define BIT_MASK_USB_WLON_MBIST_NRML_FAIL 0xf -+#define BIT_USB_WLON_MBIST_NRML_FAIL(x) \ -+ (((x) & BIT_MASK_USB_WLON_MBIST_NRML_FAIL) \ -+ << BIT_SHIFT_USB_WLON_MBIST_NRML_FAIL) -+#define BITS_USB_WLON_MBIST_NRML_FAIL \ -+ (BIT_MASK_USB_WLON_MBIST_NRML_FAIL \ -+ << BIT_SHIFT_USB_WLON_MBIST_NRML_FAIL) -+#define BIT_CLEAR_USB_WLON_MBIST_NRML_FAIL(x) \ -+ ((x) & (~BITS_USB_WLON_MBIST_NRML_FAIL)) -+#define BIT_GET_USB_WLON_MBIST_NRML_FAIL(x) \ -+ (((x) >> BIT_SHIFT_USB_WLON_MBIST_NRML_FAIL) & \ -+ BIT_MASK_USB_WLON_MBIST_NRML_FAIL) -+#define BIT_SET_USB_WLON_MBIST_NRML_FAIL(x, v) \ -+ (BIT_CLEAR_USB_WLON_MBIST_NRML_FAIL(x) | \ -+ BIT_USB_WLON_MBIST_NRML_FAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MBIST_FAIL_NRML (Offset 0x017C) */ -+ -+#define BIT_SHIFT_MBIST_FAIL_NRML_V1 0 -+#define BIT_MASK_MBIST_FAIL_NRML_V1 0x3ffff -+#define BIT_MBIST_FAIL_NRML_V1(x) \ -+ (((x) & BIT_MASK_MBIST_FAIL_NRML_V1) << BIT_SHIFT_MBIST_FAIL_NRML_V1) -+#define BITS_MBIST_FAIL_NRML_V1 \ -+ (BIT_MASK_MBIST_FAIL_NRML_V1 << BIT_SHIFT_MBIST_FAIL_NRML_V1) -+#define BIT_CLEAR_MBIST_FAIL_NRML_V1(x) ((x) & (~BITS_MBIST_FAIL_NRML_V1)) -+#define BIT_GET_MBIST_FAIL_NRML_V1(x) \ -+ (((x) >> BIT_SHIFT_MBIST_FAIL_NRML_V1) & BIT_MASK_MBIST_FAIL_NRML_V1) -+#define BIT_SET_MBIST_FAIL_NRML_V1(x, v) \ -+ (BIT_CLEAR_MBIST_FAIL_NRML_V1(x) | BIT_MBIST_FAIL_NRML_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_MBIST_FAIL_NRML (Offset 0x017C) */ -+ -+#define BIT_SHIFT_MBIST_FAIL_NRML_V2 0 -+#define BIT_MASK_MBIST_FAIL_NRML_V2 0x7ffff -+#define BIT_MBIST_FAIL_NRML_V2(x) \ -+ (((x) & BIT_MASK_MBIST_FAIL_NRML_V2) << BIT_SHIFT_MBIST_FAIL_NRML_V2) -+#define BITS_MBIST_FAIL_NRML_V2 \ -+ (BIT_MASK_MBIST_FAIL_NRML_V2 << BIT_SHIFT_MBIST_FAIL_NRML_V2) -+#define BIT_CLEAR_MBIST_FAIL_NRML_V2(x) ((x) & (~BITS_MBIST_FAIL_NRML_V2)) -+#define BIT_GET_MBIST_FAIL_NRML_V2(x) \ -+ (((x) >> BIT_SHIFT_MBIST_FAIL_NRML_V2) & BIT_MASK_MBIST_FAIL_NRML_V2) -+#define BIT_SET_MBIST_FAIL_NRML_V2(x, v) \ -+ (BIT_CLEAR_MBIST_FAIL_NRML_V2(x) | BIT_MBIST_FAIL_NRML_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MBIST_FAIL_NRML (Offset 0x017C) */ -+ -+#define BIT_SHIFT_MBIST_FAIL_NRML 0 -+#define BIT_MASK_MBIST_FAIL_NRML 0xffffffffL -+#define BIT_MBIST_FAIL_NRML(x) \ -+ (((x) & BIT_MASK_MBIST_FAIL_NRML) << BIT_SHIFT_MBIST_FAIL_NRML) -+#define BITS_MBIST_FAIL_NRML \ -+ (BIT_MASK_MBIST_FAIL_NRML << BIT_SHIFT_MBIST_FAIL_NRML) -+#define BIT_CLEAR_MBIST_FAIL_NRML(x) ((x) & (~BITS_MBIST_FAIL_NRML)) -+#define BIT_GET_MBIST_FAIL_NRML(x) \ -+ (((x) >> BIT_SHIFT_MBIST_FAIL_NRML) & BIT_MASK_MBIST_FAIL_NRML) -+#define BIT_SET_MBIST_FAIL_NRML(x, v) \ -+ (BIT_CLEAR_MBIST_FAIL_NRML(x) | BIT_MBIST_FAIL_NRML(v)) -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD 0xffffffffffffffffffffffffffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD) << BIT_SHIFT_R_WMAC_IPV6_MYIPAD) -+#define BITS_R_WMAC_IPV6_MYIPAD \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD << BIT_SHIFT_R_WMAC_IPV6_MYIPAD) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD(x) ((x) & (~BITS_R_WMAC_IPV6_MYIPAD)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD) & BIT_MASK_R_WMAC_IPV6_MYIPAD) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD(x) | BIT_R_WMAC_IPV6_MYIPAD(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AES_DECRPT_DATA (Offset 0x0180) */ -+ -+#define BIT_SHIFT_IPS_CFG_ADDR 0 -+#define BIT_MASK_IPS_CFG_ADDR 0xff -+#define BIT_IPS_CFG_ADDR(x) \ -+ (((x) & BIT_MASK_IPS_CFG_ADDR) << BIT_SHIFT_IPS_CFG_ADDR) -+#define BITS_IPS_CFG_ADDR (BIT_MASK_IPS_CFG_ADDR << BIT_SHIFT_IPS_CFG_ADDR) -+#define BIT_CLEAR_IPS_CFG_ADDR(x) ((x) & (~BITS_IPS_CFG_ADDR)) -+#define BIT_GET_IPS_CFG_ADDR(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_ADDR) & BIT_MASK_IPS_CFG_ADDR) -+#define BIT_SET_IPS_CFG_ADDR(x, v) \ -+ (BIT_CLEAR_IPS_CFG_ADDR(x) | BIT_IPS_CFG_ADDR(v)) -+ -+/* 2 REG_AES_DECRPT_CFG (Offset 0x0184) */ -+ -+#define BIT_SHIFT_IPS_CFG_DATA 0 -+#define BIT_MASK_IPS_CFG_DATA 0xffffffffL -+#define BIT_IPS_CFG_DATA(x) \ -+ (((x) & BIT_MASK_IPS_CFG_DATA) << BIT_SHIFT_IPS_CFG_DATA) -+#define BITS_IPS_CFG_DATA (BIT_MASK_IPS_CFG_DATA << BIT_SHIFT_IPS_CFG_DATA) -+#define BIT_CLEAR_IPS_CFG_DATA(x) ((x) & (~BITS_IPS_CFG_DATA)) -+#define BIT_GET_IPS_CFG_DATA(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_DATA) & BIT_MASK_IPS_CFG_DATA) -+#define BIT_SET_IPS_CFG_DATA(x, v) \ -+ (BIT_CLEAR_IPS_CFG_DATA(x) | BIT_IPS_CFG_DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIOE_CTRL (Offset 0x0188) */ -+ -+#define BIT_HIOE_CFG_FILE_LOC_SEL BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIOE_CTRL (Offset 0x0188) */ -+ -+#define BIT_HIOE_WRITE_REQ BIT(30) -+#define BIT_HIOE_READ_REQ BIT(29) -+#define BIT_INST_FORMAT_ERR BIT(25) -+#define BIT_OP_TIMEOUT_ERR BIT(24) -+ -+#define BIT_SHIFT_HIOE_OP_TIMEOUT 16 -+#define BIT_MASK_HIOE_OP_TIMEOUT 0xff -+#define BIT_HIOE_OP_TIMEOUT(x) \ -+ (((x) & BIT_MASK_HIOE_OP_TIMEOUT) << BIT_SHIFT_HIOE_OP_TIMEOUT) -+#define BITS_HIOE_OP_TIMEOUT \ -+ (BIT_MASK_HIOE_OP_TIMEOUT << BIT_SHIFT_HIOE_OP_TIMEOUT) -+#define BIT_CLEAR_HIOE_OP_TIMEOUT(x) ((x) & (~BITS_HIOE_OP_TIMEOUT)) -+#define BIT_GET_HIOE_OP_TIMEOUT(x) \ -+ (((x) >> BIT_SHIFT_HIOE_OP_TIMEOUT) & BIT_MASK_HIOE_OP_TIMEOUT) -+#define BIT_SET_HIOE_OP_TIMEOUT(x, v) \ -+ (BIT_CLEAR_HIOE_OP_TIMEOUT(x) | BIT_HIOE_OP_TIMEOUT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIST_READ_BIST_RPT_V1 (Offset 0x0188) */ -+ -+#define BIT_SHIFT_MBIST_READ_BIST_RPT 0 -+#define BIT_MASK_MBIST_READ_BIST_RPT 0xffffffffL -+#define BIT_MBIST_READ_BIST_RPT(x) \ -+ (((x) & BIT_MASK_MBIST_READ_BIST_RPT) << BIT_SHIFT_MBIST_READ_BIST_RPT) -+#define BITS_MBIST_READ_BIST_RPT \ -+ (BIT_MASK_MBIST_READ_BIST_RPT << BIT_SHIFT_MBIST_READ_BIST_RPT) -+#define BIT_CLEAR_MBIST_READ_BIST_RPT(x) ((x) & (~BITS_MBIST_READ_BIST_RPT)) -+#define BIT_GET_MBIST_READ_BIST_RPT(x) \ -+ (((x) >> BIT_SHIFT_MBIST_READ_BIST_RPT) & BIT_MASK_MBIST_READ_BIST_RPT) -+#define BIT_SET_MBIST_READ_BIST_RPT(x, v) \ -+ (BIT_CLEAR_MBIST_READ_BIST_RPT(x) | BIT_MBIST_READ_BIST_RPT(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIOE_CTRL (Offset 0x0188) */ -+ -+#define BIT_SHIFT_BITDATA_CHECKSUM 0 -+#define BIT_MASK_BITDATA_CHECKSUM 0xffff -+#define BIT_BITDATA_CHECKSUM(x) \ -+ (((x) & BIT_MASK_BITDATA_CHECKSUM) << BIT_SHIFT_BITDATA_CHECKSUM) -+#define BITS_BITDATA_CHECKSUM \ -+ (BIT_MASK_BITDATA_CHECKSUM << BIT_SHIFT_BITDATA_CHECKSUM) -+#define BIT_CLEAR_BITDATA_CHECKSUM(x) ((x) & (~BITS_BITDATA_CHECKSUM)) -+#define BIT_GET_BITDATA_CHECKSUM(x) \ -+ (((x) >> BIT_SHIFT_BITDATA_CHECKSUM) & BIT_MASK_BITDATA_CHECKSUM) -+#define BIT_SET_BITDATA_CHECKSUM(x, v) \ -+ (BIT_CLEAR_BITDATA_CHECKSUM(x) | BIT_BITDATA_CHECKSUM(v)) -+ -+/* 2 REG_HIOE_CFG_FILE (Offset 0x018C) */ -+ -+#define BIT_SHIFT_TXBF_END_ADDR 16 -+#define BIT_MASK_TXBF_END_ADDR 0xffff -+#define BIT_TXBF_END_ADDR(x) \ -+ (((x) & BIT_MASK_TXBF_END_ADDR) << BIT_SHIFT_TXBF_END_ADDR) -+#define BITS_TXBF_END_ADDR (BIT_MASK_TXBF_END_ADDR << BIT_SHIFT_TXBF_END_ADDR) -+#define BIT_CLEAR_TXBF_END_ADDR(x) ((x) & (~BITS_TXBF_END_ADDR)) -+#define BIT_GET_TXBF_END_ADDR(x) \ -+ (((x) >> BIT_SHIFT_TXBF_END_ADDR) & BIT_MASK_TXBF_END_ADDR) -+#define BIT_SET_TXBF_END_ADDR(x, v) \ -+ (BIT_CLEAR_TXBF_END_ADDR(x) | BIT_TXBF_END_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MACCLKFRQ (Offset 0x018C) */ -+ -+#define BIT_SHIFT_MACCLK_FREQ_LOW32 0 -+#define BIT_MASK_MACCLK_FREQ_LOW32 0xffffffffL -+#define BIT_MACCLK_FREQ_LOW32(x) \ -+ (((x) & BIT_MASK_MACCLK_FREQ_LOW32) << BIT_SHIFT_MACCLK_FREQ_LOW32) -+#define BITS_MACCLK_FREQ_LOW32 \ -+ (BIT_MASK_MACCLK_FREQ_LOW32 << BIT_SHIFT_MACCLK_FREQ_LOW32) -+#define BIT_CLEAR_MACCLK_FREQ_LOW32(x) ((x) & (~BITS_MACCLK_FREQ_LOW32)) -+#define BIT_GET_MACCLK_FREQ_LOW32(x) \ -+ (((x) >> BIT_SHIFT_MACCLK_FREQ_LOW32) & BIT_MASK_MACCLK_FREQ_LOW32) -+#define BIT_SET_MACCLK_FREQ_LOW32(x, v) \ -+ (BIT_CLEAR_MACCLK_FREQ_LOW32(x) | BIT_MACCLK_FREQ_LOW32(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIOE_CFG_FILE (Offset 0x018C) */ -+ -+#define BIT_SHIFT_TXBF_STR_ADDR 0 -+#define BIT_MASK_TXBF_STR_ADDR 0xffff -+#define BIT_TXBF_STR_ADDR(x) \ -+ (((x) & BIT_MASK_TXBF_STR_ADDR) << BIT_SHIFT_TXBF_STR_ADDR) -+#define BITS_TXBF_STR_ADDR (BIT_MASK_TXBF_STR_ADDR << BIT_SHIFT_TXBF_STR_ADDR) -+#define BIT_CLEAR_TXBF_STR_ADDR(x) ((x) & (~BITS_TXBF_STR_ADDR)) -+#define BIT_GET_TXBF_STR_ADDR(x) \ -+ (((x) >> BIT_SHIFT_TXBF_STR_ADDR) & BIT_MASK_TXBF_STR_ADDR) -+#define BIT_SET_TXBF_STR_ADDR(x, v) \ -+ (BIT_CLEAR_TXBF_STR_ADDR(x) | BIT_TXBF_STR_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TMETER (Offset 0x0190) */ -+ -+#define BIT_TEMP_VALID BIT(31) -+ -+#define BIT_SHIFT_TEMP_VALUE 24 -+#define BIT_MASK_TEMP_VALUE 0x3f -+#define BIT_TEMP_VALUE(x) (((x) & BIT_MASK_TEMP_VALUE) << BIT_SHIFT_TEMP_VALUE) -+#define BITS_TEMP_VALUE (BIT_MASK_TEMP_VALUE << BIT_SHIFT_TEMP_VALUE) -+#define BIT_CLEAR_TEMP_VALUE(x) ((x) & (~BITS_TEMP_VALUE)) -+#define BIT_GET_TEMP_VALUE(x) \ -+ (((x) >> BIT_SHIFT_TEMP_VALUE) & BIT_MASK_TEMP_VALUE) -+#define BIT_SET_TEMP_VALUE(x, v) (BIT_CLEAR_TEMP_VALUE(x) | BIT_TEMP_VALUE(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TMETER (Offset 0x0190) */ -+ -+#define BIT_SHIFT_NCO_OUTCLK_FREQ 12 -+#define BIT_MASK_NCO_OUTCLK_FREQ 0xfffff -+#define BIT_NCO_OUTCLK_FREQ(x) \ -+ (((x) & BIT_MASK_NCO_OUTCLK_FREQ) << BIT_SHIFT_NCO_OUTCLK_FREQ) -+#define BITS_NCO_OUTCLK_FREQ \ -+ (BIT_MASK_NCO_OUTCLK_FREQ << BIT_SHIFT_NCO_OUTCLK_FREQ) -+#define BIT_CLEAR_NCO_OUTCLK_FREQ(x) ((x) & (~BITS_NCO_OUTCLK_FREQ)) -+#define BIT_GET_NCO_OUTCLK_FREQ(x) \ -+ (((x) >> BIT_SHIFT_NCO_OUTCLK_FREQ) & BIT_MASK_NCO_OUTCLK_FREQ) -+#define BIT_SET_NCO_OUTCLK_FREQ(x, v) \ -+ (BIT_CLEAR_NCO_OUTCLK_FREQ(x) | BIT_NCO_OUTCLK_FREQ(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TMETER (Offset 0x0190) */ -+ -+#define BIT_SHIFT_REG_TMETER_TIMER 8 -+#define BIT_MASK_REG_TMETER_TIMER 0xfff -+#define BIT_REG_TMETER_TIMER(x) \ -+ (((x) & BIT_MASK_REG_TMETER_TIMER) << BIT_SHIFT_REG_TMETER_TIMER) -+#define BITS_REG_TMETER_TIMER \ -+ (BIT_MASK_REG_TMETER_TIMER << BIT_SHIFT_REG_TMETER_TIMER) -+#define BIT_CLEAR_REG_TMETER_TIMER(x) ((x) & (~BITS_REG_TMETER_TIMER)) -+#define BIT_GET_REG_TMETER_TIMER(x) \ -+ (((x) >> BIT_SHIFT_REG_TMETER_TIMER) & BIT_MASK_REG_TMETER_TIMER) -+#define BIT_SET_REG_TMETER_TIMER(x, v) \ -+ (BIT_CLEAR_REG_TMETER_TIMER(x) | BIT_REG_TMETER_TIMER(v)) -+ -+#define BIT_SHIFT_REG_TEMP_DELTA 2 -+#define BIT_MASK_REG_TEMP_DELTA 0x3f -+#define BIT_REG_TEMP_DELTA(x) \ -+ (((x) & BIT_MASK_REG_TEMP_DELTA) << BIT_SHIFT_REG_TEMP_DELTA) -+#define BITS_REG_TEMP_DELTA \ -+ (BIT_MASK_REG_TEMP_DELTA << BIT_SHIFT_REG_TEMP_DELTA) -+#define BIT_CLEAR_REG_TEMP_DELTA(x) ((x) & (~BITS_REG_TEMP_DELTA)) -+#define BIT_GET_REG_TEMP_DELTA(x) \ -+ (((x) >> BIT_SHIFT_REG_TEMP_DELTA) & BIT_MASK_REG_TEMP_DELTA) -+#define BIT_SET_REG_TEMP_DELTA(x, v) \ -+ (BIT_CLEAR_REG_TEMP_DELTA(x) | BIT_REG_TEMP_DELTA(v)) -+ -+#define BIT_REG_TMETER_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TMETER (Offset 0x0190) */ -+ -+#define BIT_SHIFT_MACCLK_FREQ_HIGH10 0 -+#define BIT_MASK_MACCLK_FREQ_HIGH10 0x3ff -+#define BIT_MACCLK_FREQ_HIGH10(x) \ -+ (((x) & BIT_MASK_MACCLK_FREQ_HIGH10) << BIT_SHIFT_MACCLK_FREQ_HIGH10) -+#define BITS_MACCLK_FREQ_HIGH10 \ -+ (BIT_MASK_MACCLK_FREQ_HIGH10 << BIT_SHIFT_MACCLK_FREQ_HIGH10) -+#define BIT_CLEAR_MACCLK_FREQ_HIGH10(x) ((x) & (~BITS_MACCLK_FREQ_HIGH10)) -+#define BIT_GET_MACCLK_FREQ_HIGH10(x) \ -+ (((x) >> BIT_SHIFT_MACCLK_FREQ_HIGH10) & BIT_MASK_MACCLK_FREQ_HIGH10) -+#define BIT_SET_MACCLK_FREQ_HIGH10(x, v) \ -+ (BIT_CLEAR_MACCLK_FREQ_HIGH10(x) | BIT_MACCLK_FREQ_HIGH10(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_OSC_32K_CTRL (Offset 0x0194) */ -+ -+#define BIT_SHIFT_OSC_32K_CLKGEN_0 16 -+#define BIT_MASK_OSC_32K_CLKGEN_0 0xffff -+#define BIT_OSC_32K_CLKGEN_0(x) \ -+ (((x) & BIT_MASK_OSC_32K_CLKGEN_0) << BIT_SHIFT_OSC_32K_CLKGEN_0) -+#define BITS_OSC_32K_CLKGEN_0 \ -+ (BIT_MASK_OSC_32K_CLKGEN_0 << BIT_SHIFT_OSC_32K_CLKGEN_0) -+#define BIT_CLEAR_OSC_32K_CLKGEN_0(x) ((x) & (~BITS_OSC_32K_CLKGEN_0)) -+#define BIT_GET_OSC_32K_CLKGEN_0(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_CLKGEN_0) & BIT_MASK_OSC_32K_CLKGEN_0) -+#define BIT_SET_OSC_32K_CLKGEN_0(x, v) \ -+ (BIT_CLEAR_OSC_32K_CLKGEN_0(x) | BIT_OSC_32K_CLKGEN_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_OSC_32K_CTRL (Offset 0x0194) */ -+ -+#define BIT_32K_CLK_OUT_RDY BIT(12) -+ -+#define BIT_SHIFT_MONITOR_CYCLE_LOG2 8 -+#define BIT_MASK_MONITOR_CYCLE_LOG2 0xf -+#define BIT_MONITOR_CYCLE_LOG2(x) \ -+ (((x) & BIT_MASK_MONITOR_CYCLE_LOG2) << BIT_SHIFT_MONITOR_CYCLE_LOG2) -+#define BITS_MONITOR_CYCLE_LOG2 \ -+ (BIT_MASK_MONITOR_CYCLE_LOG2 << BIT_SHIFT_MONITOR_CYCLE_LOG2) -+#define BIT_CLEAR_MONITOR_CYCLE_LOG2(x) ((x) & (~BITS_MONITOR_CYCLE_LOG2)) -+#define BIT_GET_MONITOR_CYCLE_LOG2(x) \ -+ (((x) >> BIT_SHIFT_MONITOR_CYCLE_LOG2) & BIT_MASK_MONITOR_CYCLE_LOG2) -+#define BIT_SET_MONITOR_CYCLE_LOG2(x, v) \ -+ (BIT_CLEAR_MONITOR_CYCLE_LOG2(x) | BIT_MONITOR_CYCLE_LOG2(v)) -+ -+#define BIT_SHIFT_FREQVALUE_UNREGCLK 8 -+#define BIT_MASK_FREQVALUE_UNREGCLK 0xffffff -+#define BIT_FREQVALUE_UNREGCLK(x) \ -+ (((x) & BIT_MASK_FREQVALUE_UNREGCLK) << BIT_SHIFT_FREQVALUE_UNREGCLK) -+#define BITS_FREQVALUE_UNREGCLK \ -+ (BIT_MASK_FREQVALUE_UNREGCLK << BIT_SHIFT_FREQVALUE_UNREGCLK) -+#define BIT_CLEAR_FREQVALUE_UNREGCLK(x) ((x) & (~BITS_FREQVALUE_UNREGCLK)) -+#define BIT_GET_FREQVALUE_UNREGCLK(x) \ -+ (((x) >> BIT_SHIFT_FREQVALUE_UNREGCLK) & BIT_MASK_FREQVALUE_UNREGCLK) -+#define BIT_SET_FREQVALUE_UNREGCLK(x, v) \ -+ (BIT_CLEAR_FREQVALUE_UNREGCLK(x) | BIT_FREQVALUE_UNREGCLK(v)) -+ -+#define BIT_CAL32K_DBGMOD BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_OSC_32K_CTRL (Offset 0x0194) */ -+ -+#define BIT_SHIFT_OSC_32K_RES_COMP 4 -+#define BIT_MASK_OSC_32K_RES_COMP 0x3 -+#define BIT_OSC_32K_RES_COMP(x) \ -+ (((x) & BIT_MASK_OSC_32K_RES_COMP) << BIT_SHIFT_OSC_32K_RES_COMP) -+#define BITS_OSC_32K_RES_COMP \ -+ (BIT_MASK_OSC_32K_RES_COMP << BIT_SHIFT_OSC_32K_RES_COMP) -+#define BIT_CLEAR_OSC_32K_RES_COMP(x) ((x) & (~BITS_OSC_32K_RES_COMP)) -+#define BIT_GET_OSC_32K_RES_COMP(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_RES_COMP) & BIT_MASK_OSC_32K_RES_COMP) -+#define BIT_SET_OSC_32K_RES_COMP(x, v) \ -+ (BIT_CLEAR_OSC_32K_RES_COMP(x) | BIT_OSC_32K_RES_COMP(v)) -+ -+#define BIT_OSC_32K_OUT_SEL BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_OSC_32K_CTRL (Offset 0x0194) */ -+ -+#define BIT_ISO_WL_2_OSC_32K BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_OSC_32K_CTRL (Offset 0x0194) */ -+ -+#define BIT_POW_CKGEN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_OSC_32K_CTRL (Offset 0x0194) */ -+ -+#define BIT_SHIFT_NCO_THRS 0 -+#define BIT_MASK_NCO_THRS 0x7f -+#define BIT_NCO_THRS(x) (((x) & BIT_MASK_NCO_THRS) << BIT_SHIFT_NCO_THRS) -+#define BITS_NCO_THRS (BIT_MASK_NCO_THRS << BIT_SHIFT_NCO_THRS) -+#define BIT_CLEAR_NCO_THRS(x) ((x) & (~BITS_NCO_THRS)) -+#define BIT_GET_NCO_THRS(x) (((x) >> BIT_SHIFT_NCO_THRS) & BIT_MASK_NCO_THRS) -+#define BIT_SET_NCO_THRS(x, v) (BIT_CLEAR_NCO_THRS(x) | BIT_NCO_THRS(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_32K_CAL_REG1 (Offset 0x0198) */ -+ -+#define BIT_CAL_32K_REG_WR BIT(31) -+#define BIT_CAL_32K_DBG_SEL BIT(22) -+ -+#define BIT_SHIFT_CAL_32K_REG_ADDR 16 -+#define BIT_MASK_CAL_32K_REG_ADDR 0x3f -+#define BIT_CAL_32K_REG_ADDR(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_ADDR) << BIT_SHIFT_CAL_32K_REG_ADDR) -+#define BITS_CAL_32K_REG_ADDR \ -+ (BIT_MASK_CAL_32K_REG_ADDR << BIT_SHIFT_CAL_32K_REG_ADDR) -+#define BIT_CLEAR_CAL_32K_REG_ADDR(x) ((x) & (~BITS_CAL_32K_REG_ADDR)) -+#define BIT_GET_CAL_32K_REG_ADDR(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_ADDR) & BIT_MASK_CAL_32K_REG_ADDR) -+#define BIT_SET_CAL_32K_REG_ADDR(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_ADDR(x) | BIT_CAL_32K_REG_ADDR(v)) -+ -+#define BIT_SHIFT_CAL_32K_REG_DATA 0 -+#define BIT_MASK_CAL_32K_REG_DATA 0xffff -+#define BIT_CAL_32K_REG_DATA(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_DATA) << BIT_SHIFT_CAL_32K_REG_DATA) -+#define BITS_CAL_32K_REG_DATA \ -+ (BIT_MASK_CAL_32K_REG_DATA << BIT_SHIFT_CAL_32K_REG_DATA) -+#define BIT_CLEAR_CAL_32K_REG_DATA(x) ((x) & (~BITS_CAL_32K_REG_DATA)) -+#define BIT_GET_CAL_32K_REG_DATA(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_DATA) & BIT_MASK_CAL_32K_REG_DATA) -+#define BIT_SET_CAL_32K_REG_DATA(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_DATA(x) | BIT_CAL_32K_REG_DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_C2HEVT (Offset 0x01A0) */ -+ -+#define BIT_SHIFT_C2HEVT_MSG 0 -+#define BIT_MASK_C2HEVT_MSG 0xffffffffffffffffffffffffffffffffL -+#define BIT_C2HEVT_MSG(x) (((x) & BIT_MASK_C2HEVT_MSG) << BIT_SHIFT_C2HEVT_MSG) -+#define BITS_C2HEVT_MSG (BIT_MASK_C2HEVT_MSG << BIT_SHIFT_C2HEVT_MSG) -+#define BIT_CLEAR_C2HEVT_MSG(x) ((x) & (~BITS_C2HEVT_MSG)) -+#define BIT_GET_C2HEVT_MSG(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG) & BIT_MASK_C2HEVT_MSG) -+#define BIT_SET_C2HEVT_MSG(x, v) (BIT_CLEAR_C2HEVT_MSG(x) | BIT_C2HEVT_MSG(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_C2HEVT (Offset 0x01A0) */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_V1 0 -+#define BIT_MASK_C2HEVT_MSG_V1 0xffffffffL -+#define BIT_C2HEVT_MSG_V1(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_V1) << BIT_SHIFT_C2HEVT_MSG_V1) -+#define BITS_C2HEVT_MSG_V1 (BIT_MASK_C2HEVT_MSG_V1 << BIT_SHIFT_C2HEVT_MSG_V1) -+#define BIT_CLEAR_C2HEVT_MSG_V1(x) ((x) & (~BITS_C2HEVT_MSG_V1)) -+#define BIT_GET_C2HEVT_MSG_V1(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_V1) & BIT_MASK_C2HEVT_MSG_V1) -+#define BIT_SET_C2HEVT_MSG_V1(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_V1(x) | BIT_C2HEVT_MSG_V1(v)) -+ -+/* 2 REG_C2HEVT_1 (Offset 0x01A4) */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_1 0 -+#define BIT_MASK_C2HEVT_MSG_1 0xffffffffL -+#define BIT_C2HEVT_MSG_1(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_1) << BIT_SHIFT_C2HEVT_MSG_1) -+#define BITS_C2HEVT_MSG_1 (BIT_MASK_C2HEVT_MSG_1 << BIT_SHIFT_C2HEVT_MSG_1) -+#define BIT_CLEAR_C2HEVT_MSG_1(x) ((x) & (~BITS_C2HEVT_MSG_1)) -+#define BIT_GET_C2HEVT_MSG_1(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_1) & BIT_MASK_C2HEVT_MSG_1) -+#define BIT_SET_C2HEVT_MSG_1(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_1(x) | BIT_C2HEVT_MSG_1(v)) -+ -+/* 2 REG_C2HEVT_2 (Offset 0x01A8) */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_2 0 -+#define BIT_MASK_C2HEVT_MSG_2 0xffffffffL -+#define BIT_C2HEVT_MSG_2(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_2) << BIT_SHIFT_C2HEVT_MSG_2) -+#define BITS_C2HEVT_MSG_2 (BIT_MASK_C2HEVT_MSG_2 << BIT_SHIFT_C2HEVT_MSG_2) -+#define BIT_CLEAR_C2HEVT_MSG_2(x) ((x) & (~BITS_C2HEVT_MSG_2)) -+#define BIT_GET_C2HEVT_MSG_2(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_2) & BIT_MASK_C2HEVT_MSG_2) -+#define BIT_SET_C2HEVT_MSG_2(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_2(x) | BIT_C2HEVT_MSG_2(v)) -+ -+/* 2 REG_C2HEVT_3 (Offset 0x01AC) */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_3 0 -+#define BIT_MASK_C2HEVT_MSG_3 0xffffffffL -+#define BIT_C2HEVT_MSG_3(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_3) << BIT_SHIFT_C2HEVT_MSG_3) -+#define BITS_C2HEVT_MSG_3 (BIT_MASK_C2HEVT_MSG_3 << BIT_SHIFT_C2HEVT_MSG_3) -+#define BIT_CLEAR_C2HEVT_MSG_3(x) ((x) & (~BITS_C2HEVT_MSG_3)) -+#define BIT_GET_C2HEVT_MSG_3(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_3) & BIT_MASK_C2HEVT_MSG_3) -+#define BIT_SET_C2HEVT_MSG_3(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_3(x) | BIT_C2HEVT_MSG_3(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MISC_CTRL_V1 (Offset 0x01B0) */ -+ -+#define BIT_SHIFT_PHYWR_SETUP_CNT 28 -+#define BIT_MASK_PHYWR_SETUP_CNT 0xf -+#define BIT_PHYWR_SETUP_CNT(x) \ -+ (((x) & BIT_MASK_PHYWR_SETUP_CNT) << BIT_SHIFT_PHYWR_SETUP_CNT) -+#define BITS_PHYWR_SETUP_CNT \ -+ (BIT_MASK_PHYWR_SETUP_CNT << BIT_SHIFT_PHYWR_SETUP_CNT) -+#define BIT_CLEAR_PHYWR_SETUP_CNT(x) ((x) & (~BITS_PHYWR_SETUP_CNT)) -+#define BIT_GET_PHYWR_SETUP_CNT(x) \ -+ (((x) >> BIT_SHIFT_PHYWR_SETUP_CNT) & BIT_MASK_PHYWR_SETUP_CNT) -+#define BIT_SET_PHYWR_SETUP_CNT(x, v) \ -+ (BIT_CLEAR_PHYWR_SETUP_CNT(x) | BIT_PHYWR_SETUP_CNT(v)) -+ -+#define BIT_SHIFT_PHYWR_HOLD_CNT 24 -+#define BIT_MASK_PHYWR_HOLD_CNT 0xf -+#define BIT_PHYWR_HOLD_CNT(x) \ -+ (((x) & BIT_MASK_PHYWR_HOLD_CNT) << BIT_SHIFT_PHYWR_HOLD_CNT) -+#define BITS_PHYWR_HOLD_CNT \ -+ (BIT_MASK_PHYWR_HOLD_CNT << BIT_SHIFT_PHYWR_HOLD_CNT) -+#define BIT_CLEAR_PHYWR_HOLD_CNT(x) ((x) & (~BITS_PHYWR_HOLD_CNT)) -+#define BIT_GET_PHYWR_HOLD_CNT(x) \ -+ (((x) >> BIT_SHIFT_PHYWR_HOLD_CNT) & BIT_MASK_PHYWR_HOLD_CNT) -+#define BIT_SET_PHYWR_HOLD_CNT(x, v) \ -+ (BIT_CLEAR_PHYWR_HOLD_CNT(x) | BIT_PHYWR_HOLD_CNT(v)) -+ -+#define BIT_SHIFT_TXBUF_WKCAM_OFFSET 8 -+#define BIT_MASK_TXBUF_WKCAM_OFFSET 0x1fff -+#define BIT_TXBUF_WKCAM_OFFSET(x) \ -+ (((x) & BIT_MASK_TXBUF_WKCAM_OFFSET) << BIT_SHIFT_TXBUF_WKCAM_OFFSET) -+#define BITS_TXBUF_WKCAM_OFFSET \ -+ (BIT_MASK_TXBUF_WKCAM_OFFSET << BIT_SHIFT_TXBUF_WKCAM_OFFSET) -+#define BIT_CLEAR_TXBUF_WKCAM_OFFSET(x) ((x) & (~BITS_TXBUF_WKCAM_OFFSET)) -+#define BIT_GET_TXBUF_WKCAM_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_TXBUF_WKCAM_OFFSET) & BIT_MASK_TXBUF_WKCAM_OFFSET) -+#define BIT_SET_TXBUF_WKCAM_OFFSET(x, v) \ -+ (BIT_CLEAR_TXBUF_WKCAM_OFFSET(x) | BIT_TXBUF_WKCAM_OFFSET(v)) -+ -+#define BIT_SHIFT_PHYRD_WAIT_CNT 4 -+#define BIT_MASK_PHYRD_WAIT_CNT 0xf -+#define BIT_PHYRD_WAIT_CNT(x) \ -+ (((x) & BIT_MASK_PHYRD_WAIT_CNT) << BIT_SHIFT_PHYRD_WAIT_CNT) -+#define BITS_PHYRD_WAIT_CNT \ -+ (BIT_MASK_PHYRD_WAIT_CNT << BIT_SHIFT_PHYRD_WAIT_CNT) -+#define BIT_CLEAR_PHYRD_WAIT_CNT(x) ((x) & (~BITS_PHYRD_WAIT_CNT)) -+#define BIT_GET_PHYRD_WAIT_CNT(x) \ -+ (((x) >> BIT_SHIFT_PHYRD_WAIT_CNT) & BIT_MASK_PHYRD_WAIT_CNT) -+#define BIT_SET_PHYRD_WAIT_CNT(x, v) \ -+ (BIT_CLEAR_PHYRD_WAIT_CNT(x) | BIT_PHYRD_WAIT_CNT(v)) -+ -+#define BIT_SHIFT_H2CQ_PRI 0 -+#define BIT_MASK_H2CQ_PRI 0x3 -+#define BIT_H2CQ_PRI(x) (((x) & BIT_MASK_H2CQ_PRI) << BIT_SHIFT_H2CQ_PRI) -+#define BITS_H2CQ_PRI (BIT_MASK_H2CQ_PRI << BIT_SHIFT_H2CQ_PRI) -+#define BIT_CLEAR_H2CQ_PRI(x) ((x) & (~BITS_H2CQ_PRI)) -+#define BIT_GET_H2CQ_PRI(x) (((x) >> BIT_SHIFT_H2CQ_PRI) & BIT_MASK_H2CQ_PRI) -+#define BIT_SET_H2CQ_PRI(x, v) (BIT_CLEAR_H2CQ_PRI(x) | BIT_H2CQ_PRI(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RXDESC_BUFF_RPTR (Offset 0x01B0) */ -+ -+#define BIT_SHIFT_RXDESC_BUFF_RPTR 0 -+#define BIT_MASK_RXDESC_BUFF_RPTR 0xffffffffL -+#define BIT_RXDESC_BUFF_RPTR(x) \ -+ (((x) & BIT_MASK_RXDESC_BUFF_RPTR) << BIT_SHIFT_RXDESC_BUFF_RPTR) -+#define BITS_RXDESC_BUFF_RPTR \ -+ (BIT_MASK_RXDESC_BUFF_RPTR << BIT_SHIFT_RXDESC_BUFF_RPTR) -+#define BIT_CLEAR_RXDESC_BUFF_RPTR(x) ((x) & (~BITS_RXDESC_BUFF_RPTR)) -+#define BIT_GET_RXDESC_BUFF_RPTR(x) \ -+ (((x) >> BIT_SHIFT_RXDESC_BUFF_RPTR) & BIT_MASK_RXDESC_BUFF_RPTR) -+#define BIT_SET_RXDESC_BUFF_RPTR(x, v) \ -+ (BIT_CLEAR_RXDESC_BUFF_RPTR(x) | BIT_RXDESC_BUFF_RPTR(v)) -+ -+/* 2 REG_RXDESC_BUFF_WPTR (Offset 0x01B4) */ -+ -+#define BIT_SHIFT_RXDESC_BUFF_WPTR 0 -+#define BIT_MASK_RXDESC_BUFF_WPTR 0xffffffffL -+#define BIT_RXDESC_BUFF_WPTR(x) \ -+ (((x) & BIT_MASK_RXDESC_BUFF_WPTR) << BIT_SHIFT_RXDESC_BUFF_WPTR) -+#define BITS_RXDESC_BUFF_WPTR \ -+ (BIT_MASK_RXDESC_BUFF_WPTR << BIT_SHIFT_RXDESC_BUFF_WPTR) -+#define BIT_CLEAR_RXDESC_BUFF_WPTR(x) ((x) & (~BITS_RXDESC_BUFF_WPTR)) -+#define BIT_GET_RXDESC_BUFF_WPTR(x) \ -+ (((x) >> BIT_SHIFT_RXDESC_BUFF_WPTR) & BIT_MASK_RXDESC_BUFF_WPTR) -+#define BIT_SET_RXDESC_BUFF_WPTR(x, v) \ -+ (BIT_CLEAR_RXDESC_BUFF_WPTR(x) | BIT_RXDESC_BUFF_WPTR(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SW_DEFINED_PAGE1 (Offset 0x01B8) */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE1 0 -+#define BIT_MASK_SW_DEFINED_PAGE1 0xffffffffffffffffL -+#define BIT_SW_DEFINED_PAGE1(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE1) << BIT_SHIFT_SW_DEFINED_PAGE1) -+#define BITS_SW_DEFINED_PAGE1 \ -+ (BIT_MASK_SW_DEFINED_PAGE1 << BIT_SHIFT_SW_DEFINED_PAGE1) -+#define BIT_CLEAR_SW_DEFINED_PAGE1(x) ((x) & (~BITS_SW_DEFINED_PAGE1)) -+#define BIT_GET_SW_DEFINED_PAGE1(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE1) & BIT_MASK_SW_DEFINED_PAGE1) -+#define BIT_SET_SW_DEFINED_PAGE1(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE1(x) | BIT_SW_DEFINED_PAGE1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SW_DEFINED_PAGE1 (Offset 0x01B8) */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE1_V1 0 -+#define BIT_MASK_SW_DEFINED_PAGE1_V1 0xffffffffL -+#define BIT_SW_DEFINED_PAGE1_V1(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE1_V1) << BIT_SHIFT_SW_DEFINED_PAGE1_V1) -+#define BITS_SW_DEFINED_PAGE1_V1 \ -+ (BIT_MASK_SW_DEFINED_PAGE1_V1 << BIT_SHIFT_SW_DEFINED_PAGE1_V1) -+#define BIT_CLEAR_SW_DEFINED_PAGE1_V1(x) ((x) & (~BITS_SW_DEFINED_PAGE1_V1)) -+#define BIT_GET_SW_DEFINED_PAGE1_V1(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE1_V1) & BIT_MASK_SW_DEFINED_PAGE1_V1) -+#define BIT_SET_SW_DEFINED_PAGE1_V1(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE1_V1(x) | BIT_SW_DEFINED_PAGE1_V1(v)) -+ -+/* 2 REG_SW_DEFINED_PAGE2 (Offset 0x01BC) */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE2 0 -+#define BIT_MASK_SW_DEFINED_PAGE2 0xffffffffL -+#define BIT_SW_DEFINED_PAGE2(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE2) << BIT_SHIFT_SW_DEFINED_PAGE2) -+#define BITS_SW_DEFINED_PAGE2 \ -+ (BIT_MASK_SW_DEFINED_PAGE2 << BIT_SHIFT_SW_DEFINED_PAGE2) -+#define BIT_CLEAR_SW_DEFINED_PAGE2(x) ((x) & (~BITS_SW_DEFINED_PAGE2)) -+#define BIT_GET_SW_DEFINED_PAGE2(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE2) & BIT_MASK_SW_DEFINED_PAGE2) -+#define BIT_SET_SW_DEFINED_PAGE2(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE2(x) | BIT_SW_DEFINED_PAGE2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MCUTST_I (Offset 0x01C0) */ -+ -+#define BIT_SHIFT_MCUDMSG_I 0 -+#define BIT_MASK_MCUDMSG_I 0xffffffffL -+#define BIT_MCUDMSG_I(x) (((x) & BIT_MASK_MCUDMSG_I) << BIT_SHIFT_MCUDMSG_I) -+#define BITS_MCUDMSG_I (BIT_MASK_MCUDMSG_I << BIT_SHIFT_MCUDMSG_I) -+#define BIT_CLEAR_MCUDMSG_I(x) ((x) & (~BITS_MCUDMSG_I)) -+#define BIT_GET_MCUDMSG_I(x) (((x) >> BIT_SHIFT_MCUDMSG_I) & BIT_MASK_MCUDMSG_I) -+#define BIT_SET_MCUDMSG_I(x, v) (BIT_CLEAR_MCUDMSG_I(x) | BIT_MCUDMSG_I(v)) -+ -+/* 2 REG_MCUTST_II (Offset 0x01C4) */ -+ -+#define BIT_SHIFT_MCUDMSG_II 0 -+#define BIT_MASK_MCUDMSG_II 0xffffffffL -+#define BIT_MCUDMSG_II(x) (((x) & BIT_MASK_MCUDMSG_II) << BIT_SHIFT_MCUDMSG_II) -+#define BITS_MCUDMSG_II (BIT_MASK_MCUDMSG_II << BIT_SHIFT_MCUDMSG_II) -+#define BIT_CLEAR_MCUDMSG_II(x) ((x) & (~BITS_MCUDMSG_II)) -+#define BIT_GET_MCUDMSG_II(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_II) & BIT_MASK_MCUDMSG_II) -+#define BIT_SET_MCUDMSG_II(x, v) (BIT_CLEAR_MCUDMSG_II(x) | BIT_MCUDMSG_II(v)) -+ -+/* 2 REG_FMETHR (Offset 0x01C8) */ -+ -+#define BIT_FMSG_INT BIT(31) -+ -+#define BIT_SHIFT_FW_MSG 0 -+#define BIT_MASK_FW_MSG 0xffffffffL -+#define BIT_FW_MSG(x) (((x) & BIT_MASK_FW_MSG) << BIT_SHIFT_FW_MSG) -+#define BITS_FW_MSG (BIT_MASK_FW_MSG << BIT_SHIFT_FW_MSG) -+#define BIT_CLEAR_FW_MSG(x) ((x) & (~BITS_FW_MSG)) -+#define BIT_GET_FW_MSG(x) (((x) >> BIT_SHIFT_FW_MSG) & BIT_MASK_FW_MSG) -+#define BIT_SET_FW_MSG(x, v) (BIT_CLEAR_FW_MSG(x) | BIT_FW_MSG(v)) -+ -+/* 2 REG_HMETFR (Offset 0x01CC) */ -+ -+#define BIT_SHIFT_HRCV_MSG 24 -+#define BIT_MASK_HRCV_MSG 0xff -+#define BIT_HRCV_MSG(x) (((x) & BIT_MASK_HRCV_MSG) << BIT_SHIFT_HRCV_MSG) -+#define BITS_HRCV_MSG (BIT_MASK_HRCV_MSG << BIT_SHIFT_HRCV_MSG) -+#define BIT_CLEAR_HRCV_MSG(x) ((x) & (~BITS_HRCV_MSG)) -+#define BIT_GET_HRCV_MSG(x) (((x) >> BIT_SHIFT_HRCV_MSG) & BIT_MASK_HRCV_MSG) -+#define BIT_SET_HRCV_MSG(x, v) (BIT_CLEAR_HRCV_MSG(x) | BIT_HRCV_MSG(v)) -+ -+#define BIT_INT_BOX3 BIT(3) -+#define BIT_INT_BOX2 BIT(2) -+#define BIT_INT_BOX1 BIT(1) -+#define BIT_INT_BOX0 BIT(0) -+ -+/* 2 REG_HMEBOX0 (Offset 0x01D0) */ -+ -+#define BIT_SHIFT_HOST_MSG_0 0 -+#define BIT_MASK_HOST_MSG_0 0xffffffffL -+#define BIT_HOST_MSG_0(x) (((x) & BIT_MASK_HOST_MSG_0) << BIT_SHIFT_HOST_MSG_0) -+#define BITS_HOST_MSG_0 (BIT_MASK_HOST_MSG_0 << BIT_SHIFT_HOST_MSG_0) -+#define BIT_CLEAR_HOST_MSG_0(x) ((x) & (~BITS_HOST_MSG_0)) -+#define BIT_GET_HOST_MSG_0(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_0) & BIT_MASK_HOST_MSG_0) -+#define BIT_SET_HOST_MSG_0(x, v) (BIT_CLEAR_HOST_MSG_0(x) | BIT_HOST_MSG_0(v)) -+ -+/* 2 REG_HMEBOX1 (Offset 0x01D4) */ -+ -+#define BIT_SHIFT_HOST_MSG_1 0 -+#define BIT_MASK_HOST_MSG_1 0xffffffffL -+#define BIT_HOST_MSG_1(x) (((x) & BIT_MASK_HOST_MSG_1) << BIT_SHIFT_HOST_MSG_1) -+#define BITS_HOST_MSG_1 (BIT_MASK_HOST_MSG_1 << BIT_SHIFT_HOST_MSG_1) -+#define BIT_CLEAR_HOST_MSG_1(x) ((x) & (~BITS_HOST_MSG_1)) -+#define BIT_GET_HOST_MSG_1(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_1) & BIT_MASK_HOST_MSG_1) -+#define BIT_SET_HOST_MSG_1(x, v) (BIT_CLEAR_HOST_MSG_1(x) | BIT_HOST_MSG_1(v)) -+ -+/* 2 REG_HMEBOX2 (Offset 0x01D8) */ -+ -+#define BIT_SHIFT_HOST_MSG_2 0 -+#define BIT_MASK_HOST_MSG_2 0xffffffffL -+#define BIT_HOST_MSG_2(x) (((x) & BIT_MASK_HOST_MSG_2) << BIT_SHIFT_HOST_MSG_2) -+#define BITS_HOST_MSG_2 (BIT_MASK_HOST_MSG_2 << BIT_SHIFT_HOST_MSG_2) -+#define BIT_CLEAR_HOST_MSG_2(x) ((x) & (~BITS_HOST_MSG_2)) -+#define BIT_GET_HOST_MSG_2(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_2) & BIT_MASK_HOST_MSG_2) -+#define BIT_SET_HOST_MSG_2(x, v) (BIT_CLEAR_HOST_MSG_2(x) | BIT_HOST_MSG_2(v)) -+ -+/* 2 REG_HMEBOX3 (Offset 0x01DC) */ -+ -+#define BIT_SHIFT_HOST_MSG_3 0 -+#define BIT_MASK_HOST_MSG_3 0xffffffffL -+#define BIT_HOST_MSG_3(x) (((x) & BIT_MASK_HOST_MSG_3) << BIT_SHIFT_HOST_MSG_3) -+#define BITS_HOST_MSG_3 (BIT_MASK_HOST_MSG_3 << BIT_SHIFT_HOST_MSG_3) -+#define BIT_CLEAR_HOST_MSG_3(x) ((x) & (~BITS_HOST_MSG_3)) -+#define BIT_GET_HOST_MSG_3(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_3) & BIT_MASK_HOST_MSG_3) -+#define BIT_SET_HOST_MSG_3(x, v) (BIT_CLEAR_HOST_MSG_3(x) | BIT_HOST_MSG_3(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RXDESC_BUFF_BNDY (Offset 0x01E0) */ -+ -+#define BIT_FW_FIFO_PTR_RST BIT(18) -+#define BIT_PHY_FIFO_PTR_RST BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LLT_INIT (Offset 0x01E0) */ -+ -+#define BIT_SHIFT_LLTINI_PDATA_V1 16 -+#define BIT_MASK_LLTINI_PDATA_V1 0xfff -+#define BIT_LLTINI_PDATA_V1(x) \ -+ (((x) & BIT_MASK_LLTINI_PDATA_V1) << BIT_SHIFT_LLTINI_PDATA_V1) -+#define BITS_LLTINI_PDATA_V1 \ -+ (BIT_MASK_LLTINI_PDATA_V1 << BIT_SHIFT_LLTINI_PDATA_V1) -+#define BIT_CLEAR_LLTINI_PDATA_V1(x) ((x) & (~BITS_LLTINI_PDATA_V1)) -+#define BIT_GET_LLTINI_PDATA_V1(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_PDATA_V1) & BIT_MASK_LLTINI_PDATA_V1) -+#define BIT_SET_LLTINI_PDATA_V1(x, v) \ -+ (BIT_CLEAR_LLTINI_PDATA_V1(x) | BIT_LLTINI_PDATA_V1(v)) -+ -+#define BIT_SHIFT_LLTINI_HDATA_V1 0 -+#define BIT_MASK_LLTINI_HDATA_V1 0xfff -+#define BIT_LLTINI_HDATA_V1(x) \ -+ (((x) & BIT_MASK_LLTINI_HDATA_V1) << BIT_SHIFT_LLTINI_HDATA_V1) -+#define BITS_LLTINI_HDATA_V1 \ -+ (BIT_MASK_LLTINI_HDATA_V1 << BIT_SHIFT_LLTINI_HDATA_V1) -+#define BIT_CLEAR_LLTINI_HDATA_V1(x) ((x) & (~BITS_LLTINI_HDATA_V1)) -+#define BIT_GET_LLTINI_HDATA_V1(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_HDATA_V1) & BIT_MASK_LLTINI_HDATA_V1) -+#define BIT_SET_LLTINI_HDATA_V1(x, v) \ -+ (BIT_CLEAR_LLTINI_HDATA_V1(x) | BIT_LLTINI_HDATA_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RXDESC_BUFF_BNDY (Offset 0x01E0) */ -+ -+#define BIT_SHIFT_RXDESC_BUFF_BNDY 0 -+#define BIT_MASK_RXDESC_BUFF_BNDY 0xffffffffL -+#define BIT_RXDESC_BUFF_BNDY(x) \ -+ (((x) & BIT_MASK_RXDESC_BUFF_BNDY) << BIT_SHIFT_RXDESC_BUFF_BNDY) -+#define BITS_RXDESC_BUFF_BNDY \ -+ (BIT_MASK_RXDESC_BUFF_BNDY << BIT_SHIFT_RXDESC_BUFF_BNDY) -+#define BIT_CLEAR_RXDESC_BUFF_BNDY(x) ((x) & (~BITS_RXDESC_BUFF_BNDY)) -+#define BIT_GET_RXDESC_BUFF_BNDY(x) \ -+ (((x) >> BIT_SHIFT_RXDESC_BUFF_BNDY) & BIT_MASK_RXDESC_BUFF_BNDY) -+#define BIT_SET_RXDESC_BUFF_BNDY(x, v) \ -+ (BIT_CLEAR_RXDESC_BUFF_BNDY(x) | BIT_RXDESC_BUFF_BNDY(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_GENTST (Offset 0x01E4) */ -+ -+#define BIT_SHIFT_GENTST 0 -+#define BIT_MASK_GENTST 0xffffffffL -+#define BIT_GENTST(x) (((x) & BIT_MASK_GENTST) << BIT_SHIFT_GENTST) -+#define BITS_GENTST (BIT_MASK_GENTST << BIT_SHIFT_GENTST) -+#define BIT_CLEAR_GENTST(x) ((x) & (~BITS_GENTST)) -+#define BIT_GET_GENTST(x) (((x) >> BIT_SHIFT_GENTST) & BIT_MASK_GENTST) -+#define BIT_SET_GENTST(x, v) (BIT_CLEAR_GENTST(x) | BIT_GENTST(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_LLT_INIT_ADDR (Offset 0x01E4) */ -+ -+#define BIT_SHIFT_LLTINI_ADDR_V1 0 -+#define BIT_MASK_LLTINI_ADDR_V1 0xfff -+#define BIT_LLTINI_ADDR_V1(x) \ -+ (((x) & BIT_MASK_LLTINI_ADDR_V1) << BIT_SHIFT_LLTINI_ADDR_V1) -+#define BITS_LLTINI_ADDR_V1 \ -+ (BIT_MASK_LLTINI_ADDR_V1 << BIT_SHIFT_LLTINI_ADDR_V1) -+#define BIT_CLEAR_LLTINI_ADDR_V1(x) ((x) & (~BITS_LLTINI_ADDR_V1)) -+#define BIT_GET_LLTINI_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_ADDR_V1) & BIT_MASK_LLTINI_ADDR_V1) -+#define BIT_SET_LLTINI_ADDR_V1(x, v) \ -+ (BIT_CLEAR_LLTINI_ADDR_V1(x) | BIT_LLTINI_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BB_ACCESS_CTRL (Offset 0x01E8) */ -+ -+#define BIT_SHIFT_BB_WRITE_READ 30 -+#define BIT_MASK_BB_WRITE_READ 0x3 -+#define BIT_BB_WRITE_READ(x) \ -+ (((x) & BIT_MASK_BB_WRITE_READ) << BIT_SHIFT_BB_WRITE_READ) -+#define BITS_BB_WRITE_READ (BIT_MASK_BB_WRITE_READ << BIT_SHIFT_BB_WRITE_READ) -+#define BIT_CLEAR_BB_WRITE_READ(x) ((x) & (~BITS_BB_WRITE_READ)) -+#define BIT_GET_BB_WRITE_READ(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_READ) & BIT_MASK_BB_WRITE_READ) -+#define BIT_SET_BB_WRITE_READ(x, v) \ -+ (BIT_CLEAR_BB_WRITE_READ(x) | BIT_BB_WRITE_READ(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BB_ACCESS_CTRL (Offset 0x01E8) */ -+ -+#define BIT_SHIFT_BB_WRITE_EN_V1 16 -+#define BIT_MASK_BB_WRITE_EN_V1 0xf -+#define BIT_BB_WRITE_EN_V1(x) \ -+ (((x) & BIT_MASK_BB_WRITE_EN_V1) << BIT_SHIFT_BB_WRITE_EN_V1) -+#define BITS_BB_WRITE_EN_V1 \ -+ (BIT_MASK_BB_WRITE_EN_V1 << BIT_SHIFT_BB_WRITE_EN_V1) -+#define BIT_CLEAR_BB_WRITE_EN_V1(x) ((x) & (~BITS_BB_WRITE_EN_V1)) -+#define BIT_GET_BB_WRITE_EN_V1(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_EN_V1) & BIT_MASK_BB_WRITE_EN_V1) -+#define BIT_SET_BB_WRITE_EN_V1(x, v) \ -+ (BIT_CLEAR_BB_WRITE_EN_V1(x) | BIT_BB_WRITE_EN_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BB_ACCESS_CTRL (Offset 0x01E8) */ -+ -+#define BIT_SHIFT_BB_WRITE_EN 12 -+#define BIT_MASK_BB_WRITE_EN 0xf -+#define BIT_BB_WRITE_EN(x) \ -+ (((x) & BIT_MASK_BB_WRITE_EN) << BIT_SHIFT_BB_WRITE_EN) -+#define BITS_BB_WRITE_EN (BIT_MASK_BB_WRITE_EN << BIT_SHIFT_BB_WRITE_EN) -+#define BIT_CLEAR_BB_WRITE_EN(x) ((x) & (~BITS_BB_WRITE_EN)) -+#define BIT_GET_BB_WRITE_EN(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_EN) & BIT_MASK_BB_WRITE_EN) -+#define BIT_SET_BB_WRITE_EN(x, v) \ -+ (BIT_CLEAR_BB_WRITE_EN(x) | BIT_BB_WRITE_EN(v)) -+ -+#define BIT_SHIFT_BB_ADDR 2 -+#define BIT_MASK_BB_ADDR 0x1ff -+#define BIT_BB_ADDR(x) (((x) & BIT_MASK_BB_ADDR) << BIT_SHIFT_BB_ADDR) -+#define BITS_BB_ADDR (BIT_MASK_BB_ADDR << BIT_SHIFT_BB_ADDR) -+#define BIT_CLEAR_BB_ADDR(x) ((x) & (~BITS_BB_ADDR)) -+#define BIT_GET_BB_ADDR(x) (((x) >> BIT_SHIFT_BB_ADDR) & BIT_MASK_BB_ADDR) -+#define BIT_SET_BB_ADDR(x, v) (BIT_CLEAR_BB_ADDR(x) | BIT_BB_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BB_ACCESS_CTRL (Offset 0x01E8) */ -+ -+#define BIT_SHIFT_BB_ADDR_V1 2 -+#define BIT_MASK_BB_ADDR_V1 0xfff -+#define BIT_BB_ADDR_V1(x) (((x) & BIT_MASK_BB_ADDR_V1) << BIT_SHIFT_BB_ADDR_V1) -+#define BITS_BB_ADDR_V1 (BIT_MASK_BB_ADDR_V1 << BIT_SHIFT_BB_ADDR_V1) -+#define BIT_CLEAR_BB_ADDR_V1(x) ((x) & (~BITS_BB_ADDR_V1)) -+#define BIT_GET_BB_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_BB_ADDR_V1) & BIT_MASK_BB_ADDR_V1) -+#define BIT_SET_BB_ADDR_V1(x, v) (BIT_CLEAR_BB_ADDR_V1(x) | BIT_BB_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BB_ACCESS_CTRL (Offset 0x01E8) */ -+ -+#define BIT_BB_ERRACC BIT(0) -+ -+/* 2 REG_BB_ACCESS_DATA (Offset 0x01EC) */ -+ -+#define BIT_SHIFT_BB_DATA 0 -+#define BIT_MASK_BB_DATA 0xffffffffL -+#define BIT_BB_DATA(x) (((x) & BIT_MASK_BB_DATA) << BIT_SHIFT_BB_DATA) -+#define BITS_BB_DATA (BIT_MASK_BB_DATA << BIT_SHIFT_BB_DATA) -+#define BIT_CLEAR_BB_DATA(x) ((x) & (~BITS_BB_DATA)) -+#define BIT_GET_BB_DATA(x) (((x) >> BIT_SHIFT_BB_DATA) & BIT_MASK_BB_DATA) -+#define BIT_SET_BB_DATA(x, v) (BIT_CLEAR_BB_DATA(x) | BIT_BB_DATA(v)) -+ -+/* 2 REG_HMEBOX_E0 (Offset 0x01F0) */ -+ -+#define BIT_SHIFT_HMEBOX_E0 0 -+#define BIT_MASK_HMEBOX_E0 0xffffffffL -+#define BIT_HMEBOX_E0(x) (((x) & BIT_MASK_HMEBOX_E0) << BIT_SHIFT_HMEBOX_E0) -+#define BITS_HMEBOX_E0 (BIT_MASK_HMEBOX_E0 << BIT_SHIFT_HMEBOX_E0) -+#define BIT_CLEAR_HMEBOX_E0(x) ((x) & (~BITS_HMEBOX_E0)) -+#define BIT_GET_HMEBOX_E0(x) (((x) >> BIT_SHIFT_HMEBOX_E0) & BIT_MASK_HMEBOX_E0) -+#define BIT_SET_HMEBOX_E0(x, v) (BIT_CLEAR_HMEBOX_E0(x) | BIT_HMEBOX_E0(v)) -+ -+/* 2 REG_HMEBOX_E1 (Offset 0x01F4) */ -+ -+#define BIT_SHIFT_HMEBOX_E1 0 -+#define BIT_MASK_HMEBOX_E1 0xffffffffL -+#define BIT_HMEBOX_E1(x) (((x) & BIT_MASK_HMEBOX_E1) << BIT_SHIFT_HMEBOX_E1) -+#define BITS_HMEBOX_E1 (BIT_MASK_HMEBOX_E1 << BIT_SHIFT_HMEBOX_E1) -+#define BIT_CLEAR_HMEBOX_E1(x) ((x) & (~BITS_HMEBOX_E1)) -+#define BIT_GET_HMEBOX_E1(x) (((x) >> BIT_SHIFT_HMEBOX_E1) & BIT_MASK_HMEBOX_E1) -+#define BIT_SET_HMEBOX_E1(x, v) (BIT_CLEAR_HMEBOX_E1(x) | BIT_HMEBOX_E1(v)) -+ -+/* 2 REG_HMEBOX_E2 (Offset 0x01F8) */ -+ -+#define BIT_SHIFT_HMEBOX_E2 0 -+#define BIT_MASK_HMEBOX_E2 0xffffffffL -+#define BIT_HMEBOX_E2(x) (((x) & BIT_MASK_HMEBOX_E2) << BIT_SHIFT_HMEBOX_E2) -+#define BITS_HMEBOX_E2 (BIT_MASK_HMEBOX_E2 << BIT_SHIFT_HMEBOX_E2) -+#define BIT_CLEAR_HMEBOX_E2(x) ((x) & (~BITS_HMEBOX_E2)) -+#define BIT_GET_HMEBOX_E2(x) (((x) >> BIT_SHIFT_HMEBOX_E2) & BIT_MASK_HMEBOX_E2) -+#define BIT_SET_HMEBOX_E2(x, v) (BIT_CLEAR_HMEBOX_E2(x) | BIT_HMEBOX_E2(v)) -+ -+/* 2 REG_HMEBOX_E3 (Offset 0x01FC) */ -+ -+#define BIT_SHIFT_HMEBOX_E3 0 -+#define BIT_MASK_HMEBOX_E3 0xffffffffL -+#define BIT_HMEBOX_E3(x) (((x) & BIT_MASK_HMEBOX_E3) << BIT_SHIFT_HMEBOX_E3) -+#define BITS_HMEBOX_E3 (BIT_MASK_HMEBOX_E3 << BIT_SHIFT_HMEBOX_E3) -+#define BIT_CLEAR_HMEBOX_E3(x) ((x) & (~BITS_HMEBOX_E3)) -+#define BIT_GET_HMEBOX_E3(x) (((x) >> BIT_SHIFT_HMEBOX_E3) & BIT_MASK_HMEBOX_E3) -+#define BIT_SET_HMEBOX_E3(x, v) (BIT_CLEAR_HMEBOX_E3(x) | BIT_HMEBOX_E3(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_0 (Offset 0x0200) */ -+ -+#define BIT_BCN1_VALID BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_HLPQ (Offset 0x0200) */ -+ -+#define BIT_EP2Q_PUBLIC_DIS BIT(29) -+#define BIT_EP1Q_PUBLIC_DIS BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_HLPQ (Offset 0x0200) */ -+ -+#define BIT_EPQ_PUBLIC_DIS BIT(27) -+#define BIT_NPQ_PUBLIC_DIS BIT(26) -+#define BIT_LPQ_PUBLIC_DIS BIT(25) -+#define BIT_HPQ_PUBLIC_DIS BIT(24) -+ -+#define BIT_SHIFT_PUBQ 16 -+#define BIT_MASK_PUBQ 0xff -+#define BIT_PUBQ(x) (((x) & BIT_MASK_PUBQ) << BIT_SHIFT_PUBQ) -+#define BITS_PUBQ (BIT_MASK_PUBQ << BIT_SHIFT_PUBQ) -+#define BIT_CLEAR_PUBQ(x) ((x) & (~BITS_PUBQ)) -+#define BIT_GET_PUBQ(x) (((x) >> BIT_SHIFT_PUBQ) & BIT_MASK_PUBQ) -+#define BIT_SET_PUBQ(x, v) (BIT_CLEAR_PUBQ(x) | BIT_PUBQ(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_CTRL_1 (Offset 0x0200) */ -+ -+#define BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1 16 -+#define BIT_MASK_TX_OQT_HE_FREE_SPACE_V1 0xff -+#define BIT_TX_OQT_HE_FREE_SPACE_V1(x) \ -+ (((x) & BIT_MASK_TX_OQT_HE_FREE_SPACE_V1) \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1) -+#define BITS_TX_OQT_HE_FREE_SPACE_V1 \ -+ (BIT_MASK_TX_OQT_HE_FREE_SPACE_V1 << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1) -+#define BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1(x) \ -+ ((x) & (~BITS_TX_OQT_HE_FREE_SPACE_V1)) -+#define BIT_GET_TX_OQT_HE_FREE_SPACE_V1(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1) & \ -+ BIT_MASK_TX_OQT_HE_FREE_SPACE_V1) -+#define BIT_SET_TX_OQT_HE_FREE_SPACE_V1(x, v) \ -+ (BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1(x) | BIT_TX_OQT_HE_FREE_SPACE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_0 (Offset 0x0200) */ -+ -+#define BIT_SHIFT_BCN1_HEAD 16 -+#define BIT_MASK_BCN1_HEAD 0xfff -+#define BIT_BCN1_HEAD(x) (((x) & BIT_MASK_BCN1_HEAD) << BIT_SHIFT_BCN1_HEAD) -+#define BITS_BCN1_HEAD (BIT_MASK_BCN1_HEAD << BIT_SHIFT_BCN1_HEAD) -+#define BIT_CLEAR_BCN1_HEAD(x) ((x) & (~BITS_BCN1_HEAD)) -+#define BIT_GET_BCN1_HEAD(x) (((x) >> BIT_SHIFT_BCN1_HEAD) & BIT_MASK_BCN1_HEAD) -+#define BIT_SET_BCN1_HEAD(x, v) (BIT_CLEAR_BCN1_HEAD(x) | BIT_BCN1_HEAD(v)) -+ -+#define BIT_BCN0_VALID BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_HLPQ (Offset 0x0200) */ -+ -+#define BIT_SHIFT_LPQ 8 -+#define BIT_MASK_LPQ 0xff -+#define BIT_LPQ(x) (((x) & BIT_MASK_LPQ) << BIT_SHIFT_LPQ) -+#define BITS_LPQ (BIT_MASK_LPQ << BIT_SHIFT_LPQ) -+#define BIT_CLEAR_LPQ(x) ((x) & (~BITS_LPQ)) -+#define BIT_GET_LPQ(x) (((x) >> BIT_SHIFT_LPQ) & BIT_MASK_LPQ) -+#define BIT_SET_LPQ(x, v) (BIT_CLEAR_LPQ(x) | BIT_LPQ(v)) -+ -+#define BIT_SHIFT_HPQ 0 -+#define BIT_MASK_HPQ 0xff -+#define BIT_HPQ(x) (((x) & BIT_MASK_HPQ) << BIT_SHIFT_HPQ) -+#define BITS_HPQ (BIT_MASK_HPQ << BIT_SHIFT_HPQ) -+#define BIT_CLEAR_HPQ(x) ((x) & (~BITS_HPQ)) -+#define BIT_GET_HPQ(x) (((x) >> BIT_SHIFT_HPQ) & BIT_MASK_HPQ) -+#define BIT_SET_HPQ(x, v) (BIT_CLEAR_HPQ(x) | BIT_HPQ(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_CTRL_1 (Offset 0x0200) */ -+ -+#define BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1 0 -+#define BIT_MASK_TX_OQT_NL_FREE_SPACE_V1 0xff -+#define BIT_TX_OQT_NL_FREE_SPACE_V1(x) \ -+ (((x) & BIT_MASK_TX_OQT_NL_FREE_SPACE_V1) \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1) -+#define BITS_TX_OQT_NL_FREE_SPACE_V1 \ -+ (BIT_MASK_TX_OQT_NL_FREE_SPACE_V1 << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1) -+#define BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1(x) \ -+ ((x) & (~BITS_TX_OQT_NL_FREE_SPACE_V1)) -+#define BIT_GET_TX_OQT_NL_FREE_SPACE_V1(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1) & \ -+ BIT_MASK_TX_OQT_NL_FREE_SPACE_V1) -+#define BIT_SET_TX_OQT_NL_FREE_SPACE_V1(x, v) \ -+ (BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1(x) | BIT_TX_OQT_NL_FREE_SPACE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_0 (Offset 0x0200) */ -+ -+#define BIT_SHIFT_BCN0_HEAD 0 -+#define BIT_MASK_BCN0_HEAD 0xfff -+#define BIT_BCN0_HEAD(x) (((x) & BIT_MASK_BCN0_HEAD) << BIT_SHIFT_BCN0_HEAD) -+#define BITS_BCN0_HEAD (BIT_MASK_BCN0_HEAD << BIT_SHIFT_BCN0_HEAD) -+#define BIT_CLEAR_BCN0_HEAD(x) ((x) & (~BITS_BCN0_HEAD)) -+#define BIT_GET_BCN0_HEAD(x) (((x) >> BIT_SHIFT_BCN0_HEAD) & BIT_MASK_BCN0_HEAD) -+#define BIT_SET_BCN0_HEAD(x, v) (BIT_CLEAR_BCN0_HEAD(x) | BIT_BCN0_HEAD(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_CTRL_2 (Offset 0x0204) */ -+ -+#define BIT_BCN_VALID_1_V1 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_1 (Offset 0x0204) */ -+ -+#define BIT_BCN3_VALID BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO (Offset 0x0204) */ -+ -+#define BIT_SHIFT_TXPKTNUM 24 -+#define BIT_MASK_TXPKTNUM 0xff -+#define BIT_TXPKTNUM(x) (((x) & BIT_MASK_TXPKTNUM) << BIT_SHIFT_TXPKTNUM) -+#define BITS_TXPKTNUM (BIT_MASK_TXPKTNUM << BIT_SHIFT_TXPKTNUM) -+#define BIT_CLEAR_TXPKTNUM(x) ((x) & (~BITS_TXPKTNUM)) -+#define BIT_GET_TXPKTNUM(x) (((x) >> BIT_SHIFT_TXPKTNUM) & BIT_MASK_TXPKTNUM) -+#define BIT_SET_TXPKTNUM(x, v) (BIT_CLEAR_TXPKTNUM(x) | BIT_TXPKTNUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_1 (Offset 0x0204) */ -+ -+#define BIT_SHIFT_R_BCN_HEAD_SEL_V1 20 -+#define BIT_MASK_R_BCN_HEAD_SEL_V1 0x7 -+#define BIT_R_BCN_HEAD_SEL_V1(x) \ -+ (((x) & BIT_MASK_R_BCN_HEAD_SEL_V1) << BIT_SHIFT_R_BCN_HEAD_SEL_V1) -+#define BITS_R_BCN_HEAD_SEL_V1 \ -+ (BIT_MASK_R_BCN_HEAD_SEL_V1 << BIT_SHIFT_R_BCN_HEAD_SEL_V1) -+#define BIT_CLEAR_R_BCN_HEAD_SEL_V1(x) ((x) & (~BITS_R_BCN_HEAD_SEL_V1)) -+#define BIT_GET_R_BCN_HEAD_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_R_BCN_HEAD_SEL_V1) & BIT_MASK_R_BCN_HEAD_SEL_V1) -+#define BIT_SET_R_BCN_HEAD_SEL_V1(x, v) \ -+ (BIT_CLEAR_R_BCN_HEAD_SEL_V1(x) | BIT_R_BCN_HEAD_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO (Offset 0x0204) */ -+ -+#define BIT_SHIFT_PUBQ_AVAL_PG 16 -+#define BIT_MASK_PUBQ_AVAL_PG 0xff -+#define BIT_PUBQ_AVAL_PG(x) \ -+ (((x) & BIT_MASK_PUBQ_AVAL_PG) << BIT_SHIFT_PUBQ_AVAL_PG) -+#define BITS_PUBQ_AVAL_PG (BIT_MASK_PUBQ_AVAL_PG << BIT_SHIFT_PUBQ_AVAL_PG) -+#define BIT_CLEAR_PUBQ_AVAL_PG(x) ((x) & (~BITS_PUBQ_AVAL_PG)) -+#define BIT_GET_PUBQ_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_AVAL_PG) & BIT_MASK_PUBQ_AVAL_PG) -+#define BIT_SET_PUBQ_AVAL_PG(x, v) \ -+ (BIT_CLEAR_PUBQ_AVAL_PG(x) | BIT_PUBQ_AVAL_PG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_CTRL_2 (Offset 0x0204) */ -+ -+#define BIT_SHIFT_BCN_HEAD_1_V1 16 -+#define BIT_MASK_BCN_HEAD_1_V1 0xfff -+#define BIT_BCN_HEAD_1_V1(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_1_V1) << BIT_SHIFT_BCN_HEAD_1_V1) -+#define BITS_BCN_HEAD_1_V1 (BIT_MASK_BCN_HEAD_1_V1 << BIT_SHIFT_BCN_HEAD_1_V1) -+#define BIT_CLEAR_BCN_HEAD_1_V1(x) ((x) & (~BITS_BCN_HEAD_1_V1)) -+#define BIT_GET_BCN_HEAD_1_V1(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_1_V1) & BIT_MASK_BCN_HEAD_1_V1) -+#define BIT_SET_BCN_HEAD_1_V1(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_1_V1(x) | BIT_BCN_HEAD_1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_1 (Offset 0x0204) */ -+ -+#define BIT_SHIFT_BCN3_HEAD 16 -+#define BIT_MASK_BCN3_HEAD 0xfff -+#define BIT_BCN3_HEAD(x) (((x) & BIT_MASK_BCN3_HEAD) << BIT_SHIFT_BCN3_HEAD) -+#define BITS_BCN3_HEAD (BIT_MASK_BCN3_HEAD << BIT_SHIFT_BCN3_HEAD) -+#define BIT_CLEAR_BCN3_HEAD(x) ((x) & (~BITS_BCN3_HEAD)) -+#define BIT_GET_BCN3_HEAD(x) (((x) >> BIT_SHIFT_BCN3_HEAD) & BIT_MASK_BCN3_HEAD) -+#define BIT_SET_BCN3_HEAD(x, v) (BIT_CLEAR_BCN3_HEAD(x) | BIT_BCN3_HEAD(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_CTRL_2 (Offset 0x0204) */ -+ -+#define BIT_BCN_VALID_V1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_1 (Offset 0x0204) */ -+ -+#define BIT_BCN2_VALID BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO (Offset 0x0204) */ -+ -+#define BIT_SHIFT_LPQ_AVAL_PG 8 -+#define BIT_MASK_LPQ_AVAL_PG 0xff -+#define BIT_LPQ_AVAL_PG(x) \ -+ (((x) & BIT_MASK_LPQ_AVAL_PG) << BIT_SHIFT_LPQ_AVAL_PG) -+#define BITS_LPQ_AVAL_PG (BIT_MASK_LPQ_AVAL_PG << BIT_SHIFT_LPQ_AVAL_PG) -+#define BIT_CLEAR_LPQ_AVAL_PG(x) ((x) & (~BITS_LPQ_AVAL_PG)) -+#define BIT_GET_LPQ_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_LPQ_AVAL_PG) & BIT_MASK_LPQ_AVAL_PG) -+#define BIT_SET_LPQ_AVAL_PG(x, v) \ -+ (BIT_CLEAR_LPQ_AVAL_PG(x) | BIT_LPQ_AVAL_PG(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_1 (Offset 0x0204) */ -+ -+#define BIT_TDE_ERROR_STOP BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO (Offset 0x0204) */ -+ -+#define BIT_SHIFT_HPQ_AVAL_PG 0 -+#define BIT_MASK_HPQ_AVAL_PG 0xff -+#define BIT_HPQ_AVAL_PG(x) \ -+ (((x) & BIT_MASK_HPQ_AVAL_PG) << BIT_SHIFT_HPQ_AVAL_PG) -+#define BITS_HPQ_AVAL_PG (BIT_MASK_HPQ_AVAL_PG << BIT_SHIFT_HPQ_AVAL_PG) -+#define BIT_CLEAR_HPQ_AVAL_PG(x) ((x) & (~BITS_HPQ_AVAL_PG)) -+#define BIT_GET_HPQ_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_HPQ_AVAL_PG) & BIT_MASK_HPQ_AVAL_PG) -+#define BIT_SET_HPQ_AVAL_PG(x, v) \ -+ (BIT_CLEAR_HPQ_AVAL_PG(x) | BIT_HPQ_AVAL_PG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_CTRL_2 (Offset 0x0204) */ -+ -+#define BIT_SHIFT_BCN_HEAD_V1 0 -+#define BIT_MASK_BCN_HEAD_V1 0xfff -+#define BIT_BCN_HEAD_V1(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_V1) << BIT_SHIFT_BCN_HEAD_V1) -+#define BITS_BCN_HEAD_V1 (BIT_MASK_BCN_HEAD_V1 << BIT_SHIFT_BCN_HEAD_V1) -+#define BIT_CLEAR_BCN_HEAD_V1(x) ((x) & (~BITS_BCN_HEAD_V1)) -+#define BIT_GET_BCN_HEAD_V1(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_V1) & BIT_MASK_BCN_HEAD_V1) -+#define BIT_SET_BCN_HEAD_V1(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_V1(x) | BIT_BCN_HEAD_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_1 (Offset 0x0204) */ -+ -+#define BIT_SHIFT_BCN2_HEAD 0 -+#define BIT_MASK_BCN2_HEAD 0xfff -+#define BIT_BCN2_HEAD(x) (((x) & BIT_MASK_BCN2_HEAD) << BIT_SHIFT_BCN2_HEAD) -+#define BITS_BCN2_HEAD (BIT_MASK_BCN2_HEAD << BIT_SHIFT_BCN2_HEAD) -+#define BIT_CLEAR_BCN2_HEAD(x) ((x) & (~BITS_BCN2_HEAD)) -+#define BIT_GET_BCN2_HEAD(x) (((x) >> BIT_SHIFT_BCN2_HEAD) & BIT_MASK_BCN2_HEAD) -+#define BIT_SET_BCN2_HEAD(x, v) (BIT_CLEAR_BCN2_HEAD(x) | BIT_BCN2_HEAD(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DWBCN0_CTRL (Offset 0x0208) */ -+ -+#define BIT_SHIFT_LLT_FREE_PAGE 24 -+#define BIT_MASK_LLT_FREE_PAGE 0xff -+#define BIT_LLT_FREE_PAGE(x) \ -+ (((x) & BIT_MASK_LLT_FREE_PAGE) << BIT_SHIFT_LLT_FREE_PAGE) -+#define BITS_LLT_FREE_PAGE (BIT_MASK_LLT_FREE_PAGE << BIT_SHIFT_LLT_FREE_PAGE) -+#define BIT_CLEAR_LLT_FREE_PAGE(x) ((x) & (~BITS_LLT_FREE_PAGE)) -+#define BIT_GET_LLT_FREE_PAGE(x) \ -+ (((x) >> BIT_SHIFT_LLT_FREE_PAGE) & BIT_MASK_LLT_FREE_PAGE) -+#define BIT_SET_LLT_FREE_PAGE(x, v) \ -+ (BIT_CLEAR_LLT_FREE_PAGE(x) | BIT_LLT_FREE_PAGE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AUTO_LLT_V1 (Offset 0x0208) */ -+ -+#define BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1 24 -+#define BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1 0xff -+#define BIT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1(x) \ -+ (((x) & BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1) \ -+ << BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1) -+#define BITS_MAX_TX_PKT_FOR_USB_AND_SDIO_V1 \ -+ (BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1 \ -+ << BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1) -+#define BIT_CLEAR_MAX_TX_PKT_FOR_USB_AND_SDIO_V1(x) \ -+ ((x) & (~BITS_MAX_TX_PKT_FOR_USB_AND_SDIO_V1)) -+#define BIT_GET_MAX_TX_PKT_FOR_USB_AND_SDIO_V1(x) \ -+ (((x) >> BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1) & \ -+ BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1) -+#define BIT_SET_MAX_TX_PKT_FOR_USB_AND_SDIO_V1(x, v) \ -+ (BIT_CLEAR_MAX_TX_PKT_FOR_USB_AND_SDIO_V1(x) | \ -+ BIT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AUTO_LLT_V1 (Offset 0x0208) */ -+ -+#define BIT_SHIFT_MAX_TX_PKT_V1 24 -+#define BIT_MASK_MAX_TX_PKT_V1 0xff -+#define BIT_MAX_TX_PKT_V1(x) \ -+ (((x) & BIT_MASK_MAX_TX_PKT_V1) << BIT_SHIFT_MAX_TX_PKT_V1) -+#define BITS_MAX_TX_PKT_V1 (BIT_MASK_MAX_TX_PKT_V1 << BIT_SHIFT_MAX_TX_PKT_V1) -+#define BIT_CLEAR_MAX_TX_PKT_V1(x) ((x) & (~BITS_MAX_TX_PKT_V1)) -+#define BIT_GET_MAX_TX_PKT_V1(x) \ -+ (((x) >> BIT_SHIFT_MAX_TX_PKT_V1) & BIT_MASK_MAX_TX_PKT_V1) -+#define BIT_SET_MAX_TX_PKT_V1(x, v) \ -+ (BIT_CLEAR_MAX_TX_PKT_V1(x) | BIT_MAX_TX_PKT_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AUTO_LLT_V1 (Offset 0x0208) */ -+ -+#define BIT_TDE_ERROR_STOP_V1 BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DWBCN0_CTRL (Offset 0x0208) */ -+ -+#define BIT_BCN_VALID BIT(16) -+ -+#define BIT_SHIFT_BCN_HEAD 8 -+#define BIT_MASK_BCN_HEAD 0xff -+#define BIT_BCN_HEAD(x) (((x) & BIT_MASK_BCN_HEAD) << BIT_SHIFT_BCN_HEAD) -+#define BITS_BCN_HEAD (BIT_MASK_BCN_HEAD << BIT_SHIFT_BCN_HEAD) -+#define BIT_CLEAR_BCN_HEAD(x) ((x) & (~BITS_BCN_HEAD)) -+#define BIT_GET_BCN_HEAD(x) (((x) >> BIT_SHIFT_BCN_HEAD) & BIT_MASK_BCN_HEAD) -+#define BIT_SET_BCN_HEAD(x, v) (BIT_CLEAR_BCN_HEAD(x) | BIT_BCN_HEAD(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_AUTO_LLT_V1 (Offset 0x0208) */ -+ -+#define BIT_SHIFT_LLT_FREE_PAGE_V1 8 -+#define BIT_MASK_LLT_FREE_PAGE_V1 0xffff -+#define BIT_LLT_FREE_PAGE_V1(x) \ -+ (((x) & BIT_MASK_LLT_FREE_PAGE_V1) << BIT_SHIFT_LLT_FREE_PAGE_V1) -+#define BITS_LLT_FREE_PAGE_V1 \ -+ (BIT_MASK_LLT_FREE_PAGE_V1 << BIT_SHIFT_LLT_FREE_PAGE_V1) -+#define BIT_CLEAR_LLT_FREE_PAGE_V1(x) ((x) & (~BITS_LLT_FREE_PAGE_V1)) -+#define BIT_GET_LLT_FREE_PAGE_V1(x) \ -+ (((x) >> BIT_SHIFT_LLT_FREE_PAGE_V1) & BIT_MASK_LLT_FREE_PAGE_V1) -+#define BIT_SET_LLT_FREE_PAGE_V1(x, v) \ -+ (BIT_CLEAR_LLT_FREE_PAGE_V1(x) | BIT_LLT_FREE_PAGE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AUTO_LLT_V1 (Offset 0x0208) */ -+ -+#define BIT_SHIFT_LLT_FREE_PAGE_V2 8 -+#define BIT_MASK_LLT_FREE_PAGE_V2 0xfff -+#define BIT_LLT_FREE_PAGE_V2(x) \ -+ (((x) & BIT_MASK_LLT_FREE_PAGE_V2) << BIT_SHIFT_LLT_FREE_PAGE_V2) -+#define BITS_LLT_FREE_PAGE_V2 \ -+ (BIT_MASK_LLT_FREE_PAGE_V2 << BIT_SHIFT_LLT_FREE_PAGE_V2) -+#define BIT_CLEAR_LLT_FREE_PAGE_V2(x) ((x) & (~BITS_LLT_FREE_PAGE_V2)) -+#define BIT_GET_LLT_FREE_PAGE_V2(x) \ -+ (((x) >> BIT_SHIFT_LLT_FREE_PAGE_V2) & BIT_MASK_LLT_FREE_PAGE_V2) -+#define BIT_SET_LLT_FREE_PAGE_V2(x, v) \ -+ (BIT_CLEAR_LLT_FREE_PAGE_V2(x) | BIT_LLT_FREE_PAGE_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AUTO_LLT_V1 (Offset 0x0208) */ -+ -+#define BIT_SHIFT_BLK_DESC_NUM 4 -+#define BIT_MASK_BLK_DESC_NUM 0xf -+#define BIT_BLK_DESC_NUM(x) \ -+ (((x) & BIT_MASK_BLK_DESC_NUM) << BIT_SHIFT_BLK_DESC_NUM) -+#define BITS_BLK_DESC_NUM (BIT_MASK_BLK_DESC_NUM << BIT_SHIFT_BLK_DESC_NUM) -+#define BIT_CLEAR_BLK_DESC_NUM(x) ((x) & (~BITS_BLK_DESC_NUM)) -+#define BIT_GET_BLK_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_BLK_DESC_NUM) & BIT_MASK_BLK_DESC_NUM) -+#define BIT_SET_BLK_DESC_NUM(x, v) \ -+ (BIT_CLEAR_BLK_DESC_NUM(x) | BIT_BLK_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AUTO_LLT_V1 (Offset 0x0208) */ -+ -+#define BIT_R_BCN_HEAD_SEL BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AUTO_LLT_V1 (Offset 0x0208) */ -+ -+#define BIT_R_EN_BCN_SW_HEAD_SEL BIT(2) -+#define BIT_LLT_DBG_SEL BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DWBCN0_CTRL (Offset 0x0208) */ -+ -+#define BIT_BLK_DESC_OPT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AUTO_LLT_V1 (Offset 0x0208) */ -+ -+#define BIT_AUTO_INIT_LLT_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_EM_CHKSUM_FIN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_EN_CHKSUM_ERR_FIN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_EMN_PCIE_DMA_MOD BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_EN_PCIE_DMA_MOD BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_EN_TXQUE_CLR BIT(29) -+#define BIT_EN_PCIE_FIFO_MODE BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_SHIFT_PG_UNDER_TH 16 -+#define BIT_MASK_PG_UNDER_TH 0xff -+#define BIT_PG_UNDER_TH(x) \ -+ (((x) & BIT_MASK_PG_UNDER_TH) << BIT_SHIFT_PG_UNDER_TH) -+#define BITS_PG_UNDER_TH (BIT_MASK_PG_UNDER_TH << BIT_SHIFT_PG_UNDER_TH) -+#define BIT_CLEAR_PG_UNDER_TH(x) ((x) & (~BITS_PG_UNDER_TH)) -+#define BIT_GET_PG_UNDER_TH(x) \ -+ (((x) >> BIT_SHIFT_PG_UNDER_TH) & BIT_MASK_PG_UNDER_TH) -+#define BIT_SET_PG_UNDER_TH(x, v) \ -+ (BIT_CLEAR_PG_UNDER_TH(x) | BIT_PG_UNDER_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_SHIFT_PG_UNDER_TH_V2 16 -+#define BIT_MASK_PG_UNDER_TH_V2 0xff -+#define BIT_PG_UNDER_TH_V2(x) \ -+ (((x) & BIT_MASK_PG_UNDER_TH_V2) << BIT_SHIFT_PG_UNDER_TH_V2) -+#define BITS_PG_UNDER_TH_V2 \ -+ (BIT_MASK_PG_UNDER_TH_V2 << BIT_SHIFT_PG_UNDER_TH_V2) -+#define BIT_CLEAR_PG_UNDER_TH_V2(x) ((x) & (~BITS_PG_UNDER_TH_V2)) -+#define BIT_GET_PG_UNDER_TH_V2(x) \ -+ (((x) >> BIT_SHIFT_PG_UNDER_TH_V2) & BIT_MASK_PG_UNDER_TH_V2) -+#define BIT_SET_PG_UNDER_TH_V2(x, v) \ -+ (BIT_CLEAR_PG_UNDER_TH_V2(x) | BIT_PG_UNDER_TH_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_SHIFT_PG_UNDER_TH_V1 16 -+#define BIT_MASK_PG_UNDER_TH_V1 0xfff -+#define BIT_PG_UNDER_TH_V1(x) \ -+ (((x) & BIT_MASK_PG_UNDER_TH_V1) << BIT_SHIFT_PG_UNDER_TH_V1) -+#define BITS_PG_UNDER_TH_V1 \ -+ (BIT_MASK_PG_UNDER_TH_V1 << BIT_SHIFT_PG_UNDER_TH_V1) -+#define BIT_CLEAR_PG_UNDER_TH_V1(x) ((x) & (~BITS_PG_UNDER_TH_V1)) -+#define BIT_GET_PG_UNDER_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_PG_UNDER_TH_V1) & BIT_MASK_PG_UNDER_TH_V1) -+#define BIT_SET_PG_UNDER_TH_V1(x, v) \ -+ (BIT_CLEAR_PG_UNDER_TH_V1(x) | BIT_PG_UNDER_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_EN_RESTORE_H2C_BY_RST BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_EN_RESET_RESTORE_H2C BIT(15) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_R_EN_RESET_RESTORE_H2C BIT(15) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_RESTORE_H2C_ADDRESS BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_SDIO_TDE_FINISH BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_OFFSET_CHK (Offset 0x020C) */ -+ -+#define BIT_SDIO_TXDESC_CHKSUM_EN BIT(13) -+#define BIT_RST_RDPTR BIT(12) -+#define BIT_RST_WRPTR BIT(11) -+#define BIT_CHK_PG_TH_EN BIT(10) -+#define BIT_DROP_DATA_EN BIT(9) -+#define BIT_CHECK_OFFSET_EN BIT(8) -+ -+#define BIT_SHIFT_CHECK_OFFSET 0 -+#define BIT_MASK_CHECK_OFFSET 0xff -+#define BIT_CHECK_OFFSET(x) \ -+ (((x) & BIT_MASK_CHECK_OFFSET) << BIT_SHIFT_CHECK_OFFSET) -+#define BITS_CHECK_OFFSET (BIT_MASK_CHECK_OFFSET << BIT_SHIFT_CHECK_OFFSET) -+#define BIT_CLEAR_CHECK_OFFSET(x) ((x) & (~BITS_CHECK_OFFSET)) -+#define BIT_GET_CHECK_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_CHECK_OFFSET) & BIT_MASK_CHECK_OFFSET) -+#define BIT_SET_CHECK_OFFSET(x, v) \ -+ (BIT_CLEAR_CHECK_OFFSET(x) | BIT_CHECK_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_LD_RQPN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_AMSDU_PKT_SIZE_ERR BIT(31) -+#define BIT_AMSDU_EN_ERR BIT(30) -+#define BIT_CHKSUM_AMSDU_EN_ERR BIT(29) -+#define BIT_TXPKTBF_REQ_ERR BIT(28) -+#define BIT_OQT_UDN_16 BIT(27) -+#define BIT_OQT_OVF_16 BIT(26) -+#define BIT_OQT_UDN_14_15 BIT(25) -+#define BIT_OQT_OVF_14_15 BIT(24) -+#define BIT_OQT_UDN_13 BIT(23) -+#define BIT_OQT_OVF_13 BIT(22) -+#define BIT_OQT_UDN_12 BIT(21) -+#define BIT_OQT_OVF_12 BIT(20) -+#define BIT_OQT_UDN_8_11 BIT(19) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_TXPKTBUF_REQ_ERR BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_OQT_OVF_8_11 BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_HI_OQT_UDN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_OQT_UDN_4_7 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_HI_OQT_OVF BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_OQT_OVF_4_7 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_PAYLOAD_CHKSUM_ERR BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_RX_CLOSE_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_PAYLOAD_UDN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_BCNQ BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_PAYLOAD_OVF BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_MGQ BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_DSC_CHKSUM_FAIL BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_VOQ BIT(12) -+#define BIT_UNKNOWN_QSEL BIT(11) -+#define BIT_STOP_VIQ BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_EP_QSEL_DIFF BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_BEQ BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_TX_OFFS_UNMATCH BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_BKQ BIT(9) -+#define BIT_TXOQT_UDN BIT(8) -+#define BIT_STOP_RXQ BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_TXOQT_UDN_0_3 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_TXOQT_OVF BIT(7) -+#define BIT_STOP_HI7Q BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_TXOQT_OVF_0_3 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_TXDMA_SFF_UDN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_HI6Q BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_TXDMA_SFF_OVF BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_HI5Q BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_LLT_NULL_PG BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_HI4Q BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_PAGE_UDN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_HI3Q BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_PAGE_OVF BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_HI2Q BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_TXFF_PG_UDN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_HI1Q BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_TXFF_PG_OVF BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXDMA_STATUS (Offset 0x0210) */ -+ -+#define BIT_STOP_HI0Q BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RQPN_NPQ (Offset 0x0214) */ -+ -+#define BIT_SHIFT_EXQ_AVAL_PG 24 -+#define BIT_MASK_EXQ_AVAL_PG 0xff -+#define BIT_EXQ_AVAL_PG(x) \ -+ (((x) & BIT_MASK_EXQ_AVAL_PG) << BIT_SHIFT_EXQ_AVAL_PG) -+#define BITS_EXQ_AVAL_PG (BIT_MASK_EXQ_AVAL_PG << BIT_SHIFT_EXQ_AVAL_PG) -+#define BIT_CLEAR_EXQ_AVAL_PG(x) ((x) & (~BITS_EXQ_AVAL_PG)) -+#define BIT_GET_EXQ_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_EXQ_AVAL_PG) & BIT_MASK_EXQ_AVAL_PG) -+#define BIT_SET_EXQ_AVAL_PG(x, v) \ -+ (BIT_CLEAR_EXQ_AVAL_PG(x) | BIT_EXQ_AVAL_PG(v)) -+ -+#define BIT_SHIFT_EXQ 16 -+#define BIT_MASK_EXQ 0xff -+#define BIT_EXQ(x) (((x) & BIT_MASK_EXQ) << BIT_SHIFT_EXQ) -+#define BITS_EXQ (BIT_MASK_EXQ << BIT_SHIFT_EXQ) -+#define BIT_CLEAR_EXQ(x) ((x) & (~BITS_EXQ)) -+#define BIT_GET_EXQ(x) (((x) >> BIT_SHIFT_EXQ) & BIT_MASK_EXQ) -+#define BIT_SET_EXQ(x, v) (BIT_CLEAR_EXQ(x) | BIT_EXQ(v)) -+ -+#define BIT_SHIFT_NPQ 0 -+#define BIT_MASK_NPQ 0xff -+#define BIT_NPQ(x) (((x) & BIT_MASK_NPQ) << BIT_SHIFT_NPQ) -+#define BITS_NPQ (BIT_MASK_NPQ << BIT_SHIFT_NPQ) -+#define BIT_CLEAR_NPQ(x) ((x) & (~BITS_NPQ)) -+#define BIT_GET_NPQ(x) (((x) >> BIT_SHIFT_NPQ) & BIT_MASK_NPQ) -+#define BIT_SET_NPQ(x, v) (BIT_CLEAR_NPQ(x) | BIT_NPQ(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT1 (Offset 0x0218) */ -+ -+#define BIT_HPQ_INT_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TQPNT1 (Offset 0x0218) */ -+ -+#define BIT_SHIFT_NPQ_HIGH_TH 24 -+#define BIT_MASK_NPQ_HIGH_TH 0xff -+#define BIT_NPQ_HIGH_TH(x) \ -+ (((x) & BIT_MASK_NPQ_HIGH_TH) << BIT_SHIFT_NPQ_HIGH_TH) -+#define BITS_NPQ_HIGH_TH (BIT_MASK_NPQ_HIGH_TH << BIT_SHIFT_NPQ_HIGH_TH) -+#define BIT_CLEAR_NPQ_HIGH_TH(x) ((x) & (~BITS_NPQ_HIGH_TH)) -+#define BIT_GET_NPQ_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_NPQ_HIGH_TH) & BIT_MASK_NPQ_HIGH_TH) -+#define BIT_SET_NPQ_HIGH_TH(x, v) \ -+ (BIT_CLEAR_NPQ_HIGH_TH(x) | BIT_NPQ_HIGH_TH(v)) -+ -+#define BIT_SHIFT_NPQ_LOW_TH 16 -+#define BIT_MASK_NPQ_LOW_TH 0xff -+#define BIT_NPQ_LOW_TH(x) (((x) & BIT_MASK_NPQ_LOW_TH) << BIT_SHIFT_NPQ_LOW_TH) -+#define BITS_NPQ_LOW_TH (BIT_MASK_NPQ_LOW_TH << BIT_SHIFT_NPQ_LOW_TH) -+#define BIT_CLEAR_NPQ_LOW_TH(x) ((x) & (~BITS_NPQ_LOW_TH)) -+#define BIT_GET_NPQ_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_NPQ_LOW_TH) & BIT_MASK_NPQ_LOW_TH) -+#define BIT_SET_NPQ_LOW_TH(x, v) (BIT_CLEAR_NPQ_LOW_TH(x) | BIT_NPQ_LOW_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT1 (Offset 0x0218) */ -+ -+#define BIT_SHIFT_HPQ_HIGH_TH_V1 16 -+#define BIT_MASK_HPQ_HIGH_TH_V1 0xfff -+#define BIT_HPQ_HIGH_TH_V1(x) \ -+ (((x) & BIT_MASK_HPQ_HIGH_TH_V1) << BIT_SHIFT_HPQ_HIGH_TH_V1) -+#define BITS_HPQ_HIGH_TH_V1 \ -+ (BIT_MASK_HPQ_HIGH_TH_V1 << BIT_SHIFT_HPQ_HIGH_TH_V1) -+#define BIT_CLEAR_HPQ_HIGH_TH_V1(x) ((x) & (~BITS_HPQ_HIGH_TH_V1)) -+#define BIT_GET_HPQ_HIGH_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_HPQ_HIGH_TH_V1) & BIT_MASK_HPQ_HIGH_TH_V1) -+#define BIT_SET_HPQ_HIGH_TH_V1(x, v) \ -+ (BIT_CLEAR_HPQ_HIGH_TH_V1(x) | BIT_HPQ_HIGH_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DMA_RQPN_INFO_PUB (Offset 0x0218) */ -+ -+#define BIT_SHIFT_PUB_AVAL_PG 16 -+#define BIT_MASK_PUB_AVAL_PG 0xfff -+#define BIT_PUB_AVAL_PG(x) \ -+ (((x) & BIT_MASK_PUB_AVAL_PG) << BIT_SHIFT_PUB_AVAL_PG) -+#define BITS_PUB_AVAL_PG (BIT_MASK_PUB_AVAL_PG << BIT_SHIFT_PUB_AVAL_PG) -+#define BIT_CLEAR_PUB_AVAL_PG(x) ((x) & (~BITS_PUB_AVAL_PG)) -+#define BIT_GET_PUB_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_PUB_AVAL_PG) & BIT_MASK_PUB_AVAL_PG) -+#define BIT_SET_PUB_AVAL_PG(x, v) \ -+ (BIT_CLEAR_PUB_AVAL_PG(x) | BIT_PUB_AVAL_PG(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TQPNT1 (Offset 0x0218) */ -+ -+#define BIT_SHIFT_HPQ_HIGH_TH 8 -+#define BIT_MASK_HPQ_HIGH_TH 0xff -+#define BIT_HPQ_HIGH_TH(x) \ -+ (((x) & BIT_MASK_HPQ_HIGH_TH) << BIT_SHIFT_HPQ_HIGH_TH) -+#define BITS_HPQ_HIGH_TH (BIT_MASK_HPQ_HIGH_TH << BIT_SHIFT_HPQ_HIGH_TH) -+#define BIT_CLEAR_HPQ_HIGH_TH(x) ((x) & (~BITS_HPQ_HIGH_TH)) -+#define BIT_GET_HPQ_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_HPQ_HIGH_TH) & BIT_MASK_HPQ_HIGH_TH) -+#define BIT_SET_HPQ_HIGH_TH(x, v) \ -+ (BIT_CLEAR_HPQ_HIGH_TH(x) | BIT_HPQ_HIGH_TH(v)) -+ -+#define BIT_SHIFT_HPQ_LOW_TH 0 -+#define BIT_MASK_HPQ_LOW_TH 0xff -+#define BIT_HPQ_LOW_TH(x) (((x) & BIT_MASK_HPQ_LOW_TH) << BIT_SHIFT_HPQ_LOW_TH) -+#define BITS_HPQ_LOW_TH (BIT_MASK_HPQ_LOW_TH << BIT_SHIFT_HPQ_LOW_TH) -+#define BIT_CLEAR_HPQ_LOW_TH(x) ((x) & (~BITS_HPQ_LOW_TH)) -+#define BIT_GET_HPQ_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_HPQ_LOW_TH) & BIT_MASK_HPQ_LOW_TH) -+#define BIT_SET_HPQ_LOW_TH(x, v) (BIT_CLEAR_HPQ_LOW_TH(x) | BIT_HPQ_LOW_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT1 (Offset 0x0218) */ -+ -+#define BIT_SHIFT_HPQ_LOW_TH_V1 0 -+#define BIT_MASK_HPQ_LOW_TH_V1 0xfff -+#define BIT_HPQ_LOW_TH_V1(x) \ -+ (((x) & BIT_MASK_HPQ_LOW_TH_V1) << BIT_SHIFT_HPQ_LOW_TH_V1) -+#define BITS_HPQ_LOW_TH_V1 (BIT_MASK_HPQ_LOW_TH_V1 << BIT_SHIFT_HPQ_LOW_TH_V1) -+#define BIT_CLEAR_HPQ_LOW_TH_V1(x) ((x) & (~BITS_HPQ_LOW_TH_V1)) -+#define BIT_GET_HPQ_LOW_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_HPQ_LOW_TH_V1) & BIT_MASK_HPQ_LOW_TH_V1) -+#define BIT_SET_HPQ_LOW_TH_V1(x, v) \ -+ (BIT_CLEAR_HPQ_LOW_TH_V1(x) | BIT_HPQ_LOW_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DMA_RQPN_INFO_PUB (Offset 0x0218) */ -+ -+#define BIT_SHIFT_PUB_RSVD_PG 0 -+#define BIT_MASK_PUB_RSVD_PG 0xfff -+#define BIT_PUB_RSVD_PG(x) \ -+ (((x) & BIT_MASK_PUB_RSVD_PG) << BIT_SHIFT_PUB_RSVD_PG) -+#define BITS_PUB_RSVD_PG (BIT_MASK_PUB_RSVD_PG << BIT_SHIFT_PUB_RSVD_PG) -+#define BIT_CLEAR_PUB_RSVD_PG(x) ((x) & (~BITS_PUB_RSVD_PG)) -+#define BIT_GET_PUB_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_PUB_RSVD_PG) & BIT_MASK_PUB_RSVD_PG) -+#define BIT_SET_PUB_RSVD_PG(x, v) \ -+ (BIT_CLEAR_PUB_RSVD_PG(x) | BIT_PUB_RSVD_PG(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT2 (Offset 0x021C) */ -+ -+#define BIT_NPQ_INT_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_2_V1 (Offset 0x021C) */ -+ -+#define BIT_LD_RQPN_V1 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TQPNT2 (Offset 0x021C) */ -+ -+#define BIT_SHIFT_EXQ_HIGH_TH 24 -+#define BIT_MASK_EXQ_HIGH_TH 0xff -+#define BIT_EXQ_HIGH_TH(x) \ -+ (((x) & BIT_MASK_EXQ_HIGH_TH) << BIT_SHIFT_EXQ_HIGH_TH) -+#define BITS_EXQ_HIGH_TH (BIT_MASK_EXQ_HIGH_TH << BIT_SHIFT_EXQ_HIGH_TH) -+#define BIT_CLEAR_EXQ_HIGH_TH(x) ((x) & (~BITS_EXQ_HIGH_TH)) -+#define BIT_GET_EXQ_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_EXQ_HIGH_TH) & BIT_MASK_EXQ_HIGH_TH) -+#define BIT_SET_EXQ_HIGH_TH(x, v) \ -+ (BIT_CLEAR_EXQ_HIGH_TH(x) | BIT_EXQ_HIGH_TH(v)) -+ -+#define BIT_SHIFT_EXQ_LOW_TH 16 -+#define BIT_MASK_EXQ_LOW_TH 0xff -+#define BIT_EXQ_LOW_TH(x) (((x) & BIT_MASK_EXQ_LOW_TH) << BIT_SHIFT_EXQ_LOW_TH) -+#define BITS_EXQ_LOW_TH (BIT_MASK_EXQ_LOW_TH << BIT_SHIFT_EXQ_LOW_TH) -+#define BIT_CLEAR_EXQ_LOW_TH(x) ((x) & (~BITS_EXQ_LOW_TH)) -+#define BIT_GET_EXQ_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_EXQ_LOW_TH) & BIT_MASK_EXQ_LOW_TH) -+#define BIT_SET_EXQ_LOW_TH(x, v) (BIT_CLEAR_EXQ_LOW_TH(x) | BIT_EXQ_LOW_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT2 (Offset 0x021C) */ -+ -+#define BIT_SHIFT_NPQ_HIGH_TH_V1 16 -+#define BIT_MASK_NPQ_HIGH_TH_V1 0xfff -+#define BIT_NPQ_HIGH_TH_V1(x) \ -+ (((x) & BIT_MASK_NPQ_HIGH_TH_V1) << BIT_SHIFT_NPQ_HIGH_TH_V1) -+#define BITS_NPQ_HIGH_TH_V1 \ -+ (BIT_MASK_NPQ_HIGH_TH_V1 << BIT_SHIFT_NPQ_HIGH_TH_V1) -+#define BIT_CLEAR_NPQ_HIGH_TH_V1(x) ((x) & (~BITS_NPQ_HIGH_TH_V1)) -+#define BIT_GET_NPQ_HIGH_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_NPQ_HIGH_TH_V1) & BIT_MASK_NPQ_HIGH_TH_V1) -+#define BIT_SET_NPQ_HIGH_TH_V1(x, v) \ -+ (BIT_CLEAR_NPQ_HIGH_TH_V1(x) | BIT_NPQ_HIGH_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_2_V1 (Offset 0x021C) */ -+ -+#define BIT_CH16_PUBLIC_DIS BIT(16) -+#define BIT_CH15_PUBLIC_DIS BIT(15) -+#define BIT_CH14_PUBLIC_DIS BIT(14) -+#define BIT_CH13_PUBLIC_DIS BIT(13) -+#define BIT_CH12_PUBLIC_DIS BIT(12) -+#define BIT_CH11_PUBLIC_DIS BIT(11) -+#define BIT_CH10_PUBLIC_DIS BIT(10) -+#define BIT_CH9_PUBLIC_DIS BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TQPNT2 (Offset 0x021C) */ -+ -+#define BIT_SHIFT_LPQ_HIGH_TH 8 -+#define BIT_MASK_LPQ_HIGH_TH 0xff -+#define BIT_LPQ_HIGH_TH(x) \ -+ (((x) & BIT_MASK_LPQ_HIGH_TH) << BIT_SHIFT_LPQ_HIGH_TH) -+#define BITS_LPQ_HIGH_TH (BIT_MASK_LPQ_HIGH_TH << BIT_SHIFT_LPQ_HIGH_TH) -+#define BIT_CLEAR_LPQ_HIGH_TH(x) ((x) & (~BITS_LPQ_HIGH_TH)) -+#define BIT_GET_LPQ_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_LPQ_HIGH_TH) & BIT_MASK_LPQ_HIGH_TH) -+#define BIT_SET_LPQ_HIGH_TH(x, v) \ -+ (BIT_CLEAR_LPQ_HIGH_TH(x) | BIT_LPQ_HIGH_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_2_V1 (Offset 0x021C) */ -+ -+#define BIT_CH8_PUBLIC_DIS BIT(8) -+#define BIT_CH7_PUBLIC_DIS BIT(7) -+#define BIT_CH6_PUBLIC_DIS BIT(6) -+#define BIT_CH5_PUBLIC_DIS BIT(5) -+#define BIT_CH4_PUBLIC_DIS BIT(4) -+#define BIT_CH3_PUBLIC_DIS BIT(3) -+#define BIT_CH2_PUBLIC_DIS BIT(2) -+#define BIT_CH1_PUBLIC_DIS BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TQPNT2 (Offset 0x021C) */ -+ -+#define BIT_SHIFT_LPQ_LOW_TH 0 -+#define BIT_MASK_LPQ_LOW_TH 0xff -+#define BIT_LPQ_LOW_TH(x) (((x) & BIT_MASK_LPQ_LOW_TH) << BIT_SHIFT_LPQ_LOW_TH) -+#define BITS_LPQ_LOW_TH (BIT_MASK_LPQ_LOW_TH << BIT_SHIFT_LPQ_LOW_TH) -+#define BIT_CLEAR_LPQ_LOW_TH(x) ((x) & (~BITS_LPQ_LOW_TH)) -+#define BIT_GET_LPQ_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_LPQ_LOW_TH) & BIT_MASK_LPQ_LOW_TH) -+#define BIT_SET_LPQ_LOW_TH(x, v) (BIT_CLEAR_LPQ_LOW_TH(x) | BIT_LPQ_LOW_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT2 (Offset 0x021C) */ -+ -+#define BIT_SHIFT_NPQ_LOW_TH_V1 0 -+#define BIT_MASK_NPQ_LOW_TH_V1 0xfff -+#define BIT_NPQ_LOW_TH_V1(x) \ -+ (((x) & BIT_MASK_NPQ_LOW_TH_V1) << BIT_SHIFT_NPQ_LOW_TH_V1) -+#define BITS_NPQ_LOW_TH_V1 (BIT_MASK_NPQ_LOW_TH_V1 << BIT_SHIFT_NPQ_LOW_TH_V1) -+#define BIT_CLEAR_NPQ_LOW_TH_V1(x) ((x) & (~BITS_NPQ_LOW_TH_V1)) -+#define BIT_GET_NPQ_LOW_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_NPQ_LOW_TH_V1) & BIT_MASK_NPQ_LOW_TH_V1) -+#define BIT_SET_NPQ_LOW_TH_V1(x, v) \ -+ (BIT_CLEAR_NPQ_LOW_TH_V1(x) | BIT_NPQ_LOW_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_2_V1 (Offset 0x021C) */ -+ -+#define BIT_CH0_PUBLIC_DIS BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT3 (Offset 0x0220) */ -+ -+#define BIT_LPQ_INT_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_2 (Offset 0x0220) */ -+ -+#define BIT_BCN0_EXT_VALID BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT3 (Offset 0x0220) */ -+ -+#define BIT_SHIFT_LPQ_HIGH_TH_V1 16 -+#define BIT_MASK_LPQ_HIGH_TH_V1 0xfff -+#define BIT_LPQ_HIGH_TH_V1(x) \ -+ (((x) & BIT_MASK_LPQ_HIGH_TH_V1) << BIT_SHIFT_LPQ_HIGH_TH_V1) -+#define BITS_LPQ_HIGH_TH_V1 \ -+ (BIT_MASK_LPQ_HIGH_TH_V1 << BIT_SHIFT_LPQ_HIGH_TH_V1) -+#define BIT_CLEAR_LPQ_HIGH_TH_V1(x) ((x) & (~BITS_LPQ_HIGH_TH_V1)) -+#define BIT_GET_LPQ_HIGH_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_LPQ_HIGH_TH_V1) & BIT_MASK_LPQ_HIGH_TH_V1) -+#define BIT_SET_LPQ_HIGH_TH_V1(x, v) \ -+ (BIT_CLEAR_LPQ_HIGH_TH_V1(x) | BIT_LPQ_HIGH_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_2 (Offset 0x0220) */ -+ -+#define BIT_SHIFT_BCN0_EXT_HEAD 16 -+#define BIT_MASK_BCN0_EXT_HEAD 0xfff -+#define BIT_BCN0_EXT_HEAD(x) \ -+ (((x) & BIT_MASK_BCN0_EXT_HEAD) << BIT_SHIFT_BCN0_EXT_HEAD) -+#define BITS_BCN0_EXT_HEAD (BIT_MASK_BCN0_EXT_HEAD << BIT_SHIFT_BCN0_EXT_HEAD) -+#define BIT_CLEAR_BCN0_EXT_HEAD(x) ((x) & (~BITS_BCN0_EXT_HEAD)) -+#define BIT_GET_BCN0_EXT_HEAD(x) \ -+ (((x) >> BIT_SHIFT_BCN0_EXT_HEAD) & BIT_MASK_BCN0_EXT_HEAD) -+#define BIT_SET_BCN0_EXT_HEAD(x, v) \ -+ (BIT_CLEAR_BCN0_EXT_HEAD(x) | BIT_BCN0_EXT_HEAD(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_CH4_7 16 -+#define BIT_MASK_TXPKTNUM_CH4_7 0xfff -+#define BIT_TXPKTNUM_CH4_7(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH4_7) << BIT_SHIFT_TXPKTNUM_CH4_7) -+#define BITS_TXPKTNUM_CH4_7 \ -+ (BIT_MASK_TXPKTNUM_CH4_7 << BIT_SHIFT_TXPKTNUM_CH4_7) -+#define BIT_CLEAR_TXPKTNUM_CH4_7(x) ((x) & (~BITS_TXPKTNUM_CH4_7)) -+#define BIT_GET_TXPKTNUM_CH4_7(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH4_7) & BIT_MASK_TXPKTNUM_CH4_7) -+#define BIT_SET_TXPKTNUM_CH4_7(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH4_7(x) | BIT_TXPKTNUM_CH4_7(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_CH12 16 -+#define BIT_MASK_TXPKTNUM_CH12 0xfff -+#define BIT_TXPKTNUM_CH12(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH12) << BIT_SHIFT_TXPKTNUM_CH12) -+#define BITS_TXPKTNUM_CH12 (BIT_MASK_TXPKTNUM_CH12 << BIT_SHIFT_TXPKTNUM_CH12) -+#define BIT_CLEAR_TXPKTNUM_CH12(x) ((x) & (~BITS_TXPKTNUM_CH12)) -+#define BIT_GET_TXPKTNUM_CH12(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH12) & BIT_MASK_TXPKTNUM_CH12) -+#define BIT_SET_TXPKTNUM_CH12(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH12(x) | BIT_TXPKTNUM_CH12(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_CH14_15 16 -+#define BIT_MASK_TXPKTNUM_CH14_15 0xfff -+#define BIT_TXPKTNUM_CH14_15(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH14_15) << BIT_SHIFT_TXPKTNUM_CH14_15) -+#define BITS_TXPKTNUM_CH14_15 \ -+ (BIT_MASK_TXPKTNUM_CH14_15 << BIT_SHIFT_TXPKTNUM_CH14_15) -+#define BIT_CLEAR_TXPKTNUM_CH14_15(x) ((x) & (~BITS_TXPKTNUM_CH14_15)) -+#define BIT_GET_TXPKTNUM_CH14_15(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH14_15) & BIT_MASK_TXPKTNUM_CH14_15) -+#define BIT_SET_TXPKTNUM_CH14_15(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH14_15(x) | BIT_TXPKTNUM_CH14_15(v)) -+ -+#define BIT_BCN4_VALID BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TDE_DEBUG (Offset 0x0220) */ -+ -+#define BIT_SHIFT_TDE_DEBUG 0 -+#define BIT_MASK_TDE_DEBUG 0xffffffffL -+#define BIT_TDE_DEBUG(x) (((x) & BIT_MASK_TDE_DEBUG) << BIT_SHIFT_TDE_DEBUG) -+#define BITS_TDE_DEBUG (BIT_MASK_TDE_DEBUG << BIT_SHIFT_TDE_DEBUG) -+#define BIT_CLEAR_TDE_DEBUG(x) ((x) & (~BITS_TDE_DEBUG)) -+#define BIT_GET_TDE_DEBUG(x) (((x) >> BIT_SHIFT_TDE_DEBUG) & BIT_MASK_TDE_DEBUG) -+#define BIT_SET_TDE_DEBUG(x, v) (BIT_CLEAR_TDE_DEBUG(x) | BIT_TDE_DEBUG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT3 (Offset 0x0220) */ -+ -+#define BIT_SHIFT_LPQ_LOW_TH_V1 0 -+#define BIT_MASK_LPQ_LOW_TH_V1 0xfff -+#define BIT_LPQ_LOW_TH_V1(x) \ -+ (((x) & BIT_MASK_LPQ_LOW_TH_V1) << BIT_SHIFT_LPQ_LOW_TH_V1) -+#define BITS_LPQ_LOW_TH_V1 (BIT_MASK_LPQ_LOW_TH_V1 << BIT_SHIFT_LPQ_LOW_TH_V1) -+#define BIT_CLEAR_LPQ_LOW_TH_V1(x) ((x) & (~BITS_LPQ_LOW_TH_V1)) -+#define BIT_GET_LPQ_LOW_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_LPQ_LOW_TH_V1) & BIT_MASK_LPQ_LOW_TH_V1) -+#define BIT_SET_LPQ_LOW_TH_V1(x, v) \ -+ (BIT_CLEAR_LPQ_LOW_TH_V1(x) | BIT_LPQ_LOW_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_2 (Offset 0x0220) */ -+ -+#define BIT_SHIFT_BCN4_HEAD 0 -+#define BIT_MASK_BCN4_HEAD 0xfff -+#define BIT_BCN4_HEAD(x) (((x) & BIT_MASK_BCN4_HEAD) << BIT_SHIFT_BCN4_HEAD) -+#define BITS_BCN4_HEAD (BIT_MASK_BCN4_HEAD << BIT_SHIFT_BCN4_HEAD) -+#define BIT_CLEAR_BCN4_HEAD(x) ((x) & (~BITS_BCN4_HEAD)) -+#define BIT_GET_BCN4_HEAD(x) (((x) >> BIT_SHIFT_BCN4_HEAD) & BIT_MASK_BCN4_HEAD) -+#define BIT_SET_BCN4_HEAD(x, v) (BIT_CLEAR_BCN4_HEAD(x) | BIT_BCN4_HEAD(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_CH0_3 0 -+#define BIT_MASK_TXPKTNUM_CH0_3 0xfff -+#define BIT_TXPKTNUM_CH0_3(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH0_3) << BIT_SHIFT_TXPKTNUM_CH0_3) -+#define BITS_TXPKTNUM_CH0_3 \ -+ (BIT_MASK_TXPKTNUM_CH0_3 << BIT_SHIFT_TXPKTNUM_CH0_3) -+#define BIT_CLEAR_TXPKTNUM_CH0_3(x) ((x) & (~BITS_TXPKTNUM_CH0_3)) -+#define BIT_GET_TXPKTNUM_CH0_3(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH0_3) & BIT_MASK_TXPKTNUM_CH0_3) -+#define BIT_SET_TXPKTNUM_CH0_3(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH0_3(x) | BIT_TXPKTNUM_CH0_3(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_CH8_11 0 -+#define BIT_MASK_TXPKTNUM_CH8_11 0xfff -+#define BIT_TXPKTNUM_CH8_11(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH8_11) << BIT_SHIFT_TXPKTNUM_CH8_11) -+#define BITS_TXPKTNUM_CH8_11 \ -+ (BIT_MASK_TXPKTNUM_CH8_11 << BIT_SHIFT_TXPKTNUM_CH8_11) -+#define BIT_CLEAR_TXPKTNUM_CH8_11(x) ((x) & (~BITS_TXPKTNUM_CH8_11)) -+#define BIT_GET_TXPKTNUM_CH8_11(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH8_11) & BIT_MASK_TXPKTNUM_CH8_11) -+#define BIT_SET_TXPKTNUM_CH8_11(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH8_11(x) | BIT_TXPKTNUM_CH8_11(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_CH13 0 -+#define BIT_MASK_TXPKTNUM_CH13 0xfff -+#define BIT_TXPKTNUM_CH13(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH13) << BIT_SHIFT_TXPKTNUM_CH13) -+#define BITS_TXPKTNUM_CH13 (BIT_MASK_TXPKTNUM_CH13 << BIT_SHIFT_TXPKTNUM_CH13) -+#define BIT_CLEAR_TXPKTNUM_CH13(x) ((x) & (~BITS_TXPKTNUM_CH13)) -+#define BIT_GET_TXPKTNUM_CH13(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH13) & BIT_MASK_TXPKTNUM_CH13) -+#define BIT_SET_TXPKTNUM_CH13(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH13(x) | BIT_TXPKTNUM_CH13(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_CH16 0 -+#define BIT_MASK_TXPKTNUM_CH16 0xfff -+#define BIT_TXPKTNUM_CH16(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH16) << BIT_SHIFT_TXPKTNUM_CH16) -+#define BITS_TXPKTNUM_CH16 (BIT_MASK_TXPKTNUM_CH16 << BIT_SHIFT_TXPKTNUM_CH16) -+#define BIT_CLEAR_TXPKTNUM_CH16(x) ((x) & (~BITS_TXPKTNUM_CH16)) -+#define BIT_GET_TXPKTNUM_CH16(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH16) & BIT_MASK_TXPKTNUM_CH16) -+#define BIT_SET_TXPKTNUM_CH16(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH16(x) | BIT_TXPKTNUM_CH16(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT4 (Offset 0x0224) */ -+ -+#define BIT_EXQ_INT_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AUTO_LLT (Offset 0x0224) */ -+ -+#define BIT_SHIFT_TXPKTNUM_V1 24 -+#define BIT_MASK_TXPKTNUM_V1 0xff -+#define BIT_TXPKTNUM_V1(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_V1) << BIT_SHIFT_TXPKTNUM_V1) -+#define BITS_TXPKTNUM_V1 (BIT_MASK_TXPKTNUM_V1 << BIT_SHIFT_TXPKTNUM_V1) -+#define BIT_CLEAR_TXPKTNUM_V1(x) ((x) & (~BITS_TXPKTNUM_V1)) -+#define BIT_GET_TXPKTNUM_V1(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_V1) & BIT_MASK_TXPKTNUM_V1) -+#define BIT_SET_TXPKTNUM_V1(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_V1(x) | BIT_TXPKTNUM_V1(v)) -+ -+#define BIT_TDE_DBG_SEL BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_AUTO_LLT (Offset 0x0224) */ -+ -+#define BIT_MASK_QSEL_DIFF BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AUTO_LLT (Offset 0x0224) */ -+ -+#define BIT_AUTO_INIT_LLT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT4 (Offset 0x0224) */ -+ -+#define BIT_SHIFT_EXQ_HIGH_TH_V1 16 -+#define BIT_MASK_EXQ_HIGH_TH_V1 0xfff -+#define BIT_EXQ_HIGH_TH_V1(x) \ -+ (((x) & BIT_MASK_EXQ_HIGH_TH_V1) << BIT_SHIFT_EXQ_HIGH_TH_V1) -+#define BITS_EXQ_HIGH_TH_V1 \ -+ (BIT_MASK_EXQ_HIGH_TH_V1 << BIT_SHIFT_EXQ_HIGH_TH_V1) -+#define BIT_CLEAR_EXQ_HIGH_TH_V1(x) ((x) & (~BITS_EXQ_HIGH_TH_V1)) -+#define BIT_GET_EXQ_HIGH_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_EXQ_HIGH_TH_V1) & BIT_MASK_EXQ_HIGH_TH_V1) -+#define BIT_SET_EXQ_HIGH_TH_V1(x, v) \ -+ (BIT_CLEAR_EXQ_HIGH_TH_V1(x) | BIT_EXQ_HIGH_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AUTO_LLT (Offset 0x0224) */ -+ -+#define BIT_SHIFT_TX_OQT_HE_FREE_SPACE 8 -+#define BIT_MASK_TX_OQT_HE_FREE_SPACE 0xff -+#define BIT_TX_OQT_HE_FREE_SPACE(x) \ -+ (((x) & BIT_MASK_TX_OQT_HE_FREE_SPACE) \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE) -+#define BITS_TX_OQT_HE_FREE_SPACE \ -+ (BIT_MASK_TX_OQT_HE_FREE_SPACE << BIT_SHIFT_TX_OQT_HE_FREE_SPACE) -+#define BIT_CLEAR_TX_OQT_HE_FREE_SPACE(x) ((x) & (~BITS_TX_OQT_HE_FREE_SPACE)) -+#define BIT_GET_TX_OQT_HE_FREE_SPACE(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_HE_FREE_SPACE) & \ -+ BIT_MASK_TX_OQT_HE_FREE_SPACE) -+#define BIT_SET_TX_OQT_HE_FREE_SPACE(x, v) \ -+ (BIT_CLEAR_TX_OQT_HE_FREE_SPACE(x) | BIT_TX_OQT_HE_FREE_SPACE(v)) -+ -+#define BIT_SHIFT_TX_OQT_NL_FREE_SPACE 0 -+#define BIT_MASK_TX_OQT_NL_FREE_SPACE 0xff -+#define BIT_TX_OQT_NL_FREE_SPACE(x) \ -+ (((x) & BIT_MASK_TX_OQT_NL_FREE_SPACE) \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE) -+#define BITS_TX_OQT_NL_FREE_SPACE \ -+ (BIT_MASK_TX_OQT_NL_FREE_SPACE << BIT_SHIFT_TX_OQT_NL_FREE_SPACE) -+#define BIT_CLEAR_TX_OQT_NL_FREE_SPACE(x) ((x) & (~BITS_TX_OQT_NL_FREE_SPACE)) -+#define BIT_GET_TX_OQT_NL_FREE_SPACE(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_NL_FREE_SPACE) & \ -+ BIT_MASK_TX_OQT_NL_FREE_SPACE) -+#define BIT_SET_TX_OQT_NL_FREE_SPACE(x, v) \ -+ (BIT_CLEAR_TX_OQT_NL_FREE_SPACE(x) | BIT_TX_OQT_NL_FREE_SPACE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TQPNT4 (Offset 0x0224) */ -+ -+#define BIT_SHIFT_EXQ_LOW_TH_V1 0 -+#define BIT_MASK_EXQ_LOW_TH_V1 0xfff -+#define BIT_EXQ_LOW_TH_V1(x) \ -+ (((x) & BIT_MASK_EXQ_LOW_TH_V1) << BIT_SHIFT_EXQ_LOW_TH_V1) -+#define BITS_EXQ_LOW_TH_V1 (BIT_MASK_EXQ_LOW_TH_V1 << BIT_SHIFT_EXQ_LOW_TH_V1) -+#define BIT_CLEAR_EXQ_LOW_TH_V1(x) ((x) & (~BITS_EXQ_LOW_TH_V1)) -+#define BIT_GET_EXQ_LOW_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_EXQ_LOW_TH_V1) & BIT_MASK_EXQ_LOW_TH_V1) -+#define BIT_SET_EXQ_LOW_TH_V1(x, v) \ -+ (BIT_CLEAR_EXQ_LOW_TH_V1(x) | BIT_EXQ_LOW_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DWBCN1_CTRL (Offset 0x0228) */ -+ -+#define BIT_SHIFT_BCN_HEAD_2 24 -+#define BIT_MASK_BCN_HEAD_2 0xff -+#define BIT_BCN_HEAD_2(x) (((x) & BIT_MASK_BCN_HEAD_2) << BIT_SHIFT_BCN_HEAD_2) -+#define BITS_BCN_HEAD_2 (BIT_MASK_BCN_HEAD_2 << BIT_SHIFT_BCN_HEAD_2) -+#define BIT_CLEAR_BCN_HEAD_2(x) ((x) & (~BITS_BCN_HEAD_2)) -+#define BIT_GET_BCN_HEAD_2(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_2) & BIT_MASK_BCN_HEAD_2) -+#define BIT_SET_BCN_HEAD_2(x, v) (BIT_CLEAR_BCN_HEAD_2(x) | BIT_BCN_HEAD_2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DWBCN1_CTRL (Offset 0x0228) */ -+ -+#define BIT_SW_BCN_SEL BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DWBCN1_CTRL (Offset 0x0228) */ -+ -+#define BIT_SHIFT_SW_BCN_SEL_V1 20 -+#define BIT_MASK_SW_BCN_SEL_V1 0x3 -+#define BIT_SW_BCN_SEL_V1(x) \ -+ (((x) & BIT_MASK_SW_BCN_SEL_V1) << BIT_SHIFT_SW_BCN_SEL_V1) -+#define BITS_SW_BCN_SEL_V1 (BIT_MASK_SW_BCN_SEL_V1 << BIT_SHIFT_SW_BCN_SEL_V1) -+#define BIT_CLEAR_SW_BCN_SEL_V1(x) ((x) & (~BITS_SW_BCN_SEL_V1)) -+#define BIT_GET_SW_BCN_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_SW_BCN_SEL_V1) & BIT_MASK_SW_BCN_SEL_V1) -+#define BIT_SET_SW_BCN_SEL_V1(x, v) \ -+ (BIT_CLEAR_SW_BCN_SEL_V1(x) | BIT_SW_BCN_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_1 (Offset 0x0228) */ -+ -+#define BIT_ENABLE_GEN_RANDON_SLOT_TX BIT(20) -+#define BIT_ENABLE_RANDOM_SHIFT_TX BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DWBCN1_CTRL (Offset 0x0228) */ -+ -+#define BIT_BCN_VALID_2 BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_1 (Offset 0x0228) */ -+ -+#define BIT_ENABLE_EDCA_REF_FUNCTION BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DWBCN1_CTRL (Offset 0x0228) */ -+ -+#define BIT_SW_BCN_SEL_EN BIT(17) -+#define BIT_BCN_VALID_1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_1 (Offset 0x0228) */ -+ -+#define BIT_SHIFT_TXPKTNUM_H 16 -+#define BIT_MASK_TXPKTNUM_H 0xffff -+#define BIT_TXPKTNUM_H(x) (((x) & BIT_MASK_TXPKTNUM_H) << BIT_SHIFT_TXPKTNUM_H) -+#define BITS_TXPKTNUM_H (BIT_MASK_TXPKTNUM_H << BIT_SHIFT_TXPKTNUM_H) -+#define BIT_CLEAR_TXPKTNUM_H(x) ((x) & (~BITS_TXPKTNUM_H)) -+#define BIT_GET_TXPKTNUM_H(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_H) & BIT_MASK_TXPKTNUM_H) -+#define BIT_SET_TXPKTNUM_H(x, v) (BIT_CLEAR_TXPKTNUM_H(x) | BIT_TXPKTNUM_H(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_1 (Offset 0x0228) */ -+ -+#define BIT_SHIFT_TXPKTNUM_H_V2 16 -+#define BIT_MASK_TXPKTNUM_H_V2 0xfff -+#define BIT_TXPKTNUM_H_V2(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_H_V2) << BIT_SHIFT_TXPKTNUM_H_V2) -+#define BITS_TXPKTNUM_H_V2 (BIT_MASK_TXPKTNUM_H_V2 << BIT_SHIFT_TXPKTNUM_H_V2) -+#define BIT_CLEAR_TXPKTNUM_H_V2(x) ((x) & (~BITS_TXPKTNUM_H_V2)) -+#define BIT_GET_TXPKTNUM_H_V2(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_H_V2) & BIT_MASK_TXPKTNUM_H_V2) -+#define BIT_SET_TXPKTNUM_H_V2(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_H_V2(x) | BIT_TXPKTNUM_H_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DWBCN1_CTRL (Offset 0x0228) */ -+ -+#define BIT_ADJUSTABLE_SIZE_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DWBCN1_CTRL (Offset 0x0228) */ -+ -+#define BIT_SHIFT_BCN_HEAD_1 8 -+#define BIT_MASK_BCN_HEAD_1 0xff -+#define BIT_BCN_HEAD_1(x) (((x) & BIT_MASK_BCN_HEAD_1) << BIT_SHIFT_BCN_HEAD_1) -+#define BITS_BCN_HEAD_1 (BIT_MASK_BCN_HEAD_1 << BIT_SHIFT_BCN_HEAD_1) -+#define BIT_CLEAR_BCN_HEAD_1(x) ((x) & (~BITS_BCN_HEAD_1)) -+#define BIT_GET_BCN_HEAD_1(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_1) & BIT_MASK_BCN_HEAD_1) -+#define BIT_SET_BCN_HEAD_1(x, v) (BIT_CLEAR_BCN_HEAD_1(x) | BIT_BCN_HEAD_1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_1 (Offset 0x0228) */ -+ -+#define BIT_RST_PGSUB_CNT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DWBCN1_CTRL (Offset 0x0228) */ -+ -+#define BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO 0 -+#define BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO 0xff -+#define BIT_MAX_TX_PKT_FOR_USB_AND_SDIO(x) \ -+ (((x) & BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO) \ -+ << BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO) -+#define BITS_MAX_TX_PKT_FOR_USB_AND_SDIO \ -+ (BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO \ -+ << BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO) -+#define BIT_CLEAR_MAX_TX_PKT_FOR_USB_AND_SDIO(x) \ -+ ((x) & (~BITS_MAX_TX_PKT_FOR_USB_AND_SDIO)) -+#define BIT_GET_MAX_TX_PKT_FOR_USB_AND_SDIO(x) \ -+ (((x) >> BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO) & \ -+ BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO) -+#define BIT_SET_MAX_TX_PKT_FOR_USB_AND_SDIO(x, v) \ -+ (BIT_CLEAR_MAX_TX_PKT_FOR_USB_AND_SDIO(x) | \ -+ BIT_MAX_TX_PKT_FOR_USB_AND_SDIO(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DWBCN1_CTRL (Offset 0x0228) */ -+ -+#define BIT_SHIFT_ALIGNMENT_SIZE 0 -+#define BIT_MASK_ALIGNMENT_SIZE 0xfff -+#define BIT_ALIGNMENT_SIZE(x) \ -+ (((x) & BIT_MASK_ALIGNMENT_SIZE) << BIT_SHIFT_ALIGNMENT_SIZE) -+#define BITS_ALIGNMENT_SIZE \ -+ (BIT_MASK_ALIGNMENT_SIZE << BIT_SHIFT_ALIGNMENT_SIZE) -+#define BIT_CLEAR_ALIGNMENT_SIZE(x) ((x) & (~BITS_ALIGNMENT_SIZE)) -+#define BIT_GET_ALIGNMENT_SIZE(x) \ -+ (((x) >> BIT_SHIFT_ALIGNMENT_SIZE) & BIT_MASK_ALIGNMENT_SIZE) -+#define BIT_SET_ALIGNMENT_SIZE(x, v) \ -+ (BIT_CLEAR_ALIGNMENT_SIZE(x) | BIT_ALIGNMENT_SIZE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_1 (Offset 0x0228) */ -+ -+#define BIT_SHIFT_TXPKTNUM_H_V1 0 -+#define BIT_MASK_TXPKTNUM_H_V1 0xffff -+#define BIT_TXPKTNUM_H_V1(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_H_V1) << BIT_SHIFT_TXPKTNUM_H_V1) -+#define BITS_TXPKTNUM_H_V1 (BIT_MASK_TXPKTNUM_H_V1 << BIT_SHIFT_TXPKTNUM_H_V1) -+#define BIT_CLEAR_TXPKTNUM_H_V1(x) ((x) & (~BITS_TXPKTNUM_H_V1)) -+#define BIT_GET_TXPKTNUM_H_V1(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_H_V1) & BIT_MASK_TXPKTNUM_H_V1) -+#define BIT_SET_TXPKTNUM_H_V1(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_H_V1(x) | BIT_TXPKTNUM_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_1 (Offset 0x0228) */ -+ -+#define BIT_SHIFT_TXPKTNUM_H_V3 0 -+#define BIT_MASK_TXPKTNUM_H_V3 0xfff -+#define BIT_TXPKTNUM_H_V3(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_H_V3) << BIT_SHIFT_TXPKTNUM_H_V3) -+#define BITS_TXPKTNUM_H_V3 (BIT_MASK_TXPKTNUM_H_V3 << BIT_SHIFT_TXPKTNUM_H_V3) -+#define BIT_CLEAR_TXPKTNUM_H_V3(x) ((x) & (~BITS_TXPKTNUM_H_V3)) -+#define BIT_GET_TXPKTNUM_H_V3(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_H_V3) & BIT_MASK_TXPKTNUM_H_V3) -+#define BIT_SET_TXPKTNUM_H_V3(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_H_V3(x) | BIT_TXPKTNUM_H_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_1 (Offset 0x0228) */ -+ -+#define BIT_SHIFT_TXPKTNUM_V3 0 -+#define BIT_MASK_TXPKTNUM_V3 0xfff -+#define BIT_TXPKTNUM_V3(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_V3) << BIT_SHIFT_TXPKTNUM_V3) -+#define BITS_TXPKTNUM_V3 (BIT_MASK_TXPKTNUM_V3 << BIT_SHIFT_TXPKTNUM_V3) -+#define BIT_CLEAR_TXPKTNUM_V3(x) ((x) & (~BITS_TXPKTNUM_V3)) -+#define BIT_GET_TXPKTNUM_V3(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_V3) & BIT_MASK_TXPKTNUM_V3) -+#define BIT_SET_TXPKTNUM_V3(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_V3(x) | BIT_TXPKTNUM_V3(v)) -+ -+#define BIT_PGSUB_CNT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_1 (Offset 0x0228) */ -+ -+#define BIT_SHIFT_TXPKTNUM_V2 0 -+#define BIT_MASK_TXPKTNUM_V2 0xffff -+#define BIT_TXPKTNUM_V2(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_V2) << BIT_SHIFT_TXPKTNUM_V2) -+#define BITS_TXPKTNUM_V2 (BIT_MASK_TXPKTNUM_V2 << BIT_SHIFT_TXPKTNUM_V2) -+#define BIT_CLEAR_TXPKTNUM_V2(x) ((x) & (~BITS_TXPKTNUM_V2)) -+#define BIT_GET_TXPKTNUM_V2(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_V2) & BIT_MASK_TXPKTNUM_V2) -+#define BIT_SET_TXPKTNUM_V2(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_V2(x) | BIT_TXPKTNUM_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_2 (Offset 0x022C) */ -+ -+#define BIT_EX2Q_PUBLIC_DIS_V1 BIT(21) -+#define BIT_EX1Q_PUBLIC_DIS_V1 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_2 (Offset 0x022C) */ -+ -+#define BIT_EXQ_PUBLIC_DIS_V1 BIT(19) -+#define BIT_NPQ_PUBLIC_DIS_V1 BIT(18) -+#define BIT_LPQ_PUBLIC_DIS_V1 BIT(17) -+#define BIT_HPQ_PUBLIC_DIS_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RQPN_CTRL_2 (Offset 0x022C) */ -+ -+#define BIT_SDIO_TXAGG_ALIGN_ADJUST_EN BIT(15) -+ -+#define BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE 0 -+#define BIT_MASK_SDIO_TXAGG_ALIGN_SIZE 0xfff -+#define BIT_SDIO_TXAGG_ALIGN_SIZE(x) \ -+ (((x) & BIT_MASK_SDIO_TXAGG_ALIGN_SIZE) \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE) -+#define BITS_SDIO_TXAGG_ALIGN_SIZE \ -+ (BIT_MASK_SDIO_TXAGG_ALIGN_SIZE << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE) -+#define BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE(x) ((x) & (~BITS_SDIO_TXAGG_ALIGN_SIZE)) -+#define BIT_GET_SDIO_TXAGG_ALIGN_SIZE(x) \ -+ (((x) >> BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE) & \ -+ BIT_MASK_SDIO_TXAGG_ALIGN_SIZE) -+#define BIT_SET_SDIO_TXAGG_ALIGN_SIZE(x, v) \ -+ (BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE(x) | BIT_SDIO_TXAGG_ALIGN_SIZE(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_RQPN_EXQ1_EXQ2 (Offset 0x0230) */ -+ -+#define BIT_SHIFT_EXQ2_AVAL_PG 24 -+#define BIT_MASK_EXQ2_AVAL_PG 0xff -+#define BIT_EXQ2_AVAL_PG(x) \ -+ (((x) & BIT_MASK_EXQ2_AVAL_PG) << BIT_SHIFT_EXQ2_AVAL_PG) -+#define BITS_EXQ2_AVAL_PG (BIT_MASK_EXQ2_AVAL_PG << BIT_SHIFT_EXQ2_AVAL_PG) -+#define BIT_CLEAR_EXQ2_AVAL_PG(x) ((x) & (~BITS_EXQ2_AVAL_PG)) -+#define BIT_GET_EXQ2_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_EXQ2_AVAL_PG) & BIT_MASK_EXQ2_AVAL_PG) -+#define BIT_SET_EXQ2_AVAL_PG(x, v) \ -+ (BIT_CLEAR_EXQ2_AVAL_PG(x) | BIT_EXQ2_AVAL_PG(v)) -+ -+#define BIT_SHIFT_EXQ2 16 -+#define BIT_MASK_EXQ2 0xff -+#define BIT_EXQ2(x) (((x) & BIT_MASK_EXQ2) << BIT_SHIFT_EXQ2) -+#define BITS_EXQ2 (BIT_MASK_EXQ2 << BIT_SHIFT_EXQ2) -+#define BIT_CLEAR_EXQ2(x) ((x) & (~BITS_EXQ2)) -+#define BIT_GET_EXQ2(x) (((x) >> BIT_SHIFT_EXQ2) & BIT_MASK_EXQ2) -+#define BIT_SET_EXQ2(x, v) (BIT_CLEAR_EXQ2(x) | BIT_EXQ2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO_1 (Offset 0x0230) */ -+ -+#define BIT_SHIFT_HPQ_AVAL_PG_V1 16 -+#define BIT_MASK_HPQ_AVAL_PG_V1 0xfff -+#define BIT_HPQ_AVAL_PG_V1(x) \ -+ (((x) & BIT_MASK_HPQ_AVAL_PG_V1) << BIT_SHIFT_HPQ_AVAL_PG_V1) -+#define BITS_HPQ_AVAL_PG_V1 \ -+ (BIT_MASK_HPQ_AVAL_PG_V1 << BIT_SHIFT_HPQ_AVAL_PG_V1) -+#define BIT_CLEAR_HPQ_AVAL_PG_V1(x) ((x) & (~BITS_HPQ_AVAL_PG_V1)) -+#define BIT_GET_HPQ_AVAL_PG_V1(x) \ -+ (((x) >> BIT_SHIFT_HPQ_AVAL_PG_V1) & BIT_MASK_HPQ_AVAL_PG_V1) -+#define BIT_SET_HPQ_AVAL_PG_V1(x, v) \ -+ (BIT_CLEAR_HPQ_AVAL_PG_V1(x) | BIT_HPQ_AVAL_PG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_RQPN_EXQ1_EXQ2 (Offset 0x0230) */ -+ -+#define BIT_SHIFT_EXQ1_AVAL_PG 8 -+#define BIT_MASK_EXQ1_AVAL_PG 0xff -+#define BIT_EXQ1_AVAL_PG(x) \ -+ (((x) & BIT_MASK_EXQ1_AVAL_PG) << BIT_SHIFT_EXQ1_AVAL_PG) -+#define BITS_EXQ1_AVAL_PG (BIT_MASK_EXQ1_AVAL_PG << BIT_SHIFT_EXQ1_AVAL_PG) -+#define BIT_CLEAR_EXQ1_AVAL_PG(x) ((x) & (~BITS_EXQ1_AVAL_PG)) -+#define BIT_GET_EXQ1_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_EXQ1_AVAL_PG) & BIT_MASK_EXQ1_AVAL_PG) -+#define BIT_SET_EXQ1_AVAL_PG(x, v) \ -+ (BIT_CLEAR_EXQ1_AVAL_PG(x) | BIT_EXQ1_AVAL_PG(v)) -+ -+#define BIT_SHIFT_EXQ1 0 -+#define BIT_MASK_EXQ1 0xff -+#define BIT_EXQ1(x) (((x) & BIT_MASK_EXQ1) << BIT_SHIFT_EXQ1) -+#define BITS_EXQ1 (BIT_MASK_EXQ1 << BIT_SHIFT_EXQ1) -+#define BIT_CLEAR_EXQ1(x) ((x) & (~BITS_EXQ1)) -+#define BIT_GET_EXQ1(x) (((x) >> BIT_SHIFT_EXQ1) & BIT_MASK_EXQ1) -+#define BIT_SET_EXQ1(x, v) (BIT_CLEAR_EXQ1(x) | BIT_EXQ1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO_1 (Offset 0x0230) */ -+ -+#define BIT_SHIFT_HPQ_V1 0 -+#define BIT_MASK_HPQ_V1 0xfff -+#define BIT_HPQ_V1(x) (((x) & BIT_MASK_HPQ_V1) << BIT_SHIFT_HPQ_V1) -+#define BITS_HPQ_V1 (BIT_MASK_HPQ_V1 << BIT_SHIFT_HPQ_V1) -+#define BIT_CLEAR_HPQ_V1(x) ((x) & (~BITS_HPQ_V1)) -+#define BIT_GET_HPQ_V1(x) (((x) >> BIT_SHIFT_HPQ_V1) & BIT_MASK_HPQ_V1) -+#define BIT_SET_HPQ_V1(x, v) (BIT_CLEAR_HPQ_V1(x) | BIT_HPQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TQPNT3_V1 (Offset 0x0234) */ -+ -+#define BIT_SHIFT_EXQ2_HIGH_TH 24 -+#define BIT_MASK_EXQ2_HIGH_TH 0xff -+#define BIT_EXQ2_HIGH_TH(x) \ -+ (((x) & BIT_MASK_EXQ2_HIGH_TH) << BIT_SHIFT_EXQ2_HIGH_TH) -+#define BITS_EXQ2_HIGH_TH (BIT_MASK_EXQ2_HIGH_TH << BIT_SHIFT_EXQ2_HIGH_TH) -+#define BIT_CLEAR_EXQ2_HIGH_TH(x) ((x) & (~BITS_EXQ2_HIGH_TH)) -+#define BIT_GET_EXQ2_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_EXQ2_HIGH_TH) & BIT_MASK_EXQ2_HIGH_TH) -+#define BIT_SET_EXQ2_HIGH_TH(x, v) \ -+ (BIT_CLEAR_EXQ2_HIGH_TH(x) | BIT_EXQ2_HIGH_TH(v)) -+ -+#define BIT_SHIFT_EXQ2_LOW_TH 16 -+#define BIT_MASK_EXQ2_LOW_TH 0xff -+#define BIT_EXQ2_LOW_TH(x) \ -+ (((x) & BIT_MASK_EXQ2_LOW_TH) << BIT_SHIFT_EXQ2_LOW_TH) -+#define BITS_EXQ2_LOW_TH (BIT_MASK_EXQ2_LOW_TH << BIT_SHIFT_EXQ2_LOW_TH) -+#define BIT_CLEAR_EXQ2_LOW_TH(x) ((x) & (~BITS_EXQ2_LOW_TH)) -+#define BIT_GET_EXQ2_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_EXQ2_LOW_TH) & BIT_MASK_EXQ2_LOW_TH) -+#define BIT_SET_EXQ2_LOW_TH(x, v) \ -+ (BIT_CLEAR_EXQ2_LOW_TH(x) | BIT_EXQ2_LOW_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO_2 (Offset 0x0234) */ -+ -+#define BIT_SHIFT_LPQ_AVAL_PG_V1 16 -+#define BIT_MASK_LPQ_AVAL_PG_V1 0xfff -+#define BIT_LPQ_AVAL_PG_V1(x) \ -+ (((x) & BIT_MASK_LPQ_AVAL_PG_V1) << BIT_SHIFT_LPQ_AVAL_PG_V1) -+#define BITS_LPQ_AVAL_PG_V1 \ -+ (BIT_MASK_LPQ_AVAL_PG_V1 << BIT_SHIFT_LPQ_AVAL_PG_V1) -+#define BIT_CLEAR_LPQ_AVAL_PG_V1(x) ((x) & (~BITS_LPQ_AVAL_PG_V1)) -+#define BIT_GET_LPQ_AVAL_PG_V1(x) \ -+ (((x) >> BIT_SHIFT_LPQ_AVAL_PG_V1) & BIT_MASK_LPQ_AVAL_PG_V1) -+#define BIT_SET_LPQ_AVAL_PG_V1(x, v) \ -+ (BIT_CLEAR_LPQ_AVAL_PG_V1(x) | BIT_LPQ_AVAL_PG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TQPNT3_V1 (Offset 0x0234) */ -+ -+#define BIT_SHIFT_EXQ1_HIGH_TH 8 -+#define BIT_MASK_EXQ1_HIGH_TH 0xff -+#define BIT_EXQ1_HIGH_TH(x) \ -+ (((x) & BIT_MASK_EXQ1_HIGH_TH) << BIT_SHIFT_EXQ1_HIGH_TH) -+#define BITS_EXQ1_HIGH_TH (BIT_MASK_EXQ1_HIGH_TH << BIT_SHIFT_EXQ1_HIGH_TH) -+#define BIT_CLEAR_EXQ1_HIGH_TH(x) ((x) & (~BITS_EXQ1_HIGH_TH)) -+#define BIT_GET_EXQ1_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_EXQ1_HIGH_TH) & BIT_MASK_EXQ1_HIGH_TH) -+#define BIT_SET_EXQ1_HIGH_TH(x, v) \ -+ (BIT_CLEAR_EXQ1_HIGH_TH(x) | BIT_EXQ1_HIGH_TH(v)) -+ -+#define BIT_SHIFT_EXQ1_LOW_TH 0 -+#define BIT_MASK_EXQ1_LOW_TH 0xff -+#define BIT_EXQ1_LOW_TH(x) \ -+ (((x) & BIT_MASK_EXQ1_LOW_TH) << BIT_SHIFT_EXQ1_LOW_TH) -+#define BITS_EXQ1_LOW_TH (BIT_MASK_EXQ1_LOW_TH << BIT_SHIFT_EXQ1_LOW_TH) -+#define BIT_CLEAR_EXQ1_LOW_TH(x) ((x) & (~BITS_EXQ1_LOW_TH)) -+#define BIT_GET_EXQ1_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_EXQ1_LOW_TH) & BIT_MASK_EXQ1_LOW_TH) -+#define BIT_SET_EXQ1_LOW_TH(x, v) \ -+ (BIT_CLEAR_EXQ1_LOW_TH(x) | BIT_EXQ1_LOW_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO_2 (Offset 0x0234) */ -+ -+#define BIT_SHIFT_LPQ_V1 0 -+#define BIT_MASK_LPQ_V1 0xfff -+#define BIT_LPQ_V1(x) (((x) & BIT_MASK_LPQ_V1) << BIT_SHIFT_LPQ_V1) -+#define BITS_LPQ_V1 (BIT_MASK_LPQ_V1 << BIT_SHIFT_LPQ_V1) -+#define BIT_CLEAR_LPQ_V1(x) ((x) & (~BITS_LPQ_V1)) -+#define BIT_GET_LPQ_V1(x) (((x) >> BIT_SHIFT_LPQ_V1) & BIT_MASK_LPQ_V1) -+#define BIT_SET_LPQ_V1(x, v) (BIT_CLEAR_LPQ_V1(x) | BIT_LPQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO_3 (Offset 0x0238) */ -+ -+#define BIT_SHIFT_NPQ_AVAL_PG_V1 16 -+#define BIT_MASK_NPQ_AVAL_PG_V1 0xfff -+#define BIT_NPQ_AVAL_PG_V1(x) \ -+ (((x) & BIT_MASK_NPQ_AVAL_PG_V1) << BIT_SHIFT_NPQ_AVAL_PG_V1) -+#define BITS_NPQ_AVAL_PG_V1 \ -+ (BIT_MASK_NPQ_AVAL_PG_V1 << BIT_SHIFT_NPQ_AVAL_PG_V1) -+#define BIT_CLEAR_NPQ_AVAL_PG_V1(x) ((x) & (~BITS_NPQ_AVAL_PG_V1)) -+#define BIT_GET_NPQ_AVAL_PG_V1(x) \ -+ (((x) >> BIT_SHIFT_NPQ_AVAL_PG_V1) & BIT_MASK_NPQ_AVAL_PG_V1) -+#define BIT_SET_NPQ_AVAL_PG_V1(x, v) \ -+ (BIT_CLEAR_NPQ_AVAL_PG_V1(x) | BIT_NPQ_AVAL_PG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO_3 (Offset 0x0238) */ -+ -+#define BIT_SHIFT_NPQ_V1 0 -+#define BIT_MASK_NPQ_V1 0xfff -+#define BIT_NPQ_V1(x) (((x) & BIT_MASK_NPQ_V1) << BIT_SHIFT_NPQ_V1) -+#define BITS_NPQ_V1 (BIT_MASK_NPQ_V1 << BIT_SHIFT_NPQ_V1) -+#define BIT_CLEAR_NPQ_V1(x) ((x) & (~BITS_NPQ_V1)) -+#define BIT_GET_NPQ_V1(x) (((x) >> BIT_SHIFT_NPQ_V1) & BIT_MASK_NPQ_V1) -+#define BIT_SET_NPQ_V1(x, v) (BIT_CLEAR_NPQ_V1(x) | BIT_NPQ_V1(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_4 (Offset 0x023C) */ -+ -+#define BIT_SHIFT_EXQ_AVAL_PG_V1 16 -+#define BIT_MASK_EXQ_AVAL_PG_V1 0xfff -+#define BIT_EXQ_AVAL_PG_V1(x) \ -+ (((x) & BIT_MASK_EXQ_AVAL_PG_V1) << BIT_SHIFT_EXQ_AVAL_PG_V1) -+#define BITS_EXQ_AVAL_PG_V1 \ -+ (BIT_MASK_EXQ_AVAL_PG_V1 << BIT_SHIFT_EXQ_AVAL_PG_V1) -+#define BIT_CLEAR_EXQ_AVAL_PG_V1(x) ((x) & (~BITS_EXQ_AVAL_PG_V1)) -+#define BIT_GET_EXQ_AVAL_PG_V1(x) \ -+ (((x) >> BIT_SHIFT_EXQ_AVAL_PG_V1) & BIT_MASK_EXQ_AVAL_PG_V1) -+#define BIT_SET_EXQ_AVAL_PG_V1(x, v) \ -+ (BIT_CLEAR_EXQ_AVAL_PG_V1(x) | BIT_EXQ_AVAL_PG_V1(v)) -+ -+#define BIT_SHIFT_EXQ_V1 0 -+#define BIT_MASK_EXQ_V1 0xfff -+#define BIT_EXQ_V1(x) (((x) & BIT_MASK_EXQ_V1) << BIT_SHIFT_EXQ_V1) -+#define BITS_EXQ_V1 (BIT_MASK_EXQ_V1 << BIT_SHIFT_EXQ_V1) -+#define BIT_CLEAR_EXQ_V1(x) ((x) & (~BITS_EXQ_V1)) -+#define BIT_GET_EXQ_V1(x) (((x) >> BIT_SHIFT_EXQ_V1) & BIT_MASK_EXQ_V1) -+#define BIT_SET_EXQ_V1(x, v) (BIT_CLEAR_EXQ_V1(x) | BIT_EXQ_V1(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_5 (Offset 0x0240) */ -+ -+#define BIT_SHIFT_PUBQ_AVAL_PG_V1 16 -+#define BIT_MASK_PUBQ_AVAL_PG_V1 0xfff -+#define BIT_PUBQ_AVAL_PG_V1(x) \ -+ (((x) & BIT_MASK_PUBQ_AVAL_PG_V1) << BIT_SHIFT_PUBQ_AVAL_PG_V1) -+#define BITS_PUBQ_AVAL_PG_V1 \ -+ (BIT_MASK_PUBQ_AVAL_PG_V1 << BIT_SHIFT_PUBQ_AVAL_PG_V1) -+#define BIT_CLEAR_PUBQ_AVAL_PG_V1(x) ((x) & (~BITS_PUBQ_AVAL_PG_V1)) -+#define BIT_GET_PUBQ_AVAL_PG_V1(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_AVAL_PG_V1) & BIT_MASK_PUBQ_AVAL_PG_V1) -+#define BIT_SET_PUBQ_AVAL_PG_V1(x, v) \ -+ (BIT_CLEAR_PUBQ_AVAL_PG_V1(x) | BIT_PUBQ_AVAL_PG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TX_AGG_ALIGN (Offset 0x0240) */ -+ -+#define BIT_SHIFT_HW_FLOW_CTL_EN 16 -+#define BIT_MASK_HW_FLOW_CTL_EN 0xffff -+#define BIT_HW_FLOW_CTL_EN(x) \ -+ (((x) & BIT_MASK_HW_FLOW_CTL_EN) << BIT_SHIFT_HW_FLOW_CTL_EN) -+#define BITS_HW_FLOW_CTL_EN \ -+ (BIT_MASK_HW_FLOW_CTL_EN << BIT_SHIFT_HW_FLOW_CTL_EN) -+#define BIT_CLEAR_HW_FLOW_CTL_EN(x) ((x) & (~BITS_HW_FLOW_CTL_EN)) -+#define BIT_GET_HW_FLOW_CTL_EN(x) \ -+ (((x) >> BIT_SHIFT_HW_FLOW_CTL_EN) & BIT_MASK_HW_FLOW_CTL_EN) -+#define BIT_SET_HW_FLOW_CTL_EN(x, v) \ -+ (BIT_CLEAR_HW_FLOW_CTL_EN(x) | BIT_HW_FLOW_CTL_EN(v)) -+ -+#define BIT_SDIO_TXAGG_ALIGN_ADJUST_EN_V1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_INFO_5 (Offset 0x0240) */ -+ -+#define BIT_SHIFT_PUBQ_V1 0 -+#define BIT_MASK_PUBQ_V1 0xfff -+#define BIT_PUBQ_V1(x) (((x) & BIT_MASK_PUBQ_V1) << BIT_SHIFT_PUBQ_V1) -+#define BITS_PUBQ_V1 (BIT_MASK_PUBQ_V1 << BIT_SHIFT_PUBQ_V1) -+#define BIT_CLEAR_PUBQ_V1(x) ((x) & (~BITS_PUBQ_V1)) -+#define BIT_GET_PUBQ_V1(x) (((x) >> BIT_SHIFT_PUBQ_V1) & BIT_MASK_PUBQ_V1) -+#define BIT_SET_PUBQ_V1(x, v) (BIT_CLEAR_PUBQ_V1(x) | BIT_PUBQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TX_AGG_ALIGN (Offset 0x0240) */ -+ -+#define BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_V1 0 -+#define BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_V1 0xfff -+#define BIT_SDIO_TXAGG_ALIGN_SIZE_V1(x) \ -+ (((x) & BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_V1) \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_V1) -+#define BITS_SDIO_TXAGG_ALIGN_SIZE_V1 \ -+ (BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_V1 \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_V1) -+#define BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE_V1(x) \ -+ ((x) & (~BITS_SDIO_TXAGG_ALIGN_SIZE_V1)) -+#define BIT_GET_SDIO_TXAGG_ALIGN_SIZE_V1(x) \ -+ (((x) >> BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_V1) & \ -+ BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_V1) -+#define BIT_SET_SDIO_TXAGG_ALIGN_SIZE_V1(x, v) \ -+ (BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE_V1(x) | \ -+ BIT_SDIO_TXAGG_ALIGN_SIZE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_H2C_HEAD (Offset 0x0244) */ -+ -+#define BIT_SHIFT_H2C_HEAD_V2 0 -+#define BIT_MASK_H2C_HEAD_V2 0xffff -+#define BIT_H2C_HEAD_V2(x) \ -+ (((x) & BIT_MASK_H2C_HEAD_V2) << BIT_SHIFT_H2C_HEAD_V2) -+#define BITS_H2C_HEAD_V2 (BIT_MASK_H2C_HEAD_V2 << BIT_SHIFT_H2C_HEAD_V2) -+#define BIT_CLEAR_H2C_HEAD_V2(x) ((x) & (~BITS_H2C_HEAD_V2)) -+#define BIT_GET_H2C_HEAD_V2(x) \ -+ (((x) >> BIT_SHIFT_H2C_HEAD_V2) & BIT_MASK_H2C_HEAD_V2) -+#define BIT_SET_H2C_HEAD_V2(x, v) \ -+ (BIT_CLEAR_H2C_HEAD_V2(x) | BIT_H2C_HEAD_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2C_HEAD (Offset 0x0244) */ -+ -+#define BIT_SHIFT_H2C_HEAD 0 -+#define BIT_MASK_H2C_HEAD 0x3ffff -+#define BIT_H2C_HEAD(x) (((x) & BIT_MASK_H2C_HEAD) << BIT_SHIFT_H2C_HEAD) -+#define BITS_H2C_HEAD (BIT_MASK_H2C_HEAD << BIT_SHIFT_H2C_HEAD) -+#define BIT_CLEAR_H2C_HEAD(x) ((x) & (~BITS_H2C_HEAD)) -+#define BIT_GET_H2C_HEAD(x) (((x) >> BIT_SHIFT_H2C_HEAD) & BIT_MASK_H2C_HEAD) -+#define BIT_SET_H2C_HEAD(x, v) (BIT_CLEAR_H2C_HEAD(x) | BIT_H2C_HEAD(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_H2C_HEAD (Offset 0x0244) */ -+ -+#define BIT_SHIFT_H2C_HEAD_V1 0 -+#define BIT_MASK_H2C_HEAD_V1 0x7ffff -+#define BIT_H2C_HEAD_V1(x) \ -+ (((x) & BIT_MASK_H2C_HEAD_V1) << BIT_SHIFT_H2C_HEAD_V1) -+#define BITS_H2C_HEAD_V1 (BIT_MASK_H2C_HEAD_V1 << BIT_SHIFT_H2C_HEAD_V1) -+#define BIT_CLEAR_H2C_HEAD_V1(x) ((x) & (~BITS_H2C_HEAD_V1)) -+#define BIT_GET_H2C_HEAD_V1(x) \ -+ (((x) >> BIT_SHIFT_H2C_HEAD_V1) & BIT_MASK_H2C_HEAD_V1) -+#define BIT_SET_H2C_HEAD_V1(x, v) \ -+ (BIT_CLEAR_H2C_HEAD_V1(x) | BIT_H2C_HEAD_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_H2C_TAIL (Offset 0x0248) */ -+ -+#define BIT_SHIFT_H2C_TAIL_V2 0 -+#define BIT_MASK_H2C_TAIL_V2 0xffff -+#define BIT_H2C_TAIL_V2(x) \ -+ (((x) & BIT_MASK_H2C_TAIL_V2) << BIT_SHIFT_H2C_TAIL_V2) -+#define BITS_H2C_TAIL_V2 (BIT_MASK_H2C_TAIL_V2 << BIT_SHIFT_H2C_TAIL_V2) -+#define BIT_CLEAR_H2C_TAIL_V2(x) ((x) & (~BITS_H2C_TAIL_V2)) -+#define BIT_GET_H2C_TAIL_V2(x) \ -+ (((x) >> BIT_SHIFT_H2C_TAIL_V2) & BIT_MASK_H2C_TAIL_V2) -+#define BIT_SET_H2C_TAIL_V2(x, v) \ -+ (BIT_CLEAR_H2C_TAIL_V2(x) | BIT_H2C_TAIL_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2C_TAIL (Offset 0x0248) */ -+ -+#define BIT_SHIFT_H2C_TAIL 0 -+#define BIT_MASK_H2C_TAIL 0x3ffff -+#define BIT_H2C_TAIL(x) (((x) & BIT_MASK_H2C_TAIL) << BIT_SHIFT_H2C_TAIL) -+#define BITS_H2C_TAIL (BIT_MASK_H2C_TAIL << BIT_SHIFT_H2C_TAIL) -+#define BIT_CLEAR_H2C_TAIL(x) ((x) & (~BITS_H2C_TAIL)) -+#define BIT_GET_H2C_TAIL(x) (((x) >> BIT_SHIFT_H2C_TAIL) & BIT_MASK_H2C_TAIL) -+#define BIT_SET_H2C_TAIL(x, v) (BIT_CLEAR_H2C_TAIL(x) | BIT_H2C_TAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_H2C_TAIL (Offset 0x0248) */ -+ -+#define BIT_SHIFT_H2C_TAIL_V1 0 -+#define BIT_MASK_H2C_TAIL_V1 0x7ffff -+#define BIT_H2C_TAIL_V1(x) \ -+ (((x) & BIT_MASK_H2C_TAIL_V1) << BIT_SHIFT_H2C_TAIL_V1) -+#define BITS_H2C_TAIL_V1 (BIT_MASK_H2C_TAIL_V1 << BIT_SHIFT_H2C_TAIL_V1) -+#define BIT_CLEAR_H2C_TAIL_V1(x) ((x) & (~BITS_H2C_TAIL_V1)) -+#define BIT_GET_H2C_TAIL_V1(x) \ -+ (((x) >> BIT_SHIFT_H2C_TAIL_V1) & BIT_MASK_H2C_TAIL_V1) -+#define BIT_SET_H2C_TAIL_V1(x, v) \ -+ (BIT_CLEAR_H2C_TAIL_V1(x) | BIT_H2C_TAIL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_H2C_READ_ADDR (Offset 0x024C) */ -+ -+#define BIT_SHIFT_H2C_READ_ADDR_V2 0 -+#define BIT_MASK_H2C_READ_ADDR_V2 0xffff -+#define BIT_H2C_READ_ADDR_V2(x) \ -+ (((x) & BIT_MASK_H2C_READ_ADDR_V2) << BIT_SHIFT_H2C_READ_ADDR_V2) -+#define BITS_H2C_READ_ADDR_V2 \ -+ (BIT_MASK_H2C_READ_ADDR_V2 << BIT_SHIFT_H2C_READ_ADDR_V2) -+#define BIT_CLEAR_H2C_READ_ADDR_V2(x) ((x) & (~BITS_H2C_READ_ADDR_V2)) -+#define BIT_GET_H2C_READ_ADDR_V2(x) \ -+ (((x) >> BIT_SHIFT_H2C_READ_ADDR_V2) & BIT_MASK_H2C_READ_ADDR_V2) -+#define BIT_SET_H2C_READ_ADDR_V2(x, v) \ -+ (BIT_CLEAR_H2C_READ_ADDR_V2(x) | BIT_H2C_READ_ADDR_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2C_READ_ADDR (Offset 0x024C) */ -+ -+#define BIT_SHIFT_H2C_READ_ADDR 0 -+#define BIT_MASK_H2C_READ_ADDR 0x3ffff -+#define BIT_H2C_READ_ADDR(x) \ -+ (((x) & BIT_MASK_H2C_READ_ADDR) << BIT_SHIFT_H2C_READ_ADDR) -+#define BITS_H2C_READ_ADDR (BIT_MASK_H2C_READ_ADDR << BIT_SHIFT_H2C_READ_ADDR) -+#define BIT_CLEAR_H2C_READ_ADDR(x) ((x) & (~BITS_H2C_READ_ADDR)) -+#define BIT_GET_H2C_READ_ADDR(x) \ -+ (((x) >> BIT_SHIFT_H2C_READ_ADDR) & BIT_MASK_H2C_READ_ADDR) -+#define BIT_SET_H2C_READ_ADDR(x, v) \ -+ (BIT_CLEAR_H2C_READ_ADDR(x) | BIT_H2C_READ_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_H2C_READ_ADDR (Offset 0x024C) */ -+ -+#define BIT_SHIFT_H2C_READ_ADDR_V1 0 -+#define BIT_MASK_H2C_READ_ADDR_V1 0x7ffff -+#define BIT_H2C_READ_ADDR_V1(x) \ -+ (((x) & BIT_MASK_H2C_READ_ADDR_V1) << BIT_SHIFT_H2C_READ_ADDR_V1) -+#define BITS_H2C_READ_ADDR_V1 \ -+ (BIT_MASK_H2C_READ_ADDR_V1 << BIT_SHIFT_H2C_READ_ADDR_V1) -+#define BIT_CLEAR_H2C_READ_ADDR_V1(x) ((x) & (~BITS_H2C_READ_ADDR_V1)) -+#define BIT_GET_H2C_READ_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_H2C_READ_ADDR_V1) & BIT_MASK_H2C_READ_ADDR_V1) -+#define BIT_SET_H2C_READ_ADDR_V1(x, v) \ -+ (BIT_CLEAR_H2C_READ_ADDR_V1(x) | BIT_H2C_READ_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_H2C_WR_ADDR (Offset 0x0250) */ -+ -+#define BIT_SHIFT_H2C_WR_ADDR_V2 0 -+#define BIT_MASK_H2C_WR_ADDR_V2 0xffff -+#define BIT_H2C_WR_ADDR_V2(x) \ -+ (((x) & BIT_MASK_H2C_WR_ADDR_V2) << BIT_SHIFT_H2C_WR_ADDR_V2) -+#define BITS_H2C_WR_ADDR_V2 \ -+ (BIT_MASK_H2C_WR_ADDR_V2 << BIT_SHIFT_H2C_WR_ADDR_V2) -+#define BIT_CLEAR_H2C_WR_ADDR_V2(x) ((x) & (~BITS_H2C_WR_ADDR_V2)) -+#define BIT_GET_H2C_WR_ADDR_V2(x) \ -+ (((x) >> BIT_SHIFT_H2C_WR_ADDR_V2) & BIT_MASK_H2C_WR_ADDR_V2) -+#define BIT_SET_H2C_WR_ADDR_V2(x, v) \ -+ (BIT_CLEAR_H2C_WR_ADDR_V2(x) | BIT_H2C_WR_ADDR_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2C_WR_ADDR (Offset 0x0250) */ -+ -+#define BIT_SHIFT_H2C_WR_ADDR 0 -+#define BIT_MASK_H2C_WR_ADDR 0x3ffff -+#define BIT_H2C_WR_ADDR(x) \ -+ (((x) & BIT_MASK_H2C_WR_ADDR) << BIT_SHIFT_H2C_WR_ADDR) -+#define BITS_H2C_WR_ADDR (BIT_MASK_H2C_WR_ADDR << BIT_SHIFT_H2C_WR_ADDR) -+#define BIT_CLEAR_H2C_WR_ADDR(x) ((x) & (~BITS_H2C_WR_ADDR)) -+#define BIT_GET_H2C_WR_ADDR(x) \ -+ (((x) >> BIT_SHIFT_H2C_WR_ADDR) & BIT_MASK_H2C_WR_ADDR) -+#define BIT_SET_H2C_WR_ADDR(x, v) \ -+ (BIT_CLEAR_H2C_WR_ADDR(x) | BIT_H2C_WR_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_H2C_WR_ADDR (Offset 0x0250) */ -+ -+#define BIT_SHIFT_H2C_WR_ADDR_V1 0 -+#define BIT_MASK_H2C_WR_ADDR_V1 0x7ffff -+#define BIT_H2C_WR_ADDR_V1(x) \ -+ (((x) & BIT_MASK_H2C_WR_ADDR_V1) << BIT_SHIFT_H2C_WR_ADDR_V1) -+#define BITS_H2C_WR_ADDR_V1 \ -+ (BIT_MASK_H2C_WR_ADDR_V1 << BIT_SHIFT_H2C_WR_ADDR_V1) -+#define BIT_CLEAR_H2C_WR_ADDR_V1(x) ((x) & (~BITS_H2C_WR_ADDR_V1)) -+#define BIT_GET_H2C_WR_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_H2C_WR_ADDR_V1) & BIT_MASK_H2C_WR_ADDR_V1) -+#define BIT_SET_H2C_WR_ADDR_V1(x, v) \ -+ (BIT_CLEAR_H2C_WR_ADDR_V1(x) | BIT_H2C_WR_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_SHIFT_MDIO_PHY_ADDR 24 -+#define BIT_MASK_MDIO_PHY_ADDR 0x1f -+#define BIT_MDIO_PHY_ADDR(x) \ -+ (((x) & BIT_MASK_MDIO_PHY_ADDR) << BIT_SHIFT_MDIO_PHY_ADDR) -+#define BITS_MDIO_PHY_ADDR (BIT_MASK_MDIO_PHY_ADDR << BIT_SHIFT_MDIO_PHY_ADDR) -+#define BIT_CLEAR_MDIO_PHY_ADDR(x) ((x) & (~BITS_MDIO_PHY_ADDR)) -+#define BIT_GET_MDIO_PHY_ADDR(x) \ -+ (((x) >> BIT_SHIFT_MDIO_PHY_ADDR) & BIT_MASK_MDIO_PHY_ADDR) -+#define BIT_SET_MDIO_PHY_ADDR(x, v) \ -+ (BIT_CLEAR_MDIO_PHY_ADDR(x) | BIT_MDIO_PHY_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_SHIFT_VI_PUB_LIMIT 16 -+#define BIT_MASK_VI_PUB_LIMIT 0xfff -+#define BIT_VI_PUB_LIMIT(x) \ -+ (((x) & BIT_MASK_VI_PUB_LIMIT) << BIT_SHIFT_VI_PUB_LIMIT) -+#define BITS_VI_PUB_LIMIT (BIT_MASK_VI_PUB_LIMIT << BIT_SHIFT_VI_PUB_LIMIT) -+#define BIT_CLEAR_VI_PUB_LIMIT(x) ((x) & (~BITS_VI_PUB_LIMIT)) -+#define BIT_GET_VI_PUB_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_VI_PUB_LIMIT) & BIT_MASK_VI_PUB_LIMIT) -+#define BIT_SET_VI_PUB_LIMIT(x, v) \ -+ (BIT_CLEAR_VI_PUB_LIMIT(x) | BIT_VI_PUB_LIMIT(v)) -+ -+#define BIT_SHIFT_BK_PUB_LIMIT 16 -+#define BIT_MASK_BK_PUB_LIMIT 0xfff -+#define BIT_BK_PUB_LIMIT(x) \ -+ (((x) & BIT_MASK_BK_PUB_LIMIT) << BIT_SHIFT_BK_PUB_LIMIT) -+#define BITS_BK_PUB_LIMIT (BIT_MASK_BK_PUB_LIMIT << BIT_SHIFT_BK_PUB_LIMIT) -+#define BIT_CLEAR_BK_PUB_LIMIT(x) ((x) & (~BITS_BK_PUB_LIMIT)) -+#define BIT_GET_BK_PUB_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_BK_PUB_LIMIT) & BIT_MASK_BK_PUB_LIMIT) -+#define BIT_SET_BK_PUB_LIMIT(x, v) \ -+ (BIT_CLEAR_BK_PUB_LIMIT(x) | BIT_BK_PUB_LIMIT(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_EX2Q_EN_PUBLIC_LIMIT BIT(13) -+#define BIT_EX1Q_EN_PUBLIC_LIMIT BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_EXQ_EN_PUBLIC_LIMIT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_EQ_EN_PUBLIC_LIMIT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_NPQ_EN_PUBLIC_LIMIT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_NQ_EN_PUBLIC_LIMIT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_LPQ_EN_PUBLIC_LIMIT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_LQ_EN_PUBLIC_LIMIT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_HPQ_EN_PUBLIC_LIMIT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_HQ_EN_PUBLIC_LIMIT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_H2C_SPACE_VLD BIT(3) -+#define BIT_H2C_WR_ADDR_RST BIT(2) -+ -+#define BIT_SHIFT_H2C_LEN_SEL 0 -+#define BIT_MASK_H2C_LEN_SEL 0x3 -+#define BIT_H2C_LEN_SEL(x) \ -+ (((x) & BIT_MASK_H2C_LEN_SEL) << BIT_SHIFT_H2C_LEN_SEL) -+#define BITS_H2C_LEN_SEL (BIT_MASK_H2C_LEN_SEL << BIT_SHIFT_H2C_LEN_SEL) -+#define BIT_CLEAR_H2C_LEN_SEL(x) ((x) & (~BITS_H2C_LEN_SEL)) -+#define BIT_GET_H2C_LEN_SEL(x) \ -+ (((x) >> BIT_SHIFT_H2C_LEN_SEL) & BIT_MASK_H2C_LEN_SEL) -+#define BIT_SET_H2C_LEN_SEL(x, v) \ -+ (BIT_CLEAR_H2C_LEN_SEL(x) | BIT_H2C_LEN_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_H2C_INFO (Offset 0x0254) */ -+ -+#define BIT_SHIFT_VO_PUB_LIMIT 0 -+#define BIT_MASK_VO_PUB_LIMIT 0xfff -+#define BIT_VO_PUB_LIMIT(x) \ -+ (((x) & BIT_MASK_VO_PUB_LIMIT) << BIT_SHIFT_VO_PUB_LIMIT) -+#define BITS_VO_PUB_LIMIT (BIT_MASK_VO_PUB_LIMIT << BIT_SHIFT_VO_PUB_LIMIT) -+#define BIT_CLEAR_VO_PUB_LIMIT(x) ((x) & (~BITS_VO_PUB_LIMIT)) -+#define BIT_GET_VO_PUB_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_VO_PUB_LIMIT) & BIT_MASK_VO_PUB_LIMIT) -+#define BIT_SET_VO_PUB_LIMIT(x, v) \ -+ (BIT_CLEAR_VO_PUB_LIMIT(x) | BIT_VO_PUB_LIMIT(v)) -+ -+#define BIT_SHIFT_BE_PUB_LIMIT 0 -+#define BIT_MASK_BE_PUB_LIMIT 0xfff -+#define BIT_BE_PUB_LIMIT(x) \ -+ (((x) & BIT_MASK_BE_PUB_LIMIT) << BIT_SHIFT_BE_PUB_LIMIT) -+#define BITS_BE_PUB_LIMIT (BIT_MASK_BE_PUB_LIMIT << BIT_SHIFT_BE_PUB_LIMIT) -+#define BIT_CLEAR_BE_PUB_LIMIT(x) ((x) & (~BITS_BE_PUB_LIMIT)) -+#define BIT_GET_BE_PUB_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_BE_PUB_LIMIT) & BIT_MASK_BE_PUB_LIMIT) -+#define BIT_SET_BE_PUB_LIMIT(x, v) \ -+ (BIT_CLEAR_BE_PUB_LIMIT(x) | BIT_BE_PUB_LIMIT(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_CTRL_5 (Offset 0x0258) */ -+ -+#define BIT_SHIFT_NQ_PG_PUBLIC_LIMIT 16 -+#define BIT_MASK_NQ_PG_PUBLIC_LIMIT 0xfff -+#define BIT_NQ_PG_PUBLIC_LIMIT(x) \ -+ (((x) & BIT_MASK_NQ_PG_PUBLIC_LIMIT) << BIT_SHIFT_NQ_PG_PUBLIC_LIMIT) -+#define BITS_NQ_PG_PUBLIC_LIMIT \ -+ (BIT_MASK_NQ_PG_PUBLIC_LIMIT << BIT_SHIFT_NQ_PG_PUBLIC_LIMIT) -+#define BIT_CLEAR_NQ_PG_PUBLIC_LIMIT(x) ((x) & (~BITS_NQ_PG_PUBLIC_LIMIT)) -+#define BIT_GET_NQ_PG_PUBLIC_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_NQ_PG_PUBLIC_LIMIT) & BIT_MASK_NQ_PG_PUBLIC_LIMIT) -+#define BIT_SET_NQ_PG_PUBLIC_LIMIT(x, v) \ -+ (BIT_CLEAR_NQ_PG_PUBLIC_LIMIT(x) | BIT_NQ_PG_PUBLIC_LIMIT(v)) -+ -+#define BIT_SHIFT_HQ_PG_PUBLIC_LIMIT 0 -+#define BIT_MASK_HQ_PG_PUBLIC_LIMIT 0xfff -+#define BIT_HQ_PG_PUBLIC_LIMIT(x) \ -+ (((x) & BIT_MASK_HQ_PG_PUBLIC_LIMIT) << BIT_SHIFT_HQ_PG_PUBLIC_LIMIT) -+#define BITS_HQ_PG_PUBLIC_LIMIT \ -+ (BIT_MASK_HQ_PG_PUBLIC_LIMIT << BIT_SHIFT_HQ_PG_PUBLIC_LIMIT) -+#define BIT_CLEAR_HQ_PG_PUBLIC_LIMIT(x) ((x) & (~BITS_HQ_PG_PUBLIC_LIMIT)) -+#define BIT_GET_HQ_PG_PUBLIC_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_HQ_PG_PUBLIC_LIMIT) & BIT_MASK_HQ_PG_PUBLIC_LIMIT) -+#define BIT_SET_HQ_PG_PUBLIC_LIMIT(x, v) \ -+ (BIT_CLEAR_HQ_PG_PUBLIC_LIMIT(x) | BIT_HQ_PG_PUBLIC_LIMIT(v)) -+ -+/* 2 REG_FIFOPAGE_CTRL_3 (Offset 0x025C) */ -+ -+#define BIT_SHIFT_EQ_PG_PUBLIC_LIMIT 16 -+#define BIT_MASK_EQ_PG_PUBLIC_LIMIT 0xfff -+#define BIT_EQ_PG_PUBLIC_LIMIT(x) \ -+ (((x) & BIT_MASK_EQ_PG_PUBLIC_LIMIT) << BIT_SHIFT_EQ_PG_PUBLIC_LIMIT) -+#define BITS_EQ_PG_PUBLIC_LIMIT \ -+ (BIT_MASK_EQ_PG_PUBLIC_LIMIT << BIT_SHIFT_EQ_PG_PUBLIC_LIMIT) -+#define BIT_CLEAR_EQ_PG_PUBLIC_LIMIT(x) ((x) & (~BITS_EQ_PG_PUBLIC_LIMIT)) -+#define BIT_GET_EQ_PG_PUBLIC_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_EQ_PG_PUBLIC_LIMIT) & BIT_MASK_EQ_PG_PUBLIC_LIMIT) -+#define BIT_SET_EQ_PG_PUBLIC_LIMIT(x, v) \ -+ (BIT_CLEAR_EQ_PG_PUBLIC_LIMIT(x) | BIT_EQ_PG_PUBLIC_LIMIT(v)) -+ -+#define BIT_SHIFT_LQ_PG_PUBLIC_LIMIT 0 -+#define BIT_MASK_LQ_PG_PUBLIC_LIMIT 0xfff -+#define BIT_LQ_PG_PUBLIC_LIMIT(x) \ -+ (((x) & BIT_MASK_LQ_PG_PUBLIC_LIMIT) << BIT_SHIFT_LQ_PG_PUBLIC_LIMIT) -+#define BITS_LQ_PG_PUBLIC_LIMIT \ -+ (BIT_MASK_LQ_PG_PUBLIC_LIMIT << BIT_SHIFT_LQ_PG_PUBLIC_LIMIT) -+#define BIT_CLEAR_LQ_PG_PUBLIC_LIMIT(x) ((x) & (~BITS_LQ_PG_PUBLIC_LIMIT)) -+#define BIT_GET_LQ_PG_PUBLIC_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_LQ_PG_PUBLIC_LIMIT) & BIT_MASK_LQ_PG_PUBLIC_LIMIT) -+#define BIT_SET_LQ_PG_PUBLIC_LIMIT(x, v) \ -+ (BIT_CLEAR_LQ_PG_PUBLIC_LIMIT(x) | BIT_LQ_PG_PUBLIC_LIMIT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DMA_OQT_0 (Offset 0x0260) */ -+ -+#define BIT_SHIFT_TX_OQT_12_FREE_SPACE 24 -+#define BIT_MASK_TX_OQT_12_FREE_SPACE 0xff -+#define BIT_TX_OQT_12_FREE_SPACE(x) \ -+ (((x) & BIT_MASK_TX_OQT_12_FREE_SPACE) \ -+ << BIT_SHIFT_TX_OQT_12_FREE_SPACE) -+#define BITS_TX_OQT_12_FREE_SPACE \ -+ (BIT_MASK_TX_OQT_12_FREE_SPACE << BIT_SHIFT_TX_OQT_12_FREE_SPACE) -+#define BIT_CLEAR_TX_OQT_12_FREE_SPACE(x) ((x) & (~BITS_TX_OQT_12_FREE_SPACE)) -+#define BIT_GET_TX_OQT_12_FREE_SPACE(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_12_FREE_SPACE) & \ -+ BIT_MASK_TX_OQT_12_FREE_SPACE) -+#define BIT_SET_TX_OQT_12_FREE_SPACE(x, v) \ -+ (BIT_CLEAR_TX_OQT_12_FREE_SPACE(x) | BIT_TX_OQT_12_FREE_SPACE(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TQPNT5 (Offset 0x0260) */ -+ -+#define BIT_SHIFT_EX1Q_HIGH_TH_V1 16 -+#define BIT_MASK_EX1Q_HIGH_TH_V1 0xfff -+#define BIT_EX1Q_HIGH_TH_V1(x) \ -+ (((x) & BIT_MASK_EX1Q_HIGH_TH_V1) << BIT_SHIFT_EX1Q_HIGH_TH_V1) -+#define BITS_EX1Q_HIGH_TH_V1 \ -+ (BIT_MASK_EX1Q_HIGH_TH_V1 << BIT_SHIFT_EX1Q_HIGH_TH_V1) -+#define BIT_CLEAR_EX1Q_HIGH_TH_V1(x) ((x) & (~BITS_EX1Q_HIGH_TH_V1)) -+#define BIT_GET_EX1Q_HIGH_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_EX1Q_HIGH_TH_V1) & BIT_MASK_EX1Q_HIGH_TH_V1) -+#define BIT_SET_EX1Q_HIGH_TH_V1(x, v) \ -+ (BIT_CLEAR_EX1Q_HIGH_TH_V1(x) | BIT_EX1Q_HIGH_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DMA_OQT_0 (Offset 0x0260) */ -+ -+#define BIT_SHIFT_TX_OQT_8_11_FREE_SPACE 16 -+#define BIT_MASK_TX_OQT_8_11_FREE_SPACE 0xff -+#define BIT_TX_OQT_8_11_FREE_SPACE(x) \ -+ (((x) & BIT_MASK_TX_OQT_8_11_FREE_SPACE) \ -+ << BIT_SHIFT_TX_OQT_8_11_FREE_SPACE) -+#define BITS_TX_OQT_8_11_FREE_SPACE \ -+ (BIT_MASK_TX_OQT_8_11_FREE_SPACE << BIT_SHIFT_TX_OQT_8_11_FREE_SPACE) -+#define BIT_CLEAR_TX_OQT_8_11_FREE_SPACE(x) \ -+ ((x) & (~BITS_TX_OQT_8_11_FREE_SPACE)) -+#define BIT_GET_TX_OQT_8_11_FREE_SPACE(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_8_11_FREE_SPACE) & \ -+ BIT_MASK_TX_OQT_8_11_FREE_SPACE) -+#define BIT_SET_TX_OQT_8_11_FREE_SPACE(x, v) \ -+ (BIT_CLEAR_TX_OQT_8_11_FREE_SPACE(x) | BIT_TX_OQT_8_11_FREE_SPACE(v)) -+ -+#define BIT_SHIFT_TX_OQT_16_FREE_SPACE 16 -+#define BIT_MASK_TX_OQT_16_FREE_SPACE 0xff -+#define BIT_TX_OQT_16_FREE_SPACE(x) \ -+ (((x) & BIT_MASK_TX_OQT_16_FREE_SPACE) \ -+ << BIT_SHIFT_TX_OQT_16_FREE_SPACE) -+#define BITS_TX_OQT_16_FREE_SPACE \ -+ (BIT_MASK_TX_OQT_16_FREE_SPACE << BIT_SHIFT_TX_OQT_16_FREE_SPACE) -+#define BIT_CLEAR_TX_OQT_16_FREE_SPACE(x) ((x) & (~BITS_TX_OQT_16_FREE_SPACE)) -+#define BIT_GET_TX_OQT_16_FREE_SPACE(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_16_FREE_SPACE) & \ -+ BIT_MASK_TX_OQT_16_FREE_SPACE) -+#define BIT_SET_TX_OQT_16_FREE_SPACE(x, v) \ -+ (BIT_CLEAR_TX_OQT_16_FREE_SPACE(x) | BIT_TX_OQT_16_FREE_SPACE(v)) -+ -+#define BIT_SHIFT_TX_OQT_4_7_FREE_SPACE 8 -+#define BIT_MASK_TX_OQT_4_7_FREE_SPACE 0xff -+#define BIT_TX_OQT_4_7_FREE_SPACE(x) \ -+ (((x) & BIT_MASK_TX_OQT_4_7_FREE_SPACE) \ -+ << BIT_SHIFT_TX_OQT_4_7_FREE_SPACE) -+#define BITS_TX_OQT_4_7_FREE_SPACE \ -+ (BIT_MASK_TX_OQT_4_7_FREE_SPACE << BIT_SHIFT_TX_OQT_4_7_FREE_SPACE) -+#define BIT_CLEAR_TX_OQT_4_7_FREE_SPACE(x) ((x) & (~BITS_TX_OQT_4_7_FREE_SPACE)) -+#define BIT_GET_TX_OQT_4_7_FREE_SPACE(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_4_7_FREE_SPACE) & \ -+ BIT_MASK_TX_OQT_4_7_FREE_SPACE) -+#define BIT_SET_TX_OQT_4_7_FREE_SPACE(x, v) \ -+ (BIT_CLEAR_TX_OQT_4_7_FREE_SPACE(x) | BIT_TX_OQT_4_7_FREE_SPACE(v)) -+ -+#define BIT_SHIFT_TX_OQT_14_15_FREE_SPACE 8 -+#define BIT_MASK_TX_OQT_14_15_FREE_SPACE 0xff -+#define BIT_TX_OQT_14_15_FREE_SPACE(x) \ -+ (((x) & BIT_MASK_TX_OQT_14_15_FREE_SPACE) \ -+ << BIT_SHIFT_TX_OQT_14_15_FREE_SPACE) -+#define BITS_TX_OQT_14_15_FREE_SPACE \ -+ (BIT_MASK_TX_OQT_14_15_FREE_SPACE << BIT_SHIFT_TX_OQT_14_15_FREE_SPACE) -+#define BIT_CLEAR_TX_OQT_14_15_FREE_SPACE(x) \ -+ ((x) & (~BITS_TX_OQT_14_15_FREE_SPACE)) -+#define BIT_GET_TX_OQT_14_15_FREE_SPACE(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_14_15_FREE_SPACE) & \ -+ BIT_MASK_TX_OQT_14_15_FREE_SPACE) -+#define BIT_SET_TX_OQT_14_15_FREE_SPACE(x, v) \ -+ (BIT_CLEAR_TX_OQT_14_15_FREE_SPACE(x) | BIT_TX_OQT_14_15_FREE_SPACE(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TQPNT5 (Offset 0x0260) */ -+ -+#define BIT_SHIFT_EX1Q_LOW_TH_V1 0 -+#define BIT_MASK_EX1Q_LOW_TH_V1 0xfff -+#define BIT_EX1Q_LOW_TH_V1(x) \ -+ (((x) & BIT_MASK_EX1Q_LOW_TH_V1) << BIT_SHIFT_EX1Q_LOW_TH_V1) -+#define BITS_EX1Q_LOW_TH_V1 \ -+ (BIT_MASK_EX1Q_LOW_TH_V1 << BIT_SHIFT_EX1Q_LOW_TH_V1) -+#define BIT_CLEAR_EX1Q_LOW_TH_V1(x) ((x) & (~BITS_EX1Q_LOW_TH_V1)) -+#define BIT_GET_EX1Q_LOW_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_EX1Q_LOW_TH_V1) & BIT_MASK_EX1Q_LOW_TH_V1) -+#define BIT_SET_EX1Q_LOW_TH_V1(x, v) \ -+ (BIT_CLEAR_EX1Q_LOW_TH_V1(x) | BIT_EX1Q_LOW_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DMA_OQT_0 (Offset 0x0260) */ -+ -+#define BIT_SHIFT_TX_OQT_0_3_FREE_SPACE 0 -+#define BIT_MASK_TX_OQT_0_3_FREE_SPACE 0xff -+#define BIT_TX_OQT_0_3_FREE_SPACE(x) \ -+ (((x) & BIT_MASK_TX_OQT_0_3_FREE_SPACE) \ -+ << BIT_SHIFT_TX_OQT_0_3_FREE_SPACE) -+#define BITS_TX_OQT_0_3_FREE_SPACE \ -+ (BIT_MASK_TX_OQT_0_3_FREE_SPACE << BIT_SHIFT_TX_OQT_0_3_FREE_SPACE) -+#define BIT_CLEAR_TX_OQT_0_3_FREE_SPACE(x) ((x) & (~BITS_TX_OQT_0_3_FREE_SPACE)) -+#define BIT_GET_TX_OQT_0_3_FREE_SPACE(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_0_3_FREE_SPACE) & \ -+ BIT_MASK_TX_OQT_0_3_FREE_SPACE) -+#define BIT_SET_TX_OQT_0_3_FREE_SPACE(x, v) \ -+ (BIT_CLEAR_TX_OQT_0_3_FREE_SPACE(x) | BIT_TX_OQT_0_3_FREE_SPACE(v)) -+ -+#define BIT_SHIFT_TX_OQT_13_FREE_SPACE 0 -+#define BIT_MASK_TX_OQT_13_FREE_SPACE 0xff -+#define BIT_TX_OQT_13_FREE_SPACE(x) \ -+ (((x) & BIT_MASK_TX_OQT_13_FREE_SPACE) \ -+ << BIT_SHIFT_TX_OQT_13_FREE_SPACE) -+#define BITS_TX_OQT_13_FREE_SPACE \ -+ (BIT_MASK_TX_OQT_13_FREE_SPACE << BIT_SHIFT_TX_OQT_13_FREE_SPACE) -+#define BIT_CLEAR_TX_OQT_13_FREE_SPACE(x) ((x) & (~BITS_TX_OQT_13_FREE_SPACE)) -+#define BIT_GET_TX_OQT_13_FREE_SPACE(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_13_FREE_SPACE) & \ -+ BIT_MASK_TX_OQT_13_FREE_SPACE) -+#define BIT_SET_TX_OQT_13_FREE_SPACE(x, v) \ -+ (BIT_CLEAR_TX_OQT_13_FREE_SPACE(x) | BIT_TX_OQT_13_FREE_SPACE(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TQPNT6 (Offset 0x0264) */ -+ -+#define BIT_SHIFT_EX2Q_HIGH_TH_V1 16 -+#define BIT_MASK_EX2Q_HIGH_TH_V1 0xfff -+#define BIT_EX2Q_HIGH_TH_V1(x) \ -+ (((x) & BIT_MASK_EX2Q_HIGH_TH_V1) << BIT_SHIFT_EX2Q_HIGH_TH_V1) -+#define BITS_EX2Q_HIGH_TH_V1 \ -+ (BIT_MASK_EX2Q_HIGH_TH_V1 << BIT_SHIFT_EX2Q_HIGH_TH_V1) -+#define BIT_CLEAR_EX2Q_HIGH_TH_V1(x) ((x) & (~BITS_EX2Q_HIGH_TH_V1)) -+#define BIT_GET_EX2Q_HIGH_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_EX2Q_HIGH_TH_V1) & BIT_MASK_EX2Q_HIGH_TH_V1) -+#define BIT_SET_EX2Q_HIGH_TH_V1(x, v) \ -+ (BIT_CLEAR_EX2Q_HIGH_TH_V1(x) | BIT_EX2Q_HIGH_TH_V1(v)) -+ -+#define BIT_SHIFT_EX2Q_LOW_TH_V1 0 -+#define BIT_MASK_EX2Q_LOW_TH_V1 0xfff -+#define BIT_EX2Q_LOW_TH_V1(x) \ -+ (((x) & BIT_MASK_EX2Q_LOW_TH_V1) << BIT_SHIFT_EX2Q_LOW_TH_V1) -+#define BITS_EX2Q_LOW_TH_V1 \ -+ (BIT_MASK_EX2Q_LOW_TH_V1 << BIT_SHIFT_EX2Q_LOW_TH_V1) -+#define BIT_CLEAR_EX2Q_LOW_TH_V1(x) ((x) & (~BITS_EX2Q_LOW_TH_V1)) -+#define BIT_GET_EX2Q_LOW_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_EX2Q_LOW_TH_V1) & BIT_MASK_EX2Q_LOW_TH_V1) -+#define BIT_SET_EX2Q_LOW_TH_V1(x, v) \ -+ (BIT_CLEAR_EX2Q_LOW_TH_V1(x) | BIT_EX2Q_LOW_TH_V1(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_6 (Offset 0x0268) */ -+ -+#define BIT_SHIFT_EX1Q_AVAL_PG_V1 16 -+#define BIT_MASK_EX1Q_AVAL_PG_V1 0xfff -+#define BIT_EX1Q_AVAL_PG_V1(x) \ -+ (((x) & BIT_MASK_EX1Q_AVAL_PG_V1) << BIT_SHIFT_EX1Q_AVAL_PG_V1) -+#define BITS_EX1Q_AVAL_PG_V1 \ -+ (BIT_MASK_EX1Q_AVAL_PG_V1 << BIT_SHIFT_EX1Q_AVAL_PG_V1) -+#define BIT_CLEAR_EX1Q_AVAL_PG_V1(x) ((x) & (~BITS_EX1Q_AVAL_PG_V1)) -+#define BIT_GET_EX1Q_AVAL_PG_V1(x) \ -+ (((x) >> BIT_SHIFT_EX1Q_AVAL_PG_V1) & BIT_MASK_EX1Q_AVAL_PG_V1) -+#define BIT_SET_EX1Q_AVAL_PG_V1(x, v) \ -+ (BIT_CLEAR_EX1Q_AVAL_PG_V1(x) | BIT_EX1Q_AVAL_PG_V1(v)) -+ -+#define BIT_SHIFT_EX1Q_V1 0 -+#define BIT_MASK_EX1Q_V1 0xfff -+#define BIT_EX1Q_V1(x) (((x) & BIT_MASK_EX1Q_V1) << BIT_SHIFT_EX1Q_V1) -+#define BITS_EX1Q_V1 (BIT_MASK_EX1Q_V1 << BIT_SHIFT_EX1Q_V1) -+#define BIT_CLEAR_EX1Q_V1(x) ((x) & (~BITS_EX1Q_V1)) -+#define BIT_GET_EX1Q_V1(x) (((x) >> BIT_SHIFT_EX1Q_V1) & BIT_MASK_EX1Q_V1) -+#define BIT_SET_EX1Q_V1(x, v) (BIT_CLEAR_EX1Q_V1(x) | BIT_EX1Q_V1(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_7 (Offset 0x026C) */ -+ -+#define BIT_SHIFT_EX2Q_AVAL_PG_V1 16 -+#define BIT_MASK_EX2Q_AVAL_PG_V1 0xfff -+#define BIT_EX2Q_AVAL_PG_V1(x) \ -+ (((x) & BIT_MASK_EX2Q_AVAL_PG_V1) << BIT_SHIFT_EX2Q_AVAL_PG_V1) -+#define BITS_EX2Q_AVAL_PG_V1 \ -+ (BIT_MASK_EX2Q_AVAL_PG_V1 << BIT_SHIFT_EX2Q_AVAL_PG_V1) -+#define BIT_CLEAR_EX2Q_AVAL_PG_V1(x) ((x) & (~BITS_EX2Q_AVAL_PG_V1)) -+#define BIT_GET_EX2Q_AVAL_PG_V1(x) \ -+ (((x) >> BIT_SHIFT_EX2Q_AVAL_PG_V1) & BIT_MASK_EX2Q_AVAL_PG_V1) -+#define BIT_SET_EX2Q_AVAL_PG_V1(x, v) \ -+ (BIT_CLEAR_EX2Q_AVAL_PG_V1(x) | BIT_EX2Q_AVAL_PG_V1(v)) -+ -+#define BIT_SHIFT_EX2Q_V1 0 -+#define BIT_MASK_EX2Q_V1 0xfff -+#define BIT_EX2Q_V1(x) (((x) & BIT_MASK_EX2Q_V1) << BIT_SHIFT_EX2Q_V1) -+#define BITS_EX2Q_V1 (BIT_MASK_EX2Q_V1 << BIT_SHIFT_EX2Q_V1) -+#define BIT_CLEAR_EX2Q_V1(x) ((x) & (~BITS_EX2Q_V1)) -+#define BIT_GET_EX2Q_V1(x) (((x) >> BIT_SHIFT_EX2Q_V1) & BIT_MASK_EX2Q_V1) -+#define BIT_SET_EX2Q_V1(x, v) (BIT_CLEAR_EX2Q_V1(x) | BIT_EX2Q_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_FIFOPAGE_CTRL_4 (Offset 0x0270) */ -+ -+#define BIT_SHIFT_EX1Q_PG_PUBLIC_LIMIT 16 -+#define BIT_MASK_EX1Q_PG_PUBLIC_LIMIT 0xfff -+#define BIT_EX1Q_PG_PUBLIC_LIMIT(x) \ -+ (((x) & BIT_MASK_EX1Q_PG_PUBLIC_LIMIT) \ -+ << BIT_SHIFT_EX1Q_PG_PUBLIC_LIMIT) -+#define BITS_EX1Q_PG_PUBLIC_LIMIT \ -+ (BIT_MASK_EX1Q_PG_PUBLIC_LIMIT << BIT_SHIFT_EX1Q_PG_PUBLIC_LIMIT) -+#define BIT_CLEAR_EX1Q_PG_PUBLIC_LIMIT(x) ((x) & (~BITS_EX1Q_PG_PUBLIC_LIMIT)) -+#define BIT_GET_EX1Q_PG_PUBLIC_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_EX1Q_PG_PUBLIC_LIMIT) & \ -+ BIT_MASK_EX1Q_PG_PUBLIC_LIMIT) -+#define BIT_SET_EX1Q_PG_PUBLIC_LIMIT(x, v) \ -+ (BIT_CLEAR_EX1Q_PG_PUBLIC_LIMIT(x) | BIT_EX1Q_PG_PUBLIC_LIMIT(v)) -+ -+#define BIT_SHIFT_EX2Q_PG_PUBLIC_LIMIT 0 -+#define BIT_MASK_EX2Q_PG_PUBLIC_LIMIT 0xfff -+#define BIT_EX2Q_PG_PUBLIC_LIMIT(x) \ -+ (((x) & BIT_MASK_EX2Q_PG_PUBLIC_LIMIT) \ -+ << BIT_SHIFT_EX2Q_PG_PUBLIC_LIMIT) -+#define BITS_EX2Q_PG_PUBLIC_LIMIT \ -+ (BIT_MASK_EX2Q_PG_PUBLIC_LIMIT << BIT_SHIFT_EX2Q_PG_PUBLIC_LIMIT) -+#define BIT_CLEAR_EX2Q_PG_PUBLIC_LIMIT(x) ((x) & (~BITS_EX2Q_PG_PUBLIC_LIMIT)) -+#define BIT_GET_EX2Q_PG_PUBLIC_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_EX2Q_PG_PUBLIC_LIMIT) & \ -+ BIT_MASK_EX2Q_PG_PUBLIC_LIMIT) -+#define BIT_SET_EX2Q_PG_PUBLIC_LIMIT(x, v) \ -+ (BIT_CLEAR_EX2Q_PG_PUBLIC_LIMIT(x) | BIT_EX2Q_PG_PUBLIC_LIMIT(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PGSUB_H (Offset 0x0270) */ -+ -+#define BIT_SHIFT_HPQ_PGSUB_CNT 0 -+#define BIT_MASK_HPQ_PGSUB_CNT 0xffffffffL -+#define BIT_HPQ_PGSUB_CNT(x) \ -+ (((x) & BIT_MASK_HPQ_PGSUB_CNT) << BIT_SHIFT_HPQ_PGSUB_CNT) -+#define BITS_HPQ_PGSUB_CNT (BIT_MASK_HPQ_PGSUB_CNT << BIT_SHIFT_HPQ_PGSUB_CNT) -+#define BIT_CLEAR_HPQ_PGSUB_CNT(x) ((x) & (~BITS_HPQ_PGSUB_CNT)) -+#define BIT_GET_HPQ_PGSUB_CNT(x) \ -+ (((x) >> BIT_SHIFT_HPQ_PGSUB_CNT) & BIT_MASK_HPQ_PGSUB_CNT) -+#define BIT_SET_HPQ_PGSUB_CNT(x, v) \ -+ (BIT_CLEAR_HPQ_PGSUB_CNT(x) | BIT_HPQ_PGSUB_CNT(v)) -+ -+/* 2 REG_PGSUB_N (Offset 0x0274) */ -+ -+#define BIT_SHIFT_NPQ_PGSUB_CNT 0 -+#define BIT_MASK_NPQ_PGSUB_CNT 0xffffffffL -+#define BIT_NPQ_PGSUB_CNT(x) \ -+ (((x) & BIT_MASK_NPQ_PGSUB_CNT) << BIT_SHIFT_NPQ_PGSUB_CNT) -+#define BITS_NPQ_PGSUB_CNT (BIT_MASK_NPQ_PGSUB_CNT << BIT_SHIFT_NPQ_PGSUB_CNT) -+#define BIT_CLEAR_NPQ_PGSUB_CNT(x) ((x) & (~BITS_NPQ_PGSUB_CNT)) -+#define BIT_GET_NPQ_PGSUB_CNT(x) \ -+ (((x) >> BIT_SHIFT_NPQ_PGSUB_CNT) & BIT_MASK_NPQ_PGSUB_CNT) -+#define BIT_SET_NPQ_PGSUB_CNT(x, v) \ -+ (BIT_CLEAR_NPQ_PGSUB_CNT(x) | BIT_NPQ_PGSUB_CNT(v)) -+ -+/* 2 REG_PGSUB_L (Offset 0x0278) */ -+ -+#define BIT_SHIFT_LPQ_PGSUB_CNT 0 -+#define BIT_MASK_LPQ_PGSUB_CNT 0xffffffffL -+#define BIT_LPQ_PGSUB_CNT(x) \ -+ (((x) & BIT_MASK_LPQ_PGSUB_CNT) << BIT_SHIFT_LPQ_PGSUB_CNT) -+#define BITS_LPQ_PGSUB_CNT (BIT_MASK_LPQ_PGSUB_CNT << BIT_SHIFT_LPQ_PGSUB_CNT) -+#define BIT_CLEAR_LPQ_PGSUB_CNT(x) ((x) & (~BITS_LPQ_PGSUB_CNT)) -+#define BIT_GET_LPQ_PGSUB_CNT(x) \ -+ (((x) >> BIT_SHIFT_LPQ_PGSUB_CNT) & BIT_MASK_LPQ_PGSUB_CNT) -+#define BIT_SET_LPQ_PGSUB_CNT(x, v) \ -+ (BIT_CLEAR_LPQ_PGSUB_CNT(x) | BIT_LPQ_PGSUB_CNT(v)) -+ -+/* 2 REG_PGSUB_E (Offset 0x027C) */ -+ -+#define BIT_SHIFT_EPQ_PGSUB_CNT 0 -+#define BIT_MASK_EPQ_PGSUB_CNT 0xffffffffL -+#define BIT_EPQ_PGSUB_CNT(x) \ -+ (((x) & BIT_MASK_EPQ_PGSUB_CNT) << BIT_SHIFT_EPQ_PGSUB_CNT) -+#define BITS_EPQ_PGSUB_CNT (BIT_MASK_EPQ_PGSUB_CNT << BIT_SHIFT_EPQ_PGSUB_CNT) -+#define BIT_CLEAR_EPQ_PGSUB_CNT(x) ((x) & (~BITS_EPQ_PGSUB_CNT)) -+#define BIT_GET_EPQ_PGSUB_CNT(x) \ -+ (((x) >> BIT_SHIFT_EPQ_PGSUB_CNT) & BIT_MASK_EPQ_PGSUB_CNT) -+#define BIT_SET_EPQ_PGSUB_CNT(x, v) \ -+ (BIT_CLEAR_EPQ_PGSUB_CNT(x) | BIT_EPQ_PGSUB_CNT(v)) -+ -+#define BIT_SHIFT_FWFF_PKT_STR_ADDR_V2 0 -+#define BIT_MASK_FWFF_PKT_STR_ADDR_V2 0x3fff -+#define BIT_FWFF_PKT_STR_ADDR_V2(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_STR_ADDR_V2) \ -+ << BIT_SHIFT_FWFF_PKT_STR_ADDR_V2) -+#define BITS_FWFF_PKT_STR_ADDR_V2 \ -+ (BIT_MASK_FWFF_PKT_STR_ADDR_V2 << BIT_SHIFT_FWFF_PKT_STR_ADDR_V2) -+#define BIT_CLEAR_FWFF_PKT_STR_ADDR_V2(x) ((x) & (~BITS_FWFF_PKT_STR_ADDR_V2)) -+#define BIT_GET_FWFF_PKT_STR_ADDR_V2(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_STR_ADDR_V2) & \ -+ BIT_MASK_FWFF_PKT_STR_ADDR_V2) -+#define BIT_SET_FWFF_PKT_STR_ADDR_V2(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_STR_ADDR_V2(x) | BIT_FWFF_PKT_STR_ADDR_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_USB_RXDMA_AGG_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_RXDMA_AGG_OLD_MOD_V1 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_DMA_STORE_MODE BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_DMA_STORE BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_EN_FW_ADD BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_RXAGG_TH_MODE BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_EN_PRE_CALC BIT(29) -+#define BIT_RXAGG_SW_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_RXAGG_SW_TRIG BIT(27) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_BCNERR_CNT_OTHERS 24 -+#define BIT_MASK_BCNERR_CNT_OTHERS 0xff -+#define BIT_BCNERR_CNT_OTHERS(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_OTHERS) << BIT_SHIFT_BCNERR_CNT_OTHERS) -+#define BITS_BCNERR_CNT_OTHERS \ -+ (BIT_MASK_BCNERR_CNT_OTHERS << BIT_SHIFT_BCNERR_CNT_OTHERS) -+#define BIT_CLEAR_BCNERR_CNT_OTHERS(x) ((x) & (~BITS_BCNERR_CNT_OTHERS)) -+#define BIT_GET_BCNERR_CNT_OTHERS(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_OTHERS) & BIT_MASK_BCNERR_CNT_OTHERS) -+#define BIT_SET_BCNERR_CNT_OTHERS(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_OTHERS(x) | BIT_BCNERR_CNT_OTHERS(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_RXDMA_AGG_OLD_MOD 24 -+#define BIT_MASK_RXDMA_AGG_OLD_MOD 0xff -+#define BIT_RXDMA_AGG_OLD_MOD(x) \ -+ (((x) & BIT_MASK_RXDMA_AGG_OLD_MOD) << BIT_SHIFT_RXDMA_AGG_OLD_MOD) -+#define BITS_RXDMA_AGG_OLD_MOD \ -+ (BIT_MASK_RXDMA_AGG_OLD_MOD << BIT_SHIFT_RXDMA_AGG_OLD_MOD) -+#define BIT_CLEAR_RXDMA_AGG_OLD_MOD(x) ((x) & (~BITS_RXDMA_AGG_OLD_MOD)) -+#define BIT_GET_RXDMA_AGG_OLD_MOD(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_AGG_OLD_MOD) & BIT_MASK_RXDMA_AGG_OLD_MOD) -+#define BIT_SET_RXDMA_AGG_OLD_MOD(x, v) \ -+ (BIT_CLEAR_RXDMA_AGG_OLD_MOD(x) | BIT_RXDMA_AGG_OLD_MOD(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_PKT_NUM_WOL 16 -+#define BIT_MASK_PKT_NUM_WOL 0xff -+#define BIT_PKT_NUM_WOL(x) \ -+ (((x) & BIT_MASK_PKT_NUM_WOL) << BIT_SHIFT_PKT_NUM_WOL) -+#define BITS_PKT_NUM_WOL (BIT_MASK_PKT_NUM_WOL << BIT_SHIFT_PKT_NUM_WOL) -+#define BIT_CLEAR_PKT_NUM_WOL(x) ((x) & (~BITS_PKT_NUM_WOL)) -+#define BIT_GET_PKT_NUM_WOL(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_WOL) & BIT_MASK_PKT_NUM_WOL) -+#define BIT_SET_PKT_NUM_WOL(x, v) \ -+ (BIT_CLEAR_PKT_NUM_WOL(x) | BIT_PKT_NUM_WOL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_RXBCN_TIMER 16 -+#define BIT_MASK_RXBCN_TIMER 0xffff -+#define BIT_RXBCN_TIMER(x) \ -+ (((x) & BIT_MASK_RXBCN_TIMER) << BIT_SHIFT_RXBCN_TIMER) -+#define BITS_RXBCN_TIMER (BIT_MASK_RXBCN_TIMER << BIT_SHIFT_RXBCN_TIMER) -+#define BIT_CLEAR_RXBCN_TIMER(x) ((x) & (~BITS_RXBCN_TIMER)) -+#define BIT_GET_RXBCN_TIMER(x) \ -+ (((x) >> BIT_SHIFT_RXBCN_TIMER) & BIT_MASK_RXBCN_TIMER) -+#define BIT_SET_RXBCN_TIMER(x, v) \ -+ (BIT_CLEAR_RXBCN_TIMER(x) | BIT_RXBCN_TIMER(v)) -+ -+#define BIT_SHIFT_BCNERR_CNT_INVALID 16 -+#define BIT_MASK_BCNERR_CNT_INVALID 0xff -+#define BIT_BCNERR_CNT_INVALID(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_INVALID) << BIT_SHIFT_BCNERR_CNT_INVALID) -+#define BITS_BCNERR_CNT_INVALID \ -+ (BIT_MASK_BCNERR_CNT_INVALID << BIT_SHIFT_BCNERR_CNT_INVALID) -+#define BIT_CLEAR_BCNERR_CNT_INVALID(x) ((x) & (~BITS_BCNERR_CNT_INVALID)) -+#define BIT_GET_BCNERR_CNT_INVALID(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_INVALID) & BIT_MASK_BCNERR_CNT_INVALID) -+#define BIT_SET_BCNERR_CNT_INVALID(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_INVALID(x) | BIT_BCNERR_CNT_INVALID(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_DMA_AGG_TO_V1 8 -+#define BIT_MASK_DMA_AGG_TO_V1 0xff -+#define BIT_DMA_AGG_TO_V1(x) \ -+ (((x) & BIT_MASK_DMA_AGG_TO_V1) << BIT_SHIFT_DMA_AGG_TO_V1) -+#define BITS_DMA_AGG_TO_V1 (BIT_MASK_DMA_AGG_TO_V1 << BIT_SHIFT_DMA_AGG_TO_V1) -+#define BIT_CLEAR_DMA_AGG_TO_V1(x) ((x) & (~BITS_DMA_AGG_TO_V1)) -+#define BIT_GET_DMA_AGG_TO_V1(x) \ -+ (((x) >> BIT_SHIFT_DMA_AGG_TO_V1) & BIT_MASK_DMA_AGG_TO_V1) -+#define BIT_SET_DMA_AGG_TO_V1(x, v) \ -+ (BIT_CLEAR_DMA_AGG_TO_V1(x) | BIT_DMA_AGG_TO_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_BCNERR_CNT_MAC 8 -+#define BIT_MASK_BCNERR_CNT_MAC 0xff -+#define BIT_BCNERR_CNT_MAC(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_MAC) << BIT_SHIFT_BCNERR_CNT_MAC) -+#define BITS_BCNERR_CNT_MAC \ -+ (BIT_MASK_BCNERR_CNT_MAC << BIT_SHIFT_BCNERR_CNT_MAC) -+#define BIT_CLEAR_BCNERR_CNT_MAC(x) ((x) & (~BITS_BCNERR_CNT_MAC)) -+#define BIT_GET_BCNERR_CNT_MAC(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_MAC) & BIT_MASK_BCNERR_CNT_MAC) -+#define BIT_SET_BCNERR_CNT_MAC(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_MAC(x) | BIT_BCNERR_CNT_MAC(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_DMA_AGG_TO 8 -+#define BIT_MASK_DMA_AGG_TO 0xf -+#define BIT_DMA_AGG_TO(x) (((x) & BIT_MASK_DMA_AGG_TO) << BIT_SHIFT_DMA_AGG_TO) -+#define BITS_DMA_AGG_TO (BIT_MASK_DMA_AGG_TO << BIT_SHIFT_DMA_AGG_TO) -+#define BIT_CLEAR_DMA_AGG_TO(x) ((x) & (~BITS_DMA_AGG_TO)) -+#define BIT_GET_DMA_AGG_TO(x) \ -+ (((x) >> BIT_SHIFT_DMA_AGG_TO) & BIT_MASK_DMA_AGG_TO) -+#define BIT_SET_DMA_AGG_TO(x, v) (BIT_CLEAR_DMA_AGG_TO(x) | BIT_DMA_AGG_TO(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_RXDMA_AGG_PG_TH_V1 0 -+#define BIT_MASK_RXDMA_AGG_PG_TH_V1 0xf -+#define BIT_RXDMA_AGG_PG_TH_V1(x) \ -+ (((x) & BIT_MASK_RXDMA_AGG_PG_TH_V1) << BIT_SHIFT_RXDMA_AGG_PG_TH_V1) -+#define BITS_RXDMA_AGG_PG_TH_V1 \ -+ (BIT_MASK_RXDMA_AGG_PG_TH_V1 << BIT_SHIFT_RXDMA_AGG_PG_TH_V1) -+#define BIT_CLEAR_RXDMA_AGG_PG_TH_V1(x) ((x) & (~BITS_RXDMA_AGG_PG_TH_V1)) -+#define BIT_GET_RXDMA_AGG_PG_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_AGG_PG_TH_V1) & BIT_MASK_RXDMA_AGG_PG_TH_V1) -+#define BIT_SET_RXDMA_AGG_PG_TH_V1(x, v) \ -+ (BIT_CLEAR_RXDMA_AGG_PG_TH_V1(x) | BIT_RXDMA_AGG_PG_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_RXDMA_AGG_PG_TH 0 -+#define BIT_MASK_RXDMA_AGG_PG_TH 0xff -+#define BIT_RXDMA_AGG_PG_TH(x) \ -+ (((x) & BIT_MASK_RXDMA_AGG_PG_TH) << BIT_SHIFT_RXDMA_AGG_PG_TH) -+#define BITS_RXDMA_AGG_PG_TH \ -+ (BIT_MASK_RXDMA_AGG_PG_TH << BIT_SHIFT_RXDMA_AGG_PG_TH) -+#define BIT_CLEAR_RXDMA_AGG_PG_TH(x) ((x) & (~BITS_RXDMA_AGG_PG_TH)) -+#define BIT_GET_RXDMA_AGG_PG_TH(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_AGG_PG_TH) & BIT_MASK_RXDMA_AGG_PG_TH) -+#define BIT_SET_RXDMA_AGG_PG_TH(x, v) \ -+ (BIT_CLEAR_RXDMA_AGG_PG_TH(x) | BIT_RXDMA_AGG_PG_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_QINFO_INDEX 0 -+#define BIT_MASK_QINFO_INDEX 0x1f -+#define BIT_QINFO_INDEX(x) \ -+ (((x) & BIT_MASK_QINFO_INDEX) << BIT_SHIFT_QINFO_INDEX) -+#define BITS_QINFO_INDEX (BIT_MASK_QINFO_INDEX << BIT_SHIFT_QINFO_INDEX) -+#define BIT_CLEAR_QINFO_INDEX(x) ((x) & (~BITS_QINFO_INDEX)) -+#define BIT_GET_QINFO_INDEX(x) \ -+ (((x) >> BIT_SHIFT_QINFO_INDEX) & BIT_MASK_QINFO_INDEX) -+#define BIT_SET_QINFO_INDEX(x, v) \ -+ (BIT_CLEAR_QINFO_INDEX(x) | BIT_QINFO_INDEX(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_BCNERR_CNT_CCA 0 -+#define BIT_MASK_BCNERR_CNT_CCA 0xff -+#define BIT_BCNERR_CNT_CCA(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_CCA) << BIT_SHIFT_BCNERR_CNT_CCA) -+#define BITS_BCNERR_CNT_CCA \ -+ (BIT_MASK_BCNERR_CNT_CCA << BIT_SHIFT_BCNERR_CNT_CCA) -+#define BIT_CLEAR_BCNERR_CNT_CCA(x) ((x) & (~BITS_BCNERR_CNT_CCA)) -+#define BIT_GET_BCNERR_CNT_CCA(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_CCA) & BIT_MASK_BCNERR_CNT_CCA) -+#define BIT_SET_BCNERR_CNT_CCA(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_CCA(x) | BIT_BCNERR_CNT_CCA(v)) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RXDMA_AGG_PG_TH (Offset 0x0280) */ -+ -+#define BIT_SHIFT_RXDMA_AGG_PG_TH_V2 0 -+#define BIT_MASK_RXDMA_AGG_PG_TH_V2 0xff -+#define BIT_RXDMA_AGG_PG_TH_V2(x) \ -+ (((x) & BIT_MASK_RXDMA_AGG_PG_TH_V2) << BIT_SHIFT_RXDMA_AGG_PG_TH_V2) -+#define BITS_RXDMA_AGG_PG_TH_V2 \ -+ (BIT_MASK_RXDMA_AGG_PG_TH_V2 << BIT_SHIFT_RXDMA_AGG_PG_TH_V2) -+#define BIT_CLEAR_RXDMA_AGG_PG_TH_V2(x) ((x) & (~BITS_RXDMA_AGG_PG_TH_V2)) -+#define BIT_GET_RXDMA_AGG_PG_TH_V2(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_AGG_PG_TH_V2) & BIT_MASK_RXDMA_AGG_PG_TH_V2) -+#define BIT_SET_RXDMA_AGG_PG_TH_V2(x, v) \ -+ (BIT_CLEAR_RXDMA_AGG_PG_TH_V2(x) | BIT_RXDMA_AGG_PG_TH_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXPKT_NUM (Offset 0x0284) */ -+ -+#define BIT_SHIFT_RXPKT_NUM 24 -+#define BIT_MASK_RXPKT_NUM 0xff -+#define BIT_RXPKT_NUM(x) (((x) & BIT_MASK_RXPKT_NUM) << BIT_SHIFT_RXPKT_NUM) -+#define BITS_RXPKT_NUM (BIT_MASK_RXPKT_NUM << BIT_SHIFT_RXPKT_NUM) -+#define BIT_CLEAR_RXPKT_NUM(x) ((x) & (~BITS_RXPKT_NUM)) -+#define BIT_GET_RXPKT_NUM(x) (((x) >> BIT_SHIFT_RXPKT_NUM) & BIT_MASK_RXPKT_NUM) -+#define BIT_SET_RXPKT_NUM(x, v) (BIT_CLEAR_RXPKT_NUM(x) | BIT_RXPKT_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_RXPKT_NUM (Offset 0x0284) */ -+ -+#define BIT_STOP_RXDMA BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXPKT_NUM (Offset 0x0284) */ -+ -+#define BIT_SHIFT_FW_UPD_RDPTR19_TO_16 20 -+#define BIT_MASK_FW_UPD_RDPTR19_TO_16 0xf -+#define BIT_FW_UPD_RDPTR19_TO_16(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR19_TO_16) \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16) -+#define BITS_FW_UPD_RDPTR19_TO_16 \ -+ (BIT_MASK_FW_UPD_RDPTR19_TO_16 << BIT_SHIFT_FW_UPD_RDPTR19_TO_16) -+#define BIT_CLEAR_FW_UPD_RDPTR19_TO_16(x) ((x) & (~BITS_FW_UPD_RDPTR19_TO_16)) -+#define BIT_GET_FW_UPD_RDPTR19_TO_16(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR19_TO_16) & \ -+ BIT_MASK_FW_UPD_RDPTR19_TO_16) -+#define BIT_SET_FW_UPD_RDPTR19_TO_16(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR19_TO_16(x) | BIT_FW_UPD_RDPTR19_TO_16(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXPKT_NUM (Offset 0x0284) */ -+ -+#define BIT_RXDMA_REQ BIT(19) -+#define BIT_RW_RELEASE_EN BIT(18) -+#define BIT_RXDMA_IDLE BIT(17) -+#define BIT_RXPKT_RELEASE_POLL BIT(16) -+ -+#define BIT_SHIFT_FW_UPD_RDPTR 0 -+#define BIT_MASK_FW_UPD_RDPTR 0xffff -+#define BIT_FW_UPD_RDPTR(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR) << BIT_SHIFT_FW_UPD_RDPTR) -+#define BITS_FW_UPD_RDPTR (BIT_MASK_FW_UPD_RDPTR << BIT_SHIFT_FW_UPD_RDPTR) -+#define BIT_CLEAR_FW_UPD_RDPTR(x) ((x) & (~BITS_FW_UPD_RDPTR)) -+#define BIT_GET_FW_UPD_RDPTR(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR) & BIT_MASK_FW_UPD_RDPTR) -+#define BIT_SET_FW_UPD_RDPTR(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR(x) | BIT_FW_UPD_RDPTR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_RXDMA_STATUS (Offset 0x0288) */ -+ -+#define BIT_FC2H_PKT_OVERFLOW BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RXDMA_STATUS (Offset 0x0288) */ -+ -+#define BIT_FC2H_PKT_OVF BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_STATUS (Offset 0x0288) */ -+ -+#define BIT_C2H_PKT_OVF BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_STATUS (Offset 0x0288) */ -+ -+#define BIT_AGG_CFG_ISSUE BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_STATUS (Offset 0x0288) */ -+ -+#define BIT_AGG_CONFGI_ISSUE BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_STATUS (Offset 0x0288) */ -+ -+#define BIT_FW_POLL_ISSUE BIT(5) -+#define BIT_RX_DATA_UDN BIT(4) -+#define BIT_RX_SFF_UDN BIT(3) -+#define BIT_RX_SFF_OVF BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_STATUS (Offset 0x0288) */ -+ -+#define BIT_USB_REQ_LEN_OVF BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_STATUS (Offset 0x0288) */ -+ -+#define BIT_RXPKT_OVF BIT(0) -+ -+/* 2 REG_RXDMA_DPR (Offset 0x028C) */ -+ -+#define BIT_SHIFT_RDE_DEBUG 0 -+#define BIT_MASK_RDE_DEBUG 0xffffffffL -+#define BIT_RDE_DEBUG(x) (((x) & BIT_MASK_RDE_DEBUG) << BIT_SHIFT_RDE_DEBUG) -+#define BITS_RDE_DEBUG (BIT_MASK_RDE_DEBUG << BIT_SHIFT_RDE_DEBUG) -+#define BIT_CLEAR_RDE_DEBUG(x) ((x) & (~BITS_RDE_DEBUG)) -+#define BIT_GET_RDE_DEBUG(x) (((x) >> BIT_SHIFT_RDE_DEBUG) & BIT_MASK_RDE_DEBUG) -+#define BIT_SET_RDE_DEBUG(x, v) (BIT_CLEAR_RDE_DEBUG(x) | BIT_RDE_DEBUG(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_MODE (Offset 0x0290) */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V2 24 -+#define BIT_MASK_PKTNUM_TH_V2 0x1f -+#define BIT_PKTNUM_TH_V2(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V2) << BIT_SHIFT_PKTNUM_TH_V2) -+#define BITS_PKTNUM_TH_V2 (BIT_MASK_PKTNUM_TH_V2 << BIT_SHIFT_PKTNUM_TH_V2) -+#define BIT_CLEAR_PKTNUM_TH_V2(x) ((x) & (~BITS_PKTNUM_TH_V2)) -+#define BIT_GET_PKTNUM_TH_V2(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V2) & BIT_MASK_PKTNUM_TH_V2) -+#define BIT_SET_PKTNUM_TH_V2(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V2(x) | BIT_PKTNUM_TH_V2(v)) -+ -+#define BIT_TXBA_BREAK_USBAGG BIT(23) -+ -+#define BIT_SHIFT_PKTLEN_PARA 16 -+#define BIT_MASK_PKTLEN_PARA 0x7 -+#define BIT_PKTLEN_PARA(x) \ -+ (((x) & BIT_MASK_PKTLEN_PARA) << BIT_SHIFT_PKTLEN_PARA) -+#define BITS_PKTLEN_PARA (BIT_MASK_PKTLEN_PARA << BIT_SHIFT_PKTLEN_PARA) -+#define BIT_CLEAR_PKTLEN_PARA(x) ((x) & (~BITS_PKTLEN_PARA)) -+#define BIT_GET_PKTLEN_PARA(x) \ -+ (((x) >> BIT_SHIFT_PKTLEN_PARA) & BIT_MASK_PKTLEN_PARA) -+#define BIT_SET_PKTLEN_PARA(x, v) \ -+ (BIT_CLEAR_PKTLEN_PARA(x) | BIT_PKTLEN_PARA(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXDMA_MODE (Offset 0x0290) */ -+ -+#define BIT_EN_SDIO_FAIL BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RXDMA_MODE (Offset 0x0290) */ -+ -+#define BIT_GRAYCODE_SYNC_WITH_BIN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXDMA_MODE (Offset 0x0290) */ -+ -+#define BIT_RXDMA_DBD_SEL BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_MODE (Offset 0x0290) */ -+ -+#define BIT_RX_DBG_SEL BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_MODE (Offset 0x0290) */ -+ -+#define BIT_EN_SPD BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_MODE (Offset 0x0290) */ -+ -+#define BIT_SHIFT_BURST_SIZE 4 -+#define BIT_MASK_BURST_SIZE 0x3 -+#define BIT_BURST_SIZE(x) (((x) & BIT_MASK_BURST_SIZE) << BIT_SHIFT_BURST_SIZE) -+#define BITS_BURST_SIZE (BIT_MASK_BURST_SIZE << BIT_SHIFT_BURST_SIZE) -+#define BIT_CLEAR_BURST_SIZE(x) ((x) & (~BITS_BURST_SIZE)) -+#define BIT_GET_BURST_SIZE(x) \ -+ (((x) >> BIT_SHIFT_BURST_SIZE) & BIT_MASK_BURST_SIZE) -+#define BIT_SET_BURST_SIZE(x, v) (BIT_CLEAR_BURST_SIZE(x) | BIT_BURST_SIZE(v)) -+ -+#define BIT_SHIFT_BURST_CNT 2 -+#define BIT_MASK_BURST_CNT 0x3 -+#define BIT_BURST_CNT(x) (((x) & BIT_MASK_BURST_CNT) << BIT_SHIFT_BURST_CNT) -+#define BITS_BURST_CNT (BIT_MASK_BURST_CNT << BIT_SHIFT_BURST_CNT) -+#define BIT_CLEAR_BURST_CNT(x) ((x) & (~BITS_BURST_CNT)) -+#define BIT_GET_BURST_CNT(x) (((x) >> BIT_SHIFT_BURST_CNT) & BIT_MASK_BURST_CNT) -+#define BIT_SET_BURST_CNT(x, v) (BIT_CLEAR_BURST_CNT(x) | BIT_BURST_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXDMA_MODE (Offset 0x0290) */ -+ -+#define BIT_DAM_MODE BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_MODE (Offset 0x0290) */ -+ -+#define BIT_DMA_MODE BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_C2H_PKT (Offset 0x0294) */ -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19 24 -+#define BIT_MASK_R_C2H_STR_ADDR_16_TO_19 0xf -+#define BIT_R_C2H_STR_ADDR_16_TO_19(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_16_TO_19) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19) -+#define BITS_R_C2H_STR_ADDR_16_TO_19 \ -+ (BIT_MASK_R_C2H_STR_ADDR_16_TO_19 << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19) -+#define BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19(x) \ -+ ((x) & (~BITS_R_C2H_STR_ADDR_16_TO_19)) -+#define BIT_GET_R_C2H_STR_ADDR_16_TO_19(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19) & \ -+ BIT_MASK_R_C2H_STR_ADDR_16_TO_19) -+#define BIT_SET_R_C2H_STR_ADDR_16_TO_19(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19(x) | BIT_R_C2H_STR_ADDR_16_TO_19(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_C2H_PKT (Offset 0x0294) */ -+ -+#define BIT_R_C2H_PKT_REQ BIT(16) -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR 0 -+#define BIT_MASK_R_C2H_STR_ADDR 0xffff -+#define BIT_R_C2H_STR_ADDR(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR) << BIT_SHIFT_R_C2H_STR_ADDR) -+#define BITS_R_C2H_STR_ADDR \ -+ (BIT_MASK_R_C2H_STR_ADDR << BIT_SHIFT_R_C2H_STR_ADDR) -+#define BIT_CLEAR_R_C2H_STR_ADDR(x) ((x) & (~BITS_R_C2H_STR_ADDR)) -+#define BIT_GET_R_C2H_STR_ADDR(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR) & BIT_MASK_R_C2H_STR_ADDR) -+#define BIT_SET_R_C2H_STR_ADDR(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR(x) | BIT_R_C2H_STR_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWFF_C2H (Offset 0x0298) */ -+ -+#define BIT_SHIFT_C2H_DMA_ADDR 0 -+#define BIT_MASK_C2H_DMA_ADDR 0x3ffff -+#define BIT_C2H_DMA_ADDR(x) \ -+ (((x) & BIT_MASK_C2H_DMA_ADDR) << BIT_SHIFT_C2H_DMA_ADDR) -+#define BITS_C2H_DMA_ADDR (BIT_MASK_C2H_DMA_ADDR << BIT_SHIFT_C2H_DMA_ADDR) -+#define BIT_CLEAR_C2H_DMA_ADDR(x) ((x) & (~BITS_C2H_DMA_ADDR)) -+#define BIT_GET_C2H_DMA_ADDR(x) \ -+ (((x) >> BIT_SHIFT_C2H_DMA_ADDR) & BIT_MASK_C2H_DMA_ADDR) -+#define BIT_SET_C2H_DMA_ADDR(x, v) \ -+ (BIT_CLEAR_C2H_DMA_ADDR(x) | BIT_C2H_DMA_ADDR(v)) -+ -+/* 2 REG_FWFF_CTRL (Offset 0x029C) */ -+ -+#define BIT_FWFF_DMAPKT_REQ BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWFF_CTRL (Offset 0x029C) */ -+ -+#define BIT_SHIFT_FWFF_DMA_PKT_NUM 16 -+#define BIT_MASK_FWFF_DMA_PKT_NUM 0xff -+#define BIT_FWFF_DMA_PKT_NUM(x) \ -+ (((x) & BIT_MASK_FWFF_DMA_PKT_NUM) << BIT_SHIFT_FWFF_DMA_PKT_NUM) -+#define BITS_FWFF_DMA_PKT_NUM \ -+ (BIT_MASK_FWFF_DMA_PKT_NUM << BIT_SHIFT_FWFF_DMA_PKT_NUM) -+#define BIT_CLEAR_FWFF_DMA_PKT_NUM(x) ((x) & (~BITS_FWFF_DMA_PKT_NUM)) -+#define BIT_GET_FWFF_DMA_PKT_NUM(x) \ -+ (((x) >> BIT_SHIFT_FWFF_DMA_PKT_NUM) & BIT_MASK_FWFF_DMA_PKT_NUM) -+#define BIT_SET_FWFF_DMA_PKT_NUM(x, v) \ -+ (BIT_CLEAR_FWFF_DMA_PKT_NUM(x) | BIT_FWFF_DMA_PKT_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWFF_CTRL (Offset 0x029C) */ -+ -+#define BIT_SHIFT_FWFF_DMA_PKT_NUM_V1 16 -+#define BIT_MASK_FWFF_DMA_PKT_NUM_V1 0x7fff -+#define BIT_FWFF_DMA_PKT_NUM_V1(x) \ -+ (((x) & BIT_MASK_FWFF_DMA_PKT_NUM_V1) << BIT_SHIFT_FWFF_DMA_PKT_NUM_V1) -+#define BITS_FWFF_DMA_PKT_NUM_V1 \ -+ (BIT_MASK_FWFF_DMA_PKT_NUM_V1 << BIT_SHIFT_FWFF_DMA_PKT_NUM_V1) -+#define BIT_CLEAR_FWFF_DMA_PKT_NUM_V1(x) ((x) & (~BITS_FWFF_DMA_PKT_NUM_V1)) -+#define BIT_GET_FWFF_DMA_PKT_NUM_V1(x) \ -+ (((x) >> BIT_SHIFT_FWFF_DMA_PKT_NUM_V1) & BIT_MASK_FWFF_DMA_PKT_NUM_V1) -+#define BIT_SET_FWFF_DMA_PKT_NUM_V1(x, v) \ -+ (BIT_CLEAR_FWFF_DMA_PKT_NUM_V1(x) | BIT_FWFF_DMA_PKT_NUM_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWFF_CTRL (Offset 0x029C) */ -+ -+#define BIT_SHIFT_FWFF_STR_ADDR 0 -+#define BIT_MASK_FWFF_STR_ADDR 0xffff -+#define BIT_FWFF_STR_ADDR(x) \ -+ (((x) & BIT_MASK_FWFF_STR_ADDR) << BIT_SHIFT_FWFF_STR_ADDR) -+#define BITS_FWFF_STR_ADDR (BIT_MASK_FWFF_STR_ADDR << BIT_SHIFT_FWFF_STR_ADDR) -+#define BIT_CLEAR_FWFF_STR_ADDR(x) ((x) & (~BITS_FWFF_STR_ADDR)) -+#define BIT_GET_FWFF_STR_ADDR(x) \ -+ (((x) >> BIT_SHIFT_FWFF_STR_ADDR) & BIT_MASK_FWFF_STR_ADDR) -+#define BIT_SET_FWFF_STR_ADDR(x, v) \ -+ (BIT_CLEAR_FWFF_STR_ADDR(x) | BIT_FWFF_STR_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWFF_PKT_INFO (Offset 0x02A0) */ -+ -+#define BIT_SHIFT_FWFF_PKT_QUEUED 16 -+#define BIT_MASK_FWFF_PKT_QUEUED 0xff -+#define BIT_FWFF_PKT_QUEUED(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_QUEUED) << BIT_SHIFT_FWFF_PKT_QUEUED) -+#define BITS_FWFF_PKT_QUEUED \ -+ (BIT_MASK_FWFF_PKT_QUEUED << BIT_SHIFT_FWFF_PKT_QUEUED) -+#define BIT_CLEAR_FWFF_PKT_QUEUED(x) ((x) & (~BITS_FWFF_PKT_QUEUED)) -+#define BIT_GET_FWFF_PKT_QUEUED(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_QUEUED) & BIT_MASK_FWFF_PKT_QUEUED) -+#define BIT_SET_FWFF_PKT_QUEUED(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_QUEUED(x) | BIT_FWFF_PKT_QUEUED(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWFF_PKT_INFO (Offset 0x02A0) */ -+ -+#define BIT_SHIFT_FWFF_PKT_READ_ADDR 16 -+#define BIT_MASK_FWFF_PKT_READ_ADDR 0xffff -+#define BIT_FWFF_PKT_READ_ADDR(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_READ_ADDR) << BIT_SHIFT_FWFF_PKT_READ_ADDR) -+#define BITS_FWFF_PKT_READ_ADDR \ -+ (BIT_MASK_FWFF_PKT_READ_ADDR << BIT_SHIFT_FWFF_PKT_READ_ADDR) -+#define BIT_CLEAR_FWFF_PKT_READ_ADDR(x) ((x) & (~BITS_FWFF_PKT_READ_ADDR)) -+#define BIT_GET_FWFF_PKT_READ_ADDR(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_READ_ADDR) & BIT_MASK_FWFF_PKT_READ_ADDR) -+#define BIT_SET_FWFF_PKT_READ_ADDR(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_READ_ADDR(x) | BIT_FWFF_PKT_READ_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FWFF_PKT_INFO (Offset 0x02A0) */ -+ -+#define BIT_SHIFT_FWFF_PKT_STR_ADDR 0 -+#define BIT_MASK_FWFF_PKT_STR_ADDR 0xffff -+#define BIT_FWFF_PKT_STR_ADDR(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_STR_ADDR) << BIT_SHIFT_FWFF_PKT_STR_ADDR) -+#define BITS_FWFF_PKT_STR_ADDR \ -+ (BIT_MASK_FWFF_PKT_STR_ADDR << BIT_SHIFT_FWFF_PKT_STR_ADDR) -+#define BIT_CLEAR_FWFF_PKT_STR_ADDR(x) ((x) & (~BITS_FWFF_PKT_STR_ADDR)) -+#define BIT_GET_FWFF_PKT_STR_ADDR(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_STR_ADDR) & BIT_MASK_FWFF_PKT_STR_ADDR) -+#define BIT_SET_FWFF_PKT_STR_ADDR(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_STR_ADDR(x) | BIT_FWFF_PKT_STR_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FWFF_PKT_INFO (Offset 0x02A0) */ -+ -+#define BIT_SHIFT_FWFF_PKT_STR_ADDR_V1 0 -+#define BIT_MASK_FWFF_PKT_STR_ADDR_V1 0x7ff -+#define BIT_FWFF_PKT_STR_ADDR_V1(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_STR_ADDR_V1) \ -+ << BIT_SHIFT_FWFF_PKT_STR_ADDR_V1) -+#define BITS_FWFF_PKT_STR_ADDR_V1 \ -+ (BIT_MASK_FWFF_PKT_STR_ADDR_V1 << BIT_SHIFT_FWFF_PKT_STR_ADDR_V1) -+#define BIT_CLEAR_FWFF_PKT_STR_ADDR_V1(x) ((x) & (~BITS_FWFF_PKT_STR_ADDR_V1)) -+#define BIT_GET_FWFF_PKT_STR_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_STR_ADDR_V1) & \ -+ BIT_MASK_FWFF_PKT_STR_ADDR_V1) -+#define BIT_SET_FWFF_PKT_STR_ADDR_V1(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_STR_ADDR_V1(x) | BIT_FWFF_PKT_STR_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWFF_PKT_INFO (Offset 0x02A0) */ -+ -+#define BIT_SHIFT_FWFF_PKT_WRITE_ADDR 0 -+#define BIT_MASK_FWFF_PKT_WRITE_ADDR 0xffff -+#define BIT_FWFF_PKT_WRITE_ADDR(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_WRITE_ADDR) << BIT_SHIFT_FWFF_PKT_WRITE_ADDR) -+#define BITS_FWFF_PKT_WRITE_ADDR \ -+ (BIT_MASK_FWFF_PKT_WRITE_ADDR << BIT_SHIFT_FWFF_PKT_WRITE_ADDR) -+#define BIT_CLEAR_FWFF_PKT_WRITE_ADDR(x) ((x) & (~BITS_FWFF_PKT_WRITE_ADDR)) -+#define BIT_GET_FWFF_PKT_WRITE_ADDR(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_WRITE_ADDR) & BIT_MASK_FWFF_PKT_WRITE_ADDR) -+#define BIT_SET_FWFF_PKT_WRITE_ADDR(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_WRITE_ADDR(x) | BIT_FWFF_PKT_WRITE_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_FC2H_INFO (Offset 0x02A4) */ -+ -+#define BIT_FC2H_PKT_REQ BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FC2H_INFO (Offset 0x02A4) */ -+ -+#define BIT_FC2H_DMAPKT_REQ BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FC2H_INFO (Offset 0x02A4) */ -+ -+#define BIT_SHIFT_FC2H_STR_ADDR 0 -+#define BIT_MASK_FC2H_STR_ADDR 0xffff -+#define BIT_FC2H_STR_ADDR(x) \ -+ (((x) & BIT_MASK_FC2H_STR_ADDR) << BIT_SHIFT_FC2H_STR_ADDR) -+#define BITS_FC2H_STR_ADDR (BIT_MASK_FC2H_STR_ADDR << BIT_SHIFT_FC2H_STR_ADDR) -+#define BIT_CLEAR_FC2H_STR_ADDR(x) ((x) & (~BITS_FC2H_STR_ADDR)) -+#define BIT_GET_FC2H_STR_ADDR(x) \ -+ (((x) >> BIT_SHIFT_FC2H_STR_ADDR) & BIT_MASK_FC2H_STR_ADDR) -+#define BIT_SET_FC2H_STR_ADDR(x, v) \ -+ (BIT_CLEAR_FC2H_STR_ADDR(x) | BIT_FC2H_STR_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWFF_PKT_INFO2 (Offset 0x02A4) */ -+ -+#define BIT_SHIFT_FWFF_PKT_QUEUED_V1 0 -+#define BIT_MASK_FWFF_PKT_QUEUED_V1 0xffff -+#define BIT_FWFF_PKT_QUEUED_V1(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_QUEUED_V1) << BIT_SHIFT_FWFF_PKT_QUEUED_V1) -+#define BITS_FWFF_PKT_QUEUED_V1 \ -+ (BIT_MASK_FWFF_PKT_QUEUED_V1 << BIT_SHIFT_FWFF_PKT_QUEUED_V1) -+#define BIT_CLEAR_FWFF_PKT_QUEUED_V1(x) ((x) & (~BITS_FWFF_PKT_QUEUED_V1)) -+#define BIT_GET_FWFF_PKT_QUEUED_V1(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_QUEUED_V1) & BIT_MASK_FWFF_PKT_QUEUED_V1) -+#define BIT_SET_FWFF_PKT_QUEUED_V1(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_QUEUED_V1(x) | BIT_FWFF_PKT_QUEUED_V1(v)) -+ -+#define BIT_SHIFT_FW_UPD_RXDES_RD_PTR 0 -+#define BIT_MASK_FW_UPD_RXDES_RD_PTR 0x3ffff -+#define BIT_FW_UPD_RXDES_RD_PTR(x) \ -+ (((x) & BIT_MASK_FW_UPD_RXDES_RD_PTR) << BIT_SHIFT_FW_UPD_RXDES_RD_PTR) -+#define BITS_FW_UPD_RXDES_RD_PTR \ -+ (BIT_MASK_FW_UPD_RXDES_RD_PTR << BIT_SHIFT_FW_UPD_RXDES_RD_PTR) -+#define BIT_CLEAR_FW_UPD_RXDES_RD_PTR(x) ((x) & (~BITS_FW_UPD_RXDES_RD_PTR)) -+#define BIT_GET_FW_UPD_RXDES_RD_PTR(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RXDES_RD_PTR) & BIT_MASK_FW_UPD_RXDES_RD_PTR) -+#define BIT_SET_FW_UPD_RXDES_RD_PTR(x, v) \ -+ (BIT_CLEAR_FW_UPD_RXDES_RD_PTR(x) | BIT_FW_UPD_RXDES_RD_PTR(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXPKTNUM (Offset 0x02B0) */ -+ -+#define BIT_SHIFT_PKT_NUM_WOL_V1 16 -+#define BIT_MASK_PKT_NUM_WOL_V1 0xffff -+#define BIT_PKT_NUM_WOL_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_WOL_V1) << BIT_SHIFT_PKT_NUM_WOL_V1) -+#define BITS_PKT_NUM_WOL_V1 \ -+ (BIT_MASK_PKT_NUM_WOL_V1 << BIT_SHIFT_PKT_NUM_WOL_V1) -+#define BIT_CLEAR_PKT_NUM_WOL_V1(x) ((x) & (~BITS_PKT_NUM_WOL_V1)) -+#define BIT_GET_PKT_NUM_WOL_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_WOL_V1) & BIT_MASK_PKT_NUM_WOL_V1) -+#define BIT_SET_PKT_NUM_WOL_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_WOL_V1(x) | BIT_PKT_NUM_WOL_V1(v)) -+ -+#define BIT_SHIFT_RXPKT_NUM_V1 0 -+#define BIT_MASK_RXPKT_NUM_V1 0xffff -+#define BIT_RXPKT_NUM_V1(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_V1) << BIT_SHIFT_RXPKT_NUM_V1) -+#define BITS_RXPKT_NUM_V1 (BIT_MASK_RXPKT_NUM_V1 << BIT_SHIFT_RXPKT_NUM_V1) -+#define BIT_CLEAR_RXPKT_NUM_V1(x) ((x) & (~BITS_RXPKT_NUM_V1)) -+#define BIT_GET_RXPKT_NUM_V1(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_V1) & BIT_MASK_RXPKT_NUM_V1) -+#define BIT_SET_RXPKT_NUM_V1(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_V1(x) | BIT_RXPKT_NUM_V1(v)) -+ -+#define BIT_SHIFT_RXPKT_NUM_TH 0 -+#define BIT_MASK_RXPKT_NUM_TH 0xff -+#define BIT_RXPKT_NUM_TH(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_TH) << BIT_SHIFT_RXPKT_NUM_TH) -+#define BITS_RXPKT_NUM_TH (BIT_MASK_RXPKT_NUM_TH << BIT_SHIFT_RXPKT_NUM_TH) -+#define BIT_CLEAR_RXPKT_NUM_TH(x) ((x) & (~BITS_RXPKT_NUM_TH)) -+#define BIT_GET_RXPKT_NUM_TH(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_TH) & BIT_MASK_RXPKT_NUM_TH) -+#define BIT_SET_RXPKT_NUM_TH(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_TH(x) | BIT_RXPKT_NUM_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FW_MSG1 (Offset 0x02E0) */ -+ -+#define BIT_SHIFT_FW_MSG_REG1 0 -+#define BIT_MASK_FW_MSG_REG1 0xffffffffL -+#define BIT_FW_MSG_REG1(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG1) << BIT_SHIFT_FW_MSG_REG1) -+#define BITS_FW_MSG_REG1 (BIT_MASK_FW_MSG_REG1 << BIT_SHIFT_FW_MSG_REG1) -+#define BIT_CLEAR_FW_MSG_REG1(x) ((x) & (~BITS_FW_MSG_REG1)) -+#define BIT_GET_FW_MSG_REG1(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG1) & BIT_MASK_FW_MSG_REG1) -+#define BIT_SET_FW_MSG_REG1(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG1(x) | BIT_FW_MSG_REG1(v)) -+ -+/* 2 REG_FW_MSG2 (Offset 0x02E4) */ -+ -+#define BIT_SHIFT_FW_MSG_REG2 0 -+#define BIT_MASK_FW_MSG_REG2 0xffffffffL -+#define BIT_FW_MSG_REG2(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG2) << BIT_SHIFT_FW_MSG_REG2) -+#define BITS_FW_MSG_REG2 (BIT_MASK_FW_MSG_REG2 << BIT_SHIFT_FW_MSG_REG2) -+#define BIT_CLEAR_FW_MSG_REG2(x) ((x) & (~BITS_FW_MSG_REG2)) -+#define BIT_GET_FW_MSG_REG2(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG2) & BIT_MASK_FW_MSG_REG2) -+#define BIT_SET_FW_MSG_REG2(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG2(x) | BIT_FW_MSG_REG2(v)) -+ -+/* 2 REG_FW_MSG3 (Offset 0x02E8) */ -+ -+#define BIT_SHIFT_FW_MSG_REG3 0 -+#define BIT_MASK_FW_MSG_REG3 0xffffffffL -+#define BIT_FW_MSG_REG3(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG3) << BIT_SHIFT_FW_MSG_REG3) -+#define BITS_FW_MSG_REG3 (BIT_MASK_FW_MSG_REG3 << BIT_SHIFT_FW_MSG_REG3) -+#define BIT_CLEAR_FW_MSG_REG3(x) ((x) & (~BITS_FW_MSG_REG3)) -+#define BIT_GET_FW_MSG_REG3(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG3) & BIT_MASK_FW_MSG_REG3) -+#define BIT_SET_FW_MSG_REG3(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG3(x) | BIT_FW_MSG_REG3(v)) -+ -+/* 2 REG_FW_MSG4 (Offset 0x02EC) */ -+ -+#define BIT_SHIFT_FW_MSG_REG4 0 -+#define BIT_MASK_FW_MSG_REG4 0xffffffffL -+#define BIT_FW_MSG_REG4(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG4) << BIT_SHIFT_FW_MSG_REG4) -+#define BITS_FW_MSG_REG4 (BIT_MASK_FW_MSG_REG4 << BIT_SHIFT_FW_MSG_REG4) -+#define BIT_CLEAR_FW_MSG_REG4(x) ((x) & (~BITS_FW_MSG_REG4)) -+#define BIT_GET_FW_MSG_REG4(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG4) & BIT_MASK_FW_MSG_REG4) -+#define BIT_SET_FW_MSG_REG4(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG4(x) | BIT_FW_MSG_REG4(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL (Offset 0x0300) */ -+ -+#define BIT_PCIEIO_PERSTB_SEL BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_CTRL (Offset 0x0300) */ -+ -+#define BIT_HCIIO_PERSTB_SEL BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL (Offset 0x0300) */ -+ -+#define BIT_SHIFT_PCIE_MAX_RXDMA 28 -+#define BIT_MASK_PCIE_MAX_RXDMA 0x7 -+#define BIT_PCIE_MAX_RXDMA(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_RXDMA) << BIT_SHIFT_PCIE_MAX_RXDMA) -+#define BITS_PCIE_MAX_RXDMA \ -+ (BIT_MASK_PCIE_MAX_RXDMA << BIT_SHIFT_PCIE_MAX_RXDMA) -+#define BIT_CLEAR_PCIE_MAX_RXDMA(x) ((x) & (~BITS_PCIE_MAX_RXDMA)) -+#define BIT_GET_PCIE_MAX_RXDMA(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_RXDMA) & BIT_MASK_PCIE_MAX_RXDMA) -+#define BIT_SET_PCIE_MAX_RXDMA(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_RXDMA(x) | BIT_PCIE_MAX_RXDMA(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_CTRL (Offset 0x0300) */ -+ -+#define BIT_SHIFT_HCI_MAX_RXDMA 28 -+#define BIT_MASK_HCI_MAX_RXDMA 0x7 -+#define BIT_HCI_MAX_RXDMA(x) \ -+ (((x) & BIT_MASK_HCI_MAX_RXDMA) << BIT_SHIFT_HCI_MAX_RXDMA) -+#define BITS_HCI_MAX_RXDMA (BIT_MASK_HCI_MAX_RXDMA << BIT_SHIFT_HCI_MAX_RXDMA) -+#define BIT_CLEAR_HCI_MAX_RXDMA(x) ((x) & (~BITS_HCI_MAX_RXDMA)) -+#define BIT_GET_HCI_MAX_RXDMA(x) \ -+ (((x) >> BIT_SHIFT_HCI_MAX_RXDMA) & BIT_MASK_HCI_MAX_RXDMA) -+#define BIT_SET_HCI_MAX_RXDMA(x, v) \ -+ (BIT_CLEAR_HCI_MAX_RXDMA(x) | BIT_HCI_MAX_RXDMA(v)) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LX_CTRL1 (Offset 0x0300) */ -+ -+#define BIT_RX_LIT_EDN_SEL BIT(27) -+#define BIT_TX_LIT_EDN_SEL BIT(26) -+#define BIT_WT_LIT_EDN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL (Offset 0x0300) */ -+ -+#define BIT_SHIFT_PCIE_MAX_TXDMA 24 -+#define BIT_MASK_PCIE_MAX_TXDMA 0x7 -+#define BIT_PCIE_MAX_TXDMA(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_TXDMA) << BIT_SHIFT_PCIE_MAX_TXDMA) -+#define BITS_PCIE_MAX_TXDMA \ -+ (BIT_MASK_PCIE_MAX_TXDMA << BIT_SHIFT_PCIE_MAX_TXDMA) -+#define BIT_CLEAR_PCIE_MAX_TXDMA(x) ((x) & (~BITS_PCIE_MAX_TXDMA)) -+#define BIT_GET_PCIE_MAX_TXDMA(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_TXDMA) & BIT_MASK_PCIE_MAX_TXDMA) -+#define BIT_SET_PCIE_MAX_TXDMA(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_TXDMA(x) | BIT_PCIE_MAX_TXDMA(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_CTRL (Offset 0x0300) */ -+ -+#define BIT_SHIFT_HCI_MAX_TXDMA 24 -+#define BIT_MASK_HCI_MAX_TXDMA 0x7 -+#define BIT_HCI_MAX_TXDMA(x) \ -+ (((x) & BIT_MASK_HCI_MAX_TXDMA) << BIT_SHIFT_HCI_MAX_TXDMA) -+#define BITS_HCI_MAX_TXDMA (BIT_MASK_HCI_MAX_TXDMA << BIT_SHIFT_HCI_MAX_TXDMA) -+#define BIT_CLEAR_HCI_MAX_TXDMA(x) ((x) & (~BITS_HCI_MAX_TXDMA)) -+#define BIT_GET_HCI_MAX_TXDMA(x) \ -+ (((x) >> BIT_SHIFT_HCI_MAX_TXDMA) & BIT_MASK_HCI_MAX_TXDMA) -+#define BIT_SET_HCI_MAX_TXDMA(x, v) \ -+ (BIT_CLEAR_HCI_MAX_TXDMA(x) | BIT_HCI_MAX_TXDMA(v)) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LX_CTRL1 (Offset 0x0300) */ -+ -+#define BIT_RD_LITT_EDN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL (Offset 0x0300) */ -+ -+#define BIT_PWR_SCALE_START_PS BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL (Offset 0x0300) */ -+ -+#define BIT_PCIE_RST_TRXDMA_INTF BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_CTRL (Offset 0x0300) */ -+ -+#define BIT_HCI_RST_TRXDMA_INTF BIT(20) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LX_CTRL1 (Offset 0x0300) */ -+ -+#define BIT_SHIFT_MAX_RXDMA 20 -+#define BIT_MASK_MAX_RXDMA 0x7 -+#define BIT_MAX_RXDMA(x) (((x) & BIT_MASK_MAX_RXDMA) << BIT_SHIFT_MAX_RXDMA) -+#define BITS_MAX_RXDMA (BIT_MASK_MAX_RXDMA << BIT_SHIFT_MAX_RXDMA) -+#define BIT_CLEAR_MAX_RXDMA(x) ((x) & (~BITS_MAX_RXDMA)) -+#define BIT_GET_MAX_RXDMA(x) (((x) >> BIT_SHIFT_MAX_RXDMA) & BIT_MASK_MAX_RXDMA) -+#define BIT_SET_MAX_RXDMA(x, v) (BIT_CLEAR_MAX_RXDMA(x) | BIT_MAX_RXDMA(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL (Offset 0x0300) */ -+ -+#define BIT_PCIE_EN_SWENT_L23 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_CTRL (Offset 0x0300) */ -+ -+#define BIT_HCI_EN_SWENT_L23 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL (Offset 0x0300) */ -+ -+#define BIT_PCIE_EN_HWEXT_L1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_CTRL (Offset 0x0300) */ -+ -+#define BIT_HCI_EN_HWEXT_L1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LX_CTRL1 (Offset 0x0300) */ -+ -+#define BIT_SHIFT_MAX_TXDMA 16 -+#define BIT_MASK_MAX_TXDMA 0x7 -+#define BIT_MAX_TXDMA(x) (((x) & BIT_MASK_MAX_TXDMA) << BIT_SHIFT_MAX_TXDMA) -+#define BITS_MAX_TXDMA (BIT_MASK_MAX_TXDMA << BIT_SHIFT_MAX_TXDMA) -+#define BIT_CLEAR_MAX_TXDMA(x) ((x) & (~BITS_MAX_TXDMA)) -+#define BIT_GET_MAX_TXDMA(x) (((x) >> BIT_SHIFT_MAX_TXDMA) & BIT_MASK_MAX_TXDMA) -+#define BIT_SET_MAX_TXDMA(x, v) (BIT_CLEAR_MAX_TXDMA(x) | BIT_MAX_TXDMA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL (Offset 0x0300) */ -+ -+#define BIT_STOP_P0_MPRT_BCNQ4 BIT(6) -+#define BIT_STOP_P0_MPRT_BCNQ3 BIT(4) -+#define BIT_STOP_P0_MPRT_BCNQ2 BIT(2) -+#define BIT_STOP_P0_MPRT_BCNQ1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_INT_MIG (Offset 0x0304) */ -+ -+#define BIT_SHIFT_TXTTIMER_MATCH_NUM 28 -+#define BIT_MASK_TXTTIMER_MATCH_NUM 0xf -+#define BIT_TXTTIMER_MATCH_NUM(x) \ -+ (((x) & BIT_MASK_TXTTIMER_MATCH_NUM) << BIT_SHIFT_TXTTIMER_MATCH_NUM) -+#define BITS_TXTTIMER_MATCH_NUM \ -+ (BIT_MASK_TXTTIMER_MATCH_NUM << BIT_SHIFT_TXTTIMER_MATCH_NUM) -+#define BIT_CLEAR_TXTTIMER_MATCH_NUM(x) ((x) & (~BITS_TXTTIMER_MATCH_NUM)) -+#define BIT_GET_TXTTIMER_MATCH_NUM(x) \ -+ (((x) >> BIT_SHIFT_TXTTIMER_MATCH_NUM) & BIT_MASK_TXTTIMER_MATCH_NUM) -+#define BIT_SET_TXTTIMER_MATCH_NUM(x, v) \ -+ (BIT_CLEAR_TXTTIMER_MATCH_NUM(x) | BIT_TXTTIMER_MATCH_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH_CTRL (Offset 0x0304) */ -+ -+#define BIT_STOP_P0HIQ19 BIT(27) -+#define BIT_STOP_P0HIQ18 BIT(26) -+#define BIT_STOP_P0HIQ17 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_INT_MIG (Offset 0x0304) */ -+ -+#define BIT_SHIFT_TXPKT_NUM_MATCH 24 -+#define BIT_MASK_TXPKT_NUM_MATCH 0xf -+#define BIT_TXPKT_NUM_MATCH(x) \ -+ (((x) & BIT_MASK_TXPKT_NUM_MATCH) << BIT_SHIFT_TXPKT_NUM_MATCH) -+#define BITS_TXPKT_NUM_MATCH \ -+ (BIT_MASK_TXPKT_NUM_MATCH << BIT_SHIFT_TXPKT_NUM_MATCH) -+#define BIT_CLEAR_TXPKT_NUM_MATCH(x) ((x) & (~BITS_TXPKT_NUM_MATCH)) -+#define BIT_GET_TXPKT_NUM_MATCH(x) \ -+ (((x) >> BIT_SHIFT_TXPKT_NUM_MATCH) & BIT_MASK_TXPKT_NUM_MATCH) -+#define BIT_SET_TXPKT_NUM_MATCH(x, v) \ -+ (BIT_CLEAR_TXPKT_NUM_MATCH(x) | BIT_TXPKT_NUM_MATCH(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_INT_MIG (Offset 0x0304) */ -+ -+#define BIT_SHIFT_TRXCOUNTER_MATCH 24 -+#define BIT_MASK_TRXCOUNTER_MATCH 0xff -+#define BIT_TRXCOUNTER_MATCH(x) \ -+ (((x) & BIT_MASK_TRXCOUNTER_MATCH) << BIT_SHIFT_TRXCOUNTER_MATCH) -+#define BITS_TRXCOUNTER_MATCH \ -+ (BIT_MASK_TRXCOUNTER_MATCH << BIT_SHIFT_TRXCOUNTER_MATCH) -+#define BIT_CLEAR_TRXCOUNTER_MATCH(x) ((x) & (~BITS_TRXCOUNTER_MATCH)) -+#define BIT_GET_TRXCOUNTER_MATCH(x) \ -+ (((x) >> BIT_SHIFT_TRXCOUNTER_MATCH) & BIT_MASK_TRXCOUNTER_MATCH) -+#define BIT_SET_TRXCOUNTER_MATCH(x, v) \ -+ (BIT_CLEAR_TRXCOUNTER_MATCH(x) | BIT_TRXCOUNTER_MATCH(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH_CTRL (Offset 0x0304) */ -+ -+#define BIT_STOP_P0HIQ16 BIT(24) -+#define BIT_RX_CLOSE_EN_V1 BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_INT_MIG (Offset 0x0304) */ -+ -+#define BIT_SHIFT_RXTTIMER_MATCH_NUM 20 -+#define BIT_MASK_RXTTIMER_MATCH_NUM 0xf -+#define BIT_RXTTIMER_MATCH_NUM(x) \ -+ (((x) & BIT_MASK_RXTTIMER_MATCH_NUM) << BIT_SHIFT_RXTTIMER_MATCH_NUM) -+#define BITS_RXTTIMER_MATCH_NUM \ -+ (BIT_MASK_RXTTIMER_MATCH_NUM << BIT_SHIFT_RXTTIMER_MATCH_NUM) -+#define BIT_CLEAR_RXTTIMER_MATCH_NUM(x) ((x) & (~BITS_RXTTIMER_MATCH_NUM)) -+#define BIT_GET_RXTTIMER_MATCH_NUM(x) \ -+ (((x) >> BIT_SHIFT_RXTTIMER_MATCH_NUM) & BIT_MASK_RXTTIMER_MATCH_NUM) -+#define BIT_SET_RXTTIMER_MATCH_NUM(x, v) \ -+ (BIT_CLEAR_RXTTIMER_MATCH_NUM(x) | BIT_RXTTIMER_MATCH_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH_CTRL (Offset 0x0304) */ -+ -+#define BIT_STOP_FWCMDQ BIT(20) -+#define BIT_STOP_P0BCNQ BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_INT_MIG (Offset 0x0304) */ -+ -+#define BIT_SHIFT_RXPKT_NUM_MATCH 16 -+#define BIT_MASK_RXPKT_NUM_MATCH 0xf -+#define BIT_RXPKT_NUM_MATCH(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_MATCH) << BIT_SHIFT_RXPKT_NUM_MATCH) -+#define BITS_RXPKT_NUM_MATCH \ -+ (BIT_MASK_RXPKT_NUM_MATCH << BIT_SHIFT_RXPKT_NUM_MATCH) -+#define BIT_CLEAR_RXPKT_NUM_MATCH(x) ((x) & (~BITS_RXPKT_NUM_MATCH)) -+#define BIT_GET_RXPKT_NUM_MATCH(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_MATCH) & BIT_MASK_RXPKT_NUM_MATCH) -+#define BIT_SET_RXPKT_NUM_MATCH(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_MATCH(x) | BIT_RXPKT_NUM_MATCH(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_INT_MIG (Offset 0x0304) */ -+ -+#define BIT_SHIFT_TRXTIMER_MATCH 16 -+#define BIT_MASK_TRXTIMER_MATCH 0xff -+#define BIT_TRXTIMER_MATCH(x) \ -+ (((x) & BIT_MASK_TRXTIMER_MATCH) << BIT_SHIFT_TRXTIMER_MATCH) -+#define BITS_TRXTIMER_MATCH \ -+ (BIT_MASK_TRXTIMER_MATCH << BIT_SHIFT_TRXTIMER_MATCH) -+#define BIT_CLEAR_TRXTIMER_MATCH(x) ((x) & (~BITS_TRXTIMER_MATCH)) -+#define BIT_GET_TRXTIMER_MATCH(x) \ -+ (((x) >> BIT_SHIFT_TRXTIMER_MATCH) & BIT_MASK_TRXTIMER_MATCH) -+#define BIT_SET_TRXTIMER_MATCH(x, v) \ -+ (BIT_CLEAR_TRXTIMER_MATCH(x) | BIT_TRXTIMER_MATCH(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH_CTRL (Offset 0x0304) */ -+ -+#define BIT_STOP_P0MGQ BIT(16) -+#define BIT_STOP_ACH13 BIT(15) -+#define BIT_STOP_ACH12 BIT(14) -+#define BIT_STOP_ACH11 BIT(13) -+#define BIT_STOP_ACH10 BIT(12) -+#define BIT_STOP_ACH9 BIT(11) -+#define BIT_STOP_ACH8 BIT(10) -+#define BIT_STOP_ACH7 BIT(9) -+#define BIT_STOP_ACH6 BIT(8) -+#define BIT_STOP_ACH5 BIT(7) -+#define BIT_STOP_ACH4 BIT(6) -+#define BIT_STOP_ACH3 BIT(5) -+#define BIT_STOP_ACH2 BIT(4) -+#define BIT_STOP_ACH1 BIT(3) -+#define BIT_STOP_ACH0 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_INT_MIG (Offset 0x0304) */ -+ -+#define BIT_SHIFT_MIGRATE_TIMER 0 -+#define BIT_MASK_MIGRATE_TIMER 0xffff -+#define BIT_MIGRATE_TIMER(x) \ -+ (((x) & BIT_MASK_MIGRATE_TIMER) << BIT_SHIFT_MIGRATE_TIMER) -+#define BITS_MIGRATE_TIMER (BIT_MASK_MIGRATE_TIMER << BIT_SHIFT_MIGRATE_TIMER) -+#define BIT_CLEAR_MIGRATE_TIMER(x) ((x) & (~BITS_MIGRATE_TIMER)) -+#define BIT_GET_MIGRATE_TIMER(x) \ -+ (((x) >> BIT_SHIFT_MIGRATE_TIMER) & BIT_MASK_MIGRATE_TIMER) -+#define BIT_SET_MIGRATE_TIMER(x, v) \ -+ (BIT_CLEAR_MIGRATE_TIMER(x) | BIT_MIGRATE_TIMER(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_INT_MIG (Offset 0x0304) */ -+ -+#define BIT_SHIFT_TRXTIMER_UNIT 0 -+#define BIT_MASK_TRXTIMER_UNIT 0x3 -+#define BIT_TRXTIMER_UNIT(x) \ -+ (((x) & BIT_MASK_TRXTIMER_UNIT) << BIT_SHIFT_TRXTIMER_UNIT) -+#define BITS_TRXTIMER_UNIT (BIT_MASK_TRXTIMER_UNIT << BIT_SHIFT_TRXTIMER_UNIT) -+#define BIT_CLEAR_TRXTIMER_UNIT(x) ((x) & (~BITS_TRXTIMER_UNIT)) -+#define BIT_GET_TRXTIMER_UNIT(x) \ -+ (((x) >> BIT_SHIFT_TRXTIMER_UNIT) & BIT_MASK_TRXTIMER_UNIT) -+#define BIT_SET_TRXTIMER_UNIT(x, v) \ -+ (BIT_CLEAR_TRXTIMER_UNIT(x) | BIT_TRXTIMER_UNIT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH_CTRL (Offset 0x0304) */ -+ -+#define BIT_STOP_P0RX BIT(0) -+ -+/* 2 REG_HIQ_CTRL (Offset 0x0308) */ -+ -+#define BIT_STOP_P0HIQ15 BIT(15) -+#define BIT_STOP_P0HIQ14 BIT(14) -+#define BIT_STOP_P0HIQ13 BIT(13) -+#define BIT_STOP_P0HIQ12 BIT(12) -+#define BIT_STOP_P0HIQ11 BIT(11) -+#define BIT_STOP_P0HIQ10 BIT(10) -+#define BIT_STOP_P0HIQ9 BIT(9) -+#define BIT_STOP_P0HIQ8 BIT(8) -+#define BIT_STOP_P0HIQ7 BIT(7) -+#define BIT_STOP_P0HIQ6 BIT(6) -+#define BIT_STOP_P0HIQ5 BIT(5) -+#define BIT_STOP_P0HIQ4 BIT(4) -+#define BIT_STOP_P0HIQ3 BIT(3) -+#define BIT_STOP_P0HIQ2 BIT(2) -+#define BIT_STOP_P0HIQ1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCNQ_TXBD_DESA (Offset 0x0308) */ -+ -+#define BIT_SHIFT_BCNQ_TXBD_DESA 0 -+#define BIT_MASK_BCNQ_TXBD_DESA 0xffffffffffffffffL -+#define BIT_BCNQ_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_BCNQ_TXBD_DESA) << BIT_SHIFT_BCNQ_TXBD_DESA) -+#define BITS_BCNQ_TXBD_DESA \ -+ (BIT_MASK_BCNQ_TXBD_DESA << BIT_SHIFT_BCNQ_TXBD_DESA) -+#define BIT_CLEAR_BCNQ_TXBD_DESA(x) ((x) & (~BITS_BCNQ_TXBD_DESA)) -+#define BIT_GET_BCNQ_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_TXBD_DESA) & BIT_MASK_BCNQ_TXBD_DESA) -+#define BIT_SET_BCNQ_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_BCNQ_TXBD_DESA(x) | BIT_BCNQ_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIQ_CTRL (Offset 0x0308) */ -+ -+#define BIT_STOP_P0HIQ0 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_TXBD_DESA (Offset 0x0310) */ -+ -+#define BIT_SHIFT_MGQ_TXBD_DESA 0 -+#define BIT_MASK_MGQ_TXBD_DESA 0xffffffffffffffffL -+#define BIT_MGQ_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_MGQ_TXBD_DESA) << BIT_SHIFT_MGQ_TXBD_DESA) -+#define BITS_MGQ_TXBD_DESA (BIT_MASK_MGQ_TXBD_DESA << BIT_SHIFT_MGQ_TXBD_DESA) -+#define BIT_CLEAR_MGQ_TXBD_DESA(x) ((x) & (~BITS_MGQ_TXBD_DESA)) -+#define BIT_GET_MGQ_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_MGQ_TXBD_DESA) & BIT_MASK_MGQ_TXBD_DESA) -+#define BIT_SET_MGQ_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_MGQ_TXBD_DESA(x) | BIT_MGQ_TXBD_DESA(v)) -+ -+/* 2 REG_VOQ_TXBD_DESA (Offset 0x0318) */ -+ -+#define BIT_SHIFT_VOQ_TXBD_DESA 0 -+#define BIT_MASK_VOQ_TXBD_DESA 0xffffffffffffffffL -+#define BIT_VOQ_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_VOQ_TXBD_DESA) << BIT_SHIFT_VOQ_TXBD_DESA) -+#define BITS_VOQ_TXBD_DESA (BIT_MASK_VOQ_TXBD_DESA << BIT_SHIFT_VOQ_TXBD_DESA) -+#define BIT_CLEAR_VOQ_TXBD_DESA(x) ((x) & (~BITS_VOQ_TXBD_DESA)) -+#define BIT_GET_VOQ_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_VOQ_TXBD_DESA) & BIT_MASK_VOQ_TXBD_DESA) -+#define BIT_SET_VOQ_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_VOQ_TXBD_DESA(x) | BIT_VOQ_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH0_TXBD_DESA_L (Offset 0x0318) */ -+ -+#define BIT_SHIFT_ACH0_TXBD_DESA_L 0 -+#define BIT_MASK_ACH0_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH0_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH0_TXBD_DESA_L) << BIT_SHIFT_ACH0_TXBD_DESA_L) -+#define BITS_ACH0_TXBD_DESA_L \ -+ (BIT_MASK_ACH0_TXBD_DESA_L << BIT_SHIFT_ACH0_TXBD_DESA_L) -+#define BIT_CLEAR_ACH0_TXBD_DESA_L(x) ((x) & (~BITS_ACH0_TXBD_DESA_L)) -+#define BIT_GET_ACH0_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH0_TXBD_DESA_L) & BIT_MASK_ACH0_TXBD_DESA_L) -+#define BIT_SET_ACH0_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH0_TXBD_DESA_L(x) | BIT_ACH0_TXBD_DESA_L(v)) -+ -+/* 2 REG_ACH0_TXBD_DESA_H (Offset 0x031C) */ -+ -+#define BIT_SHIFT_ACH0_TXBD_DESA_H 0 -+#define BIT_MASK_ACH0_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH0_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH0_TXBD_DESA_H) << BIT_SHIFT_ACH0_TXBD_DESA_H) -+#define BITS_ACH0_TXBD_DESA_H \ -+ (BIT_MASK_ACH0_TXBD_DESA_H << BIT_SHIFT_ACH0_TXBD_DESA_H) -+#define BIT_CLEAR_ACH0_TXBD_DESA_H(x) ((x) & (~BITS_ACH0_TXBD_DESA_H)) -+#define BIT_GET_ACH0_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH0_TXBD_DESA_H) & BIT_MASK_ACH0_TXBD_DESA_H) -+#define BIT_SET_ACH0_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH0_TXBD_DESA_H(x) | BIT_ACH0_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_VIQ_TXBD_DESA (Offset 0x0320) */ -+ -+#define BIT_SHIFT_VIQ_TXBD_DESA 0 -+#define BIT_MASK_VIQ_TXBD_DESA 0xffffffffffffffffL -+#define BIT_VIQ_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_VIQ_TXBD_DESA) << BIT_SHIFT_VIQ_TXBD_DESA) -+#define BITS_VIQ_TXBD_DESA (BIT_MASK_VIQ_TXBD_DESA << BIT_SHIFT_VIQ_TXBD_DESA) -+#define BIT_CLEAR_VIQ_TXBD_DESA(x) ((x) & (~BITS_VIQ_TXBD_DESA)) -+#define BIT_GET_VIQ_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_VIQ_TXBD_DESA) & BIT_MASK_VIQ_TXBD_DESA) -+#define BIT_SET_VIQ_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_VIQ_TXBD_DESA(x) | BIT_VIQ_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH1_TXBD_DESA_L (Offset 0x0320) */ -+ -+#define BIT_SHIFT_ACH1_TXBD_DESA_L 0 -+#define BIT_MASK_ACH1_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH1_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH1_TXBD_DESA_L) << BIT_SHIFT_ACH1_TXBD_DESA_L) -+#define BITS_ACH1_TXBD_DESA_L \ -+ (BIT_MASK_ACH1_TXBD_DESA_L << BIT_SHIFT_ACH1_TXBD_DESA_L) -+#define BIT_CLEAR_ACH1_TXBD_DESA_L(x) ((x) & (~BITS_ACH1_TXBD_DESA_L)) -+#define BIT_GET_ACH1_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH1_TXBD_DESA_L) & BIT_MASK_ACH1_TXBD_DESA_L) -+#define BIT_SET_ACH1_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH1_TXBD_DESA_L(x) | BIT_ACH1_TXBD_DESA_L(v)) -+ -+/* 2 REG_ACH1_TXBD_DESA_H (Offset 0x0324) */ -+ -+#define BIT_SHIFT_ACH1_TXBD_DESA_H 0 -+#define BIT_MASK_ACH1_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH1_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH1_TXBD_DESA_H) << BIT_SHIFT_ACH1_TXBD_DESA_H) -+#define BITS_ACH1_TXBD_DESA_H \ -+ (BIT_MASK_ACH1_TXBD_DESA_H << BIT_SHIFT_ACH1_TXBD_DESA_H) -+#define BIT_CLEAR_ACH1_TXBD_DESA_H(x) ((x) & (~BITS_ACH1_TXBD_DESA_H)) -+#define BIT_GET_ACH1_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH1_TXBD_DESA_H) & BIT_MASK_ACH1_TXBD_DESA_H) -+#define BIT_SET_ACH1_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH1_TXBD_DESA_H(x) | BIT_ACH1_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BEQ_TXBD_DESA (Offset 0x0328) */ -+ -+#define BIT_SHIFT_BEQ_TXBD_DESA 0 -+#define BIT_MASK_BEQ_TXBD_DESA 0xffffffffffffffffL -+#define BIT_BEQ_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_BEQ_TXBD_DESA) << BIT_SHIFT_BEQ_TXBD_DESA) -+#define BITS_BEQ_TXBD_DESA (BIT_MASK_BEQ_TXBD_DESA << BIT_SHIFT_BEQ_TXBD_DESA) -+#define BIT_CLEAR_BEQ_TXBD_DESA(x) ((x) & (~BITS_BEQ_TXBD_DESA)) -+#define BIT_GET_BEQ_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_BEQ_TXBD_DESA) & BIT_MASK_BEQ_TXBD_DESA) -+#define BIT_SET_BEQ_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_BEQ_TXBD_DESA(x) | BIT_BEQ_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH2_TXBD_DESA_L (Offset 0x0328) */ -+ -+#define BIT_SHIFT_ACH2_TXBD_DESA_L 0 -+#define BIT_MASK_ACH2_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH2_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH2_TXBD_DESA_L) << BIT_SHIFT_ACH2_TXBD_DESA_L) -+#define BITS_ACH2_TXBD_DESA_L \ -+ (BIT_MASK_ACH2_TXBD_DESA_L << BIT_SHIFT_ACH2_TXBD_DESA_L) -+#define BIT_CLEAR_ACH2_TXBD_DESA_L(x) ((x) & (~BITS_ACH2_TXBD_DESA_L)) -+#define BIT_GET_ACH2_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH2_TXBD_DESA_L) & BIT_MASK_ACH2_TXBD_DESA_L) -+#define BIT_SET_ACH2_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH2_TXBD_DESA_L(x) | BIT_ACH2_TXBD_DESA_L(v)) -+ -+/* 2 REG_ACH2_TXBD_DESA_H (Offset 0x032C) */ -+ -+#define BIT_SHIFT_ACH2_TXBD_DESA_H 0 -+#define BIT_MASK_ACH2_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH2_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH2_TXBD_DESA_H) << BIT_SHIFT_ACH2_TXBD_DESA_H) -+#define BITS_ACH2_TXBD_DESA_H \ -+ (BIT_MASK_ACH2_TXBD_DESA_H << BIT_SHIFT_ACH2_TXBD_DESA_H) -+#define BIT_CLEAR_ACH2_TXBD_DESA_H(x) ((x) & (~BITS_ACH2_TXBD_DESA_H)) -+#define BIT_GET_ACH2_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH2_TXBD_DESA_H) & BIT_MASK_ACH2_TXBD_DESA_H) -+#define BIT_SET_ACH2_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH2_TXBD_DESA_H(x) | BIT_ACH2_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BKQ_TXBD_DESA (Offset 0x0330) */ -+ -+#define BIT_SHIFT_BKQ_TXBD_DESA 0 -+#define BIT_MASK_BKQ_TXBD_DESA 0xffffffffffffffffL -+#define BIT_BKQ_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_BKQ_TXBD_DESA) << BIT_SHIFT_BKQ_TXBD_DESA) -+#define BITS_BKQ_TXBD_DESA (BIT_MASK_BKQ_TXBD_DESA << BIT_SHIFT_BKQ_TXBD_DESA) -+#define BIT_CLEAR_BKQ_TXBD_DESA(x) ((x) & (~BITS_BKQ_TXBD_DESA)) -+#define BIT_GET_BKQ_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_BKQ_TXBD_DESA) & BIT_MASK_BKQ_TXBD_DESA) -+#define BIT_SET_BKQ_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_BKQ_TXBD_DESA(x) | BIT_BKQ_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH3_TXBD_DESA_L (Offset 0x0330) */ -+ -+#define BIT_SHIFT_ACH3_TXBD_DESA_L 0 -+#define BIT_MASK_ACH3_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH3_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH3_TXBD_DESA_L) << BIT_SHIFT_ACH3_TXBD_DESA_L) -+#define BITS_ACH3_TXBD_DESA_L \ -+ (BIT_MASK_ACH3_TXBD_DESA_L << BIT_SHIFT_ACH3_TXBD_DESA_L) -+#define BIT_CLEAR_ACH3_TXBD_DESA_L(x) ((x) & (~BITS_ACH3_TXBD_DESA_L)) -+#define BIT_GET_ACH3_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH3_TXBD_DESA_L) & BIT_MASK_ACH3_TXBD_DESA_L) -+#define BIT_SET_ACH3_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH3_TXBD_DESA_L(x) | BIT_ACH3_TXBD_DESA_L(v)) -+ -+/* 2 REG_ACH3_TXBD_DESA_H (Offset 0x0334) */ -+ -+#define BIT_SHIFT_ACH3_TXBD_DESA_H 0 -+#define BIT_MASK_ACH3_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH3_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH3_TXBD_DESA_H) << BIT_SHIFT_ACH3_TXBD_DESA_H) -+#define BITS_ACH3_TXBD_DESA_H \ -+ (BIT_MASK_ACH3_TXBD_DESA_H << BIT_SHIFT_ACH3_TXBD_DESA_H) -+#define BIT_CLEAR_ACH3_TXBD_DESA_H(x) ((x) & (~BITS_ACH3_TXBD_DESA_H)) -+#define BIT_GET_ACH3_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH3_TXBD_DESA_H) & BIT_MASK_ACH3_TXBD_DESA_H) -+#define BIT_SET_ACH3_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH3_TXBD_DESA_H(x) | BIT_ACH3_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXQ_RXBD_DESA (Offset 0x0338) */ -+ -+#define BIT_SHIFT_RXQ_RXBD_DESA 0 -+#define BIT_MASK_RXQ_RXBD_DESA 0xffffffffffffffffL -+#define BIT_RXQ_RXBD_DESA(x) \ -+ (((x) & BIT_MASK_RXQ_RXBD_DESA) << BIT_SHIFT_RXQ_RXBD_DESA) -+#define BITS_RXQ_RXBD_DESA (BIT_MASK_RXQ_RXBD_DESA << BIT_SHIFT_RXQ_RXBD_DESA) -+#define BIT_CLEAR_RXQ_RXBD_DESA(x) ((x) & (~BITS_RXQ_RXBD_DESA)) -+#define BIT_GET_RXQ_RXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_RXQ_RXBD_DESA) & BIT_MASK_RXQ_RXBD_DESA) -+#define BIT_SET_RXQ_RXBD_DESA(x, v) \ -+ (BIT_CLEAR_RXQ_RXBD_DESA(x) | BIT_RXQ_RXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0RXQ_RXBD_DESA_L (Offset 0x0338) */ -+ -+#define BIT_SHIFT_P0RXQ_RXBD_DESA_L 0 -+#define BIT_MASK_P0RXQ_RXBD_DESA_L 0xffffffffL -+#define BIT_P0RXQ_RXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_P0RXQ_RXBD_DESA_L) << BIT_SHIFT_P0RXQ_RXBD_DESA_L) -+#define BITS_P0RXQ_RXBD_DESA_L \ -+ (BIT_MASK_P0RXQ_RXBD_DESA_L << BIT_SHIFT_P0RXQ_RXBD_DESA_L) -+#define BIT_CLEAR_P0RXQ_RXBD_DESA_L(x) ((x) & (~BITS_P0RXQ_RXBD_DESA_L)) -+#define BIT_GET_P0RXQ_RXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_P0RXQ_RXBD_DESA_L) & BIT_MASK_P0RXQ_RXBD_DESA_L) -+#define BIT_SET_P0RXQ_RXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_P0RXQ_RXBD_DESA_L(x) | BIT_P0RXQ_RXBD_DESA_L(v)) -+ -+/* 2 REG_P0RXQ_RXBD_DESA_H (Offset 0x033C) */ -+ -+#define BIT_SHIFT_P0RXQ_RXBD_DESA_H 0 -+#define BIT_MASK_P0RXQ_RXBD_DESA_H 0xffffffffL -+#define BIT_P0RXQ_RXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_P0RXQ_RXBD_DESA_H) << BIT_SHIFT_P0RXQ_RXBD_DESA_H) -+#define BITS_P0RXQ_RXBD_DESA_H \ -+ (BIT_MASK_P0RXQ_RXBD_DESA_H << BIT_SHIFT_P0RXQ_RXBD_DESA_H) -+#define BIT_CLEAR_P0RXQ_RXBD_DESA_H(x) ((x) & (~BITS_P0RXQ_RXBD_DESA_H)) -+#define BIT_GET_P0RXQ_RXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_P0RXQ_RXBD_DESA_H) & BIT_MASK_P0RXQ_RXBD_DESA_H) -+#define BIT_SET_P0RXQ_RXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_P0RXQ_RXBD_DESA_H(x) | BIT_P0RXQ_RXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI0Q_TXBD_DESA (Offset 0x0340) */ -+ -+#define BIT_SHIFT_HI0Q_TXBD_DESA 0 -+#define BIT_MASK_HI0Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI0Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI0Q_TXBD_DESA) << BIT_SHIFT_HI0Q_TXBD_DESA) -+#define BITS_HI0Q_TXBD_DESA \ -+ (BIT_MASK_HI0Q_TXBD_DESA << BIT_SHIFT_HI0Q_TXBD_DESA) -+#define BIT_CLEAR_HI0Q_TXBD_DESA(x) ((x) & (~BITS_HI0Q_TXBD_DESA)) -+#define BIT_GET_HI0Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_TXBD_DESA) & BIT_MASK_HI0Q_TXBD_DESA) -+#define BIT_SET_HI0Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI0Q_TXBD_DESA(x) | BIT_HI0Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0BCNQ_TXBD_DESA_L (Offset 0x0340) */ -+ -+#define BIT_SHIFT_P0BCNQ_TXBD_DESA_L 0 -+#define BIT_MASK_P0BCNQ_TXBD_DESA_L 0xffffffffL -+#define BIT_P0BCNQ_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_P0BCNQ_TXBD_DESA_L) << BIT_SHIFT_P0BCNQ_TXBD_DESA_L) -+#define BITS_P0BCNQ_TXBD_DESA_L \ -+ (BIT_MASK_P0BCNQ_TXBD_DESA_L << BIT_SHIFT_P0BCNQ_TXBD_DESA_L) -+#define BIT_CLEAR_P0BCNQ_TXBD_DESA_L(x) ((x) & (~BITS_P0BCNQ_TXBD_DESA_L)) -+#define BIT_GET_P0BCNQ_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_P0BCNQ_TXBD_DESA_L) & BIT_MASK_P0BCNQ_TXBD_DESA_L) -+#define BIT_SET_P0BCNQ_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_P0BCNQ_TXBD_DESA_L(x) | BIT_P0BCNQ_TXBD_DESA_L(v)) -+ -+/* 2 REG_P0BCNQ_TXBD_DESA_H (Offset 0x0344) */ -+ -+#define BIT_SHIFT_P0BCNQ_TXBD_DESA_H 0 -+#define BIT_MASK_P0BCNQ_TXBD_DESA_H 0xffffffffL -+#define BIT_P0BCNQ_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_P0BCNQ_TXBD_DESA_H) << BIT_SHIFT_P0BCNQ_TXBD_DESA_H) -+#define BITS_P0BCNQ_TXBD_DESA_H \ -+ (BIT_MASK_P0BCNQ_TXBD_DESA_H << BIT_SHIFT_P0BCNQ_TXBD_DESA_H) -+#define BIT_CLEAR_P0BCNQ_TXBD_DESA_H(x) ((x) & (~BITS_P0BCNQ_TXBD_DESA_H)) -+#define BIT_GET_P0BCNQ_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_P0BCNQ_TXBD_DESA_H) & BIT_MASK_P0BCNQ_TXBD_DESA_H) -+#define BIT_SET_P0BCNQ_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_P0BCNQ_TXBD_DESA_H(x) | BIT_P0BCNQ_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI1Q_TXBD_DESA (Offset 0x0348) */ -+ -+#define BIT_SHIFT_HI1Q_TXBD_DESA 0 -+#define BIT_MASK_HI1Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI1Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI1Q_TXBD_DESA) << BIT_SHIFT_HI1Q_TXBD_DESA) -+#define BITS_HI1Q_TXBD_DESA \ -+ (BIT_MASK_HI1Q_TXBD_DESA << BIT_SHIFT_HI1Q_TXBD_DESA) -+#define BIT_CLEAR_HI1Q_TXBD_DESA(x) ((x) & (~BITS_HI1Q_TXBD_DESA)) -+#define BIT_GET_HI1Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_TXBD_DESA) & BIT_MASK_HI1Q_TXBD_DESA) -+#define BIT_SET_HI1Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI1Q_TXBD_DESA(x) | BIT_HI1Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWCMDQ_TXBD_DESA_L (Offset 0x0348) */ -+ -+#define BIT_SHIFT_FWCMDQ_TXBD_DESA_L 0 -+#define BIT_MASK_FWCMDQ_TXBD_DESA_L 0xffffffffL -+#define BIT_FWCMDQ_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_FWCMDQ_TXBD_DESA_L) << BIT_SHIFT_FWCMDQ_TXBD_DESA_L) -+#define BITS_FWCMDQ_TXBD_DESA_L \ -+ (BIT_MASK_FWCMDQ_TXBD_DESA_L << BIT_SHIFT_FWCMDQ_TXBD_DESA_L) -+#define BIT_CLEAR_FWCMDQ_TXBD_DESA_L(x) ((x) & (~BITS_FWCMDQ_TXBD_DESA_L)) -+#define BIT_GET_FWCMDQ_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_TXBD_DESA_L) & BIT_MASK_FWCMDQ_TXBD_DESA_L) -+#define BIT_SET_FWCMDQ_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_FWCMDQ_TXBD_DESA_L(x) | BIT_FWCMDQ_TXBD_DESA_L(v)) -+ -+/* 2 REG_FWCMDQ_TXBD_DESA_H (Offset 0x034C) */ -+ -+#define BIT_SHIFT_FWCMDQ_TXBD_DESA_H 0 -+#define BIT_MASK_FWCMDQ_TXBD_DESA_H 0xffffffffL -+#define BIT_FWCMDQ_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_FWCMDQ_TXBD_DESA_H) << BIT_SHIFT_FWCMDQ_TXBD_DESA_H) -+#define BITS_FWCMDQ_TXBD_DESA_H \ -+ (BIT_MASK_FWCMDQ_TXBD_DESA_H << BIT_SHIFT_FWCMDQ_TXBD_DESA_H) -+#define BIT_CLEAR_FWCMDQ_TXBD_DESA_H(x) ((x) & (~BITS_FWCMDQ_TXBD_DESA_H)) -+#define BIT_GET_FWCMDQ_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_TXBD_DESA_H) & BIT_MASK_FWCMDQ_TXBD_DESA_H) -+#define BIT_SET_FWCMDQ_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_FWCMDQ_TXBD_DESA_H(x) | BIT_FWCMDQ_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI2Q_TXBD_DESA (Offset 0x0350) */ -+ -+#define BIT_SHIFT_HI2Q_TXBD_DESA 0 -+#define BIT_MASK_HI2Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI2Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI2Q_TXBD_DESA) << BIT_SHIFT_HI2Q_TXBD_DESA) -+#define BITS_HI2Q_TXBD_DESA \ -+ (BIT_MASK_HI2Q_TXBD_DESA << BIT_SHIFT_HI2Q_TXBD_DESA) -+#define BIT_CLEAR_HI2Q_TXBD_DESA(x) ((x) & (~BITS_HI2Q_TXBD_DESA)) -+#define BIT_GET_HI2Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_TXBD_DESA) & BIT_MASK_HI2Q_TXBD_DESA) -+#define BIT_SET_HI2Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI2Q_TXBD_DESA(x) | BIT_HI2Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_HRPWM1_HCPWM1_DCPU (Offset 0x0354) */ -+ -+#define BIT_SHIFT_PCIE_HCPWM1_DCPU 16 -+#define BIT_MASK_PCIE_HCPWM1_DCPU 0xff -+#define BIT_PCIE_HCPWM1_DCPU(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM1_DCPU) << BIT_SHIFT_PCIE_HCPWM1_DCPU) -+#define BITS_PCIE_HCPWM1_DCPU \ -+ (BIT_MASK_PCIE_HCPWM1_DCPU << BIT_SHIFT_PCIE_HCPWM1_DCPU) -+#define BIT_CLEAR_PCIE_HCPWM1_DCPU(x) ((x) & (~BITS_PCIE_HCPWM1_DCPU)) -+#define BIT_GET_PCIE_HCPWM1_DCPU(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM1_DCPU) & BIT_MASK_PCIE_HCPWM1_DCPU) -+#define BIT_SET_PCIE_HCPWM1_DCPU(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM1_DCPU(x) | BIT_PCIE_HCPWM1_DCPU(v)) -+ -+#define BIT_SHIFT_PCIE_HRPWM1_DCPU 8 -+#define BIT_MASK_PCIE_HRPWM1_DCPU 0xff -+#define BIT_PCIE_HRPWM1_DCPU(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM1_DCPU) << BIT_SHIFT_PCIE_HRPWM1_DCPU) -+#define BITS_PCIE_HRPWM1_DCPU \ -+ (BIT_MASK_PCIE_HRPWM1_DCPU << BIT_SHIFT_PCIE_HRPWM1_DCPU) -+#define BIT_CLEAR_PCIE_HRPWM1_DCPU(x) ((x) & (~BITS_PCIE_HRPWM1_DCPU)) -+#define BIT_GET_PCIE_HRPWM1_DCPU(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM1_DCPU) & BIT_MASK_PCIE_HRPWM1_DCPU) -+#define BIT_SET_PCIE_HRPWM1_DCPU(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM1_DCPU(x) | BIT_PCIE_HRPWM1_DCPU(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI3Q_TXBD_DESA (Offset 0x0358) */ -+ -+#define BIT_SHIFT_HI3Q_TXBD_DESA 0 -+#define BIT_MASK_HI3Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI3Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI3Q_TXBD_DESA) << BIT_SHIFT_HI3Q_TXBD_DESA) -+#define BITS_HI3Q_TXBD_DESA \ -+ (BIT_MASK_HI3Q_TXBD_DESA << BIT_SHIFT_HI3Q_TXBD_DESA) -+#define BIT_CLEAR_HI3Q_TXBD_DESA(x) ((x) & (~BITS_HI3Q_TXBD_DESA)) -+#define BIT_GET_HI3Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_TXBD_DESA) & BIT_MASK_HI3Q_TXBD_DESA) -+#define BIT_SET_HI3Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI3Q_TXBD_DESA(x) | BIT_HI3Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0_MPRT_BCNQ_TXBD_DESA_L (Offset 0x0358) */ -+ -+#define BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_L 0 -+#define BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_L 0xffffffffL -+#define BIT_P0_MPRT_BCNQ_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_L) \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_L) -+#define BITS_P0_MPRT_BCNQ_TXBD_DESA_L \ -+ (BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_L \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_L) -+#define BIT_CLEAR_P0_MPRT_BCNQ_TXBD_DESA_L(x) \ -+ ((x) & (~BITS_P0_MPRT_BCNQ_TXBD_DESA_L)) -+#define BIT_GET_P0_MPRT_BCNQ_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_L) & \ -+ BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_L) -+#define BIT_SET_P0_MPRT_BCNQ_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_P0_MPRT_BCNQ_TXBD_DESA_L(x) | \ -+ BIT_P0_MPRT_BCNQ_TXBD_DESA_L(v)) -+ -+/* 2 REG_P0_MPRT_BCNQ_TXBD_DESA_H (Offset 0x035C) */ -+ -+#define BIT_CLR_P0HI15Q_HW_IDX BIT(29) -+#define BIT_CLR_P0HI14Q_HW_IDX BIT(28) -+#define BIT_CLR_P0HI13Q_HW_IDX BIT(27) -+#define BIT_CLR_P0HI12Q_HW_IDX BIT(26) -+#define BIT_CLR_P0HI11Q_HW_IDX BIT(25) -+#define BIT_CLR_P0HI10Q_HW_IDX BIT(24) -+#define BIT_CLR_P0HI9Q_HW_IDX BIT(23) -+#define BIT_CLR_P0HI8Q_HW_IDX BIT(22) -+#define BIT_CLR_ACH7_HW_IDX BIT(21) -+#define BIT_CLR_ACH13_HW_IDX BIT(21) -+#define BIT_CLR_ACH6_HW_IDX BIT(20) -+#define BIT_CLR_ACH12_HW_IDX BIT(20) -+#define BIT_CLR_ACH5_HW_IDX BIT(19) -+#define BIT_CLR_ACH11_HW_IDX BIT(19) -+#define BIT_CLR_ACH4_HW_IDX BIT(18) -+#define BIT_CLR_ACH10_HW_IDX BIT(18) -+#define BIT_CLR_ACH9_HW_IDX BIT(17) -+#define BIT_CLR_ACH8_HW_IDX BIT(16) -+ -+#define BIT_SHIFT_P0_MPRT_BCNQ_DESC_MODE 13 -+#define BIT_MASK_P0_MPRT_BCNQ_DESC_MODE 0x3 -+#define BIT_P0_MPRT_BCNQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0_MPRT_BCNQ_DESC_MODE) \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_DESC_MODE) -+#define BITS_P0_MPRT_BCNQ_DESC_MODE \ -+ (BIT_MASK_P0_MPRT_BCNQ_DESC_MODE << BIT_SHIFT_P0_MPRT_BCNQ_DESC_MODE) -+#define BIT_CLEAR_P0_MPRT_BCNQ_DESC_MODE(x) \ -+ ((x) & (~BITS_P0_MPRT_BCNQ_DESC_MODE)) -+#define BIT_GET_P0_MPRT_BCNQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0_MPRT_BCNQ_DESC_MODE) & \ -+ BIT_MASK_P0_MPRT_BCNQ_DESC_MODE) -+#define BIT_SET_P0_MPRT_BCNQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0_MPRT_BCNQ_DESC_MODE(x) | BIT_P0_MPRT_BCNQ_DESC_MODE(v)) -+ -+#define BIT_CLR_P0HI15Q_HOST_IDX BIT(13) -+#define BIT_CLR_P0HI14Q_HOST_IDX BIT(12) -+#define BIT_PCIE_P0MPRT_BCNQ4_FLAG BIT(11) -+#define BIT_CLR_P0HI13Q_HOST_IDX BIT(11) -+#define BIT_PCIE_P0MPRT_BCNQ3_FLAG BIT(10) -+#define BIT_CLR_P0HI12Q_HOST_IDX BIT(10) -+#define BIT_PCIE_P0MPRT_BCNQ2_FLAG BIT(9) -+#define BIT_CLR_P0HI11Q_HOST_IDX BIT(9) -+#define BIT_PCIE_P0MPRT_BCNQ1_FLAG BIT(8) -+#define BIT_CLR_P0HI10Q_HOST_IDX BIT(8) -+#define BIT_CLR_P0HI9Q_HOST_IDX BIT(7) -+#define BIT_CLR_P0HI8Q_HOST_IDX BIT(6) -+#define BIT_CLR_ACH7_HOST_IDX BIT(5) -+#define BIT_CLR_ACH13_HOST_IDX BIT(5) -+#define BIT_CLR_ACH6_HOST_IDX BIT(4) -+#define BIT_CLR_ACH12_HOST_IDX BIT(4) -+#define BIT_CLR_ACH5_HOST_IDX BIT(3) -+#define BIT_CLR_ACH11_HOST_IDX BIT(3) -+#define BIT_CLR_ACH4_HOST_IDX BIT(2) -+#define BIT_CLR_ACH10_HOST_IDX BIT(2) -+#define BIT_EPHY_CAL_DONE BIT(1) -+#define BIT_CLR_ACH9_HOST_IDX BIT(1) -+ -+#define BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_H 0 -+#define BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_H 0xffffffffL -+#define BIT_P0_MPRT_BCNQ_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_H) \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_H) -+#define BITS_P0_MPRT_BCNQ_TXBD_DESA_H \ -+ (BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_H \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_H) -+#define BIT_CLEAR_P0_MPRT_BCNQ_TXBD_DESA_H(x) \ -+ ((x) & (~BITS_P0_MPRT_BCNQ_TXBD_DESA_H)) -+#define BIT_GET_P0_MPRT_BCNQ_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_H) & \ -+ BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_H) -+#define BIT_SET_P0_MPRT_BCNQ_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_P0_MPRT_BCNQ_TXBD_DESA_H(x) | \ -+ BIT_P0_MPRT_BCNQ_TXBD_DESA_H(v)) -+ -+#define BIT_RESET_APHY BIT(0) -+#define BIT_CLR_ACH8_HOST_IDX BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI4Q_TXBD_DESA (Offset 0x0360) */ -+ -+#define BIT_SHIFT_HI4Q_TXBD_DESA 0 -+#define BIT_MASK_HI4Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI4Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI4Q_TXBD_DESA) << BIT_SHIFT_HI4Q_TXBD_DESA) -+#define BITS_HI4Q_TXBD_DESA \ -+ (BIT_MASK_HI4Q_TXBD_DESA << BIT_SHIFT_HI4Q_TXBD_DESA) -+#define BIT_CLEAR_HI4Q_TXBD_DESA(x) ((x) & (~BITS_HI4Q_TXBD_DESA)) -+#define BIT_GET_HI4Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_TXBD_DESA) & BIT_MASK_HI4Q_TXBD_DESA) -+#define BIT_SET_HI4Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI4Q_TXBD_DESA(x) | BIT_HI4Q_TXBD_DESA(v)) -+ -+/* 2 REG_HI5Q_TXBD_DESA (Offset 0x0368) */ -+ -+#define BIT_SHIFT_HI5Q_TXBD_DESA 0 -+#define BIT_MASK_HI5Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI5Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI5Q_TXBD_DESA) << BIT_SHIFT_HI5Q_TXBD_DESA) -+#define BITS_HI5Q_TXBD_DESA \ -+ (BIT_MASK_HI5Q_TXBD_DESA << BIT_SHIFT_HI5Q_TXBD_DESA) -+#define BIT_CLEAR_HI5Q_TXBD_DESA(x) ((x) & (~BITS_HI5Q_TXBD_DESA)) -+#define BIT_GET_HI5Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_TXBD_DESA) & BIT_MASK_HI5Q_TXBD_DESA) -+#define BIT_SET_HI5Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI5Q_TXBD_DESA(x) | BIT_HI5Q_TXBD_DESA(v)) -+ -+/* 2 REG_HI6Q_TXBD_DESA (Offset 0x0370) */ -+ -+#define BIT_SHIFT_HI6Q_TXBD_DESA 0 -+#define BIT_MASK_HI6Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI6Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI6Q_TXBD_DESA) << BIT_SHIFT_HI6Q_TXBD_DESA) -+#define BITS_HI6Q_TXBD_DESA \ -+ (BIT_MASK_HI6Q_TXBD_DESA << BIT_SHIFT_HI6Q_TXBD_DESA) -+#define BIT_CLEAR_HI6Q_TXBD_DESA(x) ((x) & (~BITS_HI6Q_TXBD_DESA)) -+#define BIT_GET_HI6Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_TXBD_DESA) & BIT_MASK_HI6Q_TXBD_DESA) -+#define BIT_SET_HI6Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI6Q_TXBD_DESA(x) | BIT_HI6Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0MGQ_RXQ_TXRXBD_NUM (Offset 0x0378) */ -+ -+#define BIT_SYS_32_64_V1 BIT(31) -+ -+#define BIT_SHIFT_P0BCNQ_DESC_MODE 29 -+#define BIT_MASK_P0BCNQ_DESC_MODE 0x3 -+#define BIT_P0BCNQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0BCNQ_DESC_MODE) << BIT_SHIFT_P0BCNQ_DESC_MODE) -+#define BITS_P0BCNQ_DESC_MODE \ -+ (BIT_MASK_P0BCNQ_DESC_MODE << BIT_SHIFT_P0BCNQ_DESC_MODE) -+#define BIT_CLEAR_P0BCNQ_DESC_MODE(x) ((x) & (~BITS_P0BCNQ_DESC_MODE)) -+#define BIT_GET_P0BCNQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0BCNQ_DESC_MODE) & BIT_MASK_P0BCNQ_DESC_MODE) -+#define BIT_SET_P0BCNQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0BCNQ_DESC_MODE(x) | BIT_P0BCNQ_DESC_MODE(v)) -+ -+#define BIT_PCIE_P0BCNQ_FLAG BIT(28) -+ -+#define BIT_SHIFT_P0RXQ_DESC_NUM 16 -+#define BIT_MASK_P0RXQ_DESC_NUM 0xfff -+#define BIT_P0RXQ_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0RXQ_DESC_NUM) << BIT_SHIFT_P0RXQ_DESC_NUM) -+#define BITS_P0RXQ_DESC_NUM \ -+ (BIT_MASK_P0RXQ_DESC_NUM << BIT_SHIFT_P0RXQ_DESC_NUM) -+#define BIT_CLEAR_P0RXQ_DESC_NUM(x) ((x) & (~BITS_P0RXQ_DESC_NUM)) -+#define BIT_GET_P0RXQ_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0RXQ_DESC_NUM) & BIT_MASK_P0RXQ_DESC_NUM) -+#define BIT_SET_P0RXQ_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0RXQ_DESC_NUM(x) | BIT_P0RXQ_DESC_NUM(v)) -+ -+#define BIT_PCIE_P0MGQ_FLAG BIT(14) -+ -+#define BIT_SHIFT_P0MGQ_DESC_MODE 12 -+#define BIT_MASK_P0MGQ_DESC_MODE 0x3 -+#define BIT_P0MGQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0MGQ_DESC_MODE) << BIT_SHIFT_P0MGQ_DESC_MODE) -+#define BITS_P0MGQ_DESC_MODE \ -+ (BIT_MASK_P0MGQ_DESC_MODE << BIT_SHIFT_P0MGQ_DESC_MODE) -+#define BIT_CLEAR_P0MGQ_DESC_MODE(x) ((x) & (~BITS_P0MGQ_DESC_MODE)) -+#define BIT_GET_P0MGQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0MGQ_DESC_MODE) & BIT_MASK_P0MGQ_DESC_MODE) -+#define BIT_SET_P0MGQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0MGQ_DESC_MODE(x) | BIT_P0MGQ_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI7Q_TXBD_DESA (Offset 0x0378) */ -+ -+#define BIT_SHIFT_HI7Q_TXBD_DESA 0 -+#define BIT_MASK_HI7Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI7Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI7Q_TXBD_DESA) << BIT_SHIFT_HI7Q_TXBD_DESA) -+#define BITS_HI7Q_TXBD_DESA \ -+ (BIT_MASK_HI7Q_TXBD_DESA << BIT_SHIFT_HI7Q_TXBD_DESA) -+#define BIT_CLEAR_HI7Q_TXBD_DESA(x) ((x) & (~BITS_HI7Q_TXBD_DESA)) -+#define BIT_GET_HI7Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_TXBD_DESA) & BIT_MASK_HI7Q_TXBD_DESA) -+#define BIT_SET_HI7Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI7Q_TXBD_DESA(x) | BIT_HI7Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0MGQ_RXQ_TXRXBD_NUM (Offset 0x0378) */ -+ -+#define BIT_SHIFT_P0MGQ_DESC_NUM 0 -+#define BIT_MASK_P0MGQ_DESC_NUM 0xfff -+#define BIT_P0MGQ_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0MGQ_DESC_NUM) << BIT_SHIFT_P0MGQ_DESC_NUM) -+#define BITS_P0MGQ_DESC_NUM \ -+ (BIT_MASK_P0MGQ_DESC_NUM << BIT_SHIFT_P0MGQ_DESC_NUM) -+#define BIT_CLEAR_P0MGQ_DESC_NUM(x) ((x) & (~BITS_P0MGQ_DESC_NUM)) -+#define BIT_GET_P0MGQ_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0MGQ_DESC_NUM) & BIT_MASK_P0MGQ_DESC_NUM) -+#define BIT_SET_P0MGQ_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0MGQ_DESC_NUM(x) | BIT_P0MGQ_DESC_NUM(v)) -+ -+/* 2 REG_CHNL_DMA_CFG (Offset 0x037C) */ -+ -+#define BIT_TXHCI_EN BIT(26) -+#define BIT_TXHCI_IDLE BIT(25) -+#define BIT_DMA_PRI_EN BIT(24) -+#define BIT_PCIE_FWCMDQ_FLAG BIT(14) -+ -+#define BIT_SHIFT_FWCMDQ_DESC_MODE 12 -+#define BIT_MASK_FWCMDQ_DESC_MODE 0x3 -+#define BIT_FWCMDQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_FWCMDQ_DESC_MODE) << BIT_SHIFT_FWCMDQ_DESC_MODE) -+#define BITS_FWCMDQ_DESC_MODE \ -+ (BIT_MASK_FWCMDQ_DESC_MODE << BIT_SHIFT_FWCMDQ_DESC_MODE) -+#define BIT_CLEAR_FWCMDQ_DESC_MODE(x) ((x) & (~BITS_FWCMDQ_DESC_MODE)) -+#define BIT_GET_FWCMDQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_DESC_MODE) & BIT_MASK_FWCMDQ_DESC_MODE) -+#define BIT_SET_FWCMDQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_FWCMDQ_DESC_MODE(x) | BIT_FWCMDQ_DESC_MODE(v)) -+ -+#define BIT_SHIFT_FWCMDQ_DESC_NUM 0 -+#define BIT_MASK_FWCMDQ_DESC_NUM 0xfff -+#define BIT_FWCMDQ_DESC_NUM(x) \ -+ (((x) & BIT_MASK_FWCMDQ_DESC_NUM) << BIT_SHIFT_FWCMDQ_DESC_NUM) -+#define BITS_FWCMDQ_DESC_NUM \ -+ (BIT_MASK_FWCMDQ_DESC_NUM << BIT_SHIFT_FWCMDQ_DESC_NUM) -+#define BIT_CLEAR_FWCMDQ_DESC_NUM(x) ((x) & (~BITS_FWCMDQ_DESC_NUM)) -+#define BIT_GET_FWCMDQ_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_DESC_NUM) & BIT_MASK_FWCMDQ_DESC_NUM) -+#define BIT_SET_FWCMDQ_DESC_NUM(x, v) \ -+ (BIT_CLEAR_FWCMDQ_DESC_NUM(x) | BIT_FWCMDQ_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_TXBD_NUM (Offset 0x0380) */ -+ -+#define BIT_PCIE_MGQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MGQ_TXBD_NUM (Offset 0x0380) */ -+ -+#define BIT_HCI_MGQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_TXBD_NUM (Offset 0x0380) */ -+ -+#define BIT_SHIFT_MGQ_DESC_MODE 12 -+#define BIT_MASK_MGQ_DESC_MODE 0x3 -+#define BIT_MGQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_MODE) << BIT_SHIFT_MGQ_DESC_MODE) -+#define BITS_MGQ_DESC_MODE (BIT_MASK_MGQ_DESC_MODE << BIT_SHIFT_MGQ_DESC_MODE) -+#define BIT_CLEAR_MGQ_DESC_MODE(x) ((x) & (~BITS_MGQ_DESC_MODE)) -+#define BIT_GET_MGQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_MODE) & BIT_MASK_MGQ_DESC_MODE) -+#define BIT_SET_MGQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_MODE(x) | BIT_MGQ_DESC_MODE(v)) -+ -+#define BIT_SHIFT_MGQ_DESC_NUM 0 -+#define BIT_MASK_MGQ_DESC_NUM 0xfff -+#define BIT_MGQ_DESC_NUM(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_NUM) << BIT_SHIFT_MGQ_DESC_NUM) -+#define BITS_MGQ_DESC_NUM (BIT_MASK_MGQ_DESC_NUM << BIT_SHIFT_MGQ_DESC_NUM) -+#define BIT_CLEAR_MGQ_DESC_NUM(x) ((x) & (~BITS_MGQ_DESC_NUM)) -+#define BIT_GET_MGQ_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_NUM) & BIT_MASK_MGQ_DESC_NUM) -+#define BIT_SET_MGQ_DESC_NUM(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_NUM(x) | BIT_MGQ_DESC_NUM(v)) -+ -+/* 2 REG_RX_RXBD_NUM (Offset 0x0382) */ -+ -+#define BIT_SYS_32_64 BIT(15) -+ -+#define BIT_SHIFT_BCNQ_DESC_MODE 13 -+#define BIT_MASK_BCNQ_DESC_MODE 0x3 -+#define BIT_BCNQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_BCNQ_DESC_MODE) << BIT_SHIFT_BCNQ_DESC_MODE) -+#define BITS_BCNQ_DESC_MODE \ -+ (BIT_MASK_BCNQ_DESC_MODE << BIT_SHIFT_BCNQ_DESC_MODE) -+#define BIT_CLEAR_BCNQ_DESC_MODE(x) ((x) & (~BITS_BCNQ_DESC_MODE)) -+#define BIT_GET_BCNQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_DESC_MODE) & BIT_MASK_BCNQ_DESC_MODE) -+#define BIT_SET_BCNQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_BCNQ_DESC_MODE(x) | BIT_BCNQ_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RX_RXBD_NUM (Offset 0x0382) */ -+ -+#define BIT_PCIE_BCNQ_FLAG BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RX_RXBD_NUM (Offset 0x0382) */ -+ -+#define BIT_HCI_BCNQ_FLAG BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RX_RXBD_NUM (Offset 0x0382) */ -+ -+#define BIT_SHIFT_RXQ_DESC_NUM 0 -+#define BIT_MASK_RXQ_DESC_NUM 0xfff -+#define BIT_RXQ_DESC_NUM(x) \ -+ (((x) & BIT_MASK_RXQ_DESC_NUM) << BIT_SHIFT_RXQ_DESC_NUM) -+#define BITS_RXQ_DESC_NUM (BIT_MASK_RXQ_DESC_NUM << BIT_SHIFT_RXQ_DESC_NUM) -+#define BIT_CLEAR_RXQ_DESC_NUM(x) ((x) & (~BITS_RXQ_DESC_NUM)) -+#define BIT_GET_RXQ_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_RXQ_DESC_NUM) & BIT_MASK_RXQ_DESC_NUM) -+#define BIT_SET_RXQ_DESC_NUM(x, v) \ -+ (BIT_CLEAR_RXQ_DESC_NUM(x) | BIT_RXQ_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH0_ACH1_TXBD_NUM (Offset 0x0384) */ -+ -+#define BIT_PCIE_ACH1_FLAG_V1 BIT(30) -+ -+#define BIT_SHIFT_ACH1_DESC_MODE_V1 28 -+#define BIT_MASK_ACH1_DESC_MODE_V1 0x3 -+#define BIT_ACH1_DESC_MODE_V1(x) \ -+ (((x) & BIT_MASK_ACH1_DESC_MODE_V1) << BIT_SHIFT_ACH1_DESC_MODE_V1) -+#define BITS_ACH1_DESC_MODE_V1 \ -+ (BIT_MASK_ACH1_DESC_MODE_V1 << BIT_SHIFT_ACH1_DESC_MODE_V1) -+#define BIT_CLEAR_ACH1_DESC_MODE_V1(x) ((x) & (~BITS_ACH1_DESC_MODE_V1)) -+#define BIT_GET_ACH1_DESC_MODE_V1(x) \ -+ (((x) >> BIT_SHIFT_ACH1_DESC_MODE_V1) & BIT_MASK_ACH1_DESC_MODE_V1) -+#define BIT_SET_ACH1_DESC_MODE_V1(x, v) \ -+ (BIT_CLEAR_ACH1_DESC_MODE_V1(x) | BIT_ACH1_DESC_MODE_V1(v)) -+ -+#define BIT_SHIFT_ACH1_DESC_NUM_V1 16 -+#define BIT_MASK_ACH1_DESC_NUM_V1 0xfff -+#define BIT_ACH1_DESC_NUM_V1(x) \ -+ (((x) & BIT_MASK_ACH1_DESC_NUM_V1) << BIT_SHIFT_ACH1_DESC_NUM_V1) -+#define BITS_ACH1_DESC_NUM_V1 \ -+ (BIT_MASK_ACH1_DESC_NUM_V1 << BIT_SHIFT_ACH1_DESC_NUM_V1) -+#define BIT_CLEAR_ACH1_DESC_NUM_V1(x) ((x) & (~BITS_ACH1_DESC_NUM_V1)) -+#define BIT_GET_ACH1_DESC_NUM_V1(x) \ -+ (((x) >> BIT_SHIFT_ACH1_DESC_NUM_V1) & BIT_MASK_ACH1_DESC_NUM_V1) -+#define BIT_SET_ACH1_DESC_NUM_V1(x, v) \ -+ (BIT_CLEAR_ACH1_DESC_NUM_V1(x) | BIT_ACH1_DESC_NUM_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_VOQ_TXBD_NUM (Offset 0x0384) */ -+ -+#define BIT_PCIE_VOQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_VOQ_TXBD_NUM (Offset 0x0384) */ -+ -+#define BIT_HCI_VOQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH0_ACH1_TXBD_NUM (Offset 0x0384) */ -+ -+#define BIT_PCIE_ACH0_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_VOQ_TXBD_NUM (Offset 0x0384) */ -+ -+#define BIT_SHIFT_VOQ_DESC_MODE 12 -+#define BIT_MASK_VOQ_DESC_MODE 0x3 -+#define BIT_VOQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_MODE) << BIT_SHIFT_VOQ_DESC_MODE) -+#define BITS_VOQ_DESC_MODE (BIT_MASK_VOQ_DESC_MODE << BIT_SHIFT_VOQ_DESC_MODE) -+#define BIT_CLEAR_VOQ_DESC_MODE(x) ((x) & (~BITS_VOQ_DESC_MODE)) -+#define BIT_GET_VOQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_MODE) & BIT_MASK_VOQ_DESC_MODE) -+#define BIT_SET_VOQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_MODE(x) | BIT_VOQ_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH0_ACH1_TXBD_NUM (Offset 0x0384) */ -+ -+#define BIT_SHIFT_ACH0_DESC_MODE 12 -+#define BIT_MASK_ACH0_DESC_MODE 0x3 -+#define BIT_ACH0_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH0_DESC_MODE) << BIT_SHIFT_ACH0_DESC_MODE) -+#define BITS_ACH0_DESC_MODE \ -+ (BIT_MASK_ACH0_DESC_MODE << BIT_SHIFT_ACH0_DESC_MODE) -+#define BIT_CLEAR_ACH0_DESC_MODE(x) ((x) & (~BITS_ACH0_DESC_MODE)) -+#define BIT_GET_ACH0_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH0_DESC_MODE) & BIT_MASK_ACH0_DESC_MODE) -+#define BIT_SET_ACH0_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH0_DESC_MODE(x) | BIT_ACH0_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_VOQ_TXBD_NUM (Offset 0x0384) */ -+ -+#define BIT_SHIFT_VOQ_DESC_NUM 0 -+#define BIT_MASK_VOQ_DESC_NUM 0xfff -+#define BIT_VOQ_DESC_NUM(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_NUM) << BIT_SHIFT_VOQ_DESC_NUM) -+#define BITS_VOQ_DESC_NUM (BIT_MASK_VOQ_DESC_NUM << BIT_SHIFT_VOQ_DESC_NUM) -+#define BIT_CLEAR_VOQ_DESC_NUM(x) ((x) & (~BITS_VOQ_DESC_NUM)) -+#define BIT_GET_VOQ_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_NUM) & BIT_MASK_VOQ_DESC_NUM) -+#define BIT_SET_VOQ_DESC_NUM(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_NUM(x) | BIT_VOQ_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH0_ACH1_TXBD_NUM (Offset 0x0384) */ -+ -+#define BIT_SHIFT_ACH0_DESC_NUM 0 -+#define BIT_MASK_ACH0_DESC_NUM 0xfff -+#define BIT_ACH0_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH0_DESC_NUM) << BIT_SHIFT_ACH0_DESC_NUM) -+#define BITS_ACH0_DESC_NUM (BIT_MASK_ACH0_DESC_NUM << BIT_SHIFT_ACH0_DESC_NUM) -+#define BIT_CLEAR_ACH0_DESC_NUM(x) ((x) & (~BITS_ACH0_DESC_NUM)) -+#define BIT_GET_ACH0_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH0_DESC_NUM) & BIT_MASK_ACH0_DESC_NUM) -+#define BIT_SET_ACH0_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH0_DESC_NUM(x) | BIT_ACH0_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_VIQ_TXBD_NUM (Offset 0x0386) */ -+ -+#define BIT_PCIE_VIQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_VIQ_TXBD_NUM (Offset 0x0386) */ -+ -+#define BIT_HCI_VIQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_VIQ_TXBD_NUM (Offset 0x0386) */ -+ -+#define BIT_SHIFT_VIQ_DESC_MODE 12 -+#define BIT_MASK_VIQ_DESC_MODE 0x3 -+#define BIT_VIQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_MODE) << BIT_SHIFT_VIQ_DESC_MODE) -+#define BITS_VIQ_DESC_MODE (BIT_MASK_VIQ_DESC_MODE << BIT_SHIFT_VIQ_DESC_MODE) -+#define BIT_CLEAR_VIQ_DESC_MODE(x) ((x) & (~BITS_VIQ_DESC_MODE)) -+#define BIT_GET_VIQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_MODE) & BIT_MASK_VIQ_DESC_MODE) -+#define BIT_SET_VIQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_MODE(x) | BIT_VIQ_DESC_MODE(v)) -+ -+#define BIT_SHIFT_VIQ_DESC_NUM 0 -+#define BIT_MASK_VIQ_DESC_NUM 0xfff -+#define BIT_VIQ_DESC_NUM(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_NUM) << BIT_SHIFT_VIQ_DESC_NUM) -+#define BITS_VIQ_DESC_NUM (BIT_MASK_VIQ_DESC_NUM << BIT_SHIFT_VIQ_DESC_NUM) -+#define BIT_CLEAR_VIQ_DESC_NUM(x) ((x) & (~BITS_VIQ_DESC_NUM)) -+#define BIT_GET_VIQ_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_NUM) & BIT_MASK_VIQ_DESC_NUM) -+#define BIT_SET_VIQ_DESC_NUM(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_NUM(x) | BIT_VIQ_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH2_ACH3_TXBD_NUM (Offset 0x0388) */ -+ -+#define BIT_PCIE_ACH3_FLAG_V1 BIT(30) -+ -+#define BIT_SHIFT_ACH3_DESC_MODE_V1 28 -+#define BIT_MASK_ACH3_DESC_MODE_V1 0x3 -+#define BIT_ACH3_DESC_MODE_V1(x) \ -+ (((x) & BIT_MASK_ACH3_DESC_MODE_V1) << BIT_SHIFT_ACH3_DESC_MODE_V1) -+#define BITS_ACH3_DESC_MODE_V1 \ -+ (BIT_MASK_ACH3_DESC_MODE_V1 << BIT_SHIFT_ACH3_DESC_MODE_V1) -+#define BIT_CLEAR_ACH3_DESC_MODE_V1(x) ((x) & (~BITS_ACH3_DESC_MODE_V1)) -+#define BIT_GET_ACH3_DESC_MODE_V1(x) \ -+ (((x) >> BIT_SHIFT_ACH3_DESC_MODE_V1) & BIT_MASK_ACH3_DESC_MODE_V1) -+#define BIT_SET_ACH3_DESC_MODE_V1(x, v) \ -+ (BIT_CLEAR_ACH3_DESC_MODE_V1(x) | BIT_ACH3_DESC_MODE_V1(v)) -+ -+#define BIT_SHIFT_ACH3_DESC_NUM_V1 16 -+#define BIT_MASK_ACH3_DESC_NUM_V1 0xfff -+#define BIT_ACH3_DESC_NUM_V1(x) \ -+ (((x) & BIT_MASK_ACH3_DESC_NUM_V1) << BIT_SHIFT_ACH3_DESC_NUM_V1) -+#define BITS_ACH3_DESC_NUM_V1 \ -+ (BIT_MASK_ACH3_DESC_NUM_V1 << BIT_SHIFT_ACH3_DESC_NUM_V1) -+#define BIT_CLEAR_ACH3_DESC_NUM_V1(x) ((x) & (~BITS_ACH3_DESC_NUM_V1)) -+#define BIT_GET_ACH3_DESC_NUM_V1(x) \ -+ (((x) >> BIT_SHIFT_ACH3_DESC_NUM_V1) & BIT_MASK_ACH3_DESC_NUM_V1) -+#define BIT_SET_ACH3_DESC_NUM_V1(x, v) \ -+ (BIT_CLEAR_ACH3_DESC_NUM_V1(x) | BIT_ACH3_DESC_NUM_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BEQ_TXBD_NUM (Offset 0x0388) */ -+ -+#define BIT_PCIE_BEQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BEQ_TXBD_NUM (Offset 0x0388) */ -+ -+#define BIT_HCI_BEQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH2_ACH3_TXBD_NUM (Offset 0x0388) */ -+ -+#define BIT_PCIE_ACH2_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BEQ_TXBD_NUM (Offset 0x0388) */ -+ -+#define BIT_SHIFT_BEQ_DESC_MODE 12 -+#define BIT_MASK_BEQ_DESC_MODE 0x3 -+#define BIT_BEQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_MODE) << BIT_SHIFT_BEQ_DESC_MODE) -+#define BITS_BEQ_DESC_MODE (BIT_MASK_BEQ_DESC_MODE << BIT_SHIFT_BEQ_DESC_MODE) -+#define BIT_CLEAR_BEQ_DESC_MODE(x) ((x) & (~BITS_BEQ_DESC_MODE)) -+#define BIT_GET_BEQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_MODE) & BIT_MASK_BEQ_DESC_MODE) -+#define BIT_SET_BEQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_MODE(x) | BIT_BEQ_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH2_ACH3_TXBD_NUM (Offset 0x0388) */ -+ -+#define BIT_SHIFT_ACH2_DESC_MODE 12 -+#define BIT_MASK_ACH2_DESC_MODE 0x3 -+#define BIT_ACH2_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH2_DESC_MODE) << BIT_SHIFT_ACH2_DESC_MODE) -+#define BITS_ACH2_DESC_MODE \ -+ (BIT_MASK_ACH2_DESC_MODE << BIT_SHIFT_ACH2_DESC_MODE) -+#define BIT_CLEAR_ACH2_DESC_MODE(x) ((x) & (~BITS_ACH2_DESC_MODE)) -+#define BIT_GET_ACH2_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH2_DESC_MODE) & BIT_MASK_ACH2_DESC_MODE) -+#define BIT_SET_ACH2_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH2_DESC_MODE(x) | BIT_ACH2_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BEQ_TXBD_NUM (Offset 0x0388) */ -+ -+#define BIT_SHIFT_BEQ_DESC_NUM 0 -+#define BIT_MASK_BEQ_DESC_NUM 0xfff -+#define BIT_BEQ_DESC_NUM(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_NUM) << BIT_SHIFT_BEQ_DESC_NUM) -+#define BITS_BEQ_DESC_NUM (BIT_MASK_BEQ_DESC_NUM << BIT_SHIFT_BEQ_DESC_NUM) -+#define BIT_CLEAR_BEQ_DESC_NUM(x) ((x) & (~BITS_BEQ_DESC_NUM)) -+#define BIT_GET_BEQ_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_NUM) & BIT_MASK_BEQ_DESC_NUM) -+#define BIT_SET_BEQ_DESC_NUM(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_NUM(x) | BIT_BEQ_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH2_ACH3_TXBD_NUM (Offset 0x0388) */ -+ -+#define BIT_SHIFT_ACH2_DESC_NUM 0 -+#define BIT_MASK_ACH2_DESC_NUM 0xfff -+#define BIT_ACH2_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH2_DESC_NUM) << BIT_SHIFT_ACH2_DESC_NUM) -+#define BITS_ACH2_DESC_NUM (BIT_MASK_ACH2_DESC_NUM << BIT_SHIFT_ACH2_DESC_NUM) -+#define BIT_CLEAR_ACH2_DESC_NUM(x) ((x) & (~BITS_ACH2_DESC_NUM)) -+#define BIT_GET_ACH2_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH2_DESC_NUM) & BIT_MASK_ACH2_DESC_NUM) -+#define BIT_SET_ACH2_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH2_DESC_NUM(x) | BIT_ACH2_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BKQ_TXBD_NUM (Offset 0x038A) */ -+ -+#define BIT_PCIE_BKQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BKQ_TXBD_NUM (Offset 0x038A) */ -+ -+#define BIT_HCI_BKQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BKQ_TXBD_NUM (Offset 0x038A) */ -+ -+#define BIT_SHIFT_BKQ_DESC_MODE 12 -+#define BIT_MASK_BKQ_DESC_MODE 0x3 -+#define BIT_BKQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_MODE) << BIT_SHIFT_BKQ_DESC_MODE) -+#define BITS_BKQ_DESC_MODE (BIT_MASK_BKQ_DESC_MODE << BIT_SHIFT_BKQ_DESC_MODE) -+#define BIT_CLEAR_BKQ_DESC_MODE(x) ((x) & (~BITS_BKQ_DESC_MODE)) -+#define BIT_GET_BKQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_MODE) & BIT_MASK_BKQ_DESC_MODE) -+#define BIT_SET_BKQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_MODE(x) | BIT_BKQ_DESC_MODE(v)) -+ -+#define BIT_SHIFT_BKQ_DESC_NUM 0 -+#define BIT_MASK_BKQ_DESC_NUM 0xfff -+#define BIT_BKQ_DESC_NUM(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_NUM) << BIT_SHIFT_BKQ_DESC_NUM) -+#define BITS_BKQ_DESC_NUM (BIT_MASK_BKQ_DESC_NUM << BIT_SHIFT_BKQ_DESC_NUM) -+#define BIT_CLEAR_BKQ_DESC_NUM(x) ((x) & (~BITS_BKQ_DESC_NUM)) -+#define BIT_GET_BKQ_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_NUM) & BIT_MASK_BKQ_DESC_NUM) -+#define BIT_SET_BKQ_DESC_NUM(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_NUM(x) | BIT_BKQ_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI0Q_HI1Q_TXBD_NUM (Offset 0x038C) */ -+ -+#define BIT_P0HI1Q_FLAG BIT(30) -+ -+#define BIT_SHIFT_P0HI1Q_DESC_MODE 28 -+#define BIT_MASK_P0HI1Q_DESC_MODE 0x3 -+#define BIT_P0HI1Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI1Q_DESC_MODE) << BIT_SHIFT_P0HI1Q_DESC_MODE) -+#define BITS_P0HI1Q_DESC_MODE \ -+ (BIT_MASK_P0HI1Q_DESC_MODE << BIT_SHIFT_P0HI1Q_DESC_MODE) -+#define BIT_CLEAR_P0HI1Q_DESC_MODE(x) ((x) & (~BITS_P0HI1Q_DESC_MODE)) -+#define BIT_GET_P0HI1Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI1Q_DESC_MODE) & BIT_MASK_P0HI1Q_DESC_MODE) -+#define BIT_SET_P0HI1Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI1Q_DESC_MODE(x) | BIT_P0HI1Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI1Q_DESC_NUM 16 -+#define BIT_MASK_P0HI1Q_DESC_NUM 0xfff -+#define BIT_P0HI1Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI1Q_DESC_NUM) << BIT_SHIFT_P0HI1Q_DESC_NUM) -+#define BITS_P0HI1Q_DESC_NUM \ -+ (BIT_MASK_P0HI1Q_DESC_NUM << BIT_SHIFT_P0HI1Q_DESC_NUM) -+#define BIT_CLEAR_P0HI1Q_DESC_NUM(x) ((x) & (~BITS_P0HI1Q_DESC_NUM)) -+#define BIT_GET_P0HI1Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI1Q_DESC_NUM) & BIT_MASK_P0HI1Q_DESC_NUM) -+#define BIT_SET_P0HI1Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI1Q_DESC_NUM(x) | BIT_P0HI1Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI0Q_TXBD_NUM (Offset 0x038C) */ -+ -+#define BIT_HI0Q_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI0Q_HI1Q_TXBD_NUM (Offset 0x038C) */ -+ -+#define BIT_P0HI0Q_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI0Q_TXBD_NUM (Offset 0x038C) */ -+ -+#define BIT_SHIFT_HI0Q_DESC_MODE 12 -+#define BIT_MASK_HI0Q_DESC_MODE 0x3 -+#define BIT_HI0Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_MODE) << BIT_SHIFT_HI0Q_DESC_MODE) -+#define BITS_HI0Q_DESC_MODE \ -+ (BIT_MASK_HI0Q_DESC_MODE << BIT_SHIFT_HI0Q_DESC_MODE) -+#define BIT_CLEAR_HI0Q_DESC_MODE(x) ((x) & (~BITS_HI0Q_DESC_MODE)) -+#define BIT_GET_HI0Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_MODE) & BIT_MASK_HI0Q_DESC_MODE) -+#define BIT_SET_HI0Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_MODE(x) | BIT_HI0Q_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI0Q_HI1Q_TXBD_NUM (Offset 0x038C) */ -+ -+#define BIT_SHIFT_P0HI0Q_DESC_MODE 12 -+#define BIT_MASK_P0HI0Q_DESC_MODE 0x3 -+#define BIT_P0HI0Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI0Q_DESC_MODE) << BIT_SHIFT_P0HI0Q_DESC_MODE) -+#define BITS_P0HI0Q_DESC_MODE \ -+ (BIT_MASK_P0HI0Q_DESC_MODE << BIT_SHIFT_P0HI0Q_DESC_MODE) -+#define BIT_CLEAR_P0HI0Q_DESC_MODE(x) ((x) & (~BITS_P0HI0Q_DESC_MODE)) -+#define BIT_GET_P0HI0Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI0Q_DESC_MODE) & BIT_MASK_P0HI0Q_DESC_MODE) -+#define BIT_SET_P0HI0Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI0Q_DESC_MODE(x) | BIT_P0HI0Q_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI0Q_TXBD_NUM (Offset 0x038C) */ -+ -+#define BIT_SHIFT_HI0Q_DESC_NUM 0 -+#define BIT_MASK_HI0Q_DESC_NUM 0xfff -+#define BIT_HI0Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_NUM) << BIT_SHIFT_HI0Q_DESC_NUM) -+#define BITS_HI0Q_DESC_NUM (BIT_MASK_HI0Q_DESC_NUM << BIT_SHIFT_HI0Q_DESC_NUM) -+#define BIT_CLEAR_HI0Q_DESC_NUM(x) ((x) & (~BITS_HI0Q_DESC_NUM)) -+#define BIT_GET_HI0Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_NUM) & BIT_MASK_HI0Q_DESC_NUM) -+#define BIT_SET_HI0Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_NUM(x) | BIT_HI0Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI0Q_HI1Q_TXBD_NUM (Offset 0x038C) */ -+ -+#define BIT_SHIFT_P0HI0Q_DESC_NUM 0 -+#define BIT_MASK_P0HI0Q_DESC_NUM 0xfff -+#define BIT_P0HI0Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI0Q_DESC_NUM) << BIT_SHIFT_P0HI0Q_DESC_NUM) -+#define BITS_P0HI0Q_DESC_NUM \ -+ (BIT_MASK_P0HI0Q_DESC_NUM << BIT_SHIFT_P0HI0Q_DESC_NUM) -+#define BIT_CLEAR_P0HI0Q_DESC_NUM(x) ((x) & (~BITS_P0HI0Q_DESC_NUM)) -+#define BIT_GET_P0HI0Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI0Q_DESC_NUM) & BIT_MASK_P0HI0Q_DESC_NUM) -+#define BIT_SET_P0HI0Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI0Q_DESC_NUM(x) | BIT_P0HI0Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI1Q_TXBD_NUM (Offset 0x038E) */ -+ -+#define BIT_HI1Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI1Q_DESC_MODE 12 -+#define BIT_MASK_HI1Q_DESC_MODE 0x3 -+#define BIT_HI1Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_MODE) << BIT_SHIFT_HI1Q_DESC_MODE) -+#define BITS_HI1Q_DESC_MODE \ -+ (BIT_MASK_HI1Q_DESC_MODE << BIT_SHIFT_HI1Q_DESC_MODE) -+#define BIT_CLEAR_HI1Q_DESC_MODE(x) ((x) & (~BITS_HI1Q_DESC_MODE)) -+#define BIT_GET_HI1Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_MODE) & BIT_MASK_HI1Q_DESC_MODE) -+#define BIT_SET_HI1Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_MODE(x) | BIT_HI1Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI1Q_DESC_NUM 0 -+#define BIT_MASK_HI1Q_DESC_NUM 0xfff -+#define BIT_HI1Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_NUM) << BIT_SHIFT_HI1Q_DESC_NUM) -+#define BITS_HI1Q_DESC_NUM (BIT_MASK_HI1Q_DESC_NUM << BIT_SHIFT_HI1Q_DESC_NUM) -+#define BIT_CLEAR_HI1Q_DESC_NUM(x) ((x) & (~BITS_HI1Q_DESC_NUM)) -+#define BIT_GET_HI1Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_NUM) & BIT_MASK_HI1Q_DESC_NUM) -+#define BIT_SET_HI1Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_NUM(x) | BIT_HI1Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI2Q_HI3Q_TXBD_NUM (Offset 0x0390) */ -+ -+#define BIT_P0HI3Q_FLAG BIT(30) -+ -+#define BIT_SHIFT_P0HI3Q_DESC_MODE 28 -+#define BIT_MASK_P0HI3Q_DESC_MODE 0x3 -+#define BIT_P0HI3Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI3Q_DESC_MODE) << BIT_SHIFT_P0HI3Q_DESC_MODE) -+#define BITS_P0HI3Q_DESC_MODE \ -+ (BIT_MASK_P0HI3Q_DESC_MODE << BIT_SHIFT_P0HI3Q_DESC_MODE) -+#define BIT_CLEAR_P0HI3Q_DESC_MODE(x) ((x) & (~BITS_P0HI3Q_DESC_MODE)) -+#define BIT_GET_P0HI3Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI3Q_DESC_MODE) & BIT_MASK_P0HI3Q_DESC_MODE) -+#define BIT_SET_P0HI3Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI3Q_DESC_MODE(x) | BIT_P0HI3Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI3Q_DESC_NUM 16 -+#define BIT_MASK_P0HI3Q_DESC_NUM 0xfff -+#define BIT_P0HI3Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI3Q_DESC_NUM) << BIT_SHIFT_P0HI3Q_DESC_NUM) -+#define BITS_P0HI3Q_DESC_NUM \ -+ (BIT_MASK_P0HI3Q_DESC_NUM << BIT_SHIFT_P0HI3Q_DESC_NUM) -+#define BIT_CLEAR_P0HI3Q_DESC_NUM(x) ((x) & (~BITS_P0HI3Q_DESC_NUM)) -+#define BIT_GET_P0HI3Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI3Q_DESC_NUM) & BIT_MASK_P0HI3Q_DESC_NUM) -+#define BIT_SET_P0HI3Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI3Q_DESC_NUM(x) | BIT_P0HI3Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI2Q_TXBD_NUM (Offset 0x0390) */ -+ -+#define BIT_HI2Q_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI2Q_HI3Q_TXBD_NUM (Offset 0x0390) */ -+ -+#define BIT_P0HI2Q_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI2Q_TXBD_NUM (Offset 0x0390) */ -+ -+#define BIT_SHIFT_HI2Q_DESC_MODE 12 -+#define BIT_MASK_HI2Q_DESC_MODE 0x3 -+#define BIT_HI2Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_MODE) << BIT_SHIFT_HI2Q_DESC_MODE) -+#define BITS_HI2Q_DESC_MODE \ -+ (BIT_MASK_HI2Q_DESC_MODE << BIT_SHIFT_HI2Q_DESC_MODE) -+#define BIT_CLEAR_HI2Q_DESC_MODE(x) ((x) & (~BITS_HI2Q_DESC_MODE)) -+#define BIT_GET_HI2Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_MODE) & BIT_MASK_HI2Q_DESC_MODE) -+#define BIT_SET_HI2Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_MODE(x) | BIT_HI2Q_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI2Q_HI3Q_TXBD_NUM (Offset 0x0390) */ -+ -+#define BIT_SHIFT_P0HI2Q_DESC_MODE 12 -+#define BIT_MASK_P0HI2Q_DESC_MODE 0x3 -+#define BIT_P0HI2Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI2Q_DESC_MODE) << BIT_SHIFT_P0HI2Q_DESC_MODE) -+#define BITS_P0HI2Q_DESC_MODE \ -+ (BIT_MASK_P0HI2Q_DESC_MODE << BIT_SHIFT_P0HI2Q_DESC_MODE) -+#define BIT_CLEAR_P0HI2Q_DESC_MODE(x) ((x) & (~BITS_P0HI2Q_DESC_MODE)) -+#define BIT_GET_P0HI2Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI2Q_DESC_MODE) & BIT_MASK_P0HI2Q_DESC_MODE) -+#define BIT_SET_P0HI2Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI2Q_DESC_MODE(x) | BIT_P0HI2Q_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI2Q_TXBD_NUM (Offset 0x0390) */ -+ -+#define BIT_SHIFT_HI2Q_DESC_NUM 0 -+#define BIT_MASK_HI2Q_DESC_NUM 0xfff -+#define BIT_HI2Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_NUM) << BIT_SHIFT_HI2Q_DESC_NUM) -+#define BITS_HI2Q_DESC_NUM (BIT_MASK_HI2Q_DESC_NUM << BIT_SHIFT_HI2Q_DESC_NUM) -+#define BIT_CLEAR_HI2Q_DESC_NUM(x) ((x) & (~BITS_HI2Q_DESC_NUM)) -+#define BIT_GET_HI2Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_NUM) & BIT_MASK_HI2Q_DESC_NUM) -+#define BIT_SET_HI2Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_NUM(x) | BIT_HI2Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI2Q_HI3Q_TXBD_NUM (Offset 0x0390) */ -+ -+#define BIT_SHIFT_P0HI2Q_DESC_NUM 0 -+#define BIT_MASK_P0HI2Q_DESC_NUM 0xfff -+#define BIT_P0HI2Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI2Q_DESC_NUM) << BIT_SHIFT_P0HI2Q_DESC_NUM) -+#define BITS_P0HI2Q_DESC_NUM \ -+ (BIT_MASK_P0HI2Q_DESC_NUM << BIT_SHIFT_P0HI2Q_DESC_NUM) -+#define BIT_CLEAR_P0HI2Q_DESC_NUM(x) ((x) & (~BITS_P0HI2Q_DESC_NUM)) -+#define BIT_GET_P0HI2Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI2Q_DESC_NUM) & BIT_MASK_P0HI2Q_DESC_NUM) -+#define BIT_SET_P0HI2Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI2Q_DESC_NUM(x) | BIT_P0HI2Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI3Q_TXBD_NUM (Offset 0x0392) */ -+ -+#define BIT_HI3Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI3Q_DESC_MODE 12 -+#define BIT_MASK_HI3Q_DESC_MODE 0x3 -+#define BIT_HI3Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_MODE) << BIT_SHIFT_HI3Q_DESC_MODE) -+#define BITS_HI3Q_DESC_MODE \ -+ (BIT_MASK_HI3Q_DESC_MODE << BIT_SHIFT_HI3Q_DESC_MODE) -+#define BIT_CLEAR_HI3Q_DESC_MODE(x) ((x) & (~BITS_HI3Q_DESC_MODE)) -+#define BIT_GET_HI3Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_MODE) & BIT_MASK_HI3Q_DESC_MODE) -+#define BIT_SET_HI3Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_MODE(x) | BIT_HI3Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI3Q_DESC_NUM 0 -+#define BIT_MASK_HI3Q_DESC_NUM 0xfff -+#define BIT_HI3Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_NUM) << BIT_SHIFT_HI3Q_DESC_NUM) -+#define BITS_HI3Q_DESC_NUM (BIT_MASK_HI3Q_DESC_NUM << BIT_SHIFT_HI3Q_DESC_NUM) -+#define BIT_CLEAR_HI3Q_DESC_NUM(x) ((x) & (~BITS_HI3Q_DESC_NUM)) -+#define BIT_GET_HI3Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_NUM) & BIT_MASK_HI3Q_DESC_NUM) -+#define BIT_SET_HI3Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_NUM(x) | BIT_HI3Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI4Q_HI5Q_TXBD_NUM (Offset 0x0394) */ -+ -+#define BIT_P0HI5Q_FLAG BIT(30) -+ -+#define BIT_SHIFT_P0HI5Q_DESC_MODE 28 -+#define BIT_MASK_P0HI5Q_DESC_MODE 0x3 -+#define BIT_P0HI5Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI5Q_DESC_MODE) << BIT_SHIFT_P0HI5Q_DESC_MODE) -+#define BITS_P0HI5Q_DESC_MODE \ -+ (BIT_MASK_P0HI5Q_DESC_MODE << BIT_SHIFT_P0HI5Q_DESC_MODE) -+#define BIT_CLEAR_P0HI5Q_DESC_MODE(x) ((x) & (~BITS_P0HI5Q_DESC_MODE)) -+#define BIT_GET_P0HI5Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI5Q_DESC_MODE) & BIT_MASK_P0HI5Q_DESC_MODE) -+#define BIT_SET_P0HI5Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI5Q_DESC_MODE(x) | BIT_P0HI5Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI5Q_DESC_NUM 16 -+#define BIT_MASK_P0HI5Q_DESC_NUM 0xfff -+#define BIT_P0HI5Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI5Q_DESC_NUM) << BIT_SHIFT_P0HI5Q_DESC_NUM) -+#define BITS_P0HI5Q_DESC_NUM \ -+ (BIT_MASK_P0HI5Q_DESC_NUM << BIT_SHIFT_P0HI5Q_DESC_NUM) -+#define BIT_CLEAR_P0HI5Q_DESC_NUM(x) ((x) & (~BITS_P0HI5Q_DESC_NUM)) -+#define BIT_GET_P0HI5Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI5Q_DESC_NUM) & BIT_MASK_P0HI5Q_DESC_NUM) -+#define BIT_SET_P0HI5Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI5Q_DESC_NUM(x) | BIT_P0HI5Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI4Q_TXBD_NUM (Offset 0x0394) */ -+ -+#define BIT_HI4Q_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI4Q_HI5Q_TXBD_NUM (Offset 0x0394) */ -+ -+#define BIT_P0HI4Q_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI4Q_TXBD_NUM (Offset 0x0394) */ -+ -+#define BIT_SHIFT_HI4Q_DESC_MODE 12 -+#define BIT_MASK_HI4Q_DESC_MODE 0x3 -+#define BIT_HI4Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_MODE) << BIT_SHIFT_HI4Q_DESC_MODE) -+#define BITS_HI4Q_DESC_MODE \ -+ (BIT_MASK_HI4Q_DESC_MODE << BIT_SHIFT_HI4Q_DESC_MODE) -+#define BIT_CLEAR_HI4Q_DESC_MODE(x) ((x) & (~BITS_HI4Q_DESC_MODE)) -+#define BIT_GET_HI4Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_MODE) & BIT_MASK_HI4Q_DESC_MODE) -+#define BIT_SET_HI4Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_MODE(x) | BIT_HI4Q_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI4Q_HI5Q_TXBD_NUM (Offset 0x0394) */ -+ -+#define BIT_SHIFT_P0HI4Q_DESC_MODE 12 -+#define BIT_MASK_P0HI4Q_DESC_MODE 0x3 -+#define BIT_P0HI4Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI4Q_DESC_MODE) << BIT_SHIFT_P0HI4Q_DESC_MODE) -+#define BITS_P0HI4Q_DESC_MODE \ -+ (BIT_MASK_P0HI4Q_DESC_MODE << BIT_SHIFT_P0HI4Q_DESC_MODE) -+#define BIT_CLEAR_P0HI4Q_DESC_MODE(x) ((x) & (~BITS_P0HI4Q_DESC_MODE)) -+#define BIT_GET_P0HI4Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI4Q_DESC_MODE) & BIT_MASK_P0HI4Q_DESC_MODE) -+#define BIT_SET_P0HI4Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI4Q_DESC_MODE(x) | BIT_P0HI4Q_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI4Q_TXBD_NUM (Offset 0x0394) */ -+ -+#define BIT_SHIFT_HI4Q_DESC_NUM 0 -+#define BIT_MASK_HI4Q_DESC_NUM 0xfff -+#define BIT_HI4Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_NUM) << BIT_SHIFT_HI4Q_DESC_NUM) -+#define BITS_HI4Q_DESC_NUM (BIT_MASK_HI4Q_DESC_NUM << BIT_SHIFT_HI4Q_DESC_NUM) -+#define BIT_CLEAR_HI4Q_DESC_NUM(x) ((x) & (~BITS_HI4Q_DESC_NUM)) -+#define BIT_GET_HI4Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_NUM) & BIT_MASK_HI4Q_DESC_NUM) -+#define BIT_SET_HI4Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_NUM(x) | BIT_HI4Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI4Q_HI5Q_TXBD_NUM (Offset 0x0394) */ -+ -+#define BIT_SHIFT_P0HI4Q_DESC_NUM 0 -+#define BIT_MASK_P0HI4Q_DESC_NUM 0xfff -+#define BIT_P0HI4Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI4Q_DESC_NUM) << BIT_SHIFT_P0HI4Q_DESC_NUM) -+#define BITS_P0HI4Q_DESC_NUM \ -+ (BIT_MASK_P0HI4Q_DESC_NUM << BIT_SHIFT_P0HI4Q_DESC_NUM) -+#define BIT_CLEAR_P0HI4Q_DESC_NUM(x) ((x) & (~BITS_P0HI4Q_DESC_NUM)) -+#define BIT_GET_P0HI4Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI4Q_DESC_NUM) & BIT_MASK_P0HI4Q_DESC_NUM) -+#define BIT_SET_P0HI4Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI4Q_DESC_NUM(x) | BIT_P0HI4Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI5Q_TXBD_NUM (Offset 0x0396) */ -+ -+#define BIT_HI5Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI5Q_DESC_MODE 12 -+#define BIT_MASK_HI5Q_DESC_MODE 0x3 -+#define BIT_HI5Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_MODE) << BIT_SHIFT_HI5Q_DESC_MODE) -+#define BITS_HI5Q_DESC_MODE \ -+ (BIT_MASK_HI5Q_DESC_MODE << BIT_SHIFT_HI5Q_DESC_MODE) -+#define BIT_CLEAR_HI5Q_DESC_MODE(x) ((x) & (~BITS_HI5Q_DESC_MODE)) -+#define BIT_GET_HI5Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_MODE) & BIT_MASK_HI5Q_DESC_MODE) -+#define BIT_SET_HI5Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_MODE(x) | BIT_HI5Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI5Q_DESC_NUM 0 -+#define BIT_MASK_HI5Q_DESC_NUM 0xfff -+#define BIT_HI5Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_NUM) << BIT_SHIFT_HI5Q_DESC_NUM) -+#define BITS_HI5Q_DESC_NUM (BIT_MASK_HI5Q_DESC_NUM << BIT_SHIFT_HI5Q_DESC_NUM) -+#define BIT_CLEAR_HI5Q_DESC_NUM(x) ((x) & (~BITS_HI5Q_DESC_NUM)) -+#define BIT_GET_HI5Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_NUM) & BIT_MASK_HI5Q_DESC_NUM) -+#define BIT_SET_HI5Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_NUM(x) | BIT_HI5Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI6Q_HI7Q_TXBD_NUM (Offset 0x0398) */ -+ -+#define BIT_P0HI7Q_FLAG BIT(30) -+#define BIT_CLR_FWCMDQ_HW_IDX BIT(30) -+#define BIT_CLR_P0HI7Q_HW_IDX BIT(29) -+ -+#define BIT_SHIFT_P0HI7Q_DESC_MODE 28 -+#define BIT_MASK_P0HI7Q_DESC_MODE 0x3 -+#define BIT_P0HI7Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI7Q_DESC_MODE) << BIT_SHIFT_P0HI7Q_DESC_MODE) -+#define BITS_P0HI7Q_DESC_MODE \ -+ (BIT_MASK_P0HI7Q_DESC_MODE << BIT_SHIFT_P0HI7Q_DESC_MODE) -+#define BIT_CLEAR_P0HI7Q_DESC_MODE(x) ((x) & (~BITS_P0HI7Q_DESC_MODE)) -+#define BIT_GET_P0HI7Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI7Q_DESC_MODE) & BIT_MASK_P0HI7Q_DESC_MODE) -+#define BIT_SET_P0HI7Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI7Q_DESC_MODE(x) | BIT_P0HI7Q_DESC_MODE(v)) -+ -+#define BIT_CLR_P0HI6Q_HW_IDX BIT(28) -+#define BIT_CLR_P0HI5Q_HW_IDX BIT(27) -+#define BIT_CLR_P0HI4Q_HW_IDX BIT(26) -+#define BIT_CLR_P0HI3Q_HW_IDX BIT(25) -+#define BIT_CLR_P0HI2Q_HW_IDX BIT(24) -+#define BIT_CLR_P0HI1Q_HW_IDX BIT(23) -+#define BIT_CLR_P0HI0Q_HW_IDX BIT(22) -+#define BIT_CLR_ACH3_HW_IDX BIT(21) -+#define BIT_CLR_ACH2_HW_IDX BIT(20) -+#define BIT_CLR_ACH1_HW_IDX BIT(19) -+#define BIT_CLR_ACH0_HW_IDX BIT(18) -+#define BIT_CLR_P0MGQ_HW_IDX BIT(17) -+ -+#define BIT_SHIFT_P0HI7Q_DESC_NUM 16 -+#define BIT_MASK_P0HI7Q_DESC_NUM 0xfff -+#define BIT_P0HI7Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI7Q_DESC_NUM) << BIT_SHIFT_P0HI7Q_DESC_NUM) -+#define BITS_P0HI7Q_DESC_NUM \ -+ (BIT_MASK_P0HI7Q_DESC_NUM << BIT_SHIFT_P0HI7Q_DESC_NUM) -+#define BIT_CLEAR_P0HI7Q_DESC_NUM(x) ((x) & (~BITS_P0HI7Q_DESC_NUM)) -+#define BIT_GET_P0HI7Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI7Q_DESC_NUM) & BIT_MASK_P0HI7Q_DESC_NUM) -+#define BIT_SET_P0HI7Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI7Q_DESC_NUM(x) | BIT_P0HI7Q_DESC_NUM(v)) -+ -+#define BIT_CLR_P0RXQ_HW_IDX BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI6Q_TXBD_NUM (Offset 0x0398) */ -+ -+#define BIT_HI6Q_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI6Q_HI7Q_TXBD_NUM (Offset 0x0398) */ -+ -+#define BIT_P0HI6Q_FLAG BIT(14) -+#define BIT_CLR_PFWCMDQ_HOST_IDX BIT(14) -+#define BIT_CLR_P0HI7Q_HOST_IDX BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI6Q_TXBD_NUM (Offset 0x0398) */ -+ -+#define BIT_SHIFT_HI6Q_DESC_MODE 12 -+#define BIT_MASK_HI6Q_DESC_MODE 0x3 -+#define BIT_HI6Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_MODE) << BIT_SHIFT_HI6Q_DESC_MODE) -+#define BITS_HI6Q_DESC_MODE \ -+ (BIT_MASK_HI6Q_DESC_MODE << BIT_SHIFT_HI6Q_DESC_MODE) -+#define BIT_CLEAR_HI6Q_DESC_MODE(x) ((x) & (~BITS_HI6Q_DESC_MODE)) -+#define BIT_GET_HI6Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_MODE) & BIT_MASK_HI6Q_DESC_MODE) -+#define BIT_SET_HI6Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_MODE(x) | BIT_HI6Q_DESC_MODE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI6Q_HI7Q_TXBD_NUM (Offset 0x0398) */ -+ -+#define BIT_SHIFT_P0HI6Q_DESC_MODE 12 -+#define BIT_MASK_P0HI6Q_DESC_MODE 0x3 -+#define BIT_P0HI6Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI6Q_DESC_MODE) << BIT_SHIFT_P0HI6Q_DESC_MODE) -+#define BITS_P0HI6Q_DESC_MODE \ -+ (BIT_MASK_P0HI6Q_DESC_MODE << BIT_SHIFT_P0HI6Q_DESC_MODE) -+#define BIT_CLEAR_P0HI6Q_DESC_MODE(x) ((x) & (~BITS_P0HI6Q_DESC_MODE)) -+#define BIT_GET_P0HI6Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI6Q_DESC_MODE) & BIT_MASK_P0HI6Q_DESC_MODE) -+#define BIT_SET_P0HI6Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI6Q_DESC_MODE(x) | BIT_P0HI6Q_DESC_MODE(v)) -+ -+#define BIT_CLR_P0HI6Q_HOST_IDX BIT(12) -+#define BIT_CLR_P0HI5Q_HOST_IDX BIT(11) -+#define BIT_CLR_P0HI4Q_HOST_IDX BIT(10) -+#define BIT_CLR_P0HI3Q_HOST_IDX BIT(9) -+#define BIT_CLR_P0HI2Q_HOST_IDX BIT(8) -+#define BIT_CLR_P0HI1Q_HOST_IDX BIT(7) -+#define BIT_CLR_P0HI0Q_HOST_IDX BIT(6) -+#define BIT_CLR_ACH3_HOST_IDX BIT(5) -+#define BIT_CLR_ACH2_HOST_IDX BIT(4) -+#define BIT_CLR_ACH1_HOST_IDX BIT(3) -+#define BIT_CLR_ACH0_HOST_IDX BIT(2) -+#define BIT_CLR_P0MGQ_HOST_IDX BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI6Q_TXBD_NUM (Offset 0x0398) */ -+ -+#define BIT_SHIFT_HI6Q_DESC_NUM 0 -+#define BIT_MASK_HI6Q_DESC_NUM 0xfff -+#define BIT_HI6Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_NUM) << BIT_SHIFT_HI6Q_DESC_NUM) -+#define BITS_HI6Q_DESC_NUM (BIT_MASK_HI6Q_DESC_NUM << BIT_SHIFT_HI6Q_DESC_NUM) -+#define BIT_CLEAR_HI6Q_DESC_NUM(x) ((x) & (~BITS_HI6Q_DESC_NUM)) -+#define BIT_GET_HI6Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_NUM) & BIT_MASK_HI6Q_DESC_NUM) -+#define BIT_SET_HI6Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_NUM(x) | BIT_HI6Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI6Q_HI7Q_TXBD_NUM (Offset 0x0398) */ -+ -+#define BIT_SHIFT_P0HI6Q_DESC_NUM 0 -+#define BIT_MASK_P0HI6Q_DESC_NUM 0xfff -+#define BIT_P0HI6Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI6Q_DESC_NUM) << BIT_SHIFT_P0HI6Q_DESC_NUM) -+#define BITS_P0HI6Q_DESC_NUM \ -+ (BIT_MASK_P0HI6Q_DESC_NUM << BIT_SHIFT_P0HI6Q_DESC_NUM) -+#define BIT_CLEAR_P0HI6Q_DESC_NUM(x) ((x) & (~BITS_P0HI6Q_DESC_NUM)) -+#define BIT_GET_P0HI6Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI6Q_DESC_NUM) & BIT_MASK_P0HI6Q_DESC_NUM) -+#define BIT_SET_P0HI6Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI6Q_DESC_NUM(x) | BIT_P0HI6Q_DESC_NUM(v)) -+ -+#define BIT_CLR_P0RXQ_HOST_IDX BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI7Q_TXBD_NUM (Offset 0x039A) */ -+ -+#define BIT_HI7Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI7Q_DESC_MODE 12 -+#define BIT_MASK_HI7Q_DESC_MODE 0x3 -+#define BIT_HI7Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_MODE) << BIT_SHIFT_HI7Q_DESC_MODE) -+#define BITS_HI7Q_DESC_MODE \ -+ (BIT_MASK_HI7Q_DESC_MODE << BIT_SHIFT_HI7Q_DESC_MODE) -+#define BIT_CLEAR_HI7Q_DESC_MODE(x) ((x) & (~BITS_HI7Q_DESC_MODE)) -+#define BIT_GET_HI7Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_MODE) & BIT_MASK_HI7Q_DESC_MODE) -+#define BIT_SET_HI7Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_MODE(x) | BIT_HI7Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI7Q_DESC_NUM 0 -+#define BIT_MASK_HI7Q_DESC_NUM 0xfff -+#define BIT_HI7Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_NUM) << BIT_SHIFT_HI7Q_DESC_NUM) -+#define BITS_HI7Q_DESC_NUM (BIT_MASK_HI7Q_DESC_NUM << BIT_SHIFT_HI7Q_DESC_NUM) -+#define BIT_CLEAR_HI7Q_DESC_NUM(x) ((x) & (~BITS_HI7Q_DESC_NUM)) -+#define BIT_GET_HI7Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_NUM) & BIT_MASK_HI7Q_DESC_NUM) -+#define BIT_SET_HI7Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_NUM(x) | BIT_HI7Q_DESC_NUM(v)) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_HI7Q_HW_IDX BIT(29) -+#define BIT_CLR_HI6Q_HW_IDX BIT(28) -+#define BIT_CLR_HI5Q_HW_IDX BIT(27) -+#define BIT_CLR_HI4Q_HW_IDX BIT(26) -+#define BIT_CLR_HI3Q_HW_IDX BIT(25) -+#define BIT_CLR_HI2Q_HW_IDX BIT(24) -+#define BIT_CLR_HI1Q_HW_IDX BIT(23) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_BCN7DOK BIT(23) -+#define BIT_BCN7DOKM BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_HI0Q_HW_IDX BIT(22) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_BCN6DOK BIT(22) -+#define BIT_BCN6DOKM BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_BKQ_HW_IDX BIT(21) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_BCN5DOK BIT(21) -+#define BIT_BCN5DOKM BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_BEQ_HW_IDX BIT(20) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_BCN4DOK BIT(20) -+#define BIT_BCN4DOKM BIT(20) -+#define BIT_RX_OVER_RD_ERR BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_VIQ_HW_IDX BIT(19) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_BCN3DOK BIT(19) -+#define BIT_BCN3DOKM BIT(19) -+#define BIT_RXDMA_STUCK BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_VOQ_HW_IDX BIT(18) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_BCN2DOK BIT(18) -+#define BIT_BCN2DOKM BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_MGQ_HW_IDX BIT(17) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_BCN1DOK BIT(17) -+#define BIT_BCN1DOKM BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TSFTIMER_HCI (Offset 0x039C) */ -+ -+#define BIT_SHIFT_TSFT2_HCI 16 -+#define BIT_MASK_TSFT2_HCI 0xffff -+#define BIT_TSFT2_HCI(x) (((x) & BIT_MASK_TSFT2_HCI) << BIT_SHIFT_TSFT2_HCI) -+#define BITS_TSFT2_HCI (BIT_MASK_TSFT2_HCI << BIT_SHIFT_TSFT2_HCI) -+#define BIT_CLEAR_TSFT2_HCI(x) ((x) & (~BITS_TSFT2_HCI)) -+#define BIT_GET_TSFT2_HCI(x) (((x) >> BIT_SHIFT_TSFT2_HCI) & BIT_MASK_TSFT2_HCI) -+#define BIT_SET_TSFT2_HCI(x, v) (BIT_CLEAR_TSFT2_HCI(x) | BIT_TSFT2_HCI(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_RXQ_HW_IDX BIT(16) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_BCN0DOK BIT(16) -+#define BIT_BCN0DOKM BIT(16) -+ -+#define BIT_SHIFT_RX_STATE 16 -+#define BIT_MASK_RX_STATE 0x7 -+#define BIT_RX_STATE(x) (((x) & BIT_MASK_RX_STATE) << BIT_SHIFT_RX_STATE) -+#define BITS_RX_STATE (BIT_MASK_RX_STATE << BIT_SHIFT_RX_STATE) -+#define BIT_CLEAR_RX_STATE(x) ((x) & (~BITS_RX_STATE)) -+#define BIT_GET_RX_STATE(x) (((x) >> BIT_SHIFT_RX_STATE) & BIT_MASK_RX_STATE) -+#define BIT_SET_RX_STATE(x, v) (BIT_CLEAR_RX_STATE(x) | BIT_RX_STATE(v)) -+ -+#define BIT_SRST_TX BIT(15) -+#define BIT_M7DOK BIT(15) -+#define BIT_M7DOKM BIT(15) -+#define BIT_TDE_NO_IDLE BIT(15) -+#define BIT_SRST_RX BIT(14) -+#define BIT_M6DOK BIT(14) -+#define BIT_M6DOKM BIT(14) -+#define BIT_TXDMA_STUCK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_HI7Q_HOST_IDX BIT(13) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_M5DOK BIT(13) -+#define BIT_M5DOKM BIT(13) -+#define BIT_TDE_FULL_ERR BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_HI6Q_HOST_IDX BIT(12) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_M4DOK BIT(12) -+#define BIT_M4DOKM BIT(12) -+#define BIT_HD_SIZE_ERR BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_HI5Q_HOST_IDX BIT(11) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_M3DOK BIT(11) -+#define BIT_M3DOKM BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_HI4Q_HOST_IDX BIT(10) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_M2DOK BIT(10) -+#define BIT_M2DOKM BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_HI3Q_HOST_IDX BIT(9) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_M1DOK BIT(9) -+#define BIT_M1DOKM BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_HI2Q_HOST_IDX BIT(8) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_M0DOK BIT(8) -+#define BIT_M0DOKM BIT(8) -+ -+#define BIT_SHIFT_TX_STATE 8 -+#define BIT_MASK_TX_STATE 0xf -+#define BIT_TX_STATE(x) (((x) & BIT_MASK_TX_STATE) << BIT_SHIFT_TX_STATE) -+#define BITS_TX_STATE (BIT_MASK_TX_STATE << BIT_SHIFT_TX_STATE) -+#define BIT_CLEAR_TX_STATE(x) ((x) & (~BITS_TX_STATE)) -+#define BIT_GET_TX_STATE(x) (((x) >> BIT_SHIFT_TX_STATE) & BIT_MASK_TX_STATE) -+#define BIT_SET_TX_STATE(x, v) (BIT_CLEAR_TX_STATE(x) | BIT_TX_STATE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_HI1Q_HOST_IDX BIT(7) -+#define BIT_CLR_HI0Q_HOST_IDX BIT(6) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_MGQDOK BIT(6) -+#define BIT_MGQDOKM BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_BKQ_HOST_IDX BIT(5) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_BKQDOK BIT(5) -+#define BIT_BKQDOKM BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_BEQ_HOST_IDX BIT(4) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_SHIFT_HPS_CLKR 4 -+#define BIT_MASK_HPS_CLKR 0x3 -+#define BIT_HPS_CLKR(x) (((x) & BIT_MASK_HPS_CLKR) << BIT_SHIFT_HPS_CLKR) -+#define BITS_HPS_CLKR (BIT_MASK_HPS_CLKR << BIT_SHIFT_HPS_CLKR) -+#define BIT_CLEAR_HPS_CLKR(x) ((x) & (~BITS_HPS_CLKR)) -+#define BIT_GET_HPS_CLKR(x) (((x) >> BIT_SHIFT_HPS_CLKR) & BIT_MASK_HPS_CLKR) -+#define BIT_SET_HPS_CLKR(x, v) (BIT_CLEAR_HPS_CLKR(x) | BIT_HPS_CLKR(v)) -+ -+#define BIT_BEQDOK BIT(4) -+#define BIT_BEQDOKM BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_VIQ_HOST_IDX BIT(3) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_LX_INT BIT(3) -+#define BIT_VIQDOK BIT(3) -+#define BIT_VIQDOKM BIT(3) -+#define BIT_MST_BUSY BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_VOQ_HOST_IDX BIT(2) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_VOQDOK BIT(2) -+#define BIT_VOQDOKM BIT(2) -+#define BIT_SLV_BUSY BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_MGQ_HOST_IDX BIT(1) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_RDUM BIT(1) -+#define BIT_RXDES_UNAVAIL BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TSFTIMER_HCI (Offset 0x039C) */ -+ -+#define BIT_SHIFT_TSFT1_HCI 0 -+#define BIT_MASK_TSFT1_HCI 0xffff -+#define BIT_TSFT1_HCI(x) (((x) & BIT_MASK_TSFT1_HCI) << BIT_SHIFT_TSFT1_HCI) -+#define BITS_TSFT1_HCI (BIT_MASK_TSFT1_HCI << BIT_SHIFT_TSFT1_HCI) -+#define BIT_CLEAR_TSFT1_HCI(x) ((x) & (~BITS_TSFT1_HCI)) -+#define BIT_GET_TSFT1_HCI(x) (((x) >> BIT_SHIFT_TSFT1_HCI) & BIT_MASK_TSFT1_HCI) -+#define BIT_SET_TSFT1_HCI(x, v) (BIT_CLEAR_TSFT1_HCI(x) | BIT_TSFT1_HCI(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_CLR_RXQ_HOST_IDX BIT(0) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BD_RWPTR_CLR (Offset 0x039C) */ -+ -+#define BIT_RXDOK BIT(0) -+#define BIT_RXDOKM BIT(0) -+#define BIT_EN_DBG_STUCK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_VOQ_TXBD_IDX (Offset 0x03A0) */ -+ -+#define BIT_SHIFT_VOQ_HW_IDX 16 -+#define BIT_MASK_VOQ_HW_IDX 0xfff -+#define BIT_VOQ_HW_IDX(x) (((x) & BIT_MASK_VOQ_HW_IDX) << BIT_SHIFT_VOQ_HW_IDX) -+#define BITS_VOQ_HW_IDX (BIT_MASK_VOQ_HW_IDX << BIT_SHIFT_VOQ_HW_IDX) -+#define BIT_CLEAR_VOQ_HW_IDX(x) ((x) & (~BITS_VOQ_HW_IDX)) -+#define BIT_GET_VOQ_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HW_IDX) & BIT_MASK_VOQ_HW_IDX) -+#define BIT_SET_VOQ_HW_IDX(x, v) (BIT_CLEAR_VOQ_HW_IDX(x) | BIT_VOQ_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH0_TXBD_IDX (Offset 0x03A0) */ -+ -+#define BIT_SHIFT_ACH0_HW_IDX 16 -+#define BIT_MASK_ACH0_HW_IDX 0xfff -+#define BIT_ACH0_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH0_HW_IDX) << BIT_SHIFT_ACH0_HW_IDX) -+#define BITS_ACH0_HW_IDX (BIT_MASK_ACH0_HW_IDX << BIT_SHIFT_ACH0_HW_IDX) -+#define BIT_CLEAR_ACH0_HW_IDX(x) ((x) & (~BITS_ACH0_HW_IDX)) -+#define BIT_GET_ACH0_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH0_HW_IDX) & BIT_MASK_ACH0_HW_IDX) -+#define BIT_SET_ACH0_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH0_HW_IDX(x) | BIT_ACH0_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_VOQ_TXBD_IDX (Offset 0x03A0) */ -+ -+#define BIT_SHIFT_VOQ_HOST_IDX 0 -+#define BIT_MASK_VOQ_HOST_IDX 0xfff -+#define BIT_VOQ_HOST_IDX(x) \ -+ (((x) & BIT_MASK_VOQ_HOST_IDX) << BIT_SHIFT_VOQ_HOST_IDX) -+#define BITS_VOQ_HOST_IDX (BIT_MASK_VOQ_HOST_IDX << BIT_SHIFT_VOQ_HOST_IDX) -+#define BIT_CLEAR_VOQ_HOST_IDX(x) ((x) & (~BITS_VOQ_HOST_IDX)) -+#define BIT_GET_VOQ_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HOST_IDX) & BIT_MASK_VOQ_HOST_IDX) -+#define BIT_SET_VOQ_HOST_IDX(x, v) \ -+ (BIT_CLEAR_VOQ_HOST_IDX(x) | BIT_VOQ_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH0_TXBD_IDX (Offset 0x03A0) */ -+ -+#define BIT_SHIFT_ACH0_HOST_IDX 0 -+#define BIT_MASK_ACH0_HOST_IDX 0xfff -+#define BIT_ACH0_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH0_HOST_IDX) << BIT_SHIFT_ACH0_HOST_IDX) -+#define BITS_ACH0_HOST_IDX (BIT_MASK_ACH0_HOST_IDX << BIT_SHIFT_ACH0_HOST_IDX) -+#define BIT_CLEAR_ACH0_HOST_IDX(x) ((x) & (~BITS_ACH0_HOST_IDX)) -+#define BIT_GET_ACH0_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH0_HOST_IDX) & BIT_MASK_ACH0_HOST_IDX) -+#define BIT_SET_ACH0_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH0_HOST_IDX(x) | BIT_ACH0_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_VIQ_TXBD_IDX (Offset 0x03A4) */ -+ -+#define BIT_SHIFT_VIQ_HW_IDX 16 -+#define BIT_MASK_VIQ_HW_IDX 0xfff -+#define BIT_VIQ_HW_IDX(x) (((x) & BIT_MASK_VIQ_HW_IDX) << BIT_SHIFT_VIQ_HW_IDX) -+#define BITS_VIQ_HW_IDX (BIT_MASK_VIQ_HW_IDX << BIT_SHIFT_VIQ_HW_IDX) -+#define BIT_CLEAR_VIQ_HW_IDX(x) ((x) & (~BITS_VIQ_HW_IDX)) -+#define BIT_GET_VIQ_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HW_IDX) & BIT_MASK_VIQ_HW_IDX) -+#define BIT_SET_VIQ_HW_IDX(x, v) (BIT_CLEAR_VIQ_HW_IDX(x) | BIT_VIQ_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH1_TXBD_IDX (Offset 0x03A4) */ -+ -+#define BIT_SHIFT_ACH1_HW_IDX 16 -+#define BIT_MASK_ACH1_HW_IDX 0xfff -+#define BIT_ACH1_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH1_HW_IDX) << BIT_SHIFT_ACH1_HW_IDX) -+#define BITS_ACH1_HW_IDX (BIT_MASK_ACH1_HW_IDX << BIT_SHIFT_ACH1_HW_IDX) -+#define BIT_CLEAR_ACH1_HW_IDX(x) ((x) & (~BITS_ACH1_HW_IDX)) -+#define BIT_GET_ACH1_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH1_HW_IDX) & BIT_MASK_ACH1_HW_IDX) -+#define BIT_SET_ACH1_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH1_HW_IDX(x) | BIT_ACH1_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_VIQ_TXBD_IDX (Offset 0x03A4) */ -+ -+#define BIT_SHIFT_VIQ_HOST_IDX 0 -+#define BIT_MASK_VIQ_HOST_IDX 0xfff -+#define BIT_VIQ_HOST_IDX(x) \ -+ (((x) & BIT_MASK_VIQ_HOST_IDX) << BIT_SHIFT_VIQ_HOST_IDX) -+#define BITS_VIQ_HOST_IDX (BIT_MASK_VIQ_HOST_IDX << BIT_SHIFT_VIQ_HOST_IDX) -+#define BIT_CLEAR_VIQ_HOST_IDX(x) ((x) & (~BITS_VIQ_HOST_IDX)) -+#define BIT_GET_VIQ_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HOST_IDX) & BIT_MASK_VIQ_HOST_IDX) -+#define BIT_SET_VIQ_HOST_IDX(x, v) \ -+ (BIT_CLEAR_VIQ_HOST_IDX(x) | BIT_VIQ_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH1_TXBD_IDX (Offset 0x03A4) */ -+ -+#define BIT_SHIFT_ACH1_HOST_IDX 0 -+#define BIT_MASK_ACH1_HOST_IDX 0xfff -+#define BIT_ACH1_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH1_HOST_IDX) << BIT_SHIFT_ACH1_HOST_IDX) -+#define BITS_ACH1_HOST_IDX (BIT_MASK_ACH1_HOST_IDX << BIT_SHIFT_ACH1_HOST_IDX) -+#define BIT_CLEAR_ACH1_HOST_IDX(x) ((x) & (~BITS_ACH1_HOST_IDX)) -+#define BIT_GET_ACH1_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH1_HOST_IDX) & BIT_MASK_ACH1_HOST_IDX) -+#define BIT_SET_ACH1_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH1_HOST_IDX(x) | BIT_ACH1_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BEQ_TXBD_IDX (Offset 0x03A8) */ -+ -+#define BIT_SHIFT_BEQ_HW_IDX 16 -+#define BIT_MASK_BEQ_HW_IDX 0xfff -+#define BIT_BEQ_HW_IDX(x) (((x) & BIT_MASK_BEQ_HW_IDX) << BIT_SHIFT_BEQ_HW_IDX) -+#define BITS_BEQ_HW_IDX (BIT_MASK_BEQ_HW_IDX << BIT_SHIFT_BEQ_HW_IDX) -+#define BIT_CLEAR_BEQ_HW_IDX(x) ((x) & (~BITS_BEQ_HW_IDX)) -+#define BIT_GET_BEQ_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HW_IDX) & BIT_MASK_BEQ_HW_IDX) -+#define BIT_SET_BEQ_HW_IDX(x, v) (BIT_CLEAR_BEQ_HW_IDX(x) | BIT_BEQ_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH2_TXBD_IDX (Offset 0x03A8) */ -+ -+#define BIT_SHIFT_ACH2_HW_IDX 16 -+#define BIT_MASK_ACH2_HW_IDX 0xfff -+#define BIT_ACH2_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH2_HW_IDX) << BIT_SHIFT_ACH2_HW_IDX) -+#define BITS_ACH2_HW_IDX (BIT_MASK_ACH2_HW_IDX << BIT_SHIFT_ACH2_HW_IDX) -+#define BIT_CLEAR_ACH2_HW_IDX(x) ((x) & (~BITS_ACH2_HW_IDX)) -+#define BIT_GET_ACH2_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH2_HW_IDX) & BIT_MASK_ACH2_HW_IDX) -+#define BIT_SET_ACH2_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH2_HW_IDX(x) | BIT_ACH2_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BEQ_TXBD_IDX (Offset 0x03A8) */ -+ -+#define BIT_SHIFT_BEQ_HOST_IDX 0 -+#define BIT_MASK_BEQ_HOST_IDX 0xfff -+#define BIT_BEQ_HOST_IDX(x) \ -+ (((x) & BIT_MASK_BEQ_HOST_IDX) << BIT_SHIFT_BEQ_HOST_IDX) -+#define BITS_BEQ_HOST_IDX (BIT_MASK_BEQ_HOST_IDX << BIT_SHIFT_BEQ_HOST_IDX) -+#define BIT_CLEAR_BEQ_HOST_IDX(x) ((x) & (~BITS_BEQ_HOST_IDX)) -+#define BIT_GET_BEQ_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HOST_IDX) & BIT_MASK_BEQ_HOST_IDX) -+#define BIT_SET_BEQ_HOST_IDX(x, v) \ -+ (BIT_CLEAR_BEQ_HOST_IDX(x) | BIT_BEQ_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH2_TXBD_IDX (Offset 0x03A8) */ -+ -+#define BIT_SHIFT_ACH2_HOST_IDX 0 -+#define BIT_MASK_ACH2_HOST_IDX 0xfff -+#define BIT_ACH2_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH2_HOST_IDX) << BIT_SHIFT_ACH2_HOST_IDX) -+#define BITS_ACH2_HOST_IDX (BIT_MASK_ACH2_HOST_IDX << BIT_SHIFT_ACH2_HOST_IDX) -+#define BIT_CLEAR_ACH2_HOST_IDX(x) ((x) & (~BITS_ACH2_HOST_IDX)) -+#define BIT_GET_ACH2_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH2_HOST_IDX) & BIT_MASK_ACH2_HOST_IDX) -+#define BIT_SET_ACH2_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH2_HOST_IDX(x) | BIT_ACH2_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BKQ_TXBD_IDX (Offset 0x03AC) */ -+ -+#define BIT_SHIFT_BKQ_HW_IDX 16 -+#define BIT_MASK_BKQ_HW_IDX 0xfff -+#define BIT_BKQ_HW_IDX(x) (((x) & BIT_MASK_BKQ_HW_IDX) << BIT_SHIFT_BKQ_HW_IDX) -+#define BITS_BKQ_HW_IDX (BIT_MASK_BKQ_HW_IDX << BIT_SHIFT_BKQ_HW_IDX) -+#define BIT_CLEAR_BKQ_HW_IDX(x) ((x) & (~BITS_BKQ_HW_IDX)) -+#define BIT_GET_BKQ_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HW_IDX) & BIT_MASK_BKQ_HW_IDX) -+#define BIT_SET_BKQ_HW_IDX(x, v) (BIT_CLEAR_BKQ_HW_IDX(x) | BIT_BKQ_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH3_TXBD_IDX (Offset 0x03AC) */ -+ -+#define BIT_SHIFT_ACH3_HW_IDX 16 -+#define BIT_MASK_ACH3_HW_IDX 0xfff -+#define BIT_ACH3_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH3_HW_IDX) << BIT_SHIFT_ACH3_HW_IDX) -+#define BITS_ACH3_HW_IDX (BIT_MASK_ACH3_HW_IDX << BIT_SHIFT_ACH3_HW_IDX) -+#define BIT_CLEAR_ACH3_HW_IDX(x) ((x) & (~BITS_ACH3_HW_IDX)) -+#define BIT_GET_ACH3_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH3_HW_IDX) & BIT_MASK_ACH3_HW_IDX) -+#define BIT_SET_ACH3_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH3_HW_IDX(x) | BIT_ACH3_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BKQ_TXBD_IDX (Offset 0x03AC) */ -+ -+#define BIT_SHIFT_BKQ_HOST_IDX 0 -+#define BIT_MASK_BKQ_HOST_IDX 0xfff -+#define BIT_BKQ_HOST_IDX(x) \ -+ (((x) & BIT_MASK_BKQ_HOST_IDX) << BIT_SHIFT_BKQ_HOST_IDX) -+#define BITS_BKQ_HOST_IDX (BIT_MASK_BKQ_HOST_IDX << BIT_SHIFT_BKQ_HOST_IDX) -+#define BIT_CLEAR_BKQ_HOST_IDX(x) ((x) & (~BITS_BKQ_HOST_IDX)) -+#define BIT_GET_BKQ_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HOST_IDX) & BIT_MASK_BKQ_HOST_IDX) -+#define BIT_SET_BKQ_HOST_IDX(x, v) \ -+ (BIT_CLEAR_BKQ_HOST_IDX(x) | BIT_BKQ_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH3_TXBD_IDX (Offset 0x03AC) */ -+ -+#define BIT_SHIFT_ACH3_HOST_IDX 0 -+#define BIT_MASK_ACH3_HOST_IDX 0xfff -+#define BIT_ACH3_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH3_HOST_IDX) << BIT_SHIFT_ACH3_HOST_IDX) -+#define BITS_ACH3_HOST_IDX (BIT_MASK_ACH3_HOST_IDX << BIT_SHIFT_ACH3_HOST_IDX) -+#define BIT_CLEAR_ACH3_HOST_IDX(x) ((x) & (~BITS_ACH3_HOST_IDX)) -+#define BIT_GET_ACH3_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH3_HOST_IDX) & BIT_MASK_ACH3_HOST_IDX) -+#define BIT_SET_ACH3_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH3_HOST_IDX(x) | BIT_ACH3_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_TXBD_IDX (Offset 0x03B0) */ -+ -+#define BIT_SHIFT_MGQ_HW_IDX 16 -+#define BIT_MASK_MGQ_HW_IDX 0xfff -+#define BIT_MGQ_HW_IDX(x) (((x) & BIT_MASK_MGQ_HW_IDX) << BIT_SHIFT_MGQ_HW_IDX) -+#define BITS_MGQ_HW_IDX (BIT_MASK_MGQ_HW_IDX << BIT_SHIFT_MGQ_HW_IDX) -+#define BIT_CLEAR_MGQ_HW_IDX(x) ((x) & (~BITS_MGQ_HW_IDX)) -+#define BIT_GET_MGQ_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HW_IDX) & BIT_MASK_MGQ_HW_IDX) -+#define BIT_SET_MGQ_HW_IDX(x, v) (BIT_CLEAR_MGQ_HW_IDX(x) | BIT_MGQ_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0MGQ_TXBD_IDX (Offset 0x03B0) */ -+ -+#define BIT_SHIFT_P0MGQ_HW_IDX 16 -+#define BIT_MASK_P0MGQ_HW_IDX 0xfff -+#define BIT_P0MGQ_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0MGQ_HW_IDX) << BIT_SHIFT_P0MGQ_HW_IDX) -+#define BITS_P0MGQ_HW_IDX (BIT_MASK_P0MGQ_HW_IDX << BIT_SHIFT_P0MGQ_HW_IDX) -+#define BIT_CLEAR_P0MGQ_HW_IDX(x) ((x) & (~BITS_P0MGQ_HW_IDX)) -+#define BIT_GET_P0MGQ_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0MGQ_HW_IDX) & BIT_MASK_P0MGQ_HW_IDX) -+#define BIT_SET_P0MGQ_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0MGQ_HW_IDX(x) | BIT_P0MGQ_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_TXBD_IDX (Offset 0x03B0) */ -+ -+#define BIT_SHIFT_MGQ_HOST_IDX 0 -+#define BIT_MASK_MGQ_HOST_IDX 0xfff -+#define BIT_MGQ_HOST_IDX(x) \ -+ (((x) & BIT_MASK_MGQ_HOST_IDX) << BIT_SHIFT_MGQ_HOST_IDX) -+#define BITS_MGQ_HOST_IDX (BIT_MASK_MGQ_HOST_IDX << BIT_SHIFT_MGQ_HOST_IDX) -+#define BIT_CLEAR_MGQ_HOST_IDX(x) ((x) & (~BITS_MGQ_HOST_IDX)) -+#define BIT_GET_MGQ_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HOST_IDX) & BIT_MASK_MGQ_HOST_IDX) -+#define BIT_SET_MGQ_HOST_IDX(x, v) \ -+ (BIT_CLEAR_MGQ_HOST_IDX(x) | BIT_MGQ_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0MGQ_TXBD_IDX (Offset 0x03B0) */ -+ -+#define BIT_SHIFT_P0MGQ_HOST_IDX 0 -+#define BIT_MASK_P0MGQ_HOST_IDX 0xfff -+#define BIT_P0MGQ_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0MGQ_HOST_IDX) << BIT_SHIFT_P0MGQ_HOST_IDX) -+#define BITS_P0MGQ_HOST_IDX \ -+ (BIT_MASK_P0MGQ_HOST_IDX << BIT_SHIFT_P0MGQ_HOST_IDX) -+#define BIT_CLEAR_P0MGQ_HOST_IDX(x) ((x) & (~BITS_P0MGQ_HOST_IDX)) -+#define BIT_GET_P0MGQ_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0MGQ_HOST_IDX) & BIT_MASK_P0MGQ_HOST_IDX) -+#define BIT_SET_P0MGQ_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0MGQ_HOST_IDX(x) | BIT_P0MGQ_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXQ_RXBD_IDX (Offset 0x03B4) */ -+ -+#define BIT_SHIFT_RXQ_HW_IDX 16 -+#define BIT_MASK_RXQ_HW_IDX 0xfff -+#define BIT_RXQ_HW_IDX(x) (((x) & BIT_MASK_RXQ_HW_IDX) << BIT_SHIFT_RXQ_HW_IDX) -+#define BITS_RXQ_HW_IDX (BIT_MASK_RXQ_HW_IDX << BIT_SHIFT_RXQ_HW_IDX) -+#define BIT_CLEAR_RXQ_HW_IDX(x) ((x) & (~BITS_RXQ_HW_IDX)) -+#define BIT_GET_RXQ_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HW_IDX) & BIT_MASK_RXQ_HW_IDX) -+#define BIT_SET_RXQ_HW_IDX(x, v) (BIT_CLEAR_RXQ_HW_IDX(x) | BIT_RXQ_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0RXQ_RXBD_IDX (Offset 0x03B4) */ -+ -+#define BIT_SHIFT_P0RXQ_HW_IDX 16 -+#define BIT_MASK_P0RXQ_HW_IDX 0xfff -+#define BIT_P0RXQ_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0RXQ_HW_IDX) << BIT_SHIFT_P0RXQ_HW_IDX) -+#define BITS_P0RXQ_HW_IDX (BIT_MASK_P0RXQ_HW_IDX << BIT_SHIFT_P0RXQ_HW_IDX) -+#define BIT_CLEAR_P0RXQ_HW_IDX(x) ((x) & (~BITS_P0RXQ_HW_IDX)) -+#define BIT_GET_P0RXQ_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0RXQ_HW_IDX) & BIT_MASK_P0RXQ_HW_IDX) -+#define BIT_SET_P0RXQ_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0RXQ_HW_IDX(x) | BIT_P0RXQ_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXQ_RXBD_IDX (Offset 0x03B4) */ -+ -+#define BIT_SHIFT_RXQ_HOST_IDX 0 -+#define BIT_MASK_RXQ_HOST_IDX 0xfff -+#define BIT_RXQ_HOST_IDX(x) \ -+ (((x) & BIT_MASK_RXQ_HOST_IDX) << BIT_SHIFT_RXQ_HOST_IDX) -+#define BITS_RXQ_HOST_IDX (BIT_MASK_RXQ_HOST_IDX << BIT_SHIFT_RXQ_HOST_IDX) -+#define BIT_CLEAR_RXQ_HOST_IDX(x) ((x) & (~BITS_RXQ_HOST_IDX)) -+#define BIT_GET_RXQ_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HOST_IDX) & BIT_MASK_RXQ_HOST_IDX) -+#define BIT_SET_RXQ_HOST_IDX(x, v) \ -+ (BIT_CLEAR_RXQ_HOST_IDX(x) | BIT_RXQ_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0RXQ_RXBD_IDX (Offset 0x03B4) */ -+ -+#define BIT_SHIFT_P0RXQ_HOST_IDX 0 -+#define BIT_MASK_P0RXQ_HOST_IDX 0xfff -+#define BIT_P0RXQ_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0RXQ_HOST_IDX) << BIT_SHIFT_P0RXQ_HOST_IDX) -+#define BITS_P0RXQ_HOST_IDX \ -+ (BIT_MASK_P0RXQ_HOST_IDX << BIT_SHIFT_P0RXQ_HOST_IDX) -+#define BIT_CLEAR_P0RXQ_HOST_IDX(x) ((x) & (~BITS_P0RXQ_HOST_IDX)) -+#define BIT_GET_P0RXQ_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0RXQ_HOST_IDX) & BIT_MASK_P0RXQ_HOST_IDX) -+#define BIT_SET_P0RXQ_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0RXQ_HOST_IDX(x) | BIT_P0RXQ_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI0Q_TXBD_IDX (Offset 0x03B8) */ -+ -+#define BIT_SHIFT_HI0Q_HW_IDX 16 -+#define BIT_MASK_HI0Q_HW_IDX 0xfff -+#define BIT_HI0Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI0Q_HW_IDX) << BIT_SHIFT_HI0Q_HW_IDX) -+#define BITS_HI0Q_HW_IDX (BIT_MASK_HI0Q_HW_IDX << BIT_SHIFT_HI0Q_HW_IDX) -+#define BIT_CLEAR_HI0Q_HW_IDX(x) ((x) & (~BITS_HI0Q_HW_IDX)) -+#define BIT_GET_HI0Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HW_IDX) & BIT_MASK_HI0Q_HW_IDX) -+#define BIT_SET_HI0Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI0Q_HW_IDX(x) | BIT_HI0Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI0Q_TXBD_IDX (Offset 0x03B8) */ -+ -+#define BIT_SHIFT_P0HI0Q_HW_IDX 16 -+#define BIT_MASK_P0HI0Q_HW_IDX 0xfff -+#define BIT_P0HI0Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI0Q_HW_IDX) << BIT_SHIFT_P0HI0Q_HW_IDX) -+#define BITS_P0HI0Q_HW_IDX (BIT_MASK_P0HI0Q_HW_IDX << BIT_SHIFT_P0HI0Q_HW_IDX) -+#define BIT_CLEAR_P0HI0Q_HW_IDX(x) ((x) & (~BITS_P0HI0Q_HW_IDX)) -+#define BIT_GET_P0HI0Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI0Q_HW_IDX) & BIT_MASK_P0HI0Q_HW_IDX) -+#define BIT_SET_P0HI0Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI0Q_HW_IDX(x) | BIT_P0HI0Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI0Q_TXBD_IDX (Offset 0x03B8) */ -+ -+#define BIT_SHIFT_HI0Q_HOST_IDX 0 -+#define BIT_MASK_HI0Q_HOST_IDX 0xfff -+#define BIT_HI0Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI0Q_HOST_IDX) << BIT_SHIFT_HI0Q_HOST_IDX) -+#define BITS_HI0Q_HOST_IDX (BIT_MASK_HI0Q_HOST_IDX << BIT_SHIFT_HI0Q_HOST_IDX) -+#define BIT_CLEAR_HI0Q_HOST_IDX(x) ((x) & (~BITS_HI0Q_HOST_IDX)) -+#define BIT_GET_HI0Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HOST_IDX) & BIT_MASK_HI0Q_HOST_IDX) -+#define BIT_SET_HI0Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI0Q_HOST_IDX(x) | BIT_HI0Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI0Q_TXBD_IDX (Offset 0x03B8) */ -+ -+#define BIT_SHIFT_P0HI0Q_HOST_IDX 0 -+#define BIT_MASK_P0HI0Q_HOST_IDX 0xfff -+#define BIT_P0HI0Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI0Q_HOST_IDX) << BIT_SHIFT_P0HI0Q_HOST_IDX) -+#define BITS_P0HI0Q_HOST_IDX \ -+ (BIT_MASK_P0HI0Q_HOST_IDX << BIT_SHIFT_P0HI0Q_HOST_IDX) -+#define BIT_CLEAR_P0HI0Q_HOST_IDX(x) ((x) & (~BITS_P0HI0Q_HOST_IDX)) -+#define BIT_GET_P0HI0Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI0Q_HOST_IDX) & BIT_MASK_P0HI0Q_HOST_IDX) -+#define BIT_SET_P0HI0Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI0Q_HOST_IDX(x) | BIT_P0HI0Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI1Q_TXBD_IDX (Offset 0x03BC) */ -+ -+#define BIT_SHIFT_HI1Q_HW_IDX 16 -+#define BIT_MASK_HI1Q_HW_IDX 0xfff -+#define BIT_HI1Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI1Q_HW_IDX) << BIT_SHIFT_HI1Q_HW_IDX) -+#define BITS_HI1Q_HW_IDX (BIT_MASK_HI1Q_HW_IDX << BIT_SHIFT_HI1Q_HW_IDX) -+#define BIT_CLEAR_HI1Q_HW_IDX(x) ((x) & (~BITS_HI1Q_HW_IDX)) -+#define BIT_GET_HI1Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HW_IDX) & BIT_MASK_HI1Q_HW_IDX) -+#define BIT_SET_HI1Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI1Q_HW_IDX(x) | BIT_HI1Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI1Q_TXBD_IDX (Offset 0x03BC) */ -+ -+#define BIT_SHIFT_P0HI1Q_HW_IDX 16 -+#define BIT_MASK_P0HI1Q_HW_IDX 0xfff -+#define BIT_P0HI1Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI1Q_HW_IDX) << BIT_SHIFT_P0HI1Q_HW_IDX) -+#define BITS_P0HI1Q_HW_IDX (BIT_MASK_P0HI1Q_HW_IDX << BIT_SHIFT_P0HI1Q_HW_IDX) -+#define BIT_CLEAR_P0HI1Q_HW_IDX(x) ((x) & (~BITS_P0HI1Q_HW_IDX)) -+#define BIT_GET_P0HI1Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI1Q_HW_IDX) & BIT_MASK_P0HI1Q_HW_IDX) -+#define BIT_SET_P0HI1Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI1Q_HW_IDX(x) | BIT_P0HI1Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI1Q_TXBD_IDX (Offset 0x03BC) */ -+ -+#define BIT_SHIFT_HI1Q_HOST_IDX 0 -+#define BIT_MASK_HI1Q_HOST_IDX 0xfff -+#define BIT_HI1Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI1Q_HOST_IDX) << BIT_SHIFT_HI1Q_HOST_IDX) -+#define BITS_HI1Q_HOST_IDX (BIT_MASK_HI1Q_HOST_IDX << BIT_SHIFT_HI1Q_HOST_IDX) -+#define BIT_CLEAR_HI1Q_HOST_IDX(x) ((x) & (~BITS_HI1Q_HOST_IDX)) -+#define BIT_GET_HI1Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HOST_IDX) & BIT_MASK_HI1Q_HOST_IDX) -+#define BIT_SET_HI1Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI1Q_HOST_IDX(x) | BIT_HI1Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI1Q_TXBD_IDX (Offset 0x03BC) */ -+ -+#define BIT_SHIFT_P0HI1Q_HOST_IDX 0 -+#define BIT_MASK_P0HI1Q_HOST_IDX 0xfff -+#define BIT_P0HI1Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI1Q_HOST_IDX) << BIT_SHIFT_P0HI1Q_HOST_IDX) -+#define BITS_P0HI1Q_HOST_IDX \ -+ (BIT_MASK_P0HI1Q_HOST_IDX << BIT_SHIFT_P0HI1Q_HOST_IDX) -+#define BIT_CLEAR_P0HI1Q_HOST_IDX(x) ((x) & (~BITS_P0HI1Q_HOST_IDX)) -+#define BIT_GET_P0HI1Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI1Q_HOST_IDX) & BIT_MASK_P0HI1Q_HOST_IDX) -+#define BIT_SET_P0HI1Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI1Q_HOST_IDX(x) | BIT_P0HI1Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI2Q_TXBD_IDX (Offset 0x03C0) */ -+ -+#define BIT_SHIFT_HI2Q_HW_IDX 16 -+#define BIT_MASK_HI2Q_HW_IDX 0xfff -+#define BIT_HI2Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI2Q_HW_IDX) << BIT_SHIFT_HI2Q_HW_IDX) -+#define BITS_HI2Q_HW_IDX (BIT_MASK_HI2Q_HW_IDX << BIT_SHIFT_HI2Q_HW_IDX) -+#define BIT_CLEAR_HI2Q_HW_IDX(x) ((x) & (~BITS_HI2Q_HW_IDX)) -+#define BIT_GET_HI2Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HW_IDX) & BIT_MASK_HI2Q_HW_IDX) -+#define BIT_SET_HI2Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI2Q_HW_IDX(x) | BIT_HI2Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI2Q_TXBD_IDX (Offset 0x03C0) */ -+ -+#define BIT_SHIFT_P0HI2Q_HW_IDX 16 -+#define BIT_MASK_P0HI2Q_HW_IDX 0xfff -+#define BIT_P0HI2Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI2Q_HW_IDX) << BIT_SHIFT_P0HI2Q_HW_IDX) -+#define BITS_P0HI2Q_HW_IDX (BIT_MASK_P0HI2Q_HW_IDX << BIT_SHIFT_P0HI2Q_HW_IDX) -+#define BIT_CLEAR_P0HI2Q_HW_IDX(x) ((x) & (~BITS_P0HI2Q_HW_IDX)) -+#define BIT_GET_P0HI2Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI2Q_HW_IDX) & BIT_MASK_P0HI2Q_HW_IDX) -+#define BIT_SET_P0HI2Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI2Q_HW_IDX(x) | BIT_P0HI2Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI2Q_TXBD_IDX (Offset 0x03C0) */ -+ -+#define BIT_SHIFT_HI2Q_HOST_IDX 0 -+#define BIT_MASK_HI2Q_HOST_IDX 0xfff -+#define BIT_HI2Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI2Q_HOST_IDX) << BIT_SHIFT_HI2Q_HOST_IDX) -+#define BITS_HI2Q_HOST_IDX (BIT_MASK_HI2Q_HOST_IDX << BIT_SHIFT_HI2Q_HOST_IDX) -+#define BIT_CLEAR_HI2Q_HOST_IDX(x) ((x) & (~BITS_HI2Q_HOST_IDX)) -+#define BIT_GET_HI2Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HOST_IDX) & BIT_MASK_HI2Q_HOST_IDX) -+#define BIT_SET_HI2Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI2Q_HOST_IDX(x) | BIT_HI2Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI2Q_TXBD_IDX (Offset 0x03C0) */ -+ -+#define BIT_SHIFT_P0HI2Q_HOST_IDX 0 -+#define BIT_MASK_P0HI2Q_HOST_IDX 0xfff -+#define BIT_P0HI2Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI2Q_HOST_IDX) << BIT_SHIFT_P0HI2Q_HOST_IDX) -+#define BITS_P0HI2Q_HOST_IDX \ -+ (BIT_MASK_P0HI2Q_HOST_IDX << BIT_SHIFT_P0HI2Q_HOST_IDX) -+#define BIT_CLEAR_P0HI2Q_HOST_IDX(x) ((x) & (~BITS_P0HI2Q_HOST_IDX)) -+#define BIT_GET_P0HI2Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI2Q_HOST_IDX) & BIT_MASK_P0HI2Q_HOST_IDX) -+#define BIT_SET_P0HI2Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI2Q_HOST_IDX(x) | BIT_P0HI2Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI3Q_TXBD_IDX (Offset 0x03C4) */ -+ -+#define BIT_SHIFT_HI3Q_HW_IDX 16 -+#define BIT_MASK_HI3Q_HW_IDX 0xfff -+#define BIT_HI3Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI3Q_HW_IDX) << BIT_SHIFT_HI3Q_HW_IDX) -+#define BITS_HI3Q_HW_IDX (BIT_MASK_HI3Q_HW_IDX << BIT_SHIFT_HI3Q_HW_IDX) -+#define BIT_CLEAR_HI3Q_HW_IDX(x) ((x) & (~BITS_HI3Q_HW_IDX)) -+#define BIT_GET_HI3Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HW_IDX) & BIT_MASK_HI3Q_HW_IDX) -+#define BIT_SET_HI3Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI3Q_HW_IDX(x) | BIT_HI3Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI3Q_TXBD_IDX (Offset 0x03C4) */ -+ -+#define BIT_SHIFT_P0HI3Q_HW_IDX 16 -+#define BIT_MASK_P0HI3Q_HW_IDX 0xfff -+#define BIT_P0HI3Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI3Q_HW_IDX) << BIT_SHIFT_P0HI3Q_HW_IDX) -+#define BITS_P0HI3Q_HW_IDX (BIT_MASK_P0HI3Q_HW_IDX << BIT_SHIFT_P0HI3Q_HW_IDX) -+#define BIT_CLEAR_P0HI3Q_HW_IDX(x) ((x) & (~BITS_P0HI3Q_HW_IDX)) -+#define BIT_GET_P0HI3Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI3Q_HW_IDX) & BIT_MASK_P0HI3Q_HW_IDX) -+#define BIT_SET_P0HI3Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI3Q_HW_IDX(x) | BIT_P0HI3Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI3Q_TXBD_IDX (Offset 0x03C4) */ -+ -+#define BIT_SHIFT_HI3Q_HOST_IDX 0 -+#define BIT_MASK_HI3Q_HOST_IDX 0xfff -+#define BIT_HI3Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI3Q_HOST_IDX) << BIT_SHIFT_HI3Q_HOST_IDX) -+#define BITS_HI3Q_HOST_IDX (BIT_MASK_HI3Q_HOST_IDX << BIT_SHIFT_HI3Q_HOST_IDX) -+#define BIT_CLEAR_HI3Q_HOST_IDX(x) ((x) & (~BITS_HI3Q_HOST_IDX)) -+#define BIT_GET_HI3Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HOST_IDX) & BIT_MASK_HI3Q_HOST_IDX) -+#define BIT_SET_HI3Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI3Q_HOST_IDX(x) | BIT_HI3Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI3Q_TXBD_IDX (Offset 0x03C4) */ -+ -+#define BIT_SHIFT_P0HI3Q_HOST_IDX 0 -+#define BIT_MASK_P0HI3Q_HOST_IDX 0xfff -+#define BIT_P0HI3Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI3Q_HOST_IDX) << BIT_SHIFT_P0HI3Q_HOST_IDX) -+#define BITS_P0HI3Q_HOST_IDX \ -+ (BIT_MASK_P0HI3Q_HOST_IDX << BIT_SHIFT_P0HI3Q_HOST_IDX) -+#define BIT_CLEAR_P0HI3Q_HOST_IDX(x) ((x) & (~BITS_P0HI3Q_HOST_IDX)) -+#define BIT_GET_P0HI3Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI3Q_HOST_IDX) & BIT_MASK_P0HI3Q_HOST_IDX) -+#define BIT_SET_P0HI3Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI3Q_HOST_IDX(x) | BIT_P0HI3Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI4Q_TXBD_IDX (Offset 0x03C8) */ -+ -+#define BIT_SHIFT_HI4Q_HW_IDX 16 -+#define BIT_MASK_HI4Q_HW_IDX 0xfff -+#define BIT_HI4Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI4Q_HW_IDX) << BIT_SHIFT_HI4Q_HW_IDX) -+#define BITS_HI4Q_HW_IDX (BIT_MASK_HI4Q_HW_IDX << BIT_SHIFT_HI4Q_HW_IDX) -+#define BIT_CLEAR_HI4Q_HW_IDX(x) ((x) & (~BITS_HI4Q_HW_IDX)) -+#define BIT_GET_HI4Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HW_IDX) & BIT_MASK_HI4Q_HW_IDX) -+#define BIT_SET_HI4Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI4Q_HW_IDX(x) | BIT_HI4Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI4Q_TXBD_IDX (Offset 0x03C8) */ -+ -+#define BIT_SHIFT_P0HI4Q_HW_IDX 16 -+#define BIT_MASK_P0HI4Q_HW_IDX 0xfff -+#define BIT_P0HI4Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI4Q_HW_IDX) << BIT_SHIFT_P0HI4Q_HW_IDX) -+#define BITS_P0HI4Q_HW_IDX (BIT_MASK_P0HI4Q_HW_IDX << BIT_SHIFT_P0HI4Q_HW_IDX) -+#define BIT_CLEAR_P0HI4Q_HW_IDX(x) ((x) & (~BITS_P0HI4Q_HW_IDX)) -+#define BIT_GET_P0HI4Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI4Q_HW_IDX) & BIT_MASK_P0HI4Q_HW_IDX) -+#define BIT_SET_P0HI4Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI4Q_HW_IDX(x) | BIT_P0HI4Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI4Q_TXBD_IDX (Offset 0x03C8) */ -+ -+#define BIT_SHIFT_HI4Q_HOST_IDX 0 -+#define BIT_MASK_HI4Q_HOST_IDX 0xfff -+#define BIT_HI4Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI4Q_HOST_IDX) << BIT_SHIFT_HI4Q_HOST_IDX) -+#define BITS_HI4Q_HOST_IDX (BIT_MASK_HI4Q_HOST_IDX << BIT_SHIFT_HI4Q_HOST_IDX) -+#define BIT_CLEAR_HI4Q_HOST_IDX(x) ((x) & (~BITS_HI4Q_HOST_IDX)) -+#define BIT_GET_HI4Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HOST_IDX) & BIT_MASK_HI4Q_HOST_IDX) -+#define BIT_SET_HI4Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI4Q_HOST_IDX(x) | BIT_HI4Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI4Q_TXBD_IDX (Offset 0x03C8) */ -+ -+#define BIT_SHIFT_P0HI4Q_HOST_IDX 0 -+#define BIT_MASK_P0HI4Q_HOST_IDX 0xfff -+#define BIT_P0HI4Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI4Q_HOST_IDX) << BIT_SHIFT_P0HI4Q_HOST_IDX) -+#define BITS_P0HI4Q_HOST_IDX \ -+ (BIT_MASK_P0HI4Q_HOST_IDX << BIT_SHIFT_P0HI4Q_HOST_IDX) -+#define BIT_CLEAR_P0HI4Q_HOST_IDX(x) ((x) & (~BITS_P0HI4Q_HOST_IDX)) -+#define BIT_GET_P0HI4Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI4Q_HOST_IDX) & BIT_MASK_P0HI4Q_HOST_IDX) -+#define BIT_SET_P0HI4Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI4Q_HOST_IDX(x) | BIT_P0HI4Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI5Q_TXBD_IDX (Offset 0x03CC) */ -+ -+#define BIT_SHIFT_HI5Q_HW_IDX 16 -+#define BIT_MASK_HI5Q_HW_IDX 0xfff -+#define BIT_HI5Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI5Q_HW_IDX) << BIT_SHIFT_HI5Q_HW_IDX) -+#define BITS_HI5Q_HW_IDX (BIT_MASK_HI5Q_HW_IDX << BIT_SHIFT_HI5Q_HW_IDX) -+#define BIT_CLEAR_HI5Q_HW_IDX(x) ((x) & (~BITS_HI5Q_HW_IDX)) -+#define BIT_GET_HI5Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HW_IDX) & BIT_MASK_HI5Q_HW_IDX) -+#define BIT_SET_HI5Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI5Q_HW_IDX(x) | BIT_HI5Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI5Q_TXBD_IDX (Offset 0x03CC) */ -+ -+#define BIT_SHIFT_P0HI5Q_HW_IDX 16 -+#define BIT_MASK_P0HI5Q_HW_IDX 0xfff -+#define BIT_P0HI5Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI5Q_HW_IDX) << BIT_SHIFT_P0HI5Q_HW_IDX) -+#define BITS_P0HI5Q_HW_IDX (BIT_MASK_P0HI5Q_HW_IDX << BIT_SHIFT_P0HI5Q_HW_IDX) -+#define BIT_CLEAR_P0HI5Q_HW_IDX(x) ((x) & (~BITS_P0HI5Q_HW_IDX)) -+#define BIT_GET_P0HI5Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI5Q_HW_IDX) & BIT_MASK_P0HI5Q_HW_IDX) -+#define BIT_SET_P0HI5Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI5Q_HW_IDX(x) | BIT_P0HI5Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI5Q_TXBD_IDX (Offset 0x03CC) */ -+ -+#define BIT_SHIFT_HI5Q_HOST_IDX 0 -+#define BIT_MASK_HI5Q_HOST_IDX 0xfff -+#define BIT_HI5Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI5Q_HOST_IDX) << BIT_SHIFT_HI5Q_HOST_IDX) -+#define BITS_HI5Q_HOST_IDX (BIT_MASK_HI5Q_HOST_IDX << BIT_SHIFT_HI5Q_HOST_IDX) -+#define BIT_CLEAR_HI5Q_HOST_IDX(x) ((x) & (~BITS_HI5Q_HOST_IDX)) -+#define BIT_GET_HI5Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HOST_IDX) & BIT_MASK_HI5Q_HOST_IDX) -+#define BIT_SET_HI5Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI5Q_HOST_IDX(x) | BIT_HI5Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI5Q_TXBD_IDX (Offset 0x03CC) */ -+ -+#define BIT_SHIFT_P0HI5Q_HOST_IDX 0 -+#define BIT_MASK_P0HI5Q_HOST_IDX 0xfff -+#define BIT_P0HI5Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI5Q_HOST_IDX) << BIT_SHIFT_P0HI5Q_HOST_IDX) -+#define BITS_P0HI5Q_HOST_IDX \ -+ (BIT_MASK_P0HI5Q_HOST_IDX << BIT_SHIFT_P0HI5Q_HOST_IDX) -+#define BIT_CLEAR_P0HI5Q_HOST_IDX(x) ((x) & (~BITS_P0HI5Q_HOST_IDX)) -+#define BIT_GET_P0HI5Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI5Q_HOST_IDX) & BIT_MASK_P0HI5Q_HOST_IDX) -+#define BIT_SET_P0HI5Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI5Q_HOST_IDX(x) | BIT_P0HI5Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI6Q_TXBD_IDX (Offset 0x03D0) */ -+ -+#define BIT_SHIFT_HI6Q_HW_IDX 16 -+#define BIT_MASK_HI6Q_HW_IDX 0xfff -+#define BIT_HI6Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI6Q_HW_IDX) << BIT_SHIFT_HI6Q_HW_IDX) -+#define BITS_HI6Q_HW_IDX (BIT_MASK_HI6Q_HW_IDX << BIT_SHIFT_HI6Q_HW_IDX) -+#define BIT_CLEAR_HI6Q_HW_IDX(x) ((x) & (~BITS_HI6Q_HW_IDX)) -+#define BIT_GET_HI6Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HW_IDX) & BIT_MASK_HI6Q_HW_IDX) -+#define BIT_SET_HI6Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI6Q_HW_IDX(x) | BIT_HI6Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI6Q_TXBD_IDX (Offset 0x03D0) */ -+ -+#define BIT_SHIFT_P0HI6Q_HW_IDX 16 -+#define BIT_MASK_P0HI6Q_HW_IDX 0xfff -+#define BIT_P0HI6Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI6Q_HW_IDX) << BIT_SHIFT_P0HI6Q_HW_IDX) -+#define BITS_P0HI6Q_HW_IDX (BIT_MASK_P0HI6Q_HW_IDX << BIT_SHIFT_P0HI6Q_HW_IDX) -+#define BIT_CLEAR_P0HI6Q_HW_IDX(x) ((x) & (~BITS_P0HI6Q_HW_IDX)) -+#define BIT_GET_P0HI6Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI6Q_HW_IDX) & BIT_MASK_P0HI6Q_HW_IDX) -+#define BIT_SET_P0HI6Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI6Q_HW_IDX(x) | BIT_P0HI6Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI6Q_TXBD_IDX (Offset 0x03D0) */ -+ -+#define BIT_SHIFT_HI6Q_HOST_IDX 0 -+#define BIT_MASK_HI6Q_HOST_IDX 0xfff -+#define BIT_HI6Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI6Q_HOST_IDX) << BIT_SHIFT_HI6Q_HOST_IDX) -+#define BITS_HI6Q_HOST_IDX (BIT_MASK_HI6Q_HOST_IDX << BIT_SHIFT_HI6Q_HOST_IDX) -+#define BIT_CLEAR_HI6Q_HOST_IDX(x) ((x) & (~BITS_HI6Q_HOST_IDX)) -+#define BIT_GET_HI6Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HOST_IDX) & BIT_MASK_HI6Q_HOST_IDX) -+#define BIT_SET_HI6Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI6Q_HOST_IDX(x) | BIT_HI6Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI6Q_TXBD_IDX (Offset 0x03D0) */ -+ -+#define BIT_SHIFT_P0HI6Q_HOST_IDX 0 -+#define BIT_MASK_P0HI6Q_HOST_IDX 0xfff -+#define BIT_P0HI6Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI6Q_HOST_IDX) << BIT_SHIFT_P0HI6Q_HOST_IDX) -+#define BITS_P0HI6Q_HOST_IDX \ -+ (BIT_MASK_P0HI6Q_HOST_IDX << BIT_SHIFT_P0HI6Q_HOST_IDX) -+#define BIT_CLEAR_P0HI6Q_HOST_IDX(x) ((x) & (~BITS_P0HI6Q_HOST_IDX)) -+#define BIT_GET_P0HI6Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI6Q_HOST_IDX) & BIT_MASK_P0HI6Q_HOST_IDX) -+#define BIT_SET_P0HI6Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI6Q_HOST_IDX(x) | BIT_P0HI6Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI7Q_TXBD_IDX (Offset 0x03D4) */ -+ -+#define BIT_SHIFT_HI7Q_HW_IDX 16 -+#define BIT_MASK_HI7Q_HW_IDX 0xfff -+#define BIT_HI7Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI7Q_HW_IDX) << BIT_SHIFT_HI7Q_HW_IDX) -+#define BITS_HI7Q_HW_IDX (BIT_MASK_HI7Q_HW_IDX << BIT_SHIFT_HI7Q_HW_IDX) -+#define BIT_CLEAR_HI7Q_HW_IDX(x) ((x) & (~BITS_HI7Q_HW_IDX)) -+#define BIT_GET_HI7Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HW_IDX) & BIT_MASK_HI7Q_HW_IDX) -+#define BIT_SET_HI7Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI7Q_HW_IDX(x) | BIT_HI7Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI7Q_TXBD_IDX (Offset 0x03D4) */ -+ -+#define BIT_SHIFT_P0HI7Q_HW_IDX 16 -+#define BIT_MASK_P0HI7Q_HW_IDX 0xfff -+#define BIT_P0HI7Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI7Q_HW_IDX) << BIT_SHIFT_P0HI7Q_HW_IDX) -+#define BITS_P0HI7Q_HW_IDX (BIT_MASK_P0HI7Q_HW_IDX << BIT_SHIFT_P0HI7Q_HW_IDX) -+#define BIT_CLEAR_P0HI7Q_HW_IDX(x) ((x) & (~BITS_P0HI7Q_HW_IDX)) -+#define BIT_GET_P0HI7Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI7Q_HW_IDX) & BIT_MASK_P0HI7Q_HW_IDX) -+#define BIT_SET_P0HI7Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI7Q_HW_IDX(x) | BIT_P0HI7Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HI7Q_TXBD_IDX (Offset 0x03D4) */ -+ -+#define BIT_SHIFT_HI7Q_HOST_IDX 0 -+#define BIT_MASK_HI7Q_HOST_IDX 0xfff -+#define BIT_HI7Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI7Q_HOST_IDX) << BIT_SHIFT_HI7Q_HOST_IDX) -+#define BITS_HI7Q_HOST_IDX (BIT_MASK_HI7Q_HOST_IDX << BIT_SHIFT_HI7Q_HOST_IDX) -+#define BIT_CLEAR_HI7Q_HOST_IDX(x) ((x) & (~BITS_HI7Q_HOST_IDX)) -+#define BIT_GET_HI7Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HOST_IDX) & BIT_MASK_HI7Q_HOST_IDX) -+#define BIT_SET_HI7Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI7Q_HOST_IDX(x) | BIT_HI7Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI7Q_TXBD_IDX (Offset 0x03D4) */ -+ -+#define BIT_SHIFT_P0HI7Q_HOST_IDX 0 -+#define BIT_MASK_P0HI7Q_HOST_IDX 0xfff -+#define BIT_P0HI7Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI7Q_HOST_IDX) << BIT_SHIFT_P0HI7Q_HOST_IDX) -+#define BITS_P0HI7Q_HOST_IDX \ -+ (BIT_MASK_P0HI7Q_HOST_IDX << BIT_SHIFT_P0HI7Q_HOST_IDX) -+#define BIT_CLEAR_P0HI7Q_HOST_IDX(x) ((x) & (~BITS_P0HI7Q_HOST_IDX)) -+#define BIT_GET_P0HI7Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI7Q_HOST_IDX) & BIT_MASK_P0HI7Q_HOST_IDX) -+#define BIT_SET_P0HI7Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI7Q_HOST_IDX(x) | BIT_P0HI7Q_HOST_IDX(v)) -+ -+/* 2 REG_DBGSEL_PCIE_HRPWM1_HCPWM1_V1 (Offset 0x03D8) */ -+ -+#define BIT_DIS_TXDMA_PRE_V1 BIT(31) -+#define BIT_DIS_RXDMA_PRE_V1 BIT(30) -+ -+#define BIT_SHIFT_HPS_CLKR_PCIE_V1 28 -+#define BIT_MASK_HPS_CLKR_PCIE_V1 0x3 -+#define BIT_HPS_CLKR_PCIE_V1(x) \ -+ (((x) & BIT_MASK_HPS_CLKR_PCIE_V1) << BIT_SHIFT_HPS_CLKR_PCIE_V1) -+#define BITS_HPS_CLKR_PCIE_V1 \ -+ (BIT_MASK_HPS_CLKR_PCIE_V1 << BIT_SHIFT_HPS_CLKR_PCIE_V1) -+#define BIT_CLEAR_HPS_CLKR_PCIE_V1(x) ((x) & (~BITS_HPS_CLKR_PCIE_V1)) -+#define BIT_GET_HPS_CLKR_PCIE_V1(x) \ -+ (((x) >> BIT_SHIFT_HPS_CLKR_PCIE_V1) & BIT_MASK_HPS_CLKR_PCIE_V1) -+#define BIT_SET_HPS_CLKR_PCIE_V1(x, v) \ -+ (BIT_CLEAR_HPS_CLKR_PCIE_V1(x) | BIT_HPS_CLKR_PCIE_V1(v)) -+ -+#define BIT_PCIE_INT_V1 BIT(27) -+#define BIT_TXFLAG_EXIT_L1_EN_V1 BIT(26) -+#define BIT_EN_RXDMA_ALIGN_V2 BIT(25) -+#define BIT_EN_TXDMA_ALIGN_V2 BIT(24) -+ -+#define BIT_SHIFT_PCIE_HCPWM_V1 16 -+#define BIT_MASK_PCIE_HCPWM_V1 0xff -+#define BIT_PCIE_HCPWM_V1(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM_V1) << BIT_SHIFT_PCIE_HCPWM_V1) -+#define BITS_PCIE_HCPWM_V1 (BIT_MASK_PCIE_HCPWM_V1 << BIT_SHIFT_PCIE_HCPWM_V1) -+#define BIT_CLEAR_PCIE_HCPWM_V1(x) ((x) & (~BITS_PCIE_HCPWM_V1)) -+#define BIT_GET_PCIE_HCPWM_V1(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM_V1) & BIT_MASK_PCIE_HCPWM_V1) -+#define BIT_SET_PCIE_HCPWM_V1(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM_V1(x) | BIT_PCIE_HCPWM_V1(v)) -+ -+#define BIT_SHIFT_PCIE_HRPWM_V1 8 -+#define BIT_MASK_PCIE_HRPWM_V1 0xff -+#define BIT_PCIE_HRPWM_V1(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM_V1) << BIT_SHIFT_PCIE_HRPWM_V1) -+#define BITS_PCIE_HRPWM_V1 (BIT_MASK_PCIE_HRPWM_V1 << BIT_SHIFT_PCIE_HRPWM_V1) -+#define BIT_CLEAR_PCIE_HRPWM_V1(x) ((x) & (~BITS_PCIE_HRPWM_V1)) -+#define BIT_GET_PCIE_HRPWM_V1(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM_V1) & BIT_MASK_PCIE_HRPWM_V1) -+#define BIT_SET_PCIE_HRPWM_V1(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM_V1(x) | BIT_PCIE_HRPWM_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DBG_SEL_V1 (Offset 0x03D8) */ -+ -+#define BIT_SHIFT_DBG_SEL 0 -+#define BIT_MASK_DBG_SEL 0xff -+#define BIT_DBG_SEL(x) (((x) & BIT_MASK_DBG_SEL) << BIT_SHIFT_DBG_SEL) -+#define BITS_DBG_SEL (BIT_MASK_DBG_SEL << BIT_SHIFT_DBG_SEL) -+#define BIT_CLEAR_DBG_SEL(x) ((x) & (~BITS_DBG_SEL)) -+#define BIT_GET_DBG_SEL(x) (((x) >> BIT_SHIFT_DBG_SEL) & BIT_MASK_DBG_SEL) -+#define BIT_SET_DBG_SEL(x, v) (BIT_CLEAR_DBG_SEL(x) | BIT_DBG_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PCIE_HRPWM1_V1 (Offset 0x03D9) */ -+ -+#define BIT_SHIFT_PCIE_HRPWM 0 -+#define BIT_MASK_PCIE_HRPWM 0xff -+#define BIT_PCIE_HRPWM(x) (((x) & BIT_MASK_PCIE_HRPWM) << BIT_SHIFT_PCIE_HRPWM) -+#define BITS_PCIE_HRPWM (BIT_MASK_PCIE_HRPWM << BIT_SHIFT_PCIE_HRPWM) -+#define BIT_CLEAR_PCIE_HRPWM(x) ((x) & (~BITS_PCIE_HRPWM)) -+#define BIT_GET_PCIE_HRPWM(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM) & BIT_MASK_PCIE_HRPWM) -+#define BIT_SET_PCIE_HRPWM(x, v) (BIT_CLEAR_PCIE_HRPWM(x) | BIT_PCIE_HRPWM(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_HRPWM1_V1 (Offset 0x03D9) */ -+ -+#define BIT_SHIFT_HCI_HRPWM 0 -+#define BIT_MASK_HCI_HRPWM 0xff -+#define BIT_HCI_HRPWM(x) (((x) & BIT_MASK_HCI_HRPWM) << BIT_SHIFT_HCI_HRPWM) -+#define BITS_HCI_HRPWM (BIT_MASK_HCI_HRPWM << BIT_SHIFT_HCI_HRPWM) -+#define BIT_CLEAR_HCI_HRPWM(x) ((x) & (~BITS_HCI_HRPWM)) -+#define BIT_GET_HCI_HRPWM(x) (((x) >> BIT_SHIFT_HCI_HRPWM) & BIT_MASK_HCI_HRPWM) -+#define BIT_SET_HCI_HRPWM(x, v) (BIT_CLEAR_HCI_HRPWM(x) | BIT_HCI_HRPWM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PCIE_HCPWM1_V1 (Offset 0x03DA) */ -+ -+#define BIT_SHIFT_PCIE_HCPWM 0 -+#define BIT_MASK_PCIE_HCPWM 0xff -+#define BIT_PCIE_HCPWM(x) (((x) & BIT_MASK_PCIE_HCPWM) << BIT_SHIFT_PCIE_HCPWM) -+#define BITS_PCIE_HCPWM (BIT_MASK_PCIE_HCPWM << BIT_SHIFT_PCIE_HCPWM) -+#define BIT_CLEAR_PCIE_HCPWM(x) ((x) & (~BITS_PCIE_HCPWM)) -+#define BIT_GET_PCIE_HCPWM(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM) & BIT_MASK_PCIE_HCPWM) -+#define BIT_SET_PCIE_HCPWM(x, v) (BIT_CLEAR_PCIE_HCPWM(x) | BIT_PCIE_HCPWM(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_HCPWM1_V1 (Offset 0x03DA) */ -+ -+#define BIT_SHIFT_HCI_HCPWM 0 -+#define BIT_MASK_HCI_HCPWM 0xff -+#define BIT_HCI_HCPWM(x) (((x) & BIT_MASK_HCI_HCPWM) << BIT_SHIFT_HCI_HCPWM) -+#define BITS_HCI_HCPWM (BIT_MASK_HCI_HCPWM << BIT_SHIFT_HCI_HCPWM) -+#define BIT_CLEAR_HCI_HCPWM(x) ((x) & (~BITS_HCI_HCPWM)) -+#define BIT_GET_HCI_HCPWM(x) (((x) >> BIT_SHIFT_HCI_HCPWM) & BIT_MASK_HCI_HCPWM) -+#define BIT_SET_HCI_HCPWM(x, v) (BIT_CLEAR_HCI_HCPWM(x) | BIT_HCI_HCPWM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL2 (Offset 0x03DB) */ -+ -+#define BIT_SHIFT_HPS_CLKR_PCIE 4 -+#define BIT_MASK_HPS_CLKR_PCIE 0x3 -+#define BIT_HPS_CLKR_PCIE(x) \ -+ (((x) & BIT_MASK_HPS_CLKR_PCIE) << BIT_SHIFT_HPS_CLKR_PCIE) -+#define BITS_HPS_CLKR_PCIE (BIT_MASK_HPS_CLKR_PCIE << BIT_SHIFT_HPS_CLKR_PCIE) -+#define BIT_CLEAR_HPS_CLKR_PCIE(x) ((x) & (~BITS_HPS_CLKR_PCIE)) -+#define BIT_GET_HPS_CLKR_PCIE(x) \ -+ (((x) >> BIT_SHIFT_HPS_CLKR_PCIE) & BIT_MASK_HPS_CLKR_PCIE) -+#define BIT_SET_HPS_CLKR_PCIE(x, v) \ -+ (BIT_CLEAR_HPS_CLKR_PCIE(x) | BIT_HPS_CLKR_PCIE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_CTRL2 (Offset 0x03DB) */ -+ -+#define BIT_SHIFT_HPS_CLKR_HCI 4 -+#define BIT_MASK_HPS_CLKR_HCI 0x3 -+#define BIT_HPS_CLKR_HCI(x) \ -+ (((x) & BIT_MASK_HPS_CLKR_HCI) << BIT_SHIFT_HPS_CLKR_HCI) -+#define BITS_HPS_CLKR_HCI (BIT_MASK_HPS_CLKR_HCI << BIT_SHIFT_HPS_CLKR_HCI) -+#define BIT_CLEAR_HPS_CLKR_HCI(x) ((x) & (~BITS_HPS_CLKR_HCI)) -+#define BIT_GET_HPS_CLKR_HCI(x) \ -+ (((x) >> BIT_SHIFT_HPS_CLKR_HCI) & BIT_MASK_HPS_CLKR_HCI) -+#define BIT_SET_HPS_CLKR_HCI(x, v) \ -+ (BIT_CLEAR_HPS_CLKR_HCI(x) | BIT_HPS_CLKR_HCI(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL2 (Offset 0x03DB) */ -+ -+#define BIT_PCIE_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_CTRL2 (Offset 0x03DB) */ -+ -+#define BIT_HCI_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_CTRL2 (Offset 0x03DB) */ -+ -+#define BIT_EN_RXDMA_ALIGN BIT(1) -+#define BIT_EN_TXDMA_ALIGN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_HRPWM2_HCPWM2_V1 (Offset 0x03DC) */ -+ -+#define BIT_SHIFT_PCIE_HCPWM2_V1 16 -+#define BIT_MASK_PCIE_HCPWM2_V1 0xffff -+#define BIT_PCIE_HCPWM2_V1(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM2_V1) << BIT_SHIFT_PCIE_HCPWM2_V1) -+#define BITS_PCIE_HCPWM2_V1 \ -+ (BIT_MASK_PCIE_HCPWM2_V1 << BIT_SHIFT_PCIE_HCPWM2_V1) -+#define BIT_CLEAR_PCIE_HCPWM2_V1(x) ((x) & (~BITS_PCIE_HCPWM2_V1)) -+#define BIT_GET_PCIE_HCPWM2_V1(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM2_V1) & BIT_MASK_PCIE_HCPWM2_V1) -+#define BIT_SET_PCIE_HCPWM2_V1(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM2_V1(x) | BIT_PCIE_HCPWM2_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PCIE_HRPWM2_V1 (Offset 0x03DC) */ -+ -+#define BIT_SHIFT_PCIE_HRPWM2 0 -+#define BIT_MASK_PCIE_HRPWM2 0xffff -+#define BIT_PCIE_HRPWM2(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM2) << BIT_SHIFT_PCIE_HRPWM2) -+#define BITS_PCIE_HRPWM2 (BIT_MASK_PCIE_HRPWM2 << BIT_SHIFT_PCIE_HRPWM2) -+#define BIT_CLEAR_PCIE_HRPWM2(x) ((x) & (~BITS_PCIE_HRPWM2)) -+#define BIT_GET_PCIE_HRPWM2(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM2) & BIT_MASK_PCIE_HRPWM2) -+#define BIT_SET_PCIE_HRPWM2(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM2(x) | BIT_PCIE_HRPWM2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_HRPWM2_V1 (Offset 0x03DC) */ -+ -+#define BIT_SHIFT_HCI_HRPWM2 0 -+#define BIT_MASK_HCI_HRPWM2 0xffff -+#define BIT_HCI_HRPWM2(x) (((x) & BIT_MASK_HCI_HRPWM2) << BIT_SHIFT_HCI_HRPWM2) -+#define BITS_HCI_HRPWM2 (BIT_MASK_HCI_HRPWM2 << BIT_SHIFT_HCI_HRPWM2) -+#define BIT_CLEAR_HCI_HRPWM2(x) ((x) & (~BITS_HCI_HRPWM2)) -+#define BIT_GET_HCI_HRPWM2(x) \ -+ (((x) >> BIT_SHIFT_HCI_HRPWM2) & BIT_MASK_HCI_HRPWM2) -+#define BIT_SET_HCI_HRPWM2(x, v) (BIT_CLEAR_HCI_HRPWM2(x) | BIT_HCI_HRPWM2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PCIE_HCPWM2_V1 (Offset 0x03DE) */ -+ -+#define BIT_SHIFT_PCIE_HCPWM2 0 -+#define BIT_MASK_PCIE_HCPWM2 0xffff -+#define BIT_PCIE_HCPWM2(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM2) << BIT_SHIFT_PCIE_HCPWM2) -+#define BITS_PCIE_HCPWM2 (BIT_MASK_PCIE_HCPWM2 << BIT_SHIFT_PCIE_HCPWM2) -+#define BIT_CLEAR_PCIE_HCPWM2(x) ((x) & (~BITS_PCIE_HCPWM2)) -+#define BIT_GET_PCIE_HCPWM2(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM2) & BIT_MASK_PCIE_HCPWM2) -+#define BIT_SET_PCIE_HCPWM2(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM2(x) | BIT_PCIE_HCPWM2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_HCPWM2_V1 (Offset 0x03DE) */ -+ -+#define BIT_SHIFT_HCI_HCPWM2 0 -+#define BIT_MASK_HCI_HCPWM2 0xffff -+#define BIT_HCI_HCPWM2(x) (((x) & BIT_MASK_HCI_HCPWM2) << BIT_SHIFT_HCI_HCPWM2) -+#define BITS_HCI_HCPWM2 (BIT_MASK_HCI_HCPWM2 << BIT_SHIFT_HCI_HCPWM2) -+#define BIT_CLEAR_HCI_HCPWM2(x) ((x) & (~BITS_HCI_HCPWM2)) -+#define BIT_GET_HCI_HCPWM2(x) \ -+ (((x) >> BIT_SHIFT_HCI_HCPWM2) & BIT_MASK_HCI_HCPWM2) -+#define BIT_SET_HCI_HCPWM2(x, v) (BIT_CLEAR_HCI_HCPWM2(x) | BIT_HCI_HCPWM2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PCIE_H2C_MSG_V1 (Offset 0x03E0) */ -+ -+#define BIT_AC7Q_EMPTY BIT(7) -+#define BIT_AC6Q_EMPTY BIT(6) -+#define BIT_AC5Q_EMPTY BIT(5) -+#define BIT_AC4Q_EMPTY BIT(4) -+#define BIT_AC3Q_EMPTY BIT(3) -+#define BIT_AC2Q_EMPTY BIT(2) -+#define BIT_AC1Q_EMPTY BIT(1) -+ -+#define BIT_SHIFT_DRV2FW_INFO 0 -+#define BIT_MASK_DRV2FW_INFO 0xffffffffL -+#define BIT_DRV2FW_INFO(x) \ -+ (((x) & BIT_MASK_DRV2FW_INFO) << BIT_SHIFT_DRV2FW_INFO) -+#define BITS_DRV2FW_INFO (BIT_MASK_DRV2FW_INFO << BIT_SHIFT_DRV2FW_INFO) -+#define BIT_CLEAR_DRV2FW_INFO(x) ((x) & (~BITS_DRV2FW_INFO)) -+#define BIT_GET_DRV2FW_INFO(x) \ -+ (((x) >> BIT_SHIFT_DRV2FW_INFO) & BIT_MASK_DRV2FW_INFO) -+#define BIT_SET_DRV2FW_INFO(x, v) \ -+ (BIT_CLEAR_DRV2FW_INFO(x) | BIT_DRV2FW_INFO(v)) -+ -+#define BIT_AC0Q_EMPTY BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PCIE_C2H_MSG_V1 (Offset 0x03E4) */ -+ -+#define BIT_SHIFT_HCI_PCIE_C2H_MSG 0 -+#define BIT_MASK_HCI_PCIE_C2H_MSG 0xffffffffL -+#define BIT_HCI_PCIE_C2H_MSG(x) \ -+ (((x) & BIT_MASK_HCI_PCIE_C2H_MSG) << BIT_SHIFT_HCI_PCIE_C2H_MSG) -+#define BITS_HCI_PCIE_C2H_MSG \ -+ (BIT_MASK_HCI_PCIE_C2H_MSG << BIT_SHIFT_HCI_PCIE_C2H_MSG) -+#define BIT_CLEAR_HCI_PCIE_C2H_MSG(x) ((x) & (~BITS_HCI_PCIE_C2H_MSG)) -+#define BIT_GET_HCI_PCIE_C2H_MSG(x) \ -+ (((x) >> BIT_SHIFT_HCI_PCIE_C2H_MSG) & BIT_MASK_HCI_PCIE_C2H_MSG) -+#define BIT_SET_HCI_PCIE_C2H_MSG(x, v) \ -+ (BIT_CLEAR_HCI_PCIE_C2H_MSG(x) | BIT_HCI_PCIE_C2H_MSG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_C2H_MSG_V1 (Offset 0x03E4) */ -+ -+#define BIT_SHIFT_HCI_C2H_MSG 0 -+#define BIT_MASK_HCI_C2H_MSG 0xffffffffL -+#define BIT_HCI_C2H_MSG(x) \ -+ (((x) & BIT_MASK_HCI_C2H_MSG) << BIT_SHIFT_HCI_C2H_MSG) -+#define BITS_HCI_C2H_MSG (BIT_MASK_HCI_C2H_MSG << BIT_SHIFT_HCI_C2H_MSG) -+#define BIT_CLEAR_HCI_C2H_MSG(x) ((x) & (~BITS_HCI_C2H_MSG)) -+#define BIT_GET_HCI_C2H_MSG(x) \ -+ (((x) >> BIT_SHIFT_HCI_C2H_MSG) & BIT_MASK_HCI_C2H_MSG) -+#define BIT_SET_HCI_C2H_MSG(x, v) \ -+ (BIT_CLEAR_HCI_C2H_MSG(x) | BIT_HCI_C2H_MSG(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DBI_WDATA_V1 (Offset 0x03E8) */ -+ -+#define BIT_SHIFT_DBI_WDATA 0 -+#define BIT_MASK_DBI_WDATA 0xffffffffL -+#define BIT_DBI_WDATA(x) (((x) & BIT_MASK_DBI_WDATA) << BIT_SHIFT_DBI_WDATA) -+#define BITS_DBI_WDATA (BIT_MASK_DBI_WDATA << BIT_SHIFT_DBI_WDATA) -+#define BIT_CLEAR_DBI_WDATA(x) ((x) & (~BITS_DBI_WDATA)) -+#define BIT_GET_DBI_WDATA(x) (((x) >> BIT_SHIFT_DBI_WDATA) & BIT_MASK_DBI_WDATA) -+#define BIT_SET_DBI_WDATA(x, v) (BIT_CLEAR_DBI_WDATA(x) | BIT_DBI_WDATA(v)) -+ -+/* 2 REG_DBI_RDATA_V1 (Offset 0x03EC) */ -+ -+#define BIT_SHIFT_DBI_RDATA 0 -+#define BIT_MASK_DBI_RDATA 0xffffffffL -+#define BIT_DBI_RDATA(x) (((x) & BIT_MASK_DBI_RDATA) << BIT_SHIFT_DBI_RDATA) -+#define BITS_DBI_RDATA (BIT_MASK_DBI_RDATA << BIT_SHIFT_DBI_RDATA) -+#define BIT_CLEAR_DBI_RDATA(x) ((x) & (~BITS_DBI_RDATA)) -+#define BIT_GET_DBI_RDATA(x) (((x) >> BIT_SHIFT_DBI_RDATA) & BIT_MASK_DBI_RDATA) -+#define BIT_SET_DBI_RDATA(x, v) (BIT_CLEAR_DBI_RDATA(x) | BIT_DBI_RDATA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DBI_FLAG_V1 (Offset 0x03F0) */ -+ -+#define BIT_SHIFT_LOOPBACK_DBG_SEL 28 -+#define BIT_MASK_LOOPBACK_DBG_SEL 0xf -+#define BIT_LOOPBACK_DBG_SEL(x) \ -+ (((x) & BIT_MASK_LOOPBACK_DBG_SEL) << BIT_SHIFT_LOOPBACK_DBG_SEL) -+#define BITS_LOOPBACK_DBG_SEL \ -+ (BIT_MASK_LOOPBACK_DBG_SEL << BIT_SHIFT_LOOPBACK_DBG_SEL) -+#define BIT_CLEAR_LOOPBACK_DBG_SEL(x) ((x) & (~BITS_LOOPBACK_DBG_SEL)) -+#define BIT_GET_LOOPBACK_DBG_SEL(x) \ -+ (((x) >> BIT_SHIFT_LOOPBACK_DBG_SEL) & BIT_MASK_LOOPBACK_DBG_SEL) -+#define BIT_SET_LOOPBACK_DBG_SEL(x, v) \ -+ (BIT_CLEAR_LOOPBACK_DBG_SEL(x) | BIT_LOOPBACK_DBG_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_STUCK_FLAG_V1 (Offset 0x03F0) */ -+ -+#define BIT_EN_STUCK_DBG BIT(26) -+#define BIT_RX_STUCK BIT(25) -+#define BIT_TX_STUCK BIT(24) -+#define BIT_DBI_RFLAG BIT(17) -+#define BIT_DBI_WFLAG BIT(16) -+ -+#define BIT_SHIFT_DBI_WREN 12 -+#define BIT_MASK_DBI_WREN 0xf -+#define BIT_DBI_WREN(x) (((x) & BIT_MASK_DBI_WREN) << BIT_SHIFT_DBI_WREN) -+#define BITS_DBI_WREN (BIT_MASK_DBI_WREN << BIT_SHIFT_DBI_WREN) -+#define BIT_CLEAR_DBI_WREN(x) ((x) & (~BITS_DBI_WREN)) -+#define BIT_GET_DBI_WREN(x) (((x) >> BIT_SHIFT_DBI_WREN) & BIT_MASK_DBI_WREN) -+#define BIT_SET_DBI_WREN(x, v) (BIT_CLEAR_DBI_WREN(x) | BIT_DBI_WREN(v)) -+ -+#define BIT_SHIFT_DBI_ADDR 0 -+#define BIT_MASK_DBI_ADDR 0xfff -+#define BIT_DBI_ADDR(x) (((x) & BIT_MASK_DBI_ADDR) << BIT_SHIFT_DBI_ADDR) -+#define BITS_DBI_ADDR (BIT_MASK_DBI_ADDR << BIT_SHIFT_DBI_ADDR) -+#define BIT_CLEAR_DBI_ADDR(x) ((x) & (~BITS_DBI_ADDR)) -+#define BIT_GET_DBI_ADDR(x) (((x) >> BIT_SHIFT_DBI_ADDR) & BIT_MASK_DBI_ADDR) -+#define BIT_SET_DBI_ADDR(x, v) (BIT_CLEAR_DBI_ADDR(x) | BIT_DBI_ADDR(v)) -+ -+/* 2 REG_MDIO_V1 (Offset 0x03F4) */ -+ -+#define BIT_SHIFT_MDIO_RDATA 16 -+#define BIT_MASK_MDIO_RDATA 0xffff -+#define BIT_MDIO_RDATA(x) (((x) & BIT_MASK_MDIO_RDATA) << BIT_SHIFT_MDIO_RDATA) -+#define BITS_MDIO_RDATA (BIT_MASK_MDIO_RDATA << BIT_SHIFT_MDIO_RDATA) -+#define BIT_CLEAR_MDIO_RDATA(x) ((x) & (~BITS_MDIO_RDATA)) -+#define BIT_GET_MDIO_RDATA(x) \ -+ (((x) >> BIT_SHIFT_MDIO_RDATA) & BIT_MASK_MDIO_RDATA) -+#define BIT_SET_MDIO_RDATA(x, v) (BIT_CLEAR_MDIO_RDATA(x) | BIT_MDIO_RDATA(v)) -+ -+#define BIT_SHIFT_MDIO_WDATA 0 -+#define BIT_MASK_MDIO_WDATA 0xffff -+#define BIT_MDIO_WDATA(x) (((x) & BIT_MASK_MDIO_WDATA) << BIT_SHIFT_MDIO_WDATA) -+#define BITS_MDIO_WDATA (BIT_MASK_MDIO_WDATA << BIT_SHIFT_MDIO_WDATA) -+#define BIT_CLEAR_MDIO_WDATA(x) ((x) & (~BITS_MDIO_WDATA)) -+#define BIT_GET_MDIO_WDATA(x) \ -+ (((x) >> BIT_SHIFT_MDIO_WDATA) & BIT_MASK_MDIO_WDATA) -+#define BIT_SET_MDIO_WDATA(x, v) (BIT_CLEAR_MDIO_WDATA(x) | BIT_MDIO_WDATA(v)) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BUS_MIX_CFG (Offset 0x03F8) */ -+ -+#define BIT_SHIFT_DELAY_TIME 24 -+#define BIT_MASK_DELAY_TIME 0xff -+#define BIT_DELAY_TIME(x) (((x) & BIT_MASK_DELAY_TIME) << BIT_SHIFT_DELAY_TIME) -+#define BITS_DELAY_TIME (BIT_MASK_DELAY_TIME << BIT_SHIFT_DELAY_TIME) -+#define BIT_CLEAR_DELAY_TIME(x) ((x) & (~BITS_DELAY_TIME)) -+#define BIT_GET_DELAY_TIME(x) \ -+ (((x) >> BIT_SHIFT_DELAY_TIME) & BIT_MASK_DELAY_TIME) -+#define BIT_SET_DELAY_TIME(x, v) (BIT_CLEAR_DELAY_TIME(x) | BIT_DELAY_TIME(v)) -+ -+#define BIT_RX_TIMER_DELAY_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_MIX_CFG (Offset 0x03F8) */ -+ -+#define BIT_EN_WATCH_DOG BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MDIO2_V1 (Offset 0x03F8) */ -+ -+#define BIT_ECRC_EN BIT(7) -+#define BIT_MDIO_RFLAG BIT(6) -+#define BIT_MDIO_WFLAG BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_MDIO2_V1 (Offset 0x03F8) */ -+ -+#define BIT_SHIFT_MDIO_ADDR 0 -+#define BIT_MASK_MDIO_ADDR 0x1f -+#define BIT_MDIO_ADDR(x) (((x) & BIT_MASK_MDIO_ADDR) << BIT_SHIFT_MDIO_ADDR) -+#define BITS_MDIO_ADDR (BIT_MASK_MDIO_ADDR << BIT_SHIFT_MDIO_ADDR) -+#define BIT_CLEAR_MDIO_ADDR(x) ((x) & (~BITS_MDIO_ADDR)) -+#define BIT_GET_MDIO_ADDR(x) (((x) >> BIT_SHIFT_MDIO_ADDR) & BIT_MASK_MDIO_ADDR) -+#define BIT_SET_MDIO_ADDR(x, v) (BIT_CLEAR_MDIO_ADDR(x) | BIT_MDIO_ADDR(v)) -+ -+#define BIT_SHIFT_TXFAIL_DROPCNT 0 -+#define BIT_MASK_TXFAIL_DROPCNT 0xffff -+#define BIT_TXFAIL_DROPCNT(x) \ -+ (((x) & BIT_MASK_TXFAIL_DROPCNT) << BIT_SHIFT_TXFAIL_DROPCNT) -+#define BITS_TXFAIL_DROPCNT \ -+ (BIT_MASK_TXFAIL_DROPCNT << BIT_SHIFT_TXFAIL_DROPCNT) -+#define BIT_CLEAR_TXFAIL_DROPCNT(x) ((x) & (~BITS_TXFAIL_DROPCNT)) -+#define BIT_GET_TXFAIL_DROPCNT(x) \ -+ (((x) >> BIT_SHIFT_TXFAIL_DROPCNT) & BIT_MASK_TXFAIL_DROPCNT) -+#define BIT_SET_TXFAIL_DROPCNT(x, v) \ -+ (BIT_CLEAR_TXFAIL_DROPCNT(x) | BIT_TXFAIL_DROPCNT(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_MIX_CFG (Offset 0x03F8) */ -+ -+#define BIT_SHIFT_MDIO_REG_ADDR_V1 0 -+#define BIT_MASK_MDIO_REG_ADDR_V1 0x1f -+#define BIT_MDIO_REG_ADDR_V1(x) \ -+ (((x) & BIT_MASK_MDIO_REG_ADDR_V1) << BIT_SHIFT_MDIO_REG_ADDR_V1) -+#define BITS_MDIO_REG_ADDR_V1 \ -+ (BIT_MASK_MDIO_REG_ADDR_V1 << BIT_SHIFT_MDIO_REG_ADDR_V1) -+#define BIT_CLEAR_MDIO_REG_ADDR_V1(x) ((x) & (~BITS_MDIO_REG_ADDR_V1)) -+#define BIT_GET_MDIO_REG_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_MDIO_REG_ADDR_V1) & BIT_MASK_MDIO_REG_ADDR_V1) -+#define BIT_SET_MDIO_REG_ADDR_V1(x, v) \ -+ (BIT_CLEAR_MDIO_REG_ADDR_V1(x) | BIT_MDIO_REG_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_RXRST_BACKDOOR BIT(31) -+#define BIT_TXRST_BACKDOOR BIT(30) -+#define BIT_RXIDX_RSTB BIT(29) -+#define BIT_TXIDX_RSTB BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_SHIFT_WATCH_DOG_TIMER 28 -+#define BIT_MASK_WATCH_DOG_TIMER 0xf -+#define BIT_WATCH_DOG_TIMER(x) \ -+ (((x) & BIT_MASK_WATCH_DOG_TIMER) << BIT_SHIFT_WATCH_DOG_TIMER) -+#define BITS_WATCH_DOG_TIMER \ -+ (BIT_MASK_WATCH_DOG_TIMER << BIT_SHIFT_WATCH_DOG_TIMER) -+#define BIT_CLEAR_WATCH_DOG_TIMER(x) ((x) & (~BITS_WATCH_DOG_TIMER)) -+#define BIT_GET_WATCH_DOG_TIMER(x) \ -+ (((x) >> BIT_SHIFT_WATCH_DOG_TIMER) & BIT_MASK_WATCH_DOG_TIMER) -+#define BIT_SET_WATCH_DOG_TIMER(x, v) \ -+ (BIT_CLEAR_WATCH_DOG_TIMER(x) | BIT_WATCH_DOG_TIMER(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_DROP_NEXT_RXPKT BIT(27) -+#define BIT_SHORT_CORE_RST_SEL BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EXCEPT_RESUME_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EXCEPT_FLAG BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EXCEPT_RESUME_FLAG BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_ALIGN_MTU BIT(23) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EN_ALIGN_MTU BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EARLY_TAG_RETURN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_SHIFT_LATENCY_CONTROL 21 -+#define BIT_MASK_LATENCY_CONTROL 0x3 -+#define BIT_LATENCY_CONTROL(x) \ -+ (((x) & BIT_MASK_LATENCY_CONTROL) << BIT_SHIFT_LATENCY_CONTROL) -+#define BITS_LATENCY_CONTROL \ -+ (BIT_MASK_LATENCY_CONTROL << BIT_SHIFT_LATENCY_CONTROL) -+#define BIT_CLEAR_LATENCY_CONTROL(x) ((x) & (~BITS_LATENCY_CONTROL)) -+#define BIT_GET_LATENCY_CONTROL(x) \ -+ (((x) >> BIT_SHIFT_LATENCY_CONTROL) & BIT_MASK_LATENCY_CONTROL) -+#define BIT_SET_LATENCY_CONTROL(x, v) \ -+ (BIT_CLEAR_LATENCY_CONTROL(x) | BIT_LATENCY_CONTROL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_HOST_GEN2_SUPPORT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_SHIFT_TXDMA_ERR_FLAG 16 -+#define BIT_MASK_TXDMA_ERR_FLAG 0xf -+#define BIT_TXDMA_ERR_FLAG(x) \ -+ (((x) & BIT_MASK_TXDMA_ERR_FLAG) << BIT_SHIFT_TXDMA_ERR_FLAG) -+#define BITS_TXDMA_ERR_FLAG \ -+ (BIT_MASK_TXDMA_ERR_FLAG << BIT_SHIFT_TXDMA_ERR_FLAG) -+#define BIT_CLEAR_TXDMA_ERR_FLAG(x) ((x) & (~BITS_TXDMA_ERR_FLAG)) -+#define BIT_GET_TXDMA_ERR_FLAG(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_ERR_FLAG) & BIT_MASK_TXDMA_ERR_FLAG) -+#define BIT_SET_TXDMA_ERR_FLAG(x, v) \ -+ (BIT_CLEAR_TXDMA_ERR_FLAG(x) | BIT_TXDMA_ERR_FLAG(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_SHIFT_TXDMA_ERR_FLAG_V1 15 -+#define BIT_MASK_TXDMA_ERR_FLAG_V1 0x1f -+#define BIT_TXDMA_ERR_FLAG_V1(x) \ -+ (((x) & BIT_MASK_TXDMA_ERR_FLAG_V1) << BIT_SHIFT_TXDMA_ERR_FLAG_V1) -+#define BITS_TXDMA_ERR_FLAG_V1 \ -+ (BIT_MASK_TXDMA_ERR_FLAG_V1 << BIT_SHIFT_TXDMA_ERR_FLAG_V1) -+#define BIT_CLEAR_TXDMA_ERR_FLAG_V1(x) ((x) & (~BITS_TXDMA_ERR_FLAG_V1)) -+#define BIT_GET_TXDMA_ERR_FLAG_V1(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_ERR_FLAG_V1) & BIT_MASK_TXDMA_ERR_FLAG_V1) -+#define BIT_SET_TXDMA_ERR_FLAG_V1(x, v) \ -+ (BIT_CLEAR_TXDMA_ERR_FLAG_V1(x) | BIT_TXDMA_ERR_FLAG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_SHIFT_EARLY_MODE_SEL 12 -+#define BIT_MASK_EARLY_MODE_SEL 0xf -+#define BIT_EARLY_MODE_SEL(x) \ -+ (((x) & BIT_MASK_EARLY_MODE_SEL) << BIT_SHIFT_EARLY_MODE_SEL) -+#define BITS_EARLY_MODE_SEL \ -+ (BIT_MASK_EARLY_MODE_SEL << BIT_SHIFT_EARLY_MODE_SEL) -+#define BIT_CLEAR_EARLY_MODE_SEL(x) ((x) & (~BITS_EARLY_MODE_SEL)) -+#define BIT_GET_EARLY_MODE_SEL(x) \ -+ (((x) >> BIT_SHIFT_EARLY_MODE_SEL) & BIT_MASK_EARLY_MODE_SEL) -+#define BIT_SET_EARLY_MODE_SEL(x, v) \ -+ (BIT_CLEAR_EARLY_MODE_SEL(x) | BIT_EARLY_MODE_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EPHY_RX50_EN BIT(11) -+ -+#define BIT_SHIFT_MSI_TIMEOUT_ID_V1 8 -+#define BIT_MASK_MSI_TIMEOUT_ID_V1 0x7 -+#define BIT_MSI_TIMEOUT_ID_V1(x) \ -+ (((x) & BIT_MASK_MSI_TIMEOUT_ID_V1) << BIT_SHIFT_MSI_TIMEOUT_ID_V1) -+#define BITS_MSI_TIMEOUT_ID_V1 \ -+ (BIT_MASK_MSI_TIMEOUT_ID_V1 << BIT_SHIFT_MSI_TIMEOUT_ID_V1) -+#define BIT_CLEAR_MSI_TIMEOUT_ID_V1(x) ((x) & (~BITS_MSI_TIMEOUT_ID_V1)) -+#define BIT_GET_MSI_TIMEOUT_ID_V1(x) \ -+ (((x) >> BIT_SHIFT_MSI_TIMEOUT_ID_V1) & BIT_MASK_MSI_TIMEOUT_ID_V1) -+#define BIT_SET_MSI_TIMEOUT_ID_V1(x, v) \ -+ (BIT_CLEAR_MSI_TIMEOUT_ID_V1(x) | BIT_MSI_TIMEOUT_ID_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_SHIFT_RXDMA_ERR_CNT 8 -+#define BIT_MASK_RXDMA_ERR_CNT 0xff -+#define BIT_RXDMA_ERR_CNT(x) \ -+ (((x) & BIT_MASK_RXDMA_ERR_CNT) << BIT_SHIFT_RXDMA_ERR_CNT) -+#define BITS_RXDMA_ERR_CNT (BIT_MASK_RXDMA_ERR_CNT << BIT_SHIFT_RXDMA_ERR_CNT) -+#define BIT_CLEAR_RXDMA_ERR_CNT(x) ((x) & (~BITS_RXDMA_ERR_CNT)) -+#define BIT_GET_RXDMA_ERR_CNT(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_ERR_CNT) & BIT_MASK_RXDMA_ERR_CNT) -+#define BIT_SET_RXDMA_ERR_CNT(x, v) \ -+ (BIT_CLEAR_RXDMA_ERR_CNT(x) | BIT_RXDMA_ERR_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_RADDR_RD BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_TXDMA_ERR_HANDLE_REQ BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EN_MUL_TAG BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_TXDMA_ERROR_PS BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_L1OFF_PWR_OFF_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EN_EARLY_MODE BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EN_TXDMA_STUCK_ERR_HANDLE BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_L0S_LINK_OFF BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EN_TXDMA_RTN_ERR_HANDLE BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_ACT_LINK_OFF BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_RXDMA_ERR_HANDLE_REQ BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EN_SLOW_MAC_TX BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_RXDMA_ERROR_PS BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EN_SLOW_MAC_RX BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HCI_MIX_CFG (Offset 0x03FC) */ -+ -+#define BIT_EN_RXDMA_STUCK_ERR_HANDLE BIT(1) -+#define BIT_EN_SLOW_MAC_HW BIT(0) -+#define BIT_EN_RXDMA_RTN_ERR_HANDLE BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q0_INFO (Offset 0x0400) */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q0_V1 25 -+#define BIT_MASK_QUEUEMACID_Q0_V1 0x7f -+#define BIT_QUEUEMACID_Q0_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q0_V1) << BIT_SHIFT_QUEUEMACID_Q0_V1) -+#define BITS_QUEUEMACID_Q0_V1 \ -+ (BIT_MASK_QUEUEMACID_Q0_V1 << BIT_SHIFT_QUEUEMACID_Q0_V1) -+#define BIT_CLEAR_QUEUEMACID_Q0_V1(x) ((x) & (~BITS_QUEUEMACID_Q0_V1)) -+#define BIT_GET_QUEUEMACID_Q0_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q0_V1) & BIT_MASK_QUEUEMACID_Q0_V1) -+#define BIT_SET_QUEUEMACID_Q0_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q0_V1(x) | BIT_QUEUEMACID_Q0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_QUEUE_INFO1 (Offset 0x0400) */ -+ -+#define BIT_SHIFT_QUEUEMACID 25 -+#define BIT_MASK_QUEUEMACID 0x7f -+#define BIT_QUEUEMACID(x) (((x) & BIT_MASK_QUEUEMACID) << BIT_SHIFT_QUEUEMACID) -+#define BITS_QUEUEMACID (BIT_MASK_QUEUEMACID << BIT_SHIFT_QUEUEMACID) -+#define BIT_CLEAR_QUEUEMACID(x) ((x) & (~BITS_QUEUEMACID)) -+#define BIT_GET_QUEUEMACID(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID) & BIT_MASK_QUEUEMACID) -+#define BIT_SET_QUEUEMACID(x, v) (BIT_CLEAR_QUEUEMACID(x) | BIT_QUEUEMACID(v)) -+ -+#define BIT_DONE BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q0_INFO (Offset 0x0400) */ -+ -+#define BIT_SHIFT_QUEUEAC_Q0_V1 23 -+#define BIT_MASK_QUEUEAC_Q0_V1 0x3 -+#define BIT_QUEUEAC_Q0_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q0_V1) << BIT_SHIFT_QUEUEAC_Q0_V1) -+#define BITS_QUEUEAC_Q0_V1 (BIT_MASK_QUEUEAC_Q0_V1 << BIT_SHIFT_QUEUEAC_Q0_V1) -+#define BIT_CLEAR_QUEUEAC_Q0_V1(x) ((x) & (~BITS_QUEUEAC_Q0_V1)) -+#define BIT_GET_QUEUEAC_Q0_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q0_V1) & BIT_MASK_QUEUEAC_Q0_V1) -+#define BIT_SET_QUEUEAC_Q0_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q0_V1(x) | BIT_QUEUEAC_Q0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_QUEUE_INFO1 (Offset 0x0400) */ -+ -+#define BIT_SHIFT_QUEUEAC 23 -+#define BIT_MASK_QUEUEAC 0x3 -+#define BIT_QUEUEAC(x) (((x) & BIT_MASK_QUEUEAC) << BIT_SHIFT_QUEUEAC) -+#define BITS_QUEUEAC (BIT_MASK_QUEUEAC << BIT_SHIFT_QUEUEAC) -+#define BIT_CLEAR_QUEUEAC(x) ((x) & (~BITS_QUEUEAC)) -+#define BIT_GET_QUEUEAC(x) (((x) >> BIT_SHIFT_QUEUEAC) & BIT_MASK_QUEUEAC) -+#define BIT_SET_QUEUEAC(x, v) (BIT_CLEAR_QUEUEAC(x) | BIT_QUEUEAC(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q0_INFO (Offset 0x0400) */ -+ -+#define BIT_TIDEMPTY_Q0_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_QUEUE_INFO1 (Offset 0x0400) */ -+ -+#define BIT_TIDEMPTY BIT(22) -+ -+#define BIT_SHIFT_ACCWBITEN 20 -+#define BIT_MASK_ACCWBITEN 0xf -+#define BIT_ACCWBITEN(x) (((x) & BIT_MASK_ACCWBITEN) << BIT_SHIFT_ACCWBITEN) -+#define BITS_ACCWBITEN (BIT_MASK_ACCWBITEN << BIT_SHIFT_ACCWBITEN) -+#define BIT_CLEAR_ACCWBITEN(x) ((x) & (~BITS_ACCWBITEN)) -+#define BIT_GET_ACCWBITEN(x) (((x) >> BIT_SHIFT_ACCWBITEN) & BIT_MASK_ACCWBITEN) -+#define BIT_SET_ACCWBITEN(x, v) (BIT_CLEAR_ACCWBITEN(x) | BIT_ACCWBITEN(v)) -+ -+#define BIT_BCNQ_EMPTY_V1 BIT(19) -+#define BIT_HIQ_EMPTY_V1 BIT(18) -+#define BIT_MQQ_EMPTY_V1 BIT(17) -+ -+#define BIT_SHIFT_COL_CNT 16 -+#define BIT_MASK_COL_CNT 0xf -+#define BIT_COL_CNT(x) (((x) & BIT_MASK_COL_CNT) << BIT_SHIFT_COL_CNT) -+#define BITS_COL_CNT (BIT_MASK_COL_CNT << BIT_SHIFT_COL_CNT) -+#define BIT_CLEAR_COL_CNT(x) ((x) & (~BITS_COL_CNT)) -+#define BIT_GET_COL_CNT(x) (((x) >> BIT_SHIFT_COL_CNT) & BIT_MASK_COL_CNT) -+#define BIT_SET_COL_CNT(x, v) (BIT_CLEAR_COL_CNT(x) | BIT_COL_CNT(v)) -+ -+#define BIT_CPU_MGT_EMPTY BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q0_INFO (Offset 0x0400) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q0_V1 15 -+#define BIT_MASK_TAIL_PKT_Q0_V1 0xff -+#define BIT_TAIL_PKT_Q0_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q0_V1) << BIT_SHIFT_TAIL_PKT_Q0_V1) -+#define BITS_TAIL_PKT_Q0_V1 \ -+ (BIT_MASK_TAIL_PKT_Q0_V1 << BIT_SHIFT_TAIL_PKT_Q0_V1) -+#define BIT_CLEAR_TAIL_PKT_Q0_V1(x) ((x) & (~BITS_TAIL_PKT_Q0_V1)) -+#define BIT_GET_TAIL_PKT_Q0_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q0_V1) & BIT_MASK_TAIL_PKT_Q0_V1) -+#define BIT_SET_TAIL_PKT_Q0_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q0_V1(x) | BIT_TAIL_PKT_Q0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_QUEUE_INFO1 (Offset 0x0400) */ -+ -+#define BIT_AC_MACID_NOT_SAME BIT(15) -+ -+#define BIT_SHIFT_GROUP_TABLE_ID 12 -+#define BIT_MASK_GROUP_TABLE_ID 0x7 -+#define BIT_GROUP_TABLE_ID(x) \ -+ (((x) & BIT_MASK_GROUP_TABLE_ID) << BIT_SHIFT_GROUP_TABLE_ID) -+#define BITS_GROUP_TABLE_ID \ -+ (BIT_MASK_GROUP_TABLE_ID << BIT_SHIFT_GROUP_TABLE_ID) -+#define BIT_CLEAR_GROUP_TABLE_ID(x) ((x) & (~BITS_GROUP_TABLE_ID)) -+#define BIT_GET_GROUP_TABLE_ID(x) \ -+ (((x) >> BIT_SHIFT_GROUP_TABLE_ID) & BIT_MASK_GROUP_TABLE_ID) -+#define BIT_SET_GROUP_TABLE_ID(x, v) \ -+ (BIT_CLEAR_GROUP_TABLE_ID(x) | BIT_GROUP_TABLE_ID(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q0_INFO (Offset 0x0400) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q0_V2 11 -+#define BIT_MASK_TAIL_PKT_Q0_V2 0x7ff -+#define BIT_TAIL_PKT_Q0_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q0_V2) << BIT_SHIFT_TAIL_PKT_Q0_V2) -+#define BITS_TAIL_PKT_Q0_V2 \ -+ (BIT_MASK_TAIL_PKT_Q0_V2 << BIT_SHIFT_TAIL_PKT_Q0_V2) -+#define BIT_CLEAR_TAIL_PKT_Q0_V2(x) ((x) & (~BITS_TAIL_PKT_Q0_V2)) -+#define BIT_GET_TAIL_PKT_Q0_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q0_V2) & BIT_MASK_TAIL_PKT_Q0_V2) -+#define BIT_SET_TAIL_PKT_Q0_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q0_V2(x) | BIT_TAIL_PKT_Q0_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_QUEUE_INFO1 (Offset 0x0400) */ -+ -+#define BIT_SHIFT_TAIL_PKT 11 -+#define BIT_MASK_TAIL_PKT 0x7ff -+#define BIT_TAIL_PKT(x) (((x) & BIT_MASK_TAIL_PKT) << BIT_SHIFT_TAIL_PKT) -+#define BITS_TAIL_PKT (BIT_MASK_TAIL_PKT << BIT_SHIFT_TAIL_PKT) -+#define BIT_CLEAR_TAIL_PKT(x) ((x) & (~BITS_TAIL_PKT)) -+#define BIT_GET_TAIL_PKT(x) (((x) >> BIT_SHIFT_TAIL_PKT) & BIT_MASK_TAIL_PKT) -+#define BIT_SET_TAIL_PKT(x, v) (BIT_CLEAR_TAIL_PKT(x) | BIT_TAIL_PKT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q0_INFO (Offset 0x0400) */ -+ -+#define BIT_SHIFT_PKT_NUM_Q0_V1 8 -+#define BIT_MASK_PKT_NUM_Q0_V1 0x7f -+#define BIT_PKT_NUM_Q0_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_Q0_V1) << BIT_SHIFT_PKT_NUM_Q0_V1) -+#define BITS_PKT_NUM_Q0_V1 (BIT_MASK_PKT_NUM_Q0_V1 << BIT_SHIFT_PKT_NUM_Q0_V1) -+#define BIT_CLEAR_PKT_NUM_Q0_V1(x) ((x) & (~BITS_PKT_NUM_Q0_V1)) -+#define BIT_GET_PKT_NUM_Q0_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_Q0_V1) & BIT_MASK_PKT_NUM_Q0_V1) -+#define BIT_SET_PKT_NUM_Q0_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_Q0_V1(x) | BIT_PKT_NUM_Q0_V1(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q0 0 -+#define BIT_MASK_HEAD_PKT_Q0 0xff -+#define BIT_HEAD_PKT_Q0(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q0) << BIT_SHIFT_HEAD_PKT_Q0) -+#define BITS_HEAD_PKT_Q0 (BIT_MASK_HEAD_PKT_Q0 << BIT_SHIFT_HEAD_PKT_Q0) -+#define BIT_CLEAR_HEAD_PKT_Q0(x) ((x) & (~BITS_HEAD_PKT_Q0)) -+#define BIT_GET_HEAD_PKT_Q0(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q0) & BIT_MASK_HEAD_PKT_Q0) -+#define BIT_SET_HEAD_PKT_Q0(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q0(x) | BIT_HEAD_PKT_Q0(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q0_INFO (Offset 0x0400) */ -+ -+#define BIT_SHIFT_HEAD_PKT_Q0_V1 0 -+#define BIT_MASK_HEAD_PKT_Q0_V1 0x7ff -+#define BIT_HEAD_PKT_Q0_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q0_V1) << BIT_SHIFT_HEAD_PKT_Q0_V1) -+#define BITS_HEAD_PKT_Q0_V1 \ -+ (BIT_MASK_HEAD_PKT_Q0_V1 << BIT_SHIFT_HEAD_PKT_Q0_V1) -+#define BIT_CLEAR_HEAD_PKT_Q0_V1(x) ((x) & (~BITS_HEAD_PKT_Q0_V1)) -+#define BIT_GET_HEAD_PKT_Q0_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q0_V1) & BIT_MASK_HEAD_PKT_Q0_V1) -+#define BIT_SET_HEAD_PKT_Q0_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q0_V1(x) | BIT_HEAD_PKT_Q0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_QUEUE_INFO1 (Offset 0x0400) */ -+ -+#define BIT_SHIFT_HEAD_PKT 0 -+#define BIT_MASK_HEAD_PKT 0x7ff -+#define BIT_HEAD_PKT(x) (((x) & BIT_MASK_HEAD_PKT) << BIT_SHIFT_HEAD_PKT) -+#define BITS_HEAD_PKT (BIT_MASK_HEAD_PKT << BIT_SHIFT_HEAD_PKT) -+#define BIT_CLEAR_HEAD_PKT(x) ((x) & (~BITS_HEAD_PKT)) -+#define BIT_GET_HEAD_PKT(x) (((x) >> BIT_SHIFT_HEAD_PKT) & BIT_MASK_HEAD_PKT) -+#define BIT_SET_HEAD_PKT(x, v) (BIT_CLEAR_HEAD_PKT(x) | BIT_HEAD_PKT(v)) -+ -+#define BIT_SHIFT_PKT_NUMBER 0 -+#define BIT_MASK_PKT_NUMBER 0xfff -+#define BIT_PKT_NUMBER(x) (((x) & BIT_MASK_PKT_NUMBER) << BIT_SHIFT_PKT_NUMBER) -+#define BITS_PKT_NUMBER (BIT_MASK_PKT_NUMBER << BIT_SHIFT_PKT_NUMBER) -+#define BIT_CLEAR_PKT_NUMBER(x) ((x) & (~BITS_PKT_NUMBER)) -+#define BIT_GET_PKT_NUMBER(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUMBER) & BIT_MASK_PKT_NUMBER) -+#define BIT_SET_PKT_NUMBER(x, v) (BIT_CLEAR_PKT_NUMBER(x) | BIT_PKT_NUMBER(v)) -+ -+#define BIT_SHIFT_ACCW 0 -+#define BIT_MASK_ACCW 0x3ff -+#define BIT_ACCW(x) (((x) & BIT_MASK_ACCW) << BIT_SHIFT_ACCW) -+#define BITS_ACCW (BIT_MASK_ACCW << BIT_SHIFT_ACCW) -+#define BIT_CLEAR_ACCW(x) ((x) & (~BITS_ACCW)) -+#define BIT_GET_ACCW(x) (((x) >> BIT_SHIFT_ACCW) & BIT_MASK_ACCW) -+#define BIT_SET_ACCW(x, v) (BIT_CLEAR_ACCW(x) | BIT_ACCW(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_INFO0 (Offset 0x0400) */ -+ -+#define BIT_SHIFT_QINFO0 0 -+#define BIT_MASK_QINFO0 0xffffffffL -+#define BIT_QINFO0(x) (((x) & BIT_MASK_QINFO0) << BIT_SHIFT_QINFO0) -+#define BITS_QINFO0 (BIT_MASK_QINFO0 << BIT_SHIFT_QINFO0) -+#define BIT_CLEAR_QINFO0(x) ((x) & (~BITS_QINFO0)) -+#define BIT_GET_QINFO0(x) (((x) >> BIT_SHIFT_QINFO0) & BIT_MASK_QINFO0) -+#define BIT_SET_QINFO0(x, v) (BIT_CLEAR_QINFO0(x) | BIT_QINFO0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q1_INFO (Offset 0x0404) */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q1_V1 25 -+#define BIT_MASK_QUEUEMACID_Q1_V1 0x7f -+#define BIT_QUEUEMACID_Q1_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q1_V1) << BIT_SHIFT_QUEUEMACID_Q1_V1) -+#define BITS_QUEUEMACID_Q1_V1 \ -+ (BIT_MASK_QUEUEMACID_Q1_V1 << BIT_SHIFT_QUEUEMACID_Q1_V1) -+#define BIT_CLEAR_QUEUEMACID_Q1_V1(x) ((x) & (~BITS_QUEUEMACID_Q1_V1)) -+#define BIT_GET_QUEUEMACID_Q1_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q1_V1) & BIT_MASK_QUEUEMACID_Q1_V1) -+#define BIT_SET_QUEUEMACID_Q1_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q1_V1(x) | BIT_QUEUEMACID_Q1_V1(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q1_V1 23 -+#define BIT_MASK_QUEUEAC_Q1_V1 0x3 -+#define BIT_QUEUEAC_Q1_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q1_V1) << BIT_SHIFT_QUEUEAC_Q1_V1) -+#define BITS_QUEUEAC_Q1_V1 (BIT_MASK_QUEUEAC_Q1_V1 << BIT_SHIFT_QUEUEAC_Q1_V1) -+#define BIT_CLEAR_QUEUEAC_Q1_V1(x) ((x) & (~BITS_QUEUEAC_Q1_V1)) -+#define BIT_GET_QUEUEAC_Q1_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q1_V1) & BIT_MASK_QUEUEAC_Q1_V1) -+#define BIT_SET_QUEUEAC_Q1_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q1_V1(x) | BIT_QUEUEAC_Q1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q1_INFO (Offset 0x0404) */ -+ -+#define BIT_TIDEMPTY_Q1_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q1_INFO (Offset 0x0404) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q1_V1 15 -+#define BIT_MASK_TAIL_PKT_Q1_V1 0xff -+#define BIT_TAIL_PKT_Q1_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q1_V1) << BIT_SHIFT_TAIL_PKT_Q1_V1) -+#define BITS_TAIL_PKT_Q1_V1 \ -+ (BIT_MASK_TAIL_PKT_Q1_V1 << BIT_SHIFT_TAIL_PKT_Q1_V1) -+#define BIT_CLEAR_TAIL_PKT_Q1_V1(x) ((x) & (~BITS_TAIL_PKT_Q1_V1)) -+#define BIT_GET_TAIL_PKT_Q1_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q1_V1) & BIT_MASK_TAIL_PKT_Q1_V1) -+#define BIT_SET_TAIL_PKT_Q1_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q1_V1(x) | BIT_TAIL_PKT_Q1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q1_INFO (Offset 0x0404) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q1_V2 11 -+#define BIT_MASK_TAIL_PKT_Q1_V2 0x7ff -+#define BIT_TAIL_PKT_Q1_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q1_V2) << BIT_SHIFT_TAIL_PKT_Q1_V2) -+#define BITS_TAIL_PKT_Q1_V2 \ -+ (BIT_MASK_TAIL_PKT_Q1_V2 << BIT_SHIFT_TAIL_PKT_Q1_V2) -+#define BIT_CLEAR_TAIL_PKT_Q1_V2(x) ((x) & (~BITS_TAIL_PKT_Q1_V2)) -+#define BIT_GET_TAIL_PKT_Q1_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q1_V2) & BIT_MASK_TAIL_PKT_Q1_V2) -+#define BIT_SET_TAIL_PKT_Q1_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q1_V2(x) | BIT_TAIL_PKT_Q1_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q1_INFO (Offset 0x0404) */ -+ -+#define BIT_SHIFT_PKT_NUM_Q1_V1 8 -+#define BIT_MASK_PKT_NUM_Q1_V1 0x7f -+#define BIT_PKT_NUM_Q1_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_Q1_V1) << BIT_SHIFT_PKT_NUM_Q1_V1) -+#define BITS_PKT_NUM_Q1_V1 (BIT_MASK_PKT_NUM_Q1_V1 << BIT_SHIFT_PKT_NUM_Q1_V1) -+#define BIT_CLEAR_PKT_NUM_Q1_V1(x) ((x) & (~BITS_PKT_NUM_Q1_V1)) -+#define BIT_GET_PKT_NUM_Q1_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_Q1_V1) & BIT_MASK_PKT_NUM_Q1_V1) -+#define BIT_SET_PKT_NUM_Q1_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_Q1_V1(x) | BIT_PKT_NUM_Q1_V1(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q1 0 -+#define BIT_MASK_HEAD_PKT_Q1 0xff -+#define BIT_HEAD_PKT_Q1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q1) << BIT_SHIFT_HEAD_PKT_Q1) -+#define BITS_HEAD_PKT_Q1 (BIT_MASK_HEAD_PKT_Q1 << BIT_SHIFT_HEAD_PKT_Q1) -+#define BIT_CLEAR_HEAD_PKT_Q1(x) ((x) & (~BITS_HEAD_PKT_Q1)) -+#define BIT_GET_HEAD_PKT_Q1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q1) & BIT_MASK_HEAD_PKT_Q1) -+#define BIT_SET_HEAD_PKT_Q1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q1(x) | BIT_HEAD_PKT_Q1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q1_INFO (Offset 0x0404) */ -+ -+#define BIT_SHIFT_HEAD_PKT_Q1_V1 0 -+#define BIT_MASK_HEAD_PKT_Q1_V1 0x7ff -+#define BIT_HEAD_PKT_Q1_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q1_V1) << BIT_SHIFT_HEAD_PKT_Q1_V1) -+#define BITS_HEAD_PKT_Q1_V1 \ -+ (BIT_MASK_HEAD_PKT_Q1_V1 << BIT_SHIFT_HEAD_PKT_Q1_V1) -+#define BIT_CLEAR_HEAD_PKT_Q1_V1(x) ((x) & (~BITS_HEAD_PKT_Q1_V1)) -+#define BIT_GET_HEAD_PKT_Q1_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q1_V1) & BIT_MASK_HEAD_PKT_Q1_V1) -+#define BIT_SET_HEAD_PKT_Q1_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q1_V1(x) | BIT_HEAD_PKT_Q1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_INFO1 (Offset 0x0404) */ -+ -+#define BIT_SHIFT_QINFO1 0 -+#define BIT_MASK_QINFO1 0xffffffffL -+#define BIT_QINFO1(x) (((x) & BIT_MASK_QINFO1) << BIT_SHIFT_QINFO1) -+#define BITS_QINFO1 (BIT_MASK_QINFO1 << BIT_SHIFT_QINFO1) -+#define BIT_CLEAR_QINFO1(x) ((x) & (~BITS_QINFO1)) -+#define BIT_GET_QINFO1(x) (((x) >> BIT_SHIFT_QINFO1) & BIT_MASK_QINFO1) -+#define BIT_SET_QINFO1(x, v) (BIT_CLEAR_QINFO1(x) | BIT_QINFO1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q2_INFO (Offset 0x0408) */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q2_V1 25 -+#define BIT_MASK_QUEUEMACID_Q2_V1 0x7f -+#define BIT_QUEUEMACID_Q2_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q2_V1) << BIT_SHIFT_QUEUEMACID_Q2_V1) -+#define BITS_QUEUEMACID_Q2_V1 \ -+ (BIT_MASK_QUEUEMACID_Q2_V1 << BIT_SHIFT_QUEUEMACID_Q2_V1) -+#define BIT_CLEAR_QUEUEMACID_Q2_V1(x) ((x) & (~BITS_QUEUEMACID_Q2_V1)) -+#define BIT_GET_QUEUEMACID_Q2_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q2_V1) & BIT_MASK_QUEUEMACID_Q2_V1) -+#define BIT_SET_QUEUEMACID_Q2_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q2_V1(x) | BIT_QUEUEMACID_Q2_V1(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q2_V1 23 -+#define BIT_MASK_QUEUEAC_Q2_V1 0x3 -+#define BIT_QUEUEAC_Q2_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q2_V1) << BIT_SHIFT_QUEUEAC_Q2_V1) -+#define BITS_QUEUEAC_Q2_V1 (BIT_MASK_QUEUEAC_Q2_V1 << BIT_SHIFT_QUEUEAC_Q2_V1) -+#define BIT_CLEAR_QUEUEAC_Q2_V1(x) ((x) & (~BITS_QUEUEAC_Q2_V1)) -+#define BIT_GET_QUEUEAC_Q2_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q2_V1) & BIT_MASK_QUEUEAC_Q2_V1) -+#define BIT_SET_QUEUEAC_Q2_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q2_V1(x) | BIT_QUEUEAC_Q2_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q2_INFO (Offset 0x0408) */ -+ -+#define BIT_TIDEMPTY_Q2_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q2_INFO (Offset 0x0408) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q2_V1 15 -+#define BIT_MASK_TAIL_PKT_Q2_V1 0xff -+#define BIT_TAIL_PKT_Q2_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q2_V1) << BIT_SHIFT_TAIL_PKT_Q2_V1) -+#define BITS_TAIL_PKT_Q2_V1 \ -+ (BIT_MASK_TAIL_PKT_Q2_V1 << BIT_SHIFT_TAIL_PKT_Q2_V1) -+#define BIT_CLEAR_TAIL_PKT_Q2_V1(x) ((x) & (~BITS_TAIL_PKT_Q2_V1)) -+#define BIT_GET_TAIL_PKT_Q2_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q2_V1) & BIT_MASK_TAIL_PKT_Q2_V1) -+#define BIT_SET_TAIL_PKT_Q2_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q2_V1(x) | BIT_TAIL_PKT_Q2_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q2_INFO (Offset 0x0408) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q2_V2 11 -+#define BIT_MASK_TAIL_PKT_Q2_V2 0x7ff -+#define BIT_TAIL_PKT_Q2_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q2_V2) << BIT_SHIFT_TAIL_PKT_Q2_V2) -+#define BITS_TAIL_PKT_Q2_V2 \ -+ (BIT_MASK_TAIL_PKT_Q2_V2 << BIT_SHIFT_TAIL_PKT_Q2_V2) -+#define BIT_CLEAR_TAIL_PKT_Q2_V2(x) ((x) & (~BITS_TAIL_PKT_Q2_V2)) -+#define BIT_GET_TAIL_PKT_Q2_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q2_V2) & BIT_MASK_TAIL_PKT_Q2_V2) -+#define BIT_SET_TAIL_PKT_Q2_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q2_V2(x) | BIT_TAIL_PKT_Q2_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q2_INFO (Offset 0x0408) */ -+ -+#define BIT_SHIFT_PKT_NUM_Q2_V1 8 -+#define BIT_MASK_PKT_NUM_Q2_V1 0x7f -+#define BIT_PKT_NUM_Q2_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_Q2_V1) << BIT_SHIFT_PKT_NUM_Q2_V1) -+#define BITS_PKT_NUM_Q2_V1 (BIT_MASK_PKT_NUM_Q2_V1 << BIT_SHIFT_PKT_NUM_Q2_V1) -+#define BIT_CLEAR_PKT_NUM_Q2_V1(x) ((x) & (~BITS_PKT_NUM_Q2_V1)) -+#define BIT_GET_PKT_NUM_Q2_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_Q2_V1) & BIT_MASK_PKT_NUM_Q2_V1) -+#define BIT_SET_PKT_NUM_Q2_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_Q2_V1(x) | BIT_PKT_NUM_Q2_V1(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q2 0 -+#define BIT_MASK_HEAD_PKT_Q2 0xff -+#define BIT_HEAD_PKT_Q2(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q2) << BIT_SHIFT_HEAD_PKT_Q2) -+#define BITS_HEAD_PKT_Q2 (BIT_MASK_HEAD_PKT_Q2 << BIT_SHIFT_HEAD_PKT_Q2) -+#define BIT_CLEAR_HEAD_PKT_Q2(x) ((x) & (~BITS_HEAD_PKT_Q2)) -+#define BIT_GET_HEAD_PKT_Q2(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q2) & BIT_MASK_HEAD_PKT_Q2) -+#define BIT_SET_HEAD_PKT_Q2(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q2(x) | BIT_HEAD_PKT_Q2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q2_INFO (Offset 0x0408) */ -+ -+#define BIT_SHIFT_HEAD_PKT_Q2_V1 0 -+#define BIT_MASK_HEAD_PKT_Q2_V1 0x7ff -+#define BIT_HEAD_PKT_Q2_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q2_V1) << BIT_SHIFT_HEAD_PKT_Q2_V1) -+#define BITS_HEAD_PKT_Q2_V1 \ -+ (BIT_MASK_HEAD_PKT_Q2_V1 << BIT_SHIFT_HEAD_PKT_Q2_V1) -+#define BIT_CLEAR_HEAD_PKT_Q2_V1(x) ((x) & (~BITS_HEAD_PKT_Q2_V1)) -+#define BIT_GET_HEAD_PKT_Q2_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q2_V1) & BIT_MASK_HEAD_PKT_Q2_V1) -+#define BIT_SET_HEAD_PKT_Q2_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q2_V1(x) | BIT_HEAD_PKT_Q2_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_INFO2 (Offset 0x0408) */ -+ -+#define BIT_SHIFT_QINFO2 0 -+#define BIT_MASK_QINFO2 0xffffffffL -+#define BIT_QINFO2(x) (((x) & BIT_MASK_QINFO2) << BIT_SHIFT_QINFO2) -+#define BITS_QINFO2 (BIT_MASK_QINFO2 << BIT_SHIFT_QINFO2) -+#define BIT_CLEAR_QINFO2(x) ((x) & (~BITS_QINFO2)) -+#define BIT_GET_QINFO2(x) (((x) >> BIT_SHIFT_QINFO2) & BIT_MASK_QINFO2) -+#define BIT_SET_QINFO2(x, v) (BIT_CLEAR_QINFO2(x) | BIT_QINFO2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q3_INFO (Offset 0x040C) */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q3_V1 25 -+#define BIT_MASK_QUEUEMACID_Q3_V1 0x7f -+#define BIT_QUEUEMACID_Q3_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q3_V1) << BIT_SHIFT_QUEUEMACID_Q3_V1) -+#define BITS_QUEUEMACID_Q3_V1 \ -+ (BIT_MASK_QUEUEMACID_Q3_V1 << BIT_SHIFT_QUEUEMACID_Q3_V1) -+#define BIT_CLEAR_QUEUEMACID_Q3_V1(x) ((x) & (~BITS_QUEUEMACID_Q3_V1)) -+#define BIT_GET_QUEUEMACID_Q3_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q3_V1) & BIT_MASK_QUEUEMACID_Q3_V1) -+#define BIT_SET_QUEUEMACID_Q3_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q3_V1(x) | BIT_QUEUEMACID_Q3_V1(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q3_V1 23 -+#define BIT_MASK_QUEUEAC_Q3_V1 0x3 -+#define BIT_QUEUEAC_Q3_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q3_V1) << BIT_SHIFT_QUEUEAC_Q3_V1) -+#define BITS_QUEUEAC_Q3_V1 (BIT_MASK_QUEUEAC_Q3_V1 << BIT_SHIFT_QUEUEAC_Q3_V1) -+#define BIT_CLEAR_QUEUEAC_Q3_V1(x) ((x) & (~BITS_QUEUEAC_Q3_V1)) -+#define BIT_GET_QUEUEAC_Q3_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q3_V1) & BIT_MASK_QUEUEAC_Q3_V1) -+#define BIT_SET_QUEUEAC_Q3_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q3_V1(x) | BIT_QUEUEAC_Q3_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q3_INFO (Offset 0x040C) */ -+ -+#define BIT_TIDEMPTY_Q3_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q3_INFO (Offset 0x040C) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q3_V1 15 -+#define BIT_MASK_TAIL_PKT_Q3_V1 0xff -+#define BIT_TAIL_PKT_Q3_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q3_V1) << BIT_SHIFT_TAIL_PKT_Q3_V1) -+#define BITS_TAIL_PKT_Q3_V1 \ -+ (BIT_MASK_TAIL_PKT_Q3_V1 << BIT_SHIFT_TAIL_PKT_Q3_V1) -+#define BIT_CLEAR_TAIL_PKT_Q3_V1(x) ((x) & (~BITS_TAIL_PKT_Q3_V1)) -+#define BIT_GET_TAIL_PKT_Q3_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q3_V1) & BIT_MASK_TAIL_PKT_Q3_V1) -+#define BIT_SET_TAIL_PKT_Q3_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q3_V1(x) | BIT_TAIL_PKT_Q3_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q3_INFO (Offset 0x040C) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q3_V2 11 -+#define BIT_MASK_TAIL_PKT_Q3_V2 0x7ff -+#define BIT_TAIL_PKT_Q3_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q3_V2) << BIT_SHIFT_TAIL_PKT_Q3_V2) -+#define BITS_TAIL_PKT_Q3_V2 \ -+ (BIT_MASK_TAIL_PKT_Q3_V2 << BIT_SHIFT_TAIL_PKT_Q3_V2) -+#define BIT_CLEAR_TAIL_PKT_Q3_V2(x) ((x) & (~BITS_TAIL_PKT_Q3_V2)) -+#define BIT_GET_TAIL_PKT_Q3_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q3_V2) & BIT_MASK_TAIL_PKT_Q3_V2) -+#define BIT_SET_TAIL_PKT_Q3_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q3_V2(x) | BIT_TAIL_PKT_Q3_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q3_INFO (Offset 0x040C) */ -+ -+#define BIT_SHIFT_PKT_NUM_Q3_V1 8 -+#define BIT_MASK_PKT_NUM_Q3_V1 0x7f -+#define BIT_PKT_NUM_Q3_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_Q3_V1) << BIT_SHIFT_PKT_NUM_Q3_V1) -+#define BITS_PKT_NUM_Q3_V1 (BIT_MASK_PKT_NUM_Q3_V1 << BIT_SHIFT_PKT_NUM_Q3_V1) -+#define BIT_CLEAR_PKT_NUM_Q3_V1(x) ((x) & (~BITS_PKT_NUM_Q3_V1)) -+#define BIT_GET_PKT_NUM_Q3_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_Q3_V1) & BIT_MASK_PKT_NUM_Q3_V1) -+#define BIT_SET_PKT_NUM_Q3_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_Q3_V1(x) | BIT_PKT_NUM_Q3_V1(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q3 0 -+#define BIT_MASK_HEAD_PKT_Q3 0xff -+#define BIT_HEAD_PKT_Q3(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q3) << BIT_SHIFT_HEAD_PKT_Q3) -+#define BITS_HEAD_PKT_Q3 (BIT_MASK_HEAD_PKT_Q3 << BIT_SHIFT_HEAD_PKT_Q3) -+#define BIT_CLEAR_HEAD_PKT_Q3(x) ((x) & (~BITS_HEAD_PKT_Q3)) -+#define BIT_GET_HEAD_PKT_Q3(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q3) & BIT_MASK_HEAD_PKT_Q3) -+#define BIT_SET_HEAD_PKT_Q3(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q3(x) | BIT_HEAD_PKT_Q3(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q3_INFO (Offset 0x040C) */ -+ -+#define BIT_SHIFT_HEAD_PKT_Q3_V1 0 -+#define BIT_MASK_HEAD_PKT_Q3_V1 0x7ff -+#define BIT_HEAD_PKT_Q3_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q3_V1) << BIT_SHIFT_HEAD_PKT_Q3_V1) -+#define BITS_HEAD_PKT_Q3_V1 \ -+ (BIT_MASK_HEAD_PKT_Q3_V1 << BIT_SHIFT_HEAD_PKT_Q3_V1) -+#define BIT_CLEAR_HEAD_PKT_Q3_V1(x) ((x) & (~BITS_HEAD_PKT_Q3_V1)) -+#define BIT_GET_HEAD_PKT_Q3_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q3_V1) & BIT_MASK_HEAD_PKT_Q3_V1) -+#define BIT_SET_HEAD_PKT_Q3_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q3_V1(x) | BIT_HEAD_PKT_Q3_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_INFO3 (Offset 0x040C) */ -+ -+#define BIT_SHIFT_QINFO3 0 -+#define BIT_MASK_QINFO3 0xffffffffL -+#define BIT_QINFO3(x) (((x) & BIT_MASK_QINFO3) << BIT_SHIFT_QINFO3) -+#define BITS_QINFO3 (BIT_MASK_QINFO3 << BIT_SHIFT_QINFO3) -+#define BIT_CLEAR_QINFO3(x) ((x) & (~BITS_QINFO3)) -+#define BIT_GET_QINFO3(x) (((x) >> BIT_SHIFT_QINFO3) & BIT_MASK_QINFO3) -+#define BIT_SET_QINFO3(x, v) (BIT_CLEAR_QINFO3(x) | BIT_QINFO3(v)) -+ -+/* 2 REG_QUEUELIST_INFO_EMPTY (Offset 0x0410) */ -+ -+#define BIT_FWCMDQ_EMPTY BIT(31) -+#define BIT_MGQ_CPU_EMPTY_V1 BIT(30) -+#define BIT_BCNQ_EMPTY_EXTP0 BIT(29) -+#define BIT_BCNQ_EMPTY_PORT4 BIT(28) -+#define BIT_BCNQ_EMPTY_PORT3 BIT(27) -+#define BIT_BCNQ_EMPTY_PORT2 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_INFO (Offset 0x0410) */ -+ -+#define BIT_SHIFT_QUEUEMACID_MGQ_V1 25 -+#define BIT_MASK_QUEUEMACID_MGQ_V1 0x7f -+#define BIT_QUEUEMACID_MGQ_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_MGQ_V1) << BIT_SHIFT_QUEUEMACID_MGQ_V1) -+#define BITS_QUEUEMACID_MGQ_V1 \ -+ (BIT_MASK_QUEUEMACID_MGQ_V1 << BIT_SHIFT_QUEUEMACID_MGQ_V1) -+#define BIT_CLEAR_QUEUEMACID_MGQ_V1(x) ((x) & (~BITS_QUEUEMACID_MGQ_V1)) -+#define BIT_GET_QUEUEMACID_MGQ_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_MGQ_V1) & BIT_MASK_QUEUEMACID_MGQ_V1) -+#define BIT_SET_QUEUEMACID_MGQ_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_MGQ_V1(x) | BIT_QUEUEMACID_MGQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_INFO_EMPTY (Offset 0x0410) */ -+ -+#define BIT_BCNQ_EMPTY_PORT1 BIT(25) -+#define BIT_BCNQ_EMPTY_PORT0 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_INFO (Offset 0x0410) */ -+ -+#define BIT_SHIFT_QUEUEAC_MGQ_V1 23 -+#define BIT_MASK_QUEUEAC_MGQ_V1 0x3 -+#define BIT_QUEUEAC_MGQ_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_MGQ_V1) << BIT_SHIFT_QUEUEAC_MGQ_V1) -+#define BITS_QUEUEAC_MGQ_V1 \ -+ (BIT_MASK_QUEUEAC_MGQ_V1 << BIT_SHIFT_QUEUEAC_MGQ_V1) -+#define BIT_CLEAR_QUEUEAC_MGQ_V1(x) ((x) & (~BITS_QUEUEAC_MGQ_V1)) -+#define BIT_GET_QUEUEAC_MGQ_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_MGQ_V1) & BIT_MASK_QUEUEAC_MGQ_V1) -+#define BIT_SET_QUEUEAC_MGQ_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_MGQ_V1(x) | BIT_QUEUEAC_MGQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_INFO_EMPTY (Offset 0x0410) */ -+ -+#define BIT_HQQ_EMPTY_V1 BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_INFO (Offset 0x0410) */ -+ -+#define BIT_TIDEMPTY_MGQ_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_INFO_EMPTY (Offset 0x0410) */ -+ -+#define BIT_MQQ_EMPTY_V2 BIT(22) -+#define BIT_S1_EMPTY BIT(21) -+#define BIT_S0_EMPTY BIT(20) -+#define BIT_AC19Q_EMPTY BIT(19) -+#define BIT_AC18Q_EMPTY BIT(18) -+#define BIT_AC17Q_EMPTY BIT(17) -+#define BIT_AC16Q_EMPTY BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_INFO (Offset 0x0410) */ -+ -+#define BIT_SHIFT_TAIL_PKT_MGQ_V1 15 -+#define BIT_MASK_TAIL_PKT_MGQ_V1 0xff -+#define BIT_TAIL_PKT_MGQ_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_MGQ_V1) << BIT_SHIFT_TAIL_PKT_MGQ_V1) -+#define BITS_TAIL_PKT_MGQ_V1 \ -+ (BIT_MASK_TAIL_PKT_MGQ_V1 << BIT_SHIFT_TAIL_PKT_MGQ_V1) -+#define BIT_CLEAR_TAIL_PKT_MGQ_V1(x) ((x) & (~BITS_TAIL_PKT_MGQ_V1)) -+#define BIT_GET_TAIL_PKT_MGQ_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_MGQ_V1) & BIT_MASK_TAIL_PKT_MGQ_V1) -+#define BIT_SET_TAIL_PKT_MGQ_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_MGQ_V1(x) | BIT_TAIL_PKT_MGQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_INFO_EMPTY (Offset 0x0410) */ -+ -+#define BIT_AC15Q_EMPTY BIT(15) -+#define BIT_AC14Q_EMPTY BIT(14) -+#define BIT_AC13Q_EMPTY BIT(13) -+#define BIT_AC12Q_EMPTY BIT(12) -+#define BIT_AC11Q_EMPTY BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_INFO (Offset 0x0410) */ -+ -+#define BIT_SHIFT_TAIL_PKT_MGQ_V2 11 -+#define BIT_MASK_TAIL_PKT_MGQ_V2 0x7ff -+#define BIT_TAIL_PKT_MGQ_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_MGQ_V2) << BIT_SHIFT_TAIL_PKT_MGQ_V2) -+#define BITS_TAIL_PKT_MGQ_V2 \ -+ (BIT_MASK_TAIL_PKT_MGQ_V2 << BIT_SHIFT_TAIL_PKT_MGQ_V2) -+#define BIT_CLEAR_TAIL_PKT_MGQ_V2(x) ((x) & (~BITS_TAIL_PKT_MGQ_V2)) -+#define BIT_GET_TAIL_PKT_MGQ_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_MGQ_V2) & BIT_MASK_TAIL_PKT_MGQ_V2) -+#define BIT_SET_TAIL_PKT_MGQ_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_MGQ_V2(x) | BIT_TAIL_PKT_MGQ_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_INFO_EMPTY (Offset 0x0410) */ -+ -+#define BIT_AC10Q_EMPTY BIT(10) -+#define BIT_AC9Q_EMPTY BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_INFO (Offset 0x0410) */ -+ -+#define BIT_SHIFT_PKT_NUM_MGQ_V1 8 -+#define BIT_MASK_PKT_NUM_MGQ_V1 0x7f -+#define BIT_PKT_NUM_MGQ_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_MGQ_V1) << BIT_SHIFT_PKT_NUM_MGQ_V1) -+#define BITS_PKT_NUM_MGQ_V1 \ -+ (BIT_MASK_PKT_NUM_MGQ_V1 << BIT_SHIFT_PKT_NUM_MGQ_V1) -+#define BIT_CLEAR_PKT_NUM_MGQ_V1(x) ((x) & (~BITS_PKT_NUM_MGQ_V1)) -+#define BIT_GET_PKT_NUM_MGQ_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_MGQ_V1) & BIT_MASK_PKT_NUM_MGQ_V1) -+#define BIT_SET_PKT_NUM_MGQ_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_MGQ_V1(x) | BIT_PKT_NUM_MGQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_INFO_EMPTY (Offset 0x0410) */ -+ -+#define BIT_AC8Q_EMPTY BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_INFO (Offset 0x0410) */ -+ -+#define BIT_SHIFT_HEAD_PKT_MGQ 0 -+#define BIT_MASK_HEAD_PKT_MGQ 0xff -+#define BIT_HEAD_PKT_MGQ(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_MGQ) << BIT_SHIFT_HEAD_PKT_MGQ) -+#define BITS_HEAD_PKT_MGQ (BIT_MASK_HEAD_PKT_MGQ << BIT_SHIFT_HEAD_PKT_MGQ) -+#define BIT_CLEAR_HEAD_PKT_MGQ(x) ((x) & (~BITS_HEAD_PKT_MGQ)) -+#define BIT_GET_HEAD_PKT_MGQ(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_MGQ) & BIT_MASK_HEAD_PKT_MGQ) -+#define BIT_SET_HEAD_PKT_MGQ(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_MGQ(x) | BIT_HEAD_PKT_MGQ(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_INFO (Offset 0x0410) */ -+ -+#define BIT_SHIFT_HEAD_PKT_MGQ_V1 0 -+#define BIT_MASK_HEAD_PKT_MGQ_V1 0x7ff -+#define BIT_HEAD_PKT_MGQ_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_MGQ_V1) << BIT_SHIFT_HEAD_PKT_MGQ_V1) -+#define BITS_HEAD_PKT_MGQ_V1 \ -+ (BIT_MASK_HEAD_PKT_MGQ_V1 << BIT_SHIFT_HEAD_PKT_MGQ_V1) -+#define BIT_CLEAR_HEAD_PKT_MGQ_V1(x) ((x) & (~BITS_HEAD_PKT_MGQ_V1)) -+#define BIT_GET_HEAD_PKT_MGQ_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_MGQ_V1) & BIT_MASK_HEAD_PKT_MGQ_V1) -+#define BIT_SET_HEAD_PKT_MGQ_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_MGQ_V1(x) | BIT_HEAD_PKT_MGQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIQ_INFO (Offset 0x0414) */ -+ -+#define BIT_SHIFT_QUEUEMACID_HIQ_V1 25 -+#define BIT_MASK_QUEUEMACID_HIQ_V1 0x7f -+#define BIT_QUEUEMACID_HIQ_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_HIQ_V1) << BIT_SHIFT_QUEUEMACID_HIQ_V1) -+#define BITS_QUEUEMACID_HIQ_V1 \ -+ (BIT_MASK_QUEUEMACID_HIQ_V1 << BIT_SHIFT_QUEUEMACID_HIQ_V1) -+#define BIT_CLEAR_QUEUEMACID_HIQ_V1(x) ((x) & (~BITS_QUEUEMACID_HIQ_V1)) -+#define BIT_GET_QUEUEMACID_HIQ_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_HIQ_V1) & BIT_MASK_QUEUEMACID_HIQ_V1) -+#define BIT_SET_QUEUEMACID_HIQ_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_HIQ_V1(x) | BIT_QUEUEMACID_HIQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_ACQ_EN (Offset 0x0414) */ -+ -+#define BIT_SHIFT_QINFO_CTRL 24 -+#define BIT_MASK_QINFO_CTRL 0x3f -+#define BIT_QINFO_CTRL(x) (((x) & BIT_MASK_QINFO_CTRL) << BIT_SHIFT_QINFO_CTRL) -+#define BITS_QINFO_CTRL (BIT_MASK_QINFO_CTRL << BIT_SHIFT_QINFO_CTRL) -+#define BIT_CLEAR_QINFO_CTRL(x) ((x) & (~BITS_QINFO_CTRL)) -+#define BIT_GET_QINFO_CTRL(x) \ -+ (((x) >> BIT_SHIFT_QINFO_CTRL) & BIT_MASK_QINFO_CTRL) -+#define BIT_SET_QINFO_CTRL(x, v) (BIT_CLEAR_QINFO_CTRL(x) | BIT_QINFO_CTRL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIQ_INFO (Offset 0x0414) */ -+ -+#define BIT_SHIFT_QUEUEAC_HIQ_V1 23 -+#define BIT_MASK_QUEUEAC_HIQ_V1 0x3 -+#define BIT_QUEUEAC_HIQ_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_HIQ_V1) << BIT_SHIFT_QUEUEAC_HIQ_V1) -+#define BITS_QUEUEAC_HIQ_V1 \ -+ (BIT_MASK_QUEUEAC_HIQ_V1 << BIT_SHIFT_QUEUEAC_HIQ_V1) -+#define BIT_CLEAR_QUEUEAC_HIQ_V1(x) ((x) & (~BITS_QUEUEAC_HIQ_V1)) -+#define BIT_GET_QUEUEAC_HIQ_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_HIQ_V1) & BIT_MASK_QUEUEAC_HIQ_V1) -+#define BIT_SET_QUEUEAC_HIQ_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_HIQ_V1(x) | BIT_QUEUEAC_HIQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIQ_INFO (Offset 0x0414) */ -+ -+#define BIT_TIDEMPTY_HIQ_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_ACQ_EN (Offset 0x0414) */ -+ -+#define BIT_SHIFT_QINFO_MODE_BAND 20 -+#define BIT_MASK_QINFO_MODE_BAND 0x7 -+#define BIT_QINFO_MODE_BAND(x) \ -+ (((x) & BIT_MASK_QINFO_MODE_BAND) << BIT_SHIFT_QINFO_MODE_BAND) -+#define BITS_QINFO_MODE_BAND \ -+ (BIT_MASK_QINFO_MODE_BAND << BIT_SHIFT_QINFO_MODE_BAND) -+#define BIT_CLEAR_QINFO_MODE_BAND(x) ((x) & (~BITS_QINFO_MODE_BAND)) -+#define BIT_GET_QINFO_MODE_BAND(x) \ -+ (((x) >> BIT_SHIFT_QINFO_MODE_BAND) & BIT_MASK_QINFO_MODE_BAND) -+#define BIT_SET_QINFO_MODE_BAND(x, v) \ -+ (BIT_CLEAR_QINFO_MODE_BAND(x) | BIT_QINFO_MODE_BAND(v)) -+ -+#define BIT_ACQ19_ENABLE BIT(19) -+#define BIT_ACQ18_ENABLE BIT(18) -+#define BIT_ACQ17_ENABLE BIT(17) -+#define BIT_ACQ16_ENABLE BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIQ_INFO (Offset 0x0414) */ -+ -+#define BIT_SHIFT_TAIL_PKT_HIQ_V1 15 -+#define BIT_MASK_TAIL_PKT_HIQ_V1 0xff -+#define BIT_TAIL_PKT_HIQ_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_HIQ_V1) << BIT_SHIFT_TAIL_PKT_HIQ_V1) -+#define BITS_TAIL_PKT_HIQ_V1 \ -+ (BIT_MASK_TAIL_PKT_HIQ_V1 << BIT_SHIFT_TAIL_PKT_HIQ_V1) -+#define BIT_CLEAR_TAIL_PKT_HIQ_V1(x) ((x) & (~BITS_TAIL_PKT_HIQ_V1)) -+#define BIT_GET_TAIL_PKT_HIQ_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_HIQ_V1) & BIT_MASK_TAIL_PKT_HIQ_V1) -+#define BIT_SET_TAIL_PKT_HIQ_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_HIQ_V1(x) | BIT_TAIL_PKT_HIQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_ACQ_EN (Offset 0x0414) */ -+ -+#define BIT_ACQ15_ENABLE BIT(15) -+#define BIT_ACQ14_ENABLE BIT(14) -+#define BIT_ACQ13_ENABLE BIT(13) -+#define BIT_ACQ12_ENABLE BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIQ_INFO (Offset 0x0414) */ -+ -+#define BIT_SHIFT_TAIL_PKT_HIQ_V2 11 -+#define BIT_MASK_TAIL_PKT_HIQ_V2 0x7ff -+#define BIT_TAIL_PKT_HIQ_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_HIQ_V2) << BIT_SHIFT_TAIL_PKT_HIQ_V2) -+#define BITS_TAIL_PKT_HIQ_V2 \ -+ (BIT_MASK_TAIL_PKT_HIQ_V2 << BIT_SHIFT_TAIL_PKT_HIQ_V2) -+#define BIT_CLEAR_TAIL_PKT_HIQ_V2(x) ((x) & (~BITS_TAIL_PKT_HIQ_V2)) -+#define BIT_GET_TAIL_PKT_HIQ_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_HIQ_V2) & BIT_MASK_TAIL_PKT_HIQ_V2) -+#define BIT_SET_TAIL_PKT_HIQ_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_HIQ_V2(x) | BIT_TAIL_PKT_HIQ_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_ACQ_EN (Offset 0x0414) */ -+ -+#define BIT_ACQ11_ENABLE BIT(11) -+#define BIT_ACQ10_ENABLE BIT(10) -+#define BIT_ACQ9_ENABLE BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIQ_INFO (Offset 0x0414) */ -+ -+#define BIT_SHIFT_PKT_NUM_HIQ_V1 8 -+#define BIT_MASK_PKT_NUM_HIQ_V1 0x7f -+#define BIT_PKT_NUM_HIQ_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_HIQ_V1) << BIT_SHIFT_PKT_NUM_HIQ_V1) -+#define BITS_PKT_NUM_HIQ_V1 \ -+ (BIT_MASK_PKT_NUM_HIQ_V1 << BIT_SHIFT_PKT_NUM_HIQ_V1) -+#define BIT_CLEAR_PKT_NUM_HIQ_V1(x) ((x) & (~BITS_PKT_NUM_HIQ_V1)) -+#define BIT_GET_PKT_NUM_HIQ_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_HIQ_V1) & BIT_MASK_PKT_NUM_HIQ_V1) -+#define BIT_SET_PKT_NUM_HIQ_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_HIQ_V1(x) | BIT_PKT_NUM_HIQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_ACQ_EN (Offset 0x0414) */ -+ -+#define BIT_ACQ8_ENABLE BIT(8) -+#define BIT_ACQ7_ENABLE BIT(7) -+#define BIT_ACQ6_ENABLE BIT(6) -+#define BIT_ACQ5_ENABLE BIT(5) -+#define BIT_ACQ4_ENABLE BIT(4) -+#define BIT_ACQ3_ENABLE BIT(3) -+#define BIT_ACQ2_ENABLE BIT(2) -+#define BIT_ACQ1_ENABLE BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIQ_INFO (Offset 0x0414) */ -+ -+#define BIT_SHIFT_HEAD_PKT_HIQ 0 -+#define BIT_MASK_HEAD_PKT_HIQ 0xff -+#define BIT_HEAD_PKT_HIQ(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_HIQ) << BIT_SHIFT_HEAD_PKT_HIQ) -+#define BITS_HEAD_PKT_HIQ (BIT_MASK_HEAD_PKT_HIQ << BIT_SHIFT_HEAD_PKT_HIQ) -+#define BIT_CLEAR_HEAD_PKT_HIQ(x) ((x) & (~BITS_HEAD_PKT_HIQ)) -+#define BIT_GET_HEAD_PKT_HIQ(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_HIQ) & BIT_MASK_HEAD_PKT_HIQ) -+#define BIT_SET_HEAD_PKT_HIQ(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_HIQ(x) | BIT_HEAD_PKT_HIQ(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIQ_INFO (Offset 0x0414) */ -+ -+#define BIT_SHIFT_HEAD_PKT_HIQ_V1 0 -+#define BIT_MASK_HEAD_PKT_HIQ_V1 0x7ff -+#define BIT_HEAD_PKT_HIQ_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_HIQ_V1) << BIT_SHIFT_HEAD_PKT_HIQ_V1) -+#define BITS_HEAD_PKT_HIQ_V1 \ -+ (BIT_MASK_HEAD_PKT_HIQ_V1 << BIT_SHIFT_HEAD_PKT_HIQ_V1) -+#define BIT_CLEAR_HEAD_PKT_HIQ_V1(x) ((x) & (~BITS_HEAD_PKT_HIQ_V1)) -+#define BIT_GET_HEAD_PKT_HIQ_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_HIQ_V1) & BIT_MASK_HEAD_PKT_HIQ_V1) -+#define BIT_SET_HEAD_PKT_HIQ_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_HIQ_V1(x) | BIT_HEAD_PKT_HIQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUELIST_ACQ_EN (Offset 0x0414) */ -+ -+#define BIT_ACQ0_ENABLE BIT(0) -+ -+/* 2 REG_BCNQ_BDNY_V2 (Offset 0x0418) */ -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_WSEL 28 -+#define BIT_MASK_BCNQ_PGBNDY_WSEL 0x7 -+#define BIT_BCNQ_PGBNDY_WSEL(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_WSEL) << BIT_SHIFT_BCNQ_PGBNDY_WSEL) -+#define BITS_BCNQ_PGBNDY_WSEL \ -+ (BIT_MASK_BCNQ_PGBNDY_WSEL << BIT_SHIFT_BCNQ_PGBNDY_WSEL) -+#define BIT_CLEAR_BCNQ_PGBNDY_WSEL(x) ((x) & (~BITS_BCNQ_PGBNDY_WSEL)) -+#define BIT_GET_BCNQ_PGBNDY_WSEL(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_WSEL) & BIT_MASK_BCNQ_PGBNDY_WSEL) -+#define BIT_SET_BCNQ_PGBNDY_WSEL(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_WSEL(x) | BIT_BCNQ_PGBNDY_WSEL(v)) -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_RCONTENT 12 -+#define BIT_MASK_BCNQ_PGBNDY_RCONTENT 0xfff -+#define BIT_BCNQ_PGBNDY_RCONTENT(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_RCONTENT) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_RCONTENT) -+#define BITS_BCNQ_PGBNDY_RCONTENT \ -+ (BIT_MASK_BCNQ_PGBNDY_RCONTENT << BIT_SHIFT_BCNQ_PGBNDY_RCONTENT) -+#define BIT_CLEAR_BCNQ_PGBNDY_RCONTENT(x) ((x) & (~BITS_BCNQ_PGBNDY_RCONTENT)) -+#define BIT_GET_BCNQ_PGBNDY_RCONTENT(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_RCONTENT) & \ -+ BIT_MASK_BCNQ_PGBNDY_RCONTENT) -+#define BIT_SET_BCNQ_PGBNDY_RCONTENT(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_RCONTENT(x) | BIT_BCNQ_PGBNDY_RCONTENT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCNQ_INFO (Offset 0x0418) */ -+ -+#define BIT_SHIFT_PKT_NUM_BCNQ 8 -+#define BIT_MASK_PKT_NUM_BCNQ 0xff -+#define BIT_PKT_NUM_BCNQ(x) \ -+ (((x) & BIT_MASK_PKT_NUM_BCNQ) << BIT_SHIFT_PKT_NUM_BCNQ) -+#define BITS_PKT_NUM_BCNQ (BIT_MASK_PKT_NUM_BCNQ << BIT_SHIFT_PKT_NUM_BCNQ) -+#define BIT_CLEAR_PKT_NUM_BCNQ(x) ((x) & (~BITS_PKT_NUM_BCNQ)) -+#define BIT_GET_PKT_NUM_BCNQ(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_BCNQ) & BIT_MASK_PKT_NUM_BCNQ) -+#define BIT_SET_PKT_NUM_BCNQ(x, v) \ -+ (BIT_CLEAR_PKT_NUM_BCNQ(x) | BIT_PKT_NUM_BCNQ(v)) -+ -+#define BIT_SHIFT_BCNQ_HEAD_PG 0 -+#define BIT_MASK_BCNQ_HEAD_PG 0xff -+#define BIT_BCNQ_HEAD_PG(x) \ -+ (((x) & BIT_MASK_BCNQ_HEAD_PG) << BIT_SHIFT_BCNQ_HEAD_PG) -+#define BITS_BCNQ_HEAD_PG (BIT_MASK_BCNQ_HEAD_PG << BIT_SHIFT_BCNQ_HEAD_PG) -+#define BIT_CLEAR_BCNQ_HEAD_PG(x) ((x) & (~BITS_BCNQ_HEAD_PG)) -+#define BIT_GET_BCNQ_HEAD_PG(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_HEAD_PG) & BIT_MASK_BCNQ_HEAD_PG) -+#define BIT_SET_BCNQ_HEAD_PG(x, v) \ -+ (BIT_CLEAR_BCNQ_HEAD_PG(x) | BIT_BCNQ_HEAD_PG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCNQ_INFO (Offset 0x0418) */ -+ -+#define BIT_SHIFT_BCNQ_HEAD_PG_V1 0 -+#define BIT_MASK_BCNQ_HEAD_PG_V1 0xfff -+#define BIT_BCNQ_HEAD_PG_V1(x) \ -+ (((x) & BIT_MASK_BCNQ_HEAD_PG_V1) << BIT_SHIFT_BCNQ_HEAD_PG_V1) -+#define BITS_BCNQ_HEAD_PG_V1 \ -+ (BIT_MASK_BCNQ_HEAD_PG_V1 << BIT_SHIFT_BCNQ_HEAD_PG_V1) -+#define BIT_CLEAR_BCNQ_HEAD_PG_V1(x) ((x) & (~BITS_BCNQ_HEAD_PG_V1)) -+#define BIT_GET_BCNQ_HEAD_PG_V1(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_HEAD_PG_V1) & BIT_MASK_BCNQ_HEAD_PG_V1) -+#define BIT_SET_BCNQ_HEAD_PG_V1(x, v) \ -+ (BIT_CLEAR_BCNQ_HEAD_PG_V1(x) | BIT_BCNQ_HEAD_PG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCNQ_BDNY_V2 (Offset 0x0418) */ -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_WCONTENT 0 -+#define BIT_MASK_BCNQ_PGBNDY_WCONTENT 0xfff -+#define BIT_BCNQ_PGBNDY_WCONTENT(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_WCONTENT) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_WCONTENT) -+#define BITS_BCNQ_PGBNDY_WCONTENT \ -+ (BIT_MASK_BCNQ_PGBNDY_WCONTENT << BIT_SHIFT_BCNQ_PGBNDY_WCONTENT) -+#define BIT_CLEAR_BCNQ_PGBNDY_WCONTENT(x) ((x) & (~BITS_BCNQ_PGBNDY_WCONTENT)) -+#define BIT_GET_BCNQ_PGBNDY_WCONTENT(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_WCONTENT) & \ -+ BIT_MASK_BCNQ_PGBNDY_WCONTENT) -+#define BIT_SET_BCNQ_PGBNDY_WCONTENT(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_WCONTENT(x) | BIT_BCNQ_PGBNDY_WCONTENT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXPKT_EMPTY (Offset 0x041A) */ -+ -+#define BIT_BCNQ_EMPTY BIT(11) -+#define BIT_HQQ_EMPTY BIT(10) -+#define BIT_MQQ_EMPTY BIT(9) -+#define BIT_MGQ_CPU_EMPTY BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_BCN_POLL2 BIT(31) -+#define BIT_BCN_POLL1 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_BCN1_POLL BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_CPUMGT_CLR_V1 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_CPUMGT_POLL BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_CPUMGT_POLL_SET BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_BCN_POLL BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_CPUMGT_POLL_CLR BIT(27) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_CPUMGT_CLR BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_EVTQ_VALID BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_BCN_EXT_POLL BIT(21) -+#define BIT_BCN4_POLL BIT(20) -+#define BIT_BCN3_POLL BIT(19) -+#define BIT_BCN2_POLL BIT(18) -+#define BIT_BCN1_POLL_V1 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_EN_RTY_BK_COND BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_BCN_POLL_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_CPUMGQ_FW_NUM_V1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_CPUMGQ_FW_NUM BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_EN_EVTQ_RPT BIT(2) -+#define BIT_HWSEQ_EVTQ_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_SHIFT_CPUMGQ_HEAD_PG 0 -+#define BIT_MASK_CPUMGQ_HEAD_PG 0xff -+#define BIT_CPUMGQ_HEAD_PG(x) \ -+ (((x) & BIT_MASK_CPUMGQ_HEAD_PG) << BIT_SHIFT_CPUMGQ_HEAD_PG) -+#define BITS_CPUMGQ_HEAD_PG \ -+ (BIT_MASK_CPUMGQ_HEAD_PG << BIT_SHIFT_CPUMGQ_HEAD_PG) -+#define BIT_CLEAR_CPUMGQ_HEAD_PG(x) ((x) & (~BITS_CPUMGQ_HEAD_PG)) -+#define BIT_GET_CPUMGQ_HEAD_PG(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_HEAD_PG) & BIT_MASK_CPUMGQ_HEAD_PG) -+#define BIT_SET_CPUMGQ_HEAD_PG(x, v) \ -+ (BIT_CLEAR_CPUMGQ_HEAD_PG(x) | BIT_CPUMGQ_HEAD_PG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_SHIFT_FW_FREE_TAIL_V1 0 -+#define BIT_MASK_FW_FREE_TAIL_V1 0xfff -+#define BIT_FW_FREE_TAIL_V1(x) \ -+ (((x) & BIT_MASK_FW_FREE_TAIL_V1) << BIT_SHIFT_FW_FREE_TAIL_V1) -+#define BITS_FW_FREE_TAIL_V1 \ -+ (BIT_MASK_FW_FREE_TAIL_V1 << BIT_SHIFT_FW_FREE_TAIL_V1) -+#define BIT_CLEAR_FW_FREE_TAIL_V1(x) ((x) & (~BITS_FW_FREE_TAIL_V1)) -+#define BIT_GET_FW_FREE_TAIL_V1(x) \ -+ (((x) >> BIT_SHIFT_FW_FREE_TAIL_V1) & BIT_MASK_FW_FREE_TAIL_V1) -+#define BIT_SET_FW_FREE_TAIL_V1(x, v) \ -+ (BIT_CLEAR_FW_FREE_TAIL_V1(x) | BIT_FW_FREE_TAIL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPU_MGQ_INFO (Offset 0x041C) */ -+ -+#define BIT_SHIFT_FREE_TAIL_PAGE 0 -+#define BIT_MASK_FREE_TAIL_PAGE 0xfff -+#define BIT_FREE_TAIL_PAGE(x) \ -+ (((x) & BIT_MASK_FREE_TAIL_PAGE) << BIT_SHIFT_FREE_TAIL_PAGE) -+#define BITS_FREE_TAIL_PAGE \ -+ (BIT_MASK_FREE_TAIL_PAGE << BIT_SHIFT_FREE_TAIL_PAGE) -+#define BIT_CLEAR_FREE_TAIL_PAGE(x) ((x) & (~BITS_FREE_TAIL_PAGE)) -+#define BIT_GET_FREE_TAIL_PAGE(x) \ -+ (((x) >> BIT_SHIFT_FREE_TAIL_PAGE) & BIT_MASK_FREE_TAIL_PAGE) -+#define BIT_SET_FREE_TAIL_PAGE(x, v) \ -+ (BIT_CLEAR_FREE_TAIL_PAGE(x) | BIT_FREE_TAIL_PAGE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_RTS_LIMIT_IN_OFDM BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_EN_BCNQ_DL BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_EN_RD_RESP_NAV_BK BIT(21) -+#define BIT_EN_WR_FREE_TAIL BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_TXRPT_DIS BIT(19) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_NOTXRPT_USERATE_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_DIS_TXFAIL_RPT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_FTM_TIMEOUT_BYPASS BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_EN_BCNQ_DL5 BIT(13) -+#define BIT_EN_BCNQ_DL4 BIT(12) -+#define BIT_EN_BCNQ_DL3 BIT(11) -+#define BIT_EN_BCNQ_DL2 BIT(10) -+#define BIT_EN_BCNQ_DL1 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_SHIFT_EN_QUEUE_RPT 8 -+#define BIT_MASK_EN_QUEUE_RPT 0xff -+#define BIT_EN_QUEUE_RPT(x) \ -+ (((x) & BIT_MASK_EN_QUEUE_RPT) << BIT_SHIFT_EN_QUEUE_RPT) -+#define BITS_EN_QUEUE_RPT (BIT_MASK_EN_QUEUE_RPT << BIT_SHIFT_EN_QUEUE_RPT) -+#define BIT_CLEAR_EN_QUEUE_RPT(x) ((x) & (~BITS_EN_QUEUE_RPT)) -+#define BIT_GET_EN_QUEUE_RPT(x) \ -+ (((x) >> BIT_SHIFT_EN_QUEUE_RPT) & BIT_MASK_EN_QUEUE_RPT) -+#define BIT_SET_EN_QUEUE_RPT(x, v) \ -+ (BIT_CLEAR_EN_QUEUE_RPT(x) | BIT_EN_QUEUE_RPT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_EN_BCNQ_DL0 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_EN_RTY_BK BIT(7) -+#define BIT_EN_USE_INI_RAT BIT(6) -+#define BIT_EN_RTS_NAV_BK BIT(5) -+#define BIT_DIS_SSN_CHECK BIT(4) -+#define BIT_MACID_MATCH_RTS BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_EN_BCN_TRXRPT_V1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_R_EN_FTMRPT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_R_EN_FTMRPT_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_EN_FTMRPT_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_EN_FTMACKRPT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_R_BMC_NAV_PROTECT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_BMC_NAV_PROTECT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FWHW_TXQ_CTRL (Offset 0x0420) */ -+ -+#define BIT_EN_FTMRPT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HWSEQ_CTRL (Offset 0x0423) */ -+ -+#define BIT_HWSEQ_CPUM_EN BIT(7) -+#define BIT_HWSEQ_BCN_EN BIT(6) -+#define BIT_HWSEQ_HI_EN BIT(5) -+#define BIT_HWSEQ_MGT_EN BIT(4) -+#define BIT_HWSEQ_BK_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DATAFB_SEL (Offset 0x0423) */ -+ -+#define BIT_BROADCAST_RTY_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DATAFB_SEL (Offset 0x0423) */ -+ -+#define BIT_R_BROADCAST_RETRY_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HWSEQ_CTRL (Offset 0x0423) */ -+ -+#define BIT_HWSEQ_BE_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DATAFB_SEL (Offset 0x0423) */ -+ -+#define BIT__R_EN_RTY_BK_COD BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DATAFB_SEL (Offset 0x0423) */ -+ -+#define BIT_EN_RTY_BK_COD BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HWSEQ_CTRL (Offset 0x0423) */ -+ -+#define BIT_HWSEQ_VI_EN BIT(1) -+#define BIT_HWSEQ_VO_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DATAFB_SEL (Offset 0x0423) */ -+ -+#define BIT_SHIFT__R_DATA_FALLBACK_SEL 0 -+#define BIT_MASK__R_DATA_FALLBACK_SEL 0x3 -+#define BIT__R_DATA_FALLBACK_SEL(x) \ -+ (((x) & BIT_MASK__R_DATA_FALLBACK_SEL) \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL) -+#define BITS__R_DATA_FALLBACK_SEL \ -+ (BIT_MASK__R_DATA_FALLBACK_SEL << BIT_SHIFT__R_DATA_FALLBACK_SEL) -+#define BIT_CLEAR__R_DATA_FALLBACK_SEL(x) ((x) & (~BITS__R_DATA_FALLBACK_SEL)) -+#define BIT_GET__R_DATA_FALLBACK_SEL(x) \ -+ (((x) >> BIT_SHIFT__R_DATA_FALLBACK_SEL) & \ -+ BIT_MASK__R_DATA_FALLBACK_SEL) -+#define BIT_SET__R_DATA_FALLBACK_SEL(x, v) \ -+ (BIT_CLEAR__R_DATA_FALLBACK_SEL(x) | BIT__R_DATA_FALLBACK_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATAFB_SEL (Offset 0x0423) */ -+ -+#define BIT_SHIFT__DATA_FALLBACK_SEL 0 -+#define BIT_MASK__DATA_FALLBACK_SEL 0x3 -+#define BIT__DATA_FALLBACK_SEL(x) \ -+ (((x) & BIT_MASK__DATA_FALLBACK_SEL) << BIT_SHIFT__DATA_FALLBACK_SEL) -+#define BITS__DATA_FALLBACK_SEL \ -+ (BIT_MASK__DATA_FALLBACK_SEL << BIT_SHIFT__DATA_FALLBACK_SEL) -+#define BIT_CLEAR__DATA_FALLBACK_SEL(x) ((x) & (~BITS__DATA_FALLBACK_SEL)) -+#define BIT_GET__DATA_FALLBACK_SEL(x) \ -+ (((x) >> BIT_SHIFT__DATA_FALLBACK_SEL) & BIT_MASK__DATA_FALLBACK_SEL) -+#define BIT_SET__DATA_FALLBACK_SEL(x, v) \ -+ (BIT_CLEAR__DATA_FALLBACK_SEL(x) | BIT__DATA_FALLBACK_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_BCNQ_BDNY (Offset 0x0424) */ -+ -+#define BIT_SHIFT_MGQ_PGBNDY_V2 8 -+#define BIT_MASK_MGQ_PGBNDY_V2 0xff -+#define BIT_MGQ_PGBNDY_V2(x) \ -+ (((x) & BIT_MASK_MGQ_PGBNDY_V2) << BIT_SHIFT_MGQ_PGBNDY_V2) -+#define BITS_MGQ_PGBNDY_V2 (BIT_MASK_MGQ_PGBNDY_V2 << BIT_SHIFT_MGQ_PGBNDY_V2) -+#define BIT_CLEAR_MGQ_PGBNDY_V2(x) ((x) & (~BITS_MGQ_PGBNDY_V2)) -+#define BIT_GET_MGQ_PGBNDY_V2(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PGBNDY_V2) & BIT_MASK_MGQ_PGBNDY_V2) -+#define BIT_SET_MGQ_PGBNDY_V2(x, v) \ -+ (BIT_CLEAR_MGQ_PGBNDY_V2(x) | BIT_MGQ_PGBNDY_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCNQ_BDNY (Offset 0x0424) */ -+ -+#define BIT_SHIFT_BCNQ_PGBNDY 0 -+#define BIT_MASK_BCNQ_PGBNDY 0xff -+#define BIT_BCNQ_PGBNDY(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY) << BIT_SHIFT_BCNQ_PGBNDY) -+#define BITS_BCNQ_PGBNDY (BIT_MASK_BCNQ_PGBNDY << BIT_SHIFT_BCNQ_PGBNDY) -+#define BIT_CLEAR_BCNQ_PGBNDY(x) ((x) & (~BITS_BCNQ_PGBNDY)) -+#define BIT_GET_BCNQ_PGBNDY(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY) & BIT_MASK_BCNQ_PGBNDY) -+#define BIT_SET_BCNQ_PGBNDY(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY(x) | BIT_BCNQ_PGBNDY(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCNQ_BDNY_V1 (Offset 0x0424) */ -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_V1 0 -+#define BIT_MASK_BCNQ_PGBNDY_V1 0xfff -+#define BIT_BCNQ_PGBNDY_V1(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_V1) << BIT_SHIFT_BCNQ_PGBNDY_V1) -+#define BITS_BCNQ_PGBNDY_V1 \ -+ (BIT_MASK_BCNQ_PGBNDY_V1 << BIT_SHIFT_BCNQ_PGBNDY_V1) -+#define BIT_CLEAR_BCNQ_PGBNDY_V1(x) ((x) & (~BITS_BCNQ_PGBNDY_V1)) -+#define BIT_GET_BCNQ_PGBNDY_V1(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_V1) & BIT_MASK_BCNQ_PGBNDY_V1) -+#define BIT_SET_BCNQ_PGBNDY_V1(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_V1(x) | BIT_BCNQ_PGBNDY_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBDNY (Offset 0x0424) */ -+ -+#define BIT_SHIFT_TXBNDY 0 -+#define BIT_MASK_TXBNDY 0xfff -+#define BIT_TXBNDY(x) (((x) & BIT_MASK_TXBNDY) << BIT_SHIFT_TXBNDY) -+#define BITS_TXBNDY (BIT_MASK_TXBNDY << BIT_SHIFT_TXBNDY) -+#define BIT_CLEAR_TXBNDY(x) ((x) & (~BITS_TXBNDY)) -+#define BIT_GET_TXBNDY(x) (((x) >> BIT_SHIFT_TXBNDY) & BIT_MASK_TXBNDY) -+#define BIT_SET_TXBNDY(x, v) (BIT_CLEAR_TXBNDY(x) | BIT_TXBNDY(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MGQ_BDNY (Offset 0x0425) */ -+ -+#define BIT_SHIFT_MGQ_PGBNDY 0 -+#define BIT_MASK_MGQ_PGBNDY 0xff -+#define BIT_MGQ_PGBNDY(x) (((x) & BIT_MASK_MGQ_PGBNDY) << BIT_SHIFT_MGQ_PGBNDY) -+#define BITS_MGQ_PGBNDY (BIT_MASK_MGQ_PGBNDY << BIT_SHIFT_MGQ_PGBNDY) -+#define BIT_CLEAR_MGQ_PGBNDY(x) ((x) & (~BITS_MGQ_PGBNDY)) -+#define BIT_GET_MGQ_PGBNDY(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PGBNDY) & BIT_MASK_MGQ_PGBNDY) -+#define BIT_SET_MGQ_PGBNDY(x, v) (BIT_CLEAR_MGQ_PGBNDY(x) | BIT_MGQ_PGBNDY(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LIFETIME_EN (Offset 0x0426) */ -+ -+#define BIT_BT_INT_CPU BIT(7) -+#define BIT_BT_INT_PTA BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LIFETIME_EN (Offset 0x0426) */ -+ -+#define BIT_SPERPT_ENTRY BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LIFETIME_EN (Offset 0x0426) */ -+ -+#define BIT_BA_PARSER_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LIFETIME_EN (Offset 0x0426) */ -+ -+#define BIT_RTYCNT_FB BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LIFETIME_EN (Offset 0x0426) */ -+ -+#define BIT_EN_CTRL_RTYBIT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LIFETIME_EN (Offset 0x0426) */ -+ -+#define BIT_LIFETIME_BK_EN BIT(3) -+#define BIT_LIFETIME_BE_EN BIT(2) -+#define BIT_LIFETIME_VI_EN BIT(1) -+#define BIT_LIFETIME_VO_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FW_FREE_TAIL (Offset 0x0427) */ -+ -+#define BIT_SHIFT_FW_FREE_TAIL 0 -+#define BIT_MASK_FW_FREE_TAIL 0xff -+#define BIT_FW_FREE_TAIL(x) \ -+ (((x) & BIT_MASK_FW_FREE_TAIL) << BIT_SHIFT_FW_FREE_TAIL) -+#define BITS_FW_FREE_TAIL (BIT_MASK_FW_FREE_TAIL << BIT_SHIFT_FW_FREE_TAIL) -+#define BIT_CLEAR_FW_FREE_TAIL(x) ((x) & (~BITS_FW_FREE_TAIL)) -+#define BIT_GET_FW_FREE_TAIL(x) \ -+ (((x) >> BIT_SHIFT_FW_FREE_TAIL) & BIT_MASK_FW_FREE_TAIL) -+#define BIT_SET_FW_FREE_TAIL(x, v) \ -+ (BIT_CLEAR_FW_FREE_TAIL(x) | BIT_FW_FREE_TAIL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SPEC_SIFS (Offset 0x0428) */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_PTCL 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_PTCL 0xff -+#define BIT_SPEC_SIFS_OFDM_PTCL(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_PTCL) << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL) -+#define BITS_SPEC_SIFS_OFDM_PTCL \ -+ (BIT_MASK_SPEC_SIFS_OFDM_PTCL << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_PTCL(x) ((x) & (~BITS_SPEC_SIFS_OFDM_PTCL)) -+#define BIT_GET_SPEC_SIFS_OFDM_PTCL(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_PTCL) & BIT_MASK_SPEC_SIFS_OFDM_PTCL) -+#define BIT_SET_SPEC_SIFS_OFDM_PTCL(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_PTCL(x) | BIT_SPEC_SIFS_OFDM_PTCL(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_PTCL 0 -+#define BIT_MASK_SPEC_SIFS_CCK_PTCL 0xff -+#define BIT_SPEC_SIFS_CCK_PTCL(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_PTCL) << BIT_SHIFT_SPEC_SIFS_CCK_PTCL) -+#define BITS_SPEC_SIFS_CCK_PTCL \ -+ (BIT_MASK_SPEC_SIFS_CCK_PTCL << BIT_SHIFT_SPEC_SIFS_CCK_PTCL) -+#define BIT_CLEAR_SPEC_SIFS_CCK_PTCL(x) ((x) & (~BITS_SPEC_SIFS_CCK_PTCL)) -+#define BIT_GET_SPEC_SIFS_CCK_PTCL(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_PTCL) & BIT_MASK_SPEC_SIFS_CCK_PTCL) -+#define BIT_SET_SPEC_SIFS_CCK_PTCL(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_PTCL(x) | BIT_SPEC_SIFS_CCK_PTCL(v)) -+ -+/* 2 REG_RETRY_LIMIT (Offset 0x042A) */ -+ -+#define BIT_SHIFT_SRL 8 -+#define BIT_MASK_SRL 0x3f -+#define BIT_SRL(x) (((x) & BIT_MASK_SRL) << BIT_SHIFT_SRL) -+#define BITS_SRL (BIT_MASK_SRL << BIT_SHIFT_SRL) -+#define BIT_CLEAR_SRL(x) ((x) & (~BITS_SRL)) -+#define BIT_GET_SRL(x) (((x) >> BIT_SHIFT_SRL) & BIT_MASK_SRL) -+#define BIT_SET_SRL(x, v) (BIT_CLEAR_SRL(x) | BIT_SRL(v)) -+ -+#define BIT_SHIFT_LRL 0 -+#define BIT_MASK_LRL 0x3f -+#define BIT_LRL(x) (((x) & BIT_MASK_LRL) << BIT_SHIFT_LRL) -+#define BITS_LRL (BIT_MASK_LRL << BIT_SHIFT_LRL) -+#define BIT_CLEAR_LRL(x) ((x) & (~BITS_LRL)) -+#define BIT_GET_LRL(x) (((x) >> BIT_SHIFT_LRL) & BIT_MASK_LRL) -+#define BIT_SET_LRL(x, v) (BIT_CLEAR_LRL(x) | BIT_LRL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_R_ENABLE_NDPA BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_ENABLE_NDPA BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_USE_NDPA_PARAMETER BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_NDPA_PARA BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_R_PROP_TXBF BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_PROP_TXBF BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_R_EN_NDPA_INT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_EN_NDPA_INT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_R_TXBF1_80M BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_TXBF1_80M BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_TXBF1_80M_160M BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_R_TXBF1_40M BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_TXBF1_40M BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_R_TXBF1_20M BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_TXBF1_20M BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_SHIFT_R_TXBF1_AID 16 -+#define BIT_MASK_R_TXBF1_AID 0x1ff -+#define BIT_R_TXBF1_AID(x) \ -+ (((x) & BIT_MASK_R_TXBF1_AID) << BIT_SHIFT_R_TXBF1_AID) -+#define BITS_R_TXBF1_AID (BIT_MASK_R_TXBF1_AID << BIT_SHIFT_R_TXBF1_AID) -+#define BIT_CLEAR_R_TXBF1_AID(x) ((x) & (~BITS_R_TXBF1_AID)) -+#define BIT_GET_R_TXBF1_AID(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF1_AID) & BIT_MASK_R_TXBF1_AID) -+#define BIT_SET_R_TXBF1_AID(x, v) \ -+ (BIT_CLEAR_R_TXBF1_AID(x) | BIT_R_TXBF1_AID(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_SHIFT_TXBF1_AID 16 -+#define BIT_MASK_TXBF1_AID 0x1ff -+#define BIT_TXBF1_AID(x) (((x) & BIT_MASK_TXBF1_AID) << BIT_SHIFT_TXBF1_AID) -+#define BITS_TXBF1_AID (BIT_MASK_TXBF1_AID << BIT_SHIFT_TXBF1_AID) -+#define BIT_CLEAR_TXBF1_AID(x) ((x) & (~BITS_TXBF1_AID)) -+#define BIT_GET_TXBF1_AID(x) (((x) >> BIT_SHIFT_TXBF1_AID) & BIT_MASK_TXBF1_AID) -+#define BIT_SET_TXBF1_AID(x, v) (BIT_CLEAR_TXBF1_AID(x) | BIT_TXBF1_AID(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_DIS_NDP_BFEN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_TXBCN_NOBLOCK_NDP BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_R_TXBCN_NOBLOCK_NDP BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_R_TXBF0_80M BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_TXBF0_80M BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_TXBF0_80M_160M BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_R_TXBF0_40M BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_TXBF0_40M BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_R_TXBF0_20M BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_TXBF0_20M BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_SHIFT_R_TXBF0_AID 0 -+#define BIT_MASK_R_TXBF0_AID 0x1ff -+#define BIT_R_TXBF0_AID(x) \ -+ (((x) & BIT_MASK_R_TXBF0_AID) << BIT_SHIFT_R_TXBF0_AID) -+#define BITS_R_TXBF0_AID (BIT_MASK_R_TXBF0_AID << BIT_SHIFT_R_TXBF0_AID) -+#define BIT_CLEAR_R_TXBF0_AID(x) ((x) & (~BITS_R_TXBF0_AID)) -+#define BIT_GET_R_TXBF0_AID(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF0_AID) & BIT_MASK_R_TXBF0_AID) -+#define BIT_SET_R_TXBF0_AID(x, v) \ -+ (BIT_CLEAR_R_TXBF0_AID(x) | BIT_R_TXBF0_AID(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXBF_CTRL (Offset 0x042C) */ -+ -+#define BIT_SHIFT_TXBF0_AID 0 -+#define BIT_MASK_TXBF0_AID 0x1ff -+#define BIT_TXBF0_AID(x) (((x) & BIT_MASK_TXBF0_AID) << BIT_SHIFT_TXBF0_AID) -+#define BITS_TXBF0_AID (BIT_MASK_TXBF0_AID << BIT_SHIFT_TXBF0_AID) -+#define BIT_CLEAR_TXBF0_AID(x) ((x) & (~BITS_TXBF0_AID)) -+#define BIT_GET_TXBF0_AID(x) (((x) >> BIT_SHIFT_TXBF0_AID) & BIT_MASK_TXBF0_AID) -+#define BIT_SET_TXBF0_AID(x, v) (BIT_CLEAR_TXBF0_AID(x) | BIT_TXBF0_AID(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC8 (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC8 0x1f -+#define BIT_DARF_RC8(x) (((x) & BIT_MASK_DARF_RC8) << BIT_SHIFT_DARF_RC8) -+#define BITS_DARF_RC8 (BIT_MASK_DARF_RC8 << BIT_SHIFT_DARF_RC8) -+#define BIT_CLEAR_DARF_RC8(x) ((x) & (~BITS_DARF_RC8)) -+#define BIT_GET_DARF_RC8(x) (((x) >> BIT_SHIFT_DARF_RC8) & BIT_MASK_DARF_RC8) -+#define BIT_SET_DARF_RC8(x, v) (BIT_CLEAR_DARF_RC8(x) | BIT_DARF_RC8(v)) -+ -+#define BIT_SHIFT_DARF_RC7 (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC7 0x1f -+#define BIT_DARF_RC7(x) (((x) & BIT_MASK_DARF_RC7) << BIT_SHIFT_DARF_RC7) -+#define BITS_DARF_RC7 (BIT_MASK_DARF_RC7 << BIT_SHIFT_DARF_RC7) -+#define BIT_CLEAR_DARF_RC7(x) ((x) & (~BITS_DARF_RC7)) -+#define BIT_GET_DARF_RC7(x) (((x) >> BIT_SHIFT_DARF_RC7) & BIT_MASK_DARF_RC7) -+#define BIT_SET_DARF_RC7(x, v) (BIT_CLEAR_DARF_RC7(x) | BIT_DARF_RC7(v)) -+ -+#define BIT_SHIFT_DARF_RC6 (40 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC6 0x1f -+#define BIT_DARF_RC6(x) (((x) & BIT_MASK_DARF_RC6) << BIT_SHIFT_DARF_RC6) -+#define BITS_DARF_RC6 (BIT_MASK_DARF_RC6 << BIT_SHIFT_DARF_RC6) -+#define BIT_CLEAR_DARF_RC6(x) ((x) & (~BITS_DARF_RC6)) -+#define BIT_GET_DARF_RC6(x) (((x) >> BIT_SHIFT_DARF_RC6) & BIT_MASK_DARF_RC6) -+#define BIT_SET_DARF_RC6(x, v) (BIT_CLEAR_DARF_RC6(x) | BIT_DARF_RC6(v)) -+ -+#define BIT_SHIFT_DARF_RC5 (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC5 0x1f -+#define BIT_DARF_RC5(x) (((x) & BIT_MASK_DARF_RC5) << BIT_SHIFT_DARF_RC5) -+#define BITS_DARF_RC5 (BIT_MASK_DARF_RC5 << BIT_SHIFT_DARF_RC5) -+#define BIT_CLEAR_DARF_RC5(x) ((x) & (~BITS_DARF_RC5)) -+#define BIT_GET_DARF_RC5(x) (((x) >> BIT_SHIFT_DARF_RC5) & BIT_MASK_DARF_RC5) -+#define BIT_SET_DARF_RC5(x, v) (BIT_CLEAR_DARF_RC5(x) | BIT_DARF_RC5(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC4 24 -+#define BIT_MASK_DARF_RC4 0x1f -+#define BIT_DARF_RC4(x) (((x) & BIT_MASK_DARF_RC4) << BIT_SHIFT_DARF_RC4) -+#define BITS_DARF_RC4 (BIT_MASK_DARF_RC4 << BIT_SHIFT_DARF_RC4) -+#define BIT_CLEAR_DARF_RC4(x) ((x) & (~BITS_DARF_RC4)) -+#define BIT_GET_DARF_RC4(x) (((x) >> BIT_SHIFT_DARF_RC4) & BIT_MASK_DARF_RC4) -+#define BIT_SET_DARF_RC4(x, v) (BIT_CLEAR_DARF_RC4(x) | BIT_DARF_RC4(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC4_V2 24 -+#define BIT_MASK_DARF_RC4_V2 0x1f -+#define BIT_DARF_RC4_V2(x) \ -+ (((x) & BIT_MASK_DARF_RC4_V2) << BIT_SHIFT_DARF_RC4_V2) -+#define BITS_DARF_RC4_V2 (BIT_MASK_DARF_RC4_V2 << BIT_SHIFT_DARF_RC4_V2) -+#define BIT_CLEAR_DARF_RC4_V2(x) ((x) & (~BITS_DARF_RC4_V2)) -+#define BIT_GET_DARF_RC4_V2(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC4_V2) & BIT_MASK_DARF_RC4_V2) -+#define BIT_SET_DARF_RC4_V2(x, v) \ -+ (BIT_CLEAR_DARF_RC4_V2(x) | BIT_DARF_RC4_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC4_V1 24 -+#define BIT_MASK_DARF_RC4_V1 0x3f -+#define BIT_DARF_RC4_V1(x) \ -+ (((x) & BIT_MASK_DARF_RC4_V1) << BIT_SHIFT_DARF_RC4_V1) -+#define BITS_DARF_RC4_V1 (BIT_MASK_DARF_RC4_V1 << BIT_SHIFT_DARF_RC4_V1) -+#define BIT_CLEAR_DARF_RC4_V1(x) ((x) & (~BITS_DARF_RC4_V1)) -+#define BIT_GET_DARF_RC4_V1(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC4_V1) & BIT_MASK_DARF_RC4_V1) -+#define BIT_SET_DARF_RC4_V1(x, v) \ -+ (BIT_CLEAR_DARF_RC4_V1(x) | BIT_DARF_RC4_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC3 16 -+#define BIT_MASK_DARF_RC3 0x1f -+#define BIT_DARF_RC3(x) (((x) & BIT_MASK_DARF_RC3) << BIT_SHIFT_DARF_RC3) -+#define BITS_DARF_RC3 (BIT_MASK_DARF_RC3 << BIT_SHIFT_DARF_RC3) -+#define BIT_CLEAR_DARF_RC3(x) ((x) & (~BITS_DARF_RC3)) -+#define BIT_GET_DARF_RC3(x) (((x) >> BIT_SHIFT_DARF_RC3) & BIT_MASK_DARF_RC3) -+#define BIT_SET_DARF_RC3(x, v) (BIT_CLEAR_DARF_RC3(x) | BIT_DARF_RC3(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC3_V2 16 -+#define BIT_MASK_DARF_RC3_V2 0x1f -+#define BIT_DARF_RC3_V2(x) \ -+ (((x) & BIT_MASK_DARF_RC3_V2) << BIT_SHIFT_DARF_RC3_V2) -+#define BITS_DARF_RC3_V2 (BIT_MASK_DARF_RC3_V2 << BIT_SHIFT_DARF_RC3_V2) -+#define BIT_CLEAR_DARF_RC3_V2(x) ((x) & (~BITS_DARF_RC3_V2)) -+#define BIT_GET_DARF_RC3_V2(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC3_V2) & BIT_MASK_DARF_RC3_V2) -+#define BIT_SET_DARF_RC3_V2(x, v) \ -+ (BIT_CLEAR_DARF_RC3_V2(x) | BIT_DARF_RC3_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC3_V1 16 -+#define BIT_MASK_DARF_RC3_V1 0x3f -+#define BIT_DARF_RC3_V1(x) \ -+ (((x) & BIT_MASK_DARF_RC3_V1) << BIT_SHIFT_DARF_RC3_V1) -+#define BITS_DARF_RC3_V1 (BIT_MASK_DARF_RC3_V1 << BIT_SHIFT_DARF_RC3_V1) -+#define BIT_CLEAR_DARF_RC3_V1(x) ((x) & (~BITS_DARF_RC3_V1)) -+#define BIT_GET_DARF_RC3_V1(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC3_V1) & BIT_MASK_DARF_RC3_V1) -+#define BIT_SET_DARF_RC3_V1(x, v) \ -+ (BIT_CLEAR_DARF_RC3_V1(x) | BIT_DARF_RC3_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC2 8 -+#define BIT_MASK_DARF_RC2 0x1f -+#define BIT_DARF_RC2(x) (((x) & BIT_MASK_DARF_RC2) << BIT_SHIFT_DARF_RC2) -+#define BITS_DARF_RC2 (BIT_MASK_DARF_RC2 << BIT_SHIFT_DARF_RC2) -+#define BIT_CLEAR_DARF_RC2(x) ((x) & (~BITS_DARF_RC2)) -+#define BIT_GET_DARF_RC2(x) (((x) >> BIT_SHIFT_DARF_RC2) & BIT_MASK_DARF_RC2) -+#define BIT_SET_DARF_RC2(x, v) (BIT_CLEAR_DARF_RC2(x) | BIT_DARF_RC2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC2_V2 8 -+#define BIT_MASK_DARF_RC2_V2 0x1f -+#define BIT_DARF_RC2_V2(x) \ -+ (((x) & BIT_MASK_DARF_RC2_V2) << BIT_SHIFT_DARF_RC2_V2) -+#define BITS_DARF_RC2_V2 (BIT_MASK_DARF_RC2_V2 << BIT_SHIFT_DARF_RC2_V2) -+#define BIT_CLEAR_DARF_RC2_V2(x) ((x) & (~BITS_DARF_RC2_V2)) -+#define BIT_GET_DARF_RC2_V2(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC2_V2) & BIT_MASK_DARF_RC2_V2) -+#define BIT_SET_DARF_RC2_V2(x, v) \ -+ (BIT_CLEAR_DARF_RC2_V2(x) | BIT_DARF_RC2_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC2_V1 8 -+#define BIT_MASK_DARF_RC2_V1 0x3f -+#define BIT_DARF_RC2_V1(x) \ -+ (((x) & BIT_MASK_DARF_RC2_V1) << BIT_SHIFT_DARF_RC2_V1) -+#define BITS_DARF_RC2_V1 (BIT_MASK_DARF_RC2_V1 << BIT_SHIFT_DARF_RC2_V1) -+#define BIT_CLEAR_DARF_RC2_V1(x) ((x) & (~BITS_DARF_RC2_V1)) -+#define BIT_GET_DARF_RC2_V1(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC2_V1) & BIT_MASK_DARF_RC2_V1) -+#define BIT_SET_DARF_RC2_V1(x, v) \ -+ (BIT_CLEAR_DARF_RC2_V1(x) | BIT_DARF_RC2_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC1 0 -+#define BIT_MASK_DARF_RC1 0x1f -+#define BIT_DARF_RC1(x) (((x) & BIT_MASK_DARF_RC1) << BIT_SHIFT_DARF_RC1) -+#define BITS_DARF_RC1 (BIT_MASK_DARF_RC1 << BIT_SHIFT_DARF_RC1) -+#define BIT_CLEAR_DARF_RC1(x) ((x) & (~BITS_DARF_RC1)) -+#define BIT_GET_DARF_RC1(x) (((x) >> BIT_SHIFT_DARF_RC1) & BIT_MASK_DARF_RC1) -+#define BIT_SET_DARF_RC1(x, v) (BIT_CLEAR_DARF_RC1(x) | BIT_DARF_RC1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC1_V2 0 -+#define BIT_MASK_DARF_RC1_V2 0x1f -+#define BIT_DARF_RC1_V2(x) \ -+ (((x) & BIT_MASK_DARF_RC1_V2) << BIT_SHIFT_DARF_RC1_V2) -+#define BITS_DARF_RC1_V2 (BIT_MASK_DARF_RC1_V2 << BIT_SHIFT_DARF_RC1_V2) -+#define BIT_CLEAR_DARF_RC1_V2(x) ((x) & (~BITS_DARF_RC1_V2)) -+#define BIT_GET_DARF_RC1_V2(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC1_V2) & BIT_MASK_DARF_RC1_V2) -+#define BIT_SET_DARF_RC1_V2(x, v) \ -+ (BIT_CLEAR_DARF_RC1_V2(x) | BIT_DARF_RC1_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DARFRC (Offset 0x0430) */ -+ -+#define BIT_SHIFT_DARF_RC1_V1 0 -+#define BIT_MASK_DARF_RC1_V1 0x3f -+#define BIT_DARF_RC1_V1(x) \ -+ (((x) & BIT_MASK_DARF_RC1_V1) << BIT_SHIFT_DARF_RC1_V1) -+#define BITS_DARF_RC1_V1 (BIT_MASK_DARF_RC1_V1 << BIT_SHIFT_DARF_RC1_V1) -+#define BIT_CLEAR_DARF_RC1_V1(x) ((x) & (~BITS_DARF_RC1_V1)) -+#define BIT_GET_DARF_RC1_V1(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC1_V1) & BIT_MASK_DARF_RC1_V1) -+#define BIT_SET_DARF_RC1_V1(x, v) \ -+ (BIT_CLEAR_DARF_RC1_V1(x) | BIT_DARF_RC1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DARFRCH (Offset 0x0434) */ -+ -+#define BIT_SHIFT_DARF_RC8_V3 24 -+#define BIT_MASK_DARF_RC8_V3 0x1f -+#define BIT_DARF_RC8_V3(x) \ -+ (((x) & BIT_MASK_DARF_RC8_V3) << BIT_SHIFT_DARF_RC8_V3) -+#define BITS_DARF_RC8_V3 (BIT_MASK_DARF_RC8_V3 << BIT_SHIFT_DARF_RC8_V3) -+#define BIT_CLEAR_DARF_RC8_V3(x) ((x) & (~BITS_DARF_RC8_V3)) -+#define BIT_GET_DARF_RC8_V3(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC8_V3) & BIT_MASK_DARF_RC8_V3) -+#define BIT_SET_DARF_RC8_V3(x, v) \ -+ (BIT_CLEAR_DARF_RC8_V3(x) | BIT_DARF_RC8_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DARFRCH (Offset 0x0434) */ -+ -+#define BIT_SHIFT_DARF_RC8_V1 24 -+#define BIT_MASK_DARF_RC8_V1 0x1f -+#define BIT_DARF_RC8_V1(x) \ -+ (((x) & BIT_MASK_DARF_RC8_V1) << BIT_SHIFT_DARF_RC8_V1) -+#define BITS_DARF_RC8_V1 (BIT_MASK_DARF_RC8_V1 << BIT_SHIFT_DARF_RC8_V1) -+#define BIT_CLEAR_DARF_RC8_V1(x) ((x) & (~BITS_DARF_RC8_V1)) -+#define BIT_GET_DARF_RC8_V1(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC8_V1) & BIT_MASK_DARF_RC8_V1) -+#define BIT_SET_DARF_RC8_V1(x, v) \ -+ (BIT_CLEAR_DARF_RC8_V1(x) | BIT_DARF_RC8_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DARFRCH (Offset 0x0434) */ -+ -+#define BIT_SHIFT_DARF_RC7_V3 16 -+#define BIT_MASK_DARF_RC7_V3 0x1f -+#define BIT_DARF_RC7_V3(x) \ -+ (((x) & BIT_MASK_DARF_RC7_V3) << BIT_SHIFT_DARF_RC7_V3) -+#define BITS_DARF_RC7_V3 (BIT_MASK_DARF_RC7_V3 << BIT_SHIFT_DARF_RC7_V3) -+#define BIT_CLEAR_DARF_RC7_V3(x) ((x) & (~BITS_DARF_RC7_V3)) -+#define BIT_GET_DARF_RC7_V3(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC7_V3) & BIT_MASK_DARF_RC7_V3) -+#define BIT_SET_DARF_RC7_V3(x, v) \ -+ (BIT_CLEAR_DARF_RC7_V3(x) | BIT_DARF_RC7_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DARFRCH (Offset 0x0434) */ -+ -+#define BIT_SHIFT_DARF_RC7_V1 16 -+#define BIT_MASK_DARF_RC7_V1 0x1f -+#define BIT_DARF_RC7_V1(x) \ -+ (((x) & BIT_MASK_DARF_RC7_V1) << BIT_SHIFT_DARF_RC7_V1) -+#define BITS_DARF_RC7_V1 (BIT_MASK_DARF_RC7_V1 << BIT_SHIFT_DARF_RC7_V1) -+#define BIT_CLEAR_DARF_RC7_V1(x) ((x) & (~BITS_DARF_RC7_V1)) -+#define BIT_GET_DARF_RC7_V1(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC7_V1) & BIT_MASK_DARF_RC7_V1) -+#define BIT_SET_DARF_RC7_V1(x, v) \ -+ (BIT_CLEAR_DARF_RC7_V1(x) | BIT_DARF_RC7_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DARFRCH (Offset 0x0434) */ -+ -+#define BIT_SHIFT_DARF_RC6_V3 8 -+#define BIT_MASK_DARF_RC6_V3 0x1f -+#define BIT_DARF_RC6_V3(x) \ -+ (((x) & BIT_MASK_DARF_RC6_V3) << BIT_SHIFT_DARF_RC6_V3) -+#define BITS_DARF_RC6_V3 (BIT_MASK_DARF_RC6_V3 << BIT_SHIFT_DARF_RC6_V3) -+#define BIT_CLEAR_DARF_RC6_V3(x) ((x) & (~BITS_DARF_RC6_V3)) -+#define BIT_GET_DARF_RC6_V3(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC6_V3) & BIT_MASK_DARF_RC6_V3) -+#define BIT_SET_DARF_RC6_V3(x, v) \ -+ (BIT_CLEAR_DARF_RC6_V3(x) | BIT_DARF_RC6_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DARFRCH (Offset 0x0434) */ -+ -+#define BIT_SHIFT_DARF_RC6_V1 8 -+#define BIT_MASK_DARF_RC6_V1 0x1f -+#define BIT_DARF_RC6_V1(x) \ -+ (((x) & BIT_MASK_DARF_RC6_V1) << BIT_SHIFT_DARF_RC6_V1) -+#define BITS_DARF_RC6_V1 (BIT_MASK_DARF_RC6_V1 << BIT_SHIFT_DARF_RC6_V1) -+#define BIT_CLEAR_DARF_RC6_V1(x) ((x) & (~BITS_DARF_RC6_V1)) -+#define BIT_GET_DARF_RC6_V1(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC6_V1) & BIT_MASK_DARF_RC6_V1) -+#define BIT_SET_DARF_RC6_V1(x, v) \ -+ (BIT_CLEAR_DARF_RC6_V1(x) | BIT_DARF_RC6_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DARFRCH (Offset 0x0434) */ -+ -+#define BIT_SHIFT_DARF_RC5_V3 0 -+#define BIT_MASK_DARF_RC5_V3 0x1f -+#define BIT_DARF_RC5_V3(x) \ -+ (((x) & BIT_MASK_DARF_RC5_V3) << BIT_SHIFT_DARF_RC5_V3) -+#define BITS_DARF_RC5_V3 (BIT_MASK_DARF_RC5_V3 << BIT_SHIFT_DARF_RC5_V3) -+#define BIT_CLEAR_DARF_RC5_V3(x) ((x) & (~BITS_DARF_RC5_V3)) -+#define BIT_GET_DARF_RC5_V3(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC5_V3) & BIT_MASK_DARF_RC5_V3) -+#define BIT_SET_DARF_RC5_V3(x, v) \ -+ (BIT_CLEAR_DARF_RC5_V3(x) | BIT_DARF_RC5_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DARFRCH (Offset 0x0434) */ -+ -+#define BIT_SHIFT_DARF_RC5_V1 0 -+#define BIT_MASK_DARF_RC5_V1 0x1f -+#define BIT_DARF_RC5_V1(x) \ -+ (((x) & BIT_MASK_DARF_RC5_V1) << BIT_SHIFT_DARF_RC5_V1) -+#define BITS_DARF_RC5_V1 (BIT_MASK_DARF_RC5_V1 << BIT_SHIFT_DARF_RC5_V1) -+#define BIT_CLEAR_DARF_RC5_V1(x) ((x) & (~BITS_DARF_RC5_V1)) -+#define BIT_GET_DARF_RC5_V1(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC5_V1) & BIT_MASK_DARF_RC5_V1) -+#define BIT_SET_DARF_RC5_V1(x, v) \ -+ (BIT_CLEAR_DARF_RC5_V1(x) | BIT_DARF_RC5_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RARFRC (Offset 0x0438) */ -+ -+#define BIT_SHIFT_RARF_RC8 (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC8 0x1f -+#define BIT_RARF_RC8(x) (((x) & BIT_MASK_RARF_RC8) << BIT_SHIFT_RARF_RC8) -+#define BITS_RARF_RC8 (BIT_MASK_RARF_RC8 << BIT_SHIFT_RARF_RC8) -+#define BIT_CLEAR_RARF_RC8(x) ((x) & (~BITS_RARF_RC8)) -+#define BIT_GET_RARF_RC8(x) (((x) >> BIT_SHIFT_RARF_RC8) & BIT_MASK_RARF_RC8) -+#define BIT_SET_RARF_RC8(x, v) (BIT_CLEAR_RARF_RC8(x) | BIT_RARF_RC8(v)) -+ -+#define BIT_SHIFT_RARF_RC7 (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC7 0x1f -+#define BIT_RARF_RC7(x) (((x) & BIT_MASK_RARF_RC7) << BIT_SHIFT_RARF_RC7) -+#define BITS_RARF_RC7 (BIT_MASK_RARF_RC7 << BIT_SHIFT_RARF_RC7) -+#define BIT_CLEAR_RARF_RC7(x) ((x) & (~BITS_RARF_RC7)) -+#define BIT_GET_RARF_RC7(x) (((x) >> BIT_SHIFT_RARF_RC7) & BIT_MASK_RARF_RC7) -+#define BIT_SET_RARF_RC7(x, v) (BIT_CLEAR_RARF_RC7(x) | BIT_RARF_RC7(v)) -+ -+#define BIT_SHIFT_RARF_RC6 (40 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC6 0x1f -+#define BIT_RARF_RC6(x) (((x) & BIT_MASK_RARF_RC6) << BIT_SHIFT_RARF_RC6) -+#define BITS_RARF_RC6 (BIT_MASK_RARF_RC6 << BIT_SHIFT_RARF_RC6) -+#define BIT_CLEAR_RARF_RC6(x) ((x) & (~BITS_RARF_RC6)) -+#define BIT_GET_RARF_RC6(x) (((x) >> BIT_SHIFT_RARF_RC6) & BIT_MASK_RARF_RC6) -+#define BIT_SET_RARF_RC6(x, v) (BIT_CLEAR_RARF_RC6(x) | BIT_RARF_RC6(v)) -+ -+#define BIT_SHIFT_RARF_RC5 (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC5 0x1f -+#define BIT_RARF_RC5(x) (((x) & BIT_MASK_RARF_RC5) << BIT_SHIFT_RARF_RC5) -+#define BITS_RARF_RC5 (BIT_MASK_RARF_RC5 << BIT_SHIFT_RARF_RC5) -+#define BIT_CLEAR_RARF_RC5(x) ((x) & (~BITS_RARF_RC5)) -+#define BIT_GET_RARF_RC5(x) (((x) >> BIT_SHIFT_RARF_RC5) & BIT_MASK_RARF_RC5) -+#define BIT_SET_RARF_RC5(x, v) (BIT_CLEAR_RARF_RC5(x) | BIT_RARF_RC5(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RARFRC (Offset 0x0438) */ -+ -+#define BIT_SHIFT_RARF_RC4 24 -+#define BIT_MASK_RARF_RC4 0x1f -+#define BIT_RARF_RC4(x) (((x) & BIT_MASK_RARF_RC4) << BIT_SHIFT_RARF_RC4) -+#define BITS_RARF_RC4 (BIT_MASK_RARF_RC4 << BIT_SHIFT_RARF_RC4) -+#define BIT_CLEAR_RARF_RC4(x) ((x) & (~BITS_RARF_RC4)) -+#define BIT_GET_RARF_RC4(x) (((x) >> BIT_SHIFT_RARF_RC4) & BIT_MASK_RARF_RC4) -+#define BIT_SET_RARF_RC4(x, v) (BIT_CLEAR_RARF_RC4(x) | BIT_RARF_RC4(v)) -+ -+#define BIT_SHIFT_RARF_RC3 16 -+#define BIT_MASK_RARF_RC3 0x1f -+#define BIT_RARF_RC3(x) (((x) & BIT_MASK_RARF_RC3) << BIT_SHIFT_RARF_RC3) -+#define BITS_RARF_RC3 (BIT_MASK_RARF_RC3 << BIT_SHIFT_RARF_RC3) -+#define BIT_CLEAR_RARF_RC3(x) ((x) & (~BITS_RARF_RC3)) -+#define BIT_GET_RARF_RC3(x) (((x) >> BIT_SHIFT_RARF_RC3) & BIT_MASK_RARF_RC3) -+#define BIT_SET_RARF_RC3(x, v) (BIT_CLEAR_RARF_RC3(x) | BIT_RARF_RC3(v)) -+ -+#define BIT_SHIFT_RARF_RC2 8 -+#define BIT_MASK_RARF_RC2 0x1f -+#define BIT_RARF_RC2(x) (((x) & BIT_MASK_RARF_RC2) << BIT_SHIFT_RARF_RC2) -+#define BITS_RARF_RC2 (BIT_MASK_RARF_RC2 << BIT_SHIFT_RARF_RC2) -+#define BIT_CLEAR_RARF_RC2(x) ((x) & (~BITS_RARF_RC2)) -+#define BIT_GET_RARF_RC2(x) (((x) >> BIT_SHIFT_RARF_RC2) & BIT_MASK_RARF_RC2) -+#define BIT_SET_RARF_RC2(x, v) (BIT_CLEAR_RARF_RC2(x) | BIT_RARF_RC2(v)) -+ -+#define BIT_SHIFT_RARF_RC1 0 -+#define BIT_MASK_RARF_RC1 0x1f -+#define BIT_RARF_RC1(x) (((x) & BIT_MASK_RARF_RC1) << BIT_SHIFT_RARF_RC1) -+#define BITS_RARF_RC1 (BIT_MASK_RARF_RC1 << BIT_SHIFT_RARF_RC1) -+#define BIT_CLEAR_RARF_RC1(x) ((x) & (~BITS_RARF_RC1)) -+#define BIT_GET_RARF_RC1(x) (((x) >> BIT_SHIFT_RARF_RC1) & BIT_MASK_RARF_RC1) -+#define BIT_SET_RARF_RC1(x, v) (BIT_CLEAR_RARF_RC1(x) | BIT_RARF_RC1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RARFRCH (Offset 0x043C) */ -+ -+#define BIT_SHIFT_RARF_RC8_V1 24 -+#define BIT_MASK_RARF_RC8_V1 0x1f -+#define BIT_RARF_RC8_V1(x) \ -+ (((x) & BIT_MASK_RARF_RC8_V1) << BIT_SHIFT_RARF_RC8_V1) -+#define BITS_RARF_RC8_V1 (BIT_MASK_RARF_RC8_V1 << BIT_SHIFT_RARF_RC8_V1) -+#define BIT_CLEAR_RARF_RC8_V1(x) ((x) & (~BITS_RARF_RC8_V1)) -+#define BIT_GET_RARF_RC8_V1(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC8_V1) & BIT_MASK_RARF_RC8_V1) -+#define BIT_SET_RARF_RC8_V1(x, v) \ -+ (BIT_CLEAR_RARF_RC8_V1(x) | BIT_RARF_RC8_V1(v)) -+ -+#define BIT_SHIFT_RARF_RC7_V1 16 -+#define BIT_MASK_RARF_RC7_V1 0x1f -+#define BIT_RARF_RC7_V1(x) \ -+ (((x) & BIT_MASK_RARF_RC7_V1) << BIT_SHIFT_RARF_RC7_V1) -+#define BITS_RARF_RC7_V1 (BIT_MASK_RARF_RC7_V1 << BIT_SHIFT_RARF_RC7_V1) -+#define BIT_CLEAR_RARF_RC7_V1(x) ((x) & (~BITS_RARF_RC7_V1)) -+#define BIT_GET_RARF_RC7_V1(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC7_V1) & BIT_MASK_RARF_RC7_V1) -+#define BIT_SET_RARF_RC7_V1(x, v) \ -+ (BIT_CLEAR_RARF_RC7_V1(x) | BIT_RARF_RC7_V1(v)) -+ -+#define BIT_SHIFT_RARF_RC6_V1 8 -+#define BIT_MASK_RARF_RC6_V1 0x1f -+#define BIT_RARF_RC6_V1(x) \ -+ (((x) & BIT_MASK_RARF_RC6_V1) << BIT_SHIFT_RARF_RC6_V1) -+#define BITS_RARF_RC6_V1 (BIT_MASK_RARF_RC6_V1 << BIT_SHIFT_RARF_RC6_V1) -+#define BIT_CLEAR_RARF_RC6_V1(x) ((x) & (~BITS_RARF_RC6_V1)) -+#define BIT_GET_RARF_RC6_V1(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC6_V1) & BIT_MASK_RARF_RC6_V1) -+#define BIT_SET_RARF_RC6_V1(x, v) \ -+ (BIT_CLEAR_RARF_RC6_V1(x) | BIT_RARF_RC6_V1(v)) -+ -+#define BIT_SHIFT_RARF_RC5_V1 0 -+#define BIT_MASK_RARF_RC5_V1 0x1f -+#define BIT_RARF_RC5_V1(x) \ -+ (((x) & BIT_MASK_RARF_RC5_V1) << BIT_SHIFT_RARF_RC5_V1) -+#define BITS_RARF_RC5_V1 (BIT_MASK_RARF_RC5_V1 << BIT_SHIFT_RARF_RC5_V1) -+#define BIT_CLEAR_RARF_RC5_V1(x) ((x) & (~BITS_RARF_RC5_V1)) -+#define BIT_GET_RARF_RC5_V1(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC5_V1) & BIT_MASK_RARF_RC5_V1) -+#define BIT_SET_RARF_RC5_V1(x, v) \ -+ (BIT_CLEAR_RARF_RC5_V1(x) | BIT_RARF_RC5_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RRSR (Offset 0x0440) */ -+ -+#define BIT_EN_VHTBW_FALL BIT(31) -+#define BIT_EN_HTBW_FALL BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RRSR (Offset 0x0440) */ -+ -+#define BIT_SHIFT_RRSR_RSC 21 -+#define BIT_MASK_RRSR_RSC 0x3 -+#define BIT_RRSR_RSC(x) (((x) & BIT_MASK_RRSR_RSC) << BIT_SHIFT_RRSR_RSC) -+#define BITS_RRSR_RSC (BIT_MASK_RRSR_RSC << BIT_SHIFT_RRSR_RSC) -+#define BIT_CLEAR_RRSR_RSC(x) ((x) & (~BITS_RRSR_RSC)) -+#define BIT_GET_RRSR_RSC(x) (((x) >> BIT_SHIFT_RRSR_RSC) & BIT_MASK_RRSR_RSC) -+#define BIT_SET_RRSR_RSC(x, v) (BIT_CLEAR_RRSR_RSC(x) | BIT_RRSR_RSC(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RRSR (Offset 0x0440) */ -+ -+#define BIT_RRSR_BW BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RRSR (Offset 0x0440) */ -+ -+#define BIT_SHIFT_RRSC_BITMAP 0 -+#define BIT_MASK_RRSC_BITMAP 0xfffff -+#define BIT_RRSC_BITMAP(x) \ -+ (((x) & BIT_MASK_RRSC_BITMAP) << BIT_SHIFT_RRSC_BITMAP) -+#define BITS_RRSC_BITMAP (BIT_MASK_RRSC_BITMAP << BIT_SHIFT_RRSC_BITMAP) -+#define BIT_CLEAR_RRSC_BITMAP(x) ((x) & (~BITS_RRSC_BITMAP)) -+#define BIT_GET_RRSC_BITMAP(x) \ -+ (((x) >> BIT_SHIFT_RRSC_BITMAP) & BIT_MASK_RRSC_BITMAP) -+#define BIT_SET_RRSC_BITMAP(x, v) \ -+ (BIT_CLEAR_RRSC_BITMAP(x) | BIT_RRSC_BITMAP(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RRSR_H (Offset 0x0443) */ -+ -+#define BIT_EN_VHTBW_FALL_V1 BIT(7) -+#define BIT_EN_HTBW_FALL_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ARFR0 (Offset 0x0444) */ -+ -+#define BIT_SHIFT_ARFR0_V1 0 -+#define BIT_MASK_ARFR0_V1 0xffffffffffffffffL -+#define BIT_ARFR0_V1(x) (((x) & BIT_MASK_ARFR0_V1) << BIT_SHIFT_ARFR0_V1) -+#define BITS_ARFR0_V1 (BIT_MASK_ARFR0_V1 << BIT_SHIFT_ARFR0_V1) -+#define BIT_CLEAR_ARFR0_V1(x) ((x) & (~BITS_ARFR0_V1)) -+#define BIT_GET_ARFR0_V1(x) (((x) >> BIT_SHIFT_ARFR0_V1) & BIT_MASK_ARFR0_V1) -+#define BIT_SET_ARFR0_V1(x, v) (BIT_CLEAR_ARFR0_V1(x) | BIT_ARFR0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ARFR0 (Offset 0x0444) */ -+ -+#define BIT_SHIFT_ARFRL0 0 -+#define BIT_MASK_ARFRL0 0xffffffffL -+#define BIT_ARFRL0(x) (((x) & BIT_MASK_ARFRL0) << BIT_SHIFT_ARFRL0) -+#define BITS_ARFRL0 (BIT_MASK_ARFRL0 << BIT_SHIFT_ARFRL0) -+#define BIT_CLEAR_ARFRL0(x) ((x) & (~BITS_ARFRL0)) -+#define BIT_GET_ARFRL0(x) (((x) >> BIT_SHIFT_ARFRL0) & BIT_MASK_ARFRL0) -+#define BIT_SET_ARFRL0(x, v) (BIT_CLEAR_ARFRL0(x) | BIT_ARFRL0(v)) -+ -+/* 2 REG_ARFRH0 (Offset 0x0448) */ -+ -+#define BIT_SHIFT_ARFRH0 0 -+#define BIT_MASK_ARFRH0 0xffffffffL -+#define BIT_ARFRH0(x) (((x) & BIT_MASK_ARFRH0) << BIT_SHIFT_ARFRH0) -+#define BITS_ARFRH0 (BIT_MASK_ARFRH0 << BIT_SHIFT_ARFRH0) -+#define BIT_CLEAR_ARFRH0(x) ((x) & (~BITS_ARFRH0)) -+#define BIT_GET_ARFRH0(x) (((x) >> BIT_SHIFT_ARFRH0) & BIT_MASK_ARFRH0) -+#define BIT_SET_ARFRH0(x, v) (BIT_CLEAR_ARFRH0(x) | BIT_ARFRH0(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_REG_ARFR_WT0 (Offset 0x044C) */ -+ -+#define BIT_SHIFT_RATE7_WEIGHTING 28 -+#define BIT_MASK_RATE7_WEIGHTING 0xf -+#define BIT_RATE7_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE7_WEIGHTING) << BIT_SHIFT_RATE7_WEIGHTING) -+#define BITS_RATE7_WEIGHTING \ -+ (BIT_MASK_RATE7_WEIGHTING << BIT_SHIFT_RATE7_WEIGHTING) -+#define BIT_CLEAR_RATE7_WEIGHTING(x) ((x) & (~BITS_RATE7_WEIGHTING)) -+#define BIT_GET_RATE7_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE7_WEIGHTING) & BIT_MASK_RATE7_WEIGHTING) -+#define BIT_SET_RATE7_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE7_WEIGHTING(x) | BIT_RATE7_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE6_WEIGHTING 24 -+#define BIT_MASK_RATE6_WEIGHTING 0xf -+#define BIT_RATE6_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE6_WEIGHTING) << BIT_SHIFT_RATE6_WEIGHTING) -+#define BITS_RATE6_WEIGHTING \ -+ (BIT_MASK_RATE6_WEIGHTING << BIT_SHIFT_RATE6_WEIGHTING) -+#define BIT_CLEAR_RATE6_WEIGHTING(x) ((x) & (~BITS_RATE6_WEIGHTING)) -+#define BIT_GET_RATE6_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE6_WEIGHTING) & BIT_MASK_RATE6_WEIGHTING) -+#define BIT_SET_RATE6_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE6_WEIGHTING(x) | BIT_RATE6_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE5_WEIGHTING 20 -+#define BIT_MASK_RATE5_WEIGHTING 0xf -+#define BIT_RATE5_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE5_WEIGHTING) << BIT_SHIFT_RATE5_WEIGHTING) -+#define BITS_RATE5_WEIGHTING \ -+ (BIT_MASK_RATE5_WEIGHTING << BIT_SHIFT_RATE5_WEIGHTING) -+#define BIT_CLEAR_RATE5_WEIGHTING(x) ((x) & (~BITS_RATE5_WEIGHTING)) -+#define BIT_GET_RATE5_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE5_WEIGHTING) & BIT_MASK_RATE5_WEIGHTING) -+#define BIT_SET_RATE5_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE5_WEIGHTING(x) | BIT_RATE5_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE4_WEIGHTING 16 -+#define BIT_MASK_RATE4_WEIGHTING 0xf -+#define BIT_RATE4_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE4_WEIGHTING) << BIT_SHIFT_RATE4_WEIGHTING) -+#define BITS_RATE4_WEIGHTING \ -+ (BIT_MASK_RATE4_WEIGHTING << BIT_SHIFT_RATE4_WEIGHTING) -+#define BIT_CLEAR_RATE4_WEIGHTING(x) ((x) & (~BITS_RATE4_WEIGHTING)) -+#define BIT_GET_RATE4_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE4_WEIGHTING) & BIT_MASK_RATE4_WEIGHTING) -+#define BIT_SET_RATE4_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE4_WEIGHTING(x) | BIT_RATE4_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE3_WEIGHTING 12 -+#define BIT_MASK_RATE3_WEIGHTING 0xf -+#define BIT_RATE3_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE3_WEIGHTING) << BIT_SHIFT_RATE3_WEIGHTING) -+#define BITS_RATE3_WEIGHTING \ -+ (BIT_MASK_RATE3_WEIGHTING << BIT_SHIFT_RATE3_WEIGHTING) -+#define BIT_CLEAR_RATE3_WEIGHTING(x) ((x) & (~BITS_RATE3_WEIGHTING)) -+#define BIT_GET_RATE3_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE3_WEIGHTING) & BIT_MASK_RATE3_WEIGHTING) -+#define BIT_SET_RATE3_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE3_WEIGHTING(x) | BIT_RATE3_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE2_WEIGHTING 8 -+#define BIT_MASK_RATE2_WEIGHTING 0xf -+#define BIT_RATE2_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE2_WEIGHTING) << BIT_SHIFT_RATE2_WEIGHTING) -+#define BITS_RATE2_WEIGHTING \ -+ (BIT_MASK_RATE2_WEIGHTING << BIT_SHIFT_RATE2_WEIGHTING) -+#define BIT_CLEAR_RATE2_WEIGHTING(x) ((x) & (~BITS_RATE2_WEIGHTING)) -+#define BIT_GET_RATE2_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE2_WEIGHTING) & BIT_MASK_RATE2_WEIGHTING) -+#define BIT_SET_RATE2_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE2_WEIGHTING(x) | BIT_RATE2_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE1_WEIGHTING 4 -+#define BIT_MASK_RATE1_WEIGHTING 0xf -+#define BIT_RATE1_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE1_WEIGHTING) << BIT_SHIFT_RATE1_WEIGHTING) -+#define BITS_RATE1_WEIGHTING \ -+ (BIT_MASK_RATE1_WEIGHTING << BIT_SHIFT_RATE1_WEIGHTING) -+#define BIT_CLEAR_RATE1_WEIGHTING(x) ((x) & (~BITS_RATE1_WEIGHTING)) -+#define BIT_GET_RATE1_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE1_WEIGHTING) & BIT_MASK_RATE1_WEIGHTING) -+#define BIT_SET_RATE1_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE1_WEIGHTING(x) | BIT_RATE1_WEIGHTING(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ARFR1_V1 (Offset 0x044C) */ -+ -+#define BIT_SHIFT_ARFR1_V1 0 -+#define BIT_MASK_ARFR1_V1 0xffffffffffffffffL -+#define BIT_ARFR1_V1(x) (((x) & BIT_MASK_ARFR1_V1) << BIT_SHIFT_ARFR1_V1) -+#define BITS_ARFR1_V1 (BIT_MASK_ARFR1_V1 << BIT_SHIFT_ARFR1_V1) -+#define BIT_CLEAR_ARFR1_V1(x) ((x) & (~BITS_ARFR1_V1)) -+#define BIT_GET_ARFR1_V1(x) (((x) >> BIT_SHIFT_ARFR1_V1) & BIT_MASK_ARFR1_V1) -+#define BIT_SET_ARFR1_V1(x, v) (BIT_CLEAR_ARFR1_V1(x) | BIT_ARFR1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ARFR1_V1 (Offset 0x044C) */ -+ -+#define BIT_SHIFT_ARFRL1 0 -+#define BIT_MASK_ARFRL1 0xffffffffL -+#define BIT_ARFRL1(x) (((x) & BIT_MASK_ARFRL1) << BIT_SHIFT_ARFRL1) -+#define BITS_ARFRL1 (BIT_MASK_ARFRL1 << BIT_SHIFT_ARFRL1) -+#define BIT_CLEAR_ARFRL1(x) ((x) & (~BITS_ARFRL1)) -+#define BIT_GET_ARFRL1(x) (((x) >> BIT_SHIFT_ARFRL1) & BIT_MASK_ARFRL1) -+#define BIT_SET_ARFRL1(x, v) (BIT_CLEAR_ARFRL1(x) | BIT_ARFRL1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_REG_ARFR_WT0 (Offset 0x044C) */ -+ -+#define BIT_SHIFT_RATE0_WEIGHTING 0 -+#define BIT_MASK_RATE0_WEIGHTING 0xf -+#define BIT_RATE0_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE0_WEIGHTING) << BIT_SHIFT_RATE0_WEIGHTING) -+#define BITS_RATE0_WEIGHTING \ -+ (BIT_MASK_RATE0_WEIGHTING << BIT_SHIFT_RATE0_WEIGHTING) -+#define BIT_CLEAR_RATE0_WEIGHTING(x) ((x) & (~BITS_RATE0_WEIGHTING)) -+#define BIT_GET_RATE0_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE0_WEIGHTING) & BIT_MASK_RATE0_WEIGHTING) -+#define BIT_SET_RATE0_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE0_WEIGHTING(x) | BIT_RATE0_WEIGHTING(v)) -+ -+/* 2 REG_REG_ARFR_WT1 (Offset 0x0450) */ -+ -+#define BIT_SHIFT_RATE15_WEIGHTING 28 -+#define BIT_MASK_RATE15_WEIGHTING 0xf -+#define BIT_RATE15_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE15_WEIGHTING) << BIT_SHIFT_RATE15_WEIGHTING) -+#define BITS_RATE15_WEIGHTING \ -+ (BIT_MASK_RATE15_WEIGHTING << BIT_SHIFT_RATE15_WEIGHTING) -+#define BIT_CLEAR_RATE15_WEIGHTING(x) ((x) & (~BITS_RATE15_WEIGHTING)) -+#define BIT_GET_RATE15_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE15_WEIGHTING) & BIT_MASK_RATE15_WEIGHTING) -+#define BIT_SET_RATE15_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE15_WEIGHTING(x) | BIT_RATE15_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE14_WEIGHTING 24 -+#define BIT_MASK_RATE14_WEIGHTING 0xf -+#define BIT_RATE14_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE14_WEIGHTING) << BIT_SHIFT_RATE14_WEIGHTING) -+#define BITS_RATE14_WEIGHTING \ -+ (BIT_MASK_RATE14_WEIGHTING << BIT_SHIFT_RATE14_WEIGHTING) -+#define BIT_CLEAR_RATE14_WEIGHTING(x) ((x) & (~BITS_RATE14_WEIGHTING)) -+#define BIT_GET_RATE14_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE14_WEIGHTING) & BIT_MASK_RATE14_WEIGHTING) -+#define BIT_SET_RATE14_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE14_WEIGHTING(x) | BIT_RATE14_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE13_WEIGHTING 20 -+#define BIT_MASK_RATE13_WEIGHTING 0xf -+#define BIT_RATE13_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE13_WEIGHTING) << BIT_SHIFT_RATE13_WEIGHTING) -+#define BITS_RATE13_WEIGHTING \ -+ (BIT_MASK_RATE13_WEIGHTING << BIT_SHIFT_RATE13_WEIGHTING) -+#define BIT_CLEAR_RATE13_WEIGHTING(x) ((x) & (~BITS_RATE13_WEIGHTING)) -+#define BIT_GET_RATE13_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE13_WEIGHTING) & BIT_MASK_RATE13_WEIGHTING) -+#define BIT_SET_RATE13_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE13_WEIGHTING(x) | BIT_RATE13_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE12_WEIGHTING 16 -+#define BIT_MASK_RATE12_WEIGHTING 0xf -+#define BIT_RATE12_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE12_WEIGHTING) << BIT_SHIFT_RATE12_WEIGHTING) -+#define BITS_RATE12_WEIGHTING \ -+ (BIT_MASK_RATE12_WEIGHTING << BIT_SHIFT_RATE12_WEIGHTING) -+#define BIT_CLEAR_RATE12_WEIGHTING(x) ((x) & (~BITS_RATE12_WEIGHTING)) -+#define BIT_GET_RATE12_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE12_WEIGHTING) & BIT_MASK_RATE12_WEIGHTING) -+#define BIT_SET_RATE12_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE12_WEIGHTING(x) | BIT_RATE12_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE11_WEIGHTING 12 -+#define BIT_MASK_RATE11_WEIGHTING 0xf -+#define BIT_RATE11_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE11_WEIGHTING) << BIT_SHIFT_RATE11_WEIGHTING) -+#define BITS_RATE11_WEIGHTING \ -+ (BIT_MASK_RATE11_WEIGHTING << BIT_SHIFT_RATE11_WEIGHTING) -+#define BIT_CLEAR_RATE11_WEIGHTING(x) ((x) & (~BITS_RATE11_WEIGHTING)) -+#define BIT_GET_RATE11_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE11_WEIGHTING) & BIT_MASK_RATE11_WEIGHTING) -+#define BIT_SET_RATE11_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE11_WEIGHTING(x) | BIT_RATE11_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE10_WEIGHTING 8 -+#define BIT_MASK_RATE10_WEIGHTING 0xf -+#define BIT_RATE10_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE10_WEIGHTING) << BIT_SHIFT_RATE10_WEIGHTING) -+#define BITS_RATE10_WEIGHTING \ -+ (BIT_MASK_RATE10_WEIGHTING << BIT_SHIFT_RATE10_WEIGHTING) -+#define BIT_CLEAR_RATE10_WEIGHTING(x) ((x) & (~BITS_RATE10_WEIGHTING)) -+#define BIT_GET_RATE10_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE10_WEIGHTING) & BIT_MASK_RATE10_WEIGHTING) -+#define BIT_SET_RATE10_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE10_WEIGHTING(x) | BIT_RATE10_WEIGHTING(v)) -+ -+#define BIT_SHIFT_RATE9_WEIGHTING 4 -+#define BIT_MASK_RATE9_WEIGHTING 0xf -+#define BIT_RATE9_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE9_WEIGHTING) << BIT_SHIFT_RATE9_WEIGHTING) -+#define BITS_RATE9_WEIGHTING \ -+ (BIT_MASK_RATE9_WEIGHTING << BIT_SHIFT_RATE9_WEIGHTING) -+#define BIT_CLEAR_RATE9_WEIGHTING(x) ((x) & (~BITS_RATE9_WEIGHTING)) -+#define BIT_GET_RATE9_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE9_WEIGHTING) & BIT_MASK_RATE9_WEIGHTING) -+#define BIT_SET_RATE9_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE9_WEIGHTING(x) | BIT_RATE9_WEIGHTING(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ARFRH1 (Offset 0x0450) */ -+ -+#define BIT_SHIFT_ARFRH1 0 -+#define BIT_MASK_ARFRH1 0xffffffffL -+#define BIT_ARFRH1(x) (((x) & BIT_MASK_ARFRH1) << BIT_SHIFT_ARFRH1) -+#define BITS_ARFRH1 (BIT_MASK_ARFRH1 << BIT_SHIFT_ARFRH1) -+#define BIT_CLEAR_ARFRH1(x) ((x) & (~BITS_ARFRH1)) -+#define BIT_GET_ARFRH1(x) (((x) >> BIT_SHIFT_ARFRH1) & BIT_MASK_ARFRH1) -+#define BIT_SET_ARFRH1(x, v) (BIT_CLEAR_ARFRH1(x) | BIT_ARFRH1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_REG_ARFR_WT1 (Offset 0x0450) */ -+ -+#define BIT_SHIFT_RATE8_WEIGHTING 0 -+#define BIT_MASK_RATE8_WEIGHTING 0xf -+#define BIT_RATE8_WEIGHTING(x) \ -+ (((x) & BIT_MASK_RATE8_WEIGHTING) << BIT_SHIFT_RATE8_WEIGHTING) -+#define BITS_RATE8_WEIGHTING \ -+ (BIT_MASK_RATE8_WEIGHTING << BIT_SHIFT_RATE8_WEIGHTING) -+#define BIT_CLEAR_RATE8_WEIGHTING(x) ((x) & (~BITS_RATE8_WEIGHTING)) -+#define BIT_GET_RATE8_WEIGHTING(x) \ -+ (((x) >> BIT_SHIFT_RATE8_WEIGHTING) & BIT_MASK_RATE8_WEIGHTING) -+#define BIT_SET_RATE8_WEIGHTING(x, v) \ -+ (BIT_CLEAR_RATE8_WEIGHTING(x) | BIT_RATE8_WEIGHTING(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CCK_CHECK (Offset 0x0454) */ -+ -+#define BIT_CHECK_CCK_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CCK_CHECK (Offset 0x0454) */ -+ -+#define BIT_EN_BCN_PKT_REL BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CCK_CHECK (Offset 0x0454) */ -+ -+#define BIT_EN_BCN_PKT_REL_P0 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CCK_CHECK (Offset 0x0454) */ -+ -+#define BIT_BCN_PORT_SEL BIT(5) -+#define BIT_MOREDATA_BYPASS BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CCK_CHECK (Offset 0x0454) */ -+ -+#define BIT_EN_CLR_CMD_REL_BCN_PKT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CCK_CHECK (Offset 0x0454) */ -+ -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_P0 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CCK_CHECK (Offset 0x0454) */ -+ -+#define BIT_EN_SET_MOREDATA BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CCK_CHECK (Offset 0x0454) */ -+ -+#define BIT_R_EN_SET_MOREDATA BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CCK_CHECK (Offset 0x0454) */ -+ -+#define BIT__R_DIS_CLEAR_MACID_RELEASE BIT(1) -+#define BIT__R_MACID_RELEASE_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AMPDU_MAX_TIME_V1 (Offset 0x0455) */ -+ -+#define BIT_SHIFT_AMPDU_MAX_TIME 0 -+#define BIT_MASK_AMPDU_MAX_TIME 0xff -+#define BIT_AMPDU_MAX_TIME(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_TIME) << BIT_SHIFT_AMPDU_MAX_TIME) -+#define BITS_AMPDU_MAX_TIME \ -+ (BIT_MASK_AMPDU_MAX_TIME << BIT_SHIFT_AMPDU_MAX_TIME) -+#define BIT_CLEAR_AMPDU_MAX_TIME(x) ((x) & (~BITS_AMPDU_MAX_TIME)) -+#define BIT_GET_AMPDU_MAX_TIME(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_TIME) & BIT_MASK_AMPDU_MAX_TIME) -+#define BIT_SET_AMPDU_MAX_TIME(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_TIME(x) | BIT_AMPDU_MAX_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AMPDU_BURST_CTRL (Offset 0x0455) */ -+ -+#define BIT_AMPDU_BURST_GLOBAL_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_BCNQ2_HEAD (Offset 0x0455) */ -+ -+#define BIT_SHIFT_BCNQ2_HEAD 0 -+#define BIT_MASK_BCNQ2_HEAD 0xff -+#define BIT_BCNQ2_HEAD(x) (((x) & BIT_MASK_BCNQ2_HEAD) << BIT_SHIFT_BCNQ2_HEAD) -+#define BITS_BCNQ2_HEAD (BIT_MASK_BCNQ2_HEAD << BIT_SHIFT_BCNQ2_HEAD) -+#define BIT_CLEAR_BCNQ2_HEAD(x) ((x) & (~BITS_BCNQ2_HEAD)) -+#define BIT_GET_BCNQ2_HEAD(x) \ -+ (((x) >> BIT_SHIFT_BCNQ2_HEAD) & BIT_MASK_BCNQ2_HEAD) -+#define BIT_SET_BCNQ2_HEAD(x, v) (BIT_CLEAR_BCNQ2_HEAD(x) | BIT_BCNQ2_HEAD(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCNQ1_BDNY_V1 (Offset 0x0456) */ -+ -+#define BIT_SHIFT_BCNQ1_PGBNDY_V1 0 -+#define BIT_MASK_BCNQ1_PGBNDY_V1 0xfff -+#define BIT_BCNQ1_PGBNDY_V1(x) \ -+ (((x) & BIT_MASK_BCNQ1_PGBNDY_V1) << BIT_SHIFT_BCNQ1_PGBNDY_V1) -+#define BITS_BCNQ1_PGBNDY_V1 \ -+ (BIT_MASK_BCNQ1_PGBNDY_V1 << BIT_SHIFT_BCNQ1_PGBNDY_V1) -+#define BIT_CLEAR_BCNQ1_PGBNDY_V1(x) ((x) & (~BITS_BCNQ1_PGBNDY_V1)) -+#define BIT_GET_BCNQ1_PGBNDY_V1(x) \ -+ (((x) >> BIT_SHIFT_BCNQ1_PGBNDY_V1) & BIT_MASK_BCNQ1_PGBNDY_V1) -+#define BIT_SET_BCNQ1_PGBNDY_V1(x, v) \ -+ (BIT_CLEAR_BCNQ1_PGBNDY_V1(x) | BIT_BCNQ1_PGBNDY_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TAB_SEL (Offset 0x0456) */ -+ -+#define BIT_SHIFT_RATE_SEL 0 -+#define BIT_MASK_RATE_SEL 0xf -+#define BIT_RATE_SEL(x) (((x) & BIT_MASK_RATE_SEL) << BIT_SHIFT_RATE_SEL) -+#define BITS_RATE_SEL (BIT_MASK_RATE_SEL << BIT_SHIFT_RATE_SEL) -+#define BIT_CLEAR_RATE_SEL(x) ((x) & (~BITS_RATE_SEL)) -+#define BIT_GET_RATE_SEL(x) (((x) >> BIT_SHIFT_RATE_SEL) & BIT_MASK_RATE_SEL) -+#define BIT_SET_RATE_SEL(x, v) (BIT_CLEAR_RATE_SEL(x) | BIT_RATE_SEL(v)) -+ -+/* 2 REG_BCN_INVALID_CTRL (Offset 0x0457) */ -+ -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_P4 BIT(7) -+#define BIT_EN_BCN_PKT_REL_P4 BIT(6) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_P3 BIT(5) -+#define BIT_EN_BCN_PKT_REL_P3 BIT(4) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_P2 BIT(3) -+#define BIT_EN_BCN_PKT_REL_P2 BIT(2) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_P1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCNQ1_BDNY (Offset 0x0457) */ -+ -+#define BIT_SHIFT_BCNQ1_PGBNDY 0 -+#define BIT_MASK_BCNQ1_PGBNDY 0xff -+#define BIT_BCNQ1_PGBNDY(x) \ -+ (((x) & BIT_MASK_BCNQ1_PGBNDY) << BIT_SHIFT_BCNQ1_PGBNDY) -+#define BITS_BCNQ1_PGBNDY (BIT_MASK_BCNQ1_PGBNDY << BIT_SHIFT_BCNQ1_PGBNDY) -+#define BIT_CLEAR_BCNQ1_PGBNDY(x) ((x) & (~BITS_BCNQ1_PGBNDY)) -+#define BIT_GET_BCNQ1_PGBNDY(x) \ -+ (((x) >> BIT_SHIFT_BCNQ1_PGBNDY) & BIT_MASK_BCNQ1_PGBNDY) -+#define BIT_SET_BCNQ1_PGBNDY(x, v) \ -+ (BIT_CLEAR_BCNQ1_PGBNDY(x) | BIT_BCNQ1_PGBNDY(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_BCNQ1_BDNY (Offset 0x0457) */ -+ -+#define BIT_SHIFT_BCNQ1_HEAD 0 -+#define BIT_MASK_BCNQ1_HEAD 0xff -+#define BIT_BCNQ1_HEAD(x) (((x) & BIT_MASK_BCNQ1_HEAD) << BIT_SHIFT_BCNQ1_HEAD) -+#define BITS_BCNQ1_HEAD (BIT_MASK_BCNQ1_HEAD << BIT_SHIFT_BCNQ1_HEAD) -+#define BIT_CLEAR_BCNQ1_HEAD(x) ((x) & (~BITS_BCNQ1_HEAD)) -+#define BIT_GET_BCNQ1_HEAD(x) \ -+ (((x) >> BIT_SHIFT_BCNQ1_HEAD) & BIT_MASK_BCNQ1_HEAD) -+#define BIT_SET_BCNQ1_HEAD(x, v) (BIT_CLEAR_BCNQ1_HEAD(x) | BIT_BCNQ1_HEAD(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_INVALID_CTRL (Offset 0x0457) */ -+ -+#define BIT_EN_BCN_PKT_REL_P1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AMPDU_MAX_LENGTH (Offset 0x0458) */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH 0xffffffffL -+#define BIT_AMPDU_MAX_LENGTH(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH) << BIT_SHIFT_AMPDU_MAX_LENGTH) -+#define BITS_AMPDU_MAX_LENGTH \ -+ (BIT_MASK_AMPDU_MAX_LENGTH << BIT_SHIFT_AMPDU_MAX_LENGTH) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH(x) ((x) & (~BITS_AMPDU_MAX_LENGTH)) -+#define BIT_GET_AMPDU_MAX_LENGTH(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH) & BIT_MASK_AMPDU_MAX_LENGTH) -+#define BIT_SET_AMPDU_MAX_LENGTH(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH(x) | BIT_AMPDU_MAX_LENGTH(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_HT (Offset 0x0458) */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_HT 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_HT 0xffff -+#define BIT_AMPDU_MAX_LENGTH_HT(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_HT) << BIT_SHIFT_AMPDU_MAX_LENGTH_HT) -+#define BITS_AMPDU_MAX_LENGTH_HT \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_HT << BIT_SHIFT_AMPDU_MAX_LENGTH_HT) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_HT(x) ((x) & (~BITS_AMPDU_MAX_LENGTH_HT)) -+#define BIT_GET_AMPDU_MAX_LENGTH_HT(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_HT) & BIT_MASK_AMPDU_MAX_LENGTH_HT) -+#define BIT_SET_AMPDU_MAX_LENGTH_HT(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_HT(x) | BIT_AMPDU_MAX_LENGTH_HT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ACQ_STOP (Offset 0x045C) */ -+ -+#define BIT_AC7Q_STOP BIT(7) -+#define BIT_AC6Q_STOP BIT(6) -+#define BIT_AC5Q_STOP BIT(5) -+#define BIT_AC4Q_STOP BIT(4) -+#define BIT_AC3Q_STOP BIT(3) -+#define BIT_AC2Q_STOP BIT(2) -+#define BIT_AC1Q_STOP BIT(1) -+#define BIT_AC0Q_STOP BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_LBK_BUF_HD (Offset 0x045D) */ -+ -+#define BIT_SHIFT_WMAC_LBK_BUF_HEAD 0 -+#define BIT_MASK_WMAC_LBK_BUF_HEAD 0xff -+#define BIT_WMAC_LBK_BUF_HEAD(x) \ -+ (((x) & BIT_MASK_WMAC_LBK_BUF_HEAD) << BIT_SHIFT_WMAC_LBK_BUF_HEAD) -+#define BITS_WMAC_LBK_BUF_HEAD \ -+ (BIT_MASK_WMAC_LBK_BUF_HEAD << BIT_SHIFT_WMAC_LBK_BUF_HEAD) -+#define BIT_CLEAR_WMAC_LBK_BUF_HEAD(x) ((x) & (~BITS_WMAC_LBK_BUF_HEAD)) -+#define BIT_GET_WMAC_LBK_BUF_HEAD(x) \ -+ (((x) >> BIT_SHIFT_WMAC_LBK_BUF_HEAD) & BIT_MASK_WMAC_LBK_BUF_HEAD) -+#define BIT_SET_WMAC_LBK_BUF_HEAD(x, v) \ -+ (BIT_CLEAR_WMAC_LBK_BUF_HEAD(x) | BIT_WMAC_LBK_BUF_HEAD(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NDPA_RATE (Offset 0x045D) */ -+ -+#define BIT_SHIFT_R_NDPA_RATE_V1 0 -+#define BIT_MASK_R_NDPA_RATE_V1 0xff -+#define BIT_R_NDPA_RATE_V1(x) \ -+ (((x) & BIT_MASK_R_NDPA_RATE_V1) << BIT_SHIFT_R_NDPA_RATE_V1) -+#define BITS_R_NDPA_RATE_V1 \ -+ (BIT_MASK_R_NDPA_RATE_V1 << BIT_SHIFT_R_NDPA_RATE_V1) -+#define BIT_CLEAR_R_NDPA_RATE_V1(x) ((x) & (~BITS_R_NDPA_RATE_V1)) -+#define BIT_GET_R_NDPA_RATE_V1(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_RATE_V1) & BIT_MASK_R_NDPA_RATE_V1) -+#define BIT_SET_R_NDPA_RATE_V1(x, v) \ -+ (BIT_CLEAR_R_NDPA_RATE_V1(x) | BIT_R_NDPA_RATE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TX_HANG_CTRL (Offset 0x045E) */ -+ -+#define BIT_EN_GNT_BT_AWAKE BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_TX_HANG_CTRL (Offset 0x045E) */ -+ -+#define BIT_R_EN_GNT_BT_AWAKE BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TX_HANG_CTRL (Offset 0x045E) */ -+ -+#define BIT_DIS_RELEASE_RETRY BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TX_HANG_CTRL (Offset 0x045E) */ -+ -+#define BIT_EN_EOF_V1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TX_HANG_CTRL (Offset 0x045E) */ -+ -+#define BIT_DIS_OQT_BLOCK BIT(1) -+#define BIT_SEARCH_QUEUE_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NDPA_OPT_CTRL (Offset 0x045F) */ -+ -+#define BIT_R_DIS_MACID_RELEASE_RTY BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_NDPA_OPT_CTRL (Offset 0x045F) */ -+ -+#define BIT_DIS_MACID_RELEASE_RTY BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NDPA_OPT_CTRL (Offset 0x045F) */ -+ -+#define BIT_SHIFT_BW_SIGTA 3 -+#define BIT_MASK_BW_SIGTA 0x3 -+#define BIT_BW_SIGTA(x) (((x) & BIT_MASK_BW_SIGTA) << BIT_SHIFT_BW_SIGTA) -+#define BITS_BW_SIGTA (BIT_MASK_BW_SIGTA << BIT_SHIFT_BW_SIGTA) -+#define BIT_CLEAR_BW_SIGTA(x) ((x) & (~BITS_BW_SIGTA)) -+#define BIT_GET_BW_SIGTA(x) (((x) >> BIT_SHIFT_BW_SIGTA) & BIT_MASK_BW_SIGTA) -+#define BIT_SET_BW_SIGTA(x, v) (BIT_CLEAR_BW_SIGTA(x) | BIT_BW_SIGTA(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_NDPA_OPT_CTRL (Offset 0x045F) */ -+ -+#define BIT_SHIFT_R_NDPA_RATE 2 -+#define BIT_MASK_R_NDPA_RATE 0x3f -+#define BIT_R_NDPA_RATE(x) \ -+ (((x) & BIT_MASK_R_NDPA_RATE) << BIT_SHIFT_R_NDPA_RATE) -+#define BITS_R_NDPA_RATE (BIT_MASK_R_NDPA_RATE << BIT_SHIFT_R_NDPA_RATE) -+#define BIT_CLEAR_R_NDPA_RATE(x) ((x) & (~BITS_R_NDPA_RATE)) -+#define BIT_GET_R_NDPA_RATE(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_RATE) & BIT_MASK_R_NDPA_RATE) -+#define BIT_SET_R_NDPA_RATE(x, v) \ -+ (BIT_CLEAR_R_NDPA_RATE(x) | BIT_R_NDPA_RATE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NDPA_OPT_CTRL (Offset 0x045F) */ -+ -+#define BIT_EN_BAR_SIGTA BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_NDPA_OPT_CTRL (Offset 0x045F) */ -+ -+#define BIT_SHIFT_R_NDPA_BW 0 -+#define BIT_MASK_R_NDPA_BW 0x3 -+#define BIT_R_NDPA_BW(x) (((x) & BIT_MASK_R_NDPA_BW) << BIT_SHIFT_R_NDPA_BW) -+#define BITS_R_NDPA_BW (BIT_MASK_R_NDPA_BW << BIT_SHIFT_R_NDPA_BW) -+#define BIT_CLEAR_R_NDPA_BW(x) ((x) & (~BITS_R_NDPA_BW)) -+#define BIT_GET_R_NDPA_BW(x) (((x) >> BIT_SHIFT_R_NDPA_BW) & BIT_MASK_R_NDPA_BW) -+#define BIT_SET_R_NDPA_BW(x, v) (BIT_CLEAR_R_NDPA_BW(x) | BIT_R_NDPA_BW(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_NDPA_OPT_CTRL (Offset 0x045F) */ -+ -+#define BIT_SHIFT_NDPA_BW 0 -+#define BIT_MASK_NDPA_BW 0x3 -+#define BIT_NDPA_BW(x) (((x) & BIT_MASK_NDPA_BW) << BIT_SHIFT_NDPA_BW) -+#define BITS_NDPA_BW (BIT_MASK_NDPA_BW << BIT_SHIFT_NDPA_BW) -+#define BIT_CLEAR_NDPA_BW(x) ((x) & (~BITS_NDPA_BW)) -+#define BIT_GET_NDPA_BW(x) (((x) >> BIT_SHIFT_NDPA_BW) & BIT_MASK_NDPA_BW) -+#define BIT_SET_NDPA_BW(x, v) (BIT_CLEAR_NDPA_BW(x) | BIT_NDPA_BW(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FAST_EDCA_CTRL (Offset 0x0460) */ -+ -+#define BIT_SHIFT_FAST_EDCA_TO_V1 16 -+#define BIT_MASK_FAST_EDCA_TO_V1 0xff -+#define BIT_FAST_EDCA_TO_V1(x) \ -+ (((x) & BIT_MASK_FAST_EDCA_TO_V1) << BIT_SHIFT_FAST_EDCA_TO_V1) -+#define BITS_FAST_EDCA_TO_V1 \ -+ (BIT_MASK_FAST_EDCA_TO_V1 << BIT_SHIFT_FAST_EDCA_TO_V1) -+#define BIT_CLEAR_FAST_EDCA_TO_V1(x) ((x) & (~BITS_FAST_EDCA_TO_V1)) -+#define BIT_GET_FAST_EDCA_TO_V1(x) \ -+ (((x) >> BIT_SHIFT_FAST_EDCA_TO_V1) & BIT_MASK_FAST_EDCA_TO_V1) -+#define BIT_SET_FAST_EDCA_TO_V1(x, v) \ -+ (BIT_CLEAR_FAST_EDCA_TO_V1(x) | BIT_FAST_EDCA_TO_V1(v)) -+ -+#define BIT_SHIFT_AC3_AC7_FAST_EDCA_PKT_TH 12 -+#define BIT_MASK_AC3_AC7_FAST_EDCA_PKT_TH 0xf -+#define BIT_AC3_AC7_FAST_EDCA_PKT_TH(x) \ -+ (((x) & BIT_MASK_AC3_AC7_FAST_EDCA_PKT_TH) \ -+ << BIT_SHIFT_AC3_AC7_FAST_EDCA_PKT_TH) -+#define BITS_AC3_AC7_FAST_EDCA_PKT_TH \ -+ (BIT_MASK_AC3_AC7_FAST_EDCA_PKT_TH \ -+ << BIT_SHIFT_AC3_AC7_FAST_EDCA_PKT_TH) -+#define BIT_CLEAR_AC3_AC7_FAST_EDCA_PKT_TH(x) \ -+ ((x) & (~BITS_AC3_AC7_FAST_EDCA_PKT_TH)) -+#define BIT_GET_AC3_AC7_FAST_EDCA_PKT_TH(x) \ -+ (((x) >> BIT_SHIFT_AC3_AC7_FAST_EDCA_PKT_TH) & \ -+ BIT_MASK_AC3_AC7_FAST_EDCA_PKT_TH) -+#define BIT_SET_AC3_AC7_FAST_EDCA_PKT_TH(x, v) \ -+ (BIT_CLEAR_AC3_AC7_FAST_EDCA_PKT_TH(x) | \ -+ BIT_AC3_AC7_FAST_EDCA_PKT_TH(v)) -+ -+#define BIT_SHIFT_AC2_FAST_EDCA_PKT_TH 8 -+#define BIT_MASK_AC2_FAST_EDCA_PKT_TH 0xf -+#define BIT_AC2_FAST_EDCA_PKT_TH(x) \ -+ (((x) & BIT_MASK_AC2_FAST_EDCA_PKT_TH) \ -+ << BIT_SHIFT_AC2_FAST_EDCA_PKT_TH) -+#define BITS_AC2_FAST_EDCA_PKT_TH \ -+ (BIT_MASK_AC2_FAST_EDCA_PKT_TH << BIT_SHIFT_AC2_FAST_EDCA_PKT_TH) -+#define BIT_CLEAR_AC2_FAST_EDCA_PKT_TH(x) ((x) & (~BITS_AC2_FAST_EDCA_PKT_TH)) -+#define BIT_GET_AC2_FAST_EDCA_PKT_TH(x) \ -+ (((x) >> BIT_SHIFT_AC2_FAST_EDCA_PKT_TH) & \ -+ BIT_MASK_AC2_FAST_EDCA_PKT_TH) -+#define BIT_SET_AC2_FAST_EDCA_PKT_TH(x, v) \ -+ (BIT_CLEAR_AC2_FAST_EDCA_PKT_TH(x) | BIT_AC2_FAST_EDCA_PKT_TH(v)) -+ -+#define BIT_SHIFT_AC1_FAST_EDCA_PKT_TH 4 -+#define BIT_MASK_AC1_FAST_EDCA_PKT_TH 0xf -+#define BIT_AC1_FAST_EDCA_PKT_TH(x) \ -+ (((x) & BIT_MASK_AC1_FAST_EDCA_PKT_TH) \ -+ << BIT_SHIFT_AC1_FAST_EDCA_PKT_TH) -+#define BITS_AC1_FAST_EDCA_PKT_TH \ -+ (BIT_MASK_AC1_FAST_EDCA_PKT_TH << BIT_SHIFT_AC1_FAST_EDCA_PKT_TH) -+#define BIT_CLEAR_AC1_FAST_EDCA_PKT_TH(x) ((x) & (~BITS_AC1_FAST_EDCA_PKT_TH)) -+#define BIT_GET_AC1_FAST_EDCA_PKT_TH(x) \ -+ (((x) >> BIT_SHIFT_AC1_FAST_EDCA_PKT_TH) & \ -+ BIT_MASK_AC1_FAST_EDCA_PKT_TH) -+#define BIT_SET_AC1_FAST_EDCA_PKT_TH(x, v) \ -+ (BIT_CLEAR_AC1_FAST_EDCA_PKT_TH(x) | BIT_AC1_FAST_EDCA_PKT_TH(v)) -+ -+#define BIT_SHIFT_AC0_FAST_EDCA_PKT_TH 0 -+#define BIT_MASK_AC0_FAST_EDCA_PKT_TH 0xf -+#define BIT_AC0_FAST_EDCA_PKT_TH(x) \ -+ (((x) & BIT_MASK_AC0_FAST_EDCA_PKT_TH) \ -+ << BIT_SHIFT_AC0_FAST_EDCA_PKT_TH) -+#define BITS_AC0_FAST_EDCA_PKT_TH \ -+ (BIT_MASK_AC0_FAST_EDCA_PKT_TH << BIT_SHIFT_AC0_FAST_EDCA_PKT_TH) -+#define BIT_CLEAR_AC0_FAST_EDCA_PKT_TH(x) ((x) & (~BITS_AC0_FAST_EDCA_PKT_TH)) -+#define BIT_GET_AC0_FAST_EDCA_PKT_TH(x) \ -+ (((x) >> BIT_SHIFT_AC0_FAST_EDCA_PKT_TH) & \ -+ BIT_MASK_AC0_FAST_EDCA_PKT_TH) -+#define BIT_SET_AC0_FAST_EDCA_PKT_TH(x, v) \ -+ (BIT_CLEAR_AC0_FAST_EDCA_PKT_TH(x) | BIT_AC0_FAST_EDCA_PKT_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_VHT (Offset 0x0460) */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1 0xfffff -+#define BIT_AMPDU_MAX_LENGTH_VHT_V1(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1) -+#define BITS_AMPDU_MAX_LENGTH_VHT_V1 \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1 << BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_VHT_V1(x) \ -+ ((x) & (~BITS_AMPDU_MAX_LENGTH_VHT_V1)) -+#define BIT_GET_AMPDU_MAX_LENGTH_VHT_V1(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1) -+#define BIT_SET_AMPDU_MAX_LENGTH_VHT_V1(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_VHT_V1(x) | BIT_AMPDU_MAX_LENGTH_VHT_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_VHT (Offset 0x0460) */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_VHT 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_VHT 0x3ffff -+#define BIT_AMPDU_MAX_LENGTH_VHT(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_VHT) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_VHT) -+#define BITS_AMPDU_MAX_LENGTH_VHT \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_VHT << BIT_SHIFT_AMPDU_MAX_LENGTH_VHT) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_VHT(x) ((x) & (~BITS_AMPDU_MAX_LENGTH_VHT)) -+#define BIT_GET_AMPDU_MAX_LENGTH_VHT(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_VHT) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_VHT) -+#define BIT_SET_AMPDU_MAX_LENGTH_VHT(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_VHT(x) | BIT_AMPDU_MAX_LENGTH_VHT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RD_RESP_PKT_TH (Offset 0x0463) */ -+ -+#define BIT_SHIFT_RD_RESP_PKT_TH 0 -+#define BIT_MASK_RD_RESP_PKT_TH 0x1f -+#define BIT_RD_RESP_PKT_TH(x) \ -+ (((x) & BIT_MASK_RD_RESP_PKT_TH) << BIT_SHIFT_RD_RESP_PKT_TH) -+#define BITS_RD_RESP_PKT_TH \ -+ (BIT_MASK_RD_RESP_PKT_TH << BIT_SHIFT_RD_RESP_PKT_TH) -+#define BIT_CLEAR_RD_RESP_PKT_TH(x) ((x) & (~BITS_RD_RESP_PKT_TH)) -+#define BIT_GET_RD_RESP_PKT_TH(x) \ -+ (((x) >> BIT_SHIFT_RD_RESP_PKT_TH) & BIT_MASK_RD_RESP_PKT_TH) -+#define BIT_SET_RD_RESP_PKT_TH(x, v) \ -+ (BIT_CLEAR_RD_RESP_PKT_TH(x) | BIT_RD_RESP_PKT_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RD_RESP_PKT_TH (Offset 0x0463) */ -+ -+#define BIT_SHIFT_RD_RESP_PKT_TH_V1 0 -+#define BIT_MASK_RD_RESP_PKT_TH_V1 0x3f -+#define BIT_RD_RESP_PKT_TH_V1(x) \ -+ (((x) & BIT_MASK_RD_RESP_PKT_TH_V1) << BIT_SHIFT_RD_RESP_PKT_TH_V1) -+#define BITS_RD_RESP_PKT_TH_V1 \ -+ (BIT_MASK_RD_RESP_PKT_TH_V1 << BIT_SHIFT_RD_RESP_PKT_TH_V1) -+#define BIT_CLEAR_RD_RESP_PKT_TH_V1(x) ((x) & (~BITS_RD_RESP_PKT_TH_V1)) -+#define BIT_GET_RD_RESP_PKT_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_RD_RESP_PKT_TH_V1) & BIT_MASK_RD_RESP_PKT_TH_V1) -+#define BIT_SET_RD_RESP_PKT_TH_V1(x, v) \ -+ (BIT_CLEAR_RD_RESP_PKT_TH_V1(x) | BIT_RD_RESP_PKT_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CMDQ_INFO (Offset 0x0464) */ -+ -+#define BIT_SHIFT_QUEUEMACID_CMDQ_V1 25 -+#define BIT_MASK_QUEUEMACID_CMDQ_V1 0x7f -+#define BIT_QUEUEMACID_CMDQ_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_CMDQ_V1) << BIT_SHIFT_QUEUEMACID_CMDQ_V1) -+#define BITS_QUEUEMACID_CMDQ_V1 \ -+ (BIT_MASK_QUEUEMACID_CMDQ_V1 << BIT_SHIFT_QUEUEMACID_CMDQ_V1) -+#define BIT_CLEAR_QUEUEMACID_CMDQ_V1(x) ((x) & (~BITS_QUEUEMACID_CMDQ_V1)) -+#define BIT_GET_QUEUEMACID_CMDQ_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_CMDQ_V1) & BIT_MASK_QUEUEMACID_CMDQ_V1) -+#define BIT_SET_QUEUEMACID_CMDQ_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_CMDQ_V1(x) | BIT_QUEUEMACID_CMDQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CMDQ_INFO (Offset 0x0464) */ -+ -+#define BIT_SHIFT_PKT_NUM_CMDQ_V2 24 -+#define BIT_MASK_PKT_NUM_CMDQ_V2 0xff -+#define BIT_PKT_NUM_CMDQ_V2(x) \ -+ (((x) & BIT_MASK_PKT_NUM_CMDQ_V2) << BIT_SHIFT_PKT_NUM_CMDQ_V2) -+#define BITS_PKT_NUM_CMDQ_V2 \ -+ (BIT_MASK_PKT_NUM_CMDQ_V2 << BIT_SHIFT_PKT_NUM_CMDQ_V2) -+#define BIT_CLEAR_PKT_NUM_CMDQ_V2(x) ((x) & (~BITS_PKT_NUM_CMDQ_V2)) -+#define BIT_GET_PKT_NUM_CMDQ_V2(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_CMDQ_V2) & BIT_MASK_PKT_NUM_CMDQ_V2) -+#define BIT_SET_PKT_NUM_CMDQ_V2(x, v) \ -+ (BIT_CLEAR_PKT_NUM_CMDQ_V2(x) | BIT_PKT_NUM_CMDQ_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_CMDQ_INFO (Offset 0x0464) */ -+ -+#define BIT_SHIFT_PKT_NUM 23 -+#define BIT_MASK_PKT_NUM 0x1ff -+#define BIT_PKT_NUM(x) (((x) & BIT_MASK_PKT_NUM) << BIT_SHIFT_PKT_NUM) -+#define BITS_PKT_NUM (BIT_MASK_PKT_NUM << BIT_SHIFT_PKT_NUM) -+#define BIT_CLEAR_PKT_NUM(x) ((x) & (~BITS_PKT_NUM)) -+#define BIT_GET_PKT_NUM(x) (((x) >> BIT_SHIFT_PKT_NUM) & BIT_MASK_PKT_NUM) -+#define BIT_SET_PKT_NUM(x, v) (BIT_CLEAR_PKT_NUM(x) | BIT_PKT_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CMDQ_INFO (Offset 0x0464) */ -+ -+#define BIT_SHIFT_QUEUEAC_CMDQ_V1 23 -+#define BIT_MASK_QUEUEAC_CMDQ_V1 0x3 -+#define BIT_QUEUEAC_CMDQ_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_CMDQ_V1) << BIT_SHIFT_QUEUEAC_CMDQ_V1) -+#define BITS_QUEUEAC_CMDQ_V1 \ -+ (BIT_MASK_QUEUEAC_CMDQ_V1 << BIT_SHIFT_QUEUEAC_CMDQ_V1) -+#define BIT_CLEAR_QUEUEAC_CMDQ_V1(x) ((x) & (~BITS_QUEUEAC_CMDQ_V1)) -+#define BIT_GET_QUEUEAC_CMDQ_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_CMDQ_V1) & BIT_MASK_QUEUEAC_CMDQ_V1) -+#define BIT_SET_QUEUEAC_CMDQ_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_CMDQ_V1(x) | BIT_QUEUEAC_CMDQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CMDQ_INFO (Offset 0x0464) */ -+ -+#define BIT_TIDEMPTY_CMDQ_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CMDQ_INFO (Offset 0x0464) */ -+ -+#define BIT_SHIFT_TAIL_PKT_CMDQ 16 -+#define BIT_MASK_TAIL_PKT_CMDQ 0xff -+#define BIT_TAIL_PKT_CMDQ(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_CMDQ) << BIT_SHIFT_TAIL_PKT_CMDQ) -+#define BITS_TAIL_PKT_CMDQ (BIT_MASK_TAIL_PKT_CMDQ << BIT_SHIFT_TAIL_PKT_CMDQ) -+#define BIT_CLEAR_TAIL_PKT_CMDQ(x) ((x) & (~BITS_TAIL_PKT_CMDQ)) -+#define BIT_GET_TAIL_PKT_CMDQ(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_CMDQ) & BIT_MASK_TAIL_PKT_CMDQ) -+#define BIT_SET_TAIL_PKT_CMDQ(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_CMDQ(x) | BIT_TAIL_PKT_CMDQ(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_CMDQ_INFO (Offset 0x0464) */ -+ -+#define BIT_SHIFT_TAIL_PKT_CMDQ_V2 11 -+#define BIT_MASK_TAIL_PKT_CMDQ_V2 0x7ff -+#define BIT_TAIL_PKT_CMDQ_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_CMDQ_V2) << BIT_SHIFT_TAIL_PKT_CMDQ_V2) -+#define BITS_TAIL_PKT_CMDQ_V2 \ -+ (BIT_MASK_TAIL_PKT_CMDQ_V2 << BIT_SHIFT_TAIL_PKT_CMDQ_V2) -+#define BIT_CLEAR_TAIL_PKT_CMDQ_V2(x) ((x) & (~BITS_TAIL_PKT_CMDQ_V2)) -+#define BIT_GET_TAIL_PKT_CMDQ_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_CMDQ_V2) & BIT_MASK_TAIL_PKT_CMDQ_V2) -+#define BIT_SET_TAIL_PKT_CMDQ_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_CMDQ_V2(x) | BIT_TAIL_PKT_CMDQ_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_NEW_EDCA_CTRL_V1 (Offset 0x0464) */ -+ -+#define BIT_SHIFT_RANDOM_VALUE_SHIFT 9 -+#define BIT_MASK_RANDOM_VALUE_SHIFT 0x7 -+#define BIT_RANDOM_VALUE_SHIFT(x) \ -+ (((x) & BIT_MASK_RANDOM_VALUE_SHIFT) << BIT_SHIFT_RANDOM_VALUE_SHIFT) -+#define BITS_RANDOM_VALUE_SHIFT \ -+ (BIT_MASK_RANDOM_VALUE_SHIFT << BIT_SHIFT_RANDOM_VALUE_SHIFT) -+#define BIT_CLEAR_RANDOM_VALUE_SHIFT(x) ((x) & (~BITS_RANDOM_VALUE_SHIFT)) -+#define BIT_GET_RANDOM_VALUE_SHIFT(x) \ -+ (((x) >> BIT_SHIFT_RANDOM_VALUE_SHIFT) & BIT_MASK_RANDOM_VALUE_SHIFT) -+#define BIT_SET_RANDOM_VALUE_SHIFT(x, v) \ -+ (BIT_CLEAR_RANDOM_VALUE_SHIFT(x) | BIT_RANDOM_VALUE_SHIFT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CMDQ_INFO (Offset 0x0464) */ -+ -+#define BIT_SHIFT_PKT_NUM_CMDQ 8 -+#define BIT_MASK_PKT_NUM_CMDQ 0xff -+#define BIT_PKT_NUM_CMDQ(x) \ -+ (((x) & BIT_MASK_PKT_NUM_CMDQ) << BIT_SHIFT_PKT_NUM_CMDQ) -+#define BITS_PKT_NUM_CMDQ (BIT_MASK_PKT_NUM_CMDQ << BIT_SHIFT_PKT_NUM_CMDQ) -+#define BIT_CLEAR_PKT_NUM_CMDQ(x) ((x) & (~BITS_PKT_NUM_CMDQ)) -+#define BIT_GET_PKT_NUM_CMDQ(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_CMDQ) & BIT_MASK_PKT_NUM_CMDQ) -+#define BIT_SET_PKT_NUM_CMDQ(x, v) \ -+ (BIT_CLEAR_PKT_NUM_CMDQ(x) | BIT_PKT_NUM_CMDQ(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_NEW_EDCA_CTRL_V1 (Offset 0x0464) */ -+ -+#define BIT_ENABLE_NEW_EDCA BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CMDQ_INFO (Offset 0x0464) */ -+ -+#define BIT_SHIFT_HEAD_PKT_CMDQ 0 -+#define BIT_MASK_HEAD_PKT_CMDQ 0xff -+#define BIT_HEAD_PKT_CMDQ(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_CMDQ) << BIT_SHIFT_HEAD_PKT_CMDQ) -+#define BITS_HEAD_PKT_CMDQ (BIT_MASK_HEAD_PKT_CMDQ << BIT_SHIFT_HEAD_PKT_CMDQ) -+#define BIT_CLEAR_HEAD_PKT_CMDQ(x) ((x) & (~BITS_HEAD_PKT_CMDQ)) -+#define BIT_GET_HEAD_PKT_CMDQ(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_CMDQ) & BIT_MASK_HEAD_PKT_CMDQ) -+#define BIT_SET_HEAD_PKT_CMDQ(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_CMDQ(x) | BIT_HEAD_PKT_CMDQ(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CMDQ_INFO (Offset 0x0464) */ -+ -+#define BIT_SHIFT_HEAD_PKT_CMDQ_V1 0 -+#define BIT_MASK_HEAD_PKT_CMDQ_V1 0x7ff -+#define BIT_HEAD_PKT_CMDQ_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_CMDQ_V1) << BIT_SHIFT_HEAD_PKT_CMDQ_V1) -+#define BITS_HEAD_PKT_CMDQ_V1 \ -+ (BIT_MASK_HEAD_PKT_CMDQ_V1 << BIT_SHIFT_HEAD_PKT_CMDQ_V1) -+#define BIT_CLEAR_HEAD_PKT_CMDQ_V1(x) ((x) & (~BITS_HEAD_PKT_CMDQ_V1)) -+#define BIT_GET_HEAD_PKT_CMDQ_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_CMDQ_V1) & BIT_MASK_HEAD_PKT_CMDQ_V1) -+#define BIT_SET_HEAD_PKT_CMDQ_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_CMDQ_V1(x) | BIT_HEAD_PKT_CMDQ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_NEW_EDCA_CTRL_V1 (Offset 0x0464) */ -+ -+#define BIT_SHIFT_MEDIUM_HAS_IDKE_TRIGGER 0 -+#define BIT_MASK_MEDIUM_HAS_IDKE_TRIGGER 0xff -+#define BIT_MEDIUM_HAS_IDKE_TRIGGER(x) \ -+ (((x) & BIT_MASK_MEDIUM_HAS_IDKE_TRIGGER) \ -+ << BIT_SHIFT_MEDIUM_HAS_IDKE_TRIGGER) -+#define BITS_MEDIUM_HAS_IDKE_TRIGGER \ -+ (BIT_MASK_MEDIUM_HAS_IDKE_TRIGGER << BIT_SHIFT_MEDIUM_HAS_IDKE_TRIGGER) -+#define BIT_CLEAR_MEDIUM_HAS_IDKE_TRIGGER(x) \ -+ ((x) & (~BITS_MEDIUM_HAS_IDKE_TRIGGER)) -+#define BIT_GET_MEDIUM_HAS_IDKE_TRIGGER(x) \ -+ (((x) >> BIT_SHIFT_MEDIUM_HAS_IDKE_TRIGGER) & \ -+ BIT_MASK_MEDIUM_HAS_IDKE_TRIGGER) -+#define BIT_SET_MEDIUM_HAS_IDKE_TRIGGER(x, v) \ -+ (BIT_CLEAR_MEDIUM_HAS_IDKE_TRIGGER(x) | BIT_MEDIUM_HAS_IDKE_TRIGGER(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q4_INFO (Offset 0x0468) */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q4_V1 25 -+#define BIT_MASK_QUEUEMACID_Q4_V1 0x7f -+#define BIT_QUEUEMACID_Q4_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q4_V1) << BIT_SHIFT_QUEUEMACID_Q4_V1) -+#define BITS_QUEUEMACID_Q4_V1 \ -+ (BIT_MASK_QUEUEMACID_Q4_V1 << BIT_SHIFT_QUEUEMACID_Q4_V1) -+#define BIT_CLEAR_QUEUEMACID_Q4_V1(x) ((x) & (~BITS_QUEUEMACID_Q4_V1)) -+#define BIT_GET_QUEUEMACID_Q4_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q4_V1) & BIT_MASK_QUEUEMACID_Q4_V1) -+#define BIT_SET_QUEUEMACID_Q4_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q4_V1(x) | BIT_QUEUEMACID_Q4_V1(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q4_V1 23 -+#define BIT_MASK_QUEUEAC_Q4_V1 0x3 -+#define BIT_QUEUEAC_Q4_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q4_V1) << BIT_SHIFT_QUEUEAC_Q4_V1) -+#define BITS_QUEUEAC_Q4_V1 (BIT_MASK_QUEUEAC_Q4_V1 << BIT_SHIFT_QUEUEAC_Q4_V1) -+#define BIT_CLEAR_QUEUEAC_Q4_V1(x) ((x) & (~BITS_QUEUEAC_Q4_V1)) -+#define BIT_GET_QUEUEAC_Q4_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q4_V1) & BIT_MASK_QUEUEAC_Q4_V1) -+#define BIT_SET_QUEUEAC_Q4_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q4_V1(x) | BIT_QUEUEAC_Q4_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q4_INFO (Offset 0x0468) */ -+ -+#define BIT_TIDEMPTY_Q4_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACQ_STOP_V2 (Offset 0x0468) */ -+ -+#define BIT_AC19Q_STOP BIT(19) -+#define BIT_AC18Q_STOP BIT(18) -+#define BIT_AC17Q_STOP BIT(17) -+#define BIT_AC16Q_STOP BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q4_INFO (Offset 0x0468) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q4_V1 15 -+#define BIT_MASK_TAIL_PKT_Q4_V1 0xff -+#define BIT_TAIL_PKT_Q4_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q4_V1) << BIT_SHIFT_TAIL_PKT_Q4_V1) -+#define BITS_TAIL_PKT_Q4_V1 \ -+ (BIT_MASK_TAIL_PKT_Q4_V1 << BIT_SHIFT_TAIL_PKT_Q4_V1) -+#define BIT_CLEAR_TAIL_PKT_Q4_V1(x) ((x) & (~BITS_TAIL_PKT_Q4_V1)) -+#define BIT_GET_TAIL_PKT_Q4_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q4_V1) & BIT_MASK_TAIL_PKT_Q4_V1) -+#define BIT_SET_TAIL_PKT_Q4_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q4_V1(x) | BIT_TAIL_PKT_Q4_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACQ_STOP_V2 (Offset 0x0468) */ -+ -+#define BIT_AC15Q_STOP BIT(15) -+#define BIT_AC14Q_STOP BIT(14) -+#define BIT_AC13Q_STOP BIT(13) -+#define BIT_AC12Q_STOP BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q4_INFO (Offset 0x0468) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q4_V2 11 -+#define BIT_MASK_TAIL_PKT_Q4_V2 0x7ff -+#define BIT_TAIL_PKT_Q4_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q4_V2) << BIT_SHIFT_TAIL_PKT_Q4_V2) -+#define BITS_TAIL_PKT_Q4_V2 \ -+ (BIT_MASK_TAIL_PKT_Q4_V2 << BIT_SHIFT_TAIL_PKT_Q4_V2) -+#define BIT_CLEAR_TAIL_PKT_Q4_V2(x) ((x) & (~BITS_TAIL_PKT_Q4_V2)) -+#define BIT_GET_TAIL_PKT_Q4_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q4_V2) & BIT_MASK_TAIL_PKT_Q4_V2) -+#define BIT_SET_TAIL_PKT_Q4_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q4_V2(x) | BIT_TAIL_PKT_Q4_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACQ_STOP_V2 (Offset 0x0468) */ -+ -+#define BIT_AC11Q_STOP BIT(11) -+#define BIT_AC10Q_STOP BIT(10) -+#define BIT_AC9Q_STOP BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q4_INFO (Offset 0x0468) */ -+ -+#define BIT_SHIFT_PKT_NUM_Q4_V1 8 -+#define BIT_MASK_PKT_NUM_Q4_V1 0x7f -+#define BIT_PKT_NUM_Q4_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_Q4_V1) << BIT_SHIFT_PKT_NUM_Q4_V1) -+#define BITS_PKT_NUM_Q4_V1 (BIT_MASK_PKT_NUM_Q4_V1 << BIT_SHIFT_PKT_NUM_Q4_V1) -+#define BIT_CLEAR_PKT_NUM_Q4_V1(x) ((x) & (~BITS_PKT_NUM_Q4_V1)) -+#define BIT_GET_PKT_NUM_Q4_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_Q4_V1) & BIT_MASK_PKT_NUM_Q4_V1) -+#define BIT_SET_PKT_NUM_Q4_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_Q4_V1(x) | BIT_PKT_NUM_Q4_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACQ_STOP_V2 (Offset 0x0468) */ -+ -+#define BIT_AC8Q_STOP BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q4_INFO (Offset 0x0468) */ -+ -+#define BIT_SHIFT_HEAD_PKT_Q4 0 -+#define BIT_MASK_HEAD_PKT_Q4 0xff -+#define BIT_HEAD_PKT_Q4(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q4) << BIT_SHIFT_HEAD_PKT_Q4) -+#define BITS_HEAD_PKT_Q4 (BIT_MASK_HEAD_PKT_Q4 << BIT_SHIFT_HEAD_PKT_Q4) -+#define BIT_CLEAR_HEAD_PKT_Q4(x) ((x) & (~BITS_HEAD_PKT_Q4)) -+#define BIT_GET_HEAD_PKT_Q4(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q4) & BIT_MASK_HEAD_PKT_Q4) -+#define BIT_SET_HEAD_PKT_Q4(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q4(x) | BIT_HEAD_PKT_Q4(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q4_INFO (Offset 0x0468) */ -+ -+#define BIT_SHIFT_HEAD_PKT_Q4_V1 0 -+#define BIT_MASK_HEAD_PKT_Q4_V1 0x7ff -+#define BIT_HEAD_PKT_Q4_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q4_V1) << BIT_SHIFT_HEAD_PKT_Q4_V1) -+#define BITS_HEAD_PKT_Q4_V1 \ -+ (BIT_MASK_HEAD_PKT_Q4_V1 << BIT_SHIFT_HEAD_PKT_Q4_V1) -+#define BIT_CLEAR_HEAD_PKT_Q4_V1(x) ((x) & (~BITS_HEAD_PKT_Q4_V1)) -+#define BIT_GET_HEAD_PKT_Q4_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q4_V1) & BIT_MASK_HEAD_PKT_Q4_V1) -+#define BIT_SET_HEAD_PKT_Q4_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q4_V1(x) | BIT_HEAD_PKT_Q4_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q5_INFO (Offset 0x046C) */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q5_V1 25 -+#define BIT_MASK_QUEUEMACID_Q5_V1 0x7f -+#define BIT_QUEUEMACID_Q5_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q5_V1) << BIT_SHIFT_QUEUEMACID_Q5_V1) -+#define BITS_QUEUEMACID_Q5_V1 \ -+ (BIT_MASK_QUEUEMACID_Q5_V1 << BIT_SHIFT_QUEUEMACID_Q5_V1) -+#define BIT_CLEAR_QUEUEMACID_Q5_V1(x) ((x) & (~BITS_QUEUEMACID_Q5_V1)) -+#define BIT_GET_QUEUEMACID_Q5_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q5_V1) & BIT_MASK_QUEUEMACID_Q5_V1) -+#define BIT_SET_QUEUEMACID_Q5_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q5_V1(x) | BIT_QUEUEMACID_Q5_V1(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q5_V1 23 -+#define BIT_MASK_QUEUEAC_Q5_V1 0x3 -+#define BIT_QUEUEAC_Q5_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q5_V1) << BIT_SHIFT_QUEUEAC_Q5_V1) -+#define BITS_QUEUEAC_Q5_V1 (BIT_MASK_QUEUEAC_Q5_V1 << BIT_SHIFT_QUEUEAC_Q5_V1) -+#define BIT_CLEAR_QUEUEAC_Q5_V1(x) ((x) & (~BITS_QUEUEAC_Q5_V1)) -+#define BIT_GET_QUEUEAC_Q5_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q5_V1) & BIT_MASK_QUEUEAC_Q5_V1) -+#define BIT_SET_QUEUEAC_Q5_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q5_V1(x) | BIT_QUEUEAC_Q5_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q5_INFO (Offset 0x046C) */ -+ -+#define BIT_TIDEMPTY_Q5_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q5_INFO (Offset 0x046C) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q5_V1 15 -+#define BIT_MASK_TAIL_PKT_Q5_V1 0xff -+#define BIT_TAIL_PKT_Q5_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q5_V1) << BIT_SHIFT_TAIL_PKT_Q5_V1) -+#define BITS_TAIL_PKT_Q5_V1 \ -+ (BIT_MASK_TAIL_PKT_Q5_V1 << BIT_SHIFT_TAIL_PKT_Q5_V1) -+#define BIT_CLEAR_TAIL_PKT_Q5_V1(x) ((x) & (~BITS_TAIL_PKT_Q5_V1)) -+#define BIT_GET_TAIL_PKT_Q5_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q5_V1) & BIT_MASK_TAIL_PKT_Q5_V1) -+#define BIT_SET_TAIL_PKT_Q5_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q5_V1(x) | BIT_TAIL_PKT_Q5_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q5_INFO (Offset 0x046C) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q5_V2 11 -+#define BIT_MASK_TAIL_PKT_Q5_V2 0x7ff -+#define BIT_TAIL_PKT_Q5_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q5_V2) << BIT_SHIFT_TAIL_PKT_Q5_V2) -+#define BITS_TAIL_PKT_Q5_V2 \ -+ (BIT_MASK_TAIL_PKT_Q5_V2 << BIT_SHIFT_TAIL_PKT_Q5_V2) -+#define BIT_CLEAR_TAIL_PKT_Q5_V2(x) ((x) & (~BITS_TAIL_PKT_Q5_V2)) -+#define BIT_GET_TAIL_PKT_Q5_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q5_V2) & BIT_MASK_TAIL_PKT_Q5_V2) -+#define BIT_SET_TAIL_PKT_Q5_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q5_V2(x) | BIT_TAIL_PKT_Q5_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q5_INFO (Offset 0x046C) */ -+ -+#define BIT_SHIFT_PKT_NUM_Q5_V1 8 -+#define BIT_MASK_PKT_NUM_Q5_V1 0x7f -+#define BIT_PKT_NUM_Q5_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_Q5_V1) << BIT_SHIFT_PKT_NUM_Q5_V1) -+#define BITS_PKT_NUM_Q5_V1 (BIT_MASK_PKT_NUM_Q5_V1 << BIT_SHIFT_PKT_NUM_Q5_V1) -+#define BIT_CLEAR_PKT_NUM_Q5_V1(x) ((x) & (~BITS_PKT_NUM_Q5_V1)) -+#define BIT_GET_PKT_NUM_Q5_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_Q5_V1) & BIT_MASK_PKT_NUM_Q5_V1) -+#define BIT_SET_PKT_NUM_Q5_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_Q5_V1(x) | BIT_PKT_NUM_Q5_V1(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q5 0 -+#define BIT_MASK_HEAD_PKT_Q5 0xff -+#define BIT_HEAD_PKT_Q5(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q5) << BIT_SHIFT_HEAD_PKT_Q5) -+#define BITS_HEAD_PKT_Q5 (BIT_MASK_HEAD_PKT_Q5 << BIT_SHIFT_HEAD_PKT_Q5) -+#define BIT_CLEAR_HEAD_PKT_Q5(x) ((x) & (~BITS_HEAD_PKT_Q5)) -+#define BIT_GET_HEAD_PKT_Q5(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q5) & BIT_MASK_HEAD_PKT_Q5) -+#define BIT_SET_HEAD_PKT_Q5(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q5(x) | BIT_HEAD_PKT_Q5(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q5_INFO (Offset 0x046C) */ -+ -+#define BIT_SHIFT_HEAD_PKT_Q5_V1 0 -+#define BIT_MASK_HEAD_PKT_Q5_V1 0x7ff -+#define BIT_HEAD_PKT_Q5_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q5_V1) << BIT_SHIFT_HEAD_PKT_Q5_V1) -+#define BITS_HEAD_PKT_Q5_V1 \ -+ (BIT_MASK_HEAD_PKT_Q5_V1 << BIT_SHIFT_HEAD_PKT_Q5_V1) -+#define BIT_CLEAR_HEAD_PKT_Q5_V1(x) ((x) & (~BITS_HEAD_PKT_Q5_V1)) -+#define BIT_GET_HEAD_PKT_Q5_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q5_V1) & BIT_MASK_HEAD_PKT_Q5_V1) -+#define BIT_SET_HEAD_PKT_Q5_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q5_V1(x) | BIT_HEAD_PKT_Q5_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q6_INFO (Offset 0x0470) */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q6_V1 25 -+#define BIT_MASK_QUEUEMACID_Q6_V1 0x7f -+#define BIT_QUEUEMACID_Q6_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q6_V1) << BIT_SHIFT_QUEUEMACID_Q6_V1) -+#define BITS_QUEUEMACID_Q6_V1 \ -+ (BIT_MASK_QUEUEMACID_Q6_V1 << BIT_SHIFT_QUEUEMACID_Q6_V1) -+#define BIT_CLEAR_QUEUEMACID_Q6_V1(x) ((x) & (~BITS_QUEUEMACID_Q6_V1)) -+#define BIT_GET_QUEUEMACID_Q6_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q6_V1) & BIT_MASK_QUEUEMACID_Q6_V1) -+#define BIT_SET_QUEUEMACID_Q6_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q6_V1(x) | BIT_QUEUEMACID_Q6_V1(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q6_V1 23 -+#define BIT_MASK_QUEUEAC_Q6_V1 0x3 -+#define BIT_QUEUEAC_Q6_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q6_V1) << BIT_SHIFT_QUEUEAC_Q6_V1) -+#define BITS_QUEUEAC_Q6_V1 (BIT_MASK_QUEUEAC_Q6_V1 << BIT_SHIFT_QUEUEAC_Q6_V1) -+#define BIT_CLEAR_QUEUEAC_Q6_V1(x) ((x) & (~BITS_QUEUEAC_Q6_V1)) -+#define BIT_GET_QUEUEAC_Q6_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q6_V1) & BIT_MASK_QUEUEAC_Q6_V1) -+#define BIT_SET_QUEUEAC_Q6_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q6_V1(x) | BIT_QUEUEAC_Q6_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q6_INFO (Offset 0x0470) */ -+ -+#define BIT_TIDEMPTY_Q6_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q6_INFO (Offset 0x0470) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q6_V1 15 -+#define BIT_MASK_TAIL_PKT_Q6_V1 0xff -+#define BIT_TAIL_PKT_Q6_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q6_V1) << BIT_SHIFT_TAIL_PKT_Q6_V1) -+#define BITS_TAIL_PKT_Q6_V1 \ -+ (BIT_MASK_TAIL_PKT_Q6_V1 << BIT_SHIFT_TAIL_PKT_Q6_V1) -+#define BIT_CLEAR_TAIL_PKT_Q6_V1(x) ((x) & (~BITS_TAIL_PKT_Q6_V1)) -+#define BIT_GET_TAIL_PKT_Q6_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q6_V1) & BIT_MASK_TAIL_PKT_Q6_V1) -+#define BIT_SET_TAIL_PKT_Q6_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q6_V1(x) | BIT_TAIL_PKT_Q6_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q6_INFO (Offset 0x0470) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q6_V2 11 -+#define BIT_MASK_TAIL_PKT_Q6_V2 0x7ff -+#define BIT_TAIL_PKT_Q6_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q6_V2) << BIT_SHIFT_TAIL_PKT_Q6_V2) -+#define BITS_TAIL_PKT_Q6_V2 \ -+ (BIT_MASK_TAIL_PKT_Q6_V2 << BIT_SHIFT_TAIL_PKT_Q6_V2) -+#define BIT_CLEAR_TAIL_PKT_Q6_V2(x) ((x) & (~BITS_TAIL_PKT_Q6_V2)) -+#define BIT_GET_TAIL_PKT_Q6_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q6_V2) & BIT_MASK_TAIL_PKT_Q6_V2) -+#define BIT_SET_TAIL_PKT_Q6_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q6_V2(x) | BIT_TAIL_PKT_Q6_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q6_INFO (Offset 0x0470) */ -+ -+#define BIT_SHIFT_PKT_NUM_Q6_V1 8 -+#define BIT_MASK_PKT_NUM_Q6_V1 0x7f -+#define BIT_PKT_NUM_Q6_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_Q6_V1) << BIT_SHIFT_PKT_NUM_Q6_V1) -+#define BITS_PKT_NUM_Q6_V1 (BIT_MASK_PKT_NUM_Q6_V1 << BIT_SHIFT_PKT_NUM_Q6_V1) -+#define BIT_CLEAR_PKT_NUM_Q6_V1(x) ((x) & (~BITS_PKT_NUM_Q6_V1)) -+#define BIT_GET_PKT_NUM_Q6_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_Q6_V1) & BIT_MASK_PKT_NUM_Q6_V1) -+#define BIT_SET_PKT_NUM_Q6_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_Q6_V1(x) | BIT_PKT_NUM_Q6_V1(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q6 0 -+#define BIT_MASK_HEAD_PKT_Q6 0xff -+#define BIT_HEAD_PKT_Q6(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q6) << BIT_SHIFT_HEAD_PKT_Q6) -+#define BITS_HEAD_PKT_Q6 (BIT_MASK_HEAD_PKT_Q6 << BIT_SHIFT_HEAD_PKT_Q6) -+#define BIT_CLEAR_HEAD_PKT_Q6(x) ((x) & (~BITS_HEAD_PKT_Q6)) -+#define BIT_GET_HEAD_PKT_Q6(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q6) & BIT_MASK_HEAD_PKT_Q6) -+#define BIT_SET_HEAD_PKT_Q6(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q6(x) | BIT_HEAD_PKT_Q6(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q6_INFO (Offset 0x0470) */ -+ -+#define BIT_SHIFT_HEAD_PKT_Q6_V1 0 -+#define BIT_MASK_HEAD_PKT_Q6_V1 0x7ff -+#define BIT_HEAD_PKT_Q6_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q6_V1) << BIT_SHIFT_HEAD_PKT_Q6_V1) -+#define BITS_HEAD_PKT_Q6_V1 \ -+ (BIT_MASK_HEAD_PKT_Q6_V1 << BIT_SHIFT_HEAD_PKT_Q6_V1) -+#define BIT_CLEAR_HEAD_PKT_Q6_V1(x) ((x) & (~BITS_HEAD_PKT_Q6_V1)) -+#define BIT_GET_HEAD_PKT_Q6_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q6_V1) & BIT_MASK_HEAD_PKT_Q6_V1) -+#define BIT_SET_HEAD_PKT_Q6_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q6_V1(x) | BIT_HEAD_PKT_Q6_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q7_INFO (Offset 0x0474) */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q7_V1 25 -+#define BIT_MASK_QUEUEMACID_Q7_V1 0x7f -+#define BIT_QUEUEMACID_Q7_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q7_V1) << BIT_SHIFT_QUEUEMACID_Q7_V1) -+#define BITS_QUEUEMACID_Q7_V1 \ -+ (BIT_MASK_QUEUEMACID_Q7_V1 << BIT_SHIFT_QUEUEMACID_Q7_V1) -+#define BIT_CLEAR_QUEUEMACID_Q7_V1(x) ((x) & (~BITS_QUEUEMACID_Q7_V1)) -+#define BIT_GET_QUEUEMACID_Q7_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q7_V1) & BIT_MASK_QUEUEMACID_Q7_V1) -+#define BIT_SET_QUEUEMACID_Q7_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q7_V1(x) | BIT_QUEUEMACID_Q7_V1(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q7_V1 23 -+#define BIT_MASK_QUEUEAC_Q7_V1 0x3 -+#define BIT_QUEUEAC_Q7_V1(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q7_V1) << BIT_SHIFT_QUEUEAC_Q7_V1) -+#define BITS_QUEUEAC_Q7_V1 (BIT_MASK_QUEUEAC_Q7_V1 << BIT_SHIFT_QUEUEAC_Q7_V1) -+#define BIT_CLEAR_QUEUEAC_Q7_V1(x) ((x) & (~BITS_QUEUEAC_Q7_V1)) -+#define BIT_GET_QUEUEAC_Q7_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q7_V1) & BIT_MASK_QUEUEAC_Q7_V1) -+#define BIT_SET_QUEUEAC_Q7_V1(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q7_V1(x) | BIT_QUEUEAC_Q7_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q7_INFO (Offset 0x0474) */ -+ -+#define BIT_TIDEMPTY_Q7_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q7_INFO (Offset 0x0474) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q7_V1 15 -+#define BIT_MASK_TAIL_PKT_Q7_V1 0xff -+#define BIT_TAIL_PKT_Q7_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q7_V1) << BIT_SHIFT_TAIL_PKT_Q7_V1) -+#define BITS_TAIL_PKT_Q7_V1 \ -+ (BIT_MASK_TAIL_PKT_Q7_V1 << BIT_SHIFT_TAIL_PKT_Q7_V1) -+#define BIT_CLEAR_TAIL_PKT_Q7_V1(x) ((x) & (~BITS_TAIL_PKT_Q7_V1)) -+#define BIT_GET_TAIL_PKT_Q7_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q7_V1) & BIT_MASK_TAIL_PKT_Q7_V1) -+#define BIT_SET_TAIL_PKT_Q7_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q7_V1(x) | BIT_TAIL_PKT_Q7_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q7_INFO (Offset 0x0474) */ -+ -+#define BIT_SHIFT_TAIL_PKT_Q7_V2 11 -+#define BIT_MASK_TAIL_PKT_Q7_V2 0x7ff -+#define BIT_TAIL_PKT_Q7_V2(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q7_V2) << BIT_SHIFT_TAIL_PKT_Q7_V2) -+#define BITS_TAIL_PKT_Q7_V2 \ -+ (BIT_MASK_TAIL_PKT_Q7_V2 << BIT_SHIFT_TAIL_PKT_Q7_V2) -+#define BIT_CLEAR_TAIL_PKT_Q7_V2(x) ((x) & (~BITS_TAIL_PKT_Q7_V2)) -+#define BIT_GET_TAIL_PKT_Q7_V2(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q7_V2) & BIT_MASK_TAIL_PKT_Q7_V2) -+#define BIT_SET_TAIL_PKT_Q7_V2(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q7_V2(x) | BIT_TAIL_PKT_Q7_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_Q7_INFO (Offset 0x0474) */ -+ -+#define BIT_SHIFT_PKT_NUM_Q7_V1 8 -+#define BIT_MASK_PKT_NUM_Q7_V1 0x7f -+#define BIT_PKT_NUM_Q7_V1(x) \ -+ (((x) & BIT_MASK_PKT_NUM_Q7_V1) << BIT_SHIFT_PKT_NUM_Q7_V1) -+#define BITS_PKT_NUM_Q7_V1 (BIT_MASK_PKT_NUM_Q7_V1 << BIT_SHIFT_PKT_NUM_Q7_V1) -+#define BIT_CLEAR_PKT_NUM_Q7_V1(x) ((x) & (~BITS_PKT_NUM_Q7_V1)) -+#define BIT_GET_PKT_NUM_Q7_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_Q7_V1) & BIT_MASK_PKT_NUM_Q7_V1) -+#define BIT_SET_PKT_NUM_Q7_V1(x, v) \ -+ (BIT_CLEAR_PKT_NUM_Q7_V1(x) | BIT_PKT_NUM_Q7_V1(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q7 0 -+#define BIT_MASK_HEAD_PKT_Q7 0xff -+#define BIT_HEAD_PKT_Q7(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q7) << BIT_SHIFT_HEAD_PKT_Q7) -+#define BITS_HEAD_PKT_Q7 (BIT_MASK_HEAD_PKT_Q7 << BIT_SHIFT_HEAD_PKT_Q7) -+#define BIT_CLEAR_HEAD_PKT_Q7(x) ((x) & (~BITS_HEAD_PKT_Q7)) -+#define BIT_GET_HEAD_PKT_Q7(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q7) & BIT_MASK_HEAD_PKT_Q7) -+#define BIT_SET_HEAD_PKT_Q7(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q7(x) | BIT_HEAD_PKT_Q7(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q7_INFO (Offset 0x0474) */ -+ -+#define BIT_SHIFT_HEAD_PKT_Q7_V1 0 -+#define BIT_MASK_HEAD_PKT_Q7_V1 0x7ff -+#define BIT_HEAD_PKT_Q7_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q7_V1) << BIT_SHIFT_HEAD_PKT_Q7_V1) -+#define BITS_HEAD_PKT_Q7_V1 \ -+ (BIT_MASK_HEAD_PKT_Q7_V1 << BIT_SHIFT_HEAD_PKT_Q7_V1) -+#define BIT_CLEAR_HEAD_PKT_Q7_V1(x) ((x) & (~BITS_HEAD_PKT_Q7_V1)) -+#define BIT_GET_HEAD_PKT_Q7_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q7_V1) & BIT_MASK_HEAD_PKT_Q7_V1) -+#define BIT_SET_HEAD_PKT_Q7_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q7_V1(x) | BIT_HEAD_PKT_Q7_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_LBK_BUF_HD_V1 (Offset 0x0478) */ -+ -+#define BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1 0 -+#define BIT_MASK_WMAC_LBK_BUF_HEAD_V1 0xfff -+#define BIT_WMAC_LBK_BUF_HEAD_V1(x) \ -+ (((x) & BIT_MASK_WMAC_LBK_BUF_HEAD_V1) \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1) -+#define BITS_WMAC_LBK_BUF_HEAD_V1 \ -+ (BIT_MASK_WMAC_LBK_BUF_HEAD_V1 << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1) -+#define BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1(x) ((x) & (~BITS_WMAC_LBK_BUF_HEAD_V1)) -+#define BIT_GET_WMAC_LBK_BUF_HEAD_V1(x) \ -+ (((x) >> BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1) & \ -+ BIT_MASK_WMAC_LBK_BUF_HEAD_V1) -+#define BIT_SET_WMAC_LBK_BUF_HEAD_V1(x, v) \ -+ (BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1(x) | BIT_WMAC_LBK_BUF_HEAD_V1(v)) -+ -+/* 2 REG_MGQ_BDNY_V1 (Offset 0x047A) */ -+ -+#define BIT_SHIFT_MGQ_PGBNDY_V1 0 -+#define BIT_MASK_MGQ_PGBNDY_V1 0xfff -+#define BIT_MGQ_PGBNDY_V1(x) \ -+ (((x) & BIT_MASK_MGQ_PGBNDY_V1) << BIT_SHIFT_MGQ_PGBNDY_V1) -+#define BITS_MGQ_PGBNDY_V1 (BIT_MASK_MGQ_PGBNDY_V1 << BIT_SHIFT_MGQ_PGBNDY_V1) -+#define BIT_CLEAR_MGQ_PGBNDY_V1(x) ((x) & (~BITS_MGQ_PGBNDY_V1)) -+#define BIT_GET_MGQ_PGBNDY_V1(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PGBNDY_V1) & BIT_MASK_MGQ_PGBNDY_V1) -+#define BIT_SET_MGQ_PGBNDY_V1(x, v) \ -+ (BIT_CLEAR_MGQ_PGBNDY_V1(x) | BIT_MGQ_PGBNDY_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXRPT_CTRL (Offset 0x047C) */ -+ -+#define BIT_SHIFT_SPC_READ_PTR 24 -+#define BIT_MASK_SPC_READ_PTR 0xf -+#define BIT_SPC_READ_PTR(x) \ -+ (((x) & BIT_MASK_SPC_READ_PTR) << BIT_SHIFT_SPC_READ_PTR) -+#define BITS_SPC_READ_PTR (BIT_MASK_SPC_READ_PTR << BIT_SHIFT_SPC_READ_PTR) -+#define BIT_CLEAR_SPC_READ_PTR(x) ((x) & (~BITS_SPC_READ_PTR)) -+#define BIT_GET_SPC_READ_PTR(x) \ -+ (((x) >> BIT_SHIFT_SPC_READ_PTR) & BIT_MASK_SPC_READ_PTR) -+#define BIT_SET_SPC_READ_PTR(x, v) \ -+ (BIT_CLEAR_SPC_READ_PTR(x) | BIT_SPC_READ_PTR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXRPT_CTRL (Offset 0x047C) */ -+ -+#define BIT_SHIFT_TRXRPT_TIMER_TH 24 -+#define BIT_MASK_TRXRPT_TIMER_TH 0xff -+#define BIT_TRXRPT_TIMER_TH(x) \ -+ (((x) & BIT_MASK_TRXRPT_TIMER_TH) << BIT_SHIFT_TRXRPT_TIMER_TH) -+#define BITS_TRXRPT_TIMER_TH \ -+ (BIT_MASK_TRXRPT_TIMER_TH << BIT_SHIFT_TRXRPT_TIMER_TH) -+#define BIT_CLEAR_TRXRPT_TIMER_TH(x) ((x) & (~BITS_TRXRPT_TIMER_TH)) -+#define BIT_GET_TRXRPT_TIMER_TH(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_TIMER_TH) & BIT_MASK_TRXRPT_TIMER_TH) -+#define BIT_SET_TRXRPT_TIMER_TH(x, v) \ -+ (BIT_CLEAR_TRXRPT_TIMER_TH(x) | BIT_TRXRPT_TIMER_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXRPT_CTRL (Offset 0x047C) */ -+ -+#define BIT_SHIFT_SPC_WRITE_PTR 16 -+#define BIT_MASK_SPC_WRITE_PTR 0xf -+#define BIT_SPC_WRITE_PTR(x) \ -+ (((x) & BIT_MASK_SPC_WRITE_PTR) << BIT_SHIFT_SPC_WRITE_PTR) -+#define BITS_SPC_WRITE_PTR (BIT_MASK_SPC_WRITE_PTR << BIT_SHIFT_SPC_WRITE_PTR) -+#define BIT_CLEAR_SPC_WRITE_PTR(x) ((x) & (~BITS_SPC_WRITE_PTR)) -+#define BIT_GET_SPC_WRITE_PTR(x) \ -+ (((x) >> BIT_SHIFT_SPC_WRITE_PTR) & BIT_MASK_SPC_WRITE_PTR) -+#define BIT_SET_SPC_WRITE_PTR(x, v) \ -+ (BIT_CLEAR_SPC_WRITE_PTR(x) | BIT_SPC_WRITE_PTR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXRPT_CTRL (Offset 0x047C) */ -+ -+#define BIT_SHIFT_TRXRPT_LEN_TH 16 -+#define BIT_MASK_TRXRPT_LEN_TH 0xff -+#define BIT_TRXRPT_LEN_TH(x) \ -+ (((x) & BIT_MASK_TRXRPT_LEN_TH) << BIT_SHIFT_TRXRPT_LEN_TH) -+#define BITS_TRXRPT_LEN_TH (BIT_MASK_TRXRPT_LEN_TH << BIT_SHIFT_TRXRPT_LEN_TH) -+#define BIT_CLEAR_TRXRPT_LEN_TH(x) ((x) & (~BITS_TRXRPT_LEN_TH)) -+#define BIT_GET_TRXRPT_LEN_TH(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_LEN_TH) & BIT_MASK_TRXRPT_LEN_TH) -+#define BIT_SET_TRXRPT_LEN_TH(x, v) \ -+ (BIT_CLEAR_TRXRPT_LEN_TH(x) | BIT_TRXRPT_LEN_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXRPT_CTRL (Offset 0x047C) */ -+ -+#define BIT_SHIFT_AC_READ_PTR 8 -+#define BIT_MASK_AC_READ_PTR 0xf -+#define BIT_AC_READ_PTR(x) \ -+ (((x) & BIT_MASK_AC_READ_PTR) << BIT_SHIFT_AC_READ_PTR) -+#define BITS_AC_READ_PTR (BIT_MASK_AC_READ_PTR << BIT_SHIFT_AC_READ_PTR) -+#define BIT_CLEAR_AC_READ_PTR(x) ((x) & (~BITS_AC_READ_PTR)) -+#define BIT_GET_AC_READ_PTR(x) \ -+ (((x) >> BIT_SHIFT_AC_READ_PTR) & BIT_MASK_AC_READ_PTR) -+#define BIT_SET_AC_READ_PTR(x, v) \ -+ (BIT_CLEAR_AC_READ_PTR(x) | BIT_AC_READ_PTR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXRPT_CTRL (Offset 0x047C) */ -+ -+#define BIT_SHIFT_TRXRPT_READ_PTR 8 -+#define BIT_MASK_TRXRPT_READ_PTR 0xff -+#define BIT_TRXRPT_READ_PTR(x) \ -+ (((x) & BIT_MASK_TRXRPT_READ_PTR) << BIT_SHIFT_TRXRPT_READ_PTR) -+#define BITS_TRXRPT_READ_PTR \ -+ (BIT_MASK_TRXRPT_READ_PTR << BIT_SHIFT_TRXRPT_READ_PTR) -+#define BIT_CLEAR_TRXRPT_READ_PTR(x) ((x) & (~BITS_TRXRPT_READ_PTR)) -+#define BIT_GET_TRXRPT_READ_PTR(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_READ_PTR) & BIT_MASK_TRXRPT_READ_PTR) -+#define BIT_SET_TRXRPT_READ_PTR(x, v) \ -+ (BIT_CLEAR_TRXRPT_READ_PTR(x) | BIT_TRXRPT_READ_PTR(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXRPT_CTRL (Offset 0x047C) */ -+ -+#define BIT_SHIFT_AC_WRITE_PTR 0 -+#define BIT_MASK_AC_WRITE_PTR 0xf -+#define BIT_AC_WRITE_PTR(x) \ -+ (((x) & BIT_MASK_AC_WRITE_PTR) << BIT_SHIFT_AC_WRITE_PTR) -+#define BITS_AC_WRITE_PTR (BIT_MASK_AC_WRITE_PTR << BIT_SHIFT_AC_WRITE_PTR) -+#define BIT_CLEAR_AC_WRITE_PTR(x) ((x) & (~BITS_AC_WRITE_PTR)) -+#define BIT_GET_AC_WRITE_PTR(x) \ -+ (((x) >> BIT_SHIFT_AC_WRITE_PTR) & BIT_MASK_AC_WRITE_PTR) -+#define BIT_SET_AC_WRITE_PTR(x, v) \ -+ (BIT_CLEAR_AC_WRITE_PTR(x) | BIT_AC_WRITE_PTR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXRPT_CTRL (Offset 0x047C) */ -+ -+#define BIT_SHIFT_TRXRPT_WRITE_PTR 0 -+#define BIT_MASK_TRXRPT_WRITE_PTR 0xff -+#define BIT_TRXRPT_WRITE_PTR(x) \ -+ (((x) & BIT_MASK_TRXRPT_WRITE_PTR) << BIT_SHIFT_TRXRPT_WRITE_PTR) -+#define BITS_TRXRPT_WRITE_PTR \ -+ (BIT_MASK_TRXRPT_WRITE_PTR << BIT_SHIFT_TRXRPT_WRITE_PTR) -+#define BIT_CLEAR_TRXRPT_WRITE_PTR(x) ((x) & (~BITS_TRXRPT_WRITE_PTR)) -+#define BIT_GET_TRXRPT_WRITE_PTR(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_WRITE_PTR) & BIT_MASK_TRXRPT_WRITE_PTR) -+#define BIT_SET_TRXRPT_WRITE_PTR(x, v) \ -+ (BIT_CLEAR_TRXRPT_WRITE_PTR(x) | BIT_TRXRPT_WRITE_PTR(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_INIRTS_RATE_SEL (Offset 0x0480) */ -+ -+#define BIT_LEAG_RTS_BW_DUP BIT(5) -+ -+/* 2 REG_BASIC_CFEND_RATE (Offset 0x0481) */ -+ -+#define BIT_SHIFT_BASIC_CFEND_RATE 0 -+#define BIT_MASK_BASIC_CFEND_RATE 0x1f -+#define BIT_BASIC_CFEND_RATE(x) \ -+ (((x) & BIT_MASK_BASIC_CFEND_RATE) << BIT_SHIFT_BASIC_CFEND_RATE) -+#define BITS_BASIC_CFEND_RATE \ -+ (BIT_MASK_BASIC_CFEND_RATE << BIT_SHIFT_BASIC_CFEND_RATE) -+#define BIT_CLEAR_BASIC_CFEND_RATE(x) ((x) & (~BITS_BASIC_CFEND_RATE)) -+#define BIT_GET_BASIC_CFEND_RATE(x) \ -+ (((x) >> BIT_SHIFT_BASIC_CFEND_RATE) & BIT_MASK_BASIC_CFEND_RATE) -+#define BIT_SET_BASIC_CFEND_RATE(x, v) \ -+ (BIT_CLEAR_BASIC_CFEND_RATE(x) | BIT_BASIC_CFEND_RATE(v)) -+ -+/* 2 REG_STBC_CFEND_RATE (Offset 0x0482) */ -+ -+#define BIT_SHIFT_STBC_CFEND_RATE 0 -+#define BIT_MASK_STBC_CFEND_RATE 0x1f -+#define BIT_STBC_CFEND_RATE(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_RATE) << BIT_SHIFT_STBC_CFEND_RATE) -+#define BITS_STBC_CFEND_RATE \ -+ (BIT_MASK_STBC_CFEND_RATE << BIT_SHIFT_STBC_CFEND_RATE) -+#define BIT_CLEAR_STBC_CFEND_RATE(x) ((x) & (~BITS_STBC_CFEND_RATE)) -+#define BIT_GET_STBC_CFEND_RATE(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_RATE) & BIT_MASK_STBC_CFEND_RATE) -+#define BIT_SET_STBC_CFEND_RATE(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_RATE(x) | BIT_STBC_CFEND_RATE(v)) -+ -+/* 2 REG_DATA_SC (Offset 0x0483) */ -+ -+#define BIT_SHIFT_TXSC_40M 4 -+#define BIT_MASK_TXSC_40M 0xf -+#define BIT_TXSC_40M(x) (((x) & BIT_MASK_TXSC_40M) << BIT_SHIFT_TXSC_40M) -+#define BITS_TXSC_40M (BIT_MASK_TXSC_40M << BIT_SHIFT_TXSC_40M) -+#define BIT_CLEAR_TXSC_40M(x) ((x) & (~BITS_TXSC_40M)) -+#define BIT_GET_TXSC_40M(x) (((x) >> BIT_SHIFT_TXSC_40M) & BIT_MASK_TXSC_40M) -+#define BIT_SET_TXSC_40M(x, v) (BIT_CLEAR_TXSC_40M(x) | BIT_TXSC_40M(v)) -+ -+#define BIT_SHIFT_TXSC_20M 0 -+#define BIT_MASK_TXSC_20M 0xf -+#define BIT_TXSC_20M(x) (((x) & BIT_MASK_TXSC_20M) << BIT_SHIFT_TXSC_20M) -+#define BITS_TXSC_20M (BIT_MASK_TXSC_20M << BIT_SHIFT_TXSC_20M) -+#define BIT_CLEAR_TXSC_20M(x) ((x) & (~BITS_TXSC_20M)) -+#define BIT_GET_TXSC_20M(x) (((x) >> BIT_SHIFT_TXSC_20M) & BIT_MASK_TXSC_20M) -+#define BIT_SET_TXSC_20M(x, v) (BIT_CLEAR_TXSC_20M(x) | BIT_TXSC_20M(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MACID_SLEEP3 (Offset 0x0484) */ -+ -+#define BIT_SHIFT_MACID127_96_PKTSLEEP 0 -+#define BIT_MASK_MACID127_96_PKTSLEEP 0xffffffffL -+#define BIT_MACID127_96_PKTSLEEP(x) \ -+ (((x) & BIT_MASK_MACID127_96_PKTSLEEP) \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP) -+#define BITS_MACID127_96_PKTSLEEP \ -+ (BIT_MASK_MACID127_96_PKTSLEEP << BIT_SHIFT_MACID127_96_PKTSLEEP) -+#define BIT_CLEAR_MACID127_96_PKTSLEEP(x) ((x) & (~BITS_MACID127_96_PKTSLEEP)) -+#define BIT_GET_MACID127_96_PKTSLEEP(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_PKTSLEEP) & \ -+ BIT_MASK_MACID127_96_PKTSLEEP) -+#define BIT_SET_MACID127_96_PKTSLEEP(x, v) \ -+ (BIT_CLEAR_MACID127_96_PKTSLEEP(x) | BIT_MACID127_96_PKTSLEEP(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MACID_SLEEP3 (Offset 0x0484) */ -+ -+#define BIT_SHIFT_MACID103_96_PKTSLEEP 0 -+#define BIT_MASK_MACID103_96_PKTSLEEP 0xff -+#define BIT_MACID103_96_PKTSLEEP(x) \ -+ (((x) & BIT_MASK_MACID103_96_PKTSLEEP) \ -+ << BIT_SHIFT_MACID103_96_PKTSLEEP) -+#define BITS_MACID103_96_PKTSLEEP \ -+ (BIT_MASK_MACID103_96_PKTSLEEP << BIT_SHIFT_MACID103_96_PKTSLEEP) -+#define BIT_CLEAR_MACID103_96_PKTSLEEP(x) ((x) & (~BITS_MACID103_96_PKTSLEEP)) -+#define BIT_GET_MACID103_96_PKTSLEEP(x) \ -+ (((x) >> BIT_SHIFT_MACID103_96_PKTSLEEP) & \ -+ BIT_MASK_MACID103_96_PKTSLEEP) -+#define BIT_SET_MACID103_96_PKTSLEEP(x, v) \ -+ (BIT_CLEAR_MACID103_96_PKTSLEEP(x) | BIT_MACID103_96_PKTSLEEP(v)) -+ -+/* 2 REG_MACID_SLEEP4 (Offset 0x0485) */ -+ -+#define BIT_SHIFT_MACID119_104_PKTSLEEP 0 -+#define BIT_MASK_MACID119_104_PKTSLEEP 0xffff -+#define BIT_MACID119_104_PKTSLEEP(x) \ -+ (((x) & BIT_MASK_MACID119_104_PKTSLEEP) \ -+ << BIT_SHIFT_MACID119_104_PKTSLEEP) -+#define BITS_MACID119_104_PKTSLEEP \ -+ (BIT_MASK_MACID119_104_PKTSLEEP << BIT_SHIFT_MACID119_104_PKTSLEEP) -+#define BIT_CLEAR_MACID119_104_PKTSLEEP(x) ((x) & (~BITS_MACID119_104_PKTSLEEP)) -+#define BIT_GET_MACID119_104_PKTSLEEP(x) \ -+ (((x) >> BIT_SHIFT_MACID119_104_PKTSLEEP) & \ -+ BIT_MASK_MACID119_104_PKTSLEEP) -+#define BIT_SET_MACID119_104_PKTSLEEP(x, v) \ -+ (BIT_CLEAR_MACID119_104_PKTSLEEP(x) | BIT_MACID119_104_PKTSLEEP(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_SC1 (Offset 0x0487) */ -+ -+#define BIT_SHIFT_TXSC_160M 4 -+#define BIT_MASK_TXSC_160M 0xf -+#define BIT_TXSC_160M(x) (((x) & BIT_MASK_TXSC_160M) << BIT_SHIFT_TXSC_160M) -+#define BITS_TXSC_160M (BIT_MASK_TXSC_160M << BIT_SHIFT_TXSC_160M) -+#define BIT_CLEAR_TXSC_160M(x) ((x) & (~BITS_TXSC_160M)) -+#define BIT_GET_TXSC_160M(x) (((x) >> BIT_SHIFT_TXSC_160M) & BIT_MASK_TXSC_160M) -+#define BIT_SET_TXSC_160M(x, v) (BIT_CLEAR_TXSC_160M(x) | BIT_TXSC_160M(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MACID_SLEEP5 (Offset 0x0487) */ -+ -+#define BIT_SHIFT_MACID127_120_PKTSLEEP 0 -+#define BIT_MASK_MACID127_120_PKTSLEEP 0xff -+#define BIT_MACID127_120_PKTSLEEP(x) \ -+ (((x) & BIT_MASK_MACID127_120_PKTSLEEP) \ -+ << BIT_SHIFT_MACID127_120_PKTSLEEP) -+#define BITS_MACID127_120_PKTSLEEP \ -+ (BIT_MASK_MACID127_120_PKTSLEEP << BIT_SHIFT_MACID127_120_PKTSLEEP) -+#define BIT_CLEAR_MACID127_120_PKTSLEEP(x) ((x) & (~BITS_MACID127_120_PKTSLEEP)) -+#define BIT_GET_MACID127_120_PKTSLEEP(x) \ -+ (((x) >> BIT_SHIFT_MACID127_120_PKTSLEEP) & \ -+ BIT_MASK_MACID127_120_PKTSLEEP) -+#define BIT_SET_MACID127_120_PKTSLEEP(x, v) \ -+ (BIT_CLEAR_MACID127_120_PKTSLEEP(x) | BIT_MACID127_120_PKTSLEEP(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_SC1 (Offset 0x0487) */ -+ -+#define BIT_SHIFT_TXSC_80M 0 -+#define BIT_MASK_TXSC_80M 0xf -+#define BIT_TXSC_80M(x) (((x) & BIT_MASK_TXSC_80M) << BIT_SHIFT_TXSC_80M) -+#define BITS_TXSC_80M (BIT_MASK_TXSC_80M << BIT_SHIFT_TXSC_80M) -+#define BIT_CLEAR_TXSC_80M(x) ((x) & (~BITS_TXSC_80M)) -+#define BIT_GET_TXSC_80M(x) (((x) >> BIT_SHIFT_TXSC_80M) & BIT_MASK_TXSC_80M) -+#define BIT_SET_TXSC_80M(x, v) (BIT_CLEAR_TXSC_80M(x) | BIT_TXSC_80M(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MACID_SLEEP1 (Offset 0x0488) */ -+ -+#define BIT_SHIFT_MACID63_32_PKTSLEEP 0 -+#define BIT_MASK_MACID63_32_PKTSLEEP 0xffffffffL -+#define BIT_MACID63_32_PKTSLEEP(x) \ -+ (((x) & BIT_MASK_MACID63_32_PKTSLEEP) << BIT_SHIFT_MACID63_32_PKTSLEEP) -+#define BITS_MACID63_32_PKTSLEEP \ -+ (BIT_MASK_MACID63_32_PKTSLEEP << BIT_SHIFT_MACID63_32_PKTSLEEP) -+#define BIT_CLEAR_MACID63_32_PKTSLEEP(x) ((x) & (~BITS_MACID63_32_PKTSLEEP)) -+#define BIT_GET_MACID63_32_PKTSLEEP(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_PKTSLEEP) & BIT_MASK_MACID63_32_PKTSLEEP) -+#define BIT_SET_MACID63_32_PKTSLEEP(x, v) \ -+ (BIT_CLEAR_MACID63_32_PKTSLEEP(x) | BIT_MACID63_32_PKTSLEEP(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ARFR2_V1 (Offset 0x048C) */ -+ -+#define BIT_SHIFT_ARFR2_V1 0 -+#define BIT_MASK_ARFR2_V1 0xffffffffffffffffL -+#define BIT_ARFR2_V1(x) (((x) & BIT_MASK_ARFR2_V1) << BIT_SHIFT_ARFR2_V1) -+#define BITS_ARFR2_V1 (BIT_MASK_ARFR2_V1 << BIT_SHIFT_ARFR2_V1) -+#define BIT_CLEAR_ARFR2_V1(x) ((x) & (~BITS_ARFR2_V1)) -+#define BIT_GET_ARFR2_V1(x) (((x) >> BIT_SHIFT_ARFR2_V1) & BIT_MASK_ARFR2_V1) -+#define BIT_SET_ARFR2_V1(x, v) (BIT_CLEAR_ARFR2_V1(x) | BIT_ARFR2_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ARFR2 (Offset 0x048C) */ -+ -+#define BIT_SHIFT_ARFRL2 0 -+#define BIT_MASK_ARFRL2 0xffffffffL -+#define BIT_ARFRL2(x) (((x) & BIT_MASK_ARFRL2) << BIT_SHIFT_ARFRL2) -+#define BITS_ARFRL2 (BIT_MASK_ARFRL2 << BIT_SHIFT_ARFRL2) -+#define BIT_CLEAR_ARFRL2(x) ((x) & (~BITS_ARFRL2)) -+#define BIT_GET_ARFRL2(x) (((x) >> BIT_SHIFT_ARFRL2) & BIT_MASK_ARFRL2) -+#define BIT_SET_ARFRL2(x, v) (BIT_CLEAR_ARFRL2(x) | BIT_ARFRL2(v)) -+ -+/* 2 REG_ARFRH2 (Offset 0x0490) */ -+ -+#define BIT_SHIFT_ARFRH2 0 -+#define BIT_MASK_ARFRH2 0xffffffffL -+#define BIT_ARFRH2(x) (((x) & BIT_MASK_ARFRH2) << BIT_SHIFT_ARFRH2) -+#define BITS_ARFRH2 (BIT_MASK_ARFRH2 << BIT_SHIFT_ARFRH2) -+#define BIT_CLEAR_ARFRH2(x) ((x) & (~BITS_ARFRH2)) -+#define BIT_GET_ARFRH2(x) (((x) >> BIT_SHIFT_ARFRH2) & BIT_MASK_ARFRH2) -+#define BIT_SET_ARFRH2(x, v) (BIT_CLEAR_ARFRH2(x) | BIT_ARFRH2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ARFR3_V1 (Offset 0x0494) */ -+ -+#define BIT_SHIFT_ARFR3_V1 0 -+#define BIT_MASK_ARFR3_V1 0xffffffffffffffffL -+#define BIT_ARFR3_V1(x) (((x) & BIT_MASK_ARFR3_V1) << BIT_SHIFT_ARFR3_V1) -+#define BITS_ARFR3_V1 (BIT_MASK_ARFR3_V1 << BIT_SHIFT_ARFR3_V1) -+#define BIT_CLEAR_ARFR3_V1(x) ((x) & (~BITS_ARFR3_V1)) -+#define BIT_GET_ARFR3_V1(x) (((x) >> BIT_SHIFT_ARFR3_V1) & BIT_MASK_ARFR3_V1) -+#define BIT_SET_ARFR3_V1(x, v) (BIT_CLEAR_ARFR3_V1(x) | BIT_ARFR3_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ARFR3_V1 (Offset 0x0494) */ -+ -+#define BIT_SHIFT_ARFRL3 0 -+#define BIT_MASK_ARFRL3 0xffffffffL -+#define BIT_ARFRL3(x) (((x) & BIT_MASK_ARFRL3) << BIT_SHIFT_ARFRL3) -+#define BITS_ARFRL3 (BIT_MASK_ARFRL3 << BIT_SHIFT_ARFRL3) -+#define BIT_CLEAR_ARFRL3(x) ((x) & (~BITS_ARFRL3)) -+#define BIT_GET_ARFRL3(x) (((x) >> BIT_SHIFT_ARFRL3) & BIT_MASK_ARFRL3) -+#define BIT_SET_ARFRL3(x, v) (BIT_CLEAR_ARFRL3(x) | BIT_ARFRL3(v)) -+ -+/* 2 REG_ARFRH3_V1 (Offset 0x0498) */ -+ -+#define BIT_SHIFT_ARFRH3 0 -+#define BIT_MASK_ARFRH3 0xffffffffL -+#define BIT_ARFRH3(x) (((x) & BIT_MASK_ARFRH3) << BIT_SHIFT_ARFRH3) -+#define BITS_ARFRH3 (BIT_MASK_ARFRH3 << BIT_SHIFT_ARFRH3) -+#define BIT_CLEAR_ARFRH3(x) ((x) & (~BITS_ARFRH3)) -+#define BIT_GET_ARFRH3(x) (((x) >> BIT_SHIFT_ARFRH3) & BIT_MASK_ARFRH3) -+#define BIT_SET_ARFRH3(x, v) (BIT_CLEAR_ARFRH3(x) | BIT_ARFRH3(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ARFR4 (Offset 0x049C) */ -+ -+#define BIT_SHIFT_ARFR4 0 -+#define BIT_MASK_ARFR4 0xffffffffffffffffL -+#define BIT_ARFR4(x) (((x) & BIT_MASK_ARFR4) << BIT_SHIFT_ARFR4) -+#define BITS_ARFR4 (BIT_MASK_ARFR4 << BIT_SHIFT_ARFR4) -+#define BIT_CLEAR_ARFR4(x) ((x) & (~BITS_ARFR4)) -+#define BIT_GET_ARFR4(x) (((x) >> BIT_SHIFT_ARFR4) & BIT_MASK_ARFR4) -+#define BIT_SET_ARFR4(x, v) (BIT_CLEAR_ARFR4(x) | BIT_ARFR4(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ARFR4 (Offset 0x049C) */ -+ -+#define BIT_SHIFT_ARFRL4 0 -+#define BIT_MASK_ARFRL4 0xffffffffL -+#define BIT_ARFRL4(x) (((x) & BIT_MASK_ARFRL4) << BIT_SHIFT_ARFRL4) -+#define BITS_ARFRL4 (BIT_MASK_ARFRL4 << BIT_SHIFT_ARFRL4) -+#define BIT_CLEAR_ARFRL4(x) ((x) & (~BITS_ARFRL4)) -+#define BIT_GET_ARFRL4(x) (((x) >> BIT_SHIFT_ARFRL4) & BIT_MASK_ARFRL4) -+#define BIT_SET_ARFRL4(x, v) (BIT_CLEAR_ARFRL4(x) | BIT_ARFRL4(v)) -+ -+/* 2 REG_ARFRH4 (Offset 0x04A0) */ -+ -+#define BIT_SHIFT_ARFRH4 0 -+#define BIT_MASK_ARFRH4 0xffffffffL -+#define BIT_ARFRH4(x) (((x) & BIT_MASK_ARFRH4) << BIT_SHIFT_ARFRH4) -+#define BITS_ARFRH4 (BIT_MASK_ARFRH4 << BIT_SHIFT_ARFRH4) -+#define BIT_CLEAR_ARFRH4(x) ((x) & (~BITS_ARFRH4)) -+#define BIT_GET_ARFRH4(x) (((x) >> BIT_SHIFT_ARFRH4) & BIT_MASK_ARFRH4) -+#define BIT_SET_ARFRH4(x, v) (BIT_CLEAR_ARFRH4(x) | BIT_ARFRH4(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ARFR5 (Offset 0x04A4) */ -+ -+#define BIT_SHIFT_ARFR5 0 -+#define BIT_MASK_ARFR5 0xffffffffffffffffL -+#define BIT_ARFR5(x) (((x) & BIT_MASK_ARFR5) << BIT_SHIFT_ARFR5) -+#define BITS_ARFR5 (BIT_MASK_ARFR5 << BIT_SHIFT_ARFR5) -+#define BIT_CLEAR_ARFR5(x) ((x) & (~BITS_ARFR5)) -+#define BIT_GET_ARFR5(x) (((x) >> BIT_SHIFT_ARFR5) & BIT_MASK_ARFR5) -+#define BIT_SET_ARFR5(x, v) (BIT_CLEAR_ARFR5(x) | BIT_ARFR5(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ARFR5 (Offset 0x04A4) */ -+ -+#define BIT_SHIFT_ARFRL5 0 -+#define BIT_MASK_ARFRL5 0xffffffffL -+#define BIT_ARFRL5(x) (((x) & BIT_MASK_ARFRL5) << BIT_SHIFT_ARFRL5) -+#define BITS_ARFRL5 (BIT_MASK_ARFRL5 << BIT_SHIFT_ARFRL5) -+#define BIT_CLEAR_ARFRL5(x) ((x) & (~BITS_ARFRL5)) -+#define BIT_GET_ARFRL5(x) (((x) >> BIT_SHIFT_ARFRL5) & BIT_MASK_ARFRL5) -+#define BIT_SET_ARFRL5(x, v) (BIT_CLEAR_ARFRL5(x) | BIT_ARFRL5(v)) -+ -+/* 2 REG_ARFRH5 (Offset 0x04A8) */ -+ -+#define BIT_SHIFT_ARFRH5 0 -+#define BIT_MASK_ARFRH5 0xffffffffL -+#define BIT_ARFRH5(x) (((x) & BIT_MASK_ARFRH5) << BIT_SHIFT_ARFRH5) -+#define BITS_ARFRH5 (BIT_MASK_ARFRH5 << BIT_SHIFT_ARFRH5) -+#define BIT_CLEAR_ARFRH5(x) ((x) & (~BITS_ARFRH5)) -+#define BIT_GET_ARFRH5(x) (((x) >> BIT_SHIFT_ARFRH5) & BIT_MASK_ARFRH5) -+#define BIT_SET_ARFRH5(x, v) (BIT_CLEAR_ARFRH5(x) | BIT_ARFRH5(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_RPTFIFO_RPTNUM_OPT BIT(31) -+ -+#define BIT_SHIFT_MISSED_RPT_NUM 28 -+#define BIT_MASK_MISSED_RPT_NUM 0x7 -+#define BIT_MISSED_RPT_NUM(x) \ -+ (((x) & BIT_MASK_MISSED_RPT_NUM) << BIT_SHIFT_MISSED_RPT_NUM) -+#define BITS_MISSED_RPT_NUM \ -+ (BIT_MASK_MISSED_RPT_NUM << BIT_SHIFT_MISSED_RPT_NUM) -+#define BIT_CLEAR_MISSED_RPT_NUM(x) ((x) & (~BITS_MISSED_RPT_NUM)) -+#define BIT_GET_MISSED_RPT_NUM(x) \ -+ (((x) >> BIT_SHIFT_MISSED_RPT_NUM) & BIT_MASK_MISSED_RPT_NUM) -+#define BIT_SET_MISSED_RPT_NUM(x, v) \ -+ (BIT_CLEAR_MISSED_RPT_NUM(x) | BIT_MISSED_RPT_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHCUT_PARSE_DASA BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_INDEX_15 24 -+#define BIT_MASK_INDEX_15 0xff -+#define BIT_INDEX_15(x) (((x) & BIT_MASK_INDEX_15) << BIT_SHIFT_INDEX_15) -+#define BITS_INDEX_15 (BIT_MASK_INDEX_15 << BIT_SHIFT_INDEX_15) -+#define BIT_CLEAR_INDEX_15(x) ((x) & (~BITS_INDEX_15)) -+#define BIT_GET_INDEX_15(x) (((x) >> BIT_SHIFT_INDEX_15) & BIT_MASK_INDEX_15) -+#define BIT_SET_INDEX_15(x, v) (BIT_CLEAR_INDEX_15(x) | BIT_INDEX_15(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_LOC_AMPDU_BURST_CTRL 24 -+#define BIT_MASK_LOC_AMPDU_BURST_CTRL 0xff -+#define BIT_LOC_AMPDU_BURST_CTRL(x) \ -+ (((x) & BIT_MASK_LOC_AMPDU_BURST_CTRL) \ -+ << BIT_SHIFT_LOC_AMPDU_BURST_CTRL) -+#define BITS_LOC_AMPDU_BURST_CTRL \ -+ (BIT_MASK_LOC_AMPDU_BURST_CTRL << BIT_SHIFT_LOC_AMPDU_BURST_CTRL) -+#define BIT_CLEAR_LOC_AMPDU_BURST_CTRL(x) ((x) & (~BITS_LOC_AMPDU_BURST_CTRL)) -+#define BIT_GET_LOC_AMPDU_BURST_CTRL(x) \ -+ (((x) >> BIT_SHIFT_LOC_AMPDU_BURST_CTRL) & \ -+ BIT_MASK_LOC_AMPDU_BURST_CTRL) -+#define BIT_SET_LOC_AMPDU_BURST_CTRL(x, v) \ -+ (BIT_CLEAR_LOC_AMPDU_BURST_CTRL(x) | BIT_LOC_AMPDU_BURST_CTRL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_LOC_SWPS_RPT_CTRL 24 -+#define BIT_MASK_LOC_SWPS_RPT_CTRL 0xff -+#define BIT_LOC_SWPS_RPT_CTRL(x) \ -+ (((x) & BIT_MASK_LOC_SWPS_RPT_CTRL) << BIT_SHIFT_LOC_SWPS_RPT_CTRL) -+#define BITS_LOC_SWPS_RPT_CTRL \ -+ (BIT_MASK_LOC_SWPS_RPT_CTRL << BIT_SHIFT_LOC_SWPS_RPT_CTRL) -+#define BIT_CLEAR_LOC_SWPS_RPT_CTRL(x) ((x) & (~BITS_LOC_SWPS_RPT_CTRL)) -+#define BIT_GET_LOC_SWPS_RPT_CTRL(x) \ -+ (((x) >> BIT_SHIFT_LOC_SWPS_RPT_CTRL) & BIT_MASK_LOC_SWPS_RPT_CTRL) -+#define BIT_SET_LOC_SWPS_RPT_CTRL(x, v) \ -+ (BIT_CLEAR_LOC_SWPS_RPT_CTRL(x) | BIT_LOC_SWPS_RPT_CTRL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHCUT_BYPASS BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_MACID_MURATE_OFFSET 24 -+#define BIT_MASK_MACID_MURATE_OFFSET 0xff -+#define BIT_MACID_MURATE_OFFSET(x) \ -+ (((x) & BIT_MASK_MACID_MURATE_OFFSET) << BIT_SHIFT_MACID_MURATE_OFFSET) -+#define BITS_MACID_MURATE_OFFSET \ -+ (BIT_MASK_MACID_MURATE_OFFSET << BIT_SHIFT_MACID_MURATE_OFFSET) -+#define BIT_CLEAR_MACID_MURATE_OFFSET(x) ((x) & (~BITS_MACID_MURATE_OFFSET)) -+#define BIT_GET_MACID_MURATE_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_MACID_MURATE_OFFSET) & BIT_MASK_MACID_MURATE_OFFSET) -+#define BIT_SET_MACID_MURATE_OFFSET(x, v) \ -+ (BIT_CLEAR_MACID_MURATE_OFFSET(x) | BIT_MACID_MURATE_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_R_MUTAB_TXRPT_OFFSET 24 -+#define BIT_MASK_R_MUTAB_TXRPT_OFFSET 0xff -+#define BIT_R_MUTAB_TXRPT_OFFSET(x) \ -+ (((x) & BIT_MASK_R_MUTAB_TXRPT_OFFSET) \ -+ << BIT_SHIFT_R_MUTAB_TXRPT_OFFSET) -+#define BITS_R_MUTAB_TXRPT_OFFSET \ -+ (BIT_MASK_R_MUTAB_TXRPT_OFFSET << BIT_SHIFT_R_MUTAB_TXRPT_OFFSET) -+#define BIT_CLEAR_R_MUTAB_TXRPT_OFFSET(x) ((x) & (~BITS_R_MUTAB_TXRPT_OFFSET)) -+#define BIT_GET_R_MUTAB_TXRPT_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_R_MUTAB_TXRPT_OFFSET) & \ -+ BIT_MASK_R_MUTAB_TXRPT_OFFSET) -+#define BIT_SET_R_MUTAB_TXRPT_OFFSET(x, v) \ -+ (BIT_CLEAR_R_MUTAB_TXRPT_OFFSET(x) | BIT_R_MUTAB_TXRPT_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_TXRPT_MISS_COUNT 17 -+#define BIT_MASK_TXRPT_MISS_COUNT 0x7 -+#define BIT_TXRPT_MISS_COUNT(x) \ -+ (((x) & BIT_MASK_TXRPT_MISS_COUNT) << BIT_SHIFT_TXRPT_MISS_COUNT) -+#define BITS_TXRPT_MISS_COUNT \ -+ (BIT_MASK_TXRPT_MISS_COUNT << BIT_SHIFT_TXRPT_MISS_COUNT) -+#define BIT_CLEAR_TXRPT_MISS_COUNT(x) ((x) & (~BITS_TXRPT_MISS_COUNT)) -+#define BIT_GET_TXRPT_MISS_COUNT(x) \ -+ (((x) >> BIT_SHIFT_TXRPT_MISS_COUNT) & BIT_MASK_TXRPT_MISS_COUNT) -+#define BIT_SET_TXRPT_MISS_COUNT(x, v) \ -+ (BIT_CLEAR_TXRPT_MISS_COUNT(x) | BIT_TXRPT_MISS_COUNT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_LOC_BCN_RPT 16 -+#define BIT_MASK_LOC_BCN_RPT 0xff -+#define BIT_LOC_BCN_RPT(x) \ -+ (((x) & BIT_MASK_LOC_BCN_RPT) << BIT_SHIFT_LOC_BCN_RPT) -+#define BITS_LOC_BCN_RPT (BIT_MASK_LOC_BCN_RPT << BIT_SHIFT_LOC_BCN_RPT) -+#define BIT_CLEAR_LOC_BCN_RPT(x) ((x) & (~BITS_LOC_BCN_RPT)) -+#define BIT_GET_LOC_BCN_RPT(x) \ -+ (((x) >> BIT_SHIFT_LOC_BCN_RPT) & BIT_MASK_LOC_BCN_RPT) -+#define BIT_SET_LOC_BCN_RPT(x, v) \ -+ (BIT_CLEAR_LOC_BCN_RPT(x) | BIT_LOC_BCN_RPT(v)) -+ -+#define BIT_SHIFT_INDEX_14 16 -+#define BIT_MASK_INDEX_14 0xff -+#define BIT_INDEX_14(x) (((x) & BIT_MASK_INDEX_14) << BIT_SHIFT_INDEX_14) -+#define BITS_INDEX_14 (BIT_MASK_INDEX_14 << BIT_SHIFT_INDEX_14) -+#define BIT_CLEAR_INDEX_14(x) ((x) & (~BITS_INDEX_14)) -+#define BIT_GET_INDEX_14(x) (((x) >> BIT_SHIFT_INDEX_14) & BIT_MASK_INDEX_14) -+#define BIT_SET_INDEX_14(x, v) (BIT_CLEAR_INDEX_14(x) | BIT_INDEX_14(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT__R_RPTFIFO_1K BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_RPTFIFO_SIZE_OPT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_MACID_SHCUT_OFFSET 16 -+#define BIT_MASK_MACID_SHCUT_OFFSET 0xff -+#define BIT_MACID_SHCUT_OFFSET(x) \ -+ (((x) & BIT_MASK_MACID_SHCUT_OFFSET) << BIT_SHIFT_MACID_SHCUT_OFFSET) -+#define BITS_MACID_SHCUT_OFFSET \ -+ (BIT_MASK_MACID_SHCUT_OFFSET << BIT_SHIFT_MACID_SHCUT_OFFSET) -+#define BIT_CLEAR_MACID_SHCUT_OFFSET(x) ((x) & (~BITS_MACID_SHCUT_OFFSET)) -+#define BIT_GET_MACID_SHCUT_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_MACID_SHCUT_OFFSET) & BIT_MASK_MACID_SHCUT_OFFSET) -+#define BIT_SET_MACID_SHCUT_OFFSET(x, v) \ -+ (BIT_CLEAR_MACID_SHCUT_OFFSET(x) | BIT_MACID_SHCUT_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_MACID_CTRL_OFFSET_V1 16 -+#define BIT_MASK_MACID_CTRL_OFFSET_V1 0x1ff -+#define BIT_MACID_CTRL_OFFSET_V1(x) \ -+ (((x) & BIT_MASK_MACID_CTRL_OFFSET_V1) \ -+ << BIT_SHIFT_MACID_CTRL_OFFSET_V1) -+#define BITS_MACID_CTRL_OFFSET_V1 \ -+ (BIT_MASK_MACID_CTRL_OFFSET_V1 << BIT_SHIFT_MACID_CTRL_OFFSET_V1) -+#define BIT_CLEAR_MACID_CTRL_OFFSET_V1(x) ((x) & (~BITS_MACID_CTRL_OFFSET_V1)) -+#define BIT_GET_MACID_CTRL_OFFSET_V1(x) \ -+ (((x) >> BIT_SHIFT_MACID_CTRL_OFFSET_V1) & \ -+ BIT_MASK_MACID_CTRL_OFFSET_V1) -+#define BIT_SET_MACID_CTRL_OFFSET_V1(x, v) \ -+ (BIT_CLEAR_MACID_CTRL_OFFSET_V1(x) | BIT_MACID_CTRL_OFFSET_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_LOC_TXRPT 8 -+#define BIT_MASK_LOC_TXRPT 0xff -+#define BIT_LOC_TXRPT(x) (((x) & BIT_MASK_LOC_TXRPT) << BIT_SHIFT_LOC_TXRPT) -+#define BITS_LOC_TXRPT (BIT_MASK_LOC_TXRPT << BIT_SHIFT_LOC_TXRPT) -+#define BIT_CLEAR_LOC_TXRPT(x) ((x) & (~BITS_LOC_TXRPT)) -+#define BIT_GET_LOC_TXRPT(x) (((x) >> BIT_SHIFT_LOC_TXRPT) & BIT_MASK_LOC_TXRPT) -+#define BIT_SET_LOC_TXRPT(x, v) (BIT_CLEAR_LOC_TXRPT(x) | BIT_LOC_TXRPT(v)) -+ -+#define BIT_SHIFT_INDEX_13 8 -+#define BIT_MASK_INDEX_13 0xff -+#define BIT_INDEX_13(x) (((x) & BIT_MASK_INDEX_13) << BIT_SHIFT_INDEX_13) -+#define BITS_INDEX_13 (BIT_MASK_INDEX_13 << BIT_SHIFT_INDEX_13) -+#define BIT_CLEAR_INDEX_13(x) ((x) & (~BITS_INDEX_13)) -+#define BIT_GET_INDEX_13(x) (((x) >> BIT_SHIFT_INDEX_13) & BIT_MASK_INDEX_13) -+#define BIT_SET_INDEX_13(x, v) (BIT_CLEAR_INDEX_13(x) | BIT_INDEX_13(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_MACID_CTRL_OFFSET 8 -+#define BIT_MASK_MACID_CTRL_OFFSET 0xff -+#define BIT_MACID_CTRL_OFFSET(x) \ -+ (((x) & BIT_MASK_MACID_CTRL_OFFSET) << BIT_SHIFT_MACID_CTRL_OFFSET) -+#define BITS_MACID_CTRL_OFFSET \ -+ (BIT_MASK_MACID_CTRL_OFFSET << BIT_SHIFT_MACID_CTRL_OFFSET) -+#define BIT_CLEAR_MACID_CTRL_OFFSET(x) ((x) & (~BITS_MACID_CTRL_OFFSET)) -+#define BIT_GET_MACID_CTRL_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_MACID_CTRL_OFFSET) & BIT_MASK_MACID_CTRL_OFFSET) -+#define BIT_SET_MACID_CTRL_OFFSET(x, v) \ -+ (BIT_CLEAR_MACID_CTRL_OFFSET(x) | BIT_MACID_CTRL_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_LOC_SRFF 0 -+#define BIT_MASK_LOC_SRFF 0xff -+#define BIT_LOC_SRFF(x) (((x) & BIT_MASK_LOC_SRFF) << BIT_SHIFT_LOC_SRFF) -+#define BITS_LOC_SRFF (BIT_MASK_LOC_SRFF << BIT_SHIFT_LOC_SRFF) -+#define BIT_CLEAR_LOC_SRFF(x) ((x) & (~BITS_LOC_SRFF)) -+#define BIT_GET_LOC_SRFF(x) (((x) >> BIT_SHIFT_LOC_SRFF) & BIT_MASK_LOC_SRFF) -+#define BIT_SET_LOC_SRFF(x, v) (BIT_CLEAR_LOC_SRFF(x) | BIT_LOC_SRFF(v)) -+ -+#define BIT_SHIFT_INDEX_12 0 -+#define BIT_MASK_INDEX_12 0xff -+#define BIT_INDEX_12(x) (((x) & BIT_MASK_INDEX_12) << BIT_SHIFT_INDEX_12) -+#define BITS_INDEX_12 (BIT_MASK_INDEX_12 << BIT_SHIFT_INDEX_12) -+#define BIT_CLEAR_INDEX_12(x) ((x) & (~BITS_INDEX_12)) -+#define BIT_GET_INDEX_12(x) (((x) >> BIT_SHIFT_INDEX_12) & BIT_MASK_INDEX_12) -+#define BIT_SET_INDEX_12(x, v) (BIT_CLEAR_INDEX_12(x) | BIT_INDEX_12(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_RA_TRY_RATE_AGG_LMT 0 -+#define BIT_MASK_RA_TRY_RATE_AGG_LMT 0x1f -+#define BIT_RA_TRY_RATE_AGG_LMT(x) \ -+ (((x) & BIT_MASK_RA_TRY_RATE_AGG_LMT) << BIT_SHIFT_RA_TRY_RATE_AGG_LMT) -+#define BITS_RA_TRY_RATE_AGG_LMT \ -+ (BIT_MASK_RA_TRY_RATE_AGG_LMT << BIT_SHIFT_RA_TRY_RATE_AGG_LMT) -+#define BIT_CLEAR_RA_TRY_RATE_AGG_LMT(x) ((x) & (~BITS_RA_TRY_RATE_AGG_LMT)) -+#define BIT_GET_RA_TRY_RATE_AGG_LMT(x) \ -+ (((x) >> BIT_SHIFT_RA_TRY_RATE_AGG_LMT) & BIT_MASK_RA_TRY_RATE_AGG_LMT) -+#define BIT_SET_RA_TRY_RATE_AGG_LMT(x, v) \ -+ (BIT_CLEAR_RA_TRY_RATE_AGG_LMT(x) | BIT_RA_TRY_RATE_AGG_LMT(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_AMPDU_TXRPT_OFFSET 0 -+#define BIT_MASK_AMPDU_TXRPT_OFFSET 0xff -+#define BIT_AMPDU_TXRPT_OFFSET(x) \ -+ (((x) & BIT_MASK_AMPDU_TXRPT_OFFSET) << BIT_SHIFT_AMPDU_TXRPT_OFFSET) -+#define BITS_AMPDU_TXRPT_OFFSET \ -+ (BIT_MASK_AMPDU_TXRPT_OFFSET << BIT_SHIFT_AMPDU_TXRPT_OFFSET) -+#define BIT_CLEAR_AMPDU_TXRPT_OFFSET(x) ((x) & (~BITS_AMPDU_TXRPT_OFFSET)) -+#define BIT_GET_AMPDU_TXRPT_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_TXRPT_OFFSET) & BIT_MASK_AMPDU_TXRPT_OFFSET) -+#define BIT_SET_AMPDU_TXRPT_OFFSET(x, v) \ -+ (BIT_CLEAR_AMPDU_TXRPT_OFFSET(x) | BIT_AMPDU_TXRPT_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXRPT_START_OFFSET (Offset 0x04AC) */ -+ -+#define BIT_SHIFT_AMPDU_TXRPT_OFFSET_V1 0 -+#define BIT_MASK_AMPDU_TXRPT_OFFSET_V1 0x1ff -+#define BIT_AMPDU_TXRPT_OFFSET_V1(x) \ -+ (((x) & BIT_MASK_AMPDU_TXRPT_OFFSET_V1) \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_V1) -+#define BITS_AMPDU_TXRPT_OFFSET_V1 \ -+ (BIT_MASK_AMPDU_TXRPT_OFFSET_V1 << BIT_SHIFT_AMPDU_TXRPT_OFFSET_V1) -+#define BIT_CLEAR_AMPDU_TXRPT_OFFSET_V1(x) ((x) & (~BITS_AMPDU_TXRPT_OFFSET_V1)) -+#define BIT_GET_AMPDU_TXRPT_OFFSET_V1(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_TXRPT_OFFSET_V1) & \ -+ BIT_MASK_AMPDU_TXRPT_OFFSET_V1) -+#define BIT_SET_AMPDU_TXRPT_OFFSET_V1(x, v) \ -+ (BIT_CLEAR_AMPDU_TXRPT_OFFSET_V1(x) | BIT_AMPDU_TXRPT_OFFSET_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_RRSR_CTS (Offset 0x04B0) */ -+ -+#define BIT_SHIFT_RRCTSSR_RSC 21 -+#define BIT_MASK_RRCTSSR_RSC 0x3 -+#define BIT_RRCTSSR_RSC(x) \ -+ (((x) & BIT_MASK_RRCTSSR_RSC) << BIT_SHIFT_RRCTSSR_RSC) -+#define BITS_RRCTSSR_RSC (BIT_MASK_RRCTSSR_RSC << BIT_SHIFT_RRCTSSR_RSC) -+#define BIT_CLEAR_RRCTSSR_RSC(x) ((x) & (~BITS_RRCTSSR_RSC)) -+#define BIT_GET_RRCTSSR_RSC(x) \ -+ (((x) >> BIT_SHIFT_RRCTSSR_RSC) & BIT_MASK_RRCTSSR_RSC) -+#define BIT_SET_RRCTSSR_RSC(x, v) \ -+ (BIT_CLEAR_RRCTSSR_RSC(x) | BIT_RRCTSSR_RSC(v)) -+ -+#define BIT_SHIFT_RRCTSSC_BITMAP 0 -+#define BIT_MASK_RRCTSSC_BITMAP 0xfffff -+#define BIT_RRCTSSC_BITMAP(x) \ -+ (((x) & BIT_MASK_RRCTSSC_BITMAP) << BIT_SHIFT_RRCTSSC_BITMAP) -+#define BITS_RRCTSSC_BITMAP \ -+ (BIT_MASK_RRCTSSC_BITMAP << BIT_SHIFT_RRCTSSC_BITMAP) -+#define BIT_CLEAR_RRCTSSC_BITMAP(x) ((x) & (~BITS_RRCTSSC_BITMAP)) -+#define BIT_GET_RRCTSSC_BITMAP(x) \ -+ (((x) >> BIT_SHIFT_RRCTSSC_BITMAP) & BIT_MASK_RRCTSSC_BITMAP) -+#define BIT_SET_RRCTSSC_BITMAP(x, v) \ -+ (BIT_CLEAR_RRCTSSC_BITMAP(x) | BIT_RRCTSSC_BITMAP(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_POWER_STAGE1 (Offset 0x04B4) */ -+ -+#define BIT_PTA_WL_PRI_MASK_CPU_MGQ BIT(31) -+#define BIT_PTA_WL_PRI_MASK_BCNQ BIT(30) -+#define BIT_PTA_WL_PRI_MASK_HIQ BIT(29) -+#define BIT_PTA_WL_PRI_MASK_MGQ BIT(28) -+#define BIT_PTA_WL_PRI_MASK_BK BIT(27) -+#define BIT_PTA_WL_PRI_MASK_BE BIT(26) -+#define BIT_PTA_WL_PRI_MASK_VI BIT(25) -+#define BIT_PTA_WL_PRI_MASK_VO BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_POWER_STAGE1 (Offset 0x04B4) */ -+ -+#define BIT_SHIFT_POWER_STAGE1 0 -+#define BIT_MASK_POWER_STAGE1 0xffffff -+#define BIT_POWER_STAGE1(x) \ -+ (((x) & BIT_MASK_POWER_STAGE1) << BIT_SHIFT_POWER_STAGE1) -+#define BITS_POWER_STAGE1 (BIT_MASK_POWER_STAGE1 << BIT_SHIFT_POWER_STAGE1) -+#define BIT_CLEAR_POWER_STAGE1(x) ((x) & (~BITS_POWER_STAGE1)) -+#define BIT_GET_POWER_STAGE1(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE1) & BIT_MASK_POWER_STAGE1) -+#define BIT_SET_POWER_STAGE1(x, v) \ -+ (BIT_CLEAR_POWER_STAGE1(x) | BIT_POWER_STAGE1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_POWER_STAGE2 (Offset 0x04B8) */ -+ -+#define BIT_SHIFT_EVTQ_TXRPT 27 -+#define BIT_MASK_EVTQ_TXRPT 0x7 -+#define BIT_EVTQ_TXRPT(x) (((x) & BIT_MASK_EVTQ_TXRPT) << BIT_SHIFT_EVTQ_TXRPT) -+#define BITS_EVTQ_TXRPT (BIT_MASK_EVTQ_TXRPT << BIT_SHIFT_EVTQ_TXRPT) -+#define BIT_CLEAR_EVTQ_TXRPT(x) ((x) & (~BITS_EVTQ_TXRPT)) -+#define BIT_GET_EVTQ_TXRPT(x) \ -+ (((x) >> BIT_SHIFT_EVTQ_TXRPT) & BIT_MASK_EVTQ_TXRPT) -+#define BIT_SET_EVTQ_TXRPT(x, v) (BIT_CLEAR_EVTQ_TXRPT(x) | BIT_EVTQ_TXRPT(v)) -+ -+#define BIT_PTA_WL_PRI_MASK_EVT BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_POWER_STAGE2 (Offset 0x04B8) */ -+ -+#define BIT__CTRL_PKT_POW_ADJ BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_POWER_STAGE2 (Offset 0x04B8) */ -+ -+#define BIT__R_CTRL_PKT_POW_ADJ BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_POWER_STAGE2 (Offset 0x04B8) */ -+ -+#define BIT_SHIFT_POWER_STAGE2 0 -+#define BIT_MASK_POWER_STAGE2 0xffffff -+#define BIT_POWER_STAGE2(x) \ -+ (((x) & BIT_MASK_POWER_STAGE2) << BIT_SHIFT_POWER_STAGE2) -+#define BITS_POWER_STAGE2 (BIT_MASK_POWER_STAGE2 << BIT_SHIFT_POWER_STAGE2) -+#define BIT_CLEAR_POWER_STAGE2(x) ((x) & (~BITS_POWER_STAGE2)) -+#define BIT_GET_POWER_STAGE2(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE2) & BIT_MASK_POWER_STAGE2) -+#define BIT_SET_POWER_STAGE2(x, v) \ -+ (BIT_CLEAR_POWER_STAGE2(x) | BIT_POWER_STAGE2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_SHIFT_EVTQ_HEAD 24 -+#define BIT_MASK_EVTQ_HEAD 0xff -+#define BIT_EVTQ_HEAD(x) (((x) & BIT_MASK_EVTQ_HEAD) << BIT_SHIFT_EVTQ_HEAD) -+#define BITS_EVTQ_HEAD (BIT_MASK_EVTQ_HEAD << BIT_SHIFT_EVTQ_HEAD) -+#define BIT_CLEAR_EVTQ_HEAD(x) ((x) & (~BITS_EVTQ_HEAD)) -+#define BIT_GET_EVTQ_HEAD(x) (((x) >> BIT_SHIFT_EVTQ_HEAD) & BIT_MASK_EVTQ_HEAD) -+#define BIT_SET_EVTQ_HEAD(x, v) (BIT_CLEAR_EVTQ_HEAD(x) | BIT_EVTQ_HEAD(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_SHIFT_PAD_NUM_THRES 24 -+#define BIT_MASK_PAD_NUM_THRES 0x3f -+#define BIT_PAD_NUM_THRES(x) \ -+ (((x) & BIT_MASK_PAD_NUM_THRES) << BIT_SHIFT_PAD_NUM_THRES) -+#define BITS_PAD_NUM_THRES (BIT_MASK_PAD_NUM_THRES << BIT_SHIFT_PAD_NUM_THRES) -+#define BIT_CLEAR_PAD_NUM_THRES(x) ((x) & (~BITS_PAD_NUM_THRES)) -+#define BIT_GET_PAD_NUM_THRES(x) \ -+ (((x) >> BIT_SHIFT_PAD_NUM_THRES) & BIT_MASK_PAD_NUM_THRES) -+#define BIT_SET_PAD_NUM_THRES(x, v) \ -+ (BIT_CLEAR_PAD_NUM_THRES(x) | BIT_PAD_NUM_THRES(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_R_DMA_THIS_QUEUE_BK BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_DMA_THIS_QUEUE_BK BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_R_DMA_THIS_QUEUE_BE BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_DMA_THIS_QUEUE_BE BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_R_DMA_THIS_QUEUE_VI BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_DMA_THIS_QUEUE_VI BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_R_DMA_THIS_QUEUE_VO BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_DMA_THIS_QUEUE_VO BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_SHIFT_R_TOTAL_LEN_TH 8 -+#define BIT_MASK_R_TOTAL_LEN_TH 0xfff -+#define BIT_R_TOTAL_LEN_TH(x) \ -+ (((x) & BIT_MASK_R_TOTAL_LEN_TH) << BIT_SHIFT_R_TOTAL_LEN_TH) -+#define BITS_R_TOTAL_LEN_TH \ -+ (BIT_MASK_R_TOTAL_LEN_TH << BIT_SHIFT_R_TOTAL_LEN_TH) -+#define BIT_CLEAR_R_TOTAL_LEN_TH(x) ((x) & (~BITS_R_TOTAL_LEN_TH)) -+#define BIT_GET_R_TOTAL_LEN_TH(x) \ -+ (((x) >> BIT_SHIFT_R_TOTAL_LEN_TH) & BIT_MASK_R_TOTAL_LEN_TH) -+#define BIT_SET_R_TOTAL_LEN_TH(x, v) \ -+ (BIT_CLEAR_R_TOTAL_LEN_TH(x) | BIT_R_TOTAL_LEN_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_SHIFT_TOTAL_LEN_TH 8 -+#define BIT_MASK_TOTAL_LEN_TH 0xfff -+#define BIT_TOTAL_LEN_TH(x) \ -+ (((x) & BIT_MASK_TOTAL_LEN_TH) << BIT_SHIFT_TOTAL_LEN_TH) -+#define BITS_TOTAL_LEN_TH (BIT_MASK_TOTAL_LEN_TH << BIT_SHIFT_TOTAL_LEN_TH) -+#define BIT_CLEAR_TOTAL_LEN_TH(x) ((x) & (~BITS_TOTAL_LEN_TH)) -+#define BIT_GET_TOTAL_LEN_TH(x) \ -+ (((x) >> BIT_SHIFT_TOTAL_LEN_TH) & BIT_MASK_TOTAL_LEN_TH) -+#define BIT_SET_TOTAL_LEN_TH(x, v) \ -+ (BIT_CLEAR_TOTAL_LEN_TH(x) | BIT_TOTAL_LEN_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_WEP_PRETX_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_EN_NEW_EARLY BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL (Offset 0x04BC) */ -+ -+#define BIT_PRE_TX_CMD BIT(6) -+ -+#define BIT_SHIFT_NUM_SCL_EN 4 -+#define BIT_MASK_NUM_SCL_EN 0x3 -+#define BIT_NUM_SCL_EN(x) (((x) & BIT_MASK_NUM_SCL_EN) << BIT_SHIFT_NUM_SCL_EN) -+#define BITS_NUM_SCL_EN (BIT_MASK_NUM_SCL_EN << BIT_SHIFT_NUM_SCL_EN) -+#define BIT_CLEAR_NUM_SCL_EN(x) ((x) & (~BITS_NUM_SCL_EN)) -+#define BIT_GET_NUM_SCL_EN(x) \ -+ (((x) >> BIT_SHIFT_NUM_SCL_EN) & BIT_MASK_NUM_SCL_EN) -+#define BIT_SET_NUM_SCL_EN(x, v) (BIT_CLEAR_NUM_SCL_EN(x) | BIT_NUM_SCL_EN(v)) -+ -+#define BIT_BK_EN BIT(3) -+#define BIT_BE_EN BIT(2) -+#define BIT_VI_EN BIT(1) -+#define BIT_VO_EN BIT(0) -+ -+/* 2 REG_PKT_LIFE_TIME (Offset 0x04C0) */ -+ -+#define BIT_SHIFT_PKT_LIFTIME_BEBK 16 -+#define BIT_MASK_PKT_LIFTIME_BEBK 0xffff -+#define BIT_PKT_LIFTIME_BEBK(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_BEBK) << BIT_SHIFT_PKT_LIFTIME_BEBK) -+#define BITS_PKT_LIFTIME_BEBK \ -+ (BIT_MASK_PKT_LIFTIME_BEBK << BIT_SHIFT_PKT_LIFTIME_BEBK) -+#define BIT_CLEAR_PKT_LIFTIME_BEBK(x) ((x) & (~BITS_PKT_LIFTIME_BEBK)) -+#define BIT_GET_PKT_LIFTIME_BEBK(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_BEBK) & BIT_MASK_PKT_LIFTIME_BEBK) -+#define BIT_SET_PKT_LIFTIME_BEBK(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_BEBK(x) | BIT_PKT_LIFTIME_BEBK(v)) -+ -+#define BIT_SHIFT_PKT_LIFTIME_VOVI 0 -+#define BIT_MASK_PKT_LIFTIME_VOVI 0xffff -+#define BIT_PKT_LIFTIME_VOVI(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_VOVI) << BIT_SHIFT_PKT_LIFTIME_VOVI) -+#define BITS_PKT_LIFTIME_VOVI \ -+ (BIT_MASK_PKT_LIFTIME_VOVI << BIT_SHIFT_PKT_LIFTIME_VOVI) -+#define BIT_CLEAR_PKT_LIFTIME_VOVI(x) ((x) & (~BITS_PKT_LIFTIME_VOVI)) -+#define BIT_GET_PKT_LIFTIME_VOVI(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_VOVI) & BIT_MASK_PKT_LIFTIME_VOVI) -+#define BIT_SET_PKT_LIFTIME_VOVI(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_VOVI(x) | BIT_PKT_LIFTIME_VOVI(v)) -+ -+/* 2 REG_STBC_SETTING (Offset 0x04C4) */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_L 4 -+#define BIT_MASK_CDEND_TXTIME_L 0xf -+#define BIT_CDEND_TXTIME_L(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_L) << BIT_SHIFT_CDEND_TXTIME_L) -+#define BITS_CDEND_TXTIME_L \ -+ (BIT_MASK_CDEND_TXTIME_L << BIT_SHIFT_CDEND_TXTIME_L) -+#define BIT_CLEAR_CDEND_TXTIME_L(x) ((x) & (~BITS_CDEND_TXTIME_L)) -+#define BIT_GET_CDEND_TXTIME_L(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_L) & BIT_MASK_CDEND_TXTIME_L) -+#define BIT_SET_CDEND_TXTIME_L(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_L(x) | BIT_CDEND_TXTIME_L(v)) -+ -+#define BIT_SHIFT_NESS 2 -+#define BIT_MASK_NESS 0x3 -+#define BIT_NESS(x) (((x) & BIT_MASK_NESS) << BIT_SHIFT_NESS) -+#define BITS_NESS (BIT_MASK_NESS << BIT_SHIFT_NESS) -+#define BIT_CLEAR_NESS(x) ((x) & (~BITS_NESS)) -+#define BIT_GET_NESS(x) (((x) >> BIT_SHIFT_NESS) & BIT_MASK_NESS) -+#define BIT_SET_NESS(x, v) (BIT_CLEAR_NESS(x) | BIT_NESS(v)) -+ -+#define BIT_SHIFT_STBC_CFEND 0 -+#define BIT_MASK_STBC_CFEND 0x3 -+#define BIT_STBC_CFEND(x) (((x) & BIT_MASK_STBC_CFEND) << BIT_SHIFT_STBC_CFEND) -+#define BITS_STBC_CFEND (BIT_MASK_STBC_CFEND << BIT_SHIFT_STBC_CFEND) -+#define BIT_CLEAR_STBC_CFEND(x) ((x) & (~BITS_STBC_CFEND)) -+#define BIT_GET_STBC_CFEND(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND) & BIT_MASK_STBC_CFEND) -+#define BIT_SET_STBC_CFEND(x, v) (BIT_CLEAR_STBC_CFEND(x) | BIT_STBC_CFEND(v)) -+ -+/* 2 REG_STBC_SETTING2 (Offset 0x04C5) */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_H 0 -+#define BIT_MASK_CDEND_TXTIME_H 0x1f -+#define BIT_CDEND_TXTIME_H(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_H) << BIT_SHIFT_CDEND_TXTIME_H) -+#define BITS_CDEND_TXTIME_H \ -+ (BIT_MASK_CDEND_TXTIME_H << BIT_SHIFT_CDEND_TXTIME_H) -+#define BIT_CLEAR_CDEND_TXTIME_H(x) ((x) & (~BITS_CDEND_TXTIME_H)) -+#define BIT_GET_CDEND_TXTIME_H(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_H) & BIT_MASK_CDEND_TXTIME_H) -+#define BIT_SET_CDEND_TXTIME_H(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_H(x) | BIT_CDEND_TXTIME_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_QUEUE_CTRL (Offset 0x04C6) */ -+ -+#define BIT_FORCE_RND_PRI BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_QUEUE_CTRL (Offset 0x04C6) */ -+ -+#define BIT_R_FORCE_RND_PRI BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_QUEUE_CTRL (Offset 0x04C6) */ -+ -+#define BIT_PTA_EDCCA_EN BIT(5) -+#define BIT_PTA_WL_TX_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_QUEUE_CTRL (Offset 0x04C6) */ -+ -+#define BIT_R_USE_DATA_BW BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_QUEUE_CTRL (Offset 0x04C6) */ -+ -+#define BIT_USE_DATA_BW BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_QUEUE_CTRL (Offset 0x04C6) */ -+ -+#define BIT_TRI_PKT_INT_MODE1 BIT(2) -+#define BIT_TRI_PKT_INT_MODE0 BIT(1) -+#define BIT_ACQ_MODE_SEL BIT(0) -+ -+/* 2 REG_SINGLE_AMPDU_CTRL (Offset 0x04C7) */ -+ -+#define BIT_EN_SINGLE_APMDU BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SINGLE_AMPDU_CTRL (Offset 0x04C7) */ -+ -+#define BIT_SHIFT_SNDTX_MAXTIME 0 -+#define BIT_MASK_SNDTX_MAXTIME 0x7f -+#define BIT_SNDTX_MAXTIME(x) \ -+ (((x) & BIT_MASK_SNDTX_MAXTIME) << BIT_SHIFT_SNDTX_MAXTIME) -+#define BITS_SNDTX_MAXTIME (BIT_MASK_SNDTX_MAXTIME << BIT_SHIFT_SNDTX_MAXTIME) -+#define BIT_CLEAR_SNDTX_MAXTIME(x) ((x) & (~BITS_SNDTX_MAXTIME)) -+#define BIT_GET_SNDTX_MAXTIME(x) \ -+ (((x) >> BIT_SHIFT_SNDTX_MAXTIME) & BIT_MASK_SNDTX_MAXTIME) -+#define BIT_SET_SNDTX_MAXTIME(x, v) \ -+ (BIT_CLEAR_SNDTX_MAXTIME(x) | BIT_SNDTX_MAXTIME(v)) -+ -+/* 2 REG_PROT_MODE_CTRL (Offset 0x04C8) */ -+ -+#define BIT_SND_SIFS_TXDATA BIT(31) -+#define BIT_TX_SND_MATCH_MACID BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PROT_MODE_CTRL (Offset 0x04C8) */ -+ -+#define BIT_SHIFT_RTS_MAX_AGG_NUM 24 -+#define BIT_MASK_RTS_MAX_AGG_NUM 0x3f -+#define BIT_RTS_MAX_AGG_NUM(x) \ -+ (((x) & BIT_MASK_RTS_MAX_AGG_NUM) << BIT_SHIFT_RTS_MAX_AGG_NUM) -+#define BITS_RTS_MAX_AGG_NUM \ -+ (BIT_MASK_RTS_MAX_AGG_NUM << BIT_SHIFT_RTS_MAX_AGG_NUM) -+#define BIT_CLEAR_RTS_MAX_AGG_NUM(x) ((x) & (~BITS_RTS_MAX_AGG_NUM)) -+#define BIT_GET_RTS_MAX_AGG_NUM(x) \ -+ (((x) >> BIT_SHIFT_RTS_MAX_AGG_NUM) & BIT_MASK_RTS_MAX_AGG_NUM) -+#define BIT_SET_RTS_MAX_AGG_NUM(x, v) \ -+ (BIT_CLEAR_RTS_MAX_AGG_NUM(x) | BIT_RTS_MAX_AGG_NUM(v)) -+ -+#define BIT_SHIFT_MAX_AGG_NUM 16 -+#define BIT_MASK_MAX_AGG_NUM 0x3f -+#define BIT_MAX_AGG_NUM(x) \ -+ (((x) & BIT_MASK_MAX_AGG_NUM) << BIT_SHIFT_MAX_AGG_NUM) -+#define BITS_MAX_AGG_NUM (BIT_MASK_MAX_AGG_NUM << BIT_SHIFT_MAX_AGG_NUM) -+#define BIT_CLEAR_MAX_AGG_NUM(x) ((x) & (~BITS_MAX_AGG_NUM)) -+#define BIT_GET_MAX_AGG_NUM(x) \ -+ (((x) >> BIT_SHIFT_MAX_AGG_NUM) & BIT_MASK_MAX_AGG_NUM) -+#define BIT_SET_MAX_AGG_NUM(x, v) \ -+ (BIT_CLEAR_MAX_AGG_NUM(x) | BIT_MAX_AGG_NUM(v)) -+ -+#define BIT_SHIFT_RTS_TXTIME_TH 8 -+#define BIT_MASK_RTS_TXTIME_TH 0xff -+#define BIT_RTS_TXTIME_TH(x) \ -+ (((x) & BIT_MASK_RTS_TXTIME_TH) << BIT_SHIFT_RTS_TXTIME_TH) -+#define BITS_RTS_TXTIME_TH (BIT_MASK_RTS_TXTIME_TH << BIT_SHIFT_RTS_TXTIME_TH) -+#define BIT_CLEAR_RTS_TXTIME_TH(x) ((x) & (~BITS_RTS_TXTIME_TH)) -+#define BIT_GET_RTS_TXTIME_TH(x) \ -+ (((x) >> BIT_SHIFT_RTS_TXTIME_TH) & BIT_MASK_RTS_TXTIME_TH) -+#define BIT_SET_RTS_TXTIME_TH(x, v) \ -+ (BIT_CLEAR_RTS_TXTIME_TH(x) | BIT_RTS_TXTIME_TH(v)) -+ -+#define BIT_SHIFT_RTS_LEN_TH 0 -+#define BIT_MASK_RTS_LEN_TH 0xff -+#define BIT_RTS_LEN_TH(x) (((x) & BIT_MASK_RTS_LEN_TH) << BIT_SHIFT_RTS_LEN_TH) -+#define BITS_RTS_LEN_TH (BIT_MASK_RTS_LEN_TH << BIT_SHIFT_RTS_LEN_TH) -+#define BIT_CLEAR_RTS_LEN_TH(x) ((x) & (~BITS_RTS_LEN_TH)) -+#define BIT_GET_RTS_LEN_TH(x) \ -+ (((x) >> BIT_SHIFT_RTS_LEN_TH) & BIT_MASK_RTS_LEN_TH) -+#define BIT_SET_RTS_LEN_TH(x, v) (BIT_CLEAR_RTS_LEN_TH(x) | BIT_RTS_LEN_TH(v)) -+ -+/* 2 REG_BAR_MODE_CTRL (Offset 0x04CC) */ -+ -+#define BIT_SHIFT_BAR_RTY_LMT 16 -+#define BIT_MASK_BAR_RTY_LMT 0x3 -+#define BIT_BAR_RTY_LMT(x) \ -+ (((x) & BIT_MASK_BAR_RTY_LMT) << BIT_SHIFT_BAR_RTY_LMT) -+#define BITS_BAR_RTY_LMT (BIT_MASK_BAR_RTY_LMT << BIT_SHIFT_BAR_RTY_LMT) -+#define BIT_CLEAR_BAR_RTY_LMT(x) ((x) & (~BITS_BAR_RTY_LMT)) -+#define BIT_GET_BAR_RTY_LMT(x) \ -+ (((x) >> BIT_SHIFT_BAR_RTY_LMT) & BIT_MASK_BAR_RTY_LMT) -+#define BIT_SET_BAR_RTY_LMT(x, v) \ -+ (BIT_CLEAR_BAR_RTY_LMT(x) | BIT_BAR_RTY_LMT(v)) -+ -+#define BIT_SHIFT_BAR_PKT_TXTIME_TH 8 -+#define BIT_MASK_BAR_PKT_TXTIME_TH 0xff -+#define BIT_BAR_PKT_TXTIME_TH(x) \ -+ (((x) & BIT_MASK_BAR_PKT_TXTIME_TH) << BIT_SHIFT_BAR_PKT_TXTIME_TH) -+#define BITS_BAR_PKT_TXTIME_TH \ -+ (BIT_MASK_BAR_PKT_TXTIME_TH << BIT_SHIFT_BAR_PKT_TXTIME_TH) -+#define BIT_CLEAR_BAR_PKT_TXTIME_TH(x) ((x) & (~BITS_BAR_PKT_TXTIME_TH)) -+#define BIT_GET_BAR_PKT_TXTIME_TH(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKT_TXTIME_TH) & BIT_MASK_BAR_PKT_TXTIME_TH) -+#define BIT_SET_BAR_PKT_TXTIME_TH(x, v) \ -+ (BIT_CLEAR_BAR_PKT_TXTIME_TH(x) | BIT_BAR_PKT_TXTIME_TH(v)) -+ -+#define BIT_BAR_EN_V1 BIT(6) -+ -+#define BIT_SHIFT_BAR_PKTNUM_TH_V1 0 -+#define BIT_MASK_BAR_PKTNUM_TH_V1 0x3f -+#define BIT_BAR_PKTNUM_TH_V1(x) \ -+ (((x) & BIT_MASK_BAR_PKTNUM_TH_V1) << BIT_SHIFT_BAR_PKTNUM_TH_V1) -+#define BITS_BAR_PKTNUM_TH_V1 \ -+ (BIT_MASK_BAR_PKTNUM_TH_V1 << BIT_SHIFT_BAR_PKTNUM_TH_V1) -+#define BIT_CLEAR_BAR_PKTNUM_TH_V1(x) ((x) & (~BITS_BAR_PKTNUM_TH_V1)) -+#define BIT_GET_BAR_PKTNUM_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKTNUM_TH_V1) & BIT_MASK_BAR_PKTNUM_TH_V1) -+#define BIT_SET_BAR_PKTNUM_TH_V1(x, v) \ -+ (BIT_CLEAR_BAR_PKTNUM_TH_V1(x) | BIT_BAR_PKTNUM_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RA_TRY_RATE_AGG_LMT (Offset 0x04CF) */ -+ -+#define BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1 0 -+#define BIT_MASK_RA_TRY_RATE_AGG_LMT_V1 0x3f -+#define BIT_RA_TRY_RATE_AGG_LMT_V1(x) \ -+ (((x) & BIT_MASK_RA_TRY_RATE_AGG_LMT_V1) \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1) -+#define BITS_RA_TRY_RATE_AGG_LMT_V1 \ -+ (BIT_MASK_RA_TRY_RATE_AGG_LMT_V1 << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1) -+#define BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1(x) \ -+ ((x) & (~BITS_RA_TRY_RATE_AGG_LMT_V1)) -+#define BIT_GET_RA_TRY_RATE_AGG_LMT_V1(x) \ -+ (((x) >> BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1) & \ -+ BIT_MASK_RA_TRY_RATE_AGG_LMT_V1) -+#define BIT_SET_RA_TRY_RATE_AGG_LMT_V1(x, v) \ -+ (BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1(x) | BIT_RA_TRY_RATE_AGG_LMT_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MACID_SLEEP_CTRL (Offset 0x04D0) */ -+ -+#define BIT_SHIFT_DEBUG_PROTOCOL 24 -+#define BIT_MASK_DEBUG_PROTOCOL 0xff -+#define BIT_DEBUG_PROTOCOL(x) \ -+ (((x) & BIT_MASK_DEBUG_PROTOCOL) << BIT_SHIFT_DEBUG_PROTOCOL) -+#define BITS_DEBUG_PROTOCOL \ -+ (BIT_MASK_DEBUG_PROTOCOL << BIT_SHIFT_DEBUG_PROTOCOL) -+#define BIT_CLEAR_DEBUG_PROTOCOL(x) ((x) & (~BITS_DEBUG_PROTOCOL)) -+#define BIT_GET_DEBUG_PROTOCOL(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_PROTOCOL) & BIT_MASK_DEBUG_PROTOCOL) -+#define BIT_SET_DEBUG_PROTOCOL(x, v) \ -+ (BIT_CLEAR_DEBUG_PROTOCOL(x) | BIT_DEBUG_PROTOCOL(v)) -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_RSEL 16 -+#define BIT_MASK_BCNQ_PGBNDY_RSEL 0x7 -+#define BIT_BCNQ_PGBNDY_RSEL(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_RSEL) << BIT_SHIFT_BCNQ_PGBNDY_RSEL) -+#define BITS_BCNQ_PGBNDY_RSEL \ -+ (BIT_MASK_BCNQ_PGBNDY_RSEL << BIT_SHIFT_BCNQ_PGBNDY_RSEL) -+#define BIT_CLEAR_BCNQ_PGBNDY_RSEL(x) ((x) & (~BITS_BCNQ_PGBNDY_RSEL)) -+#define BIT_GET_BCNQ_PGBNDY_RSEL(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_RSEL) & BIT_MASK_BCNQ_PGBNDY_RSEL) -+#define BIT_SET_BCNQ_PGBNDY_RSEL(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_RSEL(x) | BIT_BCNQ_PGBNDY_RSEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MACID_SLEEP2 (Offset 0x04D0) */ -+ -+#define BIT_SHIFT_MACID95_64PKTSLEEP 0 -+#define BIT_MASK_MACID95_64PKTSLEEP 0xffffffffL -+#define BIT_MACID95_64PKTSLEEP(x) \ -+ (((x) & BIT_MASK_MACID95_64PKTSLEEP) << BIT_SHIFT_MACID95_64PKTSLEEP) -+#define BITS_MACID95_64PKTSLEEP \ -+ (BIT_MASK_MACID95_64PKTSLEEP << BIT_SHIFT_MACID95_64PKTSLEEP) -+#define BIT_CLEAR_MACID95_64PKTSLEEP(x) ((x) & (~BITS_MACID95_64PKTSLEEP)) -+#define BIT_GET_MACID95_64PKTSLEEP(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64PKTSLEEP) & BIT_MASK_MACID95_64PKTSLEEP) -+#define BIT_SET_MACID95_64PKTSLEEP(x, v) \ -+ (BIT_CLEAR_MACID95_64PKTSLEEP(x) | BIT_MACID95_64PKTSLEEP(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MACID_SLEEP_CTRL (Offset 0x04D0) */ -+ -+#define BIT_SHIFT_MACID_SLEEP_SEL 0 -+#define BIT_MASK_MACID_SLEEP_SEL 0x7 -+#define BIT_MACID_SLEEP_SEL(x) \ -+ (((x) & BIT_MASK_MACID_SLEEP_SEL) << BIT_SHIFT_MACID_SLEEP_SEL) -+#define BITS_MACID_SLEEP_SEL \ -+ (BIT_MASK_MACID_SLEEP_SEL << BIT_SHIFT_MACID_SLEEP_SEL) -+#define BIT_CLEAR_MACID_SLEEP_SEL(x) ((x) & (~BITS_MACID_SLEEP_SEL)) -+#define BIT_GET_MACID_SLEEP_SEL(x) \ -+ (((x) >> BIT_SHIFT_MACID_SLEEP_SEL) & BIT_MASK_MACID_SLEEP_SEL) -+#define BIT_SET_MACID_SLEEP_SEL(x, v) \ -+ (BIT_CLEAR_MACID_SLEEP_SEL(x) | BIT_MACID_SLEEP_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MACID_SLEEP (Offset 0x04D4) */ -+ -+#define BIT_SHIFT_MACID31_0_PKTSLEEP 0 -+#define BIT_MASK_MACID31_0_PKTSLEEP 0xffffffffL -+#define BIT_MACID31_0_PKTSLEEP(x) \ -+ (((x) & BIT_MASK_MACID31_0_PKTSLEEP) << BIT_SHIFT_MACID31_0_PKTSLEEP) -+#define BITS_MACID31_0_PKTSLEEP \ -+ (BIT_MASK_MACID31_0_PKTSLEEP << BIT_SHIFT_MACID31_0_PKTSLEEP) -+#define BIT_CLEAR_MACID31_0_PKTSLEEP(x) ((x) & (~BITS_MACID31_0_PKTSLEEP)) -+#define BIT_GET_MACID31_0_PKTSLEEP(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_PKTSLEEP) & BIT_MASK_MACID31_0_PKTSLEEP) -+#define BIT_SET_MACID31_0_PKTSLEEP(x, v) \ -+ (BIT_CLEAR_MACID31_0_PKTSLEEP(x) | BIT_MACID31_0_PKTSLEEP(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MACID_SLEEP (Offset 0x04D4) */ -+ -+#define BIT_SHIFT_MACID31_0PKTSLEEP 0 -+#define BIT_MASK_MACID31_0PKTSLEEP 0xffffffffL -+#define BIT_MACID31_0PKTSLEEP(x) \ -+ (((x) & BIT_MASK_MACID31_0PKTSLEEP) << BIT_SHIFT_MACID31_0PKTSLEEP) -+#define BITS_MACID31_0PKTSLEEP \ -+ (BIT_MASK_MACID31_0PKTSLEEP << BIT_SHIFT_MACID31_0PKTSLEEP) -+#define BIT_CLEAR_MACID31_0PKTSLEEP(x) ((x) & (~BITS_MACID31_0PKTSLEEP)) -+#define BIT_GET_MACID31_0PKTSLEEP(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0PKTSLEEP) & BIT_MASK_MACID31_0PKTSLEEP) -+#define BIT_SET_MACID31_0PKTSLEEP(x, v) \ -+ (BIT_CLEAR_MACID31_0PKTSLEEP(x) | BIT_MACID31_0PKTSLEEP(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MACID_SLEEP_INFO (Offset 0x04D4) */ -+ -+#define BIT_SHIFT_MACID_SLEEP_INFO 0 -+#define BIT_MASK_MACID_SLEEP_INFO 0xffffffffL -+#define BIT_MACID_SLEEP_INFO(x) \ -+ (((x) & BIT_MASK_MACID_SLEEP_INFO) << BIT_SHIFT_MACID_SLEEP_INFO) -+#define BITS_MACID_SLEEP_INFO \ -+ (BIT_MASK_MACID_SLEEP_INFO << BIT_SHIFT_MACID_SLEEP_INFO) -+#define BIT_CLEAR_MACID_SLEEP_INFO(x) ((x) & (~BITS_MACID_SLEEP_INFO)) -+#define BIT_GET_MACID_SLEEP_INFO(x) \ -+ (((x) >> BIT_SHIFT_MACID_SLEEP_INFO) & BIT_MASK_MACID_SLEEP_INFO) -+#define BIT_SET_MACID_SLEEP_INFO(x, v) \ -+ (BIT_CLEAR_MACID_SLEEP_INFO(x) | BIT_MACID_SLEEP_INFO(v)) -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V3 0 -+#define BIT_MASK_PTCL_TOTAL_PG_V3 0x1fff -+#define BIT_PTCL_TOTAL_PG_V3(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V3) << BIT_SHIFT_PTCL_TOTAL_PG_V3) -+#define BITS_PTCL_TOTAL_PG_V3 \ -+ (BIT_MASK_PTCL_TOTAL_PG_V3 << BIT_SHIFT_PTCL_TOTAL_PG_V3) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V3(x) ((x) & (~BITS_PTCL_TOTAL_PG_V3)) -+#define BIT_GET_PTCL_TOTAL_PG_V3(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V3) & BIT_MASK_PTCL_TOTAL_PG_V3) -+#define BIT_SET_PTCL_TOTAL_PG_V3(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V3(x) | BIT_PTCL_TOTAL_PG_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HW_SEQ0 (Offset 0x04D8) */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ0 0 -+#define BIT_MASK_HW_SSN_SEQ0 0xfff -+#define BIT_HW_SSN_SEQ0(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ0) << BIT_SHIFT_HW_SSN_SEQ0) -+#define BITS_HW_SSN_SEQ0 (BIT_MASK_HW_SSN_SEQ0 << BIT_SHIFT_HW_SSN_SEQ0) -+#define BIT_CLEAR_HW_SSN_SEQ0(x) ((x) & (~BITS_HW_SSN_SEQ0)) -+#define BIT_GET_HW_SSN_SEQ0(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ0) & BIT_MASK_HW_SSN_SEQ0) -+#define BIT_SET_HW_SSN_SEQ0(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ0(x) | BIT_HW_SSN_SEQ0(v)) -+ -+/* 2 REG_HW_SEQ1 (Offset 0x04DA) */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ1 0 -+#define BIT_MASK_HW_SSN_SEQ1 0xfff -+#define BIT_HW_SSN_SEQ1(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ1) << BIT_SHIFT_HW_SSN_SEQ1) -+#define BITS_HW_SSN_SEQ1 (BIT_MASK_HW_SSN_SEQ1 << BIT_SHIFT_HW_SSN_SEQ1) -+#define BIT_CLEAR_HW_SSN_SEQ1(x) ((x) & (~BITS_HW_SSN_SEQ1)) -+#define BIT_GET_HW_SSN_SEQ1(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ1) & BIT_MASK_HW_SSN_SEQ1) -+#define BIT_SET_HW_SSN_SEQ1(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ1(x) | BIT_HW_SSN_SEQ1(v)) -+ -+/* 2 REG_HW_SEQ2 (Offset 0x04DC) */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ2 0 -+#define BIT_MASK_HW_SSN_SEQ2 0xfff -+#define BIT_HW_SSN_SEQ2(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ2) << BIT_SHIFT_HW_SSN_SEQ2) -+#define BITS_HW_SSN_SEQ2 (BIT_MASK_HW_SSN_SEQ2 << BIT_SHIFT_HW_SSN_SEQ2) -+#define BIT_CLEAR_HW_SSN_SEQ2(x) ((x) & (~BITS_HW_SSN_SEQ2)) -+#define BIT_GET_HW_SSN_SEQ2(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ2) & BIT_MASK_HW_SSN_SEQ2) -+#define BIT_SET_HW_SSN_SEQ2(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ2(x) | BIT_HW_SSN_SEQ2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HW_SEQ3 (Offset 0x04DE) */ -+ -+#define BIT_SHIFT_CSI_HWSSN_SEL 12 -+#define BIT_MASK_CSI_HWSSN_SEL 0x3 -+#define BIT_CSI_HWSSN_SEL(x) \ -+ (((x) & BIT_MASK_CSI_HWSSN_SEL) << BIT_SHIFT_CSI_HWSSN_SEL) -+#define BITS_CSI_HWSSN_SEL (BIT_MASK_CSI_HWSSN_SEL << BIT_SHIFT_CSI_HWSSN_SEL) -+#define BIT_CLEAR_CSI_HWSSN_SEL(x) ((x) & (~BITS_CSI_HWSSN_SEL)) -+#define BIT_GET_CSI_HWSSN_SEL(x) \ -+ (((x) >> BIT_SHIFT_CSI_HWSSN_SEL) & BIT_MASK_CSI_HWSSN_SEL) -+#define BIT_SET_CSI_HWSSN_SEL(x, v) \ -+ (BIT_CLEAR_CSI_HWSSN_SEL(x) | BIT_CSI_HWSSN_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HW_SEQ3 (Offset 0x04DE) */ -+ -+#define BIT_SHIFT_CSI_HWSEQ_SEL 12 -+#define BIT_MASK_CSI_HWSEQ_SEL 0x3 -+#define BIT_CSI_HWSEQ_SEL(x) \ -+ (((x) & BIT_MASK_CSI_HWSEQ_SEL) << BIT_SHIFT_CSI_HWSEQ_SEL) -+#define BITS_CSI_HWSEQ_SEL (BIT_MASK_CSI_HWSEQ_SEL << BIT_SHIFT_CSI_HWSEQ_SEL) -+#define BIT_CLEAR_CSI_HWSEQ_SEL(x) ((x) & (~BITS_CSI_HWSEQ_SEL)) -+#define BIT_GET_CSI_HWSEQ_SEL(x) \ -+ (((x) >> BIT_SHIFT_CSI_HWSEQ_SEL) & BIT_MASK_CSI_HWSEQ_SEL) -+#define BIT_SET_CSI_HWSEQ_SEL(x, v) \ -+ (BIT_CLEAR_CSI_HWSEQ_SEL(x) | BIT_CSI_HWSEQ_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HW_SEQ3 (Offset 0x04DE) */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ3 0 -+#define BIT_MASK_HW_SSN_SEQ3 0xfff -+#define BIT_HW_SSN_SEQ3(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ3) << BIT_SHIFT_HW_SSN_SEQ3) -+#define BITS_HW_SSN_SEQ3 (BIT_MASK_HW_SSN_SEQ3 << BIT_SHIFT_HW_SSN_SEQ3) -+#define BIT_CLEAR_HW_SSN_SEQ3(x) ((x) & (~BITS_HW_SSN_SEQ3)) -+#define BIT_GET_HW_SSN_SEQ3(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ3) & BIT_MASK_HW_SSN_SEQ3) -+#define BIT_SET_HW_SSN_SEQ3(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ3(x) | BIT_HW_SSN_SEQ3(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_CSI_SEQ (Offset 0x04DE) */ -+ -+#define BIT_SHIFT_HW_CSI_SEQ 0 -+#define BIT_MASK_HW_CSI_SEQ 0xfff -+#define BIT_HW_CSI_SEQ(x) (((x) & BIT_MASK_HW_CSI_SEQ) << BIT_SHIFT_HW_CSI_SEQ) -+#define BITS_HW_CSI_SEQ (BIT_MASK_HW_CSI_SEQ << BIT_SHIFT_HW_CSI_SEQ) -+#define BIT_CLEAR_HW_CSI_SEQ(x) ((x) & (~BITS_HW_CSI_SEQ)) -+#define BIT_GET_HW_CSI_SEQ(x) \ -+ (((x) >> BIT_SHIFT_HW_CSI_SEQ) & BIT_MASK_HW_CSI_SEQ) -+#define BIT_SET_HW_CSI_SEQ(x, v) (BIT_CLEAR_HW_CSI_SEQ(x) | BIT_HW_CSI_SEQ(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS_V1 (Offset 0x04E0) */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V1 2 -+#define BIT_MASK_PTCL_TOTAL_PG_V1 0x1fff -+#define BIT_PTCL_TOTAL_PG_V1(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V1) << BIT_SHIFT_PTCL_TOTAL_PG_V1) -+#define BITS_PTCL_TOTAL_PG_V1 \ -+ (BIT_MASK_PTCL_TOTAL_PG_V1 << BIT_SHIFT_PTCL_TOTAL_PG_V1) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V1(x) ((x) & (~BITS_PTCL_TOTAL_PG_V1)) -+#define BIT_GET_PTCL_TOTAL_PG_V1(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V1) & BIT_MASK_PTCL_TOTAL_PG_V1) -+#define BIT_SET_PTCL_TOTAL_PG_V1(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V1(x) | BIT_PTCL_TOTAL_PG_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS_V1 (Offset 0x04E0) */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V5 2 -+#define BIT_MASK_PTCL_TOTAL_PG_V5 0x1fff -+#define BIT_PTCL_TOTAL_PG_V5(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V5) << BIT_SHIFT_PTCL_TOTAL_PG_V5) -+#define BITS_PTCL_TOTAL_PG_V5 \ -+ (BIT_MASK_PTCL_TOTAL_PG_V5 << BIT_SHIFT_PTCL_TOTAL_PG_V5) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V5(x) ((x) & (~BITS_PTCL_TOTAL_PG_V5)) -+#define BIT_GET_PTCL_TOTAL_PG_V5(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V5) & BIT_MASK_PTCL_TOTAL_PG_V5) -+#define BIT_SET_PTCL_TOTAL_PG_V5(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V5(x) | BIT_PTCL_TOTAL_PG_V5(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS_V1 (Offset 0x04E0) */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V2 2 -+#define BIT_MASK_PTCL_TOTAL_PG_V2 0x3fff -+#define BIT_PTCL_TOTAL_PG_V2(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V2) << BIT_SHIFT_PTCL_TOTAL_PG_V2) -+#define BITS_PTCL_TOTAL_PG_V2 \ -+ (BIT_MASK_PTCL_TOTAL_PG_V2 << BIT_SHIFT_PTCL_TOTAL_PG_V2) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V2(x) ((x) & (~BITS_PTCL_TOTAL_PG_V2)) -+#define BIT_GET_PTCL_TOTAL_PG_V2(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V2) & BIT_MASK_PTCL_TOTAL_PG_V2) -+#define BIT_SET_PTCL_TOTAL_PG_V2(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V2(x) | BIT_PTCL_TOTAL_PG_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS (Offset 0x04E0) */ -+ -+#define BIT_TX_NULL_1 BIT(1) -+#define BIT_TX_NULL_0 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_MUARB_SEARCH_ERR BIT(14) -+#define BIT_MU_BFEN_ERR BIT(12) -+#define BIT_NDPA_DROPNULL_ERR BIT(11) -+#define BIT_NDPA_DROPPKT_ERR BIT(10) -+#define BIT_PTCL_PKYIN_ERR BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V4 8 -+#define BIT_MASK_PTCL_TOTAL_PG_V4 0xff -+#define BIT_PTCL_TOTAL_PG_V4(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V4) << BIT_SHIFT_PTCL_TOTAL_PG_V4) -+#define BITS_PTCL_TOTAL_PG_V4 \ -+ (BIT_MASK_PTCL_TOTAL_PG_V4 << BIT_SHIFT_PTCL_TOTAL_PG_V4) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V4(x) ((x) & (~BITS_PTCL_TOTAL_PG_V4)) -+#define BIT_GET_PTCL_TOTAL_PG_V4(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V4) & BIT_MASK_PTCL_TOTAL_PG_V4) -+#define BIT_SET_PTCL_TOTAL_PG_V4(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V4(x) | BIT_PTCL_TOTAL_PG_V4(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_PTCL_QSELCNL_ERR BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_PTCL_TOTAL_PG_8 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_PTCL_RATE_TABLE_INVALID BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS (Offset 0x04E2) */ -+ -+#define BIT_P2P_OFF_DISTX_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_PTCL_RATE_TABLE_INVALID_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_FTM_T2R_ERROR BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS (Offset 0x04E2) */ -+ -+#define BIT_PTCL_ERR0 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_TXTIMEOUT_ERR BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS (Offset 0x04E2) */ -+ -+#define BIT_PTCL_ERR1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_NULLPAGE_ERR BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS (Offset 0x04E2) */ -+ -+#define BIT_PTCL_ERR2 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_CONTENTION_ERR BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS (Offset 0x04E2) */ -+ -+#define BIT_PTCL_ERR3 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_HEADNULL_ERR BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS (Offset 0x04E2) */ -+ -+#define BIT_PTCL_ERR4 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_OVERFLOW_ERR BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS (Offset 0x04E2) */ -+ -+#define BIT_PTCL_ERR5 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1 (Offset 0x04E2) */ -+ -+#define BIT_QUEUE_INDEX_ERR BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS_EXTEND (Offset 0x04E3) */ -+ -+#define BIT_CLI3_TX_NULL_1 BIT(7) -+#define BIT_CLI3_TX_NULL_0 BIT(6) -+#define BIT_CLI2_TX_NULL_1 BIT(5) -+#define BIT_CLI2_TX_NULL_0 BIT(4) -+#define BIT_CLI1_TX_NULL_1 BIT(3) -+#define BIT_CLI1_TX_NULL_0 BIT(2) -+#define BIT_CLI0_TX_NULL_1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTCL_PKT_NUM (Offset 0x04E3) */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG 0 -+#define BIT_MASK_PTCL_TOTAL_PG 0xff -+#define BIT_PTCL_TOTAL_PG(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG) << BIT_SHIFT_PTCL_TOTAL_PG) -+#define BITS_PTCL_TOTAL_PG (BIT_MASK_PTCL_TOTAL_PG << BIT_SHIFT_PTCL_TOTAL_PG) -+#define BIT_CLEAR_PTCL_TOTAL_PG(x) ((x) & (~BITS_PTCL_TOTAL_PG)) -+#define BIT_GET_PTCL_TOTAL_PG(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG) & BIT_MASK_PTCL_TOTAL_PG) -+#define BIT_SET_PTCL_TOTAL_PG(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG(x) | BIT_PTCL_TOTAL_PG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS_EXTEND (Offset 0x04E3) */ -+ -+#define BIT_CLI0_TX_NULL_0 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_TRXRPT_MISS_CNT (Offset 0x04E3) */ -+ -+#define BIT_SHIFT_TRXRPT_MISS_CNT 0 -+#define BIT_MASK_TRXRPT_MISS_CNT 0x7 -+#define BIT_TRXRPT_MISS_CNT(x) \ -+ (((x) & BIT_MASK_TRXRPT_MISS_CNT) << BIT_SHIFT_TRXRPT_MISS_CNT) -+#define BITS_TRXRPT_MISS_CNT \ -+ (BIT_MASK_TRXRPT_MISS_CNT << BIT_SHIFT_TRXRPT_MISS_CNT) -+#define BIT_CLEAR_TRXRPT_MISS_CNT(x) ((x) & (~BITS_TRXRPT_MISS_CNT)) -+#define BIT_GET_TRXRPT_MISS_CNT(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_MISS_CNT) & BIT_MASK_TRXRPT_MISS_CNT) -+#define BIT_SET_TRXRPT_MISS_CNT(x, v) \ -+ (BIT_CLEAR_TRXRPT_MISS_CNT(x) | BIT_TRXRPT_MISS_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_VIDEO_ENHANCEMENT_FUN (Offset 0x04E4) */ -+ -+#define BIT_MAX_PRETX_AGGR_EN BIT(19) -+ -+#define BIT_SHIFT_MAX_PRETX_AGGR_TIME 8 -+#define BIT_MASK_MAX_PRETX_AGGR_TIME 0x7ff -+#define BIT_MAX_PRETX_AGGR_TIME(x) \ -+ (((x) & BIT_MASK_MAX_PRETX_AGGR_TIME) << BIT_SHIFT_MAX_PRETX_AGGR_TIME) -+#define BITS_MAX_PRETX_AGGR_TIME \ -+ (BIT_MASK_MAX_PRETX_AGGR_TIME << BIT_SHIFT_MAX_PRETX_AGGR_TIME) -+#define BIT_CLEAR_MAX_PRETX_AGGR_TIME(x) ((x) & (~BITS_MAX_PRETX_AGGR_TIME)) -+#define BIT_GET_MAX_PRETX_AGGR_TIME(x) \ -+ (((x) >> BIT_SHIFT_MAX_PRETX_AGGR_TIME) & BIT_MASK_MAX_PRETX_AGGR_TIME) -+#define BIT_SET_MAX_PRETX_AGGR_TIME(x, v) \ -+ (BIT_CLEAR_MAX_PRETX_AGGR_TIME(x) | BIT_MAX_PRETX_AGGR_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS_V2 (Offset 0x04E4) */ -+ -+#define BIT_HIQ_DROP BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_VIDEO_ENHANCEMENT_FUN (Offset 0x04E4) */ -+ -+#define BIT_HGQ_DEL_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS_V2 (Offset 0x04E4) */ -+ -+#define BIT_MGQ_DROP BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_VIDEO_ENHANCEMENT_FUN (Offset 0x04E4) */ -+ -+#define BIT_MGQ_DEL_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_VIDEO_ENHANCEMENT_FUN (Offset 0x04E4) */ -+ -+#define BIT_VIDEO_JUST_DROP BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS_V2 (Offset 0x04E4) */ -+ -+#define BIT_TX_NULL_1_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_VIDEO_ENHANCEMENT_FUN (Offset 0x04E4) */ -+ -+#define BIT_VIDEO_ENHANCEMENT_FUN_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_VIDEO_ENHANCEMENT_FUN (Offset 0x04E4) */ -+ -+#define BIT_SHIFT_MEDIUM_HAS_IDLE_TRIGGER 0 -+#define BIT_MASK_MEDIUM_HAS_IDLE_TRIGGER 0xff -+#define BIT_MEDIUM_HAS_IDLE_TRIGGER(x) \ -+ (((x) & BIT_MASK_MEDIUM_HAS_IDLE_TRIGGER) \ -+ << BIT_SHIFT_MEDIUM_HAS_IDLE_TRIGGER) -+#define BITS_MEDIUM_HAS_IDLE_TRIGGER \ -+ (BIT_MASK_MEDIUM_HAS_IDLE_TRIGGER << BIT_SHIFT_MEDIUM_HAS_IDLE_TRIGGER) -+#define BIT_CLEAR_MEDIUM_HAS_IDLE_TRIGGER(x) \ -+ ((x) & (~BITS_MEDIUM_HAS_IDLE_TRIGGER)) -+#define BIT_GET_MEDIUM_HAS_IDLE_TRIGGER(x) \ -+ (((x) >> BIT_SHIFT_MEDIUM_HAS_IDLE_TRIGGER) & \ -+ BIT_MASK_MEDIUM_HAS_IDLE_TRIGGER) -+#define BIT_SET_MEDIUM_HAS_IDLE_TRIGGER(x, v) \ -+ (BIT_CLEAR_MEDIUM_HAS_IDLE_TRIGGER(x) | BIT_MEDIUM_HAS_IDLE_TRIGGER(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS_V2 (Offset 0x04E4) */ -+ -+#define BIT_TX_NULL_0_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_PRECNT_CTRL (Offset 0x04E5) */ -+ -+#define BIT_SHIFT_COLLISION_DETECT_TIME 12 -+#define BIT_MASK_COLLISION_DETECT_TIME 0xf -+#define BIT_COLLISION_DETECT_TIME(x) \ -+ (((x) & BIT_MASK_COLLISION_DETECT_TIME) \ -+ << BIT_SHIFT_COLLISION_DETECT_TIME) -+#define BITS_COLLISION_DETECT_TIME \ -+ (BIT_MASK_COLLISION_DETECT_TIME << BIT_SHIFT_COLLISION_DETECT_TIME) -+#define BIT_CLEAR_COLLISION_DETECT_TIME(x) ((x) & (~BITS_COLLISION_DETECT_TIME)) -+#define BIT_GET_COLLISION_DETECT_TIME(x) \ -+ (((x) >> BIT_SHIFT_COLLISION_DETECT_TIME) & \ -+ BIT_MASK_COLLISION_DETECT_TIME) -+#define BIT_SET_COLLISION_DETECT_TIME(x, v) \ -+ (BIT_CLEAR_COLLISION_DETECT_TIME(x) | BIT_COLLISION_DETECT_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PRECNT_CTRL (Offset 0x04E5) */ -+ -+#define BIT_EN_PRECNT BIT(11) -+ -+#define BIT_SHIFT_PRECNT_TH 0 -+#define BIT_MASK_PRECNT_TH 0x7ff -+#define BIT_PRECNT_TH(x) (((x) & BIT_MASK_PRECNT_TH) << BIT_SHIFT_PRECNT_TH) -+#define BITS_PRECNT_TH (BIT_MASK_PRECNT_TH << BIT_SHIFT_PRECNT_TH) -+#define BIT_CLEAR_PRECNT_TH(x) ((x) & (~BITS_PRECNT_TH)) -+#define BIT_GET_PRECNT_TH(x) (((x) >> BIT_SHIFT_PRECNT_TH) & BIT_MASK_PRECNT_TH) -+#define BIT_SET_PRECNT_TH(x, v) (BIT_CLEAR_PRECNT_TH(x) | BIT_PRECNT_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_NULL_PKT_STATUS_EXTEND_V1 (Offset 0x04E7) */ -+ -+#define BIT_CLI3_TX_NULL_1_V1 BIT(7) -+#define BIT_CLI3_TX_NULL_0_V1 BIT(6) -+#define BIT_CLI2_TX_NULL_1_V1 BIT(5) -+#define BIT_CLI2_TX_NULL_0_V1 BIT(4) -+#define BIT_CLI1_TX_NULL_1_V1 BIT(3) -+#define BIT_CLI1_TX_NULL_0_V1 BIT(2) -+#define BIT_CLI0_TX_NULL_1_V1 BIT(1) -+#define BIT_CLI0_TX_NULL_0_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_POLLUTE_PKT_CNT (Offset 0x04E8) */ -+ -+#define BIT_SHIFT_BT_POLLUTE_PKT_CNT 0 -+#define BIT_MASK_BT_POLLUTE_PKT_CNT 0xffff -+#define BIT_BT_POLLUTE_PKT_CNT(x) \ -+ (((x) & BIT_MASK_BT_POLLUTE_PKT_CNT) << BIT_SHIFT_BT_POLLUTE_PKT_CNT) -+#define BITS_BT_POLLUTE_PKT_CNT \ -+ (BIT_MASK_BT_POLLUTE_PKT_CNT << BIT_SHIFT_BT_POLLUTE_PKT_CNT) -+#define BIT_CLEAR_BT_POLLUTE_PKT_CNT(x) ((x) & (~BITS_BT_POLLUTE_PKT_CNT)) -+#define BIT_GET_BT_POLLUTE_PKT_CNT(x) \ -+ (((x) >> BIT_SHIFT_BT_POLLUTE_PKT_CNT) & BIT_MASK_BT_POLLUTE_PKT_CNT) -+#define BIT_SET_BT_POLLUTE_PKT_CNT(x, v) \ -+ (BIT_CLEAR_BT_POLLUTE_PKT_CNT(x) | BIT_BT_POLLUTE_PKT_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DROP_NUM (Offset 0x04EC) */ -+ -+#define BIT_SHIFT_DROP_PKT_NUM 0 -+#define BIT_MASK_DROP_PKT_NUM 0xffff -+#define BIT_DROP_PKT_NUM(x) \ -+ (((x) & BIT_MASK_DROP_PKT_NUM) << BIT_SHIFT_DROP_PKT_NUM) -+#define BITS_DROP_PKT_NUM (BIT_MASK_DROP_PKT_NUM << BIT_SHIFT_DROP_PKT_NUM) -+#define BIT_CLEAR_DROP_PKT_NUM(x) ((x) & (~BITS_DROP_PKT_NUM)) -+#define BIT_GET_DROP_PKT_NUM(x) \ -+ (((x) >> BIT_SHIFT_DROP_PKT_NUM) & BIT_MASK_DROP_PKT_NUM) -+#define BIT_SET_DROP_PKT_NUM(x, v) \ -+ (BIT_CLEAR_DROP_PKT_NUM(x) | BIT_DROP_PKT_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PTCL_DBG_V1 (Offset 0x04EC) */ -+ -+#define BIT_SHIFT_PTCL_DBG 0 -+#define BIT_MASK_PTCL_DBG 0xffffffffL -+#define BIT_PTCL_DBG(x) (((x) & BIT_MASK_PTCL_DBG) << BIT_SHIFT_PTCL_DBG) -+#define BITS_PTCL_DBG (BIT_MASK_PTCL_DBG << BIT_SHIFT_PTCL_DBG) -+#define BIT_CLEAR_PTCL_DBG(x) ((x) & (~BITS_PTCL_DBG)) -+#define BIT_GET_PTCL_DBG(x) (((x) >> BIT_SHIFT_PTCL_DBG) & BIT_MASK_PTCL_DBG) -+#define BIT_SET_PTCL_DBG(x, v) (BIT_CLEAR_PTCL_DBG(x) | BIT_PTCL_DBG(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PTCL_TX_RPT (Offset 0x04F0) */ -+ -+#define BIT_SHIFT_AC_TX_RPT_INFO 0 -+#define BIT_MASK_AC_TX_RPT_INFO 0xffffffffffffffffL -+#define BIT_AC_TX_RPT_INFO(x) \ -+ (((x) & BIT_MASK_AC_TX_RPT_INFO) << BIT_SHIFT_AC_TX_RPT_INFO) -+#define BITS_AC_TX_RPT_INFO \ -+ (BIT_MASK_AC_TX_RPT_INFO << BIT_SHIFT_AC_TX_RPT_INFO) -+#define BIT_CLEAR_AC_TX_RPT_INFO(x) ((x) & (~BITS_AC_TX_RPT_INFO)) -+#define BIT_GET_AC_TX_RPT_INFO(x) \ -+ (((x) >> BIT_SHIFT_AC_TX_RPT_INFO) & BIT_MASK_AC_TX_RPT_INFO) -+#define BIT_SET_AC_TX_RPT_INFO(x, v) \ -+ (BIT_CLEAR_AC_TX_RPT_INFO(x) | BIT_AC_TX_RPT_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TX_RPT_INFO_L32 (Offset 0x04F0) */ -+ -+#define BIT_SHIFT_AC_TX_RPT_INFO_L32 0 -+#define BIT_MASK_AC_TX_RPT_INFO_L32 0xffffffffL -+#define BIT_AC_TX_RPT_INFO_L32(x) \ -+ (((x) & BIT_MASK_AC_TX_RPT_INFO_L32) << BIT_SHIFT_AC_TX_RPT_INFO_L32) -+#define BITS_AC_TX_RPT_INFO_L32 \ -+ (BIT_MASK_AC_TX_RPT_INFO_L32 << BIT_SHIFT_AC_TX_RPT_INFO_L32) -+#define BIT_CLEAR_AC_TX_RPT_INFO_L32(x) ((x) & (~BITS_AC_TX_RPT_INFO_L32)) -+#define BIT_GET_AC_TX_RPT_INFO_L32(x) \ -+ (((x) >> BIT_SHIFT_AC_TX_RPT_INFO_L32) & BIT_MASK_AC_TX_RPT_INFO_L32) -+#define BIT_SET_AC_TX_RPT_INFO_L32(x, v) \ -+ (BIT_CLEAR_AC_TX_RPT_INFO_L32(x) | BIT_AC_TX_RPT_INFO_L32(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TXOP_EXTRA_CTRL (Offset 0x04F0) */ -+ -+#define BIT_TXOP_EFFICIENCY_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BT_POLLUTE_PKTCNT (Offset 0x04F0) */ -+ -+#define BIT_SHIFT_BT_POLLUTE_PKTCNT 0 -+#define BIT_MASK_BT_POLLUTE_PKTCNT 0xffff -+#define BIT_BT_POLLUTE_PKTCNT(x) \ -+ (((x) & BIT_MASK_BT_POLLUTE_PKTCNT) << BIT_SHIFT_BT_POLLUTE_PKTCNT) -+#define BITS_BT_POLLUTE_PKTCNT \ -+ (BIT_MASK_BT_POLLUTE_PKTCNT << BIT_SHIFT_BT_POLLUTE_PKTCNT) -+#define BIT_CLEAR_BT_POLLUTE_PKTCNT(x) ((x) & (~BITS_BT_POLLUTE_PKTCNT)) -+#define BIT_GET_BT_POLLUTE_PKTCNT(x) \ -+ (((x) >> BIT_SHIFT_BT_POLLUTE_PKTCNT) & BIT_MASK_BT_POLLUTE_PKTCNT) -+#define BIT_SET_BT_POLLUTE_PKTCNT(x, v) \ -+ (BIT_CLEAR_BT_POLLUTE_PKTCNT(x) | BIT_BT_POLLUTE_PKTCNT(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPUMGQ_TIMER_CTRL2 (Offset 0x04F4) */ -+ -+#define BIT_SHIFT_TRI_HEAD_ADDR 16 -+#define BIT_MASK_TRI_HEAD_ADDR 0xfff -+#define BIT_TRI_HEAD_ADDR(x) \ -+ (((x) & BIT_MASK_TRI_HEAD_ADDR) << BIT_SHIFT_TRI_HEAD_ADDR) -+#define BITS_TRI_HEAD_ADDR (BIT_MASK_TRI_HEAD_ADDR << BIT_SHIFT_TRI_HEAD_ADDR) -+#define BIT_CLEAR_TRI_HEAD_ADDR(x) ((x) & (~BITS_TRI_HEAD_ADDR)) -+#define BIT_GET_TRI_HEAD_ADDR(x) \ -+ (((x) >> BIT_SHIFT_TRI_HEAD_ADDR) & BIT_MASK_TRI_HEAD_ADDR) -+#define BIT_SET_TRI_HEAD_ADDR(x, v) \ -+ (BIT_CLEAR_TRI_HEAD_ADDR(x) | BIT_TRI_HEAD_ADDR(v)) -+ -+#define BIT_DROP_TH_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TX_RPT_INFO_H32 (Offset 0x04F4) */ -+ -+#define BIT_SHIFT_AC_TX_RPT_INFO_H32 0 -+#define BIT_MASK_AC_TX_RPT_INFO_H32 0xffffffffL -+#define BIT_AC_TX_RPT_INFO_H32(x) \ -+ (((x) & BIT_MASK_AC_TX_RPT_INFO_H32) << BIT_SHIFT_AC_TX_RPT_INFO_H32) -+#define BITS_AC_TX_RPT_INFO_H32 \ -+ (BIT_MASK_AC_TX_RPT_INFO_H32 << BIT_SHIFT_AC_TX_RPT_INFO_H32) -+#define BIT_CLEAR_AC_TX_RPT_INFO_H32(x) ((x) & (~BITS_AC_TX_RPT_INFO_H32)) -+#define BIT_GET_AC_TX_RPT_INFO_H32(x) \ -+ (((x) >> BIT_SHIFT_AC_TX_RPT_INFO_H32) & BIT_MASK_AC_TX_RPT_INFO_H32) -+#define BIT_SET_AC_TX_RPT_INFO_H32(x, v) \ -+ (BIT_CLEAR_AC_TX_RPT_INFO_H32(x) | BIT_AC_TX_RPT_INFO_H32(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPUMGQ_TIMER_CTRL2 (Offset 0x04F4) */ -+ -+#define BIT_SHIFT_DROP_TH 0 -+#define BIT_MASK_DROP_TH 0xff -+#define BIT_DROP_TH(x) (((x) & BIT_MASK_DROP_TH) << BIT_SHIFT_DROP_TH) -+#define BITS_DROP_TH (BIT_MASK_DROP_TH << BIT_SHIFT_DROP_TH) -+#define BIT_CLEAR_DROP_TH(x) ((x) & (~BITS_DROP_TH)) -+#define BIT_GET_DROP_TH(x) (((x) >> BIT_SHIFT_DROP_TH) & BIT_MASK_DROP_TH) -+#define BIT_SET_DROP_TH(x, v) (BIT_CLEAR_DROP_TH(x) | BIT_DROP_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PTCL_DBG_OUT (Offset 0x04F8) */ -+ -+#define BIT_SHIFT_PTCL_DBG_OUT 0 -+#define BIT_MASK_PTCL_DBG_OUT 0xffffffffL -+#define BIT_PTCL_DBG_OUT(x) \ -+ (((x) & BIT_MASK_PTCL_DBG_OUT) << BIT_SHIFT_PTCL_DBG_OUT) -+#define BITS_PTCL_DBG_OUT (BIT_MASK_PTCL_DBG_OUT << BIT_SHIFT_PTCL_DBG_OUT) -+#define BIT_CLEAR_PTCL_DBG_OUT(x) ((x) & (~BITS_PTCL_DBG_OUT)) -+#define BIT_GET_PTCL_DBG_OUT(x) \ -+ (((x) >> BIT_SHIFT_PTCL_DBG_OUT) & BIT_MASK_PTCL_DBG_OUT) -+#define BIT_SET_PTCL_DBG_OUT(x, v) \ -+ (BIT_CLEAR_PTCL_DBG_OUT(x) | BIT_PTCL_DBG_OUT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_DUMMY_PAGE4 (Offset 0x04FC) */ -+ -+#define BIT_MOREDATA_CTRL2_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DUMMY_PAGE4 (Offset 0x04FC) */ -+ -+#define BIT_MOREDATA_CTRL2_EN_V2 BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+/* 2 REG_DUMMY_PAGE4 (Offset 0x04FC) */ -+ -+#define BIT_MOREDATA_CTRL1_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DUMMY_PAGE4 (Offset 0x04FC) */ -+ -+#define BIT_MOREDATA_CTRL1_EN_V2 BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DUMMY_PAGE4 (Offset 0x04FC) */ -+ -+#define BIT_EN_BCN_TRXRPT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DUMMY_PAGE4 (Offset 0x04FC) */ -+ -+#define BIT_PKTIN_MOREDATA_REPLACE_ENABLE BIT(16) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_DUMMY_PAGE4_V1 (Offset 0x04FC) */ -+ -+#define BIT_BCN_EN_EXTHWSEQ BIT(1) -+#define BIT_BCN_EN_HWSEQ BIT(0) -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION 0xffffffffffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION) -+#define BITS_R_MU_STA_GTAB_POSITION \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION << BIT_SHIFT_R_MU_STA_GTAB_POSITION) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION) -+#define BIT_SET_R_MU_STA_GTAB_POSITION(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION(x) | BIT_R_MU_STA_GTAB_POSITION(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MOREDATA (Offset 0x04FE) */ -+ -+#define BIT_MOREDATA_CTRL2_EN_V1 BIT(3) -+#define BIT_MOREDATA_CTRL1_EN_V1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DUMMY_PAGE4_1 (Offset 0x04FE) */ -+ -+#define BIT_EN_BCN_TRXRPT_V2 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MOREDATA (Offset 0x04FE) */ -+ -+#define BIT_PKTIN_MOREDATA_REPLACE_ENABLE_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_EDCA_VO_PARAM (Offset 0x0500) */ -+ -+#define BIT_SHIFT_TXOPLIMIT 16 -+#define BIT_MASK_TXOPLIMIT 0x7ff -+#define BIT_TXOPLIMIT(x) (((x) & BIT_MASK_TXOPLIMIT) << BIT_SHIFT_TXOPLIMIT) -+#define BITS_TXOPLIMIT (BIT_MASK_TXOPLIMIT << BIT_SHIFT_TXOPLIMIT) -+#define BIT_CLEAR_TXOPLIMIT(x) ((x) & (~BITS_TXOPLIMIT)) -+#define BIT_GET_TXOPLIMIT(x) (((x) >> BIT_SHIFT_TXOPLIMIT) & BIT_MASK_TXOPLIMIT) -+#define BIT_SET_TXOPLIMIT(x, v) (BIT_CLEAR_TXOPLIMIT(x) | BIT_TXOPLIMIT(v)) -+ -+#define BIT_SHIFT_CW 8 -+#define BIT_MASK_CW 0xff -+#define BIT_CW(x) (((x) & BIT_MASK_CW) << BIT_SHIFT_CW) -+#define BITS_CW (BIT_MASK_CW << BIT_SHIFT_CW) -+#define BIT_CLEAR_CW(x) ((x) & (~BITS_CW)) -+#define BIT_GET_CW(x) (((x) >> BIT_SHIFT_CW) & BIT_MASK_CW) -+#define BIT_SET_CW(x, v) (BIT_CLEAR_CW(x) | BIT_CW(v)) -+ -+#define BIT_SHIFT_AIFS 0 -+#define BIT_MASK_AIFS 0xff -+#define BIT_AIFS(x) (((x) & BIT_MASK_AIFS) << BIT_SHIFT_AIFS) -+#define BITS_AIFS (BIT_MASK_AIFS << BIT_SHIFT_AIFS) -+#define BIT_CLEAR_AIFS(x) ((x) & (~BITS_AIFS)) -+#define BIT_GET_AIFS(x) (((x) >> BIT_SHIFT_AIFS) & BIT_MASK_AIFS) -+#define BIT_SET_AIFS(x, v) (BIT_CLEAR_AIFS(x) | BIT_AIFS(v)) -+ -+/* 2 REG_BCNTCFG (Offset 0x0510) */ -+ -+#define BIT_SHIFT_BCNCW_MAX 12 -+#define BIT_MASK_BCNCW_MAX 0xf -+#define BIT_BCNCW_MAX(x) (((x) & BIT_MASK_BCNCW_MAX) << BIT_SHIFT_BCNCW_MAX) -+#define BITS_BCNCW_MAX (BIT_MASK_BCNCW_MAX << BIT_SHIFT_BCNCW_MAX) -+#define BIT_CLEAR_BCNCW_MAX(x) ((x) & (~BITS_BCNCW_MAX)) -+#define BIT_GET_BCNCW_MAX(x) (((x) >> BIT_SHIFT_BCNCW_MAX) & BIT_MASK_BCNCW_MAX) -+#define BIT_SET_BCNCW_MAX(x, v) (BIT_CLEAR_BCNCW_MAX(x) | BIT_BCNCW_MAX(v)) -+ -+#define BIT_SHIFT_BCNCW_MIN 8 -+#define BIT_MASK_BCNCW_MIN 0xf -+#define BIT_BCNCW_MIN(x) (((x) & BIT_MASK_BCNCW_MIN) << BIT_SHIFT_BCNCW_MIN) -+#define BITS_BCNCW_MIN (BIT_MASK_BCNCW_MIN << BIT_SHIFT_BCNCW_MIN) -+#define BIT_CLEAR_BCNCW_MIN(x) ((x) & (~BITS_BCNCW_MIN)) -+#define BIT_GET_BCNCW_MIN(x) (((x) >> BIT_SHIFT_BCNCW_MIN) & BIT_MASK_BCNCW_MIN) -+#define BIT_SET_BCNCW_MIN(x, v) (BIT_CLEAR_BCNCW_MIN(x) | BIT_BCNCW_MIN(v)) -+ -+#define BIT_SHIFT_BCNIFS 0 -+#define BIT_MASK_BCNIFS 0xff -+#define BIT_BCNIFS(x) (((x) & BIT_MASK_BCNIFS) << BIT_SHIFT_BCNIFS) -+#define BITS_BCNIFS (BIT_MASK_BCNIFS << BIT_SHIFT_BCNIFS) -+#define BIT_CLEAR_BCNIFS(x) ((x) & (~BITS_BCNIFS)) -+#define BIT_GET_BCNIFS(x) (((x) >> BIT_SHIFT_BCNIFS) & BIT_MASK_BCNIFS) -+#define BIT_SET_BCNIFS(x, v) (BIT_CLEAR_BCNIFS(x) | BIT_BCNIFS(v)) -+ -+/* 2 REG_PIFS (Offset 0x0512) */ -+ -+#define BIT_SHIFT_PIFS 0 -+#define BIT_MASK_PIFS 0xff -+#define BIT_PIFS(x) (((x) & BIT_MASK_PIFS) << BIT_SHIFT_PIFS) -+#define BITS_PIFS (BIT_MASK_PIFS << BIT_SHIFT_PIFS) -+#define BIT_CLEAR_PIFS(x) ((x) & (~BITS_PIFS)) -+#define BIT_GET_PIFS(x) (((x) >> BIT_SHIFT_PIFS) & BIT_MASK_PIFS) -+#define BIT_SET_PIFS(x, v) (BIT_CLEAR_PIFS(x) | BIT_PIFS(v)) -+ -+/* 2 REG_RDG_PIFS (Offset 0x0513) */ -+ -+#define BIT_SHIFT_RDG_PIFS 0 -+#define BIT_MASK_RDG_PIFS 0xff -+#define BIT_RDG_PIFS(x) (((x) & BIT_MASK_RDG_PIFS) << BIT_SHIFT_RDG_PIFS) -+#define BITS_RDG_PIFS (BIT_MASK_RDG_PIFS << BIT_SHIFT_RDG_PIFS) -+#define BIT_CLEAR_RDG_PIFS(x) ((x) & (~BITS_RDG_PIFS)) -+#define BIT_GET_RDG_PIFS(x) (((x) >> BIT_SHIFT_RDG_PIFS) & BIT_MASK_RDG_PIFS) -+#define BIT_SET_RDG_PIFS(x, v) (BIT_CLEAR_RDG_PIFS(x) | BIT_RDG_PIFS(v)) -+ -+/* 2 REG_SIFS (Offset 0x0514) */ -+ -+#define BIT_SHIFT_SIFS_OFDM_TRX 24 -+#define BIT_MASK_SIFS_OFDM_TRX 0xff -+#define BIT_SIFS_OFDM_TRX(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_TRX) << BIT_SHIFT_SIFS_OFDM_TRX) -+#define BITS_SIFS_OFDM_TRX (BIT_MASK_SIFS_OFDM_TRX << BIT_SHIFT_SIFS_OFDM_TRX) -+#define BIT_CLEAR_SIFS_OFDM_TRX(x) ((x) & (~BITS_SIFS_OFDM_TRX)) -+#define BIT_GET_SIFS_OFDM_TRX(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_TRX) & BIT_MASK_SIFS_OFDM_TRX) -+#define BIT_SET_SIFS_OFDM_TRX(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_TRX(x) | BIT_SIFS_OFDM_TRX(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_TRX 16 -+#define BIT_MASK_SIFS_CCK_TRX 0xff -+#define BIT_SIFS_CCK_TRX(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_TRX) << BIT_SHIFT_SIFS_CCK_TRX) -+#define BITS_SIFS_CCK_TRX (BIT_MASK_SIFS_CCK_TRX << BIT_SHIFT_SIFS_CCK_TRX) -+#define BIT_CLEAR_SIFS_CCK_TRX(x) ((x) & (~BITS_SIFS_CCK_TRX)) -+#define BIT_GET_SIFS_CCK_TRX(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_TRX) & BIT_MASK_SIFS_CCK_TRX) -+#define BIT_SET_SIFS_CCK_TRX(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_TRX(x) | BIT_SIFS_CCK_TRX(v)) -+ -+#define BIT_SHIFT_SIFS_OFDM_CTX 8 -+#define BIT_MASK_SIFS_OFDM_CTX 0xff -+#define BIT_SIFS_OFDM_CTX(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_CTX) << BIT_SHIFT_SIFS_OFDM_CTX) -+#define BITS_SIFS_OFDM_CTX (BIT_MASK_SIFS_OFDM_CTX << BIT_SHIFT_SIFS_OFDM_CTX) -+#define BIT_CLEAR_SIFS_OFDM_CTX(x) ((x) & (~BITS_SIFS_OFDM_CTX)) -+#define BIT_GET_SIFS_OFDM_CTX(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_CTX) & BIT_MASK_SIFS_OFDM_CTX) -+#define BIT_SET_SIFS_OFDM_CTX(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_CTX(x) | BIT_SIFS_OFDM_CTX(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_CTX 0 -+#define BIT_MASK_SIFS_CCK_CTX 0xff -+#define BIT_SIFS_CCK_CTX(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_CTX) << BIT_SHIFT_SIFS_CCK_CTX) -+#define BITS_SIFS_CCK_CTX (BIT_MASK_SIFS_CCK_CTX << BIT_SHIFT_SIFS_CCK_CTX) -+#define BIT_CLEAR_SIFS_CCK_CTX(x) ((x) & (~BITS_SIFS_CCK_CTX)) -+#define BIT_GET_SIFS_CCK_CTX(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_CTX) & BIT_MASK_SIFS_CCK_CTX) -+#define BIT_SET_SIFS_CCK_CTX(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_CTX(x) | BIT_SIFS_CCK_CTX(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TSFTR_SYN_OFFSET (Offset 0x0518) */ -+ -+#define BIT_SHIFT_TSFTR_SNC_OFFSET 0 -+#define BIT_MASK_TSFTR_SNC_OFFSET 0xffff -+#define BIT_TSFTR_SNC_OFFSET(x) \ -+ (((x) & BIT_MASK_TSFTR_SNC_OFFSET) << BIT_SHIFT_TSFTR_SNC_OFFSET) -+#define BITS_TSFTR_SNC_OFFSET \ -+ (BIT_MASK_TSFTR_SNC_OFFSET << BIT_SHIFT_TSFTR_SNC_OFFSET) -+#define BIT_CLEAR_TSFTR_SNC_OFFSET(x) ((x) & (~BITS_TSFTR_SNC_OFFSET)) -+#define BIT_GET_TSFTR_SNC_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_TSFTR_SNC_OFFSET) & BIT_MASK_TSFTR_SNC_OFFSET) -+#define BIT_SET_TSFTR_SNC_OFFSET(x, v) \ -+ (BIT_CLEAR_TSFTR_SNC_OFFSET(x) | BIT_TSFTR_SNC_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_AGGR_BREAK_TIME (Offset 0x051A) */ -+ -+#define BIT_SHIFT_AGGR_BK_TIME 0 -+#define BIT_MASK_AGGR_BK_TIME 0xff -+#define BIT_AGGR_BK_TIME(x) \ -+ (((x) & BIT_MASK_AGGR_BK_TIME) << BIT_SHIFT_AGGR_BK_TIME) -+#define BITS_AGGR_BK_TIME (BIT_MASK_AGGR_BK_TIME << BIT_SHIFT_AGGR_BK_TIME) -+#define BIT_CLEAR_AGGR_BK_TIME(x) ((x) & (~BITS_AGGR_BK_TIME)) -+#define BIT_GET_AGGR_BK_TIME(x) \ -+ (((x) >> BIT_SHIFT_AGGR_BK_TIME) & BIT_MASK_AGGR_BK_TIME) -+#define BIT_SET_AGGR_BK_TIME(x, v) \ -+ (BIT_CLEAR_AGGR_BK_TIME(x) | BIT_AGGR_BK_TIME(v)) -+ -+/* 2 REG_SLOT (Offset 0x051B) */ -+ -+#define BIT_SHIFT_SLOT 0 -+#define BIT_MASK_SLOT 0xff -+#define BIT_SLOT(x) (((x) & BIT_MASK_SLOT) << BIT_SHIFT_SLOT) -+#define BITS_SLOT (BIT_MASK_SLOT << BIT_SHIFT_SLOT) -+#define BIT_CLEAR_SLOT(x) ((x) & (~BITS_SLOT)) -+#define BIT_GET_SLOT(x) (((x) >> BIT_SHIFT_SLOT) & BIT_MASK_SLOT) -+#define BIT_SET_SLOT(x, v) (BIT_CLEAR_SLOT(x) | BIT_SLOT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_EDCA_CPUMGQ_PARAM (Offset 0x051C) */ -+ -+#define BIT_SHIFT_CW_V1 8 -+#define BIT_MASK_CW_V1 0xff -+#define BIT_CW_V1(x) (((x) & BIT_MASK_CW_V1) << BIT_SHIFT_CW_V1) -+#define BITS_CW_V1 (BIT_MASK_CW_V1 << BIT_SHIFT_CW_V1) -+#define BIT_CLEAR_CW_V1(x) ((x) & (~BITS_CW_V1)) -+#define BIT_GET_CW_V1(x) (((x) >> BIT_SHIFT_CW_V1) & BIT_MASK_CW_V1) -+#define BIT_SET_CW_V1(x, v) (BIT_CLEAR_CW_V1(x) | BIT_CW_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NOA_ON_ERLY_TIME (Offset 0x051C) */ -+ -+#define BIT_SHIFT__NOA_ON_ERLY_TIME 0 -+#define BIT_MASK__NOA_ON_ERLY_TIME 0xff -+#define BIT__NOA_ON_ERLY_TIME(x) \ -+ (((x) & BIT_MASK__NOA_ON_ERLY_TIME) << BIT_SHIFT__NOA_ON_ERLY_TIME) -+#define BITS__NOA_ON_ERLY_TIME \ -+ (BIT_MASK__NOA_ON_ERLY_TIME << BIT_SHIFT__NOA_ON_ERLY_TIME) -+#define BIT_CLEAR__NOA_ON_ERLY_TIME(x) ((x) & (~BITS__NOA_ON_ERLY_TIME)) -+#define BIT_GET__NOA_ON_ERLY_TIME(x) \ -+ (((x) >> BIT_SHIFT__NOA_ON_ERLY_TIME) & BIT_MASK__NOA_ON_ERLY_TIME) -+#define BIT_SET__NOA_ON_ERLY_TIME(x, v) \ -+ (BIT_CLEAR__NOA_ON_ERLY_TIME(x) | BIT__NOA_ON_ERLY_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_EDCA_CPUMGQ_PARAM (Offset 0x051C) */ -+ -+#define BIT_SHIFT_AIFS_V1 0 -+#define BIT_MASK_AIFS_V1 0xff -+#define BIT_AIFS_V1(x) (((x) & BIT_MASK_AIFS_V1) << BIT_SHIFT_AIFS_V1) -+#define BITS_AIFS_V1 (BIT_MASK_AIFS_V1 << BIT_SHIFT_AIFS_V1) -+#define BIT_CLEAR_AIFS_V1(x) ((x) & (~BITS_AIFS_V1)) -+#define BIT_GET_AIFS_V1(x) (((x) >> BIT_SHIFT_AIFS_V1) & BIT_MASK_AIFS_V1) -+#define BIT_SET_AIFS_V1(x, v) (BIT_CLEAR_AIFS_V1(x) | BIT_AIFS_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NOA_OFF_ERLY_TIME (Offset 0x051D) */ -+ -+#define BIT_SHIFT__NOA_OFF_ERLY_TIME 0 -+#define BIT_MASK__NOA_OFF_ERLY_TIME 0xff -+#define BIT__NOA_OFF_ERLY_TIME(x) \ -+ (((x) & BIT_MASK__NOA_OFF_ERLY_TIME) << BIT_SHIFT__NOA_OFF_ERLY_TIME) -+#define BITS__NOA_OFF_ERLY_TIME \ -+ (BIT_MASK__NOA_OFF_ERLY_TIME << BIT_SHIFT__NOA_OFF_ERLY_TIME) -+#define BIT_CLEAR__NOA_OFF_ERLY_TIME(x) ((x) & (~BITS__NOA_OFF_ERLY_TIME)) -+#define BIT_GET__NOA_OFF_ERLY_TIME(x) \ -+ (((x) >> BIT_SHIFT__NOA_OFF_ERLY_TIME) & BIT_MASK__NOA_OFF_ERLY_TIME) -+#define BIT_SET__NOA_OFF_ERLY_TIME(x, v) \ -+ (BIT_CLEAR__NOA_OFF_ERLY_TIME(x) | BIT__NOA_OFF_ERLY_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPUMGQ_PAUSE (Offset 0x051E) */ -+ -+#define BIT_MAC_STOP_CPUMGQ_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PS_TIMER_CTRL (Offset 0x051F) */ -+ -+#define BIT_PS_TIMER_B_EN_V1 BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_B_TSF_SEL_V1 4 -+#define BIT_MASK_PS_TIMER_B_TSF_SEL_V1 0x3 -+#define BIT_PS_TIMER_B_TSF_SEL_V1(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_TSF_SEL_V1) \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_V1) -+#define BITS_PS_TIMER_B_TSF_SEL_V1 \ -+ (BIT_MASK_PS_TIMER_B_TSF_SEL_V1 << BIT_SHIFT_PS_TIMER_B_TSF_SEL_V1) -+#define BIT_CLEAR_PS_TIMER_B_TSF_SEL_V1(x) ((x) & (~BITS_PS_TIMER_B_TSF_SEL_V1)) -+#define BIT_GET_PS_TIMER_B_TSF_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_TSF_SEL_V1) & \ -+ BIT_MASK_PS_TIMER_B_TSF_SEL_V1) -+#define BIT_SET_PS_TIMER_B_TSF_SEL_V1(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_TSF_SEL_V1(x) | BIT_PS_TIMER_B_TSF_SEL_V1(v)) -+ -+#define BIT_PS_TIMER_A_EN_V1 BIT(3) -+ -+#define BIT_SHIFT_PS_TIMER_A_TSF_SEL_V1 0 -+#define BIT_MASK_PS_TIMER_A_TSF_SEL_V1 0x3 -+#define BIT_PS_TIMER_A_TSF_SEL_V1(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_TSF_SEL_V1) \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_V1) -+#define BITS_PS_TIMER_A_TSF_SEL_V1 \ -+ (BIT_MASK_PS_TIMER_A_TSF_SEL_V1 << BIT_SHIFT_PS_TIMER_A_TSF_SEL_V1) -+#define BIT_CLEAR_PS_TIMER_A_TSF_SEL_V1(x) ((x) & (~BITS_PS_TIMER_A_TSF_SEL_V1)) -+#define BIT_GET_PS_TIMER_A_TSF_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_TSF_SEL_V1) & \ -+ BIT_MASK_PS_TIMER_A_TSF_SEL_V1) -+#define BIT_SET_PS_TIMER_A_TSF_SEL_V1(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_TSF_SEL_V1(x) | BIT_PS_TIMER_A_TSF_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TX_PTCL_CTRL (Offset 0x0520) */ -+ -+#define BIT_DIS_EDCCA BIT(15) -+#define BIT_DIS_CCA BIT(14) -+#define BIT_LSIG_TXOP_TXCMD_NAV BIT(13) -+#define BIT_SIFS_BK_EN BIT(12) -+ -+#define BIT_SHIFT_TXQ_NAV_MSK 8 -+#define BIT_MASK_TXQ_NAV_MSK 0xf -+#define BIT_TXQ_NAV_MSK(x) \ -+ (((x) & BIT_MASK_TXQ_NAV_MSK) << BIT_SHIFT_TXQ_NAV_MSK) -+#define BITS_TXQ_NAV_MSK (BIT_MASK_TXQ_NAV_MSK << BIT_SHIFT_TXQ_NAV_MSK) -+#define BIT_CLEAR_TXQ_NAV_MSK(x) ((x) & (~BITS_TXQ_NAV_MSK)) -+#define BIT_GET_TXQ_NAV_MSK(x) \ -+ (((x) >> BIT_SHIFT_TXQ_NAV_MSK) & BIT_MASK_TXQ_NAV_MSK) -+#define BIT_SET_TXQ_NAV_MSK(x, v) \ -+ (BIT_CLEAR_TXQ_NAV_MSK(x) | BIT_TXQ_NAV_MSK(v)) -+ -+#define BIT_DIS_CW BIT(7) -+#define BIT_NAV_END_TXOP BIT(6) -+#define BIT_RDG_END_TXOP BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TX_PTCL_CTRL (Offset 0x0520) */ -+ -+#define BIT_AC_INBCN_HOLD BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TX_PTCL_CTRL (Offset 0x0520) */ -+ -+#define BIT_MGTQ_TXOP_EN BIT(3) -+#define BIT_MGTQ_RTSMF_EN BIT(2) -+#define BIT_HIQ_RTSMF_EN BIT(1) -+#define BIT_BCN_RTSMF_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXPAUSE (Offset 0x0522) */ -+ -+#define BIT_STOP_BCN_HI_MGT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TXPAUSE (Offset 0x0522) */ -+ -+#define BIT_MAC_STOPCPUMGQ BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXPAUSE (Offset 0x0522) */ -+ -+#define BIT_MAC_STOPBCNQ BIT(6) -+#define BIT_MAC_STOPHIQ BIT(5) -+#define BIT_MAC_STOPMGQ BIT(4) -+#define BIT_MAC_STOPBK BIT(3) -+#define BIT_MAC_STOPBE BIT(2) -+#define BIT_MAC_STOPVI BIT(1) -+#define BIT_MAC_STOPVO BIT(0) -+ -+/* 2 REG_DIS_TXREQ_CLR (Offset 0x0523) */ -+ -+#define BIT_DIS_BT_CCA BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DIS_TXREQ_CLR (Offset 0x0523) */ -+ -+#define BIT_DIS_TXREQ_CLR_CPUMGQ BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DIS_TXREQ_CLR (Offset 0x0523) */ -+ -+#define BIT_DIS_TXREQ_CLR_HI BIT(5) -+#define BIT_DIS_TXREQ_CLR_MGQ BIT(4) -+#define BIT_DIS_TXREQ_CLR_VO BIT(3) -+#define BIT_DIS_TXREQ_CLR_VI BIT(2) -+#define BIT_DIS_TXREQ_CLR_BE BIT(1) -+#define BIT_DIS_TXREQ_CLR_BK BIT(0) -+ -+/* 2 REG_RD_CTRL (Offset 0x0524) */ -+ -+#define BIT_EN_CLR_TXREQ_INCCA BIT(15) -+#define BIT_DIS_TX_OVER_BCNQ BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RD_CTRL (Offset 0x0524) */ -+ -+#define BIT_EN_BCNERR_INCCCA BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RD_CTRL (Offset 0x0524) */ -+ -+#define BIT_EN_BCNERR_INCCA BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RD_CTRL (Offset 0x0524) */ -+ -+#define BIT_EN_BCNERR_INEDCCA BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RD_CTRL (Offset 0x0524) */ -+ -+#define BIT_EDCCA_MSK_CNTDOWN_EN BIT(11) -+#define BIT_DIS_TXOP_CFE BIT(10) -+#define BIT_DIS_LSIG_CFE BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RD_CTRL (Offset 0x0524) */ -+ -+#define BIT_DIS_STBC_CFE BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RD_CTRL (Offset 0x0524) */ -+ -+#define BIT_BKQ_RD_INIT_EN BIT(7) -+#define BIT_BEQ_RD_INIT_EN BIT(6) -+#define BIT_VIQ_RD_INIT_EN BIT(5) -+#define BIT_VOQ_RD_INIT_EN BIT(4) -+#define BIT_BKQ_RD_RESP_EN BIT(3) -+#define BIT_BEQ_RD_RESP_EN BIT(2) -+#define BIT_VIQ_RD_RESP_EN BIT(1) -+#define BIT_VOQ_RD_RESP_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBSSID_CTRL (Offset 0x0526) */ -+ -+#define BIT_MBID_BCNQ7_EN BIT(7) -+#define BIT_MBID_BCNQ6_EN BIT(6) -+#define BIT_MBID_BCNQ5_EN BIT(5) -+#define BIT_MBID_BCNQ4_EN BIT(4) -+#define BIT_MBID_BCNQ3_EN BIT(3) -+#define BIT_MBID_BCNQ2_EN BIT(2) -+#define BIT_MBID_BCNQ1_EN BIT(1) -+#define BIT_MBID_BCNQ0_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_P2PPS_CTRL (Offset 0x0527) */ -+ -+#define BIT_P2P_CTW_ALLSTASLEEP BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_P2PPS_CTRL (Offset 0x0527) */ -+ -+#define BIT_P2P_DISTX_SEL BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_P2PPS_CTRL (Offset 0x0527) */ -+ -+#define BIT_PWR_MGT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_P2PPS_CTRL (Offset 0x0527) */ -+ -+#define BIT_P2P_BCN_AREA_EN BIT(4) -+#define BIT_P2P_CTWND_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_P2PPS_CTRL (Offset 0x0527) */ -+ -+#define BIT_P2P_NOA1_EN BIT(2) -+#define BIT_P2P_NOA0_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_P2PPS_CTRL (Offset 0x0527) */ -+ -+#define BIT_P2P_BCN_SEL BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PKT_LIFETIME_CTRL (Offset 0x0528) */ -+ -+#define BIT_EN_P2P_CTWND1 BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_PKT_LIFETIME_CTRL (Offset 0x0528) */ -+ -+#define BIT_EN_TBTT_AREA_FOR_BB BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PKT_LIFETIME_CTRL (Offset 0x0528) */ -+ -+#define BIT_EN_BKF_CLR_TXREQ BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PKT_LIFETIME_CTRL (Offset 0x0528) */ -+ -+#define BIT_EN_TSFBIT32_RST_P2P BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PKT_LIFETIME_CTRL (Offset 0x0528) */ -+ -+#define BIT_EN_BCN_TX_BTCCA BIT(20) -+#define BIT_DIS_PKT_TX_ATIM BIT(19) -+#define BIT_DIS_BCN_DIS_CTN BIT(18) -+#define BIT_EN_NAVEND_RST_TXOP BIT(17) -+#define BIT_EN_FILTER_CCA BIT(16) -+ -+#define BIT_SHIFT_CCA_FILTER_THRS 8 -+#define BIT_MASK_CCA_FILTER_THRS 0xff -+#define BIT_CCA_FILTER_THRS(x) \ -+ (((x) & BIT_MASK_CCA_FILTER_THRS) << BIT_SHIFT_CCA_FILTER_THRS) -+#define BITS_CCA_FILTER_THRS \ -+ (BIT_MASK_CCA_FILTER_THRS << BIT_SHIFT_CCA_FILTER_THRS) -+#define BIT_CLEAR_CCA_FILTER_THRS(x) ((x) & (~BITS_CCA_FILTER_THRS)) -+#define BIT_GET_CCA_FILTER_THRS(x) \ -+ (((x) >> BIT_SHIFT_CCA_FILTER_THRS) & BIT_MASK_CCA_FILTER_THRS) -+#define BIT_SET_CCA_FILTER_THRS(x, v) \ -+ (BIT_CLEAR_CCA_FILTER_THRS(x) | BIT_CCA_FILTER_THRS(v)) -+ -+#define BIT_SHIFT_EDCCA_THRS 0 -+#define BIT_MASK_EDCCA_THRS 0xff -+#define BIT_EDCCA_THRS(x) (((x) & BIT_MASK_EDCCA_THRS) << BIT_SHIFT_EDCCA_THRS) -+#define BITS_EDCCA_THRS (BIT_MASK_EDCCA_THRS << BIT_SHIFT_EDCCA_THRS) -+#define BIT_CLEAR_EDCCA_THRS(x) ((x) & (~BITS_EDCCA_THRS)) -+#define BIT_GET_EDCCA_THRS(x) \ -+ (((x) >> BIT_SHIFT_EDCCA_THRS) & BIT_MASK_EDCCA_THRS) -+#define BIT_SET_EDCCA_THRS(x, v) (BIT_CLEAR_EDCCA_THRS(x) | BIT_EDCCA_THRS(v)) -+ -+/* 2 REG_P2PPS_SPEC_STATE (Offset 0x052B) */ -+ -+#define BIT_SPEC_POWER_STATE BIT(7) -+#define BIT_SPEC_CTWINDOW_ON BIT(6) -+#define BIT_SPEC_BEACON_AREA_ON BIT(5) -+#define BIT_SPEC_CTWIN_EARLY_DISTX BIT(4) -+#define BIT_SPEC_NOA1_OFF_PERIOD BIT(3) -+#define BIT_SPEC_FORCE_DOZE1 BIT(2) -+#define BIT_SPEC_NOA0_OFF_PERIOD BIT(1) -+#define BIT_SPEC_FORCE_DOZE0 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXOP_LIMIT_CTRL (Offset 0x052C) */ -+ -+#define BIT_SHIFT_TXOP_TBTT_CNT 24 -+#define BIT_MASK_TXOP_TBTT_CNT 0xff -+#define BIT_TXOP_TBTT_CNT(x) \ -+ (((x) & BIT_MASK_TXOP_TBTT_CNT) << BIT_SHIFT_TXOP_TBTT_CNT) -+#define BITS_TXOP_TBTT_CNT (BIT_MASK_TXOP_TBTT_CNT << BIT_SHIFT_TXOP_TBTT_CNT) -+#define BIT_CLEAR_TXOP_TBTT_CNT(x) ((x) & (~BITS_TXOP_TBTT_CNT)) -+#define BIT_GET_TXOP_TBTT_CNT(x) \ -+ (((x) >> BIT_SHIFT_TXOP_TBTT_CNT) & BIT_MASK_TXOP_TBTT_CNT) -+#define BIT_SET_TXOP_TBTT_CNT(x, v) \ -+ (BIT_CLEAR_TXOP_TBTT_CNT(x) | BIT_TXOP_TBTT_CNT(v)) -+ -+#define BIT_SHIFT_TXOP_TBTT_CNT_SEL 20 -+#define BIT_MASK_TXOP_TBTT_CNT_SEL 0xf -+#define BIT_TXOP_TBTT_CNT_SEL(x) \ -+ (((x) & BIT_MASK_TXOP_TBTT_CNT_SEL) << BIT_SHIFT_TXOP_TBTT_CNT_SEL) -+#define BITS_TXOP_TBTT_CNT_SEL \ -+ (BIT_MASK_TXOP_TBTT_CNT_SEL << BIT_SHIFT_TXOP_TBTT_CNT_SEL) -+#define BIT_CLEAR_TXOP_TBTT_CNT_SEL(x) ((x) & (~BITS_TXOP_TBTT_CNT_SEL)) -+#define BIT_GET_TXOP_TBTT_CNT_SEL(x) \ -+ (((x) >> BIT_SHIFT_TXOP_TBTT_CNT_SEL) & BIT_MASK_TXOP_TBTT_CNT_SEL) -+#define BIT_SET_TXOP_TBTT_CNT_SEL(x, v) \ -+ (BIT_CLEAR_TXOP_TBTT_CNT_SEL(x) | BIT_TXOP_TBTT_CNT_SEL(v)) -+ -+#define BIT_SHIFT_TXOP_LMT_EN 16 -+#define BIT_MASK_TXOP_LMT_EN 0xf -+#define BIT_TXOP_LMT_EN(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_EN) << BIT_SHIFT_TXOP_LMT_EN) -+#define BITS_TXOP_LMT_EN (BIT_MASK_TXOP_LMT_EN << BIT_SHIFT_TXOP_LMT_EN) -+#define BIT_CLEAR_TXOP_LMT_EN(x) ((x) & (~BITS_TXOP_LMT_EN)) -+#define BIT_GET_TXOP_LMT_EN(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_EN) & BIT_MASK_TXOP_LMT_EN) -+#define BIT_SET_TXOP_LMT_EN(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_EN(x) | BIT_TXOP_LMT_EN(v)) -+ -+#define BIT_SHIFT_TXOP_LMT_TX_TIME 8 -+#define BIT_MASK_TXOP_LMT_TX_TIME 0xff -+#define BIT_TXOP_LMT_TX_TIME(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_TX_TIME) << BIT_SHIFT_TXOP_LMT_TX_TIME) -+#define BITS_TXOP_LMT_TX_TIME \ -+ (BIT_MASK_TXOP_LMT_TX_TIME << BIT_SHIFT_TXOP_LMT_TX_TIME) -+#define BIT_CLEAR_TXOP_LMT_TX_TIME(x) ((x) & (~BITS_TXOP_LMT_TX_TIME)) -+#define BIT_GET_TXOP_LMT_TX_TIME(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_TX_TIME) & BIT_MASK_TXOP_LMT_TX_TIME) -+#define BIT_SET_TXOP_LMT_TX_TIME(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_TX_TIME(x) | BIT_TXOP_LMT_TX_TIME(v)) -+ -+#define BIT_TXOP_CNT_TRIGGER_RESET BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_TBTT_AREA_BLK_4AC (Offset 0x052C) */ -+ -+#define BIT_EN_TBTT_AREA_BLK_4AC BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PS_TIMER_A_V2 (Offset 0x052C) */ -+ -+#define BIT_SHIFT_PS_TIMER_A_V2 0 -+#define BIT_MASK_PS_TIMER_A_V2 0xffffffffL -+#define BIT_PS_TIMER_A_V2(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_V2) << BIT_SHIFT_PS_TIMER_A_V2) -+#define BITS_PS_TIMER_A_V2 (BIT_MASK_PS_TIMER_A_V2 << BIT_SHIFT_PS_TIMER_A_V2) -+#define BIT_CLEAR_PS_TIMER_A_V2(x) ((x) & (~BITS_PS_TIMER_A_V2)) -+#define BIT_GET_PS_TIMER_A_V2(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_V2) & BIT_MASK_PS_TIMER_A_V2) -+#define BIT_SET_PS_TIMER_A_V2(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_V2(x) | BIT_PS_TIMER_A_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXOP_LIMIT_CTRL (Offset 0x052C) */ -+ -+#define BIT_SHIFT_TXOP_LMT_PKT_NUM 0 -+#define BIT_MASK_TXOP_LMT_PKT_NUM 0x3f -+#define BIT_TXOP_LMT_PKT_NUM(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_PKT_NUM) << BIT_SHIFT_TXOP_LMT_PKT_NUM) -+#define BITS_TXOP_LMT_PKT_NUM \ -+ (BIT_MASK_TXOP_LMT_PKT_NUM << BIT_SHIFT_TXOP_LMT_PKT_NUM) -+#define BIT_CLEAR_TXOP_LMT_PKT_NUM(x) ((x) & (~BITS_TXOP_LMT_PKT_NUM)) -+#define BIT_GET_TXOP_LMT_PKT_NUM(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_PKT_NUM) & BIT_MASK_TXOP_LMT_PKT_NUM) -+#define BIT_SET_TXOP_LMT_PKT_NUM(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_PKT_NUM(x) | BIT_TXOP_LMT_PKT_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PON_DIS_TXTIME (Offset 0x0531) */ -+ -+#define BIT_SHIFT_P2PON_DIS_TXTIME 0 -+#define BIT_MASK_P2PON_DIS_TXTIME 0xff -+#define BIT_P2PON_DIS_TXTIME(x) \ -+ (((x) & BIT_MASK_P2PON_DIS_TXTIME) << BIT_SHIFT_P2PON_DIS_TXTIME) -+#define BITS_P2PON_DIS_TXTIME \ -+ (BIT_MASK_P2PON_DIS_TXTIME << BIT_SHIFT_P2PON_DIS_TXTIME) -+#define BIT_CLEAR_P2PON_DIS_TXTIME(x) ((x) & (~BITS_P2PON_DIS_TXTIME)) -+#define BIT_GET_P2PON_DIS_TXTIME(x) \ -+ (((x) >> BIT_SHIFT_P2PON_DIS_TXTIME) & BIT_MASK_P2PON_DIS_TXTIME) -+#define BIT_SET_P2PON_DIS_TXTIME(x, v) \ -+ (BIT_CLEAR_P2PON_DIS_TXTIME(x) | BIT_P2PON_DIS_TXTIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PS_TIMER_B_V2 (Offset 0x0534) */ -+ -+#define BIT_FTM_PTT_TSF_R2T_SEL_V1 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CCA_TXEN_CNT (Offset 0x0534) */ -+ -+#define BIT_ENABLE_STOP_UPDATE_NAV BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PS_TIMER_B_V2 (Offset 0x0534) */ -+ -+#define BIT_TBTT_DIG BIT(20) -+#define BIT_FTM_PTT_TSF_T2R_SEL_V1 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CCA_TXEN_CNT (Offset 0x0534) */ -+ -+#define BIT_CCA_TXEN_CNT_SWITCH BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PS_TIMER_B_V2 (Offset 0x0534) */ -+ -+#define BIT_FTM_PTT_TSF_SEL_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CCA_TXEN_CNT (Offset 0x0534) */ -+ -+#define BIT_CCA_TXEN_CNT_EN BIT(16) -+ -+#define BIT_SHIFT_CCA_TXEN_BIG_CNT 8 -+#define BIT_MASK_CCA_TXEN_BIG_CNT 0xff -+#define BIT_CCA_TXEN_BIG_CNT(x) \ -+ (((x) & BIT_MASK_CCA_TXEN_BIG_CNT) << BIT_SHIFT_CCA_TXEN_BIG_CNT) -+#define BITS_CCA_TXEN_BIG_CNT \ -+ (BIT_MASK_CCA_TXEN_BIG_CNT << BIT_SHIFT_CCA_TXEN_BIG_CNT) -+#define BIT_CLEAR_CCA_TXEN_BIG_CNT(x) ((x) & (~BITS_CCA_TXEN_BIG_CNT)) -+#define BIT_GET_CCA_TXEN_BIG_CNT(x) \ -+ (((x) >> BIT_SHIFT_CCA_TXEN_BIG_CNT) & BIT_MASK_CCA_TXEN_BIG_CNT) -+#define BIT_SET_CCA_TXEN_BIG_CNT(x, v) \ -+ (BIT_CLEAR_CCA_TXEN_BIG_CNT(x) | BIT_CCA_TXEN_BIG_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PS_TIMER_B_V2 (Offset 0x0534) */ -+ -+#define BIT_SHIFT_PS_TIMER_B_V2 0 -+#define BIT_MASK_PS_TIMER_B_V2 0xffffffffL -+#define BIT_PS_TIMER_B_V2(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_V2) << BIT_SHIFT_PS_TIMER_B_V2) -+#define BITS_PS_TIMER_B_V2 (BIT_MASK_PS_TIMER_B_V2 << BIT_SHIFT_PS_TIMER_B_V2) -+#define BIT_CLEAR_PS_TIMER_B_V2(x) ((x) & (~BITS_PS_TIMER_B_V2)) -+#define BIT_GET_PS_TIMER_B_V2(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_V2) & BIT_MASK_PS_TIMER_B_V2) -+#define BIT_SET_PS_TIMER_B_V2(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_V2(x) | BIT_PS_TIMER_B_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CCA_TXEN_CNT (Offset 0x0534) */ -+ -+#define BIT_SHIFT_CCA_TXEN_SMALL_CNT 0 -+#define BIT_MASK_CCA_TXEN_SMALL_CNT 0xff -+#define BIT_CCA_TXEN_SMALL_CNT(x) \ -+ (((x) & BIT_MASK_CCA_TXEN_SMALL_CNT) << BIT_SHIFT_CCA_TXEN_SMALL_CNT) -+#define BITS_CCA_TXEN_SMALL_CNT \ -+ (BIT_MASK_CCA_TXEN_SMALL_CNT << BIT_SHIFT_CCA_TXEN_SMALL_CNT) -+#define BIT_CLEAR_CCA_TXEN_SMALL_CNT(x) ((x) & (~BITS_CCA_TXEN_SMALL_CNT)) -+#define BIT_GET_CCA_TXEN_SMALL_CNT(x) \ -+ (((x) >> BIT_SHIFT_CCA_TXEN_SMALL_CNT) & BIT_MASK_CCA_TXEN_SMALL_CNT) -+#define BIT_SET_CCA_TXEN_SMALL_CNT(x, v) \ -+ (BIT_CLEAR_CCA_TXEN_SMALL_CNT(x) | BIT_CCA_TXEN_SMALL_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_THR (Offset 0x0538) */ -+ -+#define BIT_SHIFT_BK_QUEUE_THR 24 -+#define BIT_MASK_BK_QUEUE_THR 0xff -+#define BIT_BK_QUEUE_THR(x) \ -+ (((x) & BIT_MASK_BK_QUEUE_THR) << BIT_SHIFT_BK_QUEUE_THR) -+#define BITS_BK_QUEUE_THR (BIT_MASK_BK_QUEUE_THR << BIT_SHIFT_BK_QUEUE_THR) -+#define BIT_CLEAR_BK_QUEUE_THR(x) ((x) & (~BITS_BK_QUEUE_THR)) -+#define BIT_GET_BK_QUEUE_THR(x) \ -+ (((x) >> BIT_SHIFT_BK_QUEUE_THR) & BIT_MASK_BK_QUEUE_THR) -+#define BIT_SET_BK_QUEUE_THR(x, v) \ -+ (BIT_CLEAR_BK_QUEUE_THR(x) | BIT_BK_QUEUE_THR(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAX_INTER_COLLISION (Offset 0x0538) */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_BK 24 -+#define BIT_MASK_MAX_INTER_COLLISION_BK 0xff -+#define BIT_MAX_INTER_COLLISION_BK(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_BK) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BK) -+#define BITS_MAX_INTER_COLLISION_BK \ -+ (BIT_MASK_MAX_INTER_COLLISION_BK << BIT_SHIFT_MAX_INTER_COLLISION_BK) -+#define BIT_CLEAR_MAX_INTER_COLLISION_BK(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_BK)) -+#define BIT_GET_MAX_INTER_COLLISION_BK(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_BK) & \ -+ BIT_MASK_MAX_INTER_COLLISION_BK) -+#define BIT_SET_MAX_INTER_COLLISION_BK(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_BK(x) | BIT_MAX_INTER_COLLISION_BK(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_THR (Offset 0x0538) */ -+ -+#define BIT_SHIFT_BE_QUEUE_THR 16 -+#define BIT_MASK_BE_QUEUE_THR 0xff -+#define BIT_BE_QUEUE_THR(x) \ -+ (((x) & BIT_MASK_BE_QUEUE_THR) << BIT_SHIFT_BE_QUEUE_THR) -+#define BITS_BE_QUEUE_THR (BIT_MASK_BE_QUEUE_THR << BIT_SHIFT_BE_QUEUE_THR) -+#define BIT_CLEAR_BE_QUEUE_THR(x) ((x) & (~BITS_BE_QUEUE_THR)) -+#define BIT_GET_BE_QUEUE_THR(x) \ -+ (((x) >> BIT_SHIFT_BE_QUEUE_THR) & BIT_MASK_BE_QUEUE_THR) -+#define BIT_SET_BE_QUEUE_THR(x, v) \ -+ (BIT_CLEAR_BE_QUEUE_THR(x) | BIT_BE_QUEUE_THR(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAX_INTER_COLLISION (Offset 0x0538) */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_BE 16 -+#define BIT_MASK_MAX_INTER_COLLISION_BE 0xff -+#define BIT_MAX_INTER_COLLISION_BE(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_BE) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BE) -+#define BITS_MAX_INTER_COLLISION_BE \ -+ (BIT_MASK_MAX_INTER_COLLISION_BE << BIT_SHIFT_MAX_INTER_COLLISION_BE) -+#define BIT_CLEAR_MAX_INTER_COLLISION_BE(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_BE)) -+#define BIT_GET_MAX_INTER_COLLISION_BE(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_BE) & \ -+ BIT_MASK_MAX_INTER_COLLISION_BE) -+#define BIT_SET_MAX_INTER_COLLISION_BE(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_BE(x) | BIT_MAX_INTER_COLLISION_BE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_THR (Offset 0x0538) */ -+ -+#define BIT_SHIFT_VI_QUEUE_THR 8 -+#define BIT_MASK_VI_QUEUE_THR 0xff -+#define BIT_VI_QUEUE_THR(x) \ -+ (((x) & BIT_MASK_VI_QUEUE_THR) << BIT_SHIFT_VI_QUEUE_THR) -+#define BITS_VI_QUEUE_THR (BIT_MASK_VI_QUEUE_THR << BIT_SHIFT_VI_QUEUE_THR) -+#define BIT_CLEAR_VI_QUEUE_THR(x) ((x) & (~BITS_VI_QUEUE_THR)) -+#define BIT_GET_VI_QUEUE_THR(x) \ -+ (((x) >> BIT_SHIFT_VI_QUEUE_THR) & BIT_MASK_VI_QUEUE_THR) -+#define BIT_SET_VI_QUEUE_THR(x, v) \ -+ (BIT_CLEAR_VI_QUEUE_THR(x) | BIT_VI_QUEUE_THR(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAX_INTER_COLLISION (Offset 0x0538) */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_VI 8 -+#define BIT_MASK_MAX_INTER_COLLISION_VI 0xff -+#define BIT_MAX_INTER_COLLISION_VI(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_VI) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VI) -+#define BITS_MAX_INTER_COLLISION_VI \ -+ (BIT_MASK_MAX_INTER_COLLISION_VI << BIT_SHIFT_MAX_INTER_COLLISION_VI) -+#define BIT_CLEAR_MAX_INTER_COLLISION_VI(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_VI)) -+#define BIT_GET_MAX_INTER_COLLISION_VI(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_VI) & \ -+ BIT_MASK_MAX_INTER_COLLISION_VI) -+#define BIT_SET_MAX_INTER_COLLISION_VI(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_VI(x) | BIT_MAX_INTER_COLLISION_VI(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_THR (Offset 0x0538) */ -+ -+#define BIT_SHIFT_VO_QUEUE_THR 0 -+#define BIT_MASK_VO_QUEUE_THR 0xff -+#define BIT_VO_QUEUE_THR(x) \ -+ (((x) & BIT_MASK_VO_QUEUE_THR) << BIT_SHIFT_VO_QUEUE_THR) -+#define BITS_VO_QUEUE_THR (BIT_MASK_VO_QUEUE_THR << BIT_SHIFT_VO_QUEUE_THR) -+#define BIT_CLEAR_VO_QUEUE_THR(x) ((x) & (~BITS_VO_QUEUE_THR)) -+#define BIT_GET_VO_QUEUE_THR(x) \ -+ (((x) >> BIT_SHIFT_VO_QUEUE_THR) & BIT_MASK_VO_QUEUE_THR) -+#define BIT_SET_VO_QUEUE_THR(x, v) \ -+ (BIT_CLEAR_VO_QUEUE_THR(x) | BIT_VO_QUEUE_THR(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAX_INTER_COLLISION (Offset 0x0538) */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_VO 0 -+#define BIT_MASK_MAX_INTER_COLLISION_VO 0xff -+#define BIT_MAX_INTER_COLLISION_VO(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_VO) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VO) -+#define BITS_MAX_INTER_COLLISION_VO \ -+ (BIT_MASK_MAX_INTER_COLLISION_VO << BIT_SHIFT_MAX_INTER_COLLISION_VO) -+#define BIT_CLEAR_MAX_INTER_COLLISION_VO(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_VO)) -+#define BIT_GET_MAX_INTER_COLLISION_VO(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_VO) & \ -+ BIT_MASK_MAX_INTER_COLLISION_VO) -+#define BIT_SET_MAX_INTER_COLLISION_VO(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_VO(x) | BIT_MAX_INTER_COLLISION_VO(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_EN (Offset 0x053C) */ -+ -+#define BIT_QUEUE_INCOL_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAX_INTER_COLLISION_CNT (Offset 0x053C) */ -+ -+#define BIT_MAX_INTER_COLLISION_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_EN (Offset 0x053C) */ -+ -+#define BIT_SHIFT_BK_TRIGGER_NUM_V1 12 -+#define BIT_MASK_BK_TRIGGER_NUM_V1 0xf -+#define BIT_BK_TRIGGER_NUM_V1(x) \ -+ (((x) & BIT_MASK_BK_TRIGGER_NUM_V1) << BIT_SHIFT_BK_TRIGGER_NUM_V1) -+#define BITS_BK_TRIGGER_NUM_V1 \ -+ (BIT_MASK_BK_TRIGGER_NUM_V1 << BIT_SHIFT_BK_TRIGGER_NUM_V1) -+#define BIT_CLEAR_BK_TRIGGER_NUM_V1(x) ((x) & (~BITS_BK_TRIGGER_NUM_V1)) -+#define BIT_GET_BK_TRIGGER_NUM_V1(x) \ -+ (((x) >> BIT_SHIFT_BK_TRIGGER_NUM_V1) & BIT_MASK_BK_TRIGGER_NUM_V1) -+#define BIT_SET_BK_TRIGGER_NUM_V1(x, v) \ -+ (BIT_CLEAR_BK_TRIGGER_NUM_V1(x) | BIT_BK_TRIGGER_NUM_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAX_INTER_COLLISION_CNT (Offset 0x053C) */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK 12 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_BK 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_BK(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_BK) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK) -+#define BITS_MAX_INTER_COLLISION_CNT_BK \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_BK \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_BK(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_BK)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_BK(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_BK) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_BK(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_BK(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_BK(v)) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_EN (Offset 0x053C) */ -+ -+#define BIT_SHIFT_BE_TRIGGER_NUM 12 -+#define BIT_MASK_BE_TRIGGER_NUM 0xf -+#define BIT_BE_TRIGGER_NUM(x) \ -+ (((x) & BIT_MASK_BE_TRIGGER_NUM) << BIT_SHIFT_BE_TRIGGER_NUM) -+#define BITS_BE_TRIGGER_NUM \ -+ (BIT_MASK_BE_TRIGGER_NUM << BIT_SHIFT_BE_TRIGGER_NUM) -+#define BIT_CLEAR_BE_TRIGGER_NUM(x) ((x) & (~BITS_BE_TRIGGER_NUM)) -+#define BIT_GET_BE_TRIGGER_NUM(x) \ -+ (((x) >> BIT_SHIFT_BE_TRIGGER_NUM) & BIT_MASK_BE_TRIGGER_NUM) -+#define BIT_SET_BE_TRIGGER_NUM(x, v) \ -+ (BIT_CLEAR_BE_TRIGGER_NUM(x) | BIT_BE_TRIGGER_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_EN (Offset 0x053C) */ -+ -+#define BIT_SHIFT_BE_TRIGGER_NUM_V1 8 -+#define BIT_MASK_BE_TRIGGER_NUM_V1 0xf -+#define BIT_BE_TRIGGER_NUM_V1(x) \ -+ (((x) & BIT_MASK_BE_TRIGGER_NUM_V1) << BIT_SHIFT_BE_TRIGGER_NUM_V1) -+#define BITS_BE_TRIGGER_NUM_V1 \ -+ (BIT_MASK_BE_TRIGGER_NUM_V1 << BIT_SHIFT_BE_TRIGGER_NUM_V1) -+#define BIT_CLEAR_BE_TRIGGER_NUM_V1(x) ((x) & (~BITS_BE_TRIGGER_NUM_V1)) -+#define BIT_GET_BE_TRIGGER_NUM_V1(x) \ -+ (((x) >> BIT_SHIFT_BE_TRIGGER_NUM_V1) & BIT_MASK_BE_TRIGGER_NUM_V1) -+#define BIT_SET_BE_TRIGGER_NUM_V1(x, v) \ -+ (BIT_CLEAR_BE_TRIGGER_NUM_V1(x) | BIT_BE_TRIGGER_NUM_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAX_INTER_COLLISION_CNT (Offset 0x053C) */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE 8 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_BE 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_BE(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_BE) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE) -+#define BITS_MAX_INTER_COLLISION_CNT_BE \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_BE \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_BE(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_BE)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_BE(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_BE) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_BE(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_BE(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_BE(v)) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_EN (Offset 0x053C) */ -+ -+#define BIT_SHIFT_BK_TRIGGER_NUM 8 -+#define BIT_MASK_BK_TRIGGER_NUM 0xf -+#define BIT_BK_TRIGGER_NUM(x) \ -+ (((x) & BIT_MASK_BK_TRIGGER_NUM) << BIT_SHIFT_BK_TRIGGER_NUM) -+#define BITS_BK_TRIGGER_NUM \ -+ (BIT_MASK_BK_TRIGGER_NUM << BIT_SHIFT_BK_TRIGGER_NUM) -+#define BIT_CLEAR_BK_TRIGGER_NUM(x) ((x) & (~BITS_BK_TRIGGER_NUM)) -+#define BIT_GET_BK_TRIGGER_NUM(x) \ -+ (((x) >> BIT_SHIFT_BK_TRIGGER_NUM) & BIT_MASK_BK_TRIGGER_NUM) -+#define BIT_SET_BK_TRIGGER_NUM(x, v) \ -+ (BIT_CLEAR_BK_TRIGGER_NUM(x) | BIT_BK_TRIGGER_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_EN (Offset 0x053C) */ -+ -+#define BIT_SHIFT_VI_TRIGGER_NUM 4 -+#define BIT_MASK_VI_TRIGGER_NUM 0xf -+#define BIT_VI_TRIGGER_NUM(x) \ -+ (((x) & BIT_MASK_VI_TRIGGER_NUM) << BIT_SHIFT_VI_TRIGGER_NUM) -+#define BITS_VI_TRIGGER_NUM \ -+ (BIT_MASK_VI_TRIGGER_NUM << BIT_SHIFT_VI_TRIGGER_NUM) -+#define BIT_CLEAR_VI_TRIGGER_NUM(x) ((x) & (~BITS_VI_TRIGGER_NUM)) -+#define BIT_GET_VI_TRIGGER_NUM(x) \ -+ (((x) >> BIT_SHIFT_VI_TRIGGER_NUM) & BIT_MASK_VI_TRIGGER_NUM) -+#define BIT_SET_VI_TRIGGER_NUM(x, v) \ -+ (BIT_CLEAR_VI_TRIGGER_NUM(x) | BIT_VI_TRIGGER_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAX_INTER_COLLISION_CNT (Offset 0x053C) */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI 4 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_VI 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_VI(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_VI) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI) -+#define BITS_MAX_INTER_COLLISION_CNT_VI \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_VI \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_VI(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_VI)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_VI(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_VI) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_VI(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_VI(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_VI(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_QUEUE_INCOL_EN (Offset 0x053C) */ -+ -+#define BIT_SHIFT_VO_TRIGGER_NUM 0 -+#define BIT_MASK_VO_TRIGGER_NUM 0xf -+#define BIT_VO_TRIGGER_NUM(x) \ -+ (((x) & BIT_MASK_VO_TRIGGER_NUM) << BIT_SHIFT_VO_TRIGGER_NUM) -+#define BITS_VO_TRIGGER_NUM \ -+ (BIT_MASK_VO_TRIGGER_NUM << BIT_SHIFT_VO_TRIGGER_NUM) -+#define BIT_CLEAR_VO_TRIGGER_NUM(x) ((x) & (~BITS_VO_TRIGGER_NUM)) -+#define BIT_GET_VO_TRIGGER_NUM(x) \ -+ (((x) >> BIT_SHIFT_VO_TRIGGER_NUM) & BIT_MASK_VO_TRIGGER_NUM) -+#define BIT_SET_VO_TRIGGER_NUM(x, v) \ -+ (BIT_CLEAR_VO_TRIGGER_NUM(x) | BIT_VO_TRIGGER_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAX_INTER_COLLISION_CNT (Offset 0x053C) */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO 0 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_VO 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_VO(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_VO) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO) -+#define BITS_MAX_INTER_COLLISION_CNT_VO \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_VO \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_VO(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_VO)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_VO(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_VO) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_VO(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_VO(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_VO(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TBTT_PROHIBIT (Offset 0x0540) */ -+ -+#define BIT_SHIFT_TBTT_HOLD_TIME_AP 8 -+#define BIT_MASK_TBTT_HOLD_TIME_AP 0xfff -+#define BIT_TBTT_HOLD_TIME_AP(x) \ -+ (((x) & BIT_MASK_TBTT_HOLD_TIME_AP) << BIT_SHIFT_TBTT_HOLD_TIME_AP) -+#define BITS_TBTT_HOLD_TIME_AP \ -+ (BIT_MASK_TBTT_HOLD_TIME_AP << BIT_SHIFT_TBTT_HOLD_TIME_AP) -+#define BIT_CLEAR_TBTT_HOLD_TIME_AP(x) ((x) & (~BITS_TBTT_HOLD_TIME_AP)) -+#define BIT_GET_TBTT_HOLD_TIME_AP(x) \ -+ (((x) >> BIT_SHIFT_TBTT_HOLD_TIME_AP) & BIT_MASK_TBTT_HOLD_TIME_AP) -+#define BIT_SET_TBTT_HOLD_TIME_AP(x, v) \ -+ (BIT_CLEAR_TBTT_HOLD_TIME_AP(x) | BIT_TBTT_HOLD_TIME_AP(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TBTT_PROHIBIT (Offset 0x0540) */ -+ -+#define BIT_SHIFT_TBTT_HOLD_TIME_INFRA 4 -+#define BIT_MASK_TBTT_HOLD_TIME_INFRA 0xf -+#define BIT_TBTT_HOLD_TIME_INFRA(x) \ -+ (((x) & BIT_MASK_TBTT_HOLD_TIME_INFRA) \ -+ << BIT_SHIFT_TBTT_HOLD_TIME_INFRA) -+#define BITS_TBTT_HOLD_TIME_INFRA \ -+ (BIT_MASK_TBTT_HOLD_TIME_INFRA << BIT_SHIFT_TBTT_HOLD_TIME_INFRA) -+#define BIT_CLEAR_TBTT_HOLD_TIME_INFRA(x) ((x) & (~BITS_TBTT_HOLD_TIME_INFRA)) -+#define BIT_GET_TBTT_HOLD_TIME_INFRA(x) \ -+ (((x) >> BIT_SHIFT_TBTT_HOLD_TIME_INFRA) & \ -+ BIT_MASK_TBTT_HOLD_TIME_INFRA) -+#define BIT_SET_TBTT_HOLD_TIME_INFRA(x, v) \ -+ (BIT_CLEAR_TBTT_HOLD_TIME_INFRA(x) | BIT_TBTT_HOLD_TIME_INFRA(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_P2PPS_STATE (Offset 0x0543) */ -+ -+#define BIT_POWER_STATE BIT(7) -+#define BIT_CTWINDOW_ON BIT(6) -+#define BIT_BEACON_AREA_ON BIT(5) -+#define BIT_CTWIN_EARLY_DISTX BIT(4) -+#define BIT_NOA1_OFF_PERIOD BIT(3) -+#define BIT_FORCE_DOZE1 BIT(2) -+#define BIT_NOA0_OFF_PERIOD BIT(1) -+#define BIT_FORCE_DOZE0 BIT(0) -+ -+/* 2 REG_RD_NAV_NXT (Offset 0x0544) */ -+ -+#define BIT_SHIFT_RD_NAV_PROT_NXT 0 -+#define BIT_MASK_RD_NAV_PROT_NXT 0xffff -+#define BIT_RD_NAV_PROT_NXT(x) \ -+ (((x) & BIT_MASK_RD_NAV_PROT_NXT) << BIT_SHIFT_RD_NAV_PROT_NXT) -+#define BITS_RD_NAV_PROT_NXT \ -+ (BIT_MASK_RD_NAV_PROT_NXT << BIT_SHIFT_RD_NAV_PROT_NXT) -+#define BIT_CLEAR_RD_NAV_PROT_NXT(x) ((x) & (~BITS_RD_NAV_PROT_NXT)) -+#define BIT_GET_RD_NAV_PROT_NXT(x) \ -+ (((x) >> BIT_SHIFT_RD_NAV_PROT_NXT) & BIT_MASK_RD_NAV_PROT_NXT) -+#define BIT_SET_RD_NAV_PROT_NXT(x, v) \ -+ (BIT_CLEAR_RD_NAV_PROT_NXT(x) | BIT_RD_NAV_PROT_NXT(v)) -+ -+/* 2 REG_NAV_PROT_LEN (Offset 0x0546) */ -+ -+#define BIT_SHIFT_NAV_PROT_LEN 0 -+#define BIT_MASK_NAV_PROT_LEN 0xffff -+#define BIT_NAV_PROT_LEN(x) \ -+ (((x) & BIT_MASK_NAV_PROT_LEN) << BIT_SHIFT_NAV_PROT_LEN) -+#define BITS_NAV_PROT_LEN (BIT_MASK_NAV_PROT_LEN << BIT_SHIFT_NAV_PROT_LEN) -+#define BIT_CLEAR_NAV_PROT_LEN(x) ((x) & (~BITS_NAV_PROT_LEN)) -+#define BIT_GET_NAV_PROT_LEN(x) \ -+ (((x) >> BIT_SHIFT_NAV_PROT_LEN) & BIT_MASK_NAV_PROT_LEN) -+#define BIT_SET_NAV_PROT_LEN(x, v) \ -+ (BIT_CLEAR_NAV_PROT_LEN(x) | BIT_NAV_PROT_LEN(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FTM_CTRL (Offset 0x0548) */ -+ -+#define BIT_SHIFT_FTM_TSF_R2T_PORT 22 -+#define BIT_MASK_FTM_TSF_R2T_PORT 0x7 -+#define BIT_FTM_TSF_R2T_PORT(x) \ -+ (((x) & BIT_MASK_FTM_TSF_R2T_PORT) << BIT_SHIFT_FTM_TSF_R2T_PORT) -+#define BITS_FTM_TSF_R2T_PORT \ -+ (BIT_MASK_FTM_TSF_R2T_PORT << BIT_SHIFT_FTM_TSF_R2T_PORT) -+#define BIT_CLEAR_FTM_TSF_R2T_PORT(x) ((x) & (~BITS_FTM_TSF_R2T_PORT)) -+#define BIT_GET_FTM_TSF_R2T_PORT(x) \ -+ (((x) >> BIT_SHIFT_FTM_TSF_R2T_PORT) & BIT_MASK_FTM_TSF_R2T_PORT) -+#define BIT_SET_FTM_TSF_R2T_PORT(x, v) \ -+ (BIT_CLEAR_FTM_TSF_R2T_PORT(x) | BIT_FTM_TSF_R2T_PORT(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTM_PTT (Offset 0x0548) */ -+ -+#define BIT_SHIFT_FTM_PTT_TSF_R2T_SEL 22 -+#define BIT_MASK_FTM_PTT_TSF_R2T_SEL 0x7 -+#define BIT_FTM_PTT_TSF_R2T_SEL(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_R2T_SEL) << BIT_SHIFT_FTM_PTT_TSF_R2T_SEL) -+#define BITS_FTM_PTT_TSF_R2T_SEL \ -+ (BIT_MASK_FTM_PTT_TSF_R2T_SEL << BIT_SHIFT_FTM_PTT_TSF_R2T_SEL) -+#define BIT_CLEAR_FTM_PTT_TSF_R2T_SEL(x) ((x) & (~BITS_FTM_PTT_TSF_R2T_SEL)) -+#define BIT_GET_FTM_PTT_TSF_R2T_SEL(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_R2T_SEL) & BIT_MASK_FTM_PTT_TSF_R2T_SEL) -+#define BIT_SET_FTM_PTT_TSF_R2T_SEL(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_R2T_SEL(x) | BIT_FTM_PTT_TSF_R2T_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FTM_CTRL (Offset 0x0548) */ -+ -+#define BIT_SHIFT_FTM_TSF_T2R_PORT 19 -+#define BIT_MASK_FTM_TSF_T2R_PORT 0x7 -+#define BIT_FTM_TSF_T2R_PORT(x) \ -+ (((x) & BIT_MASK_FTM_TSF_T2R_PORT) << BIT_SHIFT_FTM_TSF_T2R_PORT) -+#define BITS_FTM_TSF_T2R_PORT \ -+ (BIT_MASK_FTM_TSF_T2R_PORT << BIT_SHIFT_FTM_TSF_T2R_PORT) -+#define BIT_CLEAR_FTM_TSF_T2R_PORT(x) ((x) & (~BITS_FTM_TSF_T2R_PORT)) -+#define BIT_GET_FTM_TSF_T2R_PORT(x) \ -+ (((x) >> BIT_SHIFT_FTM_TSF_T2R_PORT) & BIT_MASK_FTM_TSF_T2R_PORT) -+#define BIT_SET_FTM_TSF_T2R_PORT(x, v) \ -+ (BIT_CLEAR_FTM_TSF_T2R_PORT(x) | BIT_FTM_TSF_T2R_PORT(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTM_PTT (Offset 0x0548) */ -+ -+#define BIT_SHIFT_FTM_PTT_TSF_T2R_SEL 19 -+#define BIT_MASK_FTM_PTT_TSF_T2R_SEL 0x7 -+#define BIT_FTM_PTT_TSF_T2R_SEL(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_T2R_SEL) << BIT_SHIFT_FTM_PTT_TSF_T2R_SEL) -+#define BITS_FTM_PTT_TSF_T2R_SEL \ -+ (BIT_MASK_FTM_PTT_TSF_T2R_SEL << BIT_SHIFT_FTM_PTT_TSF_T2R_SEL) -+#define BIT_CLEAR_FTM_PTT_TSF_T2R_SEL(x) ((x) & (~BITS_FTM_PTT_TSF_T2R_SEL)) -+#define BIT_GET_FTM_PTT_TSF_T2R_SEL(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_T2R_SEL) & BIT_MASK_FTM_PTT_TSF_T2R_SEL) -+#define BIT_SET_FTM_PTT_TSF_T2R_SEL(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_T2R_SEL(x) | BIT_FTM_PTT_TSF_T2R_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FTM_CTRL (Offset 0x0548) */ -+ -+#define BIT_SHIFT_FTM_PTT_PORT 16 -+#define BIT_MASK_FTM_PTT_PORT 0x7 -+#define BIT_FTM_PTT_PORT(x) \ -+ (((x) & BIT_MASK_FTM_PTT_PORT) << BIT_SHIFT_FTM_PTT_PORT) -+#define BITS_FTM_PTT_PORT (BIT_MASK_FTM_PTT_PORT << BIT_SHIFT_FTM_PTT_PORT) -+#define BIT_CLEAR_FTM_PTT_PORT(x) ((x) & (~BITS_FTM_PTT_PORT)) -+#define BIT_GET_FTM_PTT_PORT(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_PORT) & BIT_MASK_FTM_PTT_PORT) -+#define BIT_SET_FTM_PTT_PORT(x, v) \ -+ (BIT_CLEAR_FTM_PTT_PORT(x) | BIT_FTM_PTT_PORT(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTM_PTT (Offset 0x0548) */ -+ -+#define BIT_SHIFT_FTM_PTT_TSF_SEL 16 -+#define BIT_MASK_FTM_PTT_TSF_SEL 0x7 -+#define BIT_FTM_PTT_TSF_SEL(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_SEL) << BIT_SHIFT_FTM_PTT_TSF_SEL) -+#define BITS_FTM_PTT_TSF_SEL \ -+ (BIT_MASK_FTM_PTT_TSF_SEL << BIT_SHIFT_FTM_PTT_TSF_SEL) -+#define BIT_CLEAR_FTM_PTT_TSF_SEL(x) ((x) & (~BITS_FTM_PTT_TSF_SEL)) -+#define BIT_GET_FTM_PTT_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_SEL) & BIT_MASK_FTM_PTT_TSF_SEL) -+#define BIT_SET_FTM_PTT_TSF_SEL(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_SEL(x) | BIT_FTM_PTT_TSF_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FTM_CTRL (Offset 0x0548) */ -+ -+#define BIT_SHIFT_FTM_PTT 0 -+#define BIT_MASK_FTM_PTT 0xffff -+#define BIT_FTM_PTT(x) (((x) & BIT_MASK_FTM_PTT) << BIT_SHIFT_FTM_PTT) -+#define BITS_FTM_PTT (BIT_MASK_FTM_PTT << BIT_SHIFT_FTM_PTT) -+#define BIT_CLEAR_FTM_PTT(x) ((x) & (~BITS_FTM_PTT)) -+#define BIT_GET_FTM_PTT(x) (((x) >> BIT_SHIFT_FTM_PTT) & BIT_MASK_FTM_PTT) -+#define BIT_SET_FTM_PTT(x, v) (BIT_CLEAR_FTM_PTT(x) | BIT_FTM_PTT(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTM_PTT (Offset 0x0548) */ -+ -+#define BIT_SHIFT_FTM_PTT_VALUE 0 -+#define BIT_MASK_FTM_PTT_VALUE 0xffff -+#define BIT_FTM_PTT_VALUE(x) \ -+ (((x) & BIT_MASK_FTM_PTT_VALUE) << BIT_SHIFT_FTM_PTT_VALUE) -+#define BITS_FTM_PTT_VALUE (BIT_MASK_FTM_PTT_VALUE << BIT_SHIFT_FTM_PTT_VALUE) -+#define BIT_CLEAR_FTM_PTT_VALUE(x) ((x) & (~BITS_FTM_PTT_VALUE)) -+#define BIT_GET_FTM_PTT_VALUE(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_VALUE) & BIT_MASK_FTM_PTT_VALUE) -+#define BIT_SET_FTM_PTT_VALUE(x, v) \ -+ (BIT_CLEAR_FTM_PTT_VALUE(x) | BIT_FTM_PTT_VALUE(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FTM_TSF_CNT (Offset 0x054C) */ -+ -+#define BIT_SHIFT_FTM_TSF_R2T 16 -+#define BIT_MASK_FTM_TSF_R2T 0xffff -+#define BIT_FTM_TSF_R2T(x) \ -+ (((x) & BIT_MASK_FTM_TSF_R2T) << BIT_SHIFT_FTM_TSF_R2T) -+#define BITS_FTM_TSF_R2T (BIT_MASK_FTM_TSF_R2T << BIT_SHIFT_FTM_TSF_R2T) -+#define BIT_CLEAR_FTM_TSF_R2T(x) ((x) & (~BITS_FTM_TSF_R2T)) -+#define BIT_GET_FTM_TSF_R2T(x) \ -+ (((x) >> BIT_SHIFT_FTM_TSF_R2T) & BIT_MASK_FTM_TSF_R2T) -+#define BIT_SET_FTM_TSF_R2T(x, v) \ -+ (BIT_CLEAR_FTM_TSF_R2T(x) | BIT_FTM_TSF_R2T(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTM_TSF (Offset 0x054C) */ -+ -+#define BIT_SHIFT_FTM_T2_TSF 16 -+#define BIT_MASK_FTM_T2_TSF 0xffff -+#define BIT_FTM_T2_TSF(x) (((x) & BIT_MASK_FTM_T2_TSF) << BIT_SHIFT_FTM_T2_TSF) -+#define BITS_FTM_T2_TSF (BIT_MASK_FTM_T2_TSF << BIT_SHIFT_FTM_T2_TSF) -+#define BIT_CLEAR_FTM_T2_TSF(x) ((x) & (~BITS_FTM_T2_TSF)) -+#define BIT_GET_FTM_T2_TSF(x) \ -+ (((x) >> BIT_SHIFT_FTM_T2_TSF) & BIT_MASK_FTM_T2_TSF) -+#define BIT_SET_FTM_T2_TSF(x, v) (BIT_CLEAR_FTM_T2_TSF(x) | BIT_FTM_T2_TSF(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FTM_TSF_CNT (Offset 0x054C) */ -+ -+#define BIT_SHIFT_FTM_TSF_T2R 0 -+#define BIT_MASK_FTM_TSF_T2R 0xffff -+#define BIT_FTM_TSF_T2R(x) \ -+ (((x) & BIT_MASK_FTM_TSF_T2R) << BIT_SHIFT_FTM_TSF_T2R) -+#define BITS_FTM_TSF_T2R (BIT_MASK_FTM_TSF_T2R << BIT_SHIFT_FTM_TSF_T2R) -+#define BIT_CLEAR_FTM_TSF_T2R(x) ((x) & (~BITS_FTM_TSF_T2R)) -+#define BIT_GET_FTM_TSF_T2R(x) \ -+ (((x) >> BIT_SHIFT_FTM_TSF_T2R) & BIT_MASK_FTM_TSF_T2R) -+#define BIT_SET_FTM_TSF_T2R(x, v) \ -+ (BIT_CLEAR_FTM_TSF_T2R(x) | BIT_FTM_TSF_T2R(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FTM_TSF (Offset 0x054C) */ -+ -+#define BIT_SHIFT_FTM_T1_TSF 0 -+#define BIT_MASK_FTM_T1_TSF 0xffff -+#define BIT_FTM_T1_TSF(x) (((x) & BIT_MASK_FTM_T1_TSF) << BIT_SHIFT_FTM_T1_TSF) -+#define BITS_FTM_T1_TSF (BIT_MASK_FTM_T1_TSF << BIT_SHIFT_FTM_T1_TSF) -+#define BIT_CLEAR_FTM_T1_TSF(x) ((x) & (~BITS_FTM_T1_TSF)) -+#define BIT_GET_FTM_T1_TSF(x) \ -+ (((x) >> BIT_SHIFT_FTM_T1_TSF) & BIT_MASK_FTM_T1_TSF) -+#define BIT_SET_FTM_T1_TSF(x, v) (BIT_CLEAR_FTM_T1_TSF(x) | BIT_FTM_T1_TSF(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL (Offset 0x0550) */ -+ -+#define BIT_P0_EN_TXBCN_RPT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCN_CTRL (Offset 0x0550) */ -+ -+#define BIT_EN_BCN_FUNCTION BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCN_CTRL (Offset 0x0550) */ -+ -+#define BIT_EN_TXBCN_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL (Offset 0x0550) */ -+ -+#define BIT_P0_EN_RXBCN_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCN_CTRL (Offset 0x0550) */ -+ -+#define BIT_DIS_BCNQ_SUB BIT(1) -+ -+/* 2 REG_BCN_CTRL1 (Offset 0x0551) */ -+ -+#define BIT_DIS_RX_BSSID_FIT1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT0 (Offset 0x0551) */ -+ -+#define BIT_CLI0_DIS_RX_BSSID_FIT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCN_CTRL1 (Offset 0x0551) */ -+ -+#define BIT_DIS_TSF1_UDT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT0 (Offset 0x0551) */ -+ -+#define BIT_CLI0_DIS_TSF_UDT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCN_CTRL1 (Offset 0x0551) */ -+ -+#define BIT_EN_BCN1_FUNCTION BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT0 (Offset 0x0551) */ -+ -+#define BIT_CLI0_EN_BCN_FUNCTION BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCN_CTRL1 (Offset 0x0551) */ -+ -+#define BIT_EN_TXBCN1_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT0 (Offset 0x0551) */ -+ -+#define BIT_CLI0_EN_RXBCN_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT0 (Offset 0x0551) */ -+ -+#define BIT_CLI0_EN_BCN_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCN_CTRL1 (Offset 0x0551) */ -+ -+#define BIT_DIS_BCNQ1_SUB BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT0 (Offset 0x0551) */ -+ -+#define BIT_CLI0_ENP2P_CTWINDOW BIT(1) -+#define BIT_CLI0_ENP2P_BCNQ_AREA BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MBID_NUM (Offset 0x0552) */ -+ -+#define BIT_SHIFT_MBID_BCN_NUM_V2 4 -+#define BIT_MASK_MBID_BCN_NUM_V2 0xf -+#define BIT_MBID_BCN_NUM_V2(x) \ -+ (((x) & BIT_MASK_MBID_BCN_NUM_V2) << BIT_SHIFT_MBID_BCN_NUM_V2) -+#define BITS_MBID_BCN_NUM_V2 \ -+ (BIT_MASK_MBID_BCN_NUM_V2 << BIT_SHIFT_MBID_BCN_NUM_V2) -+#define BIT_CLEAR_MBID_BCN_NUM_V2(x) ((x) & (~BITS_MBID_BCN_NUM_V2)) -+#define BIT_GET_MBID_BCN_NUM_V2(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCN_NUM_V2) & BIT_MASK_MBID_BCN_NUM_V2) -+#define BIT_SET_MBID_BCN_NUM_V2(x, v) \ -+ (BIT_CLEAR_MBID_BCN_NUM_V2(x) | BIT_MBID_BCN_NUM_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBID_NUM (Offset 0x0552) */ -+ -+#define BIT_EN_PRE_DL_BEACON BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBID_NUM (Offset 0x0552) */ -+ -+#define BIT_SHIFT_MBID_BCN_NUM 0 -+#define BIT_MASK_MBID_BCN_NUM 0x7 -+#define BIT_MBID_BCN_NUM(x) \ -+ (((x) & BIT_MASK_MBID_BCN_NUM) << BIT_SHIFT_MBID_BCN_NUM) -+#define BITS_MBID_BCN_NUM (BIT_MASK_MBID_BCN_NUM << BIT_SHIFT_MBID_BCN_NUM) -+#define BIT_CLEAR_MBID_BCN_NUM(x) ((x) & (~BITS_MBID_BCN_NUM)) -+#define BIT_GET_MBID_BCN_NUM(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCN_NUM) & BIT_MASK_MBID_BCN_NUM) -+#define BIT_SET_MBID_BCN_NUM(x, v) \ -+ (BIT_CLEAR_MBID_BCN_NUM(x) | BIT_MBID_BCN_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_P2P_PWR_RST1 BIT(6) -+#define BIT_SCHEDULER_RST BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_FREECNT_RST BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_P2P_PWR_RST0 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_TSFTR_CLI3_RST BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_TSFTR1_SYNC_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_TSFTR_CLI2_RST BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_TSFTR_SYNC_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_TSFTR_CLI1_RST BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_TSFTR1_RST BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_TSFTR_CLI0_RST BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DUAL_TSF_RST (Offset 0x0553) */ -+ -+#define BIT_TSFTR_RST BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBSSID_BCN_SPACE (Offset 0x0554) */ -+ -+#define BIT_SHIFT_BCN_TIMER_SEL_FWRD 28 -+#define BIT_MASK_BCN_TIMER_SEL_FWRD 0x7 -+#define BIT_BCN_TIMER_SEL_FWRD(x) \ -+ (((x) & BIT_MASK_BCN_TIMER_SEL_FWRD) << BIT_SHIFT_BCN_TIMER_SEL_FWRD) -+#define BITS_BCN_TIMER_SEL_FWRD \ -+ (BIT_MASK_BCN_TIMER_SEL_FWRD << BIT_SHIFT_BCN_TIMER_SEL_FWRD) -+#define BIT_CLEAR_BCN_TIMER_SEL_FWRD(x) ((x) & (~BITS_BCN_TIMER_SEL_FWRD)) -+#define BIT_GET_BCN_TIMER_SEL_FWRD(x) \ -+ (((x) >> BIT_SHIFT_BCN_TIMER_SEL_FWRD) & BIT_MASK_BCN_TIMER_SEL_FWRD) -+#define BIT_SET_BCN_TIMER_SEL_FWRD(x, v) \ -+ (BIT_CLEAR_BCN_TIMER_SEL_FWRD(x) | BIT_BCN_TIMER_SEL_FWRD(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBSSID_BCN_SPACE (Offset 0x0554) */ -+ -+#define BIT_SHIFT_BCN_SPACE1 16 -+#define BIT_MASK_BCN_SPACE1 0xffff -+#define BIT_BCN_SPACE1(x) (((x) & BIT_MASK_BCN_SPACE1) << BIT_SHIFT_BCN_SPACE1) -+#define BITS_BCN_SPACE1 (BIT_MASK_BCN_SPACE1 << BIT_SHIFT_BCN_SPACE1) -+#define BIT_CLEAR_BCN_SPACE1(x) ((x) & (~BITS_BCN_SPACE1)) -+#define BIT_GET_BCN_SPACE1(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE1) & BIT_MASK_BCN_SPACE1) -+#define BIT_SET_BCN_SPACE1(x, v) (BIT_CLEAR_BCN_SPACE1(x) | BIT_BCN_SPACE1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBSSID_BCN_SPACE (Offset 0x0554) */ -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT0 16 -+#define BIT_MASK_BCN_SPACE_CLINT0 0xfff -+#define BIT_BCN_SPACE_CLINT0(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT0) << BIT_SHIFT_BCN_SPACE_CLINT0) -+#define BITS_BCN_SPACE_CLINT0 \ -+ (BIT_MASK_BCN_SPACE_CLINT0 << BIT_SHIFT_BCN_SPACE_CLINT0) -+#define BIT_CLEAR_BCN_SPACE_CLINT0(x) ((x) & (~BITS_BCN_SPACE_CLINT0)) -+#define BIT_GET_BCN_SPACE_CLINT0(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT0) & BIT_MASK_BCN_SPACE_CLINT0) -+#define BIT_SET_BCN_SPACE_CLINT0(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT0(x) | BIT_BCN_SPACE_CLINT0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBSSID_BCN_SPACE (Offset 0x0554) */ -+ -+#define BIT_SHIFT_BCN_SPACE0 0 -+#define BIT_MASK_BCN_SPACE0 0xffff -+#define BIT_BCN_SPACE0(x) (((x) & BIT_MASK_BCN_SPACE0) << BIT_SHIFT_BCN_SPACE0) -+#define BITS_BCN_SPACE0 (BIT_MASK_BCN_SPACE0 << BIT_SHIFT_BCN_SPACE0) -+#define BIT_CLEAR_BCN_SPACE0(x) ((x) & (~BITS_BCN_SPACE0)) -+#define BIT_GET_BCN_SPACE0(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE0) & BIT_MASK_BCN_SPACE0) -+#define BIT_SET_BCN_SPACE0(x, v) (BIT_CLEAR_BCN_SPACE0(x) | BIT_BCN_SPACE0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ATIMWND (Offset 0x055A) */ -+ -+#define BIT_SHIFT_ATIMWND 0 -+#define BIT_MASK_ATIMWND 0xffff -+#define BIT_ATIMWND(x) (((x) & BIT_MASK_ATIMWND) << BIT_SHIFT_ATIMWND) -+#define BITS_ATIMWND (BIT_MASK_ATIMWND << BIT_SHIFT_ATIMWND) -+#define BIT_CLEAR_ATIMWND(x) ((x) & (~BITS_ATIMWND)) -+#define BIT_GET_ATIMWND(x) (((x) >> BIT_SHIFT_ATIMWND) & BIT_MASK_ATIMWND) -+#define BIT_SET_ATIMWND(x, v) (BIT_CLEAR_ATIMWND(x) | BIT_ATIMWND(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ATIMWND (Offset 0x055A) */ -+ -+#define BIT_SHIFT_ATIMWND0 0 -+#define BIT_MASK_ATIMWND0 0xffff -+#define BIT_ATIMWND0(x) (((x) & BIT_MASK_ATIMWND0) << BIT_SHIFT_ATIMWND0) -+#define BITS_ATIMWND0 (BIT_MASK_ATIMWND0 << BIT_SHIFT_ATIMWND0) -+#define BIT_CLEAR_ATIMWND0(x) ((x) & (~BITS_ATIMWND0)) -+#define BIT_GET_ATIMWND0(x) (((x) >> BIT_SHIFT_ATIMWND0) & BIT_MASK_ATIMWND0) -+#define BIT_SET_ATIMWND0(x, v) (BIT_CLEAR_ATIMWND0(x) | BIT_ATIMWND0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_USTIME_TSF (Offset 0x055C) */ -+ -+#define BIT_SHIFT_USTIME_TSF_V1 0 -+#define BIT_MASK_USTIME_TSF_V1 0xff -+#define BIT_USTIME_TSF_V1(x) \ -+ (((x) & BIT_MASK_USTIME_TSF_V1) << BIT_SHIFT_USTIME_TSF_V1) -+#define BITS_USTIME_TSF_V1 (BIT_MASK_USTIME_TSF_V1 << BIT_SHIFT_USTIME_TSF_V1) -+#define BIT_CLEAR_USTIME_TSF_V1(x) ((x) & (~BITS_USTIME_TSF_V1)) -+#define BIT_GET_USTIME_TSF_V1(x) \ -+ (((x) >> BIT_SHIFT_USTIME_TSF_V1) & BIT_MASK_USTIME_TSF_V1) -+#define BIT_SET_USTIME_TSF_V1(x, v) \ -+ (BIT_CLEAR_USTIME_TSF_V1(x) | BIT_USTIME_TSF_V1(v)) -+ -+/* 2 REG_BCN_MAX_ERR (Offset 0x055D) */ -+ -+#define BIT_SHIFT_BCN_MAX_ERR 0 -+#define BIT_MASK_BCN_MAX_ERR 0xff -+#define BIT_BCN_MAX_ERR(x) \ -+ (((x) & BIT_MASK_BCN_MAX_ERR) << BIT_SHIFT_BCN_MAX_ERR) -+#define BITS_BCN_MAX_ERR (BIT_MASK_BCN_MAX_ERR << BIT_SHIFT_BCN_MAX_ERR) -+#define BIT_CLEAR_BCN_MAX_ERR(x) ((x) & (~BITS_BCN_MAX_ERR)) -+#define BIT_GET_BCN_MAX_ERR(x) \ -+ (((x) >> BIT_SHIFT_BCN_MAX_ERR) & BIT_MASK_BCN_MAX_ERR) -+#define BIT_SET_BCN_MAX_ERR(x, v) \ -+ (BIT_CLEAR_BCN_MAX_ERR(x) | BIT_BCN_MAX_ERR(v)) -+ -+/* 2 REG_RXTSF_OFFSET_CCK (Offset 0x055E) */ -+ -+#define BIT_SHIFT_CCK_RXTSF_OFFSET 0 -+#define BIT_MASK_CCK_RXTSF_OFFSET 0xff -+#define BIT_CCK_RXTSF_OFFSET(x) \ -+ (((x) & BIT_MASK_CCK_RXTSF_OFFSET) << BIT_SHIFT_CCK_RXTSF_OFFSET) -+#define BITS_CCK_RXTSF_OFFSET \ -+ (BIT_MASK_CCK_RXTSF_OFFSET << BIT_SHIFT_CCK_RXTSF_OFFSET) -+#define BIT_CLEAR_CCK_RXTSF_OFFSET(x) ((x) & (~BITS_CCK_RXTSF_OFFSET)) -+#define BIT_GET_CCK_RXTSF_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_CCK_RXTSF_OFFSET) & BIT_MASK_CCK_RXTSF_OFFSET) -+#define BIT_SET_CCK_RXTSF_OFFSET(x, v) \ -+ (BIT_CLEAR_CCK_RXTSF_OFFSET(x) | BIT_CCK_RXTSF_OFFSET(v)) -+ -+/* 2 REG_RXTSF_OFFSET_OFDM (Offset 0x055F) */ -+ -+#define BIT_SHIFT_OFDM_RXTSF_OFFSET 0 -+#define BIT_MASK_OFDM_RXTSF_OFFSET 0xff -+#define BIT_OFDM_RXTSF_OFFSET(x) \ -+ (((x) & BIT_MASK_OFDM_RXTSF_OFFSET) << BIT_SHIFT_OFDM_RXTSF_OFFSET) -+#define BITS_OFDM_RXTSF_OFFSET \ -+ (BIT_MASK_OFDM_RXTSF_OFFSET << BIT_SHIFT_OFDM_RXTSF_OFFSET) -+#define BIT_CLEAR_OFDM_RXTSF_OFFSET(x) ((x) & (~BITS_OFDM_RXTSF_OFFSET)) -+#define BIT_GET_OFDM_RXTSF_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_OFDM_RXTSF_OFFSET) & BIT_MASK_OFDM_RXTSF_OFFSET) -+#define BIT_SET_OFDM_RXTSF_OFFSET(x, v) \ -+ (BIT_CLEAR_OFDM_RXTSF_OFFSET(x) | BIT_OFDM_RXTSF_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TSFTR (Offset 0x0560) */ -+ -+#define BIT_SHIFT_TSF_TIMER 0 -+#define BIT_MASK_TSF_TIMER 0xffffffffffffffffL -+#define BIT_TSF_TIMER(x) (((x) & BIT_MASK_TSF_TIMER) << BIT_SHIFT_TSF_TIMER) -+#define BITS_TSF_TIMER (BIT_MASK_TSF_TIMER << BIT_SHIFT_TSF_TIMER) -+#define BIT_CLEAR_TSF_TIMER(x) ((x) & (~BITS_TSF_TIMER)) -+#define BIT_GET_TSF_TIMER(x) (((x) >> BIT_SHIFT_TSF_TIMER) & BIT_MASK_TSF_TIMER) -+#define BIT_SET_TSF_TIMER(x, v) (BIT_CLEAR_TSF_TIMER(x) | BIT_TSF_TIMER(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TSFTR0_L (Offset 0x0560) */ -+ -+#define BIT_SHIFT_TSF0_TIMER_L 0 -+#define BIT_MASK_TSF0_TIMER_L 0xffffffffL -+#define BIT_TSF0_TIMER_L(x) \ -+ (((x) & BIT_MASK_TSF0_TIMER_L) << BIT_SHIFT_TSF0_TIMER_L) -+#define BITS_TSF0_TIMER_L (BIT_MASK_TSF0_TIMER_L << BIT_SHIFT_TSF0_TIMER_L) -+#define BIT_CLEAR_TSF0_TIMER_L(x) ((x) & (~BITS_TSF0_TIMER_L)) -+#define BIT_GET_TSF0_TIMER_L(x) \ -+ (((x) >> BIT_SHIFT_TSF0_TIMER_L) & BIT_MASK_TSF0_TIMER_L) -+#define BIT_SET_TSF0_TIMER_L(x, v) \ -+ (BIT_CLEAR_TSF0_TIMER_L(x) | BIT_TSF0_TIMER_L(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSFTR (Offset 0x0560) */ -+ -+#define BIT_SHIFT_TSF_TIMER_V1 0 -+#define BIT_MASK_TSF_TIMER_V1 0xffffffffL -+#define BIT_TSF_TIMER_V1(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_V1) << BIT_SHIFT_TSF_TIMER_V1) -+#define BITS_TSF_TIMER_V1 (BIT_MASK_TSF_TIMER_V1 << BIT_SHIFT_TSF_TIMER_V1) -+#define BIT_CLEAR_TSF_TIMER_V1(x) ((x) & (~BITS_TSF_TIMER_V1)) -+#define BIT_GET_TSF_TIMER_V1(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_V1) & BIT_MASK_TSF_TIMER_V1) -+#define BIT_SET_TSF_TIMER_V1(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_V1(x) | BIT_TSF_TIMER_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TSFTR0_H (Offset 0x0564) */ -+ -+#define BIT_SHIFT_TSF0_TIMER_H 0 -+#define BIT_MASK_TSF0_TIMER_H 0xffffffffL -+#define BIT_TSF0_TIMER_H(x) \ -+ (((x) & BIT_MASK_TSF0_TIMER_H) << BIT_SHIFT_TSF0_TIMER_H) -+#define BITS_TSF0_TIMER_H (BIT_MASK_TSF0_TIMER_H << BIT_SHIFT_TSF0_TIMER_H) -+#define BIT_CLEAR_TSF0_TIMER_H(x) ((x) & (~BITS_TSF0_TIMER_H)) -+#define BIT_GET_TSF0_TIMER_H(x) \ -+ (((x) >> BIT_SHIFT_TSF0_TIMER_H) & BIT_MASK_TSF0_TIMER_H) -+#define BIT_SET_TSF0_TIMER_H(x, v) \ -+ (BIT_CLEAR_TSF0_TIMER_H(x) | BIT_TSF0_TIMER_H(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSFTR_1 (Offset 0x0564) */ -+ -+#define BIT_SHIFT_TSF_TIMER_V2 0 -+#define BIT_MASK_TSF_TIMER_V2 0xffffffffL -+#define BIT_TSF_TIMER_V2(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_V2) << BIT_SHIFT_TSF_TIMER_V2) -+#define BITS_TSF_TIMER_V2 (BIT_MASK_TSF_TIMER_V2 << BIT_SHIFT_TSF_TIMER_V2) -+#define BIT_CLEAR_TSF_TIMER_V2(x) ((x) & (~BITS_TSF_TIMER_V2)) -+#define BIT_GET_TSF_TIMER_V2(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_V2) & BIT_MASK_TSF_TIMER_V2) -+#define BIT_SET_TSF_TIMER_V2(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_V2(x) | BIT_TSF_TIMER_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TSFTR1 (Offset 0x0568) */ -+ -+#define BIT_SHIFT_TSF_TIMER1 0 -+#define BIT_MASK_TSF_TIMER1 0xffffffffffffffffL -+#define BIT_TSF_TIMER1(x) (((x) & BIT_MASK_TSF_TIMER1) << BIT_SHIFT_TSF_TIMER1) -+#define BITS_TSF_TIMER1 (BIT_MASK_TSF_TIMER1 << BIT_SHIFT_TSF_TIMER1) -+#define BIT_CLEAR_TSF_TIMER1(x) ((x) & (~BITS_TSF_TIMER1)) -+#define BIT_GET_TSF_TIMER1(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER1) & BIT_MASK_TSF_TIMER1) -+#define BIT_SET_TSF_TIMER1(x, v) (BIT_CLEAR_TSF_TIMER1(x) | BIT_TSF_TIMER1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TSFTR1_L (Offset 0x0568) */ -+ -+#define BIT_SHIFT_TSF1_TIMER_L 0 -+#define BIT_MASK_TSF1_TIMER_L 0xffffffffL -+#define BIT_TSF1_TIMER_L(x) \ -+ (((x) & BIT_MASK_TSF1_TIMER_L) << BIT_SHIFT_TSF1_TIMER_L) -+#define BITS_TSF1_TIMER_L (BIT_MASK_TSF1_TIMER_L << BIT_SHIFT_TSF1_TIMER_L) -+#define BIT_CLEAR_TSF1_TIMER_L(x) ((x) & (~BITS_TSF1_TIMER_L)) -+#define BIT_GET_TSF1_TIMER_L(x) \ -+ (((x) >> BIT_SHIFT_TSF1_TIMER_L) & BIT_MASK_TSF1_TIMER_L) -+#define BIT_SET_TSF1_TIMER_L(x, v) \ -+ (BIT_CLEAR_TSF1_TIMER_L(x) | BIT_TSF1_TIMER_L(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FREERUN_CNT (Offset 0x0568) */ -+ -+#define BIT_SHIFT_FREERUN_CNT 0 -+#define BIT_MASK_FREERUN_CNT 0xffffffffffffffffL -+#define BIT_FREERUN_CNT(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT) << BIT_SHIFT_FREERUN_CNT) -+#define BITS_FREERUN_CNT (BIT_MASK_FREERUN_CNT << BIT_SHIFT_FREERUN_CNT) -+#define BIT_CLEAR_FREERUN_CNT(x) ((x) & (~BITS_FREERUN_CNT)) -+#define BIT_GET_FREERUN_CNT(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT) & BIT_MASK_FREERUN_CNT) -+#define BIT_SET_FREERUN_CNT(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT(x) | BIT_FREERUN_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FREERUN_CNT (Offset 0x0568) */ -+ -+#define BIT_SHIFT_FREERUN_CNT_V1 0 -+#define BIT_MASK_FREERUN_CNT_V1 0xffffffffL -+#define BIT_FREERUN_CNT_V1(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_V1) << BIT_SHIFT_FREERUN_CNT_V1) -+#define BITS_FREERUN_CNT_V1 \ -+ (BIT_MASK_FREERUN_CNT_V1 << BIT_SHIFT_FREERUN_CNT_V1) -+#define BIT_CLEAR_FREERUN_CNT_V1(x) ((x) & (~BITS_FREERUN_CNT_V1)) -+#define BIT_GET_FREERUN_CNT_V1(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_V1) & BIT_MASK_FREERUN_CNT_V1) -+#define BIT_SET_FREERUN_CNT_V1(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_V1(x) | BIT_FREERUN_CNT_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TSFTR1_H (Offset 0x056C) */ -+ -+#define BIT_SHIFT_TSF1_TIMER_H 0 -+#define BIT_MASK_TSF1_TIMER_H 0xffffffffL -+#define BIT_TSF1_TIMER_H(x) \ -+ (((x) & BIT_MASK_TSF1_TIMER_H) << BIT_SHIFT_TSF1_TIMER_H) -+#define BITS_TSF1_TIMER_H (BIT_MASK_TSF1_TIMER_H << BIT_SHIFT_TSF1_TIMER_H) -+#define BIT_CLEAR_TSF1_TIMER_H(x) ((x) & (~BITS_TSF1_TIMER_H)) -+#define BIT_GET_TSF1_TIMER_H(x) \ -+ (((x) >> BIT_SHIFT_TSF1_TIMER_H) & BIT_MASK_TSF1_TIMER_H) -+#define BIT_SET_TSF1_TIMER_H(x, v) \ -+ (BIT_CLEAR_TSF1_TIMER_H(x) | BIT_TSF1_TIMER_H(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FREERUN_CNT_1 (Offset 0x056C) */ -+ -+#define BIT_SHIFT_FREERUN_CNT_V2 0 -+#define BIT_MASK_FREERUN_CNT_V2 0xffffffffL -+#define BIT_FREERUN_CNT_V2(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_V2) << BIT_SHIFT_FREERUN_CNT_V2) -+#define BITS_FREERUN_CNT_V2 \ -+ (BIT_MASK_FREERUN_CNT_V2 << BIT_SHIFT_FREERUN_CNT_V2) -+#define BIT_CLEAR_FREERUN_CNT_V2(x) ((x) & (~BITS_FREERUN_CNT_V2)) -+#define BIT_GET_FREERUN_CNT_V2(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_V2) & BIT_MASK_FREERUN_CNT_V2) -+#define BIT_SET_FREERUN_CNT_V2(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_V2(x) | BIT_FREERUN_CNT_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ATIMWND1 (Offset 0x0570) */ -+ -+#define BIT_SHIFT_ATIMWND1 0 -+#define BIT_MASK_ATIMWND1 0xffff -+#define BIT_ATIMWND1(x) (((x) & BIT_MASK_ATIMWND1) << BIT_SHIFT_ATIMWND1) -+#define BITS_ATIMWND1 (BIT_MASK_ATIMWND1 << BIT_SHIFT_ATIMWND1) -+#define BIT_CLEAR_ATIMWND1(x) ((x) & (~BITS_ATIMWND1)) -+#define BIT_GET_ATIMWND1(x) (((x) >> BIT_SHIFT_ATIMWND1) & BIT_MASK_ATIMWND1) -+#define BIT_SET_ATIMWND1(x, v) (BIT_CLEAR_ATIMWND1(x) | BIT_ATIMWND1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_ATIMWND1_V1 (Offset 0x0570) */ -+ -+#define BIT_SHIFT_ATIMWND1_V2 0 -+#define BIT_MASK_ATIMWND1_V2 0xffff -+#define BIT_ATIMWND1_V2(x) \ -+ (((x) & BIT_MASK_ATIMWND1_V2) << BIT_SHIFT_ATIMWND1_V2) -+#define BITS_ATIMWND1_V2 (BIT_MASK_ATIMWND1_V2 << BIT_SHIFT_ATIMWND1_V2) -+#define BIT_CLEAR_ATIMWND1_V2(x) ((x) & (~BITS_ATIMWND1_V2)) -+#define BIT_GET_ATIMWND1_V2(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND1_V2) & BIT_MASK_ATIMWND1_V2) -+#define BIT_SET_ATIMWND1_V2(x, v) \ -+ (BIT_CLEAR_ATIMWND1_V2(x) | BIT_ATIMWND1_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ATIMWND1_V1 (Offset 0x0570) */ -+ -+#define BIT_SHIFT_ATIMWND1_V1 0 -+#define BIT_MASK_ATIMWND1_V1 0xff -+#define BIT_ATIMWND1_V1(x) \ -+ (((x) & BIT_MASK_ATIMWND1_V1) << BIT_SHIFT_ATIMWND1_V1) -+#define BITS_ATIMWND1_V1 (BIT_MASK_ATIMWND1_V1 << BIT_SHIFT_ATIMWND1_V1) -+#define BIT_CLEAR_ATIMWND1_V1(x) ((x) & (~BITS_ATIMWND1_V1)) -+#define BIT_GET_ATIMWND1_V1(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND1_V1) & BIT_MASK_ATIMWND1_V1) -+#define BIT_SET_ATIMWND1_V1(x, v) \ -+ (BIT_CLEAR_ATIMWND1_V1(x) | BIT_ATIMWND1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TBTT_PROHIBIT_INFRA (Offset 0x0571) */ -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_INFRA 0 -+#define BIT_MASK_TBTT_PROHIBIT_INFRA 0xff -+#define BIT_TBTT_PROHIBIT_INFRA(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_INFRA) << BIT_SHIFT_TBTT_PROHIBIT_INFRA) -+#define BITS_TBTT_PROHIBIT_INFRA \ -+ (BIT_MASK_TBTT_PROHIBIT_INFRA << BIT_SHIFT_TBTT_PROHIBIT_INFRA) -+#define BIT_CLEAR_TBTT_PROHIBIT_INFRA(x) ((x) & (~BITS_TBTT_PROHIBIT_INFRA)) -+#define BIT_GET_TBTT_PROHIBIT_INFRA(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_INFRA) & BIT_MASK_TBTT_PROHIBIT_INFRA) -+#define BIT_SET_TBTT_PROHIBIT_INFRA(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_INFRA(x) | BIT_TBTT_PROHIBIT_INFRA(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCNIVLCUNT (Offset 0x0573) */ -+ -+#define BIT_SHIFT_BCNIVLCUNT 0 -+#define BIT_MASK_BCNIVLCUNT 0x7f -+#define BIT_BCNIVLCUNT(x) (((x) & BIT_MASK_BCNIVLCUNT) << BIT_SHIFT_BCNIVLCUNT) -+#define BITS_BCNIVLCUNT (BIT_MASK_BCNIVLCUNT << BIT_SHIFT_BCNIVLCUNT) -+#define BIT_CLEAR_BCNIVLCUNT(x) ((x) & (~BITS_BCNIVLCUNT)) -+#define BIT_GET_BCNIVLCUNT(x) \ -+ (((x) >> BIT_SHIFT_BCNIVLCUNT) & BIT_MASK_BCNIVLCUNT) -+#define BIT_SET_BCNIVLCUNT(x, v) (BIT_CLEAR_BCNIVLCUNT(x) | BIT_BCNIVLCUNT(v)) -+ -+/* 2 REG_BCNDROPCTRL (Offset 0x0574) */ -+ -+#define BIT_BEACON_DROP_EN BIT(7) -+ -+#define BIT_SHIFT_BEACON_DROP_IVL 0 -+#define BIT_MASK_BEACON_DROP_IVL 0x7f -+#define BIT_BEACON_DROP_IVL(x) \ -+ (((x) & BIT_MASK_BEACON_DROP_IVL) << BIT_SHIFT_BEACON_DROP_IVL) -+#define BITS_BEACON_DROP_IVL \ -+ (BIT_MASK_BEACON_DROP_IVL << BIT_SHIFT_BEACON_DROP_IVL) -+#define BIT_CLEAR_BEACON_DROP_IVL(x) ((x) & (~BITS_BEACON_DROP_IVL)) -+#define BIT_GET_BEACON_DROP_IVL(x) \ -+ (((x) >> BIT_SHIFT_BEACON_DROP_IVL) & BIT_MASK_BEACON_DROP_IVL) -+#define BIT_SET_BEACON_DROP_IVL(x, v) \ -+ (BIT_CLEAR_BEACON_DROP_IVL(x) | BIT_BEACON_DROP_IVL(v)) -+ -+/* 2 REG_HGQ_TIMEOUT_PERIOD (Offset 0x0575) */ -+ -+#define BIT_SHIFT_HGQ_TIMEOUT_PERIOD 0 -+#define BIT_MASK_HGQ_TIMEOUT_PERIOD 0xff -+#define BIT_HGQ_TIMEOUT_PERIOD(x) \ -+ (((x) & BIT_MASK_HGQ_TIMEOUT_PERIOD) << BIT_SHIFT_HGQ_TIMEOUT_PERIOD) -+#define BITS_HGQ_TIMEOUT_PERIOD \ -+ (BIT_MASK_HGQ_TIMEOUT_PERIOD << BIT_SHIFT_HGQ_TIMEOUT_PERIOD) -+#define BIT_CLEAR_HGQ_TIMEOUT_PERIOD(x) ((x) & (~BITS_HGQ_TIMEOUT_PERIOD)) -+#define BIT_GET_HGQ_TIMEOUT_PERIOD(x) \ -+ (((x) >> BIT_SHIFT_HGQ_TIMEOUT_PERIOD) & BIT_MASK_HGQ_TIMEOUT_PERIOD) -+#define BIT_SET_HGQ_TIMEOUT_PERIOD(x, v) \ -+ (BIT_CLEAR_HGQ_TIMEOUT_PERIOD(x) | BIT_HGQ_TIMEOUT_PERIOD(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXCMD_TIMEOUT_PERIOD (Offset 0x0576) */ -+ -+#define BIT_SHIFT_TXCMD_TIMEOUT_PERIOD 0 -+#define BIT_MASK_TXCMD_TIMEOUT_PERIOD 0xff -+#define BIT_TXCMD_TIMEOUT_PERIOD(x) \ -+ (((x) & BIT_MASK_TXCMD_TIMEOUT_PERIOD) \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD) -+#define BITS_TXCMD_TIMEOUT_PERIOD \ -+ (BIT_MASK_TXCMD_TIMEOUT_PERIOD << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD) -+#define BIT_CLEAR_TXCMD_TIMEOUT_PERIOD(x) ((x) & (~BITS_TXCMD_TIMEOUT_PERIOD)) -+#define BIT_GET_TXCMD_TIMEOUT_PERIOD(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_TIMEOUT_PERIOD) & \ -+ BIT_MASK_TXCMD_TIMEOUT_PERIOD) -+#define BIT_SET_TXCMD_TIMEOUT_PERIOD(x, v) \ -+ (BIT_CLEAR_TXCMD_TIMEOUT_PERIOD(x) | BIT_TXCMD_TIMEOUT_PERIOD(v)) -+ -+#define BIT_SHIFT_EARLY_128US 0 -+#define BIT_MASK_EARLY_128US 0x7 -+#define BIT_EARLY_128US(x) \ -+ (((x) & BIT_MASK_EARLY_128US) << BIT_SHIFT_EARLY_128US) -+#define BITS_EARLY_128US (BIT_MASK_EARLY_128US << BIT_SHIFT_EARLY_128US) -+#define BIT_CLEAR_EARLY_128US(x) ((x) & (~BITS_EARLY_128US)) -+#define BIT_GET_EARLY_128US(x) \ -+ (((x) >> BIT_SHIFT_EARLY_128US) & BIT_MASK_EARLY_128US) -+#define BIT_SET_EARLY_128US(x, v) \ -+ (BIT_CLEAR_EARLY_128US(x) | BIT_EARLY_128US(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MISC_CTRL (Offset 0x0577) */ -+ -+#define BIT_DIS_MARK_TSF_US BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MISC_CTRL (Offset 0x0577) */ -+ -+#define BIT_DIS_MARK_TSF_US_V2 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MISC_CTRL (Offset 0x0577) */ -+ -+#define BIT_EN_TSFAUTO_SYNC BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MISC_CTRL (Offset 0x0577) */ -+ -+#define BIT_AUTO_SYNC_BY_TBTT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MISC_CTRL (Offset 0x0577) */ -+ -+#define BIT_DIS_TRX_CAL_BCN BIT(5) -+#define BIT_DIS_TX_CAL_TBTT BIT(4) -+#define BIT_EN_FREECNT BIT(3) -+#define BIT_BCN_AGGRESSION BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MISC_CTRL (Offset 0x0577) */ -+ -+#define BIT_DIS_SECONDARY_CCA_80M BIT(2) -+#define BIT_DIS_SECONDARY_CCA_40M BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MISC_CTRL (Offset 0x0577) */ -+ -+#define BIT_SHIFT_DIS_SECONDARY_CCA 0 -+#define BIT_MASK_DIS_SECONDARY_CCA 0x3 -+#define BIT_DIS_SECONDARY_CCA(x) \ -+ (((x) & BIT_MASK_DIS_SECONDARY_CCA) << BIT_SHIFT_DIS_SECONDARY_CCA) -+#define BITS_DIS_SECONDARY_CCA \ -+ (BIT_MASK_DIS_SECONDARY_CCA << BIT_SHIFT_DIS_SECONDARY_CCA) -+#define BIT_CLEAR_DIS_SECONDARY_CCA(x) ((x) & (~BITS_DIS_SECONDARY_CCA)) -+#define BIT_GET_DIS_SECONDARY_CCA(x) \ -+ (((x) >> BIT_SHIFT_DIS_SECONDARY_CCA) & BIT_MASK_DIS_SECONDARY_CCA) -+#define BIT_SET_DIS_SECONDARY_CCA(x, v) \ -+ (BIT_CLEAR_DIS_SECONDARY_CCA(x) | BIT_DIS_SECONDARY_CCA(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MISC_CTRL (Offset 0x0577) */ -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI0 0 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI0 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI0(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI0) << BIT_SHIFT_TBTT_INT_SHIFT_CLI0) -+#define BITS_TBTT_INT_SHIFT_CLI0 \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI0 << BIT_SHIFT_TBTT_INT_SHIFT_CLI0) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI0(x) ((x) & (~BITS_TBTT_INT_SHIFT_CLI0)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI0(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI0) & BIT_MASK_TBTT_INT_SHIFT_CLI0) -+#define BIT_SET_TBTT_INT_SHIFT_CLI0(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI0(x) | BIT_TBTT_INT_SHIFT_CLI0(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MISC_CTRL (Offset 0x0577) */ -+ -+#define BIT_DIS_SECONDARY_CCA_20M BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT1 (Offset 0x0578) */ -+ -+#define BIT_CLI1_DIS_RX_BSSID_FIT BIT(6) -+#define BIT_CLI1_DIS_TSF_UDT BIT(4) -+#define BIT_CLI1_EN_BCN_FUNCTION BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT1 (Offset 0x0578) */ -+ -+#define BIT_CLI1_EN_RXBCN_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT1 (Offset 0x0578) */ -+ -+#define BIT_CLI1_EN_BCN_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT1 (Offset 0x0578) */ -+ -+#define BIT_CLI1_ENP2P_CTWINDOW BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TSFTR2_L (Offset 0x0578) */ -+ -+#define BIT_SHIFT_TSF2_TIMER_L 0 -+#define BIT_MASK_TSF2_TIMER_L 0xffffffffL -+#define BIT_TSF2_TIMER_L(x) \ -+ (((x) & BIT_MASK_TSF2_TIMER_L) << BIT_SHIFT_TSF2_TIMER_L) -+#define BITS_TSF2_TIMER_L (BIT_MASK_TSF2_TIMER_L << BIT_SHIFT_TSF2_TIMER_L) -+#define BIT_CLEAR_TSF2_TIMER_L(x) ((x) & (~BITS_TSF2_TIMER_L)) -+#define BIT_GET_TSF2_TIMER_L(x) \ -+ (((x) >> BIT_SHIFT_TSF2_TIMER_L) & BIT_MASK_TSF2_TIMER_L) -+#define BIT_SET_TSF2_TIMER_L(x, v) \ -+ (BIT_CLEAR_TSF2_TIMER_L(x) | BIT_TSF2_TIMER_L(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT1 (Offset 0x0578) */ -+ -+#define BIT_CLI1_ENP2P_BCNQ_AREA BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT2 (Offset 0x0579) */ -+ -+#define BIT_CLI2_DIS_RX_BSSID_FIT BIT(6) -+#define BIT_CLI2_DIS_TSF_UDT BIT(4) -+#define BIT_CLI2_EN_BCN_FUNCTION BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT2 (Offset 0x0579) */ -+ -+#define BIT_CLI2_EN_RXBCN_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT2 (Offset 0x0579) */ -+ -+#define BIT_CLI2_EN_BCN_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT2 (Offset 0x0579) */ -+ -+#define BIT_CLI2_ENP2P_CTWINDOW BIT(1) -+#define BIT_CLI2_ENP2P_BCNQ_AREA BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT3 (Offset 0x057A) */ -+ -+#define BIT_CLI3_DIS_RX_BSSID_FIT BIT(6) -+#define BIT_CLI3_DIS_TSF_UDT BIT(4) -+#define BIT_CLI3_EN_BCN_FUNCTION BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT3 (Offset 0x057A) */ -+ -+#define BIT_CLI3_EN_RXBCN_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT3 (Offset 0x057A) */ -+ -+#define BIT_CLI3_EN_BCN_RPT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_CTRL_CLINT3 (Offset 0x057A) */ -+ -+#define BIT_CLI3_ENP2P_CTWINDOW BIT(1) -+#define BIT_CLI3_ENP2P_BCNQ_AREA BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_EXTEND_CTRL (Offset 0x057B) */ -+ -+#define BIT_EN_TSFBIT32_RST_P2P2 BIT(5) -+#define BIT_EN_TSFBIT32_RST_P2P1 BIT(4) -+ -+#define BIT_SHIFT_PORT_SEL 0 -+#define BIT_MASK_PORT_SEL 0x7 -+#define BIT_PORT_SEL(x) (((x) & BIT_MASK_PORT_SEL) << BIT_SHIFT_PORT_SEL) -+#define BITS_PORT_SEL (BIT_MASK_PORT_SEL << BIT_SHIFT_PORT_SEL) -+#define BIT_CLEAR_PORT_SEL(x) ((x) & (~BITS_PORT_SEL)) -+#define BIT_GET_PORT_SEL(x) (((x) >> BIT_SHIFT_PORT_SEL) & BIT_MASK_PORT_SEL) -+#define BIT_SET_PORT_SEL(x, v) (BIT_CLEAR_PORT_SEL(x) | BIT_PORT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS1_SPEC_STATE (Offset 0x057C) */ -+ -+#define BIT_P2P1_SPEC_POWER_STATE BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS1_SPEC_STATE (Offset 0x057C) */ -+ -+#define BIT_P2P1_SPEC_CTWINDOW_ON BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS1_SPEC_STATE (Offset 0x057C) */ -+ -+#define BIT_P2P1_SPEC_BCN_AREA_ON BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS1_SPEC_STATE (Offset 0x057C) */ -+ -+#define BIT_P2P1_SPEC_CTWIN_EARLY_DISTX BIT(4) -+#define BIT_P2P1_SPEC_NOA1_OFF_PERIOD BIT(3) -+#define BIT_P2P1_SPEC_FORCE_DOZE1 BIT(2) -+#define BIT_P2P1_SPEC_NOA0_OFF_PERIOD BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TSFTR2_H (Offset 0x057C) */ -+ -+#define BIT_SHIFT_TSF2_TIMER_H 0 -+#define BIT_MASK_TSF2_TIMER_H 0xffffffffL -+#define BIT_TSF2_TIMER_H(x) \ -+ (((x) & BIT_MASK_TSF2_TIMER_H) << BIT_SHIFT_TSF2_TIMER_H) -+#define BITS_TSF2_TIMER_H (BIT_MASK_TSF2_TIMER_H << BIT_SHIFT_TSF2_TIMER_H) -+#define BIT_CLEAR_TSF2_TIMER_H(x) ((x) & (~BITS_TSF2_TIMER_H)) -+#define BIT_GET_TSF2_TIMER_H(x) \ -+ (((x) >> BIT_SHIFT_TSF2_TIMER_H) & BIT_MASK_TSF2_TIMER_H) -+#define BIT_SET_TSF2_TIMER_H(x, v) \ -+ (BIT_CLEAR_TSF2_TIMER_H(x) | BIT_TSF2_TIMER_H(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS1_SPEC_STATE (Offset 0x057C) */ -+ -+#define BIT_P2P1_SPEC_FORCE_DOZE0 BIT(0) -+ -+/* 2 REG_P2PPS1_STATE (Offset 0x057D) */ -+ -+#define BIT_P2P1_POWER_STATE BIT(7) -+#define BIT_P2P1_CTWINDOW_ON BIT(6) -+#define BIT_P2P1_BEACON_AREA_ON BIT(5) -+#define BIT_P2P1_CTWIN_EARLY_DISTX BIT(4) -+#define BIT_P2P1_NOA1_OFF_PERIOD BIT(3) -+#define BIT_P2P1_FORCE_DOZE1 BIT(2) -+#define BIT_P2P1_NOA0_OFF_PERIOD BIT(1) -+#define BIT_P2P1_FORCE_DOZE0 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS2_SPEC_STATE (Offset 0x057E) */ -+ -+#define BIT_P2P2_SPEC_POWER_STATE BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS2_SPEC_STATE (Offset 0x057E) */ -+ -+#define BIT_P2P2_SPEC_CTWINDOW_ON BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS2_SPEC_STATE (Offset 0x057E) */ -+ -+#define BIT_P2P2_SPEC_BCN_AREA_ON BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS2_SPEC_STATE (Offset 0x057E) */ -+ -+#define BIT_P2P2_SPEC_CTWIN_EARLY_DISTX BIT(4) -+#define BIT_P2P2_SPEC_NOA1_OFF_PERIOD BIT(3) -+#define BIT_P2P2_SPEC_FORCE_DOZE1 BIT(2) -+#define BIT_P2P2_SPEC_NOA0_OFF_PERIOD BIT(1) -+#define BIT_P2P2_SPEC_FORCE_DOZE0 BIT(0) -+ -+/* 2 REG_P2PPS2_STATE (Offset 0x057F) */ -+ -+#define BIT_P2P2_POWER_STATE BIT(7) -+#define BIT_P2P2_CTWINDOW_ON BIT(6) -+#define BIT_P2P2_BEACON_AREA_ON BIT(5) -+#define BIT_P2P2_CTWIN_EARLY_DISTX BIT(4) -+#define BIT_P2P2_NOA1_OFF_PERIOD BIT(3) -+#define BIT_P2P2_FORCE_DOZE1 BIT(2) -+#define BIT_P2P2_NOA0_OFF_PERIOD BIT(1) -+#define BIT_P2P2_FORCE_DOZE0 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PS_TIMER (Offset 0x0580) */ -+ -+#define BIT_SHIFT_PSTIMER 5 -+#define BIT_MASK_PSTIMER 0x7ffffff -+#define BIT_PSTIMER(x) (((x) & BIT_MASK_PSTIMER) << BIT_SHIFT_PSTIMER) -+#define BITS_PSTIMER (BIT_MASK_PSTIMER << BIT_SHIFT_PSTIMER) -+#define BIT_CLEAR_PSTIMER(x) ((x) & (~BITS_PSTIMER)) -+#define BIT_GET_PSTIMER(x) (((x) >> BIT_SHIFT_PSTIMER) & BIT_MASK_PSTIMER) -+#define BIT_SET_PSTIMER(x, v) (BIT_CLEAR_PSTIMER(x) | BIT_PSTIMER(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PS_TIMER0 (Offset 0x0580) */ -+ -+#define BIT_SHIFT_PSTIMER0_INT 5 -+#define BIT_MASK_PSTIMER0_INT 0x7ffffff -+#define BIT_PSTIMER0_INT(x) \ -+ (((x) & BIT_MASK_PSTIMER0_INT) << BIT_SHIFT_PSTIMER0_INT) -+#define BITS_PSTIMER0_INT (BIT_MASK_PSTIMER0_INT << BIT_SHIFT_PSTIMER0_INT) -+#define BIT_CLEAR_PSTIMER0_INT(x) ((x) & (~BITS_PSTIMER0_INT)) -+#define BIT_GET_PSTIMER0_INT(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER0_INT) & BIT_MASK_PSTIMER0_INT) -+#define BIT_SET_PSTIMER0_INT(x, v) \ -+ (BIT_CLEAR_PSTIMER0_INT(x) | BIT_PSTIMER0_INT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TIMER0 (Offset 0x0584) */ -+ -+#define BIT_SHIFT_TIMER0_INT 5 -+#define BIT_MASK_TIMER0_INT 0x7ffffff -+#define BIT_TIMER0_INT(x) (((x) & BIT_MASK_TIMER0_INT) << BIT_SHIFT_TIMER0_INT) -+#define BITS_TIMER0_INT (BIT_MASK_TIMER0_INT << BIT_SHIFT_TIMER0_INT) -+#define BIT_CLEAR_TIMER0_INT(x) ((x) & (~BITS_TIMER0_INT)) -+#define BIT_GET_TIMER0_INT(x) \ -+ (((x) >> BIT_SHIFT_TIMER0_INT) & BIT_MASK_TIMER0_INT) -+#define BIT_SET_TIMER0_INT(x, v) (BIT_CLEAR_TIMER0_INT(x) | BIT_TIMER0_INT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PS_TIMER1 (Offset 0x0584) */ -+ -+#define BIT_SHIFT_PSTIMER1_INT 5 -+#define BIT_MASK_PSTIMER1_INT 0x7ffffff -+#define BIT_PSTIMER1_INT(x) \ -+ (((x) & BIT_MASK_PSTIMER1_INT) << BIT_SHIFT_PSTIMER1_INT) -+#define BITS_PSTIMER1_INT (BIT_MASK_PSTIMER1_INT << BIT_SHIFT_PSTIMER1_INT) -+#define BIT_CLEAR_PSTIMER1_INT(x) ((x) & (~BITS_PSTIMER1_INT)) -+#define BIT_GET_PSTIMER1_INT(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER1_INT) & BIT_MASK_PSTIMER1_INT) -+#define BIT_SET_PSTIMER1_INT(x, v) \ -+ (BIT_CLEAR_PSTIMER1_INT(x) | BIT_PSTIMER1_INT(v)) -+ -+/* 2 REG_PS_TIMER2 (Offset 0x0588) */ -+ -+#define BIT_SHIFT_INFO_INDEX_OFFSET 16 -+#define BIT_MASK_INFO_INDEX_OFFSET 0x1fff -+#define BIT_INFO_INDEX_OFFSET(x) \ -+ (((x) & BIT_MASK_INFO_INDEX_OFFSET) << BIT_SHIFT_INFO_INDEX_OFFSET) -+#define BITS_INFO_INDEX_OFFSET \ -+ (BIT_MASK_INFO_INDEX_OFFSET << BIT_SHIFT_INFO_INDEX_OFFSET) -+#define BIT_CLEAR_INFO_INDEX_OFFSET(x) ((x) & (~BITS_INFO_INDEX_OFFSET)) -+#define BIT_GET_INFO_INDEX_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_INFO_INDEX_OFFSET) & BIT_MASK_INFO_INDEX_OFFSET) -+#define BIT_SET_INFO_INDEX_OFFSET(x, v) \ -+ (BIT_CLEAR_INFO_INDEX_OFFSET(x) | BIT_INFO_INDEX_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TIMER1 (Offset 0x0588) */ -+ -+#define BIT_SHIFT_TIMER1_INT 5 -+#define BIT_MASK_TIMER1_INT 0x7ffffff -+#define BIT_TIMER1_INT(x) (((x) & BIT_MASK_TIMER1_INT) << BIT_SHIFT_TIMER1_INT) -+#define BITS_TIMER1_INT (BIT_MASK_TIMER1_INT << BIT_SHIFT_TIMER1_INT) -+#define BIT_CLEAR_TIMER1_INT(x) ((x) & (~BITS_TIMER1_INT)) -+#define BIT_GET_TIMER1_INT(x) \ -+ (((x) >> BIT_SHIFT_TIMER1_INT) & BIT_MASK_TIMER1_INT) -+#define BIT_SET_TIMER1_INT(x, v) (BIT_CLEAR_TIMER1_INT(x) | BIT_TIMER1_INT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PS_TIMER2 (Offset 0x0588) */ -+ -+#define BIT_SHIFT_PSTIMER2_INT 5 -+#define BIT_MASK_PSTIMER2_INT 0x7ffffff -+#define BIT_PSTIMER2_INT(x) \ -+ (((x) & BIT_MASK_PSTIMER2_INT) << BIT_SHIFT_PSTIMER2_INT) -+#define BITS_PSTIMER2_INT (BIT_MASK_PSTIMER2_INT << BIT_SHIFT_PSTIMER2_INT) -+#define BIT_CLEAR_PSTIMER2_INT(x) ((x) & (~BITS_PSTIMER2_INT)) -+#define BIT_GET_PSTIMER2_INT(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER2_INT) & BIT_MASK_PSTIMER2_INT) -+#define BIT_SET_PSTIMER2_INT(x, v) \ -+ (BIT_CLEAR_PSTIMER2_INT(x) | BIT_PSTIMER2_INT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TBTT_CTN_AREA (Offset 0x058C) */ -+ -+#define BIT_SHIFT_TBTT_CTN_AREA 0 -+#define BIT_MASK_TBTT_CTN_AREA 0xff -+#define BIT_TBTT_CTN_AREA(x) \ -+ (((x) & BIT_MASK_TBTT_CTN_AREA) << BIT_SHIFT_TBTT_CTN_AREA) -+#define BITS_TBTT_CTN_AREA (BIT_MASK_TBTT_CTN_AREA << BIT_SHIFT_TBTT_CTN_AREA) -+#define BIT_CLEAR_TBTT_CTN_AREA(x) ((x) & (~BITS_TBTT_CTN_AREA)) -+#define BIT_GET_TBTT_CTN_AREA(x) \ -+ (((x) >> BIT_SHIFT_TBTT_CTN_AREA) & BIT_MASK_TBTT_CTN_AREA) -+#define BIT_SET_TBTT_CTN_AREA(x, v) \ -+ (BIT_CLEAR_TBTT_CTN_AREA(x) | BIT_TBTT_CTN_AREA(v)) -+ -+/* 2 REG_FORCE_BCN_IFS (Offset 0x058E) */ -+ -+#define BIT_SHIFT_FORCE_BCN_IFS 0 -+#define BIT_MASK_FORCE_BCN_IFS 0xff -+#define BIT_FORCE_BCN_IFS(x) \ -+ (((x) & BIT_MASK_FORCE_BCN_IFS) << BIT_SHIFT_FORCE_BCN_IFS) -+#define BITS_FORCE_BCN_IFS (BIT_MASK_FORCE_BCN_IFS << BIT_SHIFT_FORCE_BCN_IFS) -+#define BIT_CLEAR_FORCE_BCN_IFS(x) ((x) & (~BITS_FORCE_BCN_IFS)) -+#define BIT_GET_FORCE_BCN_IFS(x) \ -+ (((x) >> BIT_SHIFT_FORCE_BCN_IFS) & BIT_MASK_FORCE_BCN_IFS) -+#define BIT_SET_FORCE_BCN_IFS(x, v) \ -+ (BIT_CLEAR_FORCE_BCN_IFS(x) | BIT_FORCE_BCN_IFS(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DRVERLYINT_V1 (Offset 0x058F) */ -+ -+#define BIT_SHIFT_PRE_BCN_DMATIM 0 -+#define BIT_MASK_PRE_BCN_DMATIM 0xff -+#define BIT_PRE_BCN_DMATIM(x) \ -+ (((x) & BIT_MASK_PRE_BCN_DMATIM) << BIT_SHIFT_PRE_BCN_DMATIM) -+#define BITS_PRE_BCN_DMATIM \ -+ (BIT_MASK_PRE_BCN_DMATIM << BIT_SHIFT_PRE_BCN_DMATIM) -+#define BIT_CLEAR_PRE_BCN_DMATIM(x) ((x) & (~BITS_PRE_BCN_DMATIM)) -+#define BIT_GET_PRE_BCN_DMATIM(x) \ -+ (((x) >> BIT_SHIFT_PRE_BCN_DMATIM) & BIT_MASK_PRE_BCN_DMATIM) -+#define BIT_SET_PRE_BCN_DMATIM(x, v) \ -+ (BIT_CLEAR_PRE_BCN_DMATIM(x) | BIT_PRE_BCN_DMATIM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TXOP_MIN (Offset 0x0590) */ -+ -+#define BIT_NAV_BLK_HGQ BIT(15) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXOP_MIN (Offset 0x0590) */ -+ -+#define BIT_HIQ_NAV_BREAK_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TXOP_MIN (Offset 0x0590) */ -+ -+#define BIT_NAV_BLK_MGQ BIT(14) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXOP_MIN (Offset 0x0590) */ -+ -+#define BIT_MGQ_NAV_BREAK_EN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TXOP_MIN (Offset 0x0590) */ -+ -+#define BIT_SHIFT_TXPAUSE1 8 -+#define BIT_MASK_TXPAUSE1 0xff -+#define BIT_TXPAUSE1(x) (((x) & BIT_MASK_TXPAUSE1) << BIT_SHIFT_TXPAUSE1) -+#define BITS_TXPAUSE1 (BIT_MASK_TXPAUSE1 << BIT_SHIFT_TXPAUSE1) -+#define BIT_CLEAR_TXPAUSE1(x) ((x) & (~BITS_TXPAUSE1)) -+#define BIT_GET_TXPAUSE1(x) (((x) >> BIT_SHIFT_TXPAUSE1) & BIT_MASK_TXPAUSE1) -+#define BIT_SET_TXPAUSE1(x, v) (BIT_CLEAR_TXPAUSE1(x) | BIT_TXPAUSE1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXOP_MIN (Offset 0x0590) */ -+ -+#define BIT_SHIFT_TXOP_MIN 0 -+#define BIT_MASK_TXOP_MIN 0x3fff -+#define BIT_TXOP_MIN(x) (((x) & BIT_MASK_TXOP_MIN) << BIT_SHIFT_TXOP_MIN) -+#define BITS_TXOP_MIN (BIT_MASK_TXOP_MIN << BIT_SHIFT_TXOP_MIN) -+#define BIT_CLEAR_TXOP_MIN(x) ((x) & (~BITS_TXOP_MIN)) -+#define BIT_GET_TXOP_MIN(x) (((x) >> BIT_SHIFT_TXOP_MIN) & BIT_MASK_TXOP_MIN) -+#define BIT_SET_TXOP_MIN(x, v) (BIT_CLEAR_TXOP_MIN(x) | BIT_TXOP_MIN(v)) -+ -+/* 2 REG_PRE_BKF_TIME (Offset 0x0592) */ -+ -+#define BIT_SHIFT_PRE_BKF_TIME 0 -+#define BIT_MASK_PRE_BKF_TIME 0xff -+#define BIT_PRE_BKF_TIME(x) \ -+ (((x) & BIT_MASK_PRE_BKF_TIME) << BIT_SHIFT_PRE_BKF_TIME) -+#define BITS_PRE_BKF_TIME (BIT_MASK_PRE_BKF_TIME << BIT_SHIFT_PRE_BKF_TIME) -+#define BIT_CLEAR_PRE_BKF_TIME(x) ((x) & (~BITS_PRE_BKF_TIME)) -+#define BIT_GET_PRE_BKF_TIME(x) \ -+ (((x) >> BIT_SHIFT_PRE_BKF_TIME) & BIT_MASK_PRE_BKF_TIME) -+#define BIT_SET_PRE_BKF_TIME(x, v) \ -+ (BIT_CLEAR_PRE_BKF_TIME(x) | BIT_PRE_BKF_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CROSS_TXOP_CTRL (Offset 0x0593) */ -+ -+#define BIT_NOPKT_END_RTSMF BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CROSS_TXOP_CTRL (Offset 0x0593) */ -+ -+#define BIT_TBTT_RETRY BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CROSS_TXOP_CTRL (Offset 0x0593) */ -+ -+#define BIT_SHIFT_PRETX_US 3 -+#define BIT_MASK_PRETX_US 0xf -+#define BIT_PRETX_US(x) (((x) & BIT_MASK_PRETX_US) << BIT_SHIFT_PRETX_US) -+#define BITS_PRETX_US (BIT_MASK_PRETX_US << BIT_SHIFT_PRETX_US) -+#define BIT_CLEAR_PRETX_US(x) ((x) & (~BITS_PRETX_US)) -+#define BIT_GET_PRETX_US(x) (((x) >> BIT_SHIFT_PRETX_US) & BIT_MASK_PRETX_US) -+#define BIT_SET_PRETX_US(x, v) (BIT_CLEAR_PRETX_US(x) | BIT_PRETX_US(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CROSS_TXOP_CTRL (Offset 0x0593) */ -+ -+#define BIT_TXOP_FAIL_BREAK BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CROSS_TXOP_CTRL (Offset 0x0593) */ -+ -+#define BIT_TXFAIL_BREACK_TXOP_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CROSS_TXOP_CTRL (Offset 0x0593) */ -+ -+#define BIT_DTIM_BYPASS BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CROSS_TXOP_CTRL (Offset 0x0593) */ -+ -+#define BIT_RTS_NAV_TXOP BIT(1) -+#define BIT_NOT_CROSS_TXOP BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI (Offset 0x0594) */ -+ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI3_V1 BIT(31) -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI3_V1 24 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI3_V1 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI3_V1(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI3_V1) \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI3_V1) -+#define BITS_TBTT_INT_SHIFT_CLI3_V1 \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI3_V1 << BIT_SHIFT_TBTT_INT_SHIFT_CLI3_V1) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI3_V1(x) \ -+ ((x) & (~BITS_TBTT_INT_SHIFT_CLI3_V1)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI3_V1(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI3_V1) & \ -+ BIT_MASK_TBTT_INT_SHIFT_CLI3_V1) -+#define BIT_SET_TBTT_INT_SHIFT_CLI3_V1(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI3_V1(x) | BIT_TBTT_INT_SHIFT_CLI3_V1(v)) -+ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI2_V1 BIT(23) -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI2_V1 16 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI2_V1 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI2_V1(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI2_V1) \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI2_V1) -+#define BITS_TBTT_INT_SHIFT_CLI2_V1 \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI2_V1 << BIT_SHIFT_TBTT_INT_SHIFT_CLI2_V1) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI2_V1(x) \ -+ ((x) & (~BITS_TBTT_INT_SHIFT_CLI2_V1)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI2_V1(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI2_V1) & \ -+ BIT_MASK_TBTT_INT_SHIFT_CLI2_V1) -+#define BIT_SET_TBTT_INT_SHIFT_CLI2_V1(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI2_V1(x) | BIT_TBTT_INT_SHIFT_CLI2_V1(v)) -+ -+#define BIT_SHIFT_DIS_ATIM_V1 16 -+#define BIT_MASK_DIS_ATIM_V1 0xff -+#define BIT_DIS_ATIM_V1(x) \ -+ (((x) & BIT_MASK_DIS_ATIM_V1) << BIT_SHIFT_DIS_ATIM_V1) -+#define BITS_DIS_ATIM_V1 (BIT_MASK_DIS_ATIM_V1 << BIT_SHIFT_DIS_ATIM_V1) -+#define BIT_CLEAR_DIS_ATIM_V1(x) ((x) & (~BITS_DIS_ATIM_V1)) -+#define BIT_GET_DIS_ATIM_V1(x) \ -+ (((x) >> BIT_SHIFT_DIS_ATIM_V1) & BIT_MASK_DIS_ATIM_V1) -+#define BIT_SET_DIS_ATIM_V1(x, v) \ -+ (BIT_CLEAR_DIS_ATIM_V1(x) | BIT_DIS_ATIM_V1(v)) -+ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI1_V1 BIT(15) -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI1_V1 8 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI1_V1 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI1_V1(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI1_V1) \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI1_V1) -+#define BITS_TBTT_INT_SHIFT_CLI1_V1 \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI1_V1 << BIT_SHIFT_TBTT_INT_SHIFT_CLI1_V1) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI1_V1(x) \ -+ ((x) & (~BITS_TBTT_INT_SHIFT_CLI1_V1)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI1_V1(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI1_V1) & \ -+ BIT_MASK_TBTT_INT_SHIFT_CLI1_V1) -+#define BIT_SET_TBTT_INT_SHIFT_CLI1_V1(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI1_V1(x) | BIT_TBTT_INT_SHIFT_CLI1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI0 (Offset 0x0594) */ -+ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI0 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI (Offset 0x0594) */ -+ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI0_V1 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FREERUN_CNT_L (Offset 0x0594) */ -+ -+#define BIT_SHIFT_FREERUN_CNT_L 0 -+#define BIT_MASK_FREERUN_CNT_L 0xffffffffL -+#define BIT_FREERUN_CNT_L(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_L) << BIT_SHIFT_FREERUN_CNT_L) -+#define BITS_FREERUN_CNT_L (BIT_MASK_FREERUN_CNT_L << BIT_SHIFT_FREERUN_CNT_L) -+#define BIT_CLEAR_FREERUN_CNT_L(x) ((x) & (~BITS_FREERUN_CNT_L)) -+#define BIT_GET_FREERUN_CNT_L(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_L) & BIT_MASK_FREERUN_CNT_L) -+#define BIT_SET_FREERUN_CNT_L(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_L(x) | BIT_FREERUN_CNT_L(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI (Offset 0x0594) */ -+ -+#define BIT_SHIFT_MBID_BCNQ_EN_V1 0 -+#define BIT_MASK_MBID_BCNQ_EN_V1 0xff -+#define BIT_MBID_BCNQ_EN_V1(x) \ -+ (((x) & BIT_MASK_MBID_BCNQ_EN_V1) << BIT_SHIFT_MBID_BCNQ_EN_V1) -+#define BITS_MBID_BCNQ_EN_V1 \ -+ (BIT_MASK_MBID_BCNQ_EN_V1 << BIT_SHIFT_MBID_BCNQ_EN_V1) -+#define BIT_CLEAR_MBID_BCNQ_EN_V1(x) ((x) & (~BITS_MBID_BCNQ_EN_V1)) -+#define BIT_GET_MBID_BCNQ_EN_V1(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCNQ_EN_V1) & BIT_MASK_MBID_BCNQ_EN_V1) -+#define BIT_SET_MBID_BCNQ_EN_V1(x, v) \ -+ (BIT_CLEAR_MBID_BCNQ_EN_V1(x) | BIT_MBID_BCNQ_EN_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI1 (Offset 0x0595) */ -+ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI1 BIT(7) -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI1 0 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI1 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI1(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI1) << BIT_SHIFT_TBTT_INT_SHIFT_CLI1) -+#define BITS_TBTT_INT_SHIFT_CLI1 \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI1 << BIT_SHIFT_TBTT_INT_SHIFT_CLI1) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI1(x) ((x) & (~BITS_TBTT_INT_SHIFT_CLI1)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI1(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI1) & BIT_MASK_TBTT_INT_SHIFT_CLI1) -+#define BIT_SET_TBTT_INT_SHIFT_CLI1(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI1(x) | BIT_TBTT_INT_SHIFT_CLI1(v)) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI2 (Offset 0x0596) */ -+ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI2 BIT(7) -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI2 0 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI2 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI2(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI2) << BIT_SHIFT_TBTT_INT_SHIFT_CLI2) -+#define BITS_TBTT_INT_SHIFT_CLI2 \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI2 << BIT_SHIFT_TBTT_INT_SHIFT_CLI2) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI2(x) ((x) & (~BITS_TBTT_INT_SHIFT_CLI2)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI2(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI2) & BIT_MASK_TBTT_INT_SHIFT_CLI2) -+#define BIT_SET_TBTT_INT_SHIFT_CLI2(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI2(x) | BIT_TBTT_INT_SHIFT_CLI2(v)) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI3 (Offset 0x0597) */ -+ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI3 BIT(7) -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI3 0 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI3 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI3(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI3) << BIT_SHIFT_TBTT_INT_SHIFT_CLI3) -+#define BITS_TBTT_INT_SHIFT_CLI3 \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI3 << BIT_SHIFT_TBTT_INT_SHIFT_CLI3) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI3(x) ((x) & (~BITS_TBTT_INT_SHIFT_CLI3)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI3(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI3) & BIT_MASK_TBTT_INT_SHIFT_CLI3) -+#define BIT_SET_TBTT_INT_SHIFT_CLI3(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI3(x) | BIT_TBTT_INT_SHIFT_CLI3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_TBTT_SHIFT_V1 (Offset 0x0598) */ -+ -+#define BIT_RX_TBTT_SHIFT_RW_FLAG_V1 BIT(31) -+ -+#define BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1 16 -+#define BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1 0xfff -+#define BIT_RX_TBTT_SHIFT_OFFSET_V1(x) \ -+ (((x) & BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1) \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1) -+#define BITS_RX_TBTT_SHIFT_OFFSET_V1 \ -+ (BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1 << BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1) -+#define BIT_CLEAR_RX_TBTT_SHIFT_OFFSET_V1(x) \ -+ ((x) & (~BITS_RX_TBTT_SHIFT_OFFSET_V1)) -+#define BIT_GET_RX_TBTT_SHIFT_OFFSET_V1(x) \ -+ (((x) >> BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1) & \ -+ BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1) -+#define BIT_SET_RX_TBTT_SHIFT_OFFSET_V1(x, v) \ -+ (BIT_CLEAR_RX_TBTT_SHIFT_OFFSET_V1(x) | BIT_RX_TBTT_SHIFT_OFFSET_V1(v)) -+ -+#define BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1 8 -+#define BIT_MASK_RX_TBTT_SHIFT_SEL_V1 0x7 -+#define BIT_RX_TBTT_SHIFT_SEL_V1(x) \ -+ (((x) & BIT_MASK_RX_TBTT_SHIFT_SEL_V1) \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1) -+#define BITS_RX_TBTT_SHIFT_SEL_V1 \ -+ (BIT_MASK_RX_TBTT_SHIFT_SEL_V1 << BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1) -+#define BIT_CLEAR_RX_TBTT_SHIFT_SEL_V1(x) ((x) & (~BITS_RX_TBTT_SHIFT_SEL_V1)) -+#define BIT_GET_RX_TBTT_SHIFT_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1) & \ -+ BIT_MASK_RX_TBTT_SHIFT_SEL_V1) -+#define BIT_SET_RX_TBTT_SHIFT_SEL_V1(x, v) \ -+ (BIT_CLEAR_RX_TBTT_SHIFT_SEL_V1(x) | BIT_RX_TBTT_SHIFT_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TBTT_INT_SHIFT_ENABLE (Offset 0x0598) */ -+ -+#define BIT_EN_TBTT_RTY BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FREERUN_CNT_H (Offset 0x0598) */ -+ -+#define BIT_SHIFT_FREERUN_CNT_H 0 -+#define BIT_MASK_FREERUN_CNT_H 0xffffffffL -+#define BIT_FREERUN_CNT_H(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_H) << BIT_SHIFT_FREERUN_CNT_H) -+#define BITS_FREERUN_CNT_H (BIT_MASK_FREERUN_CNT_H << BIT_SHIFT_FREERUN_CNT_H) -+#define BIT_CLEAR_FREERUN_CNT_H(x) ((x) & (~BITS_FREERUN_CNT_H)) -+#define BIT_GET_FREERUN_CNT_H(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_H) & BIT_MASK_FREERUN_CNT_H) -+#define BIT_SET_FREERUN_CNT_H(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_H(x) | BIT_FREERUN_CNT_H(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TBTT_INT_SHIFT_ENABLE (Offset 0x0598) */ -+ -+#define BIT_TBTT_INT_SHIFT_ENABLE BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ATIMWND2 (Offset 0x05A0) */ -+ -+#define BIT_SHIFT_ATIMWND2 0 -+#define BIT_MASK_ATIMWND2 0xff -+#define BIT_ATIMWND2(x) (((x) & BIT_MASK_ATIMWND2) << BIT_SHIFT_ATIMWND2) -+#define BITS_ATIMWND2 (BIT_MASK_ATIMWND2 << BIT_SHIFT_ATIMWND2) -+#define BIT_CLEAR_ATIMWND2(x) ((x) & (~BITS_ATIMWND2)) -+#define BIT_GET_ATIMWND2(x) (((x) >> BIT_SHIFT_ATIMWND2) & BIT_MASK_ATIMWND2) -+#define BIT_SET_ATIMWND2(x, v) (BIT_CLEAR_ATIMWND2(x) | BIT_ATIMWND2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_ATIMWND_GROUP1 (Offset 0x05A0) */ -+ -+#define BIT_SHIFT_ATIMWND_GROUP1 0 -+#define BIT_MASK_ATIMWND_GROUP1 0xff -+#define BIT_ATIMWND_GROUP1(x) \ -+ (((x) & BIT_MASK_ATIMWND_GROUP1) << BIT_SHIFT_ATIMWND_GROUP1) -+#define BITS_ATIMWND_GROUP1 \ -+ (BIT_MASK_ATIMWND_GROUP1 << BIT_SHIFT_ATIMWND_GROUP1) -+#define BIT_CLEAR_ATIMWND_GROUP1(x) ((x) & (~BITS_ATIMWND_GROUP1)) -+#define BIT_GET_ATIMWND_GROUP1(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND_GROUP1) & BIT_MASK_ATIMWND_GROUP1) -+#define BIT_SET_ATIMWND_GROUP1(x, v) \ -+ (BIT_CLEAR_ATIMWND_GROUP1(x) | BIT_ATIMWND_GROUP1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ATIMWND3 (Offset 0x05A1) */ -+ -+#define BIT_SHIFT_ATIMWND3 0 -+#define BIT_MASK_ATIMWND3 0xff -+#define BIT_ATIMWND3(x) (((x) & BIT_MASK_ATIMWND3) << BIT_SHIFT_ATIMWND3) -+#define BITS_ATIMWND3 (BIT_MASK_ATIMWND3 << BIT_SHIFT_ATIMWND3) -+#define BIT_CLEAR_ATIMWND3(x) ((x) & (~BITS_ATIMWND3)) -+#define BIT_GET_ATIMWND3(x) (((x) >> BIT_SHIFT_ATIMWND3) & BIT_MASK_ATIMWND3) -+#define BIT_SET_ATIMWND3(x, v) (BIT_CLEAR_ATIMWND3(x) | BIT_ATIMWND3(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_ATIMWND_GROUP2 (Offset 0x05A1) */ -+ -+#define BIT_SHIFT_ATIMWND_GROUP2 0 -+#define BIT_MASK_ATIMWND_GROUP2 0xff -+#define BIT_ATIMWND_GROUP2(x) \ -+ (((x) & BIT_MASK_ATIMWND_GROUP2) << BIT_SHIFT_ATIMWND_GROUP2) -+#define BITS_ATIMWND_GROUP2 \ -+ (BIT_MASK_ATIMWND_GROUP2 << BIT_SHIFT_ATIMWND_GROUP2) -+#define BIT_CLEAR_ATIMWND_GROUP2(x) ((x) & (~BITS_ATIMWND_GROUP2)) -+#define BIT_GET_ATIMWND_GROUP2(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND_GROUP2) & BIT_MASK_ATIMWND_GROUP2) -+#define BIT_SET_ATIMWND_GROUP2(x, v) \ -+ (BIT_CLEAR_ATIMWND_GROUP2(x) | BIT_ATIMWND_GROUP2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ATIMWND4 (Offset 0x05A2) */ -+ -+#define BIT_SHIFT_ATIMWND4 0 -+#define BIT_MASK_ATIMWND4 0xff -+#define BIT_ATIMWND4(x) (((x) & BIT_MASK_ATIMWND4) << BIT_SHIFT_ATIMWND4) -+#define BITS_ATIMWND4 (BIT_MASK_ATIMWND4 << BIT_SHIFT_ATIMWND4) -+#define BIT_CLEAR_ATIMWND4(x) ((x) & (~BITS_ATIMWND4)) -+#define BIT_GET_ATIMWND4(x) (((x) >> BIT_SHIFT_ATIMWND4) & BIT_MASK_ATIMWND4) -+#define BIT_SET_ATIMWND4(x, v) (BIT_CLEAR_ATIMWND4(x) | BIT_ATIMWND4(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_ATIMWND_GROUP3 (Offset 0x05A2) */ -+ -+#define BIT_SHIFT_ATIMWND_GROUP3 0 -+#define BIT_MASK_ATIMWND_GROUP3 0xff -+#define BIT_ATIMWND_GROUP3(x) \ -+ (((x) & BIT_MASK_ATIMWND_GROUP3) << BIT_SHIFT_ATIMWND_GROUP3) -+#define BITS_ATIMWND_GROUP3 \ -+ (BIT_MASK_ATIMWND_GROUP3 << BIT_SHIFT_ATIMWND_GROUP3) -+#define BIT_CLEAR_ATIMWND_GROUP3(x) ((x) & (~BITS_ATIMWND_GROUP3)) -+#define BIT_GET_ATIMWND_GROUP3(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND_GROUP3) & BIT_MASK_ATIMWND_GROUP3) -+#define BIT_SET_ATIMWND_GROUP3(x, v) \ -+ (BIT_CLEAR_ATIMWND_GROUP3(x) | BIT_ATIMWND_GROUP3(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ATIMWND5 (Offset 0x05A3) */ -+ -+#define BIT_SHIFT_ATIMWND5 0 -+#define BIT_MASK_ATIMWND5 0xff -+#define BIT_ATIMWND5(x) (((x) & BIT_MASK_ATIMWND5) << BIT_SHIFT_ATIMWND5) -+#define BITS_ATIMWND5 (BIT_MASK_ATIMWND5 << BIT_SHIFT_ATIMWND5) -+#define BIT_CLEAR_ATIMWND5(x) ((x) & (~BITS_ATIMWND5)) -+#define BIT_GET_ATIMWND5(x) (((x) >> BIT_SHIFT_ATIMWND5) & BIT_MASK_ATIMWND5) -+#define BIT_SET_ATIMWND5(x, v) (BIT_CLEAR_ATIMWND5(x) | BIT_ATIMWND5(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_ATIMWND_GROUP4 (Offset 0x05A3) */ -+ -+#define BIT_SHIFT_ATIMWND_GROUP4 0 -+#define BIT_MASK_ATIMWND_GROUP4 0xff -+#define BIT_ATIMWND_GROUP4(x) \ -+ (((x) & BIT_MASK_ATIMWND_GROUP4) << BIT_SHIFT_ATIMWND_GROUP4) -+#define BITS_ATIMWND_GROUP4 \ -+ (BIT_MASK_ATIMWND_GROUP4 << BIT_SHIFT_ATIMWND_GROUP4) -+#define BIT_CLEAR_ATIMWND_GROUP4(x) ((x) & (~BITS_ATIMWND_GROUP4)) -+#define BIT_GET_ATIMWND_GROUP4(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND_GROUP4) & BIT_MASK_ATIMWND_GROUP4) -+#define BIT_SET_ATIMWND_GROUP4(x, v) \ -+ (BIT_CLEAR_ATIMWND_GROUP4(x) | BIT_ATIMWND_GROUP4(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ATIMWND6 (Offset 0x05A4) */ -+ -+#define BIT_SHIFT_ATIMWND6 0 -+#define BIT_MASK_ATIMWND6 0xff -+#define BIT_ATIMWND6(x) (((x) & BIT_MASK_ATIMWND6) << BIT_SHIFT_ATIMWND6) -+#define BITS_ATIMWND6 (BIT_MASK_ATIMWND6 << BIT_SHIFT_ATIMWND6) -+#define BIT_CLEAR_ATIMWND6(x) ((x) & (~BITS_ATIMWND6)) -+#define BIT_GET_ATIMWND6(x) (((x) >> BIT_SHIFT_ATIMWND6) & BIT_MASK_ATIMWND6) -+#define BIT_SET_ATIMWND6(x, v) (BIT_CLEAR_ATIMWND6(x) | BIT_ATIMWND6(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DTIM_COUNT_GROUP1 (Offset 0x05A4) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_GROUP1 0 -+#define BIT_MASK_DTIM_COUNT_GROUP1 0xff -+#define BIT_DTIM_COUNT_GROUP1(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_GROUP1) << BIT_SHIFT_DTIM_COUNT_GROUP1) -+#define BITS_DTIM_COUNT_GROUP1 \ -+ (BIT_MASK_DTIM_COUNT_GROUP1 << BIT_SHIFT_DTIM_COUNT_GROUP1) -+#define BIT_CLEAR_DTIM_COUNT_GROUP1(x) ((x) & (~BITS_DTIM_COUNT_GROUP1)) -+#define BIT_GET_DTIM_COUNT_GROUP1(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_GROUP1) & BIT_MASK_DTIM_COUNT_GROUP1) -+#define BIT_SET_DTIM_COUNT_GROUP1(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_GROUP1(x) | BIT_DTIM_COUNT_GROUP1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ATIMWND7 (Offset 0x05A5) */ -+ -+#define BIT_SHIFT_ATIMWND7 0 -+#define BIT_MASK_ATIMWND7 0xff -+#define BIT_ATIMWND7(x) (((x) & BIT_MASK_ATIMWND7) << BIT_SHIFT_ATIMWND7) -+#define BITS_ATIMWND7 (BIT_MASK_ATIMWND7 << BIT_SHIFT_ATIMWND7) -+#define BIT_CLEAR_ATIMWND7(x) ((x) & (~BITS_ATIMWND7)) -+#define BIT_GET_ATIMWND7(x) (((x) >> BIT_SHIFT_ATIMWND7) & BIT_MASK_ATIMWND7) -+#define BIT_SET_ATIMWND7(x, v) (BIT_CLEAR_ATIMWND7(x) | BIT_ATIMWND7(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DTIM_COUNT_GROUP2 (Offset 0x05A5) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_GROUP2 0 -+#define BIT_MASK_DTIM_COUNT_GROUP2 0xff -+#define BIT_DTIM_COUNT_GROUP2(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_GROUP2) << BIT_SHIFT_DTIM_COUNT_GROUP2) -+#define BITS_DTIM_COUNT_GROUP2 \ -+ (BIT_MASK_DTIM_COUNT_GROUP2 << BIT_SHIFT_DTIM_COUNT_GROUP2) -+#define BIT_CLEAR_DTIM_COUNT_GROUP2(x) ((x) & (~BITS_DTIM_COUNT_GROUP2)) -+#define BIT_GET_DTIM_COUNT_GROUP2(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_GROUP2) & BIT_MASK_DTIM_COUNT_GROUP2) -+#define BIT_SET_DTIM_COUNT_GROUP2(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_GROUP2(x) | BIT_DTIM_COUNT_GROUP2(v)) -+ -+/* 2 REG_DTIM_COUNT_GROUP3 (Offset 0x05A6) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_GROUP3 0 -+#define BIT_MASK_DTIM_COUNT_GROUP3 0xff -+#define BIT_DTIM_COUNT_GROUP3(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_GROUP3) << BIT_SHIFT_DTIM_COUNT_GROUP3) -+#define BITS_DTIM_COUNT_GROUP3 \ -+ (BIT_MASK_DTIM_COUNT_GROUP3 << BIT_SHIFT_DTIM_COUNT_GROUP3) -+#define BIT_CLEAR_DTIM_COUNT_GROUP3(x) ((x) & (~BITS_DTIM_COUNT_GROUP3)) -+#define BIT_GET_DTIM_COUNT_GROUP3(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_GROUP3) & BIT_MASK_DTIM_COUNT_GROUP3) -+#define BIT_SET_DTIM_COUNT_GROUP3(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_GROUP3(x) | BIT_DTIM_COUNT_GROUP3(v)) -+ -+/* 2 REG_DTIM_COUNT_GROUP4 (Offset 0x05A7) */ -+ -+#define BIT_SHIFT_ATIM_CFG_SEL 24 -+#define BIT_MASK_ATIM_CFG_SEL 0x3 -+#define BIT_ATIM_CFG_SEL(x) \ -+ (((x) & BIT_MASK_ATIM_CFG_SEL) << BIT_SHIFT_ATIM_CFG_SEL) -+#define BITS_ATIM_CFG_SEL (BIT_MASK_ATIM_CFG_SEL << BIT_SHIFT_ATIM_CFG_SEL) -+#define BIT_CLEAR_ATIM_CFG_SEL(x) ((x) & (~BITS_ATIM_CFG_SEL)) -+#define BIT_GET_ATIM_CFG_SEL(x) \ -+ (((x) >> BIT_SHIFT_ATIM_CFG_SEL) & BIT_MASK_ATIM_CFG_SEL) -+#define BIT_SET_ATIM_CFG_SEL(x, v) \ -+ (BIT_CLEAR_ATIM_CFG_SEL(x) | BIT_ATIM_CFG_SEL(v)) -+ -+#define BIT_SHIFT_ATIM_URGENT_V1 16 -+#define BIT_MASK_ATIM_URGENT_V1 0xff -+#define BIT_ATIM_URGENT_V1(x) \ -+ (((x) & BIT_MASK_ATIM_URGENT_V1) << BIT_SHIFT_ATIM_URGENT_V1) -+#define BITS_ATIM_URGENT_V1 \ -+ (BIT_MASK_ATIM_URGENT_V1 << BIT_SHIFT_ATIM_URGENT_V1) -+#define BIT_CLEAR_ATIM_URGENT_V1(x) ((x) & (~BITS_ATIM_URGENT_V1)) -+#define BIT_GET_ATIM_URGENT_V1(x) \ -+ (((x) >> BIT_SHIFT_ATIM_URGENT_V1) & BIT_MASK_ATIM_URGENT_V1) -+#define BIT_SET_ATIM_URGENT_V1(x, v) \ -+ (BIT_CLEAR_ATIM_URGENT_V1(x) | BIT_ATIM_URGENT_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIQ_NO_LMT_EN (Offset 0x05A7) */ -+ -+#define BIT_HIQ_NO_LMT_EN_VAP7 BIT(7) -+#define BIT_HIQ_NO_LMT_EN_VAP6 BIT(6) -+#define BIT_HIQ_NO_LMT_EN_VAP5 BIT(5) -+#define BIT_HIQ_NO_LMT_EN_VAP4 BIT(4) -+#define BIT_HIQ_NO_LMT_EN_VAP3 BIT(3) -+#define BIT_HIQ_NO_LMT_EN_VAP2 BIT(2) -+#define BIT_HIQ_NO_LMT_EN_VAP1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_HIQ_NO_LMT_EN (Offset 0x05A7) */ -+ -+#define BIT_HIQ_NO_LMT_EN_ROOT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DTIM_COUNT_GROUP4 (Offset 0x05A7) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_GROUP4 0 -+#define BIT_MASK_DTIM_COUNT_GROUP4 0xff -+#define BIT_DTIM_COUNT_GROUP4(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_GROUP4) << BIT_SHIFT_DTIM_COUNT_GROUP4) -+#define BITS_DTIM_COUNT_GROUP4 \ -+ (BIT_MASK_DTIM_COUNT_GROUP4 << BIT_SHIFT_DTIM_COUNT_GROUP4) -+#define BIT_CLEAR_DTIM_COUNT_GROUP4(x) ((x) & (~BITS_DTIM_COUNT_GROUP4)) -+#define BIT_GET_DTIM_COUNT_GROUP4(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_GROUP4) & BIT_MASK_DTIM_COUNT_GROUP4) -+#define BIT_SET_DTIM_COUNT_GROUP4(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_GROUP4(x) | BIT_DTIM_COUNT_GROUP4(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIQ_NO_LMT_EN_V2 (Offset 0x05A8) */ -+ -+#define BIT_SHIFT_DIS_ATIM 16 -+#define BIT_MASK_DIS_ATIM 0xffff -+#define BIT_DIS_ATIM(x) (((x) & BIT_MASK_DIS_ATIM) << BIT_SHIFT_DIS_ATIM) -+#define BITS_DIS_ATIM (BIT_MASK_DIS_ATIM << BIT_SHIFT_DIS_ATIM) -+#define BIT_CLEAR_DIS_ATIM(x) ((x) & (~BITS_DIS_ATIM)) -+#define BIT_GET_DIS_ATIM(x) (((x) >> BIT_SHIFT_DIS_ATIM) & BIT_MASK_DIS_ATIM) -+#define BIT_SET_DIS_ATIM(x, v) (BIT_CLEAR_DIS_ATIM(x) | BIT_DIS_ATIM(v)) -+ -+#define BIT_SHIFT_BCNERR_PORT_SEL_V1 16 -+#define BIT_MASK_BCNERR_PORT_SEL_V1 0xf -+#define BIT_BCNERR_PORT_SEL_V1(x) \ -+ (((x) & BIT_MASK_BCNERR_PORT_SEL_V1) << BIT_SHIFT_BCNERR_PORT_SEL_V1) -+#define BITS_BCNERR_PORT_SEL_V1 \ -+ (BIT_MASK_BCNERR_PORT_SEL_V1 << BIT_SHIFT_BCNERR_PORT_SEL_V1) -+#define BIT_CLEAR_BCNERR_PORT_SEL_V1(x) ((x) & (~BITS_BCNERR_PORT_SEL_V1)) -+#define BIT_GET_BCNERR_PORT_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_PORT_SEL_V1) & BIT_MASK_BCNERR_PORT_SEL_V1) -+#define BIT_SET_BCNERR_PORT_SEL_V1(x, v) \ -+ (BIT_CLEAR_BCNERR_PORT_SEL_V1(x) | BIT_BCNERR_PORT_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DTIM_COUNTER_ROOT (Offset 0x05A8) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_ROOT 0 -+#define BIT_MASK_DTIM_COUNT_ROOT 0xff -+#define BIT_DTIM_COUNT_ROOT(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_ROOT) << BIT_SHIFT_DTIM_COUNT_ROOT) -+#define BITS_DTIM_COUNT_ROOT \ -+ (BIT_MASK_DTIM_COUNT_ROOT << BIT_SHIFT_DTIM_COUNT_ROOT) -+#define BIT_CLEAR_DTIM_COUNT_ROOT(x) ((x) & (~BITS_DTIM_COUNT_ROOT)) -+#define BIT_GET_DTIM_COUNT_ROOT(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_ROOT) & BIT_MASK_DTIM_COUNT_ROOT) -+#define BIT_SET_DTIM_COUNT_ROOT(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_ROOT(x) | BIT_DTIM_COUNT_ROOT(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIQ_NO_LMT_EN_V2 (Offset 0x05A8) */ -+ -+#define BIT_SHIFT_MBID_BCNQ_EN 0 -+#define BIT_MASK_MBID_BCNQ_EN 0xffff -+#define BIT_MBID_BCNQ_EN(x) \ -+ (((x) & BIT_MASK_MBID_BCNQ_EN) << BIT_SHIFT_MBID_BCNQ_EN) -+#define BITS_MBID_BCNQ_EN (BIT_MASK_MBID_BCNQ_EN << BIT_SHIFT_MBID_BCNQ_EN) -+#define BIT_CLEAR_MBID_BCNQ_EN(x) ((x) & (~BITS_MBID_BCNQ_EN)) -+#define BIT_GET_MBID_BCNQ_EN(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCNQ_EN) & BIT_MASK_MBID_BCNQ_EN) -+#define BIT_SET_MBID_BCNQ_EN(x, v) \ -+ (BIT_CLEAR_MBID_BCNQ_EN(x) | BIT_MBID_BCNQ_EN(v)) -+ -+#define BIT_TSF_SYNC_SIGNAL BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DTIM_COUNTER_VAP1 (Offset 0x05A9) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP1 0 -+#define BIT_MASK_DTIM_COUNT_VAP1 0xff -+#define BIT_DTIM_COUNT_VAP1(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP1) << BIT_SHIFT_DTIM_COUNT_VAP1) -+#define BITS_DTIM_COUNT_VAP1 \ -+ (BIT_MASK_DTIM_COUNT_VAP1 << BIT_SHIFT_DTIM_COUNT_VAP1) -+#define BIT_CLEAR_DTIM_COUNT_VAP1(x) ((x) & (~BITS_DTIM_COUNT_VAP1)) -+#define BIT_GET_DTIM_COUNT_VAP1(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP1) & BIT_MASK_DTIM_COUNT_VAP1) -+#define BIT_SET_DTIM_COUNT_VAP1(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP1(x) | BIT_DTIM_COUNT_VAP1(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP2 (Offset 0x05AA) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP2 0 -+#define BIT_MASK_DTIM_COUNT_VAP2 0xff -+#define BIT_DTIM_COUNT_VAP2(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP2) << BIT_SHIFT_DTIM_COUNT_VAP2) -+#define BITS_DTIM_COUNT_VAP2 \ -+ (BIT_MASK_DTIM_COUNT_VAP2 << BIT_SHIFT_DTIM_COUNT_VAP2) -+#define BIT_CLEAR_DTIM_COUNT_VAP2(x) ((x) & (~BITS_DTIM_COUNT_VAP2)) -+#define BIT_GET_DTIM_COUNT_VAP2(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP2) & BIT_MASK_DTIM_COUNT_VAP2) -+#define BIT_SET_DTIM_COUNT_VAP2(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP2(x) | BIT_DTIM_COUNT_VAP2(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP3 (Offset 0x05AB) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP3 0 -+#define BIT_MASK_DTIM_COUNT_VAP3 0xff -+#define BIT_DTIM_COUNT_VAP3(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP3) << BIT_SHIFT_DTIM_COUNT_VAP3) -+#define BITS_DTIM_COUNT_VAP3 \ -+ (BIT_MASK_DTIM_COUNT_VAP3 << BIT_SHIFT_DTIM_COUNT_VAP3) -+#define BIT_CLEAR_DTIM_COUNT_VAP3(x) ((x) & (~BITS_DTIM_COUNT_VAP3)) -+#define BIT_GET_DTIM_COUNT_VAP3(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP3) & BIT_MASK_DTIM_COUNT_VAP3) -+#define BIT_SET_DTIM_COUNT_VAP3(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP3(x) | BIT_DTIM_COUNT_VAP3(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP4 (Offset 0x05AC) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP4 0 -+#define BIT_MASK_DTIM_COUNT_VAP4 0xff -+#define BIT_DTIM_COUNT_VAP4(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP4) << BIT_SHIFT_DTIM_COUNT_VAP4) -+#define BITS_DTIM_COUNT_VAP4 \ -+ (BIT_MASK_DTIM_COUNT_VAP4 << BIT_SHIFT_DTIM_COUNT_VAP4) -+#define BIT_CLEAR_DTIM_COUNT_VAP4(x) ((x) & (~BITS_DTIM_COUNT_VAP4)) -+#define BIT_GET_DTIM_COUNT_VAP4(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP4) & BIT_MASK_DTIM_COUNT_VAP4) -+#define BIT_SET_DTIM_COUNT_VAP4(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP4(x) | BIT_DTIM_COUNT_VAP4(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP5 (Offset 0x05AD) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP5 0 -+#define BIT_MASK_DTIM_COUNT_VAP5 0xff -+#define BIT_DTIM_COUNT_VAP5(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP5) << BIT_SHIFT_DTIM_COUNT_VAP5) -+#define BITS_DTIM_COUNT_VAP5 \ -+ (BIT_MASK_DTIM_COUNT_VAP5 << BIT_SHIFT_DTIM_COUNT_VAP5) -+#define BIT_CLEAR_DTIM_COUNT_VAP5(x) ((x) & (~BITS_DTIM_COUNT_VAP5)) -+#define BIT_GET_DTIM_COUNT_VAP5(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP5) & BIT_MASK_DTIM_COUNT_VAP5) -+#define BIT_SET_DTIM_COUNT_VAP5(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP5(x) | BIT_DTIM_COUNT_VAP5(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP6 (Offset 0x05AE) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP6 0 -+#define BIT_MASK_DTIM_COUNT_VAP6 0xff -+#define BIT_DTIM_COUNT_VAP6(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP6) << BIT_SHIFT_DTIM_COUNT_VAP6) -+#define BITS_DTIM_COUNT_VAP6 \ -+ (BIT_MASK_DTIM_COUNT_VAP6 << BIT_SHIFT_DTIM_COUNT_VAP6) -+#define BIT_CLEAR_DTIM_COUNT_VAP6(x) ((x) & (~BITS_DTIM_COUNT_VAP6)) -+#define BIT_GET_DTIM_COUNT_VAP6(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP6) & BIT_MASK_DTIM_COUNT_VAP6) -+#define BIT_SET_DTIM_COUNT_VAP6(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP6(x) | BIT_DTIM_COUNT_VAP6(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP7 (Offset 0x05AF) */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP7 0 -+#define BIT_MASK_DTIM_COUNT_VAP7 0xff -+#define BIT_DTIM_COUNT_VAP7(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP7) << BIT_SHIFT_DTIM_COUNT_VAP7) -+#define BITS_DTIM_COUNT_VAP7 \ -+ (BIT_MASK_DTIM_COUNT_VAP7 << BIT_SHIFT_DTIM_COUNT_VAP7) -+#define BIT_CLEAR_DTIM_COUNT_VAP7(x) ((x) & (~BITS_DTIM_COUNT_VAP7)) -+#define BIT_GET_DTIM_COUNT_VAP7(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP7) & BIT_MASK_DTIM_COUNT_VAP7) -+#define BIT_SET_DTIM_COUNT_VAP7(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP7(x) | BIT_DTIM_COUNT_VAP7(v)) -+ -+/* 2 REG_DIS_ATIM (Offset 0x05B0) */ -+ -+#define BIT_MBIDCAM_VALID BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DIS_ATIM (Offset 0x05B0) */ -+ -+#define BIT_DIS_ATIM_VAP7 BIT(7) -+#define BIT_DIS_ATIM_VAP6 BIT(6) -+#define BIT_DIS_ATIM_VAP5 BIT(5) -+#define BIT_DIS_ATIM_VAP4 BIT(4) -+#define BIT_DIS_ATIM_VAP3 BIT(3) -+#define BIT_DIS_ATIM_VAP2 BIT(2) -+#define BIT_DIS_ATIM_VAP1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_DIS_ATIM (Offset 0x05B0) */ -+ -+#define BIT_DIS_ATIM_ROOT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_EARLY_128US (Offset 0x05B1) */ -+ -+#define BIT_SHIFT_EARLY_128US_2ST 3 -+#define BIT_MASK_EARLY_128US_2ST 0x7 -+#define BIT_EARLY_128US_2ST(x) \ -+ (((x) & BIT_MASK_EARLY_128US_2ST) << BIT_SHIFT_EARLY_128US_2ST) -+#define BITS_EARLY_128US_2ST \ -+ (BIT_MASK_EARLY_128US_2ST << BIT_SHIFT_EARLY_128US_2ST) -+#define BIT_CLEAR_EARLY_128US_2ST(x) ((x) & (~BITS_EARLY_128US_2ST)) -+#define BIT_GET_EARLY_128US_2ST(x) \ -+ (((x) >> BIT_SHIFT_EARLY_128US_2ST) & BIT_MASK_EARLY_128US_2ST) -+#define BIT_SET_EARLY_128US_2ST(x, v) \ -+ (BIT_CLEAR_EARLY_128US_2ST(x) | BIT_EARLY_128US_2ST(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_EARLY_128US (Offset 0x05B1) */ -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER1 3 -+#define BIT_MASK_TSFT_SEL_TIMER1 0x7 -+#define BIT_TSFT_SEL_TIMER1(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER1) << BIT_SHIFT_TSFT_SEL_TIMER1) -+#define BITS_TSFT_SEL_TIMER1 \ -+ (BIT_MASK_TSFT_SEL_TIMER1 << BIT_SHIFT_TSFT_SEL_TIMER1) -+#define BIT_CLEAR_TSFT_SEL_TIMER1(x) ((x) & (~BITS_TSFT_SEL_TIMER1)) -+#define BIT_GET_TSFT_SEL_TIMER1(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER1) & BIT_MASK_TSFT_SEL_TIMER1) -+#define BIT_SET_TSFT_SEL_TIMER1(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER1(x) | BIT_TSFT_SEL_TIMER1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TBTT_HOLD_PREDICT_P1 (Offset 0x05B2) */ -+ -+#define BIT_DIS_BCN_3RD BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS1_CTRL (Offset 0x05B2) */ -+ -+#define BIT_P2P1_CTW_ALLSTASLEEP BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TBTT_HOLD_PREDICT_P1 (Offset 0x05B2) */ -+ -+#define BIT_DIS_BCN_2ST BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS1_CTRL (Offset 0x05B2) */ -+ -+#define BIT_P2P1_OFF_DISTX_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TBTT_HOLD_PREDICT_P1 (Offset 0x05B2) */ -+ -+#define BIT_DIS_BCN_1ST BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS1_CTRL (Offset 0x05B2) */ -+ -+#define BIT_P2P1_PWR_MGT_EN BIT(5) -+#define BIT_P2P1_NOA1_EN BIT(2) -+#define BIT_P2P1_NOA0_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TBTT_HOLD_PREDICT_P1 (Offset 0x05B2) */ -+ -+#define BIT_SHIFT_TBTT_HOLD_PREDICT_P1 0 -+#define BIT_MASK_TBTT_HOLD_PREDICT_P1 0x1f -+#define BIT_TBTT_HOLD_PREDICT_P1(x) \ -+ (((x) & BIT_MASK_TBTT_HOLD_PREDICT_P1) \ -+ << BIT_SHIFT_TBTT_HOLD_PREDICT_P1) -+#define BITS_TBTT_HOLD_PREDICT_P1 \ -+ (BIT_MASK_TBTT_HOLD_PREDICT_P1 << BIT_SHIFT_TBTT_HOLD_PREDICT_P1) -+#define BIT_CLEAR_TBTT_HOLD_PREDICT_P1(x) ((x) & (~BITS_TBTT_HOLD_PREDICT_P1)) -+#define BIT_GET_TBTT_HOLD_PREDICT_P1(x) \ -+ (((x) >> BIT_SHIFT_TBTT_HOLD_PREDICT_P1) & \ -+ BIT_MASK_TBTT_HOLD_PREDICT_P1) -+#define BIT_SET_TBTT_HOLD_PREDICT_P1(x, v) \ -+ (BIT_CLEAR_TBTT_HOLD_PREDICT_P1(x) | BIT_TBTT_HOLD_PREDICT_P1(v)) -+ -+/* 2 REG_MULTI_BCN_CS (Offset 0x05B3) */ -+ -+#define BIT_EN_FREECNT_V2 BIT(13) -+#define BIT_RESET_FREECNT_P BIT(12) -+#define BIT_TSFTR3_SYNC_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS2_CTRL (Offset 0x05B3) */ -+ -+#define BIT_P2P2_CTW_ALLSTASLEEP BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MULTI_BCN_CS (Offset 0x05B3) */ -+ -+#define BIT_SHIFT_P1_TSFT_SHIFT 6 -+#define BIT_MASK_P1_TSFT_SHIFT 0x3f -+#define BIT_P1_TSFT_SHIFT(x) \ -+ (((x) & BIT_MASK_P1_TSFT_SHIFT) << BIT_SHIFT_P1_TSFT_SHIFT) -+#define BITS_P1_TSFT_SHIFT (BIT_MASK_P1_TSFT_SHIFT << BIT_SHIFT_P1_TSFT_SHIFT) -+#define BIT_CLEAR_P1_TSFT_SHIFT(x) ((x) & (~BITS_P1_TSFT_SHIFT)) -+#define BIT_GET_P1_TSFT_SHIFT(x) \ -+ (((x) >> BIT_SHIFT_P1_TSFT_SHIFT) & BIT_MASK_P1_TSFT_SHIFT) -+#define BIT_SET_P1_TSFT_SHIFT(x, v) \ -+ (BIT_CLEAR_P1_TSFT_SHIFT(x) | BIT_P1_TSFT_SHIFT(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS2_CTRL (Offset 0x05B3) */ -+ -+#define BIT_P2P2_OFF_DISTX_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MULTI_BCN_CS (Offset 0x05B3) */ -+ -+#define BIT_TSFTR2_SYNC_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS2_CTRL (Offset 0x05B3) */ -+ -+#define BIT_P2P2_PWR_MGT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MULTI_BCN_CS (Offset 0x05B3) */ -+ -+#define BIT_TSFTR2_RST BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS2_CTRL (Offset 0x05B3) */ -+ -+#define BIT_P2P2_NOA1_EN BIT(2) -+#define BIT_P2P2_NOA0_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MULTI_BCN_CS (Offset 0x05B3) */ -+ -+#define BIT_SHIFT_MULTI_BCN_CS 0 -+#define BIT_MASK_MULTI_BCN_CS 0xf -+#define BIT_MULTI_BCN_CS(x) \ -+ (((x) & BIT_MASK_MULTI_BCN_CS) << BIT_SHIFT_MULTI_BCN_CS) -+#define BITS_MULTI_BCN_CS (BIT_MASK_MULTI_BCN_CS << BIT_SHIFT_MULTI_BCN_CS) -+#define BIT_CLEAR_MULTI_BCN_CS(x) ((x) & (~BITS_MULTI_BCN_CS)) -+#define BIT_GET_MULTI_BCN_CS(x) \ -+ (((x) >> BIT_SHIFT_MULTI_BCN_CS) & BIT_MASK_MULTI_BCN_CS) -+#define BIT_SET_MULTI_BCN_CS(x, v) \ -+ (BIT_CLEAR_MULTI_BCN_CS(x) | BIT_MULTI_BCN_CS(v)) -+ -+#define BIT_SHIFT_P0_TSFT_SHIFT 0 -+#define BIT_MASK_P0_TSFT_SHIFT 0x3f -+#define BIT_P0_TSFT_SHIFT(x) \ -+ (((x) & BIT_MASK_P0_TSFT_SHIFT) << BIT_SHIFT_P0_TSFT_SHIFT) -+#define BITS_P0_TSFT_SHIFT (BIT_MASK_P0_TSFT_SHIFT << BIT_SHIFT_P0_TSFT_SHIFT) -+#define BIT_CLEAR_P0_TSFT_SHIFT(x) ((x) & (~BITS_P0_TSFT_SHIFT)) -+#define BIT_GET_P0_TSFT_SHIFT(x) \ -+ (((x) >> BIT_SHIFT_P0_TSFT_SHIFT) & BIT_MASK_P0_TSFT_SHIFT) -+#define BIT_SET_P0_TSFT_SHIFT(x, v) \ -+ (BIT_CLEAR_P0_TSFT_SHIFT(x) | BIT_P0_TSFT_SHIFT(v)) -+ -+#define BIT_DIS_NDPA_NAV_CHK_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TIMER0_SRC_SEL (Offset 0x05B4) */ -+ -+#define BIT_SHIFT_SYNC_CLI_SEL 4 -+#define BIT_MASK_SYNC_CLI_SEL 0x7 -+#define BIT_SYNC_CLI_SEL(x) \ -+ (((x) & BIT_MASK_SYNC_CLI_SEL) << BIT_SHIFT_SYNC_CLI_SEL) -+#define BITS_SYNC_CLI_SEL (BIT_MASK_SYNC_CLI_SEL << BIT_SHIFT_SYNC_CLI_SEL) -+#define BIT_CLEAR_SYNC_CLI_SEL(x) ((x) & (~BITS_SYNC_CLI_SEL)) -+#define BIT_GET_SYNC_CLI_SEL(x) \ -+ (((x) >> BIT_SHIFT_SYNC_CLI_SEL) & BIT_MASK_SYNC_CLI_SEL) -+#define BIT_SET_SYNC_CLI_SEL(x, v) \ -+ (BIT_CLEAR_SYNC_CLI_SEL(x) | BIT_SYNC_CLI_SEL(v)) -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER0 0 -+#define BIT_MASK_TSFT_SEL_TIMER0 0x7 -+#define BIT_TSFT_SEL_TIMER0(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER0) << BIT_SHIFT_TSFT_SEL_TIMER0) -+#define BITS_TSFT_SEL_TIMER0 \ -+ (BIT_MASK_TSFT_SEL_TIMER0 << BIT_SHIFT_TSFT_SEL_TIMER0) -+#define BIT_CLEAR_TSFT_SEL_TIMER0(x) ((x) & (~BITS_TSFT_SEL_TIMER0)) -+#define BIT_GET_TSFT_SEL_TIMER0(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER0) & BIT_MASK_TSFT_SEL_TIMER0) -+#define BIT_SET_TSFT_SEL_TIMER0(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER0(x) | BIT_TSFT_SEL_TIMER0(v)) -+ -+/* 2 REG_NOA_UNIT_SEL (Offset 0x05B5) */ -+ -+#define BIT_SHIFT_NOA_UNIT2_SEL 8 -+#define BIT_MASK_NOA_UNIT2_SEL 0x7 -+#define BIT_NOA_UNIT2_SEL(x) \ -+ (((x) & BIT_MASK_NOA_UNIT2_SEL) << BIT_SHIFT_NOA_UNIT2_SEL) -+#define BITS_NOA_UNIT2_SEL (BIT_MASK_NOA_UNIT2_SEL << BIT_SHIFT_NOA_UNIT2_SEL) -+#define BIT_CLEAR_NOA_UNIT2_SEL(x) ((x) & (~BITS_NOA_UNIT2_SEL)) -+#define BIT_GET_NOA_UNIT2_SEL(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT2_SEL) & BIT_MASK_NOA_UNIT2_SEL) -+#define BIT_SET_NOA_UNIT2_SEL(x, v) \ -+ (BIT_CLEAR_NOA_UNIT2_SEL(x) | BIT_NOA_UNIT2_SEL(v)) -+ -+#define BIT_SHIFT_NOA_UNIT1_SEL 4 -+#define BIT_MASK_NOA_UNIT1_SEL 0x7 -+#define BIT_NOA_UNIT1_SEL(x) \ -+ (((x) & BIT_MASK_NOA_UNIT1_SEL) << BIT_SHIFT_NOA_UNIT1_SEL) -+#define BITS_NOA_UNIT1_SEL (BIT_MASK_NOA_UNIT1_SEL << BIT_SHIFT_NOA_UNIT1_SEL) -+#define BIT_CLEAR_NOA_UNIT1_SEL(x) ((x) & (~BITS_NOA_UNIT1_SEL)) -+#define BIT_GET_NOA_UNIT1_SEL(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT1_SEL) & BIT_MASK_NOA_UNIT1_SEL) -+#define BIT_SET_NOA_UNIT1_SEL(x, v) \ -+ (BIT_CLEAR_NOA_UNIT1_SEL(x) | BIT_NOA_UNIT1_SEL(v)) -+ -+#define BIT_SHIFT_NOA_UNIT0_SEL 0 -+#define BIT_MASK_NOA_UNIT0_SEL 0x7 -+#define BIT_NOA_UNIT0_SEL(x) \ -+ (((x) & BIT_MASK_NOA_UNIT0_SEL) << BIT_SHIFT_NOA_UNIT0_SEL) -+#define BITS_NOA_UNIT0_SEL (BIT_MASK_NOA_UNIT0_SEL << BIT_SHIFT_NOA_UNIT0_SEL) -+#define BIT_CLEAR_NOA_UNIT0_SEL(x) ((x) & (~BITS_NOA_UNIT0_SEL)) -+#define BIT_GET_NOA_UNIT0_SEL(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT0_SEL) & BIT_MASK_NOA_UNIT0_SEL) -+#define BIT_SET_NOA_UNIT0_SEL(x, v) \ -+ (BIT_CLEAR_NOA_UNIT0_SEL(x) | BIT_NOA_UNIT0_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2POFF_DIS_TXTIME (Offset 0x05B7) */ -+ -+#define BIT_SHIFT_P2POFF_DIS_TXTIME 0 -+#define BIT_MASK_P2POFF_DIS_TXTIME 0xff -+#define BIT_P2POFF_DIS_TXTIME(x) \ -+ (((x) & BIT_MASK_P2POFF_DIS_TXTIME) << BIT_SHIFT_P2POFF_DIS_TXTIME) -+#define BITS_P2POFF_DIS_TXTIME \ -+ (BIT_MASK_P2POFF_DIS_TXTIME << BIT_SHIFT_P2POFF_DIS_TXTIME) -+#define BIT_CLEAR_P2POFF_DIS_TXTIME(x) ((x) & (~BITS_P2POFF_DIS_TXTIME)) -+#define BIT_GET_P2POFF_DIS_TXTIME(x) \ -+ (((x) >> BIT_SHIFT_P2POFF_DIS_TXTIME) & BIT_MASK_P2POFF_DIS_TXTIME) -+#define BIT_SET_P2POFF_DIS_TXTIME(x, v) \ -+ (BIT_CLEAR_P2POFF_DIS_TXTIME(x) | BIT_P2POFF_DIS_TXTIME(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBSSID_BCN_SPACE2 (Offset 0x05B8) */ -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT2 16 -+#define BIT_MASK_BCN_SPACE_CLINT2 0xfff -+#define BIT_BCN_SPACE_CLINT2(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT2) << BIT_SHIFT_BCN_SPACE_CLINT2) -+#define BITS_BCN_SPACE_CLINT2 \ -+ (BIT_MASK_BCN_SPACE_CLINT2 << BIT_SHIFT_BCN_SPACE_CLINT2) -+#define BIT_CLEAR_BCN_SPACE_CLINT2(x) ((x) & (~BITS_BCN_SPACE_CLINT2)) -+#define BIT_GET_BCN_SPACE_CLINT2(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT2) & BIT_MASK_BCN_SPACE_CLINT2) -+#define BIT_SET_BCN_SPACE_CLINT2(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT2(x) | BIT_BCN_SPACE_CLINT2(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT1 0 -+#define BIT_MASK_BCN_SPACE_CLINT1 0xfff -+#define BIT_BCN_SPACE_CLINT1(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT1) << BIT_SHIFT_BCN_SPACE_CLINT1) -+#define BITS_BCN_SPACE_CLINT1 \ -+ (BIT_MASK_BCN_SPACE_CLINT1 << BIT_SHIFT_BCN_SPACE_CLINT1) -+#define BIT_CLEAR_BCN_SPACE_CLINT1(x) ((x) & (~BITS_BCN_SPACE_CLINT1)) -+#define BIT_GET_BCN_SPACE_CLINT1(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT1) & BIT_MASK_BCN_SPACE_CLINT1) -+#define BIT_SET_BCN_SPACE_CLINT1(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT1(x) | BIT_BCN_SPACE_CLINT1(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE3 (Offset 0x05BC) */ -+ -+#define BIT_SHIFT_SUB_BCN_SPACE 16 -+#define BIT_MASK_SUB_BCN_SPACE 0xff -+#define BIT_SUB_BCN_SPACE(x) \ -+ (((x) & BIT_MASK_SUB_BCN_SPACE) << BIT_SHIFT_SUB_BCN_SPACE) -+#define BITS_SUB_BCN_SPACE (BIT_MASK_SUB_BCN_SPACE << BIT_SHIFT_SUB_BCN_SPACE) -+#define BIT_CLEAR_SUB_BCN_SPACE(x) ((x) & (~BITS_SUB_BCN_SPACE)) -+#define BIT_GET_SUB_BCN_SPACE(x) \ -+ (((x) >> BIT_SHIFT_SUB_BCN_SPACE) & BIT_MASK_SUB_BCN_SPACE) -+#define BIT_SET_SUB_BCN_SPACE(x, v) \ -+ (BIT_CLEAR_SUB_BCN_SPACE(x) | BIT_SUB_BCN_SPACE(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT3 0 -+#define BIT_MASK_BCN_SPACE_CLINT3 0xfff -+#define BIT_BCN_SPACE_CLINT3(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT3) << BIT_SHIFT_BCN_SPACE_CLINT3) -+#define BITS_BCN_SPACE_CLINT3 \ -+ (BIT_MASK_BCN_SPACE_CLINT3 << BIT_SHIFT_BCN_SPACE_CLINT3) -+#define BIT_CLEAR_BCN_SPACE_CLINT3(x) ((x) & (~BITS_BCN_SPACE_CLINT3)) -+#define BIT_GET_BCN_SPACE_CLINT3(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT3) & BIT_MASK_BCN_SPACE_CLINT3) -+#define BIT_SET_BCN_SPACE_CLINT3(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT3(x) | BIT_BCN_SPACE_CLINT3(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ACMHWCTRL (Offset 0x05C0) */ -+ -+#define BIT_BEQ_ACM_STATUS BIT(7) -+#define BIT_VIQ_ACM_STATUS BIT(6) -+#define BIT_VOQ_ACM_STATUS BIT(5) -+#define BIT_BEQ_ACM_EN BIT(3) -+#define BIT_VIQ_ACM_EN BIT(2) -+#define BIT_VOQ_ACM_EN BIT(1) -+#define BIT_ACMHWEN BIT(0) -+ -+/* 2 REG_ACMRSTCTRL (Offset 0x05C1) */ -+ -+#define BIT_BE_ACM_RESET_USED_TIME BIT(2) -+#define BIT_VI_ACM_RESET_USED_TIME BIT(1) -+#define BIT_VO_ACM_RESET_USED_TIME BIT(0) -+ -+/* 2 REG_ACMAVG (Offset 0x05C2) */ -+ -+#define BIT_SHIFT_AVGPERIOD 0 -+#define BIT_MASK_AVGPERIOD 0xffff -+#define BIT_AVGPERIOD(x) (((x) & BIT_MASK_AVGPERIOD) << BIT_SHIFT_AVGPERIOD) -+#define BITS_AVGPERIOD (BIT_MASK_AVGPERIOD << BIT_SHIFT_AVGPERIOD) -+#define BIT_CLEAR_AVGPERIOD(x) ((x) & (~BITS_AVGPERIOD)) -+#define BIT_GET_AVGPERIOD(x) (((x) >> BIT_SHIFT_AVGPERIOD) & BIT_MASK_AVGPERIOD) -+#define BIT_SET_AVGPERIOD(x, v) (BIT_CLEAR_AVGPERIOD(x) | BIT_AVGPERIOD(v)) -+ -+/* 2 REG_VO_ADMTIME (Offset 0x05C4) */ -+ -+#define BIT_SHIFT_VO_ADMITTED_TIME 0 -+#define BIT_MASK_VO_ADMITTED_TIME 0xffff -+#define BIT_VO_ADMITTED_TIME(x) \ -+ (((x) & BIT_MASK_VO_ADMITTED_TIME) << BIT_SHIFT_VO_ADMITTED_TIME) -+#define BITS_VO_ADMITTED_TIME \ -+ (BIT_MASK_VO_ADMITTED_TIME << BIT_SHIFT_VO_ADMITTED_TIME) -+#define BIT_CLEAR_VO_ADMITTED_TIME(x) ((x) & (~BITS_VO_ADMITTED_TIME)) -+#define BIT_GET_VO_ADMITTED_TIME(x) \ -+ (((x) >> BIT_SHIFT_VO_ADMITTED_TIME) & BIT_MASK_VO_ADMITTED_TIME) -+#define BIT_SET_VO_ADMITTED_TIME(x, v) \ -+ (BIT_CLEAR_VO_ADMITTED_TIME(x) | BIT_VO_ADMITTED_TIME(v)) -+ -+/* 2 REG_VI_ADMTIME (Offset 0x05C6) */ -+ -+#define BIT_SHIFT_VI_ADMITTED_TIME 0 -+#define BIT_MASK_VI_ADMITTED_TIME 0xffff -+#define BIT_VI_ADMITTED_TIME(x) \ -+ (((x) & BIT_MASK_VI_ADMITTED_TIME) << BIT_SHIFT_VI_ADMITTED_TIME) -+#define BITS_VI_ADMITTED_TIME \ -+ (BIT_MASK_VI_ADMITTED_TIME << BIT_SHIFT_VI_ADMITTED_TIME) -+#define BIT_CLEAR_VI_ADMITTED_TIME(x) ((x) & (~BITS_VI_ADMITTED_TIME)) -+#define BIT_GET_VI_ADMITTED_TIME(x) \ -+ (((x) >> BIT_SHIFT_VI_ADMITTED_TIME) & BIT_MASK_VI_ADMITTED_TIME) -+#define BIT_SET_VI_ADMITTED_TIME(x, v) \ -+ (BIT_CLEAR_VI_ADMITTED_TIME(x) | BIT_VI_ADMITTED_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BE_ADMTIME (Offset 0x05C8) */ -+ -+#define BIT_PRETX_ERRHDL_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BE_ADMTIME (Offset 0x05C8) */ -+ -+#define BIT_CHANGE_POW_BCN_AREA BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BE_ADMTIME (Offset 0x05C8) */ -+ -+#define BIT_DIS_NDPA_NAV_CHK BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BE_ADMTIME (Offset 0x05C8) */ -+ -+#define BIT_SHIFT_BE_ADMITTED_TIME 0 -+#define BIT_MASK_BE_ADMITTED_TIME 0xffff -+#define BIT_BE_ADMITTED_TIME(x) \ -+ (((x) & BIT_MASK_BE_ADMITTED_TIME) << BIT_SHIFT_BE_ADMITTED_TIME) -+#define BITS_BE_ADMITTED_TIME \ -+ (BIT_MASK_BE_ADMITTED_TIME << BIT_SHIFT_BE_ADMITTED_TIME) -+#define BIT_CLEAR_BE_ADMITTED_TIME(x) ((x) & (~BITS_BE_ADMITTED_TIME)) -+#define BIT_GET_BE_ADMITTED_TIME(x) \ -+ (((x) >> BIT_SHIFT_BE_ADMITTED_TIME) & BIT_MASK_BE_ADMITTED_TIME) -+#define BIT_SET_BE_ADMITTED_TIME(x, v) \ -+ (BIT_CLEAR_BE_ADMITTED_TIME(x) | BIT_BE_ADMITTED_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BE_ADMTIME (Offset 0x05C8) */ -+ -+#define BIT_SHIFT_MHDR_NAV_OFFSET 0 -+#define BIT_MASK_MHDR_NAV_OFFSET 0xff -+#define BIT_MHDR_NAV_OFFSET(x) \ -+ (((x) & BIT_MASK_MHDR_NAV_OFFSET) << BIT_SHIFT_MHDR_NAV_OFFSET) -+#define BITS_MHDR_NAV_OFFSET \ -+ (BIT_MASK_MHDR_NAV_OFFSET << BIT_SHIFT_MHDR_NAV_OFFSET) -+#define BIT_CLEAR_MHDR_NAV_OFFSET(x) ((x) & (~BITS_MHDR_NAV_OFFSET)) -+#define BIT_GET_MHDR_NAV_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_MHDR_NAV_OFFSET) & BIT_MASK_MHDR_NAV_OFFSET) -+#define BIT_SET_MHDR_NAV_OFFSET(x, v) \ -+ (BIT_CLEAR_MHDR_NAV_OFFSET(x) | BIT_MHDR_NAV_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAC_HEADER_NAV_OFFSET (Offset 0x05CA) */ -+ -+#define BIT_SHIFT_MAC_HEADER_NAV_OFFSET 0 -+#define BIT_MASK_MAC_HEADER_NAV_OFFSET 0xff -+#define BIT_MAC_HEADER_NAV_OFFSET(x) \ -+ (((x) & BIT_MASK_MAC_HEADER_NAV_OFFSET) \ -+ << BIT_SHIFT_MAC_HEADER_NAV_OFFSET) -+#define BITS_MAC_HEADER_NAV_OFFSET \ -+ (BIT_MASK_MAC_HEADER_NAV_OFFSET << BIT_SHIFT_MAC_HEADER_NAV_OFFSET) -+#define BIT_CLEAR_MAC_HEADER_NAV_OFFSET(x) ((x) & (~BITS_MAC_HEADER_NAV_OFFSET)) -+#define BIT_GET_MAC_HEADER_NAV_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_MAC_HEADER_NAV_OFFSET) & \ -+ BIT_MASK_MAC_HEADER_NAV_OFFSET) -+#define BIT_SET_MAC_HEADER_NAV_OFFSET(x, v) \ -+ (BIT_CLEAR_MAC_HEADER_NAV_OFFSET(x) | BIT_MAC_HEADER_NAV_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DIS_NDPA_NAV_CHECK (Offset 0x05CB) */ -+ -+#define BIT_CHG_POWER_BCN_AREA_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DIS_NDPA_NAV_CHECK (Offset 0x05CB) */ -+ -+#define BIT_DIS_NDPA_NAV_CHECK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_EDCA_RANDOM_GEN (Offset 0x05CC) */ -+ -+#define BIT_SHIFT_RANDOM_GEN 0 -+#define BIT_MASK_RANDOM_GEN 0xffffff -+#define BIT_RANDOM_GEN(x) (((x) & BIT_MASK_RANDOM_GEN) << BIT_SHIFT_RANDOM_GEN) -+#define BITS_RANDOM_GEN (BIT_MASK_RANDOM_GEN << BIT_SHIFT_RANDOM_GEN) -+#define BIT_CLEAR_RANDOM_GEN(x) ((x) & (~BITS_RANDOM_GEN)) -+#define BIT_GET_RANDOM_GEN(x) \ -+ (((x) >> BIT_SHIFT_RANDOM_GEN) & BIT_MASK_RANDOM_GEN) -+#define BIT_SET_RANDOM_GEN(x, v) (BIT_CLEAR_RANDOM_GEN(x) | BIT_RANDOM_GEN(v)) -+ -+#define BIT_SHIFT_TXCMD_SEG_SEL 0 -+#define BIT_MASK_TXCMD_SEG_SEL 0xf -+#define BIT_TXCMD_SEG_SEL(x) \ -+ (((x) & BIT_MASK_TXCMD_SEG_SEL) << BIT_SHIFT_TXCMD_SEG_SEL) -+#define BITS_TXCMD_SEG_SEL (BIT_MASK_TXCMD_SEG_SEL << BIT_SHIFT_TXCMD_SEG_SEL) -+#define BIT_CLEAR_TXCMD_SEG_SEL(x) ((x) & (~BITS_TXCMD_SEG_SEL)) -+#define BIT_GET_TXCMD_SEG_SEL(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_SEG_SEL) & BIT_MASK_TXCMD_SEG_SEL) -+#define BIT_SET_TXCMD_SEG_SEL(x, v) \ -+ (BIT_CLEAR_TXCMD_SEG_SEL(x) | BIT_TXCMD_SEG_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TXCMD_NOA_SEL (Offset 0x05CF) */ -+ -+#define BIT_SHIFT_EVTQ_EARLY 5 -+#define BIT_MASK_EVTQ_EARLY 0x7 -+#define BIT_EVTQ_EARLY(x) (((x) & BIT_MASK_EVTQ_EARLY) << BIT_SHIFT_EVTQ_EARLY) -+#define BITS_EVTQ_EARLY (BIT_MASK_EVTQ_EARLY << BIT_SHIFT_EVTQ_EARLY) -+#define BIT_CLEAR_EVTQ_EARLY(x) ((x) & (~BITS_EVTQ_EARLY)) -+#define BIT_GET_EVTQ_EARLY(x) \ -+ (((x) >> BIT_SHIFT_EVTQ_EARLY) & BIT_MASK_EVTQ_EARLY) -+#define BIT_SET_EVTQ_EARLY(x, v) (BIT_CLEAR_EVTQ_EARLY(x) | BIT_EVTQ_EARLY(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TXCMD_NOA_SEL (Offset 0x05CF) */ -+ -+#define BIT_NOA_SEL BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXCMD_NOA_SEL (Offset 0x05CF) */ -+ -+#define BIT_SHIFT_NOA_SEL_V2 4 -+#define BIT_MASK_NOA_SEL_V2 0x7 -+#define BIT_NOA_SEL_V2(x) (((x) & BIT_MASK_NOA_SEL_V2) << BIT_SHIFT_NOA_SEL_V2) -+#define BITS_NOA_SEL_V2 (BIT_MASK_NOA_SEL_V2 << BIT_SHIFT_NOA_SEL_V2) -+#define BIT_CLEAR_NOA_SEL_V2(x) ((x) & (~BITS_NOA_SEL_V2)) -+#define BIT_GET_NOA_SEL_V2(x) \ -+ (((x) >> BIT_SHIFT_NOA_SEL_V2) & BIT_MASK_NOA_SEL_V2) -+#define BIT_SET_NOA_SEL_V2(x, v) (BIT_CLEAR_NOA_SEL_V2(x) | BIT_NOA_SEL_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BCNERR_CFG (Offset 0x05D0) */ -+ -+#define BIT_BCNERR_CNT_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_32K_CLK_SEL (Offset 0x05D0) */ -+ -+#define BIT_R_BCNERR_CNT_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DRVERLYINT2 (Offset 0x05D0) */ -+ -+#define BIT_SHIFT_TSF_DIFF_P1P2 16 -+#define BIT_MASK_TSF_DIFF_P1P2 0xffff -+#define BIT_TSF_DIFF_P1P2(x) \ -+ (((x) & BIT_MASK_TSF_DIFF_P1P2) << BIT_SHIFT_TSF_DIFF_P1P2) -+#define BITS_TSF_DIFF_P1P2 (BIT_MASK_TSF_DIFF_P1P2 << BIT_SHIFT_TSF_DIFF_P1P2) -+#define BIT_CLEAR_TSF_DIFF_P1P2(x) ((x) & (~BITS_TSF_DIFF_P1P2)) -+#define BIT_GET_TSF_DIFF_P1P2(x) \ -+ (((x) >> BIT_SHIFT_TSF_DIFF_P1P2) & BIT_MASK_TSF_DIFF_P1P2) -+#define BIT_SET_TSF_DIFF_P1P2(x, v) \ -+ (BIT_CLEAR_TSF_DIFF_P1P2(x) | BIT_TSF_DIFF_P1P2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_BCNERR_CFG (Offset 0x05D0) */ -+ -+#define BIT_SHIFT_BCNERR_PORT_SEL_V2 16 -+#define BIT_MASK_BCNERR_PORT_SEL_V2 0x7 -+#define BIT_BCNERR_PORT_SEL_V2(x) \ -+ (((x) & BIT_MASK_BCNERR_PORT_SEL_V2) << BIT_SHIFT_BCNERR_PORT_SEL_V2) -+#define BITS_BCNERR_PORT_SEL_V2 \ -+ (BIT_MASK_BCNERR_PORT_SEL_V2 << BIT_SHIFT_BCNERR_PORT_SEL_V2) -+#define BIT_CLEAR_BCNERR_PORT_SEL_V2(x) ((x) & (~BITS_BCNERR_PORT_SEL_V2)) -+#define BIT_GET_BCNERR_PORT_SEL_V2(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_PORT_SEL_V2) & BIT_MASK_BCNERR_PORT_SEL_V2) -+#define BIT_SET_BCNERR_PORT_SEL_V2(x, v) \ -+ (BIT_CLEAR_BCNERR_PORT_SEL_V2(x) | BIT_BCNERR_PORT_SEL_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_32K_CLK_SEL (Offset 0x05D0) */ -+ -+#define BIT_SHIFT_R_BCNERR_PORT_SEL 16 -+#define BIT_MASK_R_BCNERR_PORT_SEL 0x7 -+#define BIT_R_BCNERR_PORT_SEL(x) \ -+ (((x) & BIT_MASK_R_BCNERR_PORT_SEL) << BIT_SHIFT_R_BCNERR_PORT_SEL) -+#define BITS_R_BCNERR_PORT_SEL \ -+ (BIT_MASK_R_BCNERR_PORT_SEL << BIT_SHIFT_R_BCNERR_PORT_SEL) -+#define BIT_CLEAR_R_BCNERR_PORT_SEL(x) ((x) & (~BITS_R_BCNERR_PORT_SEL)) -+#define BIT_GET_R_BCNERR_PORT_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_BCNERR_PORT_SEL) & BIT_MASK_R_BCNERR_PORT_SEL) -+#define BIT_SET_R_BCNERR_PORT_SEL(x, v) \ -+ (BIT_CLEAR_R_BCNERR_PORT_SEL(x) | BIT_R_BCNERR_PORT_SEL(v)) -+ -+#define BIT_SHIFT_R_TXPAUSE1 8 -+#define BIT_MASK_R_TXPAUSE1 0xff -+#define BIT_R_TXPAUSE1(x) (((x) & BIT_MASK_R_TXPAUSE1) << BIT_SHIFT_R_TXPAUSE1) -+#define BITS_R_TXPAUSE1 (BIT_MASK_R_TXPAUSE1 << BIT_SHIFT_R_TXPAUSE1) -+#define BIT_CLEAR_R_TXPAUSE1(x) ((x) & (~BITS_R_TXPAUSE1)) -+#define BIT_GET_R_TXPAUSE1(x) \ -+ (((x) >> BIT_SHIFT_R_TXPAUSE1) & BIT_MASK_R_TXPAUSE1) -+#define BIT_SET_R_TXPAUSE1(x, v) (BIT_CLEAR_R_TXPAUSE1(x) | BIT_R_TXPAUSE1(v)) -+ -+#define BIT_SLEEP_32K_EN_V1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_DRVERLYINT2 (Offset 0x05D0) */ -+ -+#define BIT_SHIFT_DRVERLYITV2 0 -+#define BIT_MASK_DRVERLYITV2 0xff -+#define BIT_DRVERLYITV2(x) \ -+ (((x) & BIT_MASK_DRVERLYITV2) << BIT_SHIFT_DRVERLYITV2) -+#define BITS_DRVERLYITV2 (BIT_MASK_DRVERLYITV2 << BIT_SHIFT_DRVERLYITV2) -+#define BIT_CLEAR_DRVERLYITV2(x) ((x) & (~BITS_DRVERLYITV2)) -+#define BIT_GET_DRVERLYITV2(x) \ -+ (((x) >> BIT_SHIFT_DRVERLYITV2) & BIT_MASK_DRVERLYITV2) -+#define BIT_SET_DRVERLYITV2(x, v) \ -+ (BIT_CLEAR_DRVERLYITV2(x) | BIT_DRVERLYITV2(v)) -+ -+/* 2 REG_NAN_SETTING (Offset 0x05D4) */ -+ -+#define BIT_EN_MULTI_BCN BIT(31) -+#define BIT_ENP2P_DW_AREA BIT(30) -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_HOLD_P2 18 -+#define BIT_MASK_TBTT_PROHIBIT_HOLD_P2 0xfff -+#define BIT_TBTT_PROHIBIT_HOLD_P2(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_HOLD_P2) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_HOLD_P2) -+#define BITS_TBTT_PROHIBIT_HOLD_P2 \ -+ (BIT_MASK_TBTT_PROHIBIT_HOLD_P2 << BIT_SHIFT_TBTT_PROHIBIT_HOLD_P2) -+#define BIT_CLEAR_TBTT_PROHIBIT_HOLD_P2(x) ((x) & (~BITS_TBTT_PROHIBIT_HOLD_P2)) -+#define BIT_GET_TBTT_PROHIBIT_HOLD_P2(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_HOLD_P2) & \ -+ BIT_MASK_TBTT_PROHIBIT_HOLD_P2) -+#define BIT_SET_TBTT_PROHIBIT_HOLD_P2(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_HOLD_P2(x) | BIT_TBTT_PROHIBIT_HOLD_P2(v)) -+ -+#define BIT_SHIFT_BCN_PORT_PRI 16 -+#define BIT_MASK_BCN_PORT_PRI 0x3 -+#define BIT_BCN_PORT_PRI(x) \ -+ (((x) & BIT_MASK_BCN_PORT_PRI) << BIT_SHIFT_BCN_PORT_PRI) -+#define BITS_BCN_PORT_PRI (BIT_MASK_BCN_PORT_PRI << BIT_SHIFT_BCN_PORT_PRI) -+#define BIT_CLEAR_BCN_PORT_PRI(x) ((x) & (~BITS_BCN_PORT_PRI)) -+#define BIT_GET_BCN_PORT_PRI(x) \ -+ (((x) >> BIT_SHIFT_BCN_PORT_PRI) & BIT_MASK_BCN_PORT_PRI) -+#define BIT_SET_BCN_PORT_PRI(x, v) \ -+ (BIT_CLEAR_BCN_PORT_PRI(x) | BIT_BCN_PORT_PRI(v)) -+ -+#define BIT_SHIFT_DRVERLYITV1 8 -+#define BIT_MASK_DRVERLYITV1 0xff -+#define BIT_DRVERLYITV1(x) \ -+ (((x) & BIT_MASK_DRVERLYITV1) << BIT_SHIFT_DRVERLYITV1) -+#define BITS_DRVERLYITV1 (BIT_MASK_DRVERLYITV1 << BIT_SHIFT_DRVERLYITV1) -+#define BIT_CLEAR_DRVERLYITV1(x) ((x) & (~BITS_DRVERLYITV1)) -+#define BIT_GET_DRVERLYITV1(x) \ -+ (((x) >> BIT_SHIFT_DRVERLYITV1) & BIT_MASK_DRVERLYITV1) -+#define BIT_SET_DRVERLYITV1(x, v) \ -+ (BIT_CLEAR_DRVERLYITV1(x) | BIT_DRVERLYITV1(v)) -+ -+#define BIT_DIS_RX_BSSID_FIT2 BIT(6) -+#define BIT_DIS_TSF2_UDT BIT(4) -+#define BIT_EN_BCN2_FUNCTION BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BCN_ELY_ADJ (Offset 0x05D4) */ -+ -+#define BIT_SHIFT_BCN_ELY_ADJ 0 -+#define BIT_MASK_BCN_ELY_ADJ 0xffff -+#define BIT_BCN_ELY_ADJ(x) \ -+ (((x) & BIT_MASK_BCN_ELY_ADJ) << BIT_SHIFT_BCN_ELY_ADJ) -+#define BITS_BCN_ELY_ADJ (BIT_MASK_BCN_ELY_ADJ << BIT_SHIFT_BCN_ELY_ADJ) -+#define BIT_CLEAR_BCN_ELY_ADJ(x) ((x) & (~BITS_BCN_ELY_ADJ)) -+#define BIT_GET_BCN_ELY_ADJ(x) \ -+ (((x) >> BIT_SHIFT_BCN_ELY_ADJ) & BIT_MASK_BCN_ELY_ADJ) -+#define BIT_SET_BCN_ELY_ADJ(x, v) \ -+ (BIT_CLEAR_BCN_ELY_ADJ(x) | BIT_BCN_ELY_ADJ(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_EARLYINT_ADJUST (Offset 0x05D4) */ -+ -+#define BIT_SHIFT_R_ERLYINTADJ 0 -+#define BIT_MASK_R_ERLYINTADJ 0xffff -+#define BIT_R_ERLYINTADJ(x) \ -+ (((x) & BIT_MASK_R_ERLYINTADJ) << BIT_SHIFT_R_ERLYINTADJ) -+#define BITS_R_ERLYINTADJ (BIT_MASK_R_ERLYINTADJ << BIT_SHIFT_R_ERLYINTADJ) -+#define BIT_CLEAR_R_ERLYINTADJ(x) ((x) & (~BITS_R_ERLYINTADJ)) -+#define BIT_GET_R_ERLYINTADJ(x) \ -+ (((x) >> BIT_SHIFT_R_ERLYINTADJ) & BIT_MASK_R_ERLYINTADJ) -+#define BIT_SET_R_ERLYINTADJ(x, v) \ -+ (BIT_CLEAR_R_ERLYINTADJ(x) | BIT_R_ERLYINTADJ(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_NAN_BCNSPACE (Offset 0x05D8) */ -+ -+#define BIT_SHIFT_BCN_SPACE4 16 -+#define BIT_MASK_BCN_SPACE4 0xffff -+#define BIT_BCN_SPACE4(x) (((x) & BIT_MASK_BCN_SPACE4) << BIT_SHIFT_BCN_SPACE4) -+#define BITS_BCN_SPACE4 (BIT_MASK_BCN_SPACE4 << BIT_SHIFT_BCN_SPACE4) -+#define BIT_CLEAR_BCN_SPACE4(x) ((x) & (~BITS_BCN_SPACE4)) -+#define BIT_GET_BCN_SPACE4(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE4) & BIT_MASK_BCN_SPACE4) -+#define BIT_SET_BCN_SPACE4(x, v) (BIT_CLEAR_BCN_SPACE4(x) | BIT_BCN_SPACE4(v)) -+ -+#define BIT_SHIFT_BCN_SPACE3 0 -+#define BIT_MASK_BCN_SPACE3 0xffff -+#define BIT_BCN_SPACE3(x) (((x) & BIT_MASK_BCN_SPACE3) << BIT_SHIFT_BCN_SPACE3) -+#define BITS_BCN_SPACE3 (BIT_MASK_BCN_SPACE3 << BIT_SHIFT_BCN_SPACE3) -+#define BIT_CLEAR_BCN_SPACE3(x) ((x) & (~BITS_BCN_SPACE3)) -+#define BIT_GET_BCN_SPACE3(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE3) & BIT_MASK_BCN_SPACE3) -+#define BIT_SET_BCN_SPACE3(x, v) (BIT_CLEAR_BCN_SPACE3(x) | BIT_BCN_SPACE3(v)) -+ -+/* 2 REG_NAN_SETTING1 (Offset 0x05DC) */ -+ -+#define BIT_SHIFT_SYNCBCN_RXNUM 27 -+#define BIT_MASK_SYNCBCN_RXNUM 0x1f -+#define BIT_SYNCBCN_RXNUM(x) \ -+ (((x) & BIT_MASK_SYNCBCN_RXNUM) << BIT_SHIFT_SYNCBCN_RXNUM) -+#define BITS_SYNCBCN_RXNUM (BIT_MASK_SYNCBCN_RXNUM << BIT_SHIFT_SYNCBCN_RXNUM) -+#define BIT_CLEAR_SYNCBCN_RXNUM(x) ((x) & (~BITS_SYNCBCN_RXNUM)) -+#define BIT_GET_SYNCBCN_RXNUM(x) \ -+ (((x) >> BIT_SHIFT_SYNCBCN_RXNUM) & BIT_MASK_SYNCBCN_RXNUM) -+#define BIT_SET_SYNCBCN_RXNUM(x, v) \ -+ (BIT_CLEAR_SYNCBCN_RXNUM(x) | BIT_SYNCBCN_RXNUM(v)) -+ -+#define BIT_DW_END_EARLY BIT(26) -+ -+#define BIT_SHIFT_NAN_ROLE 24 -+#define BIT_MASK_NAN_ROLE 0x3 -+#define BIT_NAN_ROLE(x) (((x) & BIT_MASK_NAN_ROLE) << BIT_SHIFT_NAN_ROLE) -+#define BITS_NAN_ROLE (BIT_MASK_NAN_ROLE << BIT_SHIFT_NAN_ROLE) -+#define BIT_CLEAR_NAN_ROLE(x) ((x) & (~BITS_NAN_ROLE)) -+#define BIT_GET_NAN_ROLE(x) (((x) >> BIT_SHIFT_NAN_ROLE) & BIT_MASK_NAN_ROLE) -+#define BIT_SET_NAN_ROLE(x, v) (BIT_CLEAR_NAN_ROLE(x) | BIT_NAN_ROLE(v)) -+ -+#define BIT_SHIFT_MSLOT_EVTQ 16 -+#define BIT_MASK_MSLOT_EVTQ 0xff -+#define BIT_MSLOT_EVTQ(x) (((x) & BIT_MASK_MSLOT_EVTQ) << BIT_SHIFT_MSLOT_EVTQ) -+#define BITS_MSLOT_EVTQ (BIT_MASK_MSLOT_EVTQ << BIT_SHIFT_MSLOT_EVTQ) -+#define BIT_CLEAR_MSLOT_EVTQ(x) ((x) & (~BITS_MSLOT_EVTQ)) -+#define BIT_GET_MSLOT_EVTQ(x) \ -+ (((x) >> BIT_SHIFT_MSLOT_EVTQ) & BIT_MASK_MSLOT_EVTQ) -+#define BIT_SET_MSLOT_EVTQ(x, v) (BIT_CLEAR_MSLOT_EVTQ(x) | BIT_MSLOT_EVTQ(v)) -+ -+#define BIT_SHIFT_MDW_EVTQ 8 -+#define BIT_MASK_MDW_EVTQ 0xff -+#define BIT_MDW_EVTQ(x) (((x) & BIT_MASK_MDW_EVTQ) << BIT_SHIFT_MDW_EVTQ) -+#define BITS_MDW_EVTQ (BIT_MASK_MDW_EVTQ << BIT_SHIFT_MDW_EVTQ) -+#define BIT_CLEAR_MDW_EVTQ(x) ((x) & (~BITS_MDW_EVTQ)) -+#define BIT_GET_MDW_EVTQ(x) (((x) >> BIT_SHIFT_MDW_EVTQ) & BIT_MASK_MDW_EVTQ) -+#define BIT_SET_MDW_EVTQ(x, v) (BIT_CLEAR_MDW_EVTQ(x) | BIT_MDW_EVTQ(v)) -+ -+#define BIT_SHIFT_HC 0 -+#define BIT_MASK_HC 0xff -+#define BIT_HC(x) (((x) & BIT_MASK_HC) << BIT_SHIFT_HC) -+#define BITS_HC (BIT_MASK_HC << BIT_SHIFT_HC) -+#define BIT_CLEAR_HC(x) ((x) & (~BITS_HC)) -+#define BIT_GET_HC(x) (((x) >> BIT_SHIFT_HC) & BIT_MASK_HC) -+#define BIT_SET_HC(x, v) (BIT_CLEAR_HC(x) | BIT_HC(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_NOA_PARAM (Offset 0x05E0) */ -+ -+#define BIT_SHIFT_NOA_COUNT (96 & CPU_OPT_WIDTH) -+#define BIT_MASK_NOA_COUNT 0xff -+#define BIT_NOA_COUNT(x) (((x) & BIT_MASK_NOA_COUNT) << BIT_SHIFT_NOA_COUNT) -+#define BITS_NOA_COUNT (BIT_MASK_NOA_COUNT << BIT_SHIFT_NOA_COUNT) -+#define BIT_CLEAR_NOA_COUNT(x) ((x) & (~BITS_NOA_COUNT)) -+#define BIT_GET_NOA_COUNT(x) (((x) >> BIT_SHIFT_NOA_COUNT) & BIT_MASK_NOA_COUNT) -+#define BIT_SET_NOA_COUNT(x, v) (BIT_CLEAR_NOA_COUNT(x) | BIT_NOA_COUNT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_NOA_PARAM (Offset 0x05E0) */ -+ -+#define BIT_SHIFT_NOA_DURATION 0 -+#define BIT_MASK_NOA_DURATION 0xffffffffL -+#define BIT_NOA_DURATION(x) \ -+ (((x) & BIT_MASK_NOA_DURATION) << BIT_SHIFT_NOA_DURATION) -+#define BITS_NOA_DURATION (BIT_MASK_NOA_DURATION << BIT_SHIFT_NOA_DURATION) -+#define BIT_CLEAR_NOA_DURATION(x) ((x) & (~BITS_NOA_DURATION)) -+#define BIT_GET_NOA_DURATION(x) \ -+ (((x) >> BIT_SHIFT_NOA_DURATION) & BIT_MASK_NOA_DURATION) -+#define BIT_SET_NOA_DURATION(x, v) \ -+ (BIT_CLEAR_NOA_DURATION(x) | BIT_NOA_DURATION(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NOA_PARAM (Offset 0x05E0) */ -+ -+#define BIT_SHIFT_NOA_DURATION_V1 0 -+#define BIT_MASK_NOA_DURATION_V1 0xffffffffL -+#define BIT_NOA_DURATION_V1(x) \ -+ (((x) & BIT_MASK_NOA_DURATION_V1) << BIT_SHIFT_NOA_DURATION_V1) -+#define BITS_NOA_DURATION_V1 \ -+ (BIT_MASK_NOA_DURATION_V1 << BIT_SHIFT_NOA_DURATION_V1) -+#define BIT_CLEAR_NOA_DURATION_V1(x) ((x) & (~BITS_NOA_DURATION_V1)) -+#define BIT_GET_NOA_DURATION_V1(x) \ -+ (((x) >> BIT_SHIFT_NOA_DURATION_V1) & BIT_MASK_NOA_DURATION_V1) -+#define BIT_SET_NOA_DURATION_V1(x, v) \ -+ (BIT_CLEAR_NOA_DURATION_V1(x) | BIT_NOA_DURATION_V1(v)) -+ -+/* 2 REG_NOA_PARAM_1 (Offset 0x05E4) */ -+ -+#define BIT_SHIFT_NOA_INTERVAL_V1 0 -+#define BIT_MASK_NOA_INTERVAL_V1 0xffffffffL -+#define BIT_NOA_INTERVAL_V1(x) \ -+ (((x) & BIT_MASK_NOA_INTERVAL_V1) << BIT_SHIFT_NOA_INTERVAL_V1) -+#define BITS_NOA_INTERVAL_V1 \ -+ (BIT_MASK_NOA_INTERVAL_V1 << BIT_SHIFT_NOA_INTERVAL_V1) -+#define BIT_CLEAR_NOA_INTERVAL_V1(x) ((x) & (~BITS_NOA_INTERVAL_V1)) -+#define BIT_GET_NOA_INTERVAL_V1(x) \ -+ (((x) >> BIT_SHIFT_NOA_INTERVAL_V1) & BIT_MASK_NOA_INTERVAL_V1) -+#define BIT_SET_NOA_INTERVAL_V1(x, v) \ -+ (BIT_CLEAR_NOA_INTERVAL_V1(x) | BIT_NOA_INTERVAL_V1(v)) -+ -+/* 2 REG_NOA_PARAM_2 (Offset 0x05E8) */ -+ -+#define BIT_SHIFT_NOA_START_TIME_V1 0 -+#define BIT_MASK_NOA_START_TIME_V1 0xffffffffL -+#define BIT_NOA_START_TIME_V1(x) \ -+ (((x) & BIT_MASK_NOA_START_TIME_V1) << BIT_SHIFT_NOA_START_TIME_V1) -+#define BITS_NOA_START_TIME_V1 \ -+ (BIT_MASK_NOA_START_TIME_V1 << BIT_SHIFT_NOA_START_TIME_V1) -+#define BIT_CLEAR_NOA_START_TIME_V1(x) ((x) & (~BITS_NOA_START_TIME_V1)) -+#define BIT_GET_NOA_START_TIME_V1(x) \ -+ (((x) >> BIT_SHIFT_NOA_START_TIME_V1) & BIT_MASK_NOA_START_TIME_V1) -+#define BIT_SET_NOA_START_TIME_V1(x, v) \ -+ (BIT_CLEAR_NOA_START_TIME_V1(x) | BIT_NOA_START_TIME_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_DBG_INFO (Offset 0x05E8) */ -+ -+#define BIT_SHIFT_MU_DBG_INFO 0 -+#define BIT_MASK_MU_DBG_INFO 0xffffffffL -+#define BIT_MU_DBG_INFO(x) \ -+ (((x) & BIT_MASK_MU_DBG_INFO) << BIT_SHIFT_MU_DBG_INFO) -+#define BITS_MU_DBG_INFO (BIT_MASK_MU_DBG_INFO << BIT_SHIFT_MU_DBG_INFO) -+#define BIT_CLEAR_MU_DBG_INFO(x) ((x) & (~BITS_MU_DBG_INFO)) -+#define BIT_GET_MU_DBG_INFO(x) \ -+ (((x) >> BIT_SHIFT_MU_DBG_INFO) & BIT_MASK_MU_DBG_INFO) -+#define BIT_SET_MU_DBG_INFO(x, v) \ -+ (BIT_CLEAR_MU_DBG_INFO(x) | BIT_MU_DBG_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NOA_PARAM_3 (Offset 0x05EC) */ -+ -+#define BIT_SHIFT_NOA_COUNT_V3 0 -+#define BIT_MASK_NOA_COUNT_V3 0xff -+#define BIT_NOA_COUNT_V3(x) \ -+ (((x) & BIT_MASK_NOA_COUNT_V3) << BIT_SHIFT_NOA_COUNT_V3) -+#define BITS_NOA_COUNT_V3 (BIT_MASK_NOA_COUNT_V3 << BIT_SHIFT_NOA_COUNT_V3) -+#define BIT_CLEAR_NOA_COUNT_V3(x) ((x) & (~BITS_NOA_COUNT_V3)) -+#define BIT_GET_NOA_COUNT_V3(x) \ -+ (((x) >> BIT_SHIFT_NOA_COUNT_V3) & BIT_MASK_NOA_COUNT_V3) -+#define BIT_SET_NOA_COUNT_V3(x, v) \ -+ (BIT_CLEAR_NOA_COUNT_V3(x) | BIT_NOA_COUNT_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NOA_PARAM_3 (Offset 0x05EC) */ -+ -+#define BIT_SHIFT_NOA_COUNT_V1 0 -+#define BIT_MASK_NOA_COUNT_V1 0xffffffffL -+#define BIT_NOA_COUNT_V1(x) \ -+ (((x) & BIT_MASK_NOA_COUNT_V1) << BIT_SHIFT_NOA_COUNT_V1) -+#define BITS_NOA_COUNT_V1 (BIT_MASK_NOA_COUNT_V1 << BIT_SHIFT_NOA_COUNT_V1) -+#define BIT_CLEAR_NOA_COUNT_V1(x) ((x) & (~BITS_NOA_COUNT_V1)) -+#define BIT_GET_NOA_COUNT_V1(x) \ -+ (((x) >> BIT_SHIFT_NOA_COUNT_V1) & BIT_MASK_NOA_COUNT_V1) -+#define BIT_SET_NOA_COUNT_V1(x, v) \ -+ (BIT_CLEAR_NOA_COUNT_V1(x) | BIT_NOA_COUNT_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_DBG_INFO_1 (Offset 0x05EC) */ -+ -+#define BIT_SHIFT_MU_DBG_INFO_1 0 -+#define BIT_MASK_MU_DBG_INFO_1 0xffffffffL -+#define BIT_MU_DBG_INFO_1(x) \ -+ (((x) & BIT_MASK_MU_DBG_INFO_1) << BIT_SHIFT_MU_DBG_INFO_1) -+#define BITS_MU_DBG_INFO_1 (BIT_MASK_MU_DBG_INFO_1 << BIT_SHIFT_MU_DBG_INFO_1) -+#define BIT_CLEAR_MU_DBG_INFO_1(x) ((x) & (~BITS_MU_DBG_INFO_1)) -+#define BIT_GET_MU_DBG_INFO_1(x) \ -+ (((x) >> BIT_SHIFT_MU_DBG_INFO_1) & BIT_MASK_MU_DBG_INFO_1) -+#define BIT_SET_MU_DBG_INFO_1(x, v) \ -+ (BIT_CLEAR_MU_DBG_INFO_1(x) | BIT_MU_DBG_INFO_1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_NOA_SUBIE (Offset 0x05ED) */ -+ -+#define BIT_MORE_NOA_DESC BIT(19) -+#define BIT_NOA_DESC1_VALID BIT(18) -+#define BIT_NOA_DESC0_VALID BIT(17) -+#define BIT_NOA_HEAD_VALID BIT(16) -+#define BIT_NOA_OPP_PS BIT(15) -+ -+#define BIT_SHIFT_NOA_CTW 8 -+#define BIT_MASK_NOA_CTW 0x7f -+#define BIT_NOA_CTW(x) (((x) & BIT_MASK_NOA_CTW) << BIT_SHIFT_NOA_CTW) -+#define BITS_NOA_CTW (BIT_MASK_NOA_CTW << BIT_SHIFT_NOA_CTW) -+#define BIT_CLEAR_NOA_CTW(x) ((x) & (~BITS_NOA_CTW)) -+#define BIT_GET_NOA_CTW(x) (((x) >> BIT_SHIFT_NOA_CTW) & BIT_MASK_NOA_CTW) -+#define BIT_SET_NOA_CTW(x, v) (BIT_CLEAR_NOA_CTW(x) | BIT_NOA_CTW(v)) -+ -+#define BIT_SHIFT_NOA_INDEX 0 -+#define BIT_MASK_NOA_INDEX 0xff -+#define BIT_NOA_INDEX(x) (((x) & BIT_MASK_NOA_INDEX) << BIT_SHIFT_NOA_INDEX) -+#define BITS_NOA_INDEX (BIT_MASK_NOA_INDEX << BIT_SHIFT_NOA_INDEX) -+#define BIT_CLEAR_NOA_INDEX(x) ((x) & (~BITS_NOA_INDEX)) -+#define BIT_GET_NOA_INDEX(x) (((x) >> BIT_SHIFT_NOA_INDEX) & BIT_MASK_NOA_INDEX) -+#define BIT_SET_NOA_INDEX(x, v) (BIT_CLEAR_NOA_INDEX(x) | BIT_NOA_INDEX(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2P_RST (Offset 0x05F0) */ -+ -+#define BIT_P2P2_PWR_RST1 BIT(5) -+#define BIT_P2P2_PWR_RST0 BIT(4) -+#define BIT_P2P1_PWR_RST1 BIT(3) -+#define BIT_P2P1_PWR_RST0 BIT(2) -+#define BIT_P2P_PWR_RST1_V1 BIT(1) -+#define BIT_P2P_PWR_RST0_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SCH_DBG_SEL (Offset 0x05F0) */ -+ -+#define BIT_SHIFT_SCH_DBG_SEL 0 -+#define BIT_MASK_SCH_DBG_SEL 0xff -+#define BIT_SCH_DBG_SEL(x) \ -+ (((x) & BIT_MASK_SCH_DBG_SEL) << BIT_SHIFT_SCH_DBG_SEL) -+#define BITS_SCH_DBG_SEL (BIT_MASK_SCH_DBG_SEL << BIT_SHIFT_SCH_DBG_SEL) -+#define BIT_CLEAR_SCH_DBG_SEL(x) ((x) & (~BITS_SCH_DBG_SEL)) -+#define BIT_GET_SCH_DBG_SEL(x) \ -+ (((x) >> BIT_SHIFT_SCH_DBG_SEL) & BIT_MASK_SCH_DBG_SEL) -+#define BIT_SET_SCH_DBG_SEL(x, v) \ -+ (BIT_CLEAR_SCH_DBG_SEL(x) | BIT_SCH_DBG_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SCHEDULER_RST (Offset 0x05F1) */ -+ -+#define BIT_MAC_STOP_CPUMGQ BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_SCHEDULER_RST (Offset 0x05F1) */ -+ -+#define BIT_SYNC_TSF_NOW BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SCHEDULER_RST (Offset 0x05F1) */ -+ -+#define BIT_SYNC_CLI_ONCE_RIGHT_NOW BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SCHEDULER_RST (Offset 0x05F1) */ -+ -+#define BIT_EN_P2P_CTWINDOW BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SCHEDULER_RST (Offset 0x05F1) */ -+ -+#define BIT_SYNC_CLI BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SCHEDULER_RST (Offset 0x05F1) */ -+ -+#define BIT_SYNC_CLI_ONCE_BY_TBTT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SCHEDULER_RST (Offset 0x05F1) */ -+ -+#define BIT_SCHEDULER_RST_V1 BIT(0) -+#define BIT_EN_P2P_BCNQ_AREA BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_DBG_ERR_FLAG (Offset 0x05F2) */ -+ -+#define BIT_BCN_PORTID_ERR BIT(2) -+ -+#define BIT_SHIFT_MU_DBG_ERR_FLAG 0 -+#define BIT_MASK_MU_DBG_ERR_FLAG 0x3 -+#define BIT_MU_DBG_ERR_FLAG(x) \ -+ (((x) & BIT_MASK_MU_DBG_ERR_FLAG) << BIT_SHIFT_MU_DBG_ERR_FLAG) -+#define BITS_MU_DBG_ERR_FLAG \ -+ (BIT_MASK_MU_DBG_ERR_FLAG << BIT_SHIFT_MU_DBG_ERR_FLAG) -+#define BIT_CLEAR_MU_DBG_ERR_FLAG(x) ((x) & (~BITS_MU_DBG_ERR_FLAG)) -+#define BIT_GET_MU_DBG_ERR_FLAG(x) \ -+ (((x) >> BIT_SHIFT_MU_DBG_ERR_FLAG) & BIT_MASK_MU_DBG_ERR_FLAG) -+#define BIT_SET_MU_DBG_ERR_FLAG(x, v) \ -+ (BIT_CLEAR_MU_DBG_ERR_FLAG(x) | BIT_MU_DBG_ERR_FLAG(v)) -+ -+/* 2 REG_TX_ERR_RECOVERY_RST (Offset 0x05F3) */ -+ -+#define BIT_SHIFT_ERR_RECOVER_CNT 4 -+#define BIT_MASK_ERR_RECOVER_CNT 0xf -+#define BIT_ERR_RECOVER_CNT(x) \ -+ (((x) & BIT_MASK_ERR_RECOVER_CNT) << BIT_SHIFT_ERR_RECOVER_CNT) -+#define BITS_ERR_RECOVER_CNT \ -+ (BIT_MASK_ERR_RECOVER_CNT << BIT_SHIFT_ERR_RECOVER_CNT) -+#define BIT_CLEAR_ERR_RECOVER_CNT(x) ((x) & (~BITS_ERR_RECOVER_CNT)) -+#define BIT_GET_ERR_RECOVER_CNT(x) \ -+ (((x) >> BIT_SHIFT_ERR_RECOVER_CNT) & BIT_MASK_ERR_RECOVER_CNT) -+#define BIT_SET_ERR_RECOVER_CNT(x, v) \ -+ (BIT_CLEAR_ERR_RECOVER_CNT(x) | BIT_ERR_RECOVER_CNT(v)) -+ -+#define BIT_RX_HANG_ERR BIT(2) -+#define BIT_TX_HANG_ERR BIT(1) -+#define BIT_TX_ERR_RECOVERY_RST BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SCH_DBG (Offset 0x05F4) */ -+ -+#define BIT_SHIFT_SCH_DBG 0 -+#define BIT_MASK_SCH_DBG 0xffffffffL -+#define BIT_SCH_DBG(x) (((x) & BIT_MASK_SCH_DBG) << BIT_SHIFT_SCH_DBG) -+#define BITS_SCH_DBG (BIT_MASK_SCH_DBG << BIT_SHIFT_SCH_DBG) -+#define BIT_CLEAR_SCH_DBG(x) ((x) & (~BITS_SCH_DBG)) -+#define BIT_GET_SCH_DBG(x) (((x) >> BIT_SHIFT_SCH_DBG) & BIT_MASK_SCH_DBG) -+#define BIT_SET_SCH_DBG(x, v) (BIT_CLEAR_SCH_DBG(x) | BIT_SCH_DBG(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SCH_DBG_VALUE (Offset 0x05F4) */ -+ -+#define BIT_SHIFT_SCH_DBG_VALUE 0 -+#define BIT_MASK_SCH_DBG_VALUE 0xffffffffL -+#define BIT_SCH_DBG_VALUE(x) \ -+ (((x) & BIT_MASK_SCH_DBG_VALUE) << BIT_SHIFT_SCH_DBG_VALUE) -+#define BITS_SCH_DBG_VALUE (BIT_MASK_SCH_DBG_VALUE << BIT_SHIFT_SCH_DBG_VALUE) -+#define BIT_CLEAR_SCH_DBG_VALUE(x) ((x) & (~BITS_SCH_DBG_VALUE)) -+#define BIT_GET_SCH_DBG_VALUE(x) \ -+ (((x) >> BIT_SHIFT_SCH_DBG_VALUE) & BIT_MASK_SCH_DBG_VALUE) -+#define BIT_SET_SCH_DBG_VALUE(x, v) \ -+ (BIT_CLEAR_SCH_DBG_VALUE(x) | BIT_SCH_DBG_VALUE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SCH_TXCMD (Offset 0x05F8) */ -+ -+#define BIT_DIS_RX_BSSID_FIT BIT(6) -+#define BIT_DIS_TSF_UDT BIT(4) -+ -+#define BIT_SHIFT_SCH_TXCMD 0 -+#define BIT_MASK_SCH_TXCMD 0xffffffffL -+#define BIT_SCH_TXCMD(x) (((x) & BIT_MASK_SCH_TXCMD) << BIT_SHIFT_SCH_TXCMD) -+#define BITS_SCH_TXCMD (BIT_MASK_SCH_TXCMD << BIT_SHIFT_SCH_TXCMD) -+#define BIT_CLEAR_SCH_TXCMD(x) ((x) & (~BITS_SCH_TXCMD)) -+#define BIT_GET_SCH_TXCMD(x) (((x) >> BIT_SHIFT_SCH_TXCMD) & BIT_MASK_SCH_TXCMD) -+#define BIT_SET_SCH_TXCMD(x, v) (BIT_CLEAR_SCH_TXCMD(x) | BIT_SCH_TXCMD(v)) -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_SETUP 0 -+#define BIT_MASK_TBTT_PROHIBIT_SETUP 0xf -+#define BIT_TBTT_PROHIBIT_SETUP(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_SETUP) << BIT_SHIFT_TBTT_PROHIBIT_SETUP) -+#define BITS_TBTT_PROHIBIT_SETUP \ -+ (BIT_MASK_TBTT_PROHIBIT_SETUP << BIT_SHIFT_TBTT_PROHIBIT_SETUP) -+#define BIT_CLEAR_TBTT_PROHIBIT_SETUP(x) ((x) & (~BITS_TBTT_PROHIBIT_SETUP)) -+#define BIT_GET_TBTT_PROHIBIT_SETUP(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_SETUP) & BIT_MASK_TBTT_PROHIBIT_SETUP) -+#define BIT_SET_TBTT_PROHIBIT_SETUP(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_SETUP(x) | BIT_TBTT_PROHIBIT_SETUP(v)) -+ -+#define BIT_SHIFT_DRVERLYITV 0 -+#define BIT_MASK_DRVERLYITV 0xff -+#define BIT_DRVERLYITV(x) (((x) & BIT_MASK_DRVERLYITV) << BIT_SHIFT_DRVERLYITV) -+#define BITS_DRVERLYITV (BIT_MASK_DRVERLYITV << BIT_SHIFT_DRVERLYITV) -+#define BIT_CLEAR_DRVERLYITV(x) ((x) & (~BITS_DRVERLYITV)) -+#define BIT_GET_DRVERLYITV(x) \ -+ (((x) >> BIT_SHIFT_DRVERLYITV) & BIT_MASK_DRVERLYITV) -+#define BIT_SET_DRVERLYITV(x, v) (BIT_CLEAR_DRVERLYITV(x) | BIT_DRVERLYITV(v)) -+ -+#define BIT_SHIFT_BCNDMATIM 0 -+#define BIT_MASK_BCNDMATIM 0xff -+#define BIT_BCNDMATIM(x) (((x) & BIT_MASK_BCNDMATIM) << BIT_SHIFT_BCNDMATIM) -+#define BITS_BCNDMATIM (BIT_MASK_BCNDMATIM << BIT_SHIFT_BCNDMATIM) -+#define BIT_CLEAR_BCNDMATIM(x) ((x) & (~BITS_BCNDMATIM)) -+#define BIT_GET_BCNDMATIM(x) (((x) >> BIT_SHIFT_BCNDMATIM) & BIT_MASK_BCNDMATIM) -+#define BIT_SET_BCNDMATIM(x, v) (BIT_CLEAR_BCNDMATIM(x) | BIT_BCNDMATIM(v)) -+ -+#define BIT_SHIFT_CTWND 0 -+#define BIT_MASK_CTWND 0xff -+#define BIT_CTWND(x) (((x) & BIT_MASK_CTWND) << BIT_SHIFT_CTWND) -+#define BITS_CTWND (BIT_MASK_CTWND << BIT_SHIFT_CTWND) -+#define BIT_CLEAR_CTWND(x) ((x) & (~BITS_CTWND)) -+#define BIT_GET_CTWND(x) (((x) >> BIT_SHIFT_CTWND) & BIT_MASK_CTWND) -+#define BIT_SET_CTWND(x, v) (BIT_CLEAR_CTWND(x) | BIT_CTWND(v)) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_PAGE5_DUMMY (Offset 0x05FC) */ -+ -+#define BIT_ECO_TXOP_BREAK_FORCE_CFEND BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WMAC_CR (Offset 0x0600) */ -+ -+#define BIT_APSDOFF_STATUS BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WMAC_CR (Offset 0x0600) */ -+ -+#define BIT_APSDOFF BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WMAC_CR (Offset 0x0600) */ -+ -+#define BIT_STANDBY_STATUS BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_CR (Offset 0x0600) */ -+ -+#define BIT_IC_MACPHY_M BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_FWPKT_CR (Offset 0x0601) */ -+ -+#define BIT_FWEN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WMAC_FWPKT_CR (Offset 0x0601) */ -+ -+#define BIT_FWRX_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_FWPKT_CR (Offset 0x0601) */ -+ -+#define BIT_PHYSTS_PKT_CTRL BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_WMAC_FWPKT_CR (Offset 0x0601) */ -+ -+#define BIT_FWFULL_TO_RXFF_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_FWPKT_CR (Offset 0x0601) */ -+ -+#define BIT_APPHDR_MIDSRCH_FAIL BIT(4) -+#define BIT_FWPARSING_EN BIT(3) -+ -+#define BIT_SHIFT_APPEND_MHDR_LEN 0 -+#define BIT_MASK_APPEND_MHDR_LEN 0x7 -+#define BIT_APPEND_MHDR_LEN(x) \ -+ (((x) & BIT_MASK_APPEND_MHDR_LEN) << BIT_SHIFT_APPEND_MHDR_LEN) -+#define BITS_APPEND_MHDR_LEN \ -+ (BIT_MASK_APPEND_MHDR_LEN << BIT_SHIFT_APPEND_MHDR_LEN) -+#define BIT_CLEAR_APPEND_MHDR_LEN(x) ((x) & (~BITS_APPEND_MHDR_LEN)) -+#define BIT_GET_APPEND_MHDR_LEN(x) \ -+ (((x) >> BIT_SHIFT_APPEND_MHDR_LEN) & BIT_MASK_APPEND_MHDR_LEN) -+#define BIT_SET_APPEND_MHDR_LEN(x, v) \ -+ (BIT_CLEAR_APPEND_MHDR_LEN(x) | BIT_APPEND_MHDR_LEN(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_EN_RTS_ADDR BIT(31) -+#define BIT_WMAC_DISABLE_CCK BIT(30) -+#define BIT_WMAC_RAW_LEN BIT(29) -+#define BIT_WMAC_NOTX_IN_RXNDP BIT(28) -+#define BIT_WMAC_EN_EOF BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_TCRPWRMGT_HWCTL_V1 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_BF_SEL BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_BF_SEL BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_ANTMODE_SEL BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_RXLEN_SEL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_TCRPWRMGT_HWCTL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_TCRPWRMGT_HWCTL_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_SMOOTH_VAL BIT(23) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_EN_SCRAM_INC BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_UNDERFLOWEN_CMPLEN_SEL BIT(21) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_SHIFT_TSFT_CMP 20 -+#define BIT_MASK_TSFT_CMP 0xf -+#define BIT_TSFT_CMP(x) (((x) & BIT_MASK_TSFT_CMP) << BIT_SHIFT_TSFT_CMP) -+#define BITS_TSFT_CMP (BIT_MASK_TSFT_CMP << BIT_SHIFT_TSFT_CMP) -+#define BIT_CLEAR_TSFT_CMP(x) ((x) & (~BITS_TSFT_CMP)) -+#define BIT_GET_TSFT_CMP(x) (((x) >> BIT_SHIFT_TSFT_CMP) & BIT_MASK_TSFT_CMP) -+#define BIT_SET_TSFT_CMP(x, v) (BIT_CLEAR_TSFT_CMP(x) | BIT_TSFT_CMP(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_FETCH_MPDU_AFTER_WSEC_RDY BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_TCR_EN_20MST BIT(19) -+#define BIT_WMAC_DIS_SIGTA BIT(18) -+#define BIT_WMAC_DIS_A2B0 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_SHIFT_TSFT_CMP_CCK 16 -+#define BIT_MASK_TSFT_CMP_CCK 0xf -+#define BIT_TSFT_CMP_CCK(x) \ -+ (((x) & BIT_MASK_TSFT_CMP_CCK) << BIT_SHIFT_TSFT_CMP_CCK) -+#define BITS_TSFT_CMP_CCK (BIT_MASK_TSFT_CMP_CCK << BIT_SHIFT_TSFT_CMP_CCK) -+#define BIT_CLEAR_TSFT_CMP_CCK(x) ((x) & (~BITS_TSFT_CMP_CCK)) -+#define BIT_GET_TSFT_CMP_CCK(x) \ -+ (((x) >> BIT_SHIFT_TSFT_CMP_CCK) & BIT_MASK_TSFT_CMP_CCK) -+#define BIT_SET_TSFT_CMP_CCK(x, v) \ -+ (BIT_CLEAR_TSFT_CMP_CCK(x) | BIT_TSFT_CMP_CCK(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_MSK_SIGBCRC BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_TCR_ERRSTEN_3 BIT(15) -+#define BIT_WMAC_TCR_ERRSTEN_2 BIT(14) -+#define BIT_WMAC_TCR_ERRSTEN_1 BIT(13) -+#define BIT_WMAC_TCR_ERRSTEN_0 BIT(12) -+#define BIT_WMAC_TCR_TXSK_PERPKT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT__TXSK_PERPKT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_ICV BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_CFEND_FORMAT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_CRC BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_PWRBIT_OW_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_PWRMGT_CTL BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_TCRPWRMGT_HWDATA_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_PWR_ST BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_PWRMGT_VAL BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_TCR_UPD_TIMIE BIT(5) -+#define BIT_WMAC_TCR_UPD_HGQMD BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_VHTSIGA1_TXPS BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_PAD_SEL BIT(2) -+#define BIT_DIS_GCLK BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_TSFRST BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_WMAC_TCRPWRMGT_HWACT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_TCR (Offset 0x0604) */ -+ -+#define BIT_R_WMAC_TCR_LSIG BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_APP_FCS BIT(31) -+#define BIT_APP_MIC BIT(30) -+#define BIT_APP_ICV BIT(29) -+#define BIT_APP_PHYSTS BIT(28) -+#define BIT_APP_BASSN BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_VHT_DACK BIT(26) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_TCPOFLD_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_ENMBID BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_ENADDRCAM BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_LSIGEN BIT(23) -+#define BIT_MFBEN BIT(22) -+#define BIT_DISCHKPPDLLEN BIT(21) -+#define BIT_PKTCTL_DLEN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_DISGCLK BIT(19) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_TIM_PARSER_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_TIMPSR_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_BC_MD_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_BCMDINT_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_UC_MD_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_UCMDINT_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_RXSK_PERPKT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_HTC_LOC_CTRL BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_HTCBFMC BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_AMF BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_CHK_PREVTCA2 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_ACK_WITH_CBSSID_DATA_OPTION BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_ACF BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_ACK_WITH_CBSSID_DATA_OPTION_V1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_RPFM_CAM_ENABLE BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_ADF BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_TA_BCN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_DISDECMYPKT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_DISDECNMYPKT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_AICV BIT(9) -+#define BIT_ACRC32 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_CBSSID_BCN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_CBSSID_MGNT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RCR (Offset 0x0608) */ -+ -+#define BIT_CBSSID_DATA BIT(6) -+#define BIT_APWRMGT BIT(5) -+#define BIT_ADD3 BIT(4) -+#define BIT_AB BIT(3) -+#define BIT_AM BIT(2) -+#define BIT_APM BIT(1) -+#define BIT_AAP BIT(0) -+ -+#define BIT_SHIFT_RXPKTLMT 0 -+#define BIT_MASK_RXPKTLMT 0x3f -+#define BIT_RXPKTLMT(x) (((x) & BIT_MASK_RXPKTLMT) << BIT_SHIFT_RXPKTLMT) -+#define BITS_RXPKTLMT (BIT_MASK_RXPKTLMT << BIT_SHIFT_RXPKTLMT) -+#define BIT_CLEAR_RXPKTLMT(x) ((x) & (~BITS_RXPKTLMT)) -+#define BIT_GET_RXPKTLMT(x) (((x) >> BIT_SHIFT_RXPKTLMT) & BIT_MASK_RXPKTLMT) -+#define BIT_SET_RXPKTLMT(x, v) (BIT_CLEAR_RXPKTLMT(x) | BIT_RXPKTLMT(v)) -+ -+/* 2 REG_RX_DLK_TIME (Offset 0x060D) */ -+ -+#define BIT_SHIFT_RX_DLK_TIME 0 -+#define BIT_MASK_RX_DLK_TIME 0xff -+#define BIT_RX_DLK_TIME(x) \ -+ (((x) & BIT_MASK_RX_DLK_TIME) << BIT_SHIFT_RX_DLK_TIME) -+#define BITS_RX_DLK_TIME (BIT_MASK_RX_DLK_TIME << BIT_SHIFT_RX_DLK_TIME) -+#define BIT_CLEAR_RX_DLK_TIME(x) ((x) & (~BITS_RX_DLK_TIME)) -+#define BIT_GET_RX_DLK_TIME(x) \ -+ (((x) >> BIT_SHIFT_RX_DLK_TIME) & BIT_MASK_RX_DLK_TIME) -+#define BIT_SET_RX_DLK_TIME(x, v) \ -+ (BIT_CLEAR_RX_DLK_TIME(x) | BIT_RX_DLK_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SDIO_RXINT_LEN_TH (Offset 0x1025060E) */ -+ -+#define BIT_SHIFT_SDIO_RXINT_LEN_TH 0 -+#define BIT_MASK_SDIO_RXINT_LEN_TH 0xff -+#define BIT_SDIO_RXINT_LEN_TH(x) \ -+ (((x) & BIT_MASK_SDIO_RXINT_LEN_TH) << BIT_SHIFT_SDIO_RXINT_LEN_TH) -+#define BITS_SDIO_RXINT_LEN_TH \ -+ (BIT_MASK_SDIO_RXINT_LEN_TH << BIT_SHIFT_SDIO_RXINT_LEN_TH) -+#define BIT_CLEAR_SDIO_RXINT_LEN_TH(x) ((x) & (~BITS_SDIO_RXINT_LEN_TH)) -+#define BIT_GET_SDIO_RXINT_LEN_TH(x) \ -+ (((x) >> BIT_SHIFT_SDIO_RXINT_LEN_TH) & BIT_MASK_SDIO_RXINT_LEN_TH) -+#define BIT_SET_SDIO_RXINT_LEN_TH(x, v) \ -+ (BIT_CLEAR_SDIO_RXINT_LEN_TH(x) | BIT_SDIO_RXINT_LEN_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RX_DRVINFO_SZ (Offset 0x060F) */ -+ -+#define BIT_APP_PHYSTS_PER_SUBMPDU BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_DRVINFO_SZ (Offset 0x060F) */ -+ -+#define BIT_PHYSTS_PER_PKT_MODE BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RX_DRVINFO_SZ (Offset 0x060F) */ -+ -+#define BIT_APP_MH_SHIFT_VAL BIT(6) -+#define BIT_WMAC_ENSHIFT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_DRVINFO_SZ (Offset 0x060F) */ -+ -+#define BIT_SHIFT_BITMAP_SSNBK_COUNTER 2 -+#define BIT_MASK_BITMAP_SSNBK_COUNTER 0x3f -+#define BIT_BITMAP_SSNBK_COUNTER(x) \ -+ (((x) & BIT_MASK_BITMAP_SSNBK_COUNTER) \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER) -+#define BITS_BITMAP_SSNBK_COUNTER \ -+ (BIT_MASK_BITMAP_SSNBK_COUNTER << BIT_SHIFT_BITMAP_SSNBK_COUNTER) -+#define BIT_CLEAR_BITMAP_SSNBK_COUNTER(x) ((x) & (~BITS_BITMAP_SSNBK_COUNTER)) -+#define BIT_GET_BITMAP_SSNBK_COUNTER(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_SSNBK_COUNTER) & \ -+ BIT_MASK_BITMAP_SSNBK_COUNTER) -+#define BIT_SET_BITMAP_SSNBK_COUNTER(x, v) \ -+ (BIT_CLEAR_BITMAP_SSNBK_COUNTER(x) | BIT_BITMAP_SSNBK_COUNTER(v)) -+ -+#define BIT_BITMAP_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RX_DRVINFO_SZ (Offset 0x060F) */ -+ -+#define BIT_SHIFT_DRVINFO_SZ 0 -+#define BIT_MASK_DRVINFO_SZ 0xff -+#define BIT_DRVINFO_SZ(x) (((x) & BIT_MASK_DRVINFO_SZ) << BIT_SHIFT_DRVINFO_SZ) -+#define BITS_DRVINFO_SZ (BIT_MASK_DRVINFO_SZ << BIT_SHIFT_DRVINFO_SZ) -+#define BIT_CLEAR_DRVINFO_SZ(x) ((x) & (~BITS_DRVINFO_SZ)) -+#define BIT_GET_DRVINFO_SZ(x) \ -+ (((x) >> BIT_SHIFT_DRVINFO_SZ) & BIT_MASK_DRVINFO_SZ) -+#define BIT_SET_DRVINFO_SZ(x, v) (BIT_CLEAR_DRVINFO_SZ(x) | BIT_DRVINFO_SZ(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_DRVINFO_SZ (Offset 0x060F) */ -+ -+#define BIT_SHIFT_DRVINFO_SZ_V1 0 -+#define BIT_MASK_DRVINFO_SZ_V1 0xf -+#define BIT_DRVINFO_SZ_V1(x) \ -+ (((x) & BIT_MASK_DRVINFO_SZ_V1) << BIT_SHIFT_DRVINFO_SZ_V1) -+#define BITS_DRVINFO_SZ_V1 (BIT_MASK_DRVINFO_SZ_V1 << BIT_SHIFT_DRVINFO_SZ_V1) -+#define BIT_CLEAR_DRVINFO_SZ_V1(x) ((x) & (~BITS_DRVINFO_SZ_V1)) -+#define BIT_GET_DRVINFO_SZ_V1(x) \ -+ (((x) >> BIT_SHIFT_DRVINFO_SZ_V1) & BIT_MASK_DRVINFO_SZ_V1) -+#define BIT_SET_DRVINFO_SZ_V1(x, v) \ -+ (BIT_CLEAR_DRVINFO_SZ_V1(x) | BIT_DRVINFO_SZ_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MACID (Offset 0x0610) */ -+ -+#define BIT_SHIFT_MACID 0 -+#define BIT_MASK_MACID 0xffffffffffffL -+#define BIT_MACID(x) (((x) & BIT_MASK_MACID) << BIT_SHIFT_MACID) -+#define BITS_MACID (BIT_MASK_MACID << BIT_SHIFT_MACID) -+#define BIT_CLEAR_MACID(x) ((x) & (~BITS_MACID)) -+#define BIT_GET_MACID(x) (((x) >> BIT_SHIFT_MACID) & BIT_MASK_MACID) -+#define BIT_SET_MACID(x, v) (BIT_CLEAR_MACID(x) | BIT_MACID(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID (Offset 0x0610) */ -+ -+#define BIT_SHIFT_MACID_V1 0 -+#define BIT_MASK_MACID_V1 0xffffffffL -+#define BIT_MACID_V1(x) (((x) & BIT_MASK_MACID_V1) << BIT_SHIFT_MACID_V1) -+#define BITS_MACID_V1 (BIT_MASK_MACID_V1 << BIT_SHIFT_MACID_V1) -+#define BIT_CLEAR_MACID_V1(x) ((x) & (~BITS_MACID_V1)) -+#define BIT_GET_MACID_V1(x) (((x) >> BIT_SHIFT_MACID_V1) & BIT_MASK_MACID_V1) -+#define BIT_SET_MACID_V1(x, v) (BIT_CLEAR_MACID_V1(x) | BIT_MACID_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_MACID_H (Offset 0x0614) */ -+ -+#define BIT_SHIFT_MACID_H 0 -+#define BIT_MASK_MACID_H 0xffff -+#define BIT_MACID_H(x) (((x) & BIT_MASK_MACID_H) << BIT_SHIFT_MACID_H) -+#define BITS_MACID_H (BIT_MASK_MACID_H << BIT_SHIFT_MACID_H) -+#define BIT_CLEAR_MACID_H(x) ((x) & (~BITS_MACID_H)) -+#define BIT_GET_MACID_H(x) (((x) >> BIT_SHIFT_MACID_H) & BIT_MASK_MACID_H) -+#define BIT_SET_MACID_H(x, v) (BIT_CLEAR_MACID_H(x) | BIT_MACID_H(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID_H (Offset 0x0614) */ -+ -+#define BIT_SHIFT_MACID_H_V1 0 -+#define BIT_MASK_MACID_H_V1 0xffff -+#define BIT_MACID_H_V1(x) (((x) & BIT_MASK_MACID_H_V1) << BIT_SHIFT_MACID_H_V1) -+#define BITS_MACID_H_V1 (BIT_MASK_MACID_H_V1 << BIT_SHIFT_MACID_H_V1) -+#define BIT_CLEAR_MACID_H_V1(x) ((x) & (~BITS_MACID_H_V1)) -+#define BIT_GET_MACID_H_V1(x) \ -+ (((x) >> BIT_SHIFT_MACID_H_V1) & BIT_MASK_MACID_H_V1) -+#define BIT_SET_MACID_H_V1(x, v) (BIT_CLEAR_MACID_H_V1(x) | BIT_MACID_H_V1(v)) -+ -+#define BIT_SHIFT_BSSID_H_V1 0 -+#define BIT_MASK_BSSID_H_V1 0xffff -+#define BIT_BSSID_H_V1(x) (((x) & BIT_MASK_BSSID_H_V1) << BIT_SHIFT_BSSID_H_V1) -+#define BITS_BSSID_H_V1 (BIT_MASK_BSSID_H_V1 << BIT_SHIFT_BSSID_H_V1) -+#define BIT_CLEAR_BSSID_H_V1(x) ((x) & (~BITS_BSSID_H_V1)) -+#define BIT_GET_BSSID_H_V1(x) \ -+ (((x) >> BIT_SHIFT_BSSID_H_V1) & BIT_MASK_BSSID_H_V1) -+#define BIT_SET_BSSID_H_V1(x, v) (BIT_CLEAR_BSSID_H_V1(x) | BIT_BSSID_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BSSID (Offset 0x0618) */ -+ -+#define BIT_SHIFT_BSSID 0 -+#define BIT_MASK_BSSID 0xffffffffffffL -+#define BIT_BSSID(x) (((x) & BIT_MASK_BSSID) << BIT_SHIFT_BSSID) -+#define BITS_BSSID (BIT_MASK_BSSID << BIT_SHIFT_BSSID) -+#define BIT_CLEAR_BSSID(x) ((x) & (~BITS_BSSID)) -+#define BIT_GET_BSSID(x) (((x) >> BIT_SHIFT_BSSID) & BIT_MASK_BSSID) -+#define BIT_SET_BSSID(x, v) (BIT_CLEAR_BSSID(x) | BIT_BSSID(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BSSID (Offset 0x0618) */ -+ -+#define BIT_SHIFT_BSSID_V1 0 -+#define BIT_MASK_BSSID_V1 0xffffffffL -+#define BIT_BSSID_V1(x) (((x) & BIT_MASK_BSSID_V1) << BIT_SHIFT_BSSID_V1) -+#define BITS_BSSID_V1 (BIT_MASK_BSSID_V1 << BIT_SHIFT_BSSID_V1) -+#define BIT_CLEAR_BSSID_V1(x) ((x) & (~BITS_BSSID_V1)) -+#define BIT_GET_BSSID_V1(x) (((x) >> BIT_SHIFT_BSSID_V1) & BIT_MASK_BSSID_V1) -+#define BIT_SET_BSSID_V1(x, v) (BIT_CLEAR_BSSID_V1(x) | BIT_BSSID_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_BSSID_H (Offset 0x061C) */ -+ -+#define BIT_SHIFT_BSSID_H 0 -+#define BIT_MASK_BSSID_H 0xffff -+#define BIT_BSSID_H(x) (((x) & BIT_MASK_BSSID_H) << BIT_SHIFT_BSSID_H) -+#define BITS_BSSID_H (BIT_MASK_BSSID_H << BIT_SHIFT_BSSID_H) -+#define BIT_CLEAR_BSSID_H(x) ((x) & (~BITS_BSSID_H)) -+#define BIT_GET_BSSID_H(x) (((x) >> BIT_SHIFT_BSSID_H) & BIT_MASK_BSSID_H) -+#define BIT_SET_BSSID_H(x, v) (BIT_CLEAR_BSSID_H(x) | BIT_BSSID_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MAR (Offset 0x0620) */ -+ -+#define BIT_SHIFT_MAR 0 -+#define BIT_MASK_MAR 0xffffffffffffffffL -+#define BIT_MAR(x) (((x) & BIT_MASK_MAR) << BIT_SHIFT_MAR) -+#define BITS_MAR (BIT_MASK_MAR << BIT_SHIFT_MAR) -+#define BIT_CLEAR_MAR(x) ((x) & (~BITS_MAR)) -+#define BIT_GET_MAR(x) (((x) >> BIT_SHIFT_MAR) & BIT_MASK_MAR) -+#define BIT_SET_MAR(x, v) (BIT_CLEAR_MAR(x) | BIT_MAR(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAR (Offset 0x0620) */ -+ -+#define BIT_SHIFT_MAR_V1 0 -+#define BIT_MASK_MAR_V1 0xffffffffL -+#define BIT_MAR_V1(x) (((x) & BIT_MASK_MAR_V1) << BIT_SHIFT_MAR_V1) -+#define BITS_MAR_V1 (BIT_MASK_MAR_V1 << BIT_SHIFT_MAR_V1) -+#define BIT_CLEAR_MAR_V1(x) ((x) & (~BITS_MAR_V1)) -+#define BIT_GET_MAR_V1(x) (((x) >> BIT_SHIFT_MAR_V1) & BIT_MASK_MAR_V1) -+#define BIT_SET_MAR_V1(x, v) (BIT_CLEAR_MAR_V1(x) | BIT_MAR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_MAR_H (Offset 0x0624) */ -+ -+#define BIT_SHIFT_MAR_H 0 -+#define BIT_MASK_MAR_H 0xffffffffL -+#define BIT_MAR_H(x) (((x) & BIT_MASK_MAR_H) << BIT_SHIFT_MAR_H) -+#define BITS_MAR_H (BIT_MASK_MAR_H << BIT_SHIFT_MAR_H) -+#define BIT_CLEAR_MAR_H(x) ((x) & (~BITS_MAR_H)) -+#define BIT_GET_MAR_H(x) (((x) >> BIT_SHIFT_MAR_H) & BIT_MASK_MAR_H) -+#define BIT_SET_MAR_H(x, v) (BIT_CLEAR_MAR_H(x) | BIT_MAR_H(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MAR_H (Offset 0x0624) */ -+ -+#define BIT_SHIFT_MAR_H_V1 0 -+#define BIT_MASK_MAR_H_V1 0xffffffffL -+#define BIT_MAR_H_V1(x) (((x) & BIT_MASK_MAR_H_V1) << BIT_SHIFT_MAR_H_V1) -+#define BITS_MAR_H_V1 (BIT_MASK_MAR_H_V1 << BIT_SHIFT_MAR_H_V1) -+#define BIT_CLEAR_MAR_H_V1(x) ((x) & (~BITS_MAR_H_V1)) -+#define BIT_GET_MAR_H_V1(x) (((x) >> BIT_SHIFT_MAR_H_V1) & BIT_MASK_MAR_H_V1) -+#define BIT_SET_MAR_H_V1(x, v) (BIT_CLEAR_MAR_H_V1(x) | BIT_MAR_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MBIDCAMCFG_1 (Offset 0x0628) */ -+ -+#define BIT_MBIDCAM_POLL BIT(31) -+#define BIT_MBIDCAM_WT_EN BIT(30) -+#define BIT_LSIC_TXOP_EN BIT(17) -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_L 0 -+#define BIT_MASK_MBIDCAM_RWDATA_L 0xffffffffL -+#define BIT_MBIDCAM_RWDATA_L(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_L) << BIT_SHIFT_MBIDCAM_RWDATA_L) -+#define BITS_MBIDCAM_RWDATA_L \ -+ (BIT_MASK_MBIDCAM_RWDATA_L << BIT_SHIFT_MBIDCAM_RWDATA_L) -+#define BIT_CLEAR_MBIDCAM_RWDATA_L(x) ((x) & (~BITS_MBIDCAM_RWDATA_L)) -+#define BIT_GET_MBIDCAM_RWDATA_L(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_L) & BIT_MASK_MBIDCAM_RWDATA_L) -+#define BIT_SET_MBIDCAM_RWDATA_L(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_L(x) | BIT_MBIDCAM_RWDATA_L(v)) -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_H 0 -+#define BIT_MASK_MBIDCAM_RWDATA_H 0xffff -+#define BIT_MBIDCAM_RWDATA_H(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_H) << BIT_SHIFT_MBIDCAM_RWDATA_H) -+#define BITS_MBIDCAM_RWDATA_H \ -+ (BIT_MASK_MBIDCAM_RWDATA_H << BIT_SHIFT_MBIDCAM_RWDATA_H) -+#define BIT_CLEAR_MBIDCAM_RWDATA_H(x) ((x) & (~BITS_MBIDCAM_RWDATA_H)) -+#define BIT_GET_MBIDCAM_RWDATA_H(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_H) & BIT_MASK_MBIDCAM_RWDATA_H) -+#define BIT_SET_MBIDCAM_RWDATA_H(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_H(x) | BIT_MBIDCAM_RWDATA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_MBIDCAM_CFG (Offset 0x062C) */ -+ -+#define BIT_MBIDCAM_RST_V1 BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MBIDCAMCFG_2 (Offset 0x062C) */ -+ -+#define BIT_SHIFT_MBIDCAM_ADDR_V1 24 -+#define BIT_MASK_MBIDCAM_ADDR_V1 0x3f -+#define BIT_MBIDCAM_ADDR_V1(x) \ -+ (((x) & BIT_MASK_MBIDCAM_ADDR_V1) << BIT_SHIFT_MBIDCAM_ADDR_V1) -+#define BITS_MBIDCAM_ADDR_V1 \ -+ (BIT_MASK_MBIDCAM_ADDR_V1 << BIT_SHIFT_MBIDCAM_ADDR_V1) -+#define BIT_CLEAR_MBIDCAM_ADDR_V1(x) ((x) & (~BITS_MBIDCAM_ADDR_V1)) -+#define BIT_GET_MBIDCAM_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_ADDR_V1) & BIT_MASK_MBIDCAM_ADDR_V1) -+#define BIT_SET_MBIDCAM_ADDR_V1(x, v) \ -+ (BIT_CLEAR_MBIDCAM_ADDR_V1(x) | BIT_MBIDCAM_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MBIDCAMCFG_2 (Offset 0x062C) */ -+ -+#define BIT_SHIFT_MBIDCAM_ADDR_V2 23 -+#define BIT_MASK_MBIDCAM_ADDR_V2 0x7f -+#define BIT_MBIDCAM_ADDR_V2(x) \ -+ (((x) & BIT_MASK_MBIDCAM_ADDR_V2) << BIT_SHIFT_MBIDCAM_ADDR_V2) -+#define BITS_MBIDCAM_ADDR_V2 \ -+ (BIT_MASK_MBIDCAM_ADDR_V2 << BIT_SHIFT_MBIDCAM_ADDR_V2) -+#define BIT_CLEAR_MBIDCAM_ADDR_V2(x) ((x) & (~BITS_MBIDCAM_ADDR_V2)) -+#define BIT_GET_MBIDCAM_ADDR_V2(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_ADDR_V2) & BIT_MASK_MBIDCAM_ADDR_V2) -+#define BIT_SET_MBIDCAM_ADDR_V2(x, v) \ -+ (BIT_CLEAR_MBIDCAM_ADDR_V2(x) | BIT_MBIDCAM_ADDR_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_MBIDCAMCFG_2 (Offset 0x062C) */ -+ -+#define BIT_MBIDCAM_RST BIT(19) -+#define BIT_MBIDCAM_VALID_V1 BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_MBIDCAMCFG_2 (Offset 0x062C) */ -+ -+#define BIT_REPEAT_MODE_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WMAC_DEBUG_SEL (Offset 0x062C) */ -+ -+#define BIT_SHIFT_WMAC_ARB_DBG_SEL 3 -+#define BIT_MASK_WMAC_ARB_DBG_SEL 0x3 -+#define BIT_WMAC_ARB_DBG_SEL(x) \ -+ (((x) & BIT_MASK_WMAC_ARB_DBG_SEL) << BIT_SHIFT_WMAC_ARB_DBG_SEL) -+#define BITS_WMAC_ARB_DBG_SEL \ -+ (BIT_MASK_WMAC_ARB_DBG_SEL << BIT_SHIFT_WMAC_ARB_DBG_SEL) -+#define BIT_CLEAR_WMAC_ARB_DBG_SEL(x) ((x) & (~BITS_WMAC_ARB_DBG_SEL)) -+#define BIT_GET_WMAC_ARB_DBG_SEL(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARB_DBG_SEL) & BIT_MASK_WMAC_ARB_DBG_SEL) -+#define BIT_SET_WMAC_ARB_DBG_SEL(x, v) \ -+ (BIT_CLEAR_WMAC_ARB_DBG_SEL(x) | BIT_WMAC_ARB_DBG_SEL(v)) -+ -+#define BIT_WMAC_EXT_DBG_SEL BIT(2) -+ -+#define BIT_SHIFT_WMAC_MU_DBGSEL_V1 0 -+#define BIT_MASK_WMAC_MU_DBGSEL_V1 0x3 -+#define BIT_WMAC_MU_DBGSEL_V1(x) \ -+ (((x) & BIT_MASK_WMAC_MU_DBGSEL_V1) << BIT_SHIFT_WMAC_MU_DBGSEL_V1) -+#define BITS_WMAC_MU_DBGSEL_V1 \ -+ (BIT_MASK_WMAC_MU_DBGSEL_V1 << BIT_SHIFT_WMAC_MU_DBGSEL_V1) -+#define BIT_CLEAR_WMAC_MU_DBGSEL_V1(x) ((x) & (~BITS_WMAC_MU_DBGSEL_V1)) -+#define BIT_GET_WMAC_MU_DBGSEL_V1(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_DBGSEL_V1) & BIT_MASK_WMAC_MU_DBGSEL_V1) -+#define BIT_SET_WMAC_MU_DBGSEL_V1(x, v) \ -+ (BIT_CLEAR_WMAC_MU_DBGSEL_V1(x) | BIT_WMAC_MU_DBGSEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MCU_TEST_1 (Offset 0x0630) */ -+ -+#define BIT_SHIFT_MCU_RSVD 0 -+#define BIT_MASK_MCU_RSVD 0xffffffffL -+#define BIT_MCU_RSVD(x) (((x) & BIT_MASK_MCU_RSVD) << BIT_SHIFT_MCU_RSVD) -+#define BITS_MCU_RSVD (BIT_MASK_MCU_RSVD << BIT_SHIFT_MCU_RSVD) -+#define BIT_CLEAR_MCU_RSVD(x) ((x) & (~BITS_MCU_RSVD)) -+#define BIT_GET_MCU_RSVD(x) (((x) >> BIT_SHIFT_MCU_RSVD) & BIT_MASK_MCU_RSVD) -+#define BIT_SET_MCU_RSVD(x, v) (BIT_CLEAR_MCU_RSVD(x) | BIT_MCU_RSVD(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_TCR_TSFT_OFS (Offset 0x0630) */ -+ -+#define BIT_SHIFT_WMAC_TCR_TSFT_OFS 0 -+#define BIT_MASK_WMAC_TCR_TSFT_OFS 0xffff -+#define BIT_WMAC_TCR_TSFT_OFS(x) \ -+ (((x) & BIT_MASK_WMAC_TCR_TSFT_OFS) << BIT_SHIFT_WMAC_TCR_TSFT_OFS) -+#define BITS_WMAC_TCR_TSFT_OFS \ -+ (BIT_MASK_WMAC_TCR_TSFT_OFS << BIT_SHIFT_WMAC_TCR_TSFT_OFS) -+#define BIT_CLEAR_WMAC_TCR_TSFT_OFS(x) ((x) & (~BITS_WMAC_TCR_TSFT_OFS)) -+#define BIT_GET_WMAC_TCR_TSFT_OFS(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TCR_TSFT_OFS) & BIT_MASK_WMAC_TCR_TSFT_OFS) -+#define BIT_SET_WMAC_TCR_TSFT_OFS(x, v) \ -+ (BIT_CLEAR_WMAC_TCR_TSFT_OFS(x) | BIT_WMAC_TCR_TSFT_OFS(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_UDF_THSD (Offset 0x0632) */ -+ -+#define BIT_CSIRPT_LEN_BB_MORE_THAN_MAC BIT(23) -+#define BIT_CSI_CHKSUM_ERROR BIT(22) -+#define BIT_MACRX_ERR_4 BIT(20) -+#define BIT_MACRX_ERR_3 BIT(19) -+#define BIT_MACRX_ERR_2 BIT(18) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTD 12 -+#define BIT_MASK_WMAC_RESP_ANTD 0xf -+#define BIT_WMAC_RESP_ANTD(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTD) << BIT_SHIFT_WMAC_RESP_ANTD) -+#define BITS_WMAC_RESP_ANTD \ -+ (BIT_MASK_WMAC_RESP_ANTD << BIT_SHIFT_WMAC_RESP_ANTD) -+#define BIT_CLEAR_WMAC_RESP_ANTD(x) ((x) & (~BITS_WMAC_RESP_ANTD)) -+#define BIT_GET_WMAC_RESP_ANTD(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTD) & BIT_MASK_WMAC_RESP_ANTD) -+#define BIT_SET_WMAC_RESP_ANTD(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTD(x) | BIT_WMAC_RESP_ANTD(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTC 8 -+#define BIT_MASK_WMAC_RESP_ANTC 0xf -+#define BIT_WMAC_RESP_ANTC(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTC) << BIT_SHIFT_WMAC_RESP_ANTC) -+#define BITS_WMAC_RESP_ANTC \ -+ (BIT_MASK_WMAC_RESP_ANTC << BIT_SHIFT_WMAC_RESP_ANTC) -+#define BIT_CLEAR_WMAC_RESP_ANTC(x) ((x) & (~BITS_WMAC_RESP_ANTC)) -+#define BIT_GET_WMAC_RESP_ANTC(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTC) & BIT_MASK_WMAC_RESP_ANTC) -+#define BIT_SET_WMAC_RESP_ANTC(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTC(x) | BIT_WMAC_RESP_ANTC(v)) -+ -+#define BIT_UDF_THSD_V1 BIT(7) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTB 4 -+#define BIT_MASK_WMAC_RESP_ANTB 0xf -+#define BIT_WMAC_RESP_ANTB(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTB) << BIT_SHIFT_WMAC_RESP_ANTB) -+#define BITS_WMAC_RESP_ANTB \ -+ (BIT_MASK_WMAC_RESP_ANTB << BIT_SHIFT_WMAC_RESP_ANTB) -+#define BIT_CLEAR_WMAC_RESP_ANTB(x) ((x) & (~BITS_WMAC_RESP_ANTB)) -+#define BIT_GET_WMAC_RESP_ANTB(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTB) & BIT_MASK_WMAC_RESP_ANTB) -+#define BIT_SET_WMAC_RESP_ANTB(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTB(x) | BIT_WMAC_RESP_ANTB(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_UDF_THSD (Offset 0x0632) */ -+ -+#define BIT_SHIFT_UDF_THSD 0 -+#define BIT_MASK_UDF_THSD 0xff -+#define BIT_UDF_THSD(x) (((x) & BIT_MASK_UDF_THSD) << BIT_SHIFT_UDF_THSD) -+#define BITS_UDF_THSD (BIT_MASK_UDF_THSD << BIT_SHIFT_UDF_THSD) -+#define BIT_CLEAR_UDF_THSD(x) ((x) & (~BITS_UDF_THSD)) -+#define BIT_GET_UDF_THSD(x) (((x) >> BIT_SHIFT_UDF_THSD) & BIT_MASK_UDF_THSD) -+#define BIT_SET_UDF_THSD(x, v) (BIT_CLEAR_UDF_THSD(x) | BIT_UDF_THSD(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_UDF_THSD (Offset 0x0632) */ -+ -+#define BIT_SHIFT_UDF_THSD_VALUE 0 -+#define BIT_MASK_UDF_THSD_VALUE 0x7f -+#define BIT_UDF_THSD_VALUE(x) \ -+ (((x) & BIT_MASK_UDF_THSD_VALUE) << BIT_SHIFT_UDF_THSD_VALUE) -+#define BITS_UDF_THSD_VALUE \ -+ (BIT_MASK_UDF_THSD_VALUE << BIT_SHIFT_UDF_THSD_VALUE) -+#define BIT_CLEAR_UDF_THSD_VALUE(x) ((x) & (~BITS_UDF_THSD_VALUE)) -+#define BIT_GET_UDF_THSD_VALUE(x) \ -+ (((x) >> BIT_SHIFT_UDF_THSD_VALUE) & BIT_MASK_UDF_THSD_VALUE) -+#define BIT_SET_UDF_THSD_VALUE(x, v) \ -+ (BIT_CLEAR_UDF_THSD_VALUE(x) | BIT_UDF_THSD_VALUE(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTA 0 -+#define BIT_MASK_WMAC_RESP_ANTA 0xf -+#define BIT_WMAC_RESP_ANTA(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTA) << BIT_SHIFT_WMAC_RESP_ANTA) -+#define BITS_WMAC_RESP_ANTA \ -+ (BIT_MASK_WMAC_RESP_ANTA << BIT_SHIFT_WMAC_RESP_ANTA) -+#define BIT_CLEAR_WMAC_RESP_ANTA(x) ((x) & (~BITS_WMAC_RESP_ANTA)) -+#define BIT_GET_WMAC_RESP_ANTA(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTA) & BIT_MASK_WMAC_RESP_ANTA) -+#define BIT_SET_WMAC_RESP_ANTA(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTA(x) | BIT_WMAC_RESP_ANTA(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ZLD_NUM (Offset 0x0633) */ -+ -+#define BIT_SHIFT_ZLD_NUM 0 -+#define BIT_MASK_ZLD_NUM 0xff -+#define BIT_ZLD_NUM(x) (((x) & BIT_MASK_ZLD_NUM) << BIT_SHIFT_ZLD_NUM) -+#define BITS_ZLD_NUM (BIT_MASK_ZLD_NUM << BIT_SHIFT_ZLD_NUM) -+#define BIT_CLEAR_ZLD_NUM(x) ((x) & (~BITS_ZLD_NUM)) -+#define BIT_GET_ZLD_NUM(x) (((x) >> BIT_SHIFT_ZLD_NUM) & BIT_MASK_ZLD_NUM) -+#define BIT_SET_ZLD_NUM(x, v) (BIT_CLEAR_ZLD_NUM(x) | BIT_ZLD_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MCU_TEST_2 (Offset 0x0634) */ -+ -+#define BIT_SHIFT_MCU_RSVD_2 0 -+#define BIT_MASK_MCU_RSVD_2 0xffffffffL -+#define BIT_MCU_RSVD_2(x) (((x) & BIT_MASK_MCU_RSVD_2) << BIT_SHIFT_MCU_RSVD_2) -+#define BITS_MCU_RSVD_2 (BIT_MASK_MCU_RSVD_2 << BIT_SHIFT_MCU_RSVD_2) -+#define BIT_CLEAR_MCU_RSVD_2(x) ((x) & (~BITS_MCU_RSVD_2)) -+#define BIT_GET_MCU_RSVD_2(x) \ -+ (((x) >> BIT_SHIFT_MCU_RSVD_2) & BIT_MASK_MCU_RSVD_2) -+#define BIT_SET_MCU_RSVD_2(x, v) (BIT_CLEAR_MCU_RSVD_2(x) | BIT_MCU_RSVD_2(v)) -+ -+#define BIT_SHIFT_WKFCAM_NUM 0 -+#define BIT_MASK_WKFCAM_NUM 0x7f -+#define BIT_WKFCAM_NUM(x) (((x) & BIT_MASK_WKFCAM_NUM) << BIT_SHIFT_WKFCAM_NUM) -+#define BITS_WKFCAM_NUM (BIT_MASK_WKFCAM_NUM << BIT_SHIFT_WKFCAM_NUM) -+#define BIT_CLEAR_WKFCAM_NUM(x) ((x) & (~BITS_WKFCAM_NUM)) -+#define BIT_GET_WKFCAM_NUM(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_NUM) & BIT_MASK_WKFCAM_NUM) -+#define BIT_SET_WKFCAM_NUM(x, v) (BIT_CLEAR_WKFCAM_NUM(x) | BIT_WKFCAM_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_STMP_THSD (Offset 0x0634) */ -+ -+#define BIT_SHIFT_STMP_THSD 0 -+#define BIT_MASK_STMP_THSD 0xff -+#define BIT_STMP_THSD(x) (((x) & BIT_MASK_STMP_THSD) << BIT_SHIFT_STMP_THSD) -+#define BITS_STMP_THSD (BIT_MASK_STMP_THSD << BIT_SHIFT_STMP_THSD) -+#define BIT_CLEAR_STMP_THSD(x) ((x) & (~BITS_STMP_THSD)) -+#define BIT_GET_STMP_THSD(x) (((x) >> BIT_SHIFT_STMP_THSD) & BIT_MASK_STMP_THSD) -+#define BIT_SET_STMP_THSD(x, v) (BIT_CLEAR_STMP_THSD(x) | BIT_STMP_THSD(v)) -+ -+/* 2 REG_WMAC_TXTIMEOUT (Offset 0x0635) */ -+ -+#define BIT_SHIFT_WMAC_TXTIMEOUT 0 -+#define BIT_MASK_WMAC_TXTIMEOUT 0xff -+#define BIT_WMAC_TXTIMEOUT(x) \ -+ (((x) & BIT_MASK_WMAC_TXTIMEOUT) << BIT_SHIFT_WMAC_TXTIMEOUT) -+#define BITS_WMAC_TXTIMEOUT \ -+ (BIT_MASK_WMAC_TXTIMEOUT << BIT_SHIFT_WMAC_TXTIMEOUT) -+#define BIT_CLEAR_WMAC_TXTIMEOUT(x) ((x) & (~BITS_WMAC_TXTIMEOUT)) -+#define BIT_GET_WMAC_TXTIMEOUT(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXTIMEOUT) & BIT_MASK_WMAC_TXTIMEOUT) -+#define BIT_SET_WMAC_TXTIMEOUT(x, v) \ -+ (BIT_CLEAR_WMAC_TXTIMEOUT(x) | BIT_WMAC_TXTIMEOUT(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MCU_TEST_2_V1 (Offset 0x0636) */ -+ -+#define BIT_SHIFT_MCU_RSVD_2_V1 0 -+#define BIT_MASK_MCU_RSVD_2_V1 0xffff -+#define BIT_MCU_RSVD_2_V1(x) \ -+ (((x) & BIT_MASK_MCU_RSVD_2_V1) << BIT_SHIFT_MCU_RSVD_2_V1) -+#define BITS_MCU_RSVD_2_V1 (BIT_MASK_MCU_RSVD_2_V1 << BIT_SHIFT_MCU_RSVD_2_V1) -+#define BIT_CLEAR_MCU_RSVD_2_V1(x) ((x) & (~BITS_MCU_RSVD_2_V1)) -+#define BIT_GET_MCU_RSVD_2_V1(x) \ -+ (((x) >> BIT_SHIFT_MCU_RSVD_2_V1) & BIT_MASK_MCU_RSVD_2_V1) -+#define BIT_SET_MCU_RSVD_2_V1(x, v) \ -+ (BIT_CLEAR_MCU_RSVD_2_V1(x) | BIT_MCU_RSVD_2_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_USTIME_EDCA (Offset 0x0638) */ -+ -+#define BIT_SHIFT_USTIME_EDCA 0 -+#define BIT_MASK_USTIME_EDCA 0xff -+#define BIT_USTIME_EDCA(x) \ -+ (((x) & BIT_MASK_USTIME_EDCA) << BIT_SHIFT_USTIME_EDCA) -+#define BITS_USTIME_EDCA (BIT_MASK_USTIME_EDCA << BIT_SHIFT_USTIME_EDCA) -+#define BIT_CLEAR_USTIME_EDCA(x) ((x) & (~BITS_USTIME_EDCA)) -+#define BIT_GET_USTIME_EDCA(x) \ -+ (((x) >> BIT_SHIFT_USTIME_EDCA) & BIT_MASK_USTIME_EDCA) -+#define BIT_SET_USTIME_EDCA(x, v) \ -+ (BIT_CLEAR_USTIME_EDCA(x) | BIT_USTIME_EDCA(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_USTIME_EDCA (Offset 0x0638) */ -+ -+#define BIT_SHIFT_USTIME 0 -+#define BIT_MASK_USTIME 0xff -+#define BIT_USTIME(x) (((x) & BIT_MASK_USTIME) << BIT_SHIFT_USTIME) -+#define BITS_USTIME (BIT_MASK_USTIME << BIT_SHIFT_USTIME) -+#define BIT_CLEAR_USTIME(x) ((x) & (~BITS_USTIME)) -+#define BIT_GET_USTIME(x) (((x) >> BIT_SHIFT_USTIME) & BIT_MASK_USTIME) -+#define BIT_SET_USTIME(x, v) (BIT_CLEAR_USTIME(x) | BIT_USTIME(v)) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_USTIME_EDCA (Offset 0x0638) */ -+ -+#define BIT_SHIFT_USTIME_EDCA_V1 0 -+#define BIT_MASK_USTIME_EDCA_V1 0x1ff -+#define BIT_USTIME_EDCA_V1(x) \ -+ (((x) & BIT_MASK_USTIME_EDCA_V1) << BIT_SHIFT_USTIME_EDCA_V1) -+#define BITS_USTIME_EDCA_V1 \ -+ (BIT_MASK_USTIME_EDCA_V1 << BIT_SHIFT_USTIME_EDCA_V1) -+#define BIT_CLEAR_USTIME_EDCA_V1(x) ((x) & (~BITS_USTIME_EDCA_V1)) -+#define BIT_GET_USTIME_EDCA_V1(x) \ -+ (((x) >> BIT_SHIFT_USTIME_EDCA_V1) & BIT_MASK_USTIME_EDCA_V1) -+#define BIT_SET_USTIME_EDCA_V1(x, v) \ -+ (BIT_CLEAR_USTIME_EDCA_V1(x) | BIT_USTIME_EDCA_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ACKTO_CCK (Offset 0x0639) */ -+ -+#define BIT_SHIFT_ACKTO_CCK 0 -+#define BIT_MASK_ACKTO_CCK 0xff -+#define BIT_ACKTO_CCK(x) (((x) & BIT_MASK_ACKTO_CCK) << BIT_SHIFT_ACKTO_CCK) -+#define BITS_ACKTO_CCK (BIT_MASK_ACKTO_CCK << BIT_SHIFT_ACKTO_CCK) -+#define BIT_CLEAR_ACKTO_CCK(x) ((x) & (~BITS_ACKTO_CCK)) -+#define BIT_GET_ACKTO_CCK(x) (((x) >> BIT_SHIFT_ACKTO_CCK) & BIT_MASK_ACKTO_CCK) -+#define BIT_SET_ACKTO_CCK(x, v) (BIT_CLEAR_ACKTO_CCK(x) | BIT_ACKTO_CCK(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MAC_SPEC_SIFS (Offset 0x063A) */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM 8 -+#define BIT_MASK_SPEC_SIFS_OFDM 0xff -+#define BIT_SPEC_SIFS_OFDM(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM) << BIT_SHIFT_SPEC_SIFS_OFDM) -+#define BITS_SPEC_SIFS_OFDM \ -+ (BIT_MASK_SPEC_SIFS_OFDM << BIT_SHIFT_SPEC_SIFS_OFDM) -+#define BIT_CLEAR_SPEC_SIFS_OFDM(x) ((x) & (~BITS_SPEC_SIFS_OFDM)) -+#define BIT_GET_SPEC_SIFS_OFDM(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM) & BIT_MASK_SPEC_SIFS_OFDM) -+#define BIT_SET_SPEC_SIFS_OFDM(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM(x) | BIT_SPEC_SIFS_OFDM(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK 0 -+#define BIT_MASK_SPEC_SIFS_CCK 0xff -+#define BIT_SPEC_SIFS_CCK(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK) << BIT_SHIFT_SPEC_SIFS_CCK) -+#define BITS_SPEC_SIFS_CCK (BIT_MASK_SPEC_SIFS_CCK << BIT_SHIFT_SPEC_SIFS_CCK) -+#define BIT_CLEAR_SPEC_SIFS_CCK(x) ((x) & (~BITS_SPEC_SIFS_CCK)) -+#define BIT_GET_SPEC_SIFS_CCK(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK) & BIT_MASK_SPEC_SIFS_CCK) -+#define BIT_SET_SPEC_SIFS_CCK(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK(x) | BIT_SPEC_SIFS_CCK(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RESP_SIFS_CCK (Offset 0x063C) */ -+ -+#define BIT_SHIFT_SIFS_R2T_CCK 8 -+#define BIT_MASK_SIFS_R2T_CCK 0xff -+#define BIT_SIFS_R2T_CCK(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_CCK) << BIT_SHIFT_SIFS_R2T_CCK) -+#define BITS_SIFS_R2T_CCK (BIT_MASK_SIFS_R2T_CCK << BIT_SHIFT_SIFS_R2T_CCK) -+#define BIT_CLEAR_SIFS_R2T_CCK(x) ((x) & (~BITS_SIFS_R2T_CCK)) -+#define BIT_GET_SIFS_R2T_CCK(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_CCK) & BIT_MASK_SIFS_R2T_CCK) -+#define BIT_SET_SIFS_R2T_CCK(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_CCK(x) | BIT_SIFS_R2T_CCK(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RESP_SIFS_CCK (Offset 0x063C) */ -+ -+#define BIT_SHIFT_R2T_SIFS_CCK 8 -+#define BIT_MASK_R2T_SIFS_CCK 0xff -+#define BIT_R2T_SIFS_CCK(x) \ -+ (((x) & BIT_MASK_R2T_SIFS_CCK) << BIT_SHIFT_R2T_SIFS_CCK) -+#define BITS_R2T_SIFS_CCK (BIT_MASK_R2T_SIFS_CCK << BIT_SHIFT_R2T_SIFS_CCK) -+#define BIT_CLEAR_R2T_SIFS_CCK(x) ((x) & (~BITS_R2T_SIFS_CCK)) -+#define BIT_GET_R2T_SIFS_CCK(x) \ -+ (((x) >> BIT_SHIFT_R2T_SIFS_CCK) & BIT_MASK_R2T_SIFS_CCK) -+#define BIT_SET_R2T_SIFS_CCK(x, v) \ -+ (BIT_CLEAR_R2T_SIFS_CCK(x) | BIT_R2T_SIFS_CCK(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RESP_SIFS_CCK (Offset 0x063C) */ -+ -+#define BIT_SHIFT_SIFS_T2T_CCK 0 -+#define BIT_MASK_SIFS_T2T_CCK 0xff -+#define BIT_SIFS_T2T_CCK(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_CCK) << BIT_SHIFT_SIFS_T2T_CCK) -+#define BITS_SIFS_T2T_CCK (BIT_MASK_SIFS_T2T_CCK << BIT_SHIFT_SIFS_T2T_CCK) -+#define BIT_CLEAR_SIFS_T2T_CCK(x) ((x) & (~BITS_SIFS_T2T_CCK)) -+#define BIT_GET_SIFS_T2T_CCK(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_CCK) & BIT_MASK_SIFS_T2T_CCK) -+#define BIT_SET_SIFS_T2T_CCK(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_CCK(x) | BIT_SIFS_T2T_CCK(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RESP_SIFS_CCK (Offset 0x063C) */ -+ -+#define BIT_SHIFT_T2T_SIFS_CCK 0 -+#define BIT_MASK_T2T_SIFS_CCK 0xff -+#define BIT_T2T_SIFS_CCK(x) \ -+ (((x) & BIT_MASK_T2T_SIFS_CCK) << BIT_SHIFT_T2T_SIFS_CCK) -+#define BITS_T2T_SIFS_CCK (BIT_MASK_T2T_SIFS_CCK << BIT_SHIFT_T2T_SIFS_CCK) -+#define BIT_CLEAR_T2T_SIFS_CCK(x) ((x) & (~BITS_T2T_SIFS_CCK)) -+#define BIT_GET_T2T_SIFS_CCK(x) \ -+ (((x) >> BIT_SHIFT_T2T_SIFS_CCK) & BIT_MASK_T2T_SIFS_CCK) -+#define BIT_SET_T2T_SIFS_CCK(x, v) \ -+ (BIT_CLEAR_T2T_SIFS_CCK(x) | BIT_T2T_SIFS_CCK(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RESP_SIFS_OFDM (Offset 0x063E) */ -+ -+#define BIT_SHIFT_SIFS_R2T_OFDM 8 -+#define BIT_MASK_SIFS_R2T_OFDM 0xff -+#define BIT_SIFS_R2T_OFDM(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_OFDM) << BIT_SHIFT_SIFS_R2T_OFDM) -+#define BITS_SIFS_R2T_OFDM (BIT_MASK_SIFS_R2T_OFDM << BIT_SHIFT_SIFS_R2T_OFDM) -+#define BIT_CLEAR_SIFS_R2T_OFDM(x) ((x) & (~BITS_SIFS_R2T_OFDM)) -+#define BIT_GET_SIFS_R2T_OFDM(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_OFDM) & BIT_MASK_SIFS_R2T_OFDM) -+#define BIT_SET_SIFS_R2T_OFDM(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_OFDM(x) | BIT_SIFS_R2T_OFDM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RESP_SIFS_OFDM (Offset 0x063E) */ -+ -+#define BIT_SHIFT_R2T_SIFS_OFDM 8 -+#define BIT_MASK_R2T_SIFS_OFDM 0xff -+#define BIT_R2T_SIFS_OFDM(x) \ -+ (((x) & BIT_MASK_R2T_SIFS_OFDM) << BIT_SHIFT_R2T_SIFS_OFDM) -+#define BITS_R2T_SIFS_OFDM (BIT_MASK_R2T_SIFS_OFDM << BIT_SHIFT_R2T_SIFS_OFDM) -+#define BIT_CLEAR_R2T_SIFS_OFDM(x) ((x) & (~BITS_R2T_SIFS_OFDM)) -+#define BIT_GET_R2T_SIFS_OFDM(x) \ -+ (((x) >> BIT_SHIFT_R2T_SIFS_OFDM) & BIT_MASK_R2T_SIFS_OFDM) -+#define BIT_SET_R2T_SIFS_OFDM(x, v) \ -+ (BIT_CLEAR_R2T_SIFS_OFDM(x) | BIT_R2T_SIFS_OFDM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RESP_SIFS_OFDM (Offset 0x063E) */ -+ -+#define BIT_SHIFT_SIFS_T2T_OFDM 0 -+#define BIT_MASK_SIFS_T2T_OFDM 0xff -+#define BIT_SIFS_T2T_OFDM(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_OFDM) << BIT_SHIFT_SIFS_T2T_OFDM) -+#define BITS_SIFS_T2T_OFDM (BIT_MASK_SIFS_T2T_OFDM << BIT_SHIFT_SIFS_T2T_OFDM) -+#define BIT_CLEAR_SIFS_T2T_OFDM(x) ((x) & (~BITS_SIFS_T2T_OFDM)) -+#define BIT_GET_SIFS_T2T_OFDM(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_OFDM) & BIT_MASK_SIFS_T2T_OFDM) -+#define BIT_SET_SIFS_T2T_OFDM(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_OFDM(x) | BIT_SIFS_T2T_OFDM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RESP_SIFS_OFDM (Offset 0x063E) */ -+ -+#define BIT_SHIFT_T2T_SIFS_OFDM 0 -+#define BIT_MASK_T2T_SIFS_OFDM 0xff -+#define BIT_T2T_SIFS_OFDM(x) \ -+ (((x) & BIT_MASK_T2T_SIFS_OFDM) << BIT_SHIFT_T2T_SIFS_OFDM) -+#define BITS_T2T_SIFS_OFDM (BIT_MASK_T2T_SIFS_OFDM << BIT_SHIFT_T2T_SIFS_OFDM) -+#define BIT_CLEAR_T2T_SIFS_OFDM(x) ((x) & (~BITS_T2T_SIFS_OFDM)) -+#define BIT_GET_T2T_SIFS_OFDM(x) \ -+ (((x) >> BIT_SHIFT_T2T_SIFS_OFDM) & BIT_MASK_T2T_SIFS_OFDM) -+#define BIT_SET_T2T_SIFS_OFDM(x, v) \ -+ (BIT_CLEAR_T2T_SIFS_OFDM(x) | BIT_T2T_SIFS_OFDM(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ACKTO (Offset 0x0640) */ -+ -+#define BIT_SHIFT_ACKTO 0 -+#define BIT_MASK_ACKTO 0xff -+#define BIT_ACKTO(x) (((x) & BIT_MASK_ACKTO) << BIT_SHIFT_ACKTO) -+#define BITS_ACKTO (BIT_MASK_ACKTO << BIT_SHIFT_ACKTO) -+#define BIT_CLEAR_ACKTO(x) ((x) & (~BITS_ACKTO)) -+#define BIT_GET_ACKTO(x) (((x) >> BIT_SHIFT_ACKTO) & BIT_MASK_ACKTO) -+#define BIT_SET_ACKTO(x, v) (BIT_CLEAR_ACKTO(x) | BIT_ACKTO(v)) -+ -+/* 2 REG_CTS2TO (Offset 0x0641) */ -+ -+#define BIT_SHIFT_CTS2TO 0 -+#define BIT_MASK_CTS2TO 0xff -+#define BIT_CTS2TO(x) (((x) & BIT_MASK_CTS2TO) << BIT_SHIFT_CTS2TO) -+#define BITS_CTS2TO (BIT_MASK_CTS2TO << BIT_SHIFT_CTS2TO) -+#define BIT_CLEAR_CTS2TO(x) ((x) & (~BITS_CTS2TO)) -+#define BIT_GET_CTS2TO(x) (((x) >> BIT_SHIFT_CTS2TO) & BIT_MASK_CTS2TO) -+#define BIT_SET_CTS2TO(x, v) (BIT_CLEAR_CTS2TO(x) | BIT_CTS2TO(v)) -+ -+/* 2 REG_EIFS (Offset 0x0642) */ -+ -+#define BIT_SHIFT_EIFS 0 -+#define BIT_MASK_EIFS 0xffff -+#define BIT_EIFS(x) (((x) & BIT_MASK_EIFS) << BIT_SHIFT_EIFS) -+#define BITS_EIFS (BIT_MASK_EIFS << BIT_SHIFT_EIFS) -+#define BIT_CLEAR_EIFS(x) ((x) & (~BITS_EIFS)) -+#define BIT_GET_EIFS(x) (((x) >> BIT_SHIFT_EIFS) & BIT_MASK_EIFS) -+#define BIT_SET_EIFS(x, v) (BIT_CLEAR_EIFS(x) | BIT_EIFS(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RPFM_MAP0 (Offset 0x0644) */ -+ -+#define BIT_MGT_RPFM15EN BIT(15) -+#define BIT_MGT_RPFM14EN BIT(14) -+#define BIT_MGT_RPFM13EN BIT(13) -+#define BIT_MGT_RPFM12EN BIT(12) -+#define BIT_MGT_RPFM11EN BIT(11) -+#define BIT_MGT_RPFM10EN BIT(10) -+#define BIT_MGT_RPFM9EN BIT(9) -+#define BIT_MGT_RPFM8EN BIT(8) -+#define BIT_MGT_RPFM7EN BIT(7) -+#define BIT_MGT_RPFM6EN BIT(6) -+#define BIT_MGT_RPFM5EN BIT(5) -+#define BIT_MGT_RPFM4EN BIT(4) -+#define BIT_MGT_RPFM3EN BIT(3) -+#define BIT_MGT_RPFM2EN BIT(2) -+#define BIT_MGT_RPFM1EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RPFM_MAP0 (Offset 0x0644) */ -+ -+#define BIT_SHIFT_RPFM_MAP0 0 -+#define BIT_MASK_RPFM_MAP0 0xffff -+#define BIT_RPFM_MAP0(x) (((x) & BIT_MASK_RPFM_MAP0) << BIT_SHIFT_RPFM_MAP0) -+#define BITS_RPFM_MAP0 (BIT_MASK_RPFM_MAP0 << BIT_SHIFT_RPFM_MAP0) -+#define BIT_CLEAR_RPFM_MAP0(x) ((x) & (~BITS_RPFM_MAP0)) -+#define BIT_GET_RPFM_MAP0(x) (((x) >> BIT_SHIFT_RPFM_MAP0) & BIT_MASK_RPFM_MAP0) -+#define BIT_SET_RPFM_MAP0(x, v) (BIT_CLEAR_RPFM_MAP0(x) | BIT_RPFM_MAP0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RPFM_MAP0 (Offset 0x0644) */ -+ -+#define BIT_MGT_RPFM0EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RPFM_MAP1_V1 (Offset 0x0646) */ -+ -+#define BIT_DATA_RPFM15EN BIT(15) -+#define BIT_DATA_RPFM14EN BIT(14) -+#define BIT_DATA_RPFM13EN BIT(13) -+#define BIT_DATA_RPFM12EN BIT(12) -+#define BIT_DATA_RPFM11EN BIT(11) -+#define BIT_DATA_RPFM10EN BIT(10) -+#define BIT_DATA_RPFM9EN BIT(9) -+#define BIT_DATA_RPFM8EN BIT(8) -+#define BIT_DATA_RPFM7EN BIT(7) -+#define BIT_DATA_RPFM6EN BIT(6) -+#define BIT_DATA_RPFM5EN BIT(5) -+#define BIT_DATA_RPFM4EN BIT(4) -+#define BIT_DATA_RPFM3EN BIT(3) -+#define BIT_DATA_RPFM2EN BIT(2) -+#define BIT_DATA_RPFM1EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RPFM_MAP1 (Offset 0x0646) */ -+ -+#define BIT_SHIFT_RPFM_MAP1 0 -+#define BIT_MASK_RPFM_MAP1 0xffff -+#define BIT_RPFM_MAP1(x) (((x) & BIT_MASK_RPFM_MAP1) << BIT_SHIFT_RPFM_MAP1) -+#define BITS_RPFM_MAP1 (BIT_MASK_RPFM_MAP1 << BIT_SHIFT_RPFM_MAP1) -+#define BIT_CLEAR_RPFM_MAP1(x) ((x) & (~BITS_RPFM_MAP1)) -+#define BIT_GET_RPFM_MAP1(x) (((x) >> BIT_SHIFT_RPFM_MAP1) & BIT_MASK_RPFM_MAP1) -+#define BIT_SET_RPFM_MAP1(x, v) (BIT_CLEAR_RPFM_MAP1(x) | BIT_RPFM_MAP1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RPFM_MAP1_V1 (Offset 0x0646) */ -+ -+#define BIT_DATA_RPFM0EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RPFM_CAM_CMD (Offset 0x0648) */ -+ -+#define BIT_RPFM_CAM_POLLING BIT(31) -+#define BIT_RPFM_CAM_CLR BIT(30) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RPFM_CAM_CMD (Offset 0x0648) */ -+ -+#define BIT_RPFM_CAM_WR BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RPFM_CAM_CMD (Offset 0x0648) */ -+ -+#define BIT_RPFM_CAM_WE BIT(16) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RPFM_CAM_CMD (Offset 0x0648) */ -+ -+#define BIT_SHIFT_RPFM_CAM_ADDR 0 -+#define BIT_MASK_RPFM_CAM_ADDR 0x7f -+#define BIT_RPFM_CAM_ADDR(x) \ -+ (((x) & BIT_MASK_RPFM_CAM_ADDR) << BIT_SHIFT_RPFM_CAM_ADDR) -+#define BITS_RPFM_CAM_ADDR (BIT_MASK_RPFM_CAM_ADDR << BIT_SHIFT_RPFM_CAM_ADDR) -+#define BIT_CLEAR_RPFM_CAM_ADDR(x) ((x) & (~BITS_RPFM_CAM_ADDR)) -+#define BIT_GET_RPFM_CAM_ADDR(x) \ -+ (((x) >> BIT_SHIFT_RPFM_CAM_ADDR) & BIT_MASK_RPFM_CAM_ADDR) -+#define BIT_SET_RPFM_CAM_ADDR(x, v) \ -+ (BIT_CLEAR_RPFM_CAM_ADDR(x) | BIT_RPFM_CAM_ADDR(v)) -+ -+/* 2 REG_RPFM_CAM_RWD (Offset 0x064C) */ -+ -+#define BIT_SHIFT_RPFM_CAM_RWD 0 -+#define BIT_MASK_RPFM_CAM_RWD 0xffffffffL -+#define BIT_RPFM_CAM_RWD(x) \ -+ (((x) & BIT_MASK_RPFM_CAM_RWD) << BIT_SHIFT_RPFM_CAM_RWD) -+#define BITS_RPFM_CAM_RWD (BIT_MASK_RPFM_CAM_RWD << BIT_SHIFT_RPFM_CAM_RWD) -+#define BIT_CLEAR_RPFM_CAM_RWD(x) ((x) & (~BITS_RPFM_CAM_RWD)) -+#define BIT_GET_RPFM_CAM_RWD(x) \ -+ (((x) >> BIT_SHIFT_RPFM_CAM_RWD) & BIT_MASK_RPFM_CAM_RWD) -+#define BIT_SET_RPFM_CAM_RWD(x, v) \ -+ (BIT_CLEAR_RPFM_CAM_RWD(x) | BIT_RPFM_CAM_RWD(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_NAV_CTRL (Offset 0x0650) */ -+ -+#define BIT_SHIFT_NAV_UPPER 16 -+#define BIT_MASK_NAV_UPPER 0xff -+#define BIT_NAV_UPPER(x) (((x) & BIT_MASK_NAV_UPPER) << BIT_SHIFT_NAV_UPPER) -+#define BITS_NAV_UPPER (BIT_MASK_NAV_UPPER << BIT_SHIFT_NAV_UPPER) -+#define BIT_CLEAR_NAV_UPPER(x) ((x) & (~BITS_NAV_UPPER)) -+#define BIT_GET_NAV_UPPER(x) (((x) >> BIT_SHIFT_NAV_UPPER) & BIT_MASK_NAV_UPPER) -+#define BIT_SET_NAV_UPPER(x, v) (BIT_CLEAR_NAV_UPPER(x) | BIT_NAV_UPPER(v)) -+ -+#define BIT_SHIFT_RXMYRTS_NAV 8 -+#define BIT_MASK_RXMYRTS_NAV 0xf -+#define BIT_RXMYRTS_NAV(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV) << BIT_SHIFT_RXMYRTS_NAV) -+#define BITS_RXMYRTS_NAV (BIT_MASK_RXMYRTS_NAV << BIT_SHIFT_RXMYRTS_NAV) -+#define BIT_CLEAR_RXMYRTS_NAV(x) ((x) & (~BITS_RXMYRTS_NAV)) -+#define BIT_GET_RXMYRTS_NAV(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV) & BIT_MASK_RXMYRTS_NAV) -+#define BIT_SET_RXMYRTS_NAV(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV(x) | BIT_RXMYRTS_NAV(v)) -+ -+#define BIT_SHIFT_RTSRST 0 -+#define BIT_MASK_RTSRST 0xff -+#define BIT_RTSRST(x) (((x) & BIT_MASK_RTSRST) << BIT_SHIFT_RTSRST) -+#define BITS_RTSRST (BIT_MASK_RTSRST << BIT_SHIFT_RTSRST) -+#define BIT_CLEAR_RTSRST(x) ((x) & (~BITS_RTSRST)) -+#define BIT_GET_RTSRST(x) (((x) >> BIT_SHIFT_RTSRST) & BIT_MASK_RTSRST) -+#define BIT_SET_RTSRST(x, v) (BIT_CLEAR_RTSRST(x) | BIT_RTSRST(v)) -+ -+/* 2 REG_BACAMCMD (Offset 0x0654) */ -+ -+#define BIT_BACAM_POLL BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BACAMCMD (Offset 0x0654) */ -+ -+#define BIT_BACAM_RST BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BACAMCMD (Offset 0x0654) */ -+ -+#define BIT_BACAM_RW BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BACAMCMD (Offset 0x0654) */ -+ -+#define BIT_SHIFT_TXSBM 14 -+#define BIT_MASK_TXSBM 0x3 -+#define BIT_TXSBM(x) (((x) & BIT_MASK_TXSBM) << BIT_SHIFT_TXSBM) -+#define BITS_TXSBM (BIT_MASK_TXSBM << BIT_SHIFT_TXSBM) -+#define BIT_CLEAR_TXSBM(x) ((x) & (~BITS_TXSBM)) -+#define BIT_GET_TXSBM(x) (((x) >> BIT_SHIFT_TXSBM) & BIT_MASK_TXSBM) -+#define BIT_SET_TXSBM(x, v) (BIT_CLEAR_TXSBM(x) | BIT_TXSBM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_BACAMCMD (Offset 0x0654) */ -+ -+#define BIT_SHIFT_TXSBMPMOD 14 -+#define BIT_MASK_TXSBMPMOD 0x3 -+#define BIT_TXSBMPMOD(x) (((x) & BIT_MASK_TXSBMPMOD) << BIT_SHIFT_TXSBMPMOD) -+#define BITS_TXSBMPMOD (BIT_MASK_TXSBMPMOD << BIT_SHIFT_TXSBMPMOD) -+#define BIT_CLEAR_TXSBMPMOD(x) ((x) & (~BITS_TXSBMPMOD)) -+#define BIT_GET_TXSBMPMOD(x) (((x) >> BIT_SHIFT_TXSBMPMOD) & BIT_MASK_TXSBMPMOD) -+#define BIT_SET_TXSBMPMOD(x, v) (BIT_CLEAR_TXSBMPMOD(x) | BIT_TXSBMPMOD(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BACAMCMD (Offset 0x0654) */ -+ -+#define BIT_SHIFT_BACAM_ADDR 0 -+#define BIT_MASK_BACAM_ADDR 0x3f -+#define BIT_BACAM_ADDR(x) (((x) & BIT_MASK_BACAM_ADDR) << BIT_SHIFT_BACAM_ADDR) -+#define BITS_BACAM_ADDR (BIT_MASK_BACAM_ADDR << BIT_SHIFT_BACAM_ADDR) -+#define BIT_CLEAR_BACAM_ADDR(x) ((x) & (~BITS_BACAM_ADDR)) -+#define BIT_GET_BACAM_ADDR(x) \ -+ (((x) >> BIT_SHIFT_BACAM_ADDR) & BIT_MASK_BACAM_ADDR) -+#define BIT_SET_BACAM_ADDR(x, v) (BIT_CLEAR_BACAM_ADDR(x) | BIT_BACAM_ADDR(v)) -+ -+#define BIT_SHIFT_BA_CONTENT_L 0 -+#define BIT_MASK_BA_CONTENT_L 0xffffffffL -+#define BIT_BA_CONTENT_L(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_L) << BIT_SHIFT_BA_CONTENT_L) -+#define BITS_BA_CONTENT_L (BIT_MASK_BA_CONTENT_L << BIT_SHIFT_BA_CONTENT_L) -+#define BIT_CLEAR_BA_CONTENT_L(x) ((x) & (~BITS_BA_CONTENT_L)) -+#define BIT_GET_BA_CONTENT_L(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_L) & BIT_MASK_BA_CONTENT_L) -+#define BIT_SET_BA_CONTENT_L(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_L(x) | BIT_BA_CONTENT_L(v)) -+ -+#define BIT_SHIFT_LBDLY 0 -+#define BIT_MASK_LBDLY 0x1f -+#define BIT_LBDLY(x) (((x) & BIT_MASK_LBDLY) << BIT_SHIFT_LBDLY) -+#define BITS_LBDLY (BIT_MASK_LBDLY << BIT_SHIFT_LBDLY) -+#define BIT_CLEAR_LBDLY(x) ((x) & (~BITS_LBDLY)) -+#define BIT_GET_LBDLY(x) (((x) >> BIT_SHIFT_LBDLY) & BIT_MASK_LBDLY) -+#define BIT_SET_LBDLY(x, v) (BIT_CLEAR_LBDLY(x) | BIT_LBDLY(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_BITMAP_CMD (Offset 0x0661) */ -+ -+#define BIT_BACAM_RPMEN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_BACAM_RPMEN (Offset 0x0661) */ -+ -+#define BIT_WMAC_BACAM_RPMEN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TX_RX (Offset 0x0662) */ -+ -+#define BIT_SHIFT_RXPKT_TYPE 2 -+#define BIT_MASK_RXPKT_TYPE 0x3f -+#define BIT_RXPKT_TYPE(x) (((x) & BIT_MASK_RXPKT_TYPE) << BIT_SHIFT_RXPKT_TYPE) -+#define BITS_RXPKT_TYPE (BIT_MASK_RXPKT_TYPE << BIT_SHIFT_RXPKT_TYPE) -+#define BIT_CLEAR_RXPKT_TYPE(x) ((x) & (~BITS_RXPKT_TYPE)) -+#define BIT_GET_RXPKT_TYPE(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_TYPE) & BIT_MASK_RXPKT_TYPE) -+#define BIT_SET_RXPKT_TYPE(x, v) (BIT_CLEAR_RXPKT_TYPE(x) | BIT_RXPKT_TYPE(v)) -+ -+#define BIT_TXACT_IND BIT(1) -+#define BIT_RXACT_IND BIT(0) -+ -+/* 2 REG_WMAC_BITMAP_CTL (Offset 0x0663) */ -+ -+#define BIT_BITMAP_VO BIT(7) -+#define BIT_BITMAP_VI BIT(6) -+#define BIT_BITMAP_BE BIT(5) -+#define BIT_BITMAP_BK BIT(4) -+ -+#define BIT_SHIFT_BITMAP_CONDITION 2 -+#define BIT_MASK_BITMAP_CONDITION 0x3 -+#define BIT_BITMAP_CONDITION(x) \ -+ (((x) & BIT_MASK_BITMAP_CONDITION) << BIT_SHIFT_BITMAP_CONDITION) -+#define BITS_BITMAP_CONDITION \ -+ (BIT_MASK_BITMAP_CONDITION << BIT_SHIFT_BITMAP_CONDITION) -+#define BIT_CLEAR_BITMAP_CONDITION(x) ((x) & (~BITS_BITMAP_CONDITION)) -+#define BIT_GET_BITMAP_CONDITION(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_CONDITION) & BIT_MASK_BITMAP_CONDITION) -+#define BIT_SET_BITMAP_CONDITION(x, v) \ -+ (BIT_CLEAR_BITMAP_CONDITION(x) | BIT_BITMAP_CONDITION(v)) -+ -+#define BIT_BITMAP_SSNBK_COUNTER_CLR BIT(1) -+#define BIT_BITMAP_FORCE BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_SHIFT_RXERR_RPT_SEL_V1_3_0 28 -+#define BIT_MASK_RXERR_RPT_SEL_V1_3_0 0xf -+#define BIT_RXERR_RPT_SEL_V1_3_0(x) \ -+ (((x) & BIT_MASK_RXERR_RPT_SEL_V1_3_0) \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0) -+#define BITS_RXERR_RPT_SEL_V1_3_0 \ -+ (BIT_MASK_RXERR_RPT_SEL_V1_3_0 << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0) -+#define BIT_CLEAR_RXERR_RPT_SEL_V1_3_0(x) ((x) & (~BITS_RXERR_RPT_SEL_V1_3_0)) -+#define BIT_GET_RXERR_RPT_SEL_V1_3_0(x) \ -+ (((x) >> BIT_SHIFT_RXERR_RPT_SEL_V1_3_0) & \ -+ BIT_MASK_RXERR_RPT_SEL_V1_3_0) -+#define BIT_SET_RXERR_RPT_SEL_V1_3_0(x, v) \ -+ (BIT_CLEAR_RXERR_RPT_SEL_V1_3_0(x) | BIT_RXERR_RPT_SEL_V1_3_0(v)) -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_SHIFT_RXERR_RPT_SEL 28 -+#define BIT_MASK_RXERR_RPT_SEL 0xf -+#define BIT_RXERR_RPT_SEL(x) \ -+ (((x) & BIT_MASK_RXERR_RPT_SEL) << BIT_SHIFT_RXERR_RPT_SEL) -+#define BITS_RXERR_RPT_SEL (BIT_MASK_RXERR_RPT_SEL << BIT_SHIFT_RXERR_RPT_SEL) -+#define BIT_CLEAR_RXERR_RPT_SEL(x) ((x) & (~BITS_RXERR_RPT_SEL)) -+#define BIT_GET_RXERR_RPT_SEL(x) \ -+ (((x) >> BIT_SHIFT_RXERR_RPT_SEL) & BIT_MASK_RXERR_RPT_SEL) -+#define BIT_SET_RXERR_RPT_SEL(x, v) \ -+ (BIT_CLEAR_RXERR_RPT_SEL(x) | BIT_RXERR_RPT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_RXERR_RPT_RST BIT(27) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_RXERR_RPT_SEL_V1_4 BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_SHIFT_UD_SELECT_BSSID_2_1 24 -+#define BIT_MASK_UD_SELECT_BSSID_2_1 0x3 -+#define BIT_UD_SELECT_BSSID_2_1(x) \ -+ (((x) & BIT_MASK_UD_SELECT_BSSID_2_1) << BIT_SHIFT_UD_SELECT_BSSID_2_1) -+#define BITS_UD_SELECT_BSSID_2_1 \ -+ (BIT_MASK_UD_SELECT_BSSID_2_1 << BIT_SHIFT_UD_SELECT_BSSID_2_1) -+#define BIT_CLEAR_UD_SELECT_BSSID_2_1(x) ((x) & (~BITS_UD_SELECT_BSSID_2_1)) -+#define BIT_GET_UD_SELECT_BSSID_2_1(x) \ -+ (((x) >> BIT_SHIFT_UD_SELECT_BSSID_2_1) & BIT_MASK_UD_SELECT_BSSID_2_1) -+#define BIT_SET_UD_SELECT_BSSID_2_1(x, v) \ -+ (BIT_CLEAR_UD_SELECT_BSSID_2_1(x) | BIT_UD_SELECT_BSSID_2_1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_W1S BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_UD_SELECT_BSSID BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_UD_SELECT_BSSID_0 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_SHIFT_UD_SUB_TYPE 18 -+#define BIT_MASK_UD_SUB_TYPE 0xf -+#define BIT_UD_SUB_TYPE(x) \ -+ (((x) & BIT_MASK_UD_SUB_TYPE) << BIT_SHIFT_UD_SUB_TYPE) -+#define BITS_UD_SUB_TYPE (BIT_MASK_UD_SUB_TYPE << BIT_SHIFT_UD_SUB_TYPE) -+#define BIT_CLEAR_UD_SUB_TYPE(x) ((x) & (~BITS_UD_SUB_TYPE)) -+#define BIT_GET_UD_SUB_TYPE(x) \ -+ (((x) >> BIT_SHIFT_UD_SUB_TYPE) & BIT_MASK_UD_SUB_TYPE) -+#define BIT_SET_UD_SUB_TYPE(x, v) \ -+ (BIT_CLEAR_UD_SUB_TYPE(x) | BIT_UD_SUB_TYPE(v)) -+ -+#define BIT_SHIFT_UD_TYPE 16 -+#define BIT_MASK_UD_TYPE 0x3 -+#define BIT_UD_TYPE(x) (((x) & BIT_MASK_UD_TYPE) << BIT_SHIFT_UD_TYPE) -+#define BITS_UD_TYPE (BIT_MASK_UD_TYPE << BIT_SHIFT_UD_TYPE) -+#define BIT_CLEAR_UD_TYPE(x) ((x) & (~BITS_UD_TYPE)) -+#define BIT_GET_UD_TYPE(x) (((x) >> BIT_SHIFT_UD_TYPE) & BIT_MASK_UD_TYPE) -+#define BIT_SET_UD_TYPE(x, v) (BIT_CLEAR_UD_TYPE(x) | BIT_UD_TYPE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_CTRLFLT5EN BIT(5) -+#define BIT_CTRLFLT4EN BIT(4) -+#define BIT_CTRLFLT3EN BIT(3) -+#define BIT_CTRLFLT2EN BIT(2) -+#define BIT_CTRLFLT1EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_SHIFT_RPT_COUNTER 0 -+#define BIT_MASK_RPT_COUNTER 0xffff -+#define BIT_RPT_COUNTER(x) \ -+ (((x) & BIT_MASK_RPT_COUNTER) << BIT_SHIFT_RPT_COUNTER) -+#define BITS_RPT_COUNTER (BIT_MASK_RPT_COUNTER << BIT_SHIFT_RPT_COUNTER) -+#define BIT_CLEAR_RPT_COUNTER(x) ((x) & (~BITS_RPT_COUNTER)) -+#define BIT_GET_RPT_COUNTER(x) \ -+ (((x) >> BIT_SHIFT_RPT_COUNTER) & BIT_MASK_RPT_COUNTER) -+#define BIT_SET_RPT_COUNTER(x, v) \ -+ (BIT_CLEAR_RPT_COUNTER(x) | BIT_RPT_COUNTER(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXERR_RPT (Offset 0x0664) */ -+ -+#define BIT_CTRLFLT0EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_RXBA_IGNOREA2 BIT(42) -+#define BIT_EN_SAVE_ALL_TXOPADDR BIT(41) -+#define BIT_EN_TXCTS_TO_TXOPOWNER_INRXNAV BIT(40) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_DIS_TXBA_AMPDUFCSERR BIT(39) -+#define BIT_DIS_TXBA_RXBARINFULL BIT(38) -+#define BIT_DIS_TXCFE_INFULL BIT(37) -+#define BIT_DIS_TXCTS_INFULL BIT(36) -+#define BIT_EN_TXACKBA_IN_TX_RDG BIT(35) -+#define BIT_EN_TXACKBA_IN_TXOP BIT(34) -+#define BIT_EN_TXCTS_IN_RXNAV BIT(33) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_EN_TXCTS_INTXOP BIT(32) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_BLK_EDCA_BBSLP BIT(31) -+#define BIT_BLK_EDCA_BBSBY BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_ENABLE_STOP_UPDATE_NAV_V1 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_ACKTO_BLOCK_SCH_EN BIT(27) -+#define BIT_EIFS_BLOCK_SCH_EN BIT(26) -+#define BIT_PLCPCHK_RST_EIFS BIT(25) -+#define BIT_CCA_RST_EIFS BIT(24) -+#define BIT_DIS_UPD_MYRXPKTNAV BIT(23) -+#define BIT_EARLY_TXBA BIT(22) -+ -+#define BIT_SHIFT_RESP_CHNBUSY 20 -+#define BIT_MASK_RESP_CHNBUSY 0x3 -+#define BIT_RESP_CHNBUSY(x) \ -+ (((x) & BIT_MASK_RESP_CHNBUSY) << BIT_SHIFT_RESP_CHNBUSY) -+#define BITS_RESP_CHNBUSY (BIT_MASK_RESP_CHNBUSY << BIT_SHIFT_RESP_CHNBUSY) -+#define BIT_CLEAR_RESP_CHNBUSY(x) ((x) & (~BITS_RESP_CHNBUSY)) -+#define BIT_GET_RESP_CHNBUSY(x) \ -+ (((x) >> BIT_SHIFT_RESP_CHNBUSY) & BIT_MASK_RESP_CHNBUSY) -+#define BIT_SET_RESP_CHNBUSY(x, v) \ -+ (BIT_CLEAR_RESP_CHNBUSY(x) | BIT_RESP_CHNBUSY(v)) -+ -+#define BIT_RESP_DCTS_EN BIT(19) -+#define BIT_RESP_DCFE_EN BIT(18) -+#define BIT_RESP_SPLCPEN BIT(17) -+#define BIT_RESP_SGIEN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_RESP_LDPC_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_MGTFLT15EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_DIS_RESP_ACKINCCA BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_MGTFLT14EN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_DIS_RESP_CTSINCCA BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER 10 -+#define BIT_MASK_R_WMAC_SECOND_CCA_TIMER 0x7 -+#define BIT_R_WMAC_SECOND_CCA_TIMER(x) \ -+ (((x) & BIT_MASK_R_WMAC_SECOND_CCA_TIMER) \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER) -+#define BITS_R_WMAC_SECOND_CCA_TIMER \ -+ (BIT_MASK_R_WMAC_SECOND_CCA_TIMER << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER) -+#define BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER(x) \ -+ ((x) & (~BITS_R_WMAC_SECOND_CCA_TIMER)) -+#define BIT_GET_R_WMAC_SECOND_CCA_TIMER(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER) & \ -+ BIT_MASK_R_WMAC_SECOND_CCA_TIMER) -+#define BIT_SET_R_WMAC_SECOND_CCA_TIMER(x, v) \ -+ (BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER(x) | BIT_R_WMAC_SECOND_CCA_TIMER(v)) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_SHIFT_SECOND_CCA_CNT 10 -+#define BIT_MASK_SECOND_CCA_CNT 0x7 -+#define BIT_SECOND_CCA_CNT(x) \ -+ (((x) & BIT_MASK_SECOND_CCA_CNT) << BIT_SHIFT_SECOND_CCA_CNT) -+#define BITS_SECOND_CCA_CNT \ -+ (BIT_MASK_SECOND_CCA_CNT << BIT_SHIFT_SECOND_CCA_CNT) -+#define BIT_CLEAR_SECOND_CCA_CNT(x) ((x) & (~BITS_SECOND_CCA_CNT)) -+#define BIT_GET_SECOND_CCA_CNT(x) \ -+ (((x) >> BIT_SHIFT_SECOND_CCA_CNT) & BIT_MASK_SECOND_CCA_CNT) -+#define BIT_SET_SECOND_CCA_CNT(x, v) \ -+ (BIT_CLEAR_SECOND_CCA_CNT(x) | BIT_SECOND_CCA_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_SHIFT_RFMOD 7 -+#define BIT_MASK_RFMOD 0x3 -+#define BIT_RFMOD(x) (((x) & BIT_MASK_RFMOD) << BIT_SHIFT_RFMOD) -+#define BITS_RFMOD (BIT_MASK_RFMOD << BIT_SHIFT_RFMOD) -+#define BIT_CLEAR_RFMOD(x) ((x) & (~BITS_RFMOD)) -+#define BIT_GET_RFMOD(x) (((x) >> BIT_SHIFT_RFMOD) & BIT_MASK_RFMOD) -+#define BIT_SET_RFMOD(x, v) (BIT_CLEAR_RFMOD(x) | BIT_RFMOD(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_MGTFLT7EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_SHIFT_RF_MOD 7 -+#define BIT_MASK_RF_MOD 0x3 -+#define BIT_RF_MOD(x) (((x) & BIT_MASK_RF_MOD) << BIT_SHIFT_RF_MOD) -+#define BITS_RF_MOD (BIT_MASK_RF_MOD << BIT_SHIFT_RF_MOD) -+#define BIT_CLEAR_RF_MOD(x) ((x) & (~BITS_RF_MOD)) -+#define BIT_GET_RF_MOD(x) (((x) >> BIT_SHIFT_RF_MOD) & BIT_MASK_RF_MOD) -+#define BIT_SET_RF_MOD(x, v) (BIT_CLEAR_RF_MOD(x) | BIT_RF_MOD(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_MGTFLT6EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_SHIFT_RESP_CTS_DYNBW_SEL 5 -+#define BIT_MASK_RESP_CTS_DYNBW_SEL 0x3 -+#define BIT_RESP_CTS_DYNBW_SEL(x) \ -+ (((x) & BIT_MASK_RESP_CTS_DYNBW_SEL) << BIT_SHIFT_RESP_CTS_DYNBW_SEL) -+#define BITS_RESP_CTS_DYNBW_SEL \ -+ (BIT_MASK_RESP_CTS_DYNBW_SEL << BIT_SHIFT_RESP_CTS_DYNBW_SEL) -+#define BIT_CLEAR_RESP_CTS_DYNBW_SEL(x) ((x) & (~BITS_RESP_CTS_DYNBW_SEL)) -+#define BIT_GET_RESP_CTS_DYNBW_SEL(x) \ -+ (((x) >> BIT_SHIFT_RESP_CTS_DYNBW_SEL) & BIT_MASK_RESP_CTS_DYNBW_SEL) -+#define BIT_SET_RESP_CTS_DYNBW_SEL(x, v) \ -+ (BIT_CLEAR_RESP_CTS_DYNBW_SEL(x) | BIT_RESP_CTS_DYNBW_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_SHIFT_RESP_CTS_BW_DYNBW_SEL 5 -+#define BIT_MASK_RESP_CTS_BW_DYNBW_SEL 0x3 -+#define BIT_RESP_CTS_BW_DYNBW_SEL(x) \ -+ (((x) & BIT_MASK_RESP_CTS_BW_DYNBW_SEL) \ -+ << BIT_SHIFT_RESP_CTS_BW_DYNBW_SEL) -+#define BITS_RESP_CTS_BW_DYNBW_SEL \ -+ (BIT_MASK_RESP_CTS_BW_DYNBW_SEL << BIT_SHIFT_RESP_CTS_BW_DYNBW_SEL) -+#define BIT_CLEAR_RESP_CTS_BW_DYNBW_SEL(x) ((x) & (~BITS_RESP_CTS_BW_DYNBW_SEL)) -+#define BIT_GET_RESP_CTS_BW_DYNBW_SEL(x) \ -+ (((x) >> BIT_SHIFT_RESP_CTS_BW_DYNBW_SEL) & \ -+ BIT_MASK_RESP_CTS_BW_DYNBW_SEL) -+#define BIT_SET_RESP_CTS_BW_DYNBW_SEL(x, v) \ -+ (BIT_CLEAR_RESP_CTS_BW_DYNBW_SEL(x) | BIT_RESP_CTS_BW_DYNBW_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_DLY_TX_WAIT_RXANTSEL BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_DELAY_TX_USE_RX_ANTSEL BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_TXRESP_BY_RXANTSEL BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_TX_USE_RX_ANTSEL BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_RESP_EARLY_TXACK_RWEPTKIP BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL (Offset 0x0668) */ -+ -+#define BIT_SHIFT_ORIG_DCTS_CHK 0 -+#define BIT_MASK_ORIG_DCTS_CHK 0x3 -+#define BIT_ORIG_DCTS_CHK(x) \ -+ (((x) & BIT_MASK_ORIG_DCTS_CHK) << BIT_SHIFT_ORIG_DCTS_CHK) -+#define BITS_ORIG_DCTS_CHK (BIT_MASK_ORIG_DCTS_CHK << BIT_SHIFT_ORIG_DCTS_CHK) -+#define BIT_CLEAR_ORIG_DCTS_CHK(x) ((x) & (~BITS_ORIG_DCTS_CHK)) -+#define BIT_GET_ORIG_DCTS_CHK(x) \ -+ (((x) >> BIT_SHIFT_ORIG_DCTS_CHK) & BIT_MASK_ORIG_DCTS_CHK) -+#define BIT_SET_ORIG_DCTS_CHK(x, v) \ -+ (BIT_CLEAR_ORIG_DCTS_CHK(x) | BIT_ORIG_DCTS_CHK(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_H (Offset 0x066C) */ -+ -+#define BIT_RXBA_IGNOREA2_V1 BIT(10) -+#define BIT_EN_SAVE_ALL_TXOPADDR_V1 BIT(9) -+#define BIT_EN_TXCTS_TO_TXOPOWNER_INRXNAV_V1 BIT(8) -+#define BIT_DIS_TXBA_AMPDUFCSERR_V1 BIT(7) -+#define BIT_DIS_TXBA_RXBARINFULL_V1 BIT(6) -+#define BIT_DIS_TXCFE_INFULL_V1 BIT(5) -+#define BIT_DIS_TXCTS_INFULL_V1 BIT(4) -+#define BIT_EN_TXACKBA_IN_TX_RDG_V1 BIT(3) -+#define BIT_EN_TXACKBA_IN_TXOP_V1 BIT(2) -+#define BIT_EN_TXCTS_IN_RXNAV_V1 BIT(1) -+#define BIT_EN_TXCTS_INTXOP_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CAMCMD (Offset 0x0670) */ -+ -+#define BIT_SECCAM_POLLING BIT(31) -+#define BIT_SECCAM_CLR BIT(30) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CAMCMD (Offset 0x0670) */ -+ -+#define BIT_MFBCAM_CLR BIT(29) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CAMCMD (Offset 0x0670) */ -+ -+#define BIT_SECCAM_WE BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CAMCMD (Offset 0x0670) */ -+ -+#define BIT_SHIFT_SECCAM_ADDR_V1 0 -+#define BIT_MASK_SECCAM_ADDR_V1 0xff -+#define BIT_SECCAM_ADDR_V1(x) \ -+ (((x) & BIT_MASK_SECCAM_ADDR_V1) << BIT_SHIFT_SECCAM_ADDR_V1) -+#define BITS_SECCAM_ADDR_V1 \ -+ (BIT_MASK_SECCAM_ADDR_V1 << BIT_SHIFT_SECCAM_ADDR_V1) -+#define BIT_CLEAR_SECCAM_ADDR_V1(x) ((x) & (~BITS_SECCAM_ADDR_V1)) -+#define BIT_GET_SECCAM_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_SECCAM_ADDR_V1) & BIT_MASK_SECCAM_ADDR_V1) -+#define BIT_SET_SECCAM_ADDR_V1(x, v) \ -+ (BIT_CLEAR_SECCAM_ADDR_V1(x) | BIT_SECCAM_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CAMCMD (Offset 0x0670) */ -+ -+#define BIT_SHIFT_SECCAM_ADDR_V2 0 -+#define BIT_MASK_SECCAM_ADDR_V2 0x3ff -+#define BIT_SECCAM_ADDR_V2(x) \ -+ (((x) & BIT_MASK_SECCAM_ADDR_V2) << BIT_SHIFT_SECCAM_ADDR_V2) -+#define BITS_SECCAM_ADDR_V2 \ -+ (BIT_MASK_SECCAM_ADDR_V2 << BIT_SHIFT_SECCAM_ADDR_V2) -+#define BIT_CLEAR_SECCAM_ADDR_V2(x) ((x) & (~BITS_SECCAM_ADDR_V2)) -+#define BIT_GET_SECCAM_ADDR_V2(x) \ -+ (((x) >> BIT_SHIFT_SECCAM_ADDR_V2) & BIT_MASK_SECCAM_ADDR_V2) -+#define BIT_SET_SECCAM_ADDR_V2(x, v) \ -+ (BIT_CLEAR_SECCAM_ADDR_V2(x) | BIT_SECCAM_ADDR_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_CAMCMD (Offset 0x0670) */ -+ -+#define BIT_SHIFT_SECCAM_ADDR_V3 0 -+#define BIT_MASK_SECCAM_ADDR_V3 0x1ff -+#define BIT_SECCAM_ADDR_V3(x) \ -+ (((x) & BIT_MASK_SECCAM_ADDR_V3) << BIT_SHIFT_SECCAM_ADDR_V3) -+#define BITS_SECCAM_ADDR_V3 \ -+ (BIT_MASK_SECCAM_ADDR_V3 << BIT_SHIFT_SECCAM_ADDR_V3) -+#define BIT_CLEAR_SECCAM_ADDR_V3(x) ((x) & (~BITS_SECCAM_ADDR_V3)) -+#define BIT_GET_SECCAM_ADDR_V3(x) \ -+ (((x) >> BIT_SHIFT_SECCAM_ADDR_V3) & BIT_MASK_SECCAM_ADDR_V3) -+#define BIT_SET_SECCAM_ADDR_V3(x, v) \ -+ (BIT_CLEAR_SECCAM_ADDR_V3(x) | BIT_SECCAM_ADDR_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_CAMCMD (Offset 0x0670) */ -+ -+#define BIT_SHIFT_SECCAM_ADDR 0 -+#define BIT_MASK_SECCAM_ADDR 0xff -+#define BIT_SECCAM_ADDR(x) \ -+ (((x) & BIT_MASK_SECCAM_ADDR) << BIT_SHIFT_SECCAM_ADDR) -+#define BITS_SECCAM_ADDR (BIT_MASK_SECCAM_ADDR << BIT_SHIFT_SECCAM_ADDR) -+#define BIT_CLEAR_SECCAM_ADDR(x) ((x) & (~BITS_SECCAM_ADDR)) -+#define BIT_GET_SECCAM_ADDR(x) \ -+ (((x) >> BIT_SHIFT_SECCAM_ADDR) & BIT_MASK_SECCAM_ADDR) -+#define BIT_SET_SECCAM_ADDR(x, v) \ -+ (BIT_CLEAR_SECCAM_ADDR(x) | BIT_SECCAM_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CAMWRITE (Offset 0x0674) */ -+ -+#define BIT_SHIFT_CAMW_DATA 0 -+#define BIT_MASK_CAMW_DATA 0xffffffffL -+#define BIT_CAMW_DATA(x) (((x) & BIT_MASK_CAMW_DATA) << BIT_SHIFT_CAMW_DATA) -+#define BITS_CAMW_DATA (BIT_MASK_CAMW_DATA << BIT_SHIFT_CAMW_DATA) -+#define BIT_CLEAR_CAMW_DATA(x) ((x) & (~BITS_CAMW_DATA)) -+#define BIT_GET_CAMW_DATA(x) (((x) >> BIT_SHIFT_CAMW_DATA) & BIT_MASK_CAMW_DATA) -+#define BIT_SET_CAMW_DATA(x, v) (BIT_CLEAR_CAMW_DATA(x) | BIT_CAMW_DATA(v)) -+ -+/* 2 REG_CAMREAD (Offset 0x0678) */ -+ -+#define BIT_SHIFT_CAMR_DATA 0 -+#define BIT_MASK_CAMR_DATA 0xffffffffL -+#define BIT_CAMR_DATA(x) (((x) & BIT_MASK_CAMR_DATA) << BIT_SHIFT_CAMR_DATA) -+#define BITS_CAMR_DATA (BIT_MASK_CAMR_DATA << BIT_SHIFT_CAMR_DATA) -+#define BIT_CLEAR_CAMR_DATA(x) ((x) & (~BITS_CAMR_DATA)) -+#define BIT_GET_CAMR_DATA(x) (((x) >> BIT_SHIFT_CAMR_DATA) & BIT_MASK_CAMR_DATA) -+#define BIT_SET_CAMR_DATA(x, v) (BIT_CLEAR_CAMR_DATA(x) | BIT_CAMR_DATA(v)) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_SECCAM_INFO BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_SEC_KEYFOUND_V1 BIT(19) -+ -+#define BIT_SHIFT_CAMDBG_SEC_TYPE_V1 16 -+#define BIT_MASK_CAMDBG_SEC_TYPE_V1 0x7 -+#define BIT_CAMDBG_SEC_TYPE_V1(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_TYPE_V1) << BIT_SHIFT_CAMDBG_SEC_TYPE_V1) -+#define BITS_CAMDBG_SEC_TYPE_V1 \ -+ (BIT_MASK_CAMDBG_SEC_TYPE_V1 << BIT_SHIFT_CAMDBG_SEC_TYPE_V1) -+#define BIT_CLEAR_CAMDBG_SEC_TYPE_V1(x) ((x) & (~BITS_CAMDBG_SEC_TYPE_V1)) -+#define BIT_GET_CAMDBG_SEC_TYPE_V1(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_TYPE_V1) & BIT_MASK_CAMDBG_SEC_TYPE_V1) -+#define BIT_SET_CAMDBG_SEC_TYPE_V1(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_TYPE_V1(x) | BIT_CAMDBG_SEC_TYPE_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_SEC_KEYFOUND BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_EXT_SECTYPE BIT(15) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_CAMDBG_EXT_SEC_TYPE_V1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_SHIFT_CAMDBG_SEC_TYPE 12 -+#define BIT_MASK_CAMDBG_SEC_TYPE 0x7 -+#define BIT_CAMDBG_SEC_TYPE(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_TYPE) << BIT_SHIFT_CAMDBG_SEC_TYPE) -+#define BITS_CAMDBG_SEC_TYPE \ -+ (BIT_MASK_CAMDBG_SEC_TYPE << BIT_SHIFT_CAMDBG_SEC_TYPE) -+#define BIT_CLEAR_CAMDBG_SEC_TYPE(x) ((x) & (~BITS_CAMDBG_SEC_TYPE)) -+#define BIT_GET_CAMDBG_SEC_TYPE(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_TYPE) & BIT_MASK_CAMDBG_SEC_TYPE) -+#define BIT_SET_CAMDBG_SEC_TYPE(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_TYPE(x) | BIT_CAMDBG_SEC_TYPE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_CAMDBG_EXT_SEC_TYPE BIT(11) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_CAMDBG_EXT_SECTYPE BIT(11) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_SHIFT_CAMDBG_MIC_KEY_IDX_V1 7 -+#define BIT_MASK_CAMDBG_MIC_KEY_IDX_V1 0x7f -+#define BIT_CAMDBG_MIC_KEY_IDX_V1(x) \ -+ (((x) & BIT_MASK_CAMDBG_MIC_KEY_IDX_V1) \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_V1) -+#define BITS_CAMDBG_MIC_KEY_IDX_V1 \ -+ (BIT_MASK_CAMDBG_MIC_KEY_IDX_V1 << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_V1) -+#define BIT_CLEAR_CAMDBG_MIC_KEY_IDX_V1(x) ((x) & (~BITS_CAMDBG_MIC_KEY_IDX_V1)) -+#define BIT_GET_CAMDBG_MIC_KEY_IDX_V1(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_MIC_KEY_IDX_V1) & \ -+ BIT_MASK_CAMDBG_MIC_KEY_IDX_V1) -+#define BIT_SET_CAMDBG_MIC_KEY_IDX_V1(x, v) \ -+ (BIT_CLEAR_CAMDBG_MIC_KEY_IDX_V1(x) | BIT_CAMDBG_MIC_KEY_IDX_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_SHIFT_CAMDBG_MIC_KEY_IDX_V3 6 -+#define BIT_MASK_CAMDBG_MIC_KEY_IDX_V3 0x3f -+#define BIT_CAMDBG_MIC_KEY_IDX_V3(x) \ -+ (((x) & BIT_MASK_CAMDBG_MIC_KEY_IDX_V3) \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_V3) -+#define BITS_CAMDBG_MIC_KEY_IDX_V3 \ -+ (BIT_MASK_CAMDBG_MIC_KEY_IDX_V3 << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_V3) -+#define BIT_CLEAR_CAMDBG_MIC_KEY_IDX_V3(x) ((x) & (~BITS_CAMDBG_MIC_KEY_IDX_V3)) -+#define BIT_GET_CAMDBG_MIC_KEY_IDX_V3(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_MIC_KEY_IDX_V3) & \ -+ BIT_MASK_CAMDBG_MIC_KEY_IDX_V3) -+#define BIT_SET_CAMDBG_MIC_KEY_IDX_V3(x, v) \ -+ (BIT_CLEAR_CAMDBG_MIC_KEY_IDX_V3(x) | BIT_CAMDBG_MIC_KEY_IDX_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_SHIFT_CAMDBG_MIC_KEY_IDX 5 -+#define BIT_MASK_CAMDBG_MIC_KEY_IDX 0x1f -+#define BIT_CAMDBG_MIC_KEY_IDX(x) \ -+ (((x) & BIT_MASK_CAMDBG_MIC_KEY_IDX) << BIT_SHIFT_CAMDBG_MIC_KEY_IDX) -+#define BITS_CAMDBG_MIC_KEY_IDX \ -+ (BIT_MASK_CAMDBG_MIC_KEY_IDX << BIT_SHIFT_CAMDBG_MIC_KEY_IDX) -+#define BIT_CLEAR_CAMDBG_MIC_KEY_IDX(x) ((x) & (~BITS_CAMDBG_MIC_KEY_IDX)) -+#define BIT_GET_CAMDBG_MIC_KEY_IDX(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_MIC_KEY_IDX) & BIT_MASK_CAMDBG_MIC_KEY_IDX) -+#define BIT_SET_CAMDBG_MIC_KEY_IDX(x, v) \ -+ (BIT_CLEAR_CAMDBG_MIC_KEY_IDX(x) | BIT_CAMDBG_MIC_KEY_IDX(v)) -+ -+#define BIT_SHIFT_CAMDBG_SEC_KEY_IDX 0 -+#define BIT_MASK_CAMDBG_SEC_KEY_IDX 0x1f -+#define BIT_CAMDBG_SEC_KEY_IDX(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_KEY_IDX) << BIT_SHIFT_CAMDBG_SEC_KEY_IDX) -+#define BITS_CAMDBG_SEC_KEY_IDX \ -+ (BIT_MASK_CAMDBG_SEC_KEY_IDX << BIT_SHIFT_CAMDBG_SEC_KEY_IDX) -+#define BIT_CLEAR_CAMDBG_SEC_KEY_IDX(x) ((x) & (~BITS_CAMDBG_SEC_KEY_IDX)) -+#define BIT_GET_CAMDBG_SEC_KEY_IDX(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_KEY_IDX) & BIT_MASK_CAMDBG_SEC_KEY_IDX) -+#define BIT_SET_CAMDBG_SEC_KEY_IDX(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_KEY_IDX(x) | BIT_CAMDBG_SEC_KEY_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_SHIFT_CAMDBG_SEC_KEY_IDX_V2 0 -+#define BIT_MASK_CAMDBG_SEC_KEY_IDX_V2 0x3f -+#define BIT_CAMDBG_SEC_KEY_IDX_V2(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_KEY_IDX_V2) \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_V2) -+#define BITS_CAMDBG_SEC_KEY_IDX_V2 \ -+ (BIT_MASK_CAMDBG_SEC_KEY_IDX_V2 << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_V2) -+#define BIT_CLEAR_CAMDBG_SEC_KEY_IDX_V2(x) ((x) & (~BITS_CAMDBG_SEC_KEY_IDX_V2)) -+#define BIT_GET_CAMDBG_SEC_KEY_IDX_V2(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_KEY_IDX_V2) & \ -+ BIT_MASK_CAMDBG_SEC_KEY_IDX_V2) -+#define BIT_SET_CAMDBG_SEC_KEY_IDX_V2(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_KEY_IDX_V2(x) | BIT_CAMDBG_SEC_KEY_IDX_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CAMDBG (Offset 0x067C) */ -+ -+#define BIT_SHIFT_CAMDBG_SEC_KEY_IDX_V1 0 -+#define BIT_MASK_CAMDBG_SEC_KEY_IDX_V1 0x7f -+#define BIT_CAMDBG_SEC_KEY_IDX_V1(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_KEY_IDX_V1) \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_V1) -+#define BITS_CAMDBG_SEC_KEY_IDX_V1 \ -+ (BIT_MASK_CAMDBG_SEC_KEY_IDX_V1 << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_V1) -+#define BIT_CLEAR_CAMDBG_SEC_KEY_IDX_V1(x) ((x) & (~BITS_CAMDBG_SEC_KEY_IDX_V1)) -+#define BIT_GET_CAMDBG_SEC_KEY_IDX_V1(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_KEY_IDX_V1) & \ -+ BIT_MASK_CAMDBG_SEC_KEY_IDX_V1) -+#define BIT_SET_CAMDBG_SEC_KEY_IDX_V1(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_KEY_IDX_V1(x) | BIT_CAMDBG_SEC_KEY_IDX_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SECCFG (Offset 0x0680) */ -+ -+#define BIT_RXDEC_BM_MGNT_V1 BIT(19) -+#define BIT_TXENC_BM_MGNT_V1 BIT(18) -+#define BIT_RXDEC_UNI_MGNT_V1 BIT(17) -+#define BIT_TXENC_UNI_MGNT_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SECCFG (Offset 0x0680) */ -+ -+#define BIT_DIS_GCLK_WAPI BIT(15) -+#define BIT_DIS_GCLK_AES BIT(14) -+#define BIT_DIS_GCLK_TKIP BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SECCFG (Offset 0x0680) */ -+ -+#define BIT_AES_SEL_QC_1 BIT(12) -+#define BIT_AES_SEL_QC_0 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_SECCFG (Offset 0x0680) */ -+ -+#define BIT_WMAC_CKECK_BMC BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SECCFG (Offset 0x0680) */ -+ -+#define BIT_CHK_BMC BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_SECCFG (Offset 0x0680) */ -+ -+#define BIT_CHK_KEYID BIT(8) -+#define BIT_RXBCUSEDK BIT(7) -+#define BIT_TXBCUSEDK BIT(6) -+#define BIT_NOSKMC BIT(5) -+#define BIT_SKBYA2 BIT(4) -+#define BIT_RXDEC BIT(3) -+#define BIT_TXENC BIT(2) -+#define BIT_RXUHUSEDK BIT(1) -+#define BIT_TXUHUSEDK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXFILTER_CATEGORY_1 (Offset 0x0682) */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_1 0 -+#define BIT_MASK_RXFILTER_CATEGORY_1 0xff -+#define BIT_RXFILTER_CATEGORY_1(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_1) << BIT_SHIFT_RXFILTER_CATEGORY_1) -+#define BITS_RXFILTER_CATEGORY_1 \ -+ (BIT_MASK_RXFILTER_CATEGORY_1 << BIT_SHIFT_RXFILTER_CATEGORY_1) -+#define BIT_CLEAR_RXFILTER_CATEGORY_1(x) ((x) & (~BITS_RXFILTER_CATEGORY_1)) -+#define BIT_GET_RXFILTER_CATEGORY_1(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_1) & BIT_MASK_RXFILTER_CATEGORY_1) -+#define BIT_SET_RXFILTER_CATEGORY_1(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_1(x) | BIT_RXFILTER_CATEGORY_1(v)) -+ -+/* 2 REG_RXFILTER_ACTION_1 (Offset 0x0683) */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_1 0 -+#define BIT_MASK_RXFILTER_ACTION_1 0xff -+#define BIT_RXFILTER_ACTION_1(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_1) << BIT_SHIFT_RXFILTER_ACTION_1) -+#define BITS_RXFILTER_ACTION_1 \ -+ (BIT_MASK_RXFILTER_ACTION_1 << BIT_SHIFT_RXFILTER_ACTION_1) -+#define BIT_CLEAR_RXFILTER_ACTION_1(x) ((x) & (~BITS_RXFILTER_ACTION_1)) -+#define BIT_GET_RXFILTER_ACTION_1(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_1) & BIT_MASK_RXFILTER_ACTION_1) -+#define BIT_SET_RXFILTER_ACTION_1(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_1(x) | BIT_RXFILTER_ACTION_1(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_2 (Offset 0x0684) */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_2 0 -+#define BIT_MASK_RXFILTER_CATEGORY_2 0xff -+#define BIT_RXFILTER_CATEGORY_2(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_2) << BIT_SHIFT_RXFILTER_CATEGORY_2) -+#define BITS_RXFILTER_CATEGORY_2 \ -+ (BIT_MASK_RXFILTER_CATEGORY_2 << BIT_SHIFT_RXFILTER_CATEGORY_2) -+#define BIT_CLEAR_RXFILTER_CATEGORY_2(x) ((x) & (~BITS_RXFILTER_CATEGORY_2)) -+#define BIT_GET_RXFILTER_CATEGORY_2(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_2) & BIT_MASK_RXFILTER_CATEGORY_2) -+#define BIT_SET_RXFILTER_CATEGORY_2(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_2(x) | BIT_RXFILTER_CATEGORY_2(v)) -+ -+/* 2 REG_RXFILTER_ACTION_2 (Offset 0x0685) */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_2 0 -+#define BIT_MASK_RXFILTER_ACTION_2 0xff -+#define BIT_RXFILTER_ACTION_2(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_2) << BIT_SHIFT_RXFILTER_ACTION_2) -+#define BITS_RXFILTER_ACTION_2 \ -+ (BIT_MASK_RXFILTER_ACTION_2 << BIT_SHIFT_RXFILTER_ACTION_2) -+#define BIT_CLEAR_RXFILTER_ACTION_2(x) ((x) & (~BITS_RXFILTER_ACTION_2)) -+#define BIT_GET_RXFILTER_ACTION_2(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_2) & BIT_MASK_RXFILTER_ACTION_2) -+#define BIT_SET_RXFILTER_ACTION_2(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_2(x) | BIT_RXFILTER_ACTION_2(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_3 (Offset 0x0686) */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_3 0 -+#define BIT_MASK_RXFILTER_CATEGORY_3 0xff -+#define BIT_RXFILTER_CATEGORY_3(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_3) << BIT_SHIFT_RXFILTER_CATEGORY_3) -+#define BITS_RXFILTER_CATEGORY_3 \ -+ (BIT_MASK_RXFILTER_CATEGORY_3 << BIT_SHIFT_RXFILTER_CATEGORY_3) -+#define BIT_CLEAR_RXFILTER_CATEGORY_3(x) ((x) & (~BITS_RXFILTER_CATEGORY_3)) -+#define BIT_GET_RXFILTER_CATEGORY_3(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_3) & BIT_MASK_RXFILTER_CATEGORY_3) -+#define BIT_SET_RXFILTER_CATEGORY_3(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_3(x) | BIT_RXFILTER_CATEGORY_3(v)) -+ -+/* 2 REG_RXFILTER_ACTION_3 (Offset 0x0687) */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_3 0 -+#define BIT_MASK_RXFILTER_ACTION_3 0xff -+#define BIT_RXFILTER_ACTION_3(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_3) << BIT_SHIFT_RXFILTER_ACTION_3) -+#define BITS_RXFILTER_ACTION_3 \ -+ (BIT_MASK_RXFILTER_ACTION_3 << BIT_SHIFT_RXFILTER_ACTION_3) -+#define BIT_CLEAR_RXFILTER_ACTION_3(x) ((x) & (~BITS_RXFILTER_ACTION_3)) -+#define BIT_GET_RXFILTER_ACTION_3(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_3) & BIT_MASK_RXFILTER_ACTION_3) -+#define BIT_SET_RXFILTER_ACTION_3(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_3(x) | BIT_RXFILTER_ACTION_3(v)) -+ -+/* 2 REG_RXFLTMAP3 (Offset 0x0688) */ -+ -+#define BIT_MGTFLT15EN_FW BIT(15) -+#define BIT_MGTFLT14EN_FW BIT(14) -+#define BIT_MGTFLT13EN_FW BIT(13) -+#define BIT_MGTFLT12EN_FW BIT(12) -+#define BIT_MGTFLT11EN_FW BIT(11) -+#define BIT_MGTFLT10EN_FW BIT(10) -+#define BIT_MGTFLT9EN_FW BIT(9) -+#define BIT_MGTFLT8EN_FW BIT(8) -+#define BIT_MGTFLT7EN_FW BIT(7) -+#define BIT_MGTFLT6EN_FW BIT(6) -+#define BIT_MGTFLT5EN_FW BIT(5) -+#define BIT_MGTFLT4EN_FW BIT(4) -+#define BIT_MGTFLT3EN_FW BIT(3) -+#define BIT_MGTFLT2EN_FW BIT(2) -+#define BIT_MGTFLT1EN_FW BIT(1) -+#define BIT_MGTFLT0EN_FW BIT(0) -+ -+/* 2 REG_RXFLTMAP4 (Offset 0x068A) */ -+ -+#define BIT_CTRLFLT15EN_FW BIT(15) -+#define BIT_CTRLFLT14EN_FW BIT(14) -+#define BIT_CTRLFLT13EN_FW BIT(13) -+#define BIT_CTRLFLT12EN_FW BIT(12) -+#define BIT_CTRLFLT11EN_FW BIT(11) -+#define BIT_CTRLFLT10EN_FW BIT(10) -+#define BIT_CTRLFLT9EN_FW BIT(9) -+#define BIT_CTRLFLT8EN_FW BIT(8) -+#define BIT_CTRLFLT7EN_FW BIT(7) -+#define BIT_CTRLFLT6EN_FW BIT(6) -+#define BIT_CTRLFLT5EN_FW BIT(5) -+#define BIT_CTRLFLT4EN_FW BIT(4) -+#define BIT_CTRLFLT3EN_FW BIT(3) -+#define BIT_CTRLFLT2EN_FW BIT(2) -+#define BIT_CTRLFLT1EN_FW BIT(1) -+#define BIT_CTRLFLT0EN_FW BIT(0) -+ -+/* 2 REG_RXFLTMAP5 (Offset 0x068C) */ -+ -+#define BIT_DATAFLT15EN_FW BIT(15) -+#define BIT_DATAFLT14EN_FW BIT(14) -+#define BIT_DATAFLT13EN_FW BIT(13) -+#define BIT_DATAFLT12EN_FW BIT(12) -+#define BIT_DATAFLT11EN_FW BIT(11) -+#define BIT_DATAFLT10EN_FW BIT(10) -+#define BIT_DATAFLT9EN_FW BIT(9) -+#define BIT_DATAFLT8EN_FW BIT(8) -+#define BIT_DATAFLT7EN_FW BIT(7) -+#define BIT_DATAFLT6EN_FW BIT(6) -+#define BIT_DATAFLT5EN_FW BIT(5) -+#define BIT_DATAFLT4EN_FW BIT(4) -+#define BIT_DATAFLT3EN_FW BIT(3) -+#define BIT_DATAFLT2EN_FW BIT(2) -+#define BIT_DATAFLT1EN_FW BIT(1) -+#define BIT_DATAFLT0EN_FW BIT(0) -+ -+/* 2 REG_RXFLTMAP6 (Offset 0x068E) */ -+ -+#define BIT_ACTIONFLT15EN_FW BIT(15) -+#define BIT_ACTIONFLT14EN_FW BIT(14) -+#define BIT_ACTIONFLT13EN_FW BIT(13) -+#define BIT_ACTIONFLT12EN_FW BIT(12) -+#define BIT_ACTIONFLT11EN_FW BIT(11) -+#define BIT_ACTIONFLT10EN_FW BIT(10) -+#define BIT_ACTIONFLT9EN_FW BIT(9) -+#define BIT_ACTIONFLT8EN_FW BIT(8) -+#define BIT_ACTIONFLT7EN_FW BIT(7) -+#define BIT_ACTIONFLT6EN_FW BIT(6) -+#define BIT_ACTIONFLT5EN_FW BIT(5) -+#define BIT_ACTIONFLT4EN_FW BIT(4) -+#define BIT_ACTIONFLT3EN_FW BIT(3) -+#define BIT_ACTIONFLT2EN_FW BIT(2) -+#define BIT_ACTIONFLT1EN_FW BIT(1) -+#define BIT_ACTIONFLT0EN_FW BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WOW_CTRL (Offset 0x0690) */ -+ -+#define BIT_SHIFT_PSF_BSSIDSEL_B2B1 6 -+#define BIT_MASK_PSF_BSSIDSEL_B2B1 0x3 -+#define BIT_PSF_BSSIDSEL_B2B1(x) \ -+ (((x) & BIT_MASK_PSF_BSSIDSEL_B2B1) << BIT_SHIFT_PSF_BSSIDSEL_B2B1) -+#define BITS_PSF_BSSIDSEL_B2B1 \ -+ (BIT_MASK_PSF_BSSIDSEL_B2B1 << BIT_SHIFT_PSF_BSSIDSEL_B2B1) -+#define BIT_CLEAR_PSF_BSSIDSEL_B2B1(x) ((x) & (~BITS_PSF_BSSIDSEL_B2B1)) -+#define BIT_GET_PSF_BSSIDSEL_B2B1(x) \ -+ (((x) >> BIT_SHIFT_PSF_BSSIDSEL_B2B1) & BIT_MASK_PSF_BSSIDSEL_B2B1) -+#define BIT_SET_PSF_BSSIDSEL_B2B1(x, v) \ -+ (BIT_CLEAR_PSF_BSSIDSEL_B2B1(x) | BIT_PSF_BSSIDSEL_B2B1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WOW_CTRL (Offset 0x0690) */ -+ -+#define BIT_WOWHCI BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WOW_CTRL (Offset 0x0690) */ -+ -+#define BIT_PSF_BSSIDSEL BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WOW_CTRL (Offset 0x0690) */ -+ -+#define BIT_PSF_BSSIDSEL_B0 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WOW_CTRL (Offset 0x0690) */ -+ -+#define BIT_UWF BIT(3) -+#define BIT_MAGIC BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WOW_CTRL (Offset 0x0690) */ -+ -+#define BIT_WOWEN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WOW_CTRL (Offset 0x0690) */ -+ -+#define BIT_WFMSK BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WOW_CTRL (Offset 0x0690) */ -+ -+#define BIT_FORCE_WAKEUP BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NAN_RX_TSF_FILTER (Offset 0x0691) */ -+ -+#define BIT_CHK_TSF_TA BIT(2) -+#define BIT_CHK_TSF_CBSSID BIT(1) -+#define BIT_CHK_TSF_EN BIT(0) -+ -+/* 2 REG_PS_RX_INFO (Offset 0x0692) */ -+ -+#define BIT_WMAC_RESP_NONSTA1_DIS BIT(7) -+ -+#define BIT_SHIFT_PORTSEL__PS_RX_INFO 5 -+#define BIT_MASK_PORTSEL__PS_RX_INFO 0x7 -+#define BIT_PORTSEL__PS_RX_INFO(x) \ -+ (((x) & BIT_MASK_PORTSEL__PS_RX_INFO) << BIT_SHIFT_PORTSEL__PS_RX_INFO) -+#define BITS_PORTSEL__PS_RX_INFO \ -+ (BIT_MASK_PORTSEL__PS_RX_INFO << BIT_SHIFT_PORTSEL__PS_RX_INFO) -+#define BIT_CLEAR_PORTSEL__PS_RX_INFO(x) ((x) & (~BITS_PORTSEL__PS_RX_INFO)) -+#define BIT_GET_PORTSEL__PS_RX_INFO(x) \ -+ (((x) >> BIT_SHIFT_PORTSEL__PS_RX_INFO) & BIT_MASK_PORTSEL__PS_RX_INFO) -+#define BIT_SET_PORTSEL__PS_RX_INFO(x, v) \ -+ (BIT_CLEAR_PORTSEL__PS_RX_INFO(x) | BIT_PORTSEL__PS_RX_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PS_RX_INFO (Offset 0x0692) */ -+ -+#define BIT_RXCTRLIN0 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PS_RX_INFO (Offset 0x0692) */ -+ -+#define BIT_SHIFT_WMAC_TXMU_ACKPOLICY 4 -+#define BIT_MASK_WMAC_TXMU_ACKPOLICY 0x3 -+#define BIT_WMAC_TXMU_ACKPOLICY(x) \ -+ (((x) & BIT_MASK_WMAC_TXMU_ACKPOLICY) << BIT_SHIFT_WMAC_TXMU_ACKPOLICY) -+#define BITS_WMAC_TXMU_ACKPOLICY \ -+ (BIT_MASK_WMAC_TXMU_ACKPOLICY << BIT_SHIFT_WMAC_TXMU_ACKPOLICY) -+#define BIT_CLEAR_WMAC_TXMU_ACKPOLICY(x) ((x) & (~BITS_WMAC_TXMU_ACKPOLICY)) -+#define BIT_GET_WMAC_TXMU_ACKPOLICY(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXMU_ACKPOLICY) & BIT_MASK_WMAC_TXMU_ACKPOLICY) -+#define BIT_SET_WMAC_TXMU_ACKPOLICY(x, v) \ -+ (BIT_CLEAR_WMAC_TXMU_ACKPOLICY(x) | BIT_WMAC_TXMU_ACKPOLICY(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PS_RX_INFO (Offset 0x0692) */ -+ -+#define BIT_RXMGTIN0 BIT(3) -+#define BIT_RXDATAIN2 BIT(2) -+#define BIT_RXDATAIN1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PS_RX_INFO (Offset 0x0692) */ -+ -+#define BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL 1 -+#define BIT_MASK_WMAC_MU_BFEE_PORT_SEL 0x7 -+#define BIT_WMAC_MU_BFEE_PORT_SEL(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE_PORT_SEL) \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL) -+#define BITS_WMAC_MU_BFEE_PORT_SEL \ -+ (BIT_MASK_WMAC_MU_BFEE_PORT_SEL << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL) -+#define BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL(x) ((x) & (~BITS_WMAC_MU_BFEE_PORT_SEL)) -+#define BIT_GET_WMAC_MU_BFEE_PORT_SEL(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL) & \ -+ BIT_MASK_WMAC_MU_BFEE_PORT_SEL) -+#define BIT_SET_WMAC_MU_BFEE_PORT_SEL(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL(x) | BIT_WMAC_MU_BFEE_PORT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_PS_RX_INFO (Offset 0x0692) */ -+ -+#define BIT_RXDATAIN0 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PS_RX_INFO (Offset 0x0692) */ -+ -+#define BIT_WMAC_MU_BFEE_DIS BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMMPS_UAPSD_TID (Offset 0x0693) */ -+ -+#define BIT_SHIFT_DTIM_CNT 24 -+#define BIT_MASK_DTIM_CNT 0xff -+#define BIT_DTIM_CNT(x) (((x) & BIT_MASK_DTIM_CNT) << BIT_SHIFT_DTIM_CNT) -+#define BITS_DTIM_CNT (BIT_MASK_DTIM_CNT << BIT_SHIFT_DTIM_CNT) -+#define BIT_CLEAR_DTIM_CNT(x) ((x) & (~BITS_DTIM_CNT)) -+#define BIT_GET_DTIM_CNT(x) (((x) >> BIT_SHIFT_DTIM_CNT) & BIT_MASK_DTIM_CNT) -+#define BIT_SET_DTIM_CNT(x, v) (BIT_CLEAR_DTIM_CNT(x) | BIT_DTIM_CNT(v)) -+ -+#define BIT_CTRLFLT15EN BIT(15) -+#define BIT_DATAFLT15EN BIT(15) -+#define BIT_CTRLFLT14EN BIT(14) -+#define BIT_DATAFLT14EN BIT(14) -+#define BIT_MGTFLT13EN BIT(13) -+#define BIT_CTRLFLT13EN BIT(13) -+#define BIT_DATAFLT13EN BIT(13) -+#define BIT_MGTFLT12EN BIT(12) -+#define BIT_CTRLFLT12EN BIT(12) -+#define BIT_DATAFLT12EN BIT(12) -+#define BIT_MGTFLT11EN BIT(11) -+#define BIT_CTRLFLT11EN BIT(11) -+#define BIT_DATAFLT11EN BIT(11) -+#define BIT_MGTFLT10EN BIT(10) -+#define BIT_CTRLFLT10EN BIT(10) -+#define BIT_DATAFLT10EN BIT(10) -+#define BIT_MGTFLT9EN BIT(9) -+#define BIT_CTRLFLT9EN BIT(9) -+#define BIT_DATAFLT9EN BIT(9) -+#define BIT_MGTFLT8EN BIT(8) -+#define BIT_CTRLFLT8EN BIT(8) -+#define BIT_DATAFLT8EN BIT(8) -+#define BIT_WMMPS_UAPSD_TID7 BIT(7) -+#define BIT_CTRLFLT7EN BIT(7) -+#define BIT_DATAFLT7EN BIT(7) -+#define BIT_WMMPS_UAPSD_TID6 BIT(6) -+#define BIT_CTRLFLT6EN BIT(6) -+#define BIT_DATAFLT6EN BIT(6) -+#define BIT_WMMPS_UAPSD_TID5 BIT(5) -+#define BIT_MGTFLT5EN BIT(5) -+#define BIT_DATAFLT5EN BIT(5) -+#define BIT_WMMPS_UAPSD_TID4 BIT(4) -+#define BIT_MGTFLT4EN BIT(4) -+#define BIT_DATAFLT4EN BIT(4) -+#define BIT_WMMPS_UAPSD_TID3 BIT(3) -+#define BIT_MGTFLT3EN BIT(3) -+#define BIT_DATAFLT3EN BIT(3) -+#define BIT_WMMPS_UAPSD_TID2 BIT(2) -+#define BIT_MGTFLT2EN BIT(2) -+#define BIT_DATAFLT2EN BIT(2) -+#define BIT_WMMPS_UAPSD_TID1 BIT(1) -+#define BIT_MGTFLT1EN BIT(1) -+#define BIT_DATAFLT1EN BIT(1) -+#define BIT_WMMPS_UAPSD_TID0 BIT(0) -+#define BIT_MGTFLT0EN BIT(0) -+#define BIT_DATAFLT0EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LPNAV_CTRL (Offset 0x0694) */ -+ -+#define BIT_LPNAV_EN BIT(31) -+ -+#define BIT_SHIFT_LPNAV_EARLY 16 -+#define BIT_MASK_LPNAV_EARLY 0x7fff -+#define BIT_LPNAV_EARLY(x) \ -+ (((x) & BIT_MASK_LPNAV_EARLY) << BIT_SHIFT_LPNAV_EARLY) -+#define BITS_LPNAV_EARLY (BIT_MASK_LPNAV_EARLY << BIT_SHIFT_LPNAV_EARLY) -+#define BIT_CLEAR_LPNAV_EARLY(x) ((x) & (~BITS_LPNAV_EARLY)) -+#define BIT_GET_LPNAV_EARLY(x) \ -+ (((x) >> BIT_SHIFT_LPNAV_EARLY) & BIT_MASK_LPNAV_EARLY) -+#define BIT_SET_LPNAV_EARLY(x, v) \ -+ (BIT_CLEAR_LPNAV_EARLY(x) | BIT_LPNAV_EARLY(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_LPNAV_CTRL (Offset 0x0694) */ -+ -+#define BIT_SHIFT_LPNAV_TH 0 -+#define BIT_MASK_LPNAV_TH 0xffff -+#define BIT_LPNAV_TH(x) (((x) & BIT_MASK_LPNAV_TH) << BIT_SHIFT_LPNAV_TH) -+#define BITS_LPNAV_TH (BIT_MASK_LPNAV_TH << BIT_SHIFT_LPNAV_TH) -+#define BIT_CLEAR_LPNAV_TH(x) ((x) & (~BITS_LPNAV_TH)) -+#define BIT_GET_LPNAV_TH(x) (((x) >> BIT_SHIFT_LPNAV_TH) & BIT_MASK_LPNAV_TH) -+#define BIT_SET_LPNAV_TH(x, v) (BIT_CLEAR_LPNAV_TH(x) | BIT_LPNAV_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_LPNAV_CTRL (Offset 0x0694) */ -+ -+#define BIT_SHIFT_LPNAV_THR 0 -+#define BIT_MASK_LPNAV_THR 0xffff -+#define BIT_LPNAV_THR(x) (((x) & BIT_MASK_LPNAV_THR) << BIT_SHIFT_LPNAV_THR) -+#define BITS_LPNAV_THR (BIT_MASK_LPNAV_THR << BIT_SHIFT_LPNAV_THR) -+#define BIT_CLEAR_LPNAV_THR(x) ((x) & (~BITS_LPNAV_THR)) -+#define BIT_GET_LPNAV_THR(x) (((x) >> BIT_SHIFT_LPNAV_THR) & BIT_MASK_LPNAV_THR) -+#define BIT_SET_LPNAV_THR(x, v) (BIT_CLEAR_LPNAV_THR(x) | BIT_LPNAV_THR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WKFMCAM_CMD (Offset 0x0698) */ -+ -+#define BIT_WKFCAM_POLLING_V1 BIT(31) -+#define BIT_WKFCAM_CLR_V1 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WKFMCAM_CMD (Offset 0x0698) */ -+ -+#define BIT_WKFCAM_WE BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WKFMCAM_CMD (Offset 0x0698) */ -+ -+#define BIT_SHIFT_WKFCAM_ADDR_V2 8 -+#define BIT_MASK_WKFCAM_ADDR_V2 0xff -+#define BIT_WKFCAM_ADDR_V2(x) \ -+ (((x) & BIT_MASK_WKFCAM_ADDR_V2) << BIT_SHIFT_WKFCAM_ADDR_V2) -+#define BITS_WKFCAM_ADDR_V2 \ -+ (BIT_MASK_WKFCAM_ADDR_V2 << BIT_SHIFT_WKFCAM_ADDR_V2) -+#define BIT_CLEAR_WKFCAM_ADDR_V2(x) ((x) & (~BITS_WKFCAM_ADDR_V2)) -+#define BIT_GET_WKFCAM_ADDR_V2(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_ADDR_V2) & BIT_MASK_WKFCAM_ADDR_V2) -+#define BIT_SET_WKFCAM_ADDR_V2(x, v) \ -+ (BIT_CLEAR_WKFCAM_ADDR_V2(x) | BIT_WKFCAM_ADDR_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WKFMCAM_CMD (Offset 0x0698) */ -+ -+#define BIT_SHIFT_WKFCAM_NUM_V1 0 -+#define BIT_MASK_WKFCAM_NUM_V1 0xff -+#define BIT_WKFCAM_NUM_V1(x) \ -+ (((x) & BIT_MASK_WKFCAM_NUM_V1) << BIT_SHIFT_WKFCAM_NUM_V1) -+#define BITS_WKFCAM_NUM_V1 (BIT_MASK_WKFCAM_NUM_V1 << BIT_SHIFT_WKFCAM_NUM_V1) -+#define BIT_CLEAR_WKFCAM_NUM_V1(x) ((x) & (~BITS_WKFCAM_NUM_V1)) -+#define BIT_GET_WKFCAM_NUM_V1(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_NUM_V1) & BIT_MASK_WKFCAM_NUM_V1) -+#define BIT_SET_WKFCAM_NUM_V1(x, v) \ -+ (BIT_CLEAR_WKFCAM_NUM_V1(x) | BIT_WKFCAM_NUM_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WKFMCAM_CMD (Offset 0x0698) */ -+ -+#define BIT_SHIFT_WKFCAM_CAM_NUM_V1 0 -+#define BIT_MASK_WKFCAM_CAM_NUM_V1 0xff -+#define BIT_WKFCAM_CAM_NUM_V1(x) \ -+ (((x) & BIT_MASK_WKFCAM_CAM_NUM_V1) << BIT_SHIFT_WKFCAM_CAM_NUM_V1) -+#define BITS_WKFCAM_CAM_NUM_V1 \ -+ (BIT_MASK_WKFCAM_CAM_NUM_V1 << BIT_SHIFT_WKFCAM_CAM_NUM_V1) -+#define BIT_CLEAR_WKFCAM_CAM_NUM_V1(x) ((x) & (~BITS_WKFCAM_CAM_NUM_V1)) -+#define BIT_GET_WKFCAM_CAM_NUM_V1(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_CAM_NUM_V1) & BIT_MASK_WKFCAM_CAM_NUM_V1) -+#define BIT_SET_WKFCAM_CAM_NUM_V1(x, v) \ -+ (BIT_CLEAR_WKFCAM_CAM_NUM_V1(x) | BIT_WKFCAM_CAM_NUM_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_WKFMCAM_CMD (Offset 0x0698) */ -+ -+#define BIT_SHIFT_WKFCAM_ADDR 0 -+#define BIT_MASK_WKFCAM_ADDR 0x7f -+#define BIT_WKFCAM_ADDR(x) \ -+ (((x) & BIT_MASK_WKFCAM_ADDR) << BIT_SHIFT_WKFCAM_ADDR) -+#define BITS_WKFCAM_ADDR (BIT_MASK_WKFCAM_ADDR << BIT_SHIFT_WKFCAM_ADDR) -+#define BIT_CLEAR_WKFCAM_ADDR(x) ((x) & (~BITS_WKFCAM_ADDR)) -+#define BIT_GET_WKFCAM_ADDR(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_ADDR) & BIT_MASK_WKFCAM_ADDR) -+#define BIT_SET_WKFCAM_ADDR(x, v) \ -+ (BIT_CLEAR_WKFCAM_ADDR(x) | BIT_WKFCAM_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WKFMCAM_RWD (Offset 0x069C) */ -+ -+#define BIT_SHIFT_WKFMCAM_RWD 0 -+#define BIT_MASK_WKFMCAM_RWD 0xffffffffL -+#define BIT_WKFMCAM_RWD(x) \ -+ (((x) & BIT_MASK_WKFMCAM_RWD) << BIT_SHIFT_WKFMCAM_RWD) -+#define BITS_WKFMCAM_RWD (BIT_MASK_WKFMCAM_RWD << BIT_SHIFT_WKFMCAM_RWD) -+#define BIT_CLEAR_WKFMCAM_RWD(x) ((x) & (~BITS_WKFMCAM_RWD)) -+#define BIT_GET_WKFMCAM_RWD(x) \ -+ (((x) >> BIT_SHIFT_WKFMCAM_RWD) & BIT_MASK_WKFMCAM_RWD) -+#define BIT_SET_WKFMCAM_RWD(x, v) \ -+ (BIT_CLEAR_WKFMCAM_RWD(x) | BIT_WKFMCAM_RWD(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BCN_PSR_RPT (Offset 0x06A8) */ -+ -+#define BIT_SHIFT_DTIM_PERIOD 16 -+#define BIT_MASK_DTIM_PERIOD 0xff -+#define BIT_DTIM_PERIOD(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD) << BIT_SHIFT_DTIM_PERIOD) -+#define BITS_DTIM_PERIOD (BIT_MASK_DTIM_PERIOD << BIT_SHIFT_DTIM_PERIOD) -+#define BIT_CLEAR_DTIM_PERIOD(x) ((x) & (~BITS_DTIM_PERIOD)) -+#define BIT_GET_DTIM_PERIOD(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD) & BIT_MASK_DTIM_PERIOD) -+#define BIT_SET_DTIM_PERIOD(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD(x) | BIT_DTIM_PERIOD(v)) -+ -+#define BIT_DTIM BIT(15) -+#define BIT_TIM BIT(14) -+ -+#define BIT_SHIFT_PS_AID_0 0 -+#define BIT_MASK_PS_AID_0 0x7ff -+#define BIT_PS_AID_0(x) (((x) & BIT_MASK_PS_AID_0) << BIT_SHIFT_PS_AID_0) -+#define BITS_PS_AID_0 (BIT_MASK_PS_AID_0 << BIT_SHIFT_PS_AID_0) -+#define BIT_CLEAR_PS_AID_0(x) ((x) & (~BITS_PS_AID_0)) -+#define BIT_GET_PS_AID_0(x) (((x) >> BIT_SHIFT_PS_AID_0) & BIT_MASK_PS_AID_0) -+#define BIT_SET_PS_AID_0(x, v) (BIT_CLEAR_PS_AID_0(x) | BIT_PS_AID_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_FLC_RPC (Offset 0x06AC) */ -+ -+#define BIT_SHIFT_FLC_RPC 0 -+#define BIT_MASK_FLC_RPC 0xff -+#define BIT_FLC_RPC(x) (((x) & BIT_MASK_FLC_RPC) << BIT_SHIFT_FLC_RPC) -+#define BITS_FLC_RPC (BIT_MASK_FLC_RPC << BIT_SHIFT_FLC_RPC) -+#define BIT_CLEAR_FLC_RPC(x) ((x) & (~BITS_FLC_RPC)) -+#define BIT_GET_FLC_RPC(x) (((x) >> BIT_SHIFT_FLC_RPC) & BIT_MASK_FLC_RPC) -+#define BIT_SET_FLC_RPC(x, v) (BIT_CLEAR_FLC_RPC(x) | BIT_FLC_RPC(v)) -+ -+/* 2 REG_FLC_RPCT (Offset 0x06AD) */ -+ -+#define BIT_SHIFT_FLC_RPCT 0 -+#define BIT_MASK_FLC_RPCT 0xff -+#define BIT_FLC_RPCT(x) (((x) & BIT_MASK_FLC_RPCT) << BIT_SHIFT_FLC_RPCT) -+#define BITS_FLC_RPCT (BIT_MASK_FLC_RPCT << BIT_SHIFT_FLC_RPCT) -+#define BIT_CLEAR_FLC_RPCT(x) ((x) & (~BITS_FLC_RPCT)) -+#define BIT_GET_FLC_RPCT(x) (((x) >> BIT_SHIFT_FLC_RPCT) & BIT_MASK_FLC_RPCT) -+#define BIT_SET_FLC_RPCT(x, v) (BIT_CLEAR_FLC_RPCT(x) | BIT_FLC_RPCT(v)) -+ -+/* 2 REG_FLC_PTS (Offset 0x06AE) */ -+ -+#define BIT_CMF BIT(2) -+#define BIT_CCF BIT(1) -+#define BIT_CDF BIT(0) -+ -+/* 2 REG_FLC_TRPC (Offset 0x06AF) */ -+ -+#define BIT_FLC_RPCT_V1 BIT(7) -+#define BIT_MODE BIT(6) -+ -+#define BIT_SHIFT_TRPCD 0 -+#define BIT_MASK_TRPCD 0x3f -+#define BIT_TRPCD(x) (((x) & BIT_MASK_TRPCD) << BIT_SHIFT_TRPCD) -+#define BITS_TRPCD (BIT_MASK_TRPCD << BIT_SHIFT_TRPCD) -+#define BIT_CLEAR_TRPCD(x) ((x) & (~BITS_TRPCD)) -+#define BIT_GET_TRPCD(x) (((x) >> BIT_SHIFT_TRPCD) & BIT_MASK_TRPCD) -+#define BIT_SET_TRPCD(x, v) (BIT_CLEAR_TRPCD(x) | BIT_TRPCD(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXPKTMON_CTRL (Offset 0x06B0) */ -+ -+#define BIT_SHIFT_RXBKQPKT_SEQ 20 -+#define BIT_MASK_RXBKQPKT_SEQ 0xf -+#define BIT_RXBKQPKT_SEQ(x) \ -+ (((x) & BIT_MASK_RXBKQPKT_SEQ) << BIT_SHIFT_RXBKQPKT_SEQ) -+#define BITS_RXBKQPKT_SEQ (BIT_MASK_RXBKQPKT_SEQ << BIT_SHIFT_RXBKQPKT_SEQ) -+#define BIT_CLEAR_RXBKQPKT_SEQ(x) ((x) & (~BITS_RXBKQPKT_SEQ)) -+#define BIT_GET_RXBKQPKT_SEQ(x) \ -+ (((x) >> BIT_SHIFT_RXBKQPKT_SEQ) & BIT_MASK_RXBKQPKT_SEQ) -+#define BIT_SET_RXBKQPKT_SEQ(x, v) \ -+ (BIT_CLEAR_RXBKQPKT_SEQ(x) | BIT_RXBKQPKT_SEQ(v)) -+ -+#define BIT_SHIFT_RXBEQPKT_SEQ 16 -+#define BIT_MASK_RXBEQPKT_SEQ 0xf -+#define BIT_RXBEQPKT_SEQ(x) \ -+ (((x) & BIT_MASK_RXBEQPKT_SEQ) << BIT_SHIFT_RXBEQPKT_SEQ) -+#define BITS_RXBEQPKT_SEQ (BIT_MASK_RXBEQPKT_SEQ << BIT_SHIFT_RXBEQPKT_SEQ) -+#define BIT_CLEAR_RXBEQPKT_SEQ(x) ((x) & (~BITS_RXBEQPKT_SEQ)) -+#define BIT_GET_RXBEQPKT_SEQ(x) \ -+ (((x) >> BIT_SHIFT_RXBEQPKT_SEQ) & BIT_MASK_RXBEQPKT_SEQ) -+#define BIT_SET_RXBEQPKT_SEQ(x, v) \ -+ (BIT_CLEAR_RXBEQPKT_SEQ(x) | BIT_RXBEQPKT_SEQ(v)) -+ -+#define BIT_SHIFT_RXVIQPKT_SEQ 12 -+#define BIT_MASK_RXVIQPKT_SEQ 0xf -+#define BIT_RXVIQPKT_SEQ(x) \ -+ (((x) & BIT_MASK_RXVIQPKT_SEQ) << BIT_SHIFT_RXVIQPKT_SEQ) -+#define BITS_RXVIQPKT_SEQ (BIT_MASK_RXVIQPKT_SEQ << BIT_SHIFT_RXVIQPKT_SEQ) -+#define BIT_CLEAR_RXVIQPKT_SEQ(x) ((x) & (~BITS_RXVIQPKT_SEQ)) -+#define BIT_GET_RXVIQPKT_SEQ(x) \ -+ (((x) >> BIT_SHIFT_RXVIQPKT_SEQ) & BIT_MASK_RXVIQPKT_SEQ) -+#define BIT_SET_RXVIQPKT_SEQ(x, v) \ -+ (BIT_CLEAR_RXVIQPKT_SEQ(x) | BIT_RXVIQPKT_SEQ(v)) -+ -+#define BIT_SHIFT_RXVOQPKT_SEQ 8 -+#define BIT_MASK_RXVOQPKT_SEQ 0xf -+#define BIT_RXVOQPKT_SEQ(x) \ -+ (((x) & BIT_MASK_RXVOQPKT_SEQ) << BIT_SHIFT_RXVOQPKT_SEQ) -+#define BITS_RXVOQPKT_SEQ (BIT_MASK_RXVOQPKT_SEQ << BIT_SHIFT_RXVOQPKT_SEQ) -+#define BIT_CLEAR_RXVOQPKT_SEQ(x) ((x) & (~BITS_RXVOQPKT_SEQ)) -+#define BIT_GET_RXVOQPKT_SEQ(x) \ -+ (((x) >> BIT_SHIFT_RXVOQPKT_SEQ) & BIT_MASK_RXVOQPKT_SEQ) -+#define BIT_SET_RXVOQPKT_SEQ(x, v) \ -+ (BIT_CLEAR_RXVOQPKT_SEQ(x) | BIT_RXVOQPKT_SEQ(v)) -+ -+#define BIT_RXBKQPKT_ERR BIT(7) -+#define BIT_RXBEQPKT_ERR BIT(6) -+#define BIT_RXVIQPKT_ERR BIT(5) -+#define BIT_RXVOQPKT_ERR BIT(4) -+#define BIT_RXDMA_MON_EN BIT(2) -+#define BIT_RXPKT_MON_RST BIT(1) -+#define BIT_RXPKT_MON_EN BIT(0) -+ -+/* 2 REG_STATE_MON (Offset 0x06B4) */ -+ -+#define BIT_EN_TXRPTBUF_CLK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_STATE_MON (Offset 0x06B4) */ -+ -+#define BIT_SHIFT_DMA_MON_EN 24 -+#define BIT_MASK_DMA_MON_EN 0x1f -+#define BIT_DMA_MON_EN(x) (((x) & BIT_MASK_DMA_MON_EN) << BIT_SHIFT_DMA_MON_EN) -+#define BITS_DMA_MON_EN (BIT_MASK_DMA_MON_EN << BIT_SHIFT_DMA_MON_EN) -+#define BIT_CLEAR_DMA_MON_EN(x) ((x) & (~BITS_DMA_MON_EN)) -+#define BIT_GET_DMA_MON_EN(x) \ -+ (((x) >> BIT_SHIFT_DMA_MON_EN) & BIT_MASK_DMA_MON_EN) -+#define BIT_SET_DMA_MON_EN(x, v) (BIT_CLEAR_DMA_MON_EN(x) | BIT_DMA_MON_EN(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_STATE_MON (Offset 0x06B4) */ -+ -+#define BIT_SHIFT_STATE_SEL 24 -+#define BIT_MASK_STATE_SEL 0x1f -+#define BIT_STATE_SEL(x) (((x) & BIT_MASK_STATE_SEL) << BIT_SHIFT_STATE_SEL) -+#define BITS_STATE_SEL (BIT_MASK_STATE_SEL << BIT_SHIFT_STATE_SEL) -+#define BIT_CLEAR_STATE_SEL(x) ((x) & (~BITS_STATE_SEL)) -+#define BIT_GET_STATE_SEL(x) (((x) >> BIT_SHIFT_STATE_SEL) & BIT_MASK_STATE_SEL) -+#define BIT_SET_STATE_SEL(x, v) (BIT_CLEAR_STATE_SEL(x) | BIT_STATE_SEL(v)) -+ -+#define BIT_MACRX_ERR_1 BIT(17) -+#define BIT_MACRX_ERR_0 BIT(16) -+#define BIT_DIS_INFOSRCH BIT(14) -+ -+#define BIT_SHIFT_STATE_INFO 8 -+#define BIT_MASK_STATE_INFO 0xff -+#define BIT_STATE_INFO(x) (((x) & BIT_MASK_STATE_INFO) << BIT_SHIFT_STATE_INFO) -+#define BITS_STATE_INFO (BIT_MASK_STATE_INFO << BIT_SHIFT_STATE_INFO) -+#define BIT_CLEAR_STATE_INFO(x) ((x) & (~BITS_STATE_INFO)) -+#define BIT_GET_STATE_INFO(x) \ -+ (((x) >> BIT_SHIFT_STATE_INFO) & BIT_MASK_STATE_INFO) -+#define BIT_SET_STATE_INFO(x, v) (BIT_CLEAR_STATE_INFO(x) | BIT_STATE_INFO(v)) -+ -+#define BIT_UPD_NXT_STATE BIT(7) -+#define BIT_MACTX_ERR_3 BIT(3) -+#define BIT_MACTX_ERR_2 BIT(2) -+#define BIT_MACTX_ERR_1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_STATE_MON (Offset 0x06B4) */ -+ -+#define BIT_SHIFT_PKT_MON_EN 0 -+#define BIT_MASK_PKT_MON_EN 0x7f -+#define BIT_PKT_MON_EN(x) (((x) & BIT_MASK_PKT_MON_EN) << BIT_SHIFT_PKT_MON_EN) -+#define BITS_PKT_MON_EN (BIT_MASK_PKT_MON_EN << BIT_SHIFT_PKT_MON_EN) -+#define BIT_CLEAR_PKT_MON_EN(x) ((x) & (~BITS_PKT_MON_EN)) -+#define BIT_GET_PKT_MON_EN(x) \ -+ (((x) >> BIT_SHIFT_PKT_MON_EN) & BIT_MASK_PKT_MON_EN) -+#define BIT_SET_PKT_MON_EN(x, v) (BIT_CLEAR_PKT_MON_EN(x) | BIT_PKT_MON_EN(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_STATE_MON (Offset 0x06B4) */ -+ -+#define BIT_SHIFT_CUR_STATE 0 -+#define BIT_MASK_CUR_STATE 0x7f -+#define BIT_CUR_STATE(x) (((x) & BIT_MASK_CUR_STATE) << BIT_SHIFT_CUR_STATE) -+#define BITS_CUR_STATE (BIT_MASK_CUR_STATE << BIT_SHIFT_CUR_STATE) -+#define BIT_CLEAR_CUR_STATE(x) ((x) & (~BITS_CUR_STATE)) -+#define BIT_GET_CUR_STATE(x) (((x) >> BIT_SHIFT_CUR_STATE) & BIT_MASK_CUR_STATE) -+#define BIT_SET_CUR_STATE(x, v) (BIT_CLEAR_CUR_STATE(x) | BIT_CUR_STATE(v)) -+ -+#define BIT_MACTX_ERR_0 BIT(0) -+ -+#define BIT_SHIFT_INFO_ADDR_OFFSET 0 -+#define BIT_MASK_INFO_ADDR_OFFSET 0x1fff -+#define BIT_INFO_ADDR_OFFSET(x) \ -+ (((x) & BIT_MASK_INFO_ADDR_OFFSET) << BIT_SHIFT_INFO_ADDR_OFFSET) -+#define BITS_INFO_ADDR_OFFSET \ -+ (BIT_MASK_INFO_ADDR_OFFSET << BIT_SHIFT_INFO_ADDR_OFFSET) -+#define BIT_CLEAR_INFO_ADDR_OFFSET(x) ((x) & (~BITS_INFO_ADDR_OFFSET)) -+#define BIT_GET_INFO_ADDR_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_INFO_ADDR_OFFSET) & BIT_MASK_INFO_ADDR_OFFSET) -+#define BIT_SET_INFO_ADDR_OFFSET(x, v) \ -+ (BIT_CLEAR_INFO_ADDR_OFFSET(x) | BIT_INFO_ADDR_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_ERROR_MON (Offset 0x06B8) */ -+ -+#define BIT_BFM_RPTNUM_ERROR BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ERROR_MON (Offset 0x06B8) */ -+ -+#define BIT_MACRX_ERR_5 BIT(21) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_ERROR_MON (Offset 0x06B8) */ -+ -+#define BIT_BFM_CHECKSUM_ERROR BIT(20) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ERROR_MON (Offset 0x06B8) */ -+ -+#define BIT_WMAC_PRETX_ERRHDL_EN BIT(15) -+#define BIT_MACTX_ERR_5 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BT_COEX_TABLE (Offset 0x06C0) */ -+ -+#define BIT_PRI_MASK_RX_RESP BIT(126) -+#define BIT_PRI_MASK_RXOFDM BIT(125) -+#define BIT_PRI_MASK_RXCCK BIT(124) -+#define BIT_PRI_MASK_CCK BIT(108) -+#define BIT_PRI_MASK_OFDM BIT(107) -+#define BIT_PRI_MASK_RTY BIT(106) -+#define BIT_OOB BIT(97) -+#define BIT_ANT_SEL BIT(96) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_BT_COEX_TABLE (Offset 0x06C0) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_1 16 -+#define BIT_MASK_R_WMAC_BFINFO_20M_1 0xfff -+#define BIT_R_WMAC_BFINFO_20M_1(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_1) << BIT_SHIFT_R_WMAC_BFINFO_20M_1) -+#define BITS_R_WMAC_BFINFO_20M_1 \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_1 << BIT_SHIFT_R_WMAC_BFINFO_20M_1) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_1(x) ((x) & (~BITS_R_WMAC_BFINFO_20M_1)) -+#define BIT_GET_R_WMAC_BFINFO_20M_1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_1) & BIT_MASK_R_WMAC_BFINFO_20M_1) -+#define BIT_SET_R_WMAC_BFINFO_20M_1(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_1(x) | BIT_R_WMAC_BFINFO_20M_1(v)) -+ -+#define BIT_SHIFT_COEX_TABLE_1 0 -+#define BIT_MASK_COEX_TABLE_1 0xffffffffL -+#define BIT_COEX_TABLE_1(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_1) << BIT_SHIFT_COEX_TABLE_1) -+#define BITS_COEX_TABLE_1 (BIT_MASK_COEX_TABLE_1 << BIT_SHIFT_COEX_TABLE_1) -+#define BIT_CLEAR_COEX_TABLE_1(x) ((x) & (~BITS_COEX_TABLE_1)) -+#define BIT_GET_COEX_TABLE_1(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_1) & BIT_MASK_COEX_TABLE_1) -+#define BIT_SET_COEX_TABLE_1(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_1(x) | BIT_COEX_TABLE_1(v)) -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_0 0 -+#define BIT_MASK_R_WMAC_BFINFO_20M_0 0xfff -+#define BIT_R_WMAC_BFINFO_20M_0(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_0) << BIT_SHIFT_R_WMAC_BFINFO_20M_0) -+#define BITS_R_WMAC_BFINFO_20M_0 \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_0 << BIT_SHIFT_R_WMAC_BFINFO_20M_0) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_0(x) ((x) & (~BITS_R_WMAC_BFINFO_20M_0)) -+#define BIT_GET_R_WMAC_BFINFO_20M_0(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_0) & BIT_MASK_R_WMAC_BFINFO_20M_0) -+#define BIT_SET_R_WMAC_BFINFO_20M_0(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_0(x) | BIT_R_WMAC_BFINFO_20M_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_COEX_TABLE_H (Offset 0x06CC) */ -+ -+#define BIT_PRI_MASK_RX_RESP_V1 BIT(30) -+#define BIT_PRI_MASK_RXOFDM_V1 BIT(29) -+#define BIT_PRI_MASK_RXCCK_V1 BIT(28) -+#define BIT_PRI_MASK_CCK_V1 BIT(12) -+#define BIT_PRI_MASK_OFDM_V1 BIT(11) -+#define BIT_PRI_MASK_RTY_V1 BIT(10) -+#define BIT_OOB_V1 BIT(1) -+#define BIT_ANT_SEL_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXCMD_0 (Offset 0x06D0) */ -+ -+#define BIT_RXCMD_EN BIT(31) -+ -+#define BIT_SHIFT_RXCMD_INFO 0 -+#define BIT_MASK_RXCMD_INFO 0x7fffffffL -+#define BIT_RXCMD_INFO(x) (((x) & BIT_MASK_RXCMD_INFO) << BIT_SHIFT_RXCMD_INFO) -+#define BITS_RXCMD_INFO (BIT_MASK_RXCMD_INFO << BIT_SHIFT_RXCMD_INFO) -+#define BIT_CLEAR_RXCMD_INFO(x) ((x) & (~BITS_RXCMD_INFO)) -+#define BIT_GET_RXCMD_INFO(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_INFO) & BIT_MASK_RXCMD_INFO) -+#define BIT_SET_RXCMD_INFO(x, v) (BIT_CLEAR_RXCMD_INFO(x) | BIT_RXCMD_INFO(v)) -+ -+/* 2 REG_RXCMD_1 (Offset 0x06D4) */ -+ -+#define BIT_TXUSER_ID1 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXCMD_1 (Offset 0x06D4) */ -+ -+#define BIT_SHIFT_CSI_RADDR_LATCH_V1 24 -+#define BIT_MASK_CSI_RADDR_LATCH_V1 0x3f -+#define BIT_CSI_RADDR_LATCH_V1(x) \ -+ (((x) & BIT_MASK_CSI_RADDR_LATCH_V1) << BIT_SHIFT_CSI_RADDR_LATCH_V1) -+#define BITS_CSI_RADDR_LATCH_V1 \ -+ (BIT_MASK_CSI_RADDR_LATCH_V1 << BIT_SHIFT_CSI_RADDR_LATCH_V1) -+#define BIT_CLEAR_CSI_RADDR_LATCH_V1(x) ((x) & (~BITS_CSI_RADDR_LATCH_V1)) -+#define BIT_GET_CSI_RADDR_LATCH_V1(x) \ -+ (((x) >> BIT_SHIFT_CSI_RADDR_LATCH_V1) & BIT_MASK_CSI_RADDR_LATCH_V1) -+#define BIT_SET_CSI_RADDR_LATCH_V1(x, v) \ -+ (BIT_CLEAR_CSI_RADDR_LATCH_V1(x) | BIT_CSI_RADDR_LATCH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_RXCMD_1 (Offset 0x06D4) */ -+ -+#define BIT_SHIFT_CSI_RADDR_LATCH 24 -+#define BIT_MASK_CSI_RADDR_LATCH 0xff -+#define BIT_CSI_RADDR_LATCH(x) \ -+ (((x) & BIT_MASK_CSI_RADDR_LATCH) << BIT_SHIFT_CSI_RADDR_LATCH) -+#define BITS_CSI_RADDR_LATCH \ -+ (BIT_MASK_CSI_RADDR_LATCH << BIT_SHIFT_CSI_RADDR_LATCH) -+#define BIT_CLEAR_CSI_RADDR_LATCH(x) ((x) & (~BITS_CSI_RADDR_LATCH)) -+#define BIT_GET_CSI_RADDR_LATCH(x) \ -+ (((x) >> BIT_SHIFT_CSI_RADDR_LATCH) & BIT_MASK_CSI_RADDR_LATCH) -+#define BIT_SET_CSI_RADDR_LATCH(x, v) \ -+ (BIT_CLEAR_CSI_RADDR_LATCH(x) | BIT_CSI_RADDR_LATCH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXCMD_1 (Offset 0x06D4) */ -+ -+#define BIT_SHIFT_AID1 16 -+#define BIT_MASK_AID1 0x1ff -+#define BIT_AID1(x) (((x) & BIT_MASK_AID1) << BIT_SHIFT_AID1) -+#define BITS_AID1 (BIT_MASK_AID1 << BIT_SHIFT_AID1) -+#define BIT_CLEAR_AID1(x) ((x) & (~BITS_AID1)) -+#define BIT_GET_AID1(x) (((x) >> BIT_SHIFT_AID1) & BIT_MASK_AID1) -+#define BIT_SET_AID1(x, v) (BIT_CLEAR_AID1(x) | BIT_AID1(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXCMD_1 (Offset 0x06D4) */ -+ -+#define BIT_SHIFT_CSI_WADDR_LATCH_V1 16 -+#define BIT_MASK_CSI_WADDR_LATCH_V1 0x3f -+#define BIT_CSI_WADDR_LATCH_V1(x) \ -+ (((x) & BIT_MASK_CSI_WADDR_LATCH_V1) << BIT_SHIFT_CSI_WADDR_LATCH_V1) -+#define BITS_CSI_WADDR_LATCH_V1 \ -+ (BIT_MASK_CSI_WADDR_LATCH_V1 << BIT_SHIFT_CSI_WADDR_LATCH_V1) -+#define BIT_CLEAR_CSI_WADDR_LATCH_V1(x) ((x) & (~BITS_CSI_WADDR_LATCH_V1)) -+#define BIT_GET_CSI_WADDR_LATCH_V1(x) \ -+ (((x) >> BIT_SHIFT_CSI_WADDR_LATCH_V1) & BIT_MASK_CSI_WADDR_LATCH_V1) -+#define BIT_SET_CSI_WADDR_LATCH_V1(x, v) \ -+ (BIT_CLEAR_CSI_WADDR_LATCH_V1(x) | BIT_CSI_WADDR_LATCH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_RXCMD_1 (Offset 0x06D4) */ -+ -+#define BIT_SHIFT_CSI_WADDR_LATCH 16 -+#define BIT_MASK_CSI_WADDR_LATCH 0xff -+#define BIT_CSI_WADDR_LATCH(x) \ -+ (((x) & BIT_MASK_CSI_WADDR_LATCH) << BIT_SHIFT_CSI_WADDR_LATCH) -+#define BITS_CSI_WADDR_LATCH \ -+ (BIT_MASK_CSI_WADDR_LATCH << BIT_SHIFT_CSI_WADDR_LATCH) -+#define BIT_CLEAR_CSI_WADDR_LATCH(x) ((x) & (~BITS_CSI_WADDR_LATCH)) -+#define BIT_GET_CSI_WADDR_LATCH(x) \ -+ (((x) >> BIT_SHIFT_CSI_WADDR_LATCH) & BIT_MASK_CSI_WADDR_LATCH) -+#define BIT_SET_CSI_WADDR_LATCH(x, v) \ -+ (BIT_CLEAR_CSI_WADDR_LATCH(x) | BIT_CSI_WADDR_LATCH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXCMD_1 (Offset 0x06D4) */ -+ -+#define BIT_TXUSER_ID0 BIT(9) -+ -+#define BIT_SHIFT_RXCMD_PRD 0 -+#define BIT_MASK_RXCMD_PRD 0xffff -+#define BIT_RXCMD_PRD(x) (((x) & BIT_MASK_RXCMD_PRD) << BIT_SHIFT_RXCMD_PRD) -+#define BITS_RXCMD_PRD (BIT_MASK_RXCMD_PRD << BIT_SHIFT_RXCMD_PRD) -+#define BIT_CLEAR_RXCMD_PRD(x) ((x) & (~BITS_RXCMD_PRD)) -+#define BIT_GET_RXCMD_PRD(x) (((x) >> BIT_SHIFT_RXCMD_PRD) & BIT_MASK_RXCMD_PRD) -+#define BIT_SET_RXCMD_PRD(x, v) (BIT_CLEAR_RXCMD_PRD(x) | BIT_RXCMD_PRD(v)) -+ -+#define BIT_SHIFT_AID0 0 -+#define BIT_MASK_AID0 0x1ff -+#define BIT_AID0(x) (((x) & BIT_MASK_AID0) << BIT_SHIFT_AID0) -+#define BITS_AID0 (BIT_MASK_AID0 << BIT_SHIFT_AID0) -+#define BIT_CLEAR_AID0(x) ((x) & (~BITS_AID0)) -+#define BIT_GET_AID0(x) (((x) >> BIT_SHIFT_AID0) & BIT_MASK_AID0) -+#define BIT_SET_AID0(x, v) (BIT_CLEAR_AID0(x) | BIT_AID0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RESP_TXINFO_CFG (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_RESP_MFB 25 -+#define BIT_MASK_RESP_MFB 0x7f -+#define BIT_RESP_MFB(x) (((x) & BIT_MASK_RESP_MFB) << BIT_SHIFT_RESP_MFB) -+#define BITS_RESP_MFB (BIT_MASK_RESP_MFB << BIT_SHIFT_RESP_MFB) -+#define BIT_CLEAR_RESP_MFB(x) ((x) & (~BITS_RESP_MFB)) -+#define BIT_GET_RESP_MFB(x) (((x) >> BIT_SHIFT_RESP_MFB) & BIT_MASK_RESP_MFB) -+#define BIT_SET_RESP_MFB(x, v) (BIT_CLEAR_RESP_MFB(x) | BIT_RESP_MFB(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_RESP_TXINFO (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_WMAC_RESP_MFB 25 -+#define BIT_MASK_WMAC_RESP_MFB 0x7f -+#define BIT_WMAC_RESP_MFB(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_MFB) << BIT_SHIFT_WMAC_RESP_MFB) -+#define BITS_WMAC_RESP_MFB (BIT_MASK_WMAC_RESP_MFB << BIT_SHIFT_WMAC_RESP_MFB) -+#define BIT_CLEAR_WMAC_RESP_MFB(x) ((x) & (~BITS_WMAC_RESP_MFB)) -+#define BIT_GET_WMAC_RESP_MFB(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_MFB) & BIT_MASK_WMAC_RESP_MFB) -+#define BIT_SET_WMAC_RESP_MFB(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_MFB(x) | BIT_WMAC_RESP_MFB(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RESP_TXINFO_CFG (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_ANTINF_SEL 23 -+#define BIT_MASK_ANTINF_SEL 0x3 -+#define BIT_ANTINF_SEL(x) (((x) & BIT_MASK_ANTINF_SEL) << BIT_SHIFT_ANTINF_SEL) -+#define BITS_ANTINF_SEL (BIT_MASK_ANTINF_SEL << BIT_SHIFT_ANTINF_SEL) -+#define BIT_CLEAR_ANTINF_SEL(x) ((x) & (~BITS_ANTINF_SEL)) -+#define BIT_GET_ANTINF_SEL(x) \ -+ (((x) >> BIT_SHIFT_ANTINF_SEL) & BIT_MASK_ANTINF_SEL) -+#define BIT_SET_ANTINF_SEL(x, v) (BIT_CLEAR_ANTINF_SEL(x) | BIT_ANTINF_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_RESP_TXINFO (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_WMAC_ANTINF_SEL 23 -+#define BIT_MASK_WMAC_ANTINF_SEL 0x3 -+#define BIT_WMAC_ANTINF_SEL(x) \ -+ (((x) & BIT_MASK_WMAC_ANTINF_SEL) << BIT_SHIFT_WMAC_ANTINF_SEL) -+#define BITS_WMAC_ANTINF_SEL \ -+ (BIT_MASK_WMAC_ANTINF_SEL << BIT_SHIFT_WMAC_ANTINF_SEL) -+#define BIT_CLEAR_WMAC_ANTINF_SEL(x) ((x) & (~BITS_WMAC_ANTINF_SEL)) -+#define BIT_GET_WMAC_ANTINF_SEL(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTINF_SEL) & BIT_MASK_WMAC_ANTINF_SEL) -+#define BIT_SET_WMAC_ANTINF_SEL(x, v) \ -+ (BIT_CLEAR_WMAC_ANTINF_SEL(x) | BIT_WMAC_ANTINF_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RESP_TXINFO_CFG (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_ANTSEL_SEL 21 -+#define BIT_MASK_ANTSEL_SEL 0x3 -+#define BIT_ANTSEL_SEL(x) (((x) & BIT_MASK_ANTSEL_SEL) << BIT_SHIFT_ANTSEL_SEL) -+#define BITS_ANTSEL_SEL (BIT_MASK_ANTSEL_SEL << BIT_SHIFT_ANTSEL_SEL) -+#define BIT_CLEAR_ANTSEL_SEL(x) ((x) & (~BITS_ANTSEL_SEL)) -+#define BIT_GET_ANTSEL_SEL(x) \ -+ (((x) >> BIT_SHIFT_ANTSEL_SEL) & BIT_MASK_ANTSEL_SEL) -+#define BIT_SET_ANTSEL_SEL(x, v) (BIT_CLEAR_ANTSEL_SEL(x) | BIT_ANTSEL_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_RESP_TXINFO (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_WMAC_ANTSEL_SEL 21 -+#define BIT_MASK_WMAC_ANTSEL_SEL 0x3 -+#define BIT_WMAC_ANTSEL_SEL(x) \ -+ (((x) & BIT_MASK_WMAC_ANTSEL_SEL) << BIT_SHIFT_WMAC_ANTSEL_SEL) -+#define BITS_WMAC_ANTSEL_SEL \ -+ (BIT_MASK_WMAC_ANTSEL_SEL << BIT_SHIFT_WMAC_ANTSEL_SEL) -+#define BIT_CLEAR_WMAC_ANTSEL_SEL(x) ((x) & (~BITS_WMAC_ANTSEL_SEL)) -+#define BIT_GET_WMAC_ANTSEL_SEL(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTSEL_SEL) & BIT_MASK_WMAC_ANTSEL_SEL) -+#define BIT_SET_WMAC_ANTSEL_SEL(x, v) \ -+ (BIT_CLEAR_WMAC_ANTSEL_SEL(x) | BIT_WMAC_ANTSEL_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WMAC_RESP_TXINFO (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_R_WMAC_RESP_TXPOWER 18 -+#define BIT_MASK_R_WMAC_RESP_TXPOWER 0x7 -+#define BIT_R_WMAC_RESP_TXPOWER(x) \ -+ (((x) & BIT_MASK_R_WMAC_RESP_TXPOWER) << BIT_SHIFT_R_WMAC_RESP_TXPOWER) -+#define BITS_R_WMAC_RESP_TXPOWER \ -+ (BIT_MASK_R_WMAC_RESP_TXPOWER << BIT_SHIFT_R_WMAC_RESP_TXPOWER) -+#define BIT_CLEAR_R_WMAC_RESP_TXPOWER(x) ((x) & (~BITS_R_WMAC_RESP_TXPOWER)) -+#define BIT_GET_R_WMAC_RESP_TXPOWER(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RESP_TXPOWER) & BIT_MASK_R_WMAC_RESP_TXPOWER) -+#define BIT_SET_R_WMAC_RESP_TXPOWER(x, v) \ -+ (BIT_CLEAR_R_WMAC_RESP_TXPOWER(x) | BIT_R_WMAC_RESP_TXPOWER(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_RESP_TXINFO (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE 18 -+#define BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE 0x3 -+#define BIT_WMAC_RESP_TXPOWER_OFFSET_TYPE(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE) \ -+ << BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE) -+#define BITS_WMAC_RESP_TXPOWER_OFFSET_TYPE \ -+ (BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE \ -+ << BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE) -+#define BIT_CLEAR_WMAC_RESP_TXPOWER_OFFSET_TYPE(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXPOWER_OFFSET_TYPE)) -+#define BIT_GET_WMAC_RESP_TXPOWER_OFFSET_TYPE(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE) & \ -+ BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE) -+#define BIT_SET_WMAC_RESP_TXPOWER_OFFSET_TYPE(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXPOWER_OFFSET_TYPE(x) | \ -+ BIT_WMAC_RESP_TXPOWER_OFFSET_TYPE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_RESP_TXINFO (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_RESP_TXAGC_B 13 -+#define BIT_MASK_RESP_TXAGC_B 0x1f -+#define BIT_RESP_TXAGC_B(x) \ -+ (((x) & BIT_MASK_RESP_TXAGC_B) << BIT_SHIFT_RESP_TXAGC_B) -+#define BITS_RESP_TXAGC_B (BIT_MASK_RESP_TXAGC_B << BIT_SHIFT_RESP_TXAGC_B) -+#define BIT_CLEAR_RESP_TXAGC_B(x) ((x) & (~BITS_RESP_TXAGC_B)) -+#define BIT_GET_RESP_TXAGC_B(x) \ -+ (((x) >> BIT_SHIFT_RESP_TXAGC_B) & BIT_MASK_RESP_TXAGC_B) -+#define BIT_SET_RESP_TXAGC_B(x, v) \ -+ (BIT_CLEAR_RESP_TXAGC_B(x) | BIT_RESP_TXAGC_B(v)) -+ -+#define BIT_SHIFT_RESP_TXAGC_A 8 -+#define BIT_MASK_RESP_TXAGC_A 0x1f -+#define BIT_RESP_TXAGC_A(x) \ -+ (((x) & BIT_MASK_RESP_TXAGC_A) << BIT_SHIFT_RESP_TXAGC_A) -+#define BITS_RESP_TXAGC_A (BIT_MASK_RESP_TXAGC_A << BIT_SHIFT_RESP_TXAGC_A) -+#define BIT_CLEAR_RESP_TXAGC_A(x) ((x) & (~BITS_RESP_TXAGC_A)) -+#define BIT_GET_RESP_TXAGC_A(x) \ -+ (((x) >> BIT_SHIFT_RESP_TXAGC_A) & BIT_MASK_RESP_TXAGC_A) -+#define BIT_SET_RESP_TXAGC_A(x, v) \ -+ (BIT_CLEAR_RESP_TXAGC_A(x) | BIT_RESP_TXAGC_A(v)) -+ -+#define BIT_RESP_ANTSEL_B BIT(7) -+#define BIT_RESP_ANTSEL_A BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_RESP_TXINFO (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_WMAC_RESP_TXANT_V1 6 -+#define BIT_MASK_WMAC_RESP_TXANT_V1 0xfff -+#define BIT_WMAC_RESP_TXANT_V1(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXANT_V1) << BIT_SHIFT_WMAC_RESP_TXANT_V1) -+#define BITS_WMAC_RESP_TXANT_V1 \ -+ (BIT_MASK_WMAC_RESP_TXANT_V1 << BIT_SHIFT_WMAC_RESP_TXANT_V1) -+#define BIT_CLEAR_WMAC_RESP_TXANT_V1(x) ((x) & (~BITS_WMAC_RESP_TXANT_V1)) -+#define BIT_GET_WMAC_RESP_TXANT_V1(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXANT_V1) & BIT_MASK_WMAC_RESP_TXANT_V1) -+#define BIT_SET_WMAC_RESP_TXANT_V1(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXANT_V1(x) | BIT_WMAC_RESP_TXANT_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_RESP_TXINFO (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_RESP_TXANT_CCK 4 -+#define BIT_MASK_RESP_TXANT_CCK 0x3 -+#define BIT_RESP_TXANT_CCK(x) \ -+ (((x) & BIT_MASK_RESP_TXANT_CCK) << BIT_SHIFT_RESP_TXANT_CCK) -+#define BITS_RESP_TXANT_CCK \ -+ (BIT_MASK_RESP_TXANT_CCK << BIT_SHIFT_RESP_TXANT_CCK) -+#define BIT_CLEAR_RESP_TXANT_CCK(x) ((x) & (~BITS_RESP_TXANT_CCK)) -+#define BIT_GET_RESP_TXANT_CCK(x) \ -+ (((x) >> BIT_SHIFT_RESP_TXANT_CCK) & BIT_MASK_RESP_TXANT_CCK) -+#define BIT_SET_RESP_TXANT_CCK(x, v) \ -+ (BIT_CLEAR_RESP_TXANT_CCK(x) | BIT_RESP_TXANT_CCK(v)) -+ -+#define BIT_SHIFT_RESP_TXANT_L 2 -+#define BIT_MASK_RESP_TXANT_L 0x3 -+#define BIT_RESP_TXANT_L(x) \ -+ (((x) & BIT_MASK_RESP_TXANT_L) << BIT_SHIFT_RESP_TXANT_L) -+#define BITS_RESP_TXANT_L (BIT_MASK_RESP_TXANT_L << BIT_SHIFT_RESP_TXANT_L) -+#define BIT_CLEAR_RESP_TXANT_L(x) ((x) & (~BITS_RESP_TXANT_L)) -+#define BIT_GET_RESP_TXANT_L(x) \ -+ (((x) >> BIT_SHIFT_RESP_TXANT_L) & BIT_MASK_RESP_TXANT_L) -+#define BIT_SET_RESP_TXANT_L(x, v) \ -+ (BIT_CLEAR_RESP_TXANT_L(x) | BIT_RESP_TXANT_L(v)) -+ -+#define BIT_SHIFT_RESP_TXANT_HT 0 -+#define BIT_MASK_RESP_TXANT_HT 0x3 -+#define BIT_RESP_TXANT_HT(x) \ -+ (((x) & BIT_MASK_RESP_TXANT_HT) << BIT_SHIFT_RESP_TXANT_HT) -+#define BITS_RESP_TXANT_HT (BIT_MASK_RESP_TXANT_HT << BIT_SHIFT_RESP_TXANT_HT) -+#define BIT_CLEAR_RESP_TXANT_HT(x) ((x) & (~BITS_RESP_TXANT_HT)) -+#define BIT_GET_RESP_TXANT_HT(x) \ -+ (((x) >> BIT_SHIFT_RESP_TXANT_HT) & BIT_MASK_RESP_TXANT_HT) -+#define BIT_SET_RESP_TXANT_HT(x, v) \ -+ (BIT_CLEAR_RESP_TXANT_HT(x) | BIT_RESP_TXANT_HT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RESP_TXINFO_CFG (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_RESP_TXANT 0 -+#define BIT_MASK_RESP_TXANT 0x3ffff -+#define BIT_RESP_TXANT(x) (((x) & BIT_MASK_RESP_TXANT) << BIT_SHIFT_RESP_TXANT) -+#define BITS_RESP_TXANT (BIT_MASK_RESP_TXANT << BIT_SHIFT_RESP_TXANT) -+#define BIT_CLEAR_RESP_TXANT(x) ((x) & (~BITS_RESP_TXANT)) -+#define BIT_GET_RESP_TXANT(x) \ -+ (((x) >> BIT_SHIFT_RESP_TXANT) & BIT_MASK_RESP_TXANT) -+#define BIT_SET_RESP_TXANT(x, v) (BIT_CLEAR_RESP_TXANT(x) | BIT_RESP_TXANT(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WMAC_RESP_TXINFO (Offset 0x06D8) */ -+ -+#define BIT_SHIFT_WMAC_RESP_TXANT 0 -+#define BIT_MASK_WMAC_RESP_TXANT 0x3ffff -+#define BIT_WMAC_RESP_TXANT(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXANT) << BIT_SHIFT_WMAC_RESP_TXANT) -+#define BITS_WMAC_RESP_TXANT \ -+ (BIT_MASK_WMAC_RESP_TXANT << BIT_SHIFT_WMAC_RESP_TXANT) -+#define BIT_CLEAR_WMAC_RESP_TXANT(x) ((x) & (~BITS_WMAC_RESP_TXANT)) -+#define BIT_GET_WMAC_RESP_TXANT(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXANT) & BIT_MASK_WMAC_RESP_TXANT) -+#define BIT_SET_WMAC_RESP_TXANT(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXANT(x) | BIT_WMAC_RESP_TXANT(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_CTL_IDLE_CLR_CSI_RPT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_WMAC_USE_NDPARATE BIT(30) -+ -+#define BIT_SHIFT_WMAC_CSI_RATE 24 -+#define BIT_MASK_WMAC_CSI_RATE 0x3f -+#define BIT_WMAC_CSI_RATE(x) \ -+ (((x) & BIT_MASK_WMAC_CSI_RATE) << BIT_SHIFT_WMAC_CSI_RATE) -+#define BITS_WMAC_CSI_RATE (BIT_MASK_WMAC_CSI_RATE << BIT_SHIFT_WMAC_CSI_RATE) -+#define BIT_CLEAR_WMAC_CSI_RATE(x) ((x) & (~BITS_WMAC_CSI_RATE)) -+#define BIT_GET_WMAC_CSI_RATE(x) \ -+ (((x) >> BIT_SHIFT_WMAC_CSI_RATE) & BIT_MASK_WMAC_CSI_RATE) -+#define BIT_SET_WMAC_CSI_RATE(x, v) \ -+ (BIT_CLEAR_WMAC_CSI_RATE(x) | BIT_WMAC_CSI_RATE(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXRATE 16 -+#define BIT_MASK_WMAC_RESP_TXRATE 0xff -+#define BIT_WMAC_RESP_TXRATE(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXRATE) << BIT_SHIFT_WMAC_RESP_TXRATE) -+#define BITS_WMAC_RESP_TXRATE \ -+ (BIT_MASK_WMAC_RESP_TXRATE << BIT_SHIFT_WMAC_RESP_TXRATE) -+#define BIT_CLEAR_WMAC_RESP_TXRATE(x) ((x) & (~BITS_WMAC_RESP_TXRATE)) -+#define BIT_GET_WMAC_RESP_TXRATE(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXRATE) & BIT_MASK_WMAC_RESP_TXRATE) -+#define BIT_SET_WMAC_RESP_TXRATE(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXRATE(x) | BIT_WMAC_RESP_TXRATE(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_WMAC_CSI_RATE_FORCE_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_CSI_FORCE_RATE_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_SHIFT_WMAC_CSI_RSC_FORCE 13 -+#define BIT_MASK_WMAC_CSI_RSC_FORCE 0x3 -+#define BIT_WMAC_CSI_RSC_FORCE(x) \ -+ (((x) & BIT_MASK_WMAC_CSI_RSC_FORCE) << BIT_SHIFT_WMAC_CSI_RSC_FORCE) -+#define BITS_WMAC_CSI_RSC_FORCE \ -+ (BIT_MASK_WMAC_CSI_RSC_FORCE << BIT_SHIFT_WMAC_CSI_RSC_FORCE) -+#define BIT_CLEAR_WMAC_CSI_RSC_FORCE(x) ((x) & (~BITS_WMAC_CSI_RSC_FORCE)) -+#define BIT_GET_WMAC_CSI_RSC_FORCE(x) \ -+ (((x) >> BIT_SHIFT_WMAC_CSI_RSC_FORCE) & BIT_MASK_WMAC_CSI_RSC_FORCE) -+#define BIT_SET_WMAC_CSI_RSC_FORCE(x, v) \ -+ (BIT_CLEAR_WMAC_CSI_RSC_FORCE(x) | BIT_WMAC_CSI_RSC_FORCE(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_SHIFT_CSI_RSC 13 -+#define BIT_MASK_CSI_RSC 0x3 -+#define BIT_CSI_RSC(x) (((x) & BIT_MASK_CSI_RSC) << BIT_SHIFT_CSI_RSC) -+#define BITS_CSI_RSC (BIT_MASK_CSI_RSC << BIT_SHIFT_CSI_RSC) -+#define BIT_CLEAR_CSI_RSC(x) ((x) & (~BITS_CSI_RSC)) -+#define BIT_GET_CSI_RSC(x) (((x) >> BIT_SHIFT_CSI_RSC) & BIT_MASK_CSI_RSC) -+#define BIT_SET_CSI_RSC(x, v) (BIT_CLEAR_CSI_RSC(x) | BIT_CSI_RSC(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_WMAC_CSI_GID_SEL BIT(12) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_CSI_GID_SEL BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_RDCSIMD_FLAG_TRIG_SEL BIT(11) -+#define BIT_NDPVLD_POS_RST_FFPTR_DIS_V1 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_NDPVLD_PROTECT_RDRDY_DIS BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_CSIRD_EMPTY_APPZERO BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_RDCSI_EMPTY_APPZERO BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_WMC_CSI_RATE_FB_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_CSI_RATE_FB_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_RXFIFO_WRPTR_WO_CHKSUM BIT(6) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_BBPSF_MPDUCHKEN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BBPSF_CTRL (Offset 0x06DC) */ -+ -+#define BIT_BBPSF_MHCHKEN BIT(4) -+#define BIT_BBPSF_ERRCHKEN BIT(3) -+ -+#define BIT_SHIFT_BBPSF_ERRTHR 0 -+#define BIT_MASK_BBPSF_ERRTHR 0x7 -+#define BIT_BBPSF_ERRTHR(x) \ -+ (((x) & BIT_MASK_BBPSF_ERRTHR) << BIT_SHIFT_BBPSF_ERRTHR) -+#define BITS_BBPSF_ERRTHR (BIT_MASK_BBPSF_ERRTHR << BIT_SHIFT_BBPSF_ERRTHR) -+#define BIT_CLEAR_BBPSF_ERRTHR(x) ((x) & (~BITS_BBPSF_ERRTHR)) -+#define BIT_GET_BBPSF_ERRTHR(x) \ -+ (((x) >> BIT_SHIFT_BBPSF_ERRTHR) & BIT_MASK_BBPSF_ERRTHR) -+#define BIT_SET_BBPSF_ERRTHR(x, v) \ -+ (BIT_CLEAR_BBPSF_ERRTHR(x) | BIT_BBPSF_ERRTHR(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RESP_TXINFO_RATE (Offset 0x06DE) */ -+ -+#define BIT_CTL_IDLE_CLR_CSI_RPT_V1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_RESP_TXINFO_RATE (Offset 0x06DE) */ -+ -+#define BIT_USE_NDPARATE BIT(14) -+ -+#define BIT_SHIFT_CSI_RATE 8 -+#define BIT_MASK_CSI_RATE 0x3f -+#define BIT_CSI_RATE(x) (((x) & BIT_MASK_CSI_RATE) << BIT_SHIFT_CSI_RATE) -+#define BITS_CSI_RATE (BIT_MASK_CSI_RATE << BIT_SHIFT_CSI_RATE) -+#define BIT_CLEAR_CSI_RATE(x) ((x) & (~BITS_CSI_RATE)) -+#define BIT_GET_CSI_RATE(x) (((x) >> BIT_SHIFT_CSI_RATE) & BIT_MASK_CSI_RATE) -+#define BIT_SET_CSI_RATE(x, v) (BIT_CLEAR_CSI_RATE(x) | BIT_CSI_RATE(v)) -+ -+#define BIT_SHIFT_RESP_TXRATE 0 -+#define BIT_MASK_RESP_TXRATE 0xff -+#define BIT_RESP_TXRATE(x) \ -+ (((x) & BIT_MASK_RESP_TXRATE) << BIT_SHIFT_RESP_TXRATE) -+#define BITS_RESP_TXRATE (BIT_MASK_RESP_TXRATE << BIT_SHIFT_RESP_TXRATE) -+#define BIT_CLEAR_RESP_TXRATE(x) ((x) & (~BITS_RESP_TXRATE)) -+#define BIT_GET_RESP_TXRATE(x) \ -+ (((x) >> BIT_SHIFT_RESP_TXRATE) & BIT_MASK_RESP_TXRATE) -+#define BIT_SET_RESP_TXRATE(x, v) \ -+ (BIT_CLEAR_RESP_TXRATE(x) | BIT_RESP_TXRATE(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_P2P_RX_BCN_NOA (Offset 0x06E0) */ -+ -+#define BIT_NOA_PARSER_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_P2P_RX_BCN_NOA (Offset 0x06E0) */ -+ -+#define BIT_BSSID_SEL BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2P_RX_BCN_NOA (Offset 0x06E0) */ -+ -+#define BIT_SHIFT_BSSID_SEL_V1 12 -+#define BIT_MASK_BSSID_SEL_V1 0x7 -+#define BIT_BSSID_SEL_V1(x) \ -+ (((x) & BIT_MASK_BSSID_SEL_V1) << BIT_SHIFT_BSSID_SEL_V1) -+#define BITS_BSSID_SEL_V1 (BIT_MASK_BSSID_SEL_V1 << BIT_SHIFT_BSSID_SEL_V1) -+#define BIT_CLEAR_BSSID_SEL_V1(x) ((x) & (~BITS_BSSID_SEL_V1)) -+#define BIT_GET_BSSID_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_BSSID_SEL_V1) & BIT_MASK_BSSID_SEL_V1) -+#define BIT_SET_BSSID_SEL_V1(x, v) \ -+ (BIT_CLEAR_BSSID_SEL_V1(x) | BIT_BSSID_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_P2P_RX_BCN_NOA (Offset 0x06E0) */ -+ -+#define BIT_SHIFT_P2P_OUI_TYPE 0 -+#define BIT_MASK_P2P_OUI_TYPE 0xff -+#define BIT_P2P_OUI_TYPE(x) \ -+ (((x) & BIT_MASK_P2P_OUI_TYPE) << BIT_SHIFT_P2P_OUI_TYPE) -+#define BITS_P2P_OUI_TYPE (BIT_MASK_P2P_OUI_TYPE << BIT_SHIFT_P2P_OUI_TYPE) -+#define BIT_CLEAR_P2P_OUI_TYPE(x) ((x) & (~BITS_P2P_OUI_TYPE)) -+#define BIT_GET_P2P_OUI_TYPE(x) \ -+ (((x) >> BIT_SHIFT_P2P_OUI_TYPE) & BIT_MASK_P2P_OUI_TYPE) -+#define BIT_SET_P2P_OUI_TYPE(x, v) \ -+ (BIT_CLEAR_P2P_OUI_TYPE(x) | BIT_P2P_OUI_TYPE(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_P2P_RX_BCN_NOA (Offset 0x06E0) */ -+ -+#define BIT_SHIFT_INFO_TXRPT_OFFSET_V1 0 -+#define BIT_MASK_INFO_TXRPT_OFFSET_V1 0x1fff -+#define BIT_INFO_TXRPT_OFFSET_V1(x) \ -+ (((x) & BIT_MASK_INFO_TXRPT_OFFSET_V1) \ -+ << BIT_SHIFT_INFO_TXRPT_OFFSET_V1) -+#define BITS_INFO_TXRPT_OFFSET_V1 \ -+ (BIT_MASK_INFO_TXRPT_OFFSET_V1 << BIT_SHIFT_INFO_TXRPT_OFFSET_V1) -+#define BIT_CLEAR_INFO_TXRPT_OFFSET_V1(x) ((x) & (~BITS_INFO_TXRPT_OFFSET_V1)) -+#define BIT_GET_INFO_TXRPT_OFFSET_V1(x) \ -+ (((x) >> BIT_SHIFT_INFO_TXRPT_OFFSET_V1) & \ -+ BIT_MASK_INFO_TXRPT_OFFSET_V1) -+#define BIT_SET_INFO_TXRPT_OFFSET_V1(x, v) \ -+ (BIT_CLEAR_INFO_TXRPT_OFFSET_V1(x) | BIT_INFO_TXRPT_OFFSET_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO (Offset 0x06E4) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0 0xffffffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R0(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0 \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0 \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO (Offset 0x06E4) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_V1(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_V1 \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1 \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_V1(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_V1)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_V1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_V1(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_V1(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SOUNDING_CFG1 (Offset 0x06E8) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_H(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_H \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_H)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_H(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_H(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_H(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_H (Offset 0x06E8) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_H_V1(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_H_V1 \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1 \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H_V1(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_H_V1)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_H_V1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_H_V1(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H_V1(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO (Offset 0x06EC) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1 0xffffffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R1(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1 \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1 \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SOUNDING_CFG2 (Offset 0x06EC) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V2 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V2 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_V2(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V2) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V2) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_V2 \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V2 \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V2) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V2(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_V2)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_V2(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V2) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V2) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_V2(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V2(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO (Offset 0x06EC) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_V1(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_V1 \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1 \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V1(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_V1)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_V1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_V1(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V1(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SOUNDING_CFG3 (Offset 0x06F0) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V2 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V2 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_H_V2(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V2) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V2) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_H_V2 \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V2 \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V2) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V2(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_H_V2)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_H_V2(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V2) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V2) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_H_V2(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V2(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_H_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_H (Offset 0x06F0) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_H_V1(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_H_V1 \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1 \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V1(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_H_V1)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_H_V1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_H_V1(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V1(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW40 (Offset 0x06F8) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_40M_1 13 -+#define BIT_MASK_R_WMAC_BFINFO_40M_1 0x7fff -+#define BIT_R_WMAC_BFINFO_40M_1(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_40M_1) << BIT_SHIFT_R_WMAC_BFINFO_40M_1) -+#define BITS_R_WMAC_BFINFO_40M_1 \ -+ (BIT_MASK_R_WMAC_BFINFO_40M_1 << BIT_SHIFT_R_WMAC_BFINFO_40M_1) -+#define BIT_CLEAR_R_WMAC_BFINFO_40M_1(x) ((x) & (~BITS_R_WMAC_BFINFO_40M_1)) -+#define BIT_GET_R_WMAC_BFINFO_40M_1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_40M_1) & BIT_MASK_R_WMAC_BFINFO_40M_1) -+#define BIT_SET_R_WMAC_BFINFO_40M_1(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_40M_1(x) | BIT_R_WMAC_BFINFO_40M_1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_ANTCD_INFO (Offset 0x06F8) */ -+ -+#define BIT_RESP_SMOOTH BIT(8) -+ -+#define BIT_SHIFT_POWER_STAGE2_NORETRY 6 -+#define BIT_MASK_POWER_STAGE2_NORETRY 0x3 -+#define BIT_POWER_STAGE2_NORETRY(x) \ -+ (((x) & BIT_MASK_POWER_STAGE2_NORETRY) \ -+ << BIT_SHIFT_POWER_STAGE2_NORETRY) -+#define BITS_POWER_STAGE2_NORETRY \ -+ (BIT_MASK_POWER_STAGE2_NORETRY << BIT_SHIFT_POWER_STAGE2_NORETRY) -+#define BIT_CLEAR_POWER_STAGE2_NORETRY(x) ((x) & (~BITS_POWER_STAGE2_NORETRY)) -+#define BIT_GET_POWER_STAGE2_NORETRY(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE2_NORETRY) & \ -+ BIT_MASK_POWER_STAGE2_NORETRY) -+#define BIT_SET_POWER_STAGE2_NORETRY(x, v) \ -+ (BIT_CLEAR_POWER_STAGE2_NORETRY(x) | BIT_POWER_STAGE2_NORETRY(v)) -+ -+#define BIT_SHIFT_POWER_STAGE1_NORETRY 4 -+#define BIT_MASK_POWER_STAGE1_NORETRY 0x3 -+#define BIT_POWER_STAGE1_NORETRY(x) \ -+ (((x) & BIT_MASK_POWER_STAGE1_NORETRY) \ -+ << BIT_SHIFT_POWER_STAGE1_NORETRY) -+#define BITS_POWER_STAGE1_NORETRY \ -+ (BIT_MASK_POWER_STAGE1_NORETRY << BIT_SHIFT_POWER_STAGE1_NORETRY) -+#define BIT_CLEAR_POWER_STAGE1_NORETRY(x) ((x) & (~BITS_POWER_STAGE1_NORETRY)) -+#define BIT_GET_POWER_STAGE1_NORETRY(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE1_NORETRY) & \ -+ BIT_MASK_POWER_STAGE1_NORETRY) -+#define BIT_SET_POWER_STAGE1_NORETRY(x, v) \ -+ (BIT_CLEAR_POWER_STAGE1_NORETRY(x) | BIT_POWER_STAGE1_NORETRY(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW40 (Offset 0x06F8) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_40M_0 0 -+#define BIT_MASK_R_WMAC_BFINFO_40M_0 0xfff -+#define BIT_R_WMAC_BFINFO_40M_0(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_40M_0) << BIT_SHIFT_R_WMAC_BFINFO_40M_0) -+#define BITS_R_WMAC_BFINFO_40M_0 \ -+ (BIT_MASK_R_WMAC_BFINFO_40M_0 << BIT_SHIFT_R_WMAC_BFINFO_40M_0) -+#define BIT_CLEAR_R_WMAC_BFINFO_40M_0(x) ((x) & (~BITS_R_WMAC_BFINFO_40M_0)) -+#define BIT_GET_R_WMAC_BFINFO_40M_0(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_40M_0) & BIT_MASK_R_WMAC_BFINFO_40M_0) -+#define BIT_SET_R_WMAC_BFINFO_40M_0(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_40M_0(x) | BIT_R_WMAC_BFINFO_40M_0(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_ANTCD_INFO (Offset 0x06F8) */ -+ -+#define BIT_SHIFT_RESP_ANTCD 0 -+#define BIT_MASK_RESP_ANTCD 0xf -+#define BIT_RESP_ANTCD(x) (((x) & BIT_MASK_RESP_ANTCD) << BIT_SHIFT_RESP_ANTCD) -+#define BITS_RESP_ANTCD (BIT_MASK_RESP_ANTCD << BIT_SHIFT_RESP_ANTCD) -+#define BIT_CLEAR_RESP_ANTCD(x) ((x) & (~BITS_RESP_ANTCD)) -+#define BIT_GET_RESP_ANTCD(x) \ -+ (((x) >> BIT_SHIFT_RESP_ANTCD) & BIT_MASK_RESP_ANTCD) -+#define BIT_SET_RESP_ANTCD(x, v) (BIT_CLEAR_RESP_ANTCD(x) | BIT_RESP_ANTCD(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW40 (Offset 0x06F8) */ -+ -+#define BIT_SHIFT_WMAC_RESP_ANTCD 0 -+#define BIT_MASK_WMAC_RESP_ANTCD 0xf -+#define BIT_WMAC_RESP_ANTCD(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTCD) << BIT_SHIFT_WMAC_RESP_ANTCD) -+#define BITS_WMAC_RESP_ANTCD \ -+ (BIT_MASK_WMAC_RESP_ANTCD << BIT_SHIFT_WMAC_RESP_ANTCD) -+#define BIT_CLEAR_WMAC_RESP_ANTCD(x) ((x) & (~BITS_WMAC_RESP_ANTCD)) -+#define BIT_GET_WMAC_RESP_ANTCD(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTCD) & BIT_MASK_WMAC_RESP_ANTCD) -+#define BIT_SET_WMAC_RESP_ANTCD(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTCD(x) | BIT_WMAC_RESP_ANTCD(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CSI_RRSR_V1 (Offset 0x06FC) */ -+ -+#define BIT_WMAC_CSI_LDPC_EN BIT(29) -+#define BIT_WMAC_CSI_STBC_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW80 (Offset 0x06FC) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_80M_1 16 -+#define BIT_MASK_R_WMAC_BFINFO_80M_1 0xfff -+#define BIT_R_WMAC_BFINFO_80M_1(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_80M_1) << BIT_SHIFT_R_WMAC_BFINFO_80M_1) -+#define BITS_R_WMAC_BFINFO_80M_1 \ -+ (BIT_MASK_R_WMAC_BFINFO_80M_1 << BIT_SHIFT_R_WMAC_BFINFO_80M_1) -+#define BIT_CLEAR_R_WMAC_BFINFO_80M_1(x) ((x) & (~BITS_R_WMAC_BFINFO_80M_1)) -+#define BIT_GET_R_WMAC_BFINFO_80M_1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_80M_1) & BIT_MASK_R_WMAC_BFINFO_80M_1) -+#define BIT_SET_R_WMAC_BFINFO_80M_1(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_80M_1(x) | BIT_R_WMAC_BFINFO_80M_1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CSI_PTR (Offset 0x06FC) */ -+ -+#define BIT_SHIFT_CSI_RADDR_LATCH_V2 16 -+#define BIT_MASK_CSI_RADDR_LATCH_V2 0xffff -+#define BIT_CSI_RADDR_LATCH_V2(x) \ -+ (((x) & BIT_MASK_CSI_RADDR_LATCH_V2) << BIT_SHIFT_CSI_RADDR_LATCH_V2) -+#define BITS_CSI_RADDR_LATCH_V2 \ -+ (BIT_MASK_CSI_RADDR_LATCH_V2 << BIT_SHIFT_CSI_RADDR_LATCH_V2) -+#define BIT_CLEAR_CSI_RADDR_LATCH_V2(x) ((x) & (~BITS_CSI_RADDR_LATCH_V2)) -+#define BIT_GET_CSI_RADDR_LATCH_V2(x) \ -+ (((x) >> BIT_SHIFT_CSI_RADDR_LATCH_V2) & BIT_MASK_CSI_RADDR_LATCH_V2) -+#define BIT_SET_CSI_RADDR_LATCH_V2(x, v) \ -+ (BIT_CLEAR_CSI_RADDR_LATCH_V2(x) | BIT_CSI_RADDR_LATCH_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CSI_RRSR_V1 (Offset 0x06FC) */ -+ -+#define BIT_SHIFT_WMAC_CSI_RRSC_BITMAP 4 -+#define BIT_MASK_WMAC_CSI_RRSC_BITMAP 0xffffff -+#define BIT_WMAC_CSI_RRSC_BITMAP(x) \ -+ (((x) & BIT_MASK_WMAC_CSI_RRSC_BITMAP) \ -+ << BIT_SHIFT_WMAC_CSI_RRSC_BITMAP) -+#define BITS_WMAC_CSI_RRSC_BITMAP \ -+ (BIT_MASK_WMAC_CSI_RRSC_BITMAP << BIT_SHIFT_WMAC_CSI_RRSC_BITMAP) -+#define BIT_CLEAR_WMAC_CSI_RRSC_BITMAP(x) ((x) & (~BITS_WMAC_CSI_RRSC_BITMAP)) -+#define BIT_GET_WMAC_CSI_RRSC_BITMAP(x) \ -+ (((x) >> BIT_SHIFT_WMAC_CSI_RRSC_BITMAP) & \ -+ BIT_MASK_WMAC_CSI_RRSC_BITMAP) -+#define BIT_SET_WMAC_CSI_RRSC_BITMAP(x, v) \ -+ (BIT_CLEAR_WMAC_CSI_RRSC_BITMAP(x) | BIT_WMAC_CSI_RRSC_BITMAP(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW80 (Offset 0x06FC) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_80M_0 0 -+#define BIT_MASK_R_WMAC_BFINFO_80M_0 0xfff -+#define BIT_R_WMAC_BFINFO_80M_0(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_80M_0) << BIT_SHIFT_R_WMAC_BFINFO_80M_0) -+#define BITS_R_WMAC_BFINFO_80M_0 \ -+ (BIT_MASK_R_WMAC_BFINFO_80M_0 << BIT_SHIFT_R_WMAC_BFINFO_80M_0) -+#define BIT_CLEAR_R_WMAC_BFINFO_80M_0(x) ((x) & (~BITS_R_WMAC_BFINFO_80M_0)) -+#define BIT_GET_R_WMAC_BFINFO_80M_0(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_80M_0) & BIT_MASK_R_WMAC_BFINFO_80M_0) -+#define BIT_SET_R_WMAC_BFINFO_80M_0(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_80M_0(x) | BIT_R_WMAC_BFINFO_80M_0(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CSI_PTR (Offset 0x06FC) */ -+ -+#define BIT_SHIFT_CSI_WADDR_LATCH_V2 0 -+#define BIT_MASK_CSI_WADDR_LATCH_V2 0xffff -+#define BIT_CSI_WADDR_LATCH_V2(x) \ -+ (((x) & BIT_MASK_CSI_WADDR_LATCH_V2) << BIT_SHIFT_CSI_WADDR_LATCH_V2) -+#define BITS_CSI_WADDR_LATCH_V2 \ -+ (BIT_MASK_CSI_WADDR_LATCH_V2 << BIT_SHIFT_CSI_WADDR_LATCH_V2) -+#define BIT_CLEAR_CSI_WADDR_LATCH_V2(x) ((x) & (~BITS_CSI_WADDR_LATCH_V2)) -+#define BIT_GET_CSI_WADDR_LATCH_V2(x) \ -+ (((x) >> BIT_SHIFT_CSI_WADDR_LATCH_V2) & BIT_MASK_CSI_WADDR_LATCH_V2) -+#define BIT_SET_CSI_WADDR_LATCH_V2(x, v) \ -+ (BIT_CLEAR_CSI_WADDR_LATCH_V2(x) | BIT_CSI_WADDR_LATCH_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CSI_RRSR_V1 (Offset 0x06FC) */ -+ -+#define BIT_SHIFT_WMAC_CSI_OFDM_LEN_TH 0 -+#define BIT_MASK_WMAC_CSI_OFDM_LEN_TH 0xf -+#define BIT_WMAC_CSI_OFDM_LEN_TH(x) \ -+ (((x) & BIT_MASK_WMAC_CSI_OFDM_LEN_TH) \ -+ << BIT_SHIFT_WMAC_CSI_OFDM_LEN_TH) -+#define BITS_WMAC_CSI_OFDM_LEN_TH \ -+ (BIT_MASK_WMAC_CSI_OFDM_LEN_TH << BIT_SHIFT_WMAC_CSI_OFDM_LEN_TH) -+#define BIT_CLEAR_WMAC_CSI_OFDM_LEN_TH(x) ((x) & (~BITS_WMAC_CSI_OFDM_LEN_TH)) -+#define BIT_GET_WMAC_CSI_OFDM_LEN_TH(x) \ -+ (((x) >> BIT_SHIFT_WMAC_CSI_OFDM_LEN_TH) & \ -+ BIT_MASK_WMAC_CSI_OFDM_LEN_TH) -+#define BIT_SET_WMAC_CSI_OFDM_LEN_TH(x, v) \ -+ (BIT_CLEAR_WMAC_CSI_OFDM_LEN_TH(x) | BIT_WMAC_CSI_OFDM_LEN_TH(v)) -+ -+#define BIT_SHIFT_CSI_PARA_RDY_DLYCNT 0 -+#define BIT_MASK_CSI_PARA_RDY_DLYCNT 0x1f -+#define BIT_CSI_PARA_RDY_DLYCNT(x) \ -+ (((x) & BIT_MASK_CSI_PARA_RDY_DLYCNT) << BIT_SHIFT_CSI_PARA_RDY_DLYCNT) -+#define BITS_CSI_PARA_RDY_DLYCNT \ -+ (BIT_MASK_CSI_PARA_RDY_DLYCNT << BIT_SHIFT_CSI_PARA_RDY_DLYCNT) -+#define BIT_CLEAR_CSI_PARA_RDY_DLYCNT(x) ((x) & (~BITS_CSI_PARA_RDY_DLYCNT)) -+#define BIT_GET_CSI_PARA_RDY_DLYCNT(x) \ -+ (((x) >> BIT_SHIFT_CSI_PARA_RDY_DLYCNT) & BIT_MASK_CSI_PARA_RDY_DLYCNT) -+#define BIT_SET_CSI_PARA_RDY_DLYCNT(x, v) \ -+ (BIT_CLEAR_CSI_PARA_RDY_DLYCNT(x) | BIT_CSI_PARA_RDY_DLYCNT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_MACID1 (Offset 0x0700) */ -+ -+#define BIT_SHIFT_MACID1 0 -+#define BIT_MASK_MACID1 0xffffffffffffL -+#define BIT_MACID1(x) (((x) & BIT_MASK_MACID1) << BIT_SHIFT_MACID1) -+#define BITS_MACID1 (BIT_MASK_MACID1 << BIT_SHIFT_MACID1) -+#define BIT_CLEAR_MACID1(x) ((x) & (~BITS_MACID1)) -+#define BIT_GET_MACID1(x) (((x) >> BIT_SHIFT_MACID1) & BIT_MASK_MACID1) -+#define BIT_SET_MACID1(x, v) (BIT_CLEAR_MACID1(x) | BIT_MACID1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID1 (Offset 0x0700) */ -+ -+#define BIT_SHIFT_MACID1_0 0 -+#define BIT_MASK_MACID1_0 0xffffffffL -+#define BIT_MACID1_0(x) (((x) & BIT_MASK_MACID1_0) << BIT_SHIFT_MACID1_0) -+#define BITS_MACID1_0 (BIT_MASK_MACID1_0 << BIT_SHIFT_MACID1_0) -+#define BIT_CLEAR_MACID1_0(x) ((x) & (~BITS_MACID1_0)) -+#define BIT_GET_MACID1_0(x) (((x) >> BIT_SHIFT_MACID1_0) & BIT_MASK_MACID1_0) -+#define BIT_SET_MACID1_0(x, v) (BIT_CLEAR_MACID1_0(x) | BIT_MACID1_0(v)) -+ -+/* 2 REG_MACID1_1 (Offset 0x0704) */ -+ -+#define BIT_SHIFT_MACID1_1 0 -+#define BIT_MASK_MACID1_1 0xffff -+#define BIT_MACID1_1(x) (((x) & BIT_MASK_MACID1_1) << BIT_SHIFT_MACID1_1) -+#define BITS_MACID1_1 (BIT_MASK_MACID1_1 << BIT_SHIFT_MACID1_1) -+#define BIT_CLEAR_MACID1_1(x) ((x) & (~BITS_MACID1_1)) -+#define BIT_GET_MACID1_1(x) (((x) >> BIT_SHIFT_MACID1_1) & BIT_MASK_MACID1_1) -+#define BIT_SET_MACID1_1(x, v) (BIT_CLEAR_MACID1_1(x) | BIT_MACID1_1(v)) -+ -+/* 2 REG_BSSID1 (Offset 0x0708) */ -+ -+#define BIT_SHIFT_BSSID1_0 0 -+#define BIT_MASK_BSSID1_0 0xffffffffL -+#define BIT_BSSID1_0(x) (((x) & BIT_MASK_BSSID1_0) << BIT_SHIFT_BSSID1_0) -+#define BITS_BSSID1_0 (BIT_MASK_BSSID1_0 << BIT_SHIFT_BSSID1_0) -+#define BIT_CLEAR_BSSID1_0(x) ((x) & (~BITS_BSSID1_0)) -+#define BIT_GET_BSSID1_0(x) (((x) >> BIT_SHIFT_BSSID1_0) & BIT_MASK_BSSID1_0) -+#define BIT_SET_BSSID1_0(x, v) (BIT_CLEAR_BSSID1_0(x) | BIT_BSSID1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BSSID1 (Offset 0x0708) */ -+ -+#define BIT_SHIFT_BSSID1 0 -+#define BIT_MASK_BSSID1 0xffffffffffffL -+#define BIT_BSSID1(x) (((x) & BIT_MASK_BSSID1) << BIT_SHIFT_BSSID1) -+#define BITS_BSSID1 (BIT_MASK_BSSID1 << BIT_SHIFT_BSSID1) -+#define BIT_CLEAR_BSSID1(x) ((x) & (~BITS_BSSID1)) -+#define BIT_GET_BSSID1(x) (((x) >> BIT_SHIFT_BSSID1) & BIT_MASK_BSSID1) -+#define BIT_SET_BSSID1(x, v) (BIT_CLEAR_BSSID1(x) | BIT_BSSID1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_CFG_FORCE_LINK_L (Offset 0x0709) */ -+ -+#define BIT_PCIE_CFG_FORCE_EN BIT(7) -+ -+/* 2 REG_PCIE_CFG_FORCE_LINK_H (Offset 0x070A) */ -+ -+#define BIT_PCIE_CFG_TRXACT_DIS_IDLE_TIMER BIT(6) -+ -+#define BIT_SHIFT_PCIE_CFG_LINK_STATE 0 -+#define BIT_MASK_PCIE_CFG_LINK_STATE 0x3f -+#define BIT_PCIE_CFG_LINK_STATE(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_LINK_STATE) << BIT_SHIFT_PCIE_CFG_LINK_STATE) -+#define BITS_PCIE_CFG_LINK_STATE \ -+ (BIT_MASK_PCIE_CFG_LINK_STATE << BIT_SHIFT_PCIE_CFG_LINK_STATE) -+#define BIT_CLEAR_PCIE_CFG_LINK_STATE(x) ((x) & (~BITS_PCIE_CFG_LINK_STATE)) -+#define BIT_GET_PCIE_CFG_LINK_STATE(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_LINK_STATE) & BIT_MASK_PCIE_CFG_LINK_STATE) -+#define BIT_SET_PCIE_CFG_LINK_STATE(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_LINK_STATE(x) | BIT_PCIE_CFG_LINK_STATE(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BSSID1_1 (Offset 0x070C) */ -+ -+#define BIT_SHIFT_BSSID1_1 0 -+#define BIT_MASK_BSSID1_1 0xffff -+#define BIT_BSSID1_1(x) (((x) & BIT_MASK_BSSID1_1) << BIT_SHIFT_BSSID1_1) -+#define BITS_BSSID1_1 (BIT_MASK_BSSID1_1 << BIT_SHIFT_BSSID1_1) -+#define BIT_CLEAR_BSSID1_1(x) ((x) & (~BITS_BSSID1_1)) -+#define BIT_GET_BSSID1_1(x) (((x) >> BIT_SHIFT_BSSID1_1) & BIT_MASK_BSSID1_1) -+#define BIT_SET_BSSID1_1(x, v) (BIT_CLEAR_BSSID1_1(x) | BIT_BSSID1_1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_CFG_DEFAULT_ACK_FREQUENCY (Offset 0x070C) */ -+ -+#define BIT_SHIFT_PCIE_CFG_DEFAULT_ACK_FREQUENCY 0 -+#define BIT_MASK_PCIE_CFG_DEFAULT_ACK_FREQUENCY 0xff -+#define BIT_PCIE_CFG_DEFAULT_ACK_FREQUENCY(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_DEFAULT_ACK_FREQUENCY) \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_ACK_FREQUENCY) -+#define BITS_PCIE_CFG_DEFAULT_ACK_FREQUENCY \ -+ (BIT_MASK_PCIE_CFG_DEFAULT_ACK_FREQUENCY \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_ACK_FREQUENCY) -+#define BIT_CLEAR_PCIE_CFG_DEFAULT_ACK_FREQUENCY(x) \ -+ ((x) & (~BITS_PCIE_CFG_DEFAULT_ACK_FREQUENCY)) -+#define BIT_GET_PCIE_CFG_DEFAULT_ACK_FREQUENCY(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_DEFAULT_ACK_FREQUENCY) & \ -+ BIT_MASK_PCIE_CFG_DEFAULT_ACK_FREQUENCY) -+#define BIT_SET_PCIE_CFG_DEFAULT_ACK_FREQUENCY(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_DEFAULT_ACK_FREQUENCY(x) | \ -+ BIT_PCIE_CFG_DEFAULT_ACK_FREQUENCY(v)) -+ -+/* 2 REG_PCIE_CFG_CX_NFTS (Offset 0x070D) */ -+ -+#define BIT_SHIFT_PCIE_CFG_CX_NFTS 0 -+#define BIT_MASK_PCIE_CFG_CX_NFTS 0xff -+#define BIT_PCIE_CFG_CX_NFTS(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_CX_NFTS) << BIT_SHIFT_PCIE_CFG_CX_NFTS) -+#define BITS_PCIE_CFG_CX_NFTS \ -+ (BIT_MASK_PCIE_CFG_CX_NFTS << BIT_SHIFT_PCIE_CFG_CX_NFTS) -+#define BIT_CLEAR_PCIE_CFG_CX_NFTS(x) ((x) & (~BITS_PCIE_CFG_CX_NFTS)) -+#define BIT_GET_PCIE_CFG_CX_NFTS(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_CX_NFTS) & BIT_MASK_PCIE_CFG_CX_NFTS) -+#define BIT_SET_PCIE_CFG_CX_NFTS(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_CX_NFTS(x) | BIT_PCIE_CFG_CX_NFTS(v)) -+ -+/* 2 REG_PCIE_CFG_DEFAULT_ENTR_LATENCY (Offset 0x070F) */ -+ -+#define BIT_PCIE_CFG_REAL_EN_L0S BIT(7) -+#define BIT_PCIE_CFG_ENTER_ASPM BIT(6) -+ -+#define BIT_SHIFT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY 3 -+#define BIT_MASK_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY 0x7 -+#define BIT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY) \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY) -+#define BITS_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY \ -+ (BIT_MASK_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY) -+#define BIT_CLEAR_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY(x) \ -+ ((x) & (~BITS_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY)) -+#define BIT_GET_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY) & \ -+ BIT_MASK_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY) -+#define BIT_SET_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY(x) | \ -+ BIT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY(v)) -+ -+#define BIT_SHIFT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY 0 -+#define BIT_MASK_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY 0x7 -+#define BIT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY) \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY) -+#define BITS_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY \ -+ (BIT_MASK_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY) -+#define BIT_CLEAR_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY(x) \ -+ ((x) & (~BITS_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY)) -+#define BIT_GET_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY) & \ -+ BIT_MASK_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY) -+#define BIT_SET_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY(x) | \ -+ BIT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_PSR_RPT1 (Offset 0x0710) */ -+ -+#define BIT_SHIFT_DTIM_CNT1 24 -+#define BIT_MASK_DTIM_CNT1 0xff -+#define BIT_DTIM_CNT1(x) (((x) & BIT_MASK_DTIM_CNT1) << BIT_SHIFT_DTIM_CNT1) -+#define BITS_DTIM_CNT1 (BIT_MASK_DTIM_CNT1 << BIT_SHIFT_DTIM_CNT1) -+#define BIT_CLEAR_DTIM_CNT1(x) ((x) & (~BITS_DTIM_CNT1)) -+#define BIT_GET_DTIM_CNT1(x) (((x) >> BIT_SHIFT_DTIM_CNT1) & BIT_MASK_DTIM_CNT1) -+#define BIT_SET_DTIM_CNT1(x, v) (BIT_CLEAR_DTIM_CNT1(x) | BIT_DTIM_CNT1(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD1 16 -+#define BIT_MASK_DTIM_PERIOD1 0xff -+#define BIT_DTIM_PERIOD1(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD1) << BIT_SHIFT_DTIM_PERIOD1) -+#define BITS_DTIM_PERIOD1 (BIT_MASK_DTIM_PERIOD1 << BIT_SHIFT_DTIM_PERIOD1) -+#define BIT_CLEAR_DTIM_PERIOD1(x) ((x) & (~BITS_DTIM_PERIOD1)) -+#define BIT_GET_DTIM_PERIOD1(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD1) & BIT_MASK_DTIM_PERIOD1) -+#define BIT_SET_DTIM_PERIOD1(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD1(x) | BIT_DTIM_PERIOD1(v)) -+ -+#define BIT_DTIM1 BIT(15) -+#define BIT_TIM1 BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_PSR_RPT1 (Offset 0x0710) */ -+ -+#define BIT_BCN_VALID_V2 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_PSR_RPT1 (Offset 0x0710) */ -+ -+#define BIT_SHIFT_PS_AID_1 0 -+#define BIT_MASK_PS_AID_1 0x7ff -+#define BIT_PS_AID_1(x) (((x) & BIT_MASK_PS_AID_1) << BIT_SHIFT_PS_AID_1) -+#define BITS_PS_AID_1 (BIT_MASK_PS_AID_1 << BIT_SHIFT_PS_AID_1) -+#define BIT_CLEAR_PS_AID_1(x) ((x) & (~BITS_PS_AID_1)) -+#define BIT_GET_PS_AID_1(x) (((x) >> BIT_SHIFT_PS_AID_1) & BIT_MASK_PS_AID_1) -+#define BIT_SET_PS_AID_1(x, v) (BIT_CLEAR_PS_AID_1(x) | BIT_PS_AID_1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_CFG_L1_MISC_SEL (Offset 0x0711) */ -+ -+#define BIT_PCIE_CFG_L1_RIDLE_SEL BIT(6) -+#define BIT_PCIE_CFG_L1_TIMEOUT_SEL BIT(5) -+#define BIT_PCIE_CFG_L1_EIDLE_SEL BIT(4) -+ -+#define BIT_SHIFT_PCIE_CFG_DEFAULT_LINK_RATE 0 -+#define BIT_MASK_PCIE_CFG_DEFAULT_LINK_RATE 0xf -+#define BIT_PCIE_CFG_DEFAULT_LINK_RATE(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_DEFAULT_LINK_RATE) \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_LINK_RATE) -+#define BITS_PCIE_CFG_DEFAULT_LINK_RATE \ -+ (BIT_MASK_PCIE_CFG_DEFAULT_LINK_RATE \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_LINK_RATE) -+#define BIT_CLEAR_PCIE_CFG_DEFAULT_LINK_RATE(x) \ -+ ((x) & (~BITS_PCIE_CFG_DEFAULT_LINK_RATE)) -+#define BIT_GET_PCIE_CFG_DEFAULT_LINK_RATE(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_DEFAULT_LINK_RATE) & \ -+ BIT_MASK_PCIE_CFG_DEFAULT_LINK_RATE) -+#define BIT_SET_PCIE_CFG_DEFAULT_LINK_RATE(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_DEFAULT_LINK_RATE(x) | \ -+ BIT_PCIE_CFG_DEFAULT_LINK_RATE(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_ASSOCIATED_BFMEE_SEL (Offset 0x0714) */ -+ -+#define BIT_SHIFT_RD_BF_SEL 29 -+#define BIT_MASK_RD_BF_SEL 0x7 -+#define BIT_RD_BF_SEL(x) (((x) & BIT_MASK_RD_BF_SEL) << BIT_SHIFT_RD_BF_SEL) -+#define BITS_RD_BF_SEL (BIT_MASK_RD_BF_SEL << BIT_SHIFT_RD_BF_SEL) -+#define BIT_CLEAR_RD_BF_SEL(x) ((x) & (~BITS_RD_BF_SEL)) -+#define BIT_GET_RD_BF_SEL(x) (((x) >> BIT_SHIFT_RD_BF_SEL) & BIT_MASK_RD_BF_SEL) -+#define BIT_SET_RD_BF_SEL(x, v) (BIT_CLEAR_RD_BF_SEL(x) | BIT_RD_BF_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_SHIFT_NDP_RX_STANDBY_TIMER 24 -+#define BIT_MASK_NDP_RX_STANDBY_TIMER 0xff -+#define BIT_NDP_RX_STANDBY_TIMER(x) \ -+ (((x) & BIT_MASK_NDP_RX_STANDBY_TIMER) \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER) -+#define BITS_NDP_RX_STANDBY_TIMER \ -+ (BIT_MASK_NDP_RX_STANDBY_TIMER << BIT_SHIFT_NDP_RX_STANDBY_TIMER) -+#define BIT_CLEAR_NDP_RX_STANDBY_TIMER(x) ((x) & (~BITS_NDP_RX_STANDBY_TIMER)) -+#define BIT_GET_NDP_RX_STANDBY_TIMER(x) \ -+ (((x) >> BIT_SHIFT_NDP_RX_STANDBY_TIMER) & \ -+ BIT_MASK_NDP_RX_STANDBY_TIMER) -+#define BIT_SET_NDP_RX_STANDBY_TIMER(x, v) \ -+ (BIT_CLEAR_NDP_RX_STANDBY_TIMER(x) | BIT_NDP_RX_STANDBY_TIMER(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_R_WMAC_CHK_RPTPOLL_A2_DIS BIT(23) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_WMAC_CHK_RPTPOLL_A2_DIS BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_R_WMAC_CHK_UCNDPA_A2_DIS BIT(22) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_WMAC_CHK_UCNDPA_A2_DIS BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_ANTTRN_SWITCH BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_HT 16 -+#define BIT_MASK_CSI_RPT_OFFSET_HT 0xff -+#define BIT_CSI_RPT_OFFSET_HT(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_HT) << BIT_SHIFT_CSI_RPT_OFFSET_HT) -+#define BITS_CSI_RPT_OFFSET_HT \ -+ (BIT_MASK_CSI_RPT_OFFSET_HT << BIT_SHIFT_CSI_RPT_OFFSET_HT) -+#define BIT_CLEAR_CSI_RPT_OFFSET_HT(x) ((x) & (~BITS_CSI_RPT_OFFSET_HT)) -+#define BIT_GET_CSI_RPT_OFFSET_HT(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_HT) & BIT_MASK_CSI_RPT_OFFSET_HT) -+#define BIT_SET_CSI_RPT_OFFSET_HT(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_HT(x) | BIT_CSI_RPT_OFFSET_HT(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_HT_V1 16 -+#define BIT_MASK_CSI_RPT_OFFSET_HT_V1 0x3f -+#define BIT_CSI_RPT_OFFSET_HT_V1(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_HT_V1) \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_HT_V1) -+#define BITS_CSI_RPT_OFFSET_HT_V1 \ -+ (BIT_MASK_CSI_RPT_OFFSET_HT_V1 << BIT_SHIFT_CSI_RPT_OFFSET_HT_V1) -+#define BIT_CLEAR_CSI_RPT_OFFSET_HT_V1(x) ((x) & (~BITS_CSI_RPT_OFFSET_HT_V1)) -+#define BIT_GET_CSI_RPT_OFFSET_HT_V1(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_HT_V1) & \ -+ BIT_MASK_CSI_RPT_OFFSET_HT_V1) -+#define BIT_SET_CSI_RPT_OFFSET_HT_V1(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_HT_V1(x) | BIT_CSI_RPT_OFFSET_HT_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_R_WMAC_OFFSET_RPTPOLL_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_WMAC_OFFSET_RPTPOLL_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_VHTNDP_RPTPOLL_CSI_STR_OFFSET_SEL BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_R_WMAC_CSI_CHKSUM_DIS BIT(14) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_WMAC_CSI_CHKSUM_DIS BIT(14) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_NDPVLD_POS_RST_FFPTR_DIS BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_SHIFT_R_WMAC_VHT_CATEGORY 8 -+#define BIT_MASK_R_WMAC_VHT_CATEGORY 0xff -+#define BIT_R_WMAC_VHT_CATEGORY(x) \ -+ (((x) & BIT_MASK_R_WMAC_VHT_CATEGORY) << BIT_SHIFT_R_WMAC_VHT_CATEGORY) -+#define BITS_R_WMAC_VHT_CATEGORY \ -+ (BIT_MASK_R_WMAC_VHT_CATEGORY << BIT_SHIFT_R_WMAC_VHT_CATEGORY) -+#define BIT_CLEAR_R_WMAC_VHT_CATEGORY(x) ((x) & (~BITS_R_WMAC_VHT_CATEGORY)) -+#define BIT_GET_R_WMAC_VHT_CATEGORY(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_VHT_CATEGORY) & BIT_MASK_R_WMAC_VHT_CATEGORY) -+#define BIT_SET_R_WMAC_VHT_CATEGORY(x, v) \ -+ (BIT_CLEAR_R_WMAC_VHT_CATEGORY(x) | BIT_R_WMAC_VHT_CATEGORY(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_VHT 8 -+#define BIT_MASK_CSI_RPT_OFFSET_VHT 0xff -+#define BIT_CSI_RPT_OFFSET_VHT(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_VHT) << BIT_SHIFT_CSI_RPT_OFFSET_VHT) -+#define BITS_CSI_RPT_OFFSET_VHT \ -+ (BIT_MASK_CSI_RPT_OFFSET_VHT << BIT_SHIFT_CSI_RPT_OFFSET_VHT) -+#define BIT_CLEAR_CSI_RPT_OFFSET_VHT(x) ((x) & (~BITS_CSI_RPT_OFFSET_VHT)) -+#define BIT_GET_CSI_RPT_OFFSET_VHT(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_VHT) & BIT_MASK_CSI_RPT_OFFSET_VHT) -+#define BIT_SET_CSI_RPT_OFFSET_VHT(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_VHT(x) | BIT_CSI_RPT_OFFSET_VHT(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1 8 -+#define BIT_MASK_R_WMAC_VHT_CATEGORY_V1 0x3f -+#define BIT_R_WMAC_VHT_CATEGORY_V1(x) \ -+ (((x) & BIT_MASK_R_WMAC_VHT_CATEGORY_V1) \ -+ << BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1) -+#define BITS_R_WMAC_VHT_CATEGORY_V1 \ -+ (BIT_MASK_R_WMAC_VHT_CATEGORY_V1 << BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1) -+#define BIT_CLEAR_R_WMAC_VHT_CATEGORY_V1(x) \ -+ ((x) & (~BITS_R_WMAC_VHT_CATEGORY_V1)) -+#define BIT_GET_R_WMAC_VHT_CATEGORY_V1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1) & \ -+ BIT_MASK_R_WMAC_VHT_CATEGORY_V1) -+#define BIT_SET_R_WMAC_VHT_CATEGORY_V1(x, v) \ -+ (BIT_CLEAR_R_WMAC_VHT_CATEGORY_V1(x) | BIT_R_WMAC_VHT_CATEGORY_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_VHT_V1 8 -+#define BIT_MASK_CSI_RPT_OFFSET_VHT_V1 0x3f -+#define BIT_CSI_RPT_OFFSET_VHT_V1(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_VHT_V1) \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_VHT_V1) -+#define BITS_CSI_RPT_OFFSET_VHT_V1 \ -+ (BIT_MASK_CSI_RPT_OFFSET_VHT_V1 << BIT_SHIFT_CSI_RPT_OFFSET_VHT_V1) -+#define BIT_CLEAR_CSI_RPT_OFFSET_VHT_V1(x) ((x) & (~BITS_CSI_RPT_OFFSET_VHT_V1)) -+#define BIT_GET_CSI_RPT_OFFSET_VHT_V1(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_VHT_V1) & \ -+ BIT_MASK_CSI_RPT_OFFSET_VHT_V1) -+#define BIT_SET_CSI_RPT_OFFSET_VHT_V1(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_VHT_V1(x) | BIT_CSI_RPT_OFFSET_VHT_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1 8 -+#define BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1 0x3f -+#define BIT_R_CSI_RPT_OFFSET_VHT_V1(x) \ -+ (((x) & BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1) \ -+ << BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1) -+#define BITS_R_CSI_RPT_OFFSET_VHT_V1 \ -+ (BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1 << BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1) -+#define BIT_CLEAR_R_CSI_RPT_OFFSET_VHT_V1(x) \ -+ ((x) & (~BITS_R_CSI_RPT_OFFSET_VHT_V1)) -+#define BIT_GET_R_CSI_RPT_OFFSET_VHT_V1(x) \ -+ (((x) >> BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1) & \ -+ BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1) -+#define BIT_SET_R_CSI_RPT_OFFSET_VHT_V1(x, v) \ -+ (BIT_CLEAR_R_CSI_RPT_OFFSET_VHT_V1(x) | BIT_R_CSI_RPT_OFFSET_VHT_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_R_WMAC_USE_NSTS BIT(7) -+#define BIT_R_DISABLE_CHECK_VHTSIGB_CRC BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF (Offset 0x0718) */ -+ -+#define BIT_PCIE_CFG_REAL_PTM_ENABLE BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_R_DISABLE_CHECK_VHTSIGA_CRC BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF (Offset 0x0718) */ -+ -+#define BIT_PCIE_CFG_REAL_EN_L1SUB BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SND_PTCL_CTRL (Offset 0x0718) */ -+ -+#define BIT_R_WMAC_BFPARAM_SEL BIT(4) -+#define BIT_R_WMAC_CSISEQ_SEL BIT(3) -+#define BIT_R_WMAC_CSI_WITHHTC_EN BIT(2) -+#define BIT_R_WMAC_HT_NDPA_EN BIT(1) -+#define BIT_R_WMAC_VHT_NDPA_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF (Offset 0x0718) */ -+ -+#define BIT_SHIFT_PCIE_CFG_MAX_FUNC_NUM 0 -+#define BIT_MASK_PCIE_CFG_MAX_FUNC_NUM 0x7 -+#define BIT_PCIE_CFG_MAX_FUNC_NUM(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_MAX_FUNC_NUM) \ -+ << BIT_SHIFT_PCIE_CFG_MAX_FUNC_NUM) -+#define BITS_PCIE_CFG_MAX_FUNC_NUM \ -+ (BIT_MASK_PCIE_CFG_MAX_FUNC_NUM << BIT_SHIFT_PCIE_CFG_MAX_FUNC_NUM) -+#define BIT_CLEAR_PCIE_CFG_MAX_FUNC_NUM(x) ((x) & (~BITS_PCIE_CFG_MAX_FUNC_NUM)) -+#define BIT_GET_PCIE_CFG_MAX_FUNC_NUM(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_MAX_FUNC_NUM) & \ -+ BIT_MASK_PCIE_CFG_MAX_FUNC_NUM) -+#define BIT_SET_PCIE_CFG_MAX_FUNC_NUM(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_MAX_FUNC_NUM(x) | BIT_PCIE_CFG_MAX_FUNC_NUM(v)) -+ -+/* 2 REG_PCIE_CFG_FORCE_CLKREQ_N_PAD (Offset 0x0719) */ -+ -+#define BIT_PCIE_CFG_REAL_EN_64BITS BIT(5) -+#define BIT_PCIE_CFG_REAL_EN_CLKREQ BIT(4) -+#define BIT_PCIE_CFG_REAL_EN_L1 BIT(3) -+#define BIT_PCIE_CFG_WAKE_N_EN BIT(2) -+#define BIT_PCIE_CFG_BYPASS_LTR_OPTION BIT(1) -+#define BIT_PCIE_CFG_FORCE_CLKREQ_N_PAD BIT(0) -+ -+/* 2 REG_PCIE_CFG_TIMER_MODIFIER_FOR_ACK_NAK_LATENCY (Offset 0x071A) */ -+ -+#define BIT_SHIFT_PCIE_CFG_TIMER_MOD_ACK_NAK 0 -+#define BIT_MASK_PCIE_CFG_TIMER_MOD_ACK_NAK 0xff -+#define BIT_PCIE_CFG_TIMER_MOD_ACK_NAK(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_TIMER_MOD_ACK_NAK) \ -+ << BIT_SHIFT_PCIE_CFG_TIMER_MOD_ACK_NAK) -+#define BITS_PCIE_CFG_TIMER_MOD_ACK_NAK \ -+ (BIT_MASK_PCIE_CFG_TIMER_MOD_ACK_NAK \ -+ << BIT_SHIFT_PCIE_CFG_TIMER_MOD_ACK_NAK) -+#define BIT_CLEAR_PCIE_CFG_TIMER_MOD_ACK_NAK(x) \ -+ ((x) & (~BITS_PCIE_CFG_TIMER_MOD_ACK_NAK)) -+#define BIT_GET_PCIE_CFG_TIMER_MOD_ACK_NAK(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_TIMER_MOD_ACK_NAK) & \ -+ BIT_MASK_PCIE_CFG_TIMER_MOD_ACK_NAK) -+#define BIT_SET_PCIE_CFG_TIMER_MOD_ACK_NAK(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_TIMER_MOD_ACK_NAK(x) | \ -+ BIT_PCIE_CFG_TIMER_MOD_ACK_NAK(v)) -+ -+/* 2 REG_PCIE_CFG_TIMER_MODIFIER_FOR_FLOW_CONTROL_WATCHDOG (Offset 0x071B) */ -+ -+#define BIT_PCIE_CFG_BYPASS_L1_SUBSTATE_OPTION BIT(7) -+ -+#define BIT_SHIFT_PCIE_CFG_FAST_LINK_SCALING_FACTOR 5 -+#define BIT_MASK_PCIE_CFG_FAST_LINK_SCALING_FACTOR 0x3 -+#define BIT_PCIE_CFG_FAST_LINK_SCALING_FACTOR(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_FAST_LINK_SCALING_FACTOR) \ -+ << BIT_SHIFT_PCIE_CFG_FAST_LINK_SCALING_FACTOR) -+#define BITS_PCIE_CFG_FAST_LINK_SCALING_FACTOR \ -+ (BIT_MASK_PCIE_CFG_FAST_LINK_SCALING_FACTOR \ -+ << BIT_SHIFT_PCIE_CFG_FAST_LINK_SCALING_FACTOR) -+#define BIT_CLEAR_PCIE_CFG_FAST_LINK_SCALING_FACTOR(x) \ -+ ((x) & (~BITS_PCIE_CFG_FAST_LINK_SCALING_FACTOR)) -+#define BIT_GET_PCIE_CFG_FAST_LINK_SCALING_FACTOR(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_FAST_LINK_SCALING_FACTOR) & \ -+ BIT_MASK_PCIE_CFG_FAST_LINK_SCALING_FACTOR) -+#define BIT_SET_PCIE_CFG_FAST_LINK_SCALING_FACTOR(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_FAST_LINK_SCALING_FACTOR(x) | \ -+ BIT_PCIE_CFG_FAST_LINK_SCALING_FACTOR(v)) -+ -+#define BIT_SHIFT_PCIE_CFG_UPDATE_FREQ_TIMER 0 -+#define BIT_MASK_PCIE_CFG_UPDATE_FREQ_TIMER 0x1f -+#define BIT_PCIE_CFG_UPDATE_FREQ_TIMER(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_UPDATE_FREQ_TIMER) \ -+ << BIT_SHIFT_PCIE_CFG_UPDATE_FREQ_TIMER) -+#define BITS_PCIE_CFG_UPDATE_FREQ_TIMER \ -+ (BIT_MASK_PCIE_CFG_UPDATE_FREQ_TIMER \ -+ << BIT_SHIFT_PCIE_CFG_UPDATE_FREQ_TIMER) -+#define BIT_CLEAR_PCIE_CFG_UPDATE_FREQ_TIMER(x) \ -+ ((x) & (~BITS_PCIE_CFG_UPDATE_FREQ_TIMER)) -+#define BIT_GET_PCIE_CFG_UPDATE_FREQ_TIMER(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_UPDATE_FREQ_TIMER) & \ -+ BIT_MASK_PCIE_CFG_UPDATE_FREQ_TIMER) -+#define BIT_SET_PCIE_CFG_UPDATE_FREQ_TIMER(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_UPDATE_FREQ_TIMER(x) | \ -+ BIT_PCIE_CFG_UPDATE_FREQ_TIMER(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_CSI_RPT_INFO (Offset 0x071C) */ -+ -+#define BIT_WMAC_CHECK_SOUNDING_SEQ BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_CFG_SKP_INTERVAL_VALUE_L (Offset 0x071C) */ -+ -+#define BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_L 0 -+#define BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_L 0xff -+#define BIT_PCIE_CFG_SKP_INTERVAL_VALUE_L(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_L) \ -+ << BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_L) -+#define BITS_PCIE_CFG_SKP_INTERVAL_VALUE_L \ -+ (BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_L \ -+ << BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_L) -+#define BIT_CLEAR_PCIE_CFG_SKP_INTERVAL_VALUE_L(x) \ -+ ((x) & (~BITS_PCIE_CFG_SKP_INTERVAL_VALUE_L)) -+#define BIT_GET_PCIE_CFG_SKP_INTERVAL_VALUE_L(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_L) & \ -+ BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_L) -+#define BIT_SET_PCIE_CFG_SKP_INTERVAL_VALUE_L(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_SKP_INTERVAL_VALUE_L(x) | \ -+ BIT_PCIE_CFG_SKP_INTERVAL_VALUE_L(v)) -+ -+/* 2 REG_PCIE_CFG_SKP_INTERVAL_VALUE_H (Offset 0x071D) */ -+ -+#define BIT_PCIE_CFG_DISABLE_FC_WATCHDOG_TIMER BIT(7) -+ -+#define BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_H 0 -+#define BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_H 0x7 -+#define BIT_PCIE_CFG_SKP_INTERVAL_VALUE_H(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_H) \ -+ << BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_H) -+#define BITS_PCIE_CFG_SKP_INTERVAL_VALUE_H \ -+ (BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_H \ -+ << BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_H) -+#define BIT_CLEAR_PCIE_CFG_SKP_INTERVAL_VALUE_H(x) \ -+ ((x) & (~BITS_PCIE_CFG_SKP_INTERVAL_VALUE_H)) -+#define BIT_GET_PCIE_CFG_SKP_INTERVAL_VALUE_H(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_H) & \ -+ BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_H) -+#define BIT_SET_PCIE_CFG_SKP_INTERVAL_VALUE_H(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_SKP_INTERVAL_VALUE_H(x) | \ -+ BIT_PCIE_CFG_SKP_INTERVAL_VALUE_H(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NS_ARP_CTRL (Offset 0x0720) */ -+ -+#define BIT_R_WMAC_NSARP_RSPEN BIT(15) -+#define BIT_R_WMAC_NSARP_RARP BIT(9) -+#define BIT_R_WMAC_NSARP_RIPV6 BIT(8) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_MODEN 6 -+#define BIT_MASK_R_WMAC_NSARP_MODEN 0x3 -+#define BIT_R_WMAC_NSARP_MODEN(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_MODEN) << BIT_SHIFT_R_WMAC_NSARP_MODEN) -+#define BITS_R_WMAC_NSARP_MODEN \ -+ (BIT_MASK_R_WMAC_NSARP_MODEN << BIT_SHIFT_R_WMAC_NSARP_MODEN) -+#define BIT_CLEAR_R_WMAC_NSARP_MODEN(x) ((x) & (~BITS_R_WMAC_NSARP_MODEN)) -+#define BIT_GET_R_WMAC_NSARP_MODEN(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_MODEN) & BIT_MASK_R_WMAC_NSARP_MODEN) -+#define BIT_SET_R_WMAC_NSARP_MODEN(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_MODEN(x) | BIT_R_WMAC_NSARP_MODEN(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPFTP 4 -+#define BIT_MASK_R_WMAC_NSARP_RSPFTP 0x3 -+#define BIT_R_WMAC_NSARP_RSPFTP(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPFTP) << BIT_SHIFT_R_WMAC_NSARP_RSPFTP) -+#define BITS_R_WMAC_NSARP_RSPFTP \ -+ (BIT_MASK_R_WMAC_NSARP_RSPFTP << BIT_SHIFT_R_WMAC_NSARP_RSPFTP) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPFTP(x) ((x) & (~BITS_R_WMAC_NSARP_RSPFTP)) -+#define BIT_GET_R_WMAC_NSARP_RSPFTP(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPFTP) & BIT_MASK_R_WMAC_NSARP_RSPFTP) -+#define BIT_SET_R_WMAC_NSARP_RSPFTP(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPFTP(x) | BIT_R_WMAC_NSARP_RSPFTP(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPSEC 0 -+#define BIT_MASK_R_WMAC_NSARP_RSPSEC 0xf -+#define BIT_R_WMAC_NSARP_RSPSEC(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPSEC) << BIT_SHIFT_R_WMAC_NSARP_RSPSEC) -+#define BITS_R_WMAC_NSARP_RSPSEC \ -+ (BIT_MASK_R_WMAC_NSARP_RSPSEC << BIT_SHIFT_R_WMAC_NSARP_RSPSEC) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPSEC(x) ((x) & (~BITS_R_WMAC_NSARP_RSPSEC)) -+#define BIT_GET_R_WMAC_NSARP_RSPSEC(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPSEC) & BIT_MASK_R_WMAC_NSARP_RSPSEC) -+#define BIT_SET_R_WMAC_NSARP_RSPSEC(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPSEC(x) | BIT_R_WMAC_NSARP_RSPSEC(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NS_ARP_INFO (Offset 0x0724) */ -+ -+#define BIT_REQ_IS_MCNS BIT(23) -+#define BIT_REQ_IS_UCNS BIT(22) -+#define BIT_REQ_IS_USNS BIT(21) -+#define BIT_REQ_IS_ARP BIT(20) -+#define BIT_EXPRSP_MH_WITHQC BIT(19) -+ -+#define BIT_SHIFT_EXPRSP_SECTYPE 16 -+#define BIT_MASK_EXPRSP_SECTYPE 0x7 -+#define BIT_EXPRSP_SECTYPE(x) \ -+ (((x) & BIT_MASK_EXPRSP_SECTYPE) << BIT_SHIFT_EXPRSP_SECTYPE) -+#define BITS_EXPRSP_SECTYPE \ -+ (BIT_MASK_EXPRSP_SECTYPE << BIT_SHIFT_EXPRSP_SECTYPE) -+#define BIT_CLEAR_EXPRSP_SECTYPE(x) ((x) & (~BITS_EXPRSP_SECTYPE)) -+#define BIT_GET_EXPRSP_SECTYPE(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_SECTYPE) & BIT_MASK_EXPRSP_SECTYPE) -+#define BIT_SET_EXPRSP_SECTYPE(x, v) \ -+ (BIT_CLEAR_EXPRSP_SECTYPE(x) | BIT_EXPRSP_SECTYPE(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_7_TO_0 8 -+#define BIT_MASK_EXPRSP_CHKSM_7_TO_0 0xff -+#define BIT_EXPRSP_CHKSM_7_TO_0(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_7_TO_0) << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0) -+#define BITS_EXPRSP_CHKSM_7_TO_0 \ -+ (BIT_MASK_EXPRSP_CHKSM_7_TO_0 << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0) -+#define BIT_CLEAR_EXPRSP_CHKSM_7_TO_0(x) ((x) & (~BITS_EXPRSP_CHKSM_7_TO_0)) -+#define BIT_GET_EXPRSP_CHKSM_7_TO_0(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_7_TO_0) & BIT_MASK_EXPRSP_CHKSM_7_TO_0) -+#define BIT_SET_EXPRSP_CHKSM_7_TO_0(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_7_TO_0(x) | BIT_EXPRSP_CHKSM_7_TO_0(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_15_TO_8 0 -+#define BIT_MASK_EXPRSP_CHKSM_15_TO_8 0xff -+#define BIT_EXPRSP_CHKSM_15_TO_8(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_15_TO_8) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8) -+#define BITS_EXPRSP_CHKSM_15_TO_8 \ -+ (BIT_MASK_EXPRSP_CHKSM_15_TO_8 << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8) -+#define BIT_CLEAR_EXPRSP_CHKSM_15_TO_8(x) ((x) & (~BITS_EXPRSP_CHKSM_15_TO_8)) -+#define BIT_GET_EXPRSP_CHKSM_15_TO_8(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_15_TO_8) & \ -+ BIT_MASK_EXPRSP_CHKSM_15_TO_8) -+#define BIT_SET_EXPRSP_CHKSM_15_TO_8(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_15_TO_8(x) | BIT_EXPRSP_CHKSM_15_TO_8(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PCIE_CFG_L1_UNIT_SEL (Offset 0x0724) */ -+ -+#define BIT_SHIFT_PCIE_CFG_L1_UNIT_SEL 0 -+#define BIT_MASK_PCIE_CFG_L1_UNIT_SEL 0xff -+#define BIT_PCIE_CFG_L1_UNIT_SEL(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_L1_UNIT_SEL) \ -+ << BIT_SHIFT_PCIE_CFG_L1_UNIT_SEL) -+#define BITS_PCIE_CFG_L1_UNIT_SEL \ -+ (BIT_MASK_PCIE_CFG_L1_UNIT_SEL << BIT_SHIFT_PCIE_CFG_L1_UNIT_SEL) -+#define BIT_CLEAR_PCIE_CFG_L1_UNIT_SEL(x) ((x) & (~BITS_PCIE_CFG_L1_UNIT_SEL)) -+#define BIT_GET_PCIE_CFG_L1_UNIT_SEL(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_L1_UNIT_SEL) & \ -+ BIT_MASK_PCIE_CFG_L1_UNIT_SEL) -+#define BIT_SET_PCIE_CFG_L1_UNIT_SEL(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_L1_UNIT_SEL(x) | BIT_PCIE_CFG_L1_UNIT_SEL(v)) -+ -+/* 2 REG_PCIE_CFG_MIN_CLKREQ_SEL (Offset 0x0725) */ -+ -+#define BIT_SHIFT_PCIE_CFG_MIN_CLKREQ_SEL 0 -+#define BIT_MASK_PCIE_CFG_MIN_CLKREQ_SEL 0xf -+#define BIT_PCIE_CFG_MIN_CLKREQ_SEL(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_MIN_CLKREQ_SEL) \ -+ << BIT_SHIFT_PCIE_CFG_MIN_CLKREQ_SEL) -+#define BITS_PCIE_CFG_MIN_CLKREQ_SEL \ -+ (BIT_MASK_PCIE_CFG_MIN_CLKREQ_SEL << BIT_SHIFT_PCIE_CFG_MIN_CLKREQ_SEL) -+#define BIT_CLEAR_PCIE_CFG_MIN_CLKREQ_SEL(x) \ -+ ((x) & (~BITS_PCIE_CFG_MIN_CLKREQ_SEL)) -+#define BIT_GET_PCIE_CFG_MIN_CLKREQ_SEL(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_MIN_CLKREQ_SEL) & \ -+ BIT_MASK_PCIE_CFG_MIN_CLKREQ_SEL) -+#define BIT_SET_PCIE_CFG_MIN_CLKREQ_SEL(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_MIN_CLKREQ_SEL(x) | BIT_PCIE_CFG_MIN_CLKREQ_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_V1 (Offset 0x0728) */ -+ -+#define BIT_SHIFT_WMAC_ARPIP 0 -+#define BIT_MASK_WMAC_ARPIP 0xffffffffL -+#define BIT_WMAC_ARPIP(x) (((x) & BIT_MASK_WMAC_ARPIP) << BIT_SHIFT_WMAC_ARPIP) -+#define BITS_WMAC_ARPIP (BIT_MASK_WMAC_ARPIP << BIT_SHIFT_WMAC_ARPIP) -+#define BIT_CLEAR_WMAC_ARPIP(x) ((x) & (~BITS_WMAC_ARPIP)) -+#define BIT_GET_WMAC_ARPIP(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARPIP) & BIT_MASK_WMAC_ARPIP) -+#define BIT_SET_WMAC_ARPIP(x, v) (BIT_CLEAR_WMAC_ARPIP(x) | BIT_WMAC_ARPIP(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP (Offset 0x072C) */ -+ -+#define BIT_SHIFT_UPD_BFMEE_USERID 13 -+#define BIT_MASK_UPD_BFMEE_USERID 0x7 -+#define BIT_UPD_BFMEE_USERID(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_USERID) << BIT_SHIFT_UPD_BFMEE_USERID) -+#define BITS_UPD_BFMEE_USERID \ -+ (BIT_MASK_UPD_BFMEE_USERID << BIT_SHIFT_UPD_BFMEE_USERID) -+#define BIT_CLEAR_UPD_BFMEE_USERID(x) ((x) & (~BITS_UPD_BFMEE_USERID)) -+#define BIT_GET_UPD_BFMEE_USERID(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_USERID) & BIT_MASK_UPD_BFMEE_USERID) -+#define BIT_SET_UPD_BFMEE_USERID(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_USERID(x) | BIT_UPD_BFMEE_USERID(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RX_CSI_RPT_INFO_V1 (Offset 0x072C) */ -+ -+#define BIT_WRITE_USERID BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP (Offset 0x072C) */ -+ -+#define BIT_UPD_BFMEE_FBTP BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RX_CSI_RPT_INFO_V1 (Offset 0x072C) */ -+ -+#define BIT_SHIFT_WRITE_BW 10 -+#define BIT_MASK_WRITE_BW 0x3 -+#define BIT_WRITE_BW(x) (((x) & BIT_MASK_WRITE_BW) << BIT_SHIFT_WRITE_BW) -+#define BITS_WRITE_BW (BIT_MASK_WRITE_BW << BIT_SHIFT_WRITE_BW) -+#define BIT_CLEAR_WRITE_BW(x) ((x) & (~BITS_WRITE_BW)) -+#define BIT_GET_WRITE_BW(x) (((x) >> BIT_SHIFT_WRITE_BW) & BIT_MASK_WRITE_BW) -+#define BIT_SET_WRITE_BW(x, v) (BIT_CLEAR_WRITE_BW(x) | BIT_WRITE_BW(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP (Offset 0x072C) */ -+ -+#define BIT_SHIFT_UPD_BFMEE_BW_V1 10 -+#define BIT_MASK_UPD_BFMEE_BW_V1 0x3 -+#define BIT_UPD_BFMEE_BW_V1(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_BW_V1) << BIT_SHIFT_UPD_BFMEE_BW_V1) -+#define BITS_UPD_BFMEE_BW_V1 \ -+ (BIT_MASK_UPD_BFMEE_BW_V1 << BIT_SHIFT_UPD_BFMEE_BW_V1) -+#define BIT_CLEAR_UPD_BFMEE_BW_V1(x) ((x) & (~BITS_UPD_BFMEE_BW_V1)) -+#define BIT_GET_UPD_BFMEE_BW_V1(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_BW_V1) & BIT_MASK_UPD_BFMEE_BW_V1) -+#define BIT_SET_UPD_BFMEE_BW_V1(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_BW_V1(x) | BIT_UPD_BFMEE_BW_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RX_CSI_RPT_INFO_V1 (Offset 0x072C) */ -+ -+#define BIT_SHIFT_WRITE_CB 8 -+#define BIT_MASK_WRITE_CB 0x3 -+#define BIT_WRITE_CB(x) (((x) & BIT_MASK_WRITE_CB) << BIT_SHIFT_WRITE_CB) -+#define BITS_WRITE_CB (BIT_MASK_WRITE_CB << BIT_SHIFT_WRITE_CB) -+#define BIT_CLEAR_WRITE_CB(x) ((x) & (~BITS_WRITE_CB)) -+#define BIT_GET_WRITE_CB(x) (((x) >> BIT_SHIFT_WRITE_CB) & BIT_MASK_WRITE_CB) -+#define BIT_SET_WRITE_CB(x, v) (BIT_CLEAR_WRITE_CB(x) | BIT_WRITE_CB(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP (Offset 0x072C) */ -+ -+#define BIT_SHIFT_UPD_BFMEE_CB 8 -+#define BIT_MASK_UPD_BFMEE_CB 0x3 -+#define BIT_UPD_BFMEE_CB(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_CB) << BIT_SHIFT_UPD_BFMEE_CB) -+#define BITS_UPD_BFMEE_CB (BIT_MASK_UPD_BFMEE_CB << BIT_SHIFT_UPD_BFMEE_CB) -+#define BIT_CLEAR_UPD_BFMEE_CB(x) ((x) & (~BITS_UPD_BFMEE_CB)) -+#define BIT_GET_UPD_BFMEE_CB(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_CB) & BIT_MASK_UPD_BFMEE_CB) -+#define BIT_SET_UPD_BFMEE_CB(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_CB(x) | BIT_UPD_BFMEE_CB(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RX_CSI_RPT_INFO_V1 (Offset 0x072C) */ -+ -+#define BIT_SHIFT_WRITE_GROUPING 6 -+#define BIT_MASK_WRITE_GROUPING 0x3 -+#define BIT_WRITE_GROUPING(x) \ -+ (((x) & BIT_MASK_WRITE_GROUPING) << BIT_SHIFT_WRITE_GROUPING) -+#define BITS_WRITE_GROUPING \ -+ (BIT_MASK_WRITE_GROUPING << BIT_SHIFT_WRITE_GROUPING) -+#define BIT_CLEAR_WRITE_GROUPING(x) ((x) & (~BITS_WRITE_GROUPING)) -+#define BIT_GET_WRITE_GROUPING(x) \ -+ (((x) >> BIT_SHIFT_WRITE_GROUPING) & BIT_MASK_WRITE_GROUPING) -+#define BIT_SET_WRITE_GROUPING(x, v) \ -+ (BIT_CLEAR_WRITE_GROUPING(x) | BIT_WRITE_GROUPING(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP (Offset 0x072C) */ -+ -+#define BIT_SHIFT_UPD_BFMEE_NG 6 -+#define BIT_MASK_UPD_BFMEE_NG 0x3 -+#define BIT_UPD_BFMEE_NG(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_NG) << BIT_SHIFT_UPD_BFMEE_NG) -+#define BITS_UPD_BFMEE_NG (BIT_MASK_UPD_BFMEE_NG << BIT_SHIFT_UPD_BFMEE_NG) -+#define BIT_CLEAR_UPD_BFMEE_NG(x) ((x) & (~BITS_UPD_BFMEE_NG)) -+#define BIT_GET_UPD_BFMEE_NG(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_NG) & BIT_MASK_UPD_BFMEE_NG) -+#define BIT_SET_UPD_BFMEE_NG(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_NG(x) | BIT_UPD_BFMEE_NG(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RX_CSI_RPT_INFO_V1 (Offset 0x072C) */ -+ -+#define BIT_SHIFT_WRITE_NR 3 -+#define BIT_MASK_WRITE_NR 0x7 -+#define BIT_WRITE_NR(x) (((x) & BIT_MASK_WRITE_NR) << BIT_SHIFT_WRITE_NR) -+#define BITS_WRITE_NR (BIT_MASK_WRITE_NR << BIT_SHIFT_WRITE_NR) -+#define BIT_CLEAR_WRITE_NR(x) ((x) & (~BITS_WRITE_NR)) -+#define BIT_GET_WRITE_NR(x) (((x) >> BIT_SHIFT_WRITE_NR) & BIT_MASK_WRITE_NR) -+#define BIT_SET_WRITE_NR(x, v) (BIT_CLEAR_WRITE_NR(x) | BIT_WRITE_NR(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP (Offset 0x072C) */ -+ -+#define BIT_SHIFT_UPD_BFMEE_NR 3 -+#define BIT_MASK_UPD_BFMEE_NR 0x7 -+#define BIT_UPD_BFMEE_NR(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_NR) << BIT_SHIFT_UPD_BFMEE_NR) -+#define BITS_UPD_BFMEE_NR (BIT_MASK_UPD_BFMEE_NR << BIT_SHIFT_UPD_BFMEE_NR) -+#define BIT_CLEAR_UPD_BFMEE_NR(x) ((x) & (~BITS_UPD_BFMEE_NR)) -+#define BIT_GET_UPD_BFMEE_NR(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_NR) & BIT_MASK_UPD_BFMEE_NR) -+#define BIT_SET_UPD_BFMEE_NR(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_NR(x) | BIT_UPD_BFMEE_NR(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RX_CSI_RPT_INFO_V1 (Offset 0x072C) */ -+ -+#define BIT_SHIFT_WRITE_NC 0 -+#define BIT_MASK_WRITE_NC 0x7 -+#define BIT_WRITE_NC(x) (((x) & BIT_MASK_WRITE_NC) << BIT_SHIFT_WRITE_NC) -+#define BITS_WRITE_NC (BIT_MASK_WRITE_NC << BIT_SHIFT_WRITE_NC) -+#define BIT_CLEAR_WRITE_NC(x) ((x) & (~BITS_WRITE_NC)) -+#define BIT_GET_WRITE_NC(x) (((x) >> BIT_SHIFT_WRITE_NC) & BIT_MASK_WRITE_NC) -+#define BIT_SET_WRITE_NC(x, v) (BIT_CLEAR_WRITE_NC(x) | BIT_WRITE_NC(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP (Offset 0x072C) */ -+ -+#define BIT_SHIFT_UPD_BFMEE_NC 0 -+#define BIT_MASK_UPD_BFMEE_NC 0x7 -+#define BIT_UPD_BFMEE_NC(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_NC) << BIT_SHIFT_UPD_BFMEE_NC) -+#define BITS_UPD_BFMEE_NC (BIT_MASK_UPD_BFMEE_NC << BIT_SHIFT_UPD_BFMEE_NC) -+#define BIT_CLEAR_UPD_BFMEE_NC(x) ((x) & (~BITS_UPD_BFMEE_NC)) -+#define BIT_GET_UPD_BFMEE_NC(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_NC) & BIT_MASK_UPD_BFMEE_NC) -+#define BIT_SET_UPD_BFMEE_NC(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_NC(x) | BIT_UPD_BFMEE_NC(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP (Offset 0x072C) */ -+ -+#define BIT_SHIFT_BEAMFORMING_INFO 0 -+#define BIT_MASK_BEAMFORMING_INFO 0xffffffffL -+#define BIT_BEAMFORMING_INFO(x) \ -+ (((x) & BIT_MASK_BEAMFORMING_INFO) << BIT_SHIFT_BEAMFORMING_INFO) -+#define BITS_BEAMFORMING_INFO \ -+ (BIT_MASK_BEAMFORMING_INFO << BIT_SHIFT_BEAMFORMING_INFO) -+#define BIT_CLEAR_BEAMFORMING_INFO(x) ((x) & (~BITS_BEAMFORMING_INFO)) -+#define BIT_GET_BEAMFORMING_INFO(x) \ -+ (((x) >> BIT_SHIFT_BEAMFORMING_INFO) & BIT_MASK_BEAMFORMING_INFO) -+#define BIT_SET_BEAMFORMING_INFO(x, v) \ -+ (BIT_CLEAR_BEAMFORMING_INFO(x) | BIT_BEAMFORMING_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP (Offset 0x072C) */ -+ -+#define BIT_SHIFT_UPD_BFMEE_BW 0 -+#define BIT_MASK_UPD_BFMEE_BW 0xfff -+#define BIT_UPD_BFMEE_BW(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_BW) << BIT_SHIFT_UPD_BFMEE_BW) -+#define BITS_UPD_BFMEE_BW (BIT_MASK_UPD_BFMEE_BW << BIT_SHIFT_UPD_BFMEE_BW) -+#define BIT_CLEAR_UPD_BFMEE_BW(x) ((x) & (~BITS_UPD_BFMEE_BW)) -+#define BIT_GET_UPD_BFMEE_BW(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_BW) & BIT_MASK_UPD_BFMEE_BW) -+#define BIT_SET_UPD_BFMEE_BW(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_BW(x) | BIT_UPD_BFMEE_BW(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_IPV6 (Offset 0x0730) */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_0 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_0(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_0) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0) -+#define BITS_R_WMAC_IPV6_MYIPAD_0 \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_0 << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_0(x) ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_0)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_0(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_0) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_0(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_0(x) | BIT_R_WMAC_IPV6_MYIPAD_0(v)) -+ -+/* 2 REG_IPV6_1 (Offset 0x0734) */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_1 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_1(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_1) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1) -+#define BITS_R_WMAC_IPV6_MYIPAD_1 \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_1 << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_1(x) ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_1)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_1) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_1(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_1(x) | BIT_R_WMAC_IPV6_MYIPAD_1(v)) -+ -+/* 2 REG_IPV6_2 (Offset 0x0738) */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_2 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_2(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_2) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2) -+#define BITS_R_WMAC_IPV6_MYIPAD_2 \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_2 << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_2(x) ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_2)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_2(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_2) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_2(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_2(x) | BIT_R_WMAC_IPV6_MYIPAD_2(v)) -+ -+/* 2 REG_IPV6_3 (Offset 0x073C) */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_3 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_3(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_3) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3) -+#define BITS_R_WMAC_IPV6_MYIPAD_3 \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_3 << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_3(x) ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_3)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_3(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_3) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_3(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_3(x) | BIT_R_WMAC_IPV6_MYIPAD_3(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_RTX_CTX_SUBTYPE_CFG (Offset 0x0750) */ -+ -+#define BIT_SHIFT_R_WMAC_CTX_SUBTYPE 4 -+#define BIT_MASK_R_WMAC_CTX_SUBTYPE 0xf -+#define BIT_R_WMAC_CTX_SUBTYPE(x) \ -+ (((x) & BIT_MASK_R_WMAC_CTX_SUBTYPE) << BIT_SHIFT_R_WMAC_CTX_SUBTYPE) -+#define BITS_R_WMAC_CTX_SUBTYPE \ -+ (BIT_MASK_R_WMAC_CTX_SUBTYPE << BIT_SHIFT_R_WMAC_CTX_SUBTYPE) -+#define BIT_CLEAR_R_WMAC_CTX_SUBTYPE(x) ((x) & (~BITS_R_WMAC_CTX_SUBTYPE)) -+#define BIT_GET_R_WMAC_CTX_SUBTYPE(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_CTX_SUBTYPE) & BIT_MASK_R_WMAC_CTX_SUBTYPE) -+#define BIT_SET_R_WMAC_CTX_SUBTYPE(x, v) \ -+ (BIT_CLEAR_R_WMAC_CTX_SUBTYPE(x) | BIT_R_WMAC_CTX_SUBTYPE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_RTX_CTX_SUBTYPE_CFG (Offset 0x0750) */ -+ -+#define BIT_SHIFT_R_WMAC_RTX_SUBTYPE 0 -+#define BIT_MASK_R_WMAC_RTX_SUBTYPE 0xf -+#define BIT_R_WMAC_RTX_SUBTYPE(x) \ -+ (((x) & BIT_MASK_R_WMAC_RTX_SUBTYPE) << BIT_SHIFT_R_WMAC_RTX_SUBTYPE) -+#define BITS_R_WMAC_RTX_SUBTYPE \ -+ (BIT_MASK_R_WMAC_RTX_SUBTYPE << BIT_SHIFT_R_WMAC_RTX_SUBTYPE) -+#define BIT_CLEAR_R_WMAC_RTX_SUBTYPE(x) ((x) & (~BITS_R_WMAC_RTX_SUBTYPE)) -+#define BIT_GET_R_WMAC_RTX_SUBTYPE(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RTX_SUBTYPE) & BIT_MASK_R_WMAC_RTX_SUBTYPE) -+#define BIT_SET_R_WMAC_RTX_SUBTYPE(x, v) \ -+ (BIT_CLEAR_R_WMAC_RTX_SUBTYPE(x) | BIT_R_WMAC_RTX_SUBTYPE(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_SWAES_DIO_B63_B32 (Offset 0x0754) */ -+ -+#define BIT_SHIFT_WMAC_SWAES_DIO_B63_B32 0 -+#define BIT_MASK_WMAC_SWAES_DIO_B63_B32 0xffffffffL -+#define BIT_WMAC_SWAES_DIO_B63_B32(x) \ -+ (((x) & BIT_MASK_WMAC_SWAES_DIO_B63_B32) \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B63_B32) -+#define BITS_WMAC_SWAES_DIO_B63_B32 \ -+ (BIT_MASK_WMAC_SWAES_DIO_B63_B32 << BIT_SHIFT_WMAC_SWAES_DIO_B63_B32) -+#define BIT_CLEAR_WMAC_SWAES_DIO_B63_B32(x) \ -+ ((x) & (~BITS_WMAC_SWAES_DIO_B63_B32)) -+#define BIT_GET_WMAC_SWAES_DIO_B63_B32(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SWAES_DIO_B63_B32) & \ -+ BIT_MASK_WMAC_SWAES_DIO_B63_B32) -+#define BIT_SET_WMAC_SWAES_DIO_B63_B32(x, v) \ -+ (BIT_CLEAR_WMAC_SWAES_DIO_B63_B32(x) | BIT_WMAC_SWAES_DIO_B63_B32(v)) -+ -+/* 2 REG_WMAC_SWAES_DIO_B95_B64 (Offset 0x0758) */ -+ -+#define BIT_SHIFT_WMAC_SWAES_DIO_B95_B64 0 -+#define BIT_MASK_WMAC_SWAES_DIO_B95_B64 0xffffffffL -+#define BIT_WMAC_SWAES_DIO_B95_B64(x) \ -+ (((x) & BIT_MASK_WMAC_SWAES_DIO_B95_B64) \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B95_B64) -+#define BITS_WMAC_SWAES_DIO_B95_B64 \ -+ (BIT_MASK_WMAC_SWAES_DIO_B95_B64 << BIT_SHIFT_WMAC_SWAES_DIO_B95_B64) -+#define BIT_CLEAR_WMAC_SWAES_DIO_B95_B64(x) \ -+ ((x) & (~BITS_WMAC_SWAES_DIO_B95_B64)) -+#define BIT_GET_WMAC_SWAES_DIO_B95_B64(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SWAES_DIO_B95_B64) & \ -+ BIT_MASK_WMAC_SWAES_DIO_B95_B64) -+#define BIT_SET_WMAC_SWAES_DIO_B95_B64(x, v) \ -+ (BIT_CLEAR_WMAC_SWAES_DIO_B95_B64(x) | BIT_WMAC_SWAES_DIO_B95_B64(v)) -+ -+/* 2 REG_WMAC_SWAES_DIO_B127_B96 (Offset 0x075C) */ -+ -+#define BIT_SHIFT_WMAC_SWAES_DIO_B127_B96 0 -+#define BIT_MASK_WMAC_SWAES_DIO_B127_B96 0xffffffffL -+#define BIT_WMAC_SWAES_DIO_B127_B96(x) \ -+ (((x) & BIT_MASK_WMAC_SWAES_DIO_B127_B96) \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B127_B96) -+#define BITS_WMAC_SWAES_DIO_B127_B96 \ -+ (BIT_MASK_WMAC_SWAES_DIO_B127_B96 << BIT_SHIFT_WMAC_SWAES_DIO_B127_B96) -+#define BIT_CLEAR_WMAC_SWAES_DIO_B127_B96(x) \ -+ ((x) & (~BITS_WMAC_SWAES_DIO_B127_B96)) -+#define BIT_GET_WMAC_SWAES_DIO_B127_B96(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SWAES_DIO_B127_B96) & \ -+ BIT_MASK_WMAC_SWAES_DIO_B127_B96) -+#define BIT_SET_WMAC_SWAES_DIO_B127_B96(x, v) \ -+ (BIT_CLEAR_WMAC_SWAES_DIO_B127_B96(x) | BIT_WMAC_SWAES_DIO_B127_B96(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WMAC_SWAES_CFG (Offset 0x0760) */ -+ -+#define BIT_SWAES_REQ BIT(7) -+#define BIT_CLR_SWAES_REQ BIT(6) -+#define BIT_R_WMAC_SWAES_WE BIT(3) -+#define BIT_R_WMAC_SWAES_SEL BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_COEX_V2 (Offset 0x0762) */ -+ -+#define BIT_GNT_BT_POLARITY BIT(12) -+#define BIT_GNT_BT_BYPASS_PRIORITY BIT(8) -+ -+#define BIT_SHIFT_TIMER 0 -+#define BIT_MASK_TIMER 0xff -+#define BIT_TIMER(x) (((x) & BIT_MASK_TIMER) << BIT_SHIFT_TIMER) -+#define BITS_TIMER (BIT_MASK_TIMER << BIT_SHIFT_TIMER) -+#define BIT_CLEAR_TIMER(x) ((x) & (~BITS_TIMER)) -+#define BIT_GET_TIMER(x) (((x) >> BIT_SHIFT_TIMER) & BIT_MASK_TIMER) -+#define BIT_SET_TIMER(x, v) (BIT_CLEAR_TIMER(x) | BIT_TIMER(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_COEX (Offset 0x0764) */ -+ -+#define BIT_R_GNT_BT_RFC_SW BIT(12) -+#define BIT_R_GNT_BT_RFC_SW_EN BIT(11) -+#define BIT_R_GNT_BT_BB_SW BIT(10) -+#define BIT_R_GNT_BT_BB_SW_EN BIT(9) -+#define BIT_R_BT_CNT_THREN BIT(8) -+ -+#define BIT_SHIFT_R_BT_CNT_THR 0 -+#define BIT_MASK_R_BT_CNT_THR 0xff -+#define BIT_R_BT_CNT_THR(x) \ -+ (((x) & BIT_MASK_R_BT_CNT_THR) << BIT_SHIFT_R_BT_CNT_THR) -+#define BITS_R_BT_CNT_THR (BIT_MASK_R_BT_CNT_THR << BIT_SHIFT_R_BT_CNT_THR) -+#define BIT_CLEAR_R_BT_CNT_THR(x) ((x) & (~BITS_R_BT_CNT_THR)) -+#define BIT_GET_R_BT_CNT_THR(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CNT_THR) & BIT_MASK_R_BT_CNT_THR) -+#define BIT_SET_R_BT_CNT_THR(x, v) \ -+ (BIT_CLEAR_R_BT_CNT_THR(x) | BIT_R_BT_CNT_THR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL (Offset 0x0768) */ -+ -+#define BIT_WLRX_TER_BY_CTL BIT(43) -+#define BIT_WLRX_TER_BY_AD BIT(42) -+#define BIT_ANT_DIVERSITY_SEL BIT(41) -+#define BIT_ANTSEL_FOR_BT_CTRL_EN BIT(40) -+#define BIT_WLACT_LOW_GNTWL_EN BIT(34) -+#define BIT_WLACT_HIGH_GNTBT_EN BIT(33) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL (Offset 0x0768) */ -+ -+#define BIT_NAV_UPPER_V1 BIT(32) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL (Offset 0x0768) */ -+ -+#define BIT_SHIFT_RXMYRTS_NAV_V1 8 -+#define BIT_MASK_RXMYRTS_NAV_V1 0xff -+#define BIT_RXMYRTS_NAV_V1(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_V1) << BIT_SHIFT_RXMYRTS_NAV_V1) -+#define BITS_RXMYRTS_NAV_V1 \ -+ (BIT_MASK_RXMYRTS_NAV_V1 << BIT_SHIFT_RXMYRTS_NAV_V1) -+#define BIT_CLEAR_RXMYRTS_NAV_V1(x) ((x) & (~BITS_RXMYRTS_NAV_V1)) -+#define BIT_GET_RXMYRTS_NAV_V1(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_V1) & BIT_MASK_RXMYRTS_NAV_V1) -+#define BIT_SET_RXMYRTS_NAV_V1(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_V1(x) | BIT_RXMYRTS_NAV_V1(v)) -+ -+#define BIT_SHIFT_RTSRST_V1 0 -+#define BIT_MASK_RTSRST_V1 0xff -+#define BIT_RTSRST_V1(x) (((x) & BIT_MASK_RTSRST_V1) << BIT_SHIFT_RTSRST_V1) -+#define BITS_RTSRST_V1 (BIT_MASK_RTSRST_V1 << BIT_SHIFT_RTSRST_V1) -+#define BIT_CLEAR_RTSRST_V1(x) ((x) & (~BITS_RTSRST_V1)) -+#define BIT_GET_RTSRST_V1(x) (((x) >> BIT_SHIFT_RTSRST_V1) & BIT_MASK_RTSRST_V1) -+#define BIT_SET_RTSRST_V1(x, v) (BIT_CLEAR_RTSRST_V1(x) | BIT_RTSRST_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_1 (Offset 0x076C) */ -+ -+#define BIT_WLRX_TER_BY_CTL_1 BIT(11) -+#define BIT_WLRX_TER_BY_AD_1 BIT(10) -+#define BIT_ANT_DIVERSITY_SEL_1 BIT(9) -+#define BIT_ANTSEL_FOR_BT_CTRL_EN_1 BIT(8) -+#define BIT_WLACT_LOW_GNTWL_EN_1 BIT(2) -+#define BIT_WLACT_HIGH_GNTBT_EN_1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_1 (Offset 0x076C) */ -+ -+#define BIT_NAV_UPPER_1_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_COEX_ENHANCED_INTR_CTRL (Offset 0x076E) */ -+ -+#define BIT_SHIFT_BT_STAT_DELAY 12 -+#define BIT_MASK_BT_STAT_DELAY 0xf -+#define BIT_BT_STAT_DELAY(x) \ -+ (((x) & BIT_MASK_BT_STAT_DELAY) << BIT_SHIFT_BT_STAT_DELAY) -+#define BITS_BT_STAT_DELAY (BIT_MASK_BT_STAT_DELAY << BIT_SHIFT_BT_STAT_DELAY) -+#define BIT_CLEAR_BT_STAT_DELAY(x) ((x) & (~BITS_BT_STAT_DELAY)) -+#define BIT_GET_BT_STAT_DELAY(x) \ -+ (((x) >> BIT_SHIFT_BT_STAT_DELAY) & BIT_MASK_BT_STAT_DELAY) -+#define BIT_SET_BT_STAT_DELAY(x, v) \ -+ (BIT_CLEAR_BT_STAT_DELAY(x) | BIT_BT_STAT_DELAY(v)) -+ -+#define BIT_SHIFT_BT_TRX_INIT_DETECT 8 -+#define BIT_MASK_BT_TRX_INIT_DETECT 0xf -+#define BIT_BT_TRX_INIT_DETECT(x) \ -+ (((x) & BIT_MASK_BT_TRX_INIT_DETECT) << BIT_SHIFT_BT_TRX_INIT_DETECT) -+#define BITS_BT_TRX_INIT_DETECT \ -+ (BIT_MASK_BT_TRX_INIT_DETECT << BIT_SHIFT_BT_TRX_INIT_DETECT) -+#define BIT_CLEAR_BT_TRX_INIT_DETECT(x) ((x) & (~BITS_BT_TRX_INIT_DETECT)) -+#define BIT_GET_BT_TRX_INIT_DETECT(x) \ -+ (((x) >> BIT_SHIFT_BT_TRX_INIT_DETECT) & BIT_MASK_BT_TRX_INIT_DETECT) -+#define BIT_SET_BT_TRX_INIT_DETECT(x, v) \ -+ (BIT_CLEAR_BT_TRX_INIT_DETECT(x) | BIT_BT_TRX_INIT_DETECT(v)) -+ -+#define BIT_SHIFT_BT_PRI_DETECT_TO 4 -+#define BIT_MASK_BT_PRI_DETECT_TO 0xf -+#define BIT_BT_PRI_DETECT_TO(x) \ -+ (((x) & BIT_MASK_BT_PRI_DETECT_TO) << BIT_SHIFT_BT_PRI_DETECT_TO) -+#define BITS_BT_PRI_DETECT_TO \ -+ (BIT_MASK_BT_PRI_DETECT_TO << BIT_SHIFT_BT_PRI_DETECT_TO) -+#define BIT_CLEAR_BT_PRI_DETECT_TO(x) ((x) & (~BITS_BT_PRI_DETECT_TO)) -+#define BIT_GET_BT_PRI_DETECT_TO(x) \ -+ (((x) >> BIT_SHIFT_BT_PRI_DETECT_TO) & BIT_MASK_BT_PRI_DETECT_TO) -+#define BIT_SET_BT_PRI_DETECT_TO(x, v) \ -+ (BIT_CLEAR_BT_PRI_DETECT_TO(x) | BIT_BT_PRI_DETECT_TO(v)) -+ -+#define BIT_R_GRANTALL_WLMASK BIT(3) -+#define BIT_STATIS_BT_EN BIT(2) -+#define BIT_WL_ACT_MASK_ENABLE BIT(1) -+#define BIT_ENHANCED_BT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BT_ACT_STATISTICS (Offset 0x0770) */ -+ -+#define BIT_SHIFT_STATIS_BT_LO_RX (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_STATIS_BT_LO_RX 0xffff -+#define BIT_STATIS_BT_LO_RX(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_RX) << BIT_SHIFT_STATIS_BT_LO_RX) -+#define BITS_STATIS_BT_LO_RX \ -+ (BIT_MASK_STATIS_BT_LO_RX << BIT_SHIFT_STATIS_BT_LO_RX) -+#define BIT_CLEAR_STATIS_BT_LO_RX(x) ((x) & (~BITS_STATIS_BT_LO_RX)) -+#define BIT_GET_STATIS_BT_LO_RX(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_RX) & BIT_MASK_STATIS_BT_LO_RX) -+#define BIT_SET_STATIS_BT_LO_RX(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_RX(x) | BIT_STATIS_BT_LO_RX(v)) -+ -+#define BIT_SHIFT_STATIS_BT_LO_TX (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_STATIS_BT_LO_TX 0xffff -+#define BIT_STATIS_BT_LO_TX(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_TX) << BIT_SHIFT_STATIS_BT_LO_TX) -+#define BITS_STATIS_BT_LO_TX \ -+ (BIT_MASK_STATIS_BT_LO_TX << BIT_SHIFT_STATIS_BT_LO_TX) -+#define BIT_CLEAR_STATIS_BT_LO_TX(x) ((x) & (~BITS_STATIS_BT_LO_TX)) -+#define BIT_GET_STATIS_BT_LO_TX(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_TX) & BIT_MASK_STATIS_BT_LO_TX) -+#define BIT_SET_STATIS_BT_LO_TX(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_TX(x) | BIT_STATIS_BT_LO_TX(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_ACT_STATISTICS (Offset 0x0770) */ -+ -+#define BIT_SHIFT_STATIS_BT_HI_RX 16 -+#define BIT_MASK_STATIS_BT_HI_RX 0xffff -+#define BIT_STATIS_BT_HI_RX(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_RX) << BIT_SHIFT_STATIS_BT_HI_RX) -+#define BITS_STATIS_BT_HI_RX \ -+ (BIT_MASK_STATIS_BT_HI_RX << BIT_SHIFT_STATIS_BT_HI_RX) -+#define BIT_CLEAR_STATIS_BT_HI_RX(x) ((x) & (~BITS_STATIS_BT_HI_RX)) -+#define BIT_GET_STATIS_BT_HI_RX(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_RX) & BIT_MASK_STATIS_BT_HI_RX) -+#define BIT_SET_STATIS_BT_HI_RX(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_RX(x) | BIT_STATIS_BT_HI_RX(v)) -+ -+#define BIT_SHIFT_STATIS_BT_HI_TX 0 -+#define BIT_MASK_STATIS_BT_HI_TX 0xffff -+#define BIT_STATIS_BT_HI_TX(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_TX) << BIT_SHIFT_STATIS_BT_HI_TX) -+#define BITS_STATIS_BT_HI_TX \ -+ (BIT_MASK_STATIS_BT_HI_TX << BIT_SHIFT_STATIS_BT_HI_TX) -+#define BIT_CLEAR_STATIS_BT_HI_TX(x) ((x) & (~BITS_STATIS_BT_HI_TX)) -+#define BIT_GET_STATIS_BT_HI_TX(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_TX) & BIT_MASK_STATIS_BT_HI_TX) -+#define BIT_SET_STATIS_BT_HI_TX(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_TX(x) | BIT_STATIS_BT_HI_TX(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_ACT_STATISTICS_1 (Offset 0x0774) */ -+ -+#define BIT_APPEND_MACID_IN_RESP_EN_1 BIT(18) -+#define BIT_ADDR2_MATCH_EN_1 BIT(17) -+ -+#define BIT_SHIFT_STATIS_BT_LO_RX_1 16 -+#define BIT_MASK_STATIS_BT_LO_RX_1 0xffff -+#define BIT_STATIS_BT_LO_RX_1(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_RX_1) << BIT_SHIFT_STATIS_BT_LO_RX_1) -+#define BITS_STATIS_BT_LO_RX_1 \ -+ (BIT_MASK_STATIS_BT_LO_RX_1 << BIT_SHIFT_STATIS_BT_LO_RX_1) -+#define BIT_CLEAR_STATIS_BT_LO_RX_1(x) ((x) & (~BITS_STATIS_BT_LO_RX_1)) -+#define BIT_GET_STATIS_BT_LO_RX_1(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_RX_1) & BIT_MASK_STATIS_BT_LO_RX_1) -+#define BIT_SET_STATIS_BT_LO_RX_1(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_RX_1(x) | BIT_STATIS_BT_LO_RX_1(v)) -+ -+#define BIT_ANTTRN_EN_1 BIT(16) -+ -+#define BIT_SHIFT_STATIS_BT_LO_TX_1 0 -+#define BIT_MASK_STATIS_BT_LO_TX_1 0xffff -+#define BIT_STATIS_BT_LO_TX_1(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_TX_1) << BIT_SHIFT_STATIS_BT_LO_TX_1) -+#define BITS_STATIS_BT_LO_TX_1 \ -+ (BIT_MASK_STATIS_BT_LO_TX_1 << BIT_SHIFT_STATIS_BT_LO_TX_1) -+#define BIT_CLEAR_STATIS_BT_LO_TX_1(x) ((x) & (~BITS_STATIS_BT_LO_TX_1)) -+#define BIT_GET_STATIS_BT_LO_TX_1(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_TX_1) & BIT_MASK_STATIS_BT_LO_TX_1) -+#define BIT_SET_STATIS_BT_LO_TX_1(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_TX_1(x) | BIT_STATIS_BT_LO_TX_1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_STATISTICS_CONTROL_REGISTER (Offset 0x0778) */ -+ -+#define BIT_SHIFT_R_BT_CMD_RPT 16 -+#define BIT_MASK_R_BT_CMD_RPT 0xffff -+#define BIT_R_BT_CMD_RPT(x) \ -+ (((x) & BIT_MASK_R_BT_CMD_RPT) << BIT_SHIFT_R_BT_CMD_RPT) -+#define BITS_R_BT_CMD_RPT (BIT_MASK_R_BT_CMD_RPT << BIT_SHIFT_R_BT_CMD_RPT) -+#define BIT_CLEAR_R_BT_CMD_RPT(x) ((x) & (~BITS_R_BT_CMD_RPT)) -+#define BIT_GET_R_BT_CMD_RPT(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CMD_RPT) & BIT_MASK_R_BT_CMD_RPT) -+#define BIT_SET_R_BT_CMD_RPT(x, v) \ -+ (BIT_CLEAR_R_BT_CMD_RPT(x) | BIT_R_BT_CMD_RPT(v)) -+ -+#define BIT_SHIFT_R_RPT_FROM_BT 8 -+#define BIT_MASK_R_RPT_FROM_BT 0xff -+#define BIT_R_RPT_FROM_BT(x) \ -+ (((x) & BIT_MASK_R_RPT_FROM_BT) << BIT_SHIFT_R_RPT_FROM_BT) -+#define BITS_R_RPT_FROM_BT (BIT_MASK_R_RPT_FROM_BT << BIT_SHIFT_R_RPT_FROM_BT) -+#define BIT_CLEAR_R_RPT_FROM_BT(x) ((x) & (~BITS_R_RPT_FROM_BT)) -+#define BIT_GET_R_RPT_FROM_BT(x) \ -+ (((x) >> BIT_SHIFT_R_RPT_FROM_BT) & BIT_MASK_R_RPT_FROM_BT) -+#define BIT_SET_R_RPT_FROM_BT(x, v) \ -+ (BIT_CLEAR_R_RPT_FROM_BT(x) | BIT_R_RPT_FROM_BT(v)) -+ -+#define BIT_SHIFT_BT_HID_ISR_SET 6 -+#define BIT_MASK_BT_HID_ISR_SET 0x3 -+#define BIT_BT_HID_ISR_SET(x) \ -+ (((x) & BIT_MASK_BT_HID_ISR_SET) << BIT_SHIFT_BT_HID_ISR_SET) -+#define BITS_BT_HID_ISR_SET \ -+ (BIT_MASK_BT_HID_ISR_SET << BIT_SHIFT_BT_HID_ISR_SET) -+#define BIT_CLEAR_BT_HID_ISR_SET(x) ((x) & (~BITS_BT_HID_ISR_SET)) -+#define BIT_GET_BT_HID_ISR_SET(x) \ -+ (((x) >> BIT_SHIFT_BT_HID_ISR_SET) & BIT_MASK_BT_HID_ISR_SET) -+#define BIT_SET_BT_HID_ISR_SET(x, v) \ -+ (BIT_CLEAR_BT_HID_ISR_SET(x) | BIT_BT_HID_ISR_SET(v)) -+ -+#define BIT_TDMA_BT_START_NOTIFY BIT(5) -+#define BIT_ENABLE_TDMA_FW_MODE BIT(4) -+#define BIT_ENABLE_PTA_TDMA_MODE BIT(3) -+#define BIT_ENABLE_COEXIST_TAB_IN_TDMA BIT(2) -+#define BIT_GPIO2_GPIO3_EXANGE_OR_NO_BT_CCA BIT(1) -+#define BIT_RTK_BT_ENABLE BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_STATUS_REPORT_REGISTER (Offset 0x077C) */ -+ -+#define BIT_SHIFT_BT_PROFILE 24 -+#define BIT_MASK_BT_PROFILE 0xff -+#define BIT_BT_PROFILE(x) (((x) & BIT_MASK_BT_PROFILE) << BIT_SHIFT_BT_PROFILE) -+#define BITS_BT_PROFILE (BIT_MASK_BT_PROFILE << BIT_SHIFT_BT_PROFILE) -+#define BIT_CLEAR_BT_PROFILE(x) ((x) & (~BITS_BT_PROFILE)) -+#define BIT_GET_BT_PROFILE(x) \ -+ (((x) >> BIT_SHIFT_BT_PROFILE) & BIT_MASK_BT_PROFILE) -+#define BIT_SET_BT_PROFILE(x, v) (BIT_CLEAR_BT_PROFILE(x) | BIT_BT_PROFILE(v)) -+ -+#define BIT_SHIFT_BT_POWER 16 -+#define BIT_MASK_BT_POWER 0xff -+#define BIT_BT_POWER(x) (((x) & BIT_MASK_BT_POWER) << BIT_SHIFT_BT_POWER) -+#define BITS_BT_POWER (BIT_MASK_BT_POWER << BIT_SHIFT_BT_POWER) -+#define BIT_CLEAR_BT_POWER(x) ((x) & (~BITS_BT_POWER)) -+#define BIT_GET_BT_POWER(x) (((x) >> BIT_SHIFT_BT_POWER) & BIT_MASK_BT_POWER) -+#define BIT_SET_BT_POWER(x, v) (BIT_CLEAR_BT_POWER(x) | BIT_BT_POWER(v)) -+ -+#define BIT_SHIFT_BT_PREDECT_STATUS 8 -+#define BIT_MASK_BT_PREDECT_STATUS 0xff -+#define BIT_BT_PREDECT_STATUS(x) \ -+ (((x) & BIT_MASK_BT_PREDECT_STATUS) << BIT_SHIFT_BT_PREDECT_STATUS) -+#define BITS_BT_PREDECT_STATUS \ -+ (BIT_MASK_BT_PREDECT_STATUS << BIT_SHIFT_BT_PREDECT_STATUS) -+#define BIT_CLEAR_BT_PREDECT_STATUS(x) ((x) & (~BITS_BT_PREDECT_STATUS)) -+#define BIT_GET_BT_PREDECT_STATUS(x) \ -+ (((x) >> BIT_SHIFT_BT_PREDECT_STATUS) & BIT_MASK_BT_PREDECT_STATUS) -+#define BIT_SET_BT_PREDECT_STATUS(x, v) \ -+ (BIT_CLEAR_BT_PREDECT_STATUS(x) | BIT_BT_PREDECT_STATUS(v)) -+ -+#define BIT_SHIFT_BT_CMD_INFO 0 -+#define BIT_MASK_BT_CMD_INFO 0xff -+#define BIT_BT_CMD_INFO(x) \ -+ (((x) & BIT_MASK_BT_CMD_INFO) << BIT_SHIFT_BT_CMD_INFO) -+#define BITS_BT_CMD_INFO (BIT_MASK_BT_CMD_INFO << BIT_SHIFT_BT_CMD_INFO) -+#define BIT_CLEAR_BT_CMD_INFO(x) ((x) & (~BITS_BT_CMD_INFO)) -+#define BIT_GET_BT_CMD_INFO(x) \ -+ (((x) >> BIT_SHIFT_BT_CMD_INFO) & BIT_MASK_BT_CMD_INFO) -+#define BIT_SET_BT_CMD_INFO(x, v) \ -+ (BIT_CLEAR_BT_CMD_INFO(x) | BIT_BT_CMD_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_INTERRUPT_CONTROL_REGISTER (Offset 0x0780) */ -+ -+#define BIT_EN_MAC_NULL_PKT_NOTIFY BIT(31) -+#define BIT_EN_WLAN_RPT_AND_BT_QUERY BIT(30) -+#define BIT_EN_BT_STSTUS_RPT BIT(29) -+#define BIT_EN_BT_POWER BIT(28) -+#define BIT_EN_BT_CHANNEL BIT(27) -+#define BIT_EN_BT_SLOT_CHANGE BIT(26) -+#define BIT_EN_BT_PROFILE_OR_HID BIT(25) -+#define BIT_WLAN_RPT_NOTIFY BIT(24) -+ -+#define BIT_SHIFT_WLAN_RPT_DATA 16 -+#define BIT_MASK_WLAN_RPT_DATA 0xff -+#define BIT_WLAN_RPT_DATA(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_DATA) << BIT_SHIFT_WLAN_RPT_DATA) -+#define BITS_WLAN_RPT_DATA (BIT_MASK_WLAN_RPT_DATA << BIT_SHIFT_WLAN_RPT_DATA) -+#define BIT_CLEAR_WLAN_RPT_DATA(x) ((x) & (~BITS_WLAN_RPT_DATA)) -+#define BIT_GET_WLAN_RPT_DATA(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_DATA) & BIT_MASK_WLAN_RPT_DATA) -+#define BIT_SET_WLAN_RPT_DATA(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_DATA(x) | BIT_WLAN_RPT_DATA(v)) -+ -+#define BIT_SHIFT_CMD_ID 8 -+#define BIT_MASK_CMD_ID 0xff -+#define BIT_CMD_ID(x) (((x) & BIT_MASK_CMD_ID) << BIT_SHIFT_CMD_ID) -+#define BITS_CMD_ID (BIT_MASK_CMD_ID << BIT_SHIFT_CMD_ID) -+#define BIT_CLEAR_CMD_ID(x) ((x) & (~BITS_CMD_ID)) -+#define BIT_GET_CMD_ID(x) (((x) >> BIT_SHIFT_CMD_ID) & BIT_MASK_CMD_ID) -+#define BIT_SET_CMD_ID(x, v) (BIT_CLEAR_CMD_ID(x) | BIT_CMD_ID(v)) -+ -+#define BIT_SHIFT_BT_DATA 0 -+#define BIT_MASK_BT_DATA 0xff -+#define BIT_BT_DATA(x) (((x) & BIT_MASK_BT_DATA) << BIT_SHIFT_BT_DATA) -+#define BITS_BT_DATA (BIT_MASK_BT_DATA << BIT_SHIFT_BT_DATA) -+#define BIT_CLEAR_BT_DATA(x) ((x) & (~BITS_BT_DATA)) -+#define BIT_GET_BT_DATA(x) (((x) >> BIT_SHIFT_BT_DATA) & BIT_MASK_BT_DATA) -+#define BIT_SET_BT_DATA(x, v) (BIT_CLEAR_BT_DATA(x) | BIT_BT_DATA(v)) -+ -+/* 2 REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER (Offset 0x0784) */ -+ -+#define BIT_SHIFT_WLAN_RPT_TO 0 -+#define BIT_MASK_WLAN_RPT_TO 0xff -+#define BIT_WLAN_RPT_TO(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_TO) << BIT_SHIFT_WLAN_RPT_TO) -+#define BITS_WLAN_RPT_TO (BIT_MASK_WLAN_RPT_TO << BIT_SHIFT_WLAN_RPT_TO) -+#define BIT_CLEAR_WLAN_RPT_TO(x) ((x) & (~BITS_WLAN_RPT_TO)) -+#define BIT_GET_WLAN_RPT_TO(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_TO) & BIT_MASK_WLAN_RPT_TO) -+#define BIT_SET_WLAN_RPT_TO(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_TO(x) | BIT_WLAN_RPT_TO(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER (Offset 0x0785) */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_0 1 -+#define BIT_MASK_ISOLATION_CHK_0 0x7fffff -+#define BIT_ISOLATION_CHK_0(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_0) << BIT_SHIFT_ISOLATION_CHK_0) -+#define BITS_ISOLATION_CHK_0 \ -+ (BIT_MASK_ISOLATION_CHK_0 << BIT_SHIFT_ISOLATION_CHK_0) -+#define BIT_CLEAR_ISOLATION_CHK_0(x) ((x) & (~BITS_ISOLATION_CHK_0)) -+#define BIT_GET_ISOLATION_CHK_0(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_0) & BIT_MASK_ISOLATION_CHK_0) -+#define BIT_SET_ISOLATION_CHK_0(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_0(x) | BIT_ISOLATION_CHK_0(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER (Offset 0x0785) */ -+ -+#define BIT_SHIFT_ISOLATION_CHK 1 -+#define BIT_MASK_ISOLATION_CHK 0x7fffffffffffffffffffL -+#define BIT_ISOLATION_CHK(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK) << BIT_SHIFT_ISOLATION_CHK) -+#define BITS_ISOLATION_CHK (BIT_MASK_ISOLATION_CHK << BIT_SHIFT_ISOLATION_CHK) -+#define BIT_CLEAR_ISOLATION_CHK(x) ((x) & (~BITS_ISOLATION_CHK)) -+#define BIT_GET_ISOLATION_CHK(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK) & BIT_MASK_ISOLATION_CHK) -+#define BIT_SET_ISOLATION_CHK(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK(x) | BIT_ISOLATION_CHK(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER (Offset 0x0785) */ -+ -+#define BIT_ISOLATION_EN BIT(0) -+ -+#define BIT_SHIFT_R_CCK_LEN 0 -+#define BIT_MASK_R_CCK_LEN 0xffff -+#define BIT_R_CCK_LEN(x) (((x) & BIT_MASK_R_CCK_LEN) << BIT_SHIFT_R_CCK_LEN) -+#define BITS_R_CCK_LEN (BIT_MASK_R_CCK_LEN << BIT_SHIFT_R_CCK_LEN) -+#define BIT_CLEAR_R_CCK_LEN(x) ((x) & (~BITS_R_CCK_LEN)) -+#define BIT_GET_R_CCK_LEN(x) (((x) >> BIT_SHIFT_R_CCK_LEN) & BIT_MASK_R_CCK_LEN) -+#define BIT_SET_R_CCK_LEN(x, v) (BIT_CLEAR_R_CCK_LEN(x) | BIT_R_CCK_LEN(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_1 (Offset 0x0788) */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_1 0 -+#define BIT_MASK_ISOLATION_CHK_1 0xffffffffL -+#define BIT_ISOLATION_CHK_1(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_1) << BIT_SHIFT_ISOLATION_CHK_1) -+#define BITS_ISOLATION_CHK_1 \ -+ (BIT_MASK_ISOLATION_CHK_1 << BIT_SHIFT_ISOLATION_CHK_1) -+#define BIT_CLEAR_ISOLATION_CHK_1(x) ((x) & (~BITS_ISOLATION_CHK_1)) -+#define BIT_GET_ISOLATION_CHK_1(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_1) & BIT_MASK_ISOLATION_CHK_1) -+#define BIT_SET_ISOLATION_CHK_1(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_1(x) | BIT_ISOLATION_CHK_1(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_2 (Offset 0x078C) */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_2 0 -+#define BIT_MASK_ISOLATION_CHK_2 0xffffff -+#define BIT_ISOLATION_CHK_2(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_2) << BIT_SHIFT_ISOLATION_CHK_2) -+#define BITS_ISOLATION_CHK_2 \ -+ (BIT_MASK_ISOLATION_CHK_2 << BIT_SHIFT_ISOLATION_CHK_2) -+#define BIT_CLEAR_ISOLATION_CHK_2(x) ((x) & (~BITS_ISOLATION_CHK_2)) -+#define BIT_GET_ISOLATION_CHK_2(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_2) & BIT_MASK_ISOLATION_CHK_2) -+#define BIT_SET_ISOLATION_CHK_2(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_2(x) | BIT_ISOLATION_CHK_2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_INTERRUPT_STATUS_REGISTER (Offset 0x078F) */ -+ -+#define BIT_BT_HID_ISR BIT(7) -+#define BIT_BT_QUERY_ISR BIT(6) -+#define BIT_MAC_NULL_PKT_NOTIFY_ISR BIT(5) -+#define BIT_WLAN_RPT_ISR BIT(4) -+#define BIT_BT_POWER_ISR BIT(3) -+#define BIT_BT_CHANNEL_ISR BIT(2) -+#define BIT_BT_SLOT_CHANGE_ISR BIT(1) -+#define BIT_BT_PROFILE_ISR BIT(0) -+ -+/* 2 REG_BT_TDMA_TIME_REGISTER (Offset 0x0790) */ -+ -+#define BIT_SHIFT_BT_TIME 6 -+#define BIT_MASK_BT_TIME 0x3ffffff -+#define BIT_BT_TIME(x) (((x) & BIT_MASK_BT_TIME) << BIT_SHIFT_BT_TIME) -+#define BITS_BT_TIME (BIT_MASK_BT_TIME << BIT_SHIFT_BT_TIME) -+#define BIT_CLEAR_BT_TIME(x) ((x) & (~BITS_BT_TIME)) -+#define BIT_GET_BT_TIME(x) (((x) >> BIT_SHIFT_BT_TIME) & BIT_MASK_BT_TIME) -+#define BIT_SET_BT_TIME(x, v) (BIT_CLEAR_BT_TIME(x) | BIT_BT_TIME(v)) -+ -+#define BIT_SHIFT_BT_RPT_SAMPLE_RATE 0 -+#define BIT_MASK_BT_RPT_SAMPLE_RATE 0x3f -+#define BIT_BT_RPT_SAMPLE_RATE(x) \ -+ (((x) & BIT_MASK_BT_RPT_SAMPLE_RATE) << BIT_SHIFT_BT_RPT_SAMPLE_RATE) -+#define BITS_BT_RPT_SAMPLE_RATE \ -+ (BIT_MASK_BT_RPT_SAMPLE_RATE << BIT_SHIFT_BT_RPT_SAMPLE_RATE) -+#define BIT_CLEAR_BT_RPT_SAMPLE_RATE(x) ((x) & (~BITS_BT_RPT_SAMPLE_RATE)) -+#define BIT_GET_BT_RPT_SAMPLE_RATE(x) \ -+ (((x) >> BIT_SHIFT_BT_RPT_SAMPLE_RATE) & BIT_MASK_BT_RPT_SAMPLE_RATE) -+#define BIT_SET_BT_RPT_SAMPLE_RATE(x, v) \ -+ (BIT_CLEAR_BT_RPT_SAMPLE_RATE(x) | BIT_BT_RPT_SAMPLE_RATE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BT_ACT_REGISTER (Offset 0x0794) */ -+ -+#define BIT_SHIFT_R_OFDM_LEN 26 -+#define BIT_MASK_R_OFDM_LEN 0x3f -+#define BIT_R_OFDM_LEN(x) (((x) & BIT_MASK_R_OFDM_LEN) << BIT_SHIFT_R_OFDM_LEN) -+#define BITS_R_OFDM_LEN (BIT_MASK_R_OFDM_LEN << BIT_SHIFT_R_OFDM_LEN) -+#define BIT_CLEAR_R_OFDM_LEN(x) ((x) & (~BITS_R_OFDM_LEN)) -+#define BIT_GET_R_OFDM_LEN(x) \ -+ (((x) >> BIT_SHIFT_R_OFDM_LEN) & BIT_MASK_R_OFDM_LEN) -+#define BIT_SET_R_OFDM_LEN(x, v) (BIT_CLEAR_R_OFDM_LEN(x) | BIT_R_OFDM_LEN(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_ACT_REGISTER (Offset 0x0794) */ -+ -+#define BIT_SHIFT_BT_EISR_EN 16 -+#define BIT_MASK_BT_EISR_EN 0xff -+#define BIT_BT_EISR_EN(x) (((x) & BIT_MASK_BT_EISR_EN) << BIT_SHIFT_BT_EISR_EN) -+#define BITS_BT_EISR_EN (BIT_MASK_BT_EISR_EN << BIT_SHIFT_BT_EISR_EN) -+#define BIT_CLEAR_BT_EISR_EN(x) ((x) & (~BITS_BT_EISR_EN)) -+#define BIT_GET_BT_EISR_EN(x) \ -+ (((x) >> BIT_SHIFT_BT_EISR_EN) & BIT_MASK_BT_EISR_EN) -+#define BIT_SET_BT_EISR_EN(x, v) (BIT_CLEAR_BT_EISR_EN(x) | BIT_BT_EISR_EN(v)) -+ -+#define BIT_BT_ACT_FALLING_ISR BIT(10) -+#define BIT_BT_ACT_RISING_ISR BIT(9) -+#define BIT_TDMA_TO_ISR BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BT_ACT_REGISTER (Offset 0x0794) */ -+ -+#define BIT_SHIFT_BT_CH 0 -+#define BIT_MASK_BT_CH 0xff -+#define BIT_BT_CH(x) (((x) & BIT_MASK_BT_CH) << BIT_SHIFT_BT_CH) -+#define BITS_BT_CH (BIT_MASK_BT_CH << BIT_SHIFT_BT_CH) -+#define BIT_CLEAR_BT_CH(x) ((x) & (~BITS_BT_CH)) -+#define BIT_GET_BT_CH(x) (((x) >> BIT_SHIFT_BT_CH) & BIT_MASK_BT_CH) -+#define BIT_SET_BT_CH(x, v) (BIT_CLEAR_BT_CH(x) | BIT_BT_CH(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BT_ACT_REGISTER (Offset 0x0794) */ -+ -+#define BIT_SHIFT_BT_CH_V1 0 -+#define BIT_MASK_BT_CH_V1 0x7f -+#define BIT_BT_CH_V1(x) (((x) & BIT_MASK_BT_CH_V1) << BIT_SHIFT_BT_CH_V1) -+#define BITS_BT_CH_V1 (BIT_MASK_BT_CH_V1 << BIT_SHIFT_BT_CH_V1) -+#define BIT_CLEAR_BT_CH_V1(x) ((x) & (~BITS_BT_CH_V1)) -+#define BIT_GET_BT_CH_V1(x) (((x) >> BIT_SHIFT_BT_CH_V1) & BIT_MASK_BT_CH_V1) -+#define BIT_SET_BT_CH_V1(x, v) (BIT_CLEAR_BT_CH_V1(x) | BIT_BT_CH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_OBFF_CTRL_BASIC (Offset 0x0798) */ -+ -+#define BIT_OBFF_EN_V1 BIT(31) -+ -+#define BIT_SHIFT_OBFF_STATE_V1 28 -+#define BIT_MASK_OBFF_STATE_V1 0x3 -+#define BIT_OBFF_STATE_V1(x) \ -+ (((x) & BIT_MASK_OBFF_STATE_V1) << BIT_SHIFT_OBFF_STATE_V1) -+#define BITS_OBFF_STATE_V1 (BIT_MASK_OBFF_STATE_V1 << BIT_SHIFT_OBFF_STATE_V1) -+#define BIT_CLEAR_OBFF_STATE_V1(x) ((x) & (~BITS_OBFF_STATE_V1)) -+#define BIT_GET_OBFF_STATE_V1(x) \ -+ (((x) >> BIT_SHIFT_OBFF_STATE_V1) & BIT_MASK_OBFF_STATE_V1) -+#define BIT_SET_OBFF_STATE_V1(x, v) \ -+ (BIT_CLEAR_OBFF_STATE_V1(x) | BIT_OBFF_STATE_V1(v)) -+ -+#define BIT_OBFF_ACT_RXDMA_EN BIT(27) -+#define BIT_OBFF_BLOCK_INT_EN BIT(26) -+#define BIT_OBFF_AUTOACT_EN BIT(25) -+#define BIT_OBFF_AUTOIDLE_EN BIT(24) -+ -+#define BIT_SHIFT_WAKE_MAX_PLS 20 -+#define BIT_MASK_WAKE_MAX_PLS 0x7 -+#define BIT_WAKE_MAX_PLS(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_PLS) << BIT_SHIFT_WAKE_MAX_PLS) -+#define BITS_WAKE_MAX_PLS (BIT_MASK_WAKE_MAX_PLS << BIT_SHIFT_WAKE_MAX_PLS) -+#define BIT_CLEAR_WAKE_MAX_PLS(x) ((x) & (~BITS_WAKE_MAX_PLS)) -+#define BIT_GET_WAKE_MAX_PLS(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_PLS) & BIT_MASK_WAKE_MAX_PLS) -+#define BIT_SET_WAKE_MAX_PLS(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_PLS(x) | BIT_WAKE_MAX_PLS(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_PLS 16 -+#define BIT_MASK_WAKE_MIN_PLS 0x7 -+#define BIT_WAKE_MIN_PLS(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_PLS) << BIT_SHIFT_WAKE_MIN_PLS) -+#define BITS_WAKE_MIN_PLS (BIT_MASK_WAKE_MIN_PLS << BIT_SHIFT_WAKE_MIN_PLS) -+#define BIT_CLEAR_WAKE_MIN_PLS(x) ((x) & (~BITS_WAKE_MIN_PLS)) -+#define BIT_GET_WAKE_MIN_PLS(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_PLS) & BIT_MASK_WAKE_MIN_PLS) -+#define BIT_SET_WAKE_MIN_PLS(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_PLS(x) | BIT_WAKE_MIN_PLS(v)) -+ -+#define BIT_SHIFT_WAKE_MAX_F2F 12 -+#define BIT_MASK_WAKE_MAX_F2F 0x7 -+#define BIT_WAKE_MAX_F2F(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_F2F) << BIT_SHIFT_WAKE_MAX_F2F) -+#define BITS_WAKE_MAX_F2F (BIT_MASK_WAKE_MAX_F2F << BIT_SHIFT_WAKE_MAX_F2F) -+#define BIT_CLEAR_WAKE_MAX_F2F(x) ((x) & (~BITS_WAKE_MAX_F2F)) -+#define BIT_GET_WAKE_MAX_F2F(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_F2F) & BIT_MASK_WAKE_MAX_F2F) -+#define BIT_SET_WAKE_MAX_F2F(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_F2F(x) | BIT_WAKE_MAX_F2F(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_F2F 8 -+#define BIT_MASK_WAKE_MIN_F2F 0x7 -+#define BIT_WAKE_MIN_F2F(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_F2F) << BIT_SHIFT_WAKE_MIN_F2F) -+#define BITS_WAKE_MIN_F2F (BIT_MASK_WAKE_MIN_F2F << BIT_SHIFT_WAKE_MIN_F2F) -+#define BIT_CLEAR_WAKE_MIN_F2F(x) ((x) & (~BITS_WAKE_MIN_F2F)) -+#define BIT_GET_WAKE_MIN_F2F(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_F2F) & BIT_MASK_WAKE_MIN_F2F) -+#define BIT_SET_WAKE_MIN_F2F(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_F2F(x) | BIT_WAKE_MIN_F2F(v)) -+ -+#define BIT_APP_CPU_ACT_V1 BIT(3) -+#define BIT_APP_OBFF_V1 BIT(2) -+#define BIT_APP_IDLE_V1 BIT(1) -+#define BIT_APP_INIT_V1 BIT(0) -+ -+/* 2 REG_OBFF_CTRL2_TIMER (Offset 0x079C) */ -+ -+#define BIT_SHIFT_RX_HIGH_TIMER_IDX 24 -+#define BIT_MASK_RX_HIGH_TIMER_IDX 0x7 -+#define BIT_RX_HIGH_TIMER_IDX(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TIMER_IDX) << BIT_SHIFT_RX_HIGH_TIMER_IDX) -+#define BITS_RX_HIGH_TIMER_IDX \ -+ (BIT_MASK_RX_HIGH_TIMER_IDX << BIT_SHIFT_RX_HIGH_TIMER_IDX) -+#define BIT_CLEAR_RX_HIGH_TIMER_IDX(x) ((x) & (~BITS_RX_HIGH_TIMER_IDX)) -+#define BIT_GET_RX_HIGH_TIMER_IDX(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TIMER_IDX) & BIT_MASK_RX_HIGH_TIMER_IDX) -+#define BIT_SET_RX_HIGH_TIMER_IDX(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TIMER_IDX(x) | BIT_RX_HIGH_TIMER_IDX(v)) -+ -+#define BIT_SHIFT_RX_MED_TIMER_IDX 16 -+#define BIT_MASK_RX_MED_TIMER_IDX 0x7 -+#define BIT_RX_MED_TIMER_IDX(x) \ -+ (((x) & BIT_MASK_RX_MED_TIMER_IDX) << BIT_SHIFT_RX_MED_TIMER_IDX) -+#define BITS_RX_MED_TIMER_IDX \ -+ (BIT_MASK_RX_MED_TIMER_IDX << BIT_SHIFT_RX_MED_TIMER_IDX) -+#define BIT_CLEAR_RX_MED_TIMER_IDX(x) ((x) & (~BITS_RX_MED_TIMER_IDX)) -+#define BIT_GET_RX_MED_TIMER_IDX(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TIMER_IDX) & BIT_MASK_RX_MED_TIMER_IDX) -+#define BIT_SET_RX_MED_TIMER_IDX(x, v) \ -+ (BIT_CLEAR_RX_MED_TIMER_IDX(x) | BIT_RX_MED_TIMER_IDX(v)) -+ -+#define BIT_SHIFT_RX_LOW_TIMER_IDX 8 -+#define BIT_MASK_RX_LOW_TIMER_IDX 0x7 -+#define BIT_RX_LOW_TIMER_IDX(x) \ -+ (((x) & BIT_MASK_RX_LOW_TIMER_IDX) << BIT_SHIFT_RX_LOW_TIMER_IDX) -+#define BITS_RX_LOW_TIMER_IDX \ -+ (BIT_MASK_RX_LOW_TIMER_IDX << BIT_SHIFT_RX_LOW_TIMER_IDX) -+#define BIT_CLEAR_RX_LOW_TIMER_IDX(x) ((x) & (~BITS_RX_LOW_TIMER_IDX)) -+#define BIT_GET_RX_LOW_TIMER_IDX(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TIMER_IDX) & BIT_MASK_RX_LOW_TIMER_IDX) -+#define BIT_SET_RX_LOW_TIMER_IDX(x, v) \ -+ (BIT_CLEAR_RX_LOW_TIMER_IDX(x) | BIT_RX_LOW_TIMER_IDX(v)) -+ -+#define BIT_SHIFT_OBFF_INT_TIMER_IDX 0 -+#define BIT_MASK_OBFF_INT_TIMER_IDX 0x7 -+#define BIT_OBFF_INT_TIMER_IDX(x) \ -+ (((x) & BIT_MASK_OBFF_INT_TIMER_IDX) << BIT_SHIFT_OBFF_INT_TIMER_IDX) -+#define BITS_OBFF_INT_TIMER_IDX \ -+ (BIT_MASK_OBFF_INT_TIMER_IDX << BIT_SHIFT_OBFF_INT_TIMER_IDX) -+#define BIT_CLEAR_OBFF_INT_TIMER_IDX(x) ((x) & (~BITS_OBFF_INT_TIMER_IDX)) -+#define BIT_GET_OBFF_INT_TIMER_IDX(x) \ -+ (((x) >> BIT_SHIFT_OBFF_INT_TIMER_IDX) & BIT_MASK_OBFF_INT_TIMER_IDX) -+#define BIT_SET_OBFF_INT_TIMER_IDX(x, v) \ -+ (BIT_CLEAR_OBFF_INT_TIMER_IDX(x) | BIT_OBFF_INT_TIMER_IDX(v)) -+ -+/* 2 REG_LTR_CTRL_BASIC (Offset 0x07A0) */ -+ -+#define BIT_LTR_EN_V1 BIT(31) -+#define BIT_LTR_HW_EN_V1 BIT(30) -+#define BIT_LRT_ACT_CTS_EN BIT(29) -+#define BIT_LTR_ACT_RXPKT_EN BIT(28) -+#define BIT_LTR_ACT_RXDMA_EN BIT(27) -+#define BIT_LTR_IDLE_NO_SNOOP BIT(26) -+#define BIT_SPDUP_MGTPKT BIT(25) -+#define BIT_RX_AGG_EN BIT(24) -+#define BIT_APP_LTR_ACT BIT(23) -+#define BIT_APP_LTR_IDLE BIT(22) -+ -+#define BIT_SHIFT_HIGH_RATE_TRIG_SEL 20 -+#define BIT_MASK_HIGH_RATE_TRIG_SEL 0x3 -+#define BIT_HIGH_RATE_TRIG_SEL(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_TRIG_SEL) << BIT_SHIFT_HIGH_RATE_TRIG_SEL) -+#define BITS_HIGH_RATE_TRIG_SEL \ -+ (BIT_MASK_HIGH_RATE_TRIG_SEL << BIT_SHIFT_HIGH_RATE_TRIG_SEL) -+#define BIT_CLEAR_HIGH_RATE_TRIG_SEL(x) ((x) & (~BITS_HIGH_RATE_TRIG_SEL)) -+#define BIT_GET_HIGH_RATE_TRIG_SEL(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_TRIG_SEL) & BIT_MASK_HIGH_RATE_TRIG_SEL) -+#define BIT_SET_HIGH_RATE_TRIG_SEL(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_TRIG_SEL(x) | BIT_HIGH_RATE_TRIG_SEL(v)) -+ -+#define BIT_SHIFT_MED_RATE_TRIG_SEL 18 -+#define BIT_MASK_MED_RATE_TRIG_SEL 0x3 -+#define BIT_MED_RATE_TRIG_SEL(x) \ -+ (((x) & BIT_MASK_MED_RATE_TRIG_SEL) << BIT_SHIFT_MED_RATE_TRIG_SEL) -+#define BITS_MED_RATE_TRIG_SEL \ -+ (BIT_MASK_MED_RATE_TRIG_SEL << BIT_SHIFT_MED_RATE_TRIG_SEL) -+#define BIT_CLEAR_MED_RATE_TRIG_SEL(x) ((x) & (~BITS_MED_RATE_TRIG_SEL)) -+#define BIT_GET_MED_RATE_TRIG_SEL(x) \ -+ (((x) >> BIT_SHIFT_MED_RATE_TRIG_SEL) & BIT_MASK_MED_RATE_TRIG_SEL) -+#define BIT_SET_MED_RATE_TRIG_SEL(x, v) \ -+ (BIT_CLEAR_MED_RATE_TRIG_SEL(x) | BIT_MED_RATE_TRIG_SEL(v)) -+ -+#define BIT_SHIFT_LOW_RATE_TRIG_SEL 16 -+#define BIT_MASK_LOW_RATE_TRIG_SEL 0x3 -+#define BIT_LOW_RATE_TRIG_SEL(x) \ -+ (((x) & BIT_MASK_LOW_RATE_TRIG_SEL) << BIT_SHIFT_LOW_RATE_TRIG_SEL) -+#define BITS_LOW_RATE_TRIG_SEL \ -+ (BIT_MASK_LOW_RATE_TRIG_SEL << BIT_SHIFT_LOW_RATE_TRIG_SEL) -+#define BIT_CLEAR_LOW_RATE_TRIG_SEL(x) ((x) & (~BITS_LOW_RATE_TRIG_SEL)) -+#define BIT_GET_LOW_RATE_TRIG_SEL(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_TRIG_SEL) & BIT_MASK_LOW_RATE_TRIG_SEL) -+#define BIT_SET_LOW_RATE_TRIG_SEL(x, v) \ -+ (BIT_CLEAR_LOW_RATE_TRIG_SEL(x) | BIT_LOW_RATE_TRIG_SEL(v)) -+ -+#define BIT_SHIFT_HIGH_RATE_BD_IDX 8 -+#define BIT_MASK_HIGH_RATE_BD_IDX 0x7f -+#define BIT_HIGH_RATE_BD_IDX(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_BD_IDX) << BIT_SHIFT_HIGH_RATE_BD_IDX) -+#define BITS_HIGH_RATE_BD_IDX \ -+ (BIT_MASK_HIGH_RATE_BD_IDX << BIT_SHIFT_HIGH_RATE_BD_IDX) -+#define BIT_CLEAR_HIGH_RATE_BD_IDX(x) ((x) & (~BITS_HIGH_RATE_BD_IDX)) -+#define BIT_GET_HIGH_RATE_BD_IDX(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_BD_IDX) & BIT_MASK_HIGH_RATE_BD_IDX) -+#define BIT_SET_HIGH_RATE_BD_IDX(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_BD_IDX(x) | BIT_HIGH_RATE_BD_IDX(v)) -+ -+#define BIT_SHIFT_LOW_RATE_BD_IDX 0 -+#define BIT_MASK_LOW_RATE_BD_IDX 0x7f -+#define BIT_LOW_RATE_BD_IDX(x) \ -+ (((x) & BIT_MASK_LOW_RATE_BD_IDX) << BIT_SHIFT_LOW_RATE_BD_IDX) -+#define BITS_LOW_RATE_BD_IDX \ -+ (BIT_MASK_LOW_RATE_BD_IDX << BIT_SHIFT_LOW_RATE_BD_IDX) -+#define BIT_CLEAR_LOW_RATE_BD_IDX(x) ((x) & (~BITS_LOW_RATE_BD_IDX)) -+#define BIT_GET_LOW_RATE_BD_IDX(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_BD_IDX) & BIT_MASK_LOW_RATE_BD_IDX) -+#define BIT_SET_LOW_RATE_BD_IDX(x, v) \ -+ (BIT_CLEAR_LOW_RATE_BD_IDX(x) | BIT_LOW_RATE_BD_IDX(v)) -+ -+/* 2 REG_LTR_CTRL2_TIMER_THRESHOLD (Offset 0x07A4) */ -+ -+#define BIT_SHIFT_RX_EMPTY_TIMER_IDX 24 -+#define BIT_MASK_RX_EMPTY_TIMER_IDX 0x7 -+#define BIT_RX_EMPTY_TIMER_IDX(x) \ -+ (((x) & BIT_MASK_RX_EMPTY_TIMER_IDX) << BIT_SHIFT_RX_EMPTY_TIMER_IDX) -+#define BITS_RX_EMPTY_TIMER_IDX \ -+ (BIT_MASK_RX_EMPTY_TIMER_IDX << BIT_SHIFT_RX_EMPTY_TIMER_IDX) -+#define BIT_CLEAR_RX_EMPTY_TIMER_IDX(x) ((x) & (~BITS_RX_EMPTY_TIMER_IDX)) -+#define BIT_GET_RX_EMPTY_TIMER_IDX(x) \ -+ (((x) >> BIT_SHIFT_RX_EMPTY_TIMER_IDX) & BIT_MASK_RX_EMPTY_TIMER_IDX) -+#define BIT_SET_RX_EMPTY_TIMER_IDX(x, v) \ -+ (BIT_CLEAR_RX_EMPTY_TIMER_IDX(x) | BIT_RX_EMPTY_TIMER_IDX(v)) -+ -+#define BIT_SHIFT_RX_AFULL_TH_IDX 20 -+#define BIT_MASK_RX_AFULL_TH_IDX 0x7 -+#define BIT_RX_AFULL_TH_IDX(x) \ -+ (((x) & BIT_MASK_RX_AFULL_TH_IDX) << BIT_SHIFT_RX_AFULL_TH_IDX) -+#define BITS_RX_AFULL_TH_IDX \ -+ (BIT_MASK_RX_AFULL_TH_IDX << BIT_SHIFT_RX_AFULL_TH_IDX) -+#define BIT_CLEAR_RX_AFULL_TH_IDX(x) ((x) & (~BITS_RX_AFULL_TH_IDX)) -+#define BIT_GET_RX_AFULL_TH_IDX(x) \ -+ (((x) >> BIT_SHIFT_RX_AFULL_TH_IDX) & BIT_MASK_RX_AFULL_TH_IDX) -+#define BIT_SET_RX_AFULL_TH_IDX(x, v) \ -+ (BIT_CLEAR_RX_AFULL_TH_IDX(x) | BIT_RX_AFULL_TH_IDX(v)) -+ -+#define BIT_SHIFT_RX_HIGH_TH_IDX 16 -+#define BIT_MASK_RX_HIGH_TH_IDX 0x7 -+#define BIT_RX_HIGH_TH_IDX(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TH_IDX) << BIT_SHIFT_RX_HIGH_TH_IDX) -+#define BITS_RX_HIGH_TH_IDX \ -+ (BIT_MASK_RX_HIGH_TH_IDX << BIT_SHIFT_RX_HIGH_TH_IDX) -+#define BIT_CLEAR_RX_HIGH_TH_IDX(x) ((x) & (~BITS_RX_HIGH_TH_IDX)) -+#define BIT_GET_RX_HIGH_TH_IDX(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TH_IDX) & BIT_MASK_RX_HIGH_TH_IDX) -+#define BIT_SET_RX_HIGH_TH_IDX(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TH_IDX(x) | BIT_RX_HIGH_TH_IDX(v)) -+ -+#define BIT_SHIFT_RX_MED_TH_IDX 12 -+#define BIT_MASK_RX_MED_TH_IDX 0x7 -+#define BIT_RX_MED_TH_IDX(x) \ -+ (((x) & BIT_MASK_RX_MED_TH_IDX) << BIT_SHIFT_RX_MED_TH_IDX) -+#define BITS_RX_MED_TH_IDX (BIT_MASK_RX_MED_TH_IDX << BIT_SHIFT_RX_MED_TH_IDX) -+#define BIT_CLEAR_RX_MED_TH_IDX(x) ((x) & (~BITS_RX_MED_TH_IDX)) -+#define BIT_GET_RX_MED_TH_IDX(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TH_IDX) & BIT_MASK_RX_MED_TH_IDX) -+#define BIT_SET_RX_MED_TH_IDX(x, v) \ -+ (BIT_CLEAR_RX_MED_TH_IDX(x) | BIT_RX_MED_TH_IDX(v)) -+ -+#define BIT_SHIFT_RX_LOW_TH_IDX 8 -+#define BIT_MASK_RX_LOW_TH_IDX 0x7 -+#define BIT_RX_LOW_TH_IDX(x) \ -+ (((x) & BIT_MASK_RX_LOW_TH_IDX) << BIT_SHIFT_RX_LOW_TH_IDX) -+#define BITS_RX_LOW_TH_IDX (BIT_MASK_RX_LOW_TH_IDX << BIT_SHIFT_RX_LOW_TH_IDX) -+#define BIT_CLEAR_RX_LOW_TH_IDX(x) ((x) & (~BITS_RX_LOW_TH_IDX)) -+#define BIT_GET_RX_LOW_TH_IDX(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TH_IDX) & BIT_MASK_RX_LOW_TH_IDX) -+#define BIT_SET_RX_LOW_TH_IDX(x, v) \ -+ (BIT_CLEAR_RX_LOW_TH_IDX(x) | BIT_RX_LOW_TH_IDX(v)) -+ -+#define BIT_SHIFT_LTR_SPACE_IDX 4 -+#define BIT_MASK_LTR_SPACE_IDX 0x3 -+#define BIT_LTR_SPACE_IDX(x) \ -+ (((x) & BIT_MASK_LTR_SPACE_IDX) << BIT_SHIFT_LTR_SPACE_IDX) -+#define BITS_LTR_SPACE_IDX (BIT_MASK_LTR_SPACE_IDX << BIT_SHIFT_LTR_SPACE_IDX) -+#define BIT_CLEAR_LTR_SPACE_IDX(x) ((x) & (~BITS_LTR_SPACE_IDX)) -+#define BIT_GET_LTR_SPACE_IDX(x) \ -+ (((x) >> BIT_SHIFT_LTR_SPACE_IDX) & BIT_MASK_LTR_SPACE_IDX) -+#define BIT_SET_LTR_SPACE_IDX(x, v) \ -+ (BIT_CLEAR_LTR_SPACE_IDX(x) | BIT_LTR_SPACE_IDX(v)) -+ -+#define BIT_SHIFT_LTR_IDLE_TIMER_IDX 0 -+#define BIT_MASK_LTR_IDLE_TIMER_IDX 0x7 -+#define BIT_LTR_IDLE_TIMER_IDX(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_TIMER_IDX) << BIT_SHIFT_LTR_IDLE_TIMER_IDX) -+#define BITS_LTR_IDLE_TIMER_IDX \ -+ (BIT_MASK_LTR_IDLE_TIMER_IDX << BIT_SHIFT_LTR_IDLE_TIMER_IDX) -+#define BIT_CLEAR_LTR_IDLE_TIMER_IDX(x) ((x) & (~BITS_LTR_IDLE_TIMER_IDX)) -+#define BIT_GET_LTR_IDLE_TIMER_IDX(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_TIMER_IDX) & BIT_MASK_LTR_IDLE_TIMER_IDX) -+#define BIT_SET_LTR_IDLE_TIMER_IDX(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_TIMER_IDX(x) | BIT_LTR_IDLE_TIMER_IDX(v)) -+ -+/* 2 REG_LTR_IDLE_LATENCY_V1 (Offset 0x07A8) */ -+ -+#define BIT_SHIFT_LTR_IDLE_L 0 -+#define BIT_MASK_LTR_IDLE_L 0xffffffffL -+#define BIT_LTR_IDLE_L(x) (((x) & BIT_MASK_LTR_IDLE_L) << BIT_SHIFT_LTR_IDLE_L) -+#define BITS_LTR_IDLE_L (BIT_MASK_LTR_IDLE_L << BIT_SHIFT_LTR_IDLE_L) -+#define BIT_CLEAR_LTR_IDLE_L(x) ((x) & (~BITS_LTR_IDLE_L)) -+#define BIT_GET_LTR_IDLE_L(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_L) & BIT_MASK_LTR_IDLE_L) -+#define BIT_SET_LTR_IDLE_L(x, v) (BIT_CLEAR_LTR_IDLE_L(x) | BIT_LTR_IDLE_L(v)) -+ -+/* 2 REG_LTR_ACTIVE_LATENCY_V1 (Offset 0x07AC) */ -+ -+#define BIT_SHIFT_LTR_ACT_L 0 -+#define BIT_MASK_LTR_ACT_L 0xffffffffL -+#define BIT_LTR_ACT_L(x) (((x) & BIT_MASK_LTR_ACT_L) << BIT_SHIFT_LTR_ACT_L) -+#define BITS_LTR_ACT_L (BIT_MASK_LTR_ACT_L << BIT_SHIFT_LTR_ACT_L) -+#define BIT_CLEAR_LTR_ACT_L(x) ((x) & (~BITS_LTR_ACT_L)) -+#define BIT_GET_LTR_ACT_L(x) (((x) >> BIT_SHIFT_LTR_ACT_L) & BIT_MASK_LTR_ACT_L) -+#define BIT_SET_LTR_ACT_L(x, v) (BIT_CLEAR_LTR_ACT_L(x) | BIT_LTR_ACT_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_LTR_ACTIVE_LATENCY_V1 (Offset 0x07AC) */ -+ -+#define BIT_SHIFT_ANT_ADDR2_1 0 -+#define BIT_MASK_ANT_ADDR2_1 0xffffffffL -+#define BIT_ANT_ADDR2_1(x) \ -+ (((x) & BIT_MASK_ANT_ADDR2_1) << BIT_SHIFT_ANT_ADDR2_1) -+#define BITS_ANT_ADDR2_1 (BIT_MASK_ANT_ADDR2_1 << BIT_SHIFT_ANT_ADDR2_1) -+#define BIT_CLEAR_ANT_ADDR2_1(x) ((x) & (~BITS_ANT_ADDR2_1)) -+#define BIT_GET_ANT_ADDR2_1(x) \ -+ (((x) >> BIT_SHIFT_ANT_ADDR2_1) & BIT_MASK_ANT_ADDR2_1) -+#define BIT_SET_ANT_ADDR2_1(x, v) \ -+ (BIT_CLEAR_ANT_ADDR2_1(x) | BIT_ANT_ADDR2_1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER (Offset 0x07B0) */ -+ -+#define BIT_APPEND_MACID_IN_RESP_EN BIT(50) -+#define BIT_ADDR2_MATCH_EN BIT(49) -+#define BIT_ANTTRN_EN BIT(48) -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR 0 -+#define BIT_MASK_TRAIN_STA_ADDR 0xffffffffffffL -+#define BIT_TRAIN_STA_ADDR(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR) << BIT_SHIFT_TRAIN_STA_ADDR) -+#define BITS_TRAIN_STA_ADDR \ -+ (BIT_MASK_TRAIN_STA_ADDR << BIT_SHIFT_TRAIN_STA_ADDR) -+#define BIT_CLEAR_TRAIN_STA_ADDR(x) ((x) & (~BITS_TRAIN_STA_ADDR)) -+#define BIT_GET_TRAIN_STA_ADDR(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR) & BIT_MASK_TRAIN_STA_ADDR) -+#define BIT_SET_TRAIN_STA_ADDR(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR(x) | BIT_TRAIN_STA_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER (Offset 0x07B0) */ -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR_0 0 -+#define BIT_MASK_TRAIN_STA_ADDR_0 0xffffffffL -+#define BIT_TRAIN_STA_ADDR_0(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR_0) << BIT_SHIFT_TRAIN_STA_ADDR_0) -+#define BITS_TRAIN_STA_ADDR_0 \ -+ (BIT_MASK_TRAIN_STA_ADDR_0 << BIT_SHIFT_TRAIN_STA_ADDR_0) -+#define BIT_CLEAR_TRAIN_STA_ADDR_0(x) ((x) & (~BITS_TRAIN_STA_ADDR_0)) -+#define BIT_GET_TRAIN_STA_ADDR_0(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR_0) & BIT_MASK_TRAIN_STA_ADDR_0) -+#define BIT_SET_TRAIN_STA_ADDR_0(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR_0(x) | BIT_TRAIN_STA_ADDR_0(v)) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER_1 (Offset 0x07B4) */ -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR_1 0 -+#define BIT_MASK_TRAIN_STA_ADDR_1 0xffff -+#define BIT_TRAIN_STA_ADDR_1(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR_1) << BIT_SHIFT_TRAIN_STA_ADDR_1) -+#define BITS_TRAIN_STA_ADDR_1 \ -+ (BIT_MASK_TRAIN_STA_ADDR_1 << BIT_SHIFT_TRAIN_STA_ADDR_1) -+#define BIT_CLEAR_TRAIN_STA_ADDR_1(x) ((x) & (~BITS_TRAIN_STA_ADDR_1)) -+#define BIT_GET_TRAIN_STA_ADDR_1(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR_1) & BIT_MASK_TRAIN_STA_ADDR_1) -+#define BIT_SET_TRAIN_STA_ADDR_1(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR_1(x) | BIT_TRAIN_STA_ADDR_1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SMART_ANT_CTRL (Offset 0x07B4) */ -+ -+#define BIT_SHIFT_ANT_ADDR2_2 0 -+#define BIT_MASK_ANT_ADDR2_2 0xffff -+#define BIT_ANT_ADDR2_2(x) \ -+ (((x) & BIT_MASK_ANT_ADDR2_2) << BIT_SHIFT_ANT_ADDR2_2) -+#define BITS_ANT_ADDR2_2 (BIT_MASK_ANT_ADDR2_2 << BIT_SHIFT_ANT_ADDR2_2) -+#define BIT_CLEAR_ANT_ADDR2_2(x) ((x) & (~BITS_ANT_ADDR2_2)) -+#define BIT_GET_ANT_ADDR2_2(x) \ -+ (((x) >> BIT_SHIFT_ANT_ADDR2_2) & BIT_MASK_ANT_ADDR2_2) -+#define BIT_SET_ANT_ADDR2_2(x, v) \ -+ (BIT_CLEAR_ANT_ADDR2_2(x) | BIT_ANT_ADDR2_2(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_PKTCNT_RWD (Offset 0x07B8) */ -+ -+#define BIT_SHIFT_PKTCNT_BSSIDMAP 4 -+#define BIT_MASK_PKTCNT_BSSIDMAP 0xf -+#define BIT_PKTCNT_BSSIDMAP(x) \ -+ (((x) & BIT_MASK_PKTCNT_BSSIDMAP) << BIT_SHIFT_PKTCNT_BSSIDMAP) -+#define BITS_PKTCNT_BSSIDMAP \ -+ (BIT_MASK_PKTCNT_BSSIDMAP << BIT_SHIFT_PKTCNT_BSSIDMAP) -+#define BIT_CLEAR_PKTCNT_BSSIDMAP(x) ((x) & (~BITS_PKTCNT_BSSIDMAP)) -+#define BIT_GET_PKTCNT_BSSIDMAP(x) \ -+ (((x) >> BIT_SHIFT_PKTCNT_BSSIDMAP) & BIT_MASK_PKTCNT_BSSIDMAP) -+#define BIT_SET_PKTCNT_BSSIDMAP(x, v) \ -+ (BIT_CLEAR_PKTCNT_BSSIDMAP(x) | BIT_PKTCNT_BSSIDMAP(v)) -+ -+#define BIT_PKTCNT_CNTRST BIT(1) -+#define BIT_PKTCNT_CNTEN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CONTROL_FRAME_REPORT (Offset 0x07B8) */ -+ -+#define BIT_SHIFT_CONTROL_FRAME_REPORT 0 -+#define BIT_MASK_CONTROL_FRAME_REPORT 0xffffffffL -+#define BIT_CONTROL_FRAME_REPORT(x) \ -+ (((x) & BIT_MASK_CONTROL_FRAME_REPORT) \ -+ << BIT_SHIFT_CONTROL_FRAME_REPORT) -+#define BITS_CONTROL_FRAME_REPORT \ -+ (BIT_MASK_CONTROL_FRAME_REPORT << BIT_SHIFT_CONTROL_FRAME_REPORT) -+#define BIT_CLEAR_CONTROL_FRAME_REPORT(x) ((x) & (~BITS_CONTROL_FRAME_REPORT)) -+#define BIT_GET_CONTROL_FRAME_REPORT(x) \ -+ (((x) >> BIT_SHIFT_CONTROL_FRAME_REPORT) & \ -+ BIT_MASK_CONTROL_FRAME_REPORT) -+#define BIT_SET_CONTROL_FRAME_REPORT(x, v) \ -+ (BIT_CLEAR_CONTROL_FRAME_REPORT(x) | BIT_CONTROL_FRAME_REPORT(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_PKTCNT_CTRL (Offset 0x07BC) */ -+ -+#define BIT_WMAC_PKTCNT_TRST BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CONTROL_FRAME_CNT_CTRL (Offset 0x07BC) */ -+ -+#define BIT_ALLCNTRST BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_PKTCNT_CTRL (Offset 0x07BC) */ -+ -+#define BIT_WMAC_PKTCNT_FEN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CONTROL_FRAME_CNT_CTRL (Offset 0x07BC) */ -+ -+#define BIT__ALLCNTEN BIT(8) -+ -+#define BIT_SHIFT_ADDR 4 -+#define BIT_MASK_ADDR 0xf -+#define BIT_ADDR(x) (((x) & BIT_MASK_ADDR) << BIT_SHIFT_ADDR) -+#define BITS_ADDR (BIT_MASK_ADDR << BIT_SHIFT_ADDR) -+#define BIT_CLEAR_ADDR(x) ((x) & (~BITS_ADDR)) -+#define BIT_GET_ADDR(x) (((x) >> BIT_SHIFT_ADDR) & BIT_MASK_ADDR) -+#define BIT_SET_ADDR(x, v) (BIT_CLEAR_ADDR(x) | BIT_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_WMAC_PKTCNT_CTRL (Offset 0x07BC) */ -+ -+#define BIT_SHIFT_WMAC_PKTCNT_CFGAD 0 -+#define BIT_MASK_WMAC_PKTCNT_CFGAD 0xff -+#define BIT_WMAC_PKTCNT_CFGAD(x) \ -+ (((x) & BIT_MASK_WMAC_PKTCNT_CFGAD) << BIT_SHIFT_WMAC_PKTCNT_CFGAD) -+#define BITS_WMAC_PKTCNT_CFGAD \ -+ (BIT_MASK_WMAC_PKTCNT_CFGAD << BIT_SHIFT_WMAC_PKTCNT_CFGAD) -+#define BIT_CLEAR_WMAC_PKTCNT_CFGAD(x) ((x) & (~BITS_WMAC_PKTCNT_CFGAD)) -+#define BIT_GET_WMAC_PKTCNT_CFGAD(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PKTCNT_CFGAD) & BIT_MASK_WMAC_PKTCNT_CFGAD) -+#define BIT_SET_WMAC_PKTCNT_CFGAD(x, v) \ -+ (BIT_CLEAR_WMAC_PKTCNT_CFGAD(x) | BIT_WMAC_PKTCNT_CFGAD(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CONTROL_FRAME_CNT_CTRL (Offset 0x07BC) */ -+ -+#define BIT_SHIFT_CTRL_SEL 0 -+#define BIT_MASK_CTRL_SEL 0xf -+#define BIT_CTRL_SEL(x) (((x) & BIT_MASK_CTRL_SEL) << BIT_SHIFT_CTRL_SEL) -+#define BITS_CTRL_SEL (BIT_MASK_CTRL_SEL << BIT_SHIFT_CTRL_SEL) -+#define BIT_CLEAR_CTRL_SEL(x) ((x) & (~BITS_CTRL_SEL)) -+#define BIT_GET_CTRL_SEL(x) (((x) >> BIT_SHIFT_CTRL_SEL) & BIT_MASK_CTRL_SEL) -+#define BIT_SET_CTRL_SEL(x, v) (BIT_CLEAR_CTRL_SEL(x) | BIT_CTRL_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_IQ_DUMP (Offset 0x07C0) */ -+ -+#define BIT_SHIFT_R_WMAC_MATCH_REF_MAC (64 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_MATCH_REF_MAC 0xffffffffL -+#define BIT_R_WMAC_MATCH_REF_MAC(x) \ -+ (((x) & BIT_MASK_R_WMAC_MATCH_REF_MAC) \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC) -+#define BITS_R_WMAC_MATCH_REF_MAC \ -+ (BIT_MASK_R_WMAC_MATCH_REF_MAC << BIT_SHIFT_R_WMAC_MATCH_REF_MAC) -+#define BIT_CLEAR_R_WMAC_MATCH_REF_MAC(x) ((x) & (~BITS_R_WMAC_MATCH_REF_MAC)) -+#define BIT_GET_R_WMAC_MATCH_REF_MAC(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MATCH_REF_MAC) & \ -+ BIT_MASK_R_WMAC_MATCH_REF_MAC) -+#define BIT_SET_R_WMAC_MATCH_REF_MAC(x, v) \ -+ (BIT_CLEAR_R_WMAC_MATCH_REF_MAC(x) | BIT_R_WMAC_MATCH_REF_MAC(v)) -+ -+#define BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_RXFIFO_FULL_TH 0xff -+#define BIT_R_WMAC_RXFIFO_FULL_TH(x) \ -+ (((x) & BIT_MASK_R_WMAC_RXFIFO_FULL_TH) \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH) -+#define BITS_R_WMAC_RXFIFO_FULL_TH \ -+ (BIT_MASK_R_WMAC_RXFIFO_FULL_TH << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH) -+#define BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH(x) ((x) & (~BITS_R_WMAC_RXFIFO_FULL_TH)) -+#define BIT_GET_R_WMAC_RXFIFO_FULL_TH(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH) & \ -+ BIT_MASK_R_WMAC_RXFIFO_FULL_TH) -+#define BIT_SET_R_WMAC_RXFIFO_FULL_TH(x, v) \ -+ (BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH(x) | BIT_R_WMAC_RXFIFO_FULL_TH(v)) -+ -+#define BIT_R_WMAC_SRCH_TXRPT_TYPE BIT(51) -+#define BIT_R_WMAC_NDP_RST BIT(50) -+#define BIT_R_WMAC_POWINT_EN BIT(49) -+#define BIT_R_WMAC_SRCH_TXRPT_PERPKT BIT(48) -+#define BIT_R_WMAC_SRCH_TXRPT_MID BIT(47) -+#define BIT_R_WMAC_PFIN_TOEN BIT(46) -+#define BIT_R_WMAC_FIL_SECERR BIT(45) -+#define BIT_R_WMAC_FIL_CTLPKTLEN BIT(44) -+#define BIT_R_WMAC_FIL_FCTYPE BIT(43) -+#define BIT_R_WMAC_FIL_FCPROVER BIT(42) -+#define BIT_R_WMAC_PHYSTS_SNIF BIT(41) -+#define BIT_R_WMAC_PHYSTS_PLCP BIT(40) -+#define BIT_R_MAC_TCR_VBONF_RD BIT(39) -+#define BIT_R_WMAC_TCR_MPAR_NDP BIT(38) -+#define BIT_R_WMAC_NDP_FILTER BIT(37) -+#define BIT_R_WMAC_RXLEN_SEL BIT(36) -+#define BIT_R_WMAC_RXLEN_SEL1 BIT(35) -+#define BIT_R_OFDM_FILTER BIT(34) -+#define BIT_R_WMAC_CHK_OFDM_LEN BIT(33) -+ -+#define BIT_SHIFT_R_WMAC_MASK_LA_MAC (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_MASK_LA_MAC 0xffffffffL -+#define BIT_R_WMAC_MASK_LA_MAC(x) \ -+ (((x) & BIT_MASK_R_WMAC_MASK_LA_MAC) << BIT_SHIFT_R_WMAC_MASK_LA_MAC) -+#define BITS_R_WMAC_MASK_LA_MAC \ -+ (BIT_MASK_R_WMAC_MASK_LA_MAC << BIT_SHIFT_R_WMAC_MASK_LA_MAC) -+#define BIT_CLEAR_R_WMAC_MASK_LA_MAC(x) ((x) & (~BITS_R_WMAC_MASK_LA_MAC)) -+#define BIT_GET_R_WMAC_MASK_LA_MAC(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MASK_LA_MAC) & BIT_MASK_R_WMAC_MASK_LA_MAC) -+#define BIT_SET_R_WMAC_MASK_LA_MAC(x, v) \ -+ (BIT_CLEAR_R_WMAC_MASK_LA_MAC(x) | BIT_R_WMAC_MASK_LA_MAC(v)) -+ -+#define BIT_R_WMAC_CHK_CCK_LEN BIT(32) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL (Offset 0x07C0) */ -+ -+#define BIT_LTECOEX_ACCESS_START BIT(31) -+#define BIT_LTECOEX_WRITE_MODE BIT(30) -+#define BIT_LTECOEX_READY_BIT BIT(29) -+ -+#define BIT_SHIFT_WRITE_BYTE_EN 16 -+#define BIT_MASK_WRITE_BYTE_EN 0xf -+#define BIT_WRITE_BYTE_EN(x) \ -+ (((x) & BIT_MASK_WRITE_BYTE_EN) << BIT_SHIFT_WRITE_BYTE_EN) -+#define BITS_WRITE_BYTE_EN (BIT_MASK_WRITE_BYTE_EN << BIT_SHIFT_WRITE_BYTE_EN) -+#define BIT_CLEAR_WRITE_BYTE_EN(x) ((x) & (~BITS_WRITE_BYTE_EN)) -+#define BIT_GET_WRITE_BYTE_EN(x) \ -+ (((x) >> BIT_SHIFT_WRITE_BYTE_EN) & BIT_MASK_WRITE_BYTE_EN) -+#define BIT_SET_WRITE_BYTE_EN(x, v) \ -+ (BIT_CLEAR_WRITE_BYTE_EN(x) | BIT_WRITE_BYTE_EN(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_IQ_DUMP (Offset 0x07C0) */ -+ -+#define BIT_SHIFT_DUMP_OK_ADDR 16 -+#define BIT_MASK_DUMP_OK_ADDR 0xffff -+#define BIT_DUMP_OK_ADDR(x) \ -+ (((x) & BIT_MASK_DUMP_OK_ADDR) << BIT_SHIFT_DUMP_OK_ADDR) -+#define BITS_DUMP_OK_ADDR (BIT_MASK_DUMP_OK_ADDR << BIT_SHIFT_DUMP_OK_ADDR) -+#define BIT_CLEAR_DUMP_OK_ADDR(x) ((x) & (~BITS_DUMP_OK_ADDR)) -+#define BIT_GET_DUMP_OK_ADDR(x) \ -+ (((x) >> BIT_SHIFT_DUMP_OK_ADDR) & BIT_MASK_DUMP_OK_ADDR) -+#define BIT_SET_DUMP_OK_ADDR(x, v) \ -+ (BIT_CLEAR_DUMP_OK_ADDR(x) | BIT_DUMP_OK_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_IQ_DUMP (Offset 0x07C0) */ -+ -+#define BIT_SHIFT_DUMP_OK_ADDR_V1 15 -+#define BIT_MASK_DUMP_OK_ADDR_V1 0x1ffff -+#define BIT_DUMP_OK_ADDR_V1(x) \ -+ (((x) & BIT_MASK_DUMP_OK_ADDR_V1) << BIT_SHIFT_DUMP_OK_ADDR_V1) -+#define BITS_DUMP_OK_ADDR_V1 \ -+ (BIT_MASK_DUMP_OK_ADDR_V1 << BIT_SHIFT_DUMP_OK_ADDR_V1) -+#define BIT_CLEAR_DUMP_OK_ADDR_V1(x) ((x) & (~BITS_DUMP_OK_ADDR_V1)) -+#define BIT_GET_DUMP_OK_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_DUMP_OK_ADDR_V1) & BIT_MASK_DUMP_OK_ADDR_V1) -+#define BIT_SET_DUMP_OK_ADDR_V1(x, v) \ -+ (BIT_CLEAR_DUMP_OK_ADDR_V1(x) | BIT_DUMP_OK_ADDR_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_IQ_DUMP (Offset 0x07C0) */ -+ -+#define BIT_MACDBG_TRIG_IQDUMP BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_IQ_DUMP (Offset 0x07C0) */ -+ -+#define BIT_SHIFT_R_TRIG_TIME_SEL 8 -+#define BIT_MASK_R_TRIG_TIME_SEL 0x7f -+#define BIT_R_TRIG_TIME_SEL(x) \ -+ (((x) & BIT_MASK_R_TRIG_TIME_SEL) << BIT_SHIFT_R_TRIG_TIME_SEL) -+#define BITS_R_TRIG_TIME_SEL \ -+ (BIT_MASK_R_TRIG_TIME_SEL << BIT_SHIFT_R_TRIG_TIME_SEL) -+#define BIT_CLEAR_R_TRIG_TIME_SEL(x) ((x) & (~BITS_R_TRIG_TIME_SEL)) -+#define BIT_GET_R_TRIG_TIME_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_TRIG_TIME_SEL) & BIT_MASK_R_TRIG_TIME_SEL) -+#define BIT_SET_R_TRIG_TIME_SEL(x, v) \ -+ (BIT_CLEAR_R_TRIG_TIME_SEL(x) | BIT_R_TRIG_TIME_SEL(v)) -+ -+#define BIT_SHIFT_R_MAC_TRIG_SEL 6 -+#define BIT_MASK_R_MAC_TRIG_SEL 0x3 -+#define BIT_R_MAC_TRIG_SEL(x) \ -+ (((x) & BIT_MASK_R_MAC_TRIG_SEL) << BIT_SHIFT_R_MAC_TRIG_SEL) -+#define BITS_R_MAC_TRIG_SEL \ -+ (BIT_MASK_R_MAC_TRIG_SEL << BIT_SHIFT_R_MAC_TRIG_SEL) -+#define BIT_CLEAR_R_MAC_TRIG_SEL(x) ((x) & (~BITS_R_MAC_TRIG_SEL)) -+#define BIT_GET_R_MAC_TRIG_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_TRIG_SEL) & BIT_MASK_R_MAC_TRIG_SEL) -+#define BIT_SET_R_MAC_TRIG_SEL(x, v) \ -+ (BIT_CLEAR_R_MAC_TRIG_SEL(x) | BIT_R_MAC_TRIG_SEL(v)) -+ -+#define BIT_MAC_TRIG_REG BIT(5) -+ -+#define BIT_SHIFT_R_LEVEL_PULSE_SEL 3 -+#define BIT_MASK_R_LEVEL_PULSE_SEL 0x3 -+#define BIT_R_LEVEL_PULSE_SEL(x) \ -+ (((x) & BIT_MASK_R_LEVEL_PULSE_SEL) << BIT_SHIFT_R_LEVEL_PULSE_SEL) -+#define BITS_R_LEVEL_PULSE_SEL \ -+ (BIT_MASK_R_LEVEL_PULSE_SEL << BIT_SHIFT_R_LEVEL_PULSE_SEL) -+#define BIT_CLEAR_R_LEVEL_PULSE_SEL(x) ((x) & (~BITS_R_LEVEL_PULSE_SEL)) -+#define BIT_GET_R_LEVEL_PULSE_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_LEVEL_PULSE_SEL) & BIT_MASK_R_LEVEL_PULSE_SEL) -+#define BIT_SET_R_LEVEL_PULSE_SEL(x, v) \ -+ (BIT_CLEAR_R_LEVEL_PULSE_SEL(x) | BIT_R_LEVEL_PULSE_SEL(v)) -+ -+#define BIT_EN_LA_MAC BIT(2) -+#define BIT_R_EN_IQDUMP BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL (Offset 0x07C0) */ -+ -+#define BIT_SHIFT_LTECOEX_REG_ADDR 0 -+#define BIT_MASK_LTECOEX_REG_ADDR 0xffff -+#define BIT_LTECOEX_REG_ADDR(x) \ -+ (((x) & BIT_MASK_LTECOEX_REG_ADDR) << BIT_SHIFT_LTECOEX_REG_ADDR) -+#define BITS_LTECOEX_REG_ADDR \ -+ (BIT_MASK_LTECOEX_REG_ADDR << BIT_SHIFT_LTECOEX_REG_ADDR) -+#define BIT_CLEAR_LTECOEX_REG_ADDR(x) ((x) & (~BITS_LTECOEX_REG_ADDR)) -+#define BIT_GET_LTECOEX_REG_ADDR(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_REG_ADDR) & BIT_MASK_LTECOEX_REG_ADDR) -+#define BIT_SET_LTECOEX_REG_ADDR(x, v) \ -+ (BIT_CLEAR_LTECOEX_REG_ADDR(x) | BIT_LTECOEX_REG_ADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_IQ_DUMP (Offset 0x07C0) */ -+ -+#define BIT_R_IQDATA_DUMP BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA (Offset 0x07C4) */ -+ -+#define BIT_SHIFT_LTECOEX_W_DATA 0 -+#define BIT_MASK_LTECOEX_W_DATA 0xffffffffL -+#define BIT_LTECOEX_W_DATA(x) \ -+ (((x) & BIT_MASK_LTECOEX_W_DATA) << BIT_SHIFT_LTECOEX_W_DATA) -+#define BITS_LTECOEX_W_DATA \ -+ (BIT_MASK_LTECOEX_W_DATA << BIT_SHIFT_LTECOEX_W_DATA) -+#define BIT_CLEAR_LTECOEX_W_DATA(x) ((x) & (~BITS_LTECOEX_W_DATA)) -+#define BIT_GET_LTECOEX_W_DATA(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_W_DATA) & BIT_MASK_LTECOEX_W_DATA) -+#define BIT_SET_LTECOEX_W_DATA(x, v) \ -+ (BIT_CLEAR_LTECOEX_W_DATA(x) | BIT_LTECOEX_W_DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_IQ_DUMP_1 (Offset 0x07C4) */ -+ -+#define BIT_SHIFT_R_WMAC_MASK_LA_MAC_1 0 -+#define BIT_MASK_R_WMAC_MASK_LA_MAC_1 0xffffffffL -+#define BIT_R_WMAC_MASK_LA_MAC_1(x) \ -+ (((x) & BIT_MASK_R_WMAC_MASK_LA_MAC_1) \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_1) -+#define BITS_R_WMAC_MASK_LA_MAC_1 \ -+ (BIT_MASK_R_WMAC_MASK_LA_MAC_1 << BIT_SHIFT_R_WMAC_MASK_LA_MAC_1) -+#define BIT_CLEAR_R_WMAC_MASK_LA_MAC_1(x) ((x) & (~BITS_R_WMAC_MASK_LA_MAC_1)) -+#define BIT_GET_R_WMAC_MASK_LA_MAC_1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MASK_LA_MAC_1) & \ -+ BIT_MASK_R_WMAC_MASK_LA_MAC_1) -+#define BIT_SET_R_WMAC_MASK_LA_MAC_1(x, v) \ -+ (BIT_CLEAR_R_WMAC_MASK_LA_MAC_1(x) | BIT_R_WMAC_MASK_LA_MAC_1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA (Offset 0x07C8) */ -+ -+#define BIT_SHIFT_LTECOEX_R_DATA 0 -+#define BIT_MASK_LTECOEX_R_DATA 0xffffffffL -+#define BIT_LTECOEX_R_DATA(x) \ -+ (((x) & BIT_MASK_LTECOEX_R_DATA) << BIT_SHIFT_LTECOEX_R_DATA) -+#define BITS_LTECOEX_R_DATA \ -+ (BIT_MASK_LTECOEX_R_DATA << BIT_SHIFT_LTECOEX_R_DATA) -+#define BIT_CLEAR_LTECOEX_R_DATA(x) ((x) & (~BITS_LTECOEX_R_DATA)) -+#define BIT_GET_LTECOEX_R_DATA(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_R_DATA) & BIT_MASK_LTECOEX_R_DATA) -+#define BIT_SET_LTECOEX_R_DATA(x, v) \ -+ (BIT_CLEAR_LTECOEX_R_DATA(x) | BIT_LTECOEX_R_DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_IQ_DUMP_2 (Offset 0x07C8) */ -+ -+#define BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2 0 -+#define BIT_MASK_R_WMAC_MATCH_REF_MAC_2 0xffffffffL -+#define BIT_R_WMAC_MATCH_REF_MAC_2(x) \ -+ (((x) & BIT_MASK_R_WMAC_MATCH_REF_MAC_2) \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2) -+#define BITS_R_WMAC_MATCH_REF_MAC_2 \ -+ (BIT_MASK_R_WMAC_MATCH_REF_MAC_2 << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2) -+#define BIT_CLEAR_R_WMAC_MATCH_REF_MAC_2(x) \ -+ ((x) & (~BITS_R_WMAC_MATCH_REF_MAC_2)) -+#define BIT_GET_R_WMAC_MATCH_REF_MAC_2(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2) & \ -+ BIT_MASK_R_WMAC_MATCH_REF_MAC_2) -+#define BIT_SET_R_WMAC_MATCH_REF_MAC_2(x, v) \ -+ (BIT_CLEAR_R_WMAC_MATCH_REF_MAC_2(x) | BIT_R_WMAC_MATCH_REF_MAC_2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WMAC_FTM_CTL (Offset 0x07CC) */ -+ -+#define BIT_SHIFT_RX_STOPRXDMA_RXPOINT 16 -+#define BIT_MASK_RX_STOPRXDMA_RXPOINT 0xffff -+#define BIT_RX_STOPRXDMA_RXPOINT(x) \ -+ (((x) & BIT_MASK_RX_STOPRXDMA_RXPOINT) \ -+ << BIT_SHIFT_RX_STOPRXDMA_RXPOINT) -+#define BITS_RX_STOPRXDMA_RXPOINT \ -+ (BIT_MASK_RX_STOPRXDMA_RXPOINT << BIT_SHIFT_RX_STOPRXDMA_RXPOINT) -+#define BIT_CLEAR_RX_STOPRXDMA_RXPOINT(x) ((x) & (~BITS_RX_STOPRXDMA_RXPOINT)) -+#define BIT_GET_RX_STOPRXDMA_RXPOINT(x) \ -+ (((x) >> BIT_SHIFT_RX_STOPRXDMA_RXPOINT) & \ -+ BIT_MASK_RX_STOPRXDMA_RXPOINT) -+#define BIT_SET_RX_STOPRXDMA_RXPOINT(x, v) \ -+ (BIT_CLEAR_RX_STOPRXDMA_RXPOINT(x) | BIT_RX_STOPRXDMA_RXPOINT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_FTM_CTL (Offset 0x07CC) */ -+ -+#define BIT_RXFTM_TXACK_SC BIT(6) -+#define BIT_RXFTM_TXACK_BW BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WMAC_FTM_CTL (Offset 0x07CC) */ -+ -+#define BIT_RXFTM_STOPRXDMAEN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_FTM_CTL (Offset 0x07CC) */ -+ -+#define BIT_RXFTM_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_WMAC_FTM_CTL (Offset 0x07CC) */ -+ -+#define BIT_RXFTMREQ_STOPRXDMAEN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_FTM_CTL (Offset 0x07CC) */ -+ -+#define BIT_RXFTMREQ_BYDRV BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_FTM_CTL (Offset 0x07CC) */ -+ -+#define BIT_RXFTMREQ_EN BIT(1) -+#define BIT_FTM_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_IQ_DUMP_EXT (Offset 0x07CF) */ -+ -+#define BIT_SHIFT_R_LA_MAC_TIMEOUT_UNIT_SEL 10 -+#define BIT_MASK_R_LA_MAC_TIMEOUT_UNIT_SEL 0x3 -+#define BIT_R_LA_MAC_TIMEOUT_UNIT_SEL(x) \ -+ (((x) & BIT_MASK_R_LA_MAC_TIMEOUT_UNIT_SEL) \ -+ << BIT_SHIFT_R_LA_MAC_TIMEOUT_UNIT_SEL) -+#define BITS_R_LA_MAC_TIMEOUT_UNIT_SEL \ -+ (BIT_MASK_R_LA_MAC_TIMEOUT_UNIT_SEL \ -+ << BIT_SHIFT_R_LA_MAC_TIMEOUT_UNIT_SEL) -+#define BIT_CLEAR_R_LA_MAC_TIMEOUT_UNIT_SEL(x) \ -+ ((x) & (~BITS_R_LA_MAC_TIMEOUT_UNIT_SEL)) -+#define BIT_GET_R_LA_MAC_TIMEOUT_UNIT_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_LA_MAC_TIMEOUT_UNIT_SEL) & \ -+ BIT_MASK_R_LA_MAC_TIMEOUT_UNIT_SEL) -+#define BIT_SET_R_LA_MAC_TIMEOUT_UNIT_SEL(x, v) \ -+ (BIT_CLEAR_R_LA_MAC_TIMEOUT_UNIT_SEL(x) | \ -+ BIT_R_LA_MAC_TIMEOUT_UNIT_SEL(v)) -+ -+#define BIT_SHIFT_R_LA_MAC_TIMEOUT_VALUE 4 -+#define BIT_MASK_R_LA_MAC_TIMEOUT_VALUE 0x3f -+#define BIT_R_LA_MAC_TIMEOUT_VALUE(x) \ -+ (((x) & BIT_MASK_R_LA_MAC_TIMEOUT_VALUE) \ -+ << BIT_SHIFT_R_LA_MAC_TIMEOUT_VALUE) -+#define BITS_R_LA_MAC_TIMEOUT_VALUE \ -+ (BIT_MASK_R_LA_MAC_TIMEOUT_VALUE << BIT_SHIFT_R_LA_MAC_TIMEOUT_VALUE) -+#define BIT_CLEAR_R_LA_MAC_TIMEOUT_VALUE(x) \ -+ ((x) & (~BITS_R_LA_MAC_TIMEOUT_VALUE)) -+#define BIT_GET_R_LA_MAC_TIMEOUT_VALUE(x) \ -+ (((x) >> BIT_SHIFT_R_LA_MAC_TIMEOUT_VALUE) & \ -+ BIT_MASK_R_LA_MAC_TIMEOUT_VALUE) -+#define BIT_SET_R_LA_MAC_TIMEOUT_VALUE(x, v) \ -+ (BIT_CLEAR_R_LA_MAC_TIMEOUT_VALUE(x) | BIT_R_LA_MAC_TIMEOUT_VALUE(v)) -+ -+#define BIT_R_LEVEL_PULSE_SEL_EXTL BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_IQ_DUMP_EXT (Offset 0x07CF) */ -+ -+#define BIT_SHIFT_R_TIME_UNIT_SEL 0 -+#define BIT_MASK_R_TIME_UNIT_SEL 0x7 -+#define BIT_R_TIME_UNIT_SEL(x) \ -+ (((x) & BIT_MASK_R_TIME_UNIT_SEL) << BIT_SHIFT_R_TIME_UNIT_SEL) -+#define BITS_R_TIME_UNIT_SEL \ -+ (BIT_MASK_R_TIME_UNIT_SEL << BIT_SHIFT_R_TIME_UNIT_SEL) -+#define BIT_CLEAR_R_TIME_UNIT_SEL(x) ((x) & (~BITS_R_TIME_UNIT_SEL)) -+#define BIT_GET_R_TIME_UNIT_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_TIME_UNIT_SEL) & BIT_MASK_R_TIME_UNIT_SEL) -+#define BIT_SET_R_TIME_UNIT_SEL(x, v) \ -+ (BIT_CLEAR_R_TIME_UNIT_SEL(x) | BIT_R_TIME_UNIT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_OFDM_CCK_LEN_MASK (Offset 0x07D0) */ -+ -+#define BIT_MICICV_CLR BIT(86) -+#define BIT_MPDU_RDY_SET BIT(85) -+#define BIT_CLR_SEC_TYPE BIT(84) -+#define BIT_NEWPKT_IN BIT(83) -+#define BIT_FCS_END BIT(82) -+#define BIT_DEL_MESH_TYPE BIT(81) -+#define BIT_MASK_MESH_TYPE BIT(80) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1 (Offset 0x07D4) */ -+ -+#define BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1 24 -+#define BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1 0xff -+#define BIT_R_WMAC_RXFIFO_FULL_TH_1(x) \ -+ (((x) & BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1) \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1) -+#define BITS_R_WMAC_RXFIFO_FULL_TH_1 \ -+ (BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1 << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1) -+#define BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_1(x) \ -+ ((x) & (~BITS_R_WMAC_RXFIFO_FULL_TH_1)) -+#define BIT_GET_R_WMAC_RXFIFO_FULL_TH_1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1) & \ -+ BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1) -+#define BIT_SET_R_WMAC_RXFIFO_FULL_TH_1(x, v) \ -+ (BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_1(x) | BIT_R_WMAC_RXFIFO_FULL_TH_1(v)) -+ -+#define BIT_R_WMAC_RX_SYNCFIFO_SYNC_1 BIT(23) -+#define BIT_R_WMAC_RXRST_DLY_1 BIT(22) -+#define BIT_R_WMAC_SRCH_TXRPT_REF_DROP_1 BIT(21) -+#define BIT_R_WMAC_SRCH_TXRPT_UA1_1 BIT(20) -+#define BIT_R_WMAC_SRCH_TXRPT_TYPE_1 BIT(19) -+#define BIT_R_WMAC_NDP_RST_1 BIT(18) -+#define BIT_R_WMAC_POWINT_EN_1 BIT(17) -+#define BIT_R_WMAC_SRCH_TXRPT_PERPKT_1 BIT(16) -+#define BIT_R_WMAC_SRCH_TXRPT_MID_1 BIT(15) -+#define BIT_R_WMAC_PFIN_TOEN_1 BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FA_FILTER1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_FIL_SECERR_V1 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_FIL_SECERR_1 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FA_FILTER1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_FIL_CTLPKTLEN_V1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_FIL_CTLPKTLEN_1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FA_FILTER1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_FIL_FCTYPE_V1 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_FIL_FCTYPE_1 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FA_FILTER1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_FIL_FCPROVER_V1 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_FIL_FCPROVER_1 BIT(10) -+#define BIT_R_WMAC_PHYSTS_SNIF_1 BIT(9) -+#define BIT_R_WMAC_PHYSTS_PLCP_1 BIT(8) -+#define BIT_R_MAC_TCR_VBONF_RD_1 BIT(7) -+#define BIT_R_WMAC_TCR_MPAR_NDP_1 BIT(6) -+#define BIT_R_WMAC_NDP_FILTER_1 BIT(5) -+#define BIT_R_WMAC_RXLEN_SEL_1 BIT(4) -+#define BIT_R_WMAC_RXLEN_SEL1_1 BIT(3) -+#define BIT_R_OFDM_FILTER_1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FA_FILTER1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_CHK_OFDM_LEN_V1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_CHK_OFDM_LEN_1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FA_FILTER1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_CHK_CCK_LEN_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1 (Offset 0x07D4) */ -+ -+#define BIT_R_WMAC_CHK_CCK_LEN_1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FA_FILTER2 (Offset 0x07D8) */ -+ -+#define BIT_DEL_MESH_TYPE_V1 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_2 (Offset 0x07D8) */ -+ -+#define BIT_SHIFT_R_WMAC_RX_FIL_LEN_2 0 -+#define BIT_MASK_R_WMAC_RX_FIL_LEN_2 0xffff -+#define BIT_R_WMAC_RX_FIL_LEN_2(x) \ -+ (((x) & BIT_MASK_R_WMAC_RX_FIL_LEN_2) << BIT_SHIFT_R_WMAC_RX_FIL_LEN_2) -+#define BITS_R_WMAC_RX_FIL_LEN_2 \ -+ (BIT_MASK_R_WMAC_RX_FIL_LEN_2 << BIT_SHIFT_R_WMAC_RX_FIL_LEN_2) -+#define BIT_CLEAR_R_WMAC_RX_FIL_LEN_2(x) ((x) & (~BITS_R_WMAC_RX_FIL_LEN_2)) -+#define BIT_GET_R_WMAC_RX_FIL_LEN_2(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RX_FIL_LEN_2) & BIT_MASK_R_WMAC_RX_FIL_LEN_2) -+#define BIT_SET_R_WMAC_RX_FIL_LEN_2(x, v) \ -+ (BIT_CLEAR_R_WMAC_RX_FIL_LEN_2(x) | BIT_R_WMAC_RX_FIL_LEN_2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RX_FILTER_FUNCTION (Offset 0x07DA) */ -+ -+#define BIT_R_WMAC_RXHANG_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_FILTER_FUNCTION (Offset 0x07DA) */ -+ -+#define BIT_RXHANG_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_FILTER_FUNCTION (Offset 0x07DA) */ -+ -+#define BIT_R_WMAC_MHRDDY_LATCH BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RX_FILTER_FUNCTION (Offset 0x07DA) */ -+ -+#define BIT_R_MHRDDY_CLR BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_FILTER_FUNCTION (Offset 0x07DA) */ -+ -+#define BIT_R_WMAC_MHRDDY_CLR BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_FILTER_FUNCTION (Offset 0x07DA) */ -+ -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY1 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RX_FILTER_FUNCTION (Offset 0x07DA) */ -+ -+#define BIT_R_WMAC_DIS_VHT_PLCP_CHK_MU BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_FILTER_FUNCTION (Offset 0x07DA) */ -+ -+#define BIT_WMAC_DIS_VHT_PLCP_CHK_MU BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_FILTER_FUNCTION (Offset 0x07DA) */ -+ -+#define BIT_R_CHK_DELIMIT_LEN BIT(10) -+#define BIT_R_REAPTER_ADDR_MATCH BIT(9) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY BIT(8) -+#define BIT_R_LATCH_MACHRDY BIT(7) -+#define BIT_R_WMAC_RXFIL_REND BIT(6) -+#define BIT_R_WMAC_MPDURDY_CLR BIT(5) -+#define BIT_R_WMAC_CLRRXSEC BIT(4) -+#define BIT_R_WMAC_RXFIL_RDEL BIT(3) -+#define BIT_R_WMAC_RXFIL_FCSE BIT(2) -+#define BIT_R_WMAC_RXFIL_MESH_DEL BIT(1) -+#define BIT_R_WMAC_RXFIL_MASKM BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_NDP_SIG (Offset 0x07E0) */ -+ -+#define BIT_SHIFT_R_WMAC_TXNDP_SIGB 0 -+#define BIT_MASK_R_WMAC_TXNDP_SIGB 0x1fffff -+#define BIT_R_WMAC_TXNDP_SIGB(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXNDP_SIGB) << BIT_SHIFT_R_WMAC_TXNDP_SIGB) -+#define BITS_R_WMAC_TXNDP_SIGB \ -+ (BIT_MASK_R_WMAC_TXNDP_SIGB << BIT_SHIFT_R_WMAC_TXNDP_SIGB) -+#define BIT_CLEAR_R_WMAC_TXNDP_SIGB(x) ((x) & (~BITS_R_WMAC_TXNDP_SIGB)) -+#define BIT_GET_R_WMAC_TXNDP_SIGB(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXNDP_SIGB) & BIT_MASK_R_WMAC_TXNDP_SIGB) -+#define BIT_SET_R_WMAC_TXNDP_SIGB(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXNDP_SIGB(x) | BIT_R_WMAC_TXNDP_SIGB(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT (Offset 0x07E4) */ -+ -+#define BIT_SHIFT_R_MAC_DEBUG (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_MAC_DEBUG 0xffffffffL -+#define BIT_R_MAC_DEBUG(x) \ -+ (((x) & BIT_MASK_R_MAC_DEBUG) << BIT_SHIFT_R_MAC_DEBUG) -+#define BITS_R_MAC_DEBUG (BIT_MASK_R_MAC_DEBUG << BIT_SHIFT_R_MAC_DEBUG) -+#define BIT_CLEAR_R_MAC_DEBUG(x) ((x) & (~BITS_R_MAC_DEBUG)) -+#define BIT_GET_R_MAC_DEBUG(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DEBUG) & BIT_MASK_R_MAC_DEBUG) -+#define BIT_SET_R_MAC_DEBUG(x, v) \ -+ (BIT_CLEAR_R_MAC_DEBUG(x) | BIT_R_MAC_DEBUG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT (Offset 0x07E4) */ -+ -+#define BIT_SHIFT_R_MAC_DBG_SHIFT 8 -+#define BIT_MASK_R_MAC_DBG_SHIFT 0x7 -+#define BIT_R_MAC_DBG_SHIFT(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SHIFT) << BIT_SHIFT_R_MAC_DBG_SHIFT) -+#define BITS_R_MAC_DBG_SHIFT \ -+ (BIT_MASK_R_MAC_DBG_SHIFT << BIT_SHIFT_R_MAC_DBG_SHIFT) -+#define BIT_CLEAR_R_MAC_DBG_SHIFT(x) ((x) & (~BITS_R_MAC_DBG_SHIFT)) -+#define BIT_GET_R_MAC_DBG_SHIFT(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SHIFT) & BIT_MASK_R_MAC_DBG_SHIFT) -+#define BIT_SET_R_MAC_DBG_SHIFT(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SHIFT(x) | BIT_R_MAC_DBG_SHIFT(v)) -+ -+#define BIT_SHIFT_R_MAC_DBG_SEL 0 -+#define BIT_MASK_R_MAC_DBG_SEL 0x3 -+#define BIT_R_MAC_DBG_SEL(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SEL) << BIT_SHIFT_R_MAC_DBG_SEL) -+#define BITS_R_MAC_DBG_SEL (BIT_MASK_R_MAC_DBG_SEL << BIT_SHIFT_R_MAC_DBG_SEL) -+#define BIT_CLEAR_R_MAC_DBG_SEL(x) ((x) & (~BITS_R_MAC_DBG_SEL)) -+#define BIT_GET_R_MAC_DBG_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SEL) & BIT_MASK_R_MAC_DBG_SEL) -+#define BIT_SET_R_MAC_DBG_SEL(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SEL(x) | BIT_R_MAC_DBG_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_1 (Offset 0x07E8) */ -+ -+#define BIT_SHIFT_R_MAC_DEBUG_1 0 -+#define BIT_MASK_R_MAC_DEBUG_1 0xffffffffL -+#define BIT_R_MAC_DEBUG_1(x) \ -+ (((x) & BIT_MASK_R_MAC_DEBUG_1) << BIT_SHIFT_R_MAC_DEBUG_1) -+#define BITS_R_MAC_DEBUG_1 (BIT_MASK_R_MAC_DEBUG_1 << BIT_SHIFT_R_MAC_DEBUG_1) -+#define BIT_CLEAR_R_MAC_DEBUG_1(x) ((x) & (~BITS_R_MAC_DEBUG_1)) -+#define BIT_GET_R_MAC_DEBUG_1(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DEBUG_1) & BIT_MASK_R_MAC_DEBUG_1) -+#define BIT_SET_R_MAC_DEBUG_1(x, v) \ -+ (BIT_CLEAR_R_MAC_DEBUG_1(x) | BIT_R_MAC_DEBUG_1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WSEC_OPTION (Offset 0x07EC) */ -+ -+#define BIT_RXDEC_BM_MGNT BIT(22) -+#define BIT_TXENC_BM_MGNT BIT(21) -+#define BIT_RXDEC_UNI_MGNT BIT(20) -+#define BIT_TXENC_UNI_MGNT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SEC_OPT_V2 (Offset 0x07EC) */ -+ -+#define BIT_MASK_IV BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WSEC_OPTION (Offset 0x07EC) */ -+ -+#define BIT_WMAC_SEC_MASKIV BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SEC_OPT_V2 (Offset 0x07EC) */ -+ -+#define BIT_EIVL_ENDIAN BIT(17) -+#define BIT_EIVH_ENDIAN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WSEC_OPTION (Offset 0x07EC) */ -+ -+#define BIT_SHIFT_WMAC_SEC_PN_SEL 16 -+#define BIT_MASK_WMAC_SEC_PN_SEL 0x3 -+#define BIT_WMAC_SEC_PN_SEL(x) \ -+ (((x) & BIT_MASK_WMAC_SEC_PN_SEL) << BIT_SHIFT_WMAC_SEC_PN_SEL) -+#define BITS_WMAC_SEC_PN_SEL \ -+ (BIT_MASK_WMAC_SEC_PN_SEL << BIT_SHIFT_WMAC_SEC_PN_SEL) -+#define BIT_CLEAR_WMAC_SEC_PN_SEL(x) ((x) & (~BITS_WMAC_SEC_PN_SEL)) -+#define BIT_GET_WMAC_SEC_PN_SEL(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SEC_PN_SEL) & BIT_MASK_WMAC_SEC_PN_SEL) -+#define BIT_SET_WMAC_SEC_PN_SEL(x, v) \ -+ (BIT_CLEAR_WMAC_SEC_PN_SEL(x) | BIT_WMAC_SEC_PN_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WSEC_OPTION (Offset 0x07EC) */ -+ -+#define BIT_SHIFT_BT_TIME_CNT 0 -+#define BIT_MASK_BT_TIME_CNT 0xff -+#define BIT_BT_TIME_CNT(x) \ -+ (((x) & BIT_MASK_BT_TIME_CNT) << BIT_SHIFT_BT_TIME_CNT) -+#define BITS_BT_TIME_CNT (BIT_MASK_BT_TIME_CNT << BIT_SHIFT_BT_TIME_CNT) -+#define BIT_CLEAR_BT_TIME_CNT(x) ((x) & (~BITS_BT_TIME_CNT)) -+#define BIT_GET_BT_TIME_CNT(x) \ -+ (((x) >> BIT_SHIFT_BT_TIME_CNT) & BIT_MASK_BT_TIME_CNT) -+#define BIT_SET_BT_TIME_CNT(x, v) \ -+ (BIT_CLEAR_BT_TIME_CNT(x) | BIT_BT_TIME_CNT(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RTS_ADDRESS_0 (Offset 0x07F0) */ -+ -+#define BIT_SHIFT_R_WMAC_RTS_ADDR0 0 -+#define BIT_MASK_R_WMAC_RTS_ADDR0 0xffffffffffffL -+#define BIT_R_WMAC_RTS_ADDR0(x) \ -+ (((x) & BIT_MASK_R_WMAC_RTS_ADDR0) << BIT_SHIFT_R_WMAC_RTS_ADDR0) -+#define BITS_R_WMAC_RTS_ADDR0 \ -+ (BIT_MASK_R_WMAC_RTS_ADDR0 << BIT_SHIFT_R_WMAC_RTS_ADDR0) -+#define BIT_CLEAR_R_WMAC_RTS_ADDR0(x) ((x) & (~BITS_R_WMAC_RTS_ADDR0)) -+#define BIT_GET_R_WMAC_RTS_ADDR0(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RTS_ADDR0) & BIT_MASK_R_WMAC_RTS_ADDR0) -+#define BIT_SET_R_WMAC_RTS_ADDR0(x, v) \ -+ (BIT_CLEAR_R_WMAC_RTS_ADDR0(x) | BIT_R_WMAC_RTS_ADDR0(v)) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RTS_ADDR0 (Offset 0x07F0) */ -+ -+#define BIT_SHIFT_RTS_ADDR0 0 -+#define BIT_MASK_RTS_ADDR0 0xffffffffffffL -+#define BIT_RTS_ADDR0(x) (((x) & BIT_MASK_RTS_ADDR0) << BIT_SHIFT_RTS_ADDR0) -+#define BITS_RTS_ADDR0 (BIT_MASK_RTS_ADDR0 << BIT_SHIFT_RTS_ADDR0) -+#define BIT_CLEAR_RTS_ADDR0(x) ((x) & (~BITS_RTS_ADDR0)) -+#define BIT_GET_RTS_ADDR0(x) (((x) >> BIT_SHIFT_RTS_ADDR0) & BIT_MASK_RTS_ADDR0) -+#define BIT_SET_RTS_ADDR0(x, v) (BIT_CLEAR_RTS_ADDR0(x) | BIT_RTS_ADDR0(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RTS_ADDRESS_1 (Offset 0x07F8) */ -+ -+#define BIT_SHIFT_R_WMAC_RTS_ADDR1 0 -+#define BIT_MASK_R_WMAC_RTS_ADDR1 0xffffffffffffL -+#define BIT_R_WMAC_RTS_ADDR1(x) \ -+ (((x) & BIT_MASK_R_WMAC_RTS_ADDR1) << BIT_SHIFT_R_WMAC_RTS_ADDR1) -+#define BITS_R_WMAC_RTS_ADDR1 \ -+ (BIT_MASK_R_WMAC_RTS_ADDR1 << BIT_SHIFT_R_WMAC_RTS_ADDR1) -+#define BIT_CLEAR_R_WMAC_RTS_ADDR1(x) ((x) & (~BITS_R_WMAC_RTS_ADDR1)) -+#define BIT_GET_R_WMAC_RTS_ADDR1(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RTS_ADDR1) & BIT_MASK_R_WMAC_RTS_ADDR1) -+#define BIT_SET_R_WMAC_RTS_ADDR1(x, v) \ -+ (BIT_CLEAR_R_WMAC_RTS_ADDR1(x) | BIT_R_WMAC_RTS_ADDR1(v)) -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RTS_ADDR1 (Offset 0x07F8) */ -+ -+#define BIT_SHIFT_RTS_ADDR1 0 -+#define BIT_MASK_RTS_ADDR1 0xffffffffffffL -+#define BIT_RTS_ADDR1(x) (((x) & BIT_MASK_RTS_ADDR1) << BIT_SHIFT_RTS_ADDR1) -+#define BITS_RTS_ADDR1 (BIT_MASK_RTS_ADDR1 << BIT_SHIFT_RTS_ADDR1) -+#define BIT_CLEAR_RTS_ADDR1(x) ((x) & (~BITS_RTS_ADDR1)) -+#define BIT_GET_RTS_ADDR1(x) (((x) >> BIT_SHIFT_RTS_ADDR1) & BIT_MASK_RTS_ADDR1) -+#define BIT_SET_RTS_ADDR1(x, v) (BIT_CLEAR_RTS_ADDR1(x) | BIT_RTS_ADDR1(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG3 (Offset 0x1000) */ -+ -+#define BIT_FEN_BB_GLB_RSTN_V1 BIT(17) -+#define BIT_FEN_BBRSTB_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_CFG3 (Offset 0x1000) */ -+ -+#define BIT_PWC_MA33V BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG3 (Offset 0x1000) */ -+ -+#define BIT_PWC_EV25V_1 BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SYS_CFG3 (Offset 0x1000) */ -+ -+#define BIT_PWC_MA12V BIT(14) -+#define BIT_PWC_MD12V BIT(13) -+#define BIT_PWC_PD12V BIT(12) -+#define BIT_PWC_UD12V BIT(11) -+#define BIT_ISO_MA2MD BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_OCP_L BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_OCP_L_0 BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_POWOCP_L BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_CF_L_V2 28 -+#define BIT_MASK_CF_L_V2 0x3 -+#define BIT_CF_L_V2(x) (((x) & BIT_MASK_CF_L_V2) << BIT_SHIFT_CF_L_V2) -+#define BITS_CF_L_V2 (BIT_MASK_CF_L_V2 << BIT_SHIFT_CF_L_V2) -+#define BIT_CLEAR_CF_L_V2(x) ((x) & (~BITS_CF_L_V2)) -+#define BIT_GET_CF_L_V2(x) (((x) >> BIT_SHIFT_CF_L_V2) & BIT_MASK_CF_L_V2) -+#define BIT_SET_CF_L_V2(x, v) (BIT_CLEAR_CF_L_V2(x) | BIT_CF_L_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_CF_L_1_0 28 -+#define BIT_MASK_CF_L_1_0 0x3 -+#define BIT_CF_L_1_0(x) (((x) & BIT_MASK_CF_L_1_0) << BIT_SHIFT_CF_L_1_0) -+#define BITS_CF_L_1_0 (BIT_MASK_CF_L_1_0 << BIT_SHIFT_CF_L_1_0) -+#define BIT_CLEAR_CF_L_1_0(x) ((x) & (~BITS_CF_L_1_0)) -+#define BIT_GET_CF_L_1_0(x) (((x) >> BIT_SHIFT_CF_L_1_0) & BIT_MASK_CF_L_1_0) -+#define BIT_SET_CF_L_1_0(x, v) (BIT_CLEAR_CF_L_1_0(x) | BIT_CF_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_CFC_L_V2 26 -+#define BIT_MASK_CFC_L_V2 0x3 -+#define BIT_CFC_L_V2(x) (((x) & BIT_MASK_CFC_L_V2) << BIT_SHIFT_CFC_L_V2) -+#define BITS_CFC_L_V2 (BIT_MASK_CFC_L_V2 << BIT_SHIFT_CFC_L_V2) -+#define BIT_CLEAR_CFC_L_V2(x) ((x) & (~BITS_CFC_L_V2)) -+#define BIT_GET_CFC_L_V2(x) (((x) >> BIT_SHIFT_CFC_L_V2) & BIT_MASK_CFC_L_V2) -+#define BIT_SET_CFC_L_V2(x, v) (BIT_CLEAR_CFC_L_V2(x) | BIT_CFC_L_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_CFC_L_1_0 26 -+#define BIT_MASK_CFC_L_1_0 0x3 -+#define BIT_CFC_L_1_0(x) (((x) & BIT_MASK_CFC_L_1_0) << BIT_SHIFT_CFC_L_1_0) -+#define BITS_CFC_L_1_0 (BIT_MASK_CFC_L_1_0 << BIT_SHIFT_CFC_L_1_0) -+#define BIT_CLEAR_CFC_L_1_0(x) ((x) & (~BITS_CFC_L_1_0)) -+#define BIT_GET_CFC_L_1_0(x) (((x) >> BIT_SHIFT_CFC_L_1_0) & BIT_MASK_CFC_L_1_0) -+#define BIT_SET_CFC_L_1_0(x, v) (BIT_CLEAR_CFC_L_1_0(x) | BIT_CFC_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_R3_L_V2 24 -+#define BIT_MASK_R3_L_V2 0x3 -+#define BIT_R3_L_V2(x) (((x) & BIT_MASK_R3_L_V2) << BIT_SHIFT_R3_L_V2) -+#define BITS_R3_L_V2 (BIT_MASK_R3_L_V2 << BIT_SHIFT_R3_L_V2) -+#define BIT_CLEAR_R3_L_V2(x) ((x) & (~BITS_R3_L_V2)) -+#define BIT_GET_R3_L_V2(x) (((x) >> BIT_SHIFT_R3_L_V2) & BIT_MASK_R3_L_V2) -+#define BIT_SET_R3_L_V2(x, v) (BIT_CLEAR_R3_L_V2(x) | BIT_R3_L_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_R3_L_1_0 24 -+#define BIT_MASK_R3_L_1_0 0x3 -+#define BIT_R3_L_1_0(x) (((x) & BIT_MASK_R3_L_1_0) << BIT_SHIFT_R3_L_1_0) -+#define BITS_R3_L_1_0 (BIT_MASK_R3_L_1_0 << BIT_SHIFT_R3_L_1_0) -+#define BIT_CLEAR_R3_L_1_0(x) ((x) & (~BITS_R3_L_1_0)) -+#define BIT_GET_R3_L_1_0(x) (((x) >> BIT_SHIFT_R3_L_1_0) & BIT_MASK_R3_L_1_0) -+#define BIT_SET_R3_L_1_0(x, v) (BIT_CLEAR_R3_L_1_0(x) | BIT_R3_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_R2_L 22 -+#define BIT_MASK_R2_L 0x3 -+#define BIT_R2_L(x) (((x) & BIT_MASK_R2_L) << BIT_SHIFT_R2_L) -+#define BITS_R2_L (BIT_MASK_R2_L << BIT_SHIFT_R2_L) -+#define BIT_CLEAR_R2_L(x) ((x) & (~BITS_R2_L)) -+#define BIT_GET_R2_L(x) (((x) >> BIT_SHIFT_R2_L) & BIT_MASK_R2_L) -+#define BIT_SET_R2_L(x, v) (BIT_CLEAR_R2_L(x) | BIT_R2_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_R2_L_1_0 22 -+#define BIT_MASK_R2_L_1_0 0x3 -+#define BIT_R2_L_1_0(x) (((x) & BIT_MASK_R2_L_1_0) << BIT_SHIFT_R2_L_1_0) -+#define BITS_R2_L_1_0 (BIT_MASK_R2_L_1_0 << BIT_SHIFT_R2_L_1_0) -+#define BIT_CLEAR_R2_L_1_0(x) ((x) & (~BITS_R2_L_1_0)) -+#define BIT_GET_R2_L_1_0(x) (((x) >> BIT_SHIFT_R2_L_1_0) & BIT_MASK_R2_L_1_0) -+#define BIT_SET_R2_L_1_0(x, v) (BIT_CLEAR_R2_L_1_0(x) | BIT_R2_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_R1_L 20 -+#define BIT_MASK_R1_L 0x3 -+#define BIT_R1_L(x) (((x) & BIT_MASK_R1_L) << BIT_SHIFT_R1_L) -+#define BITS_R1_L (BIT_MASK_R1_L << BIT_SHIFT_R1_L) -+#define BIT_CLEAR_R1_L(x) ((x) & (~BITS_R1_L)) -+#define BIT_GET_R1_L(x) (((x) >> BIT_SHIFT_R1_L) & BIT_MASK_R1_L) -+#define BIT_SET_R1_L(x, v) (BIT_CLEAR_R1_L(x) | BIT_R1_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_R1_L_1_0 20 -+#define BIT_MASK_R1_L_1_0 0x3 -+#define BIT_R1_L_1_0(x) (((x) & BIT_MASK_R1_L_1_0) << BIT_SHIFT_R1_L_1_0) -+#define BITS_R1_L_1_0 (BIT_MASK_R1_L_1_0 << BIT_SHIFT_R1_L_1_0) -+#define BIT_CLEAR_R1_L_1_0(x) ((x) & (~BITS_R1_L_1_0)) -+#define BIT_GET_R1_L_1_0(x) (((x) >> BIT_SHIFT_R1_L_1_0) & BIT_MASK_R1_L_1_0) -+#define BIT_SET_R1_L_1_0(x, v) (BIT_CLEAR_R1_L_1_0(x) | BIT_R1_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_C3_L 18 -+#define BIT_MASK_C3_L 0x3 -+#define BIT_C3_L(x) (((x) & BIT_MASK_C3_L) << BIT_SHIFT_C3_L) -+#define BITS_C3_L (BIT_MASK_C3_L << BIT_SHIFT_C3_L) -+#define BIT_CLEAR_C3_L(x) ((x) & (~BITS_C3_L)) -+#define BIT_GET_C3_L(x) (((x) >> BIT_SHIFT_C3_L) & BIT_MASK_C3_L) -+#define BIT_SET_C3_L(x, v) (BIT_CLEAR_C3_L(x) | BIT_C3_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_C3_L_1_0 18 -+#define BIT_MASK_C3_L_1_0 0x3 -+#define BIT_C3_L_1_0(x) (((x) & BIT_MASK_C3_L_1_0) << BIT_SHIFT_C3_L_1_0) -+#define BITS_C3_L_1_0 (BIT_MASK_C3_L_1_0 << BIT_SHIFT_C3_L_1_0) -+#define BIT_CLEAR_C3_L_1_0(x) ((x) & (~BITS_C3_L_1_0)) -+#define BIT_GET_C3_L_1_0(x) (((x) >> BIT_SHIFT_C3_L_1_0) & BIT_MASK_C3_L_1_0) -+#define BIT_SET_C3_L_1_0(x, v) (BIT_CLEAR_C3_L_1_0(x) | BIT_C3_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_C2_L 16 -+#define BIT_MASK_C2_L 0x3 -+#define BIT_C2_L(x) (((x) & BIT_MASK_C2_L) << BIT_SHIFT_C2_L) -+#define BITS_C2_L (BIT_MASK_C2_L << BIT_SHIFT_C2_L) -+#define BIT_CLEAR_C2_L(x) ((x) & (~BITS_C2_L)) -+#define BIT_GET_C2_L(x) (((x) >> BIT_SHIFT_C2_L) & BIT_MASK_C2_L) -+#define BIT_SET_C2_L(x, v) (BIT_CLEAR_C2_L(x) | BIT_C2_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_C2_L_1_0 16 -+#define BIT_MASK_C2_L_1_0 0x3 -+#define BIT_C2_L_1_0(x) (((x) & BIT_MASK_C2_L_1_0) << BIT_SHIFT_C2_L_1_0) -+#define BITS_C2_L_1_0 (BIT_MASK_C2_L_1_0 << BIT_SHIFT_C2_L_1_0) -+#define BIT_CLEAR_C2_L_1_0(x) ((x) & (~BITS_C2_L_1_0)) -+#define BIT_GET_C2_L_1_0(x) (((x) >> BIT_SHIFT_C2_L_1_0) & BIT_MASK_C2_L_1_0) -+#define BIT_SET_C2_L_1_0(x, v) (BIT_CLEAR_C2_L_1_0(x) | BIT_C2_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_C1_L_V2 14 -+#define BIT_MASK_C1_L_V2 0x3 -+#define BIT_C1_L_V2(x) (((x) & BIT_MASK_C1_L_V2) << BIT_SHIFT_C1_L_V2) -+#define BITS_C1_L_V2 (BIT_MASK_C1_L_V2 << BIT_SHIFT_C1_L_V2) -+#define BIT_CLEAR_C1_L_V2(x) ((x) & (~BITS_C1_L_V2)) -+#define BIT_GET_C1_L_V2(x) (((x) >> BIT_SHIFT_C1_L_V2) & BIT_MASK_C1_L_V2) -+#define BIT_SET_C1_L_V2(x, v) (BIT_CLEAR_C1_L_V2(x) | BIT_C1_L_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_C1_L_1_0 14 -+#define BIT_MASK_C1_L_1_0 0x3 -+#define BIT_C1_L_1_0(x) (((x) & BIT_MASK_C1_L_1_0) << BIT_SHIFT_C1_L_1_0) -+#define BITS_C1_L_1_0 (BIT_MASK_C1_L_1_0 << BIT_SHIFT_C1_L_1_0) -+#define BIT_CLEAR_C1_L_1_0(x) ((x) & (~BITS_C1_L_1_0)) -+#define BIT_GET_C1_L_1_0(x) (((x) >> BIT_SHIFT_C1_L_1_0) & BIT_MASK_C1_L_1_0) -+#define BIT_SET_C1_L_1_0(x, v) (BIT_CLEAR_C1_L_1_0(x) | BIT_C1_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_REG_TYPE_L_V2 BIT(13) -+#define BIT_REG_PWM_L BIT(12) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_V15ADJ_L 9 -+#define BIT_MASK_V15ADJ_L 0x7 -+#define BIT_V15ADJ_L(x) (((x) & BIT_MASK_V15ADJ_L) << BIT_SHIFT_V15ADJ_L) -+#define BITS_V15ADJ_L (BIT_MASK_V15ADJ_L << BIT_SHIFT_V15ADJ_L) -+#define BIT_CLEAR_V15ADJ_L(x) ((x) & (~BITS_V15ADJ_L)) -+#define BIT_GET_V15ADJ_L(x) (((x) >> BIT_SHIFT_V15ADJ_L) & BIT_MASK_V15ADJ_L) -+#define BIT_SET_V15ADJ_L(x, v) (BIT_CLEAR_V15ADJ_L(x) | BIT_V15ADJ_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_V15ADJ_L_2_0 9 -+#define BIT_MASK_V15ADJ_L_2_0 0x7 -+#define BIT_V15ADJ_L_2_0(x) \ -+ (((x) & BIT_MASK_V15ADJ_L_2_0) << BIT_SHIFT_V15ADJ_L_2_0) -+#define BITS_V15ADJ_L_2_0 (BIT_MASK_V15ADJ_L_2_0 << BIT_SHIFT_V15ADJ_L_2_0) -+#define BIT_CLEAR_V15ADJ_L_2_0(x) ((x) & (~BITS_V15ADJ_L_2_0)) -+#define BIT_GET_V15ADJ_L_2_0(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L_2_0) & BIT_MASK_V15ADJ_L_2_0) -+#define BIT_SET_V15ADJ_L_2_0(x, v) \ -+ (BIT_CLEAR_V15ADJ_L_2_0(x) | BIT_V15ADJ_L_2_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_IN_L 6 -+#define BIT_MASK_IN_L 0x7 -+#define BIT_IN_L(x) (((x) & BIT_MASK_IN_L) << BIT_SHIFT_IN_L) -+#define BITS_IN_L (BIT_MASK_IN_L << BIT_SHIFT_IN_L) -+#define BIT_CLEAR_IN_L(x) ((x) & (~BITS_IN_L)) -+#define BIT_GET_IN_L(x) (((x) >> BIT_SHIFT_IN_L) & BIT_MASK_IN_L) -+#define BIT_SET_IN_L(x, v) (BIT_CLEAR_IN_L(x) | BIT_IN_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_IN_L_2_0 6 -+#define BIT_MASK_IN_L_2_0 0x7 -+#define BIT_IN_L_2_0(x) (((x) & BIT_MASK_IN_L_2_0) << BIT_SHIFT_IN_L_2_0) -+#define BITS_IN_L_2_0 (BIT_MASK_IN_L_2_0 << BIT_SHIFT_IN_L_2_0) -+#define BIT_CLEAR_IN_L_2_0(x) ((x) & (~BITS_IN_L_2_0)) -+#define BIT_GET_IN_L_2_0(x) (((x) >> BIT_SHIFT_IN_L_2_0) & BIT_MASK_IN_L_2_0) -+#define BIT_SET_IN_L_2_0(x, v) (BIT_CLEAR_IN_L_2_0(x) | BIT_IN_L_2_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_STD_L 4 -+#define BIT_MASK_STD_L 0x3 -+#define BIT_STD_L(x) (((x) & BIT_MASK_STD_L) << BIT_SHIFT_STD_L) -+#define BITS_STD_L (BIT_MASK_STD_L << BIT_SHIFT_STD_L) -+#define BIT_CLEAR_STD_L(x) ((x) & (~BITS_STD_L)) -+#define BIT_GET_STD_L(x) (((x) >> BIT_SHIFT_STD_L) & BIT_MASK_STD_L) -+#define BIT_SET_STD_L(x, v) (BIT_CLEAR_STD_L(x) | BIT_STD_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_STD_L_1_0 4 -+#define BIT_MASK_STD_L_1_0 0x3 -+#define BIT_STD_L_1_0(x) (((x) & BIT_MASK_STD_L_1_0) << BIT_SHIFT_STD_L_1_0) -+#define BITS_STD_L_1_0 (BIT_MASK_STD_L_1_0 << BIT_SHIFT_STD_L_1_0) -+#define BIT_CLEAR_STD_L_1_0(x) ((x) & (~BITS_STD_L_1_0)) -+#define BIT_GET_STD_L_1_0(x) (((x) >> BIT_SHIFT_STD_L_1_0) & BIT_MASK_STD_L_1_0) -+#define BIT_SET_STD_L_1_0(x, v) (BIT_CLEAR_STD_L_1_0(x) | BIT_STD_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_VOL_L 0 -+#define BIT_MASK_VOL_L 0xf -+#define BIT_VOL_L(x) (((x) & BIT_MASK_VOL_L) << BIT_SHIFT_VOL_L) -+#define BITS_VOL_L (BIT_MASK_VOL_L << BIT_SHIFT_VOL_L) -+#define BIT_CLEAR_VOL_L(x) ((x) & (~BITS_VOL_L)) -+#define BIT_GET_VOL_L(x) (((x) >> BIT_SHIFT_VOL_L) & BIT_MASK_VOL_L) -+#define BIT_SET_VOL_L(x, v) (BIT_CLEAR_VOL_L(x) | BIT_VOL_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_0 (Offset 0x1010) */ -+ -+#define BIT_SHIFT_VOL_L_3_0 0 -+#define BIT_MASK_VOL_L_3_0 0xf -+#define BIT_VOL_L_3_0(x) (((x) & BIT_MASK_VOL_L_3_0) << BIT_SHIFT_VOL_L_3_0) -+#define BITS_VOL_L_3_0 (BIT_MASK_VOL_L_3_0 << BIT_SHIFT_VOL_L_3_0) -+#define BIT_CLEAR_VOL_L_3_0(x) ((x) & (~BITS_VOL_L_3_0)) -+#define BIT_GET_VOL_L_3_0(x) (((x) >> BIT_SHIFT_VOL_L_3_0) & BIT_MASK_VOL_L_3_0) -+#define BIT_SET_VOL_L_3_0(x, v) (BIT_CLEAR_VOL_L_3_0(x) | BIT_VOL_L_3_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_SHIFT_OCP_L_PFM 29 -+#define BIT_MASK_OCP_L_PFM 0x7 -+#define BIT_OCP_L_PFM(x) (((x) & BIT_MASK_OCP_L_PFM) << BIT_SHIFT_OCP_L_PFM) -+#define BITS_OCP_L_PFM (BIT_MASK_OCP_L_PFM << BIT_SHIFT_OCP_L_PFM) -+#define BIT_CLEAR_OCP_L_PFM(x) ((x) & (~BITS_OCP_L_PFM)) -+#define BIT_GET_OCP_L_PFM(x) (((x) >> BIT_SHIFT_OCP_L_PFM) & BIT_MASK_OCP_L_PFM) -+#define BIT_SET_OCP_L_PFM(x, v) (BIT_CLEAR_OCP_L_PFM(x) | BIT_OCP_L_PFM(v)) -+ -+#define BIT_SHIFT_CFC_L_PFM 27 -+#define BIT_MASK_CFC_L_PFM 0x3 -+#define BIT_CFC_L_PFM(x) (((x) & BIT_MASK_CFC_L_PFM) << BIT_SHIFT_CFC_L_PFM) -+#define BITS_CFC_L_PFM (BIT_MASK_CFC_L_PFM << BIT_SHIFT_CFC_L_PFM) -+#define BIT_CLEAR_CFC_L_PFM(x) ((x) & (~BITS_CFC_L_PFM)) -+#define BIT_GET_CFC_L_PFM(x) (((x) >> BIT_SHIFT_CFC_L_PFM) & BIT_MASK_CFC_L_PFM) -+#define BIT_SET_CFC_L_PFM(x, v) (BIT_CLEAR_CFC_L_PFM(x) | BIT_CFC_L_PFM(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_SHIFT_REG_FREQ_L_V1 20 -+#define BIT_MASK_REG_FREQ_L_V1 0x7 -+#define BIT_REG_FREQ_L_V1(x) \ -+ (((x) & BIT_MASK_REG_FREQ_L_V1) << BIT_SHIFT_REG_FREQ_L_V1) -+#define BITS_REG_FREQ_L_V1 (BIT_MASK_REG_FREQ_L_V1 << BIT_SHIFT_REG_FREQ_L_V1) -+#define BIT_CLEAR_REG_FREQ_L_V1(x) ((x) & (~BITS_REG_FREQ_L_V1)) -+#define BIT_GET_REG_FREQ_L_V1(x) \ -+ (((x) >> BIT_SHIFT_REG_FREQ_L_V1) & BIT_MASK_REG_FREQ_L_V1) -+#define BIT_SET_REG_FREQ_L_V1(x, v) \ -+ (BIT_CLEAR_REG_FREQ_L_V1(x) | BIT_REG_FREQ_L_V1(v)) -+ -+#define BIT_EN_DUTY BIT(19) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_SHIFT_REG_MODE_V2 17 -+#define BIT_MASK_REG_MODE_V2 0x3 -+#define BIT_REG_MODE_V2(x) \ -+ (((x) & BIT_MASK_REG_MODE_V2) << BIT_SHIFT_REG_MODE_V2) -+#define BITS_REG_MODE_V2 (BIT_MASK_REG_MODE_V2 << BIT_SHIFT_REG_MODE_V2) -+#define BIT_CLEAR_REG_MODE_V2(x) ((x) & (~BITS_REG_MODE_V2)) -+#define BIT_GET_REG_MODE_V2(x) \ -+ (((x) >> BIT_SHIFT_REG_MODE_V2) & BIT_MASK_REG_MODE_V2) -+#define BIT_SET_REG_MODE_V2(x, v) \ -+ (BIT_CLEAR_REG_MODE_V2(x) | BIT_REG_MODE_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_SHIFT_REG_MOS_HALF 17 -+#define BIT_MASK_REG_MOS_HALF 0x3 -+#define BIT_REG_MOS_HALF(x) \ -+ (((x) & BIT_MASK_REG_MOS_HALF) << BIT_SHIFT_REG_MOS_HALF) -+#define BITS_REG_MOS_HALF (BIT_MASK_REG_MOS_HALF << BIT_SHIFT_REG_MOS_HALF) -+#define BIT_CLEAR_REG_MOS_HALF(x) ((x) & (~BITS_REG_MOS_HALF)) -+#define BIT_GET_REG_MOS_HALF(x) \ -+ (((x) >> BIT_SHIFT_REG_MOS_HALF) & BIT_MASK_REG_MOS_HALF) -+#define BIT_SET_REG_MOS_HALF(x, v) \ -+ (BIT_CLEAR_REG_MOS_HALF(x) | BIT_REG_MOS_HALF(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_EN_SP BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_REG_AUTO_L_V2 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_REG_AUTO_L_V1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_REG_LDOF_L_V2 BIT(14) -+#define BIT_REG_OCPS_L_V2 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_VO15_V1P05_H BIT(12) -+#define BIT_ARENB_L_V2 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_ARENB_L_V1 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_SHIFT_TBOX_L1_V2 9 -+#define BIT_MASK_TBOX_L1_V2 0x3 -+#define BIT_TBOX_L1_V2(x) (((x) & BIT_MASK_TBOX_L1_V2) << BIT_SHIFT_TBOX_L1_V2) -+#define BITS_TBOX_L1_V2 (BIT_MASK_TBOX_L1_V2 << BIT_SHIFT_TBOX_L1_V2) -+#define BIT_CLEAR_TBOX_L1_V2(x) ((x) & (~BITS_TBOX_L1_V2)) -+#define BIT_GET_TBOX_L1_V2(x) \ -+ (((x) >> BIT_SHIFT_TBOX_L1_V2) & BIT_MASK_TBOX_L1_V2) -+#define BIT_SET_TBOX_L1_V2(x, v) (BIT_CLEAR_TBOX_L1_V2(x) | BIT_TBOX_L1_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_SHIFT_TBOX_L1_1_0 9 -+#define BIT_MASK_TBOX_L1_1_0 0x3 -+#define BIT_TBOX_L1_1_0(x) \ -+ (((x) & BIT_MASK_TBOX_L1_1_0) << BIT_SHIFT_TBOX_L1_1_0) -+#define BITS_TBOX_L1_1_0 (BIT_MASK_TBOX_L1_1_0 << BIT_SHIFT_TBOX_L1_1_0) -+#define BIT_CLEAR_TBOX_L1_1_0(x) ((x) & (~BITS_TBOX_L1_1_0)) -+#define BIT_GET_TBOX_L1_1_0(x) \ -+ (((x) >> BIT_SHIFT_TBOX_L1_1_0) & BIT_MASK_TBOX_L1_1_0) -+#define BIT_SET_TBOX_L1_1_0(x, v) \ -+ (BIT_CLEAR_TBOX_L1_1_0(x) | BIT_TBOX_L1_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_SHIFT_REG_DELAY_L 7 -+#define BIT_MASK_REG_DELAY_L 0x3 -+#define BIT_REG_DELAY_L(x) \ -+ (((x) & BIT_MASK_REG_DELAY_L) << BIT_SHIFT_REG_DELAY_L) -+#define BITS_REG_DELAY_L (BIT_MASK_REG_DELAY_L << BIT_SHIFT_REG_DELAY_L) -+#define BIT_CLEAR_REG_DELAY_L(x) ((x) & (~BITS_REG_DELAY_L)) -+#define BIT_GET_REG_DELAY_L(x) \ -+ (((x) >> BIT_SHIFT_REG_DELAY_L) & BIT_MASK_REG_DELAY_L) -+#define BIT_SET_REG_DELAY_L(x, v) \ -+ (BIT_CLEAR_REG_DELAY_L(x) | BIT_REG_DELAY_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_SHIFT_REG_DELAY_L_1_0 7 -+#define BIT_MASK_REG_DELAY_L_1_0 0x3 -+#define BIT_REG_DELAY_L_1_0(x) \ -+ (((x) & BIT_MASK_REG_DELAY_L_1_0) << BIT_SHIFT_REG_DELAY_L_1_0) -+#define BITS_REG_DELAY_L_1_0 \ -+ (BIT_MASK_REG_DELAY_L_1_0 << BIT_SHIFT_REG_DELAY_L_1_0) -+#define BIT_CLEAR_REG_DELAY_L_1_0(x) ((x) & (~BITS_REG_DELAY_L_1_0)) -+#define BIT_GET_REG_DELAY_L_1_0(x) \ -+ (((x) >> BIT_SHIFT_REG_DELAY_L_1_0) & BIT_MASK_REG_DELAY_L_1_0) -+#define BIT_SET_REG_DELAY_L_1_0(x, v) \ -+ (BIT_CLEAR_REG_DELAY_L_1_0(x) | BIT_REG_DELAY_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_REG_CLAMP_D_L BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_REG_BYPASS_L_V2 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_REG_BYPASS_L_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_REG_AUTOZCD_L BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_POW_ZCD_L_V2 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_POW_ZCD_L_V1 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_REG_HALF_L BIT(2) -+ -+#define BIT_SHIFT_OCP_L_V2 0 -+#define BIT_MASK_OCP_L_V2 0x3 -+#define BIT_OCP_L_V2(x) (((x) & BIT_MASK_OCP_L_V2) << BIT_SHIFT_OCP_L_V2) -+#define BITS_OCP_L_V2 (BIT_MASK_OCP_L_V2 << BIT_SHIFT_OCP_L_V2) -+#define BIT_CLEAR_OCP_L_V2(x) ((x) & (~BITS_OCP_L_V2)) -+#define BIT_GET_OCP_L_V2(x) (((x) >> BIT_SHIFT_OCP_L_V2) & BIT_MASK_OCP_L_V2) -+#define BIT_SET_OCP_L_V2(x, v) (BIT_CLEAR_OCP_L_V2(x) | BIT_OCP_L_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPARSW_MAC_1 (Offset 0x1014) */ -+ -+#define BIT_SHIFT_OCP_L_2_1 0 -+#define BIT_MASK_OCP_L_2_1 0x3 -+#define BIT_OCP_L_2_1(x) (((x) & BIT_MASK_OCP_L_2_1) << BIT_SHIFT_OCP_L_2_1) -+#define BITS_OCP_L_2_1 (BIT_MASK_OCP_L_2_1 << BIT_SHIFT_OCP_L_2_1) -+#define BIT_CLEAR_OCP_L_2_1(x) ((x) & (~BITS_OCP_L_2_1)) -+#define BIT_GET_OCP_L_2_1(x) (((x) >> BIT_SHIFT_OCP_L_2_1) & BIT_MASK_OCP_L_2_1) -+#define BIT_SET_OCP_L_2_1(x, v) (BIT_CLEAR_OCP_L_2_1(x) | BIT_OCP_L_2_1(v)) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_LPF_C2_1_0 30 -+#define BIT_MASK_LPF_C2_1_0 0x3 -+#define BIT_LPF_C2_1_0(x) (((x) & BIT_MASK_LPF_C2_1_0) << BIT_SHIFT_LPF_C2_1_0) -+#define BITS_LPF_C2_1_0 (BIT_MASK_LPF_C2_1_0 << BIT_SHIFT_LPF_C2_1_0) -+#define BIT_CLEAR_LPF_C2_1_0(x) ((x) & (~BITS_LPF_C2_1_0)) -+#define BIT_GET_LPF_C2_1_0(x) \ -+ (((x) >> BIT_SHIFT_LPF_C2_1_0) & BIT_MASK_LPF_C2_1_0) -+#define BIT_SET_LPF_C2_1_0(x, v) (BIT_CLEAR_LPF_C2_1_0(x) | BIT_LPF_C2_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_REG_LPF_R3 29 -+#define BIT_MASK_REG_LPF_R3 0x7 -+#define BIT_REG_LPF_R3(x) (((x) & BIT_MASK_REG_LPF_R3) << BIT_SHIFT_REG_LPF_R3) -+#define BITS_REG_LPF_R3 (BIT_MASK_REG_LPF_R3 << BIT_SHIFT_REG_LPF_R3) -+#define BIT_CLEAR_REG_LPF_R3(x) ((x) & (~BITS_REG_LPF_R3)) -+#define BIT_GET_REG_LPF_R3(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R3) & BIT_MASK_REG_LPF_R3) -+#define BIT_SET_REG_LPF_R3(x, v) (BIT_CLEAR_REG_LPF_R3(x) | BIT_REG_LPF_R3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_EN_XTAL_AAC_TRIG BIT(28) -+#define BIT_EN_XTAL_AAC BIT(27) -+#define BIT_EN_XTAL_AAC_DIGI BIT(26) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_REG_LPF_R2 24 -+#define BIT_MASK_REG_LPF_R2 0x1f -+#define BIT_REG_LPF_R2(x) (((x) & BIT_MASK_REG_LPF_R2) << BIT_SHIFT_REG_LPF_R2) -+#define BITS_REG_LPF_R2 (BIT_MASK_REG_LPF_R2 << BIT_SHIFT_REG_LPF_R2) -+#define BIT_CLEAR_REG_LPF_R2(x) ((x) & (~BITS_REG_LPF_R2)) -+#define BIT_GET_REG_LPF_R2(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R2) & BIT_MASK_REG_LPF_R2) -+#define BIT_SET_REG_LPF_R2(x, v) (BIT_CLEAR_REG_LPF_R2(x) | BIT_REG_LPF_R2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_LPF_C1_5_0 24 -+#define BIT_MASK_LPF_C1_5_0 0x3f -+#define BIT_LPF_C1_5_0(x) (((x) & BIT_MASK_LPF_C1_5_0) << BIT_SHIFT_LPF_C1_5_0) -+#define BITS_LPF_C1_5_0 (BIT_MASK_LPF_C1_5_0 << BIT_SHIFT_LPF_C1_5_0) -+#define BIT_CLEAR_LPF_C1_5_0(x) ((x) & (~BITS_LPF_C1_5_0)) -+#define BIT_GET_LPF_C1_5_0(x) \ -+ (((x) >> BIT_SHIFT_LPF_C1_5_0) & BIT_MASK_LPF_C1_5_0) -+#define BIT_SET_LPF_C1_5_0(x, v) (BIT_CLEAR_LPF_C1_5_0(x) | BIT_LPF_C1_5_0(v)) -+ -+#define BIT_LPF_TIEL BIT(23) -+#define BIT_LPF_TIEH BIT(22) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_REG_LPF_C3 21 -+#define BIT_MASK_REG_LPF_C3 0x7 -+#define BIT_REG_LPF_C3(x) (((x) & BIT_MASK_REG_LPF_C3) << BIT_SHIFT_REG_LPF_C3) -+#define BITS_REG_LPF_C3 (BIT_MASK_REG_LPF_C3 << BIT_SHIFT_REG_LPF_C3) -+#define BIT_CLEAR_REG_LPF_C3(x) ((x) & (~BITS_REG_LPF_C3)) -+#define BIT_GET_REG_LPF_C3(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C3) & BIT_MASK_REG_LPF_C3) -+#define BIT_SET_REG_LPF_C3(x, v) (BIT_CLEAR_REG_LPF_C3(x) | BIT_REG_LPF_C3(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_LOCKDET_VREF_L_1_0 20 -+#define BIT_MASK_LOCKDET_VREF_L_1_0 0x3 -+#define BIT_LOCKDET_VREF_L_1_0(x) \ -+ (((x) & BIT_MASK_LOCKDET_VREF_L_1_0) << BIT_SHIFT_LOCKDET_VREF_L_1_0) -+#define BITS_LOCKDET_VREF_L_1_0 \ -+ (BIT_MASK_LOCKDET_VREF_L_1_0 << BIT_SHIFT_LOCKDET_VREF_L_1_0) -+#define BIT_CLEAR_LOCKDET_VREF_L_1_0(x) ((x) & (~BITS_LOCKDET_VREF_L_1_0)) -+#define BIT_GET_LOCKDET_VREF_L_1_0(x) \ -+ (((x) >> BIT_SHIFT_LOCKDET_VREF_L_1_0) & BIT_MASK_LOCKDET_VREF_L_1_0) -+#define BIT_SET_LOCKDET_VREF_L_1_0(x, v) \ -+ (BIT_CLEAR_LOCKDET_VREF_L_1_0(x) | BIT_LOCKDET_VREF_L_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_REG_LPF_C2 18 -+#define BIT_MASK_REG_LPF_C2 0x7 -+#define BIT_REG_LPF_C2(x) (((x) & BIT_MASK_REG_LPF_C2) << BIT_SHIFT_REG_LPF_C2) -+#define BITS_REG_LPF_C2 (BIT_MASK_REG_LPF_C2 << BIT_SHIFT_REG_LPF_C2) -+#define BIT_CLEAR_REG_LPF_C2(x) ((x) & (~BITS_REG_LPF_C2)) -+#define BIT_GET_REG_LPF_C2(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C2) & BIT_MASK_REG_LPF_C2) -+#define BIT_SET_REG_LPF_C2(x, v) (BIT_CLEAR_REG_LPF_C2(x) | BIT_REG_LPF_C2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_LOCKDET_VREF_H_1_0 18 -+#define BIT_MASK_LOCKDET_VREF_H_1_0 0x3 -+#define BIT_LOCKDET_VREF_H_1_0(x) \ -+ (((x) & BIT_MASK_LOCKDET_VREF_H_1_0) << BIT_SHIFT_LOCKDET_VREF_H_1_0) -+#define BITS_LOCKDET_VREF_H_1_0 \ -+ (BIT_MASK_LOCKDET_VREF_H_1_0 << BIT_SHIFT_LOCKDET_VREF_H_1_0) -+#define BIT_CLEAR_LOCKDET_VREF_H_1_0(x) ((x) & (~BITS_LOCKDET_VREF_H_1_0)) -+#define BIT_GET_LOCKDET_VREF_H_1_0(x) \ -+ (((x) >> BIT_SHIFT_LOCKDET_VREF_H_1_0) & BIT_MASK_LOCKDET_VREF_H_1_0) -+#define BIT_SET_LOCKDET_VREF_H_1_0(x, v) \ -+ (BIT_CLEAR_LOCKDET_VREF_H_1_0(x) | BIT_LOCKDET_VREF_H_1_0(v)) -+ -+#define BIT_SHIFT_LDO_SEL_1_0 16 -+#define BIT_MASK_LDO_SEL_1_0 0x3 -+#define BIT_LDO_SEL_1_0(x) \ -+ (((x) & BIT_MASK_LDO_SEL_1_0) << BIT_SHIFT_LDO_SEL_1_0) -+#define BITS_LDO_SEL_1_0 (BIT_MASK_LDO_SEL_1_0 << BIT_SHIFT_LDO_SEL_1_0) -+#define BIT_CLEAR_LDO_SEL_1_0(x) ((x) & (~BITS_LDO_SEL_1_0)) -+#define BIT_GET_LDO_SEL_1_0(x) \ -+ (((x) >> BIT_SHIFT_LDO_SEL_1_0) & BIT_MASK_LDO_SEL_1_0) -+#define BIT_SET_LDO_SEL_1_0(x, v) \ -+ (BIT_CLEAR_LDO_SEL_1_0(x) | BIT_LDO_SEL_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_REG_LPF_C1 15 -+#define BIT_MASK_REG_LPF_C1 0x7 -+#define BIT_REG_LPF_C1(x) (((x) & BIT_MASK_REG_LPF_C1) << BIT_SHIFT_REG_LPF_C1) -+#define BITS_REG_LPF_C1 (BIT_MASK_REG_LPF_C1 << BIT_SHIFT_REG_LPF_C1) -+#define BIT_CLEAR_REG_LPF_C1(x) ((x) & (~BITS_REG_LPF_C1)) -+#define BIT_GET_REG_LPF_C1(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C1) & BIT_MASK_REG_LPF_C1) -+#define BIT_SET_REG_LPF_C1(x, v) (BIT_CLEAR_REG_LPF_C1(x) | BIT_REG_LPF_C1(v)) -+ -+#define BIT_SHIFT_REG_LDO_SEL_V1 13 -+#define BIT_MASK_REG_LDO_SEL_V1 0x3 -+#define BIT_REG_LDO_SEL_V1(x) \ -+ (((x) & BIT_MASK_REG_LDO_SEL_V1) << BIT_SHIFT_REG_LDO_SEL_V1) -+#define BITS_REG_LDO_SEL_V1 \ -+ (BIT_MASK_REG_LDO_SEL_V1 << BIT_SHIFT_REG_LDO_SEL_V1) -+#define BIT_CLEAR_REG_LDO_SEL_V1(x) ((x) & (~BITS_REG_LDO_SEL_V1)) -+#define BIT_GET_REG_LDO_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_REG_LDO_SEL_V1) & BIT_MASK_REG_LDO_SEL_V1) -+#define BIT_SET_REG_LDO_SEL_V1(x, v) \ -+ (BIT_CLEAR_REG_LDO_SEL_V1(x) | BIT_REG_LDO_SEL_V1(v)) -+ -+#define BIT_REG_CP_ICPX2 BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_IOFFSET_5_0 10 -+#define BIT_MASK_IOFFSET_5_0 0x3f -+#define BIT_IOFFSET_5_0(x) \ -+ (((x) & BIT_MASK_IOFFSET_5_0) << BIT_SHIFT_IOFFSET_5_0) -+#define BITS_IOFFSET_5_0 (BIT_MASK_IOFFSET_5_0 << BIT_SHIFT_IOFFSET_5_0) -+#define BIT_CLEAR_IOFFSET_5_0(x) ((x) & (~BITS_IOFFSET_5_0)) -+#define BIT_GET_IOFFSET_5_0(x) \ -+ (((x) >> BIT_SHIFT_IOFFSET_5_0) & BIT_MASK_IOFFSET_5_0) -+#define BIT_SET_IOFFSET_5_0(x, v) \ -+ (BIT_CLEAR_IOFFSET_5_0(x) | BIT_IOFFSET_5_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_REG_CP_ICP_SEL_FAST 9 -+#define BIT_MASK_REG_CP_ICP_SEL_FAST 0x7 -+#define BIT_REG_CP_ICP_SEL_FAST(x) \ -+ (((x) & BIT_MASK_REG_CP_ICP_SEL_FAST) << BIT_SHIFT_REG_CP_ICP_SEL_FAST) -+#define BITS_REG_CP_ICP_SEL_FAST \ -+ (BIT_MASK_REG_CP_ICP_SEL_FAST << BIT_SHIFT_REG_CP_ICP_SEL_FAST) -+#define BIT_CLEAR_REG_CP_ICP_SEL_FAST(x) ((x) & (~BITS_REG_CP_ICP_SEL_FAST)) -+#define BIT_GET_REG_CP_ICP_SEL_FAST(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_ICP_SEL_FAST) & BIT_MASK_REG_CP_ICP_SEL_FAST) -+#define BIT_SET_REG_CP_ICP_SEL_FAST(x, v) \ -+ (BIT_CLEAR_REG_CP_ICP_SEL_FAST(x) | BIT_REG_CP_ICP_SEL_FAST(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_CP_ICPX2 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_GM_STEP BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_REG_CP_ICP_SEL 6 -+#define BIT_MASK_REG_CP_ICP_SEL 0x7 -+#define BIT_REG_CP_ICP_SEL(x) \ -+ (((x) & BIT_MASK_REG_CP_ICP_SEL) << BIT_SHIFT_REG_CP_ICP_SEL) -+#define BITS_REG_CP_ICP_SEL \ -+ (BIT_MASK_REG_CP_ICP_SEL << BIT_SHIFT_REG_CP_ICP_SEL) -+#define BIT_CLEAR_REG_CP_ICP_SEL(x) ((x) & (~BITS_REG_CP_ICP_SEL)) -+#define BIT_GET_REG_CP_ICP_SEL(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_ICP_SEL) & BIT_MASK_REG_CP_ICP_SEL) -+#define BIT_SET_REG_CP_ICP_SEL(x, v) \ -+ (BIT_CLEAR_REG_CP_ICP_SEL(x) | BIT_REG_CP_ICP_SEL(v)) -+ -+#define BIT_SHIFT_REG_IB_PI 4 -+#define BIT_MASK_REG_IB_PI 0x3 -+#define BIT_REG_IB_PI(x) (((x) & BIT_MASK_REG_IB_PI) << BIT_SHIFT_REG_IB_PI) -+#define BITS_REG_IB_PI (BIT_MASK_REG_IB_PI << BIT_SHIFT_REG_IB_PI) -+#define BIT_CLEAR_REG_IB_PI(x) ((x) & (~BITS_REG_IB_PI)) -+#define BIT_GET_REG_IB_PI(x) (((x) >> BIT_SHIFT_REG_IB_PI) & BIT_MASK_REG_IB_PI) -+#define BIT_SET_REG_IB_PI(x, v) (BIT_CLEAR_REG_IB_PI(x) | BIT_REG_IB_PI(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_CP_ICP_SEL_4_0 4 -+#define BIT_MASK_CP_ICP_SEL_4_0 0x1f -+#define BIT_CP_ICP_SEL_4_0(x) \ -+ (((x) & BIT_MASK_CP_ICP_SEL_4_0) << BIT_SHIFT_CP_ICP_SEL_4_0) -+#define BITS_CP_ICP_SEL_4_0 \ -+ (BIT_MASK_CP_ICP_SEL_4_0 << BIT_SHIFT_CP_ICP_SEL_4_0) -+#define BIT_CLEAR_CP_ICP_SEL_4_0(x) ((x) & (~BITS_CP_ICP_SEL_4_0)) -+#define BIT_GET_CP_ICP_SEL_4_0(x) \ -+ (((x) >> BIT_SHIFT_CP_ICP_SEL_4_0) & BIT_MASK_CP_ICP_SEL_4_0) -+#define BIT_SET_CP_ICP_SEL_4_0(x, v) \ -+ (BIT_CLEAR_CP_ICP_SEL_4_0(x) | BIT_CP_ICP_SEL_4_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_LDO2PWRCUT BIT(3) -+#define BIT_VPULSE_LDO BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_SHIFT_IB_PI_1_0 2 -+#define BIT_MASK_IB_PI_1_0 0x3 -+#define BIT_IB_PI_1_0(x) (((x) & BIT_MASK_IB_PI_1_0) << BIT_SHIFT_IB_PI_1_0) -+#define BITS_IB_PI_1_0 (BIT_MASK_IB_PI_1_0 << BIT_SHIFT_IB_PI_1_0) -+#define BIT_CLEAR_IB_PI_1_0(x) ((x) & (~BITS_IB_PI_1_0)) -+#define BIT_GET_IB_PI_1_0(x) (((x) >> BIT_SHIFT_IB_PI_1_0) & BIT_MASK_IB_PI_1_0) -+#define BIT_SET_IB_PI_1_0(x, v) (BIT_CLEAR_IB_PI_1_0(x) | BIT_IB_PI_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_0 (Offset 0x1018) */ -+ -+#define BIT_OFFSET_PLUS BIT(1) -+ -+#define BIT_SHIFT_LDO_VSEL 0 -+#define BIT_MASK_LDO_VSEL 0x3 -+#define BIT_LDO_VSEL(x) (((x) & BIT_MASK_LDO_VSEL) << BIT_SHIFT_LDO_VSEL) -+#define BITS_LDO_VSEL (BIT_MASK_LDO_VSEL << BIT_SHIFT_LDO_VSEL) -+#define BIT_CLEAR_LDO_VSEL(x) ((x) & (~BITS_LDO_VSEL)) -+#define BIT_GET_LDO_VSEL(x) (((x) >> BIT_SHIFT_LDO_VSEL) & BIT_MASK_LDO_VSEL) -+#define BIT_SET_LDO_VSEL(x, v) (BIT_CLEAR_LDO_VSEL(x) | BIT_LDO_VSEL(v)) -+ -+#define BIT_RESET_N BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_REG_CK_MON_SEL 29 -+#define BIT_MASK_REG_CK_MON_SEL 0x7 -+#define BIT_REG_CK_MON_SEL(x) \ -+ (((x) & BIT_MASK_REG_CK_MON_SEL) << BIT_SHIFT_REG_CK_MON_SEL) -+#define BITS_REG_CK_MON_SEL \ -+ (BIT_MASK_REG_CK_MON_SEL << BIT_SHIFT_REG_CK_MON_SEL) -+#define BIT_CLEAR_REG_CK_MON_SEL(x) ((x) & (~BITS_REG_CK_MON_SEL)) -+#define BIT_GET_REG_CK_MON_SEL(x) \ -+ (((x) >> BIT_SHIFT_REG_CK_MON_SEL) & BIT_MASK_REG_CK_MON_SEL) -+#define BIT_SET_REG_CK_MON_SEL(x, v) \ -+ (BIT_CLEAR_REG_CK_MON_SEL(x) | BIT_REG_CK_MON_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_CKX_USB_IB_SEL 29 -+#define BIT_MASK_CKX_USB_IB_SEL 0x7 -+#define BIT_CKX_USB_IB_SEL(x) \ -+ (((x) & BIT_MASK_CKX_USB_IB_SEL) << BIT_SHIFT_CKX_USB_IB_SEL) -+#define BITS_CKX_USB_IB_SEL \ -+ (BIT_MASK_CKX_USB_IB_SEL << BIT_SHIFT_CKX_USB_IB_SEL) -+#define BIT_CLEAR_CKX_USB_IB_SEL(x) ((x) & (~BITS_CKX_USB_IB_SEL)) -+#define BIT_GET_CKX_USB_IB_SEL(x) \ -+ (((x) >> BIT_SHIFT_CKX_USB_IB_SEL) & BIT_MASK_CKX_USB_IB_SEL) -+#define BIT_SET_CKX_USB_IB_SEL(x, v) \ -+ (BIT_CLEAR_CKX_USB_IB_SEL(x) | BIT_CKX_USB_IB_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_REG_CK_MON_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_PFD_DN_GATED BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_REG_XTAL_FREQ_SEL BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_PFD_UP_GATED BIT(27) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_REG_XTAL_EDGE_SEL BIT(26) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_PFD_RESET_GATED BIT(26) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_REG_VCO_KVCO BIT(25) -+#define BIT_REG_SDM_EDGE_SEL BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_PFD_OUT_DRV_1_0 24 -+#define BIT_MASK_PFD_OUT_DRV_1_0 0x3 -+#define BIT_PFD_OUT_DRV_1_0(x) \ -+ (((x) & BIT_MASK_PFD_OUT_DRV_1_0) << BIT_SHIFT_PFD_OUT_DRV_1_0) -+#define BITS_PFD_OUT_DRV_1_0 \ -+ (BIT_MASK_PFD_OUT_DRV_1_0 << BIT_SHIFT_PFD_OUT_DRV_1_0) -+#define BIT_CLEAR_PFD_OUT_DRV_1_0(x) ((x) & (~BITS_PFD_OUT_DRV_1_0)) -+#define BIT_GET_PFD_OUT_DRV_1_0(x) \ -+ (((x) >> BIT_SHIFT_PFD_OUT_DRV_1_0) & BIT_MASK_PFD_OUT_DRV_1_0) -+#define BIT_SET_PFD_OUT_DRV_1_0(x, v) \ -+ (BIT_CLEAR_PFD_OUT_DRV_1_0(x) | BIT_PFD_OUT_DRV_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_REG_SDM_CK_SEL BIT(23) -+#define BIT_REG_SDM_CK_GATED BIT(22) -+#define BIT_REG_PFD_RESET_GATED BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_LPF_TIEMID_2_0 20 -+#define BIT_MASK_LPF_TIEMID_2_0 0x7 -+#define BIT_LPF_TIEMID_2_0(x) \ -+ (((x) & BIT_MASK_LPF_TIEMID_2_0) << BIT_SHIFT_LPF_TIEMID_2_0) -+#define BITS_LPF_TIEMID_2_0 \ -+ (BIT_MASK_LPF_TIEMID_2_0 << BIT_SHIFT_LPF_TIEMID_2_0) -+#define BIT_CLEAR_LPF_TIEMID_2_0(x) ((x) & (~BITS_LPF_TIEMID_2_0)) -+#define BIT_GET_LPF_TIEMID_2_0(x) \ -+ (((x) >> BIT_SHIFT_LPF_TIEMID_2_0) & BIT_MASK_LPF_TIEMID_2_0) -+#define BIT_SET_LPF_TIEMID_2_0(x, v) \ -+ (BIT_CLEAR_LPF_TIEMID_2_0(x) | BIT_LPF_TIEMID_2_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_REG_LPF_R3_FAST 16 -+#define BIT_MASK_REG_LPF_R3_FAST 0x1f -+#define BIT_REG_LPF_R3_FAST(x) \ -+ (((x) & BIT_MASK_REG_LPF_R3_FAST) << BIT_SHIFT_REG_LPF_R3_FAST) -+#define BITS_REG_LPF_R3_FAST \ -+ (BIT_MASK_REG_LPF_R3_FAST << BIT_SHIFT_REG_LPF_R3_FAST) -+#define BIT_CLEAR_REG_LPF_R3_FAST(x) ((x) & (~BITS_REG_LPF_R3_FAST)) -+#define BIT_GET_REG_LPF_R3_FAST(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R3_FAST) & BIT_MASK_REG_LPF_R3_FAST) -+#define BIT_SET_REG_LPF_R3_FAST(x, v) \ -+ (BIT_CLEAR_REG_LPF_R3_FAST(x) | BIT_REG_LPF_R3_FAST(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_LPF_R3_4_0 15 -+#define BIT_MASK_LPF_R3_4_0 0x1f -+#define BIT_LPF_R3_4_0(x) (((x) & BIT_MASK_LPF_R3_4_0) << BIT_SHIFT_LPF_R3_4_0) -+#define BITS_LPF_R3_4_0 (BIT_MASK_LPF_R3_4_0 << BIT_SHIFT_LPF_R3_4_0) -+#define BIT_CLEAR_LPF_R3_4_0(x) ((x) & (~BITS_LPF_R3_4_0)) -+#define BIT_GET_LPF_R3_4_0(x) \ -+ (((x) >> BIT_SHIFT_LPF_R3_4_0) & BIT_MASK_LPF_R3_4_0) -+#define BIT_SET_LPF_R3_4_0(x, v) (BIT_CLEAR_LPF_R3_4_0(x) | BIT_LPF_R3_4_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_REG_LPF_R2_FAST 11 -+#define BIT_MASK_REG_LPF_R2_FAST 0x1f -+#define BIT_REG_LPF_R2_FAST(x) \ -+ (((x) & BIT_MASK_REG_LPF_R2_FAST) << BIT_SHIFT_REG_LPF_R2_FAST) -+#define BITS_REG_LPF_R2_FAST \ -+ (BIT_MASK_REG_LPF_R2_FAST << BIT_SHIFT_REG_LPF_R2_FAST) -+#define BIT_CLEAR_REG_LPF_R2_FAST(x) ((x) & (~BITS_REG_LPF_R2_FAST)) -+#define BIT_GET_REG_LPF_R2_FAST(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R2_FAST) & BIT_MASK_REG_LPF_R2_FAST) -+#define BIT_SET_REG_LPF_R2_FAST(x, v) \ -+ (BIT_CLEAR_REG_LPF_R2_FAST(x) | BIT_REG_LPF_R2_FAST(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_LPF_R2_4_0 10 -+#define BIT_MASK_LPF_R2_4_0 0x1f -+#define BIT_LPF_R2_4_0(x) (((x) & BIT_MASK_LPF_R2_4_0) << BIT_SHIFT_LPF_R2_4_0) -+#define BITS_LPF_R2_4_0 (BIT_MASK_LPF_R2_4_0 << BIT_SHIFT_LPF_R2_4_0) -+#define BIT_CLEAR_LPF_R2_4_0(x) ((x) & (~BITS_LPF_R2_4_0)) -+#define BIT_GET_LPF_R2_4_0(x) \ -+ (((x) >> BIT_SHIFT_LPF_R2_4_0) & BIT_MASK_LPF_R2_4_0) -+#define BIT_SET_LPF_R2_4_0(x, v) (BIT_CLEAR_LPF_R2_4_0(x) | BIT_LPF_R2_4_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_REG_LPF_C3_FAST 8 -+#define BIT_MASK_REG_LPF_C3_FAST 0x7 -+#define BIT_REG_LPF_C3_FAST(x) \ -+ (((x) & BIT_MASK_REG_LPF_C3_FAST) << BIT_SHIFT_REG_LPF_C3_FAST) -+#define BITS_REG_LPF_C3_FAST \ -+ (BIT_MASK_REG_LPF_C3_FAST << BIT_SHIFT_REG_LPF_C3_FAST) -+#define BIT_CLEAR_REG_LPF_C3_FAST(x) ((x) & (~BITS_REG_LPF_C3_FAST)) -+#define BIT_GET_REG_LPF_C3_FAST(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C3_FAST) & BIT_MASK_REG_LPF_C3_FAST) -+#define BIT_SET_REG_LPF_C3_FAST(x, v) \ -+ (BIT_CLEAR_REG_LPF_C3_FAST(x) | BIT_REG_LPF_C3_FAST(v)) -+ -+#define BIT_SHIFT_REG_LPF_C2_FAST 5 -+#define BIT_MASK_REG_LPF_C2_FAST 0x7 -+#define BIT_REG_LPF_C2_FAST(x) \ -+ (((x) & BIT_MASK_REG_LPF_C2_FAST) << BIT_SHIFT_REG_LPF_C2_FAST) -+#define BITS_REG_LPF_C2_FAST \ -+ (BIT_MASK_REG_LPF_C2_FAST << BIT_SHIFT_REG_LPF_C2_FAST) -+#define BIT_CLEAR_REG_LPF_C2_FAST(x) ((x) & (~BITS_REG_LPF_C2_FAST)) -+#define BIT_GET_REG_LPF_C2_FAST(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C2_FAST) & BIT_MASK_REG_LPF_C2_FAST) -+#define BIT_SET_REG_LPF_C2_FAST(x, v) \ -+ (BIT_CLEAR_REG_LPF_C2_FAST(x) | BIT_REG_LPF_C2_FAST(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_LPF_C3_5_0 4 -+#define BIT_MASK_LPF_C3_5_0 0x3f -+#define BIT_LPF_C3_5_0(x) (((x) & BIT_MASK_LPF_C3_5_0) << BIT_SHIFT_LPF_C3_5_0) -+#define BITS_LPF_C3_5_0 (BIT_MASK_LPF_C3_5_0 << BIT_SHIFT_LPF_C3_5_0) -+#define BIT_CLEAR_LPF_C3_5_0(x) ((x) & (~BITS_LPF_C3_5_0)) -+#define BIT_GET_LPF_C3_5_0(x) \ -+ (((x) >> BIT_SHIFT_LPF_C3_5_0) & BIT_MASK_LPF_C3_5_0) -+#define BIT_SET_LPF_C3_5_0(x, v) (BIT_CLEAR_LPF_C3_5_0(x) | BIT_LPF_C3_5_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_REG_LPF_C1_FAST 2 -+#define BIT_MASK_REG_LPF_C1_FAST 0x7 -+#define BIT_REG_LPF_C1_FAST(x) \ -+ (((x) & BIT_MASK_REG_LPF_C1_FAST) << BIT_SHIFT_REG_LPF_C1_FAST) -+#define BITS_REG_LPF_C1_FAST \ -+ (BIT_MASK_REG_LPF_C1_FAST << BIT_SHIFT_REG_LPF_C1_FAST) -+#define BIT_CLEAR_REG_LPF_C1_FAST(x) ((x) & (~BITS_REG_LPF_C1_FAST)) -+#define BIT_GET_REG_LPF_C1_FAST(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C1_FAST) & BIT_MASK_REG_LPF_C1_FAST) -+#define BIT_SET_REG_LPF_C1_FAST(x, v) \ -+ (BIT_CLEAR_REG_LPF_C1_FAST(x) | BIT_REG_LPF_C1_FAST(v)) -+ -+#define BIT_SHIFT_REG_LPF_R3_V1 0 -+#define BIT_MASK_REG_LPF_R3_V1 0x3 -+#define BIT_REG_LPF_R3_V1(x) \ -+ (((x) & BIT_MASK_REG_LPF_R3_V1) << BIT_SHIFT_REG_LPF_R3_V1) -+#define BITS_REG_LPF_R3_V1 (BIT_MASK_REG_LPF_R3_V1 << BIT_SHIFT_REG_LPF_R3_V1) -+#define BIT_CLEAR_REG_LPF_R3_V1(x) ((x) & (~BITS_REG_LPF_R3_V1)) -+#define BIT_GET_REG_LPF_R3_V1(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R3_V1) & BIT_MASK_REG_LPF_R3_V1) -+#define BIT_SET_REG_LPF_R3_V1(x, v) \ -+ (BIT_CLEAR_REG_LPF_R3_V1(x) | BIT_REG_LPF_R3_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_1 (Offset 0x101C) */ -+ -+#define BIT_SHIFT_LPF_C2_5_2 0 -+#define BIT_MASK_LPF_C2_5_2 0xf -+#define BIT_LPF_C2_5_2(x) (((x) & BIT_MASK_LPF_C2_5_2) << BIT_SHIFT_LPF_C2_5_2) -+#define BITS_LPF_C2_5_2 (BIT_MASK_LPF_C2_5_2 << BIT_SHIFT_LPF_C2_5_2) -+#define BIT_CLEAR_LPF_C2_5_2(x) ((x) & (~BITS_LPF_C2_5_2)) -+#define BIT_GET_LPF_C2_5_2(x) \ -+ (((x) >> BIT_SHIFT_LPF_C2_5_2) & BIT_MASK_LPF_C2_5_2) -+#define BIT_SET_LPF_C2_5_2(x, v) (BIT_CLEAR_LPF_C2_5_2(x) | BIT_LPF_C2_5_2(v)) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_CK_PHASE_SEL BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_SHIFT_AGPIO_DRV_V1 30 -+#define BIT_MASK_AGPIO_DRV_V1 0x3 -+#define BIT_AGPIO_DRV_V1(x) \ -+ (((x) & BIT_MASK_AGPIO_DRV_V1) << BIT_SHIFT_AGPIO_DRV_V1) -+#define BITS_AGPIO_DRV_V1 (BIT_MASK_AGPIO_DRV_V1 << BIT_SHIFT_AGPIO_DRV_V1) -+#define BIT_CLEAR_AGPIO_DRV_V1(x) ((x) & (~BITS_AGPIO_DRV_V1)) -+#define BIT_GET_AGPIO_DRV_V1(x) \ -+ (((x) >> BIT_SHIFT_AGPIO_DRV_V1) & BIT_MASK_AGPIO_DRV_V1) -+#define BIT_SET_AGPIO_DRV_V1(x, v) \ -+ (BIT_CLEAR_AGPIO_DRV_V1(x) | BIT_AGPIO_DRV_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_CK960M_EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_AGPIO_GPO_V1 BIT(29) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_CK640M_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_AGPIO_GPE_V1 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_CK240M_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_SEL_CLK BIT(27) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_SHIFT_CK_MON_SEL_2_0 25 -+#define BIT_MASK_CK_MON_SEL_2_0 0x7 -+#define BIT_CK_MON_SEL_2_0(x) \ -+ (((x) & BIT_MASK_CK_MON_SEL_2_0) << BIT_SHIFT_CK_MON_SEL_2_0) -+#define BITS_CK_MON_SEL_2_0 \ -+ (BIT_MASK_CK_MON_SEL_2_0 << BIT_SHIFT_CK_MON_SEL_2_0) -+#define BIT_CLEAR_CK_MON_SEL_2_0(x) ((x) & (~BITS_CK_MON_SEL_2_0)) -+#define BIT_GET_CK_MON_SEL_2_0(x) \ -+ (((x) >> BIT_SHIFT_CK_MON_SEL_2_0) & BIT_MASK_CK_MON_SEL_2_0) -+#define BIT_SET_CK_MON_SEL_2_0(x, v) \ -+ (BIT_CLEAR_CK_MON_SEL_2_0(x) | BIT_CK_MON_SEL_2_0(v)) -+ -+#define BIT_CK_MON_EN_V1 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_SHIFT_LS_XTAL_SEL 23 -+#define BIT_MASK_LS_XTAL_SEL 0xf -+#define BIT_LS_XTAL_SEL(x) \ -+ (((x) & BIT_MASK_LS_XTAL_SEL) << BIT_SHIFT_LS_XTAL_SEL) -+#define BITS_LS_XTAL_SEL (BIT_MASK_LS_XTAL_SEL << BIT_SHIFT_LS_XTAL_SEL) -+#define BIT_CLEAR_LS_XTAL_SEL(x) ((x) & (~BITS_LS_XTAL_SEL)) -+#define BIT_GET_LS_XTAL_SEL(x) \ -+ (((x) >> BIT_SHIFT_LS_XTAL_SEL) & BIT_MASK_LS_XTAL_SEL) -+#define BIT_SET_LS_XTAL_SEL(x, v) \ -+ (BIT_CLEAR_LS_XTAL_SEL(x) | BIT_LS_XTAL_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_XTAL_SOURCE_SEL BIT(23) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_LS_SDM_ORDER_V1 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_XTAL_FREQ_SEL BIT(22) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_LS_DELAY_PH BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_XTAL_EDGE_SEL BIT(21) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_DIVIDER_SEL BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_XTAL_BUF_SEL BIT(20) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_SHIFT_PCODE 15 -+#define BIT_MASK_PCODE 0x1f -+#define BIT_PCODE(x) (((x) & BIT_MASK_PCODE) << BIT_SHIFT_PCODE) -+#define BITS_PCODE (BIT_MASK_PCODE << BIT_SHIFT_PCODE) -+#define BIT_CLEAR_PCODE(x) ((x) & (~BITS_PCODE)) -+#define BIT_GET_PCODE(x) (((x) >> BIT_SHIFT_PCODE) & BIT_MASK_PCODE) -+#define BIT_SET_PCODE(x, v) (BIT_CLEAR_PCODE(x) | BIT_PCODE(v)) -+ -+#define BIT_SHIFT_NCODE 7 -+#define BIT_MASK_NCODE 0xff -+#define BIT_NCODE(x) (((x) & BIT_MASK_NCODE) << BIT_SHIFT_NCODE) -+#define BITS_NCODE (BIT_MASK_NCODE << BIT_SHIFT_NCODE) -+#define BIT_CLEAR_NCODE(x) ((x) & (~BITS_NCODE)) -+#define BIT_GET_NCODE(x) (((x) >> BIT_SHIFT_NCODE) & BIT_MASK_NCODE) -+#define BIT_SET_NCODE(x, v) (BIT_CLEAR_NCODE(x) | BIT_NCODE(v)) -+ -+#define BIT_REG_BEACON BIT(6) -+#define BIT_REG_MBIASE BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_SHIFT_VCO_CV_7_0 4 -+#define BIT_MASK_VCO_CV_7_0 0xff -+#define BIT_VCO_CV_7_0(x) (((x) & BIT_MASK_VCO_CV_7_0) << BIT_SHIFT_VCO_CV_7_0) -+#define BITS_VCO_CV_7_0 (BIT_MASK_VCO_CV_7_0 << BIT_SHIFT_VCO_CV_7_0) -+#define BIT_CLEAR_VCO_CV_7_0(x) ((x) & (~BITS_VCO_CV_7_0)) -+#define BIT_GET_VCO_CV_7_0(x) \ -+ (((x) >> BIT_SHIFT_VCO_CV_7_0) & BIT_MASK_VCO_CV_7_0) -+#define BIT_SET_VCO_CV_7_0(x, v) (BIT_CLEAR_VCO_CV_7_0(x) | BIT_VCO_CV_7_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_SHIFT_REG_FAST_SEL 3 -+#define BIT_MASK_REG_FAST_SEL 0x3 -+#define BIT_REG_FAST_SEL(x) \ -+ (((x) & BIT_MASK_REG_FAST_SEL) << BIT_SHIFT_REG_FAST_SEL) -+#define BITS_REG_FAST_SEL (BIT_MASK_REG_FAST_SEL << BIT_SHIFT_REG_FAST_SEL) -+#define BIT_CLEAR_REG_FAST_SEL(x) ((x) & (~BITS_REG_FAST_SEL)) -+#define BIT_GET_REG_FAST_SEL(x) \ -+ (((x) >> BIT_SHIFT_REG_FAST_SEL) & BIT_MASK_REG_FAST_SEL) -+#define BIT_SET_REG_FAST_SEL(x, v) \ -+ (BIT_CLEAR_REG_FAST_SEL(x) | BIT_REG_FAST_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_VCO_KVCO BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_REG_CK960M_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_SDM_EDGE_SEL BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_REG_CK320M_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_SDM_CK_SEL BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_REG_CK_5M_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_MAC_2 (Offset 0x1020) */ -+ -+#define BIT_SDM_CK_GATED BIT(0) -+ -+/* 2 REG_ANAPAR_MAC_3 (Offset 0x1024) */ -+ -+#define BIT_SHIFT_LCK_WAIT_CYCLE_2_0 28 -+#define BIT_MASK_LCK_WAIT_CYCLE_2_0 0x7 -+#define BIT_LCK_WAIT_CYCLE_2_0(x) \ -+ (((x) & BIT_MASK_LCK_WAIT_CYCLE_2_0) << BIT_SHIFT_LCK_WAIT_CYCLE_2_0) -+#define BITS_LCK_WAIT_CYCLE_2_0 \ -+ (BIT_MASK_LCK_WAIT_CYCLE_2_0 << BIT_SHIFT_LCK_WAIT_CYCLE_2_0) -+#define BIT_CLEAR_LCK_WAIT_CYCLE_2_0(x) ((x) & (~BITS_LCK_WAIT_CYCLE_2_0)) -+#define BIT_GET_LCK_WAIT_CYCLE_2_0(x) \ -+ (((x) >> BIT_SHIFT_LCK_WAIT_CYCLE_2_0) & BIT_MASK_LCK_WAIT_CYCLE_2_0) -+#define BIT_SET_LCK_WAIT_CYCLE_2_0(x, v) \ -+ (BIT_CLEAR_LCK_WAIT_CYCLE_2_0(x) | BIT_LCK_WAIT_CYCLE_2_0(v)) -+ -+#define BIT_SHIFT_LCK_VCO_DIVISOR_1_0 26 -+#define BIT_MASK_LCK_VCO_DIVISOR_1_0 0x3 -+#define BIT_LCK_VCO_DIVISOR_1_0(x) \ -+ (((x) & BIT_MASK_LCK_VCO_DIVISOR_1_0) << BIT_SHIFT_LCK_VCO_DIVISOR_1_0) -+#define BITS_LCK_VCO_DIVISOR_1_0 \ -+ (BIT_MASK_LCK_VCO_DIVISOR_1_0 << BIT_SHIFT_LCK_VCO_DIVISOR_1_0) -+#define BIT_CLEAR_LCK_VCO_DIVISOR_1_0(x) ((x) & (~BITS_LCK_VCO_DIVISOR_1_0)) -+#define BIT_GET_LCK_VCO_DIVISOR_1_0(x) \ -+ (((x) >> BIT_SHIFT_LCK_VCO_DIVISOR_1_0) & BIT_MASK_LCK_VCO_DIVISOR_1_0) -+#define BIT_SET_LCK_VCO_DIVISOR_1_0(x, v) \ -+ (BIT_CLEAR_LCK_VCO_DIVISOR_1_0(x) | BIT_LCK_VCO_DIVISOR_1_0(v)) -+ -+#define BIT_SHIFT_LCK_SEARCH_MODE_1_0 24 -+#define BIT_MASK_LCK_SEARCH_MODE_1_0 0x3 -+#define BIT_LCK_SEARCH_MODE_1_0(x) \ -+ (((x) & BIT_MASK_LCK_SEARCH_MODE_1_0) << BIT_SHIFT_LCK_SEARCH_MODE_1_0) -+#define BITS_LCK_SEARCH_MODE_1_0 \ -+ (BIT_MASK_LCK_SEARCH_MODE_1_0 << BIT_SHIFT_LCK_SEARCH_MODE_1_0) -+#define BIT_CLEAR_LCK_SEARCH_MODE_1_0(x) ((x) & (~BITS_LCK_SEARCH_MODE_1_0)) -+#define BIT_GET_LCK_SEARCH_MODE_1_0(x) \ -+ (((x) >> BIT_SHIFT_LCK_SEARCH_MODE_1_0) & BIT_MASK_LCK_SEARCH_MODE_1_0) -+#define BIT_SET_LCK_SEARCH_MODE_1_0(x, v) \ -+ (BIT_CLEAR_LCK_SEARCH_MODE_1_0(x) | BIT_LCK_SEARCH_MODE_1_0(v)) -+ -+#define BIT_SHIFT_LS_CV_OFFSET_3_0 12 -+#define BIT_MASK_LS_CV_OFFSET_3_0 0xf -+#define BIT_LS_CV_OFFSET_3_0(x) \ -+ (((x) & BIT_MASK_LS_CV_OFFSET_3_0) << BIT_SHIFT_LS_CV_OFFSET_3_0) -+#define BITS_LS_CV_OFFSET_3_0 \ -+ (BIT_MASK_LS_CV_OFFSET_3_0 << BIT_SHIFT_LS_CV_OFFSET_3_0) -+#define BIT_CLEAR_LS_CV_OFFSET_3_0(x) ((x) & (~BITS_LS_CV_OFFSET_3_0)) -+#define BIT_GET_LS_CV_OFFSET_3_0(x) \ -+ (((x) >> BIT_SHIFT_LS_CV_OFFSET_3_0) & BIT_MASK_LS_CV_OFFSET_3_0) -+#define BIT_SET_LS_CV_OFFSET_3_0(x, v) \ -+ (BIT_CLEAR_LS_CV_OFFSET_3_0(x) | BIT_LS_CV_OFFSET_3_0(v)) -+ -+#define BIT_LS_EN_LC_CK40M BIT(11) -+#define BIT_LS__CV_MANUAL BIT(10) -+#define BIT_LS_PYPASS_PI BIT(9) -+#define BIT_MBIASE BIT(4) -+ -+/* 2 REG_ANAPAR_MAC_4 (Offset 0x1028) */ -+ -+#define BIT_LS_TIE_MID_MODE BIT(28) -+ -+#define BIT_SHIFT_LS_SYNC_CYCLE_1_0 26 -+#define BIT_MASK_LS_SYNC_CYCLE_1_0 0x3 -+#define BIT_LS_SYNC_CYCLE_1_0(x) \ -+ (((x) & BIT_MASK_LS_SYNC_CYCLE_1_0) << BIT_SHIFT_LS_SYNC_CYCLE_1_0) -+#define BITS_LS_SYNC_CYCLE_1_0 \ -+ (BIT_MASK_LS_SYNC_CYCLE_1_0 << BIT_SHIFT_LS_SYNC_CYCLE_1_0) -+#define BIT_CLEAR_LS_SYNC_CYCLE_1_0(x) ((x) & (~BITS_LS_SYNC_CYCLE_1_0)) -+#define BIT_GET_LS_SYNC_CYCLE_1_0(x) \ -+ (((x) >> BIT_SHIFT_LS_SYNC_CYCLE_1_0) & BIT_MASK_LS_SYNC_CYCLE_1_0) -+#define BIT_SET_LS_SYNC_CYCLE_1_0(x, v) \ -+ (BIT_CLEAR_LS_SYNC_CYCLE_1_0(x) | BIT_LS_SYNC_CYCLE_1_0(v)) -+ -+#define BIT_LS_SDM_ORDER BIT(25) -+#define BIT_LS_RST_LC_CAL BIT(14) -+#define BIT_LS_RSTB BIT(13) -+#define BIT_LS_POW_LC_CAL_PREP BIT(11) -+ -+#define BIT_SHIFT_LCK_XTAL_DIVISOR_1_0 0 -+#define BIT_MASK_LCK_XTAL_DIVISOR_1_0 0x3 -+#define BIT_LCK_XTAL_DIVISOR_1_0(x) \ -+ (((x) & BIT_MASK_LCK_XTAL_DIVISOR_1_0) \ -+ << BIT_SHIFT_LCK_XTAL_DIVISOR_1_0) -+#define BITS_LCK_XTAL_DIVISOR_1_0 \ -+ (BIT_MASK_LCK_XTAL_DIVISOR_1_0 << BIT_SHIFT_LCK_XTAL_DIVISOR_1_0) -+#define BIT_CLEAR_LCK_XTAL_DIVISOR_1_0(x) ((x) & (~BITS_LCK_XTAL_DIVISOR_1_0)) -+#define BIT_GET_LCK_XTAL_DIVISOR_1_0(x) \ -+ (((x) >> BIT_SHIFT_LCK_XTAL_DIVISOR_1_0) & \ -+ BIT_MASK_LCK_XTAL_DIVISOR_1_0) -+#define BIT_SET_LCK_XTAL_DIVISOR_1_0(x, v) \ -+ (BIT_CLEAR_LCK_XTAL_DIVISOR_1_0(x) | BIT_LCK_XTAL_DIVISOR_1_0(v)) -+ -+/* 2 REG_ANAPAR_MAC_5 (Offset 0x102C) */ -+ -+#define BIT_SHIFT_LS_XTAL_SEL_3_0 0 -+#define BIT_MASK_LS_XTAL_SEL_3_0 0xf -+#define BIT_LS_XTAL_SEL_3_0(x) \ -+ (((x) & BIT_MASK_LS_XTAL_SEL_3_0) << BIT_SHIFT_LS_XTAL_SEL_3_0) -+#define BITS_LS_XTAL_SEL_3_0 \ -+ (BIT_MASK_LS_XTAL_SEL_3_0 << BIT_SHIFT_LS_XTAL_SEL_3_0) -+#define BIT_CLEAR_LS_XTAL_SEL_3_0(x) ((x) & (~BITS_LS_XTAL_SEL_3_0)) -+#define BIT_GET_LS_XTAL_SEL_3_0(x) \ -+ (((x) >> BIT_SHIFT_LS_XTAL_SEL_3_0) & BIT_MASK_LS_XTAL_SEL_3_0) -+#define BIT_SET_LS_XTAL_SEL_3_0(x, v) \ -+ (BIT_CLEAR_LS_XTAL_SEL_3_0(x) | BIT_LS_XTAL_SEL_3_0(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SYS_CFG4 (Offset 0x1034) */ -+ -+#define BIT_EF_CSER_1 BIT(26) -+#define BIT_SW_PG_EN_1 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_XTAL_SC_LPS BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_XTAL_DRV_RF1_0 BIT(31) -+#define BIT_XTAL_GATED_RF1N BIT(30) -+#define BIT_XTAL_GATED_RF1P BIT(29) -+#define BIT_XTAL_GM_SEP_V2 BIT(28) -+ -+#define BIT_SHIFT_XTAL_LDO_1_0 26 -+#define BIT_MASK_XTAL_LDO_1_0 0x3 -+#define BIT_XTAL_LDO_1_0(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_1_0) << BIT_SHIFT_XTAL_LDO_1_0) -+#define BITS_XTAL_LDO_1_0 (BIT_MASK_XTAL_LDO_1_0 << BIT_SHIFT_XTAL_LDO_1_0) -+#define BIT_CLEAR_XTAL_LDO_1_0(x) ((x) & (~BITS_XTAL_LDO_1_0)) -+#define BIT_GET_XTAL_LDO_1_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_1_0) & BIT_MASK_XTAL_LDO_1_0) -+#define BIT_SET_XTAL_LDO_1_0(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_1_0(x) | BIT_XTAL_LDO_1_0(v)) -+ -+#define BIT_XQSEL_V1 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_SHIFT_XTAL_SC_INIT 24 -+#define BIT_MASK_XTAL_SC_INIT 0x7f -+#define BIT_XTAL_SC_INIT(x) \ -+ (((x) & BIT_MASK_XTAL_SC_INIT) << BIT_SHIFT_XTAL_SC_INIT) -+#define BITS_XTAL_SC_INIT (BIT_MASK_XTAL_SC_INIT << BIT_SHIFT_XTAL_SC_INIT) -+#define BIT_CLEAR_XTAL_SC_INIT(x) ((x) & (~BITS_XTAL_SC_INIT)) -+#define BIT_GET_XTAL_SC_INIT(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_INIT) & BIT_MASK_XTAL_SC_INIT) -+#define BIT_SET_XTAL_SC_INIT(x, v) \ -+ (BIT_CLEAR_XTAL_SC_INIT(x) | BIT_XTAL_SC_INIT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_GATED_XTAL_OK0 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_SHIFT_XTAL_SC_XO 17 -+#define BIT_MASK_XTAL_SC_XO 0x7f -+#define BIT_XTAL_SC_XO(x) (((x) & BIT_MASK_XTAL_SC_XO) << BIT_SHIFT_XTAL_SC_XO) -+#define BITS_XTAL_SC_XO (BIT_MASK_XTAL_SC_XO << BIT_SHIFT_XTAL_SC_XO) -+#define BIT_CLEAR_XTAL_SC_XO(x) ((x) & (~BITS_XTAL_SC_XO)) -+#define BIT_GET_XTAL_SC_XO(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_XO) & BIT_MASK_XTAL_SC_XO) -+#define BIT_SET_XTAL_SC_XO(x, v) (BIT_CLEAR_XTAL_SC_XO(x) | BIT_XTAL_SC_XO(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_SHIFT_XTAL_SC_XO_6_0 17 -+#define BIT_MASK_XTAL_SC_XO_6_0 0x7f -+#define BIT_XTAL_SC_XO_6_0(x) \ -+ (((x) & BIT_MASK_XTAL_SC_XO_6_0) << BIT_SHIFT_XTAL_SC_XO_6_0) -+#define BITS_XTAL_SC_XO_6_0 \ -+ (BIT_MASK_XTAL_SC_XO_6_0 << BIT_SHIFT_XTAL_SC_XO_6_0) -+#define BIT_CLEAR_XTAL_SC_XO_6_0(x) ((x) & (~BITS_XTAL_SC_XO_6_0)) -+#define BIT_GET_XTAL_SC_XO_6_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_XO_6_0) & BIT_MASK_XTAL_SC_XO_6_0) -+#define BIT_SET_XTAL_SC_XO_6_0(x, v) \ -+ (BIT_CLEAR_XTAL_SC_XO_6_0(x) | BIT_XTAL_SC_XO_6_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_SHIFT_XTAL_SC_XI 10 -+#define BIT_MASK_XTAL_SC_XI 0x7f -+#define BIT_XTAL_SC_XI(x) (((x) & BIT_MASK_XTAL_SC_XI) << BIT_SHIFT_XTAL_SC_XI) -+#define BITS_XTAL_SC_XI (BIT_MASK_XTAL_SC_XI << BIT_SHIFT_XTAL_SC_XI) -+#define BIT_CLEAR_XTAL_SC_XI(x) ((x) & (~BITS_XTAL_SC_XI)) -+#define BIT_GET_XTAL_SC_XI(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_XI) & BIT_MASK_XTAL_SC_XI) -+#define BIT_SET_XTAL_SC_XI(x, v) (BIT_CLEAR_XTAL_SC_XI(x) | BIT_XTAL_SC_XI(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_SHIFT_XTAL_SC_XI_6_0 10 -+#define BIT_MASK_XTAL_SC_XI_6_0 0x7f -+#define BIT_XTAL_SC_XI_6_0(x) \ -+ (((x) & BIT_MASK_XTAL_SC_XI_6_0) << BIT_SHIFT_XTAL_SC_XI_6_0) -+#define BITS_XTAL_SC_XI_6_0 \ -+ (BIT_MASK_XTAL_SC_XI_6_0 << BIT_SHIFT_XTAL_SC_XI_6_0) -+#define BIT_CLEAR_XTAL_SC_XI_6_0(x) ((x) & (~BITS_XTAL_SC_XI_6_0)) -+#define BIT_GET_XTAL_SC_XI_6_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_XI_6_0) & BIT_MASK_XTAL_SC_XI_6_0) -+#define BIT_SET_XTAL_SC_XI_6_0(x, v) \ -+ (BIT_CLEAR_XTAL_SC_XI_6_0(x) | BIT_XTAL_SC_XI_6_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_SHIFT_XTAL_GMN_V3 5 -+#define BIT_MASK_XTAL_GMN_V3 0x1f -+#define BIT_XTAL_GMN_V3(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_V3) << BIT_SHIFT_XTAL_GMN_V3) -+#define BITS_XTAL_GMN_V3 (BIT_MASK_XTAL_GMN_V3 << BIT_SHIFT_XTAL_GMN_V3) -+#define BIT_CLEAR_XTAL_GMN_V3(x) ((x) & (~BITS_XTAL_GMN_V3)) -+#define BIT_GET_XTAL_GMN_V3(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_V3) & BIT_MASK_XTAL_GMN_V3) -+#define BIT_SET_XTAL_GMN_V3(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_V3(x) | BIT_XTAL_GMN_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_SHIFT_XTAL_GMN_4_0 5 -+#define BIT_MASK_XTAL_GMN_4_0 0x1f -+#define BIT_XTAL_GMN_4_0(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_4_0) << BIT_SHIFT_XTAL_GMN_4_0) -+#define BITS_XTAL_GMN_4_0 (BIT_MASK_XTAL_GMN_4_0 << BIT_SHIFT_XTAL_GMN_4_0) -+#define BIT_CLEAR_XTAL_GMN_4_0(x) ((x) & (~BITS_XTAL_GMN_4_0)) -+#define BIT_GET_XTAL_GMN_4_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_4_0) & BIT_MASK_XTAL_GMN_4_0) -+#define BIT_SET_XTAL_GMN_4_0(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_4_0(x) | BIT_XTAL_GMN_4_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_SHIFT_XTAL_GMP_V3 0 -+#define BIT_MASK_XTAL_GMP_V3 0x1f -+#define BIT_XTAL_GMP_V3(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_V3) << BIT_SHIFT_XTAL_GMP_V3) -+#define BITS_XTAL_GMP_V3 (BIT_MASK_XTAL_GMP_V3 << BIT_SHIFT_XTAL_GMP_V3) -+#define BIT_CLEAR_XTAL_GMP_V3(x) ((x) & (~BITS_XTAL_GMP_V3)) -+#define BIT_GET_XTAL_GMP_V3(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_V3) & BIT_MASK_XTAL_GMP_V3) -+#define BIT_SET_XTAL_GMP_V3(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_V3(x) | BIT_XTAL_GMP_V3(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_0 (Offset 0x1040) */ -+ -+#define BIT_SHIFT_XTAL_GMP_4_0 0 -+#define BIT_MASK_XTAL_GMP_4_0 0x1f -+#define BIT_XTAL_GMP_4_0(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_4_0) << BIT_SHIFT_XTAL_GMP_4_0) -+#define BITS_XTAL_GMP_4_0 (BIT_MASK_XTAL_GMP_4_0 << BIT_SHIFT_XTAL_GMP_4_0) -+#define BIT_CLEAR_XTAL_GMP_4_0(x) ((x) & (~BITS_XTAL_GMP_4_0)) -+#define BIT_GET_XTAL_GMP_4_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_4_0) & BIT_MASK_XTAL_GMP_4_0) -+#define BIT_SET_XTAL_GMP_4_0(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_4_0(x) | BIT_XTAL_GMP_4_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XTAL_SEL_TOK_V1 BIT(31) -+#define BIT_XTAL_DELAY_DIGI_V2 BIT(30) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_SHIFT_XTAL_LDO_OK_1_0 30 -+#define BIT_MASK_XTAL_LDO_OK_1_0 0x3 -+#define BIT_XTAL_LDO_OK_1_0(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_OK_1_0) << BIT_SHIFT_XTAL_LDO_OK_1_0) -+#define BITS_XTAL_LDO_OK_1_0 \ -+ (BIT_MASK_XTAL_LDO_OK_1_0 << BIT_SHIFT_XTAL_LDO_OK_1_0) -+#define BIT_CLEAR_XTAL_LDO_OK_1_0(x) ((x) & (~BITS_XTAL_LDO_OK_1_0)) -+#define BIT_GET_XTAL_LDO_OK_1_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_OK_1_0) & BIT_MASK_XTAL_LDO_OK_1_0) -+#define BIT_SET_XTAL_LDO_OK_1_0(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_OK_1_0(x) | BIT_XTAL_LDO_OK_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XTAL_DELAY_USB_V2 BIT(29) -+#define BIT_XTAL_DELAY_AFE_V2 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_SHIFT_XTAL_XORES_SEL_2_0 27 -+#define BIT_MASK_XTAL_XORES_SEL_2_0 0x7 -+#define BIT_XTAL_XORES_SEL_2_0(x) \ -+ (((x) & BIT_MASK_XTAL_XORES_SEL_2_0) << BIT_SHIFT_XTAL_XORES_SEL_2_0) -+#define BITS_XTAL_XORES_SEL_2_0 \ -+ (BIT_MASK_XTAL_XORES_SEL_2_0 << BIT_SHIFT_XTAL_XORES_SEL_2_0) -+#define BIT_CLEAR_XTAL_XORES_SEL_2_0(x) ((x) & (~BITS_XTAL_XORES_SEL_2_0)) -+#define BIT_GET_XTAL_XORES_SEL_2_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_XORES_SEL_2_0) & BIT_MASK_XTAL_XORES_SEL_2_0) -+#define BIT_SET_XTAL_XORES_SEL_2_0(x, v) \ -+ (BIT_CLEAR_XTAL_XORES_SEL_2_0(x) | BIT_XTAL_XORES_SEL_2_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_SHIFT_XTAL_DRV_DIGI_V2 26 -+#define BIT_MASK_XTAL_DRV_DIGI_V2 0x3 -+#define BIT_XTAL_DRV_DIGI_V2(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_DIGI_V2) << BIT_SHIFT_XTAL_DRV_DIGI_V2) -+#define BITS_XTAL_DRV_DIGI_V2 \ -+ (BIT_MASK_XTAL_DRV_DIGI_V2 << BIT_SHIFT_XTAL_DRV_DIGI_V2) -+#define BIT_CLEAR_XTAL_DRV_DIGI_V2(x) ((x) & (~BITS_XTAL_DRV_DIGI_V2)) -+#define BIT_GET_XTAL_DRV_DIGI_V2(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_DIGI_V2) & BIT_MASK_XTAL_DRV_DIGI_V2) -+#define BIT_SET_XTAL_DRV_DIGI_V2(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_DIGI_V2(x) | BIT_XTAL_DRV_DIGI_V2(v)) -+ -+#define BIT_EN_XTAL_DRV_LPS BIT(25) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_SHIFT_XTAL_AAC_PK_SEL_1_0 25 -+#define BIT_MASK_XTAL_AAC_PK_SEL_1_0 0x3 -+#define BIT_XTAL_AAC_PK_SEL_1_0(x) \ -+ (((x) & BIT_MASK_XTAL_AAC_PK_SEL_1_0) << BIT_SHIFT_XTAL_AAC_PK_SEL_1_0) -+#define BITS_XTAL_AAC_PK_SEL_1_0 \ -+ (BIT_MASK_XTAL_AAC_PK_SEL_1_0 << BIT_SHIFT_XTAL_AAC_PK_SEL_1_0) -+#define BIT_CLEAR_XTAL_AAC_PK_SEL_1_0(x) ((x) & (~BITS_XTAL_AAC_PK_SEL_1_0)) -+#define BIT_GET_XTAL_AAC_PK_SEL_1_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_AAC_PK_SEL_1_0) & BIT_MASK_XTAL_AAC_PK_SEL_1_0) -+#define BIT_SET_XTAL_AAC_PK_SEL_1_0(x, v) \ -+ (BIT_CLEAR_XTAL_AAC_PK_SEL_1_0(x) | BIT_XTAL_AAC_PK_SEL_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_EN_XTAL_DRV_DIGI_V2 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_EN_XTAL_AAC_PKDET BIT(24) -+#define BIT_EN_XTAL_AAC_GM BIT(23) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_SHIFT_XTAL_DRV_USB 22 -+#define BIT_MASK_XTAL_DRV_USB 0x3 -+#define BIT_XTAL_DRV_USB(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_USB) << BIT_SHIFT_XTAL_DRV_USB) -+#define BITS_XTAL_DRV_USB (BIT_MASK_XTAL_DRV_USB << BIT_SHIFT_XTAL_DRV_USB) -+#define BIT_CLEAR_XTAL_DRV_USB(x) ((x) & (~BITS_XTAL_DRV_USB)) -+#define BIT_GET_XTAL_DRV_USB(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_USB) & BIT_MASK_XTAL_DRV_USB) -+#define BIT_SET_XTAL_DRV_USB(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_USB(x) | BIT_XTAL_DRV_USB(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XTAL_LPMODE BIT(22) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_EN_XTAL_DRV_USB BIT(21) -+ -+#define BIT_SHIFT_XTAL_DRV_AFE_V2 19 -+#define BIT_MASK_XTAL_DRV_AFE_V2 0x3 -+#define BIT_XTAL_DRV_AFE_V2(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_AFE_V2) << BIT_SHIFT_XTAL_DRV_AFE_V2) -+#define BITS_XTAL_DRV_AFE_V2 \ -+ (BIT_MASK_XTAL_DRV_AFE_V2 << BIT_SHIFT_XTAL_DRV_AFE_V2) -+#define BIT_CLEAR_XTAL_DRV_AFE_V2(x) ((x) & (~BITS_XTAL_DRV_AFE_V2)) -+#define BIT_GET_XTAL_DRV_AFE_V2(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_AFE_V2) & BIT_MASK_XTAL_DRV_AFE_V2) -+#define BIT_SET_XTAL_DRV_AFE_V2(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_AFE_V2(x) | BIT_XTAL_DRV_AFE_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_SHIFT_XTAL_SEL_TOK_2_0 19 -+#define BIT_MASK_XTAL_SEL_TOK_2_0 0x7 -+#define BIT_XTAL_SEL_TOK_2_0(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_TOK_2_0) << BIT_SHIFT_XTAL_SEL_TOK_2_0) -+#define BITS_XTAL_SEL_TOK_2_0 \ -+ (BIT_MASK_XTAL_SEL_TOK_2_0 << BIT_SHIFT_XTAL_SEL_TOK_2_0) -+#define BIT_CLEAR_XTAL_SEL_TOK_2_0(x) ((x) & (~BITS_XTAL_SEL_TOK_2_0)) -+#define BIT_GET_XTAL_SEL_TOK_2_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_TOK_2_0) & BIT_MASK_XTAL_SEL_TOK_2_0) -+#define BIT_SET_XTAL_SEL_TOK_2_0(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_TOK_2_0(x) | BIT_XTAL_SEL_TOK_2_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_EN_XTAL_DRV_AFE BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XQSEL_RF_AWAKE_V2 BIT(18) -+#define BIT_XQSEL_RF_INITIAL_V2 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_SHIFT_XTAL_DRV_RF2_V2 16 -+#define BIT_MASK_XTAL_DRV_RF2_V2 0x3 -+#define BIT_XTAL_DRV_RF2_V2(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF2_V2) << BIT_SHIFT_XTAL_DRV_RF2_V2) -+#define BITS_XTAL_DRV_RF2_V2 \ -+ (BIT_MASK_XTAL_DRV_RF2_V2 << BIT_SHIFT_XTAL_DRV_RF2_V2) -+#define BIT_CLEAR_XTAL_DRV_RF2_V2(x) ((x) & (~BITS_XTAL_DRV_RF2_V2)) -+#define BIT_GET_XTAL_DRV_RF2_V2(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF2_V2) & BIT_MASK_XTAL_DRV_RF2_V2) -+#define BIT_SET_XTAL_DRV_RF2_V2(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF2_V2(x) | BIT_XTAL_DRV_RF2_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XTAL_DELAY_USB_V1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_EN_XTAL_DRV_RF2 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XTAL_DELAY_DIGI_V1 BIT(15) -+#define BIT_XTAL_DELAY_AFE_V1 BIT(14) -+#define BIT_XTAL_DRV_RF_LATCH_V3 BIT(13) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_EN_XTAL_DRV_RF1 BIT(12) -+#define BIT_XTAL_DRV_RF_LATCH_V4 BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_SHIFT_XTAL_DRV_DIGI_1_0 11 -+#define BIT_MASK_XTAL_DRV_DIGI_1_0 0x3 -+#define BIT_XTAL_DRV_DIGI_1_0(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_DIGI_1_0) << BIT_SHIFT_XTAL_DRV_DIGI_1_0) -+#define BITS_XTAL_DRV_DIGI_1_0 \ -+ (BIT_MASK_XTAL_DRV_DIGI_1_0 << BIT_SHIFT_XTAL_DRV_DIGI_1_0) -+#define BIT_CLEAR_XTAL_DRV_DIGI_1_0(x) ((x) & (~BITS_XTAL_DRV_DIGI_1_0)) -+#define BIT_GET_XTAL_DRV_DIGI_1_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_DIGI_1_0) & BIT_MASK_XTAL_DRV_DIGI_1_0) -+#define BIT_SET_XTAL_DRV_DIGI_1_0(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_DIGI_1_0(x) | BIT_XTAL_DRV_DIGI_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XTAL_GM_SEP_V3 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XTAL_GATED_DIGIN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XQSEL_RF_AWAKE_V3 BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XTAL_GATED_DIGIP BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XQSEL_RF_INITIAL_V3 BIT(8) -+#define BIT_XQSEL_V2 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_SHIFT_XTAL_DRV_USB_1_0 7 -+#define BIT_MASK_XTAL_DRV_USB_1_0 0x3 -+#define BIT_XTAL_DRV_USB_1_0(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_USB_1_0) << BIT_SHIFT_XTAL_DRV_USB_1_0) -+#define BITS_XTAL_DRV_USB_1_0 \ -+ (BIT_MASK_XTAL_DRV_USB_1_0 << BIT_SHIFT_XTAL_DRV_USB_1_0) -+#define BIT_CLEAR_XTAL_DRV_USB_1_0(x) ((x) & (~BITS_XTAL_DRV_USB_1_0)) -+#define BIT_GET_XTAL_DRV_USB_1_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_USB_1_0) & BIT_MASK_XTAL_DRV_USB_1_0) -+#define BIT_SET_XTAL_DRV_USB_1_0(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_USB_1_0(x) | BIT_XTAL_DRV_USB_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_GATED_XTAL_OK0_V2 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XTAL_GATED_USBN BIT(6) -+#define BIT_XTAL_GATED_USBP BIT(5) -+ -+#define BIT_SHIFT_XTAL_DRV_AFE_1_0 3 -+#define BIT_MASK_XTAL_DRV_AFE_1_0 0x3 -+#define BIT_XTAL_DRV_AFE_1_0(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_AFE_1_0) << BIT_SHIFT_XTAL_DRV_AFE_1_0) -+#define BITS_XTAL_DRV_AFE_1_0 \ -+ (BIT_MASK_XTAL_DRV_AFE_1_0 << BIT_SHIFT_XTAL_DRV_AFE_1_0) -+#define BIT_CLEAR_XTAL_DRV_AFE_1_0(x) ((x) & (~BITS_XTAL_DRV_AFE_1_0)) -+#define BIT_GET_XTAL_DRV_AFE_1_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_AFE_1_0) & BIT_MASK_XTAL_DRV_AFE_1_0) -+#define BIT_SET_XTAL_DRV_AFE_1_0(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_AFE_1_0(x) | BIT_XTAL_DRV_AFE_1_0(v)) -+ -+#define BIT_XTAL_GATED_AFEN BIT(2) -+#define BIT_XTAL_GATED_AFEP BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_SHIFT_XTAL_SC_LPS_V2 0 -+#define BIT_MASK_XTAL_SC_LPS_V2 0x3f -+#define BIT_XTAL_SC_LPS_V2(x) \ -+ (((x) & BIT_MASK_XTAL_SC_LPS_V2) << BIT_SHIFT_XTAL_SC_LPS_V2) -+#define BITS_XTAL_SC_LPS_V2 \ -+ (BIT_MASK_XTAL_SC_LPS_V2 << BIT_SHIFT_XTAL_SC_LPS_V2) -+#define BIT_CLEAR_XTAL_SC_LPS_V2(x) ((x) & (~BITS_XTAL_SC_LPS_V2)) -+#define BIT_GET_XTAL_SC_LPS_V2(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_LPS_V2) & BIT_MASK_XTAL_SC_LPS_V2) -+#define BIT_SET_XTAL_SC_LPS_V2(x, v) \ -+ (BIT_CLEAR_XTAL_SC_LPS_V2(x) | BIT_XTAL_SC_LPS_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_1 (Offset 0x1044) */ -+ -+#define BIT_XTAL_DRV_RF1_1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_XTAL_AAC_CAP BIT(31) -+ -+#define BIT_SHIFT_XTAL_PDSW 29 -+#define BIT_MASK_XTAL_PDSW 0x3 -+#define BIT_XTAL_PDSW(x) (((x) & BIT_MASK_XTAL_PDSW) << BIT_SHIFT_XTAL_PDSW) -+#define BITS_XTAL_PDSW (BIT_MASK_XTAL_PDSW << BIT_SHIFT_XTAL_PDSW) -+#define BIT_CLEAR_XTAL_PDSW(x) ((x) & (~BITS_XTAL_PDSW)) -+#define BIT_GET_XTAL_PDSW(x) (((x) >> BIT_SHIFT_XTAL_PDSW) & BIT_MASK_XTAL_PDSW) -+#define BIT_SET_XTAL_PDSW(x, v) (BIT_CLEAR_XTAL_PDSW(x) | BIT_XTAL_PDSW(v)) -+ -+#define BIT_SHIFT_XTAL_LPS_BUF_VB 27 -+#define BIT_MASK_XTAL_LPS_BUF_VB 0x3 -+#define BIT_XTAL_LPS_BUF_VB(x) \ -+ (((x) & BIT_MASK_XTAL_LPS_BUF_VB) << BIT_SHIFT_XTAL_LPS_BUF_VB) -+#define BITS_XTAL_LPS_BUF_VB \ -+ (BIT_MASK_XTAL_LPS_BUF_VB << BIT_SHIFT_XTAL_LPS_BUF_VB) -+#define BIT_CLEAR_XTAL_LPS_BUF_VB(x) ((x) & (~BITS_XTAL_LPS_BUF_VB)) -+#define BIT_GET_XTAL_LPS_BUF_VB(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LPS_BUF_VB) & BIT_MASK_XTAL_LPS_BUF_VB) -+#define BIT_SET_XTAL_LPS_BUF_VB(x, v) \ -+ (BIT_CLEAR_XTAL_LPS_BUF_VB(x) | BIT_XTAL_LPS_BUF_VB(v)) -+ -+#define BIT_XTAL_PDCK_MANU BIT(26) -+#define BIT_XTAL_PDCK_OK_MANU BIT(25) -+ -+#define BIT_SHIFT_XTAL_VREF_SEL 20 -+#define BIT_MASK_XTAL_VREF_SEL 0x1f -+#define BIT_XTAL_VREF_SEL(x) \ -+ (((x) & BIT_MASK_XTAL_VREF_SEL) << BIT_SHIFT_XTAL_VREF_SEL) -+#define BITS_XTAL_VREF_SEL (BIT_MASK_XTAL_VREF_SEL << BIT_SHIFT_XTAL_VREF_SEL) -+#define BIT_CLEAR_XTAL_VREF_SEL(x) ((x) & (~BITS_XTAL_VREF_SEL)) -+#define BIT_GET_XTAL_VREF_SEL(x) \ -+ (((x) >> BIT_SHIFT_XTAL_VREF_SEL) & BIT_MASK_XTAL_VREF_SEL) -+#define BIT_SET_XTAL_VREF_SEL(x, v) \ -+ (BIT_CLEAR_XTAL_VREF_SEL(x) | BIT_XTAL_VREF_SEL(v)) -+ -+#define BIT_EN_XTAL_PDCK_VREF BIT(19) -+#define BIT_XTAL_SEL_PWR_V1 BIT(18) -+#define BIT_XTAL_LPS_DIVISOR BIT(17) -+#define BIT_XTAL_CKDIGI_SEL BIT(16) -+#define BIT_EN_XTAL_LPS_CLK BIT(15) -+#define BIT_EN_XTAL_SCHMITT BIT(14) -+#define BIT_XTAL_PK_SEL_OFFSET BIT(13) -+ -+#define BIT_SHIFT_XTAL_MANU_PK_SEL 11 -+#define BIT_MASK_XTAL_MANU_PK_SEL 0x3 -+#define BIT_XTAL_MANU_PK_SEL(x) \ -+ (((x) & BIT_MASK_XTAL_MANU_PK_SEL) << BIT_SHIFT_XTAL_MANU_PK_SEL) -+#define BITS_XTAL_MANU_PK_SEL \ -+ (BIT_MASK_XTAL_MANU_PK_SEL << BIT_SHIFT_XTAL_MANU_PK_SEL) -+#define BIT_CLEAR_XTAL_MANU_PK_SEL(x) ((x) & (~BITS_XTAL_MANU_PK_SEL)) -+#define BIT_GET_XTAL_MANU_PK_SEL(x) \ -+ (((x) >> BIT_SHIFT_XTAL_MANU_PK_SEL) & BIT_MASK_XTAL_MANU_PK_SEL) -+#define BIT_SET_XTAL_MANU_PK_SEL(x, v) \ -+ (BIT_CLEAR_XTAL_MANU_PK_SEL(x) | BIT_XTAL_MANU_PK_SEL(v)) -+ -+#define BIT_XTAL_AACK_PK_MANU BIT(10) -+#define BIT_EN_XTAL_AAC_PKDET_V1 BIT(9) -+#define BIT_EN_XTAL_AAC_GM_V1 BIT(8) -+#define BIT_XTAL_LDO_OPVB_SEL BIT(7) -+ -+#define BIT_SHIFT_XTAL_DUMMY_V1 7 -+#define BIT_MASK_XTAL_DUMMY_V1 0x3f -+#define BIT_XTAL_DUMMY_V1(x) \ -+ (((x) & BIT_MASK_XTAL_DUMMY_V1) << BIT_SHIFT_XTAL_DUMMY_V1) -+#define BITS_XTAL_DUMMY_V1 (BIT_MASK_XTAL_DUMMY_V1 << BIT_SHIFT_XTAL_DUMMY_V1) -+#define BIT_CLEAR_XTAL_DUMMY_V1(x) ((x) & (~BITS_XTAL_DUMMY_V1)) -+#define BIT_GET_XTAL_DUMMY_V1(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DUMMY_V1) & BIT_MASK_XTAL_DUMMY_V1) -+#define BIT_SET_XTAL_DUMMY_V1(x, v) \ -+ (BIT_CLEAR_XTAL_DUMMY_V1(x) | BIT_XTAL_DUMMY_V1(v)) -+ -+#define BIT_XTAL_LDO_NC BIT(6) -+#define BIT_XTAL_EN_LNBUF BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_XTAL_DRV_RF2_LATCH BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_XTAL__AAC_TIE_MID BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_SHIFT_XTAL_DRV_RF2_1_0 4 -+#define BIT_MASK_XTAL_DRV_RF2_1_0 0x3 -+#define BIT_XTAL_DRV_RF2_1_0(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF2_1_0) << BIT_SHIFT_XTAL_DRV_RF2_1_0) -+#define BITS_XTAL_DRV_RF2_1_0 \ -+ (BIT_MASK_XTAL_DRV_RF2_1_0 << BIT_SHIFT_XTAL_DRV_RF2_1_0) -+#define BIT_CLEAR_XTAL_DRV_RF2_1_0(x) ((x) & (~BITS_XTAL_DRV_RF2_1_0)) -+#define BIT_GET_XTAL_DRV_RF2_1_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF2_1_0) & BIT_MASK_XTAL_DRV_RF2_1_0) -+#define BIT_SET_XTAL_DRV_RF2_1_0(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF2_1_0(x) | BIT_XTAL_DRV_RF2_1_0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_SHIFT_XTAL_LDO_VREF_V2 3 -+#define BIT_MASK_XTAL_LDO_VREF_V2 0x7 -+#define BIT_XTAL_LDO_VREF_V2(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_VREF_V2) << BIT_SHIFT_XTAL_LDO_VREF_V2) -+#define BITS_XTAL_LDO_VREF_V2 \ -+ (BIT_MASK_XTAL_LDO_VREF_V2 << BIT_SHIFT_XTAL_LDO_VREF_V2) -+#define BIT_CLEAR_XTAL_LDO_VREF_V2(x) ((x) & (~BITS_XTAL_LDO_VREF_V2)) -+#define BIT_GET_XTAL_LDO_VREF_V2(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_VREF_V2) & BIT_MASK_XTAL_LDO_VREF_V2) -+#define BIT_SET_XTAL_LDO_VREF_V2(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_VREF_V2(x) | BIT_XTAL_LDO_VREF_V2(v)) -+ -+#define BIT_SHIFT_XTAL_AAC_OPCUR 3 -+#define BIT_MASK_XTAL_AAC_OPCUR 0x3 -+#define BIT_XTAL_AAC_OPCUR(x) \ -+ (((x) & BIT_MASK_XTAL_AAC_OPCUR) << BIT_SHIFT_XTAL_AAC_OPCUR) -+#define BITS_XTAL_AAC_OPCUR \ -+ (BIT_MASK_XTAL_AAC_OPCUR << BIT_SHIFT_XTAL_AAC_OPCUR) -+#define BIT_CLEAR_XTAL_AAC_OPCUR(x) ((x) & (~BITS_XTAL_AAC_OPCUR)) -+#define BIT_GET_XTAL_AAC_OPCUR(x) \ -+ (((x) >> BIT_SHIFT_XTAL_AAC_OPCUR) & BIT_MASK_XTAL_AAC_OPCUR) -+#define BIT_SET_XTAL_AAC_OPCUR(x, v) \ -+ (BIT_CLEAR_XTAL_AAC_OPCUR(x) | BIT_XTAL_AAC_OPCUR(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_XTAL_GATED_RF2N BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_XTAL_LPMODE_V1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_XTAL_GATED_RF2P BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_SHIFT_XTAL_AAC_IOFFSET 1 -+#define BIT_MASK_XTAL_AAC_IOFFSET 0x3 -+#define BIT_XTAL_AAC_IOFFSET(x) \ -+ (((x) & BIT_MASK_XTAL_AAC_IOFFSET) << BIT_SHIFT_XTAL_AAC_IOFFSET) -+#define BITS_XTAL_AAC_IOFFSET \ -+ (BIT_MASK_XTAL_AAC_IOFFSET << BIT_SHIFT_XTAL_AAC_IOFFSET) -+#define BIT_CLEAR_XTAL_AAC_IOFFSET(x) ((x) & (~BITS_XTAL_AAC_IOFFSET)) -+#define BIT_GET_XTAL_AAC_IOFFSET(x) \ -+ (((x) >> BIT_SHIFT_XTAL_AAC_IOFFSET) & BIT_MASK_XTAL_AAC_IOFFSET) -+#define BIT_SET_XTAL_AAC_IOFFSET(x, v) \ -+ (BIT_CLEAR_XTAL_AAC_IOFFSET(x) | BIT_XTAL_AAC_IOFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_XTAL_LDO_DI BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_SHIFT_XTAL_SEL_TOK_V3 0 -+#define BIT_MASK_XTAL_SEL_TOK_V3 0x3 -+#define BIT_XTAL_SEL_TOK_V3(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_TOK_V3) << BIT_SHIFT_XTAL_SEL_TOK_V3) -+#define BITS_XTAL_SEL_TOK_V3 \ -+ (BIT_MASK_XTAL_SEL_TOK_V3 << BIT_SHIFT_XTAL_SEL_TOK_V3) -+#define BIT_CLEAR_XTAL_SEL_TOK_V3(x) ((x) & (~BITS_XTAL_SEL_TOK_V3)) -+#define BIT_GET_XTAL_SEL_TOK_V3(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_TOK_V3) & BIT_MASK_XTAL_SEL_TOK_V3) -+#define BIT_SET_XTAL_SEL_TOK_V3(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_TOK_V3(x) | BIT_XTAL_SEL_TOK_V3(v)) -+ -+#define BIT_XTAL_AAC_CAP_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_2 (Offset 0x1048) */ -+ -+#define BIT_XTAL_SEL_PWR BIT(0) -+ -+/* 2 REG_ANAPAR_XTAL_AAC (Offset 0x104C) */ -+ -+#define BIT_SHIFT_GM_MANUAL_4_0 21 -+#define BIT_MASK_GM_MANUAL_4_0 0x1f -+#define BIT_GM_MANUAL_4_0(x) \ -+ (((x) & BIT_MASK_GM_MANUAL_4_0) << BIT_SHIFT_GM_MANUAL_4_0) -+#define BITS_GM_MANUAL_4_0 (BIT_MASK_GM_MANUAL_4_0 << BIT_SHIFT_GM_MANUAL_4_0) -+#define BIT_CLEAR_GM_MANUAL_4_0(x) ((x) & (~BITS_GM_MANUAL_4_0)) -+#define BIT_GET_GM_MANUAL_4_0(x) \ -+ (((x) >> BIT_SHIFT_GM_MANUAL_4_0) & BIT_MASK_GM_MANUAL_4_0) -+#define BIT_SET_GM_MANUAL_4_0(x, v) \ -+ (BIT_CLEAR_GM_MANUAL_4_0(x) | BIT_GM_MANUAL_4_0(v)) -+ -+#define BIT_SHIFT_GM_STUP_4_0 16 -+#define BIT_MASK_GM_STUP_4_0 0x1f -+#define BIT_GM_STUP_4_0(x) \ -+ (((x) & BIT_MASK_GM_STUP_4_0) << BIT_SHIFT_GM_STUP_4_0) -+#define BITS_GM_STUP_4_0 (BIT_MASK_GM_STUP_4_0 << BIT_SHIFT_GM_STUP_4_0) -+#define BIT_CLEAR_GM_STUP_4_0(x) ((x) & (~BITS_GM_STUP_4_0)) -+#define BIT_GET_GM_STUP_4_0(x) \ -+ (((x) >> BIT_SHIFT_GM_STUP_4_0) & BIT_MASK_GM_STUP_4_0) -+#define BIT_SET_GM_STUP_4_0(x, v) \ -+ (BIT_CLEAR_GM_STUP_4_0(x) | BIT_GM_STUP_4_0(v)) -+ -+#define BIT_SHIFT_XTAL_CK_SET_2_0 13 -+#define BIT_MASK_XTAL_CK_SET_2_0 0x7 -+#define BIT_XTAL_CK_SET_2_0(x) \ -+ (((x) & BIT_MASK_XTAL_CK_SET_2_0) << BIT_SHIFT_XTAL_CK_SET_2_0) -+#define BITS_XTAL_CK_SET_2_0 \ -+ (BIT_MASK_XTAL_CK_SET_2_0 << BIT_SHIFT_XTAL_CK_SET_2_0) -+#define BIT_CLEAR_XTAL_CK_SET_2_0(x) ((x) & (~BITS_XTAL_CK_SET_2_0)) -+#define BIT_GET_XTAL_CK_SET_2_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CK_SET_2_0) & BIT_MASK_XTAL_CK_SET_2_0) -+#define BIT_SET_XTAL_CK_SET_2_0(x, v) \ -+ (BIT_CLEAR_XTAL_CK_SET_2_0(x) | BIT_XTAL_CK_SET_2_0(v)) -+ -+#define BIT_SHIFT_GM_INIT_4_0 8 -+#define BIT_MASK_GM_INIT_4_0 0x1f -+#define BIT_GM_INIT_4_0(x) \ -+ (((x) & BIT_MASK_GM_INIT_4_0) << BIT_SHIFT_GM_INIT_4_0) -+#define BITS_GM_INIT_4_0 (BIT_MASK_GM_INIT_4_0 << BIT_SHIFT_GM_INIT_4_0) -+#define BIT_CLEAR_GM_INIT_4_0(x) ((x) & (~BITS_GM_INIT_4_0)) -+#define BIT_GET_GM_INIT_4_0(x) \ -+ (((x) >> BIT_SHIFT_GM_INIT_4_0) & BIT_MASK_GM_INIT_4_0) -+#define BIT_SET_GM_INIT_4_0(x, v) \ -+ (BIT_CLEAR_GM_INIT_4_0(x) | BIT_GM_INIT_4_0(v)) -+ -+#define BIT_SHIFT_XAAC_GM_OFFSET_4_0 2 -+#define BIT_MASK_XAAC_GM_OFFSET_4_0 0x1f -+#define BIT_XAAC_GM_OFFSET_4_0(x) \ -+ (((x) & BIT_MASK_XAAC_GM_OFFSET_4_0) << BIT_SHIFT_XAAC_GM_OFFSET_4_0) -+#define BITS_XAAC_GM_OFFSET_4_0 \ -+ (BIT_MASK_XAAC_GM_OFFSET_4_0 << BIT_SHIFT_XAAC_GM_OFFSET_4_0) -+#define BIT_CLEAR_XAAC_GM_OFFSET_4_0(x) ((x) & (~BITS_XAAC_GM_OFFSET_4_0)) -+#define BIT_GET_XAAC_GM_OFFSET_4_0(x) \ -+ (((x) >> BIT_SHIFT_XAAC_GM_OFFSET_4_0) & BIT_MASK_XAAC_GM_OFFSET_4_0) -+#define BIT_SET_XAAC_GM_OFFSET_4_0(x, v) \ -+ (BIT_CLEAR_XAAC_GM_OFFSET_4_0(x) | BIT_XAAC_GM_OFFSET_4_0(v)) -+ -+/* 2 REG_ANAPAR_XTAL_R_ONLY (Offset 0x1050) */ -+ -+#define BIT_XTAL_PKDET_OUT BIT(6) -+ -+#define BIT_SHIFT_XTAL_GM_AAC_4_0 1 -+#define BIT_MASK_XTAL_GM_AAC_4_0 0x1f -+#define BIT_XTAL_GM_AAC_4_0(x) \ -+ (((x) & BIT_MASK_XTAL_GM_AAC_4_0) << BIT_SHIFT_XTAL_GM_AAC_4_0) -+#define BITS_XTAL_GM_AAC_4_0 \ -+ (BIT_MASK_XTAL_GM_AAC_4_0 << BIT_SHIFT_XTAL_GM_AAC_4_0) -+#define BIT_CLEAR_XTAL_GM_AAC_4_0(x) ((x) & (~BITS_XTAL_GM_AAC_4_0)) -+#define BIT_GET_XTAL_GM_AAC_4_0(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GM_AAC_4_0) & BIT_MASK_XTAL_GM_AAC_4_0) -+#define BIT_SET_XTAL_GM_AAC_4_0(x, v) \ -+ (BIT_CLEAR_XTAL_GM_AAC_4_0(x) | BIT_XTAL_GM_AAC_4_0(v)) -+ -+#define BIT_XAAC_READY BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_AACK_0 (Offset 0x1054) */ -+ -+#define BIT_XAAC_LPOW BIT(31) -+ -+#define BIT_SHIFT_AAC_MODE 29 -+#define BIT_MASK_AAC_MODE 0x3 -+#define BIT_AAC_MODE(x) (((x) & BIT_MASK_AAC_MODE) << BIT_SHIFT_AAC_MODE) -+#define BITS_AAC_MODE (BIT_MASK_AAC_MODE << BIT_SHIFT_AAC_MODE) -+#define BIT_CLEAR_AAC_MODE(x) ((x) & (~BITS_AAC_MODE)) -+#define BIT_GET_AAC_MODE(x) (((x) >> BIT_SHIFT_AAC_MODE) & BIT_MASK_AAC_MODE) -+#define BIT_SET_AAC_MODE(x, v) (BIT_CLEAR_AAC_MODE(x) | BIT_AAC_MODE(v)) -+ -+#define BIT_SHIFT_GM_MANUAL 21 -+#define BIT_MASK_GM_MANUAL 0x1f -+#define BIT_GM_MANUAL(x) (((x) & BIT_MASK_GM_MANUAL) << BIT_SHIFT_GM_MANUAL) -+#define BITS_GM_MANUAL (BIT_MASK_GM_MANUAL << BIT_SHIFT_GM_MANUAL) -+#define BIT_CLEAR_GM_MANUAL(x) ((x) & (~BITS_GM_MANUAL)) -+#define BIT_GET_GM_MANUAL(x) (((x) >> BIT_SHIFT_GM_MANUAL) & BIT_MASK_GM_MANUAL) -+#define BIT_SET_GM_MANUAL(x, v) (BIT_CLEAR_GM_MANUAL(x) | BIT_GM_MANUAL(v)) -+ -+#define BIT_SHIFT_XTAL_LDO_LPS 21 -+#define BIT_MASK_XTAL_LDO_LPS 0x7 -+#define BIT_XTAL_LDO_LPS(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_LPS) << BIT_SHIFT_XTAL_LDO_LPS) -+#define BITS_XTAL_LDO_LPS (BIT_MASK_XTAL_LDO_LPS << BIT_SHIFT_XTAL_LDO_LPS) -+#define BIT_CLEAR_XTAL_LDO_LPS(x) ((x) & (~BITS_XTAL_LDO_LPS)) -+#define BIT_GET_XTAL_LDO_LPS(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_LPS) & BIT_MASK_XTAL_LDO_LPS) -+#define BIT_SET_XTAL_LDO_LPS(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_LPS(x) | BIT_XTAL_LDO_LPS(v)) -+ -+#define BIT_SHIFT_GM_STUP 16 -+#define BIT_MASK_GM_STUP 0x1f -+#define BIT_GM_STUP(x) (((x) & BIT_MASK_GM_STUP) << BIT_SHIFT_GM_STUP) -+#define BITS_GM_STUP (BIT_MASK_GM_STUP << BIT_SHIFT_GM_STUP) -+#define BIT_CLEAR_GM_STUP(x) ((x) & (~BITS_GM_STUP)) -+#define BIT_GET_GM_STUP(x) (((x) >> BIT_SHIFT_GM_STUP) & BIT_MASK_GM_STUP) -+#define BIT_SET_GM_STUP(x, v) (BIT_CLEAR_GM_STUP(x) | BIT_GM_STUP(v)) -+ -+#define BIT_SHIFT_XTAL_WAIT_CYC 15 -+#define BIT_MASK_XTAL_WAIT_CYC 0x3f -+#define BIT_XTAL_WAIT_CYC(x) \ -+ (((x) & BIT_MASK_XTAL_WAIT_CYC) << BIT_SHIFT_XTAL_WAIT_CYC) -+#define BITS_XTAL_WAIT_CYC (BIT_MASK_XTAL_WAIT_CYC << BIT_SHIFT_XTAL_WAIT_CYC) -+#define BIT_CLEAR_XTAL_WAIT_CYC(x) ((x) & (~BITS_XTAL_WAIT_CYC)) -+#define BIT_GET_XTAL_WAIT_CYC(x) \ -+ (((x) >> BIT_SHIFT_XTAL_WAIT_CYC) & BIT_MASK_XTAL_WAIT_CYC) -+#define BIT_SET_XTAL_WAIT_CYC(x, v) \ -+ (BIT_CLEAR_XTAL_WAIT_CYC(x) | BIT_XTAL_WAIT_CYC(v)) -+ -+#define BIT_SHIFT_XTAL_CK_SET 13 -+#define BIT_MASK_XTAL_CK_SET 0x7 -+#define BIT_XTAL_CK_SET(x) \ -+ (((x) & BIT_MASK_XTAL_CK_SET) << BIT_SHIFT_XTAL_CK_SET) -+#define BITS_XTAL_CK_SET (BIT_MASK_XTAL_CK_SET << BIT_SHIFT_XTAL_CK_SET) -+#define BIT_CLEAR_XTAL_CK_SET(x) ((x) & (~BITS_XTAL_CK_SET)) -+#define BIT_GET_XTAL_CK_SET(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CK_SET) & BIT_MASK_XTAL_CK_SET) -+#define BIT_SET_XTAL_CK_SET(x, v) \ -+ (BIT_CLEAR_XTAL_CK_SET(x) | BIT_XTAL_CK_SET(v)) -+ -+#define BIT_SHIFT_XTAL_LDO_OK 12 -+#define BIT_MASK_XTAL_LDO_OK 0x7 -+#define BIT_XTAL_LDO_OK(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_OK) << BIT_SHIFT_XTAL_LDO_OK) -+#define BITS_XTAL_LDO_OK (BIT_MASK_XTAL_LDO_OK << BIT_SHIFT_XTAL_LDO_OK) -+#define BIT_CLEAR_XTAL_LDO_OK(x) ((x) & (~BITS_XTAL_LDO_OK)) -+#define BIT_GET_XTAL_LDO_OK(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_OK) & BIT_MASK_XTAL_LDO_OK) -+#define BIT_SET_XTAL_LDO_OK(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_OK(x) | BIT_XTAL_LDO_OK(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPHY_LDO (Offset 0x1054) */ -+ -+#define BIT_SHIFT_CPHY_LDO_PD 12 -+#define BIT_MASK_CPHY_LDO_PD 0x3 -+#define BIT_CPHY_LDO_PD(x) \ -+ (((x) & BIT_MASK_CPHY_LDO_PD) << BIT_SHIFT_CPHY_LDO_PD) -+#define BITS_CPHY_LDO_PD (BIT_MASK_CPHY_LDO_PD << BIT_SHIFT_CPHY_LDO_PD) -+#define BIT_CLEAR_CPHY_LDO_PD(x) ((x) & (~BITS_CPHY_LDO_PD)) -+#define BIT_GET_CPHY_LDO_PD(x) \ -+ (((x) >> BIT_SHIFT_CPHY_LDO_PD) & BIT_MASK_CPHY_LDO_PD) -+#define BIT_SET_CPHY_LDO_PD(x, v) \ -+ (BIT_CLEAR_CPHY_LDO_PD(x) | BIT_CPHY_LDO_PD(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_AACK_0 (Offset 0x1054) */ -+ -+#define BIT_XTAL_MD_LPOW BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPHY_LDO (Offset 0x1054) */ -+ -+#define BIT_SHIFT_CPHY_LDO_SR 10 -+#define BIT_MASK_CPHY_LDO_SR 0x3 -+#define BIT_CPHY_LDO_SR(x) \ -+ (((x) & BIT_MASK_CPHY_LDO_SR) << BIT_SHIFT_CPHY_LDO_SR) -+#define BITS_CPHY_LDO_SR (BIT_MASK_CPHY_LDO_SR << BIT_SHIFT_CPHY_LDO_SR) -+#define BIT_CLEAR_CPHY_LDO_SR(x) ((x) & (~BITS_CPHY_LDO_SR)) -+#define BIT_GET_CPHY_LDO_SR(x) \ -+ (((x) >> BIT_SHIFT_CPHY_LDO_SR) & BIT_MASK_CPHY_LDO_SR) -+#define BIT_SET_CPHY_LDO_SR(x, v) \ -+ (BIT_CLEAR_CPHY_LDO_SR(x) | BIT_CPHY_LDO_SR(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_AACK_0 (Offset 0x1054) */ -+ -+#define BIT_SHIFT_XTAL_OV_RATIO 9 -+#define BIT_MASK_XTAL_OV_RATIO 0x3 -+#define BIT_XTAL_OV_RATIO(x) \ -+ (((x) & BIT_MASK_XTAL_OV_RATIO) << BIT_SHIFT_XTAL_OV_RATIO) -+#define BITS_XTAL_OV_RATIO (BIT_MASK_XTAL_OV_RATIO << BIT_SHIFT_XTAL_OV_RATIO) -+#define BIT_CLEAR_XTAL_OV_RATIO(x) ((x) & (~BITS_XTAL_OV_RATIO)) -+#define BIT_GET_XTAL_OV_RATIO(x) \ -+ (((x) >> BIT_SHIFT_XTAL_OV_RATIO) & BIT_MASK_XTAL_OV_RATIO) -+#define BIT_SET_XTAL_OV_RATIO(x, v) \ -+ (BIT_CLEAR_XTAL_OV_RATIO(x) | BIT_XTAL_OV_RATIO(v)) -+ -+#define BIT_SHIFT_GM_INIT 8 -+#define BIT_MASK_GM_INIT 0x1f -+#define BIT_GM_INIT(x) (((x) & BIT_MASK_GM_INIT) << BIT_SHIFT_GM_INIT) -+#define BITS_GM_INIT (BIT_MASK_GM_INIT << BIT_SHIFT_GM_INIT) -+#define BIT_CLEAR_GM_INIT(x) ((x) & (~BITS_GM_INIT)) -+#define BIT_GET_GM_INIT(x) (((x) >> BIT_SHIFT_GM_INIT) & BIT_MASK_GM_INIT) -+#define BIT_SET_GM_INIT(x, v) (BIT_CLEAR_GM_INIT(x) | BIT_GM_INIT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPHY_LDO (Offset 0x1054) */ -+ -+#define BIT_SHIFT_CPHY_LDO_TUNEREF 8 -+#define BIT_MASK_CPHY_LDO_TUNEREF 0x3 -+#define BIT_CPHY_LDO_TUNEREF(x) \ -+ (((x) & BIT_MASK_CPHY_LDO_TUNEREF) << BIT_SHIFT_CPHY_LDO_TUNEREF) -+#define BITS_CPHY_LDO_TUNEREF \ -+ (BIT_MASK_CPHY_LDO_TUNEREF << BIT_SHIFT_CPHY_LDO_TUNEREF) -+#define BIT_CLEAR_CPHY_LDO_TUNEREF(x) ((x) & (~BITS_CPHY_LDO_TUNEREF)) -+#define BIT_GET_CPHY_LDO_TUNEREF(x) \ -+ (((x) >> BIT_SHIFT_CPHY_LDO_TUNEREF) & BIT_MASK_CPHY_LDO_TUNEREF) -+#define BIT_SET_CPHY_LDO_TUNEREF(x, v) \ -+ (BIT_CLEAR_CPHY_LDO_TUNEREF(x) | BIT_CPHY_LDO_TUNEREF(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_AACK_0 (Offset 0x1054) */ -+ -+#define BIT_SHIFT_XTAL_OV_UNIT 6 -+#define BIT_MASK_XTAL_OV_UNIT 0x7 -+#define BIT_XTAL_OV_UNIT(x) \ -+ (((x) & BIT_MASK_XTAL_OV_UNIT) << BIT_SHIFT_XTAL_OV_UNIT) -+#define BITS_XTAL_OV_UNIT (BIT_MASK_XTAL_OV_UNIT << BIT_SHIFT_XTAL_OV_UNIT) -+#define BIT_CLEAR_XTAL_OV_UNIT(x) ((x) & (~BITS_XTAL_OV_UNIT)) -+#define BIT_GET_XTAL_OV_UNIT(x) \ -+ (((x) >> BIT_SHIFT_XTAL_OV_UNIT) & BIT_MASK_XTAL_OV_UNIT) -+#define BIT_SET_XTAL_OV_UNIT(x, v) \ -+ (BIT_CLEAR_XTAL_OV_UNIT(x) | BIT_XTAL_OV_UNIT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPHY_LDO (Offset 0x1054) */ -+ -+#define BIT_SHIFT_CPHY_LDO_TUNE_VO 5 -+#define BIT_MASK_CPHY_LDO_TUNE_VO 0x7 -+#define BIT_CPHY_LDO_TUNE_VO(x) \ -+ (((x) & BIT_MASK_CPHY_LDO_TUNE_VO) << BIT_SHIFT_CPHY_LDO_TUNE_VO) -+#define BITS_CPHY_LDO_TUNE_VO \ -+ (BIT_MASK_CPHY_LDO_TUNE_VO << BIT_SHIFT_CPHY_LDO_TUNE_VO) -+#define BIT_CLEAR_CPHY_LDO_TUNE_VO(x) ((x) & (~BITS_CPHY_LDO_TUNE_VO)) -+#define BIT_GET_CPHY_LDO_TUNE_VO(x) \ -+ (((x) >> BIT_SHIFT_CPHY_LDO_TUNE_VO) & BIT_MASK_CPHY_LDO_TUNE_VO) -+#define BIT_SET_CPHY_LDO_TUNE_VO(x, v) \ -+ (BIT_CLEAR_CPHY_LDO_TUNE_VO(x) | BIT_CPHY_LDO_TUNE_VO(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_AACK_0 (Offset 0x1054) */ -+ -+#define BIT_SHIFT_XTAL_MODE_MANUAL 4 -+#define BIT_MASK_XTAL_MODE_MANUAL 0x3 -+#define BIT_XTAL_MODE_MANUAL(x) \ -+ (((x) & BIT_MASK_XTAL_MODE_MANUAL) << BIT_SHIFT_XTAL_MODE_MANUAL) -+#define BITS_XTAL_MODE_MANUAL \ -+ (BIT_MASK_XTAL_MODE_MANUAL << BIT_SHIFT_XTAL_MODE_MANUAL) -+#define BIT_CLEAR_XTAL_MODE_MANUAL(x) ((x) & (~BITS_XTAL_MODE_MANUAL)) -+#define BIT_GET_XTAL_MODE_MANUAL(x) \ -+ (((x) >> BIT_SHIFT_XTAL_MODE_MANUAL) & BIT_MASK_XTAL_MODE_MANUAL) -+#define BIT_SET_XTAL_MODE_MANUAL(x, v) \ -+ (BIT_CLEAR_XTAL_MODE_MANUAL(x) | BIT_XTAL_MODE_MANUAL(v)) -+ -+#define BIT_SHIFT_PK_END_AR 3 -+#define BIT_MASK_PK_END_AR 0x3 -+#define BIT_PK_END_AR(x) (((x) & BIT_MASK_PK_END_AR) << BIT_SHIFT_PK_END_AR) -+#define BITS_PK_END_AR (BIT_MASK_PK_END_AR << BIT_SHIFT_PK_END_AR) -+#define BIT_CLEAR_PK_END_AR(x) ((x) & (~BITS_PK_END_AR)) -+#define BIT_GET_PK_END_AR(x) (((x) >> BIT_SHIFT_PK_END_AR) & BIT_MASK_PK_END_AR) -+#define BIT_SET_PK_END_AR(x, v) (BIT_CLEAR_PK_END_AR(x) | BIT_PK_END_AR(v)) -+ -+#define BIT_XTAL_MANU_SEL BIT(3) -+ -+#define BIT_SHIFT_XAAC_GM_OFFSET 2 -+#define BIT_MASK_XAAC_GM_OFFSET 0x1f -+#define BIT_XAAC_GM_OFFSET(x) \ -+ (((x) & BIT_MASK_XAAC_GM_OFFSET) << BIT_SHIFT_XAAC_GM_OFFSET) -+#define BITS_XAAC_GM_OFFSET \ -+ (BIT_MASK_XAAC_GM_OFFSET << BIT_SHIFT_XAAC_GM_OFFSET) -+#define BIT_CLEAR_XAAC_GM_OFFSET(x) ((x) & (~BITS_XAAC_GM_OFFSET)) -+#define BIT_GET_XAAC_GM_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_XAAC_GM_OFFSET) & BIT_MASK_XAAC_GM_OFFSET) -+#define BIT_SET_XAAC_GM_OFFSET(x, v) \ -+ (BIT_CLEAR_XAAC_GM_OFFSET(x) | BIT_XAAC_GM_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPHY_LDO (Offset 0x1054) */ -+ -+#define BIT_SHIFT_CPHY_LDO_OCP_VTH 2 -+#define BIT_MASK_CPHY_LDO_OCP_VTH 0x7 -+#define BIT_CPHY_LDO_OCP_VTH(x) \ -+ (((x) & BIT_MASK_CPHY_LDO_OCP_VTH) << BIT_SHIFT_CPHY_LDO_OCP_VTH) -+#define BITS_CPHY_LDO_OCP_VTH \ -+ (BIT_MASK_CPHY_LDO_OCP_VTH << BIT_SHIFT_CPHY_LDO_OCP_VTH) -+#define BIT_CLEAR_CPHY_LDO_OCP_VTH(x) ((x) & (~BITS_CPHY_LDO_OCP_VTH)) -+#define BIT_GET_CPHY_LDO_OCP_VTH(x) \ -+ (((x) >> BIT_SHIFT_CPHY_LDO_OCP_VTH) & BIT_MASK_CPHY_LDO_OCP_VTH) -+#define BIT_SET_CPHY_LDO_OCP_VTH(x, v) \ -+ (BIT_CLEAR_CPHY_LDO_OCP_VTH(x) | BIT_CPHY_LDO_OCP_VTH(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_ANAPAR_XTAL_AACK_0 (Offset 0x1054) */ -+ -+#define BIT_SHIFT_PK_START_AR 1 -+#define BIT_MASK_PK_START_AR 0x3 -+#define BIT_PK_START_AR(x) \ -+ (((x) & BIT_MASK_PK_START_AR) << BIT_SHIFT_PK_START_AR) -+#define BITS_PK_START_AR (BIT_MASK_PK_START_AR << BIT_SHIFT_PK_START_AR) -+#define BIT_CLEAR_PK_START_AR(x) ((x) & (~BITS_PK_START_AR)) -+#define BIT_GET_PK_START_AR(x) \ -+ (((x) >> BIT_SHIFT_PK_START_AR) & BIT_MASK_PK_START_AR) -+#define BIT_SET_PK_START_AR(x, v) \ -+ (BIT_CLEAR_PK_START_AR(x) | BIT_PK_START_AR(v)) -+ -+#define BIT_XTAL_MODE BIT(1) -+#define BIT_XAAC_LUT_MANUAL_EN BIT(0) -+#define BIT_RESET_N_DECODER BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CPHY_LDO (Offset 0x1054) */ -+ -+#define BIT_SHIFT_VREF_LDO_OK 0 -+#define BIT_MASK_VREF_LDO_OK 0x3 -+#define BIT_VREF_LDO_OK(x) \ -+ (((x) & BIT_MASK_VREF_LDO_OK) << BIT_SHIFT_VREF_LDO_OK) -+#define BITS_VREF_LDO_OK (BIT_MASK_VREF_LDO_OK << BIT_SHIFT_VREF_LDO_OK) -+#define BIT_CLEAR_VREF_LDO_OK(x) ((x) & (~BITS_VREF_LDO_OK)) -+#define BIT_GET_VREF_LDO_OK(x) \ -+ (((x) >> BIT_SHIFT_VREF_LDO_OK) & BIT_MASK_VREF_LDO_OK) -+#define BIT_SET_VREF_LDO_OK(x, v) \ -+ (BIT_CLEAR_VREF_LDO_OK(x) | BIT_VREF_LDO_OK(v)) -+ -+/* 2 REG_CPHY_BG (Offset 0x1058) */ -+ -+#define BIT_TXBCN_OK_PORT4 BIT(31) -+#define BIT_ATIMEND_PORT4 BIT(31) -+#define BIT_TXBCN_OK_PORT3 BIT(30) -+#define BIT_ATIMEND_PORT3 BIT(30) -+#define BIT_TXBCN_OK_PORT2 BIT(29) -+#define BIT_ATIMEND_PORT2 BIT(29) -+#define BIT_TXBCN_OK_PORT1 BIT(28) -+#define BIT_ATIMEND_PORT1 BIT(28) -+#define BIT_TXBCN15OK BIT(23) -+#define BIT_BCNDMAINT15 BIT(23) -+#define BIT_ATIMEND15 BIT(23) -+#define BIT_TXBCN14OK BIT(22) -+#define BIT_BCNDMAINT14 BIT(22) -+#define BIT_ATIMEND14 BIT(22) -+#define BIT_TXBCN13OK BIT(21) -+#define BIT_BCNDMAINT13 BIT(21) -+#define BIT_ATIMEND13 BIT(21) -+#define BIT_TXBCN12OK BIT(20) -+#define BIT_BCNDMAINT12 BIT(20) -+#define BIT_ATIMEND12 BIT(20) -+#define BIT_TXBCN11OK BIT(19) -+#define BIT_BCNDMAINT11 BIT(19) -+#define BIT_ATIMEND11 BIT(19) -+#define BIT_TXBCN10OK BIT(18) -+#define BIT_BCNDMAINT10 BIT(18) -+#define BIT_ATIMEND10 BIT(18) -+#define BIT_TXBCN9OK BIT(17) -+#define BIT_BCNDMAINT9 BIT(17) -+#define BIT_ATIMEND9 BIT(17) -+#define BIT_TXBCN8OK BIT(16) -+#define BIT_BCNDMAINT8 BIT(16) -+#define BIT_ATIMEND8 BIT(16) -+#define BIT_BCNDERR_PORT4 BIT(15) -+#define BIT_BCNDERR_PORT3 BIT(14) -+#define BIT_BCNDERR_PORT2 BIT(13) -+#define BIT_BCNDERR_PORT1 BIT(12) -+#define BIT_TXBCN15ERR BIT(7) -+#define BIT_BCNDERR15 BIT(7) -+#define BIT_TXBCN14ERR BIT(6) -+#define BIT_BCNDERR14 BIT(6) -+#define BIT_TXBCN13ERR BIT(5) -+#define BIT_BCNDERR13 BIT(5) -+#define BIT_PS_TIMER_EARLY_INT_5 BIT(5) -+#define BIT_TXBCN12ERR BIT(4) -+#define BIT_BCNDERR12 BIT(4) -+#define BIT_PS_TIMER_EARLY_INT_4 BIT(4) -+#define BIT_TXBCN11ERR BIT(3) -+#define BIT_BCNDERR11 BIT(3) -+#define BIT_PS_TIMER_EARLY_INT_3 BIT(3) -+#define BIT_TXBCN10ERR BIT(2) -+#define BIT_BCNDERR10 BIT(2) -+#define BIT_PS_TIMER_EARLY_INT_2 BIT(2) -+#define BIT_TXBCN9ERR BIT(1) -+#define BIT_BCNDERR9 BIT(1) -+#define BIT_PS_TIMER_EARLY_INT_1 BIT(1) -+ -+#define BIT_SHIFT_BG 0 -+#define BIT_MASK_BG 0x7 -+#define BIT_BG(x) (((x) & BIT_MASK_BG) << BIT_SHIFT_BG) -+#define BITS_BG (BIT_MASK_BG << BIT_SHIFT_BG) -+#define BIT_CLEAR_BG(x) ((x) & (~BITS_BG)) -+#define BIT_GET_BG(x) (((x) >> BIT_SHIFT_BG) & BIT_MASK_BG) -+#define BIT_SET_BG(x, v) (BIT_CLEAR_BG(x) | BIT_BG(v)) -+ -+#define BIT_TXBCN8ERR BIT(0) -+#define BIT_BCNDERR8 BIT(0) -+#define BIT_PS_TIMER_EARLY_INT_0 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SYS_CFG5 (Offset 0x1070) */ -+ -+#define BIT_LPS_STATUS BIT(3) -+#define BIT_HCI_TXDMA_BUSY BIT(2) -+#define BIT_HCI_TXDMA_ALLOW BIT(1) -+#define BIT_FW_CTRL_HCI_TXDMA_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_REGU_32K_1 (Offset 0x1078) */ -+ -+#define BIT_OUT_SEL BIT(26) -+ -+#define BIT_SHIFT_FREQ_SEL 24 -+#define BIT_MASK_FREQ_SEL 0x3 -+#define BIT_FREQ_SEL(x) (((x) & BIT_MASK_FREQ_SEL) << BIT_SHIFT_FREQ_SEL) -+#define BITS_FREQ_SEL (BIT_MASK_FREQ_SEL << BIT_SHIFT_FREQ_SEL) -+#define BIT_CLEAR_FREQ_SEL(x) ((x) & (~BITS_FREQ_SEL)) -+#define BIT_GET_FREQ_SEL(x) (((x) >> BIT_SHIFT_FREQ_SEL) & BIT_MASK_FREQ_SEL) -+#define BIT_SET_FREQ_SEL(x, v) (BIT_CLEAR_FREQ_SEL(x) | BIT_FREQ_SEL(v)) -+ -+#define BIT_SHIFT_CLKGEN0 16 -+#define BIT_MASK_CLKGEN0 0xff -+#define BIT_CLKGEN0(x) (((x) & BIT_MASK_CLKGEN0) << BIT_SHIFT_CLKGEN0) -+#define BITS_CLKGEN0 (BIT_MASK_CLKGEN0 << BIT_SHIFT_CLKGEN0) -+#define BIT_CLEAR_CLKGEN0(x) ((x) & (~BITS_CLKGEN0)) -+#define BIT_GET_CLKGEN0(x) (((x) >> BIT_SHIFT_CLKGEN0) & BIT_MASK_CLKGEN0) -+#define BIT_SET_CLKGEN0(x, v) (BIT_CLEAR_CLKGEN0(x) | BIT_CLKGEN0(v)) -+ -+#define BIT_SHIFT_TEMP_COMP 12 -+#define BIT_MASK_TEMP_COMP 0xf -+#define BIT_TEMP_COMP(x) (((x) & BIT_MASK_TEMP_COMP) << BIT_SHIFT_TEMP_COMP) -+#define BITS_TEMP_COMP (BIT_MASK_TEMP_COMP << BIT_SHIFT_TEMP_COMP) -+#define BIT_CLEAR_TEMP_COMP(x) ((x) & (~BITS_TEMP_COMP)) -+#define BIT_GET_TEMP_COMP(x) (((x) >> BIT_SHIFT_TEMP_COMP) & BIT_MASK_TEMP_COMP) -+#define BIT_SET_TEMP_COMP(x, v) (BIT_CLEAR_TEMP_COMP(x) | BIT_TEMP_COMP(v)) -+ -+#define BIT_SHIFT_LDO_V18ADJ 8 -+#define BIT_MASK_LDO_V18ADJ 0xf -+#define BIT_LDO_V18ADJ(x) (((x) & BIT_MASK_LDO_V18ADJ) << BIT_SHIFT_LDO_V18ADJ) -+#define BITS_LDO_V18ADJ (BIT_MASK_LDO_V18ADJ << BIT_SHIFT_LDO_V18ADJ) -+#define BIT_CLEAR_LDO_V18ADJ(x) ((x) & (~BITS_LDO_V18ADJ)) -+#define BIT_GET_LDO_V18ADJ(x) \ -+ (((x) >> BIT_SHIFT_LDO_V18ADJ) & BIT_MASK_LDO_V18ADJ) -+#define BIT_SET_LDO_V18ADJ(x, v) (BIT_CLEAR_LDO_V18ADJ(x) | BIT_LDO_V18ADJ(v)) -+ -+#define BIT_SHIFT_COMP_LOAD_CUR 5 -+#define BIT_MASK_COMP_LOAD_CUR 0x3 -+#define BIT_COMP_LOAD_CUR(x) \ -+ (((x) & BIT_MASK_COMP_LOAD_CUR) << BIT_SHIFT_COMP_LOAD_CUR) -+#define BITS_COMP_LOAD_CUR (BIT_MASK_COMP_LOAD_CUR << BIT_SHIFT_COMP_LOAD_CUR) -+#define BIT_CLEAR_COMP_LOAD_CUR(x) ((x) & (~BITS_COMP_LOAD_CUR)) -+#define BIT_GET_COMP_LOAD_CUR(x) \ -+ (((x) >> BIT_SHIFT_COMP_LOAD_CUR) & BIT_MASK_COMP_LOAD_CUR) -+#define BIT_SET_COMP_LOAD_CUR(x, v) \ -+ (BIT_CLEAR_COMP_LOAD_CUR(x) | BIT_COMP_LOAD_CUR(v)) -+ -+#define BIT_SHIFT_COMP_LATCH_CUR 3 -+#define BIT_MASK_COMP_LATCH_CUR 0x3 -+#define BIT_COMP_LATCH_CUR(x) \ -+ (((x) & BIT_MASK_COMP_LATCH_CUR) << BIT_SHIFT_COMP_LATCH_CUR) -+#define BITS_COMP_LATCH_CUR \ -+ (BIT_MASK_COMP_LATCH_CUR << BIT_SHIFT_COMP_LATCH_CUR) -+#define BIT_CLEAR_COMP_LATCH_CUR(x) ((x) & (~BITS_COMP_LATCH_CUR)) -+#define BIT_GET_COMP_LATCH_CUR(x) \ -+ (((x) >> BIT_SHIFT_COMP_LATCH_CUR) & BIT_MASK_COMP_LATCH_CUR) -+#define BIT_SET_COMP_LATCH_CUR(x, v) \ -+ (BIT_CLEAR_COMP_LATCH_CUR(x) | BIT_COMP_LATCH_CUR(v)) -+ -+#define BIT_SHIFT_COMP_GM_CUR 1 -+#define BIT_MASK_COMP_GM_CUR 0x3 -+#define BIT_COMP_GM_CUR(x) \ -+ (((x) & BIT_MASK_COMP_GM_CUR) << BIT_SHIFT_COMP_GM_CUR) -+#define BITS_COMP_GM_CUR (BIT_MASK_COMP_GM_CUR << BIT_SHIFT_COMP_GM_CUR) -+#define BIT_CLEAR_COMP_GM_CUR(x) ((x) & (~BITS_COMP_GM_CUR)) -+#define BIT_GET_COMP_GM_CUR(x) \ -+ (((x) >> BIT_SHIFT_COMP_GM_CUR) & BIT_MASK_COMP_GM_CUR) -+#define BIT_SET_COMP_GM_CUR(x, v) \ -+ (BIT_CLEAR_COMP_GM_CUR(x) | BIT_COMP_GM_CUR(v)) -+ -+/* 2 REG_REGU_32K_2 (Offset 0x107C) */ -+ -+#define BIT_SEL_RCAL_SOURCE BIT(16) -+ -+#define BIT_SHIFT_RCAL 0 -+#define BIT_MASK_RCAL 0x3f -+#define BIT_RCAL(x) (((x) & BIT_MASK_RCAL) << BIT_SHIFT_RCAL) -+#define BITS_RCAL (BIT_MASK_RCAL << BIT_SHIFT_RCAL) -+#define BIT_CLEAR_RCAL(x) ((x) & (~BITS_RCAL)) -+#define BIT_GET_RCAL(x) (((x) >> BIT_SHIFT_RCAL) & BIT_MASK_RCAL) -+#define BIT_SET_RCAL(x, v) (BIT_CLEAR_RCAL(x) | BIT_RCAL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_SCH_PHY_TXOP_SIFS_INT BIT(23) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_WDT_AUTO_MODE BIT(22) -+#define BIT_WDT_PLATFORM_EN BIT(21) -+#define BIT_WDT_CPU_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_WDT_OPT_IOWRAPPER BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_ANA_PORT_IDLE BIT(18) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_TEST_EPHY_BY_REG BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_MAC_PORT_IDLE BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_SYM_FEN_WLPLT BIT(16) -+#define BIT_TEST_UPHY_BY_REG BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_WL_PLATFORM_RST BIT(16) -+#define BIT_WL_SECURITY_CLK BIT(15) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_DDMA_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_UPHY_SLB_HW_PRD BIT(7) -+#define BIT_UPHY_FS_SLB_OK BIT(6) -+#define BIT_UPHY_HS_SLB_OK BIT(5) -+#define BIT_UPHY_SLB_CMD BIT(4) -+#define BIT_UPHY_SLB_FAIL BIT(3) -+#define BIT_UPHY_SLB_DONE BIT(2) -+#define BIT_UPHY_FORCE_SLB BIT(1) -+ -+#define BIT_SHIFT_SYM_CPU_DMEN_CON 0 -+#define BIT_MASK_SYM_CPU_DMEN_CON 0xff -+#define BIT_SYM_CPU_DMEN_CON(x) \ -+ (((x) & BIT_MASK_SYM_CPU_DMEN_CON) << BIT_SHIFT_SYM_CPU_DMEN_CON) -+#define BITS_SYM_CPU_DMEN_CON \ -+ (BIT_MASK_SYM_CPU_DMEN_CON << BIT_SHIFT_SYM_CPU_DMEN_CON) -+#define BIT_CLEAR_SYM_CPU_DMEN_CON(x) ((x) & (~BITS_SYM_CPU_DMEN_CON)) -+#define BIT_GET_SYM_CPU_DMEN_CON(x) \ -+ (((x) >> BIT_SHIFT_SYM_CPU_DMEN_CON) & BIT_MASK_SYM_CPU_DMEN_CON) -+#define BIT_SET_SYM_CPU_DMEN_CON(x, v) \ -+ (BIT_CLEAR_SYM_CPU_DMEN_CON(x) | BIT_SYM_CPU_DMEN_CON(v)) -+ -+#define BIT_UPHY_SLB_HS BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPU_DMEM_CON (Offset 0x1080) */ -+ -+#define BIT_SHIFT_CPU_DMEM_CON 0 -+#define BIT_MASK_CPU_DMEM_CON 0xff -+#define BIT_CPU_DMEM_CON(x) \ -+ (((x) & BIT_MASK_CPU_DMEM_CON) << BIT_SHIFT_CPU_DMEM_CON) -+#define BITS_CPU_DMEM_CON (BIT_MASK_CPU_DMEM_CON << BIT_SHIFT_CPU_DMEM_CON) -+#define BIT_CLEAR_CPU_DMEM_CON(x) ((x) & (~BITS_CPU_DMEM_CON)) -+#define BIT_GET_CPU_DMEM_CON(x) \ -+ (((x) >> BIT_SHIFT_CPU_DMEM_CON) & BIT_MASK_CPU_DMEM_CON) -+#define BIT_SET_CPU_DMEM_CON(x, v) \ -+ (BIT_CLEAR_CPU_DMEM_CON(x) | BIT_CPU_DMEM_CON(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BOOT_REASON (Offset 0x1088) */ -+ -+#define BIT_SHIFT_BOOT_REASON_V1 0 -+#define BIT_MASK_BOOT_REASON_V1 0x7 -+#define BIT_BOOT_REASON_V1(x) \ -+ (((x) & BIT_MASK_BOOT_REASON_V1) << BIT_SHIFT_BOOT_REASON_V1) -+#define BITS_BOOT_REASON_V1 \ -+ (BIT_MASK_BOOT_REASON_V1 << BIT_SHIFT_BOOT_REASON_V1) -+#define BIT_CLEAR_BOOT_REASON_V1(x) ((x) & (~BITS_BOOT_REASON_V1)) -+#define BIT_GET_BOOT_REASON_V1(x) \ -+ (((x) >> BIT_SHIFT_BOOT_REASON_V1) & BIT_MASK_BOOT_REASON_V1) -+#define BIT_SET_BOOT_REASON_V1(x, v) \ -+ (BIT_CLEAR_BOOT_REASON_V1(x) | BIT_BOOT_REASON_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR4 (Offset 0x1090) */ -+ -+#define BIT_ATIM_END_INT16_MSK BIT(32) -+#define BIT_ATIM_END_INT15_MSK BIT(31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL0 (Offset 0x1090) */ -+ -+#define BIT_DATA_FW_READY BIT(31) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR4 (Offset 0x1090) */ -+ -+#define BIT_ATIM_END_INT14_MSK BIT(30) -+#define BIT_ATIM_END_INT13_MSK BIT(29) -+#define BIT_ATIM_END_INT12_MSK BIT(28) -+#define BIT_ATIM_END_INT11_MSK BIT(27) -+#define BIT_ATIM_END_INT10_MSK BIT(26) -+#define BIT_ATIM_END_INT9_MSK BIT(25) -+#define BIT_ATIM_END_INT8_MSK BIT(24) -+#define BIT_TX_BCN_ERR_INT15_MSK BIT(23) -+#define BIT_TX_BCN_ERR_INT14_MSK BIT(22) -+#define BIT_TX_BCN_ERR_INT13_MSK BIT(21) -+#define BIT_TX_BCN_ERR_INT12_MSK BIT(20) -+#define BIT_TX_BCN_ERR_INT11_MSK BIT(19) -+#define BIT_TX_BCN_ERR_INT10_MSK BIT(18) -+#define BIT_TX_BCN_ERR_INT9_MSK BIT(17) -+#define BIT_TX_BCN_ERR_INT8_MSK BIT(16) -+#define BIT_TX_BCN_OK_INT15_MSK BIT(15) -+#define BIT_TX_BCN_OK_INT14_MSK BIT(14) -+#define BIT_TX_BCN_OK_INT13_MSK BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL0 (Offset 0x1090) */ -+ -+#define BIT_WDT_SYS_RST BIT(13) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR4 (Offset 0x1090) */ -+ -+#define BIT_TX_BCN_OK_INT12_MSK BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL0 (Offset 0x1090) */ -+ -+#define BIT_WDT_ENABLE BIT(12) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR4 (Offset 0x1090) */ -+ -+#define BIT_TX_BCN_OK_INT11_MSK BIT(11) -+#define BIT_TX_BCN_OK_INT10_MSK BIT(10) -+#define BIT_TX_BCN_OK_INT9_MSK BIT(9) -+#define BIT_TX_BCN_OK_INT8_MSK BIT(8) -+#define BIT_BCN_DMA_INT15_MSK BIT(7) -+#define BIT_BCN_DMA_INT14_MSK BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL0 (Offset 0x1090) */ -+ -+#define BIT_SHIFT_BOOT_SEL 6 -+#define BIT_MASK_BOOT_SEL 0x3 -+#define BIT_BOOT_SEL(x) (((x) & BIT_MASK_BOOT_SEL) << BIT_SHIFT_BOOT_SEL) -+#define BITS_BOOT_SEL (BIT_MASK_BOOT_SEL << BIT_SHIFT_BOOT_SEL) -+#define BIT_CLEAR_BOOT_SEL(x) ((x) & (~BITS_BOOT_SEL)) -+#define BIT_GET_BOOT_SEL(x) (((x) >> BIT_SHIFT_BOOT_SEL) & BIT_MASK_BOOT_SEL) -+#define BIT_SET_BOOT_SEL(x, v) (BIT_CLEAR_BOOT_SEL(x) | BIT_BOOT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR4 (Offset 0x1090) */ -+ -+#define BIT_BCN_DMA_INT13_MSK BIT(5) -+#define BIT_BCN_DMA_INT12_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL0 (Offset 0x1090) */ -+ -+#define BIT_CLK_SEL BIT(4) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR4 (Offset 0x1090) */ -+ -+#define BIT_BCN_DMA_INT11_MSK BIT(3) -+#define BIT_BCN_DMA_INT10_MSK BIT(2) -+#define BIT_BCN_DMA_INT9_MSK BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL0 (Offset 0x1090) */ -+ -+#define BIT_DATA_PLATFORM_RST BIT(1) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR4 (Offset 0x1090) */ -+ -+#define BIT_BCN_DMA_INT8_MSK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL0 (Offset 0x1090) */ -+ -+#define BIT_DATA_CPU_RST BIT(0) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR4 (Offset 0x1094) */ -+ -+#define BIT_TX_BCN_ERR_INT15 BIT(23) -+#define BIT_TX_BCN_ERR_INT14 BIT(22) -+#define BIT_TX_BCN_ERR_INT13 BIT(21) -+#define BIT_TX_BCN_ERR_INT12 BIT(20) -+#define BIT_TX_BCN_ERR_INT11 BIT(19) -+#define BIT_TX_BCN_ERR_INT10 BIT(18) -+#define BIT_TX_BCN_ERR_INT9 BIT(17) -+#define BIT_TX_BCN_ERR_INT8 BIT(16) -+#define BIT_TX_BCN_OK_INT15 BIT(15) -+#define BIT_TX_BCN_OK_INT14 BIT(14) -+#define BIT_TX_BCN_OK_INT13 BIT(13) -+#define BIT_TX_BCN_OK_INT12 BIT(12) -+#define BIT_TX_BCN_OK_INT11 BIT(11) -+#define BIT_TX_BCN_OK_INT10 BIT(10) -+#define BIT_TX_BCN_OK_INT9 BIT(9) -+#define BIT_TX_BCN_OK_INT8 BIT(8) -+#define BIT_BCN_DMA_INT15 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL1 (Offset 0x1094) */ -+ -+#define BIT_HOST_INTERFACE_IO_PATH BIT(7) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR4 (Offset 0x1094) */ -+ -+#define BIT_BCN_DMA_INT14 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL1 (Offset 0x1094) */ -+ -+#define BIT_EN_TXDMA_OFLD BIT(6) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR4 (Offset 0x1094) */ -+ -+#define BIT_BCN_DMA_INT13 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL1 (Offset 0x1094) */ -+ -+#define BIT_EN_RXDMA_OFLD BIT(5) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR4 (Offset 0x1094) */ -+ -+#define BIT_BCN_DMA_INT12 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL1 (Offset 0x1094) */ -+ -+#define BIT_EN_HCI_DMA_TX BIT(4) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR4 (Offset 0x1094) */ -+ -+#define BIT_BCN_DMA_INT11 BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL1 (Offset 0x1094) */ -+ -+#define BIT_EN_HCI_DMA_RX BIT(3) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR4 (Offset 0x1094) */ -+ -+#define BIT_BCN_DMA_INT10 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL1 (Offset 0x1094) */ -+ -+#define BIT_EN_AXI_DMA_TX BIT(2) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR4 (Offset 0x1094) */ -+ -+#define BIT_BCN_DMA_INT9 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL1 (Offset 0x1094) */ -+ -+#define BIT_EN_AXI_DMA_RX BIT(1) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR4 (Offset 0x1094) */ -+ -+#define BIT_BCN_DMA_INT8 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DATA_CPU_CTL1 (Offset 0x1094) */ -+ -+#define BIT_EN_PKT_ENG BIT(0) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HIMR5 (Offset 0x1098) */ -+ -+#define BIT_BCN_QDMA_ERR_INT15_MSK BIT(7) -+#define BIT_BCN_QDMA_ERR_INT14_MSK BIT(6) -+#define BIT_BCN_QDMA_ERR_INT13_MSK BIT(5) -+#define BIT_BCN_QDMA_ERR_INT12_MSK BIT(4) -+#define BIT_BCN_QDMA_ERR_INT11_MSK BIT(3) -+#define BIT_BCN_QDMA_ERR_INT10_MSK BIT(2) -+#define BIT_BCN_QDMA_ERR_INT9_MSK BIT(1) -+#define BIT_BCN_QDMA_ERR_INT8_MSK BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXDMA_STOP_HIMR (Offset 0x1098) */ -+ -+#define BIT_SHIFT_NTH_TXDMA_STOP_INT_MSK 0 -+#define BIT_MASK_NTH_TXDMA_STOP_INT_MSK 0x1ffff -+#define BIT_NTH_TXDMA_STOP_INT_MSK(x) \ -+ (((x) & BIT_MASK_NTH_TXDMA_STOP_INT_MSK) \ -+ << BIT_SHIFT_NTH_TXDMA_STOP_INT_MSK) -+#define BITS_NTH_TXDMA_STOP_INT_MSK \ -+ (BIT_MASK_NTH_TXDMA_STOP_INT_MSK << BIT_SHIFT_NTH_TXDMA_STOP_INT_MSK) -+#define BIT_CLEAR_NTH_TXDMA_STOP_INT_MSK(x) \ -+ ((x) & (~BITS_NTH_TXDMA_STOP_INT_MSK)) -+#define BIT_GET_NTH_TXDMA_STOP_INT_MSK(x) \ -+ (((x) >> BIT_SHIFT_NTH_TXDMA_STOP_INT_MSK) & \ -+ BIT_MASK_NTH_TXDMA_STOP_INT_MSK) -+#define BIT_SET_NTH_TXDMA_STOP_INT_MSK(x, v) \ -+ (BIT_CLEAR_NTH_TXDMA_STOP_INT_MSK(x) | BIT_NTH_TXDMA_STOP_INT_MSK(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HISR5 (Offset 0x109C) */ -+ -+#define BIT_BCN_QDMA_ERR_INT15 BIT(7) -+#define BIT_BCN_QDMA_ERR_INT14 BIT(6) -+#define BIT_BCN_QDMA_ERR_INT13 BIT(5) -+#define BIT_BCN_QDMA_ERR_INT12 BIT(4) -+#define BIT_BCN_QDMA_ERR_INT11 BIT(3) -+#define BIT_BCN_QDMA_ERR_INT10 BIT(2) -+#define BIT_BCN_QDMA_ERR_INT9 BIT(1) -+#define BIT_BCN_QDMA_ERR_INT8 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXDMA_STOP_HISR (Offset 0x109C) */ -+ -+#define BIT_SHIFT_NTH_TXDMA_STOP_INT 0 -+#define BIT_MASK_NTH_TXDMA_STOP_INT 0x1ffff -+#define BIT_NTH_TXDMA_STOP_INT(x) \ -+ (((x) & BIT_MASK_NTH_TXDMA_STOP_INT) << BIT_SHIFT_NTH_TXDMA_STOP_INT) -+#define BITS_NTH_TXDMA_STOP_INT \ -+ (BIT_MASK_NTH_TXDMA_STOP_INT << BIT_SHIFT_NTH_TXDMA_STOP_INT) -+#define BIT_CLEAR_NTH_TXDMA_STOP_INT(x) ((x) & (~BITS_NTH_TXDMA_STOP_INT)) -+#define BIT_GET_NTH_TXDMA_STOP_INT(x) \ -+ (((x) >> BIT_SHIFT_NTH_TXDMA_STOP_INT) & BIT_MASK_NTH_TXDMA_STOP_INT) -+#define BIT_SET_NTH_TXDMA_STOP_INT(x, v) \ -+ (BIT_CLEAR_NTH_TXDMA_STOP_INT(x) | BIT_NTH_TXDMA_STOP_INT(v)) -+ -+/* 2 REG_TXDMA_START_HIMR (Offset 0x10A0) */ -+ -+#define BIT_SHIFT_NTH_TXDMA_START_INT_MSK 0 -+#define BIT_MASK_NTH_TXDMA_START_INT_MSK 0x1ffff -+#define BIT_NTH_TXDMA_START_INT_MSK(x) \ -+ (((x) & BIT_MASK_NTH_TXDMA_START_INT_MSK) \ -+ << BIT_SHIFT_NTH_TXDMA_START_INT_MSK) -+#define BITS_NTH_TXDMA_START_INT_MSK \ -+ (BIT_MASK_NTH_TXDMA_START_INT_MSK << BIT_SHIFT_NTH_TXDMA_START_INT_MSK) -+#define BIT_CLEAR_NTH_TXDMA_START_INT_MSK(x) \ -+ ((x) & (~BITS_NTH_TXDMA_START_INT_MSK)) -+#define BIT_GET_NTH_TXDMA_START_INT_MSK(x) \ -+ (((x) >> BIT_SHIFT_NTH_TXDMA_START_INT_MSK) & \ -+ BIT_MASK_NTH_TXDMA_START_INT_MSK) -+#define BIT_SET_NTH_TXDMA_START_INT_MSK(x, v) \ -+ (BIT_CLEAR_NTH_TXDMA_START_INT_MSK(x) | BIT_NTH_TXDMA_START_INT_MSK(v)) -+ -+/* 2 REG_TXDMA_START_HISR (Offset 0x10A4) */ -+ -+#define BIT_SHIFT_NTH_TXDMA_START_INT 0 -+#define BIT_MASK_NTH_TXDMA_START_INT 0x1ffff -+#define BIT_NTH_TXDMA_START_INT(x) \ -+ (((x) & BIT_MASK_NTH_TXDMA_START_INT) << BIT_SHIFT_NTH_TXDMA_START_INT) -+#define BITS_NTH_TXDMA_START_INT \ -+ (BIT_MASK_NTH_TXDMA_START_INT << BIT_SHIFT_NTH_TXDMA_START_INT) -+#define BIT_CLEAR_NTH_TXDMA_START_INT(x) ((x) & (~BITS_NTH_TXDMA_START_INT)) -+#define BIT_GET_NTH_TXDMA_START_INT(x) \ -+ (((x) >> BIT_SHIFT_NTH_TXDMA_START_INT) & BIT_MASK_NTH_TXDMA_START_INT) -+#define BIT_SET_NTH_TXDMA_START_INT(x, v) \ -+ (BIT_CLEAR_NTH_TXDMA_START_INT(x) | BIT_NTH_TXDMA_START_INT(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NFC_PAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYM_NFC_PAD_SEL BIT(19) -+#define BIT_SYM_NFC_PAD_SHDN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_NFCPAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_PAD_SHUTDW BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NFC_PAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYM_NFC_PAD_E2 BIT(17) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_NFCPAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYSON_NFC_PAD BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NFC_PAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYM_NFC_INTPL BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_NFCPAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_NFC_INT_PAD_CTRL BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NFC_PAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYM_NFC_RFDIS_PULL BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_NFCPAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_NFC_RFDIS_PAD_CTRL BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NFC_PAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYM_NFC_CLK_PULL BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_NFCPAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_NFC_CLK_PAD_CTRL BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NFC_PAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYM_NFC_DATA_PULL BIT(13) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_NFCPAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_NFC_DATA_PAD_CTRL BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NFC_PAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYM_NFC_PAD_PULL_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_NFCPAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_NFC_PAD_PULL_CTRL BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NFC_PAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYM_NFC_INT_E BIT(11) -+#define BIT_SYM_NFC_RFDIS_E BIT(10) -+#define BIT_SYM_NFC_CLK_E BIT(9) -+#define BIT_SYM_NFC_DATA_E BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_NFCPAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SHIFT_NFCPAD_IO_SEL 8 -+#define BIT_MASK_NFCPAD_IO_SEL 0xf -+#define BIT_NFCPAD_IO_SEL(x) \ -+ (((x) & BIT_MASK_NFCPAD_IO_SEL) << BIT_SHIFT_NFCPAD_IO_SEL) -+#define BITS_NFCPAD_IO_SEL (BIT_MASK_NFCPAD_IO_SEL << BIT_SHIFT_NFCPAD_IO_SEL) -+#define BIT_CLEAR_NFCPAD_IO_SEL(x) ((x) & (~BITS_NFCPAD_IO_SEL)) -+#define BIT_GET_NFCPAD_IO_SEL(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_IO_SEL) & BIT_MASK_NFCPAD_IO_SEL) -+#define BIT_SET_NFCPAD_IO_SEL(x, v) \ -+ (BIT_CLEAR_NFCPAD_IO_SEL(x) | BIT_NFCPAD_IO_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NFC_PAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYM_NFC_INT BIT(7) -+#define BIT_SYM_NFC_RFDIS BIT(6) -+#define BIT_SYM_NFC_CLK BIT(5) -+#define BIT_SYM_NFC_DATA BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_NFCPAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SHIFT_NFCPAD_OUT 4 -+#define BIT_MASK_NFCPAD_OUT 0xf -+#define BIT_NFCPAD_OUT(x) (((x) & BIT_MASK_NFCPAD_OUT) << BIT_SHIFT_NFCPAD_OUT) -+#define BITS_NFCPAD_OUT (BIT_MASK_NFCPAD_OUT << BIT_SHIFT_NFCPAD_OUT) -+#define BIT_CLEAR_NFCPAD_OUT(x) ((x) & (~BITS_NFCPAD_OUT)) -+#define BIT_GET_NFCPAD_OUT(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_OUT) & BIT_MASK_NFCPAD_OUT) -+#define BIT_SET_NFCPAD_OUT(x, v) (BIT_CLEAR_NFCPAD_OUT(x) | BIT_NFCPAD_OUT(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_NFC_PAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SYM_NFC_INT_I BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_NFCPAD_CTRL (Offset 0x10A8) */ -+ -+#define BIT_SHIFT_NFCPAD_IN 0 -+#define BIT_MASK_NFCPAD_IN 0xf -+#define BIT_NFCPAD_IN(x) (((x) & BIT_MASK_NFCPAD_IN) << BIT_SHIFT_NFCPAD_IN) -+#define BITS_NFCPAD_IN (BIT_MASK_NFCPAD_IN << BIT_SHIFT_NFCPAD_IN) -+#define BIT_CLEAR_NFCPAD_IN(x) ((x) & (~BITS_NFCPAD_IN)) -+#define BIT_GET_NFCPAD_IN(x) (((x) >> BIT_SHIFT_NFCPAD_IN) & BIT_MASK_NFCPAD_IN) -+#define BIT_SET_NFCPAD_IN(x, v) (BIT_CLEAR_NFCPAD_IN(x) | BIT_NFCPAD_IN(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR2 (Offset 0x10B0) */ -+ -+#define BIT_BCNDMAINT_P4_MSK BIT(31) -+#define BIT_BCNDMAINT_P4 BIT(31) -+#define BIT_BCNDMAINT_P3_MSK BIT(30) -+#define BIT_BCNDMAINT_P3 BIT(30) -+#define BIT_BCNDMAINT_P2_MSK BIT(29) -+#define BIT_BCNDMAINT_P2 BIT(29) -+#define BIT_BCNDMAINT_P1_MSK BIT(28) -+#define BIT_BCNDMAINT_P1 BIT(28) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR2 (Offset 0x10B0) */ -+ -+#define BIT_SCH_PHY_TXOP_SIFS_INT_MSK BIT(23) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR2 (Offset 0x10B0) */ -+ -+#define BIT_ATIMEND7_MSK BIT(22) -+#define BIT_ATIMEND7 BIT(22) -+#define BIT_ATIMEND6_MSK BIT(21) -+#define BIT_ATIMEND6 BIT(21) -+#define BIT_ATIMEND5_MSK BIT(20) -+#define BIT_ATIMEND5 BIT(20) -+#define BIT_ATIMEND4_MSK BIT(19) -+#define BIT_ATIMEND4 BIT(19) -+#define BIT_ATIMEND3_MSK BIT(18) -+#define BIT_ATIMEND3 BIT(18) -+#define BIT_ATIMEND2_MSK BIT(17) -+#define BIT_ATIMEND2 BIT(17) -+#define BIT_ATIMEND1_MSK BIT(16) -+#define BIT_ATIMEND1 BIT(16) -+#define BIT_TXBCN7OK_MSK BIT(14) -+#define BIT_TXBCN7OK BIT(14) -+#define BIT_TXBCN6OK_MSK BIT(13) -+#define BIT_TXBCN6OK BIT(13) -+#define BIT_TXBCN5OK_MSK BIT(12) -+#define BIT_TXBCN5OK BIT(12) -+#define BIT_TXBCN4OK_MSK BIT(11) -+#define BIT_TXBCN4OK BIT(11) -+#define BIT_TXBCN3OK_MSK BIT(10) -+#define BIT_TXBCN3OK BIT(10) -+#define BIT_TXBCN2OK_MSK BIT(9) -+#define BIT_TXBCN2OK BIT(9) -+#define BIT_TXBCN1OK_MSK_V1 BIT(8) -+#define BIT_TXBCN1OK BIT(8) -+#define BIT_TXBCN7ERR_MSK BIT(6) -+#define BIT_TXBCN7ERR BIT(6) -+#define BIT_TXBCN6ERR_MSK BIT(5) -+#define BIT_TXBCN6ERR BIT(5) -+#define BIT_TXBCN5ERR_MSK BIT(4) -+#define BIT_TXBCN5ERR BIT(4) -+#define BIT_TXBCN4ERR_MSK BIT(3) -+#define BIT_TXBCN4ERR BIT(3) -+#define BIT_TXBCN3ERR_MSK BIT(2) -+#define BIT_TXBCN3ERR BIT(2) -+#define BIT_TXBCN2ERR_MSK BIT(1) -+#define BIT_TXBCN2ERR BIT(1) -+#define BIT_TXBCN1ERR_MSK_V1 BIT(0) -+#define BIT_TXBCN1ERR BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_GTINT12 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_GTINT12_MSK BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_GTINT11 BIT(23) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_GTINT11_MSK BIT(23) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_GTINT10 BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_GTINT10_MSK BIT(22) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_GTINT9 BIT(21) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_GTINT9_MSK BIT(21) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_RX_DESC_BUF_FULL BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_RX_DESC_BUF_FULL_MSK BIT(20) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_CPHY_LDO_OCP_DET_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_CPHY_LDO_OCP_DET_INT_MSK BIT(19) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_WDT_PLATFORM_INT_MSK BIT(18) -+#define BIT_WDT_PLATFORM_INT BIT(18) -+#define BIT_WDT_CPU_INT_MSK BIT(17) -+#define BIT_WDT_CPU_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_SETH2CDOK_MASK BIT(16) -+#define BIT_SETH2CDOK BIT(16) -+#define BIT_H2C_CMD_FULL_MASK BIT(15) -+#define BIT_H2C_CMD_FULL BIT(15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_PWR_INT_127_MASK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_PKT_TRANS_ERR BIT(14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_PKT_TRANS_ERR_MASK BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_MASK BIT(13) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_MASK BIT(12) -+#define BIT_TXSHORTCUT_BKUPDATEOK BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_MASK BIT(11) -+#define BIT_TXSHORTCUT_BEUPDATEOK BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_MAS BIT(10) -+#define BIT_TXSHORTCUT_VIUPDATEOK BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_MASK BIT(9) -+#define BIT_TXSHORTCUT_VOUPDATEOK BIT(9) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_PWR_INT_127_MASK_V1 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_SEARCH_FAIL BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_SEARCH_FAIL_MSK BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_PWR_INT_126TO96_MASK BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_PWR_INT_127TO96 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_PWR_INT_127TO96_MASK BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_PWR_INT_95TO64_MASK BIT(6) -+#define BIT_PWR_INT_95TO64 BIT(6) -+#define BIT_PWR_INT_63TO32_MASK BIT(5) -+#define BIT_PWR_INT_63TO32 BIT(5) -+#define BIT_PWR_INT_31TO0_MASK BIT(4) -+#define BIT_PWR_INT_31TO0 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_RX_DMA_STUCK_MSK BIT(3) -+#define BIT_RX_DMA_STUCK BIT(3) -+#define BIT_TX_DMA_STUCK_MSK BIT(2) -+#define BIT_TX_DMA_STUCK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HIMR3 (Offset 0x10B8) */ -+ -+#define BIT_DDMA0_LP_INT_MSK BIT(1) -+#define BIT_DDMA0_LP_INT BIT(1) -+#define BIT_DDMA0_HP_INT_MSK BIT(0) -+#define BIT_DDMA0_HP_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HISR3 (Offset 0x10BC) */ -+ -+#define BIT_PWR_INT_127 BIT(14) -+#define BIT_PWR_INT_127_V1 BIT(8) -+#define BIT_PWR_INT_126TO96 BIT(7) -+#define BIT_ECRC_EN_V1 BIT(7) -+#define BIT_MDIO_RFLAG_V1 BIT(6) -+#define BIT_MDIO_WFLAG_V1 BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_WLDSS_RST_N_0 BIT(27) -+#define BIT_WLDSS_RST_N_1 BIT(27) -+#define BIT_WLDSS_RST_N_2 BIT(27) -+#define BIT_WLDSS_ENCLK_0 BIT(26) -+#define BIT_WLDSS_ENCLK_1 BIT(26) -+#define BIT_WLDSS_ENCLK_2 BIT(26) -+#define BIT_WLDSS_SPEED_EN_0 BIT(25) -+#define BIT_WLDSS_SPEED_EN_1 BIT(25) -+#define BIT_WLDSS_SPEED_EN_2 BIT(25) -+#define BIT_WLDSS_WIRE_SEL_0 BIT(24) -+#define BIT_WLDSS_WIRE_SEL_1 BIT(24) -+#define BIT_WLDSS_WIRE_SEL_2 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_DIS_TIMEOUT_IO BIT(24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_WLDSS_READY_0 BIT(21) -+#define BIT_WLDSS_READY_1 BIT(21) -+#define BIT_WLDSS_READY_2 BIT(21) -+ -+#define BIT_SHIFT_WLDSS_RO_SEL_0 20 -+#define BIT_MASK_WLDSS_RO_SEL_0 0x7 -+#define BIT_WLDSS_RO_SEL_0(x) \ -+ (((x) & BIT_MASK_WLDSS_RO_SEL_0) << BIT_SHIFT_WLDSS_RO_SEL_0) -+#define BITS_WLDSS_RO_SEL_0 \ -+ (BIT_MASK_WLDSS_RO_SEL_0 << BIT_SHIFT_WLDSS_RO_SEL_0) -+#define BIT_CLEAR_WLDSS_RO_SEL_0(x) ((x) & (~BITS_WLDSS_RO_SEL_0)) -+#define BIT_GET_WLDSS_RO_SEL_0(x) \ -+ (((x) >> BIT_SHIFT_WLDSS_RO_SEL_0) & BIT_MASK_WLDSS_RO_SEL_0) -+#define BIT_SET_WLDSS_RO_SEL_0(x, v) \ -+ (BIT_CLEAR_WLDSS_RO_SEL_0(x) | BIT_WLDSS_RO_SEL_0(v)) -+ -+#define BIT_WLDSS_WSORT_GO_0 BIT(20) -+ -+#define BIT_SHIFT_WLDSS_RO_SEL_1 20 -+#define BIT_MASK_WLDSS_RO_SEL_1 0x7 -+#define BIT_WLDSS_RO_SEL_1(x) \ -+ (((x) & BIT_MASK_WLDSS_RO_SEL_1) << BIT_SHIFT_WLDSS_RO_SEL_1) -+#define BITS_WLDSS_RO_SEL_1 \ -+ (BIT_MASK_WLDSS_RO_SEL_1 << BIT_SHIFT_WLDSS_RO_SEL_1) -+#define BIT_CLEAR_WLDSS_RO_SEL_1(x) ((x) & (~BITS_WLDSS_RO_SEL_1)) -+#define BIT_GET_WLDSS_RO_SEL_1(x) \ -+ (((x) >> BIT_SHIFT_WLDSS_RO_SEL_1) & BIT_MASK_WLDSS_RO_SEL_1) -+#define BIT_SET_WLDSS_RO_SEL_1(x, v) \ -+ (BIT_CLEAR_WLDSS_RO_SEL_1(x) | BIT_WLDSS_RO_SEL_1(v)) -+ -+#define BIT_WLDSS_WSORT_GO_1 BIT(20) -+ -+#define BIT_SHIFT_WLDSS_RO_SEL_2 20 -+#define BIT_MASK_WLDSS_RO_SEL_2 0x7 -+#define BIT_WLDSS_RO_SEL_2(x) \ -+ (((x) & BIT_MASK_WLDSS_RO_SEL_2) << BIT_SHIFT_WLDSS_RO_SEL_2) -+#define BITS_WLDSS_RO_SEL_2 \ -+ (BIT_MASK_WLDSS_RO_SEL_2 << BIT_SHIFT_WLDSS_RO_SEL_2) -+#define BIT_CLEAR_WLDSS_RO_SEL_2(x) ((x) & (~BITS_WLDSS_RO_SEL_2)) -+#define BIT_GET_WLDSS_RO_SEL_2(x) \ -+ (((x) >> BIT_SHIFT_WLDSS_RO_SEL_2) & BIT_MASK_WLDSS_RO_SEL_2) -+#define BIT_SET_WLDSS_RO_SEL_2(x, v) \ -+ (BIT_CLEAR_WLDSS_RO_SEL_2(x) | BIT_WLDSS_RO_SEL_2(v)) -+ -+#define BIT_WLDSS_WSORT_GO_2 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_SUS_PL BIT(18) -+#define BIT_SOP_ESUS BIT(17) -+#define BIT_SOP_DLDO BIT(16) -+#define BIT_R_OCP_ST_CLR BIT(8) -+#define BIT_SW_USB3_MD_SEL BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_SYM_SW_PCIE_MDSL_V1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_SW_PCIE_MD_SEL BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_SYM_SW_PCIE_MDSL BIT(3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_SYM_SW_PCIE_MDCK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_SW_MDCK BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_SYM_SW_PCIE_MDI BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_SW_MDI BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_SYM_SW_PCIE_MDO BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_SHIFT_WLDSS_DATA_IN_0 0 -+#define BIT_MASK_WLDSS_DATA_IN_0 0xfffff -+#define BIT_WLDSS_DATA_IN_0(x) \ -+ (((x) & BIT_MASK_WLDSS_DATA_IN_0) << BIT_SHIFT_WLDSS_DATA_IN_0) -+#define BITS_WLDSS_DATA_IN_0 \ -+ (BIT_MASK_WLDSS_DATA_IN_0 << BIT_SHIFT_WLDSS_DATA_IN_0) -+#define BIT_CLEAR_WLDSS_DATA_IN_0(x) ((x) & (~BITS_WLDSS_DATA_IN_0)) -+#define BIT_GET_WLDSS_DATA_IN_0(x) \ -+ (((x) >> BIT_SHIFT_WLDSS_DATA_IN_0) & BIT_MASK_WLDSS_DATA_IN_0) -+#define BIT_SET_WLDSS_DATA_IN_0(x, v) \ -+ (BIT_CLEAR_WLDSS_DATA_IN_0(x) | BIT_WLDSS_DATA_IN_0(v)) -+ -+#define BIT_SHIFT_WLDSS_COUNT_OUT_0 0 -+#define BIT_MASK_WLDSS_COUNT_OUT_0 0xfffff -+#define BIT_WLDSS_COUNT_OUT_0(x) \ -+ (((x) & BIT_MASK_WLDSS_COUNT_OUT_0) << BIT_SHIFT_WLDSS_COUNT_OUT_0) -+#define BITS_WLDSS_COUNT_OUT_0 \ -+ (BIT_MASK_WLDSS_COUNT_OUT_0 << BIT_SHIFT_WLDSS_COUNT_OUT_0) -+#define BIT_CLEAR_WLDSS_COUNT_OUT_0(x) ((x) & (~BITS_WLDSS_COUNT_OUT_0)) -+#define BIT_GET_WLDSS_COUNT_OUT_0(x) \ -+ (((x) >> BIT_SHIFT_WLDSS_COUNT_OUT_0) & BIT_MASK_WLDSS_COUNT_OUT_0) -+#define BIT_SET_WLDSS_COUNT_OUT_0(x, v) \ -+ (BIT_CLEAR_WLDSS_COUNT_OUT_0(x) | BIT_WLDSS_COUNT_OUT_0(v)) -+ -+#define BIT_SHIFT_WLDSS_DATA_IN_1 0 -+#define BIT_MASK_WLDSS_DATA_IN_1 0xfffff -+#define BIT_WLDSS_DATA_IN_1(x) \ -+ (((x) & BIT_MASK_WLDSS_DATA_IN_1) << BIT_SHIFT_WLDSS_DATA_IN_1) -+#define BITS_WLDSS_DATA_IN_1 \ -+ (BIT_MASK_WLDSS_DATA_IN_1 << BIT_SHIFT_WLDSS_DATA_IN_1) -+#define BIT_CLEAR_WLDSS_DATA_IN_1(x) ((x) & (~BITS_WLDSS_DATA_IN_1)) -+#define BIT_GET_WLDSS_DATA_IN_1(x) \ -+ (((x) >> BIT_SHIFT_WLDSS_DATA_IN_1) & BIT_MASK_WLDSS_DATA_IN_1) -+#define BIT_SET_WLDSS_DATA_IN_1(x, v) \ -+ (BIT_CLEAR_WLDSS_DATA_IN_1(x) | BIT_WLDSS_DATA_IN_1(v)) -+ -+#define BIT_SHIFT_WLDSS_COUNT_OUT_1 0 -+#define BIT_MASK_WLDSS_COUNT_OUT_1 0xfffff -+#define BIT_WLDSS_COUNT_OUT_1(x) \ -+ (((x) & BIT_MASK_WLDSS_COUNT_OUT_1) << BIT_SHIFT_WLDSS_COUNT_OUT_1) -+#define BITS_WLDSS_COUNT_OUT_1 \ -+ (BIT_MASK_WLDSS_COUNT_OUT_1 << BIT_SHIFT_WLDSS_COUNT_OUT_1) -+#define BIT_CLEAR_WLDSS_COUNT_OUT_1(x) ((x) & (~BITS_WLDSS_COUNT_OUT_1)) -+#define BIT_GET_WLDSS_COUNT_OUT_1(x) \ -+ (((x) >> BIT_SHIFT_WLDSS_COUNT_OUT_1) & BIT_MASK_WLDSS_COUNT_OUT_1) -+#define BIT_SET_WLDSS_COUNT_OUT_1(x, v) \ -+ (BIT_CLEAR_WLDSS_COUNT_OUT_1(x) | BIT_WLDSS_COUNT_OUT_1(v)) -+ -+#define BIT_SHIFT_WLDSS_DATA_IN_2 0 -+#define BIT_MASK_WLDSS_DATA_IN_2 0xfffff -+#define BIT_WLDSS_DATA_IN_2(x) \ -+ (((x) & BIT_MASK_WLDSS_DATA_IN_2) << BIT_SHIFT_WLDSS_DATA_IN_2) -+#define BITS_WLDSS_DATA_IN_2 \ -+ (BIT_MASK_WLDSS_DATA_IN_2 << BIT_SHIFT_WLDSS_DATA_IN_2) -+#define BIT_CLEAR_WLDSS_DATA_IN_2(x) ((x) & (~BITS_WLDSS_DATA_IN_2)) -+#define BIT_GET_WLDSS_DATA_IN_2(x) \ -+ (((x) >> BIT_SHIFT_WLDSS_DATA_IN_2) & BIT_MASK_WLDSS_DATA_IN_2) -+#define BIT_SET_WLDSS_DATA_IN_2(x, v) \ -+ (BIT_CLEAR_WLDSS_DATA_IN_2(x) | BIT_WLDSS_DATA_IN_2(v)) -+ -+#define BIT_SHIFT_WLDSS_COUNT_OUT_2 0 -+#define BIT_MASK_WLDSS_COUNT_OUT_2 0xfffff -+#define BIT_WLDSS_COUNT_OUT_2(x) \ -+ (((x) & BIT_MASK_WLDSS_COUNT_OUT_2) << BIT_SHIFT_WLDSS_COUNT_OUT_2) -+#define BITS_WLDSS_COUNT_OUT_2 \ -+ (BIT_MASK_WLDSS_COUNT_OUT_2 << BIT_SHIFT_WLDSS_COUNT_OUT_2) -+#define BIT_CLEAR_WLDSS_COUNT_OUT_2(x) ((x) & (~BITS_WLDSS_COUNT_OUT_2)) -+#define BIT_GET_WLDSS_COUNT_OUT_2(x) \ -+ (((x) >> BIT_SHIFT_WLDSS_COUNT_OUT_2) & BIT_MASK_WLDSS_COUNT_OUT_2) -+#define BIT_SET_WLDSS_COUNT_OUT_2(x, v) \ -+ (BIT_CLEAR_WLDSS_COUNT_OUT_2(x) | BIT_WLDSS_COUNT_OUT_2(v)) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_SW_MDIO (Offset 0x10C0) */ -+ -+#define BIT_MDO BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_SW_FLUSH (Offset 0x10C4) */ -+ -+#define BIT_FLUSH_HOLDN_EN BIT(25) -+#define BIT_FLUSH_WR_EN BIT(24) -+#define BIT_SW_FLASH_CONTROL BIT(23) -+#define BIT_SW_FLASH_WEN_E BIT(19) -+#define BIT_SW_FLASH_HOLDN_E BIT(18) -+#define BIT_SW_FLASH_SO_E BIT(17) -+#define BIT_SW_FLASH_SI_E BIT(16) -+#define BIT_SW_FLASH_SK_O BIT(13) -+#define BIT_SW_FLASH_CEN_O BIT(12) -+#define BIT_SW_FLASH_WEN_O BIT(11) -+#define BIT_SW_FLASH_HOLDN_O BIT(10) -+#define BIT_SW_FLASH_SO_O BIT(9) -+#define BIT_SW_FLASH_SI_O BIT(8) -+#define BIT_SW_FLASH_WEN_I BIT(3) -+#define BIT_SW_FLASH_HOLDN_I BIT(2) -+#define BIT_SW_FLASH_SO_I BIT(1) -+#define BIT_SW_FLASH_SI_I BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR_7 (Offset 0x10C8) */ -+ -+#define BIT_DATA_CPU_WDT_INT_MSK BIT(31) -+#define BIT_OFLD_TXDMA_ERR_MSK BIT(30) -+#define BIT_OFLD_TXDMA_FULL_MSK BIT(29) -+#define BIT_OFLD_RXDMA_OVR_MSK BIT(28) -+#define BIT_OFLD_RXDMA_ERR_MSK BIT(27) -+#define BIT_OFLD_RXDMA_DES_UA_MSK BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DBG_GPIO_BMUX (Offset 0x10C8) */ -+ -+#define BIT_SHIFT_WL_DSS_CLKEN_BACKDOOR 24 -+#define BIT_MASK_WL_DSS_CLKEN_BACKDOOR 0x3 -+#define BIT_WL_DSS_CLKEN_BACKDOOR(x) \ -+ (((x) & BIT_MASK_WL_DSS_CLKEN_BACKDOOR) \ -+ << BIT_SHIFT_WL_DSS_CLKEN_BACKDOOR) -+#define BITS_WL_DSS_CLKEN_BACKDOOR \ -+ (BIT_MASK_WL_DSS_CLKEN_BACKDOOR << BIT_SHIFT_WL_DSS_CLKEN_BACKDOOR) -+#define BIT_CLEAR_WL_DSS_CLKEN_BACKDOOR(x) ((x) & (~BITS_WL_DSS_CLKEN_BACKDOOR)) -+#define BIT_GET_WL_DSS_CLKEN_BACKDOOR(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_CLKEN_BACKDOOR) & \ -+ BIT_MASK_WL_DSS_CLKEN_BACKDOOR) -+#define BIT_SET_WL_DSS_CLKEN_BACKDOOR(x, v) \ -+ (BIT_CLEAR_WL_DSS_CLKEN_BACKDOOR(x) | BIT_WL_DSS_CLKEN_BACKDOOR(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DBG_GPIO_BMUX (Offset 0x10C8) */ -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_7 21 -+#define BIT_MASK_DBG_GPIO_BMUX_7 0x7 -+#define BIT_DBG_GPIO_BMUX_7(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_7) << BIT_SHIFT_DBG_GPIO_BMUX_7) -+#define BITS_DBG_GPIO_BMUX_7 \ -+ (BIT_MASK_DBG_GPIO_BMUX_7 << BIT_SHIFT_DBG_GPIO_BMUX_7) -+#define BIT_CLEAR_DBG_GPIO_BMUX_7(x) ((x) & (~BITS_DBG_GPIO_BMUX_7)) -+#define BIT_GET_DBG_GPIO_BMUX_7(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_7) & BIT_MASK_DBG_GPIO_BMUX_7) -+#define BIT_SET_DBG_GPIO_BMUX_7(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_7(x) | BIT_DBG_GPIO_BMUX_7(v)) -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_6 18 -+#define BIT_MASK_DBG_GPIO_BMUX_6 0x7 -+#define BIT_DBG_GPIO_BMUX_6(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_6) << BIT_SHIFT_DBG_GPIO_BMUX_6) -+#define BITS_DBG_GPIO_BMUX_6 \ -+ (BIT_MASK_DBG_GPIO_BMUX_6 << BIT_SHIFT_DBG_GPIO_BMUX_6) -+#define BIT_CLEAR_DBG_GPIO_BMUX_6(x) ((x) & (~BITS_DBG_GPIO_BMUX_6)) -+#define BIT_GET_DBG_GPIO_BMUX_6(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_6) & BIT_MASK_DBG_GPIO_BMUX_6) -+#define BIT_SET_DBG_GPIO_BMUX_6(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_6(x) | BIT_DBG_GPIO_BMUX_6(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR_7 (Offset 0x10C8) */ -+ -+#define BIT_TXDMAOK_CHANNEL_16_MSK BIT(16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DBG_GPIO_BMUX (Offset 0x10C8) */ -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_5 15 -+#define BIT_MASK_DBG_GPIO_BMUX_5 0x7 -+#define BIT_DBG_GPIO_BMUX_5(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_5) << BIT_SHIFT_DBG_GPIO_BMUX_5) -+#define BITS_DBG_GPIO_BMUX_5 \ -+ (BIT_MASK_DBG_GPIO_BMUX_5 << BIT_SHIFT_DBG_GPIO_BMUX_5) -+#define BIT_CLEAR_DBG_GPIO_BMUX_5(x) ((x) & (~BITS_DBG_GPIO_BMUX_5)) -+#define BIT_GET_DBG_GPIO_BMUX_5(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_5) & BIT_MASK_DBG_GPIO_BMUX_5) -+#define BIT_SET_DBG_GPIO_BMUX_5(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_5(x) | BIT_DBG_GPIO_BMUX_5(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR_7 (Offset 0x10C8) */ -+ -+#define BIT_TXDMAOK_CHANNEL_13_MSK BIT(13) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DBG_GPIO_BMUX (Offset 0x10C8) */ -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_4 12 -+#define BIT_MASK_DBG_GPIO_BMUX_4 0x7 -+#define BIT_DBG_GPIO_BMUX_4(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_4) << BIT_SHIFT_DBG_GPIO_BMUX_4) -+#define BITS_DBG_GPIO_BMUX_4 \ -+ (BIT_MASK_DBG_GPIO_BMUX_4 << BIT_SHIFT_DBG_GPIO_BMUX_4) -+#define BIT_CLEAR_DBG_GPIO_BMUX_4(x) ((x) & (~BITS_DBG_GPIO_BMUX_4)) -+#define BIT_GET_DBG_GPIO_BMUX_4(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_4) & BIT_MASK_DBG_GPIO_BMUX_4) -+#define BIT_SET_DBG_GPIO_BMUX_4(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_4(x) | BIT_DBG_GPIO_BMUX_4(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR_7 (Offset 0x10C8) */ -+ -+#define BIT_TXDMAOK_CHANNEL_12_MSK BIT(12) -+#define BIT_TXDMAOK_CHANNEL_11_MSK BIT(11) -+#define BIT_TXDMAOK_CHANNEL_10_MSK BIT(10) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DBG_GPIO_BMUX (Offset 0x10C8) */ -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_3 9 -+#define BIT_MASK_DBG_GPIO_BMUX_3 0x7 -+#define BIT_DBG_GPIO_BMUX_3(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_3) << BIT_SHIFT_DBG_GPIO_BMUX_3) -+#define BITS_DBG_GPIO_BMUX_3 \ -+ (BIT_MASK_DBG_GPIO_BMUX_3 << BIT_SHIFT_DBG_GPIO_BMUX_3) -+#define BIT_CLEAR_DBG_GPIO_BMUX_3(x) ((x) & (~BITS_DBG_GPIO_BMUX_3)) -+#define BIT_GET_DBG_GPIO_BMUX_3(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_3) & BIT_MASK_DBG_GPIO_BMUX_3) -+#define BIT_SET_DBG_GPIO_BMUX_3(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_3(x) | BIT_DBG_GPIO_BMUX_3(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR_7 (Offset 0x10C8) */ -+ -+#define BIT_TXDMAOK_CHANNEL_9_MSK BIT(9) -+#define BIT_TXDMAOK_CHANNEL_8_MSK BIT(8) -+#define BIT_TXDMAOK_CHANNEL_7_MSK BIT(7) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DBG_GPIO_BMUX (Offset 0x10C8) */ -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_2 6 -+#define BIT_MASK_DBG_GPIO_BMUX_2 0x7 -+#define BIT_DBG_GPIO_BMUX_2(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_2) << BIT_SHIFT_DBG_GPIO_BMUX_2) -+#define BITS_DBG_GPIO_BMUX_2 \ -+ (BIT_MASK_DBG_GPIO_BMUX_2 << BIT_SHIFT_DBG_GPIO_BMUX_2) -+#define BIT_CLEAR_DBG_GPIO_BMUX_2(x) ((x) & (~BITS_DBG_GPIO_BMUX_2)) -+#define BIT_GET_DBG_GPIO_BMUX_2(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_2) & BIT_MASK_DBG_GPIO_BMUX_2) -+#define BIT_SET_DBG_GPIO_BMUX_2(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_2(x) | BIT_DBG_GPIO_BMUX_2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIMR_7 (Offset 0x10C8) */ -+ -+#define BIT_TXDMAOK_CHANNEL_6_MSK BIT(6) -+#define BIT_TXDMAOK_CHANNEL_5_MSK BIT(5) -+#define BIT_TXDMAOK_CHANNEL_4_MSK BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DBG_GPIO_BMUX (Offset 0x10C8) */ -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_1 3 -+#define BIT_MASK_DBG_GPIO_BMUX_1 0x7 -+#define BIT_DBG_GPIO_BMUX_1(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_1) << BIT_SHIFT_DBG_GPIO_BMUX_1) -+#define BITS_DBG_GPIO_BMUX_1 \ -+ (BIT_MASK_DBG_GPIO_BMUX_1 << BIT_SHIFT_DBG_GPIO_BMUX_1) -+#define BIT_CLEAR_DBG_GPIO_BMUX_1(x) ((x) & (~BITS_DBG_GPIO_BMUX_1)) -+#define BIT_GET_DBG_GPIO_BMUX_1(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_1) & BIT_MASK_DBG_GPIO_BMUX_1) -+#define BIT_SET_DBG_GPIO_BMUX_1(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_1(x) | BIT_DBG_GPIO_BMUX_1(v)) -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_0 0 -+#define BIT_MASK_DBG_GPIO_BMUX_0 0x7 -+#define BIT_DBG_GPIO_BMUX_0(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_0) << BIT_SHIFT_DBG_GPIO_BMUX_0) -+#define BITS_DBG_GPIO_BMUX_0 \ -+ (BIT_MASK_DBG_GPIO_BMUX_0 << BIT_SHIFT_DBG_GPIO_BMUX_0) -+#define BIT_CLEAR_DBG_GPIO_BMUX_0(x) ((x) & (~BITS_DBG_GPIO_BMUX_0)) -+#define BIT_GET_DBG_GPIO_BMUX_0(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_0) & BIT_MASK_DBG_GPIO_BMUX_0) -+#define BIT_SET_DBG_GPIO_BMUX_0(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_0(x) | BIT_DBG_GPIO_BMUX_0(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HISR_7 (Offset 0x10CC) */ -+ -+#define BIT_DATA_CPU_WDT_INT BIT(31) -+#define BIT_OFLD_TXDMA_ERR BIT(30) -+#define BIT_OFLD_TXDMA_FULL BIT(29) -+#define BIT_OFLD_RXDMA_OVR BIT(28) -+#define BIT_OFLD_RXDMA_ERR BIT(27) -+#define BIT_OFLD_RXDMA_DES_UA BIT(26) -+#define BIT_TXDMAOK_CHANNEL_16 BIT(16) -+#define BIT_TXDMAOK_CHANNEL_13 BIT(13) -+#define BIT_TXDMAOK_CHANNEL_12 BIT(12) -+#define BIT_TXDMAOK_CHANNEL_11 BIT(11) -+#define BIT_TXDMAOK_CHANNEL_10 BIT(10) -+#define BIT_TXDMAOK_CHANNEL_9 BIT(9) -+#define BIT_TXDMAOK_CHANNEL_8 BIT(8) -+#define BIT_TXDMAOK_CHANNEL_7 BIT(7) -+#define BIT_TXDMAOK_CHANNEL_6 BIT(6) -+#define BIT_TXDMAOK_CHANNEL_5 BIT(5) -+#define BIT_TXDMAOK_CHANNEL_4 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FPGA_TAG (Offset 0x10CC) */ -+ -+#define BIT_SHIFT_FPGA_TAG 0 -+#define BIT_MASK_FPGA_TAG 0xffffffffL -+#define BIT_FPGA_TAG(x) (((x) & BIT_MASK_FPGA_TAG) << BIT_SHIFT_FPGA_TAG) -+#define BITS_FPGA_TAG (BIT_MASK_FPGA_TAG << BIT_SHIFT_FPGA_TAG) -+#define BIT_CLEAR_FPGA_TAG(x) ((x) & (~BITS_FPGA_TAG)) -+#define BIT_GET_FPGA_TAG(x) (((x) >> BIT_SHIFT_FPGA_TAG) & BIT_MASK_FPGA_TAG) -+#define BIT_SET_FPGA_TAG(x, v) (BIT_CLEAR_FPGA_TAG(x) | BIT_FPGA_TAG(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WL_DSS_CTRL0 (Offset 0x10D0) */ -+ -+#define BIT_SHIFT_WL_DSS_DBG0_5_0 26 -+#define BIT_MASK_WL_DSS_DBG0_5_0 0x3f -+#define BIT_WL_DSS_DBG0_5_0(x) \ -+ (((x) & BIT_MASK_WL_DSS_DBG0_5_0) << BIT_SHIFT_WL_DSS_DBG0_5_0) -+#define BITS_WL_DSS_DBG0_5_0 \ -+ (BIT_MASK_WL_DSS_DBG0_5_0 << BIT_SHIFT_WL_DSS_DBG0_5_0) -+#define BIT_CLEAR_WL_DSS_DBG0_5_0(x) ((x) & (~BITS_WL_DSS_DBG0_5_0)) -+#define BIT_GET_WL_DSS_DBG0_5_0(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_DBG0_5_0) & BIT_MASK_WL_DSS_DBG0_5_0) -+#define BIT_SET_WL_DSS_DBG0_5_0(x, v) \ -+ (BIT_CLEAR_WL_DSS_DBG0_5_0(x) | BIT_WL_DSS_DBG0_5_0(v)) -+ -+#define BIT_SHIFT_WL_DSS_DATA_IN_V1 5 -+#define BIT_MASK_WL_DSS_DATA_IN_V1 0xfffff -+#define BIT_WL_DSS_DATA_IN_V1(x) \ -+ (((x) & BIT_MASK_WL_DSS_DATA_IN_V1) << BIT_SHIFT_WL_DSS_DATA_IN_V1) -+#define BITS_WL_DSS_DATA_IN_V1 \ -+ (BIT_MASK_WL_DSS_DATA_IN_V1 << BIT_SHIFT_WL_DSS_DATA_IN_V1) -+#define BIT_CLEAR_WL_DSS_DATA_IN_V1(x) ((x) & (~BITS_WL_DSS_DATA_IN_V1)) -+#define BIT_GET_WL_DSS_DATA_IN_V1(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_DATA_IN_V1) & BIT_MASK_WL_DSS_DATA_IN_V1) -+#define BIT_SET_WL_DSS_DATA_IN_V1(x, v) \ -+ (BIT_CLEAR_WL_DSS_DATA_IN_V1(x) | BIT_WL_DSS_DATA_IN_V1(v)) -+ -+#define BIT_WL_DSS_WIRE_SEL_V1 BIT(4) -+ -+#define BIT_SHIFT_WL_DSS_RO_SEL_V1 1 -+#define BIT_MASK_WL_DSS_RO_SEL_V1 0x7 -+#define BIT_WL_DSS_RO_SEL_V1(x) \ -+ (((x) & BIT_MASK_WL_DSS_RO_SEL_V1) << BIT_SHIFT_WL_DSS_RO_SEL_V1) -+#define BITS_WL_DSS_RO_SEL_V1 \ -+ (BIT_MASK_WL_DSS_RO_SEL_V1 << BIT_SHIFT_WL_DSS_RO_SEL_V1) -+#define BIT_CLEAR_WL_DSS_RO_SEL_V1(x) ((x) & (~BITS_WL_DSS_RO_SEL_V1)) -+#define BIT_GET_WL_DSS_RO_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_RO_SEL_V1) & BIT_MASK_WL_DSS_RO_SEL_V1) -+#define BIT_SET_WL_DSS_RO_SEL_V1(x, v) \ -+ (BIT_CLEAR_WL_DSS_RO_SEL_V1(x) | BIT_WL_DSS_RO_SEL_V1(v)) -+ -+#define BIT_WL_DSS_RSTN_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2C_PKT_READADDR (Offset 0x10D0) */ -+ -+#define BIT_SHIFT_H2C_PKT_READADDR 0 -+#define BIT_MASK_H2C_PKT_READADDR 0x3ffff -+#define BIT_H2C_PKT_READADDR(x) \ -+ (((x) & BIT_MASK_H2C_PKT_READADDR) << BIT_SHIFT_H2C_PKT_READADDR) -+#define BITS_H2C_PKT_READADDR \ -+ (BIT_MASK_H2C_PKT_READADDR << BIT_SHIFT_H2C_PKT_READADDR) -+#define BIT_CLEAR_H2C_PKT_READADDR(x) ((x) & (~BITS_H2C_PKT_READADDR)) -+#define BIT_GET_H2C_PKT_READADDR(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_READADDR) & BIT_MASK_H2C_PKT_READADDR) -+#define BIT_SET_H2C_PKT_READADDR(x, v) \ -+ (BIT_CLEAR_H2C_PKT_READADDR(x) | BIT_H2C_PKT_READADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WL_DSS_STATUS0 (Offset 0x10D4) */ -+ -+#define BIT_SHIFT_WL_DSS_DBG0_15_6 22 -+#define BIT_MASK_WL_DSS_DBG0_15_6 0x3ff -+#define BIT_WL_DSS_DBG0_15_6(x) \ -+ (((x) & BIT_MASK_WL_DSS_DBG0_15_6) << BIT_SHIFT_WL_DSS_DBG0_15_6) -+#define BITS_WL_DSS_DBG0_15_6 \ -+ (BIT_MASK_WL_DSS_DBG0_15_6 << BIT_SHIFT_WL_DSS_DBG0_15_6) -+#define BIT_CLEAR_WL_DSS_DBG0_15_6(x) ((x) & (~BITS_WL_DSS_DBG0_15_6)) -+#define BIT_GET_WL_DSS_DBG0_15_6(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_DBG0_15_6) & BIT_MASK_WL_DSS_DBG0_15_6) -+#define BIT_SET_WL_DSS_DBG0_15_6(x, v) \ -+ (BIT_CLEAR_WL_DSS_DBG0_15_6(x) | BIT_WL_DSS_DBG0_15_6(v)) -+ -+#define BIT_WL_DSS_WSORT_GO_V1 BIT(21) -+#define BIT_WL_DSS_READY_V1 BIT(20) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2C_PKT_WRITEADDR (Offset 0x10D4) */ -+ -+#define BIT_SHIFT_H2C_PKT_WRITEADDR 0 -+#define BIT_MASK_H2C_PKT_WRITEADDR 0x3ffff -+#define BIT_H2C_PKT_WRITEADDR(x) \ -+ (((x) & BIT_MASK_H2C_PKT_WRITEADDR) << BIT_SHIFT_H2C_PKT_WRITEADDR) -+#define BITS_H2C_PKT_WRITEADDR \ -+ (BIT_MASK_H2C_PKT_WRITEADDR << BIT_SHIFT_H2C_PKT_WRITEADDR) -+#define BIT_CLEAR_H2C_PKT_WRITEADDR(x) ((x) & (~BITS_H2C_PKT_WRITEADDR)) -+#define BIT_GET_H2C_PKT_WRITEADDR(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_WRITEADDR) & BIT_MASK_H2C_PKT_WRITEADDR) -+#define BIT_SET_H2C_PKT_WRITEADDR(x, v) \ -+ (BIT_CLEAR_H2C_PKT_WRITEADDR(x) | BIT_H2C_PKT_WRITEADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WL_DSS_CTRL1 (Offset 0x10D8) */ -+ -+#define BIT_SHIFT_WL_DSS_DBG1_5_0 26 -+#define BIT_MASK_WL_DSS_DBG1_5_0 0x3f -+#define BIT_WL_DSS_DBG1_5_0(x) \ -+ (((x) & BIT_MASK_WL_DSS_DBG1_5_0) << BIT_SHIFT_WL_DSS_DBG1_5_0) -+#define BITS_WL_DSS_DBG1_5_0 \ -+ (BIT_MASK_WL_DSS_DBG1_5_0 << BIT_SHIFT_WL_DSS_DBG1_5_0) -+#define BIT_CLEAR_WL_DSS_DBG1_5_0(x) ((x) & (~BITS_WL_DSS_DBG1_5_0)) -+#define BIT_GET_WL_DSS_DBG1_5_0(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_DBG1_5_0) & BIT_MASK_WL_DSS_DBG1_5_0) -+#define BIT_SET_WL_DSS_DBG1_5_0(x, v) \ -+ (BIT_CLEAR_WL_DSS_DBG1_5_0(x) | BIT_WL_DSS_DBG1_5_0(v)) -+ -+#define BIT_WL_DSS_SPEED_EN1 BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_WL_DSS_CTRL1 (Offset 0x10D8) */ -+ -+#define BIT_WL_DSS_WIRE_SEL BIT(24) -+ -+#define BIT_SHIFT_WL_DSS_RO_SEL 20 -+#define BIT_MASK_WL_DSS_RO_SEL 0x7 -+#define BIT_WL_DSS_RO_SEL(x) \ -+ (((x) & BIT_MASK_WL_DSS_RO_SEL) << BIT_SHIFT_WL_DSS_RO_SEL) -+#define BITS_WL_DSS_RO_SEL (BIT_MASK_WL_DSS_RO_SEL << BIT_SHIFT_WL_DSS_RO_SEL) -+#define BIT_CLEAR_WL_DSS_RO_SEL(x) ((x) & (~BITS_WL_DSS_RO_SEL)) -+#define BIT_GET_WL_DSS_RO_SEL(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_RO_SEL) & BIT_MASK_WL_DSS_RO_SEL) -+#define BIT_SET_WL_DSS_RO_SEL(x, v) \ -+ (BIT_CLEAR_WL_DSS_RO_SEL(x) | BIT_WL_DSS_RO_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MEM_PWR_CRTL (Offset 0x10D8) */ -+ -+#define BIT_MEM_BB_SD BIT(17) -+#define BIT_MEM_BB_DS BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MEM_PWR_CRTL (Offset 0x10D8) */ -+ -+#define BIT_MEM_DENG_LS BIT(13) -+#define BIT_MEM_DENG_DS BIT(12) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MEM_PWR_CRTL (Offset 0x10D8) */ -+ -+#define BIT_MEM_BT_DS BIT(10) -+#define BIT_MEM_SDIO_LS BIT(9) -+#define BIT_MEM_SDIO_DS BIT(8) -+#define BIT_MEM_USB_LS BIT(7) -+#define BIT_MEM_USB_DS BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WL_DSS_CTRL1 (Offset 0x10D8) */ -+ -+#define BIT_SHIFT_WL_DSS_DATA_IN1 5 -+#define BIT_MASK_WL_DSS_DATA_IN1 0xfffff -+#define BIT_WL_DSS_DATA_IN1(x) \ -+ (((x) & BIT_MASK_WL_DSS_DATA_IN1) << BIT_SHIFT_WL_DSS_DATA_IN1) -+#define BITS_WL_DSS_DATA_IN1 \ -+ (BIT_MASK_WL_DSS_DATA_IN1 << BIT_SHIFT_WL_DSS_DATA_IN1) -+#define BIT_CLEAR_WL_DSS_DATA_IN1(x) ((x) & (~BITS_WL_DSS_DATA_IN1)) -+#define BIT_GET_WL_DSS_DATA_IN1(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_DATA_IN1) & BIT_MASK_WL_DSS_DATA_IN1) -+#define BIT_SET_WL_DSS_DATA_IN1(x, v) \ -+ (BIT_CLEAR_WL_DSS_DATA_IN1(x) | BIT_WL_DSS_DATA_IN1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MEM_PWR_CRTL (Offset 0x10D8) */ -+ -+#define BIT_MEM_PCI_LS BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WL_DSS_CTRL1 (Offset 0x10D8) */ -+ -+#define BIT_WL_DSS_WIRE_SEL1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MEM_PWR_CRTL (Offset 0x10D8) */ -+ -+#define BIT_MEM_PCI_DS BIT(4) -+#define BIT_MEM_WLMAC_LS BIT(3) -+#define BIT_MEM_WLMAC_DS BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WL_DSS_CTRL1 (Offset 0x10D8) */ -+ -+#define BIT_SHIFT_WL_DSS_RO_SEL1 1 -+#define BIT_MASK_WL_DSS_RO_SEL1 0x7 -+#define BIT_WL_DSS_RO_SEL1(x) \ -+ (((x) & BIT_MASK_WL_DSS_RO_SEL1) << BIT_SHIFT_WL_DSS_RO_SEL1) -+#define BITS_WL_DSS_RO_SEL1 \ -+ (BIT_MASK_WL_DSS_RO_SEL1 << BIT_SHIFT_WL_DSS_RO_SEL1) -+#define BIT_CLEAR_WL_DSS_RO_SEL1(x) ((x) & (~BITS_WL_DSS_RO_SEL1)) -+#define BIT_GET_WL_DSS_RO_SEL1(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_RO_SEL1) & BIT_MASK_WL_DSS_RO_SEL1) -+#define BIT_SET_WL_DSS_RO_SEL1(x, v) \ -+ (BIT_CLEAR_WL_DSS_RO_SEL1(x) | BIT_WL_DSS_RO_SEL1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MEM_PWR_CRTL (Offset 0x10D8) */ -+ -+#define BIT_MEM_WLMCU_LS BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_WL_DSS_CTRL1 (Offset 0x10D8) */ -+ -+#define BIT_SHIFT_WL_DSS_DATA_IN 0 -+#define BIT_MASK_WL_DSS_DATA_IN 0xfffff -+#define BIT_WL_DSS_DATA_IN(x) \ -+ (((x) & BIT_MASK_WL_DSS_DATA_IN) << BIT_SHIFT_WL_DSS_DATA_IN) -+#define BITS_WL_DSS_DATA_IN \ -+ (BIT_MASK_WL_DSS_DATA_IN << BIT_SHIFT_WL_DSS_DATA_IN) -+#define BIT_CLEAR_WL_DSS_DATA_IN(x) ((x) & (~BITS_WL_DSS_DATA_IN)) -+#define BIT_GET_WL_DSS_DATA_IN(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_DATA_IN) & BIT_MASK_WL_DSS_DATA_IN) -+#define BIT_SET_WL_DSS_DATA_IN(x, v) \ -+ (BIT_CLEAR_WL_DSS_DATA_IN(x) | BIT_WL_DSS_DATA_IN(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WL_DSS_CTRL1 (Offset 0x10D8) */ -+ -+#define BIT_WL_DSS_RSTN1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MEM_PWR_CRTL (Offset 0x10D8) */ -+ -+#define BIT_MEM_WLMCU_DS BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WL_DSS_STATUS1 (Offset 0x10DC) */ -+ -+#define BIT_SHIFT_WL_DSS_DBG1_15_6 22 -+#define BIT_MASK_WL_DSS_DBG1_15_6 0x3ff -+#define BIT_WL_DSS_DBG1_15_6(x) \ -+ (((x) & BIT_MASK_WL_DSS_DBG1_15_6) << BIT_SHIFT_WL_DSS_DBG1_15_6) -+#define BITS_WL_DSS_DBG1_15_6 \ -+ (BIT_MASK_WL_DSS_DBG1_15_6 << BIT_SHIFT_WL_DSS_DBG1_15_6) -+#define BIT_CLEAR_WL_DSS_DBG1_15_6(x) ((x) & (~BITS_WL_DSS_DBG1_15_6)) -+#define BIT_GET_WL_DSS_DBG1_15_6(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_DBG1_15_6) & BIT_MASK_WL_DSS_DBG1_15_6) -+#define BIT_SET_WL_DSS_DBG1_15_6(x, v) \ -+ (BIT_CLEAR_WL_DSS_DBG1_15_6(x) | BIT_WL_DSS_DBG1_15_6(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_WL_DSS_STATUS1 (Offset 0x10DC) */ -+ -+#define BIT_WL_DSS_READY BIT(21) -+#define BIT_WL_DSS_WSORT_GO BIT(20) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FW_DRV_HANDSHAKE (Offset 0x10DC) */ -+ -+#define BIT_SHIFT_FW_DRV_HANDSHAKE 0 -+#define BIT_MASK_FW_DRV_HANDSHAKE 0xffffffffL -+#define BIT_FW_DRV_HANDSHAKE(x) \ -+ (((x) & BIT_MASK_FW_DRV_HANDSHAKE) << BIT_SHIFT_FW_DRV_HANDSHAKE) -+#define BITS_FW_DRV_HANDSHAKE \ -+ (BIT_MASK_FW_DRV_HANDSHAKE << BIT_SHIFT_FW_DRV_HANDSHAKE) -+#define BIT_CLEAR_FW_DRV_HANDSHAKE(x) ((x) & (~BITS_FW_DRV_HANDSHAKE)) -+#define BIT_GET_FW_DRV_HANDSHAKE(x) \ -+ (((x) >> BIT_SHIFT_FW_DRV_HANDSHAKE) & BIT_MASK_FW_DRV_HANDSHAKE) -+#define BIT_SET_FW_DRV_HANDSHAKE(x, v) \ -+ (BIT_CLEAR_FW_DRV_HANDSHAKE(x) | BIT_FW_DRV_HANDSHAKE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FW_DBG0 (Offset 0x10E0) */ -+ -+#define BIT_SHIFT_FW_DBG0 0 -+#define BIT_MASK_FW_DBG0 0xffffffffL -+#define BIT_FW_DBG0(x) (((x) & BIT_MASK_FW_DBG0) << BIT_SHIFT_FW_DBG0) -+#define BITS_FW_DBG0 (BIT_MASK_FW_DBG0 << BIT_SHIFT_FW_DBG0) -+#define BIT_CLEAR_FW_DBG0(x) ((x) & (~BITS_FW_DBG0)) -+#define BIT_GET_FW_DBG0(x) (((x) >> BIT_SHIFT_FW_DBG0) & BIT_MASK_FW_DBG0) -+#define BIT_SET_FW_DBG0(x, v) (BIT_CLEAR_FW_DBG0(x) | BIT_FW_DBG0(v)) -+ -+/* 2 REG_FW_DBG1 (Offset 0x10E4) */ -+ -+#define BIT_SHIFT_FW_DBG1 0 -+#define BIT_MASK_FW_DBG1 0xffffffffL -+#define BIT_FW_DBG1(x) (((x) & BIT_MASK_FW_DBG1) << BIT_SHIFT_FW_DBG1) -+#define BITS_FW_DBG1 (BIT_MASK_FW_DBG1 << BIT_SHIFT_FW_DBG1) -+#define BIT_CLEAR_FW_DBG1(x) ((x) & (~BITS_FW_DBG1)) -+#define BIT_GET_FW_DBG1(x) (((x) >> BIT_SHIFT_FW_DBG1) & BIT_MASK_FW_DBG1) -+#define BIT_SET_FW_DBG1(x, v) (BIT_CLEAR_FW_DBG1(x) | BIT_FW_DBG1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_FW_DBG2 (Offset 0x10E8) */ -+ -+#define BIT_SHIFT_FW_DBG2 0 -+#define BIT_MASK_FW_DBG2 0xffffffffL -+#define BIT_FW_DBG2(x) (((x) & BIT_MASK_FW_DBG2) << BIT_SHIFT_FW_DBG2) -+#define BITS_FW_DBG2 (BIT_MASK_FW_DBG2 << BIT_SHIFT_FW_DBG2) -+#define BIT_CLEAR_FW_DBG2(x) ((x) & (~BITS_FW_DBG2)) -+#define BIT_GET_FW_DBG2(x) (((x) >> BIT_SHIFT_FW_DBG2) & BIT_MASK_FW_DBG2) -+#define BIT_SET_FW_DBG2(x, v) (BIT_CLEAR_FW_DBG2(x) | BIT_FW_DBG2(v)) -+ -+/* 2 REG_FW_DBG3 (Offset 0x10EC) */ -+ -+#define BIT_SHIFT_FW_DBG3 0 -+#define BIT_MASK_FW_DBG3 0xffffffffL -+#define BIT_FW_DBG3(x) (((x) & BIT_MASK_FW_DBG3) << BIT_SHIFT_FW_DBG3) -+#define BITS_FW_DBG3 (BIT_MASK_FW_DBG3 << BIT_SHIFT_FW_DBG3) -+#define BIT_CLEAR_FW_DBG3(x) ((x) & (~BITS_FW_DBG3)) -+#define BIT_GET_FW_DBG3(x) (((x) >> BIT_SHIFT_FW_DBG3) & BIT_MASK_FW_DBG3) -+#define BIT_SET_FW_DBG3(x, v) (BIT_CLEAR_FW_DBG3(x) | BIT_FW_DBG3(v)) -+ -+/* 2 REG_FW_DBG4 (Offset 0x10F0) */ -+ -+#define BIT_SHIFT_FW_DBG4 0 -+#define BIT_MASK_FW_DBG4 0xffffffffL -+#define BIT_FW_DBG4(x) (((x) & BIT_MASK_FW_DBG4) << BIT_SHIFT_FW_DBG4) -+#define BITS_FW_DBG4 (BIT_MASK_FW_DBG4 << BIT_SHIFT_FW_DBG4) -+#define BIT_CLEAR_FW_DBG4(x) ((x) & (~BITS_FW_DBG4)) -+#define BIT_GET_FW_DBG4(x) (((x) >> BIT_SHIFT_FW_DBG4) & BIT_MASK_FW_DBG4) -+#define BIT_SET_FW_DBG4(x, v) (BIT_CLEAR_FW_DBG4(x) | BIT_FW_DBG4(v)) -+ -+/* 2 REG_FW_DBG5 (Offset 0x10F4) */ -+ -+#define BIT_SHIFT_FW_DBG5 0 -+#define BIT_MASK_FW_DBG5 0xffffffffL -+#define BIT_FW_DBG5(x) (((x) & BIT_MASK_FW_DBG5) << BIT_SHIFT_FW_DBG5) -+#define BITS_FW_DBG5 (BIT_MASK_FW_DBG5 << BIT_SHIFT_FW_DBG5) -+#define BIT_CLEAR_FW_DBG5(x) ((x) & (~BITS_FW_DBG5)) -+#define BIT_GET_FW_DBG5(x) (((x) >> BIT_SHIFT_FW_DBG5) & BIT_MASK_FW_DBG5) -+#define BIT_SET_FW_DBG5(x, v) (BIT_CLEAR_FW_DBG5(x) | BIT_FW_DBG5(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FW_DBG6 (Offset 0x10F8) */ -+ -+#define BIT_SHIFT_FW_DBG6 0 -+#define BIT_MASK_FW_DBG6 0xffffffffL -+#define BIT_FW_DBG6(x) (((x) & BIT_MASK_FW_DBG6) << BIT_SHIFT_FW_DBG6) -+#define BITS_FW_DBG6 (BIT_MASK_FW_DBG6 << BIT_SHIFT_FW_DBG6) -+#define BIT_CLEAR_FW_DBG6(x) ((x) & (~BITS_FW_DBG6)) -+#define BIT_GET_FW_DBG6(x) (((x) >> BIT_SHIFT_FW_DBG6) & BIT_MASK_FW_DBG6) -+#define BIT_SET_FW_DBG6(x, v) (BIT_CLEAR_FW_DBG6(x) | BIT_FW_DBG6(v)) -+ -+/* 2 REG_FW_DBG7 (Offset 0x10FC) */ -+ -+#define BIT_SHIFT_FW_DBG7 0 -+#define BIT_MASK_FW_DBG7 0xffffffffL -+#define BIT_FW_DBG7(x) (((x) & BIT_MASK_FW_DBG7) << BIT_SHIFT_FW_DBG7) -+#define BITS_FW_DBG7 (BIT_MASK_FW_DBG7 << BIT_SHIFT_FW_DBG7) -+#define BIT_CLEAR_FW_DBG7(x) ((x) & (~BITS_FW_DBG7)) -+#define BIT_GET_FW_DBG7(x) (((x) >> BIT_SHIFT_FW_DBG7) & BIT_MASK_FW_DBG7) -+#define BIT_SET_FW_DBG7(x, v) (BIT_CLEAR_FW_DBG7(x) | BIT_FW_DBG7(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CR_EXT (Offset 0x1100) */ -+ -+#define BIT_SHIFT_PHY_REQ_DELAY 24 -+#define BIT_MASK_PHY_REQ_DELAY 0xf -+#define BIT_PHY_REQ_DELAY(x) \ -+ (((x) & BIT_MASK_PHY_REQ_DELAY) << BIT_SHIFT_PHY_REQ_DELAY) -+#define BITS_PHY_REQ_DELAY (BIT_MASK_PHY_REQ_DELAY << BIT_SHIFT_PHY_REQ_DELAY) -+#define BIT_CLEAR_PHY_REQ_DELAY(x) ((x) & (~BITS_PHY_REQ_DELAY)) -+#define BIT_GET_PHY_REQ_DELAY(x) \ -+ (((x) >> BIT_SHIFT_PHY_REQ_DELAY) & BIT_MASK_PHY_REQ_DELAY) -+#define BIT_SET_PHY_REQ_DELAY(x, v) \ -+ (BIT_CLEAR_PHY_REQ_DELAY(x) | BIT_PHY_REQ_DELAY(v)) -+ -+#define BIT_SPD_DOWN BIT(16) -+ -+#define BIT_SHIFT_NETYPE4 4 -+#define BIT_MASK_NETYPE4 0x3 -+#define BIT_NETYPE4(x) (((x) & BIT_MASK_NETYPE4) << BIT_SHIFT_NETYPE4) -+#define BITS_NETYPE4 (BIT_MASK_NETYPE4 << BIT_SHIFT_NETYPE4) -+#define BIT_CLEAR_NETYPE4(x) ((x) & (~BITS_NETYPE4)) -+#define BIT_GET_NETYPE4(x) (((x) >> BIT_SHIFT_NETYPE4) & BIT_MASK_NETYPE4) -+#define BIT_SET_NETYPE4(x, v) (BIT_CLEAR_NETYPE4(x) | BIT_NETYPE4(v)) -+ -+#define BIT_SHIFT_NETYPE3 2 -+#define BIT_MASK_NETYPE3 0x3 -+#define BIT_NETYPE3(x) (((x) & BIT_MASK_NETYPE3) << BIT_SHIFT_NETYPE3) -+#define BITS_NETYPE3 (BIT_MASK_NETYPE3 << BIT_SHIFT_NETYPE3) -+#define BIT_CLEAR_NETYPE3(x) ((x) & (~BITS_NETYPE3)) -+#define BIT_GET_NETYPE3(x) (((x) >> BIT_SHIFT_NETYPE3) & BIT_MASK_NETYPE3) -+#define BIT_SET_NETYPE3(x, v) (BIT_CLEAR_NETYPE3(x) | BIT_NETYPE3(v)) -+ -+#define BIT_SHIFT_NETYPE2 0 -+#define BIT_MASK_NETYPE2 0x3 -+#define BIT_NETYPE2(x) (((x) & BIT_MASK_NETYPE2) << BIT_SHIFT_NETYPE2) -+#define BITS_NETYPE2 (BIT_MASK_NETYPE2 << BIT_SHIFT_NETYPE2) -+#define BIT_CLEAR_NETYPE2(x) ((x) & (~BITS_NETYPE2)) -+#define BIT_GET_NETYPE2(x) (((x) >> BIT_SHIFT_NETYPE2) & BIT_MASK_NETYPE2) -+#define BIT_SET_NETYPE2(x, v) (BIT_CLEAR_NETYPE2(x) | BIT_NETYPE2(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TC9_CTRL (Offset 0x1104) */ -+ -+#define BIT_TC9INT_EN BIT(26) -+#define BIT_TC9MODE BIT(25) -+#define BIT_TC9EN BIT(24) -+ -+#define BIT_SHIFT_TC9DATA 0 -+#define BIT_MASK_TC9DATA 0xffffff -+#define BIT_TC9DATA(x) (((x) & BIT_MASK_TC9DATA) << BIT_SHIFT_TC9DATA) -+#define BITS_TC9DATA (BIT_MASK_TC9DATA << BIT_SHIFT_TC9DATA) -+#define BIT_CLEAR_TC9DATA(x) ((x) & (~BITS_TC9DATA)) -+#define BIT_GET_TC9DATA(x) (((x) >> BIT_SHIFT_TC9DATA) & BIT_MASK_TC9DATA) -+#define BIT_SET_TC9DATA(x, v) (BIT_CLEAR_TC9DATA(x) | BIT_TC9DATA(v)) -+ -+/* 2 REG_TC10_CTRL (Offset 0x1108) */ -+ -+#define BIT_TC10INT_EN BIT(26) -+#define BIT_TC10MODE BIT(25) -+#define BIT_TC10EN BIT(24) -+ -+#define BIT_SHIFT_TC10DATA 0 -+#define BIT_MASK_TC10DATA 0xffffff -+#define BIT_TC10DATA(x) (((x) & BIT_MASK_TC10DATA) << BIT_SHIFT_TC10DATA) -+#define BITS_TC10DATA (BIT_MASK_TC10DATA << BIT_SHIFT_TC10DATA) -+#define BIT_CLEAR_TC10DATA(x) ((x) & (~BITS_TC10DATA)) -+#define BIT_GET_TC10DATA(x) (((x) >> BIT_SHIFT_TC10DATA) & BIT_MASK_TC10DATA) -+#define BIT_SET_TC10DATA(x, v) (BIT_CLEAR_TC10DATA(x) | BIT_TC10DATA(v)) -+ -+/* 2 REG_TC11_CTRL (Offset 0x110C) */ -+ -+#define BIT_TC11INT_EN BIT(26) -+#define BIT_TC11MODE BIT(25) -+#define BIT_TC11EN BIT(24) -+ -+#define BIT_SHIFT_TC11DATA 0 -+#define BIT_MASK_TC11DATA 0xffffff -+#define BIT_TC11DATA(x) (((x) & BIT_MASK_TC11DATA) << BIT_SHIFT_TC11DATA) -+#define BITS_TC11DATA (BIT_MASK_TC11DATA << BIT_SHIFT_TC11DATA) -+#define BIT_CLEAR_TC11DATA(x) ((x) & (~BITS_TC11DATA)) -+#define BIT_GET_TC11DATA(x) (((x) >> BIT_SHIFT_TC11DATA) & BIT_MASK_TC11DATA) -+#define BIT_SET_TC11DATA(x, v) (BIT_CLEAR_TC11DATA(x) | BIT_TC11DATA(v)) -+ -+/* 2 REG_TC12_CTRL (Offset 0x1110) */ -+ -+#define BIT_TC12INT_EN BIT(26) -+#define BIT_TC12MODE BIT(25) -+#define BIT_TC12EN BIT(24) -+#define BIT_P2P_PWROFF_NOA2_ERLY_INT BIT(22) -+#define BIT_P2P_PWROFF_NOA1_ERLY_INT BIT(21) -+#define BIT_P2P_PWROFF_NOA0_ERLY_INT BIT(20) -+ -+#define BIT_SHIFT_TC12DATA 0 -+#define BIT_MASK_TC12DATA 0xffffff -+#define BIT_TC12DATA(x) (((x) & BIT_MASK_TC12DATA) << BIT_SHIFT_TC12DATA) -+#define BITS_TC12DATA (BIT_MASK_TC12DATA << BIT_SHIFT_TC12DATA) -+#define BIT_CLEAR_TC12DATA(x) ((x) & (~BITS_TC12DATA)) -+#define BIT_GET_TC12DATA(x) (((x) >> BIT_SHIFT_TC12DATA) & BIT_MASK_TC12DATA) -+#define BIT_SET_TC12DATA(x, v) (BIT_CLEAR_TC12DATA(x) | BIT_TC12DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FWFF (Offset 0x1114) */ -+ -+#define BIT_SHIFT_PKTNUM_TH 24 -+#define BIT_MASK_PKTNUM_TH 0xff -+#define BIT_PKTNUM_TH(x) (((x) & BIT_MASK_PKTNUM_TH) << BIT_SHIFT_PKTNUM_TH) -+#define BITS_PKTNUM_TH (BIT_MASK_PKTNUM_TH << BIT_SHIFT_PKTNUM_TH) -+#define BIT_CLEAR_PKTNUM_TH(x) ((x) & (~BITS_PKTNUM_TH)) -+#define BIT_GET_PKTNUM_TH(x) (((x) >> BIT_SHIFT_PKTNUM_TH) & BIT_MASK_PKTNUM_TH) -+#define BIT_SET_PKTNUM_TH(x, v) (BIT_CLEAR_PKTNUM_TH(x) | BIT_PKTNUM_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWFF (Offset 0x1114) */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V1 24 -+#define BIT_MASK_PKTNUM_TH_V1 0xff -+#define BIT_PKTNUM_TH_V1(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V1) << BIT_SHIFT_PKTNUM_TH_V1) -+#define BITS_PKTNUM_TH_V1 (BIT_MASK_PKTNUM_TH_V1 << BIT_SHIFT_PKTNUM_TH_V1) -+#define BIT_CLEAR_PKTNUM_TH_V1(x) ((x) & (~BITS_PKTNUM_TH_V1)) -+#define BIT_GET_PKTNUM_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V1) & BIT_MASK_PKTNUM_TH_V1) -+#define BIT_SET_PKTNUM_TH_V1(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V1(x) | BIT_PKTNUM_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FWFF (Offset 0x1114) */ -+ -+#define BIT_SHIFT_TIMER_TH 16 -+#define BIT_MASK_TIMER_TH 0xff -+#define BIT_TIMER_TH(x) (((x) & BIT_MASK_TIMER_TH) << BIT_SHIFT_TIMER_TH) -+#define BITS_TIMER_TH (BIT_MASK_TIMER_TH << BIT_SHIFT_TIMER_TH) -+#define BIT_CLEAR_TIMER_TH(x) ((x) & (~BITS_TIMER_TH)) -+#define BIT_GET_TIMER_TH(x) (((x) >> BIT_SHIFT_TIMER_TH) & BIT_MASK_TIMER_TH) -+#define BIT_SET_TIMER_TH(x, v) (BIT_CLEAR_TIMER_TH(x) | BIT_TIMER_TH(v)) -+ -+#define BIT_SHIFT_RXPKT1ENADDR 0 -+#define BIT_MASK_RXPKT1ENADDR 0xffff -+#define BIT_RXPKT1ENADDR(x) \ -+ (((x) & BIT_MASK_RXPKT1ENADDR) << BIT_SHIFT_RXPKT1ENADDR) -+#define BITS_RXPKT1ENADDR (BIT_MASK_RXPKT1ENADDR << BIT_SHIFT_RXPKT1ENADDR) -+#define BIT_CLEAR_RXPKT1ENADDR(x) ((x) & (~BITS_RXPKT1ENADDR)) -+#define BIT_GET_RXPKT1ENADDR(x) \ -+ (((x) >> BIT_SHIFT_RXPKT1ENADDR) & BIT_MASK_RXPKT1ENADDR) -+#define BIT_SET_RXPKT1ENADDR(x, v) \ -+ (BIT_CLEAR_RXPKT1ENADDR(x) | BIT_RXPKT1ENADDR(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE2IMR (Offset 0x1120) */ -+ -+#define BIT__FE4ISR__IND_MSK BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE2IMR (Offset 0x1120) */ -+ -+#define BIT_FS_TXSC_DESC_DONE_INT_EN BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_EN BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_EN BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_EN BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE2IMR (Offset 0x1120) */ -+ -+#define BIT_FS_ATIM_MB7_INT_EN BIT(23) -+#define BIT_FS_ATIM_MB6_INT_EN BIT(22) -+#define BIT_FS_ATIM_MB5_INT_EN BIT(21) -+#define BIT_FS_ATIM_MB4_INT_EN BIT(20) -+#define BIT_FS_ATIM_MB3_INT_EN BIT(19) -+#define BIT_FS_ATIM_MB2_INT_EN BIT(18) -+#define BIT_FS_ATIM_MB1_INT_EN BIT(17) -+#define BIT_FS_ATIM_MB0_INT_EN BIT(16) -+#define BIT_FS_TBTT4INT_EN BIT(11) -+#define BIT_FS_TBTT3INT_EN BIT(10) -+#define BIT_FS_TBTT2INT_EN BIT(9) -+#define BIT_FS_TBTT1INT_EN BIT(8) -+#define BIT_FS_TBTT0_MB7INT_EN BIT(7) -+#define BIT_FS_TBTT0_MB6INT_EN BIT(6) -+#define BIT_FS_TBTT0_MB5INT_EN BIT(5) -+#define BIT_FS_TBTT0_MB4INT_EN BIT(4) -+#define BIT_FS_TBTT0_MB3INT_EN BIT(3) -+#define BIT_FS_TBTT0_MB2INT_EN BIT(2) -+#define BIT_FS_TBTT0_MB1INT_EN BIT(1) -+#define BIT_FS_TBTT0_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE2ISR (Offset 0x1124) */ -+ -+#define BIT__FE4ISR__IND_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE2ISR (Offset 0x1124) */ -+ -+#define BIT_FS_TXSC_DESC_DONE_INT BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT BIT(25) -+#define BIT_FS_TXSC_VODONE_INT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE2ISR (Offset 0x1124) */ -+ -+#define BIT_FS_ATIM_MB7_INT BIT(23) -+#define BIT_FS_ATIM_MB6_INT BIT(22) -+#define BIT_FS_ATIM_MB5_INT BIT(21) -+#define BIT_FS_ATIM_MB4_INT BIT(20) -+#define BIT_FS_ATIM_MB3_INT BIT(19) -+#define BIT_FS_ATIM_MB2_INT BIT(18) -+#define BIT_FS_ATIM_MB1_INT BIT(17) -+#define BIT_FS_ATIM_MB0_INT BIT(16) -+#define BIT_FS_TBTT4INT BIT(11) -+#define BIT_FS_TBTT3INT BIT(10) -+#define BIT_FS_TBTT2INT BIT(9) -+#define BIT_FS_TBTT1INT BIT(8) -+#define BIT_FS_TBTT0_MB7INT BIT(7) -+#define BIT_FS_TBTT0_MB6INT BIT(6) -+#define BIT_FS_TBTT0_MB5INT BIT(5) -+#define BIT_FS_TBTT0_MB4INT BIT(4) -+#define BIT_FS_TBTT0_MB3INT BIT(3) -+#define BIT_FS_TBTT0_MB2INT BIT(2) -+#define BIT_FS_TBTT0_MB1INT BIT(1) -+#define BIT_FS_TBTT0_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE3IMR (Offset 0x1128) */ -+ -+#define BIT_FS_BCNELY4_AGGR_INT_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE3IMR (Offset 0x1128) */ -+ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT__EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE3IMR (Offset 0x1128) */ -+ -+#define BIT_FS_BCNELY3_AGGR_INT_EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE3IMR (Offset 0x1128) */ -+ -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT__EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE3IMR (Offset 0x1128) */ -+ -+#define BIT_FS_BCNELY2_AGGR_INT_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE3IMR (Offset 0x1128) */ -+ -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT__EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE3IMR (Offset 0x1128) */ -+ -+#define BIT_FS_BCNELY1_AGGR_INT_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE3IMR (Offset 0x1128) */ -+ -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT__EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE3IMR (Offset 0x1128) */ -+ -+#define BIT_FS_BCNDMA4_INT_EN BIT(27) -+#define BIT_FS_BCNDMA3_INT_EN BIT(26) -+#define BIT_FS_BCNDMA2_INT_EN BIT(25) -+#define BIT_FS_BCNDMA1_INT_EN BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_EN BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_EN BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_EN BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_EN BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_EN BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_EN BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_EN BIT(17) -+#define BIT_FS_BCNDMA0_INT_EN BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT__EN BIT(15) -+#define BIT_FS_BCNERLY4_INT_EN BIT(11) -+#define BIT_FS_BCNERLY3_INT_EN BIT(10) -+#define BIT_FS_BCNERLY2_INT_EN BIT(9) -+#define BIT_FS_BCNERLY1_INT_EN BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_EN BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_EN BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_EN BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_EN BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_EN BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_EN BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_EN BIT(1) -+#define BIT_FS_BCNERLY0_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE3ISR (Offset 0x112C) */ -+ -+#define BIT_FS_BCNELY4_AGGR_INT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE3ISR (Offset 0x112C) */ -+ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE3ISR (Offset 0x112C) */ -+ -+#define BIT_FS_BCNELY3_AGGR_INT BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE3ISR (Offset 0x112C) */ -+ -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE3ISR (Offset 0x112C) */ -+ -+#define BIT_FS_BCNELY2_AGGR_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE3ISR (Offset 0x112C) */ -+ -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE3ISR (Offset 0x112C) */ -+ -+#define BIT_FS_BCNELY1_AGGR_INT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE3ISR (Offset 0x112C) */ -+ -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE3ISR (Offset 0x112C) */ -+ -+#define BIT_FS_BCNDMA4_INT BIT(27) -+#define BIT_FS_BCNDMA3_INT BIT(26) -+#define BIT_FS_BCNDMA2_INT BIT(25) -+#define BIT_FS_BCNDMA1_INT BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT BIT(17) -+#define BIT_FS_BCNDMA0_INT BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT BIT(15) -+#define BIT_FS_BCNERLY4_INT BIT(11) -+#define BIT_FS_BCNERLY3_INT BIT(10) -+#define BIT_FS_BCNERLY2_INT BIT(9) -+#define BIT_FS_BCNERLY1_INT BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT BIT(1) -+#define BIT_FS_BCNERLY0_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT4_PKTIN_INT_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI3_TXPKTIN_INT_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT3_PKTIN_INT_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI2_TXPKTIN_INT_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT2_PKTIN_INT_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI1_TXPKTIN_INT_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT1_PKTIN_INT_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI0_TXPKTIN_INT_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT4_RXUCMD0_OK_INT_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI3_RX_UMD0_INT_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT4_RXUCMD1_OK_INT_EN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI3_RX_UMD1_INT_EN BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT4_RXBCMD0_OK_INT_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI3_RX_BMD0_INT_EN BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT4_RXBCMD1_OK_INT_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI3_RX_BMD1_INT_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT3_RXUCMD0_OK_INT_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI2_RX_UMD0_INT_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT3_RXUCMD1_OK_INT_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI2_RX_UMD1_INT_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT3_RXBCMD0_OK_INT_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI2_RX_BMD0_INT_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT3_RXBCMD1_OK_INT_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI2_RX_BMD1_INT_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT2_RXUCMD0_OK_INT_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI1_RX_UMD0_INT_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT2_RXUCMD1_OK_INT_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI1_RX_UMD1_INT_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT2_RXBCMD0_OK_INT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI1_RX_BMD0_INT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT2_RXBCMD1_OK_INT_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI1_RX_BMD1_INT_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT1_RXUCMD0_OK_INT_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI0_RX_UMD0_INT_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT1_RXUCMD1_OK_INT_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI0_RX_UMD1_INT_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_DMEM1_WPTR_UPDATE_INT_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT1_RXBCMD0_OK_INT_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI0_RX_BMD0_INT_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_PORT1_RXBCMD1_OK_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4IMR (Offset 0x1130) */ -+ -+#define BIT_FS_CLI0_RX_BMD1_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT4_PKTIN_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI3_TXPKTIN_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT3_PKTIN_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI2_TXPKTIN_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT2_PKTIN_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI1_TXPKTIN_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT1_PKTIN_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI0_TXPKTIN_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT4_RXUCMD0_OK_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI3_RX_UMD0_INT BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT4_RXUCMD1_OK_INT BIT(14) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI3_RX_UMD1_INT BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT4_RXBCMD0_OK_INT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI3_RX_BMD0_INT BIT(13) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT4_RXBCMD1_OK_INT BIT(12) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI3_RX_BMD1_INT BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT3_RXUCMD0_OK_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI2_RX_UMD0_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT3_RXUCMD1_OK_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI2_RX_UMD1_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT3_RXBCMD0_OK_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI2_RX_BMD0_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT3_RXBCMD1_OK_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI2_RX_BMD1_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT2_RXUCMD0_OK_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI1_RX_UMD0_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT2_RXUCMD1_OK_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI1_RX_UMD1_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT2_RXBCMD0_OK_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI1_RX_BMD0_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT2_RXBCMD1_OK_INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI1_RX_BMD1_INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT1_RXUCMD0_OK_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI0_RX_UMD0_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT1_RXUCMD1_OK_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI0_RX_UMD1_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_DMEM1_WPTR_UPDATE_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT1_RXBCMD0_OK_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI0_RX_BMD0_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_PORT1_RXBCMD1_OK_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FE4ISR (Offset 0x1134) */ -+ -+#define BIT_FS_CLI0_RX_BMD1_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1IMR (Offset 0x1138) */ -+ -+#define BIT__FT2ISR__IND_MSK BIT(30) -+#define BIT_FTM_PTT_INT_EN BIT(29) -+#define BIT_RXFTMREQ_INT_EN BIT(28) -+#define BIT_RXFTM_INT_EN BIT(27) -+#define BIT_TXFTM_INT_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1IMR (Offset 0x1138) */ -+ -+#define BIT_FS_H2C_CMD_OK_INT_EN BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1IMR (Offset 0x1138) */ -+ -+#define BIT_FS_MACID_PWRCHANGE5_INT_EN BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1IMR (Offset 0x1138) */ -+ -+#define BIT_FS_MACID_SEARCH_FAIL_INT_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1IMR (Offset 0x1138) */ -+ -+#define BIT_FS_MACID_PWRCHANGE3_INT_EN BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_EN BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_EN BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_EN BIT(18) -+#define BIT_FS_CTWEND2_INT_EN BIT(17) -+#define BIT_FS_CTWEND1_INT_EN BIT(16) -+#define BIT_FS_CTWEND0_INT_EN BIT(15) -+#define BIT_FS_TX_NULL1_INT_EN BIT(14) -+#define BIT_FS_TX_NULL0_INT_EN BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_EN BIT(12) -+#define BIT_FS_P2P_RFON2_INT_EN BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_EN BIT(10) -+#define BIT_FS_P2P_RFON1_INT_EN BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_EN BIT(8) -+#define BIT_FS_P2P_RFON0_INT_EN BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_EN BIT(6) -+#define BIT_FS_RX_UAPSDMD1_EN BIT(5) -+#define BIT_FS_RX_UAPSDMD0_EN BIT(4) -+#define BIT_FS_TRIGGER_PKT_EN BIT(3) -+#define BIT_FS_EOSP_INT_EN BIT(2) -+#define BIT_FS_RPWM2_INT_EN BIT(1) -+#define BIT_FS_RPWM_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT__FT2ISR__IND_INT BIT(30) -+#define BIT_FTM_PTT_INT BIT(29) -+#define BIT_RXFTMREQ_INT BIT(28) -+#define BIT_RXFTM_INT BIT(27) -+#define BIT_TXFTM_INT BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_H2C_CMD_OK_INT BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_MACID_PWRCHANGE5_INT BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT BIT(22) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_MACID_SEARCH_FAIL_INT BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_MACID_PWRCHANGE3_INT BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT BIT(18) -+#define BIT_FS_CTWEND2_INT BIT(17) -+#define BIT_FS_CTWEND1_INT BIT(16) -+#define BIT_FS_CTWEND0_INT BIT(15) -+#define BIT_FS_TX_NULL1_INT BIT(14) -+#define BIT_FS_TX_NULL0_INT BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_INT BIT(12) -+#define BIT_FS_P2P_RFON2_INT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_TXBCNOK_PORT4_INT_EN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_P2P_RFOFF2_INT BIT(10) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_TXBCNOK_PORT3_INT_EN BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_P2P_RFON1_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_TXBCNOK_PORT2_INT_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_P2P_RFOFF1_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_TXBCNOK_PORT1_INT_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_P2P_RFON0_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_TXBCNERR_PORT4_INT_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_P2P_RFOFF0_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_TXBCNERR_PORT3_INT_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_RX_UAPSDMD1_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_TXBCNERR_PORT2_INT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_RX_UAPSDMD0_INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_TXBCNERR_PORT1_INT_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_TRIGGER_PKT_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_ATIM_PORT4_INT_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_EOSP_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_ATIM_PORT3_INT_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_RPWM2_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_ATIM_PORT2_INT_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_RPWM_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FT1ISR (Offset 0x113C) */ -+ -+#define BIT_FS_ATIM_PORT1_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SPWR0 (Offset 0x1140) */ -+ -+#define BIT_SHIFT_MID_31TO0 0 -+#define BIT_MASK_MID_31TO0 0xffffffffL -+#define BIT_MID_31TO0(x) (((x) & BIT_MASK_MID_31TO0) << BIT_SHIFT_MID_31TO0) -+#define BITS_MID_31TO0 (BIT_MASK_MID_31TO0 << BIT_SHIFT_MID_31TO0) -+#define BIT_CLEAR_MID_31TO0(x) ((x) & (~BITS_MID_31TO0)) -+#define BIT_GET_MID_31TO0(x) (((x) >> BIT_SHIFT_MID_31TO0) & BIT_MASK_MID_31TO0) -+#define BIT_SET_MID_31TO0(x, v) (BIT_CLEAR_MID_31TO0(x) | BIT_MID_31TO0(v)) -+ -+/* 2 REG_SPWR1 (Offset 0x1144) */ -+ -+#define BIT_SHIFT_MID_63TO32 0 -+#define BIT_MASK_MID_63TO32 0xffffffffL -+#define BIT_MID_63TO32(x) (((x) & BIT_MASK_MID_63TO32) << BIT_SHIFT_MID_63TO32) -+#define BITS_MID_63TO32 (BIT_MASK_MID_63TO32 << BIT_SHIFT_MID_63TO32) -+#define BIT_CLEAR_MID_63TO32(x) ((x) & (~BITS_MID_63TO32)) -+#define BIT_GET_MID_63TO32(x) \ -+ (((x) >> BIT_SHIFT_MID_63TO32) & BIT_MASK_MID_63TO32) -+#define BIT_SET_MID_63TO32(x, v) (BIT_CLEAR_MID_63TO32(x) | BIT_MID_63TO32(v)) -+ -+/* 2 REG_SPWR2 (Offset 0x1148) */ -+ -+#define BIT_SHIFT_MID_95O64 0 -+#define BIT_MASK_MID_95O64 0xffffffffL -+#define BIT_MID_95O64(x) (((x) & BIT_MASK_MID_95O64) << BIT_SHIFT_MID_95O64) -+#define BITS_MID_95O64 (BIT_MASK_MID_95O64 << BIT_SHIFT_MID_95O64) -+#define BIT_CLEAR_MID_95O64(x) ((x) & (~BITS_MID_95O64)) -+#define BIT_GET_MID_95O64(x) (((x) >> BIT_SHIFT_MID_95O64) & BIT_MASK_MID_95O64) -+#define BIT_SET_MID_95O64(x, v) (BIT_CLEAR_MID_95O64(x) | BIT_MID_95O64(v)) -+ -+/* 2 REG_SPWR3 (Offset 0x114C) */ -+ -+#define BIT_SHIFT_MID_127TO96 0 -+#define BIT_MASK_MID_127TO96 0xffffffffL -+#define BIT_MID_127TO96(x) \ -+ (((x) & BIT_MASK_MID_127TO96) << BIT_SHIFT_MID_127TO96) -+#define BITS_MID_127TO96 (BIT_MASK_MID_127TO96 << BIT_SHIFT_MID_127TO96) -+#define BIT_CLEAR_MID_127TO96(x) ((x) & (~BITS_MID_127TO96)) -+#define BIT_GET_MID_127TO96(x) \ -+ (((x) >> BIT_SHIFT_MID_127TO96) & BIT_MASK_MID_127TO96) -+#define BIT_SET_MID_127TO96(x, v) \ -+ (BIT_CLEAR_MID_127TO96(x) | BIT_MID_127TO96(v)) -+ -+/* 2 REG_POWSEQ (Offset 0x1150) */ -+ -+#define BIT_SHIFT_REF_MID 0 -+#define BIT_MASK_REF_MID 0x7f -+#define BIT_REF_MID(x) (((x) & BIT_MASK_REF_MID) << BIT_SHIFT_REF_MID) -+#define BITS_REF_MID (BIT_MASK_REF_MID << BIT_SHIFT_REF_MID) -+#define BIT_CLEAR_REF_MID(x) ((x) & (~BITS_REF_MID)) -+#define BIT_GET_REF_MID(x) (((x) >> BIT_SHIFT_REF_MID) & BIT_MASK_REF_MID) -+#define BIT_SET_REF_MID(x, v) (BIT_CLEAR_REF_MID(x) | BIT_REF_MID(v)) -+ -+/* 2 REG_TC7_CTRL_V1 (Offset 0x1158) */ -+ -+#define BIT_TC7INT_EN BIT(26) -+#define BIT_TC7MODE BIT(25) -+#define BIT_TC7EN BIT(24) -+ -+#define BIT_SHIFT_TC7DATA 0 -+#define BIT_MASK_TC7DATA 0xffffff -+#define BIT_TC7DATA(x) (((x) & BIT_MASK_TC7DATA) << BIT_SHIFT_TC7DATA) -+#define BITS_TC7DATA (BIT_MASK_TC7DATA << BIT_SHIFT_TC7DATA) -+#define BIT_CLEAR_TC7DATA(x) ((x) & (~BITS_TC7DATA)) -+#define BIT_GET_TC7DATA(x) (((x) >> BIT_SHIFT_TC7DATA) & BIT_MASK_TC7DATA) -+#define BIT_SET_TC7DATA(x, v) (BIT_CLEAR_TC7DATA(x) | BIT_TC7DATA(v)) -+ -+/* 2 REG_TC8_CTRL_V1 (Offset 0x115C) */ -+ -+#define BIT_TC8INT_EN BIT(26) -+#define BIT_TC8MODE BIT(25) -+#define BIT_TC8EN BIT(24) -+ -+#define BIT_SHIFT_TC8DATA 0 -+#define BIT_MASK_TC8DATA 0xffffff -+#define BIT_TC8DATA(x) (((x) & BIT_MASK_TC8DATA) << BIT_SHIFT_TC8DATA) -+#define BITS_TC8DATA (BIT_MASK_TC8DATA << BIT_SHIFT_TC8DATA) -+#define BIT_CLEAR_TC8DATA(x) ((x) & (~BITS_TC8DATA)) -+#define BIT_GET_TC8DATA(x) (((x) >> BIT_SHIFT_TC8DATA) & BIT_MASK_TC8DATA) -+#define BIT_SET_TC8DATA(x, v) (BIT_CLEAR_TC8DATA(x) | BIT_TC8DATA(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXBCN_TBTT_INTERVAL_PORT0TO3 (Offset 0x1160) */ -+ -+#define BIT_SHIFT_PORT3_RXBCN_TBTT_INTERVAL 24 -+#define BIT_MASK_PORT3_RXBCN_TBTT_INTERVAL 0xff -+#define BIT_PORT3_RXBCN_TBTT_INTERVAL(x) \ -+ (((x) & BIT_MASK_PORT3_RXBCN_TBTT_INTERVAL) \ -+ << BIT_SHIFT_PORT3_RXBCN_TBTT_INTERVAL) -+#define BITS_PORT3_RXBCN_TBTT_INTERVAL \ -+ (BIT_MASK_PORT3_RXBCN_TBTT_INTERVAL \ -+ << BIT_SHIFT_PORT3_RXBCN_TBTT_INTERVAL) -+#define BIT_CLEAR_PORT3_RXBCN_TBTT_INTERVAL(x) \ -+ ((x) & (~BITS_PORT3_RXBCN_TBTT_INTERVAL)) -+#define BIT_GET_PORT3_RXBCN_TBTT_INTERVAL(x) \ -+ (((x) >> BIT_SHIFT_PORT3_RXBCN_TBTT_INTERVAL) & \ -+ BIT_MASK_PORT3_RXBCN_TBTT_INTERVAL) -+#define BIT_SET_PORT3_RXBCN_TBTT_INTERVAL(x, v) \ -+ (BIT_CLEAR_PORT3_RXBCN_TBTT_INTERVAL(x) | \ -+ BIT_PORT3_RXBCN_TBTT_INTERVAL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL0 (Offset 0x1160) */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2 24 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT2(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT2 \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2 \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT2(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT2)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT2(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT2(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT2(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXBCN_TBTT_INTERVAL_PORT0TO3 (Offset 0x1160) */ -+ -+#define BIT_SHIFT_PORT2_RXBCN_TBTT_INTERVAL 16 -+#define BIT_MASK_PORT2_RXBCN_TBTT_INTERVAL 0xff -+#define BIT_PORT2_RXBCN_TBTT_INTERVAL(x) \ -+ (((x) & BIT_MASK_PORT2_RXBCN_TBTT_INTERVAL) \ -+ << BIT_SHIFT_PORT2_RXBCN_TBTT_INTERVAL) -+#define BITS_PORT2_RXBCN_TBTT_INTERVAL \ -+ (BIT_MASK_PORT2_RXBCN_TBTT_INTERVAL \ -+ << BIT_SHIFT_PORT2_RXBCN_TBTT_INTERVAL) -+#define BIT_CLEAR_PORT2_RXBCN_TBTT_INTERVAL(x) \ -+ ((x) & (~BITS_PORT2_RXBCN_TBTT_INTERVAL)) -+#define BIT_GET_PORT2_RXBCN_TBTT_INTERVAL(x) \ -+ (((x) >> BIT_SHIFT_PORT2_RXBCN_TBTT_INTERVAL) & \ -+ BIT_MASK_PORT2_RXBCN_TBTT_INTERVAL) -+#define BIT_SET_PORT2_RXBCN_TBTT_INTERVAL(x, v) \ -+ (BIT_CLEAR_PORT2_RXBCN_TBTT_INTERVAL(x) | \ -+ BIT_PORT2_RXBCN_TBTT_INTERVAL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL0 (Offset 0x1160) */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1 16 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT1(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT1 \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1 \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT1(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT1)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT1(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT1(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT1(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXBCN_TBTT_INTERVAL_PORT0TO3 (Offset 0x1160) */ -+ -+#define BIT_SHIFT_PORT1_RXBCN_TBTT_INTERVAL 8 -+#define BIT_MASK_PORT1_RXBCN_TBTT_INTERVAL 0xff -+#define BIT_PORT1_RXBCN_TBTT_INTERVAL(x) \ -+ (((x) & BIT_MASK_PORT1_RXBCN_TBTT_INTERVAL) \ -+ << BIT_SHIFT_PORT1_RXBCN_TBTT_INTERVAL) -+#define BITS_PORT1_RXBCN_TBTT_INTERVAL \ -+ (BIT_MASK_PORT1_RXBCN_TBTT_INTERVAL \ -+ << BIT_SHIFT_PORT1_RXBCN_TBTT_INTERVAL) -+#define BIT_CLEAR_PORT1_RXBCN_TBTT_INTERVAL(x) \ -+ ((x) & (~BITS_PORT1_RXBCN_TBTT_INTERVAL)) -+#define BIT_GET_PORT1_RXBCN_TBTT_INTERVAL(x) \ -+ (((x) >> BIT_SHIFT_PORT1_RXBCN_TBTT_INTERVAL) & \ -+ BIT_MASK_PORT1_RXBCN_TBTT_INTERVAL) -+#define BIT_SET_PORT1_RXBCN_TBTT_INTERVAL(x, v) \ -+ (BIT_CLEAR_PORT1_RXBCN_TBTT_INTERVAL(x) | \ -+ BIT_PORT1_RXBCN_TBTT_INTERVAL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL0 (Offset 0x1160) */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0 8 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT0(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT0 \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0 \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT0(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT0)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT0(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT0(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT0(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT0(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXBCN_TBTT_INTERVAL_PORT0TO3 (Offset 0x1160) */ -+ -+#define BIT_SHIFT_PORT0_RXBCN_TBTT_INTERVAL 0 -+#define BIT_MASK_PORT0_RXBCN_TBTT_INTERVAL 0xff -+#define BIT_PORT0_RXBCN_TBTT_INTERVAL(x) \ -+ (((x) & BIT_MASK_PORT0_RXBCN_TBTT_INTERVAL) \ -+ << BIT_SHIFT_PORT0_RXBCN_TBTT_INTERVAL) -+#define BITS_PORT0_RXBCN_TBTT_INTERVAL \ -+ (BIT_MASK_PORT0_RXBCN_TBTT_INTERVAL \ -+ << BIT_SHIFT_PORT0_RXBCN_TBTT_INTERVAL) -+#define BIT_CLEAR_PORT0_RXBCN_TBTT_INTERVAL(x) \ -+ ((x) & (~BITS_PORT0_RXBCN_TBTT_INTERVAL)) -+#define BIT_GET_PORT0_RXBCN_TBTT_INTERVAL(x) \ -+ (((x) >> BIT_SHIFT_PORT0_RXBCN_TBTT_INTERVAL) & \ -+ BIT_MASK_PORT0_RXBCN_TBTT_INTERVAL) -+#define BIT_SET_PORT0_RXBCN_TBTT_INTERVAL(x, v) \ -+ (BIT_CLEAR_PORT0_RXBCN_TBTT_INTERVAL(x) | \ -+ BIT_PORT0_RXBCN_TBTT_INTERVAL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL0 (Offset 0x1160) */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0 0 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_PORT0 0xff -+#define BIT_RX_BCN_TBTT_ITVL_PORT0(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_PORT0) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0) -+#define BITS_RX_BCN_TBTT_ITVL_PORT0 \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_PORT0 << BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_PORT0(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_PORT0)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_PORT0(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_PORT0) -+#define BIT_SET_RX_BCN_TBTT_ITVL_PORT0(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_PORT0(x) | BIT_RX_BCN_TBTT_ITVL_PORT0(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_RXBCN_TBTT_INTERVAL_PORT4 (Offset 0x1164) */ -+ -+#define BIT_SHIFT_PORT4_RXBCN_TBTT_INTERVAL 0 -+#define BIT_MASK_PORT4_RXBCN_TBTT_INTERVAL 0xff -+#define BIT_PORT4_RXBCN_TBTT_INTERVAL(x) \ -+ (((x) & BIT_MASK_PORT4_RXBCN_TBTT_INTERVAL) \ -+ << BIT_SHIFT_PORT4_RXBCN_TBTT_INTERVAL) -+#define BITS_PORT4_RXBCN_TBTT_INTERVAL \ -+ (BIT_MASK_PORT4_RXBCN_TBTT_INTERVAL \ -+ << BIT_SHIFT_PORT4_RXBCN_TBTT_INTERVAL) -+#define BIT_CLEAR_PORT4_RXBCN_TBTT_INTERVAL(x) \ -+ ((x) & (~BITS_PORT4_RXBCN_TBTT_INTERVAL)) -+#define BIT_GET_PORT4_RXBCN_TBTT_INTERVAL(x) \ -+ (((x) >> BIT_SHIFT_PORT4_RXBCN_TBTT_INTERVAL) & \ -+ BIT_MASK_PORT4_RXBCN_TBTT_INTERVAL) -+#define BIT_SET_PORT4_RXBCN_TBTT_INTERVAL(x, v) \ -+ (BIT_CLEAR_PORT4_RXBCN_TBTT_INTERVAL(x) | \ -+ BIT_PORT4_RXBCN_TBTT_INTERVAL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL1 (Offset 0x1164) */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3 0 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT3(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT3 \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3 \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT3(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT3)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT3(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT3(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT3(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT3(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWIMR1 (Offset 0x1168) */ -+ -+#define BIT_FS_ATIM_MB15_INT_EN BIT(31) -+#define BIT_FS_ATIM_MB14_INT_EN BIT(30) -+#define BIT_FS_ATIM_MB13_INT_EN BIT(29) -+#define BIT_FS_ATIM_MB12_INT_EN BIT(28) -+#define BIT_FS_ATIM_MB11_INT_EN BIT(27) -+#define BIT_FS_ATIM_MB10_INT_EN BIT(26) -+#define BIT_FS_ATIM_MB9_INT_EN BIT(25) -+#define BIT_FS_ATIM_MB8_INT_EN BIT(24) -+#define BIT_FS_TXBCNERR_MB15_INT_EN BIT(23) -+#define BIT_FS_TXBCNERR_MB14_INT_EN BIT(22) -+#define BIT_FS_TXBCNERR_MB13_INT_EN BIT(21) -+#define BIT_FS_TXBCNERR_MB12_INT_EN BIT(20) -+#define BIT_FS_TXBCNERR_MB11_INT_EN BIT(19) -+#define BIT_FS_TXBCNERR_MB10_INT_EN BIT(18) -+#define BIT_FS_TXBCNERR_MB9_INT_EN BIT(17) -+#define BIT_FS_TXBCNERR_MB8_INT_EN BIT(16) -+#define BIT_FS_TXBCNOK_MB15_INT_EN BIT(15) -+#define BIT_FS_TXBCNOK_MB14_INT_EN BIT(14) -+#define BIT_FS_TXBCNOK_MB13_INT_EN BIT(13) -+#define BIT_FS_TXBCNOK_MB12_INT_EN BIT(12) -+#define BIT_FS_TXBCNOK_MB11_INT_EN BIT(11) -+#define BIT_FS_TXBCNOK_MB10_INT_EN BIT(10) -+#define BIT_FS_TXBCNOK_MB9_INT_EN BIT(9) -+#define BIT_FS_TXBCNOK_MB8_INT_EN BIT(8) -+#define BIT_FS_BCNERLY0_MB15INT_EN BIT(7) -+#define BIT_FS_BCNERLY0_MB14INT_EN BIT(6) -+#define BIT_FS_BCNERLY0_MB13INT_EN BIT(5) -+#define BIT_FS_BCNERLY0_MB12INT_EN BIT(4) -+#define BIT_FS_BCNERLY0_MB11INT_EN BIT(3) -+#define BIT_FS_BCNERLY0_MB10INT_EN BIT(2) -+#define BIT_FS_BCNERLY0_MB9INT_EN BIT(1) -+#define BIT_FS_BCNERLY0_MB8INT_EN BIT(0) -+ -+/* 2 REG_FWISR1 (Offset 0x116C) */ -+ -+#define BIT_FS_ATIM_MB15_INT BIT(31) -+#define BIT_FS_ATIM_MB14_INT BIT(30) -+#define BIT_FS_ATIM_MB13_INT BIT(29) -+#define BIT_FS_ATIM_MB12_INT BIT(28) -+#define BIT_FS_ATIM_MB11_INT BIT(27) -+#define BIT_FS_ATIM_MB10_INT BIT(26) -+#define BIT_FS_ATIM_MB9_INT BIT(25) -+#define BIT_FS_ATIM_MB8_INT BIT(24) -+#define BIT_FS_TXBCNERR_MB15_INT BIT(23) -+#define BIT_FS_TXBCNERR_MB14_INT BIT(22) -+#define BIT_FS_TXBCNERR_MB13_INT BIT(21) -+#define BIT_FS_TXBCNERR_MB12_INT BIT(20) -+#define BIT_FS_TXBCNERR_MB11_INT BIT(19) -+#define BIT_FS_TXBCNERR_MB10_INT BIT(18) -+#define BIT_FS_TXBCNERR_MB9_INT BIT(17) -+#define BIT_FS_TXBCNERR_MB8_INT BIT(16) -+#define BIT_FS_TXBCNOK_MB15_INT BIT(15) -+#define BIT_FS_TXBCNOK_MB14_INT BIT(14) -+#define BIT_FS_TXBCNOK_MB13_INT BIT(13) -+#define BIT_FS_TXBCNOK_MB12_INT BIT(12) -+#define BIT_FS_TXBCNOK_MB11_INT BIT(11) -+#define BIT_FS_TXBCNOK_MB10_INT BIT(10) -+#define BIT_FS_TXBCNOK_MB9_INT BIT(9) -+#define BIT_FS_TXBCNOK_MB8_INT BIT(8) -+#define BIT_FS_BCNERLY0_MB15INT BIT(7) -+#define BIT_FS_BCNERLY0_MB14INT BIT(6) -+#define BIT_FS_BCNERLY0_MB13INT BIT(5) -+#define BIT_FS_BCNERLY0_MB12INT BIT(4) -+#define BIT_FS_BCNERLY0_MB11INT BIT(3) -+#define BIT_FS_BCNERLY0_MB10INT BIT(2) -+#define BIT_FS_BCNERLY0_MB9INT BIT(1) -+#define BIT_FS_BCNERLY0_MB8INT BIT(0) -+ -+/* 2 REG_FWIMR2 (Offset 0x1170) */ -+ -+#define BIT_FS_BCNDMA0_MB15_INT_EN BIT(15) -+#define BIT_FS_BCNDMA0_MB14_INT_EN BIT(14) -+#define BIT_FS_BCNDMA0_MB13_INT_EN BIT(13) -+#define BIT_FS_BCNDMA0_MB12_INT_EN BIT(12) -+#define BIT_FS_BCNDMA0_MB11_INT_EN BIT(11) -+#define BIT_FS_BCNDMA0_MB10_INT_EN BIT(10) -+#define BIT_FS_BCNDMA0_MB9_INT_EN BIT(9) -+#define BIT_FS_BCNDMA0_MB8_INT_EN BIT(8) -+#define BIT_FS_TBTT0_MB15INT_EN BIT(7) -+#define BIT_FS_TBTT0_MB14INT_EN BIT(6) -+#define BIT_FS_TBTT0_MB13INT_EN BIT(5) -+#define BIT_FS_TBTT0_MB12INT_EN BIT(4) -+#define BIT_FS_TBTT0_MB11INT_EN BIT(3) -+#define BIT_FS_TBTT0_MB10INT_EN BIT(2) -+#define BIT_FS_TBTT0_MB9INT_EN BIT(1) -+#define BIT_FS_TBTT0_MB8INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_IO_WRAP_ERR_FLAG (Offset 0x1170) */ -+ -+#define BIT_IO_WRAP_ERR BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWISR2 (Offset 0x1174) */ -+ -+#define BIT_FS_BCNDMA0_MB15_INT BIT(15) -+#define BIT_FS_BCNDMA0_MB14_INT BIT(14) -+#define BIT_FS_BCNDMA0_MB13_INT BIT(13) -+#define BIT_FS_BCNDMA0_MB12_INT BIT(12) -+#define BIT_FS_BCNDMA0_MB11_INT BIT(11) -+#define BIT_FS_BCNDMA0_MB10_INT BIT(10) -+#define BIT_FS_BCNDMA0_MB9_INT BIT(9) -+#define BIT_FS_BCNDMA0_MB8_INT BIT(8) -+#define BIT_FS_TBTT0_MB15INT BIT(7) -+#define BIT_FS_TBTT0_MB14INT BIT(6) -+#define BIT_FS_TBTT0_MB13INT BIT(5) -+#define BIT_FS_TBTT0_MB12INT BIT(4) -+#define BIT_FS_TBTT0_MB11INT BIT(3) -+#define BIT_FS_TBTT0_MB10INT BIT(2) -+#define BIT_FS_TBTT0_MB9INT BIT(1) -+#define BIT_FS_TBTT0_MB8INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWISR3 (Offset 0x117C) */ -+ -+#define BIT_FS_TXBCNOK_PORT4_INT BIT(11) -+#define BIT_FS_TXBCNOK_PORT3_INT BIT(10) -+#define BIT_FS_TXBCNOK_PORT2_INT BIT(9) -+#define BIT_FS_TXBCNOK_PORT1_INT BIT(8) -+#define BIT_FS_TXBCNERR_PORT4_INT BIT(7) -+#define BIT_FS_TXBCNERR_PORT3_INT BIT(6) -+#define BIT_FS_TXBCNERR_PORT2_INT BIT(5) -+#define BIT_FS_TXBCNERR_PORT1_INT BIT(4) -+#define BIT_FS_ATIM_PORT4_INT BIT(3) -+#define BIT_FS_ATIM_PORT3_INT BIT(2) -+#define BIT_FS_ATIM_PORT2_INT BIT(1) -+#define BIT_FS_ATIM_PORT1_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SPEED_SENSOR (Offset 0x1180) */ -+ -+#define BIT_DSS_1_RST_N BIT(31) -+#define BIT_DSS_1_SPEED_EN BIT(30) -+#define BIT_DSS_1_WIRE_SEL BIT(29) -+#define BIT_DSS_ENCLK BIT(28) -+ -+#define BIT_SHIFT_DSS_1_RO_SEL 24 -+#define BIT_MASK_DSS_1_RO_SEL 0x7 -+#define BIT_DSS_1_RO_SEL(x) \ -+ (((x) & BIT_MASK_DSS_1_RO_SEL) << BIT_SHIFT_DSS_1_RO_SEL) -+#define BITS_DSS_1_RO_SEL (BIT_MASK_DSS_1_RO_SEL << BIT_SHIFT_DSS_1_RO_SEL) -+#define BIT_CLEAR_DSS_1_RO_SEL(x) ((x) & (~BITS_DSS_1_RO_SEL)) -+#define BIT_GET_DSS_1_RO_SEL(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_RO_SEL) & BIT_MASK_DSS_1_RO_SEL) -+#define BIT_SET_DSS_1_RO_SEL(x, v) \ -+ (BIT_CLEAR_DSS_1_RO_SEL(x) | BIT_DSS_1_RO_SEL(v)) -+ -+#define BIT_SHIFT_DSS_1_DATA_IN 0 -+#define BIT_MASK_DSS_1_DATA_IN 0xfffff -+#define BIT_DSS_1_DATA_IN(x) \ -+ (((x) & BIT_MASK_DSS_1_DATA_IN) << BIT_SHIFT_DSS_1_DATA_IN) -+#define BITS_DSS_1_DATA_IN (BIT_MASK_DSS_1_DATA_IN << BIT_SHIFT_DSS_1_DATA_IN) -+#define BIT_CLEAR_DSS_1_DATA_IN(x) ((x) & (~BITS_DSS_1_DATA_IN)) -+#define BIT_GET_DSS_1_DATA_IN(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_DATA_IN) & BIT_MASK_DSS_1_DATA_IN) -+#define BIT_SET_DSS_1_DATA_IN(x, v) \ -+ (BIT_CLEAR_DSS_1_DATA_IN(x) | BIT_DSS_1_DATA_IN(v)) -+ -+/* 2 REG_SPEED_SENSOR1 (Offset 0x1184) */ -+ -+#define BIT_DSS_1_READY BIT(31) -+#define BIT_DSS_1_WSORT_GO BIT(30) -+ -+#define BIT_SHIFT_DSS_1_COUNT_OUT 0 -+#define BIT_MASK_DSS_1_COUNT_OUT 0xfffff -+#define BIT_DSS_1_COUNT_OUT(x) \ -+ (((x) & BIT_MASK_DSS_1_COUNT_OUT) << BIT_SHIFT_DSS_1_COUNT_OUT) -+#define BITS_DSS_1_COUNT_OUT \ -+ (BIT_MASK_DSS_1_COUNT_OUT << BIT_SHIFT_DSS_1_COUNT_OUT) -+#define BIT_CLEAR_DSS_1_COUNT_OUT(x) ((x) & (~BITS_DSS_1_COUNT_OUT)) -+#define BIT_GET_DSS_1_COUNT_OUT(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_COUNT_OUT) & BIT_MASK_DSS_1_COUNT_OUT) -+#define BIT_SET_DSS_1_COUNT_OUT(x, v) \ -+ (BIT_CLEAR_DSS_1_COUNT_OUT(x) | BIT_DSS_1_COUNT_OUT(v)) -+ -+/* 2 REG_SPEED_SENSOR2 (Offset 0x1188) */ -+ -+#define BIT_DSS_2_RST_N BIT(31) -+#define BIT_DSS_2_SPEED_EN BIT(30) -+#define BIT_DSS_2_WIRE_SEL BIT(29) -+ -+#define BIT_SHIFT_DSS_2_RO_SEL 24 -+#define BIT_MASK_DSS_2_RO_SEL 0x7 -+#define BIT_DSS_2_RO_SEL(x) \ -+ (((x) & BIT_MASK_DSS_2_RO_SEL) << BIT_SHIFT_DSS_2_RO_SEL) -+#define BITS_DSS_2_RO_SEL (BIT_MASK_DSS_2_RO_SEL << BIT_SHIFT_DSS_2_RO_SEL) -+#define BIT_CLEAR_DSS_2_RO_SEL(x) ((x) & (~BITS_DSS_2_RO_SEL)) -+#define BIT_GET_DSS_2_RO_SEL(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_RO_SEL) & BIT_MASK_DSS_2_RO_SEL) -+#define BIT_SET_DSS_2_RO_SEL(x, v) \ -+ (BIT_CLEAR_DSS_2_RO_SEL(x) | BIT_DSS_2_RO_SEL(v)) -+ -+#define BIT_SHIFT_DSS_2_DATA_IN 0 -+#define BIT_MASK_DSS_2_DATA_IN 0xfffff -+#define BIT_DSS_2_DATA_IN(x) \ -+ (((x) & BIT_MASK_DSS_2_DATA_IN) << BIT_SHIFT_DSS_2_DATA_IN) -+#define BITS_DSS_2_DATA_IN (BIT_MASK_DSS_2_DATA_IN << BIT_SHIFT_DSS_2_DATA_IN) -+#define BIT_CLEAR_DSS_2_DATA_IN(x) ((x) & (~BITS_DSS_2_DATA_IN)) -+#define BIT_GET_DSS_2_DATA_IN(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_DATA_IN) & BIT_MASK_DSS_2_DATA_IN) -+#define BIT_SET_DSS_2_DATA_IN(x, v) \ -+ (BIT_CLEAR_DSS_2_DATA_IN(x) | BIT_DSS_2_DATA_IN(v)) -+ -+/* 2 REG_SPEED_SENSOR3 (Offset 0x118C) */ -+ -+#define BIT_DSS_2_READY BIT(31) -+#define BIT_DSS_2_WSORT_GO BIT(30) -+ -+#define BIT_SHIFT_DSS_2_COUNT_OUT 0 -+#define BIT_MASK_DSS_2_COUNT_OUT 0xfffff -+#define BIT_DSS_2_COUNT_OUT(x) \ -+ (((x) & BIT_MASK_DSS_2_COUNT_OUT) << BIT_SHIFT_DSS_2_COUNT_OUT) -+#define BITS_DSS_2_COUNT_OUT \ -+ (BIT_MASK_DSS_2_COUNT_OUT << BIT_SHIFT_DSS_2_COUNT_OUT) -+#define BIT_CLEAR_DSS_2_COUNT_OUT(x) ((x) & (~BITS_DSS_2_COUNT_OUT)) -+#define BIT_GET_DSS_2_COUNT_OUT(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_COUNT_OUT) & BIT_MASK_DSS_2_COUNT_OUT) -+#define BIT_SET_DSS_2_COUNT_OUT(x, v) \ -+ (BIT_CLEAR_DSS_2_COUNT_OUT(x) | BIT_DSS_2_COUNT_OUT(v)) -+ -+/* 2 REG_SPEED_SENSOR4 (Offset 0x1190) */ -+ -+#define BIT_DSS_3_RST_N BIT(31) -+#define BIT_DSS_3_SPEED_EN BIT(30) -+#define BIT_DSS_3_WIRE_SEL BIT(29) -+ -+#define BIT_SHIFT_DSS_3_RO_SEL 24 -+#define BIT_MASK_DSS_3_RO_SEL 0x7 -+#define BIT_DSS_3_RO_SEL(x) \ -+ (((x) & BIT_MASK_DSS_3_RO_SEL) << BIT_SHIFT_DSS_3_RO_SEL) -+#define BITS_DSS_3_RO_SEL (BIT_MASK_DSS_3_RO_SEL << BIT_SHIFT_DSS_3_RO_SEL) -+#define BIT_CLEAR_DSS_3_RO_SEL(x) ((x) & (~BITS_DSS_3_RO_SEL)) -+#define BIT_GET_DSS_3_RO_SEL(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_RO_SEL) & BIT_MASK_DSS_3_RO_SEL) -+#define BIT_SET_DSS_3_RO_SEL(x, v) \ -+ (BIT_CLEAR_DSS_3_RO_SEL(x) | BIT_DSS_3_RO_SEL(v)) -+ -+#define BIT_SHIFT_DSS_3_DATA_IN 0 -+#define BIT_MASK_DSS_3_DATA_IN 0xfffff -+#define BIT_DSS_3_DATA_IN(x) \ -+ (((x) & BIT_MASK_DSS_3_DATA_IN) << BIT_SHIFT_DSS_3_DATA_IN) -+#define BITS_DSS_3_DATA_IN (BIT_MASK_DSS_3_DATA_IN << BIT_SHIFT_DSS_3_DATA_IN) -+#define BIT_CLEAR_DSS_3_DATA_IN(x) ((x) & (~BITS_DSS_3_DATA_IN)) -+#define BIT_GET_DSS_3_DATA_IN(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_DATA_IN) & BIT_MASK_DSS_3_DATA_IN) -+#define BIT_SET_DSS_3_DATA_IN(x, v) \ -+ (BIT_CLEAR_DSS_3_DATA_IN(x) | BIT_DSS_3_DATA_IN(v)) -+ -+/* 2 REG_SPEED_SENSOR5 (Offset 0x1194) */ -+ -+#define BIT_DSS_3_READY BIT(31) -+#define BIT_DSS_3_WSORT_GO BIT(30) -+ -+#define BIT_SHIFT_DSS_3_COUNT_OUT 0 -+#define BIT_MASK_DSS_3_COUNT_OUT 0xfffff -+#define BIT_DSS_3_COUNT_OUT(x) \ -+ (((x) & BIT_MASK_DSS_3_COUNT_OUT) << BIT_SHIFT_DSS_3_COUNT_OUT) -+#define BITS_DSS_3_COUNT_OUT \ -+ (BIT_MASK_DSS_3_COUNT_OUT << BIT_SHIFT_DSS_3_COUNT_OUT) -+#define BIT_CLEAR_DSS_3_COUNT_OUT(x) ((x) & (~BITS_DSS_3_COUNT_OUT)) -+#define BIT_GET_DSS_3_COUNT_OUT(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_COUNT_OUT) & BIT_MASK_DSS_3_COUNT_OUT) -+#define BIT_SET_DSS_3_COUNT_OUT(x, v) \ -+ (BIT_CLEAR_DSS_3_COUNT_OUT(x) | BIT_DSS_3_COUNT_OUT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RXPKTBUF_1_MAX_ADDR (Offset 0x1198) */ -+ -+#define BIT_SHIFT_RXPKTBUF_SIZE 30 -+#define BIT_MASK_RXPKTBUF_SIZE 0x3 -+#define BIT_RXPKTBUF_SIZE(x) \ -+ (((x) & BIT_MASK_RXPKTBUF_SIZE) << BIT_SHIFT_RXPKTBUF_SIZE) -+#define BITS_RXPKTBUF_SIZE (BIT_MASK_RXPKTBUF_SIZE << BIT_SHIFT_RXPKTBUF_SIZE) -+#define BIT_CLEAR_RXPKTBUF_SIZE(x) ((x) & (~BITS_RXPKTBUF_SIZE)) -+#define BIT_GET_RXPKTBUF_SIZE(x) \ -+ (((x) >> BIT_SHIFT_RXPKTBUF_SIZE) & BIT_MASK_RXPKTBUF_SIZE) -+#define BIT_SET_RXPKTBUF_SIZE(x, v) \ -+ (BIT_CLEAR_RXPKTBUF_SIZE(x) | BIT_RXPKTBUF_SIZE(v)) -+ -+#define BIT_RXPKTBUF_DBG_SEL BIT(29) -+ -+#define BIT_SHIFT_RXPKTBUF_1_MAX_ADDR 0 -+#define BIT_MASK_RXPKTBUF_1_MAX_ADDR 0x3ffff -+#define BIT_RXPKTBUF_1_MAX_ADDR(x) \ -+ (((x) & BIT_MASK_RXPKTBUF_1_MAX_ADDR) << BIT_SHIFT_RXPKTBUF_1_MAX_ADDR) -+#define BITS_RXPKTBUF_1_MAX_ADDR \ -+ (BIT_MASK_RXPKTBUF_1_MAX_ADDR << BIT_SHIFT_RXPKTBUF_1_MAX_ADDR) -+#define BIT_CLEAR_RXPKTBUF_1_MAX_ADDR(x) ((x) & (~BITS_RXPKTBUF_1_MAX_ADDR)) -+#define BIT_GET_RXPKTBUF_1_MAX_ADDR(x) \ -+ (((x) >> BIT_SHIFT_RXPKTBUF_1_MAX_ADDR) & BIT_MASK_RXPKTBUF_1_MAX_ADDR) -+#define BIT_SET_RXPKTBUF_1_MAX_ADDR(x, v) \ -+ (BIT_CLEAR_RXPKTBUF_1_MAX_ADDR(x) | BIT_RXPKTBUF_1_MAX_ADDR(v)) -+ -+/* 2 REG_RXFWBUF_1_MAX_ADDR (Offset 0x119C) */ -+ -+#define BIT_SHIFT_RXFWBUF_1_MAX_ADDR 0 -+#define BIT_MASK_RXFWBUF_1_MAX_ADDR 0xffff -+#define BIT_RXFWBUF_1_MAX_ADDR(x) \ -+ (((x) & BIT_MASK_RXFWBUF_1_MAX_ADDR) << BIT_SHIFT_RXFWBUF_1_MAX_ADDR) -+#define BITS_RXFWBUF_1_MAX_ADDR \ -+ (BIT_MASK_RXFWBUF_1_MAX_ADDR << BIT_SHIFT_RXFWBUF_1_MAX_ADDR) -+#define BIT_CLEAR_RXFWBUF_1_MAX_ADDR(x) ((x) & (~BITS_RXFWBUF_1_MAX_ADDR)) -+#define BIT_GET_RXFWBUF_1_MAX_ADDR(x) \ -+ (((x) >> BIT_SHIFT_RXFWBUF_1_MAX_ADDR) & BIT_MASK_RXFWBUF_1_MAX_ADDR) -+#define BIT_SET_RXFWBUF_1_MAX_ADDR(x, v) \ -+ (BIT_CLEAR_RXFWBUF_1_MAX_ADDR(x) | BIT_RXFWBUF_1_MAX_ADDR(v)) -+ -+/* 2 REG_RXPKTBUF_1_READ (Offset 0x11A4) */ -+ -+#define BIT_SHIFT_RXPKTBUF_1_READ 0 -+#define BIT_MASK_RXPKTBUF_1_READ 0x3ffff -+#define BIT_RXPKTBUF_1_READ(x) \ -+ (((x) & BIT_MASK_RXPKTBUF_1_READ) << BIT_SHIFT_RXPKTBUF_1_READ) -+#define BITS_RXPKTBUF_1_READ \ -+ (BIT_MASK_RXPKTBUF_1_READ << BIT_SHIFT_RXPKTBUF_1_READ) -+#define BIT_CLEAR_RXPKTBUF_1_READ(x) ((x) & (~BITS_RXPKTBUF_1_READ)) -+#define BIT_GET_RXPKTBUF_1_READ(x) \ -+ (((x) >> BIT_SHIFT_RXPKTBUF_1_READ) & BIT_MASK_RXPKTBUF_1_READ) -+#define BIT_SET_RXPKTBUF_1_READ(x, v) \ -+ (BIT_CLEAR_RXPKTBUF_1_READ(x) | BIT_RXPKTBUF_1_READ(v)) -+ -+/* 2 REG_RXPKTBUF_1_WRITE (Offset 0x11A8) */ -+ -+#define BIT_SHIFT_R_OQT_DBG_SEL 16 -+#define BIT_MASK_R_OQT_DBG_SEL 0xff -+#define BIT_R_OQT_DBG_SEL(x) \ -+ (((x) & BIT_MASK_R_OQT_DBG_SEL) << BIT_SHIFT_R_OQT_DBG_SEL) -+#define BITS_R_OQT_DBG_SEL (BIT_MASK_R_OQT_DBG_SEL << BIT_SHIFT_R_OQT_DBG_SEL) -+#define BIT_CLEAR_R_OQT_DBG_SEL(x) ((x) & (~BITS_R_OQT_DBG_SEL)) -+#define BIT_GET_R_OQT_DBG_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_OQT_DBG_SEL) & BIT_MASK_R_OQT_DBG_SEL) -+#define BIT_SET_R_OQT_DBG_SEL(x, v) \ -+ (BIT_CLEAR_R_OQT_DBG_SEL(x) | BIT_R_OQT_DBG_SEL(v)) -+ -+#define BIT_SHIFT_R_TXPKTBF_DBG_SEL 8 -+#define BIT_MASK_R_TXPKTBF_DBG_SEL 0x7 -+#define BIT_R_TXPKTBF_DBG_SEL(x) \ -+ (((x) & BIT_MASK_R_TXPKTBF_DBG_SEL) << BIT_SHIFT_R_TXPKTBF_DBG_SEL) -+#define BITS_R_TXPKTBF_DBG_SEL \ -+ (BIT_MASK_R_TXPKTBF_DBG_SEL << BIT_SHIFT_R_TXPKTBF_DBG_SEL) -+#define BIT_CLEAR_R_TXPKTBF_DBG_SEL(x) ((x) & (~BITS_R_TXPKTBF_DBG_SEL)) -+#define BIT_GET_R_TXPKTBF_DBG_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_TXPKTBF_DBG_SEL) & BIT_MASK_R_TXPKTBF_DBG_SEL) -+#define BIT_SET_R_TXPKTBF_DBG_SEL(x, v) \ -+ (BIT_CLEAR_R_TXPKTBF_DBG_SEL(x) | BIT_R_TXPKTBF_DBG_SEL(v)) -+ -+#define BIT_SHIFT_R_RXPKT_DBG_SEL 6 -+#define BIT_MASK_R_RXPKT_DBG_SEL 0x3 -+#define BIT_R_RXPKT_DBG_SEL(x) \ -+ (((x) & BIT_MASK_R_RXPKT_DBG_SEL) << BIT_SHIFT_R_RXPKT_DBG_SEL) -+#define BITS_R_RXPKT_DBG_SEL \ -+ (BIT_MASK_R_RXPKT_DBG_SEL << BIT_SHIFT_R_RXPKT_DBG_SEL) -+#define BIT_CLEAR_R_RXPKT_DBG_SEL(x) ((x) & (~BITS_R_RXPKT_DBG_SEL)) -+#define BIT_GET_R_RXPKT_DBG_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_RXPKT_DBG_SEL) & BIT_MASK_R_RXPKT_DBG_SEL) -+#define BIT_SET_R_RXPKT_DBG_SEL(x, v) \ -+ (BIT_CLEAR_R_RXPKT_DBG_SEL(x) | BIT_R_RXPKT_DBG_SEL(v)) -+ -+#define BIT_SHIFT_RXPKTBUF_1_WRITE 0 -+#define BIT_MASK_RXPKTBUF_1_WRITE 0x3ffff -+#define BIT_RXPKTBUF_1_WRITE(x) \ -+ (((x) & BIT_MASK_RXPKTBUF_1_WRITE) << BIT_SHIFT_RXPKTBUF_1_WRITE) -+#define BITS_RXPKTBUF_1_WRITE \ -+ (BIT_MASK_RXPKTBUF_1_WRITE << BIT_SHIFT_RXPKTBUF_1_WRITE) -+#define BIT_CLEAR_RXPKTBUF_1_WRITE(x) ((x) & (~BITS_RXPKTBUF_1_WRITE)) -+#define BIT_GET_RXPKTBUF_1_WRITE(x) \ -+ (((x) >> BIT_SHIFT_RXPKTBUF_1_WRITE) & BIT_MASK_RXPKTBUF_1_WRITE) -+#define BIT_SET_RXPKTBUF_1_WRITE(x, v) \ -+ (BIT_CLEAR_RXPKTBUF_1_WRITE(x) | BIT_RXPKTBUF_1_WRITE(v)) -+ -+#define BIT_SHIFT_R_RXPKTBF_DBG_SEL 0 -+#define BIT_MASK_R_RXPKTBF_DBG_SEL 0x3 -+#define BIT_R_RXPKTBF_DBG_SEL(x) \ -+ (((x) & BIT_MASK_R_RXPKTBF_DBG_SEL) << BIT_SHIFT_R_RXPKTBF_DBG_SEL) -+#define BITS_R_RXPKTBF_DBG_SEL \ -+ (BIT_MASK_R_RXPKTBF_DBG_SEL << BIT_SHIFT_R_RXPKTBF_DBG_SEL) -+#define BIT_CLEAR_R_RXPKTBF_DBG_SEL(x) ((x) & (~BITS_R_RXPKTBF_DBG_SEL)) -+#define BIT_GET_R_RXPKTBF_DBG_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_RXPKTBF_DBG_SEL) & BIT_MASK_R_RXPKTBF_DBG_SEL) -+#define BIT_SET_R_RXPKTBF_DBG_SEL(x, v) \ -+ (BIT_CLEAR_R_RXPKTBF_DBG_SEL(x) | BIT_R_RXPKTBF_DBG_SEL(v)) -+ -+/* 2 REG_RFE_CTRL_PAD_E2 (Offset 0x11B0) */ -+ -+#define BIT_RFE_CTRL_ANTSW_E2 BIT(16) -+#define BIT_RFE_CTRL_PIN15_E2 BIT(15) -+#define BIT_RFE_CTRL_PIN14_E2 BIT(14) -+#define BIT_RFE_CTRL_PIN13_E2 BIT(13) -+#define BIT_RFE_CTRL_PIN12_E2 BIT(12) -+#define BIT_RFE_CTRL_PIN11_E2 BIT(11) -+#define BIT_RFE_CTRL_PIN10_E2 BIT(10) -+#define BIT_RFE_CTRL_PIN9_E2 BIT(9) -+#define BIT_RFE_CTRL_PIN8_E2 BIT(8) -+#define BIT_RFE_CTRL_PIN7_E2 BIT(7) -+#define BIT_RFE_CTRL_PIN6_E2 BIT(6) -+#define BIT_RFE_CTRL_PIN5_E2 BIT(5) -+#define BIT_RFE_CTRL_PIN4_E2 BIT(4) -+#define BIT_RFE_CTRL_PIN3_E2 BIT(3) -+#define BIT_RFE_CTRL_PIN2_E2 BIT(2) -+#define BIT_RFE_CTRL_PIN1_E2 BIT(1) -+#define BIT_RFE_CTRL_PIN0_E2 BIT(0) -+ -+/* 2 REG_RFE_CTRL_PAD_SR (Offset 0x11B4) */ -+ -+#define BIT_RFE_CTRL_ANTSW_SR BIT(16) -+#define BIT_RFE_CTRL_PIN15_SR BIT(15) -+#define BIT_RFE_CTRL_PIN14_SR BIT(14) -+#define BIT_RFE_CTRL_PIN13_SR BIT(13) -+#define BIT_RFE_CTRL_PIN12_SR BIT(12) -+#define BIT_RFE_CTRL_PIN11_SR BIT(11) -+#define BIT_RFE_CTRL_PIN10_SR BIT(10) -+#define BIT_RFE_CTRL_PIN9_SR BIT(9) -+#define BIT_RFE_CTRL_PIN8_SR BIT(8) -+#define BIT_RFE_CTRL_PIN7_SR BIT(7) -+#define BIT_RFE_CTRL_PIN6_SR BIT(6) -+#define BIT_RFE_CTRL_PIN5_SR BIT(5) -+#define BIT_RFE_CTRL_PIN4_SR BIT(4) -+#define BIT_RFE_CTRL_PIN3_SR BIT(3) -+#define BIT_RFE_CTRL_PIN2_SR BIT(2) -+#define BIT_RFE_CTRL_PIN1_SR BIT(1) -+#define BIT_RFE_CTRL_PIN0_SR BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_EXT_QUEUE_REG (Offset 0x11C0) */ -+ -+#define BIT_SHIFT_PCIE_PRIORITY_SEL 0 -+#define BIT_MASK_PCIE_PRIORITY_SEL 0x3 -+#define BIT_PCIE_PRIORITY_SEL(x) \ -+ (((x) & BIT_MASK_PCIE_PRIORITY_SEL) << BIT_SHIFT_PCIE_PRIORITY_SEL) -+#define BITS_PCIE_PRIORITY_SEL \ -+ (BIT_MASK_PCIE_PRIORITY_SEL << BIT_SHIFT_PCIE_PRIORITY_SEL) -+#define BIT_CLEAR_PCIE_PRIORITY_SEL(x) ((x) & (~BITS_PCIE_PRIORITY_SEL)) -+#define BIT_GET_PCIE_PRIORITY_SEL(x) \ -+ (((x) >> BIT_SHIFT_PCIE_PRIORITY_SEL) & BIT_MASK_PCIE_PRIORITY_SEL) -+#define BIT_SET_PCIE_PRIORITY_SEL(x, v) \ -+ (BIT_CLEAR_PCIE_PRIORITY_SEL(x) | BIT_PCIE_PRIORITY_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_H2C_PRIORITY_SEL (Offset 0x11C0) */ -+ -+#define BIT_SHIFT_H2C_PRIORITY_SEL 0 -+#define BIT_MASK_H2C_PRIORITY_SEL 0x3 -+#define BIT_H2C_PRIORITY_SEL(x) \ -+ (((x) & BIT_MASK_H2C_PRIORITY_SEL) << BIT_SHIFT_H2C_PRIORITY_SEL) -+#define BITS_H2C_PRIORITY_SEL \ -+ (BIT_MASK_H2C_PRIORITY_SEL << BIT_SHIFT_H2C_PRIORITY_SEL) -+#define BIT_CLEAR_H2C_PRIORITY_SEL(x) ((x) & (~BITS_H2C_PRIORITY_SEL)) -+#define BIT_GET_H2C_PRIORITY_SEL(x) \ -+ (((x) >> BIT_SHIFT_H2C_PRIORITY_SEL) & BIT_MASK_H2C_PRIORITY_SEL) -+#define BIT_SET_H2C_PRIORITY_SEL(x, v) \ -+ (BIT_CLEAR_H2C_PRIORITY_SEL(x) | BIT_H2C_PRIORITY_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_CONTROL (Offset 0x11C4) */ -+ -+#define BIT_EN_USB_CNT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_CTRL (Offset 0x11C4) */ -+ -+#define BIT_USB_COUNT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_CONTROL (Offset 0x11C4) */ -+ -+#define BIT_EN_PCIE_CNT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_CTRL (Offset 0x11C4) */ -+ -+#define BIT_PCIE_COUNT_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_CONTROL (Offset 0x11C4) */ -+ -+#define BIT_RQPN_CNT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_CTRL (Offset 0x11C4) */ -+ -+#define BIT_RQPN_COUNT_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_CONTROL (Offset 0x11C4) */ -+ -+#define BIT_RDE_CNT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_CTRL (Offset 0x11C4) */ -+ -+#define BIT_RDE_COUNT_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_CONTROL (Offset 0x11C4) */ -+ -+#define BIT_TDE_CNT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_CTRL (Offset 0x11C4) */ -+ -+#define BIT_TDE_COUNT_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_CONTROL (Offset 0x11C4) */ -+ -+#define BIT_DIS_CNT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_CTRL (Offset 0x11C4) */ -+ -+#define BIT_DISABLE_COUNTER BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_TH (Offset 0x11C8) */ -+ -+#define BIT_CNT_ALL_MACID BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_THRESHOLD (Offset 0x11C8) */ -+ -+#define BIT_SEL_ALL_MACID BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_TH (Offset 0x11C8) */ -+ -+#define BIT_SHIFT_CNT_MACID 24 -+#define BIT_MASK_CNT_MACID 0x7f -+#define BIT_CNT_MACID(x) (((x) & BIT_MASK_CNT_MACID) << BIT_SHIFT_CNT_MACID) -+#define BITS_CNT_MACID (BIT_MASK_CNT_MACID << BIT_SHIFT_CNT_MACID) -+#define BIT_CLEAR_CNT_MACID(x) ((x) & (~BITS_CNT_MACID)) -+#define BIT_GET_CNT_MACID(x) (((x) >> BIT_SHIFT_CNT_MACID) & BIT_MASK_CNT_MACID) -+#define BIT_SET_CNT_MACID(x, v) (BIT_CLEAR_CNT_MACID(x) | BIT_CNT_MACID(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_THRESHOLD (Offset 0x11C8) */ -+ -+#define BIT_SHIFT_COUNTER_MACID 24 -+#define BIT_MASK_COUNTER_MACID 0x7f -+#define BIT_COUNTER_MACID(x) \ -+ (((x) & BIT_MASK_COUNTER_MACID) << BIT_SHIFT_COUNTER_MACID) -+#define BITS_COUNTER_MACID (BIT_MASK_COUNTER_MACID << BIT_SHIFT_COUNTER_MACID) -+#define BIT_CLEAR_COUNTER_MACID(x) ((x) & (~BITS_COUNTER_MACID)) -+#define BIT_GET_COUNTER_MACID(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_MACID) & BIT_MASK_COUNTER_MACID) -+#define BIT_SET_COUNTER_MACID(x, v) \ -+ (BIT_CLEAR_COUNTER_MACID(x) | BIT_COUNTER_MACID(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_SET (Offset 0x11CC) */ -+ -+#define BIT_RTS_RST BIT(24) -+#define BIT_PTCL_RST BIT(23) -+#define BIT_SCH_RST BIT(22) -+#define BIT_EDCA_RST BIT(21) -+#define BIT_RQPN_RST BIT(20) -+#define BIT_USB_RST BIT(19) -+#define BIT_PCIE_RST BIT(18) -+#define BIT_RXDMA_RST BIT(17) -+#define BIT_TXDMA_RST BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_SET (Offset 0x11CC) */ -+ -+#define BIT_SHIFT_REQUEST_RESET 16 -+#define BIT_MASK_REQUEST_RESET 0xffff -+#define BIT_REQUEST_RESET(x) \ -+ (((x) & BIT_MASK_REQUEST_RESET) << BIT_SHIFT_REQUEST_RESET) -+#define BITS_REQUEST_RESET (BIT_MASK_REQUEST_RESET << BIT_SHIFT_REQUEST_RESET) -+#define BIT_CLEAR_REQUEST_RESET(x) ((x) & (~BITS_REQUEST_RESET)) -+#define BIT_GET_REQUEST_RESET(x) \ -+ (((x) >> BIT_SHIFT_REQUEST_RESET) & BIT_MASK_REQUEST_RESET) -+#define BIT_SET_REQUEST_RESET(x, v) \ -+ (BIT_CLEAR_REQUEST_RESET(x) | BIT_REQUEST_RESET(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_SET (Offset 0x11CC) */ -+ -+#define BIT_EN_RTS_START BIT(8) -+#define BIT_EN_PTCL_START BIT(7) -+#define BIT_EN_SCH_START BIT(6) -+#define BIT_EN_EDCA_START BIT(5) -+#define BIT_EN_RQPN_START BIT(4) -+#define BIT_EN_USB_START BIT(3) -+#define BIT_EN_PCIE_START BIT(2) -+#define BIT_EN_RXDMA_START BIT(1) -+#define BIT_EN_TXDMA_START BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_SET (Offset 0x11CC) */ -+ -+#define BIT_SHIFT_REQUEST_START 0 -+#define BIT_MASK_REQUEST_START 0xffff -+#define BIT_REQUEST_START(x) \ -+ (((x) & BIT_MASK_REQUEST_START) << BIT_SHIFT_REQUEST_START) -+#define BITS_REQUEST_START (BIT_MASK_REQUEST_START << BIT_SHIFT_REQUEST_START) -+#define BIT_CLEAR_REQUEST_START(x) ((x) & (~BITS_REQUEST_START)) -+#define BIT_GET_REQUEST_START(x) \ -+ (((x) >> BIT_SHIFT_REQUEST_START) & BIT_MASK_REQUEST_START) -+#define BIT_SET_REQUEST_START(x, v) \ -+ (BIT_CLEAR_REQUEST_START(x) | BIT_REQUEST_START(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_COUNTER_OVERFLOW (Offset 0x11D0) */ -+ -+#define BIT_RTS_OVF BIT(8) -+#define BIT_PTCL_OVF BIT(7) -+#define BIT_SCH_OVF BIT(6) -+#define BIT_EDCA_OVF BIT(5) -+#define BIT_RQPN_OVF BIT(4) -+#define BIT_USB_OVF BIT(3) -+#define BIT_PCIE_OVF BIT(2) -+#define BIT_RXDMA_OVF BIT(1) -+#define BIT_TXDMA_OVF BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_COUNTER_OVERFLOW (Offset 0x11D0) */ -+ -+#define BIT_SHIFT_CNT_OVF_REG 0 -+#define BIT_MASK_CNT_OVF_REG 0xffff -+#define BIT_CNT_OVF_REG(x) \ -+ (((x) & BIT_MASK_CNT_OVF_REG) << BIT_SHIFT_CNT_OVF_REG) -+#define BITS_CNT_OVF_REG (BIT_MASK_CNT_OVF_REG << BIT_SHIFT_CNT_OVF_REG) -+#define BIT_CLEAR_CNT_OVF_REG(x) ((x) & (~BITS_CNT_OVF_REG)) -+#define BIT_GET_CNT_OVF_REG(x) \ -+ (((x) >> BIT_SHIFT_CNT_OVF_REG) & BIT_MASK_CNT_OVF_REG) -+#define BIT_SET_CNT_OVF_REG(x, v) \ -+ (BIT_CLEAR_CNT_OVF_REG(x) | BIT_CNT_OVF_REG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_TDE_LEN_TH (Offset 0x11D4) */ -+ -+#define BIT_SHIFT_TXDMA_LEN_TH0 16 -+#define BIT_MASK_TXDMA_LEN_TH0 0xffff -+#define BIT_TXDMA_LEN_TH0(x) \ -+ (((x) & BIT_MASK_TXDMA_LEN_TH0) << BIT_SHIFT_TXDMA_LEN_TH0) -+#define BITS_TXDMA_LEN_TH0 (BIT_MASK_TXDMA_LEN_TH0 << BIT_SHIFT_TXDMA_LEN_TH0) -+#define BIT_CLEAR_TXDMA_LEN_TH0(x) ((x) & (~BITS_TXDMA_LEN_TH0)) -+#define BIT_GET_TXDMA_LEN_TH0(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_LEN_TH0) & BIT_MASK_TXDMA_LEN_TH0) -+#define BIT_SET_TXDMA_LEN_TH0(x, v) \ -+ (BIT_CLEAR_TXDMA_LEN_TH0(x) | BIT_TXDMA_LEN_TH0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXDMA_LEN_THRESHOLD (Offset 0x11D4) */ -+ -+#define BIT_SHIFT_TDE_LEN_TH1 16 -+#define BIT_MASK_TDE_LEN_TH1 0xffff -+#define BIT_TDE_LEN_TH1(x) \ -+ (((x) & BIT_MASK_TDE_LEN_TH1) << BIT_SHIFT_TDE_LEN_TH1) -+#define BITS_TDE_LEN_TH1 (BIT_MASK_TDE_LEN_TH1 << BIT_SHIFT_TDE_LEN_TH1) -+#define BIT_CLEAR_TDE_LEN_TH1(x) ((x) & (~BITS_TDE_LEN_TH1)) -+#define BIT_GET_TDE_LEN_TH1(x) \ -+ (((x) >> BIT_SHIFT_TDE_LEN_TH1) & BIT_MASK_TDE_LEN_TH1) -+#define BIT_SET_TDE_LEN_TH1(x, v) \ -+ (BIT_CLEAR_TDE_LEN_TH1(x) | BIT_TDE_LEN_TH1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_TDE_LEN_TH (Offset 0x11D4) */ -+ -+#define BIT_SHIFT_TXDMA_LEN_TH1 0 -+#define BIT_MASK_TXDMA_LEN_TH1 0xffff -+#define BIT_TXDMA_LEN_TH1(x) \ -+ (((x) & BIT_MASK_TXDMA_LEN_TH1) << BIT_SHIFT_TXDMA_LEN_TH1) -+#define BITS_TXDMA_LEN_TH1 (BIT_MASK_TXDMA_LEN_TH1 << BIT_SHIFT_TXDMA_LEN_TH1) -+#define BIT_CLEAR_TXDMA_LEN_TH1(x) ((x) & (~BITS_TXDMA_LEN_TH1)) -+#define BIT_GET_TXDMA_LEN_TH1(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_LEN_TH1) & BIT_MASK_TXDMA_LEN_TH1) -+#define BIT_SET_TXDMA_LEN_TH1(x, v) \ -+ (BIT_CLEAR_TXDMA_LEN_TH1(x) | BIT_TXDMA_LEN_TH1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TXDMA_LEN_THRESHOLD (Offset 0x11D4) */ -+ -+#define BIT_SHIFT_TDE_LEN_TH0 0 -+#define BIT_MASK_TDE_LEN_TH0 0xffff -+#define BIT_TDE_LEN_TH0(x) \ -+ (((x) & BIT_MASK_TDE_LEN_TH0) << BIT_SHIFT_TDE_LEN_TH0) -+#define BITS_TDE_LEN_TH0 (BIT_MASK_TDE_LEN_TH0 << BIT_SHIFT_TDE_LEN_TH0) -+#define BIT_CLEAR_TDE_LEN_TH0(x) ((x) & (~BITS_TDE_LEN_TH0)) -+#define BIT_GET_TDE_LEN_TH0(x) \ -+ (((x) >> BIT_SHIFT_TDE_LEN_TH0) & BIT_MASK_TDE_LEN_TH0) -+#define BIT_SET_TDE_LEN_TH0(x, v) \ -+ (BIT_CLEAR_TDE_LEN_TH0(x) | BIT_TDE_LEN_TH0(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RDE_LEN_TH (Offset 0x11D8) */ -+ -+#define BIT_SHIFT_RXDMA_LEN_TH0 16 -+#define BIT_MASK_RXDMA_LEN_TH0 0xffff -+#define BIT_RXDMA_LEN_TH0(x) \ -+ (((x) & BIT_MASK_RXDMA_LEN_TH0) << BIT_SHIFT_RXDMA_LEN_TH0) -+#define BITS_RXDMA_LEN_TH0 (BIT_MASK_RXDMA_LEN_TH0 << BIT_SHIFT_RXDMA_LEN_TH0) -+#define BIT_CLEAR_RXDMA_LEN_TH0(x) ((x) & (~BITS_RXDMA_LEN_TH0)) -+#define BIT_GET_RXDMA_LEN_TH0(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_LEN_TH0) & BIT_MASK_RXDMA_LEN_TH0) -+#define BIT_SET_RXDMA_LEN_TH0(x, v) \ -+ (BIT_CLEAR_RXDMA_LEN_TH0(x) | BIT_RXDMA_LEN_TH0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_LEN_THRESHOLD (Offset 0x11D8) */ -+ -+#define BIT_SHIFT_RDE_LEN_TH1 16 -+#define BIT_MASK_RDE_LEN_TH1 0xffff -+#define BIT_RDE_LEN_TH1(x) \ -+ (((x) & BIT_MASK_RDE_LEN_TH1) << BIT_SHIFT_RDE_LEN_TH1) -+#define BITS_RDE_LEN_TH1 (BIT_MASK_RDE_LEN_TH1 << BIT_SHIFT_RDE_LEN_TH1) -+#define BIT_CLEAR_RDE_LEN_TH1(x) ((x) & (~BITS_RDE_LEN_TH1)) -+#define BIT_GET_RDE_LEN_TH1(x) \ -+ (((x) >> BIT_SHIFT_RDE_LEN_TH1) & BIT_MASK_RDE_LEN_TH1) -+#define BIT_SET_RDE_LEN_TH1(x, v) \ -+ (BIT_CLEAR_RDE_LEN_TH1(x) | BIT_RDE_LEN_TH1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_RDE_LEN_TH (Offset 0x11D8) */ -+ -+#define BIT_SHIFT_RXDMA_LEN_TH1 0 -+#define BIT_MASK_RXDMA_LEN_TH1 0xffff -+#define BIT_RXDMA_LEN_TH1(x) \ -+ (((x) & BIT_MASK_RXDMA_LEN_TH1) << BIT_SHIFT_RXDMA_LEN_TH1) -+#define BITS_RXDMA_LEN_TH1 (BIT_MASK_RXDMA_LEN_TH1 << BIT_SHIFT_RXDMA_LEN_TH1) -+#define BIT_CLEAR_RXDMA_LEN_TH1(x) ((x) & (~BITS_RXDMA_LEN_TH1)) -+#define BIT_GET_RXDMA_LEN_TH1(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_LEN_TH1) & BIT_MASK_RXDMA_LEN_TH1) -+#define BIT_SET_RXDMA_LEN_TH1(x, v) \ -+ (BIT_CLEAR_RXDMA_LEN_TH1(x) | BIT_RXDMA_LEN_TH1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXDMA_LEN_THRESHOLD (Offset 0x11D8) */ -+ -+#define BIT_SHIFT_RDE_LEN_TH0 0 -+#define BIT_MASK_RDE_LEN_TH0 0xffff -+#define BIT_RDE_LEN_TH0(x) \ -+ (((x) & BIT_MASK_RDE_LEN_TH0) << BIT_SHIFT_RDE_LEN_TH0) -+#define BITS_RDE_LEN_TH0 (BIT_MASK_RDE_LEN_TH0 << BIT_SHIFT_RDE_LEN_TH0) -+#define BIT_CLEAR_RDE_LEN_TH0(x) ((x) & (~BITS_RDE_LEN_TH0)) -+#define BIT_GET_RDE_LEN_TH0(x) \ -+ (((x) >> BIT_SHIFT_RDE_LEN_TH0) & BIT_MASK_RDE_LEN_TH0) -+#define BIT_SET_RDE_LEN_TH0(x, v) \ -+ (BIT_CLEAR_RDE_LEN_TH0(x) | BIT_RDE_LEN_TH0(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PCIE_EXEC_TIME (Offset 0x11DC) */ -+ -+#define BIT_SHIFT_COUNTER_INTERVAL_SEL 16 -+#define BIT_MASK_COUNTER_INTERVAL_SEL 0x3 -+#define BIT_COUNTER_INTERVAL_SEL(x) \ -+ (((x) & BIT_MASK_COUNTER_INTERVAL_SEL) \ -+ << BIT_SHIFT_COUNTER_INTERVAL_SEL) -+#define BITS_COUNTER_INTERVAL_SEL \ -+ (BIT_MASK_COUNTER_INTERVAL_SEL << BIT_SHIFT_COUNTER_INTERVAL_SEL) -+#define BIT_CLEAR_COUNTER_INTERVAL_SEL(x) ((x) & (~BITS_COUNTER_INTERVAL_SEL)) -+#define BIT_GET_COUNTER_INTERVAL_SEL(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_INTERVAL_SEL) & \ -+ BIT_MASK_COUNTER_INTERVAL_SEL) -+#define BIT_SET_COUNTER_INTERVAL_SEL(x, v) \ -+ (BIT_CLEAR_COUNTER_INTERVAL_SEL(x) | BIT_COUNTER_INTERVAL_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_EXEC_TIME_THRESHOLD (Offset 0x11DC) */ -+ -+#define BIT_SHIFT_COUNT_INT_SEL 16 -+#define BIT_MASK_COUNT_INT_SEL 0x3 -+#define BIT_COUNT_INT_SEL(x) \ -+ (((x) & BIT_MASK_COUNT_INT_SEL) << BIT_SHIFT_COUNT_INT_SEL) -+#define BITS_COUNT_INT_SEL (BIT_MASK_COUNT_INT_SEL << BIT_SHIFT_COUNT_INT_SEL) -+#define BIT_CLEAR_COUNT_INT_SEL(x) ((x) & (~BITS_COUNT_INT_SEL)) -+#define BIT_GET_COUNT_INT_SEL(x) \ -+ (((x) >> BIT_SHIFT_COUNT_INT_SEL) & BIT_MASK_COUNT_INT_SEL) -+#define BIT_SET_COUNT_INT_SEL(x, v) \ -+ (BIT_CLEAR_COUNT_INT_SEL(x) | BIT_COUNT_INT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+/* 2 REG_PCIE_EXEC_TIME (Offset 0x11DC) */ -+ -+#define BIT_SHIFT_PCIE_TRANS_DATA_TH1 0 -+#define BIT_MASK_PCIE_TRANS_DATA_TH1 0xffff -+#define BIT_PCIE_TRANS_DATA_TH1(x) \ -+ (((x) & BIT_MASK_PCIE_TRANS_DATA_TH1) << BIT_SHIFT_PCIE_TRANS_DATA_TH1) -+#define BITS_PCIE_TRANS_DATA_TH1 \ -+ (BIT_MASK_PCIE_TRANS_DATA_TH1 << BIT_SHIFT_PCIE_TRANS_DATA_TH1) -+#define BIT_CLEAR_PCIE_TRANS_DATA_TH1(x) ((x) & (~BITS_PCIE_TRANS_DATA_TH1)) -+#define BIT_GET_PCIE_TRANS_DATA_TH1(x) \ -+ (((x) >> BIT_SHIFT_PCIE_TRANS_DATA_TH1) & BIT_MASK_PCIE_TRANS_DATA_TH1) -+#define BIT_SET_PCIE_TRANS_DATA_TH1(x, v) \ -+ (BIT_CLEAR_PCIE_TRANS_DATA_TH1(x) | BIT_PCIE_TRANS_DATA_TH1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_EXEC_TIME_THRESHOLD (Offset 0x11DC) */ -+ -+#define BIT_SHIFT_EXEC_TIME_TH 0 -+#define BIT_MASK_EXEC_TIME_TH 0xffff -+#define BIT_EXEC_TIME_TH(x) \ -+ (((x) & BIT_MASK_EXEC_TIME_TH) << BIT_SHIFT_EXEC_TIME_TH) -+#define BITS_EXEC_TIME_TH (BIT_MASK_EXEC_TIME_TH << BIT_SHIFT_EXEC_TIME_TH) -+#define BIT_CLEAR_EXEC_TIME_TH(x) ((x) & (~BITS_EXEC_TIME_TH)) -+#define BIT_GET_EXEC_TIME_TH(x) \ -+ (((x) >> BIT_SHIFT_EXEC_TIME_TH) & BIT_MASK_EXEC_TIME_TH) -+#define BIT_SET_EXEC_TIME_TH(x, v) \ -+ (BIT_CLEAR_EXEC_TIME_TH(x) | BIT_EXEC_TIME_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT4_RX_UCMD1_UAPSD0_OK_INT_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI3_RX_UAPSDMD1_EN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT4_RX_UCMD0_UAPSD0_OK_INT_EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI3_RX_UAPSDMD0_EN BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT4_TRIPKT_OK_INT_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI3_TRIGGER_PKT_EN BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT4_RX_EOSP_OK_INT_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI3_EOSP_INT_EN BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT3_RX_UCMD1_UAPSD0_OK_INT_EN BIT(27) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI2_RX_UAPSDMD1_EN BIT(27) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT3_RX_UCMD0_UAPSD0_OK_INT_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI2_RX_UAPSDMD0_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT3_TRIPKT_OK_INT_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI2_TRIGGER_PKT_EN BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT3_RX_EOSP_OK_INT_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI2_EOSP_INT_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT2_RX_UCMD1_UAPSD0_OK_INT_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI1_RX_UAPSDMD1_EN BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT2_RX_UCMD0_UAPSD0_OK_INT_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI1_RX_UAPSDMD0_EN BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT2_TRIPKT_OK_INT_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI1_TRIGGER_PKT_EN BIT(21) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT2_RX_EOSP_OK_INT_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI1_EOSP_INT_EN BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT1_RX_UCMD1_UAPSD0_OK_INT_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI0_RX_UAPSDMD1_EN BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT1_RX_UCMD0_UAPSD0_OK_INT_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI0_RX_UAPSDMD0_EN BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT1_TRIPKT_OK_INT_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI0_TRIGGER_PKT_EN BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT1_RX_EOSP_OK_INT_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI0_EOSP_INT_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_NOA2_TSFT_BIT32_TOGGLE_INT_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_NOA1_TSFT_BIT32_TOGGLE_INT_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_EN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT4_TX_NULL1_DONE_INT_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI3_TX_NULL1_INT_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT4_TX_NULL0_DONE_INT_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI3_TX_NULL0_INT_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT3_TX_NULL1_DONE_INT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI2_TX_NULL1_INT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT3_TX_NULL0_DONE_INT_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI2_TX_NULL0_INT_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT2_TX_NULL1_DONE_INT_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI1_TX_NULL1_INT_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT2_TX_NULL0_DONE_INT_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI1_TX_NULL0_INT_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT1_TX_NULL1_DONE_INT_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI0_TX_NULL1_INT_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_PORT1_TX_NULL0_DONE_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2IMR (Offset 0x11E0) */ -+ -+#define BIT_FS_CLI0_TX_NULL0_INT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT4_RX_UCMD1_UAPSD0_OK_INT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI3_RX_UAPSDMD1_INT BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT4_RX_UCMD0_UAPSD0_OK_INT BIT(30) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI3_RX_UAPSDMD0_INT BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT4_TRIPKT_OK_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI3_TRIGGER_PKT_INT BIT(29) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT4_RX_EOSP_OK_INT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI3_EOSP_INT BIT(28) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT3_RX_UCMD1_UAPSD0_OK_INT BIT(27) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI2_RX_UAPSDMD1_INT BIT(27) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT3_RX_UCMD0_UAPSD0_OK_INT BIT(26) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI2_RX_UAPSDMD0_INT BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT3_TRIPKT_OK_INT BIT(25) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI2_TRIGGER_PKT_INT BIT(25) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT3_RX_EOSP_OK_INT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI2_EOSP_INT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT2_RX_UCMD1_UAPSD0_OK_INT BIT(23) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI1_RX_UAPSDMD1_INT BIT(23) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT2_RX_UCMD0_UAPSD0_OK_INT BIT(22) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI1_RX_UAPSDMD0_INT BIT(22) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT2_TRIPKT_OK_INT BIT(21) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI1_TRIGGER_PKT_INT BIT(21) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT2_RX_EOSP_OK_INT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI1_EOSP_INT BIT(20) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT1_RX_UCMD1_UAPSD0_OK_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI0_RX_UAPSDMD1_INT BIT(19) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT1_RX_UCMD0_UAPSD0_OK_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI0_RX_UAPSDMD0_INT BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT1_TRIPKT_OK_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI0_TRIGGER_PKT_INT BIT(17) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT1_RX_EOSP_OK_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI0_EOSP_INT BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_NOA2_TSFT_BIT32_TOGGLE_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_INT BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_NOA1_TSFT_BIT32_TOGGLE_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_INT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT4_TX_NULL1_DONE_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI3_TX_NULL1_INT BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT4_TX_NULL0_DONE_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI3_TX_NULL0_INT BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT3_TX_NULL1_DONE_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI2_TX_NULL1_INT BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT3_TX_NULL0_DONE_INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI2_TX_NULL0_INT BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT2_TX_NULL1_DONE_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI1_TX_NULL1_INT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT2_TX_NULL0_DONE_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI1_TX_NULL0_INT BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT1_TX_NULL1_DONE_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI0_TX_NULL1_INT BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_PORT1_TX_NULL0_DONE_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FT2ISR (Offset 0x11E4) */ -+ -+#define BIT_FS_CLI0_TX_NULL0_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MSG2 (Offset 0x11F0) */ -+ -+#define BIT_SHIFT_FW_MSG2 0 -+#define BIT_MASK_FW_MSG2 0xffffffffL -+#define BIT_FW_MSG2(x) (((x) & BIT_MASK_FW_MSG2) << BIT_SHIFT_FW_MSG2) -+#define BITS_FW_MSG2 (BIT_MASK_FW_MSG2 << BIT_SHIFT_FW_MSG2) -+#define BIT_CLEAR_FW_MSG2(x) ((x) & (~BITS_FW_MSG2)) -+#define BIT_GET_FW_MSG2(x) (((x) >> BIT_SHIFT_FW_MSG2) & BIT_MASK_FW_MSG2) -+#define BIT_SET_FW_MSG2(x, v) (BIT_CLEAR_FW_MSG2(x) | BIT_FW_MSG2(v)) -+ -+/* 2 REG_MSG3 (Offset 0x11F4) */ -+ -+#define BIT_SHIFT_FW_MSG3 0 -+#define BIT_MASK_FW_MSG3 0xffffffffL -+#define BIT_FW_MSG3(x) (((x) & BIT_MASK_FW_MSG3) << BIT_SHIFT_FW_MSG3) -+#define BITS_FW_MSG3 (BIT_MASK_FW_MSG3 << BIT_SHIFT_FW_MSG3) -+#define BIT_CLEAR_FW_MSG3(x) ((x) & (~BITS_FW_MSG3)) -+#define BIT_GET_FW_MSG3(x) (((x) >> BIT_SHIFT_FW_MSG3) & BIT_MASK_FW_MSG3) -+#define BIT_SET_FW_MSG3(x, v) (BIT_CLEAR_FW_MSG3(x) | BIT_FW_MSG3(v)) -+ -+/* 2 REG_MSG4 (Offset 0x11F8) */ -+ -+#define BIT_SHIFT_FW_MSG4 0 -+#define BIT_MASK_FW_MSG4 0xffffffffL -+#define BIT_FW_MSG4(x) (((x) & BIT_MASK_FW_MSG4) << BIT_SHIFT_FW_MSG4) -+#define BITS_FW_MSG4 (BIT_MASK_FW_MSG4 << BIT_SHIFT_FW_MSG4) -+#define BIT_CLEAR_FW_MSG4(x) ((x) & (~BITS_FW_MSG4)) -+#define BIT_GET_FW_MSG4(x) (((x) >> BIT_SHIFT_FW_MSG4) & BIT_MASK_FW_MSG4) -+#define BIT_SET_FW_MSG4(x, v) (BIT_CLEAR_FW_MSG4(x) | BIT_FW_MSG4(v)) -+ -+/* 2 REG_MSG5 (Offset 0x11FC) */ -+ -+#define BIT_SHIFT_FW_MSG5 0 -+#define BIT_MASK_FW_MSG5 0xffffffffL -+#define BIT_FW_MSG5(x) (((x) & BIT_MASK_FW_MSG5) << BIT_SHIFT_FW_MSG5) -+#define BITS_FW_MSG5 (BIT_MASK_FW_MSG5 << BIT_SHIFT_FW_MSG5) -+#define BIT_CLEAR_FW_MSG5(x) ((x) & (~BITS_FW_MSG5)) -+#define BIT_GET_FW_MSG5(x) (((x) >> BIT_SHIFT_FW_MSG5) & BIT_MASK_FW_MSG5) -+#define BIT_SET_FW_MSG5(x, v) (BIT_CLEAR_FW_MSG5(x) | BIT_FW_MSG5(v)) -+ -+/* 2 REG_DDMA_CH0SA (Offset 0x1200) */ -+ -+#define BIT_SHIFT_DDMACH0_SA 0 -+#define BIT_MASK_DDMACH0_SA 0xffffffffL -+#define BIT_DDMACH0_SA(x) (((x) & BIT_MASK_DDMACH0_SA) << BIT_SHIFT_DDMACH0_SA) -+#define BITS_DDMACH0_SA (BIT_MASK_DDMACH0_SA << BIT_SHIFT_DDMACH0_SA) -+#define BIT_CLEAR_DDMACH0_SA(x) ((x) & (~BITS_DDMACH0_SA)) -+#define BIT_GET_DDMACH0_SA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_SA) & BIT_MASK_DDMACH0_SA) -+#define BIT_SET_DDMACH0_SA(x, v) (BIT_CLEAR_DDMACH0_SA(x) | BIT_DDMACH0_SA(v)) -+ -+/* 2 REG_DDMA_CH0DA (Offset 0x1204) */ -+ -+#define BIT_SHIFT_DDMACH0_DA 0 -+#define BIT_MASK_DDMACH0_DA 0xffffffffL -+#define BIT_DDMACH0_DA(x) (((x) & BIT_MASK_DDMACH0_DA) << BIT_SHIFT_DDMACH0_DA) -+#define BITS_DDMACH0_DA (BIT_MASK_DDMACH0_DA << BIT_SHIFT_DDMACH0_DA) -+#define BIT_CLEAR_DDMACH0_DA(x) ((x) & (~BITS_DDMACH0_DA)) -+#define BIT_GET_DDMACH0_DA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DA) & BIT_MASK_DDMACH0_DA) -+#define BIT_SET_DDMACH0_DA(x, v) (BIT_CLEAR_DDMACH0_DA(x) | BIT_DDMACH0_DA(v)) -+ -+/* 2 REG_DDMA_CH0CTRL (Offset 0x1208) */ -+ -+#define BIT_DDMACH0_OWN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH0CTRL (Offset 0x1208) */ -+ -+#define BIT_DDMACH0_IDMEM_ERR BIT(30) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DDMA_CH0CTRL (Offset 0x1208) */ -+ -+#define BIT_DDMACH0_ERR_MON BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH0CTRL (Offset 0x1208) */ -+ -+#define BIT_DDMACH0_CHKSUM_EN BIT(29) -+#define BIT_DDMACH0_DA_W_DISABLE BIT(28) -+#define BIT_DDMACH0_CHKSUM_STS BIT(27) -+#define BIT_DDMACH0_DDMA_MODE BIT(26) -+#define BIT_DDMACH0_RESET_CHKSUM_STS BIT(25) -+#define BIT_DDMACH0_CHKSUM_CONT BIT(24) -+ -+#define BIT_SHIFT_DDMACH0_DLEN 0 -+#define BIT_MASK_DDMACH0_DLEN 0x3ffff -+#define BIT_DDMACH0_DLEN(x) \ -+ (((x) & BIT_MASK_DDMACH0_DLEN) << BIT_SHIFT_DDMACH0_DLEN) -+#define BITS_DDMACH0_DLEN (BIT_MASK_DDMACH0_DLEN << BIT_SHIFT_DDMACH0_DLEN) -+#define BIT_CLEAR_DDMACH0_DLEN(x) ((x) & (~BITS_DDMACH0_DLEN)) -+#define BIT_GET_DDMACH0_DLEN(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DLEN) & BIT_MASK_DDMACH0_DLEN) -+#define BIT_SET_DDMACH0_DLEN(x, v) \ -+ (BIT_CLEAR_DDMACH0_DLEN(x) | BIT_DDMACH0_DLEN(v)) -+ -+/* 2 REG_DDMA_CH1SA (Offset 0x1210) */ -+ -+#define BIT_SHIFT_DDMACH1_SA 0 -+#define BIT_MASK_DDMACH1_SA 0xffffffffL -+#define BIT_DDMACH1_SA(x) (((x) & BIT_MASK_DDMACH1_SA) << BIT_SHIFT_DDMACH1_SA) -+#define BITS_DDMACH1_SA (BIT_MASK_DDMACH1_SA << BIT_SHIFT_DDMACH1_SA) -+#define BIT_CLEAR_DDMACH1_SA(x) ((x) & (~BITS_DDMACH1_SA)) -+#define BIT_GET_DDMACH1_SA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_SA) & BIT_MASK_DDMACH1_SA) -+#define BIT_SET_DDMACH1_SA(x, v) (BIT_CLEAR_DDMACH1_SA(x) | BIT_DDMACH1_SA(v)) -+ -+/* 2 REG_DDMA_CH1DA (Offset 0x1214) */ -+ -+#define BIT_SHIFT_DDMACH1_DA 0 -+#define BIT_MASK_DDMACH1_DA 0xffffffffL -+#define BIT_DDMACH1_DA(x) (((x) & BIT_MASK_DDMACH1_DA) << BIT_SHIFT_DDMACH1_DA) -+#define BITS_DDMACH1_DA (BIT_MASK_DDMACH1_DA << BIT_SHIFT_DDMACH1_DA) -+#define BIT_CLEAR_DDMACH1_DA(x) ((x) & (~BITS_DDMACH1_DA)) -+#define BIT_GET_DDMACH1_DA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DA) & BIT_MASK_DDMACH1_DA) -+#define BIT_SET_DDMACH1_DA(x, v) (BIT_CLEAR_DDMACH1_DA(x) | BIT_DDMACH1_DA(v)) -+ -+/* 2 REG_DDMA_CH1CTRL (Offset 0x1218) */ -+ -+#define BIT_DDMACH1_OWN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH1CTRL (Offset 0x1218) */ -+ -+#define BIT_DDMACH1_IDMEM_ERR BIT(30) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DDMA_CH1CTRL (Offset 0x1218) */ -+ -+#define BIT_DDMACH1_ERR_MON BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH1CTRL (Offset 0x1218) */ -+ -+#define BIT_DDMACH1_CHKSUM_EN BIT(29) -+#define BIT_DDMACH1_DA_W_DISABLE BIT(28) -+#define BIT_DDMACH1_CHKSUM_STS BIT(27) -+#define BIT_DDMACH1_DDMA_MODE BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_DDMA_CH1CTRL (Offset 0x1218) */ -+ -+#define BIT_DDMACH1_RESET_CHKSUM_STS BIT(25) -+#define BIT_DDMACH1_CHKSUM_CONT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH1CTRL (Offset 0x1218) */ -+ -+#define BIT_SHIFT_DDMACH1_DLEN 0 -+#define BIT_MASK_DDMACH1_DLEN 0x3ffff -+#define BIT_DDMACH1_DLEN(x) \ -+ (((x) & BIT_MASK_DDMACH1_DLEN) << BIT_SHIFT_DDMACH1_DLEN) -+#define BITS_DDMACH1_DLEN (BIT_MASK_DDMACH1_DLEN << BIT_SHIFT_DDMACH1_DLEN) -+#define BIT_CLEAR_DDMACH1_DLEN(x) ((x) & (~BITS_DDMACH1_DLEN)) -+#define BIT_GET_DDMACH1_DLEN(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DLEN) & BIT_MASK_DDMACH1_DLEN) -+#define BIT_SET_DDMACH1_DLEN(x, v) \ -+ (BIT_CLEAR_DDMACH1_DLEN(x) | BIT_DDMACH1_DLEN(v)) -+ -+/* 2 REG_DDMA_CH2SA (Offset 0x1220) */ -+ -+#define BIT_SHIFT_DDMACH2_SA 0 -+#define BIT_MASK_DDMACH2_SA 0xffffffffL -+#define BIT_DDMACH2_SA(x) (((x) & BIT_MASK_DDMACH2_SA) << BIT_SHIFT_DDMACH2_SA) -+#define BITS_DDMACH2_SA (BIT_MASK_DDMACH2_SA << BIT_SHIFT_DDMACH2_SA) -+#define BIT_CLEAR_DDMACH2_SA(x) ((x) & (~BITS_DDMACH2_SA)) -+#define BIT_GET_DDMACH2_SA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_SA) & BIT_MASK_DDMACH2_SA) -+#define BIT_SET_DDMACH2_SA(x, v) (BIT_CLEAR_DDMACH2_SA(x) | BIT_DDMACH2_SA(v)) -+ -+/* 2 REG_DDMA_CH2DA (Offset 0x1224) */ -+ -+#define BIT_SHIFT_DDMACH2_DA 0 -+#define BIT_MASK_DDMACH2_DA 0xffffffffL -+#define BIT_DDMACH2_DA(x) (((x) & BIT_MASK_DDMACH2_DA) << BIT_SHIFT_DDMACH2_DA) -+#define BITS_DDMACH2_DA (BIT_MASK_DDMACH2_DA << BIT_SHIFT_DDMACH2_DA) -+#define BIT_CLEAR_DDMACH2_DA(x) ((x) & (~BITS_DDMACH2_DA)) -+#define BIT_GET_DDMACH2_DA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DA) & BIT_MASK_DDMACH2_DA) -+#define BIT_SET_DDMACH2_DA(x, v) (BIT_CLEAR_DDMACH2_DA(x) | BIT_DDMACH2_DA(v)) -+ -+/* 2 REG_DDMA_CH2CTRL (Offset 0x1228) */ -+ -+#define BIT_DDMACH2_OWN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH2CTRL (Offset 0x1228) */ -+ -+#define BIT_DDMACH2_IDMEM_ERR BIT(30) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DDMA_CH2CTRL (Offset 0x1228) */ -+ -+#define BIT_DDMACH2_ERR_MON BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH2CTRL (Offset 0x1228) */ -+ -+#define BIT_DDMACH2_CHKSUM_EN BIT(29) -+#define BIT_DDMACH2_DA_W_DISABLE BIT(28) -+#define BIT_DDMACH2_CHKSUM_STS BIT(27) -+#define BIT_DDMACH2_DDMA_MODE BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_DDMA_CH2CTRL (Offset 0x1228) */ -+ -+#define BIT_DDMACH2_RESET_CHKSUM_STS BIT(25) -+#define BIT_DDMACH2_CHKSUM_CONT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH2CTRL (Offset 0x1228) */ -+ -+#define BIT_SHIFT_DDMACH2_DLEN 0 -+#define BIT_MASK_DDMACH2_DLEN 0x3ffff -+#define BIT_DDMACH2_DLEN(x) \ -+ (((x) & BIT_MASK_DDMACH2_DLEN) << BIT_SHIFT_DDMACH2_DLEN) -+#define BITS_DDMACH2_DLEN (BIT_MASK_DDMACH2_DLEN << BIT_SHIFT_DDMACH2_DLEN) -+#define BIT_CLEAR_DDMACH2_DLEN(x) ((x) & (~BITS_DDMACH2_DLEN)) -+#define BIT_GET_DDMACH2_DLEN(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DLEN) & BIT_MASK_DDMACH2_DLEN) -+#define BIT_SET_DDMACH2_DLEN(x, v) \ -+ (BIT_CLEAR_DDMACH2_DLEN(x) | BIT_DDMACH2_DLEN(v)) -+ -+/* 2 REG_DDMA_CH3SA (Offset 0x1230) */ -+ -+#define BIT_SHIFT_DDMACH3_SA 0 -+#define BIT_MASK_DDMACH3_SA 0xffffffffL -+#define BIT_DDMACH3_SA(x) (((x) & BIT_MASK_DDMACH3_SA) << BIT_SHIFT_DDMACH3_SA) -+#define BITS_DDMACH3_SA (BIT_MASK_DDMACH3_SA << BIT_SHIFT_DDMACH3_SA) -+#define BIT_CLEAR_DDMACH3_SA(x) ((x) & (~BITS_DDMACH3_SA)) -+#define BIT_GET_DDMACH3_SA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_SA) & BIT_MASK_DDMACH3_SA) -+#define BIT_SET_DDMACH3_SA(x, v) (BIT_CLEAR_DDMACH3_SA(x) | BIT_DDMACH3_SA(v)) -+ -+/* 2 REG_DDMA_CH3DA (Offset 0x1234) */ -+ -+#define BIT_SHIFT_DDMACH3_DA 0 -+#define BIT_MASK_DDMACH3_DA 0xffffffffL -+#define BIT_DDMACH3_DA(x) (((x) & BIT_MASK_DDMACH3_DA) << BIT_SHIFT_DDMACH3_DA) -+#define BITS_DDMACH3_DA (BIT_MASK_DDMACH3_DA << BIT_SHIFT_DDMACH3_DA) -+#define BIT_CLEAR_DDMACH3_DA(x) ((x) & (~BITS_DDMACH3_DA)) -+#define BIT_GET_DDMACH3_DA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DA) & BIT_MASK_DDMACH3_DA) -+#define BIT_SET_DDMACH3_DA(x, v) (BIT_CLEAR_DDMACH3_DA(x) | BIT_DDMACH3_DA(v)) -+ -+/* 2 REG_DDMA_CH3CTRL (Offset 0x1238) */ -+ -+#define BIT_DDMACH3_OWN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH3CTRL (Offset 0x1238) */ -+ -+#define BIT_DDMACH3_IDMEM_ERR BIT(30) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DDMA_CH3CTRL (Offset 0x1238) */ -+ -+#define BIT_DDMACH3_ERR_MON BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH3CTRL (Offset 0x1238) */ -+ -+#define BIT_DDMACH3_CHKSUM_EN BIT(29) -+#define BIT_DDMACH3_DA_W_DISABLE BIT(28) -+#define BIT_DDMACH3_CHKSUM_STS BIT(27) -+#define BIT_DDMACH3_DDMA_MODE BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_DDMA_CH3CTRL (Offset 0x1238) */ -+ -+#define BIT_DDMACH3_RESET_CHKSUM_STS BIT(25) -+#define BIT_DDMACH3_CHKSUM_CONT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH3CTRL (Offset 0x1238) */ -+ -+#define BIT_SHIFT_DDMACH3_DLEN 0 -+#define BIT_MASK_DDMACH3_DLEN 0x3ffff -+#define BIT_DDMACH3_DLEN(x) \ -+ (((x) & BIT_MASK_DDMACH3_DLEN) << BIT_SHIFT_DDMACH3_DLEN) -+#define BITS_DDMACH3_DLEN (BIT_MASK_DDMACH3_DLEN << BIT_SHIFT_DDMACH3_DLEN) -+#define BIT_CLEAR_DDMACH3_DLEN(x) ((x) & (~BITS_DDMACH3_DLEN)) -+#define BIT_GET_DDMACH3_DLEN(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DLEN) & BIT_MASK_DDMACH3_DLEN) -+#define BIT_SET_DDMACH3_DLEN(x, v) \ -+ (BIT_CLEAR_DDMACH3_DLEN(x) | BIT_DDMACH3_DLEN(v)) -+ -+/* 2 REG_DDMA_CH4SA (Offset 0x1240) */ -+ -+#define BIT_SHIFT_DDMACH4_SA 0 -+#define BIT_MASK_DDMACH4_SA 0xffffffffL -+#define BIT_DDMACH4_SA(x) (((x) & BIT_MASK_DDMACH4_SA) << BIT_SHIFT_DDMACH4_SA) -+#define BITS_DDMACH4_SA (BIT_MASK_DDMACH4_SA << BIT_SHIFT_DDMACH4_SA) -+#define BIT_CLEAR_DDMACH4_SA(x) ((x) & (~BITS_DDMACH4_SA)) -+#define BIT_GET_DDMACH4_SA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_SA) & BIT_MASK_DDMACH4_SA) -+#define BIT_SET_DDMACH4_SA(x, v) (BIT_CLEAR_DDMACH4_SA(x) | BIT_DDMACH4_SA(v)) -+ -+/* 2 REG_DDMA_CH4DA (Offset 0x1244) */ -+ -+#define BIT_SHIFT_DDMACH4_DA 0 -+#define BIT_MASK_DDMACH4_DA 0xffffffffL -+#define BIT_DDMACH4_DA(x) (((x) & BIT_MASK_DDMACH4_DA) << BIT_SHIFT_DDMACH4_DA) -+#define BITS_DDMACH4_DA (BIT_MASK_DDMACH4_DA << BIT_SHIFT_DDMACH4_DA) -+#define BIT_CLEAR_DDMACH4_DA(x) ((x) & (~BITS_DDMACH4_DA)) -+#define BIT_GET_DDMACH4_DA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DA) & BIT_MASK_DDMACH4_DA) -+#define BIT_SET_DDMACH4_DA(x, v) (BIT_CLEAR_DDMACH4_DA(x) | BIT_DDMACH4_DA(v)) -+ -+/* 2 REG_DDMA_CH4CTRL (Offset 0x1248) */ -+ -+#define BIT_DDMACH4_OWN BIT(31) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH4CTRL (Offset 0x1248) */ -+ -+#define BIT_DDMACH4_IDMEM_ERR BIT(30) -+#define BIT_DDMACH5_IDMEM_ERR BIT(30) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_DDMA_CH4CTRL (Offset 0x1248) */ -+ -+#define BIT_DDMACH4_ERR_MON BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH4CTRL (Offset 0x1248) */ -+ -+#define BIT_DDMACH4_CHKSUM_EN BIT(29) -+#define BIT_DDMACH4_DA_W_DISABLE BIT(28) -+#define BIT_DDMACH4_CHKSUM_STS BIT(27) -+#define BIT_DDMACH4_DDMA_MODE BIT(26) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_DDMA_CH4CTRL (Offset 0x1248) */ -+ -+#define BIT_DDMACH4_RESET_CHKSUM_STS BIT(25) -+#define BIT_DDMACH5_RESET_CHKSUM_STS BIT(25) -+#define BIT_DDMACH4_CHKSUM_CONT BIT(24) -+#define BIT_DDMACH5_CHKSUM_CONT BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_CH4CTRL (Offset 0x1248) */ -+ -+#define BIT_SHIFT_DDMACH4_DLEN 0 -+#define BIT_MASK_DDMACH4_DLEN 0x3ffff -+#define BIT_DDMACH4_DLEN(x) \ -+ (((x) & BIT_MASK_DDMACH4_DLEN) << BIT_SHIFT_DDMACH4_DLEN) -+#define BITS_DDMACH4_DLEN (BIT_MASK_DDMACH4_DLEN << BIT_SHIFT_DDMACH4_DLEN) -+#define BIT_CLEAR_DDMACH4_DLEN(x) ((x) & (~BITS_DDMACH4_DLEN)) -+#define BIT_GET_DDMACH4_DLEN(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DLEN) & BIT_MASK_DDMACH4_DLEN) -+#define BIT_SET_DDMACH4_DLEN(x, v) \ -+ (BIT_CLEAR_DDMACH4_DLEN(x) | BIT_DDMACH4_DLEN(v)) -+ -+/* 2 REG_DDMA_CH5SA (Offset 0x1250) */ -+ -+#define BIT_SHIFT_DDMACH5_SA 0 -+#define BIT_MASK_DDMACH5_SA 0xffffffffL -+#define BIT_DDMACH5_SA(x) (((x) & BIT_MASK_DDMACH5_SA) << BIT_SHIFT_DDMACH5_SA) -+#define BITS_DDMACH5_SA (BIT_MASK_DDMACH5_SA << BIT_SHIFT_DDMACH5_SA) -+#define BIT_CLEAR_DDMACH5_SA(x) ((x) & (~BITS_DDMACH5_SA)) -+#define BIT_GET_DDMACH5_SA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_SA) & BIT_MASK_DDMACH5_SA) -+#define BIT_SET_DDMACH5_SA(x, v) (BIT_CLEAR_DDMACH5_SA(x) | BIT_DDMACH5_SA(v)) -+ -+/* 2 REG_DDMA_CH5DA (Offset 0x1254) */ -+ -+#define BIT_DDMACH5_OWN BIT(31) -+#define BIT_DDMACH5_CHKSUM_EN BIT(29) -+#define BIT_DDMACH5_DA_W_DISABLE BIT(28) -+#define BIT_DDMACH5_CHKSUM_STS BIT(27) -+#define BIT_DDMACH5_DDMA_MODE BIT(26) -+ -+#define BIT_SHIFT_DDMACH5_DA 0 -+#define BIT_MASK_DDMACH5_DA 0xffffffffL -+#define BIT_DDMACH5_DA(x) (((x) & BIT_MASK_DDMACH5_DA) << BIT_SHIFT_DDMACH5_DA) -+#define BITS_DDMACH5_DA (BIT_MASK_DDMACH5_DA << BIT_SHIFT_DDMACH5_DA) -+#define BIT_CLEAR_DDMACH5_DA(x) ((x) & (~BITS_DDMACH5_DA)) -+#define BIT_GET_DDMACH5_DA(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DA) & BIT_MASK_DDMACH5_DA) -+#define BIT_SET_DDMACH5_DA(x, v) (BIT_CLEAR_DDMACH5_DA(x) | BIT_DDMACH5_DA(v)) -+ -+#define BIT_SHIFT_DDMACH5_DLEN 0 -+#define BIT_MASK_DDMACH5_DLEN 0x3ffff -+#define BIT_DDMACH5_DLEN(x) \ -+ (((x) & BIT_MASK_DDMACH5_DLEN) << BIT_SHIFT_DDMACH5_DLEN) -+#define BITS_DDMACH5_DLEN (BIT_MASK_DDMACH5_DLEN << BIT_SHIFT_DDMACH5_DLEN) -+#define BIT_CLEAR_DDMACH5_DLEN(x) ((x) & (~BITS_DDMACH5_DLEN)) -+#define BIT_GET_DDMACH5_DLEN(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DLEN) & BIT_MASK_DDMACH5_DLEN) -+#define BIT_SET_DDMACH5_DLEN(x, v) \ -+ (BIT_CLEAR_DDMACH5_DLEN(x) | BIT_DDMACH5_DLEN(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_REG_DDMA_CH5CTRL (Offset 0x1258) */ -+ -+#define BIT_DDMACH5_ERR_MON BIT(30) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DDMA_INT_MSK (Offset 0x12E0) */ -+ -+#define BIT_DDMACH5_MSK BIT(5) -+#define BIT_DDMACH4_MSK BIT(4) -+#define BIT_DDMACH3_MSK BIT(3) -+#define BIT_DDMACH2_MSK BIT(2) -+#define BIT_DDMACH1_MSK BIT(1) -+#define BIT_DDMACH0_MSK BIT(0) -+ -+/* 2 REG_DDMA_CHSTATUS (Offset 0x12E8) */ -+ -+#define BIT_DDMACH5_BUSY BIT(5) -+#define BIT_DDMACH4_BUSY BIT(4) -+#define BIT_DDMACH3_BUSY BIT(3) -+#define BIT_DDMACH2_BUSY BIT(2) -+#define BIT_DDMACH1_BUSY BIT(1) -+#define BIT_DDMACH0_BUSY BIT(0) -+ -+/* 2 REG_DDMA_CHKSUM (Offset 0x12F0) */ -+ -+#define BIT_SHIFT_IDDMA0_CHKSUM 0 -+#define BIT_MASK_IDDMA0_CHKSUM 0xffff -+#define BIT_IDDMA0_CHKSUM(x) \ -+ (((x) & BIT_MASK_IDDMA0_CHKSUM) << BIT_SHIFT_IDDMA0_CHKSUM) -+#define BITS_IDDMA0_CHKSUM (BIT_MASK_IDDMA0_CHKSUM << BIT_SHIFT_IDDMA0_CHKSUM) -+#define BIT_CLEAR_IDDMA0_CHKSUM(x) ((x) & (~BITS_IDDMA0_CHKSUM)) -+#define BIT_GET_IDDMA0_CHKSUM(x) \ -+ (((x) >> BIT_SHIFT_IDDMA0_CHKSUM) & BIT_MASK_IDDMA0_CHKSUM) -+#define BIT_SET_IDDMA0_CHKSUM(x, v) \ -+ (BIT_CLEAR_IDDMA0_CHKSUM(x) | BIT_IDDMA0_CHKSUM(v)) -+ -+/* 2 REG_DDMA_MONITOR (Offset 0x12FC) */ -+ -+#define BIT_IDDMA0_PERMU_UNDERFLOW BIT(14) -+#define BIT_IDDMA0_FIFO_UNDERFLOW BIT(13) -+#define BIT_IDDMA0_FIFO_OVERFLOW BIT(12) -+#define BIT_CH5_ERR BIT(5) -+#define BIT_CH4_ERR BIT(4) -+#define BIT_CH3_ERR BIT(3) -+#define BIT_CH2_ERR BIT(2) -+#define BIT_CH1_ERR BIT(1) -+#define BIT_CH0_ERR BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_STC_INT_CS (Offset 0x1300) */ -+ -+#define BIT_STC_INT_EN BIT(31) -+#define BIT_STC_INT_GRP_EN BIT(31) -+ -+#define BIT_SHIFT_STC_INT_FLAG 16 -+#define BIT_MASK_STC_INT_FLAG 0xff -+#define BIT_STC_INT_FLAG(x) \ -+ (((x) & BIT_MASK_STC_INT_FLAG) << BIT_SHIFT_STC_INT_FLAG) -+#define BITS_STC_INT_FLAG (BIT_MASK_STC_INT_FLAG << BIT_SHIFT_STC_INT_FLAG) -+#define BIT_CLEAR_STC_INT_FLAG(x) ((x) & (~BITS_STC_INT_FLAG)) -+#define BIT_GET_STC_INT_FLAG(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_FLAG) & BIT_MASK_STC_INT_FLAG) -+#define BIT_SET_STC_INT_FLAG(x, v) \ -+ (BIT_CLEAR_STC_INT_FLAG(x) | BIT_STC_INT_FLAG(v)) -+ -+#define BIT_SHIFT_STC_INT_IDX 8 -+#define BIT_MASK_STC_INT_IDX 0x7 -+#define BIT_STC_INT_IDX(x) \ -+ (((x) & BIT_MASK_STC_INT_IDX) << BIT_SHIFT_STC_INT_IDX) -+#define BITS_STC_INT_IDX (BIT_MASK_STC_INT_IDX << BIT_SHIFT_STC_INT_IDX) -+#define BIT_CLEAR_STC_INT_IDX(x) ((x) & (~BITS_STC_INT_IDX)) -+#define BIT_GET_STC_INT_IDX(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_IDX) & BIT_MASK_STC_INT_IDX) -+#define BIT_SET_STC_INT_IDX(x, v) \ -+ (BIT_CLEAR_STC_INT_IDX(x) | BIT_STC_INT_IDX(v)) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_LS 8 -+#define BIT_MASK_STC_INT_EXPECT_LS 0x3f -+#define BIT_STC_INT_EXPECT_LS(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_LS) << BIT_SHIFT_STC_INT_EXPECT_LS) -+#define BITS_STC_INT_EXPECT_LS \ -+ (BIT_MASK_STC_INT_EXPECT_LS << BIT_SHIFT_STC_INT_EXPECT_LS) -+#define BIT_CLEAR_STC_INT_EXPECT_LS(x) ((x) & (~BITS_STC_INT_EXPECT_LS)) -+#define BIT_GET_STC_INT_EXPECT_LS(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_LS) & BIT_MASK_STC_INT_EXPECT_LS) -+#define BIT_SET_STC_INT_EXPECT_LS(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_LS(x) | BIT_STC_INT_EXPECT_LS(v)) -+ -+#define BIT_SHIFT_STC_INT_REALTIME_CS 0 -+#define BIT_MASK_STC_INT_REALTIME_CS 0x3f -+#define BIT_STC_INT_REALTIME_CS(x) \ -+ (((x) & BIT_MASK_STC_INT_REALTIME_CS) << BIT_SHIFT_STC_INT_REALTIME_CS) -+#define BITS_STC_INT_REALTIME_CS \ -+ (BIT_MASK_STC_INT_REALTIME_CS << BIT_SHIFT_STC_INT_REALTIME_CS) -+#define BIT_CLEAR_STC_INT_REALTIME_CS(x) ((x) & (~BITS_STC_INT_REALTIME_CS)) -+#define BIT_GET_STC_INT_REALTIME_CS(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_REALTIME_CS) & BIT_MASK_STC_INT_REALTIME_CS) -+#define BIT_SET_STC_INT_REALTIME_CS(x, v) \ -+ (BIT_CLEAR_STC_INT_REALTIME_CS(x) | BIT_STC_INT_REALTIME_CS(v)) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_CS 0 -+#define BIT_MASK_STC_INT_EXPECT_CS 0x3f -+#define BIT_STC_INT_EXPECT_CS(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_CS) << BIT_SHIFT_STC_INT_EXPECT_CS) -+#define BITS_STC_INT_EXPECT_CS \ -+ (BIT_MASK_STC_INT_EXPECT_CS << BIT_SHIFT_STC_INT_EXPECT_CS) -+#define BIT_CLEAR_STC_INT_EXPECT_CS(x) ((x) & (~BITS_STC_INT_EXPECT_CS)) -+#define BIT_GET_STC_INT_EXPECT_CS(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_CS) & BIT_MASK_STC_INT_EXPECT_CS) -+#define BIT_SET_STC_INT_EXPECT_CS(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_CS(x) | BIT_STC_INT_EXPECT_CS(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH4_ACH5_TXBD_NUM (Offset 0x130C) */ -+ -+#define BIT_PCIE_ACH5_FLAG BIT(30) -+ -+#define BIT_SHIFT_ACH5_DESC_MODE 28 -+#define BIT_MASK_ACH5_DESC_MODE 0x3 -+#define BIT_ACH5_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH5_DESC_MODE) << BIT_SHIFT_ACH5_DESC_MODE) -+#define BITS_ACH5_DESC_MODE \ -+ (BIT_MASK_ACH5_DESC_MODE << BIT_SHIFT_ACH5_DESC_MODE) -+#define BIT_CLEAR_ACH5_DESC_MODE(x) ((x) & (~BITS_ACH5_DESC_MODE)) -+#define BIT_GET_ACH5_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH5_DESC_MODE) & BIT_MASK_ACH5_DESC_MODE) -+#define BIT_SET_ACH5_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH5_DESC_MODE(x) | BIT_ACH5_DESC_MODE(v)) -+ -+#define BIT_SHIFT_ACH5_DESC_NUM 16 -+#define BIT_MASK_ACH5_DESC_NUM 0xfff -+#define BIT_ACH5_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH5_DESC_NUM) << BIT_SHIFT_ACH5_DESC_NUM) -+#define BITS_ACH5_DESC_NUM (BIT_MASK_ACH5_DESC_NUM << BIT_SHIFT_ACH5_DESC_NUM) -+#define BIT_CLEAR_ACH5_DESC_NUM(x) ((x) & (~BITS_ACH5_DESC_NUM)) -+#define BIT_GET_ACH5_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH5_DESC_NUM) & BIT_MASK_ACH5_DESC_NUM) -+#define BIT_SET_ACH5_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH5_DESC_NUM(x) | BIT_ACH5_DESC_NUM(v)) -+ -+#define BIT_PCIE_ACH4_FLAG BIT(14) -+ -+#define BIT_SHIFT_ACH4_DESC_MODE 12 -+#define BIT_MASK_ACH4_DESC_MODE 0x3 -+#define BIT_ACH4_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH4_DESC_MODE) << BIT_SHIFT_ACH4_DESC_MODE) -+#define BITS_ACH4_DESC_MODE \ -+ (BIT_MASK_ACH4_DESC_MODE << BIT_SHIFT_ACH4_DESC_MODE) -+#define BIT_CLEAR_ACH4_DESC_MODE(x) ((x) & (~BITS_ACH4_DESC_MODE)) -+#define BIT_GET_ACH4_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH4_DESC_MODE) & BIT_MASK_ACH4_DESC_MODE) -+#define BIT_SET_ACH4_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH4_DESC_MODE(x) | BIT_ACH4_DESC_MODE(v)) -+ -+#define BIT_SHIFT_ACH4_DESC_NUM 0 -+#define BIT_MASK_ACH4_DESC_NUM 0xfff -+#define BIT_ACH4_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH4_DESC_NUM) << BIT_SHIFT_ACH4_DESC_NUM) -+#define BITS_ACH4_DESC_NUM (BIT_MASK_ACH4_DESC_NUM << BIT_SHIFT_ACH4_DESC_NUM) -+#define BIT_CLEAR_ACH4_DESC_NUM(x) ((x) & (~BITS_ACH4_DESC_NUM)) -+#define BIT_GET_ACH4_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH4_DESC_NUM) & BIT_MASK_ACH4_DESC_NUM) -+#define BIT_SET_ACH4_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH4_DESC_NUM(x) | BIT_ACH4_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_CMU_DLY_CTRL (Offset 0x1310) */ -+ -+#define BIT_CMU_DLY_EN BIT(31) -+#define BIT_CMU_DLY_MODE BIT(30) -+ -+#define BIT_SHIFT_CMU_DLY_PRE_DIV 0 -+#define BIT_MASK_CMU_DLY_PRE_DIV 0xff -+#define BIT_CMU_DLY_PRE_DIV(x) \ -+ (((x) & BIT_MASK_CMU_DLY_PRE_DIV) << BIT_SHIFT_CMU_DLY_PRE_DIV) -+#define BITS_CMU_DLY_PRE_DIV \ -+ (BIT_MASK_CMU_DLY_PRE_DIV << BIT_SHIFT_CMU_DLY_PRE_DIV) -+#define BIT_CLEAR_CMU_DLY_PRE_DIV(x) ((x) & (~BITS_CMU_DLY_PRE_DIV)) -+#define BIT_GET_CMU_DLY_PRE_DIV(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_PRE_DIV) & BIT_MASK_CMU_DLY_PRE_DIV) -+#define BIT_SET_CMU_DLY_PRE_DIV(x, v) \ -+ (BIT_CLEAR_CMU_DLY_PRE_DIV(x) | BIT_CMU_DLY_PRE_DIV(v)) -+ -+/* 2 REG_CMU_DLY_CFG (Offset 0x1314) */ -+ -+#define BIT_SHIFT_CMU_DLY_LTR_A2I 24 -+#define BIT_MASK_CMU_DLY_LTR_A2I 0xff -+#define BIT_CMU_DLY_LTR_A2I(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_A2I) << BIT_SHIFT_CMU_DLY_LTR_A2I) -+#define BITS_CMU_DLY_LTR_A2I \ -+ (BIT_MASK_CMU_DLY_LTR_A2I << BIT_SHIFT_CMU_DLY_LTR_A2I) -+#define BIT_CLEAR_CMU_DLY_LTR_A2I(x) ((x) & (~BITS_CMU_DLY_LTR_A2I)) -+#define BIT_GET_CMU_DLY_LTR_A2I(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_A2I) & BIT_MASK_CMU_DLY_LTR_A2I) -+#define BIT_SET_CMU_DLY_LTR_A2I(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_A2I(x) | BIT_CMU_DLY_LTR_A2I(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_I2A 16 -+#define BIT_MASK_CMU_DLY_LTR_I2A 0xff -+#define BIT_CMU_DLY_LTR_I2A(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_I2A) << BIT_SHIFT_CMU_DLY_LTR_I2A) -+#define BITS_CMU_DLY_LTR_I2A \ -+ (BIT_MASK_CMU_DLY_LTR_I2A << BIT_SHIFT_CMU_DLY_LTR_I2A) -+#define BIT_CLEAR_CMU_DLY_LTR_I2A(x) ((x) & (~BITS_CMU_DLY_LTR_I2A)) -+#define BIT_GET_CMU_DLY_LTR_I2A(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_I2A) & BIT_MASK_CMU_DLY_LTR_I2A) -+#define BIT_SET_CMU_DLY_LTR_I2A(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_I2A(x) | BIT_CMU_DLY_LTR_I2A(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_IDLE 8 -+#define BIT_MASK_CMU_DLY_LTR_IDLE 0xff -+#define BIT_CMU_DLY_LTR_IDLE(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_IDLE) << BIT_SHIFT_CMU_DLY_LTR_IDLE) -+#define BITS_CMU_DLY_LTR_IDLE \ -+ (BIT_MASK_CMU_DLY_LTR_IDLE << BIT_SHIFT_CMU_DLY_LTR_IDLE) -+#define BIT_CLEAR_CMU_DLY_LTR_IDLE(x) ((x) & (~BITS_CMU_DLY_LTR_IDLE)) -+#define BIT_GET_CMU_DLY_LTR_IDLE(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_IDLE) & BIT_MASK_CMU_DLY_LTR_IDLE) -+#define BIT_SET_CMU_DLY_LTR_IDLE(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_IDLE(x) | BIT_CMU_DLY_LTR_IDLE(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_ACT 0 -+#define BIT_MASK_CMU_DLY_LTR_ACT 0xff -+#define BIT_CMU_DLY_LTR_ACT(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_ACT) << BIT_SHIFT_CMU_DLY_LTR_ACT) -+#define BITS_CMU_DLY_LTR_ACT \ -+ (BIT_MASK_CMU_DLY_LTR_ACT << BIT_SHIFT_CMU_DLY_LTR_ACT) -+#define BIT_CLEAR_CMU_DLY_LTR_ACT(x) ((x) & (~BITS_CMU_DLY_LTR_ACT)) -+#define BIT_GET_CMU_DLY_LTR_ACT(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_ACT) & BIT_MASK_CMU_DLY_LTR_ACT) -+#define BIT_SET_CMU_DLY_LTR_ACT(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_ACT(x) | BIT_CMU_DLY_LTR_ACT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWCMDQ_TXBD_IDX (Offset 0x1318) */ -+ -+#define BIT_SHIFT_FWCMDQ_HW_IDX 16 -+#define BIT_MASK_FWCMDQ_HW_IDX 0xfff -+#define BIT_FWCMDQ_HW_IDX(x) \ -+ (((x) & BIT_MASK_FWCMDQ_HW_IDX) << BIT_SHIFT_FWCMDQ_HW_IDX) -+#define BITS_FWCMDQ_HW_IDX (BIT_MASK_FWCMDQ_HW_IDX << BIT_SHIFT_FWCMDQ_HW_IDX) -+#define BIT_CLEAR_FWCMDQ_HW_IDX(x) ((x) & (~BITS_FWCMDQ_HW_IDX)) -+#define BIT_GET_FWCMDQ_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_HW_IDX) & BIT_MASK_FWCMDQ_HW_IDX) -+#define BIT_SET_FWCMDQ_HW_IDX(x, v) \ -+ (BIT_CLEAR_FWCMDQ_HW_IDX(x) | BIT_FWCMDQ_HW_IDX(v)) -+ -+#define BIT_SHIFT_FWCMDQ_HOST_IDX 0 -+#define BIT_MASK_FWCMDQ_HOST_IDX 0xfff -+#define BIT_FWCMDQ_HOST_IDX(x) \ -+ (((x) & BIT_MASK_FWCMDQ_HOST_IDX) << BIT_SHIFT_FWCMDQ_HOST_IDX) -+#define BITS_FWCMDQ_HOST_IDX \ -+ (BIT_MASK_FWCMDQ_HOST_IDX << BIT_SHIFT_FWCMDQ_HOST_IDX) -+#define BIT_CLEAR_FWCMDQ_HOST_IDX(x) ((x) & (~BITS_FWCMDQ_HOST_IDX)) -+#define BIT_GET_FWCMDQ_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_HOST_IDX) & BIT_MASK_FWCMDQ_HOST_IDX) -+#define BIT_SET_FWCMDQ_HOST_IDX(x, v) \ -+ (BIT_CLEAR_FWCMDQ_HOST_IDX(x) | BIT_FWCMDQ_HOST_IDX(v)) -+ -+/* 2 REG_P0HI8Q_TXBD_IDX (Offset 0x131C) */ -+ -+#define BIT_SHIFT_P0HI8Q_HW_IDX 16 -+#define BIT_MASK_P0HI8Q_HW_IDX 0xfff -+#define BIT_P0HI8Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI8Q_HW_IDX) << BIT_SHIFT_P0HI8Q_HW_IDX) -+#define BITS_P0HI8Q_HW_IDX (BIT_MASK_P0HI8Q_HW_IDX << BIT_SHIFT_P0HI8Q_HW_IDX) -+#define BIT_CLEAR_P0HI8Q_HW_IDX(x) ((x) & (~BITS_P0HI8Q_HW_IDX)) -+#define BIT_GET_P0HI8Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI8Q_HW_IDX) & BIT_MASK_P0HI8Q_HW_IDX) -+#define BIT_SET_P0HI8Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI8Q_HW_IDX(x) | BIT_P0HI8Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI8Q_HOST_IDX 0 -+#define BIT_MASK_P0HI8Q_HOST_IDX 0xfff -+#define BIT_P0HI8Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI8Q_HOST_IDX) << BIT_SHIFT_P0HI8Q_HOST_IDX) -+#define BITS_P0HI8Q_HOST_IDX \ -+ (BIT_MASK_P0HI8Q_HOST_IDX << BIT_SHIFT_P0HI8Q_HOST_IDX) -+#define BIT_CLEAR_P0HI8Q_HOST_IDX(x) ((x) & (~BITS_P0HI8Q_HOST_IDX)) -+#define BIT_GET_P0HI8Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI8Q_HOST_IDX) & BIT_MASK_P0HI8Q_HOST_IDX) -+#define BIT_SET_P0HI8Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI8Q_HOST_IDX(x) | BIT_P0HI8Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2CQ_TXBD_DESA (Offset 0x1320) */ -+ -+#define BIT_SHIFT_H2CQ_TXBD_DESA 0 -+#define BIT_MASK_H2CQ_TXBD_DESA 0xffffffffffffffffL -+#define BIT_H2CQ_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_H2CQ_TXBD_DESA) << BIT_SHIFT_H2CQ_TXBD_DESA) -+#define BITS_H2CQ_TXBD_DESA \ -+ (BIT_MASK_H2CQ_TXBD_DESA << BIT_SHIFT_H2CQ_TXBD_DESA) -+#define BIT_CLEAR_H2CQ_TXBD_DESA(x) ((x) & (~BITS_H2CQ_TXBD_DESA)) -+#define BIT_GET_H2CQ_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_TXBD_DESA) & BIT_MASK_H2CQ_TXBD_DESA) -+#define BIT_SET_H2CQ_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_H2CQ_TXBD_DESA(x) | BIT_H2CQ_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_H2CQ_TXBD_DESA_L (Offset 0x1320) */ -+ -+#define BIT_SHIFT_H2CQ_TXBD_DESA_L 0 -+#define BIT_MASK_H2CQ_TXBD_DESA_L 0xffffffffL -+#define BIT_H2CQ_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_H2CQ_TXBD_DESA_L) << BIT_SHIFT_H2CQ_TXBD_DESA_L) -+#define BITS_H2CQ_TXBD_DESA_L \ -+ (BIT_MASK_H2CQ_TXBD_DESA_L << BIT_SHIFT_H2CQ_TXBD_DESA_L) -+#define BIT_CLEAR_H2CQ_TXBD_DESA_L(x) ((x) & (~BITS_H2CQ_TXBD_DESA_L)) -+#define BIT_GET_H2CQ_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_TXBD_DESA_L) & BIT_MASK_H2CQ_TXBD_DESA_L) -+#define BIT_SET_H2CQ_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_H2CQ_TXBD_DESA_L(x) | BIT_H2CQ_TXBD_DESA_L(v)) -+ -+/* 2 REG_H2CQ_TXBD_DESA_H (Offset 0x1324) */ -+ -+#define BIT_SHIFT_H2CQ_TXBD_DESA_H 0 -+#define BIT_MASK_H2CQ_TXBD_DESA_H 0xffffffffL -+#define BIT_H2CQ_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_H2CQ_TXBD_DESA_H) << BIT_SHIFT_H2CQ_TXBD_DESA_H) -+#define BITS_H2CQ_TXBD_DESA_H \ -+ (BIT_MASK_H2CQ_TXBD_DESA_H << BIT_SHIFT_H2CQ_TXBD_DESA_H) -+#define BIT_CLEAR_H2CQ_TXBD_DESA_H(x) ((x) & (~BITS_H2CQ_TXBD_DESA_H)) -+#define BIT_GET_H2CQ_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_TXBD_DESA_H) & BIT_MASK_H2CQ_TXBD_DESA_H) -+#define BIT_SET_H2CQ_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_H2CQ_TXBD_DESA_H(x) | BIT_H2CQ_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2CQ_TXBD_NUM (Offset 0x1328) */ -+ -+#define BIT_PCIE_H2CQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_H2CQ_TXBD_NUM (Offset 0x1328) */ -+ -+#define BIT_HCI_H2CQ_FLAG BIT(14) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_H2CQ_TXBD_NUM (Offset 0x1328) */ -+ -+#define BIT_SHIFT_H2CQ_DESC_MODE 12 -+#define BIT_MASK_H2CQ_DESC_MODE 0x3 -+#define BIT_H2CQ_DESC_MODE(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_MODE) << BIT_SHIFT_H2CQ_DESC_MODE) -+#define BITS_H2CQ_DESC_MODE \ -+ (BIT_MASK_H2CQ_DESC_MODE << BIT_SHIFT_H2CQ_DESC_MODE) -+#define BIT_CLEAR_H2CQ_DESC_MODE(x) ((x) & (~BITS_H2CQ_DESC_MODE)) -+#define BIT_GET_H2CQ_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_MODE) & BIT_MASK_H2CQ_DESC_MODE) -+#define BIT_SET_H2CQ_DESC_MODE(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_MODE(x) | BIT_H2CQ_DESC_MODE(v)) -+ -+#define BIT_SHIFT_H2CQ_DESC_NUM 0 -+#define BIT_MASK_H2CQ_DESC_NUM 0xfff -+#define BIT_H2CQ_DESC_NUM(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_NUM) << BIT_SHIFT_H2CQ_DESC_NUM) -+#define BITS_H2CQ_DESC_NUM (BIT_MASK_H2CQ_DESC_NUM << BIT_SHIFT_H2CQ_DESC_NUM) -+#define BIT_CLEAR_H2CQ_DESC_NUM(x) ((x) & (~BITS_H2CQ_DESC_NUM)) -+#define BIT_GET_H2CQ_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_NUM) & BIT_MASK_H2CQ_DESC_NUM) -+#define BIT_SET_H2CQ_DESC_NUM(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_NUM(x) | BIT_H2CQ_DESC_NUM(v)) -+ -+/* 2 REG_H2CQ_TXBD_IDX (Offset 0x132C) */ -+ -+#define BIT_SHIFT_H2CQ_HW_IDX 16 -+#define BIT_MASK_H2CQ_HW_IDX 0xfff -+#define BIT_H2CQ_HW_IDX(x) \ -+ (((x) & BIT_MASK_H2CQ_HW_IDX) << BIT_SHIFT_H2CQ_HW_IDX) -+#define BITS_H2CQ_HW_IDX (BIT_MASK_H2CQ_HW_IDX << BIT_SHIFT_H2CQ_HW_IDX) -+#define BIT_CLEAR_H2CQ_HW_IDX(x) ((x) & (~BITS_H2CQ_HW_IDX)) -+#define BIT_GET_H2CQ_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HW_IDX) & BIT_MASK_H2CQ_HW_IDX) -+#define BIT_SET_H2CQ_HW_IDX(x, v) \ -+ (BIT_CLEAR_H2CQ_HW_IDX(x) | BIT_H2CQ_HW_IDX(v)) -+ -+#define BIT_SHIFT_H2CQ_HOST_IDX 0 -+#define BIT_MASK_H2CQ_HOST_IDX 0xfff -+#define BIT_H2CQ_HOST_IDX(x) \ -+ (((x) & BIT_MASK_H2CQ_HOST_IDX) << BIT_SHIFT_H2CQ_HOST_IDX) -+#define BITS_H2CQ_HOST_IDX (BIT_MASK_H2CQ_HOST_IDX << BIT_SHIFT_H2CQ_HOST_IDX) -+#define BIT_CLEAR_H2CQ_HOST_IDX(x) ((x) & (~BITS_H2CQ_HOST_IDX)) -+#define BIT_GET_H2CQ_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HOST_IDX) & BIT_MASK_H2CQ_HOST_IDX) -+#define BIT_SET_H2CQ_HOST_IDX(x, v) \ -+ (BIT_CLEAR_H2CQ_HOST_IDX(x) | BIT_H2CQ_HOST_IDX(v)) -+ -+/* 2 REG_H2CQ_CSR (Offset 0x1330) */ -+ -+#define BIT_H2CQ_FULL BIT(31) -+#define BIT_CLR_H2CQ_HOST_IDX BIT(16) -+#define BIT_CLR_H2CQ_HW_IDX BIT(8) -+#define BIT_STOP_H2CQ BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI9Q_TXBD_IDX (Offset 0x1334) */ -+ -+#define BIT_SHIFT_P0HI9Q_HW_IDX 16 -+#define BIT_MASK_P0HI9Q_HW_IDX 0xfff -+#define BIT_P0HI9Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI9Q_HW_IDX) << BIT_SHIFT_P0HI9Q_HW_IDX) -+#define BITS_P0HI9Q_HW_IDX (BIT_MASK_P0HI9Q_HW_IDX << BIT_SHIFT_P0HI9Q_HW_IDX) -+#define BIT_CLEAR_P0HI9Q_HW_IDX(x) ((x) & (~BITS_P0HI9Q_HW_IDX)) -+#define BIT_GET_P0HI9Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI9Q_HW_IDX) & BIT_MASK_P0HI9Q_HW_IDX) -+#define BIT_SET_P0HI9Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI9Q_HW_IDX(x) | BIT_P0HI9Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI9Q_HOST_IDX 0 -+#define BIT_MASK_P0HI9Q_HOST_IDX 0xfff -+#define BIT_P0HI9Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI9Q_HOST_IDX) << BIT_SHIFT_P0HI9Q_HOST_IDX) -+#define BITS_P0HI9Q_HOST_IDX \ -+ (BIT_MASK_P0HI9Q_HOST_IDX << BIT_SHIFT_P0HI9Q_HOST_IDX) -+#define BIT_CLEAR_P0HI9Q_HOST_IDX(x) ((x) & (~BITS_P0HI9Q_HOST_IDX)) -+#define BIT_GET_P0HI9Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI9Q_HOST_IDX) & BIT_MASK_P0HI9Q_HOST_IDX) -+#define BIT_SET_P0HI9Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI9Q_HOST_IDX(x) | BIT_P0HI9Q_HOST_IDX(v)) -+ -+/* 2 REG_P0HI10Q_TXBD_IDX (Offset 0x1338) */ -+ -+#define BIT_SHIFT_P0HI10Q_HW_IDX 16 -+#define BIT_MASK_P0HI10Q_HW_IDX 0xfff -+#define BIT_P0HI10Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI10Q_HW_IDX) << BIT_SHIFT_P0HI10Q_HW_IDX) -+#define BITS_P0HI10Q_HW_IDX \ -+ (BIT_MASK_P0HI10Q_HW_IDX << BIT_SHIFT_P0HI10Q_HW_IDX) -+#define BIT_CLEAR_P0HI10Q_HW_IDX(x) ((x) & (~BITS_P0HI10Q_HW_IDX)) -+#define BIT_GET_P0HI10Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI10Q_HW_IDX) & BIT_MASK_P0HI10Q_HW_IDX) -+#define BIT_SET_P0HI10Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI10Q_HW_IDX(x) | BIT_P0HI10Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI10Q_HOST_IDX 0 -+#define BIT_MASK_P0HI10Q_HOST_IDX 0xfff -+#define BIT_P0HI10Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI10Q_HOST_IDX) << BIT_SHIFT_P0HI10Q_HOST_IDX) -+#define BITS_P0HI10Q_HOST_IDX \ -+ (BIT_MASK_P0HI10Q_HOST_IDX << BIT_SHIFT_P0HI10Q_HOST_IDX) -+#define BIT_CLEAR_P0HI10Q_HOST_IDX(x) ((x) & (~BITS_P0HI10Q_HOST_IDX)) -+#define BIT_GET_P0HI10Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI10Q_HOST_IDX) & BIT_MASK_P0HI10Q_HOST_IDX) -+#define BIT_SET_P0HI10Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI10Q_HOST_IDX(x) | BIT_P0HI10Q_HOST_IDX(v)) -+ -+/* 2 REG_P0HI11Q_TXBD_IDX (Offset 0x133C) */ -+ -+#define BIT_SHIFT_P0HI11Q_HW_IDX 16 -+#define BIT_MASK_P0HI11Q_HW_IDX 0xfff -+#define BIT_P0HI11Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI11Q_HW_IDX) << BIT_SHIFT_P0HI11Q_HW_IDX) -+#define BITS_P0HI11Q_HW_IDX \ -+ (BIT_MASK_P0HI11Q_HW_IDX << BIT_SHIFT_P0HI11Q_HW_IDX) -+#define BIT_CLEAR_P0HI11Q_HW_IDX(x) ((x) & (~BITS_P0HI11Q_HW_IDX)) -+#define BIT_GET_P0HI11Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI11Q_HW_IDX) & BIT_MASK_P0HI11Q_HW_IDX) -+#define BIT_SET_P0HI11Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI11Q_HW_IDX(x) | BIT_P0HI11Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI11Q_HOST_IDX 0 -+#define BIT_MASK_P0HI11Q_HOST_IDX 0xfff -+#define BIT_P0HI11Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI11Q_HOST_IDX) << BIT_SHIFT_P0HI11Q_HOST_IDX) -+#define BITS_P0HI11Q_HOST_IDX \ -+ (BIT_MASK_P0HI11Q_HOST_IDX << BIT_SHIFT_P0HI11Q_HOST_IDX) -+#define BIT_CLEAR_P0HI11Q_HOST_IDX(x) ((x) & (~BITS_P0HI11Q_HOST_IDX)) -+#define BIT_GET_P0HI11Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI11Q_HOST_IDX) & BIT_MASK_P0HI11Q_HOST_IDX) -+#define BIT_SET_P0HI11Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI11Q_HOST_IDX(x) | BIT_P0HI11Q_HOST_IDX(v)) -+ -+/* 2 REG_P0HI12Q_TXBD_IDX (Offset 0x1340) */ -+ -+#define BIT_SHIFT_P0HI12Q_HW_IDX 16 -+#define BIT_MASK_P0HI12Q_HW_IDX 0xfff -+#define BIT_P0HI12Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI12Q_HW_IDX) << BIT_SHIFT_P0HI12Q_HW_IDX) -+#define BITS_P0HI12Q_HW_IDX \ -+ (BIT_MASK_P0HI12Q_HW_IDX << BIT_SHIFT_P0HI12Q_HW_IDX) -+#define BIT_CLEAR_P0HI12Q_HW_IDX(x) ((x) & (~BITS_P0HI12Q_HW_IDX)) -+#define BIT_GET_P0HI12Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI12Q_HW_IDX) & BIT_MASK_P0HI12Q_HW_IDX) -+#define BIT_SET_P0HI12Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI12Q_HW_IDX(x) | BIT_P0HI12Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI12Q_HOST_IDX 0 -+#define BIT_MASK_P0HI12Q_HOST_IDX 0xfff -+#define BIT_P0HI12Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI12Q_HOST_IDX) << BIT_SHIFT_P0HI12Q_HOST_IDX) -+#define BITS_P0HI12Q_HOST_IDX \ -+ (BIT_MASK_P0HI12Q_HOST_IDX << BIT_SHIFT_P0HI12Q_HOST_IDX) -+#define BIT_CLEAR_P0HI12Q_HOST_IDX(x) ((x) & (~BITS_P0HI12Q_HOST_IDX)) -+#define BIT_GET_P0HI12Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI12Q_HOST_IDX) & BIT_MASK_P0HI12Q_HOST_IDX) -+#define BIT_SET_P0HI12Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI12Q_HOST_IDX(x) | BIT_P0HI12Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPL_BUFFER_MONITOR (Offset 0x1344) */ -+ -+#define BIT_TXQFULL_FLAG BIT(19) -+ -+#define BIT_SHIFT_RELAX_ORDERING_ATTR 17 -+#define BIT_MASK_RELAX_ORDERING_ATTR 0x3 -+#define BIT_RELAX_ORDERING_ATTR(x) \ -+ (((x) & BIT_MASK_RELAX_ORDERING_ATTR) << BIT_SHIFT_RELAX_ORDERING_ATTR) -+#define BITS_RELAX_ORDERING_ATTR \ -+ (BIT_MASK_RELAX_ORDERING_ATTR << BIT_SHIFT_RELAX_ORDERING_ATTR) -+#define BIT_CLEAR_RELAX_ORDERING_ATTR(x) ((x) & (~BITS_RELAX_ORDERING_ATTR)) -+#define BIT_GET_RELAX_ORDERING_ATTR(x) \ -+ (((x) >> BIT_SHIFT_RELAX_ORDERING_ATTR) & BIT_MASK_RELAX_ORDERING_ATTR) -+#define BIT_SET_RELAX_ORDERING_ATTR(x, v) \ -+ (BIT_CLEAR_RELAX_ORDERING_ATTR(x) | BIT_RELAX_ORDERING_ATTR(v)) -+ -+#define BIT_CLR_QD_CPL_MIN_REMAIN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI13Q_TXBD_IDX (Offset 0x1344) */ -+ -+#define BIT_SHIFT_P0HI13Q_HW_IDX 16 -+#define BIT_MASK_P0HI13Q_HW_IDX 0xfff -+#define BIT_P0HI13Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI13Q_HW_IDX) << BIT_SHIFT_P0HI13Q_HW_IDX) -+#define BITS_P0HI13Q_HW_IDX \ -+ (BIT_MASK_P0HI13Q_HW_IDX << BIT_SHIFT_P0HI13Q_HW_IDX) -+#define BIT_CLEAR_P0HI13Q_HW_IDX(x) ((x) & (~BITS_P0HI13Q_HW_IDX)) -+#define BIT_GET_P0HI13Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI13Q_HW_IDX) & BIT_MASK_P0HI13Q_HW_IDX) -+#define BIT_SET_P0HI13Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI13Q_HW_IDX(x) | BIT_P0HI13Q_HW_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_CPL_BUFFER_MONITOR (Offset 0x1344) */ -+ -+#define BIT_SHIFT_QD_CPL_MIN_REMAIN_ADDR 8 -+#define BIT_MASK_QD_CPL_MIN_REMAIN_ADDR 0xff -+#define BIT_QD_CPL_MIN_REMAIN_ADDR(x) \ -+ (((x) & BIT_MASK_QD_CPL_MIN_REMAIN_ADDR) \ -+ << BIT_SHIFT_QD_CPL_MIN_REMAIN_ADDR) -+#define BITS_QD_CPL_MIN_REMAIN_ADDR \ -+ (BIT_MASK_QD_CPL_MIN_REMAIN_ADDR << BIT_SHIFT_QD_CPL_MIN_REMAIN_ADDR) -+#define BIT_CLEAR_QD_CPL_MIN_REMAIN_ADDR(x) \ -+ ((x) & (~BITS_QD_CPL_MIN_REMAIN_ADDR)) -+#define BIT_GET_QD_CPL_MIN_REMAIN_ADDR(x) \ -+ (((x) >> BIT_SHIFT_QD_CPL_MIN_REMAIN_ADDR) & \ -+ BIT_MASK_QD_CPL_MIN_REMAIN_ADDR) -+#define BIT_SET_QD_CPL_MIN_REMAIN_ADDR(x, v) \ -+ (BIT_CLEAR_QD_CPL_MIN_REMAIN_ADDR(x) | BIT_QD_CPL_MIN_REMAIN_ADDR(v)) -+ -+#define BIT_SHIFT_QD_CPL_CUR_REMAIN_ADDR 0 -+#define BIT_MASK_QD_CPL_CUR_REMAIN_ADDR 0xff -+#define BIT_QD_CPL_CUR_REMAIN_ADDR(x) \ -+ (((x) & BIT_MASK_QD_CPL_CUR_REMAIN_ADDR) \ -+ << BIT_SHIFT_QD_CPL_CUR_REMAIN_ADDR) -+#define BITS_QD_CPL_CUR_REMAIN_ADDR \ -+ (BIT_MASK_QD_CPL_CUR_REMAIN_ADDR << BIT_SHIFT_QD_CPL_CUR_REMAIN_ADDR) -+#define BIT_CLEAR_QD_CPL_CUR_REMAIN_ADDR(x) \ -+ ((x) & (~BITS_QD_CPL_CUR_REMAIN_ADDR)) -+#define BIT_GET_QD_CPL_CUR_REMAIN_ADDR(x) \ -+ (((x) >> BIT_SHIFT_QD_CPL_CUR_REMAIN_ADDR) & \ -+ BIT_MASK_QD_CPL_CUR_REMAIN_ADDR) -+#define BIT_SET_QD_CPL_CUR_REMAIN_ADDR(x, v) \ -+ (BIT_CLEAR_QD_CPL_CUR_REMAIN_ADDR(x) | BIT_QD_CPL_CUR_REMAIN_ADDR(v)) -+ -+#define BIT_SHIFT_PTM_LOCAL_CLOCK 0 -+#define BIT_MASK_PTM_LOCAL_CLOCK 0xffffffffL -+#define BIT_PTM_LOCAL_CLOCK(x) \ -+ (((x) & BIT_MASK_PTM_LOCAL_CLOCK) << BIT_SHIFT_PTM_LOCAL_CLOCK) -+#define BITS_PTM_LOCAL_CLOCK \ -+ (BIT_MASK_PTM_LOCAL_CLOCK << BIT_SHIFT_PTM_LOCAL_CLOCK) -+#define BIT_CLEAR_PTM_LOCAL_CLOCK(x) ((x) & (~BITS_PTM_LOCAL_CLOCK)) -+#define BIT_GET_PTM_LOCAL_CLOCK(x) \ -+ (((x) >> BIT_SHIFT_PTM_LOCAL_CLOCK) & BIT_MASK_PTM_LOCAL_CLOCK) -+#define BIT_SET_PTM_LOCAL_CLOCK(x, v) \ -+ (BIT_CLEAR_PTM_LOCAL_CLOCK(x) | BIT_PTM_LOCAL_CLOCK(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI13Q_TXBD_IDX (Offset 0x1344) */ -+ -+#define BIT_SHIFT_P0HI13Q_HOST_IDX 0 -+#define BIT_MASK_P0HI13Q_HOST_IDX 0xfff -+#define BIT_P0HI13Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI13Q_HOST_IDX) << BIT_SHIFT_P0HI13Q_HOST_IDX) -+#define BITS_P0HI13Q_HOST_IDX \ -+ (BIT_MASK_P0HI13Q_HOST_IDX << BIT_SHIFT_P0HI13Q_HOST_IDX) -+#define BIT_CLEAR_P0HI13Q_HOST_IDX(x) ((x) & (~BITS_P0HI13Q_HOST_IDX)) -+#define BIT_GET_P0HI13Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI13Q_HOST_IDX) & BIT_MASK_P0HI13Q_HOST_IDX) -+#define BIT_SET_P0HI13Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI13Q_HOST_IDX(x) | BIT_P0HI13Q_HOST_IDX(v)) -+ -+/* 2 REG_P0HI14Q_TXBD_IDX (Offset 0x1348) */ -+ -+#define BIT_SHIFT_P0HI14Q_HW_IDX 16 -+#define BIT_MASK_P0HI14Q_HW_IDX 0xfff -+#define BIT_P0HI14Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI14Q_HW_IDX) << BIT_SHIFT_P0HI14Q_HW_IDX) -+#define BITS_P0HI14Q_HW_IDX \ -+ (BIT_MASK_P0HI14Q_HW_IDX << BIT_SHIFT_P0HI14Q_HW_IDX) -+#define BIT_CLEAR_P0HI14Q_HW_IDX(x) ((x) & (~BITS_P0HI14Q_HW_IDX)) -+#define BIT_GET_P0HI14Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI14Q_HW_IDX) & BIT_MASK_P0HI14Q_HW_IDX) -+#define BIT_SET_P0HI14Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI14Q_HW_IDX(x) | BIT_P0HI14Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI14Q_HOST_IDX 0 -+#define BIT_MASK_P0HI14Q_HOST_IDX 0xfff -+#define BIT_P0HI14Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI14Q_HOST_IDX) << BIT_SHIFT_P0HI14Q_HOST_IDX) -+#define BITS_P0HI14Q_HOST_IDX \ -+ (BIT_MASK_P0HI14Q_HOST_IDX << BIT_SHIFT_P0HI14Q_HOST_IDX) -+#define BIT_CLEAR_P0HI14Q_HOST_IDX(x) ((x) & (~BITS_P0HI14Q_HOST_IDX)) -+#define BIT_GET_P0HI14Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI14Q_HOST_IDX) & BIT_MASK_P0HI14Q_HOST_IDX) -+#define BIT_SET_P0HI14Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI14Q_HOST_IDX(x) | BIT_P0HI14Q_HOST_IDX(v)) -+ -+/* 2 REG_P0HI15Q_TXBD_IDX (Offset 0x134C) */ -+ -+#define BIT_SHIFT_P0HI15Q_HW_IDX 16 -+#define BIT_MASK_P0HI15Q_HW_IDX 0xfff -+#define BIT_P0HI15Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI15Q_HW_IDX) << BIT_SHIFT_P0HI15Q_HW_IDX) -+#define BITS_P0HI15Q_HW_IDX \ -+ (BIT_MASK_P0HI15Q_HW_IDX << BIT_SHIFT_P0HI15Q_HW_IDX) -+#define BIT_CLEAR_P0HI15Q_HW_IDX(x) ((x) & (~BITS_P0HI15Q_HW_IDX)) -+#define BIT_GET_P0HI15Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI15Q_HW_IDX) & BIT_MASK_P0HI15Q_HW_IDX) -+#define BIT_SET_P0HI15Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI15Q_HW_IDX(x) | BIT_P0HI15Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI15Q_HOST_IDX 0 -+#define BIT_MASK_P0HI15Q_HOST_IDX 0xfff -+#define BIT_P0HI15Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI15Q_HOST_IDX) << BIT_SHIFT_P0HI15Q_HOST_IDX) -+#define BITS_P0HI15Q_HOST_IDX \ -+ (BIT_MASK_P0HI15Q_HOST_IDX << BIT_SHIFT_P0HI15Q_HOST_IDX) -+#define BIT_CLEAR_P0HI15Q_HOST_IDX(x) ((x) & (~BITS_P0HI15Q_HOST_IDX)) -+#define BIT_GET_P0HI15Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI15Q_HOST_IDX) & BIT_MASK_P0HI15Q_HOST_IDX) -+#define BIT_SET_P0HI15Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI15Q_HOST_IDX(x) | BIT_P0HI15Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_CS (Offset 0x1350) */ -+ -+#define BIT_AXI_RXDMA_TIMEOUT_RE BIT(21) -+#define BIT_AXI_TXDMA_TIMEOUT_RE BIT(20) -+#define BIT_AXI_DECERR_W_RE BIT(19) -+#define BIT_AXI_DECERR_R_RE BIT(18) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_CHANGE_PCIE_SPEED (Offset 0x1350) */ -+ -+#define BIT_CHANGE_PCIE_SPEED BIT(18) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_CS (Offset 0x1350) */ -+ -+#define BIT_AXI_SLVERR_W_RE BIT(17) -+#define BIT_AXI_SLVERR_R_RE BIT(16) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_CHANGE_PCIE_SPEED (Offset 0x1350) */ -+ -+#define BIT_SHIFT_GEN1_GEN2 16 -+#define BIT_MASK_GEN1_GEN2 0x3 -+#define BIT_GEN1_GEN2(x) (((x) & BIT_MASK_GEN1_GEN2) << BIT_SHIFT_GEN1_GEN2) -+#define BITS_GEN1_GEN2 (BIT_MASK_GEN1_GEN2 << BIT_SHIFT_GEN1_GEN2) -+#define BIT_CLEAR_GEN1_GEN2(x) ((x) & (~BITS_GEN1_GEN2)) -+#define BIT_GET_GEN1_GEN2(x) (((x) >> BIT_SHIFT_GEN1_GEN2) & BIT_MASK_GEN1_GEN2) -+#define BIT_SET_GEN1_GEN2(x, v) (BIT_CLEAR_GEN1_GEN2(x) | BIT_GEN1_GEN2(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_CS (Offset 0x1350) */ -+ -+#define BIT_AXI_RXDMA_TIMEOUT_IE BIT(13) -+#define BIT_AXI_TXDMA_TIMEOUT_IE BIT(12) -+#define BIT_AXI_DECERR_W_IE BIT(11) -+#define BIT_AXI_DECERR_R_IE BIT(10) -+#define BIT_AXI_SLVERR_W_IE BIT(9) -+#define BIT_AXI_SLVERR_R_IE BIT(8) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_CHANGE_PCIE_SPEED (Offset 0x1350) */ -+ -+#define BIT_SHIFT_RXDMA_ERROR_COUNTER 8 -+#define BIT_MASK_RXDMA_ERROR_COUNTER 0xff -+#define BIT_RXDMA_ERROR_COUNTER(x) \ -+ (((x) & BIT_MASK_RXDMA_ERROR_COUNTER) << BIT_SHIFT_RXDMA_ERROR_COUNTER) -+#define BITS_RXDMA_ERROR_COUNTER \ -+ (BIT_MASK_RXDMA_ERROR_COUNTER << BIT_SHIFT_RXDMA_ERROR_COUNTER) -+#define BIT_CLEAR_RXDMA_ERROR_COUNTER(x) ((x) & (~BITS_RXDMA_ERROR_COUNTER)) -+#define BIT_GET_RXDMA_ERROR_COUNTER(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_ERROR_COUNTER) & BIT_MASK_RXDMA_ERROR_COUNTER) -+#define BIT_SET_RXDMA_ERROR_COUNTER(x, v) \ -+ (BIT_CLEAR_RXDMA_ERROR_COUNTER(x) | BIT_RXDMA_ERROR_COUNTER(v)) -+ -+#define BIT_TXDMA_ERROR_HANDLE_STATUS BIT(7) -+#define BIT_TXDMA_ERROR_PULSE BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_CS (Offset 0x1350) */ -+ -+#define BIT_AXI_RXDMA_TIMEOUT_FLAG BIT(5) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_CHANGE_PCIE_SPEED (Offset 0x1350) */ -+ -+#define BIT_TXDMA_STUCK_ERROR_HANDLE_ENABLE BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_CS (Offset 0x1350) */ -+ -+#define BIT_AXI_TXDMA_TIMEOUT_FLAG BIT(4) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_CHANGE_PCIE_SPEED (Offset 0x1350) */ -+ -+#define BIT_TXDMA_RETURN_ERROR_ENABLE BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_CS (Offset 0x1350) */ -+ -+#define BIT_AXI_DECERR_W_FLAG BIT(3) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_CHANGE_PCIE_SPEED (Offset 0x1350) */ -+ -+#define BIT_RXDMA_ERROR_HANDLE_STATUS BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_CS (Offset 0x1350) */ -+ -+#define BIT_AXI_DECERR_R_FLAG BIT(2) -+#define BIT_AXI_SLVERR_W_FLAG BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_TSFT_PTM_DIFF (Offset 0x1350) */ -+ -+#define BIT_SHIFT_TSFT_PTM_DIFF 0 -+#define BIT_MASK_TSFT_PTM_DIFF 0xffffffffL -+#define BIT_TSFT_PTM_DIFF(x) \ -+ (((x) & BIT_MASK_TSFT_PTM_DIFF) << BIT_SHIFT_TSFT_PTM_DIFF) -+#define BITS_TSFT_PTM_DIFF (BIT_MASK_TSFT_PTM_DIFF << BIT_SHIFT_TSFT_PTM_DIFF) -+#define BIT_CLEAR_TSFT_PTM_DIFF(x) ((x) & (~BITS_TSFT_PTM_DIFF)) -+#define BIT_GET_TSFT_PTM_DIFF(x) \ -+ (((x) >> BIT_SHIFT_TSFT_PTM_DIFF) & BIT_MASK_TSFT_PTM_DIFF) -+#define BIT_SET_TSFT_PTM_DIFF(x, v) \ -+ (BIT_CLEAR_TSFT_PTM_DIFF(x) | BIT_TSFT_PTM_DIFF(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_CS (Offset 0x1350) */ -+ -+#define BIT_AXI_SLVERR_R_FLAG BIT(0) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_CHANGE_PCIE_SPEED (Offset 0x1350) */ -+ -+#define BIT_SHIFT_AUTO_HANG_RELEASE 0 -+#define BIT_MASK_AUTO_HANG_RELEASE 0x7 -+#define BIT_AUTO_HANG_RELEASE(x) \ -+ (((x) & BIT_MASK_AUTO_HANG_RELEASE) << BIT_SHIFT_AUTO_HANG_RELEASE) -+#define BITS_AUTO_HANG_RELEASE \ -+ (BIT_MASK_AUTO_HANG_RELEASE << BIT_SHIFT_AUTO_HANG_RELEASE) -+#define BIT_CLEAR_AUTO_HANG_RELEASE(x) ((x) & (~BITS_AUTO_HANG_RELEASE)) -+#define BIT_GET_AUTO_HANG_RELEASE(x) \ -+ (((x) >> BIT_SHIFT_AUTO_HANG_RELEASE) & BIT_MASK_AUTO_HANG_RELEASE) -+#define BIT_SET_AUTO_HANG_RELEASE(x, v) \ -+ (BIT_CLEAR_AUTO_HANG_RELEASE(x) | BIT_AUTO_HANG_RELEASE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_TIME (Offset 0x1354) */ -+ -+#define BIT_SHIFT_AXI_RECOVERY_TIME 24 -+#define BIT_MASK_AXI_RECOVERY_TIME 0xff -+#define BIT_AXI_RECOVERY_TIME(x) \ -+ (((x) & BIT_MASK_AXI_RECOVERY_TIME) << BIT_SHIFT_AXI_RECOVERY_TIME) -+#define BITS_AXI_RECOVERY_TIME \ -+ (BIT_MASK_AXI_RECOVERY_TIME << BIT_SHIFT_AXI_RECOVERY_TIME) -+#define BIT_CLEAR_AXI_RECOVERY_TIME(x) ((x) & (~BITS_AXI_RECOVERY_TIME)) -+#define BIT_GET_AXI_RECOVERY_TIME(x) \ -+ (((x) >> BIT_SHIFT_AXI_RECOVERY_TIME) & BIT_MASK_AXI_RECOVERY_TIME) -+#define BIT_SET_AXI_RECOVERY_TIME(x, v) \ -+ (BIT_CLEAR_AXI_RECOVERY_TIME(x) | BIT_AXI_RECOVERY_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PTM_CTRL_STATUS (Offset 0x1354) */ -+ -+#define BIT_BCNQ2_EMPTY BIT(23) -+#define BIT_BCNQ1_EMPTY BIT(22) -+#define BIT_BCNQ0_EMPTY BIT(21) -+#define BIT_EVTQ_EMPTY BIT(20) -+#define BIT_MGQ_CPU_EMPTY_V2 BIT(19) -+#define BIT_BCNQ_EMPTY_V2 BIT(18) -+#define BIT_HQQ_EMPTY_V2 BIT(17) -+ -+#define BIT_SHIFT_TAIL_PKT_V1 16 -+#define BIT_MASK_TAIL_PKT_V1 0xff -+#define BIT_TAIL_PKT_V1(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_V1) << BIT_SHIFT_TAIL_PKT_V1) -+#define BITS_TAIL_PKT_V1 (BIT_MASK_TAIL_PKT_V1 << BIT_SHIFT_TAIL_PKT_V1) -+#define BIT_CLEAR_TAIL_PKT_V1(x) ((x) & (~BITS_TAIL_PKT_V1)) -+#define BIT_GET_TAIL_PKT_V1(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_V1) & BIT_MASK_TAIL_PKT_V1) -+#define BIT_SET_TAIL_PKT_V1(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_V1(x) | BIT_TAIL_PKT_V1(v)) -+ -+#define BIT_MQQ_EMPTY_V3 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_TIME (Offset 0x1354) */ -+ -+#define BIT_SHIFT_AXI_RXDMA_TIMEOUT_VAL 12 -+#define BIT_MASK_AXI_RXDMA_TIMEOUT_VAL 0xfff -+#define BIT_AXI_RXDMA_TIMEOUT_VAL(x) \ -+ (((x) & BIT_MASK_AXI_RXDMA_TIMEOUT_VAL) \ -+ << BIT_SHIFT_AXI_RXDMA_TIMEOUT_VAL) -+#define BITS_AXI_RXDMA_TIMEOUT_VAL \ -+ (BIT_MASK_AXI_RXDMA_TIMEOUT_VAL << BIT_SHIFT_AXI_RXDMA_TIMEOUT_VAL) -+#define BIT_CLEAR_AXI_RXDMA_TIMEOUT_VAL(x) ((x) & (~BITS_AXI_RXDMA_TIMEOUT_VAL)) -+#define BIT_GET_AXI_RXDMA_TIMEOUT_VAL(x) \ -+ (((x) >> BIT_SHIFT_AXI_RXDMA_TIMEOUT_VAL) & \ -+ BIT_MASK_AXI_RXDMA_TIMEOUT_VAL) -+#define BIT_SET_AXI_RXDMA_TIMEOUT_VAL(x, v) \ -+ (BIT_CLEAR_AXI_RXDMA_TIMEOUT_VAL(x) | BIT_AXI_RXDMA_TIMEOUT_VAL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_PTM_CTRL_STATUS (Offset 0x1354) */ -+ -+#define BIT_SHIFT_PKT_NUM_V1 8 -+#define BIT_MASK_PKT_NUM_V1 0xff -+#define BIT_PKT_NUM_V1(x) (((x) & BIT_MASK_PKT_NUM_V1) << BIT_SHIFT_PKT_NUM_V1) -+#define BITS_PKT_NUM_V1 (BIT_MASK_PKT_NUM_V1 << BIT_SHIFT_PKT_NUM_V1) -+#define BIT_CLEAR_PKT_NUM_V1(x) ((x) & (~BITS_PKT_NUM_V1)) -+#define BIT_GET_PKT_NUM_V1(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_V1) & BIT_MASK_PKT_NUM_V1) -+#define BIT_SET_PKT_NUM_V1(x, v) (BIT_CLEAR_PKT_NUM_V1(x) | BIT_PKT_NUM_V1(v)) -+ -+#define BIT_SHIFT_QUEUEAC_V1 8 -+#define BIT_MASK_QUEUEAC_V1 0x3 -+#define BIT_QUEUEAC_V1(x) (((x) & BIT_MASK_QUEUEAC_V1) << BIT_SHIFT_QUEUEAC_V1) -+#define BITS_QUEUEAC_V1 (BIT_MASK_QUEUEAC_V1 << BIT_SHIFT_QUEUEAC_V1) -+#define BIT_CLEAR_QUEUEAC_V1(x) ((x) & (~BITS_QUEUEAC_V1)) -+#define BIT_GET_QUEUEAC_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_V1) & BIT_MASK_QUEUEAC_V1) -+#define BIT_SET_QUEUEAC_V1(x, v) (BIT_CLEAR_QUEUEAC_V1(x) | BIT_QUEUEAC_V1(v)) -+ -+#define BIT_SHIFT_ACQ_STOP 5 -+#define BIT_MASK_ACQ_STOP 0xffff -+#define BIT_ACQ_STOP(x) (((x) & BIT_MASK_ACQ_STOP) << BIT_SHIFT_ACQ_STOP) -+#define BITS_ACQ_STOP (BIT_MASK_ACQ_STOP << BIT_SHIFT_ACQ_STOP) -+#define BIT_CLEAR_ACQ_STOP(x) ((x) & (~BITS_ACQ_STOP)) -+#define BIT_GET_ACQ_STOP(x) (((x) >> BIT_SHIFT_ACQ_STOP) & BIT_MASK_ACQ_STOP) -+#define BIT_SET_ACQ_STOP(x, v) (BIT_CLEAR_ACQ_STOP(x) | BIT_ACQ_STOP(v)) -+ -+#define BIT_SHIFT_TSFT_PORT_SEL 3 -+#define BIT_MASK_TSFT_PORT_SEL 0x3 -+#define BIT_TSFT_PORT_SEL(x) \ -+ (((x) & BIT_MASK_TSFT_PORT_SEL) << BIT_SHIFT_TSFT_PORT_SEL) -+#define BITS_TSFT_PORT_SEL (BIT_MASK_TSFT_PORT_SEL << BIT_SHIFT_TSFT_PORT_SEL) -+#define BIT_CLEAR_TSFT_PORT_SEL(x) ((x) & (~BITS_TSFT_PORT_SEL)) -+#define BIT_GET_TSFT_PORT_SEL(x) \ -+ (((x) >> BIT_SHIFT_TSFT_PORT_SEL) & BIT_MASK_TSFT_PORT_SEL) -+#define BIT_SET_TSFT_PORT_SEL(x, v) \ -+ (BIT_CLEAR_TSFT_PORT_SEL(x) | BIT_TSFT_PORT_SEL(v)) -+ -+#define BIT_PTM_CONTEXT_VALID BIT(2) -+#define BIT_PTM_MANUL_UPDATE BIT(1) -+#define BIT_PTM_AUTO_UPDATE BIT(0) -+ -+#define BIT_SHIFT_HEAD_PKT_V1 0 -+#define BIT_MASK_HEAD_PKT_V1 0xff -+#define BIT_HEAD_PKT_V1(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_V1) << BIT_SHIFT_HEAD_PKT_V1) -+#define BITS_HEAD_PKT_V1 (BIT_MASK_HEAD_PKT_V1 << BIT_SHIFT_HEAD_PKT_V1) -+#define BIT_CLEAR_HEAD_PKT_V1(x) ((x) & (~BITS_HEAD_PKT_V1)) -+#define BIT_GET_HEAD_PKT_V1(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_V1) & BIT_MASK_HEAD_PKT_V1) -+#define BIT_SET_HEAD_PKT_V1(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_V1(x) | BIT_HEAD_PKT_V1(v)) -+ -+#define BIT_SHIFT_QUEUEMACID_V1 0 -+#define BIT_MASK_QUEUEMACID_V1 0x7f -+#define BIT_QUEUEMACID_V1(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_V1) << BIT_SHIFT_QUEUEMACID_V1) -+#define BITS_QUEUEMACID_V1 (BIT_MASK_QUEUEMACID_V1 << BIT_SHIFT_QUEUEMACID_V1) -+#define BIT_CLEAR_QUEUEMACID_V1(x) ((x) & (~BITS_QUEUEMACID_V1)) -+#define BIT_GET_QUEUEMACID_V1(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_V1) & BIT_MASK_QUEUEMACID_V1) -+#define BIT_SET_QUEUEMACID_V1(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_V1(x) | BIT_QUEUEMACID_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_AXI_EXCEPT_TIME (Offset 0x1354) */ -+ -+#define BIT_SHIFT_AXI_TXDMA_TIMEOUT_VAL 0 -+#define BIT_MASK_AXI_TXDMA_TIMEOUT_VAL 0xfff -+#define BIT_AXI_TXDMA_TIMEOUT_VAL(x) \ -+ (((x) & BIT_MASK_AXI_TXDMA_TIMEOUT_VAL) \ -+ << BIT_SHIFT_AXI_TXDMA_TIMEOUT_VAL) -+#define BITS_AXI_TXDMA_TIMEOUT_VAL \ -+ (BIT_MASK_AXI_TXDMA_TIMEOUT_VAL << BIT_SHIFT_AXI_TXDMA_TIMEOUT_VAL) -+#define BIT_CLEAR_AXI_TXDMA_TIMEOUT_VAL(x) ((x) & (~BITS_AXI_TXDMA_TIMEOUT_VAL)) -+#define BIT_GET_AXI_TXDMA_TIMEOUT_VAL(x) \ -+ (((x) >> BIT_SHIFT_AXI_TXDMA_TIMEOUT_VAL) & \ -+ BIT_MASK_AXI_TXDMA_TIMEOUT_VAL) -+#define BIT_SET_AXI_TXDMA_TIMEOUT_VAL(x, v) \ -+ (BIT_CLEAR_AXI_TXDMA_TIMEOUT_VAL(x) | BIT_AXI_TXDMA_TIMEOUT_VAL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DEBUG_STATE1 (Offset 0x1354) */ -+ -+#define BIT_SHIFT_DEBUG_STATE1 0 -+#define BIT_MASK_DEBUG_STATE1 0xffffffffL -+#define BIT_DEBUG_STATE1(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE1) << BIT_SHIFT_DEBUG_STATE1) -+#define BITS_DEBUG_STATE1 (BIT_MASK_DEBUG_STATE1 << BIT_SHIFT_DEBUG_STATE1) -+#define BIT_CLEAR_DEBUG_STATE1(x) ((x) & (~BITS_DEBUG_STATE1)) -+#define BIT_GET_DEBUG_STATE1(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE1) & BIT_MASK_DEBUG_STATE1) -+#define BIT_SET_DEBUG_STATE1(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE1(x) | BIT_DEBUG_STATE1(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI8Q_TXBD_IDX (Offset 0x1358) */ -+ -+#define BIT_SHIFT_HI8Q_HW_IDX 16 -+#define BIT_MASK_HI8Q_HW_IDX 0xfff -+#define BIT_HI8Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI8Q_HW_IDX) << BIT_SHIFT_HI8Q_HW_IDX) -+#define BITS_HI8Q_HW_IDX (BIT_MASK_HI8Q_HW_IDX << BIT_SHIFT_HI8Q_HW_IDX) -+#define BIT_CLEAR_HI8Q_HW_IDX(x) ((x) & (~BITS_HI8Q_HW_IDX)) -+#define BIT_GET_HI8Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI8Q_HW_IDX) & BIT_MASK_HI8Q_HW_IDX) -+#define BIT_SET_HI8Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI8Q_HW_IDX(x) | BIT_HI8Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_HI8Q_HOST_IDX 0 -+#define BIT_MASK_HI8Q_HOST_IDX 0xfff -+#define BIT_HI8Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI8Q_HOST_IDX) << BIT_SHIFT_HI8Q_HOST_IDX) -+#define BITS_HI8Q_HOST_IDX (BIT_MASK_HI8Q_HOST_IDX << BIT_SHIFT_HI8Q_HOST_IDX) -+#define BIT_CLEAR_HI8Q_HOST_IDX(x) ((x) & (~BITS_HI8Q_HOST_IDX)) -+#define BIT_GET_HI8Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI8Q_HOST_IDX) & BIT_MASK_HI8Q_HOST_IDX) -+#define BIT_SET_HI8Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI8Q_HOST_IDX(x) | BIT_HI8Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DEBUG_STATE2 (Offset 0x1358) */ -+ -+#define BIT_SHIFT_DEBUG_STATE2 0 -+#define BIT_MASK_DEBUG_STATE2 0xffffffffL -+#define BIT_DEBUG_STATE2(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE2) << BIT_SHIFT_DEBUG_STATE2) -+#define BITS_DEBUG_STATE2 (BIT_MASK_DEBUG_STATE2 << BIT_SHIFT_DEBUG_STATE2) -+#define BIT_CLEAR_DEBUG_STATE2(x) ((x) & (~BITS_DEBUG_STATE2)) -+#define BIT_GET_DEBUG_STATE2(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE2) & BIT_MASK_DEBUG_STATE2) -+#define BIT_SET_DEBUG_STATE2(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE2(x) | BIT_DEBUG_STATE2(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI9Q_TXBD_IDX (Offset 0x135C) */ -+ -+#define BIT_SHIFT_HI9Q_HW_IDX 16 -+#define BIT_MASK_HI9Q_HW_IDX 0xfff -+#define BIT_HI9Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI9Q_HW_IDX) << BIT_SHIFT_HI9Q_HW_IDX) -+#define BITS_HI9Q_HW_IDX (BIT_MASK_HI9Q_HW_IDX << BIT_SHIFT_HI9Q_HW_IDX) -+#define BIT_CLEAR_HI9Q_HW_IDX(x) ((x) & (~BITS_HI9Q_HW_IDX)) -+#define BIT_GET_HI9Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI9Q_HW_IDX) & BIT_MASK_HI9Q_HW_IDX) -+#define BIT_SET_HI9Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI9Q_HW_IDX(x) | BIT_HI9Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_HI9Q_HOST_IDX 0 -+#define BIT_MASK_HI9Q_HOST_IDX 0xfff -+#define BIT_HI9Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI9Q_HOST_IDX) << BIT_SHIFT_HI9Q_HOST_IDX) -+#define BITS_HI9Q_HOST_IDX (BIT_MASK_HI9Q_HOST_IDX << BIT_SHIFT_HI9Q_HOST_IDX) -+#define BIT_CLEAR_HI9Q_HOST_IDX(x) ((x) & (~BITS_HI9Q_HOST_IDX)) -+#define BIT_GET_HI9Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI9Q_HOST_IDX) & BIT_MASK_HI9Q_HOST_IDX) -+#define BIT_SET_HI9Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI9Q_HOST_IDX(x) | BIT_HI9Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_DEBUG_STATE3 (Offset 0x135C) */ -+ -+#define BIT_SHIFT_DEBUG_STATE3 0 -+#define BIT_MASK_DEBUG_STATE3 0xffffffffL -+#define BIT_DEBUG_STATE3(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE3) << BIT_SHIFT_DEBUG_STATE3) -+#define BITS_DEBUG_STATE3 (BIT_MASK_DEBUG_STATE3 << BIT_SHIFT_DEBUG_STATE3) -+#define BIT_CLEAR_DEBUG_STATE3(x) ((x) & (~BITS_DEBUG_STATE3)) -+#define BIT_GET_DEBUG_STATE3(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE3) & BIT_MASK_DEBUG_STATE3) -+#define BIT_SET_DEBUG_STATE3(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE3(x) | BIT_DEBUG_STATE3(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI10Q_TXBD_IDX (Offset 0x1360) */ -+ -+#define BIT_SHIFT_HI10Q_HW_IDX 16 -+#define BIT_MASK_HI10Q_HW_IDX 0xfff -+#define BIT_HI10Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI10Q_HW_IDX) << BIT_SHIFT_HI10Q_HW_IDX) -+#define BITS_HI10Q_HW_IDX (BIT_MASK_HI10Q_HW_IDX << BIT_SHIFT_HI10Q_HW_IDX) -+#define BIT_CLEAR_HI10Q_HW_IDX(x) ((x) & (~BITS_HI10Q_HW_IDX)) -+#define BIT_GET_HI10Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI10Q_HW_IDX) & BIT_MASK_HI10Q_HW_IDX) -+#define BIT_SET_HI10Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI10Q_HW_IDX(x) | BIT_HI10Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_HI10Q_HOST_IDX 0 -+#define BIT_MASK_HI10Q_HOST_IDX 0xfff -+#define BIT_HI10Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI10Q_HOST_IDX) << BIT_SHIFT_HI10Q_HOST_IDX) -+#define BITS_HI10Q_HOST_IDX \ -+ (BIT_MASK_HI10Q_HOST_IDX << BIT_SHIFT_HI10Q_HOST_IDX) -+#define BIT_CLEAR_HI10Q_HOST_IDX(x) ((x) & (~BITS_HI10Q_HOST_IDX)) -+#define BIT_GET_HI10Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI10Q_HOST_IDX) & BIT_MASK_HI10Q_HOST_IDX) -+#define BIT_SET_HI10Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI10Q_HOST_IDX(x) | BIT_HI10Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH5_TXBD_DESA_L (Offset 0x1360) */ -+ -+#define BIT_SHIFT_ACH5_TXBD_DESA_L 0 -+#define BIT_MASK_ACH5_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH5_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH5_TXBD_DESA_L) << BIT_SHIFT_ACH5_TXBD_DESA_L) -+#define BITS_ACH5_TXBD_DESA_L \ -+ (BIT_MASK_ACH5_TXBD_DESA_L << BIT_SHIFT_ACH5_TXBD_DESA_L) -+#define BIT_CLEAR_ACH5_TXBD_DESA_L(x) ((x) & (~BITS_ACH5_TXBD_DESA_L)) -+#define BIT_GET_ACH5_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH5_TXBD_DESA_L) & BIT_MASK_ACH5_TXBD_DESA_L) -+#define BIT_SET_ACH5_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH5_TXBD_DESA_L(x) | BIT_ACH5_TXBD_DESA_L(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI11Q_TXBD_IDX (Offset 0x1364) */ -+ -+#define BIT_SHIFT_HI11Q_HW_IDX 16 -+#define BIT_MASK_HI11Q_HW_IDX 0xfff -+#define BIT_HI11Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI11Q_HW_IDX) << BIT_SHIFT_HI11Q_HW_IDX) -+#define BITS_HI11Q_HW_IDX (BIT_MASK_HI11Q_HW_IDX << BIT_SHIFT_HI11Q_HW_IDX) -+#define BIT_CLEAR_HI11Q_HW_IDX(x) ((x) & (~BITS_HI11Q_HW_IDX)) -+#define BIT_GET_HI11Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI11Q_HW_IDX) & BIT_MASK_HI11Q_HW_IDX) -+#define BIT_SET_HI11Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI11Q_HW_IDX(x) | BIT_HI11Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_HI11Q_HOST_IDX 0 -+#define BIT_MASK_HI11Q_HOST_IDX 0xfff -+#define BIT_HI11Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI11Q_HOST_IDX) << BIT_SHIFT_HI11Q_HOST_IDX) -+#define BITS_HI11Q_HOST_IDX \ -+ (BIT_MASK_HI11Q_HOST_IDX << BIT_SHIFT_HI11Q_HOST_IDX) -+#define BIT_CLEAR_HI11Q_HOST_IDX(x) ((x) & (~BITS_HI11Q_HOST_IDX)) -+#define BIT_GET_HI11Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI11Q_HOST_IDX) & BIT_MASK_HI11Q_HOST_IDX) -+#define BIT_SET_HI11Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI11Q_HOST_IDX(x) | BIT_HI11Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH5_TXBD_DESA_H (Offset 0x1364) */ -+ -+#define BIT_SHIFT_ACH5_TXBD_DESA_H 0 -+#define BIT_MASK_ACH5_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH5_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH5_TXBD_DESA_H) << BIT_SHIFT_ACH5_TXBD_DESA_H) -+#define BITS_ACH5_TXBD_DESA_H \ -+ (BIT_MASK_ACH5_TXBD_DESA_H << BIT_SHIFT_ACH5_TXBD_DESA_H) -+#define BIT_CLEAR_ACH5_TXBD_DESA_H(x) ((x) & (~BITS_ACH5_TXBD_DESA_H)) -+#define BIT_GET_ACH5_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH5_TXBD_DESA_H) & BIT_MASK_ACH5_TXBD_DESA_H) -+#define BIT_SET_ACH5_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH5_TXBD_DESA_H(x) | BIT_ACH5_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI12Q_TXBD_IDX (Offset 0x1368) */ -+ -+#define BIT_SHIFT_HI12Q_HW_IDX 16 -+#define BIT_MASK_HI12Q_HW_IDX 0xfff -+#define BIT_HI12Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI12Q_HW_IDX) << BIT_SHIFT_HI12Q_HW_IDX) -+#define BITS_HI12Q_HW_IDX (BIT_MASK_HI12Q_HW_IDX << BIT_SHIFT_HI12Q_HW_IDX) -+#define BIT_CLEAR_HI12Q_HW_IDX(x) ((x) & (~BITS_HI12Q_HW_IDX)) -+#define BIT_GET_HI12Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI12Q_HW_IDX) & BIT_MASK_HI12Q_HW_IDX) -+#define BIT_SET_HI12Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI12Q_HW_IDX(x) | BIT_HI12Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_HI12Q_HOST_IDX 0 -+#define BIT_MASK_HI12Q_HOST_IDX 0xfff -+#define BIT_HI12Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI12Q_HOST_IDX) << BIT_SHIFT_HI12Q_HOST_IDX) -+#define BITS_HI12Q_HOST_IDX \ -+ (BIT_MASK_HI12Q_HOST_IDX << BIT_SHIFT_HI12Q_HOST_IDX) -+#define BIT_CLEAR_HI12Q_HOST_IDX(x) ((x) & (~BITS_HI12Q_HOST_IDX)) -+#define BIT_GET_HI12Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI12Q_HOST_IDX) & BIT_MASK_HI12Q_HOST_IDX) -+#define BIT_SET_HI12Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI12Q_HOST_IDX(x) | BIT_HI12Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH6_TXBD_DESA_L (Offset 0x1368) */ -+ -+#define BIT_SHIFT_ACH6_TXBD_DESA_L 0 -+#define BIT_MASK_ACH6_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH6_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH6_TXBD_DESA_L) << BIT_SHIFT_ACH6_TXBD_DESA_L) -+#define BITS_ACH6_TXBD_DESA_L \ -+ (BIT_MASK_ACH6_TXBD_DESA_L << BIT_SHIFT_ACH6_TXBD_DESA_L) -+#define BIT_CLEAR_ACH6_TXBD_DESA_L(x) ((x) & (~BITS_ACH6_TXBD_DESA_L)) -+#define BIT_GET_ACH6_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH6_TXBD_DESA_L) & BIT_MASK_ACH6_TXBD_DESA_L) -+#define BIT_SET_ACH6_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH6_TXBD_DESA_L(x) | BIT_ACH6_TXBD_DESA_L(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI13Q_TXBD_IDX (Offset 0x136C) */ -+ -+#define BIT_SHIFT_HI13Q_HW_IDX 16 -+#define BIT_MASK_HI13Q_HW_IDX 0xfff -+#define BIT_HI13Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI13Q_HW_IDX) << BIT_SHIFT_HI13Q_HW_IDX) -+#define BITS_HI13Q_HW_IDX (BIT_MASK_HI13Q_HW_IDX << BIT_SHIFT_HI13Q_HW_IDX) -+#define BIT_CLEAR_HI13Q_HW_IDX(x) ((x) & (~BITS_HI13Q_HW_IDX)) -+#define BIT_GET_HI13Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI13Q_HW_IDX) & BIT_MASK_HI13Q_HW_IDX) -+#define BIT_SET_HI13Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI13Q_HW_IDX(x) | BIT_HI13Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_HI13Q_HOST_IDX 0 -+#define BIT_MASK_HI13Q_HOST_IDX 0xfff -+#define BIT_HI13Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI13Q_HOST_IDX) << BIT_SHIFT_HI13Q_HOST_IDX) -+#define BITS_HI13Q_HOST_IDX \ -+ (BIT_MASK_HI13Q_HOST_IDX << BIT_SHIFT_HI13Q_HOST_IDX) -+#define BIT_CLEAR_HI13Q_HOST_IDX(x) ((x) & (~BITS_HI13Q_HOST_IDX)) -+#define BIT_GET_HI13Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI13Q_HOST_IDX) & BIT_MASK_HI13Q_HOST_IDX) -+#define BIT_SET_HI13Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI13Q_HOST_IDX(x) | BIT_HI13Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH6_TXBD_DESA_H (Offset 0x136C) */ -+ -+#define BIT_SHIFT_ACH6_TXBD_DESA_H 0 -+#define BIT_MASK_ACH6_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH6_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH6_TXBD_DESA_H) << BIT_SHIFT_ACH6_TXBD_DESA_H) -+#define BITS_ACH6_TXBD_DESA_H \ -+ (BIT_MASK_ACH6_TXBD_DESA_H << BIT_SHIFT_ACH6_TXBD_DESA_H) -+#define BIT_CLEAR_ACH6_TXBD_DESA_H(x) ((x) & (~BITS_ACH6_TXBD_DESA_H)) -+#define BIT_GET_ACH6_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH6_TXBD_DESA_H) & BIT_MASK_ACH6_TXBD_DESA_H) -+#define BIT_SET_ACH6_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH6_TXBD_DESA_H(x) | BIT_ACH6_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI14Q_TXBD_IDX (Offset 0x1370) */ -+ -+#define BIT_SHIFT_HI14Q_HW_IDX 16 -+#define BIT_MASK_HI14Q_HW_IDX 0xfff -+#define BIT_HI14Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI14Q_HW_IDX) << BIT_SHIFT_HI14Q_HW_IDX) -+#define BITS_HI14Q_HW_IDX (BIT_MASK_HI14Q_HW_IDX << BIT_SHIFT_HI14Q_HW_IDX) -+#define BIT_CLEAR_HI14Q_HW_IDX(x) ((x) & (~BITS_HI14Q_HW_IDX)) -+#define BIT_GET_HI14Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI14Q_HW_IDX) & BIT_MASK_HI14Q_HW_IDX) -+#define BIT_SET_HI14Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI14Q_HW_IDX(x) | BIT_HI14Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_HI14Q_HOST_IDX 0 -+#define BIT_MASK_HI14Q_HOST_IDX 0xfff -+#define BIT_HI14Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI14Q_HOST_IDX) << BIT_SHIFT_HI14Q_HOST_IDX) -+#define BITS_HI14Q_HOST_IDX \ -+ (BIT_MASK_HI14Q_HOST_IDX << BIT_SHIFT_HI14Q_HOST_IDX) -+#define BIT_CLEAR_HI14Q_HOST_IDX(x) ((x) & (~BITS_HI14Q_HOST_IDX)) -+#define BIT_GET_HI14Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI14Q_HOST_IDX) & BIT_MASK_HI14Q_HOST_IDX) -+#define BIT_SET_HI14Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI14Q_HOST_IDX(x) | BIT_HI14Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH7_TXBD_DESA_L (Offset 0x1370) */ -+ -+#define BIT_SHIFT_ACH7_TXBD_DESA_L 0 -+#define BIT_MASK_ACH7_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH7_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH7_TXBD_DESA_L) << BIT_SHIFT_ACH7_TXBD_DESA_L) -+#define BITS_ACH7_TXBD_DESA_L \ -+ (BIT_MASK_ACH7_TXBD_DESA_L << BIT_SHIFT_ACH7_TXBD_DESA_L) -+#define BIT_CLEAR_ACH7_TXBD_DESA_L(x) ((x) & (~BITS_ACH7_TXBD_DESA_L)) -+#define BIT_GET_ACH7_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH7_TXBD_DESA_L) & BIT_MASK_ACH7_TXBD_DESA_L) -+#define BIT_SET_ACH7_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH7_TXBD_DESA_L(x) | BIT_ACH7_TXBD_DESA_L(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI15Q_TXBD_IDX (Offset 0x1374) */ -+ -+#define BIT_SHIFT_HI15Q_HW_IDX 16 -+#define BIT_MASK_HI15Q_HW_IDX 0xfff -+#define BIT_HI15Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_HI15Q_HW_IDX) << BIT_SHIFT_HI15Q_HW_IDX) -+#define BITS_HI15Q_HW_IDX (BIT_MASK_HI15Q_HW_IDX << BIT_SHIFT_HI15Q_HW_IDX) -+#define BIT_CLEAR_HI15Q_HW_IDX(x) ((x) & (~BITS_HI15Q_HW_IDX)) -+#define BIT_GET_HI15Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI15Q_HW_IDX) & BIT_MASK_HI15Q_HW_IDX) -+#define BIT_SET_HI15Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_HI15Q_HW_IDX(x) | BIT_HI15Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_HI15Q_HOST_IDX 0 -+#define BIT_MASK_HI15Q_HOST_IDX 0xfff -+#define BIT_HI15Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_HI15Q_HOST_IDX) << BIT_SHIFT_HI15Q_HOST_IDX) -+#define BITS_HI15Q_HOST_IDX \ -+ (BIT_MASK_HI15Q_HOST_IDX << BIT_SHIFT_HI15Q_HOST_IDX) -+#define BIT_CLEAR_HI15Q_HOST_IDX(x) ((x) & (~BITS_HI15Q_HOST_IDX)) -+#define BIT_GET_HI15Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_HI15Q_HOST_IDX) & BIT_MASK_HI15Q_HOST_IDX) -+#define BIT_SET_HI15Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_HI15Q_HOST_IDX(x) | BIT_HI15Q_HOST_IDX(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH7_TXBD_DESA_H (Offset 0x1374) */ -+ -+#define BIT_SHIFT_ACH7_TXBD_DESA_H 0 -+#define BIT_MASK_ACH7_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH7_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH7_TXBD_DESA_H) << BIT_SHIFT_ACH7_TXBD_DESA_H) -+#define BITS_ACH7_TXBD_DESA_H \ -+ (BIT_MASK_ACH7_TXBD_DESA_H << BIT_SHIFT_ACH7_TXBD_DESA_H) -+#define BIT_CLEAR_ACH7_TXBD_DESA_H(x) ((x) & (~BITS_ACH7_TXBD_DESA_H)) -+#define BIT_GET_ACH7_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH7_TXBD_DESA_H) & BIT_MASK_ACH7_TXBD_DESA_H) -+#define BIT_SET_ACH7_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH7_TXBD_DESA_H(x) | BIT_ACH7_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI8Q_TXBD_DESA (Offset 0x1378) */ -+ -+#define BIT_SHIFT_HI8Q_TXBD_DESA 0 -+#define BIT_MASK_HI8Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI8Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI8Q_TXBD_DESA) << BIT_SHIFT_HI8Q_TXBD_DESA) -+#define BITS_HI8Q_TXBD_DESA \ -+ (BIT_MASK_HI8Q_TXBD_DESA << BIT_SHIFT_HI8Q_TXBD_DESA) -+#define BIT_CLEAR_HI8Q_TXBD_DESA(x) ((x) & (~BITS_HI8Q_TXBD_DESA)) -+#define BIT_GET_HI8Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI8Q_TXBD_DESA) & BIT_MASK_HI8Q_TXBD_DESA) -+#define BIT_SET_HI8Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI8Q_TXBD_DESA(x) | BIT_HI8Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH8_TXBD_DESA_L (Offset 0x1378) */ -+ -+#define BIT_SHIFT_ACH8_TXBD_DESA_L 0 -+#define BIT_MASK_ACH8_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH8_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH8_TXBD_DESA_L) << BIT_SHIFT_ACH8_TXBD_DESA_L) -+#define BITS_ACH8_TXBD_DESA_L \ -+ (BIT_MASK_ACH8_TXBD_DESA_L << BIT_SHIFT_ACH8_TXBD_DESA_L) -+#define BIT_CLEAR_ACH8_TXBD_DESA_L(x) ((x) & (~BITS_ACH8_TXBD_DESA_L)) -+#define BIT_GET_ACH8_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH8_TXBD_DESA_L) & BIT_MASK_ACH8_TXBD_DESA_L) -+#define BIT_SET_ACH8_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH8_TXBD_DESA_L(x) | BIT_ACH8_TXBD_DESA_L(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CHNL_DMA_CFG_V1 (Offset 0x137C) */ -+ -+#define BIT_TXHCI_EN_V1 BIT(26) -+#define BIT_TXHCI_IDLE_V1 BIT(25) -+#define BIT_DMA_PRI_EN_V1 BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH8_TXBD_DESA_H (Offset 0x137C) */ -+ -+#define BIT_SHIFT_ACH8_TXBD_DESA_H 0 -+#define BIT_MASK_ACH8_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH8_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH8_TXBD_DESA_H) << BIT_SHIFT_ACH8_TXBD_DESA_H) -+#define BITS_ACH8_TXBD_DESA_H \ -+ (BIT_MASK_ACH8_TXBD_DESA_H << BIT_SHIFT_ACH8_TXBD_DESA_H) -+#define BIT_CLEAR_ACH8_TXBD_DESA_H(x) ((x) & (~BITS_ACH8_TXBD_DESA_H)) -+#define BIT_GET_ACH8_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH8_TXBD_DESA_H) & BIT_MASK_ACH8_TXBD_DESA_H) -+#define BIT_SET_ACH8_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH8_TXBD_DESA_H(x) | BIT_ACH8_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI9Q_TXBD_DESA (Offset 0x1380) */ -+ -+#define BIT_SHIFT_HI9Q_TXBD_DESA 0 -+#define BIT_MASK_HI9Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI9Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI9Q_TXBD_DESA) << BIT_SHIFT_HI9Q_TXBD_DESA) -+#define BITS_HI9Q_TXBD_DESA \ -+ (BIT_MASK_HI9Q_TXBD_DESA << BIT_SHIFT_HI9Q_TXBD_DESA) -+#define BIT_CLEAR_HI9Q_TXBD_DESA(x) ((x) & (~BITS_HI9Q_TXBD_DESA)) -+#define BIT_GET_HI9Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI9Q_TXBD_DESA) & BIT_MASK_HI9Q_TXBD_DESA) -+#define BIT_SET_HI9Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI9Q_TXBD_DESA(x) | BIT_HI9Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH9_TXBD_DESA_L (Offset 0x1380) */ -+ -+#define BIT_SHIFT_ACH9_TXBD_DESA_L 0 -+#define BIT_MASK_ACH9_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH9_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH9_TXBD_DESA_L) << BIT_SHIFT_ACH9_TXBD_DESA_L) -+#define BITS_ACH9_TXBD_DESA_L \ -+ (BIT_MASK_ACH9_TXBD_DESA_L << BIT_SHIFT_ACH9_TXBD_DESA_L) -+#define BIT_CLEAR_ACH9_TXBD_DESA_L(x) ((x) & (~BITS_ACH9_TXBD_DESA_L)) -+#define BIT_GET_ACH9_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH9_TXBD_DESA_L) & BIT_MASK_ACH9_TXBD_DESA_L) -+#define BIT_SET_ACH9_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH9_TXBD_DESA_L(x) | BIT_ACH9_TXBD_DESA_L(v)) -+ -+/* 2 REG_ACH9_TXBD_DESA_H (Offset 0x1384) */ -+ -+#define BIT_SHIFT_ACH9_TXBD_DESA_H 0 -+#define BIT_MASK_ACH9_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH9_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH9_TXBD_DESA_H) << BIT_SHIFT_ACH9_TXBD_DESA_H) -+#define BITS_ACH9_TXBD_DESA_H \ -+ (BIT_MASK_ACH9_TXBD_DESA_H << BIT_SHIFT_ACH9_TXBD_DESA_H) -+#define BIT_CLEAR_ACH9_TXBD_DESA_H(x) ((x) & (~BITS_ACH9_TXBD_DESA_H)) -+#define BIT_GET_ACH9_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH9_TXBD_DESA_H) & BIT_MASK_ACH9_TXBD_DESA_H) -+#define BIT_SET_ACH9_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH9_TXBD_DESA_H(x) | BIT_ACH9_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI10Q_TXBD_DESA (Offset 0x1388) */ -+ -+#define BIT_SHIFT_HI10Q_TXBD_DESA 0 -+#define BIT_MASK_HI10Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI10Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI10Q_TXBD_DESA) << BIT_SHIFT_HI10Q_TXBD_DESA) -+#define BITS_HI10Q_TXBD_DESA \ -+ (BIT_MASK_HI10Q_TXBD_DESA << BIT_SHIFT_HI10Q_TXBD_DESA) -+#define BIT_CLEAR_HI10Q_TXBD_DESA(x) ((x) & (~BITS_HI10Q_TXBD_DESA)) -+#define BIT_GET_HI10Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI10Q_TXBD_DESA) & BIT_MASK_HI10Q_TXBD_DESA) -+#define BIT_SET_HI10Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI10Q_TXBD_DESA(x) | BIT_HI10Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH10_TXBD_DESA_L (Offset 0x1388) */ -+ -+#define BIT_SHIFT_ACH10_TXBD_DESA_L 0 -+#define BIT_MASK_ACH10_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH10_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH10_TXBD_DESA_L) << BIT_SHIFT_ACH10_TXBD_DESA_L) -+#define BITS_ACH10_TXBD_DESA_L \ -+ (BIT_MASK_ACH10_TXBD_DESA_L << BIT_SHIFT_ACH10_TXBD_DESA_L) -+#define BIT_CLEAR_ACH10_TXBD_DESA_L(x) ((x) & (~BITS_ACH10_TXBD_DESA_L)) -+#define BIT_GET_ACH10_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH10_TXBD_DESA_L) & BIT_MASK_ACH10_TXBD_DESA_L) -+#define BIT_SET_ACH10_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH10_TXBD_DESA_L(x) | BIT_ACH10_TXBD_DESA_L(v)) -+ -+/* 2 REG_ACH10_TXBD_DESA_H (Offset 0x138C) */ -+ -+#define BIT_SHIFT_ACH10_TXBD_DESA_H 0 -+#define BIT_MASK_ACH10_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH10_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH10_TXBD_DESA_H) << BIT_SHIFT_ACH10_TXBD_DESA_H) -+#define BITS_ACH10_TXBD_DESA_H \ -+ (BIT_MASK_ACH10_TXBD_DESA_H << BIT_SHIFT_ACH10_TXBD_DESA_H) -+#define BIT_CLEAR_ACH10_TXBD_DESA_H(x) ((x) & (~BITS_ACH10_TXBD_DESA_H)) -+#define BIT_GET_ACH10_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH10_TXBD_DESA_H) & BIT_MASK_ACH10_TXBD_DESA_H) -+#define BIT_SET_ACH10_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH10_TXBD_DESA_H(x) | BIT_ACH10_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI11Q_TXBD_DESA (Offset 0x1390) */ -+ -+#define BIT_SHIFT_HI11Q_TXBD_DESA 0 -+#define BIT_MASK_HI11Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI11Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI11Q_TXBD_DESA) << BIT_SHIFT_HI11Q_TXBD_DESA) -+#define BITS_HI11Q_TXBD_DESA \ -+ (BIT_MASK_HI11Q_TXBD_DESA << BIT_SHIFT_HI11Q_TXBD_DESA) -+#define BIT_CLEAR_HI11Q_TXBD_DESA(x) ((x) & (~BITS_HI11Q_TXBD_DESA)) -+#define BIT_GET_HI11Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI11Q_TXBD_DESA) & BIT_MASK_HI11Q_TXBD_DESA) -+#define BIT_SET_HI11Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI11Q_TXBD_DESA(x) | BIT_HI11Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH11_TXBD_DESA_L (Offset 0x1390) */ -+ -+#define BIT_SHIFT_ACH11_TXBD_DESA_L 0 -+#define BIT_MASK_ACH11_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH11_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH11_TXBD_DESA_L) << BIT_SHIFT_ACH11_TXBD_DESA_L) -+#define BITS_ACH11_TXBD_DESA_L \ -+ (BIT_MASK_ACH11_TXBD_DESA_L << BIT_SHIFT_ACH11_TXBD_DESA_L) -+#define BIT_CLEAR_ACH11_TXBD_DESA_L(x) ((x) & (~BITS_ACH11_TXBD_DESA_L)) -+#define BIT_GET_ACH11_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH11_TXBD_DESA_L) & BIT_MASK_ACH11_TXBD_DESA_L) -+#define BIT_SET_ACH11_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH11_TXBD_DESA_L(x) | BIT_ACH11_TXBD_DESA_L(v)) -+ -+/* 2 REG_ACH11_TXBD_DESA_H (Offset 0x1394) */ -+ -+#define BIT_SHIFT_ACH11_TXBD_DESA_H 0 -+#define BIT_MASK_ACH11_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH11_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH11_TXBD_DESA_H) << BIT_SHIFT_ACH11_TXBD_DESA_H) -+#define BITS_ACH11_TXBD_DESA_H \ -+ (BIT_MASK_ACH11_TXBD_DESA_H << BIT_SHIFT_ACH11_TXBD_DESA_H) -+#define BIT_CLEAR_ACH11_TXBD_DESA_H(x) ((x) & (~BITS_ACH11_TXBD_DESA_H)) -+#define BIT_GET_ACH11_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH11_TXBD_DESA_H) & BIT_MASK_ACH11_TXBD_DESA_H) -+#define BIT_SET_ACH11_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH11_TXBD_DESA_H(x) | BIT_ACH11_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI12Q_TXBD_DESA (Offset 0x1398) */ -+ -+#define BIT_SHIFT_HI12Q_TXBD_DESA 0 -+#define BIT_MASK_HI12Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI12Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI12Q_TXBD_DESA) << BIT_SHIFT_HI12Q_TXBD_DESA) -+#define BITS_HI12Q_TXBD_DESA \ -+ (BIT_MASK_HI12Q_TXBD_DESA << BIT_SHIFT_HI12Q_TXBD_DESA) -+#define BIT_CLEAR_HI12Q_TXBD_DESA(x) ((x) & (~BITS_HI12Q_TXBD_DESA)) -+#define BIT_GET_HI12Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI12Q_TXBD_DESA) & BIT_MASK_HI12Q_TXBD_DESA) -+#define BIT_SET_HI12Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI12Q_TXBD_DESA(x) | BIT_HI12Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH12_TXBD_DESA_L (Offset 0x1398) */ -+ -+#define BIT_SHIFT_ACH12_TXBD_DESA_L 0 -+#define BIT_MASK_ACH12_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH12_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH12_TXBD_DESA_L) << BIT_SHIFT_ACH12_TXBD_DESA_L) -+#define BITS_ACH12_TXBD_DESA_L \ -+ (BIT_MASK_ACH12_TXBD_DESA_L << BIT_SHIFT_ACH12_TXBD_DESA_L) -+#define BIT_CLEAR_ACH12_TXBD_DESA_L(x) ((x) & (~BITS_ACH12_TXBD_DESA_L)) -+#define BIT_GET_ACH12_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH12_TXBD_DESA_L) & BIT_MASK_ACH12_TXBD_DESA_L) -+#define BIT_SET_ACH12_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH12_TXBD_DESA_L(x) | BIT_ACH12_TXBD_DESA_L(v)) -+ -+/* 2 REG_ACH12_TXBD_DESA_H (Offset 0x139C) */ -+ -+#define BIT_SHIFT_ACH12_TXBD_DESA_H 0 -+#define BIT_MASK_ACH12_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH12_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH12_TXBD_DESA_H) << BIT_SHIFT_ACH12_TXBD_DESA_H) -+#define BITS_ACH12_TXBD_DESA_H \ -+ (BIT_MASK_ACH12_TXBD_DESA_H << BIT_SHIFT_ACH12_TXBD_DESA_H) -+#define BIT_CLEAR_ACH12_TXBD_DESA_H(x) ((x) & (~BITS_ACH12_TXBD_DESA_H)) -+#define BIT_GET_ACH12_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH12_TXBD_DESA_H) & BIT_MASK_ACH12_TXBD_DESA_H) -+#define BIT_SET_ACH12_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH12_TXBD_DESA_H(x) | BIT_ACH12_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI13Q_TXBD_DESA (Offset 0x13A0) */ -+ -+#define BIT_SHIFT_HI13Q_TXBD_DESA 0 -+#define BIT_MASK_HI13Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI13Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI13Q_TXBD_DESA) << BIT_SHIFT_HI13Q_TXBD_DESA) -+#define BITS_HI13Q_TXBD_DESA \ -+ (BIT_MASK_HI13Q_TXBD_DESA << BIT_SHIFT_HI13Q_TXBD_DESA) -+#define BIT_CLEAR_HI13Q_TXBD_DESA(x) ((x) & (~BITS_HI13Q_TXBD_DESA)) -+#define BIT_GET_HI13Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI13Q_TXBD_DESA) & BIT_MASK_HI13Q_TXBD_DESA) -+#define BIT_SET_HI13Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI13Q_TXBD_DESA(x) | BIT_HI13Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH13_TXBD_DESA_L (Offset 0x13A0) */ -+ -+#define BIT_SHIFT_ACH13_TXBD_DESA_L 0 -+#define BIT_MASK_ACH13_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH13_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH13_TXBD_DESA_L) << BIT_SHIFT_ACH13_TXBD_DESA_L) -+#define BITS_ACH13_TXBD_DESA_L \ -+ (BIT_MASK_ACH13_TXBD_DESA_L << BIT_SHIFT_ACH13_TXBD_DESA_L) -+#define BIT_CLEAR_ACH13_TXBD_DESA_L(x) ((x) & (~BITS_ACH13_TXBD_DESA_L)) -+#define BIT_GET_ACH13_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH13_TXBD_DESA_L) & BIT_MASK_ACH13_TXBD_DESA_L) -+#define BIT_SET_ACH13_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH13_TXBD_DESA_L(x) | BIT_ACH13_TXBD_DESA_L(v)) -+ -+/* 2 REG_ACH13_TXBD_DESA_H (Offset 0x13A4) */ -+ -+#define BIT_SHIFT_ACH13_TXBD_DESA_H 0 -+#define BIT_MASK_ACH13_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH13_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH13_TXBD_DESA_H) << BIT_SHIFT_ACH13_TXBD_DESA_H) -+#define BITS_ACH13_TXBD_DESA_H \ -+ (BIT_MASK_ACH13_TXBD_DESA_H << BIT_SHIFT_ACH13_TXBD_DESA_H) -+#define BIT_CLEAR_ACH13_TXBD_DESA_H(x) ((x) & (~BITS_ACH13_TXBD_DESA_H)) -+#define BIT_GET_ACH13_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH13_TXBD_DESA_H) & BIT_MASK_ACH13_TXBD_DESA_H) -+#define BIT_SET_ACH13_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH13_TXBD_DESA_H(x) | BIT_ACH13_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI14Q_TXBD_DESA (Offset 0x13A8) */ -+ -+#define BIT_SHIFT_HI14Q_TXBD_DESA 0 -+#define BIT_MASK_HI14Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI14Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI14Q_TXBD_DESA) << BIT_SHIFT_HI14Q_TXBD_DESA) -+#define BITS_HI14Q_TXBD_DESA \ -+ (BIT_MASK_HI14Q_TXBD_DESA << BIT_SHIFT_HI14Q_TXBD_DESA) -+#define BIT_CLEAR_HI14Q_TXBD_DESA(x) ((x) & (~BITS_HI14Q_TXBD_DESA)) -+#define BIT_GET_HI14Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI14Q_TXBD_DESA) & BIT_MASK_HI14Q_TXBD_DESA) -+#define BIT_SET_HI14Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI14Q_TXBD_DESA(x) | BIT_HI14Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HI0Q_TXBD_DESA_L (Offset 0x13A8) */ -+ -+#define BIT_SHIFT_HI0Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI0Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI0Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI0Q_TXBD_DESA_L) << BIT_SHIFT_HI0Q_TXBD_DESA_L) -+#define BITS_HI0Q_TXBD_DESA_L \ -+ (BIT_MASK_HI0Q_TXBD_DESA_L << BIT_SHIFT_HI0Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI0Q_TXBD_DESA_L(x) ((x) & (~BITS_HI0Q_TXBD_DESA_L)) -+#define BIT_GET_HI0Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_TXBD_DESA_L) & BIT_MASK_HI0Q_TXBD_DESA_L) -+#define BIT_SET_HI0Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI0Q_TXBD_DESA_L(x) | BIT_HI0Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI0Q_TXBD_DESA_H (Offset 0x13AC) */ -+ -+#define BIT_SHIFT_HI0Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI0Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI0Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI0Q_TXBD_DESA_H) << BIT_SHIFT_HI0Q_TXBD_DESA_H) -+#define BITS_HI0Q_TXBD_DESA_H \ -+ (BIT_MASK_HI0Q_TXBD_DESA_H << BIT_SHIFT_HI0Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI0Q_TXBD_DESA_H(x) ((x) & (~BITS_HI0Q_TXBD_DESA_H)) -+#define BIT_GET_HI0Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_TXBD_DESA_H) & BIT_MASK_HI0Q_TXBD_DESA_H) -+#define BIT_SET_HI0Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI0Q_TXBD_DESA_H(x) | BIT_HI0Q_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI15Q_TXBD_DESA (Offset 0x13B0) */ -+ -+#define BIT_SHIFT_HI15Q_TXBD_DESA 0 -+#define BIT_MASK_HI15Q_TXBD_DESA 0xffffffffffffffffL -+#define BIT_HI15Q_TXBD_DESA(x) \ -+ (((x) & BIT_MASK_HI15Q_TXBD_DESA) << BIT_SHIFT_HI15Q_TXBD_DESA) -+#define BITS_HI15Q_TXBD_DESA \ -+ (BIT_MASK_HI15Q_TXBD_DESA << BIT_SHIFT_HI15Q_TXBD_DESA) -+#define BIT_CLEAR_HI15Q_TXBD_DESA(x) ((x) & (~BITS_HI15Q_TXBD_DESA)) -+#define BIT_GET_HI15Q_TXBD_DESA(x) \ -+ (((x) >> BIT_SHIFT_HI15Q_TXBD_DESA) & BIT_MASK_HI15Q_TXBD_DESA) -+#define BIT_SET_HI15Q_TXBD_DESA(x, v) \ -+ (BIT_CLEAR_HI15Q_TXBD_DESA(x) | BIT_HI15Q_TXBD_DESA(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HI1Q_TXBD_DESA_L (Offset 0x13B0) */ -+ -+#define BIT_SHIFT_HI1Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI1Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI1Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI1Q_TXBD_DESA_L) << BIT_SHIFT_HI1Q_TXBD_DESA_L) -+#define BITS_HI1Q_TXBD_DESA_L \ -+ (BIT_MASK_HI1Q_TXBD_DESA_L << BIT_SHIFT_HI1Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI1Q_TXBD_DESA_L(x) ((x) & (~BITS_HI1Q_TXBD_DESA_L)) -+#define BIT_GET_HI1Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_TXBD_DESA_L) & BIT_MASK_HI1Q_TXBD_DESA_L) -+#define BIT_SET_HI1Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI1Q_TXBD_DESA_L(x) | BIT_HI1Q_TXBD_DESA_L(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_HISR0_V1 (Offset 0x13B4) */ -+ -+#define BIT_PRE_TX_ERR_INT BIT(31) -+#define BIT_HISR1_IND BIT(11) -+#define BIT_TXDMAOK_CHANNEL15 BIT(7) -+#define BIT_TXDMAOK_CHANNEL14 BIT(6) -+#define BIT_TXDMAOK_CHANNEL3 BIT(5) -+#define BIT_TXDMAOK_CHANNEL2 BIT(4) -+#define BIT_TXDMAOK_CHANNEL1 BIT(3) -+#define BIT_TXDMAOK_CHANNEL0 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HI1Q_TXBD_DESA_H (Offset 0x13B4) */ -+ -+#define BIT_SHIFT_HI1Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI1Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI1Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI1Q_TXBD_DESA_H) << BIT_SHIFT_HI1Q_TXBD_DESA_H) -+#define BITS_HI1Q_TXBD_DESA_H \ -+ (BIT_MASK_HI1Q_TXBD_DESA_H << BIT_SHIFT_HI1Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI1Q_TXBD_DESA_H(x) ((x) & (~BITS_HI1Q_TXBD_DESA_H)) -+#define BIT_GET_HI1Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_TXBD_DESA_H) & BIT_MASK_HI1Q_TXBD_DESA_H) -+#define BIT_SET_HI1Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI1Q_TXBD_DESA_H(x) | BIT_HI1Q_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI8Q_TXBD_NUM (Offset 0x13B8) */ -+ -+#define BIT_HI8Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI8Q_DESC_MODE 12 -+#define BIT_MASK_HI8Q_DESC_MODE 0x3 -+#define BIT_HI8Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI8Q_DESC_MODE) << BIT_SHIFT_HI8Q_DESC_MODE) -+#define BITS_HI8Q_DESC_MODE \ -+ (BIT_MASK_HI8Q_DESC_MODE << BIT_SHIFT_HI8Q_DESC_MODE) -+#define BIT_CLEAR_HI8Q_DESC_MODE(x) ((x) & (~BITS_HI8Q_DESC_MODE)) -+#define BIT_GET_HI8Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI8Q_DESC_MODE) & BIT_MASK_HI8Q_DESC_MODE) -+#define BIT_SET_HI8Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI8Q_DESC_MODE(x) | BIT_HI8Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI8Q_DESC_NUM 0 -+#define BIT_MASK_HI8Q_DESC_NUM 0xfff -+#define BIT_HI8Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI8Q_DESC_NUM) << BIT_SHIFT_HI8Q_DESC_NUM) -+#define BITS_HI8Q_DESC_NUM (BIT_MASK_HI8Q_DESC_NUM << BIT_SHIFT_HI8Q_DESC_NUM) -+#define BIT_CLEAR_HI8Q_DESC_NUM(x) ((x) & (~BITS_HI8Q_DESC_NUM)) -+#define BIT_GET_HI8Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI8Q_DESC_NUM) & BIT_MASK_HI8Q_DESC_NUM) -+#define BIT_SET_HI8Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI8Q_DESC_NUM(x) | BIT_HI8Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HI2Q_TXBD_DESA_L (Offset 0x13B8) */ -+ -+#define BIT_SHIFT_HI2Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI2Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI2Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI2Q_TXBD_DESA_L) << BIT_SHIFT_HI2Q_TXBD_DESA_L) -+#define BITS_HI2Q_TXBD_DESA_L \ -+ (BIT_MASK_HI2Q_TXBD_DESA_L << BIT_SHIFT_HI2Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI2Q_TXBD_DESA_L(x) ((x) & (~BITS_HI2Q_TXBD_DESA_L)) -+#define BIT_GET_HI2Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_TXBD_DESA_L) & BIT_MASK_HI2Q_TXBD_DESA_L) -+#define BIT_SET_HI2Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI2Q_TXBD_DESA_L(x) | BIT_HI2Q_TXBD_DESA_L(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI9Q_TXBD_NUM (Offset 0x13BA) */ -+ -+#define BIT_HI9Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI9Q_DESC_MODE 12 -+#define BIT_MASK_HI9Q_DESC_MODE 0x3 -+#define BIT_HI9Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI9Q_DESC_MODE) << BIT_SHIFT_HI9Q_DESC_MODE) -+#define BITS_HI9Q_DESC_MODE \ -+ (BIT_MASK_HI9Q_DESC_MODE << BIT_SHIFT_HI9Q_DESC_MODE) -+#define BIT_CLEAR_HI9Q_DESC_MODE(x) ((x) & (~BITS_HI9Q_DESC_MODE)) -+#define BIT_GET_HI9Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI9Q_DESC_MODE) & BIT_MASK_HI9Q_DESC_MODE) -+#define BIT_SET_HI9Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI9Q_DESC_MODE(x) | BIT_HI9Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI9Q_DESC_NUM 0 -+#define BIT_MASK_HI9Q_DESC_NUM 0xfff -+#define BIT_HI9Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI9Q_DESC_NUM) << BIT_SHIFT_HI9Q_DESC_NUM) -+#define BITS_HI9Q_DESC_NUM (BIT_MASK_HI9Q_DESC_NUM << BIT_SHIFT_HI9Q_DESC_NUM) -+#define BIT_CLEAR_HI9Q_DESC_NUM(x) ((x) & (~BITS_HI9Q_DESC_NUM)) -+#define BIT_GET_HI9Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI9Q_DESC_NUM) & BIT_MASK_HI9Q_DESC_NUM) -+#define BIT_SET_HI9Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI9Q_DESC_NUM(x) | BIT_HI9Q_DESC_NUM(v)) -+ -+/* 2 REG_HI10Q_TXBD_NUM (Offset 0x13BC) */ -+ -+#define BIT_HI10Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI10Q_DESC_MODE 12 -+#define BIT_MASK_HI10Q_DESC_MODE 0x3 -+#define BIT_HI10Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI10Q_DESC_MODE) << BIT_SHIFT_HI10Q_DESC_MODE) -+#define BITS_HI10Q_DESC_MODE \ -+ (BIT_MASK_HI10Q_DESC_MODE << BIT_SHIFT_HI10Q_DESC_MODE) -+#define BIT_CLEAR_HI10Q_DESC_MODE(x) ((x) & (~BITS_HI10Q_DESC_MODE)) -+#define BIT_GET_HI10Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI10Q_DESC_MODE) & BIT_MASK_HI10Q_DESC_MODE) -+#define BIT_SET_HI10Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI10Q_DESC_MODE(x) | BIT_HI10Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI10Q_DESC_NUM 0 -+#define BIT_MASK_HI10Q_DESC_NUM 0xfff -+#define BIT_HI10Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI10Q_DESC_NUM) << BIT_SHIFT_HI10Q_DESC_NUM) -+#define BITS_HI10Q_DESC_NUM \ -+ (BIT_MASK_HI10Q_DESC_NUM << BIT_SHIFT_HI10Q_DESC_NUM) -+#define BIT_CLEAR_HI10Q_DESC_NUM(x) ((x) & (~BITS_HI10Q_DESC_NUM)) -+#define BIT_GET_HI10Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI10Q_DESC_NUM) & BIT_MASK_HI10Q_DESC_NUM) -+#define BIT_SET_HI10Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI10Q_DESC_NUM(x) | BIT_HI10Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HI2Q_TXBD_DESA_H (Offset 0x13BC) */ -+ -+#define BIT_SHIFT_HI2Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI2Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI2Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI2Q_TXBD_DESA_H) << BIT_SHIFT_HI2Q_TXBD_DESA_H) -+#define BITS_HI2Q_TXBD_DESA_H \ -+ (BIT_MASK_HI2Q_TXBD_DESA_H << BIT_SHIFT_HI2Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI2Q_TXBD_DESA_H(x) ((x) & (~BITS_HI2Q_TXBD_DESA_H)) -+#define BIT_GET_HI2Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_TXBD_DESA_H) & BIT_MASK_HI2Q_TXBD_DESA_H) -+#define BIT_SET_HI2Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI2Q_TXBD_DESA_H(x) | BIT_HI2Q_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI11Q_TXBD_NUM (Offset 0x13BE) */ -+ -+#define BIT_HI11Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI11Q_DESC_MODE 12 -+#define BIT_MASK_HI11Q_DESC_MODE 0x3 -+#define BIT_HI11Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI11Q_DESC_MODE) << BIT_SHIFT_HI11Q_DESC_MODE) -+#define BITS_HI11Q_DESC_MODE \ -+ (BIT_MASK_HI11Q_DESC_MODE << BIT_SHIFT_HI11Q_DESC_MODE) -+#define BIT_CLEAR_HI11Q_DESC_MODE(x) ((x) & (~BITS_HI11Q_DESC_MODE)) -+#define BIT_GET_HI11Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI11Q_DESC_MODE) & BIT_MASK_HI11Q_DESC_MODE) -+#define BIT_SET_HI11Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI11Q_DESC_MODE(x) | BIT_HI11Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI11Q_DESC_NUM 0 -+#define BIT_MASK_HI11Q_DESC_NUM 0xfff -+#define BIT_HI11Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI11Q_DESC_NUM) << BIT_SHIFT_HI11Q_DESC_NUM) -+#define BITS_HI11Q_DESC_NUM \ -+ (BIT_MASK_HI11Q_DESC_NUM << BIT_SHIFT_HI11Q_DESC_NUM) -+#define BIT_CLEAR_HI11Q_DESC_NUM(x) ((x) & (~BITS_HI11Q_DESC_NUM)) -+#define BIT_GET_HI11Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI11Q_DESC_NUM) & BIT_MASK_HI11Q_DESC_NUM) -+#define BIT_SET_HI11Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI11Q_DESC_NUM(x) | BIT_HI11Q_DESC_NUM(v)) -+ -+/* 2 REG_HI12Q_TXBD_NUM (Offset 0x13C0) */ -+ -+#define BIT_HI12Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI12Q_DESC_MODE 12 -+#define BIT_MASK_HI12Q_DESC_MODE 0x3 -+#define BIT_HI12Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI12Q_DESC_MODE) << BIT_SHIFT_HI12Q_DESC_MODE) -+#define BITS_HI12Q_DESC_MODE \ -+ (BIT_MASK_HI12Q_DESC_MODE << BIT_SHIFT_HI12Q_DESC_MODE) -+#define BIT_CLEAR_HI12Q_DESC_MODE(x) ((x) & (~BITS_HI12Q_DESC_MODE)) -+#define BIT_GET_HI12Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI12Q_DESC_MODE) & BIT_MASK_HI12Q_DESC_MODE) -+#define BIT_SET_HI12Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI12Q_DESC_MODE(x) | BIT_HI12Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI12Q_DESC_NUM 0 -+#define BIT_MASK_HI12Q_DESC_NUM 0xfff -+#define BIT_HI12Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI12Q_DESC_NUM) << BIT_SHIFT_HI12Q_DESC_NUM) -+#define BITS_HI12Q_DESC_NUM \ -+ (BIT_MASK_HI12Q_DESC_NUM << BIT_SHIFT_HI12Q_DESC_NUM) -+#define BIT_CLEAR_HI12Q_DESC_NUM(x) ((x) & (~BITS_HI12Q_DESC_NUM)) -+#define BIT_GET_HI12Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI12Q_DESC_NUM) & BIT_MASK_HI12Q_DESC_NUM) -+#define BIT_SET_HI12Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI12Q_DESC_NUM(x) | BIT_HI12Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HI3Q_TXBD_DESA_L (Offset 0x13C0) */ -+ -+#define BIT_SHIFT_HI3Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI3Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI3Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI3Q_TXBD_DESA_L) << BIT_SHIFT_HI3Q_TXBD_DESA_L) -+#define BITS_HI3Q_TXBD_DESA_L \ -+ (BIT_MASK_HI3Q_TXBD_DESA_L << BIT_SHIFT_HI3Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI3Q_TXBD_DESA_L(x) ((x) & (~BITS_HI3Q_TXBD_DESA_L)) -+#define BIT_GET_HI3Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_TXBD_DESA_L) & BIT_MASK_HI3Q_TXBD_DESA_L) -+#define BIT_SET_HI3Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI3Q_TXBD_DESA_L(x) | BIT_HI3Q_TXBD_DESA_L(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI13Q_TXBD_NUM (Offset 0x13C2) */ -+ -+#define BIT_HI13Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI13Q_DESC_MODE 12 -+#define BIT_MASK_HI13Q_DESC_MODE 0x3 -+#define BIT_HI13Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI13Q_DESC_MODE) << BIT_SHIFT_HI13Q_DESC_MODE) -+#define BITS_HI13Q_DESC_MODE \ -+ (BIT_MASK_HI13Q_DESC_MODE << BIT_SHIFT_HI13Q_DESC_MODE) -+#define BIT_CLEAR_HI13Q_DESC_MODE(x) ((x) & (~BITS_HI13Q_DESC_MODE)) -+#define BIT_GET_HI13Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI13Q_DESC_MODE) & BIT_MASK_HI13Q_DESC_MODE) -+#define BIT_SET_HI13Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI13Q_DESC_MODE(x) | BIT_HI13Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI13Q_DESC_NUM 0 -+#define BIT_MASK_HI13Q_DESC_NUM 0xfff -+#define BIT_HI13Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI13Q_DESC_NUM) << BIT_SHIFT_HI13Q_DESC_NUM) -+#define BITS_HI13Q_DESC_NUM \ -+ (BIT_MASK_HI13Q_DESC_NUM << BIT_SHIFT_HI13Q_DESC_NUM) -+#define BIT_CLEAR_HI13Q_DESC_NUM(x) ((x) & (~BITS_HI13Q_DESC_NUM)) -+#define BIT_GET_HI13Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI13Q_DESC_NUM) & BIT_MASK_HI13Q_DESC_NUM) -+#define BIT_SET_HI13Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI13Q_DESC_NUM(x) | BIT_HI13Q_DESC_NUM(v)) -+ -+/* 2 REG_HI14Q_TXBD_NUM (Offset 0x13C4) */ -+ -+#define BIT_HI14Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI14Q_DESC_MODE 12 -+#define BIT_MASK_HI14Q_DESC_MODE 0x3 -+#define BIT_HI14Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI14Q_DESC_MODE) << BIT_SHIFT_HI14Q_DESC_MODE) -+#define BITS_HI14Q_DESC_MODE \ -+ (BIT_MASK_HI14Q_DESC_MODE << BIT_SHIFT_HI14Q_DESC_MODE) -+#define BIT_CLEAR_HI14Q_DESC_MODE(x) ((x) & (~BITS_HI14Q_DESC_MODE)) -+#define BIT_GET_HI14Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI14Q_DESC_MODE) & BIT_MASK_HI14Q_DESC_MODE) -+#define BIT_SET_HI14Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI14Q_DESC_MODE(x) | BIT_HI14Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI14Q_DESC_NUM 0 -+#define BIT_MASK_HI14Q_DESC_NUM 0xfff -+#define BIT_HI14Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI14Q_DESC_NUM) << BIT_SHIFT_HI14Q_DESC_NUM) -+#define BITS_HI14Q_DESC_NUM \ -+ (BIT_MASK_HI14Q_DESC_NUM << BIT_SHIFT_HI14Q_DESC_NUM) -+#define BIT_CLEAR_HI14Q_DESC_NUM(x) ((x) & (~BITS_HI14Q_DESC_NUM)) -+#define BIT_GET_HI14Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI14Q_DESC_NUM) & BIT_MASK_HI14Q_DESC_NUM) -+#define BIT_SET_HI14Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI14Q_DESC_NUM(x) | BIT_HI14Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HI3Q_TXBD_DESA_H (Offset 0x13C4) */ -+ -+#define BIT_SHIFT_HI3Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI3Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI3Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI3Q_TXBD_DESA_H) << BIT_SHIFT_HI3Q_TXBD_DESA_H) -+#define BITS_HI3Q_TXBD_DESA_H \ -+ (BIT_MASK_HI3Q_TXBD_DESA_H << BIT_SHIFT_HI3Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI3Q_TXBD_DESA_H(x) ((x) & (~BITS_HI3Q_TXBD_DESA_H)) -+#define BIT_GET_HI3Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_TXBD_DESA_H) & BIT_MASK_HI3Q_TXBD_DESA_H) -+#define BIT_SET_HI3Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI3Q_TXBD_DESA_H(x) | BIT_HI3Q_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_HI15Q_TXBD_NUM (Offset 0x13C6) */ -+ -+#define BIT_HI15Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_HI15Q_DESC_MODE 12 -+#define BIT_MASK_HI15Q_DESC_MODE 0x3 -+#define BIT_HI15Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_HI15Q_DESC_MODE) << BIT_SHIFT_HI15Q_DESC_MODE) -+#define BITS_HI15Q_DESC_MODE \ -+ (BIT_MASK_HI15Q_DESC_MODE << BIT_SHIFT_HI15Q_DESC_MODE) -+#define BIT_CLEAR_HI15Q_DESC_MODE(x) ((x) & (~BITS_HI15Q_DESC_MODE)) -+#define BIT_GET_HI15Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_HI15Q_DESC_MODE) & BIT_MASK_HI15Q_DESC_MODE) -+#define BIT_SET_HI15Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_HI15Q_DESC_MODE(x) | BIT_HI15Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_HI15Q_DESC_NUM 0 -+#define BIT_MASK_HI15Q_DESC_NUM 0xfff -+#define BIT_HI15Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_HI15Q_DESC_NUM) << BIT_SHIFT_HI15Q_DESC_NUM) -+#define BITS_HI15Q_DESC_NUM \ -+ (BIT_MASK_HI15Q_DESC_NUM << BIT_SHIFT_HI15Q_DESC_NUM) -+#define BIT_CLEAR_HI15Q_DESC_NUM(x) ((x) & (~BITS_HI15Q_DESC_NUM)) -+#define BIT_GET_HI15Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_HI15Q_DESC_NUM) & BIT_MASK_HI15Q_DESC_NUM) -+#define BIT_SET_HI15Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_HI15Q_DESC_NUM(x) | BIT_HI15Q_DESC_NUM(v)) -+ -+/* 2 REG_HIQ_DMA_STOP (Offset 0x13C8) */ -+ -+#define BIT_STOP_HI15Q BIT(7) -+#define BIT_STOP_HI14Q BIT(6) -+#define BIT_STOP_HI13Q BIT(5) -+#define BIT_STOP_HI12Q BIT(4) -+#define BIT_STOP_HI11Q BIT(3) -+#define BIT_STOP_HI10Q BIT(2) -+#define BIT_STOP_HI9Q BIT(1) -+#define BIT_STOP_HI8Q BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HI4Q_TXBD_DESA_L (Offset 0x13C8) */ -+ -+#define BIT_SHIFT_HI4Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI4Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI4Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI4Q_TXBD_DESA_L) << BIT_SHIFT_HI4Q_TXBD_DESA_L) -+#define BITS_HI4Q_TXBD_DESA_L \ -+ (BIT_MASK_HI4Q_TXBD_DESA_L << BIT_SHIFT_HI4Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI4Q_TXBD_DESA_L(x) ((x) & (~BITS_HI4Q_TXBD_DESA_L)) -+#define BIT_GET_HI4Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_TXBD_DESA_L) & BIT_MASK_HI4Q_TXBD_DESA_L) -+#define BIT_SET_HI4Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI4Q_TXBD_DESA_L(x) | BIT_HI4Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI4Q_TXBD_DESA_H (Offset 0x13CC) */ -+ -+#define BIT_SHIFT_HI4Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI4Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI4Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI4Q_TXBD_DESA_H) << BIT_SHIFT_HI4Q_TXBD_DESA_H) -+#define BITS_HI4Q_TXBD_DESA_H \ -+ (BIT_MASK_HI4Q_TXBD_DESA_H << BIT_SHIFT_HI4Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI4Q_TXBD_DESA_H(x) ((x) & (~BITS_HI4Q_TXBD_DESA_H)) -+#define BIT_GET_HI4Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_TXBD_DESA_H) & BIT_MASK_HI4Q_TXBD_DESA_H) -+#define BIT_SET_HI4Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI4Q_TXBD_DESA_H(x) | BIT_HI4Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI5Q_TXBD_DESA_L (Offset 0x13D0) */ -+ -+#define BIT_SHIFT_HI5Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI5Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI5Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI5Q_TXBD_DESA_L) << BIT_SHIFT_HI5Q_TXBD_DESA_L) -+#define BITS_HI5Q_TXBD_DESA_L \ -+ (BIT_MASK_HI5Q_TXBD_DESA_L << BIT_SHIFT_HI5Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI5Q_TXBD_DESA_L(x) ((x) & (~BITS_HI5Q_TXBD_DESA_L)) -+#define BIT_GET_HI5Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_TXBD_DESA_L) & BIT_MASK_HI5Q_TXBD_DESA_L) -+#define BIT_SET_HI5Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI5Q_TXBD_DESA_L(x) | BIT_HI5Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI5Q_TXBD_DESA_H (Offset 0x13D4) */ -+ -+#define BIT_SHIFT_HI5Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI5Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI5Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI5Q_TXBD_DESA_H) << BIT_SHIFT_HI5Q_TXBD_DESA_H) -+#define BITS_HI5Q_TXBD_DESA_H \ -+ (BIT_MASK_HI5Q_TXBD_DESA_H << BIT_SHIFT_HI5Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI5Q_TXBD_DESA_H(x) ((x) & (~BITS_HI5Q_TXBD_DESA_H)) -+#define BIT_GET_HI5Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_TXBD_DESA_H) & BIT_MASK_HI5Q_TXBD_DESA_H) -+#define BIT_SET_HI5Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI5Q_TXBD_DESA_H(x) | BIT_HI5Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI6Q_TXBD_DESA_L (Offset 0x13D8) */ -+ -+#define BIT_SHIFT_HI6Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI6Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI6Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI6Q_TXBD_DESA_L) << BIT_SHIFT_HI6Q_TXBD_DESA_L) -+#define BITS_HI6Q_TXBD_DESA_L \ -+ (BIT_MASK_HI6Q_TXBD_DESA_L << BIT_SHIFT_HI6Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI6Q_TXBD_DESA_L(x) ((x) & (~BITS_HI6Q_TXBD_DESA_L)) -+#define BIT_GET_HI6Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_TXBD_DESA_L) & BIT_MASK_HI6Q_TXBD_DESA_L) -+#define BIT_SET_HI6Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI6Q_TXBD_DESA_L(x) | BIT_HI6Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI6Q_TXBD_DESA_H (Offset 0x13DC) */ -+ -+#define BIT_SHIFT_HI6Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI6Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI6Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI6Q_TXBD_DESA_H) << BIT_SHIFT_HI6Q_TXBD_DESA_H) -+#define BITS_HI6Q_TXBD_DESA_H \ -+ (BIT_MASK_HI6Q_TXBD_DESA_H << BIT_SHIFT_HI6Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI6Q_TXBD_DESA_H(x) ((x) & (~BITS_HI6Q_TXBD_DESA_H)) -+#define BIT_GET_HI6Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_TXBD_DESA_H) & BIT_MASK_HI6Q_TXBD_DESA_H) -+#define BIT_SET_HI6Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI6Q_TXBD_DESA_H(x) | BIT_HI6Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI7Q_TXBD_DESA_L (Offset 0x13E0) */ -+ -+#define BIT_SHIFT_HI7Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI7Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI7Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI7Q_TXBD_DESA_L) << BIT_SHIFT_HI7Q_TXBD_DESA_L) -+#define BITS_HI7Q_TXBD_DESA_L \ -+ (BIT_MASK_HI7Q_TXBD_DESA_L << BIT_SHIFT_HI7Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI7Q_TXBD_DESA_L(x) ((x) & (~BITS_HI7Q_TXBD_DESA_L)) -+#define BIT_GET_HI7Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_TXBD_DESA_L) & BIT_MASK_HI7Q_TXBD_DESA_L) -+#define BIT_SET_HI7Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI7Q_TXBD_DESA_L(x) | BIT_HI7Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI7Q_TXBD_DESA_H (Offset 0x13E4) */ -+ -+#define BIT_SHIFT_HI7Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI7Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI7Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI7Q_TXBD_DESA_H) << BIT_SHIFT_HI7Q_TXBD_DESA_H) -+#define BITS_HI7Q_TXBD_DESA_H \ -+ (BIT_MASK_HI7Q_TXBD_DESA_H << BIT_SHIFT_HI7Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI7Q_TXBD_DESA_H(x) ((x) & (~BITS_HI7Q_TXBD_DESA_H)) -+#define BIT_GET_HI7Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_TXBD_DESA_H) & BIT_MASK_HI7Q_TXBD_DESA_H) -+#define BIT_SET_HI7Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI7Q_TXBD_DESA_H(x) | BIT_HI7Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_ACH8_ACH9_TXBD_NUM (Offset 0x13E8) */ -+ -+#define BIT_PCIE_ACH9_FLAG BIT(30) -+ -+#define BIT_SHIFT_ACH9_DESC_MODE 28 -+#define BIT_MASK_ACH9_DESC_MODE 0x3 -+#define BIT_ACH9_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH9_DESC_MODE) << BIT_SHIFT_ACH9_DESC_MODE) -+#define BITS_ACH9_DESC_MODE \ -+ (BIT_MASK_ACH9_DESC_MODE << BIT_SHIFT_ACH9_DESC_MODE) -+#define BIT_CLEAR_ACH9_DESC_MODE(x) ((x) & (~BITS_ACH9_DESC_MODE)) -+#define BIT_GET_ACH9_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH9_DESC_MODE) & BIT_MASK_ACH9_DESC_MODE) -+#define BIT_SET_ACH9_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH9_DESC_MODE(x) | BIT_ACH9_DESC_MODE(v)) -+ -+#define BIT_SHIFT_ACH9_DESC_NUM 16 -+#define BIT_MASK_ACH9_DESC_NUM 0xfff -+#define BIT_ACH9_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH9_DESC_NUM) << BIT_SHIFT_ACH9_DESC_NUM) -+#define BITS_ACH9_DESC_NUM (BIT_MASK_ACH9_DESC_NUM << BIT_SHIFT_ACH9_DESC_NUM) -+#define BIT_CLEAR_ACH9_DESC_NUM(x) ((x) & (~BITS_ACH9_DESC_NUM)) -+#define BIT_GET_ACH9_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH9_DESC_NUM) & BIT_MASK_ACH9_DESC_NUM) -+#define BIT_SET_ACH9_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH9_DESC_NUM(x) | BIT_ACH9_DESC_NUM(v)) -+ -+#define BIT_PCIE_ACH8_FLAG BIT(14) -+ -+#define BIT_SHIFT_ACH8_DESC_MODE 12 -+#define BIT_MASK_ACH8_DESC_MODE 0x3 -+#define BIT_ACH8_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH8_DESC_MODE) << BIT_SHIFT_ACH8_DESC_MODE) -+#define BITS_ACH8_DESC_MODE \ -+ (BIT_MASK_ACH8_DESC_MODE << BIT_SHIFT_ACH8_DESC_MODE) -+#define BIT_CLEAR_ACH8_DESC_MODE(x) ((x) & (~BITS_ACH8_DESC_MODE)) -+#define BIT_GET_ACH8_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH8_DESC_MODE) & BIT_MASK_ACH8_DESC_MODE) -+#define BIT_SET_ACH8_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH8_DESC_MODE(x) | BIT_ACH8_DESC_MODE(v)) -+ -+#define BIT_SHIFT_ACH8_DESC_NUM 0 -+#define BIT_MASK_ACH8_DESC_NUM 0xfff -+#define BIT_ACH8_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH8_DESC_NUM) << BIT_SHIFT_ACH8_DESC_NUM) -+#define BITS_ACH8_DESC_NUM (BIT_MASK_ACH8_DESC_NUM << BIT_SHIFT_ACH8_DESC_NUM) -+#define BIT_CLEAR_ACH8_DESC_NUM(x) ((x) & (~BITS_ACH8_DESC_NUM)) -+#define BIT_GET_ACH8_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH8_DESC_NUM) & BIT_MASK_ACH8_DESC_NUM) -+#define BIT_SET_ACH8_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH8_DESC_NUM(x) | BIT_ACH8_DESC_NUM(v)) -+ -+/* 2 REG_ACH10_ACH11_TXBD_NUM (Offset 0x13EC) */ -+ -+#define BIT_PCIE_ACH11_FLAG BIT(30) -+ -+#define BIT_SHIFT_ACH11_DESC_MODE 28 -+#define BIT_MASK_ACH11_DESC_MODE 0x3 -+#define BIT_ACH11_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH11_DESC_MODE) << BIT_SHIFT_ACH11_DESC_MODE) -+#define BITS_ACH11_DESC_MODE \ -+ (BIT_MASK_ACH11_DESC_MODE << BIT_SHIFT_ACH11_DESC_MODE) -+#define BIT_CLEAR_ACH11_DESC_MODE(x) ((x) & (~BITS_ACH11_DESC_MODE)) -+#define BIT_GET_ACH11_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH11_DESC_MODE) & BIT_MASK_ACH11_DESC_MODE) -+#define BIT_SET_ACH11_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH11_DESC_MODE(x) | BIT_ACH11_DESC_MODE(v)) -+ -+#define BIT_SHIFT_ACH11_DESC_NUM 16 -+#define BIT_MASK_ACH11_DESC_NUM 0xfff -+#define BIT_ACH11_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH11_DESC_NUM) << BIT_SHIFT_ACH11_DESC_NUM) -+#define BITS_ACH11_DESC_NUM \ -+ (BIT_MASK_ACH11_DESC_NUM << BIT_SHIFT_ACH11_DESC_NUM) -+#define BIT_CLEAR_ACH11_DESC_NUM(x) ((x) & (~BITS_ACH11_DESC_NUM)) -+#define BIT_GET_ACH11_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH11_DESC_NUM) & BIT_MASK_ACH11_DESC_NUM) -+#define BIT_SET_ACH11_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH11_DESC_NUM(x) | BIT_ACH11_DESC_NUM(v)) -+ -+#define BIT_PCIE_ACH10_FLAG BIT(14) -+ -+#define BIT_SHIFT_ACH10_DESC_MODE 12 -+#define BIT_MASK_ACH10_DESC_MODE 0x3 -+#define BIT_ACH10_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH10_DESC_MODE) << BIT_SHIFT_ACH10_DESC_MODE) -+#define BITS_ACH10_DESC_MODE \ -+ (BIT_MASK_ACH10_DESC_MODE << BIT_SHIFT_ACH10_DESC_MODE) -+#define BIT_CLEAR_ACH10_DESC_MODE(x) ((x) & (~BITS_ACH10_DESC_MODE)) -+#define BIT_GET_ACH10_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH10_DESC_MODE) & BIT_MASK_ACH10_DESC_MODE) -+#define BIT_SET_ACH10_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH10_DESC_MODE(x) | BIT_ACH10_DESC_MODE(v)) -+ -+#define BIT_SHIFT_ACH10_DESC_NUM 0 -+#define BIT_MASK_ACH10_DESC_NUM 0xfff -+#define BIT_ACH10_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH10_DESC_NUM) << BIT_SHIFT_ACH10_DESC_NUM) -+#define BITS_ACH10_DESC_NUM \ -+ (BIT_MASK_ACH10_DESC_NUM << BIT_SHIFT_ACH10_DESC_NUM) -+#define BIT_CLEAR_ACH10_DESC_NUM(x) ((x) & (~BITS_ACH10_DESC_NUM)) -+#define BIT_GET_ACH10_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH10_DESC_NUM) & BIT_MASK_ACH10_DESC_NUM) -+#define BIT_SET_ACH10_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH10_DESC_NUM(x) | BIT_ACH10_DESC_NUM(v)) -+ -+/* 2 REG_ACH12_ACH13_TXBD_NUM (Offset 0x13F0) */ -+ -+#define BIT_PCIE_ACH13_FLAG BIT(30) -+ -+#define BIT_SHIFT_ACH13_DESC_MODE 28 -+#define BIT_MASK_ACH13_DESC_MODE 0x3 -+#define BIT_ACH13_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH13_DESC_MODE) << BIT_SHIFT_ACH13_DESC_MODE) -+#define BITS_ACH13_DESC_MODE \ -+ (BIT_MASK_ACH13_DESC_MODE << BIT_SHIFT_ACH13_DESC_MODE) -+#define BIT_CLEAR_ACH13_DESC_MODE(x) ((x) & (~BITS_ACH13_DESC_MODE)) -+#define BIT_GET_ACH13_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH13_DESC_MODE) & BIT_MASK_ACH13_DESC_MODE) -+#define BIT_SET_ACH13_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH13_DESC_MODE(x) | BIT_ACH13_DESC_MODE(v)) -+ -+#define BIT_SHIFT_ACH13_DESC_NUM 16 -+#define BIT_MASK_ACH13_DESC_NUM 0xfff -+#define BIT_ACH13_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH13_DESC_NUM) << BIT_SHIFT_ACH13_DESC_NUM) -+#define BITS_ACH13_DESC_NUM \ -+ (BIT_MASK_ACH13_DESC_NUM << BIT_SHIFT_ACH13_DESC_NUM) -+#define BIT_CLEAR_ACH13_DESC_NUM(x) ((x) & (~BITS_ACH13_DESC_NUM)) -+#define BIT_GET_ACH13_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH13_DESC_NUM) & BIT_MASK_ACH13_DESC_NUM) -+#define BIT_SET_ACH13_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH13_DESC_NUM(x) | BIT_ACH13_DESC_NUM(v)) -+ -+#define BIT_PCIE_ACH12_FLAG BIT(14) -+ -+#define BIT_SHIFT_ACH12_DESC_MODE 12 -+#define BIT_MASK_ACH12_DESC_MODE 0x3 -+#define BIT_ACH12_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH12_DESC_MODE) << BIT_SHIFT_ACH12_DESC_MODE) -+#define BITS_ACH12_DESC_MODE \ -+ (BIT_MASK_ACH12_DESC_MODE << BIT_SHIFT_ACH12_DESC_MODE) -+#define BIT_CLEAR_ACH12_DESC_MODE(x) ((x) & (~BITS_ACH12_DESC_MODE)) -+#define BIT_GET_ACH12_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH12_DESC_MODE) & BIT_MASK_ACH12_DESC_MODE) -+#define BIT_SET_ACH12_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH12_DESC_MODE(x) | BIT_ACH12_DESC_MODE(v)) -+ -+#define BIT_SHIFT_ACH12_DESC_NUM 0 -+#define BIT_MASK_ACH12_DESC_NUM 0xfff -+#define BIT_ACH12_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH12_DESC_NUM) << BIT_SHIFT_ACH12_DESC_NUM) -+#define BITS_ACH12_DESC_NUM \ -+ (BIT_MASK_ACH12_DESC_NUM << BIT_SHIFT_ACH12_DESC_NUM) -+#define BIT_CLEAR_ACH12_DESC_NUM(x) ((x) & (~BITS_ACH12_DESC_NUM)) -+#define BIT_GET_ACH12_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH12_DESC_NUM) & BIT_MASK_ACH12_DESC_NUM) -+#define BIT_SET_ACH12_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH12_DESC_NUM(x) | BIT_ACH12_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_OLD_DEHANG (Offset 0x13F4) */ -+ -+#define BIT_OLD_DEHANG BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_ACH4_TXBD_DESA_L (Offset 0x13F8) */ -+ -+#define BIT_SHIFT_ACH4_TXBD_DESA_L 0 -+#define BIT_MASK_ACH4_TXBD_DESA_L 0xffffffffL -+#define BIT_ACH4_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_ACH4_TXBD_DESA_L) << BIT_SHIFT_ACH4_TXBD_DESA_L) -+#define BITS_ACH4_TXBD_DESA_L \ -+ (BIT_MASK_ACH4_TXBD_DESA_L << BIT_SHIFT_ACH4_TXBD_DESA_L) -+#define BIT_CLEAR_ACH4_TXBD_DESA_L(x) ((x) & (~BITS_ACH4_TXBD_DESA_L)) -+#define BIT_GET_ACH4_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_ACH4_TXBD_DESA_L) & BIT_MASK_ACH4_TXBD_DESA_L) -+#define BIT_SET_ACH4_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_ACH4_TXBD_DESA_L(x) | BIT_ACH4_TXBD_DESA_L(v)) -+ -+/* 2 REG_ACH4_TXBD_DESA_H (Offset 0x13FC) */ -+ -+#define BIT_SHIFT_ACH4_TXBD_DESA_H 0 -+#define BIT_MASK_ACH4_TXBD_DESA_H 0xffffffffL -+#define BIT_ACH4_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_ACH4_TXBD_DESA_H) << BIT_SHIFT_ACH4_TXBD_DESA_H) -+#define BITS_ACH4_TXBD_DESA_H \ -+ (BIT_MASK_ACH4_TXBD_DESA_H << BIT_SHIFT_ACH4_TXBD_DESA_H) -+#define BIT_CLEAR_ACH4_TXBD_DESA_H(x) ((x) & (~BITS_ACH4_TXBD_DESA_H)) -+#define BIT_GET_ACH4_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_ACH4_TXBD_DESA_H) & BIT_MASK_ACH4_TXBD_DESA_H) -+#define BIT_SET_ACH4_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_ACH4_TXBD_DESA_H(x) | BIT_ACH4_TXBD_DESA_H(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q0_Q1_INFO (Offset 0x1400) */ -+ -+#define BIT_SHIFT_AC1_PKT_INFO 16 -+#define BIT_MASK_AC1_PKT_INFO 0xfff -+#define BIT_AC1_PKT_INFO(x) \ -+ (((x) & BIT_MASK_AC1_PKT_INFO) << BIT_SHIFT_AC1_PKT_INFO) -+#define BITS_AC1_PKT_INFO (BIT_MASK_AC1_PKT_INFO << BIT_SHIFT_AC1_PKT_INFO) -+#define BIT_CLEAR_AC1_PKT_INFO(x) ((x) & (~BITS_AC1_PKT_INFO)) -+#define BIT_GET_AC1_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_AC1_PKT_INFO) & BIT_MASK_AC1_PKT_INFO) -+#define BIT_SET_AC1_PKT_INFO(x, v) \ -+ (BIT_CLEAR_AC1_PKT_INFO(x) | BIT_AC1_PKT_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_OFFSET (Offset 0x1400) */ -+ -+#define BIT_SHIFT_MU_RATETABLE_OFFSET 16 -+#define BIT_MASK_MU_RATETABLE_OFFSET 0x1ff -+#define BIT_MU_RATETABLE_OFFSET(x) \ -+ (((x) & BIT_MASK_MU_RATETABLE_OFFSET) << BIT_SHIFT_MU_RATETABLE_OFFSET) -+#define BITS_MU_RATETABLE_OFFSET \ -+ (BIT_MASK_MU_RATETABLE_OFFSET << BIT_SHIFT_MU_RATETABLE_OFFSET) -+#define BIT_CLEAR_MU_RATETABLE_OFFSET(x) ((x) & (~BITS_MU_RATETABLE_OFFSET)) -+#define BIT_GET_MU_RATETABLE_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_MU_RATETABLE_OFFSET) & BIT_MASK_MU_RATETABLE_OFFSET) -+#define BIT_SET_MU_RATETABLE_OFFSET(x, v) \ -+ (BIT_CLEAR_MU_RATETABLE_OFFSET(x) | BIT_MU_RATETABLE_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q0_Q1_INFO (Offset 0x1400) */ -+ -+#define BIT_SHIFT_AC0_PKT_INFO 0 -+#define BIT_MASK_AC0_PKT_INFO 0xfff -+#define BIT_AC0_PKT_INFO(x) \ -+ (((x) & BIT_MASK_AC0_PKT_INFO) << BIT_SHIFT_AC0_PKT_INFO) -+#define BITS_AC0_PKT_INFO (BIT_MASK_AC0_PKT_INFO << BIT_SHIFT_AC0_PKT_INFO) -+#define BIT_CLEAR_AC0_PKT_INFO(x) ((x) & (~BITS_AC0_PKT_INFO)) -+#define BIT_GET_AC0_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_AC0_PKT_INFO) & BIT_MASK_AC0_PKT_INFO) -+#define BIT_SET_AC0_PKT_INFO(x, v) \ -+ (BIT_CLEAR_AC0_PKT_INFO(x) | BIT_AC0_PKT_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_ARFR6 (Offset 0x1400) */ -+ -+#define BIT_SHIFT_ARFRL6 0 -+#define BIT_MASK_ARFRL6 0xffffffffL -+#define BIT_ARFRL6(x) (((x) & BIT_MASK_ARFRL6) << BIT_SHIFT_ARFRL6) -+#define BITS_ARFRL6 (BIT_MASK_ARFRL6 << BIT_SHIFT_ARFRL6) -+#define BIT_CLEAR_ARFRL6(x) ((x) & (~BITS_ARFRL6)) -+#define BIT_GET_ARFRL6(x) (((x) >> BIT_SHIFT_ARFRL6) & BIT_MASK_ARFRL6) -+#define BIT_SET_ARFRL6(x, v) (BIT_CLEAR_ARFRL6(x) | BIT_ARFRL6(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_ARFR6 (Offset 0x1400) */ -+ -+#define BIT_SHIFT_ARFR6_V1 0 -+#define BIT_MASK_ARFR6_V1 0xffffffffffffffffL -+#define BIT_ARFR6_V1(x) (((x) & BIT_MASK_ARFR6_V1) << BIT_SHIFT_ARFR6_V1) -+#define BITS_ARFR6_V1 (BIT_MASK_ARFR6_V1 << BIT_SHIFT_ARFR6_V1) -+#define BIT_CLEAR_ARFR6_V1(x) ((x) & (~BITS_ARFR6_V1)) -+#define BIT_GET_ARFR6_V1(x) (((x) >> BIT_SHIFT_ARFR6_V1) & BIT_MASK_ARFR6_V1) -+#define BIT_SET_ARFR6_V1(x, v) (BIT_CLEAR_ARFR6_V1(x) | BIT_ARFR6_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_OFFSET (Offset 0x1400) */ -+ -+#define BIT_SHIFT_MU_SCORETABLE_OFFSET 0 -+#define BIT_MASK_MU_SCORETABLE_OFFSET 0x1ff -+#define BIT_MU_SCORETABLE_OFFSET(x) \ -+ (((x) & BIT_MASK_MU_SCORETABLE_OFFSET) \ -+ << BIT_SHIFT_MU_SCORETABLE_OFFSET) -+#define BITS_MU_SCORETABLE_OFFSET \ -+ (BIT_MASK_MU_SCORETABLE_OFFSET << BIT_SHIFT_MU_SCORETABLE_OFFSET) -+#define BIT_CLEAR_MU_SCORETABLE_OFFSET(x) ((x) & (~BITS_MU_SCORETABLE_OFFSET)) -+#define BIT_GET_MU_SCORETABLE_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_MU_SCORETABLE_OFFSET) & \ -+ BIT_MASK_MU_SCORETABLE_OFFSET) -+#define BIT_SET_MU_SCORETABLE_OFFSET(x, v) \ -+ (BIT_CLEAR_MU_SCORETABLE_OFFSET(x) | BIT_MU_SCORETABLE_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q2_Q3_INFO (Offset 0x1404) */ -+ -+#define BIT_SHIFT_AC3_PKT_INFO 16 -+#define BIT_MASK_AC3_PKT_INFO 0xfff -+#define BIT_AC3_PKT_INFO(x) \ -+ (((x) & BIT_MASK_AC3_PKT_INFO) << BIT_SHIFT_AC3_PKT_INFO) -+#define BITS_AC3_PKT_INFO (BIT_MASK_AC3_PKT_INFO << BIT_SHIFT_AC3_PKT_INFO) -+#define BIT_CLEAR_AC3_PKT_INFO(x) ((x) & (~BITS_AC3_PKT_INFO)) -+#define BIT_GET_AC3_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_AC3_PKT_INFO) & BIT_MASK_AC3_PKT_INFO) -+#define BIT_SET_AC3_PKT_INFO(x, v) \ -+ (BIT_CLEAR_AC3_PKT_INFO(x) | BIT_AC3_PKT_INFO(v)) -+ -+#define BIT_SHIFT_AC2_PKT_INFO 0 -+#define BIT_MASK_AC2_PKT_INFO 0xfff -+#define BIT_AC2_PKT_INFO(x) \ -+ (((x) & BIT_MASK_AC2_PKT_INFO) << BIT_SHIFT_AC2_PKT_INFO) -+#define BITS_AC2_PKT_INFO (BIT_MASK_AC2_PKT_INFO << BIT_SHIFT_AC2_PKT_INFO) -+#define BIT_CLEAR_AC2_PKT_INFO(x) ((x) & (~BITS_AC2_PKT_INFO)) -+#define BIT_GET_AC2_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_AC2_PKT_INFO) & BIT_MASK_AC2_PKT_INFO) -+#define BIT_SET_AC2_PKT_INFO(x, v) \ -+ (BIT_CLEAR_AC2_PKT_INFO(x) | BIT_AC2_PKT_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_ARFRH6 (Offset 0x1404) */ -+ -+#define BIT_SHIFT_ARFRH6 0 -+#define BIT_MASK_ARFRH6 0xffffffffL -+#define BIT_ARFRH6(x) (((x) & BIT_MASK_ARFRH6) << BIT_SHIFT_ARFRH6) -+#define BITS_ARFRH6 (BIT_MASK_ARFRH6 << BIT_SHIFT_ARFRH6) -+#define BIT_CLEAR_ARFRH6(x) ((x) & (~BITS_ARFRH6)) -+#define BIT_GET_ARFRH6(x) (((x) >> BIT_SHIFT_ARFRH6) & BIT_MASK_ARFRH6) -+#define BIT_SET_ARFRH6(x, v) (BIT_CLEAR_ARFRH6(x) | BIT_ARFRH6(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q4_Q5_INFO (Offset 0x1408) */ -+ -+#define BIT_SHIFT_AC5_PKT_INFO 16 -+#define BIT_MASK_AC5_PKT_INFO 0xfff -+#define BIT_AC5_PKT_INFO(x) \ -+ (((x) & BIT_MASK_AC5_PKT_INFO) << BIT_SHIFT_AC5_PKT_INFO) -+#define BITS_AC5_PKT_INFO (BIT_MASK_AC5_PKT_INFO << BIT_SHIFT_AC5_PKT_INFO) -+#define BIT_CLEAR_AC5_PKT_INFO(x) ((x) & (~BITS_AC5_PKT_INFO)) -+#define BIT_GET_AC5_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_AC5_PKT_INFO) & BIT_MASK_AC5_PKT_INFO) -+#define BIT_SET_AC5_PKT_INFO(x, v) \ -+ (BIT_CLEAR_AC5_PKT_INFO(x) | BIT_AC5_PKT_INFO(v)) -+ -+#define BIT_SHIFT_AC4_PKT_INFO 0 -+#define BIT_MASK_AC4_PKT_INFO 0xfff -+#define BIT_AC4_PKT_INFO(x) \ -+ (((x) & BIT_MASK_AC4_PKT_INFO) << BIT_SHIFT_AC4_PKT_INFO) -+#define BITS_AC4_PKT_INFO (BIT_MASK_AC4_PKT_INFO << BIT_SHIFT_AC4_PKT_INFO) -+#define BIT_CLEAR_AC4_PKT_INFO(x) ((x) & (~BITS_AC4_PKT_INFO)) -+#define BIT_GET_AC4_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_AC4_PKT_INFO) & BIT_MASK_AC4_PKT_INFO) -+#define BIT_SET_AC4_PKT_INFO(x, v) \ -+ (BIT_CLEAR_AC4_PKT_INFO(x) | BIT_AC4_PKT_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_ARFR7 (Offset 0x1408) */ -+ -+#define BIT_SHIFT_ARFRL7 0 -+#define BIT_MASK_ARFRL7 0xffffffffL -+#define BIT_ARFRL7(x) (((x) & BIT_MASK_ARFRL7) << BIT_SHIFT_ARFRL7) -+#define BITS_ARFRL7 (BIT_MASK_ARFRL7 << BIT_SHIFT_ARFRL7) -+#define BIT_CLEAR_ARFRL7(x) ((x) & (~BITS_ARFRL7)) -+#define BIT_GET_ARFRL7(x) (((x) >> BIT_SHIFT_ARFRL7) & BIT_MASK_ARFRL7) -+#define BIT_SET_ARFRL7(x, v) (BIT_CLEAR_ARFRL7(x) | BIT_ARFRL7(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_ARFR7 (Offset 0x1408) */ -+ -+#define BIT_SHIFT_ARFR7_V1 0 -+#define BIT_MASK_ARFR7_V1 0xffffffffffffffffL -+#define BIT_ARFR7_V1(x) (((x) & BIT_MASK_ARFR7_V1) << BIT_SHIFT_ARFR7_V1) -+#define BITS_ARFR7_V1 (BIT_MASK_ARFR7_V1 << BIT_SHIFT_ARFR7_V1) -+#define BIT_CLEAR_ARFR7_V1(x) ((x) & (~BITS_ARFR7_V1)) -+#define BIT_GET_ARFR7_V1(x) (((x) >> BIT_SHIFT_ARFR7_V1) & BIT_MASK_ARFR7_V1) -+#define BIT_SET_ARFR7_V1(x, v) (BIT_CLEAR_ARFR7_V1(x) | BIT_ARFR7_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_Q6_Q7_INFO (Offset 0x140C) */ -+ -+#define BIT_SHIFT_AC7_PKT_INFO 16 -+#define BIT_MASK_AC7_PKT_INFO 0xfff -+#define BIT_AC7_PKT_INFO(x) \ -+ (((x) & BIT_MASK_AC7_PKT_INFO) << BIT_SHIFT_AC7_PKT_INFO) -+#define BITS_AC7_PKT_INFO (BIT_MASK_AC7_PKT_INFO << BIT_SHIFT_AC7_PKT_INFO) -+#define BIT_CLEAR_AC7_PKT_INFO(x) ((x) & (~BITS_AC7_PKT_INFO)) -+#define BIT_GET_AC7_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_AC7_PKT_INFO) & BIT_MASK_AC7_PKT_INFO) -+#define BIT_SET_AC7_PKT_INFO(x, v) \ -+ (BIT_CLEAR_AC7_PKT_INFO(x) | BIT_AC7_PKT_INFO(v)) -+ -+#define BIT_SHIFT_AC6_PKT_INFO 0 -+#define BIT_MASK_AC6_PKT_INFO 0xfff -+#define BIT_AC6_PKT_INFO(x) \ -+ (((x) & BIT_MASK_AC6_PKT_INFO) << BIT_SHIFT_AC6_PKT_INFO) -+#define BITS_AC6_PKT_INFO (BIT_MASK_AC6_PKT_INFO << BIT_SHIFT_AC6_PKT_INFO) -+#define BIT_CLEAR_AC6_PKT_INFO(x) ((x) & (~BITS_AC6_PKT_INFO)) -+#define BIT_GET_AC6_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_AC6_PKT_INFO) & BIT_MASK_AC6_PKT_INFO) -+#define BIT_SET_AC6_PKT_INFO(x, v) \ -+ (BIT_CLEAR_AC6_PKT_INFO(x) | BIT_AC6_PKT_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_ARFRH7 (Offset 0x140C) */ -+ -+#define BIT_SHIFT_ARFRH7 0 -+#define BIT_MASK_ARFRH7 0xffffffffL -+#define BIT_ARFRH7(x) (((x) & BIT_MASK_ARFRH7) << BIT_SHIFT_ARFRH7) -+#define BITS_ARFRH7 (BIT_MASK_ARFRH7 << BIT_SHIFT_ARFRH7) -+#define BIT_CLEAR_ARFRH7(x) ((x) & (~BITS_ARFRH7)) -+#define BIT_GET_ARFRH7(x) (((x) >> BIT_SHIFT_ARFRH7) & BIT_MASK_ARFRH7) -+#define BIT_SET_ARFRH7(x, v) (BIT_CLEAR_ARFRH7(x) | BIT_ARFRH7(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_HIQ_INFO (Offset 0x1410) */ -+ -+#define BIT_SHIFT_HIQ_PKT_INFO 16 -+#define BIT_MASK_HIQ_PKT_INFO 0xfff -+#define BIT_HIQ_PKT_INFO(x) \ -+ (((x) & BIT_MASK_HIQ_PKT_INFO) << BIT_SHIFT_HIQ_PKT_INFO) -+#define BITS_HIQ_PKT_INFO (BIT_MASK_HIQ_PKT_INFO << BIT_SHIFT_HIQ_PKT_INFO) -+#define BIT_CLEAR_HIQ_PKT_INFO(x) ((x) & (~BITS_HIQ_PKT_INFO)) -+#define BIT_GET_HIQ_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_HIQ_PKT_INFO) & BIT_MASK_HIQ_PKT_INFO) -+#define BIT_SET_HIQ_PKT_INFO(x, v) \ -+ (BIT_CLEAR_HIQ_PKT_INFO(x) | BIT_HIQ_PKT_INFO(v)) -+ -+#define BIT_SHIFT_MGQ_PKT_INFO 0 -+#define BIT_MASK_MGQ_PKT_INFO 0xfff -+#define BIT_MGQ_PKT_INFO(x) \ -+ (((x) & BIT_MASK_MGQ_PKT_INFO) << BIT_SHIFT_MGQ_PKT_INFO) -+#define BITS_MGQ_PKT_INFO (BIT_MASK_MGQ_PKT_INFO << BIT_SHIFT_MGQ_PKT_INFO) -+#define BIT_CLEAR_MGQ_PKT_INFO(x) ((x) & (~BITS_MGQ_PKT_INFO)) -+#define BIT_GET_MGQ_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PKT_INFO) & BIT_MASK_MGQ_PKT_INFO) -+#define BIT_SET_MGQ_PKT_INFO(x, v) \ -+ (BIT_CLEAR_MGQ_PKT_INFO(x) | BIT_MGQ_PKT_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_ARFR8 (Offset 0x1410) */ -+ -+#define BIT_SHIFT_ARFRL8 0 -+#define BIT_MASK_ARFRL8 0xffffffffL -+#define BIT_ARFRL8(x) (((x) & BIT_MASK_ARFRL8) << BIT_SHIFT_ARFRL8) -+#define BITS_ARFRL8 (BIT_MASK_ARFRL8 << BIT_SHIFT_ARFRL8) -+#define BIT_CLEAR_ARFRL8(x) ((x) & (~BITS_ARFRL8)) -+#define BIT_GET_ARFRL8(x) (((x) >> BIT_SHIFT_ARFRL8) & BIT_MASK_ARFRL8) -+#define BIT_SET_ARFRL8(x, v) (BIT_CLEAR_ARFRL8(x) | BIT_ARFRL8(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_ARFR8 (Offset 0x1410) */ -+ -+#define BIT_SHIFT_ARFR8_V1 0 -+#define BIT_MASK_ARFR8_V1 0xffffffffffffffffL -+#define BIT_ARFR8_V1(x) (((x) & BIT_MASK_ARFR8_V1) << BIT_SHIFT_ARFR8_V1) -+#define BITS_ARFR8_V1 (BIT_MASK_ARFR8_V1 << BIT_SHIFT_ARFR8_V1) -+#define BIT_CLEAR_ARFR8_V1(x) ((x) & (~BITS_ARFR8_V1)) -+#define BIT_GET_ARFR8_V1(x) (((x) >> BIT_SHIFT_ARFR8_V1) & BIT_MASK_ARFR8_V1) -+#define BIT_SET_ARFR8_V1(x, v) (BIT_CLEAR_ARFR8_V1(x) | BIT_ARFR8_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_CMDQ_BCNQ_INFO (Offset 0x1414) */ -+ -+#define BIT_SHIFT_BCNQ_PKT_INFO_V1 16 -+#define BIT_MASK_BCNQ_PKT_INFO_V1 0xfff -+#define BIT_BCNQ_PKT_INFO_V1(x) \ -+ (((x) & BIT_MASK_BCNQ_PKT_INFO_V1) << BIT_SHIFT_BCNQ_PKT_INFO_V1) -+#define BITS_BCNQ_PKT_INFO_V1 \ -+ (BIT_MASK_BCNQ_PKT_INFO_V1 << BIT_SHIFT_BCNQ_PKT_INFO_V1) -+#define BIT_CLEAR_BCNQ_PKT_INFO_V1(x) ((x) & (~BITS_BCNQ_PKT_INFO_V1)) -+#define BIT_GET_BCNQ_PKT_INFO_V1(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PKT_INFO_V1) & BIT_MASK_BCNQ_PKT_INFO_V1) -+#define BIT_SET_BCNQ_PKT_INFO_V1(x, v) \ -+ (BIT_CLEAR_BCNQ_PKT_INFO_V1(x) | BIT_BCNQ_PKT_INFO_V1(v)) -+ -+#define BIT_SHIFT_BCNERR_PORT_SEL 16 -+#define BIT_MASK_BCNERR_PORT_SEL 0x7 -+#define BIT_BCNERR_PORT_SEL(x) \ -+ (((x) & BIT_MASK_BCNERR_PORT_SEL) << BIT_SHIFT_BCNERR_PORT_SEL) -+#define BITS_BCNERR_PORT_SEL \ -+ (BIT_MASK_BCNERR_PORT_SEL << BIT_SHIFT_BCNERR_PORT_SEL) -+#define BIT_CLEAR_BCNERR_PORT_SEL(x) ((x) & (~BITS_BCNERR_PORT_SEL)) -+#define BIT_GET_BCNERR_PORT_SEL(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_PORT_SEL) & BIT_MASK_BCNERR_PORT_SEL) -+#define BIT_SET_BCNERR_PORT_SEL(x, v) \ -+ (BIT_CLEAR_BCNERR_PORT_SEL(x) | BIT_BCNERR_PORT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CMDQ_BCNQ_INFO (Offset 0x1414) */ -+ -+#define BIT_SHIFT_CMDQ_PKT_INFO 16 -+#define BIT_MASK_CMDQ_PKT_INFO 0xfff -+#define BIT_CMDQ_PKT_INFO(x) \ -+ (((x) & BIT_MASK_CMDQ_PKT_INFO) << BIT_SHIFT_CMDQ_PKT_INFO) -+#define BITS_CMDQ_PKT_INFO (BIT_MASK_CMDQ_PKT_INFO << BIT_SHIFT_CMDQ_PKT_INFO) -+#define BIT_CLEAR_CMDQ_PKT_INFO(x) ((x) & (~BITS_CMDQ_PKT_INFO)) -+#define BIT_GET_CMDQ_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_CMDQ_PKT_INFO) & BIT_MASK_CMDQ_PKT_INFO) -+#define BIT_SET_CMDQ_PKT_INFO(x, v) \ -+ (BIT_CLEAR_CMDQ_PKT_INFO(x) | BIT_CMDQ_PKT_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/* 2 REG_CMDQ_BCNQ_INFO (Offset 0x1414) */ -+ -+#define BIT_SHIFT_CMDQ_PKT_INFO_V1 0 -+#define BIT_MASK_CMDQ_PKT_INFO_V1 0xfff -+#define BIT_CMDQ_PKT_INFO_V1(x) \ -+ (((x) & BIT_MASK_CMDQ_PKT_INFO_V1) << BIT_SHIFT_CMDQ_PKT_INFO_V1) -+#define BITS_CMDQ_PKT_INFO_V1 \ -+ (BIT_MASK_CMDQ_PKT_INFO_V1 << BIT_SHIFT_CMDQ_PKT_INFO_V1) -+#define BIT_CLEAR_CMDQ_PKT_INFO_V1(x) ((x) & (~BITS_CMDQ_PKT_INFO_V1)) -+#define BIT_GET_CMDQ_PKT_INFO_V1(x) \ -+ (((x) >> BIT_SHIFT_CMDQ_PKT_INFO_V1) & BIT_MASK_CMDQ_PKT_INFO_V1) -+#define BIT_SET_CMDQ_PKT_INFO_V1(x, v) \ -+ (BIT_CLEAR_CMDQ_PKT_INFO_V1(x) | BIT_CMDQ_PKT_INFO_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_ARFRH8 (Offset 0x1414) */ -+ -+#define BIT_SHIFT_ARFRH8 0 -+#define BIT_MASK_ARFRH8 0xffffffffL -+#define BIT_ARFRH8(x) (((x) & BIT_MASK_ARFRH8) << BIT_SHIFT_ARFRH8) -+#define BITS_ARFRH8 (BIT_MASK_ARFRH8 << BIT_SHIFT_ARFRH8) -+#define BIT_CLEAR_ARFRH8(x) ((x) & (~BITS_ARFRH8)) -+#define BIT_GET_ARFRH8(x) (((x) >> BIT_SHIFT_ARFRH8) & BIT_MASK_ARFRH8) -+#define BIT_SET_ARFRH8(x, v) (BIT_CLEAR_ARFRH8(x) | BIT_ARFRH8(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CMDQ_BCNQ_INFO (Offset 0x1414) */ -+ -+#define BIT_SHIFT_BCNQ_PKT_INFO 0 -+#define BIT_MASK_BCNQ_PKT_INFO 0xfff -+#define BIT_BCNQ_PKT_INFO(x) \ -+ (((x) & BIT_MASK_BCNQ_PKT_INFO) << BIT_SHIFT_BCNQ_PKT_INFO) -+#define BITS_BCNQ_PKT_INFO (BIT_MASK_BCNQ_PKT_INFO << BIT_SHIFT_BCNQ_PKT_INFO) -+#define BIT_CLEAR_BCNQ_PKT_INFO(x) ((x) & (~BITS_BCNQ_PKT_INFO)) -+#define BIT_GET_BCNQ_PKT_INFO(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PKT_INFO) & BIT_MASK_BCNQ_PKT_INFO) -+#define BIT_SET_BCNQ_PKT_INFO(x, v) \ -+ (BIT_CLEAR_BCNQ_PKT_INFO(x) | BIT_BCNQ_PKT_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_LOOPBACK_OPTION (Offset 0x1420) */ -+ -+#define BIT_LOOPACK_FAST_EDCA_EN BIT(24) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_USEREG_SETTING (Offset 0x1420) */ -+ -+#define BIT_NDPA_USEREG BIT(21) -+ -+#define BIT_SHIFT_RETRY_USEREG 19 -+#define BIT_MASK_RETRY_USEREG 0x3 -+#define BIT_RETRY_USEREG(x) \ -+ (((x) & BIT_MASK_RETRY_USEREG) << BIT_SHIFT_RETRY_USEREG) -+#define BITS_RETRY_USEREG (BIT_MASK_RETRY_USEREG << BIT_SHIFT_RETRY_USEREG) -+#define BIT_CLEAR_RETRY_USEREG(x) ((x) & (~BITS_RETRY_USEREG)) -+#define BIT_GET_RETRY_USEREG(x) \ -+ (((x) >> BIT_SHIFT_RETRY_USEREG) & BIT_MASK_RETRY_USEREG) -+#define BIT_SET_RETRY_USEREG(x, v) \ -+ (BIT_CLEAR_RETRY_USEREG(x) | BIT_RETRY_USEREG(v)) -+ -+#define BIT_SHIFT_TRYPKT_USEREG 17 -+#define BIT_MASK_TRYPKT_USEREG 0x3 -+#define BIT_TRYPKT_USEREG(x) \ -+ (((x) & BIT_MASK_TRYPKT_USEREG) << BIT_SHIFT_TRYPKT_USEREG) -+#define BITS_TRYPKT_USEREG (BIT_MASK_TRYPKT_USEREG << BIT_SHIFT_TRYPKT_USEREG) -+#define BIT_CLEAR_TRYPKT_USEREG(x) ((x) & (~BITS_TRYPKT_USEREG)) -+#define BIT_GET_TRYPKT_USEREG(x) \ -+ (((x) >> BIT_SHIFT_TRYPKT_USEREG) & BIT_MASK_TRYPKT_USEREG) -+#define BIT_SET_TRYPKT_USEREG(x, v) \ -+ (BIT_CLEAR_TRYPKT_USEREG(x) | BIT_TRYPKT_USEREG(v)) -+ -+#define BIT_CTLPKT_USEREG BIT(16) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_AESIV_SETTING (Offset 0x1424) */ -+ -+#define BIT_SHIFT_AESIV_OFFSET 0 -+#define BIT_MASK_AESIV_OFFSET 0xfff -+#define BIT_AESIV_OFFSET(x) \ -+ (((x) & BIT_MASK_AESIV_OFFSET) << BIT_SHIFT_AESIV_OFFSET) -+#define BITS_AESIV_OFFSET (BIT_MASK_AESIV_OFFSET << BIT_SHIFT_AESIV_OFFSET) -+#define BIT_CLEAR_AESIV_OFFSET(x) ((x) & (~BITS_AESIV_OFFSET)) -+#define BIT_GET_AESIV_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_AESIV_OFFSET) & BIT_MASK_AESIV_OFFSET) -+#define BIT_SET_AESIV_OFFSET(x, v) \ -+ (BIT_CLEAR_AESIV_OFFSET(x) | BIT_AESIV_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BF0_TIME_SETTING (Offset 0x1428) */ -+ -+#define BIT_BF0_TIMER_SET BIT(31) -+#define BIT_BF0_TIMER_CLR BIT(30) -+#define BIT_BF0_UPDATE_EN BIT(29) -+#define BIT_BF0_TIMER_EN BIT(28) -+ -+#define BIT_SHIFT_BF0_PRETIME_OVER 16 -+#define BIT_MASK_BF0_PRETIME_OVER 0xfff -+#define BIT_BF0_PRETIME_OVER(x) \ -+ (((x) & BIT_MASK_BF0_PRETIME_OVER) << BIT_SHIFT_BF0_PRETIME_OVER) -+#define BITS_BF0_PRETIME_OVER \ -+ (BIT_MASK_BF0_PRETIME_OVER << BIT_SHIFT_BF0_PRETIME_OVER) -+#define BIT_CLEAR_BF0_PRETIME_OVER(x) ((x) & (~BITS_BF0_PRETIME_OVER)) -+#define BIT_GET_BF0_PRETIME_OVER(x) \ -+ (((x) >> BIT_SHIFT_BF0_PRETIME_OVER) & BIT_MASK_BF0_PRETIME_OVER) -+#define BIT_SET_BF0_PRETIME_OVER(x, v) \ -+ (BIT_CLEAR_BF0_PRETIME_OVER(x) | BIT_BF0_PRETIME_OVER(v)) -+ -+#define BIT_SHIFT_BF0_LIFETIME 0 -+#define BIT_MASK_BF0_LIFETIME 0xffff -+#define BIT_BF0_LIFETIME(x) \ -+ (((x) & BIT_MASK_BF0_LIFETIME) << BIT_SHIFT_BF0_LIFETIME) -+#define BITS_BF0_LIFETIME (BIT_MASK_BF0_LIFETIME << BIT_SHIFT_BF0_LIFETIME) -+#define BIT_CLEAR_BF0_LIFETIME(x) ((x) & (~BITS_BF0_LIFETIME)) -+#define BIT_GET_BF0_LIFETIME(x) \ -+ (((x) >> BIT_SHIFT_BF0_LIFETIME) & BIT_MASK_BF0_LIFETIME) -+#define BIT_SET_BF0_LIFETIME(x, v) \ -+ (BIT_CLEAR_BF0_LIFETIME(x) | BIT_BF0_LIFETIME(v)) -+ -+/* 2 REG_BF1_TIME_SETTING (Offset 0x142C) */ -+ -+#define BIT_BF1_TIMER_SET BIT(31) -+#define BIT_BF1_TIMER_CLR BIT(30) -+#define BIT_BF1_UPDATE_EN BIT(29) -+#define BIT_BF1_TIMER_EN BIT(28) -+ -+#define BIT_SHIFT_BF1_PRETIME_OVER 16 -+#define BIT_MASK_BF1_PRETIME_OVER 0xfff -+#define BIT_BF1_PRETIME_OVER(x) \ -+ (((x) & BIT_MASK_BF1_PRETIME_OVER) << BIT_SHIFT_BF1_PRETIME_OVER) -+#define BITS_BF1_PRETIME_OVER \ -+ (BIT_MASK_BF1_PRETIME_OVER << BIT_SHIFT_BF1_PRETIME_OVER) -+#define BIT_CLEAR_BF1_PRETIME_OVER(x) ((x) & (~BITS_BF1_PRETIME_OVER)) -+#define BIT_GET_BF1_PRETIME_OVER(x) \ -+ (((x) >> BIT_SHIFT_BF1_PRETIME_OVER) & BIT_MASK_BF1_PRETIME_OVER) -+#define BIT_SET_BF1_PRETIME_OVER(x, v) \ -+ (BIT_CLEAR_BF1_PRETIME_OVER(x) | BIT_BF1_PRETIME_OVER(v)) -+ -+#define BIT_SHIFT_BF1_LIFETIME 0 -+#define BIT_MASK_BF1_LIFETIME 0xffff -+#define BIT_BF1_LIFETIME(x) \ -+ (((x) & BIT_MASK_BF1_LIFETIME) << BIT_SHIFT_BF1_LIFETIME) -+#define BITS_BF1_LIFETIME (BIT_MASK_BF1_LIFETIME << BIT_SHIFT_BF1_LIFETIME) -+#define BIT_CLEAR_BF1_LIFETIME(x) ((x) & (~BITS_BF1_LIFETIME)) -+#define BIT_GET_BF1_LIFETIME(x) \ -+ (((x) >> BIT_SHIFT_BF1_LIFETIME) & BIT_MASK_BF1_LIFETIME) -+#define BIT_SET_BF1_LIFETIME(x, v) \ -+ (BIT_CLEAR_BF1_LIFETIME(x) | BIT_BF1_LIFETIME(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BF_TIMEOUT_EN (Offset 0x1430) */ -+ -+#define BIT_EN_VHT_LDPC BIT(9) -+#define BIT_EN_HT_LDPC BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BF_TIMEOUT_EN (Offset 0x1430) */ -+ -+#define BIT_BF1_TIMEOUT_EN BIT(1) -+#define BIT_BF0_TIMEOUT_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID_RELEASE0 (Offset 0x1434) */ -+ -+#define BIT_SHIFT_MACID31_0_RELEASE 0 -+#define BIT_MASK_MACID31_0_RELEASE 0xffffffffL -+#define BIT_MACID31_0_RELEASE(x) \ -+ (((x) & BIT_MASK_MACID31_0_RELEASE) << BIT_SHIFT_MACID31_0_RELEASE) -+#define BITS_MACID31_0_RELEASE \ -+ (BIT_MASK_MACID31_0_RELEASE << BIT_SHIFT_MACID31_0_RELEASE) -+#define BIT_CLEAR_MACID31_0_RELEASE(x) ((x) & (~BITS_MACID31_0_RELEASE)) -+#define BIT_GET_MACID31_0_RELEASE(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_RELEASE) & BIT_MASK_MACID31_0_RELEASE) -+#define BIT_SET_MACID31_0_RELEASE(x, v) \ -+ (BIT_CLEAR_MACID31_0_RELEASE(x) | BIT_MACID31_0_RELEASE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MACID_RELEASE_INFO (Offset 0x1434) */ -+ -+#define BIT_SHIFT_MACID_RELEASE_INFO 0 -+#define BIT_MASK_MACID_RELEASE_INFO 0xffffffffL -+#define BIT_MACID_RELEASE_INFO(x) \ -+ (((x) & BIT_MASK_MACID_RELEASE_INFO) << BIT_SHIFT_MACID_RELEASE_INFO) -+#define BITS_MACID_RELEASE_INFO \ -+ (BIT_MASK_MACID_RELEASE_INFO << BIT_SHIFT_MACID_RELEASE_INFO) -+#define BIT_CLEAR_MACID_RELEASE_INFO(x) ((x) & (~BITS_MACID_RELEASE_INFO)) -+#define BIT_GET_MACID_RELEASE_INFO(x) \ -+ (((x) >> BIT_SHIFT_MACID_RELEASE_INFO) & BIT_MASK_MACID_RELEASE_INFO) -+#define BIT_SET_MACID_RELEASE_INFO(x, v) \ -+ (BIT_CLEAR_MACID_RELEASE_INFO(x) | BIT_MACID_RELEASE_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID_RELEASE1 (Offset 0x1438) */ -+ -+#define BIT_SHIFT_MACID63_32_RELEASE 0 -+#define BIT_MASK_MACID63_32_RELEASE 0xffffffffL -+#define BIT_MACID63_32_RELEASE(x) \ -+ (((x) & BIT_MASK_MACID63_32_RELEASE) << BIT_SHIFT_MACID63_32_RELEASE) -+#define BITS_MACID63_32_RELEASE \ -+ (BIT_MASK_MACID63_32_RELEASE << BIT_SHIFT_MACID63_32_RELEASE) -+#define BIT_CLEAR_MACID63_32_RELEASE(x) ((x) & (~BITS_MACID63_32_RELEASE)) -+#define BIT_GET_MACID63_32_RELEASE(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_RELEASE) & BIT_MASK_MACID63_32_RELEASE) -+#define BIT_SET_MACID63_32_RELEASE(x, v) \ -+ (BIT_CLEAR_MACID63_32_RELEASE(x) | BIT_MACID63_32_RELEASE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MACID_RELEASE_SUCCESS_INFO (Offset 0x1438) */ -+ -+#define BIT_SHIFT_MACID_RELEASE_SUCCESS_INFO 0 -+#define BIT_MASK_MACID_RELEASE_SUCCESS_INFO 0xffffffffL -+#define BIT_MACID_RELEASE_SUCCESS_INFO(x) \ -+ (((x) & BIT_MASK_MACID_RELEASE_SUCCESS_INFO) \ -+ << BIT_SHIFT_MACID_RELEASE_SUCCESS_INFO) -+#define BITS_MACID_RELEASE_SUCCESS_INFO \ -+ (BIT_MASK_MACID_RELEASE_SUCCESS_INFO \ -+ << BIT_SHIFT_MACID_RELEASE_SUCCESS_INFO) -+#define BIT_CLEAR_MACID_RELEASE_SUCCESS_INFO(x) \ -+ ((x) & (~BITS_MACID_RELEASE_SUCCESS_INFO)) -+#define BIT_GET_MACID_RELEASE_SUCCESS_INFO(x) \ -+ (((x) >> BIT_SHIFT_MACID_RELEASE_SUCCESS_INFO) & \ -+ BIT_MASK_MACID_RELEASE_SUCCESS_INFO) -+#define BIT_SET_MACID_RELEASE_SUCCESS_INFO(x, v) \ -+ (BIT_CLEAR_MACID_RELEASE_SUCCESS_INFO(x) | \ -+ BIT_MACID_RELEASE_SUCCESS_INFO(v)) -+ -+/* 2 REG_MACID_RELEASE_CTRL (Offset 0x143C) */ -+ -+#define BIT_SHIFT_MACID_RELEASE_SEL 24 -+#define BIT_MASK_MACID_RELEASE_SEL 0x7 -+#define BIT_MACID_RELEASE_SEL(x) \ -+ (((x) & BIT_MASK_MACID_RELEASE_SEL) << BIT_SHIFT_MACID_RELEASE_SEL) -+#define BITS_MACID_RELEASE_SEL \ -+ (BIT_MASK_MACID_RELEASE_SEL << BIT_SHIFT_MACID_RELEASE_SEL) -+#define BIT_CLEAR_MACID_RELEASE_SEL(x) ((x) & (~BITS_MACID_RELEASE_SEL)) -+#define BIT_GET_MACID_RELEASE_SEL(x) \ -+ (((x) >> BIT_SHIFT_MACID_RELEASE_SEL) & BIT_MASK_MACID_RELEASE_SEL) -+#define BIT_SET_MACID_RELEASE_SEL(x, v) \ -+ (BIT_CLEAR_MACID_RELEASE_SEL(x) | BIT_MACID_RELEASE_SEL(v)) -+ -+#define BIT_SHIFT_MACID_RELEASE_CLEAR_OFFSET 16 -+#define BIT_MASK_MACID_RELEASE_CLEAR_OFFSET 0xff -+#define BIT_MACID_RELEASE_CLEAR_OFFSET(x) \ -+ (((x) & BIT_MASK_MACID_RELEASE_CLEAR_OFFSET) \ -+ << BIT_SHIFT_MACID_RELEASE_CLEAR_OFFSET) -+#define BITS_MACID_RELEASE_CLEAR_OFFSET \ -+ (BIT_MASK_MACID_RELEASE_CLEAR_OFFSET \ -+ << BIT_SHIFT_MACID_RELEASE_CLEAR_OFFSET) -+#define BIT_CLEAR_MACID_RELEASE_CLEAR_OFFSET(x) \ -+ ((x) & (~BITS_MACID_RELEASE_CLEAR_OFFSET)) -+#define BIT_GET_MACID_RELEASE_CLEAR_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_MACID_RELEASE_CLEAR_OFFSET) & \ -+ BIT_MASK_MACID_RELEASE_CLEAR_OFFSET) -+#define BIT_SET_MACID_RELEASE_CLEAR_OFFSET(x, v) \ -+ (BIT_CLEAR_MACID_RELEASE_CLEAR_OFFSET(x) | \ -+ BIT_MACID_RELEASE_CLEAR_OFFSET(v)) -+ -+#define BIT_MACID_RELEASE_VALUE BIT(8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID_RELEASE2 (Offset 0x143C) */ -+ -+#define BIT_SHIFT_MACID95_64_RELEASE 0 -+#define BIT_MASK_MACID95_64_RELEASE 0xffffffffL -+#define BIT_MACID95_64_RELEASE(x) \ -+ (((x) & BIT_MASK_MACID95_64_RELEASE) << BIT_SHIFT_MACID95_64_RELEASE) -+#define BITS_MACID95_64_RELEASE \ -+ (BIT_MASK_MACID95_64_RELEASE << BIT_SHIFT_MACID95_64_RELEASE) -+#define BIT_CLEAR_MACID95_64_RELEASE(x) ((x) & (~BITS_MACID95_64_RELEASE)) -+#define BIT_GET_MACID95_64_RELEASE(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_RELEASE) & BIT_MASK_MACID95_64_RELEASE) -+#define BIT_SET_MACID95_64_RELEASE(x, v) \ -+ (BIT_CLEAR_MACID95_64_RELEASE(x) | BIT_MACID95_64_RELEASE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MACID_RELEASE_CTRL (Offset 0x143C) */ -+ -+#define BIT_SHIFT_MACID_RELEASE_OFFSET 0 -+#define BIT_MASK_MACID_RELEASE_OFFSET 0xff -+#define BIT_MACID_RELEASE_OFFSET(x) \ -+ (((x) & BIT_MASK_MACID_RELEASE_OFFSET) \ -+ << BIT_SHIFT_MACID_RELEASE_OFFSET) -+#define BITS_MACID_RELEASE_OFFSET \ -+ (BIT_MASK_MACID_RELEASE_OFFSET << BIT_SHIFT_MACID_RELEASE_OFFSET) -+#define BIT_CLEAR_MACID_RELEASE_OFFSET(x) ((x) & (~BITS_MACID_RELEASE_OFFSET)) -+#define BIT_GET_MACID_RELEASE_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_MACID_RELEASE_OFFSET) & \ -+ BIT_MASK_MACID_RELEASE_OFFSET) -+#define BIT_SET_MACID_RELEASE_OFFSET(x, v) \ -+ (BIT_CLEAR_MACID_RELEASE_OFFSET(x) | BIT_MACID_RELEASE_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID_RELEASE3 (Offset 0x1440) */ -+ -+#define BIT_SHIFT_MACID127_96_RELEASE 0 -+#define BIT_MASK_MACID127_96_RELEASE 0xffffffffL -+#define BIT_MACID127_96_RELEASE(x) \ -+ (((x) & BIT_MASK_MACID127_96_RELEASE) << BIT_SHIFT_MACID127_96_RELEASE) -+#define BITS_MACID127_96_RELEASE \ -+ (BIT_MASK_MACID127_96_RELEASE << BIT_SHIFT_MACID127_96_RELEASE) -+#define BIT_CLEAR_MACID127_96_RELEASE(x) ((x) & (~BITS_MACID127_96_RELEASE)) -+#define BIT_GET_MACID127_96_RELEASE(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_RELEASE) & BIT_MASK_MACID127_96_RELEASE) -+#define BIT_SET_MACID127_96_RELEASE(x, v) \ -+ (BIT_CLEAR_MACID127_96_RELEASE(x) | BIT_MACID127_96_RELEASE(v)) -+ -+/* 2 REG_MACID_RELEASE_SETTING (Offset 0x1444) */ -+ -+#define BIT_MACID_VALUE BIT(7) -+ -+#define BIT_SHIFT_MACID_OFFSET 0 -+#define BIT_MASK_MACID_OFFSET 0x7f -+#define BIT_MACID_OFFSET(x) \ -+ (((x) & BIT_MASK_MACID_OFFSET) << BIT_SHIFT_MACID_OFFSET) -+#define BITS_MACID_OFFSET (BIT_MASK_MACID_OFFSET << BIT_SHIFT_MACID_OFFSET) -+#define BIT_CLEAR_MACID_OFFSET(x) ((x) & (~BITS_MACID_OFFSET)) -+#define BIT_GET_MACID_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_MACID_OFFSET) & BIT_MASK_MACID_OFFSET) -+#define BIT_SET_MACID_OFFSET(x, v) \ -+ (BIT_CLEAR_MACID_OFFSET(x) | BIT_MACID_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FAST_EDCA_VOVI_SETTING (Offset 0x1448) */ -+ -+#define BIT_SHIFT_VI_FAST_EDCA_TO 24 -+#define BIT_MASK_VI_FAST_EDCA_TO 0xff -+#define BIT_VI_FAST_EDCA_TO(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_TO) << BIT_SHIFT_VI_FAST_EDCA_TO) -+#define BITS_VI_FAST_EDCA_TO \ -+ (BIT_MASK_VI_FAST_EDCA_TO << BIT_SHIFT_VI_FAST_EDCA_TO) -+#define BIT_CLEAR_VI_FAST_EDCA_TO(x) ((x) & (~BITS_VI_FAST_EDCA_TO)) -+#define BIT_GET_VI_FAST_EDCA_TO(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_TO) & BIT_MASK_VI_FAST_EDCA_TO) -+#define BIT_SET_VI_FAST_EDCA_TO(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_TO(x) | BIT_VI_FAST_EDCA_TO(v)) -+ -+#define BIT_VI_THRESHOLD_SEL BIT(23) -+ -+#define BIT_SHIFT_VI_FAST_EDCA_PKT_TH 16 -+#define BIT_MASK_VI_FAST_EDCA_PKT_TH 0x7f -+#define BIT_VI_FAST_EDCA_PKT_TH(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_PKT_TH) << BIT_SHIFT_VI_FAST_EDCA_PKT_TH) -+#define BITS_VI_FAST_EDCA_PKT_TH \ -+ (BIT_MASK_VI_FAST_EDCA_PKT_TH << BIT_SHIFT_VI_FAST_EDCA_PKT_TH) -+#define BIT_CLEAR_VI_FAST_EDCA_PKT_TH(x) ((x) & (~BITS_VI_FAST_EDCA_PKT_TH)) -+#define BIT_GET_VI_FAST_EDCA_PKT_TH(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_PKT_TH) & BIT_MASK_VI_FAST_EDCA_PKT_TH) -+#define BIT_SET_VI_FAST_EDCA_PKT_TH(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_PKT_TH(x) | BIT_VI_FAST_EDCA_PKT_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FAST_EDCA_VOVI_SETTING (Offset 0x1448) */ -+ -+#define BIT_SHIFT_VO_FAST_EDCA_TO 8 -+#define BIT_MASK_VO_FAST_EDCA_TO 0xff -+#define BIT_VO_FAST_EDCA_TO(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_TO) << BIT_SHIFT_VO_FAST_EDCA_TO) -+#define BITS_VO_FAST_EDCA_TO \ -+ (BIT_MASK_VO_FAST_EDCA_TO << BIT_SHIFT_VO_FAST_EDCA_TO) -+#define BIT_CLEAR_VO_FAST_EDCA_TO(x) ((x) & (~BITS_VO_FAST_EDCA_TO)) -+#define BIT_GET_VO_FAST_EDCA_TO(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_TO) & BIT_MASK_VO_FAST_EDCA_TO) -+#define BIT_SET_VO_FAST_EDCA_TO(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_TO(x) | BIT_VO_FAST_EDCA_TO(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FAST_EDCA_VOVI_SETTING (Offset 0x1448) */ -+ -+#define BIT_VO_THRESHOLD_SEL BIT(7) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_PKT_TH 0 -+#define BIT_MASK_VO_FAST_EDCA_PKT_TH 0x7f -+#define BIT_VO_FAST_EDCA_PKT_TH(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_PKT_TH) << BIT_SHIFT_VO_FAST_EDCA_PKT_TH) -+#define BITS_VO_FAST_EDCA_PKT_TH \ -+ (BIT_MASK_VO_FAST_EDCA_PKT_TH << BIT_SHIFT_VO_FAST_EDCA_PKT_TH) -+#define BIT_CLEAR_VO_FAST_EDCA_PKT_TH(x) ((x) & (~BITS_VO_FAST_EDCA_PKT_TH)) -+#define BIT_GET_VO_FAST_EDCA_PKT_TH(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_PKT_TH) & BIT_MASK_VO_FAST_EDCA_PKT_TH) -+#define BIT_SET_VO_FAST_EDCA_PKT_TH(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_PKT_TH(x) | BIT_VO_FAST_EDCA_PKT_TH(v)) -+ -+/* 2 REG_FAST_EDCA_BEBK_SETTING (Offset 0x144C) */ -+ -+#define BIT_SHIFT_BK_FAST_EDCA_TO 24 -+#define BIT_MASK_BK_FAST_EDCA_TO 0xff -+#define BIT_BK_FAST_EDCA_TO(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_TO) << BIT_SHIFT_BK_FAST_EDCA_TO) -+#define BITS_BK_FAST_EDCA_TO \ -+ (BIT_MASK_BK_FAST_EDCA_TO << BIT_SHIFT_BK_FAST_EDCA_TO) -+#define BIT_CLEAR_BK_FAST_EDCA_TO(x) ((x) & (~BITS_BK_FAST_EDCA_TO)) -+#define BIT_GET_BK_FAST_EDCA_TO(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_TO) & BIT_MASK_BK_FAST_EDCA_TO) -+#define BIT_SET_BK_FAST_EDCA_TO(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_TO(x) | BIT_BK_FAST_EDCA_TO(v)) -+ -+#define BIT_BK_THRESHOLD_SEL BIT(23) -+ -+#define BIT_SHIFT_BK_FAST_EDCA_PKT_TH 16 -+#define BIT_MASK_BK_FAST_EDCA_PKT_TH 0x7f -+#define BIT_BK_FAST_EDCA_PKT_TH(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_PKT_TH) << BIT_SHIFT_BK_FAST_EDCA_PKT_TH) -+#define BITS_BK_FAST_EDCA_PKT_TH \ -+ (BIT_MASK_BK_FAST_EDCA_PKT_TH << BIT_SHIFT_BK_FAST_EDCA_PKT_TH) -+#define BIT_CLEAR_BK_FAST_EDCA_PKT_TH(x) ((x) & (~BITS_BK_FAST_EDCA_PKT_TH)) -+#define BIT_GET_BK_FAST_EDCA_PKT_TH(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_PKT_TH) & BIT_MASK_BK_FAST_EDCA_PKT_TH) -+#define BIT_SET_BK_FAST_EDCA_PKT_TH(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_PKT_TH(x) | BIT_BK_FAST_EDCA_PKT_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FAST_EDCA_BEBK_SETTING (Offset 0x144C) */ -+ -+#define BIT_SHIFT_BE_FAST_EDCA_TO 8 -+#define BIT_MASK_BE_FAST_EDCA_TO 0xff -+#define BIT_BE_FAST_EDCA_TO(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_TO) << BIT_SHIFT_BE_FAST_EDCA_TO) -+#define BITS_BE_FAST_EDCA_TO \ -+ (BIT_MASK_BE_FAST_EDCA_TO << BIT_SHIFT_BE_FAST_EDCA_TO) -+#define BIT_CLEAR_BE_FAST_EDCA_TO(x) ((x) & (~BITS_BE_FAST_EDCA_TO)) -+#define BIT_GET_BE_FAST_EDCA_TO(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_TO) & BIT_MASK_BE_FAST_EDCA_TO) -+#define BIT_SET_BE_FAST_EDCA_TO(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_TO(x) | BIT_BE_FAST_EDCA_TO(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_FAST_EDCA_BEBK_SETTING (Offset 0x144C) */ -+ -+#define BIT_BE_THRESHOLD_SEL BIT(7) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_PKT_TH 0 -+#define BIT_MASK_BE_FAST_EDCA_PKT_TH 0x7f -+#define BIT_BE_FAST_EDCA_PKT_TH(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_PKT_TH) << BIT_SHIFT_BE_FAST_EDCA_PKT_TH) -+#define BITS_BE_FAST_EDCA_PKT_TH \ -+ (BIT_MASK_BE_FAST_EDCA_PKT_TH << BIT_SHIFT_BE_FAST_EDCA_PKT_TH) -+#define BIT_CLEAR_BE_FAST_EDCA_PKT_TH(x) ((x) & (~BITS_BE_FAST_EDCA_PKT_TH)) -+#define BIT_GET_BE_FAST_EDCA_PKT_TH(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_PKT_TH) & BIT_MASK_BE_FAST_EDCA_PKT_TH) -+#define BIT_SET_BE_FAST_EDCA_PKT_TH(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_PKT_TH(x) | BIT_BE_FAST_EDCA_PKT_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID_DROP0 (Offset 0x1450) */ -+ -+#define BIT_SHIFT_MACID31_0_DROP 0 -+#define BIT_MASK_MACID31_0_DROP 0xffffffffL -+#define BIT_MACID31_0_DROP(x) \ -+ (((x) & BIT_MASK_MACID31_0_DROP) << BIT_SHIFT_MACID31_0_DROP) -+#define BITS_MACID31_0_DROP \ -+ (BIT_MASK_MACID31_0_DROP << BIT_SHIFT_MACID31_0_DROP) -+#define BIT_CLEAR_MACID31_0_DROP(x) ((x) & (~BITS_MACID31_0_DROP)) -+#define BIT_GET_MACID31_0_DROP(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_DROP) & BIT_MASK_MACID31_0_DROP) -+#define BIT_SET_MACID31_0_DROP(x, v) \ -+ (BIT_CLEAR_MACID31_0_DROP(x) | BIT_MACID31_0_DROP(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MACID_DROP_INFO (Offset 0x1450) */ -+ -+#define BIT_SHIFT_MACID_DROP_INFO 0 -+#define BIT_MASK_MACID_DROP_INFO 0xffffffffL -+#define BIT_MACID_DROP_INFO(x) \ -+ (((x) & BIT_MASK_MACID_DROP_INFO) << BIT_SHIFT_MACID_DROP_INFO) -+#define BITS_MACID_DROP_INFO \ -+ (BIT_MASK_MACID_DROP_INFO << BIT_SHIFT_MACID_DROP_INFO) -+#define BIT_CLEAR_MACID_DROP_INFO(x) ((x) & (~BITS_MACID_DROP_INFO)) -+#define BIT_GET_MACID_DROP_INFO(x) \ -+ (((x) >> BIT_SHIFT_MACID_DROP_INFO) & BIT_MASK_MACID_DROP_INFO) -+#define BIT_SET_MACID_DROP_INFO(x, v) \ -+ (BIT_CLEAR_MACID_DROP_INFO(x) | BIT_MACID_DROP_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID_DROP1 (Offset 0x1454) */ -+ -+#define BIT_SHIFT_MACID63_32_DROP 0 -+#define BIT_MASK_MACID63_32_DROP 0xffffffffL -+#define BIT_MACID63_32_DROP(x) \ -+ (((x) & BIT_MASK_MACID63_32_DROP) << BIT_SHIFT_MACID63_32_DROP) -+#define BITS_MACID63_32_DROP \ -+ (BIT_MASK_MACID63_32_DROP << BIT_SHIFT_MACID63_32_DROP) -+#define BIT_CLEAR_MACID63_32_DROP(x) ((x) & (~BITS_MACID63_32_DROP)) -+#define BIT_GET_MACID63_32_DROP(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_DROP) & BIT_MASK_MACID63_32_DROP) -+#define BIT_SET_MACID63_32_DROP(x, v) \ -+ (BIT_CLEAR_MACID63_32_DROP(x) | BIT_MACID63_32_DROP(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MACID_DROP_CTRL (Offset 0x1454) */ -+ -+#define BIT_SHIFT_MACID_DROP_SEL 0 -+#define BIT_MASK_MACID_DROP_SEL 0x7 -+#define BIT_MACID_DROP_SEL(x) \ -+ (((x) & BIT_MASK_MACID_DROP_SEL) << BIT_SHIFT_MACID_DROP_SEL) -+#define BITS_MACID_DROP_SEL \ -+ (BIT_MASK_MACID_DROP_SEL << BIT_SHIFT_MACID_DROP_SEL) -+#define BIT_CLEAR_MACID_DROP_SEL(x) ((x) & (~BITS_MACID_DROP_SEL)) -+#define BIT_GET_MACID_DROP_SEL(x) \ -+ (((x) >> BIT_SHIFT_MACID_DROP_SEL) & BIT_MASK_MACID_DROP_SEL) -+#define BIT_SET_MACID_DROP_SEL(x, v) \ -+ (BIT_CLEAR_MACID_DROP_SEL(x) | BIT_MACID_DROP_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID_DROP2 (Offset 0x1458) */ -+ -+#define BIT_SHIFT_MACID95_64_DROP 0 -+#define BIT_MASK_MACID95_64_DROP 0xffffffffL -+#define BIT_MACID95_64_DROP(x) \ -+ (((x) & BIT_MASK_MACID95_64_DROP) << BIT_SHIFT_MACID95_64_DROP) -+#define BITS_MACID95_64_DROP \ -+ (BIT_MASK_MACID95_64_DROP << BIT_SHIFT_MACID95_64_DROP) -+#define BIT_CLEAR_MACID95_64_DROP(x) ((x) & (~BITS_MACID95_64_DROP)) -+#define BIT_GET_MACID95_64_DROP(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_DROP) & BIT_MASK_MACID95_64_DROP) -+#define BIT_SET_MACID95_64_DROP(x, v) \ -+ (BIT_CLEAR_MACID95_64_DROP(x) | BIT_MACID95_64_DROP(v)) -+ -+/* 2 REG_MACID_DROP3 (Offset 0x145C) */ -+ -+#define BIT_SHIFT_MACID127_96_DROP 0 -+#define BIT_MASK_MACID127_96_DROP 0xffffffffL -+#define BIT_MACID127_96_DROP(x) \ -+ (((x) & BIT_MASK_MACID127_96_DROP) << BIT_SHIFT_MACID127_96_DROP) -+#define BITS_MACID127_96_DROP \ -+ (BIT_MASK_MACID127_96_DROP << BIT_SHIFT_MACID127_96_DROP) -+#define BIT_CLEAR_MACID127_96_DROP(x) ((x) & (~BITS_MACID127_96_DROP)) -+#define BIT_GET_MACID127_96_DROP(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_DROP) & BIT_MASK_MACID127_96_DROP) -+#define BIT_SET_MACID127_96_DROP(x, v) \ -+ (BIT_CLEAR_MACID127_96_DROP(x) | BIT_MACID127_96_DROP(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_1 (Offset 0x1464) */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_1 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_1(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_1) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1) -+#define BITS_R_MACID_RELEASE_SUCCESS_1 \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_1 \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_1)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_1(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_1) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_1(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_1(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_3 (Offset 0x146C) */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_3 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_3(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_3) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3) -+#define BITS_R_MACID_RELEASE_SUCCESS_3 \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_3 \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_3)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_3(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_3) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_3(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_3(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MGG_FIFO_CRTL (Offset 0x1470) */ -+ -+#define BIT_R_MGG_FIFO_EN BIT(31) -+ -+#define BIT_SHIFT_R_MGG_FIFO_PG_SIZE 28 -+#define BIT_MASK_R_MGG_FIFO_PG_SIZE 0x7 -+#define BIT_R_MGG_FIFO_PG_SIZE(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_PG_SIZE) << BIT_SHIFT_R_MGG_FIFO_PG_SIZE) -+#define BITS_R_MGG_FIFO_PG_SIZE \ -+ (BIT_MASK_R_MGG_FIFO_PG_SIZE << BIT_SHIFT_R_MGG_FIFO_PG_SIZE) -+#define BIT_CLEAR_R_MGG_FIFO_PG_SIZE(x) ((x) & (~BITS_R_MGG_FIFO_PG_SIZE)) -+#define BIT_GET_R_MGG_FIFO_PG_SIZE(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_PG_SIZE) & BIT_MASK_R_MGG_FIFO_PG_SIZE) -+#define BIT_SET_R_MGG_FIFO_PG_SIZE(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_PG_SIZE(x) | BIT_R_MGG_FIFO_PG_SIZE(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_START_PG 16 -+#define BIT_MASK_R_MGG_FIFO_START_PG 0xfff -+#define BIT_R_MGG_FIFO_START_PG(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_START_PG) << BIT_SHIFT_R_MGG_FIFO_START_PG) -+#define BITS_R_MGG_FIFO_START_PG \ -+ (BIT_MASK_R_MGG_FIFO_START_PG << BIT_SHIFT_R_MGG_FIFO_START_PG) -+#define BIT_CLEAR_R_MGG_FIFO_START_PG(x) ((x) & (~BITS_R_MGG_FIFO_START_PG)) -+#define BIT_GET_R_MGG_FIFO_START_PG(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_START_PG) & BIT_MASK_R_MGG_FIFO_START_PG) -+#define BIT_SET_R_MGG_FIFO_START_PG(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_START_PG(x) | BIT_R_MGG_FIFO_START_PG(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_SIZE 14 -+#define BIT_MASK_R_MGG_FIFO_SIZE 0x3 -+#define BIT_R_MGG_FIFO_SIZE(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_SIZE) << BIT_SHIFT_R_MGG_FIFO_SIZE) -+#define BITS_R_MGG_FIFO_SIZE \ -+ (BIT_MASK_R_MGG_FIFO_SIZE << BIT_SHIFT_R_MGG_FIFO_SIZE) -+#define BIT_CLEAR_R_MGG_FIFO_SIZE(x) ((x) & (~BITS_R_MGG_FIFO_SIZE)) -+#define BIT_GET_R_MGG_FIFO_SIZE(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_SIZE) & BIT_MASK_R_MGG_FIFO_SIZE) -+#define BIT_SET_R_MGG_FIFO_SIZE(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_SIZE(x) | BIT_R_MGG_FIFO_SIZE(v)) -+ -+#define BIT_R_MGG_FIFO_PAUSE BIT(13) -+ -+#define BIT_SHIFT_R_MGG_FIFO_RPTR 8 -+#define BIT_MASK_R_MGG_FIFO_RPTR 0x1f -+#define BIT_R_MGG_FIFO_RPTR(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_RPTR) << BIT_SHIFT_R_MGG_FIFO_RPTR) -+#define BITS_R_MGG_FIFO_RPTR \ -+ (BIT_MASK_R_MGG_FIFO_RPTR << BIT_SHIFT_R_MGG_FIFO_RPTR) -+#define BIT_CLEAR_R_MGG_FIFO_RPTR(x) ((x) & (~BITS_R_MGG_FIFO_RPTR)) -+#define BIT_GET_R_MGG_FIFO_RPTR(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_RPTR) & BIT_MASK_R_MGG_FIFO_RPTR) -+#define BIT_SET_R_MGG_FIFO_RPTR(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_RPTR(x) | BIT_R_MGG_FIFO_RPTR(v)) -+ -+#define BIT_R_MGG_FIFO_OV BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_FIFO_WRITE_POINTER (Offset 0x1470) */ -+ -+#define BIT_MGQ_FIFO_OV BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MGG_FIFO_CRTL (Offset 0x1470) */ -+ -+#define BIT_R_MGG_FIFO_WPTR_ERROR BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_FIFO_WRITE_POINTER (Offset 0x1470) */ -+ -+#define BIT_MGQ_FIFO_WPTR_ERROR BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MGG_FIFO_CRTL (Offset 0x1470) */ -+ -+#define BIT_R_EN_CPU_LIFETIME BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_FIFO_WRITE_POINTER (Offset 0x1470) */ -+ -+#define BIT_EN_MGQ_FIFO_LIFETIME BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MGG_FIFO_CRTL (Offset 0x1470) */ -+ -+#define BIT_SHIFT_R_MGG_FIFO_WPTR 0 -+#define BIT_MASK_R_MGG_FIFO_WPTR 0x1f -+#define BIT_R_MGG_FIFO_WPTR(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_WPTR) << BIT_SHIFT_R_MGG_FIFO_WPTR) -+#define BITS_R_MGG_FIFO_WPTR \ -+ (BIT_MASK_R_MGG_FIFO_WPTR << BIT_SHIFT_R_MGG_FIFO_WPTR) -+#define BIT_CLEAR_R_MGG_FIFO_WPTR(x) ((x) & (~BITS_R_MGG_FIFO_WPTR)) -+#define BIT_GET_R_MGG_FIFO_WPTR(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_WPTR) & BIT_MASK_R_MGG_FIFO_WPTR) -+#define BIT_SET_R_MGG_FIFO_WPTR(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_WPTR(x) | BIT_R_MGG_FIFO_WPTR(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_FIFO_WRITE_POINTER (Offset 0x1470) */ -+ -+#define BIT_SHIFT_MGQ_FIFO_WPTR 0 -+#define BIT_MASK_MGQ_FIFO_WPTR 0x1f -+#define BIT_MGQ_FIFO_WPTR(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_WPTR) << BIT_SHIFT_MGQ_FIFO_WPTR) -+#define BITS_MGQ_FIFO_WPTR (BIT_MASK_MGQ_FIFO_WPTR << BIT_SHIFT_MGQ_FIFO_WPTR) -+#define BIT_CLEAR_MGQ_FIFO_WPTR(x) ((x) & (~BITS_MGQ_FIFO_WPTR)) -+#define BIT_GET_MGQ_FIFO_WPTR(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_WPTR) & BIT_MASK_MGQ_FIFO_WPTR) -+#define BIT_SET_MGQ_FIFO_WPTR(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_WPTR(x) | BIT_MGQ_FIFO_WPTR(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_FIFO_ENABLE (Offset 0x1472) */ -+ -+#define BIT_MGQ_FIFO_EN BIT(15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MGQ_FIFO_ENABLE (Offset 0x1472) */ -+ -+#define BIT_MGQ_FIFO_EN_V1 BIT(15) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_FIFO_READ_POINTER (Offset 0x1472) */ -+ -+#define BIT_SHIFT_MGQ_FIFO_SIZE 14 -+#define BIT_MASK_MGQ_FIFO_SIZE 0x3 -+#define BIT_MGQ_FIFO_SIZE(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_SIZE) << BIT_SHIFT_MGQ_FIFO_SIZE) -+#define BITS_MGQ_FIFO_SIZE (BIT_MASK_MGQ_FIFO_SIZE << BIT_SHIFT_MGQ_FIFO_SIZE) -+#define BIT_CLEAR_MGQ_FIFO_SIZE(x) ((x) & (~BITS_MGQ_FIFO_SIZE)) -+#define BIT_GET_MGQ_FIFO_SIZE(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_SIZE) & BIT_MASK_MGQ_FIFO_SIZE) -+#define BIT_SET_MGQ_FIFO_SIZE(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_SIZE(x) | BIT_MGQ_FIFO_SIZE(v)) -+ -+#define BIT_MGQ_FIFO_PAUSE BIT(13) -+ -+#define BIT_SHIFT_MGQ_FIFO_PG_SIZE 12 -+#define BIT_MASK_MGQ_FIFO_PG_SIZE 0x7 -+#define BIT_MGQ_FIFO_PG_SIZE(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_PG_SIZE) << BIT_SHIFT_MGQ_FIFO_PG_SIZE) -+#define BITS_MGQ_FIFO_PG_SIZE \ -+ (BIT_MASK_MGQ_FIFO_PG_SIZE << BIT_SHIFT_MGQ_FIFO_PG_SIZE) -+#define BIT_CLEAR_MGQ_FIFO_PG_SIZE(x) ((x) & (~BITS_MGQ_FIFO_PG_SIZE)) -+#define BIT_GET_MGQ_FIFO_PG_SIZE(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_PG_SIZE) & BIT_MASK_MGQ_FIFO_PG_SIZE) -+#define BIT_SET_MGQ_FIFO_PG_SIZE(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_PG_SIZE(x) | BIT_MGQ_FIFO_PG_SIZE(v)) -+ -+#define BIT_SHIFT_MGQ_FIFO_RPTR 8 -+#define BIT_MASK_MGQ_FIFO_RPTR 0x1f -+#define BIT_MGQ_FIFO_RPTR(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_RPTR) << BIT_SHIFT_MGQ_FIFO_RPTR) -+#define BITS_MGQ_FIFO_RPTR (BIT_MASK_MGQ_FIFO_RPTR << BIT_SHIFT_MGQ_FIFO_RPTR) -+#define BIT_CLEAR_MGQ_FIFO_RPTR(x) ((x) & (~BITS_MGQ_FIFO_RPTR)) -+#define BIT_GET_MGQ_FIFO_RPTR(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_RPTR) & BIT_MASK_MGQ_FIFO_RPTR) -+#define BIT_SET_MGQ_FIFO_RPTR(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_RPTR(x) | BIT_MGQ_FIFO_RPTR(v)) -+ -+#define BIT_SHIFT_MGQ_FIFO_START_PG 0 -+#define BIT_MASK_MGQ_FIFO_START_PG 0xfff -+#define BIT_MGQ_FIFO_START_PG(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_START_PG) << BIT_SHIFT_MGQ_FIFO_START_PG) -+#define BITS_MGQ_FIFO_START_PG \ -+ (BIT_MASK_MGQ_FIFO_START_PG << BIT_SHIFT_MGQ_FIFO_START_PG) -+#define BIT_CLEAR_MGQ_FIFO_START_PG(x) ((x) & (~BITS_MGQ_FIFO_START_PG)) -+#define BIT_GET_MGQ_FIFO_START_PG(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_START_PG) & BIT_MASK_MGQ_FIFO_START_PG) -+#define BIT_SET_MGQ_FIFO_START_PG(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_START_PG(x) | BIT_MGQ_FIFO_START_PG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MGG_FIFO_INT (Offset 0x1474) */ -+ -+#define BIT_SHIFT_R_MGG_FIFO_INT_FLAG 16 -+#define BIT_MASK_R_MGG_FIFO_INT_FLAG 0xffff -+#define BIT_R_MGG_FIFO_INT_FLAG(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_INT_FLAG) << BIT_SHIFT_R_MGG_FIFO_INT_FLAG) -+#define BITS_R_MGG_FIFO_INT_FLAG \ -+ (BIT_MASK_R_MGG_FIFO_INT_FLAG << BIT_SHIFT_R_MGG_FIFO_INT_FLAG) -+#define BIT_CLEAR_R_MGG_FIFO_INT_FLAG(x) ((x) & (~BITS_R_MGG_FIFO_INT_FLAG)) -+#define BIT_GET_R_MGG_FIFO_INT_FLAG(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_INT_FLAG) & BIT_MASK_R_MGG_FIFO_INT_FLAG) -+#define BIT_SET_R_MGG_FIFO_INT_FLAG(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_INT_FLAG(x) | BIT_R_MGG_FIFO_INT_FLAG(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_INT_MASK 0 -+#define BIT_MASK_R_MGG_FIFO_INT_MASK 0xffff -+#define BIT_R_MGG_FIFO_INT_MASK(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_INT_MASK) << BIT_SHIFT_R_MGG_FIFO_INT_MASK) -+#define BITS_R_MGG_FIFO_INT_MASK \ -+ (BIT_MASK_R_MGG_FIFO_INT_MASK << BIT_SHIFT_R_MGG_FIFO_INT_MASK) -+#define BIT_CLEAR_R_MGG_FIFO_INT_MASK(x) ((x) & (~BITS_R_MGG_FIFO_INT_MASK)) -+#define BIT_GET_R_MGG_FIFO_INT_MASK(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_INT_MASK) & BIT_MASK_R_MGG_FIFO_INT_MASK) -+#define BIT_SET_R_MGG_FIFO_INT_MASK(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_INT_MASK(x) | BIT_R_MGG_FIFO_INT_MASK(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_FIFO_RELEASE_INT_MASK (Offset 0x1474) */ -+ -+#define BIT_SHIFT_MGQ_FIFO_REL_INT_MASK 0 -+#define BIT_MASK_MGQ_FIFO_REL_INT_MASK 0xffff -+#define BIT_MGQ_FIFO_REL_INT_MASK(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_REL_INT_MASK) \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_MASK) -+#define BITS_MGQ_FIFO_REL_INT_MASK \ -+ (BIT_MASK_MGQ_FIFO_REL_INT_MASK << BIT_SHIFT_MGQ_FIFO_REL_INT_MASK) -+#define BIT_CLEAR_MGQ_FIFO_REL_INT_MASK(x) ((x) & (~BITS_MGQ_FIFO_REL_INT_MASK)) -+#define BIT_GET_MGQ_FIFO_REL_INT_MASK(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_REL_INT_MASK) & \ -+ BIT_MASK_MGQ_FIFO_REL_INT_MASK) -+#define BIT_SET_MGQ_FIFO_REL_INT_MASK(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_REL_INT_MASK(x) | BIT_MGQ_FIFO_REL_INT_MASK(v)) -+ -+/* 2 REG_MGQ_FIFO_RELEASE_INT_FLAG (Offset 0x1476) */ -+ -+#define BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG 0 -+#define BIT_MASK_MGQ_FIFO_REL_INT_FLAG 0xffff -+#define BIT_MGQ_FIFO_REL_INT_FLAG(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_REL_INT_FLAG) \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG) -+#define BITS_MGQ_FIFO_REL_INT_FLAG \ -+ (BIT_MASK_MGQ_FIFO_REL_INT_FLAG << BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG) -+#define BIT_CLEAR_MGQ_FIFO_REL_INT_FLAG(x) ((x) & (~BITS_MGQ_FIFO_REL_INT_FLAG)) -+#define BIT_GET_MGQ_FIFO_REL_INT_FLAG(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG) & \ -+ BIT_MASK_MGQ_FIFO_REL_INT_FLAG) -+#define BIT_SET_MGQ_FIFO_REL_INT_FLAG(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_REL_INT_FLAG(x) | BIT_MGQ_FIFO_REL_INT_FLAG(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MGG_FIFO_LIFETIME (Offset 0x1478) */ -+ -+#define BIT_SHIFT_R_MGG_FIFO_LIFETIME 16 -+#define BIT_MASK_R_MGG_FIFO_LIFETIME 0xffff -+#define BIT_R_MGG_FIFO_LIFETIME(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_LIFETIME) << BIT_SHIFT_R_MGG_FIFO_LIFETIME) -+#define BITS_R_MGG_FIFO_LIFETIME \ -+ (BIT_MASK_R_MGG_FIFO_LIFETIME << BIT_SHIFT_R_MGG_FIFO_LIFETIME) -+#define BIT_CLEAR_R_MGG_FIFO_LIFETIME(x) ((x) & (~BITS_R_MGG_FIFO_LIFETIME)) -+#define BIT_GET_R_MGG_FIFO_LIFETIME(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_LIFETIME) & BIT_MASK_R_MGG_FIFO_LIFETIME) -+#define BIT_SET_R_MGG_FIFO_LIFETIME(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_LIFETIME(x) | BIT_R_MGG_FIFO_LIFETIME(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_VALID_MAP 0 -+#define BIT_MASK_R_MGG_FIFO_VALID_MAP 0xffff -+#define BIT_R_MGG_FIFO_VALID_MAP(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_VALID_MAP) \ -+ << BIT_SHIFT_R_MGG_FIFO_VALID_MAP) -+#define BITS_R_MGG_FIFO_VALID_MAP \ -+ (BIT_MASK_R_MGG_FIFO_VALID_MAP << BIT_SHIFT_R_MGG_FIFO_VALID_MAP) -+#define BIT_CLEAR_R_MGG_FIFO_VALID_MAP(x) ((x) & (~BITS_R_MGG_FIFO_VALID_MAP)) -+#define BIT_GET_R_MGG_FIFO_VALID_MAP(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_VALID_MAP) & \ -+ BIT_MASK_R_MGG_FIFO_VALID_MAP) -+#define BIT_SET_R_MGG_FIFO_VALID_MAP(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_VALID_MAP(x) | BIT_R_MGG_FIFO_VALID_MAP(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MGQ_FIFO_VALID_MAP (Offset 0x1478) */ -+ -+#define BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP 0 -+#define BIT_MASK_MGQ_FIFO_PKT_VALID_MAP 0xffff -+#define BIT_MGQ_FIFO_PKT_VALID_MAP(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_PKT_VALID_MAP) \ -+ << BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP) -+#define BITS_MGQ_FIFO_PKT_VALID_MAP \ -+ (BIT_MASK_MGQ_FIFO_PKT_VALID_MAP << BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP) -+#define BIT_CLEAR_MGQ_FIFO_PKT_VALID_MAP(x) \ -+ ((x) & (~BITS_MGQ_FIFO_PKT_VALID_MAP)) -+#define BIT_GET_MGQ_FIFO_PKT_VALID_MAP(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP) & \ -+ BIT_MASK_MGQ_FIFO_PKT_VALID_MAP) -+#define BIT_SET_MGQ_FIFO_PKT_VALID_MAP(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_PKT_VALID_MAP(x) | BIT_MGQ_FIFO_PKT_VALID_MAP(v)) -+ -+/* 2 REG_MGQ_FIFO_LIFETIME (Offset 0x147A) */ -+ -+#define BIT_RPT_VALID BIT(13) -+ -+#define BIT_SHIFT_MGQ_FIFO_LIFETIME 0 -+#define BIT_MASK_MGQ_FIFO_LIFETIME 0xffff -+#define BIT_MGQ_FIFO_LIFETIME(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_LIFETIME) << BIT_SHIFT_MGQ_FIFO_LIFETIME) -+#define BITS_MGQ_FIFO_LIFETIME \ -+ (BIT_MASK_MGQ_FIFO_LIFETIME << BIT_SHIFT_MGQ_FIFO_LIFETIME) -+#define BIT_CLEAR_MGQ_FIFO_LIFETIME(x) ((x) & (~BITS_MGQ_FIFO_LIFETIME)) -+#define BIT_GET_MGQ_FIFO_LIFETIME(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_LIFETIME) & BIT_MASK_MGQ_FIFO_LIFETIME) -+#define BIT_SET_MGQ_FIFO_LIFETIME(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_LIFETIME(x) | BIT_MGQ_FIFO_LIFETIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET (Offset 0x147C) */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET 0x7f -+#define BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET) -+#define BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PKT_TRANS (Offset 0x1480) */ -+ -+#define BIT_SHIFT_IE_DESC_OFFSET 16 -+#define BIT_MASK_IE_DESC_OFFSET 0x1ff -+#define BIT_IE_DESC_OFFSET(x) \ -+ (((x) & BIT_MASK_IE_DESC_OFFSET) << BIT_SHIFT_IE_DESC_OFFSET) -+#define BITS_IE_DESC_OFFSET \ -+ (BIT_MASK_IE_DESC_OFFSET << BIT_SHIFT_IE_DESC_OFFSET) -+#define BIT_CLEAR_IE_DESC_OFFSET(x) ((x) & (~BITS_IE_DESC_OFFSET)) -+#define BIT_GET_IE_DESC_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_IE_DESC_OFFSET) & BIT_MASK_IE_DESC_OFFSET) -+#define BIT_SET_IE_DESC_OFFSET(x, v) \ -+ (BIT_CLEAR_IE_DESC_OFFSET(x) | BIT_IE_DESC_OFFSET(v)) -+ -+#define BIT_DIS_FWCMD_PATH_ERRCHK BIT(13) -+#define BIT_MAC_HDR_CONVERT_EN BIT(12) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SHCUT_SETTING (Offset 0x1480) */ -+ -+#define BIT_SHCUT_LLC_WR_LOCK BIT(11) -+#define BIT_SHCUT_ENABLE_LLC_CONV BIT(10) -+#define BIT_SHCUT_PARSE_DASA_2 BIT(9) -+#define BIT_SHCUT_BYPASS_2 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PKT_TRANS (Offset 0x1480) */ -+ -+#define BIT_TXDESC_TRANS_EN BIT(8) -+#define BIT_PKT_TRANS_ERRINT_EN BIT(7) -+ -+#define BIT_SHIFT_PKT_TRANS_ERR_MACID_SEL 4 -+#define BIT_MASK_PKT_TRANS_ERR_MACID_SEL 0x3 -+#define BIT_PKT_TRANS_ERR_MACID_SEL(x) \ -+ (((x) & BIT_MASK_PKT_TRANS_ERR_MACID_SEL) \ -+ << BIT_SHIFT_PKT_TRANS_ERR_MACID_SEL) -+#define BITS_PKT_TRANS_ERR_MACID_SEL \ -+ (BIT_MASK_PKT_TRANS_ERR_MACID_SEL << BIT_SHIFT_PKT_TRANS_ERR_MACID_SEL) -+#define BIT_CLEAR_PKT_TRANS_ERR_MACID_SEL(x) \ -+ ((x) & (~BITS_PKT_TRANS_ERR_MACID_SEL)) -+#define BIT_GET_PKT_TRANS_ERR_MACID_SEL(x) \ -+ (((x) >> BIT_SHIFT_PKT_TRANS_ERR_MACID_SEL) & \ -+ BIT_MASK_PKT_TRANS_ERR_MACID_SEL) -+#define BIT_SET_PKT_TRANS_ERR_MACID_SEL(x, v) \ -+ (BIT_CLEAR_PKT_TRANS_ERR_MACID_SEL(x) | BIT_PKT_TRANS_ERR_MACID_SEL(v)) -+ -+#define BIT_PKT_TRANS_IEINIT_ERR BIT(3) -+#define BIT_PKT_TRANS_IENUM_ERR BIT(2) -+#define BIT_PKT_TRANS_IECNT_ERR1 BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SHCUT_SETTING (Offset 0x1480) */ -+ -+#define BIT_SHIFT_SHCUT_MACID_OFFSET 0 -+#define BIT_MASK_SHCUT_MACID_OFFSET 0xff -+#define BIT_SHCUT_MACID_OFFSET(x) \ -+ (((x) & BIT_MASK_SHCUT_MACID_OFFSET) << BIT_SHIFT_SHCUT_MACID_OFFSET) -+#define BITS_SHCUT_MACID_OFFSET \ -+ (BIT_MASK_SHCUT_MACID_OFFSET << BIT_SHIFT_SHCUT_MACID_OFFSET) -+#define BIT_CLEAR_SHCUT_MACID_OFFSET(x) ((x) & (~BITS_SHCUT_MACID_OFFSET)) -+#define BIT_GET_SHCUT_MACID_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_SHCUT_MACID_OFFSET) & BIT_MASK_SHCUT_MACID_OFFSET) -+#define BIT_SET_SHCUT_MACID_OFFSET(x, v) \ -+ (BIT_CLEAR_SHCUT_MACID_OFFSET(x) | BIT_SHCUT_MACID_OFFSET(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PKT_TRANS (Offset 0x1480) */ -+ -+#define BIT_PKT_TRANS_IECNT_ERR0 BIT(0) -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE1 (Offset 0x1488) */ -+ -+#define BIT_SHIFT_SHCUT_MHDR_OFFSET 16 -+#define BIT_MASK_SHCUT_MHDR_OFFSET 0x1ff -+#define BIT_SHCUT_MHDR_OFFSET(x) \ -+ (((x) & BIT_MASK_SHCUT_MHDR_OFFSET) << BIT_SHIFT_SHCUT_MHDR_OFFSET) -+#define BITS_SHCUT_MHDR_OFFSET \ -+ (BIT_MASK_SHCUT_MHDR_OFFSET << BIT_SHIFT_SHCUT_MHDR_OFFSET) -+#define BIT_CLEAR_SHCUT_MHDR_OFFSET(x) ((x) & (~BITS_SHCUT_MHDR_OFFSET)) -+#define BIT_GET_SHCUT_MHDR_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_SHCUT_MHDR_OFFSET) & BIT_MASK_SHCUT_MHDR_OFFSET) -+#define BIT_SET_SHCUT_MHDR_OFFSET(x, v) \ -+ (BIT_CLEAR_SHCUT_MHDR_OFFSET(x) | BIT_SHCUT_MHDR_OFFSET(v)) -+ -+#define BIT_SHIFT_PKT_TRANS_ERR_MACID 0 -+#define BIT_MASK_PKT_TRANS_ERR_MACID 0xffffffffL -+#define BIT_PKT_TRANS_ERR_MACID(x) \ -+ (((x) & BIT_MASK_PKT_TRANS_ERR_MACID) << BIT_SHIFT_PKT_TRANS_ERR_MACID) -+#define BITS_PKT_TRANS_ERR_MACID \ -+ (BIT_MASK_PKT_TRANS_ERR_MACID << BIT_SHIFT_PKT_TRANS_ERR_MACID) -+#define BIT_CLEAR_PKT_TRANS_ERR_MACID(x) ((x) & (~BITS_PKT_TRANS_ERR_MACID)) -+#define BIT_GET_PKT_TRANS_ERR_MACID(x) \ -+ (((x) >> BIT_SHIFT_PKT_TRANS_ERR_MACID) & BIT_MASK_PKT_TRANS_ERR_MACID) -+#define BIT_SET_PKT_TRANS_ERR_MACID(x, v) \ -+ (BIT_CLEAR_PKT_TRANS_ERR_MACID(x) | BIT_PKT_TRANS_ERR_MACID(v)) -+ -+/* 2 REG_FWCMDQ_CTRL (Offset 0x14A0) */ -+ -+#define BIT_FW_RELEASEPKT_POLLING BIT(31) -+ -+#define BIT_SHIFT_FWCMDQ_RELEASE_HEAD 16 -+#define BIT_MASK_FWCMDQ_RELEASE_HEAD 0xfff -+#define BIT_FWCMDQ_RELEASE_HEAD(x) \ -+ (((x) & BIT_MASK_FWCMDQ_RELEASE_HEAD) << BIT_SHIFT_FWCMDQ_RELEASE_HEAD) -+#define BITS_FWCMDQ_RELEASE_HEAD \ -+ (BIT_MASK_FWCMDQ_RELEASE_HEAD << BIT_SHIFT_FWCMDQ_RELEASE_HEAD) -+#define BIT_CLEAR_FWCMDQ_RELEASE_HEAD(x) ((x) & (~BITS_FWCMDQ_RELEASE_HEAD)) -+#define BIT_GET_FWCMDQ_RELEASE_HEAD(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_RELEASE_HEAD) & BIT_MASK_FWCMDQ_RELEASE_HEAD) -+#define BIT_SET_FWCMDQ_RELEASE_HEAD(x, v) \ -+ (BIT_CLEAR_FWCMDQ_RELEASE_HEAD(x) | BIT_FWCMDQ_RELEASE_HEAD(v)) -+ -+#define BIT_FW_GETPKTT_POLLING BIT(15) -+ -+#define BIT_SHIFT_FWCMDQ_H 0 -+#define BIT_MASK_FWCMDQ_H 0xfff -+#define BIT_FWCMDQ_H(x) (((x) & BIT_MASK_FWCMDQ_H) << BIT_SHIFT_FWCMDQ_H) -+#define BITS_FWCMDQ_H (BIT_MASK_FWCMDQ_H << BIT_SHIFT_FWCMDQ_H) -+#define BIT_CLEAR_FWCMDQ_H(x) ((x) & (~BITS_FWCMDQ_H)) -+#define BIT_GET_FWCMDQ_H(x) (((x) >> BIT_SHIFT_FWCMDQ_H) & BIT_MASK_FWCMDQ_H) -+#define BIT_SET_FWCMDQ_H(x, v) (BIT_CLEAR_FWCMDQ_H(x) | BIT_FWCMDQ_H(v)) -+ -+/* 2 REG_FWCMDQ_PAGE (Offset 0x14A4) */ -+ -+#define BIT_SHIFT_FWCMDQ_TOTAL_PAGE 16 -+#define BIT_MASK_FWCMDQ_TOTAL_PAGE 0xfff -+#define BIT_FWCMDQ_TOTAL_PAGE(x) \ -+ (((x) & BIT_MASK_FWCMDQ_TOTAL_PAGE) << BIT_SHIFT_FWCMDQ_TOTAL_PAGE) -+#define BITS_FWCMDQ_TOTAL_PAGE \ -+ (BIT_MASK_FWCMDQ_TOTAL_PAGE << BIT_SHIFT_FWCMDQ_TOTAL_PAGE) -+#define BIT_CLEAR_FWCMDQ_TOTAL_PAGE(x) ((x) & (~BITS_FWCMDQ_TOTAL_PAGE)) -+#define BIT_GET_FWCMDQ_TOTAL_PAGE(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_TOTAL_PAGE) & BIT_MASK_FWCMDQ_TOTAL_PAGE) -+#define BIT_SET_FWCMDQ_TOTAL_PAGE(x, v) \ -+ (BIT_CLEAR_FWCMDQ_TOTAL_PAGE(x) | BIT_FWCMDQ_TOTAL_PAGE(v)) -+ -+#define BIT_SHIFT_FWCMDQ_QUEUE_PAGE 0 -+#define BIT_MASK_FWCMDQ_QUEUE_PAGE 0xfff -+#define BIT_FWCMDQ_QUEUE_PAGE(x) \ -+ (((x) & BIT_MASK_FWCMDQ_QUEUE_PAGE) << BIT_SHIFT_FWCMDQ_QUEUE_PAGE) -+#define BITS_FWCMDQ_QUEUE_PAGE \ -+ (BIT_MASK_FWCMDQ_QUEUE_PAGE << BIT_SHIFT_FWCMDQ_QUEUE_PAGE) -+#define BIT_CLEAR_FWCMDQ_QUEUE_PAGE(x) ((x) & (~BITS_FWCMDQ_QUEUE_PAGE)) -+#define BIT_GET_FWCMDQ_QUEUE_PAGE(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_QUEUE_PAGE) & BIT_MASK_FWCMDQ_QUEUE_PAGE) -+#define BIT_SET_FWCMDQ_QUEUE_PAGE(x, v) \ -+ (BIT_CLEAR_FWCMDQ_QUEUE_PAGE(x) | BIT_FWCMDQ_QUEUE_PAGE(v)) -+ -+/* 2 REG_FWCMDQ_INFO (Offset 0x14A8) */ -+ -+#define BIT_FWCMD_READY BIT(31) -+#define BIT_FWCMDQ_OVERFLOW BIT(30) -+#define BIT_FWCMDQ_UNDERFLOW BIT(29) -+#define BIT_FWCMDQ_RELEASE_MISS BIT(28) -+ -+#define BIT_SHIFT_FWCMDQ_TOTAL_PKT 16 -+#define BIT_MASK_FWCMDQ_TOTAL_PKT 0xfff -+#define BIT_FWCMDQ_TOTAL_PKT(x) \ -+ (((x) & BIT_MASK_FWCMDQ_TOTAL_PKT) << BIT_SHIFT_FWCMDQ_TOTAL_PKT) -+#define BITS_FWCMDQ_TOTAL_PKT \ -+ (BIT_MASK_FWCMDQ_TOTAL_PKT << BIT_SHIFT_FWCMDQ_TOTAL_PKT) -+#define BIT_CLEAR_FWCMDQ_TOTAL_PKT(x) ((x) & (~BITS_FWCMDQ_TOTAL_PKT)) -+#define BIT_GET_FWCMDQ_TOTAL_PKT(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_TOTAL_PKT) & BIT_MASK_FWCMDQ_TOTAL_PKT) -+#define BIT_SET_FWCMDQ_TOTAL_PKT(x, v) \ -+ (BIT_CLEAR_FWCMDQ_TOTAL_PKT(x) | BIT_FWCMDQ_TOTAL_PKT(v)) -+ -+#define BIT_SHIFT_FWCMDQ_QUEUE_PKT 0 -+#define BIT_MASK_FWCMDQ_QUEUE_PKT 0xfff -+#define BIT_FWCMDQ_QUEUE_PKT(x) \ -+ (((x) & BIT_MASK_FWCMDQ_QUEUE_PKT) << BIT_SHIFT_FWCMDQ_QUEUE_PKT) -+#define BITS_FWCMDQ_QUEUE_PKT \ -+ (BIT_MASK_FWCMDQ_QUEUE_PKT << BIT_SHIFT_FWCMDQ_QUEUE_PKT) -+#define BIT_CLEAR_FWCMDQ_QUEUE_PKT(x) ((x) & (~BITS_FWCMDQ_QUEUE_PKT)) -+#define BIT_GET_FWCMDQ_QUEUE_PKT(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_QUEUE_PKT) & BIT_MASK_FWCMDQ_QUEUE_PKT) -+#define BIT_SET_FWCMDQ_QUEUE_PKT(x, v) \ -+ (BIT_CLEAR_FWCMDQ_QUEUE_PKT(x) | BIT_FWCMDQ_QUEUE_PKT(v)) -+ -+/* 2 REG_FWCMDQ_HOLD_PKTNUM (Offset 0x14AC) */ -+ -+#define BIT_SHIFT_FWCMDQ_HOLD__PKTNUM 0 -+#define BIT_MASK_FWCMDQ_HOLD__PKTNUM 0xfff -+#define BIT_FWCMDQ_HOLD__PKTNUM(x) \ -+ (((x) & BIT_MASK_FWCMDQ_HOLD__PKTNUM) << BIT_SHIFT_FWCMDQ_HOLD__PKTNUM) -+#define BITS_FWCMDQ_HOLD__PKTNUM \ -+ (BIT_MASK_FWCMDQ_HOLD__PKTNUM << BIT_SHIFT_FWCMDQ_HOLD__PKTNUM) -+#define BIT_CLEAR_FWCMDQ_HOLD__PKTNUM(x) ((x) & (~BITS_FWCMDQ_HOLD__PKTNUM)) -+#define BIT_GET_FWCMDQ_HOLD__PKTNUM(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_HOLD__PKTNUM) & BIT_MASK_FWCMDQ_HOLD__PKTNUM) -+#define BIT_SET_FWCMDQ_HOLD__PKTNUM(x, v) \ -+ (BIT_CLEAR_FWCMDQ_HOLD__PKTNUM(x) | BIT_FWCMDQ_HOLD__PKTNUM(v)) -+ -+/* 2 REG_MU_TX_CTRL (Offset 0x14C0) */ -+ -+#define BIT_SEARCH_DONE_RDY BIT(31) -+#define BIT_MU_EN BIT(30) -+#define BIT_MU_SECONDARY_WAITMODE_EN BIT(29) -+#define BIT_MU_BB_SCORE_EN BIT(28) -+#define BIT_MU_SECONDARY_ANT_COUNT_EN BIT(27) -+#define BIT_MUARB_SEARCH_ERR_EN BIT(26) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_TX_CTL (Offset 0x14C0) */ -+ -+#define BIT_R_MU_P1_WAIT_STATE_EN BIT(16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_TX_CTRL (Offset 0x14C0) */ -+ -+#define BIT_SHIFT_DIS_SU_TXBF 16 -+#define BIT_MASK_DIS_SU_TXBF 0x3f -+#define BIT_DIS_SU_TXBF(x) \ -+ (((x) & BIT_MASK_DIS_SU_TXBF) << BIT_SHIFT_DIS_SU_TXBF) -+#define BITS_DIS_SU_TXBF (BIT_MASK_DIS_SU_TXBF << BIT_SHIFT_DIS_SU_TXBF) -+#define BIT_CLEAR_DIS_SU_TXBF(x) ((x) & (~BITS_DIS_SU_TXBF)) -+#define BIT_GET_DIS_SU_TXBF(x) \ -+ (((x) >> BIT_SHIFT_DIS_SU_TXBF) & BIT_MASK_DIS_SU_TXBF) -+#define BIT_SET_DIS_SU_TXBF(x, v) \ -+ (BIT_CLEAR_DIS_SU_TXBF(x) | BIT_DIS_SU_TXBF(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_TX_CTL (Offset 0x14C0) */ -+ -+#define BIT_SHIFT_R_MU_RL 12 -+#define BIT_MASK_R_MU_RL 0xf -+#define BIT_R_MU_RL(x) (((x) & BIT_MASK_R_MU_RL) << BIT_SHIFT_R_MU_RL) -+#define BITS_R_MU_RL (BIT_MASK_R_MU_RL << BIT_SHIFT_R_MU_RL) -+#define BIT_CLEAR_R_MU_RL(x) ((x) & (~BITS_R_MU_RL)) -+#define BIT_GET_R_MU_RL(x) (((x) >> BIT_SHIFT_R_MU_RL) & BIT_MASK_R_MU_RL) -+#define BIT_SET_R_MU_RL(x, v) (BIT_CLEAR_R_MU_RL(x) | BIT_R_MU_RL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_TX_CTRL (Offset 0x14C0) */ -+ -+#define BIT_SHIFT_MU_RL 12 -+#define BIT_MASK_MU_RL 0xf -+#define BIT_MU_RL(x) (((x) & BIT_MASK_MU_RL) << BIT_SHIFT_MU_RL) -+#define BITS_MU_RL (BIT_MASK_MU_RL << BIT_SHIFT_MU_RL) -+#define BIT_CLEAR_MU_RL(x) ((x) & (~BITS_MU_RL)) -+#define BIT_GET_MU_RL(x) (((x) >> BIT_SHIFT_MU_RL) & BIT_MASK_MU_RL) -+#define BIT_SET_MU_RL(x, v) (BIT_CLEAR_MU_RL(x) | BIT_MU_RL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_TX_CTL (Offset 0x14C0) */ -+ -+#define BIT_R_FORCE_P1_RATEDOWN BIT(11) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_TX_CTL (Offset 0x14C0) */ -+ -+#define BIT_SHIFT_R_MU_TAB_SEL 8 -+#define BIT_MASK_R_MU_TAB_SEL 0x7 -+#define BIT_R_MU_TAB_SEL(x) \ -+ (((x) & BIT_MASK_R_MU_TAB_SEL) << BIT_SHIFT_R_MU_TAB_SEL) -+#define BITS_R_MU_TAB_SEL (BIT_MASK_R_MU_TAB_SEL << BIT_SHIFT_R_MU_TAB_SEL) -+#define BIT_CLEAR_R_MU_TAB_SEL(x) ((x) & (~BITS_R_MU_TAB_SEL)) -+#define BIT_GET_R_MU_TAB_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_MU_TAB_SEL) & BIT_MASK_R_MU_TAB_SEL) -+#define BIT_SET_R_MU_TAB_SEL(x, v) \ -+ (BIT_CLEAR_R_MU_TAB_SEL(x) | BIT_R_MU_TAB_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_TX_CTRL (Offset 0x14C0) */ -+ -+#define BIT_SHIFT_MU_TAB_SEL 8 -+#define BIT_MASK_MU_TAB_SEL 0xf -+#define BIT_MU_TAB_SEL(x) (((x) & BIT_MASK_MU_TAB_SEL) << BIT_SHIFT_MU_TAB_SEL) -+#define BITS_MU_TAB_SEL (BIT_MASK_MU_TAB_SEL << BIT_SHIFT_MU_TAB_SEL) -+#define BIT_CLEAR_MU_TAB_SEL(x) ((x) & (~BITS_MU_TAB_SEL)) -+#define BIT_GET_MU_TAB_SEL(x) \ -+ (((x) >> BIT_SHIFT_MU_TAB_SEL) & BIT_MASK_MU_TAB_SEL) -+#define BIT_SET_MU_TAB_SEL(x, v) (BIT_CLEAR_MU_TAB_SEL(x) | BIT_MU_TAB_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_TX_CTL (Offset 0x14C0) */ -+ -+#define BIT_R_EN_MU_MIMO BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_TX_CTL (Offset 0x14C0) */ -+ -+#define BIT_R_EN_REVERS_GTAB BIT(6) -+ -+#define BIT_SHIFT_R_MU_TABLE_VALID 0 -+#define BIT_MASK_R_MU_TABLE_VALID 0x3f -+#define BIT_R_MU_TABLE_VALID(x) \ -+ (((x) & BIT_MASK_R_MU_TABLE_VALID) << BIT_SHIFT_R_MU_TABLE_VALID) -+#define BITS_R_MU_TABLE_VALID \ -+ (BIT_MASK_R_MU_TABLE_VALID << BIT_SHIFT_R_MU_TABLE_VALID) -+#define BIT_CLEAR_R_MU_TABLE_VALID(x) ((x) & (~BITS_R_MU_TABLE_VALID)) -+#define BIT_GET_R_MU_TABLE_VALID(x) \ -+ (((x) >> BIT_SHIFT_R_MU_TABLE_VALID) & BIT_MASK_R_MU_TABLE_VALID) -+#define BIT_SET_R_MU_TABLE_VALID(x, v) \ -+ (BIT_CLEAR_R_MU_TABLE_VALID(x) | BIT_R_MU_TABLE_VALID(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_TX_CTRL (Offset 0x14C0) */ -+ -+#define BIT_SHIFT_MU_TAB_VALID 0 -+#define BIT_MASK_MU_TAB_VALID 0x3f -+#define BIT_MU_TAB_VALID(x) \ -+ (((x) & BIT_MASK_MU_TAB_VALID) << BIT_SHIFT_MU_TAB_VALID) -+#define BITS_MU_TAB_VALID (BIT_MASK_MU_TAB_VALID << BIT_SHIFT_MU_TAB_VALID) -+#define BIT_CLEAR_MU_TAB_VALID(x) ((x) & (~BITS_MU_TAB_VALID)) -+#define BIT_GET_MU_TAB_VALID(x) \ -+ (((x) >> BIT_SHIFT_MU_TAB_VALID) & BIT_MASK_MU_TAB_VALID) -+#define BIT_SET_MU_TAB_VALID(x, v) \ -+ (BIT_CLEAR_MU_TAB_VALID(x) | BIT_MU_TAB_VALID(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_STA_GID_VLD (Offset 0x14C4) */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_VALID 0 -+#define BIT_MASK_R_MU_STA_GTAB_VALID 0xffffffffL -+#define BIT_R_MU_STA_GTAB_VALID(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_VALID) << BIT_SHIFT_R_MU_STA_GTAB_VALID) -+#define BITS_R_MU_STA_GTAB_VALID \ -+ (BIT_MASK_R_MU_STA_GTAB_VALID << BIT_SHIFT_R_MU_STA_GTAB_VALID) -+#define BIT_CLEAR_R_MU_STA_GTAB_VALID(x) ((x) & (~BITS_R_MU_STA_GTAB_VALID)) -+#define BIT_GET_R_MU_STA_GTAB_VALID(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_VALID) & BIT_MASK_R_MU_STA_GTAB_VALID) -+#define BIT_SET_R_MU_STA_GTAB_VALID(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_VALID(x) | BIT_R_MU_STA_GTAB_VALID(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_STA_GID_VLD (Offset 0x14C4) */ -+ -+#define BIT_SHIFT_MU_STA_GTAB_VALID 0 -+#define BIT_MASK_MU_STA_GTAB_VALID 0xffffffffL -+#define BIT_MU_STA_GTAB_VALID(x) \ -+ (((x) & BIT_MASK_MU_STA_GTAB_VALID) << BIT_SHIFT_MU_STA_GTAB_VALID) -+#define BITS_MU_STA_GTAB_VALID \ -+ (BIT_MASK_MU_STA_GTAB_VALID << BIT_SHIFT_MU_STA_GTAB_VALID) -+#define BIT_CLEAR_MU_STA_GTAB_VALID(x) ((x) & (~BITS_MU_STA_GTAB_VALID)) -+#define BIT_GET_MU_STA_GTAB_VALID(x) \ -+ (((x) >> BIT_SHIFT_MU_STA_GTAB_VALID) & BIT_MASK_MU_STA_GTAB_VALID) -+#define BIT_SET_MU_STA_GTAB_VALID(x, v) \ -+ (BIT_CLEAR_MU_STA_GTAB_VALID(x) | BIT_MU_STA_GTAB_VALID(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_STA_USER_POS_INFO (Offset 0x14C8) */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_L 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_L 0xffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_L(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_L) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_L) -+#define BITS_R_MU_STA_GTAB_POSITION_L \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_L \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_L) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_L(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_L)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_L(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_L) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_L) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_L(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_L(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_L(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_STA_USER_POS_INFO (Offset 0x14C8) */ -+ -+#define BIT_SHIFT_MU_STA_GTAB_POSITION_L 0 -+#define BIT_MASK_MU_STA_GTAB_POSITION_L 0xffffffffL -+#define BIT_MU_STA_GTAB_POSITION_L(x) \ -+ (((x) & BIT_MASK_MU_STA_GTAB_POSITION_L) \ -+ << BIT_SHIFT_MU_STA_GTAB_POSITION_L) -+#define BITS_MU_STA_GTAB_POSITION_L \ -+ (BIT_MASK_MU_STA_GTAB_POSITION_L << BIT_SHIFT_MU_STA_GTAB_POSITION_L) -+#define BIT_CLEAR_MU_STA_GTAB_POSITION_L(x) \ -+ ((x) & (~BITS_MU_STA_GTAB_POSITION_L)) -+#define BIT_GET_MU_STA_GTAB_POSITION_L(x) \ -+ (((x) >> BIT_SHIFT_MU_STA_GTAB_POSITION_L) & \ -+ BIT_MASK_MU_STA_GTAB_POSITION_L) -+#define BIT_SET_MU_STA_GTAB_POSITION_L(x, v) \ -+ (BIT_CLEAR_MU_STA_GTAB_POSITION_L(x) | BIT_MU_STA_GTAB_POSITION_L(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_H (Offset 0x14CC) */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_H 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_H 0xffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_H(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_H) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_H) -+#define BITS_R_MU_STA_GTAB_POSITION_H \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_H \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_H) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_H(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_H)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_H(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_H) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_H) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_H(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_H(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_H(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_H (Offset 0x14CC) */ -+ -+#define BIT_SHIFT_MU_STA_GTAB_POSITION_H 0 -+#define BIT_MASK_MU_STA_GTAB_POSITION_H 0xffffffffL -+#define BIT_MU_STA_GTAB_POSITION_H(x) \ -+ (((x) & BIT_MASK_MU_STA_GTAB_POSITION_H) \ -+ << BIT_SHIFT_MU_STA_GTAB_POSITION_H) -+#define BITS_MU_STA_GTAB_POSITION_H \ -+ (BIT_MASK_MU_STA_GTAB_POSITION_H << BIT_SHIFT_MU_STA_GTAB_POSITION_H) -+#define BIT_CLEAR_MU_STA_GTAB_POSITION_H(x) \ -+ ((x) & (~BITS_MU_STA_GTAB_POSITION_H)) -+#define BIT_GET_MU_STA_GTAB_POSITION_H(x) \ -+ (((x) >> BIT_SHIFT_MU_STA_GTAB_POSITION_H) & \ -+ BIT_MASK_MU_STA_GTAB_POSITION_H) -+#define BIT_SET_MU_STA_GTAB_POSITION_H(x, v) \ -+ (BIT_CLEAR_MU_STA_GTAB_POSITION_H(x) | BIT_MU_STA_GTAB_POSITION_H(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_TRX_DBG_CNT (Offset 0x14D0) */ -+ -+#define BIT_MU_DNGCNT_RST BIT(20) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MU_TRX_DBG_CNT (Offset 0x14D0) */ -+ -+#define BIT_SHIFT_MU_DBGCNT_SEL 16 -+#define BIT_MASK_MU_DBGCNT_SEL 0xf -+#define BIT_MU_DBGCNT_SEL(x) \ -+ (((x) & BIT_MASK_MU_DBGCNT_SEL) << BIT_SHIFT_MU_DBGCNT_SEL) -+#define BITS_MU_DBGCNT_SEL (BIT_MASK_MU_DBGCNT_SEL << BIT_SHIFT_MU_DBGCNT_SEL) -+#define BIT_CLEAR_MU_DBGCNT_SEL(x) ((x) & (~BITS_MU_DBGCNT_SEL)) -+#define BIT_GET_MU_DBGCNT_SEL(x) \ -+ (((x) >> BIT_SHIFT_MU_DBGCNT_SEL) & BIT_MASK_MU_DBGCNT_SEL) -+#define BIT_SET_MU_DBGCNT_SEL(x, v) \ -+ (BIT_CLEAR_MU_DBGCNT_SEL(x) | BIT_MU_DBGCNT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CHNL_INFO_CTRL (Offset 0x14D0) */ -+ -+#define BIT_CHNL_REF_RXNAV BIT(7) -+#define BIT_CHNL_REF_VBON BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CHNL_INFO_CTRL (Offset 0x14D0) */ -+ -+#define BIT_CHNL_REF_EDCCA BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CHNL_INFO_CTRL (Offset 0x14D0) */ -+ -+#define BIT_CHNL_REF_CCA BIT(4) -+#define BIT_MACTX_ERR_4 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CHNL_INFO_CTRL (Offset 0x14D0) */ -+ -+#define BIT_RST_CHNL_BUSY BIT(3) -+#define BIT_RST_CHNL_IDLE BIT(2) -+#define BIT_CHNL_INFO_RST BIT(1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CHNL_INFO_CTRL (Offset 0x14D0) */ -+ -+#define BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD 1 -+#define BIT_MASK_VHTHT_MIMO_CTRL_FIELD 0xffffff -+#define BIT_VHTHT_MIMO_CTRL_FIELD(x) \ -+ (((x) & BIT_MASK_VHTHT_MIMO_CTRL_FIELD) \ -+ << BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD) -+#define BITS_VHTHT_MIMO_CTRL_FIELD \ -+ (BIT_MASK_VHTHT_MIMO_CTRL_FIELD << BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD) -+#define BIT_CLEAR_VHTHT_MIMO_CTRL_FIELD(x) ((x) & (~BITS_VHTHT_MIMO_CTRL_FIELD)) -+#define BIT_GET_VHTHT_MIMO_CTRL_FIELD(x) \ -+ (((x) >> BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD) & \ -+ BIT_MASK_VHTHT_MIMO_CTRL_FIELD) -+#define BIT_SET_VHTHT_MIMO_CTRL_FIELD(x, v) \ -+ (BIT_CLEAR_VHTHT_MIMO_CTRL_FIELD(x) | BIT_VHTHT_MIMO_CTRL_FIELD(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CHNL_INFO_CTRL (Offset 0x14D0) */ -+ -+#define BIT_ATM_AIRTIME_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CHNL_INFO_CTRL (Offset 0x14D0) */ -+ -+#define BIT_CSI_INTERRUPT_STATUS BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_TRX_DBG_CNT (Offset 0x14D0) */ -+ -+#define BIT_SHIFT_MU_DNGCNT 0 -+#define BIT_MASK_MU_DNGCNT 0xffff -+#define BIT_MU_DNGCNT(x) (((x) & BIT_MASK_MU_DNGCNT) << BIT_SHIFT_MU_DNGCNT) -+#define BITS_MU_DNGCNT (BIT_MASK_MU_DNGCNT << BIT_SHIFT_MU_DNGCNT) -+#define BIT_CLEAR_MU_DNGCNT(x) ((x) & (~BITS_MU_DNGCNT)) -+#define BIT_GET_MU_DNGCNT(x) (((x) >> BIT_SHIFT_MU_DNGCNT) & BIT_MASK_MU_DNGCNT) -+#define BIT_SET_MU_DNGCNT(x, v) (BIT_CLEAR_MU_DNGCNT(x) | BIT_MU_DNGCNT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CHNL_BUSY_TIME (Offset 0x14D8) */ -+ -+#define BIT_SHIFT_CHNL_BUSY_TIME 0 -+#define BIT_MASK_CHNL_BUSY_TIME 0xffffffffL -+#define BIT_CHNL_BUSY_TIME(x) \ -+ (((x) & BIT_MASK_CHNL_BUSY_TIME) << BIT_SHIFT_CHNL_BUSY_TIME) -+#define BITS_CHNL_BUSY_TIME \ -+ (BIT_MASK_CHNL_BUSY_TIME << BIT_SHIFT_CHNL_BUSY_TIME) -+#define BIT_CLEAR_CHNL_BUSY_TIME(x) ((x) & (~BITS_CHNL_BUSY_TIME)) -+#define BIT_GET_CHNL_BUSY_TIME(x) \ -+ (((x) >> BIT_SHIFT_CHNL_BUSY_TIME) & BIT_MASK_CHNL_BUSY_TIME) -+#define BIT_SET_CHNL_BUSY_TIME(x, v) \ -+ (BIT_CLEAR_CHNL_BUSY_TIME(x) | BIT_CHNL_BUSY_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MU_TRX_DBG_CNT_V1 (Offset 0x14DC) */ -+ -+#define BIT_FORCE_SND_STS_EN BIT(31) -+ -+#define BIT_SHIFT_SND_STS_VALUE 24 -+#define BIT_MASK_SND_STS_VALUE 0x3f -+#define BIT_SND_STS_VALUE(x) \ -+ (((x) & BIT_MASK_SND_STS_VALUE) << BIT_SHIFT_SND_STS_VALUE) -+#define BITS_SND_STS_VALUE (BIT_MASK_SND_STS_VALUE << BIT_SHIFT_SND_STS_VALUE) -+#define BIT_CLEAR_SND_STS_VALUE(x) ((x) & (~BITS_SND_STS_VALUE)) -+#define BIT_GET_SND_STS_VALUE(x) \ -+ (((x) >> BIT_SHIFT_SND_STS_VALUE) & BIT_MASK_SND_STS_VALUE) -+#define BIT_SET_SND_STS_VALUE(x, v) \ -+ (BIT_CLEAR_SND_STS_VALUE(x) | BIT_SND_STS_VALUE(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_TRX_DBG_CNT_V1 (Offset 0x14DC) */ -+ -+#define BIT_SHIFT_MU_DNGCNT_SEL 16 -+#define BIT_MASK_MU_DNGCNT_SEL 0xf -+#define BIT_MU_DNGCNT_SEL(x) \ -+ (((x) & BIT_MASK_MU_DNGCNT_SEL) << BIT_SHIFT_MU_DNGCNT_SEL) -+#define BITS_MU_DNGCNT_SEL (BIT_MASK_MU_DNGCNT_SEL << BIT_SHIFT_MU_DNGCNT_SEL) -+#define BIT_CLEAR_MU_DNGCNT_SEL(x) ((x) & (~BITS_MU_DNGCNT_SEL)) -+#define BIT_GET_MU_DNGCNT_SEL(x) \ -+ (((x) >> BIT_SHIFT_MU_DNGCNT_SEL) & BIT_MASK_MU_DNGCNT_SEL) -+#define BIT_SET_MU_DNGCNT_SEL(x, v) \ -+ (BIT_CLEAR_MU_DNGCNT_SEL(x) | BIT_MU_DNGCNT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_SU_DURATION (Offset 0x14F0) */ -+ -+#define BIT_SHIFT_SU_DURATION 0 -+#define BIT_MASK_SU_DURATION 0xffff -+#define BIT_SU_DURATION(x) \ -+ (((x) & BIT_MASK_SU_DURATION) << BIT_SHIFT_SU_DURATION) -+#define BITS_SU_DURATION (BIT_MASK_SU_DURATION << BIT_SHIFT_SU_DURATION) -+#define BIT_CLEAR_SU_DURATION(x) ((x) & (~BITS_SU_DURATION)) -+#define BIT_GET_SU_DURATION(x) \ -+ (((x) >> BIT_SHIFT_SU_DURATION) & BIT_MASK_SU_DURATION) -+#define BIT_SET_SU_DURATION(x, v) \ -+ (BIT_CLEAR_SU_DURATION(x) | BIT_SU_DURATION(v)) -+ -+/* 2 REG_MU_DURATION (Offset 0x14F2) */ -+ -+#define BIT_SHIFT_MU_DURATION 0 -+#define BIT_MASK_MU_DURATION 0xffff -+#define BIT_MU_DURATION(x) \ -+ (((x) & BIT_MASK_MU_DURATION) << BIT_SHIFT_MU_DURATION) -+#define BITS_MU_DURATION (BIT_MASK_MU_DURATION << BIT_SHIFT_MU_DURATION) -+#define BIT_CLEAR_MU_DURATION(x) ((x) & (~BITS_MU_DURATION)) -+#define BIT_GET_MU_DURATION(x) \ -+ (((x) >> BIT_SHIFT_MU_DURATION) & BIT_MASK_MU_DURATION) -+#define BIT_SET_MU_DURATION(x, v) \ -+ (BIT_CLEAR_MU_DURATION(x) | BIT_MU_DURATION(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SWPS_CTRL (Offset 0x14F4) */ -+ -+#define BIT_SHIFT_SWPS_PKT_TH_V1 16 -+#define BIT_MASK_SWPS_PKT_TH_V1 0xffff -+#define BIT_SWPS_PKT_TH_V1(x) \ -+ (((x) & BIT_MASK_SWPS_PKT_TH_V1) << BIT_SHIFT_SWPS_PKT_TH_V1) -+#define BITS_SWPS_PKT_TH_V1 \ -+ (BIT_MASK_SWPS_PKT_TH_V1 << BIT_SHIFT_SWPS_PKT_TH_V1) -+#define BIT_CLEAR_SWPS_PKT_TH_V1(x) ((x) & (~BITS_SWPS_PKT_TH_V1)) -+#define BIT_GET_SWPS_PKT_TH_V1(x) \ -+ (((x) >> BIT_SHIFT_SWPS_PKT_TH_V1) & BIT_MASK_SWPS_PKT_TH_V1) -+#define BIT_SET_SWPS_PKT_TH_V1(x, v) \ -+ (BIT_CLEAR_SWPS_PKT_TH_V1(x) | BIT_SWPS_PKT_TH_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SWPS_CTRL (Offset 0x14F4) */ -+ -+#define BIT_SHIFT_SWPS_RPT_LENGTH 8 -+#define BIT_MASK_SWPS_RPT_LENGTH 0x7f -+#define BIT_SWPS_RPT_LENGTH(x) \ -+ (((x) & BIT_MASK_SWPS_RPT_LENGTH) << BIT_SHIFT_SWPS_RPT_LENGTH) -+#define BITS_SWPS_RPT_LENGTH \ -+ (BIT_MASK_SWPS_RPT_LENGTH << BIT_SHIFT_SWPS_RPT_LENGTH) -+#define BIT_CLEAR_SWPS_RPT_LENGTH(x) ((x) & (~BITS_SWPS_RPT_LENGTH)) -+#define BIT_GET_SWPS_RPT_LENGTH(x) \ -+ (((x) >> BIT_SHIFT_SWPS_RPT_LENGTH) & BIT_MASK_SWPS_RPT_LENGTH) -+#define BIT_SET_SWPS_RPT_LENGTH(x, v) \ -+ (BIT_CLEAR_SWPS_RPT_LENGTH(x) | BIT_SWPS_RPT_LENGTH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SWPS_CTRL (Offset 0x14F4) */ -+ -+#define BIT_SHIFT_MACID_SWPS_EN_SEL 2 -+#define BIT_MASK_MACID_SWPS_EN_SEL 0x3 -+#define BIT_MACID_SWPS_EN_SEL(x) \ -+ (((x) & BIT_MASK_MACID_SWPS_EN_SEL) << BIT_SHIFT_MACID_SWPS_EN_SEL) -+#define BITS_MACID_SWPS_EN_SEL \ -+ (BIT_MASK_MACID_SWPS_EN_SEL << BIT_SHIFT_MACID_SWPS_EN_SEL) -+#define BIT_CLEAR_MACID_SWPS_EN_SEL(x) ((x) & (~BITS_MACID_SWPS_EN_SEL)) -+#define BIT_GET_MACID_SWPS_EN_SEL(x) \ -+ (((x) >> BIT_SHIFT_MACID_SWPS_EN_SEL) & BIT_MASK_MACID_SWPS_EN_SEL) -+#define BIT_SET_MACID_SWPS_EN_SEL(x, v) \ -+ (BIT_CLEAR_MACID_SWPS_EN_SEL(x) | BIT_MACID_SWPS_EN_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SWPS_CTRL (Offset 0x14F4) */ -+ -+#define BIT_MACID_SWPS_EN_SEL_V1 BIT(2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SWPS_CTRL (Offset 0x14F4) */ -+ -+#define BIT_SWPS_MANUALL_POLLING BIT(1) -+#define BIT_SWPS_EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_HW_NDPA_RTY_LIMIT (Offset 0x14F4) */ -+ -+#define BIT_SHIFT_HW_NDPA_RTY_LIMIT 0 -+#define BIT_MASK_HW_NDPA_RTY_LIMIT 0xf -+#define BIT_HW_NDPA_RTY_LIMIT(x) \ -+ (((x) & BIT_MASK_HW_NDPA_RTY_LIMIT) << BIT_SHIFT_HW_NDPA_RTY_LIMIT) -+#define BITS_HW_NDPA_RTY_LIMIT \ -+ (BIT_MASK_HW_NDPA_RTY_LIMIT << BIT_SHIFT_HW_NDPA_RTY_LIMIT) -+#define BIT_CLEAR_HW_NDPA_RTY_LIMIT(x) ((x) & (~BITS_HW_NDPA_RTY_LIMIT)) -+#define BIT_GET_HW_NDPA_RTY_LIMIT(x) \ -+ (((x) >> BIT_SHIFT_HW_NDPA_RTY_LIMIT) & BIT_MASK_HW_NDPA_RTY_LIMIT) -+#define BIT_SET_HW_NDPA_RTY_LIMIT(x, v) \ -+ (BIT_CLEAR_HW_NDPA_RTY_LIMIT(x) | BIT_HW_NDPA_RTY_LIMIT(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_MACID_SWPS_EN (Offset 0x14FC) */ -+ -+#define BIT_SHIFT_MACID_SWPS_EN 0 -+#define BIT_MASK_MACID_SWPS_EN 0xffffffffL -+#define BIT_MACID_SWPS_EN(x) \ -+ (((x) & BIT_MASK_MACID_SWPS_EN) << BIT_SHIFT_MACID_SWPS_EN) -+#define BITS_MACID_SWPS_EN (BIT_MASK_MACID_SWPS_EN << BIT_SHIFT_MACID_SWPS_EN) -+#define BIT_CLEAR_MACID_SWPS_EN(x) ((x) & (~BITS_MACID_SWPS_EN)) -+#define BIT_GET_MACID_SWPS_EN(x) \ -+ (((x) >> BIT_SHIFT_MACID_SWPS_EN) & BIT_MASK_MACID_SWPS_EN) -+#define BIT_SET_MACID_SWPS_EN(x, v) \ -+ (BIT_CLEAR_MACID_SWPS_EN(x) | BIT_MACID_SWPS_EN(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PORT_CTRL_SEL (Offset 0x1500) */ -+ -+#define BIT_SHIFT_BCN_TIMER_SEL_FWRD_V1 4 -+#define BIT_MASK_BCN_TIMER_SEL_FWRD_V1 0x7 -+#define BIT_BCN_TIMER_SEL_FWRD_V1(x) \ -+ (((x) & BIT_MASK_BCN_TIMER_SEL_FWRD_V1) \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_V1) -+#define BITS_BCN_TIMER_SEL_FWRD_V1 \ -+ (BIT_MASK_BCN_TIMER_SEL_FWRD_V1 << BIT_SHIFT_BCN_TIMER_SEL_FWRD_V1) -+#define BIT_CLEAR_BCN_TIMER_SEL_FWRD_V1(x) ((x) & (~BITS_BCN_TIMER_SEL_FWRD_V1)) -+#define BIT_GET_BCN_TIMER_SEL_FWRD_V1(x) \ -+ (((x) >> BIT_SHIFT_BCN_TIMER_SEL_FWRD_V1) & \ -+ BIT_MASK_BCN_TIMER_SEL_FWRD_V1) -+#define BIT_SET_BCN_TIMER_SEL_FWRD_V1(x, v) \ -+ (BIT_CLEAR_BCN_TIMER_SEL_FWRD_V1(x) | BIT_BCN_TIMER_SEL_FWRD_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPUMGQ_TX_TIMER (Offset 0x1500) */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_V1 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_V1 0xffffffffL -+#define BIT_CPUMGQ_TX_TIMER_V1(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_V1) << BIT_SHIFT_CPUMGQ_TX_TIMER_V1) -+#define BITS_CPUMGQ_TX_TIMER_V1 \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_V1 << BIT_SHIFT_CPUMGQ_TX_TIMER_V1) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_V1(x) ((x) & (~BITS_CPUMGQ_TX_TIMER_V1)) -+#define BIT_GET_CPUMGQ_TX_TIMER_V1(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_V1) & BIT_MASK_CPUMGQ_TX_TIMER_V1) -+#define BIT_SET_CPUMGQ_TX_TIMER_V1(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_V1(x) | BIT_CPUMGQ_TX_TIMER_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_PORT_CTRL_SEL (Offset 0x1500) */ -+ -+#define BIT_SHIFT_PORT_CTRL_SEL 0 -+#define BIT_MASK_PORT_CTRL_SEL 0x7 -+#define BIT_PORT_CTRL_SEL(x) \ -+ (((x) & BIT_MASK_PORT_CTRL_SEL) << BIT_SHIFT_PORT_CTRL_SEL) -+#define BITS_PORT_CTRL_SEL (BIT_MASK_PORT_CTRL_SEL << BIT_SHIFT_PORT_CTRL_SEL) -+#define BIT_CLEAR_PORT_CTRL_SEL(x) ((x) & (~BITS_PORT_CTRL_SEL)) -+#define BIT_GET_PORT_CTRL_SEL(x) \ -+ (((x) >> BIT_SHIFT_PORT_CTRL_SEL) & BIT_MASK_PORT_CTRL_SEL) -+#define BIT_SET_PORT_CTRL_SEL(x, v) \ -+ (BIT_CLEAR_PORT_CTRL_SEL(x) | BIT_PORT_CTRL_SEL(v)) -+ -+/* 2 REG_PORT_CTRL_CFG (Offset 0x1501) */ -+ -+#define BIT_BCNERR_CNT_EN_V1 BIT(11) -+#define BIT_DIS_TRX_CAL_BCN_V1 BIT(10) -+#define BIT_DIS_TX_CAL_TBTT_V1 BIT(9) -+#define BIT_BCN_AGGRESSION_V1 BIT(8) -+#define BIT_TSFTR_RST_V1 BIT(7) -+#define BIT_EN_TXBCN_RPT_V1 BIT(5) -+#define BIT_EN_PORT_FUNCTION BIT(3) -+#define BIT_EN_RXBCN_RPT BIT(2) -+ -+/* 2 REG_TBTT_PROHIBIT_CFG (Offset 0x1504) */ -+ -+#define BIT_MASK_PROHIBIT BIT(23) -+ -+#define BIT_SHIFT_TBTT_HOLD_TIME 8 -+#define BIT_MASK_TBTT_HOLD_TIME 0xfff -+#define BIT_TBTT_HOLD_TIME(x) \ -+ (((x) & BIT_MASK_TBTT_HOLD_TIME) << BIT_SHIFT_TBTT_HOLD_TIME) -+#define BITS_TBTT_HOLD_TIME \ -+ (BIT_MASK_TBTT_HOLD_TIME << BIT_SHIFT_TBTT_HOLD_TIME) -+#define BIT_CLEAR_TBTT_HOLD_TIME(x) ((x) & (~BITS_TBTT_HOLD_TIME)) -+#define BIT_GET_TBTT_HOLD_TIME(x) \ -+ (((x) >> BIT_SHIFT_TBTT_HOLD_TIME) & BIT_MASK_TBTT_HOLD_TIME) -+#define BIT_SET_TBTT_HOLD_TIME(x, v) \ -+ (BIT_CLEAR_TBTT_HOLD_TIME(x) | BIT_TBTT_HOLD_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PS_TIMER_A (Offset 0x1504) */ -+ -+#define BIT_SHIFT_PS_TIMER_A_V1 0 -+#define BIT_MASK_PS_TIMER_A_V1 0xffffffffL -+#define BIT_PS_TIMER_A_V1(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_V1) << BIT_SHIFT_PS_TIMER_A_V1) -+#define BITS_PS_TIMER_A_V1 (BIT_MASK_PS_TIMER_A_V1 << BIT_SHIFT_PS_TIMER_A_V1) -+#define BIT_CLEAR_PS_TIMER_A_V1(x) ((x) & (~BITS_PS_TIMER_A_V1)) -+#define BIT_GET_PS_TIMER_A_V1(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_V1) & BIT_MASK_PS_TIMER_A_V1) -+#define BIT_SET_PS_TIMER_A_V1(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_V1(x) | BIT_PS_TIMER_A_V1(v)) -+ -+/* 2 REG_PS_TIMER_B (Offset 0x1508) */ -+ -+#define BIT_SHIFT_PS_TIMER_B_V1 0 -+#define BIT_MASK_PS_TIMER_B_V1 0xffffffffL -+#define BIT_PS_TIMER_B_V1(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_V1) << BIT_SHIFT_PS_TIMER_B_V1) -+#define BITS_PS_TIMER_B_V1 (BIT_MASK_PS_TIMER_B_V1 << BIT_SHIFT_PS_TIMER_B_V1) -+#define BIT_CLEAR_PS_TIMER_B_V1(x) ((x) & (~BITS_PS_TIMER_B_V1)) -+#define BIT_GET_PS_TIMER_B_V1(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_V1) & BIT_MASK_PS_TIMER_B_V1) -+#define BIT_SET_PS_TIMER_B_V1(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_V1(x) | BIT_PS_TIMER_B_V1(v)) -+ -+/* 2 REG_PS_TIMER_C (Offset 0x150C) */ -+ -+#define BIT_SHIFT_PS_TIMER_C_V1 0 -+#define BIT_MASK_PS_TIMER_C_V1 0xffffffffL -+#define BIT_PS_TIMER_C_V1(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_V1) << BIT_SHIFT_PS_TIMER_C_V1) -+#define BITS_PS_TIMER_C_V1 (BIT_MASK_PS_TIMER_C_V1 << BIT_SHIFT_PS_TIMER_C_V1) -+#define BIT_CLEAR_PS_TIMER_C_V1(x) ((x) & (~BITS_PS_TIMER_C_V1)) -+#define BIT_GET_PS_TIMER_C_V1(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_V1) & BIT_MASK_PS_TIMER_C_V1) -+#define BIT_SET_PS_TIMER_C_V1(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_V1(x) | BIT_PS_TIMER_C_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TSFTR_SYNC_OFFSET_CFG (Offset 0x150C) */ -+ -+#define BIT_SHIFT_TSFTR_SNC_OFFSET_V1 0 -+#define BIT_MASK_TSFTR_SNC_OFFSET_V1 0xffffff -+#define BIT_TSFTR_SNC_OFFSET_V1(x) \ -+ (((x) & BIT_MASK_TSFTR_SNC_OFFSET_V1) << BIT_SHIFT_TSFTR_SNC_OFFSET_V1) -+#define BITS_TSFTR_SNC_OFFSET_V1 \ -+ (BIT_MASK_TSFTR_SNC_OFFSET_V1 << BIT_SHIFT_TSFTR_SNC_OFFSET_V1) -+#define BIT_CLEAR_TSFTR_SNC_OFFSET_V1(x) ((x) & (~BITS_TSFTR_SNC_OFFSET_V1)) -+#define BIT_GET_TSFTR_SNC_OFFSET_V1(x) \ -+ (((x) >> BIT_SHIFT_TSFTR_SNC_OFFSET_V1) & BIT_MASK_TSFTR_SNC_OFFSET_V1) -+#define BIT_SET_TSFTR_SNC_OFFSET_V1(x, v) \ -+ (BIT_CLEAR_TSFTR_SNC_OFFSET_V1(x) | BIT_TSFTR_SNC_OFFSET_V1(v)) -+ -+/* 2 REG_TSFTR_SYNC_CTRL_CFG (Offset 0x150F) */ -+ -+#define BIT_SYNC_TSF_NOW_V1 BIT(5) -+#define BIT_SYNC_TSF_ONCE BIT(4) -+#define BIT_SYNC_TSF_AUTO BIT(3) -+ -+#define BIT_SHIFT_SYNC_PORT_SEL 0 -+#define BIT_MASK_SYNC_PORT_SEL 0x7 -+#define BIT_SYNC_PORT_SEL(x) \ -+ (((x) & BIT_MASK_SYNC_PORT_SEL) << BIT_SHIFT_SYNC_PORT_SEL) -+#define BITS_SYNC_PORT_SEL (BIT_MASK_SYNC_PORT_SEL << BIT_SHIFT_SYNC_PORT_SEL) -+#define BIT_CLEAR_SYNC_PORT_SEL(x) ((x) & (~BITS_SYNC_PORT_SEL)) -+#define BIT_GET_SYNC_PORT_SEL(x) \ -+ (((x) >> BIT_SHIFT_SYNC_PORT_SEL) & BIT_MASK_SYNC_PORT_SEL) -+#define BIT_SET_SYNC_PORT_SEL(x, v) \ -+ (BIT_CLEAR_SYNC_PORT_SEL(x) | BIT_SYNC_PORT_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL (Offset 0x1510) */ -+ -+#define BIT_CPUMGQ_TIMER_EN BIT(31) -+#define BIT_CPUMGQ_TX_EN BIT(28) -+ -+#define BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL 24 -+#define BIT_MASK_CPUMGQ_TIMER_TSF_SEL 0x7 -+#define BIT_CPUMGQ_TIMER_TSF_SEL(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TIMER_TSF_SEL) \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL) -+#define BITS_CPUMGQ_TIMER_TSF_SEL \ -+ (BIT_MASK_CPUMGQ_TIMER_TSF_SEL << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL) -+#define BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL(x) ((x) & (~BITS_CPUMGQ_TIMER_TSF_SEL)) -+#define BIT_GET_CPUMGQ_TIMER_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL) & \ -+ BIT_MASK_CPUMGQ_TIMER_TSF_SEL) -+#define BIT_SET_CPUMGQ_TIMER_TSF_SEL(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL(x) | BIT_CPUMGQ_TIMER_TSF_SEL(v)) -+ -+#define BIT_PS_TIMER_C_EN BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_C_TSF_SEL 16 -+#define BIT_MASK_PS_TIMER_C_TSF_SEL 0x7 -+#define BIT_PS_TIMER_C_TSF_SEL(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_TSF_SEL) << BIT_SHIFT_PS_TIMER_C_TSF_SEL) -+#define BITS_PS_TIMER_C_TSF_SEL \ -+ (BIT_MASK_PS_TIMER_C_TSF_SEL << BIT_SHIFT_PS_TIMER_C_TSF_SEL) -+#define BIT_CLEAR_PS_TIMER_C_TSF_SEL(x) ((x) & (~BITS_PS_TIMER_C_TSF_SEL)) -+#define BIT_GET_PS_TIMER_C_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_TSF_SEL) & BIT_MASK_PS_TIMER_C_TSF_SEL) -+#define BIT_SET_PS_TIMER_C_TSF_SEL(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_TSF_SEL(x) | BIT_PS_TIMER_C_TSF_SEL(v)) -+ -+#define BIT_PS_TIMER_B_EN BIT(15) -+ -+#define BIT_SHIFT_PS_TIMER_B_TSF_SEL 8 -+#define BIT_MASK_PS_TIMER_B_TSF_SEL 0x7 -+#define BIT_PS_TIMER_B_TSF_SEL(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_TSF_SEL) << BIT_SHIFT_PS_TIMER_B_TSF_SEL) -+#define BITS_PS_TIMER_B_TSF_SEL \ -+ (BIT_MASK_PS_TIMER_B_TSF_SEL << BIT_SHIFT_PS_TIMER_B_TSF_SEL) -+#define BIT_CLEAR_PS_TIMER_B_TSF_SEL(x) ((x) & (~BITS_PS_TIMER_B_TSF_SEL)) -+#define BIT_GET_PS_TIMER_B_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_TSF_SEL) & BIT_MASK_PS_TIMER_B_TSF_SEL) -+#define BIT_SET_PS_TIMER_B_TSF_SEL(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_TSF_SEL(x) | BIT_PS_TIMER_B_TSF_SEL(v)) -+ -+#define BIT_PS_TIMER_A_EN BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_A_TSF_SEL 0 -+#define BIT_MASK_PS_TIMER_A_TSF_SEL 0x7 -+#define BIT_PS_TIMER_A_TSF_SEL(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_TSF_SEL) << BIT_SHIFT_PS_TIMER_A_TSF_SEL) -+#define BITS_PS_TIMER_A_TSF_SEL \ -+ (BIT_MASK_PS_TIMER_A_TSF_SEL << BIT_SHIFT_PS_TIMER_A_TSF_SEL) -+#define BIT_CLEAR_PS_TIMER_A_TSF_SEL(x) ((x) & (~BITS_PS_TIMER_A_TSF_SEL)) -+#define BIT_GET_PS_TIMER_A_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_TSF_SEL) & BIT_MASK_PS_TIMER_A_TSF_SEL) -+#define BIT_SET_PS_TIMER_A_TSF_SEL(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_TSF_SEL(x) | BIT_PS_TIMER_A_TSF_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_SPACE_CFG (Offset 0x1510) */ -+ -+#define BIT_SHIFT_BCN_SPACE 0 -+#define BIT_MASK_BCN_SPACE 0xffff -+#define BIT_BCN_SPACE(x) (((x) & BIT_MASK_BCN_SPACE) << BIT_SHIFT_BCN_SPACE) -+#define BITS_BCN_SPACE (BIT_MASK_BCN_SPACE << BIT_SHIFT_BCN_SPACE) -+#define BIT_CLEAR_BCN_SPACE(x) ((x) & (~BITS_BCN_SPACE)) -+#define BIT_GET_BCN_SPACE(x) (((x) >> BIT_SHIFT_BCN_SPACE) & BIT_MASK_BCN_SPACE) -+#define BIT_SET_BCN_SPACE(x, v) (BIT_CLEAR_BCN_SPACE(x) | BIT_BCN_SPACE(v)) -+ -+/* 2 REG_EARLY_INT_ADJUST_CFG (Offset 0x1512) */ -+ -+#define BIT_SHIFT_EARLY_INT_ADJUST 0 -+#define BIT_MASK_EARLY_INT_ADJUST 0xffff -+#define BIT_EARLY_INT_ADJUST(x) \ -+ (((x) & BIT_MASK_EARLY_INT_ADJUST) << BIT_SHIFT_EARLY_INT_ADJUST) -+#define BITS_EARLY_INT_ADJUST \ -+ (BIT_MASK_EARLY_INT_ADJUST << BIT_SHIFT_EARLY_INT_ADJUST) -+#define BIT_CLEAR_EARLY_INT_ADJUST(x) ((x) & (~BITS_EARLY_INT_ADJUST)) -+#define BIT_GET_EARLY_INT_ADJUST(x) \ -+ (((x) >> BIT_SHIFT_EARLY_INT_ADJUST) & BIT_MASK_EARLY_INT_ADJUST) -+#define BIT_SET_EARLY_INT_ADJUST(x, v) \ -+ (BIT_CLEAR_EARLY_INT_ADJUST(x) | BIT_EARLY_INT_ADJUST(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CPUMGQ_TX_TIMER_EARLY (Offset 0x1514) */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_EARLY 0xff -+#define BIT_CPUMGQ_TX_TIMER_EARLY(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_EARLY) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY) -+#define BITS_CPUMGQ_TX_TIMER_EARLY \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_EARLY << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY(x) ((x) & (~BITS_CPUMGQ_TX_TIMER_EARLY)) -+#define BIT_GET_CPUMGQ_TX_TIMER_EARLY(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_EARLY) -+#define BIT_SET_CPUMGQ_TX_TIMER_EARLY(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY(x) | BIT_CPUMGQ_TX_TIMER_EARLY(v)) -+ -+/* 2 REG_PS_TIMER_A_EARLY (Offset 0x1515) */ -+ -+#define BIT_SHIFT_PS_TIMER_A_EARLY 0 -+#define BIT_MASK_PS_TIMER_A_EARLY 0xff -+#define BIT_PS_TIMER_A_EARLY(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_EARLY) << BIT_SHIFT_PS_TIMER_A_EARLY) -+#define BITS_PS_TIMER_A_EARLY \ -+ (BIT_MASK_PS_TIMER_A_EARLY << BIT_SHIFT_PS_TIMER_A_EARLY) -+#define BIT_CLEAR_PS_TIMER_A_EARLY(x) ((x) & (~BITS_PS_TIMER_A_EARLY)) -+#define BIT_GET_PS_TIMER_A_EARLY(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_EARLY) & BIT_MASK_PS_TIMER_A_EARLY) -+#define BIT_SET_PS_TIMER_A_EARLY(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_EARLY(x) | BIT_PS_TIMER_A_EARLY(v)) -+ -+/* 2 REG_PS_TIMER_B_EARLY (Offset 0x1516) */ -+ -+#define BIT_SHIFT_PS_TIMER_B_EARLY 0 -+#define BIT_MASK_PS_TIMER_B_EARLY 0xff -+#define BIT_PS_TIMER_B_EARLY(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_EARLY) << BIT_SHIFT_PS_TIMER_B_EARLY) -+#define BITS_PS_TIMER_B_EARLY \ -+ (BIT_MASK_PS_TIMER_B_EARLY << BIT_SHIFT_PS_TIMER_B_EARLY) -+#define BIT_CLEAR_PS_TIMER_B_EARLY(x) ((x) & (~BITS_PS_TIMER_B_EARLY)) -+#define BIT_GET_PS_TIMER_B_EARLY(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_EARLY) & BIT_MASK_PS_TIMER_B_EARLY) -+#define BIT_SET_PS_TIMER_B_EARLY(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_EARLY(x) | BIT_PS_TIMER_B_EARLY(v)) -+ -+/* 2 REG_PS_TIMER_C_EARLY (Offset 0x1517) */ -+ -+#define BIT_SHIFT_PS_TIMER_C_EARLY 0 -+#define BIT_MASK_PS_TIMER_C_EARLY 0xff -+#define BIT_PS_TIMER_C_EARLY(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_EARLY) << BIT_SHIFT_PS_TIMER_C_EARLY) -+#define BITS_PS_TIMER_C_EARLY \ -+ (BIT_MASK_PS_TIMER_C_EARLY << BIT_SHIFT_PS_TIMER_C_EARLY) -+#define BIT_CLEAR_PS_TIMER_C_EARLY(x) ((x) & (~BITS_PS_TIMER_C_EARLY)) -+#define BIT_GET_PS_TIMER_C_EARLY(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_EARLY) & BIT_MASK_PS_TIMER_C_EARLY) -+#define BIT_SET_PS_TIMER_C_EARLY(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_EARLY(x) | BIT_PS_TIMER_C_EARLY(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_CPUMGQ_PARAMETER (Offset 0x1518) */ -+ -+#define BIT_STOP_CPUMGQ BIT(16) -+ -+#define BIT_SHIFT_CPUMGQ_PARAMETER 0 -+#define BIT_MASK_CPUMGQ_PARAMETER 0xffff -+#define BIT_CPUMGQ_PARAMETER(x) \ -+ (((x) & BIT_MASK_CPUMGQ_PARAMETER) << BIT_SHIFT_CPUMGQ_PARAMETER) -+#define BITS_CPUMGQ_PARAMETER \ -+ (BIT_MASK_CPUMGQ_PARAMETER << BIT_SHIFT_CPUMGQ_PARAMETER) -+#define BIT_CLEAR_CPUMGQ_PARAMETER(x) ((x) & (~BITS_CPUMGQ_PARAMETER)) -+#define BIT_GET_CPUMGQ_PARAMETER(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_PARAMETER) & BIT_MASK_CPUMGQ_PARAMETER) -+#define BIT_SET_CPUMGQ_PARAMETER(x, v) \ -+ (BIT_CLEAR_CPUMGQ_PARAMETER(x) | BIT_CPUMGQ_PARAMETER(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SW_TBTT_TSF_INFO (Offset 0x151C) */ -+ -+#define BIT_SHIFT_SW_TBTT_TSF_INFO 0 -+#define BIT_MASK_SW_TBTT_TSF_INFO 0xffffffffL -+#define BIT_SW_TBTT_TSF_INFO(x) \ -+ (((x) & BIT_MASK_SW_TBTT_TSF_INFO) << BIT_SHIFT_SW_TBTT_TSF_INFO) -+#define BITS_SW_TBTT_TSF_INFO \ -+ (BIT_MASK_SW_TBTT_TSF_INFO << BIT_SHIFT_SW_TBTT_TSF_INFO) -+#define BIT_CLEAR_SW_TBTT_TSF_INFO(x) ((x) & (~BITS_SW_TBTT_TSF_INFO)) -+#define BIT_GET_SW_TBTT_TSF_INFO(x) \ -+ (((x) >> BIT_SHIFT_SW_TBTT_TSF_INFO) & BIT_MASK_SW_TBTT_TSF_INFO) -+#define BIT_SET_SW_TBTT_TSF_INFO(x, v) \ -+ (BIT_CLEAR_SW_TBTT_TSF_INFO(x) | BIT_SW_TBTT_TSF_INFO(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_TSF_SYN_CTRL0 (Offset 0x1520) */ -+ -+#define BIT_SHIFT_TSF_SYNC_INTERVAL_PORT0_V1 16 -+#define BIT_MASK_TSF_SYNC_INTERVAL_PORT0_V1 0xffff -+#define BIT_TSF_SYNC_INTERVAL_PORT0_V1(x) \ -+ (((x) & BIT_MASK_TSF_SYNC_INTERVAL_PORT0_V1) \ -+ << BIT_SHIFT_TSF_SYNC_INTERVAL_PORT0_V1) -+#define BITS_TSF_SYNC_INTERVAL_PORT0_V1 \ -+ (BIT_MASK_TSF_SYNC_INTERVAL_PORT0_V1 \ -+ << BIT_SHIFT_TSF_SYNC_INTERVAL_PORT0_V1) -+#define BIT_CLEAR_TSF_SYNC_INTERVAL_PORT0_V1(x) \ -+ ((x) & (~BITS_TSF_SYNC_INTERVAL_PORT0_V1)) -+#define BIT_GET_TSF_SYNC_INTERVAL_PORT0_V1(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYNC_INTERVAL_PORT0_V1) & \ -+ BIT_MASK_TSF_SYNC_INTERVAL_PORT0_V1) -+#define BIT_SET_TSF_SYNC_INTERVAL_PORT0_V1(x, v) \ -+ (BIT_CLEAR_TSF_SYNC_INTERVAL_PORT0_V1(x) | \ -+ BIT_TSF_SYNC_INTERVAL_PORT0_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSF_SYNC_ADJ (Offset 0x1520) */ -+ -+#define BIT_SHIFT_R_P0_TSFT_ADJ_VAL 16 -+#define BIT_MASK_R_P0_TSFT_ADJ_VAL 0xffff -+#define BIT_R_P0_TSFT_ADJ_VAL(x) \ -+ (((x) & BIT_MASK_R_P0_TSFT_ADJ_VAL) << BIT_SHIFT_R_P0_TSFT_ADJ_VAL) -+#define BITS_R_P0_TSFT_ADJ_VAL \ -+ (BIT_MASK_R_P0_TSFT_ADJ_VAL << BIT_SHIFT_R_P0_TSFT_ADJ_VAL) -+#define BIT_CLEAR_R_P0_TSFT_ADJ_VAL(x) ((x) & (~BITS_R_P0_TSFT_ADJ_VAL)) -+#define BIT_GET_R_P0_TSFT_ADJ_VAL(x) \ -+ (((x) >> BIT_SHIFT_R_P0_TSFT_ADJ_VAL) & BIT_MASK_R_P0_TSFT_ADJ_VAL) -+#define BIT_SET_R_P0_TSFT_ADJ_VAL(x, v) \ -+ (BIT_CLEAR_R_P0_TSFT_ADJ_VAL(x) | BIT_R_P0_TSFT_ADJ_VAL(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_TSF_SYN_CTRL0 (Offset 0x1520) */ -+ -+#define BIT_TSF_SYNC_SIGNAL_V1 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSF_SYNC_ADJ (Offset 0x1520) */ -+ -+#define BIT_R_X_COMP_Y_OVER BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TSF_SYN_CTRL0 (Offset 0x1520) */ -+ -+#define BIT_TSF_SYNC_COMPARE_POLLING BIT(7) -+#define BIT_TSF_SYNC_POLLING BIT(6) -+ -+#define BIT_SHIFT_TSF_SYNC_DUT 3 -+#define BIT_MASK_TSF_SYNC_DUT 0x7 -+#define BIT_TSF_SYNC_DUT(x) \ -+ (((x) & BIT_MASK_TSF_SYNC_DUT) << BIT_SHIFT_TSF_SYNC_DUT) -+#define BITS_TSF_SYNC_DUT (BIT_MASK_TSF_SYNC_DUT << BIT_SHIFT_TSF_SYNC_DUT) -+#define BIT_CLEAR_TSF_SYNC_DUT(x) ((x) & (~BITS_TSF_SYNC_DUT)) -+#define BIT_GET_TSF_SYNC_DUT(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYNC_DUT) & BIT_MASK_TSF_SYNC_DUT) -+#define BIT_SET_TSF_SYNC_DUT(x, v) \ -+ (BIT_CLEAR_TSF_SYNC_DUT(x) | BIT_TSF_SYNC_DUT(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSF_SYNC_ADJ (Offset 0x1520) */ -+ -+#define BIT_SHIFT_R_X_SYNC_SEL 3 -+#define BIT_MASK_R_X_SYNC_SEL 0x7 -+#define BIT_R_X_SYNC_SEL(x) \ -+ (((x) & BIT_MASK_R_X_SYNC_SEL) << BIT_SHIFT_R_X_SYNC_SEL) -+#define BITS_R_X_SYNC_SEL (BIT_MASK_R_X_SYNC_SEL << BIT_SHIFT_R_X_SYNC_SEL) -+#define BIT_CLEAR_R_X_SYNC_SEL(x) ((x) & (~BITS_R_X_SYNC_SEL)) -+#define BIT_GET_R_X_SYNC_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_X_SYNC_SEL) & BIT_MASK_R_X_SYNC_SEL) -+#define BIT_SET_R_X_SYNC_SEL(x, v) \ -+ (BIT_CLEAR_R_X_SYNC_SEL(x) | BIT_R_X_SYNC_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TSF_SYN_CTRL0 (Offset 0x1520) */ -+ -+#define BIT_SHIFT_TSF_SYNC_SOURCE 0 -+#define BIT_MASK_TSF_SYNC_SOURCE 0x7 -+#define BIT_TSF_SYNC_SOURCE(x) \ -+ (((x) & BIT_MASK_TSF_SYNC_SOURCE) << BIT_SHIFT_TSF_SYNC_SOURCE) -+#define BITS_TSF_SYNC_SOURCE \ -+ (BIT_MASK_TSF_SYNC_SOURCE << BIT_SHIFT_TSF_SYNC_SOURCE) -+#define BIT_CLEAR_TSF_SYNC_SOURCE(x) ((x) & (~BITS_TSF_SYNC_SOURCE)) -+#define BIT_GET_TSF_SYNC_SOURCE(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYNC_SOURCE) & BIT_MASK_TSF_SYNC_SOURCE) -+#define BIT_SET_TSF_SYNC_SOURCE(x, v) \ -+ (BIT_CLEAR_TSF_SYNC_SOURCE(x) | BIT_TSF_SYNC_SOURCE(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSF_SYNC_ADJ (Offset 0x1520) */ -+ -+#define BIT_SHIFT_R_SYNC_Y_SEL 0 -+#define BIT_MASK_R_SYNC_Y_SEL 0x7 -+#define BIT_R_SYNC_Y_SEL(x) \ -+ (((x) & BIT_MASK_R_SYNC_Y_SEL) << BIT_SHIFT_R_SYNC_Y_SEL) -+#define BITS_R_SYNC_Y_SEL (BIT_MASK_R_SYNC_Y_SEL << BIT_SHIFT_R_SYNC_Y_SEL) -+#define BIT_CLEAR_R_SYNC_Y_SEL(x) ((x) & (~BITS_R_SYNC_Y_SEL)) -+#define BIT_GET_R_SYNC_Y_SEL(x) \ -+ (((x) >> BIT_SHIFT_R_SYNC_Y_SEL) & BIT_MASK_R_SYNC_Y_SEL) -+#define BIT_SET_R_SYNC_Y_SEL(x, v) \ -+ (BIT_CLEAR_R_SYNC_Y_SEL(x) | BIT_R_SYNC_Y_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TSFTR_LOW (Offset 0x1520) */ -+ -+#define BIT_SHIFT_TSF_TIMER_LOW 0 -+#define BIT_MASK_TSF_TIMER_LOW 0xffffffffL -+#define BIT_TSF_TIMER_LOW(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_LOW) << BIT_SHIFT_TSF_TIMER_LOW) -+#define BITS_TSF_TIMER_LOW (BIT_MASK_TSF_TIMER_LOW << BIT_SHIFT_TSF_TIMER_LOW) -+#define BIT_CLEAR_TSF_TIMER_LOW(x) ((x) & (~BITS_TSF_TIMER_LOW)) -+#define BIT_GET_TSF_TIMER_LOW(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_LOW) & BIT_MASK_TSF_TIMER_LOW) -+#define BIT_SET_TSF_TIMER_LOW(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_LOW(x) | BIT_TSF_TIMER_LOW(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TSF_SYN_OFFSET0 (Offset 0x1522) */ -+ -+#define BIT_SHIFT_TSF_SYNC_INTERVAL_PORT0 0 -+#define BIT_MASK_TSF_SYNC_INTERVAL_PORT0 0xffff -+#define BIT_TSF_SYNC_INTERVAL_PORT0(x) \ -+ (((x) & BIT_MASK_TSF_SYNC_INTERVAL_PORT0) \ -+ << BIT_SHIFT_TSF_SYNC_INTERVAL_PORT0) -+#define BITS_TSF_SYNC_INTERVAL_PORT0 \ -+ (BIT_MASK_TSF_SYNC_INTERVAL_PORT0 << BIT_SHIFT_TSF_SYNC_INTERVAL_PORT0) -+#define BIT_CLEAR_TSF_SYNC_INTERVAL_PORT0(x) \ -+ ((x) & (~BITS_TSF_SYNC_INTERVAL_PORT0)) -+#define BIT_GET_TSF_SYNC_INTERVAL_PORT0(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYNC_INTERVAL_PORT0) & \ -+ BIT_MASK_TSF_SYNC_INTERVAL_PORT0) -+#define BIT_SET_TSF_SYNC_INTERVAL_PORT0(x, v) \ -+ (BIT_CLEAR_TSF_SYNC_INTERVAL_PORT0(x) | BIT_TSF_SYNC_INTERVAL_PORT0(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TSF_SYN_OFFSET1 (Offset 0x1524) */ -+ -+#define BIT_SHIFT_TSF_SYNC_INTERVAL_CLI1 16 -+#define BIT_MASK_TSF_SYNC_INTERVAL_CLI1 0xffff -+#define BIT_TSF_SYNC_INTERVAL_CLI1(x) \ -+ (((x) & BIT_MASK_TSF_SYNC_INTERVAL_CLI1) \ -+ << BIT_SHIFT_TSF_SYNC_INTERVAL_CLI1) -+#define BITS_TSF_SYNC_INTERVAL_CLI1 \ -+ (BIT_MASK_TSF_SYNC_INTERVAL_CLI1 << BIT_SHIFT_TSF_SYNC_INTERVAL_CLI1) -+#define BIT_CLEAR_TSF_SYNC_INTERVAL_CLI1(x) \ -+ ((x) & (~BITS_TSF_SYNC_INTERVAL_CLI1)) -+#define BIT_GET_TSF_SYNC_INTERVAL_CLI1(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYNC_INTERVAL_CLI1) & \ -+ BIT_MASK_TSF_SYNC_INTERVAL_CLI1) -+#define BIT_SET_TSF_SYNC_INTERVAL_CLI1(x, v) \ -+ (BIT_CLEAR_TSF_SYNC_INTERVAL_CLI1(x) | BIT_TSF_SYNC_INTERVAL_CLI1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSF_ADJ_VLAUE (Offset 0x1524) */ -+ -+#define BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL 16 -+#define BIT_MASK_R_CLI1_TSFT_ADJ_VAL 0xffff -+#define BIT_R_CLI1_TSFT_ADJ_VAL(x) \ -+ (((x) & BIT_MASK_R_CLI1_TSFT_ADJ_VAL) << BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL) -+#define BITS_R_CLI1_TSFT_ADJ_VAL \ -+ (BIT_MASK_R_CLI1_TSFT_ADJ_VAL << BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL) -+#define BIT_CLEAR_R_CLI1_TSFT_ADJ_VAL(x) ((x) & (~BITS_R_CLI1_TSFT_ADJ_VAL)) -+#define BIT_GET_R_CLI1_TSFT_ADJ_VAL(x) \ -+ (((x) >> BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL) & BIT_MASK_R_CLI1_TSFT_ADJ_VAL) -+#define BIT_SET_R_CLI1_TSFT_ADJ_VAL(x, v) \ -+ (BIT_CLEAR_R_CLI1_TSFT_ADJ_VAL(x) | BIT_R_CLI1_TSFT_ADJ_VAL(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TSF_SYN_OFFSET1 (Offset 0x1524) */ -+ -+#define BIT_SHIFT_TSF_SYNC_INTERVAL_CLI0 0 -+#define BIT_MASK_TSF_SYNC_INTERVAL_CLI0 0xffff -+#define BIT_TSF_SYNC_INTERVAL_CLI0(x) \ -+ (((x) & BIT_MASK_TSF_SYNC_INTERVAL_CLI0) \ -+ << BIT_SHIFT_TSF_SYNC_INTERVAL_CLI0) -+#define BITS_TSF_SYNC_INTERVAL_CLI0 \ -+ (BIT_MASK_TSF_SYNC_INTERVAL_CLI0 << BIT_SHIFT_TSF_SYNC_INTERVAL_CLI0) -+#define BIT_CLEAR_TSF_SYNC_INTERVAL_CLI0(x) \ -+ ((x) & (~BITS_TSF_SYNC_INTERVAL_CLI0)) -+#define BIT_GET_TSF_SYNC_INTERVAL_CLI0(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYNC_INTERVAL_CLI0) & \ -+ BIT_MASK_TSF_SYNC_INTERVAL_CLI0) -+#define BIT_SET_TSF_SYNC_INTERVAL_CLI0(x, v) \ -+ (BIT_CLEAR_TSF_SYNC_INTERVAL_CLI0(x) | BIT_TSF_SYNC_INTERVAL_CLI0(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSF_ADJ_VLAUE (Offset 0x1524) */ -+ -+#define BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL 0 -+#define BIT_MASK_R_CLI0_TSFT_ADJ_VAL 0xffff -+#define BIT_R_CLI0_TSFT_ADJ_VAL(x) \ -+ (((x) & BIT_MASK_R_CLI0_TSFT_ADJ_VAL) << BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL) -+#define BITS_R_CLI0_TSFT_ADJ_VAL \ -+ (BIT_MASK_R_CLI0_TSFT_ADJ_VAL << BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL) -+#define BIT_CLEAR_R_CLI0_TSFT_ADJ_VAL(x) ((x) & (~BITS_R_CLI0_TSFT_ADJ_VAL)) -+#define BIT_GET_R_CLI0_TSFT_ADJ_VAL(x) \ -+ (((x) >> BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL) & BIT_MASK_R_CLI0_TSFT_ADJ_VAL) -+#define BIT_SET_R_CLI0_TSFT_ADJ_VAL(x, v) \ -+ (BIT_CLEAR_R_CLI0_TSFT_ADJ_VAL(x) | BIT_R_CLI0_TSFT_ADJ_VAL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TSFTR_HIGH (Offset 0x1524) */ -+ -+#define BIT_SHIFT_TSF_TIMER_HIGH 0 -+#define BIT_MASK_TSF_TIMER_HIGH 0xffffffffL -+#define BIT_TSF_TIMER_HIGH(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_HIGH) << BIT_SHIFT_TSF_TIMER_HIGH) -+#define BITS_TSF_TIMER_HIGH \ -+ (BIT_MASK_TSF_TIMER_HIGH << BIT_SHIFT_TSF_TIMER_HIGH) -+#define BIT_CLEAR_TSF_TIMER_HIGH(x) ((x) & (~BITS_TSF_TIMER_HIGH)) -+#define BIT_GET_TSF_TIMER_HIGH(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_HIGH) & BIT_MASK_TSF_TIMER_HIGH) -+#define BIT_SET_TSF_TIMER_HIGH(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_HIGH(x) | BIT_TSF_TIMER_HIGH(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TSF_SYN_OFFSET2 (Offset 0x1528) */ -+ -+#define BIT_SHIFT_TSF_SYNC_INTERVAL_CLI3 16 -+#define BIT_MASK_TSF_SYNC_INTERVAL_CLI3 0xffff -+#define BIT_TSF_SYNC_INTERVAL_CLI3(x) \ -+ (((x) & BIT_MASK_TSF_SYNC_INTERVAL_CLI3) \ -+ << BIT_SHIFT_TSF_SYNC_INTERVAL_CLI3) -+#define BITS_TSF_SYNC_INTERVAL_CLI3 \ -+ (BIT_MASK_TSF_SYNC_INTERVAL_CLI3 << BIT_SHIFT_TSF_SYNC_INTERVAL_CLI3) -+#define BIT_CLEAR_TSF_SYNC_INTERVAL_CLI3(x) \ -+ ((x) & (~BITS_TSF_SYNC_INTERVAL_CLI3)) -+#define BIT_GET_TSF_SYNC_INTERVAL_CLI3(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYNC_INTERVAL_CLI3) & \ -+ BIT_MASK_TSF_SYNC_INTERVAL_CLI3) -+#define BIT_SET_TSF_SYNC_INTERVAL_CLI3(x, v) \ -+ (BIT_CLEAR_TSF_SYNC_INTERVAL_CLI3(x) | BIT_TSF_SYNC_INTERVAL_CLI3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSF_ADJ_VLAUE_2 (Offset 0x1528) */ -+ -+#define BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL 16 -+#define BIT_MASK_R_CLI3_TSFT_ADJ_VAL 0xffff -+#define BIT_R_CLI3_TSFT_ADJ_VAL(x) \ -+ (((x) & BIT_MASK_R_CLI3_TSFT_ADJ_VAL) << BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL) -+#define BITS_R_CLI3_TSFT_ADJ_VAL \ -+ (BIT_MASK_R_CLI3_TSFT_ADJ_VAL << BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL) -+#define BIT_CLEAR_R_CLI3_TSFT_ADJ_VAL(x) ((x) & (~BITS_R_CLI3_TSFT_ADJ_VAL)) -+#define BIT_GET_R_CLI3_TSFT_ADJ_VAL(x) \ -+ (((x) >> BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL) & BIT_MASK_R_CLI3_TSFT_ADJ_VAL) -+#define BIT_SET_R_CLI3_TSFT_ADJ_VAL(x, v) \ -+ (BIT_CLEAR_R_CLI3_TSFT_ADJ_VAL(x) | BIT_R_CLI3_TSFT_ADJ_VAL(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TSF_SYN_OFFSET2 (Offset 0x1528) */ -+ -+#define BIT_WMAC_20MHZBW BIT(2) -+ -+#define BIT_SHIFT_TSF_SYNC_INTERVAL_CLI2 0 -+#define BIT_MASK_TSF_SYNC_INTERVAL_CLI2 0xffff -+#define BIT_TSF_SYNC_INTERVAL_CLI2(x) \ -+ (((x) & BIT_MASK_TSF_SYNC_INTERVAL_CLI2) \ -+ << BIT_SHIFT_TSF_SYNC_INTERVAL_CLI2) -+#define BITS_TSF_SYNC_INTERVAL_CLI2 \ -+ (BIT_MASK_TSF_SYNC_INTERVAL_CLI2 << BIT_SHIFT_TSF_SYNC_INTERVAL_CLI2) -+#define BIT_CLEAR_TSF_SYNC_INTERVAL_CLI2(x) \ -+ ((x) & (~BITS_TSF_SYNC_INTERVAL_CLI2)) -+#define BIT_GET_TSF_SYNC_INTERVAL_CLI2(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYNC_INTERVAL_CLI2) & \ -+ BIT_MASK_TSF_SYNC_INTERVAL_CLI2) -+#define BIT_SET_TSF_SYNC_INTERVAL_CLI2(x, v) \ -+ (BIT_CLEAR_TSF_SYNC_INTERVAL_CLI2(x) | BIT_TSF_SYNC_INTERVAL_CLI2(v)) -+ -+#define BIT_WMAC_M11J BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TSF_ADJ_VLAUE_2 (Offset 0x1528) */ -+ -+#define BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL 0 -+#define BIT_MASK_R_CLI2_TSFT_ADJ_VAL 0xffff -+#define BIT_R_CLI2_TSFT_ADJ_VAL(x) \ -+ (((x) & BIT_MASK_R_CLI2_TSFT_ADJ_VAL) << BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL) -+#define BITS_R_CLI2_TSFT_ADJ_VAL \ -+ (BIT_MASK_R_CLI2_TSFT_ADJ_VAL << BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL) -+#define BIT_CLEAR_R_CLI2_TSFT_ADJ_VAL(x) ((x) & (~BITS_R_CLI2_TSFT_ADJ_VAL)) -+#define BIT_GET_R_CLI2_TSFT_ADJ_VAL(x) \ -+ (((x) >> BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL) & BIT_MASK_R_CLI2_TSFT_ADJ_VAL) -+#define BIT_SET_R_CLI2_TSFT_ADJ_VAL(x, v) \ -+ (BIT_CLEAR_R_CLI2_TSFT_ADJ_VAL(x) | BIT_R_CLI2_TSFT_ADJ_VAL(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_BCN_ERR_CNT_MAC (Offset 0x1528) */ -+ -+#define BIT_SHIFT_BCN_ERR_CNT_MAC 0 -+#define BIT_MASK_BCN_ERR_CNT_MAC 0xff -+#define BIT_BCN_ERR_CNT_MAC(x) \ -+ (((x) & BIT_MASK_BCN_ERR_CNT_MAC) << BIT_SHIFT_BCN_ERR_CNT_MAC) -+#define BITS_BCN_ERR_CNT_MAC \ -+ (BIT_MASK_BCN_ERR_CNT_MAC << BIT_SHIFT_BCN_ERR_CNT_MAC) -+#define BIT_CLEAR_BCN_ERR_CNT_MAC(x) ((x) & (~BITS_BCN_ERR_CNT_MAC)) -+#define BIT_GET_BCN_ERR_CNT_MAC(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_CNT_MAC) & BIT_MASK_BCN_ERR_CNT_MAC) -+#define BIT_SET_BCN_ERR_CNT_MAC(x, v) \ -+ (BIT_CLEAR_BCN_ERR_CNT_MAC(x) | BIT_BCN_ERR_CNT_MAC(v)) -+ -+/* 2 REG_BCN_ERR_CNT_EDCCA (Offset 0x1529) */ -+ -+#define BIT_SHIFT_BCN_ERR_CNT_EDCCA 0 -+#define BIT_MASK_BCN_ERR_CNT_EDCCA 0xff -+#define BIT_BCN_ERR_CNT_EDCCA(x) \ -+ (((x) & BIT_MASK_BCN_ERR_CNT_EDCCA) << BIT_SHIFT_BCN_ERR_CNT_EDCCA) -+#define BITS_BCN_ERR_CNT_EDCCA \ -+ (BIT_MASK_BCN_ERR_CNT_EDCCA << BIT_SHIFT_BCN_ERR_CNT_EDCCA) -+#define BIT_CLEAR_BCN_ERR_CNT_EDCCA(x) ((x) & (~BITS_BCN_ERR_CNT_EDCCA)) -+#define BIT_GET_BCN_ERR_CNT_EDCCA(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_CNT_EDCCA) & BIT_MASK_BCN_ERR_CNT_EDCCA) -+#define BIT_SET_BCN_ERR_CNT_EDCCA(x, v) \ -+ (BIT_CLEAR_BCN_ERR_CNT_EDCCA(x) | BIT_BCN_ERR_CNT_EDCCA(v)) -+ -+/* 2 REG_BCN_ERR_CNT_CCA (Offset 0x152A) */ -+ -+#define BIT_SHIFT_BCN_ERR_CNT_CCA 0 -+#define BIT_MASK_BCN_ERR_CNT_CCA 0xff -+#define BIT_BCN_ERR_CNT_CCA(x) \ -+ (((x) & BIT_MASK_BCN_ERR_CNT_CCA) << BIT_SHIFT_BCN_ERR_CNT_CCA) -+#define BITS_BCN_ERR_CNT_CCA \ -+ (BIT_MASK_BCN_ERR_CNT_CCA << BIT_SHIFT_BCN_ERR_CNT_CCA) -+#define BIT_CLEAR_BCN_ERR_CNT_CCA(x) ((x) & (~BITS_BCN_ERR_CNT_CCA)) -+#define BIT_GET_BCN_ERR_CNT_CCA(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_CNT_CCA) & BIT_MASK_BCN_ERR_CNT_CCA) -+#define BIT_SET_BCN_ERR_CNT_CCA(x, v) \ -+ (BIT_CLEAR_BCN_ERR_CNT_CCA(x) | BIT_BCN_ERR_CNT_CCA(v)) -+ -+/* 2 REG_BCN_ERR_CNT_INVALID (Offset 0x152B) */ -+ -+#define BIT_SHIFT_BCN_ERR_CNT_INVALID 0 -+#define BIT_MASK_BCN_ERR_CNT_INVALID 0xff -+#define BIT_BCN_ERR_CNT_INVALID(x) \ -+ (((x) & BIT_MASK_BCN_ERR_CNT_INVALID) << BIT_SHIFT_BCN_ERR_CNT_INVALID) -+#define BITS_BCN_ERR_CNT_INVALID \ -+ (BIT_MASK_BCN_ERR_CNT_INVALID << BIT_SHIFT_BCN_ERR_CNT_INVALID) -+#define BIT_CLEAR_BCN_ERR_CNT_INVALID(x) ((x) & (~BITS_BCN_ERR_CNT_INVALID)) -+#define BIT_GET_BCN_ERR_CNT_INVALID(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_CNT_INVALID) & BIT_MASK_BCN_ERR_CNT_INVALID) -+#define BIT_SET_BCN_ERR_CNT_INVALID(x, v) \ -+ (BIT_CLEAR_BCN_ERR_CNT_INVALID(x) | BIT_BCN_ERR_CNT_INVALID(v)) -+ -+/* 2 REG_BCN_ERR_CNT_OTHERS (Offset 0x152C) */ -+ -+#define BIT_SHIFT_BCN_ERR_CNT_OTHERS 0 -+#define BIT_MASK_BCN_ERR_CNT_OTHERS 0xff -+#define BIT_BCN_ERR_CNT_OTHERS(x) \ -+ (((x) & BIT_MASK_BCN_ERR_CNT_OTHERS) << BIT_SHIFT_BCN_ERR_CNT_OTHERS) -+#define BITS_BCN_ERR_CNT_OTHERS \ -+ (BIT_MASK_BCN_ERR_CNT_OTHERS << BIT_SHIFT_BCN_ERR_CNT_OTHERS) -+#define BIT_CLEAR_BCN_ERR_CNT_OTHERS(x) ((x) & (~BITS_BCN_ERR_CNT_OTHERS)) -+#define BIT_GET_BCN_ERR_CNT_OTHERS(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_CNT_OTHERS) & BIT_MASK_BCN_ERR_CNT_OTHERS) -+#define BIT_SET_BCN_ERR_CNT_OTHERS(x, v) \ -+ (BIT_CLEAR_BCN_ERR_CNT_OTHERS(x) | BIT_BCN_ERR_CNT_OTHERS(v)) -+ -+/* 2 REG_RX_BCN_TIMER (Offset 0x152D) */ -+ -+#define BIT_SHIFT_RX_BCN_TIMER 0 -+#define BIT_MASK_RX_BCN_TIMER 0xffff -+#define BIT_RX_BCN_TIMER(x) \ -+ (((x) & BIT_MASK_RX_BCN_TIMER) << BIT_SHIFT_RX_BCN_TIMER) -+#define BITS_RX_BCN_TIMER (BIT_MASK_RX_BCN_TIMER << BIT_SHIFT_RX_BCN_TIMER) -+#define BIT_CLEAR_RX_BCN_TIMER(x) ((x) & (~BITS_RX_BCN_TIMER)) -+#define BIT_GET_RX_BCN_TIMER(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TIMER) & BIT_MASK_RX_BCN_TIMER) -+#define BIT_SET_RX_BCN_TIMER(x, v) \ -+ (BIT_CLEAR_RX_BCN_TIMER(x) | BIT_RX_BCN_TIMER(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_TSF_SYN_COMPARE_VALUE_L (Offset 0x1530) */ -+ -+#define BIT_SHIFT_TSF_SYN_COMPARE_VALUE_L 0 -+#define BIT_MASK_TSF_SYN_COMPARE_VALUE_L 0xffffffffL -+#define BIT_TSF_SYN_COMPARE_VALUE_L(x) \ -+ (((x) & BIT_MASK_TSF_SYN_COMPARE_VALUE_L) \ -+ << BIT_SHIFT_TSF_SYN_COMPARE_VALUE_L) -+#define BITS_TSF_SYN_COMPARE_VALUE_L \ -+ (BIT_MASK_TSF_SYN_COMPARE_VALUE_L << BIT_SHIFT_TSF_SYN_COMPARE_VALUE_L) -+#define BIT_CLEAR_TSF_SYN_COMPARE_VALUE_L(x) \ -+ ((x) & (~BITS_TSF_SYN_COMPARE_VALUE_L)) -+#define BIT_GET_TSF_SYN_COMPARE_VALUE_L(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYN_COMPARE_VALUE_L) & \ -+ BIT_MASK_TSF_SYN_COMPARE_VALUE_L) -+#define BIT_SET_TSF_SYN_COMPARE_VALUE_L(x, v) \ -+ (BIT_CLEAR_TSF_SYN_COMPARE_VALUE_L(x) | BIT_TSF_SYN_COMPARE_VALUE_L(v)) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_TSF_SYN_COMPARE_VALUE (Offset 0x1530) */ -+ -+#define BIT_SHIFT_TSF_SYN_COMPARE_VALUE 0 -+#define BIT_MASK_TSF_SYN_COMPARE_VALUE 0xffffffffffffffffL -+#define BIT_TSF_SYN_COMPARE_VALUE(x) \ -+ (((x) & BIT_MASK_TSF_SYN_COMPARE_VALUE) \ -+ << BIT_SHIFT_TSF_SYN_COMPARE_VALUE) -+#define BITS_TSF_SYN_COMPARE_VALUE \ -+ (BIT_MASK_TSF_SYN_COMPARE_VALUE << BIT_SHIFT_TSF_SYN_COMPARE_VALUE) -+#define BIT_CLEAR_TSF_SYN_COMPARE_VALUE(x) ((x) & (~BITS_TSF_SYN_COMPARE_VALUE)) -+#define BIT_GET_TSF_SYN_COMPARE_VALUE(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYN_COMPARE_VALUE) & \ -+ BIT_MASK_TSF_SYN_COMPARE_VALUE) -+#define BIT_SET_TSF_SYN_COMPARE_VALUE(x, v) \ -+ (BIT_CLEAR_TSF_SYN_COMPARE_VALUE(x) | BIT_TSF_SYN_COMPARE_VALUE(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_TSF_SYN_COMPARE_VALUE_H (Offset 0x1534) */ -+ -+#define BIT_SHIFT_TSF_SYN_COMPARE_VALUE_H 0 -+#define BIT_MASK_TSF_SYN_COMPARE_VALUE_H 0xffffffffL -+#define BIT_TSF_SYN_COMPARE_VALUE_H(x) \ -+ (((x) & BIT_MASK_TSF_SYN_COMPARE_VALUE_H) \ -+ << BIT_SHIFT_TSF_SYN_COMPARE_VALUE_H) -+#define BITS_TSF_SYN_COMPARE_VALUE_H \ -+ (BIT_MASK_TSF_SYN_COMPARE_VALUE_H << BIT_SHIFT_TSF_SYN_COMPARE_VALUE_H) -+#define BIT_CLEAR_TSF_SYN_COMPARE_VALUE_H(x) \ -+ ((x) & (~BITS_TSF_SYN_COMPARE_VALUE_H)) -+#define BIT_GET_TSF_SYN_COMPARE_VALUE_H(x) \ -+ (((x) >> BIT_SHIFT_TSF_SYN_COMPARE_VALUE_H) & \ -+ BIT_MASK_TSF_SYN_COMPARE_VALUE_H) -+#define BIT_SET_TSF_SYN_COMPARE_VALUE_H(x, v) \ -+ (BIT_CLEAR_TSF_SYN_COMPARE_VALUE_H(x) | BIT_TSF_SYN_COMPARE_VALUE_H(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SUB_BCN_SPACE (Offset 0x1534) */ -+ -+#define BIT_SHIFT_SUB_BCN_SPACE_V2 0 -+#define BIT_MASK_SUB_BCN_SPACE_V2 0xff -+#define BIT_SUB_BCN_SPACE_V2(x) \ -+ (((x) & BIT_MASK_SUB_BCN_SPACE_V2) << BIT_SHIFT_SUB_BCN_SPACE_V2) -+#define BITS_SUB_BCN_SPACE_V2 \ -+ (BIT_MASK_SUB_BCN_SPACE_V2 << BIT_SHIFT_SUB_BCN_SPACE_V2) -+#define BIT_CLEAR_SUB_BCN_SPACE_V2(x) ((x) & (~BITS_SUB_BCN_SPACE_V2)) -+#define BIT_GET_SUB_BCN_SPACE_V2(x) \ -+ (((x) >> BIT_SHIFT_SUB_BCN_SPACE_V2) & BIT_MASK_SUB_BCN_SPACE_V2) -+#define BIT_SET_SUB_BCN_SPACE_V2(x, v) \ -+ (BIT_CLEAR_SUB_BCN_SPACE_V2(x) | BIT_SUB_BCN_SPACE_V2(v)) -+ -+/* 2 REG_MBID_NUM_V1 (Offset 0x1535) */ -+ -+#define BIT_SHIFT_BCN_ERR_PORT_SEL 4 -+#define BIT_MASK_BCN_ERR_PORT_SEL 0xf -+#define BIT_BCN_ERR_PORT_SEL(x) \ -+ (((x) & BIT_MASK_BCN_ERR_PORT_SEL) << BIT_SHIFT_BCN_ERR_PORT_SEL) -+#define BITS_BCN_ERR_PORT_SEL \ -+ (BIT_MASK_BCN_ERR_PORT_SEL << BIT_SHIFT_BCN_ERR_PORT_SEL) -+#define BIT_CLEAR_BCN_ERR_PORT_SEL(x) ((x) & (~BITS_BCN_ERR_PORT_SEL)) -+#define BIT_GET_BCN_ERR_PORT_SEL(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_PORT_SEL) & BIT_MASK_BCN_ERR_PORT_SEL) -+#define BIT_SET_BCN_ERR_PORT_SEL(x, v) \ -+ (BIT_CLEAR_BCN_ERR_PORT_SEL(x) | BIT_BCN_ERR_PORT_SEL(v)) -+ -+#define BIT_SHIFT_MBID_BCN_NUM_V1 0 -+#define BIT_MASK_MBID_BCN_NUM_V1 0xf -+#define BIT_MBID_BCN_NUM_V1(x) \ -+ (((x) & BIT_MASK_MBID_BCN_NUM_V1) << BIT_SHIFT_MBID_BCN_NUM_V1) -+#define BITS_MBID_BCN_NUM_V1 \ -+ (BIT_MASK_MBID_BCN_NUM_V1 << BIT_SHIFT_MBID_BCN_NUM_V1) -+#define BIT_CLEAR_MBID_BCN_NUM_V1(x) ((x) & (~BITS_MBID_BCN_NUM_V1)) -+#define BIT_GET_MBID_BCN_NUM_V1(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCN_NUM_V1) & BIT_MASK_MBID_BCN_NUM_V1) -+#define BIT_SET_MBID_BCN_NUM_V1(x, v) \ -+ (BIT_CLEAR_MBID_BCN_NUM_V1(x) | BIT_MBID_BCN_NUM_V1(v)) -+ -+/* 2 REG_MBSSID_CTRL_V1 (Offset 0x1536) */ -+ -+#define BIT_MBID_BCNQ15_EN BIT(15) -+#define BIT_MBID_BCNQ14_EN BIT(14) -+#define BIT_MBID_BCNQ13_EN BIT(13) -+#define BIT_MBID_BCNQ12_EN BIT(12) -+#define BIT_MBID_BCNQ11_EN BIT(11) -+#define BIT_MBID_BCNQ10_EN BIT(10) -+#define BIT_MBID_BCNQ9_EN BIT(9) -+#define BIT_MBID_BCNQ8_EN BIT(8) -+ -+/* 2 REG_BW_CFG (Offset 0x1539) */ -+ -+#define BIT_SLEEP_32K_EN BIT(3) -+#define BIT_DIS_MARK_TSF_US_V1 BIT(2) -+ -+/* 2 REG_ATIMWND_CFG (Offset 0x153A) */ -+ -+#define BIT_SHIFT_ATIMWND_V1 0 -+#define BIT_MASK_ATIMWND_V1 0xff -+#define BIT_ATIMWND_V1(x) (((x) & BIT_MASK_ATIMWND_V1) << BIT_SHIFT_ATIMWND_V1) -+#define BITS_ATIMWND_V1 (BIT_MASK_ATIMWND_V1 << BIT_SHIFT_ATIMWND_V1) -+#define BIT_CLEAR_ATIMWND_V1(x) ((x) & (~BITS_ATIMWND_V1)) -+#define BIT_GET_ATIMWND_V1(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND_V1) & BIT_MASK_ATIMWND_V1) -+#define BIT_SET_ATIMWND_V1(x, v) (BIT_CLEAR_ATIMWND_V1(x) | BIT_ATIMWND_V1(v)) -+ -+/* 2 REG_DTIM_COUNTER_CFG (Offset 0x153B) */ -+ -+#define BIT_SHIFT_DTIM_COUNT 0 -+#define BIT_MASK_DTIM_COUNT 0xff -+#define BIT_DTIM_COUNT(x) (((x) & BIT_MASK_DTIM_COUNT) << BIT_SHIFT_DTIM_COUNT) -+#define BITS_DTIM_COUNT (BIT_MASK_DTIM_COUNT << BIT_SHIFT_DTIM_COUNT) -+#define BIT_CLEAR_DTIM_COUNT(x) ((x) & (~BITS_DTIM_COUNT)) -+#define BIT_GET_DTIM_COUNT(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT) & BIT_MASK_DTIM_COUNT) -+#define BIT_SET_DTIM_COUNT(x, v) (BIT_CLEAR_DTIM_COUNT(x) | BIT_DTIM_COUNT(v)) -+ -+/* 2 REG_ATIM_DTIM_CTRL_SEL (Offset 0x153C) */ -+ -+#define BIT_DTIM_BYPASS_V1 BIT(7) -+ -+#define BIT_SHIFT_ATIM_DTIM_SEL 0 -+#define BIT_MASK_ATIM_DTIM_SEL 0x1f -+#define BIT_ATIM_DTIM_SEL(x) \ -+ (((x) & BIT_MASK_ATIM_DTIM_SEL) << BIT_SHIFT_ATIM_DTIM_SEL) -+#define BITS_ATIM_DTIM_SEL (BIT_MASK_ATIM_DTIM_SEL << BIT_SHIFT_ATIM_DTIM_SEL) -+#define BIT_CLEAR_ATIM_DTIM_SEL(x) ((x) & (~BITS_ATIM_DTIM_SEL)) -+#define BIT_GET_ATIM_DTIM_SEL(x) \ -+ (((x) >> BIT_SHIFT_ATIM_DTIM_SEL) & BIT_MASK_ATIM_DTIM_SEL) -+#define BIT_SET_ATIM_DTIM_SEL(x, v) \ -+ (BIT_CLEAR_ATIM_DTIM_SEL(x) | BIT_ATIM_DTIM_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+/* 2 REG_ATIMUGT_V1 (Offset 0x153D) */ -+ -+#define BIT_SHIFT_ATIM_URGENT 0 -+#define BIT_MASK_ATIM_URGENT 0xff -+#define BIT_ATIM_URGENT(x) \ -+ (((x) & BIT_MASK_ATIM_URGENT) << BIT_SHIFT_ATIM_URGENT) -+#define BITS_ATIM_URGENT (BIT_MASK_ATIM_URGENT << BIT_SHIFT_ATIM_URGENT) -+#define BIT_CLEAR_ATIM_URGENT(x) ((x) & (~BITS_ATIM_URGENT)) -+#define BIT_GET_ATIM_URGENT(x) \ -+ (((x) >> BIT_SHIFT_ATIM_URGENT) & BIT_MASK_ATIM_URGENT) -+#define BIT_SET_ATIM_URGENT(x, v) \ -+ (BIT_CLEAR_ATIM_URGENT(x) | BIT_ATIM_URGENT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DIS_ATIM_V1 (Offset 0x1540) */ -+ -+#define BIT_DIS_ATIM_P4 BIT(19) -+#define BIT_DIS_ATIM_P3 BIT(18) -+#define BIT_DIS_ATIM_P2 BIT(17) -+#define BIT_DIS_ATIM_P1 BIT(16) -+#define BIT_DIS_ATIM_VAP15 BIT(15) -+#define BIT_DIS_ATIM_VAP14 BIT(14) -+#define BIT_DIS_ATIM_VAP13 BIT(13) -+#define BIT_DIS_ATIM_VAP12 BIT(12) -+#define BIT_DIS_ATIM_VAP11 BIT(11) -+#define BIT_DIS_ATIM_VAP10 BIT(10) -+#define BIT_DIS_ATIM_VAP9 BIT(9) -+#define BIT_DIS_ATIM_VAP8 BIT(8) -+#define BIT_DIS_ATIM_ROOT_P0 BIT(0) -+ -+/* 2 REG_HIQ_NO_LMT_EN_V1 (Offset 0x1544) */ -+ -+#define BIT_HIQ_NO_LMT_EN_P4 BIT(19) -+#define BIT_HIQ_NO_LMT_EN_P3 BIT(18) -+#define BIT_HIQ_NO_LMT_EN_P2 BIT(17) -+#define BIT_HIQ_NO_LMT_EN_P1 BIT(16) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIQ_NO_LMT_EN_V1 (Offset 0x1544) */ -+ -+#define BIT_HIQ_NO_LMT_EN_VAP15 BIT(15) -+#define BIT_HIQ_NO_LMT_EN_VAP14 BIT(14) -+#define BIT_HIQ_NO_LMT_EN_VAP13 BIT(13) -+#define BIT_HIQ_NO_LMT_EN_VAP12 BIT(12) -+#define BIT_HIQ_NO_LMT_EN_VAP11 BIT(11) -+#define BIT_HIQ_NO_LMT_EN_VAP10 BIT(10) -+#define BIT_HIQ_NO_LMT_EN_VAP9 BIT(9) -+#define BIT_HIQ_NO_LMT_EN_VAP8 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_HIQ_NO_LMT_EN_V1 (Offset 0x1544) */ -+ -+#define BIT_HIQ_NO_LMT_EN_ROOT_P0 BIT(0) -+ -+/* 2 REG_P2PPS_CTRL_V1 (Offset 0x1548) */ -+ -+#define BIT_P2P_PWR_RST1_V2 BIT(15) -+#define BIT_P2P_PWR_RST0_V2 BIT(14) -+#define BIT_EN_TSFBIT32_RST_P2P_V1 BIT(13) -+ -+#define BIT_SHIFT_NOA_UNIT0_SEL_V1 8 -+#define BIT_MASK_NOA_UNIT0_SEL_V1 0x7 -+#define BIT_NOA_UNIT0_SEL_V1(x) \ -+ (((x) & BIT_MASK_NOA_UNIT0_SEL_V1) << BIT_SHIFT_NOA_UNIT0_SEL_V1) -+#define BITS_NOA_UNIT0_SEL_V1 \ -+ (BIT_MASK_NOA_UNIT0_SEL_V1 << BIT_SHIFT_NOA_UNIT0_SEL_V1) -+#define BIT_CLEAR_NOA_UNIT0_SEL_V1(x) ((x) & (~BITS_NOA_UNIT0_SEL_V1)) -+#define BIT_GET_NOA_UNIT0_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT0_SEL_V1) & BIT_MASK_NOA_UNIT0_SEL_V1) -+#define BIT_SET_NOA_UNIT0_SEL_V1(x, v) \ -+ (BIT_CLEAR_NOA_UNIT0_SEL_V1(x) | BIT_NOA_UNIT0_SEL_V1(v)) -+ -+#define BIT_P2P_CTW_ALLSTASLEEP_V1 BIT(7) -+#define BIT_P2P_OFF_DISTX_EN_V1 BIT(6) -+#define BIT_PWR_MGT_EN_V1 BIT(5) -+#define BIT_P2P_NOA1_EN_V1 BIT(2) -+#define BIT_P2P_NOA0_EN_V1 BIT(1) -+ -+/* 2 REG_P2PPS1_CTRL_V1 (Offset 0x154C) */ -+ -+#define BIT_P2P1_PWR_RST1_V2 BIT(15) -+#define BIT_P2P1_PWR_RST0_V2 BIT(14) -+#define BIT_EN_TSFBIT32_RST_P2P1_V1 BIT(13) -+ -+#define BIT_SHIFT_NOA_UNIT1_SEL_V1 8 -+#define BIT_MASK_NOA_UNIT1_SEL_V1 0x7 -+#define BIT_NOA_UNIT1_SEL_V1(x) \ -+ (((x) & BIT_MASK_NOA_UNIT1_SEL_V1) << BIT_SHIFT_NOA_UNIT1_SEL_V1) -+#define BITS_NOA_UNIT1_SEL_V1 \ -+ (BIT_MASK_NOA_UNIT1_SEL_V1 << BIT_SHIFT_NOA_UNIT1_SEL_V1) -+#define BIT_CLEAR_NOA_UNIT1_SEL_V1(x) ((x) & (~BITS_NOA_UNIT1_SEL_V1)) -+#define BIT_GET_NOA_UNIT1_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT1_SEL_V1) & BIT_MASK_NOA_UNIT1_SEL_V1) -+#define BIT_SET_NOA_UNIT1_SEL_V1(x, v) \ -+ (BIT_CLEAR_NOA_UNIT1_SEL_V1(x) | BIT_NOA_UNIT1_SEL_V1(v)) -+ -+#define BIT_P2P1_CTW_ALLSTASLEEP_V1 BIT(7) -+#define BIT_P2P1_PWR_MGT_EN_V1 BIT(5) -+#define BIT_P2P1_NOA1_EN_V1 BIT(2) -+#define BIT_P2P1_NOA0_EN_V1 BIT(1) -+ -+/* 2 REG_P2PPS1_SPEC_STATE_V1 (Offset 0x154E) */ -+ -+#define BIT_P2P1_SPEC_POWER_STATEP BIT(7) -+#define BIT_P2P1_SPEC_BEACON_AREA_ON BIT(5) -+ -+/* 2 REG_P2PPS2_CTRL_V1 (Offset 0x1550) */ -+ -+#define BIT_P2P2_PWR_RST1_V2 BIT(15) -+#define BIT_P2P2_PWR_RST0_V2 BIT(14) -+#define BIT_EN_TSFBIT32_RST_P2P2_V1 BIT(13) -+ -+#define BIT_SHIFT_NOA_UNIT2_SEL_V1 8 -+#define BIT_MASK_NOA_UNIT2_SEL_V1 0x7 -+#define BIT_NOA_UNIT2_SEL_V1(x) \ -+ (((x) & BIT_MASK_NOA_UNIT2_SEL_V1) << BIT_SHIFT_NOA_UNIT2_SEL_V1) -+#define BITS_NOA_UNIT2_SEL_V1 \ -+ (BIT_MASK_NOA_UNIT2_SEL_V1 << BIT_SHIFT_NOA_UNIT2_SEL_V1) -+#define BIT_CLEAR_NOA_UNIT2_SEL_V1(x) ((x) & (~BITS_NOA_UNIT2_SEL_V1)) -+#define BIT_GET_NOA_UNIT2_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT2_SEL_V1) & BIT_MASK_NOA_UNIT2_SEL_V1) -+#define BIT_SET_NOA_UNIT2_SEL_V1(x, v) \ -+ (BIT_CLEAR_NOA_UNIT2_SEL_V1(x) | BIT_NOA_UNIT2_SEL_V1(v)) -+ -+#define BIT_P2P2_CTW_ALLSTASLEEP_V1 BIT(7) -+#define BIT_P2P2_OFF_DISTX_EN_V1 BIT(6) -+#define BIT_P2P2_PWR_MGT_EN_V1 BIT(5) -+#define BIT_P2P2_NOA1_EN_V1 BIT(2) -+#define BIT_P2P2_NOA0_EN_V1 BIT(1) -+ -+/* 2 REG_P2PPS2_SPEC_STATE_V1 (Offset 0x1552) */ -+ -+#define BIT_P2P2_SPEC_POWER_STATEP BIT(7) -+#define BIT_P2P2_SPEC_BEACON_AREA_ON BIT(5) -+ -+/* 2 REG_CHG_POWER_BCN_AREA (Offset 0x1556) */ -+ -+#define BIT_CHG_POWER_BCN_AREA BIT(0) -+ -+/* 2 REG_NOA_SEL (Offset 0x1557) */ -+ -+#define BIT_SHIFT_NOA_SEL_V1 0 -+#define BIT_MASK_NOA_SEL_V1 0x7 -+#define BIT_NOA_SEL_V1(x) (((x) & BIT_MASK_NOA_SEL_V1) << BIT_SHIFT_NOA_SEL_V1) -+#define BITS_NOA_SEL_V1 (BIT_MASK_NOA_SEL_V1 << BIT_SHIFT_NOA_SEL_V1) -+#define BIT_CLEAR_NOA_SEL_V1(x) ((x) & (~BITS_NOA_SEL_V1)) -+#define BIT_GET_NOA_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_NOA_SEL_V1) & BIT_MASK_NOA_SEL_V1) -+#define BIT_SET_NOA_SEL_V1(x, v) (BIT_CLEAR_NOA_SEL_V1(x) | BIT_NOA_SEL_V1(v)) -+ -+/* 2 REG_NOA_PARAM_3_V1 (Offset 0x1564) */ -+ -+#define BIT_SHIFT_NOA_COUNT_V2 0 -+#define BIT_MASK_NOA_COUNT_V2 0xffffffffL -+#define BIT_NOA_COUNT_V2(x) \ -+ (((x) & BIT_MASK_NOA_COUNT_V2) << BIT_SHIFT_NOA_COUNT_V2) -+#define BITS_NOA_COUNT_V2 (BIT_MASK_NOA_COUNT_V2 << BIT_SHIFT_NOA_COUNT_V2) -+#define BIT_CLEAR_NOA_COUNT_V2(x) ((x) & (~BITS_NOA_COUNT_V2)) -+#define BIT_GET_NOA_COUNT_V2(x) \ -+ (((x) >> BIT_SHIFT_NOA_COUNT_V2) & BIT_MASK_NOA_COUNT_V2) -+#define BIT_SET_NOA_COUNT_V2(x, v) \ -+ (BIT_CLEAR_NOA_COUNT_V2(x) | BIT_NOA_COUNT_V2(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_P2PPS_HW_AUTO_PAUSE_CTRL (Offset 0x156C) */ -+ -+#define BIT_P2PPS_NOA_STOP_TX_HANG BIT(31) -+#define BIT_P2PPS_MACID_PAUSE_EN BIT(11) -+#define BIT_P2PPS__MGQ_PAUSE BIT(10) -+#define BIT_P2PPS__HIQ_PAUSE BIT(9) -+#define BIT_P2PPS__BCNQ_PAUSE BIT(8) -+ -+#define BIT_SHIFT_P2PPS_MACID_PAUSE 0 -+#define BIT_MASK_P2PPS_MACID_PAUSE 0xff -+#define BIT_P2PPS_MACID_PAUSE(x) \ -+ (((x) & BIT_MASK_P2PPS_MACID_PAUSE) << BIT_SHIFT_P2PPS_MACID_PAUSE) -+#define BITS_P2PPS_MACID_PAUSE \ -+ (BIT_MASK_P2PPS_MACID_PAUSE << BIT_SHIFT_P2PPS_MACID_PAUSE) -+#define BIT_CLEAR_P2PPS_MACID_PAUSE(x) ((x) & (~BITS_P2PPS_MACID_PAUSE)) -+#define BIT_GET_P2PPS_MACID_PAUSE(x) \ -+ (((x) >> BIT_SHIFT_P2PPS_MACID_PAUSE) & BIT_MASK_P2PPS_MACID_PAUSE) -+#define BIT_SET_P2PPS_MACID_PAUSE(x, v) \ -+ (BIT_CLEAR_P2PPS_MACID_PAUSE(x) | BIT_P2PPS_MACID_PAUSE(v)) -+ -+/* 2 REG_P2PPS1_HW_AUTO_PAUSE_CTRL (Offset 0x1570) */ -+ -+#define BIT_P2PPS1_NOA_STOP_TX_HANG BIT(31) -+#define BIT_P2PPS1_MACID_PAUSE_EN BIT(11) -+#define BIT_P2PPS1__MGQ_PAUSE BIT(10) -+#define BIT_P2PPS1__HIQ_PAUSE BIT(9) -+#define BIT_P2PPS1__BCNQ_PAUSE BIT(8) -+ -+#define BIT_SHIFT_P2PPS1_MACID_PAUSE 0 -+#define BIT_MASK_P2PPS1_MACID_PAUSE 0xff -+#define BIT_P2PPS1_MACID_PAUSE(x) \ -+ (((x) & BIT_MASK_P2PPS1_MACID_PAUSE) << BIT_SHIFT_P2PPS1_MACID_PAUSE) -+#define BITS_P2PPS1_MACID_PAUSE \ -+ (BIT_MASK_P2PPS1_MACID_PAUSE << BIT_SHIFT_P2PPS1_MACID_PAUSE) -+#define BIT_CLEAR_P2PPS1_MACID_PAUSE(x) ((x) & (~BITS_P2PPS1_MACID_PAUSE)) -+#define BIT_GET_P2PPS1_MACID_PAUSE(x) \ -+ (((x) >> BIT_SHIFT_P2PPS1_MACID_PAUSE) & BIT_MASK_P2PPS1_MACID_PAUSE) -+#define BIT_SET_P2PPS1_MACID_PAUSE(x, v) \ -+ (BIT_CLEAR_P2PPS1_MACID_PAUSE(x) | BIT_P2PPS1_MACID_PAUSE(v)) -+ -+/* 2 REG_P2PPS2_HW_AUTO_PAUSE_CTRL (Offset 0x1574) */ -+ -+#define BIT_P2PPS2_NOA_STOP_TX_HANG BIT(31) -+#define BIT_P2PPS2_MACID_PAUSE_EN BIT(11) -+#define BIT_P2PPS2__MGQ_PAUSE BIT(10) -+#define BIT_P2PPS2__HIQ_PAUSE BIT(9) -+#define BIT_P2PPS2__BCNQ_PAUSE BIT(8) -+ -+#define BIT_SHIFT_P2PPS2_MACID_PAUSE 0 -+#define BIT_MASK_P2PPS2_MACID_PAUSE 0xff -+#define BIT_P2PPS2_MACID_PAUSE(x) \ -+ (((x) & BIT_MASK_P2PPS2_MACID_PAUSE) << BIT_SHIFT_P2PPS2_MACID_PAUSE) -+#define BITS_P2PPS2_MACID_PAUSE \ -+ (BIT_MASK_P2PPS2_MACID_PAUSE << BIT_SHIFT_P2PPS2_MACID_PAUSE) -+#define BIT_CLEAR_P2PPS2_MACID_PAUSE(x) ((x) & (~BITS_P2PPS2_MACID_PAUSE)) -+#define BIT_GET_P2PPS2_MACID_PAUSE(x) \ -+ (((x) >> BIT_SHIFT_P2PPS2_MACID_PAUSE) & BIT_MASK_P2PPS2_MACID_PAUSE) -+#define BIT_SET_P2PPS2_MACID_PAUSE(x, v) \ -+ (BIT_CLEAR_P2PPS2_MACID_PAUSE(x) | BIT_P2PPS2_MACID_PAUSE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_RX_TBTT_SHIFT (Offset 0x1578) */ -+ -+#define BIT_SHIFT_RX_TBTT_SHIFT_SEL 24 -+#define BIT_MASK_RX_TBTT_SHIFT_SEL 0x7 -+#define BIT_RX_TBTT_SHIFT_SEL(x) \ -+ (((x) & BIT_MASK_RX_TBTT_SHIFT_SEL) << BIT_SHIFT_RX_TBTT_SHIFT_SEL) -+#define BITS_RX_TBTT_SHIFT_SEL \ -+ (BIT_MASK_RX_TBTT_SHIFT_SEL << BIT_SHIFT_RX_TBTT_SHIFT_SEL) -+#define BIT_CLEAR_RX_TBTT_SHIFT_SEL(x) ((x) & (~BITS_RX_TBTT_SHIFT_SEL)) -+#define BIT_GET_RX_TBTT_SHIFT_SEL(x) \ -+ (((x) >> BIT_SHIFT_RX_TBTT_SHIFT_SEL) & BIT_MASK_RX_TBTT_SHIFT_SEL) -+#define BIT_SET_RX_TBTT_SHIFT_SEL(x, v) \ -+ (BIT_CLEAR_RX_TBTT_SHIFT_SEL(x) | BIT_RX_TBTT_SHIFT_SEL(v)) -+ -+#define BIT_RX_TBTT_SHIFT_RW_FLAG BIT(15) -+ -+#define BIT_SHIFT_RX_TBTT_SHIFT_OFFSET 0 -+#define BIT_MASK_RX_TBTT_SHIFT_OFFSET 0xfff -+#define BIT_RX_TBTT_SHIFT_OFFSET(x) \ -+ (((x) & BIT_MASK_RX_TBTT_SHIFT_OFFSET) \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_OFFSET) -+#define BITS_RX_TBTT_SHIFT_OFFSET \ -+ (BIT_MASK_RX_TBTT_SHIFT_OFFSET << BIT_SHIFT_RX_TBTT_SHIFT_OFFSET) -+#define BIT_CLEAR_RX_TBTT_SHIFT_OFFSET(x) ((x) & (~BITS_RX_TBTT_SHIFT_OFFSET)) -+#define BIT_GET_RX_TBTT_SHIFT_OFFSET(x) \ -+ (((x) >> BIT_SHIFT_RX_TBTT_SHIFT_OFFSET) & \ -+ BIT_MASK_RX_TBTT_SHIFT_OFFSET) -+#define BIT_SET_RX_TBTT_SHIFT_OFFSET(x, v) \ -+ (BIT_CLEAR_RX_TBTT_SHIFT_OFFSET(x) | BIT_RX_TBTT_SHIFT_OFFSET(v)) -+ -+/* 2 REG_FREERUN_CNT_LOW (Offset 0x1580) */ -+ -+#define BIT_SHIFT_FREERUN_CNT_LOW 0 -+#define BIT_MASK_FREERUN_CNT_LOW 0xffffffffL -+#define BIT_FREERUN_CNT_LOW(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_LOW) << BIT_SHIFT_FREERUN_CNT_LOW) -+#define BITS_FREERUN_CNT_LOW \ -+ (BIT_MASK_FREERUN_CNT_LOW << BIT_SHIFT_FREERUN_CNT_LOW) -+#define BIT_CLEAR_FREERUN_CNT_LOW(x) ((x) & (~BITS_FREERUN_CNT_LOW)) -+#define BIT_GET_FREERUN_CNT_LOW(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_LOW) & BIT_MASK_FREERUN_CNT_LOW) -+#define BIT_SET_FREERUN_CNT_LOW(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_LOW(x) | BIT_FREERUN_CNT_LOW(v)) -+ -+/* 2 REG_FREERUN_CNT_HIGH (Offset 0x1584) */ -+ -+#define BIT_SHIFT_FREERUN_CNT_HIGH 0 -+#define BIT_MASK_FREERUN_CNT_HIGH 0xffffffffL -+#define BIT_FREERUN_CNT_HIGH(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_HIGH) << BIT_SHIFT_FREERUN_CNT_HIGH) -+#define BITS_FREERUN_CNT_HIGH \ -+ (BIT_MASK_FREERUN_CNT_HIGH << BIT_SHIFT_FREERUN_CNT_HIGH) -+#define BIT_CLEAR_FREERUN_CNT_HIGH(x) ((x) & (~BITS_FREERUN_CNT_HIGH)) -+#define BIT_GET_FREERUN_CNT_HIGH(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_HIGH) & BIT_MASK_FREERUN_CNT_HIGH) -+#define BIT_SET_FREERUN_CNT_HIGH(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_HIGH(x) | BIT_FREERUN_CNT_HIGH(v)) -+ -+/* 2 REG_PS_TIMER_0 (Offset 0x158C) */ -+ -+#define BIT_SHIFT_PS_TIMER_0 0 -+#define BIT_MASK_PS_TIMER_0 0xffffffffL -+#define BIT_PS_TIMER_0(x) (((x) & BIT_MASK_PS_TIMER_0) << BIT_SHIFT_PS_TIMER_0) -+#define BITS_PS_TIMER_0 (BIT_MASK_PS_TIMER_0 << BIT_SHIFT_PS_TIMER_0) -+#define BIT_CLEAR_PS_TIMER_0(x) ((x) & (~BITS_PS_TIMER_0)) -+#define BIT_GET_PS_TIMER_0(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_0) & BIT_MASK_PS_TIMER_0) -+#define BIT_SET_PS_TIMER_0(x, v) (BIT_CLEAR_PS_TIMER_0(x) | BIT_PS_TIMER_0(v)) -+ -+/* 2 REG_PS_TIMER_1 (Offset 0x1590) */ -+ -+#define BIT_SHIFT_PS_TIMER_1 0 -+#define BIT_MASK_PS_TIMER_1 0xffffffffL -+#define BIT_PS_TIMER_1(x) (((x) & BIT_MASK_PS_TIMER_1) << BIT_SHIFT_PS_TIMER_1) -+#define BITS_PS_TIMER_1 (BIT_MASK_PS_TIMER_1 << BIT_SHIFT_PS_TIMER_1) -+#define BIT_CLEAR_PS_TIMER_1(x) ((x) & (~BITS_PS_TIMER_1)) -+#define BIT_GET_PS_TIMER_1(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_1) & BIT_MASK_PS_TIMER_1) -+#define BIT_SET_PS_TIMER_1(x, v) (BIT_CLEAR_PS_TIMER_1(x) | BIT_PS_TIMER_1(v)) -+ -+/* 2 REG_PS_TIMER_2 (Offset 0x1594) */ -+ -+#define BIT_SHIFT_PS_TIMER_2 0 -+#define BIT_MASK_PS_TIMER_2 0xffffffffL -+#define BIT_PS_TIMER_2(x) (((x) & BIT_MASK_PS_TIMER_2) << BIT_SHIFT_PS_TIMER_2) -+#define BITS_PS_TIMER_2 (BIT_MASK_PS_TIMER_2 << BIT_SHIFT_PS_TIMER_2) -+#define BIT_CLEAR_PS_TIMER_2(x) ((x) & (~BITS_PS_TIMER_2)) -+#define BIT_GET_PS_TIMER_2(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_2) & BIT_MASK_PS_TIMER_2) -+#define BIT_SET_PS_TIMER_2(x, v) (BIT_CLEAR_PS_TIMER_2(x) | BIT_PS_TIMER_2(v)) -+ -+/* 2 REG_PS_TIMER_3 (Offset 0x1598) */ -+ -+#define BIT_SHIFT_PS_TIMER_3 0 -+#define BIT_MASK_PS_TIMER_3 0xffffffffL -+#define BIT_PS_TIMER_3(x) (((x) & BIT_MASK_PS_TIMER_3) << BIT_SHIFT_PS_TIMER_3) -+#define BITS_PS_TIMER_3 (BIT_MASK_PS_TIMER_3 << BIT_SHIFT_PS_TIMER_3) -+#define BIT_CLEAR_PS_TIMER_3(x) ((x) & (~BITS_PS_TIMER_3)) -+#define BIT_GET_PS_TIMER_3(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_3) & BIT_MASK_PS_TIMER_3) -+#define BIT_SET_PS_TIMER_3(x, v) (BIT_CLEAR_PS_TIMER_3(x) | BIT_PS_TIMER_3(v)) -+ -+/* 2 REG_PS_TIMER_4 (Offset 0x159C) */ -+ -+#define BIT_SHIFT_PS_TIMER_4 0 -+#define BIT_MASK_PS_TIMER_4 0xffffffffL -+#define BIT_PS_TIMER_4(x) (((x) & BIT_MASK_PS_TIMER_4) << BIT_SHIFT_PS_TIMER_4) -+#define BITS_PS_TIMER_4 (BIT_MASK_PS_TIMER_4 << BIT_SHIFT_PS_TIMER_4) -+#define BIT_CLEAR_PS_TIMER_4(x) ((x) & (~BITS_PS_TIMER_4)) -+#define BIT_GET_PS_TIMER_4(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_4) & BIT_MASK_PS_TIMER_4) -+#define BIT_SET_PS_TIMER_4(x, v) (BIT_CLEAR_PS_TIMER_4(x) | BIT_PS_TIMER_4(v)) -+ -+/* 2 REG_PS_TIMER_5 (Offset 0x15A0) */ -+ -+#define BIT_SHIFT_PS_TIMER_5 0 -+#define BIT_MASK_PS_TIMER_5 0xffffffffL -+#define BIT_PS_TIMER_5(x) (((x) & BIT_MASK_PS_TIMER_5) << BIT_SHIFT_PS_TIMER_5) -+#define BITS_PS_TIMER_5 (BIT_MASK_PS_TIMER_5 << BIT_SHIFT_PS_TIMER_5) -+#define BIT_CLEAR_PS_TIMER_5(x) ((x) & (~BITS_PS_TIMER_5)) -+#define BIT_GET_PS_TIMER_5(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_5) & BIT_MASK_PS_TIMER_5) -+#define BIT_SET_PS_TIMER_5(x, v) (BIT_CLEAR_PS_TIMER_5(x) | BIT_PS_TIMER_5(v)) -+ -+/* 2 REG_PS_TIMER_01_CTRL (Offset 0x15A4) */ -+ -+#define BIT_SHIFT_PS_TIMER_1_EARLY_TIME 24 -+#define BIT_MASK_PS_TIMER_1_EARLY_TIME 0xff -+#define BIT_PS_TIMER_1_EARLY_TIME(x) \ -+ (((x) & BIT_MASK_PS_TIMER_1_EARLY_TIME) \ -+ << BIT_SHIFT_PS_TIMER_1_EARLY_TIME) -+#define BITS_PS_TIMER_1_EARLY_TIME \ -+ (BIT_MASK_PS_TIMER_1_EARLY_TIME << BIT_SHIFT_PS_TIMER_1_EARLY_TIME) -+#define BIT_CLEAR_PS_TIMER_1_EARLY_TIME(x) ((x) & (~BITS_PS_TIMER_1_EARLY_TIME)) -+#define BIT_GET_PS_TIMER_1_EARLY_TIME(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_1_EARLY_TIME) & \ -+ BIT_MASK_PS_TIMER_1_EARLY_TIME) -+#define BIT_SET_PS_TIMER_1_EARLY_TIME(x, v) \ -+ (BIT_CLEAR_PS_TIMER_1_EARLY_TIME(x) | BIT_PS_TIMER_1_EARLY_TIME(v)) -+ -+#define BIT_PS_TIMER_1_EN BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_1_TSF_SEL 16 -+#define BIT_MASK_PS_TIMER_1_TSF_SEL 0x7 -+#define BIT_PS_TIMER_1_TSF_SEL(x) \ -+ (((x) & BIT_MASK_PS_TIMER_1_TSF_SEL) << BIT_SHIFT_PS_TIMER_1_TSF_SEL) -+#define BITS_PS_TIMER_1_TSF_SEL \ -+ (BIT_MASK_PS_TIMER_1_TSF_SEL << BIT_SHIFT_PS_TIMER_1_TSF_SEL) -+#define BIT_CLEAR_PS_TIMER_1_TSF_SEL(x) ((x) & (~BITS_PS_TIMER_1_TSF_SEL)) -+#define BIT_GET_PS_TIMER_1_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_1_TSF_SEL) & BIT_MASK_PS_TIMER_1_TSF_SEL) -+#define BIT_SET_PS_TIMER_1_TSF_SEL(x, v) \ -+ (BIT_CLEAR_PS_TIMER_1_TSF_SEL(x) | BIT_PS_TIMER_1_TSF_SEL(v)) -+ -+#define BIT_SHIFT_PS_TIMER_0_EARLY_TIME 8 -+#define BIT_MASK_PS_TIMER_0_EARLY_TIME 0xff -+#define BIT_PS_TIMER_0_EARLY_TIME(x) \ -+ (((x) & BIT_MASK_PS_TIMER_0_EARLY_TIME) \ -+ << BIT_SHIFT_PS_TIMER_0_EARLY_TIME) -+#define BITS_PS_TIMER_0_EARLY_TIME \ -+ (BIT_MASK_PS_TIMER_0_EARLY_TIME << BIT_SHIFT_PS_TIMER_0_EARLY_TIME) -+#define BIT_CLEAR_PS_TIMER_0_EARLY_TIME(x) ((x) & (~BITS_PS_TIMER_0_EARLY_TIME)) -+#define BIT_GET_PS_TIMER_0_EARLY_TIME(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_0_EARLY_TIME) & \ -+ BIT_MASK_PS_TIMER_0_EARLY_TIME) -+#define BIT_SET_PS_TIMER_0_EARLY_TIME(x, v) \ -+ (BIT_CLEAR_PS_TIMER_0_EARLY_TIME(x) | BIT_PS_TIMER_0_EARLY_TIME(v)) -+ -+#define BIT_PS_TIMER_0_EN BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_0_TSF_SEL 0 -+#define BIT_MASK_PS_TIMER_0_TSF_SEL 0x7 -+#define BIT_PS_TIMER_0_TSF_SEL(x) \ -+ (((x) & BIT_MASK_PS_TIMER_0_TSF_SEL) << BIT_SHIFT_PS_TIMER_0_TSF_SEL) -+#define BITS_PS_TIMER_0_TSF_SEL \ -+ (BIT_MASK_PS_TIMER_0_TSF_SEL << BIT_SHIFT_PS_TIMER_0_TSF_SEL) -+#define BIT_CLEAR_PS_TIMER_0_TSF_SEL(x) ((x) & (~BITS_PS_TIMER_0_TSF_SEL)) -+#define BIT_GET_PS_TIMER_0_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_0_TSF_SEL) & BIT_MASK_PS_TIMER_0_TSF_SEL) -+#define BIT_SET_PS_TIMER_0_TSF_SEL(x, v) \ -+ (BIT_CLEAR_PS_TIMER_0_TSF_SEL(x) | BIT_PS_TIMER_0_TSF_SEL(v)) -+ -+/* 2 REG_PS_TIMER_23_CTRL (Offset 0x15A8) */ -+ -+#define BIT_SHIFT_PS_TIMER_3_EARLY_TIME 24 -+#define BIT_MASK_PS_TIMER_3_EARLY_TIME 0xff -+#define BIT_PS_TIMER_3_EARLY_TIME(x) \ -+ (((x) & BIT_MASK_PS_TIMER_3_EARLY_TIME) \ -+ << BIT_SHIFT_PS_TIMER_3_EARLY_TIME) -+#define BITS_PS_TIMER_3_EARLY_TIME \ -+ (BIT_MASK_PS_TIMER_3_EARLY_TIME << BIT_SHIFT_PS_TIMER_3_EARLY_TIME) -+#define BIT_CLEAR_PS_TIMER_3_EARLY_TIME(x) ((x) & (~BITS_PS_TIMER_3_EARLY_TIME)) -+#define BIT_GET_PS_TIMER_3_EARLY_TIME(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_3_EARLY_TIME) & \ -+ BIT_MASK_PS_TIMER_3_EARLY_TIME) -+#define BIT_SET_PS_TIMER_3_EARLY_TIME(x, v) \ -+ (BIT_CLEAR_PS_TIMER_3_EARLY_TIME(x) | BIT_PS_TIMER_3_EARLY_TIME(v)) -+ -+#define BIT_PS_TIMER_3_EN BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_3_TSF_SEL 16 -+#define BIT_MASK_PS_TIMER_3_TSF_SEL 0x7 -+#define BIT_PS_TIMER_3_TSF_SEL(x) \ -+ (((x) & BIT_MASK_PS_TIMER_3_TSF_SEL) << BIT_SHIFT_PS_TIMER_3_TSF_SEL) -+#define BITS_PS_TIMER_3_TSF_SEL \ -+ (BIT_MASK_PS_TIMER_3_TSF_SEL << BIT_SHIFT_PS_TIMER_3_TSF_SEL) -+#define BIT_CLEAR_PS_TIMER_3_TSF_SEL(x) ((x) & (~BITS_PS_TIMER_3_TSF_SEL)) -+#define BIT_GET_PS_TIMER_3_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_3_TSF_SEL) & BIT_MASK_PS_TIMER_3_TSF_SEL) -+#define BIT_SET_PS_TIMER_3_TSF_SEL(x, v) \ -+ (BIT_CLEAR_PS_TIMER_3_TSF_SEL(x) | BIT_PS_TIMER_3_TSF_SEL(v)) -+ -+#define BIT_SHIFT_PS_TIMER_2_EARLY_TIME 8 -+#define BIT_MASK_PS_TIMER_2_EARLY_TIME 0xff -+#define BIT_PS_TIMER_2_EARLY_TIME(x) \ -+ (((x) & BIT_MASK_PS_TIMER_2_EARLY_TIME) \ -+ << BIT_SHIFT_PS_TIMER_2_EARLY_TIME) -+#define BITS_PS_TIMER_2_EARLY_TIME \ -+ (BIT_MASK_PS_TIMER_2_EARLY_TIME << BIT_SHIFT_PS_TIMER_2_EARLY_TIME) -+#define BIT_CLEAR_PS_TIMER_2_EARLY_TIME(x) ((x) & (~BITS_PS_TIMER_2_EARLY_TIME)) -+#define BIT_GET_PS_TIMER_2_EARLY_TIME(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_2_EARLY_TIME) & \ -+ BIT_MASK_PS_TIMER_2_EARLY_TIME) -+#define BIT_SET_PS_TIMER_2_EARLY_TIME(x, v) \ -+ (BIT_CLEAR_PS_TIMER_2_EARLY_TIME(x) | BIT_PS_TIMER_2_EARLY_TIME(v)) -+ -+#define BIT_PS_TIMER_2_EN BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_2_TSF_SEL 0 -+#define BIT_MASK_PS_TIMER_2_TSF_SEL 0x7 -+#define BIT_PS_TIMER_2_TSF_SEL(x) \ -+ (((x) & BIT_MASK_PS_TIMER_2_TSF_SEL) << BIT_SHIFT_PS_TIMER_2_TSF_SEL) -+#define BITS_PS_TIMER_2_TSF_SEL \ -+ (BIT_MASK_PS_TIMER_2_TSF_SEL << BIT_SHIFT_PS_TIMER_2_TSF_SEL) -+#define BIT_CLEAR_PS_TIMER_2_TSF_SEL(x) ((x) & (~BITS_PS_TIMER_2_TSF_SEL)) -+#define BIT_GET_PS_TIMER_2_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_2_TSF_SEL) & BIT_MASK_PS_TIMER_2_TSF_SEL) -+#define BIT_SET_PS_TIMER_2_TSF_SEL(x, v) \ -+ (BIT_CLEAR_PS_TIMER_2_TSF_SEL(x) | BIT_PS_TIMER_2_TSF_SEL(v)) -+ -+/* 2 REG_PS_TIMER_45_CTRL (Offset 0x15AC) */ -+ -+#define BIT_SHIFT_PS_TIMER_5_EARLY_TIME 24 -+#define BIT_MASK_PS_TIMER_5_EARLY_TIME 0xff -+#define BIT_PS_TIMER_5_EARLY_TIME(x) \ -+ (((x) & BIT_MASK_PS_TIMER_5_EARLY_TIME) \ -+ << BIT_SHIFT_PS_TIMER_5_EARLY_TIME) -+#define BITS_PS_TIMER_5_EARLY_TIME \ -+ (BIT_MASK_PS_TIMER_5_EARLY_TIME << BIT_SHIFT_PS_TIMER_5_EARLY_TIME) -+#define BIT_CLEAR_PS_TIMER_5_EARLY_TIME(x) ((x) & (~BITS_PS_TIMER_5_EARLY_TIME)) -+#define BIT_GET_PS_TIMER_5_EARLY_TIME(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_5_EARLY_TIME) & \ -+ BIT_MASK_PS_TIMER_5_EARLY_TIME) -+#define BIT_SET_PS_TIMER_5_EARLY_TIME(x, v) \ -+ (BIT_CLEAR_PS_TIMER_5_EARLY_TIME(x) | BIT_PS_TIMER_5_EARLY_TIME(v)) -+ -+#define BIT_PS_TIMER_5_EN BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_5_TSF_SEL 16 -+#define BIT_MASK_PS_TIMER_5_TSF_SEL 0x7 -+#define BIT_PS_TIMER_5_TSF_SEL(x) \ -+ (((x) & BIT_MASK_PS_TIMER_5_TSF_SEL) << BIT_SHIFT_PS_TIMER_5_TSF_SEL) -+#define BITS_PS_TIMER_5_TSF_SEL \ -+ (BIT_MASK_PS_TIMER_5_TSF_SEL << BIT_SHIFT_PS_TIMER_5_TSF_SEL) -+#define BIT_CLEAR_PS_TIMER_5_TSF_SEL(x) ((x) & (~BITS_PS_TIMER_5_TSF_SEL)) -+#define BIT_GET_PS_TIMER_5_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_5_TSF_SEL) & BIT_MASK_PS_TIMER_5_TSF_SEL) -+#define BIT_SET_PS_TIMER_5_TSF_SEL(x, v) \ -+ (BIT_CLEAR_PS_TIMER_5_TSF_SEL(x) | BIT_PS_TIMER_5_TSF_SEL(v)) -+ -+#define BIT_SHIFT_PS_TIMER_4_EARLY_TIME 8 -+#define BIT_MASK_PS_TIMER_4_EARLY_TIME 0xff -+#define BIT_PS_TIMER_4_EARLY_TIME(x) \ -+ (((x) & BIT_MASK_PS_TIMER_4_EARLY_TIME) \ -+ << BIT_SHIFT_PS_TIMER_4_EARLY_TIME) -+#define BITS_PS_TIMER_4_EARLY_TIME \ -+ (BIT_MASK_PS_TIMER_4_EARLY_TIME << BIT_SHIFT_PS_TIMER_4_EARLY_TIME) -+#define BIT_CLEAR_PS_TIMER_4_EARLY_TIME(x) ((x) & (~BITS_PS_TIMER_4_EARLY_TIME)) -+#define BIT_GET_PS_TIMER_4_EARLY_TIME(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_4_EARLY_TIME) & \ -+ BIT_MASK_PS_TIMER_4_EARLY_TIME) -+#define BIT_SET_PS_TIMER_4_EARLY_TIME(x, v) \ -+ (BIT_CLEAR_PS_TIMER_4_EARLY_TIME(x) | BIT_PS_TIMER_4_EARLY_TIME(v)) -+ -+#define BIT_PS_TIMER_4_EN BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_4_TSF_SEL 0 -+#define BIT_MASK_PS_TIMER_4_TSF_SEL 0x7 -+#define BIT_PS_TIMER_4_TSF_SEL(x) \ -+ (((x) & BIT_MASK_PS_TIMER_4_TSF_SEL) << BIT_SHIFT_PS_TIMER_4_TSF_SEL) -+#define BITS_PS_TIMER_4_TSF_SEL \ -+ (BIT_MASK_PS_TIMER_4_TSF_SEL << BIT_SHIFT_PS_TIMER_4_TSF_SEL) -+#define BIT_CLEAR_PS_TIMER_4_TSF_SEL(x) ((x) & (~BITS_PS_TIMER_4_TSF_SEL)) -+#define BIT_GET_PS_TIMER_4_TSF_SEL(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_4_TSF_SEL) & BIT_MASK_PS_TIMER_4_TSF_SEL) -+#define BIT_SET_PS_TIMER_4_TSF_SEL(x, v) \ -+ (BIT_CLEAR_PS_TIMER_4_TSF_SEL(x) | BIT_PS_TIMER_4_TSF_SEL(v)) -+ -+/* 2 REG_CPUMGQ_FREERUN_TIMER_CTRL (Offset 0x15B0) */ -+ -+#define BIT_FREECNT_RST_V1 BIT(23) -+#define BIT_EN_FREECNT_V1 BIT(16) -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_V1 8 -+#define BIT_MASK_CPUMGQ_TX_TIMER_EARLY_V1 0xff -+#define BIT_CPUMGQ_TX_TIMER_EARLY_V1(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_EARLY_V1) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_V1) -+#define BITS_CPUMGQ_TX_TIMER_EARLY_V1 \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_EARLY_V1 \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_V1) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_V1(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_EARLY_V1)) -+#define BIT_GET_CPUMGQ_TX_TIMER_EARLY_V1(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_V1) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_EARLY_V1) -+#define BIT_SET_CPUMGQ_TX_TIMER_EARLY_V1(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_V1(x) | \ -+ BIT_CPUMGQ_TX_TIMER_EARLY_V1(v)) -+ -+#define BIT_CPUMGQ_TIMER_EN_V1 BIT(7) -+#define BIT_CPUMGQ_DROP_BY_HOLDTIME BIT(5) -+#define BIT_CPUMGQ_TX_EN_V1 BIT(4) -+ -+#define BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_V1 0 -+#define BIT_MASK_CPUMGQ_TIMER_TSF_SEL_V1 0x7 -+#define BIT_CPUMGQ_TIMER_TSF_SEL_V1(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TIMER_TSF_SEL_V1) \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_V1) -+#define BITS_CPUMGQ_TIMER_TSF_SEL_V1 \ -+ (BIT_MASK_CPUMGQ_TIMER_TSF_SEL_V1 << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_V1) -+#define BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_V1(x) \ -+ ((x) & (~BITS_CPUMGQ_TIMER_TSF_SEL_V1)) -+#define BIT_GET_CPUMGQ_TIMER_TSF_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_V1) & \ -+ BIT_MASK_CPUMGQ_TIMER_TSF_SEL_V1) -+#define BIT_SET_CPUMGQ_TIMER_TSF_SEL_V1(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_V1(x) | BIT_CPUMGQ_TIMER_TSF_SEL_V1(v)) -+ -+/* 2 REG_CPUMGQ_PROHIBIT (Offset 0x15B4) */ -+ -+#define BIT_SHIFT_CPUMGQ_HOLD_TIME 8 -+#define BIT_MASK_CPUMGQ_HOLD_TIME 0xfff -+#define BIT_CPUMGQ_HOLD_TIME(x) \ -+ (((x) & BIT_MASK_CPUMGQ_HOLD_TIME) << BIT_SHIFT_CPUMGQ_HOLD_TIME) -+#define BITS_CPUMGQ_HOLD_TIME \ -+ (BIT_MASK_CPUMGQ_HOLD_TIME << BIT_SHIFT_CPUMGQ_HOLD_TIME) -+#define BIT_CLEAR_CPUMGQ_HOLD_TIME(x) ((x) & (~BITS_CPUMGQ_HOLD_TIME)) -+#define BIT_GET_CPUMGQ_HOLD_TIME(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_HOLD_TIME) & BIT_MASK_CPUMGQ_HOLD_TIME) -+#define BIT_SET_CPUMGQ_HOLD_TIME(x, v) \ -+ (BIT_CLEAR_CPUMGQ_HOLD_TIME(x) | BIT_CPUMGQ_HOLD_TIME(v)) -+ -+#define BIT_SHIFT_CPUMGQ_PROHIBIT_SETUP 0 -+#define BIT_MASK_CPUMGQ_PROHIBIT_SETUP 0xf -+#define BIT_CPUMGQ_PROHIBIT_SETUP(x) \ -+ (((x) & BIT_MASK_CPUMGQ_PROHIBIT_SETUP) \ -+ << BIT_SHIFT_CPUMGQ_PROHIBIT_SETUP) -+#define BITS_CPUMGQ_PROHIBIT_SETUP \ -+ (BIT_MASK_CPUMGQ_PROHIBIT_SETUP << BIT_SHIFT_CPUMGQ_PROHIBIT_SETUP) -+#define BIT_CLEAR_CPUMGQ_PROHIBIT_SETUP(x) ((x) & (~BITS_CPUMGQ_PROHIBIT_SETUP)) -+#define BIT_GET_CPUMGQ_PROHIBIT_SETUP(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_PROHIBIT_SETUP) & \ -+ BIT_MASK_CPUMGQ_PROHIBIT_SETUP) -+#define BIT_SET_CPUMGQ_PROHIBIT_SETUP(x, v) \ -+ (BIT_CLEAR_CPUMGQ_PROHIBIT_SETUP(x) | BIT_CPUMGQ_PROHIBIT_SETUP(v)) -+ -+/* 2 REG_TIMER_COMPARE (Offset 0x15C0) */ -+ -+#define BIT_COMP_TRIGGER BIT(7) -+ -+#define BIT_SHIFT_Y_COMP 4 -+#define BIT_MASK_Y_COMP 0x7 -+#define BIT_Y_COMP(x) (((x) & BIT_MASK_Y_COMP) << BIT_SHIFT_Y_COMP) -+#define BITS_Y_COMP (BIT_MASK_Y_COMP << BIT_SHIFT_Y_COMP) -+#define BIT_CLEAR_Y_COMP(x) ((x) & (~BITS_Y_COMP)) -+#define BIT_GET_Y_COMP(x) (((x) >> BIT_SHIFT_Y_COMP) & BIT_MASK_Y_COMP) -+#define BIT_SET_Y_COMP(x, v) (BIT_CLEAR_Y_COMP(x) | BIT_Y_COMP(v)) -+ -+#define BIT_X_COMP_Y_OVERFLOW BIT(3) -+ -+#define BIT_SHIFT_X_COMP 0 -+#define BIT_MASK_X_COMP 0x7 -+#define BIT_X_COMP(x) (((x) & BIT_MASK_X_COMP) << BIT_SHIFT_X_COMP) -+#define BITS_X_COMP (BIT_MASK_X_COMP << BIT_SHIFT_X_COMP) -+#define BIT_CLEAR_X_COMP(x) ((x) & (~BITS_X_COMP)) -+#define BIT_GET_X_COMP(x) (((x) >> BIT_SHIFT_X_COMP) & BIT_MASK_X_COMP) -+#define BIT_SET_X_COMP(x, v) (BIT_CLEAR_X_COMP(x) | BIT_X_COMP(v)) -+ -+/* 2 REG_TIMER_COMPARE_VALUE_LOW (Offset 0x15C4) */ -+ -+#define BIT_SHIFT_COMP_VALUE_LOW 0 -+#define BIT_MASK_COMP_VALUE_LOW 0xffffffffL -+#define BIT_COMP_VALUE_LOW(x) \ -+ (((x) & BIT_MASK_COMP_VALUE_LOW) << BIT_SHIFT_COMP_VALUE_LOW) -+#define BITS_COMP_VALUE_LOW \ -+ (BIT_MASK_COMP_VALUE_LOW << BIT_SHIFT_COMP_VALUE_LOW) -+#define BIT_CLEAR_COMP_VALUE_LOW(x) ((x) & (~BITS_COMP_VALUE_LOW)) -+#define BIT_GET_COMP_VALUE_LOW(x) \ -+ (((x) >> BIT_SHIFT_COMP_VALUE_LOW) & BIT_MASK_COMP_VALUE_LOW) -+#define BIT_SET_COMP_VALUE_LOW(x, v) \ -+ (BIT_CLEAR_COMP_VALUE_LOW(x) | BIT_COMP_VALUE_LOW(v)) -+ -+/* 2 REG_TIMER_COMPARE_VALUE_HIGH (Offset 0x15C8) */ -+ -+#define BIT_SHIFT_COMP_VALUE_HIGH 0 -+#define BIT_MASK_COMP_VALUE_HIGH 0xffffffffL -+#define BIT_COMP_VALUE_HIGH(x) \ -+ (((x) & BIT_MASK_COMP_VALUE_HIGH) << BIT_SHIFT_COMP_VALUE_HIGH) -+#define BITS_COMP_VALUE_HIGH \ -+ (BIT_MASK_COMP_VALUE_HIGH << BIT_SHIFT_COMP_VALUE_HIGH) -+#define BIT_CLEAR_COMP_VALUE_HIGH(x) ((x) & (~BITS_COMP_VALUE_HIGH)) -+#define BIT_GET_COMP_VALUE_HIGH(x) \ -+ (((x) >> BIT_SHIFT_COMP_VALUE_HIGH) & BIT_MASK_COMP_VALUE_HIGH) -+#define BIT_SET_COMP_VALUE_HIGH(x, v) \ -+ (BIT_CLEAR_COMP_VALUE_HIGH(x) | BIT_COMP_VALUE_HIGH(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SCHEDULER_COUNTER (Offset 0x15D0) */ -+ -+#define BIT_SHIFT_SCHEDULER_COUNTER 16 -+#define BIT_MASK_SCHEDULER_COUNTER 0xffff -+#define BIT_SCHEDULER_COUNTER(x) \ -+ (((x) & BIT_MASK_SCHEDULER_COUNTER) << BIT_SHIFT_SCHEDULER_COUNTER) -+#define BITS_SCHEDULER_COUNTER \ -+ (BIT_MASK_SCHEDULER_COUNTER << BIT_SHIFT_SCHEDULER_COUNTER) -+#define BIT_CLEAR_SCHEDULER_COUNTER(x) ((x) & (~BITS_SCHEDULER_COUNTER)) -+#define BIT_GET_SCHEDULER_COUNTER(x) \ -+ (((x) >> BIT_SHIFT_SCHEDULER_COUNTER) & BIT_MASK_SCHEDULER_COUNTER) -+#define BIT_SET_SCHEDULER_COUNTER(x, v) \ -+ (BIT_CLEAR_SCHEDULER_COUNTER(x) | BIT_SCHEDULER_COUNTER(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SCHEDULER_COUNTER (Offset 0x15D0) */ -+ -+#define BIT_SHIFT__SCHEDULER_COUNTER 16 -+#define BIT_MASK__SCHEDULER_COUNTER 0xffff -+#define BIT__SCHEDULER_COUNTER(x) \ -+ (((x) & BIT_MASK__SCHEDULER_COUNTER) << BIT_SHIFT__SCHEDULER_COUNTER) -+#define BITS__SCHEDULER_COUNTER \ -+ (BIT_MASK__SCHEDULER_COUNTER << BIT_SHIFT__SCHEDULER_COUNTER) -+#define BIT_CLEAR__SCHEDULER_COUNTER(x) ((x) & (~BITS__SCHEDULER_COUNTER)) -+#define BIT_GET__SCHEDULER_COUNTER(x) \ -+ (((x) >> BIT_SHIFT__SCHEDULER_COUNTER) & BIT_MASK__SCHEDULER_COUNTER) -+#define BIT_SET__SCHEDULER_COUNTER(x, v) \ -+ (BIT_CLEAR__SCHEDULER_COUNTER(x) | BIT__SCHEDULER_COUNTER(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/* 2 REG_SCHEDULER_COUNTER (Offset 0x15D0) */ -+ -+#define BIT_SCHEDULER_COUNTER_RST BIT(8) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SCHEDULER_COUNTER (Offset 0x15D0) */ -+ -+#define BIT__SCHEDULER_COUNTER_RST BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_SCHEDULER_COUNTER (Offset 0x15D0) */ -+ -+#define BIT_SHIFT_SCHEDULER_COUNTER_SEL 0 -+#define BIT_MASK_SCHEDULER_COUNTER_SEL 0xff -+#define BIT_SCHEDULER_COUNTER_SEL(x) \ -+ (((x) & BIT_MASK_SCHEDULER_COUNTER_SEL) \ -+ << BIT_SHIFT_SCHEDULER_COUNTER_SEL) -+#define BITS_SCHEDULER_COUNTER_SEL \ -+ (BIT_MASK_SCHEDULER_COUNTER_SEL << BIT_SHIFT_SCHEDULER_COUNTER_SEL) -+#define BIT_CLEAR_SCHEDULER_COUNTER_SEL(x) ((x) & (~BITS_SCHEDULER_COUNTER_SEL)) -+#define BIT_GET_SCHEDULER_COUNTER_SEL(x) \ -+ (((x) >> BIT_SHIFT_SCHEDULER_COUNTER_SEL) & \ -+ BIT_MASK_SCHEDULER_COUNTER_SEL) -+#define BIT_SET_SCHEDULER_COUNTER_SEL(x, v) \ -+ (BIT_CLEAR_SCHEDULER_COUNTER_SEL(x) | BIT_SCHEDULER_COUNTER_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BCN_PSR_RPT2 (Offset 0x1600) */ -+ -+#define BIT_SHIFT_DTIM_CNT2 24 -+#define BIT_MASK_DTIM_CNT2 0xff -+#define BIT_DTIM_CNT2(x) (((x) & BIT_MASK_DTIM_CNT2) << BIT_SHIFT_DTIM_CNT2) -+#define BITS_DTIM_CNT2 (BIT_MASK_DTIM_CNT2 << BIT_SHIFT_DTIM_CNT2) -+#define BIT_CLEAR_DTIM_CNT2(x) ((x) & (~BITS_DTIM_CNT2)) -+#define BIT_GET_DTIM_CNT2(x) (((x) >> BIT_SHIFT_DTIM_CNT2) & BIT_MASK_DTIM_CNT2) -+#define BIT_SET_DTIM_CNT2(x, v) (BIT_CLEAR_DTIM_CNT2(x) | BIT_DTIM_CNT2(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD2 16 -+#define BIT_MASK_DTIM_PERIOD2 0xff -+#define BIT_DTIM_PERIOD2(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD2) << BIT_SHIFT_DTIM_PERIOD2) -+#define BITS_DTIM_PERIOD2 (BIT_MASK_DTIM_PERIOD2 << BIT_SHIFT_DTIM_PERIOD2) -+#define BIT_CLEAR_DTIM_PERIOD2(x) ((x) & (~BITS_DTIM_PERIOD2)) -+#define BIT_GET_DTIM_PERIOD2(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD2) & BIT_MASK_DTIM_PERIOD2) -+#define BIT_SET_DTIM_PERIOD2(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD2(x) | BIT_DTIM_PERIOD2(v)) -+ -+#define BIT_DTIM2 BIT(15) -+#define BIT_TIM2 BIT(14) -+ -+#define BIT_SHIFT_PS_AID_2 0 -+#define BIT_MASK_PS_AID_2 0x7ff -+#define BIT_PS_AID_2(x) (((x) & BIT_MASK_PS_AID_2) << BIT_SHIFT_PS_AID_2) -+#define BITS_PS_AID_2 (BIT_MASK_PS_AID_2 << BIT_SHIFT_PS_AID_2) -+#define BIT_CLEAR_PS_AID_2(x) ((x) & (~BITS_PS_AID_2)) -+#define BIT_GET_PS_AID_2(x) (((x) >> BIT_SHIFT_PS_AID_2) & BIT_MASK_PS_AID_2) -+#define BIT_SET_PS_AID_2(x, v) (BIT_CLEAR_PS_AID_2(x) | BIT_PS_AID_2(v)) -+ -+/* 2 REG_BCN_PSR_RPT3 (Offset 0x1604) */ -+ -+#define BIT_SHIFT_DTIM_CNT3 24 -+#define BIT_MASK_DTIM_CNT3 0xff -+#define BIT_DTIM_CNT3(x) (((x) & BIT_MASK_DTIM_CNT3) << BIT_SHIFT_DTIM_CNT3) -+#define BITS_DTIM_CNT3 (BIT_MASK_DTIM_CNT3 << BIT_SHIFT_DTIM_CNT3) -+#define BIT_CLEAR_DTIM_CNT3(x) ((x) & (~BITS_DTIM_CNT3)) -+#define BIT_GET_DTIM_CNT3(x) (((x) >> BIT_SHIFT_DTIM_CNT3) & BIT_MASK_DTIM_CNT3) -+#define BIT_SET_DTIM_CNT3(x, v) (BIT_CLEAR_DTIM_CNT3(x) | BIT_DTIM_CNT3(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD3 16 -+#define BIT_MASK_DTIM_PERIOD3 0xff -+#define BIT_DTIM_PERIOD3(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD3) << BIT_SHIFT_DTIM_PERIOD3) -+#define BITS_DTIM_PERIOD3 (BIT_MASK_DTIM_PERIOD3 << BIT_SHIFT_DTIM_PERIOD3) -+#define BIT_CLEAR_DTIM_PERIOD3(x) ((x) & (~BITS_DTIM_PERIOD3)) -+#define BIT_GET_DTIM_PERIOD3(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD3) & BIT_MASK_DTIM_PERIOD3) -+#define BIT_SET_DTIM_PERIOD3(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD3(x) | BIT_DTIM_PERIOD3(v)) -+ -+#define BIT_DTIM3 BIT(15) -+#define BIT_TIM3 BIT(14) -+ -+#define BIT_SHIFT_PS_AID_3 0 -+#define BIT_MASK_PS_AID_3 0x7ff -+#define BIT_PS_AID_3(x) (((x) & BIT_MASK_PS_AID_3) << BIT_SHIFT_PS_AID_3) -+#define BITS_PS_AID_3 (BIT_MASK_PS_AID_3 << BIT_SHIFT_PS_AID_3) -+#define BIT_CLEAR_PS_AID_3(x) ((x) & (~BITS_PS_AID_3)) -+#define BIT_GET_PS_AID_3(x) (((x) >> BIT_SHIFT_PS_AID_3) & BIT_MASK_PS_AID_3) -+#define BIT_SET_PS_AID_3(x, v) (BIT_CLEAR_PS_AID_3(x) | BIT_PS_AID_3(v)) -+ -+/* 2 REG_BCN_PSR_RPT4 (Offset 0x1608) */ -+ -+#define BIT_SHIFT_DTIM_CNT4 24 -+#define BIT_MASK_DTIM_CNT4 0xff -+#define BIT_DTIM_CNT4(x) (((x) & BIT_MASK_DTIM_CNT4) << BIT_SHIFT_DTIM_CNT4) -+#define BITS_DTIM_CNT4 (BIT_MASK_DTIM_CNT4 << BIT_SHIFT_DTIM_CNT4) -+#define BIT_CLEAR_DTIM_CNT4(x) ((x) & (~BITS_DTIM_CNT4)) -+#define BIT_GET_DTIM_CNT4(x) (((x) >> BIT_SHIFT_DTIM_CNT4) & BIT_MASK_DTIM_CNT4) -+#define BIT_SET_DTIM_CNT4(x, v) (BIT_CLEAR_DTIM_CNT4(x) | BIT_DTIM_CNT4(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD4 16 -+#define BIT_MASK_DTIM_PERIOD4 0xff -+#define BIT_DTIM_PERIOD4(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD4) << BIT_SHIFT_DTIM_PERIOD4) -+#define BITS_DTIM_PERIOD4 (BIT_MASK_DTIM_PERIOD4 << BIT_SHIFT_DTIM_PERIOD4) -+#define BIT_CLEAR_DTIM_PERIOD4(x) ((x) & (~BITS_DTIM_PERIOD4)) -+#define BIT_GET_DTIM_PERIOD4(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD4) & BIT_MASK_DTIM_PERIOD4) -+#define BIT_SET_DTIM_PERIOD4(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD4(x) | BIT_DTIM_PERIOD4(v)) -+ -+#define BIT_DTIM4 BIT(15) -+#define BIT_TIM4 BIT(14) -+ -+#define BIT_SHIFT_PS_AID_4 0 -+#define BIT_MASK_PS_AID_4 0x7ff -+#define BIT_PS_AID_4(x) (((x) & BIT_MASK_PS_AID_4) << BIT_SHIFT_PS_AID_4) -+#define BITS_PS_AID_4 (BIT_MASK_PS_AID_4 << BIT_SHIFT_PS_AID_4) -+#define BIT_CLEAR_PS_AID_4(x) ((x) & (~BITS_PS_AID_4)) -+#define BIT_GET_PS_AID_4(x) (((x) >> BIT_SHIFT_PS_AID_4) & BIT_MASK_PS_AID_4) -+#define BIT_SET_PS_AID_4(x, v) (BIT_CLEAR_PS_AID_4(x) | BIT_PS_AID_4(v)) -+ -+/* 2 REG_A1_ADDR_MASK (Offset 0x160C) */ -+ -+#define BIT_SHIFT_A1_ADDR_MASK 0 -+#define BIT_MASK_A1_ADDR_MASK 0xffffffffL -+#define BIT_A1_ADDR_MASK(x) \ -+ (((x) & BIT_MASK_A1_ADDR_MASK) << BIT_SHIFT_A1_ADDR_MASK) -+#define BITS_A1_ADDR_MASK (BIT_MASK_A1_ADDR_MASK << BIT_SHIFT_A1_ADDR_MASK) -+#define BIT_CLEAR_A1_ADDR_MASK(x) ((x) & (~BITS_A1_ADDR_MASK)) -+#define BIT_GET_A1_ADDR_MASK(x) \ -+ (((x) >> BIT_SHIFT_A1_ADDR_MASK) & BIT_MASK_A1_ADDR_MASK) -+#define BIT_SET_A1_ADDR_MASK(x, v) \ -+ (BIT_CLEAR_A1_ADDR_MASK(x) | BIT_A1_ADDR_MASK(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_RXPSF_CTRL (Offset 0x1610) */ -+ -+#define BIT_RXGCK_FIFOTHR_EN BIT(28) -+ -+#define BIT_SHIFT_RXGCK_VHT_FIFOTHR 26 -+#define BIT_MASK_RXGCK_VHT_FIFOTHR 0x3 -+#define BIT_RXGCK_VHT_FIFOTHR(x) \ -+ (((x) & BIT_MASK_RXGCK_VHT_FIFOTHR) << BIT_SHIFT_RXGCK_VHT_FIFOTHR) -+#define BITS_RXGCK_VHT_FIFOTHR \ -+ (BIT_MASK_RXGCK_VHT_FIFOTHR << BIT_SHIFT_RXGCK_VHT_FIFOTHR) -+#define BIT_CLEAR_RXGCK_VHT_FIFOTHR(x) ((x) & (~BITS_RXGCK_VHT_FIFOTHR)) -+#define BIT_GET_RXGCK_VHT_FIFOTHR(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_VHT_FIFOTHR) & BIT_MASK_RXGCK_VHT_FIFOTHR) -+#define BIT_SET_RXGCK_VHT_FIFOTHR(x, v) \ -+ (BIT_CLEAR_RXGCK_VHT_FIFOTHR(x) | BIT_RXGCK_VHT_FIFOTHR(v)) -+ -+#define BIT_SHIFT_RXGCK_HT_FIFOTHR 24 -+#define BIT_MASK_RXGCK_HT_FIFOTHR 0x3 -+#define BIT_RXGCK_HT_FIFOTHR(x) \ -+ (((x) & BIT_MASK_RXGCK_HT_FIFOTHR) << BIT_SHIFT_RXGCK_HT_FIFOTHR) -+#define BITS_RXGCK_HT_FIFOTHR \ -+ (BIT_MASK_RXGCK_HT_FIFOTHR << BIT_SHIFT_RXGCK_HT_FIFOTHR) -+#define BIT_CLEAR_RXGCK_HT_FIFOTHR(x) ((x) & (~BITS_RXGCK_HT_FIFOTHR)) -+#define BIT_GET_RXGCK_HT_FIFOTHR(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_HT_FIFOTHR) & BIT_MASK_RXGCK_HT_FIFOTHR) -+#define BIT_SET_RXGCK_HT_FIFOTHR(x, v) \ -+ (BIT_CLEAR_RXGCK_HT_FIFOTHR(x) | BIT_RXGCK_HT_FIFOTHR(v)) -+ -+#define BIT_SHIFT_RXGCK_OFDM_FIFOTHR 22 -+#define BIT_MASK_RXGCK_OFDM_FIFOTHR 0x3 -+#define BIT_RXGCK_OFDM_FIFOTHR(x) \ -+ (((x) & BIT_MASK_RXGCK_OFDM_FIFOTHR) << BIT_SHIFT_RXGCK_OFDM_FIFOTHR) -+#define BITS_RXGCK_OFDM_FIFOTHR \ -+ (BIT_MASK_RXGCK_OFDM_FIFOTHR << BIT_SHIFT_RXGCK_OFDM_FIFOTHR) -+#define BIT_CLEAR_RXGCK_OFDM_FIFOTHR(x) ((x) & (~BITS_RXGCK_OFDM_FIFOTHR)) -+#define BIT_GET_RXGCK_OFDM_FIFOTHR(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_OFDM_FIFOTHR) & BIT_MASK_RXGCK_OFDM_FIFOTHR) -+#define BIT_SET_RXGCK_OFDM_FIFOTHR(x, v) \ -+ (BIT_CLEAR_RXGCK_OFDM_FIFOTHR(x) | BIT_RXGCK_OFDM_FIFOTHR(v)) -+ -+#define BIT_SHIFT_RXGCK_CCK_FIFOTHR 20 -+#define BIT_MASK_RXGCK_CCK_FIFOTHR 0x3 -+#define BIT_RXGCK_CCK_FIFOTHR(x) \ -+ (((x) & BIT_MASK_RXGCK_CCK_FIFOTHR) << BIT_SHIFT_RXGCK_CCK_FIFOTHR) -+#define BITS_RXGCK_CCK_FIFOTHR \ -+ (BIT_MASK_RXGCK_CCK_FIFOTHR << BIT_SHIFT_RXGCK_CCK_FIFOTHR) -+#define BIT_CLEAR_RXGCK_CCK_FIFOTHR(x) ((x) & (~BITS_RXGCK_CCK_FIFOTHR)) -+#define BIT_GET_RXGCK_CCK_FIFOTHR(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_CCK_FIFOTHR) & BIT_MASK_RXGCK_CCK_FIFOTHR) -+#define BIT_SET_RXGCK_CCK_FIFOTHR(x, v) \ -+ (BIT_CLEAR_RXGCK_CCK_FIFOTHR(x) | BIT_RXGCK_CCK_FIFOTHR(v)) -+ -+#define BIT_SHIFT_RXGCK_ENTRY_DELAY 17 -+#define BIT_MASK_RXGCK_ENTRY_DELAY 0x7 -+#define BIT_RXGCK_ENTRY_DELAY(x) \ -+ (((x) & BIT_MASK_RXGCK_ENTRY_DELAY) << BIT_SHIFT_RXGCK_ENTRY_DELAY) -+#define BITS_RXGCK_ENTRY_DELAY \ -+ (BIT_MASK_RXGCK_ENTRY_DELAY << BIT_SHIFT_RXGCK_ENTRY_DELAY) -+#define BIT_CLEAR_RXGCK_ENTRY_DELAY(x) ((x) & (~BITS_RXGCK_ENTRY_DELAY)) -+#define BIT_GET_RXGCK_ENTRY_DELAY(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_ENTRY_DELAY) & BIT_MASK_RXGCK_ENTRY_DELAY) -+#define BIT_SET_RXGCK_ENTRY_DELAY(x, v) \ -+ (BIT_CLEAR_RXGCK_ENTRY_DELAY(x) | BIT_RXGCK_ENTRY_DELAY(v)) -+ -+#define BIT_RXGCK_OFDMCCA_EN BIT(16) -+ -+#define BIT_SHIFT_RXPSF_PKTLENTHR 13 -+#define BIT_MASK_RXPSF_PKTLENTHR 0x7 -+#define BIT_RXPSF_PKTLENTHR(x) \ -+ (((x) & BIT_MASK_RXPSF_PKTLENTHR) << BIT_SHIFT_RXPSF_PKTLENTHR) -+#define BITS_RXPSF_PKTLENTHR \ -+ (BIT_MASK_RXPSF_PKTLENTHR << BIT_SHIFT_RXPSF_PKTLENTHR) -+#define BIT_CLEAR_RXPSF_PKTLENTHR(x) ((x) & (~BITS_RXPSF_PKTLENTHR)) -+#define BIT_GET_RXPSF_PKTLENTHR(x) \ -+ (((x) >> BIT_SHIFT_RXPSF_PKTLENTHR) & BIT_MASK_RXPSF_PKTLENTHR) -+#define BIT_SET_RXPSF_PKTLENTHR(x, v) \ -+ (BIT_CLEAR_RXPSF_PKTLENTHR(x) | BIT_RXPSF_PKTLENTHR(v)) -+ -+#define BIT_RXPSF_CTRLEN BIT(12) -+#define BIT_RXPSF_VHTCHKEN BIT(11) -+#define BIT_RXPSF_HTCHKEN BIT(10) -+#define BIT_RXPSF_OFDMCHKEN BIT(9) -+#define BIT_RXPSF_CCKCHKEN BIT(8) -+#define BIT_RXPSF_OFDMRST BIT(7) -+#define BIT_RXPSF_CCKRST BIT(6) -+#define BIT_RXPSF_MHCHKEN BIT(5) -+#define BIT_RXPSF_CONT_ERRCHKEN BIT(4) -+#define BIT_RXPSF_ALL_ERRCHKEN BIT(3) -+ -+#define BIT_SHIFT_RXPSF_ERRTHR 0 -+#define BIT_MASK_RXPSF_ERRTHR 0x7 -+#define BIT_RXPSF_ERRTHR(x) \ -+ (((x) & BIT_MASK_RXPSF_ERRTHR) << BIT_SHIFT_RXPSF_ERRTHR) -+#define BITS_RXPSF_ERRTHR (BIT_MASK_RXPSF_ERRTHR << BIT_SHIFT_RXPSF_ERRTHR) -+#define BIT_CLEAR_RXPSF_ERRTHR(x) ((x) & (~BITS_RXPSF_ERRTHR)) -+#define BIT_GET_RXPSF_ERRTHR(x) \ -+ (((x) >> BIT_SHIFT_RXPSF_ERRTHR) & BIT_MASK_RXPSF_ERRTHR) -+#define BIT_SET_RXPSF_ERRTHR(x, v) \ -+ (BIT_CLEAR_RXPSF_ERRTHR(x) | BIT_RXPSF_ERRTHR(v)) -+ -+/* 2 REG_RXPSF_TYPE_CTRL (Offset 0x1614) */ -+ -+#define BIT_RXPSF_DATA15EN BIT(31) -+#define BIT_RXPSF_DATA14EN BIT(30) -+#define BIT_RXPSF_DATA13EN BIT(29) -+#define BIT_RXPSF_DATA12EN BIT(28) -+#define BIT_RXPSF_DATA11EN BIT(27) -+#define BIT_RXPSF_DATA10EN BIT(26) -+#define BIT_RXPSF_DATA9EN BIT(25) -+#define BIT_RXPSF_DATA8EN BIT(24) -+#define BIT_RXPSF_DATA7EN BIT(23) -+#define BIT_RXPSF_DATA6EN BIT(22) -+#define BIT_RXPSF_DATA5EN BIT(21) -+#define BIT_RXPSF_DATA4EN BIT(20) -+#define BIT_RXPSF_DATA3EN BIT(19) -+#define BIT_RXPSF_DATA2EN BIT(18) -+#define BIT_RXPSF_DATA1EN BIT(17) -+#define BIT_RXPSF_DATA0EN BIT(16) -+#define BIT_RXPSF_MGT15EN BIT(15) -+#define BIT_RXPSF_MGT14EN BIT(14) -+#define BIT_RXPSF_MGT13EN BIT(13) -+#define BIT_RXPSF_MGT12EN BIT(12) -+#define BIT_RXPSF_MGT11EN BIT(11) -+#define BIT_RXPSF_MGT10EN BIT(10) -+#define BIT_RXPSF_MGT9EN BIT(9) -+#define BIT_RXPSF_MGT8EN BIT(8) -+#define BIT_RXPSF_MGT7EN BIT(7) -+#define BIT_RXPSF_MGT6EN BIT(6) -+#define BIT_RXPSF_MGT5EN BIT(5) -+#define BIT_RXPSF_MGT4EN BIT(4) -+#define BIT_RXPSF_MGT3EN BIT(3) -+#define BIT_RXPSF_MGT2EN BIT(2) -+#define BIT_RXPSF_MGT1EN BIT(1) -+#define BIT_RXPSF_MGT0EN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CAM_ACCESS_CTRL (Offset 0x1618) */ -+ -+#define BIT_INDIRECT_ERR BIT(6) -+#define BIT_DIRECT_ERR BIT(5) -+#define BIT_DIR_ACCESS_EN_RX_BA BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CAM_ACCESS_CTRL (Offset 0x1618) */ -+ -+#define BIT_DIR_ACCESS_EN_MBSSIDCAM BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CAM_ACCESS_CTRL (Offset 0x1618) */ -+ -+#define BIT_DIR_ACCESS_EN_ADDRCAM BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CAM_ACCESS_CTRL (Offset 0x1618) */ -+ -+#define BIT_DIR_ACCESS_EN_KEY BIT(2) -+#define BIT_DIR_ACCESS_EN_WOWLAN BIT(1) -+#define BIT_DIR_ACCESS_EN_FW_FILTER BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CUT_AMSDU_CTRL (Offset 0x161C) */ -+ -+#define BIT__CUT_AMSDU_CHKLEN_EN BIT(31) -+#define BIT_EN_CUT_AMSDU BIT(30) -+ -+#define BIT_SHIFT_CUT_AMSDU_CHKLEN_L_TH 16 -+#define BIT_MASK_CUT_AMSDU_CHKLEN_L_TH 0xff -+#define BIT_CUT_AMSDU_CHKLEN_L_TH(x) \ -+ (((x) & BIT_MASK_CUT_AMSDU_CHKLEN_L_TH) \ -+ << BIT_SHIFT_CUT_AMSDU_CHKLEN_L_TH) -+#define BITS_CUT_AMSDU_CHKLEN_L_TH \ -+ (BIT_MASK_CUT_AMSDU_CHKLEN_L_TH << BIT_SHIFT_CUT_AMSDU_CHKLEN_L_TH) -+#define BIT_CLEAR_CUT_AMSDU_CHKLEN_L_TH(x) ((x) & (~BITS_CUT_AMSDU_CHKLEN_L_TH)) -+#define BIT_GET_CUT_AMSDU_CHKLEN_L_TH(x) \ -+ (((x) >> BIT_SHIFT_CUT_AMSDU_CHKLEN_L_TH) & \ -+ BIT_MASK_CUT_AMSDU_CHKLEN_L_TH) -+#define BIT_SET_CUT_AMSDU_CHKLEN_L_TH(x, v) \ -+ (BIT_CLEAR_CUT_AMSDU_CHKLEN_L_TH(x) | BIT_CUT_AMSDU_CHKLEN_L_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_HT_SND_REF_RATE (Offset 0x161C) */ -+ -+#define BIT_SHIFT_WMAC_HT_CSI_RATE 0 -+#define BIT_MASK_WMAC_HT_CSI_RATE 0x3f -+#define BIT_WMAC_HT_CSI_RATE(x) \ -+ (((x) & BIT_MASK_WMAC_HT_CSI_RATE) << BIT_SHIFT_WMAC_HT_CSI_RATE) -+#define BITS_WMAC_HT_CSI_RATE \ -+ (BIT_MASK_WMAC_HT_CSI_RATE << BIT_SHIFT_WMAC_HT_CSI_RATE) -+#define BIT_CLEAR_WMAC_HT_CSI_RATE(x) ((x) & (~BITS_WMAC_HT_CSI_RATE)) -+#define BIT_GET_WMAC_HT_CSI_RATE(x) \ -+ (((x) >> BIT_SHIFT_WMAC_HT_CSI_RATE) & BIT_MASK_WMAC_HT_CSI_RATE) -+#define BIT_SET_WMAC_HT_CSI_RATE(x, v) \ -+ (BIT_CLEAR_WMAC_HT_CSI_RATE(x) | BIT_WMAC_HT_CSI_RATE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_CUT_AMSDU_CTRL (Offset 0x161C) */ -+ -+#define BIT_SHIFT_CUT_AMSDU_CHKLEN_H_TH 0 -+#define BIT_MASK_CUT_AMSDU_CHKLEN_H_TH 0xffff -+#define BIT_CUT_AMSDU_CHKLEN_H_TH(x) \ -+ (((x) & BIT_MASK_CUT_AMSDU_CHKLEN_H_TH) \ -+ << BIT_SHIFT_CUT_AMSDU_CHKLEN_H_TH) -+#define BITS_CUT_AMSDU_CHKLEN_H_TH \ -+ (BIT_MASK_CUT_AMSDU_CHKLEN_H_TH << BIT_SHIFT_CUT_AMSDU_CHKLEN_H_TH) -+#define BIT_CLEAR_CUT_AMSDU_CHKLEN_H_TH(x) ((x) & (~BITS_CUT_AMSDU_CHKLEN_H_TH)) -+#define BIT_GET_CUT_AMSDU_CHKLEN_H_TH(x) \ -+ (((x) >> BIT_SHIFT_CUT_AMSDU_CHKLEN_H_TH) & \ -+ BIT_MASK_CUT_AMSDU_CHKLEN_H_TH) -+#define BIT_SET_CUT_AMSDU_CHKLEN_H_TH(x, v) \ -+ (BIT_CLEAR_CUT_AMSDU_CHKLEN_H_TH(x) | BIT_CUT_AMSDU_CHKLEN_H_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MACID2 (Offset 0x1620) */ -+ -+#define BIT_SHIFT_MACID2 0 -+#define BIT_MASK_MACID2 0xffffffffffffL -+#define BIT_MACID2(x) (((x) & BIT_MASK_MACID2) << BIT_SHIFT_MACID2) -+#define BITS_MACID2 (BIT_MASK_MACID2 << BIT_SHIFT_MACID2) -+#define BIT_CLEAR_MACID2(x) ((x) & (~BITS_MACID2)) -+#define BIT_GET_MACID2(x) (((x) >> BIT_SHIFT_MACID2) & BIT_MASK_MACID2) -+#define BIT_SET_MACID2(x, v) (BIT_CLEAR_MACID2(x) | BIT_MACID2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID2 (Offset 0x1620) */ -+ -+#define BIT_SHIFT_MACID2_V1 0 -+#define BIT_MASK_MACID2_V1 0xffffffffL -+#define BIT_MACID2_V1(x) (((x) & BIT_MASK_MACID2_V1) << BIT_SHIFT_MACID2_V1) -+#define BITS_MACID2_V1 (BIT_MASK_MACID2_V1 << BIT_SHIFT_MACID2_V1) -+#define BIT_CLEAR_MACID2_V1(x) ((x) & (~BITS_MACID2_V1)) -+#define BIT_GET_MACID2_V1(x) (((x) >> BIT_SHIFT_MACID2_V1) & BIT_MASK_MACID2_V1) -+#define BIT_SET_MACID2_V1(x, v) (BIT_CLEAR_MACID2_V1(x) | BIT_MACID2_V1(v)) -+ -+/* 2 REG_MACID2_H (Offset 0x1624) */ -+ -+#define BIT_SHIFT_MACID2_H_V1 0 -+#define BIT_MASK_MACID2_H_V1 0xffff -+#define BIT_MACID2_H_V1(x) \ -+ (((x) & BIT_MASK_MACID2_H_V1) << BIT_SHIFT_MACID2_H_V1) -+#define BITS_MACID2_H_V1 (BIT_MASK_MACID2_H_V1 << BIT_SHIFT_MACID2_H_V1) -+#define BIT_CLEAR_MACID2_H_V1(x) ((x) & (~BITS_MACID2_H_V1)) -+#define BIT_GET_MACID2_H_V1(x) \ -+ (((x) >> BIT_SHIFT_MACID2_H_V1) & BIT_MASK_MACID2_H_V1) -+#define BIT_SET_MACID2_H_V1(x, v) \ -+ (BIT_CLEAR_MACID2_H_V1(x) | BIT_MACID2_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BSSID2 (Offset 0x1628) */ -+ -+#define BIT_SHIFT_BSSID2 0 -+#define BIT_MASK_BSSID2 0xffffffffffffL -+#define BIT_BSSID2(x) (((x) & BIT_MASK_BSSID2) << BIT_SHIFT_BSSID2) -+#define BITS_BSSID2 (BIT_MASK_BSSID2 << BIT_SHIFT_BSSID2) -+#define BIT_CLEAR_BSSID2(x) ((x) & (~BITS_BSSID2)) -+#define BIT_GET_BSSID2(x) (((x) >> BIT_SHIFT_BSSID2) & BIT_MASK_BSSID2) -+#define BIT_SET_BSSID2(x, v) (BIT_CLEAR_BSSID2(x) | BIT_BSSID2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BSSID2 (Offset 0x1628) */ -+ -+#define BIT_SHIFT_BSSID2_V1 0 -+#define BIT_MASK_BSSID2_V1 0xffffffffL -+#define BIT_BSSID2_V1(x) (((x) & BIT_MASK_BSSID2_V1) << BIT_SHIFT_BSSID2_V1) -+#define BITS_BSSID2_V1 (BIT_MASK_BSSID2_V1 << BIT_SHIFT_BSSID2_V1) -+#define BIT_CLEAR_BSSID2_V1(x) ((x) & (~BITS_BSSID2_V1)) -+#define BIT_GET_BSSID2_V1(x) (((x) >> BIT_SHIFT_BSSID2_V1) & BIT_MASK_BSSID2_V1) -+#define BIT_SET_BSSID2_V1(x, v) (BIT_CLEAR_BSSID2_V1(x) | BIT_BSSID2_V1(v)) -+ -+/* 2 REG_BSSID2_H (Offset 0x162C) */ -+ -+#define BIT_SHIFT_BSSID2_H_V1 0 -+#define BIT_MASK_BSSID2_H_V1 0xffff -+#define BIT_BSSID2_H_V1(x) \ -+ (((x) & BIT_MASK_BSSID2_H_V1) << BIT_SHIFT_BSSID2_H_V1) -+#define BITS_BSSID2_H_V1 (BIT_MASK_BSSID2_H_V1 << BIT_SHIFT_BSSID2_H_V1) -+#define BIT_CLEAR_BSSID2_H_V1(x) ((x) & (~BITS_BSSID2_H_V1)) -+#define BIT_GET_BSSID2_H_V1(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_H_V1) & BIT_MASK_BSSID2_H_V1) -+#define BIT_SET_BSSID2_H_V1(x, v) \ -+ (BIT_CLEAR_BSSID2_H_V1(x) | BIT_BSSID2_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MACID3 (Offset 0x1630) */ -+ -+#define BIT_SHIFT_MACID3 0 -+#define BIT_MASK_MACID3 0xffffffffffffL -+#define BIT_MACID3(x) (((x) & BIT_MASK_MACID3) << BIT_SHIFT_MACID3) -+#define BITS_MACID3 (BIT_MASK_MACID3 << BIT_SHIFT_MACID3) -+#define BIT_CLEAR_MACID3(x) ((x) & (~BITS_MACID3)) -+#define BIT_GET_MACID3(x) (((x) >> BIT_SHIFT_MACID3) & BIT_MASK_MACID3) -+#define BIT_SET_MACID3(x, v) (BIT_CLEAR_MACID3(x) | BIT_MACID3(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID3 (Offset 0x1630) */ -+ -+#define BIT_SHIFT_MACID3_V1 0 -+#define BIT_MASK_MACID3_V1 0xffffffffL -+#define BIT_MACID3_V1(x) (((x) & BIT_MASK_MACID3_V1) << BIT_SHIFT_MACID3_V1) -+#define BITS_MACID3_V1 (BIT_MASK_MACID3_V1 << BIT_SHIFT_MACID3_V1) -+#define BIT_CLEAR_MACID3_V1(x) ((x) & (~BITS_MACID3_V1)) -+#define BIT_GET_MACID3_V1(x) (((x) >> BIT_SHIFT_MACID3_V1) & BIT_MASK_MACID3_V1) -+#define BIT_SET_MACID3_V1(x, v) (BIT_CLEAR_MACID3_V1(x) | BIT_MACID3_V1(v)) -+ -+/* 2 REG_MACID3_H (Offset 0x1634) */ -+ -+#define BIT_SHIFT_MACID3_H_V1 0 -+#define BIT_MASK_MACID3_H_V1 0xffff -+#define BIT_MACID3_H_V1(x) \ -+ (((x) & BIT_MASK_MACID3_H_V1) << BIT_SHIFT_MACID3_H_V1) -+#define BITS_MACID3_H_V1 (BIT_MASK_MACID3_H_V1 << BIT_SHIFT_MACID3_H_V1) -+#define BIT_CLEAR_MACID3_H_V1(x) ((x) & (~BITS_MACID3_H_V1)) -+#define BIT_GET_MACID3_H_V1(x) \ -+ (((x) >> BIT_SHIFT_MACID3_H_V1) & BIT_MASK_MACID3_H_V1) -+#define BIT_SET_MACID3_H_V1(x, v) \ -+ (BIT_CLEAR_MACID3_H_V1(x) | BIT_MACID3_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BSSID3 (Offset 0x1638) */ -+ -+#define BIT_SHIFT_BSSID3 0 -+#define BIT_MASK_BSSID3 0xffffffffffffL -+#define BIT_BSSID3(x) (((x) & BIT_MASK_BSSID3) << BIT_SHIFT_BSSID3) -+#define BITS_BSSID3 (BIT_MASK_BSSID3 << BIT_SHIFT_BSSID3) -+#define BIT_CLEAR_BSSID3(x) ((x) & (~BITS_BSSID3)) -+#define BIT_GET_BSSID3(x) (((x) >> BIT_SHIFT_BSSID3) & BIT_MASK_BSSID3) -+#define BIT_SET_BSSID3(x, v) (BIT_CLEAR_BSSID3(x) | BIT_BSSID3(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BSSID3 (Offset 0x1638) */ -+ -+#define BIT_SHIFT_BSSID3_V1 0 -+#define BIT_MASK_BSSID3_V1 0xffffffffL -+#define BIT_BSSID3_V1(x) (((x) & BIT_MASK_BSSID3_V1) << BIT_SHIFT_BSSID3_V1) -+#define BITS_BSSID3_V1 (BIT_MASK_BSSID3_V1 << BIT_SHIFT_BSSID3_V1) -+#define BIT_CLEAR_BSSID3_V1(x) ((x) & (~BITS_BSSID3_V1)) -+#define BIT_GET_BSSID3_V1(x) (((x) >> BIT_SHIFT_BSSID3_V1) & BIT_MASK_BSSID3_V1) -+#define BIT_SET_BSSID3_V1(x, v) (BIT_CLEAR_BSSID3_V1(x) | BIT_BSSID3_V1(v)) -+ -+/* 2 REG_BSSID3_H (Offset 0x163C) */ -+ -+#define BIT_SHIFT_BSSID3_H_V1 0 -+#define BIT_MASK_BSSID3_H_V1 0xffff -+#define BIT_BSSID3_H_V1(x) \ -+ (((x) & BIT_MASK_BSSID3_H_V1) << BIT_SHIFT_BSSID3_H_V1) -+#define BITS_BSSID3_H_V1 (BIT_MASK_BSSID3_H_V1 << BIT_SHIFT_BSSID3_H_V1) -+#define BIT_CLEAR_BSSID3_H_V1(x) ((x) & (~BITS_BSSID3_H_V1)) -+#define BIT_GET_BSSID3_H_V1(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_H_V1) & BIT_MASK_BSSID3_H_V1) -+#define BIT_SET_BSSID3_H_V1(x, v) \ -+ (BIT_CLEAR_BSSID3_H_V1(x) | BIT_BSSID3_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MACID4 (Offset 0x1640) */ -+ -+#define BIT_SHIFT_MACID4 0 -+#define BIT_MASK_MACID4 0xffffffffffffL -+#define BIT_MACID4(x) (((x) & BIT_MASK_MACID4) << BIT_SHIFT_MACID4) -+#define BITS_MACID4 (BIT_MASK_MACID4 << BIT_SHIFT_MACID4) -+#define BIT_CLEAR_MACID4(x) ((x) & (~BITS_MACID4)) -+#define BIT_GET_MACID4(x) (((x) >> BIT_SHIFT_MACID4) & BIT_MASK_MACID4) -+#define BIT_SET_MACID4(x, v) (BIT_CLEAR_MACID4(x) | BIT_MACID4(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MACID4 (Offset 0x1640) */ -+ -+#define BIT_SHIFT_MACID4_V1 0 -+#define BIT_MASK_MACID4_V1 0xffffffffL -+#define BIT_MACID4_V1(x) (((x) & BIT_MASK_MACID4_V1) << BIT_SHIFT_MACID4_V1) -+#define BITS_MACID4_V1 (BIT_MASK_MACID4_V1 << BIT_SHIFT_MACID4_V1) -+#define BIT_CLEAR_MACID4_V1(x) ((x) & (~BITS_MACID4_V1)) -+#define BIT_GET_MACID4_V1(x) (((x) >> BIT_SHIFT_MACID4_V1) & BIT_MASK_MACID4_V1) -+#define BIT_SET_MACID4_V1(x, v) (BIT_CLEAR_MACID4_V1(x) | BIT_MACID4_V1(v)) -+ -+/* 2 REG_MACID4_H (Offset 0x1644) */ -+ -+#define BIT_SHIFT_MACID4_H_V1 0 -+#define BIT_MASK_MACID4_H_V1 0xffff -+#define BIT_MACID4_H_V1(x) \ -+ (((x) & BIT_MASK_MACID4_H_V1) << BIT_SHIFT_MACID4_H_V1) -+#define BITS_MACID4_H_V1 (BIT_MASK_MACID4_H_V1 << BIT_SHIFT_MACID4_H_V1) -+#define BIT_CLEAR_MACID4_H_V1(x) ((x) & (~BITS_MACID4_H_V1)) -+#define BIT_GET_MACID4_H_V1(x) \ -+ (((x) >> BIT_SHIFT_MACID4_H_V1) & BIT_MASK_MACID4_H_V1) -+#define BIT_SET_MACID4_H_V1(x, v) \ -+ (BIT_CLEAR_MACID4_H_V1(x) | BIT_MACID4_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_BSSID4 (Offset 0x1648) */ -+ -+#define BIT_SHIFT_BSSID4 0 -+#define BIT_MASK_BSSID4 0xffffffffffffL -+#define BIT_BSSID4(x) (((x) & BIT_MASK_BSSID4) << BIT_SHIFT_BSSID4) -+#define BITS_BSSID4 (BIT_MASK_BSSID4 << BIT_SHIFT_BSSID4) -+#define BIT_CLEAR_BSSID4(x) ((x) & (~BITS_BSSID4)) -+#define BIT_GET_BSSID4(x) (((x) >> BIT_SHIFT_BSSID4) & BIT_MASK_BSSID4) -+#define BIT_SET_BSSID4(x, v) (BIT_CLEAR_BSSID4(x) | BIT_BSSID4(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_BSSID4 (Offset 0x1648) */ -+ -+#define BIT_SHIFT_BSSID4_V1 0 -+#define BIT_MASK_BSSID4_V1 0xffffffffL -+#define BIT_BSSID4_V1(x) (((x) & BIT_MASK_BSSID4_V1) << BIT_SHIFT_BSSID4_V1) -+#define BITS_BSSID4_V1 (BIT_MASK_BSSID4_V1 << BIT_SHIFT_BSSID4_V1) -+#define BIT_CLEAR_BSSID4_V1(x) ((x) & (~BITS_BSSID4_V1)) -+#define BIT_GET_BSSID4_V1(x) (((x) >> BIT_SHIFT_BSSID4_V1) & BIT_MASK_BSSID4_V1) -+#define BIT_SET_BSSID4_V1(x, v) (BIT_CLEAR_BSSID4_V1(x) | BIT_BSSID4_V1(v)) -+ -+/* 2 REG_BSSID4_H (Offset 0x164C) */ -+ -+#define BIT_SHIFT_BSSID4_H_V1 0 -+#define BIT_MASK_BSSID4_H_V1 0xffff -+#define BIT_BSSID4_H_V1(x) \ -+ (((x) & BIT_MASK_BSSID4_H_V1) << BIT_SHIFT_BSSID4_H_V1) -+#define BITS_BSSID4_H_V1 (BIT_MASK_BSSID4_H_V1 << BIT_SHIFT_BSSID4_H_V1) -+#define BIT_CLEAR_BSSID4_H_V1(x) ((x) & (~BITS_BSSID4_H_V1)) -+#define BIT_GET_BSSID4_H_V1(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_H_V1) & BIT_MASK_BSSID4_H_V1) -+#define BIT_SET_BSSID4_H_V1(x, v) \ -+ (BIT_CLEAR_BSSID4_H_V1(x) | BIT_BSSID4_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_NOA_REPORT (Offset 0x1650) */ -+ -+#define BIT_SHIFT_NOA_RPT 0 -+#define BIT_MASK_NOA_RPT 0xffffffffL -+#define BIT_NOA_RPT(x) (((x) & BIT_MASK_NOA_RPT) << BIT_SHIFT_NOA_RPT) -+#define BITS_NOA_RPT (BIT_MASK_NOA_RPT << BIT_SHIFT_NOA_RPT) -+#define BIT_CLEAR_NOA_RPT(x) ((x) & (~BITS_NOA_RPT)) -+#define BIT_GET_NOA_RPT(x) (((x) >> BIT_SHIFT_NOA_RPT) & BIT_MASK_NOA_RPT) -+#define BIT_SET_NOA_RPT(x, v) (BIT_CLEAR_NOA_RPT(x) | BIT_NOA_RPT(v)) -+ -+/* 2 REG_NOA_REPORT_1 (Offset 0x1654) */ -+ -+#define BIT_SHIFT_NOA_RPT_1 0 -+#define BIT_MASK_NOA_RPT_1 0xffffffffL -+#define BIT_NOA_RPT_1(x) (((x) & BIT_MASK_NOA_RPT_1) << BIT_SHIFT_NOA_RPT_1) -+#define BITS_NOA_RPT_1 (BIT_MASK_NOA_RPT_1 << BIT_SHIFT_NOA_RPT_1) -+#define BIT_CLEAR_NOA_RPT_1(x) ((x) & (~BITS_NOA_RPT_1)) -+#define BIT_GET_NOA_RPT_1(x) (((x) >> BIT_SHIFT_NOA_RPT_1) & BIT_MASK_NOA_RPT_1) -+#define BIT_SET_NOA_RPT_1(x, v) (BIT_CLEAR_NOA_RPT_1(x) | BIT_NOA_RPT_1(v)) -+ -+/* 2 REG_NOA_REPORT_2 (Offset 0x1658) */ -+ -+#define BIT_SHIFT_NOA_RPT_2 0 -+#define BIT_MASK_NOA_RPT_2 0xffffffffL -+#define BIT_NOA_RPT_2(x) (((x) & BIT_MASK_NOA_RPT_2) << BIT_SHIFT_NOA_RPT_2) -+#define BITS_NOA_RPT_2 (BIT_MASK_NOA_RPT_2 << BIT_SHIFT_NOA_RPT_2) -+#define BIT_CLEAR_NOA_RPT_2(x) ((x) & (~BITS_NOA_RPT_2)) -+#define BIT_GET_NOA_RPT_2(x) (((x) >> BIT_SHIFT_NOA_RPT_2) & BIT_MASK_NOA_RPT_2) -+#define BIT_SET_NOA_RPT_2(x, v) (BIT_CLEAR_NOA_RPT_2(x) | BIT_NOA_RPT_2(v)) -+ -+/* 2 REG_NOA_REPORT_3 (Offset 0x165C) */ -+ -+#define BIT_SHIFT_NOA_RPT_3 0 -+#define BIT_MASK_NOA_RPT_3 0xff -+#define BIT_NOA_RPT_3(x) (((x) & BIT_MASK_NOA_RPT_3) << BIT_SHIFT_NOA_RPT_3) -+#define BITS_NOA_RPT_3 (BIT_MASK_NOA_RPT_3 << BIT_SHIFT_NOA_RPT_3) -+#define BIT_CLEAR_NOA_RPT_3(x) ((x) & (~BITS_NOA_RPT_3)) -+#define BIT_GET_NOA_RPT_3(x) (((x) >> BIT_SHIFT_NOA_RPT_3) & BIT_MASK_NOA_RPT_3) -+#define BIT_SET_NOA_RPT_3(x, v) (BIT_CLEAR_NOA_RPT_3(x) | BIT_NOA_RPT_3(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWCTL_EN BIT(15) -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWDATA_EN BIT(14) -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWACT_EN BIT(13) -+#define BIT_CLI3_PWR_ST_V1 BIT(12) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWCTL_EN BIT(11) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWDATA_EN BIT(10) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWACT_EN BIT(9) -+#define BIT_CLI2_PWR_ST_V1 BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI3_PWRBIT_OW_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWCTL_EN BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI3_PWR_ST BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWDATA_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI2_PWRBIT_OW_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWACT_EN BIT(5) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI2_PWR_ST BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI1_PWR_ST_V1 BIT(4) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI1_PWRBIT_OW_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWCTL_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI1_PWR_ST BIT(2) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWDATA_EN BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI0_PWRBIT_OW_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWACT_EN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI0_PWR_ST BIT(0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PWRBIT_SETTING (Offset 0x1660) */ -+ -+#define BIT_CLI0_PWR_ST_V1 BIT(0) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_MACRX_HANG_TIMER_CONTROL (Offset 0x1661) */ -+ -+#define BIT_TIMEOUT_COUNTER_EN BIT(7) -+#define BIT_RESET_FIFO_CONTROL BIT(5) -+ -+#define BIT_SHIFT_COUNT_TIMEOUT 0 -+#define BIT_MASK_COUNT_TIMEOUT 0x1f -+#define BIT_COUNT_TIMEOUT(x) \ -+ (((x) & BIT_MASK_COUNT_TIMEOUT) << BIT_SHIFT_COUNT_TIMEOUT) -+#define BITS_COUNT_TIMEOUT (BIT_MASK_COUNT_TIMEOUT << BIT_SHIFT_COUNT_TIMEOUT) -+#define BIT_CLEAR_COUNT_TIMEOUT(x) ((x) & (~BITS_COUNT_TIMEOUT)) -+#define BIT_GET_COUNT_TIMEOUT(x) \ -+ (((x) >> BIT_SHIFT_COUNT_TIMEOUT) & BIT_MASK_COUNT_TIMEOUT) -+#define BIT_SET_COUNT_TIMEOUT(x, v) \ -+ (BIT_CLEAR_COUNT_TIMEOUT(x) | BIT_COUNT_TIMEOUT(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_FIX_MSDU_TAIL_WR BIT(12) -+#define BIT_FIX_MSDU_SHIFT BIT(11) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_WMAC_RXRST_NDP_TIMEOUT BIT(11) -+#define BIT_WMAC_NDP_STANDBY_WAIT_RXEND BIT(10) -+#define BIT_DUMMY_FCS_READY_MASK_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_RXFIFO_GNT_CUT BIT(8) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_DUMMY_RXD_FCS_ERROR_MASK_EN_V1 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_WMAC_EXT_DBG_SEL_V1 BIT(6) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_WMAC_FIX_FIRST_MPDU_WITH_PHYSTS BIT(5) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_RX_DMA_BYPASS_CHECK_DATABYPASS_CHECK_DATA BIT(4) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_DUMMY_RXD_FCS_ERROR_MASK_EN BIT(4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_RX_DMA_BYPASS_CHECK_MGTBIT_RX_DMA_BYPASS_CHECK_MGT BIT(3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_PATTERN_MATCH_FIX_EN BIT(3) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_GENERAL_OPTION (Offset 0x1664) */ -+ -+#define BIT_TXSERV_FIELD_SEL BIT(2) -+#define BIT_RXVHT_LEN_SEL BIT(1) -+#define BIT_RXMIC_PROTECT_EN BIT(0) -+ -+#define BIT_SHIFT_WMAC_MULBK_PAGE_SIZE 0 -+#define BIT_MASK_WMAC_MULBK_PAGE_SIZE 0xff -+#define BIT_WMAC_MULBK_PAGE_SIZE(x) \ -+ (((x) & BIT_MASK_WMAC_MULBK_PAGE_SIZE) \ -+ << BIT_SHIFT_WMAC_MULBK_PAGE_SIZE) -+#define BITS_WMAC_MULBK_PAGE_SIZE \ -+ (BIT_MASK_WMAC_MULBK_PAGE_SIZE << BIT_SHIFT_WMAC_MULBK_PAGE_SIZE) -+#define BIT_CLEAR_WMAC_MULBK_PAGE_SIZE(x) ((x) & (~BITS_WMAC_MULBK_PAGE_SIZE)) -+#define BIT_GET_WMAC_MULBK_PAGE_SIZE(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MULBK_PAGE_SIZE) & \ -+ BIT_MASK_WMAC_MULBK_PAGE_SIZE) -+#define BIT_SET_WMAC_MULBK_PAGE_SIZE(x, v) \ -+ (BIT_CLEAR_WMAC_MULBK_PAGE_SIZE(x) | BIT_WMAC_MULBK_PAGE_SIZE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWPHYFF_RCR (Offset 0x1668) */ -+ -+#define BIT_RCR2_AAMSDU BIT(25) -+#define BIT_RCR2_CBSSID_BCN BIT(24) -+#define BIT_RCR2_ACRC32 BIT(23) -+#define BIT_RCR2_TA_BCN BIT(22) -+#define BIT_RCR2_CBSSID_DATA BIT(21) -+#define BIT_RCR2_ADD3 BIT(20) -+#define BIT_RCR2_AB BIT(19) -+#define BIT_RCR2_AM BIT(18) -+#define BIT_RCR2_APM BIT(17) -+#define BIT_RCR2_AAP BIT(16) -+#define BIT_RCR1_AAMSDU BIT(9) -+#define BIT_RCR1_CBSSID_BCN BIT(8) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_RXAI_CTRL (Offset 0x1668) */ -+ -+#define BIT_RXAI_INFO_RST BIT(7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWPHYFF_RCR (Offset 0x1668) */ -+ -+#define BIT_RCR1_ACRC32 BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_RXAI_CTRL (Offset 0x1668) */ -+ -+#define BIT_RXAI_PRTCT_REL BIT(6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWPHYFF_RCR (Offset 0x1668) */ -+ -+#define BIT_RCR1_TA_BCN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_RXAI_CTRL (Offset 0x1668) */ -+ -+#define BIT_RXAI_PRTCT_VIO BIT(5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWPHYFF_RCR (Offset 0x1668) */ -+ -+#define BIT_RCR1_CBSSID_DATA BIT(5) -+#define BIT_RCR1_ADD3 BIT(4) -+#define BIT_RCR1_AB BIT(3) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_RXAI_CTRL (Offset 0x1668) */ -+ -+#define BIT_RXAI_PRTCT_SEL BIT(2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWPHYFF_RCR (Offset 0x1668) */ -+ -+#define BIT_RCR1_AM BIT(2) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_RXAI_CTRL (Offset 0x1668) */ -+ -+#define BIT_RXAI_AGG_CHKEN BIT(1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWPHYFF_RCR (Offset 0x1668) */ -+ -+#define BIT_RCR1_APM BIT(1) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_RXAI_CTRL (Offset 0x1668) */ -+ -+#define BIT_RXAI_ADDR_CHKEN BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_FWPHYFF_RCR (Offset 0x1668) */ -+ -+#define BIT_RCR1_AAP BIT(0) -+ -+/* 2 REG_ADDRCAM_WRITE_CONTENT (Offset 0x166C) */ -+ -+#define BIT_SHIFT_ADDRCAM_WDATA 0 -+#define BIT_MASK_ADDRCAM_WDATA 0xffffffffL -+#define BIT_ADDRCAM_WDATA(x) \ -+ (((x) & BIT_MASK_ADDRCAM_WDATA) << BIT_SHIFT_ADDRCAM_WDATA) -+#define BITS_ADDRCAM_WDATA (BIT_MASK_ADDRCAM_WDATA << BIT_SHIFT_ADDRCAM_WDATA) -+#define BIT_CLEAR_ADDRCAM_WDATA(x) ((x) & (~BITS_ADDRCAM_WDATA)) -+#define BIT_GET_ADDRCAM_WDATA(x) \ -+ (((x) >> BIT_SHIFT_ADDRCAM_WDATA) & BIT_MASK_ADDRCAM_WDATA) -+#define BIT_SET_ADDRCAM_WDATA(x, v) \ -+ (BIT_CLEAR_ADDRCAM_WDATA(x) | BIT_ADDRCAM_WDATA(v)) -+ -+/* 2 REG_ADDRCAM_READ_CONTENT (Offset 0x1670) */ -+ -+#define BIT_SHIFT_ADDRCAM_RDATA 0 -+#define BIT_MASK_ADDRCAM_RDATA 0xffffffffL -+#define BIT_ADDRCAM_RDATA(x) \ -+ (((x) & BIT_MASK_ADDRCAM_RDATA) << BIT_SHIFT_ADDRCAM_RDATA) -+#define BITS_ADDRCAM_RDATA (BIT_MASK_ADDRCAM_RDATA << BIT_SHIFT_ADDRCAM_RDATA) -+#define BIT_CLEAR_ADDRCAM_RDATA(x) ((x) & (~BITS_ADDRCAM_RDATA)) -+#define BIT_GET_ADDRCAM_RDATA(x) \ -+ (((x) >> BIT_SHIFT_ADDRCAM_RDATA) & BIT_MASK_ADDRCAM_RDATA) -+#define BIT_SET_ADDRCAM_RDATA(x, v) \ -+ (BIT_CLEAR_ADDRCAM_RDATA(x) | BIT_ADDRCAM_RDATA(v)) -+ -+/* 2 REG_ADDRCAM_CFG (Offset 0x1674) */ -+ -+#define BIT_ADDRCAM_POLL BIT(31) -+#define BIT__ADDRCAM_WT_EN BIT(30) -+#define BIT_CLRADDRCAM BIT(29) -+ -+#define BIT_SHIFT__ADDRCAM_ADDR 8 -+#define BIT_MASK__ADDRCAM_ADDR 0x3ff -+#define BIT__ADDRCAM_ADDR(x) \ -+ (((x) & BIT_MASK__ADDRCAM_ADDR) << BIT_SHIFT__ADDRCAM_ADDR) -+#define BITS__ADDRCAM_ADDR (BIT_MASK__ADDRCAM_ADDR << BIT_SHIFT__ADDRCAM_ADDR) -+#define BIT_CLEAR__ADDRCAM_ADDR(x) ((x) & (~BITS__ADDRCAM_ADDR)) -+#define BIT_GET__ADDRCAM_ADDR(x) \ -+ (((x) >> BIT_SHIFT__ADDRCAM_ADDR) & BIT_MASK__ADDRCAM_ADDR) -+#define BIT_SET__ADDRCAM_ADDR(x, v) \ -+ (BIT_CLEAR__ADDRCAM_ADDR(x) | BIT__ADDRCAM_ADDR(v)) -+ -+#define BIT_SHIFT_ADDRCAM_RANGE 0 -+#define BIT_MASK_ADDRCAM_RANGE 0x7f -+#define BIT_ADDRCAM_RANGE(x) \ -+ (((x) & BIT_MASK_ADDRCAM_RANGE) << BIT_SHIFT_ADDRCAM_RANGE) -+#define BITS_ADDRCAM_RANGE (BIT_MASK_ADDRCAM_RANGE << BIT_SHIFT_ADDRCAM_RANGE) -+#define BIT_CLEAR_ADDRCAM_RANGE(x) ((x) & (~BITS_ADDRCAM_RANGE)) -+#define BIT_GET_ADDRCAM_RANGE(x) \ -+ (((x) >> BIT_SHIFT_ADDRCAM_RANGE) & BIT_MASK_ADDRCAM_RANGE) -+#define BIT_SET_ADDRCAM_RANGE(x, v) \ -+ (BIT_CLEAR_ADDRCAM_RANGE(x) | BIT_ADDRCAM_RANGE(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CSI_RRSR (Offset 0x1678) */ -+ -+#define BIT_CSI_LDPC_EN BIT(29) -+#define BIT_CSI_STBC_EN BIT(28) -+ -+#define BIT_SHIFT_CSI_RRSC_BITMAP 4 -+#define BIT_MASK_CSI_RRSC_BITMAP 0xffffff -+#define BIT_CSI_RRSC_BITMAP(x) \ -+ (((x) & BIT_MASK_CSI_RRSC_BITMAP) << BIT_SHIFT_CSI_RRSC_BITMAP) -+#define BITS_CSI_RRSC_BITMAP \ -+ (BIT_MASK_CSI_RRSC_BITMAP << BIT_SHIFT_CSI_RRSC_BITMAP) -+#define BIT_CLEAR_CSI_RRSC_BITMAP(x) ((x) & (~BITS_CSI_RRSC_BITMAP)) -+#define BIT_GET_CSI_RRSC_BITMAP(x) \ -+ (((x) >> BIT_SHIFT_CSI_RRSC_BITMAP) & BIT_MASK_CSI_RRSC_BITMAP) -+#define BIT_SET_CSI_RRSC_BITMAP(x, v) \ -+ (BIT_CLEAR_CSI_RRSC_BITMAP(x) | BIT_CSI_RRSC_BITMAP(v)) -+ -+#define BIT_SHIFT_OFDM_LEN_TH 0 -+#define BIT_MASK_OFDM_LEN_TH 0xf -+#define BIT_OFDM_LEN_TH(x) \ -+ (((x) & BIT_MASK_OFDM_LEN_TH) << BIT_SHIFT_OFDM_LEN_TH) -+#define BITS_OFDM_LEN_TH (BIT_MASK_OFDM_LEN_TH << BIT_SHIFT_OFDM_LEN_TH) -+#define BIT_CLEAR_OFDM_LEN_TH(x) ((x) & (~BITS_OFDM_LEN_TH)) -+#define BIT_GET_OFDM_LEN_TH(x) \ -+ (((x) >> BIT_SHIFT_OFDM_LEN_TH) & BIT_MASK_OFDM_LEN_TH) -+#define BIT_SET_OFDM_LEN_TH(x, v) \ -+ (BIT_CLEAR_OFDM_LEN_TH(x) | BIT_OFDM_LEN_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WMAC_MU_BF_OPTION (Offset 0x167C) */ -+ -+#define BIT_BIT_WMAC_TXMU_ACKPOLICY_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_MU_BF_OPTION (Offset 0x167C) */ -+ -+#define BIT_WMAC_TXMU_ACKPOLICY_EN BIT(6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_PAUSE_BB_CLR_TH (Offset 0x167D) */ -+ -+#define BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH 0 -+#define BIT_MASK_WMAC_PAUSE_BB_CLR_TH 0xff -+#define BIT_WMAC_PAUSE_BB_CLR_TH(x) \ -+ (((x) & BIT_MASK_WMAC_PAUSE_BB_CLR_TH) \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH) -+#define BITS_WMAC_PAUSE_BB_CLR_TH \ -+ (BIT_MASK_WMAC_PAUSE_BB_CLR_TH << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH) -+#define BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH(x) ((x) & (~BITS_WMAC_PAUSE_BB_CLR_TH)) -+#define BIT_GET_WMAC_PAUSE_BB_CLR_TH(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH) & \ -+ BIT_MASK_WMAC_PAUSE_BB_CLR_TH) -+#define BIT_SET_WMAC_PAUSE_BB_CLR_TH(x, v) \ -+ (BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH(x) | BIT_WMAC_PAUSE_BB_CLR_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WMAC_MU_ARB (Offset 0x167E) */ -+ -+#define BIT_WMAC_ARB_HW_ADAPT_EN BIT(7) -+#define BIT_WMAC_ARB_SW_EN BIT(6) -+ -+#define BIT_SHIFT_WMAC_ARB_SW_STATE 0 -+#define BIT_MASK_WMAC_ARB_SW_STATE 0x3f -+#define BIT_WMAC_ARB_SW_STATE(x) \ -+ (((x) & BIT_MASK_WMAC_ARB_SW_STATE) << BIT_SHIFT_WMAC_ARB_SW_STATE) -+#define BITS_WMAC_ARB_SW_STATE \ -+ (BIT_MASK_WMAC_ARB_SW_STATE << BIT_SHIFT_WMAC_ARB_SW_STATE) -+#define BIT_CLEAR_WMAC_ARB_SW_STATE(x) ((x) & (~BITS_WMAC_ARB_SW_STATE)) -+#define BIT_GET_WMAC_ARB_SW_STATE(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARB_SW_STATE) & BIT_MASK_WMAC_ARB_SW_STATE) -+#define BIT_SET_WMAC_ARB_SW_STATE(x, v) \ -+ (BIT_CLEAR_WMAC_ARB_SW_STATE(x) | BIT_WMAC_ARB_SW_STATE(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WMAC_MU_OPTION (Offset 0x167F) */ -+ -+#define BIT_NOCHK_BFPOLL_BMP BIT(7) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WMAC_MU_OPTION (Offset 0x167F) */ -+ -+#define BIT_SHIFT_WMAC_MU_DBGSEL 5 -+#define BIT_MASK_WMAC_MU_DBGSEL 0x3 -+#define BIT_WMAC_MU_DBGSEL(x) \ -+ (((x) & BIT_MASK_WMAC_MU_DBGSEL) << BIT_SHIFT_WMAC_MU_DBGSEL) -+#define BITS_WMAC_MU_DBGSEL \ -+ (BIT_MASK_WMAC_MU_DBGSEL << BIT_SHIFT_WMAC_MU_DBGSEL) -+#define BIT_CLEAR_WMAC_MU_DBGSEL(x) ((x) & (~BITS_WMAC_MU_DBGSEL)) -+#define BIT_GET_WMAC_MU_DBGSEL(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_DBGSEL) & BIT_MASK_WMAC_MU_DBGSEL) -+#define BIT_SET_WMAC_MU_DBGSEL(x, v) \ -+ (BIT_CLEAR_WMAC_MU_DBGSEL(x) | BIT_WMAC_MU_DBGSEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WMAC_MU_OPTION (Offset 0x167F) */ -+ -+#define BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT 0 -+#define BIT_MASK_WMAC_MU_CPRD_TIMEOUT 0x1f -+#define BIT_WMAC_MU_CPRD_TIMEOUT(x) \ -+ (((x) & BIT_MASK_WMAC_MU_CPRD_TIMEOUT) \ -+ << BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT) -+#define BITS_WMAC_MU_CPRD_TIMEOUT \ -+ (BIT_MASK_WMAC_MU_CPRD_TIMEOUT << BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT) -+#define BIT_CLEAR_WMAC_MU_CPRD_TIMEOUT(x) ((x) & (~BITS_WMAC_MU_CPRD_TIMEOUT)) -+#define BIT_GET_WMAC_MU_CPRD_TIMEOUT(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT) & \ -+ BIT_MASK_WMAC_MU_CPRD_TIMEOUT) -+#define BIT_SET_WMAC_MU_CPRD_TIMEOUT(x, v) \ -+ (BIT_CLEAR_WMAC_MU_CPRD_TIMEOUT(x) | BIT_WMAC_MU_CPRD_TIMEOUT(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_MU_BF_CTL (Offset 0x1680) */ -+ -+#define BIT_WMAC_INVLD_BFPRT_CHK BIT(15) -+#define BIT_WMAC_RETXBFRPTSEQ_UPD BIT(14) -+ -+#define BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL 12 -+#define BIT_MASK_WMAC_MU_BFRPTSEG_SEL 0x3 -+#define BIT_WMAC_MU_BFRPTSEG_SEL(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFRPTSEG_SEL) \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL) -+#define BITS_WMAC_MU_BFRPTSEG_SEL \ -+ (BIT_MASK_WMAC_MU_BFRPTSEG_SEL << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL) -+#define BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL(x) ((x) & (~BITS_WMAC_MU_BFRPTSEG_SEL)) -+#define BIT_GET_WMAC_MU_BFRPTSEG_SEL(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL) & \ -+ BIT_MASK_WMAC_MU_BFRPTSEG_SEL) -+#define BIT_SET_WMAC_MU_BFRPTSEG_SEL(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL(x) | BIT_WMAC_MU_BFRPTSEG_SEL(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BF_MYAID 0 -+#define BIT_MASK_WMAC_MU_BF_MYAID 0xfff -+#define BIT_WMAC_MU_BF_MYAID(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BF_MYAID) << BIT_SHIFT_WMAC_MU_BF_MYAID) -+#define BITS_WMAC_MU_BF_MYAID \ -+ (BIT_MASK_WMAC_MU_BF_MYAID << BIT_SHIFT_WMAC_MU_BF_MYAID) -+#define BIT_CLEAR_WMAC_MU_BF_MYAID(x) ((x) & (~BITS_WMAC_MU_BF_MYAID)) -+#define BIT_GET_WMAC_MU_BF_MYAID(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BF_MYAID) & BIT_MASK_WMAC_MU_BF_MYAID) -+#define BIT_SET_WMAC_MU_BF_MYAID(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BF_MYAID(x) | BIT_WMAC_MU_BF_MYAID(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA (Offset 0x1682) */ -+ -+#define BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1 13 -+#define BIT_MASK_BFRPT_PARA_USERID_SEL_V1 0x7 -+#define BIT_BFRPT_PARA_USERID_SEL_V1(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_USERID_SEL_V1) \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1) -+#define BITS_BFRPT_PARA_USERID_SEL_V1 \ -+ (BIT_MASK_BFRPT_PARA_USERID_SEL_V1 \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1) -+#define BIT_CLEAR_BFRPT_PARA_USERID_SEL_V1(x) \ -+ ((x) & (~BITS_BFRPT_PARA_USERID_SEL_V1)) -+#define BIT_GET_BFRPT_PARA_USERID_SEL_V1(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1) & \ -+ BIT_MASK_BFRPT_PARA_USERID_SEL_V1) -+#define BIT_SET_BFRPT_PARA_USERID_SEL_V1(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_USERID_SEL_V1(x) | \ -+ BIT_BFRPT_PARA_USERID_SEL_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA (Offset 0x1682) */ -+ -+#define BIT_SHIFT_BFRPT_PARA_USERID_SEL 12 -+#define BIT_MASK_BFRPT_PARA_USERID_SEL 0x7 -+#define BIT_BFRPT_PARA_USERID_SEL(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_USERID_SEL) \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL) -+#define BITS_BFRPT_PARA_USERID_SEL \ -+ (BIT_MASK_BFRPT_PARA_USERID_SEL << BIT_SHIFT_BFRPT_PARA_USERID_SEL) -+#define BIT_CLEAR_BFRPT_PARA_USERID_SEL(x) ((x) & (~BITS_BFRPT_PARA_USERID_SEL)) -+#define BIT_GET_BFRPT_PARA_USERID_SEL(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_USERID_SEL) & \ -+ BIT_MASK_BFRPT_PARA_USERID_SEL) -+#define BIT_SET_BFRPT_PARA_USERID_SEL(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_USERID_SEL(x) | BIT_BFRPT_PARA_USERID_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA (Offset 0x1682) */ -+ -+#define BIT_SHIFT_BIT_BFRPT_PARA_USERID_SEL 12 -+#define BIT_MASK_BIT_BFRPT_PARA_USERID_SEL 0x7 -+#define BIT_BIT_BFRPT_PARA_USERID_SEL(x) \ -+ (((x) & BIT_MASK_BIT_BFRPT_PARA_USERID_SEL) \ -+ << BIT_SHIFT_BIT_BFRPT_PARA_USERID_SEL) -+#define BITS_BIT_BFRPT_PARA_USERID_SEL \ -+ (BIT_MASK_BIT_BFRPT_PARA_USERID_SEL \ -+ << BIT_SHIFT_BIT_BFRPT_PARA_USERID_SEL) -+#define BIT_CLEAR_BIT_BFRPT_PARA_USERID_SEL(x) \ -+ ((x) & (~BITS_BIT_BFRPT_PARA_USERID_SEL)) -+#define BIT_GET_BIT_BFRPT_PARA_USERID_SEL(x) \ -+ (((x) >> BIT_SHIFT_BIT_BFRPT_PARA_USERID_SEL) & \ -+ BIT_MASK_BIT_BFRPT_PARA_USERID_SEL) -+#define BIT_SET_BIT_BFRPT_PARA_USERID_SEL(x, v) \ -+ (BIT_CLEAR_BIT_BFRPT_PARA_USERID_SEL(x) | \ -+ BIT_BIT_BFRPT_PARA_USERID_SEL(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA (Offset 0x1682) */ -+ -+#define BIT_SHIFT_BFRPT_PARA 0 -+#define BIT_MASK_BFRPT_PARA 0xfff -+#define BIT_BFRPT_PARA(x) (((x) & BIT_MASK_BFRPT_PARA) << BIT_SHIFT_BFRPT_PARA) -+#define BITS_BFRPT_PARA (BIT_MASK_BFRPT_PARA << BIT_SHIFT_BFRPT_PARA) -+#define BIT_CLEAR_BFRPT_PARA(x) ((x) & (~BITS_BFRPT_PARA)) -+#define BIT_GET_BFRPT_PARA(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA) & BIT_MASK_BFRPT_PARA) -+#define BIT_SET_BFRPT_PARA(x, v) (BIT_CLEAR_BFRPT_PARA(x) | BIT_BFRPT_PARA(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA (Offset 0x1682) */ -+ -+#define BIT_SHIFT_BFRPT_PARA_V1 0 -+#define BIT_MASK_BFRPT_PARA_V1 0x1fff -+#define BIT_BFRPT_PARA_V1(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_V1) << BIT_SHIFT_BFRPT_PARA_V1) -+#define BITS_BFRPT_PARA_V1 (BIT_MASK_BFRPT_PARA_V1 << BIT_SHIFT_BFRPT_PARA_V1) -+#define BIT_CLEAR_BFRPT_PARA_V1(x) ((x) & (~BITS_BFRPT_PARA_V1)) -+#define BIT_GET_BFRPT_PARA_V1(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_V1) & BIT_MASK_BFRPT_PARA_V1) -+#define BIT_SET_BFRPT_PARA_V1(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_V1(x) | BIT_BFRPT_PARA_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE2 (Offset 0x1684) */ -+ -+#define BIT_STATUS_BFEE2 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE2 (Offset 0x1684) */ -+ -+#define BIT_WMAC_MU_BFEE2_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE2 (Offset 0x1684) */ -+ -+#define BIT_WMAC_MU_BFEE2_USER_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE2 (Offset 0x1684) */ -+ -+#define BIT_SHIFT_WMAC_MU_BFEE2_AID 0 -+#define BIT_MASK_WMAC_MU_BFEE2_AID 0x1ff -+#define BIT_WMAC_MU_BFEE2_AID(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE2_AID) << BIT_SHIFT_WMAC_MU_BFEE2_AID) -+#define BITS_WMAC_MU_BFEE2_AID \ -+ (BIT_MASK_WMAC_MU_BFEE2_AID << BIT_SHIFT_WMAC_MU_BFEE2_AID) -+#define BIT_CLEAR_WMAC_MU_BFEE2_AID(x) ((x) & (~BITS_WMAC_MU_BFEE2_AID)) -+#define BIT_GET_WMAC_MU_BFEE2_AID(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE2_AID) & BIT_MASK_WMAC_MU_BFEE2_AID) -+#define BIT_SET_WMAC_MU_BFEE2_AID(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE2_AID(x) | BIT_WMAC_MU_BFEE2_AID(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE3 (Offset 0x1686) */ -+ -+#define BIT_STATUS_BFEE3 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE3 (Offset 0x1686) */ -+ -+#define BIT_WMAC_MU_BFEE3_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE3 (Offset 0x1686) */ -+ -+#define BIT_WMAC_MU_BFEE3_USER_EN BIT(9) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE3 (Offset 0x1686) */ -+ -+#define BIT_SHIFT_WMAC_MU_BFEE3_AID 0 -+#define BIT_MASK_WMAC_MU_BFEE3_AID 0x1ff -+#define BIT_WMAC_MU_BFEE3_AID(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE3_AID) << BIT_SHIFT_WMAC_MU_BFEE3_AID) -+#define BITS_WMAC_MU_BFEE3_AID \ -+ (BIT_MASK_WMAC_MU_BFEE3_AID << BIT_SHIFT_WMAC_MU_BFEE3_AID) -+#define BIT_CLEAR_WMAC_MU_BFEE3_AID(x) ((x) & (~BITS_WMAC_MU_BFEE3_AID)) -+#define BIT_GET_WMAC_MU_BFEE3_AID(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE3_AID) & BIT_MASK_WMAC_MU_BFEE3_AID) -+#define BIT_SET_WMAC_MU_BFEE3_AID(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE3_AID(x) | BIT_WMAC_MU_BFEE3_AID(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE4 (Offset 0x1688) */ -+ -+#define BIT_STATUS_BFEE4 BIT(10) -+#define BIT_WMAC_MU_BFEE4_EN BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE4_AID 0 -+#define BIT_MASK_WMAC_MU_BFEE4_AID 0x1ff -+#define BIT_WMAC_MU_BFEE4_AID(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE4_AID) << BIT_SHIFT_WMAC_MU_BFEE4_AID) -+#define BITS_WMAC_MU_BFEE4_AID \ -+ (BIT_MASK_WMAC_MU_BFEE4_AID << BIT_SHIFT_WMAC_MU_BFEE4_AID) -+#define BIT_CLEAR_WMAC_MU_BFEE4_AID(x) ((x) & (~BITS_WMAC_MU_BFEE4_AID)) -+#define BIT_GET_WMAC_MU_BFEE4_AID(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE4_AID) & BIT_MASK_WMAC_MU_BFEE4_AID) -+#define BIT_SET_WMAC_MU_BFEE4_AID(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE4_AID(x) | BIT_WMAC_MU_BFEE4_AID(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE5 (Offset 0x168A) */ -+ -+#define BIT_STATUS_BFEE5 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE5 (Offset 0x168A) */ -+ -+#define BIT_BIT_STATUS_BFEE5 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE5 (Offset 0x168A) */ -+ -+#define BIT_WMAC_MU_BFEE5_EN BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE5_AID 0 -+#define BIT_MASK_WMAC_MU_BFEE5_AID 0x1ff -+#define BIT_WMAC_MU_BFEE5_AID(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE5_AID) << BIT_SHIFT_WMAC_MU_BFEE5_AID) -+#define BITS_WMAC_MU_BFEE5_AID \ -+ (BIT_MASK_WMAC_MU_BFEE5_AID << BIT_SHIFT_WMAC_MU_BFEE5_AID) -+#define BIT_CLEAR_WMAC_MU_BFEE5_AID(x) ((x) & (~BITS_WMAC_MU_BFEE5_AID)) -+#define BIT_GET_WMAC_MU_BFEE5_AID(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE5_AID) & BIT_MASK_WMAC_MU_BFEE5_AID) -+#define BIT_SET_WMAC_MU_BFEE5_AID(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE5_AID(x) | BIT_WMAC_MU_BFEE5_AID(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE6 (Offset 0x168C) */ -+ -+#define BIT_STATUS_BFEE6 BIT(10) -+#define BIT_WMAC_MU_BFEE6_EN BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE6_AID 0 -+#define BIT_MASK_WMAC_MU_BFEE6_AID 0x1ff -+#define BIT_WMAC_MU_BFEE6_AID(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE6_AID) << BIT_SHIFT_WMAC_MU_BFEE6_AID) -+#define BITS_WMAC_MU_BFEE6_AID \ -+ (BIT_MASK_WMAC_MU_BFEE6_AID << BIT_SHIFT_WMAC_MU_BFEE6_AID) -+#define BIT_CLEAR_WMAC_MU_BFEE6_AID(x) ((x) & (~BITS_WMAC_MU_BFEE6_AID)) -+#define BIT_GET_WMAC_MU_BFEE6_AID(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE6_AID) & BIT_MASK_WMAC_MU_BFEE6_AID) -+#define BIT_SET_WMAC_MU_BFEE6_AID(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE6_AID(x) | BIT_WMAC_MU_BFEE6_AID(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE7 (Offset 0x168E) */ -+ -+#define BIT_BIT_STATUS_BFEE4 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE7 (Offset 0x168E) */ -+ -+#define BIT_STATUS_BFEE7 BIT(10) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE7 (Offset 0x168E) */ -+ -+#define BIT_WMAC_MU_BFEE7_EN BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE7_AID 0 -+#define BIT_MASK_WMAC_MU_BFEE7_AID 0x1ff -+#define BIT_WMAC_MU_BFEE7_AID(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE7_AID) << BIT_SHIFT_WMAC_MU_BFEE7_AID) -+#define BITS_WMAC_MU_BFEE7_AID \ -+ (BIT_MASK_WMAC_MU_BFEE7_AID << BIT_SHIFT_WMAC_MU_BFEE7_AID) -+#define BIT_CLEAR_WMAC_MU_BFEE7_AID(x) ((x) & (~BITS_WMAC_MU_BFEE7_AID)) -+#define BIT_GET_WMAC_MU_BFEE7_AID(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE7_AID) & BIT_MASK_WMAC_MU_BFEE7_AID) -+#define BIT_SET_WMAC_MU_BFEE7_AID(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE7_AID(x) | BIT_WMAC_MU_BFEE7_AID(v)) -+ -+/* 2 REG_WMAC_BB_STOP_RX_COUNTER (Offset 0x1690) */ -+ -+#define BIT_RST_ALL_COUNTER BIT(31) -+ -+#define BIT_SHIFT_ABORT_RX_VBON_COUNTER 16 -+#define BIT_MASK_ABORT_RX_VBON_COUNTER 0xff -+#define BIT_ABORT_RX_VBON_COUNTER(x) \ -+ (((x) & BIT_MASK_ABORT_RX_VBON_COUNTER) \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER) -+#define BITS_ABORT_RX_VBON_COUNTER \ -+ (BIT_MASK_ABORT_RX_VBON_COUNTER << BIT_SHIFT_ABORT_RX_VBON_COUNTER) -+#define BIT_CLEAR_ABORT_RX_VBON_COUNTER(x) ((x) & (~BITS_ABORT_RX_VBON_COUNTER)) -+#define BIT_GET_ABORT_RX_VBON_COUNTER(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_VBON_COUNTER) & \ -+ BIT_MASK_ABORT_RX_VBON_COUNTER) -+#define BIT_SET_ABORT_RX_VBON_COUNTER(x, v) \ -+ (BIT_CLEAR_ABORT_RX_VBON_COUNTER(x) | BIT_ABORT_RX_VBON_COUNTER(v)) -+ -+#define BIT_SHIFT_ABORT_RX_RDRDY_COUNTER 8 -+#define BIT_MASK_ABORT_RX_RDRDY_COUNTER 0xff -+#define BIT_ABORT_RX_RDRDY_COUNTER(x) \ -+ (((x) & BIT_MASK_ABORT_RX_RDRDY_COUNTER) \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER) -+#define BITS_ABORT_RX_RDRDY_COUNTER \ -+ (BIT_MASK_ABORT_RX_RDRDY_COUNTER << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER) -+#define BIT_CLEAR_ABORT_RX_RDRDY_COUNTER(x) \ -+ ((x) & (~BITS_ABORT_RX_RDRDY_COUNTER)) -+#define BIT_GET_ABORT_RX_RDRDY_COUNTER(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_RDRDY_COUNTER) & \ -+ BIT_MASK_ABORT_RX_RDRDY_COUNTER) -+#define BIT_SET_ABORT_RX_RDRDY_COUNTER(x, v) \ -+ (BIT_CLEAR_ABORT_RX_RDRDY_COUNTER(x) | BIT_ABORT_RX_RDRDY_COUNTER(v)) -+ -+#define BIT_SHIFT_VBON_EARLY_FALLING_COUNTER 0 -+#define BIT_MASK_VBON_EARLY_FALLING_COUNTER 0xff -+#define BIT_VBON_EARLY_FALLING_COUNTER(x) \ -+ (((x) & BIT_MASK_VBON_EARLY_FALLING_COUNTER) \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER) -+#define BITS_VBON_EARLY_FALLING_COUNTER \ -+ (BIT_MASK_VBON_EARLY_FALLING_COUNTER \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER) -+#define BIT_CLEAR_VBON_EARLY_FALLING_COUNTER(x) \ -+ ((x) & (~BITS_VBON_EARLY_FALLING_COUNTER)) -+#define BIT_GET_VBON_EARLY_FALLING_COUNTER(x) \ -+ (((x) >> BIT_SHIFT_VBON_EARLY_FALLING_COUNTER) & \ -+ BIT_MASK_VBON_EARLY_FALLING_COUNTER) -+#define BIT_SET_VBON_EARLY_FALLING_COUNTER(x, v) \ -+ (BIT_CLEAR_VBON_EARLY_FALLING_COUNTER(x) | \ -+ BIT_VBON_EARLY_FALLING_COUNTER(v)) -+ -+/* 2 REG_WMAC_PLCP_MONITOR (Offset 0x1694) */ -+ -+#define BIT_WMAC_PLCP_TRX_SEL BIT(31) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_SEL 28 -+#define BIT_MASK_WMAC_PLCP_RDSIG_SEL 0x7 -+#define BIT_WMAC_PLCP_RDSIG_SEL(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_SEL) << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL) -+#define BITS_WMAC_PLCP_RDSIG_SEL \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_SEL << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_SEL(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_SEL)) -+#define BIT_GET_WMAC_PLCP_RDSIG_SEL(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_SEL) & BIT_MASK_WMAC_PLCP_RDSIG_SEL) -+#define BIT_SET_WMAC_PLCP_RDSIG_SEL(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_SEL(x) | BIT_WMAC_PLCP_RDSIG_SEL(v)) -+ -+#define BIT_SHIFT_WMAC_RATE_IDX 24 -+#define BIT_MASK_WMAC_RATE_IDX 0xf -+#define BIT_WMAC_RATE_IDX(x) \ -+ (((x) & BIT_MASK_WMAC_RATE_IDX) << BIT_SHIFT_WMAC_RATE_IDX) -+#define BITS_WMAC_RATE_IDX (BIT_MASK_WMAC_RATE_IDX << BIT_SHIFT_WMAC_RATE_IDX) -+#define BIT_CLEAR_WMAC_RATE_IDX(x) ((x) & (~BITS_WMAC_RATE_IDX)) -+#define BIT_GET_WMAC_RATE_IDX(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RATE_IDX) & BIT_MASK_WMAC_RATE_IDX) -+#define BIT_SET_WMAC_RATE_IDX(x, v) \ -+ (BIT_CLEAR_WMAC_RATE_IDX(x) | BIT_WMAC_RATE_IDX(v)) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG 0xffffff -+#define BIT_WMAC_PLCP_RDSIG(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG) << BIT_SHIFT_WMAC_PLCP_RDSIG) -+#define BITS_WMAC_PLCP_RDSIG \ -+ (BIT_MASK_WMAC_PLCP_RDSIG << BIT_SHIFT_WMAC_PLCP_RDSIG) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG(x) ((x) & (~BITS_WMAC_PLCP_RDSIG)) -+#define BIT_GET_WMAC_PLCP_RDSIG(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG) & BIT_MASK_WMAC_PLCP_RDSIG) -+#define BIT_SET_WMAC_PLCP_RDSIG(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG(x) | BIT_WMAC_PLCP_RDSIG(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_PLCP_MONITOR_MUTX (Offset 0x1698) */ -+ -+#define BIT_WMAC_MUTX_IDX BIT(24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_WMAC_DEBUG_PORT (Offset 0x1698) */ -+ -+#define BIT_SHIFT_WMAC_DEBUG_PORT 0 -+#define BIT_MASK_WMAC_DEBUG_PORT 0xffffffffL -+#define BIT_WMAC_DEBUG_PORT(x) \ -+ (((x) & BIT_MASK_WMAC_DEBUG_PORT) << BIT_SHIFT_WMAC_DEBUG_PORT) -+#define BITS_WMAC_DEBUG_PORT \ -+ (BIT_MASK_WMAC_DEBUG_PORT << BIT_SHIFT_WMAC_DEBUG_PORT) -+#define BIT_CLEAR_WMAC_DEBUG_PORT(x) ((x) & (~BITS_WMAC_DEBUG_PORT)) -+#define BIT_GET_WMAC_DEBUG_PORT(x) \ -+ (((x) >> BIT_SHIFT_WMAC_DEBUG_PORT) & BIT_MASK_WMAC_DEBUG_PORT) -+#define BIT_SET_WMAC_DEBUG_PORT(x, v) \ -+ (BIT_CLEAR_WMAC_DEBUG_PORT(x) | BIT_WMAC_DEBUG_PORT(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WMAC_CSIDMA_CFG (Offset 0x169C) */ -+ -+#define BIT_SHIFT_CSI_SEG_SIZE 16 -+#define BIT_MASK_CSI_SEG_SIZE 0xfff -+#define BIT_CSI_SEG_SIZE(x) \ -+ (((x) & BIT_MASK_CSI_SEG_SIZE) << BIT_SHIFT_CSI_SEG_SIZE) -+#define BITS_CSI_SEG_SIZE (BIT_MASK_CSI_SEG_SIZE << BIT_SHIFT_CSI_SEG_SIZE) -+#define BIT_CLEAR_CSI_SEG_SIZE(x) ((x) & (~BITS_CSI_SEG_SIZE)) -+#define BIT_GET_CSI_SEG_SIZE(x) \ -+ (((x) >> BIT_SHIFT_CSI_SEG_SIZE) & BIT_MASK_CSI_SEG_SIZE) -+#define BIT_SET_CSI_SEG_SIZE(x, v) \ -+ (BIT_CLEAR_CSI_SEG_SIZE(x) | BIT_CSI_SEG_SIZE(v)) -+ -+#define BIT_SHIFT_CSI_START_PAGE 0 -+#define BIT_MASK_CSI_START_PAGE 0xfff -+#define BIT_CSI_START_PAGE(x) \ -+ (((x) & BIT_MASK_CSI_START_PAGE) << BIT_SHIFT_CSI_START_PAGE) -+#define BITS_CSI_START_PAGE \ -+ (BIT_MASK_CSI_START_PAGE << BIT_SHIFT_CSI_START_PAGE) -+#define BIT_CLEAR_CSI_START_PAGE(x) ((x) & (~BITS_CSI_START_PAGE)) -+#define BIT_GET_CSI_START_PAGE(x) \ -+ (((x) >> BIT_SHIFT_CSI_START_PAGE) & BIT_MASK_CSI_START_PAGE) -+#define BIT_SET_CSI_START_PAGE(x, v) \ -+ (BIT_CLEAR_CSI_START_PAGE(x) | BIT_CSI_START_PAGE(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_TRANSMIT_ADDRSS_0 (Offset 0x16A0) */ -+ -+#define BIT_SHIFT_TA0 0 -+#define BIT_MASK_TA0 0xffffffffffffL -+#define BIT_TA0(x) (((x) & BIT_MASK_TA0) << BIT_SHIFT_TA0) -+#define BITS_TA0 (BIT_MASK_TA0 << BIT_SHIFT_TA0) -+#define BIT_CLEAR_TA0(x) ((x) & (~BITS_TA0)) -+#define BIT_GET_TA0(x) (((x) >> BIT_SHIFT_TA0) & BIT_MASK_TA0) -+#define BIT_SET_TA0(x, v) (BIT_CLEAR_TA0(x) | BIT_TA0(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TRANSMIT_ADDRSS_0 (Offset 0x16A0) */ -+ -+#define BIT_SHIFT_TA0_V1 0 -+#define BIT_MASK_TA0_V1 0xffffffffL -+#define BIT_TA0_V1(x) (((x) & BIT_MASK_TA0_V1) << BIT_SHIFT_TA0_V1) -+#define BITS_TA0_V1 (BIT_MASK_TA0_V1 << BIT_SHIFT_TA0_V1) -+#define BIT_CLEAR_TA0_V1(x) ((x) & (~BITS_TA0_V1)) -+#define BIT_GET_TA0_V1(x) (((x) >> BIT_SHIFT_TA0_V1) & BIT_MASK_TA0_V1) -+#define BIT_SET_TA0_V1(x, v) (BIT_CLEAR_TA0_V1(x) | BIT_TA0_V1(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_H (Offset 0x16A4) */ -+ -+#define BIT_SHIFT_TA0_H_V1 0 -+#define BIT_MASK_TA0_H_V1 0xffff -+#define BIT_TA0_H_V1(x) (((x) & BIT_MASK_TA0_H_V1) << BIT_SHIFT_TA0_H_V1) -+#define BITS_TA0_H_V1 (BIT_MASK_TA0_H_V1 << BIT_SHIFT_TA0_H_V1) -+#define BIT_CLEAR_TA0_H_V1(x) ((x) & (~BITS_TA0_H_V1)) -+#define BIT_GET_TA0_H_V1(x) (((x) >> BIT_SHIFT_TA0_H_V1) & BIT_MASK_TA0_H_V1) -+#define BIT_SET_TA0_H_V1(x, v) (BIT_CLEAR_TA0_H_V1(x) | BIT_TA0_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1 (Offset 0x16A8) */ -+ -+#define BIT_SHIFT_TA1 0 -+#define BIT_MASK_TA1 0xffffffffffffL -+#define BIT_TA1(x) (((x) & BIT_MASK_TA1) << BIT_SHIFT_TA1) -+#define BITS_TA1 (BIT_MASK_TA1 << BIT_SHIFT_TA1) -+#define BIT_CLEAR_TA1(x) ((x) & (~BITS_TA1)) -+#define BIT_GET_TA1(x) (((x) >> BIT_SHIFT_TA1) & BIT_MASK_TA1) -+#define BIT_SET_TA1(x, v) (BIT_CLEAR_TA1(x) | BIT_TA1(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1 (Offset 0x16A8) */ -+ -+#define BIT_SHIFT_TA1_V1 0 -+#define BIT_MASK_TA1_V1 0xffffffffL -+#define BIT_TA1_V1(x) (((x) & BIT_MASK_TA1_V1) << BIT_SHIFT_TA1_V1) -+#define BITS_TA1_V1 (BIT_MASK_TA1_V1 << BIT_SHIFT_TA1_V1) -+#define BIT_CLEAR_TA1_V1(x) ((x) & (~BITS_TA1_V1)) -+#define BIT_GET_TA1_V1(x) (((x) >> BIT_SHIFT_TA1_V1) & BIT_MASK_TA1_V1) -+#define BIT_SET_TA1_V1(x, v) (BIT_CLEAR_TA1_V1(x) | BIT_TA1_V1(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_H (Offset 0x16AC) */ -+ -+#define BIT_SHIFT_TA1_H_V1 0 -+#define BIT_MASK_TA1_H_V1 0xffff -+#define BIT_TA1_H_V1(x) (((x) & BIT_MASK_TA1_H_V1) << BIT_SHIFT_TA1_H_V1) -+#define BITS_TA1_H_V1 (BIT_MASK_TA1_H_V1 << BIT_SHIFT_TA1_H_V1) -+#define BIT_CLEAR_TA1_H_V1(x) ((x) & (~BITS_TA1_H_V1)) -+#define BIT_GET_TA1_H_V1(x) (((x) >> BIT_SHIFT_TA1_H_V1) & BIT_MASK_TA1_H_V1) -+#define BIT_SET_TA1_H_V1(x, v) (BIT_CLEAR_TA1_H_V1(x) | BIT_TA1_H_V1(v)) -+ -+#define BIT_SHIFT_TA2_V1 0 -+#define BIT_MASK_TA2_V1 0xffffffffL -+#define BIT_TA2_V1(x) (((x) & BIT_MASK_TA2_V1) << BIT_SHIFT_TA2_V1) -+#define BITS_TA2_V1 (BIT_MASK_TA2_V1 << BIT_SHIFT_TA2_V1) -+#define BIT_CLEAR_TA2_V1(x) ((x) & (~BITS_TA2_V1)) -+#define BIT_GET_TA2_V1(x) (((x) >> BIT_SHIFT_TA2_V1) & BIT_MASK_TA2_V1) -+#define BIT_SET_TA2_V1(x, v) (BIT_CLEAR_TA2_V1(x) | BIT_TA2_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2 (Offset 0x16B0) */ -+ -+#define BIT_SHIFT_TA2 0 -+#define BIT_MASK_TA2 0xffffffffffffL -+#define BIT_TA2(x) (((x) & BIT_MASK_TA2) << BIT_SHIFT_TA2) -+#define BITS_TA2 (BIT_MASK_TA2 << BIT_SHIFT_TA2) -+#define BIT_CLEAR_TA2(x) ((x) & (~BITS_TA2)) -+#define BIT_GET_TA2(x) (((x) >> BIT_SHIFT_TA2) & BIT_MASK_TA2) -+#define BIT_SET_TA2(x, v) (BIT_CLEAR_TA2(x) | BIT_TA2(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_H (Offset 0x16B4) */ -+ -+#define BIT_SHIFT_TA2_H_V1 0 -+#define BIT_MASK_TA2_H_V1 0xffff -+#define BIT_TA2_H_V1(x) (((x) & BIT_MASK_TA2_H_V1) << BIT_SHIFT_TA2_H_V1) -+#define BITS_TA2_H_V1 (BIT_MASK_TA2_H_V1 << BIT_SHIFT_TA2_H_V1) -+#define BIT_CLEAR_TA2_H_V1(x) ((x) & (~BITS_TA2_H_V1)) -+#define BIT_GET_TA2_H_V1(x) (((x) >> BIT_SHIFT_TA2_H_V1) & BIT_MASK_TA2_H_V1) -+#define BIT_SET_TA2_H_V1(x, v) (BIT_CLEAR_TA2_H_V1(x) | BIT_TA2_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3 (Offset 0x16B8) */ -+ -+#define BIT_SHIFT_TA3 0 -+#define BIT_MASK_TA3 0xffffffffffffL -+#define BIT_TA3(x) (((x) & BIT_MASK_TA3) << BIT_SHIFT_TA3) -+#define BITS_TA3 (BIT_MASK_TA3 << BIT_SHIFT_TA3) -+#define BIT_CLEAR_TA3(x) ((x) & (~BITS_TA3)) -+#define BIT_GET_TA3(x) (((x) >> BIT_SHIFT_TA3) & BIT_MASK_TA3) -+#define BIT_SET_TA3(x, v) (BIT_CLEAR_TA3(x) | BIT_TA3(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_H (Offset 0x16BC) */ -+ -+#define BIT_SHIFT_TA3_H_V1 0 -+#define BIT_MASK_TA3_H_V1 0xffff -+#define BIT_TA3_H_V1(x) (((x) & BIT_MASK_TA3_H_V1) << BIT_SHIFT_TA3_H_V1) -+#define BITS_TA3_H_V1 (BIT_MASK_TA3_H_V1 << BIT_SHIFT_TA3_H_V1) -+#define BIT_CLEAR_TA3_H_V1(x) ((x) & (~BITS_TA3_H_V1)) -+#define BIT_GET_TA3_H_V1(x) (((x) >> BIT_SHIFT_TA3_H_V1) & BIT_MASK_TA3_H_V1) -+#define BIT_SET_TA3_H_V1(x, v) (BIT_CLEAR_TA3_H_V1(x) | BIT_TA3_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4 (Offset 0x16C0) */ -+ -+#define BIT_R_WMAC_RX_SYNCFIFO_SYNC BIT(55) -+#define BIT_R_WMAC_RXRST_DLY BIT(54) -+#define BIT_R_WMAC_SRCH_TXRPT_REF_DROP BIT(53) -+#define BIT_R_WMAC_SRCH_TXRPT_UA1 BIT(52) -+ -+#define BIT_SHIFT_TA4 0 -+#define BIT_MASK_TA4 0xffffffffffffL -+#define BIT_TA4(x) (((x) & BIT_MASK_TA4) << BIT_SHIFT_TA4) -+#define BITS_TA4 (BIT_MASK_TA4 << BIT_SHIFT_TA4) -+#define BIT_CLEAR_TA4(x) ((x) & (~BITS_TA4)) -+#define BIT_GET_TA4(x) (((x) >> BIT_SHIFT_TA4) & BIT_MASK_TA4) -+#define BIT_SET_TA4(x, v) (BIT_CLEAR_TA4(x) | BIT_TA4(v)) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4 (Offset 0x16C0) */ -+ -+#define BIT_SHIFT_TA4_V1 0 -+#define BIT_MASK_TA4_V1 0xffffffffL -+#define BIT_TA4_V1(x) (((x) & BIT_MASK_TA4_V1) << BIT_SHIFT_TA4_V1) -+#define BITS_TA4_V1 (BIT_MASK_TA4_V1 << BIT_SHIFT_TA4_V1) -+#define BIT_CLEAR_TA4_V1(x) ((x) & (~BITS_TA4_V1)) -+#define BIT_GET_TA4_V1(x) (((x) >> BIT_SHIFT_TA4_V1) & BIT_MASK_TA4_V1) -+#define BIT_SET_TA4_V1(x, v) (BIT_CLEAR_TA4_V1(x) | BIT_TA4_V1(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_H (Offset 0x16C4) */ -+ -+#define BIT_SHIFT_TA4_H_V1 0 -+#define BIT_MASK_TA4_H_V1 0xffff -+#define BIT_TA4_H_V1(x) (((x) & BIT_MASK_TA4_H_V1) << BIT_SHIFT_TA4_H_V1) -+#define BITS_TA4_H_V1 (BIT_MASK_TA4_H_V1 << BIT_SHIFT_TA4_H_V1) -+#define BIT_CLEAR_TA4_H_V1(x) ((x) & (~BITS_TA4_H_V1)) -+#define BIT_GET_TA4_H_V1(x) (((x) >> BIT_SHIFT_TA4_H_V1) & BIT_MASK_TA4_H_V1) -+#define BIT_SET_TA4_H_V1(x, v) (BIT_CLEAR_TA4_H_V1(x) | BIT_TA4_H_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/* 2 REG_SND_AID12 (Offset 0x16D0) */ -+ -+#define BIT_SHIFT_USERID_SEL 12 -+#define BIT_MASK_USERID_SEL 0x7 -+#define BIT_USERID_SEL(x) (((x) & BIT_MASK_USERID_SEL) << BIT_SHIFT_USERID_SEL) -+#define BITS_USERID_SEL (BIT_MASK_USERID_SEL << BIT_SHIFT_USERID_SEL) -+#define BIT_CLEAR_USERID_SEL(x) ((x) & (~BITS_USERID_SEL)) -+#define BIT_GET_USERID_SEL(x) \ -+ (((x) >> BIT_SHIFT_USERID_SEL) & BIT_MASK_USERID_SEL) -+#define BIT_SET_USERID_SEL(x, v) (BIT_CLEAR_USERID_SEL(x) | BIT_USERID_SEL(v)) -+ -+#define BIT_SHIFT_USERID_AID12 0 -+#define BIT_MASK_USERID_AID12 0xfff -+#define BIT_USERID_AID12(x) \ -+ (((x) & BIT_MASK_USERID_AID12) << BIT_SHIFT_USERID_AID12) -+#define BITS_USERID_AID12 (BIT_MASK_USERID_AID12 << BIT_SHIFT_USERID_AID12) -+#define BIT_CLEAR_USERID_AID12(x) ((x) & (~BITS_USERID_AID12)) -+#define BIT_GET_USERID_AID12(x) \ -+ (((x) >> BIT_SHIFT_USERID_AID12) & BIT_MASK_USERID_AID12) -+#define BIT_SET_USERID_AID12(x, v) \ -+ (BIT_CLEAR_USERID_AID12(x) | BIT_USERID_AID12(v)) -+ -+/* 2 REG_SND_PKT_INFO (Offset 0x16D2) */ -+ -+#define BIT_SND_FROM_DS BIT(7) -+#define BIT_SND_TO_DS BIT(6) -+ -+#define BIT_SHIFT_SND_TOKEN 0 -+#define BIT_MASK_SND_TOKEN 0x3f -+#define BIT_SND_TOKEN(x) (((x) & BIT_MASK_SND_TOKEN) << BIT_SHIFT_SND_TOKEN) -+#define BITS_SND_TOKEN (BIT_MASK_SND_TOKEN << BIT_SHIFT_SND_TOKEN) -+#define BIT_CLEAR_SND_TOKEN(x) ((x) & (~BITS_SND_TOKEN)) -+#define BIT_GET_SND_TOKEN(x) (((x) >> BIT_SHIFT_SND_TOKEN) & BIT_MASK_SND_TOKEN) -+#define BIT_SET_SND_TOKEN(x, v) (BIT_CLEAR_SND_TOKEN(x) | BIT_SND_TOKEN(v)) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1 (Offset 0x1700) */ -+ -+#define BIT_LTECOEX_ACCESS_START_V1 BIT(31) -+#define BIT_LTECOEX_WRITE_MODE_V1 BIT(30) -+#define BIT_LTECOEX_READY_BIT_V1 BIT(29) -+ -+#define BIT_SHIFT_WRITE_BYTE_EN_V1 16 -+#define BIT_MASK_WRITE_BYTE_EN_V1 0xf -+#define BIT_WRITE_BYTE_EN_V1(x) \ -+ (((x) & BIT_MASK_WRITE_BYTE_EN_V1) << BIT_SHIFT_WRITE_BYTE_EN_V1) -+#define BITS_WRITE_BYTE_EN_V1 \ -+ (BIT_MASK_WRITE_BYTE_EN_V1 << BIT_SHIFT_WRITE_BYTE_EN_V1) -+#define BIT_CLEAR_WRITE_BYTE_EN_V1(x) ((x) & (~BITS_WRITE_BYTE_EN_V1)) -+#define BIT_GET_WRITE_BYTE_EN_V1(x) \ -+ (((x) >> BIT_SHIFT_WRITE_BYTE_EN_V1) & BIT_MASK_WRITE_BYTE_EN_V1) -+#define BIT_SET_WRITE_BYTE_EN_V1(x, v) \ -+ (BIT_CLEAR_WRITE_BYTE_EN_V1(x) | BIT_WRITE_BYTE_EN_V1(v)) -+ -+#define BIT_SHIFT_LTECOEX_REG_ADDR_V1 0 -+#define BIT_MASK_LTECOEX_REG_ADDR_V1 0xffff -+#define BIT_LTECOEX_REG_ADDR_V1(x) \ -+ (((x) & BIT_MASK_LTECOEX_REG_ADDR_V1) << BIT_SHIFT_LTECOEX_REG_ADDR_V1) -+#define BITS_LTECOEX_REG_ADDR_V1 \ -+ (BIT_MASK_LTECOEX_REG_ADDR_V1 << BIT_SHIFT_LTECOEX_REG_ADDR_V1) -+#define BIT_CLEAR_LTECOEX_REG_ADDR_V1(x) ((x) & (~BITS_LTECOEX_REG_ADDR_V1)) -+#define BIT_GET_LTECOEX_REG_ADDR_V1(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_REG_ADDR_V1) & BIT_MASK_LTECOEX_REG_ADDR_V1) -+#define BIT_SET_LTECOEX_REG_ADDR_V1(x, v) \ -+ (BIT_CLEAR_LTECOEX_REG_ADDR_V1(x) | BIT_LTECOEX_REG_ADDR_V1(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1 (Offset 0x1704) */ -+ -+#define BIT_SHIFT_LTECOEX_W_DATA_V1 0 -+#define BIT_MASK_LTECOEX_W_DATA_V1 0xffffffffL -+#define BIT_LTECOEX_W_DATA_V1(x) \ -+ (((x) & BIT_MASK_LTECOEX_W_DATA_V1) << BIT_SHIFT_LTECOEX_W_DATA_V1) -+#define BITS_LTECOEX_W_DATA_V1 \ -+ (BIT_MASK_LTECOEX_W_DATA_V1 << BIT_SHIFT_LTECOEX_W_DATA_V1) -+#define BIT_CLEAR_LTECOEX_W_DATA_V1(x) ((x) & (~BITS_LTECOEX_W_DATA_V1)) -+#define BIT_GET_LTECOEX_W_DATA_V1(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_W_DATA_V1) & BIT_MASK_LTECOEX_W_DATA_V1) -+#define BIT_SET_LTECOEX_W_DATA_V1(x, v) \ -+ (BIT_CLEAR_LTECOEX_W_DATA_V1(x) | BIT_LTECOEX_W_DATA_V1(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1 (Offset 0x1708) */ -+ -+#define BIT_SHIFT_LTECOEX_R_DATA_V1 0 -+#define BIT_MASK_LTECOEX_R_DATA_V1 0xffffffffL -+#define BIT_LTECOEX_R_DATA_V1(x) \ -+ (((x) & BIT_MASK_LTECOEX_R_DATA_V1) << BIT_SHIFT_LTECOEX_R_DATA_V1) -+#define BITS_LTECOEX_R_DATA_V1 \ -+ (BIT_MASK_LTECOEX_R_DATA_V1 << BIT_SHIFT_LTECOEX_R_DATA_V1) -+#define BIT_CLEAR_LTECOEX_R_DATA_V1(x) ((x) & (~BITS_LTECOEX_R_DATA_V1)) -+#define BIT_GET_LTECOEX_R_DATA_V1(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_R_DATA_V1) & BIT_MASK_LTECOEX_R_DATA_V1) -+#define BIT_SET_LTECOEX_R_DATA_V1(x, v) \ -+ (BIT_CLEAR_LTECOEX_R_DATA_V1(x) | BIT_LTECOEX_R_DATA_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_DMA_RQPN_INFO_0 (Offset 0x2200) */ -+ -+#define BIT_SHIFT_CH0_AVAL_PG 16 -+#define BIT_MASK_CH0_AVAL_PG 0xfff -+#define BIT_CH0_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH0_AVAL_PG) << BIT_SHIFT_CH0_AVAL_PG) -+#define BITS_CH0_AVAL_PG (BIT_MASK_CH0_AVAL_PG << BIT_SHIFT_CH0_AVAL_PG) -+#define BIT_CLEAR_CH0_AVAL_PG(x) ((x) & (~BITS_CH0_AVAL_PG)) -+#define BIT_GET_CH0_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH0_AVAL_PG) & BIT_MASK_CH0_AVAL_PG) -+#define BIT_SET_CH0_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH0_AVAL_PG(x) | BIT_CH0_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH0_RSVD_PG 0 -+#define BIT_MASK_CH0_RSVD_PG 0xfff -+#define BIT_CH0_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH0_RSVD_PG) << BIT_SHIFT_CH0_RSVD_PG) -+#define BITS_CH0_RSVD_PG (BIT_MASK_CH0_RSVD_PG << BIT_SHIFT_CH0_RSVD_PG) -+#define BIT_CLEAR_CH0_RSVD_PG(x) ((x) & (~BITS_CH0_RSVD_PG)) -+#define BIT_GET_CH0_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH0_RSVD_PG) & BIT_MASK_CH0_RSVD_PG) -+#define BIT_SET_CH0_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH0_RSVD_PG(x) | BIT_CH0_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_1 (Offset 0x2204) */ -+ -+#define BIT_SHIFT_CH1_AVAL_PG 16 -+#define BIT_MASK_CH1_AVAL_PG 0xfff -+#define BIT_CH1_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH1_AVAL_PG) << BIT_SHIFT_CH1_AVAL_PG) -+#define BITS_CH1_AVAL_PG (BIT_MASK_CH1_AVAL_PG << BIT_SHIFT_CH1_AVAL_PG) -+#define BIT_CLEAR_CH1_AVAL_PG(x) ((x) & (~BITS_CH1_AVAL_PG)) -+#define BIT_GET_CH1_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH1_AVAL_PG) & BIT_MASK_CH1_AVAL_PG) -+#define BIT_SET_CH1_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH1_AVAL_PG(x) | BIT_CH1_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH1_RSVD_PG 0 -+#define BIT_MASK_CH1_RSVD_PG 0xfff -+#define BIT_CH1_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH1_RSVD_PG) << BIT_SHIFT_CH1_RSVD_PG) -+#define BITS_CH1_RSVD_PG (BIT_MASK_CH1_RSVD_PG << BIT_SHIFT_CH1_RSVD_PG) -+#define BIT_CLEAR_CH1_RSVD_PG(x) ((x) & (~BITS_CH1_RSVD_PG)) -+#define BIT_GET_CH1_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH1_RSVD_PG) & BIT_MASK_CH1_RSVD_PG) -+#define BIT_SET_CH1_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH1_RSVD_PG(x) | BIT_CH1_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_2 (Offset 0x2208) */ -+ -+#define BIT_SHIFT_CH2_AVAL_PG 16 -+#define BIT_MASK_CH2_AVAL_PG 0xfff -+#define BIT_CH2_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH2_AVAL_PG) << BIT_SHIFT_CH2_AVAL_PG) -+#define BITS_CH2_AVAL_PG (BIT_MASK_CH2_AVAL_PG << BIT_SHIFT_CH2_AVAL_PG) -+#define BIT_CLEAR_CH2_AVAL_PG(x) ((x) & (~BITS_CH2_AVAL_PG)) -+#define BIT_GET_CH2_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH2_AVAL_PG) & BIT_MASK_CH2_AVAL_PG) -+#define BIT_SET_CH2_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH2_AVAL_PG(x) | BIT_CH2_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH2_RSVD_PG 0 -+#define BIT_MASK_CH2_RSVD_PG 0xfff -+#define BIT_CH2_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH2_RSVD_PG) << BIT_SHIFT_CH2_RSVD_PG) -+#define BITS_CH2_RSVD_PG (BIT_MASK_CH2_RSVD_PG << BIT_SHIFT_CH2_RSVD_PG) -+#define BIT_CLEAR_CH2_RSVD_PG(x) ((x) & (~BITS_CH2_RSVD_PG)) -+#define BIT_GET_CH2_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH2_RSVD_PG) & BIT_MASK_CH2_RSVD_PG) -+#define BIT_SET_CH2_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH2_RSVD_PG(x) | BIT_CH2_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_3 (Offset 0x220C) */ -+ -+#define BIT_SHIFT_CH3_AVAL_PG 16 -+#define BIT_MASK_CH3_AVAL_PG 0xfff -+#define BIT_CH3_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH3_AVAL_PG) << BIT_SHIFT_CH3_AVAL_PG) -+#define BITS_CH3_AVAL_PG (BIT_MASK_CH3_AVAL_PG << BIT_SHIFT_CH3_AVAL_PG) -+#define BIT_CLEAR_CH3_AVAL_PG(x) ((x) & (~BITS_CH3_AVAL_PG)) -+#define BIT_GET_CH3_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH3_AVAL_PG) & BIT_MASK_CH3_AVAL_PG) -+#define BIT_SET_CH3_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH3_AVAL_PG(x) | BIT_CH3_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH3_RSVD_PG 0 -+#define BIT_MASK_CH3_RSVD_PG 0xfff -+#define BIT_CH3_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH3_RSVD_PG) << BIT_SHIFT_CH3_RSVD_PG) -+#define BITS_CH3_RSVD_PG (BIT_MASK_CH3_RSVD_PG << BIT_SHIFT_CH3_RSVD_PG) -+#define BIT_CLEAR_CH3_RSVD_PG(x) ((x) & (~BITS_CH3_RSVD_PG)) -+#define BIT_GET_CH3_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH3_RSVD_PG) & BIT_MASK_CH3_RSVD_PG) -+#define BIT_SET_CH3_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH3_RSVD_PG(x) | BIT_CH3_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_4 (Offset 0x2210) */ -+ -+#define BIT_SHIFT_CH4_AVAL_PG 16 -+#define BIT_MASK_CH4_AVAL_PG 0xfff -+#define BIT_CH4_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH4_AVAL_PG) << BIT_SHIFT_CH4_AVAL_PG) -+#define BITS_CH4_AVAL_PG (BIT_MASK_CH4_AVAL_PG << BIT_SHIFT_CH4_AVAL_PG) -+#define BIT_CLEAR_CH4_AVAL_PG(x) ((x) & (~BITS_CH4_AVAL_PG)) -+#define BIT_GET_CH4_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH4_AVAL_PG) & BIT_MASK_CH4_AVAL_PG) -+#define BIT_SET_CH4_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH4_AVAL_PG(x) | BIT_CH4_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH4_RSVD_PG 0 -+#define BIT_MASK_CH4_RSVD_PG 0xfff -+#define BIT_CH4_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH4_RSVD_PG) << BIT_SHIFT_CH4_RSVD_PG) -+#define BITS_CH4_RSVD_PG (BIT_MASK_CH4_RSVD_PG << BIT_SHIFT_CH4_RSVD_PG) -+#define BIT_CLEAR_CH4_RSVD_PG(x) ((x) & (~BITS_CH4_RSVD_PG)) -+#define BIT_GET_CH4_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH4_RSVD_PG) & BIT_MASK_CH4_RSVD_PG) -+#define BIT_SET_CH4_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH4_RSVD_PG(x) | BIT_CH4_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_5 (Offset 0x2214) */ -+ -+#define BIT_SHIFT_CH5_AVAL_PG 16 -+#define BIT_MASK_CH5_AVAL_PG 0xfff -+#define BIT_CH5_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH5_AVAL_PG) << BIT_SHIFT_CH5_AVAL_PG) -+#define BITS_CH5_AVAL_PG (BIT_MASK_CH5_AVAL_PG << BIT_SHIFT_CH5_AVAL_PG) -+#define BIT_CLEAR_CH5_AVAL_PG(x) ((x) & (~BITS_CH5_AVAL_PG)) -+#define BIT_GET_CH5_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH5_AVAL_PG) & BIT_MASK_CH5_AVAL_PG) -+#define BIT_SET_CH5_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH5_AVAL_PG(x) | BIT_CH5_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH5_RSVD_PG 0 -+#define BIT_MASK_CH5_RSVD_PG 0xfff -+#define BIT_CH5_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH5_RSVD_PG) << BIT_SHIFT_CH5_RSVD_PG) -+#define BITS_CH5_RSVD_PG (BIT_MASK_CH5_RSVD_PG << BIT_SHIFT_CH5_RSVD_PG) -+#define BIT_CLEAR_CH5_RSVD_PG(x) ((x) & (~BITS_CH5_RSVD_PG)) -+#define BIT_GET_CH5_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH5_RSVD_PG) & BIT_MASK_CH5_RSVD_PG) -+#define BIT_SET_CH5_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH5_RSVD_PG(x) | BIT_CH5_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_6 (Offset 0x2218) */ -+ -+#define BIT_SHIFT_CH6_AVAL_PG 16 -+#define BIT_MASK_CH6_AVAL_PG 0xfff -+#define BIT_CH6_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH6_AVAL_PG) << BIT_SHIFT_CH6_AVAL_PG) -+#define BITS_CH6_AVAL_PG (BIT_MASK_CH6_AVAL_PG << BIT_SHIFT_CH6_AVAL_PG) -+#define BIT_CLEAR_CH6_AVAL_PG(x) ((x) & (~BITS_CH6_AVAL_PG)) -+#define BIT_GET_CH6_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH6_AVAL_PG) & BIT_MASK_CH6_AVAL_PG) -+#define BIT_SET_CH6_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH6_AVAL_PG(x) | BIT_CH6_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH6_RSVD_PG 0 -+#define BIT_MASK_CH6_RSVD_PG 0xfff -+#define BIT_CH6_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH6_RSVD_PG) << BIT_SHIFT_CH6_RSVD_PG) -+#define BITS_CH6_RSVD_PG (BIT_MASK_CH6_RSVD_PG << BIT_SHIFT_CH6_RSVD_PG) -+#define BIT_CLEAR_CH6_RSVD_PG(x) ((x) & (~BITS_CH6_RSVD_PG)) -+#define BIT_GET_CH6_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH6_RSVD_PG) & BIT_MASK_CH6_RSVD_PG) -+#define BIT_SET_CH6_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH6_RSVD_PG(x) | BIT_CH6_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_7 (Offset 0x221C) */ -+ -+#define BIT_SHIFT_CH7_AVAL_PG 16 -+#define BIT_MASK_CH7_AVAL_PG 0xfff -+#define BIT_CH7_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH7_AVAL_PG) << BIT_SHIFT_CH7_AVAL_PG) -+#define BITS_CH7_AVAL_PG (BIT_MASK_CH7_AVAL_PG << BIT_SHIFT_CH7_AVAL_PG) -+#define BIT_CLEAR_CH7_AVAL_PG(x) ((x) & (~BITS_CH7_AVAL_PG)) -+#define BIT_GET_CH7_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH7_AVAL_PG) & BIT_MASK_CH7_AVAL_PG) -+#define BIT_SET_CH7_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH7_AVAL_PG(x) | BIT_CH7_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH7_RSVD_PG 0 -+#define BIT_MASK_CH7_RSVD_PG 0xfff -+#define BIT_CH7_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH7_RSVD_PG) << BIT_SHIFT_CH7_RSVD_PG) -+#define BITS_CH7_RSVD_PG (BIT_MASK_CH7_RSVD_PG << BIT_SHIFT_CH7_RSVD_PG) -+#define BIT_CLEAR_CH7_RSVD_PG(x) ((x) & (~BITS_CH7_RSVD_PG)) -+#define BIT_GET_CH7_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH7_RSVD_PG) & BIT_MASK_CH7_RSVD_PG) -+#define BIT_SET_CH7_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH7_RSVD_PG(x) | BIT_CH7_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_8 (Offset 0x2220) */ -+ -+#define BIT_SHIFT_CH8_AVAL_PG 16 -+#define BIT_MASK_CH8_AVAL_PG 0xfff -+#define BIT_CH8_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH8_AVAL_PG) << BIT_SHIFT_CH8_AVAL_PG) -+#define BITS_CH8_AVAL_PG (BIT_MASK_CH8_AVAL_PG << BIT_SHIFT_CH8_AVAL_PG) -+#define BIT_CLEAR_CH8_AVAL_PG(x) ((x) & (~BITS_CH8_AVAL_PG)) -+#define BIT_GET_CH8_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH8_AVAL_PG) & BIT_MASK_CH8_AVAL_PG) -+#define BIT_SET_CH8_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH8_AVAL_PG(x) | BIT_CH8_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH8_RSVD_PG 0 -+#define BIT_MASK_CH8_RSVD_PG 0xfff -+#define BIT_CH8_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH8_RSVD_PG) << BIT_SHIFT_CH8_RSVD_PG) -+#define BITS_CH8_RSVD_PG (BIT_MASK_CH8_RSVD_PG << BIT_SHIFT_CH8_RSVD_PG) -+#define BIT_CLEAR_CH8_RSVD_PG(x) ((x) & (~BITS_CH8_RSVD_PG)) -+#define BIT_GET_CH8_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH8_RSVD_PG) & BIT_MASK_CH8_RSVD_PG) -+#define BIT_SET_CH8_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH8_RSVD_PG(x) | BIT_CH8_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_9 (Offset 0x2224) */ -+ -+#define BIT_SHIFT_CH9_AVAL_PG 16 -+#define BIT_MASK_CH9_AVAL_PG 0xfff -+#define BIT_CH9_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH9_AVAL_PG) << BIT_SHIFT_CH9_AVAL_PG) -+#define BITS_CH9_AVAL_PG (BIT_MASK_CH9_AVAL_PG << BIT_SHIFT_CH9_AVAL_PG) -+#define BIT_CLEAR_CH9_AVAL_PG(x) ((x) & (~BITS_CH9_AVAL_PG)) -+#define BIT_GET_CH9_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH9_AVAL_PG) & BIT_MASK_CH9_AVAL_PG) -+#define BIT_SET_CH9_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH9_AVAL_PG(x) | BIT_CH9_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH9_RSVD_PG 0 -+#define BIT_MASK_CH9_RSVD_PG 0xfff -+#define BIT_CH9_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH9_RSVD_PG) << BIT_SHIFT_CH9_RSVD_PG) -+#define BITS_CH9_RSVD_PG (BIT_MASK_CH9_RSVD_PG << BIT_SHIFT_CH9_RSVD_PG) -+#define BIT_CLEAR_CH9_RSVD_PG(x) ((x) & (~BITS_CH9_RSVD_PG)) -+#define BIT_GET_CH9_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH9_RSVD_PG) & BIT_MASK_CH9_RSVD_PG) -+#define BIT_SET_CH9_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH9_RSVD_PG(x) | BIT_CH9_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_10 (Offset 0x2228) */ -+ -+#define BIT_SHIFT_CH10_AVAL_PG 16 -+#define BIT_MASK_CH10_AVAL_PG 0xfff -+#define BIT_CH10_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH10_AVAL_PG) << BIT_SHIFT_CH10_AVAL_PG) -+#define BITS_CH10_AVAL_PG (BIT_MASK_CH10_AVAL_PG << BIT_SHIFT_CH10_AVAL_PG) -+#define BIT_CLEAR_CH10_AVAL_PG(x) ((x) & (~BITS_CH10_AVAL_PG)) -+#define BIT_GET_CH10_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH10_AVAL_PG) & BIT_MASK_CH10_AVAL_PG) -+#define BIT_SET_CH10_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH10_AVAL_PG(x) | BIT_CH10_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH10_RSVD_PG 0 -+#define BIT_MASK_CH10_RSVD_PG 0xfff -+#define BIT_CH10_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH10_RSVD_PG) << BIT_SHIFT_CH10_RSVD_PG) -+#define BITS_CH10_RSVD_PG (BIT_MASK_CH10_RSVD_PG << BIT_SHIFT_CH10_RSVD_PG) -+#define BIT_CLEAR_CH10_RSVD_PG(x) ((x) & (~BITS_CH10_RSVD_PG)) -+#define BIT_GET_CH10_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH10_RSVD_PG) & BIT_MASK_CH10_RSVD_PG) -+#define BIT_SET_CH10_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH10_RSVD_PG(x) | BIT_CH10_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_11 (Offset 0x222C) */ -+ -+#define BIT_SHIFT_CH11_AVAL_PG 16 -+#define BIT_MASK_CH11_AVAL_PG 0xfff -+#define BIT_CH11_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH11_AVAL_PG) << BIT_SHIFT_CH11_AVAL_PG) -+#define BITS_CH11_AVAL_PG (BIT_MASK_CH11_AVAL_PG << BIT_SHIFT_CH11_AVAL_PG) -+#define BIT_CLEAR_CH11_AVAL_PG(x) ((x) & (~BITS_CH11_AVAL_PG)) -+#define BIT_GET_CH11_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH11_AVAL_PG) & BIT_MASK_CH11_AVAL_PG) -+#define BIT_SET_CH11_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH11_AVAL_PG(x) | BIT_CH11_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH11_RSVD_PG 0 -+#define BIT_MASK_CH11_RSVD_PG 0xfff -+#define BIT_CH11_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH11_RSVD_PG) << BIT_SHIFT_CH11_RSVD_PG) -+#define BITS_CH11_RSVD_PG (BIT_MASK_CH11_RSVD_PG << BIT_SHIFT_CH11_RSVD_PG) -+#define BIT_CLEAR_CH11_RSVD_PG(x) ((x) & (~BITS_CH11_RSVD_PG)) -+#define BIT_GET_CH11_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH11_RSVD_PG) & BIT_MASK_CH11_RSVD_PG) -+#define BIT_SET_CH11_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH11_RSVD_PG(x) | BIT_CH11_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_12 (Offset 0x2230) */ -+ -+#define BIT_SHIFT_CH12_AVAL_PG 16 -+#define BIT_MASK_CH12_AVAL_PG 0xfff -+#define BIT_CH12_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH12_AVAL_PG) << BIT_SHIFT_CH12_AVAL_PG) -+#define BITS_CH12_AVAL_PG (BIT_MASK_CH12_AVAL_PG << BIT_SHIFT_CH12_AVAL_PG) -+#define BIT_CLEAR_CH12_AVAL_PG(x) ((x) & (~BITS_CH12_AVAL_PG)) -+#define BIT_GET_CH12_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH12_AVAL_PG) & BIT_MASK_CH12_AVAL_PG) -+#define BIT_SET_CH12_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH12_AVAL_PG(x) | BIT_CH12_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH12_RSVD_PG 0 -+#define BIT_MASK_CH12_RSVD_PG 0xfff -+#define BIT_CH12_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH12_RSVD_PG) << BIT_SHIFT_CH12_RSVD_PG) -+#define BITS_CH12_RSVD_PG (BIT_MASK_CH12_RSVD_PG << BIT_SHIFT_CH12_RSVD_PG) -+#define BIT_CLEAR_CH12_RSVD_PG(x) ((x) & (~BITS_CH12_RSVD_PG)) -+#define BIT_GET_CH12_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH12_RSVD_PG) & BIT_MASK_CH12_RSVD_PG) -+#define BIT_SET_CH12_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH12_RSVD_PG(x) | BIT_CH12_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_13 (Offset 0x2234) */ -+ -+#define BIT_SHIFT_CH13_AVAL_PG 16 -+#define BIT_MASK_CH13_AVAL_PG 0xfff -+#define BIT_CH13_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH13_AVAL_PG) << BIT_SHIFT_CH13_AVAL_PG) -+#define BITS_CH13_AVAL_PG (BIT_MASK_CH13_AVAL_PG << BIT_SHIFT_CH13_AVAL_PG) -+#define BIT_CLEAR_CH13_AVAL_PG(x) ((x) & (~BITS_CH13_AVAL_PG)) -+#define BIT_GET_CH13_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH13_AVAL_PG) & BIT_MASK_CH13_AVAL_PG) -+#define BIT_SET_CH13_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH13_AVAL_PG(x) | BIT_CH13_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH13_RSVD_PG 0 -+#define BIT_MASK_CH13_RSVD_PG 0xfff -+#define BIT_CH13_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH13_RSVD_PG) << BIT_SHIFT_CH13_RSVD_PG) -+#define BITS_CH13_RSVD_PG (BIT_MASK_CH13_RSVD_PG << BIT_SHIFT_CH13_RSVD_PG) -+#define BIT_CLEAR_CH13_RSVD_PG(x) ((x) & (~BITS_CH13_RSVD_PG)) -+#define BIT_GET_CH13_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH13_RSVD_PG) & BIT_MASK_CH13_RSVD_PG) -+#define BIT_SET_CH13_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH13_RSVD_PG(x) | BIT_CH13_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_14 (Offset 0x2238) */ -+ -+#define BIT_SHIFT_CH14_AVAL_PG 16 -+#define BIT_MASK_CH14_AVAL_PG 0xfff -+#define BIT_CH14_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH14_AVAL_PG) << BIT_SHIFT_CH14_AVAL_PG) -+#define BITS_CH14_AVAL_PG (BIT_MASK_CH14_AVAL_PG << BIT_SHIFT_CH14_AVAL_PG) -+#define BIT_CLEAR_CH14_AVAL_PG(x) ((x) & (~BITS_CH14_AVAL_PG)) -+#define BIT_GET_CH14_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH14_AVAL_PG) & BIT_MASK_CH14_AVAL_PG) -+#define BIT_SET_CH14_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH14_AVAL_PG(x) | BIT_CH14_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH14_RSVD_PG 0 -+#define BIT_MASK_CH14_RSVD_PG 0xfff -+#define BIT_CH14_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH14_RSVD_PG) << BIT_SHIFT_CH14_RSVD_PG) -+#define BITS_CH14_RSVD_PG (BIT_MASK_CH14_RSVD_PG << BIT_SHIFT_CH14_RSVD_PG) -+#define BIT_CLEAR_CH14_RSVD_PG(x) ((x) & (~BITS_CH14_RSVD_PG)) -+#define BIT_GET_CH14_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH14_RSVD_PG) & BIT_MASK_CH14_RSVD_PG) -+#define BIT_SET_CH14_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH14_RSVD_PG(x) | BIT_CH14_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_15 (Offset 0x223C) */ -+ -+#define BIT_SHIFT_CH15_AVAL_PG 16 -+#define BIT_MASK_CH15_AVAL_PG 0xfff -+#define BIT_CH15_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH15_AVAL_PG) << BIT_SHIFT_CH15_AVAL_PG) -+#define BITS_CH15_AVAL_PG (BIT_MASK_CH15_AVAL_PG << BIT_SHIFT_CH15_AVAL_PG) -+#define BIT_CLEAR_CH15_AVAL_PG(x) ((x) & (~BITS_CH15_AVAL_PG)) -+#define BIT_GET_CH15_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH15_AVAL_PG) & BIT_MASK_CH15_AVAL_PG) -+#define BIT_SET_CH15_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH15_AVAL_PG(x) | BIT_CH15_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH15_RSVD_PG 0 -+#define BIT_MASK_CH15_RSVD_PG 0xfff -+#define BIT_CH15_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH15_RSVD_PG) << BIT_SHIFT_CH15_RSVD_PG) -+#define BITS_CH15_RSVD_PG (BIT_MASK_CH15_RSVD_PG << BIT_SHIFT_CH15_RSVD_PG) -+#define BIT_CLEAR_CH15_RSVD_PG(x) ((x) & (~BITS_CH15_RSVD_PG)) -+#define BIT_GET_CH15_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH15_RSVD_PG) & BIT_MASK_CH15_RSVD_PG) -+#define BIT_SET_CH15_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH15_RSVD_PG(x) | BIT_CH15_RSVD_PG(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_16 (Offset 0x2240) */ -+ -+#define BIT_SHIFT_CH16_AVAL_PG 16 -+#define BIT_MASK_CH16_AVAL_PG 0xfff -+#define BIT_CH16_AVAL_PG(x) \ -+ (((x) & BIT_MASK_CH16_AVAL_PG) << BIT_SHIFT_CH16_AVAL_PG) -+#define BITS_CH16_AVAL_PG (BIT_MASK_CH16_AVAL_PG << BIT_SHIFT_CH16_AVAL_PG) -+#define BIT_CLEAR_CH16_AVAL_PG(x) ((x) & (~BITS_CH16_AVAL_PG)) -+#define BIT_GET_CH16_AVAL_PG(x) \ -+ (((x) >> BIT_SHIFT_CH16_AVAL_PG) & BIT_MASK_CH16_AVAL_PG) -+#define BIT_SET_CH16_AVAL_PG(x, v) \ -+ (BIT_CLEAR_CH16_AVAL_PG(x) | BIT_CH16_AVAL_PG(v)) -+ -+#define BIT_SHIFT_CH16_RSVD_PG 0 -+#define BIT_MASK_CH16_RSVD_PG 0xfff -+#define BIT_CH16_RSVD_PG(x) \ -+ (((x) & BIT_MASK_CH16_RSVD_PG) << BIT_SHIFT_CH16_RSVD_PG) -+#define BITS_CH16_RSVD_PG (BIT_MASK_CH16_RSVD_PG << BIT_SHIFT_CH16_RSVD_PG) -+#define BIT_CLEAR_CH16_RSVD_PG(x) ((x) & (~BITS_CH16_RSVD_PG)) -+#define BIT_GET_CH16_RSVD_PG(x) \ -+ (((x) >> BIT_SHIFT_CH16_RSVD_PG) & BIT_MASK_CH16_RSVD_PG) -+#define BIT_SET_CH16_RSVD_PG(x, v) \ -+ (BIT_CLEAR_CH16_RSVD_PG(x) | BIT_CH16_RSVD_PG(v)) -+ -+/* 2 REG_HWAMSDU_CTL1 (Offset 0x2250) */ -+ -+#define BIT_SHIFT_HWAMSDU_PKTNUM 8 -+#define BIT_MASK_HWAMSDU_PKTNUM 0x3f -+#define BIT_HWAMSDU_PKTNUM(x) \ -+ (((x) & BIT_MASK_HWAMSDU_PKTNUM) << BIT_SHIFT_HWAMSDU_PKTNUM) -+#define BITS_HWAMSDU_PKTNUM \ -+ (BIT_MASK_HWAMSDU_PKTNUM << BIT_SHIFT_HWAMSDU_PKTNUM) -+#define BIT_CLEAR_HWAMSDU_PKTNUM(x) ((x) & (~BITS_HWAMSDU_PKTNUM)) -+#define BIT_GET_HWAMSDU_PKTNUM(x) \ -+ (((x) >> BIT_SHIFT_HWAMSDU_PKTNUM) & BIT_MASK_HWAMSDU_PKTNUM) -+#define BIT_SET_HWAMSDU_PKTNUM(x, v) \ -+ (BIT_CLEAR_HWAMSDU_PKTNUM(x) | BIT_HWAMSDU_PKTNUM(v)) -+ -+#define BIT_HWAMSDU_BUSY BIT(7) -+#define BIT_SINGLE_AMSDU BIT(2) -+#define BIT_HWAMSDU_PADDING_MODE BIT(1) -+#define BIT_HWAMSDU_EN BIT(0) -+ -+/* 2 REG_HWAMSDU_CTL2 (Offset 0x2254) */ -+ -+#define BIT_SHIFT_HWAMSDU_AMSDU_TIMEOUT 16 -+#define BIT_MASK_HWAMSDU_AMSDU_TIMEOUT 0xffff -+#define BIT_HWAMSDU_AMSDU_TIMEOUT(x) \ -+ (((x) & BIT_MASK_HWAMSDU_AMSDU_TIMEOUT) \ -+ << BIT_SHIFT_HWAMSDU_AMSDU_TIMEOUT) -+#define BITS_HWAMSDU_AMSDU_TIMEOUT \ -+ (BIT_MASK_HWAMSDU_AMSDU_TIMEOUT << BIT_SHIFT_HWAMSDU_AMSDU_TIMEOUT) -+#define BIT_CLEAR_HWAMSDU_AMSDU_TIMEOUT(x) ((x) & (~BITS_HWAMSDU_AMSDU_TIMEOUT)) -+#define BIT_GET_HWAMSDU_AMSDU_TIMEOUT(x) \ -+ (((x) >> BIT_SHIFT_HWAMSDU_AMSDU_TIMEOUT) & \ -+ BIT_MASK_HWAMSDU_AMSDU_TIMEOUT) -+#define BIT_SET_HWAMSDU_AMSDU_TIMEOUT(x, v) \ -+ (BIT_CLEAR_HWAMSDU_AMSDU_TIMEOUT(x) | BIT_HWAMSDU_AMSDU_TIMEOUT(v)) -+ -+#define BIT_SHIFT_HWAMSDU_MSDU_TIMEOUT 0 -+#define BIT_MASK_HWAMSDU_MSDU_TIMEOUT 0xffff -+#define BIT_HWAMSDU_MSDU_TIMEOUT(x) \ -+ (((x) & BIT_MASK_HWAMSDU_MSDU_TIMEOUT) \ -+ << BIT_SHIFT_HWAMSDU_MSDU_TIMEOUT) -+#define BITS_HWAMSDU_MSDU_TIMEOUT \ -+ (BIT_MASK_HWAMSDU_MSDU_TIMEOUT << BIT_SHIFT_HWAMSDU_MSDU_TIMEOUT) -+#define BIT_CLEAR_HWAMSDU_MSDU_TIMEOUT(x) ((x) & (~BITS_HWAMSDU_MSDU_TIMEOUT)) -+#define BIT_GET_HWAMSDU_MSDU_TIMEOUT(x) \ -+ (((x) >> BIT_SHIFT_HWAMSDU_MSDU_TIMEOUT) & \ -+ BIT_MASK_HWAMSDU_MSDU_TIMEOUT) -+#define BIT_SET_HWAMSDU_MSDU_TIMEOUT(x, v) \ -+ (BIT_CLEAR_HWAMSDU_MSDU_TIMEOUT(x) | BIT_HWAMSDU_MSDU_TIMEOUT(v)) -+ -+/* 2 REG_HI8Q_TXBD_DESA_L (Offset 0x2300) */ -+ -+#define BIT_SHIFT_HI8Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI8Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI8Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI8Q_TXBD_DESA_L) << BIT_SHIFT_HI8Q_TXBD_DESA_L) -+#define BITS_HI8Q_TXBD_DESA_L \ -+ (BIT_MASK_HI8Q_TXBD_DESA_L << BIT_SHIFT_HI8Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI8Q_TXBD_DESA_L(x) ((x) & (~BITS_HI8Q_TXBD_DESA_L)) -+#define BIT_GET_HI8Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI8Q_TXBD_DESA_L) & BIT_MASK_HI8Q_TXBD_DESA_L) -+#define BIT_SET_HI8Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI8Q_TXBD_DESA_L(x) | BIT_HI8Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI8Q_TXBD_DESA_H (Offset 0x2304) */ -+ -+#define BIT_SHIFT_HI8Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI8Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI8Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI8Q_TXBD_DESA_H) << BIT_SHIFT_HI8Q_TXBD_DESA_H) -+#define BITS_HI8Q_TXBD_DESA_H \ -+ (BIT_MASK_HI8Q_TXBD_DESA_H << BIT_SHIFT_HI8Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI8Q_TXBD_DESA_H(x) ((x) & (~BITS_HI8Q_TXBD_DESA_H)) -+#define BIT_GET_HI8Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI8Q_TXBD_DESA_H) & BIT_MASK_HI8Q_TXBD_DESA_H) -+#define BIT_SET_HI8Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI8Q_TXBD_DESA_H(x) | BIT_HI8Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI9Q_TXBD_DESA_L (Offset 0x2308) */ -+ -+#define BIT_SHIFT_HI9Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI9Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI9Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI9Q_TXBD_DESA_L) << BIT_SHIFT_HI9Q_TXBD_DESA_L) -+#define BITS_HI9Q_TXBD_DESA_L \ -+ (BIT_MASK_HI9Q_TXBD_DESA_L << BIT_SHIFT_HI9Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI9Q_TXBD_DESA_L(x) ((x) & (~BITS_HI9Q_TXBD_DESA_L)) -+#define BIT_GET_HI9Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI9Q_TXBD_DESA_L) & BIT_MASK_HI9Q_TXBD_DESA_L) -+#define BIT_SET_HI9Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI9Q_TXBD_DESA_L(x) | BIT_HI9Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI9Q_TXBD_DESA_H (Offset 0x230C) */ -+ -+#define BIT_SHIFT_HI9Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI9Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI9Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI9Q_TXBD_DESA_H) << BIT_SHIFT_HI9Q_TXBD_DESA_H) -+#define BITS_HI9Q_TXBD_DESA_H \ -+ (BIT_MASK_HI9Q_TXBD_DESA_H << BIT_SHIFT_HI9Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI9Q_TXBD_DESA_H(x) ((x) & (~BITS_HI9Q_TXBD_DESA_H)) -+#define BIT_GET_HI9Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI9Q_TXBD_DESA_H) & BIT_MASK_HI9Q_TXBD_DESA_H) -+#define BIT_SET_HI9Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI9Q_TXBD_DESA_H(x) | BIT_HI9Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI10Q_TXBD_DESA_L (Offset 0x2310) */ -+ -+#define BIT_SHIFT_HI10Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI10Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI10Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI10Q_TXBD_DESA_L) << BIT_SHIFT_HI10Q_TXBD_DESA_L) -+#define BITS_HI10Q_TXBD_DESA_L \ -+ (BIT_MASK_HI10Q_TXBD_DESA_L << BIT_SHIFT_HI10Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI10Q_TXBD_DESA_L(x) ((x) & (~BITS_HI10Q_TXBD_DESA_L)) -+#define BIT_GET_HI10Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI10Q_TXBD_DESA_L) & BIT_MASK_HI10Q_TXBD_DESA_L) -+#define BIT_SET_HI10Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI10Q_TXBD_DESA_L(x) | BIT_HI10Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI10Q_TXBD_DESA_H (Offset 0x2314) */ -+ -+#define BIT_SHIFT_HI10Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI10Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI10Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI10Q_TXBD_DESA_H) << BIT_SHIFT_HI10Q_TXBD_DESA_H) -+#define BITS_HI10Q_TXBD_DESA_H \ -+ (BIT_MASK_HI10Q_TXBD_DESA_H << BIT_SHIFT_HI10Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI10Q_TXBD_DESA_H(x) ((x) & (~BITS_HI10Q_TXBD_DESA_H)) -+#define BIT_GET_HI10Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI10Q_TXBD_DESA_H) & BIT_MASK_HI10Q_TXBD_DESA_H) -+#define BIT_SET_HI10Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI10Q_TXBD_DESA_H(x) | BIT_HI10Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI11Q_TXBD_DESA_L (Offset 0x2318) */ -+ -+#define BIT_SHIFT_HI11Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI11Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI11Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI11Q_TXBD_DESA_L) << BIT_SHIFT_HI11Q_TXBD_DESA_L) -+#define BITS_HI11Q_TXBD_DESA_L \ -+ (BIT_MASK_HI11Q_TXBD_DESA_L << BIT_SHIFT_HI11Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI11Q_TXBD_DESA_L(x) ((x) & (~BITS_HI11Q_TXBD_DESA_L)) -+#define BIT_GET_HI11Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI11Q_TXBD_DESA_L) & BIT_MASK_HI11Q_TXBD_DESA_L) -+#define BIT_SET_HI11Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI11Q_TXBD_DESA_L(x) | BIT_HI11Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI11Q_TXBD_DESA_H (Offset 0x231C) */ -+ -+#define BIT_SHIFT_HI11Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI11Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI11Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI11Q_TXBD_DESA_H) << BIT_SHIFT_HI11Q_TXBD_DESA_H) -+#define BITS_HI11Q_TXBD_DESA_H \ -+ (BIT_MASK_HI11Q_TXBD_DESA_H << BIT_SHIFT_HI11Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI11Q_TXBD_DESA_H(x) ((x) & (~BITS_HI11Q_TXBD_DESA_H)) -+#define BIT_GET_HI11Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI11Q_TXBD_DESA_H) & BIT_MASK_HI11Q_TXBD_DESA_H) -+#define BIT_SET_HI11Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI11Q_TXBD_DESA_H(x) | BIT_HI11Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI12Q_TXBD_DESA_L (Offset 0x2320) */ -+ -+#define BIT_SHIFT_HI12Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI12Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI12Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI12Q_TXBD_DESA_L) << BIT_SHIFT_HI12Q_TXBD_DESA_L) -+#define BITS_HI12Q_TXBD_DESA_L \ -+ (BIT_MASK_HI12Q_TXBD_DESA_L << BIT_SHIFT_HI12Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI12Q_TXBD_DESA_L(x) ((x) & (~BITS_HI12Q_TXBD_DESA_L)) -+#define BIT_GET_HI12Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI12Q_TXBD_DESA_L) & BIT_MASK_HI12Q_TXBD_DESA_L) -+#define BIT_SET_HI12Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI12Q_TXBD_DESA_L(x) | BIT_HI12Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI12Q_TXBD_DESA_H (Offset 0x2324) */ -+ -+#define BIT_SHIFT_HI12Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI12Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI12Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI12Q_TXBD_DESA_H) << BIT_SHIFT_HI12Q_TXBD_DESA_H) -+#define BITS_HI12Q_TXBD_DESA_H \ -+ (BIT_MASK_HI12Q_TXBD_DESA_H << BIT_SHIFT_HI12Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI12Q_TXBD_DESA_H(x) ((x) & (~BITS_HI12Q_TXBD_DESA_H)) -+#define BIT_GET_HI12Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI12Q_TXBD_DESA_H) & BIT_MASK_HI12Q_TXBD_DESA_H) -+#define BIT_SET_HI12Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI12Q_TXBD_DESA_H(x) | BIT_HI12Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI13Q_TXBD_DESA_L (Offset 0x2328) */ -+ -+#define BIT_SHIFT_HI13Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI13Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI13Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI13Q_TXBD_DESA_L) << BIT_SHIFT_HI13Q_TXBD_DESA_L) -+#define BITS_HI13Q_TXBD_DESA_L \ -+ (BIT_MASK_HI13Q_TXBD_DESA_L << BIT_SHIFT_HI13Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI13Q_TXBD_DESA_L(x) ((x) & (~BITS_HI13Q_TXBD_DESA_L)) -+#define BIT_GET_HI13Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI13Q_TXBD_DESA_L) & BIT_MASK_HI13Q_TXBD_DESA_L) -+#define BIT_SET_HI13Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI13Q_TXBD_DESA_L(x) | BIT_HI13Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI13Q_TXBD_DESA_H (Offset 0x232C) */ -+ -+#define BIT_SHIFT_HI13Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI13Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI13Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI13Q_TXBD_DESA_H) << BIT_SHIFT_HI13Q_TXBD_DESA_H) -+#define BITS_HI13Q_TXBD_DESA_H \ -+ (BIT_MASK_HI13Q_TXBD_DESA_H << BIT_SHIFT_HI13Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI13Q_TXBD_DESA_H(x) ((x) & (~BITS_HI13Q_TXBD_DESA_H)) -+#define BIT_GET_HI13Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI13Q_TXBD_DESA_H) & BIT_MASK_HI13Q_TXBD_DESA_H) -+#define BIT_SET_HI13Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI13Q_TXBD_DESA_H(x) | BIT_HI13Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI14Q_TXBD_DESA_L (Offset 0x2330) */ -+ -+#define BIT_SHIFT_HI14Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI14Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI14Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI14Q_TXBD_DESA_L) << BIT_SHIFT_HI14Q_TXBD_DESA_L) -+#define BITS_HI14Q_TXBD_DESA_L \ -+ (BIT_MASK_HI14Q_TXBD_DESA_L << BIT_SHIFT_HI14Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI14Q_TXBD_DESA_L(x) ((x) & (~BITS_HI14Q_TXBD_DESA_L)) -+#define BIT_GET_HI14Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI14Q_TXBD_DESA_L) & BIT_MASK_HI14Q_TXBD_DESA_L) -+#define BIT_SET_HI14Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI14Q_TXBD_DESA_L(x) | BIT_HI14Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI14Q_TXBD_DESA_H (Offset 0x2334) */ -+ -+#define BIT_SHIFT_HI14Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI14Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI14Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI14Q_TXBD_DESA_H) << BIT_SHIFT_HI14Q_TXBD_DESA_H) -+#define BITS_HI14Q_TXBD_DESA_H \ -+ (BIT_MASK_HI14Q_TXBD_DESA_H << BIT_SHIFT_HI14Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI14Q_TXBD_DESA_H(x) ((x) & (~BITS_HI14Q_TXBD_DESA_H)) -+#define BIT_GET_HI14Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI14Q_TXBD_DESA_H) & BIT_MASK_HI14Q_TXBD_DESA_H) -+#define BIT_SET_HI14Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI14Q_TXBD_DESA_H(x) | BIT_HI14Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI15Q_TXBD_DESA_L (Offset 0x2338) */ -+ -+#define BIT_SHIFT_HI15Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI15Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI15Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI15Q_TXBD_DESA_L) << BIT_SHIFT_HI15Q_TXBD_DESA_L) -+#define BITS_HI15Q_TXBD_DESA_L \ -+ (BIT_MASK_HI15Q_TXBD_DESA_L << BIT_SHIFT_HI15Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI15Q_TXBD_DESA_L(x) ((x) & (~BITS_HI15Q_TXBD_DESA_L)) -+#define BIT_GET_HI15Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI15Q_TXBD_DESA_L) & BIT_MASK_HI15Q_TXBD_DESA_L) -+#define BIT_SET_HI15Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI15Q_TXBD_DESA_L(x) | BIT_HI15Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI15Q_TXBD_DESA_H (Offset 0x233C) */ -+ -+#define BIT_SHIFT_HI15Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI15Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI15Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI15Q_TXBD_DESA_H) << BIT_SHIFT_HI15Q_TXBD_DESA_H) -+#define BITS_HI15Q_TXBD_DESA_H \ -+ (BIT_MASK_HI15Q_TXBD_DESA_H << BIT_SHIFT_HI15Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI15Q_TXBD_DESA_H(x) ((x) & (~BITS_HI15Q_TXBD_DESA_H)) -+#define BIT_GET_HI15Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI15Q_TXBD_DESA_H) & BIT_MASK_HI15Q_TXBD_DESA_H) -+#define BIT_SET_HI15Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI15Q_TXBD_DESA_H(x) | BIT_HI15Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI16Q_TXBD_DESA_L (Offset 0x2340) */ -+ -+#define BIT_SHIFT_HI16Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI16Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI16Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI16Q_TXBD_DESA_L) << BIT_SHIFT_HI16Q_TXBD_DESA_L) -+#define BITS_HI16Q_TXBD_DESA_L \ -+ (BIT_MASK_HI16Q_TXBD_DESA_L << BIT_SHIFT_HI16Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI16Q_TXBD_DESA_L(x) ((x) & (~BITS_HI16Q_TXBD_DESA_L)) -+#define BIT_GET_HI16Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI16Q_TXBD_DESA_L) & BIT_MASK_HI16Q_TXBD_DESA_L) -+#define BIT_SET_HI16Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI16Q_TXBD_DESA_L(x) | BIT_HI16Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI16Q_TXBD_DESA_H (Offset 0x2344) */ -+ -+#define BIT_SHIFT_HI16Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI16Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI16Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI16Q_TXBD_DESA_H) << BIT_SHIFT_HI16Q_TXBD_DESA_H) -+#define BITS_HI16Q_TXBD_DESA_H \ -+ (BIT_MASK_HI16Q_TXBD_DESA_H << BIT_SHIFT_HI16Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI16Q_TXBD_DESA_H(x) ((x) & (~BITS_HI16Q_TXBD_DESA_H)) -+#define BIT_GET_HI16Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI16Q_TXBD_DESA_H) & BIT_MASK_HI16Q_TXBD_DESA_H) -+#define BIT_SET_HI16Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI16Q_TXBD_DESA_H(x) | BIT_HI16Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI17Q_TXBD_DESA_L (Offset 0x2348) */ -+ -+#define BIT_SHIFT_HI17Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI17Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI17Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI17Q_TXBD_DESA_L) << BIT_SHIFT_HI17Q_TXBD_DESA_L) -+#define BITS_HI17Q_TXBD_DESA_L \ -+ (BIT_MASK_HI17Q_TXBD_DESA_L << BIT_SHIFT_HI17Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI17Q_TXBD_DESA_L(x) ((x) & (~BITS_HI17Q_TXBD_DESA_L)) -+#define BIT_GET_HI17Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI17Q_TXBD_DESA_L) & BIT_MASK_HI17Q_TXBD_DESA_L) -+#define BIT_SET_HI17Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI17Q_TXBD_DESA_L(x) | BIT_HI17Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI17Q_TXBD_DESA_H (Offset 0x234C) */ -+ -+#define BIT_SHIFT_HI17Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI17Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI17Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI17Q_TXBD_DESA_H) << BIT_SHIFT_HI17Q_TXBD_DESA_H) -+#define BITS_HI17Q_TXBD_DESA_H \ -+ (BIT_MASK_HI17Q_TXBD_DESA_H << BIT_SHIFT_HI17Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI17Q_TXBD_DESA_H(x) ((x) & (~BITS_HI17Q_TXBD_DESA_H)) -+#define BIT_GET_HI17Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI17Q_TXBD_DESA_H) & BIT_MASK_HI17Q_TXBD_DESA_H) -+#define BIT_SET_HI17Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI17Q_TXBD_DESA_H(x) | BIT_HI17Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI18Q_TXBD_DESA_L (Offset 0x2350) */ -+ -+#define BIT_SHIFT_HI18Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI18Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI18Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI18Q_TXBD_DESA_L) << BIT_SHIFT_HI18Q_TXBD_DESA_L) -+#define BITS_HI18Q_TXBD_DESA_L \ -+ (BIT_MASK_HI18Q_TXBD_DESA_L << BIT_SHIFT_HI18Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI18Q_TXBD_DESA_L(x) ((x) & (~BITS_HI18Q_TXBD_DESA_L)) -+#define BIT_GET_HI18Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI18Q_TXBD_DESA_L) & BIT_MASK_HI18Q_TXBD_DESA_L) -+#define BIT_SET_HI18Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI18Q_TXBD_DESA_L(x) | BIT_HI18Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI18Q_TXBD_DESA_H (Offset 0x2354) */ -+ -+#define BIT_SHIFT_HI18Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI18Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI18Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI18Q_TXBD_DESA_H) << BIT_SHIFT_HI18Q_TXBD_DESA_H) -+#define BITS_HI18Q_TXBD_DESA_H \ -+ (BIT_MASK_HI18Q_TXBD_DESA_H << BIT_SHIFT_HI18Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI18Q_TXBD_DESA_H(x) ((x) & (~BITS_HI18Q_TXBD_DESA_H)) -+#define BIT_GET_HI18Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI18Q_TXBD_DESA_H) & BIT_MASK_HI18Q_TXBD_DESA_H) -+#define BIT_SET_HI18Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI18Q_TXBD_DESA_H(x) | BIT_HI18Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_HI19Q_TXBD_DESA_L (Offset 0x2358) */ -+ -+#define BIT_SHIFT_HI19Q_TXBD_DESA_L 0 -+#define BIT_MASK_HI19Q_TXBD_DESA_L 0xffffffffL -+#define BIT_HI19Q_TXBD_DESA_L(x) \ -+ (((x) & BIT_MASK_HI19Q_TXBD_DESA_L) << BIT_SHIFT_HI19Q_TXBD_DESA_L) -+#define BITS_HI19Q_TXBD_DESA_L \ -+ (BIT_MASK_HI19Q_TXBD_DESA_L << BIT_SHIFT_HI19Q_TXBD_DESA_L) -+#define BIT_CLEAR_HI19Q_TXBD_DESA_L(x) ((x) & (~BITS_HI19Q_TXBD_DESA_L)) -+#define BIT_GET_HI19Q_TXBD_DESA_L(x) \ -+ (((x) >> BIT_SHIFT_HI19Q_TXBD_DESA_L) & BIT_MASK_HI19Q_TXBD_DESA_L) -+#define BIT_SET_HI19Q_TXBD_DESA_L(x, v) \ -+ (BIT_CLEAR_HI19Q_TXBD_DESA_L(x) | BIT_HI19Q_TXBD_DESA_L(v)) -+ -+/* 2 REG_HI19Q_TXBD_DESA_H (Offset 0x235C) */ -+ -+#define BIT_CLR_P0HI19Q_HW_IDX BIT(25) -+#define BIT_CLR_P0HI18Q_HW_IDX BIT(24) -+#define BIT_CLR_P0HI17Q_HW_IDX BIT(23) -+#define BIT_CLR_P0HI16Q_HW_IDX BIT(22) -+#define BIT_CLR_P0HI19Q_HOST_IDX BIT(9) -+#define BIT_CLR_P0HI18Q_HOST_IDX BIT(8) -+#define BIT_CLR_P0HI17Q_HOST_IDX BIT(7) -+#define BIT_CLR_P0HI16Q_HOST_IDX BIT(6) -+ -+#define BIT_SHIFT_HI19Q_TXBD_DESA_H 0 -+#define BIT_MASK_HI19Q_TXBD_DESA_H 0xffffffffL -+#define BIT_HI19Q_TXBD_DESA_H(x) \ -+ (((x) & BIT_MASK_HI19Q_TXBD_DESA_H) << BIT_SHIFT_HI19Q_TXBD_DESA_H) -+#define BITS_HI19Q_TXBD_DESA_H \ -+ (BIT_MASK_HI19Q_TXBD_DESA_H << BIT_SHIFT_HI19Q_TXBD_DESA_H) -+#define BIT_CLEAR_HI19Q_TXBD_DESA_H(x) ((x) & (~BITS_HI19Q_TXBD_DESA_H)) -+#define BIT_GET_HI19Q_TXBD_DESA_H(x) \ -+ (((x) >> BIT_SHIFT_HI19Q_TXBD_DESA_H) & BIT_MASK_HI19Q_TXBD_DESA_H) -+#define BIT_SET_HI19Q_TXBD_DESA_H(x, v) \ -+ (BIT_CLEAR_HI19Q_TXBD_DESA_H(x) | BIT_HI19Q_TXBD_DESA_H(v)) -+ -+/* 2 REG_P0HI16Q_TXBD_IDX (Offset 0x2370) */ -+ -+#define BIT_SHIFT_P0HI16Q_HW_IDX 16 -+#define BIT_MASK_P0HI16Q_HW_IDX 0xfff -+#define BIT_P0HI16Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI16Q_HW_IDX) << BIT_SHIFT_P0HI16Q_HW_IDX) -+#define BITS_P0HI16Q_HW_IDX \ -+ (BIT_MASK_P0HI16Q_HW_IDX << BIT_SHIFT_P0HI16Q_HW_IDX) -+#define BIT_CLEAR_P0HI16Q_HW_IDX(x) ((x) & (~BITS_P0HI16Q_HW_IDX)) -+#define BIT_GET_P0HI16Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI16Q_HW_IDX) & BIT_MASK_P0HI16Q_HW_IDX) -+#define BIT_SET_P0HI16Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI16Q_HW_IDX(x) | BIT_P0HI16Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI16Q_HOST_IDX 0 -+#define BIT_MASK_P0HI16Q_HOST_IDX 0xfff -+#define BIT_P0HI16Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI16Q_HOST_IDX) << BIT_SHIFT_P0HI16Q_HOST_IDX) -+#define BITS_P0HI16Q_HOST_IDX \ -+ (BIT_MASK_P0HI16Q_HOST_IDX << BIT_SHIFT_P0HI16Q_HOST_IDX) -+#define BIT_CLEAR_P0HI16Q_HOST_IDX(x) ((x) & (~BITS_P0HI16Q_HOST_IDX)) -+#define BIT_GET_P0HI16Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI16Q_HOST_IDX) & BIT_MASK_P0HI16Q_HOST_IDX) -+#define BIT_SET_P0HI16Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI16Q_HOST_IDX(x) | BIT_P0HI16Q_HOST_IDX(v)) -+ -+/* 2 REG_P0HI17Q_TXBD_IDX (Offset 0x2374) */ -+ -+#define BIT_SHIFT_P0HI17Q_HW_IDX 16 -+#define BIT_MASK_P0HI17Q_HW_IDX 0xfff -+#define BIT_P0HI17Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI17Q_HW_IDX) << BIT_SHIFT_P0HI17Q_HW_IDX) -+#define BITS_P0HI17Q_HW_IDX \ -+ (BIT_MASK_P0HI17Q_HW_IDX << BIT_SHIFT_P0HI17Q_HW_IDX) -+#define BIT_CLEAR_P0HI17Q_HW_IDX(x) ((x) & (~BITS_P0HI17Q_HW_IDX)) -+#define BIT_GET_P0HI17Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI17Q_HW_IDX) & BIT_MASK_P0HI17Q_HW_IDX) -+#define BIT_SET_P0HI17Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI17Q_HW_IDX(x) | BIT_P0HI17Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI17Q_HOST_IDX 0 -+#define BIT_MASK_P0HI17Q_HOST_IDX 0xfff -+#define BIT_P0HI17Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI17Q_HOST_IDX) << BIT_SHIFT_P0HI17Q_HOST_IDX) -+#define BITS_P0HI17Q_HOST_IDX \ -+ (BIT_MASK_P0HI17Q_HOST_IDX << BIT_SHIFT_P0HI17Q_HOST_IDX) -+#define BIT_CLEAR_P0HI17Q_HOST_IDX(x) ((x) & (~BITS_P0HI17Q_HOST_IDX)) -+#define BIT_GET_P0HI17Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI17Q_HOST_IDX) & BIT_MASK_P0HI17Q_HOST_IDX) -+#define BIT_SET_P0HI17Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI17Q_HOST_IDX(x) | BIT_P0HI17Q_HOST_IDX(v)) -+ -+/* 2 REG_P0HI18Q_TXBD_IDX (Offset 0x2378) */ -+ -+#define BIT_SHIFT_P0HI18Q_HW_IDX 16 -+#define BIT_MASK_P0HI18Q_HW_IDX 0xfff -+#define BIT_P0HI18Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI18Q_HW_IDX) << BIT_SHIFT_P0HI18Q_HW_IDX) -+#define BITS_P0HI18Q_HW_IDX \ -+ (BIT_MASK_P0HI18Q_HW_IDX << BIT_SHIFT_P0HI18Q_HW_IDX) -+#define BIT_CLEAR_P0HI18Q_HW_IDX(x) ((x) & (~BITS_P0HI18Q_HW_IDX)) -+#define BIT_GET_P0HI18Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI18Q_HW_IDX) & BIT_MASK_P0HI18Q_HW_IDX) -+#define BIT_SET_P0HI18Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI18Q_HW_IDX(x) | BIT_P0HI18Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI18Q_HOST_IDX 0 -+#define BIT_MASK_P0HI18Q_HOST_IDX 0xfff -+#define BIT_P0HI18Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI18Q_HOST_IDX) << BIT_SHIFT_P0HI18Q_HOST_IDX) -+#define BITS_P0HI18Q_HOST_IDX \ -+ (BIT_MASK_P0HI18Q_HOST_IDX << BIT_SHIFT_P0HI18Q_HOST_IDX) -+#define BIT_CLEAR_P0HI18Q_HOST_IDX(x) ((x) & (~BITS_P0HI18Q_HOST_IDX)) -+#define BIT_GET_P0HI18Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI18Q_HOST_IDX) & BIT_MASK_P0HI18Q_HOST_IDX) -+#define BIT_SET_P0HI18Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI18Q_HOST_IDX(x) | BIT_P0HI18Q_HOST_IDX(v)) -+ -+/* 2 REG_P0HI19Q_TXBD_IDX (Offset 0x237C) */ -+ -+#define BIT_SHIFT_P0HI19Q_HW_IDX 16 -+#define BIT_MASK_P0HI19Q_HW_IDX 0xfff -+#define BIT_P0HI19Q_HW_IDX(x) \ -+ (((x) & BIT_MASK_P0HI19Q_HW_IDX) << BIT_SHIFT_P0HI19Q_HW_IDX) -+#define BITS_P0HI19Q_HW_IDX \ -+ (BIT_MASK_P0HI19Q_HW_IDX << BIT_SHIFT_P0HI19Q_HW_IDX) -+#define BIT_CLEAR_P0HI19Q_HW_IDX(x) ((x) & (~BITS_P0HI19Q_HW_IDX)) -+#define BIT_GET_P0HI19Q_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI19Q_HW_IDX) & BIT_MASK_P0HI19Q_HW_IDX) -+#define BIT_SET_P0HI19Q_HW_IDX(x, v) \ -+ (BIT_CLEAR_P0HI19Q_HW_IDX(x) | BIT_P0HI19Q_HW_IDX(v)) -+ -+#define BIT_SHIFT_P0HI19Q_HOST_IDX 0 -+#define BIT_MASK_P0HI19Q_HOST_IDX 0xfff -+#define BIT_P0HI19Q_HOST_IDX(x) \ -+ (((x) & BIT_MASK_P0HI19Q_HOST_IDX) << BIT_SHIFT_P0HI19Q_HOST_IDX) -+#define BITS_P0HI19Q_HOST_IDX \ -+ (BIT_MASK_P0HI19Q_HOST_IDX << BIT_SHIFT_P0HI19Q_HOST_IDX) -+#define BIT_CLEAR_P0HI19Q_HOST_IDX(x) ((x) & (~BITS_P0HI19Q_HOST_IDX)) -+#define BIT_GET_P0HI19Q_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_P0HI19Q_HOST_IDX) & BIT_MASK_P0HI19Q_HOST_IDX) -+#define BIT_SET_P0HI19Q_HOST_IDX(x, v) \ -+ (BIT_CLEAR_P0HI19Q_HOST_IDX(x) | BIT_P0HI19Q_HOST_IDX(v)) -+ -+/* 2 REG_P0HI16Q_HI17Q_TXBD_NUM (Offset 0x2380) */ -+ -+#define BIT_P0HI17Q_FLAG BIT(30) -+ -+#define BIT_SHIFT_P0HI17Q_DESC_MODE 28 -+#define BIT_MASK_P0HI17Q_DESC_MODE 0x3 -+#define BIT_P0HI17Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI17Q_DESC_MODE) << BIT_SHIFT_P0HI17Q_DESC_MODE) -+#define BITS_P0HI17Q_DESC_MODE \ -+ (BIT_MASK_P0HI17Q_DESC_MODE << BIT_SHIFT_P0HI17Q_DESC_MODE) -+#define BIT_CLEAR_P0HI17Q_DESC_MODE(x) ((x) & (~BITS_P0HI17Q_DESC_MODE)) -+#define BIT_GET_P0HI17Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI17Q_DESC_MODE) & BIT_MASK_P0HI17Q_DESC_MODE) -+#define BIT_SET_P0HI17Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI17Q_DESC_MODE(x) | BIT_P0HI17Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI17Q_DESC_NUM 16 -+#define BIT_MASK_P0HI17Q_DESC_NUM 0xfff -+#define BIT_P0HI17Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI17Q_DESC_NUM) << BIT_SHIFT_P0HI17Q_DESC_NUM) -+#define BITS_P0HI17Q_DESC_NUM \ -+ (BIT_MASK_P0HI17Q_DESC_NUM << BIT_SHIFT_P0HI17Q_DESC_NUM) -+#define BIT_CLEAR_P0HI17Q_DESC_NUM(x) ((x) & (~BITS_P0HI17Q_DESC_NUM)) -+#define BIT_GET_P0HI17Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI17Q_DESC_NUM) & BIT_MASK_P0HI17Q_DESC_NUM) -+#define BIT_SET_P0HI17Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI17Q_DESC_NUM(x) | BIT_P0HI17Q_DESC_NUM(v)) -+ -+#define BIT_P0HI16Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_P0HI16Q_DESC_MODE 12 -+#define BIT_MASK_P0HI16Q_DESC_MODE 0x3 -+#define BIT_P0HI16Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI16Q_DESC_MODE) << BIT_SHIFT_P0HI16Q_DESC_MODE) -+#define BITS_P0HI16Q_DESC_MODE \ -+ (BIT_MASK_P0HI16Q_DESC_MODE << BIT_SHIFT_P0HI16Q_DESC_MODE) -+#define BIT_CLEAR_P0HI16Q_DESC_MODE(x) ((x) & (~BITS_P0HI16Q_DESC_MODE)) -+#define BIT_GET_P0HI16Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI16Q_DESC_MODE) & BIT_MASK_P0HI16Q_DESC_MODE) -+#define BIT_SET_P0HI16Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI16Q_DESC_MODE(x) | BIT_P0HI16Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI16Q_DESC_NUM 0 -+#define BIT_MASK_P0HI16Q_DESC_NUM 0xfff -+#define BIT_P0HI16Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI16Q_DESC_NUM) << BIT_SHIFT_P0HI16Q_DESC_NUM) -+#define BITS_P0HI16Q_DESC_NUM \ -+ (BIT_MASK_P0HI16Q_DESC_NUM << BIT_SHIFT_P0HI16Q_DESC_NUM) -+#define BIT_CLEAR_P0HI16Q_DESC_NUM(x) ((x) & (~BITS_P0HI16Q_DESC_NUM)) -+#define BIT_GET_P0HI16Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI16Q_DESC_NUM) & BIT_MASK_P0HI16Q_DESC_NUM) -+#define BIT_SET_P0HI16Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI16Q_DESC_NUM(x) | BIT_P0HI16Q_DESC_NUM(v)) -+ -+/* 2 REG_P0HI18Q_HI19Q_TXBD_NUM (Offset 0x2384) */ -+ -+#define BIT_P0HI19Q_FLAG BIT(30) -+ -+#define BIT_SHIFT_P0HI19Q_DESC_MODE 28 -+#define BIT_MASK_P0HI19Q_DESC_MODE 0x3 -+#define BIT_P0HI19Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI19Q_DESC_MODE) << BIT_SHIFT_P0HI19Q_DESC_MODE) -+#define BITS_P0HI19Q_DESC_MODE \ -+ (BIT_MASK_P0HI19Q_DESC_MODE << BIT_SHIFT_P0HI19Q_DESC_MODE) -+#define BIT_CLEAR_P0HI19Q_DESC_MODE(x) ((x) & (~BITS_P0HI19Q_DESC_MODE)) -+#define BIT_GET_P0HI19Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI19Q_DESC_MODE) & BIT_MASK_P0HI19Q_DESC_MODE) -+#define BIT_SET_P0HI19Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI19Q_DESC_MODE(x) | BIT_P0HI19Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI19Q_DESC_NUM 16 -+#define BIT_MASK_P0HI19Q_DESC_NUM 0xfff -+#define BIT_P0HI19Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI19Q_DESC_NUM) << BIT_SHIFT_P0HI19Q_DESC_NUM) -+#define BITS_P0HI19Q_DESC_NUM \ -+ (BIT_MASK_P0HI19Q_DESC_NUM << BIT_SHIFT_P0HI19Q_DESC_NUM) -+#define BIT_CLEAR_P0HI19Q_DESC_NUM(x) ((x) & (~BITS_P0HI19Q_DESC_NUM)) -+#define BIT_GET_P0HI19Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI19Q_DESC_NUM) & BIT_MASK_P0HI19Q_DESC_NUM) -+#define BIT_SET_P0HI19Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI19Q_DESC_NUM(x) | BIT_P0HI19Q_DESC_NUM(v)) -+ -+#define BIT_P0HI18Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_P0HI18Q_DESC_MODE 12 -+#define BIT_MASK_P0HI18Q_DESC_MODE 0x3 -+#define BIT_P0HI18Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI18Q_DESC_MODE) << BIT_SHIFT_P0HI18Q_DESC_MODE) -+#define BITS_P0HI18Q_DESC_MODE \ -+ (BIT_MASK_P0HI18Q_DESC_MODE << BIT_SHIFT_P0HI18Q_DESC_MODE) -+#define BIT_CLEAR_P0HI18Q_DESC_MODE(x) ((x) & (~BITS_P0HI18Q_DESC_MODE)) -+#define BIT_GET_P0HI18Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI18Q_DESC_MODE) & BIT_MASK_P0HI18Q_DESC_MODE) -+#define BIT_SET_P0HI18Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI18Q_DESC_MODE(x) | BIT_P0HI18Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI18Q_DESC_NUM 0 -+#define BIT_MASK_P0HI18Q_DESC_NUM 0xfff -+#define BIT_P0HI18Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI18Q_DESC_NUM) << BIT_SHIFT_P0HI18Q_DESC_NUM) -+#define BITS_P0HI18Q_DESC_NUM \ -+ (BIT_MASK_P0HI18Q_DESC_NUM << BIT_SHIFT_P0HI18Q_DESC_NUM) -+#define BIT_CLEAR_P0HI18Q_DESC_NUM(x) ((x) & (~BITS_P0HI18Q_DESC_NUM)) -+#define BIT_GET_P0HI18Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI18Q_DESC_NUM) & BIT_MASK_P0HI18Q_DESC_NUM) -+#define BIT_SET_P0HI18Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI18Q_DESC_NUM(x) | BIT_P0HI18Q_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_PCIE_HISR1 (Offset 0x23BC) */ -+ -+#define BIT_CPU_MGQ_EARLY_INT BIT(6) -+#define BIT_PSTIMER_5 BIT(4) -+#define BIT_PSTIMER_4 BIT(3) -+#define BIT_PSTIMER_3 BIT(2) -+#define BIT_BB_STOPRX_INT BIT(0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_P0HI8Q_HI9Q_TXBD_NUM (Offset 0x23C0) */ -+ -+#define BIT_P0HI9Q_FLAG BIT(30) -+ -+#define BIT_SHIFT_P0HI9Q_DESC_MODE 28 -+#define BIT_MASK_P0HI9Q_DESC_MODE 0x3 -+#define BIT_P0HI9Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI9Q_DESC_MODE) << BIT_SHIFT_P0HI9Q_DESC_MODE) -+#define BITS_P0HI9Q_DESC_MODE \ -+ (BIT_MASK_P0HI9Q_DESC_MODE << BIT_SHIFT_P0HI9Q_DESC_MODE) -+#define BIT_CLEAR_P0HI9Q_DESC_MODE(x) ((x) & (~BITS_P0HI9Q_DESC_MODE)) -+#define BIT_GET_P0HI9Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI9Q_DESC_MODE) & BIT_MASK_P0HI9Q_DESC_MODE) -+#define BIT_SET_P0HI9Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI9Q_DESC_MODE(x) | BIT_P0HI9Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI9Q_DESC_NUM 16 -+#define BIT_MASK_P0HI9Q_DESC_NUM 0xfff -+#define BIT_P0HI9Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI9Q_DESC_NUM) << BIT_SHIFT_P0HI9Q_DESC_NUM) -+#define BITS_P0HI9Q_DESC_NUM \ -+ (BIT_MASK_P0HI9Q_DESC_NUM << BIT_SHIFT_P0HI9Q_DESC_NUM) -+#define BIT_CLEAR_P0HI9Q_DESC_NUM(x) ((x) & (~BITS_P0HI9Q_DESC_NUM)) -+#define BIT_GET_P0HI9Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI9Q_DESC_NUM) & BIT_MASK_P0HI9Q_DESC_NUM) -+#define BIT_SET_P0HI9Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI9Q_DESC_NUM(x) | BIT_P0HI9Q_DESC_NUM(v)) -+ -+#define BIT_P0HI8Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_P0HI8Q_DESC_MODE 12 -+#define BIT_MASK_P0HI8Q_DESC_MODE 0x3 -+#define BIT_P0HI8Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI8Q_DESC_MODE) << BIT_SHIFT_P0HI8Q_DESC_MODE) -+#define BITS_P0HI8Q_DESC_MODE \ -+ (BIT_MASK_P0HI8Q_DESC_MODE << BIT_SHIFT_P0HI8Q_DESC_MODE) -+#define BIT_CLEAR_P0HI8Q_DESC_MODE(x) ((x) & (~BITS_P0HI8Q_DESC_MODE)) -+#define BIT_GET_P0HI8Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI8Q_DESC_MODE) & BIT_MASK_P0HI8Q_DESC_MODE) -+#define BIT_SET_P0HI8Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI8Q_DESC_MODE(x) | BIT_P0HI8Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI8Q_DESC_NUM 0 -+#define BIT_MASK_P0HI8Q_DESC_NUM 0xfff -+#define BIT_P0HI8Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI8Q_DESC_NUM) << BIT_SHIFT_P0HI8Q_DESC_NUM) -+#define BITS_P0HI8Q_DESC_NUM \ -+ (BIT_MASK_P0HI8Q_DESC_NUM << BIT_SHIFT_P0HI8Q_DESC_NUM) -+#define BIT_CLEAR_P0HI8Q_DESC_NUM(x) ((x) & (~BITS_P0HI8Q_DESC_NUM)) -+#define BIT_GET_P0HI8Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI8Q_DESC_NUM) & BIT_MASK_P0HI8Q_DESC_NUM) -+#define BIT_SET_P0HI8Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI8Q_DESC_NUM(x) | BIT_P0HI8Q_DESC_NUM(v)) -+ -+/* 2 REG_P0HI10Q_HI11Q_TXBD_NUM (Offset 0x23C4) */ -+ -+#define BIT_P0HI11Q_FLAG BIT(30) -+ -+#define BIT_SHIFT_P0HI11Q_DESC_MODE 28 -+#define BIT_MASK_P0HI11Q_DESC_MODE 0x3 -+#define BIT_P0HI11Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI11Q_DESC_MODE) << BIT_SHIFT_P0HI11Q_DESC_MODE) -+#define BITS_P0HI11Q_DESC_MODE \ -+ (BIT_MASK_P0HI11Q_DESC_MODE << BIT_SHIFT_P0HI11Q_DESC_MODE) -+#define BIT_CLEAR_P0HI11Q_DESC_MODE(x) ((x) & (~BITS_P0HI11Q_DESC_MODE)) -+#define BIT_GET_P0HI11Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI11Q_DESC_MODE) & BIT_MASK_P0HI11Q_DESC_MODE) -+#define BIT_SET_P0HI11Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI11Q_DESC_MODE(x) | BIT_P0HI11Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI11Q_DESC_NUM 16 -+#define BIT_MASK_P0HI11Q_DESC_NUM 0xfff -+#define BIT_P0HI11Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI11Q_DESC_NUM) << BIT_SHIFT_P0HI11Q_DESC_NUM) -+#define BITS_P0HI11Q_DESC_NUM \ -+ (BIT_MASK_P0HI11Q_DESC_NUM << BIT_SHIFT_P0HI11Q_DESC_NUM) -+#define BIT_CLEAR_P0HI11Q_DESC_NUM(x) ((x) & (~BITS_P0HI11Q_DESC_NUM)) -+#define BIT_GET_P0HI11Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI11Q_DESC_NUM) & BIT_MASK_P0HI11Q_DESC_NUM) -+#define BIT_SET_P0HI11Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI11Q_DESC_NUM(x) | BIT_P0HI11Q_DESC_NUM(v)) -+ -+#define BIT_P0HI10Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_P0HI10Q_DESC_MODE 12 -+#define BIT_MASK_P0HI10Q_DESC_MODE 0x3 -+#define BIT_P0HI10Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI10Q_DESC_MODE) << BIT_SHIFT_P0HI10Q_DESC_MODE) -+#define BITS_P0HI10Q_DESC_MODE \ -+ (BIT_MASK_P0HI10Q_DESC_MODE << BIT_SHIFT_P0HI10Q_DESC_MODE) -+#define BIT_CLEAR_P0HI10Q_DESC_MODE(x) ((x) & (~BITS_P0HI10Q_DESC_MODE)) -+#define BIT_GET_P0HI10Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI10Q_DESC_MODE) & BIT_MASK_P0HI10Q_DESC_MODE) -+#define BIT_SET_P0HI10Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI10Q_DESC_MODE(x) | BIT_P0HI10Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI10Q_DESC_NUM 0 -+#define BIT_MASK_P0HI10Q_DESC_NUM 0xfff -+#define BIT_P0HI10Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI10Q_DESC_NUM) << BIT_SHIFT_P0HI10Q_DESC_NUM) -+#define BITS_P0HI10Q_DESC_NUM \ -+ (BIT_MASK_P0HI10Q_DESC_NUM << BIT_SHIFT_P0HI10Q_DESC_NUM) -+#define BIT_CLEAR_P0HI10Q_DESC_NUM(x) ((x) & (~BITS_P0HI10Q_DESC_NUM)) -+#define BIT_GET_P0HI10Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI10Q_DESC_NUM) & BIT_MASK_P0HI10Q_DESC_NUM) -+#define BIT_SET_P0HI10Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI10Q_DESC_NUM(x) | BIT_P0HI10Q_DESC_NUM(v)) -+ -+/* 2 REG_P0HI12Q_HI13Q_TXBD_NUM (Offset 0x23C8) */ -+ -+#define BIT_P0HI13Q_FLAG BIT(30) -+ -+#define BIT_SHIFT_P0HI13Q_DESC_MODE 28 -+#define BIT_MASK_P0HI13Q_DESC_MODE 0x3 -+#define BIT_P0HI13Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI13Q_DESC_MODE) << BIT_SHIFT_P0HI13Q_DESC_MODE) -+#define BITS_P0HI13Q_DESC_MODE \ -+ (BIT_MASK_P0HI13Q_DESC_MODE << BIT_SHIFT_P0HI13Q_DESC_MODE) -+#define BIT_CLEAR_P0HI13Q_DESC_MODE(x) ((x) & (~BITS_P0HI13Q_DESC_MODE)) -+#define BIT_GET_P0HI13Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI13Q_DESC_MODE) & BIT_MASK_P0HI13Q_DESC_MODE) -+#define BIT_SET_P0HI13Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI13Q_DESC_MODE(x) | BIT_P0HI13Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI13Q_DESC_NUM 16 -+#define BIT_MASK_P0HI13Q_DESC_NUM 0xfff -+#define BIT_P0HI13Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI13Q_DESC_NUM) << BIT_SHIFT_P0HI13Q_DESC_NUM) -+#define BITS_P0HI13Q_DESC_NUM \ -+ (BIT_MASK_P0HI13Q_DESC_NUM << BIT_SHIFT_P0HI13Q_DESC_NUM) -+#define BIT_CLEAR_P0HI13Q_DESC_NUM(x) ((x) & (~BITS_P0HI13Q_DESC_NUM)) -+#define BIT_GET_P0HI13Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI13Q_DESC_NUM) & BIT_MASK_P0HI13Q_DESC_NUM) -+#define BIT_SET_P0HI13Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI13Q_DESC_NUM(x) | BIT_P0HI13Q_DESC_NUM(v)) -+ -+#define BIT_P0HI12Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_P0HI12Q_DESC_MODE 12 -+#define BIT_MASK_P0HI12Q_DESC_MODE 0x3 -+#define BIT_P0HI12Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI12Q_DESC_MODE) << BIT_SHIFT_P0HI12Q_DESC_MODE) -+#define BITS_P0HI12Q_DESC_MODE \ -+ (BIT_MASK_P0HI12Q_DESC_MODE << BIT_SHIFT_P0HI12Q_DESC_MODE) -+#define BIT_CLEAR_P0HI12Q_DESC_MODE(x) ((x) & (~BITS_P0HI12Q_DESC_MODE)) -+#define BIT_GET_P0HI12Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI12Q_DESC_MODE) & BIT_MASK_P0HI12Q_DESC_MODE) -+#define BIT_SET_P0HI12Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI12Q_DESC_MODE(x) | BIT_P0HI12Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI12Q_DESC_NUM 0 -+#define BIT_MASK_P0HI12Q_DESC_NUM 0xfff -+#define BIT_P0HI12Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI12Q_DESC_NUM) << BIT_SHIFT_P0HI12Q_DESC_NUM) -+#define BITS_P0HI12Q_DESC_NUM \ -+ (BIT_MASK_P0HI12Q_DESC_NUM << BIT_SHIFT_P0HI12Q_DESC_NUM) -+#define BIT_CLEAR_P0HI12Q_DESC_NUM(x) ((x) & (~BITS_P0HI12Q_DESC_NUM)) -+#define BIT_GET_P0HI12Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI12Q_DESC_NUM) & BIT_MASK_P0HI12Q_DESC_NUM) -+#define BIT_SET_P0HI12Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI12Q_DESC_NUM(x) | BIT_P0HI12Q_DESC_NUM(v)) -+ -+/* 2 REG_P0HI14Q_HI15Q_TXBD_NUM (Offset 0x23CC) */ -+ -+#define BIT_P0HI15Q_FLAG BIT(30) -+ -+#define BIT_SHIFT_P0HI15Q_DESC_MODE 28 -+#define BIT_MASK_P0HI15Q_DESC_MODE 0x3 -+#define BIT_P0HI15Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI15Q_DESC_MODE) << BIT_SHIFT_P0HI15Q_DESC_MODE) -+#define BITS_P0HI15Q_DESC_MODE \ -+ (BIT_MASK_P0HI15Q_DESC_MODE << BIT_SHIFT_P0HI15Q_DESC_MODE) -+#define BIT_CLEAR_P0HI15Q_DESC_MODE(x) ((x) & (~BITS_P0HI15Q_DESC_MODE)) -+#define BIT_GET_P0HI15Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI15Q_DESC_MODE) & BIT_MASK_P0HI15Q_DESC_MODE) -+#define BIT_SET_P0HI15Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI15Q_DESC_MODE(x) | BIT_P0HI15Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI15Q_DESC_NUM 16 -+#define BIT_MASK_P0HI15Q_DESC_NUM 0xfff -+#define BIT_P0HI15Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI15Q_DESC_NUM) << BIT_SHIFT_P0HI15Q_DESC_NUM) -+#define BITS_P0HI15Q_DESC_NUM \ -+ (BIT_MASK_P0HI15Q_DESC_NUM << BIT_SHIFT_P0HI15Q_DESC_NUM) -+#define BIT_CLEAR_P0HI15Q_DESC_NUM(x) ((x) & (~BITS_P0HI15Q_DESC_NUM)) -+#define BIT_GET_P0HI15Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI15Q_DESC_NUM) & BIT_MASK_P0HI15Q_DESC_NUM) -+#define BIT_SET_P0HI15Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI15Q_DESC_NUM(x) | BIT_P0HI15Q_DESC_NUM(v)) -+ -+#define BIT_P0HI14Q_FLAG BIT(14) -+ -+#define BIT_SHIFT_P0HI14Q_DESC_MODE 12 -+#define BIT_MASK_P0HI14Q_DESC_MODE 0x3 -+#define BIT_P0HI14Q_DESC_MODE(x) \ -+ (((x) & BIT_MASK_P0HI14Q_DESC_MODE) << BIT_SHIFT_P0HI14Q_DESC_MODE) -+#define BITS_P0HI14Q_DESC_MODE \ -+ (BIT_MASK_P0HI14Q_DESC_MODE << BIT_SHIFT_P0HI14Q_DESC_MODE) -+#define BIT_CLEAR_P0HI14Q_DESC_MODE(x) ((x) & (~BITS_P0HI14Q_DESC_MODE)) -+#define BIT_GET_P0HI14Q_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_P0HI14Q_DESC_MODE) & BIT_MASK_P0HI14Q_DESC_MODE) -+#define BIT_SET_P0HI14Q_DESC_MODE(x, v) \ -+ (BIT_CLEAR_P0HI14Q_DESC_MODE(x) | BIT_P0HI14Q_DESC_MODE(v)) -+ -+#define BIT_SHIFT_P0HI14Q_DESC_NUM 0 -+#define BIT_MASK_P0HI14Q_DESC_NUM 0xfff -+#define BIT_P0HI14Q_DESC_NUM(x) \ -+ (((x) & BIT_MASK_P0HI14Q_DESC_NUM) << BIT_SHIFT_P0HI14Q_DESC_NUM) -+#define BITS_P0HI14Q_DESC_NUM \ -+ (BIT_MASK_P0HI14Q_DESC_NUM << BIT_SHIFT_P0HI14Q_DESC_NUM) -+#define BIT_CLEAR_P0HI14Q_DESC_NUM(x) ((x) & (~BITS_P0HI14Q_DESC_NUM)) -+#define BIT_GET_P0HI14Q_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_P0HI14Q_DESC_NUM) & BIT_MASK_P0HI14Q_DESC_NUM) -+#define BIT_SET_P0HI14Q_DESC_NUM(x, v) \ -+ (BIT_CLEAR_P0HI14Q_DESC_NUM(x) | BIT_P0HI14Q_DESC_NUM(v)) -+ -+/* 2 REG_ACH6_ACH7_TXBD_NUM (Offset 0x23F0) */ -+ -+#define BIT_PCIE_ACH7_FLAG BIT(30) -+ -+#define BIT_SHIFT_ACH7_DESC_MODE 28 -+#define BIT_MASK_ACH7_DESC_MODE 0x3 -+#define BIT_ACH7_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH7_DESC_MODE) << BIT_SHIFT_ACH7_DESC_MODE) -+#define BITS_ACH7_DESC_MODE \ -+ (BIT_MASK_ACH7_DESC_MODE << BIT_SHIFT_ACH7_DESC_MODE) -+#define BIT_CLEAR_ACH7_DESC_MODE(x) ((x) & (~BITS_ACH7_DESC_MODE)) -+#define BIT_GET_ACH7_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH7_DESC_MODE) & BIT_MASK_ACH7_DESC_MODE) -+#define BIT_SET_ACH7_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH7_DESC_MODE(x) | BIT_ACH7_DESC_MODE(v)) -+ -+#define BIT_SHIFT_ACH7_DESC_NUM 16 -+#define BIT_MASK_ACH7_DESC_NUM 0xfff -+#define BIT_ACH7_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH7_DESC_NUM) << BIT_SHIFT_ACH7_DESC_NUM) -+#define BITS_ACH7_DESC_NUM (BIT_MASK_ACH7_DESC_NUM << BIT_SHIFT_ACH7_DESC_NUM) -+#define BIT_CLEAR_ACH7_DESC_NUM(x) ((x) & (~BITS_ACH7_DESC_NUM)) -+#define BIT_GET_ACH7_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH7_DESC_NUM) & BIT_MASK_ACH7_DESC_NUM) -+#define BIT_SET_ACH7_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH7_DESC_NUM(x) | BIT_ACH7_DESC_NUM(v)) -+ -+#define BIT_PCIE_ACH6_FLAG BIT(14) -+ -+#define BIT_SHIFT_ACH6_DESC_MODE 12 -+#define BIT_MASK_ACH6_DESC_MODE 0x3 -+#define BIT_ACH6_DESC_MODE(x) \ -+ (((x) & BIT_MASK_ACH6_DESC_MODE) << BIT_SHIFT_ACH6_DESC_MODE) -+#define BITS_ACH6_DESC_MODE \ -+ (BIT_MASK_ACH6_DESC_MODE << BIT_SHIFT_ACH6_DESC_MODE) -+#define BIT_CLEAR_ACH6_DESC_MODE(x) ((x) & (~BITS_ACH6_DESC_MODE)) -+#define BIT_GET_ACH6_DESC_MODE(x) \ -+ (((x) >> BIT_SHIFT_ACH6_DESC_MODE) & BIT_MASK_ACH6_DESC_MODE) -+#define BIT_SET_ACH6_DESC_MODE(x, v) \ -+ (BIT_CLEAR_ACH6_DESC_MODE(x) | BIT_ACH6_DESC_MODE(v)) -+ -+#define BIT_SHIFT_ACH6_DESC_NUM 0 -+#define BIT_MASK_ACH6_DESC_NUM 0xfff -+#define BIT_ACH6_DESC_NUM(x) \ -+ (((x) & BIT_MASK_ACH6_DESC_NUM) << BIT_SHIFT_ACH6_DESC_NUM) -+#define BITS_ACH6_DESC_NUM (BIT_MASK_ACH6_DESC_NUM << BIT_SHIFT_ACH6_DESC_NUM) -+#define BIT_CLEAR_ACH6_DESC_NUM(x) ((x) & (~BITS_ACH6_DESC_NUM)) -+#define BIT_GET_ACH6_DESC_NUM(x) \ -+ (((x) >> BIT_SHIFT_ACH6_DESC_NUM) & BIT_MASK_ACH6_DESC_NUM) -+#define BIT_SET_ACH6_DESC_NUM(x, v) \ -+ (BIT_CLEAR_ACH6_DESC_NUM(x) | BIT_ACH6_DESC_NUM(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_FAST_EDCA_VOVI_SETTING_V1 (Offset 0x2448) */ -+ -+#define BIT_SHIFT_VO_FAST_EDCA_TO_V1 0 -+#define BIT_MASK_VO_FAST_EDCA_TO_V1 0xffff -+#define BIT_VO_FAST_EDCA_TO_V1(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_TO_V1) << BIT_SHIFT_VO_FAST_EDCA_TO_V1) -+#define BITS_VO_FAST_EDCA_TO_V1 \ -+ (BIT_MASK_VO_FAST_EDCA_TO_V1 << BIT_SHIFT_VO_FAST_EDCA_TO_V1) -+#define BIT_CLEAR_VO_FAST_EDCA_TO_V1(x) ((x) & (~BITS_VO_FAST_EDCA_TO_V1)) -+#define BIT_GET_VO_FAST_EDCA_TO_V1(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_TO_V1) & BIT_MASK_VO_FAST_EDCA_TO_V1) -+#define BIT_SET_VO_FAST_EDCA_TO_V1(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_TO_V1(x) | BIT_VO_FAST_EDCA_TO_V1(v)) -+ -+/* 2 REG_FAST_EDCA_BEBK_SETTING_V1 (Offset 0x244C) */ -+ -+#define BIT_SHIFT_BE_FAST_EDCA_TO_V1 0 -+#define BIT_MASK_BE_FAST_EDCA_TO_V1 0xffff -+#define BIT_BE_FAST_EDCA_TO_V1(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_TO_V1) << BIT_SHIFT_BE_FAST_EDCA_TO_V1) -+#define BITS_BE_FAST_EDCA_TO_V1 \ -+ (BIT_MASK_BE_FAST_EDCA_TO_V1 << BIT_SHIFT_BE_FAST_EDCA_TO_V1) -+#define BIT_CLEAR_BE_FAST_EDCA_TO_V1(x) ((x) & (~BITS_BE_FAST_EDCA_TO_V1)) -+#define BIT_GET_BE_FAST_EDCA_TO_V1(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_TO_V1) & BIT_MASK_BE_FAST_EDCA_TO_V1) -+#define BIT_SET_BE_FAST_EDCA_TO_V1(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_TO_V1(x) | BIT_BE_FAST_EDCA_TO_V1(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_0_V1 (Offset 0x2460) */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_0 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_0(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_0) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0) -+#define BITS_R_MACID_RELEASE_SUCCESS_0 \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_0 \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_0)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_0(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_0) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_0(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_0(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_2_V1 (Offset 0x2468) */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_2 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_2(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_2) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2) -+#define BITS_R_MACID_RELEASE_SUCCESS_2 \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_2 \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_2)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_2(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_2) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_2(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_2(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/* 2 REG_NAN_INFO0 (Offset 0x2480) */ -+ -+#define BIT_SHIFT_NAN_INFO0 0 -+#define BIT_MASK_NAN_INFO0 0xffffffffL -+#define BIT_NAN_INFO0(x) (((x) & BIT_MASK_NAN_INFO0) << BIT_SHIFT_NAN_INFO0) -+#define BITS_NAN_INFO0 (BIT_MASK_NAN_INFO0 << BIT_SHIFT_NAN_INFO0) -+#define BIT_CLEAR_NAN_INFO0(x) ((x) & (~BITS_NAN_INFO0)) -+#define BIT_GET_NAN_INFO0(x) (((x) >> BIT_SHIFT_NAN_INFO0) & BIT_MASK_NAN_INFO0) -+#define BIT_SET_NAN_INFO0(x, v) (BIT_CLEAR_NAN_INFO0(x) | BIT_NAN_INFO0(v)) -+ -+/* 2 REG_NAN_INFO1 (Offset 0x2484) */ -+ -+#define BIT_SHIFT_NAN_INFO1 0 -+#define BIT_MASK_NAN_INFO1 0xffffffffL -+#define BIT_NAN_INFO1(x) (((x) & BIT_MASK_NAN_INFO1) << BIT_SHIFT_NAN_INFO1) -+#define BITS_NAN_INFO1 (BIT_MASK_NAN_INFO1 << BIT_SHIFT_NAN_INFO1) -+#define BIT_CLEAR_NAN_INFO1(x) ((x) & (~BITS_NAN_INFO1)) -+#define BIT_GET_NAN_INFO1(x) (((x) >> BIT_SHIFT_NAN_INFO1) & BIT_MASK_NAN_INFO1) -+#define BIT_SET_NAN_INFO1(x, v) (BIT_CLEAR_NAN_INFO1(x) | BIT_NAN_INFO1(v)) -+ -+/* 2 REG_NAN_INFO2 (Offset 0x2488) */ -+ -+#define BIT_SHIFT_NAN_INFO2 0 -+#define BIT_MASK_NAN_INFO2 0xffffffffL -+#define BIT_NAN_INFO2(x) (((x) & BIT_MASK_NAN_INFO2) << BIT_SHIFT_NAN_INFO2) -+#define BITS_NAN_INFO2 (BIT_MASK_NAN_INFO2 << BIT_SHIFT_NAN_INFO2) -+#define BIT_CLEAR_NAN_INFO2(x) ((x) & (~BITS_NAN_INFO2)) -+#define BIT_GET_NAN_INFO2(x) (((x) >> BIT_SHIFT_NAN_INFO2) & BIT_MASK_NAN_INFO2) -+#define BIT_SET_NAN_INFO2(x, v) (BIT_CLEAR_NAN_INFO2(x) | BIT_NAN_INFO2(v)) -+ -+/* 2 REG_NAN_INFO3 (Offset 0x248C) */ -+ -+#define BIT_SHIFT_NAN_INFO3 0 -+#define BIT_MASK_NAN_INFO3 0xffffffffL -+#define BIT_NAN_INFO3(x) (((x) & BIT_MASK_NAN_INFO3) << BIT_SHIFT_NAN_INFO3) -+#define BITS_NAN_INFO3 (BIT_MASK_NAN_INFO3 << BIT_SHIFT_NAN_INFO3) -+#define BIT_CLEAR_NAN_INFO3(x) ((x) & (~BITS_NAN_INFO3)) -+#define BIT_GET_NAN_INFO3(x) (((x) >> BIT_SHIFT_NAN_INFO3) & BIT_MASK_NAN_INFO3) -+#define BIT_SET_NAN_INFO3(x, v) (BIT_CLEAR_NAN_INFO3(x) | BIT_NAN_INFO3(v)) -+ -+/* 2 REG_NAN_INFO4 (Offset 0x2490) */ -+ -+#define BIT_SHIFT_NAN_INFO4 0 -+#define BIT_MASK_NAN_INFO4 0xffffffffL -+#define BIT_NAN_INFO4(x) (((x) & BIT_MASK_NAN_INFO4) << BIT_SHIFT_NAN_INFO4) -+#define BITS_NAN_INFO4 (BIT_MASK_NAN_INFO4 << BIT_SHIFT_NAN_INFO4) -+#define BIT_CLEAR_NAN_INFO4(x) ((x) & (~BITS_NAN_INFO4)) -+#define BIT_GET_NAN_INFO4(x) (((x) >> BIT_SHIFT_NAN_INFO4) & BIT_MASK_NAN_INFO4) -+#define BIT_SET_NAN_INFO4(x, v) (BIT_CLEAR_NAN_INFO4(x) | BIT_NAN_INFO4(v)) -+ -+/* 2 REG_NAN_INFO5 (Offset 0x2494) */ -+ -+#define BIT_SHIFT_NAN_INFO5 0 -+#define BIT_MASK_NAN_INFO5 0xffffffffL -+#define BIT_NAN_INFO5(x) (((x) & BIT_MASK_NAN_INFO5) << BIT_SHIFT_NAN_INFO5) -+#define BITS_NAN_INFO5 (BIT_MASK_NAN_INFO5 << BIT_SHIFT_NAN_INFO5) -+#define BIT_CLEAR_NAN_INFO5(x) ((x) & (~BITS_NAN_INFO5)) -+#define BIT_GET_NAN_INFO5(x) (((x) >> BIT_SHIFT_NAN_INFO5) & BIT_MASK_NAN_INFO5) -+#define BIT_SET_NAN_INFO5(x, v) (BIT_CLEAR_NAN_INFO5(x) | BIT_NAN_INFO5(v)) -+ -+/* 2 REG_NAN_INFO6 (Offset 0x2498) */ -+ -+#define BIT_SHIFT_NAN_INFO6 0 -+#define BIT_MASK_NAN_INFO6 0xffffffffL -+#define BIT_NAN_INFO6(x) (((x) & BIT_MASK_NAN_INFO6) << BIT_SHIFT_NAN_INFO6) -+#define BITS_NAN_INFO6 (BIT_MASK_NAN_INFO6 << BIT_SHIFT_NAN_INFO6) -+#define BIT_CLEAR_NAN_INFO6(x) ((x) & (~BITS_NAN_INFO6)) -+#define BIT_GET_NAN_INFO6(x) (((x) >> BIT_SHIFT_NAN_INFO6) & BIT_MASK_NAN_INFO6) -+#define BIT_SET_NAN_INFO6(x, v) (BIT_CLEAR_NAN_INFO6(x) | BIT_NAN_INFO6(v)) -+ -+/* 2 REG_NAN_INFO7 (Offset 0x249C) */ -+ -+#define BIT_SHIFT_NAN_INFO7 0 -+#define BIT_MASK_NAN_INFO7 0xffffffffL -+#define BIT_NAN_INFO7(x) (((x) & BIT_MASK_NAN_INFO7) << BIT_SHIFT_NAN_INFO7) -+#define BITS_NAN_INFO7 (BIT_MASK_NAN_INFO7 << BIT_SHIFT_NAN_INFO7) -+#define BIT_CLEAR_NAN_INFO7(x) ((x) & (~BITS_NAN_INFO7)) -+#define BIT_GET_NAN_INFO7(x) (((x) >> BIT_SHIFT_NAN_INFO7) & BIT_MASK_NAN_INFO7) -+#define BIT_SET_NAN_INFO7(x, v) (BIT_CLEAR_NAN_INFO7(x) | BIT_NAN_INFO7(v)) -+ -+/* 2 REG_NAN_INFO8 (Offset 0x24A0) */ -+ -+#define BIT_SHIFT_NAN_INFO8 0 -+#define BIT_MASK_NAN_INFO8 0xffffffffL -+#define BIT_NAN_INFO8(x) (((x) & BIT_MASK_NAN_INFO8) << BIT_SHIFT_NAN_INFO8) -+#define BITS_NAN_INFO8 (BIT_MASK_NAN_INFO8 << BIT_SHIFT_NAN_INFO8) -+#define BIT_CLEAR_NAN_INFO8(x) ((x) & (~BITS_NAN_INFO8)) -+#define BIT_GET_NAN_INFO8(x) (((x) >> BIT_SHIFT_NAN_INFO8) & BIT_MASK_NAN_INFO8) -+#define BIT_SET_NAN_INFO8(x, v) (BIT_CLEAR_NAN_INFO8(x) | BIT_NAN_INFO8(v)) -+ -+/* 2 REG_NAN_INFO9 (Offset 0x24A4) */ -+ -+#define BIT_SHIFT_NAN_INFO9 0 -+#define BIT_MASK_NAN_INFO9 0xffffffffL -+#define BIT_NAN_INFO9(x) (((x) & BIT_MASK_NAN_INFO9) << BIT_SHIFT_NAN_INFO9) -+#define BITS_NAN_INFO9 (BIT_MASK_NAN_INFO9 << BIT_SHIFT_NAN_INFO9) -+#define BIT_CLEAR_NAN_INFO9(x) ((x) & (~BITS_NAN_INFO9)) -+#define BIT_GET_NAN_INFO9(x) (((x) >> BIT_SHIFT_NAN_INFO9) & BIT_MASK_NAN_INFO9) -+#define BIT_SET_NAN_INFO9(x, v) (BIT_CLEAR_NAN_INFO9(x) | BIT_NAN_INFO9(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CHNL_INFO_CTRL_V1 (Offset 0x24D0) */ -+ -+#define BIT_CHNL_REF_EDCA BIT(5) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+/* 2 REG_CHNL_IDLE_TIME_V1 (Offset 0x24D4) */ -+ -+#define BIT_SHIFT_CHNL_IDLE_TIME 0 -+#define BIT_MASK_CHNL_IDLE_TIME 0xffffffffL -+#define BIT_CHNL_IDLE_TIME(x) \ -+ (((x) & BIT_MASK_CHNL_IDLE_TIME) << BIT_SHIFT_CHNL_IDLE_TIME) -+#define BITS_CHNL_IDLE_TIME \ -+ (BIT_MASK_CHNL_IDLE_TIME << BIT_SHIFT_CHNL_IDLE_TIME) -+#define BIT_CLEAR_CHNL_IDLE_TIME(x) ((x) & (~BITS_CHNL_IDLE_TIME)) -+#define BIT_GET_CHNL_IDLE_TIME(x) \ -+ (((x) >> BIT_SHIFT_CHNL_IDLE_TIME) & BIT_MASK_CHNL_IDLE_TIME) -+#define BIT_SET_CHNL_IDLE_TIME(x, v) \ -+ (BIT_CLEAR_CHNL_IDLE_TIME(x) | BIT_CHNL_IDLE_TIME(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SWPS_PKT_TH_V1 (Offset 0x24F6) */ -+ -+#define BIT_SHIFT_SWPS_PKT_TH 0 -+#define BIT_MASK_SWPS_PKT_TH 0xffff -+#define BIT_SWPS_PKT_TH(x) \ -+ (((x) & BIT_MASK_SWPS_PKT_TH) << BIT_SHIFT_SWPS_PKT_TH) -+#define BITS_SWPS_PKT_TH (BIT_MASK_SWPS_PKT_TH << BIT_SHIFT_SWPS_PKT_TH) -+#define BIT_CLEAR_SWPS_PKT_TH(x) ((x) & (~BITS_SWPS_PKT_TH)) -+#define BIT_GET_SWPS_PKT_TH(x) \ -+ (((x) >> BIT_SHIFT_SWPS_PKT_TH) & BIT_MASK_SWPS_PKT_TH) -+#define BIT_SET_SWPS_PKT_TH(x, v) \ -+ (BIT_CLEAR_SWPS_PKT_TH(x) | BIT_SWPS_PKT_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_SWPS_TIME_TH_V1 (Offset 0x24F8) */ -+ -+#define BIT_SHIFT_SWPS_PSTIME_TH 16 -+#define BIT_MASK_SWPS_PSTIME_TH 0xffff -+#define BIT_SWPS_PSTIME_TH(x) \ -+ (((x) & BIT_MASK_SWPS_PSTIME_TH) << BIT_SHIFT_SWPS_PSTIME_TH) -+#define BITS_SWPS_PSTIME_TH \ -+ (BIT_MASK_SWPS_PSTIME_TH << BIT_SHIFT_SWPS_PSTIME_TH) -+#define BIT_CLEAR_SWPS_PSTIME_TH(x) ((x) & (~BITS_SWPS_PSTIME_TH)) -+#define BIT_GET_SWPS_PSTIME_TH(x) \ -+ (((x) >> BIT_SHIFT_SWPS_PSTIME_TH) & BIT_MASK_SWPS_PSTIME_TH) -+#define BIT_SET_SWPS_PSTIME_TH(x, v) \ -+ (BIT_CLEAR_SWPS_PSTIME_TH(x) | BIT_SWPS_PSTIME_TH(v)) -+ -+#define BIT_SHIFT_SWPS_TIME_TH 0 -+#define BIT_MASK_SWPS_TIME_TH 0xffff -+#define BIT_SWPS_TIME_TH(x) \ -+ (((x) & BIT_MASK_SWPS_TIME_TH) << BIT_SHIFT_SWPS_TIME_TH) -+#define BITS_SWPS_TIME_TH (BIT_MASK_SWPS_TIME_TH << BIT_SHIFT_SWPS_TIME_TH) -+#define BIT_CLEAR_SWPS_TIME_TH(x) ((x) & (~BITS_SWPS_TIME_TH)) -+#define BIT_GET_SWPS_TIME_TH(x) \ -+ (((x) >> BIT_SHIFT_SWPS_TIME_TH) & BIT_MASK_SWPS_TIME_TH) -+#define BIT_SET_SWPS_TIME_TH(x, v) \ -+ (BIT_CLEAR_SWPS_TIME_TH(x) | BIT_SWPS_TIME_TH(v)) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/* 2 REG_TXPAGE_INT_CTRL_0 (Offset 0x3200) */ -+ -+#define BIT_CH0_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH0_HIGH_TH 16 -+#define BIT_MASK_CH0_HIGH_TH 0xfff -+#define BIT_CH0_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH0_HIGH_TH) << BIT_SHIFT_CH0_HIGH_TH) -+#define BITS_CH0_HIGH_TH (BIT_MASK_CH0_HIGH_TH << BIT_SHIFT_CH0_HIGH_TH) -+#define BIT_CLEAR_CH0_HIGH_TH(x) ((x) & (~BITS_CH0_HIGH_TH)) -+#define BIT_GET_CH0_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH0_HIGH_TH) & BIT_MASK_CH0_HIGH_TH) -+#define BIT_SET_CH0_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH0_HIGH_TH(x) | BIT_CH0_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH0_LOW_TH 0 -+#define BIT_MASK_CH0_LOW_TH 0xfff -+#define BIT_CH0_LOW_TH(x) (((x) & BIT_MASK_CH0_LOW_TH) << BIT_SHIFT_CH0_LOW_TH) -+#define BITS_CH0_LOW_TH (BIT_MASK_CH0_LOW_TH << BIT_SHIFT_CH0_LOW_TH) -+#define BIT_CLEAR_CH0_LOW_TH(x) ((x) & (~BITS_CH0_LOW_TH)) -+#define BIT_GET_CH0_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH0_LOW_TH) & BIT_MASK_CH0_LOW_TH) -+#define BIT_SET_CH0_LOW_TH(x, v) (BIT_CLEAR_CH0_LOW_TH(x) | BIT_CH0_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_1 (Offset 0x3204) */ -+ -+#define BIT_CH1_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH1_HIGH_TH 16 -+#define BIT_MASK_CH1_HIGH_TH 0xfff -+#define BIT_CH1_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH1_HIGH_TH) << BIT_SHIFT_CH1_HIGH_TH) -+#define BITS_CH1_HIGH_TH (BIT_MASK_CH1_HIGH_TH << BIT_SHIFT_CH1_HIGH_TH) -+#define BIT_CLEAR_CH1_HIGH_TH(x) ((x) & (~BITS_CH1_HIGH_TH)) -+#define BIT_GET_CH1_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH1_HIGH_TH) & BIT_MASK_CH1_HIGH_TH) -+#define BIT_SET_CH1_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH1_HIGH_TH(x) | BIT_CH1_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH1_LOW_TH 0 -+#define BIT_MASK_CH1_LOW_TH 0xfff -+#define BIT_CH1_LOW_TH(x) (((x) & BIT_MASK_CH1_LOW_TH) << BIT_SHIFT_CH1_LOW_TH) -+#define BITS_CH1_LOW_TH (BIT_MASK_CH1_LOW_TH << BIT_SHIFT_CH1_LOW_TH) -+#define BIT_CLEAR_CH1_LOW_TH(x) ((x) & (~BITS_CH1_LOW_TH)) -+#define BIT_GET_CH1_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH1_LOW_TH) & BIT_MASK_CH1_LOW_TH) -+#define BIT_SET_CH1_LOW_TH(x, v) (BIT_CLEAR_CH1_LOW_TH(x) | BIT_CH1_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_2 (Offset 0x3208) */ -+ -+#define BIT_CH2_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH2_HIGH_TH 16 -+#define BIT_MASK_CH2_HIGH_TH 0xfff -+#define BIT_CH2_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH2_HIGH_TH) << BIT_SHIFT_CH2_HIGH_TH) -+#define BITS_CH2_HIGH_TH (BIT_MASK_CH2_HIGH_TH << BIT_SHIFT_CH2_HIGH_TH) -+#define BIT_CLEAR_CH2_HIGH_TH(x) ((x) & (~BITS_CH2_HIGH_TH)) -+#define BIT_GET_CH2_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH2_HIGH_TH) & BIT_MASK_CH2_HIGH_TH) -+#define BIT_SET_CH2_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH2_HIGH_TH(x) | BIT_CH2_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH2_LOW_TH 0 -+#define BIT_MASK_CH2_LOW_TH 0xfff -+#define BIT_CH2_LOW_TH(x) (((x) & BIT_MASK_CH2_LOW_TH) << BIT_SHIFT_CH2_LOW_TH) -+#define BITS_CH2_LOW_TH (BIT_MASK_CH2_LOW_TH << BIT_SHIFT_CH2_LOW_TH) -+#define BIT_CLEAR_CH2_LOW_TH(x) ((x) & (~BITS_CH2_LOW_TH)) -+#define BIT_GET_CH2_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH2_LOW_TH) & BIT_MASK_CH2_LOW_TH) -+#define BIT_SET_CH2_LOW_TH(x, v) (BIT_CLEAR_CH2_LOW_TH(x) | BIT_CH2_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_3 (Offset 0x320C) */ -+ -+#define BIT_CH3_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH3_HIGH_TH 16 -+#define BIT_MASK_CH3_HIGH_TH 0xfff -+#define BIT_CH3_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH3_HIGH_TH) << BIT_SHIFT_CH3_HIGH_TH) -+#define BITS_CH3_HIGH_TH (BIT_MASK_CH3_HIGH_TH << BIT_SHIFT_CH3_HIGH_TH) -+#define BIT_CLEAR_CH3_HIGH_TH(x) ((x) & (~BITS_CH3_HIGH_TH)) -+#define BIT_GET_CH3_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH3_HIGH_TH) & BIT_MASK_CH3_HIGH_TH) -+#define BIT_SET_CH3_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH3_HIGH_TH(x) | BIT_CH3_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH3_LOW_TH 0 -+#define BIT_MASK_CH3_LOW_TH 0xfff -+#define BIT_CH3_LOW_TH(x) (((x) & BIT_MASK_CH3_LOW_TH) << BIT_SHIFT_CH3_LOW_TH) -+#define BITS_CH3_LOW_TH (BIT_MASK_CH3_LOW_TH << BIT_SHIFT_CH3_LOW_TH) -+#define BIT_CLEAR_CH3_LOW_TH(x) ((x) & (~BITS_CH3_LOW_TH)) -+#define BIT_GET_CH3_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH3_LOW_TH) & BIT_MASK_CH3_LOW_TH) -+#define BIT_SET_CH3_LOW_TH(x, v) (BIT_CLEAR_CH3_LOW_TH(x) | BIT_CH3_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_4 (Offset 0x3210) */ -+ -+#define BIT_CH4_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH4_HIGH_TH 16 -+#define BIT_MASK_CH4_HIGH_TH 0xfff -+#define BIT_CH4_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH4_HIGH_TH) << BIT_SHIFT_CH4_HIGH_TH) -+#define BITS_CH4_HIGH_TH (BIT_MASK_CH4_HIGH_TH << BIT_SHIFT_CH4_HIGH_TH) -+#define BIT_CLEAR_CH4_HIGH_TH(x) ((x) & (~BITS_CH4_HIGH_TH)) -+#define BIT_GET_CH4_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH4_HIGH_TH) & BIT_MASK_CH4_HIGH_TH) -+#define BIT_SET_CH4_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH4_HIGH_TH(x) | BIT_CH4_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH4_LOW_TH 0 -+#define BIT_MASK_CH4_LOW_TH 0xfff -+#define BIT_CH4_LOW_TH(x) (((x) & BIT_MASK_CH4_LOW_TH) << BIT_SHIFT_CH4_LOW_TH) -+#define BITS_CH4_LOW_TH (BIT_MASK_CH4_LOW_TH << BIT_SHIFT_CH4_LOW_TH) -+#define BIT_CLEAR_CH4_LOW_TH(x) ((x) & (~BITS_CH4_LOW_TH)) -+#define BIT_GET_CH4_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH4_LOW_TH) & BIT_MASK_CH4_LOW_TH) -+#define BIT_SET_CH4_LOW_TH(x, v) (BIT_CLEAR_CH4_LOW_TH(x) | BIT_CH4_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_5 (Offset 0x3214) */ -+ -+#define BIT_CH5_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH5_HIGH_TH 16 -+#define BIT_MASK_CH5_HIGH_TH 0xfff -+#define BIT_CH5_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH5_HIGH_TH) << BIT_SHIFT_CH5_HIGH_TH) -+#define BITS_CH5_HIGH_TH (BIT_MASK_CH5_HIGH_TH << BIT_SHIFT_CH5_HIGH_TH) -+#define BIT_CLEAR_CH5_HIGH_TH(x) ((x) & (~BITS_CH5_HIGH_TH)) -+#define BIT_GET_CH5_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH5_HIGH_TH) & BIT_MASK_CH5_HIGH_TH) -+#define BIT_SET_CH5_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH5_HIGH_TH(x) | BIT_CH5_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH5_LOW_TH 0 -+#define BIT_MASK_CH5_LOW_TH 0xfff -+#define BIT_CH5_LOW_TH(x) (((x) & BIT_MASK_CH5_LOW_TH) << BIT_SHIFT_CH5_LOW_TH) -+#define BITS_CH5_LOW_TH (BIT_MASK_CH5_LOW_TH << BIT_SHIFT_CH5_LOW_TH) -+#define BIT_CLEAR_CH5_LOW_TH(x) ((x) & (~BITS_CH5_LOW_TH)) -+#define BIT_GET_CH5_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH5_LOW_TH) & BIT_MASK_CH5_LOW_TH) -+#define BIT_SET_CH5_LOW_TH(x, v) (BIT_CLEAR_CH5_LOW_TH(x) | BIT_CH5_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_6 (Offset 0x3218) */ -+ -+#define BIT_CH6_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH6_HIGH_TH 16 -+#define BIT_MASK_CH6_HIGH_TH 0xfff -+#define BIT_CH6_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH6_HIGH_TH) << BIT_SHIFT_CH6_HIGH_TH) -+#define BITS_CH6_HIGH_TH (BIT_MASK_CH6_HIGH_TH << BIT_SHIFT_CH6_HIGH_TH) -+#define BIT_CLEAR_CH6_HIGH_TH(x) ((x) & (~BITS_CH6_HIGH_TH)) -+#define BIT_GET_CH6_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH6_HIGH_TH) & BIT_MASK_CH6_HIGH_TH) -+#define BIT_SET_CH6_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH6_HIGH_TH(x) | BIT_CH6_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH6_LOW_TH 0 -+#define BIT_MASK_CH6_LOW_TH 0xfff -+#define BIT_CH6_LOW_TH(x) (((x) & BIT_MASK_CH6_LOW_TH) << BIT_SHIFT_CH6_LOW_TH) -+#define BITS_CH6_LOW_TH (BIT_MASK_CH6_LOW_TH << BIT_SHIFT_CH6_LOW_TH) -+#define BIT_CLEAR_CH6_LOW_TH(x) ((x) & (~BITS_CH6_LOW_TH)) -+#define BIT_GET_CH6_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH6_LOW_TH) & BIT_MASK_CH6_LOW_TH) -+#define BIT_SET_CH6_LOW_TH(x, v) (BIT_CLEAR_CH6_LOW_TH(x) | BIT_CH6_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_7 (Offset 0x321C) */ -+ -+#define BIT_CH7_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH7_HIGH_TH 16 -+#define BIT_MASK_CH7_HIGH_TH 0xfff -+#define BIT_CH7_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH7_HIGH_TH) << BIT_SHIFT_CH7_HIGH_TH) -+#define BITS_CH7_HIGH_TH (BIT_MASK_CH7_HIGH_TH << BIT_SHIFT_CH7_HIGH_TH) -+#define BIT_CLEAR_CH7_HIGH_TH(x) ((x) & (~BITS_CH7_HIGH_TH)) -+#define BIT_GET_CH7_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH7_HIGH_TH) & BIT_MASK_CH7_HIGH_TH) -+#define BIT_SET_CH7_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH7_HIGH_TH(x) | BIT_CH7_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH7_LOW_TH 0 -+#define BIT_MASK_CH7_LOW_TH 0xfff -+#define BIT_CH7_LOW_TH(x) (((x) & BIT_MASK_CH7_LOW_TH) << BIT_SHIFT_CH7_LOW_TH) -+#define BITS_CH7_LOW_TH (BIT_MASK_CH7_LOW_TH << BIT_SHIFT_CH7_LOW_TH) -+#define BIT_CLEAR_CH7_LOW_TH(x) ((x) & (~BITS_CH7_LOW_TH)) -+#define BIT_GET_CH7_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH7_LOW_TH) & BIT_MASK_CH7_LOW_TH) -+#define BIT_SET_CH7_LOW_TH(x, v) (BIT_CLEAR_CH7_LOW_TH(x) | BIT_CH7_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_8 (Offset 0x3220) */ -+ -+#define BIT_CH8_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH8_HIGH_TH 16 -+#define BIT_MASK_CH8_HIGH_TH 0xfff -+#define BIT_CH8_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH8_HIGH_TH) << BIT_SHIFT_CH8_HIGH_TH) -+#define BITS_CH8_HIGH_TH (BIT_MASK_CH8_HIGH_TH << BIT_SHIFT_CH8_HIGH_TH) -+#define BIT_CLEAR_CH8_HIGH_TH(x) ((x) & (~BITS_CH8_HIGH_TH)) -+#define BIT_GET_CH8_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH8_HIGH_TH) & BIT_MASK_CH8_HIGH_TH) -+#define BIT_SET_CH8_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH8_HIGH_TH(x) | BIT_CH8_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH8_LOW_TH 0 -+#define BIT_MASK_CH8_LOW_TH 0xfff -+#define BIT_CH8_LOW_TH(x) (((x) & BIT_MASK_CH8_LOW_TH) << BIT_SHIFT_CH8_LOW_TH) -+#define BITS_CH8_LOW_TH (BIT_MASK_CH8_LOW_TH << BIT_SHIFT_CH8_LOW_TH) -+#define BIT_CLEAR_CH8_LOW_TH(x) ((x) & (~BITS_CH8_LOW_TH)) -+#define BIT_GET_CH8_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH8_LOW_TH) & BIT_MASK_CH8_LOW_TH) -+#define BIT_SET_CH8_LOW_TH(x, v) (BIT_CLEAR_CH8_LOW_TH(x) | BIT_CH8_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_9 (Offset 0x3224) */ -+ -+#define BIT_CH9_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH9_HIGH_TH 16 -+#define BIT_MASK_CH9_HIGH_TH 0xfff -+#define BIT_CH9_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH9_HIGH_TH) << BIT_SHIFT_CH9_HIGH_TH) -+#define BITS_CH9_HIGH_TH (BIT_MASK_CH9_HIGH_TH << BIT_SHIFT_CH9_HIGH_TH) -+#define BIT_CLEAR_CH9_HIGH_TH(x) ((x) & (~BITS_CH9_HIGH_TH)) -+#define BIT_GET_CH9_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH9_HIGH_TH) & BIT_MASK_CH9_HIGH_TH) -+#define BIT_SET_CH9_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH9_HIGH_TH(x) | BIT_CH9_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH9_LOW_TH 0 -+#define BIT_MASK_CH9_LOW_TH 0xfff -+#define BIT_CH9_LOW_TH(x) (((x) & BIT_MASK_CH9_LOW_TH) << BIT_SHIFT_CH9_LOW_TH) -+#define BITS_CH9_LOW_TH (BIT_MASK_CH9_LOW_TH << BIT_SHIFT_CH9_LOW_TH) -+#define BIT_CLEAR_CH9_LOW_TH(x) ((x) & (~BITS_CH9_LOW_TH)) -+#define BIT_GET_CH9_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH9_LOW_TH) & BIT_MASK_CH9_LOW_TH) -+#define BIT_SET_CH9_LOW_TH(x, v) (BIT_CLEAR_CH9_LOW_TH(x) | BIT_CH9_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_10 (Offset 0x3228) */ -+ -+#define BIT_CH10_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH10_HIGH_TH 16 -+#define BIT_MASK_CH10_HIGH_TH 0xfff -+#define BIT_CH10_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH10_HIGH_TH) << BIT_SHIFT_CH10_HIGH_TH) -+#define BITS_CH10_HIGH_TH (BIT_MASK_CH10_HIGH_TH << BIT_SHIFT_CH10_HIGH_TH) -+#define BIT_CLEAR_CH10_HIGH_TH(x) ((x) & (~BITS_CH10_HIGH_TH)) -+#define BIT_GET_CH10_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH10_HIGH_TH) & BIT_MASK_CH10_HIGH_TH) -+#define BIT_SET_CH10_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH10_HIGH_TH(x) | BIT_CH10_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH10_LOW_TH 0 -+#define BIT_MASK_CH10_LOW_TH 0xfff -+#define BIT_CH10_LOW_TH(x) \ -+ (((x) & BIT_MASK_CH10_LOW_TH) << BIT_SHIFT_CH10_LOW_TH) -+#define BITS_CH10_LOW_TH (BIT_MASK_CH10_LOW_TH << BIT_SHIFT_CH10_LOW_TH) -+#define BIT_CLEAR_CH10_LOW_TH(x) ((x) & (~BITS_CH10_LOW_TH)) -+#define BIT_GET_CH10_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH10_LOW_TH) & BIT_MASK_CH10_LOW_TH) -+#define BIT_SET_CH10_LOW_TH(x, v) \ -+ (BIT_CLEAR_CH10_LOW_TH(x) | BIT_CH10_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_11 (Offset 0x322C) */ -+ -+#define BIT_CH11_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH11_HIGH_TH 16 -+#define BIT_MASK_CH11_HIGH_TH 0xfff -+#define BIT_CH11_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH11_HIGH_TH) << BIT_SHIFT_CH11_HIGH_TH) -+#define BITS_CH11_HIGH_TH (BIT_MASK_CH11_HIGH_TH << BIT_SHIFT_CH11_HIGH_TH) -+#define BIT_CLEAR_CH11_HIGH_TH(x) ((x) & (~BITS_CH11_HIGH_TH)) -+#define BIT_GET_CH11_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH11_HIGH_TH) & BIT_MASK_CH11_HIGH_TH) -+#define BIT_SET_CH11_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH11_HIGH_TH(x) | BIT_CH11_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH11_LOW_TH 0 -+#define BIT_MASK_CH11_LOW_TH 0xfff -+#define BIT_CH11_LOW_TH(x) \ -+ (((x) & BIT_MASK_CH11_LOW_TH) << BIT_SHIFT_CH11_LOW_TH) -+#define BITS_CH11_LOW_TH (BIT_MASK_CH11_LOW_TH << BIT_SHIFT_CH11_LOW_TH) -+#define BIT_CLEAR_CH11_LOW_TH(x) ((x) & (~BITS_CH11_LOW_TH)) -+#define BIT_GET_CH11_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH11_LOW_TH) & BIT_MASK_CH11_LOW_TH) -+#define BIT_SET_CH11_LOW_TH(x, v) \ -+ (BIT_CLEAR_CH11_LOW_TH(x) | BIT_CH11_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_12 (Offset 0x3230) */ -+ -+#define BIT_CH12_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH12_HIGH_TH 16 -+#define BIT_MASK_CH12_HIGH_TH 0xfff -+#define BIT_CH12_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH12_HIGH_TH) << BIT_SHIFT_CH12_HIGH_TH) -+#define BITS_CH12_HIGH_TH (BIT_MASK_CH12_HIGH_TH << BIT_SHIFT_CH12_HIGH_TH) -+#define BIT_CLEAR_CH12_HIGH_TH(x) ((x) & (~BITS_CH12_HIGH_TH)) -+#define BIT_GET_CH12_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH12_HIGH_TH) & BIT_MASK_CH12_HIGH_TH) -+#define BIT_SET_CH12_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH12_HIGH_TH(x) | BIT_CH12_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH12_LOW_TH 0 -+#define BIT_MASK_CH12_LOW_TH 0xfff -+#define BIT_CH12_LOW_TH(x) \ -+ (((x) & BIT_MASK_CH12_LOW_TH) << BIT_SHIFT_CH12_LOW_TH) -+#define BITS_CH12_LOW_TH (BIT_MASK_CH12_LOW_TH << BIT_SHIFT_CH12_LOW_TH) -+#define BIT_CLEAR_CH12_LOW_TH(x) ((x) & (~BITS_CH12_LOW_TH)) -+#define BIT_GET_CH12_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH12_LOW_TH) & BIT_MASK_CH12_LOW_TH) -+#define BIT_SET_CH12_LOW_TH(x, v) \ -+ (BIT_CLEAR_CH12_LOW_TH(x) | BIT_CH12_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_13 (Offset 0x3234) */ -+ -+#define BIT_CH13_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH13_HIGH_TH 16 -+#define BIT_MASK_CH13_HIGH_TH 0xfff -+#define BIT_CH13_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH13_HIGH_TH) << BIT_SHIFT_CH13_HIGH_TH) -+#define BITS_CH13_HIGH_TH (BIT_MASK_CH13_HIGH_TH << BIT_SHIFT_CH13_HIGH_TH) -+#define BIT_CLEAR_CH13_HIGH_TH(x) ((x) & (~BITS_CH13_HIGH_TH)) -+#define BIT_GET_CH13_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH13_HIGH_TH) & BIT_MASK_CH13_HIGH_TH) -+#define BIT_SET_CH13_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH13_HIGH_TH(x) | BIT_CH13_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH13_LOW_TH 0 -+#define BIT_MASK_CH13_LOW_TH 0xfff -+#define BIT_CH13_LOW_TH(x) \ -+ (((x) & BIT_MASK_CH13_LOW_TH) << BIT_SHIFT_CH13_LOW_TH) -+#define BITS_CH13_LOW_TH (BIT_MASK_CH13_LOW_TH << BIT_SHIFT_CH13_LOW_TH) -+#define BIT_CLEAR_CH13_LOW_TH(x) ((x) & (~BITS_CH13_LOW_TH)) -+#define BIT_GET_CH13_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH13_LOW_TH) & BIT_MASK_CH13_LOW_TH) -+#define BIT_SET_CH13_LOW_TH(x, v) \ -+ (BIT_CLEAR_CH13_LOW_TH(x) | BIT_CH13_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_14 (Offset 0x3238) */ -+ -+#define BIT_CH14_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH14_HIGH_TH 16 -+#define BIT_MASK_CH14_HIGH_TH 0xfff -+#define BIT_CH14_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH14_HIGH_TH) << BIT_SHIFT_CH14_HIGH_TH) -+#define BITS_CH14_HIGH_TH (BIT_MASK_CH14_HIGH_TH << BIT_SHIFT_CH14_HIGH_TH) -+#define BIT_CLEAR_CH14_HIGH_TH(x) ((x) & (~BITS_CH14_HIGH_TH)) -+#define BIT_GET_CH14_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH14_HIGH_TH) & BIT_MASK_CH14_HIGH_TH) -+#define BIT_SET_CH14_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH14_HIGH_TH(x) | BIT_CH14_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH14_LOW_TH 0 -+#define BIT_MASK_CH14_LOW_TH 0xfff -+#define BIT_CH14_LOW_TH(x) \ -+ (((x) & BIT_MASK_CH14_LOW_TH) << BIT_SHIFT_CH14_LOW_TH) -+#define BITS_CH14_LOW_TH (BIT_MASK_CH14_LOW_TH << BIT_SHIFT_CH14_LOW_TH) -+#define BIT_CLEAR_CH14_LOW_TH(x) ((x) & (~BITS_CH14_LOW_TH)) -+#define BIT_GET_CH14_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH14_LOW_TH) & BIT_MASK_CH14_LOW_TH) -+#define BIT_SET_CH14_LOW_TH(x, v) \ -+ (BIT_CLEAR_CH14_LOW_TH(x) | BIT_CH14_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_15 (Offset 0x323C) */ -+ -+#define BIT_CH15_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH15_HIGH_TH 16 -+#define BIT_MASK_CH15_HIGH_TH 0xfff -+#define BIT_CH15_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH15_HIGH_TH) << BIT_SHIFT_CH15_HIGH_TH) -+#define BITS_CH15_HIGH_TH (BIT_MASK_CH15_HIGH_TH << BIT_SHIFT_CH15_HIGH_TH) -+#define BIT_CLEAR_CH15_HIGH_TH(x) ((x) & (~BITS_CH15_HIGH_TH)) -+#define BIT_GET_CH15_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH15_HIGH_TH) & BIT_MASK_CH15_HIGH_TH) -+#define BIT_SET_CH15_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH15_HIGH_TH(x) | BIT_CH15_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH15_LOW_TH 0 -+#define BIT_MASK_CH15_LOW_TH 0xfff -+#define BIT_CH15_LOW_TH(x) \ -+ (((x) & BIT_MASK_CH15_LOW_TH) << BIT_SHIFT_CH15_LOW_TH) -+#define BITS_CH15_LOW_TH (BIT_MASK_CH15_LOW_TH << BIT_SHIFT_CH15_LOW_TH) -+#define BIT_CLEAR_CH15_LOW_TH(x) ((x) & (~BITS_CH15_LOW_TH)) -+#define BIT_GET_CH15_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH15_LOW_TH) & BIT_MASK_CH15_LOW_TH) -+#define BIT_SET_CH15_LOW_TH(x, v) \ -+ (BIT_CLEAR_CH15_LOW_TH(x) | BIT_CH15_LOW_TH(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_16 (Offset 0x3240) */ -+ -+#define BIT_CH16_INT_EN BIT(31) -+ -+#define BIT_SHIFT_CH16_HIGH_TH 16 -+#define BIT_MASK_CH16_HIGH_TH 0xfff -+#define BIT_CH16_HIGH_TH(x) \ -+ (((x) & BIT_MASK_CH16_HIGH_TH) << BIT_SHIFT_CH16_HIGH_TH) -+#define BITS_CH16_HIGH_TH (BIT_MASK_CH16_HIGH_TH << BIT_SHIFT_CH16_HIGH_TH) -+#define BIT_CLEAR_CH16_HIGH_TH(x) ((x) & (~BITS_CH16_HIGH_TH)) -+#define BIT_GET_CH16_HIGH_TH(x) \ -+ (((x) >> BIT_SHIFT_CH16_HIGH_TH) & BIT_MASK_CH16_HIGH_TH) -+#define BIT_SET_CH16_HIGH_TH(x, v) \ -+ (BIT_CLEAR_CH16_HIGH_TH(x) | BIT_CH16_HIGH_TH(v)) -+ -+#define BIT_SHIFT_CH16_LOW_TH 0 -+#define BIT_MASK_CH16_LOW_TH 0xfff -+#define BIT_CH16_LOW_TH(x) \ -+ (((x) & BIT_MASK_CH16_LOW_TH) << BIT_SHIFT_CH16_LOW_TH) -+#define BITS_CH16_LOW_TH (BIT_MASK_CH16_LOW_TH << BIT_SHIFT_CH16_LOW_TH) -+#define BIT_CLEAR_CH16_LOW_TH(x) ((x) & (~BITS_CH16_LOW_TH)) -+#define BIT_GET_CH16_LOW_TH(x) \ -+ (((x) >> BIT_SHIFT_CH16_LOW_TH) & BIT_MASK_CH16_LOW_TH) -+#define BIT_SET_CH16_LOW_TH(x, v) \ -+ (BIT_CLEAR_CH16_LOW_TH(x) | BIT_CH16_LOW_TH(v)) -+ -+/* 2 REG_ACH4_TXBD_IDX (Offset 0x3340) */ -+ -+#define BIT_SHIFT_ACH4_HW_IDX 16 -+#define BIT_MASK_ACH4_HW_IDX 0xfff -+#define BIT_ACH4_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH4_HW_IDX) << BIT_SHIFT_ACH4_HW_IDX) -+#define BITS_ACH4_HW_IDX (BIT_MASK_ACH4_HW_IDX << BIT_SHIFT_ACH4_HW_IDX) -+#define BIT_CLEAR_ACH4_HW_IDX(x) ((x) & (~BITS_ACH4_HW_IDX)) -+#define BIT_GET_ACH4_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH4_HW_IDX) & BIT_MASK_ACH4_HW_IDX) -+#define BIT_SET_ACH4_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH4_HW_IDX(x) | BIT_ACH4_HW_IDX(v)) -+ -+#define BIT_SHIFT_ACH4_HOST_IDX 0 -+#define BIT_MASK_ACH4_HOST_IDX 0xfff -+#define BIT_ACH4_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH4_HOST_IDX) << BIT_SHIFT_ACH4_HOST_IDX) -+#define BITS_ACH4_HOST_IDX (BIT_MASK_ACH4_HOST_IDX << BIT_SHIFT_ACH4_HOST_IDX) -+#define BIT_CLEAR_ACH4_HOST_IDX(x) ((x) & (~BITS_ACH4_HOST_IDX)) -+#define BIT_GET_ACH4_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH4_HOST_IDX) & BIT_MASK_ACH4_HOST_IDX) -+#define BIT_SET_ACH4_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH4_HOST_IDX(x) | BIT_ACH4_HOST_IDX(v)) -+ -+/* 2 REG_ACH5_TXBD_IDX (Offset 0x3344) */ -+ -+#define BIT_SHIFT_ACH5_HW_IDX 16 -+#define BIT_MASK_ACH5_HW_IDX 0xfff -+#define BIT_ACH5_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH5_HW_IDX) << BIT_SHIFT_ACH5_HW_IDX) -+#define BITS_ACH5_HW_IDX (BIT_MASK_ACH5_HW_IDX << BIT_SHIFT_ACH5_HW_IDX) -+#define BIT_CLEAR_ACH5_HW_IDX(x) ((x) & (~BITS_ACH5_HW_IDX)) -+#define BIT_GET_ACH5_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH5_HW_IDX) & BIT_MASK_ACH5_HW_IDX) -+#define BIT_SET_ACH5_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH5_HW_IDX(x) | BIT_ACH5_HW_IDX(v)) -+ -+#define BIT_SHIFT_ACH5_HOST_IDX 0 -+#define BIT_MASK_ACH5_HOST_IDX 0xfff -+#define BIT_ACH5_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH5_HOST_IDX) << BIT_SHIFT_ACH5_HOST_IDX) -+#define BITS_ACH5_HOST_IDX (BIT_MASK_ACH5_HOST_IDX << BIT_SHIFT_ACH5_HOST_IDX) -+#define BIT_CLEAR_ACH5_HOST_IDX(x) ((x) & (~BITS_ACH5_HOST_IDX)) -+#define BIT_GET_ACH5_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH5_HOST_IDX) & BIT_MASK_ACH5_HOST_IDX) -+#define BIT_SET_ACH5_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH5_HOST_IDX(x) | BIT_ACH5_HOST_IDX(v)) -+ -+/* 2 REG_ACH6_TXBD_IDX (Offset 0x3348) */ -+ -+#define BIT_SHIFT_ACH6_HW_IDX 16 -+#define BIT_MASK_ACH6_HW_IDX 0xfff -+#define BIT_ACH6_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH6_HW_IDX) << BIT_SHIFT_ACH6_HW_IDX) -+#define BITS_ACH6_HW_IDX (BIT_MASK_ACH6_HW_IDX << BIT_SHIFT_ACH6_HW_IDX) -+#define BIT_CLEAR_ACH6_HW_IDX(x) ((x) & (~BITS_ACH6_HW_IDX)) -+#define BIT_GET_ACH6_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH6_HW_IDX) & BIT_MASK_ACH6_HW_IDX) -+#define BIT_SET_ACH6_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH6_HW_IDX(x) | BIT_ACH6_HW_IDX(v)) -+ -+#define BIT_SHIFT_ACH6_HOST_IDX 0 -+#define BIT_MASK_ACH6_HOST_IDX 0xfff -+#define BIT_ACH6_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH6_HOST_IDX) << BIT_SHIFT_ACH6_HOST_IDX) -+#define BITS_ACH6_HOST_IDX (BIT_MASK_ACH6_HOST_IDX << BIT_SHIFT_ACH6_HOST_IDX) -+#define BIT_CLEAR_ACH6_HOST_IDX(x) ((x) & (~BITS_ACH6_HOST_IDX)) -+#define BIT_GET_ACH6_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH6_HOST_IDX) & BIT_MASK_ACH6_HOST_IDX) -+#define BIT_SET_ACH6_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH6_HOST_IDX(x) | BIT_ACH6_HOST_IDX(v)) -+ -+/* 2 REG_ACH7_TXBD_IDX (Offset 0x334C) */ -+ -+#define BIT_SHIFT_ACH7_HW_IDX 16 -+#define BIT_MASK_ACH7_HW_IDX 0xfff -+#define BIT_ACH7_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH7_HW_IDX) << BIT_SHIFT_ACH7_HW_IDX) -+#define BITS_ACH7_HW_IDX (BIT_MASK_ACH7_HW_IDX << BIT_SHIFT_ACH7_HW_IDX) -+#define BIT_CLEAR_ACH7_HW_IDX(x) ((x) & (~BITS_ACH7_HW_IDX)) -+#define BIT_GET_ACH7_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH7_HW_IDX) & BIT_MASK_ACH7_HW_IDX) -+#define BIT_SET_ACH7_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH7_HW_IDX(x) | BIT_ACH7_HW_IDX(v)) -+ -+#define BIT_SHIFT_ACH7_HOST_IDX 0 -+#define BIT_MASK_ACH7_HOST_IDX 0xfff -+#define BIT_ACH7_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH7_HOST_IDX) << BIT_SHIFT_ACH7_HOST_IDX) -+#define BITS_ACH7_HOST_IDX (BIT_MASK_ACH7_HOST_IDX << BIT_SHIFT_ACH7_HOST_IDX) -+#define BIT_CLEAR_ACH7_HOST_IDX(x) ((x) & (~BITS_ACH7_HOST_IDX)) -+#define BIT_GET_ACH7_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH7_HOST_IDX) & BIT_MASK_ACH7_HOST_IDX) -+#define BIT_SET_ACH7_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH7_HOST_IDX(x) | BIT_ACH7_HOST_IDX(v)) -+ -+/* 2 REG_ACH8_TXBD_IDX (Offset 0x3350) */ -+ -+#define BIT_SHIFT_ACH8_HW_IDX 16 -+#define BIT_MASK_ACH8_HW_IDX 0xfff -+#define BIT_ACH8_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH8_HW_IDX) << BIT_SHIFT_ACH8_HW_IDX) -+#define BITS_ACH8_HW_IDX (BIT_MASK_ACH8_HW_IDX << BIT_SHIFT_ACH8_HW_IDX) -+#define BIT_CLEAR_ACH8_HW_IDX(x) ((x) & (~BITS_ACH8_HW_IDX)) -+#define BIT_GET_ACH8_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH8_HW_IDX) & BIT_MASK_ACH8_HW_IDX) -+#define BIT_SET_ACH8_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH8_HW_IDX(x) | BIT_ACH8_HW_IDX(v)) -+ -+#define BIT_SHIFT_ACH8_HOST_IDX 0 -+#define BIT_MASK_ACH8_HOST_IDX 0xfff -+#define BIT_ACH8_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH8_HOST_IDX) << BIT_SHIFT_ACH8_HOST_IDX) -+#define BITS_ACH8_HOST_IDX (BIT_MASK_ACH8_HOST_IDX << BIT_SHIFT_ACH8_HOST_IDX) -+#define BIT_CLEAR_ACH8_HOST_IDX(x) ((x) & (~BITS_ACH8_HOST_IDX)) -+#define BIT_GET_ACH8_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH8_HOST_IDX) & BIT_MASK_ACH8_HOST_IDX) -+#define BIT_SET_ACH8_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH8_HOST_IDX(x) | BIT_ACH8_HOST_IDX(v)) -+ -+/* 2 REG_ACH9_TXBD_IDX (Offset 0x3354) */ -+ -+#define BIT_SHIFT_ACH9_HW_IDX 16 -+#define BIT_MASK_ACH9_HW_IDX 0xfff -+#define BIT_ACH9_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH9_HW_IDX) << BIT_SHIFT_ACH9_HW_IDX) -+#define BITS_ACH9_HW_IDX (BIT_MASK_ACH9_HW_IDX << BIT_SHIFT_ACH9_HW_IDX) -+#define BIT_CLEAR_ACH9_HW_IDX(x) ((x) & (~BITS_ACH9_HW_IDX)) -+#define BIT_GET_ACH9_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH9_HW_IDX) & BIT_MASK_ACH9_HW_IDX) -+#define BIT_SET_ACH9_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH9_HW_IDX(x) | BIT_ACH9_HW_IDX(v)) -+ -+#define BIT_SHIFT_ACH9_HOST_IDX 0 -+#define BIT_MASK_ACH9_HOST_IDX 0xfff -+#define BIT_ACH9_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH9_HOST_IDX) << BIT_SHIFT_ACH9_HOST_IDX) -+#define BITS_ACH9_HOST_IDX (BIT_MASK_ACH9_HOST_IDX << BIT_SHIFT_ACH9_HOST_IDX) -+#define BIT_CLEAR_ACH9_HOST_IDX(x) ((x) & (~BITS_ACH9_HOST_IDX)) -+#define BIT_GET_ACH9_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH9_HOST_IDX) & BIT_MASK_ACH9_HOST_IDX) -+#define BIT_SET_ACH9_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH9_HOST_IDX(x) | BIT_ACH9_HOST_IDX(v)) -+ -+/* 2 REG_ACH10_TXBD_IDX (Offset 0x3358) */ -+ -+#define BIT_SHIFT_ACH10_HW_IDX 16 -+#define BIT_MASK_ACH10_HW_IDX 0xfff -+#define BIT_ACH10_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH10_HW_IDX) << BIT_SHIFT_ACH10_HW_IDX) -+#define BITS_ACH10_HW_IDX (BIT_MASK_ACH10_HW_IDX << BIT_SHIFT_ACH10_HW_IDX) -+#define BIT_CLEAR_ACH10_HW_IDX(x) ((x) & (~BITS_ACH10_HW_IDX)) -+#define BIT_GET_ACH10_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH10_HW_IDX) & BIT_MASK_ACH10_HW_IDX) -+#define BIT_SET_ACH10_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH10_HW_IDX(x) | BIT_ACH10_HW_IDX(v)) -+ -+#define BIT_SHIFT_ACH10_HOST_IDX 0 -+#define BIT_MASK_ACH10_HOST_IDX 0xfff -+#define BIT_ACH10_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH10_HOST_IDX) << BIT_SHIFT_ACH10_HOST_IDX) -+#define BITS_ACH10_HOST_IDX \ -+ (BIT_MASK_ACH10_HOST_IDX << BIT_SHIFT_ACH10_HOST_IDX) -+#define BIT_CLEAR_ACH10_HOST_IDX(x) ((x) & (~BITS_ACH10_HOST_IDX)) -+#define BIT_GET_ACH10_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH10_HOST_IDX) & BIT_MASK_ACH10_HOST_IDX) -+#define BIT_SET_ACH10_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH10_HOST_IDX(x) | BIT_ACH10_HOST_IDX(v)) -+ -+/* 2 REG_ACH11_TXBD_IDX (Offset 0x335C) */ -+ -+#define BIT_SHIFT_ACH11_HW_IDX 16 -+#define BIT_MASK_ACH11_HW_IDX 0xfff -+#define BIT_ACH11_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH11_HW_IDX) << BIT_SHIFT_ACH11_HW_IDX) -+#define BITS_ACH11_HW_IDX (BIT_MASK_ACH11_HW_IDX << BIT_SHIFT_ACH11_HW_IDX) -+#define BIT_CLEAR_ACH11_HW_IDX(x) ((x) & (~BITS_ACH11_HW_IDX)) -+#define BIT_GET_ACH11_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH11_HW_IDX) & BIT_MASK_ACH11_HW_IDX) -+#define BIT_SET_ACH11_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH11_HW_IDX(x) | BIT_ACH11_HW_IDX(v)) -+ -+#define BIT_SHIFT_ACH11_HOST_IDX 0 -+#define BIT_MASK_ACH11_HOST_IDX 0xfff -+#define BIT_ACH11_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH11_HOST_IDX) << BIT_SHIFT_ACH11_HOST_IDX) -+#define BITS_ACH11_HOST_IDX \ -+ (BIT_MASK_ACH11_HOST_IDX << BIT_SHIFT_ACH11_HOST_IDX) -+#define BIT_CLEAR_ACH11_HOST_IDX(x) ((x) & (~BITS_ACH11_HOST_IDX)) -+#define BIT_GET_ACH11_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH11_HOST_IDX) & BIT_MASK_ACH11_HOST_IDX) -+#define BIT_SET_ACH11_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH11_HOST_IDX(x) | BIT_ACH11_HOST_IDX(v)) -+ -+/* 2 REG_ACH12_TXBD_IDX (Offset 0x3360) */ -+ -+#define BIT_SHIFT_ACH12_HW_IDX 16 -+#define BIT_MASK_ACH12_HW_IDX 0xfff -+#define BIT_ACH12_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH12_HW_IDX) << BIT_SHIFT_ACH12_HW_IDX) -+#define BITS_ACH12_HW_IDX (BIT_MASK_ACH12_HW_IDX << BIT_SHIFT_ACH12_HW_IDX) -+#define BIT_CLEAR_ACH12_HW_IDX(x) ((x) & (~BITS_ACH12_HW_IDX)) -+#define BIT_GET_ACH12_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH12_HW_IDX) & BIT_MASK_ACH12_HW_IDX) -+#define BIT_SET_ACH12_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH12_HW_IDX(x) | BIT_ACH12_HW_IDX(v)) -+ -+#define BIT_SHIFT_ACH12_HOST_IDX 0 -+#define BIT_MASK_ACH12_HOST_IDX 0xfff -+#define BIT_ACH12_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH12_HOST_IDX) << BIT_SHIFT_ACH12_HOST_IDX) -+#define BITS_ACH12_HOST_IDX \ -+ (BIT_MASK_ACH12_HOST_IDX << BIT_SHIFT_ACH12_HOST_IDX) -+#define BIT_CLEAR_ACH12_HOST_IDX(x) ((x) & (~BITS_ACH12_HOST_IDX)) -+#define BIT_GET_ACH12_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH12_HOST_IDX) & BIT_MASK_ACH12_HOST_IDX) -+#define BIT_SET_ACH12_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH12_HOST_IDX(x) | BIT_ACH12_HOST_IDX(v)) -+ -+/* 2 REG_ACH13_TXBD_IDX (Offset 0x3364) */ -+ -+#define BIT_SHIFT_ACH13_HW_IDX 16 -+#define BIT_MASK_ACH13_HW_IDX 0xfff -+#define BIT_ACH13_HW_IDX(x) \ -+ (((x) & BIT_MASK_ACH13_HW_IDX) << BIT_SHIFT_ACH13_HW_IDX) -+#define BITS_ACH13_HW_IDX (BIT_MASK_ACH13_HW_IDX << BIT_SHIFT_ACH13_HW_IDX) -+#define BIT_CLEAR_ACH13_HW_IDX(x) ((x) & (~BITS_ACH13_HW_IDX)) -+#define BIT_GET_ACH13_HW_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH13_HW_IDX) & BIT_MASK_ACH13_HW_IDX) -+#define BIT_SET_ACH13_HW_IDX(x, v) \ -+ (BIT_CLEAR_ACH13_HW_IDX(x) | BIT_ACH13_HW_IDX(v)) -+ -+#define BIT_SHIFT_ACH13_HOST_IDX 0 -+#define BIT_MASK_ACH13_HOST_IDX 0xfff -+#define BIT_ACH13_HOST_IDX(x) \ -+ (((x) & BIT_MASK_ACH13_HOST_IDX) << BIT_SHIFT_ACH13_HOST_IDX) -+#define BITS_ACH13_HOST_IDX \ -+ (BIT_MASK_ACH13_HOST_IDX << BIT_SHIFT_ACH13_HOST_IDX) -+#define BIT_CLEAR_ACH13_HOST_IDX(x) ((x) & (~BITS_ACH13_HOST_IDX)) -+#define BIT_GET_ACH13_HOST_IDX(x) \ -+ (((x) >> BIT_SHIFT_ACH13_HOST_IDX) & BIT_MASK_ACH13_HOST_IDX) -+#define BIT_SET_ACH13_HOST_IDX(x, v) \ -+ (BIT_CLEAR_ACH13_HOST_IDX(x) | BIT_ACH13_HOST_IDX(v)) -+ -+/* 2 REG_AC_CHANNEL0_WEIGHT (Offset 0x3368) */ -+ -+#define BIT_SHIFT_AC_CHANNEL0_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL0_WEIGHT 0xff -+#define BIT_AC_CHANNEL0_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL0_WEIGHT) << BIT_SHIFT_AC_CHANNEL0_WEIGHT) -+#define BITS_AC_CHANNEL0_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL0_WEIGHT << BIT_SHIFT_AC_CHANNEL0_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL0_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL0_WEIGHT)) -+#define BIT_GET_AC_CHANNEL0_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL0_WEIGHT) & BIT_MASK_AC_CHANNEL0_WEIGHT) -+#define BIT_SET_AC_CHANNEL0_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL0_WEIGHT(x) | BIT_AC_CHANNEL0_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL1_WEIGHT (Offset 0x3369) */ -+ -+#define BIT_SHIFT_AC_CHANNEL1_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL1_WEIGHT 0xff -+#define BIT_AC_CHANNEL1_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL1_WEIGHT) << BIT_SHIFT_AC_CHANNEL1_WEIGHT) -+#define BITS_AC_CHANNEL1_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL1_WEIGHT << BIT_SHIFT_AC_CHANNEL1_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL1_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL1_WEIGHT)) -+#define BIT_GET_AC_CHANNEL1_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL1_WEIGHT) & BIT_MASK_AC_CHANNEL1_WEIGHT) -+#define BIT_SET_AC_CHANNEL1_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL1_WEIGHT(x) | BIT_AC_CHANNEL1_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL2_WEIGHT (Offset 0x336A) */ -+ -+#define BIT_SHIFT_AC_CHANNEL2_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL2_WEIGHT 0xff -+#define BIT_AC_CHANNEL2_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL2_WEIGHT) << BIT_SHIFT_AC_CHANNEL2_WEIGHT) -+#define BITS_AC_CHANNEL2_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL2_WEIGHT << BIT_SHIFT_AC_CHANNEL2_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL2_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL2_WEIGHT)) -+#define BIT_GET_AC_CHANNEL2_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL2_WEIGHT) & BIT_MASK_AC_CHANNEL2_WEIGHT) -+#define BIT_SET_AC_CHANNEL2_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL2_WEIGHT(x) | BIT_AC_CHANNEL2_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL3_WEIGHT (Offset 0x336B) */ -+ -+#define BIT_SHIFT_AC_CHANNEL3_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL3_WEIGHT 0xff -+#define BIT_AC_CHANNEL3_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL3_WEIGHT) << BIT_SHIFT_AC_CHANNEL3_WEIGHT) -+#define BITS_AC_CHANNEL3_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL3_WEIGHT << BIT_SHIFT_AC_CHANNEL3_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL3_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL3_WEIGHT)) -+#define BIT_GET_AC_CHANNEL3_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL3_WEIGHT) & BIT_MASK_AC_CHANNEL3_WEIGHT) -+#define BIT_SET_AC_CHANNEL3_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL3_WEIGHT(x) | BIT_AC_CHANNEL3_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL4_WEIGHT (Offset 0x336C) */ -+ -+#define BIT_SHIFT_AC_CHANNEL4_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL4_WEIGHT 0xff -+#define BIT_AC_CHANNEL4_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL4_WEIGHT) << BIT_SHIFT_AC_CHANNEL4_WEIGHT) -+#define BITS_AC_CHANNEL4_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL4_WEIGHT << BIT_SHIFT_AC_CHANNEL4_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL4_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL4_WEIGHT)) -+#define BIT_GET_AC_CHANNEL4_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL4_WEIGHT) & BIT_MASK_AC_CHANNEL4_WEIGHT) -+#define BIT_SET_AC_CHANNEL4_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL4_WEIGHT(x) | BIT_AC_CHANNEL4_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL5_WEIGHT (Offset 0x336D) */ -+ -+#define BIT_SHIFT_AC_CHANNEL5_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL5_WEIGHT 0xff -+#define BIT_AC_CHANNEL5_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL5_WEIGHT) << BIT_SHIFT_AC_CHANNEL5_WEIGHT) -+#define BITS_AC_CHANNEL5_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL5_WEIGHT << BIT_SHIFT_AC_CHANNEL5_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL5_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL5_WEIGHT)) -+#define BIT_GET_AC_CHANNEL5_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL5_WEIGHT) & BIT_MASK_AC_CHANNEL5_WEIGHT) -+#define BIT_SET_AC_CHANNEL5_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL5_WEIGHT(x) | BIT_AC_CHANNEL5_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL6_WEIGHT (Offset 0x336E) */ -+ -+#define BIT_SHIFT_AC_CHANNEL6_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL6_WEIGHT 0xff -+#define BIT_AC_CHANNEL6_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL6_WEIGHT) << BIT_SHIFT_AC_CHANNEL6_WEIGHT) -+#define BITS_AC_CHANNEL6_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL6_WEIGHT << BIT_SHIFT_AC_CHANNEL6_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL6_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL6_WEIGHT)) -+#define BIT_GET_AC_CHANNEL6_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL6_WEIGHT) & BIT_MASK_AC_CHANNEL6_WEIGHT) -+#define BIT_SET_AC_CHANNEL6_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL6_WEIGHT(x) | BIT_AC_CHANNEL6_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL7_WEIGHT (Offset 0x336F) */ -+ -+#define BIT_SHIFT_AC_CHANNEL7_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL7_WEIGHT 0xff -+#define BIT_AC_CHANNEL7_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL7_WEIGHT) << BIT_SHIFT_AC_CHANNEL7_WEIGHT) -+#define BITS_AC_CHANNEL7_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL7_WEIGHT << BIT_SHIFT_AC_CHANNEL7_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL7_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL7_WEIGHT)) -+#define BIT_GET_AC_CHANNEL7_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL7_WEIGHT) & BIT_MASK_AC_CHANNEL7_WEIGHT) -+#define BIT_SET_AC_CHANNEL7_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL7_WEIGHT(x) | BIT_AC_CHANNEL7_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL8_WEIGHT (Offset 0x3370) */ -+ -+#define BIT_SHIFT_AC_CHANNEL8_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL8_WEIGHT 0xff -+#define BIT_AC_CHANNEL8_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL8_WEIGHT) << BIT_SHIFT_AC_CHANNEL8_WEIGHT) -+#define BITS_AC_CHANNEL8_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL8_WEIGHT << BIT_SHIFT_AC_CHANNEL8_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL8_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL8_WEIGHT)) -+#define BIT_GET_AC_CHANNEL8_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL8_WEIGHT) & BIT_MASK_AC_CHANNEL8_WEIGHT) -+#define BIT_SET_AC_CHANNEL8_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL8_WEIGHT(x) | BIT_AC_CHANNEL8_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL9_WEIGHT (Offset 0x3371) */ -+ -+#define BIT_SHIFT_AC_CHANNEL9_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL9_WEIGHT 0xff -+#define BIT_AC_CHANNEL9_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL9_WEIGHT) << BIT_SHIFT_AC_CHANNEL9_WEIGHT) -+#define BITS_AC_CHANNEL9_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL9_WEIGHT << BIT_SHIFT_AC_CHANNEL9_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL9_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL9_WEIGHT)) -+#define BIT_GET_AC_CHANNEL9_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL9_WEIGHT) & BIT_MASK_AC_CHANNEL9_WEIGHT) -+#define BIT_SET_AC_CHANNEL9_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL9_WEIGHT(x) | BIT_AC_CHANNEL9_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL10_WEIGHT (Offset 0x3372) */ -+ -+#define BIT_SHIFT_AC_CHANNEL10_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL10_WEIGHT 0xff -+#define BIT_AC_CHANNEL10_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL10_WEIGHT) << BIT_SHIFT_AC_CHANNEL10_WEIGHT) -+#define BITS_AC_CHANNEL10_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL10_WEIGHT << BIT_SHIFT_AC_CHANNEL10_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL10_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL10_WEIGHT)) -+#define BIT_GET_AC_CHANNEL10_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL10_WEIGHT) & BIT_MASK_AC_CHANNEL10_WEIGHT) -+#define BIT_SET_AC_CHANNEL10_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL10_WEIGHT(x) | BIT_AC_CHANNEL10_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL11_WEIGHT (Offset 0x3373) */ -+ -+#define BIT_SHIFT_AC_CHANNEL11_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL11_WEIGHT 0xff -+#define BIT_AC_CHANNEL11_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL11_WEIGHT) << BIT_SHIFT_AC_CHANNEL11_WEIGHT) -+#define BITS_AC_CHANNEL11_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL11_WEIGHT << BIT_SHIFT_AC_CHANNEL11_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL11_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL11_WEIGHT)) -+#define BIT_GET_AC_CHANNEL11_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL11_WEIGHT) & BIT_MASK_AC_CHANNEL11_WEIGHT) -+#define BIT_SET_AC_CHANNEL11_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL11_WEIGHT(x) | BIT_AC_CHANNEL11_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL12_WEIGHT (Offset 0x3374) */ -+ -+#define BIT_SHIFT_AC_CHANNEL12_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL12_WEIGHT 0xff -+#define BIT_AC_CHANNEL12_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL12_WEIGHT) << BIT_SHIFT_AC_CHANNEL12_WEIGHT) -+#define BITS_AC_CHANNEL12_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL12_WEIGHT << BIT_SHIFT_AC_CHANNEL12_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL12_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL12_WEIGHT)) -+#define BIT_GET_AC_CHANNEL12_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL12_WEIGHT) & BIT_MASK_AC_CHANNEL12_WEIGHT) -+#define BIT_SET_AC_CHANNEL12_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL12_WEIGHT(x) | BIT_AC_CHANNEL12_WEIGHT(v)) -+ -+/* 2 REG_AC_CHANNEL13_WEIGHT (Offset 0x3375) */ -+ -+#define BIT_SHIFT_AC_CHANNEL13_WEIGHT 0 -+#define BIT_MASK_AC_CHANNEL13_WEIGHT 0xff -+#define BIT_AC_CHANNEL13_WEIGHT(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL13_WEIGHT) << BIT_SHIFT_AC_CHANNEL13_WEIGHT) -+#define BITS_AC_CHANNEL13_WEIGHT \ -+ (BIT_MASK_AC_CHANNEL13_WEIGHT << BIT_SHIFT_AC_CHANNEL13_WEIGHT) -+#define BIT_CLEAR_AC_CHANNEL13_WEIGHT(x) ((x) & (~BITS_AC_CHANNEL13_WEIGHT)) -+#define BIT_GET_AC_CHANNEL13_WEIGHT(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL13_WEIGHT) & BIT_MASK_AC_CHANNEL13_WEIGHT) -+#define BIT_SET_AC_CHANNEL13_WEIGHT(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL13_WEIGHT(x) | BIT_AC_CHANNEL13_WEIGHT(v)) -+ -+#endif -+ -+#endif /* __RTL_WLAN_BITDEF_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8197f.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8197f.h -new file mode 100644 -index 000000000..e60b39562 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8197f.h -@@ -0,0 +1,17368 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_BIT_8197F_H -+#define __INC_HALMAC_BIT_8197F_H -+ -+#define CPU_OPT_WIDTH 0x1F -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_SYS_ISO_CTRL_8197F */ -+#define BIT_PWC_EV12V_8197F BIT(15) -+#define BIT_PWC_EV25V_8197F BIT(14) -+#define BIT_PA33V_EN_8197F BIT(13) -+#define BIT_PA12V_EN_8197F BIT(12) -+#define BIT_UA33V_EN_8197F BIT(11) -+#define BIT_UA12V_EN_8197F BIT(10) -+#define BIT_ISO_RFDIO_8197F BIT(9) -+#define BIT_ISO_EB2CORE_8197F BIT(8) -+#define BIT_ISO_DIOE_8197F BIT(7) -+#define BIT_ISO_WLPON2PP_8197F BIT(6) -+#define BIT_ISO_IP2MAC_WA2PP_8197F BIT(5) -+#define BIT_ISO_PD2CORE_8197F BIT(4) -+#define BIT_ISO_PA2PCIE_8197F BIT(3) -+#define BIT_ISO_UD2CORE_8197F BIT(2) -+#define BIT_ISO_UA2USB_8197F BIT(1) -+#define BIT_ISO_WD2PP_8197F BIT(0) -+ -+/* 2 REG_SYS_FUNC_EN_8197F */ -+#define BIT_FEN_MREGEN_8197F BIT(15) -+#define BIT_FEN_HWPDN_8197F BIT(14) -+#define BIT_EN_25_1_8197F BIT(13) -+#define BIT_FEN_ELDR_8197F BIT(12) -+#define BIT_FEN_DCORE_8197F BIT(11) -+#define BIT_FEN_CPUEN_8197F BIT(10) -+#define BIT_FEN_DIOE_8197F BIT(9) -+#define BIT_FEN_PCIED_8197F BIT(8) -+#define BIT_FEN_PPLL_8197F BIT(7) -+#define BIT_FEN_PCIEA_8197F BIT(6) -+#define BIT_FEN_DIO_PCIE_8197F BIT(5) -+#define BIT_FEN_USBD_8197F BIT(4) -+#define BIT_FEN_UPLL_8197F BIT(3) -+#define BIT_FEN_USBA_8197F BIT(2) -+#define BIT_FEN_BB_GLB_RSTN_8197F BIT(1) -+#define BIT_FEN_BBRSTB_8197F BIT(0) -+ -+/* 2 REG_SYS_PW_CTRL_8197F */ -+#define BIT_SOP_EABM_8197F BIT(31) -+#define BIT_SOP_ACKF_8197F BIT(30) -+#define BIT_SOP_ERCK_8197F BIT(29) -+#define BIT_SOP_ESWR_8197F BIT(28) -+#define BIT_SOP_PWMM_8197F BIT(27) -+#define BIT_SOP_EECK_8197F BIT(26) -+#define BIT_SOP_EXTL_8197F BIT(24) -+#define BIT_SYM_OP_RING_12M_8197F BIT(22) -+#define BIT_ROP_SWPR_8197F BIT(21) -+#define BIT_DIS_HW_LPLDM_8197F BIT(20) -+#define BIT_OPT_SWRST_WLMCU_8197F BIT(19) -+#define BIT_RDY_SYSPWR_8197F BIT(17) -+#define BIT_EN_WLON_8197F BIT(16) -+#define BIT_APDM_HPDN_8197F BIT(15) -+#define BIT_AFSM_PCIE_SUS_EN_8197F BIT(12) -+#define BIT_AFSM_WLSUS_EN_8197F BIT(11) -+#define BIT_APFM_SWLPS_8197F BIT(10) -+#define BIT_APFM_OFFMAC_8197F BIT(9) -+#define BIT_APFN_ONMAC_8197F BIT(8) -+#define BIT_CHIP_PDN_EN_8197F BIT(7) -+#define BIT_RDY_MACDIS_8197F BIT(6) -+#define BIT_RING_CLK_12M_EN_8197F BIT(4) -+#define BIT_PFM_WOWL_8197F BIT(3) -+#define BIT_PFM_LDKP_8197F BIT(2) -+#define BIT_WL_HCI_ALD_8197F BIT(1) -+#define BIT_PFM_LDALL_8197F BIT(0) -+ -+/* 2 REG_SYS_CLK_CTRL_8197F */ -+#define BIT_LDO_DUMMY_8197F BIT(15) -+#define BIT_CPU_CLK_EN_8197F BIT(14) -+#define BIT_SYMREG_CLK_EN_8197F BIT(13) -+#define BIT_HCI_CLK_EN_8197F BIT(12) -+#define BIT_MAC_CLK_EN_8197F BIT(11) -+#define BIT_SEC_CLK_EN_8197F BIT(10) -+#define BIT_PHY_SSC_RSTB_8197F BIT(9) -+#define BIT_EXT_32K_EN_8197F BIT(8) -+#define BIT_WL_CLK_TEST_8197F BIT(7) -+#define BIT_OP_SPS_PWM_EN_8197F BIT(6) -+#define BIT_LOADER_CLK_EN_8197F BIT(5) -+#define BIT_MACSLP_8197F BIT(4) -+#define BIT_WAKEPAD_EN_8197F BIT(3) -+#define BIT_ROMD16V_EN_8197F BIT(2) -+#define BIT_CKANA12M_EN_8197F BIT(1) -+#define BIT_CNTD16V_EN_8197F BIT(0) -+ -+/* 2 REG_SYS_EEPROM_CTRL_8197F */ -+ -+#define BIT_SHIFT_VPDIDX_8197F 8 -+#define BIT_MASK_VPDIDX_8197F 0xff -+#define BIT_VPDIDX_8197F(x) \ -+ (((x) & BIT_MASK_VPDIDX_8197F) << BIT_SHIFT_VPDIDX_8197F) -+#define BITS_VPDIDX_8197F (BIT_MASK_VPDIDX_8197F << BIT_SHIFT_VPDIDX_8197F) -+#define BIT_CLEAR_VPDIDX_8197F(x) ((x) & (~BITS_VPDIDX_8197F)) -+#define BIT_GET_VPDIDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_VPDIDX_8197F) & BIT_MASK_VPDIDX_8197F) -+#define BIT_SET_VPDIDX_8197F(x, v) \ -+ (BIT_CLEAR_VPDIDX_8197F(x) | BIT_VPDIDX_8197F(v)) -+ -+#define BIT_SHIFT_EEM1_0_8197F 6 -+#define BIT_MASK_EEM1_0_8197F 0x3 -+#define BIT_EEM1_0_8197F(x) \ -+ (((x) & BIT_MASK_EEM1_0_8197F) << BIT_SHIFT_EEM1_0_8197F) -+#define BITS_EEM1_0_8197F (BIT_MASK_EEM1_0_8197F << BIT_SHIFT_EEM1_0_8197F) -+#define BIT_CLEAR_EEM1_0_8197F(x) ((x) & (~BITS_EEM1_0_8197F)) -+#define BIT_GET_EEM1_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_EEM1_0_8197F) & BIT_MASK_EEM1_0_8197F) -+#define BIT_SET_EEM1_0_8197F(x, v) \ -+ (BIT_CLEAR_EEM1_0_8197F(x) | BIT_EEM1_0_8197F(v)) -+ -+#define BIT_AUTOLOAD_SUS_8197F BIT(5) -+#define BIT_EERPOMSEL_8197F BIT(4) -+#define BIT_EECS_V1_8197F BIT(3) -+#define BIT_EESK_V1_8197F BIT(2) -+#define BIT_EEDI_V1_8197F BIT(1) -+#define BIT_EEDO_V1_8197F BIT(0) -+ -+/* 2 REG_EE_VPD_8197F */ -+ -+#define BIT_SHIFT_VPD_DATA_8197F 0 -+#define BIT_MASK_VPD_DATA_8197F 0xffffffffL -+#define BIT_VPD_DATA_8197F(x) \ -+ (((x) & BIT_MASK_VPD_DATA_8197F) << BIT_SHIFT_VPD_DATA_8197F) -+#define BITS_VPD_DATA_8197F \ -+ (BIT_MASK_VPD_DATA_8197F << BIT_SHIFT_VPD_DATA_8197F) -+#define BIT_CLEAR_VPD_DATA_8197F(x) ((x) & (~BITS_VPD_DATA_8197F)) -+#define BIT_GET_VPD_DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_VPD_DATA_8197F) & BIT_MASK_VPD_DATA_8197F) -+#define BIT_SET_VPD_DATA_8197F(x, v) \ -+ (BIT_CLEAR_VPD_DATA_8197F(x) | BIT_VPD_DATA_8197F(v)) -+ -+/* 2 REG_SYS_SWR_CTRL1_8197F */ -+#define BIT_SW18_C2_BIT0_8197F BIT(31) -+ -+#define BIT_SHIFT_SW18_C1_8197F 29 -+#define BIT_MASK_SW18_C1_8197F 0x3 -+#define BIT_SW18_C1_8197F(x) \ -+ (((x) & BIT_MASK_SW18_C1_8197F) << BIT_SHIFT_SW18_C1_8197F) -+#define BITS_SW18_C1_8197F (BIT_MASK_SW18_C1_8197F << BIT_SHIFT_SW18_C1_8197F) -+#define BIT_CLEAR_SW18_C1_8197F(x) ((x) & (~BITS_SW18_C1_8197F)) -+#define BIT_GET_SW18_C1_8197F(x) \ -+ (((x) >> BIT_SHIFT_SW18_C1_8197F) & BIT_MASK_SW18_C1_8197F) -+#define BIT_SET_SW18_C1_8197F(x, v) \ -+ (BIT_CLEAR_SW18_C1_8197F(x) | BIT_SW18_C1_8197F(v)) -+ -+#define BIT_SHIFT_REG_FREQ_L_8197F 25 -+#define BIT_MASK_REG_FREQ_L_8197F 0x7 -+#define BIT_REG_FREQ_L_8197F(x) \ -+ (((x) & BIT_MASK_REG_FREQ_L_8197F) << BIT_SHIFT_REG_FREQ_L_8197F) -+#define BITS_REG_FREQ_L_8197F \ -+ (BIT_MASK_REG_FREQ_L_8197F << BIT_SHIFT_REG_FREQ_L_8197F) -+#define BIT_CLEAR_REG_FREQ_L_8197F(x) ((x) & (~BITS_REG_FREQ_L_8197F)) -+#define BIT_GET_REG_FREQ_L_8197F(x) \ -+ (((x) >> BIT_SHIFT_REG_FREQ_L_8197F) & BIT_MASK_REG_FREQ_L_8197F) -+#define BIT_SET_REG_FREQ_L_8197F(x, v) \ -+ (BIT_CLEAR_REG_FREQ_L_8197F(x) | BIT_REG_FREQ_L_8197F(v)) -+ -+#define BIT_REG_EN_DUTY_8197F BIT(24) -+ -+#define BIT_SHIFT_REG_MODE_8197F 22 -+#define BIT_MASK_REG_MODE_8197F 0x3 -+#define BIT_REG_MODE_8197F(x) \ -+ (((x) & BIT_MASK_REG_MODE_8197F) << BIT_SHIFT_REG_MODE_8197F) -+#define BITS_REG_MODE_8197F \ -+ (BIT_MASK_REG_MODE_8197F << BIT_SHIFT_REG_MODE_8197F) -+#define BIT_CLEAR_REG_MODE_8197F(x) ((x) & (~BITS_REG_MODE_8197F)) -+#define BIT_GET_REG_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_REG_MODE_8197F) & BIT_MASK_REG_MODE_8197F) -+#define BIT_SET_REG_MODE_8197F(x, v) \ -+ (BIT_CLEAR_REG_MODE_8197F(x) | BIT_REG_MODE_8197F(v)) -+ -+#define BIT_REG_EN_SP_8197F BIT(21) -+#define BIT_REG_AUTO_L_8197F BIT(20) -+#define BIT_SW18_SELD_BIT0_8197F BIT(19) -+#define BIT_SW18_POWOCP_8197F BIT(18) -+ -+#define BIT_SHIFT_SW18_OCP_8197F 15 -+#define BIT_MASK_SW18_OCP_8197F 0x7 -+#define BIT_SW18_OCP_8197F(x) \ -+ (((x) & BIT_MASK_SW18_OCP_8197F) << BIT_SHIFT_SW18_OCP_8197F) -+#define BITS_SW18_OCP_8197F \ -+ (BIT_MASK_SW18_OCP_8197F << BIT_SHIFT_SW18_OCP_8197F) -+#define BIT_CLEAR_SW18_OCP_8197F(x) ((x) & (~BITS_SW18_OCP_8197F)) -+#define BIT_GET_SW18_OCP_8197F(x) \ -+ (((x) >> BIT_SHIFT_SW18_OCP_8197F) & BIT_MASK_SW18_OCP_8197F) -+#define BIT_SET_SW18_OCP_8197F(x, v) \ -+ (BIT_CLEAR_SW18_OCP_8197F(x) | BIT_SW18_OCP_8197F(v)) -+ -+#define BIT_SHIFT_CF_L_BIT0_TO_1_8197F 13 -+#define BIT_MASK_CF_L_BIT0_TO_1_8197F 0x3 -+#define BIT_CF_L_BIT0_TO_1_8197F(x) \ -+ (((x) & BIT_MASK_CF_L_BIT0_TO_1_8197F) \ -+ << BIT_SHIFT_CF_L_BIT0_TO_1_8197F) -+#define BITS_CF_L_BIT0_TO_1_8197F \ -+ (BIT_MASK_CF_L_BIT0_TO_1_8197F << BIT_SHIFT_CF_L_BIT0_TO_1_8197F) -+#define BIT_CLEAR_CF_L_BIT0_TO_1_8197F(x) ((x) & (~BITS_CF_L_BIT0_TO_1_8197F)) -+#define BIT_GET_CF_L_BIT0_TO_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_CF_L_BIT0_TO_1_8197F) & \ -+ BIT_MASK_CF_L_BIT0_TO_1_8197F) -+#define BIT_SET_CF_L_BIT0_TO_1_8197F(x, v) \ -+ (BIT_CLEAR_CF_L_BIT0_TO_1_8197F(x) | BIT_CF_L_BIT0_TO_1_8197F(v)) -+ -+#define BIT_SW18_FPWM_8197F BIT(11) -+#define BIT_SW18_SWEN_8197F BIT(9) -+#define BIT_SW18_LDEN_8197F BIT(8) -+#define BIT_MAC_ID_EN_8197F BIT(7) -+#define BIT_WL_CTRL_XTAL_CADJ_8197F BIT(6) -+#define BIT_AFE_BGEN_8197F BIT(0) -+ -+/* 2 REG_SYS_SWR_CTRL2_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_SYS_SWR_CTRL3_8197F */ -+#define BIT_SPS18_OCP_DIS_8197F BIT(31) -+ -+#define BIT_SHIFT_SPS18_OCP_TH_8197F 16 -+#define BIT_MASK_SPS18_OCP_TH_8197F 0x7fff -+#define BIT_SPS18_OCP_TH_8197F(x) \ -+ (((x) & BIT_MASK_SPS18_OCP_TH_8197F) << BIT_SHIFT_SPS18_OCP_TH_8197F) -+#define BITS_SPS18_OCP_TH_8197F \ -+ (BIT_MASK_SPS18_OCP_TH_8197F << BIT_SHIFT_SPS18_OCP_TH_8197F) -+#define BIT_CLEAR_SPS18_OCP_TH_8197F(x) ((x) & (~BITS_SPS18_OCP_TH_8197F)) -+#define BIT_GET_SPS18_OCP_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_SPS18_OCP_TH_8197F) & BIT_MASK_SPS18_OCP_TH_8197F) -+#define BIT_SET_SPS18_OCP_TH_8197F(x, v) \ -+ (BIT_CLEAR_SPS18_OCP_TH_8197F(x) | BIT_SPS18_OCP_TH_8197F(v)) -+ -+#define BIT_SHIFT_OCP_WINDOW_8197F 0 -+#define BIT_MASK_OCP_WINDOW_8197F 0xffff -+#define BIT_OCP_WINDOW_8197F(x) \ -+ (((x) & BIT_MASK_OCP_WINDOW_8197F) << BIT_SHIFT_OCP_WINDOW_8197F) -+#define BITS_OCP_WINDOW_8197F \ -+ (BIT_MASK_OCP_WINDOW_8197F << BIT_SHIFT_OCP_WINDOW_8197F) -+#define BIT_CLEAR_OCP_WINDOW_8197F(x) ((x) & (~BITS_OCP_WINDOW_8197F)) -+#define BIT_GET_OCP_WINDOW_8197F(x) \ -+ (((x) >> BIT_SHIFT_OCP_WINDOW_8197F) & BIT_MASK_OCP_WINDOW_8197F) -+#define BIT_SET_OCP_WINDOW_8197F(x, v) \ -+ (BIT_CLEAR_OCP_WINDOW_8197F(x) | BIT_OCP_WINDOW_8197F(v)) -+ -+/* 2 REG_RSV_CTRL_8197F */ -+#define BIT_HREG_DBG_8197F BIT(23) -+#define BIT_WLMCUIOIF_8197F BIT(8) -+#define BIT_LOCK_ALL_EN_8197F BIT(7) -+#define BIT_R_DIS_PRST_8197F BIT(6) -+#define BIT_WLOCK_1C_B6_8197F BIT(5) -+#define BIT_WLOCK_40_8197F BIT(4) -+#define BIT_WLOCK_08_8197F BIT(3) -+#define BIT_WLOCK_04_8197F BIT(2) -+#define BIT_WLOCK_00_8197F BIT(1) -+#define BIT_WLOCK_ALL_8197F BIT(0) -+ -+/* 2 REG_RF0_CTRL_8197F */ -+#define BIT_RF0_SDMRSTB_8197F BIT(2) -+#define BIT_RF0_RSTB_8197F BIT(1) -+#define BIT_RF0_EN_8197F BIT(0) -+ -+/* 2 REG_AFE_LDO_CTRL_8197F */ -+ -+#define BIT_SHIFT_LPLDH12_RSV_8197F 29 -+#define BIT_MASK_LPLDH12_RSV_8197F 0x7 -+#define BIT_LPLDH12_RSV_8197F(x) \ -+ (((x) & BIT_MASK_LPLDH12_RSV_8197F) << BIT_SHIFT_LPLDH12_RSV_8197F) -+#define BITS_LPLDH12_RSV_8197F \ -+ (BIT_MASK_LPLDH12_RSV_8197F << BIT_SHIFT_LPLDH12_RSV_8197F) -+#define BIT_CLEAR_LPLDH12_RSV_8197F(x) ((x) & (~BITS_LPLDH12_RSV_8197F)) -+#define BIT_GET_LPLDH12_RSV_8197F(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_RSV_8197F) & BIT_MASK_LPLDH12_RSV_8197F) -+#define BIT_SET_LPLDH12_RSV_8197F(x, v) \ -+ (BIT_CLEAR_LPLDH12_RSV_8197F(x) | BIT_LPLDH12_RSV_8197F(v)) -+ -+#define BIT_LPLDH12_SLP_8197F BIT(28) -+ -+#define BIT_SHIFT_LPLDH12_VADJ_8197F 24 -+#define BIT_MASK_LPLDH12_VADJ_8197F 0xf -+#define BIT_LPLDH12_VADJ_8197F(x) \ -+ (((x) & BIT_MASK_LPLDH12_VADJ_8197F) << BIT_SHIFT_LPLDH12_VADJ_8197F) -+#define BITS_LPLDH12_VADJ_8197F \ -+ (BIT_MASK_LPLDH12_VADJ_8197F << BIT_SHIFT_LPLDH12_VADJ_8197F) -+#define BIT_CLEAR_LPLDH12_VADJ_8197F(x) ((x) & (~BITS_LPLDH12_VADJ_8197F)) -+#define BIT_GET_LPLDH12_VADJ_8197F(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_VADJ_8197F) & BIT_MASK_LPLDH12_VADJ_8197F) -+#define BIT_SET_LPLDH12_VADJ_8197F(x, v) \ -+ (BIT_CLEAR_LPLDH12_VADJ_8197F(x) | BIT_LPLDH12_VADJ_8197F(v)) -+ -+#define BIT_LDH12_EN_8197F BIT(16) -+#define BIT_POW_REGU_P1_8197F BIT(10) -+#define BIT_LDOV12W_EN_8197F BIT(8) -+#define BIT_EX_XTAL_DRV_DIGI_8197F BIT(7) -+#define BIT_EX_XTAL_DRV_USB_8197F BIT(6) -+#define BIT_EX_XTAL_DRV_AFE_8197F BIT(5) -+#define BIT_EX_XTAL_DRV_RF2_8197F BIT(4) -+#define BIT_EX_XTAL_DRV_RF1_8197F BIT(3) -+#define BIT_POW_REGU_P0_8197F BIT(2) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_POW_PLL_LDO_8197F BIT(0) -+ -+/* 2 REG_AFE_CTRL1_8197F */ -+#define BIT_AGPIO_GPE_8197F BIT(31) -+ -+#define BIT_SHIFT_XTAL_CAP_XI_8197F 25 -+#define BIT_MASK_XTAL_CAP_XI_8197F 0x3f -+#define BIT_XTAL_CAP_XI_8197F(x) \ -+ (((x) & BIT_MASK_XTAL_CAP_XI_8197F) << BIT_SHIFT_XTAL_CAP_XI_8197F) -+#define BITS_XTAL_CAP_XI_8197F \ -+ (BIT_MASK_XTAL_CAP_XI_8197F << BIT_SHIFT_XTAL_CAP_XI_8197F) -+#define BIT_CLEAR_XTAL_CAP_XI_8197F(x) ((x) & (~BITS_XTAL_CAP_XI_8197F)) -+#define BIT_GET_XTAL_CAP_XI_8197F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CAP_XI_8197F) & BIT_MASK_XTAL_CAP_XI_8197F) -+#define BIT_SET_XTAL_CAP_XI_8197F(x, v) \ -+ (BIT_CLEAR_XTAL_CAP_XI_8197F(x) | BIT_XTAL_CAP_XI_8197F(v)) -+ -+#define BIT_SHIFT_XTAL_DRV_DIGI_8197F 23 -+#define BIT_MASK_XTAL_DRV_DIGI_8197F 0x3 -+#define BIT_XTAL_DRV_DIGI_8197F(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_DIGI_8197F) << BIT_SHIFT_XTAL_DRV_DIGI_8197F) -+#define BITS_XTAL_DRV_DIGI_8197F \ -+ (BIT_MASK_XTAL_DRV_DIGI_8197F << BIT_SHIFT_XTAL_DRV_DIGI_8197F) -+#define BIT_CLEAR_XTAL_DRV_DIGI_8197F(x) ((x) & (~BITS_XTAL_DRV_DIGI_8197F)) -+#define BIT_GET_XTAL_DRV_DIGI_8197F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_DIGI_8197F) & BIT_MASK_XTAL_DRV_DIGI_8197F) -+#define BIT_SET_XTAL_DRV_DIGI_8197F(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_DIGI_8197F(x) | BIT_XTAL_DRV_DIGI_8197F(v)) -+ -+#define BIT_XTAL_DRV_USB_BIT1_8197F BIT(22) -+ -+#define BIT_SHIFT_MAC_CLK_SEL_8197F 20 -+#define BIT_MASK_MAC_CLK_SEL_8197F 0x3 -+#define BIT_MAC_CLK_SEL_8197F(x) \ -+ (((x) & BIT_MASK_MAC_CLK_SEL_8197F) << BIT_SHIFT_MAC_CLK_SEL_8197F) -+#define BITS_MAC_CLK_SEL_8197F \ -+ (BIT_MASK_MAC_CLK_SEL_8197F << BIT_SHIFT_MAC_CLK_SEL_8197F) -+#define BIT_CLEAR_MAC_CLK_SEL_8197F(x) ((x) & (~BITS_MAC_CLK_SEL_8197F)) -+#define BIT_GET_MAC_CLK_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_MAC_CLK_SEL_8197F) & BIT_MASK_MAC_CLK_SEL_8197F) -+#define BIT_SET_MAC_CLK_SEL_8197F(x, v) \ -+ (BIT_CLEAR_MAC_CLK_SEL_8197F(x) | BIT_MAC_CLK_SEL_8197F(v)) -+ -+#define BIT_XTAL_DRV_USB_BIT0_8197F BIT(19) -+ -+#define BIT_SHIFT_XTAL_DRV_AFE_8197F 17 -+#define BIT_MASK_XTAL_DRV_AFE_8197F 0x3 -+#define BIT_XTAL_DRV_AFE_8197F(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_AFE_8197F) << BIT_SHIFT_XTAL_DRV_AFE_8197F) -+#define BITS_XTAL_DRV_AFE_8197F \ -+ (BIT_MASK_XTAL_DRV_AFE_8197F << BIT_SHIFT_XTAL_DRV_AFE_8197F) -+#define BIT_CLEAR_XTAL_DRV_AFE_8197F(x) ((x) & (~BITS_XTAL_DRV_AFE_8197F)) -+#define BIT_GET_XTAL_DRV_AFE_8197F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_AFE_8197F) & BIT_MASK_XTAL_DRV_AFE_8197F) -+#define BIT_SET_XTAL_DRV_AFE_8197F(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_AFE_8197F(x) | BIT_XTAL_DRV_AFE_8197F(v)) -+ -+#define BIT_SHIFT_XTAL_DRV_RF2_8197F 15 -+#define BIT_MASK_XTAL_DRV_RF2_8197F 0x3 -+#define BIT_XTAL_DRV_RF2_8197F(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF2_8197F) << BIT_SHIFT_XTAL_DRV_RF2_8197F) -+#define BITS_XTAL_DRV_RF2_8197F \ -+ (BIT_MASK_XTAL_DRV_RF2_8197F << BIT_SHIFT_XTAL_DRV_RF2_8197F) -+#define BIT_CLEAR_XTAL_DRV_RF2_8197F(x) ((x) & (~BITS_XTAL_DRV_RF2_8197F)) -+#define BIT_GET_XTAL_DRV_RF2_8197F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF2_8197F) & BIT_MASK_XTAL_DRV_RF2_8197F) -+#define BIT_SET_XTAL_DRV_RF2_8197F(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF2_8197F(x) | BIT_XTAL_DRV_RF2_8197F(v)) -+ -+#define BIT_SHIFT_XTAL_DRV_RF1_8197F 13 -+#define BIT_MASK_XTAL_DRV_RF1_8197F 0x3 -+#define BIT_XTAL_DRV_RF1_8197F(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF1_8197F) << BIT_SHIFT_XTAL_DRV_RF1_8197F) -+#define BITS_XTAL_DRV_RF1_8197F \ -+ (BIT_MASK_XTAL_DRV_RF1_8197F << BIT_SHIFT_XTAL_DRV_RF1_8197F) -+#define BIT_CLEAR_XTAL_DRV_RF1_8197F(x) ((x) & (~BITS_XTAL_DRV_RF1_8197F)) -+#define BIT_GET_XTAL_DRV_RF1_8197F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF1_8197F) & BIT_MASK_XTAL_DRV_RF1_8197F) -+#define BIT_SET_XTAL_DRV_RF1_8197F(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF1_8197F(x) | BIT_XTAL_DRV_RF1_8197F(v)) -+ -+#define BIT_XTAL_DELAY_DIGI_8197F BIT(12) -+#define BIT_XTAL_DELAY_USB_8197F BIT(11) -+#define BIT_XTAL_DELAY_AFE_8197F BIT(10) -+#define BIT_XTAL_LP_V1_8197F BIT(9) -+#define BIT_XTAL_GM_SEP_V1_8197F BIT(8) -+#define BIT_XTAL_LDO_VREF_V1_8197F BIT(7) -+#define BIT_XTAL_XQSEL_RF_8197F BIT(6) -+#define BIT_XTAL_XQSEL_8197F BIT(5) -+ -+#define BIT_SHIFT_XTAL_GMN_V1_8197F 3 -+#define BIT_MASK_XTAL_GMN_V1_8197F 0x3 -+#define BIT_XTAL_GMN_V1_8197F(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_V1_8197F) << BIT_SHIFT_XTAL_GMN_V1_8197F) -+#define BITS_XTAL_GMN_V1_8197F \ -+ (BIT_MASK_XTAL_GMN_V1_8197F << BIT_SHIFT_XTAL_GMN_V1_8197F) -+#define BIT_CLEAR_XTAL_GMN_V1_8197F(x) ((x) & (~BITS_XTAL_GMN_V1_8197F)) -+#define BIT_GET_XTAL_GMN_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_V1_8197F) & BIT_MASK_XTAL_GMN_V1_8197F) -+#define BIT_SET_XTAL_GMN_V1_8197F(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_V1_8197F(x) | BIT_XTAL_GMN_V1_8197F(v)) -+ -+#define BIT_SHIFT_XTAL_GMP_V1_8197F 1 -+#define BIT_MASK_XTAL_GMP_V1_8197F 0x3 -+#define BIT_XTAL_GMP_V1_8197F(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_V1_8197F) << BIT_SHIFT_XTAL_GMP_V1_8197F) -+#define BITS_XTAL_GMP_V1_8197F \ -+ (BIT_MASK_XTAL_GMP_V1_8197F << BIT_SHIFT_XTAL_GMP_V1_8197F) -+#define BIT_CLEAR_XTAL_GMP_V1_8197F(x) ((x) & (~BITS_XTAL_GMP_V1_8197F)) -+#define BIT_GET_XTAL_GMP_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_V1_8197F) & BIT_MASK_XTAL_GMP_V1_8197F) -+#define BIT_SET_XTAL_GMP_V1_8197F(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_V1_8197F(x) | BIT_XTAL_GMP_V1_8197F(v)) -+ -+#define BIT_XTAL_EN_8197F BIT(0) -+ -+/* 2 REG_AFE_CTRL2_8197F */ -+ -+#define BIT_SHIFT_RS_SET_V2_8197F 26 -+#define BIT_MASK_RS_SET_V2_8197F 0x7 -+#define BIT_RS_SET_V2_8197F(x) \ -+ (((x) & BIT_MASK_RS_SET_V2_8197F) << BIT_SHIFT_RS_SET_V2_8197F) -+#define BITS_RS_SET_V2_8197F \ -+ (BIT_MASK_RS_SET_V2_8197F << BIT_SHIFT_RS_SET_V2_8197F) -+#define BIT_CLEAR_RS_SET_V2_8197F(x) ((x) & (~BITS_RS_SET_V2_8197F)) -+#define BIT_GET_RS_SET_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_RS_SET_V2_8197F) & BIT_MASK_RS_SET_V2_8197F) -+#define BIT_SET_RS_SET_V2_8197F(x, v) \ -+ (BIT_CLEAR_RS_SET_V2_8197F(x) | BIT_RS_SET_V2_8197F(v)) -+ -+#define BIT_SHIFT_CP_BIAS_V2_8197F 18 -+#define BIT_MASK_CP_BIAS_V2_8197F 0x7 -+#define BIT_CP_BIAS_V2_8197F(x) \ -+ (((x) & BIT_MASK_CP_BIAS_V2_8197F) << BIT_SHIFT_CP_BIAS_V2_8197F) -+#define BITS_CP_BIAS_V2_8197F \ -+ (BIT_MASK_CP_BIAS_V2_8197F << BIT_SHIFT_CP_BIAS_V2_8197F) -+#define BIT_CLEAR_CP_BIAS_V2_8197F(x) ((x) & (~BITS_CP_BIAS_V2_8197F)) -+#define BIT_GET_CP_BIAS_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_CP_BIAS_V2_8197F) & BIT_MASK_CP_BIAS_V2_8197F) -+#define BIT_SET_CP_BIAS_V2_8197F(x, v) \ -+ (BIT_CLEAR_CP_BIAS_V2_8197F(x) | BIT_CP_BIAS_V2_8197F(v)) -+ -+#define BIT_FREF_SEL_8197F BIT(16) -+ -+#define BIT_SHIFT_MCCO_V2_8197F 14 -+#define BIT_MASK_MCCO_V2_8197F 0x3 -+#define BIT_MCCO_V2_8197F(x) \ -+ (((x) & BIT_MASK_MCCO_V2_8197F) << BIT_SHIFT_MCCO_V2_8197F) -+#define BITS_MCCO_V2_8197F (BIT_MASK_MCCO_V2_8197F << BIT_SHIFT_MCCO_V2_8197F) -+#define BIT_CLEAR_MCCO_V2_8197F(x) ((x) & (~BITS_MCCO_V2_8197F)) -+#define BIT_GET_MCCO_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_MCCO_V2_8197F) & BIT_MASK_MCCO_V2_8197F) -+#define BIT_SET_MCCO_V2_8197F(x, v) \ -+ (BIT_CLEAR_MCCO_V2_8197F(x) | BIT_MCCO_V2_8197F(v)) -+ -+#define BIT_SHIFT_CK320_EN_8197F 12 -+#define BIT_MASK_CK320_EN_8197F 0x3 -+#define BIT_CK320_EN_8197F(x) \ -+ (((x) & BIT_MASK_CK320_EN_8197F) << BIT_SHIFT_CK320_EN_8197F) -+#define BITS_CK320_EN_8197F \ -+ (BIT_MASK_CK320_EN_8197F << BIT_SHIFT_CK320_EN_8197F) -+#define BIT_CLEAR_CK320_EN_8197F(x) ((x) & (~BITS_CK320_EN_8197F)) -+#define BIT_GET_CK320_EN_8197F(x) \ -+ (((x) >> BIT_SHIFT_CK320_EN_8197F) & BIT_MASK_CK320_EN_8197F) -+#define BIT_SET_CK320_EN_8197F(x, v) \ -+ (BIT_CLEAR_CK320_EN_8197F(x) | BIT_CK320_EN_8197F(v)) -+ -+#define BIT_AGPIO_GPO_8197F BIT(9) -+ -+#define BIT_SHIFT_AGPIO_DRV_8197F 7 -+#define BIT_MASK_AGPIO_DRV_8197F 0x3 -+#define BIT_AGPIO_DRV_8197F(x) \ -+ (((x) & BIT_MASK_AGPIO_DRV_8197F) << BIT_SHIFT_AGPIO_DRV_8197F) -+#define BITS_AGPIO_DRV_8197F \ -+ (BIT_MASK_AGPIO_DRV_8197F << BIT_SHIFT_AGPIO_DRV_8197F) -+#define BIT_CLEAR_AGPIO_DRV_8197F(x) ((x) & (~BITS_AGPIO_DRV_8197F)) -+#define BIT_GET_AGPIO_DRV_8197F(x) \ -+ (((x) >> BIT_SHIFT_AGPIO_DRV_8197F) & BIT_MASK_AGPIO_DRV_8197F) -+#define BIT_SET_AGPIO_DRV_8197F(x, v) \ -+ (BIT_CLEAR_AGPIO_DRV_8197F(x) | BIT_AGPIO_DRV_8197F(v)) -+ -+#define BIT_SHIFT_XTAL_CAP_XO_8197F 1 -+#define BIT_MASK_XTAL_CAP_XO_8197F 0x3f -+#define BIT_XTAL_CAP_XO_8197F(x) \ -+ (((x) & BIT_MASK_XTAL_CAP_XO_8197F) << BIT_SHIFT_XTAL_CAP_XO_8197F) -+#define BITS_XTAL_CAP_XO_8197F \ -+ (BIT_MASK_XTAL_CAP_XO_8197F << BIT_SHIFT_XTAL_CAP_XO_8197F) -+#define BIT_CLEAR_XTAL_CAP_XO_8197F(x) ((x) & (~BITS_XTAL_CAP_XO_8197F)) -+#define BIT_GET_XTAL_CAP_XO_8197F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CAP_XO_8197F) & BIT_MASK_XTAL_CAP_XO_8197F) -+#define BIT_SET_XTAL_CAP_XO_8197F(x, v) \ -+ (BIT_CLEAR_XTAL_CAP_XO_8197F(x) | BIT_XTAL_CAP_XO_8197F(v)) -+ -+#define BIT_POW_PLL_8197F BIT(0) -+ -+/* 2 REG_AFE_CTRL3_8197F */ -+ -+#define BIT_SHIFT_PS_V2_8197F 7 -+#define BIT_MASK_PS_V2_8197F 0x7 -+#define BIT_PS_V2_8197F(x) \ -+ (((x) & BIT_MASK_PS_V2_8197F) << BIT_SHIFT_PS_V2_8197F) -+#define BITS_PS_V2_8197F (BIT_MASK_PS_V2_8197F << BIT_SHIFT_PS_V2_8197F) -+#define BIT_CLEAR_PS_V2_8197F(x) ((x) & (~BITS_PS_V2_8197F)) -+#define BIT_GET_PS_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_V2_8197F) & BIT_MASK_PS_V2_8197F) -+#define BIT_SET_PS_V2_8197F(x, v) \ -+ (BIT_CLEAR_PS_V2_8197F(x) | BIT_PS_V2_8197F(v)) -+ -+#define BIT_PSEN_8197F BIT(6) -+#define BIT_DOGENB_8197F BIT(5) -+ -+/* 2 REG_EFUSE_CTRL_8197F */ -+#define BIT_EF_FLAG_8197F BIT(31) -+ -+#define BIT_SHIFT_EF_PGPD_8197F 28 -+#define BIT_MASK_EF_PGPD_8197F 0x7 -+#define BIT_EF_PGPD_8197F(x) \ -+ (((x) & BIT_MASK_EF_PGPD_8197F) << BIT_SHIFT_EF_PGPD_8197F) -+#define BITS_EF_PGPD_8197F (BIT_MASK_EF_PGPD_8197F << BIT_SHIFT_EF_PGPD_8197F) -+#define BIT_CLEAR_EF_PGPD_8197F(x) ((x) & (~BITS_EF_PGPD_8197F)) -+#define BIT_GET_EF_PGPD_8197F(x) \ -+ (((x) >> BIT_SHIFT_EF_PGPD_8197F) & BIT_MASK_EF_PGPD_8197F) -+#define BIT_SET_EF_PGPD_8197F(x, v) \ -+ (BIT_CLEAR_EF_PGPD_8197F(x) | BIT_EF_PGPD_8197F(v)) -+ -+#define BIT_SHIFT_EF_RDT_8197F 24 -+#define BIT_MASK_EF_RDT_8197F 0xf -+#define BIT_EF_RDT_8197F(x) \ -+ (((x) & BIT_MASK_EF_RDT_8197F) << BIT_SHIFT_EF_RDT_8197F) -+#define BITS_EF_RDT_8197F (BIT_MASK_EF_RDT_8197F << BIT_SHIFT_EF_RDT_8197F) -+#define BIT_CLEAR_EF_RDT_8197F(x) ((x) & (~BITS_EF_RDT_8197F)) -+#define BIT_GET_EF_RDT_8197F(x) \ -+ (((x) >> BIT_SHIFT_EF_RDT_8197F) & BIT_MASK_EF_RDT_8197F) -+#define BIT_SET_EF_RDT_8197F(x, v) \ -+ (BIT_CLEAR_EF_RDT_8197F(x) | BIT_EF_RDT_8197F(v)) -+ -+#define BIT_SHIFT_EF_PGTS_8197F 20 -+#define BIT_MASK_EF_PGTS_8197F 0xf -+#define BIT_EF_PGTS_8197F(x) \ -+ (((x) & BIT_MASK_EF_PGTS_8197F) << BIT_SHIFT_EF_PGTS_8197F) -+#define BITS_EF_PGTS_8197F (BIT_MASK_EF_PGTS_8197F << BIT_SHIFT_EF_PGTS_8197F) -+#define BIT_CLEAR_EF_PGTS_8197F(x) ((x) & (~BITS_EF_PGTS_8197F)) -+#define BIT_GET_EF_PGTS_8197F(x) \ -+ (((x) >> BIT_SHIFT_EF_PGTS_8197F) & BIT_MASK_EF_PGTS_8197F) -+#define BIT_SET_EF_PGTS_8197F(x, v) \ -+ (BIT_CLEAR_EF_PGTS_8197F(x) | BIT_EF_PGTS_8197F(v)) -+ -+#define BIT_EF_PDWN_8197F BIT(19) -+#define BIT_EF_ALDEN_8197F BIT(18) -+ -+#define BIT_SHIFT_EF_ADDR_8197F 8 -+#define BIT_MASK_EF_ADDR_8197F 0x3ff -+#define BIT_EF_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_EF_ADDR_8197F) << BIT_SHIFT_EF_ADDR_8197F) -+#define BITS_EF_ADDR_8197F (BIT_MASK_EF_ADDR_8197F << BIT_SHIFT_EF_ADDR_8197F) -+#define BIT_CLEAR_EF_ADDR_8197F(x) ((x) & (~BITS_EF_ADDR_8197F)) -+#define BIT_GET_EF_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_EF_ADDR_8197F) & BIT_MASK_EF_ADDR_8197F) -+#define BIT_SET_EF_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_EF_ADDR_8197F(x) | BIT_EF_ADDR_8197F(v)) -+ -+#define BIT_SHIFT_EF_DATA_8197F 0 -+#define BIT_MASK_EF_DATA_8197F 0xff -+#define BIT_EF_DATA_8197F(x) \ -+ (((x) & BIT_MASK_EF_DATA_8197F) << BIT_SHIFT_EF_DATA_8197F) -+#define BITS_EF_DATA_8197F (BIT_MASK_EF_DATA_8197F << BIT_SHIFT_EF_DATA_8197F) -+#define BIT_CLEAR_EF_DATA_8197F(x) ((x) & (~BITS_EF_DATA_8197F)) -+#define BIT_GET_EF_DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_EF_DATA_8197F) & BIT_MASK_EF_DATA_8197F) -+#define BIT_SET_EF_DATA_8197F(x, v) \ -+ (BIT_CLEAR_EF_DATA_8197F(x) | BIT_EF_DATA_8197F(v)) -+ -+/* 2 REG_LDO_EFUSE_CTRL_8197F */ -+#define BIT_LDOE25_EN_8197F BIT(31) -+ -+#define BIT_SHIFT_LDOE25_V12ADJ_L_8197F 27 -+#define BIT_MASK_LDOE25_V12ADJ_L_8197F 0xf -+#define BIT_LDOE25_V12ADJ_L_8197F(x) \ -+ (((x) & BIT_MASK_LDOE25_V12ADJ_L_8197F) \ -+ << BIT_SHIFT_LDOE25_V12ADJ_L_8197F) -+#define BITS_LDOE25_V12ADJ_L_8197F \ -+ (BIT_MASK_LDOE25_V12ADJ_L_8197F << BIT_SHIFT_LDOE25_V12ADJ_L_8197F) -+#define BIT_CLEAR_LDOE25_V12ADJ_L_8197F(x) ((x) & (~BITS_LDOE25_V12ADJ_L_8197F)) -+#define BIT_GET_LDOE25_V12ADJ_L_8197F(x) \ -+ (((x) >> BIT_SHIFT_LDOE25_V12ADJ_L_8197F) & \ -+ BIT_MASK_LDOE25_V12ADJ_L_8197F) -+#define BIT_SET_LDOE25_V12ADJ_L_8197F(x, v) \ -+ (BIT_CLEAR_LDOE25_V12ADJ_L_8197F(x) | BIT_LDOE25_V12ADJ_L_8197F(v)) -+ -+#define BIT_SHIFT_EF_SCAN_START_V1_8197F 16 -+#define BIT_MASK_EF_SCAN_START_V1_8197F 0x3ff -+#define BIT_EF_SCAN_START_V1_8197F(x) \ -+ (((x) & BIT_MASK_EF_SCAN_START_V1_8197F) \ -+ << BIT_SHIFT_EF_SCAN_START_V1_8197F) -+#define BITS_EF_SCAN_START_V1_8197F \ -+ (BIT_MASK_EF_SCAN_START_V1_8197F << BIT_SHIFT_EF_SCAN_START_V1_8197F) -+#define BIT_CLEAR_EF_SCAN_START_V1_8197F(x) \ -+ ((x) & (~BITS_EF_SCAN_START_V1_8197F)) -+#define BIT_GET_EF_SCAN_START_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_START_V1_8197F) & \ -+ BIT_MASK_EF_SCAN_START_V1_8197F) -+#define BIT_SET_EF_SCAN_START_V1_8197F(x, v) \ -+ (BIT_CLEAR_EF_SCAN_START_V1_8197F(x) | BIT_EF_SCAN_START_V1_8197F(v)) -+ -+#define BIT_SHIFT_EF_SCAN_END_8197F 12 -+#define BIT_MASK_EF_SCAN_END_8197F 0xf -+#define BIT_EF_SCAN_END_8197F(x) \ -+ (((x) & BIT_MASK_EF_SCAN_END_8197F) << BIT_SHIFT_EF_SCAN_END_8197F) -+#define BITS_EF_SCAN_END_8197F \ -+ (BIT_MASK_EF_SCAN_END_8197F << BIT_SHIFT_EF_SCAN_END_8197F) -+#define BIT_CLEAR_EF_SCAN_END_8197F(x) ((x) & (~BITS_EF_SCAN_END_8197F)) -+#define BIT_GET_EF_SCAN_END_8197F(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_END_8197F) & BIT_MASK_EF_SCAN_END_8197F) -+#define BIT_SET_EF_SCAN_END_8197F(x, v) \ -+ (BIT_CLEAR_EF_SCAN_END_8197F(x) | BIT_EF_SCAN_END_8197F(v)) -+ -+#define BIT_SHIFT_EF_CELL_SEL_8197F 8 -+#define BIT_MASK_EF_CELL_SEL_8197F 0x3 -+#define BIT_EF_CELL_SEL_8197F(x) \ -+ (((x) & BIT_MASK_EF_CELL_SEL_8197F) << BIT_SHIFT_EF_CELL_SEL_8197F) -+#define BITS_EF_CELL_SEL_8197F \ -+ (BIT_MASK_EF_CELL_SEL_8197F << BIT_SHIFT_EF_CELL_SEL_8197F) -+#define BIT_CLEAR_EF_CELL_SEL_8197F(x) ((x) & (~BITS_EF_CELL_SEL_8197F)) -+#define BIT_GET_EF_CELL_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_EF_CELL_SEL_8197F) & BIT_MASK_EF_CELL_SEL_8197F) -+#define BIT_SET_EF_CELL_SEL_8197F(x, v) \ -+ (BIT_CLEAR_EF_CELL_SEL_8197F(x) | BIT_EF_CELL_SEL_8197F(v)) -+ -+#define BIT_EF_TRPT_8197F BIT(7) -+ -+#define BIT_SHIFT_EF_TTHD_8197F 0 -+#define BIT_MASK_EF_TTHD_8197F 0x7f -+#define BIT_EF_TTHD_8197F(x) \ -+ (((x) & BIT_MASK_EF_TTHD_8197F) << BIT_SHIFT_EF_TTHD_8197F) -+#define BITS_EF_TTHD_8197F (BIT_MASK_EF_TTHD_8197F << BIT_SHIFT_EF_TTHD_8197F) -+#define BIT_CLEAR_EF_TTHD_8197F(x) ((x) & (~BITS_EF_TTHD_8197F)) -+#define BIT_GET_EF_TTHD_8197F(x) \ -+ (((x) >> BIT_SHIFT_EF_TTHD_8197F) & BIT_MASK_EF_TTHD_8197F) -+#define BIT_SET_EF_TTHD_8197F(x, v) \ -+ (BIT_CLEAR_EF_TTHD_8197F(x) | BIT_EF_TTHD_8197F(v)) -+ -+/* 2 REG_PWR_OPTION_CTRL_8197F */ -+ -+#define BIT_SHIFT_DBG_SEL_V1_8197F 16 -+#define BIT_MASK_DBG_SEL_V1_8197F 0xff -+#define BIT_DBG_SEL_V1_8197F(x) \ -+ (((x) & BIT_MASK_DBG_SEL_V1_8197F) << BIT_SHIFT_DBG_SEL_V1_8197F) -+#define BITS_DBG_SEL_V1_8197F \ -+ (BIT_MASK_DBG_SEL_V1_8197F << BIT_SHIFT_DBG_SEL_V1_8197F) -+#define BIT_CLEAR_DBG_SEL_V1_8197F(x) ((x) & (~BITS_DBG_SEL_V1_8197F)) -+#define BIT_GET_DBG_SEL_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_V1_8197F) & BIT_MASK_DBG_SEL_V1_8197F) -+#define BIT_SET_DBG_SEL_V1_8197F(x, v) \ -+ (BIT_CLEAR_DBG_SEL_V1_8197F(x) | BIT_DBG_SEL_V1_8197F(v)) -+ -+#define BIT_SHIFT_DBG_SEL_BYTE_8197F 14 -+#define BIT_MASK_DBG_SEL_BYTE_8197F 0x3 -+#define BIT_DBG_SEL_BYTE_8197F(x) \ -+ (((x) & BIT_MASK_DBG_SEL_BYTE_8197F) << BIT_SHIFT_DBG_SEL_BYTE_8197F) -+#define BITS_DBG_SEL_BYTE_8197F \ -+ (BIT_MASK_DBG_SEL_BYTE_8197F << BIT_SHIFT_DBG_SEL_BYTE_8197F) -+#define BIT_CLEAR_DBG_SEL_BYTE_8197F(x) ((x) & (~BITS_DBG_SEL_BYTE_8197F)) -+#define BIT_GET_DBG_SEL_BYTE_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_BYTE_8197F) & BIT_MASK_DBG_SEL_BYTE_8197F) -+#define BIT_SET_DBG_SEL_BYTE_8197F(x, v) \ -+ (BIT_CLEAR_DBG_SEL_BYTE_8197F(x) | BIT_DBG_SEL_BYTE_8197F(v)) -+ -+#define BIT_SHIFT_STD_L1_V1_8197F 12 -+#define BIT_MASK_STD_L1_V1_8197F 0x3 -+#define BIT_STD_L1_V1_8197F(x) \ -+ (((x) & BIT_MASK_STD_L1_V1_8197F) << BIT_SHIFT_STD_L1_V1_8197F) -+#define BITS_STD_L1_V1_8197F \ -+ (BIT_MASK_STD_L1_V1_8197F << BIT_SHIFT_STD_L1_V1_8197F) -+#define BIT_CLEAR_STD_L1_V1_8197F(x) ((x) & (~BITS_STD_L1_V1_8197F)) -+#define BIT_GET_STD_L1_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_STD_L1_V1_8197F) & BIT_MASK_STD_L1_V1_8197F) -+#define BIT_SET_STD_L1_V1_8197F(x, v) \ -+ (BIT_CLEAR_STD_L1_V1_8197F(x) | BIT_STD_L1_V1_8197F(v)) -+ -+#define BIT_SYSON_DBG_PAD_E2_8197F BIT(11) -+#define BIT_SYSON_LED_PAD_E2_8197F BIT(10) -+#define BIT_SYSON_GPEE_PAD_E2_8197F BIT(9) -+#define BIT_SYSON_PCI_PAD_E2_8197F BIT(8) -+#define BIT_AUTO_SW_LDO_VOL_EN_8197F BIT(7) -+ -+#define BIT_SHIFT_SYSON_SPS0WWV_WT_8197F 4 -+#define BIT_MASK_SYSON_SPS0WWV_WT_8197F 0x3 -+#define BIT_SYSON_SPS0WWV_WT_8197F(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0WWV_WT_8197F) \ -+ << BIT_SHIFT_SYSON_SPS0WWV_WT_8197F) -+#define BITS_SYSON_SPS0WWV_WT_8197F \ -+ (BIT_MASK_SYSON_SPS0WWV_WT_8197F << BIT_SHIFT_SYSON_SPS0WWV_WT_8197F) -+#define BIT_CLEAR_SYSON_SPS0WWV_WT_8197F(x) \ -+ ((x) & (~BITS_SYSON_SPS0WWV_WT_8197F)) -+#define BIT_GET_SYSON_SPS0WWV_WT_8197F(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0WWV_WT_8197F) & \ -+ BIT_MASK_SYSON_SPS0WWV_WT_8197F) -+#define BIT_SET_SYSON_SPS0WWV_WT_8197F(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0WWV_WT_8197F(x) | BIT_SYSON_SPS0WWV_WT_8197F(v)) -+ -+#define BIT_SHIFT_SYSON_SPS0LDO_WT_8197F 2 -+#define BIT_MASK_SYSON_SPS0LDO_WT_8197F 0x3 -+#define BIT_SYSON_SPS0LDO_WT_8197F(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0LDO_WT_8197F) \ -+ << BIT_SHIFT_SYSON_SPS0LDO_WT_8197F) -+#define BITS_SYSON_SPS0LDO_WT_8197F \ -+ (BIT_MASK_SYSON_SPS0LDO_WT_8197F << BIT_SHIFT_SYSON_SPS0LDO_WT_8197F) -+#define BIT_CLEAR_SYSON_SPS0LDO_WT_8197F(x) \ -+ ((x) & (~BITS_SYSON_SPS0LDO_WT_8197F)) -+#define BIT_GET_SYSON_SPS0LDO_WT_8197F(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0LDO_WT_8197F) & \ -+ BIT_MASK_SYSON_SPS0LDO_WT_8197F) -+#define BIT_SET_SYSON_SPS0LDO_WT_8197F(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0LDO_WT_8197F(x) | BIT_SYSON_SPS0LDO_WT_8197F(v)) -+ -+#define BIT_SHIFT_SYSON_RCLK_SCALE_8197F 0 -+#define BIT_MASK_SYSON_RCLK_SCALE_8197F 0x3 -+#define BIT_SYSON_RCLK_SCALE_8197F(x) \ -+ (((x) & BIT_MASK_SYSON_RCLK_SCALE_8197F) \ -+ << BIT_SHIFT_SYSON_RCLK_SCALE_8197F) -+#define BITS_SYSON_RCLK_SCALE_8197F \ -+ (BIT_MASK_SYSON_RCLK_SCALE_8197F << BIT_SHIFT_SYSON_RCLK_SCALE_8197F) -+#define BIT_CLEAR_SYSON_RCLK_SCALE_8197F(x) \ -+ ((x) & (~BITS_SYSON_RCLK_SCALE_8197F)) -+#define BIT_GET_SYSON_RCLK_SCALE_8197F(x) \ -+ (((x) >> BIT_SHIFT_SYSON_RCLK_SCALE_8197F) & \ -+ BIT_MASK_SYSON_RCLK_SCALE_8197F) -+#define BIT_SET_SYSON_RCLK_SCALE_8197F(x, v) \ -+ (BIT_CLEAR_SYSON_RCLK_SCALE_8197F(x) | BIT_SYSON_RCLK_SCALE_8197F(v)) -+ -+/* 2 REG_CAL_TIMER_8197F */ -+ -+#define BIT_SHIFT_MATCH_CNT_8197F 8 -+#define BIT_MASK_MATCH_CNT_8197F 0xff -+#define BIT_MATCH_CNT_8197F(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8197F) << BIT_SHIFT_MATCH_CNT_8197F) -+#define BITS_MATCH_CNT_8197F \ -+ (BIT_MASK_MATCH_CNT_8197F << BIT_SHIFT_MATCH_CNT_8197F) -+#define BIT_CLEAR_MATCH_CNT_8197F(x) ((x) & (~BITS_MATCH_CNT_8197F)) -+#define BIT_GET_MATCH_CNT_8197F(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8197F) & BIT_MASK_MATCH_CNT_8197F) -+#define BIT_SET_MATCH_CNT_8197F(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8197F(x) | BIT_MATCH_CNT_8197F(v)) -+ -+#define BIT_SHIFT_CAL_SCAL_8197F 0 -+#define BIT_MASK_CAL_SCAL_8197F 0xff -+#define BIT_CAL_SCAL_8197F(x) \ -+ (((x) & BIT_MASK_CAL_SCAL_8197F) << BIT_SHIFT_CAL_SCAL_8197F) -+#define BITS_CAL_SCAL_8197F \ -+ (BIT_MASK_CAL_SCAL_8197F << BIT_SHIFT_CAL_SCAL_8197F) -+#define BIT_CLEAR_CAL_SCAL_8197F(x) ((x) & (~BITS_CAL_SCAL_8197F)) -+#define BIT_GET_CAL_SCAL_8197F(x) \ -+ (((x) >> BIT_SHIFT_CAL_SCAL_8197F) & BIT_MASK_CAL_SCAL_8197F) -+#define BIT_SET_CAL_SCAL_8197F(x, v) \ -+ (BIT_CLEAR_CAL_SCAL_8197F(x) | BIT_CAL_SCAL_8197F(v)) -+ -+/* 2 REG_ACLK_MON_8197F */ -+ -+#define BIT_SHIFT_RCLK_MON_8197F 5 -+#define BIT_MASK_RCLK_MON_8197F 0x7ff -+#define BIT_RCLK_MON_8197F(x) \ -+ (((x) & BIT_MASK_RCLK_MON_8197F) << BIT_SHIFT_RCLK_MON_8197F) -+#define BITS_RCLK_MON_8197F \ -+ (BIT_MASK_RCLK_MON_8197F << BIT_SHIFT_RCLK_MON_8197F) -+#define BIT_CLEAR_RCLK_MON_8197F(x) ((x) & (~BITS_RCLK_MON_8197F)) -+#define BIT_GET_RCLK_MON_8197F(x) \ -+ (((x) >> BIT_SHIFT_RCLK_MON_8197F) & BIT_MASK_RCLK_MON_8197F) -+#define BIT_SET_RCLK_MON_8197F(x, v) \ -+ (BIT_CLEAR_RCLK_MON_8197F(x) | BIT_RCLK_MON_8197F(v)) -+ -+#define BIT_CAL_EN_8197F BIT(4) -+ -+#define BIT_SHIFT_DPSTU_8197F 2 -+#define BIT_MASK_DPSTU_8197F 0x3 -+#define BIT_DPSTU_8197F(x) \ -+ (((x) & BIT_MASK_DPSTU_8197F) << BIT_SHIFT_DPSTU_8197F) -+#define BITS_DPSTU_8197F (BIT_MASK_DPSTU_8197F << BIT_SHIFT_DPSTU_8197F) -+#define BIT_CLEAR_DPSTU_8197F(x) ((x) & (~BITS_DPSTU_8197F)) -+#define BIT_GET_DPSTU_8197F(x) \ -+ (((x) >> BIT_SHIFT_DPSTU_8197F) & BIT_MASK_DPSTU_8197F) -+#define BIT_SET_DPSTU_8197F(x, v) \ -+ (BIT_CLEAR_DPSTU_8197F(x) | BIT_DPSTU_8197F(v)) -+ -+#define BIT_SUS_16X_8197F BIT(1) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_GPIO_MUXCFG_8197F */ -+#define BIT_SIC_LOWEST_PRIORITY_8197F BIT(28) -+ -+#define BIT_SHIFT_PIN_USECASE_8197F 24 -+#define BIT_MASK_PIN_USECASE_8197F 0xf -+#define BIT_PIN_USECASE_8197F(x) \ -+ (((x) & BIT_MASK_PIN_USECASE_8197F) << BIT_SHIFT_PIN_USECASE_8197F) -+#define BITS_PIN_USECASE_8197F \ -+ (BIT_MASK_PIN_USECASE_8197F << BIT_SHIFT_PIN_USECASE_8197F) -+#define BIT_CLEAR_PIN_USECASE_8197F(x) ((x) & (~BITS_PIN_USECASE_8197F)) -+#define BIT_GET_PIN_USECASE_8197F(x) \ -+ (((x) >> BIT_SHIFT_PIN_USECASE_8197F) & BIT_MASK_PIN_USECASE_8197F) -+#define BIT_SET_PIN_USECASE_8197F(x, v) \ -+ (BIT_CLEAR_PIN_USECASE_8197F(x) | BIT_PIN_USECASE_8197F(v)) -+ -+#define BIT_FSPI_EN_8197F BIT(19) -+#define BIT_WL_RTS_EXT_32K_SEL_8197F BIT(18) -+#define BIT_WLGP_SPI_EN_8197F BIT(16) -+#define BIT_SIC_LBK_8197F BIT(15) -+#define BIT_ENHTP_8197F BIT(14) -+#define BIT_WLPHY_DBG_EN_8197F BIT(13) -+#define BIT_ENSIC_8197F BIT(12) -+#define BIT_SIC_SWRST_8197F BIT(11) -+#define BIT_PO_WIFI_PTA_PINS_8197F BIT(10) -+#define BIT_BTCOEX_MBOX_EN_8197F BIT(9) -+#define BIT_ENUART_8197F BIT(8) -+ -+#define BIT_SHIFT_BTMODE_8197F 6 -+#define BIT_MASK_BTMODE_8197F 0x3 -+#define BIT_BTMODE_8197F(x) \ -+ (((x) & BIT_MASK_BTMODE_8197F) << BIT_SHIFT_BTMODE_8197F) -+#define BITS_BTMODE_8197F (BIT_MASK_BTMODE_8197F << BIT_SHIFT_BTMODE_8197F) -+#define BIT_CLEAR_BTMODE_8197F(x) ((x) & (~BITS_BTMODE_8197F)) -+#define BIT_GET_BTMODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_BTMODE_8197F) & BIT_MASK_BTMODE_8197F) -+#define BIT_SET_BTMODE_8197F(x, v) \ -+ (BIT_CLEAR_BTMODE_8197F(x) | BIT_BTMODE_8197F(v)) -+ -+#define BIT_ENBT_8197F BIT(5) -+#define BIT_EROM_EN_8197F BIT(4) -+#define BIT_WLRFE_6_7_EN_8197F BIT(3) -+#define BIT_WLRFE_4_5_EN_8197F BIT(2) -+ -+#define BIT_SHIFT_GPIOSEL_8197F 0 -+#define BIT_MASK_GPIOSEL_8197F 0x3 -+#define BIT_GPIOSEL_8197F(x) \ -+ (((x) & BIT_MASK_GPIOSEL_8197F) << BIT_SHIFT_GPIOSEL_8197F) -+#define BITS_GPIOSEL_8197F (BIT_MASK_GPIOSEL_8197F << BIT_SHIFT_GPIOSEL_8197F) -+#define BIT_CLEAR_GPIOSEL_8197F(x) ((x) & (~BITS_GPIOSEL_8197F)) -+#define BIT_GET_GPIOSEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_GPIOSEL_8197F) & BIT_MASK_GPIOSEL_8197F) -+#define BIT_SET_GPIOSEL_8197F(x, v) \ -+ (BIT_CLEAR_GPIOSEL_8197F(x) | BIT_GPIOSEL_8197F(v)) -+ -+/* 2 REG_GPIO_PIN_CTRL_8197F */ -+ -+#define BIT_SHIFT_GPIO_MOD_7_TO_0_8197F 24 -+#define BIT_MASK_GPIO_MOD_7_TO_0_8197F 0xff -+#define BIT_GPIO_MOD_7_TO_0_8197F(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_7_TO_0_8197F) \ -+ << BIT_SHIFT_GPIO_MOD_7_TO_0_8197F) -+#define BITS_GPIO_MOD_7_TO_0_8197F \ -+ (BIT_MASK_GPIO_MOD_7_TO_0_8197F << BIT_SHIFT_GPIO_MOD_7_TO_0_8197F) -+#define BIT_CLEAR_GPIO_MOD_7_TO_0_8197F(x) ((x) & (~BITS_GPIO_MOD_7_TO_0_8197F)) -+#define BIT_GET_GPIO_MOD_7_TO_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_7_TO_0_8197F) & \ -+ BIT_MASK_GPIO_MOD_7_TO_0_8197F) -+#define BIT_SET_GPIO_MOD_7_TO_0_8197F(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_7_TO_0_8197F(x) | BIT_GPIO_MOD_7_TO_0_8197F(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8197F 16 -+#define BIT_MASK_GPIO_IO_SEL_7_TO_0_8197F 0xff -+#define BIT_GPIO_IO_SEL_7_TO_0_8197F(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_7_TO_0_8197F) \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8197F) -+#define BITS_GPIO_IO_SEL_7_TO_0_8197F \ -+ (BIT_MASK_GPIO_IO_SEL_7_TO_0_8197F \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8197F) -+#define BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8197F(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_7_TO_0_8197F)) -+#define BIT_GET_GPIO_IO_SEL_7_TO_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8197F) & \ -+ BIT_MASK_GPIO_IO_SEL_7_TO_0_8197F) -+#define BIT_SET_GPIO_IO_SEL_7_TO_0_8197F(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8197F(x) | \ -+ BIT_GPIO_IO_SEL_7_TO_0_8197F(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_7_TO_0_8197F 8 -+#define BIT_MASK_GPIO_OUT_7_TO_0_8197F 0xff -+#define BIT_GPIO_OUT_7_TO_0_8197F(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_7_TO_0_8197F) \ -+ << BIT_SHIFT_GPIO_OUT_7_TO_0_8197F) -+#define BITS_GPIO_OUT_7_TO_0_8197F \ -+ (BIT_MASK_GPIO_OUT_7_TO_0_8197F << BIT_SHIFT_GPIO_OUT_7_TO_0_8197F) -+#define BIT_CLEAR_GPIO_OUT_7_TO_0_8197F(x) ((x) & (~BITS_GPIO_OUT_7_TO_0_8197F)) -+#define BIT_GET_GPIO_OUT_7_TO_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_7_TO_0_8197F) & \ -+ BIT_MASK_GPIO_OUT_7_TO_0_8197F) -+#define BIT_SET_GPIO_OUT_7_TO_0_8197F(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_7_TO_0_8197F(x) | BIT_GPIO_OUT_7_TO_0_8197F(v)) -+ -+#define BIT_SHIFT_GPIO_IN_7_TO_0_8197F 0 -+#define BIT_MASK_GPIO_IN_7_TO_0_8197F 0xff -+#define BIT_GPIO_IN_7_TO_0_8197F(x) \ -+ (((x) & BIT_MASK_GPIO_IN_7_TO_0_8197F) \ -+ << BIT_SHIFT_GPIO_IN_7_TO_0_8197F) -+#define BITS_GPIO_IN_7_TO_0_8197F \ -+ (BIT_MASK_GPIO_IN_7_TO_0_8197F << BIT_SHIFT_GPIO_IN_7_TO_0_8197F) -+#define BIT_CLEAR_GPIO_IN_7_TO_0_8197F(x) ((x) & (~BITS_GPIO_IN_7_TO_0_8197F)) -+#define BIT_GET_GPIO_IN_7_TO_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_7_TO_0_8197F) & \ -+ BIT_MASK_GPIO_IN_7_TO_0_8197F) -+#define BIT_SET_GPIO_IN_7_TO_0_8197F(x, v) \ -+ (BIT_CLEAR_GPIO_IN_7_TO_0_8197F(x) | BIT_GPIO_IN_7_TO_0_8197F(v)) -+ -+/* 2 REG_GPIO_INTM_8197F */ -+ -+#define BIT_SHIFT_MUXDBG_SEL_8197F 30 -+#define BIT_MASK_MUXDBG_SEL_8197F 0x3 -+#define BIT_MUXDBG_SEL_8197F(x) \ -+ (((x) & BIT_MASK_MUXDBG_SEL_8197F) << BIT_SHIFT_MUXDBG_SEL_8197F) -+#define BITS_MUXDBG_SEL_8197F \ -+ (BIT_MASK_MUXDBG_SEL_8197F << BIT_SHIFT_MUXDBG_SEL_8197F) -+#define BIT_CLEAR_MUXDBG_SEL_8197F(x) ((x) & (~BITS_MUXDBG_SEL_8197F)) -+#define BIT_GET_MUXDBG_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_MUXDBG_SEL_8197F) & BIT_MASK_MUXDBG_SEL_8197F) -+#define BIT_SET_MUXDBG_SEL_8197F(x, v) \ -+ (BIT_CLEAR_MUXDBG_SEL_8197F(x) | BIT_MUXDBG_SEL_8197F(v)) -+ -+#define BIT_EXTWOL_SEL_8197F BIT(17) -+#define BIT_EXTWOL_EN_8197F BIT(16) -+#define BIT_GPIOF_INT_MD_8197F BIT(15) -+#define BIT_GPIOE_INT_MD_8197F BIT(14) -+#define BIT_GPIOD_INT_MD_8197F BIT(13) -+#define BIT_GPIOC_INT_MD_8197F BIT(12) -+#define BIT_GPIOB_INT_MD_8197F BIT(11) -+#define BIT_GPIOA_INT_MD_8197F BIT(10) -+#define BIT_GPIO9_INT_MD_8197F BIT(9) -+#define BIT_GPIO8_INT_MD_8197F BIT(8) -+#define BIT_GPIO7_INT_MD_8197F BIT(7) -+#define BIT_GPIO6_INT_MD_8197F BIT(6) -+#define BIT_GPIO5_INT_MD_8197F BIT(5) -+#define BIT_GPIO4_INT_MD_8197F BIT(4) -+#define BIT_GPIO3_INT_MD_8197F BIT(3) -+#define BIT_GPIO2_INT_MD_8197F BIT(2) -+#define BIT_GPIO1_INT_MD_8197F BIT(1) -+#define BIT_GPIO0_INT_MD_8197F BIT(0) -+ -+/* 2 REG_LED_CFG_8197F */ -+#define BIT_LNAON_SEL_EN_8197F BIT(26) -+#define BIT_PAPE_SEL_EN_8197F BIT(25) -+#define BIT_DPDT_WLBT_SEL_8197F BIT(24) -+#define BIT_DPDT_SEL_EN_8197F BIT(23) -+#define BIT_LED2DIS_V1_8197F BIT(22) -+#define BIT_LED2EN_8197F BIT(21) -+#define BIT_LED2PL_8197F BIT(20) -+#define BIT_LED2SV_8197F BIT(19) -+ -+#define BIT_SHIFT_LED2CM_8197F 16 -+#define BIT_MASK_LED2CM_8197F 0x7 -+#define BIT_LED2CM_8197F(x) \ -+ (((x) & BIT_MASK_LED2CM_8197F) << BIT_SHIFT_LED2CM_8197F) -+#define BITS_LED2CM_8197F (BIT_MASK_LED2CM_8197F << BIT_SHIFT_LED2CM_8197F) -+#define BIT_CLEAR_LED2CM_8197F(x) ((x) & (~BITS_LED2CM_8197F)) -+#define BIT_GET_LED2CM_8197F(x) \ -+ (((x) >> BIT_SHIFT_LED2CM_8197F) & BIT_MASK_LED2CM_8197F) -+#define BIT_SET_LED2CM_8197F(x, v) \ -+ (BIT_CLEAR_LED2CM_8197F(x) | BIT_LED2CM_8197F(v)) -+ -+#define BIT_LED1DIS_8197F BIT(15) -+#define BIT_LED1PL_8197F BIT(12) -+#define BIT_LED1SV_8197F BIT(11) -+ -+#define BIT_SHIFT_LED1CM_8197F 8 -+#define BIT_MASK_LED1CM_8197F 0x7 -+#define BIT_LED1CM_8197F(x) \ -+ (((x) & BIT_MASK_LED1CM_8197F) << BIT_SHIFT_LED1CM_8197F) -+#define BITS_LED1CM_8197F (BIT_MASK_LED1CM_8197F << BIT_SHIFT_LED1CM_8197F) -+#define BIT_CLEAR_LED1CM_8197F(x) ((x) & (~BITS_LED1CM_8197F)) -+#define BIT_GET_LED1CM_8197F(x) \ -+ (((x) >> BIT_SHIFT_LED1CM_8197F) & BIT_MASK_LED1CM_8197F) -+#define BIT_SET_LED1CM_8197F(x, v) \ -+ (BIT_CLEAR_LED1CM_8197F(x) | BIT_LED1CM_8197F(v)) -+ -+#define BIT_LED0DIS_8197F BIT(7) -+ -+#define BIT_SHIFT_AFE_LDO_SWR_CHECK_8197F 5 -+#define BIT_MASK_AFE_LDO_SWR_CHECK_8197F 0x3 -+#define BIT_AFE_LDO_SWR_CHECK_8197F(x) \ -+ (((x) & BIT_MASK_AFE_LDO_SWR_CHECK_8197F) \ -+ << BIT_SHIFT_AFE_LDO_SWR_CHECK_8197F) -+#define BITS_AFE_LDO_SWR_CHECK_8197F \ -+ (BIT_MASK_AFE_LDO_SWR_CHECK_8197F << BIT_SHIFT_AFE_LDO_SWR_CHECK_8197F) -+#define BIT_CLEAR_AFE_LDO_SWR_CHECK_8197F(x) \ -+ ((x) & (~BITS_AFE_LDO_SWR_CHECK_8197F)) -+#define BIT_GET_AFE_LDO_SWR_CHECK_8197F(x) \ -+ (((x) >> BIT_SHIFT_AFE_LDO_SWR_CHECK_8197F) & \ -+ BIT_MASK_AFE_LDO_SWR_CHECK_8197F) -+#define BIT_SET_AFE_LDO_SWR_CHECK_8197F(x, v) \ -+ (BIT_CLEAR_AFE_LDO_SWR_CHECK_8197F(x) | BIT_AFE_LDO_SWR_CHECK_8197F(v)) -+ -+#define BIT_LED0PL_8197F BIT(4) -+#define BIT_LED0SV_8197F BIT(3) -+ -+#define BIT_SHIFT_LED0CM_8197F 0 -+#define BIT_MASK_LED0CM_8197F 0x7 -+#define BIT_LED0CM_8197F(x) \ -+ (((x) & BIT_MASK_LED0CM_8197F) << BIT_SHIFT_LED0CM_8197F) -+#define BITS_LED0CM_8197F (BIT_MASK_LED0CM_8197F << BIT_SHIFT_LED0CM_8197F) -+#define BIT_CLEAR_LED0CM_8197F(x) ((x) & (~BITS_LED0CM_8197F)) -+#define BIT_GET_LED0CM_8197F(x) \ -+ (((x) >> BIT_SHIFT_LED0CM_8197F) & BIT_MASK_LED0CM_8197F) -+#define BIT_SET_LED0CM_8197F(x, v) \ -+ (BIT_CLEAR_LED0CM_8197F(x) | BIT_LED0CM_8197F(v)) -+ -+/* 2 REG_FSIMR_8197F */ -+#define BIT_FS_PDNINT_EN_8197F BIT(31) -+#define BIT_FS_SPS_OCP_INT_EN_8197F BIT(29) -+#define BIT_FS_PWMERR_INT_EN_8197F BIT(28) -+#define BIT_FS_GPIOF_INT_EN_8197F BIT(27) -+#define BIT_FS_GPIOE_INT_EN_8197F BIT(26) -+#define BIT_FS_GPIOD_INT_EN_8197F BIT(25) -+#define BIT_FS_GPIOC_INT_EN_8197F BIT(24) -+#define BIT_FS_GPIOB_INT_EN_8197F BIT(23) -+#define BIT_FS_GPIOA_INT_EN_8197F BIT(22) -+#define BIT_FS_GPIO9_INT_EN_8197F BIT(21) -+#define BIT_FS_GPIO8_INT_EN_8197F BIT(20) -+#define BIT_FS_GPIO7_INT_EN_8197F BIT(19) -+#define BIT_FS_GPIO6_INT_EN_8197F BIT(18) -+#define BIT_FS_GPIO5_INT_EN_8197F BIT(17) -+#define BIT_FS_GPIO4_INT_EN_8197F BIT(16) -+#define BIT_FS_GPIO3_INT_EN_8197F BIT(15) -+#define BIT_FS_GPIO2_INT_EN_8197F BIT(14) -+#define BIT_FS_GPIO1_INT_EN_8197F BIT(13) -+#define BIT_FS_GPIO0_INT_EN_8197F BIT(12) -+#define BIT_FS_HCI_SUS_EN_8197F BIT(11) -+#define BIT_FS_HCI_RES_EN_8197F BIT(10) -+#define BIT_FS_HCI_RESET_EN_8197F BIT(9) -+#define BIT_AXI_EXCEPT_FINT_EN_8197F BIT(8) -+#define BIT_FS_BTON_STS_UPDATE_MSK_EN_8197F BIT(7) -+#define BIT_ACT2RECOVERY_INT_EN_V1_8197F BIT(6) -+#define BIT_FS_TRPC_TO_INT_EN_8197F BIT(5) -+#define BIT_FS_RPC_O_T_INT_EN_8197F BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_MAK_8197F BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_MAK_8197F BIT(2) -+#define BIT_FS_USB_LPMRSM_MSK_8197F BIT(1) -+#define BIT_FS_USB_LPMINT_MSK_8197F BIT(0) -+ -+/* 2 REG_FSISR_8197F */ -+#define BIT_FS_PDNINT_8197F BIT(31) -+#define BIT_FS_SPS_OCP_INT_8197F BIT(29) -+#define BIT_FS_PWMERR_INT_8197F BIT(28) -+#define BIT_FS_GPIOF_INT_8197F BIT(27) -+#define BIT_FS_GPIOE_INT_8197F BIT(26) -+#define BIT_FS_GPIOD_INT_8197F BIT(25) -+#define BIT_FS_GPIOC_INT_8197F BIT(24) -+#define BIT_FS_GPIOB_INT_8197F BIT(23) -+#define BIT_FS_GPIOA_INT_8197F BIT(22) -+#define BIT_FS_GPIO9_INT_8197F BIT(21) -+#define BIT_FS_GPIO8_INT_8197F BIT(20) -+#define BIT_FS_GPIO7_INT_8197F BIT(19) -+#define BIT_FS_GPIO6_INT_8197F BIT(18) -+#define BIT_FS_GPIO5_INT_8197F BIT(17) -+#define BIT_FS_GPIO4_INT_8197F BIT(16) -+#define BIT_FS_GPIO3_INT_8197F BIT(15) -+#define BIT_FS_GPIO2_INT_8197F BIT(14) -+#define BIT_FS_GPIO1_INT_8197F BIT(13) -+#define BIT_FS_GPIO0_INT_8197F BIT(12) -+#define BIT_FS_HCI_SUS_INT_8197F BIT(11) -+#define BIT_FS_HCI_RES_INT_8197F BIT(10) -+#define BIT_FS_HCI_RESET_INT_8197F BIT(9) -+#define BIT_AXI_EXCEPT_FINT_8197F BIT(8) -+#define BIT_FS_BTON_STS_UPDATE_INT_8197F BIT(7) -+#define BIT_ACT2RECOVERY_INT_V1_8197F BIT(6) -+#define BIT_FS_TRPC_TO_INT_INT_8197F BIT(5) -+#define BIT_FS_RPC_O_T_INT_INT_8197F BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_INT_8197F BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_INT_8197F BIT(2) -+#define BIT_FS_USB_LPMRSM_INT_8197F BIT(1) -+#define BIT_FS_USB_LPMINT_INT_8197F BIT(0) -+ -+/* 2 REG_HSIMR_8197F */ -+#define BIT_GPIOF_INT_EN_8197F BIT(31) -+#define BIT_GPIOE_INT_EN_8197F BIT(30) -+#define BIT_GPIOD_INT_EN_8197F BIT(29) -+#define BIT_GPIOC_INT_EN_8197F BIT(28) -+#define BIT_GPIOB_INT_EN_8197F BIT(27) -+#define BIT_GPIOA_INT_EN_8197F BIT(26) -+#define BIT_GPIO9_INT_EN_8197F BIT(25) -+#define BIT_GPIO8_INT_EN_8197F BIT(24) -+#define BIT_GPIO7_INT_EN_8197F BIT(23) -+#define BIT_GPIO6_INT_EN_8197F BIT(22) -+#define BIT_GPIO5_INT_EN_8197F BIT(21) -+#define BIT_GPIO4_INT_EN_8197F BIT(20) -+#define BIT_GPIO3_INT_EN_8197F BIT(19) -+#define BIT_GPIO2_INT_EN_8197F BIT(18) -+#define BIT_GPIO1_INT_EN_8197F BIT(17) -+#define BIT_GPIO0_INT_EN_8197F BIT(16) -+#define BIT_AXI_EXCEPT_HINT_EN_8197F BIT(9) -+#define BIT_PDNINT_EN_V2_8197F BIT(8) -+#define BIT_PDNINT_EN_V1_8197F BIT(7) -+#define BIT_RON_INT_EN_V1_8197F BIT(6) -+#define BIT_SPS_OCP_INT_EN_V1_8197F BIT(5) -+#define BIT_GPIO15_0_INT_EN_V1_8197F BIT(0) -+ -+/* 2 REG_HSISR_8197F */ -+#define BIT_GPIOF_INT_8197F BIT(31) -+#define BIT_GPIOE_INT_8197F BIT(30) -+#define BIT_GPIOD_INT_8197F BIT(29) -+#define BIT_GPIOC_INT_8197F BIT(28) -+#define BIT_GPIOB_INT_8197F BIT(27) -+#define BIT_GPIOA_INT_8197F BIT(26) -+#define BIT_GPIO9_INT_8197F BIT(25) -+#define BIT_GPIO8_INT_8197F BIT(24) -+#define BIT_GPIO7_INT_8197F BIT(23) -+#define BIT_GPIO6_INT_8197F BIT(22) -+#define BIT_GPIO5_INT_8197F BIT(21) -+#define BIT_GPIO4_INT_8197F BIT(20) -+#define BIT_GPIO3_INT_8197F BIT(19) -+#define BIT_GPIO2_INT_8197F BIT(18) -+#define BIT_GPIO1_INT_8197F BIT(17) -+#define BIT_GPIO0_INT_8197F BIT(16) -+#define BIT_AXI_EXCEPT_HINT_8197F BIT(8) -+#define BIT_PDNINT_V1_8197F BIT(7) -+#define BIT_RON_INT_V1_8197F BIT(6) -+#define BIT_SPS_OCP_INT_V1_8197F BIT(5) -+#define BIT_GPIO15_0_INT_V1_8197F BIT(0) -+ -+/* 2 REG_GPIO_EXT_CTRL_8197F */ -+ -+#define BIT_SHIFT_GPIO_MOD_15_TO_8_8197F 24 -+#define BIT_MASK_GPIO_MOD_15_TO_8_8197F 0xff -+#define BIT_GPIO_MOD_15_TO_8_8197F(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_15_TO_8_8197F) \ -+ << BIT_SHIFT_GPIO_MOD_15_TO_8_8197F) -+#define BITS_GPIO_MOD_15_TO_8_8197F \ -+ (BIT_MASK_GPIO_MOD_15_TO_8_8197F << BIT_SHIFT_GPIO_MOD_15_TO_8_8197F) -+#define BIT_CLEAR_GPIO_MOD_15_TO_8_8197F(x) \ -+ ((x) & (~BITS_GPIO_MOD_15_TO_8_8197F)) -+#define BIT_GET_GPIO_MOD_15_TO_8_8197F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_15_TO_8_8197F) & \ -+ BIT_MASK_GPIO_MOD_15_TO_8_8197F) -+#define BIT_SET_GPIO_MOD_15_TO_8_8197F(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_15_TO_8_8197F(x) | BIT_GPIO_MOD_15_TO_8_8197F(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8197F 16 -+#define BIT_MASK_GPIO_IO_SEL_15_TO_8_8197F 0xff -+#define BIT_GPIO_IO_SEL_15_TO_8_8197F(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_15_TO_8_8197F) \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8197F) -+#define BITS_GPIO_IO_SEL_15_TO_8_8197F \ -+ (BIT_MASK_GPIO_IO_SEL_15_TO_8_8197F \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8197F) -+#define BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8197F(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_15_TO_8_8197F)) -+#define BIT_GET_GPIO_IO_SEL_15_TO_8_8197F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8197F) & \ -+ BIT_MASK_GPIO_IO_SEL_15_TO_8_8197F) -+#define BIT_SET_GPIO_IO_SEL_15_TO_8_8197F(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8197F(x) | \ -+ BIT_GPIO_IO_SEL_15_TO_8_8197F(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_15_TO_8_8197F 8 -+#define BIT_MASK_GPIO_OUT_15_TO_8_8197F 0xff -+#define BIT_GPIO_OUT_15_TO_8_8197F(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_15_TO_8_8197F) \ -+ << BIT_SHIFT_GPIO_OUT_15_TO_8_8197F) -+#define BITS_GPIO_OUT_15_TO_8_8197F \ -+ (BIT_MASK_GPIO_OUT_15_TO_8_8197F << BIT_SHIFT_GPIO_OUT_15_TO_8_8197F) -+#define BIT_CLEAR_GPIO_OUT_15_TO_8_8197F(x) \ -+ ((x) & (~BITS_GPIO_OUT_15_TO_8_8197F)) -+#define BIT_GET_GPIO_OUT_15_TO_8_8197F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_15_TO_8_8197F) & \ -+ BIT_MASK_GPIO_OUT_15_TO_8_8197F) -+#define BIT_SET_GPIO_OUT_15_TO_8_8197F(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_15_TO_8_8197F(x) | BIT_GPIO_OUT_15_TO_8_8197F(v)) -+ -+#define BIT_SHIFT_GPIO_IN_15_TO_8_8197F 0 -+#define BIT_MASK_GPIO_IN_15_TO_8_8197F 0xff -+#define BIT_GPIO_IN_15_TO_8_8197F(x) \ -+ (((x) & BIT_MASK_GPIO_IN_15_TO_8_8197F) \ -+ << BIT_SHIFT_GPIO_IN_15_TO_8_8197F) -+#define BITS_GPIO_IN_15_TO_8_8197F \ -+ (BIT_MASK_GPIO_IN_15_TO_8_8197F << BIT_SHIFT_GPIO_IN_15_TO_8_8197F) -+#define BIT_CLEAR_GPIO_IN_15_TO_8_8197F(x) ((x) & (~BITS_GPIO_IN_15_TO_8_8197F)) -+#define BIT_GET_GPIO_IN_15_TO_8_8197F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_15_TO_8_8197F) & \ -+ BIT_MASK_GPIO_IN_15_TO_8_8197F) -+#define BIT_SET_GPIO_IN_15_TO_8_8197F(x, v) \ -+ (BIT_CLEAR_GPIO_IN_15_TO_8_8197F(x) | BIT_GPIO_IN_15_TO_8_8197F(v)) -+ -+/* 2 REG_PAD_CTRL1_8197F */ -+#define BIT_PAPE_WLBT_SEL_8197F BIT(29) -+#define BIT_LNAON_WLBT_SEL_8197F BIT(28) -+#define BIT_BTGP_GPG3_FEN_8197F BIT(26) -+#define BIT_BTGP_GPG2_FEN_8197F BIT(25) -+#define BIT_BTGP_JTAG_EN_8197F BIT(24) -+#define BIT_XTAL_CLK_EXTARNAL_EN_8197F BIT(23) -+#define BIT_BTGP_UART0_EN_8197F BIT(22) -+#define BIT_BTGP_UART1_EN_8197F BIT(21) -+#define BIT_BTGP_SPI_EN_8197F BIT(20) -+#define BIT_BTGP_GPIO_E2_8197F BIT(19) -+#define BIT_BTGP_GPIO_EN_8197F BIT(18) -+ -+#define BIT_SHIFT_BTGP_GPIO_SL_8197F 16 -+#define BIT_MASK_BTGP_GPIO_SL_8197F 0x3 -+#define BIT_BTGP_GPIO_SL_8197F(x) \ -+ (((x) & BIT_MASK_BTGP_GPIO_SL_8197F) << BIT_SHIFT_BTGP_GPIO_SL_8197F) -+#define BITS_BTGP_GPIO_SL_8197F \ -+ (BIT_MASK_BTGP_GPIO_SL_8197F << BIT_SHIFT_BTGP_GPIO_SL_8197F) -+#define BIT_CLEAR_BTGP_GPIO_SL_8197F(x) ((x) & (~BITS_BTGP_GPIO_SL_8197F)) -+#define BIT_GET_BTGP_GPIO_SL_8197F(x) \ -+ (((x) >> BIT_SHIFT_BTGP_GPIO_SL_8197F) & BIT_MASK_BTGP_GPIO_SL_8197F) -+#define BIT_SET_BTGP_GPIO_SL_8197F(x, v) \ -+ (BIT_CLEAR_BTGP_GPIO_SL_8197F(x) | BIT_BTGP_GPIO_SL_8197F(v)) -+ -+#define BIT_PAD_SDIO_SR_8197F BIT(14) -+#define BIT_GPIO14_OUTPUT_PL_8197F BIT(13) -+#define BIT_HOST_WAKE_PAD_PULL_EN_8197F BIT(12) -+#define BIT_HOST_WAKE_PAD_SL_8197F BIT(11) -+#define BIT_PAD_LNAON_SR_8197F BIT(10) -+#define BIT_PAD_LNAON_E2_8197F BIT(9) -+#define BIT_SW_LNAON_G_SEL_DATA_8197F BIT(8) -+#define BIT_SW_LNAON_A_SEL_DATA_8197F BIT(7) -+#define BIT_PAD_PAPE_SR_8197F BIT(6) -+#define BIT_PAD_PAPE_E2_8197F BIT(5) -+#define BIT_SW_PAPE_G_SEL_DATA_8197F BIT(4) -+#define BIT_SW_PAPE_A_SEL_DATA_8197F BIT(3) -+#define BIT_PAD_DPDT_SR_8197F BIT(2) -+#define BIT_PAD_DPDT_PAD_E2_8197F BIT(1) -+#define BIT_SW_DPDT_SEL_DATA_8197F BIT(0) -+ -+/* 2 REG_WL_BT_PWR_CTRL_8197F */ -+#define BIT_ISO_BD2PP_8197F BIT(31) -+#define BIT_LDOV12B_EN_8197F BIT(30) -+#define BIT_CKEN_BTGPS_8197F BIT(29) -+#define BIT_FEN_BTGPS_8197F BIT(28) -+#define BIT_BTCPU_BOOTSEL_8197F BIT(27) -+#define BIT_SPI_SPEEDUP_8197F BIT(26) -+#define BIT_DEVWAKE_PAD_TYPE_SEL_8197F BIT(24) -+#define BIT_CLKREQ_PAD_TYPE_SEL_8197F BIT(23) -+#define BIT_ISO_BTPON2PP_8197F BIT(22) -+#define BIT_BT_HWROF_EN_8197F BIT(19) -+#define BIT_BT_FUNC_EN_8197F BIT(18) -+#define BIT_BT_HWPDN_SL_8197F BIT(17) -+#define BIT_BT_DISN_EN_8197F BIT(16) -+#define BIT_BT_PDN_PULL_EN_8197F BIT(15) -+#define BIT_WL_PDN_PULL_EN_8197F BIT(14) -+#define BIT_EXTERNAL_REQUEST_PL_8197F BIT(13) -+#define BIT_GPIO0_2_3_PULL_LOW_EN_8197F BIT(12) -+#define BIT_ISO_BA2PP_8197F BIT(11) -+#define BIT_BT_AFE_LDO_EN_8197F BIT(10) -+#define BIT_BT_AFE_PLL_EN_8197F BIT(9) -+#define BIT_BT_DIG_CLK_EN_8197F BIT(8) -+#define BIT_WL_DRV_EXIST_IDX_8197F BIT(5) -+#define BIT_DOP_EHPAD_8197F BIT(4) -+#define BIT_WL_HWROF_EN_8197F BIT(3) -+#define BIT_WL_FUNC_EN_8197F BIT(2) -+#define BIT_WL_HWPDN_SL_8197F BIT(1) -+#define BIT_WL_HWPDN_EN_8197F BIT(0) -+ -+/* 2 REG_SDM_DEBUG_8197F */ -+ -+#define BIT_SHIFT_WLCLK_PHASE_8197F 0 -+#define BIT_MASK_WLCLK_PHASE_8197F 0x1f -+#define BIT_WLCLK_PHASE_8197F(x) \ -+ (((x) & BIT_MASK_WLCLK_PHASE_8197F) << BIT_SHIFT_WLCLK_PHASE_8197F) -+#define BITS_WLCLK_PHASE_8197F \ -+ (BIT_MASK_WLCLK_PHASE_8197F << BIT_SHIFT_WLCLK_PHASE_8197F) -+#define BIT_CLEAR_WLCLK_PHASE_8197F(x) ((x) & (~BITS_WLCLK_PHASE_8197F)) -+#define BIT_GET_WLCLK_PHASE_8197F(x) \ -+ (((x) >> BIT_SHIFT_WLCLK_PHASE_8197F) & BIT_MASK_WLCLK_PHASE_8197F) -+#define BIT_SET_WLCLK_PHASE_8197F(x, v) \ -+ (BIT_CLEAR_WLCLK_PHASE_8197F(x) | BIT_WLCLK_PHASE_8197F(v)) -+ -+/* 2 REG_SYS_SDIO_CTRL_8197F */ -+#define BIT_DBG_GNT_WL_BT_8197F BIT(27) -+#define BIT_LTE_MUX_CTRL_PATH_8197F BIT(26) -+#define BIT_SDIO_INT_POLARITY_8197F BIT(19) -+#define BIT_SDIO_INT_8197F BIT(18) -+#define BIT_SDIO_OFF_EN_8197F BIT(17) -+#define BIT_SDIO_ON_EN_8197F BIT(16) -+ -+/* 2 REG_HCI_OPT_CTRL_8197F */ -+#define BIT_USB_HOST_PWR_OFF_EN_8197F BIT(12) -+#define BIT_SYM_LPS_BLOCK_EN_8197F BIT(11) -+#define BIT_USB_LPM_ACT_EN_8197F BIT(10) -+#define BIT_USB_LPM_NY_8197F BIT(9) -+#define BIT_USB_SUS_DIS_8197F BIT(8) -+ -+#define BIT_SHIFT_SDIO_PAD_E_8197F 5 -+#define BIT_MASK_SDIO_PAD_E_8197F 0x7 -+#define BIT_SDIO_PAD_E_8197F(x) \ -+ (((x) & BIT_MASK_SDIO_PAD_E_8197F) << BIT_SHIFT_SDIO_PAD_E_8197F) -+#define BITS_SDIO_PAD_E_8197F \ -+ (BIT_MASK_SDIO_PAD_E_8197F << BIT_SHIFT_SDIO_PAD_E_8197F) -+#define BIT_CLEAR_SDIO_PAD_E_8197F(x) ((x) & (~BITS_SDIO_PAD_E_8197F)) -+#define BIT_GET_SDIO_PAD_E_8197F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_PAD_E_8197F) & BIT_MASK_SDIO_PAD_E_8197F) -+#define BIT_SET_SDIO_PAD_E_8197F(x, v) \ -+ (BIT_CLEAR_SDIO_PAD_E_8197F(x) | BIT_SDIO_PAD_E_8197F(v)) -+ -+#define BIT_USB_LPPLL_EN_8197F BIT(4) -+#define BIT_ROP_SW15_8197F BIT(2) -+#define BIT_PCI_CKRDY_OPT_8197F BIT(1) -+#define BIT_PCI_VAUX_EN_8197F BIT(0) -+ -+/* 2 REG_AFE_CTRL4_8197F */ -+#define BIT_RF1_SDMRSTB_8197F BIT(26) -+#define BIT_RF1_RSTB_8197F BIT(25) -+#define BIT_RF1_EN_8197F BIT(24) -+ -+#define BIT_SHIFT_XTAL_LDO_8197F 20 -+#define BIT_MASK_XTAL_LDO_8197F 0x7 -+#define BIT_XTAL_LDO_8197F(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_8197F) << BIT_SHIFT_XTAL_LDO_8197F) -+#define BITS_XTAL_LDO_8197F \ -+ (BIT_MASK_XTAL_LDO_8197F << BIT_SHIFT_XTAL_LDO_8197F) -+#define BIT_CLEAR_XTAL_LDO_8197F(x) ((x) & (~BITS_XTAL_LDO_8197F)) -+#define BIT_GET_XTAL_LDO_8197F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_8197F) & BIT_MASK_XTAL_LDO_8197F) -+#define BIT_SET_XTAL_LDO_8197F(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_8197F(x) | BIT_XTAL_LDO_8197F(v)) -+ -+#define BIT_ADC_CK_SYNC_EN_8197F BIT(16) -+ -+/* 2 REG_LDO_SWR_CTRL_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_MCUFW_CTRL_8197F */ -+ -+#define BIT_SHIFT_RPWM_8197F 24 -+#define BIT_MASK_RPWM_8197F 0xff -+#define BIT_RPWM_8197F(x) (((x) & BIT_MASK_RPWM_8197F) << BIT_SHIFT_RPWM_8197F) -+#define BITS_RPWM_8197F (BIT_MASK_RPWM_8197F << BIT_SHIFT_RPWM_8197F) -+#define BIT_CLEAR_RPWM_8197F(x) ((x) & (~BITS_RPWM_8197F)) -+#define BIT_GET_RPWM_8197F(x) \ -+ (((x) >> BIT_SHIFT_RPWM_8197F) & BIT_MASK_RPWM_8197F) -+#define BIT_SET_RPWM_8197F(x, v) (BIT_CLEAR_RPWM_8197F(x) | BIT_RPWM_8197F(v)) -+ -+#define BIT_CPRST_8197F BIT(23) -+#define BIT_ANA_PORT_EN_8197F BIT(22) -+#define BIT_MAC_PORT_EN_8197F BIT(21) -+#define BIT_BOOT_FSPI_EN_8197F BIT(20) -+#define BIT_ROM_DLEN_8197F BIT(19) -+ -+#define BIT_SHIFT_ROM_PGE_8197F 16 -+#define BIT_MASK_ROM_PGE_8197F 0x7 -+#define BIT_ROM_PGE_8197F(x) \ -+ (((x) & BIT_MASK_ROM_PGE_8197F) << BIT_SHIFT_ROM_PGE_8197F) -+#define BITS_ROM_PGE_8197F (BIT_MASK_ROM_PGE_8197F << BIT_SHIFT_ROM_PGE_8197F) -+#define BIT_CLEAR_ROM_PGE_8197F(x) ((x) & (~BITS_ROM_PGE_8197F)) -+#define BIT_GET_ROM_PGE_8197F(x) \ -+ (((x) >> BIT_SHIFT_ROM_PGE_8197F) & BIT_MASK_ROM_PGE_8197F) -+#define BIT_SET_ROM_PGE_8197F(x, v) \ -+ (BIT_CLEAR_ROM_PGE_8197F(x) | BIT_ROM_PGE_8197F(v)) -+ -+#define BIT_FW_INIT_RDY_8197F BIT(15) -+#define BIT_FW_DW_RDY_8197F BIT(14) -+ -+#define BIT_SHIFT_CPU_CLK_SEL_8197F 12 -+#define BIT_MASK_CPU_CLK_SEL_8197F 0x3 -+#define BIT_CPU_CLK_SEL_8197F(x) \ -+ (((x) & BIT_MASK_CPU_CLK_SEL_8197F) << BIT_SHIFT_CPU_CLK_SEL_8197F) -+#define BITS_CPU_CLK_SEL_8197F \ -+ (BIT_MASK_CPU_CLK_SEL_8197F << BIT_SHIFT_CPU_CLK_SEL_8197F) -+#define BIT_CLEAR_CPU_CLK_SEL_8197F(x) ((x) & (~BITS_CPU_CLK_SEL_8197F)) -+#define BIT_GET_CPU_CLK_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_CPU_CLK_SEL_8197F) & BIT_MASK_CPU_CLK_SEL_8197F) -+#define BIT_SET_CPU_CLK_SEL_8197F(x, v) \ -+ (BIT_CLEAR_CPU_CLK_SEL_8197F(x) | BIT_CPU_CLK_SEL_8197F(v)) -+ -+#define BIT_CCLK_CHG_MASK_8197F BIT(11) -+#define BIT_FW_INIT_RDY_V1_8197F BIT(10) -+#define BIT_R_8051_SPD_8197F BIT(9) -+#define BIT_MCU_CLK_EN_8197F BIT(8) -+#define BIT_RAM_DL_SEL_8197F BIT(7) -+#define BIT_WINTINI_RDY_8197F BIT(6) -+#define BIT_RF_INIT_RDY_8197F BIT(5) -+#define BIT_BB_INIT_RDY_8197F BIT(4) -+#define BIT_MAC_INIT_RDY_8197F BIT(3) -+#define BIT_MCU_FWDL_RDY_8197F BIT(1) -+#define BIT_MCU_FWDL_EN_8197F BIT(0) -+ -+/* 2 REG_MCU_TST_CFG_8197F */ -+ -+#define BIT_SHIFT_LBKTST_8197F 0 -+#define BIT_MASK_LBKTST_8197F 0xffff -+#define BIT_LBKTST_8197F(x) \ -+ (((x) & BIT_MASK_LBKTST_8197F) << BIT_SHIFT_LBKTST_8197F) -+#define BITS_LBKTST_8197F (BIT_MASK_LBKTST_8197F << BIT_SHIFT_LBKTST_8197F) -+#define BIT_CLEAR_LBKTST_8197F(x) ((x) & (~BITS_LBKTST_8197F)) -+#define BIT_GET_LBKTST_8197F(x) \ -+ (((x) >> BIT_SHIFT_LBKTST_8197F) & BIT_MASK_LBKTST_8197F) -+#define BIT_SET_LBKTST_8197F(x, v) \ -+ (BIT_CLEAR_LBKTST_8197F(x) | BIT_LBKTST_8197F(v)) -+ -+/* 2 REG_HMEBOX_E0_E1_8197F */ -+ -+#define BIT_SHIFT_HOST_MSG_E1_8197F 16 -+#define BIT_MASK_HOST_MSG_E1_8197F 0xffff -+#define BIT_HOST_MSG_E1_8197F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E1_8197F) << BIT_SHIFT_HOST_MSG_E1_8197F) -+#define BITS_HOST_MSG_E1_8197F \ -+ (BIT_MASK_HOST_MSG_E1_8197F << BIT_SHIFT_HOST_MSG_E1_8197F) -+#define BIT_CLEAR_HOST_MSG_E1_8197F(x) ((x) & (~BITS_HOST_MSG_E1_8197F)) -+#define BIT_GET_HOST_MSG_E1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E1_8197F) & BIT_MASK_HOST_MSG_E1_8197F) -+#define BIT_SET_HOST_MSG_E1_8197F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E1_8197F(x) | BIT_HOST_MSG_E1_8197F(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E0_8197F 0 -+#define BIT_MASK_HOST_MSG_E0_8197F 0xffff -+#define BIT_HOST_MSG_E0_8197F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E0_8197F) << BIT_SHIFT_HOST_MSG_E0_8197F) -+#define BITS_HOST_MSG_E0_8197F \ -+ (BIT_MASK_HOST_MSG_E0_8197F << BIT_SHIFT_HOST_MSG_E0_8197F) -+#define BIT_CLEAR_HOST_MSG_E0_8197F(x) ((x) & (~BITS_HOST_MSG_E0_8197F)) -+#define BIT_GET_HOST_MSG_E0_8197F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E0_8197F) & BIT_MASK_HOST_MSG_E0_8197F) -+#define BIT_SET_HOST_MSG_E0_8197F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E0_8197F(x) | BIT_HOST_MSG_E0_8197F(v)) -+ -+/* 2 REG_HMEBOX_E2_E3_8197F */ -+ -+#define BIT_SHIFT_HOST_MSG_E3_8197F 16 -+#define BIT_MASK_HOST_MSG_E3_8197F 0xffff -+#define BIT_HOST_MSG_E3_8197F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E3_8197F) << BIT_SHIFT_HOST_MSG_E3_8197F) -+#define BITS_HOST_MSG_E3_8197F \ -+ (BIT_MASK_HOST_MSG_E3_8197F << BIT_SHIFT_HOST_MSG_E3_8197F) -+#define BIT_CLEAR_HOST_MSG_E3_8197F(x) ((x) & (~BITS_HOST_MSG_E3_8197F)) -+#define BIT_GET_HOST_MSG_E3_8197F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E3_8197F) & BIT_MASK_HOST_MSG_E3_8197F) -+#define BIT_SET_HOST_MSG_E3_8197F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E3_8197F(x) | BIT_HOST_MSG_E3_8197F(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E2_8197F 0 -+#define BIT_MASK_HOST_MSG_E2_8197F 0xffff -+#define BIT_HOST_MSG_E2_8197F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E2_8197F) << BIT_SHIFT_HOST_MSG_E2_8197F) -+#define BITS_HOST_MSG_E2_8197F \ -+ (BIT_MASK_HOST_MSG_E2_8197F << BIT_SHIFT_HOST_MSG_E2_8197F) -+#define BIT_CLEAR_HOST_MSG_E2_8197F(x) ((x) & (~BITS_HOST_MSG_E2_8197F)) -+#define BIT_GET_HOST_MSG_E2_8197F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E2_8197F) & BIT_MASK_HOST_MSG_E2_8197F) -+#define BIT_SET_HOST_MSG_E2_8197F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E2_8197F(x) | BIT_HOST_MSG_E2_8197F(v)) -+ -+/* 2 REG_WLLPS_CTRL_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_AFE_CTRL5_8197F */ -+#define BIT_BB_DBG_SEL_AFE_SDM_V3_8197F BIT(31) -+#define BIT_ORDER_SDM_8197F BIT(30) -+#define BIT_RFE_SEL_SDM_8197F BIT(29) -+ -+#define BIT_SHIFT_REF_SEL_8197F 25 -+#define BIT_MASK_REF_SEL_8197F 0xf -+#define BIT_REF_SEL_8197F(x) \ -+ (((x) & BIT_MASK_REF_SEL_8197F) << BIT_SHIFT_REF_SEL_8197F) -+#define BITS_REF_SEL_8197F (BIT_MASK_REF_SEL_8197F << BIT_SHIFT_REF_SEL_8197F) -+#define BIT_CLEAR_REF_SEL_8197F(x) ((x) & (~BITS_REF_SEL_8197F)) -+#define BIT_GET_REF_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_REF_SEL_8197F) & BIT_MASK_REF_SEL_8197F) -+#define BIT_SET_REF_SEL_8197F(x, v) \ -+ (BIT_CLEAR_REF_SEL_8197F(x) | BIT_REF_SEL_8197F(v)) -+ -+#define BIT_SHIFT_F0F_SDM_V2_8197F 12 -+#define BIT_MASK_F0F_SDM_V2_8197F 0x1fff -+#define BIT_F0F_SDM_V2_8197F(x) \ -+ (((x) & BIT_MASK_F0F_SDM_V2_8197F) << BIT_SHIFT_F0F_SDM_V2_8197F) -+#define BITS_F0F_SDM_V2_8197F \ -+ (BIT_MASK_F0F_SDM_V2_8197F << BIT_SHIFT_F0F_SDM_V2_8197F) -+#define BIT_CLEAR_F0F_SDM_V2_8197F(x) ((x) & (~BITS_F0F_SDM_V2_8197F)) -+#define BIT_GET_F0F_SDM_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_F0F_SDM_V2_8197F) & BIT_MASK_F0F_SDM_V2_8197F) -+#define BIT_SET_F0F_SDM_V2_8197F(x, v) \ -+ (BIT_CLEAR_F0F_SDM_V2_8197F(x) | BIT_F0F_SDM_V2_8197F(v)) -+ -+#define BIT_SHIFT_F0N_SDM_V2_8197F 9 -+#define BIT_MASK_F0N_SDM_V2_8197F 0x7 -+#define BIT_F0N_SDM_V2_8197F(x) \ -+ (((x) & BIT_MASK_F0N_SDM_V2_8197F) << BIT_SHIFT_F0N_SDM_V2_8197F) -+#define BITS_F0N_SDM_V2_8197F \ -+ (BIT_MASK_F0N_SDM_V2_8197F << BIT_SHIFT_F0N_SDM_V2_8197F) -+#define BIT_CLEAR_F0N_SDM_V2_8197F(x) ((x) & (~BITS_F0N_SDM_V2_8197F)) -+#define BIT_GET_F0N_SDM_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_F0N_SDM_V2_8197F) & BIT_MASK_F0N_SDM_V2_8197F) -+#define BIT_SET_F0N_SDM_V2_8197F(x, v) \ -+ (BIT_CLEAR_F0N_SDM_V2_8197F(x) | BIT_F0N_SDM_V2_8197F(v)) -+ -+#define BIT_SHIFT_DIVN_SDM_V2_8197F 3 -+#define BIT_MASK_DIVN_SDM_V2_8197F 0x3f -+#define BIT_DIVN_SDM_V2_8197F(x) \ -+ (((x) & BIT_MASK_DIVN_SDM_V2_8197F) << BIT_SHIFT_DIVN_SDM_V2_8197F) -+#define BITS_DIVN_SDM_V2_8197F \ -+ (BIT_MASK_DIVN_SDM_V2_8197F << BIT_SHIFT_DIVN_SDM_V2_8197F) -+#define BIT_CLEAR_DIVN_SDM_V2_8197F(x) ((x) & (~BITS_DIVN_SDM_V2_8197F)) -+#define BIT_GET_DIVN_SDM_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_DIVN_SDM_V2_8197F) & BIT_MASK_DIVN_SDM_V2_8197F) -+#define BIT_SET_DIVN_SDM_V2_8197F(x, v) \ -+ (BIT_CLEAR_DIVN_SDM_V2_8197F(x) | BIT_DIVN_SDM_V2_8197F(v)) -+ -+#define BIT_SHIFT_DITHER_SDM_V2_8197F 0 -+#define BIT_MASK_DITHER_SDM_V2_8197F 0x7 -+#define BIT_DITHER_SDM_V2_8197F(x) \ -+ (((x) & BIT_MASK_DITHER_SDM_V2_8197F) << BIT_SHIFT_DITHER_SDM_V2_8197F) -+#define BITS_DITHER_SDM_V2_8197F \ -+ (BIT_MASK_DITHER_SDM_V2_8197F << BIT_SHIFT_DITHER_SDM_V2_8197F) -+#define BIT_CLEAR_DITHER_SDM_V2_8197F(x) ((x) & (~BITS_DITHER_SDM_V2_8197F)) -+#define BIT_GET_DITHER_SDM_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_DITHER_SDM_V2_8197F) & BIT_MASK_DITHER_SDM_V2_8197F) -+#define BIT_SET_DITHER_SDM_V2_8197F(x, v) \ -+ (BIT_CLEAR_DITHER_SDM_V2_8197F(x) | BIT_DITHER_SDM_V2_8197F(v)) -+ -+/* 2 REG_GPIO_DEBOUNCE_CTRL_8197F */ -+#define BIT_WLGP_DBC1EN_8197F BIT(15) -+ -+#define BIT_SHIFT_WLGP_DBC1_8197F 8 -+#define BIT_MASK_WLGP_DBC1_8197F 0xf -+#define BIT_WLGP_DBC1_8197F(x) \ -+ (((x) & BIT_MASK_WLGP_DBC1_8197F) << BIT_SHIFT_WLGP_DBC1_8197F) -+#define BITS_WLGP_DBC1_8197F \ -+ (BIT_MASK_WLGP_DBC1_8197F << BIT_SHIFT_WLGP_DBC1_8197F) -+#define BIT_CLEAR_WLGP_DBC1_8197F(x) ((x) & (~BITS_WLGP_DBC1_8197F)) -+#define BIT_GET_WLGP_DBC1_8197F(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC1_8197F) & BIT_MASK_WLGP_DBC1_8197F) -+#define BIT_SET_WLGP_DBC1_8197F(x, v) \ -+ (BIT_CLEAR_WLGP_DBC1_8197F(x) | BIT_WLGP_DBC1_8197F(v)) -+ -+#define BIT_WLGP_DBC0EN_8197F BIT(7) -+ -+#define BIT_SHIFT_WLGP_DBC0_8197F 0 -+#define BIT_MASK_WLGP_DBC0_8197F 0xf -+#define BIT_WLGP_DBC0_8197F(x) \ -+ (((x) & BIT_MASK_WLGP_DBC0_8197F) << BIT_SHIFT_WLGP_DBC0_8197F) -+#define BITS_WLGP_DBC0_8197F \ -+ (BIT_MASK_WLGP_DBC0_8197F << BIT_SHIFT_WLGP_DBC0_8197F) -+#define BIT_CLEAR_WLGP_DBC0_8197F(x) ((x) & (~BITS_WLGP_DBC0_8197F)) -+#define BIT_GET_WLGP_DBC0_8197F(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC0_8197F) & BIT_MASK_WLGP_DBC0_8197F) -+#define BIT_SET_WLGP_DBC0_8197F(x, v) \ -+ (BIT_CLEAR_WLGP_DBC0_8197F(x) | BIT_WLGP_DBC0_8197F(v)) -+ -+/* 2 REG_RPWM2_8197F */ -+ -+#define BIT_SHIFT_RPWM2_8197F 16 -+#define BIT_MASK_RPWM2_8197F 0xffff -+#define BIT_RPWM2_8197F(x) \ -+ (((x) & BIT_MASK_RPWM2_8197F) << BIT_SHIFT_RPWM2_8197F) -+#define BITS_RPWM2_8197F (BIT_MASK_RPWM2_8197F << BIT_SHIFT_RPWM2_8197F) -+#define BIT_CLEAR_RPWM2_8197F(x) ((x) & (~BITS_RPWM2_8197F)) -+#define BIT_GET_RPWM2_8197F(x) \ -+ (((x) >> BIT_SHIFT_RPWM2_8197F) & BIT_MASK_RPWM2_8197F) -+#define BIT_SET_RPWM2_8197F(x, v) \ -+ (BIT_CLEAR_RPWM2_8197F(x) | BIT_RPWM2_8197F(v)) -+ -+/* 2 REG_SYSON_FSM_MON_8197F */ -+ -+#define BIT_SHIFT_FSM_MON_SEL_8197F 24 -+#define BIT_MASK_FSM_MON_SEL_8197F 0x7 -+#define BIT_FSM_MON_SEL_8197F(x) \ -+ (((x) & BIT_MASK_FSM_MON_SEL_8197F) << BIT_SHIFT_FSM_MON_SEL_8197F) -+#define BITS_FSM_MON_SEL_8197F \ -+ (BIT_MASK_FSM_MON_SEL_8197F << BIT_SHIFT_FSM_MON_SEL_8197F) -+#define BIT_CLEAR_FSM_MON_SEL_8197F(x) ((x) & (~BITS_FSM_MON_SEL_8197F)) -+#define BIT_GET_FSM_MON_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_FSM_MON_SEL_8197F) & BIT_MASK_FSM_MON_SEL_8197F) -+#define BIT_SET_FSM_MON_SEL_8197F(x, v) \ -+ (BIT_CLEAR_FSM_MON_SEL_8197F(x) | BIT_FSM_MON_SEL_8197F(v)) -+ -+#define BIT_DOP_ELDO_8197F BIT(23) -+#define BIT_FSM_MON_UPD_8197F BIT(15) -+ -+#define BIT_SHIFT_FSM_PAR_8197F 0 -+#define BIT_MASK_FSM_PAR_8197F 0x7fff -+#define BIT_FSM_PAR_8197F(x) \ -+ (((x) & BIT_MASK_FSM_PAR_8197F) << BIT_SHIFT_FSM_PAR_8197F) -+#define BITS_FSM_PAR_8197F (BIT_MASK_FSM_PAR_8197F << BIT_SHIFT_FSM_PAR_8197F) -+#define BIT_CLEAR_FSM_PAR_8197F(x) ((x) & (~BITS_FSM_PAR_8197F)) -+#define BIT_GET_FSM_PAR_8197F(x) \ -+ (((x) >> BIT_SHIFT_FSM_PAR_8197F) & BIT_MASK_FSM_PAR_8197F) -+#define BIT_SET_FSM_PAR_8197F(x, v) \ -+ (BIT_CLEAR_FSM_PAR_8197F(x) | BIT_FSM_PAR_8197F(v)) -+ -+/* 2 REG_AFE_CTRL6_8197F */ -+ -+#define BIT_SHIFT_TSFT_SEL_V1_8197F 0 -+#define BIT_MASK_TSFT_SEL_V1_8197F 0x7 -+#define BIT_TSFT_SEL_V1_8197F(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_V1_8197F) << BIT_SHIFT_TSFT_SEL_V1_8197F) -+#define BITS_TSFT_SEL_V1_8197F \ -+ (BIT_MASK_TSFT_SEL_V1_8197F << BIT_SHIFT_TSFT_SEL_V1_8197F) -+#define BIT_CLEAR_TSFT_SEL_V1_8197F(x) ((x) & (~BITS_TSFT_SEL_V1_8197F)) -+#define BIT_GET_TSFT_SEL_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_V1_8197F) & BIT_MASK_TSFT_SEL_V1_8197F) -+#define BIT_SET_TSFT_SEL_V1_8197F(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_V1_8197F(x) | BIT_TSFT_SEL_V1_8197F(v)) -+ -+/* 2 REG_PMC_DBG_CTRL1_8197F */ -+#define BIT_BT_INT_EN_8197F BIT(31) -+ -+#define BIT_SHIFT_RD_WR_WIFI_BT_INFO_8197F 16 -+#define BIT_MASK_RD_WR_WIFI_BT_INFO_8197F 0x7fff -+#define BIT_RD_WR_WIFI_BT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_RD_WR_WIFI_BT_INFO_8197F) \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8197F) -+#define BITS_RD_WR_WIFI_BT_INFO_8197F \ -+ (BIT_MASK_RD_WR_WIFI_BT_INFO_8197F \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8197F) -+#define BIT_CLEAR_RD_WR_WIFI_BT_INFO_8197F(x) \ -+ ((x) & (~BITS_RD_WR_WIFI_BT_INFO_8197F)) -+#define BIT_GET_RD_WR_WIFI_BT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_RD_WR_WIFI_BT_INFO_8197F) & \ -+ BIT_MASK_RD_WR_WIFI_BT_INFO_8197F) -+#define BIT_SET_RD_WR_WIFI_BT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_RD_WR_WIFI_BT_INFO_8197F(x) | \ -+ BIT_RD_WR_WIFI_BT_INFO_8197F(v)) -+ -+#define BIT_PMC_WR_OVF_8197F BIT(8) -+ -+#define BIT_SHIFT_WLPMC_ERRINT_8197F 0 -+#define BIT_MASK_WLPMC_ERRINT_8197F 0xff -+#define BIT_WLPMC_ERRINT_8197F(x) \ -+ (((x) & BIT_MASK_WLPMC_ERRINT_8197F) << BIT_SHIFT_WLPMC_ERRINT_8197F) -+#define BITS_WLPMC_ERRINT_8197F \ -+ (BIT_MASK_WLPMC_ERRINT_8197F << BIT_SHIFT_WLPMC_ERRINT_8197F) -+#define BIT_CLEAR_WLPMC_ERRINT_8197F(x) ((x) & (~BITS_WLPMC_ERRINT_8197F)) -+#define BIT_GET_WLPMC_ERRINT_8197F(x) \ -+ (((x) >> BIT_SHIFT_WLPMC_ERRINT_8197F) & BIT_MASK_WLPMC_ERRINT_8197F) -+#define BIT_SET_WLPMC_ERRINT_8197F(x, v) \ -+ (BIT_CLEAR_WLPMC_ERRINT_8197F(x) | BIT_WLPMC_ERRINT_8197F(v)) -+ -+/* 2 REG_AFE_CTRL7_8197F */ -+ -+#define BIT_SHIFT_SEL_V_8197F 30 -+#define BIT_MASK_SEL_V_8197F 0x3 -+#define BIT_SEL_V_8197F(x) \ -+ (((x) & BIT_MASK_SEL_V_8197F) << BIT_SHIFT_SEL_V_8197F) -+#define BITS_SEL_V_8197F (BIT_MASK_SEL_V_8197F << BIT_SHIFT_SEL_V_8197F) -+#define BIT_CLEAR_SEL_V_8197F(x) ((x) & (~BITS_SEL_V_8197F)) -+#define BIT_GET_SEL_V_8197F(x) \ -+ (((x) >> BIT_SHIFT_SEL_V_8197F) & BIT_MASK_SEL_V_8197F) -+#define BIT_SET_SEL_V_8197F(x, v) \ -+ (BIT_CLEAR_SEL_V_8197F(x) | BIT_SEL_V_8197F(v)) -+ -+#define BIT_SEL_LDO_PC_8197F BIT(29) -+ -+#define BIT_SHIFT_CK_MON_SEL_V2_8197F 26 -+#define BIT_MASK_CK_MON_SEL_V2_8197F 0x7 -+#define BIT_CK_MON_SEL_V2_8197F(x) \ -+ (((x) & BIT_MASK_CK_MON_SEL_V2_8197F) << BIT_SHIFT_CK_MON_SEL_V2_8197F) -+#define BITS_CK_MON_SEL_V2_8197F \ -+ (BIT_MASK_CK_MON_SEL_V2_8197F << BIT_SHIFT_CK_MON_SEL_V2_8197F) -+#define BIT_CLEAR_CK_MON_SEL_V2_8197F(x) ((x) & (~BITS_CK_MON_SEL_V2_8197F)) -+#define BIT_GET_CK_MON_SEL_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_CK_MON_SEL_V2_8197F) & BIT_MASK_CK_MON_SEL_V2_8197F) -+#define BIT_SET_CK_MON_SEL_V2_8197F(x, v) \ -+ (BIT_CLEAR_CK_MON_SEL_V2_8197F(x) | BIT_CK_MON_SEL_V2_8197F(v)) -+ -+#define BIT_CK_MON_EN_8197F BIT(25) -+#define BIT_FREF_EDGE_8197F BIT(24) -+#define BIT_CK320M_EN_8197F BIT(23) -+#define BIT_CK_5M_EN_8197F BIT(22) -+#define BIT_TESTEN_8197F BIT(21) -+ -+/* 2 REG_HIMR0_8197F */ -+#define BIT_TIMEOUT_INTERRUPT2_MASK_8197F BIT(31) -+#define BIT_TIMEOUT_INTERRUTP1_MASK_8197F BIT(30) -+#define BIT_PSTIMEOUT_MSK_8197F BIT(29) -+#define BIT_GTINT4_MSK_8197F BIT(28) -+#define BIT_GTINT3_MSK_8197F BIT(27) -+#define BIT_TXBCN0ERR_MSK_8197F BIT(26) -+#define BIT_TXBCN0OK_MSK_8197F BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_MSK_8197F BIT(24) -+#define BIT_BCNDMAINT0_MSK_8197F BIT(20) -+#define BIT_BCNDERR0_MSK_8197F BIT(16) -+#define BIT_HSISR_IND_ON_INT_MSK_8197F BIT(15) -+#define BIT_HISR3_IND_INT_MSK_8197F BIT(14) -+#define BIT_HISR2_IND_INT_MSK_8197F BIT(13) -+#define BIT_CTWEND_MSK_8197F BIT(12) -+#define BIT_HISR1_IND_MSK_8197F BIT(11) -+#define BIT_C2HCMD_MSK_8197F BIT(10) -+#define BIT_CPWM2_MSK_8197F BIT(9) -+#define BIT_CPWM_MSK_8197F BIT(8) -+#define BIT_HIGHDOK_MSK_8197F BIT(7) -+#define BIT_MGTDOK_MSK_8197F BIT(6) -+#define BIT_BKDOK_MSK_8197F BIT(5) -+#define BIT_BEDOK_MSK_8197F BIT(4) -+#define BIT_VIDOK_MSK_8197F BIT(3) -+#define BIT_VODOK_MSK_8197F BIT(2) -+#define BIT_RDU_MSK_8197F BIT(1) -+#define BIT_RXOK_MSK_8197F BIT(0) -+ -+/* 2 REG_HISR0_8197F */ -+#define BIT_PSTIMEOUT2_8197F BIT(31) -+#define BIT_PSTIMEOUT1_8197F BIT(30) -+#define BIT_PSTIMEOUT_8197F BIT(29) -+#define BIT_GTINT4_8197F BIT(28) -+#define BIT_GTINT3_8197F BIT(27) -+#define BIT_TXBCN0ERR_8197F BIT(26) -+#define BIT_TXBCN0OK_8197F BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_8197F BIT(24) -+#define BIT_BCNDMAINT0_8197F BIT(20) -+#define BIT_BCNDERR0_8197F BIT(16) -+#define BIT_HSISR_IND_ON_INT_8197F BIT(15) -+#define BIT_HISR3_IND_INT_8197F BIT(14) -+#define BIT_HISR2_IND_INT_8197F BIT(13) -+#define BIT_CTWEND_8197F BIT(12) -+#define BIT_HISR1_IND_INT_8197F BIT(11) -+#define BIT_C2HCMD_8197F BIT(10) -+#define BIT_CPWM2_8197F BIT(9) -+#define BIT_CPWM_8197F BIT(8) -+#define BIT_HIGHDOK_8197F BIT(7) -+#define BIT_MGTDOK_8197F BIT(6) -+#define BIT_BKDOK_8197F BIT(5) -+#define BIT_BEDOK_8197F BIT(4) -+#define BIT_VIDOK_8197F BIT(3) -+#define BIT_VODOK_8197F BIT(2) -+#define BIT_RDU_8197F BIT(1) -+#define BIT_RXOK_8197F BIT(0) -+ -+/* 2 REG_HIMR1_8197F */ -+#define BIT_BTON_STS_UPDATE_MSK_8197F BIT(29) -+#define BIT_MCU_ERR_MASK_8197F BIT(28) -+#define BIT_BCNDMAINT7__MSK_8197F BIT(27) -+#define BIT_BCNDMAINT6__MSK_8197F BIT(26) -+#define BIT_BCNDMAINT5__MSK_8197F BIT(25) -+#define BIT_BCNDMAINT4__MSK_8197F BIT(24) -+#define BIT_BCNDMAINT3_MSK_8197F BIT(23) -+#define BIT_BCNDMAINT2_MSK_8197F BIT(22) -+#define BIT_BCNDMAINT1_MSK_8197F BIT(21) -+#define BIT_BCNDERR7_MSK_8197F BIT(20) -+#define BIT_BCNDERR6_MSK_8197F BIT(19) -+#define BIT_BCNDERR5_MSK_8197F BIT(18) -+#define BIT_BCNDERR4_MSK_8197F BIT(17) -+#define BIT_BCNDERR3_MSK_8197F BIT(16) -+#define BIT_BCNDERR2_MSK_8197F BIT(15) -+#define BIT_BCNDERR1_MSK_8197F BIT(14) -+#define BIT_ATIMEND_E_MSK_8197F BIT(13) -+#define BIT_ATIMEND__MSK_8197F BIT(12) -+#define BIT_TXERR_MSK_8197F BIT(11) -+#define BIT_RXERR_MSK_8197F BIT(10) -+#define BIT_TXFOVW_MSK_8197F BIT(9) -+#define BIT_FOVW_MSK_8197F BIT(8) -+ -+/* 2 REG_HISR1_8197F */ -+#define BIT_BTON_STS_UPDATE_INT_8197F BIT(29) -+#define BIT_MCU_ERR_8197F BIT(28) -+#define BIT_BCNDMAINT7_8197F BIT(27) -+#define BIT_BCNDMAINT6_8197F BIT(26) -+#define BIT_BCNDMAINT5_8197F BIT(25) -+#define BIT_BCNDMAINT4_8197F BIT(24) -+#define BIT_BCNDMAINT3_8197F BIT(23) -+#define BIT_BCNDMAINT2_8197F BIT(22) -+#define BIT_BCNDMAINT1_8197F BIT(21) -+#define BIT_BCNDERR7_8197F BIT(20) -+#define BIT_BCNDERR6_8197F BIT(19) -+#define BIT_BCNDERR5_8197F BIT(18) -+#define BIT_BCNDERR4_8197F BIT(17) -+#define BIT_BCNDERR3_8197F BIT(16) -+#define BIT_BCNDERR2_8197F BIT(15) -+#define BIT_BCNDERR1_8197F BIT(14) -+#define BIT_ATIMEND_E_8197F BIT(13) -+#define BIT_ATIMEND_8197F BIT(12) -+#define BIT_TXERR_INT_8197F BIT(11) -+#define BIT_RXERR_INT_8197F BIT(10) -+#define BIT_TXFOVW_8197F BIT(9) -+#define BIT_FOVW_8197F BIT(8) -+ -+/* 2 REG_DBG_PORT_SEL_8197F */ -+ -+#define BIT_SHIFT_DEBUG_ST_8197F 0 -+#define BIT_MASK_DEBUG_ST_8197F 0xffffffffL -+#define BIT_DEBUG_ST_8197F(x) \ -+ (((x) & BIT_MASK_DEBUG_ST_8197F) << BIT_SHIFT_DEBUG_ST_8197F) -+#define BITS_DEBUG_ST_8197F \ -+ (BIT_MASK_DEBUG_ST_8197F << BIT_SHIFT_DEBUG_ST_8197F) -+#define BIT_CLEAR_DEBUG_ST_8197F(x) ((x) & (~BITS_DEBUG_ST_8197F)) -+#define BIT_GET_DEBUG_ST_8197F(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_ST_8197F) & BIT_MASK_DEBUG_ST_8197F) -+#define BIT_SET_DEBUG_ST_8197F(x, v) \ -+ (BIT_CLEAR_DEBUG_ST_8197F(x) | BIT_DEBUG_ST_8197F(v)) -+ -+/* 2 REG_PAD_CTRL2_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_LD_B12V_EN_V1_8197F BIT(7) -+#define BIT_EECS_IOSEL_V1_8197F BIT(6) -+#define BIT_EECS_DATA_O_V1_8197F BIT(5) -+#define BIT_EECS_DATA_I_V1_8197F BIT(4) -+#define BIT_EESK_IOSEL_V1_8197F BIT(2) -+#define BIT_EESK_DATA_O_V1_8197F BIT(1) -+#define BIT_EESK_DATA_I_V1_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_PMC_DBG_CTRL2_8197F */ -+ -+#define BIT_SHIFT_EFUSE_BURN_GNT_8197F 24 -+#define BIT_MASK_EFUSE_BURN_GNT_8197F 0xff -+#define BIT_EFUSE_BURN_GNT_8197F(x) \ -+ (((x) & BIT_MASK_EFUSE_BURN_GNT_8197F) \ -+ << BIT_SHIFT_EFUSE_BURN_GNT_8197F) -+#define BITS_EFUSE_BURN_GNT_8197F \ -+ (BIT_MASK_EFUSE_BURN_GNT_8197F << BIT_SHIFT_EFUSE_BURN_GNT_8197F) -+#define BIT_CLEAR_EFUSE_BURN_GNT_8197F(x) ((x) & (~BITS_EFUSE_BURN_GNT_8197F)) -+#define BIT_GET_EFUSE_BURN_GNT_8197F(x) \ -+ (((x) >> BIT_SHIFT_EFUSE_BURN_GNT_8197F) & \ -+ BIT_MASK_EFUSE_BURN_GNT_8197F) -+#define BIT_SET_EFUSE_BURN_GNT_8197F(x, v) \ -+ (BIT_CLEAR_EFUSE_BURN_GNT_8197F(x) | BIT_EFUSE_BURN_GNT_8197F(v)) -+ -+#define BIT_STOP_WL_PMC_8197F BIT(9) -+#define BIT_STOP_SYM_PMC_8197F BIT(8) -+#define BIT_REG_RST_WLPMC_8197F BIT(5) -+#define BIT_REG_RST_PD12N_8197F BIT(4) -+#define BIT_SYSON_DIS_WLREG_WRMSK_8197F BIT(3) -+#define BIT_SYSON_DIS_PMCREG_WRMSK_8197F BIT(2) -+ -+#define BIT_SHIFT_SYSON_REG_ARB_8197F 0 -+#define BIT_MASK_SYSON_REG_ARB_8197F 0x3 -+#define BIT_SYSON_REG_ARB_8197F(x) \ -+ (((x) & BIT_MASK_SYSON_REG_ARB_8197F) << BIT_SHIFT_SYSON_REG_ARB_8197F) -+#define BITS_SYSON_REG_ARB_8197F \ -+ (BIT_MASK_SYSON_REG_ARB_8197F << BIT_SHIFT_SYSON_REG_ARB_8197F) -+#define BIT_CLEAR_SYSON_REG_ARB_8197F(x) ((x) & (~BITS_SYSON_REG_ARB_8197F)) -+#define BIT_GET_SYSON_REG_ARB_8197F(x) \ -+ (((x) >> BIT_SHIFT_SYSON_REG_ARB_8197F) & BIT_MASK_SYSON_REG_ARB_8197F) -+#define BIT_SET_SYSON_REG_ARB_8197F(x, v) \ -+ (BIT_CLEAR_SYSON_REG_ARB_8197F(x) | BIT_SYSON_REG_ARB_8197F(v)) -+ -+/* 2 REG_BIST_CTRL_8197F */ -+#define BIT_BIST_USB_DIS_8197F BIT(27) -+#define BIT_BIST_PCI_DIS_8197F BIT(26) -+#define BIT_BIST_BT_DIS_8197F BIT(25) -+#define BIT_BIST_WL_DIS_8197F BIT(24) -+ -+#define BIT_SHIFT_BIST_RPT_SEL_8197F 16 -+#define BIT_MASK_BIST_RPT_SEL_8197F 0xf -+#define BIT_BIST_RPT_SEL_8197F(x) \ -+ (((x) & BIT_MASK_BIST_RPT_SEL_8197F) << BIT_SHIFT_BIST_RPT_SEL_8197F) -+#define BITS_BIST_RPT_SEL_8197F \ -+ (BIT_MASK_BIST_RPT_SEL_8197F << BIT_SHIFT_BIST_RPT_SEL_8197F) -+#define BIT_CLEAR_BIST_RPT_SEL_8197F(x) ((x) & (~BITS_BIST_RPT_SEL_8197F)) -+#define BIT_GET_BIST_RPT_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_BIST_RPT_SEL_8197F) & BIT_MASK_BIST_RPT_SEL_8197F) -+#define BIT_SET_BIST_RPT_SEL_8197F(x, v) \ -+ (BIT_CLEAR_BIST_RPT_SEL_8197F(x) | BIT_BIST_RPT_SEL_8197F(v)) -+ -+#define BIT_BIST_RESUME_PS_8197F BIT(4) -+#define BIT_BIST_RESUME_8197F BIT(3) -+#define BIT_BIST_NORMAL_8197F BIT(2) -+#define BIT_BIST_RSTN_8197F BIT(1) -+#define BIT_BIST_CLK_EN_8197F BIT(0) -+ -+/* 2 REG_BIST_RPT_8197F */ -+ -+#define BIT_SHIFT_MBIST_REPORT_8197F 0 -+#define BIT_MASK_MBIST_REPORT_8197F 0xffffffffL -+#define BIT_MBIST_REPORT_8197F(x) \ -+ (((x) & BIT_MASK_MBIST_REPORT_8197F) << BIT_SHIFT_MBIST_REPORT_8197F) -+#define BITS_MBIST_REPORT_8197F \ -+ (BIT_MASK_MBIST_REPORT_8197F << BIT_SHIFT_MBIST_REPORT_8197F) -+#define BIT_CLEAR_MBIST_REPORT_8197F(x) ((x) & (~BITS_MBIST_REPORT_8197F)) -+#define BIT_GET_MBIST_REPORT_8197F(x) \ -+ (((x) >> BIT_SHIFT_MBIST_REPORT_8197F) & BIT_MASK_MBIST_REPORT_8197F) -+#define BIT_SET_MBIST_REPORT_8197F(x, v) \ -+ (BIT_CLEAR_MBIST_REPORT_8197F(x) | BIT_MBIST_REPORT_8197F(v)) -+ -+/* 2 REG_MEM_CTRL_8197F */ -+#define BIT_UMEM_RME_8197F BIT(31) -+ -+#define BIT_SHIFT_BT_SPRAM_8197F 28 -+#define BIT_MASK_BT_SPRAM_8197F 0x3 -+#define BIT_BT_SPRAM_8197F(x) \ -+ (((x) & BIT_MASK_BT_SPRAM_8197F) << BIT_SHIFT_BT_SPRAM_8197F) -+#define BITS_BT_SPRAM_8197F \ -+ (BIT_MASK_BT_SPRAM_8197F << BIT_SHIFT_BT_SPRAM_8197F) -+#define BIT_CLEAR_BT_SPRAM_8197F(x) ((x) & (~BITS_BT_SPRAM_8197F)) -+#define BIT_GET_BT_SPRAM_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_SPRAM_8197F) & BIT_MASK_BT_SPRAM_8197F) -+#define BIT_SET_BT_SPRAM_8197F(x, v) \ -+ (BIT_CLEAR_BT_SPRAM_8197F(x) | BIT_BT_SPRAM_8197F(v)) -+ -+#define BIT_SHIFT_BT_ROM_8197F 24 -+#define BIT_MASK_BT_ROM_8197F 0xf -+#define BIT_BT_ROM_8197F(x) \ -+ (((x) & BIT_MASK_BT_ROM_8197F) << BIT_SHIFT_BT_ROM_8197F) -+#define BITS_BT_ROM_8197F (BIT_MASK_BT_ROM_8197F << BIT_SHIFT_BT_ROM_8197F) -+#define BIT_CLEAR_BT_ROM_8197F(x) ((x) & (~BITS_BT_ROM_8197F)) -+#define BIT_GET_BT_ROM_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_ROM_8197F) & BIT_MASK_BT_ROM_8197F) -+#define BIT_SET_BT_ROM_8197F(x, v) \ -+ (BIT_CLEAR_BT_ROM_8197F(x) | BIT_BT_ROM_8197F(v)) -+ -+#define BIT_SHIFT_PCI_DPRAM_8197F 10 -+#define BIT_MASK_PCI_DPRAM_8197F 0x3 -+#define BIT_PCI_DPRAM_8197F(x) \ -+ (((x) & BIT_MASK_PCI_DPRAM_8197F) << BIT_SHIFT_PCI_DPRAM_8197F) -+#define BITS_PCI_DPRAM_8197F \ -+ (BIT_MASK_PCI_DPRAM_8197F << BIT_SHIFT_PCI_DPRAM_8197F) -+#define BIT_CLEAR_PCI_DPRAM_8197F(x) ((x) & (~BITS_PCI_DPRAM_8197F)) -+#define BIT_GET_PCI_DPRAM_8197F(x) \ -+ (((x) >> BIT_SHIFT_PCI_DPRAM_8197F) & BIT_MASK_PCI_DPRAM_8197F) -+#define BIT_SET_PCI_DPRAM_8197F(x, v) \ -+ (BIT_CLEAR_PCI_DPRAM_8197F(x) | BIT_PCI_DPRAM_8197F(v)) -+ -+#define BIT_SHIFT_PCI_SPRAM_8197F 8 -+#define BIT_MASK_PCI_SPRAM_8197F 0x3 -+#define BIT_PCI_SPRAM_8197F(x) \ -+ (((x) & BIT_MASK_PCI_SPRAM_8197F) << BIT_SHIFT_PCI_SPRAM_8197F) -+#define BITS_PCI_SPRAM_8197F \ -+ (BIT_MASK_PCI_SPRAM_8197F << BIT_SHIFT_PCI_SPRAM_8197F) -+#define BIT_CLEAR_PCI_SPRAM_8197F(x) ((x) & (~BITS_PCI_SPRAM_8197F)) -+#define BIT_GET_PCI_SPRAM_8197F(x) \ -+ (((x) >> BIT_SHIFT_PCI_SPRAM_8197F) & BIT_MASK_PCI_SPRAM_8197F) -+#define BIT_SET_PCI_SPRAM_8197F(x, v) \ -+ (BIT_CLEAR_PCI_SPRAM_8197F(x) | BIT_PCI_SPRAM_8197F(v)) -+ -+#define BIT_SHIFT_USB_SPRAM_8197F 6 -+#define BIT_MASK_USB_SPRAM_8197F 0x3 -+#define BIT_USB_SPRAM_8197F(x) \ -+ (((x) & BIT_MASK_USB_SPRAM_8197F) << BIT_SHIFT_USB_SPRAM_8197F) -+#define BITS_USB_SPRAM_8197F \ -+ (BIT_MASK_USB_SPRAM_8197F << BIT_SHIFT_USB_SPRAM_8197F) -+#define BIT_CLEAR_USB_SPRAM_8197F(x) ((x) & (~BITS_USB_SPRAM_8197F)) -+#define BIT_GET_USB_SPRAM_8197F(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRAM_8197F) & BIT_MASK_USB_SPRAM_8197F) -+#define BIT_SET_USB_SPRAM_8197F(x, v) \ -+ (BIT_CLEAR_USB_SPRAM_8197F(x) | BIT_USB_SPRAM_8197F(v)) -+ -+#define BIT_SHIFT_USB_SPRF_8197F 4 -+#define BIT_MASK_USB_SPRF_8197F 0x3 -+#define BIT_USB_SPRF_8197F(x) \ -+ (((x) & BIT_MASK_USB_SPRF_8197F) << BIT_SHIFT_USB_SPRF_8197F) -+#define BITS_USB_SPRF_8197F \ -+ (BIT_MASK_USB_SPRF_8197F << BIT_SHIFT_USB_SPRF_8197F) -+#define BIT_CLEAR_USB_SPRF_8197F(x) ((x) & (~BITS_USB_SPRF_8197F)) -+#define BIT_GET_USB_SPRF_8197F(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRF_8197F) & BIT_MASK_USB_SPRF_8197F) -+#define BIT_SET_USB_SPRF_8197F(x, v) \ -+ (BIT_CLEAR_USB_SPRF_8197F(x) | BIT_USB_SPRF_8197F(v)) -+ -+#define BIT_SHIFT_MCU_ROM_8197F 0 -+#define BIT_MASK_MCU_ROM_8197F 0xf -+#define BIT_MCU_ROM_8197F(x) \ -+ (((x) & BIT_MASK_MCU_ROM_8197F) << BIT_SHIFT_MCU_ROM_8197F) -+#define BITS_MCU_ROM_8197F (BIT_MASK_MCU_ROM_8197F << BIT_SHIFT_MCU_ROM_8197F) -+#define BIT_CLEAR_MCU_ROM_8197F(x) ((x) & (~BITS_MCU_ROM_8197F)) -+#define BIT_GET_MCU_ROM_8197F(x) \ -+ (((x) >> BIT_SHIFT_MCU_ROM_8197F) & BIT_MASK_MCU_ROM_8197F) -+#define BIT_SET_MCU_ROM_8197F(x, v) \ -+ (BIT_CLEAR_MCU_ROM_8197F(x) | BIT_MCU_ROM_8197F(v)) -+ -+/* 2 REG_AFE_CTRL8_8197F */ -+ -+#define BIT_SHIFT_BB_DBG_SEL_AFE_SDM_V4_8197F 26 -+#define BIT_MASK_BB_DBG_SEL_AFE_SDM_V4_8197F 0x7 -+#define BIT_BB_DBG_SEL_AFE_SDM_V4_8197F(x) \ -+ (((x) & BIT_MASK_BB_DBG_SEL_AFE_SDM_V4_8197F) \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_V4_8197F) -+#define BITS_BB_DBG_SEL_AFE_SDM_V4_8197F \ -+ (BIT_MASK_BB_DBG_SEL_AFE_SDM_V4_8197F \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_V4_8197F) -+#define BIT_CLEAR_BB_DBG_SEL_AFE_SDM_V4_8197F(x) \ -+ ((x) & (~BITS_BB_DBG_SEL_AFE_SDM_V4_8197F)) -+#define BIT_GET_BB_DBG_SEL_AFE_SDM_V4_8197F(x) \ -+ (((x) >> BIT_SHIFT_BB_DBG_SEL_AFE_SDM_V4_8197F) & \ -+ BIT_MASK_BB_DBG_SEL_AFE_SDM_V4_8197F) -+#define BIT_SET_BB_DBG_SEL_AFE_SDM_V4_8197F(x, v) \ -+ (BIT_CLEAR_BB_DBG_SEL_AFE_SDM_V4_8197F(x) | \ -+ BIT_BB_DBG_SEL_AFE_SDM_V4_8197F(v)) -+ -+#define BIT_SYN_AGPIO_8197F BIT(20) -+ -+#define BIT_SHIFT_XTAL_SEL_TOK_V2_8197F 0 -+#define BIT_MASK_XTAL_SEL_TOK_V2_8197F 0x7 -+#define BIT_XTAL_SEL_TOK_V2_8197F(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_TOK_V2_8197F) \ -+ << BIT_SHIFT_XTAL_SEL_TOK_V2_8197F) -+#define BITS_XTAL_SEL_TOK_V2_8197F \ -+ (BIT_MASK_XTAL_SEL_TOK_V2_8197F << BIT_SHIFT_XTAL_SEL_TOK_V2_8197F) -+#define BIT_CLEAR_XTAL_SEL_TOK_V2_8197F(x) ((x) & (~BITS_XTAL_SEL_TOK_V2_8197F)) -+#define BIT_GET_XTAL_SEL_TOK_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_TOK_V2_8197F) & \ -+ BIT_MASK_XTAL_SEL_TOK_V2_8197F) -+#define BIT_SET_XTAL_SEL_TOK_V2_8197F(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_TOK_V2_8197F(x) | BIT_XTAL_SEL_TOK_V2_8197F(v)) -+ -+/* 2 REG_USB_SIE_INTF_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_PCIE_MIO_INTF_8197F */ -+#define BIT_PCIE_MIO_BYIOREG_8197F BIT(13) -+#define BIT_PCIE_MIO_RE_8197F BIT(12) -+ -+#define BIT_SHIFT_PCIE_MIO_WE_8197F 8 -+#define BIT_MASK_PCIE_MIO_WE_8197F 0xf -+#define BIT_PCIE_MIO_WE_8197F(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_WE_8197F) << BIT_SHIFT_PCIE_MIO_WE_8197F) -+#define BITS_PCIE_MIO_WE_8197F \ -+ (BIT_MASK_PCIE_MIO_WE_8197F << BIT_SHIFT_PCIE_MIO_WE_8197F) -+#define BIT_CLEAR_PCIE_MIO_WE_8197F(x) ((x) & (~BITS_PCIE_MIO_WE_8197F)) -+#define BIT_GET_PCIE_MIO_WE_8197F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_WE_8197F) & BIT_MASK_PCIE_MIO_WE_8197F) -+#define BIT_SET_PCIE_MIO_WE_8197F(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_WE_8197F(x) | BIT_PCIE_MIO_WE_8197F(v)) -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_8197F 0 -+#define BIT_MASK_PCIE_MIO_ADDR_8197F 0xff -+#define BIT_PCIE_MIO_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_8197F) << BIT_SHIFT_PCIE_MIO_ADDR_8197F) -+#define BITS_PCIE_MIO_ADDR_8197F \ -+ (BIT_MASK_PCIE_MIO_ADDR_8197F << BIT_SHIFT_PCIE_MIO_ADDR_8197F) -+#define BIT_CLEAR_PCIE_MIO_ADDR_8197F(x) ((x) & (~BITS_PCIE_MIO_ADDR_8197F)) -+#define BIT_GET_PCIE_MIO_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_8197F) & BIT_MASK_PCIE_MIO_ADDR_8197F) -+#define BIT_SET_PCIE_MIO_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_8197F(x) | BIT_PCIE_MIO_ADDR_8197F(v)) -+ -+/* 2 REG_PCIE_MIO_INTD_8197F */ -+ -+#define BIT_SHIFT_PCIE_MIO_DATA_8197F 0 -+#define BIT_MASK_PCIE_MIO_DATA_8197F 0xffffffffL -+#define BIT_PCIE_MIO_DATA_8197F(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_DATA_8197F) << BIT_SHIFT_PCIE_MIO_DATA_8197F) -+#define BITS_PCIE_MIO_DATA_8197F \ -+ (BIT_MASK_PCIE_MIO_DATA_8197F << BIT_SHIFT_PCIE_MIO_DATA_8197F) -+#define BIT_CLEAR_PCIE_MIO_DATA_8197F(x) ((x) & (~BITS_PCIE_MIO_DATA_8197F)) -+#define BIT_GET_PCIE_MIO_DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_DATA_8197F) & BIT_MASK_PCIE_MIO_DATA_8197F) -+#define BIT_SET_PCIE_MIO_DATA_8197F(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_DATA_8197F(x) | BIT_PCIE_MIO_DATA_8197F(v)) -+ -+/* 2 REG_WLRF1_8197F */ -+ -+/* 2 REG_SYS_CFG1_8197F */ -+ -+#define BIT_SHIFT_TRP_ICFG_8197F 28 -+#define BIT_MASK_TRP_ICFG_8197F 0xf -+#define BIT_TRP_ICFG_8197F(x) \ -+ (((x) & BIT_MASK_TRP_ICFG_8197F) << BIT_SHIFT_TRP_ICFG_8197F) -+#define BITS_TRP_ICFG_8197F \ -+ (BIT_MASK_TRP_ICFG_8197F << BIT_SHIFT_TRP_ICFG_8197F) -+#define BIT_CLEAR_TRP_ICFG_8197F(x) ((x) & (~BITS_TRP_ICFG_8197F)) -+#define BIT_GET_TRP_ICFG_8197F(x) \ -+ (((x) >> BIT_SHIFT_TRP_ICFG_8197F) & BIT_MASK_TRP_ICFG_8197F) -+#define BIT_SET_TRP_ICFG_8197F(x, v) \ -+ (BIT_CLEAR_TRP_ICFG_8197F(x) | BIT_TRP_ICFG_8197F(v)) -+ -+#define BIT_RF_TYPE_ID_8197F BIT(27) -+#define BIT_BD_HCI_SEL_8197F BIT(26) -+#define BIT_BD_PKG_SEL_8197F BIT(25) -+#define BIT_SPSLDO_SEL_8197F BIT(24) -+#define BIT_RTL_ID_8197F BIT(23) -+#define BIT_PAD_HWPD_IDN_8197F BIT(22) -+#define BIT_TESTMODE_8197F BIT(20) -+ -+#define BIT_SHIFT_VENDOR_ID_8197F 16 -+#define BIT_MASK_VENDOR_ID_8197F 0xf -+#define BIT_VENDOR_ID_8197F(x) \ -+ (((x) & BIT_MASK_VENDOR_ID_8197F) << BIT_SHIFT_VENDOR_ID_8197F) -+#define BITS_VENDOR_ID_8197F \ -+ (BIT_MASK_VENDOR_ID_8197F << BIT_SHIFT_VENDOR_ID_8197F) -+#define BIT_CLEAR_VENDOR_ID_8197F(x) ((x) & (~BITS_VENDOR_ID_8197F)) -+#define BIT_GET_VENDOR_ID_8197F(x) \ -+ (((x) >> BIT_SHIFT_VENDOR_ID_8197F) & BIT_MASK_VENDOR_ID_8197F) -+#define BIT_SET_VENDOR_ID_8197F(x, v) \ -+ (BIT_CLEAR_VENDOR_ID_8197F(x) | BIT_VENDOR_ID_8197F(v)) -+ -+#define BIT_SHIFT_CHIP_VER_8197F 12 -+#define BIT_MASK_CHIP_VER_8197F 0xf -+#define BIT_CHIP_VER_8197F(x) \ -+ (((x) & BIT_MASK_CHIP_VER_8197F) << BIT_SHIFT_CHIP_VER_8197F) -+#define BITS_CHIP_VER_8197F \ -+ (BIT_MASK_CHIP_VER_8197F << BIT_SHIFT_CHIP_VER_8197F) -+#define BIT_CLEAR_CHIP_VER_8197F(x) ((x) & (~BITS_CHIP_VER_8197F)) -+#define BIT_GET_CHIP_VER_8197F(x) \ -+ (((x) >> BIT_SHIFT_CHIP_VER_8197F) & BIT_MASK_CHIP_VER_8197F) -+#define BIT_SET_CHIP_VER_8197F(x, v) \ -+ (BIT_CLEAR_CHIP_VER_8197F(x) | BIT_CHIP_VER_8197F(v)) -+ -+#define BIT_BD_MAC1_8197F BIT(10) -+#define BIT_BD_MAC2_8197F BIT(9) -+#define BIT_SIC_IDLE_8197F BIT(8) -+#define BIT_SW_OFFLOAD_EN_8197F BIT(7) -+#define BIT_OCP_SHUTDN_8197F BIT(6) -+#define BIT_V15_VLD_8197F BIT(5) -+#define BIT_PCIRSTB_8197F BIT(4) -+#define BIT_PCLK_VLD_8197F BIT(3) -+#define BIT_UCLK_VLD_8197F BIT(2) -+#define BIT_ACLK_VLD_8197F BIT(1) -+#define BIT_XCLK_VLD_8197F BIT(0) -+ -+/* 2 REG_SYS_STATUS1_8197F */ -+ -+#define BIT_SHIFT_RF_RL_ID_8197F 28 -+#define BIT_MASK_RF_RL_ID_8197F 0xf -+#define BIT_RF_RL_ID_8197F(x) \ -+ (((x) & BIT_MASK_RF_RL_ID_8197F) << BIT_SHIFT_RF_RL_ID_8197F) -+#define BITS_RF_RL_ID_8197F \ -+ (BIT_MASK_RF_RL_ID_8197F << BIT_SHIFT_RF_RL_ID_8197F) -+#define BIT_CLEAR_RF_RL_ID_8197F(x) ((x) & (~BITS_RF_RL_ID_8197F)) -+#define BIT_GET_RF_RL_ID_8197F(x) \ -+ (((x) >> BIT_SHIFT_RF_RL_ID_8197F) & BIT_MASK_RF_RL_ID_8197F) -+#define BIT_SET_RF_RL_ID_8197F(x, v) \ -+ (BIT_CLEAR_RF_RL_ID_8197F(x) | BIT_RF_RL_ID_8197F(v)) -+ -+#define BIT_HPHY_ICFG_8197F BIT(19) -+ -+#define BIT_SHIFT_SEL_0XC0_8197F 16 -+#define BIT_MASK_SEL_0XC0_8197F 0x3 -+#define BIT_SEL_0XC0_8197F(x) \ -+ (((x) & BIT_MASK_SEL_0XC0_8197F) << BIT_SHIFT_SEL_0XC0_8197F) -+#define BITS_SEL_0XC0_8197F \ -+ (BIT_MASK_SEL_0XC0_8197F << BIT_SHIFT_SEL_0XC0_8197F) -+#define BIT_CLEAR_SEL_0XC0_8197F(x) ((x) & (~BITS_SEL_0XC0_8197F)) -+#define BIT_GET_SEL_0XC0_8197F(x) \ -+ (((x) >> BIT_SHIFT_SEL_0XC0_8197F) & BIT_MASK_SEL_0XC0_8197F) -+#define BIT_SET_SEL_0XC0_8197F(x, v) \ -+ (BIT_CLEAR_SEL_0XC0_8197F(x) | BIT_SEL_0XC0_8197F(v)) -+ -+#define BIT_USB_OPERATION_MODE_8197F BIT(10) -+#define BIT_BT_PDN_8197F BIT(9) -+#define BIT_AUTO_WLPON_8197F BIT(8) -+#define BIT_WL_MODE_8197F BIT(7) -+#define BIT_PKG_SEL_HCI_8197F BIT(6) -+ -+#define BIT_SHIFT_HCI_SEL_8197F 4 -+#define BIT_MASK_HCI_SEL_8197F 0x3 -+#define BIT_HCI_SEL_8197F(x) \ -+ (((x) & BIT_MASK_HCI_SEL_8197F) << BIT_SHIFT_HCI_SEL_8197F) -+#define BITS_HCI_SEL_8197F (BIT_MASK_HCI_SEL_8197F << BIT_SHIFT_HCI_SEL_8197F) -+#define BIT_CLEAR_HCI_SEL_8197F(x) ((x) & (~BITS_HCI_SEL_8197F)) -+#define BIT_GET_HCI_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_HCI_SEL_8197F) & BIT_MASK_HCI_SEL_8197F) -+#define BIT_SET_HCI_SEL_8197F(x, v) \ -+ (BIT_CLEAR_HCI_SEL_8197F(x) | BIT_HCI_SEL_8197F(v)) -+ -+#define BIT_SHIFT_PAD_HCI_SEL_8197F 2 -+#define BIT_MASK_PAD_HCI_SEL_8197F 0x3 -+#define BIT_PAD_HCI_SEL_8197F(x) \ -+ (((x) & BIT_MASK_PAD_HCI_SEL_8197F) << BIT_SHIFT_PAD_HCI_SEL_8197F) -+#define BITS_PAD_HCI_SEL_8197F \ -+ (BIT_MASK_PAD_HCI_SEL_8197F << BIT_SHIFT_PAD_HCI_SEL_8197F) -+#define BIT_CLEAR_PAD_HCI_SEL_8197F(x) ((x) & (~BITS_PAD_HCI_SEL_8197F)) -+#define BIT_GET_PAD_HCI_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_PAD_HCI_SEL_8197F) & BIT_MASK_PAD_HCI_SEL_8197F) -+#define BIT_SET_PAD_HCI_SEL_8197F(x, v) \ -+ (BIT_CLEAR_PAD_HCI_SEL_8197F(x) | BIT_PAD_HCI_SEL_8197F(v)) -+ -+#define BIT_SHIFT_EFS_HCI_SEL_8197F 0 -+#define BIT_MASK_EFS_HCI_SEL_8197F 0x3 -+#define BIT_EFS_HCI_SEL_8197F(x) \ -+ (((x) & BIT_MASK_EFS_HCI_SEL_8197F) << BIT_SHIFT_EFS_HCI_SEL_8197F) -+#define BITS_EFS_HCI_SEL_8197F \ -+ (BIT_MASK_EFS_HCI_SEL_8197F << BIT_SHIFT_EFS_HCI_SEL_8197F) -+#define BIT_CLEAR_EFS_HCI_SEL_8197F(x) ((x) & (~BITS_EFS_HCI_SEL_8197F)) -+#define BIT_GET_EFS_HCI_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_EFS_HCI_SEL_8197F) & BIT_MASK_EFS_HCI_SEL_8197F) -+#define BIT_SET_EFS_HCI_SEL_8197F(x, v) \ -+ (BIT_CLEAR_EFS_HCI_SEL_8197F(x) | BIT_EFS_HCI_SEL_8197F(v)) -+ -+/* 2 REG_SYS_STATUS2_8197F */ -+#define BIT_SIO_ALDN_8197F BIT(19) -+#define BIT_USB_ALDN_8197F BIT(18) -+#define BIT_PCI_ALDN_8197F BIT(17) -+#define BIT_SYS_ALDN_8197F BIT(16) -+ -+#define BIT_SHIFT_EPVID1_8197F 8 -+#define BIT_MASK_EPVID1_8197F 0xff -+#define BIT_EPVID1_8197F(x) \ -+ (((x) & BIT_MASK_EPVID1_8197F) << BIT_SHIFT_EPVID1_8197F) -+#define BITS_EPVID1_8197F (BIT_MASK_EPVID1_8197F << BIT_SHIFT_EPVID1_8197F) -+#define BIT_CLEAR_EPVID1_8197F(x) ((x) & (~BITS_EPVID1_8197F)) -+#define BIT_GET_EPVID1_8197F(x) \ -+ (((x) >> BIT_SHIFT_EPVID1_8197F) & BIT_MASK_EPVID1_8197F) -+#define BIT_SET_EPVID1_8197F(x, v) \ -+ (BIT_CLEAR_EPVID1_8197F(x) | BIT_EPVID1_8197F(v)) -+ -+#define BIT_SHIFT_EPVID0_8197F 0 -+#define BIT_MASK_EPVID0_8197F 0xff -+#define BIT_EPVID0_8197F(x) \ -+ (((x) & BIT_MASK_EPVID0_8197F) << BIT_SHIFT_EPVID0_8197F) -+#define BITS_EPVID0_8197F (BIT_MASK_EPVID0_8197F << BIT_SHIFT_EPVID0_8197F) -+#define BIT_CLEAR_EPVID0_8197F(x) ((x) & (~BITS_EPVID0_8197F)) -+#define BIT_GET_EPVID0_8197F(x) \ -+ (((x) >> BIT_SHIFT_EPVID0_8197F) & BIT_MASK_EPVID0_8197F) -+#define BIT_SET_EPVID0_8197F(x, v) \ -+ (BIT_CLEAR_EPVID0_8197F(x) | BIT_EPVID0_8197F(v)) -+ -+/* 2 REG_SYS_CFG2_8197F */ -+ -+#define BIT_SHIFT_HW_ID_8197F 0 -+#define BIT_MASK_HW_ID_8197F 0xff -+#define BIT_HW_ID_8197F(x) \ -+ (((x) & BIT_MASK_HW_ID_8197F) << BIT_SHIFT_HW_ID_8197F) -+#define BITS_HW_ID_8197F (BIT_MASK_HW_ID_8197F << BIT_SHIFT_HW_ID_8197F) -+#define BIT_CLEAR_HW_ID_8197F(x) ((x) & (~BITS_HW_ID_8197F)) -+#define BIT_GET_HW_ID_8197F(x) \ -+ (((x) >> BIT_SHIFT_HW_ID_8197F) & BIT_MASK_HW_ID_8197F) -+#define BIT_SET_HW_ID_8197F(x, v) \ -+ (BIT_CLEAR_HW_ID_8197F(x) | BIT_HW_ID_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_SYS_CFG3_8197F */ -+ -+/* 2 REG_SYS_CFG4_8197F */ -+ -+/* 2 REG_CPU_DMEM_CON_8197F */ -+#define BIT_ANA_PORT_IDLE_8197F BIT(18) -+#define BIT_MAC_PORT_IDLE_8197F BIT(17) -+#define BIT_WL_PLATFORM_RST_8197F BIT(16) -+#define BIT_WL_SECURITY_CLK_8197F BIT(15) -+ -+#define BIT_SHIFT_CPU_DMEM_CON_8197F 0 -+#define BIT_MASK_CPU_DMEM_CON_8197F 0xff -+#define BIT_CPU_DMEM_CON_8197F(x) \ -+ (((x) & BIT_MASK_CPU_DMEM_CON_8197F) << BIT_SHIFT_CPU_DMEM_CON_8197F) -+#define BITS_CPU_DMEM_CON_8197F \ -+ (BIT_MASK_CPU_DMEM_CON_8197F << BIT_SHIFT_CPU_DMEM_CON_8197F) -+#define BIT_CLEAR_CPU_DMEM_CON_8197F(x) ((x) & (~BITS_CPU_DMEM_CON_8197F)) -+#define BIT_GET_CPU_DMEM_CON_8197F(x) \ -+ (((x) >> BIT_SHIFT_CPU_DMEM_CON_8197F) & BIT_MASK_CPU_DMEM_CON_8197F) -+#define BIT_SET_CPU_DMEM_CON_8197F(x, v) \ -+ (BIT_CLEAR_CPU_DMEM_CON_8197F(x) | BIT_CPU_DMEM_CON_8197F(v)) -+ -+/* 2 REG_HIMR2_8197F */ -+#define BIT_BCNDMAINT_P4_MSK_8197F BIT(31) -+#define BIT_BCNDMAINT_P3_MSK_8197F BIT(30) -+#define BIT_BCNDMAINT_P2_MSK_8197F BIT(29) -+#define BIT_BCNDMAINT_P1_MSK_8197F BIT(28) -+#define BIT_ATIMEND7_MSK_8197F BIT(22) -+#define BIT_ATIMEND6_MSK_8197F BIT(21) -+#define BIT_ATIMEND5_MSK_8197F BIT(20) -+#define BIT_ATIMEND4_MSK_8197F BIT(19) -+#define BIT_ATIMEND3_MSK_8197F BIT(18) -+#define BIT_ATIMEND2_MSK_8197F BIT(17) -+#define BIT_ATIMEND1_MSK_8197F BIT(16) -+#define BIT_TXBCN7OK_MSK_8197F BIT(14) -+#define BIT_TXBCN6OK_MSK_8197F BIT(13) -+#define BIT_TXBCN5OK_MSK_8197F BIT(12) -+#define BIT_TXBCN4OK_MSK_8197F BIT(11) -+#define BIT_TXBCN3OK_MSK_8197F BIT(10) -+#define BIT_TXBCN2OK_MSK_8197F BIT(9) -+#define BIT_TXBCN1OK_MSK_V1_8197F BIT(8) -+#define BIT_TXBCN7ERR_MSK_8197F BIT(6) -+#define BIT_TXBCN6ERR_MSK_8197F BIT(5) -+#define BIT_TXBCN5ERR_MSK_8197F BIT(4) -+#define BIT_TXBCN4ERR_MSK_8197F BIT(3) -+#define BIT_TXBCN3ERR_MSK_8197F BIT(2) -+#define BIT_TXBCN2ERR_MSK_8197F BIT(1) -+#define BIT_TXBCN1ERR_MSK_V1_8197F BIT(0) -+ -+/* 2 REG_HISR2_8197F */ -+#define BIT_BCNDMAINT_P4_8197F BIT(31) -+#define BIT_BCNDMAINT_P3_8197F BIT(30) -+#define BIT_BCNDMAINT_P2_8197F BIT(29) -+#define BIT_BCNDMAINT_P1_8197F BIT(28) -+#define BIT_ATIMEND7_8197F BIT(22) -+#define BIT_ATIMEND6_8197F BIT(21) -+#define BIT_ATIMEND5_8197F BIT(20) -+#define BIT_ATIMEND4_8197F BIT(19) -+#define BIT_ATIMEND3_8197F BIT(18) -+#define BIT_ATIMEND2_8197F BIT(17) -+#define BIT_ATIMEND1_8197F BIT(16) -+#define BIT_TXBCN7OK_8197F BIT(14) -+#define BIT_TXBCN6OK_8197F BIT(13) -+#define BIT_TXBCN5OK_8197F BIT(12) -+#define BIT_TXBCN4OK_8197F BIT(11) -+#define BIT_TXBCN3OK_8197F BIT(10) -+#define BIT_TXBCN2OK_8197F BIT(9) -+#define BIT_TXBCN1OK_8197F BIT(8) -+#define BIT_TXBCN7ERR_8197F BIT(6) -+#define BIT_TXBCN6ERR_8197F BIT(5) -+#define BIT_TXBCN5ERR_8197F BIT(4) -+#define BIT_TXBCN4ERR_8197F BIT(3) -+#define BIT_TXBCN3ERR_8197F BIT(2) -+#define BIT_TXBCN2ERR_8197F BIT(1) -+#define BIT_TXBCN1ERR_8197F BIT(0) -+ -+/* 2 REG_HIMR3_8197F */ -+#define BIT_SETH2CDOK_MASK_8197F BIT(16) -+#define BIT_H2C_CMD_FULL_MASK_8197F BIT(15) -+#define BIT_PWR_INT_127_MASK_8197F BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_MASK_8197F BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_MASK_8197F BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_MASK_8197F BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_MAS_8197F BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_MASK_8197F BIT(9) -+#define BIT_PWR_INT_127_MASK_V1_8197F BIT(8) -+#define BIT_PWR_INT_126TO96_MASK_8197F BIT(7) -+#define BIT_PWR_INT_95TO64_MASK_8197F BIT(6) -+#define BIT_PWR_INT_63TO32_MASK_8197F BIT(5) -+#define BIT_PWR_INT_31TO0_MASK_8197F BIT(4) -+#define BIT_DDMA0_LP_INT_MSK_8197F BIT(1) -+#define BIT_DDMA0_HP_INT_MSK_8197F BIT(0) -+ -+/* 2 REG_HISR3_8197F */ -+#define BIT_SETH2CDOK_8197F BIT(16) -+#define BIT_H2C_CMD_FULL_8197F BIT(15) -+#define BIT_PWR_INT_127_8197F BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_8197F BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_8197F BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_8197F BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_8197F BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_8197F BIT(9) -+#define BIT_PWR_INT_127_V1_8197F BIT(8) -+#define BIT_PWR_INT_126TO96_8197F BIT(7) -+#define BIT_PWR_INT_95TO64_8197F BIT(6) -+#define BIT_PWR_INT_63TO32_8197F BIT(5) -+#define BIT_PWR_INT_31TO0_8197F BIT(4) -+#define BIT_DDMA0_LP_INT_8197F BIT(1) -+#define BIT_DDMA0_HP_INT_8197F BIT(0) -+ -+/* 2 REG_SW_MDIO_8197F */ -+ -+/* 2 REG_SW_FLUSH_8197F */ -+#define BIT_FLUSH_HOLDN_EN_8197F BIT(25) -+#define BIT_FLUSH_WR_EN_8197F BIT(24) -+#define BIT_SW_FLASH_CONTROL_8197F BIT(23) -+#define BIT_SW_FLASH_WEN_E_8197F BIT(19) -+#define BIT_SW_FLASH_HOLDN_E_8197F BIT(18) -+#define BIT_SW_FLASH_SO_E_8197F BIT(17) -+#define BIT_SW_FLASH_SI_E_8197F BIT(16) -+#define BIT_SW_FLASH_SK_O_8197F BIT(13) -+#define BIT_SW_FLASH_CEN_O_8197F BIT(12) -+#define BIT_SW_FLASH_WEN_O_8197F BIT(11) -+#define BIT_SW_FLASH_HOLDN_O_8197F BIT(10) -+#define BIT_SW_FLASH_SO_O_8197F BIT(9) -+#define BIT_SW_FLASH_SI_O_8197F BIT(8) -+#define BIT_SW_FLASH_WEN_I_8197F BIT(3) -+#define BIT_SW_FLASH_HOLDN_I_8197F BIT(2) -+#define BIT_SW_FLASH_SO_I_8197F BIT(1) -+#define BIT_SW_FLASH_SI_I_8197F BIT(0) -+ -+/* 2 REG_DBG_GPIO_BMUX_8197F */ -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_7_8197F 21 -+#define BIT_MASK_DBG_GPIO_BMUX_7_8197F 0x7 -+#define BIT_DBG_GPIO_BMUX_7_8197F(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_7_8197F) \ -+ << BIT_SHIFT_DBG_GPIO_BMUX_7_8197F) -+#define BITS_DBG_GPIO_BMUX_7_8197F \ -+ (BIT_MASK_DBG_GPIO_BMUX_7_8197F << BIT_SHIFT_DBG_GPIO_BMUX_7_8197F) -+#define BIT_CLEAR_DBG_GPIO_BMUX_7_8197F(x) ((x) & (~BITS_DBG_GPIO_BMUX_7_8197F)) -+#define BIT_GET_DBG_GPIO_BMUX_7_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_7_8197F) & \ -+ BIT_MASK_DBG_GPIO_BMUX_7_8197F) -+#define BIT_SET_DBG_GPIO_BMUX_7_8197F(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_7_8197F(x) | BIT_DBG_GPIO_BMUX_7_8197F(v)) -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_6_8197F 18 -+#define BIT_MASK_DBG_GPIO_BMUX_6_8197F 0x7 -+#define BIT_DBG_GPIO_BMUX_6_8197F(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_6_8197F) \ -+ << BIT_SHIFT_DBG_GPIO_BMUX_6_8197F) -+#define BITS_DBG_GPIO_BMUX_6_8197F \ -+ (BIT_MASK_DBG_GPIO_BMUX_6_8197F << BIT_SHIFT_DBG_GPIO_BMUX_6_8197F) -+#define BIT_CLEAR_DBG_GPIO_BMUX_6_8197F(x) ((x) & (~BITS_DBG_GPIO_BMUX_6_8197F)) -+#define BIT_GET_DBG_GPIO_BMUX_6_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_6_8197F) & \ -+ BIT_MASK_DBG_GPIO_BMUX_6_8197F) -+#define BIT_SET_DBG_GPIO_BMUX_6_8197F(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_6_8197F(x) | BIT_DBG_GPIO_BMUX_6_8197F(v)) -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_5_8197F 15 -+#define BIT_MASK_DBG_GPIO_BMUX_5_8197F 0x7 -+#define BIT_DBG_GPIO_BMUX_5_8197F(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_5_8197F) \ -+ << BIT_SHIFT_DBG_GPIO_BMUX_5_8197F) -+#define BITS_DBG_GPIO_BMUX_5_8197F \ -+ (BIT_MASK_DBG_GPIO_BMUX_5_8197F << BIT_SHIFT_DBG_GPIO_BMUX_5_8197F) -+#define BIT_CLEAR_DBG_GPIO_BMUX_5_8197F(x) ((x) & (~BITS_DBG_GPIO_BMUX_5_8197F)) -+#define BIT_GET_DBG_GPIO_BMUX_5_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_5_8197F) & \ -+ BIT_MASK_DBG_GPIO_BMUX_5_8197F) -+#define BIT_SET_DBG_GPIO_BMUX_5_8197F(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_5_8197F(x) | BIT_DBG_GPIO_BMUX_5_8197F(v)) -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_4_8197F 12 -+#define BIT_MASK_DBG_GPIO_BMUX_4_8197F 0x7 -+#define BIT_DBG_GPIO_BMUX_4_8197F(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_4_8197F) \ -+ << BIT_SHIFT_DBG_GPIO_BMUX_4_8197F) -+#define BITS_DBG_GPIO_BMUX_4_8197F \ -+ (BIT_MASK_DBG_GPIO_BMUX_4_8197F << BIT_SHIFT_DBG_GPIO_BMUX_4_8197F) -+#define BIT_CLEAR_DBG_GPIO_BMUX_4_8197F(x) ((x) & (~BITS_DBG_GPIO_BMUX_4_8197F)) -+#define BIT_GET_DBG_GPIO_BMUX_4_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_4_8197F) & \ -+ BIT_MASK_DBG_GPIO_BMUX_4_8197F) -+#define BIT_SET_DBG_GPIO_BMUX_4_8197F(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_4_8197F(x) | BIT_DBG_GPIO_BMUX_4_8197F(v)) -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_3_8197F 9 -+#define BIT_MASK_DBG_GPIO_BMUX_3_8197F 0x7 -+#define BIT_DBG_GPIO_BMUX_3_8197F(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_3_8197F) \ -+ << BIT_SHIFT_DBG_GPIO_BMUX_3_8197F) -+#define BITS_DBG_GPIO_BMUX_3_8197F \ -+ (BIT_MASK_DBG_GPIO_BMUX_3_8197F << BIT_SHIFT_DBG_GPIO_BMUX_3_8197F) -+#define BIT_CLEAR_DBG_GPIO_BMUX_3_8197F(x) ((x) & (~BITS_DBG_GPIO_BMUX_3_8197F)) -+#define BIT_GET_DBG_GPIO_BMUX_3_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_3_8197F) & \ -+ BIT_MASK_DBG_GPIO_BMUX_3_8197F) -+#define BIT_SET_DBG_GPIO_BMUX_3_8197F(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_3_8197F(x) | BIT_DBG_GPIO_BMUX_3_8197F(v)) -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_2_8197F 6 -+#define BIT_MASK_DBG_GPIO_BMUX_2_8197F 0x7 -+#define BIT_DBG_GPIO_BMUX_2_8197F(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_2_8197F) \ -+ << BIT_SHIFT_DBG_GPIO_BMUX_2_8197F) -+#define BITS_DBG_GPIO_BMUX_2_8197F \ -+ (BIT_MASK_DBG_GPIO_BMUX_2_8197F << BIT_SHIFT_DBG_GPIO_BMUX_2_8197F) -+#define BIT_CLEAR_DBG_GPIO_BMUX_2_8197F(x) ((x) & (~BITS_DBG_GPIO_BMUX_2_8197F)) -+#define BIT_GET_DBG_GPIO_BMUX_2_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_2_8197F) & \ -+ BIT_MASK_DBG_GPIO_BMUX_2_8197F) -+#define BIT_SET_DBG_GPIO_BMUX_2_8197F(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_2_8197F(x) | BIT_DBG_GPIO_BMUX_2_8197F(v)) -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_1_8197F 3 -+#define BIT_MASK_DBG_GPIO_BMUX_1_8197F 0x7 -+#define BIT_DBG_GPIO_BMUX_1_8197F(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_1_8197F) \ -+ << BIT_SHIFT_DBG_GPIO_BMUX_1_8197F) -+#define BITS_DBG_GPIO_BMUX_1_8197F \ -+ (BIT_MASK_DBG_GPIO_BMUX_1_8197F << BIT_SHIFT_DBG_GPIO_BMUX_1_8197F) -+#define BIT_CLEAR_DBG_GPIO_BMUX_1_8197F(x) ((x) & (~BITS_DBG_GPIO_BMUX_1_8197F)) -+#define BIT_GET_DBG_GPIO_BMUX_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_1_8197F) & \ -+ BIT_MASK_DBG_GPIO_BMUX_1_8197F) -+#define BIT_SET_DBG_GPIO_BMUX_1_8197F(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_1_8197F(x) | BIT_DBG_GPIO_BMUX_1_8197F(v)) -+ -+#define BIT_SHIFT_DBG_GPIO_BMUX_0_8197F 0 -+#define BIT_MASK_DBG_GPIO_BMUX_0_8197F 0x7 -+#define BIT_DBG_GPIO_BMUX_0_8197F(x) \ -+ (((x) & BIT_MASK_DBG_GPIO_BMUX_0_8197F) \ -+ << BIT_SHIFT_DBG_GPIO_BMUX_0_8197F) -+#define BITS_DBG_GPIO_BMUX_0_8197F \ -+ (BIT_MASK_DBG_GPIO_BMUX_0_8197F << BIT_SHIFT_DBG_GPIO_BMUX_0_8197F) -+#define BIT_CLEAR_DBG_GPIO_BMUX_0_8197F(x) ((x) & (~BITS_DBG_GPIO_BMUX_0_8197F)) -+#define BIT_GET_DBG_GPIO_BMUX_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_GPIO_BMUX_0_8197F) & \ -+ BIT_MASK_DBG_GPIO_BMUX_0_8197F) -+#define BIT_SET_DBG_GPIO_BMUX_0_8197F(x, v) \ -+ (BIT_CLEAR_DBG_GPIO_BMUX_0_8197F(x) | BIT_DBG_GPIO_BMUX_0_8197F(v)) -+ -+/* 2 REG_FPGA_TAG_8197F (NO USE IN ASIC) */ -+ -+#define BIT_SHIFT_FPGA_TAG_8197F 0 -+#define BIT_MASK_FPGA_TAG_8197F 0xffffffffL -+#define BIT_FPGA_TAG_8197F(x) \ -+ (((x) & BIT_MASK_FPGA_TAG_8197F) << BIT_SHIFT_FPGA_TAG_8197F) -+#define BITS_FPGA_TAG_8197F \ -+ (BIT_MASK_FPGA_TAG_8197F << BIT_SHIFT_FPGA_TAG_8197F) -+#define BIT_CLEAR_FPGA_TAG_8197F(x) ((x) & (~BITS_FPGA_TAG_8197F)) -+#define BIT_GET_FPGA_TAG_8197F(x) \ -+ (((x) >> BIT_SHIFT_FPGA_TAG_8197F) & BIT_MASK_FPGA_TAG_8197F) -+#define BIT_SET_FPGA_TAG_8197F(x, v) \ -+ (BIT_CLEAR_FPGA_TAG_8197F(x) | BIT_FPGA_TAG_8197F(v)) -+ -+/* 2 REG_WL_DSS_CTRL0_8197F */ -+#define BIT_WL_DSS_RSTN_8197F BIT(27) -+#define BIT_WL_DSS_EN_CLK_8197F BIT(26) -+#define BIT_WL_DSS_SPEED_EN_8197F BIT(25) -+ -+#define BIT_SHIFT_WL_DSS_COUNT_OUT_8197F 0 -+#define BIT_MASK_WL_DSS_COUNT_OUT_8197F 0xfffff -+#define BIT_WL_DSS_COUNT_OUT_8197F(x) \ -+ (((x) & BIT_MASK_WL_DSS_COUNT_OUT_8197F) \ -+ << BIT_SHIFT_WL_DSS_COUNT_OUT_8197F) -+#define BITS_WL_DSS_COUNT_OUT_8197F \ -+ (BIT_MASK_WL_DSS_COUNT_OUT_8197F << BIT_SHIFT_WL_DSS_COUNT_OUT_8197F) -+#define BIT_CLEAR_WL_DSS_COUNT_OUT_8197F(x) \ -+ ((x) & (~BITS_WL_DSS_COUNT_OUT_8197F)) -+#define BIT_GET_WL_DSS_COUNT_OUT_8197F(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_COUNT_OUT_8197F) & \ -+ BIT_MASK_WL_DSS_COUNT_OUT_8197F) -+#define BIT_SET_WL_DSS_COUNT_OUT_8197F(x, v) \ -+ (BIT_CLEAR_WL_DSS_COUNT_OUT_8197F(x) | BIT_WL_DSS_COUNT_OUT_8197F(v)) -+ -+/* 2 REG_WL_DSS_CTRL1_8197F */ -+#define BIT_WL_DSS_RSTN_8197F BIT(27) -+#define BIT_WL_DSS_EN_CLK_8197F BIT(26) -+#define BIT_WL_DSS_SPEED_EN_8197F BIT(25) -+#define BIT_WL_DSS_WIRE_SEL_8197F BIT(24) -+ -+#define BIT_SHIFT_WL_DSS_RO_SEL_8197F 20 -+#define BIT_MASK_WL_DSS_RO_SEL_8197F 0x7 -+#define BIT_WL_DSS_RO_SEL_8197F(x) \ -+ (((x) & BIT_MASK_WL_DSS_RO_SEL_8197F) << BIT_SHIFT_WL_DSS_RO_SEL_8197F) -+#define BITS_WL_DSS_RO_SEL_8197F \ -+ (BIT_MASK_WL_DSS_RO_SEL_8197F << BIT_SHIFT_WL_DSS_RO_SEL_8197F) -+#define BIT_CLEAR_WL_DSS_RO_SEL_8197F(x) ((x) & (~BITS_WL_DSS_RO_SEL_8197F)) -+#define BIT_GET_WL_DSS_RO_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_RO_SEL_8197F) & BIT_MASK_WL_DSS_RO_SEL_8197F) -+#define BIT_SET_WL_DSS_RO_SEL_8197F(x, v) \ -+ (BIT_CLEAR_WL_DSS_RO_SEL_8197F(x) | BIT_WL_DSS_RO_SEL_8197F(v)) -+ -+#define BIT_SHIFT_WL_DSS_DATA_IN_8197F 0 -+#define BIT_MASK_WL_DSS_DATA_IN_8197F 0xfffff -+#define BIT_WL_DSS_DATA_IN_8197F(x) \ -+ (((x) & BIT_MASK_WL_DSS_DATA_IN_8197F) \ -+ << BIT_SHIFT_WL_DSS_DATA_IN_8197F) -+#define BITS_WL_DSS_DATA_IN_8197F \ -+ (BIT_MASK_WL_DSS_DATA_IN_8197F << BIT_SHIFT_WL_DSS_DATA_IN_8197F) -+#define BIT_CLEAR_WL_DSS_DATA_IN_8197F(x) ((x) & (~BITS_WL_DSS_DATA_IN_8197F)) -+#define BIT_GET_WL_DSS_DATA_IN_8197F(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_DATA_IN_8197F) & \ -+ BIT_MASK_WL_DSS_DATA_IN_8197F) -+#define BIT_SET_WL_DSS_DATA_IN_8197F(x, v) \ -+ (BIT_CLEAR_WL_DSS_DATA_IN_8197F(x) | BIT_WL_DSS_DATA_IN_8197F(v)) -+ -+/* 2 REG_WL_DSS_STATUS1_8197F */ -+#define BIT_WL_DSS_READY_8197F BIT(21) -+#define BIT_WL_DSS_WSORT_GO_8197F BIT(20) -+ -+#define BIT_SHIFT_WL_DSS_COUNT_OUT_8197F 0 -+#define BIT_MASK_WL_DSS_COUNT_OUT_8197F 0xfffff -+#define BIT_WL_DSS_COUNT_OUT_8197F(x) \ -+ (((x) & BIT_MASK_WL_DSS_COUNT_OUT_8197F) \ -+ << BIT_SHIFT_WL_DSS_COUNT_OUT_8197F) -+#define BITS_WL_DSS_COUNT_OUT_8197F \ -+ (BIT_MASK_WL_DSS_COUNT_OUT_8197F << BIT_SHIFT_WL_DSS_COUNT_OUT_8197F) -+#define BIT_CLEAR_WL_DSS_COUNT_OUT_8197F(x) \ -+ ((x) & (~BITS_WL_DSS_COUNT_OUT_8197F)) -+#define BIT_GET_WL_DSS_COUNT_OUT_8197F(x) \ -+ (((x) >> BIT_SHIFT_WL_DSS_COUNT_OUT_8197F) & \ -+ BIT_MASK_WL_DSS_COUNT_OUT_8197F) -+#define BIT_SET_WL_DSS_COUNT_OUT_8197F(x, v) \ -+ (BIT_CLEAR_WL_DSS_COUNT_OUT_8197F(x) | BIT_WL_DSS_COUNT_OUT_8197F(v)) -+ -+/* 2 REG_FW_DBG0_8197F */ -+ -+#define BIT_SHIFT_FW_DBG0_8197F 0 -+#define BIT_MASK_FW_DBG0_8197F 0xffffffffL -+#define BIT_FW_DBG0_8197F(x) \ -+ (((x) & BIT_MASK_FW_DBG0_8197F) << BIT_SHIFT_FW_DBG0_8197F) -+#define BITS_FW_DBG0_8197F (BIT_MASK_FW_DBG0_8197F << BIT_SHIFT_FW_DBG0_8197F) -+#define BIT_CLEAR_FW_DBG0_8197F(x) ((x) & (~BITS_FW_DBG0_8197F)) -+#define BIT_GET_FW_DBG0_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG0_8197F) & BIT_MASK_FW_DBG0_8197F) -+#define BIT_SET_FW_DBG0_8197F(x, v) \ -+ (BIT_CLEAR_FW_DBG0_8197F(x) | BIT_FW_DBG0_8197F(v)) -+ -+/* 2 REG_FW_DBG1_8197F */ -+ -+#define BIT_SHIFT_FW_DBG1_8197F 0 -+#define BIT_MASK_FW_DBG1_8197F 0xffffffffL -+#define BIT_FW_DBG1_8197F(x) \ -+ (((x) & BIT_MASK_FW_DBG1_8197F) << BIT_SHIFT_FW_DBG1_8197F) -+#define BITS_FW_DBG1_8197F (BIT_MASK_FW_DBG1_8197F << BIT_SHIFT_FW_DBG1_8197F) -+#define BIT_CLEAR_FW_DBG1_8197F(x) ((x) & (~BITS_FW_DBG1_8197F)) -+#define BIT_GET_FW_DBG1_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG1_8197F) & BIT_MASK_FW_DBG1_8197F) -+#define BIT_SET_FW_DBG1_8197F(x, v) \ -+ (BIT_CLEAR_FW_DBG1_8197F(x) | BIT_FW_DBG1_8197F(v)) -+ -+/* 2 REG_FW_DBG2_8197F */ -+ -+#define BIT_SHIFT_FW_DBG2_8197F 0 -+#define BIT_MASK_FW_DBG2_8197F 0xffffffffL -+#define BIT_FW_DBG2_8197F(x) \ -+ (((x) & BIT_MASK_FW_DBG2_8197F) << BIT_SHIFT_FW_DBG2_8197F) -+#define BITS_FW_DBG2_8197F (BIT_MASK_FW_DBG2_8197F << BIT_SHIFT_FW_DBG2_8197F) -+#define BIT_CLEAR_FW_DBG2_8197F(x) ((x) & (~BITS_FW_DBG2_8197F)) -+#define BIT_GET_FW_DBG2_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG2_8197F) & BIT_MASK_FW_DBG2_8197F) -+#define BIT_SET_FW_DBG2_8197F(x, v) \ -+ (BIT_CLEAR_FW_DBG2_8197F(x) | BIT_FW_DBG2_8197F(v)) -+ -+/* 2 REG_FW_DBG3_8197F */ -+ -+#define BIT_SHIFT_FW_DBG3_8197F 0 -+#define BIT_MASK_FW_DBG3_8197F 0xffffffffL -+#define BIT_FW_DBG3_8197F(x) \ -+ (((x) & BIT_MASK_FW_DBG3_8197F) << BIT_SHIFT_FW_DBG3_8197F) -+#define BITS_FW_DBG3_8197F (BIT_MASK_FW_DBG3_8197F << BIT_SHIFT_FW_DBG3_8197F) -+#define BIT_CLEAR_FW_DBG3_8197F(x) ((x) & (~BITS_FW_DBG3_8197F)) -+#define BIT_GET_FW_DBG3_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG3_8197F) & BIT_MASK_FW_DBG3_8197F) -+#define BIT_SET_FW_DBG3_8197F(x, v) \ -+ (BIT_CLEAR_FW_DBG3_8197F(x) | BIT_FW_DBG3_8197F(v)) -+ -+/* 2 REG_FW_DBG4_8197F */ -+ -+#define BIT_SHIFT_FW_DBG4_8197F 0 -+#define BIT_MASK_FW_DBG4_8197F 0xffffffffL -+#define BIT_FW_DBG4_8197F(x) \ -+ (((x) & BIT_MASK_FW_DBG4_8197F) << BIT_SHIFT_FW_DBG4_8197F) -+#define BITS_FW_DBG4_8197F (BIT_MASK_FW_DBG4_8197F << BIT_SHIFT_FW_DBG4_8197F) -+#define BIT_CLEAR_FW_DBG4_8197F(x) ((x) & (~BITS_FW_DBG4_8197F)) -+#define BIT_GET_FW_DBG4_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG4_8197F) & BIT_MASK_FW_DBG4_8197F) -+#define BIT_SET_FW_DBG4_8197F(x, v) \ -+ (BIT_CLEAR_FW_DBG4_8197F(x) | BIT_FW_DBG4_8197F(v)) -+ -+/* 2 REG_FW_DBG5_8197F */ -+ -+#define BIT_SHIFT_FW_DBG5_8197F 0 -+#define BIT_MASK_FW_DBG5_8197F 0xffffffffL -+#define BIT_FW_DBG5_8197F(x) \ -+ (((x) & BIT_MASK_FW_DBG5_8197F) << BIT_SHIFT_FW_DBG5_8197F) -+#define BITS_FW_DBG5_8197F (BIT_MASK_FW_DBG5_8197F << BIT_SHIFT_FW_DBG5_8197F) -+#define BIT_CLEAR_FW_DBG5_8197F(x) ((x) & (~BITS_FW_DBG5_8197F)) -+#define BIT_GET_FW_DBG5_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG5_8197F) & BIT_MASK_FW_DBG5_8197F) -+#define BIT_SET_FW_DBG5_8197F(x, v) \ -+ (BIT_CLEAR_FW_DBG5_8197F(x) | BIT_FW_DBG5_8197F(v)) -+ -+/* 2 REG_FW_DBG6_8197F */ -+ -+#define BIT_SHIFT_FW_DBG6_8197F 0 -+#define BIT_MASK_FW_DBG6_8197F 0xffffffffL -+#define BIT_FW_DBG6_8197F(x) \ -+ (((x) & BIT_MASK_FW_DBG6_8197F) << BIT_SHIFT_FW_DBG6_8197F) -+#define BITS_FW_DBG6_8197F (BIT_MASK_FW_DBG6_8197F << BIT_SHIFT_FW_DBG6_8197F) -+#define BIT_CLEAR_FW_DBG6_8197F(x) ((x) & (~BITS_FW_DBG6_8197F)) -+#define BIT_GET_FW_DBG6_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG6_8197F) & BIT_MASK_FW_DBG6_8197F) -+#define BIT_SET_FW_DBG6_8197F(x, v) \ -+ (BIT_CLEAR_FW_DBG6_8197F(x) | BIT_FW_DBG6_8197F(v)) -+ -+/* 2 REG_FW_DBG7_8197F */ -+ -+#define BIT_SHIFT_FW_DBG7_8197F 0 -+#define BIT_MASK_FW_DBG7_8197F 0xffffffffL -+#define BIT_FW_DBG7_8197F(x) \ -+ (((x) & BIT_MASK_FW_DBG7_8197F) << BIT_SHIFT_FW_DBG7_8197F) -+#define BITS_FW_DBG7_8197F (BIT_MASK_FW_DBG7_8197F << BIT_SHIFT_FW_DBG7_8197F) -+#define BIT_CLEAR_FW_DBG7_8197F(x) ((x) & (~BITS_FW_DBG7_8197F)) -+#define BIT_GET_FW_DBG7_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG7_8197F) & BIT_MASK_FW_DBG7_8197F) -+#define BIT_SET_FW_DBG7_8197F(x, v) \ -+ (BIT_CLEAR_FW_DBG7_8197F(x) | BIT_FW_DBG7_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_CR_8197F (ENABLE FUNCTION REGISTER) */ -+#define BIT_MACIO_TIMEOUT_EN_8197F BIT(29) -+ -+#define BIT_SHIFT_LBMODE_8197F 24 -+#define BIT_MASK_LBMODE_8197F 0x1f -+#define BIT_LBMODE_8197F(x) \ -+ (((x) & BIT_MASK_LBMODE_8197F) << BIT_SHIFT_LBMODE_8197F) -+#define BITS_LBMODE_8197F (BIT_MASK_LBMODE_8197F << BIT_SHIFT_LBMODE_8197F) -+#define BIT_CLEAR_LBMODE_8197F(x) ((x) & (~BITS_LBMODE_8197F)) -+#define BIT_GET_LBMODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_LBMODE_8197F) & BIT_MASK_LBMODE_8197F) -+#define BIT_SET_LBMODE_8197F(x, v) \ -+ (BIT_CLEAR_LBMODE_8197F(x) | BIT_LBMODE_8197F(v)) -+ -+#define BIT_SHIFT_NETYPE1_8197F 18 -+#define BIT_MASK_NETYPE1_8197F 0x3 -+#define BIT_NETYPE1_8197F(x) \ -+ (((x) & BIT_MASK_NETYPE1_8197F) << BIT_SHIFT_NETYPE1_8197F) -+#define BITS_NETYPE1_8197F (BIT_MASK_NETYPE1_8197F << BIT_SHIFT_NETYPE1_8197F) -+#define BIT_CLEAR_NETYPE1_8197F(x) ((x) & (~BITS_NETYPE1_8197F)) -+#define BIT_GET_NETYPE1_8197F(x) \ -+ (((x) >> BIT_SHIFT_NETYPE1_8197F) & BIT_MASK_NETYPE1_8197F) -+#define BIT_SET_NETYPE1_8197F(x, v) \ -+ (BIT_CLEAR_NETYPE1_8197F(x) | BIT_NETYPE1_8197F(v)) -+ -+#define BIT_SHIFT_NETYPE0_8197F 16 -+#define BIT_MASK_NETYPE0_8197F 0x3 -+#define BIT_NETYPE0_8197F(x) \ -+ (((x) & BIT_MASK_NETYPE0_8197F) << BIT_SHIFT_NETYPE0_8197F) -+#define BITS_NETYPE0_8197F (BIT_MASK_NETYPE0_8197F << BIT_SHIFT_NETYPE0_8197F) -+#define BIT_CLEAR_NETYPE0_8197F(x) ((x) & (~BITS_NETYPE0_8197F)) -+#define BIT_GET_NETYPE0_8197F(x) \ -+ (((x) >> BIT_SHIFT_NETYPE0_8197F) & BIT_MASK_NETYPE0_8197F) -+#define BIT_SET_NETYPE0_8197F(x, v) \ -+ (BIT_CLEAR_NETYPE0_8197F(x) | BIT_NETYPE0_8197F(v)) -+ -+#define BIT_STAT_FUNC_RST_8197F BIT(13) -+#define BIT_I2C_MAILBOX_EN_8197F BIT(12) -+#define BIT_SHCUT_EN_8197F BIT(11) -+#define BIT_32K_CAL_TMR_EN_8197F BIT(10) -+#define BIT_MAC_SEC_EN_8197F BIT(9) -+#define BIT_ENSWBCN_8197F BIT(8) -+#define BIT_MACRXEN_8197F BIT(7) -+#define BIT_MACTXEN_8197F BIT(6) -+#define BIT_SCHEDULE_EN_8197F BIT(5) -+#define BIT_PROTOCOL_EN_8197F BIT(4) -+#define BIT_RXDMA_EN_8197F BIT(3) -+#define BIT_TXDMA_EN_8197F BIT(2) -+#define BIT_HCI_RXDMA_EN_8197F BIT(1) -+#define BIT_HCI_TXDMA_EN_8197F BIT(0) -+ -+/* 2 REG_TSF_CLK_STATE_8197F */ -+#define BIT_TSF_CLK_STABLE_8197F BIT(15) -+ -+/* 2 REG_TXDMA_PQ_MAP_8197F */ -+ -+#define BIT_SHIFT_TXDMA_HIQ_MAP_8197F 14 -+#define BIT_MASK_TXDMA_HIQ_MAP_8197F 0x3 -+#define BIT_TXDMA_HIQ_MAP_8197F(x) \ -+ (((x) & BIT_MASK_TXDMA_HIQ_MAP_8197F) << BIT_SHIFT_TXDMA_HIQ_MAP_8197F) -+#define BITS_TXDMA_HIQ_MAP_8197F \ -+ (BIT_MASK_TXDMA_HIQ_MAP_8197F << BIT_SHIFT_TXDMA_HIQ_MAP_8197F) -+#define BIT_CLEAR_TXDMA_HIQ_MAP_8197F(x) ((x) & (~BITS_TXDMA_HIQ_MAP_8197F)) -+#define BIT_GET_TXDMA_HIQ_MAP_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_HIQ_MAP_8197F) & BIT_MASK_TXDMA_HIQ_MAP_8197F) -+#define BIT_SET_TXDMA_HIQ_MAP_8197F(x, v) \ -+ (BIT_CLEAR_TXDMA_HIQ_MAP_8197F(x) | BIT_TXDMA_HIQ_MAP_8197F(v)) -+ -+#define BIT_SHIFT_TXDMA_MGQ_MAP_8197F 12 -+#define BIT_MASK_TXDMA_MGQ_MAP_8197F 0x3 -+#define BIT_TXDMA_MGQ_MAP_8197F(x) \ -+ (((x) & BIT_MASK_TXDMA_MGQ_MAP_8197F) << BIT_SHIFT_TXDMA_MGQ_MAP_8197F) -+#define BITS_TXDMA_MGQ_MAP_8197F \ -+ (BIT_MASK_TXDMA_MGQ_MAP_8197F << BIT_SHIFT_TXDMA_MGQ_MAP_8197F) -+#define BIT_CLEAR_TXDMA_MGQ_MAP_8197F(x) ((x) & (~BITS_TXDMA_MGQ_MAP_8197F)) -+#define BIT_GET_TXDMA_MGQ_MAP_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_MGQ_MAP_8197F) & BIT_MASK_TXDMA_MGQ_MAP_8197F) -+#define BIT_SET_TXDMA_MGQ_MAP_8197F(x, v) \ -+ (BIT_CLEAR_TXDMA_MGQ_MAP_8197F(x) | BIT_TXDMA_MGQ_MAP_8197F(v)) -+ -+#define BIT_SHIFT_TXDMA_BKQ_MAP_8197F 10 -+#define BIT_MASK_TXDMA_BKQ_MAP_8197F 0x3 -+#define BIT_TXDMA_BKQ_MAP_8197F(x) \ -+ (((x) & BIT_MASK_TXDMA_BKQ_MAP_8197F) << BIT_SHIFT_TXDMA_BKQ_MAP_8197F) -+#define BITS_TXDMA_BKQ_MAP_8197F \ -+ (BIT_MASK_TXDMA_BKQ_MAP_8197F << BIT_SHIFT_TXDMA_BKQ_MAP_8197F) -+#define BIT_CLEAR_TXDMA_BKQ_MAP_8197F(x) ((x) & (~BITS_TXDMA_BKQ_MAP_8197F)) -+#define BIT_GET_TXDMA_BKQ_MAP_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BKQ_MAP_8197F) & BIT_MASK_TXDMA_BKQ_MAP_8197F) -+#define BIT_SET_TXDMA_BKQ_MAP_8197F(x, v) \ -+ (BIT_CLEAR_TXDMA_BKQ_MAP_8197F(x) | BIT_TXDMA_BKQ_MAP_8197F(v)) -+ -+#define BIT_SHIFT_TXDMA_BEQ_MAP_8197F 8 -+#define BIT_MASK_TXDMA_BEQ_MAP_8197F 0x3 -+#define BIT_TXDMA_BEQ_MAP_8197F(x) \ -+ (((x) & BIT_MASK_TXDMA_BEQ_MAP_8197F) << BIT_SHIFT_TXDMA_BEQ_MAP_8197F) -+#define BITS_TXDMA_BEQ_MAP_8197F \ -+ (BIT_MASK_TXDMA_BEQ_MAP_8197F << BIT_SHIFT_TXDMA_BEQ_MAP_8197F) -+#define BIT_CLEAR_TXDMA_BEQ_MAP_8197F(x) ((x) & (~BITS_TXDMA_BEQ_MAP_8197F)) -+#define BIT_GET_TXDMA_BEQ_MAP_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BEQ_MAP_8197F) & BIT_MASK_TXDMA_BEQ_MAP_8197F) -+#define BIT_SET_TXDMA_BEQ_MAP_8197F(x, v) \ -+ (BIT_CLEAR_TXDMA_BEQ_MAP_8197F(x) | BIT_TXDMA_BEQ_MAP_8197F(v)) -+ -+#define BIT_SHIFT_TXDMA_VIQ_MAP_8197F 6 -+#define BIT_MASK_TXDMA_VIQ_MAP_8197F 0x3 -+#define BIT_TXDMA_VIQ_MAP_8197F(x) \ -+ (((x) & BIT_MASK_TXDMA_VIQ_MAP_8197F) << BIT_SHIFT_TXDMA_VIQ_MAP_8197F) -+#define BITS_TXDMA_VIQ_MAP_8197F \ -+ (BIT_MASK_TXDMA_VIQ_MAP_8197F << BIT_SHIFT_TXDMA_VIQ_MAP_8197F) -+#define BIT_CLEAR_TXDMA_VIQ_MAP_8197F(x) ((x) & (~BITS_TXDMA_VIQ_MAP_8197F)) -+#define BIT_GET_TXDMA_VIQ_MAP_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VIQ_MAP_8197F) & BIT_MASK_TXDMA_VIQ_MAP_8197F) -+#define BIT_SET_TXDMA_VIQ_MAP_8197F(x, v) \ -+ (BIT_CLEAR_TXDMA_VIQ_MAP_8197F(x) | BIT_TXDMA_VIQ_MAP_8197F(v)) -+ -+#define BIT_SHIFT_TXDMA_VOQ_MAP_8197F 4 -+#define BIT_MASK_TXDMA_VOQ_MAP_8197F 0x3 -+#define BIT_TXDMA_VOQ_MAP_8197F(x) \ -+ (((x) & BIT_MASK_TXDMA_VOQ_MAP_8197F) << BIT_SHIFT_TXDMA_VOQ_MAP_8197F) -+#define BITS_TXDMA_VOQ_MAP_8197F \ -+ (BIT_MASK_TXDMA_VOQ_MAP_8197F << BIT_SHIFT_TXDMA_VOQ_MAP_8197F) -+#define BIT_CLEAR_TXDMA_VOQ_MAP_8197F(x) ((x) & (~BITS_TXDMA_VOQ_MAP_8197F)) -+#define BIT_GET_TXDMA_VOQ_MAP_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VOQ_MAP_8197F) & BIT_MASK_TXDMA_VOQ_MAP_8197F) -+#define BIT_SET_TXDMA_VOQ_MAP_8197F(x, v) \ -+ (BIT_CLEAR_TXDMA_VOQ_MAP_8197F(x) | BIT_TXDMA_VOQ_MAP_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_RXDMA_AGG_EN_8197F BIT(2) -+#define BIT_RXSHFT_EN_8197F BIT(1) -+#define BIT_RXDMA_ARBBW_EN_8197F BIT(0) -+ -+/* 2 REG_TRXFF_BNDY_8197F */ -+ -+#define BIT_SHIFT_RXFFOVFL_RSV_V2_8197F 8 -+#define BIT_MASK_RXFFOVFL_RSV_V2_8197F 0xf -+#define BIT_RXFFOVFL_RSV_V2_8197F(x) \ -+ (((x) & BIT_MASK_RXFFOVFL_RSV_V2_8197F) \ -+ << BIT_SHIFT_RXFFOVFL_RSV_V2_8197F) -+#define BITS_RXFFOVFL_RSV_V2_8197F \ -+ (BIT_MASK_RXFFOVFL_RSV_V2_8197F << BIT_SHIFT_RXFFOVFL_RSV_V2_8197F) -+#define BIT_CLEAR_RXFFOVFL_RSV_V2_8197F(x) ((x) & (~BITS_RXFFOVFL_RSV_V2_8197F)) -+#define BIT_GET_RXFFOVFL_RSV_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXFFOVFL_RSV_V2_8197F) & \ -+ BIT_MASK_RXFFOVFL_RSV_V2_8197F) -+#define BIT_SET_RXFFOVFL_RSV_V2_8197F(x, v) \ -+ (BIT_CLEAR_RXFFOVFL_RSV_V2_8197F(x) | BIT_RXFFOVFL_RSV_V2_8197F(v)) -+ -+#define BIT_SHIFT_TXPKTBUF_PGBNDY_8197F 0 -+#define BIT_MASK_TXPKTBUF_PGBNDY_8197F 0xff -+#define BIT_TXPKTBUF_PGBNDY_8197F(x) \ -+ (((x) & BIT_MASK_TXPKTBUF_PGBNDY_8197F) \ -+ << BIT_SHIFT_TXPKTBUF_PGBNDY_8197F) -+#define BITS_TXPKTBUF_PGBNDY_8197F \ -+ (BIT_MASK_TXPKTBUF_PGBNDY_8197F << BIT_SHIFT_TXPKTBUF_PGBNDY_8197F) -+#define BIT_CLEAR_TXPKTBUF_PGBNDY_8197F(x) ((x) & (~BITS_TXPKTBUF_PGBNDY_8197F)) -+#define BIT_GET_TXPKTBUF_PGBNDY_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXPKTBUF_PGBNDY_8197F) & \ -+ BIT_MASK_TXPKTBUF_PGBNDY_8197F) -+#define BIT_SET_TXPKTBUF_PGBNDY_8197F(x, v) \ -+ (BIT_CLEAR_TXPKTBUF_PGBNDY_8197F(x) | BIT_TXPKTBUF_PGBNDY_8197F(v)) -+ -+/* 2 REG_PTA_I2C_MBOX_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_I2C_M_STATUS_8197F 8 -+#define BIT_MASK_I2C_M_STATUS_8197F 0xf -+#define BIT_I2C_M_STATUS_8197F(x) \ -+ (((x) & BIT_MASK_I2C_M_STATUS_8197F) << BIT_SHIFT_I2C_M_STATUS_8197F) -+#define BITS_I2C_M_STATUS_8197F \ -+ (BIT_MASK_I2C_M_STATUS_8197F << BIT_SHIFT_I2C_M_STATUS_8197F) -+#define BIT_CLEAR_I2C_M_STATUS_8197F(x) ((x) & (~BITS_I2C_M_STATUS_8197F)) -+#define BIT_GET_I2C_M_STATUS_8197F(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_STATUS_8197F) & BIT_MASK_I2C_M_STATUS_8197F) -+#define BIT_SET_I2C_M_STATUS_8197F(x, v) \ -+ (BIT_CLEAR_I2C_M_STATUS_8197F(x) | BIT_I2C_M_STATUS_8197F(v)) -+ -+#define BIT_SHIFT_I2C_M_BUS_GNT_FW_8197F 4 -+#define BIT_MASK_I2C_M_BUS_GNT_FW_8197F 0x7 -+#define BIT_I2C_M_BUS_GNT_FW_8197F(x) \ -+ (((x) & BIT_MASK_I2C_M_BUS_GNT_FW_8197F) \ -+ << BIT_SHIFT_I2C_M_BUS_GNT_FW_8197F) -+#define BITS_I2C_M_BUS_GNT_FW_8197F \ -+ (BIT_MASK_I2C_M_BUS_GNT_FW_8197F << BIT_SHIFT_I2C_M_BUS_GNT_FW_8197F) -+#define BIT_CLEAR_I2C_M_BUS_GNT_FW_8197F(x) \ -+ ((x) & (~BITS_I2C_M_BUS_GNT_FW_8197F)) -+#define BIT_GET_I2C_M_BUS_GNT_FW_8197F(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_BUS_GNT_FW_8197F) & \ -+ BIT_MASK_I2C_M_BUS_GNT_FW_8197F) -+#define BIT_SET_I2C_M_BUS_GNT_FW_8197F(x, v) \ -+ (BIT_CLEAR_I2C_M_BUS_GNT_FW_8197F(x) | BIT_I2C_M_BUS_GNT_FW_8197F(v)) -+ -+#define BIT_I2C_M_GNT_FW_8197F BIT(3) -+ -+#define BIT_SHIFT_I2C_M_SPEED_8197F 1 -+#define BIT_MASK_I2C_M_SPEED_8197F 0x3 -+#define BIT_I2C_M_SPEED_8197F(x) \ -+ (((x) & BIT_MASK_I2C_M_SPEED_8197F) << BIT_SHIFT_I2C_M_SPEED_8197F) -+#define BITS_I2C_M_SPEED_8197F \ -+ (BIT_MASK_I2C_M_SPEED_8197F << BIT_SHIFT_I2C_M_SPEED_8197F) -+#define BIT_CLEAR_I2C_M_SPEED_8197F(x) ((x) & (~BITS_I2C_M_SPEED_8197F)) -+#define BIT_GET_I2C_M_SPEED_8197F(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_SPEED_8197F) & BIT_MASK_I2C_M_SPEED_8197F) -+#define BIT_SET_I2C_M_SPEED_8197F(x, v) \ -+ (BIT_CLEAR_I2C_M_SPEED_8197F(x) | BIT_I2C_M_SPEED_8197F(v)) -+ -+#define BIT_I2C_M_UNLOCK_8197F BIT(0) -+ -+/* 2 REG_RXFF_BNDY_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_RXFF0_BNDY_V2_8197F 0 -+#define BIT_MASK_RXFF0_BNDY_V2_8197F 0x3ffff -+#define BIT_RXFF0_BNDY_V2_8197F(x) \ -+ (((x) & BIT_MASK_RXFF0_BNDY_V2_8197F) << BIT_SHIFT_RXFF0_BNDY_V2_8197F) -+#define BITS_RXFF0_BNDY_V2_8197F \ -+ (BIT_MASK_RXFF0_BNDY_V2_8197F << BIT_SHIFT_RXFF0_BNDY_V2_8197F) -+#define BIT_CLEAR_RXFF0_BNDY_V2_8197F(x) ((x) & (~BITS_RXFF0_BNDY_V2_8197F)) -+#define BIT_GET_RXFF0_BNDY_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_BNDY_V2_8197F) & BIT_MASK_RXFF0_BNDY_V2_8197F) -+#define BIT_SET_RXFF0_BNDY_V2_8197F(x, v) \ -+ (BIT_CLEAR_RXFF0_BNDY_V2_8197F(x) | BIT_RXFF0_BNDY_V2_8197F(v)) -+ -+/* 2 REG_FE1IMR_8197F */ -+#define BIT_BB_STOP_RX_INT_EN_8197F BIT(29) -+#define BIT_FS_RXDMA2_DONE_INT_EN_8197F BIT(28) -+#define BIT_FS_RXDONE3_INT_EN_8197F BIT(27) -+#define BIT_FS_RXDONE2_INT_EN_8197F BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_EN_8197F BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_EN_8197F BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_EN_8197F BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_EN_8197F BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_EN_8197F BIT(21) -+#define BIT_FS_RX_UMD0_INT_EN_8197F BIT(20) -+#define BIT_FS_RX_UMD1_INT_EN_8197F BIT(19) -+#define BIT_FS_RX_BMD0_INT_EN_8197F BIT(18) -+#define BIT_FS_RX_BMD1_INT_EN_8197F BIT(17) -+#define BIT_FS_RXDONE_INT_EN_8197F BIT(16) -+#define BIT_FS_WWLAN_INT_EN_8197F BIT(15) -+#define BIT_FS_SOUND_DONE_INT_EN_8197F BIT(14) -+#define BIT_FS_LP_STBY_INT_EN_8197F BIT(13) -+#define BIT_FS_TRL_MTR_INT_EN_8197F BIT(12) -+#define BIT_FS_BF1_PRETO_INT_EN_8197F BIT(11) -+#define BIT_FS_BF0_PRETO_INT_EN_8197F BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_EN_8197F BIT(9) -+#define BIT_FS_LTE_COEX_EN_8197F BIT(6) -+#define BIT_FS_WLACTOFF_INT_EN_8197F BIT(5) -+#define BIT_FS_WLACTON_INT_EN_8197F BIT(4) -+#define BIT_FS_BTCMD_INT_EN_8197F BIT(3) -+#define BIT_FS_REG_MAILBOX_TO_I2C_INT_EN_8197F BIT(2) -+#define BIT_FS_TRPC_TO_INT_EN_V1_8197F BIT(1) -+#define BIT_FS_RPC_O_T_INT_EN_V1_8197F BIT(0) -+ -+/* 2 REG_FE1ISR_8197F */ -+#define BIT_BB_STOP_RX_INT_8197F BIT(29) -+#define BIT_FS_RXDMA2_DONE_INT_8197F BIT(28) -+#define BIT_FS_RXDONE3_INT_8197F BIT(27) -+#define BIT_FS_RXDONE2_INT_8197F BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_8197F BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_8197F BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_8197F BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_8197F BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_8197F BIT(21) -+#define BIT_FS_RX_UMD0_INT_8197F BIT(20) -+#define BIT_FS_RX_UMD1_INT_8197F BIT(19) -+#define BIT_FS_RX_BMD0_INT_8197F BIT(18) -+#define BIT_FS_RX_BMD1_INT_8197F BIT(17) -+#define BIT_FS_RXDONE_INT_8197F BIT(16) -+#define BIT_FS_WWLAN_INT_8197F BIT(15) -+#define BIT_FS_SOUND_DONE_INT_8197F BIT(14) -+#define BIT_FS_LP_STBY_INT_8197F BIT(13) -+#define BIT_FS_TRL_MTR_INT_8197F BIT(12) -+#define BIT_FS_BF1_PRETO_INT_8197F BIT(11) -+#define BIT_FS_BF0_PRETO_INT_8197F BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_8197F BIT(9) -+#define BIT_FS_LTE_COEX_INT_8197F BIT(6) -+#define BIT_FS_WLACTOFF_INT_8197F BIT(5) -+#define BIT_FS_WLACTON_INT_8197F BIT(4) -+#define BIT_FS_BCN_RX_INT_INT_8197F BIT(3) -+#define BIT_FS_MAILBOX_TO_I2C_INT_8197F BIT(2) -+#define BIT_FS_TRPC_TO_INT_8197F BIT(1) -+#define BIT_FS_RPC_O_T_INT_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_CPWM_8197F */ -+#define BIT_CPWM_TOGGLING_8197F BIT(31) -+ -+#define BIT_SHIFT_CPWM_MOD_8197F 24 -+#define BIT_MASK_CPWM_MOD_8197F 0x7f -+#define BIT_CPWM_MOD_8197F(x) \ -+ (((x) & BIT_MASK_CPWM_MOD_8197F) << BIT_SHIFT_CPWM_MOD_8197F) -+#define BITS_CPWM_MOD_8197F \ -+ (BIT_MASK_CPWM_MOD_8197F << BIT_SHIFT_CPWM_MOD_8197F) -+#define BIT_CLEAR_CPWM_MOD_8197F(x) ((x) & (~BITS_CPWM_MOD_8197F)) -+#define BIT_GET_CPWM_MOD_8197F(x) \ -+ (((x) >> BIT_SHIFT_CPWM_MOD_8197F) & BIT_MASK_CPWM_MOD_8197F) -+#define BIT_SET_CPWM_MOD_8197F(x, v) \ -+ (BIT_CLEAR_CPWM_MOD_8197F(x) | BIT_CPWM_MOD_8197F(v)) -+ -+/* 2 REG_FWIMR_8197F */ -+#define BIT_FS_TXBCNOK_MB7_INT_EN_8197F BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_EN_8197F BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_EN_8197F BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_EN_8197F BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_EN_8197F BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_EN_8197F BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_EN_8197F BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_EN_8197F BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_EN_8197F BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_EN_8197F BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_EN_8197F BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_EN_8197F BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_EN_8197F BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_EN_8197F BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_EN_8197F BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_EN_8197F BIT(16) -+#define BIT_CPUMGN_POLLED_PKT_DONE_INT_EN_8197F BIT(15) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_EN_8197F BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_EN_8197F BIT(12) -+#define BIT_FS_DDMA1_LP_INT_ENBIT_CPUMGN_POLLED_PKT_BUSY_ERR_INT_EN_8197F \ -+ BIT(11) -+#define BIT_FS_DDMA1_HP_INT_EN_8197F BIT(10) -+#define BIT_FS_DDMA0_LP_INT_EN_8197F BIT(9) -+#define BIT_FS_DDMA0_HP_INT_EN_8197F BIT(8) -+#define BIT_FS_TRXRPT_INT_EN_8197F BIT(7) -+#define BIT_FS_C2H_W_READY_INT_EN_8197F BIT(6) -+#define BIT_FS_HRCV_INT_EN_8197F BIT(5) -+#define BIT_FS_H2CCMD_INT_EN_8197F BIT(4) -+#define BIT_FS_TXPKTIN_INT_EN_8197F BIT(3) -+#define BIT_FS_ERRORHDL_INT_EN_8197F BIT(2) -+#define BIT_FS_TXCCX_INT_EN_8197F BIT(1) -+#define BIT_FS_TXCLOSE_INT_EN_8197F BIT(0) -+ -+/* 2 REG_FWISR_8197F */ -+#define BIT_FS_TXBCNOK_MB7_INT_8197F BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_8197F BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_8197F BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_8197F BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_8197F BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_8197F BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_8197F BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_8197F BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_8197F BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_8197F BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_8197F BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_8197F BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_8197F BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_8197F BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_8197F BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_8197F BIT(16) -+#define BIT_CPUMGN_POLLED_PKT_DONE_INT_8197F BIT(15) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_8197F BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_8197F BIT(12) -+#define BIT_FS_DDMA1_LP_INTBIT_CPUMGN_POLLED_PKT_BUSY_ERR_INT_8197F BIT(11) -+#define BIT_FS_DDMA1_HP_INT_8197F BIT(10) -+#define BIT_FS_DDMA0_LP_INT_8197F BIT(9) -+#define BIT_FS_DDMA0_HP_INT_8197F BIT(8) -+#define BIT_FS_TRXRPT_INT_8197F BIT(7) -+#define BIT_FS_C2H_W_READY_INT_8197F BIT(6) -+#define BIT_FS_HRCV_INT_8197F BIT(5) -+#define BIT_FS_H2CCMD_INT_8197F BIT(4) -+#define BIT_FS_TXPKTIN_INT_8197F BIT(3) -+#define BIT_FS_ERRORHDL_INT_8197F BIT(2) -+#define BIT_FS_TXCCX_INT_8197F BIT(1) -+#define BIT_FS_TXCLOSE_INT_8197F BIT(0) -+ -+/* 2 REG_FTIMR_8197F */ -+#define BIT_PS_TIMER_C_EARLY_INT_EN_8197F BIT(23) -+#define BIT_PS_TIMER_B_EARLY_INT_EN_8197F BIT(22) -+#define BIT_PS_TIMER_A_EARLY_INT_EN_8197F BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_EN_8197F BIT(20) -+#define BIT_PS_TIMER_C_INT_EN_8197F BIT(19) -+#define BIT_PS_TIMER_B_INT_EN_8197F BIT(18) -+#define BIT_PS_TIMER_A_INT_EN_8197F BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_EN_8197F BIT(16) -+#define BIT_FS_PS_TIMEOUT2_EN_8197F BIT(15) -+#define BIT_FS_PS_TIMEOUT1_EN_8197F BIT(14) -+#define BIT_FS_PS_TIMEOUT0_EN_8197F BIT(13) -+#define BIT_FS_GTINT8_EN_8197F BIT(8) -+#define BIT_FS_GTINT7_EN_8197F BIT(7) -+#define BIT_FS_GTINT6_EN_8197F BIT(6) -+#define BIT_FS_GTINT5_EN_8197F BIT(5) -+#define BIT_FS_GTINT4_EN_8197F BIT(4) -+#define BIT_FS_GTINT3_EN_8197F BIT(3) -+#define BIT_FS_GTINT2_EN_8197F BIT(2) -+#define BIT_FS_GTINT1_EN_8197F BIT(1) -+#define BIT_FS_GTINT0_EN_8197F BIT(0) -+ -+/* 2 REG_FTISR_8197F */ -+#define BIT_PS_TIMER_C_EARLY__INT_8197F BIT(23) -+#define BIT_PS_TIMER_B_EARLY__INT_8197F BIT(22) -+#define BIT_PS_TIMER_A_EARLY__INT_8197F BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_8197F BIT(20) -+#define BIT_PS_TIMER_C_INT_8197F BIT(19) -+#define BIT_PS_TIMER_B_INT_8197F BIT(18) -+#define BIT_PS_TIMER_A_INT_8197F BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_8197F BIT(16) -+#define BIT_FS_PS_TIMEOUT2_INT_8197F BIT(15) -+#define BIT_FS_PS_TIMEOUT1_INT_8197F BIT(14) -+#define BIT_FS_PS_TIMEOUT0_INT_8197F BIT(13) -+#define BIT_FS_GTINT8_INT_8197F BIT(8) -+#define BIT_FS_GTINT7_INT_8197F BIT(7) -+#define BIT_FS_GTINT6_INT_8197F BIT(6) -+#define BIT_FS_GTINT5_INT_8197F BIT(5) -+#define BIT_FS_GTINT4_INT_8197F BIT(4) -+#define BIT_FS_GTINT3_INT_8197F BIT(3) -+#define BIT_FS_GTINT2_INT_8197F BIT(2) -+#define BIT_FS_GTINT1_INT_8197F BIT(1) -+#define BIT_FS_GTINT0_INT_8197F BIT(0) -+ -+/* 2 REG_PKTBUF_DBG_CTRL_8197F */ -+ -+#define BIT_SHIFT_PKTBUF_WRITE_EN_8197F 24 -+#define BIT_MASK_PKTBUF_WRITE_EN_8197F 0xff -+#define BIT_PKTBUF_WRITE_EN_8197F(x) \ -+ (((x) & BIT_MASK_PKTBUF_WRITE_EN_8197F) \ -+ << BIT_SHIFT_PKTBUF_WRITE_EN_8197F) -+#define BITS_PKTBUF_WRITE_EN_8197F \ -+ (BIT_MASK_PKTBUF_WRITE_EN_8197F << BIT_SHIFT_PKTBUF_WRITE_EN_8197F) -+#define BIT_CLEAR_PKTBUF_WRITE_EN_8197F(x) ((x) & (~BITS_PKTBUF_WRITE_EN_8197F)) -+#define BIT_GET_PKTBUF_WRITE_EN_8197F(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_WRITE_EN_8197F) & \ -+ BIT_MASK_PKTBUF_WRITE_EN_8197F) -+#define BIT_SET_PKTBUF_WRITE_EN_8197F(x, v) \ -+ (BIT_CLEAR_PKTBUF_WRITE_EN_8197F(x) | BIT_PKTBUF_WRITE_EN_8197F(v)) -+ -+#define BIT_TXRPTBUF_DBG_8197F BIT(23) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_TXPKTBUF_DBG_V2_8197F BIT(20) -+#define BIT_RXPKTBUF_DBG_8197F BIT(16) -+ -+#define BIT_SHIFT_PKTBUF_DBG_ADDR_8197F 0 -+#define BIT_MASK_PKTBUF_DBG_ADDR_8197F 0x1fff -+#define BIT_PKTBUF_DBG_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_ADDR_8197F) \ -+ << BIT_SHIFT_PKTBUF_DBG_ADDR_8197F) -+#define BITS_PKTBUF_DBG_ADDR_8197F \ -+ (BIT_MASK_PKTBUF_DBG_ADDR_8197F << BIT_SHIFT_PKTBUF_DBG_ADDR_8197F) -+#define BIT_CLEAR_PKTBUF_DBG_ADDR_8197F(x) ((x) & (~BITS_PKTBUF_DBG_ADDR_8197F)) -+#define BIT_GET_PKTBUF_DBG_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_ADDR_8197F) & \ -+ BIT_MASK_PKTBUF_DBG_ADDR_8197F) -+#define BIT_SET_PKTBUF_DBG_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_ADDR_8197F(x) | BIT_PKTBUF_DBG_ADDR_8197F(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_L_8197F */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_L_8197F 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_L_8197F 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_L_8197F(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_L_8197F) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_L_8197F) -+#define BITS_PKTBUF_DBG_DATA_L_8197F \ -+ (BIT_MASK_PKTBUF_DBG_DATA_L_8197F << BIT_SHIFT_PKTBUF_DBG_DATA_L_8197F) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_L_8197F(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_L_8197F)) -+#define BIT_GET_PKTBUF_DBG_DATA_L_8197F(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_L_8197F) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_L_8197F) -+#define BIT_SET_PKTBUF_DBG_DATA_L_8197F(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_L_8197F(x) | BIT_PKTBUF_DBG_DATA_L_8197F(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_H_8197F */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_H_8197F 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_H_8197F 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_H_8197F(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_H_8197F) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_H_8197F) -+#define BITS_PKTBUF_DBG_DATA_H_8197F \ -+ (BIT_MASK_PKTBUF_DBG_DATA_H_8197F << BIT_SHIFT_PKTBUF_DBG_DATA_H_8197F) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_H_8197F(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_H_8197F)) -+#define BIT_GET_PKTBUF_DBG_DATA_H_8197F(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_H_8197F) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_H_8197F) -+#define BIT_SET_PKTBUF_DBG_DATA_H_8197F(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_H_8197F(x) | BIT_PKTBUF_DBG_DATA_H_8197F(v)) -+ -+/* 2 REG_CPWM2_8197F */ -+ -+#define BIT_SHIFT_L0S_TO_RCVY_NUM_8197F 16 -+#define BIT_MASK_L0S_TO_RCVY_NUM_8197F 0xff -+#define BIT_L0S_TO_RCVY_NUM_8197F(x) \ -+ (((x) & BIT_MASK_L0S_TO_RCVY_NUM_8197F) \ -+ << BIT_SHIFT_L0S_TO_RCVY_NUM_8197F) -+#define BITS_L0S_TO_RCVY_NUM_8197F \ -+ (BIT_MASK_L0S_TO_RCVY_NUM_8197F << BIT_SHIFT_L0S_TO_RCVY_NUM_8197F) -+#define BIT_CLEAR_L0S_TO_RCVY_NUM_8197F(x) ((x) & (~BITS_L0S_TO_RCVY_NUM_8197F)) -+#define BIT_GET_L0S_TO_RCVY_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_L0S_TO_RCVY_NUM_8197F) & \ -+ BIT_MASK_L0S_TO_RCVY_NUM_8197F) -+#define BIT_SET_L0S_TO_RCVY_NUM_8197F(x, v) \ -+ (BIT_CLEAR_L0S_TO_RCVY_NUM_8197F(x) | BIT_L0S_TO_RCVY_NUM_8197F(v)) -+ -+#define BIT_CPWM2_TOGGLING_8197F BIT(15) -+ -+#define BIT_SHIFT_CPWM2_MOD_8197F 0 -+#define BIT_MASK_CPWM2_MOD_8197F 0x7fff -+#define BIT_CPWM2_MOD_8197F(x) \ -+ (((x) & BIT_MASK_CPWM2_MOD_8197F) << BIT_SHIFT_CPWM2_MOD_8197F) -+#define BITS_CPWM2_MOD_8197F \ -+ (BIT_MASK_CPWM2_MOD_8197F << BIT_SHIFT_CPWM2_MOD_8197F) -+#define BIT_CLEAR_CPWM2_MOD_8197F(x) ((x) & (~BITS_CPWM2_MOD_8197F)) -+#define BIT_GET_CPWM2_MOD_8197F(x) \ -+ (((x) >> BIT_SHIFT_CPWM2_MOD_8197F) & BIT_MASK_CPWM2_MOD_8197F) -+#define BIT_SET_CPWM2_MOD_8197F(x, v) \ -+ (BIT_CLEAR_CPWM2_MOD_8197F(x) | BIT_CPWM2_MOD_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_TC0_CTRL_8197F */ -+#define BIT_TC0INT_EN_8197F BIT(26) -+#define BIT_TC0MODE_8197F BIT(25) -+#define BIT_TC0EN_8197F BIT(24) -+ -+#define BIT_SHIFT_TC0DATA_8197F 0 -+#define BIT_MASK_TC0DATA_8197F 0xffffff -+#define BIT_TC0DATA_8197F(x) \ -+ (((x) & BIT_MASK_TC0DATA_8197F) << BIT_SHIFT_TC0DATA_8197F) -+#define BITS_TC0DATA_8197F (BIT_MASK_TC0DATA_8197F << BIT_SHIFT_TC0DATA_8197F) -+#define BIT_CLEAR_TC0DATA_8197F(x) ((x) & (~BITS_TC0DATA_8197F)) -+#define BIT_GET_TC0DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TC0DATA_8197F) & BIT_MASK_TC0DATA_8197F) -+#define BIT_SET_TC0DATA_8197F(x, v) \ -+ (BIT_CLEAR_TC0DATA_8197F(x) | BIT_TC0DATA_8197F(v)) -+ -+/* 2 REG_TC1_CTRL_8197F */ -+#define BIT_TC1INT_EN_8197F BIT(26) -+#define BIT_TC1MODE_8197F BIT(25) -+#define BIT_TC1EN_8197F BIT(24) -+ -+#define BIT_SHIFT_TC1DATA_8197F 0 -+#define BIT_MASK_TC1DATA_8197F 0xffffff -+#define BIT_TC1DATA_8197F(x) \ -+ (((x) & BIT_MASK_TC1DATA_8197F) << BIT_SHIFT_TC1DATA_8197F) -+#define BITS_TC1DATA_8197F (BIT_MASK_TC1DATA_8197F << BIT_SHIFT_TC1DATA_8197F) -+#define BIT_CLEAR_TC1DATA_8197F(x) ((x) & (~BITS_TC1DATA_8197F)) -+#define BIT_GET_TC1DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TC1DATA_8197F) & BIT_MASK_TC1DATA_8197F) -+#define BIT_SET_TC1DATA_8197F(x, v) \ -+ (BIT_CLEAR_TC1DATA_8197F(x) | BIT_TC1DATA_8197F(v)) -+ -+/* 2 REG_TC2_CTRL_8197F */ -+#define BIT_TC2INT_EN_8197F BIT(26) -+#define BIT_TC2MODE_8197F BIT(25) -+#define BIT_TC2EN_8197F BIT(24) -+ -+#define BIT_SHIFT_TC2DATA_8197F 0 -+#define BIT_MASK_TC2DATA_8197F 0xffffff -+#define BIT_TC2DATA_8197F(x) \ -+ (((x) & BIT_MASK_TC2DATA_8197F) << BIT_SHIFT_TC2DATA_8197F) -+#define BITS_TC2DATA_8197F (BIT_MASK_TC2DATA_8197F << BIT_SHIFT_TC2DATA_8197F) -+#define BIT_CLEAR_TC2DATA_8197F(x) ((x) & (~BITS_TC2DATA_8197F)) -+#define BIT_GET_TC2DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TC2DATA_8197F) & BIT_MASK_TC2DATA_8197F) -+#define BIT_SET_TC2DATA_8197F(x, v) \ -+ (BIT_CLEAR_TC2DATA_8197F(x) | BIT_TC2DATA_8197F(v)) -+ -+/* 2 REG_TC3_CTRL_8197F */ -+#define BIT_TC3INT_EN_8197F BIT(26) -+#define BIT_TC3MODE_8197F BIT(25) -+#define BIT_TC3EN_8197F BIT(24) -+ -+#define BIT_SHIFT_TC3DATA_8197F 0 -+#define BIT_MASK_TC3DATA_8197F 0xffffff -+#define BIT_TC3DATA_8197F(x) \ -+ (((x) & BIT_MASK_TC3DATA_8197F) << BIT_SHIFT_TC3DATA_8197F) -+#define BITS_TC3DATA_8197F (BIT_MASK_TC3DATA_8197F << BIT_SHIFT_TC3DATA_8197F) -+#define BIT_CLEAR_TC3DATA_8197F(x) ((x) & (~BITS_TC3DATA_8197F)) -+#define BIT_GET_TC3DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TC3DATA_8197F) & BIT_MASK_TC3DATA_8197F) -+#define BIT_SET_TC3DATA_8197F(x, v) \ -+ (BIT_CLEAR_TC3DATA_8197F(x) | BIT_TC3DATA_8197F(v)) -+ -+/* 2 REG_TC4_CTRL_8197F */ -+#define BIT_TC4INT_EN_8197F BIT(26) -+#define BIT_TC4MODE_8197F BIT(25) -+#define BIT_TC4EN_8197F BIT(24) -+ -+#define BIT_SHIFT_TC4DATA_8197F 0 -+#define BIT_MASK_TC4DATA_8197F 0xffffff -+#define BIT_TC4DATA_8197F(x) \ -+ (((x) & BIT_MASK_TC4DATA_8197F) << BIT_SHIFT_TC4DATA_8197F) -+#define BITS_TC4DATA_8197F (BIT_MASK_TC4DATA_8197F << BIT_SHIFT_TC4DATA_8197F) -+#define BIT_CLEAR_TC4DATA_8197F(x) ((x) & (~BITS_TC4DATA_8197F)) -+#define BIT_GET_TC4DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TC4DATA_8197F) & BIT_MASK_TC4DATA_8197F) -+#define BIT_SET_TC4DATA_8197F(x, v) \ -+ (BIT_CLEAR_TC4DATA_8197F(x) | BIT_TC4DATA_8197F(v)) -+ -+/* 2 REG_TCUNIT_BASE_8197F */ -+ -+#define BIT_SHIFT_TCUNIT_BASE_8197F 0 -+#define BIT_MASK_TCUNIT_BASE_8197F 0x3fff -+#define BIT_TCUNIT_BASE_8197F(x) \ -+ (((x) & BIT_MASK_TCUNIT_BASE_8197F) << BIT_SHIFT_TCUNIT_BASE_8197F) -+#define BITS_TCUNIT_BASE_8197F \ -+ (BIT_MASK_TCUNIT_BASE_8197F << BIT_SHIFT_TCUNIT_BASE_8197F) -+#define BIT_CLEAR_TCUNIT_BASE_8197F(x) ((x) & (~BITS_TCUNIT_BASE_8197F)) -+#define BIT_GET_TCUNIT_BASE_8197F(x) \ -+ (((x) >> BIT_SHIFT_TCUNIT_BASE_8197F) & BIT_MASK_TCUNIT_BASE_8197F) -+#define BIT_SET_TCUNIT_BASE_8197F(x, v) \ -+ (BIT_CLEAR_TCUNIT_BASE_8197F(x) | BIT_TCUNIT_BASE_8197F(v)) -+ -+/* 2 REG_TC5_CTRL_8197F */ -+#define BIT_TC5INT_EN_8197F BIT(26) -+#define BIT_TC5MODE_8197F BIT(25) -+#define BIT_TC5EN_8197F BIT(24) -+ -+#define BIT_SHIFT_TC5DATA_8197F 0 -+#define BIT_MASK_TC5DATA_8197F 0xffffff -+#define BIT_TC5DATA_8197F(x) \ -+ (((x) & BIT_MASK_TC5DATA_8197F) << BIT_SHIFT_TC5DATA_8197F) -+#define BITS_TC5DATA_8197F (BIT_MASK_TC5DATA_8197F << BIT_SHIFT_TC5DATA_8197F) -+#define BIT_CLEAR_TC5DATA_8197F(x) ((x) & (~BITS_TC5DATA_8197F)) -+#define BIT_GET_TC5DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TC5DATA_8197F) & BIT_MASK_TC5DATA_8197F) -+#define BIT_SET_TC5DATA_8197F(x, v) \ -+ (BIT_CLEAR_TC5DATA_8197F(x) | BIT_TC5DATA_8197F(v)) -+ -+/* 2 REG_TC6_CTRL_8197F */ -+#define BIT_TC6INT_EN_8197F BIT(26) -+#define BIT_TC6MODE_8197F BIT(25) -+#define BIT_TC6EN_8197F BIT(24) -+ -+#define BIT_SHIFT_TC6DATA_8197F 0 -+#define BIT_MASK_TC6DATA_8197F 0xffffff -+#define BIT_TC6DATA_8197F(x) \ -+ (((x) & BIT_MASK_TC6DATA_8197F) << BIT_SHIFT_TC6DATA_8197F) -+#define BITS_TC6DATA_8197F (BIT_MASK_TC6DATA_8197F << BIT_SHIFT_TC6DATA_8197F) -+#define BIT_CLEAR_TC6DATA_8197F(x) ((x) & (~BITS_TC6DATA_8197F)) -+#define BIT_GET_TC6DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TC6DATA_8197F) & BIT_MASK_TC6DATA_8197F) -+#define BIT_SET_TC6DATA_8197F(x, v) \ -+ (BIT_CLEAR_TC6DATA_8197F(x) | BIT_TC6DATA_8197F(v)) -+ -+/* 2 REG_MBIST_FAIL_8197F */ -+ -+#define BIT_SHIFT_8051_MBIST_FAIL_8197F 26 -+#define BIT_MASK_8051_MBIST_FAIL_8197F 0x7 -+#define BIT_8051_MBIST_FAIL_8197F(x) \ -+ (((x) & BIT_MASK_8051_MBIST_FAIL_8197F) \ -+ << BIT_SHIFT_8051_MBIST_FAIL_8197F) -+#define BITS_8051_MBIST_FAIL_8197F \ -+ (BIT_MASK_8051_MBIST_FAIL_8197F << BIT_SHIFT_8051_MBIST_FAIL_8197F) -+#define BIT_CLEAR_8051_MBIST_FAIL_8197F(x) ((x) & (~BITS_8051_MBIST_FAIL_8197F)) -+#define BIT_GET_8051_MBIST_FAIL_8197F(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_FAIL_8197F) & \ -+ BIT_MASK_8051_MBIST_FAIL_8197F) -+#define BIT_SET_8051_MBIST_FAIL_8197F(x, v) \ -+ (BIT_CLEAR_8051_MBIST_FAIL_8197F(x) | BIT_8051_MBIST_FAIL_8197F(v)) -+ -+#define BIT_SHIFT_USB_MBIST_FAIL_8197F 24 -+#define BIT_MASK_USB_MBIST_FAIL_8197F 0x3 -+#define BIT_USB_MBIST_FAIL_8197F(x) \ -+ (((x) & BIT_MASK_USB_MBIST_FAIL_8197F) \ -+ << BIT_SHIFT_USB_MBIST_FAIL_8197F) -+#define BITS_USB_MBIST_FAIL_8197F \ -+ (BIT_MASK_USB_MBIST_FAIL_8197F << BIT_SHIFT_USB_MBIST_FAIL_8197F) -+#define BIT_CLEAR_USB_MBIST_FAIL_8197F(x) ((x) & (~BITS_USB_MBIST_FAIL_8197F)) -+#define BIT_GET_USB_MBIST_FAIL_8197F(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_FAIL_8197F) & \ -+ BIT_MASK_USB_MBIST_FAIL_8197F) -+#define BIT_SET_USB_MBIST_FAIL_8197F(x, v) \ -+ (BIT_CLEAR_USB_MBIST_FAIL_8197F(x) | BIT_USB_MBIST_FAIL_8197F(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_FAIL_8197F 16 -+#define BIT_MASK_PCIE_MBIST_FAIL_8197F 0x3f -+#define BIT_PCIE_MBIST_FAIL_8197F(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_FAIL_8197F) \ -+ << BIT_SHIFT_PCIE_MBIST_FAIL_8197F) -+#define BITS_PCIE_MBIST_FAIL_8197F \ -+ (BIT_MASK_PCIE_MBIST_FAIL_8197F << BIT_SHIFT_PCIE_MBIST_FAIL_8197F) -+#define BIT_CLEAR_PCIE_MBIST_FAIL_8197F(x) ((x) & (~BITS_PCIE_MBIST_FAIL_8197F)) -+#define BIT_GET_PCIE_MBIST_FAIL_8197F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_FAIL_8197F) & \ -+ BIT_MASK_PCIE_MBIST_FAIL_8197F) -+#define BIT_SET_PCIE_MBIST_FAIL_8197F(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_FAIL_8197F(x) | BIT_PCIE_MBIST_FAIL_8197F(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_FAIL_DRF_8197F 0 -+#define BIT_MASK_MAC_MBIST_FAIL_DRF_8197F 0x3ffff -+#define BIT_MAC_MBIST_FAIL_DRF_8197F(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_FAIL_DRF_8197F) \ -+ << BIT_SHIFT_MAC_MBIST_FAIL_DRF_8197F) -+#define BITS_MAC_MBIST_FAIL_DRF_8197F \ -+ (BIT_MASK_MAC_MBIST_FAIL_DRF_8197F \ -+ << BIT_SHIFT_MAC_MBIST_FAIL_DRF_8197F) -+#define BIT_CLEAR_MAC_MBIST_FAIL_DRF_8197F(x) \ -+ ((x) & (~BITS_MAC_MBIST_FAIL_DRF_8197F)) -+#define BIT_GET_MAC_MBIST_FAIL_DRF_8197F(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_FAIL_DRF_8197F) & \ -+ BIT_MASK_MAC_MBIST_FAIL_DRF_8197F) -+#define BIT_SET_MAC_MBIST_FAIL_DRF_8197F(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_FAIL_DRF_8197F(x) | \ -+ BIT_MAC_MBIST_FAIL_DRF_8197F(v)) -+ -+/* 2 REG_MBIST_START_PAUSE_8197F */ -+ -+#define BIT_SHIFT_8051_MBIST_START_PAUSE_8197F 26 -+#define BIT_MASK_8051_MBIST_START_PAUSE_8197F 0x7 -+#define BIT_8051_MBIST_START_PAUSE_8197F(x) \ -+ (((x) & BIT_MASK_8051_MBIST_START_PAUSE_8197F) \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_8197F) -+#define BITS_8051_MBIST_START_PAUSE_8197F \ -+ (BIT_MASK_8051_MBIST_START_PAUSE_8197F \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_8197F) -+#define BIT_CLEAR_8051_MBIST_START_PAUSE_8197F(x) \ -+ ((x) & (~BITS_8051_MBIST_START_PAUSE_8197F)) -+#define BIT_GET_8051_MBIST_START_PAUSE_8197F(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_START_PAUSE_8197F) & \ -+ BIT_MASK_8051_MBIST_START_PAUSE_8197F) -+#define BIT_SET_8051_MBIST_START_PAUSE_8197F(x, v) \ -+ (BIT_CLEAR_8051_MBIST_START_PAUSE_8197F(x) | \ -+ BIT_8051_MBIST_START_PAUSE_8197F(v)) -+ -+#define BIT_SHIFT_USB_MBIST_START_PAUSE_8197F 24 -+#define BIT_MASK_USB_MBIST_START_PAUSE_8197F 0x3 -+#define BIT_USB_MBIST_START_PAUSE_8197F(x) \ -+ (((x) & BIT_MASK_USB_MBIST_START_PAUSE_8197F) \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_8197F) -+#define BITS_USB_MBIST_START_PAUSE_8197F \ -+ (BIT_MASK_USB_MBIST_START_PAUSE_8197F \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_8197F) -+#define BIT_CLEAR_USB_MBIST_START_PAUSE_8197F(x) \ -+ ((x) & (~BITS_USB_MBIST_START_PAUSE_8197F)) -+#define BIT_GET_USB_MBIST_START_PAUSE_8197F(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_START_PAUSE_8197F) & \ -+ BIT_MASK_USB_MBIST_START_PAUSE_8197F) -+#define BIT_SET_USB_MBIST_START_PAUSE_8197F(x, v) \ -+ (BIT_CLEAR_USB_MBIST_START_PAUSE_8197F(x) | \ -+ BIT_USB_MBIST_START_PAUSE_8197F(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_START_PAUSE_8197F 16 -+#define BIT_MASK_PCIE_MBIST_START_PAUSE_8197F 0x3f -+#define BIT_PCIE_MBIST_START_PAUSE_8197F(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_START_PAUSE_8197F) \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_8197F) -+#define BITS_PCIE_MBIST_START_PAUSE_8197F \ -+ (BIT_MASK_PCIE_MBIST_START_PAUSE_8197F \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_8197F) -+#define BIT_CLEAR_PCIE_MBIST_START_PAUSE_8197F(x) \ -+ ((x) & (~BITS_PCIE_MBIST_START_PAUSE_8197F)) -+#define BIT_GET_PCIE_MBIST_START_PAUSE_8197F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_START_PAUSE_8197F) & \ -+ BIT_MASK_PCIE_MBIST_START_PAUSE_8197F) -+#define BIT_SET_PCIE_MBIST_START_PAUSE_8197F(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_START_PAUSE_8197F(x) | \ -+ BIT_PCIE_MBIST_START_PAUSE_8197F(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8197F 0 -+#define BIT_MASK_MAC_MBIST_START_PAUSE_V1_8197F 0x3ffff -+#define BIT_MAC_MBIST_START_PAUSE_V1_8197F(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_START_PAUSE_V1_8197F) \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8197F) -+#define BITS_MAC_MBIST_START_PAUSE_V1_8197F \ -+ (BIT_MASK_MAC_MBIST_START_PAUSE_V1_8197F \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8197F) -+#define BIT_CLEAR_MAC_MBIST_START_PAUSE_V1_8197F(x) \ -+ ((x) & (~BITS_MAC_MBIST_START_PAUSE_V1_8197F)) -+#define BIT_GET_MAC_MBIST_START_PAUSE_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8197F) & \ -+ BIT_MASK_MAC_MBIST_START_PAUSE_V1_8197F) -+#define BIT_SET_MAC_MBIST_START_PAUSE_V1_8197F(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_START_PAUSE_V1_8197F(x) | \ -+ BIT_MAC_MBIST_START_PAUSE_V1_8197F(v)) -+ -+/* 2 REG_MBIST_DONE_8197F */ -+ -+#define BIT_SHIFT_8051_MBIST_DONE_8197F 26 -+#define BIT_MASK_8051_MBIST_DONE_8197F 0x7 -+#define BIT_8051_MBIST_DONE_8197F(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DONE_8197F) \ -+ << BIT_SHIFT_8051_MBIST_DONE_8197F) -+#define BITS_8051_MBIST_DONE_8197F \ -+ (BIT_MASK_8051_MBIST_DONE_8197F << BIT_SHIFT_8051_MBIST_DONE_8197F) -+#define BIT_CLEAR_8051_MBIST_DONE_8197F(x) ((x) & (~BITS_8051_MBIST_DONE_8197F)) -+#define BIT_GET_8051_MBIST_DONE_8197F(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DONE_8197F) & \ -+ BIT_MASK_8051_MBIST_DONE_8197F) -+#define BIT_SET_8051_MBIST_DONE_8197F(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DONE_8197F(x) | BIT_8051_MBIST_DONE_8197F(v)) -+ -+#define BIT_SHIFT_USB_MBIST_DONE_8197F 24 -+#define BIT_MASK_USB_MBIST_DONE_8197F 0x3 -+#define BIT_USB_MBIST_DONE_8197F(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DONE_8197F) \ -+ << BIT_SHIFT_USB_MBIST_DONE_8197F) -+#define BITS_USB_MBIST_DONE_8197F \ -+ (BIT_MASK_USB_MBIST_DONE_8197F << BIT_SHIFT_USB_MBIST_DONE_8197F) -+#define BIT_CLEAR_USB_MBIST_DONE_8197F(x) ((x) & (~BITS_USB_MBIST_DONE_8197F)) -+#define BIT_GET_USB_MBIST_DONE_8197F(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DONE_8197F) & \ -+ BIT_MASK_USB_MBIST_DONE_8197F) -+#define BIT_SET_USB_MBIST_DONE_8197F(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DONE_8197F(x) | BIT_USB_MBIST_DONE_8197F(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DONE_8197F 16 -+#define BIT_MASK_PCIE_MBIST_DONE_8197F 0x3f -+#define BIT_PCIE_MBIST_DONE_8197F(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DONE_8197F) \ -+ << BIT_SHIFT_PCIE_MBIST_DONE_8197F) -+#define BITS_PCIE_MBIST_DONE_8197F \ -+ (BIT_MASK_PCIE_MBIST_DONE_8197F << BIT_SHIFT_PCIE_MBIST_DONE_8197F) -+#define BIT_CLEAR_PCIE_MBIST_DONE_8197F(x) ((x) & (~BITS_PCIE_MBIST_DONE_8197F)) -+#define BIT_GET_PCIE_MBIST_DONE_8197F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DONE_8197F) & \ -+ BIT_MASK_PCIE_MBIST_DONE_8197F) -+#define BIT_SET_PCIE_MBIST_DONE_8197F(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DONE_8197F(x) | BIT_PCIE_MBIST_DONE_8197F(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_DONE_V1_8197F 0 -+#define BIT_MASK_MAC_MBIST_DONE_V1_8197F 0x3ffff -+#define BIT_MAC_MBIST_DONE_V1_8197F(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DONE_V1_8197F) \ -+ << BIT_SHIFT_MAC_MBIST_DONE_V1_8197F) -+#define BITS_MAC_MBIST_DONE_V1_8197F \ -+ (BIT_MASK_MAC_MBIST_DONE_V1_8197F << BIT_SHIFT_MAC_MBIST_DONE_V1_8197F) -+#define BIT_CLEAR_MAC_MBIST_DONE_V1_8197F(x) \ -+ ((x) & (~BITS_MAC_MBIST_DONE_V1_8197F)) -+#define BIT_GET_MAC_MBIST_DONE_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DONE_V1_8197F) & \ -+ BIT_MASK_MAC_MBIST_DONE_V1_8197F) -+#define BIT_SET_MAC_MBIST_DONE_V1_8197F(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DONE_V1_8197F(x) | BIT_MAC_MBIST_DONE_V1_8197F(v)) -+ -+/* 2 REG_MBIST_FAIL_NRML_8197F */ -+ -+#define BIT_SHIFT_MBIST_FAIL_NRML_V1_8197F 0 -+#define BIT_MASK_MBIST_FAIL_NRML_V1_8197F 0x3ffff -+#define BIT_MBIST_FAIL_NRML_V1_8197F(x) \ -+ (((x) & BIT_MASK_MBIST_FAIL_NRML_V1_8197F) \ -+ << BIT_SHIFT_MBIST_FAIL_NRML_V1_8197F) -+#define BITS_MBIST_FAIL_NRML_V1_8197F \ -+ (BIT_MASK_MBIST_FAIL_NRML_V1_8197F \ -+ << BIT_SHIFT_MBIST_FAIL_NRML_V1_8197F) -+#define BIT_CLEAR_MBIST_FAIL_NRML_V1_8197F(x) \ -+ ((x) & (~BITS_MBIST_FAIL_NRML_V1_8197F)) -+#define BIT_GET_MBIST_FAIL_NRML_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_MBIST_FAIL_NRML_V1_8197F) & \ -+ BIT_MASK_MBIST_FAIL_NRML_V1_8197F) -+#define BIT_SET_MBIST_FAIL_NRML_V1_8197F(x, v) \ -+ (BIT_CLEAR_MBIST_FAIL_NRML_V1_8197F(x) | \ -+ BIT_MBIST_FAIL_NRML_V1_8197F(v)) -+ -+/* 2 REG_AES_DECRPT_DATA_8197F */ -+ -+#define BIT_SHIFT_IPS_CFG_ADDR_8197F 0 -+#define BIT_MASK_IPS_CFG_ADDR_8197F 0xff -+#define BIT_IPS_CFG_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_IPS_CFG_ADDR_8197F) << BIT_SHIFT_IPS_CFG_ADDR_8197F) -+#define BITS_IPS_CFG_ADDR_8197F \ -+ (BIT_MASK_IPS_CFG_ADDR_8197F << BIT_SHIFT_IPS_CFG_ADDR_8197F) -+#define BIT_CLEAR_IPS_CFG_ADDR_8197F(x) ((x) & (~BITS_IPS_CFG_ADDR_8197F)) -+#define BIT_GET_IPS_CFG_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_ADDR_8197F) & BIT_MASK_IPS_CFG_ADDR_8197F) -+#define BIT_SET_IPS_CFG_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_IPS_CFG_ADDR_8197F(x) | BIT_IPS_CFG_ADDR_8197F(v)) -+ -+/* 2 REG_AES_DECRPT_CFG_8197F */ -+ -+#define BIT_SHIFT_IPS_CFG_DATA_8197F 0 -+#define BIT_MASK_IPS_CFG_DATA_8197F 0xffffffffL -+#define BIT_IPS_CFG_DATA_8197F(x) \ -+ (((x) & BIT_MASK_IPS_CFG_DATA_8197F) << BIT_SHIFT_IPS_CFG_DATA_8197F) -+#define BITS_IPS_CFG_DATA_8197F \ -+ (BIT_MASK_IPS_CFG_DATA_8197F << BIT_SHIFT_IPS_CFG_DATA_8197F) -+#define BIT_CLEAR_IPS_CFG_DATA_8197F(x) ((x) & (~BITS_IPS_CFG_DATA_8197F)) -+#define BIT_GET_IPS_CFG_DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_DATA_8197F) & BIT_MASK_IPS_CFG_DATA_8197F) -+#define BIT_SET_IPS_CFG_DATA_8197F(x, v) \ -+ (BIT_CLEAR_IPS_CFG_DATA_8197F(x) | BIT_IPS_CFG_DATA_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_MACCLKFRQ_8197F */ -+ -+#define BIT_SHIFT_MACCLK_FREQ_LOW32_8197F 0 -+#define BIT_MASK_MACCLK_FREQ_LOW32_8197F 0xffffffffL -+#define BIT_MACCLK_FREQ_LOW32_8197F(x) \ -+ (((x) & BIT_MASK_MACCLK_FREQ_LOW32_8197F) \ -+ << BIT_SHIFT_MACCLK_FREQ_LOW32_8197F) -+#define BITS_MACCLK_FREQ_LOW32_8197F \ -+ (BIT_MASK_MACCLK_FREQ_LOW32_8197F << BIT_SHIFT_MACCLK_FREQ_LOW32_8197F) -+#define BIT_CLEAR_MACCLK_FREQ_LOW32_8197F(x) \ -+ ((x) & (~BITS_MACCLK_FREQ_LOW32_8197F)) -+#define BIT_GET_MACCLK_FREQ_LOW32_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACCLK_FREQ_LOW32_8197F) & \ -+ BIT_MASK_MACCLK_FREQ_LOW32_8197F) -+#define BIT_SET_MACCLK_FREQ_LOW32_8197F(x, v) \ -+ (BIT_CLEAR_MACCLK_FREQ_LOW32_8197F(x) | BIT_MACCLK_FREQ_LOW32_8197F(v)) -+ -+/* 2 REG_TMETER_8197F */ -+ -+#define BIT_SHIFT_MACCLK_FREQ_HIGH10_8197F 0 -+#define BIT_MASK_MACCLK_FREQ_HIGH10_8197F 0x3ff -+#define BIT_MACCLK_FREQ_HIGH10_8197F(x) \ -+ (((x) & BIT_MASK_MACCLK_FREQ_HIGH10_8197F) \ -+ << BIT_SHIFT_MACCLK_FREQ_HIGH10_8197F) -+#define BITS_MACCLK_FREQ_HIGH10_8197F \ -+ (BIT_MASK_MACCLK_FREQ_HIGH10_8197F \ -+ << BIT_SHIFT_MACCLK_FREQ_HIGH10_8197F) -+#define BIT_CLEAR_MACCLK_FREQ_HIGH10_8197F(x) \ -+ ((x) & (~BITS_MACCLK_FREQ_HIGH10_8197F)) -+#define BIT_GET_MACCLK_FREQ_HIGH10_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACCLK_FREQ_HIGH10_8197F) & \ -+ BIT_MASK_MACCLK_FREQ_HIGH10_8197F) -+#define BIT_SET_MACCLK_FREQ_HIGH10_8197F(x, v) \ -+ (BIT_CLEAR_MACCLK_FREQ_HIGH10_8197F(x) | \ -+ BIT_MACCLK_FREQ_HIGH10_8197F(v)) -+ -+/* 2 REG_OSC_32K_CTRL_8197F */ -+#define BIT_32K_CLK_OUT_RDY_8197F BIT(12) -+ -+#define BIT_SHIFT_MONITOR_CYCLE_LOG2_8197F 8 -+#define BIT_MASK_MONITOR_CYCLE_LOG2_8197F 0xf -+#define BIT_MONITOR_CYCLE_LOG2_8197F(x) \ -+ (((x) & BIT_MASK_MONITOR_CYCLE_LOG2_8197F) \ -+ << BIT_SHIFT_MONITOR_CYCLE_LOG2_8197F) -+#define BITS_MONITOR_CYCLE_LOG2_8197F \ -+ (BIT_MASK_MONITOR_CYCLE_LOG2_8197F \ -+ << BIT_SHIFT_MONITOR_CYCLE_LOG2_8197F) -+#define BIT_CLEAR_MONITOR_CYCLE_LOG2_8197F(x) \ -+ ((x) & (~BITS_MONITOR_CYCLE_LOG2_8197F)) -+#define BIT_GET_MONITOR_CYCLE_LOG2_8197F(x) \ -+ (((x) >> BIT_SHIFT_MONITOR_CYCLE_LOG2_8197F) & \ -+ BIT_MASK_MONITOR_CYCLE_LOG2_8197F) -+#define BIT_SET_MONITOR_CYCLE_LOG2_8197F(x, v) \ -+ (BIT_CLEAR_MONITOR_CYCLE_LOG2_8197F(x) | \ -+ BIT_MONITOR_CYCLE_LOG2_8197F(v)) -+ -+/* 2 REG_32K_CAL_REG1_8197F */ -+ -+#define BIT_SHIFT_FREQVALUE_UNREGCLK_8197F 8 -+#define BIT_MASK_FREQVALUE_UNREGCLK_8197F 0xffffff -+#define BIT_FREQVALUE_UNREGCLK_8197F(x) \ -+ (((x) & BIT_MASK_FREQVALUE_UNREGCLK_8197F) \ -+ << BIT_SHIFT_FREQVALUE_UNREGCLK_8197F) -+#define BITS_FREQVALUE_UNREGCLK_8197F \ -+ (BIT_MASK_FREQVALUE_UNREGCLK_8197F \ -+ << BIT_SHIFT_FREQVALUE_UNREGCLK_8197F) -+#define BIT_CLEAR_FREQVALUE_UNREGCLK_8197F(x) \ -+ ((x) & (~BITS_FREQVALUE_UNREGCLK_8197F)) -+#define BIT_GET_FREQVALUE_UNREGCLK_8197F(x) \ -+ (((x) >> BIT_SHIFT_FREQVALUE_UNREGCLK_8197F) & \ -+ BIT_MASK_FREQVALUE_UNREGCLK_8197F) -+#define BIT_SET_FREQVALUE_UNREGCLK_8197F(x, v) \ -+ (BIT_CLEAR_FREQVALUE_UNREGCLK_8197F(x) | \ -+ BIT_FREQVALUE_UNREGCLK_8197F(v)) -+ -+#define BIT_CAL32K_DBGMOD_8197F BIT(7) -+ -+#define BIT_SHIFT_NCO_THRS_8197F 0 -+#define BIT_MASK_NCO_THRS_8197F 0x7f -+#define BIT_NCO_THRS_8197F(x) \ -+ (((x) & BIT_MASK_NCO_THRS_8197F) << BIT_SHIFT_NCO_THRS_8197F) -+#define BITS_NCO_THRS_8197F \ -+ (BIT_MASK_NCO_THRS_8197F << BIT_SHIFT_NCO_THRS_8197F) -+#define BIT_CLEAR_NCO_THRS_8197F(x) ((x) & (~BITS_NCO_THRS_8197F)) -+#define BIT_GET_NCO_THRS_8197F(x) \ -+ (((x) >> BIT_SHIFT_NCO_THRS_8197F) & BIT_MASK_NCO_THRS_8197F) -+#define BIT_SET_NCO_THRS_8197F(x, v) \ -+ (BIT_CLEAR_NCO_THRS_8197F(x) | BIT_NCO_THRS_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_C2HEVT_8197F */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_8197F 0 -+#define BIT_MASK_C2HEVT_MSG_8197F 0xffffffffffffffffffffffffffffffffL -+#define BIT_C2HEVT_MSG_8197F(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_8197F) << BIT_SHIFT_C2HEVT_MSG_8197F) -+#define BITS_C2HEVT_MSG_8197F \ -+ (BIT_MASK_C2HEVT_MSG_8197F << BIT_SHIFT_C2HEVT_MSG_8197F) -+#define BIT_CLEAR_C2HEVT_MSG_8197F(x) ((x) & (~BITS_C2HEVT_MSG_8197F)) -+#define BIT_GET_C2HEVT_MSG_8197F(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_8197F) & BIT_MASK_C2HEVT_MSG_8197F) -+#define BIT_SET_C2HEVT_MSG_8197F(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_8197F(x) | BIT_C2HEVT_MSG_8197F(v)) -+ -+/* 2 REG_SW_DEFINED_PAGE1_8197F */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE1_8197F 0 -+#define BIT_MASK_SW_DEFINED_PAGE1_8197F 0xffffffffffffffffL -+#define BIT_SW_DEFINED_PAGE1_8197F(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE1_8197F) \ -+ << BIT_SHIFT_SW_DEFINED_PAGE1_8197F) -+#define BITS_SW_DEFINED_PAGE1_8197F \ -+ (BIT_MASK_SW_DEFINED_PAGE1_8197F << BIT_SHIFT_SW_DEFINED_PAGE1_8197F) -+#define BIT_CLEAR_SW_DEFINED_PAGE1_8197F(x) \ -+ ((x) & (~BITS_SW_DEFINED_PAGE1_8197F)) -+#define BIT_GET_SW_DEFINED_PAGE1_8197F(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE1_8197F) & \ -+ BIT_MASK_SW_DEFINED_PAGE1_8197F) -+#define BIT_SET_SW_DEFINED_PAGE1_8197F(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE1_8197F(x) | BIT_SW_DEFINED_PAGE1_8197F(v)) -+ -+/* 2 REG_MCUTST_I_8197F */ -+ -+#define BIT_SHIFT_MCUDMSG_I_8197F 0 -+#define BIT_MASK_MCUDMSG_I_8197F 0xffffffffL -+#define BIT_MCUDMSG_I_8197F(x) \ -+ (((x) & BIT_MASK_MCUDMSG_I_8197F) << BIT_SHIFT_MCUDMSG_I_8197F) -+#define BITS_MCUDMSG_I_8197F \ -+ (BIT_MASK_MCUDMSG_I_8197F << BIT_SHIFT_MCUDMSG_I_8197F) -+#define BIT_CLEAR_MCUDMSG_I_8197F(x) ((x) & (~BITS_MCUDMSG_I_8197F)) -+#define BIT_GET_MCUDMSG_I_8197F(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_I_8197F) & BIT_MASK_MCUDMSG_I_8197F) -+#define BIT_SET_MCUDMSG_I_8197F(x, v) \ -+ (BIT_CLEAR_MCUDMSG_I_8197F(x) | BIT_MCUDMSG_I_8197F(v)) -+ -+/* 2 REG_MCUTST_II_8197F */ -+ -+#define BIT_SHIFT_MCUDMSG_II_8197F 0 -+#define BIT_MASK_MCUDMSG_II_8197F 0xffffffffL -+#define BIT_MCUDMSG_II_8197F(x) \ -+ (((x) & BIT_MASK_MCUDMSG_II_8197F) << BIT_SHIFT_MCUDMSG_II_8197F) -+#define BITS_MCUDMSG_II_8197F \ -+ (BIT_MASK_MCUDMSG_II_8197F << BIT_SHIFT_MCUDMSG_II_8197F) -+#define BIT_CLEAR_MCUDMSG_II_8197F(x) ((x) & (~BITS_MCUDMSG_II_8197F)) -+#define BIT_GET_MCUDMSG_II_8197F(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_II_8197F) & BIT_MASK_MCUDMSG_II_8197F) -+#define BIT_SET_MCUDMSG_II_8197F(x, v) \ -+ (BIT_CLEAR_MCUDMSG_II_8197F(x) | BIT_MCUDMSG_II_8197F(v)) -+ -+/* 2 REG_FMETHR_8197F */ -+#define BIT_FMSG_INT_8197F BIT(31) -+ -+#define BIT_SHIFT_FW_MSG_8197F 0 -+#define BIT_MASK_FW_MSG_8197F 0xffffffffL -+#define BIT_FW_MSG_8197F(x) \ -+ (((x) & BIT_MASK_FW_MSG_8197F) << BIT_SHIFT_FW_MSG_8197F) -+#define BITS_FW_MSG_8197F (BIT_MASK_FW_MSG_8197F << BIT_SHIFT_FW_MSG_8197F) -+#define BIT_CLEAR_FW_MSG_8197F(x) ((x) & (~BITS_FW_MSG_8197F)) -+#define BIT_GET_FW_MSG_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_8197F) & BIT_MASK_FW_MSG_8197F) -+#define BIT_SET_FW_MSG_8197F(x, v) \ -+ (BIT_CLEAR_FW_MSG_8197F(x) | BIT_FW_MSG_8197F(v)) -+ -+/* 2 REG_HMETFR_8197F */ -+ -+#define BIT_SHIFT_HRCV_MSG_8197F 24 -+#define BIT_MASK_HRCV_MSG_8197F 0xff -+#define BIT_HRCV_MSG_8197F(x) \ -+ (((x) & BIT_MASK_HRCV_MSG_8197F) << BIT_SHIFT_HRCV_MSG_8197F) -+#define BITS_HRCV_MSG_8197F \ -+ (BIT_MASK_HRCV_MSG_8197F << BIT_SHIFT_HRCV_MSG_8197F) -+#define BIT_CLEAR_HRCV_MSG_8197F(x) ((x) & (~BITS_HRCV_MSG_8197F)) -+#define BIT_GET_HRCV_MSG_8197F(x) \ -+ (((x) >> BIT_SHIFT_HRCV_MSG_8197F) & BIT_MASK_HRCV_MSG_8197F) -+#define BIT_SET_HRCV_MSG_8197F(x, v) \ -+ (BIT_CLEAR_HRCV_MSG_8197F(x) | BIT_HRCV_MSG_8197F(v)) -+ -+#define BIT_INT_BOX3_8197F BIT(3) -+#define BIT_INT_BOX2_8197F BIT(2) -+#define BIT_INT_BOX1_8197F BIT(1) -+#define BIT_INT_BOX0_8197F BIT(0) -+ -+/* 2 REG_HMEBOX0_8197F */ -+ -+#define BIT_SHIFT_HOST_MSG_0_8197F 0 -+#define BIT_MASK_HOST_MSG_0_8197F 0xffffffffL -+#define BIT_HOST_MSG_0_8197F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_0_8197F) << BIT_SHIFT_HOST_MSG_0_8197F) -+#define BITS_HOST_MSG_0_8197F \ -+ (BIT_MASK_HOST_MSG_0_8197F << BIT_SHIFT_HOST_MSG_0_8197F) -+#define BIT_CLEAR_HOST_MSG_0_8197F(x) ((x) & (~BITS_HOST_MSG_0_8197F)) -+#define BIT_GET_HOST_MSG_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_0_8197F) & BIT_MASK_HOST_MSG_0_8197F) -+#define BIT_SET_HOST_MSG_0_8197F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_0_8197F(x) | BIT_HOST_MSG_0_8197F(v)) -+ -+/* 2 REG_HMEBOX1_8197F */ -+ -+#define BIT_SHIFT_HOST_MSG_1_8197F 0 -+#define BIT_MASK_HOST_MSG_1_8197F 0xffffffffL -+#define BIT_HOST_MSG_1_8197F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_1_8197F) << BIT_SHIFT_HOST_MSG_1_8197F) -+#define BITS_HOST_MSG_1_8197F \ -+ (BIT_MASK_HOST_MSG_1_8197F << BIT_SHIFT_HOST_MSG_1_8197F) -+#define BIT_CLEAR_HOST_MSG_1_8197F(x) ((x) & (~BITS_HOST_MSG_1_8197F)) -+#define BIT_GET_HOST_MSG_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_1_8197F) & BIT_MASK_HOST_MSG_1_8197F) -+#define BIT_SET_HOST_MSG_1_8197F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_1_8197F(x) | BIT_HOST_MSG_1_8197F(v)) -+ -+/* 2 REG_HMEBOX2_8197F */ -+ -+#define BIT_SHIFT_HOST_MSG_2_8197F 0 -+#define BIT_MASK_HOST_MSG_2_8197F 0xffffffffL -+#define BIT_HOST_MSG_2_8197F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_2_8197F) << BIT_SHIFT_HOST_MSG_2_8197F) -+#define BITS_HOST_MSG_2_8197F \ -+ (BIT_MASK_HOST_MSG_2_8197F << BIT_SHIFT_HOST_MSG_2_8197F) -+#define BIT_CLEAR_HOST_MSG_2_8197F(x) ((x) & (~BITS_HOST_MSG_2_8197F)) -+#define BIT_GET_HOST_MSG_2_8197F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_2_8197F) & BIT_MASK_HOST_MSG_2_8197F) -+#define BIT_SET_HOST_MSG_2_8197F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_2_8197F(x) | BIT_HOST_MSG_2_8197F(v)) -+ -+/* 2 REG_HMEBOX3_8197F */ -+ -+#define BIT_SHIFT_HOST_MSG_3_8197F 0 -+#define BIT_MASK_HOST_MSG_3_8197F 0xffffffffL -+#define BIT_HOST_MSG_3_8197F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_3_8197F) << BIT_SHIFT_HOST_MSG_3_8197F) -+#define BITS_HOST_MSG_3_8197F \ -+ (BIT_MASK_HOST_MSG_3_8197F << BIT_SHIFT_HOST_MSG_3_8197F) -+#define BIT_CLEAR_HOST_MSG_3_8197F(x) ((x) & (~BITS_HOST_MSG_3_8197F)) -+#define BIT_GET_HOST_MSG_3_8197F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_3_8197F) & BIT_MASK_HOST_MSG_3_8197F) -+#define BIT_SET_HOST_MSG_3_8197F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_3_8197F(x) | BIT_HOST_MSG_3_8197F(v)) -+ -+/* 2 REG_LLT_INIT_8197F */ -+ -+#define BIT_SHIFT_LLTE_RWM_8197F 30 -+#define BIT_MASK_LLTE_RWM_8197F 0x3 -+#define BIT_LLTE_RWM_8197F(x) \ -+ (((x) & BIT_MASK_LLTE_RWM_8197F) << BIT_SHIFT_LLTE_RWM_8197F) -+#define BITS_LLTE_RWM_8197F \ -+ (BIT_MASK_LLTE_RWM_8197F << BIT_SHIFT_LLTE_RWM_8197F) -+#define BIT_CLEAR_LLTE_RWM_8197F(x) ((x) & (~BITS_LLTE_RWM_8197F)) -+#define BIT_GET_LLTE_RWM_8197F(x) \ -+ (((x) >> BIT_SHIFT_LLTE_RWM_8197F) & BIT_MASK_LLTE_RWM_8197F) -+#define BIT_SET_LLTE_RWM_8197F(x, v) \ -+ (BIT_CLEAR_LLTE_RWM_8197F(x) | BIT_LLTE_RWM_8197F(v)) -+ -+#define BIT_SHIFT_LLTINI_PDATA_V1_8197F 16 -+#define BIT_MASK_LLTINI_PDATA_V1_8197F 0xfff -+#define BIT_LLTINI_PDATA_V1_8197F(x) \ -+ (((x) & BIT_MASK_LLTINI_PDATA_V1_8197F) \ -+ << BIT_SHIFT_LLTINI_PDATA_V1_8197F) -+#define BITS_LLTINI_PDATA_V1_8197F \ -+ (BIT_MASK_LLTINI_PDATA_V1_8197F << BIT_SHIFT_LLTINI_PDATA_V1_8197F) -+#define BIT_CLEAR_LLTINI_PDATA_V1_8197F(x) ((x) & (~BITS_LLTINI_PDATA_V1_8197F)) -+#define BIT_GET_LLTINI_PDATA_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_PDATA_V1_8197F) & \ -+ BIT_MASK_LLTINI_PDATA_V1_8197F) -+#define BIT_SET_LLTINI_PDATA_V1_8197F(x, v) \ -+ (BIT_CLEAR_LLTINI_PDATA_V1_8197F(x) | BIT_LLTINI_PDATA_V1_8197F(v)) -+ -+#define BIT_SHIFT_LLTINI_HDATA_V1_8197F 0 -+#define BIT_MASK_LLTINI_HDATA_V1_8197F 0xfff -+#define BIT_LLTINI_HDATA_V1_8197F(x) \ -+ (((x) & BIT_MASK_LLTINI_HDATA_V1_8197F) \ -+ << BIT_SHIFT_LLTINI_HDATA_V1_8197F) -+#define BITS_LLTINI_HDATA_V1_8197F \ -+ (BIT_MASK_LLTINI_HDATA_V1_8197F << BIT_SHIFT_LLTINI_HDATA_V1_8197F) -+#define BIT_CLEAR_LLTINI_HDATA_V1_8197F(x) ((x) & (~BITS_LLTINI_HDATA_V1_8197F)) -+#define BIT_GET_LLTINI_HDATA_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_HDATA_V1_8197F) & \ -+ BIT_MASK_LLTINI_HDATA_V1_8197F) -+#define BIT_SET_LLTINI_HDATA_V1_8197F(x, v) \ -+ (BIT_CLEAR_LLTINI_HDATA_V1_8197F(x) | BIT_LLTINI_HDATA_V1_8197F(v)) -+ -+/* 2 REG_LLT_INIT_ADDR_8197F */ -+ -+#define BIT_SHIFT_LLTINI_ADDR_V1_8197F 0 -+#define BIT_MASK_LLTINI_ADDR_V1_8197F 0xfff -+#define BIT_LLTINI_ADDR_V1_8197F(x) \ -+ (((x) & BIT_MASK_LLTINI_ADDR_V1_8197F) \ -+ << BIT_SHIFT_LLTINI_ADDR_V1_8197F) -+#define BITS_LLTINI_ADDR_V1_8197F \ -+ (BIT_MASK_LLTINI_ADDR_V1_8197F << BIT_SHIFT_LLTINI_ADDR_V1_8197F) -+#define BIT_CLEAR_LLTINI_ADDR_V1_8197F(x) ((x) & (~BITS_LLTINI_ADDR_V1_8197F)) -+#define BIT_GET_LLTINI_ADDR_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_ADDR_V1_8197F) & \ -+ BIT_MASK_LLTINI_ADDR_V1_8197F) -+#define BIT_SET_LLTINI_ADDR_V1_8197F(x, v) \ -+ (BIT_CLEAR_LLTINI_ADDR_V1_8197F(x) | BIT_LLTINI_ADDR_V1_8197F(v)) -+ -+/* 2 REG_BB_ACCESS_CTRL_8197F */ -+ -+#define BIT_SHIFT_BB_WRITE_READ_8197F 30 -+#define BIT_MASK_BB_WRITE_READ_8197F 0x3 -+#define BIT_BB_WRITE_READ_8197F(x) \ -+ (((x) & BIT_MASK_BB_WRITE_READ_8197F) << BIT_SHIFT_BB_WRITE_READ_8197F) -+#define BITS_BB_WRITE_READ_8197F \ -+ (BIT_MASK_BB_WRITE_READ_8197F << BIT_SHIFT_BB_WRITE_READ_8197F) -+#define BIT_CLEAR_BB_WRITE_READ_8197F(x) ((x) & (~BITS_BB_WRITE_READ_8197F)) -+#define BIT_GET_BB_WRITE_READ_8197F(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_READ_8197F) & BIT_MASK_BB_WRITE_READ_8197F) -+#define BIT_SET_BB_WRITE_READ_8197F(x, v) \ -+ (BIT_CLEAR_BB_WRITE_READ_8197F(x) | BIT_BB_WRITE_READ_8197F(v)) -+ -+#define BIT_SHIFT_BB_WRITE_EN_V1_8197F 16 -+#define BIT_MASK_BB_WRITE_EN_V1_8197F 0xf -+#define BIT_BB_WRITE_EN_V1_8197F(x) \ -+ (((x) & BIT_MASK_BB_WRITE_EN_V1_8197F) \ -+ << BIT_SHIFT_BB_WRITE_EN_V1_8197F) -+#define BITS_BB_WRITE_EN_V1_8197F \ -+ (BIT_MASK_BB_WRITE_EN_V1_8197F << BIT_SHIFT_BB_WRITE_EN_V1_8197F) -+#define BIT_CLEAR_BB_WRITE_EN_V1_8197F(x) ((x) & (~BITS_BB_WRITE_EN_V1_8197F)) -+#define BIT_GET_BB_WRITE_EN_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_EN_V1_8197F) & \ -+ BIT_MASK_BB_WRITE_EN_V1_8197F) -+#define BIT_SET_BB_WRITE_EN_V1_8197F(x, v) \ -+ (BIT_CLEAR_BB_WRITE_EN_V1_8197F(x) | BIT_BB_WRITE_EN_V1_8197F(v)) -+ -+#define BIT_SHIFT_BB_ADDR_V1_8197F 2 -+#define BIT_MASK_BB_ADDR_V1_8197F 0xfff -+#define BIT_BB_ADDR_V1_8197F(x) \ -+ (((x) & BIT_MASK_BB_ADDR_V1_8197F) << BIT_SHIFT_BB_ADDR_V1_8197F) -+#define BITS_BB_ADDR_V1_8197F \ -+ (BIT_MASK_BB_ADDR_V1_8197F << BIT_SHIFT_BB_ADDR_V1_8197F) -+#define BIT_CLEAR_BB_ADDR_V1_8197F(x) ((x) & (~BITS_BB_ADDR_V1_8197F)) -+#define BIT_GET_BB_ADDR_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BB_ADDR_V1_8197F) & BIT_MASK_BB_ADDR_V1_8197F) -+#define BIT_SET_BB_ADDR_V1_8197F(x, v) \ -+ (BIT_CLEAR_BB_ADDR_V1_8197F(x) | BIT_BB_ADDR_V1_8197F(v)) -+ -+#define BIT_BB_ERRACC_8197F BIT(0) -+ -+/* 2 REG_BB_ACCESS_DATA_8197F */ -+ -+#define BIT_SHIFT_BB_DATA_8197F 0 -+#define BIT_MASK_BB_DATA_8197F 0xffffffffL -+#define BIT_BB_DATA_8197F(x) \ -+ (((x) & BIT_MASK_BB_DATA_8197F) << BIT_SHIFT_BB_DATA_8197F) -+#define BITS_BB_DATA_8197F (BIT_MASK_BB_DATA_8197F << BIT_SHIFT_BB_DATA_8197F) -+#define BIT_CLEAR_BB_DATA_8197F(x) ((x) & (~BITS_BB_DATA_8197F)) -+#define BIT_GET_BB_DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_BB_DATA_8197F) & BIT_MASK_BB_DATA_8197F) -+#define BIT_SET_BB_DATA_8197F(x, v) \ -+ (BIT_CLEAR_BB_DATA_8197F(x) | BIT_BB_DATA_8197F(v)) -+ -+/* 2 REG_HMEBOX_E0_8197F */ -+ -+#define BIT_SHIFT_HMEBOX_E0_8197F 0 -+#define BIT_MASK_HMEBOX_E0_8197F 0xffffffffL -+#define BIT_HMEBOX_E0_8197F(x) \ -+ (((x) & BIT_MASK_HMEBOX_E0_8197F) << BIT_SHIFT_HMEBOX_E0_8197F) -+#define BITS_HMEBOX_E0_8197F \ -+ (BIT_MASK_HMEBOX_E0_8197F << BIT_SHIFT_HMEBOX_E0_8197F) -+#define BIT_CLEAR_HMEBOX_E0_8197F(x) ((x) & (~BITS_HMEBOX_E0_8197F)) -+#define BIT_GET_HMEBOX_E0_8197F(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E0_8197F) & BIT_MASK_HMEBOX_E0_8197F) -+#define BIT_SET_HMEBOX_E0_8197F(x, v) \ -+ (BIT_CLEAR_HMEBOX_E0_8197F(x) | BIT_HMEBOX_E0_8197F(v)) -+ -+/* 2 REG_HMEBOX_E1_8197F */ -+ -+#define BIT_SHIFT_HMEBOX_E1_8197F 0 -+#define BIT_MASK_HMEBOX_E1_8197F 0xffffffffL -+#define BIT_HMEBOX_E1_8197F(x) \ -+ (((x) & BIT_MASK_HMEBOX_E1_8197F) << BIT_SHIFT_HMEBOX_E1_8197F) -+#define BITS_HMEBOX_E1_8197F \ -+ (BIT_MASK_HMEBOX_E1_8197F << BIT_SHIFT_HMEBOX_E1_8197F) -+#define BIT_CLEAR_HMEBOX_E1_8197F(x) ((x) & (~BITS_HMEBOX_E1_8197F)) -+#define BIT_GET_HMEBOX_E1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E1_8197F) & BIT_MASK_HMEBOX_E1_8197F) -+#define BIT_SET_HMEBOX_E1_8197F(x, v) \ -+ (BIT_CLEAR_HMEBOX_E1_8197F(x) | BIT_HMEBOX_E1_8197F(v)) -+ -+/* 2 REG_HMEBOX_E2_8197F */ -+ -+#define BIT_SHIFT_HMEBOX_E2_8197F 0 -+#define BIT_MASK_HMEBOX_E2_8197F 0xffffffffL -+#define BIT_HMEBOX_E2_8197F(x) \ -+ (((x) & BIT_MASK_HMEBOX_E2_8197F) << BIT_SHIFT_HMEBOX_E2_8197F) -+#define BITS_HMEBOX_E2_8197F \ -+ (BIT_MASK_HMEBOX_E2_8197F << BIT_SHIFT_HMEBOX_E2_8197F) -+#define BIT_CLEAR_HMEBOX_E2_8197F(x) ((x) & (~BITS_HMEBOX_E2_8197F)) -+#define BIT_GET_HMEBOX_E2_8197F(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E2_8197F) & BIT_MASK_HMEBOX_E2_8197F) -+#define BIT_SET_HMEBOX_E2_8197F(x, v) \ -+ (BIT_CLEAR_HMEBOX_E2_8197F(x) | BIT_HMEBOX_E2_8197F(v)) -+ -+/* 2 REG_HMEBOX_E3_8197F */ -+ -+#define BIT_SHIFT_HMEBOX_E3_8197F 0 -+#define BIT_MASK_HMEBOX_E3_8197F 0xffffffffL -+#define BIT_HMEBOX_E3_8197F(x) \ -+ (((x) & BIT_MASK_HMEBOX_E3_8197F) << BIT_SHIFT_HMEBOX_E3_8197F) -+#define BITS_HMEBOX_E3_8197F \ -+ (BIT_MASK_HMEBOX_E3_8197F << BIT_SHIFT_HMEBOX_E3_8197F) -+#define BIT_CLEAR_HMEBOX_E3_8197F(x) ((x) & (~BITS_HMEBOX_E3_8197F)) -+#define BIT_GET_HMEBOX_E3_8197F(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E3_8197F) & BIT_MASK_HMEBOX_E3_8197F) -+#define BIT_SET_HMEBOX_E3_8197F(x, v) \ -+ (BIT_CLEAR_HMEBOX_E3_8197F(x) | BIT_HMEBOX_E3_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_CR_EXT_8197F */ -+ -+#define BIT_SHIFT_PHY_REQ_DELAY_8197F 24 -+#define BIT_MASK_PHY_REQ_DELAY_8197F 0xf -+#define BIT_PHY_REQ_DELAY_8197F(x) \ -+ (((x) & BIT_MASK_PHY_REQ_DELAY_8197F) << BIT_SHIFT_PHY_REQ_DELAY_8197F) -+#define BITS_PHY_REQ_DELAY_8197F \ -+ (BIT_MASK_PHY_REQ_DELAY_8197F << BIT_SHIFT_PHY_REQ_DELAY_8197F) -+#define BIT_CLEAR_PHY_REQ_DELAY_8197F(x) ((x) & (~BITS_PHY_REQ_DELAY_8197F)) -+#define BIT_GET_PHY_REQ_DELAY_8197F(x) \ -+ (((x) >> BIT_SHIFT_PHY_REQ_DELAY_8197F) & BIT_MASK_PHY_REQ_DELAY_8197F) -+#define BIT_SET_PHY_REQ_DELAY_8197F(x, v) \ -+ (BIT_CLEAR_PHY_REQ_DELAY_8197F(x) | BIT_PHY_REQ_DELAY_8197F(v)) -+ -+#define BIT_SPD_DOWN_8197F BIT(16) -+ -+#define BIT_SHIFT_NETYPE4_8197F 4 -+#define BIT_MASK_NETYPE4_8197F 0x3 -+#define BIT_NETYPE4_8197F(x) \ -+ (((x) & BIT_MASK_NETYPE4_8197F) << BIT_SHIFT_NETYPE4_8197F) -+#define BITS_NETYPE4_8197F (BIT_MASK_NETYPE4_8197F << BIT_SHIFT_NETYPE4_8197F) -+#define BIT_CLEAR_NETYPE4_8197F(x) ((x) & (~BITS_NETYPE4_8197F)) -+#define BIT_GET_NETYPE4_8197F(x) \ -+ (((x) >> BIT_SHIFT_NETYPE4_8197F) & BIT_MASK_NETYPE4_8197F) -+#define BIT_SET_NETYPE4_8197F(x, v) \ -+ (BIT_CLEAR_NETYPE4_8197F(x) | BIT_NETYPE4_8197F(v)) -+ -+#define BIT_SHIFT_NETYPE3_8197F 2 -+#define BIT_MASK_NETYPE3_8197F 0x3 -+#define BIT_NETYPE3_8197F(x) \ -+ (((x) & BIT_MASK_NETYPE3_8197F) << BIT_SHIFT_NETYPE3_8197F) -+#define BITS_NETYPE3_8197F (BIT_MASK_NETYPE3_8197F << BIT_SHIFT_NETYPE3_8197F) -+#define BIT_CLEAR_NETYPE3_8197F(x) ((x) & (~BITS_NETYPE3_8197F)) -+#define BIT_GET_NETYPE3_8197F(x) \ -+ (((x) >> BIT_SHIFT_NETYPE3_8197F) & BIT_MASK_NETYPE3_8197F) -+#define BIT_SET_NETYPE3_8197F(x, v) \ -+ (BIT_CLEAR_NETYPE3_8197F(x) | BIT_NETYPE3_8197F(v)) -+ -+#define BIT_SHIFT_NETYPE2_8197F 0 -+#define BIT_MASK_NETYPE2_8197F 0x3 -+#define BIT_NETYPE2_8197F(x) \ -+ (((x) & BIT_MASK_NETYPE2_8197F) << BIT_SHIFT_NETYPE2_8197F) -+#define BITS_NETYPE2_8197F (BIT_MASK_NETYPE2_8197F << BIT_SHIFT_NETYPE2_8197F) -+#define BIT_CLEAR_NETYPE2_8197F(x) ((x) & (~BITS_NETYPE2_8197F)) -+#define BIT_GET_NETYPE2_8197F(x) \ -+ (((x) >> BIT_SHIFT_NETYPE2_8197F) & BIT_MASK_NETYPE2_8197F) -+#define BIT_SET_NETYPE2_8197F(x, v) \ -+ (BIT_CLEAR_NETYPE2_8197F(x) | BIT_NETYPE2_8197F(v)) -+ -+/* 2 REG_FWFF_8197F */ -+ -+#define BIT_SHIFT_PKTNUM_TH_8197F 24 -+#define BIT_MASK_PKTNUM_TH_8197F 0xff -+#define BIT_PKTNUM_TH_8197F(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_8197F) << BIT_SHIFT_PKTNUM_TH_8197F) -+#define BITS_PKTNUM_TH_8197F \ -+ (BIT_MASK_PKTNUM_TH_8197F << BIT_SHIFT_PKTNUM_TH_8197F) -+#define BIT_CLEAR_PKTNUM_TH_8197F(x) ((x) & (~BITS_PKTNUM_TH_8197F)) -+#define BIT_GET_PKTNUM_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_8197F) & BIT_MASK_PKTNUM_TH_8197F) -+#define BIT_SET_PKTNUM_TH_8197F(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_8197F(x) | BIT_PKTNUM_TH_8197F(v)) -+ -+#define BIT_SHIFT_TIMER_TH_8197F 16 -+#define BIT_MASK_TIMER_TH_8197F 0xff -+#define BIT_TIMER_TH_8197F(x) \ -+ (((x) & BIT_MASK_TIMER_TH_8197F) << BIT_SHIFT_TIMER_TH_8197F) -+#define BITS_TIMER_TH_8197F \ -+ (BIT_MASK_TIMER_TH_8197F << BIT_SHIFT_TIMER_TH_8197F) -+#define BIT_CLEAR_TIMER_TH_8197F(x) ((x) & (~BITS_TIMER_TH_8197F)) -+#define BIT_GET_TIMER_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_TIMER_TH_8197F) & BIT_MASK_TIMER_TH_8197F) -+#define BIT_SET_TIMER_TH_8197F(x, v) \ -+ (BIT_CLEAR_TIMER_TH_8197F(x) | BIT_TIMER_TH_8197F(v)) -+ -+#define BIT_SHIFT_RXPKT1ENADDR_8197F 0 -+#define BIT_MASK_RXPKT1ENADDR_8197F 0xffff -+#define BIT_RXPKT1ENADDR_8197F(x) \ -+ (((x) & BIT_MASK_RXPKT1ENADDR_8197F) << BIT_SHIFT_RXPKT1ENADDR_8197F) -+#define BITS_RXPKT1ENADDR_8197F \ -+ (BIT_MASK_RXPKT1ENADDR_8197F << BIT_SHIFT_RXPKT1ENADDR_8197F) -+#define BIT_CLEAR_RXPKT1ENADDR_8197F(x) ((x) & (~BITS_RXPKT1ENADDR_8197F)) -+#define BIT_GET_RXPKT1ENADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXPKT1ENADDR_8197F) & BIT_MASK_RXPKT1ENADDR_8197F) -+#define BIT_SET_RXPKT1ENADDR_8197F(x, v) \ -+ (BIT_CLEAR_RXPKT1ENADDR_8197F(x) | BIT_RXPKT1ENADDR_8197F(v)) -+ -+/* 2 REG_RXFF_PTR_V1_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_RXFF0_RDPTR_V2_8197F 0 -+#define BIT_MASK_RXFF0_RDPTR_V2_8197F 0x3ffff -+#define BIT_RXFF0_RDPTR_V2_8197F(x) \ -+ (((x) & BIT_MASK_RXFF0_RDPTR_V2_8197F) \ -+ << BIT_SHIFT_RXFF0_RDPTR_V2_8197F) -+#define BITS_RXFF0_RDPTR_V2_8197F \ -+ (BIT_MASK_RXFF0_RDPTR_V2_8197F << BIT_SHIFT_RXFF0_RDPTR_V2_8197F) -+#define BIT_CLEAR_RXFF0_RDPTR_V2_8197F(x) ((x) & (~BITS_RXFF0_RDPTR_V2_8197F)) -+#define BIT_GET_RXFF0_RDPTR_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_RDPTR_V2_8197F) & \ -+ BIT_MASK_RXFF0_RDPTR_V2_8197F) -+#define BIT_SET_RXFF0_RDPTR_V2_8197F(x, v) \ -+ (BIT_CLEAR_RXFF0_RDPTR_V2_8197F(x) | BIT_RXFF0_RDPTR_V2_8197F(v)) -+ -+/* 2 REG_RXFF_WTR_V1_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_RXFF0_WTPTR_V2_8197F 0 -+#define BIT_MASK_RXFF0_WTPTR_V2_8197F 0x3ffff -+#define BIT_RXFF0_WTPTR_V2_8197F(x) \ -+ (((x) & BIT_MASK_RXFF0_WTPTR_V2_8197F) \ -+ << BIT_SHIFT_RXFF0_WTPTR_V2_8197F) -+#define BITS_RXFF0_WTPTR_V2_8197F \ -+ (BIT_MASK_RXFF0_WTPTR_V2_8197F << BIT_SHIFT_RXFF0_WTPTR_V2_8197F) -+#define BIT_CLEAR_RXFF0_WTPTR_V2_8197F(x) ((x) & (~BITS_RXFF0_WTPTR_V2_8197F)) -+#define BIT_GET_RXFF0_WTPTR_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_WTPTR_V2_8197F) & \ -+ BIT_MASK_RXFF0_WTPTR_V2_8197F) -+#define BIT_SET_RXFF0_WTPTR_V2_8197F(x, v) \ -+ (BIT_CLEAR_RXFF0_WTPTR_V2_8197F(x) | BIT_RXFF0_WTPTR_V2_8197F(v)) -+ -+/* 2 REG_FE2IMR_8197F */ -+#define BIT_FS_TXSC_DESC_DONE_INT_EN_8197F BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_EN_8197F BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_EN_8197F BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_EN_8197F BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_EN_8197F BIT(24) -+#define BIT_FS_ATIM_MB7_INT_EN_8197F BIT(23) -+#define BIT_FS_ATIM_MB6_INT_EN_8197F BIT(22) -+#define BIT_FS_ATIM_MB5_INT_EN_8197F BIT(21) -+#define BIT_FS_ATIM_MB4_INT_EN_8197F BIT(20) -+#define BIT_FS_ATIM_MB3_INT_EN_8197F BIT(19) -+#define BIT_FS_ATIM_MB2_INT_EN_8197F BIT(18) -+#define BIT_FS_ATIM_MB1_INT_EN_8197F BIT(17) -+#define BIT_FS_ATIM_MB0_INT_EN_8197F BIT(16) -+#define BIT_FS_TBTT4INT_EN_8197F BIT(11) -+#define BIT_FS_TBTT3INT_EN_8197F BIT(10) -+#define BIT_FS_TBTT2INT_EN_8197F BIT(9) -+#define BIT_FS_TBTT1INT_EN_8197F BIT(8) -+#define BIT_FS_TBTT0_MB7INT_EN_8197F BIT(7) -+#define BIT_FS_TBTT0_MB6INT_EN_8197F BIT(6) -+#define BIT_FS_TBTT0_MB5INT_EN_8197F BIT(5) -+#define BIT_FS_TBTT0_MB4INT_EN_8197F BIT(4) -+#define BIT_FS_TBTT0_MB3INT_EN_8197F BIT(3) -+#define BIT_FS_TBTT0_MB2INT_EN_8197F BIT(2) -+#define BIT_FS_TBTT0_MB1INT_EN_8197F BIT(1) -+#define BIT_FS_TBTT0_INT_EN_8197F BIT(0) -+ -+/* 2 REG_FE2ISR_8197F */ -+#define BIT_FS_TXSC_DESC_DONE_INT_8197F BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_8197F BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_8197F BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_8197F BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_8197F BIT(24) -+#define BIT_FS_ATIM_MB7_INT_8197F BIT(23) -+#define BIT_FS_ATIM_MB6_INT_8197F BIT(22) -+#define BIT_FS_ATIM_MB5_INT_8197F BIT(21) -+#define BIT_FS_ATIM_MB4_INT_8197F BIT(20) -+#define BIT_FS_ATIM_MB3_INT_8197F BIT(19) -+#define BIT_FS_ATIM_MB2_INT_8197F BIT(18) -+#define BIT_FS_ATIM_MB1_INT_8197F BIT(17) -+#define BIT_FS_ATIM_MB0_INT_8197F BIT(16) -+#define BIT_FS_TBTT4INT_8197F BIT(11) -+#define BIT_FS_TBTT3INT_8197F BIT(10) -+#define BIT_FS_TBTT2INT_8197F BIT(9) -+#define BIT_FS_TBTT1INT_8197F BIT(8) -+#define BIT_FS_TBTT0_MB7INT_8197F BIT(7) -+#define BIT_FS_TBTT0_MB6INT_8197F BIT(6) -+#define BIT_FS_TBTT0_MB5INT_8197F BIT(5) -+#define BIT_FS_TBTT0_MB4INT_8197F BIT(4) -+#define BIT_FS_TBTT0_MB3INT_8197F BIT(3) -+#define BIT_FS_TBTT0_MB2INT_8197F BIT(2) -+#define BIT_FS_TBTT0_MB1INT_8197F BIT(1) -+#define BIT_FS_TBTT0_INT_8197F BIT(0) -+ -+/* 2 REG_FE3IMR_8197F */ -+#define BIT_FS_BCNELY4_AGGR_INT_EN_8197F BIT(31) -+#define BIT_FS_BCNELY3_AGGR_INT_EN_8197F BIT(30) -+#define BIT_FS_BCNELY2_AGGR_INT_EN_8197F BIT(29) -+#define BIT_FS_BCNELY1_AGGR_INT_EN_8197F BIT(28) -+#define BIT_FS_BCNDMA4_INT_EN_8197F BIT(27) -+#define BIT_FS_BCNDMA3_INT_EN_8197F BIT(26) -+#define BIT_FS_BCNDMA2_INT_EN_8197F BIT(25) -+#define BIT_FS_BCNDMA1_INT_EN_8197F BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_EN_8197F BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_EN_8197F BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_EN_8197F BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_EN_8197F BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_EN_8197F BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_EN_8197F BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_EN_8197F BIT(17) -+#define BIT_FS_BCNDMA0_INT_EN_8197F BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT__EN_8197F BIT(15) -+#define BIT_FS_BCNERLY4_INT_EN_8197F BIT(11) -+#define BIT_FS_BCNERLY3_INT_EN_8197F BIT(10) -+#define BIT_FS_BCNERLY2_INT_EN_8197F BIT(9) -+#define BIT_FS_BCNERLY1_INT_EN_8197F BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_EN_8197F BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_EN_8197F BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_EN_8197F BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_EN_8197F BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_EN_8197F BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_EN_8197F BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_EN_8197F BIT(1) -+#define BIT_FS_BCNERLY0_INT_EN_8197F BIT(0) -+ -+/* 2 REG_FE3ISR_8197F */ -+#define BIT_FS_BCNELY4_AGGR_INT_8197F BIT(31) -+#define BIT_FS_BCNELY3_AGGR_INT_8197F BIT(30) -+#define BIT_FS_BCNELY2_AGGR_INT_8197F BIT(29) -+#define BIT_FS_BCNELY1_AGGR_INT_8197F BIT(28) -+#define BIT_FS_BCNDMA4_INT_8197F BIT(27) -+#define BIT_FS_BCNDMA3_INT_8197F BIT(26) -+#define BIT_FS_BCNDMA2_INT_8197F BIT(25) -+#define BIT_FS_BCNDMA1_INT_8197F BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_8197F BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_8197F BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_8197F BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_8197F BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_8197F BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_8197F BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_8197F BIT(17) -+#define BIT_FS_BCNDMA0_INT_8197F BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT_8197F BIT(15) -+#define BIT_FS_BCNERLY4_INT_8197F BIT(11) -+#define BIT_FS_BCNERLY3_INT_8197F BIT(10) -+#define BIT_FS_BCNERLY2_INT_8197F BIT(9) -+#define BIT_FS_BCNERLY1_INT_8197F BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_8197F BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_8197F BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_8197F BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_8197F BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_8197F BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_8197F BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_8197F BIT(1) -+#define BIT_FS_BCNERLY0_INT_8197F BIT(0) -+ -+/* 2 REG_FE4IMR_8197F */ -+#define BIT_PORT4_PKTIN_INT_EN_8197F BIT(19) -+#define BIT_PORT3_PKTIN_INT_EN_8197F BIT(18) -+#define BIT_PORT2_PKTIN_INT_EN_8197F BIT(17) -+#define BIT_PORT1_PKTIN_INT_EN_8197F BIT(16) -+#define BIT_PORT4_RXUCMD0_OK_INT_EN_8197F BIT(15) -+#define BIT_PORT4_RXUCMD1_OK_INT_EN_8197F BIT(14) -+#define BIT_PORT4_RXBCMD0_OK_INT_EN_8197F BIT(13) -+#define BIT_PORT4_RXBCMD1_OK_INT_EN_8197F BIT(12) -+#define BIT_PORT3_RXUCMD0_OK_INT_EN_8197F BIT(11) -+#define BIT_PORT3_RXUCMD1_OK_INT_EN_8197F BIT(10) -+#define BIT_PORT3_RXBCMD0_OK_INT_EN_8197F BIT(9) -+#define BIT_PORT3_RXBCMD1_OK_INT_EN_8197F BIT(8) -+#define BIT_PORT2_RXUCMD0_OK_INT_EN_8197F BIT(7) -+#define BIT_PORT2_RXUCMD1_OK_INT_EN_8197F BIT(6) -+#define BIT_PORT2_RXBCMD0_OK_INT_EN_8197F BIT(5) -+#define BIT_PORT2_RXBCMD1_OK_INT_EN_8197F BIT(4) -+#define BIT_PORT1_RXUCMD0_OK_INT_EN_8197F BIT(3) -+#define BIT_PORT1_RXUCMD1_OK_INT_EN_8197F BIT(2) -+#define BIT_PORT1_RXBCMD0_OK_INT_EN_8197F BIT(1) -+#define BIT_PORT1_RXBCMD1_OK_INT_EN_8197F BIT(0) -+ -+/* 2 REG_FE4ISR_8197F */ -+#define BIT_PORT4_PKTIN_INT_8197F BIT(19) -+#define BIT_PORT3_PKTIN_INT_8197F BIT(18) -+#define BIT_PORT2_PKTIN_INT_8197F BIT(17) -+#define BIT_PORT1_PKTIN_INT_8197F BIT(16) -+#define BIT_PORT4_RXUCMD0_OK_INT_8197F BIT(15) -+#define BIT_PORT4_RXUCMD1_OK_INT_8197F BIT(14) -+#define BIT_PORT4_RXBCMD0_OK_INT_8197F BIT(13) -+#define BIT_PORT4_RXBCMD1_OK_INT_8197F BIT(12) -+#define BIT_PORT3_RXUCMD0_OK_INT_8197F BIT(11) -+#define BIT_PORT3_RXUCMD1_OK_INT_8197F BIT(10) -+#define BIT_PORT3_RXBCMD0_OK_INT_8197F BIT(9) -+#define BIT_PORT3_RXBCMD1_OK_INT_8197F BIT(8) -+#define BIT_PORT2_RXUCMD0_OK_INT_8197F BIT(7) -+#define BIT_PORT2_RXUCMD1_OK_INT_8197F BIT(6) -+#define BIT_PORT2_RXBCMD0_OK_INT_8197F BIT(5) -+#define BIT_PORT2_RXBCMD1_OK_INT_8197F BIT(4) -+#define BIT_PORT1_RXUCMD0_OK_INT_8197F BIT(3) -+#define BIT_PORT1_RXUCMD1_OK_INT_8197F BIT(2) -+#define BIT_PORT1_RXBCMD0_OK_INT_8197F BIT(1) -+#define BIT_PORT1_RXBCMD1_OK_INT_8197F BIT(0) -+ -+/* 2 REG_FT1IMR_8197F */ -+#define BIT__FT2ISR__IND_MSK_8197F BIT(30) -+#define BIT_FTM_PTT_INT_EN_8197F BIT(29) -+#define BIT_RXFTMREQ_INT_EN_8197F BIT(28) -+#define BIT_RXFTM_INT_EN_8197F BIT(27) -+#define BIT_TXFTM_INT_EN_8197F BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_EN_8197F BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_EN_8197F BIT(24) -+#define BIT_FS_MACID_PWRCHANGE5_INT_EN_8197F BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_EN_8197F BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_EN_8197F BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_EN_8197F BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_EN_8197F BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_EN_8197F BIT(18) -+#define BIT_FS_CTWEND2_INT_EN_8197F BIT(17) -+#define BIT_FS_CTWEND1_INT_EN_8197F BIT(16) -+#define BIT_FS_CTWEND0_INT_EN_8197F BIT(15) -+#define BIT_FS_TX_NULL1_INT_EN_8197F BIT(14) -+#define BIT_FS_TX_NULL0_INT_EN_8197F BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_EN_8197F BIT(12) -+#define BIT_FS_P2P_RFON2_INT_EN_8197F BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_EN_8197F BIT(10) -+#define BIT_FS_P2P_RFON1_INT_EN_8197F BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_EN_8197F BIT(8) -+#define BIT_FS_P2P_RFON0_INT_EN_8197F BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_EN_8197F BIT(6) -+#define BIT_FS_RX_UAPSDMD1_EN_8197F BIT(5) -+#define BIT_FS_RX_UAPSDMD0_EN_8197F BIT(4) -+#define BIT_FS_TRIGGER_PKT_EN_8197F BIT(3) -+#define BIT_FS_EOSP_INT_EN_8197F BIT(2) -+#define BIT_FS_RPWM2_INT_EN_8197F BIT(1) -+#define BIT_FS_RPWM_INT_EN_8197F BIT(0) -+ -+/* 2 REG_FT1ISR_8197F */ -+#define BIT__FT2ISR__IND_INT_8197F BIT(30) -+#define BIT_FTM_PTT_INT_8197F BIT(29) -+#define BIT_RXFTMREQ_INT_8197F BIT(28) -+#define BIT_RXFTM_INT_8197F BIT(27) -+#define BIT_TXFTM_INT_8197F BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_8197F BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_8197F BIT(24) -+#define BIT_FS_MACID_PWRCHANGE5_INT_8197F BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_8197F BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_8197F BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_8197F BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_8197F BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_8197F BIT(18) -+#define BIT_FS_CTWEND2_INT_8197F BIT(17) -+#define BIT_FS_CTWEND1_INT_8197F BIT(16) -+#define BIT_FS_CTWEND0_INT_8197F BIT(15) -+#define BIT_FS_TX_NULL1_INT_8197F BIT(14) -+#define BIT_FS_TX_NULL0_INT_8197F BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_INT_8197F BIT(12) -+#define BIT_FS_P2P_RFON2_INT_8197F BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_8197F BIT(10) -+#define BIT_FS_P2P_RFON1_INT_8197F BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_8197F BIT(8) -+#define BIT_FS_P2P_RFON0_INT_8197F BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_8197F BIT(6) -+#define BIT_FS_RX_UAPSDMD1_INT_8197F BIT(5) -+#define BIT_FS_RX_UAPSDMD0_INT_8197F BIT(4) -+#define BIT_FS_TRIGGER_PKT_INT_8197F BIT(3) -+#define BIT_FS_EOSP_INT_8197F BIT(2) -+#define BIT_FS_RPWM2_INT_8197F BIT(1) -+#define BIT_FS_RPWM_INT_8197F BIT(0) -+ -+/* 2 REG_SPWR0_8197F */ -+ -+#define BIT_SHIFT_MID_31TO0_8197F 0 -+#define BIT_MASK_MID_31TO0_8197F 0xffffffffL -+#define BIT_MID_31TO0_8197F(x) \ -+ (((x) & BIT_MASK_MID_31TO0_8197F) << BIT_SHIFT_MID_31TO0_8197F) -+#define BITS_MID_31TO0_8197F \ -+ (BIT_MASK_MID_31TO0_8197F << BIT_SHIFT_MID_31TO0_8197F) -+#define BIT_CLEAR_MID_31TO0_8197F(x) ((x) & (~BITS_MID_31TO0_8197F)) -+#define BIT_GET_MID_31TO0_8197F(x) \ -+ (((x) >> BIT_SHIFT_MID_31TO0_8197F) & BIT_MASK_MID_31TO0_8197F) -+#define BIT_SET_MID_31TO0_8197F(x, v) \ -+ (BIT_CLEAR_MID_31TO0_8197F(x) | BIT_MID_31TO0_8197F(v)) -+ -+/* 2 REG_SPWR1_8197F */ -+ -+#define BIT_SHIFT_MID_63TO32_8197F 0 -+#define BIT_MASK_MID_63TO32_8197F 0xffffffffL -+#define BIT_MID_63TO32_8197F(x) \ -+ (((x) & BIT_MASK_MID_63TO32_8197F) << BIT_SHIFT_MID_63TO32_8197F) -+#define BITS_MID_63TO32_8197F \ -+ (BIT_MASK_MID_63TO32_8197F << BIT_SHIFT_MID_63TO32_8197F) -+#define BIT_CLEAR_MID_63TO32_8197F(x) ((x) & (~BITS_MID_63TO32_8197F)) -+#define BIT_GET_MID_63TO32_8197F(x) \ -+ (((x) >> BIT_SHIFT_MID_63TO32_8197F) & BIT_MASK_MID_63TO32_8197F) -+#define BIT_SET_MID_63TO32_8197F(x, v) \ -+ (BIT_CLEAR_MID_63TO32_8197F(x) | BIT_MID_63TO32_8197F(v)) -+ -+/* 2 REG_SPWR2_8197F */ -+ -+#define BIT_SHIFT_MID_95O64_8197F 0 -+#define BIT_MASK_MID_95O64_8197F 0xffffffffL -+#define BIT_MID_95O64_8197F(x) \ -+ (((x) & BIT_MASK_MID_95O64_8197F) << BIT_SHIFT_MID_95O64_8197F) -+#define BITS_MID_95O64_8197F \ -+ (BIT_MASK_MID_95O64_8197F << BIT_SHIFT_MID_95O64_8197F) -+#define BIT_CLEAR_MID_95O64_8197F(x) ((x) & (~BITS_MID_95O64_8197F)) -+#define BIT_GET_MID_95O64_8197F(x) \ -+ (((x) >> BIT_SHIFT_MID_95O64_8197F) & BIT_MASK_MID_95O64_8197F) -+#define BIT_SET_MID_95O64_8197F(x, v) \ -+ (BIT_CLEAR_MID_95O64_8197F(x) | BIT_MID_95O64_8197F(v)) -+ -+/* 2 REG_SPWR3_8197F */ -+ -+#define BIT_SHIFT_MID_127TO96_8197F 0 -+#define BIT_MASK_MID_127TO96_8197F 0xffffffffL -+#define BIT_MID_127TO96_8197F(x) \ -+ (((x) & BIT_MASK_MID_127TO96_8197F) << BIT_SHIFT_MID_127TO96_8197F) -+#define BITS_MID_127TO96_8197F \ -+ (BIT_MASK_MID_127TO96_8197F << BIT_SHIFT_MID_127TO96_8197F) -+#define BIT_CLEAR_MID_127TO96_8197F(x) ((x) & (~BITS_MID_127TO96_8197F)) -+#define BIT_GET_MID_127TO96_8197F(x) \ -+ (((x) >> BIT_SHIFT_MID_127TO96_8197F) & BIT_MASK_MID_127TO96_8197F) -+#define BIT_SET_MID_127TO96_8197F(x, v) \ -+ (BIT_CLEAR_MID_127TO96_8197F(x) | BIT_MID_127TO96_8197F(v)) -+ -+/* 2 REG_POWSEQ_8197F */ -+ -+#define BIT_SHIFT_SEQNUM_MID_8197F 16 -+#define BIT_MASK_SEQNUM_MID_8197F 0xffff -+#define BIT_SEQNUM_MID_8197F(x) \ -+ (((x) & BIT_MASK_SEQNUM_MID_8197F) << BIT_SHIFT_SEQNUM_MID_8197F) -+#define BITS_SEQNUM_MID_8197F \ -+ (BIT_MASK_SEQNUM_MID_8197F << BIT_SHIFT_SEQNUM_MID_8197F) -+#define BIT_CLEAR_SEQNUM_MID_8197F(x) ((x) & (~BITS_SEQNUM_MID_8197F)) -+#define BIT_GET_SEQNUM_MID_8197F(x) \ -+ (((x) >> BIT_SHIFT_SEQNUM_MID_8197F) & BIT_MASK_SEQNUM_MID_8197F) -+#define BIT_SET_SEQNUM_MID_8197F(x, v) \ -+ (BIT_CLEAR_SEQNUM_MID_8197F(x) | BIT_SEQNUM_MID_8197F(v)) -+ -+#define BIT_SHIFT_REF_MID_8197F 0 -+#define BIT_MASK_REF_MID_8197F 0x7f -+#define BIT_REF_MID_8197F(x) \ -+ (((x) & BIT_MASK_REF_MID_8197F) << BIT_SHIFT_REF_MID_8197F) -+#define BITS_REF_MID_8197F (BIT_MASK_REF_MID_8197F << BIT_SHIFT_REF_MID_8197F) -+#define BIT_CLEAR_REF_MID_8197F(x) ((x) & (~BITS_REF_MID_8197F)) -+#define BIT_GET_REF_MID_8197F(x) \ -+ (((x) >> BIT_SHIFT_REF_MID_8197F) & BIT_MASK_REF_MID_8197F) -+#define BIT_SET_REF_MID_8197F(x, v) \ -+ (BIT_CLEAR_REF_MID_8197F(x) | BIT_REF_MID_8197F(v)) -+ -+/* 2 REG_TC7_CTRL_V1_8197F */ -+#define BIT_TC7INT_EN_8197F BIT(26) -+#define BIT_TC7MODE_8197F BIT(25) -+#define BIT_TC7EN_8197F BIT(24) -+ -+#define BIT_SHIFT_TC7DATA_8197F 0 -+#define BIT_MASK_TC7DATA_8197F 0xffffff -+#define BIT_TC7DATA_8197F(x) \ -+ (((x) & BIT_MASK_TC7DATA_8197F) << BIT_SHIFT_TC7DATA_8197F) -+#define BITS_TC7DATA_8197F (BIT_MASK_TC7DATA_8197F << BIT_SHIFT_TC7DATA_8197F) -+#define BIT_CLEAR_TC7DATA_8197F(x) ((x) & (~BITS_TC7DATA_8197F)) -+#define BIT_GET_TC7DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TC7DATA_8197F) & BIT_MASK_TC7DATA_8197F) -+#define BIT_SET_TC7DATA_8197F(x, v) \ -+ (BIT_CLEAR_TC7DATA_8197F(x) | BIT_TC7DATA_8197F(v)) -+ -+/* 2 REG_TC8_CTRL_V1_8197F */ -+#define BIT_TC8INT_EN_8197F BIT(26) -+#define BIT_TC8MODE_8197F BIT(25) -+#define BIT_TC8EN_8197F BIT(24) -+ -+#define BIT_SHIFT_TC8DATA_8197F 0 -+#define BIT_MASK_TC8DATA_8197F 0xffffff -+#define BIT_TC8DATA_8197F(x) \ -+ (((x) & BIT_MASK_TC8DATA_8197F) << BIT_SHIFT_TC8DATA_8197F) -+#define BITS_TC8DATA_8197F (BIT_MASK_TC8DATA_8197F << BIT_SHIFT_TC8DATA_8197F) -+#define BIT_CLEAR_TC8DATA_8197F(x) ((x) & (~BITS_TC8DATA_8197F)) -+#define BIT_GET_TC8DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TC8DATA_8197F) & BIT_MASK_TC8DATA_8197F) -+#define BIT_SET_TC8DATA_8197F(x, v) \ -+ (BIT_CLEAR_TC8DATA_8197F(x) | BIT_TC8DATA_8197F(v)) -+ -+/* 2 REG_RXBCN_TBTT_INTERVAL_PORT0TO3_8197F */ -+ -+/* 2 REG_RXBCN_TBTT_INTERVAL_PORT4_8197F */ -+ -+/* 2 REG_EXT_QUEUE_REG_8197F */ -+ -+#define BIT_SHIFT_PCIE_PRIORITY_SEL_8197F 0 -+#define BIT_MASK_PCIE_PRIORITY_SEL_8197F 0x3 -+#define BIT_PCIE_PRIORITY_SEL_8197F(x) \ -+ (((x) & BIT_MASK_PCIE_PRIORITY_SEL_8197F) \ -+ << BIT_SHIFT_PCIE_PRIORITY_SEL_8197F) -+#define BITS_PCIE_PRIORITY_SEL_8197F \ -+ (BIT_MASK_PCIE_PRIORITY_SEL_8197F << BIT_SHIFT_PCIE_PRIORITY_SEL_8197F) -+#define BIT_CLEAR_PCIE_PRIORITY_SEL_8197F(x) \ -+ ((x) & (~BITS_PCIE_PRIORITY_SEL_8197F)) -+#define BIT_GET_PCIE_PRIORITY_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_PRIORITY_SEL_8197F) & \ -+ BIT_MASK_PCIE_PRIORITY_SEL_8197F) -+#define BIT_SET_PCIE_PRIORITY_SEL_8197F(x, v) \ -+ (BIT_CLEAR_PCIE_PRIORITY_SEL_8197F(x) | BIT_PCIE_PRIORITY_SEL_8197F(v)) -+ -+/* 2 REG_COUNTER_CONTROL_8197F */ -+ -+#define BIT_SHIFT_COUNTER_BASE_8197F 16 -+#define BIT_MASK_COUNTER_BASE_8197F 0x1fff -+#define BIT_COUNTER_BASE_8197F(x) \ -+ (((x) & BIT_MASK_COUNTER_BASE_8197F) << BIT_SHIFT_COUNTER_BASE_8197F) -+#define BITS_COUNTER_BASE_8197F \ -+ (BIT_MASK_COUNTER_BASE_8197F << BIT_SHIFT_COUNTER_BASE_8197F) -+#define BIT_CLEAR_COUNTER_BASE_8197F(x) ((x) & (~BITS_COUNTER_BASE_8197F)) -+#define BIT_GET_COUNTER_BASE_8197F(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_BASE_8197F) & BIT_MASK_COUNTER_BASE_8197F) -+#define BIT_SET_COUNTER_BASE_8197F(x, v) \ -+ (BIT_CLEAR_COUNTER_BASE_8197F(x) | BIT_COUNTER_BASE_8197F(v)) -+ -+#define BIT_EN_RTS_REQ_8197F BIT(9) -+#define BIT_EN_EDCA_REQ_8197F BIT(8) -+#define BIT_EN_PTCL_REQ_8197F BIT(7) -+#define BIT_EN_SCH_REQ_8197F BIT(6) -+#define BIT_EN_USB_CNT_8197F BIT(5) -+#define BIT_EN_PCIE_CNT_8197F BIT(4) -+#define BIT_RQPN_CNT_8197F BIT(3) -+#define BIT_RDE_CNT_8197F BIT(2) -+#define BIT_TDE_CNT_8197F BIT(1) -+#define BIT_DIS_CNT_8197F BIT(0) -+ -+/* 2 REG_COUNTER_TH_8197F */ -+#define BIT_CNT_ALL_MACID_8197F BIT(31) -+ -+#define BIT_SHIFT_CNT_MACID_8197F 24 -+#define BIT_MASK_CNT_MACID_8197F 0x7f -+#define BIT_CNT_MACID_8197F(x) \ -+ (((x) & BIT_MASK_CNT_MACID_8197F) << BIT_SHIFT_CNT_MACID_8197F) -+#define BITS_CNT_MACID_8197F \ -+ (BIT_MASK_CNT_MACID_8197F << BIT_SHIFT_CNT_MACID_8197F) -+#define BIT_CLEAR_CNT_MACID_8197F(x) ((x) & (~BITS_CNT_MACID_8197F)) -+#define BIT_GET_CNT_MACID_8197F(x) \ -+ (((x) >> BIT_SHIFT_CNT_MACID_8197F) & BIT_MASK_CNT_MACID_8197F) -+#define BIT_SET_CNT_MACID_8197F(x, v) \ -+ (BIT_CLEAR_CNT_MACID_8197F(x) | BIT_CNT_MACID_8197F(v)) -+ -+#define BIT_SHIFT_AGG_VALUE2_8197F 16 -+#define BIT_MASK_AGG_VALUE2_8197F 0x7f -+#define BIT_AGG_VALUE2_8197F(x) \ -+ (((x) & BIT_MASK_AGG_VALUE2_8197F) << BIT_SHIFT_AGG_VALUE2_8197F) -+#define BITS_AGG_VALUE2_8197F \ -+ (BIT_MASK_AGG_VALUE2_8197F << BIT_SHIFT_AGG_VALUE2_8197F) -+#define BIT_CLEAR_AGG_VALUE2_8197F(x) ((x) & (~BITS_AGG_VALUE2_8197F)) -+#define BIT_GET_AGG_VALUE2_8197F(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE2_8197F) & BIT_MASK_AGG_VALUE2_8197F) -+#define BIT_SET_AGG_VALUE2_8197F(x, v) \ -+ (BIT_CLEAR_AGG_VALUE2_8197F(x) | BIT_AGG_VALUE2_8197F(v)) -+ -+#define BIT_SHIFT_AGG_VALUE1_8197F 8 -+#define BIT_MASK_AGG_VALUE1_8197F 0x7f -+#define BIT_AGG_VALUE1_8197F(x) \ -+ (((x) & BIT_MASK_AGG_VALUE1_8197F) << BIT_SHIFT_AGG_VALUE1_8197F) -+#define BITS_AGG_VALUE1_8197F \ -+ (BIT_MASK_AGG_VALUE1_8197F << BIT_SHIFT_AGG_VALUE1_8197F) -+#define BIT_CLEAR_AGG_VALUE1_8197F(x) ((x) & (~BITS_AGG_VALUE1_8197F)) -+#define BIT_GET_AGG_VALUE1_8197F(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE1_8197F) & BIT_MASK_AGG_VALUE1_8197F) -+#define BIT_SET_AGG_VALUE1_8197F(x, v) \ -+ (BIT_CLEAR_AGG_VALUE1_8197F(x) | BIT_AGG_VALUE1_8197F(v)) -+ -+#define BIT_SHIFT_AGG_VALUE0_8197F 0 -+#define BIT_MASK_AGG_VALUE0_8197F 0x7f -+#define BIT_AGG_VALUE0_8197F(x) \ -+ (((x) & BIT_MASK_AGG_VALUE0_8197F) << BIT_SHIFT_AGG_VALUE0_8197F) -+#define BITS_AGG_VALUE0_8197F \ -+ (BIT_MASK_AGG_VALUE0_8197F << BIT_SHIFT_AGG_VALUE0_8197F) -+#define BIT_CLEAR_AGG_VALUE0_8197F(x) ((x) & (~BITS_AGG_VALUE0_8197F)) -+#define BIT_GET_AGG_VALUE0_8197F(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE0_8197F) & BIT_MASK_AGG_VALUE0_8197F) -+#define BIT_SET_AGG_VALUE0_8197F(x, v) \ -+ (BIT_CLEAR_AGG_VALUE0_8197F(x) | BIT_AGG_VALUE0_8197F(v)) -+ -+/* 2 REG_COUNTER_SET_8197F */ -+#define BIT_RTS_RST_8197F BIT(24) -+#define BIT_PTCL_RST_8197F BIT(23) -+#define BIT_SCH_RST_8197F BIT(22) -+#define BIT_EDCA_RST_8197F BIT(21) -+#define BIT_RQPN_RST_8197F BIT(20) -+#define BIT_USB_RST_8197F BIT(19) -+#define BIT_PCIE_RST_8197F BIT(18) -+#define BIT_RXDMA_RST_8197F BIT(17) -+#define BIT_TXDMA_RST_8197F BIT(16) -+#define BIT_EN_RTS_START_8197F BIT(8) -+#define BIT_EN_PTCL_START_8197F BIT(7) -+#define BIT_EN_SCH_START_8197F BIT(6) -+#define BIT_EN_EDCA_START_8197F BIT(5) -+#define BIT_EN_RQPN_START_8197F BIT(4) -+#define BIT_EN_USB_START_8197F BIT(3) -+#define BIT_EN_PCIE_START_8197F BIT(2) -+#define BIT_EN_RXDMA_START_8197F BIT(1) -+#define BIT_EN_TXDMA_START_8197F BIT(0) -+ -+/* 2 REG_COUNTER_OVERFLOW_8197F */ -+#define BIT_RTS_OVF_8197F BIT(8) -+#define BIT_PTCL_OVF_8197F BIT(7) -+#define BIT_SCH_OVF_8197F BIT(6) -+#define BIT_EDCA_OVF_8197F BIT(5) -+#define BIT_RQPN_OVF_8197F BIT(4) -+#define BIT_USB_OVF_8197F BIT(3) -+#define BIT_PCIE_OVF_8197F BIT(2) -+#define BIT_RXDMA_OVF_8197F BIT(1) -+#define BIT_TXDMA_OVF_8197F BIT(0) -+ -+/* 2 REG_TDE_LEN_TH_8197F */ -+ -+#define BIT_SHIFT_TXDMA_LEN_TH0_8197F 16 -+#define BIT_MASK_TXDMA_LEN_TH0_8197F 0xffff -+#define BIT_TXDMA_LEN_TH0_8197F(x) \ -+ (((x) & BIT_MASK_TXDMA_LEN_TH0_8197F) << BIT_SHIFT_TXDMA_LEN_TH0_8197F) -+#define BITS_TXDMA_LEN_TH0_8197F \ -+ (BIT_MASK_TXDMA_LEN_TH0_8197F << BIT_SHIFT_TXDMA_LEN_TH0_8197F) -+#define BIT_CLEAR_TXDMA_LEN_TH0_8197F(x) ((x) & (~BITS_TXDMA_LEN_TH0_8197F)) -+#define BIT_GET_TXDMA_LEN_TH0_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_LEN_TH0_8197F) & BIT_MASK_TXDMA_LEN_TH0_8197F) -+#define BIT_SET_TXDMA_LEN_TH0_8197F(x, v) \ -+ (BIT_CLEAR_TXDMA_LEN_TH0_8197F(x) | BIT_TXDMA_LEN_TH0_8197F(v)) -+ -+#define BIT_SHIFT_TXDMA_LEN_TH1_8197F 0 -+#define BIT_MASK_TXDMA_LEN_TH1_8197F 0xffff -+#define BIT_TXDMA_LEN_TH1_8197F(x) \ -+ (((x) & BIT_MASK_TXDMA_LEN_TH1_8197F) << BIT_SHIFT_TXDMA_LEN_TH1_8197F) -+#define BITS_TXDMA_LEN_TH1_8197F \ -+ (BIT_MASK_TXDMA_LEN_TH1_8197F << BIT_SHIFT_TXDMA_LEN_TH1_8197F) -+#define BIT_CLEAR_TXDMA_LEN_TH1_8197F(x) ((x) & (~BITS_TXDMA_LEN_TH1_8197F)) -+#define BIT_GET_TXDMA_LEN_TH1_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_LEN_TH1_8197F) & BIT_MASK_TXDMA_LEN_TH1_8197F) -+#define BIT_SET_TXDMA_LEN_TH1_8197F(x, v) \ -+ (BIT_CLEAR_TXDMA_LEN_TH1_8197F(x) | BIT_TXDMA_LEN_TH1_8197F(v)) -+ -+/* 2 REG_RDE_LEN_TH_8197F */ -+ -+#define BIT_SHIFT_RXDMA_LEN_TH0_8197F 16 -+#define BIT_MASK_RXDMA_LEN_TH0_8197F 0xffff -+#define BIT_RXDMA_LEN_TH0_8197F(x) \ -+ (((x) & BIT_MASK_RXDMA_LEN_TH0_8197F) << BIT_SHIFT_RXDMA_LEN_TH0_8197F) -+#define BITS_RXDMA_LEN_TH0_8197F \ -+ (BIT_MASK_RXDMA_LEN_TH0_8197F << BIT_SHIFT_RXDMA_LEN_TH0_8197F) -+#define BIT_CLEAR_RXDMA_LEN_TH0_8197F(x) ((x) & (~BITS_RXDMA_LEN_TH0_8197F)) -+#define BIT_GET_RXDMA_LEN_TH0_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_LEN_TH0_8197F) & BIT_MASK_RXDMA_LEN_TH0_8197F) -+#define BIT_SET_RXDMA_LEN_TH0_8197F(x, v) \ -+ (BIT_CLEAR_RXDMA_LEN_TH0_8197F(x) | BIT_RXDMA_LEN_TH0_8197F(v)) -+ -+#define BIT_SHIFT_RXDMA_LEN_TH1_8197F 0 -+#define BIT_MASK_RXDMA_LEN_TH1_8197F 0xffff -+#define BIT_RXDMA_LEN_TH1_8197F(x) \ -+ (((x) & BIT_MASK_RXDMA_LEN_TH1_8197F) << BIT_SHIFT_RXDMA_LEN_TH1_8197F) -+#define BITS_RXDMA_LEN_TH1_8197F \ -+ (BIT_MASK_RXDMA_LEN_TH1_8197F << BIT_SHIFT_RXDMA_LEN_TH1_8197F) -+#define BIT_CLEAR_RXDMA_LEN_TH1_8197F(x) ((x) & (~BITS_RXDMA_LEN_TH1_8197F)) -+#define BIT_GET_RXDMA_LEN_TH1_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_LEN_TH1_8197F) & BIT_MASK_RXDMA_LEN_TH1_8197F) -+#define BIT_SET_RXDMA_LEN_TH1_8197F(x, v) \ -+ (BIT_CLEAR_RXDMA_LEN_TH1_8197F(x) | BIT_RXDMA_LEN_TH1_8197F(v)) -+ -+/* 2 REG_PCIE_EXEC_TIME_8197F */ -+ -+#define BIT_SHIFT_COUNTER_INTERVAL_SEL_8197F 16 -+#define BIT_MASK_COUNTER_INTERVAL_SEL_8197F 0x3 -+#define BIT_COUNTER_INTERVAL_SEL_8197F(x) \ -+ (((x) & BIT_MASK_COUNTER_INTERVAL_SEL_8197F) \ -+ << BIT_SHIFT_COUNTER_INTERVAL_SEL_8197F) -+#define BITS_COUNTER_INTERVAL_SEL_8197F \ -+ (BIT_MASK_COUNTER_INTERVAL_SEL_8197F \ -+ << BIT_SHIFT_COUNTER_INTERVAL_SEL_8197F) -+#define BIT_CLEAR_COUNTER_INTERVAL_SEL_8197F(x) \ -+ ((x) & (~BITS_COUNTER_INTERVAL_SEL_8197F)) -+#define BIT_GET_COUNTER_INTERVAL_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_INTERVAL_SEL_8197F) & \ -+ BIT_MASK_COUNTER_INTERVAL_SEL_8197F) -+#define BIT_SET_COUNTER_INTERVAL_SEL_8197F(x, v) \ -+ (BIT_CLEAR_COUNTER_INTERVAL_SEL_8197F(x) | \ -+ BIT_COUNTER_INTERVAL_SEL_8197F(v)) -+ -+#define BIT_SHIFT_PCIE_TRANS_DATA_TH1_8197F 0 -+#define BIT_MASK_PCIE_TRANS_DATA_TH1_8197F 0xffff -+#define BIT_PCIE_TRANS_DATA_TH1_8197F(x) \ -+ (((x) & BIT_MASK_PCIE_TRANS_DATA_TH1_8197F) \ -+ << BIT_SHIFT_PCIE_TRANS_DATA_TH1_8197F) -+#define BITS_PCIE_TRANS_DATA_TH1_8197F \ -+ (BIT_MASK_PCIE_TRANS_DATA_TH1_8197F \ -+ << BIT_SHIFT_PCIE_TRANS_DATA_TH1_8197F) -+#define BIT_CLEAR_PCIE_TRANS_DATA_TH1_8197F(x) \ -+ ((x) & (~BITS_PCIE_TRANS_DATA_TH1_8197F)) -+#define BIT_GET_PCIE_TRANS_DATA_TH1_8197F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_TRANS_DATA_TH1_8197F) & \ -+ BIT_MASK_PCIE_TRANS_DATA_TH1_8197F) -+#define BIT_SET_PCIE_TRANS_DATA_TH1_8197F(x, v) \ -+ (BIT_CLEAR_PCIE_TRANS_DATA_TH1_8197F(x) | \ -+ BIT_PCIE_TRANS_DATA_TH1_8197F(v)) -+ -+/* 2 REG_FT2IMR_8197F */ -+#define BIT_PORT4_RX_UCMD1_UAPSD0_OK_INT_EN_8197F BIT(31) -+#define BIT_PORT4_RX_UCMD0_UAPSD0_OK_INT_EN_8197F BIT(30) -+#define BIT_PORT4_TRIPKT_OK_INT_EN_8197F BIT(29) -+#define BIT_PORT4_RX_EOSP_OK_INT_EN_8197F BIT(28) -+#define BIT_PORT3_RX_UCMD1_UAPSD0_OK_INT_EN_8197F BIT(27) -+#define BIT_PORT3_RX_UCMD0_UAPSD0_OK_INT_EN_8197F BIT(26) -+#define BIT_PORT3_TRIPKT_OK_INT_EN_8197F BIT(25) -+#define BIT_PORT3_RX_EOSP_OK_INT_EN_8197F BIT(24) -+#define BIT_PORT2_RX_UCMD1_UAPSD0_OK_INT_EN_8197F BIT(23) -+#define BIT_PORT2_RX_UCMD0_UAPSD0_OK_INT_EN_8197F BIT(22) -+#define BIT_PORT2_TRIPKT_OK_INT_EN_8197F BIT(21) -+#define BIT_PORT2_RX_EOSP_OK_INT_EN_8197F BIT(20) -+#define BIT_PORT1_RX_UCMD1_UAPSD0_OK_INT_EN_8197F BIT(19) -+#define BIT_PORT1_RX_UCMD0_UAPSD0_OK_INT_EN_8197F BIT(18) -+#define BIT_PORT1_TRIPKT_OK_INT_EN_8197F BIT(17) -+#define BIT_PORT1_RX_EOSP_OK_INT_EN_8197F BIT(16) -+#define BIT_NOA2_TSFT_BIT32_TOGGLE_INT_EN_8197F BIT(9) -+#define BIT_NOA1_TSFT_BIT32_TOGGLE_INT_EN_8197F BIT(8) -+#define BIT_PORT4_TX_NULL1_DONE_INT_EN_8197F BIT(7) -+#define BIT_PORT4_TX_NULL0_DONE_INT_EN_8197F BIT(6) -+#define BIT_PORT3_TX_NULL1_DONE_INT_EN_8197F BIT(5) -+#define BIT_PORT3_TX_NULL0_DONE_INT_EN_8197F BIT(4) -+#define BIT_PORT2_TX_NULL1_DONE_INT_EN_8197F BIT(3) -+#define BIT_PORT2_TX_NULL0_DONE_INT_EN_8197F BIT(2) -+#define BIT_PORT1_TX_NULL1_DONE_INT_EN_8197F BIT(1) -+#define BIT_PORT1_TX_NULL0_DONE_INT_EN_8197F BIT(0) -+ -+/* 2 REG_FT2ISR_8197F */ -+#define BIT_PORT4_RX_UCMD1_UAPSD0_OK_INT_8197F BIT(31) -+#define BIT_PORT4_RX_UCMD0_UAPSD0_OK_INT_8197F BIT(30) -+#define BIT_PORT4_TRIPKT_OK_INT_8197F BIT(29) -+#define BIT_PORT4_RX_EOSP_OK_INT_8197F BIT(28) -+#define BIT_PORT3_RX_UCMD1_UAPSD0_OK_INT_8197F BIT(27) -+#define BIT_PORT3_RX_UCMD0_UAPSD0_OK_INT_8197F BIT(26) -+#define BIT_PORT3_TRIPKT_OK_INT_8197F BIT(25) -+#define BIT_PORT3_RX_EOSP_OK_INT_8197F BIT(24) -+#define BIT_PORT2_RX_UCMD1_UAPSD0_OK_INT_8197F BIT(23) -+#define BIT_PORT2_RX_UCMD0_UAPSD0_OK_INT_8197F BIT(22) -+#define BIT_PORT2_TRIPKT_OK_INT_8197F BIT(21) -+#define BIT_PORT2_RX_EOSP_OK_INT_8197F BIT(20) -+#define BIT_PORT1_RX_UCMD1_UAPSD0_OK_INT_8197F BIT(19) -+#define BIT_PORT1_RX_UCMD0_UAPSD0_OK_INT_8197F BIT(18) -+#define BIT_PORT1_TRIPKT_OK_INT_8197F BIT(17) -+#define BIT_PORT1_RX_EOSP_OK_INT_8197F BIT(16) -+#define BIT_NOA2_TSFT_BIT32_TOGGLE_INT_8197F BIT(9) -+#define BIT_NOA1_TSFT_BIT32_TOGGLE_INT_8197F BIT(8) -+#define BIT_PORT4_TX_NULL1_DONE_INT_8197F BIT(7) -+#define BIT_PORT4_TX_NULL0_DONE_INT_8197F BIT(6) -+#define BIT_PORT3_TX_NULL1_DONE_INT_8197F BIT(5) -+#define BIT_PORT3_TX_NULL0_DONE_INT_8197F BIT(4) -+#define BIT_PORT2_TX_NULL1_DONE_INT_8197F BIT(3) -+#define BIT_PORT2_TX_NULL0_DONE_INT_8197F BIT(2) -+#define BIT_PORT1_TX_NULL1_DONE_INT_8197F BIT(1) -+#define BIT_PORT1_TX_NULL0_DONE_INT_8197F BIT(0) -+ -+/* 2 REG_MSG2_8197F */ -+ -+#define BIT_SHIFT_FW_MSG2_8197F 0 -+#define BIT_MASK_FW_MSG2_8197F 0xffffffffL -+#define BIT_FW_MSG2_8197F(x) \ -+ (((x) & BIT_MASK_FW_MSG2_8197F) << BIT_SHIFT_FW_MSG2_8197F) -+#define BITS_FW_MSG2_8197F (BIT_MASK_FW_MSG2_8197F << BIT_SHIFT_FW_MSG2_8197F) -+#define BIT_CLEAR_FW_MSG2_8197F(x) ((x) & (~BITS_FW_MSG2_8197F)) -+#define BIT_GET_FW_MSG2_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG2_8197F) & BIT_MASK_FW_MSG2_8197F) -+#define BIT_SET_FW_MSG2_8197F(x, v) \ -+ (BIT_CLEAR_FW_MSG2_8197F(x) | BIT_FW_MSG2_8197F(v)) -+ -+/* 2 REG_MSG3_8197F */ -+ -+#define BIT_SHIFT_FW_MSG3_8197F 0 -+#define BIT_MASK_FW_MSG3_8197F 0xffffffffL -+#define BIT_FW_MSG3_8197F(x) \ -+ (((x) & BIT_MASK_FW_MSG3_8197F) << BIT_SHIFT_FW_MSG3_8197F) -+#define BITS_FW_MSG3_8197F (BIT_MASK_FW_MSG3_8197F << BIT_SHIFT_FW_MSG3_8197F) -+#define BIT_CLEAR_FW_MSG3_8197F(x) ((x) & (~BITS_FW_MSG3_8197F)) -+#define BIT_GET_FW_MSG3_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG3_8197F) & BIT_MASK_FW_MSG3_8197F) -+#define BIT_SET_FW_MSG3_8197F(x, v) \ -+ (BIT_CLEAR_FW_MSG3_8197F(x) | BIT_FW_MSG3_8197F(v)) -+ -+/* 2 REG_MSG4_8197F */ -+ -+#define BIT_SHIFT_FW_MSG4_8197F 0 -+#define BIT_MASK_FW_MSG4_8197F 0xffffffffL -+#define BIT_FW_MSG4_8197F(x) \ -+ (((x) & BIT_MASK_FW_MSG4_8197F) << BIT_SHIFT_FW_MSG4_8197F) -+#define BITS_FW_MSG4_8197F (BIT_MASK_FW_MSG4_8197F << BIT_SHIFT_FW_MSG4_8197F) -+#define BIT_CLEAR_FW_MSG4_8197F(x) ((x) & (~BITS_FW_MSG4_8197F)) -+#define BIT_GET_FW_MSG4_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG4_8197F) & BIT_MASK_FW_MSG4_8197F) -+#define BIT_SET_FW_MSG4_8197F(x, v) \ -+ (BIT_CLEAR_FW_MSG4_8197F(x) | BIT_FW_MSG4_8197F(v)) -+ -+/* 2 REG_MSG5_8197F */ -+ -+#define BIT_SHIFT_FW_MSG5_8197F 0 -+#define BIT_MASK_FW_MSG5_8197F 0xffffffffL -+#define BIT_FW_MSG5_8197F(x) \ -+ (((x) & BIT_MASK_FW_MSG5_8197F) << BIT_SHIFT_FW_MSG5_8197F) -+#define BITS_FW_MSG5_8197F (BIT_MASK_FW_MSG5_8197F << BIT_SHIFT_FW_MSG5_8197F) -+#define BIT_CLEAR_FW_MSG5_8197F(x) ((x) & (~BITS_FW_MSG5_8197F)) -+#define BIT_GET_FW_MSG5_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG5_8197F) & BIT_MASK_FW_MSG5_8197F) -+#define BIT_SET_FW_MSG5_8197F(x, v) \ -+ (BIT_CLEAR_FW_MSG5_8197F(x) | BIT_FW_MSG5_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_FIFOPAGE_CTRL_1_8197F */ -+ -+#define BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8197F 16 -+#define BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8197F 0xff -+#define BIT_TX_OQT_HE_FREE_SPACE_V1_8197F(x) \ -+ (((x) & BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8197F) \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8197F) -+#define BITS_TX_OQT_HE_FREE_SPACE_V1_8197F \ -+ (BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8197F \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8197F) -+#define BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1_8197F(x) \ -+ ((x) & (~BITS_TX_OQT_HE_FREE_SPACE_V1_8197F)) -+#define BIT_GET_TX_OQT_HE_FREE_SPACE_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8197F) & \ -+ BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8197F) -+#define BIT_SET_TX_OQT_HE_FREE_SPACE_V1_8197F(x, v) \ -+ (BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1_8197F(x) | \ -+ BIT_TX_OQT_HE_FREE_SPACE_V1_8197F(v)) -+ -+#define BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8197F 0 -+#define BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8197F 0xff -+#define BIT_TX_OQT_NL_FREE_SPACE_V1_8197F(x) \ -+ (((x) & BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8197F) \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8197F) -+#define BITS_TX_OQT_NL_FREE_SPACE_V1_8197F \ -+ (BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8197F \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8197F) -+#define BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1_8197F(x) \ -+ ((x) & (~BITS_TX_OQT_NL_FREE_SPACE_V1_8197F)) -+#define BIT_GET_TX_OQT_NL_FREE_SPACE_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8197F) & \ -+ BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8197F) -+#define BIT_SET_TX_OQT_NL_FREE_SPACE_V1_8197F(x, v) \ -+ (BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1_8197F(x) | \ -+ BIT_TX_OQT_NL_FREE_SPACE_V1_8197F(v)) -+ -+/* 2 REG_FIFOPAGE_CTRL_2_8197F */ -+#define BIT_BCN_VALID_1_V1_8197F BIT(31) -+ -+#define BIT_SHIFT_BCN_HEAD_1_V1_8197F 16 -+#define BIT_MASK_BCN_HEAD_1_V1_8197F 0xfff -+#define BIT_BCN_HEAD_1_V1_8197F(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_1_V1_8197F) << BIT_SHIFT_BCN_HEAD_1_V1_8197F) -+#define BITS_BCN_HEAD_1_V1_8197F \ -+ (BIT_MASK_BCN_HEAD_1_V1_8197F << BIT_SHIFT_BCN_HEAD_1_V1_8197F) -+#define BIT_CLEAR_BCN_HEAD_1_V1_8197F(x) ((x) & (~BITS_BCN_HEAD_1_V1_8197F)) -+#define BIT_GET_BCN_HEAD_1_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_1_V1_8197F) & BIT_MASK_BCN_HEAD_1_V1_8197F) -+#define BIT_SET_BCN_HEAD_1_V1_8197F(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_1_V1_8197F(x) | BIT_BCN_HEAD_1_V1_8197F(v)) -+ -+#define BIT_BCN_VALID_V1_8197F BIT(15) -+ -+#define BIT_SHIFT_BCN_HEAD_V1_8197F 0 -+#define BIT_MASK_BCN_HEAD_V1_8197F 0xfff -+#define BIT_BCN_HEAD_V1_8197F(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_V1_8197F) << BIT_SHIFT_BCN_HEAD_V1_8197F) -+#define BITS_BCN_HEAD_V1_8197F \ -+ (BIT_MASK_BCN_HEAD_V1_8197F << BIT_SHIFT_BCN_HEAD_V1_8197F) -+#define BIT_CLEAR_BCN_HEAD_V1_8197F(x) ((x) & (~BITS_BCN_HEAD_V1_8197F)) -+#define BIT_GET_BCN_HEAD_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_V1_8197F) & BIT_MASK_BCN_HEAD_V1_8197F) -+#define BIT_SET_BCN_HEAD_V1_8197F(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_V1_8197F(x) | BIT_BCN_HEAD_V1_8197F(v)) -+ -+/* 2 REG_AUTO_LLT_V1_8197F */ -+ -+#define BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F 24 -+#define BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F 0xff -+#define BIT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F(x) \ -+ (((x) & BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F) \ -+ << BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F) -+#define BITS_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F \ -+ (BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F \ -+ << BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F) -+#define BIT_CLEAR_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F(x) \ -+ ((x) & (~BITS_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F)) -+#define BIT_GET_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F) & \ -+ BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F) -+#define BIT_SET_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F(x, v) \ -+ (BIT_CLEAR_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F(x) | \ -+ BIT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8197F(v)) -+ -+#define BIT_SHIFT_LLT_FREE_PAGE_V1_8197F 8 -+#define BIT_MASK_LLT_FREE_PAGE_V1_8197F 0xffff -+#define BIT_LLT_FREE_PAGE_V1_8197F(x) \ -+ (((x) & BIT_MASK_LLT_FREE_PAGE_V1_8197F) \ -+ << BIT_SHIFT_LLT_FREE_PAGE_V1_8197F) -+#define BITS_LLT_FREE_PAGE_V1_8197F \ -+ (BIT_MASK_LLT_FREE_PAGE_V1_8197F << BIT_SHIFT_LLT_FREE_PAGE_V1_8197F) -+#define BIT_CLEAR_LLT_FREE_PAGE_V1_8197F(x) \ -+ ((x) & (~BITS_LLT_FREE_PAGE_V1_8197F)) -+#define BIT_GET_LLT_FREE_PAGE_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LLT_FREE_PAGE_V1_8197F) & \ -+ BIT_MASK_LLT_FREE_PAGE_V1_8197F) -+#define BIT_SET_LLT_FREE_PAGE_V1_8197F(x, v) \ -+ (BIT_CLEAR_LLT_FREE_PAGE_V1_8197F(x) | BIT_LLT_FREE_PAGE_V1_8197F(v)) -+ -+#define BIT_SHIFT_BLK_DESC_NUM_8197F 4 -+#define BIT_MASK_BLK_DESC_NUM_8197F 0xf -+#define BIT_BLK_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_BLK_DESC_NUM_8197F) << BIT_SHIFT_BLK_DESC_NUM_8197F) -+#define BITS_BLK_DESC_NUM_8197F \ -+ (BIT_MASK_BLK_DESC_NUM_8197F << BIT_SHIFT_BLK_DESC_NUM_8197F) -+#define BIT_CLEAR_BLK_DESC_NUM_8197F(x) ((x) & (~BITS_BLK_DESC_NUM_8197F)) -+#define BIT_GET_BLK_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_BLK_DESC_NUM_8197F) & BIT_MASK_BLK_DESC_NUM_8197F) -+#define BIT_SET_BLK_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_BLK_DESC_NUM_8197F(x) | BIT_BLK_DESC_NUM_8197F(v)) -+ -+#define BIT_R_BCN_HEAD_SEL_8197F BIT(3) -+#define BIT_R_EN_BCN_SW_HEAD_SEL_8197F BIT(2) -+#define BIT_LLT_DBG_SEL_8197F BIT(1) -+#define BIT_AUTO_INIT_LLT_V1_8197F BIT(0) -+ -+/* 2 REG_TXDMA_OFFSET_CHK_8197F */ -+#define BIT_EM_CHKSUM_FIN_8197F BIT(31) -+#define BIT_EMN_PCIE_DMA_MOD_8197F BIT(30) -+#define BIT_EN_TXQUE_CLR_8197F BIT(29) -+#define BIT_EN_PCIE_FIFO_MODE_8197F BIT(28) -+ -+#define BIT_SHIFT_PG_UNDER_TH_V1_8197F 16 -+#define BIT_MASK_PG_UNDER_TH_V1_8197F 0xfff -+#define BIT_PG_UNDER_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_PG_UNDER_TH_V1_8197F) \ -+ << BIT_SHIFT_PG_UNDER_TH_V1_8197F) -+#define BITS_PG_UNDER_TH_V1_8197F \ -+ (BIT_MASK_PG_UNDER_TH_V1_8197F << BIT_SHIFT_PG_UNDER_TH_V1_8197F) -+#define BIT_CLEAR_PG_UNDER_TH_V1_8197F(x) ((x) & (~BITS_PG_UNDER_TH_V1_8197F)) -+#define BIT_GET_PG_UNDER_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_PG_UNDER_TH_V1_8197F) & \ -+ BIT_MASK_PG_UNDER_TH_V1_8197F) -+#define BIT_SET_PG_UNDER_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_PG_UNDER_TH_V1_8197F(x) | BIT_PG_UNDER_TH_V1_8197F(v)) -+ -+#define BIT_EN_RESET_RESTORE_H2C_8197F BIT(15) -+#define BIT_SDIO_TDE_FINISH_8197F BIT(14) -+#define BIT_SDIO_TXDESC_CHKSUM_EN_8197F BIT(13) -+#define BIT_RST_RDPTR_8197F BIT(12) -+#define BIT_RST_WRPTR_8197F BIT(11) -+#define BIT_CHK_PG_TH_EN_8197F BIT(10) -+#define BIT_DROP_DATA_EN_8197F BIT(9) -+#define BIT_CHECK_OFFSET_EN_8197F BIT(8) -+ -+#define BIT_SHIFT_CHECK_OFFSET_8197F 0 -+#define BIT_MASK_CHECK_OFFSET_8197F 0xff -+#define BIT_CHECK_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_CHECK_OFFSET_8197F) << BIT_SHIFT_CHECK_OFFSET_8197F) -+#define BITS_CHECK_OFFSET_8197F \ -+ (BIT_MASK_CHECK_OFFSET_8197F << BIT_SHIFT_CHECK_OFFSET_8197F) -+#define BIT_CLEAR_CHECK_OFFSET_8197F(x) ((x) & (~BITS_CHECK_OFFSET_8197F)) -+#define BIT_GET_CHECK_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_CHECK_OFFSET_8197F) & BIT_MASK_CHECK_OFFSET_8197F) -+#define BIT_SET_CHECK_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_CHECK_OFFSET_8197F(x) | BIT_CHECK_OFFSET_8197F(v)) -+ -+/* 2 REG_TXDMA_STATUS_8197F */ -+#define BIT_HI_OQT_UDN_8197F BIT(17) -+#define BIT_HI_OQT_OVF_8197F BIT(16) -+#define BIT_PAYLOAD_CHKSUM_ERR_8197F BIT(15) -+#define BIT_PAYLOAD_UDN_8197F BIT(14) -+#define BIT_PAYLOAD_OVF_8197F BIT(13) -+#define BIT_DSC_CHKSUM_FAIL_8197F BIT(12) -+#define BIT_UNKNOWN_QSEL_8197F BIT(11) -+#define BIT_EP_QSEL_DIFF_8197F BIT(10) -+#define BIT_TX_OFFS_UNMATCH_8197F BIT(9) -+#define BIT_TXOQT_UDN_8197F BIT(8) -+#define BIT_TXOQT_OVF_8197F BIT(7) -+#define BIT_TXDMA_SFF_UDN_8197F BIT(6) -+#define BIT_TXDMA_SFF_OVF_8197F BIT(5) -+#define BIT_LLT_NULL_PG_8197F BIT(4) -+#define BIT_PAGE_UDN_8197F BIT(3) -+#define BIT_PAGE_OVF_8197F BIT(2) -+#define BIT_TXFF_PG_UDN_8197F BIT(1) -+#define BIT_TXFF_PG_OVF_8197F BIT(0) -+ -+/* 2 REG_TX_DMA_DBG_8197F */ -+ -+/* 2 REG_TQPNT1_8197F */ -+ -+#define BIT_SHIFT_HPQ_HIGH_TH_V1_8197F 16 -+#define BIT_MASK_HPQ_HIGH_TH_V1_8197F 0xfff -+#define BIT_HPQ_HIGH_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_HPQ_HIGH_TH_V1_8197F) \ -+ << BIT_SHIFT_HPQ_HIGH_TH_V1_8197F) -+#define BITS_HPQ_HIGH_TH_V1_8197F \ -+ (BIT_MASK_HPQ_HIGH_TH_V1_8197F << BIT_SHIFT_HPQ_HIGH_TH_V1_8197F) -+#define BIT_CLEAR_HPQ_HIGH_TH_V1_8197F(x) ((x) & (~BITS_HPQ_HIGH_TH_V1_8197F)) -+#define BIT_GET_HPQ_HIGH_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HPQ_HIGH_TH_V1_8197F) & \ -+ BIT_MASK_HPQ_HIGH_TH_V1_8197F) -+#define BIT_SET_HPQ_HIGH_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_HPQ_HIGH_TH_V1_8197F(x) | BIT_HPQ_HIGH_TH_V1_8197F(v)) -+ -+#define BIT_SHIFT_HPQ_LOW_TH_V1_8197F 0 -+#define BIT_MASK_HPQ_LOW_TH_V1_8197F 0xfff -+#define BIT_HPQ_LOW_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_HPQ_LOW_TH_V1_8197F) << BIT_SHIFT_HPQ_LOW_TH_V1_8197F) -+#define BITS_HPQ_LOW_TH_V1_8197F \ -+ (BIT_MASK_HPQ_LOW_TH_V1_8197F << BIT_SHIFT_HPQ_LOW_TH_V1_8197F) -+#define BIT_CLEAR_HPQ_LOW_TH_V1_8197F(x) ((x) & (~BITS_HPQ_LOW_TH_V1_8197F)) -+#define BIT_GET_HPQ_LOW_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HPQ_LOW_TH_V1_8197F) & BIT_MASK_HPQ_LOW_TH_V1_8197F) -+#define BIT_SET_HPQ_LOW_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_HPQ_LOW_TH_V1_8197F(x) | BIT_HPQ_LOW_TH_V1_8197F(v)) -+ -+/* 2 REG_TQPNT2_8197F */ -+ -+#define BIT_SHIFT_NPQ_HIGH_TH_V1_8197F 16 -+#define BIT_MASK_NPQ_HIGH_TH_V1_8197F 0xfff -+#define BIT_NPQ_HIGH_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_NPQ_HIGH_TH_V1_8197F) \ -+ << BIT_SHIFT_NPQ_HIGH_TH_V1_8197F) -+#define BITS_NPQ_HIGH_TH_V1_8197F \ -+ (BIT_MASK_NPQ_HIGH_TH_V1_8197F << BIT_SHIFT_NPQ_HIGH_TH_V1_8197F) -+#define BIT_CLEAR_NPQ_HIGH_TH_V1_8197F(x) ((x) & (~BITS_NPQ_HIGH_TH_V1_8197F)) -+#define BIT_GET_NPQ_HIGH_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_NPQ_HIGH_TH_V1_8197F) & \ -+ BIT_MASK_NPQ_HIGH_TH_V1_8197F) -+#define BIT_SET_NPQ_HIGH_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_NPQ_HIGH_TH_V1_8197F(x) | BIT_NPQ_HIGH_TH_V1_8197F(v)) -+ -+#define BIT_SHIFT_NPQ_LOW_TH_V1_8197F 0 -+#define BIT_MASK_NPQ_LOW_TH_V1_8197F 0xfff -+#define BIT_NPQ_LOW_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_NPQ_LOW_TH_V1_8197F) << BIT_SHIFT_NPQ_LOW_TH_V1_8197F) -+#define BITS_NPQ_LOW_TH_V1_8197F \ -+ (BIT_MASK_NPQ_LOW_TH_V1_8197F << BIT_SHIFT_NPQ_LOW_TH_V1_8197F) -+#define BIT_CLEAR_NPQ_LOW_TH_V1_8197F(x) ((x) & (~BITS_NPQ_LOW_TH_V1_8197F)) -+#define BIT_GET_NPQ_LOW_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_NPQ_LOW_TH_V1_8197F) & BIT_MASK_NPQ_LOW_TH_V1_8197F) -+#define BIT_SET_NPQ_LOW_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_NPQ_LOW_TH_V1_8197F(x) | BIT_NPQ_LOW_TH_V1_8197F(v)) -+ -+/* 2 REG_TQPNT3_8197F */ -+ -+#define BIT_SHIFT_LPQ_HIGH_TH_V1_8197F 16 -+#define BIT_MASK_LPQ_HIGH_TH_V1_8197F 0xfff -+#define BIT_LPQ_HIGH_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_LPQ_HIGH_TH_V1_8197F) \ -+ << BIT_SHIFT_LPQ_HIGH_TH_V1_8197F) -+#define BITS_LPQ_HIGH_TH_V1_8197F \ -+ (BIT_MASK_LPQ_HIGH_TH_V1_8197F << BIT_SHIFT_LPQ_HIGH_TH_V1_8197F) -+#define BIT_CLEAR_LPQ_HIGH_TH_V1_8197F(x) ((x) & (~BITS_LPQ_HIGH_TH_V1_8197F)) -+#define BIT_GET_LPQ_HIGH_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LPQ_HIGH_TH_V1_8197F) & \ -+ BIT_MASK_LPQ_HIGH_TH_V1_8197F) -+#define BIT_SET_LPQ_HIGH_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_LPQ_HIGH_TH_V1_8197F(x) | BIT_LPQ_HIGH_TH_V1_8197F(v)) -+ -+#define BIT_SHIFT_LPQ_LOW_TH_V1_8197F 0 -+#define BIT_MASK_LPQ_LOW_TH_V1_8197F 0xfff -+#define BIT_LPQ_LOW_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_LPQ_LOW_TH_V1_8197F) << BIT_SHIFT_LPQ_LOW_TH_V1_8197F) -+#define BITS_LPQ_LOW_TH_V1_8197F \ -+ (BIT_MASK_LPQ_LOW_TH_V1_8197F << BIT_SHIFT_LPQ_LOW_TH_V1_8197F) -+#define BIT_CLEAR_LPQ_LOW_TH_V1_8197F(x) ((x) & (~BITS_LPQ_LOW_TH_V1_8197F)) -+#define BIT_GET_LPQ_LOW_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LPQ_LOW_TH_V1_8197F) & BIT_MASK_LPQ_LOW_TH_V1_8197F) -+#define BIT_SET_LPQ_LOW_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_LPQ_LOW_TH_V1_8197F(x) | BIT_LPQ_LOW_TH_V1_8197F(v)) -+ -+/* 2 REG_TQPNT4_8197F */ -+ -+#define BIT_SHIFT_EXQ_HIGH_TH_V1_8197F 16 -+#define BIT_MASK_EXQ_HIGH_TH_V1_8197F 0xfff -+#define BIT_EXQ_HIGH_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_EXQ_HIGH_TH_V1_8197F) \ -+ << BIT_SHIFT_EXQ_HIGH_TH_V1_8197F) -+#define BITS_EXQ_HIGH_TH_V1_8197F \ -+ (BIT_MASK_EXQ_HIGH_TH_V1_8197F << BIT_SHIFT_EXQ_HIGH_TH_V1_8197F) -+#define BIT_CLEAR_EXQ_HIGH_TH_V1_8197F(x) ((x) & (~BITS_EXQ_HIGH_TH_V1_8197F)) -+#define BIT_GET_EXQ_HIGH_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_EXQ_HIGH_TH_V1_8197F) & \ -+ BIT_MASK_EXQ_HIGH_TH_V1_8197F) -+#define BIT_SET_EXQ_HIGH_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_EXQ_HIGH_TH_V1_8197F(x) | BIT_EXQ_HIGH_TH_V1_8197F(v)) -+ -+#define BIT_SHIFT_EXQ_LOW_TH_V1_8197F 0 -+#define BIT_MASK_EXQ_LOW_TH_V1_8197F 0xfff -+#define BIT_EXQ_LOW_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_EXQ_LOW_TH_V1_8197F) << BIT_SHIFT_EXQ_LOW_TH_V1_8197F) -+#define BITS_EXQ_LOW_TH_V1_8197F \ -+ (BIT_MASK_EXQ_LOW_TH_V1_8197F << BIT_SHIFT_EXQ_LOW_TH_V1_8197F) -+#define BIT_CLEAR_EXQ_LOW_TH_V1_8197F(x) ((x) & (~BITS_EXQ_LOW_TH_V1_8197F)) -+#define BIT_GET_EXQ_LOW_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_EXQ_LOW_TH_V1_8197F) & BIT_MASK_EXQ_LOW_TH_V1_8197F) -+#define BIT_SET_EXQ_LOW_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_EXQ_LOW_TH_V1_8197F(x) | BIT_EXQ_LOW_TH_V1_8197F(v)) -+ -+/* 2 REG_RQPN_CTRL_1_8197F */ -+ -+#define BIT_SHIFT_TXPKTNUM_H_8197F 16 -+#define BIT_MASK_TXPKTNUM_H_8197F 0xffff -+#define BIT_TXPKTNUM_H_8197F(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_H_8197F) << BIT_SHIFT_TXPKTNUM_H_8197F) -+#define BITS_TXPKTNUM_H_8197F \ -+ (BIT_MASK_TXPKTNUM_H_8197F << BIT_SHIFT_TXPKTNUM_H_8197F) -+#define BIT_CLEAR_TXPKTNUM_H_8197F(x) ((x) & (~BITS_TXPKTNUM_H_8197F)) -+#define BIT_GET_TXPKTNUM_H_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_H_8197F) & BIT_MASK_TXPKTNUM_H_8197F) -+#define BIT_SET_TXPKTNUM_H_8197F(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_H_8197F(x) | BIT_TXPKTNUM_H_8197F(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_H_V1_8197F 0 -+#define BIT_MASK_TXPKTNUM_H_V1_8197F 0xffff -+#define BIT_TXPKTNUM_H_V1_8197F(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_H_V1_8197F) << BIT_SHIFT_TXPKTNUM_H_V1_8197F) -+#define BITS_TXPKTNUM_H_V1_8197F \ -+ (BIT_MASK_TXPKTNUM_H_V1_8197F << BIT_SHIFT_TXPKTNUM_H_V1_8197F) -+#define BIT_CLEAR_TXPKTNUM_H_V1_8197F(x) ((x) & (~BITS_TXPKTNUM_H_V1_8197F)) -+#define BIT_GET_TXPKTNUM_H_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_H_V1_8197F) & BIT_MASK_TXPKTNUM_H_V1_8197F) -+#define BIT_SET_TXPKTNUM_H_V1_8197F(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_H_V1_8197F(x) | BIT_TXPKTNUM_H_V1_8197F(v)) -+ -+/* 2 REG_RQPN_CTRL_2_8197F */ -+#define BIT_LD_RQPN_8197F BIT(31) -+#define BIT_EXQ_PUBLIC_DIS_V1_8197F BIT(19) -+#define BIT_NPQ_PUBLIC_DIS_V1_8197F BIT(18) -+#define BIT_LPQ_PUBLIC_DIS_V1_8197F BIT(17) -+#define BIT_HPQ_PUBLIC_DIS_V1_8197F BIT(16) -+ -+/* 2 REG_FIFOPAGE_INFO_1_8197F */ -+ -+#define BIT_SHIFT_HPQ_AVAL_PG_V1_8197F 16 -+#define BIT_MASK_HPQ_AVAL_PG_V1_8197F 0xfff -+#define BIT_HPQ_AVAL_PG_V1_8197F(x) \ -+ (((x) & BIT_MASK_HPQ_AVAL_PG_V1_8197F) \ -+ << BIT_SHIFT_HPQ_AVAL_PG_V1_8197F) -+#define BITS_HPQ_AVAL_PG_V1_8197F \ -+ (BIT_MASK_HPQ_AVAL_PG_V1_8197F << BIT_SHIFT_HPQ_AVAL_PG_V1_8197F) -+#define BIT_CLEAR_HPQ_AVAL_PG_V1_8197F(x) ((x) & (~BITS_HPQ_AVAL_PG_V1_8197F)) -+#define BIT_GET_HPQ_AVAL_PG_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HPQ_AVAL_PG_V1_8197F) & \ -+ BIT_MASK_HPQ_AVAL_PG_V1_8197F) -+#define BIT_SET_HPQ_AVAL_PG_V1_8197F(x, v) \ -+ (BIT_CLEAR_HPQ_AVAL_PG_V1_8197F(x) | BIT_HPQ_AVAL_PG_V1_8197F(v)) -+ -+#define BIT_SHIFT_HPQ_V1_8197F 0 -+#define BIT_MASK_HPQ_V1_8197F 0xfff -+#define BIT_HPQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_HPQ_V1_8197F) << BIT_SHIFT_HPQ_V1_8197F) -+#define BITS_HPQ_V1_8197F (BIT_MASK_HPQ_V1_8197F << BIT_SHIFT_HPQ_V1_8197F) -+#define BIT_CLEAR_HPQ_V1_8197F(x) ((x) & (~BITS_HPQ_V1_8197F)) -+#define BIT_GET_HPQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HPQ_V1_8197F) & BIT_MASK_HPQ_V1_8197F) -+#define BIT_SET_HPQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_HPQ_V1_8197F(x) | BIT_HPQ_V1_8197F(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_2_8197F */ -+ -+#define BIT_SHIFT_LPQ_AVAL_PG_V1_8197F 16 -+#define BIT_MASK_LPQ_AVAL_PG_V1_8197F 0xfff -+#define BIT_LPQ_AVAL_PG_V1_8197F(x) \ -+ (((x) & BIT_MASK_LPQ_AVAL_PG_V1_8197F) \ -+ << BIT_SHIFT_LPQ_AVAL_PG_V1_8197F) -+#define BITS_LPQ_AVAL_PG_V1_8197F \ -+ (BIT_MASK_LPQ_AVAL_PG_V1_8197F << BIT_SHIFT_LPQ_AVAL_PG_V1_8197F) -+#define BIT_CLEAR_LPQ_AVAL_PG_V1_8197F(x) ((x) & (~BITS_LPQ_AVAL_PG_V1_8197F)) -+#define BIT_GET_LPQ_AVAL_PG_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LPQ_AVAL_PG_V1_8197F) & \ -+ BIT_MASK_LPQ_AVAL_PG_V1_8197F) -+#define BIT_SET_LPQ_AVAL_PG_V1_8197F(x, v) \ -+ (BIT_CLEAR_LPQ_AVAL_PG_V1_8197F(x) | BIT_LPQ_AVAL_PG_V1_8197F(v)) -+ -+#define BIT_SHIFT_LPQ_V1_8197F 0 -+#define BIT_MASK_LPQ_V1_8197F 0xfff -+#define BIT_LPQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_LPQ_V1_8197F) << BIT_SHIFT_LPQ_V1_8197F) -+#define BITS_LPQ_V1_8197F (BIT_MASK_LPQ_V1_8197F << BIT_SHIFT_LPQ_V1_8197F) -+#define BIT_CLEAR_LPQ_V1_8197F(x) ((x) & (~BITS_LPQ_V1_8197F)) -+#define BIT_GET_LPQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LPQ_V1_8197F) & BIT_MASK_LPQ_V1_8197F) -+#define BIT_SET_LPQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_LPQ_V1_8197F(x) | BIT_LPQ_V1_8197F(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_3_8197F */ -+ -+#define BIT_SHIFT_NPQ_AVAL_PG_V1_8197F 16 -+#define BIT_MASK_NPQ_AVAL_PG_V1_8197F 0xfff -+#define BIT_NPQ_AVAL_PG_V1_8197F(x) \ -+ (((x) & BIT_MASK_NPQ_AVAL_PG_V1_8197F) \ -+ << BIT_SHIFT_NPQ_AVAL_PG_V1_8197F) -+#define BITS_NPQ_AVAL_PG_V1_8197F \ -+ (BIT_MASK_NPQ_AVAL_PG_V1_8197F << BIT_SHIFT_NPQ_AVAL_PG_V1_8197F) -+#define BIT_CLEAR_NPQ_AVAL_PG_V1_8197F(x) ((x) & (~BITS_NPQ_AVAL_PG_V1_8197F)) -+#define BIT_GET_NPQ_AVAL_PG_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_NPQ_AVAL_PG_V1_8197F) & \ -+ BIT_MASK_NPQ_AVAL_PG_V1_8197F) -+#define BIT_SET_NPQ_AVAL_PG_V1_8197F(x, v) \ -+ (BIT_CLEAR_NPQ_AVAL_PG_V1_8197F(x) | BIT_NPQ_AVAL_PG_V1_8197F(v)) -+ -+#define BIT_SHIFT_NPQ_V1_8197F 0 -+#define BIT_MASK_NPQ_V1_8197F 0xfff -+#define BIT_NPQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_NPQ_V1_8197F) << BIT_SHIFT_NPQ_V1_8197F) -+#define BITS_NPQ_V1_8197F (BIT_MASK_NPQ_V1_8197F << BIT_SHIFT_NPQ_V1_8197F) -+#define BIT_CLEAR_NPQ_V1_8197F(x) ((x) & (~BITS_NPQ_V1_8197F)) -+#define BIT_GET_NPQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_NPQ_V1_8197F) & BIT_MASK_NPQ_V1_8197F) -+#define BIT_SET_NPQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_NPQ_V1_8197F(x) | BIT_NPQ_V1_8197F(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_4_8197F */ -+ -+#define BIT_SHIFT_EXQ_AVAL_PG_V1_8197F 16 -+#define BIT_MASK_EXQ_AVAL_PG_V1_8197F 0xfff -+#define BIT_EXQ_AVAL_PG_V1_8197F(x) \ -+ (((x) & BIT_MASK_EXQ_AVAL_PG_V1_8197F) \ -+ << BIT_SHIFT_EXQ_AVAL_PG_V1_8197F) -+#define BITS_EXQ_AVAL_PG_V1_8197F \ -+ (BIT_MASK_EXQ_AVAL_PG_V1_8197F << BIT_SHIFT_EXQ_AVAL_PG_V1_8197F) -+#define BIT_CLEAR_EXQ_AVAL_PG_V1_8197F(x) ((x) & (~BITS_EXQ_AVAL_PG_V1_8197F)) -+#define BIT_GET_EXQ_AVAL_PG_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_EXQ_AVAL_PG_V1_8197F) & \ -+ BIT_MASK_EXQ_AVAL_PG_V1_8197F) -+#define BIT_SET_EXQ_AVAL_PG_V1_8197F(x, v) \ -+ (BIT_CLEAR_EXQ_AVAL_PG_V1_8197F(x) | BIT_EXQ_AVAL_PG_V1_8197F(v)) -+ -+#define BIT_SHIFT_EXQ_V1_8197F 0 -+#define BIT_MASK_EXQ_V1_8197F 0xfff -+#define BIT_EXQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_EXQ_V1_8197F) << BIT_SHIFT_EXQ_V1_8197F) -+#define BITS_EXQ_V1_8197F (BIT_MASK_EXQ_V1_8197F << BIT_SHIFT_EXQ_V1_8197F) -+#define BIT_CLEAR_EXQ_V1_8197F(x) ((x) & (~BITS_EXQ_V1_8197F)) -+#define BIT_GET_EXQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_EXQ_V1_8197F) & BIT_MASK_EXQ_V1_8197F) -+#define BIT_SET_EXQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_EXQ_V1_8197F(x) | BIT_EXQ_V1_8197F(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_5_8197F */ -+ -+#define BIT_SHIFT_PUBQ_AVAL_PG_V1_8197F 16 -+#define BIT_MASK_PUBQ_AVAL_PG_V1_8197F 0xfff -+#define BIT_PUBQ_AVAL_PG_V1_8197F(x) \ -+ (((x) & BIT_MASK_PUBQ_AVAL_PG_V1_8197F) \ -+ << BIT_SHIFT_PUBQ_AVAL_PG_V1_8197F) -+#define BITS_PUBQ_AVAL_PG_V1_8197F \ -+ (BIT_MASK_PUBQ_AVAL_PG_V1_8197F << BIT_SHIFT_PUBQ_AVAL_PG_V1_8197F) -+#define BIT_CLEAR_PUBQ_AVAL_PG_V1_8197F(x) ((x) & (~BITS_PUBQ_AVAL_PG_V1_8197F)) -+#define BIT_GET_PUBQ_AVAL_PG_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_AVAL_PG_V1_8197F) & \ -+ BIT_MASK_PUBQ_AVAL_PG_V1_8197F) -+#define BIT_SET_PUBQ_AVAL_PG_V1_8197F(x, v) \ -+ (BIT_CLEAR_PUBQ_AVAL_PG_V1_8197F(x) | BIT_PUBQ_AVAL_PG_V1_8197F(v)) -+ -+#define BIT_SHIFT_PUBQ_V1_8197F 0 -+#define BIT_MASK_PUBQ_V1_8197F 0xfff -+#define BIT_PUBQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_PUBQ_V1_8197F) << BIT_SHIFT_PUBQ_V1_8197F) -+#define BITS_PUBQ_V1_8197F (BIT_MASK_PUBQ_V1_8197F << BIT_SHIFT_PUBQ_V1_8197F) -+#define BIT_CLEAR_PUBQ_V1_8197F(x) ((x) & (~BITS_PUBQ_V1_8197F)) -+#define BIT_GET_PUBQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_V1_8197F) & BIT_MASK_PUBQ_V1_8197F) -+#define BIT_SET_PUBQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_PUBQ_V1_8197F(x) | BIT_PUBQ_V1_8197F(v)) -+ -+/* 2 REG_H2C_HEAD_8197F */ -+ -+#define BIT_SHIFT_H2C_HEAD_8197F 0 -+#define BIT_MASK_H2C_HEAD_8197F 0x3ffff -+#define BIT_H2C_HEAD_8197F(x) \ -+ (((x) & BIT_MASK_H2C_HEAD_8197F) << BIT_SHIFT_H2C_HEAD_8197F) -+#define BITS_H2C_HEAD_8197F \ -+ (BIT_MASK_H2C_HEAD_8197F << BIT_SHIFT_H2C_HEAD_8197F) -+#define BIT_CLEAR_H2C_HEAD_8197F(x) ((x) & (~BITS_H2C_HEAD_8197F)) -+#define BIT_GET_H2C_HEAD_8197F(x) \ -+ (((x) >> BIT_SHIFT_H2C_HEAD_8197F) & BIT_MASK_H2C_HEAD_8197F) -+#define BIT_SET_H2C_HEAD_8197F(x, v) \ -+ (BIT_CLEAR_H2C_HEAD_8197F(x) | BIT_H2C_HEAD_8197F(v)) -+ -+/* 2 REG_H2C_TAIL_8197F */ -+ -+#define BIT_SHIFT_H2C_TAIL_8197F 0 -+#define BIT_MASK_H2C_TAIL_8197F 0x3ffff -+#define BIT_H2C_TAIL_8197F(x) \ -+ (((x) & BIT_MASK_H2C_TAIL_8197F) << BIT_SHIFT_H2C_TAIL_8197F) -+#define BITS_H2C_TAIL_8197F \ -+ (BIT_MASK_H2C_TAIL_8197F << BIT_SHIFT_H2C_TAIL_8197F) -+#define BIT_CLEAR_H2C_TAIL_8197F(x) ((x) & (~BITS_H2C_TAIL_8197F)) -+#define BIT_GET_H2C_TAIL_8197F(x) \ -+ (((x) >> BIT_SHIFT_H2C_TAIL_8197F) & BIT_MASK_H2C_TAIL_8197F) -+#define BIT_SET_H2C_TAIL_8197F(x, v) \ -+ (BIT_CLEAR_H2C_TAIL_8197F(x) | BIT_H2C_TAIL_8197F(v)) -+ -+/* 2 REG_H2C_READ_ADDR_8197F */ -+ -+#define BIT_SHIFT_H2C_READ_ADDR_8197F 0 -+#define BIT_MASK_H2C_READ_ADDR_8197F 0x3ffff -+#define BIT_H2C_READ_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_H2C_READ_ADDR_8197F) << BIT_SHIFT_H2C_READ_ADDR_8197F) -+#define BITS_H2C_READ_ADDR_8197F \ -+ (BIT_MASK_H2C_READ_ADDR_8197F << BIT_SHIFT_H2C_READ_ADDR_8197F) -+#define BIT_CLEAR_H2C_READ_ADDR_8197F(x) ((x) & (~BITS_H2C_READ_ADDR_8197F)) -+#define BIT_GET_H2C_READ_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_H2C_READ_ADDR_8197F) & BIT_MASK_H2C_READ_ADDR_8197F) -+#define BIT_SET_H2C_READ_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_H2C_READ_ADDR_8197F(x) | BIT_H2C_READ_ADDR_8197F(v)) -+ -+/* 2 REG_H2C_WR_ADDR_8197F */ -+ -+#define BIT_SHIFT_H2C_WR_ADDR_8197F 0 -+#define BIT_MASK_H2C_WR_ADDR_8197F 0x3ffff -+#define BIT_H2C_WR_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_H2C_WR_ADDR_8197F) << BIT_SHIFT_H2C_WR_ADDR_8197F) -+#define BITS_H2C_WR_ADDR_8197F \ -+ (BIT_MASK_H2C_WR_ADDR_8197F << BIT_SHIFT_H2C_WR_ADDR_8197F) -+#define BIT_CLEAR_H2C_WR_ADDR_8197F(x) ((x) & (~BITS_H2C_WR_ADDR_8197F)) -+#define BIT_GET_H2C_WR_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_H2C_WR_ADDR_8197F) & BIT_MASK_H2C_WR_ADDR_8197F) -+#define BIT_SET_H2C_WR_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_H2C_WR_ADDR_8197F(x) | BIT_H2C_WR_ADDR_8197F(v)) -+ -+/* 2 REG_H2C_INFO_8197F */ -+#define BIT_EXQ_EN_PUBLIC_LIMIT_8197F BIT(11) -+#define BIT_NPQ_EN_PUBLIC_LIMIT_8197F BIT(10) -+#define BIT_LPQ_EN_PUBLIC_LIMIT_8197F BIT(9) -+#define BIT_HPQ_EN_PUBLIC_LIMIT_8197F BIT(8) -+#define BIT_H2C_SPACE_VLD_8197F BIT(3) -+#define BIT_H2C_WR_ADDR_RST_8197F BIT(2) -+ -+#define BIT_SHIFT_H2C_LEN_SEL_8197F 0 -+#define BIT_MASK_H2C_LEN_SEL_8197F 0x3 -+#define BIT_H2C_LEN_SEL_8197F(x) \ -+ (((x) & BIT_MASK_H2C_LEN_SEL_8197F) << BIT_SHIFT_H2C_LEN_SEL_8197F) -+#define BITS_H2C_LEN_SEL_8197F \ -+ (BIT_MASK_H2C_LEN_SEL_8197F << BIT_SHIFT_H2C_LEN_SEL_8197F) -+#define BIT_CLEAR_H2C_LEN_SEL_8197F(x) ((x) & (~BITS_H2C_LEN_SEL_8197F)) -+#define BIT_GET_H2C_LEN_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_H2C_LEN_SEL_8197F) & BIT_MASK_H2C_LEN_SEL_8197F) -+#define BIT_SET_H2C_LEN_SEL_8197F(x, v) \ -+ (BIT_CLEAR_H2C_LEN_SEL_8197F(x) | BIT_H2C_LEN_SEL_8197F(v)) -+ -+#define BIT_SHIFT_VI_PUB_LIMIT_8197F 16 -+#define BIT_MASK_VI_PUB_LIMIT_8197F 0xfff -+#define BIT_VI_PUB_LIMIT_8197F(x) \ -+ (((x) & BIT_MASK_VI_PUB_LIMIT_8197F) << BIT_SHIFT_VI_PUB_LIMIT_8197F) -+#define BITS_VI_PUB_LIMIT_8197F \ -+ (BIT_MASK_VI_PUB_LIMIT_8197F << BIT_SHIFT_VI_PUB_LIMIT_8197F) -+#define BIT_CLEAR_VI_PUB_LIMIT_8197F(x) ((x) & (~BITS_VI_PUB_LIMIT_8197F)) -+#define BIT_GET_VI_PUB_LIMIT_8197F(x) \ -+ (((x) >> BIT_SHIFT_VI_PUB_LIMIT_8197F) & BIT_MASK_VI_PUB_LIMIT_8197F) -+#define BIT_SET_VI_PUB_LIMIT_8197F(x, v) \ -+ (BIT_CLEAR_VI_PUB_LIMIT_8197F(x) | BIT_VI_PUB_LIMIT_8197F(v)) -+ -+#define BIT_SHIFT_VO_PUB_LIMIT_8197F 0 -+#define BIT_MASK_VO_PUB_LIMIT_8197F 0xfff -+#define BIT_VO_PUB_LIMIT_8197F(x) \ -+ (((x) & BIT_MASK_VO_PUB_LIMIT_8197F) << BIT_SHIFT_VO_PUB_LIMIT_8197F) -+#define BITS_VO_PUB_LIMIT_8197F \ -+ (BIT_MASK_VO_PUB_LIMIT_8197F << BIT_SHIFT_VO_PUB_LIMIT_8197F) -+#define BIT_CLEAR_VO_PUB_LIMIT_8197F(x) ((x) & (~BITS_VO_PUB_LIMIT_8197F)) -+#define BIT_GET_VO_PUB_LIMIT_8197F(x) \ -+ (((x) >> BIT_SHIFT_VO_PUB_LIMIT_8197F) & BIT_MASK_VO_PUB_LIMIT_8197F) -+#define BIT_SET_VO_PUB_LIMIT_8197F(x, v) \ -+ (BIT_CLEAR_VO_PUB_LIMIT_8197F(x) | BIT_VO_PUB_LIMIT_8197F(v)) -+ -+#define BIT_SHIFT_BK_PUB_LIMIT_8197F 16 -+#define BIT_MASK_BK_PUB_LIMIT_8197F 0xfff -+#define BIT_BK_PUB_LIMIT_8197F(x) \ -+ (((x) & BIT_MASK_BK_PUB_LIMIT_8197F) << BIT_SHIFT_BK_PUB_LIMIT_8197F) -+#define BITS_BK_PUB_LIMIT_8197F \ -+ (BIT_MASK_BK_PUB_LIMIT_8197F << BIT_SHIFT_BK_PUB_LIMIT_8197F) -+#define BIT_CLEAR_BK_PUB_LIMIT_8197F(x) ((x) & (~BITS_BK_PUB_LIMIT_8197F)) -+#define BIT_GET_BK_PUB_LIMIT_8197F(x) \ -+ (((x) >> BIT_SHIFT_BK_PUB_LIMIT_8197F) & BIT_MASK_BK_PUB_LIMIT_8197F) -+#define BIT_SET_BK_PUB_LIMIT_8197F(x, v) \ -+ (BIT_CLEAR_BK_PUB_LIMIT_8197F(x) | BIT_BK_PUB_LIMIT_8197F(v)) -+ -+#define BIT_SHIFT_BE_PUB_LIMIT_8197F 0 -+#define BIT_MASK_BE_PUB_LIMIT_8197F 0xfff -+#define BIT_BE_PUB_LIMIT_8197F(x) \ -+ (((x) & BIT_MASK_BE_PUB_LIMIT_8197F) << BIT_SHIFT_BE_PUB_LIMIT_8197F) -+#define BITS_BE_PUB_LIMIT_8197F \ -+ (BIT_MASK_BE_PUB_LIMIT_8197F << BIT_SHIFT_BE_PUB_LIMIT_8197F) -+#define BIT_CLEAR_BE_PUB_LIMIT_8197F(x) ((x) & (~BITS_BE_PUB_LIMIT_8197F)) -+#define BIT_GET_BE_PUB_LIMIT_8197F(x) \ -+ (((x) >> BIT_SHIFT_BE_PUB_LIMIT_8197F) & BIT_MASK_BE_PUB_LIMIT_8197F) -+#define BIT_SET_BE_PUB_LIMIT_8197F(x, v) \ -+ (BIT_CLEAR_BE_PUB_LIMIT_8197F(x) | BIT_BE_PUB_LIMIT_8197F(v)) -+ -+/* 2 REG_RXDMA_AGG_PG_TH_8197F */ -+#define BIT_DMA_STORE_MODE_8197F BIT(31) -+#define BIT_EN_FW_ADD_8197F BIT(30) -+#define BIT_EN_PRE_CALC_8197F BIT(29) -+#define BIT_RXAGG_SW_EN_8197F BIT(28) -+ -+#define BIT_SHIFT_PKT_NUM_WOL_8197F 16 -+#define BIT_MASK_PKT_NUM_WOL_8197F 0xff -+#define BIT_PKT_NUM_WOL_8197F(x) \ -+ (((x) & BIT_MASK_PKT_NUM_WOL_8197F) << BIT_SHIFT_PKT_NUM_WOL_8197F) -+#define BITS_PKT_NUM_WOL_8197F \ -+ (BIT_MASK_PKT_NUM_WOL_8197F << BIT_SHIFT_PKT_NUM_WOL_8197F) -+#define BIT_CLEAR_PKT_NUM_WOL_8197F(x) ((x) & (~BITS_PKT_NUM_WOL_8197F)) -+#define BIT_GET_PKT_NUM_WOL_8197F(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_WOL_8197F) & BIT_MASK_PKT_NUM_WOL_8197F) -+#define BIT_SET_PKT_NUM_WOL_8197F(x, v) \ -+ (BIT_CLEAR_PKT_NUM_WOL_8197F(x) | BIT_PKT_NUM_WOL_8197F(v)) -+ -+#define BIT_SHIFT_DMA_AGG_TO_V1_8197F 8 -+#define BIT_MASK_DMA_AGG_TO_V1_8197F 0xff -+#define BIT_DMA_AGG_TO_V1_8197F(x) \ -+ (((x) & BIT_MASK_DMA_AGG_TO_V1_8197F) << BIT_SHIFT_DMA_AGG_TO_V1_8197F) -+#define BITS_DMA_AGG_TO_V1_8197F \ -+ (BIT_MASK_DMA_AGG_TO_V1_8197F << BIT_SHIFT_DMA_AGG_TO_V1_8197F) -+#define BIT_CLEAR_DMA_AGG_TO_V1_8197F(x) ((x) & (~BITS_DMA_AGG_TO_V1_8197F)) -+#define BIT_GET_DMA_AGG_TO_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DMA_AGG_TO_V1_8197F) & BIT_MASK_DMA_AGG_TO_V1_8197F) -+#define BIT_SET_DMA_AGG_TO_V1_8197F(x, v) \ -+ (BIT_CLEAR_DMA_AGG_TO_V1_8197F(x) | BIT_DMA_AGG_TO_V1_8197F(v)) -+ -+#define BIT_SHIFT_RXDMA_AGG_PG_TH_8197F 0 -+#define BIT_MASK_RXDMA_AGG_PG_TH_8197F 0xff -+#define BIT_RXDMA_AGG_PG_TH_8197F(x) \ -+ (((x) & BIT_MASK_RXDMA_AGG_PG_TH_8197F) \ -+ << BIT_SHIFT_RXDMA_AGG_PG_TH_8197F) -+#define BITS_RXDMA_AGG_PG_TH_8197F \ -+ (BIT_MASK_RXDMA_AGG_PG_TH_8197F << BIT_SHIFT_RXDMA_AGG_PG_TH_8197F) -+#define BIT_CLEAR_RXDMA_AGG_PG_TH_8197F(x) ((x) & (~BITS_RXDMA_AGG_PG_TH_8197F)) -+#define BIT_GET_RXDMA_AGG_PG_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_AGG_PG_TH_8197F) & \ -+ BIT_MASK_RXDMA_AGG_PG_TH_8197F) -+#define BIT_SET_RXDMA_AGG_PG_TH_8197F(x, v) \ -+ (BIT_CLEAR_RXDMA_AGG_PG_TH_8197F(x) | BIT_RXDMA_AGG_PG_TH_8197F(v)) -+ -+/* 2 REG_RXPKT_NUM_8197F */ -+ -+#define BIT_SHIFT_RXPKT_NUM_8197F 24 -+#define BIT_MASK_RXPKT_NUM_8197F 0xff -+#define BIT_RXPKT_NUM_8197F(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_8197F) << BIT_SHIFT_RXPKT_NUM_8197F) -+#define BITS_RXPKT_NUM_8197F \ -+ (BIT_MASK_RXPKT_NUM_8197F << BIT_SHIFT_RXPKT_NUM_8197F) -+#define BIT_CLEAR_RXPKT_NUM_8197F(x) ((x) & (~BITS_RXPKT_NUM_8197F)) -+#define BIT_GET_RXPKT_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_8197F) & BIT_MASK_RXPKT_NUM_8197F) -+#define BIT_SET_RXPKT_NUM_8197F(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_8197F(x) | BIT_RXPKT_NUM_8197F(v)) -+ -+#define BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8197F 20 -+#define BIT_MASK_FW_UPD_RDPTR19_TO_16_8197F 0xf -+#define BIT_FW_UPD_RDPTR19_TO_16_8197F(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR19_TO_16_8197F) \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8197F) -+#define BITS_FW_UPD_RDPTR19_TO_16_8197F \ -+ (BIT_MASK_FW_UPD_RDPTR19_TO_16_8197F \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8197F) -+#define BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8197F(x) \ -+ ((x) & (~BITS_FW_UPD_RDPTR19_TO_16_8197F)) -+#define BIT_GET_FW_UPD_RDPTR19_TO_16_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8197F) & \ -+ BIT_MASK_FW_UPD_RDPTR19_TO_16_8197F) -+#define BIT_SET_FW_UPD_RDPTR19_TO_16_8197F(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8197F(x) | \ -+ BIT_FW_UPD_RDPTR19_TO_16_8197F(v)) -+ -+#define BIT_RXDMA_REQ_8197F BIT(19) -+#define BIT_RW_RELEASE_EN_8197F BIT(18) -+#define BIT_RXDMA_IDLE_8197F BIT(17) -+#define BIT_RXPKT_RELEASE_POLL_8197F BIT(16) -+ -+#define BIT_SHIFT_FW_UPD_RDPTR_8197F 0 -+#define BIT_MASK_FW_UPD_RDPTR_8197F 0xffff -+#define BIT_FW_UPD_RDPTR_8197F(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR_8197F) << BIT_SHIFT_FW_UPD_RDPTR_8197F) -+#define BITS_FW_UPD_RDPTR_8197F \ -+ (BIT_MASK_FW_UPD_RDPTR_8197F << BIT_SHIFT_FW_UPD_RDPTR_8197F) -+#define BIT_CLEAR_FW_UPD_RDPTR_8197F(x) ((x) & (~BITS_FW_UPD_RDPTR_8197F)) -+#define BIT_GET_FW_UPD_RDPTR_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR_8197F) & BIT_MASK_FW_UPD_RDPTR_8197F) -+#define BIT_SET_FW_UPD_RDPTR_8197F(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR_8197F(x) | BIT_FW_UPD_RDPTR_8197F(v)) -+ -+/* 2 REG_RXDMA_STATUS_8197F */ -+#define BIT_FC2H_PKT_OVERFLOW_8197F BIT(8) -+#define BIT_C2H_PKT_OVF_8197F BIT(7) -+#define BIT_AGG_CONFGI_ISSUE_8197F BIT(6) -+#define BIT_FW_POLL_ISSUE_8197F BIT(5) -+#define BIT_RX_DATA_UDN_8197F BIT(4) -+#define BIT_RX_SFF_UDN_8197F BIT(3) -+#define BIT_RX_SFF_OVF_8197F BIT(2) -+#define BIT_RXPKT_OVF_8197F BIT(0) -+ -+/* 2 REG_RXDMA_DPR_8197F */ -+ -+#define BIT_SHIFT_RDE_DEBUG_8197F 0 -+#define BIT_MASK_RDE_DEBUG_8197F 0xffffffffL -+#define BIT_RDE_DEBUG_8197F(x) \ -+ (((x) & BIT_MASK_RDE_DEBUG_8197F) << BIT_SHIFT_RDE_DEBUG_8197F) -+#define BITS_RDE_DEBUG_8197F \ -+ (BIT_MASK_RDE_DEBUG_8197F << BIT_SHIFT_RDE_DEBUG_8197F) -+#define BIT_CLEAR_RDE_DEBUG_8197F(x) ((x) & (~BITS_RDE_DEBUG_8197F)) -+#define BIT_GET_RDE_DEBUG_8197F(x) \ -+ (((x) >> BIT_SHIFT_RDE_DEBUG_8197F) & BIT_MASK_RDE_DEBUG_8197F) -+#define BIT_SET_RDE_DEBUG_8197F(x, v) \ -+ (BIT_CLEAR_RDE_DEBUG_8197F(x) | BIT_RDE_DEBUG_8197F(v)) -+ -+/* 2 REG_RXDMA_MODE_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_EN_SPD_8197F BIT(6) -+ -+#define BIT_SHIFT_BURST_SIZE_8197F 4 -+#define BIT_MASK_BURST_SIZE_8197F 0x3 -+#define BIT_BURST_SIZE_8197F(x) \ -+ (((x) & BIT_MASK_BURST_SIZE_8197F) << BIT_SHIFT_BURST_SIZE_8197F) -+#define BITS_BURST_SIZE_8197F \ -+ (BIT_MASK_BURST_SIZE_8197F << BIT_SHIFT_BURST_SIZE_8197F) -+#define BIT_CLEAR_BURST_SIZE_8197F(x) ((x) & (~BITS_BURST_SIZE_8197F)) -+#define BIT_GET_BURST_SIZE_8197F(x) \ -+ (((x) >> BIT_SHIFT_BURST_SIZE_8197F) & BIT_MASK_BURST_SIZE_8197F) -+#define BIT_SET_BURST_SIZE_8197F(x, v) \ -+ (BIT_CLEAR_BURST_SIZE_8197F(x) | BIT_BURST_SIZE_8197F(v)) -+ -+#define BIT_SHIFT_BURST_CNT_8197F 2 -+#define BIT_MASK_BURST_CNT_8197F 0x3 -+#define BIT_BURST_CNT_8197F(x) \ -+ (((x) & BIT_MASK_BURST_CNT_8197F) << BIT_SHIFT_BURST_CNT_8197F) -+#define BITS_BURST_CNT_8197F \ -+ (BIT_MASK_BURST_CNT_8197F << BIT_SHIFT_BURST_CNT_8197F) -+#define BIT_CLEAR_BURST_CNT_8197F(x) ((x) & (~BITS_BURST_CNT_8197F)) -+#define BIT_GET_BURST_CNT_8197F(x) \ -+ (((x) >> BIT_SHIFT_BURST_CNT_8197F) & BIT_MASK_BURST_CNT_8197F) -+#define BIT_SET_BURST_CNT_8197F(x, v) \ -+ (BIT_CLEAR_BURST_CNT_8197F(x) | BIT_BURST_CNT_8197F(v)) -+ -+#define BIT_DMA_MODE_8197F BIT(1) -+ -+/* 2 REG_C2H_PKT_8197F */ -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8197F 24 -+#define BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8197F 0xf -+#define BIT_R_C2H_STR_ADDR_16_TO_19_8197F(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8197F) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8197F) -+#define BITS_R_C2H_STR_ADDR_16_TO_19_8197F \ -+ (BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8197F \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8197F) -+#define BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8197F(x) \ -+ ((x) & (~BITS_R_C2H_STR_ADDR_16_TO_19_8197F)) -+#define BIT_GET_R_C2H_STR_ADDR_16_TO_19_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8197F) & \ -+ BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8197F) -+#define BIT_SET_R_C2H_STR_ADDR_16_TO_19_8197F(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8197F(x) | \ -+ BIT_R_C2H_STR_ADDR_16_TO_19_8197F(v)) -+ -+#define BIT_R_C2H_PKT_REQ_8197F BIT(16) -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_8197F 0 -+#define BIT_MASK_R_C2H_STR_ADDR_8197F 0xffff -+#define BIT_R_C2H_STR_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_8197F) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_8197F) -+#define BITS_R_C2H_STR_ADDR_8197F \ -+ (BIT_MASK_R_C2H_STR_ADDR_8197F << BIT_SHIFT_R_C2H_STR_ADDR_8197F) -+#define BIT_CLEAR_R_C2H_STR_ADDR_8197F(x) ((x) & (~BITS_R_C2H_STR_ADDR_8197F)) -+#define BIT_GET_R_C2H_STR_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_8197F) & \ -+ BIT_MASK_R_C2H_STR_ADDR_8197F) -+#define BIT_SET_R_C2H_STR_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_8197F(x) | BIT_R_C2H_STR_ADDR_8197F(v)) -+ -+/* 2 REG_FWFF_C2H_8197F */ -+ -+#define BIT_SHIFT_C2H_DMA_ADDR_8197F 0 -+#define BIT_MASK_C2H_DMA_ADDR_8197F 0x3ffff -+#define BIT_C2H_DMA_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_C2H_DMA_ADDR_8197F) << BIT_SHIFT_C2H_DMA_ADDR_8197F) -+#define BITS_C2H_DMA_ADDR_8197F \ -+ (BIT_MASK_C2H_DMA_ADDR_8197F << BIT_SHIFT_C2H_DMA_ADDR_8197F) -+#define BIT_CLEAR_C2H_DMA_ADDR_8197F(x) ((x) & (~BITS_C2H_DMA_ADDR_8197F)) -+#define BIT_GET_C2H_DMA_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_C2H_DMA_ADDR_8197F) & BIT_MASK_C2H_DMA_ADDR_8197F) -+#define BIT_SET_C2H_DMA_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_C2H_DMA_ADDR_8197F(x) | BIT_C2H_DMA_ADDR_8197F(v)) -+ -+/* 2 REG_FWFF_CTRL_8197F */ -+#define BIT_FWFF_DMAPKT_REQ_8197F BIT(31) -+ -+#define BIT_SHIFT_FWFF_DMA_PKT_NUM_8197F 16 -+#define BIT_MASK_FWFF_DMA_PKT_NUM_8197F 0xff -+#define BIT_FWFF_DMA_PKT_NUM_8197F(x) \ -+ (((x) & BIT_MASK_FWFF_DMA_PKT_NUM_8197F) \ -+ << BIT_SHIFT_FWFF_DMA_PKT_NUM_8197F) -+#define BITS_FWFF_DMA_PKT_NUM_8197F \ -+ (BIT_MASK_FWFF_DMA_PKT_NUM_8197F << BIT_SHIFT_FWFF_DMA_PKT_NUM_8197F) -+#define BIT_CLEAR_FWFF_DMA_PKT_NUM_8197F(x) \ -+ ((x) & (~BITS_FWFF_DMA_PKT_NUM_8197F)) -+#define BIT_GET_FWFF_DMA_PKT_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_FWFF_DMA_PKT_NUM_8197F) & \ -+ BIT_MASK_FWFF_DMA_PKT_NUM_8197F) -+#define BIT_SET_FWFF_DMA_PKT_NUM_8197F(x, v) \ -+ (BIT_CLEAR_FWFF_DMA_PKT_NUM_8197F(x) | BIT_FWFF_DMA_PKT_NUM_8197F(v)) -+ -+#define BIT_SHIFT_FWFF_STR_ADDR_8197F 0 -+#define BIT_MASK_FWFF_STR_ADDR_8197F 0xffff -+#define BIT_FWFF_STR_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_FWFF_STR_ADDR_8197F) << BIT_SHIFT_FWFF_STR_ADDR_8197F) -+#define BITS_FWFF_STR_ADDR_8197F \ -+ (BIT_MASK_FWFF_STR_ADDR_8197F << BIT_SHIFT_FWFF_STR_ADDR_8197F) -+#define BIT_CLEAR_FWFF_STR_ADDR_8197F(x) ((x) & (~BITS_FWFF_STR_ADDR_8197F)) -+#define BIT_GET_FWFF_STR_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_FWFF_STR_ADDR_8197F) & BIT_MASK_FWFF_STR_ADDR_8197F) -+#define BIT_SET_FWFF_STR_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_FWFF_STR_ADDR_8197F(x) | BIT_FWFF_STR_ADDR_8197F(v)) -+ -+/* 2 REG_FWFF_PKT_INFO_8197F */ -+ -+#define BIT_SHIFT_FWFF_PKT_QUEUED_8197F 16 -+#define BIT_MASK_FWFF_PKT_QUEUED_8197F 0xff -+#define BIT_FWFF_PKT_QUEUED_8197F(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_QUEUED_8197F) \ -+ << BIT_SHIFT_FWFF_PKT_QUEUED_8197F) -+#define BITS_FWFF_PKT_QUEUED_8197F \ -+ (BIT_MASK_FWFF_PKT_QUEUED_8197F << BIT_SHIFT_FWFF_PKT_QUEUED_8197F) -+#define BIT_CLEAR_FWFF_PKT_QUEUED_8197F(x) ((x) & (~BITS_FWFF_PKT_QUEUED_8197F)) -+#define BIT_GET_FWFF_PKT_QUEUED_8197F(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_QUEUED_8197F) & \ -+ BIT_MASK_FWFF_PKT_QUEUED_8197F) -+#define BIT_SET_FWFF_PKT_QUEUED_8197F(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_QUEUED_8197F(x) | BIT_FWFF_PKT_QUEUED_8197F(v)) -+ -+#define BIT_SHIFT_FWFF_PKT_STR_ADDR_8197F 0 -+#define BIT_MASK_FWFF_PKT_STR_ADDR_8197F 0xffff -+#define BIT_FWFF_PKT_STR_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_STR_ADDR_8197F) \ -+ << BIT_SHIFT_FWFF_PKT_STR_ADDR_8197F) -+#define BITS_FWFF_PKT_STR_ADDR_8197F \ -+ (BIT_MASK_FWFF_PKT_STR_ADDR_8197F << BIT_SHIFT_FWFF_PKT_STR_ADDR_8197F) -+#define BIT_CLEAR_FWFF_PKT_STR_ADDR_8197F(x) \ -+ ((x) & (~BITS_FWFF_PKT_STR_ADDR_8197F)) -+#define BIT_GET_FWFF_PKT_STR_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_STR_ADDR_8197F) & \ -+ BIT_MASK_FWFF_PKT_STR_ADDR_8197F) -+#define BIT_SET_FWFF_PKT_STR_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_STR_ADDR_8197F(x) | BIT_FWFF_PKT_STR_ADDR_8197F(v)) -+ -+/* 2 REG_FC2H_INFO_8197F */ -+#define BIT_FC2H_PKT_REQ_8197F BIT(16) -+ -+#define BIT_SHIFT_FC2H_STR_ADDR_8197F 0 -+#define BIT_MASK_FC2H_STR_ADDR_8197F 0xffff -+#define BIT_FC2H_STR_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_FC2H_STR_ADDR_8197F) << BIT_SHIFT_FC2H_STR_ADDR_8197F) -+#define BITS_FC2H_STR_ADDR_8197F \ -+ (BIT_MASK_FC2H_STR_ADDR_8197F << BIT_SHIFT_FC2H_STR_ADDR_8197F) -+#define BIT_CLEAR_FC2H_STR_ADDR_8197F(x) ((x) & (~BITS_FC2H_STR_ADDR_8197F)) -+#define BIT_GET_FC2H_STR_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_FC2H_STR_ADDR_8197F) & BIT_MASK_FC2H_STR_ADDR_8197F) -+#define BIT_SET_FC2H_STR_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_FC2H_STR_ADDR_8197F(x) | BIT_FC2H_STR_ADDR_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_DDMA_CH0SA_8197F */ -+ -+#define BIT_SHIFT_DDMACH0_SA_8197F 0 -+#define BIT_MASK_DDMACH0_SA_8197F 0xffffffffL -+#define BIT_DDMACH0_SA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH0_SA_8197F) << BIT_SHIFT_DDMACH0_SA_8197F) -+#define BITS_DDMACH0_SA_8197F \ -+ (BIT_MASK_DDMACH0_SA_8197F << BIT_SHIFT_DDMACH0_SA_8197F) -+#define BIT_CLEAR_DDMACH0_SA_8197F(x) ((x) & (~BITS_DDMACH0_SA_8197F)) -+#define BIT_GET_DDMACH0_SA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_SA_8197F) & BIT_MASK_DDMACH0_SA_8197F) -+#define BIT_SET_DDMACH0_SA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH0_SA_8197F(x) | BIT_DDMACH0_SA_8197F(v)) -+ -+/* 2 REG_DDMA_CH0DA_8197F */ -+ -+#define BIT_SHIFT_DDMACH0_DA_8197F 0 -+#define BIT_MASK_DDMACH0_DA_8197F 0xffffffffL -+#define BIT_DDMACH0_DA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH0_DA_8197F) << BIT_SHIFT_DDMACH0_DA_8197F) -+#define BITS_DDMACH0_DA_8197F \ -+ (BIT_MASK_DDMACH0_DA_8197F << BIT_SHIFT_DDMACH0_DA_8197F) -+#define BIT_CLEAR_DDMACH0_DA_8197F(x) ((x) & (~BITS_DDMACH0_DA_8197F)) -+#define BIT_GET_DDMACH0_DA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DA_8197F) & BIT_MASK_DDMACH0_DA_8197F) -+#define BIT_SET_DDMACH0_DA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH0_DA_8197F(x) | BIT_DDMACH0_DA_8197F(v)) -+ -+/* 2 REG_DDMA_CH0CTRL_8197F */ -+#define BIT_DDMACH0_OWN_8197F BIT(31) -+#define BIT_DDMACH0_CHKSUM_EN_8197F BIT(29) -+#define BIT_DDMACH0_DA_W_DISABLE_8197F BIT(28) -+#define BIT_DDMACH0_CHKSUM_STS_8197F BIT(27) -+#define BIT_DDMACH0_DDMA_MODE_8197F BIT(26) -+#define BIT_DDMACH0_RESET_CHKSUM_STS_8197F BIT(25) -+#define BIT_DDMACH0_CHKSUM_CONT_8197F BIT(24) -+ -+#define BIT_SHIFT_DDMACH0_DLEN_8197F 0 -+#define BIT_MASK_DDMACH0_DLEN_8197F 0x3ffff -+#define BIT_DDMACH0_DLEN_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH0_DLEN_8197F) << BIT_SHIFT_DDMACH0_DLEN_8197F) -+#define BITS_DDMACH0_DLEN_8197F \ -+ (BIT_MASK_DDMACH0_DLEN_8197F << BIT_SHIFT_DDMACH0_DLEN_8197F) -+#define BIT_CLEAR_DDMACH0_DLEN_8197F(x) ((x) & (~BITS_DDMACH0_DLEN_8197F)) -+#define BIT_GET_DDMACH0_DLEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DLEN_8197F) & BIT_MASK_DDMACH0_DLEN_8197F) -+#define BIT_SET_DDMACH0_DLEN_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH0_DLEN_8197F(x) | BIT_DDMACH0_DLEN_8197F(v)) -+ -+/* 2 REG_DDMA_CH1SA_8197F */ -+ -+#define BIT_SHIFT_DDMACH1_SA_8197F 0 -+#define BIT_MASK_DDMACH1_SA_8197F 0xffffffffL -+#define BIT_DDMACH1_SA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH1_SA_8197F) << BIT_SHIFT_DDMACH1_SA_8197F) -+#define BITS_DDMACH1_SA_8197F \ -+ (BIT_MASK_DDMACH1_SA_8197F << BIT_SHIFT_DDMACH1_SA_8197F) -+#define BIT_CLEAR_DDMACH1_SA_8197F(x) ((x) & (~BITS_DDMACH1_SA_8197F)) -+#define BIT_GET_DDMACH1_SA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_SA_8197F) & BIT_MASK_DDMACH1_SA_8197F) -+#define BIT_SET_DDMACH1_SA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH1_SA_8197F(x) | BIT_DDMACH1_SA_8197F(v)) -+ -+/* 2 REG_DDMA_CH1DA_8197F */ -+ -+#define BIT_SHIFT_DDMACH1_DA_8197F 0 -+#define BIT_MASK_DDMACH1_DA_8197F 0xffffffffL -+#define BIT_DDMACH1_DA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH1_DA_8197F) << BIT_SHIFT_DDMACH1_DA_8197F) -+#define BITS_DDMACH1_DA_8197F \ -+ (BIT_MASK_DDMACH1_DA_8197F << BIT_SHIFT_DDMACH1_DA_8197F) -+#define BIT_CLEAR_DDMACH1_DA_8197F(x) ((x) & (~BITS_DDMACH1_DA_8197F)) -+#define BIT_GET_DDMACH1_DA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DA_8197F) & BIT_MASK_DDMACH1_DA_8197F) -+#define BIT_SET_DDMACH1_DA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH1_DA_8197F(x) | BIT_DDMACH1_DA_8197F(v)) -+ -+/* 2 REG_DDMA_CH1CTRL_8197F */ -+#define BIT_DDMACH1_OWN_8197F BIT(31) -+#define BIT_DDMACH1_CHKSUM_EN_8197F BIT(29) -+#define BIT_DDMACH1_DA_W_DISABLE_8197F BIT(28) -+#define BIT_DDMACH1_CHKSUM_STS_8197F BIT(27) -+#define BIT_DDMACH1_DDMA_MODE_8197F BIT(26) -+#define BIT_DDMACH1_RESET_CHKSUM_STS_8197F BIT(25) -+#define BIT_DDMACH1_CHKSUM_CONT_8197F BIT(24) -+ -+#define BIT_SHIFT_DDMACH1_DLEN_8197F 0 -+#define BIT_MASK_DDMACH1_DLEN_8197F 0x3ffff -+#define BIT_DDMACH1_DLEN_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH1_DLEN_8197F) << BIT_SHIFT_DDMACH1_DLEN_8197F) -+#define BITS_DDMACH1_DLEN_8197F \ -+ (BIT_MASK_DDMACH1_DLEN_8197F << BIT_SHIFT_DDMACH1_DLEN_8197F) -+#define BIT_CLEAR_DDMACH1_DLEN_8197F(x) ((x) & (~BITS_DDMACH1_DLEN_8197F)) -+#define BIT_GET_DDMACH1_DLEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DLEN_8197F) & BIT_MASK_DDMACH1_DLEN_8197F) -+#define BIT_SET_DDMACH1_DLEN_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH1_DLEN_8197F(x) | BIT_DDMACH1_DLEN_8197F(v)) -+ -+/* 2 REG_DDMA_CH2SA_8197F */ -+ -+#define BIT_SHIFT_DDMACH2_SA_8197F 0 -+#define BIT_MASK_DDMACH2_SA_8197F 0xffffffffL -+#define BIT_DDMACH2_SA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH2_SA_8197F) << BIT_SHIFT_DDMACH2_SA_8197F) -+#define BITS_DDMACH2_SA_8197F \ -+ (BIT_MASK_DDMACH2_SA_8197F << BIT_SHIFT_DDMACH2_SA_8197F) -+#define BIT_CLEAR_DDMACH2_SA_8197F(x) ((x) & (~BITS_DDMACH2_SA_8197F)) -+#define BIT_GET_DDMACH2_SA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_SA_8197F) & BIT_MASK_DDMACH2_SA_8197F) -+#define BIT_SET_DDMACH2_SA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH2_SA_8197F(x) | BIT_DDMACH2_SA_8197F(v)) -+ -+/* 2 REG_DDMA_CH2DA_8197F */ -+ -+#define BIT_SHIFT_DDMACH2_DA_8197F 0 -+#define BIT_MASK_DDMACH2_DA_8197F 0xffffffffL -+#define BIT_DDMACH2_DA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH2_DA_8197F) << BIT_SHIFT_DDMACH2_DA_8197F) -+#define BITS_DDMACH2_DA_8197F \ -+ (BIT_MASK_DDMACH2_DA_8197F << BIT_SHIFT_DDMACH2_DA_8197F) -+#define BIT_CLEAR_DDMACH2_DA_8197F(x) ((x) & (~BITS_DDMACH2_DA_8197F)) -+#define BIT_GET_DDMACH2_DA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DA_8197F) & BIT_MASK_DDMACH2_DA_8197F) -+#define BIT_SET_DDMACH2_DA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH2_DA_8197F(x) | BIT_DDMACH2_DA_8197F(v)) -+ -+/* 2 REG_DDMA_CH2CTRL_8197F */ -+#define BIT_DDMACH2_OWN_8197F BIT(31) -+#define BIT_DDMACH2_CHKSUM_EN_8197F BIT(29) -+#define BIT_DDMACH2_DA_W_DISABLE_8197F BIT(28) -+#define BIT_DDMACH2_CHKSUM_STS_8197F BIT(27) -+#define BIT_DDMACH2_DDMA_MODE_8197F BIT(26) -+#define BIT_DDMACH2_RESET_CHKSUM_STS_8197F BIT(25) -+#define BIT_DDMACH2_CHKSUM_CONT_8197F BIT(24) -+ -+#define BIT_SHIFT_DDMACH2_DLEN_8197F 0 -+#define BIT_MASK_DDMACH2_DLEN_8197F 0x3ffff -+#define BIT_DDMACH2_DLEN_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH2_DLEN_8197F) << BIT_SHIFT_DDMACH2_DLEN_8197F) -+#define BITS_DDMACH2_DLEN_8197F \ -+ (BIT_MASK_DDMACH2_DLEN_8197F << BIT_SHIFT_DDMACH2_DLEN_8197F) -+#define BIT_CLEAR_DDMACH2_DLEN_8197F(x) ((x) & (~BITS_DDMACH2_DLEN_8197F)) -+#define BIT_GET_DDMACH2_DLEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DLEN_8197F) & BIT_MASK_DDMACH2_DLEN_8197F) -+#define BIT_SET_DDMACH2_DLEN_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH2_DLEN_8197F(x) | BIT_DDMACH2_DLEN_8197F(v)) -+ -+/* 2 REG_DDMA_CH3SA_8197F */ -+ -+#define BIT_SHIFT_DDMACH3_SA_8197F 0 -+#define BIT_MASK_DDMACH3_SA_8197F 0xffffffffL -+#define BIT_DDMACH3_SA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH3_SA_8197F) << BIT_SHIFT_DDMACH3_SA_8197F) -+#define BITS_DDMACH3_SA_8197F \ -+ (BIT_MASK_DDMACH3_SA_8197F << BIT_SHIFT_DDMACH3_SA_8197F) -+#define BIT_CLEAR_DDMACH3_SA_8197F(x) ((x) & (~BITS_DDMACH3_SA_8197F)) -+#define BIT_GET_DDMACH3_SA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_SA_8197F) & BIT_MASK_DDMACH3_SA_8197F) -+#define BIT_SET_DDMACH3_SA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH3_SA_8197F(x) | BIT_DDMACH3_SA_8197F(v)) -+ -+/* 2 REG_DDMA_CH3DA_8197F */ -+ -+#define BIT_SHIFT_DDMACH3_DA_8197F 0 -+#define BIT_MASK_DDMACH3_DA_8197F 0xffffffffL -+#define BIT_DDMACH3_DA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH3_DA_8197F) << BIT_SHIFT_DDMACH3_DA_8197F) -+#define BITS_DDMACH3_DA_8197F \ -+ (BIT_MASK_DDMACH3_DA_8197F << BIT_SHIFT_DDMACH3_DA_8197F) -+#define BIT_CLEAR_DDMACH3_DA_8197F(x) ((x) & (~BITS_DDMACH3_DA_8197F)) -+#define BIT_GET_DDMACH3_DA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DA_8197F) & BIT_MASK_DDMACH3_DA_8197F) -+#define BIT_SET_DDMACH3_DA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH3_DA_8197F(x) | BIT_DDMACH3_DA_8197F(v)) -+ -+/* 2 REG_DDMA_CH3CTRL_8197F */ -+#define BIT_DDMACH3_OWN_8197F BIT(31) -+#define BIT_DDMACH3_CHKSUM_EN_8197F BIT(29) -+#define BIT_DDMACH3_DA_W_DISABLE_8197F BIT(28) -+#define BIT_DDMACH3_CHKSUM_STS_8197F BIT(27) -+#define BIT_DDMACH3_DDMA_MODE_8197F BIT(26) -+#define BIT_DDMACH3_RESET_CHKSUM_STS_8197F BIT(25) -+#define BIT_DDMACH3_CHKSUM_CONT_8197F BIT(24) -+ -+#define BIT_SHIFT_DDMACH3_DLEN_8197F 0 -+#define BIT_MASK_DDMACH3_DLEN_8197F 0x3ffff -+#define BIT_DDMACH3_DLEN_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH3_DLEN_8197F) << BIT_SHIFT_DDMACH3_DLEN_8197F) -+#define BITS_DDMACH3_DLEN_8197F \ -+ (BIT_MASK_DDMACH3_DLEN_8197F << BIT_SHIFT_DDMACH3_DLEN_8197F) -+#define BIT_CLEAR_DDMACH3_DLEN_8197F(x) ((x) & (~BITS_DDMACH3_DLEN_8197F)) -+#define BIT_GET_DDMACH3_DLEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DLEN_8197F) & BIT_MASK_DDMACH3_DLEN_8197F) -+#define BIT_SET_DDMACH3_DLEN_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH3_DLEN_8197F(x) | BIT_DDMACH3_DLEN_8197F(v)) -+ -+/* 2 REG_DDMA_CH4SA_8197F */ -+ -+#define BIT_SHIFT_DDMACH4_SA_8197F 0 -+#define BIT_MASK_DDMACH4_SA_8197F 0xffffffffL -+#define BIT_DDMACH4_SA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH4_SA_8197F) << BIT_SHIFT_DDMACH4_SA_8197F) -+#define BITS_DDMACH4_SA_8197F \ -+ (BIT_MASK_DDMACH4_SA_8197F << BIT_SHIFT_DDMACH4_SA_8197F) -+#define BIT_CLEAR_DDMACH4_SA_8197F(x) ((x) & (~BITS_DDMACH4_SA_8197F)) -+#define BIT_GET_DDMACH4_SA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_SA_8197F) & BIT_MASK_DDMACH4_SA_8197F) -+#define BIT_SET_DDMACH4_SA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH4_SA_8197F(x) | BIT_DDMACH4_SA_8197F(v)) -+ -+/* 2 REG_DDMA_CH4DA_8197F */ -+ -+#define BIT_SHIFT_DDMACH4_DA_8197F 0 -+#define BIT_MASK_DDMACH4_DA_8197F 0xffffffffL -+#define BIT_DDMACH4_DA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH4_DA_8197F) << BIT_SHIFT_DDMACH4_DA_8197F) -+#define BITS_DDMACH4_DA_8197F \ -+ (BIT_MASK_DDMACH4_DA_8197F << BIT_SHIFT_DDMACH4_DA_8197F) -+#define BIT_CLEAR_DDMACH4_DA_8197F(x) ((x) & (~BITS_DDMACH4_DA_8197F)) -+#define BIT_GET_DDMACH4_DA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DA_8197F) & BIT_MASK_DDMACH4_DA_8197F) -+#define BIT_SET_DDMACH4_DA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH4_DA_8197F(x) | BIT_DDMACH4_DA_8197F(v)) -+ -+/* 2 REG_DDMA_CH4CTRL_8197F */ -+#define BIT_DDMACH4_OWN_8197F BIT(31) -+#define BIT_DDMACH4_CHKSUM_EN_8197F BIT(29) -+#define BIT_DDMACH4_DA_W_DISABLE_8197F BIT(28) -+#define BIT_DDMACH4_CHKSUM_STS_8197F BIT(27) -+#define BIT_DDMACH4_DDMA_MODE_8197F BIT(26) -+#define BIT_DDMACH4_RESET_CHKSUM_STS_8197F BIT(25) -+#define BIT_DDMACH4_CHKSUM_CONT_8197F BIT(24) -+ -+#define BIT_SHIFT_DDMACH4_DLEN_8197F 0 -+#define BIT_MASK_DDMACH4_DLEN_8197F 0x3ffff -+#define BIT_DDMACH4_DLEN_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH4_DLEN_8197F) << BIT_SHIFT_DDMACH4_DLEN_8197F) -+#define BITS_DDMACH4_DLEN_8197F \ -+ (BIT_MASK_DDMACH4_DLEN_8197F << BIT_SHIFT_DDMACH4_DLEN_8197F) -+#define BIT_CLEAR_DDMACH4_DLEN_8197F(x) ((x) & (~BITS_DDMACH4_DLEN_8197F)) -+#define BIT_GET_DDMACH4_DLEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DLEN_8197F) & BIT_MASK_DDMACH4_DLEN_8197F) -+#define BIT_SET_DDMACH4_DLEN_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH4_DLEN_8197F(x) | BIT_DDMACH4_DLEN_8197F(v)) -+ -+/* 2 REG_DDMA_CH5SA_8197F */ -+ -+#define BIT_SHIFT_DDMACH5_SA_8197F 0 -+#define BIT_MASK_DDMACH5_SA_8197F 0xffffffffL -+#define BIT_DDMACH5_SA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH5_SA_8197F) << BIT_SHIFT_DDMACH5_SA_8197F) -+#define BITS_DDMACH5_SA_8197F \ -+ (BIT_MASK_DDMACH5_SA_8197F << BIT_SHIFT_DDMACH5_SA_8197F) -+#define BIT_CLEAR_DDMACH5_SA_8197F(x) ((x) & (~BITS_DDMACH5_SA_8197F)) -+#define BIT_GET_DDMACH5_SA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_SA_8197F) & BIT_MASK_DDMACH5_SA_8197F) -+#define BIT_SET_DDMACH5_SA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH5_SA_8197F(x) | BIT_DDMACH5_SA_8197F(v)) -+ -+/* 2 REG_DDMA_CH5DA_8197F */ -+ -+#define BIT_SHIFT_DDMACH5_DA_8197F 0 -+#define BIT_MASK_DDMACH5_DA_8197F 0xffffffffL -+#define BIT_DDMACH5_DA_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH5_DA_8197F) << BIT_SHIFT_DDMACH5_DA_8197F) -+#define BITS_DDMACH5_DA_8197F \ -+ (BIT_MASK_DDMACH5_DA_8197F << BIT_SHIFT_DDMACH5_DA_8197F) -+#define BIT_CLEAR_DDMACH5_DA_8197F(x) ((x) & (~BITS_DDMACH5_DA_8197F)) -+#define BIT_GET_DDMACH5_DA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DA_8197F) & BIT_MASK_DDMACH5_DA_8197F) -+#define BIT_SET_DDMACH5_DA_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH5_DA_8197F(x) | BIT_DDMACH5_DA_8197F(v)) -+ -+/* 2 REG_REG_DDMA_CH5CTRL_8197F */ -+#define BIT_DDMACH5_OWN_8197F BIT(31) -+#define BIT_DDMACH5_CHKSUM_EN_8197F BIT(29) -+#define BIT_DDMACH5_DA_W_DISABLE_8197F BIT(28) -+#define BIT_DDMACH5_CHKSUM_STS_8197F BIT(27) -+#define BIT_DDMACH5_DDMA_MODE_8197F BIT(26) -+#define BIT_DDMACH5_RESET_CHKSUM_STS_8197F BIT(25) -+#define BIT_DDMACH5_CHKSUM_CONT_8197F BIT(24) -+ -+#define BIT_SHIFT_DDMACH5_DLEN_8197F 0 -+#define BIT_MASK_DDMACH5_DLEN_8197F 0x3ffff -+#define BIT_DDMACH5_DLEN_8197F(x) \ -+ (((x) & BIT_MASK_DDMACH5_DLEN_8197F) << BIT_SHIFT_DDMACH5_DLEN_8197F) -+#define BITS_DDMACH5_DLEN_8197F \ -+ (BIT_MASK_DDMACH5_DLEN_8197F << BIT_SHIFT_DDMACH5_DLEN_8197F) -+#define BIT_CLEAR_DDMACH5_DLEN_8197F(x) ((x) & (~BITS_DDMACH5_DLEN_8197F)) -+#define BIT_GET_DDMACH5_DLEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DLEN_8197F) & BIT_MASK_DDMACH5_DLEN_8197F) -+#define BIT_SET_DDMACH5_DLEN_8197F(x, v) \ -+ (BIT_CLEAR_DDMACH5_DLEN_8197F(x) | BIT_DDMACH5_DLEN_8197F(v)) -+ -+/* 2 REG_DDMA_INT_MSK_8197F */ -+#define BIT_DDMACH5_MSK_8197F BIT(5) -+#define BIT_DDMACH4_MSK_8197F BIT(4) -+#define BIT_DDMACH3_MSK_8197F BIT(3) -+#define BIT_DDMACH2_MSK_8197F BIT(2) -+#define BIT_DDMACH1_MSK_8197F BIT(1) -+#define BIT_DDMACH0_MSK_8197F BIT(0) -+ -+/* 2 REG_DDMA_CHSTATUS_8197F */ -+#define BIT_DDMACH5_BUSY_8197F BIT(5) -+#define BIT_DDMACH4_BUSY_8197F BIT(4) -+#define BIT_DDMACH3_BUSY_8197F BIT(3) -+#define BIT_DDMACH2_BUSY_8197F BIT(2) -+#define BIT_DDMACH1_BUSY_8197F BIT(1) -+#define BIT_DDMACH0_BUSY_8197F BIT(0) -+ -+/* 2 REG_DDMA_CHKSUM_8197F */ -+ -+#define BIT_SHIFT_IDDMA0_CHKSUM_8197F 0 -+#define BIT_MASK_IDDMA0_CHKSUM_8197F 0xffff -+#define BIT_IDDMA0_CHKSUM_8197F(x) \ -+ (((x) & BIT_MASK_IDDMA0_CHKSUM_8197F) << BIT_SHIFT_IDDMA0_CHKSUM_8197F) -+#define BITS_IDDMA0_CHKSUM_8197F \ -+ (BIT_MASK_IDDMA0_CHKSUM_8197F << BIT_SHIFT_IDDMA0_CHKSUM_8197F) -+#define BIT_CLEAR_IDDMA0_CHKSUM_8197F(x) ((x) & (~BITS_IDDMA0_CHKSUM_8197F)) -+#define BIT_GET_IDDMA0_CHKSUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_IDDMA0_CHKSUM_8197F) & BIT_MASK_IDDMA0_CHKSUM_8197F) -+#define BIT_SET_IDDMA0_CHKSUM_8197F(x, v) \ -+ (BIT_CLEAR_IDDMA0_CHKSUM_8197F(x) | BIT_IDDMA0_CHKSUM_8197F(v)) -+ -+/* 2 REG_DDMA_MONITOR_8197F */ -+#define BIT_IDDMA0_PERMU_UNDERFLOW_8197F BIT(14) -+#define BIT_IDDMA0_FIFO_UNDERFLOW_8197F BIT(13) -+#define BIT_IDDMA0_FIFO_OVERFLOW_8197F BIT(12) -+#define BIT_CH5_ERR_8197F BIT(5) -+#define BIT_CH4_ERR_8197F BIT(4) -+#define BIT_CH3_ERR_8197F BIT(3) -+#define BIT_CH2_ERR_8197F BIT(2) -+#define BIT_CH1_ERR_8197F BIT(1) -+#define BIT_CH0_ERR_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_HCI_CTRL_8197F */ -+#define BIT_HCIIO_PERSTB_SEL_8197F BIT(31) -+ -+#define BIT_SHIFT_HCI_MAX_RXDMA_8197F 28 -+#define BIT_MASK_HCI_MAX_RXDMA_8197F 0x7 -+#define BIT_HCI_MAX_RXDMA_8197F(x) \ -+ (((x) & BIT_MASK_HCI_MAX_RXDMA_8197F) << BIT_SHIFT_HCI_MAX_RXDMA_8197F) -+#define BITS_HCI_MAX_RXDMA_8197F \ -+ (BIT_MASK_HCI_MAX_RXDMA_8197F << BIT_SHIFT_HCI_MAX_RXDMA_8197F) -+#define BIT_CLEAR_HCI_MAX_RXDMA_8197F(x) ((x) & (~BITS_HCI_MAX_RXDMA_8197F)) -+#define BIT_GET_HCI_MAX_RXDMA_8197F(x) \ -+ (((x) >> BIT_SHIFT_HCI_MAX_RXDMA_8197F) & BIT_MASK_HCI_MAX_RXDMA_8197F) -+#define BIT_SET_HCI_MAX_RXDMA_8197F(x, v) \ -+ (BIT_CLEAR_HCI_MAX_RXDMA_8197F(x) | BIT_HCI_MAX_RXDMA_8197F(v)) -+ -+#define BIT_MULRW_8197F BIT(27) -+ -+#define BIT_SHIFT_HCI_MAX_TXDMA_8197F 24 -+#define BIT_MASK_HCI_MAX_TXDMA_8197F 0x7 -+#define BIT_HCI_MAX_TXDMA_8197F(x) \ -+ (((x) & BIT_MASK_HCI_MAX_TXDMA_8197F) << BIT_SHIFT_HCI_MAX_TXDMA_8197F) -+#define BITS_HCI_MAX_TXDMA_8197F \ -+ (BIT_MASK_HCI_MAX_TXDMA_8197F << BIT_SHIFT_HCI_MAX_TXDMA_8197F) -+#define BIT_CLEAR_HCI_MAX_TXDMA_8197F(x) ((x) & (~BITS_HCI_MAX_TXDMA_8197F)) -+#define BIT_GET_HCI_MAX_TXDMA_8197F(x) \ -+ (((x) >> BIT_SHIFT_HCI_MAX_TXDMA_8197F) & BIT_MASK_HCI_MAX_TXDMA_8197F) -+#define BIT_SET_HCI_MAX_TXDMA_8197F(x, v) \ -+ (BIT_CLEAR_HCI_MAX_TXDMA_8197F(x) | BIT_HCI_MAX_TXDMA_8197F(v)) -+ -+#define BIT_EN_CPL_TIMEOUT_PS_8197F BIT(22) -+#define BIT_REG_TXDMA_FAIL_PS_8197F BIT(21) -+#define BIT_HCI_RST_TRXDMA_INTF_8197F BIT(20) -+#define BIT_EN_HWENTR_L1_8197F BIT(19) -+#define BIT_EN_ADV_CLKGATE_8197F BIT(18) -+#define BIT_HCI_EN_SWENT_L23_8197F BIT(17) -+#define BIT_HCI_EN_HWEXT_L1_8197F BIT(16) -+#define BIT_RX_CLOSE_EN_8197F BIT(15) -+#define BIT_STOP_BCNQ_8197F BIT(14) -+#define BIT_STOP_MGQ_8197F BIT(13) -+#define BIT_STOP_VOQ_8197F BIT(12) -+#define BIT_STOP_VIQ_8197F BIT(11) -+#define BIT_STOP_BEQ_8197F BIT(10) -+#define BIT_STOP_BKQ_8197F BIT(9) -+#define BIT_STOP_RXQ_8197F BIT(8) -+#define BIT_STOP_HI7Q_8197F BIT(7) -+#define BIT_STOP_HI6Q_8197F BIT(6) -+#define BIT_STOP_HI5Q_8197F BIT(5) -+#define BIT_STOP_HI4Q_8197F BIT(4) -+#define BIT_STOP_HI3Q_8197F BIT(3) -+#define BIT_STOP_HI2Q_8197F BIT(2) -+#define BIT_STOP_HI1Q_8197F BIT(1) -+#define BIT_STOP_HI0Q_8197F BIT(0) -+ -+/* 2 REG_INT_MIG_8197F */ -+ -+#define BIT_SHIFT_TXTTIMER_MATCH_NUM_8197F 28 -+#define BIT_MASK_TXTTIMER_MATCH_NUM_8197F 0xf -+#define BIT_TXTTIMER_MATCH_NUM_8197F(x) \ -+ (((x) & BIT_MASK_TXTTIMER_MATCH_NUM_8197F) \ -+ << BIT_SHIFT_TXTTIMER_MATCH_NUM_8197F) -+#define BITS_TXTTIMER_MATCH_NUM_8197F \ -+ (BIT_MASK_TXTTIMER_MATCH_NUM_8197F \ -+ << BIT_SHIFT_TXTTIMER_MATCH_NUM_8197F) -+#define BIT_CLEAR_TXTTIMER_MATCH_NUM_8197F(x) \ -+ ((x) & (~BITS_TXTTIMER_MATCH_NUM_8197F)) -+#define BIT_GET_TXTTIMER_MATCH_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXTTIMER_MATCH_NUM_8197F) & \ -+ BIT_MASK_TXTTIMER_MATCH_NUM_8197F) -+#define BIT_SET_TXTTIMER_MATCH_NUM_8197F(x, v) \ -+ (BIT_CLEAR_TXTTIMER_MATCH_NUM_8197F(x) | \ -+ BIT_TXTTIMER_MATCH_NUM_8197F(v)) -+ -+#define BIT_SHIFT_TXPKT_NUM_MATCH_8197F 24 -+#define BIT_MASK_TXPKT_NUM_MATCH_8197F 0xf -+#define BIT_TXPKT_NUM_MATCH_8197F(x) \ -+ (((x) & BIT_MASK_TXPKT_NUM_MATCH_8197F) \ -+ << BIT_SHIFT_TXPKT_NUM_MATCH_8197F) -+#define BITS_TXPKT_NUM_MATCH_8197F \ -+ (BIT_MASK_TXPKT_NUM_MATCH_8197F << BIT_SHIFT_TXPKT_NUM_MATCH_8197F) -+#define BIT_CLEAR_TXPKT_NUM_MATCH_8197F(x) ((x) & (~BITS_TXPKT_NUM_MATCH_8197F)) -+#define BIT_GET_TXPKT_NUM_MATCH_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXPKT_NUM_MATCH_8197F) & \ -+ BIT_MASK_TXPKT_NUM_MATCH_8197F) -+#define BIT_SET_TXPKT_NUM_MATCH_8197F(x, v) \ -+ (BIT_CLEAR_TXPKT_NUM_MATCH_8197F(x) | BIT_TXPKT_NUM_MATCH_8197F(v)) -+ -+#define BIT_SHIFT_RXTTIMER_MATCH_NUM_8197F 20 -+#define BIT_MASK_RXTTIMER_MATCH_NUM_8197F 0xf -+#define BIT_RXTTIMER_MATCH_NUM_8197F(x) \ -+ (((x) & BIT_MASK_RXTTIMER_MATCH_NUM_8197F) \ -+ << BIT_SHIFT_RXTTIMER_MATCH_NUM_8197F) -+#define BITS_RXTTIMER_MATCH_NUM_8197F \ -+ (BIT_MASK_RXTTIMER_MATCH_NUM_8197F \ -+ << BIT_SHIFT_RXTTIMER_MATCH_NUM_8197F) -+#define BIT_CLEAR_RXTTIMER_MATCH_NUM_8197F(x) \ -+ ((x) & (~BITS_RXTTIMER_MATCH_NUM_8197F)) -+#define BIT_GET_RXTTIMER_MATCH_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXTTIMER_MATCH_NUM_8197F) & \ -+ BIT_MASK_RXTTIMER_MATCH_NUM_8197F) -+#define BIT_SET_RXTTIMER_MATCH_NUM_8197F(x, v) \ -+ (BIT_CLEAR_RXTTIMER_MATCH_NUM_8197F(x) | \ -+ BIT_RXTTIMER_MATCH_NUM_8197F(v)) -+ -+#define BIT_SHIFT_RXPKT_NUM_MATCH_8197F 16 -+#define BIT_MASK_RXPKT_NUM_MATCH_8197F 0xf -+#define BIT_RXPKT_NUM_MATCH_8197F(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_MATCH_8197F) \ -+ << BIT_SHIFT_RXPKT_NUM_MATCH_8197F) -+#define BITS_RXPKT_NUM_MATCH_8197F \ -+ (BIT_MASK_RXPKT_NUM_MATCH_8197F << BIT_SHIFT_RXPKT_NUM_MATCH_8197F) -+#define BIT_CLEAR_RXPKT_NUM_MATCH_8197F(x) ((x) & (~BITS_RXPKT_NUM_MATCH_8197F)) -+#define BIT_GET_RXPKT_NUM_MATCH_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_MATCH_8197F) & \ -+ BIT_MASK_RXPKT_NUM_MATCH_8197F) -+#define BIT_SET_RXPKT_NUM_MATCH_8197F(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_MATCH_8197F(x) | BIT_RXPKT_NUM_MATCH_8197F(v)) -+ -+#define BIT_SHIFT_MIGRATE_TIMER_8197F 0 -+#define BIT_MASK_MIGRATE_TIMER_8197F 0xffff -+#define BIT_MIGRATE_TIMER_8197F(x) \ -+ (((x) & BIT_MASK_MIGRATE_TIMER_8197F) << BIT_SHIFT_MIGRATE_TIMER_8197F) -+#define BITS_MIGRATE_TIMER_8197F \ -+ (BIT_MASK_MIGRATE_TIMER_8197F << BIT_SHIFT_MIGRATE_TIMER_8197F) -+#define BIT_CLEAR_MIGRATE_TIMER_8197F(x) ((x) & (~BITS_MIGRATE_TIMER_8197F)) -+#define BIT_GET_MIGRATE_TIMER_8197F(x) \ -+ (((x) >> BIT_SHIFT_MIGRATE_TIMER_8197F) & BIT_MASK_MIGRATE_TIMER_8197F) -+#define BIT_SET_MIGRATE_TIMER_8197F(x, v) \ -+ (BIT_CLEAR_MIGRATE_TIMER_8197F(x) | BIT_MIGRATE_TIMER_8197F(v)) -+ -+/* 2 REG_BCNQ_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_BCNQ_TXBD_DESA_8197F 0 -+#define BIT_MASK_BCNQ_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_BCNQ_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_BCNQ_TXBD_DESA_8197F) \ -+ << BIT_SHIFT_BCNQ_TXBD_DESA_8197F) -+#define BITS_BCNQ_TXBD_DESA_8197F \ -+ (BIT_MASK_BCNQ_TXBD_DESA_8197F << BIT_SHIFT_BCNQ_TXBD_DESA_8197F) -+#define BIT_CLEAR_BCNQ_TXBD_DESA_8197F(x) ((x) & (~BITS_BCNQ_TXBD_DESA_8197F)) -+#define BIT_GET_BCNQ_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_TXBD_DESA_8197F) & \ -+ BIT_MASK_BCNQ_TXBD_DESA_8197F) -+#define BIT_SET_BCNQ_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_BCNQ_TXBD_DESA_8197F(x) | BIT_BCNQ_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_MGQ_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_MGQ_TXBD_DESA_8197F 0 -+#define BIT_MASK_MGQ_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_MGQ_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_MGQ_TXBD_DESA_8197F) << BIT_SHIFT_MGQ_TXBD_DESA_8197F) -+#define BITS_MGQ_TXBD_DESA_8197F \ -+ (BIT_MASK_MGQ_TXBD_DESA_8197F << BIT_SHIFT_MGQ_TXBD_DESA_8197F) -+#define BIT_CLEAR_MGQ_TXBD_DESA_8197F(x) ((x) & (~BITS_MGQ_TXBD_DESA_8197F)) -+#define BIT_GET_MGQ_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_TXBD_DESA_8197F) & BIT_MASK_MGQ_TXBD_DESA_8197F) -+#define BIT_SET_MGQ_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_MGQ_TXBD_DESA_8197F(x) | BIT_MGQ_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_VOQ_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_VOQ_TXBD_DESA_8197F 0 -+#define BIT_MASK_VOQ_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_VOQ_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_VOQ_TXBD_DESA_8197F) << BIT_SHIFT_VOQ_TXBD_DESA_8197F) -+#define BITS_VOQ_TXBD_DESA_8197F \ -+ (BIT_MASK_VOQ_TXBD_DESA_8197F << BIT_SHIFT_VOQ_TXBD_DESA_8197F) -+#define BIT_CLEAR_VOQ_TXBD_DESA_8197F(x) ((x) & (~BITS_VOQ_TXBD_DESA_8197F)) -+#define BIT_GET_VOQ_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_VOQ_TXBD_DESA_8197F) & BIT_MASK_VOQ_TXBD_DESA_8197F) -+#define BIT_SET_VOQ_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_VOQ_TXBD_DESA_8197F(x) | BIT_VOQ_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_VIQ_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_VIQ_TXBD_DESA_8197F 0 -+#define BIT_MASK_VIQ_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_VIQ_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_VIQ_TXBD_DESA_8197F) << BIT_SHIFT_VIQ_TXBD_DESA_8197F) -+#define BITS_VIQ_TXBD_DESA_8197F \ -+ (BIT_MASK_VIQ_TXBD_DESA_8197F << BIT_SHIFT_VIQ_TXBD_DESA_8197F) -+#define BIT_CLEAR_VIQ_TXBD_DESA_8197F(x) ((x) & (~BITS_VIQ_TXBD_DESA_8197F)) -+#define BIT_GET_VIQ_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_VIQ_TXBD_DESA_8197F) & BIT_MASK_VIQ_TXBD_DESA_8197F) -+#define BIT_SET_VIQ_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_VIQ_TXBD_DESA_8197F(x) | BIT_VIQ_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_BEQ_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_BEQ_TXBD_DESA_8197F 0 -+#define BIT_MASK_BEQ_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_BEQ_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_BEQ_TXBD_DESA_8197F) << BIT_SHIFT_BEQ_TXBD_DESA_8197F) -+#define BITS_BEQ_TXBD_DESA_8197F \ -+ (BIT_MASK_BEQ_TXBD_DESA_8197F << BIT_SHIFT_BEQ_TXBD_DESA_8197F) -+#define BIT_CLEAR_BEQ_TXBD_DESA_8197F(x) ((x) & (~BITS_BEQ_TXBD_DESA_8197F)) -+#define BIT_GET_BEQ_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_BEQ_TXBD_DESA_8197F) & BIT_MASK_BEQ_TXBD_DESA_8197F) -+#define BIT_SET_BEQ_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_BEQ_TXBD_DESA_8197F(x) | BIT_BEQ_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_BKQ_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_BKQ_TXBD_DESA_8197F 0 -+#define BIT_MASK_BKQ_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_BKQ_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_BKQ_TXBD_DESA_8197F) << BIT_SHIFT_BKQ_TXBD_DESA_8197F) -+#define BITS_BKQ_TXBD_DESA_8197F \ -+ (BIT_MASK_BKQ_TXBD_DESA_8197F << BIT_SHIFT_BKQ_TXBD_DESA_8197F) -+#define BIT_CLEAR_BKQ_TXBD_DESA_8197F(x) ((x) & (~BITS_BKQ_TXBD_DESA_8197F)) -+#define BIT_GET_BKQ_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_BKQ_TXBD_DESA_8197F) & BIT_MASK_BKQ_TXBD_DESA_8197F) -+#define BIT_SET_BKQ_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_BKQ_TXBD_DESA_8197F(x) | BIT_BKQ_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_RXQ_RXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_RXQ_RXBD_DESA_8197F 0 -+#define BIT_MASK_RXQ_RXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_RXQ_RXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_RXQ_RXBD_DESA_8197F) << BIT_SHIFT_RXQ_RXBD_DESA_8197F) -+#define BITS_RXQ_RXBD_DESA_8197F \ -+ (BIT_MASK_RXQ_RXBD_DESA_8197F << BIT_SHIFT_RXQ_RXBD_DESA_8197F) -+#define BIT_CLEAR_RXQ_RXBD_DESA_8197F(x) ((x) & (~BITS_RXQ_RXBD_DESA_8197F)) -+#define BIT_GET_RXQ_RXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXQ_RXBD_DESA_8197F) & BIT_MASK_RXQ_RXBD_DESA_8197F) -+#define BIT_SET_RXQ_RXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_RXQ_RXBD_DESA_8197F(x) | BIT_RXQ_RXBD_DESA_8197F(v)) -+ -+/* 2 REG_HI0Q_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_HI0Q_TXBD_DESA_8197F 0 -+#define BIT_MASK_HI0Q_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_HI0Q_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_HI0Q_TXBD_DESA_8197F) \ -+ << BIT_SHIFT_HI0Q_TXBD_DESA_8197F) -+#define BITS_HI0Q_TXBD_DESA_8197F \ -+ (BIT_MASK_HI0Q_TXBD_DESA_8197F << BIT_SHIFT_HI0Q_TXBD_DESA_8197F) -+#define BIT_CLEAR_HI0Q_TXBD_DESA_8197F(x) ((x) & (~BITS_HI0Q_TXBD_DESA_8197F)) -+#define BIT_GET_HI0Q_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_TXBD_DESA_8197F) & \ -+ BIT_MASK_HI0Q_TXBD_DESA_8197F) -+#define BIT_SET_HI0Q_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_HI0Q_TXBD_DESA_8197F(x) | BIT_HI0Q_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_HI1Q_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_HI1Q_TXBD_DESA_8197F 0 -+#define BIT_MASK_HI1Q_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_HI1Q_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_HI1Q_TXBD_DESA_8197F) \ -+ << BIT_SHIFT_HI1Q_TXBD_DESA_8197F) -+#define BITS_HI1Q_TXBD_DESA_8197F \ -+ (BIT_MASK_HI1Q_TXBD_DESA_8197F << BIT_SHIFT_HI1Q_TXBD_DESA_8197F) -+#define BIT_CLEAR_HI1Q_TXBD_DESA_8197F(x) ((x) & (~BITS_HI1Q_TXBD_DESA_8197F)) -+#define BIT_GET_HI1Q_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_TXBD_DESA_8197F) & \ -+ BIT_MASK_HI1Q_TXBD_DESA_8197F) -+#define BIT_SET_HI1Q_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_HI1Q_TXBD_DESA_8197F(x) | BIT_HI1Q_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_HI2Q_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_HI2Q_TXBD_DESA_8197F 0 -+#define BIT_MASK_HI2Q_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_HI2Q_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_HI2Q_TXBD_DESA_8197F) \ -+ << BIT_SHIFT_HI2Q_TXBD_DESA_8197F) -+#define BITS_HI2Q_TXBD_DESA_8197F \ -+ (BIT_MASK_HI2Q_TXBD_DESA_8197F << BIT_SHIFT_HI2Q_TXBD_DESA_8197F) -+#define BIT_CLEAR_HI2Q_TXBD_DESA_8197F(x) ((x) & (~BITS_HI2Q_TXBD_DESA_8197F)) -+#define BIT_GET_HI2Q_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_TXBD_DESA_8197F) & \ -+ BIT_MASK_HI2Q_TXBD_DESA_8197F) -+#define BIT_SET_HI2Q_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_HI2Q_TXBD_DESA_8197F(x) | BIT_HI2Q_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_HI3Q_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_HI3Q_TXBD_DESA_8197F 0 -+#define BIT_MASK_HI3Q_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_HI3Q_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_HI3Q_TXBD_DESA_8197F) \ -+ << BIT_SHIFT_HI3Q_TXBD_DESA_8197F) -+#define BITS_HI3Q_TXBD_DESA_8197F \ -+ (BIT_MASK_HI3Q_TXBD_DESA_8197F << BIT_SHIFT_HI3Q_TXBD_DESA_8197F) -+#define BIT_CLEAR_HI3Q_TXBD_DESA_8197F(x) ((x) & (~BITS_HI3Q_TXBD_DESA_8197F)) -+#define BIT_GET_HI3Q_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_TXBD_DESA_8197F) & \ -+ BIT_MASK_HI3Q_TXBD_DESA_8197F) -+#define BIT_SET_HI3Q_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_HI3Q_TXBD_DESA_8197F(x) | BIT_HI3Q_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_HI4Q_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_HI4Q_TXBD_DESA_8197F 0 -+#define BIT_MASK_HI4Q_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_HI4Q_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_HI4Q_TXBD_DESA_8197F) \ -+ << BIT_SHIFT_HI4Q_TXBD_DESA_8197F) -+#define BITS_HI4Q_TXBD_DESA_8197F \ -+ (BIT_MASK_HI4Q_TXBD_DESA_8197F << BIT_SHIFT_HI4Q_TXBD_DESA_8197F) -+#define BIT_CLEAR_HI4Q_TXBD_DESA_8197F(x) ((x) & (~BITS_HI4Q_TXBD_DESA_8197F)) -+#define BIT_GET_HI4Q_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_TXBD_DESA_8197F) & \ -+ BIT_MASK_HI4Q_TXBD_DESA_8197F) -+#define BIT_SET_HI4Q_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_HI4Q_TXBD_DESA_8197F(x) | BIT_HI4Q_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_HI5Q_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_HI5Q_TXBD_DESA_8197F 0 -+#define BIT_MASK_HI5Q_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_HI5Q_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_HI5Q_TXBD_DESA_8197F) \ -+ << BIT_SHIFT_HI5Q_TXBD_DESA_8197F) -+#define BITS_HI5Q_TXBD_DESA_8197F \ -+ (BIT_MASK_HI5Q_TXBD_DESA_8197F << BIT_SHIFT_HI5Q_TXBD_DESA_8197F) -+#define BIT_CLEAR_HI5Q_TXBD_DESA_8197F(x) ((x) & (~BITS_HI5Q_TXBD_DESA_8197F)) -+#define BIT_GET_HI5Q_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_TXBD_DESA_8197F) & \ -+ BIT_MASK_HI5Q_TXBD_DESA_8197F) -+#define BIT_SET_HI5Q_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_HI5Q_TXBD_DESA_8197F(x) | BIT_HI5Q_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_HI6Q_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_HI6Q_TXBD_DESA_8197F 0 -+#define BIT_MASK_HI6Q_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_HI6Q_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_HI6Q_TXBD_DESA_8197F) \ -+ << BIT_SHIFT_HI6Q_TXBD_DESA_8197F) -+#define BITS_HI6Q_TXBD_DESA_8197F \ -+ (BIT_MASK_HI6Q_TXBD_DESA_8197F << BIT_SHIFT_HI6Q_TXBD_DESA_8197F) -+#define BIT_CLEAR_HI6Q_TXBD_DESA_8197F(x) ((x) & (~BITS_HI6Q_TXBD_DESA_8197F)) -+#define BIT_GET_HI6Q_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_TXBD_DESA_8197F) & \ -+ BIT_MASK_HI6Q_TXBD_DESA_8197F) -+#define BIT_SET_HI6Q_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_HI6Q_TXBD_DESA_8197F(x) | BIT_HI6Q_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_HI7Q_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_HI7Q_TXBD_DESA_8197F 0 -+#define BIT_MASK_HI7Q_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_HI7Q_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_HI7Q_TXBD_DESA_8197F) \ -+ << BIT_SHIFT_HI7Q_TXBD_DESA_8197F) -+#define BITS_HI7Q_TXBD_DESA_8197F \ -+ (BIT_MASK_HI7Q_TXBD_DESA_8197F << BIT_SHIFT_HI7Q_TXBD_DESA_8197F) -+#define BIT_CLEAR_HI7Q_TXBD_DESA_8197F(x) ((x) & (~BITS_HI7Q_TXBD_DESA_8197F)) -+#define BIT_GET_HI7Q_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_TXBD_DESA_8197F) & \ -+ BIT_MASK_HI7Q_TXBD_DESA_8197F) -+#define BIT_SET_HI7Q_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_HI7Q_TXBD_DESA_8197F(x) | BIT_HI7Q_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_MGQ_TXBD_NUM_8197F */ -+#define BIT_HCI_MGQ_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_MGQ_DESC_MODE_8197F 12 -+#define BIT_MASK_MGQ_DESC_MODE_8197F 0x3 -+#define BIT_MGQ_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_MODE_8197F) << BIT_SHIFT_MGQ_DESC_MODE_8197F) -+#define BITS_MGQ_DESC_MODE_8197F \ -+ (BIT_MASK_MGQ_DESC_MODE_8197F << BIT_SHIFT_MGQ_DESC_MODE_8197F) -+#define BIT_CLEAR_MGQ_DESC_MODE_8197F(x) ((x) & (~BITS_MGQ_DESC_MODE_8197F)) -+#define BIT_GET_MGQ_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_MODE_8197F) & BIT_MASK_MGQ_DESC_MODE_8197F) -+#define BIT_SET_MGQ_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_MODE_8197F(x) | BIT_MGQ_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_MGQ_DESC_NUM_8197F 0 -+#define BIT_MASK_MGQ_DESC_NUM_8197F 0xfff -+#define BIT_MGQ_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_NUM_8197F) << BIT_SHIFT_MGQ_DESC_NUM_8197F) -+#define BITS_MGQ_DESC_NUM_8197F \ -+ (BIT_MASK_MGQ_DESC_NUM_8197F << BIT_SHIFT_MGQ_DESC_NUM_8197F) -+#define BIT_CLEAR_MGQ_DESC_NUM_8197F(x) ((x) & (~BITS_MGQ_DESC_NUM_8197F)) -+#define BIT_GET_MGQ_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_NUM_8197F) & BIT_MASK_MGQ_DESC_NUM_8197F) -+#define BIT_SET_MGQ_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_NUM_8197F(x) | BIT_MGQ_DESC_NUM_8197F(v)) -+ -+/* 2 REG_RX_RXBD_NUM_8197F */ -+#define BIT_SYS_32_64_8197F BIT(15) -+ -+#define BIT_SHIFT_BCNQ_DESC_MODE_8197F 13 -+#define BIT_MASK_BCNQ_DESC_MODE_8197F 0x3 -+#define BIT_BCNQ_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_BCNQ_DESC_MODE_8197F) \ -+ << BIT_SHIFT_BCNQ_DESC_MODE_8197F) -+#define BITS_BCNQ_DESC_MODE_8197F \ -+ (BIT_MASK_BCNQ_DESC_MODE_8197F << BIT_SHIFT_BCNQ_DESC_MODE_8197F) -+#define BIT_CLEAR_BCNQ_DESC_MODE_8197F(x) ((x) & (~BITS_BCNQ_DESC_MODE_8197F)) -+#define BIT_GET_BCNQ_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_DESC_MODE_8197F) & \ -+ BIT_MASK_BCNQ_DESC_MODE_8197F) -+#define BIT_SET_BCNQ_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_BCNQ_DESC_MODE_8197F(x) | BIT_BCNQ_DESC_MODE_8197F(v)) -+ -+#define BIT_HCI_BCNQ_FLAG_8197F BIT(12) -+ -+#define BIT_SHIFT_RXQ_DESC_NUM_8197F 0 -+#define BIT_MASK_RXQ_DESC_NUM_8197F 0xfff -+#define BIT_RXQ_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_RXQ_DESC_NUM_8197F) << BIT_SHIFT_RXQ_DESC_NUM_8197F) -+#define BITS_RXQ_DESC_NUM_8197F \ -+ (BIT_MASK_RXQ_DESC_NUM_8197F << BIT_SHIFT_RXQ_DESC_NUM_8197F) -+#define BIT_CLEAR_RXQ_DESC_NUM_8197F(x) ((x) & (~BITS_RXQ_DESC_NUM_8197F)) -+#define BIT_GET_RXQ_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXQ_DESC_NUM_8197F) & BIT_MASK_RXQ_DESC_NUM_8197F) -+#define BIT_SET_RXQ_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_RXQ_DESC_NUM_8197F(x) | BIT_RXQ_DESC_NUM_8197F(v)) -+ -+/* 2 REG_VOQ_TXBD_NUM_8197F */ -+#define BIT_HCI_VOQ_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_VOQ_DESC_MODE_8197F 12 -+#define BIT_MASK_VOQ_DESC_MODE_8197F 0x3 -+#define BIT_VOQ_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_MODE_8197F) << BIT_SHIFT_VOQ_DESC_MODE_8197F) -+#define BITS_VOQ_DESC_MODE_8197F \ -+ (BIT_MASK_VOQ_DESC_MODE_8197F << BIT_SHIFT_VOQ_DESC_MODE_8197F) -+#define BIT_CLEAR_VOQ_DESC_MODE_8197F(x) ((x) & (~BITS_VOQ_DESC_MODE_8197F)) -+#define BIT_GET_VOQ_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_MODE_8197F) & BIT_MASK_VOQ_DESC_MODE_8197F) -+#define BIT_SET_VOQ_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_MODE_8197F(x) | BIT_VOQ_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_VOQ_DESC_NUM_8197F 0 -+#define BIT_MASK_VOQ_DESC_NUM_8197F 0xfff -+#define BIT_VOQ_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_NUM_8197F) << BIT_SHIFT_VOQ_DESC_NUM_8197F) -+#define BITS_VOQ_DESC_NUM_8197F \ -+ (BIT_MASK_VOQ_DESC_NUM_8197F << BIT_SHIFT_VOQ_DESC_NUM_8197F) -+#define BIT_CLEAR_VOQ_DESC_NUM_8197F(x) ((x) & (~BITS_VOQ_DESC_NUM_8197F)) -+#define BIT_GET_VOQ_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_NUM_8197F) & BIT_MASK_VOQ_DESC_NUM_8197F) -+#define BIT_SET_VOQ_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_NUM_8197F(x) | BIT_VOQ_DESC_NUM_8197F(v)) -+ -+/* 2 REG_VIQ_TXBD_NUM_8197F */ -+#define BIT_HCI_VIQ_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_VIQ_DESC_MODE_8197F 12 -+#define BIT_MASK_VIQ_DESC_MODE_8197F 0x3 -+#define BIT_VIQ_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_MODE_8197F) << BIT_SHIFT_VIQ_DESC_MODE_8197F) -+#define BITS_VIQ_DESC_MODE_8197F \ -+ (BIT_MASK_VIQ_DESC_MODE_8197F << BIT_SHIFT_VIQ_DESC_MODE_8197F) -+#define BIT_CLEAR_VIQ_DESC_MODE_8197F(x) ((x) & (~BITS_VIQ_DESC_MODE_8197F)) -+#define BIT_GET_VIQ_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_MODE_8197F) & BIT_MASK_VIQ_DESC_MODE_8197F) -+#define BIT_SET_VIQ_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_MODE_8197F(x) | BIT_VIQ_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_VIQ_DESC_NUM_8197F 0 -+#define BIT_MASK_VIQ_DESC_NUM_8197F 0xfff -+#define BIT_VIQ_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_NUM_8197F) << BIT_SHIFT_VIQ_DESC_NUM_8197F) -+#define BITS_VIQ_DESC_NUM_8197F \ -+ (BIT_MASK_VIQ_DESC_NUM_8197F << BIT_SHIFT_VIQ_DESC_NUM_8197F) -+#define BIT_CLEAR_VIQ_DESC_NUM_8197F(x) ((x) & (~BITS_VIQ_DESC_NUM_8197F)) -+#define BIT_GET_VIQ_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_NUM_8197F) & BIT_MASK_VIQ_DESC_NUM_8197F) -+#define BIT_SET_VIQ_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_NUM_8197F(x) | BIT_VIQ_DESC_NUM_8197F(v)) -+ -+/* 2 REG_BEQ_TXBD_NUM_8197F */ -+#define BIT_HCI_BEQ_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_BEQ_DESC_MODE_8197F 12 -+#define BIT_MASK_BEQ_DESC_MODE_8197F 0x3 -+#define BIT_BEQ_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_MODE_8197F) << BIT_SHIFT_BEQ_DESC_MODE_8197F) -+#define BITS_BEQ_DESC_MODE_8197F \ -+ (BIT_MASK_BEQ_DESC_MODE_8197F << BIT_SHIFT_BEQ_DESC_MODE_8197F) -+#define BIT_CLEAR_BEQ_DESC_MODE_8197F(x) ((x) & (~BITS_BEQ_DESC_MODE_8197F)) -+#define BIT_GET_BEQ_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_MODE_8197F) & BIT_MASK_BEQ_DESC_MODE_8197F) -+#define BIT_SET_BEQ_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_MODE_8197F(x) | BIT_BEQ_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_BEQ_DESC_NUM_8197F 0 -+#define BIT_MASK_BEQ_DESC_NUM_8197F 0xfff -+#define BIT_BEQ_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_NUM_8197F) << BIT_SHIFT_BEQ_DESC_NUM_8197F) -+#define BITS_BEQ_DESC_NUM_8197F \ -+ (BIT_MASK_BEQ_DESC_NUM_8197F << BIT_SHIFT_BEQ_DESC_NUM_8197F) -+#define BIT_CLEAR_BEQ_DESC_NUM_8197F(x) ((x) & (~BITS_BEQ_DESC_NUM_8197F)) -+#define BIT_GET_BEQ_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_NUM_8197F) & BIT_MASK_BEQ_DESC_NUM_8197F) -+#define BIT_SET_BEQ_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_NUM_8197F(x) | BIT_BEQ_DESC_NUM_8197F(v)) -+ -+/* 2 REG_BKQ_TXBD_NUM_8197F */ -+#define BIT_HCI_BKQ_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_BKQ_DESC_MODE_8197F 12 -+#define BIT_MASK_BKQ_DESC_MODE_8197F 0x3 -+#define BIT_BKQ_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_MODE_8197F) << BIT_SHIFT_BKQ_DESC_MODE_8197F) -+#define BITS_BKQ_DESC_MODE_8197F \ -+ (BIT_MASK_BKQ_DESC_MODE_8197F << BIT_SHIFT_BKQ_DESC_MODE_8197F) -+#define BIT_CLEAR_BKQ_DESC_MODE_8197F(x) ((x) & (~BITS_BKQ_DESC_MODE_8197F)) -+#define BIT_GET_BKQ_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_MODE_8197F) & BIT_MASK_BKQ_DESC_MODE_8197F) -+#define BIT_SET_BKQ_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_MODE_8197F(x) | BIT_BKQ_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_BKQ_DESC_NUM_8197F 0 -+#define BIT_MASK_BKQ_DESC_NUM_8197F 0xfff -+#define BIT_BKQ_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_NUM_8197F) << BIT_SHIFT_BKQ_DESC_NUM_8197F) -+#define BITS_BKQ_DESC_NUM_8197F \ -+ (BIT_MASK_BKQ_DESC_NUM_8197F << BIT_SHIFT_BKQ_DESC_NUM_8197F) -+#define BIT_CLEAR_BKQ_DESC_NUM_8197F(x) ((x) & (~BITS_BKQ_DESC_NUM_8197F)) -+#define BIT_GET_BKQ_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_NUM_8197F) & BIT_MASK_BKQ_DESC_NUM_8197F) -+#define BIT_SET_BKQ_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_NUM_8197F(x) | BIT_BKQ_DESC_NUM_8197F(v)) -+ -+/* 2 REG_HI0Q_TXBD_NUM_8197F */ -+#define BIT_HI0Q_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_HI0Q_DESC_MODE_8197F 12 -+#define BIT_MASK_HI0Q_DESC_MODE_8197F 0x3 -+#define BIT_HI0Q_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_MODE_8197F) \ -+ << BIT_SHIFT_HI0Q_DESC_MODE_8197F) -+#define BITS_HI0Q_DESC_MODE_8197F \ -+ (BIT_MASK_HI0Q_DESC_MODE_8197F << BIT_SHIFT_HI0Q_DESC_MODE_8197F) -+#define BIT_CLEAR_HI0Q_DESC_MODE_8197F(x) ((x) & (~BITS_HI0Q_DESC_MODE_8197F)) -+#define BIT_GET_HI0Q_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_MODE_8197F) & \ -+ BIT_MASK_HI0Q_DESC_MODE_8197F) -+#define BIT_SET_HI0Q_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_MODE_8197F(x) | BIT_HI0Q_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_HI0Q_DESC_NUM_8197F 0 -+#define BIT_MASK_HI0Q_DESC_NUM_8197F 0xfff -+#define BIT_HI0Q_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_NUM_8197F) << BIT_SHIFT_HI0Q_DESC_NUM_8197F) -+#define BITS_HI0Q_DESC_NUM_8197F \ -+ (BIT_MASK_HI0Q_DESC_NUM_8197F << BIT_SHIFT_HI0Q_DESC_NUM_8197F) -+#define BIT_CLEAR_HI0Q_DESC_NUM_8197F(x) ((x) & (~BITS_HI0Q_DESC_NUM_8197F)) -+#define BIT_GET_HI0Q_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_NUM_8197F) & BIT_MASK_HI0Q_DESC_NUM_8197F) -+#define BIT_SET_HI0Q_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_NUM_8197F(x) | BIT_HI0Q_DESC_NUM_8197F(v)) -+ -+/* 2 REG_HI1Q_TXBD_NUM_8197F */ -+#define BIT_HI1Q_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_HI1Q_DESC_MODE_8197F 12 -+#define BIT_MASK_HI1Q_DESC_MODE_8197F 0x3 -+#define BIT_HI1Q_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_MODE_8197F) \ -+ << BIT_SHIFT_HI1Q_DESC_MODE_8197F) -+#define BITS_HI1Q_DESC_MODE_8197F \ -+ (BIT_MASK_HI1Q_DESC_MODE_8197F << BIT_SHIFT_HI1Q_DESC_MODE_8197F) -+#define BIT_CLEAR_HI1Q_DESC_MODE_8197F(x) ((x) & (~BITS_HI1Q_DESC_MODE_8197F)) -+#define BIT_GET_HI1Q_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_MODE_8197F) & \ -+ BIT_MASK_HI1Q_DESC_MODE_8197F) -+#define BIT_SET_HI1Q_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_MODE_8197F(x) | BIT_HI1Q_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_HI1Q_DESC_NUM_8197F 0 -+#define BIT_MASK_HI1Q_DESC_NUM_8197F 0xfff -+#define BIT_HI1Q_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_NUM_8197F) << BIT_SHIFT_HI1Q_DESC_NUM_8197F) -+#define BITS_HI1Q_DESC_NUM_8197F \ -+ (BIT_MASK_HI1Q_DESC_NUM_8197F << BIT_SHIFT_HI1Q_DESC_NUM_8197F) -+#define BIT_CLEAR_HI1Q_DESC_NUM_8197F(x) ((x) & (~BITS_HI1Q_DESC_NUM_8197F)) -+#define BIT_GET_HI1Q_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_NUM_8197F) & BIT_MASK_HI1Q_DESC_NUM_8197F) -+#define BIT_SET_HI1Q_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_NUM_8197F(x) | BIT_HI1Q_DESC_NUM_8197F(v)) -+ -+/* 2 REG_HI2Q_TXBD_NUM_8197F */ -+#define BIT_HI2Q_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_HI2Q_DESC_MODE_8197F 12 -+#define BIT_MASK_HI2Q_DESC_MODE_8197F 0x3 -+#define BIT_HI2Q_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_MODE_8197F) \ -+ << BIT_SHIFT_HI2Q_DESC_MODE_8197F) -+#define BITS_HI2Q_DESC_MODE_8197F \ -+ (BIT_MASK_HI2Q_DESC_MODE_8197F << BIT_SHIFT_HI2Q_DESC_MODE_8197F) -+#define BIT_CLEAR_HI2Q_DESC_MODE_8197F(x) ((x) & (~BITS_HI2Q_DESC_MODE_8197F)) -+#define BIT_GET_HI2Q_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_MODE_8197F) & \ -+ BIT_MASK_HI2Q_DESC_MODE_8197F) -+#define BIT_SET_HI2Q_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_MODE_8197F(x) | BIT_HI2Q_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_HI2Q_DESC_NUM_8197F 0 -+#define BIT_MASK_HI2Q_DESC_NUM_8197F 0xfff -+#define BIT_HI2Q_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_NUM_8197F) << BIT_SHIFT_HI2Q_DESC_NUM_8197F) -+#define BITS_HI2Q_DESC_NUM_8197F \ -+ (BIT_MASK_HI2Q_DESC_NUM_8197F << BIT_SHIFT_HI2Q_DESC_NUM_8197F) -+#define BIT_CLEAR_HI2Q_DESC_NUM_8197F(x) ((x) & (~BITS_HI2Q_DESC_NUM_8197F)) -+#define BIT_GET_HI2Q_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_NUM_8197F) & BIT_MASK_HI2Q_DESC_NUM_8197F) -+#define BIT_SET_HI2Q_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_NUM_8197F(x) | BIT_HI2Q_DESC_NUM_8197F(v)) -+ -+/* 2 REG_HI3Q_TXBD_NUM_8197F */ -+#define BIT_HI3Q_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_HI3Q_DESC_MODE_8197F 12 -+#define BIT_MASK_HI3Q_DESC_MODE_8197F 0x3 -+#define BIT_HI3Q_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_MODE_8197F) \ -+ << BIT_SHIFT_HI3Q_DESC_MODE_8197F) -+#define BITS_HI3Q_DESC_MODE_8197F \ -+ (BIT_MASK_HI3Q_DESC_MODE_8197F << BIT_SHIFT_HI3Q_DESC_MODE_8197F) -+#define BIT_CLEAR_HI3Q_DESC_MODE_8197F(x) ((x) & (~BITS_HI3Q_DESC_MODE_8197F)) -+#define BIT_GET_HI3Q_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_MODE_8197F) & \ -+ BIT_MASK_HI3Q_DESC_MODE_8197F) -+#define BIT_SET_HI3Q_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_MODE_8197F(x) | BIT_HI3Q_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_HI3Q_DESC_NUM_8197F 0 -+#define BIT_MASK_HI3Q_DESC_NUM_8197F 0xfff -+#define BIT_HI3Q_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_NUM_8197F) << BIT_SHIFT_HI3Q_DESC_NUM_8197F) -+#define BITS_HI3Q_DESC_NUM_8197F \ -+ (BIT_MASK_HI3Q_DESC_NUM_8197F << BIT_SHIFT_HI3Q_DESC_NUM_8197F) -+#define BIT_CLEAR_HI3Q_DESC_NUM_8197F(x) ((x) & (~BITS_HI3Q_DESC_NUM_8197F)) -+#define BIT_GET_HI3Q_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_NUM_8197F) & BIT_MASK_HI3Q_DESC_NUM_8197F) -+#define BIT_SET_HI3Q_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_NUM_8197F(x) | BIT_HI3Q_DESC_NUM_8197F(v)) -+ -+/* 2 REG_HI4Q_TXBD_NUM_8197F */ -+#define BIT_HI4Q_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_HI4Q_DESC_MODE_8197F 12 -+#define BIT_MASK_HI4Q_DESC_MODE_8197F 0x3 -+#define BIT_HI4Q_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_MODE_8197F) \ -+ << BIT_SHIFT_HI4Q_DESC_MODE_8197F) -+#define BITS_HI4Q_DESC_MODE_8197F \ -+ (BIT_MASK_HI4Q_DESC_MODE_8197F << BIT_SHIFT_HI4Q_DESC_MODE_8197F) -+#define BIT_CLEAR_HI4Q_DESC_MODE_8197F(x) ((x) & (~BITS_HI4Q_DESC_MODE_8197F)) -+#define BIT_GET_HI4Q_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_MODE_8197F) & \ -+ BIT_MASK_HI4Q_DESC_MODE_8197F) -+#define BIT_SET_HI4Q_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_MODE_8197F(x) | BIT_HI4Q_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_HI4Q_DESC_NUM_8197F 0 -+#define BIT_MASK_HI4Q_DESC_NUM_8197F 0xfff -+#define BIT_HI4Q_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_NUM_8197F) << BIT_SHIFT_HI4Q_DESC_NUM_8197F) -+#define BITS_HI4Q_DESC_NUM_8197F \ -+ (BIT_MASK_HI4Q_DESC_NUM_8197F << BIT_SHIFT_HI4Q_DESC_NUM_8197F) -+#define BIT_CLEAR_HI4Q_DESC_NUM_8197F(x) ((x) & (~BITS_HI4Q_DESC_NUM_8197F)) -+#define BIT_GET_HI4Q_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_NUM_8197F) & BIT_MASK_HI4Q_DESC_NUM_8197F) -+#define BIT_SET_HI4Q_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_NUM_8197F(x) | BIT_HI4Q_DESC_NUM_8197F(v)) -+ -+/* 2 REG_HI5Q_TXBD_NUM_8197F */ -+#define BIT_HI5Q_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_HI5Q_DESC_MODE_8197F 12 -+#define BIT_MASK_HI5Q_DESC_MODE_8197F 0x3 -+#define BIT_HI5Q_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_MODE_8197F) \ -+ << BIT_SHIFT_HI5Q_DESC_MODE_8197F) -+#define BITS_HI5Q_DESC_MODE_8197F \ -+ (BIT_MASK_HI5Q_DESC_MODE_8197F << BIT_SHIFT_HI5Q_DESC_MODE_8197F) -+#define BIT_CLEAR_HI5Q_DESC_MODE_8197F(x) ((x) & (~BITS_HI5Q_DESC_MODE_8197F)) -+#define BIT_GET_HI5Q_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_MODE_8197F) & \ -+ BIT_MASK_HI5Q_DESC_MODE_8197F) -+#define BIT_SET_HI5Q_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_MODE_8197F(x) | BIT_HI5Q_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_HI5Q_DESC_NUM_8197F 0 -+#define BIT_MASK_HI5Q_DESC_NUM_8197F 0xfff -+#define BIT_HI5Q_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_NUM_8197F) << BIT_SHIFT_HI5Q_DESC_NUM_8197F) -+#define BITS_HI5Q_DESC_NUM_8197F \ -+ (BIT_MASK_HI5Q_DESC_NUM_8197F << BIT_SHIFT_HI5Q_DESC_NUM_8197F) -+#define BIT_CLEAR_HI5Q_DESC_NUM_8197F(x) ((x) & (~BITS_HI5Q_DESC_NUM_8197F)) -+#define BIT_GET_HI5Q_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_NUM_8197F) & BIT_MASK_HI5Q_DESC_NUM_8197F) -+#define BIT_SET_HI5Q_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_NUM_8197F(x) | BIT_HI5Q_DESC_NUM_8197F(v)) -+ -+/* 2 REG_HI6Q_TXBD_NUM_8197F */ -+#define BIT_HI6Q_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_HI6Q_DESC_MODE_8197F 12 -+#define BIT_MASK_HI6Q_DESC_MODE_8197F 0x3 -+#define BIT_HI6Q_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_MODE_8197F) \ -+ << BIT_SHIFT_HI6Q_DESC_MODE_8197F) -+#define BITS_HI6Q_DESC_MODE_8197F \ -+ (BIT_MASK_HI6Q_DESC_MODE_8197F << BIT_SHIFT_HI6Q_DESC_MODE_8197F) -+#define BIT_CLEAR_HI6Q_DESC_MODE_8197F(x) ((x) & (~BITS_HI6Q_DESC_MODE_8197F)) -+#define BIT_GET_HI6Q_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_MODE_8197F) & \ -+ BIT_MASK_HI6Q_DESC_MODE_8197F) -+#define BIT_SET_HI6Q_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_MODE_8197F(x) | BIT_HI6Q_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_HI6Q_DESC_NUM_8197F 0 -+#define BIT_MASK_HI6Q_DESC_NUM_8197F 0xfff -+#define BIT_HI6Q_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_NUM_8197F) << BIT_SHIFT_HI6Q_DESC_NUM_8197F) -+#define BITS_HI6Q_DESC_NUM_8197F \ -+ (BIT_MASK_HI6Q_DESC_NUM_8197F << BIT_SHIFT_HI6Q_DESC_NUM_8197F) -+#define BIT_CLEAR_HI6Q_DESC_NUM_8197F(x) ((x) & (~BITS_HI6Q_DESC_NUM_8197F)) -+#define BIT_GET_HI6Q_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_NUM_8197F) & BIT_MASK_HI6Q_DESC_NUM_8197F) -+#define BIT_SET_HI6Q_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_NUM_8197F(x) | BIT_HI6Q_DESC_NUM_8197F(v)) -+ -+/* 2 REG_HI7Q_TXBD_NUM_8197F */ -+#define BIT_HI7Q_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_HI7Q_DESC_MODE_8197F 12 -+#define BIT_MASK_HI7Q_DESC_MODE_8197F 0x3 -+#define BIT_HI7Q_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_MODE_8197F) \ -+ << BIT_SHIFT_HI7Q_DESC_MODE_8197F) -+#define BITS_HI7Q_DESC_MODE_8197F \ -+ (BIT_MASK_HI7Q_DESC_MODE_8197F << BIT_SHIFT_HI7Q_DESC_MODE_8197F) -+#define BIT_CLEAR_HI7Q_DESC_MODE_8197F(x) ((x) & (~BITS_HI7Q_DESC_MODE_8197F)) -+#define BIT_GET_HI7Q_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_MODE_8197F) & \ -+ BIT_MASK_HI7Q_DESC_MODE_8197F) -+#define BIT_SET_HI7Q_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_MODE_8197F(x) | BIT_HI7Q_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_HI7Q_DESC_NUM_8197F 0 -+#define BIT_MASK_HI7Q_DESC_NUM_8197F 0xfff -+#define BIT_HI7Q_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_NUM_8197F) << BIT_SHIFT_HI7Q_DESC_NUM_8197F) -+#define BITS_HI7Q_DESC_NUM_8197F \ -+ (BIT_MASK_HI7Q_DESC_NUM_8197F << BIT_SHIFT_HI7Q_DESC_NUM_8197F) -+#define BIT_CLEAR_HI7Q_DESC_NUM_8197F(x) ((x) & (~BITS_HI7Q_DESC_NUM_8197F)) -+#define BIT_GET_HI7Q_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_NUM_8197F) & BIT_MASK_HI7Q_DESC_NUM_8197F) -+#define BIT_SET_HI7Q_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_NUM_8197F(x) | BIT_HI7Q_DESC_NUM_8197F(v)) -+ -+/* 2 REG_TSFTIMER_HCI_8197F */ -+ -+#define BIT_SHIFT_TSFT2_HCI_8197F 16 -+#define BIT_MASK_TSFT2_HCI_8197F 0xffff -+#define BIT_TSFT2_HCI_8197F(x) \ -+ (((x) & BIT_MASK_TSFT2_HCI_8197F) << BIT_SHIFT_TSFT2_HCI_8197F) -+#define BITS_TSFT2_HCI_8197F \ -+ (BIT_MASK_TSFT2_HCI_8197F << BIT_SHIFT_TSFT2_HCI_8197F) -+#define BIT_CLEAR_TSFT2_HCI_8197F(x) ((x) & (~BITS_TSFT2_HCI_8197F)) -+#define BIT_GET_TSFT2_HCI_8197F(x) \ -+ (((x) >> BIT_SHIFT_TSFT2_HCI_8197F) & BIT_MASK_TSFT2_HCI_8197F) -+#define BIT_SET_TSFT2_HCI_8197F(x, v) \ -+ (BIT_CLEAR_TSFT2_HCI_8197F(x) | BIT_TSFT2_HCI_8197F(v)) -+ -+#define BIT_SHIFT_TSFT1_HCI_8197F 0 -+#define BIT_MASK_TSFT1_HCI_8197F 0xffff -+#define BIT_TSFT1_HCI_8197F(x) \ -+ (((x) & BIT_MASK_TSFT1_HCI_8197F) << BIT_SHIFT_TSFT1_HCI_8197F) -+#define BITS_TSFT1_HCI_8197F \ -+ (BIT_MASK_TSFT1_HCI_8197F << BIT_SHIFT_TSFT1_HCI_8197F) -+#define BIT_CLEAR_TSFT1_HCI_8197F(x) ((x) & (~BITS_TSFT1_HCI_8197F)) -+#define BIT_GET_TSFT1_HCI_8197F(x) \ -+ (((x) >> BIT_SHIFT_TSFT1_HCI_8197F) & BIT_MASK_TSFT1_HCI_8197F) -+#define BIT_SET_TSFT1_HCI_8197F(x, v) \ -+ (BIT_CLEAR_TSFT1_HCI_8197F(x) | BIT_TSFT1_HCI_8197F(v)) -+ -+/* 2 REG_BD_RWPTR_CLR_8197F */ -+#define BIT_CLR_HI7Q_HW_IDX_8197F BIT(29) -+#define BIT_CLR_HI6Q_HW_IDX_8197F BIT(28) -+#define BIT_CLR_HI5Q_HW_IDX_8197F BIT(27) -+#define BIT_CLR_HI4Q_HW_IDX_8197F BIT(26) -+#define BIT_CLR_HI3Q_HW_IDX_8197F BIT(25) -+#define BIT_CLR_HI2Q_HW_IDX_8197F BIT(24) -+#define BIT_CLR_HI1Q_HW_IDX_8197F BIT(23) -+#define BIT_CLR_HI0Q_HW_IDX_8197F BIT(22) -+#define BIT_CLR_BKQ_HW_IDX_8197F BIT(21) -+#define BIT_CLR_BEQ_HW_IDX_8197F BIT(20) -+#define BIT_CLR_VIQ_HW_IDX_8197F BIT(19) -+#define BIT_CLR_VOQ_HW_IDX_8197F BIT(18) -+#define BIT_CLR_MGQ_HW_IDX_8197F BIT(17) -+#define BIT_CLR_RXQ_HW_IDX_8197F BIT(16) -+#define BIT_CLR_HI7Q_HOST_IDX_8197F BIT(13) -+#define BIT_CLR_HI6Q_HOST_IDX_8197F BIT(12) -+#define BIT_CLR_HI5Q_HOST_IDX_8197F BIT(11) -+#define BIT_CLR_HI4Q_HOST_IDX_8197F BIT(10) -+#define BIT_CLR_HI3Q_HOST_IDX_8197F BIT(9) -+#define BIT_CLR_HI2Q_HOST_IDX_8197F BIT(8) -+#define BIT_CLR_HI1Q_HOST_IDX_8197F BIT(7) -+#define BIT_CLR_HI0Q_HOST_IDX_8197F BIT(6) -+#define BIT_CLR_BKQ_HOST_IDX_8197F BIT(5) -+#define BIT_CLR_BEQ_HOST_IDX_8197F BIT(4) -+#define BIT_CLR_VIQ_HOST_IDX_8197F BIT(3) -+#define BIT_CLR_VOQ_HOST_IDX_8197F BIT(2) -+#define BIT_CLR_MGQ_HOST_IDX_8197F BIT(1) -+#define BIT_CLR_RXQ_HOST_IDX_8197F BIT(0) -+ -+/* 2 REG_VOQ_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_VOQ_HW_IDX_8197F 16 -+#define BIT_MASK_VOQ_HW_IDX_8197F 0xfff -+#define BIT_VOQ_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_VOQ_HW_IDX_8197F) << BIT_SHIFT_VOQ_HW_IDX_8197F) -+#define BITS_VOQ_HW_IDX_8197F \ -+ (BIT_MASK_VOQ_HW_IDX_8197F << BIT_SHIFT_VOQ_HW_IDX_8197F) -+#define BIT_CLEAR_VOQ_HW_IDX_8197F(x) ((x) & (~BITS_VOQ_HW_IDX_8197F)) -+#define BIT_GET_VOQ_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HW_IDX_8197F) & BIT_MASK_VOQ_HW_IDX_8197F) -+#define BIT_SET_VOQ_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_VOQ_HW_IDX_8197F(x) | BIT_VOQ_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_VOQ_HOST_IDX_8197F 0 -+#define BIT_MASK_VOQ_HOST_IDX_8197F 0xfff -+#define BIT_VOQ_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_VOQ_HOST_IDX_8197F) << BIT_SHIFT_VOQ_HOST_IDX_8197F) -+#define BITS_VOQ_HOST_IDX_8197F \ -+ (BIT_MASK_VOQ_HOST_IDX_8197F << BIT_SHIFT_VOQ_HOST_IDX_8197F) -+#define BIT_CLEAR_VOQ_HOST_IDX_8197F(x) ((x) & (~BITS_VOQ_HOST_IDX_8197F)) -+#define BIT_GET_VOQ_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HOST_IDX_8197F) & BIT_MASK_VOQ_HOST_IDX_8197F) -+#define BIT_SET_VOQ_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_VOQ_HOST_IDX_8197F(x) | BIT_VOQ_HOST_IDX_8197F(v)) -+ -+/* 2 REG_VIQ_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_VIQ_HW_IDX_8197F 16 -+#define BIT_MASK_VIQ_HW_IDX_8197F 0xfff -+#define BIT_VIQ_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_VIQ_HW_IDX_8197F) << BIT_SHIFT_VIQ_HW_IDX_8197F) -+#define BITS_VIQ_HW_IDX_8197F \ -+ (BIT_MASK_VIQ_HW_IDX_8197F << BIT_SHIFT_VIQ_HW_IDX_8197F) -+#define BIT_CLEAR_VIQ_HW_IDX_8197F(x) ((x) & (~BITS_VIQ_HW_IDX_8197F)) -+#define BIT_GET_VIQ_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HW_IDX_8197F) & BIT_MASK_VIQ_HW_IDX_8197F) -+#define BIT_SET_VIQ_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_VIQ_HW_IDX_8197F(x) | BIT_VIQ_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_VIQ_HOST_IDX_8197F 0 -+#define BIT_MASK_VIQ_HOST_IDX_8197F 0xfff -+#define BIT_VIQ_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_VIQ_HOST_IDX_8197F) << BIT_SHIFT_VIQ_HOST_IDX_8197F) -+#define BITS_VIQ_HOST_IDX_8197F \ -+ (BIT_MASK_VIQ_HOST_IDX_8197F << BIT_SHIFT_VIQ_HOST_IDX_8197F) -+#define BIT_CLEAR_VIQ_HOST_IDX_8197F(x) ((x) & (~BITS_VIQ_HOST_IDX_8197F)) -+#define BIT_GET_VIQ_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HOST_IDX_8197F) & BIT_MASK_VIQ_HOST_IDX_8197F) -+#define BIT_SET_VIQ_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_VIQ_HOST_IDX_8197F(x) | BIT_VIQ_HOST_IDX_8197F(v)) -+ -+/* 2 REG_BEQ_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_BEQ_HW_IDX_8197F 16 -+#define BIT_MASK_BEQ_HW_IDX_8197F 0xfff -+#define BIT_BEQ_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_BEQ_HW_IDX_8197F) << BIT_SHIFT_BEQ_HW_IDX_8197F) -+#define BITS_BEQ_HW_IDX_8197F \ -+ (BIT_MASK_BEQ_HW_IDX_8197F << BIT_SHIFT_BEQ_HW_IDX_8197F) -+#define BIT_CLEAR_BEQ_HW_IDX_8197F(x) ((x) & (~BITS_BEQ_HW_IDX_8197F)) -+#define BIT_GET_BEQ_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HW_IDX_8197F) & BIT_MASK_BEQ_HW_IDX_8197F) -+#define BIT_SET_BEQ_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_BEQ_HW_IDX_8197F(x) | BIT_BEQ_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_BEQ_HOST_IDX_8197F 0 -+#define BIT_MASK_BEQ_HOST_IDX_8197F 0xfff -+#define BIT_BEQ_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_BEQ_HOST_IDX_8197F) << BIT_SHIFT_BEQ_HOST_IDX_8197F) -+#define BITS_BEQ_HOST_IDX_8197F \ -+ (BIT_MASK_BEQ_HOST_IDX_8197F << BIT_SHIFT_BEQ_HOST_IDX_8197F) -+#define BIT_CLEAR_BEQ_HOST_IDX_8197F(x) ((x) & (~BITS_BEQ_HOST_IDX_8197F)) -+#define BIT_GET_BEQ_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HOST_IDX_8197F) & BIT_MASK_BEQ_HOST_IDX_8197F) -+#define BIT_SET_BEQ_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_BEQ_HOST_IDX_8197F(x) | BIT_BEQ_HOST_IDX_8197F(v)) -+ -+/* 2 REG_BKQ_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_BKQ_HW_IDX_8197F 16 -+#define BIT_MASK_BKQ_HW_IDX_8197F 0xfff -+#define BIT_BKQ_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_BKQ_HW_IDX_8197F) << BIT_SHIFT_BKQ_HW_IDX_8197F) -+#define BITS_BKQ_HW_IDX_8197F \ -+ (BIT_MASK_BKQ_HW_IDX_8197F << BIT_SHIFT_BKQ_HW_IDX_8197F) -+#define BIT_CLEAR_BKQ_HW_IDX_8197F(x) ((x) & (~BITS_BKQ_HW_IDX_8197F)) -+#define BIT_GET_BKQ_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HW_IDX_8197F) & BIT_MASK_BKQ_HW_IDX_8197F) -+#define BIT_SET_BKQ_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_BKQ_HW_IDX_8197F(x) | BIT_BKQ_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_BKQ_HOST_IDX_8197F 0 -+#define BIT_MASK_BKQ_HOST_IDX_8197F 0xfff -+#define BIT_BKQ_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_BKQ_HOST_IDX_8197F) << BIT_SHIFT_BKQ_HOST_IDX_8197F) -+#define BITS_BKQ_HOST_IDX_8197F \ -+ (BIT_MASK_BKQ_HOST_IDX_8197F << BIT_SHIFT_BKQ_HOST_IDX_8197F) -+#define BIT_CLEAR_BKQ_HOST_IDX_8197F(x) ((x) & (~BITS_BKQ_HOST_IDX_8197F)) -+#define BIT_GET_BKQ_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HOST_IDX_8197F) & BIT_MASK_BKQ_HOST_IDX_8197F) -+#define BIT_SET_BKQ_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_BKQ_HOST_IDX_8197F(x) | BIT_BKQ_HOST_IDX_8197F(v)) -+ -+/* 2 REG_MGQ_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_MGQ_HW_IDX_8197F 16 -+#define BIT_MASK_MGQ_HW_IDX_8197F 0xfff -+#define BIT_MGQ_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_MGQ_HW_IDX_8197F) << BIT_SHIFT_MGQ_HW_IDX_8197F) -+#define BITS_MGQ_HW_IDX_8197F \ -+ (BIT_MASK_MGQ_HW_IDX_8197F << BIT_SHIFT_MGQ_HW_IDX_8197F) -+#define BIT_CLEAR_MGQ_HW_IDX_8197F(x) ((x) & (~BITS_MGQ_HW_IDX_8197F)) -+#define BIT_GET_MGQ_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HW_IDX_8197F) & BIT_MASK_MGQ_HW_IDX_8197F) -+#define BIT_SET_MGQ_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_MGQ_HW_IDX_8197F(x) | BIT_MGQ_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_MGQ_HOST_IDX_8197F 0 -+#define BIT_MASK_MGQ_HOST_IDX_8197F 0xfff -+#define BIT_MGQ_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_MGQ_HOST_IDX_8197F) << BIT_SHIFT_MGQ_HOST_IDX_8197F) -+#define BITS_MGQ_HOST_IDX_8197F \ -+ (BIT_MASK_MGQ_HOST_IDX_8197F << BIT_SHIFT_MGQ_HOST_IDX_8197F) -+#define BIT_CLEAR_MGQ_HOST_IDX_8197F(x) ((x) & (~BITS_MGQ_HOST_IDX_8197F)) -+#define BIT_GET_MGQ_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HOST_IDX_8197F) & BIT_MASK_MGQ_HOST_IDX_8197F) -+#define BIT_SET_MGQ_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_MGQ_HOST_IDX_8197F(x) | BIT_MGQ_HOST_IDX_8197F(v)) -+ -+/* 2 REG_RXQ_RXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_RXQ_HW_IDX_8197F 16 -+#define BIT_MASK_RXQ_HW_IDX_8197F 0xfff -+#define BIT_RXQ_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_RXQ_HW_IDX_8197F) << BIT_SHIFT_RXQ_HW_IDX_8197F) -+#define BITS_RXQ_HW_IDX_8197F \ -+ (BIT_MASK_RXQ_HW_IDX_8197F << BIT_SHIFT_RXQ_HW_IDX_8197F) -+#define BIT_CLEAR_RXQ_HW_IDX_8197F(x) ((x) & (~BITS_RXQ_HW_IDX_8197F)) -+#define BIT_GET_RXQ_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HW_IDX_8197F) & BIT_MASK_RXQ_HW_IDX_8197F) -+#define BIT_SET_RXQ_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_RXQ_HW_IDX_8197F(x) | BIT_RXQ_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_RXQ_HOST_IDX_8197F 0 -+#define BIT_MASK_RXQ_HOST_IDX_8197F 0xfff -+#define BIT_RXQ_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_RXQ_HOST_IDX_8197F) << BIT_SHIFT_RXQ_HOST_IDX_8197F) -+#define BITS_RXQ_HOST_IDX_8197F \ -+ (BIT_MASK_RXQ_HOST_IDX_8197F << BIT_SHIFT_RXQ_HOST_IDX_8197F) -+#define BIT_CLEAR_RXQ_HOST_IDX_8197F(x) ((x) & (~BITS_RXQ_HOST_IDX_8197F)) -+#define BIT_GET_RXQ_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HOST_IDX_8197F) & BIT_MASK_RXQ_HOST_IDX_8197F) -+#define BIT_SET_RXQ_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_RXQ_HOST_IDX_8197F(x) | BIT_RXQ_HOST_IDX_8197F(v)) -+ -+/* 2 REG_HI0Q_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_HI0Q_HW_IDX_8197F 16 -+#define BIT_MASK_HI0Q_HW_IDX_8197F 0xfff -+#define BIT_HI0Q_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI0Q_HW_IDX_8197F) << BIT_SHIFT_HI0Q_HW_IDX_8197F) -+#define BITS_HI0Q_HW_IDX_8197F \ -+ (BIT_MASK_HI0Q_HW_IDX_8197F << BIT_SHIFT_HI0Q_HW_IDX_8197F) -+#define BIT_CLEAR_HI0Q_HW_IDX_8197F(x) ((x) & (~BITS_HI0Q_HW_IDX_8197F)) -+#define BIT_GET_HI0Q_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HW_IDX_8197F) & BIT_MASK_HI0Q_HW_IDX_8197F) -+#define BIT_SET_HI0Q_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI0Q_HW_IDX_8197F(x) | BIT_HI0Q_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_HI0Q_HOST_IDX_8197F 0 -+#define BIT_MASK_HI0Q_HOST_IDX_8197F 0xfff -+#define BIT_HI0Q_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI0Q_HOST_IDX_8197F) << BIT_SHIFT_HI0Q_HOST_IDX_8197F) -+#define BITS_HI0Q_HOST_IDX_8197F \ -+ (BIT_MASK_HI0Q_HOST_IDX_8197F << BIT_SHIFT_HI0Q_HOST_IDX_8197F) -+#define BIT_CLEAR_HI0Q_HOST_IDX_8197F(x) ((x) & (~BITS_HI0Q_HOST_IDX_8197F)) -+#define BIT_GET_HI0Q_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HOST_IDX_8197F) & BIT_MASK_HI0Q_HOST_IDX_8197F) -+#define BIT_SET_HI0Q_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI0Q_HOST_IDX_8197F(x) | BIT_HI0Q_HOST_IDX_8197F(v)) -+ -+/* 2 REG_HI1Q_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_HI1Q_HW_IDX_8197F 16 -+#define BIT_MASK_HI1Q_HW_IDX_8197F 0xfff -+#define BIT_HI1Q_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI1Q_HW_IDX_8197F) << BIT_SHIFT_HI1Q_HW_IDX_8197F) -+#define BITS_HI1Q_HW_IDX_8197F \ -+ (BIT_MASK_HI1Q_HW_IDX_8197F << BIT_SHIFT_HI1Q_HW_IDX_8197F) -+#define BIT_CLEAR_HI1Q_HW_IDX_8197F(x) ((x) & (~BITS_HI1Q_HW_IDX_8197F)) -+#define BIT_GET_HI1Q_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HW_IDX_8197F) & BIT_MASK_HI1Q_HW_IDX_8197F) -+#define BIT_SET_HI1Q_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI1Q_HW_IDX_8197F(x) | BIT_HI1Q_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_HI1Q_HOST_IDX_8197F 0 -+#define BIT_MASK_HI1Q_HOST_IDX_8197F 0xfff -+#define BIT_HI1Q_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI1Q_HOST_IDX_8197F) << BIT_SHIFT_HI1Q_HOST_IDX_8197F) -+#define BITS_HI1Q_HOST_IDX_8197F \ -+ (BIT_MASK_HI1Q_HOST_IDX_8197F << BIT_SHIFT_HI1Q_HOST_IDX_8197F) -+#define BIT_CLEAR_HI1Q_HOST_IDX_8197F(x) ((x) & (~BITS_HI1Q_HOST_IDX_8197F)) -+#define BIT_GET_HI1Q_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HOST_IDX_8197F) & BIT_MASK_HI1Q_HOST_IDX_8197F) -+#define BIT_SET_HI1Q_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI1Q_HOST_IDX_8197F(x) | BIT_HI1Q_HOST_IDX_8197F(v)) -+ -+/* 2 REG_HI2Q_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_HI2Q_HW_IDX_8197F 16 -+#define BIT_MASK_HI2Q_HW_IDX_8197F 0xfff -+#define BIT_HI2Q_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI2Q_HW_IDX_8197F) << BIT_SHIFT_HI2Q_HW_IDX_8197F) -+#define BITS_HI2Q_HW_IDX_8197F \ -+ (BIT_MASK_HI2Q_HW_IDX_8197F << BIT_SHIFT_HI2Q_HW_IDX_8197F) -+#define BIT_CLEAR_HI2Q_HW_IDX_8197F(x) ((x) & (~BITS_HI2Q_HW_IDX_8197F)) -+#define BIT_GET_HI2Q_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HW_IDX_8197F) & BIT_MASK_HI2Q_HW_IDX_8197F) -+#define BIT_SET_HI2Q_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI2Q_HW_IDX_8197F(x) | BIT_HI2Q_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_HI2Q_HOST_IDX_8197F 0 -+#define BIT_MASK_HI2Q_HOST_IDX_8197F 0xfff -+#define BIT_HI2Q_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI2Q_HOST_IDX_8197F) << BIT_SHIFT_HI2Q_HOST_IDX_8197F) -+#define BITS_HI2Q_HOST_IDX_8197F \ -+ (BIT_MASK_HI2Q_HOST_IDX_8197F << BIT_SHIFT_HI2Q_HOST_IDX_8197F) -+#define BIT_CLEAR_HI2Q_HOST_IDX_8197F(x) ((x) & (~BITS_HI2Q_HOST_IDX_8197F)) -+#define BIT_GET_HI2Q_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HOST_IDX_8197F) & BIT_MASK_HI2Q_HOST_IDX_8197F) -+#define BIT_SET_HI2Q_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI2Q_HOST_IDX_8197F(x) | BIT_HI2Q_HOST_IDX_8197F(v)) -+ -+/* 2 REG_HI3Q_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_HI3Q_HW_IDX_8197F 16 -+#define BIT_MASK_HI3Q_HW_IDX_8197F 0xfff -+#define BIT_HI3Q_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI3Q_HW_IDX_8197F) << BIT_SHIFT_HI3Q_HW_IDX_8197F) -+#define BITS_HI3Q_HW_IDX_8197F \ -+ (BIT_MASK_HI3Q_HW_IDX_8197F << BIT_SHIFT_HI3Q_HW_IDX_8197F) -+#define BIT_CLEAR_HI3Q_HW_IDX_8197F(x) ((x) & (~BITS_HI3Q_HW_IDX_8197F)) -+#define BIT_GET_HI3Q_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HW_IDX_8197F) & BIT_MASK_HI3Q_HW_IDX_8197F) -+#define BIT_SET_HI3Q_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI3Q_HW_IDX_8197F(x) | BIT_HI3Q_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_HI3Q_HOST_IDX_8197F 0 -+#define BIT_MASK_HI3Q_HOST_IDX_8197F 0xfff -+#define BIT_HI3Q_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI3Q_HOST_IDX_8197F) << BIT_SHIFT_HI3Q_HOST_IDX_8197F) -+#define BITS_HI3Q_HOST_IDX_8197F \ -+ (BIT_MASK_HI3Q_HOST_IDX_8197F << BIT_SHIFT_HI3Q_HOST_IDX_8197F) -+#define BIT_CLEAR_HI3Q_HOST_IDX_8197F(x) ((x) & (~BITS_HI3Q_HOST_IDX_8197F)) -+#define BIT_GET_HI3Q_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HOST_IDX_8197F) & BIT_MASK_HI3Q_HOST_IDX_8197F) -+#define BIT_SET_HI3Q_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI3Q_HOST_IDX_8197F(x) | BIT_HI3Q_HOST_IDX_8197F(v)) -+ -+/* 2 REG_HI4Q_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_HI4Q_HW_IDX_8197F 16 -+#define BIT_MASK_HI4Q_HW_IDX_8197F 0xfff -+#define BIT_HI4Q_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI4Q_HW_IDX_8197F) << BIT_SHIFT_HI4Q_HW_IDX_8197F) -+#define BITS_HI4Q_HW_IDX_8197F \ -+ (BIT_MASK_HI4Q_HW_IDX_8197F << BIT_SHIFT_HI4Q_HW_IDX_8197F) -+#define BIT_CLEAR_HI4Q_HW_IDX_8197F(x) ((x) & (~BITS_HI4Q_HW_IDX_8197F)) -+#define BIT_GET_HI4Q_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HW_IDX_8197F) & BIT_MASK_HI4Q_HW_IDX_8197F) -+#define BIT_SET_HI4Q_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI4Q_HW_IDX_8197F(x) | BIT_HI4Q_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_HI4Q_HOST_IDX_8197F 0 -+#define BIT_MASK_HI4Q_HOST_IDX_8197F 0xfff -+#define BIT_HI4Q_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI4Q_HOST_IDX_8197F) << BIT_SHIFT_HI4Q_HOST_IDX_8197F) -+#define BITS_HI4Q_HOST_IDX_8197F \ -+ (BIT_MASK_HI4Q_HOST_IDX_8197F << BIT_SHIFT_HI4Q_HOST_IDX_8197F) -+#define BIT_CLEAR_HI4Q_HOST_IDX_8197F(x) ((x) & (~BITS_HI4Q_HOST_IDX_8197F)) -+#define BIT_GET_HI4Q_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HOST_IDX_8197F) & BIT_MASK_HI4Q_HOST_IDX_8197F) -+#define BIT_SET_HI4Q_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI4Q_HOST_IDX_8197F(x) | BIT_HI4Q_HOST_IDX_8197F(v)) -+ -+/* 2 REG_HI5Q_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_HI5Q_HW_IDX_8197F 16 -+#define BIT_MASK_HI5Q_HW_IDX_8197F 0xfff -+#define BIT_HI5Q_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI5Q_HW_IDX_8197F) << BIT_SHIFT_HI5Q_HW_IDX_8197F) -+#define BITS_HI5Q_HW_IDX_8197F \ -+ (BIT_MASK_HI5Q_HW_IDX_8197F << BIT_SHIFT_HI5Q_HW_IDX_8197F) -+#define BIT_CLEAR_HI5Q_HW_IDX_8197F(x) ((x) & (~BITS_HI5Q_HW_IDX_8197F)) -+#define BIT_GET_HI5Q_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HW_IDX_8197F) & BIT_MASK_HI5Q_HW_IDX_8197F) -+#define BIT_SET_HI5Q_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI5Q_HW_IDX_8197F(x) | BIT_HI5Q_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_HI5Q_HOST_IDX_8197F 0 -+#define BIT_MASK_HI5Q_HOST_IDX_8197F 0xfff -+#define BIT_HI5Q_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI5Q_HOST_IDX_8197F) << BIT_SHIFT_HI5Q_HOST_IDX_8197F) -+#define BITS_HI5Q_HOST_IDX_8197F \ -+ (BIT_MASK_HI5Q_HOST_IDX_8197F << BIT_SHIFT_HI5Q_HOST_IDX_8197F) -+#define BIT_CLEAR_HI5Q_HOST_IDX_8197F(x) ((x) & (~BITS_HI5Q_HOST_IDX_8197F)) -+#define BIT_GET_HI5Q_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HOST_IDX_8197F) & BIT_MASK_HI5Q_HOST_IDX_8197F) -+#define BIT_SET_HI5Q_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI5Q_HOST_IDX_8197F(x) | BIT_HI5Q_HOST_IDX_8197F(v)) -+ -+/* 2 REG_HI6Q_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_HI6Q_HW_IDX_8197F 16 -+#define BIT_MASK_HI6Q_HW_IDX_8197F 0xfff -+#define BIT_HI6Q_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI6Q_HW_IDX_8197F) << BIT_SHIFT_HI6Q_HW_IDX_8197F) -+#define BITS_HI6Q_HW_IDX_8197F \ -+ (BIT_MASK_HI6Q_HW_IDX_8197F << BIT_SHIFT_HI6Q_HW_IDX_8197F) -+#define BIT_CLEAR_HI6Q_HW_IDX_8197F(x) ((x) & (~BITS_HI6Q_HW_IDX_8197F)) -+#define BIT_GET_HI6Q_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HW_IDX_8197F) & BIT_MASK_HI6Q_HW_IDX_8197F) -+#define BIT_SET_HI6Q_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI6Q_HW_IDX_8197F(x) | BIT_HI6Q_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_HI6Q_HOST_IDX_8197F 0 -+#define BIT_MASK_HI6Q_HOST_IDX_8197F 0xfff -+#define BIT_HI6Q_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI6Q_HOST_IDX_8197F) << BIT_SHIFT_HI6Q_HOST_IDX_8197F) -+#define BITS_HI6Q_HOST_IDX_8197F \ -+ (BIT_MASK_HI6Q_HOST_IDX_8197F << BIT_SHIFT_HI6Q_HOST_IDX_8197F) -+#define BIT_CLEAR_HI6Q_HOST_IDX_8197F(x) ((x) & (~BITS_HI6Q_HOST_IDX_8197F)) -+#define BIT_GET_HI6Q_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HOST_IDX_8197F) & BIT_MASK_HI6Q_HOST_IDX_8197F) -+#define BIT_SET_HI6Q_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI6Q_HOST_IDX_8197F(x) | BIT_HI6Q_HOST_IDX_8197F(v)) -+ -+/* 2 REG_HI7Q_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_HI7Q_HW_IDX_8197F 16 -+#define BIT_MASK_HI7Q_HW_IDX_8197F 0xfff -+#define BIT_HI7Q_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI7Q_HW_IDX_8197F) << BIT_SHIFT_HI7Q_HW_IDX_8197F) -+#define BITS_HI7Q_HW_IDX_8197F \ -+ (BIT_MASK_HI7Q_HW_IDX_8197F << BIT_SHIFT_HI7Q_HW_IDX_8197F) -+#define BIT_CLEAR_HI7Q_HW_IDX_8197F(x) ((x) & (~BITS_HI7Q_HW_IDX_8197F)) -+#define BIT_GET_HI7Q_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HW_IDX_8197F) & BIT_MASK_HI7Q_HW_IDX_8197F) -+#define BIT_SET_HI7Q_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI7Q_HW_IDX_8197F(x) | BIT_HI7Q_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_HI7Q_HOST_IDX_8197F 0 -+#define BIT_MASK_HI7Q_HOST_IDX_8197F 0xfff -+#define BIT_HI7Q_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HI7Q_HOST_IDX_8197F) << BIT_SHIFT_HI7Q_HOST_IDX_8197F) -+#define BITS_HI7Q_HOST_IDX_8197F \ -+ (BIT_MASK_HI7Q_HOST_IDX_8197F << BIT_SHIFT_HI7Q_HOST_IDX_8197F) -+#define BIT_CLEAR_HI7Q_HOST_IDX_8197F(x) ((x) & (~BITS_HI7Q_HOST_IDX_8197F)) -+#define BIT_GET_HI7Q_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HOST_IDX_8197F) & BIT_MASK_HI7Q_HOST_IDX_8197F) -+#define BIT_SET_HI7Q_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HI7Q_HOST_IDX_8197F(x) | BIT_HI7Q_HOST_IDX_8197F(v)) -+ -+/* 2 REG_DBG_SEL_V1_8197F */ -+ -+#define BIT_SHIFT_DBG_SEL_8197F 0 -+#define BIT_MASK_DBG_SEL_8197F 0xff -+#define BIT_DBG_SEL_8197F(x) \ -+ (((x) & BIT_MASK_DBG_SEL_8197F) << BIT_SHIFT_DBG_SEL_8197F) -+#define BITS_DBG_SEL_8197F (BIT_MASK_DBG_SEL_8197F << BIT_SHIFT_DBG_SEL_8197F) -+#define BIT_CLEAR_DBG_SEL_8197F(x) ((x) & (~BITS_DBG_SEL_8197F)) -+#define BIT_GET_DBG_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_8197F) & BIT_MASK_DBG_SEL_8197F) -+#define BIT_SET_DBG_SEL_8197F(x, v) \ -+ (BIT_CLEAR_DBG_SEL_8197F(x) | BIT_DBG_SEL_8197F(v)) -+ -+/* 2 REG_HCI_HRPWM1_V1_8197F */ -+ -+#define BIT_SHIFT_HCI_HRPWM_8197F 0 -+#define BIT_MASK_HCI_HRPWM_8197F 0xff -+#define BIT_HCI_HRPWM_8197F(x) \ -+ (((x) & BIT_MASK_HCI_HRPWM_8197F) << BIT_SHIFT_HCI_HRPWM_8197F) -+#define BITS_HCI_HRPWM_8197F \ -+ (BIT_MASK_HCI_HRPWM_8197F << BIT_SHIFT_HCI_HRPWM_8197F) -+#define BIT_CLEAR_HCI_HRPWM_8197F(x) ((x) & (~BITS_HCI_HRPWM_8197F)) -+#define BIT_GET_HCI_HRPWM_8197F(x) \ -+ (((x) >> BIT_SHIFT_HCI_HRPWM_8197F) & BIT_MASK_HCI_HRPWM_8197F) -+#define BIT_SET_HCI_HRPWM_8197F(x, v) \ -+ (BIT_CLEAR_HCI_HRPWM_8197F(x) | BIT_HCI_HRPWM_8197F(v)) -+ -+/* 2 REG_HCI_HCPWM1_V1_8197F */ -+ -+#define BIT_SHIFT_HCI_HCPWM_8197F 0 -+#define BIT_MASK_HCI_HCPWM_8197F 0xff -+#define BIT_HCI_HCPWM_8197F(x) \ -+ (((x) & BIT_MASK_HCI_HCPWM_8197F) << BIT_SHIFT_HCI_HCPWM_8197F) -+#define BITS_HCI_HCPWM_8197F \ -+ (BIT_MASK_HCI_HCPWM_8197F << BIT_SHIFT_HCI_HCPWM_8197F) -+#define BIT_CLEAR_HCI_HCPWM_8197F(x) ((x) & (~BITS_HCI_HCPWM_8197F)) -+#define BIT_GET_HCI_HCPWM_8197F(x) \ -+ (((x) >> BIT_SHIFT_HCI_HCPWM_8197F) & BIT_MASK_HCI_HCPWM_8197F) -+#define BIT_SET_HCI_HCPWM_8197F(x, v) \ -+ (BIT_CLEAR_HCI_HCPWM_8197F(x) | BIT_HCI_HCPWM_8197F(v)) -+ -+/* 2 REG_HCI_CTRL2_8197F */ -+#define BIT_DIS_TXDMA_PRE_8197F BIT(7) -+#define BIT_DIS_RXDMA_PRE_8197F BIT(6) -+ -+#define BIT_SHIFT_HPS_CLKR_HCI_8197F 4 -+#define BIT_MASK_HPS_CLKR_HCI_8197F 0x3 -+#define BIT_HPS_CLKR_HCI_8197F(x) \ -+ (((x) & BIT_MASK_HPS_CLKR_HCI_8197F) << BIT_SHIFT_HPS_CLKR_HCI_8197F) -+#define BITS_HPS_CLKR_HCI_8197F \ -+ (BIT_MASK_HPS_CLKR_HCI_8197F << BIT_SHIFT_HPS_CLKR_HCI_8197F) -+#define BIT_CLEAR_HPS_CLKR_HCI_8197F(x) ((x) & (~BITS_HPS_CLKR_HCI_8197F)) -+#define BIT_GET_HPS_CLKR_HCI_8197F(x) \ -+ (((x) >> BIT_SHIFT_HPS_CLKR_HCI_8197F) & BIT_MASK_HPS_CLKR_HCI_8197F) -+#define BIT_SET_HPS_CLKR_HCI_8197F(x, v) \ -+ (BIT_CLEAR_HPS_CLKR_HCI_8197F(x) | BIT_HPS_CLKR_HCI_8197F(v)) -+ -+#define BIT_HCI_INT_8197F BIT(3) -+#define BIT_TXFLAG_EXIT_L1_EN_8197F BIT(2) -+#define BIT_EN_RXDMA_ALIGN_V1_8197F BIT(1) -+#define BIT_EN_TXDMA_ALIGN_V1_8197F BIT(0) -+ -+/* 2 REG_HCI_HRPWM2_V1_8197F */ -+ -+#define BIT_SHIFT_HCI_HRPWM2_8197F 0 -+#define BIT_MASK_HCI_HRPWM2_8197F 0xffff -+#define BIT_HCI_HRPWM2_8197F(x) \ -+ (((x) & BIT_MASK_HCI_HRPWM2_8197F) << BIT_SHIFT_HCI_HRPWM2_8197F) -+#define BITS_HCI_HRPWM2_8197F \ -+ (BIT_MASK_HCI_HRPWM2_8197F << BIT_SHIFT_HCI_HRPWM2_8197F) -+#define BIT_CLEAR_HCI_HRPWM2_8197F(x) ((x) & (~BITS_HCI_HRPWM2_8197F)) -+#define BIT_GET_HCI_HRPWM2_8197F(x) \ -+ (((x) >> BIT_SHIFT_HCI_HRPWM2_8197F) & BIT_MASK_HCI_HRPWM2_8197F) -+#define BIT_SET_HCI_HRPWM2_8197F(x, v) \ -+ (BIT_CLEAR_HCI_HRPWM2_8197F(x) | BIT_HCI_HRPWM2_8197F(v)) -+ -+/* 2 REG_HCI_HCPWM2_V1_8197F */ -+ -+#define BIT_SHIFT_HCI_HCPWM2_8197F 0 -+#define BIT_MASK_HCI_HCPWM2_8197F 0xffff -+#define BIT_HCI_HCPWM2_8197F(x) \ -+ (((x) & BIT_MASK_HCI_HCPWM2_8197F) << BIT_SHIFT_HCI_HCPWM2_8197F) -+#define BITS_HCI_HCPWM2_8197F \ -+ (BIT_MASK_HCI_HCPWM2_8197F << BIT_SHIFT_HCI_HCPWM2_8197F) -+#define BIT_CLEAR_HCI_HCPWM2_8197F(x) ((x) & (~BITS_HCI_HCPWM2_8197F)) -+#define BIT_GET_HCI_HCPWM2_8197F(x) \ -+ (((x) >> BIT_SHIFT_HCI_HCPWM2_8197F) & BIT_MASK_HCI_HCPWM2_8197F) -+#define BIT_SET_HCI_HCPWM2_8197F(x, v) \ -+ (BIT_CLEAR_HCI_HCPWM2_8197F(x) | BIT_HCI_HCPWM2_8197F(v)) -+ -+/* 2 REG_HCI_H2C_MSG_V1_8197F */ -+ -+#define BIT_SHIFT_DRV2FW_INFO_8197F 0 -+#define BIT_MASK_DRV2FW_INFO_8197F 0xffffffffL -+#define BIT_DRV2FW_INFO_8197F(x) \ -+ (((x) & BIT_MASK_DRV2FW_INFO_8197F) << BIT_SHIFT_DRV2FW_INFO_8197F) -+#define BITS_DRV2FW_INFO_8197F \ -+ (BIT_MASK_DRV2FW_INFO_8197F << BIT_SHIFT_DRV2FW_INFO_8197F) -+#define BIT_CLEAR_DRV2FW_INFO_8197F(x) ((x) & (~BITS_DRV2FW_INFO_8197F)) -+#define BIT_GET_DRV2FW_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_DRV2FW_INFO_8197F) & BIT_MASK_DRV2FW_INFO_8197F) -+#define BIT_SET_DRV2FW_INFO_8197F(x, v) \ -+ (BIT_CLEAR_DRV2FW_INFO_8197F(x) | BIT_DRV2FW_INFO_8197F(v)) -+ -+/* 2 REG_HCI_C2H_MSG_V1_8197F */ -+ -+#define BIT_SHIFT_HCI_C2H_MSG_8197F 0 -+#define BIT_MASK_HCI_C2H_MSG_8197F 0xffffffffL -+#define BIT_HCI_C2H_MSG_8197F(x) \ -+ (((x) & BIT_MASK_HCI_C2H_MSG_8197F) << BIT_SHIFT_HCI_C2H_MSG_8197F) -+#define BITS_HCI_C2H_MSG_8197F \ -+ (BIT_MASK_HCI_C2H_MSG_8197F << BIT_SHIFT_HCI_C2H_MSG_8197F) -+#define BIT_CLEAR_HCI_C2H_MSG_8197F(x) ((x) & (~BITS_HCI_C2H_MSG_8197F)) -+#define BIT_GET_HCI_C2H_MSG_8197F(x) \ -+ (((x) >> BIT_SHIFT_HCI_C2H_MSG_8197F) & BIT_MASK_HCI_C2H_MSG_8197F) -+#define BIT_SET_HCI_C2H_MSG_8197F(x, v) \ -+ (BIT_CLEAR_HCI_C2H_MSG_8197F(x) | BIT_HCI_C2H_MSG_8197F(v)) -+ -+/* 2 REG_DBI_WDATA_V1_8197F */ -+ -+#define BIT_SHIFT_DBI_WDATA_8197F 0 -+#define BIT_MASK_DBI_WDATA_8197F 0xffffffffL -+#define BIT_DBI_WDATA_8197F(x) \ -+ (((x) & BIT_MASK_DBI_WDATA_8197F) << BIT_SHIFT_DBI_WDATA_8197F) -+#define BITS_DBI_WDATA_8197F \ -+ (BIT_MASK_DBI_WDATA_8197F << BIT_SHIFT_DBI_WDATA_8197F) -+#define BIT_CLEAR_DBI_WDATA_8197F(x) ((x) & (~BITS_DBI_WDATA_8197F)) -+#define BIT_GET_DBI_WDATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBI_WDATA_8197F) & BIT_MASK_DBI_WDATA_8197F) -+#define BIT_SET_DBI_WDATA_8197F(x, v) \ -+ (BIT_CLEAR_DBI_WDATA_8197F(x) | BIT_DBI_WDATA_8197F(v)) -+ -+/* 2 REG_DBI_RDATA_V1_8197F */ -+ -+#define BIT_SHIFT_DBI_RDATA_8197F 0 -+#define BIT_MASK_DBI_RDATA_8197F 0xffffffffL -+#define BIT_DBI_RDATA_8197F(x) \ -+ (((x) & BIT_MASK_DBI_RDATA_8197F) << BIT_SHIFT_DBI_RDATA_8197F) -+#define BITS_DBI_RDATA_8197F \ -+ (BIT_MASK_DBI_RDATA_8197F << BIT_SHIFT_DBI_RDATA_8197F) -+#define BIT_CLEAR_DBI_RDATA_8197F(x) ((x) & (~BITS_DBI_RDATA_8197F)) -+#define BIT_GET_DBI_RDATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBI_RDATA_8197F) & BIT_MASK_DBI_RDATA_8197F) -+#define BIT_SET_DBI_RDATA_8197F(x, v) \ -+ (BIT_CLEAR_DBI_RDATA_8197F(x) | BIT_DBI_RDATA_8197F(v)) -+ -+/* 2 REG_STUCK_FLAG_V1_8197F */ -+#define BIT_EN_STUCK_DBG_8197F BIT(26) -+#define BIT_RX_STUCK_8197F BIT(25) -+#define BIT_TX_STUCK_8197F BIT(24) -+#define BIT_DBI_RFLAG_8197F BIT(17) -+#define BIT_DBI_WFLAG_8197F BIT(16) -+ -+#define BIT_SHIFT_DBI_WREN_8197F 12 -+#define BIT_MASK_DBI_WREN_8197F 0xf -+#define BIT_DBI_WREN_8197F(x) \ -+ (((x) & BIT_MASK_DBI_WREN_8197F) << BIT_SHIFT_DBI_WREN_8197F) -+#define BITS_DBI_WREN_8197F \ -+ (BIT_MASK_DBI_WREN_8197F << BIT_SHIFT_DBI_WREN_8197F) -+#define BIT_CLEAR_DBI_WREN_8197F(x) ((x) & (~BITS_DBI_WREN_8197F)) -+#define BIT_GET_DBI_WREN_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBI_WREN_8197F) & BIT_MASK_DBI_WREN_8197F) -+#define BIT_SET_DBI_WREN_8197F(x, v) \ -+ (BIT_CLEAR_DBI_WREN_8197F(x) | BIT_DBI_WREN_8197F(v)) -+ -+#define BIT_SHIFT_DBI_ADDR_8197F 0 -+#define BIT_MASK_DBI_ADDR_8197F 0xfff -+#define BIT_DBI_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_DBI_ADDR_8197F) << BIT_SHIFT_DBI_ADDR_8197F) -+#define BITS_DBI_ADDR_8197F \ -+ (BIT_MASK_DBI_ADDR_8197F << BIT_SHIFT_DBI_ADDR_8197F) -+#define BIT_CLEAR_DBI_ADDR_8197F(x) ((x) & (~BITS_DBI_ADDR_8197F)) -+#define BIT_GET_DBI_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_DBI_ADDR_8197F) & BIT_MASK_DBI_ADDR_8197F) -+#define BIT_SET_DBI_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_DBI_ADDR_8197F(x) | BIT_DBI_ADDR_8197F(v)) -+ -+/* 2 REG_MDIO_V1_8197F */ -+ -+#define BIT_SHIFT_MDIO_RDATA_8197F 16 -+#define BIT_MASK_MDIO_RDATA_8197F 0xffff -+#define BIT_MDIO_RDATA_8197F(x) \ -+ (((x) & BIT_MASK_MDIO_RDATA_8197F) << BIT_SHIFT_MDIO_RDATA_8197F) -+#define BITS_MDIO_RDATA_8197F \ -+ (BIT_MASK_MDIO_RDATA_8197F << BIT_SHIFT_MDIO_RDATA_8197F) -+#define BIT_CLEAR_MDIO_RDATA_8197F(x) ((x) & (~BITS_MDIO_RDATA_8197F)) -+#define BIT_GET_MDIO_RDATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_MDIO_RDATA_8197F) & BIT_MASK_MDIO_RDATA_8197F) -+#define BIT_SET_MDIO_RDATA_8197F(x, v) \ -+ (BIT_CLEAR_MDIO_RDATA_8197F(x) | BIT_MDIO_RDATA_8197F(v)) -+ -+#define BIT_SHIFT_MDIO_WDATA_8197F 0 -+#define BIT_MASK_MDIO_WDATA_8197F 0xffff -+#define BIT_MDIO_WDATA_8197F(x) \ -+ (((x) & BIT_MASK_MDIO_WDATA_8197F) << BIT_SHIFT_MDIO_WDATA_8197F) -+#define BITS_MDIO_WDATA_8197F \ -+ (BIT_MASK_MDIO_WDATA_8197F << BIT_SHIFT_MDIO_WDATA_8197F) -+#define BIT_CLEAR_MDIO_WDATA_8197F(x) ((x) & (~BITS_MDIO_WDATA_8197F)) -+#define BIT_GET_MDIO_WDATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_MDIO_WDATA_8197F) & BIT_MASK_MDIO_WDATA_8197F) -+#define BIT_SET_MDIO_WDATA_8197F(x, v) \ -+ (BIT_CLEAR_MDIO_WDATA_8197F(x) | BIT_MDIO_WDATA_8197F(v)) -+ -+/* 2 REG_WDT_CFG_8197F */ -+ -+#define BIT_SHIFT_MDIO_PHY_ADDR_8197F 24 -+#define BIT_MASK_MDIO_PHY_ADDR_8197F 0x1f -+#define BIT_MDIO_PHY_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_MDIO_PHY_ADDR_8197F) << BIT_SHIFT_MDIO_PHY_ADDR_8197F) -+#define BITS_MDIO_PHY_ADDR_8197F \ -+ (BIT_MASK_MDIO_PHY_ADDR_8197F << BIT_SHIFT_MDIO_PHY_ADDR_8197F) -+#define BIT_CLEAR_MDIO_PHY_ADDR_8197F(x) ((x) & (~BITS_MDIO_PHY_ADDR_8197F)) -+#define BIT_GET_MDIO_PHY_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_MDIO_PHY_ADDR_8197F) & BIT_MASK_MDIO_PHY_ADDR_8197F) -+#define BIT_SET_MDIO_PHY_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_MDIO_PHY_ADDR_8197F(x) | BIT_MDIO_PHY_ADDR_8197F(v)) -+ -+#define BIT_SHIFT_WATCH_DOG_RECORD_V1_8197F 10 -+#define BIT_MASK_WATCH_DOG_RECORD_V1_8197F 0x3fff -+#define BIT_WATCH_DOG_RECORD_V1_8197F(x) \ -+ (((x) & BIT_MASK_WATCH_DOG_RECORD_V1_8197F) \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8197F) -+#define BITS_WATCH_DOG_RECORD_V1_8197F \ -+ (BIT_MASK_WATCH_DOG_RECORD_V1_8197F \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8197F) -+#define BIT_CLEAR_WATCH_DOG_RECORD_V1_8197F(x) \ -+ ((x) & (~BITS_WATCH_DOG_RECORD_V1_8197F)) -+#define BIT_GET_WATCH_DOG_RECORD_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_WATCH_DOG_RECORD_V1_8197F) & \ -+ BIT_MASK_WATCH_DOG_RECORD_V1_8197F) -+#define BIT_SET_WATCH_DOG_RECORD_V1_8197F(x, v) \ -+ (BIT_CLEAR_WATCH_DOG_RECORD_V1_8197F(x) | \ -+ BIT_WATCH_DOG_RECORD_V1_8197F(v)) -+ -+#define BIT_R_IO_TIMEOUT_FLAG_V1_8197F BIT(9) -+#define BIT_EN_WATCH_DOG_V1_8197F BIT(8) -+#define BIT_ECRC_EN_V1_8197F BIT(7) -+#define BIT_MDIO_RFLAG_V1_8197F BIT(6) -+#define BIT_MDIO_WFLAG_V1_8197F BIT(5) -+ -+#define BIT_SHIFT_MDIO_REG_ADDR_8197F 0 -+#define BIT_MASK_MDIO_REG_ADDR_8197F 0x1f -+#define BIT_MDIO_REG_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_MDIO_REG_ADDR_8197F) << BIT_SHIFT_MDIO_REG_ADDR_8197F) -+#define BITS_MDIO_REG_ADDR_8197F \ -+ (BIT_MASK_MDIO_REG_ADDR_8197F << BIT_SHIFT_MDIO_REG_ADDR_8197F) -+#define BIT_CLEAR_MDIO_REG_ADDR_8197F(x) ((x) & (~BITS_MDIO_REG_ADDR_8197F)) -+#define BIT_GET_MDIO_REG_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_MDIO_REG_ADDR_8197F) & BIT_MASK_MDIO_REG_ADDR_8197F) -+#define BIT_SET_MDIO_REG_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_MDIO_REG_ADDR_8197F(x) | BIT_MDIO_REG_ADDR_8197F(v)) -+ -+/* 2 REG_HCI_MIX_CFG_8197F */ -+#define BIT_RXRST_BACKDOOR_8197F BIT(31) -+#define BIT_TXRST_BACKDOOR_8197F BIT(30) -+#define BIT_RXIDX_RSTB_8197F BIT(29) -+#define BIT_TXIDX_RSTB_8197F BIT(28) -+#define BIT_DROP_NEXT_RXPKT_8197F BIT(27) -+#define BIT_SHORT_CORE_RST_SEL_8197F BIT(26) -+#define BIT_EXCEPT_RESUME_EN_8197F BIT(25) -+#define BIT_EXCEPT_RESUME_FLAG_8197F BIT(24) -+#define BIT_ALIGN_MTU_8197F BIT(23) -+#define BIT_HOST_GEN2_SUPPORT_8197F BIT(20) -+ -+#define BIT_SHIFT_TXDMA_ERR_FLAG_8197F 16 -+#define BIT_MASK_TXDMA_ERR_FLAG_8197F 0xf -+#define BIT_TXDMA_ERR_FLAG_8197F(x) \ -+ (((x) & BIT_MASK_TXDMA_ERR_FLAG_8197F) \ -+ << BIT_SHIFT_TXDMA_ERR_FLAG_8197F) -+#define BITS_TXDMA_ERR_FLAG_8197F \ -+ (BIT_MASK_TXDMA_ERR_FLAG_8197F << BIT_SHIFT_TXDMA_ERR_FLAG_8197F) -+#define BIT_CLEAR_TXDMA_ERR_FLAG_8197F(x) ((x) & (~BITS_TXDMA_ERR_FLAG_8197F)) -+#define BIT_GET_TXDMA_ERR_FLAG_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_ERR_FLAG_8197F) & \ -+ BIT_MASK_TXDMA_ERR_FLAG_8197F) -+#define BIT_SET_TXDMA_ERR_FLAG_8197F(x, v) \ -+ (BIT_CLEAR_TXDMA_ERR_FLAG_8197F(x) | BIT_TXDMA_ERR_FLAG_8197F(v)) -+ -+#define BIT_SHIFT_EARLY_MODE_SEL_8197F 12 -+#define BIT_MASK_EARLY_MODE_SEL_8197F 0xf -+#define BIT_EARLY_MODE_SEL_8197F(x) \ -+ (((x) & BIT_MASK_EARLY_MODE_SEL_8197F) \ -+ << BIT_SHIFT_EARLY_MODE_SEL_8197F) -+#define BITS_EARLY_MODE_SEL_8197F \ -+ (BIT_MASK_EARLY_MODE_SEL_8197F << BIT_SHIFT_EARLY_MODE_SEL_8197F) -+#define BIT_CLEAR_EARLY_MODE_SEL_8197F(x) ((x) & (~BITS_EARLY_MODE_SEL_8197F)) -+#define BIT_GET_EARLY_MODE_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_EARLY_MODE_SEL_8197F) & \ -+ BIT_MASK_EARLY_MODE_SEL_8197F) -+#define BIT_SET_EARLY_MODE_SEL_8197F(x, v) \ -+ (BIT_CLEAR_EARLY_MODE_SEL_8197F(x) | BIT_EARLY_MODE_SEL_8197F(v)) -+ -+#define BIT_EPHY_RX50_EN_8197F BIT(11) -+ -+#define BIT_SHIFT_MSI_TIMEOUT_ID_V1_8197F 8 -+#define BIT_MASK_MSI_TIMEOUT_ID_V1_8197F 0x7 -+#define BIT_MSI_TIMEOUT_ID_V1_8197F(x) \ -+ (((x) & BIT_MASK_MSI_TIMEOUT_ID_V1_8197F) \ -+ << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8197F) -+#define BITS_MSI_TIMEOUT_ID_V1_8197F \ -+ (BIT_MASK_MSI_TIMEOUT_ID_V1_8197F << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8197F) -+#define BIT_CLEAR_MSI_TIMEOUT_ID_V1_8197F(x) \ -+ ((x) & (~BITS_MSI_TIMEOUT_ID_V1_8197F)) -+#define BIT_GET_MSI_TIMEOUT_ID_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_MSI_TIMEOUT_ID_V1_8197F) & \ -+ BIT_MASK_MSI_TIMEOUT_ID_V1_8197F) -+#define BIT_SET_MSI_TIMEOUT_ID_V1_8197F(x, v) \ -+ (BIT_CLEAR_MSI_TIMEOUT_ID_V1_8197F(x) | BIT_MSI_TIMEOUT_ID_V1_8197F(v)) -+ -+#define BIT_RADDR_RD_8197F BIT(7) -+#define BIT_EN_MUL_TAG_8197F BIT(6) -+#define BIT_EN_EARLY_MODE_8197F BIT(5) -+#define BIT_L0S_LINK_OFF_8197F BIT(4) -+#define BIT_ACT_LINK_OFF_8197F BIT(3) -+ -+/* 2 REG_STC_INT_CS_8197F(HCI STATE CHANGE INTERRUPT CONTROL AND STATUS) */ -+#define BIT_STC_INT_EN_8197F BIT(31) -+ -+#define BIT_SHIFT_STC_INT_FLAG_8197F 16 -+#define BIT_MASK_STC_INT_FLAG_8197F 0xff -+#define BIT_STC_INT_FLAG_8197F(x) \ -+ (((x) & BIT_MASK_STC_INT_FLAG_8197F) << BIT_SHIFT_STC_INT_FLAG_8197F) -+#define BITS_STC_INT_FLAG_8197F \ -+ (BIT_MASK_STC_INT_FLAG_8197F << BIT_SHIFT_STC_INT_FLAG_8197F) -+#define BIT_CLEAR_STC_INT_FLAG_8197F(x) ((x) & (~BITS_STC_INT_FLAG_8197F)) -+#define BIT_GET_STC_INT_FLAG_8197F(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_FLAG_8197F) & BIT_MASK_STC_INT_FLAG_8197F) -+#define BIT_SET_STC_INT_FLAG_8197F(x, v) \ -+ (BIT_CLEAR_STC_INT_FLAG_8197F(x) | BIT_STC_INT_FLAG_8197F(v)) -+ -+#define BIT_SHIFT_STC_INT_IDX_8197F 8 -+#define BIT_MASK_STC_INT_IDX_8197F 0x7 -+#define BIT_STC_INT_IDX_8197F(x) \ -+ (((x) & BIT_MASK_STC_INT_IDX_8197F) << BIT_SHIFT_STC_INT_IDX_8197F) -+#define BITS_STC_INT_IDX_8197F \ -+ (BIT_MASK_STC_INT_IDX_8197F << BIT_SHIFT_STC_INT_IDX_8197F) -+#define BIT_CLEAR_STC_INT_IDX_8197F(x) ((x) & (~BITS_STC_INT_IDX_8197F)) -+#define BIT_GET_STC_INT_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_IDX_8197F) & BIT_MASK_STC_INT_IDX_8197F) -+#define BIT_SET_STC_INT_IDX_8197F(x, v) \ -+ (BIT_CLEAR_STC_INT_IDX_8197F(x) | BIT_STC_INT_IDX_8197F(v)) -+ -+#define BIT_SHIFT_STC_INT_REALTIME_CS_8197F 0 -+#define BIT_MASK_STC_INT_REALTIME_CS_8197F 0x3f -+#define BIT_STC_INT_REALTIME_CS_8197F(x) \ -+ (((x) & BIT_MASK_STC_INT_REALTIME_CS_8197F) \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8197F) -+#define BITS_STC_INT_REALTIME_CS_8197F \ -+ (BIT_MASK_STC_INT_REALTIME_CS_8197F \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8197F) -+#define BIT_CLEAR_STC_INT_REALTIME_CS_8197F(x) \ -+ ((x) & (~BITS_STC_INT_REALTIME_CS_8197F)) -+#define BIT_GET_STC_INT_REALTIME_CS_8197F(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_REALTIME_CS_8197F) & \ -+ BIT_MASK_STC_INT_REALTIME_CS_8197F) -+#define BIT_SET_STC_INT_REALTIME_CS_8197F(x, v) \ -+ (BIT_CLEAR_STC_INT_REALTIME_CS_8197F(x) | \ -+ BIT_STC_INT_REALTIME_CS_8197F(v)) -+ -+/* 2 REG_ST_INT_CFG_8197F(HCI STATE CHANGE INTERRUPT CONFIGURATION) */ -+#define BIT_STC_INT_GRP_EN_8197F BIT(31) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_LS_8197F 8 -+#define BIT_MASK_STC_INT_EXPECT_LS_8197F 0x3f -+#define BIT_STC_INT_EXPECT_LS_8197F(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_LS_8197F) \ -+ << BIT_SHIFT_STC_INT_EXPECT_LS_8197F) -+#define BITS_STC_INT_EXPECT_LS_8197F \ -+ (BIT_MASK_STC_INT_EXPECT_LS_8197F << BIT_SHIFT_STC_INT_EXPECT_LS_8197F) -+#define BIT_CLEAR_STC_INT_EXPECT_LS_8197F(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_LS_8197F)) -+#define BIT_GET_STC_INT_EXPECT_LS_8197F(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_LS_8197F) & \ -+ BIT_MASK_STC_INT_EXPECT_LS_8197F) -+#define BIT_SET_STC_INT_EXPECT_LS_8197F(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_LS_8197F(x) | BIT_STC_INT_EXPECT_LS_8197F(v)) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_CS_8197F 0 -+#define BIT_MASK_STC_INT_EXPECT_CS_8197F 0x3f -+#define BIT_STC_INT_EXPECT_CS_8197F(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_CS_8197F) \ -+ << BIT_SHIFT_STC_INT_EXPECT_CS_8197F) -+#define BITS_STC_INT_EXPECT_CS_8197F \ -+ (BIT_MASK_STC_INT_EXPECT_CS_8197F << BIT_SHIFT_STC_INT_EXPECT_CS_8197F) -+#define BIT_CLEAR_STC_INT_EXPECT_CS_8197F(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_CS_8197F)) -+#define BIT_GET_STC_INT_EXPECT_CS_8197F(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_CS_8197F) & \ -+ BIT_MASK_STC_INT_EXPECT_CS_8197F) -+#define BIT_SET_STC_INT_EXPECT_CS_8197F(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_CS_8197F(x) | BIT_STC_INT_EXPECT_CS_8197F(v)) -+ -+/* 2 REG_CMU_DLY_CTRL_8197F(HCI PHY CLOCK MGT UNIT DELAY CONTROL ) */ -+#define BIT_CMU_DLY_EN_8197F BIT(31) -+#define BIT_CMU_DLY_MODE_8197F BIT(30) -+ -+#define BIT_SHIFT_CMU_DLY_PRE_DIV_8197F 0 -+#define BIT_MASK_CMU_DLY_PRE_DIV_8197F 0xff -+#define BIT_CMU_DLY_PRE_DIV_8197F(x) \ -+ (((x) & BIT_MASK_CMU_DLY_PRE_DIV_8197F) \ -+ << BIT_SHIFT_CMU_DLY_PRE_DIV_8197F) -+#define BITS_CMU_DLY_PRE_DIV_8197F \ -+ (BIT_MASK_CMU_DLY_PRE_DIV_8197F << BIT_SHIFT_CMU_DLY_PRE_DIV_8197F) -+#define BIT_CLEAR_CMU_DLY_PRE_DIV_8197F(x) ((x) & (~BITS_CMU_DLY_PRE_DIV_8197F)) -+#define BIT_GET_CMU_DLY_PRE_DIV_8197F(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_PRE_DIV_8197F) & \ -+ BIT_MASK_CMU_DLY_PRE_DIV_8197F) -+#define BIT_SET_CMU_DLY_PRE_DIV_8197F(x, v) \ -+ (BIT_CLEAR_CMU_DLY_PRE_DIV_8197F(x) | BIT_CMU_DLY_PRE_DIV_8197F(v)) -+ -+/* 2 REG_CMU_DLY_CFG_8197F(HCI PHY CLOCK MGT UNIT DELAY CONFIGURATION ) */ -+ -+#define BIT_SHIFT_CMU_DLY_LTR_A2I_8197F 24 -+#define BIT_MASK_CMU_DLY_LTR_A2I_8197F 0xff -+#define BIT_CMU_DLY_LTR_A2I_8197F(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_A2I_8197F) \ -+ << BIT_SHIFT_CMU_DLY_LTR_A2I_8197F) -+#define BITS_CMU_DLY_LTR_A2I_8197F \ -+ (BIT_MASK_CMU_DLY_LTR_A2I_8197F << BIT_SHIFT_CMU_DLY_LTR_A2I_8197F) -+#define BIT_CLEAR_CMU_DLY_LTR_A2I_8197F(x) ((x) & (~BITS_CMU_DLY_LTR_A2I_8197F)) -+#define BIT_GET_CMU_DLY_LTR_A2I_8197F(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_A2I_8197F) & \ -+ BIT_MASK_CMU_DLY_LTR_A2I_8197F) -+#define BIT_SET_CMU_DLY_LTR_A2I_8197F(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_A2I_8197F(x) | BIT_CMU_DLY_LTR_A2I_8197F(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_I2A_8197F 16 -+#define BIT_MASK_CMU_DLY_LTR_I2A_8197F 0xff -+#define BIT_CMU_DLY_LTR_I2A_8197F(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_I2A_8197F) \ -+ << BIT_SHIFT_CMU_DLY_LTR_I2A_8197F) -+#define BITS_CMU_DLY_LTR_I2A_8197F \ -+ (BIT_MASK_CMU_DLY_LTR_I2A_8197F << BIT_SHIFT_CMU_DLY_LTR_I2A_8197F) -+#define BIT_CLEAR_CMU_DLY_LTR_I2A_8197F(x) ((x) & (~BITS_CMU_DLY_LTR_I2A_8197F)) -+#define BIT_GET_CMU_DLY_LTR_I2A_8197F(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_I2A_8197F) & \ -+ BIT_MASK_CMU_DLY_LTR_I2A_8197F) -+#define BIT_SET_CMU_DLY_LTR_I2A_8197F(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_I2A_8197F(x) | BIT_CMU_DLY_LTR_I2A_8197F(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_IDLE_8197F 8 -+#define BIT_MASK_CMU_DLY_LTR_IDLE_8197F 0xff -+#define BIT_CMU_DLY_LTR_IDLE_8197F(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_IDLE_8197F) \ -+ << BIT_SHIFT_CMU_DLY_LTR_IDLE_8197F) -+#define BITS_CMU_DLY_LTR_IDLE_8197F \ -+ (BIT_MASK_CMU_DLY_LTR_IDLE_8197F << BIT_SHIFT_CMU_DLY_LTR_IDLE_8197F) -+#define BIT_CLEAR_CMU_DLY_LTR_IDLE_8197F(x) \ -+ ((x) & (~BITS_CMU_DLY_LTR_IDLE_8197F)) -+#define BIT_GET_CMU_DLY_LTR_IDLE_8197F(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_IDLE_8197F) & \ -+ BIT_MASK_CMU_DLY_LTR_IDLE_8197F) -+#define BIT_SET_CMU_DLY_LTR_IDLE_8197F(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_IDLE_8197F(x) | BIT_CMU_DLY_LTR_IDLE_8197F(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_ACT_8197F 0 -+#define BIT_MASK_CMU_DLY_LTR_ACT_8197F 0xff -+#define BIT_CMU_DLY_LTR_ACT_8197F(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_ACT_8197F) \ -+ << BIT_SHIFT_CMU_DLY_LTR_ACT_8197F) -+#define BITS_CMU_DLY_LTR_ACT_8197F \ -+ (BIT_MASK_CMU_DLY_LTR_ACT_8197F << BIT_SHIFT_CMU_DLY_LTR_ACT_8197F) -+#define BIT_CLEAR_CMU_DLY_LTR_ACT_8197F(x) ((x) & (~BITS_CMU_DLY_LTR_ACT_8197F)) -+#define BIT_GET_CMU_DLY_LTR_ACT_8197F(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_ACT_8197F) & \ -+ BIT_MASK_CMU_DLY_LTR_ACT_8197F) -+#define BIT_SET_CMU_DLY_LTR_ACT_8197F(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_ACT_8197F(x) | BIT_CMU_DLY_LTR_ACT_8197F(v)) -+ -+/* 2 REG_H2CQ_TXBD_DESA_8197F */ -+ -+#define BIT_SHIFT_H2CQ_TXBD_DESA_8197F 0 -+#define BIT_MASK_H2CQ_TXBD_DESA_8197F 0xffffffffffffffffL -+#define BIT_H2CQ_TXBD_DESA_8197F(x) \ -+ (((x) & BIT_MASK_H2CQ_TXBD_DESA_8197F) \ -+ << BIT_SHIFT_H2CQ_TXBD_DESA_8197F) -+#define BITS_H2CQ_TXBD_DESA_8197F \ -+ (BIT_MASK_H2CQ_TXBD_DESA_8197F << BIT_SHIFT_H2CQ_TXBD_DESA_8197F) -+#define BIT_CLEAR_H2CQ_TXBD_DESA_8197F(x) ((x) & (~BITS_H2CQ_TXBD_DESA_8197F)) -+#define BIT_GET_H2CQ_TXBD_DESA_8197F(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_TXBD_DESA_8197F) & \ -+ BIT_MASK_H2CQ_TXBD_DESA_8197F) -+#define BIT_SET_H2CQ_TXBD_DESA_8197F(x, v) \ -+ (BIT_CLEAR_H2CQ_TXBD_DESA_8197F(x) | BIT_H2CQ_TXBD_DESA_8197F(v)) -+ -+/* 2 REG_H2CQ_TXBD_NUM_8197F */ -+#define BIT_HCI_H2CQ_FLAG_8197F BIT(14) -+ -+#define BIT_SHIFT_H2CQ_DESC_MODE_8197F 12 -+#define BIT_MASK_H2CQ_DESC_MODE_8197F 0x3 -+#define BIT_H2CQ_DESC_MODE_8197F(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_MODE_8197F) \ -+ << BIT_SHIFT_H2CQ_DESC_MODE_8197F) -+#define BITS_H2CQ_DESC_MODE_8197F \ -+ (BIT_MASK_H2CQ_DESC_MODE_8197F << BIT_SHIFT_H2CQ_DESC_MODE_8197F) -+#define BIT_CLEAR_H2CQ_DESC_MODE_8197F(x) ((x) & (~BITS_H2CQ_DESC_MODE_8197F)) -+#define BIT_GET_H2CQ_DESC_MODE_8197F(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_MODE_8197F) & \ -+ BIT_MASK_H2CQ_DESC_MODE_8197F) -+#define BIT_SET_H2CQ_DESC_MODE_8197F(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_MODE_8197F(x) | BIT_H2CQ_DESC_MODE_8197F(v)) -+ -+#define BIT_SHIFT_H2CQ_DESC_NUM_8197F 0 -+#define BIT_MASK_H2CQ_DESC_NUM_8197F 0xfff -+#define BIT_H2CQ_DESC_NUM_8197F(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_NUM_8197F) << BIT_SHIFT_H2CQ_DESC_NUM_8197F) -+#define BITS_H2CQ_DESC_NUM_8197F \ -+ (BIT_MASK_H2CQ_DESC_NUM_8197F << BIT_SHIFT_H2CQ_DESC_NUM_8197F) -+#define BIT_CLEAR_H2CQ_DESC_NUM_8197F(x) ((x) & (~BITS_H2CQ_DESC_NUM_8197F)) -+#define BIT_GET_H2CQ_DESC_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_NUM_8197F) & BIT_MASK_H2CQ_DESC_NUM_8197F) -+#define BIT_SET_H2CQ_DESC_NUM_8197F(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_NUM_8197F(x) | BIT_H2CQ_DESC_NUM_8197F(v)) -+ -+/* 2 REG_H2CQ_TXBD_IDX_8197F */ -+ -+#define BIT_SHIFT_H2CQ_HW_IDX_8197F 16 -+#define BIT_MASK_H2CQ_HW_IDX_8197F 0xfff -+#define BIT_H2CQ_HW_IDX_8197F(x) \ -+ (((x) & BIT_MASK_H2CQ_HW_IDX_8197F) << BIT_SHIFT_H2CQ_HW_IDX_8197F) -+#define BITS_H2CQ_HW_IDX_8197F \ -+ (BIT_MASK_H2CQ_HW_IDX_8197F << BIT_SHIFT_H2CQ_HW_IDX_8197F) -+#define BIT_CLEAR_H2CQ_HW_IDX_8197F(x) ((x) & (~BITS_H2CQ_HW_IDX_8197F)) -+#define BIT_GET_H2CQ_HW_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HW_IDX_8197F) & BIT_MASK_H2CQ_HW_IDX_8197F) -+#define BIT_SET_H2CQ_HW_IDX_8197F(x, v) \ -+ (BIT_CLEAR_H2CQ_HW_IDX_8197F(x) | BIT_H2CQ_HW_IDX_8197F(v)) -+ -+#define BIT_SHIFT_H2CQ_HOST_IDX_8197F 0 -+#define BIT_MASK_H2CQ_HOST_IDX_8197F 0xfff -+#define BIT_H2CQ_HOST_IDX_8197F(x) \ -+ (((x) & BIT_MASK_H2CQ_HOST_IDX_8197F) << BIT_SHIFT_H2CQ_HOST_IDX_8197F) -+#define BITS_H2CQ_HOST_IDX_8197F \ -+ (BIT_MASK_H2CQ_HOST_IDX_8197F << BIT_SHIFT_H2CQ_HOST_IDX_8197F) -+#define BIT_CLEAR_H2CQ_HOST_IDX_8197F(x) ((x) & (~BITS_H2CQ_HOST_IDX_8197F)) -+#define BIT_GET_H2CQ_HOST_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HOST_IDX_8197F) & BIT_MASK_H2CQ_HOST_IDX_8197F) -+#define BIT_SET_H2CQ_HOST_IDX_8197F(x, v) \ -+ (BIT_CLEAR_H2CQ_HOST_IDX_8197F(x) | BIT_H2CQ_HOST_IDX_8197F(v)) -+ -+/* 2 REG_H2CQ_CSR_8197F[31:0] (H2CQ CONTROL AND STATUS) */ -+#define BIT_H2CQ_FULL_8197F BIT(31) -+#define BIT_CLR_H2CQ_HOST_IDX_8197F BIT(16) -+#define BIT_CLR_H2CQ_HW_IDX_8197F BIT(8) -+#define BIT_STOP_H2CQ_8197F BIT(0) -+ -+/* 2 REG_AXI_EXCEPT_CS_8197F[31:0] (AXI EXCEPTION CONTROL AND STATUS) */ -+#define BIT_AXI_RXDMA_TIMEOUT_RE_8197F BIT(21) -+#define BIT_AXI_TXDMA_TIMEOUT_RE_8197F BIT(20) -+#define BIT_AXI_DECERR_W_RE_8197F BIT(19) -+#define BIT_AXI_DECERR_R_RE_8197F BIT(18) -+#define BIT_AXI_SLVERR_W_RE_8197F BIT(17) -+#define BIT_AXI_SLVERR_R_RE_8197F BIT(16) -+#define BIT_AXI_RXDMA_TIMEOUT_IE_8197F BIT(13) -+#define BIT_AXI_TXDMA_TIMEOUT_IE_8197F BIT(12) -+#define BIT_AXI_DECERR_W_IE_8197F BIT(11) -+#define BIT_AXI_DECERR_R_IE_8197F BIT(10) -+#define BIT_AXI_SLVERR_W_IE_8197F BIT(9) -+#define BIT_AXI_SLVERR_R_IE_8197F BIT(8) -+#define BIT_AXI_RXDMA_TIMEOUT_FLAG_8197F BIT(5) -+#define BIT_AXI_TXDMA_TIMEOUT_FLAG_8197F BIT(4) -+#define BIT_AXI_DECERR_W_FLAG_8197F BIT(3) -+#define BIT_AXI_DECERR_R_FLAG_8197F BIT(2) -+#define BIT_AXI_SLVERR_W_FLAG_8197F BIT(1) -+#define BIT_AXI_SLVERR_R_FLAG_8197F BIT(0) -+ -+/* 2 REG_AXI_EXCEPT_TIME_8197F[31:0] (AXI EXCEPTION TIME CONTROL) */ -+ -+#define BIT_SHIFT_AXI_RECOVERY_TIME_8197F 24 -+#define BIT_MASK_AXI_RECOVERY_TIME_8197F 0xff -+#define BIT_AXI_RECOVERY_TIME_8197F(x) \ -+ (((x) & BIT_MASK_AXI_RECOVERY_TIME_8197F) \ -+ << BIT_SHIFT_AXI_RECOVERY_TIME_8197F) -+#define BITS_AXI_RECOVERY_TIME_8197F \ -+ (BIT_MASK_AXI_RECOVERY_TIME_8197F << BIT_SHIFT_AXI_RECOVERY_TIME_8197F) -+#define BIT_CLEAR_AXI_RECOVERY_TIME_8197F(x) \ -+ ((x) & (~BITS_AXI_RECOVERY_TIME_8197F)) -+#define BIT_GET_AXI_RECOVERY_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_AXI_RECOVERY_TIME_8197F) & \ -+ BIT_MASK_AXI_RECOVERY_TIME_8197F) -+#define BIT_SET_AXI_RECOVERY_TIME_8197F(x, v) \ -+ (BIT_CLEAR_AXI_RECOVERY_TIME_8197F(x) | BIT_AXI_RECOVERY_TIME_8197F(v)) -+ -+#define BIT_SHIFT_AXI_RXDMA_TIMEOUT_VAL_8197F 12 -+#define BIT_MASK_AXI_RXDMA_TIMEOUT_VAL_8197F 0xfff -+#define BIT_AXI_RXDMA_TIMEOUT_VAL_8197F(x) \ -+ (((x) & BIT_MASK_AXI_RXDMA_TIMEOUT_VAL_8197F) \ -+ << BIT_SHIFT_AXI_RXDMA_TIMEOUT_VAL_8197F) -+#define BITS_AXI_RXDMA_TIMEOUT_VAL_8197F \ -+ (BIT_MASK_AXI_RXDMA_TIMEOUT_VAL_8197F \ -+ << BIT_SHIFT_AXI_RXDMA_TIMEOUT_VAL_8197F) -+#define BIT_CLEAR_AXI_RXDMA_TIMEOUT_VAL_8197F(x) \ -+ ((x) & (~BITS_AXI_RXDMA_TIMEOUT_VAL_8197F)) -+#define BIT_GET_AXI_RXDMA_TIMEOUT_VAL_8197F(x) \ -+ (((x) >> BIT_SHIFT_AXI_RXDMA_TIMEOUT_VAL_8197F) & \ -+ BIT_MASK_AXI_RXDMA_TIMEOUT_VAL_8197F) -+#define BIT_SET_AXI_RXDMA_TIMEOUT_VAL_8197F(x, v) \ -+ (BIT_CLEAR_AXI_RXDMA_TIMEOUT_VAL_8197F(x) | \ -+ BIT_AXI_RXDMA_TIMEOUT_VAL_8197F(v)) -+ -+#define BIT_SHIFT_AXI_TXDMA_TIMEOUT_VAL_8197F 0 -+#define BIT_MASK_AXI_TXDMA_TIMEOUT_VAL_8197F 0xfff -+#define BIT_AXI_TXDMA_TIMEOUT_VAL_8197F(x) \ -+ (((x) & BIT_MASK_AXI_TXDMA_TIMEOUT_VAL_8197F) \ -+ << BIT_SHIFT_AXI_TXDMA_TIMEOUT_VAL_8197F) -+#define BITS_AXI_TXDMA_TIMEOUT_VAL_8197F \ -+ (BIT_MASK_AXI_TXDMA_TIMEOUT_VAL_8197F \ -+ << BIT_SHIFT_AXI_TXDMA_TIMEOUT_VAL_8197F) -+#define BIT_CLEAR_AXI_TXDMA_TIMEOUT_VAL_8197F(x) \ -+ ((x) & (~BITS_AXI_TXDMA_TIMEOUT_VAL_8197F)) -+#define BIT_GET_AXI_TXDMA_TIMEOUT_VAL_8197F(x) \ -+ (((x) >> BIT_SHIFT_AXI_TXDMA_TIMEOUT_VAL_8197F) & \ -+ BIT_MASK_AXI_TXDMA_TIMEOUT_VAL_8197F) -+#define BIT_SET_AXI_TXDMA_TIMEOUT_VAL_8197F(x, v) \ -+ (BIT_CLEAR_AXI_TXDMA_TIMEOUT_VAL_8197F(x) | \ -+ BIT_AXI_TXDMA_TIMEOUT_VAL_8197F(v)) -+ -+/* 2 REG_Q0_INFO_8197F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q0_V1_8197F 25 -+#define BIT_MASK_QUEUEMACID_Q0_V1_8197F 0x7f -+#define BIT_QUEUEMACID_Q0_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q0_V1_8197F) \ -+ << BIT_SHIFT_QUEUEMACID_Q0_V1_8197F) -+#define BITS_QUEUEMACID_Q0_V1_8197F \ -+ (BIT_MASK_QUEUEMACID_Q0_V1_8197F << BIT_SHIFT_QUEUEMACID_Q0_V1_8197F) -+#define BIT_CLEAR_QUEUEMACID_Q0_V1_8197F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q0_V1_8197F)) -+#define BIT_GET_QUEUEMACID_Q0_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q0_V1_8197F) & \ -+ BIT_MASK_QUEUEMACID_Q0_V1_8197F) -+#define BIT_SET_QUEUEMACID_Q0_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q0_V1_8197F(x) | BIT_QUEUEMACID_Q0_V1_8197F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q0_V1_8197F 23 -+#define BIT_MASK_QUEUEAC_Q0_V1_8197F 0x3 -+#define BIT_QUEUEAC_Q0_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q0_V1_8197F) << BIT_SHIFT_QUEUEAC_Q0_V1_8197F) -+#define BITS_QUEUEAC_Q0_V1_8197F \ -+ (BIT_MASK_QUEUEAC_Q0_V1_8197F << BIT_SHIFT_QUEUEAC_Q0_V1_8197F) -+#define BIT_CLEAR_QUEUEAC_Q0_V1_8197F(x) ((x) & (~BITS_QUEUEAC_Q0_V1_8197F)) -+#define BIT_GET_QUEUEAC_Q0_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q0_V1_8197F) & BIT_MASK_QUEUEAC_Q0_V1_8197F) -+#define BIT_SET_QUEUEAC_Q0_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q0_V1_8197F(x) | BIT_QUEUEAC_Q0_V1_8197F(v)) -+ -+#define BIT_TIDEMPTY_Q0_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q0_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_Q0_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_Q0_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q0_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_Q0_V2_8197F) -+#define BITS_TAIL_PKT_Q0_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_Q0_V2_8197F << BIT_SHIFT_TAIL_PKT_Q0_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_Q0_V2_8197F(x) ((x) & (~BITS_TAIL_PKT_Q0_V2_8197F)) -+#define BIT_GET_TAIL_PKT_Q0_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q0_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_Q0_V2_8197F) -+#define BIT_SET_TAIL_PKT_Q0_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q0_V2_8197F(x) | BIT_TAIL_PKT_Q0_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q0_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_Q0_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_Q0_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q0_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_Q0_V1_8197F) -+#define BITS_HEAD_PKT_Q0_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_Q0_V1_8197F << BIT_SHIFT_HEAD_PKT_Q0_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_Q0_V1_8197F(x) ((x) & (~BITS_HEAD_PKT_Q0_V1_8197F)) -+#define BIT_GET_HEAD_PKT_Q0_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q0_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_Q0_V1_8197F) -+#define BIT_SET_HEAD_PKT_Q0_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q0_V1_8197F(x) | BIT_HEAD_PKT_Q0_V1_8197F(v)) -+ -+/* 2 REG_Q1_INFO_8197F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q1_V1_8197F 25 -+#define BIT_MASK_QUEUEMACID_Q1_V1_8197F 0x7f -+#define BIT_QUEUEMACID_Q1_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q1_V1_8197F) \ -+ << BIT_SHIFT_QUEUEMACID_Q1_V1_8197F) -+#define BITS_QUEUEMACID_Q1_V1_8197F \ -+ (BIT_MASK_QUEUEMACID_Q1_V1_8197F << BIT_SHIFT_QUEUEMACID_Q1_V1_8197F) -+#define BIT_CLEAR_QUEUEMACID_Q1_V1_8197F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q1_V1_8197F)) -+#define BIT_GET_QUEUEMACID_Q1_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q1_V1_8197F) & \ -+ BIT_MASK_QUEUEMACID_Q1_V1_8197F) -+#define BIT_SET_QUEUEMACID_Q1_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q1_V1_8197F(x) | BIT_QUEUEMACID_Q1_V1_8197F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q1_V1_8197F 23 -+#define BIT_MASK_QUEUEAC_Q1_V1_8197F 0x3 -+#define BIT_QUEUEAC_Q1_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q1_V1_8197F) << BIT_SHIFT_QUEUEAC_Q1_V1_8197F) -+#define BITS_QUEUEAC_Q1_V1_8197F \ -+ (BIT_MASK_QUEUEAC_Q1_V1_8197F << BIT_SHIFT_QUEUEAC_Q1_V1_8197F) -+#define BIT_CLEAR_QUEUEAC_Q1_V1_8197F(x) ((x) & (~BITS_QUEUEAC_Q1_V1_8197F)) -+#define BIT_GET_QUEUEAC_Q1_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q1_V1_8197F) & BIT_MASK_QUEUEAC_Q1_V1_8197F) -+#define BIT_SET_QUEUEAC_Q1_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q1_V1_8197F(x) | BIT_QUEUEAC_Q1_V1_8197F(v)) -+ -+#define BIT_TIDEMPTY_Q1_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q1_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_Q1_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_Q1_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q1_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_Q1_V2_8197F) -+#define BITS_TAIL_PKT_Q1_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_Q1_V2_8197F << BIT_SHIFT_TAIL_PKT_Q1_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_Q1_V2_8197F(x) ((x) & (~BITS_TAIL_PKT_Q1_V2_8197F)) -+#define BIT_GET_TAIL_PKT_Q1_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q1_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_Q1_V2_8197F) -+#define BIT_SET_TAIL_PKT_Q1_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q1_V2_8197F(x) | BIT_TAIL_PKT_Q1_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q1_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_Q1_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_Q1_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q1_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_Q1_V1_8197F) -+#define BITS_HEAD_PKT_Q1_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_Q1_V1_8197F << BIT_SHIFT_HEAD_PKT_Q1_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_Q1_V1_8197F(x) ((x) & (~BITS_HEAD_PKT_Q1_V1_8197F)) -+#define BIT_GET_HEAD_PKT_Q1_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q1_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_Q1_V1_8197F) -+#define BIT_SET_HEAD_PKT_Q1_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q1_V1_8197F(x) | BIT_HEAD_PKT_Q1_V1_8197F(v)) -+ -+/* 2 REG_Q2_INFO_8197F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q2_V1_8197F 25 -+#define BIT_MASK_QUEUEMACID_Q2_V1_8197F 0x7f -+#define BIT_QUEUEMACID_Q2_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q2_V1_8197F) \ -+ << BIT_SHIFT_QUEUEMACID_Q2_V1_8197F) -+#define BITS_QUEUEMACID_Q2_V1_8197F \ -+ (BIT_MASK_QUEUEMACID_Q2_V1_8197F << BIT_SHIFT_QUEUEMACID_Q2_V1_8197F) -+#define BIT_CLEAR_QUEUEMACID_Q2_V1_8197F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q2_V1_8197F)) -+#define BIT_GET_QUEUEMACID_Q2_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q2_V1_8197F) & \ -+ BIT_MASK_QUEUEMACID_Q2_V1_8197F) -+#define BIT_SET_QUEUEMACID_Q2_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q2_V1_8197F(x) | BIT_QUEUEMACID_Q2_V1_8197F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q2_V1_8197F 23 -+#define BIT_MASK_QUEUEAC_Q2_V1_8197F 0x3 -+#define BIT_QUEUEAC_Q2_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q2_V1_8197F) << BIT_SHIFT_QUEUEAC_Q2_V1_8197F) -+#define BITS_QUEUEAC_Q2_V1_8197F \ -+ (BIT_MASK_QUEUEAC_Q2_V1_8197F << BIT_SHIFT_QUEUEAC_Q2_V1_8197F) -+#define BIT_CLEAR_QUEUEAC_Q2_V1_8197F(x) ((x) & (~BITS_QUEUEAC_Q2_V1_8197F)) -+#define BIT_GET_QUEUEAC_Q2_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q2_V1_8197F) & BIT_MASK_QUEUEAC_Q2_V1_8197F) -+#define BIT_SET_QUEUEAC_Q2_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q2_V1_8197F(x) | BIT_QUEUEAC_Q2_V1_8197F(v)) -+ -+#define BIT_TIDEMPTY_Q2_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q2_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_Q2_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_Q2_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q2_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_Q2_V2_8197F) -+#define BITS_TAIL_PKT_Q2_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_Q2_V2_8197F << BIT_SHIFT_TAIL_PKT_Q2_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_Q2_V2_8197F(x) ((x) & (~BITS_TAIL_PKT_Q2_V2_8197F)) -+#define BIT_GET_TAIL_PKT_Q2_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q2_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_Q2_V2_8197F) -+#define BIT_SET_TAIL_PKT_Q2_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q2_V2_8197F(x) | BIT_TAIL_PKT_Q2_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q2_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_Q2_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_Q2_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q2_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_Q2_V1_8197F) -+#define BITS_HEAD_PKT_Q2_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_Q2_V1_8197F << BIT_SHIFT_HEAD_PKT_Q2_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_Q2_V1_8197F(x) ((x) & (~BITS_HEAD_PKT_Q2_V1_8197F)) -+#define BIT_GET_HEAD_PKT_Q2_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q2_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_Q2_V1_8197F) -+#define BIT_SET_HEAD_PKT_Q2_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q2_V1_8197F(x) | BIT_HEAD_PKT_Q2_V1_8197F(v)) -+ -+/* 2 REG_Q3_INFO_8197F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q3_V1_8197F 25 -+#define BIT_MASK_QUEUEMACID_Q3_V1_8197F 0x7f -+#define BIT_QUEUEMACID_Q3_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q3_V1_8197F) \ -+ << BIT_SHIFT_QUEUEMACID_Q3_V1_8197F) -+#define BITS_QUEUEMACID_Q3_V1_8197F \ -+ (BIT_MASK_QUEUEMACID_Q3_V1_8197F << BIT_SHIFT_QUEUEMACID_Q3_V1_8197F) -+#define BIT_CLEAR_QUEUEMACID_Q3_V1_8197F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q3_V1_8197F)) -+#define BIT_GET_QUEUEMACID_Q3_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q3_V1_8197F) & \ -+ BIT_MASK_QUEUEMACID_Q3_V1_8197F) -+#define BIT_SET_QUEUEMACID_Q3_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q3_V1_8197F(x) | BIT_QUEUEMACID_Q3_V1_8197F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q3_V1_8197F 23 -+#define BIT_MASK_QUEUEAC_Q3_V1_8197F 0x3 -+#define BIT_QUEUEAC_Q3_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q3_V1_8197F) << BIT_SHIFT_QUEUEAC_Q3_V1_8197F) -+#define BITS_QUEUEAC_Q3_V1_8197F \ -+ (BIT_MASK_QUEUEAC_Q3_V1_8197F << BIT_SHIFT_QUEUEAC_Q3_V1_8197F) -+#define BIT_CLEAR_QUEUEAC_Q3_V1_8197F(x) ((x) & (~BITS_QUEUEAC_Q3_V1_8197F)) -+#define BIT_GET_QUEUEAC_Q3_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q3_V1_8197F) & BIT_MASK_QUEUEAC_Q3_V1_8197F) -+#define BIT_SET_QUEUEAC_Q3_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q3_V1_8197F(x) | BIT_QUEUEAC_Q3_V1_8197F(v)) -+ -+#define BIT_TIDEMPTY_Q3_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q3_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_Q3_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_Q3_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q3_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_Q3_V2_8197F) -+#define BITS_TAIL_PKT_Q3_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_Q3_V2_8197F << BIT_SHIFT_TAIL_PKT_Q3_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_Q3_V2_8197F(x) ((x) & (~BITS_TAIL_PKT_Q3_V2_8197F)) -+#define BIT_GET_TAIL_PKT_Q3_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q3_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_Q3_V2_8197F) -+#define BIT_SET_TAIL_PKT_Q3_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q3_V2_8197F(x) | BIT_TAIL_PKT_Q3_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q3_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_Q3_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_Q3_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q3_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_Q3_V1_8197F) -+#define BITS_HEAD_PKT_Q3_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_Q3_V1_8197F << BIT_SHIFT_HEAD_PKT_Q3_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_Q3_V1_8197F(x) ((x) & (~BITS_HEAD_PKT_Q3_V1_8197F)) -+#define BIT_GET_HEAD_PKT_Q3_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q3_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_Q3_V1_8197F) -+#define BIT_SET_HEAD_PKT_Q3_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q3_V1_8197F(x) | BIT_HEAD_PKT_Q3_V1_8197F(v)) -+ -+/* 2 REG_MGQ_INFO_8197F */ -+ -+#define BIT_SHIFT_QUEUEMACID_MGQ_V1_8197F 25 -+#define BIT_MASK_QUEUEMACID_MGQ_V1_8197F 0x7f -+#define BIT_QUEUEMACID_MGQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_MGQ_V1_8197F) \ -+ << BIT_SHIFT_QUEUEMACID_MGQ_V1_8197F) -+#define BITS_QUEUEMACID_MGQ_V1_8197F \ -+ (BIT_MASK_QUEUEMACID_MGQ_V1_8197F << BIT_SHIFT_QUEUEMACID_MGQ_V1_8197F) -+#define BIT_CLEAR_QUEUEMACID_MGQ_V1_8197F(x) \ -+ ((x) & (~BITS_QUEUEMACID_MGQ_V1_8197F)) -+#define BIT_GET_QUEUEMACID_MGQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_MGQ_V1_8197F) & \ -+ BIT_MASK_QUEUEMACID_MGQ_V1_8197F) -+#define BIT_SET_QUEUEMACID_MGQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_MGQ_V1_8197F(x) | BIT_QUEUEMACID_MGQ_V1_8197F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_MGQ_V1_8197F 23 -+#define BIT_MASK_QUEUEAC_MGQ_V1_8197F 0x3 -+#define BIT_QUEUEAC_MGQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_MGQ_V1_8197F) \ -+ << BIT_SHIFT_QUEUEAC_MGQ_V1_8197F) -+#define BITS_QUEUEAC_MGQ_V1_8197F \ -+ (BIT_MASK_QUEUEAC_MGQ_V1_8197F << BIT_SHIFT_QUEUEAC_MGQ_V1_8197F) -+#define BIT_CLEAR_QUEUEAC_MGQ_V1_8197F(x) ((x) & (~BITS_QUEUEAC_MGQ_V1_8197F)) -+#define BIT_GET_QUEUEAC_MGQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_MGQ_V1_8197F) & \ -+ BIT_MASK_QUEUEAC_MGQ_V1_8197F) -+#define BIT_SET_QUEUEAC_MGQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_MGQ_V1_8197F(x) | BIT_QUEUEAC_MGQ_V1_8197F(v)) -+ -+#define BIT_TIDEMPTY_MGQ_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_MGQ_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_MGQ_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_MGQ_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_MGQ_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_MGQ_V2_8197F) -+#define BITS_TAIL_PKT_MGQ_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_MGQ_V2_8197F << BIT_SHIFT_TAIL_PKT_MGQ_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_MGQ_V2_8197F(x) ((x) & (~BITS_TAIL_PKT_MGQ_V2_8197F)) -+#define BIT_GET_TAIL_PKT_MGQ_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_MGQ_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_MGQ_V2_8197F) -+#define BIT_SET_TAIL_PKT_MGQ_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_MGQ_V2_8197F(x) | BIT_TAIL_PKT_MGQ_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_MGQ_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_MGQ_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_MGQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_MGQ_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_MGQ_V1_8197F) -+#define BITS_HEAD_PKT_MGQ_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_MGQ_V1_8197F << BIT_SHIFT_HEAD_PKT_MGQ_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_MGQ_V1_8197F(x) ((x) & (~BITS_HEAD_PKT_MGQ_V1_8197F)) -+#define BIT_GET_HEAD_PKT_MGQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_MGQ_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_MGQ_V1_8197F) -+#define BIT_SET_HEAD_PKT_MGQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_MGQ_V1_8197F(x) | BIT_HEAD_PKT_MGQ_V1_8197F(v)) -+ -+/* 2 REG_HIQ_INFO_8197F */ -+ -+#define BIT_SHIFT_QUEUEMACID_HIQ_V1_8197F 25 -+#define BIT_MASK_QUEUEMACID_HIQ_V1_8197F 0x7f -+#define BIT_QUEUEMACID_HIQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_HIQ_V1_8197F) \ -+ << BIT_SHIFT_QUEUEMACID_HIQ_V1_8197F) -+#define BITS_QUEUEMACID_HIQ_V1_8197F \ -+ (BIT_MASK_QUEUEMACID_HIQ_V1_8197F << BIT_SHIFT_QUEUEMACID_HIQ_V1_8197F) -+#define BIT_CLEAR_QUEUEMACID_HIQ_V1_8197F(x) \ -+ ((x) & (~BITS_QUEUEMACID_HIQ_V1_8197F)) -+#define BIT_GET_QUEUEMACID_HIQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_HIQ_V1_8197F) & \ -+ BIT_MASK_QUEUEMACID_HIQ_V1_8197F) -+#define BIT_SET_QUEUEMACID_HIQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_HIQ_V1_8197F(x) | BIT_QUEUEMACID_HIQ_V1_8197F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_HIQ_V1_8197F 23 -+#define BIT_MASK_QUEUEAC_HIQ_V1_8197F 0x3 -+#define BIT_QUEUEAC_HIQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_HIQ_V1_8197F) \ -+ << BIT_SHIFT_QUEUEAC_HIQ_V1_8197F) -+#define BITS_QUEUEAC_HIQ_V1_8197F \ -+ (BIT_MASK_QUEUEAC_HIQ_V1_8197F << BIT_SHIFT_QUEUEAC_HIQ_V1_8197F) -+#define BIT_CLEAR_QUEUEAC_HIQ_V1_8197F(x) ((x) & (~BITS_QUEUEAC_HIQ_V1_8197F)) -+#define BIT_GET_QUEUEAC_HIQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_HIQ_V1_8197F) & \ -+ BIT_MASK_QUEUEAC_HIQ_V1_8197F) -+#define BIT_SET_QUEUEAC_HIQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_HIQ_V1_8197F(x) | BIT_QUEUEAC_HIQ_V1_8197F(v)) -+ -+#define BIT_TIDEMPTY_HIQ_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_HIQ_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_HIQ_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_HIQ_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_HIQ_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_HIQ_V2_8197F) -+#define BITS_TAIL_PKT_HIQ_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_HIQ_V2_8197F << BIT_SHIFT_TAIL_PKT_HIQ_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_HIQ_V2_8197F(x) ((x) & (~BITS_TAIL_PKT_HIQ_V2_8197F)) -+#define BIT_GET_TAIL_PKT_HIQ_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_HIQ_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_HIQ_V2_8197F) -+#define BIT_SET_TAIL_PKT_HIQ_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_HIQ_V2_8197F(x) | BIT_TAIL_PKT_HIQ_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_HIQ_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_HIQ_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_HIQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_HIQ_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_HIQ_V1_8197F) -+#define BITS_HEAD_PKT_HIQ_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_HIQ_V1_8197F << BIT_SHIFT_HEAD_PKT_HIQ_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_HIQ_V1_8197F(x) ((x) & (~BITS_HEAD_PKT_HIQ_V1_8197F)) -+#define BIT_GET_HEAD_PKT_HIQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_HIQ_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_HIQ_V1_8197F) -+#define BIT_SET_HEAD_PKT_HIQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_HIQ_V1_8197F(x) | BIT_HEAD_PKT_HIQ_V1_8197F(v)) -+ -+/* 2 REG_BCNQ_INFO_8197F */ -+ -+#define BIT_SHIFT_BCNQ_HEAD_PG_V1_8197F 0 -+#define BIT_MASK_BCNQ_HEAD_PG_V1_8197F 0xfff -+#define BIT_BCNQ_HEAD_PG_V1_8197F(x) \ -+ (((x) & BIT_MASK_BCNQ_HEAD_PG_V1_8197F) \ -+ << BIT_SHIFT_BCNQ_HEAD_PG_V1_8197F) -+#define BITS_BCNQ_HEAD_PG_V1_8197F \ -+ (BIT_MASK_BCNQ_HEAD_PG_V1_8197F << BIT_SHIFT_BCNQ_HEAD_PG_V1_8197F) -+#define BIT_CLEAR_BCNQ_HEAD_PG_V1_8197F(x) ((x) & (~BITS_BCNQ_HEAD_PG_V1_8197F)) -+#define BIT_GET_BCNQ_HEAD_PG_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_HEAD_PG_V1_8197F) & \ -+ BIT_MASK_BCNQ_HEAD_PG_V1_8197F) -+#define BIT_SET_BCNQ_HEAD_PG_V1_8197F(x, v) \ -+ (BIT_CLEAR_BCNQ_HEAD_PG_V1_8197F(x) | BIT_BCNQ_HEAD_PG_V1_8197F(v)) -+ -+/* 2 REG_TXPKT_EMPTY_8197F */ -+#define BIT_BCNQ_EMPTY_8197F BIT(11) -+#define BIT_HQQ_EMPTY_8197F BIT(10) -+#define BIT_MQQ_EMPTY_8197F BIT(9) -+#define BIT_MGQ_CPU_EMPTY_8197F BIT(8) -+#define BIT_AC7Q_EMPTY_8197F BIT(7) -+#define BIT_AC6Q_EMPTY_8197F BIT(6) -+#define BIT_AC5Q_EMPTY_8197F BIT(5) -+#define BIT_AC4Q_EMPTY_8197F BIT(4) -+#define BIT_AC3Q_EMPTY_8197F BIT(3) -+#define BIT_AC2Q_EMPTY_8197F BIT(2) -+#define BIT_AC1Q_EMPTY_8197F BIT(1) -+#define BIT_AC0Q_EMPTY_8197F BIT(0) -+ -+/* 2 REG_CPU_MGQ_INFO_8197F */ -+#define BIT_BCN1_POLL_8197F BIT(30) -+#define BIT_CPUMGT_POLL_8197F BIT(29) -+#define BIT_BCN_POLL_8197F BIT(28) -+#define BIT_CPUMGQ_FW_NUM_V1_8197F BIT(12) -+ -+#define BIT_SHIFT_FW_FREE_TAIL_V1_8197F 0 -+#define BIT_MASK_FW_FREE_TAIL_V1_8197F 0xfff -+#define BIT_FW_FREE_TAIL_V1_8197F(x) \ -+ (((x) & BIT_MASK_FW_FREE_TAIL_V1_8197F) \ -+ << BIT_SHIFT_FW_FREE_TAIL_V1_8197F) -+#define BITS_FW_FREE_TAIL_V1_8197F \ -+ (BIT_MASK_FW_FREE_TAIL_V1_8197F << BIT_SHIFT_FW_FREE_TAIL_V1_8197F) -+#define BIT_CLEAR_FW_FREE_TAIL_V1_8197F(x) ((x) & (~BITS_FW_FREE_TAIL_V1_8197F)) -+#define BIT_GET_FW_FREE_TAIL_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_FW_FREE_TAIL_V1_8197F) & \ -+ BIT_MASK_FW_FREE_TAIL_V1_8197F) -+#define BIT_SET_FW_FREE_TAIL_V1_8197F(x, v) \ -+ (BIT_CLEAR_FW_FREE_TAIL_V1_8197F(x) | BIT_FW_FREE_TAIL_V1_8197F(v)) -+ -+/* 2 REG_FWHW_TXQ_CTRL_8197F */ -+#define BIT_RTS_LIMIT_IN_OFDM_8197F BIT(23) -+#define BIT_EN_BCNQ_DL_8197F BIT(22) -+#define BIT_EN_RD_RESP_NAV_BK_8197F BIT(21) -+#define BIT_EN_WR_FREE_TAIL_8197F BIT(20) -+ -+#define BIT_SHIFT_EN_QUEUE_RPT_8197F 8 -+#define BIT_MASK_EN_QUEUE_RPT_8197F 0xff -+#define BIT_EN_QUEUE_RPT_8197F(x) \ -+ (((x) & BIT_MASK_EN_QUEUE_RPT_8197F) << BIT_SHIFT_EN_QUEUE_RPT_8197F) -+#define BITS_EN_QUEUE_RPT_8197F \ -+ (BIT_MASK_EN_QUEUE_RPT_8197F << BIT_SHIFT_EN_QUEUE_RPT_8197F) -+#define BIT_CLEAR_EN_QUEUE_RPT_8197F(x) ((x) & (~BITS_EN_QUEUE_RPT_8197F)) -+#define BIT_GET_EN_QUEUE_RPT_8197F(x) \ -+ (((x) >> BIT_SHIFT_EN_QUEUE_RPT_8197F) & BIT_MASK_EN_QUEUE_RPT_8197F) -+#define BIT_SET_EN_QUEUE_RPT_8197F(x, v) \ -+ (BIT_CLEAR_EN_QUEUE_RPT_8197F(x) | BIT_EN_QUEUE_RPT_8197F(v)) -+ -+#define BIT_EN_RTY_BK_8197F BIT(7) -+#define BIT_EN_USE_INI_RAT_8197F BIT(6) -+#define BIT_EN_RTS_NAV_BK_8197F BIT(5) -+#define BIT_DIS_SSN_CHECK_8197F BIT(4) -+#define BIT_MACID_MATCH_RTS_8197F BIT(3) -+#define BIT_EN_BCN_TRXRPT_V1_8197F BIT(2) -+#define BIT_R_EN_FTMRPT_8197F BIT(1) -+#define BIT_R_BMC_NAV_PROTECT_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT__R_EN_RTY_BK_COD_8197F BIT(2) -+ -+#define BIT_SHIFT__R_DATA_FALLBACK_SEL_8197F 0 -+#define BIT_MASK__R_DATA_FALLBACK_SEL_8197F 0x3 -+#define BIT__R_DATA_FALLBACK_SEL_8197F(x) \ -+ (((x) & BIT_MASK__R_DATA_FALLBACK_SEL_8197F) \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL_8197F) -+#define BITS__R_DATA_FALLBACK_SEL_8197F \ -+ (BIT_MASK__R_DATA_FALLBACK_SEL_8197F \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL_8197F) -+#define BIT_CLEAR__R_DATA_FALLBACK_SEL_8197F(x) \ -+ ((x) & (~BITS__R_DATA_FALLBACK_SEL_8197F)) -+#define BIT_GET__R_DATA_FALLBACK_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT__R_DATA_FALLBACK_SEL_8197F) & \ -+ BIT_MASK__R_DATA_FALLBACK_SEL_8197F) -+#define BIT_SET__R_DATA_FALLBACK_SEL_8197F(x, v) \ -+ (BIT_CLEAR__R_DATA_FALLBACK_SEL_8197F(x) | \ -+ BIT__R_DATA_FALLBACK_SEL_8197F(v)) -+ -+/* 2 REG_BCNQ_BDNY_V1_8197F */ -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_V1_8197F 0 -+#define BIT_MASK_BCNQ_PGBNDY_V1_8197F 0xfff -+#define BIT_BCNQ_PGBNDY_V1_8197F(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_V1_8197F) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_V1_8197F) -+#define BITS_BCNQ_PGBNDY_V1_8197F \ -+ (BIT_MASK_BCNQ_PGBNDY_V1_8197F << BIT_SHIFT_BCNQ_PGBNDY_V1_8197F) -+#define BIT_CLEAR_BCNQ_PGBNDY_V1_8197F(x) ((x) & (~BITS_BCNQ_PGBNDY_V1_8197F)) -+#define BIT_GET_BCNQ_PGBNDY_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_V1_8197F) & \ -+ BIT_MASK_BCNQ_PGBNDY_V1_8197F) -+#define BIT_SET_BCNQ_PGBNDY_V1_8197F(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_V1_8197F(x) | BIT_BCNQ_PGBNDY_V1_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_LIFETIME_EN_8197F */ -+#define BIT_BT_INT_CPU_8197F BIT(7) -+#define BIT_BT_INT_PTA_8197F BIT(6) -+#define BIT_EN_CTRL_RTYBIT_8197F BIT(4) -+#define BIT_LIFETIME_BK_EN_8197F BIT(3) -+#define BIT_LIFETIME_BE_EN_8197F BIT(2) -+#define BIT_LIFETIME_VI_EN_8197F BIT(1) -+#define BIT_LIFETIME_VO_EN_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_SPEC_SIFS_8197F */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8197F 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_PTCL_8197F 0xff -+#define BIT_SPEC_SIFS_OFDM_PTCL_8197F(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_PTCL_8197F) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8197F) -+#define BITS_SPEC_SIFS_OFDM_PTCL_8197F \ -+ (BIT_MASK_SPEC_SIFS_OFDM_PTCL_8197F \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8197F) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8197F(x) \ -+ ((x) & (~BITS_SPEC_SIFS_OFDM_PTCL_8197F)) -+#define BIT_GET_SPEC_SIFS_OFDM_PTCL_8197F(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8197F) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_PTCL_8197F) -+#define BIT_SET_SPEC_SIFS_OFDM_PTCL_8197F(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8197F(x) | \ -+ BIT_SPEC_SIFS_OFDM_PTCL_8197F(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8197F 0 -+#define BIT_MASK_SPEC_SIFS_CCK_PTCL_8197F 0xff -+#define BIT_SPEC_SIFS_CCK_PTCL_8197F(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_PTCL_8197F) \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8197F) -+#define BITS_SPEC_SIFS_CCK_PTCL_8197F \ -+ (BIT_MASK_SPEC_SIFS_CCK_PTCL_8197F \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8197F) -+#define BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8197F(x) \ -+ ((x) & (~BITS_SPEC_SIFS_CCK_PTCL_8197F)) -+#define BIT_GET_SPEC_SIFS_CCK_PTCL_8197F(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8197F) & \ -+ BIT_MASK_SPEC_SIFS_CCK_PTCL_8197F) -+#define BIT_SET_SPEC_SIFS_CCK_PTCL_8197F(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8197F(x) | \ -+ BIT_SPEC_SIFS_CCK_PTCL_8197F(v)) -+ -+/* 2 REG_RETRY_LIMIT_8197F */ -+ -+#define BIT_SHIFT_SRL_8197F 8 -+#define BIT_MASK_SRL_8197F 0x3f -+#define BIT_SRL_8197F(x) (((x) & BIT_MASK_SRL_8197F) << BIT_SHIFT_SRL_8197F) -+#define BITS_SRL_8197F (BIT_MASK_SRL_8197F << BIT_SHIFT_SRL_8197F) -+#define BIT_CLEAR_SRL_8197F(x) ((x) & (~BITS_SRL_8197F)) -+#define BIT_GET_SRL_8197F(x) (((x) >> BIT_SHIFT_SRL_8197F) & BIT_MASK_SRL_8197F) -+#define BIT_SET_SRL_8197F(x, v) (BIT_CLEAR_SRL_8197F(x) | BIT_SRL_8197F(v)) -+ -+#define BIT_SHIFT_LRL_8197F 0 -+#define BIT_MASK_LRL_8197F 0x3f -+#define BIT_LRL_8197F(x) (((x) & BIT_MASK_LRL_8197F) << BIT_SHIFT_LRL_8197F) -+#define BITS_LRL_8197F (BIT_MASK_LRL_8197F << BIT_SHIFT_LRL_8197F) -+#define BIT_CLEAR_LRL_8197F(x) ((x) & (~BITS_LRL_8197F)) -+#define BIT_GET_LRL_8197F(x) (((x) >> BIT_SHIFT_LRL_8197F) & BIT_MASK_LRL_8197F) -+#define BIT_SET_LRL_8197F(x, v) (BIT_CLEAR_LRL_8197F(x) | BIT_LRL_8197F(v)) -+ -+/* 2 REG_TXBF_CTRL_8197F */ -+#define BIT_R_ENABLE_NDPA_8197F BIT(31) -+#define BIT_USE_NDPA_PARAMETER_8197F BIT(30) -+#define BIT_R_PROP_TXBF_8197F BIT(29) -+#define BIT_R_EN_NDPA_INT_8197F BIT(28) -+#define BIT_R_TXBF1_80M_8197F BIT(27) -+#define BIT_R_TXBF1_40M_8197F BIT(26) -+#define BIT_R_TXBF1_20M_8197F BIT(25) -+ -+#define BIT_SHIFT_R_TXBF1_AID_8197F 16 -+#define BIT_MASK_R_TXBF1_AID_8197F 0x1ff -+#define BIT_R_TXBF1_AID_8197F(x) \ -+ (((x) & BIT_MASK_R_TXBF1_AID_8197F) << BIT_SHIFT_R_TXBF1_AID_8197F) -+#define BITS_R_TXBF1_AID_8197F \ -+ (BIT_MASK_R_TXBF1_AID_8197F << BIT_SHIFT_R_TXBF1_AID_8197F) -+#define BIT_CLEAR_R_TXBF1_AID_8197F(x) ((x) & (~BITS_R_TXBF1_AID_8197F)) -+#define BIT_GET_R_TXBF1_AID_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF1_AID_8197F) & BIT_MASK_R_TXBF1_AID_8197F) -+#define BIT_SET_R_TXBF1_AID_8197F(x, v) \ -+ (BIT_CLEAR_R_TXBF1_AID_8197F(x) | BIT_R_TXBF1_AID_8197F(v)) -+ -+#define BIT_DIS_NDP_BFEN_8197F BIT(15) -+#define BIT_R_TXBCN_NOBLOCK_NDP_8197F BIT(14) -+#define BIT_R_TXBF0_80M_8197F BIT(11) -+#define BIT_R_TXBF0_40M_8197F BIT(10) -+#define BIT_R_TXBF0_20M_8197F BIT(9) -+ -+#define BIT_SHIFT_R_TXBF0_AID_8197F 0 -+#define BIT_MASK_R_TXBF0_AID_8197F 0x1ff -+#define BIT_R_TXBF0_AID_8197F(x) \ -+ (((x) & BIT_MASK_R_TXBF0_AID_8197F) << BIT_SHIFT_R_TXBF0_AID_8197F) -+#define BITS_R_TXBF0_AID_8197F \ -+ (BIT_MASK_R_TXBF0_AID_8197F << BIT_SHIFT_R_TXBF0_AID_8197F) -+#define BIT_CLEAR_R_TXBF0_AID_8197F(x) ((x) & (~BITS_R_TXBF0_AID_8197F)) -+#define BIT_GET_R_TXBF0_AID_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF0_AID_8197F) & BIT_MASK_R_TXBF0_AID_8197F) -+#define BIT_SET_R_TXBF0_AID_8197F(x, v) \ -+ (BIT_CLEAR_R_TXBF0_AID_8197F(x) | BIT_R_TXBF0_AID_8197F(v)) -+ -+/* 2 REG_DARFRC_8197F */ -+ -+#define BIT_SHIFT_DARF_RC8_V2_8197F (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC8_V2_8197F 0x3f -+#define BIT_DARF_RC8_V2_8197F(x) \ -+ (((x) & BIT_MASK_DARF_RC8_V2_8197F) << BIT_SHIFT_DARF_RC8_V2_8197F) -+#define BITS_DARF_RC8_V2_8197F \ -+ (BIT_MASK_DARF_RC8_V2_8197F << BIT_SHIFT_DARF_RC8_V2_8197F) -+#define BIT_CLEAR_DARF_RC8_V2_8197F(x) ((x) & (~BITS_DARF_RC8_V2_8197F)) -+#define BIT_GET_DARF_RC8_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC8_V2_8197F) & BIT_MASK_DARF_RC8_V2_8197F) -+#define BIT_SET_DARF_RC8_V2_8197F(x, v) \ -+ (BIT_CLEAR_DARF_RC8_V2_8197F(x) | BIT_DARF_RC8_V2_8197F(v)) -+ -+#define BIT_SHIFT_DARF_RC7_V2_8197F (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC7_V2_8197F 0x3f -+#define BIT_DARF_RC7_V2_8197F(x) \ -+ (((x) & BIT_MASK_DARF_RC7_V2_8197F) << BIT_SHIFT_DARF_RC7_V2_8197F) -+#define BITS_DARF_RC7_V2_8197F \ -+ (BIT_MASK_DARF_RC7_V2_8197F << BIT_SHIFT_DARF_RC7_V2_8197F) -+#define BIT_CLEAR_DARF_RC7_V2_8197F(x) ((x) & (~BITS_DARF_RC7_V2_8197F)) -+#define BIT_GET_DARF_RC7_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC7_V2_8197F) & BIT_MASK_DARF_RC7_V2_8197F) -+#define BIT_SET_DARF_RC7_V2_8197F(x, v) \ -+ (BIT_CLEAR_DARF_RC7_V2_8197F(x) | BIT_DARF_RC7_V2_8197F(v)) -+ -+#define BIT_SHIFT_DARF_RC6_V2_8197F (40 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC6_V2_8197F 0x3f -+#define BIT_DARF_RC6_V2_8197F(x) \ -+ (((x) & BIT_MASK_DARF_RC6_V2_8197F) << BIT_SHIFT_DARF_RC6_V2_8197F) -+#define BITS_DARF_RC6_V2_8197F \ -+ (BIT_MASK_DARF_RC6_V2_8197F << BIT_SHIFT_DARF_RC6_V2_8197F) -+#define BIT_CLEAR_DARF_RC6_V2_8197F(x) ((x) & (~BITS_DARF_RC6_V2_8197F)) -+#define BIT_GET_DARF_RC6_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC6_V2_8197F) & BIT_MASK_DARF_RC6_V2_8197F) -+#define BIT_SET_DARF_RC6_V2_8197F(x, v) \ -+ (BIT_CLEAR_DARF_RC6_V2_8197F(x) | BIT_DARF_RC6_V2_8197F(v)) -+ -+#define BIT_SHIFT_DARF_RC5_V2_8197F (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC5_V2_8197F 0x3f -+#define BIT_DARF_RC5_V2_8197F(x) \ -+ (((x) & BIT_MASK_DARF_RC5_V2_8197F) << BIT_SHIFT_DARF_RC5_V2_8197F) -+#define BITS_DARF_RC5_V2_8197F \ -+ (BIT_MASK_DARF_RC5_V2_8197F << BIT_SHIFT_DARF_RC5_V2_8197F) -+#define BIT_CLEAR_DARF_RC5_V2_8197F(x) ((x) & (~BITS_DARF_RC5_V2_8197F)) -+#define BIT_GET_DARF_RC5_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC5_V2_8197F) & BIT_MASK_DARF_RC5_V2_8197F) -+#define BIT_SET_DARF_RC5_V2_8197F(x, v) \ -+ (BIT_CLEAR_DARF_RC5_V2_8197F(x) | BIT_DARF_RC5_V2_8197F(v)) -+ -+#define BIT_SHIFT_DARF_RC4_V1_8197F 24 -+#define BIT_MASK_DARF_RC4_V1_8197F 0x3f -+#define BIT_DARF_RC4_V1_8197F(x) \ -+ (((x) & BIT_MASK_DARF_RC4_V1_8197F) << BIT_SHIFT_DARF_RC4_V1_8197F) -+#define BITS_DARF_RC4_V1_8197F \ -+ (BIT_MASK_DARF_RC4_V1_8197F << BIT_SHIFT_DARF_RC4_V1_8197F) -+#define BIT_CLEAR_DARF_RC4_V1_8197F(x) ((x) & (~BITS_DARF_RC4_V1_8197F)) -+#define BIT_GET_DARF_RC4_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC4_V1_8197F) & BIT_MASK_DARF_RC4_V1_8197F) -+#define BIT_SET_DARF_RC4_V1_8197F(x, v) \ -+ (BIT_CLEAR_DARF_RC4_V1_8197F(x) | BIT_DARF_RC4_V1_8197F(v)) -+ -+#define BIT_SHIFT_DARF_RC3_V1_8197F 16 -+#define BIT_MASK_DARF_RC3_V1_8197F 0x3f -+#define BIT_DARF_RC3_V1_8197F(x) \ -+ (((x) & BIT_MASK_DARF_RC3_V1_8197F) << BIT_SHIFT_DARF_RC3_V1_8197F) -+#define BITS_DARF_RC3_V1_8197F \ -+ (BIT_MASK_DARF_RC3_V1_8197F << BIT_SHIFT_DARF_RC3_V1_8197F) -+#define BIT_CLEAR_DARF_RC3_V1_8197F(x) ((x) & (~BITS_DARF_RC3_V1_8197F)) -+#define BIT_GET_DARF_RC3_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC3_V1_8197F) & BIT_MASK_DARF_RC3_V1_8197F) -+#define BIT_SET_DARF_RC3_V1_8197F(x, v) \ -+ (BIT_CLEAR_DARF_RC3_V1_8197F(x) | BIT_DARF_RC3_V1_8197F(v)) -+ -+#define BIT_SHIFT_DARF_RC2_V1_8197F 8 -+#define BIT_MASK_DARF_RC2_V1_8197F 0x3f -+#define BIT_DARF_RC2_V1_8197F(x) \ -+ (((x) & BIT_MASK_DARF_RC2_V1_8197F) << BIT_SHIFT_DARF_RC2_V1_8197F) -+#define BITS_DARF_RC2_V1_8197F \ -+ (BIT_MASK_DARF_RC2_V1_8197F << BIT_SHIFT_DARF_RC2_V1_8197F) -+#define BIT_CLEAR_DARF_RC2_V1_8197F(x) ((x) & (~BITS_DARF_RC2_V1_8197F)) -+#define BIT_GET_DARF_RC2_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC2_V1_8197F) & BIT_MASK_DARF_RC2_V1_8197F) -+#define BIT_SET_DARF_RC2_V1_8197F(x, v) \ -+ (BIT_CLEAR_DARF_RC2_V1_8197F(x) | BIT_DARF_RC2_V1_8197F(v)) -+ -+#define BIT_SHIFT_DARF_RC1_V1_8197F 0 -+#define BIT_MASK_DARF_RC1_V1_8197F 0x3f -+#define BIT_DARF_RC1_V1_8197F(x) \ -+ (((x) & BIT_MASK_DARF_RC1_V1_8197F) << BIT_SHIFT_DARF_RC1_V1_8197F) -+#define BITS_DARF_RC1_V1_8197F \ -+ (BIT_MASK_DARF_RC1_V1_8197F << BIT_SHIFT_DARF_RC1_V1_8197F) -+#define BIT_CLEAR_DARF_RC1_V1_8197F(x) ((x) & (~BITS_DARF_RC1_V1_8197F)) -+#define BIT_GET_DARF_RC1_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC1_V1_8197F) & BIT_MASK_DARF_RC1_V1_8197F) -+#define BIT_SET_DARF_RC1_V1_8197F(x, v) \ -+ (BIT_CLEAR_DARF_RC1_V1_8197F(x) | BIT_DARF_RC1_V1_8197F(v)) -+ -+/* 2 REG_RARFRC_8197F */ -+ -+#define BIT_SHIFT_RARF_RC8_8197F (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC8_8197F 0x1f -+#define BIT_RARF_RC8_8197F(x) \ -+ (((x) & BIT_MASK_RARF_RC8_8197F) << BIT_SHIFT_RARF_RC8_8197F) -+#define BITS_RARF_RC8_8197F \ -+ (BIT_MASK_RARF_RC8_8197F << BIT_SHIFT_RARF_RC8_8197F) -+#define BIT_CLEAR_RARF_RC8_8197F(x) ((x) & (~BITS_RARF_RC8_8197F)) -+#define BIT_GET_RARF_RC8_8197F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC8_8197F) & BIT_MASK_RARF_RC8_8197F) -+#define BIT_SET_RARF_RC8_8197F(x, v) \ -+ (BIT_CLEAR_RARF_RC8_8197F(x) | BIT_RARF_RC8_8197F(v)) -+ -+#define BIT_SHIFT_RARF_RC7_8197F (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC7_8197F 0x1f -+#define BIT_RARF_RC7_8197F(x) \ -+ (((x) & BIT_MASK_RARF_RC7_8197F) << BIT_SHIFT_RARF_RC7_8197F) -+#define BITS_RARF_RC7_8197F \ -+ (BIT_MASK_RARF_RC7_8197F << BIT_SHIFT_RARF_RC7_8197F) -+#define BIT_CLEAR_RARF_RC7_8197F(x) ((x) & (~BITS_RARF_RC7_8197F)) -+#define BIT_GET_RARF_RC7_8197F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC7_8197F) & BIT_MASK_RARF_RC7_8197F) -+#define BIT_SET_RARF_RC7_8197F(x, v) \ -+ (BIT_CLEAR_RARF_RC7_8197F(x) | BIT_RARF_RC7_8197F(v)) -+ -+#define BIT_SHIFT_RARF_RC6_8197F (40 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC6_8197F 0x1f -+#define BIT_RARF_RC6_8197F(x) \ -+ (((x) & BIT_MASK_RARF_RC6_8197F) << BIT_SHIFT_RARF_RC6_8197F) -+#define BITS_RARF_RC6_8197F \ -+ (BIT_MASK_RARF_RC6_8197F << BIT_SHIFT_RARF_RC6_8197F) -+#define BIT_CLEAR_RARF_RC6_8197F(x) ((x) & (~BITS_RARF_RC6_8197F)) -+#define BIT_GET_RARF_RC6_8197F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC6_8197F) & BIT_MASK_RARF_RC6_8197F) -+#define BIT_SET_RARF_RC6_8197F(x, v) \ -+ (BIT_CLEAR_RARF_RC6_8197F(x) | BIT_RARF_RC6_8197F(v)) -+ -+#define BIT_SHIFT_RARF_RC5_8197F (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC5_8197F 0x1f -+#define BIT_RARF_RC5_8197F(x) \ -+ (((x) & BIT_MASK_RARF_RC5_8197F) << BIT_SHIFT_RARF_RC5_8197F) -+#define BITS_RARF_RC5_8197F \ -+ (BIT_MASK_RARF_RC5_8197F << BIT_SHIFT_RARF_RC5_8197F) -+#define BIT_CLEAR_RARF_RC5_8197F(x) ((x) & (~BITS_RARF_RC5_8197F)) -+#define BIT_GET_RARF_RC5_8197F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC5_8197F) & BIT_MASK_RARF_RC5_8197F) -+#define BIT_SET_RARF_RC5_8197F(x, v) \ -+ (BIT_CLEAR_RARF_RC5_8197F(x) | BIT_RARF_RC5_8197F(v)) -+ -+#define BIT_SHIFT_RARF_RC4_8197F 24 -+#define BIT_MASK_RARF_RC4_8197F 0x1f -+#define BIT_RARF_RC4_8197F(x) \ -+ (((x) & BIT_MASK_RARF_RC4_8197F) << BIT_SHIFT_RARF_RC4_8197F) -+#define BITS_RARF_RC4_8197F \ -+ (BIT_MASK_RARF_RC4_8197F << BIT_SHIFT_RARF_RC4_8197F) -+#define BIT_CLEAR_RARF_RC4_8197F(x) ((x) & (~BITS_RARF_RC4_8197F)) -+#define BIT_GET_RARF_RC4_8197F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC4_8197F) & BIT_MASK_RARF_RC4_8197F) -+#define BIT_SET_RARF_RC4_8197F(x, v) \ -+ (BIT_CLEAR_RARF_RC4_8197F(x) | BIT_RARF_RC4_8197F(v)) -+ -+#define BIT_SHIFT_RARF_RC3_8197F 16 -+#define BIT_MASK_RARF_RC3_8197F 0x1f -+#define BIT_RARF_RC3_8197F(x) \ -+ (((x) & BIT_MASK_RARF_RC3_8197F) << BIT_SHIFT_RARF_RC3_8197F) -+#define BITS_RARF_RC3_8197F \ -+ (BIT_MASK_RARF_RC3_8197F << BIT_SHIFT_RARF_RC3_8197F) -+#define BIT_CLEAR_RARF_RC3_8197F(x) ((x) & (~BITS_RARF_RC3_8197F)) -+#define BIT_GET_RARF_RC3_8197F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC3_8197F) & BIT_MASK_RARF_RC3_8197F) -+#define BIT_SET_RARF_RC3_8197F(x, v) \ -+ (BIT_CLEAR_RARF_RC3_8197F(x) | BIT_RARF_RC3_8197F(v)) -+ -+#define BIT_SHIFT_RARF_RC2_8197F 8 -+#define BIT_MASK_RARF_RC2_8197F 0x1f -+#define BIT_RARF_RC2_8197F(x) \ -+ (((x) & BIT_MASK_RARF_RC2_8197F) << BIT_SHIFT_RARF_RC2_8197F) -+#define BITS_RARF_RC2_8197F \ -+ (BIT_MASK_RARF_RC2_8197F << BIT_SHIFT_RARF_RC2_8197F) -+#define BIT_CLEAR_RARF_RC2_8197F(x) ((x) & (~BITS_RARF_RC2_8197F)) -+#define BIT_GET_RARF_RC2_8197F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC2_8197F) & BIT_MASK_RARF_RC2_8197F) -+#define BIT_SET_RARF_RC2_8197F(x, v) \ -+ (BIT_CLEAR_RARF_RC2_8197F(x) | BIT_RARF_RC2_8197F(v)) -+ -+#define BIT_SHIFT_RARF_RC1_8197F 0 -+#define BIT_MASK_RARF_RC1_8197F 0x1f -+#define BIT_RARF_RC1_8197F(x) \ -+ (((x) & BIT_MASK_RARF_RC1_8197F) << BIT_SHIFT_RARF_RC1_8197F) -+#define BITS_RARF_RC1_8197F \ -+ (BIT_MASK_RARF_RC1_8197F << BIT_SHIFT_RARF_RC1_8197F) -+#define BIT_CLEAR_RARF_RC1_8197F(x) ((x) & (~BITS_RARF_RC1_8197F)) -+#define BIT_GET_RARF_RC1_8197F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC1_8197F) & BIT_MASK_RARF_RC1_8197F) -+#define BIT_SET_RARF_RC1_8197F(x, v) \ -+ (BIT_CLEAR_RARF_RC1_8197F(x) | BIT_RARF_RC1_8197F(v)) -+ -+/* 2 REG_RRSR_8197F */ -+#define BIT_EN_VHTBW_FALL_8197F BIT(31) -+#define BIT_EN_HTBW_FALL_8197F BIT(30) -+ -+#define BIT_SHIFT_RRSR_RSC_8197F 21 -+#define BIT_MASK_RRSR_RSC_8197F 0x3 -+#define BIT_RRSR_RSC_8197F(x) \ -+ (((x) & BIT_MASK_RRSR_RSC_8197F) << BIT_SHIFT_RRSR_RSC_8197F) -+#define BITS_RRSR_RSC_8197F \ -+ (BIT_MASK_RRSR_RSC_8197F << BIT_SHIFT_RRSR_RSC_8197F) -+#define BIT_CLEAR_RRSR_RSC_8197F(x) ((x) & (~BITS_RRSR_RSC_8197F)) -+#define BIT_GET_RRSR_RSC_8197F(x) \ -+ (((x) >> BIT_SHIFT_RRSR_RSC_8197F) & BIT_MASK_RRSR_RSC_8197F) -+#define BIT_SET_RRSR_RSC_8197F(x, v) \ -+ (BIT_CLEAR_RRSR_RSC_8197F(x) | BIT_RRSR_RSC_8197F(v)) -+ -+#define BIT_RRSR_BW_8197F BIT(20) -+ -+#define BIT_SHIFT_RRSC_BITMAP_8197F 0 -+#define BIT_MASK_RRSC_BITMAP_8197F 0xfffff -+#define BIT_RRSC_BITMAP_8197F(x) \ -+ (((x) & BIT_MASK_RRSC_BITMAP_8197F) << BIT_SHIFT_RRSC_BITMAP_8197F) -+#define BITS_RRSC_BITMAP_8197F \ -+ (BIT_MASK_RRSC_BITMAP_8197F << BIT_SHIFT_RRSC_BITMAP_8197F) -+#define BIT_CLEAR_RRSC_BITMAP_8197F(x) ((x) & (~BITS_RRSC_BITMAP_8197F)) -+#define BIT_GET_RRSC_BITMAP_8197F(x) \ -+ (((x) >> BIT_SHIFT_RRSC_BITMAP_8197F) & BIT_MASK_RRSC_BITMAP_8197F) -+#define BIT_SET_RRSC_BITMAP_8197F(x, v) \ -+ (BIT_CLEAR_RRSC_BITMAP_8197F(x) | BIT_RRSC_BITMAP_8197F(v)) -+ -+/* 2 REG_ARFR0_8197F */ -+ -+#define BIT_SHIFT_ARFR0_V1_8197F 0 -+#define BIT_MASK_ARFR0_V1_8197F 0xffffffffffffffffL -+#define BIT_ARFR0_V1_8197F(x) \ -+ (((x) & BIT_MASK_ARFR0_V1_8197F) << BIT_SHIFT_ARFR0_V1_8197F) -+#define BITS_ARFR0_V1_8197F \ -+ (BIT_MASK_ARFR0_V1_8197F << BIT_SHIFT_ARFR0_V1_8197F) -+#define BIT_CLEAR_ARFR0_V1_8197F(x) ((x) & (~BITS_ARFR0_V1_8197F)) -+#define BIT_GET_ARFR0_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_ARFR0_V1_8197F) & BIT_MASK_ARFR0_V1_8197F) -+#define BIT_SET_ARFR0_V1_8197F(x, v) \ -+ (BIT_CLEAR_ARFR0_V1_8197F(x) | BIT_ARFR0_V1_8197F(v)) -+ -+/* 2 REG_ARFR1_V1_8197F */ -+ -+#define BIT_SHIFT_ARFR1_V1_8197F 0 -+#define BIT_MASK_ARFR1_V1_8197F 0xffffffffffffffffL -+#define BIT_ARFR1_V1_8197F(x) \ -+ (((x) & BIT_MASK_ARFR1_V1_8197F) << BIT_SHIFT_ARFR1_V1_8197F) -+#define BITS_ARFR1_V1_8197F \ -+ (BIT_MASK_ARFR1_V1_8197F << BIT_SHIFT_ARFR1_V1_8197F) -+#define BIT_CLEAR_ARFR1_V1_8197F(x) ((x) & (~BITS_ARFR1_V1_8197F)) -+#define BIT_GET_ARFR1_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_ARFR1_V1_8197F) & BIT_MASK_ARFR1_V1_8197F) -+#define BIT_SET_ARFR1_V1_8197F(x, v) \ -+ (BIT_CLEAR_ARFR1_V1_8197F(x) | BIT_ARFR1_V1_8197F(v)) -+ -+/* 2 REG_CCK_CHECK_8197F */ -+#define BIT_CHECK_CCK_EN_8197F BIT(7) -+#define BIT_EN_BCN_PKT_REL_8197F BIT(6) -+#define BIT_BCN_PORT_SEL_8197F BIT(5) -+#define BIT_MOREDATA_BYPASS_8197F BIT(4) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_8197F BIT(3) -+#define BIT_R_EN_SET_MOREDATA_8197F BIT(2) -+#define BIT__R_DIS_CLEAR_MACID_RELEASE_8197F BIT(1) -+#define BIT__R_MACID_RELEASE_EN_8197F BIT(0) -+ -+/* 2 REG_AMPDU_MAX_TIME_V1_8197F */ -+ -+#define BIT_SHIFT_AMPDU_MAX_TIME_8197F 0 -+#define BIT_MASK_AMPDU_MAX_TIME_8197F 0xff -+#define BIT_AMPDU_MAX_TIME_8197F(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_TIME_8197F) \ -+ << BIT_SHIFT_AMPDU_MAX_TIME_8197F) -+#define BITS_AMPDU_MAX_TIME_8197F \ -+ (BIT_MASK_AMPDU_MAX_TIME_8197F << BIT_SHIFT_AMPDU_MAX_TIME_8197F) -+#define BIT_CLEAR_AMPDU_MAX_TIME_8197F(x) ((x) & (~BITS_AMPDU_MAX_TIME_8197F)) -+#define BIT_GET_AMPDU_MAX_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_TIME_8197F) & \ -+ BIT_MASK_AMPDU_MAX_TIME_8197F) -+#define BIT_SET_AMPDU_MAX_TIME_8197F(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_TIME_8197F(x) | BIT_AMPDU_MAX_TIME_8197F(v)) -+ -+/* 2 REG_BCNQ1_BDNY_V1_8197F */ -+ -+#define BIT_SHIFT_BCNQ1_PGBNDY_V1_8197F 0 -+#define BIT_MASK_BCNQ1_PGBNDY_V1_8197F 0xfff -+#define BIT_BCNQ1_PGBNDY_V1_8197F(x) \ -+ (((x) & BIT_MASK_BCNQ1_PGBNDY_V1_8197F) \ -+ << BIT_SHIFT_BCNQ1_PGBNDY_V1_8197F) -+#define BITS_BCNQ1_PGBNDY_V1_8197F \ -+ (BIT_MASK_BCNQ1_PGBNDY_V1_8197F << BIT_SHIFT_BCNQ1_PGBNDY_V1_8197F) -+#define BIT_CLEAR_BCNQ1_PGBNDY_V1_8197F(x) ((x) & (~BITS_BCNQ1_PGBNDY_V1_8197F)) -+#define BIT_GET_BCNQ1_PGBNDY_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ1_PGBNDY_V1_8197F) & \ -+ BIT_MASK_BCNQ1_PGBNDY_V1_8197F) -+#define BIT_SET_BCNQ1_PGBNDY_V1_8197F(x, v) \ -+ (BIT_CLEAR_BCNQ1_PGBNDY_V1_8197F(x) | BIT_BCNQ1_PGBNDY_V1_8197F(v)) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_8197F */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_8197F 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_8197F 0xffffffffL -+#define BIT_AMPDU_MAX_LENGTH_8197F(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_8197F) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_8197F) -+#define BITS_AMPDU_MAX_LENGTH_8197F \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_8197F << BIT_SHIFT_AMPDU_MAX_LENGTH_8197F) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_8197F(x) \ -+ ((x) & (~BITS_AMPDU_MAX_LENGTH_8197F)) -+#define BIT_GET_AMPDU_MAX_LENGTH_8197F(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_8197F) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_8197F) -+#define BIT_SET_AMPDU_MAX_LENGTH_8197F(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_8197F(x) | BIT_AMPDU_MAX_LENGTH_8197F(v)) -+ -+/* 2 REG_ACQ_STOP_8197F */ -+#define BIT_AC7Q_STOP_8197F BIT(7) -+#define BIT_AC6Q_STOP_8197F BIT(6) -+#define BIT_AC5Q_STOP_8197F BIT(5) -+#define BIT_AC4Q_STOP_8197F BIT(4) -+#define BIT_AC3Q_STOP_8197F BIT(3) -+#define BIT_AC2Q_STOP_8197F BIT(2) -+#define BIT_AC1Q_STOP_8197F BIT(1) -+#define BIT_AC0Q_STOP_8197F BIT(0) -+ -+/* 2 REG_NDPA_RATE_8197F */ -+ -+#define BIT_SHIFT_R_NDPA_RATE_V1_8197F 0 -+#define BIT_MASK_R_NDPA_RATE_V1_8197F 0xff -+#define BIT_R_NDPA_RATE_V1_8197F(x) \ -+ (((x) & BIT_MASK_R_NDPA_RATE_V1_8197F) \ -+ << BIT_SHIFT_R_NDPA_RATE_V1_8197F) -+#define BITS_R_NDPA_RATE_V1_8197F \ -+ (BIT_MASK_R_NDPA_RATE_V1_8197F << BIT_SHIFT_R_NDPA_RATE_V1_8197F) -+#define BIT_CLEAR_R_NDPA_RATE_V1_8197F(x) ((x) & (~BITS_R_NDPA_RATE_V1_8197F)) -+#define BIT_GET_R_NDPA_RATE_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_RATE_V1_8197F) & \ -+ BIT_MASK_R_NDPA_RATE_V1_8197F) -+#define BIT_SET_R_NDPA_RATE_V1_8197F(x, v) \ -+ (BIT_CLEAR_R_NDPA_RATE_V1_8197F(x) | BIT_R_NDPA_RATE_V1_8197F(v)) -+ -+/* 2 REG_TX_HANG_CTRL_8197F */ -+#define BIT_R_EN_GNT_BT_AWAKE_8197F BIT(3) -+#define BIT_EN_EOF_V1_8197F BIT(2) -+#define BIT_DIS_OQT_BLOCK_8197F BIT(1) -+#define BIT_SEARCH_QUEUE_EN_8197F BIT(0) -+ -+/* 2 REG_NDPA_OPT_CTRL_8197F */ -+#define BIT_R_DIS_MACID_RELEASE_RTY_8197F BIT(5) -+ -+#define BIT_SHIFT_BW_SIGTA_8197F 3 -+#define BIT_MASK_BW_SIGTA_8197F 0x3 -+#define BIT_BW_SIGTA_8197F(x) \ -+ (((x) & BIT_MASK_BW_SIGTA_8197F) << BIT_SHIFT_BW_SIGTA_8197F) -+#define BITS_BW_SIGTA_8197F \ -+ (BIT_MASK_BW_SIGTA_8197F << BIT_SHIFT_BW_SIGTA_8197F) -+#define BIT_CLEAR_BW_SIGTA_8197F(x) ((x) & (~BITS_BW_SIGTA_8197F)) -+#define BIT_GET_BW_SIGTA_8197F(x) \ -+ (((x) >> BIT_SHIFT_BW_SIGTA_8197F) & BIT_MASK_BW_SIGTA_8197F) -+#define BIT_SET_BW_SIGTA_8197F(x, v) \ -+ (BIT_CLEAR_BW_SIGTA_8197F(x) | BIT_BW_SIGTA_8197F(v)) -+ -+#define BIT_EN_BAR_SIGTA_8197F BIT(2) -+ -+#define BIT_SHIFT_R_NDPA_BW_8197F 0 -+#define BIT_MASK_R_NDPA_BW_8197F 0x3 -+#define BIT_R_NDPA_BW_8197F(x) \ -+ (((x) & BIT_MASK_R_NDPA_BW_8197F) << BIT_SHIFT_R_NDPA_BW_8197F) -+#define BITS_R_NDPA_BW_8197F \ -+ (BIT_MASK_R_NDPA_BW_8197F << BIT_SHIFT_R_NDPA_BW_8197F) -+#define BIT_CLEAR_R_NDPA_BW_8197F(x) ((x) & (~BITS_R_NDPA_BW_8197F)) -+#define BIT_GET_R_NDPA_BW_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_BW_8197F) & BIT_MASK_R_NDPA_BW_8197F) -+#define BIT_SET_R_NDPA_BW_8197F(x, v) \ -+ (BIT_CLEAR_R_NDPA_BW_8197F(x) | BIT_R_NDPA_BW_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_RD_RESP_PKT_TH_8197F */ -+ -+#define BIT_SHIFT_RD_RESP_PKT_TH_V1_8197F 0 -+#define BIT_MASK_RD_RESP_PKT_TH_V1_8197F 0x3f -+#define BIT_RD_RESP_PKT_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_RD_RESP_PKT_TH_V1_8197F) \ -+ << BIT_SHIFT_RD_RESP_PKT_TH_V1_8197F) -+#define BITS_RD_RESP_PKT_TH_V1_8197F \ -+ (BIT_MASK_RD_RESP_PKT_TH_V1_8197F << BIT_SHIFT_RD_RESP_PKT_TH_V1_8197F) -+#define BIT_CLEAR_RD_RESP_PKT_TH_V1_8197F(x) \ -+ ((x) & (~BITS_RD_RESP_PKT_TH_V1_8197F)) -+#define BIT_GET_RD_RESP_PKT_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_RD_RESP_PKT_TH_V1_8197F) & \ -+ BIT_MASK_RD_RESP_PKT_TH_V1_8197F) -+#define BIT_SET_RD_RESP_PKT_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_RD_RESP_PKT_TH_V1_8197F(x) | BIT_RD_RESP_PKT_TH_V1_8197F(v)) -+ -+/* 2 REG_CMDQ_INFO_8197F */ -+ -+#define BIT_SHIFT_PKT_NUM_8197F 23 -+#define BIT_MASK_PKT_NUM_8197F 0x1ff -+#define BIT_PKT_NUM_8197F(x) \ -+ (((x) & BIT_MASK_PKT_NUM_8197F) << BIT_SHIFT_PKT_NUM_8197F) -+#define BITS_PKT_NUM_8197F (BIT_MASK_PKT_NUM_8197F << BIT_SHIFT_PKT_NUM_8197F) -+#define BIT_CLEAR_PKT_NUM_8197F(x) ((x) & (~BITS_PKT_NUM_8197F)) -+#define BIT_GET_PKT_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_8197F) & BIT_MASK_PKT_NUM_8197F) -+#define BIT_SET_PKT_NUM_8197F(x, v) \ -+ (BIT_CLEAR_PKT_NUM_8197F(x) | BIT_PKT_NUM_8197F(v)) -+ -+#define BIT_TIDEMPTY_CMDQ_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_CMDQ_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_CMDQ_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_CMDQ_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_CMDQ_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_CMDQ_V2_8197F) -+#define BITS_TAIL_PKT_CMDQ_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_CMDQ_V2_8197F << BIT_SHIFT_TAIL_PKT_CMDQ_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_CMDQ_V2_8197F(x) \ -+ ((x) & (~BITS_TAIL_PKT_CMDQ_V2_8197F)) -+#define BIT_GET_TAIL_PKT_CMDQ_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_CMDQ_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_CMDQ_V2_8197F) -+#define BIT_SET_TAIL_PKT_CMDQ_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_CMDQ_V2_8197F(x) | BIT_TAIL_PKT_CMDQ_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_CMDQ_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_CMDQ_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_CMDQ_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_CMDQ_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_CMDQ_V1_8197F) -+#define BITS_HEAD_PKT_CMDQ_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_CMDQ_V1_8197F << BIT_SHIFT_HEAD_PKT_CMDQ_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_CMDQ_V1_8197F(x) \ -+ ((x) & (~BITS_HEAD_PKT_CMDQ_V1_8197F)) -+#define BIT_GET_HEAD_PKT_CMDQ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_CMDQ_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_CMDQ_V1_8197F) -+#define BIT_SET_HEAD_PKT_CMDQ_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_CMDQ_V1_8197F(x) | BIT_HEAD_PKT_CMDQ_V1_8197F(v)) -+ -+/* 2 REG_Q4_INFO_8197F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q4_V1_8197F 25 -+#define BIT_MASK_QUEUEMACID_Q4_V1_8197F 0x7f -+#define BIT_QUEUEMACID_Q4_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q4_V1_8197F) \ -+ << BIT_SHIFT_QUEUEMACID_Q4_V1_8197F) -+#define BITS_QUEUEMACID_Q4_V1_8197F \ -+ (BIT_MASK_QUEUEMACID_Q4_V1_8197F << BIT_SHIFT_QUEUEMACID_Q4_V1_8197F) -+#define BIT_CLEAR_QUEUEMACID_Q4_V1_8197F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q4_V1_8197F)) -+#define BIT_GET_QUEUEMACID_Q4_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q4_V1_8197F) & \ -+ BIT_MASK_QUEUEMACID_Q4_V1_8197F) -+#define BIT_SET_QUEUEMACID_Q4_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q4_V1_8197F(x) | BIT_QUEUEMACID_Q4_V1_8197F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q4_V1_8197F 23 -+#define BIT_MASK_QUEUEAC_Q4_V1_8197F 0x3 -+#define BIT_QUEUEAC_Q4_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q4_V1_8197F) << BIT_SHIFT_QUEUEAC_Q4_V1_8197F) -+#define BITS_QUEUEAC_Q4_V1_8197F \ -+ (BIT_MASK_QUEUEAC_Q4_V1_8197F << BIT_SHIFT_QUEUEAC_Q4_V1_8197F) -+#define BIT_CLEAR_QUEUEAC_Q4_V1_8197F(x) ((x) & (~BITS_QUEUEAC_Q4_V1_8197F)) -+#define BIT_GET_QUEUEAC_Q4_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q4_V1_8197F) & BIT_MASK_QUEUEAC_Q4_V1_8197F) -+#define BIT_SET_QUEUEAC_Q4_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q4_V1_8197F(x) | BIT_QUEUEAC_Q4_V1_8197F(v)) -+ -+#define BIT_TIDEMPTY_Q4_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q4_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_Q4_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_Q4_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q4_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_Q4_V2_8197F) -+#define BITS_TAIL_PKT_Q4_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_Q4_V2_8197F << BIT_SHIFT_TAIL_PKT_Q4_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_Q4_V2_8197F(x) ((x) & (~BITS_TAIL_PKT_Q4_V2_8197F)) -+#define BIT_GET_TAIL_PKT_Q4_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q4_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_Q4_V2_8197F) -+#define BIT_SET_TAIL_PKT_Q4_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q4_V2_8197F(x) | BIT_TAIL_PKT_Q4_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q4_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_Q4_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_Q4_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q4_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_Q4_V1_8197F) -+#define BITS_HEAD_PKT_Q4_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_Q4_V1_8197F << BIT_SHIFT_HEAD_PKT_Q4_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_Q4_V1_8197F(x) ((x) & (~BITS_HEAD_PKT_Q4_V1_8197F)) -+#define BIT_GET_HEAD_PKT_Q4_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q4_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_Q4_V1_8197F) -+#define BIT_SET_HEAD_PKT_Q4_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q4_V1_8197F(x) | BIT_HEAD_PKT_Q4_V1_8197F(v)) -+ -+/* 2 REG_Q5_INFO_8197F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q5_V1_8197F 25 -+#define BIT_MASK_QUEUEMACID_Q5_V1_8197F 0x7f -+#define BIT_QUEUEMACID_Q5_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q5_V1_8197F) \ -+ << BIT_SHIFT_QUEUEMACID_Q5_V1_8197F) -+#define BITS_QUEUEMACID_Q5_V1_8197F \ -+ (BIT_MASK_QUEUEMACID_Q5_V1_8197F << BIT_SHIFT_QUEUEMACID_Q5_V1_8197F) -+#define BIT_CLEAR_QUEUEMACID_Q5_V1_8197F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q5_V1_8197F)) -+#define BIT_GET_QUEUEMACID_Q5_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q5_V1_8197F) & \ -+ BIT_MASK_QUEUEMACID_Q5_V1_8197F) -+#define BIT_SET_QUEUEMACID_Q5_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q5_V1_8197F(x) | BIT_QUEUEMACID_Q5_V1_8197F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q5_V1_8197F 23 -+#define BIT_MASK_QUEUEAC_Q5_V1_8197F 0x3 -+#define BIT_QUEUEAC_Q5_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q5_V1_8197F) << BIT_SHIFT_QUEUEAC_Q5_V1_8197F) -+#define BITS_QUEUEAC_Q5_V1_8197F \ -+ (BIT_MASK_QUEUEAC_Q5_V1_8197F << BIT_SHIFT_QUEUEAC_Q5_V1_8197F) -+#define BIT_CLEAR_QUEUEAC_Q5_V1_8197F(x) ((x) & (~BITS_QUEUEAC_Q5_V1_8197F)) -+#define BIT_GET_QUEUEAC_Q5_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q5_V1_8197F) & BIT_MASK_QUEUEAC_Q5_V1_8197F) -+#define BIT_SET_QUEUEAC_Q5_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q5_V1_8197F(x) | BIT_QUEUEAC_Q5_V1_8197F(v)) -+ -+#define BIT_TIDEMPTY_Q5_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q5_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_Q5_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_Q5_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q5_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_Q5_V2_8197F) -+#define BITS_TAIL_PKT_Q5_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_Q5_V2_8197F << BIT_SHIFT_TAIL_PKT_Q5_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_Q5_V2_8197F(x) ((x) & (~BITS_TAIL_PKT_Q5_V2_8197F)) -+#define BIT_GET_TAIL_PKT_Q5_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q5_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_Q5_V2_8197F) -+#define BIT_SET_TAIL_PKT_Q5_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q5_V2_8197F(x) | BIT_TAIL_PKT_Q5_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q5_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_Q5_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_Q5_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q5_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_Q5_V1_8197F) -+#define BITS_HEAD_PKT_Q5_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_Q5_V1_8197F << BIT_SHIFT_HEAD_PKT_Q5_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_Q5_V1_8197F(x) ((x) & (~BITS_HEAD_PKT_Q5_V1_8197F)) -+#define BIT_GET_HEAD_PKT_Q5_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q5_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_Q5_V1_8197F) -+#define BIT_SET_HEAD_PKT_Q5_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q5_V1_8197F(x) | BIT_HEAD_PKT_Q5_V1_8197F(v)) -+ -+/* 2 REG_Q6_INFO_8197F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q6_V1_8197F 25 -+#define BIT_MASK_QUEUEMACID_Q6_V1_8197F 0x7f -+#define BIT_QUEUEMACID_Q6_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q6_V1_8197F) \ -+ << BIT_SHIFT_QUEUEMACID_Q6_V1_8197F) -+#define BITS_QUEUEMACID_Q6_V1_8197F \ -+ (BIT_MASK_QUEUEMACID_Q6_V1_8197F << BIT_SHIFT_QUEUEMACID_Q6_V1_8197F) -+#define BIT_CLEAR_QUEUEMACID_Q6_V1_8197F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q6_V1_8197F)) -+#define BIT_GET_QUEUEMACID_Q6_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q6_V1_8197F) & \ -+ BIT_MASK_QUEUEMACID_Q6_V1_8197F) -+#define BIT_SET_QUEUEMACID_Q6_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q6_V1_8197F(x) | BIT_QUEUEMACID_Q6_V1_8197F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q6_V1_8197F 23 -+#define BIT_MASK_QUEUEAC_Q6_V1_8197F 0x3 -+#define BIT_QUEUEAC_Q6_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q6_V1_8197F) << BIT_SHIFT_QUEUEAC_Q6_V1_8197F) -+#define BITS_QUEUEAC_Q6_V1_8197F \ -+ (BIT_MASK_QUEUEAC_Q6_V1_8197F << BIT_SHIFT_QUEUEAC_Q6_V1_8197F) -+#define BIT_CLEAR_QUEUEAC_Q6_V1_8197F(x) ((x) & (~BITS_QUEUEAC_Q6_V1_8197F)) -+#define BIT_GET_QUEUEAC_Q6_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q6_V1_8197F) & BIT_MASK_QUEUEAC_Q6_V1_8197F) -+#define BIT_SET_QUEUEAC_Q6_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q6_V1_8197F(x) | BIT_QUEUEAC_Q6_V1_8197F(v)) -+ -+#define BIT_TIDEMPTY_Q6_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q6_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_Q6_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_Q6_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q6_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_Q6_V2_8197F) -+#define BITS_TAIL_PKT_Q6_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_Q6_V2_8197F << BIT_SHIFT_TAIL_PKT_Q6_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_Q6_V2_8197F(x) ((x) & (~BITS_TAIL_PKT_Q6_V2_8197F)) -+#define BIT_GET_TAIL_PKT_Q6_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q6_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_Q6_V2_8197F) -+#define BIT_SET_TAIL_PKT_Q6_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q6_V2_8197F(x) | BIT_TAIL_PKT_Q6_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q6_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_Q6_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_Q6_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q6_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_Q6_V1_8197F) -+#define BITS_HEAD_PKT_Q6_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_Q6_V1_8197F << BIT_SHIFT_HEAD_PKT_Q6_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_Q6_V1_8197F(x) ((x) & (~BITS_HEAD_PKT_Q6_V1_8197F)) -+#define BIT_GET_HEAD_PKT_Q6_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q6_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_Q6_V1_8197F) -+#define BIT_SET_HEAD_PKT_Q6_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q6_V1_8197F(x) | BIT_HEAD_PKT_Q6_V1_8197F(v)) -+ -+/* 2 REG_Q7_INFO_8197F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q7_V1_8197F 25 -+#define BIT_MASK_QUEUEMACID_Q7_V1_8197F 0x7f -+#define BIT_QUEUEMACID_Q7_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q7_V1_8197F) \ -+ << BIT_SHIFT_QUEUEMACID_Q7_V1_8197F) -+#define BITS_QUEUEMACID_Q7_V1_8197F \ -+ (BIT_MASK_QUEUEMACID_Q7_V1_8197F << BIT_SHIFT_QUEUEMACID_Q7_V1_8197F) -+#define BIT_CLEAR_QUEUEMACID_Q7_V1_8197F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q7_V1_8197F)) -+#define BIT_GET_QUEUEMACID_Q7_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q7_V1_8197F) & \ -+ BIT_MASK_QUEUEMACID_Q7_V1_8197F) -+#define BIT_SET_QUEUEMACID_Q7_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q7_V1_8197F(x) | BIT_QUEUEMACID_Q7_V1_8197F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q7_V1_8197F 23 -+#define BIT_MASK_QUEUEAC_Q7_V1_8197F 0x3 -+#define BIT_QUEUEAC_Q7_V1_8197F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q7_V1_8197F) << BIT_SHIFT_QUEUEAC_Q7_V1_8197F) -+#define BITS_QUEUEAC_Q7_V1_8197F \ -+ (BIT_MASK_QUEUEAC_Q7_V1_8197F << BIT_SHIFT_QUEUEAC_Q7_V1_8197F) -+#define BIT_CLEAR_QUEUEAC_Q7_V1_8197F(x) ((x) & (~BITS_QUEUEAC_Q7_V1_8197F)) -+#define BIT_GET_QUEUEAC_Q7_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q7_V1_8197F) & BIT_MASK_QUEUEAC_Q7_V1_8197F) -+#define BIT_SET_QUEUEAC_Q7_V1_8197F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q7_V1_8197F(x) | BIT_QUEUEAC_Q7_V1_8197F(v)) -+ -+#define BIT_TIDEMPTY_Q7_V1_8197F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q7_V2_8197F 11 -+#define BIT_MASK_TAIL_PKT_Q7_V2_8197F 0x7ff -+#define BIT_TAIL_PKT_Q7_V2_8197F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q7_V2_8197F) \ -+ << BIT_SHIFT_TAIL_PKT_Q7_V2_8197F) -+#define BITS_TAIL_PKT_Q7_V2_8197F \ -+ (BIT_MASK_TAIL_PKT_Q7_V2_8197F << BIT_SHIFT_TAIL_PKT_Q7_V2_8197F) -+#define BIT_CLEAR_TAIL_PKT_Q7_V2_8197F(x) ((x) & (~BITS_TAIL_PKT_Q7_V2_8197F)) -+#define BIT_GET_TAIL_PKT_Q7_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q7_V2_8197F) & \ -+ BIT_MASK_TAIL_PKT_Q7_V2_8197F) -+#define BIT_SET_TAIL_PKT_Q7_V2_8197F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q7_V2_8197F(x) | BIT_TAIL_PKT_Q7_V2_8197F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q7_V1_8197F 0 -+#define BIT_MASK_HEAD_PKT_Q7_V1_8197F 0x7ff -+#define BIT_HEAD_PKT_Q7_V1_8197F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q7_V1_8197F) \ -+ << BIT_SHIFT_HEAD_PKT_Q7_V1_8197F) -+#define BITS_HEAD_PKT_Q7_V1_8197F \ -+ (BIT_MASK_HEAD_PKT_Q7_V1_8197F << BIT_SHIFT_HEAD_PKT_Q7_V1_8197F) -+#define BIT_CLEAR_HEAD_PKT_Q7_V1_8197F(x) ((x) & (~BITS_HEAD_PKT_Q7_V1_8197F)) -+#define BIT_GET_HEAD_PKT_Q7_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q7_V1_8197F) & \ -+ BIT_MASK_HEAD_PKT_Q7_V1_8197F) -+#define BIT_SET_HEAD_PKT_Q7_V1_8197F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q7_V1_8197F(x) | BIT_HEAD_PKT_Q7_V1_8197F(v)) -+ -+/* 2 REG_WMAC_LBK_BUF_HD_V1_8197F */ -+ -+#define BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8197F 0 -+#define BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8197F 0xfff -+#define BIT_WMAC_LBK_BUF_HEAD_V1_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8197F) \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8197F) -+#define BITS_WMAC_LBK_BUF_HEAD_V1_8197F \ -+ (BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8197F \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8197F) -+#define BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8197F(x) \ -+ ((x) & (~BITS_WMAC_LBK_BUF_HEAD_V1_8197F)) -+#define BIT_GET_WMAC_LBK_BUF_HEAD_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8197F) & \ -+ BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8197F) -+#define BIT_SET_WMAC_LBK_BUF_HEAD_V1_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8197F(x) | \ -+ BIT_WMAC_LBK_BUF_HEAD_V1_8197F(v)) -+ -+/* 2 REG_MGQ_BDNY_V1_8197F */ -+ -+#define BIT_SHIFT_MGQ_PGBNDY_V1_8197F 0 -+#define BIT_MASK_MGQ_PGBNDY_V1_8197F 0xfff -+#define BIT_MGQ_PGBNDY_V1_8197F(x) \ -+ (((x) & BIT_MASK_MGQ_PGBNDY_V1_8197F) << BIT_SHIFT_MGQ_PGBNDY_V1_8197F) -+#define BITS_MGQ_PGBNDY_V1_8197F \ -+ (BIT_MASK_MGQ_PGBNDY_V1_8197F << BIT_SHIFT_MGQ_PGBNDY_V1_8197F) -+#define BIT_CLEAR_MGQ_PGBNDY_V1_8197F(x) ((x) & (~BITS_MGQ_PGBNDY_V1_8197F)) -+#define BIT_GET_MGQ_PGBNDY_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PGBNDY_V1_8197F) & BIT_MASK_MGQ_PGBNDY_V1_8197F) -+#define BIT_SET_MGQ_PGBNDY_V1_8197F(x, v) \ -+ (BIT_CLEAR_MGQ_PGBNDY_V1_8197F(x) | BIT_MGQ_PGBNDY_V1_8197F(v)) -+ -+/* 2 REG_TXRPT_CTRL_8197F */ -+ -+#define BIT_SHIFT_TRXRPT_TIMER_TH_8197F 24 -+#define BIT_MASK_TRXRPT_TIMER_TH_8197F 0xff -+#define BIT_TRXRPT_TIMER_TH_8197F(x) \ -+ (((x) & BIT_MASK_TRXRPT_TIMER_TH_8197F) \ -+ << BIT_SHIFT_TRXRPT_TIMER_TH_8197F) -+#define BITS_TRXRPT_TIMER_TH_8197F \ -+ (BIT_MASK_TRXRPT_TIMER_TH_8197F << BIT_SHIFT_TRXRPT_TIMER_TH_8197F) -+#define BIT_CLEAR_TRXRPT_TIMER_TH_8197F(x) ((x) & (~BITS_TRXRPT_TIMER_TH_8197F)) -+#define BIT_GET_TRXRPT_TIMER_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_TIMER_TH_8197F) & \ -+ BIT_MASK_TRXRPT_TIMER_TH_8197F) -+#define BIT_SET_TRXRPT_TIMER_TH_8197F(x, v) \ -+ (BIT_CLEAR_TRXRPT_TIMER_TH_8197F(x) | BIT_TRXRPT_TIMER_TH_8197F(v)) -+ -+#define BIT_SHIFT_TRXRPT_LEN_TH_8197F 16 -+#define BIT_MASK_TRXRPT_LEN_TH_8197F 0xff -+#define BIT_TRXRPT_LEN_TH_8197F(x) \ -+ (((x) & BIT_MASK_TRXRPT_LEN_TH_8197F) << BIT_SHIFT_TRXRPT_LEN_TH_8197F) -+#define BITS_TRXRPT_LEN_TH_8197F \ -+ (BIT_MASK_TRXRPT_LEN_TH_8197F << BIT_SHIFT_TRXRPT_LEN_TH_8197F) -+#define BIT_CLEAR_TRXRPT_LEN_TH_8197F(x) ((x) & (~BITS_TRXRPT_LEN_TH_8197F)) -+#define BIT_GET_TRXRPT_LEN_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_LEN_TH_8197F) & BIT_MASK_TRXRPT_LEN_TH_8197F) -+#define BIT_SET_TRXRPT_LEN_TH_8197F(x, v) \ -+ (BIT_CLEAR_TRXRPT_LEN_TH_8197F(x) | BIT_TRXRPT_LEN_TH_8197F(v)) -+ -+#define BIT_SHIFT_TRXRPT_READ_PTR_8197F 8 -+#define BIT_MASK_TRXRPT_READ_PTR_8197F 0xff -+#define BIT_TRXRPT_READ_PTR_8197F(x) \ -+ (((x) & BIT_MASK_TRXRPT_READ_PTR_8197F) \ -+ << BIT_SHIFT_TRXRPT_READ_PTR_8197F) -+#define BITS_TRXRPT_READ_PTR_8197F \ -+ (BIT_MASK_TRXRPT_READ_PTR_8197F << BIT_SHIFT_TRXRPT_READ_PTR_8197F) -+#define BIT_CLEAR_TRXRPT_READ_PTR_8197F(x) ((x) & (~BITS_TRXRPT_READ_PTR_8197F)) -+#define BIT_GET_TRXRPT_READ_PTR_8197F(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_READ_PTR_8197F) & \ -+ BIT_MASK_TRXRPT_READ_PTR_8197F) -+#define BIT_SET_TRXRPT_READ_PTR_8197F(x, v) \ -+ (BIT_CLEAR_TRXRPT_READ_PTR_8197F(x) | BIT_TRXRPT_READ_PTR_8197F(v)) -+ -+#define BIT_SHIFT_TRXRPT_WRITE_PTR_8197F 0 -+#define BIT_MASK_TRXRPT_WRITE_PTR_8197F 0xff -+#define BIT_TRXRPT_WRITE_PTR_8197F(x) \ -+ (((x) & BIT_MASK_TRXRPT_WRITE_PTR_8197F) \ -+ << BIT_SHIFT_TRXRPT_WRITE_PTR_8197F) -+#define BITS_TRXRPT_WRITE_PTR_8197F \ -+ (BIT_MASK_TRXRPT_WRITE_PTR_8197F << BIT_SHIFT_TRXRPT_WRITE_PTR_8197F) -+#define BIT_CLEAR_TRXRPT_WRITE_PTR_8197F(x) \ -+ ((x) & (~BITS_TRXRPT_WRITE_PTR_8197F)) -+#define BIT_GET_TRXRPT_WRITE_PTR_8197F(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_WRITE_PTR_8197F) & \ -+ BIT_MASK_TRXRPT_WRITE_PTR_8197F) -+#define BIT_SET_TRXRPT_WRITE_PTR_8197F(x, v) \ -+ (BIT_CLEAR_TRXRPT_WRITE_PTR_8197F(x) | BIT_TRXRPT_WRITE_PTR_8197F(v)) -+ -+/* 2 REG_INIRTS_RATE_SEL_8197F */ -+#define BIT_LEAG_RTS_BW_DUP_8197F BIT(5) -+ -+/* 2 REG_BASIC_CFEND_RATE_8197F */ -+ -+#define BIT_SHIFT_BASIC_CFEND_RATE_8197F 0 -+#define BIT_MASK_BASIC_CFEND_RATE_8197F 0x1f -+#define BIT_BASIC_CFEND_RATE_8197F(x) \ -+ (((x) & BIT_MASK_BASIC_CFEND_RATE_8197F) \ -+ << BIT_SHIFT_BASIC_CFEND_RATE_8197F) -+#define BITS_BASIC_CFEND_RATE_8197F \ -+ (BIT_MASK_BASIC_CFEND_RATE_8197F << BIT_SHIFT_BASIC_CFEND_RATE_8197F) -+#define BIT_CLEAR_BASIC_CFEND_RATE_8197F(x) \ -+ ((x) & (~BITS_BASIC_CFEND_RATE_8197F)) -+#define BIT_GET_BASIC_CFEND_RATE_8197F(x) \ -+ (((x) >> BIT_SHIFT_BASIC_CFEND_RATE_8197F) & \ -+ BIT_MASK_BASIC_CFEND_RATE_8197F) -+#define BIT_SET_BASIC_CFEND_RATE_8197F(x, v) \ -+ (BIT_CLEAR_BASIC_CFEND_RATE_8197F(x) | BIT_BASIC_CFEND_RATE_8197F(v)) -+ -+/* 2 REG_STBC_CFEND_RATE_8197F */ -+ -+#define BIT_SHIFT_STBC_CFEND_RATE_8197F 0 -+#define BIT_MASK_STBC_CFEND_RATE_8197F 0x1f -+#define BIT_STBC_CFEND_RATE_8197F(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_RATE_8197F) \ -+ << BIT_SHIFT_STBC_CFEND_RATE_8197F) -+#define BITS_STBC_CFEND_RATE_8197F \ -+ (BIT_MASK_STBC_CFEND_RATE_8197F << BIT_SHIFT_STBC_CFEND_RATE_8197F) -+#define BIT_CLEAR_STBC_CFEND_RATE_8197F(x) ((x) & (~BITS_STBC_CFEND_RATE_8197F)) -+#define BIT_GET_STBC_CFEND_RATE_8197F(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_RATE_8197F) & \ -+ BIT_MASK_STBC_CFEND_RATE_8197F) -+#define BIT_SET_STBC_CFEND_RATE_8197F(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_RATE_8197F(x) | BIT_STBC_CFEND_RATE_8197F(v)) -+ -+/* 2 REG_DATA_SC_8197F */ -+ -+#define BIT_SHIFT_TXSC_40M_8197F 4 -+#define BIT_MASK_TXSC_40M_8197F 0xf -+#define BIT_TXSC_40M_8197F(x) \ -+ (((x) & BIT_MASK_TXSC_40M_8197F) << BIT_SHIFT_TXSC_40M_8197F) -+#define BITS_TXSC_40M_8197F \ -+ (BIT_MASK_TXSC_40M_8197F << BIT_SHIFT_TXSC_40M_8197F) -+#define BIT_CLEAR_TXSC_40M_8197F(x) ((x) & (~BITS_TXSC_40M_8197F)) -+#define BIT_GET_TXSC_40M_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXSC_40M_8197F) & BIT_MASK_TXSC_40M_8197F) -+#define BIT_SET_TXSC_40M_8197F(x, v) \ -+ (BIT_CLEAR_TXSC_40M_8197F(x) | BIT_TXSC_40M_8197F(v)) -+ -+#define BIT_SHIFT_TXSC_20M_8197F 0 -+#define BIT_MASK_TXSC_20M_8197F 0xf -+#define BIT_TXSC_20M_8197F(x) \ -+ (((x) & BIT_MASK_TXSC_20M_8197F) << BIT_SHIFT_TXSC_20M_8197F) -+#define BITS_TXSC_20M_8197F \ -+ (BIT_MASK_TXSC_20M_8197F << BIT_SHIFT_TXSC_20M_8197F) -+#define BIT_CLEAR_TXSC_20M_8197F(x) ((x) & (~BITS_TXSC_20M_8197F)) -+#define BIT_GET_TXSC_20M_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXSC_20M_8197F) & BIT_MASK_TXSC_20M_8197F) -+#define BIT_SET_TXSC_20M_8197F(x, v) \ -+ (BIT_CLEAR_TXSC_20M_8197F(x) | BIT_TXSC_20M_8197F(v)) -+ -+/* 2 REG_MACID_SLEEP3_8197F */ -+ -+#define BIT_SHIFT_MACID127_96_PKTSLEEP_8197F 0 -+#define BIT_MASK_MACID127_96_PKTSLEEP_8197F 0xffffffffL -+#define BIT_MACID127_96_PKTSLEEP_8197F(x) \ -+ (((x) & BIT_MASK_MACID127_96_PKTSLEEP_8197F) \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP_8197F) -+#define BITS_MACID127_96_PKTSLEEP_8197F \ -+ (BIT_MASK_MACID127_96_PKTSLEEP_8197F \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP_8197F) -+#define BIT_CLEAR_MACID127_96_PKTSLEEP_8197F(x) \ -+ ((x) & (~BITS_MACID127_96_PKTSLEEP_8197F)) -+#define BIT_GET_MACID127_96_PKTSLEEP_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_PKTSLEEP_8197F) & \ -+ BIT_MASK_MACID127_96_PKTSLEEP_8197F) -+#define BIT_SET_MACID127_96_PKTSLEEP_8197F(x, v) \ -+ (BIT_CLEAR_MACID127_96_PKTSLEEP_8197F(x) | \ -+ BIT_MACID127_96_PKTSLEEP_8197F(v)) -+ -+/* 2 REG_MACID_SLEEP1_8197F */ -+ -+#define BIT_SHIFT_MACID63_32_PKTSLEEP_8197F 0 -+#define BIT_MASK_MACID63_32_PKTSLEEP_8197F 0xffffffffL -+#define BIT_MACID63_32_PKTSLEEP_8197F(x) \ -+ (((x) & BIT_MASK_MACID63_32_PKTSLEEP_8197F) \ -+ << BIT_SHIFT_MACID63_32_PKTSLEEP_8197F) -+#define BITS_MACID63_32_PKTSLEEP_8197F \ -+ (BIT_MASK_MACID63_32_PKTSLEEP_8197F \ -+ << BIT_SHIFT_MACID63_32_PKTSLEEP_8197F) -+#define BIT_CLEAR_MACID63_32_PKTSLEEP_8197F(x) \ -+ ((x) & (~BITS_MACID63_32_PKTSLEEP_8197F)) -+#define BIT_GET_MACID63_32_PKTSLEEP_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_PKTSLEEP_8197F) & \ -+ BIT_MASK_MACID63_32_PKTSLEEP_8197F) -+#define BIT_SET_MACID63_32_PKTSLEEP_8197F(x, v) \ -+ (BIT_CLEAR_MACID63_32_PKTSLEEP_8197F(x) | \ -+ BIT_MACID63_32_PKTSLEEP_8197F(v)) -+ -+/* 2 REG_ARFR2_V1_8197F */ -+ -+#define BIT_SHIFT_ARFR2_V1_8197F 0 -+#define BIT_MASK_ARFR2_V1_8197F 0xffffffffffffffffL -+#define BIT_ARFR2_V1_8197F(x) \ -+ (((x) & BIT_MASK_ARFR2_V1_8197F) << BIT_SHIFT_ARFR2_V1_8197F) -+#define BITS_ARFR2_V1_8197F \ -+ (BIT_MASK_ARFR2_V1_8197F << BIT_SHIFT_ARFR2_V1_8197F) -+#define BIT_CLEAR_ARFR2_V1_8197F(x) ((x) & (~BITS_ARFR2_V1_8197F)) -+#define BIT_GET_ARFR2_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_ARFR2_V1_8197F) & BIT_MASK_ARFR2_V1_8197F) -+#define BIT_SET_ARFR2_V1_8197F(x, v) \ -+ (BIT_CLEAR_ARFR2_V1_8197F(x) | BIT_ARFR2_V1_8197F(v)) -+ -+/* 2 REG_ARFR3_V1_8197F */ -+ -+#define BIT_SHIFT_ARFR3_V1_8197F 0 -+#define BIT_MASK_ARFR3_V1_8197F 0xffffffffffffffffL -+#define BIT_ARFR3_V1_8197F(x) \ -+ (((x) & BIT_MASK_ARFR3_V1_8197F) << BIT_SHIFT_ARFR3_V1_8197F) -+#define BITS_ARFR3_V1_8197F \ -+ (BIT_MASK_ARFR3_V1_8197F << BIT_SHIFT_ARFR3_V1_8197F) -+#define BIT_CLEAR_ARFR3_V1_8197F(x) ((x) & (~BITS_ARFR3_V1_8197F)) -+#define BIT_GET_ARFR3_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_ARFR3_V1_8197F) & BIT_MASK_ARFR3_V1_8197F) -+#define BIT_SET_ARFR3_V1_8197F(x, v) \ -+ (BIT_CLEAR_ARFR3_V1_8197F(x) | BIT_ARFR3_V1_8197F(v)) -+ -+/* 2 REG_ARFR4_8197F */ -+ -+#define BIT_SHIFT_ARFR4_8197F 0 -+#define BIT_MASK_ARFR4_8197F 0xffffffffffffffffL -+#define BIT_ARFR4_8197F(x) \ -+ (((x) & BIT_MASK_ARFR4_8197F) << BIT_SHIFT_ARFR4_8197F) -+#define BITS_ARFR4_8197F (BIT_MASK_ARFR4_8197F << BIT_SHIFT_ARFR4_8197F) -+#define BIT_CLEAR_ARFR4_8197F(x) ((x) & (~BITS_ARFR4_8197F)) -+#define BIT_GET_ARFR4_8197F(x) \ -+ (((x) >> BIT_SHIFT_ARFR4_8197F) & BIT_MASK_ARFR4_8197F) -+#define BIT_SET_ARFR4_8197F(x, v) \ -+ (BIT_CLEAR_ARFR4_8197F(x) | BIT_ARFR4_8197F(v)) -+ -+/* 2 REG_ARFR5_8197F */ -+ -+#define BIT_SHIFT_ARFR5_8197F 0 -+#define BIT_MASK_ARFR5_8197F 0xffffffffffffffffL -+#define BIT_ARFR5_8197F(x) \ -+ (((x) & BIT_MASK_ARFR5_8197F) << BIT_SHIFT_ARFR5_8197F) -+#define BITS_ARFR5_8197F (BIT_MASK_ARFR5_8197F << BIT_SHIFT_ARFR5_8197F) -+#define BIT_CLEAR_ARFR5_8197F(x) ((x) & (~BITS_ARFR5_8197F)) -+#define BIT_GET_ARFR5_8197F(x) \ -+ (((x) >> BIT_SHIFT_ARFR5_8197F) & BIT_MASK_ARFR5_8197F) -+#define BIT_SET_ARFR5_8197F(x, v) \ -+ (BIT_CLEAR_ARFR5_8197F(x) | BIT_ARFR5_8197F(v)) -+ -+/* 2 REG_TXRPT_START_OFFSET_8197F */ -+#define BIT_SHCUT_PARSE_DASA_8197F BIT(25) -+#define BIT_SHCUT_BYPASS_8197F BIT(24) -+#define BIT__R_RPTFIFO_1K_8197F BIT(16) -+ -+#define BIT_SHIFT_MACID_CTRL_OFFSET_8197F 8 -+#define BIT_MASK_MACID_CTRL_OFFSET_8197F 0xff -+#define BIT_MACID_CTRL_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_MACID_CTRL_OFFSET_8197F) \ -+ << BIT_SHIFT_MACID_CTRL_OFFSET_8197F) -+#define BITS_MACID_CTRL_OFFSET_8197F \ -+ (BIT_MASK_MACID_CTRL_OFFSET_8197F << BIT_SHIFT_MACID_CTRL_OFFSET_8197F) -+#define BIT_CLEAR_MACID_CTRL_OFFSET_8197F(x) \ -+ ((x) & (~BITS_MACID_CTRL_OFFSET_8197F)) -+#define BIT_GET_MACID_CTRL_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID_CTRL_OFFSET_8197F) & \ -+ BIT_MASK_MACID_CTRL_OFFSET_8197F) -+#define BIT_SET_MACID_CTRL_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_MACID_CTRL_OFFSET_8197F(x) | BIT_MACID_CTRL_OFFSET_8197F(v)) -+ -+#define BIT_SHIFT_AMPDU_TXRPT_OFFSET_8197F 0 -+#define BIT_MASK_AMPDU_TXRPT_OFFSET_8197F 0xff -+#define BIT_AMPDU_TXRPT_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_AMPDU_TXRPT_OFFSET_8197F) \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_8197F) -+#define BITS_AMPDU_TXRPT_OFFSET_8197F \ -+ (BIT_MASK_AMPDU_TXRPT_OFFSET_8197F \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_8197F) -+#define BIT_CLEAR_AMPDU_TXRPT_OFFSET_8197F(x) \ -+ ((x) & (~BITS_AMPDU_TXRPT_OFFSET_8197F)) -+#define BIT_GET_AMPDU_TXRPT_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_TXRPT_OFFSET_8197F) & \ -+ BIT_MASK_AMPDU_TXRPT_OFFSET_8197F) -+#define BIT_SET_AMPDU_TXRPT_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_AMPDU_TXRPT_OFFSET_8197F(x) | \ -+ BIT_AMPDU_TXRPT_OFFSET_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_POWER_STAGE1_8197F */ -+#define BIT_PTA_WL_PRI_MASK_CPU_MGQ_8197F BIT(31) -+#define BIT_PTA_WL_PRI_MASK_BCNQ_8197F BIT(30) -+#define BIT_PTA_WL_PRI_MASK_HIQ_8197F BIT(29) -+#define BIT_PTA_WL_PRI_MASK_MGQ_8197F BIT(28) -+#define BIT_PTA_WL_PRI_MASK_BK_8197F BIT(27) -+#define BIT_PTA_WL_PRI_MASK_BE_8197F BIT(26) -+#define BIT_PTA_WL_PRI_MASK_VI_8197F BIT(25) -+#define BIT_PTA_WL_PRI_MASK_VO_8197F BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE1_8197F 0 -+#define BIT_MASK_POWER_STAGE1_8197F 0xffffff -+#define BIT_POWER_STAGE1_8197F(x) \ -+ (((x) & BIT_MASK_POWER_STAGE1_8197F) << BIT_SHIFT_POWER_STAGE1_8197F) -+#define BITS_POWER_STAGE1_8197F \ -+ (BIT_MASK_POWER_STAGE1_8197F << BIT_SHIFT_POWER_STAGE1_8197F) -+#define BIT_CLEAR_POWER_STAGE1_8197F(x) ((x) & (~BITS_POWER_STAGE1_8197F)) -+#define BIT_GET_POWER_STAGE1_8197F(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE1_8197F) & BIT_MASK_POWER_STAGE1_8197F) -+#define BIT_SET_POWER_STAGE1_8197F(x, v) \ -+ (BIT_CLEAR_POWER_STAGE1_8197F(x) | BIT_POWER_STAGE1_8197F(v)) -+ -+/* 2 REG_POWER_STAGE2_8197F */ -+#define BIT__R_CTRL_PKT_POW_ADJ_8197F BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE2_8197F 0 -+#define BIT_MASK_POWER_STAGE2_8197F 0xffffff -+#define BIT_POWER_STAGE2_8197F(x) \ -+ (((x) & BIT_MASK_POWER_STAGE2_8197F) << BIT_SHIFT_POWER_STAGE2_8197F) -+#define BITS_POWER_STAGE2_8197F \ -+ (BIT_MASK_POWER_STAGE2_8197F << BIT_SHIFT_POWER_STAGE2_8197F) -+#define BIT_CLEAR_POWER_STAGE2_8197F(x) ((x) & (~BITS_POWER_STAGE2_8197F)) -+#define BIT_GET_POWER_STAGE2_8197F(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE2_8197F) & BIT_MASK_POWER_STAGE2_8197F) -+#define BIT_SET_POWER_STAGE2_8197F(x, v) \ -+ (BIT_CLEAR_POWER_STAGE2_8197F(x) | BIT_POWER_STAGE2_8197F(v)) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL_8197F */ -+ -+#define BIT_SHIFT_PAD_NUM_THRES_8197F 24 -+#define BIT_MASK_PAD_NUM_THRES_8197F 0x3f -+#define BIT_PAD_NUM_THRES_8197F(x) \ -+ (((x) & BIT_MASK_PAD_NUM_THRES_8197F) << BIT_SHIFT_PAD_NUM_THRES_8197F) -+#define BITS_PAD_NUM_THRES_8197F \ -+ (BIT_MASK_PAD_NUM_THRES_8197F << BIT_SHIFT_PAD_NUM_THRES_8197F) -+#define BIT_CLEAR_PAD_NUM_THRES_8197F(x) ((x) & (~BITS_PAD_NUM_THRES_8197F)) -+#define BIT_GET_PAD_NUM_THRES_8197F(x) \ -+ (((x) >> BIT_SHIFT_PAD_NUM_THRES_8197F) & BIT_MASK_PAD_NUM_THRES_8197F) -+#define BIT_SET_PAD_NUM_THRES_8197F(x, v) \ -+ (BIT_CLEAR_PAD_NUM_THRES_8197F(x) | BIT_PAD_NUM_THRES_8197F(v)) -+ -+#define BIT_R_DMA_THIS_QUEUE_BK_8197F BIT(23) -+#define BIT_R_DMA_THIS_QUEUE_BE_8197F BIT(22) -+#define BIT_R_DMA_THIS_QUEUE_VI_8197F BIT(21) -+#define BIT_R_DMA_THIS_QUEUE_VO_8197F BIT(20) -+ -+#define BIT_SHIFT_R_TOTAL_LEN_TH_8197F 8 -+#define BIT_MASK_R_TOTAL_LEN_TH_8197F 0xfff -+#define BIT_R_TOTAL_LEN_TH_8197F(x) \ -+ (((x) & BIT_MASK_R_TOTAL_LEN_TH_8197F) \ -+ << BIT_SHIFT_R_TOTAL_LEN_TH_8197F) -+#define BITS_R_TOTAL_LEN_TH_8197F \ -+ (BIT_MASK_R_TOTAL_LEN_TH_8197F << BIT_SHIFT_R_TOTAL_LEN_TH_8197F) -+#define BIT_CLEAR_R_TOTAL_LEN_TH_8197F(x) ((x) & (~BITS_R_TOTAL_LEN_TH_8197F)) -+#define BIT_GET_R_TOTAL_LEN_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_TOTAL_LEN_TH_8197F) & \ -+ BIT_MASK_R_TOTAL_LEN_TH_8197F) -+#define BIT_SET_R_TOTAL_LEN_TH_8197F(x, v) \ -+ (BIT_CLEAR_R_TOTAL_LEN_TH_8197F(x) | BIT_R_TOTAL_LEN_TH_8197F(v)) -+ -+#define BIT_EN_NEW_EARLY_8197F BIT(7) -+#define BIT_PRE_TX_CMD_8197F BIT(6) -+ -+#define BIT_SHIFT_NUM_SCL_EN_8197F 4 -+#define BIT_MASK_NUM_SCL_EN_8197F 0x3 -+#define BIT_NUM_SCL_EN_8197F(x) \ -+ (((x) & BIT_MASK_NUM_SCL_EN_8197F) << BIT_SHIFT_NUM_SCL_EN_8197F) -+#define BITS_NUM_SCL_EN_8197F \ -+ (BIT_MASK_NUM_SCL_EN_8197F << BIT_SHIFT_NUM_SCL_EN_8197F) -+#define BIT_CLEAR_NUM_SCL_EN_8197F(x) ((x) & (~BITS_NUM_SCL_EN_8197F)) -+#define BIT_GET_NUM_SCL_EN_8197F(x) \ -+ (((x) >> BIT_SHIFT_NUM_SCL_EN_8197F) & BIT_MASK_NUM_SCL_EN_8197F) -+#define BIT_SET_NUM_SCL_EN_8197F(x, v) \ -+ (BIT_CLEAR_NUM_SCL_EN_8197F(x) | BIT_NUM_SCL_EN_8197F(v)) -+ -+#define BIT_BK_EN_8197F BIT(3) -+#define BIT_BE_EN_8197F BIT(2) -+#define BIT_VI_EN_8197F BIT(1) -+#define BIT_VO_EN_8197F BIT(0) -+ -+/* 2 REG_PKT_LIFE_TIME_8197F */ -+ -+#define BIT_SHIFT_PKT_LIFTIME_BEBK_8197F 16 -+#define BIT_MASK_PKT_LIFTIME_BEBK_8197F 0xffff -+#define BIT_PKT_LIFTIME_BEBK_8197F(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_BEBK_8197F) \ -+ << BIT_SHIFT_PKT_LIFTIME_BEBK_8197F) -+#define BITS_PKT_LIFTIME_BEBK_8197F \ -+ (BIT_MASK_PKT_LIFTIME_BEBK_8197F << BIT_SHIFT_PKT_LIFTIME_BEBK_8197F) -+#define BIT_CLEAR_PKT_LIFTIME_BEBK_8197F(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_BEBK_8197F)) -+#define BIT_GET_PKT_LIFTIME_BEBK_8197F(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_BEBK_8197F) & \ -+ BIT_MASK_PKT_LIFTIME_BEBK_8197F) -+#define BIT_SET_PKT_LIFTIME_BEBK_8197F(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_BEBK_8197F(x) | BIT_PKT_LIFTIME_BEBK_8197F(v)) -+ -+#define BIT_SHIFT_PKT_LIFTIME_VOVI_8197F 0 -+#define BIT_MASK_PKT_LIFTIME_VOVI_8197F 0xffff -+#define BIT_PKT_LIFTIME_VOVI_8197F(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_VOVI_8197F) \ -+ << BIT_SHIFT_PKT_LIFTIME_VOVI_8197F) -+#define BITS_PKT_LIFTIME_VOVI_8197F \ -+ (BIT_MASK_PKT_LIFTIME_VOVI_8197F << BIT_SHIFT_PKT_LIFTIME_VOVI_8197F) -+#define BIT_CLEAR_PKT_LIFTIME_VOVI_8197F(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_VOVI_8197F)) -+#define BIT_GET_PKT_LIFTIME_VOVI_8197F(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_VOVI_8197F) & \ -+ BIT_MASK_PKT_LIFTIME_VOVI_8197F) -+#define BIT_SET_PKT_LIFTIME_VOVI_8197F(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_VOVI_8197F(x) | BIT_PKT_LIFTIME_VOVI_8197F(v)) -+ -+/* 2 REG_STBC_SETTING_8197F */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_L_8197F 4 -+#define BIT_MASK_CDEND_TXTIME_L_8197F 0xf -+#define BIT_CDEND_TXTIME_L_8197F(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_L_8197F) \ -+ << BIT_SHIFT_CDEND_TXTIME_L_8197F) -+#define BITS_CDEND_TXTIME_L_8197F \ -+ (BIT_MASK_CDEND_TXTIME_L_8197F << BIT_SHIFT_CDEND_TXTIME_L_8197F) -+#define BIT_CLEAR_CDEND_TXTIME_L_8197F(x) ((x) & (~BITS_CDEND_TXTIME_L_8197F)) -+#define BIT_GET_CDEND_TXTIME_L_8197F(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_L_8197F) & \ -+ BIT_MASK_CDEND_TXTIME_L_8197F) -+#define BIT_SET_CDEND_TXTIME_L_8197F(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_L_8197F(x) | BIT_CDEND_TXTIME_L_8197F(v)) -+ -+#define BIT_SHIFT_NESS_8197F 2 -+#define BIT_MASK_NESS_8197F 0x3 -+#define BIT_NESS_8197F(x) (((x) & BIT_MASK_NESS_8197F) << BIT_SHIFT_NESS_8197F) -+#define BITS_NESS_8197F (BIT_MASK_NESS_8197F << BIT_SHIFT_NESS_8197F) -+#define BIT_CLEAR_NESS_8197F(x) ((x) & (~BITS_NESS_8197F)) -+#define BIT_GET_NESS_8197F(x) \ -+ (((x) >> BIT_SHIFT_NESS_8197F) & BIT_MASK_NESS_8197F) -+#define BIT_SET_NESS_8197F(x, v) (BIT_CLEAR_NESS_8197F(x) | BIT_NESS_8197F(v)) -+ -+#define BIT_SHIFT_STBC_CFEND_8197F 0 -+#define BIT_MASK_STBC_CFEND_8197F 0x3 -+#define BIT_STBC_CFEND_8197F(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_8197F) << BIT_SHIFT_STBC_CFEND_8197F) -+#define BITS_STBC_CFEND_8197F \ -+ (BIT_MASK_STBC_CFEND_8197F << BIT_SHIFT_STBC_CFEND_8197F) -+#define BIT_CLEAR_STBC_CFEND_8197F(x) ((x) & (~BITS_STBC_CFEND_8197F)) -+#define BIT_GET_STBC_CFEND_8197F(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_8197F) & BIT_MASK_STBC_CFEND_8197F) -+#define BIT_SET_STBC_CFEND_8197F(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_8197F(x) | BIT_STBC_CFEND_8197F(v)) -+ -+/* 2 REG_STBC_SETTING2_8197F */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_H_8197F 0 -+#define BIT_MASK_CDEND_TXTIME_H_8197F 0x1f -+#define BIT_CDEND_TXTIME_H_8197F(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_H_8197F) \ -+ << BIT_SHIFT_CDEND_TXTIME_H_8197F) -+#define BITS_CDEND_TXTIME_H_8197F \ -+ (BIT_MASK_CDEND_TXTIME_H_8197F << BIT_SHIFT_CDEND_TXTIME_H_8197F) -+#define BIT_CLEAR_CDEND_TXTIME_H_8197F(x) ((x) & (~BITS_CDEND_TXTIME_H_8197F)) -+#define BIT_GET_CDEND_TXTIME_H_8197F(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_H_8197F) & \ -+ BIT_MASK_CDEND_TXTIME_H_8197F) -+#define BIT_SET_CDEND_TXTIME_H_8197F(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_H_8197F(x) | BIT_CDEND_TXTIME_H_8197F(v)) -+ -+/* 2 REG_QUEUE_CTRL_8197F */ -+#define BIT_PTA_EDCCA_EN_8197F BIT(5) -+#define BIT_PTA_WL_TX_EN_8197F BIT(4) -+#define BIT_R_USE_DATA_BW_8197F BIT(3) -+#define BIT_TRI_PKT_INT_MODE1_8197F BIT(2) -+#define BIT_TRI_PKT_INT_MODE0_8197F BIT(1) -+#define BIT_ACQ_MODE_SEL_8197F BIT(0) -+ -+/* 2 REG_SINGLE_AMPDU_CTRL_8197F */ -+#define BIT_EN_SINGLE_APMDU_8197F BIT(7) -+ -+/* 2 REG_PROT_MODE_CTRL_8197F */ -+ -+#define BIT_SHIFT_RTS_MAX_AGG_NUM_8197F 24 -+#define BIT_MASK_RTS_MAX_AGG_NUM_8197F 0x3f -+#define BIT_RTS_MAX_AGG_NUM_8197F(x) \ -+ (((x) & BIT_MASK_RTS_MAX_AGG_NUM_8197F) \ -+ << BIT_SHIFT_RTS_MAX_AGG_NUM_8197F) -+#define BITS_RTS_MAX_AGG_NUM_8197F \ -+ (BIT_MASK_RTS_MAX_AGG_NUM_8197F << BIT_SHIFT_RTS_MAX_AGG_NUM_8197F) -+#define BIT_CLEAR_RTS_MAX_AGG_NUM_8197F(x) ((x) & (~BITS_RTS_MAX_AGG_NUM_8197F)) -+#define BIT_GET_RTS_MAX_AGG_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_RTS_MAX_AGG_NUM_8197F) & \ -+ BIT_MASK_RTS_MAX_AGG_NUM_8197F) -+#define BIT_SET_RTS_MAX_AGG_NUM_8197F(x, v) \ -+ (BIT_CLEAR_RTS_MAX_AGG_NUM_8197F(x) | BIT_RTS_MAX_AGG_NUM_8197F(v)) -+ -+#define BIT_SHIFT_MAX_AGG_NUM_8197F 16 -+#define BIT_MASK_MAX_AGG_NUM_8197F 0x3f -+#define BIT_MAX_AGG_NUM_8197F(x) \ -+ (((x) & BIT_MASK_MAX_AGG_NUM_8197F) << BIT_SHIFT_MAX_AGG_NUM_8197F) -+#define BITS_MAX_AGG_NUM_8197F \ -+ (BIT_MASK_MAX_AGG_NUM_8197F << BIT_SHIFT_MAX_AGG_NUM_8197F) -+#define BIT_CLEAR_MAX_AGG_NUM_8197F(x) ((x) & (~BITS_MAX_AGG_NUM_8197F)) -+#define BIT_GET_MAX_AGG_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_MAX_AGG_NUM_8197F) & BIT_MASK_MAX_AGG_NUM_8197F) -+#define BIT_SET_MAX_AGG_NUM_8197F(x, v) \ -+ (BIT_CLEAR_MAX_AGG_NUM_8197F(x) | BIT_MAX_AGG_NUM_8197F(v)) -+ -+#define BIT_SHIFT_RTS_TXTIME_TH_8197F 8 -+#define BIT_MASK_RTS_TXTIME_TH_8197F 0xff -+#define BIT_RTS_TXTIME_TH_8197F(x) \ -+ (((x) & BIT_MASK_RTS_TXTIME_TH_8197F) << BIT_SHIFT_RTS_TXTIME_TH_8197F) -+#define BITS_RTS_TXTIME_TH_8197F \ -+ (BIT_MASK_RTS_TXTIME_TH_8197F << BIT_SHIFT_RTS_TXTIME_TH_8197F) -+#define BIT_CLEAR_RTS_TXTIME_TH_8197F(x) ((x) & (~BITS_RTS_TXTIME_TH_8197F)) -+#define BIT_GET_RTS_TXTIME_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_RTS_TXTIME_TH_8197F) & BIT_MASK_RTS_TXTIME_TH_8197F) -+#define BIT_SET_RTS_TXTIME_TH_8197F(x, v) \ -+ (BIT_CLEAR_RTS_TXTIME_TH_8197F(x) | BIT_RTS_TXTIME_TH_8197F(v)) -+ -+#define BIT_SHIFT_RTS_LEN_TH_8197F 0 -+#define BIT_MASK_RTS_LEN_TH_8197F 0xff -+#define BIT_RTS_LEN_TH_8197F(x) \ -+ (((x) & BIT_MASK_RTS_LEN_TH_8197F) << BIT_SHIFT_RTS_LEN_TH_8197F) -+#define BITS_RTS_LEN_TH_8197F \ -+ (BIT_MASK_RTS_LEN_TH_8197F << BIT_SHIFT_RTS_LEN_TH_8197F) -+#define BIT_CLEAR_RTS_LEN_TH_8197F(x) ((x) & (~BITS_RTS_LEN_TH_8197F)) -+#define BIT_GET_RTS_LEN_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_RTS_LEN_TH_8197F) & BIT_MASK_RTS_LEN_TH_8197F) -+#define BIT_SET_RTS_LEN_TH_8197F(x, v) \ -+ (BIT_CLEAR_RTS_LEN_TH_8197F(x) | BIT_RTS_LEN_TH_8197F(v)) -+ -+/* 2 REG_BAR_MODE_CTRL_8197F */ -+ -+#define BIT_SHIFT_BAR_RTY_LMT_8197F 16 -+#define BIT_MASK_BAR_RTY_LMT_8197F 0x3 -+#define BIT_BAR_RTY_LMT_8197F(x) \ -+ (((x) & BIT_MASK_BAR_RTY_LMT_8197F) << BIT_SHIFT_BAR_RTY_LMT_8197F) -+#define BITS_BAR_RTY_LMT_8197F \ -+ (BIT_MASK_BAR_RTY_LMT_8197F << BIT_SHIFT_BAR_RTY_LMT_8197F) -+#define BIT_CLEAR_BAR_RTY_LMT_8197F(x) ((x) & (~BITS_BAR_RTY_LMT_8197F)) -+#define BIT_GET_BAR_RTY_LMT_8197F(x) \ -+ (((x) >> BIT_SHIFT_BAR_RTY_LMT_8197F) & BIT_MASK_BAR_RTY_LMT_8197F) -+#define BIT_SET_BAR_RTY_LMT_8197F(x, v) \ -+ (BIT_CLEAR_BAR_RTY_LMT_8197F(x) | BIT_BAR_RTY_LMT_8197F(v)) -+ -+#define BIT_SHIFT_BAR_PKT_TXTIME_TH_8197F 8 -+#define BIT_MASK_BAR_PKT_TXTIME_TH_8197F 0xff -+#define BIT_BAR_PKT_TXTIME_TH_8197F(x) \ -+ (((x) & BIT_MASK_BAR_PKT_TXTIME_TH_8197F) \ -+ << BIT_SHIFT_BAR_PKT_TXTIME_TH_8197F) -+#define BITS_BAR_PKT_TXTIME_TH_8197F \ -+ (BIT_MASK_BAR_PKT_TXTIME_TH_8197F << BIT_SHIFT_BAR_PKT_TXTIME_TH_8197F) -+#define BIT_CLEAR_BAR_PKT_TXTIME_TH_8197F(x) \ -+ ((x) & (~BITS_BAR_PKT_TXTIME_TH_8197F)) -+#define BIT_GET_BAR_PKT_TXTIME_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKT_TXTIME_TH_8197F) & \ -+ BIT_MASK_BAR_PKT_TXTIME_TH_8197F) -+#define BIT_SET_BAR_PKT_TXTIME_TH_8197F(x, v) \ -+ (BIT_CLEAR_BAR_PKT_TXTIME_TH_8197F(x) | BIT_BAR_PKT_TXTIME_TH_8197F(v)) -+ -+#define BIT_BAR_EN_V1_8197F BIT(6) -+ -+#define BIT_SHIFT_BAR_PKTNUM_TH_V1_8197F 0 -+#define BIT_MASK_BAR_PKTNUM_TH_V1_8197F 0x3f -+#define BIT_BAR_PKTNUM_TH_V1_8197F(x) \ -+ (((x) & BIT_MASK_BAR_PKTNUM_TH_V1_8197F) \ -+ << BIT_SHIFT_BAR_PKTNUM_TH_V1_8197F) -+#define BITS_BAR_PKTNUM_TH_V1_8197F \ -+ (BIT_MASK_BAR_PKTNUM_TH_V1_8197F << BIT_SHIFT_BAR_PKTNUM_TH_V1_8197F) -+#define BIT_CLEAR_BAR_PKTNUM_TH_V1_8197F(x) \ -+ ((x) & (~BITS_BAR_PKTNUM_TH_V1_8197F)) -+#define BIT_GET_BAR_PKTNUM_TH_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKTNUM_TH_V1_8197F) & \ -+ BIT_MASK_BAR_PKTNUM_TH_V1_8197F) -+#define BIT_SET_BAR_PKTNUM_TH_V1_8197F(x, v) \ -+ (BIT_CLEAR_BAR_PKTNUM_TH_V1_8197F(x) | BIT_BAR_PKTNUM_TH_V1_8197F(v)) -+ -+/* 2 REG_RA_TRY_RATE_AGG_LMT_8197F */ -+ -+#define BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8197F 0 -+#define BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8197F 0x3f -+#define BIT_RA_TRY_RATE_AGG_LMT_V1_8197F(x) \ -+ (((x) & BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8197F) \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8197F) -+#define BITS_RA_TRY_RATE_AGG_LMT_V1_8197F \ -+ (BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8197F \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8197F) -+#define BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8197F(x) \ -+ ((x) & (~BITS_RA_TRY_RATE_AGG_LMT_V1_8197F)) -+#define BIT_GET_RA_TRY_RATE_AGG_LMT_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8197F) & \ -+ BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8197F) -+#define BIT_SET_RA_TRY_RATE_AGG_LMT_V1_8197F(x, v) \ -+ (BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8197F(x) | \ -+ BIT_RA_TRY_RATE_AGG_LMT_V1_8197F(v)) -+ -+/* 2 REG_MACID_SLEEP2_8197F */ -+ -+#define BIT_SHIFT_MACID95_64PKTSLEEP_8197F 0 -+#define BIT_MASK_MACID95_64PKTSLEEP_8197F 0xffffffffL -+#define BIT_MACID95_64PKTSLEEP_8197F(x) \ -+ (((x) & BIT_MASK_MACID95_64PKTSLEEP_8197F) \ -+ << BIT_SHIFT_MACID95_64PKTSLEEP_8197F) -+#define BITS_MACID95_64PKTSLEEP_8197F \ -+ (BIT_MASK_MACID95_64PKTSLEEP_8197F \ -+ << BIT_SHIFT_MACID95_64PKTSLEEP_8197F) -+#define BIT_CLEAR_MACID95_64PKTSLEEP_8197F(x) \ -+ ((x) & (~BITS_MACID95_64PKTSLEEP_8197F)) -+#define BIT_GET_MACID95_64PKTSLEEP_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64PKTSLEEP_8197F) & \ -+ BIT_MASK_MACID95_64PKTSLEEP_8197F) -+#define BIT_SET_MACID95_64PKTSLEEP_8197F(x, v) \ -+ (BIT_CLEAR_MACID95_64PKTSLEEP_8197F(x) | \ -+ BIT_MACID95_64PKTSLEEP_8197F(v)) -+ -+/* 2 REG_MACID_SLEEP_8197F */ -+ -+#define BIT_SHIFT_MACID31_0_PKTSLEEP_8197F 0 -+#define BIT_MASK_MACID31_0_PKTSLEEP_8197F 0xffffffffL -+#define BIT_MACID31_0_PKTSLEEP_8197F(x) \ -+ (((x) & BIT_MASK_MACID31_0_PKTSLEEP_8197F) \ -+ << BIT_SHIFT_MACID31_0_PKTSLEEP_8197F) -+#define BITS_MACID31_0_PKTSLEEP_8197F \ -+ (BIT_MASK_MACID31_0_PKTSLEEP_8197F \ -+ << BIT_SHIFT_MACID31_0_PKTSLEEP_8197F) -+#define BIT_CLEAR_MACID31_0_PKTSLEEP_8197F(x) \ -+ ((x) & (~BITS_MACID31_0_PKTSLEEP_8197F)) -+#define BIT_GET_MACID31_0_PKTSLEEP_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_PKTSLEEP_8197F) & \ -+ BIT_MASK_MACID31_0_PKTSLEEP_8197F) -+#define BIT_SET_MACID31_0_PKTSLEEP_8197F(x, v) \ -+ (BIT_CLEAR_MACID31_0_PKTSLEEP_8197F(x) | \ -+ BIT_MACID31_0_PKTSLEEP_8197F(v)) -+ -+/* 2 REG_HW_SEQ0_8197F */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ0_8197F 0 -+#define BIT_MASK_HW_SSN_SEQ0_8197F 0xfff -+#define BIT_HW_SSN_SEQ0_8197F(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ0_8197F) << BIT_SHIFT_HW_SSN_SEQ0_8197F) -+#define BITS_HW_SSN_SEQ0_8197F \ -+ (BIT_MASK_HW_SSN_SEQ0_8197F << BIT_SHIFT_HW_SSN_SEQ0_8197F) -+#define BIT_CLEAR_HW_SSN_SEQ0_8197F(x) ((x) & (~BITS_HW_SSN_SEQ0_8197F)) -+#define BIT_GET_HW_SSN_SEQ0_8197F(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ0_8197F) & BIT_MASK_HW_SSN_SEQ0_8197F) -+#define BIT_SET_HW_SSN_SEQ0_8197F(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ0_8197F(x) | BIT_HW_SSN_SEQ0_8197F(v)) -+ -+/* 2 REG_HW_SEQ1_8197F */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ1_8197F 0 -+#define BIT_MASK_HW_SSN_SEQ1_8197F 0xfff -+#define BIT_HW_SSN_SEQ1_8197F(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ1_8197F) << BIT_SHIFT_HW_SSN_SEQ1_8197F) -+#define BITS_HW_SSN_SEQ1_8197F \ -+ (BIT_MASK_HW_SSN_SEQ1_8197F << BIT_SHIFT_HW_SSN_SEQ1_8197F) -+#define BIT_CLEAR_HW_SSN_SEQ1_8197F(x) ((x) & (~BITS_HW_SSN_SEQ1_8197F)) -+#define BIT_GET_HW_SSN_SEQ1_8197F(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ1_8197F) & BIT_MASK_HW_SSN_SEQ1_8197F) -+#define BIT_SET_HW_SSN_SEQ1_8197F(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ1_8197F(x) | BIT_HW_SSN_SEQ1_8197F(v)) -+ -+/* 2 REG_HW_SEQ2_8197F */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ2_8197F 0 -+#define BIT_MASK_HW_SSN_SEQ2_8197F 0xfff -+#define BIT_HW_SSN_SEQ2_8197F(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ2_8197F) << BIT_SHIFT_HW_SSN_SEQ2_8197F) -+#define BITS_HW_SSN_SEQ2_8197F \ -+ (BIT_MASK_HW_SSN_SEQ2_8197F << BIT_SHIFT_HW_SSN_SEQ2_8197F) -+#define BIT_CLEAR_HW_SSN_SEQ2_8197F(x) ((x) & (~BITS_HW_SSN_SEQ2_8197F)) -+#define BIT_GET_HW_SSN_SEQ2_8197F(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ2_8197F) & BIT_MASK_HW_SSN_SEQ2_8197F) -+#define BIT_SET_HW_SSN_SEQ2_8197F(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ2_8197F(x) | BIT_HW_SSN_SEQ2_8197F(v)) -+ -+/* 2 REG_HW_SEQ3_8197F */ -+ -+#define BIT_SHIFT_CSI_HWSSN_SEL_8197F 12 -+#define BIT_MASK_CSI_HWSSN_SEL_8197F 0x3 -+#define BIT_CSI_HWSSN_SEL_8197F(x) \ -+ (((x) & BIT_MASK_CSI_HWSSN_SEL_8197F) << BIT_SHIFT_CSI_HWSSN_SEL_8197F) -+#define BITS_CSI_HWSSN_SEL_8197F \ -+ (BIT_MASK_CSI_HWSSN_SEL_8197F << BIT_SHIFT_CSI_HWSSN_SEL_8197F) -+#define BIT_CLEAR_CSI_HWSSN_SEL_8197F(x) ((x) & (~BITS_CSI_HWSSN_SEL_8197F)) -+#define BIT_GET_CSI_HWSSN_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_CSI_HWSSN_SEL_8197F) & BIT_MASK_CSI_HWSSN_SEL_8197F) -+#define BIT_SET_CSI_HWSSN_SEL_8197F(x, v) \ -+ (BIT_CLEAR_CSI_HWSSN_SEL_8197F(x) | BIT_CSI_HWSSN_SEL_8197F(v)) -+ -+#define BIT_SHIFT_HW_SSN_SEQ3_8197F 0 -+#define BIT_MASK_HW_SSN_SEQ3_8197F 0xfff -+#define BIT_HW_SSN_SEQ3_8197F(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ3_8197F) << BIT_SHIFT_HW_SSN_SEQ3_8197F) -+#define BITS_HW_SSN_SEQ3_8197F \ -+ (BIT_MASK_HW_SSN_SEQ3_8197F << BIT_SHIFT_HW_SSN_SEQ3_8197F) -+#define BIT_CLEAR_HW_SSN_SEQ3_8197F(x) ((x) & (~BITS_HW_SSN_SEQ3_8197F)) -+#define BIT_GET_HW_SSN_SEQ3_8197F(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ3_8197F) & BIT_MASK_HW_SSN_SEQ3_8197F) -+#define BIT_SET_HW_SSN_SEQ3_8197F(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ3_8197F(x) | BIT_HW_SSN_SEQ3_8197F(v)) -+ -+/* 2 REG_NULL_PKT_STATUS_V1_8197F */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V1_8197F 2 -+#define BIT_MASK_PTCL_TOTAL_PG_V1_8197F 0x1fff -+#define BIT_PTCL_TOTAL_PG_V1_8197F(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V1_8197F) \ -+ << BIT_SHIFT_PTCL_TOTAL_PG_V1_8197F) -+#define BITS_PTCL_TOTAL_PG_V1_8197F \ -+ (BIT_MASK_PTCL_TOTAL_PG_V1_8197F << BIT_SHIFT_PTCL_TOTAL_PG_V1_8197F) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V1_8197F(x) \ -+ ((x) & (~BITS_PTCL_TOTAL_PG_V1_8197F)) -+#define BIT_GET_PTCL_TOTAL_PG_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V1_8197F) & \ -+ BIT_MASK_PTCL_TOTAL_PG_V1_8197F) -+#define BIT_SET_PTCL_TOTAL_PG_V1_8197F(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V1_8197F(x) | BIT_PTCL_TOTAL_PG_V1_8197F(v)) -+ -+#define BIT_TX_NULL_1_8197F BIT(1) -+#define BIT_TX_NULL_0_8197F BIT(0) -+ -+/* 2 REG_PTCL_ERR_STATUS_8197F */ -+#define BIT_PTCL_RATE_TABLE_INVALID_8197F BIT(7) -+#define BIT_FTM_T2R_ERROR_8197F BIT(6) -+#define BIT_PTCL_ERR0_8197F BIT(5) -+#define BIT_PTCL_ERR1_8197F BIT(4) -+#define BIT_PTCL_ERR2_8197F BIT(3) -+#define BIT_PTCL_ERR3_8197F BIT(2) -+#define BIT_PTCL_ERR4_8197F BIT(1) -+#define BIT_PTCL_ERR5_8197F BIT(0) -+ -+/* 2 REG_NULL_PKT_STATUS_EXTEND_8197F */ -+#define BIT_CLI3_TX_NULL_1_8197F BIT(7) -+#define BIT_CLI3_TX_NULL_0_8197F BIT(6) -+#define BIT_CLI2_TX_NULL_1_8197F BIT(5) -+#define BIT_CLI2_TX_NULL_0_8197F BIT(4) -+#define BIT_CLI1_TX_NULL_1_8197F BIT(3) -+#define BIT_CLI1_TX_NULL_0_8197F BIT(2) -+#define BIT_CLI0_TX_NULL_1_8197F BIT(1) -+#define BIT_CLI0_TX_NULL_0_8197F BIT(0) -+ -+/* 2 REG_VIDEO_ENHANCEMENT_FUN_8197F */ -+#define BIT_VIDEO_JUST_DROP_8197F BIT(1) -+#define BIT_VIDEO_ENHANCEMENT_FUN_EN_8197F BIT(0) -+ -+/* 2 REG_BT_POLLUTE_PKT_CNT_8197F */ -+ -+#define BIT_SHIFT_BT_POLLUTE_PKT_CNT_8197F 0 -+#define BIT_MASK_BT_POLLUTE_PKT_CNT_8197F 0xffff -+#define BIT_BT_POLLUTE_PKT_CNT_8197F(x) \ -+ (((x) & BIT_MASK_BT_POLLUTE_PKT_CNT_8197F) \ -+ << BIT_SHIFT_BT_POLLUTE_PKT_CNT_8197F) -+#define BITS_BT_POLLUTE_PKT_CNT_8197F \ -+ (BIT_MASK_BT_POLLUTE_PKT_CNT_8197F \ -+ << BIT_SHIFT_BT_POLLUTE_PKT_CNT_8197F) -+#define BIT_CLEAR_BT_POLLUTE_PKT_CNT_8197F(x) \ -+ ((x) & (~BITS_BT_POLLUTE_PKT_CNT_8197F)) -+#define BIT_GET_BT_POLLUTE_PKT_CNT_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_POLLUTE_PKT_CNT_8197F) & \ -+ BIT_MASK_BT_POLLUTE_PKT_CNT_8197F) -+#define BIT_SET_BT_POLLUTE_PKT_CNT_8197F(x, v) \ -+ (BIT_CLEAR_BT_POLLUTE_PKT_CNT_8197F(x) | \ -+ BIT_BT_POLLUTE_PKT_CNT_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_PTCL_DBG_8197F */ -+ -+#define BIT_SHIFT_PTCL_DBG_8197F 0 -+#define BIT_MASK_PTCL_DBG_8197F 0xffffffffL -+#define BIT_PTCL_DBG_8197F(x) \ -+ (((x) & BIT_MASK_PTCL_DBG_8197F) << BIT_SHIFT_PTCL_DBG_8197F) -+#define BITS_PTCL_DBG_8197F \ -+ (BIT_MASK_PTCL_DBG_8197F << BIT_SHIFT_PTCL_DBG_8197F) -+#define BIT_CLEAR_PTCL_DBG_8197F(x) ((x) & (~BITS_PTCL_DBG_8197F)) -+#define BIT_GET_PTCL_DBG_8197F(x) \ -+ (((x) >> BIT_SHIFT_PTCL_DBG_8197F) & BIT_MASK_PTCL_DBG_8197F) -+#define BIT_SET_PTCL_DBG_8197F(x, v) \ -+ (BIT_CLEAR_PTCL_DBG_8197F(x) | BIT_PTCL_DBG_8197F(v)) -+ -+/* 2 REG_TXOP_EXTRA_CTRL_8197F */ -+#define BIT_TXOP_EFFICIENCY_EN_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_CPUMGQ_TIMER_CTRL2_8197F */ -+ -+#define BIT_SHIFT_TRI_HEAD_ADDR_8197F 16 -+#define BIT_MASK_TRI_HEAD_ADDR_8197F 0xfff -+#define BIT_TRI_HEAD_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_TRI_HEAD_ADDR_8197F) << BIT_SHIFT_TRI_HEAD_ADDR_8197F) -+#define BITS_TRI_HEAD_ADDR_8197F \ -+ (BIT_MASK_TRI_HEAD_ADDR_8197F << BIT_SHIFT_TRI_HEAD_ADDR_8197F) -+#define BIT_CLEAR_TRI_HEAD_ADDR_8197F(x) ((x) & (~BITS_TRI_HEAD_ADDR_8197F)) -+#define BIT_GET_TRI_HEAD_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_TRI_HEAD_ADDR_8197F) & BIT_MASK_TRI_HEAD_ADDR_8197F) -+#define BIT_SET_TRI_HEAD_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_TRI_HEAD_ADDR_8197F(x) | BIT_TRI_HEAD_ADDR_8197F(v)) -+ -+#define BIT_DROP_TH_EN_8197F BIT(8) -+ -+#define BIT_SHIFT_DROP_TH_8197F 0 -+#define BIT_MASK_DROP_TH_8197F 0xff -+#define BIT_DROP_TH_8197F(x) \ -+ (((x) & BIT_MASK_DROP_TH_8197F) << BIT_SHIFT_DROP_TH_8197F) -+#define BITS_DROP_TH_8197F (BIT_MASK_DROP_TH_8197F << BIT_SHIFT_DROP_TH_8197F) -+#define BIT_CLEAR_DROP_TH_8197F(x) ((x) & (~BITS_DROP_TH_8197F)) -+#define BIT_GET_DROP_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_DROP_TH_8197F) & BIT_MASK_DROP_TH_8197F) -+#define BIT_SET_DROP_TH_8197F(x, v) \ -+ (BIT_CLEAR_DROP_TH_8197F(x) | BIT_DROP_TH_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_DUMMY_PAGE4_8197F */ -+#define BIT_MOREDATA_CTRL2_EN_V2_8197F BIT(19) -+#define BIT_MOREDATA_CTRL1_EN_V2_8197F BIT(18) -+#define BIT_PKTIN_MOREDATA_REPLACE_ENABLE_8197F BIT(16) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_Q0_Q1_INFO_8197F */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8197F BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8197F 28 -+#define BIT_MASK_GTAB_ID_8197F 0x7 -+#define BIT_GTAB_ID_8197F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8197F) << BIT_SHIFT_GTAB_ID_8197F) -+#define BITS_GTAB_ID_8197F (BIT_MASK_GTAB_ID_8197F << BIT_SHIFT_GTAB_ID_8197F) -+#define BIT_CLEAR_GTAB_ID_8197F(x) ((x) & (~BITS_GTAB_ID_8197F)) -+#define BIT_GET_GTAB_ID_8197F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8197F) & BIT_MASK_GTAB_ID_8197F) -+#define BIT_SET_GTAB_ID_8197F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8197F(x) | BIT_GTAB_ID_8197F(v)) -+ -+#define BIT_SHIFT_AC1_PKT_INFO_8197F 16 -+#define BIT_MASK_AC1_PKT_INFO_8197F 0xfff -+#define BIT_AC1_PKT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_AC1_PKT_INFO_8197F) << BIT_SHIFT_AC1_PKT_INFO_8197F) -+#define BITS_AC1_PKT_INFO_8197F \ -+ (BIT_MASK_AC1_PKT_INFO_8197F << BIT_SHIFT_AC1_PKT_INFO_8197F) -+#define BIT_CLEAR_AC1_PKT_INFO_8197F(x) ((x) & (~BITS_AC1_PKT_INFO_8197F)) -+#define BIT_GET_AC1_PKT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_AC1_PKT_INFO_8197F) & BIT_MASK_AC1_PKT_INFO_8197F) -+#define BIT_SET_AC1_PKT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_AC1_PKT_INFO_8197F(x) | BIT_AC1_PKT_INFO_8197F(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8197F BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8197F 12 -+#define BIT_MASK_GTAB_ID_V1_8197F 0x7 -+#define BIT_GTAB_ID_V1_8197F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8197F) << BIT_SHIFT_GTAB_ID_V1_8197F) -+#define BITS_GTAB_ID_V1_8197F \ -+ (BIT_MASK_GTAB_ID_V1_8197F << BIT_SHIFT_GTAB_ID_V1_8197F) -+#define BIT_CLEAR_GTAB_ID_V1_8197F(x) ((x) & (~BITS_GTAB_ID_V1_8197F)) -+#define BIT_GET_GTAB_ID_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8197F) & BIT_MASK_GTAB_ID_V1_8197F) -+#define BIT_SET_GTAB_ID_V1_8197F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8197F(x) | BIT_GTAB_ID_V1_8197F(v)) -+ -+#define BIT_SHIFT_AC0_PKT_INFO_8197F 0 -+#define BIT_MASK_AC0_PKT_INFO_8197F 0xfff -+#define BIT_AC0_PKT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_AC0_PKT_INFO_8197F) << BIT_SHIFT_AC0_PKT_INFO_8197F) -+#define BITS_AC0_PKT_INFO_8197F \ -+ (BIT_MASK_AC0_PKT_INFO_8197F << BIT_SHIFT_AC0_PKT_INFO_8197F) -+#define BIT_CLEAR_AC0_PKT_INFO_8197F(x) ((x) & (~BITS_AC0_PKT_INFO_8197F)) -+#define BIT_GET_AC0_PKT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_AC0_PKT_INFO_8197F) & BIT_MASK_AC0_PKT_INFO_8197F) -+#define BIT_SET_AC0_PKT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_AC0_PKT_INFO_8197F(x) | BIT_AC0_PKT_INFO_8197F(v)) -+ -+/* 2 REG_Q2_Q3_INFO_8197F */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8197F BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8197F 28 -+#define BIT_MASK_GTAB_ID_8197F 0x7 -+#define BIT_GTAB_ID_8197F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8197F) << BIT_SHIFT_GTAB_ID_8197F) -+#define BITS_GTAB_ID_8197F (BIT_MASK_GTAB_ID_8197F << BIT_SHIFT_GTAB_ID_8197F) -+#define BIT_CLEAR_GTAB_ID_8197F(x) ((x) & (~BITS_GTAB_ID_8197F)) -+#define BIT_GET_GTAB_ID_8197F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8197F) & BIT_MASK_GTAB_ID_8197F) -+#define BIT_SET_GTAB_ID_8197F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8197F(x) | BIT_GTAB_ID_8197F(v)) -+ -+#define BIT_SHIFT_AC3_PKT_INFO_8197F 16 -+#define BIT_MASK_AC3_PKT_INFO_8197F 0xfff -+#define BIT_AC3_PKT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_AC3_PKT_INFO_8197F) << BIT_SHIFT_AC3_PKT_INFO_8197F) -+#define BITS_AC3_PKT_INFO_8197F \ -+ (BIT_MASK_AC3_PKT_INFO_8197F << BIT_SHIFT_AC3_PKT_INFO_8197F) -+#define BIT_CLEAR_AC3_PKT_INFO_8197F(x) ((x) & (~BITS_AC3_PKT_INFO_8197F)) -+#define BIT_GET_AC3_PKT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_AC3_PKT_INFO_8197F) & BIT_MASK_AC3_PKT_INFO_8197F) -+#define BIT_SET_AC3_PKT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_AC3_PKT_INFO_8197F(x) | BIT_AC3_PKT_INFO_8197F(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8197F BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8197F 12 -+#define BIT_MASK_GTAB_ID_V1_8197F 0x7 -+#define BIT_GTAB_ID_V1_8197F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8197F) << BIT_SHIFT_GTAB_ID_V1_8197F) -+#define BITS_GTAB_ID_V1_8197F \ -+ (BIT_MASK_GTAB_ID_V1_8197F << BIT_SHIFT_GTAB_ID_V1_8197F) -+#define BIT_CLEAR_GTAB_ID_V1_8197F(x) ((x) & (~BITS_GTAB_ID_V1_8197F)) -+#define BIT_GET_GTAB_ID_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8197F) & BIT_MASK_GTAB_ID_V1_8197F) -+#define BIT_SET_GTAB_ID_V1_8197F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8197F(x) | BIT_GTAB_ID_V1_8197F(v)) -+ -+#define BIT_SHIFT_AC2_PKT_INFO_8197F 0 -+#define BIT_MASK_AC2_PKT_INFO_8197F 0xfff -+#define BIT_AC2_PKT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_AC2_PKT_INFO_8197F) << BIT_SHIFT_AC2_PKT_INFO_8197F) -+#define BITS_AC2_PKT_INFO_8197F \ -+ (BIT_MASK_AC2_PKT_INFO_8197F << BIT_SHIFT_AC2_PKT_INFO_8197F) -+#define BIT_CLEAR_AC2_PKT_INFO_8197F(x) ((x) & (~BITS_AC2_PKT_INFO_8197F)) -+#define BIT_GET_AC2_PKT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_AC2_PKT_INFO_8197F) & BIT_MASK_AC2_PKT_INFO_8197F) -+#define BIT_SET_AC2_PKT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_AC2_PKT_INFO_8197F(x) | BIT_AC2_PKT_INFO_8197F(v)) -+ -+/* 2 REG_Q4_Q5_INFO_8197F */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8197F BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8197F 28 -+#define BIT_MASK_GTAB_ID_8197F 0x7 -+#define BIT_GTAB_ID_8197F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8197F) << BIT_SHIFT_GTAB_ID_8197F) -+#define BITS_GTAB_ID_8197F (BIT_MASK_GTAB_ID_8197F << BIT_SHIFT_GTAB_ID_8197F) -+#define BIT_CLEAR_GTAB_ID_8197F(x) ((x) & (~BITS_GTAB_ID_8197F)) -+#define BIT_GET_GTAB_ID_8197F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8197F) & BIT_MASK_GTAB_ID_8197F) -+#define BIT_SET_GTAB_ID_8197F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8197F(x) | BIT_GTAB_ID_8197F(v)) -+ -+#define BIT_SHIFT_AC5_PKT_INFO_8197F 16 -+#define BIT_MASK_AC5_PKT_INFO_8197F 0xfff -+#define BIT_AC5_PKT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_AC5_PKT_INFO_8197F) << BIT_SHIFT_AC5_PKT_INFO_8197F) -+#define BITS_AC5_PKT_INFO_8197F \ -+ (BIT_MASK_AC5_PKT_INFO_8197F << BIT_SHIFT_AC5_PKT_INFO_8197F) -+#define BIT_CLEAR_AC5_PKT_INFO_8197F(x) ((x) & (~BITS_AC5_PKT_INFO_8197F)) -+#define BIT_GET_AC5_PKT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_AC5_PKT_INFO_8197F) & BIT_MASK_AC5_PKT_INFO_8197F) -+#define BIT_SET_AC5_PKT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_AC5_PKT_INFO_8197F(x) | BIT_AC5_PKT_INFO_8197F(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8197F BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8197F 12 -+#define BIT_MASK_GTAB_ID_V1_8197F 0x7 -+#define BIT_GTAB_ID_V1_8197F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8197F) << BIT_SHIFT_GTAB_ID_V1_8197F) -+#define BITS_GTAB_ID_V1_8197F \ -+ (BIT_MASK_GTAB_ID_V1_8197F << BIT_SHIFT_GTAB_ID_V1_8197F) -+#define BIT_CLEAR_GTAB_ID_V1_8197F(x) ((x) & (~BITS_GTAB_ID_V1_8197F)) -+#define BIT_GET_GTAB_ID_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8197F) & BIT_MASK_GTAB_ID_V1_8197F) -+#define BIT_SET_GTAB_ID_V1_8197F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8197F(x) | BIT_GTAB_ID_V1_8197F(v)) -+ -+#define BIT_SHIFT_AC4_PKT_INFO_8197F 0 -+#define BIT_MASK_AC4_PKT_INFO_8197F 0xfff -+#define BIT_AC4_PKT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_AC4_PKT_INFO_8197F) << BIT_SHIFT_AC4_PKT_INFO_8197F) -+#define BITS_AC4_PKT_INFO_8197F \ -+ (BIT_MASK_AC4_PKT_INFO_8197F << BIT_SHIFT_AC4_PKT_INFO_8197F) -+#define BIT_CLEAR_AC4_PKT_INFO_8197F(x) ((x) & (~BITS_AC4_PKT_INFO_8197F)) -+#define BIT_GET_AC4_PKT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_AC4_PKT_INFO_8197F) & BIT_MASK_AC4_PKT_INFO_8197F) -+#define BIT_SET_AC4_PKT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_AC4_PKT_INFO_8197F(x) | BIT_AC4_PKT_INFO_8197F(v)) -+ -+/* 2 REG_Q6_Q7_INFO_8197F */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8197F BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8197F 28 -+#define BIT_MASK_GTAB_ID_8197F 0x7 -+#define BIT_GTAB_ID_8197F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8197F) << BIT_SHIFT_GTAB_ID_8197F) -+#define BITS_GTAB_ID_8197F (BIT_MASK_GTAB_ID_8197F << BIT_SHIFT_GTAB_ID_8197F) -+#define BIT_CLEAR_GTAB_ID_8197F(x) ((x) & (~BITS_GTAB_ID_8197F)) -+#define BIT_GET_GTAB_ID_8197F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8197F) & BIT_MASK_GTAB_ID_8197F) -+#define BIT_SET_GTAB_ID_8197F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8197F(x) | BIT_GTAB_ID_8197F(v)) -+ -+#define BIT_SHIFT_AC7_PKT_INFO_8197F 16 -+#define BIT_MASK_AC7_PKT_INFO_8197F 0xfff -+#define BIT_AC7_PKT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_AC7_PKT_INFO_8197F) << BIT_SHIFT_AC7_PKT_INFO_8197F) -+#define BITS_AC7_PKT_INFO_8197F \ -+ (BIT_MASK_AC7_PKT_INFO_8197F << BIT_SHIFT_AC7_PKT_INFO_8197F) -+#define BIT_CLEAR_AC7_PKT_INFO_8197F(x) ((x) & (~BITS_AC7_PKT_INFO_8197F)) -+#define BIT_GET_AC7_PKT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_AC7_PKT_INFO_8197F) & BIT_MASK_AC7_PKT_INFO_8197F) -+#define BIT_SET_AC7_PKT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_AC7_PKT_INFO_8197F(x) | BIT_AC7_PKT_INFO_8197F(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8197F BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8197F 12 -+#define BIT_MASK_GTAB_ID_V1_8197F 0x7 -+#define BIT_GTAB_ID_V1_8197F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8197F) << BIT_SHIFT_GTAB_ID_V1_8197F) -+#define BITS_GTAB_ID_V1_8197F \ -+ (BIT_MASK_GTAB_ID_V1_8197F << BIT_SHIFT_GTAB_ID_V1_8197F) -+#define BIT_CLEAR_GTAB_ID_V1_8197F(x) ((x) & (~BITS_GTAB_ID_V1_8197F)) -+#define BIT_GET_GTAB_ID_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8197F) & BIT_MASK_GTAB_ID_V1_8197F) -+#define BIT_SET_GTAB_ID_V1_8197F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8197F(x) | BIT_GTAB_ID_V1_8197F(v)) -+ -+#define BIT_SHIFT_AC6_PKT_INFO_8197F 0 -+#define BIT_MASK_AC6_PKT_INFO_8197F 0xfff -+#define BIT_AC6_PKT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_AC6_PKT_INFO_8197F) << BIT_SHIFT_AC6_PKT_INFO_8197F) -+#define BITS_AC6_PKT_INFO_8197F \ -+ (BIT_MASK_AC6_PKT_INFO_8197F << BIT_SHIFT_AC6_PKT_INFO_8197F) -+#define BIT_CLEAR_AC6_PKT_INFO_8197F(x) ((x) & (~BITS_AC6_PKT_INFO_8197F)) -+#define BIT_GET_AC6_PKT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_AC6_PKT_INFO_8197F) & BIT_MASK_AC6_PKT_INFO_8197F) -+#define BIT_SET_AC6_PKT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_AC6_PKT_INFO_8197F(x) | BIT_AC6_PKT_INFO_8197F(v)) -+ -+/* 2 REG_MGQ_HIQ_INFO_8197F */ -+ -+#define BIT_SHIFT_HIQ_PKT_INFO_8197F 16 -+#define BIT_MASK_HIQ_PKT_INFO_8197F 0xfff -+#define BIT_HIQ_PKT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_HIQ_PKT_INFO_8197F) << BIT_SHIFT_HIQ_PKT_INFO_8197F) -+#define BITS_HIQ_PKT_INFO_8197F \ -+ (BIT_MASK_HIQ_PKT_INFO_8197F << BIT_SHIFT_HIQ_PKT_INFO_8197F) -+#define BIT_CLEAR_HIQ_PKT_INFO_8197F(x) ((x) & (~BITS_HIQ_PKT_INFO_8197F)) -+#define BIT_GET_HIQ_PKT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_HIQ_PKT_INFO_8197F) & BIT_MASK_HIQ_PKT_INFO_8197F) -+#define BIT_SET_HIQ_PKT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_HIQ_PKT_INFO_8197F(x) | BIT_HIQ_PKT_INFO_8197F(v)) -+ -+#define BIT_SHIFT_MGQ_PKT_INFO_8197F 0 -+#define BIT_MASK_MGQ_PKT_INFO_8197F 0xfff -+#define BIT_MGQ_PKT_INFO_8197F(x) \ -+ (((x) & BIT_MASK_MGQ_PKT_INFO_8197F) << BIT_SHIFT_MGQ_PKT_INFO_8197F) -+#define BITS_MGQ_PKT_INFO_8197F \ -+ (BIT_MASK_MGQ_PKT_INFO_8197F << BIT_SHIFT_MGQ_PKT_INFO_8197F) -+#define BIT_CLEAR_MGQ_PKT_INFO_8197F(x) ((x) & (~BITS_MGQ_PKT_INFO_8197F)) -+#define BIT_GET_MGQ_PKT_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PKT_INFO_8197F) & BIT_MASK_MGQ_PKT_INFO_8197F) -+#define BIT_SET_MGQ_PKT_INFO_8197F(x, v) \ -+ (BIT_CLEAR_MGQ_PKT_INFO_8197F(x) | BIT_MGQ_PKT_INFO_8197F(v)) -+ -+/* 2 REG_CMDQ_BCNQ_INFO_8197F */ -+ -+#define BIT_SHIFT_BCNQ_PKT_INFO_V1_8197F 16 -+#define BIT_MASK_BCNQ_PKT_INFO_V1_8197F 0xfff -+#define BIT_BCNQ_PKT_INFO_V1_8197F(x) \ -+ (((x) & BIT_MASK_BCNQ_PKT_INFO_V1_8197F) \ -+ << BIT_SHIFT_BCNQ_PKT_INFO_V1_8197F) -+#define BITS_BCNQ_PKT_INFO_V1_8197F \ -+ (BIT_MASK_BCNQ_PKT_INFO_V1_8197F << BIT_SHIFT_BCNQ_PKT_INFO_V1_8197F) -+#define BIT_CLEAR_BCNQ_PKT_INFO_V1_8197F(x) \ -+ ((x) & (~BITS_BCNQ_PKT_INFO_V1_8197F)) -+#define BIT_GET_BCNQ_PKT_INFO_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PKT_INFO_V1_8197F) & \ -+ BIT_MASK_BCNQ_PKT_INFO_V1_8197F) -+#define BIT_SET_BCNQ_PKT_INFO_V1_8197F(x, v) \ -+ (BIT_CLEAR_BCNQ_PKT_INFO_V1_8197F(x) | BIT_BCNQ_PKT_INFO_V1_8197F(v)) -+ -+#define BIT_SHIFT_CMDQ_PKT_INFO_V1_8197F 0 -+#define BIT_MASK_CMDQ_PKT_INFO_V1_8197F 0xfff -+#define BIT_CMDQ_PKT_INFO_V1_8197F(x) \ -+ (((x) & BIT_MASK_CMDQ_PKT_INFO_V1_8197F) \ -+ << BIT_SHIFT_CMDQ_PKT_INFO_V1_8197F) -+#define BITS_CMDQ_PKT_INFO_V1_8197F \ -+ (BIT_MASK_CMDQ_PKT_INFO_V1_8197F << BIT_SHIFT_CMDQ_PKT_INFO_V1_8197F) -+#define BIT_CLEAR_CMDQ_PKT_INFO_V1_8197F(x) \ -+ ((x) & (~BITS_CMDQ_PKT_INFO_V1_8197F)) -+#define BIT_GET_CMDQ_PKT_INFO_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_CMDQ_PKT_INFO_V1_8197F) & \ -+ BIT_MASK_CMDQ_PKT_INFO_V1_8197F) -+#define BIT_SET_CMDQ_PKT_INFO_V1_8197F(x, v) \ -+ (BIT_CLEAR_CMDQ_PKT_INFO_V1_8197F(x) | BIT_CMDQ_PKT_INFO_V1_8197F(v)) -+ -+/* 2 REG_USEREG_SETTING_8197F */ -+#define BIT_NDPA_USEREG_8197F BIT(21) -+ -+#define BIT_SHIFT_RETRY_USEREG_8197F 19 -+#define BIT_MASK_RETRY_USEREG_8197F 0x3 -+#define BIT_RETRY_USEREG_8197F(x) \ -+ (((x) & BIT_MASK_RETRY_USEREG_8197F) << BIT_SHIFT_RETRY_USEREG_8197F) -+#define BITS_RETRY_USEREG_8197F \ -+ (BIT_MASK_RETRY_USEREG_8197F << BIT_SHIFT_RETRY_USEREG_8197F) -+#define BIT_CLEAR_RETRY_USEREG_8197F(x) ((x) & (~BITS_RETRY_USEREG_8197F)) -+#define BIT_GET_RETRY_USEREG_8197F(x) \ -+ (((x) >> BIT_SHIFT_RETRY_USEREG_8197F) & BIT_MASK_RETRY_USEREG_8197F) -+#define BIT_SET_RETRY_USEREG_8197F(x, v) \ -+ (BIT_CLEAR_RETRY_USEREG_8197F(x) | BIT_RETRY_USEREG_8197F(v)) -+ -+#define BIT_SHIFT_TRYPKT_USEREG_8197F 17 -+#define BIT_MASK_TRYPKT_USEREG_8197F 0x3 -+#define BIT_TRYPKT_USEREG_8197F(x) \ -+ (((x) & BIT_MASK_TRYPKT_USEREG_8197F) << BIT_SHIFT_TRYPKT_USEREG_8197F) -+#define BITS_TRYPKT_USEREG_8197F \ -+ (BIT_MASK_TRYPKT_USEREG_8197F << BIT_SHIFT_TRYPKT_USEREG_8197F) -+#define BIT_CLEAR_TRYPKT_USEREG_8197F(x) ((x) & (~BITS_TRYPKT_USEREG_8197F)) -+#define BIT_GET_TRYPKT_USEREG_8197F(x) \ -+ (((x) >> BIT_SHIFT_TRYPKT_USEREG_8197F) & BIT_MASK_TRYPKT_USEREG_8197F) -+#define BIT_SET_TRYPKT_USEREG_8197F(x, v) \ -+ (BIT_CLEAR_TRYPKT_USEREG_8197F(x) | BIT_TRYPKT_USEREG_8197F(v)) -+ -+#define BIT_CTLPKT_USEREG_8197F BIT(16) -+ -+/* 2 REG_AESIV_SETTING_8197F */ -+ -+#define BIT_SHIFT_AESIV_OFFSET_8197F 0 -+#define BIT_MASK_AESIV_OFFSET_8197F 0xfff -+#define BIT_AESIV_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_AESIV_OFFSET_8197F) << BIT_SHIFT_AESIV_OFFSET_8197F) -+#define BITS_AESIV_OFFSET_8197F \ -+ (BIT_MASK_AESIV_OFFSET_8197F << BIT_SHIFT_AESIV_OFFSET_8197F) -+#define BIT_CLEAR_AESIV_OFFSET_8197F(x) ((x) & (~BITS_AESIV_OFFSET_8197F)) -+#define BIT_GET_AESIV_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_AESIV_OFFSET_8197F) & BIT_MASK_AESIV_OFFSET_8197F) -+#define BIT_SET_AESIV_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_AESIV_OFFSET_8197F(x) | BIT_AESIV_OFFSET_8197F(v)) -+ -+/* 2 REG_BF0_TIME_SETTING_8197F */ -+#define BIT_BF0_TIMER_SET_8197F BIT(31) -+#define BIT_BF0_TIMER_CLR_8197F BIT(30) -+#define BIT_BF0_UPDATE_EN_8197F BIT(29) -+#define BIT_BF0_TIMER_EN_8197F BIT(28) -+ -+#define BIT_SHIFT_BF0_PRETIME_OVER_8197F 16 -+#define BIT_MASK_BF0_PRETIME_OVER_8197F 0xfff -+#define BIT_BF0_PRETIME_OVER_8197F(x) \ -+ (((x) & BIT_MASK_BF0_PRETIME_OVER_8197F) \ -+ << BIT_SHIFT_BF0_PRETIME_OVER_8197F) -+#define BITS_BF0_PRETIME_OVER_8197F \ -+ (BIT_MASK_BF0_PRETIME_OVER_8197F << BIT_SHIFT_BF0_PRETIME_OVER_8197F) -+#define BIT_CLEAR_BF0_PRETIME_OVER_8197F(x) \ -+ ((x) & (~BITS_BF0_PRETIME_OVER_8197F)) -+#define BIT_GET_BF0_PRETIME_OVER_8197F(x) \ -+ (((x) >> BIT_SHIFT_BF0_PRETIME_OVER_8197F) & \ -+ BIT_MASK_BF0_PRETIME_OVER_8197F) -+#define BIT_SET_BF0_PRETIME_OVER_8197F(x, v) \ -+ (BIT_CLEAR_BF0_PRETIME_OVER_8197F(x) | BIT_BF0_PRETIME_OVER_8197F(v)) -+ -+#define BIT_SHIFT_BF0_LIFETIME_8197F 0 -+#define BIT_MASK_BF0_LIFETIME_8197F 0xffff -+#define BIT_BF0_LIFETIME_8197F(x) \ -+ (((x) & BIT_MASK_BF0_LIFETIME_8197F) << BIT_SHIFT_BF0_LIFETIME_8197F) -+#define BITS_BF0_LIFETIME_8197F \ -+ (BIT_MASK_BF0_LIFETIME_8197F << BIT_SHIFT_BF0_LIFETIME_8197F) -+#define BIT_CLEAR_BF0_LIFETIME_8197F(x) ((x) & (~BITS_BF0_LIFETIME_8197F)) -+#define BIT_GET_BF0_LIFETIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_BF0_LIFETIME_8197F) & BIT_MASK_BF0_LIFETIME_8197F) -+#define BIT_SET_BF0_LIFETIME_8197F(x, v) \ -+ (BIT_CLEAR_BF0_LIFETIME_8197F(x) | BIT_BF0_LIFETIME_8197F(v)) -+ -+/* 2 REG_BF1_TIME_SETTING_8197F */ -+#define BIT_BF1_TIMER_SET_8197F BIT(31) -+#define BIT_BF1_TIMER_CLR_8197F BIT(30) -+#define BIT_BF1_UPDATE_EN_8197F BIT(29) -+#define BIT_BF1_TIMER_EN_8197F BIT(28) -+ -+#define BIT_SHIFT_BF1_PRETIME_OVER_8197F 16 -+#define BIT_MASK_BF1_PRETIME_OVER_8197F 0xfff -+#define BIT_BF1_PRETIME_OVER_8197F(x) \ -+ (((x) & BIT_MASK_BF1_PRETIME_OVER_8197F) \ -+ << BIT_SHIFT_BF1_PRETIME_OVER_8197F) -+#define BITS_BF1_PRETIME_OVER_8197F \ -+ (BIT_MASK_BF1_PRETIME_OVER_8197F << BIT_SHIFT_BF1_PRETIME_OVER_8197F) -+#define BIT_CLEAR_BF1_PRETIME_OVER_8197F(x) \ -+ ((x) & (~BITS_BF1_PRETIME_OVER_8197F)) -+#define BIT_GET_BF1_PRETIME_OVER_8197F(x) \ -+ (((x) >> BIT_SHIFT_BF1_PRETIME_OVER_8197F) & \ -+ BIT_MASK_BF1_PRETIME_OVER_8197F) -+#define BIT_SET_BF1_PRETIME_OVER_8197F(x, v) \ -+ (BIT_CLEAR_BF1_PRETIME_OVER_8197F(x) | BIT_BF1_PRETIME_OVER_8197F(v)) -+ -+#define BIT_SHIFT_BF1_LIFETIME_8197F 0 -+#define BIT_MASK_BF1_LIFETIME_8197F 0xffff -+#define BIT_BF1_LIFETIME_8197F(x) \ -+ (((x) & BIT_MASK_BF1_LIFETIME_8197F) << BIT_SHIFT_BF1_LIFETIME_8197F) -+#define BITS_BF1_LIFETIME_8197F \ -+ (BIT_MASK_BF1_LIFETIME_8197F << BIT_SHIFT_BF1_LIFETIME_8197F) -+#define BIT_CLEAR_BF1_LIFETIME_8197F(x) ((x) & (~BITS_BF1_LIFETIME_8197F)) -+#define BIT_GET_BF1_LIFETIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_BF1_LIFETIME_8197F) & BIT_MASK_BF1_LIFETIME_8197F) -+#define BIT_SET_BF1_LIFETIME_8197F(x, v) \ -+ (BIT_CLEAR_BF1_LIFETIME_8197F(x) | BIT_BF1_LIFETIME_8197F(v)) -+ -+/* 2 REG_BF_TIMEOUT_EN_8197F */ -+#define BIT_EN_VHT_LDPC_8197F BIT(9) -+#define BIT_EN_HT_LDPC_8197F BIT(8) -+#define BIT_BF1_TIMEOUT_EN_8197F BIT(1) -+#define BIT_BF0_TIMEOUT_EN_8197F BIT(0) -+ -+/* 2 REG_MACID_RELEASE0_8197F */ -+ -+#define BIT_SHIFT_MACID31_0_RELEASE_8197F 0 -+#define BIT_MASK_MACID31_0_RELEASE_8197F 0xffffffffL -+#define BIT_MACID31_0_RELEASE_8197F(x) \ -+ (((x) & BIT_MASK_MACID31_0_RELEASE_8197F) \ -+ << BIT_SHIFT_MACID31_0_RELEASE_8197F) -+#define BITS_MACID31_0_RELEASE_8197F \ -+ (BIT_MASK_MACID31_0_RELEASE_8197F << BIT_SHIFT_MACID31_0_RELEASE_8197F) -+#define BIT_CLEAR_MACID31_0_RELEASE_8197F(x) \ -+ ((x) & (~BITS_MACID31_0_RELEASE_8197F)) -+#define BIT_GET_MACID31_0_RELEASE_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_RELEASE_8197F) & \ -+ BIT_MASK_MACID31_0_RELEASE_8197F) -+#define BIT_SET_MACID31_0_RELEASE_8197F(x, v) \ -+ (BIT_CLEAR_MACID31_0_RELEASE_8197F(x) | BIT_MACID31_0_RELEASE_8197F(v)) -+ -+/* 2 REG_MACID_RELEASE1_8197F */ -+ -+#define BIT_SHIFT_MACID63_32_RELEASE_8197F 0 -+#define BIT_MASK_MACID63_32_RELEASE_8197F 0xffffffffL -+#define BIT_MACID63_32_RELEASE_8197F(x) \ -+ (((x) & BIT_MASK_MACID63_32_RELEASE_8197F) \ -+ << BIT_SHIFT_MACID63_32_RELEASE_8197F) -+#define BITS_MACID63_32_RELEASE_8197F \ -+ (BIT_MASK_MACID63_32_RELEASE_8197F \ -+ << BIT_SHIFT_MACID63_32_RELEASE_8197F) -+#define BIT_CLEAR_MACID63_32_RELEASE_8197F(x) \ -+ ((x) & (~BITS_MACID63_32_RELEASE_8197F)) -+#define BIT_GET_MACID63_32_RELEASE_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_RELEASE_8197F) & \ -+ BIT_MASK_MACID63_32_RELEASE_8197F) -+#define BIT_SET_MACID63_32_RELEASE_8197F(x, v) \ -+ (BIT_CLEAR_MACID63_32_RELEASE_8197F(x) | \ -+ BIT_MACID63_32_RELEASE_8197F(v)) -+ -+/* 2 REG_MACID_RELEASE2_8197F */ -+ -+#define BIT_SHIFT_MACID95_64_RELEASE_8197F 0 -+#define BIT_MASK_MACID95_64_RELEASE_8197F 0xffffffffL -+#define BIT_MACID95_64_RELEASE_8197F(x) \ -+ (((x) & BIT_MASK_MACID95_64_RELEASE_8197F) \ -+ << BIT_SHIFT_MACID95_64_RELEASE_8197F) -+#define BITS_MACID95_64_RELEASE_8197F \ -+ (BIT_MASK_MACID95_64_RELEASE_8197F \ -+ << BIT_SHIFT_MACID95_64_RELEASE_8197F) -+#define BIT_CLEAR_MACID95_64_RELEASE_8197F(x) \ -+ ((x) & (~BITS_MACID95_64_RELEASE_8197F)) -+#define BIT_GET_MACID95_64_RELEASE_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_RELEASE_8197F) & \ -+ BIT_MASK_MACID95_64_RELEASE_8197F) -+#define BIT_SET_MACID95_64_RELEASE_8197F(x, v) \ -+ (BIT_CLEAR_MACID95_64_RELEASE_8197F(x) | \ -+ BIT_MACID95_64_RELEASE_8197F(v)) -+ -+/* 2 REG_MACID_RELEASE3_8197F */ -+ -+#define BIT_SHIFT_MACID127_96_RELEASE_8197F 0 -+#define BIT_MASK_MACID127_96_RELEASE_8197F 0xffffffffL -+#define BIT_MACID127_96_RELEASE_8197F(x) \ -+ (((x) & BIT_MASK_MACID127_96_RELEASE_8197F) \ -+ << BIT_SHIFT_MACID127_96_RELEASE_8197F) -+#define BITS_MACID127_96_RELEASE_8197F \ -+ (BIT_MASK_MACID127_96_RELEASE_8197F \ -+ << BIT_SHIFT_MACID127_96_RELEASE_8197F) -+#define BIT_CLEAR_MACID127_96_RELEASE_8197F(x) \ -+ ((x) & (~BITS_MACID127_96_RELEASE_8197F)) -+#define BIT_GET_MACID127_96_RELEASE_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_RELEASE_8197F) & \ -+ BIT_MASK_MACID127_96_RELEASE_8197F) -+#define BIT_SET_MACID127_96_RELEASE_8197F(x, v) \ -+ (BIT_CLEAR_MACID127_96_RELEASE_8197F(x) | \ -+ BIT_MACID127_96_RELEASE_8197F(v)) -+ -+/* 2 REG_MACID_RELEASE_SETTING_8197F */ -+#define BIT_MACID_VALUE_8197F BIT(7) -+ -+#define BIT_SHIFT_MACID_OFFSET_8197F 0 -+#define BIT_MASK_MACID_OFFSET_8197F 0x7f -+#define BIT_MACID_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_MACID_OFFSET_8197F) << BIT_SHIFT_MACID_OFFSET_8197F) -+#define BITS_MACID_OFFSET_8197F \ -+ (BIT_MASK_MACID_OFFSET_8197F << BIT_SHIFT_MACID_OFFSET_8197F) -+#define BIT_CLEAR_MACID_OFFSET_8197F(x) ((x) & (~BITS_MACID_OFFSET_8197F)) -+#define BIT_GET_MACID_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID_OFFSET_8197F) & BIT_MASK_MACID_OFFSET_8197F) -+#define BIT_SET_MACID_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_MACID_OFFSET_8197F(x) | BIT_MACID_OFFSET_8197F(v)) -+ -+/* 2 REG_FAST_EDCA_VOVI_SETTING_8197F */ -+ -+#define BIT_SHIFT_VI_FAST_EDCA_TO_8197F 24 -+#define BIT_MASK_VI_FAST_EDCA_TO_8197F 0xff -+#define BIT_VI_FAST_EDCA_TO_8197F(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_TO_8197F) \ -+ << BIT_SHIFT_VI_FAST_EDCA_TO_8197F) -+#define BITS_VI_FAST_EDCA_TO_8197F \ -+ (BIT_MASK_VI_FAST_EDCA_TO_8197F << BIT_SHIFT_VI_FAST_EDCA_TO_8197F) -+#define BIT_CLEAR_VI_FAST_EDCA_TO_8197F(x) ((x) & (~BITS_VI_FAST_EDCA_TO_8197F)) -+#define BIT_GET_VI_FAST_EDCA_TO_8197F(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_TO_8197F) & \ -+ BIT_MASK_VI_FAST_EDCA_TO_8197F) -+#define BIT_SET_VI_FAST_EDCA_TO_8197F(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_TO_8197F(x) | BIT_VI_FAST_EDCA_TO_8197F(v)) -+ -+#define BIT_VI_THRESHOLD_SEL_8197F BIT(23) -+ -+#define BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8197F 16 -+#define BIT_MASK_VI_FAST_EDCA_PKT_TH_8197F 0x7f -+#define BIT_VI_FAST_EDCA_PKT_TH_8197F(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_PKT_TH_8197F) \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8197F) -+#define BITS_VI_FAST_EDCA_PKT_TH_8197F \ -+ (BIT_MASK_VI_FAST_EDCA_PKT_TH_8197F \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8197F) -+#define BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8197F(x) \ -+ ((x) & (~BITS_VI_FAST_EDCA_PKT_TH_8197F)) -+#define BIT_GET_VI_FAST_EDCA_PKT_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8197F) & \ -+ BIT_MASK_VI_FAST_EDCA_PKT_TH_8197F) -+#define BIT_SET_VI_FAST_EDCA_PKT_TH_8197F(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8197F(x) | \ -+ BIT_VI_FAST_EDCA_PKT_TH_8197F(v)) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_TO_8197F 8 -+#define BIT_MASK_VO_FAST_EDCA_TO_8197F 0xff -+#define BIT_VO_FAST_EDCA_TO_8197F(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_TO_8197F) \ -+ << BIT_SHIFT_VO_FAST_EDCA_TO_8197F) -+#define BITS_VO_FAST_EDCA_TO_8197F \ -+ (BIT_MASK_VO_FAST_EDCA_TO_8197F << BIT_SHIFT_VO_FAST_EDCA_TO_8197F) -+#define BIT_CLEAR_VO_FAST_EDCA_TO_8197F(x) ((x) & (~BITS_VO_FAST_EDCA_TO_8197F)) -+#define BIT_GET_VO_FAST_EDCA_TO_8197F(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_TO_8197F) & \ -+ BIT_MASK_VO_FAST_EDCA_TO_8197F) -+#define BIT_SET_VO_FAST_EDCA_TO_8197F(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_TO_8197F(x) | BIT_VO_FAST_EDCA_TO_8197F(v)) -+ -+#define BIT_VO_THRESHOLD_SEL_8197F BIT(7) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8197F 0 -+#define BIT_MASK_VO_FAST_EDCA_PKT_TH_8197F 0x7f -+#define BIT_VO_FAST_EDCA_PKT_TH_8197F(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_PKT_TH_8197F) \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8197F) -+#define BITS_VO_FAST_EDCA_PKT_TH_8197F \ -+ (BIT_MASK_VO_FAST_EDCA_PKT_TH_8197F \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8197F) -+#define BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8197F(x) \ -+ ((x) & (~BITS_VO_FAST_EDCA_PKT_TH_8197F)) -+#define BIT_GET_VO_FAST_EDCA_PKT_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8197F) & \ -+ BIT_MASK_VO_FAST_EDCA_PKT_TH_8197F) -+#define BIT_SET_VO_FAST_EDCA_PKT_TH_8197F(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8197F(x) | \ -+ BIT_VO_FAST_EDCA_PKT_TH_8197F(v)) -+ -+/* 2 REG_FAST_EDCA_BEBK_SETTING_8197F */ -+ -+#define BIT_SHIFT_BK_FAST_EDCA_TO_8197F 24 -+#define BIT_MASK_BK_FAST_EDCA_TO_8197F 0xff -+#define BIT_BK_FAST_EDCA_TO_8197F(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_TO_8197F) \ -+ << BIT_SHIFT_BK_FAST_EDCA_TO_8197F) -+#define BITS_BK_FAST_EDCA_TO_8197F \ -+ (BIT_MASK_BK_FAST_EDCA_TO_8197F << BIT_SHIFT_BK_FAST_EDCA_TO_8197F) -+#define BIT_CLEAR_BK_FAST_EDCA_TO_8197F(x) ((x) & (~BITS_BK_FAST_EDCA_TO_8197F)) -+#define BIT_GET_BK_FAST_EDCA_TO_8197F(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_TO_8197F) & \ -+ BIT_MASK_BK_FAST_EDCA_TO_8197F) -+#define BIT_SET_BK_FAST_EDCA_TO_8197F(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_TO_8197F(x) | BIT_BK_FAST_EDCA_TO_8197F(v)) -+ -+#define BIT_BK_THRESHOLD_SEL_8197F BIT(23) -+ -+#define BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8197F 16 -+#define BIT_MASK_BK_FAST_EDCA_PKT_TH_8197F 0x7f -+#define BIT_BK_FAST_EDCA_PKT_TH_8197F(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_PKT_TH_8197F) \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8197F) -+#define BITS_BK_FAST_EDCA_PKT_TH_8197F \ -+ (BIT_MASK_BK_FAST_EDCA_PKT_TH_8197F \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8197F) -+#define BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8197F(x) \ -+ ((x) & (~BITS_BK_FAST_EDCA_PKT_TH_8197F)) -+#define BIT_GET_BK_FAST_EDCA_PKT_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8197F) & \ -+ BIT_MASK_BK_FAST_EDCA_PKT_TH_8197F) -+#define BIT_SET_BK_FAST_EDCA_PKT_TH_8197F(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8197F(x) | \ -+ BIT_BK_FAST_EDCA_PKT_TH_8197F(v)) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_TO_8197F 8 -+#define BIT_MASK_BE_FAST_EDCA_TO_8197F 0xff -+#define BIT_BE_FAST_EDCA_TO_8197F(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_TO_8197F) \ -+ << BIT_SHIFT_BE_FAST_EDCA_TO_8197F) -+#define BITS_BE_FAST_EDCA_TO_8197F \ -+ (BIT_MASK_BE_FAST_EDCA_TO_8197F << BIT_SHIFT_BE_FAST_EDCA_TO_8197F) -+#define BIT_CLEAR_BE_FAST_EDCA_TO_8197F(x) ((x) & (~BITS_BE_FAST_EDCA_TO_8197F)) -+#define BIT_GET_BE_FAST_EDCA_TO_8197F(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_TO_8197F) & \ -+ BIT_MASK_BE_FAST_EDCA_TO_8197F) -+#define BIT_SET_BE_FAST_EDCA_TO_8197F(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_TO_8197F(x) | BIT_BE_FAST_EDCA_TO_8197F(v)) -+ -+#define BIT_BE_THRESHOLD_SEL_8197F BIT(7) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8197F 0 -+#define BIT_MASK_BE_FAST_EDCA_PKT_TH_8197F 0x7f -+#define BIT_BE_FAST_EDCA_PKT_TH_8197F(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_PKT_TH_8197F) \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8197F) -+#define BITS_BE_FAST_EDCA_PKT_TH_8197F \ -+ (BIT_MASK_BE_FAST_EDCA_PKT_TH_8197F \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8197F) -+#define BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8197F(x) \ -+ ((x) & (~BITS_BE_FAST_EDCA_PKT_TH_8197F)) -+#define BIT_GET_BE_FAST_EDCA_PKT_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8197F) & \ -+ BIT_MASK_BE_FAST_EDCA_PKT_TH_8197F) -+#define BIT_SET_BE_FAST_EDCA_PKT_TH_8197F(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8197F(x) | \ -+ BIT_BE_FAST_EDCA_PKT_TH_8197F(v)) -+ -+/* 2 REG_MACID_DROP0_8197F */ -+ -+#define BIT_SHIFT_MACID31_0_DROP_8197F 0 -+#define BIT_MASK_MACID31_0_DROP_8197F 0xffffffffL -+#define BIT_MACID31_0_DROP_8197F(x) \ -+ (((x) & BIT_MASK_MACID31_0_DROP_8197F) \ -+ << BIT_SHIFT_MACID31_0_DROP_8197F) -+#define BITS_MACID31_0_DROP_8197F \ -+ (BIT_MASK_MACID31_0_DROP_8197F << BIT_SHIFT_MACID31_0_DROP_8197F) -+#define BIT_CLEAR_MACID31_0_DROP_8197F(x) ((x) & (~BITS_MACID31_0_DROP_8197F)) -+#define BIT_GET_MACID31_0_DROP_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_DROP_8197F) & \ -+ BIT_MASK_MACID31_0_DROP_8197F) -+#define BIT_SET_MACID31_0_DROP_8197F(x, v) \ -+ (BIT_CLEAR_MACID31_0_DROP_8197F(x) | BIT_MACID31_0_DROP_8197F(v)) -+ -+/* 2 REG_MACID_DROP1_8197F */ -+ -+#define BIT_SHIFT_MACID63_32_DROP_8197F 0 -+#define BIT_MASK_MACID63_32_DROP_8197F 0xffffffffL -+#define BIT_MACID63_32_DROP_8197F(x) \ -+ (((x) & BIT_MASK_MACID63_32_DROP_8197F) \ -+ << BIT_SHIFT_MACID63_32_DROP_8197F) -+#define BITS_MACID63_32_DROP_8197F \ -+ (BIT_MASK_MACID63_32_DROP_8197F << BIT_SHIFT_MACID63_32_DROP_8197F) -+#define BIT_CLEAR_MACID63_32_DROP_8197F(x) ((x) & (~BITS_MACID63_32_DROP_8197F)) -+#define BIT_GET_MACID63_32_DROP_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_DROP_8197F) & \ -+ BIT_MASK_MACID63_32_DROP_8197F) -+#define BIT_SET_MACID63_32_DROP_8197F(x, v) \ -+ (BIT_CLEAR_MACID63_32_DROP_8197F(x) | BIT_MACID63_32_DROP_8197F(v)) -+ -+/* 2 REG_MACID_DROP2_8197F */ -+ -+#define BIT_SHIFT_MACID95_64_DROP_8197F 0 -+#define BIT_MASK_MACID95_64_DROP_8197F 0xffffffffL -+#define BIT_MACID95_64_DROP_8197F(x) \ -+ (((x) & BIT_MASK_MACID95_64_DROP_8197F) \ -+ << BIT_SHIFT_MACID95_64_DROP_8197F) -+#define BITS_MACID95_64_DROP_8197F \ -+ (BIT_MASK_MACID95_64_DROP_8197F << BIT_SHIFT_MACID95_64_DROP_8197F) -+#define BIT_CLEAR_MACID95_64_DROP_8197F(x) ((x) & (~BITS_MACID95_64_DROP_8197F)) -+#define BIT_GET_MACID95_64_DROP_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_DROP_8197F) & \ -+ BIT_MASK_MACID95_64_DROP_8197F) -+#define BIT_SET_MACID95_64_DROP_8197F(x, v) \ -+ (BIT_CLEAR_MACID95_64_DROP_8197F(x) | BIT_MACID95_64_DROP_8197F(v)) -+ -+/* 2 REG_MACID_DROP3_8197F */ -+ -+#define BIT_SHIFT_MACID127_96_DROP_8197F 0 -+#define BIT_MASK_MACID127_96_DROP_8197F 0xffffffffL -+#define BIT_MACID127_96_DROP_8197F(x) \ -+ (((x) & BIT_MASK_MACID127_96_DROP_8197F) \ -+ << BIT_SHIFT_MACID127_96_DROP_8197F) -+#define BITS_MACID127_96_DROP_8197F \ -+ (BIT_MASK_MACID127_96_DROP_8197F << BIT_SHIFT_MACID127_96_DROP_8197F) -+#define BIT_CLEAR_MACID127_96_DROP_8197F(x) \ -+ ((x) & (~BITS_MACID127_96_DROP_8197F)) -+#define BIT_GET_MACID127_96_DROP_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_DROP_8197F) & \ -+ BIT_MASK_MACID127_96_DROP_8197F) -+#define BIT_SET_MACID127_96_DROP_8197F(x, v) \ -+ (BIT_CLEAR_MACID127_96_DROP_8197F(x) | BIT_MACID127_96_DROP_8197F(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_0_8197F */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8197F 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8197F 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_0_8197F(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8197F) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8197F) -+#define BITS_R_MACID_RELEASE_SUCCESS_0_8197F \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8197F \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8197F) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0_8197F(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_0_8197F)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8197F) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8197F) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_0_8197F(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0_8197F(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_0_8197F(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_1_8197F */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8197F 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8197F 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_1_8197F(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8197F) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8197F) -+#define BITS_R_MACID_RELEASE_SUCCESS_1_8197F \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8197F \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8197F) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1_8197F(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_1_8197F)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8197F) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8197F) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_1_8197F(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1_8197F(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_1_8197F(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_2_8197F */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8197F 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8197F 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_2_8197F(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8197F) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8197F) -+#define BITS_R_MACID_RELEASE_SUCCESS_2_8197F \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8197F \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8197F) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2_8197F(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_2_8197F)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_2_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8197F) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8197F) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_2_8197F(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2_8197F(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_2_8197F(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_3_8197F */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8197F 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8197F 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_3_8197F(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8197F) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8197F) -+#define BITS_R_MACID_RELEASE_SUCCESS_3_8197F \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8197F \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8197F) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3_8197F(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_3_8197F)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_3_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8197F) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8197F) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_3_8197F(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3_8197F(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_3_8197F(v)) -+ -+/* 2 REG_MGG_FIFO_CRTL_8197F */ -+#define BIT_R_MGG_FIFO_EN_8197F BIT(31) -+ -+#define BIT_SHIFT_R_MGG_FIFO_PG_SIZE_8197F 28 -+#define BIT_MASK_R_MGG_FIFO_PG_SIZE_8197F 0x7 -+#define BIT_R_MGG_FIFO_PG_SIZE_8197F(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_PG_SIZE_8197F) \ -+ << BIT_SHIFT_R_MGG_FIFO_PG_SIZE_8197F) -+#define BITS_R_MGG_FIFO_PG_SIZE_8197F \ -+ (BIT_MASK_R_MGG_FIFO_PG_SIZE_8197F \ -+ << BIT_SHIFT_R_MGG_FIFO_PG_SIZE_8197F) -+#define BIT_CLEAR_R_MGG_FIFO_PG_SIZE_8197F(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_PG_SIZE_8197F)) -+#define BIT_GET_R_MGG_FIFO_PG_SIZE_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_PG_SIZE_8197F) & \ -+ BIT_MASK_R_MGG_FIFO_PG_SIZE_8197F) -+#define BIT_SET_R_MGG_FIFO_PG_SIZE_8197F(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_PG_SIZE_8197F(x) | \ -+ BIT_R_MGG_FIFO_PG_SIZE_8197F(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_START_PG_8197F 16 -+#define BIT_MASK_R_MGG_FIFO_START_PG_8197F 0xfff -+#define BIT_R_MGG_FIFO_START_PG_8197F(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_START_PG_8197F) \ -+ << BIT_SHIFT_R_MGG_FIFO_START_PG_8197F) -+#define BITS_R_MGG_FIFO_START_PG_8197F \ -+ (BIT_MASK_R_MGG_FIFO_START_PG_8197F \ -+ << BIT_SHIFT_R_MGG_FIFO_START_PG_8197F) -+#define BIT_CLEAR_R_MGG_FIFO_START_PG_8197F(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_START_PG_8197F)) -+#define BIT_GET_R_MGG_FIFO_START_PG_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_START_PG_8197F) & \ -+ BIT_MASK_R_MGG_FIFO_START_PG_8197F) -+#define BIT_SET_R_MGG_FIFO_START_PG_8197F(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_START_PG_8197F(x) | \ -+ BIT_R_MGG_FIFO_START_PG_8197F(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_SIZE_8197F 14 -+#define BIT_MASK_R_MGG_FIFO_SIZE_8197F 0x3 -+#define BIT_R_MGG_FIFO_SIZE_8197F(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_SIZE_8197F) \ -+ << BIT_SHIFT_R_MGG_FIFO_SIZE_8197F) -+#define BITS_R_MGG_FIFO_SIZE_8197F \ -+ (BIT_MASK_R_MGG_FIFO_SIZE_8197F << BIT_SHIFT_R_MGG_FIFO_SIZE_8197F) -+#define BIT_CLEAR_R_MGG_FIFO_SIZE_8197F(x) ((x) & (~BITS_R_MGG_FIFO_SIZE_8197F)) -+#define BIT_GET_R_MGG_FIFO_SIZE_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_SIZE_8197F) & \ -+ BIT_MASK_R_MGG_FIFO_SIZE_8197F) -+#define BIT_SET_R_MGG_FIFO_SIZE_8197F(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_SIZE_8197F(x) | BIT_R_MGG_FIFO_SIZE_8197F(v)) -+ -+#define BIT_R_MGG_FIFO_PAUSE_8197F BIT(13) -+ -+#define BIT_SHIFT_R_MGG_FIFO_RPTR_8197F 8 -+#define BIT_MASK_R_MGG_FIFO_RPTR_8197F 0x1f -+#define BIT_R_MGG_FIFO_RPTR_8197F(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_RPTR_8197F) \ -+ << BIT_SHIFT_R_MGG_FIFO_RPTR_8197F) -+#define BITS_R_MGG_FIFO_RPTR_8197F \ -+ (BIT_MASK_R_MGG_FIFO_RPTR_8197F << BIT_SHIFT_R_MGG_FIFO_RPTR_8197F) -+#define BIT_CLEAR_R_MGG_FIFO_RPTR_8197F(x) ((x) & (~BITS_R_MGG_FIFO_RPTR_8197F)) -+#define BIT_GET_R_MGG_FIFO_RPTR_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_RPTR_8197F) & \ -+ BIT_MASK_R_MGG_FIFO_RPTR_8197F) -+#define BIT_SET_R_MGG_FIFO_RPTR_8197F(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_RPTR_8197F(x) | BIT_R_MGG_FIFO_RPTR_8197F(v)) -+ -+#define BIT_R_MGG_FIFO_OV_8197F BIT(7) -+#define BIT_R_MGG_FIFO_WPTR_ERROR_8197F BIT(6) -+#define BIT_R_EN_CPU_LIFETIME_8197F BIT(5) -+ -+#define BIT_SHIFT_R_MGG_FIFO_WPTR_8197F 0 -+#define BIT_MASK_R_MGG_FIFO_WPTR_8197F 0x1f -+#define BIT_R_MGG_FIFO_WPTR_8197F(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_WPTR_8197F) \ -+ << BIT_SHIFT_R_MGG_FIFO_WPTR_8197F) -+#define BITS_R_MGG_FIFO_WPTR_8197F \ -+ (BIT_MASK_R_MGG_FIFO_WPTR_8197F << BIT_SHIFT_R_MGG_FIFO_WPTR_8197F) -+#define BIT_CLEAR_R_MGG_FIFO_WPTR_8197F(x) ((x) & (~BITS_R_MGG_FIFO_WPTR_8197F)) -+#define BIT_GET_R_MGG_FIFO_WPTR_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_WPTR_8197F) & \ -+ BIT_MASK_R_MGG_FIFO_WPTR_8197F) -+#define BIT_SET_R_MGG_FIFO_WPTR_8197F(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_WPTR_8197F(x) | BIT_R_MGG_FIFO_WPTR_8197F(v)) -+ -+/* 2 REG_MGG_FIFO_INT_8197F */ -+ -+#define BIT_SHIFT_R_MGG_FIFO_INT_FLAG_8197F 16 -+#define BIT_MASK_R_MGG_FIFO_INT_FLAG_8197F 0xffff -+#define BIT_R_MGG_FIFO_INT_FLAG_8197F(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_INT_FLAG_8197F) \ -+ << BIT_SHIFT_R_MGG_FIFO_INT_FLAG_8197F) -+#define BITS_R_MGG_FIFO_INT_FLAG_8197F \ -+ (BIT_MASK_R_MGG_FIFO_INT_FLAG_8197F \ -+ << BIT_SHIFT_R_MGG_FIFO_INT_FLAG_8197F) -+#define BIT_CLEAR_R_MGG_FIFO_INT_FLAG_8197F(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_INT_FLAG_8197F)) -+#define BIT_GET_R_MGG_FIFO_INT_FLAG_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_INT_FLAG_8197F) & \ -+ BIT_MASK_R_MGG_FIFO_INT_FLAG_8197F) -+#define BIT_SET_R_MGG_FIFO_INT_FLAG_8197F(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_INT_FLAG_8197F(x) | \ -+ BIT_R_MGG_FIFO_INT_FLAG_8197F(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_INT_MASK_8197F 0 -+#define BIT_MASK_R_MGG_FIFO_INT_MASK_8197F 0xffff -+#define BIT_R_MGG_FIFO_INT_MASK_8197F(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_INT_MASK_8197F) \ -+ << BIT_SHIFT_R_MGG_FIFO_INT_MASK_8197F) -+#define BITS_R_MGG_FIFO_INT_MASK_8197F \ -+ (BIT_MASK_R_MGG_FIFO_INT_MASK_8197F \ -+ << BIT_SHIFT_R_MGG_FIFO_INT_MASK_8197F) -+#define BIT_CLEAR_R_MGG_FIFO_INT_MASK_8197F(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_INT_MASK_8197F)) -+#define BIT_GET_R_MGG_FIFO_INT_MASK_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_INT_MASK_8197F) & \ -+ BIT_MASK_R_MGG_FIFO_INT_MASK_8197F) -+#define BIT_SET_R_MGG_FIFO_INT_MASK_8197F(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_INT_MASK_8197F(x) | \ -+ BIT_R_MGG_FIFO_INT_MASK_8197F(v)) -+ -+/* 2 REG_MGG_FIFO_LIFETIME_8197F */ -+ -+#define BIT_SHIFT_R_MGG_FIFO_LIFETIME_8197F 16 -+#define BIT_MASK_R_MGG_FIFO_LIFETIME_8197F 0xffff -+#define BIT_R_MGG_FIFO_LIFETIME_8197F(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_LIFETIME_8197F) \ -+ << BIT_SHIFT_R_MGG_FIFO_LIFETIME_8197F) -+#define BITS_R_MGG_FIFO_LIFETIME_8197F \ -+ (BIT_MASK_R_MGG_FIFO_LIFETIME_8197F \ -+ << BIT_SHIFT_R_MGG_FIFO_LIFETIME_8197F) -+#define BIT_CLEAR_R_MGG_FIFO_LIFETIME_8197F(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_LIFETIME_8197F)) -+#define BIT_GET_R_MGG_FIFO_LIFETIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_LIFETIME_8197F) & \ -+ BIT_MASK_R_MGG_FIFO_LIFETIME_8197F) -+#define BIT_SET_R_MGG_FIFO_LIFETIME_8197F(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_LIFETIME_8197F(x) | \ -+ BIT_R_MGG_FIFO_LIFETIME_8197F(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_VALID_MAP_8197F 0 -+#define BIT_MASK_R_MGG_FIFO_VALID_MAP_8197F 0xffff -+#define BIT_R_MGG_FIFO_VALID_MAP_8197F(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_VALID_MAP_8197F) \ -+ << BIT_SHIFT_R_MGG_FIFO_VALID_MAP_8197F) -+#define BITS_R_MGG_FIFO_VALID_MAP_8197F \ -+ (BIT_MASK_R_MGG_FIFO_VALID_MAP_8197F \ -+ << BIT_SHIFT_R_MGG_FIFO_VALID_MAP_8197F) -+#define BIT_CLEAR_R_MGG_FIFO_VALID_MAP_8197F(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_VALID_MAP_8197F)) -+#define BIT_GET_R_MGG_FIFO_VALID_MAP_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_VALID_MAP_8197F) & \ -+ BIT_MASK_R_MGG_FIFO_VALID_MAP_8197F) -+#define BIT_SET_R_MGG_FIFO_VALID_MAP_8197F(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_VALID_MAP_8197F(x) | \ -+ BIT_R_MGG_FIFO_VALID_MAP_8197F(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F 0x7f -+#define BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F) -+#define BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F(v)) -+ -+/* 2 REG_SHCUT_SETTING_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE0_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE1_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_SHCUT_LLC_OUI0_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_SHCUT_LLC_OUI1_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_SHCUT_LLC_OUI2_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_SHCUT_LLC_OUI3_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_CHNL_INFO_CTRL_8197F */ -+#define BIT_CHNL_REF_RXNAV_8197F BIT(7) -+#define BIT_CHNL_REF_VBON_8197F BIT(6) -+#define BIT_CHNL_REF_EDCCA_8197F BIT(5) -+#define BIT_RST_CHNL_BUSY_8197F BIT(3) -+#define BIT_RST_CHNL_IDLE_8197F BIT(2) -+#define BIT_CHNL_INFO_RST_8197F BIT(1) -+#define BIT_ATM_AIRTIME_EN_8197F BIT(0) -+ -+/* 2 REG_CHNL_IDLE_TIME_8197F */ -+ -+#define BIT_SHIFT_CHNL_IDLE_TIME_8197F 0 -+#define BIT_MASK_CHNL_IDLE_TIME_8197F 0xffffffffL -+#define BIT_CHNL_IDLE_TIME_8197F(x) \ -+ (((x) & BIT_MASK_CHNL_IDLE_TIME_8197F) \ -+ << BIT_SHIFT_CHNL_IDLE_TIME_8197F) -+#define BITS_CHNL_IDLE_TIME_8197F \ -+ (BIT_MASK_CHNL_IDLE_TIME_8197F << BIT_SHIFT_CHNL_IDLE_TIME_8197F) -+#define BIT_CLEAR_CHNL_IDLE_TIME_8197F(x) ((x) & (~BITS_CHNL_IDLE_TIME_8197F)) -+#define BIT_GET_CHNL_IDLE_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_CHNL_IDLE_TIME_8197F) & \ -+ BIT_MASK_CHNL_IDLE_TIME_8197F) -+#define BIT_SET_CHNL_IDLE_TIME_8197F(x, v) \ -+ (BIT_CLEAR_CHNL_IDLE_TIME_8197F(x) | BIT_CHNL_IDLE_TIME_8197F(v)) -+ -+/* 2 REG_CHNL_BUSY_TIME_8197F */ -+ -+#define BIT_SHIFT_CHNL_BUSY_TIME_8197F 0 -+#define BIT_MASK_CHNL_BUSY_TIME_8197F 0xffffffffL -+#define BIT_CHNL_BUSY_TIME_8197F(x) \ -+ (((x) & BIT_MASK_CHNL_BUSY_TIME_8197F) \ -+ << BIT_SHIFT_CHNL_BUSY_TIME_8197F) -+#define BITS_CHNL_BUSY_TIME_8197F \ -+ (BIT_MASK_CHNL_BUSY_TIME_8197F << BIT_SHIFT_CHNL_BUSY_TIME_8197F) -+#define BIT_CLEAR_CHNL_BUSY_TIME_8197F(x) ((x) & (~BITS_CHNL_BUSY_TIME_8197F)) -+#define BIT_GET_CHNL_BUSY_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_CHNL_BUSY_TIME_8197F) & \ -+ BIT_MASK_CHNL_BUSY_TIME_8197F) -+#define BIT_SET_CHNL_BUSY_TIME_8197F(x, v) \ -+ (BIT_CLEAR_CHNL_BUSY_TIME_8197F(x) | BIT_CHNL_BUSY_TIME_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_EDCA_VO_PARAM_8197F */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8197F 16 -+#define BIT_MASK_TXOPLIMIT_8197F 0x7ff -+#define BIT_TXOPLIMIT_8197F(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8197F) << BIT_SHIFT_TXOPLIMIT_8197F) -+#define BITS_TXOPLIMIT_8197F \ -+ (BIT_MASK_TXOPLIMIT_8197F << BIT_SHIFT_TXOPLIMIT_8197F) -+#define BIT_CLEAR_TXOPLIMIT_8197F(x) ((x) & (~BITS_TXOPLIMIT_8197F)) -+#define BIT_GET_TXOPLIMIT_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8197F) & BIT_MASK_TXOPLIMIT_8197F) -+#define BIT_SET_TXOPLIMIT_8197F(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8197F(x) | BIT_TXOPLIMIT_8197F(v)) -+ -+#define BIT_SHIFT_CW_8197F 8 -+#define BIT_MASK_CW_8197F 0xff -+#define BIT_CW_8197F(x) (((x) & BIT_MASK_CW_8197F) << BIT_SHIFT_CW_8197F) -+#define BITS_CW_8197F (BIT_MASK_CW_8197F << BIT_SHIFT_CW_8197F) -+#define BIT_CLEAR_CW_8197F(x) ((x) & (~BITS_CW_8197F)) -+#define BIT_GET_CW_8197F(x) (((x) >> BIT_SHIFT_CW_8197F) & BIT_MASK_CW_8197F) -+#define BIT_SET_CW_8197F(x, v) (BIT_CLEAR_CW_8197F(x) | BIT_CW_8197F(v)) -+ -+#define BIT_SHIFT_AIFS_8197F 0 -+#define BIT_MASK_AIFS_8197F 0xff -+#define BIT_AIFS_8197F(x) (((x) & BIT_MASK_AIFS_8197F) << BIT_SHIFT_AIFS_8197F) -+#define BITS_AIFS_8197F (BIT_MASK_AIFS_8197F << BIT_SHIFT_AIFS_8197F) -+#define BIT_CLEAR_AIFS_8197F(x) ((x) & (~BITS_AIFS_8197F)) -+#define BIT_GET_AIFS_8197F(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8197F) & BIT_MASK_AIFS_8197F) -+#define BIT_SET_AIFS_8197F(x, v) (BIT_CLEAR_AIFS_8197F(x) | BIT_AIFS_8197F(v)) -+ -+/* 2 REG_EDCA_VI_PARAM_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8197F 16 -+#define BIT_MASK_TXOPLIMIT_8197F 0x7ff -+#define BIT_TXOPLIMIT_8197F(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8197F) << BIT_SHIFT_TXOPLIMIT_8197F) -+#define BITS_TXOPLIMIT_8197F \ -+ (BIT_MASK_TXOPLIMIT_8197F << BIT_SHIFT_TXOPLIMIT_8197F) -+#define BIT_CLEAR_TXOPLIMIT_8197F(x) ((x) & (~BITS_TXOPLIMIT_8197F)) -+#define BIT_GET_TXOPLIMIT_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8197F) & BIT_MASK_TXOPLIMIT_8197F) -+#define BIT_SET_TXOPLIMIT_8197F(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8197F(x) | BIT_TXOPLIMIT_8197F(v)) -+ -+#define BIT_SHIFT_CW_8197F 8 -+#define BIT_MASK_CW_8197F 0xff -+#define BIT_CW_8197F(x) (((x) & BIT_MASK_CW_8197F) << BIT_SHIFT_CW_8197F) -+#define BITS_CW_8197F (BIT_MASK_CW_8197F << BIT_SHIFT_CW_8197F) -+#define BIT_CLEAR_CW_8197F(x) ((x) & (~BITS_CW_8197F)) -+#define BIT_GET_CW_8197F(x) (((x) >> BIT_SHIFT_CW_8197F) & BIT_MASK_CW_8197F) -+#define BIT_SET_CW_8197F(x, v) (BIT_CLEAR_CW_8197F(x) | BIT_CW_8197F(v)) -+ -+#define BIT_SHIFT_AIFS_8197F 0 -+#define BIT_MASK_AIFS_8197F 0xff -+#define BIT_AIFS_8197F(x) (((x) & BIT_MASK_AIFS_8197F) << BIT_SHIFT_AIFS_8197F) -+#define BITS_AIFS_8197F (BIT_MASK_AIFS_8197F << BIT_SHIFT_AIFS_8197F) -+#define BIT_CLEAR_AIFS_8197F(x) ((x) & (~BITS_AIFS_8197F)) -+#define BIT_GET_AIFS_8197F(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8197F) & BIT_MASK_AIFS_8197F) -+#define BIT_SET_AIFS_8197F(x, v) (BIT_CLEAR_AIFS_8197F(x) | BIT_AIFS_8197F(v)) -+ -+/* 2 REG_EDCA_BE_PARAM_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8197F 16 -+#define BIT_MASK_TXOPLIMIT_8197F 0x7ff -+#define BIT_TXOPLIMIT_8197F(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8197F) << BIT_SHIFT_TXOPLIMIT_8197F) -+#define BITS_TXOPLIMIT_8197F \ -+ (BIT_MASK_TXOPLIMIT_8197F << BIT_SHIFT_TXOPLIMIT_8197F) -+#define BIT_CLEAR_TXOPLIMIT_8197F(x) ((x) & (~BITS_TXOPLIMIT_8197F)) -+#define BIT_GET_TXOPLIMIT_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8197F) & BIT_MASK_TXOPLIMIT_8197F) -+#define BIT_SET_TXOPLIMIT_8197F(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8197F(x) | BIT_TXOPLIMIT_8197F(v)) -+ -+#define BIT_SHIFT_CW_8197F 8 -+#define BIT_MASK_CW_8197F 0xff -+#define BIT_CW_8197F(x) (((x) & BIT_MASK_CW_8197F) << BIT_SHIFT_CW_8197F) -+#define BITS_CW_8197F (BIT_MASK_CW_8197F << BIT_SHIFT_CW_8197F) -+#define BIT_CLEAR_CW_8197F(x) ((x) & (~BITS_CW_8197F)) -+#define BIT_GET_CW_8197F(x) (((x) >> BIT_SHIFT_CW_8197F) & BIT_MASK_CW_8197F) -+#define BIT_SET_CW_8197F(x, v) (BIT_CLEAR_CW_8197F(x) | BIT_CW_8197F(v)) -+ -+#define BIT_SHIFT_AIFS_8197F 0 -+#define BIT_MASK_AIFS_8197F 0xff -+#define BIT_AIFS_8197F(x) (((x) & BIT_MASK_AIFS_8197F) << BIT_SHIFT_AIFS_8197F) -+#define BITS_AIFS_8197F (BIT_MASK_AIFS_8197F << BIT_SHIFT_AIFS_8197F) -+#define BIT_CLEAR_AIFS_8197F(x) ((x) & (~BITS_AIFS_8197F)) -+#define BIT_GET_AIFS_8197F(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8197F) & BIT_MASK_AIFS_8197F) -+#define BIT_SET_AIFS_8197F(x, v) (BIT_CLEAR_AIFS_8197F(x) | BIT_AIFS_8197F(v)) -+ -+/* 2 REG_EDCA_BK_PARAM_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8197F 16 -+#define BIT_MASK_TXOPLIMIT_8197F 0x7ff -+#define BIT_TXOPLIMIT_8197F(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8197F) << BIT_SHIFT_TXOPLIMIT_8197F) -+#define BITS_TXOPLIMIT_8197F \ -+ (BIT_MASK_TXOPLIMIT_8197F << BIT_SHIFT_TXOPLIMIT_8197F) -+#define BIT_CLEAR_TXOPLIMIT_8197F(x) ((x) & (~BITS_TXOPLIMIT_8197F)) -+#define BIT_GET_TXOPLIMIT_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8197F) & BIT_MASK_TXOPLIMIT_8197F) -+#define BIT_SET_TXOPLIMIT_8197F(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8197F(x) | BIT_TXOPLIMIT_8197F(v)) -+ -+#define BIT_SHIFT_CW_8197F 8 -+#define BIT_MASK_CW_8197F 0xff -+#define BIT_CW_8197F(x) (((x) & BIT_MASK_CW_8197F) << BIT_SHIFT_CW_8197F) -+#define BITS_CW_8197F (BIT_MASK_CW_8197F << BIT_SHIFT_CW_8197F) -+#define BIT_CLEAR_CW_8197F(x) ((x) & (~BITS_CW_8197F)) -+#define BIT_GET_CW_8197F(x) (((x) >> BIT_SHIFT_CW_8197F) & BIT_MASK_CW_8197F) -+#define BIT_SET_CW_8197F(x, v) (BIT_CLEAR_CW_8197F(x) | BIT_CW_8197F(v)) -+ -+#define BIT_SHIFT_AIFS_8197F 0 -+#define BIT_MASK_AIFS_8197F 0xff -+#define BIT_AIFS_8197F(x) (((x) & BIT_MASK_AIFS_8197F) << BIT_SHIFT_AIFS_8197F) -+#define BITS_AIFS_8197F (BIT_MASK_AIFS_8197F << BIT_SHIFT_AIFS_8197F) -+#define BIT_CLEAR_AIFS_8197F(x) ((x) & (~BITS_AIFS_8197F)) -+#define BIT_GET_AIFS_8197F(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8197F) & BIT_MASK_AIFS_8197F) -+#define BIT_SET_AIFS_8197F(x, v) (BIT_CLEAR_AIFS_8197F(x) | BIT_AIFS_8197F(v)) -+ -+/* 2 REG_BCNTCFG_8197F */ -+ -+#define BIT_SHIFT_BCNCW_MAX_8197F 12 -+#define BIT_MASK_BCNCW_MAX_8197F 0xf -+#define BIT_BCNCW_MAX_8197F(x) \ -+ (((x) & BIT_MASK_BCNCW_MAX_8197F) << BIT_SHIFT_BCNCW_MAX_8197F) -+#define BITS_BCNCW_MAX_8197F \ -+ (BIT_MASK_BCNCW_MAX_8197F << BIT_SHIFT_BCNCW_MAX_8197F) -+#define BIT_CLEAR_BCNCW_MAX_8197F(x) ((x) & (~BITS_BCNCW_MAX_8197F)) -+#define BIT_GET_BCNCW_MAX_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MAX_8197F) & BIT_MASK_BCNCW_MAX_8197F) -+#define BIT_SET_BCNCW_MAX_8197F(x, v) \ -+ (BIT_CLEAR_BCNCW_MAX_8197F(x) | BIT_BCNCW_MAX_8197F(v)) -+ -+#define BIT_SHIFT_BCNCW_MIN_8197F 8 -+#define BIT_MASK_BCNCW_MIN_8197F 0xf -+#define BIT_BCNCW_MIN_8197F(x) \ -+ (((x) & BIT_MASK_BCNCW_MIN_8197F) << BIT_SHIFT_BCNCW_MIN_8197F) -+#define BITS_BCNCW_MIN_8197F \ -+ (BIT_MASK_BCNCW_MIN_8197F << BIT_SHIFT_BCNCW_MIN_8197F) -+#define BIT_CLEAR_BCNCW_MIN_8197F(x) ((x) & (~BITS_BCNCW_MIN_8197F)) -+#define BIT_GET_BCNCW_MIN_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MIN_8197F) & BIT_MASK_BCNCW_MIN_8197F) -+#define BIT_SET_BCNCW_MIN_8197F(x, v) \ -+ (BIT_CLEAR_BCNCW_MIN_8197F(x) | BIT_BCNCW_MIN_8197F(v)) -+ -+#define BIT_SHIFT_BCNIFS_8197F 0 -+#define BIT_MASK_BCNIFS_8197F 0xff -+#define BIT_BCNIFS_8197F(x) \ -+ (((x) & BIT_MASK_BCNIFS_8197F) << BIT_SHIFT_BCNIFS_8197F) -+#define BITS_BCNIFS_8197F (BIT_MASK_BCNIFS_8197F << BIT_SHIFT_BCNIFS_8197F) -+#define BIT_CLEAR_BCNIFS_8197F(x) ((x) & (~BITS_BCNIFS_8197F)) -+#define BIT_GET_BCNIFS_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNIFS_8197F) & BIT_MASK_BCNIFS_8197F) -+#define BIT_SET_BCNIFS_8197F(x, v) \ -+ (BIT_CLEAR_BCNIFS_8197F(x) | BIT_BCNIFS_8197F(v)) -+ -+/* 2 REG_PIFS_8197F */ -+ -+#define BIT_SHIFT_PIFS_8197F 0 -+#define BIT_MASK_PIFS_8197F 0xff -+#define BIT_PIFS_8197F(x) (((x) & BIT_MASK_PIFS_8197F) << BIT_SHIFT_PIFS_8197F) -+#define BITS_PIFS_8197F (BIT_MASK_PIFS_8197F << BIT_SHIFT_PIFS_8197F) -+#define BIT_CLEAR_PIFS_8197F(x) ((x) & (~BITS_PIFS_8197F)) -+#define BIT_GET_PIFS_8197F(x) \ -+ (((x) >> BIT_SHIFT_PIFS_8197F) & BIT_MASK_PIFS_8197F) -+#define BIT_SET_PIFS_8197F(x, v) (BIT_CLEAR_PIFS_8197F(x) | BIT_PIFS_8197F(v)) -+ -+/* 2 REG_RDG_PIFS_8197F */ -+ -+#define BIT_SHIFT_RDG_PIFS_8197F 0 -+#define BIT_MASK_RDG_PIFS_8197F 0xff -+#define BIT_RDG_PIFS_8197F(x) \ -+ (((x) & BIT_MASK_RDG_PIFS_8197F) << BIT_SHIFT_RDG_PIFS_8197F) -+#define BITS_RDG_PIFS_8197F \ -+ (BIT_MASK_RDG_PIFS_8197F << BIT_SHIFT_RDG_PIFS_8197F) -+#define BIT_CLEAR_RDG_PIFS_8197F(x) ((x) & (~BITS_RDG_PIFS_8197F)) -+#define BIT_GET_RDG_PIFS_8197F(x) \ -+ (((x) >> BIT_SHIFT_RDG_PIFS_8197F) & BIT_MASK_RDG_PIFS_8197F) -+#define BIT_SET_RDG_PIFS_8197F(x, v) \ -+ (BIT_CLEAR_RDG_PIFS_8197F(x) | BIT_RDG_PIFS_8197F(v)) -+ -+/* 2 REG_SIFS_8197F */ -+ -+#define BIT_SHIFT_SIFS_OFDM_TRX_8197F 24 -+#define BIT_MASK_SIFS_OFDM_TRX_8197F 0xff -+#define BIT_SIFS_OFDM_TRX_8197F(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_TRX_8197F) << BIT_SHIFT_SIFS_OFDM_TRX_8197F) -+#define BITS_SIFS_OFDM_TRX_8197F \ -+ (BIT_MASK_SIFS_OFDM_TRX_8197F << BIT_SHIFT_SIFS_OFDM_TRX_8197F) -+#define BIT_CLEAR_SIFS_OFDM_TRX_8197F(x) ((x) & (~BITS_SIFS_OFDM_TRX_8197F)) -+#define BIT_GET_SIFS_OFDM_TRX_8197F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_TRX_8197F) & BIT_MASK_SIFS_OFDM_TRX_8197F) -+#define BIT_SET_SIFS_OFDM_TRX_8197F(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_TRX_8197F(x) | BIT_SIFS_OFDM_TRX_8197F(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_TRX_8197F 16 -+#define BIT_MASK_SIFS_CCK_TRX_8197F 0xff -+#define BIT_SIFS_CCK_TRX_8197F(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_TRX_8197F) << BIT_SHIFT_SIFS_CCK_TRX_8197F) -+#define BITS_SIFS_CCK_TRX_8197F \ -+ (BIT_MASK_SIFS_CCK_TRX_8197F << BIT_SHIFT_SIFS_CCK_TRX_8197F) -+#define BIT_CLEAR_SIFS_CCK_TRX_8197F(x) ((x) & (~BITS_SIFS_CCK_TRX_8197F)) -+#define BIT_GET_SIFS_CCK_TRX_8197F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_TRX_8197F) & BIT_MASK_SIFS_CCK_TRX_8197F) -+#define BIT_SET_SIFS_CCK_TRX_8197F(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_TRX_8197F(x) | BIT_SIFS_CCK_TRX_8197F(v)) -+ -+#define BIT_SHIFT_SIFS_OFDM_CTX_8197F 8 -+#define BIT_MASK_SIFS_OFDM_CTX_8197F 0xff -+#define BIT_SIFS_OFDM_CTX_8197F(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_CTX_8197F) << BIT_SHIFT_SIFS_OFDM_CTX_8197F) -+#define BITS_SIFS_OFDM_CTX_8197F \ -+ (BIT_MASK_SIFS_OFDM_CTX_8197F << BIT_SHIFT_SIFS_OFDM_CTX_8197F) -+#define BIT_CLEAR_SIFS_OFDM_CTX_8197F(x) ((x) & (~BITS_SIFS_OFDM_CTX_8197F)) -+#define BIT_GET_SIFS_OFDM_CTX_8197F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_CTX_8197F) & BIT_MASK_SIFS_OFDM_CTX_8197F) -+#define BIT_SET_SIFS_OFDM_CTX_8197F(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_CTX_8197F(x) | BIT_SIFS_OFDM_CTX_8197F(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_CTX_8197F 0 -+#define BIT_MASK_SIFS_CCK_CTX_8197F 0xff -+#define BIT_SIFS_CCK_CTX_8197F(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_CTX_8197F) << BIT_SHIFT_SIFS_CCK_CTX_8197F) -+#define BITS_SIFS_CCK_CTX_8197F \ -+ (BIT_MASK_SIFS_CCK_CTX_8197F << BIT_SHIFT_SIFS_CCK_CTX_8197F) -+#define BIT_CLEAR_SIFS_CCK_CTX_8197F(x) ((x) & (~BITS_SIFS_CCK_CTX_8197F)) -+#define BIT_GET_SIFS_CCK_CTX_8197F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_CTX_8197F) & BIT_MASK_SIFS_CCK_CTX_8197F) -+#define BIT_SET_SIFS_CCK_CTX_8197F(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_CTX_8197F(x) | BIT_SIFS_CCK_CTX_8197F(v)) -+ -+/* 2 REG_TSFTR_SYN_OFFSET_8197F */ -+ -+#define BIT_SHIFT_TSFTR_SNC_OFFSET_8197F 0 -+#define BIT_MASK_TSFTR_SNC_OFFSET_8197F 0xffff -+#define BIT_TSFTR_SNC_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_TSFTR_SNC_OFFSET_8197F) \ -+ << BIT_SHIFT_TSFTR_SNC_OFFSET_8197F) -+#define BITS_TSFTR_SNC_OFFSET_8197F \ -+ (BIT_MASK_TSFTR_SNC_OFFSET_8197F << BIT_SHIFT_TSFTR_SNC_OFFSET_8197F) -+#define BIT_CLEAR_TSFTR_SNC_OFFSET_8197F(x) \ -+ ((x) & (~BITS_TSFTR_SNC_OFFSET_8197F)) -+#define BIT_GET_TSFTR_SNC_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_TSFTR_SNC_OFFSET_8197F) & \ -+ BIT_MASK_TSFTR_SNC_OFFSET_8197F) -+#define BIT_SET_TSFTR_SNC_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_TSFTR_SNC_OFFSET_8197F(x) | BIT_TSFTR_SNC_OFFSET_8197F(v)) -+ -+/* 2 REG_AGGR_BREAK_TIME_8197F */ -+ -+#define BIT_SHIFT_AGGR_BK_TIME_8197F 0 -+#define BIT_MASK_AGGR_BK_TIME_8197F 0xff -+#define BIT_AGGR_BK_TIME_8197F(x) \ -+ (((x) & BIT_MASK_AGGR_BK_TIME_8197F) << BIT_SHIFT_AGGR_BK_TIME_8197F) -+#define BITS_AGGR_BK_TIME_8197F \ -+ (BIT_MASK_AGGR_BK_TIME_8197F << BIT_SHIFT_AGGR_BK_TIME_8197F) -+#define BIT_CLEAR_AGGR_BK_TIME_8197F(x) ((x) & (~BITS_AGGR_BK_TIME_8197F)) -+#define BIT_GET_AGGR_BK_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_AGGR_BK_TIME_8197F) & BIT_MASK_AGGR_BK_TIME_8197F) -+#define BIT_SET_AGGR_BK_TIME_8197F(x, v) \ -+ (BIT_CLEAR_AGGR_BK_TIME_8197F(x) | BIT_AGGR_BK_TIME_8197F(v)) -+ -+/* 2 REG_SLOT_8197F */ -+ -+#define BIT_SHIFT_SLOT_8197F 0 -+#define BIT_MASK_SLOT_8197F 0xff -+#define BIT_SLOT_8197F(x) (((x) & BIT_MASK_SLOT_8197F) << BIT_SHIFT_SLOT_8197F) -+#define BITS_SLOT_8197F (BIT_MASK_SLOT_8197F << BIT_SHIFT_SLOT_8197F) -+#define BIT_CLEAR_SLOT_8197F(x) ((x) & (~BITS_SLOT_8197F)) -+#define BIT_GET_SLOT_8197F(x) \ -+ (((x) >> BIT_SHIFT_SLOT_8197F) & BIT_MASK_SLOT_8197F) -+#define BIT_SET_SLOT_8197F(x, v) (BIT_CLEAR_SLOT_8197F(x) | BIT_SLOT_8197F(v)) -+ -+/* 2 REG_TX_PTCL_CTRL_8197F */ -+#define BIT_DIS_EDCCA_8197F BIT(15) -+#define BIT_DIS_CCA_8197F BIT(14) -+#define BIT_LSIG_TXOP_TXCMD_NAV_8197F BIT(13) -+#define BIT_SIFS_BK_EN_8197F BIT(12) -+ -+#define BIT_SHIFT_TXQ_NAV_MSK_8197F 8 -+#define BIT_MASK_TXQ_NAV_MSK_8197F 0xf -+#define BIT_TXQ_NAV_MSK_8197F(x) \ -+ (((x) & BIT_MASK_TXQ_NAV_MSK_8197F) << BIT_SHIFT_TXQ_NAV_MSK_8197F) -+#define BITS_TXQ_NAV_MSK_8197F \ -+ (BIT_MASK_TXQ_NAV_MSK_8197F << BIT_SHIFT_TXQ_NAV_MSK_8197F) -+#define BIT_CLEAR_TXQ_NAV_MSK_8197F(x) ((x) & (~BITS_TXQ_NAV_MSK_8197F)) -+#define BIT_GET_TXQ_NAV_MSK_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXQ_NAV_MSK_8197F) & BIT_MASK_TXQ_NAV_MSK_8197F) -+#define BIT_SET_TXQ_NAV_MSK_8197F(x, v) \ -+ (BIT_CLEAR_TXQ_NAV_MSK_8197F(x) | BIT_TXQ_NAV_MSK_8197F(v)) -+ -+#define BIT_DIS_CW_8197F BIT(7) -+#define BIT_NAV_END_TXOP_8197F BIT(6) -+#define BIT_RDG_END_TXOP_8197F BIT(5) -+#define BIT_AC_INBCN_HOLD_8197F BIT(4) -+#define BIT_MGTQ_TXOP_EN_8197F BIT(3) -+#define BIT_MGTQ_RTSMF_EN_8197F BIT(2) -+#define BIT_HIQ_RTSMF_EN_8197F BIT(1) -+#define BIT_BCN_RTSMF_EN_8197F BIT(0) -+ -+/* 2 REG_TXPAUSE_8197F */ -+#define BIT_STOP_BCN_HI_MGT_8197F BIT(7) -+#define BIT_MAC_STOPBCNQ_8197F BIT(6) -+#define BIT_MAC_STOPHIQ_8197F BIT(5) -+#define BIT_MAC_STOPMGQ_8197F BIT(4) -+#define BIT_MAC_STOPBK_8197F BIT(3) -+#define BIT_MAC_STOPBE_8197F BIT(2) -+#define BIT_MAC_STOPVI_8197F BIT(1) -+#define BIT_MAC_STOPVO_8197F BIT(0) -+ -+/* 2 REG_DIS_TXREQ_CLR_8197F */ -+#define BIT_DIS_BT_CCA_8197F BIT(7) -+#define BIT_DIS_TXREQ_CLR_CPUMGQ_8197F BIT(6) -+#define BIT_DIS_TXREQ_CLR_HI_8197F BIT(5) -+#define BIT_DIS_TXREQ_CLR_MGQ_8197F BIT(4) -+#define BIT_DIS_TXREQ_CLR_VO_8197F BIT(3) -+#define BIT_DIS_TXREQ_CLR_VI_8197F BIT(2) -+#define BIT_DIS_TXREQ_CLR_BE_8197F BIT(1) -+#define BIT_DIS_TXREQ_CLR_BK_8197F BIT(0) -+ -+/* 2 REG_RD_CTRL_8197F */ -+#define BIT_EN_CLR_TXREQ_INCCA_8197F BIT(15) -+#define BIT_DIS_TX_OVER_BCNQ_8197F BIT(14) -+#define BIT_EN_BCNERR_INCCA_8197F BIT(13) -+#define BIT_EN_BCNERR_INEDCCA_8197F BIT(12) -+#define BIT_EDCCA_MSK_CNTDOWN_EN_8197F BIT(11) -+#define BIT_DIS_TXOP_CFE_8197F BIT(10) -+#define BIT_DIS_LSIG_CFE_8197F BIT(9) -+#define BIT_DIS_STBC_CFE_8197F BIT(8) -+#define BIT_BKQ_RD_INIT_EN_8197F BIT(7) -+#define BIT_BEQ_RD_INIT_EN_8197F BIT(6) -+#define BIT_VIQ_RD_INIT_EN_8197F BIT(5) -+#define BIT_VOQ_RD_INIT_EN_8197F BIT(4) -+#define BIT_BKQ_RD_RESP_EN_8197F BIT(3) -+#define BIT_BEQ_RD_RESP_EN_8197F BIT(2) -+#define BIT_VIQ_RD_RESP_EN_8197F BIT(1) -+#define BIT_VOQ_RD_RESP_EN_8197F BIT(0) -+ -+/* 2 REG_MBSSID_CTRL_8197F */ -+#define BIT_MBID_BCNQ7_EN_8197F BIT(7) -+#define BIT_MBID_BCNQ6_EN_8197F BIT(6) -+#define BIT_MBID_BCNQ5_EN_8197F BIT(5) -+#define BIT_MBID_BCNQ4_EN_8197F BIT(4) -+#define BIT_MBID_BCNQ3_EN_8197F BIT(3) -+#define BIT_MBID_BCNQ2_EN_8197F BIT(2) -+#define BIT_MBID_BCNQ1_EN_8197F BIT(1) -+#define BIT_MBID_BCNQ0_EN_8197F BIT(0) -+ -+/* 2 REG_P2PPS_CTRL_8197F */ -+#define BIT_P2P_CTW_ALLSTASLEEP_8197F BIT(7) -+#define BIT_P2P_OFF_DISTX_EN_8197F BIT(6) -+#define BIT_PWR_MGT_EN_8197F BIT(5) -+#define BIT_P2P_NOA1_EN_8197F BIT(2) -+#define BIT_P2P_NOA0_EN_8197F BIT(1) -+ -+/* 2 REG_PKT_LIFETIME_CTRL_8197F */ -+#define BIT_EN_TBTT_AREA_FOR_BB_8197F BIT(23) -+#define BIT_EN_BKF_CLR_TXREQ_8197F BIT(22) -+#define BIT_EN_TSFBIT32_RST_P2P_8197F BIT(21) -+#define BIT_EN_BCN_TX_BTCCA_8197F BIT(20) -+#define BIT_DIS_PKT_TX_ATIM_8197F BIT(19) -+#define BIT_DIS_BCN_DIS_CTN_8197F BIT(18) -+#define BIT_EN_NAVEND_RST_TXOP_8197F BIT(17) -+#define BIT_EN_FILTER_CCA_8197F BIT(16) -+ -+#define BIT_SHIFT_CCA_FILTER_THRS_8197F 8 -+#define BIT_MASK_CCA_FILTER_THRS_8197F 0xff -+#define BIT_CCA_FILTER_THRS_8197F(x) \ -+ (((x) & BIT_MASK_CCA_FILTER_THRS_8197F) \ -+ << BIT_SHIFT_CCA_FILTER_THRS_8197F) -+#define BITS_CCA_FILTER_THRS_8197F \ -+ (BIT_MASK_CCA_FILTER_THRS_8197F << BIT_SHIFT_CCA_FILTER_THRS_8197F) -+#define BIT_CLEAR_CCA_FILTER_THRS_8197F(x) ((x) & (~BITS_CCA_FILTER_THRS_8197F)) -+#define BIT_GET_CCA_FILTER_THRS_8197F(x) \ -+ (((x) >> BIT_SHIFT_CCA_FILTER_THRS_8197F) & \ -+ BIT_MASK_CCA_FILTER_THRS_8197F) -+#define BIT_SET_CCA_FILTER_THRS_8197F(x, v) \ -+ (BIT_CLEAR_CCA_FILTER_THRS_8197F(x) | BIT_CCA_FILTER_THRS_8197F(v)) -+ -+#define BIT_SHIFT_EDCCA_THRS_8197F 0 -+#define BIT_MASK_EDCCA_THRS_8197F 0xff -+#define BIT_EDCCA_THRS_8197F(x) \ -+ (((x) & BIT_MASK_EDCCA_THRS_8197F) << BIT_SHIFT_EDCCA_THRS_8197F) -+#define BITS_EDCCA_THRS_8197F \ -+ (BIT_MASK_EDCCA_THRS_8197F << BIT_SHIFT_EDCCA_THRS_8197F) -+#define BIT_CLEAR_EDCCA_THRS_8197F(x) ((x) & (~BITS_EDCCA_THRS_8197F)) -+#define BIT_GET_EDCCA_THRS_8197F(x) \ -+ (((x) >> BIT_SHIFT_EDCCA_THRS_8197F) & BIT_MASK_EDCCA_THRS_8197F) -+#define BIT_SET_EDCCA_THRS_8197F(x, v) \ -+ (BIT_CLEAR_EDCCA_THRS_8197F(x) | BIT_EDCCA_THRS_8197F(v)) -+ -+/* 2 REG_P2PPS_SPEC_STATE_8197F */ -+#define BIT_SPEC_POWER_STATE_8197F BIT(7) -+#define BIT_SPEC_CTWINDOW_ON_8197F BIT(6) -+#define BIT_SPEC_BEACON_AREA_ON_8197F BIT(5) -+#define BIT_SPEC_CTWIN_EARLY_DISTX_8197F BIT(4) -+#define BIT_SPEC_NOA1_OFF_PERIOD_8197F BIT(3) -+#define BIT_SPEC_FORCE_DOZE1_8197F BIT(2) -+#define BIT_SPEC_NOA0_OFF_PERIOD_8197F BIT(1) -+#define BIT_SPEC_FORCE_DOZE0_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_P2PON_DIS_TXTIME_8197F 0 -+#define BIT_MASK_P2PON_DIS_TXTIME_8197F 0xff -+#define BIT_P2PON_DIS_TXTIME_8197F(x) \ -+ (((x) & BIT_MASK_P2PON_DIS_TXTIME_8197F) \ -+ << BIT_SHIFT_P2PON_DIS_TXTIME_8197F) -+#define BITS_P2PON_DIS_TXTIME_8197F \ -+ (BIT_MASK_P2PON_DIS_TXTIME_8197F << BIT_SHIFT_P2PON_DIS_TXTIME_8197F) -+#define BIT_CLEAR_P2PON_DIS_TXTIME_8197F(x) \ -+ ((x) & (~BITS_P2PON_DIS_TXTIME_8197F)) -+#define BIT_GET_P2PON_DIS_TXTIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_P2PON_DIS_TXTIME_8197F) & \ -+ BIT_MASK_P2PON_DIS_TXTIME_8197F) -+#define BIT_SET_P2PON_DIS_TXTIME_8197F(x, v) \ -+ (BIT_CLEAR_P2PON_DIS_TXTIME_8197F(x) | BIT_P2PON_DIS_TXTIME_8197F(v)) -+ -+/* 2 REG_QUEUE_INCOL_THR_8197F */ -+ -+#define BIT_SHIFT_BK_QUEUE_THR_8197F 24 -+#define BIT_MASK_BK_QUEUE_THR_8197F 0xff -+#define BIT_BK_QUEUE_THR_8197F(x) \ -+ (((x) & BIT_MASK_BK_QUEUE_THR_8197F) << BIT_SHIFT_BK_QUEUE_THR_8197F) -+#define BITS_BK_QUEUE_THR_8197F \ -+ (BIT_MASK_BK_QUEUE_THR_8197F << BIT_SHIFT_BK_QUEUE_THR_8197F) -+#define BIT_CLEAR_BK_QUEUE_THR_8197F(x) ((x) & (~BITS_BK_QUEUE_THR_8197F)) -+#define BIT_GET_BK_QUEUE_THR_8197F(x) \ -+ (((x) >> BIT_SHIFT_BK_QUEUE_THR_8197F) & BIT_MASK_BK_QUEUE_THR_8197F) -+#define BIT_SET_BK_QUEUE_THR_8197F(x, v) \ -+ (BIT_CLEAR_BK_QUEUE_THR_8197F(x) | BIT_BK_QUEUE_THR_8197F(v)) -+ -+#define BIT_SHIFT_BE_QUEUE_THR_8197F 16 -+#define BIT_MASK_BE_QUEUE_THR_8197F 0xff -+#define BIT_BE_QUEUE_THR_8197F(x) \ -+ (((x) & BIT_MASK_BE_QUEUE_THR_8197F) << BIT_SHIFT_BE_QUEUE_THR_8197F) -+#define BITS_BE_QUEUE_THR_8197F \ -+ (BIT_MASK_BE_QUEUE_THR_8197F << BIT_SHIFT_BE_QUEUE_THR_8197F) -+#define BIT_CLEAR_BE_QUEUE_THR_8197F(x) ((x) & (~BITS_BE_QUEUE_THR_8197F)) -+#define BIT_GET_BE_QUEUE_THR_8197F(x) \ -+ (((x) >> BIT_SHIFT_BE_QUEUE_THR_8197F) & BIT_MASK_BE_QUEUE_THR_8197F) -+#define BIT_SET_BE_QUEUE_THR_8197F(x, v) \ -+ (BIT_CLEAR_BE_QUEUE_THR_8197F(x) | BIT_BE_QUEUE_THR_8197F(v)) -+ -+#define BIT_SHIFT_VI_QUEUE_THR_8197F 8 -+#define BIT_MASK_VI_QUEUE_THR_8197F 0xff -+#define BIT_VI_QUEUE_THR_8197F(x) \ -+ (((x) & BIT_MASK_VI_QUEUE_THR_8197F) << BIT_SHIFT_VI_QUEUE_THR_8197F) -+#define BITS_VI_QUEUE_THR_8197F \ -+ (BIT_MASK_VI_QUEUE_THR_8197F << BIT_SHIFT_VI_QUEUE_THR_8197F) -+#define BIT_CLEAR_VI_QUEUE_THR_8197F(x) ((x) & (~BITS_VI_QUEUE_THR_8197F)) -+#define BIT_GET_VI_QUEUE_THR_8197F(x) \ -+ (((x) >> BIT_SHIFT_VI_QUEUE_THR_8197F) & BIT_MASK_VI_QUEUE_THR_8197F) -+#define BIT_SET_VI_QUEUE_THR_8197F(x, v) \ -+ (BIT_CLEAR_VI_QUEUE_THR_8197F(x) | BIT_VI_QUEUE_THR_8197F(v)) -+ -+#define BIT_SHIFT_VO_QUEUE_THR_8197F 0 -+#define BIT_MASK_VO_QUEUE_THR_8197F 0xff -+#define BIT_VO_QUEUE_THR_8197F(x) \ -+ (((x) & BIT_MASK_VO_QUEUE_THR_8197F) << BIT_SHIFT_VO_QUEUE_THR_8197F) -+#define BITS_VO_QUEUE_THR_8197F \ -+ (BIT_MASK_VO_QUEUE_THR_8197F << BIT_SHIFT_VO_QUEUE_THR_8197F) -+#define BIT_CLEAR_VO_QUEUE_THR_8197F(x) ((x) & (~BITS_VO_QUEUE_THR_8197F)) -+#define BIT_GET_VO_QUEUE_THR_8197F(x) \ -+ (((x) >> BIT_SHIFT_VO_QUEUE_THR_8197F) & BIT_MASK_VO_QUEUE_THR_8197F) -+#define BIT_SET_VO_QUEUE_THR_8197F(x, v) \ -+ (BIT_CLEAR_VO_QUEUE_THR_8197F(x) | BIT_VO_QUEUE_THR_8197F(v)) -+ -+/* 2 REG_QUEUE_INCOL_EN_8197F */ -+#define BIT_QUEUE_INCOL_EN_8197F BIT(16) -+ -+#define BIT_SHIFT_BK_TRIGGER_NUM_V1_8197F 12 -+#define BIT_MASK_BK_TRIGGER_NUM_V1_8197F 0xf -+#define BIT_BK_TRIGGER_NUM_V1_8197F(x) \ -+ (((x) & BIT_MASK_BK_TRIGGER_NUM_V1_8197F) \ -+ << BIT_SHIFT_BK_TRIGGER_NUM_V1_8197F) -+#define BITS_BK_TRIGGER_NUM_V1_8197F \ -+ (BIT_MASK_BK_TRIGGER_NUM_V1_8197F << BIT_SHIFT_BK_TRIGGER_NUM_V1_8197F) -+#define BIT_CLEAR_BK_TRIGGER_NUM_V1_8197F(x) \ -+ ((x) & (~BITS_BK_TRIGGER_NUM_V1_8197F)) -+#define BIT_GET_BK_TRIGGER_NUM_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BK_TRIGGER_NUM_V1_8197F) & \ -+ BIT_MASK_BK_TRIGGER_NUM_V1_8197F) -+#define BIT_SET_BK_TRIGGER_NUM_V1_8197F(x, v) \ -+ (BIT_CLEAR_BK_TRIGGER_NUM_V1_8197F(x) | BIT_BK_TRIGGER_NUM_V1_8197F(v)) -+ -+#define BIT_SHIFT_BE_TRIGGER_NUM_V1_8197F 8 -+#define BIT_MASK_BE_TRIGGER_NUM_V1_8197F 0xf -+#define BIT_BE_TRIGGER_NUM_V1_8197F(x) \ -+ (((x) & BIT_MASK_BE_TRIGGER_NUM_V1_8197F) \ -+ << BIT_SHIFT_BE_TRIGGER_NUM_V1_8197F) -+#define BITS_BE_TRIGGER_NUM_V1_8197F \ -+ (BIT_MASK_BE_TRIGGER_NUM_V1_8197F << BIT_SHIFT_BE_TRIGGER_NUM_V1_8197F) -+#define BIT_CLEAR_BE_TRIGGER_NUM_V1_8197F(x) \ -+ ((x) & (~BITS_BE_TRIGGER_NUM_V1_8197F)) -+#define BIT_GET_BE_TRIGGER_NUM_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BE_TRIGGER_NUM_V1_8197F) & \ -+ BIT_MASK_BE_TRIGGER_NUM_V1_8197F) -+#define BIT_SET_BE_TRIGGER_NUM_V1_8197F(x, v) \ -+ (BIT_CLEAR_BE_TRIGGER_NUM_V1_8197F(x) | BIT_BE_TRIGGER_NUM_V1_8197F(v)) -+ -+#define BIT_SHIFT_VI_TRIGGER_NUM_8197F 4 -+#define BIT_MASK_VI_TRIGGER_NUM_8197F 0xf -+#define BIT_VI_TRIGGER_NUM_8197F(x) \ -+ (((x) & BIT_MASK_VI_TRIGGER_NUM_8197F) \ -+ << BIT_SHIFT_VI_TRIGGER_NUM_8197F) -+#define BITS_VI_TRIGGER_NUM_8197F \ -+ (BIT_MASK_VI_TRIGGER_NUM_8197F << BIT_SHIFT_VI_TRIGGER_NUM_8197F) -+#define BIT_CLEAR_VI_TRIGGER_NUM_8197F(x) ((x) & (~BITS_VI_TRIGGER_NUM_8197F)) -+#define BIT_GET_VI_TRIGGER_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_VI_TRIGGER_NUM_8197F) & \ -+ BIT_MASK_VI_TRIGGER_NUM_8197F) -+#define BIT_SET_VI_TRIGGER_NUM_8197F(x, v) \ -+ (BIT_CLEAR_VI_TRIGGER_NUM_8197F(x) | BIT_VI_TRIGGER_NUM_8197F(v)) -+ -+#define BIT_SHIFT_VO_TRIGGER_NUM_8197F 0 -+#define BIT_MASK_VO_TRIGGER_NUM_8197F 0xf -+#define BIT_VO_TRIGGER_NUM_8197F(x) \ -+ (((x) & BIT_MASK_VO_TRIGGER_NUM_8197F) \ -+ << BIT_SHIFT_VO_TRIGGER_NUM_8197F) -+#define BITS_VO_TRIGGER_NUM_8197F \ -+ (BIT_MASK_VO_TRIGGER_NUM_8197F << BIT_SHIFT_VO_TRIGGER_NUM_8197F) -+#define BIT_CLEAR_VO_TRIGGER_NUM_8197F(x) ((x) & (~BITS_VO_TRIGGER_NUM_8197F)) -+#define BIT_GET_VO_TRIGGER_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_VO_TRIGGER_NUM_8197F) & \ -+ BIT_MASK_VO_TRIGGER_NUM_8197F) -+#define BIT_SET_VO_TRIGGER_NUM_8197F(x, v) \ -+ (BIT_CLEAR_VO_TRIGGER_NUM_8197F(x) | BIT_VO_TRIGGER_NUM_8197F(v)) -+ -+/* 2 REG_TBTT_PROHIBIT_8197F */ -+ -+#define BIT_SHIFT_TBTT_HOLD_TIME_AP_8197F 8 -+#define BIT_MASK_TBTT_HOLD_TIME_AP_8197F 0xfff -+#define BIT_TBTT_HOLD_TIME_AP_8197F(x) \ -+ (((x) & BIT_MASK_TBTT_HOLD_TIME_AP_8197F) \ -+ << BIT_SHIFT_TBTT_HOLD_TIME_AP_8197F) -+#define BITS_TBTT_HOLD_TIME_AP_8197F \ -+ (BIT_MASK_TBTT_HOLD_TIME_AP_8197F << BIT_SHIFT_TBTT_HOLD_TIME_AP_8197F) -+#define BIT_CLEAR_TBTT_HOLD_TIME_AP_8197F(x) \ -+ ((x) & (~BITS_TBTT_HOLD_TIME_AP_8197F)) -+#define BIT_GET_TBTT_HOLD_TIME_AP_8197F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_HOLD_TIME_AP_8197F) & \ -+ BIT_MASK_TBTT_HOLD_TIME_AP_8197F) -+#define BIT_SET_TBTT_HOLD_TIME_AP_8197F(x, v) \ -+ (BIT_CLEAR_TBTT_HOLD_TIME_AP_8197F(x) | BIT_TBTT_HOLD_TIME_AP_8197F(v)) -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_SETUP_8197F 0 -+#define BIT_MASK_TBTT_PROHIBIT_SETUP_8197F 0xf -+#define BIT_TBTT_PROHIBIT_SETUP_8197F(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_SETUP_8197F) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8197F) -+#define BITS_TBTT_PROHIBIT_SETUP_8197F \ -+ (BIT_MASK_TBTT_PROHIBIT_SETUP_8197F \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8197F) -+#define BIT_CLEAR_TBTT_PROHIBIT_SETUP_8197F(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_SETUP_8197F)) -+#define BIT_GET_TBTT_PROHIBIT_SETUP_8197F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_SETUP_8197F) & \ -+ BIT_MASK_TBTT_PROHIBIT_SETUP_8197F) -+#define BIT_SET_TBTT_PROHIBIT_SETUP_8197F(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_SETUP_8197F(x) | \ -+ BIT_TBTT_PROHIBIT_SETUP_8197F(v)) -+ -+/* 2 REG_P2PPS_STATE_8197F */ -+#define BIT_POWER_STATE_8197F BIT(7) -+#define BIT_CTWINDOW_ON_8197F BIT(6) -+#define BIT_BEACON_AREA_ON_8197F BIT(5) -+#define BIT_CTWIN_EARLY_DISTX_8197F BIT(4) -+#define BIT_NOA1_OFF_PERIOD_8197F BIT(3) -+#define BIT_FORCE_DOZE1_8197F BIT(2) -+#define BIT_NOA0_OFF_PERIOD_8197F BIT(1) -+#define BIT_FORCE_DOZE0_8197F BIT(0) -+ -+/* 2 REG_RD_NAV_NXT_8197F */ -+ -+#define BIT_SHIFT_RD_NAV_PROT_NXT_8197F 0 -+#define BIT_MASK_RD_NAV_PROT_NXT_8197F 0xffff -+#define BIT_RD_NAV_PROT_NXT_8197F(x) \ -+ (((x) & BIT_MASK_RD_NAV_PROT_NXT_8197F) \ -+ << BIT_SHIFT_RD_NAV_PROT_NXT_8197F) -+#define BITS_RD_NAV_PROT_NXT_8197F \ -+ (BIT_MASK_RD_NAV_PROT_NXT_8197F << BIT_SHIFT_RD_NAV_PROT_NXT_8197F) -+#define BIT_CLEAR_RD_NAV_PROT_NXT_8197F(x) ((x) & (~BITS_RD_NAV_PROT_NXT_8197F)) -+#define BIT_GET_RD_NAV_PROT_NXT_8197F(x) \ -+ (((x) >> BIT_SHIFT_RD_NAV_PROT_NXT_8197F) & \ -+ BIT_MASK_RD_NAV_PROT_NXT_8197F) -+#define BIT_SET_RD_NAV_PROT_NXT_8197F(x, v) \ -+ (BIT_CLEAR_RD_NAV_PROT_NXT_8197F(x) | BIT_RD_NAV_PROT_NXT_8197F(v)) -+ -+/* 2 REG_NAV_PROT_LEN_8197F */ -+ -+#define BIT_SHIFT_NAV_PROT_LEN_8197F 0 -+#define BIT_MASK_NAV_PROT_LEN_8197F 0xffff -+#define BIT_NAV_PROT_LEN_8197F(x) \ -+ (((x) & BIT_MASK_NAV_PROT_LEN_8197F) << BIT_SHIFT_NAV_PROT_LEN_8197F) -+#define BITS_NAV_PROT_LEN_8197F \ -+ (BIT_MASK_NAV_PROT_LEN_8197F << BIT_SHIFT_NAV_PROT_LEN_8197F) -+#define BIT_CLEAR_NAV_PROT_LEN_8197F(x) ((x) & (~BITS_NAV_PROT_LEN_8197F)) -+#define BIT_GET_NAV_PROT_LEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_NAV_PROT_LEN_8197F) & BIT_MASK_NAV_PROT_LEN_8197F) -+#define BIT_SET_NAV_PROT_LEN_8197F(x, v) \ -+ (BIT_CLEAR_NAV_PROT_LEN_8197F(x) | BIT_NAV_PROT_LEN_8197F(v)) -+ -+/* 2 REG_FTM_CTRL_8197F */ -+ -+#define BIT_SHIFT_FTM_TSF_R2T_PORT_8197F 22 -+#define BIT_MASK_FTM_TSF_R2T_PORT_8197F 0x7 -+#define BIT_FTM_TSF_R2T_PORT_8197F(x) \ -+ (((x) & BIT_MASK_FTM_TSF_R2T_PORT_8197F) \ -+ << BIT_SHIFT_FTM_TSF_R2T_PORT_8197F) -+#define BITS_FTM_TSF_R2T_PORT_8197F \ -+ (BIT_MASK_FTM_TSF_R2T_PORT_8197F << BIT_SHIFT_FTM_TSF_R2T_PORT_8197F) -+#define BIT_CLEAR_FTM_TSF_R2T_PORT_8197F(x) \ -+ ((x) & (~BITS_FTM_TSF_R2T_PORT_8197F)) -+#define BIT_GET_FTM_TSF_R2T_PORT_8197F(x) \ -+ (((x) >> BIT_SHIFT_FTM_TSF_R2T_PORT_8197F) & \ -+ BIT_MASK_FTM_TSF_R2T_PORT_8197F) -+#define BIT_SET_FTM_TSF_R2T_PORT_8197F(x, v) \ -+ (BIT_CLEAR_FTM_TSF_R2T_PORT_8197F(x) | BIT_FTM_TSF_R2T_PORT_8197F(v)) -+ -+#define BIT_SHIFT_FTM_TSF_T2R_PORT_8197F 19 -+#define BIT_MASK_FTM_TSF_T2R_PORT_8197F 0x7 -+#define BIT_FTM_TSF_T2R_PORT_8197F(x) \ -+ (((x) & BIT_MASK_FTM_TSF_T2R_PORT_8197F) \ -+ << BIT_SHIFT_FTM_TSF_T2R_PORT_8197F) -+#define BITS_FTM_TSF_T2R_PORT_8197F \ -+ (BIT_MASK_FTM_TSF_T2R_PORT_8197F << BIT_SHIFT_FTM_TSF_T2R_PORT_8197F) -+#define BIT_CLEAR_FTM_TSF_T2R_PORT_8197F(x) \ -+ ((x) & (~BITS_FTM_TSF_T2R_PORT_8197F)) -+#define BIT_GET_FTM_TSF_T2R_PORT_8197F(x) \ -+ (((x) >> BIT_SHIFT_FTM_TSF_T2R_PORT_8197F) & \ -+ BIT_MASK_FTM_TSF_T2R_PORT_8197F) -+#define BIT_SET_FTM_TSF_T2R_PORT_8197F(x, v) \ -+ (BIT_CLEAR_FTM_TSF_T2R_PORT_8197F(x) | BIT_FTM_TSF_T2R_PORT_8197F(v)) -+ -+#define BIT_SHIFT_FTM_PTT_PORT_8197F 16 -+#define BIT_MASK_FTM_PTT_PORT_8197F 0x7 -+#define BIT_FTM_PTT_PORT_8197F(x) \ -+ (((x) & BIT_MASK_FTM_PTT_PORT_8197F) << BIT_SHIFT_FTM_PTT_PORT_8197F) -+#define BITS_FTM_PTT_PORT_8197F \ -+ (BIT_MASK_FTM_PTT_PORT_8197F << BIT_SHIFT_FTM_PTT_PORT_8197F) -+#define BIT_CLEAR_FTM_PTT_PORT_8197F(x) ((x) & (~BITS_FTM_PTT_PORT_8197F)) -+#define BIT_GET_FTM_PTT_PORT_8197F(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_PORT_8197F) & BIT_MASK_FTM_PTT_PORT_8197F) -+#define BIT_SET_FTM_PTT_PORT_8197F(x, v) \ -+ (BIT_CLEAR_FTM_PTT_PORT_8197F(x) | BIT_FTM_PTT_PORT_8197F(v)) -+ -+#define BIT_SHIFT_FTM_PTT_8197F 0 -+#define BIT_MASK_FTM_PTT_8197F 0xffff -+#define BIT_FTM_PTT_8197F(x) \ -+ (((x) & BIT_MASK_FTM_PTT_8197F) << BIT_SHIFT_FTM_PTT_8197F) -+#define BITS_FTM_PTT_8197F (BIT_MASK_FTM_PTT_8197F << BIT_SHIFT_FTM_PTT_8197F) -+#define BIT_CLEAR_FTM_PTT_8197F(x) ((x) & (~BITS_FTM_PTT_8197F)) -+#define BIT_GET_FTM_PTT_8197F(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_8197F) & BIT_MASK_FTM_PTT_8197F) -+#define BIT_SET_FTM_PTT_8197F(x, v) \ -+ (BIT_CLEAR_FTM_PTT_8197F(x) | BIT_FTM_PTT_8197F(v)) -+ -+/* 2 REG_FTM_TSF_CNT_8197F */ -+ -+#define BIT_SHIFT_FTM_TSF_R2T_8197F 16 -+#define BIT_MASK_FTM_TSF_R2T_8197F 0xffff -+#define BIT_FTM_TSF_R2T_8197F(x) \ -+ (((x) & BIT_MASK_FTM_TSF_R2T_8197F) << BIT_SHIFT_FTM_TSF_R2T_8197F) -+#define BITS_FTM_TSF_R2T_8197F \ -+ (BIT_MASK_FTM_TSF_R2T_8197F << BIT_SHIFT_FTM_TSF_R2T_8197F) -+#define BIT_CLEAR_FTM_TSF_R2T_8197F(x) ((x) & (~BITS_FTM_TSF_R2T_8197F)) -+#define BIT_GET_FTM_TSF_R2T_8197F(x) \ -+ (((x) >> BIT_SHIFT_FTM_TSF_R2T_8197F) & BIT_MASK_FTM_TSF_R2T_8197F) -+#define BIT_SET_FTM_TSF_R2T_8197F(x, v) \ -+ (BIT_CLEAR_FTM_TSF_R2T_8197F(x) | BIT_FTM_TSF_R2T_8197F(v)) -+ -+#define BIT_SHIFT_FTM_TSF_T2R_8197F 0 -+#define BIT_MASK_FTM_TSF_T2R_8197F 0xffff -+#define BIT_FTM_TSF_T2R_8197F(x) \ -+ (((x) & BIT_MASK_FTM_TSF_T2R_8197F) << BIT_SHIFT_FTM_TSF_T2R_8197F) -+#define BITS_FTM_TSF_T2R_8197F \ -+ (BIT_MASK_FTM_TSF_T2R_8197F << BIT_SHIFT_FTM_TSF_T2R_8197F) -+#define BIT_CLEAR_FTM_TSF_T2R_8197F(x) ((x) & (~BITS_FTM_TSF_T2R_8197F)) -+#define BIT_GET_FTM_TSF_T2R_8197F(x) \ -+ (((x) >> BIT_SHIFT_FTM_TSF_T2R_8197F) & BIT_MASK_FTM_TSF_T2R_8197F) -+#define BIT_SET_FTM_TSF_T2R_8197F(x, v) \ -+ (BIT_CLEAR_FTM_TSF_T2R_8197F(x) | BIT_FTM_TSF_T2R_8197F(v)) -+ -+/* 2 REG_BCN_CTRL_8197F */ -+#define BIT_DIS_RX_BSSID_FIT_8197F BIT(6) -+#define BIT_P0_EN_TXBCN_RPT_8197F BIT(5) -+#define BIT_DIS_TSF_UDT_8197F BIT(4) -+#define BIT_EN_BCN_FUNCTION_8197F BIT(3) -+#define BIT_P0_EN_RXBCN_RPT_8197F BIT(2) -+#define BIT_EN_P2P_CTWINDOW_8197F BIT(1) -+#define BIT_EN_P2P_BCNQ_AREA_8197F BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT0_8197F */ -+#define BIT_CLI0_DIS_RX_BSSID_FIT_8197F BIT(6) -+#define BIT_CLI0_DIS_TSF_UDT_8197F BIT(4) -+#define BIT_CLI0_EN_BCN_FUNCTION_8197F BIT(3) -+#define BIT_CLI0_EN_RXBCN_RPT_8197F BIT(2) -+#define BIT_CLI0_ENP2P_CTWINDOW_8197F BIT(1) -+#define BIT_CLI0_ENP2P_BCNQ_AREA_8197F BIT(0) -+ -+/* 2 REG_MBID_NUM_8197F */ -+#define BIT_EN_PRE_DL_BEACON_8197F BIT(3) -+ -+#define BIT_SHIFT_MBID_BCN_NUM_8197F 0 -+#define BIT_MASK_MBID_BCN_NUM_8197F 0x7 -+#define BIT_MBID_BCN_NUM_8197F(x) \ -+ (((x) & BIT_MASK_MBID_BCN_NUM_8197F) << BIT_SHIFT_MBID_BCN_NUM_8197F) -+#define BITS_MBID_BCN_NUM_8197F \ -+ (BIT_MASK_MBID_BCN_NUM_8197F << BIT_SHIFT_MBID_BCN_NUM_8197F) -+#define BIT_CLEAR_MBID_BCN_NUM_8197F(x) ((x) & (~BITS_MBID_BCN_NUM_8197F)) -+#define BIT_GET_MBID_BCN_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCN_NUM_8197F) & BIT_MASK_MBID_BCN_NUM_8197F) -+#define BIT_SET_MBID_BCN_NUM_8197F(x, v) \ -+ (BIT_CLEAR_MBID_BCN_NUM_8197F(x) | BIT_MBID_BCN_NUM_8197F(v)) -+ -+/* 2 REG_DUAL_TSF_RST_8197F */ -+#define BIT_FREECNT_RST_8197F BIT(5) -+#define BIT_TSFTR_CLI3_RST_8197F BIT(4) -+#define BIT_TSFTR_CLI2_RST_8197F BIT(3) -+#define BIT_TSFTR_CLI1_RST_8197F BIT(2) -+#define BIT_TSFTR_CLI0_RST_8197F BIT(1) -+#define BIT_TSFTR_RST_8197F BIT(0) -+ -+/* 2 REG_MBSSID_BCN_SPACE_8197F */ -+ -+#define BIT_SHIFT_BCN_TIMER_SEL_FWRD_8197F 28 -+#define BIT_MASK_BCN_TIMER_SEL_FWRD_8197F 0x7 -+#define BIT_BCN_TIMER_SEL_FWRD_8197F(x) \ -+ (((x) & BIT_MASK_BCN_TIMER_SEL_FWRD_8197F) \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_8197F) -+#define BITS_BCN_TIMER_SEL_FWRD_8197F \ -+ (BIT_MASK_BCN_TIMER_SEL_FWRD_8197F \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_8197F) -+#define BIT_CLEAR_BCN_TIMER_SEL_FWRD_8197F(x) \ -+ ((x) & (~BITS_BCN_TIMER_SEL_FWRD_8197F)) -+#define BIT_GET_BCN_TIMER_SEL_FWRD_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCN_TIMER_SEL_FWRD_8197F) & \ -+ BIT_MASK_BCN_TIMER_SEL_FWRD_8197F) -+#define BIT_SET_BCN_TIMER_SEL_FWRD_8197F(x, v) \ -+ (BIT_CLEAR_BCN_TIMER_SEL_FWRD_8197F(x) | \ -+ BIT_BCN_TIMER_SEL_FWRD_8197F(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT0_8197F 16 -+#define BIT_MASK_BCN_SPACE_CLINT0_8197F 0xfff -+#define BIT_BCN_SPACE_CLINT0_8197F(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT0_8197F) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT0_8197F) -+#define BITS_BCN_SPACE_CLINT0_8197F \ -+ (BIT_MASK_BCN_SPACE_CLINT0_8197F << BIT_SHIFT_BCN_SPACE_CLINT0_8197F) -+#define BIT_CLEAR_BCN_SPACE_CLINT0_8197F(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT0_8197F)) -+#define BIT_GET_BCN_SPACE_CLINT0_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT0_8197F) & \ -+ BIT_MASK_BCN_SPACE_CLINT0_8197F) -+#define BIT_SET_BCN_SPACE_CLINT0_8197F(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT0_8197F(x) | BIT_BCN_SPACE_CLINT0_8197F(v)) -+ -+#define BIT_SHIFT_BCN_SPACE0_8197F 0 -+#define BIT_MASK_BCN_SPACE0_8197F 0xffff -+#define BIT_BCN_SPACE0_8197F(x) \ -+ (((x) & BIT_MASK_BCN_SPACE0_8197F) << BIT_SHIFT_BCN_SPACE0_8197F) -+#define BITS_BCN_SPACE0_8197F \ -+ (BIT_MASK_BCN_SPACE0_8197F << BIT_SHIFT_BCN_SPACE0_8197F) -+#define BIT_CLEAR_BCN_SPACE0_8197F(x) ((x) & (~BITS_BCN_SPACE0_8197F)) -+#define BIT_GET_BCN_SPACE0_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE0_8197F) & BIT_MASK_BCN_SPACE0_8197F) -+#define BIT_SET_BCN_SPACE0_8197F(x, v) \ -+ (BIT_CLEAR_BCN_SPACE0_8197F(x) | BIT_BCN_SPACE0_8197F(v)) -+ -+/* 2 REG_DRVERLYINT_8197F */ -+ -+#define BIT_SHIFT_DRVERLYITV_8197F 0 -+#define BIT_MASK_DRVERLYITV_8197F 0xff -+#define BIT_DRVERLYITV_8197F(x) \ -+ (((x) & BIT_MASK_DRVERLYITV_8197F) << BIT_SHIFT_DRVERLYITV_8197F) -+#define BITS_DRVERLYITV_8197F \ -+ (BIT_MASK_DRVERLYITV_8197F << BIT_SHIFT_DRVERLYITV_8197F) -+#define BIT_CLEAR_DRVERLYITV_8197F(x) ((x) & (~BITS_DRVERLYITV_8197F)) -+#define BIT_GET_DRVERLYITV_8197F(x) \ -+ (((x) >> BIT_SHIFT_DRVERLYITV_8197F) & BIT_MASK_DRVERLYITV_8197F) -+#define BIT_SET_DRVERLYITV_8197F(x, v) \ -+ (BIT_CLEAR_DRVERLYITV_8197F(x) | BIT_DRVERLYITV_8197F(v)) -+ -+/* 2 REG_BCNDMATIM_8197F */ -+ -+#define BIT_SHIFT_BCNDMATIM_8197F 0 -+#define BIT_MASK_BCNDMATIM_8197F 0xff -+#define BIT_BCNDMATIM_8197F(x) \ -+ (((x) & BIT_MASK_BCNDMATIM_8197F) << BIT_SHIFT_BCNDMATIM_8197F) -+#define BITS_BCNDMATIM_8197F \ -+ (BIT_MASK_BCNDMATIM_8197F << BIT_SHIFT_BCNDMATIM_8197F) -+#define BIT_CLEAR_BCNDMATIM_8197F(x) ((x) & (~BITS_BCNDMATIM_8197F)) -+#define BIT_GET_BCNDMATIM_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNDMATIM_8197F) & BIT_MASK_BCNDMATIM_8197F) -+#define BIT_SET_BCNDMATIM_8197F(x, v) \ -+ (BIT_CLEAR_BCNDMATIM_8197F(x) | BIT_BCNDMATIM_8197F(v)) -+ -+/* 2 REG_ATIMWND_8197F */ -+ -+#define BIT_SHIFT_ATIMWND0_8197F 0 -+#define BIT_MASK_ATIMWND0_8197F 0xffff -+#define BIT_ATIMWND0_8197F(x) \ -+ (((x) & BIT_MASK_ATIMWND0_8197F) << BIT_SHIFT_ATIMWND0_8197F) -+#define BITS_ATIMWND0_8197F \ -+ (BIT_MASK_ATIMWND0_8197F << BIT_SHIFT_ATIMWND0_8197F) -+#define BIT_CLEAR_ATIMWND0_8197F(x) ((x) & (~BITS_ATIMWND0_8197F)) -+#define BIT_GET_ATIMWND0_8197F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND0_8197F) & BIT_MASK_ATIMWND0_8197F) -+#define BIT_SET_ATIMWND0_8197F(x, v) \ -+ (BIT_CLEAR_ATIMWND0_8197F(x) | BIT_ATIMWND0_8197F(v)) -+ -+/* 2 REG_USTIME_TSF_8197F */ -+ -+#define BIT_SHIFT_USTIME_TSF_V1_8197F 0 -+#define BIT_MASK_USTIME_TSF_V1_8197F 0xff -+#define BIT_USTIME_TSF_V1_8197F(x) \ -+ (((x) & BIT_MASK_USTIME_TSF_V1_8197F) << BIT_SHIFT_USTIME_TSF_V1_8197F) -+#define BITS_USTIME_TSF_V1_8197F \ -+ (BIT_MASK_USTIME_TSF_V1_8197F << BIT_SHIFT_USTIME_TSF_V1_8197F) -+#define BIT_CLEAR_USTIME_TSF_V1_8197F(x) ((x) & (~BITS_USTIME_TSF_V1_8197F)) -+#define BIT_GET_USTIME_TSF_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_USTIME_TSF_V1_8197F) & BIT_MASK_USTIME_TSF_V1_8197F) -+#define BIT_SET_USTIME_TSF_V1_8197F(x, v) \ -+ (BIT_CLEAR_USTIME_TSF_V1_8197F(x) | BIT_USTIME_TSF_V1_8197F(v)) -+ -+/* 2 REG_BCN_MAX_ERR_8197F */ -+ -+#define BIT_SHIFT_BCN_MAX_ERR_8197F 0 -+#define BIT_MASK_BCN_MAX_ERR_8197F 0xff -+#define BIT_BCN_MAX_ERR_8197F(x) \ -+ (((x) & BIT_MASK_BCN_MAX_ERR_8197F) << BIT_SHIFT_BCN_MAX_ERR_8197F) -+#define BITS_BCN_MAX_ERR_8197F \ -+ (BIT_MASK_BCN_MAX_ERR_8197F << BIT_SHIFT_BCN_MAX_ERR_8197F) -+#define BIT_CLEAR_BCN_MAX_ERR_8197F(x) ((x) & (~BITS_BCN_MAX_ERR_8197F)) -+#define BIT_GET_BCN_MAX_ERR_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCN_MAX_ERR_8197F) & BIT_MASK_BCN_MAX_ERR_8197F) -+#define BIT_SET_BCN_MAX_ERR_8197F(x, v) \ -+ (BIT_CLEAR_BCN_MAX_ERR_8197F(x) | BIT_BCN_MAX_ERR_8197F(v)) -+ -+/* 2 REG_RXTSF_OFFSET_CCK_8197F */ -+ -+#define BIT_SHIFT_CCK_RXTSF_OFFSET_8197F 0 -+#define BIT_MASK_CCK_RXTSF_OFFSET_8197F 0xff -+#define BIT_CCK_RXTSF_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_CCK_RXTSF_OFFSET_8197F) \ -+ << BIT_SHIFT_CCK_RXTSF_OFFSET_8197F) -+#define BITS_CCK_RXTSF_OFFSET_8197F \ -+ (BIT_MASK_CCK_RXTSF_OFFSET_8197F << BIT_SHIFT_CCK_RXTSF_OFFSET_8197F) -+#define BIT_CLEAR_CCK_RXTSF_OFFSET_8197F(x) \ -+ ((x) & (~BITS_CCK_RXTSF_OFFSET_8197F)) -+#define BIT_GET_CCK_RXTSF_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_CCK_RXTSF_OFFSET_8197F) & \ -+ BIT_MASK_CCK_RXTSF_OFFSET_8197F) -+#define BIT_SET_CCK_RXTSF_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_CCK_RXTSF_OFFSET_8197F(x) | BIT_CCK_RXTSF_OFFSET_8197F(v)) -+ -+/* 2 REG_RXTSF_OFFSET_OFDM_8197F */ -+ -+#define BIT_SHIFT_OFDM_RXTSF_OFFSET_8197F 0 -+#define BIT_MASK_OFDM_RXTSF_OFFSET_8197F 0xff -+#define BIT_OFDM_RXTSF_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_OFDM_RXTSF_OFFSET_8197F) \ -+ << BIT_SHIFT_OFDM_RXTSF_OFFSET_8197F) -+#define BITS_OFDM_RXTSF_OFFSET_8197F \ -+ (BIT_MASK_OFDM_RXTSF_OFFSET_8197F << BIT_SHIFT_OFDM_RXTSF_OFFSET_8197F) -+#define BIT_CLEAR_OFDM_RXTSF_OFFSET_8197F(x) \ -+ ((x) & (~BITS_OFDM_RXTSF_OFFSET_8197F)) -+#define BIT_GET_OFDM_RXTSF_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_OFDM_RXTSF_OFFSET_8197F) & \ -+ BIT_MASK_OFDM_RXTSF_OFFSET_8197F) -+#define BIT_SET_OFDM_RXTSF_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_OFDM_RXTSF_OFFSET_8197F(x) | BIT_OFDM_RXTSF_OFFSET_8197F(v)) -+ -+/* 2 REG_TSFTR_8197F */ -+ -+#define BIT_SHIFT_TSF_TIMER_8197F 0 -+#define BIT_MASK_TSF_TIMER_8197F 0xffffffffffffffffL -+#define BIT_TSF_TIMER_8197F(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_8197F) << BIT_SHIFT_TSF_TIMER_8197F) -+#define BITS_TSF_TIMER_8197F \ -+ (BIT_MASK_TSF_TIMER_8197F << BIT_SHIFT_TSF_TIMER_8197F) -+#define BIT_CLEAR_TSF_TIMER_8197F(x) ((x) & (~BITS_TSF_TIMER_8197F)) -+#define BIT_GET_TSF_TIMER_8197F(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_8197F) & BIT_MASK_TSF_TIMER_8197F) -+#define BIT_SET_TSF_TIMER_8197F(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_8197F(x) | BIT_TSF_TIMER_8197F(v)) -+ -+/* 2 REG_FREERUN_CNT_8197F */ -+ -+#define BIT_SHIFT_FREERUN_CNT_8197F 0 -+#define BIT_MASK_FREERUN_CNT_8197F 0xffffffffffffffffL -+#define BIT_FREERUN_CNT_8197F(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_8197F) << BIT_SHIFT_FREERUN_CNT_8197F) -+#define BITS_FREERUN_CNT_8197F \ -+ (BIT_MASK_FREERUN_CNT_8197F << BIT_SHIFT_FREERUN_CNT_8197F) -+#define BIT_CLEAR_FREERUN_CNT_8197F(x) ((x) & (~BITS_FREERUN_CNT_8197F)) -+#define BIT_GET_FREERUN_CNT_8197F(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_8197F) & BIT_MASK_FREERUN_CNT_8197F) -+#define BIT_SET_FREERUN_CNT_8197F(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_8197F(x) | BIT_FREERUN_CNT_8197F(v)) -+ -+/* 2 REG_ATIMWND1_8197F */ -+ -+#define BIT_SHIFT_ATIMWND1_V1_8197F 0 -+#define BIT_MASK_ATIMWND1_V1_8197F 0xff -+#define BIT_ATIMWND1_V1_8197F(x) \ -+ (((x) & BIT_MASK_ATIMWND1_V1_8197F) << BIT_SHIFT_ATIMWND1_V1_8197F) -+#define BITS_ATIMWND1_V1_8197F \ -+ (BIT_MASK_ATIMWND1_V1_8197F << BIT_SHIFT_ATIMWND1_V1_8197F) -+#define BIT_CLEAR_ATIMWND1_V1_8197F(x) ((x) & (~BITS_ATIMWND1_V1_8197F)) -+#define BIT_GET_ATIMWND1_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND1_V1_8197F) & BIT_MASK_ATIMWND1_V1_8197F) -+#define BIT_SET_ATIMWND1_V1_8197F(x, v) \ -+ (BIT_CLEAR_ATIMWND1_V1_8197F(x) | BIT_ATIMWND1_V1_8197F(v)) -+ -+/* 2 REG_TBTT_PROHIBIT_INFRA_8197F */ -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_INFRA_8197F 0 -+#define BIT_MASK_TBTT_PROHIBIT_INFRA_8197F 0xff -+#define BIT_TBTT_PROHIBIT_INFRA_8197F(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_INFRA_8197F) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_INFRA_8197F) -+#define BITS_TBTT_PROHIBIT_INFRA_8197F \ -+ (BIT_MASK_TBTT_PROHIBIT_INFRA_8197F \ -+ << BIT_SHIFT_TBTT_PROHIBIT_INFRA_8197F) -+#define BIT_CLEAR_TBTT_PROHIBIT_INFRA_8197F(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_INFRA_8197F)) -+#define BIT_GET_TBTT_PROHIBIT_INFRA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_INFRA_8197F) & \ -+ BIT_MASK_TBTT_PROHIBIT_INFRA_8197F) -+#define BIT_SET_TBTT_PROHIBIT_INFRA_8197F(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_INFRA_8197F(x) | \ -+ BIT_TBTT_PROHIBIT_INFRA_8197F(v)) -+ -+/* 2 REG_CTWND_8197F */ -+ -+#define BIT_SHIFT_CTWND_8197F 0 -+#define BIT_MASK_CTWND_8197F 0xff -+#define BIT_CTWND_8197F(x) \ -+ (((x) & BIT_MASK_CTWND_8197F) << BIT_SHIFT_CTWND_8197F) -+#define BITS_CTWND_8197F (BIT_MASK_CTWND_8197F << BIT_SHIFT_CTWND_8197F) -+#define BIT_CLEAR_CTWND_8197F(x) ((x) & (~BITS_CTWND_8197F)) -+#define BIT_GET_CTWND_8197F(x) \ -+ (((x) >> BIT_SHIFT_CTWND_8197F) & BIT_MASK_CTWND_8197F) -+#define BIT_SET_CTWND_8197F(x, v) \ -+ (BIT_CLEAR_CTWND_8197F(x) | BIT_CTWND_8197F(v)) -+ -+/* 2 REG_BCNIVLCUNT_8197F */ -+ -+#define BIT_SHIFT_BCNIVLCUNT_8197F 0 -+#define BIT_MASK_BCNIVLCUNT_8197F 0x7f -+#define BIT_BCNIVLCUNT_8197F(x) \ -+ (((x) & BIT_MASK_BCNIVLCUNT_8197F) << BIT_SHIFT_BCNIVLCUNT_8197F) -+#define BITS_BCNIVLCUNT_8197F \ -+ (BIT_MASK_BCNIVLCUNT_8197F << BIT_SHIFT_BCNIVLCUNT_8197F) -+#define BIT_CLEAR_BCNIVLCUNT_8197F(x) ((x) & (~BITS_BCNIVLCUNT_8197F)) -+#define BIT_GET_BCNIVLCUNT_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNIVLCUNT_8197F) & BIT_MASK_BCNIVLCUNT_8197F) -+#define BIT_SET_BCNIVLCUNT_8197F(x, v) \ -+ (BIT_CLEAR_BCNIVLCUNT_8197F(x) | BIT_BCNIVLCUNT_8197F(v)) -+ -+/* 2 REG_BCNDROPCTRL_8197F */ -+#define BIT_BEACON_DROP_EN_8197F BIT(7) -+ -+#define BIT_SHIFT_BEACON_DROP_IVL_8197F 0 -+#define BIT_MASK_BEACON_DROP_IVL_8197F 0x7f -+#define BIT_BEACON_DROP_IVL_8197F(x) \ -+ (((x) & BIT_MASK_BEACON_DROP_IVL_8197F) \ -+ << BIT_SHIFT_BEACON_DROP_IVL_8197F) -+#define BITS_BEACON_DROP_IVL_8197F \ -+ (BIT_MASK_BEACON_DROP_IVL_8197F << BIT_SHIFT_BEACON_DROP_IVL_8197F) -+#define BIT_CLEAR_BEACON_DROP_IVL_8197F(x) ((x) & (~BITS_BEACON_DROP_IVL_8197F)) -+#define BIT_GET_BEACON_DROP_IVL_8197F(x) \ -+ (((x) >> BIT_SHIFT_BEACON_DROP_IVL_8197F) & \ -+ BIT_MASK_BEACON_DROP_IVL_8197F) -+#define BIT_SET_BEACON_DROP_IVL_8197F(x, v) \ -+ (BIT_CLEAR_BEACON_DROP_IVL_8197F(x) | BIT_BEACON_DROP_IVL_8197F(v)) -+ -+/* 2 REG_HGQ_TIMEOUT_PERIOD_8197F */ -+ -+#define BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8197F 0 -+#define BIT_MASK_HGQ_TIMEOUT_PERIOD_8197F 0xff -+#define BIT_HGQ_TIMEOUT_PERIOD_8197F(x) \ -+ (((x) & BIT_MASK_HGQ_TIMEOUT_PERIOD_8197F) \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8197F) -+#define BITS_HGQ_TIMEOUT_PERIOD_8197F \ -+ (BIT_MASK_HGQ_TIMEOUT_PERIOD_8197F \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8197F) -+#define BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8197F(x) \ -+ ((x) & (~BITS_HGQ_TIMEOUT_PERIOD_8197F)) -+#define BIT_GET_HGQ_TIMEOUT_PERIOD_8197F(x) \ -+ (((x) >> BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8197F) & \ -+ BIT_MASK_HGQ_TIMEOUT_PERIOD_8197F) -+#define BIT_SET_HGQ_TIMEOUT_PERIOD_8197F(x, v) \ -+ (BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8197F(x) | \ -+ BIT_HGQ_TIMEOUT_PERIOD_8197F(v)) -+ -+/* 2 REG_TXCMD_TIMEOUT_PERIOD_8197F */ -+ -+#define BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8197F 0 -+#define BIT_MASK_TXCMD_TIMEOUT_PERIOD_8197F 0xff -+#define BIT_TXCMD_TIMEOUT_PERIOD_8197F(x) \ -+ (((x) & BIT_MASK_TXCMD_TIMEOUT_PERIOD_8197F) \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8197F) -+#define BITS_TXCMD_TIMEOUT_PERIOD_8197F \ -+ (BIT_MASK_TXCMD_TIMEOUT_PERIOD_8197F \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8197F) -+#define BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8197F(x) \ -+ ((x) & (~BITS_TXCMD_TIMEOUT_PERIOD_8197F)) -+#define BIT_GET_TXCMD_TIMEOUT_PERIOD_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8197F) & \ -+ BIT_MASK_TXCMD_TIMEOUT_PERIOD_8197F) -+#define BIT_SET_TXCMD_TIMEOUT_PERIOD_8197F(x, v) \ -+ (BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8197F(x) | \ -+ BIT_TXCMD_TIMEOUT_PERIOD_8197F(v)) -+ -+/* 2 REG_MISC_CTRL_8197F */ -+#define BIT_DIS_MARK_TSF_US_8197F BIT(7) -+#define BIT_EN_TSFAUTO_SYNC_8197F BIT(6) -+#define BIT_DIS_TRX_CAL_BCN_8197F BIT(5) -+#define BIT_DIS_TX_CAL_TBTT_8197F BIT(4) -+#define BIT_EN_FREECNT_8197F BIT(3) -+#define BIT_BCN_AGGRESSION_8197F BIT(2) -+ -+#define BIT_SHIFT_DIS_SECONDARY_CCA_8197F 0 -+#define BIT_MASK_DIS_SECONDARY_CCA_8197F 0x3 -+#define BIT_DIS_SECONDARY_CCA_8197F(x) \ -+ (((x) & BIT_MASK_DIS_SECONDARY_CCA_8197F) \ -+ << BIT_SHIFT_DIS_SECONDARY_CCA_8197F) -+#define BITS_DIS_SECONDARY_CCA_8197F \ -+ (BIT_MASK_DIS_SECONDARY_CCA_8197F << BIT_SHIFT_DIS_SECONDARY_CCA_8197F) -+#define BIT_CLEAR_DIS_SECONDARY_CCA_8197F(x) \ -+ ((x) & (~BITS_DIS_SECONDARY_CCA_8197F)) -+#define BIT_GET_DIS_SECONDARY_CCA_8197F(x) \ -+ (((x) >> BIT_SHIFT_DIS_SECONDARY_CCA_8197F) & \ -+ BIT_MASK_DIS_SECONDARY_CCA_8197F) -+#define BIT_SET_DIS_SECONDARY_CCA_8197F(x, v) \ -+ (BIT_CLEAR_DIS_SECONDARY_CCA_8197F(x) | BIT_DIS_SECONDARY_CCA_8197F(v)) -+ -+/* 2 REG_BCN_CTRL_CLINT1_8197F */ -+#define BIT_CLI1_DIS_RX_BSSID_FIT_8197F BIT(6) -+#define BIT_CLI1_DIS_TSF_UDT_8197F BIT(4) -+#define BIT_CLI1_EN_BCN_FUNCTION_8197F BIT(3) -+#define BIT_CLI1_EN_RXBCN_RPT_8197F BIT(2) -+#define BIT_CLI1_ENP2P_CTWINDOW_8197F BIT(1) -+#define BIT_CLI1_ENP2P_BCNQ_AREA_8197F BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT2_8197F */ -+#define BIT_CLI2_DIS_RX_BSSID_FIT_8197F BIT(6) -+#define BIT_CLI2_DIS_TSF_UDT_8197F BIT(4) -+#define BIT_CLI2_EN_BCN_FUNCTION_8197F BIT(3) -+#define BIT_CLI2_EN_RXBCN_RPT_8197F BIT(2) -+#define BIT_CLI2_ENP2P_CTWINDOW_8197F BIT(1) -+#define BIT_CLI2_ENP2P_BCNQ_AREA_8197F BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT3_8197F */ -+#define BIT_CLI3_DIS_RX_BSSID_FIT_8197F BIT(6) -+#define BIT_CLI3_DIS_TSF_UDT_8197F BIT(4) -+#define BIT_CLI3_EN_BCN_FUNCTION_8197F BIT(3) -+#define BIT_CLI3_EN_RXBCN_RPT_8197F BIT(2) -+#define BIT_CLI3_ENP2P_CTWINDOW_8197F BIT(1) -+#define BIT_CLI3_ENP2P_BCNQ_AREA_8197F BIT(0) -+ -+/* 2 REG_EXTEND_CTRL_8197F */ -+#define BIT_EN_TSFBIT32_RST_P2P2_8197F BIT(5) -+#define BIT_EN_TSFBIT32_RST_P2P1_8197F BIT(4) -+ -+#define BIT_SHIFT_PORT_SEL_8197F 0 -+#define BIT_MASK_PORT_SEL_8197F 0x7 -+#define BIT_PORT_SEL_8197F(x) \ -+ (((x) & BIT_MASK_PORT_SEL_8197F) << BIT_SHIFT_PORT_SEL_8197F) -+#define BITS_PORT_SEL_8197F \ -+ (BIT_MASK_PORT_SEL_8197F << BIT_SHIFT_PORT_SEL_8197F) -+#define BIT_CLEAR_PORT_SEL_8197F(x) ((x) & (~BITS_PORT_SEL_8197F)) -+#define BIT_GET_PORT_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_PORT_SEL_8197F) & BIT_MASK_PORT_SEL_8197F) -+#define BIT_SET_PORT_SEL_8197F(x, v) \ -+ (BIT_CLEAR_PORT_SEL_8197F(x) | BIT_PORT_SEL_8197F(v)) -+ -+/* 2 REG_P2PPS1_SPEC_STATE_8197F */ -+#define BIT_P2P1_SPEC_POWER_STATE_8197F BIT(7) -+#define BIT_P2P1_SPEC_CTWINDOW_ON_8197F BIT(6) -+#define BIT_P2P1_SPEC_BCN_AREA_ON_8197F BIT(5) -+#define BIT_P2P1_SPEC_CTWIN_EARLY_DISTX_8197F BIT(4) -+#define BIT_P2P1_SPEC_NOA1_OFF_PERIOD_8197F BIT(3) -+#define BIT_P2P1_SPEC_FORCE_DOZE1_8197F BIT(2) -+#define BIT_P2P1_SPEC_NOA0_OFF_PERIOD_8197F BIT(1) -+#define BIT_P2P1_SPEC_FORCE_DOZE0_8197F BIT(0) -+ -+/* 2 REG_P2PPS1_STATE_8197F */ -+#define BIT_P2P1_POWER_STATE_8197F BIT(7) -+#define BIT_P2P1_CTWINDOW_ON_8197F BIT(6) -+#define BIT_P2P1_BEACON_AREA_ON_8197F BIT(5) -+#define BIT_P2P1_CTWIN_EARLY_DISTX_8197F BIT(4) -+#define BIT_P2P1_NOA1_OFF_PERIOD_8197F BIT(3) -+#define BIT_P2P1_FORCE_DOZE1_8197F BIT(2) -+#define BIT_P2P1_NOA0_OFF_PERIOD_8197F BIT(1) -+#define BIT_P2P1_FORCE_DOZE0_8197F BIT(0) -+ -+/* 2 REG_P2PPS2_SPEC_STATE_8197F */ -+#define BIT_P2P2_SPEC_POWER_STATE_8197F BIT(7) -+#define BIT_P2P2_SPEC_CTWINDOW_ON_8197F BIT(6) -+#define BIT_P2P2_SPEC_BCN_AREA_ON_8197F BIT(5) -+#define BIT_P2P2_SPEC_CTWIN_EARLY_DISTX_8197F BIT(4) -+#define BIT_P2P2_SPEC_NOA1_OFF_PERIOD_8197F BIT(3) -+#define BIT_P2P2_SPEC_FORCE_DOZE1_8197F BIT(2) -+#define BIT_P2P2_SPEC_NOA0_OFF_PERIOD_8197F BIT(1) -+#define BIT_P2P2_SPEC_FORCE_DOZE0_8197F BIT(0) -+ -+/* 2 REG_P2PPS2_STATE_8197F */ -+#define BIT_P2P2_POWER_STATE_8197F BIT(7) -+#define BIT_P2P2_CTWINDOW_ON_8197F BIT(6) -+#define BIT_P2P2_BEACON_AREA_ON_8197F BIT(5) -+#define BIT_P2P2_CTWIN_EARLY_DISTX_8197F BIT(4) -+#define BIT_P2P2_NOA1_OFF_PERIOD_8197F BIT(3) -+#define BIT_P2P2_FORCE_DOZE1_8197F BIT(2) -+#define BIT_P2P2_NOA0_OFF_PERIOD_8197F BIT(1) -+#define BIT_P2P2_FORCE_DOZE0_8197F BIT(0) -+ -+/* 2 REG_PS_TIMER0_8197F */ -+ -+#define BIT_SHIFT_PSTIMER0_INT_8197F 5 -+#define BIT_MASK_PSTIMER0_INT_8197F 0x7ffffff -+#define BIT_PSTIMER0_INT_8197F(x) \ -+ (((x) & BIT_MASK_PSTIMER0_INT_8197F) << BIT_SHIFT_PSTIMER0_INT_8197F) -+#define BITS_PSTIMER0_INT_8197F \ -+ (BIT_MASK_PSTIMER0_INT_8197F << BIT_SHIFT_PSTIMER0_INT_8197F) -+#define BIT_CLEAR_PSTIMER0_INT_8197F(x) ((x) & (~BITS_PSTIMER0_INT_8197F)) -+#define BIT_GET_PSTIMER0_INT_8197F(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER0_INT_8197F) & BIT_MASK_PSTIMER0_INT_8197F) -+#define BIT_SET_PSTIMER0_INT_8197F(x, v) \ -+ (BIT_CLEAR_PSTIMER0_INT_8197F(x) | BIT_PSTIMER0_INT_8197F(v)) -+ -+/* 2 REG_PS_TIMER1_8197F */ -+ -+#define BIT_SHIFT_PSTIMER1_INT_8197F 5 -+#define BIT_MASK_PSTIMER1_INT_8197F 0x7ffffff -+#define BIT_PSTIMER1_INT_8197F(x) \ -+ (((x) & BIT_MASK_PSTIMER1_INT_8197F) << BIT_SHIFT_PSTIMER1_INT_8197F) -+#define BITS_PSTIMER1_INT_8197F \ -+ (BIT_MASK_PSTIMER1_INT_8197F << BIT_SHIFT_PSTIMER1_INT_8197F) -+#define BIT_CLEAR_PSTIMER1_INT_8197F(x) ((x) & (~BITS_PSTIMER1_INT_8197F)) -+#define BIT_GET_PSTIMER1_INT_8197F(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER1_INT_8197F) & BIT_MASK_PSTIMER1_INT_8197F) -+#define BIT_SET_PSTIMER1_INT_8197F(x, v) \ -+ (BIT_CLEAR_PSTIMER1_INT_8197F(x) | BIT_PSTIMER1_INT_8197F(v)) -+ -+/* 2 REG_PS_TIMER2_8197F */ -+ -+#define BIT_SHIFT_PSTIMER2_INT_8197F 5 -+#define BIT_MASK_PSTIMER2_INT_8197F 0x7ffffff -+#define BIT_PSTIMER2_INT_8197F(x) \ -+ (((x) & BIT_MASK_PSTIMER2_INT_8197F) << BIT_SHIFT_PSTIMER2_INT_8197F) -+#define BITS_PSTIMER2_INT_8197F \ -+ (BIT_MASK_PSTIMER2_INT_8197F << BIT_SHIFT_PSTIMER2_INT_8197F) -+#define BIT_CLEAR_PSTIMER2_INT_8197F(x) ((x) & (~BITS_PSTIMER2_INT_8197F)) -+#define BIT_GET_PSTIMER2_INT_8197F(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER2_INT_8197F) & BIT_MASK_PSTIMER2_INT_8197F) -+#define BIT_SET_PSTIMER2_INT_8197F(x, v) \ -+ (BIT_CLEAR_PSTIMER2_INT_8197F(x) | BIT_PSTIMER2_INT_8197F(v)) -+ -+/* 2 REG_TBTT_CTN_AREA_8197F */ -+ -+#define BIT_SHIFT_TBTT_CTN_AREA_8197F 0 -+#define BIT_MASK_TBTT_CTN_AREA_8197F 0xff -+#define BIT_TBTT_CTN_AREA_8197F(x) \ -+ (((x) & BIT_MASK_TBTT_CTN_AREA_8197F) << BIT_SHIFT_TBTT_CTN_AREA_8197F) -+#define BITS_TBTT_CTN_AREA_8197F \ -+ (BIT_MASK_TBTT_CTN_AREA_8197F << BIT_SHIFT_TBTT_CTN_AREA_8197F) -+#define BIT_CLEAR_TBTT_CTN_AREA_8197F(x) ((x) & (~BITS_TBTT_CTN_AREA_8197F)) -+#define BIT_GET_TBTT_CTN_AREA_8197F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_CTN_AREA_8197F) & BIT_MASK_TBTT_CTN_AREA_8197F) -+#define BIT_SET_TBTT_CTN_AREA_8197F(x, v) \ -+ (BIT_CLEAR_TBTT_CTN_AREA_8197F(x) | BIT_TBTT_CTN_AREA_8197F(v)) -+ -+/* 2 REG_FORCE_BCN_IFS_8197F */ -+ -+#define BIT_SHIFT_FORCE_BCN_IFS_8197F 0 -+#define BIT_MASK_FORCE_BCN_IFS_8197F 0xff -+#define BIT_FORCE_BCN_IFS_8197F(x) \ -+ (((x) & BIT_MASK_FORCE_BCN_IFS_8197F) << BIT_SHIFT_FORCE_BCN_IFS_8197F) -+#define BITS_FORCE_BCN_IFS_8197F \ -+ (BIT_MASK_FORCE_BCN_IFS_8197F << BIT_SHIFT_FORCE_BCN_IFS_8197F) -+#define BIT_CLEAR_FORCE_BCN_IFS_8197F(x) ((x) & (~BITS_FORCE_BCN_IFS_8197F)) -+#define BIT_GET_FORCE_BCN_IFS_8197F(x) \ -+ (((x) >> BIT_SHIFT_FORCE_BCN_IFS_8197F) & BIT_MASK_FORCE_BCN_IFS_8197F) -+#define BIT_SET_FORCE_BCN_IFS_8197F(x, v) \ -+ (BIT_CLEAR_FORCE_BCN_IFS_8197F(x) | BIT_FORCE_BCN_IFS_8197F(v)) -+ -+/* 2 REG_TXOP_MIN_8197F */ -+#define BIT_NAV_BLK_HGQ_8197F BIT(15) -+#define BIT_NAV_BLK_MGQ_8197F BIT(14) -+ -+#define BIT_SHIFT_TXOP_MIN_8197F 0 -+#define BIT_MASK_TXOP_MIN_8197F 0x3fff -+#define BIT_TXOP_MIN_8197F(x) \ -+ (((x) & BIT_MASK_TXOP_MIN_8197F) << BIT_SHIFT_TXOP_MIN_8197F) -+#define BITS_TXOP_MIN_8197F \ -+ (BIT_MASK_TXOP_MIN_8197F << BIT_SHIFT_TXOP_MIN_8197F) -+#define BIT_CLEAR_TXOP_MIN_8197F(x) ((x) & (~BITS_TXOP_MIN_8197F)) -+#define BIT_GET_TXOP_MIN_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXOP_MIN_8197F) & BIT_MASK_TXOP_MIN_8197F) -+#define BIT_SET_TXOP_MIN_8197F(x, v) \ -+ (BIT_CLEAR_TXOP_MIN_8197F(x) | BIT_TXOP_MIN_8197F(v)) -+ -+/* 2 REG_PRE_BKF_TIME_8197F */ -+ -+#define BIT_SHIFT_PRE_BKF_TIME_8197F 0 -+#define BIT_MASK_PRE_BKF_TIME_8197F 0xff -+#define BIT_PRE_BKF_TIME_8197F(x) \ -+ (((x) & BIT_MASK_PRE_BKF_TIME_8197F) << BIT_SHIFT_PRE_BKF_TIME_8197F) -+#define BITS_PRE_BKF_TIME_8197F \ -+ (BIT_MASK_PRE_BKF_TIME_8197F << BIT_SHIFT_PRE_BKF_TIME_8197F) -+#define BIT_CLEAR_PRE_BKF_TIME_8197F(x) ((x) & (~BITS_PRE_BKF_TIME_8197F)) -+#define BIT_GET_PRE_BKF_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_PRE_BKF_TIME_8197F) & BIT_MASK_PRE_BKF_TIME_8197F) -+#define BIT_SET_PRE_BKF_TIME_8197F(x, v) \ -+ (BIT_CLEAR_PRE_BKF_TIME_8197F(x) | BIT_PRE_BKF_TIME_8197F(v)) -+ -+/* 2 REG_CROSS_TXOP_CTRL_8197F */ -+#define BIT_DTIM_BYPASS_8197F BIT(2) -+#define BIT_RTS_NAV_TXOP_8197F BIT(1) -+#define BIT_NOT_CROSS_TXOP_8197F BIT(0) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI0_8197F */ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI0_8197F BIT(7) -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI0_8197F 0 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI0_8197F 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI0_8197F(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI0_8197F) \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI0_8197F) -+#define BITS_TBTT_INT_SHIFT_CLI0_8197F \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI0_8197F \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI0_8197F) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI0_8197F(x) \ -+ ((x) & (~BITS_TBTT_INT_SHIFT_CLI0_8197F)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI0_8197F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI0_8197F) & \ -+ BIT_MASK_TBTT_INT_SHIFT_CLI0_8197F) -+#define BIT_SET_TBTT_INT_SHIFT_CLI0_8197F(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI0_8197F(x) | \ -+ BIT_TBTT_INT_SHIFT_CLI0_8197F(v)) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI1_8197F */ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI1_8197F BIT(7) -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI1_8197F 0 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI1_8197F 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI1_8197F(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI1_8197F) \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI1_8197F) -+#define BITS_TBTT_INT_SHIFT_CLI1_8197F \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI1_8197F \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI1_8197F) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI1_8197F(x) \ -+ ((x) & (~BITS_TBTT_INT_SHIFT_CLI1_8197F)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI1_8197F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI1_8197F) & \ -+ BIT_MASK_TBTT_INT_SHIFT_CLI1_8197F) -+#define BIT_SET_TBTT_INT_SHIFT_CLI1_8197F(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI1_8197F(x) | \ -+ BIT_TBTT_INT_SHIFT_CLI1_8197F(v)) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI2_8197F */ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI2_8197F BIT(7) -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI2_8197F 0 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI2_8197F 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI2_8197F(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI2_8197F) \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI2_8197F) -+#define BITS_TBTT_INT_SHIFT_CLI2_8197F \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI2_8197F \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI2_8197F) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI2_8197F(x) \ -+ ((x) & (~BITS_TBTT_INT_SHIFT_CLI2_8197F)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI2_8197F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI2_8197F) & \ -+ BIT_MASK_TBTT_INT_SHIFT_CLI2_8197F) -+#define BIT_SET_TBTT_INT_SHIFT_CLI2_8197F(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI2_8197F(x) | \ -+ BIT_TBTT_INT_SHIFT_CLI2_8197F(v)) -+ -+/* 2 REG_TBTT_INT_SHIFT_CLI3_8197F */ -+#define BIT_TBTT_INT_SHIFT_DIR_CLI3_8197F BIT(7) -+ -+#define BIT_SHIFT_TBTT_INT_SHIFT_CLI3_8197F 0 -+#define BIT_MASK_TBTT_INT_SHIFT_CLI3_8197F 0x7f -+#define BIT_TBTT_INT_SHIFT_CLI3_8197F(x) \ -+ (((x) & BIT_MASK_TBTT_INT_SHIFT_CLI3_8197F) \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI3_8197F) -+#define BITS_TBTT_INT_SHIFT_CLI3_8197F \ -+ (BIT_MASK_TBTT_INT_SHIFT_CLI3_8197F \ -+ << BIT_SHIFT_TBTT_INT_SHIFT_CLI3_8197F) -+#define BIT_CLEAR_TBTT_INT_SHIFT_CLI3_8197F(x) \ -+ ((x) & (~BITS_TBTT_INT_SHIFT_CLI3_8197F)) -+#define BIT_GET_TBTT_INT_SHIFT_CLI3_8197F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_INT_SHIFT_CLI3_8197F) & \ -+ BIT_MASK_TBTT_INT_SHIFT_CLI3_8197F) -+#define BIT_SET_TBTT_INT_SHIFT_CLI3_8197F(x, v) \ -+ (BIT_CLEAR_TBTT_INT_SHIFT_CLI3_8197F(x) | \ -+ BIT_TBTT_INT_SHIFT_CLI3_8197F(v)) -+ -+/* 2 REG_TBTT_INT_SHIFT_ENABLE_8197F */ -+#define BIT_EN_TBTT_RTY_8197F BIT(1) -+#define BIT_TBTT_INT_SHIFT_ENABLE_8197F BIT(0) -+ -+/* 2 REG_ATIMWND2_8197F */ -+ -+#define BIT_SHIFT_ATIMWND2_8197F 0 -+#define BIT_MASK_ATIMWND2_8197F 0xff -+#define BIT_ATIMWND2_8197F(x) \ -+ (((x) & BIT_MASK_ATIMWND2_8197F) << BIT_SHIFT_ATIMWND2_8197F) -+#define BITS_ATIMWND2_8197F \ -+ (BIT_MASK_ATIMWND2_8197F << BIT_SHIFT_ATIMWND2_8197F) -+#define BIT_CLEAR_ATIMWND2_8197F(x) ((x) & (~BITS_ATIMWND2_8197F)) -+#define BIT_GET_ATIMWND2_8197F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND2_8197F) & BIT_MASK_ATIMWND2_8197F) -+#define BIT_SET_ATIMWND2_8197F(x, v) \ -+ (BIT_CLEAR_ATIMWND2_8197F(x) | BIT_ATIMWND2_8197F(v)) -+ -+/* 2 REG_ATIMWND3_8197F */ -+ -+#define BIT_SHIFT_ATIMWND3_8197F 0 -+#define BIT_MASK_ATIMWND3_8197F 0xff -+#define BIT_ATIMWND3_8197F(x) \ -+ (((x) & BIT_MASK_ATIMWND3_8197F) << BIT_SHIFT_ATIMWND3_8197F) -+#define BITS_ATIMWND3_8197F \ -+ (BIT_MASK_ATIMWND3_8197F << BIT_SHIFT_ATIMWND3_8197F) -+#define BIT_CLEAR_ATIMWND3_8197F(x) ((x) & (~BITS_ATIMWND3_8197F)) -+#define BIT_GET_ATIMWND3_8197F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND3_8197F) & BIT_MASK_ATIMWND3_8197F) -+#define BIT_SET_ATIMWND3_8197F(x, v) \ -+ (BIT_CLEAR_ATIMWND3_8197F(x) | BIT_ATIMWND3_8197F(v)) -+ -+/* 2 REG_ATIMWND4_8197F */ -+ -+#define BIT_SHIFT_ATIMWND4_8197F 0 -+#define BIT_MASK_ATIMWND4_8197F 0xff -+#define BIT_ATIMWND4_8197F(x) \ -+ (((x) & BIT_MASK_ATIMWND4_8197F) << BIT_SHIFT_ATIMWND4_8197F) -+#define BITS_ATIMWND4_8197F \ -+ (BIT_MASK_ATIMWND4_8197F << BIT_SHIFT_ATIMWND4_8197F) -+#define BIT_CLEAR_ATIMWND4_8197F(x) ((x) & (~BITS_ATIMWND4_8197F)) -+#define BIT_GET_ATIMWND4_8197F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND4_8197F) & BIT_MASK_ATIMWND4_8197F) -+#define BIT_SET_ATIMWND4_8197F(x, v) \ -+ (BIT_CLEAR_ATIMWND4_8197F(x) | BIT_ATIMWND4_8197F(v)) -+ -+/* 2 REG_ATIMWND5_8197F */ -+ -+#define BIT_SHIFT_ATIMWND5_8197F 0 -+#define BIT_MASK_ATIMWND5_8197F 0xff -+#define BIT_ATIMWND5_8197F(x) \ -+ (((x) & BIT_MASK_ATIMWND5_8197F) << BIT_SHIFT_ATIMWND5_8197F) -+#define BITS_ATIMWND5_8197F \ -+ (BIT_MASK_ATIMWND5_8197F << BIT_SHIFT_ATIMWND5_8197F) -+#define BIT_CLEAR_ATIMWND5_8197F(x) ((x) & (~BITS_ATIMWND5_8197F)) -+#define BIT_GET_ATIMWND5_8197F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND5_8197F) & BIT_MASK_ATIMWND5_8197F) -+#define BIT_SET_ATIMWND5_8197F(x, v) \ -+ (BIT_CLEAR_ATIMWND5_8197F(x) | BIT_ATIMWND5_8197F(v)) -+ -+/* 2 REG_ATIMWND6_8197F */ -+ -+#define BIT_SHIFT_ATIMWND6_8197F 0 -+#define BIT_MASK_ATIMWND6_8197F 0xff -+#define BIT_ATIMWND6_8197F(x) \ -+ (((x) & BIT_MASK_ATIMWND6_8197F) << BIT_SHIFT_ATIMWND6_8197F) -+#define BITS_ATIMWND6_8197F \ -+ (BIT_MASK_ATIMWND6_8197F << BIT_SHIFT_ATIMWND6_8197F) -+#define BIT_CLEAR_ATIMWND6_8197F(x) ((x) & (~BITS_ATIMWND6_8197F)) -+#define BIT_GET_ATIMWND6_8197F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND6_8197F) & BIT_MASK_ATIMWND6_8197F) -+#define BIT_SET_ATIMWND6_8197F(x, v) \ -+ (BIT_CLEAR_ATIMWND6_8197F(x) | BIT_ATIMWND6_8197F(v)) -+ -+/* 2 REG_ATIMWND7_8197F */ -+ -+#define BIT_SHIFT_ATIMWND7_8197F 0 -+#define BIT_MASK_ATIMWND7_8197F 0xff -+#define BIT_ATIMWND7_8197F(x) \ -+ (((x) & BIT_MASK_ATIMWND7_8197F) << BIT_SHIFT_ATIMWND7_8197F) -+#define BITS_ATIMWND7_8197F \ -+ (BIT_MASK_ATIMWND7_8197F << BIT_SHIFT_ATIMWND7_8197F) -+#define BIT_CLEAR_ATIMWND7_8197F(x) ((x) & (~BITS_ATIMWND7_8197F)) -+#define BIT_GET_ATIMWND7_8197F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND7_8197F) & BIT_MASK_ATIMWND7_8197F) -+#define BIT_SET_ATIMWND7_8197F(x, v) \ -+ (BIT_CLEAR_ATIMWND7_8197F(x) | BIT_ATIMWND7_8197F(v)) -+ -+/* 2 REG_ATIMUGT_8197F */ -+ -+#define BIT_SHIFT_ATIM_URGENT_8197F 0 -+#define BIT_MASK_ATIM_URGENT_8197F 0xff -+#define BIT_ATIM_URGENT_8197F(x) \ -+ (((x) & BIT_MASK_ATIM_URGENT_8197F) << BIT_SHIFT_ATIM_URGENT_8197F) -+#define BITS_ATIM_URGENT_8197F \ -+ (BIT_MASK_ATIM_URGENT_8197F << BIT_SHIFT_ATIM_URGENT_8197F) -+#define BIT_CLEAR_ATIM_URGENT_8197F(x) ((x) & (~BITS_ATIM_URGENT_8197F)) -+#define BIT_GET_ATIM_URGENT_8197F(x) \ -+ (((x) >> BIT_SHIFT_ATIM_URGENT_8197F) & BIT_MASK_ATIM_URGENT_8197F) -+#define BIT_SET_ATIM_URGENT_8197F(x, v) \ -+ (BIT_CLEAR_ATIM_URGENT_8197F(x) | BIT_ATIM_URGENT_8197F(v)) -+ -+/* 2 REG_HIQ_NO_LMT_EN_8197F */ -+#define BIT_HIQ_NO_LMT_EN_VAP7_8197F BIT(7) -+#define BIT_HIQ_NO_LMT_EN_VAP6_8197F BIT(6) -+#define BIT_HIQ_NO_LMT_EN_VAP5_8197F BIT(5) -+#define BIT_HIQ_NO_LMT_EN_VAP4_8197F BIT(4) -+#define BIT_HIQ_NO_LMT_EN_VAP3_8197F BIT(3) -+#define BIT_HIQ_NO_LMT_EN_VAP2_8197F BIT(2) -+#define BIT_HIQ_NO_LMT_EN_VAP1_8197F BIT(1) -+#define BIT_HIQ_NO_LMT_EN_ROOT_8197F BIT(0) -+ -+/* 2 REG_DTIM_COUNTER_ROOT_8197F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_ROOT_8197F 0 -+#define BIT_MASK_DTIM_COUNT_ROOT_8197F 0xff -+#define BIT_DTIM_COUNT_ROOT_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_ROOT_8197F) \ -+ << BIT_SHIFT_DTIM_COUNT_ROOT_8197F) -+#define BITS_DTIM_COUNT_ROOT_8197F \ -+ (BIT_MASK_DTIM_COUNT_ROOT_8197F << BIT_SHIFT_DTIM_COUNT_ROOT_8197F) -+#define BIT_CLEAR_DTIM_COUNT_ROOT_8197F(x) ((x) & (~BITS_DTIM_COUNT_ROOT_8197F)) -+#define BIT_GET_DTIM_COUNT_ROOT_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_ROOT_8197F) & \ -+ BIT_MASK_DTIM_COUNT_ROOT_8197F) -+#define BIT_SET_DTIM_COUNT_ROOT_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_ROOT_8197F(x) | BIT_DTIM_COUNT_ROOT_8197F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP1_8197F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP1_8197F 0 -+#define BIT_MASK_DTIM_COUNT_VAP1_8197F 0xff -+#define BIT_DTIM_COUNT_VAP1_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP1_8197F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP1_8197F) -+#define BITS_DTIM_COUNT_VAP1_8197F \ -+ (BIT_MASK_DTIM_COUNT_VAP1_8197F << BIT_SHIFT_DTIM_COUNT_VAP1_8197F) -+#define BIT_CLEAR_DTIM_COUNT_VAP1_8197F(x) ((x) & (~BITS_DTIM_COUNT_VAP1_8197F)) -+#define BIT_GET_DTIM_COUNT_VAP1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP1_8197F) & \ -+ BIT_MASK_DTIM_COUNT_VAP1_8197F) -+#define BIT_SET_DTIM_COUNT_VAP1_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP1_8197F(x) | BIT_DTIM_COUNT_VAP1_8197F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP2_8197F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP2_8197F 0 -+#define BIT_MASK_DTIM_COUNT_VAP2_8197F 0xff -+#define BIT_DTIM_COUNT_VAP2_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP2_8197F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP2_8197F) -+#define BITS_DTIM_COUNT_VAP2_8197F \ -+ (BIT_MASK_DTIM_COUNT_VAP2_8197F << BIT_SHIFT_DTIM_COUNT_VAP2_8197F) -+#define BIT_CLEAR_DTIM_COUNT_VAP2_8197F(x) ((x) & (~BITS_DTIM_COUNT_VAP2_8197F)) -+#define BIT_GET_DTIM_COUNT_VAP2_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP2_8197F) & \ -+ BIT_MASK_DTIM_COUNT_VAP2_8197F) -+#define BIT_SET_DTIM_COUNT_VAP2_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP2_8197F(x) | BIT_DTIM_COUNT_VAP2_8197F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP3_8197F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP3_8197F 0 -+#define BIT_MASK_DTIM_COUNT_VAP3_8197F 0xff -+#define BIT_DTIM_COUNT_VAP3_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP3_8197F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP3_8197F) -+#define BITS_DTIM_COUNT_VAP3_8197F \ -+ (BIT_MASK_DTIM_COUNT_VAP3_8197F << BIT_SHIFT_DTIM_COUNT_VAP3_8197F) -+#define BIT_CLEAR_DTIM_COUNT_VAP3_8197F(x) ((x) & (~BITS_DTIM_COUNT_VAP3_8197F)) -+#define BIT_GET_DTIM_COUNT_VAP3_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP3_8197F) & \ -+ BIT_MASK_DTIM_COUNT_VAP3_8197F) -+#define BIT_SET_DTIM_COUNT_VAP3_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP3_8197F(x) | BIT_DTIM_COUNT_VAP3_8197F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP4_8197F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP4_8197F 0 -+#define BIT_MASK_DTIM_COUNT_VAP4_8197F 0xff -+#define BIT_DTIM_COUNT_VAP4_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP4_8197F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP4_8197F) -+#define BITS_DTIM_COUNT_VAP4_8197F \ -+ (BIT_MASK_DTIM_COUNT_VAP4_8197F << BIT_SHIFT_DTIM_COUNT_VAP4_8197F) -+#define BIT_CLEAR_DTIM_COUNT_VAP4_8197F(x) ((x) & (~BITS_DTIM_COUNT_VAP4_8197F)) -+#define BIT_GET_DTIM_COUNT_VAP4_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP4_8197F) & \ -+ BIT_MASK_DTIM_COUNT_VAP4_8197F) -+#define BIT_SET_DTIM_COUNT_VAP4_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP4_8197F(x) | BIT_DTIM_COUNT_VAP4_8197F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP5_8197F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP5_8197F 0 -+#define BIT_MASK_DTIM_COUNT_VAP5_8197F 0xff -+#define BIT_DTIM_COUNT_VAP5_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP5_8197F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP5_8197F) -+#define BITS_DTIM_COUNT_VAP5_8197F \ -+ (BIT_MASK_DTIM_COUNT_VAP5_8197F << BIT_SHIFT_DTIM_COUNT_VAP5_8197F) -+#define BIT_CLEAR_DTIM_COUNT_VAP5_8197F(x) ((x) & (~BITS_DTIM_COUNT_VAP5_8197F)) -+#define BIT_GET_DTIM_COUNT_VAP5_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP5_8197F) & \ -+ BIT_MASK_DTIM_COUNT_VAP5_8197F) -+#define BIT_SET_DTIM_COUNT_VAP5_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP5_8197F(x) | BIT_DTIM_COUNT_VAP5_8197F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP6_8197F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP6_8197F 0 -+#define BIT_MASK_DTIM_COUNT_VAP6_8197F 0xff -+#define BIT_DTIM_COUNT_VAP6_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP6_8197F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP6_8197F) -+#define BITS_DTIM_COUNT_VAP6_8197F \ -+ (BIT_MASK_DTIM_COUNT_VAP6_8197F << BIT_SHIFT_DTIM_COUNT_VAP6_8197F) -+#define BIT_CLEAR_DTIM_COUNT_VAP6_8197F(x) ((x) & (~BITS_DTIM_COUNT_VAP6_8197F)) -+#define BIT_GET_DTIM_COUNT_VAP6_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP6_8197F) & \ -+ BIT_MASK_DTIM_COUNT_VAP6_8197F) -+#define BIT_SET_DTIM_COUNT_VAP6_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP6_8197F(x) | BIT_DTIM_COUNT_VAP6_8197F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP7_8197F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP7_8197F 0 -+#define BIT_MASK_DTIM_COUNT_VAP7_8197F 0xff -+#define BIT_DTIM_COUNT_VAP7_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP7_8197F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP7_8197F) -+#define BITS_DTIM_COUNT_VAP7_8197F \ -+ (BIT_MASK_DTIM_COUNT_VAP7_8197F << BIT_SHIFT_DTIM_COUNT_VAP7_8197F) -+#define BIT_CLEAR_DTIM_COUNT_VAP7_8197F(x) ((x) & (~BITS_DTIM_COUNT_VAP7_8197F)) -+#define BIT_GET_DTIM_COUNT_VAP7_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP7_8197F) & \ -+ BIT_MASK_DTIM_COUNT_VAP7_8197F) -+#define BIT_SET_DTIM_COUNT_VAP7_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP7_8197F(x) | BIT_DTIM_COUNT_VAP7_8197F(v)) -+ -+/* 2 REG_DIS_ATIM_8197F */ -+#define BIT_DIS_ATIM_VAP7_8197F BIT(7) -+#define BIT_DIS_ATIM_VAP6_8197F BIT(6) -+#define BIT_DIS_ATIM_VAP5_8197F BIT(5) -+#define BIT_DIS_ATIM_VAP4_8197F BIT(4) -+#define BIT_DIS_ATIM_VAP3_8197F BIT(3) -+#define BIT_DIS_ATIM_VAP2_8197F BIT(2) -+#define BIT_DIS_ATIM_VAP1_8197F BIT(1) -+#define BIT_DIS_ATIM_ROOT_8197F BIT(0) -+ -+/* 2 REG_EARLY_128US_8197F */ -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER1_8197F 3 -+#define BIT_MASK_TSFT_SEL_TIMER1_8197F 0x7 -+#define BIT_TSFT_SEL_TIMER1_8197F(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER1_8197F) \ -+ << BIT_SHIFT_TSFT_SEL_TIMER1_8197F) -+#define BITS_TSFT_SEL_TIMER1_8197F \ -+ (BIT_MASK_TSFT_SEL_TIMER1_8197F << BIT_SHIFT_TSFT_SEL_TIMER1_8197F) -+#define BIT_CLEAR_TSFT_SEL_TIMER1_8197F(x) ((x) & (~BITS_TSFT_SEL_TIMER1_8197F)) -+#define BIT_GET_TSFT_SEL_TIMER1_8197F(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER1_8197F) & \ -+ BIT_MASK_TSFT_SEL_TIMER1_8197F) -+#define BIT_SET_TSFT_SEL_TIMER1_8197F(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER1_8197F(x) | BIT_TSFT_SEL_TIMER1_8197F(v)) -+ -+#define BIT_SHIFT_EARLY_128US_8197F 0 -+#define BIT_MASK_EARLY_128US_8197F 0x7 -+#define BIT_EARLY_128US_8197F(x) \ -+ (((x) & BIT_MASK_EARLY_128US_8197F) << BIT_SHIFT_EARLY_128US_8197F) -+#define BITS_EARLY_128US_8197F \ -+ (BIT_MASK_EARLY_128US_8197F << BIT_SHIFT_EARLY_128US_8197F) -+#define BIT_CLEAR_EARLY_128US_8197F(x) ((x) & (~BITS_EARLY_128US_8197F)) -+#define BIT_GET_EARLY_128US_8197F(x) \ -+ (((x) >> BIT_SHIFT_EARLY_128US_8197F) & BIT_MASK_EARLY_128US_8197F) -+#define BIT_SET_EARLY_128US_8197F(x, v) \ -+ (BIT_CLEAR_EARLY_128US_8197F(x) | BIT_EARLY_128US_8197F(v)) -+ -+/* 2 REG_P2PPS1_CTRL_8197F */ -+#define BIT_P2P1_CTW_ALLSTASLEEP_8197F BIT(7) -+#define BIT_P2P1_OFF_DISTX_EN_8197F BIT(6) -+#define BIT_P2P1_PWR_MGT_EN_8197F BIT(5) -+#define BIT_P2P1_NOA1_EN_8197F BIT(2) -+#define BIT_P2P1_NOA0_EN_8197F BIT(1) -+ -+/* 2 REG_P2PPS2_CTRL_8197F */ -+#define BIT_P2P2_CTW_ALLSTASLEEP_8197F BIT(7) -+#define BIT_P2P2_OFF_DISTX_EN_8197F BIT(6) -+#define BIT_P2P2_PWR_MGT_EN_8197F BIT(5) -+#define BIT_P2P2_NOA1_EN_8197F BIT(2) -+#define BIT_P2P2_NOA0_EN_8197F BIT(1) -+ -+/* 2 REG_TIMER0_SRC_SEL_8197F */ -+ -+#define BIT_SHIFT_SYNC_CLI_SEL_8197F 4 -+#define BIT_MASK_SYNC_CLI_SEL_8197F 0x7 -+#define BIT_SYNC_CLI_SEL_8197F(x) \ -+ (((x) & BIT_MASK_SYNC_CLI_SEL_8197F) << BIT_SHIFT_SYNC_CLI_SEL_8197F) -+#define BITS_SYNC_CLI_SEL_8197F \ -+ (BIT_MASK_SYNC_CLI_SEL_8197F << BIT_SHIFT_SYNC_CLI_SEL_8197F) -+#define BIT_CLEAR_SYNC_CLI_SEL_8197F(x) ((x) & (~BITS_SYNC_CLI_SEL_8197F)) -+#define BIT_GET_SYNC_CLI_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_SYNC_CLI_SEL_8197F) & BIT_MASK_SYNC_CLI_SEL_8197F) -+#define BIT_SET_SYNC_CLI_SEL_8197F(x, v) \ -+ (BIT_CLEAR_SYNC_CLI_SEL_8197F(x) | BIT_SYNC_CLI_SEL_8197F(v)) -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER0_8197F 0 -+#define BIT_MASK_TSFT_SEL_TIMER0_8197F 0x7 -+#define BIT_TSFT_SEL_TIMER0_8197F(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER0_8197F) \ -+ << BIT_SHIFT_TSFT_SEL_TIMER0_8197F) -+#define BITS_TSFT_SEL_TIMER0_8197F \ -+ (BIT_MASK_TSFT_SEL_TIMER0_8197F << BIT_SHIFT_TSFT_SEL_TIMER0_8197F) -+#define BIT_CLEAR_TSFT_SEL_TIMER0_8197F(x) ((x) & (~BITS_TSFT_SEL_TIMER0_8197F)) -+#define BIT_GET_TSFT_SEL_TIMER0_8197F(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER0_8197F) & \ -+ BIT_MASK_TSFT_SEL_TIMER0_8197F) -+#define BIT_SET_TSFT_SEL_TIMER0_8197F(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER0_8197F(x) | BIT_TSFT_SEL_TIMER0_8197F(v)) -+ -+/* 2 REG_NOA_UNIT_SEL_8197F */ -+ -+#define BIT_SHIFT_NOA_UNIT2_SEL_8197F 8 -+#define BIT_MASK_NOA_UNIT2_SEL_8197F 0x7 -+#define BIT_NOA_UNIT2_SEL_8197F(x) \ -+ (((x) & BIT_MASK_NOA_UNIT2_SEL_8197F) << BIT_SHIFT_NOA_UNIT2_SEL_8197F) -+#define BITS_NOA_UNIT2_SEL_8197F \ -+ (BIT_MASK_NOA_UNIT2_SEL_8197F << BIT_SHIFT_NOA_UNIT2_SEL_8197F) -+#define BIT_CLEAR_NOA_UNIT2_SEL_8197F(x) ((x) & (~BITS_NOA_UNIT2_SEL_8197F)) -+#define BIT_GET_NOA_UNIT2_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT2_SEL_8197F) & BIT_MASK_NOA_UNIT2_SEL_8197F) -+#define BIT_SET_NOA_UNIT2_SEL_8197F(x, v) \ -+ (BIT_CLEAR_NOA_UNIT2_SEL_8197F(x) | BIT_NOA_UNIT2_SEL_8197F(v)) -+ -+#define BIT_SHIFT_NOA_UNIT1_SEL_8197F 4 -+#define BIT_MASK_NOA_UNIT1_SEL_8197F 0x7 -+#define BIT_NOA_UNIT1_SEL_8197F(x) \ -+ (((x) & BIT_MASK_NOA_UNIT1_SEL_8197F) << BIT_SHIFT_NOA_UNIT1_SEL_8197F) -+#define BITS_NOA_UNIT1_SEL_8197F \ -+ (BIT_MASK_NOA_UNIT1_SEL_8197F << BIT_SHIFT_NOA_UNIT1_SEL_8197F) -+#define BIT_CLEAR_NOA_UNIT1_SEL_8197F(x) ((x) & (~BITS_NOA_UNIT1_SEL_8197F)) -+#define BIT_GET_NOA_UNIT1_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT1_SEL_8197F) & BIT_MASK_NOA_UNIT1_SEL_8197F) -+#define BIT_SET_NOA_UNIT1_SEL_8197F(x, v) \ -+ (BIT_CLEAR_NOA_UNIT1_SEL_8197F(x) | BIT_NOA_UNIT1_SEL_8197F(v)) -+ -+#define BIT_SHIFT_NOA_UNIT0_SEL_8197F 0 -+#define BIT_MASK_NOA_UNIT0_SEL_8197F 0x7 -+#define BIT_NOA_UNIT0_SEL_8197F(x) \ -+ (((x) & BIT_MASK_NOA_UNIT0_SEL_8197F) << BIT_SHIFT_NOA_UNIT0_SEL_8197F) -+#define BITS_NOA_UNIT0_SEL_8197F \ -+ (BIT_MASK_NOA_UNIT0_SEL_8197F << BIT_SHIFT_NOA_UNIT0_SEL_8197F) -+#define BIT_CLEAR_NOA_UNIT0_SEL_8197F(x) ((x) & (~BITS_NOA_UNIT0_SEL_8197F)) -+#define BIT_GET_NOA_UNIT0_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT0_SEL_8197F) & BIT_MASK_NOA_UNIT0_SEL_8197F) -+#define BIT_SET_NOA_UNIT0_SEL_8197F(x, v) \ -+ (BIT_CLEAR_NOA_UNIT0_SEL_8197F(x) | BIT_NOA_UNIT0_SEL_8197F(v)) -+ -+/* 2 REG_P2POFF_DIS_TXTIME_8197F */ -+ -+#define BIT_SHIFT_P2POFF_DIS_TXTIME_8197F 0 -+#define BIT_MASK_P2POFF_DIS_TXTIME_8197F 0xff -+#define BIT_P2POFF_DIS_TXTIME_8197F(x) \ -+ (((x) & BIT_MASK_P2POFF_DIS_TXTIME_8197F) \ -+ << BIT_SHIFT_P2POFF_DIS_TXTIME_8197F) -+#define BITS_P2POFF_DIS_TXTIME_8197F \ -+ (BIT_MASK_P2POFF_DIS_TXTIME_8197F << BIT_SHIFT_P2POFF_DIS_TXTIME_8197F) -+#define BIT_CLEAR_P2POFF_DIS_TXTIME_8197F(x) \ -+ ((x) & (~BITS_P2POFF_DIS_TXTIME_8197F)) -+#define BIT_GET_P2POFF_DIS_TXTIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_P2POFF_DIS_TXTIME_8197F) & \ -+ BIT_MASK_P2POFF_DIS_TXTIME_8197F) -+#define BIT_SET_P2POFF_DIS_TXTIME_8197F(x, v) \ -+ (BIT_CLEAR_P2POFF_DIS_TXTIME_8197F(x) | BIT_P2POFF_DIS_TXTIME_8197F(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE2_8197F */ -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT2_8197F 16 -+#define BIT_MASK_BCN_SPACE_CLINT2_8197F 0xfff -+#define BIT_BCN_SPACE_CLINT2_8197F(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT2_8197F) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT2_8197F) -+#define BITS_BCN_SPACE_CLINT2_8197F \ -+ (BIT_MASK_BCN_SPACE_CLINT2_8197F << BIT_SHIFT_BCN_SPACE_CLINT2_8197F) -+#define BIT_CLEAR_BCN_SPACE_CLINT2_8197F(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT2_8197F)) -+#define BIT_GET_BCN_SPACE_CLINT2_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT2_8197F) & \ -+ BIT_MASK_BCN_SPACE_CLINT2_8197F) -+#define BIT_SET_BCN_SPACE_CLINT2_8197F(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT2_8197F(x) | BIT_BCN_SPACE_CLINT2_8197F(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT1_8197F 0 -+#define BIT_MASK_BCN_SPACE_CLINT1_8197F 0xfff -+#define BIT_BCN_SPACE_CLINT1_8197F(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT1_8197F) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT1_8197F) -+#define BITS_BCN_SPACE_CLINT1_8197F \ -+ (BIT_MASK_BCN_SPACE_CLINT1_8197F << BIT_SHIFT_BCN_SPACE_CLINT1_8197F) -+#define BIT_CLEAR_BCN_SPACE_CLINT1_8197F(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT1_8197F)) -+#define BIT_GET_BCN_SPACE_CLINT1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT1_8197F) & \ -+ BIT_MASK_BCN_SPACE_CLINT1_8197F) -+#define BIT_SET_BCN_SPACE_CLINT1_8197F(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT1_8197F(x) | BIT_BCN_SPACE_CLINT1_8197F(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE3_8197F */ -+ -+#define BIT_SHIFT_SUB_BCN_SPACE_8197F 16 -+#define BIT_MASK_SUB_BCN_SPACE_8197F 0xff -+#define BIT_SUB_BCN_SPACE_8197F(x) \ -+ (((x) & BIT_MASK_SUB_BCN_SPACE_8197F) << BIT_SHIFT_SUB_BCN_SPACE_8197F) -+#define BITS_SUB_BCN_SPACE_8197F \ -+ (BIT_MASK_SUB_BCN_SPACE_8197F << BIT_SHIFT_SUB_BCN_SPACE_8197F) -+#define BIT_CLEAR_SUB_BCN_SPACE_8197F(x) ((x) & (~BITS_SUB_BCN_SPACE_8197F)) -+#define BIT_GET_SUB_BCN_SPACE_8197F(x) \ -+ (((x) >> BIT_SHIFT_SUB_BCN_SPACE_8197F) & BIT_MASK_SUB_BCN_SPACE_8197F) -+#define BIT_SET_SUB_BCN_SPACE_8197F(x, v) \ -+ (BIT_CLEAR_SUB_BCN_SPACE_8197F(x) | BIT_SUB_BCN_SPACE_8197F(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT3_8197F 0 -+#define BIT_MASK_BCN_SPACE_CLINT3_8197F 0xfff -+#define BIT_BCN_SPACE_CLINT3_8197F(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT3_8197F) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT3_8197F) -+#define BITS_BCN_SPACE_CLINT3_8197F \ -+ (BIT_MASK_BCN_SPACE_CLINT3_8197F << BIT_SHIFT_BCN_SPACE_CLINT3_8197F) -+#define BIT_CLEAR_BCN_SPACE_CLINT3_8197F(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT3_8197F)) -+#define BIT_GET_BCN_SPACE_CLINT3_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT3_8197F) & \ -+ BIT_MASK_BCN_SPACE_CLINT3_8197F) -+#define BIT_SET_BCN_SPACE_CLINT3_8197F(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT3_8197F(x) | BIT_BCN_SPACE_CLINT3_8197F(v)) -+ -+/* 2 REG_ACMHWCTRL_8197F */ -+#define BIT_BEQ_ACM_STATUS_8197F BIT(7) -+#define BIT_VIQ_ACM_STATUS_8197F BIT(6) -+#define BIT_VOQ_ACM_STATUS_8197F BIT(5) -+#define BIT_BEQ_ACM_EN_8197F BIT(3) -+#define BIT_VIQ_ACM_EN_8197F BIT(2) -+#define BIT_VOQ_ACM_EN_8197F BIT(1) -+#define BIT_ACMHWEN_8197F BIT(0) -+ -+/* 2 REG_ACMRSTCTRL_8197F */ -+#define BIT_BE_ACM_RESET_USED_TIME_8197F BIT(2) -+#define BIT_VI_ACM_RESET_USED_TIME_8197F BIT(1) -+#define BIT_VO_ACM_RESET_USED_TIME_8197F BIT(0) -+ -+/* 2 REG_ACMAVG_8197F */ -+ -+#define BIT_SHIFT_AVGPERIOD_8197F 0 -+#define BIT_MASK_AVGPERIOD_8197F 0xffff -+#define BIT_AVGPERIOD_8197F(x) \ -+ (((x) & BIT_MASK_AVGPERIOD_8197F) << BIT_SHIFT_AVGPERIOD_8197F) -+#define BITS_AVGPERIOD_8197F \ -+ (BIT_MASK_AVGPERIOD_8197F << BIT_SHIFT_AVGPERIOD_8197F) -+#define BIT_CLEAR_AVGPERIOD_8197F(x) ((x) & (~BITS_AVGPERIOD_8197F)) -+#define BIT_GET_AVGPERIOD_8197F(x) \ -+ (((x) >> BIT_SHIFT_AVGPERIOD_8197F) & BIT_MASK_AVGPERIOD_8197F) -+#define BIT_SET_AVGPERIOD_8197F(x, v) \ -+ (BIT_CLEAR_AVGPERIOD_8197F(x) | BIT_AVGPERIOD_8197F(v)) -+ -+/* 2 REG_VO_ADMTIME_8197F */ -+ -+#define BIT_SHIFT_VO_ADMITTED_TIME_8197F 0 -+#define BIT_MASK_VO_ADMITTED_TIME_8197F 0xffff -+#define BIT_VO_ADMITTED_TIME_8197F(x) \ -+ (((x) & BIT_MASK_VO_ADMITTED_TIME_8197F) \ -+ << BIT_SHIFT_VO_ADMITTED_TIME_8197F) -+#define BITS_VO_ADMITTED_TIME_8197F \ -+ (BIT_MASK_VO_ADMITTED_TIME_8197F << BIT_SHIFT_VO_ADMITTED_TIME_8197F) -+#define BIT_CLEAR_VO_ADMITTED_TIME_8197F(x) \ -+ ((x) & (~BITS_VO_ADMITTED_TIME_8197F)) -+#define BIT_GET_VO_ADMITTED_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_VO_ADMITTED_TIME_8197F) & \ -+ BIT_MASK_VO_ADMITTED_TIME_8197F) -+#define BIT_SET_VO_ADMITTED_TIME_8197F(x, v) \ -+ (BIT_CLEAR_VO_ADMITTED_TIME_8197F(x) | BIT_VO_ADMITTED_TIME_8197F(v)) -+ -+/* 2 REG_VI_ADMTIME_8197F */ -+ -+#define BIT_SHIFT_VI_ADMITTED_TIME_8197F 0 -+#define BIT_MASK_VI_ADMITTED_TIME_8197F 0xffff -+#define BIT_VI_ADMITTED_TIME_8197F(x) \ -+ (((x) & BIT_MASK_VI_ADMITTED_TIME_8197F) \ -+ << BIT_SHIFT_VI_ADMITTED_TIME_8197F) -+#define BITS_VI_ADMITTED_TIME_8197F \ -+ (BIT_MASK_VI_ADMITTED_TIME_8197F << BIT_SHIFT_VI_ADMITTED_TIME_8197F) -+#define BIT_CLEAR_VI_ADMITTED_TIME_8197F(x) \ -+ ((x) & (~BITS_VI_ADMITTED_TIME_8197F)) -+#define BIT_GET_VI_ADMITTED_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_VI_ADMITTED_TIME_8197F) & \ -+ BIT_MASK_VI_ADMITTED_TIME_8197F) -+#define BIT_SET_VI_ADMITTED_TIME_8197F(x, v) \ -+ (BIT_CLEAR_VI_ADMITTED_TIME_8197F(x) | BIT_VI_ADMITTED_TIME_8197F(v)) -+ -+/* 2 REG_BE_ADMTIME_8197F */ -+ -+#define BIT_SHIFT_BE_ADMITTED_TIME_8197F 0 -+#define BIT_MASK_BE_ADMITTED_TIME_8197F 0xffff -+#define BIT_BE_ADMITTED_TIME_8197F(x) \ -+ (((x) & BIT_MASK_BE_ADMITTED_TIME_8197F) \ -+ << BIT_SHIFT_BE_ADMITTED_TIME_8197F) -+#define BITS_BE_ADMITTED_TIME_8197F \ -+ (BIT_MASK_BE_ADMITTED_TIME_8197F << BIT_SHIFT_BE_ADMITTED_TIME_8197F) -+#define BIT_CLEAR_BE_ADMITTED_TIME_8197F(x) \ -+ ((x) & (~BITS_BE_ADMITTED_TIME_8197F)) -+#define BIT_GET_BE_ADMITTED_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_BE_ADMITTED_TIME_8197F) & \ -+ BIT_MASK_BE_ADMITTED_TIME_8197F) -+#define BIT_SET_BE_ADMITTED_TIME_8197F(x, v) \ -+ (BIT_CLEAR_BE_ADMITTED_TIME_8197F(x) | BIT_BE_ADMITTED_TIME_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_CHANGE_POW_BCN_AREA_8197F BIT(9) -+ -+/* 2 REG_EDCA_RANDOM_GEN_8197F */ -+ -+#define BIT_SHIFT_RANDOM_GEN_8197F 0 -+#define BIT_MASK_RANDOM_GEN_8197F 0xffffff -+#define BIT_RANDOM_GEN_8197F(x) \ -+ (((x) & BIT_MASK_RANDOM_GEN_8197F) << BIT_SHIFT_RANDOM_GEN_8197F) -+#define BITS_RANDOM_GEN_8197F \ -+ (BIT_MASK_RANDOM_GEN_8197F << BIT_SHIFT_RANDOM_GEN_8197F) -+#define BIT_CLEAR_RANDOM_GEN_8197F(x) ((x) & (~BITS_RANDOM_GEN_8197F)) -+#define BIT_GET_RANDOM_GEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_RANDOM_GEN_8197F) & BIT_MASK_RANDOM_GEN_8197F) -+#define BIT_SET_RANDOM_GEN_8197F(x, v) \ -+ (BIT_CLEAR_RANDOM_GEN_8197F(x) | BIT_RANDOM_GEN_8197F(v)) -+ -+/* 2 REG_TXCMD_NOA_SEL_8197F */ -+ -+#define BIT_SHIFT_NOA_SEL_V2_8197F 4 -+#define BIT_MASK_NOA_SEL_V2_8197F 0x7 -+#define BIT_NOA_SEL_V2_8197F(x) \ -+ (((x) & BIT_MASK_NOA_SEL_V2_8197F) << BIT_SHIFT_NOA_SEL_V2_8197F) -+#define BITS_NOA_SEL_V2_8197F \ -+ (BIT_MASK_NOA_SEL_V2_8197F << BIT_SHIFT_NOA_SEL_V2_8197F) -+#define BIT_CLEAR_NOA_SEL_V2_8197F(x) ((x) & (~BITS_NOA_SEL_V2_8197F)) -+#define BIT_GET_NOA_SEL_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_NOA_SEL_V2_8197F) & BIT_MASK_NOA_SEL_V2_8197F) -+#define BIT_SET_NOA_SEL_V2_8197F(x, v) \ -+ (BIT_CLEAR_NOA_SEL_V2_8197F(x) | BIT_NOA_SEL_V2_8197F(v)) -+ -+#define BIT_SHIFT_TXCMD_SEG_SEL_8197F 0 -+#define BIT_MASK_TXCMD_SEG_SEL_8197F 0xf -+#define BIT_TXCMD_SEG_SEL_8197F(x) \ -+ (((x) & BIT_MASK_TXCMD_SEG_SEL_8197F) << BIT_SHIFT_TXCMD_SEG_SEL_8197F) -+#define BITS_TXCMD_SEG_SEL_8197F \ -+ (BIT_MASK_TXCMD_SEG_SEL_8197F << BIT_SHIFT_TXCMD_SEG_SEL_8197F) -+#define BIT_CLEAR_TXCMD_SEG_SEL_8197F(x) ((x) & (~BITS_TXCMD_SEG_SEL_8197F)) -+#define BIT_GET_TXCMD_SEG_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_SEG_SEL_8197F) & BIT_MASK_TXCMD_SEG_SEL_8197F) -+#define BIT_SET_TXCMD_SEG_SEL_8197F(x, v) \ -+ (BIT_CLEAR_TXCMD_SEG_SEL_8197F(x) | BIT_TXCMD_SEG_SEL_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_BCNERR_CNT_EN_8197F BIT(20) -+ -+#define BIT_SHIFT_BCNERR_PORT_SEL_8197F 16 -+#define BIT_MASK_BCNERR_PORT_SEL_8197F 0x7 -+#define BIT_BCNERR_PORT_SEL_8197F(x) \ -+ (((x) & BIT_MASK_BCNERR_PORT_SEL_8197F) \ -+ << BIT_SHIFT_BCNERR_PORT_SEL_8197F) -+#define BITS_BCNERR_PORT_SEL_8197F \ -+ (BIT_MASK_BCNERR_PORT_SEL_8197F << BIT_SHIFT_BCNERR_PORT_SEL_8197F) -+#define BIT_CLEAR_BCNERR_PORT_SEL_8197F(x) ((x) & (~BITS_BCNERR_PORT_SEL_8197F)) -+#define BIT_GET_BCNERR_PORT_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_PORT_SEL_8197F) & \ -+ BIT_MASK_BCNERR_PORT_SEL_8197F) -+#define BIT_SET_BCNERR_PORT_SEL_8197F(x, v) \ -+ (BIT_CLEAR_BCNERR_PORT_SEL_8197F(x) | BIT_BCNERR_PORT_SEL_8197F(v)) -+ -+#define BIT_SHIFT_TXPAUSE1_8197F 8 -+#define BIT_MASK_TXPAUSE1_8197F 0xff -+#define BIT_TXPAUSE1_8197F(x) \ -+ (((x) & BIT_MASK_TXPAUSE1_8197F) << BIT_SHIFT_TXPAUSE1_8197F) -+#define BITS_TXPAUSE1_8197F \ -+ (BIT_MASK_TXPAUSE1_8197F << BIT_SHIFT_TXPAUSE1_8197F) -+#define BIT_CLEAR_TXPAUSE1_8197F(x) ((x) & (~BITS_TXPAUSE1_8197F)) -+#define BIT_GET_TXPAUSE1_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXPAUSE1_8197F) & BIT_MASK_TXPAUSE1_8197F) -+#define BIT_SET_TXPAUSE1_8197F(x, v) \ -+ (BIT_CLEAR_TXPAUSE1_8197F(x) | BIT_TXPAUSE1_8197F(v)) -+ -+#define BIT_SHIFT_BW_CFG_8197F 0 -+#define BIT_MASK_BW_CFG_8197F 0x3 -+#define BIT_BW_CFG_8197F(x) \ -+ (((x) & BIT_MASK_BW_CFG_8197F) << BIT_SHIFT_BW_CFG_8197F) -+#define BITS_BW_CFG_8197F (BIT_MASK_BW_CFG_8197F << BIT_SHIFT_BW_CFG_8197F) -+#define BIT_CLEAR_BW_CFG_8197F(x) ((x) & (~BITS_BW_CFG_8197F)) -+#define BIT_GET_BW_CFG_8197F(x) \ -+ (((x) >> BIT_SHIFT_BW_CFG_8197F) & BIT_MASK_BW_CFG_8197F) -+#define BIT_SET_BW_CFG_8197F(x, v) \ -+ (BIT_CLEAR_BW_CFG_8197F(x) | BIT_BW_CFG_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_RXBCN_TIMER_8197F 16 -+#define BIT_MASK_RXBCN_TIMER_8197F 0xffff -+#define BIT_RXBCN_TIMER_8197F(x) \ -+ (((x) & BIT_MASK_RXBCN_TIMER_8197F) << BIT_SHIFT_RXBCN_TIMER_8197F) -+#define BITS_RXBCN_TIMER_8197F \ -+ (BIT_MASK_RXBCN_TIMER_8197F << BIT_SHIFT_RXBCN_TIMER_8197F) -+#define BIT_CLEAR_RXBCN_TIMER_8197F(x) ((x) & (~BITS_RXBCN_TIMER_8197F)) -+#define BIT_GET_RXBCN_TIMER_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXBCN_TIMER_8197F) & BIT_MASK_RXBCN_TIMER_8197F) -+#define BIT_SET_RXBCN_TIMER_8197F(x, v) \ -+ (BIT_CLEAR_RXBCN_TIMER_8197F(x) | BIT_RXBCN_TIMER_8197F(v)) -+ -+#define BIT_SHIFT_BCN_ELY_ADJ_8197F 0 -+#define BIT_MASK_BCN_ELY_ADJ_8197F 0xffff -+#define BIT_BCN_ELY_ADJ_8197F(x) \ -+ (((x) & BIT_MASK_BCN_ELY_ADJ_8197F) << BIT_SHIFT_BCN_ELY_ADJ_8197F) -+#define BITS_BCN_ELY_ADJ_8197F \ -+ (BIT_MASK_BCN_ELY_ADJ_8197F << BIT_SHIFT_BCN_ELY_ADJ_8197F) -+#define BIT_CLEAR_BCN_ELY_ADJ_8197F(x) ((x) & (~BITS_BCN_ELY_ADJ_8197F)) -+#define BIT_GET_BCN_ELY_ADJ_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCN_ELY_ADJ_8197F) & BIT_MASK_BCN_ELY_ADJ_8197F) -+#define BIT_SET_BCN_ELY_ADJ_8197F(x, v) \ -+ (BIT_CLEAR_BCN_ELY_ADJ_8197F(x) | BIT_BCN_ELY_ADJ_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_BCNERR_CNT_OTHERS_8197F 24 -+#define BIT_MASK_BCNERR_CNT_OTHERS_8197F 0xff -+#define BIT_BCNERR_CNT_OTHERS_8197F(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_OTHERS_8197F) \ -+ << BIT_SHIFT_BCNERR_CNT_OTHERS_8197F) -+#define BITS_BCNERR_CNT_OTHERS_8197F \ -+ (BIT_MASK_BCNERR_CNT_OTHERS_8197F << BIT_SHIFT_BCNERR_CNT_OTHERS_8197F) -+#define BIT_CLEAR_BCNERR_CNT_OTHERS_8197F(x) \ -+ ((x) & (~BITS_BCNERR_CNT_OTHERS_8197F)) -+#define BIT_GET_BCNERR_CNT_OTHERS_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_OTHERS_8197F) & \ -+ BIT_MASK_BCNERR_CNT_OTHERS_8197F) -+#define BIT_SET_BCNERR_CNT_OTHERS_8197F(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_OTHERS_8197F(x) | BIT_BCNERR_CNT_OTHERS_8197F(v)) -+ -+#define BIT_SHIFT_BCNERR_CNT_INVALID_8197F 16 -+#define BIT_MASK_BCNERR_CNT_INVALID_8197F 0xff -+#define BIT_BCNERR_CNT_INVALID_8197F(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_INVALID_8197F) \ -+ << BIT_SHIFT_BCNERR_CNT_INVALID_8197F) -+#define BITS_BCNERR_CNT_INVALID_8197F \ -+ (BIT_MASK_BCNERR_CNT_INVALID_8197F \ -+ << BIT_SHIFT_BCNERR_CNT_INVALID_8197F) -+#define BIT_CLEAR_BCNERR_CNT_INVALID_8197F(x) \ -+ ((x) & (~BITS_BCNERR_CNT_INVALID_8197F)) -+#define BIT_GET_BCNERR_CNT_INVALID_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_INVALID_8197F) & \ -+ BIT_MASK_BCNERR_CNT_INVALID_8197F) -+#define BIT_SET_BCNERR_CNT_INVALID_8197F(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_INVALID_8197F(x) | \ -+ BIT_BCNERR_CNT_INVALID_8197F(v)) -+ -+#define BIT_SHIFT_BCNERR_CNT_MAC_8197F 8 -+#define BIT_MASK_BCNERR_CNT_MAC_8197F 0xff -+#define BIT_BCNERR_CNT_MAC_8197F(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_MAC_8197F) \ -+ << BIT_SHIFT_BCNERR_CNT_MAC_8197F) -+#define BITS_BCNERR_CNT_MAC_8197F \ -+ (BIT_MASK_BCNERR_CNT_MAC_8197F << BIT_SHIFT_BCNERR_CNT_MAC_8197F) -+#define BIT_CLEAR_BCNERR_CNT_MAC_8197F(x) ((x) & (~BITS_BCNERR_CNT_MAC_8197F)) -+#define BIT_GET_BCNERR_CNT_MAC_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_MAC_8197F) & \ -+ BIT_MASK_BCNERR_CNT_MAC_8197F) -+#define BIT_SET_BCNERR_CNT_MAC_8197F(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_MAC_8197F(x) | BIT_BCNERR_CNT_MAC_8197F(v)) -+ -+#define BIT_SHIFT_BCNERR_CNT_CCA_8197F 0 -+#define BIT_MASK_BCNERR_CNT_CCA_8197F 0xff -+#define BIT_BCNERR_CNT_CCA_8197F(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_CCA_8197F) \ -+ << BIT_SHIFT_BCNERR_CNT_CCA_8197F) -+#define BITS_BCNERR_CNT_CCA_8197F \ -+ (BIT_MASK_BCNERR_CNT_CCA_8197F << BIT_SHIFT_BCNERR_CNT_CCA_8197F) -+#define BIT_CLEAR_BCNERR_CNT_CCA_8197F(x) ((x) & (~BITS_BCNERR_CNT_CCA_8197F)) -+#define BIT_GET_BCNERR_CNT_CCA_8197F(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_CCA_8197F) & \ -+ BIT_MASK_BCNERR_CNT_CCA_8197F) -+#define BIT_SET_BCNERR_CNT_CCA_8197F(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_CCA_8197F(x) | BIT_BCNERR_CNT_CCA_8197F(v)) -+ -+/* 2 REG_NOA_PARAM_8197F */ -+ -+#define BIT_SHIFT_NOA_COUNT_8197F (96 & CPU_OPT_WIDTH) -+#define BIT_MASK_NOA_COUNT_8197F 0xff -+#define BIT_NOA_COUNT_8197F(x) \ -+ (((x) & BIT_MASK_NOA_COUNT_8197F) << BIT_SHIFT_NOA_COUNT_8197F) -+#define BITS_NOA_COUNT_8197F \ -+ (BIT_MASK_NOA_COUNT_8197F << BIT_SHIFT_NOA_COUNT_8197F) -+#define BIT_CLEAR_NOA_COUNT_8197F(x) ((x) & (~BITS_NOA_COUNT_8197F)) -+#define BIT_GET_NOA_COUNT_8197F(x) \ -+ (((x) >> BIT_SHIFT_NOA_COUNT_8197F) & BIT_MASK_NOA_COUNT_8197F) -+#define BIT_SET_NOA_COUNT_8197F(x, v) \ -+ (BIT_CLEAR_NOA_COUNT_8197F(x) | BIT_NOA_COUNT_8197F(v)) -+ -+#define BIT_SHIFT_NOA_START_TIME_8197F (64 & CPU_OPT_WIDTH) -+#define BIT_MASK_NOA_START_TIME_8197F 0xffffffffL -+#define BIT_NOA_START_TIME_8197F(x) \ -+ (((x) & BIT_MASK_NOA_START_TIME_8197F) \ -+ << BIT_SHIFT_NOA_START_TIME_8197F) -+#define BITS_NOA_START_TIME_8197F \ -+ (BIT_MASK_NOA_START_TIME_8197F << BIT_SHIFT_NOA_START_TIME_8197F) -+#define BIT_CLEAR_NOA_START_TIME_8197F(x) ((x) & (~BITS_NOA_START_TIME_8197F)) -+#define BIT_GET_NOA_START_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_NOA_START_TIME_8197F) & \ -+ BIT_MASK_NOA_START_TIME_8197F) -+#define BIT_SET_NOA_START_TIME_8197F(x, v) \ -+ (BIT_CLEAR_NOA_START_TIME_8197F(x) | BIT_NOA_START_TIME_8197F(v)) -+ -+#define BIT_SHIFT_NOA_INTERVAL_8197F (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_NOA_INTERVAL_8197F 0xffffffffL -+#define BIT_NOA_INTERVAL_8197F(x) \ -+ (((x) & BIT_MASK_NOA_INTERVAL_8197F) << BIT_SHIFT_NOA_INTERVAL_8197F) -+#define BITS_NOA_INTERVAL_8197F \ -+ (BIT_MASK_NOA_INTERVAL_8197F << BIT_SHIFT_NOA_INTERVAL_8197F) -+#define BIT_CLEAR_NOA_INTERVAL_8197F(x) ((x) & (~BITS_NOA_INTERVAL_8197F)) -+#define BIT_GET_NOA_INTERVAL_8197F(x) \ -+ (((x) >> BIT_SHIFT_NOA_INTERVAL_8197F) & BIT_MASK_NOA_INTERVAL_8197F) -+#define BIT_SET_NOA_INTERVAL_8197F(x, v) \ -+ (BIT_CLEAR_NOA_INTERVAL_8197F(x) | BIT_NOA_INTERVAL_8197F(v)) -+ -+#define BIT_SHIFT_NOA_DURATION_8197F 0 -+#define BIT_MASK_NOA_DURATION_8197F 0xffffffffL -+#define BIT_NOA_DURATION_8197F(x) \ -+ (((x) & BIT_MASK_NOA_DURATION_8197F) << BIT_SHIFT_NOA_DURATION_8197F) -+#define BITS_NOA_DURATION_8197F \ -+ (BIT_MASK_NOA_DURATION_8197F << BIT_SHIFT_NOA_DURATION_8197F) -+#define BIT_CLEAR_NOA_DURATION_8197F(x) ((x) & (~BITS_NOA_DURATION_8197F)) -+#define BIT_GET_NOA_DURATION_8197F(x) \ -+ (((x) >> BIT_SHIFT_NOA_DURATION_8197F) & BIT_MASK_NOA_DURATION_8197F) -+#define BIT_SET_NOA_DURATION_8197F(x, v) \ -+ (BIT_CLEAR_NOA_DURATION_8197F(x) | BIT_NOA_DURATION_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_P2P_RST_8197F */ -+#define BIT_P2P2_PWR_RST1_8197F BIT(5) -+#define BIT_P2P2_PWR_RST0_8197F BIT(4) -+#define BIT_P2P1_PWR_RST1_8197F BIT(3) -+#define BIT_P2P1_PWR_RST0_8197F BIT(2) -+#define BIT_P2P_PWR_RST1_V1_8197F BIT(1) -+#define BIT_P2P_PWR_RST0_V1_8197F BIT(0) -+ -+/* 2 REG_SCHEDULER_RST_8197F */ -+#define BIT_SYNC_TSF_NOW_8197F BIT(2) -+#define BIT_SYNC_CLI_8197F BIT(1) -+#define BIT_SCHEDULER_RST_V1_8197F BIT(0) -+ -+/* 2 REG_SCH_TXCMD_8197F */ -+ -+#define BIT_SHIFT_SCH_TXCMD_8197F 0 -+#define BIT_MASK_SCH_TXCMD_8197F 0xffffffffL -+#define BIT_SCH_TXCMD_8197F(x) \ -+ (((x) & BIT_MASK_SCH_TXCMD_8197F) << BIT_SHIFT_SCH_TXCMD_8197F) -+#define BITS_SCH_TXCMD_8197F \ -+ (BIT_MASK_SCH_TXCMD_8197F << BIT_SHIFT_SCH_TXCMD_8197F) -+#define BIT_CLEAR_SCH_TXCMD_8197F(x) ((x) & (~BITS_SCH_TXCMD_8197F)) -+#define BIT_GET_SCH_TXCMD_8197F(x) \ -+ (((x) >> BIT_SHIFT_SCH_TXCMD_8197F) & BIT_MASK_SCH_TXCMD_8197F) -+#define BIT_SET_SCH_TXCMD_8197F(x, v) \ -+ (BIT_CLEAR_SCH_TXCMD_8197F(x) | BIT_SCH_TXCMD_8197F(v)) -+ -+/* 2 REG_PAGE5_DUMMY_8197F */ -+ -+/* 2 REG_CPUMGQ_TX_TIMER_8197F */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8197F 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_V1_8197F 0xffffffffL -+#define BIT_CPUMGQ_TX_TIMER_V1_8197F(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_V1_8197F) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8197F) -+#define BITS_CPUMGQ_TX_TIMER_V1_8197F \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_V1_8197F \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8197F) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8197F(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_V1_8197F)) -+#define BIT_GET_CPUMGQ_TX_TIMER_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8197F) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_V1_8197F) -+#define BIT_SET_CPUMGQ_TX_TIMER_V1_8197F(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8197F(x) | \ -+ BIT_CPUMGQ_TX_TIMER_V1_8197F(v)) -+ -+/* 2 REG_PS_TIMER_A_8197F */ -+ -+#define BIT_SHIFT_PS_TIMER_A_V1_8197F 0 -+#define BIT_MASK_PS_TIMER_A_V1_8197F 0xffffffffL -+#define BIT_PS_TIMER_A_V1_8197F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_V1_8197F) << BIT_SHIFT_PS_TIMER_A_V1_8197F) -+#define BITS_PS_TIMER_A_V1_8197F \ -+ (BIT_MASK_PS_TIMER_A_V1_8197F << BIT_SHIFT_PS_TIMER_A_V1_8197F) -+#define BIT_CLEAR_PS_TIMER_A_V1_8197F(x) ((x) & (~BITS_PS_TIMER_A_V1_8197F)) -+#define BIT_GET_PS_TIMER_A_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_V1_8197F) & BIT_MASK_PS_TIMER_A_V1_8197F) -+#define BIT_SET_PS_TIMER_A_V1_8197F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_V1_8197F(x) | BIT_PS_TIMER_A_V1_8197F(v)) -+ -+/* 2 REG_PS_TIMER_B_8197F */ -+ -+#define BIT_SHIFT_PS_TIMER_B_V1_8197F 0 -+#define BIT_MASK_PS_TIMER_B_V1_8197F 0xffffffffL -+#define BIT_PS_TIMER_B_V1_8197F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_V1_8197F) << BIT_SHIFT_PS_TIMER_B_V1_8197F) -+#define BITS_PS_TIMER_B_V1_8197F \ -+ (BIT_MASK_PS_TIMER_B_V1_8197F << BIT_SHIFT_PS_TIMER_B_V1_8197F) -+#define BIT_CLEAR_PS_TIMER_B_V1_8197F(x) ((x) & (~BITS_PS_TIMER_B_V1_8197F)) -+#define BIT_GET_PS_TIMER_B_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_V1_8197F) & BIT_MASK_PS_TIMER_B_V1_8197F) -+#define BIT_SET_PS_TIMER_B_V1_8197F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_V1_8197F(x) | BIT_PS_TIMER_B_V1_8197F(v)) -+ -+/* 2 REG_PS_TIMER_C_8197F */ -+ -+#define BIT_SHIFT_PS_TIMER_C_V1_8197F 0 -+#define BIT_MASK_PS_TIMER_C_V1_8197F 0xffffffffL -+#define BIT_PS_TIMER_C_V1_8197F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_V1_8197F) << BIT_SHIFT_PS_TIMER_C_V1_8197F) -+#define BITS_PS_TIMER_C_V1_8197F \ -+ (BIT_MASK_PS_TIMER_C_V1_8197F << BIT_SHIFT_PS_TIMER_C_V1_8197F) -+#define BIT_CLEAR_PS_TIMER_C_V1_8197F(x) ((x) & (~BITS_PS_TIMER_C_V1_8197F)) -+#define BIT_GET_PS_TIMER_C_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_V1_8197F) & BIT_MASK_PS_TIMER_C_V1_8197F) -+#define BIT_SET_PS_TIMER_C_V1_8197F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_V1_8197F(x) | BIT_PS_TIMER_C_V1_8197F(v)) -+ -+/* 2 REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL_8197F */ -+#define BIT_CPUMGQ_TIMER_EN_8197F BIT(31) -+#define BIT_CPUMGQ_TX_EN_8197F BIT(28) -+ -+#define BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8197F 24 -+#define BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8197F 0x7 -+#define BIT_CPUMGQ_TIMER_TSF_SEL_8197F(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8197F) \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8197F) -+#define BITS_CPUMGQ_TIMER_TSF_SEL_8197F \ -+ (BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8197F \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8197F) -+#define BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_8197F(x) \ -+ ((x) & (~BITS_CPUMGQ_TIMER_TSF_SEL_8197F)) -+#define BIT_GET_CPUMGQ_TIMER_TSF_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8197F) & \ -+ BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8197F) -+#define BIT_SET_CPUMGQ_TIMER_TSF_SEL_8197F(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_8197F(x) | \ -+ BIT_CPUMGQ_TIMER_TSF_SEL_8197F(v)) -+ -+#define BIT_PS_TIMER_C_EN_8197F BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_C_TSF_SEL_8197F 16 -+#define BIT_MASK_PS_TIMER_C_TSF_SEL_8197F 0x7 -+#define BIT_PS_TIMER_C_TSF_SEL_8197F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_TSF_SEL_8197F) \ -+ << BIT_SHIFT_PS_TIMER_C_TSF_SEL_8197F) -+#define BITS_PS_TIMER_C_TSF_SEL_8197F \ -+ (BIT_MASK_PS_TIMER_C_TSF_SEL_8197F \ -+ << BIT_SHIFT_PS_TIMER_C_TSF_SEL_8197F) -+#define BIT_CLEAR_PS_TIMER_C_TSF_SEL_8197F(x) \ -+ ((x) & (~BITS_PS_TIMER_C_TSF_SEL_8197F)) -+#define BIT_GET_PS_TIMER_C_TSF_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_TSF_SEL_8197F) & \ -+ BIT_MASK_PS_TIMER_C_TSF_SEL_8197F) -+#define BIT_SET_PS_TIMER_C_TSF_SEL_8197F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_TSF_SEL_8197F(x) | \ -+ BIT_PS_TIMER_C_TSF_SEL_8197F(v)) -+ -+#define BIT_PS_TIMER_B_EN_8197F BIT(15) -+ -+#define BIT_SHIFT_PS_TIMER_B_TSF_SEL_8197F 8 -+#define BIT_MASK_PS_TIMER_B_TSF_SEL_8197F 0x7 -+#define BIT_PS_TIMER_B_TSF_SEL_8197F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_TSF_SEL_8197F) \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_8197F) -+#define BITS_PS_TIMER_B_TSF_SEL_8197F \ -+ (BIT_MASK_PS_TIMER_B_TSF_SEL_8197F \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_8197F) -+#define BIT_CLEAR_PS_TIMER_B_TSF_SEL_8197F(x) \ -+ ((x) & (~BITS_PS_TIMER_B_TSF_SEL_8197F)) -+#define BIT_GET_PS_TIMER_B_TSF_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_TSF_SEL_8197F) & \ -+ BIT_MASK_PS_TIMER_B_TSF_SEL_8197F) -+#define BIT_SET_PS_TIMER_B_TSF_SEL_8197F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_TSF_SEL_8197F(x) | \ -+ BIT_PS_TIMER_B_TSF_SEL_8197F(v)) -+ -+#define BIT_PS_TIMER_A_EN_8197F BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_A_TSF_SEL_8197F 0 -+#define BIT_MASK_PS_TIMER_A_TSF_SEL_8197F 0x7 -+#define BIT_PS_TIMER_A_TSF_SEL_8197F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_TSF_SEL_8197F) \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_8197F) -+#define BITS_PS_TIMER_A_TSF_SEL_8197F \ -+ (BIT_MASK_PS_TIMER_A_TSF_SEL_8197F \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_8197F) -+#define BIT_CLEAR_PS_TIMER_A_TSF_SEL_8197F(x) \ -+ ((x) & (~BITS_PS_TIMER_A_TSF_SEL_8197F)) -+#define BIT_GET_PS_TIMER_A_TSF_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_TSF_SEL_8197F) & \ -+ BIT_MASK_PS_TIMER_A_TSF_SEL_8197F) -+#define BIT_SET_PS_TIMER_A_TSF_SEL_8197F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_TSF_SEL_8197F(x) | \ -+ BIT_PS_TIMER_A_TSF_SEL_8197F(v)) -+ -+/* 2 REG_CPUMGQ_TX_TIMER_EARLY_8197F */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8197F 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8197F 0xff -+#define BIT_CPUMGQ_TX_TIMER_EARLY_8197F(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8197F) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8197F) -+#define BITS_CPUMGQ_TX_TIMER_EARLY_8197F \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8197F \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8197F) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_8197F(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_EARLY_8197F)) -+#define BIT_GET_CPUMGQ_TX_TIMER_EARLY_8197F(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8197F) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8197F) -+#define BIT_SET_CPUMGQ_TX_TIMER_EARLY_8197F(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_8197F(x) | \ -+ BIT_CPUMGQ_TX_TIMER_EARLY_8197F(v)) -+ -+/* 2 REG_PS_TIMER_A_EARLY_8197F */ -+ -+#define BIT_SHIFT_PS_TIMER_A_EARLY_8197F 0 -+#define BIT_MASK_PS_TIMER_A_EARLY_8197F 0xff -+#define BIT_PS_TIMER_A_EARLY_8197F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_EARLY_8197F) \ -+ << BIT_SHIFT_PS_TIMER_A_EARLY_8197F) -+#define BITS_PS_TIMER_A_EARLY_8197F \ -+ (BIT_MASK_PS_TIMER_A_EARLY_8197F << BIT_SHIFT_PS_TIMER_A_EARLY_8197F) -+#define BIT_CLEAR_PS_TIMER_A_EARLY_8197F(x) \ -+ ((x) & (~BITS_PS_TIMER_A_EARLY_8197F)) -+#define BIT_GET_PS_TIMER_A_EARLY_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_EARLY_8197F) & \ -+ BIT_MASK_PS_TIMER_A_EARLY_8197F) -+#define BIT_SET_PS_TIMER_A_EARLY_8197F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_EARLY_8197F(x) | BIT_PS_TIMER_A_EARLY_8197F(v)) -+ -+/* 2 REG_PS_TIMER_B_EARLY_8197F */ -+ -+#define BIT_SHIFT_PS_TIMER_B_EARLY_8197F 0 -+#define BIT_MASK_PS_TIMER_B_EARLY_8197F 0xff -+#define BIT_PS_TIMER_B_EARLY_8197F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_EARLY_8197F) \ -+ << BIT_SHIFT_PS_TIMER_B_EARLY_8197F) -+#define BITS_PS_TIMER_B_EARLY_8197F \ -+ (BIT_MASK_PS_TIMER_B_EARLY_8197F << BIT_SHIFT_PS_TIMER_B_EARLY_8197F) -+#define BIT_CLEAR_PS_TIMER_B_EARLY_8197F(x) \ -+ ((x) & (~BITS_PS_TIMER_B_EARLY_8197F)) -+#define BIT_GET_PS_TIMER_B_EARLY_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_EARLY_8197F) & \ -+ BIT_MASK_PS_TIMER_B_EARLY_8197F) -+#define BIT_SET_PS_TIMER_B_EARLY_8197F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_EARLY_8197F(x) | BIT_PS_TIMER_B_EARLY_8197F(v)) -+ -+/* 2 REG_PS_TIMER_C_EARLY_8197F */ -+ -+#define BIT_SHIFT_PS_TIMER_C_EARLY_8197F 0 -+#define BIT_MASK_PS_TIMER_C_EARLY_8197F 0xff -+#define BIT_PS_TIMER_C_EARLY_8197F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_EARLY_8197F) \ -+ << BIT_SHIFT_PS_TIMER_C_EARLY_8197F) -+#define BITS_PS_TIMER_C_EARLY_8197F \ -+ (BIT_MASK_PS_TIMER_C_EARLY_8197F << BIT_SHIFT_PS_TIMER_C_EARLY_8197F) -+#define BIT_CLEAR_PS_TIMER_C_EARLY_8197F(x) \ -+ ((x) & (~BITS_PS_TIMER_C_EARLY_8197F)) -+#define BIT_GET_PS_TIMER_C_EARLY_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_EARLY_8197F) & \ -+ BIT_MASK_PS_TIMER_C_EARLY_8197F) -+#define BIT_SET_PS_TIMER_C_EARLY_8197F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_EARLY_8197F(x) | BIT_PS_TIMER_C_EARLY_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_STOP_CPUMGQ_8197F BIT(16) -+ -+#define BIT_SHIFT_CPUMGQ_PARAMETER_8197F 0 -+#define BIT_MASK_CPUMGQ_PARAMETER_8197F 0xffff -+#define BIT_CPUMGQ_PARAMETER_8197F(x) \ -+ (((x) & BIT_MASK_CPUMGQ_PARAMETER_8197F) \ -+ << BIT_SHIFT_CPUMGQ_PARAMETER_8197F) -+#define BITS_CPUMGQ_PARAMETER_8197F \ -+ (BIT_MASK_CPUMGQ_PARAMETER_8197F << BIT_SHIFT_CPUMGQ_PARAMETER_8197F) -+#define BIT_CLEAR_CPUMGQ_PARAMETER_8197F(x) \ -+ ((x) & (~BITS_CPUMGQ_PARAMETER_8197F)) -+#define BIT_GET_CPUMGQ_PARAMETER_8197F(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_PARAMETER_8197F) & \ -+ BIT_MASK_CPUMGQ_PARAMETER_8197F) -+#define BIT_SET_CPUMGQ_PARAMETER_8197F(x, v) \ -+ (BIT_CLEAR_CPUMGQ_PARAMETER_8197F(x) | BIT_CPUMGQ_PARAMETER_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_BWOPMODE_8197F (BW OPERATION MODE REGISTER) */ -+ -+/* 2 REG_WMAC_FWPKT_CR_8197F */ -+#define BIT_FWEN_8197F BIT(7) -+#define BIT_PHYSTS_PKT_CTRL_8197F BIT(6) -+#define BIT_APPHDR_MIDSRCH_FAIL_8197F BIT(4) -+#define BIT_FWPARSING_EN_8197F BIT(3) -+ -+#define BIT_SHIFT_APPEND_MHDR_LEN_8197F 0 -+#define BIT_MASK_APPEND_MHDR_LEN_8197F 0x7 -+#define BIT_APPEND_MHDR_LEN_8197F(x) \ -+ (((x) & BIT_MASK_APPEND_MHDR_LEN_8197F) \ -+ << BIT_SHIFT_APPEND_MHDR_LEN_8197F) -+#define BITS_APPEND_MHDR_LEN_8197F \ -+ (BIT_MASK_APPEND_MHDR_LEN_8197F << BIT_SHIFT_APPEND_MHDR_LEN_8197F) -+#define BIT_CLEAR_APPEND_MHDR_LEN_8197F(x) ((x) & (~BITS_APPEND_MHDR_LEN_8197F)) -+#define BIT_GET_APPEND_MHDR_LEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_APPEND_MHDR_LEN_8197F) & \ -+ BIT_MASK_APPEND_MHDR_LEN_8197F) -+#define BIT_SET_APPEND_MHDR_LEN_8197F(x, v) \ -+ (BIT_CLEAR_APPEND_MHDR_LEN_8197F(x) | BIT_APPEND_MHDR_LEN_8197F(v)) -+ -+/* 2 REG_WMAC_CR_8197F (WMAC CR AND APSD CONTROL REGISTER) */ -+#define BIT_APSDOFF_8197F BIT(6) -+#define BIT_IC_MACPHY_M_8197F BIT(0) -+ -+/* 2 REG_TCR_8197F (TRANSMISSION CONFIGURATION REGISTER) */ -+#define BIT_WMAC_EN_RTS_ADDR_8197F BIT(31) -+#define BIT_WMAC_DISABLE_CCK_8197F BIT(30) -+#define BIT_WMAC_RAW_LEN_8197F BIT(29) -+#define BIT_WMAC_NOTX_IN_RXNDP_8197F BIT(28) -+#define BIT_WMAC_EN_EOF_8197F BIT(27) -+#define BIT_WMAC_BF_SEL_8197F BIT(26) -+#define BIT_WMAC_ANTMODE_SEL_8197F BIT(25) -+#define BIT_WMAC_TCRPWRMGT_HWCTL_8197F BIT(24) -+#define BIT_WMAC_SMOOTH_VAL_8197F BIT(23) -+#define BIT_UNDERFLOWEN_CMPLEN_SEL_8197F BIT(21) -+#define BIT_FETCH_MPDU_AFTER_WSEC_RDY_8197F BIT(20) -+#define BIT_WMAC_TCR_EN_20MST_8197F BIT(19) -+#define BIT_WMAC_DIS_SIGTA_8197F BIT(18) -+#define BIT_WMAC_DIS_A2B0_8197F BIT(17) -+#define BIT_WMAC_MSK_SIGBCRC_8197F BIT(16) -+#define BIT_WMAC_TCR_ERRSTEN_3_8197F BIT(15) -+#define BIT_WMAC_TCR_ERRSTEN_2_8197F BIT(14) -+#define BIT_WMAC_TCR_ERRSTEN_1_8197F BIT(13) -+#define BIT_WMAC_TCR_ERRSTEN_0_8197F BIT(12) -+#define BIT_WMAC_TCR_TXSK_PERPKT_8197F BIT(11) -+#define BIT_ICV_8197F BIT(10) -+#define BIT_CFEND_FORMAT_8197F BIT(9) -+#define BIT_CRC_8197F BIT(8) -+#define BIT_PWRBIT_OW_EN_8197F BIT(7) -+#define BIT_PWR_ST_8197F BIT(6) -+#define BIT_WMAC_TCR_UPD_TIMIE_8197F BIT(5) -+#define BIT_WMAC_TCR_UPD_HGQMD_8197F BIT(4) -+#define BIT_VHTSIGA1_TXPS_8197F BIT(3) -+#define BIT_PAD_SEL_8197F BIT(2) -+#define BIT_DIS_GCLK_8197F BIT(1) -+ -+/* 2 REG_RCR_8197F (RECEIVE CONFIGURATION REGISTER) */ -+#define BIT_APP_FCS_8197F BIT(31) -+#define BIT_APP_MIC_8197F BIT(30) -+#define BIT_APP_ICV_8197F BIT(29) -+#define BIT_APP_PHYSTS_8197F BIT(28) -+#define BIT_APP_BASSN_8197F BIT(27) -+#define BIT_VHT_DACK_8197F BIT(26) -+#define BIT_TCPOFLD_EN_8197F BIT(25) -+#define BIT_ENMBID_8197F BIT(24) -+#define BIT_LSIGEN_8197F BIT(23) -+#define BIT_MFBEN_8197F BIT(22) -+#define BIT_DISCHKPPDLLEN_8197F BIT(21) -+#define BIT_PKTCTL_DLEN_8197F BIT(20) -+#define BIT_TIM_PARSER_EN_8197F BIT(18) -+#define BIT_BC_MD_EN_8197F BIT(17) -+#define BIT_UC_MD_EN_8197F BIT(16) -+#define BIT_RXSK_PERPKT_8197F BIT(15) -+#define BIT_HTC_LOC_CTRL_8197F BIT(14) -+#define BIT_TA_BCN_8197F BIT(11) -+#define BIT_DISDECMYPKT_8197F BIT(10) -+#define BIT_AICV_8197F BIT(9) -+#define BIT_ACRC32_8197F BIT(8) -+#define BIT_CBSSID_BCN_8197F BIT(7) -+#define BIT_CBSSID_DATA_8197F BIT(6) -+#define BIT_APWRMGT_8197F BIT(5) -+#define BIT_ADD3_8197F BIT(4) -+#define BIT_AB_8197F BIT(3) -+#define BIT_AM_8197F BIT(2) -+#define BIT_APM_8197F BIT(1) -+#define BIT_AAP_8197F BIT(0) -+ -+/* 2 REG_RX_DRVINFO_SZ_8197F (RX DRIVER INFO SIZE REGISTER) */ -+#define BIT_APP_PHYSTS_PER_SUBMPDU_8197F BIT(7) -+#define BIT_APP_MH_SHIFT_VAL_8197F BIT(6) -+#define BIT_WMAC_ENSHIFT_8197F BIT(5) -+ -+#define BIT_SHIFT_DRVINFO_SZ_V1_8197F 0 -+#define BIT_MASK_DRVINFO_SZ_V1_8197F 0xf -+#define BIT_DRVINFO_SZ_V1_8197F(x) \ -+ (((x) & BIT_MASK_DRVINFO_SZ_V1_8197F) << BIT_SHIFT_DRVINFO_SZ_V1_8197F) -+#define BITS_DRVINFO_SZ_V1_8197F \ -+ (BIT_MASK_DRVINFO_SZ_V1_8197F << BIT_SHIFT_DRVINFO_SZ_V1_8197F) -+#define BIT_CLEAR_DRVINFO_SZ_V1_8197F(x) ((x) & (~BITS_DRVINFO_SZ_V1_8197F)) -+#define BIT_GET_DRVINFO_SZ_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DRVINFO_SZ_V1_8197F) & BIT_MASK_DRVINFO_SZ_V1_8197F) -+#define BIT_SET_DRVINFO_SZ_V1_8197F(x, v) \ -+ (BIT_CLEAR_DRVINFO_SZ_V1_8197F(x) | BIT_DRVINFO_SZ_V1_8197F(v)) -+ -+/* 2 REG_RX_DLK_TIME_8197F (RX DEADLOCK TIME REGISTER) */ -+ -+#define BIT_SHIFT_RX_DLK_TIME_8197F 0 -+#define BIT_MASK_RX_DLK_TIME_8197F 0xff -+#define BIT_RX_DLK_TIME_8197F(x) \ -+ (((x) & BIT_MASK_RX_DLK_TIME_8197F) << BIT_SHIFT_RX_DLK_TIME_8197F) -+#define BITS_RX_DLK_TIME_8197F \ -+ (BIT_MASK_RX_DLK_TIME_8197F << BIT_SHIFT_RX_DLK_TIME_8197F) -+#define BIT_CLEAR_RX_DLK_TIME_8197F(x) ((x) & (~BITS_RX_DLK_TIME_8197F)) -+#define BIT_GET_RX_DLK_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_RX_DLK_TIME_8197F) & BIT_MASK_RX_DLK_TIME_8197F) -+#define BIT_SET_RX_DLK_TIME_8197F(x, v) \ -+ (BIT_CLEAR_RX_DLK_TIME_8197F(x) | BIT_RX_DLK_TIME_8197F(v)) -+ -+/* 2 REG_RX_PKT_LIMIT_8197F (RX PACKET LENGTH LIMIT REGISTER) */ -+ -+#define BIT_SHIFT_RXPKTLMT_8197F 0 -+#define BIT_MASK_RXPKTLMT_8197F 0x3f -+#define BIT_RXPKTLMT_8197F(x) \ -+ (((x) & BIT_MASK_RXPKTLMT_8197F) << BIT_SHIFT_RXPKTLMT_8197F) -+#define BITS_RXPKTLMT_8197F \ -+ (BIT_MASK_RXPKTLMT_8197F << BIT_SHIFT_RXPKTLMT_8197F) -+#define BIT_CLEAR_RXPKTLMT_8197F(x) ((x) & (~BITS_RXPKTLMT_8197F)) -+#define BIT_GET_RXPKTLMT_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXPKTLMT_8197F) & BIT_MASK_RXPKTLMT_8197F) -+#define BIT_SET_RXPKTLMT_8197F(x, v) \ -+ (BIT_CLEAR_RXPKTLMT_8197F(x) | BIT_RXPKTLMT_8197F(v)) -+ -+/* 2 REG_MACID_8197F (MAC ID REGISTER) */ -+ -+#define BIT_SHIFT_MACID_8197F 0 -+#define BIT_MASK_MACID_8197F 0xffffffffffffL -+#define BIT_MACID_8197F(x) \ -+ (((x) & BIT_MASK_MACID_8197F) << BIT_SHIFT_MACID_8197F) -+#define BITS_MACID_8197F (BIT_MASK_MACID_8197F << BIT_SHIFT_MACID_8197F) -+#define BIT_CLEAR_MACID_8197F(x) ((x) & (~BITS_MACID_8197F)) -+#define BIT_GET_MACID_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID_8197F) & BIT_MASK_MACID_8197F) -+#define BIT_SET_MACID_8197F(x, v) \ -+ (BIT_CLEAR_MACID_8197F(x) | BIT_MACID_8197F(v)) -+ -+/* 2 REG_BSSID_8197F (BSSID REGISTER) */ -+ -+#define BIT_SHIFT_BSSID_8197F 0 -+#define BIT_MASK_BSSID_8197F 0xffffffffffffL -+#define BIT_BSSID_8197F(x) \ -+ (((x) & BIT_MASK_BSSID_8197F) << BIT_SHIFT_BSSID_8197F) -+#define BITS_BSSID_8197F (BIT_MASK_BSSID_8197F << BIT_SHIFT_BSSID_8197F) -+#define BIT_CLEAR_BSSID_8197F(x) ((x) & (~BITS_BSSID_8197F)) -+#define BIT_GET_BSSID_8197F(x) \ -+ (((x) >> BIT_SHIFT_BSSID_8197F) & BIT_MASK_BSSID_8197F) -+#define BIT_SET_BSSID_8197F(x, v) \ -+ (BIT_CLEAR_BSSID_8197F(x) | BIT_BSSID_8197F(v)) -+ -+/* 2 REG_MAR_8197F (MULTICAST ADDRESS REGISTER) */ -+ -+#define BIT_SHIFT_MAR_8197F 0 -+#define BIT_MASK_MAR_8197F 0xffffffffffffffffL -+#define BIT_MAR_8197F(x) (((x) & BIT_MASK_MAR_8197F) << BIT_SHIFT_MAR_8197F) -+#define BITS_MAR_8197F (BIT_MASK_MAR_8197F << BIT_SHIFT_MAR_8197F) -+#define BIT_CLEAR_MAR_8197F(x) ((x) & (~BITS_MAR_8197F)) -+#define BIT_GET_MAR_8197F(x) (((x) >> BIT_SHIFT_MAR_8197F) & BIT_MASK_MAR_8197F) -+#define BIT_SET_MAR_8197F(x, v) (BIT_CLEAR_MAR_8197F(x) | BIT_MAR_8197F(v)) -+ -+/* 2 REG_MBIDCAMCFG_1_8197F (MBSSID CAM CONFIGURATION REGISTER) */ -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_L_8197F 0 -+#define BIT_MASK_MBIDCAM_RWDATA_L_8197F 0xffffffffL -+#define BIT_MBIDCAM_RWDATA_L_8197F(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_L_8197F) \ -+ << BIT_SHIFT_MBIDCAM_RWDATA_L_8197F) -+#define BITS_MBIDCAM_RWDATA_L_8197F \ -+ (BIT_MASK_MBIDCAM_RWDATA_L_8197F << BIT_SHIFT_MBIDCAM_RWDATA_L_8197F) -+#define BIT_CLEAR_MBIDCAM_RWDATA_L_8197F(x) \ -+ ((x) & (~BITS_MBIDCAM_RWDATA_L_8197F)) -+#define BIT_GET_MBIDCAM_RWDATA_L_8197F(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_L_8197F) & \ -+ BIT_MASK_MBIDCAM_RWDATA_L_8197F) -+#define BIT_SET_MBIDCAM_RWDATA_L_8197F(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_L_8197F(x) | BIT_MBIDCAM_RWDATA_L_8197F(v)) -+ -+/* 2 REG_MBIDCAMCFG_2_8197F (MBSSID CAM CONFIGURATION REGISTER) */ -+#define BIT_MBIDCAM_POLL_8197F BIT(31) -+#define BIT_MBIDCAM_WT_EN_8197F BIT(30) -+ -+#define BIT_SHIFT_MBIDCAM_ADDR_V1_8197F 24 -+#define BIT_MASK_MBIDCAM_ADDR_V1_8197F 0x3f -+#define BIT_MBIDCAM_ADDR_V1_8197F(x) \ -+ (((x) & BIT_MASK_MBIDCAM_ADDR_V1_8197F) \ -+ << BIT_SHIFT_MBIDCAM_ADDR_V1_8197F) -+#define BITS_MBIDCAM_ADDR_V1_8197F \ -+ (BIT_MASK_MBIDCAM_ADDR_V1_8197F << BIT_SHIFT_MBIDCAM_ADDR_V1_8197F) -+#define BIT_CLEAR_MBIDCAM_ADDR_V1_8197F(x) ((x) & (~BITS_MBIDCAM_ADDR_V1_8197F)) -+#define BIT_GET_MBIDCAM_ADDR_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_ADDR_V1_8197F) & \ -+ BIT_MASK_MBIDCAM_ADDR_V1_8197F) -+#define BIT_SET_MBIDCAM_ADDR_V1_8197F(x, v) \ -+ (BIT_CLEAR_MBIDCAM_ADDR_V1_8197F(x) | BIT_MBIDCAM_ADDR_V1_8197F(v)) -+ -+#define BIT_MBIDCAM_VALID_8197F BIT(23) -+#define BIT_LSIC_TXOP_EN_8197F BIT(17) -+#define BIT_REPEAT_MODE_EN_8197F BIT(16) -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_H_8197F 0 -+#define BIT_MASK_MBIDCAM_RWDATA_H_8197F 0xffff -+#define BIT_MBIDCAM_RWDATA_H_8197F(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_H_8197F) \ -+ << BIT_SHIFT_MBIDCAM_RWDATA_H_8197F) -+#define BITS_MBIDCAM_RWDATA_H_8197F \ -+ (BIT_MASK_MBIDCAM_RWDATA_H_8197F << BIT_SHIFT_MBIDCAM_RWDATA_H_8197F) -+#define BIT_CLEAR_MBIDCAM_RWDATA_H_8197F(x) \ -+ ((x) & (~BITS_MBIDCAM_RWDATA_H_8197F)) -+#define BIT_GET_MBIDCAM_RWDATA_H_8197F(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_H_8197F) & \ -+ BIT_MASK_MBIDCAM_RWDATA_H_8197F) -+#define BIT_SET_MBIDCAM_RWDATA_H_8197F(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_H_8197F(x) | BIT_MBIDCAM_RWDATA_H_8197F(v)) -+ -+/* 2 REG_ZLD_NUM_8197F */ -+ -+#define BIT_SHIFT_ZLD_NUM_8197F 0 -+#define BIT_MASK_ZLD_NUM_8197F 0xff -+#define BIT_ZLD_NUM_8197F(x) \ -+ (((x) & BIT_MASK_ZLD_NUM_8197F) << BIT_SHIFT_ZLD_NUM_8197F) -+#define BITS_ZLD_NUM_8197F (BIT_MASK_ZLD_NUM_8197F << BIT_SHIFT_ZLD_NUM_8197F) -+#define BIT_CLEAR_ZLD_NUM_8197F(x) ((x) & (~BITS_ZLD_NUM_8197F)) -+#define BIT_GET_ZLD_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_ZLD_NUM_8197F) & BIT_MASK_ZLD_NUM_8197F) -+#define BIT_SET_ZLD_NUM_8197F(x, v) \ -+ (BIT_CLEAR_ZLD_NUM_8197F(x) | BIT_ZLD_NUM_8197F(v)) -+ -+/* 2 REG_UDF_THSD_8197F */ -+ -+#define BIT_SHIFT_UDF_THSD_8197F 0 -+#define BIT_MASK_UDF_THSD_8197F 0xff -+#define BIT_UDF_THSD_8197F(x) \ -+ (((x) & BIT_MASK_UDF_THSD_8197F) << BIT_SHIFT_UDF_THSD_8197F) -+#define BITS_UDF_THSD_8197F \ -+ (BIT_MASK_UDF_THSD_8197F << BIT_SHIFT_UDF_THSD_8197F) -+#define BIT_CLEAR_UDF_THSD_8197F(x) ((x) & (~BITS_UDF_THSD_8197F)) -+#define BIT_GET_UDF_THSD_8197F(x) \ -+ (((x) >> BIT_SHIFT_UDF_THSD_8197F) & BIT_MASK_UDF_THSD_8197F) -+#define BIT_SET_UDF_THSD_8197F(x, v) \ -+ (BIT_CLEAR_UDF_THSD_8197F(x) | BIT_UDF_THSD_8197F(v)) -+ -+/* 2 REG_WMAC_TCR_TSFT_OFS_8197F */ -+ -+#define BIT_SHIFT_WMAC_TCR_TSFT_OFS_8197F 0 -+#define BIT_MASK_WMAC_TCR_TSFT_OFS_8197F 0xffff -+#define BIT_WMAC_TCR_TSFT_OFS_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_TCR_TSFT_OFS_8197F) \ -+ << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8197F) -+#define BITS_WMAC_TCR_TSFT_OFS_8197F \ -+ (BIT_MASK_WMAC_TCR_TSFT_OFS_8197F << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8197F) -+#define BIT_CLEAR_WMAC_TCR_TSFT_OFS_8197F(x) \ -+ ((x) & (~BITS_WMAC_TCR_TSFT_OFS_8197F)) -+#define BIT_GET_WMAC_TCR_TSFT_OFS_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TCR_TSFT_OFS_8197F) & \ -+ BIT_MASK_WMAC_TCR_TSFT_OFS_8197F) -+#define BIT_SET_WMAC_TCR_TSFT_OFS_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_TCR_TSFT_OFS_8197F(x) | BIT_WMAC_TCR_TSFT_OFS_8197F(v)) -+ -+/* 2 REG_MCU_TEST_2_V1_8197F */ -+ -+#define BIT_SHIFT_MCU_RSVD_2_V1_8197F 0 -+#define BIT_MASK_MCU_RSVD_2_V1_8197F 0xffff -+#define BIT_MCU_RSVD_2_V1_8197F(x) \ -+ (((x) & BIT_MASK_MCU_RSVD_2_V1_8197F) << BIT_SHIFT_MCU_RSVD_2_V1_8197F) -+#define BITS_MCU_RSVD_2_V1_8197F \ -+ (BIT_MASK_MCU_RSVD_2_V1_8197F << BIT_SHIFT_MCU_RSVD_2_V1_8197F) -+#define BIT_CLEAR_MCU_RSVD_2_V1_8197F(x) ((x) & (~BITS_MCU_RSVD_2_V1_8197F)) -+#define BIT_GET_MCU_RSVD_2_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_MCU_RSVD_2_V1_8197F) & BIT_MASK_MCU_RSVD_2_V1_8197F) -+#define BIT_SET_MCU_RSVD_2_V1_8197F(x, v) \ -+ (BIT_CLEAR_MCU_RSVD_2_V1_8197F(x) | BIT_MCU_RSVD_2_V1_8197F(v)) -+ -+/* 2 REG_WMAC_TXTIMEOUT_8197F */ -+ -+#define BIT_SHIFT_WMAC_TXTIMEOUT_8197F 0 -+#define BIT_MASK_WMAC_TXTIMEOUT_8197F 0xff -+#define BIT_WMAC_TXTIMEOUT_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_TXTIMEOUT_8197F) \ -+ << BIT_SHIFT_WMAC_TXTIMEOUT_8197F) -+#define BITS_WMAC_TXTIMEOUT_8197F \ -+ (BIT_MASK_WMAC_TXTIMEOUT_8197F << BIT_SHIFT_WMAC_TXTIMEOUT_8197F) -+#define BIT_CLEAR_WMAC_TXTIMEOUT_8197F(x) ((x) & (~BITS_WMAC_TXTIMEOUT_8197F)) -+#define BIT_GET_WMAC_TXTIMEOUT_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXTIMEOUT_8197F) & \ -+ BIT_MASK_WMAC_TXTIMEOUT_8197F) -+#define BIT_SET_WMAC_TXTIMEOUT_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_TXTIMEOUT_8197F(x) | BIT_WMAC_TXTIMEOUT_8197F(v)) -+ -+/* 2 REG_STMP_THSD_8197F */ -+ -+#define BIT_SHIFT_STMP_THSD_8197F 0 -+#define BIT_MASK_STMP_THSD_8197F 0xff -+#define BIT_STMP_THSD_8197F(x) \ -+ (((x) & BIT_MASK_STMP_THSD_8197F) << BIT_SHIFT_STMP_THSD_8197F) -+#define BITS_STMP_THSD_8197F \ -+ (BIT_MASK_STMP_THSD_8197F << BIT_SHIFT_STMP_THSD_8197F) -+#define BIT_CLEAR_STMP_THSD_8197F(x) ((x) & (~BITS_STMP_THSD_8197F)) -+#define BIT_GET_STMP_THSD_8197F(x) \ -+ (((x) >> BIT_SHIFT_STMP_THSD_8197F) & BIT_MASK_STMP_THSD_8197F) -+#define BIT_SET_STMP_THSD_8197F(x, v) \ -+ (BIT_CLEAR_STMP_THSD_8197F(x) | BIT_STMP_THSD_8197F(v)) -+ -+/* 2 REG_MAC_SPEC_SIFS_8197F (SPECIFICATION SIFS REGISTER) */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_8197F 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_8197F 0xff -+#define BIT_SPEC_SIFS_OFDM_8197F(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_8197F) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_8197F) -+#define BITS_SPEC_SIFS_OFDM_8197F \ -+ (BIT_MASK_SPEC_SIFS_OFDM_8197F << BIT_SHIFT_SPEC_SIFS_OFDM_8197F) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_8197F(x) ((x) & (~BITS_SPEC_SIFS_OFDM_8197F)) -+#define BIT_GET_SPEC_SIFS_OFDM_8197F(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_8197F) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_8197F) -+#define BIT_SET_SPEC_SIFS_OFDM_8197F(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_8197F(x) | BIT_SPEC_SIFS_OFDM_8197F(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_8197F 0 -+#define BIT_MASK_SPEC_SIFS_CCK_8197F 0xff -+#define BIT_SPEC_SIFS_CCK_8197F(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_8197F) << BIT_SHIFT_SPEC_SIFS_CCK_8197F) -+#define BITS_SPEC_SIFS_CCK_8197F \ -+ (BIT_MASK_SPEC_SIFS_CCK_8197F << BIT_SHIFT_SPEC_SIFS_CCK_8197F) -+#define BIT_CLEAR_SPEC_SIFS_CCK_8197F(x) ((x) & (~BITS_SPEC_SIFS_CCK_8197F)) -+#define BIT_GET_SPEC_SIFS_CCK_8197F(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_8197F) & BIT_MASK_SPEC_SIFS_CCK_8197F) -+#define BIT_SET_SPEC_SIFS_CCK_8197F(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_8197F(x) | BIT_SPEC_SIFS_CCK_8197F(v)) -+ -+/* 2 REG_USTIME_EDCA_8197F (US TIME TUNING FOR EDCA REGISTER) */ -+ -+#define BIT_SHIFT_USTIME_EDCA_8197F 0 -+#define BIT_MASK_USTIME_EDCA_8197F 0xff -+#define BIT_USTIME_EDCA_8197F(x) \ -+ (((x) & BIT_MASK_USTIME_EDCA_8197F) << BIT_SHIFT_USTIME_EDCA_8197F) -+#define BITS_USTIME_EDCA_8197F \ -+ (BIT_MASK_USTIME_EDCA_8197F << BIT_SHIFT_USTIME_EDCA_8197F) -+#define BIT_CLEAR_USTIME_EDCA_8197F(x) ((x) & (~BITS_USTIME_EDCA_8197F)) -+#define BIT_GET_USTIME_EDCA_8197F(x) \ -+ (((x) >> BIT_SHIFT_USTIME_EDCA_8197F) & BIT_MASK_USTIME_EDCA_8197F) -+#define BIT_SET_USTIME_EDCA_8197F(x, v) \ -+ (BIT_CLEAR_USTIME_EDCA_8197F(x) | BIT_USTIME_EDCA_8197F(v)) -+ -+/* 2 REG_RESP_SIFS_OFDM_8197F (RESPONSE SIFS FOR OFDM REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_OFDM_8197F 8 -+#define BIT_MASK_SIFS_R2T_OFDM_8197F 0xff -+#define BIT_SIFS_R2T_OFDM_8197F(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_OFDM_8197F) << BIT_SHIFT_SIFS_R2T_OFDM_8197F) -+#define BITS_SIFS_R2T_OFDM_8197F \ -+ (BIT_MASK_SIFS_R2T_OFDM_8197F << BIT_SHIFT_SIFS_R2T_OFDM_8197F) -+#define BIT_CLEAR_SIFS_R2T_OFDM_8197F(x) ((x) & (~BITS_SIFS_R2T_OFDM_8197F)) -+#define BIT_GET_SIFS_R2T_OFDM_8197F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_OFDM_8197F) & BIT_MASK_SIFS_R2T_OFDM_8197F) -+#define BIT_SET_SIFS_R2T_OFDM_8197F(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_OFDM_8197F(x) | BIT_SIFS_R2T_OFDM_8197F(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_OFDM_8197F 0 -+#define BIT_MASK_SIFS_T2T_OFDM_8197F 0xff -+#define BIT_SIFS_T2T_OFDM_8197F(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_OFDM_8197F) << BIT_SHIFT_SIFS_T2T_OFDM_8197F) -+#define BITS_SIFS_T2T_OFDM_8197F \ -+ (BIT_MASK_SIFS_T2T_OFDM_8197F << BIT_SHIFT_SIFS_T2T_OFDM_8197F) -+#define BIT_CLEAR_SIFS_T2T_OFDM_8197F(x) ((x) & (~BITS_SIFS_T2T_OFDM_8197F)) -+#define BIT_GET_SIFS_T2T_OFDM_8197F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_OFDM_8197F) & BIT_MASK_SIFS_T2T_OFDM_8197F) -+#define BIT_SET_SIFS_T2T_OFDM_8197F(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_OFDM_8197F(x) | BIT_SIFS_T2T_OFDM_8197F(v)) -+ -+/* 2 REG_RESP_SIFS_CCK_8197F (RESPONSE SIFS FOR CCK REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_CCK_8197F 8 -+#define BIT_MASK_SIFS_R2T_CCK_8197F 0xff -+#define BIT_SIFS_R2T_CCK_8197F(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_CCK_8197F) << BIT_SHIFT_SIFS_R2T_CCK_8197F) -+#define BITS_SIFS_R2T_CCK_8197F \ -+ (BIT_MASK_SIFS_R2T_CCK_8197F << BIT_SHIFT_SIFS_R2T_CCK_8197F) -+#define BIT_CLEAR_SIFS_R2T_CCK_8197F(x) ((x) & (~BITS_SIFS_R2T_CCK_8197F)) -+#define BIT_GET_SIFS_R2T_CCK_8197F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_CCK_8197F) & BIT_MASK_SIFS_R2T_CCK_8197F) -+#define BIT_SET_SIFS_R2T_CCK_8197F(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_CCK_8197F(x) | BIT_SIFS_R2T_CCK_8197F(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_CCK_8197F 0 -+#define BIT_MASK_SIFS_T2T_CCK_8197F 0xff -+#define BIT_SIFS_T2T_CCK_8197F(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_CCK_8197F) << BIT_SHIFT_SIFS_T2T_CCK_8197F) -+#define BITS_SIFS_T2T_CCK_8197F \ -+ (BIT_MASK_SIFS_T2T_CCK_8197F << BIT_SHIFT_SIFS_T2T_CCK_8197F) -+#define BIT_CLEAR_SIFS_T2T_CCK_8197F(x) ((x) & (~BITS_SIFS_T2T_CCK_8197F)) -+#define BIT_GET_SIFS_T2T_CCK_8197F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_CCK_8197F) & BIT_MASK_SIFS_T2T_CCK_8197F) -+#define BIT_SET_SIFS_T2T_CCK_8197F(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_CCK_8197F(x) | BIT_SIFS_T2T_CCK_8197F(v)) -+ -+/* 2 REG_EIFS_8197F (EIFS REGISTER) */ -+ -+#define BIT_SHIFT_EIFS_8197F 0 -+#define BIT_MASK_EIFS_8197F 0xffff -+#define BIT_EIFS_8197F(x) (((x) & BIT_MASK_EIFS_8197F) << BIT_SHIFT_EIFS_8197F) -+#define BITS_EIFS_8197F (BIT_MASK_EIFS_8197F << BIT_SHIFT_EIFS_8197F) -+#define BIT_CLEAR_EIFS_8197F(x) ((x) & (~BITS_EIFS_8197F)) -+#define BIT_GET_EIFS_8197F(x) \ -+ (((x) >> BIT_SHIFT_EIFS_8197F) & BIT_MASK_EIFS_8197F) -+#define BIT_SET_EIFS_8197F(x, v) (BIT_CLEAR_EIFS_8197F(x) | BIT_EIFS_8197F(v)) -+ -+/* 2 REG_CTS2TO_8197F (CTS2 TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_CTS2TO_8197F 0 -+#define BIT_MASK_CTS2TO_8197F 0xff -+#define BIT_CTS2TO_8197F(x) \ -+ (((x) & BIT_MASK_CTS2TO_8197F) << BIT_SHIFT_CTS2TO_8197F) -+#define BITS_CTS2TO_8197F (BIT_MASK_CTS2TO_8197F << BIT_SHIFT_CTS2TO_8197F) -+#define BIT_CLEAR_CTS2TO_8197F(x) ((x) & (~BITS_CTS2TO_8197F)) -+#define BIT_GET_CTS2TO_8197F(x) \ -+ (((x) >> BIT_SHIFT_CTS2TO_8197F) & BIT_MASK_CTS2TO_8197F) -+#define BIT_SET_CTS2TO_8197F(x, v) \ -+ (BIT_CLEAR_CTS2TO_8197F(x) | BIT_CTS2TO_8197F(v)) -+ -+/* 2 REG_ACKTO_8197F (ACK TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_ACKTO_8197F 0 -+#define BIT_MASK_ACKTO_8197F 0xff -+#define BIT_ACKTO_8197F(x) \ -+ (((x) & BIT_MASK_ACKTO_8197F) << BIT_SHIFT_ACKTO_8197F) -+#define BITS_ACKTO_8197F (BIT_MASK_ACKTO_8197F << BIT_SHIFT_ACKTO_8197F) -+#define BIT_CLEAR_ACKTO_8197F(x) ((x) & (~BITS_ACKTO_8197F)) -+#define BIT_GET_ACKTO_8197F(x) \ -+ (((x) >> BIT_SHIFT_ACKTO_8197F) & BIT_MASK_ACKTO_8197F) -+#define BIT_SET_ACKTO_8197F(x, v) \ -+ (BIT_CLEAR_ACKTO_8197F(x) | BIT_ACKTO_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NAV_CTRL_8197F (NAV CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_NAV_UPPER_8197F 16 -+#define BIT_MASK_NAV_UPPER_8197F 0xff -+#define BIT_NAV_UPPER_8197F(x) \ -+ (((x) & BIT_MASK_NAV_UPPER_8197F) << BIT_SHIFT_NAV_UPPER_8197F) -+#define BITS_NAV_UPPER_8197F \ -+ (BIT_MASK_NAV_UPPER_8197F << BIT_SHIFT_NAV_UPPER_8197F) -+#define BIT_CLEAR_NAV_UPPER_8197F(x) ((x) & (~BITS_NAV_UPPER_8197F)) -+#define BIT_GET_NAV_UPPER_8197F(x) \ -+ (((x) >> BIT_SHIFT_NAV_UPPER_8197F) & BIT_MASK_NAV_UPPER_8197F) -+#define BIT_SET_NAV_UPPER_8197F(x, v) \ -+ (BIT_CLEAR_NAV_UPPER_8197F(x) | BIT_NAV_UPPER_8197F(v)) -+ -+#define BIT_SHIFT_RXMYRTS_NAV_8197F 8 -+#define BIT_MASK_RXMYRTS_NAV_8197F 0xf -+#define BIT_RXMYRTS_NAV_8197F(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_8197F) << BIT_SHIFT_RXMYRTS_NAV_8197F) -+#define BITS_RXMYRTS_NAV_8197F \ -+ (BIT_MASK_RXMYRTS_NAV_8197F << BIT_SHIFT_RXMYRTS_NAV_8197F) -+#define BIT_CLEAR_RXMYRTS_NAV_8197F(x) ((x) & (~BITS_RXMYRTS_NAV_8197F)) -+#define BIT_GET_RXMYRTS_NAV_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_8197F) & BIT_MASK_RXMYRTS_NAV_8197F) -+#define BIT_SET_RXMYRTS_NAV_8197F(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_8197F(x) | BIT_RXMYRTS_NAV_8197F(v)) -+ -+#define BIT_SHIFT_RTSRST_8197F 0 -+#define BIT_MASK_RTSRST_8197F 0xff -+#define BIT_RTSRST_8197F(x) \ -+ (((x) & BIT_MASK_RTSRST_8197F) << BIT_SHIFT_RTSRST_8197F) -+#define BITS_RTSRST_8197F (BIT_MASK_RTSRST_8197F << BIT_SHIFT_RTSRST_8197F) -+#define BIT_CLEAR_RTSRST_8197F(x) ((x) & (~BITS_RTSRST_8197F)) -+#define BIT_GET_RTSRST_8197F(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_8197F) & BIT_MASK_RTSRST_8197F) -+#define BIT_SET_RTSRST_8197F(x, v) \ -+ (BIT_CLEAR_RTSRST_8197F(x) | BIT_RTSRST_8197F(v)) -+ -+/* 2 REG_BACAMCMD_8197F (BLOCK ACK CAM COMMAND REGISTER) */ -+#define BIT_BACAM_POLL_8197F BIT(31) -+#define BIT_BACAM_RST_8197F BIT(17) -+#define BIT_BACAM_RW_8197F BIT(16) -+ -+#define BIT_SHIFT_TXSBM_8197F 14 -+#define BIT_MASK_TXSBM_8197F 0x3 -+#define BIT_TXSBM_8197F(x) \ -+ (((x) & BIT_MASK_TXSBM_8197F) << BIT_SHIFT_TXSBM_8197F) -+#define BITS_TXSBM_8197F (BIT_MASK_TXSBM_8197F << BIT_SHIFT_TXSBM_8197F) -+#define BIT_CLEAR_TXSBM_8197F(x) ((x) & (~BITS_TXSBM_8197F)) -+#define BIT_GET_TXSBM_8197F(x) \ -+ (((x) >> BIT_SHIFT_TXSBM_8197F) & BIT_MASK_TXSBM_8197F) -+#define BIT_SET_TXSBM_8197F(x, v) \ -+ (BIT_CLEAR_TXSBM_8197F(x) | BIT_TXSBM_8197F(v)) -+ -+#define BIT_SHIFT_BACAM_ADDR_8197F 0 -+#define BIT_MASK_BACAM_ADDR_8197F 0x3f -+#define BIT_BACAM_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_BACAM_ADDR_8197F) << BIT_SHIFT_BACAM_ADDR_8197F) -+#define BITS_BACAM_ADDR_8197F \ -+ (BIT_MASK_BACAM_ADDR_8197F << BIT_SHIFT_BACAM_ADDR_8197F) -+#define BIT_CLEAR_BACAM_ADDR_8197F(x) ((x) & (~BITS_BACAM_ADDR_8197F)) -+#define BIT_GET_BACAM_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_BACAM_ADDR_8197F) & BIT_MASK_BACAM_ADDR_8197F) -+#define BIT_SET_BACAM_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_BACAM_ADDR_8197F(x) | BIT_BACAM_ADDR_8197F(v)) -+ -+/* 2 REG_BACAMCONTENT_8197F (BLOCK ACK CAM CONTENT REGISTER) */ -+ -+#define BIT_SHIFT_BA_CONTENT_H_8197F (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_BA_CONTENT_H_8197F 0xffffffffL -+#define BIT_BA_CONTENT_H_8197F(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_H_8197F) << BIT_SHIFT_BA_CONTENT_H_8197F) -+#define BITS_BA_CONTENT_H_8197F \ -+ (BIT_MASK_BA_CONTENT_H_8197F << BIT_SHIFT_BA_CONTENT_H_8197F) -+#define BIT_CLEAR_BA_CONTENT_H_8197F(x) ((x) & (~BITS_BA_CONTENT_H_8197F)) -+#define BIT_GET_BA_CONTENT_H_8197F(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_H_8197F) & BIT_MASK_BA_CONTENT_H_8197F) -+#define BIT_SET_BA_CONTENT_H_8197F(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_H_8197F(x) | BIT_BA_CONTENT_H_8197F(v)) -+ -+#define BIT_SHIFT_BA_CONTENT_L_8197F 0 -+#define BIT_MASK_BA_CONTENT_L_8197F 0xffffffffL -+#define BIT_BA_CONTENT_L_8197F(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_L_8197F) << BIT_SHIFT_BA_CONTENT_L_8197F) -+#define BITS_BA_CONTENT_L_8197F \ -+ (BIT_MASK_BA_CONTENT_L_8197F << BIT_SHIFT_BA_CONTENT_L_8197F) -+#define BIT_CLEAR_BA_CONTENT_L_8197F(x) ((x) & (~BITS_BA_CONTENT_L_8197F)) -+#define BIT_GET_BA_CONTENT_L_8197F(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_L_8197F) & BIT_MASK_BA_CONTENT_L_8197F) -+#define BIT_SET_BA_CONTENT_L_8197F(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_L_8197F(x) | BIT_BA_CONTENT_L_8197F(v)) -+ -+/* 2 REG_WMAC_BITMAP_CTL_8197F */ -+#define BIT_BITMAP_VO_8197F BIT(7) -+#define BIT_BITMAP_VI_8197F BIT(6) -+#define BIT_BITMAP_BE_8197F BIT(5) -+#define BIT_BITMAP_BK_8197F BIT(4) -+ -+#define BIT_SHIFT_BITMAP_CONDITION_8197F 2 -+#define BIT_MASK_BITMAP_CONDITION_8197F 0x3 -+#define BIT_BITMAP_CONDITION_8197F(x) \ -+ (((x) & BIT_MASK_BITMAP_CONDITION_8197F) \ -+ << BIT_SHIFT_BITMAP_CONDITION_8197F) -+#define BITS_BITMAP_CONDITION_8197F \ -+ (BIT_MASK_BITMAP_CONDITION_8197F << BIT_SHIFT_BITMAP_CONDITION_8197F) -+#define BIT_CLEAR_BITMAP_CONDITION_8197F(x) \ -+ ((x) & (~BITS_BITMAP_CONDITION_8197F)) -+#define BIT_GET_BITMAP_CONDITION_8197F(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_CONDITION_8197F) & \ -+ BIT_MASK_BITMAP_CONDITION_8197F) -+#define BIT_SET_BITMAP_CONDITION_8197F(x, v) \ -+ (BIT_CLEAR_BITMAP_CONDITION_8197F(x) | BIT_BITMAP_CONDITION_8197F(v)) -+ -+#define BIT_BITMAP_SSNBK_COUNTER_CLR_8197F BIT(1) -+#define BIT_BITMAP_FORCE_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_RXPKT_TYPE_8197F 2 -+#define BIT_MASK_RXPKT_TYPE_8197F 0x3f -+#define BIT_RXPKT_TYPE_8197F(x) \ -+ (((x) & BIT_MASK_RXPKT_TYPE_8197F) << BIT_SHIFT_RXPKT_TYPE_8197F) -+#define BITS_RXPKT_TYPE_8197F \ -+ (BIT_MASK_RXPKT_TYPE_8197F << BIT_SHIFT_RXPKT_TYPE_8197F) -+#define BIT_CLEAR_RXPKT_TYPE_8197F(x) ((x) & (~BITS_RXPKT_TYPE_8197F)) -+#define BIT_GET_RXPKT_TYPE_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_TYPE_8197F) & BIT_MASK_RXPKT_TYPE_8197F) -+#define BIT_SET_RXPKT_TYPE_8197F(x, v) \ -+ (BIT_CLEAR_RXPKT_TYPE_8197F(x) | BIT_RXPKT_TYPE_8197F(v)) -+ -+#define BIT_TXACT_IND_8197F BIT(1) -+#define BIT_RXACT_IND_8197F BIT(0) -+ -+/* 2 REG_WMAC_BACAM_RPMEN_8197F */ -+ -+#define BIT_SHIFT_BITMAP_SSNBK_COUNTER_8197F 2 -+#define BIT_MASK_BITMAP_SSNBK_COUNTER_8197F 0x3f -+#define BIT_BITMAP_SSNBK_COUNTER_8197F(x) \ -+ (((x) & BIT_MASK_BITMAP_SSNBK_COUNTER_8197F) \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8197F) -+#define BITS_BITMAP_SSNBK_COUNTER_8197F \ -+ (BIT_MASK_BITMAP_SSNBK_COUNTER_8197F \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8197F) -+#define BIT_CLEAR_BITMAP_SSNBK_COUNTER_8197F(x) \ -+ ((x) & (~BITS_BITMAP_SSNBK_COUNTER_8197F)) -+#define BIT_GET_BITMAP_SSNBK_COUNTER_8197F(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_SSNBK_COUNTER_8197F) & \ -+ BIT_MASK_BITMAP_SSNBK_COUNTER_8197F) -+#define BIT_SET_BITMAP_SSNBK_COUNTER_8197F(x, v) \ -+ (BIT_CLEAR_BITMAP_SSNBK_COUNTER_8197F(x) | \ -+ BIT_BITMAP_SSNBK_COUNTER_8197F(v)) -+ -+#define BIT_BITMAP_EN_8197F BIT(1) -+#define BIT_WMAC_BACAM_RPMEN_8197F BIT(0) -+ -+/* 2 REG_LBDLY_8197F (LOOPBACK DELAY REGISTER) */ -+ -+#define BIT_SHIFT_LBDLY_8197F 0 -+#define BIT_MASK_LBDLY_8197F 0x1f -+#define BIT_LBDLY_8197F(x) \ -+ (((x) & BIT_MASK_LBDLY_8197F) << BIT_SHIFT_LBDLY_8197F) -+#define BITS_LBDLY_8197F (BIT_MASK_LBDLY_8197F << BIT_SHIFT_LBDLY_8197F) -+#define BIT_CLEAR_LBDLY_8197F(x) ((x) & (~BITS_LBDLY_8197F)) -+#define BIT_GET_LBDLY_8197F(x) \ -+ (((x) >> BIT_SHIFT_LBDLY_8197F) & BIT_MASK_LBDLY_8197F) -+#define BIT_SET_LBDLY_8197F(x, v) \ -+ (BIT_CLEAR_LBDLY_8197F(x) | BIT_LBDLY_8197F(v)) -+ -+/* 2 REG_RXERR_RPT_8197F (RX ERROR REPORT REGISTER) */ -+ -+#define BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8197F 28 -+#define BIT_MASK_RXERR_RPT_SEL_V1_3_0_8197F 0xf -+#define BIT_RXERR_RPT_SEL_V1_3_0_8197F(x) \ -+ (((x) & BIT_MASK_RXERR_RPT_SEL_V1_3_0_8197F) \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8197F) -+#define BITS_RXERR_RPT_SEL_V1_3_0_8197F \ -+ (BIT_MASK_RXERR_RPT_SEL_V1_3_0_8197F \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8197F) -+#define BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8197F(x) \ -+ ((x) & (~BITS_RXERR_RPT_SEL_V1_3_0_8197F)) -+#define BIT_GET_RXERR_RPT_SEL_V1_3_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8197F) & \ -+ BIT_MASK_RXERR_RPT_SEL_V1_3_0_8197F) -+#define BIT_SET_RXERR_RPT_SEL_V1_3_0_8197F(x, v) \ -+ (BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8197F(x) | \ -+ BIT_RXERR_RPT_SEL_V1_3_0_8197F(v)) -+ -+#define BIT_RXERR_RPT_RST_8197F BIT(27) -+#define BIT_RXERR_RPT_SEL_V1_4_8197F BIT(26) -+ -+#define BIT_SHIFT_UD_SELECT_BSSID_2_1_8197F 24 -+#define BIT_MASK_UD_SELECT_BSSID_2_1_8197F 0x3 -+#define BIT_UD_SELECT_BSSID_2_1_8197F(x) \ -+ (((x) & BIT_MASK_UD_SELECT_BSSID_2_1_8197F) \ -+ << BIT_SHIFT_UD_SELECT_BSSID_2_1_8197F) -+#define BITS_UD_SELECT_BSSID_2_1_8197F \ -+ (BIT_MASK_UD_SELECT_BSSID_2_1_8197F \ -+ << BIT_SHIFT_UD_SELECT_BSSID_2_1_8197F) -+#define BIT_CLEAR_UD_SELECT_BSSID_2_1_8197F(x) \ -+ ((x) & (~BITS_UD_SELECT_BSSID_2_1_8197F)) -+#define BIT_GET_UD_SELECT_BSSID_2_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_UD_SELECT_BSSID_2_1_8197F) & \ -+ BIT_MASK_UD_SELECT_BSSID_2_1_8197F) -+#define BIT_SET_UD_SELECT_BSSID_2_1_8197F(x, v) \ -+ (BIT_CLEAR_UD_SELECT_BSSID_2_1_8197F(x) | \ -+ BIT_UD_SELECT_BSSID_2_1_8197F(v)) -+ -+#define BIT_W1S_8197F BIT(23) -+#define BIT_UD_SELECT_BSSID_0_8197F BIT(22) -+ -+#define BIT_SHIFT_UD_SUB_TYPE_8197F 18 -+#define BIT_MASK_UD_SUB_TYPE_8197F 0xf -+#define BIT_UD_SUB_TYPE_8197F(x) \ -+ (((x) & BIT_MASK_UD_SUB_TYPE_8197F) << BIT_SHIFT_UD_SUB_TYPE_8197F) -+#define BITS_UD_SUB_TYPE_8197F \ -+ (BIT_MASK_UD_SUB_TYPE_8197F << BIT_SHIFT_UD_SUB_TYPE_8197F) -+#define BIT_CLEAR_UD_SUB_TYPE_8197F(x) ((x) & (~BITS_UD_SUB_TYPE_8197F)) -+#define BIT_GET_UD_SUB_TYPE_8197F(x) \ -+ (((x) >> BIT_SHIFT_UD_SUB_TYPE_8197F) & BIT_MASK_UD_SUB_TYPE_8197F) -+#define BIT_SET_UD_SUB_TYPE_8197F(x, v) \ -+ (BIT_CLEAR_UD_SUB_TYPE_8197F(x) | BIT_UD_SUB_TYPE_8197F(v)) -+ -+#define BIT_SHIFT_UD_TYPE_8197F 16 -+#define BIT_MASK_UD_TYPE_8197F 0x3 -+#define BIT_UD_TYPE_8197F(x) \ -+ (((x) & BIT_MASK_UD_TYPE_8197F) << BIT_SHIFT_UD_TYPE_8197F) -+#define BITS_UD_TYPE_8197F (BIT_MASK_UD_TYPE_8197F << BIT_SHIFT_UD_TYPE_8197F) -+#define BIT_CLEAR_UD_TYPE_8197F(x) ((x) & (~BITS_UD_TYPE_8197F)) -+#define BIT_GET_UD_TYPE_8197F(x) \ -+ (((x) >> BIT_SHIFT_UD_TYPE_8197F) & BIT_MASK_UD_TYPE_8197F) -+#define BIT_SET_UD_TYPE_8197F(x, v) \ -+ (BIT_CLEAR_UD_TYPE_8197F(x) | BIT_UD_TYPE_8197F(v)) -+ -+#define BIT_SHIFT_RPT_COUNTER_8197F 0 -+#define BIT_MASK_RPT_COUNTER_8197F 0xffff -+#define BIT_RPT_COUNTER_8197F(x) \ -+ (((x) & BIT_MASK_RPT_COUNTER_8197F) << BIT_SHIFT_RPT_COUNTER_8197F) -+#define BITS_RPT_COUNTER_8197F \ -+ (BIT_MASK_RPT_COUNTER_8197F << BIT_SHIFT_RPT_COUNTER_8197F) -+#define BIT_CLEAR_RPT_COUNTER_8197F(x) ((x) & (~BITS_RPT_COUNTER_8197F)) -+#define BIT_GET_RPT_COUNTER_8197F(x) \ -+ (((x) >> BIT_SHIFT_RPT_COUNTER_8197F) & BIT_MASK_RPT_COUNTER_8197F) -+#define BIT_SET_RPT_COUNTER_8197F(x, v) \ -+ (BIT_CLEAR_RPT_COUNTER_8197F(x) | BIT_RPT_COUNTER_8197F(v)) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_8197F (WMAC TX/RX PROTOCOL CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_ACKBA_TYPSEL_8197F (60 & CPU_OPT_WIDTH) -+#define BIT_MASK_ACKBA_TYPSEL_8197F 0xf -+#define BIT_ACKBA_TYPSEL_8197F(x) \ -+ (((x) & BIT_MASK_ACKBA_TYPSEL_8197F) << BIT_SHIFT_ACKBA_TYPSEL_8197F) -+#define BITS_ACKBA_TYPSEL_8197F \ -+ (BIT_MASK_ACKBA_TYPSEL_8197F << BIT_SHIFT_ACKBA_TYPSEL_8197F) -+#define BIT_CLEAR_ACKBA_TYPSEL_8197F(x) ((x) & (~BITS_ACKBA_TYPSEL_8197F)) -+#define BIT_GET_ACKBA_TYPSEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_TYPSEL_8197F) & BIT_MASK_ACKBA_TYPSEL_8197F) -+#define BIT_SET_ACKBA_TYPSEL_8197F(x, v) \ -+ (BIT_CLEAR_ACKBA_TYPSEL_8197F(x) | BIT_ACKBA_TYPSEL_8197F(v)) -+ -+#define BIT_SHIFT_ACKBA_ACKPCHK_8197F (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_ACKBA_ACKPCHK_8197F 0xf -+#define BIT_ACKBA_ACKPCHK_8197F(x) \ -+ (((x) & BIT_MASK_ACKBA_ACKPCHK_8197F) << BIT_SHIFT_ACKBA_ACKPCHK_8197F) -+#define BITS_ACKBA_ACKPCHK_8197F \ -+ (BIT_MASK_ACKBA_ACKPCHK_8197F << BIT_SHIFT_ACKBA_ACKPCHK_8197F) -+#define BIT_CLEAR_ACKBA_ACKPCHK_8197F(x) ((x) & (~BITS_ACKBA_ACKPCHK_8197F)) -+#define BIT_GET_ACKBA_ACKPCHK_8197F(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_ACKPCHK_8197F) & BIT_MASK_ACKBA_ACKPCHK_8197F) -+#define BIT_SET_ACKBA_ACKPCHK_8197F(x, v) \ -+ (BIT_CLEAR_ACKBA_ACKPCHK_8197F(x) | BIT_ACKBA_ACKPCHK_8197F(v)) -+ -+#define BIT_SHIFT_ACKBAR_TYPESEL_8197F (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_ACKBAR_TYPESEL_8197F 0xff -+#define BIT_ACKBAR_TYPESEL_8197F(x) \ -+ (((x) & BIT_MASK_ACKBAR_TYPESEL_8197F) \ -+ << BIT_SHIFT_ACKBAR_TYPESEL_8197F) -+#define BITS_ACKBAR_TYPESEL_8197F \ -+ (BIT_MASK_ACKBAR_TYPESEL_8197F << BIT_SHIFT_ACKBAR_TYPESEL_8197F) -+#define BIT_CLEAR_ACKBAR_TYPESEL_8197F(x) ((x) & (~BITS_ACKBAR_TYPESEL_8197F)) -+#define BIT_GET_ACKBAR_TYPESEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_TYPESEL_8197F) & \ -+ BIT_MASK_ACKBAR_TYPESEL_8197F) -+#define BIT_SET_ACKBAR_TYPESEL_8197F(x, v) \ -+ (BIT_CLEAR_ACKBAR_TYPESEL_8197F(x) | BIT_ACKBAR_TYPESEL_8197F(v)) -+ -+#define BIT_SHIFT_ACKBAR_ACKPCHK_8197F (44 & CPU_OPT_WIDTH) -+#define BIT_MASK_ACKBAR_ACKPCHK_8197F 0xf -+#define BIT_ACKBAR_ACKPCHK_8197F(x) \ -+ (((x) & BIT_MASK_ACKBAR_ACKPCHK_8197F) \ -+ << BIT_SHIFT_ACKBAR_ACKPCHK_8197F) -+#define BITS_ACKBAR_ACKPCHK_8197F \ -+ (BIT_MASK_ACKBAR_ACKPCHK_8197F << BIT_SHIFT_ACKBAR_ACKPCHK_8197F) -+#define BIT_CLEAR_ACKBAR_ACKPCHK_8197F(x) ((x) & (~BITS_ACKBAR_ACKPCHK_8197F)) -+#define BIT_GET_ACKBAR_ACKPCHK_8197F(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_ACKPCHK_8197F) & \ -+ BIT_MASK_ACKBAR_ACKPCHK_8197F) -+#define BIT_SET_ACKBAR_ACKPCHK_8197F(x, v) \ -+ (BIT_CLEAR_ACKBAR_ACKPCHK_8197F(x) | BIT_ACKBAR_ACKPCHK_8197F(v)) -+ -+#define BIT_RXBA_IGNOREA2_8197F BIT(42) -+#define BIT_EN_SAVE_ALL_TXOPADDR_8197F BIT(41) -+#define BIT_EN_TXCTS_TO_TXOPOWNER_INRXNAV_8197F BIT(40) -+#define BIT_DIS_TXBA_AMPDUFCSERR_8197F BIT(39) -+#define BIT_DIS_TXBA_RXBARINFULL_8197F BIT(38) -+#define BIT_DIS_TXCFE_INFULL_8197F BIT(37) -+#define BIT_DIS_TXCTS_INFULL_8197F BIT(36) -+#define BIT_EN_TXACKBA_IN_TX_RDG_8197F BIT(35) -+#define BIT_EN_TXACKBA_IN_TXOP_8197F BIT(34) -+#define BIT_EN_TXCTS_IN_RXNAV_8197F BIT(33) -+#define BIT_EN_TXCTS_INTXOP_8197F BIT(32) -+#define BIT_BLK_EDCA_BBSLP_8197F BIT(31) -+#define BIT_BLK_EDCA_BBSBY_8197F BIT(30) -+#define BIT_ACKTO_BLOCK_SCH_EN_8197F BIT(27) -+#define BIT_EIFS_BLOCK_SCH_EN_8197F BIT(26) -+#define BIT_PLCPCHK_RST_EIFS_8197F BIT(25) -+#define BIT_CCA_RST_EIFS_8197F BIT(24) -+#define BIT_DIS_UPD_MYRXPKTNAV_8197F BIT(23) -+#define BIT_EARLY_TXBA_8197F BIT(22) -+ -+#define BIT_SHIFT_RESP_CHNBUSY_8197F 20 -+#define BIT_MASK_RESP_CHNBUSY_8197F 0x3 -+#define BIT_RESP_CHNBUSY_8197F(x) \ -+ (((x) & BIT_MASK_RESP_CHNBUSY_8197F) << BIT_SHIFT_RESP_CHNBUSY_8197F) -+#define BITS_RESP_CHNBUSY_8197F \ -+ (BIT_MASK_RESP_CHNBUSY_8197F << BIT_SHIFT_RESP_CHNBUSY_8197F) -+#define BIT_CLEAR_RESP_CHNBUSY_8197F(x) ((x) & (~BITS_RESP_CHNBUSY_8197F)) -+#define BIT_GET_RESP_CHNBUSY_8197F(x) \ -+ (((x) >> BIT_SHIFT_RESP_CHNBUSY_8197F) & BIT_MASK_RESP_CHNBUSY_8197F) -+#define BIT_SET_RESP_CHNBUSY_8197F(x, v) \ -+ (BIT_CLEAR_RESP_CHNBUSY_8197F(x) | BIT_RESP_CHNBUSY_8197F(v)) -+ -+#define BIT_RESP_DCTS_EN_8197F BIT(19) -+#define BIT_RESP_DCFE_EN_8197F BIT(18) -+#define BIT_RESP_SPLCPEN_8197F BIT(17) -+#define BIT_RESP_SGIEN_8197F BIT(16) -+#define BIT_RESP_LDPC_EN_8197F BIT(15) -+#define BIT_DIS_RESP_ACKINCCA_8197F BIT(14) -+#define BIT_DIS_RESP_CTSINCCA_8197F BIT(13) -+ -+#define BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8197F 10 -+#define BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8197F 0x7 -+#define BIT_R_WMAC_SECOND_CCA_TIMER_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8197F) \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8197F) -+#define BITS_R_WMAC_SECOND_CCA_TIMER_8197F \ -+ (BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8197F \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8197F) -+#define BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_SECOND_CCA_TIMER_8197F)) -+#define BIT_GET_R_WMAC_SECOND_CCA_TIMER_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8197F) & \ -+ BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8197F) -+#define BIT_SET_R_WMAC_SECOND_CCA_TIMER_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8197F(x) | \ -+ BIT_R_WMAC_SECOND_CCA_TIMER_8197F(v)) -+ -+#define BIT_SHIFT_RFMOD_8197F 7 -+#define BIT_MASK_RFMOD_8197F 0x3 -+#define BIT_RFMOD_8197F(x) \ -+ (((x) & BIT_MASK_RFMOD_8197F) << BIT_SHIFT_RFMOD_8197F) -+#define BITS_RFMOD_8197F (BIT_MASK_RFMOD_8197F << BIT_SHIFT_RFMOD_8197F) -+#define BIT_CLEAR_RFMOD_8197F(x) ((x) & (~BITS_RFMOD_8197F)) -+#define BIT_GET_RFMOD_8197F(x) \ -+ (((x) >> BIT_SHIFT_RFMOD_8197F) & BIT_MASK_RFMOD_8197F) -+#define BIT_SET_RFMOD_8197F(x, v) \ -+ (BIT_CLEAR_RFMOD_8197F(x) | BIT_RFMOD_8197F(v)) -+ -+#define BIT_SHIFT_RESP_CTS_DYNBW_SEL_8197F 5 -+#define BIT_MASK_RESP_CTS_DYNBW_SEL_8197F 0x3 -+#define BIT_RESP_CTS_DYNBW_SEL_8197F(x) \ -+ (((x) & BIT_MASK_RESP_CTS_DYNBW_SEL_8197F) \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8197F) -+#define BITS_RESP_CTS_DYNBW_SEL_8197F \ -+ (BIT_MASK_RESP_CTS_DYNBW_SEL_8197F \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8197F) -+#define BIT_CLEAR_RESP_CTS_DYNBW_SEL_8197F(x) \ -+ ((x) & (~BITS_RESP_CTS_DYNBW_SEL_8197F)) -+#define BIT_GET_RESP_CTS_DYNBW_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_RESP_CTS_DYNBW_SEL_8197F) & \ -+ BIT_MASK_RESP_CTS_DYNBW_SEL_8197F) -+#define BIT_SET_RESP_CTS_DYNBW_SEL_8197F(x, v) \ -+ (BIT_CLEAR_RESP_CTS_DYNBW_SEL_8197F(x) | \ -+ BIT_RESP_CTS_DYNBW_SEL_8197F(v)) -+ -+#define BIT_DLY_TX_WAIT_RXANTSEL_8197F BIT(4) -+#define BIT_TXRESP_BY_RXANTSEL_8197F BIT(3) -+ -+#define BIT_SHIFT_ORIG_DCTS_CHK_8197F 0 -+#define BIT_MASK_ORIG_DCTS_CHK_8197F 0x3 -+#define BIT_ORIG_DCTS_CHK_8197F(x) \ -+ (((x) & BIT_MASK_ORIG_DCTS_CHK_8197F) << BIT_SHIFT_ORIG_DCTS_CHK_8197F) -+#define BITS_ORIG_DCTS_CHK_8197F \ -+ (BIT_MASK_ORIG_DCTS_CHK_8197F << BIT_SHIFT_ORIG_DCTS_CHK_8197F) -+#define BIT_CLEAR_ORIG_DCTS_CHK_8197F(x) ((x) & (~BITS_ORIG_DCTS_CHK_8197F)) -+#define BIT_GET_ORIG_DCTS_CHK_8197F(x) \ -+ (((x) >> BIT_SHIFT_ORIG_DCTS_CHK_8197F) & BIT_MASK_ORIG_DCTS_CHK_8197F) -+#define BIT_SET_ORIG_DCTS_CHK_8197F(x, v) \ -+ (BIT_CLEAR_ORIG_DCTS_CHK_8197F(x) | BIT_ORIG_DCTS_CHK_8197F(v)) -+ -+/* 2 REG_CAMCMD_8197F (CAM COMMAND REGISTER) */ -+#define BIT_SECCAM_POLLING_8197F BIT(31) -+#define BIT_SECCAM_CLR_8197F BIT(30) -+#define BIT_MFBCAM_CLR_8197F BIT(29) -+#define BIT_SECCAM_WE_8197F BIT(16) -+ -+#define BIT_SHIFT_SECCAM_ADDR_V2_8197F 0 -+#define BIT_MASK_SECCAM_ADDR_V2_8197F 0x3ff -+#define BIT_SECCAM_ADDR_V2_8197F(x) \ -+ (((x) & BIT_MASK_SECCAM_ADDR_V2_8197F) \ -+ << BIT_SHIFT_SECCAM_ADDR_V2_8197F) -+#define BITS_SECCAM_ADDR_V2_8197F \ -+ (BIT_MASK_SECCAM_ADDR_V2_8197F << BIT_SHIFT_SECCAM_ADDR_V2_8197F) -+#define BIT_CLEAR_SECCAM_ADDR_V2_8197F(x) ((x) & (~BITS_SECCAM_ADDR_V2_8197F)) -+#define BIT_GET_SECCAM_ADDR_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_SECCAM_ADDR_V2_8197F) & \ -+ BIT_MASK_SECCAM_ADDR_V2_8197F) -+#define BIT_SET_SECCAM_ADDR_V2_8197F(x, v) \ -+ (BIT_CLEAR_SECCAM_ADDR_V2_8197F(x) | BIT_SECCAM_ADDR_V2_8197F(v)) -+ -+/* 2 REG_CAMWRITE_8197F (CAM WRITE REGISTER) */ -+ -+#define BIT_SHIFT_CAMW_DATA_8197F 0 -+#define BIT_MASK_CAMW_DATA_8197F 0xffffffffL -+#define BIT_CAMW_DATA_8197F(x) \ -+ (((x) & BIT_MASK_CAMW_DATA_8197F) << BIT_SHIFT_CAMW_DATA_8197F) -+#define BITS_CAMW_DATA_8197F \ -+ (BIT_MASK_CAMW_DATA_8197F << BIT_SHIFT_CAMW_DATA_8197F) -+#define BIT_CLEAR_CAMW_DATA_8197F(x) ((x) & (~BITS_CAMW_DATA_8197F)) -+#define BIT_GET_CAMW_DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_CAMW_DATA_8197F) & BIT_MASK_CAMW_DATA_8197F) -+#define BIT_SET_CAMW_DATA_8197F(x, v) \ -+ (BIT_CLEAR_CAMW_DATA_8197F(x) | BIT_CAMW_DATA_8197F(v)) -+ -+/* 2 REG_CAMREAD_8197F (CAM READ REGISTER) */ -+ -+#define BIT_SHIFT_CAMR_DATA_8197F 0 -+#define BIT_MASK_CAMR_DATA_8197F 0xffffffffL -+#define BIT_CAMR_DATA_8197F(x) \ -+ (((x) & BIT_MASK_CAMR_DATA_8197F) << BIT_SHIFT_CAMR_DATA_8197F) -+#define BITS_CAMR_DATA_8197F \ -+ (BIT_MASK_CAMR_DATA_8197F << BIT_SHIFT_CAMR_DATA_8197F) -+#define BIT_CLEAR_CAMR_DATA_8197F(x) ((x) & (~BITS_CAMR_DATA_8197F)) -+#define BIT_GET_CAMR_DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_CAMR_DATA_8197F) & BIT_MASK_CAMR_DATA_8197F) -+#define BIT_SET_CAMR_DATA_8197F(x, v) \ -+ (BIT_CLEAR_CAMR_DATA_8197F(x) | BIT_CAMR_DATA_8197F(v)) -+ -+/* 2 REG_CAMDBG_8197F (CAM DEBUG REGISTER) */ -+#define BIT_SECCAM_INFO_8197F BIT(31) -+#define BIT_SEC_KEYFOUND_8197F BIT(15) -+ -+#define BIT_SHIFT_CAMDBG_SEC_TYPE_8197F 12 -+#define BIT_MASK_CAMDBG_SEC_TYPE_8197F 0x7 -+#define BIT_CAMDBG_SEC_TYPE_8197F(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_TYPE_8197F) \ -+ << BIT_SHIFT_CAMDBG_SEC_TYPE_8197F) -+#define BITS_CAMDBG_SEC_TYPE_8197F \ -+ (BIT_MASK_CAMDBG_SEC_TYPE_8197F << BIT_SHIFT_CAMDBG_SEC_TYPE_8197F) -+#define BIT_CLEAR_CAMDBG_SEC_TYPE_8197F(x) ((x) & (~BITS_CAMDBG_SEC_TYPE_8197F)) -+#define BIT_GET_CAMDBG_SEC_TYPE_8197F(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_TYPE_8197F) & \ -+ BIT_MASK_CAMDBG_SEC_TYPE_8197F) -+#define BIT_SET_CAMDBG_SEC_TYPE_8197F(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_TYPE_8197F(x) | BIT_CAMDBG_SEC_TYPE_8197F(v)) -+ -+#define BIT_CAMDBG_EXT_SEC_TYPE_8197F BIT(11) -+ -+#define BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8197F 5 -+#define BIT_MASK_CAMDBG_MIC_KEY_IDX_8197F 0x1f -+#define BIT_CAMDBG_MIC_KEY_IDX_8197F(x) \ -+ (((x) & BIT_MASK_CAMDBG_MIC_KEY_IDX_8197F) \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8197F) -+#define BITS_CAMDBG_MIC_KEY_IDX_8197F \ -+ (BIT_MASK_CAMDBG_MIC_KEY_IDX_8197F \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8197F) -+#define BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8197F(x) \ -+ ((x) & (~BITS_CAMDBG_MIC_KEY_IDX_8197F)) -+#define BIT_GET_CAMDBG_MIC_KEY_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8197F) & \ -+ BIT_MASK_CAMDBG_MIC_KEY_IDX_8197F) -+#define BIT_SET_CAMDBG_MIC_KEY_IDX_8197F(x, v) \ -+ (BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8197F(x) | \ -+ BIT_CAMDBG_MIC_KEY_IDX_8197F(v)) -+ -+#define BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8197F 0 -+#define BIT_MASK_CAMDBG_SEC_KEY_IDX_8197F 0x1f -+#define BIT_CAMDBG_SEC_KEY_IDX_8197F(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_KEY_IDX_8197F) \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8197F) -+#define BITS_CAMDBG_SEC_KEY_IDX_8197F \ -+ (BIT_MASK_CAMDBG_SEC_KEY_IDX_8197F \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8197F) -+#define BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8197F(x) \ -+ ((x) & (~BITS_CAMDBG_SEC_KEY_IDX_8197F)) -+#define BIT_GET_CAMDBG_SEC_KEY_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8197F) & \ -+ BIT_MASK_CAMDBG_SEC_KEY_IDX_8197F) -+#define BIT_SET_CAMDBG_SEC_KEY_IDX_8197F(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8197F(x) | \ -+ BIT_CAMDBG_SEC_KEY_IDX_8197F(v)) -+ -+/* 2 REG_RXFILTER_ACTION_1_8197F */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_1_8197F 0 -+#define BIT_MASK_RXFILTER_ACTION_1_8197F 0xff -+#define BIT_RXFILTER_ACTION_1_8197F(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_1_8197F) \ -+ << BIT_SHIFT_RXFILTER_ACTION_1_8197F) -+#define BITS_RXFILTER_ACTION_1_8197F \ -+ (BIT_MASK_RXFILTER_ACTION_1_8197F << BIT_SHIFT_RXFILTER_ACTION_1_8197F) -+#define BIT_CLEAR_RXFILTER_ACTION_1_8197F(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_1_8197F)) -+#define BIT_GET_RXFILTER_ACTION_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_1_8197F) & \ -+ BIT_MASK_RXFILTER_ACTION_1_8197F) -+#define BIT_SET_RXFILTER_ACTION_1_8197F(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_1_8197F(x) | BIT_RXFILTER_ACTION_1_8197F(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_1_8197F */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_1_8197F 0 -+#define BIT_MASK_RXFILTER_CATEGORY_1_8197F 0xff -+#define BIT_RXFILTER_CATEGORY_1_8197F(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_1_8197F) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8197F) -+#define BITS_RXFILTER_CATEGORY_1_8197F \ -+ (BIT_MASK_RXFILTER_CATEGORY_1_8197F \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8197F) -+#define BIT_CLEAR_RXFILTER_CATEGORY_1_8197F(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_1_8197F)) -+#define BIT_GET_RXFILTER_CATEGORY_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_1_8197F) & \ -+ BIT_MASK_RXFILTER_CATEGORY_1_8197F) -+#define BIT_SET_RXFILTER_CATEGORY_1_8197F(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_1_8197F(x) | \ -+ BIT_RXFILTER_CATEGORY_1_8197F(v)) -+ -+/* 2 REG_SECCFG_8197F (SECURITY CONFIGURATION REGISTER) */ -+#define BIT_DIS_GCLK_WAPI_8197F BIT(15) -+#define BIT_DIS_GCLK_AES_8197F BIT(14) -+#define BIT_DIS_GCLK_TKIP_8197F BIT(13) -+#define BIT_AES_SEL_QC_1_8197F BIT(12) -+#define BIT_AES_SEL_QC_0_8197F BIT(11) -+#define BIT_WMAC_CKECK_BMC_8197F BIT(9) -+#define BIT_CHK_KEYID_8197F BIT(8) -+#define BIT_RXBCUSEDK_8197F BIT(7) -+#define BIT_TXBCUSEDK_8197F BIT(6) -+#define BIT_NOSKMC_8197F BIT(5) -+#define BIT_SKBYA2_8197F BIT(4) -+#define BIT_RXDEC_8197F BIT(3) -+#define BIT_TXENC_8197F BIT(2) -+#define BIT_RXUHUSEDK_8197F BIT(1) -+#define BIT_TXUHUSEDK_8197F BIT(0) -+ -+/* 2 REG_RXFILTER_ACTION_3_8197F */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_3_8197F 0 -+#define BIT_MASK_RXFILTER_ACTION_3_8197F 0xff -+#define BIT_RXFILTER_ACTION_3_8197F(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_3_8197F) \ -+ << BIT_SHIFT_RXFILTER_ACTION_3_8197F) -+#define BITS_RXFILTER_ACTION_3_8197F \ -+ (BIT_MASK_RXFILTER_ACTION_3_8197F << BIT_SHIFT_RXFILTER_ACTION_3_8197F) -+#define BIT_CLEAR_RXFILTER_ACTION_3_8197F(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_3_8197F)) -+#define BIT_GET_RXFILTER_ACTION_3_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_3_8197F) & \ -+ BIT_MASK_RXFILTER_ACTION_3_8197F) -+#define BIT_SET_RXFILTER_ACTION_3_8197F(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_3_8197F(x) | BIT_RXFILTER_ACTION_3_8197F(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_3_8197F */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_3_8197F 0 -+#define BIT_MASK_RXFILTER_CATEGORY_3_8197F 0xff -+#define BIT_RXFILTER_CATEGORY_3_8197F(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_3_8197F) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8197F) -+#define BITS_RXFILTER_CATEGORY_3_8197F \ -+ (BIT_MASK_RXFILTER_CATEGORY_3_8197F \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8197F) -+#define BIT_CLEAR_RXFILTER_CATEGORY_3_8197F(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_3_8197F)) -+#define BIT_GET_RXFILTER_CATEGORY_3_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_3_8197F) & \ -+ BIT_MASK_RXFILTER_CATEGORY_3_8197F) -+#define BIT_SET_RXFILTER_CATEGORY_3_8197F(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_3_8197F(x) | \ -+ BIT_RXFILTER_CATEGORY_3_8197F(v)) -+ -+/* 2 REG_RXFILTER_ACTION_2_8197F */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_2_8197F 0 -+#define BIT_MASK_RXFILTER_ACTION_2_8197F 0xff -+#define BIT_RXFILTER_ACTION_2_8197F(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_2_8197F) \ -+ << BIT_SHIFT_RXFILTER_ACTION_2_8197F) -+#define BITS_RXFILTER_ACTION_2_8197F \ -+ (BIT_MASK_RXFILTER_ACTION_2_8197F << BIT_SHIFT_RXFILTER_ACTION_2_8197F) -+#define BIT_CLEAR_RXFILTER_ACTION_2_8197F(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_2_8197F)) -+#define BIT_GET_RXFILTER_ACTION_2_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_2_8197F) & \ -+ BIT_MASK_RXFILTER_ACTION_2_8197F) -+#define BIT_SET_RXFILTER_ACTION_2_8197F(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_2_8197F(x) | BIT_RXFILTER_ACTION_2_8197F(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_2_8197F */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_2_8197F 0 -+#define BIT_MASK_RXFILTER_CATEGORY_2_8197F 0xff -+#define BIT_RXFILTER_CATEGORY_2_8197F(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_2_8197F) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8197F) -+#define BITS_RXFILTER_CATEGORY_2_8197F \ -+ (BIT_MASK_RXFILTER_CATEGORY_2_8197F \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8197F) -+#define BIT_CLEAR_RXFILTER_CATEGORY_2_8197F(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_2_8197F)) -+#define BIT_GET_RXFILTER_CATEGORY_2_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_2_8197F) & \ -+ BIT_MASK_RXFILTER_CATEGORY_2_8197F) -+#define BIT_SET_RXFILTER_CATEGORY_2_8197F(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_2_8197F(x) | \ -+ BIT_RXFILTER_CATEGORY_2_8197F(v)) -+ -+/* 2 REG_RXFLTMAP4_8197F (RX FILTER MAP GROUP 4) */ -+#define BIT_CTRLFLT15EN_FW_8197F BIT(15) -+#define BIT_CTRLFLT14EN_FW_8197F BIT(14) -+#define BIT_CTRLFLT13EN_FW_8197F BIT(13) -+#define BIT_CTRLFLT12EN_FW_8197F BIT(12) -+#define BIT_CTRLFLT11EN_FW_8197F BIT(11) -+#define BIT_CTRLFLT10EN_FW_8197F BIT(10) -+#define BIT_CTRLFLT9EN_FW_8197F BIT(9) -+#define BIT_CTRLFLT8EN_FW_8197F BIT(8) -+#define BIT_CTRLFLT7EN_FW_8197F BIT(7) -+#define BIT_CTRLFLT6EN_FW_8197F BIT(6) -+#define BIT_CTRLFLT5EN_FW_8197F BIT(5) -+#define BIT_CTRLFLT4EN_FW_8197F BIT(4) -+#define BIT_CTRLFLT3EN_FW_8197F BIT(3) -+#define BIT_CTRLFLT2EN_FW_8197F BIT(2) -+#define BIT_CTRLFLT1EN_FW_8197F BIT(1) -+#define BIT_CTRLFLT0EN_FW_8197F BIT(0) -+ -+/* 2 REG_RXFLTMAP3_8197F (RX FILTER MAP GROUP 3) */ -+#define BIT_MGTFLT15EN_FW_8197F BIT(15) -+#define BIT_MGTFLT14EN_FW_8197F BIT(14) -+#define BIT_MGTFLT13EN_FW_8197F BIT(13) -+#define BIT_MGTFLT12EN_FW_8197F BIT(12) -+#define BIT_MGTFLT11EN_FW_8197F BIT(11) -+#define BIT_MGTFLT10EN_FW_8197F BIT(10) -+#define BIT_MGTFLT9EN_FW_8197F BIT(9) -+#define BIT_MGTFLT8EN_FW_8197F BIT(8) -+#define BIT_MGTFLT7EN_FW_8197F BIT(7) -+#define BIT_MGTFLT6EN_FW_8197F BIT(6) -+#define BIT_MGTFLT5EN_FW_8197F BIT(5) -+#define BIT_MGTFLT4EN_FW_8197F BIT(4) -+#define BIT_MGTFLT3EN_FW_8197F BIT(3) -+#define BIT_MGTFLT2EN_FW_8197F BIT(2) -+#define BIT_MGTFLT1EN_FW_8197F BIT(1) -+#define BIT_MGTFLT0EN_FW_8197F BIT(0) -+ -+/* 2 REG_RXFLTMAP6_8197F (RX FILTER MAP GROUP 3) */ -+#define BIT_ACTIONFLT15EN_FW_8197F BIT(15) -+#define BIT_ACTIONFLT14EN_FW_8197F BIT(14) -+#define BIT_ACTIONFLT13EN_FW_8197F BIT(13) -+#define BIT_ACTIONFLT12EN_FW_8197F BIT(12) -+#define BIT_ACTIONFLT11EN_FW_8197F BIT(11) -+#define BIT_ACTIONFLT10EN_FW_8197F BIT(10) -+#define BIT_ACTIONFLT9EN_FW_8197F BIT(9) -+#define BIT_ACTIONFLT8EN_FW_8197F BIT(8) -+#define BIT_ACTIONFLT7EN_FW_8197F BIT(7) -+#define BIT_ACTIONFLT6EN_FW_8197F BIT(6) -+#define BIT_ACTIONFLT5EN_FW_8197F BIT(5) -+#define BIT_ACTIONFLT4EN_FW_8197F BIT(4) -+#define BIT_ACTIONFLT3EN_FW_8197F BIT(3) -+#define BIT_ACTIONFLT2EN_FW_8197F BIT(2) -+#define BIT_ACTIONFLT1EN_FW_8197F BIT(1) -+#define BIT_ACTIONFLT0EN_FW_8197F BIT(0) -+ -+/* 2 REG_RXFLTMAP5_8197F (RX FILTER MAP GROUP 3) */ -+#define BIT_DATAFLT15EN_FW_8197F BIT(15) -+#define BIT_DATAFLT14EN_FW_8197F BIT(14) -+#define BIT_DATAFLT13EN_FW_8197F BIT(13) -+#define BIT_DATAFLT12EN_FW_8197F BIT(12) -+#define BIT_DATAFLT11EN_FW_8197F BIT(11) -+#define BIT_DATAFLT10EN_FW_8197F BIT(10) -+#define BIT_DATAFLT9EN_FW_8197F BIT(9) -+#define BIT_DATAFLT8EN_FW_8197F BIT(8) -+#define BIT_DATAFLT7EN_FW_8197F BIT(7) -+#define BIT_DATAFLT6EN_FW_8197F BIT(6) -+#define BIT_DATAFLT5EN_FW_8197F BIT(5) -+#define BIT_DATAFLT4EN_FW_8197F BIT(4) -+#define BIT_DATAFLT3EN_FW_8197F BIT(3) -+#define BIT_DATAFLT2EN_FW_8197F BIT(2) -+#define BIT_DATAFLT1EN_FW_8197F BIT(1) -+#define BIT_DATAFLT0EN_FW_8197F BIT(0) -+ -+/* 2 REG_WMMPS_UAPSD_TID_8197F (WMM POWER SAVE UAPSD TID REGISTER) */ -+#define BIT_WMMPS_UAPSD_TID7_8197F BIT(7) -+#define BIT_WMMPS_UAPSD_TID6_8197F BIT(6) -+#define BIT_WMMPS_UAPSD_TID5_8197F BIT(5) -+#define BIT_WMMPS_UAPSD_TID4_8197F BIT(4) -+#define BIT_WMMPS_UAPSD_TID3_8197F BIT(3) -+#define BIT_WMMPS_UAPSD_TID2_8197F BIT(2) -+#define BIT_WMMPS_UAPSD_TID1_8197F BIT(1) -+#define BIT_WMMPS_UAPSD_TID0_8197F BIT(0) -+ -+/* 2 REG_PS_RX_INFO_8197F (POWER SAVE RX INFORMATION REGISTER) */ -+ -+#define BIT_SHIFT_PORTSEL__PS_RX_INFO_8197F 5 -+#define BIT_MASK_PORTSEL__PS_RX_INFO_8197F 0x7 -+#define BIT_PORTSEL__PS_RX_INFO_8197F(x) \ -+ (((x) & BIT_MASK_PORTSEL__PS_RX_INFO_8197F) \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8197F) -+#define BITS_PORTSEL__PS_RX_INFO_8197F \ -+ (BIT_MASK_PORTSEL__PS_RX_INFO_8197F \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8197F) -+#define BIT_CLEAR_PORTSEL__PS_RX_INFO_8197F(x) \ -+ ((x) & (~BITS_PORTSEL__PS_RX_INFO_8197F)) -+#define BIT_GET_PORTSEL__PS_RX_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_PORTSEL__PS_RX_INFO_8197F) & \ -+ BIT_MASK_PORTSEL__PS_RX_INFO_8197F) -+#define BIT_SET_PORTSEL__PS_RX_INFO_8197F(x, v) \ -+ (BIT_CLEAR_PORTSEL__PS_RX_INFO_8197F(x) | \ -+ BIT_PORTSEL__PS_RX_INFO_8197F(v)) -+ -+#define BIT_RXCTRLIN0_8197F BIT(4) -+#define BIT_RXMGTIN0_8197F BIT(3) -+#define BIT_RXDATAIN2_8197F BIT(2) -+#define BIT_RXDATAIN1_8197F BIT(1) -+#define BIT_RXDATAIN0_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_CHK_TSF_TA_8197F BIT(2) -+#define BIT_CHK_TSF_CBSSID_8197F BIT(1) -+#define BIT_CHK_TSF_EN_8197F BIT(0) -+ -+/* 2 REG_WOW_CTRL_8197F (WAKE ON WLAN CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_PSF_BSSIDSEL_B2B1_8197F 6 -+#define BIT_MASK_PSF_BSSIDSEL_B2B1_8197F 0x3 -+#define BIT_PSF_BSSIDSEL_B2B1_8197F(x) \ -+ (((x) & BIT_MASK_PSF_BSSIDSEL_B2B1_8197F) \ -+ << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8197F) -+#define BITS_PSF_BSSIDSEL_B2B1_8197F \ -+ (BIT_MASK_PSF_BSSIDSEL_B2B1_8197F << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8197F) -+#define BIT_CLEAR_PSF_BSSIDSEL_B2B1_8197F(x) \ -+ ((x) & (~BITS_PSF_BSSIDSEL_B2B1_8197F)) -+#define BIT_GET_PSF_BSSIDSEL_B2B1_8197F(x) \ -+ (((x) >> BIT_SHIFT_PSF_BSSIDSEL_B2B1_8197F) & \ -+ BIT_MASK_PSF_BSSIDSEL_B2B1_8197F) -+#define BIT_SET_PSF_BSSIDSEL_B2B1_8197F(x, v) \ -+ (BIT_CLEAR_PSF_BSSIDSEL_B2B1_8197F(x) | BIT_PSF_BSSIDSEL_B2B1_8197F(v)) -+ -+#define BIT_WOWHCI_8197F BIT(5) -+#define BIT_PSF_BSSIDSEL_B0_8197F BIT(4) -+#define BIT_UWF_8197F BIT(3) -+#define BIT_MAGIC_8197F BIT(2) -+#define BIT_WOWEN_8197F BIT(1) -+#define BIT_FORCE_WAKEUP_8197F BIT(0) -+ -+/* 2 REG_LPNAV_CTRL_8197F (LOW POWER NAV CONTROL REGISTER) */ -+#define BIT_LPNAV_EN_8197F BIT(31) -+ -+#define BIT_SHIFT_LPNAV_EARLY_8197F 16 -+#define BIT_MASK_LPNAV_EARLY_8197F 0x7fff -+#define BIT_LPNAV_EARLY_8197F(x) \ -+ (((x) & BIT_MASK_LPNAV_EARLY_8197F) << BIT_SHIFT_LPNAV_EARLY_8197F) -+#define BITS_LPNAV_EARLY_8197F \ -+ (BIT_MASK_LPNAV_EARLY_8197F << BIT_SHIFT_LPNAV_EARLY_8197F) -+#define BIT_CLEAR_LPNAV_EARLY_8197F(x) ((x) & (~BITS_LPNAV_EARLY_8197F)) -+#define BIT_GET_LPNAV_EARLY_8197F(x) \ -+ (((x) >> BIT_SHIFT_LPNAV_EARLY_8197F) & BIT_MASK_LPNAV_EARLY_8197F) -+#define BIT_SET_LPNAV_EARLY_8197F(x, v) \ -+ (BIT_CLEAR_LPNAV_EARLY_8197F(x) | BIT_LPNAV_EARLY_8197F(v)) -+ -+#define BIT_SHIFT_LPNAV_TH_8197F 0 -+#define BIT_MASK_LPNAV_TH_8197F 0xffff -+#define BIT_LPNAV_TH_8197F(x) \ -+ (((x) & BIT_MASK_LPNAV_TH_8197F) << BIT_SHIFT_LPNAV_TH_8197F) -+#define BITS_LPNAV_TH_8197F \ -+ (BIT_MASK_LPNAV_TH_8197F << BIT_SHIFT_LPNAV_TH_8197F) -+#define BIT_CLEAR_LPNAV_TH_8197F(x) ((x) & (~BITS_LPNAV_TH_8197F)) -+#define BIT_GET_LPNAV_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_LPNAV_TH_8197F) & BIT_MASK_LPNAV_TH_8197F) -+#define BIT_SET_LPNAV_TH_8197F(x, v) \ -+ (BIT_CLEAR_LPNAV_TH_8197F(x) | BIT_LPNAV_TH_8197F(v)) -+ -+/* 2 REG_WKFMCAM_CMD_8197F (WAKEUP FRAME CAM COMMAND REGISTER) */ -+#define BIT_WKFCAM_POLLING_V1_8197F BIT(31) -+#define BIT_WKFCAM_CLR_V1_8197F BIT(30) -+#define BIT_WKFCAM_WE_8197F BIT(16) -+ -+#define BIT_SHIFT_WKFCAM_ADDR_V2_8197F 8 -+#define BIT_MASK_WKFCAM_ADDR_V2_8197F 0xff -+#define BIT_WKFCAM_ADDR_V2_8197F(x) \ -+ (((x) & BIT_MASK_WKFCAM_ADDR_V2_8197F) \ -+ << BIT_SHIFT_WKFCAM_ADDR_V2_8197F) -+#define BITS_WKFCAM_ADDR_V2_8197F \ -+ (BIT_MASK_WKFCAM_ADDR_V2_8197F << BIT_SHIFT_WKFCAM_ADDR_V2_8197F) -+#define BIT_CLEAR_WKFCAM_ADDR_V2_8197F(x) ((x) & (~BITS_WKFCAM_ADDR_V2_8197F)) -+#define BIT_GET_WKFCAM_ADDR_V2_8197F(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_ADDR_V2_8197F) & \ -+ BIT_MASK_WKFCAM_ADDR_V2_8197F) -+#define BIT_SET_WKFCAM_ADDR_V2_8197F(x, v) \ -+ (BIT_CLEAR_WKFCAM_ADDR_V2_8197F(x) | BIT_WKFCAM_ADDR_V2_8197F(v)) -+ -+#define BIT_SHIFT_WKFCAM_CAM_NUM_V1_8197F 0 -+#define BIT_MASK_WKFCAM_CAM_NUM_V1_8197F 0xff -+#define BIT_WKFCAM_CAM_NUM_V1_8197F(x) \ -+ (((x) & BIT_MASK_WKFCAM_CAM_NUM_V1_8197F) \ -+ << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8197F) -+#define BITS_WKFCAM_CAM_NUM_V1_8197F \ -+ (BIT_MASK_WKFCAM_CAM_NUM_V1_8197F << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8197F) -+#define BIT_CLEAR_WKFCAM_CAM_NUM_V1_8197F(x) \ -+ ((x) & (~BITS_WKFCAM_CAM_NUM_V1_8197F)) -+#define BIT_GET_WKFCAM_CAM_NUM_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_CAM_NUM_V1_8197F) & \ -+ BIT_MASK_WKFCAM_CAM_NUM_V1_8197F) -+#define BIT_SET_WKFCAM_CAM_NUM_V1_8197F(x, v) \ -+ (BIT_CLEAR_WKFCAM_CAM_NUM_V1_8197F(x) | BIT_WKFCAM_CAM_NUM_V1_8197F(v)) -+ -+/* 2 REG_WKFMCAM_RWD_8197F (WAKEUP FRAME READ/WRITE DATA) */ -+ -+#define BIT_SHIFT_WKFMCAM_RWD_8197F 0 -+#define BIT_MASK_WKFMCAM_RWD_8197F 0xffffffffL -+#define BIT_WKFMCAM_RWD_8197F(x) \ -+ (((x) & BIT_MASK_WKFMCAM_RWD_8197F) << BIT_SHIFT_WKFMCAM_RWD_8197F) -+#define BITS_WKFMCAM_RWD_8197F \ -+ (BIT_MASK_WKFMCAM_RWD_8197F << BIT_SHIFT_WKFMCAM_RWD_8197F) -+#define BIT_CLEAR_WKFMCAM_RWD_8197F(x) ((x) & (~BITS_WKFMCAM_RWD_8197F)) -+#define BIT_GET_WKFMCAM_RWD_8197F(x) \ -+ (((x) >> BIT_SHIFT_WKFMCAM_RWD_8197F) & BIT_MASK_WKFMCAM_RWD_8197F) -+#define BIT_SET_WKFMCAM_RWD_8197F(x, v) \ -+ (BIT_CLEAR_WKFMCAM_RWD_8197F(x) | BIT_WKFMCAM_RWD_8197F(v)) -+ -+/* 2 REG_RXFLTMAP1_8197F (RX FILTER MAP GROUP 1) */ -+#define BIT_CTRLFLT15EN_8197F BIT(15) -+#define BIT_CTRLFLT14EN_8197F BIT(14) -+#define BIT_CTRLFLT13EN_8197F BIT(13) -+#define BIT_CTRLFLT12EN_8197F BIT(12) -+#define BIT_CTRLFLT11EN_8197F BIT(11) -+#define BIT_CTRLFLT10EN_8197F BIT(10) -+#define BIT_CTRLFLT9EN_8197F BIT(9) -+#define BIT_CTRLFLT8EN_8197F BIT(8) -+#define BIT_CTRLFLT7EN_8197F BIT(7) -+#define BIT_CTRLFLT6EN_8197F BIT(6) -+#define BIT_CTRLFLT5EN_8197F BIT(5) -+#define BIT_CTRLFLT4EN_8197F BIT(4) -+#define BIT_CTRLFLT3EN_8197F BIT(3) -+#define BIT_CTRLFLT2EN_8197F BIT(2) -+#define BIT_CTRLFLT1EN_8197F BIT(1) -+#define BIT_CTRLFLT0EN_8197F BIT(0) -+ -+/* 2 REG_RXFLTMAP0_8197F (RX FILTER MAP GROUP 0) */ -+#define BIT_MGTFLT15EN_8197F BIT(15) -+#define BIT_MGTFLT14EN_8197F BIT(14) -+#define BIT_MGTFLT13EN_8197F BIT(13) -+#define BIT_MGTFLT12EN_8197F BIT(12) -+#define BIT_MGTFLT11EN_8197F BIT(11) -+#define BIT_MGTFLT10EN_8197F BIT(10) -+#define BIT_MGTFLT9EN_8197F BIT(9) -+#define BIT_MGTFLT8EN_8197F BIT(8) -+#define BIT_MGTFLT7EN_8197F BIT(7) -+#define BIT_MGTFLT6EN_8197F BIT(6) -+#define BIT_MGTFLT5EN_8197F BIT(5) -+#define BIT_MGTFLT4EN_8197F BIT(4) -+#define BIT_MGTFLT3EN_8197F BIT(3) -+#define BIT_MGTFLT2EN_8197F BIT(2) -+#define BIT_MGTFLT1EN_8197F BIT(1) -+#define BIT_MGTFLT0EN_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_RXFLTMAP_8197F (RX FILTER MAP GROUP 2) */ -+#define BIT_DATAFLT15EN_8197F BIT(15) -+#define BIT_DATAFLT14EN_8197F BIT(14) -+#define BIT_DATAFLT13EN_8197F BIT(13) -+#define BIT_DATAFLT12EN_8197F BIT(12) -+#define BIT_DATAFLT11EN_8197F BIT(11) -+#define BIT_DATAFLT10EN_8197F BIT(10) -+#define BIT_DATAFLT9EN_8197F BIT(9) -+#define BIT_DATAFLT8EN_8197F BIT(8) -+#define BIT_DATAFLT7EN_8197F BIT(7) -+#define BIT_DATAFLT6EN_8197F BIT(6) -+#define BIT_DATAFLT5EN_8197F BIT(5) -+#define BIT_DATAFLT4EN_8197F BIT(4) -+#define BIT_DATAFLT3EN_8197F BIT(3) -+#define BIT_DATAFLT2EN_8197F BIT(2) -+#define BIT_DATAFLT1EN_8197F BIT(1) -+#define BIT_DATAFLT0EN_8197F BIT(0) -+ -+/* 2 REG_BCN_PSR_RPT_8197F (BEACON PARSER REPORT REGISTER) */ -+ -+#define BIT_SHIFT_DTIM_CNT_8197F 24 -+#define BIT_MASK_DTIM_CNT_8197F 0xff -+#define BIT_DTIM_CNT_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_CNT_8197F) << BIT_SHIFT_DTIM_CNT_8197F) -+#define BITS_DTIM_CNT_8197F \ -+ (BIT_MASK_DTIM_CNT_8197F << BIT_SHIFT_DTIM_CNT_8197F) -+#define BIT_CLEAR_DTIM_CNT_8197F(x) ((x) & (~BITS_DTIM_CNT_8197F)) -+#define BIT_GET_DTIM_CNT_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT_8197F) & BIT_MASK_DTIM_CNT_8197F) -+#define BIT_SET_DTIM_CNT_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_CNT_8197F(x) | BIT_DTIM_CNT_8197F(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD_8197F 16 -+#define BIT_MASK_DTIM_PERIOD_8197F 0xff -+#define BIT_DTIM_PERIOD_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD_8197F) << BIT_SHIFT_DTIM_PERIOD_8197F) -+#define BITS_DTIM_PERIOD_8197F \ -+ (BIT_MASK_DTIM_PERIOD_8197F << BIT_SHIFT_DTIM_PERIOD_8197F) -+#define BIT_CLEAR_DTIM_PERIOD_8197F(x) ((x) & (~BITS_DTIM_PERIOD_8197F)) -+#define BIT_GET_DTIM_PERIOD_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD_8197F) & BIT_MASK_DTIM_PERIOD_8197F) -+#define BIT_SET_DTIM_PERIOD_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD_8197F(x) | BIT_DTIM_PERIOD_8197F(v)) -+ -+#define BIT_DTIM_8197F BIT(15) -+#define BIT_TIM_8197F BIT(14) -+ -+#define BIT_SHIFT_PS_AID_0_8197F 0 -+#define BIT_MASK_PS_AID_0_8197F 0x7ff -+#define BIT_PS_AID_0_8197F(x) \ -+ (((x) & BIT_MASK_PS_AID_0_8197F) << BIT_SHIFT_PS_AID_0_8197F) -+#define BITS_PS_AID_0_8197F \ -+ (BIT_MASK_PS_AID_0_8197F << BIT_SHIFT_PS_AID_0_8197F) -+#define BIT_CLEAR_PS_AID_0_8197F(x) ((x) & (~BITS_PS_AID_0_8197F)) -+#define BIT_GET_PS_AID_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_0_8197F) & BIT_MASK_PS_AID_0_8197F) -+#define BIT_SET_PS_AID_0_8197F(x, v) \ -+ (BIT_CLEAR_PS_AID_0_8197F(x) | BIT_PS_AID_0_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_FLC_RPCT_V1_8197F BIT(7) -+#define BIT_MODE_8197F BIT(6) -+ -+#define BIT_SHIFT_TRPCD_8197F 0 -+#define BIT_MASK_TRPCD_8197F 0x3f -+#define BIT_TRPCD_8197F(x) \ -+ (((x) & BIT_MASK_TRPCD_8197F) << BIT_SHIFT_TRPCD_8197F) -+#define BITS_TRPCD_8197F (BIT_MASK_TRPCD_8197F << BIT_SHIFT_TRPCD_8197F) -+#define BIT_CLEAR_TRPCD_8197F(x) ((x) & (~BITS_TRPCD_8197F)) -+#define BIT_GET_TRPCD_8197F(x) \ -+ (((x) >> BIT_SHIFT_TRPCD_8197F) & BIT_MASK_TRPCD_8197F) -+#define BIT_SET_TRPCD_8197F(x, v) \ -+ (BIT_CLEAR_TRPCD_8197F(x) | BIT_TRPCD_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_CMF_8197F BIT(2) -+#define BIT_CCF_8197F BIT(1) -+#define BIT_CDF_8197F BIT(0) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_FLC_RPCT_8197F 0 -+#define BIT_MASK_FLC_RPCT_8197F 0xff -+#define BIT_FLC_RPCT_8197F(x) \ -+ (((x) & BIT_MASK_FLC_RPCT_8197F) << BIT_SHIFT_FLC_RPCT_8197F) -+#define BITS_FLC_RPCT_8197F \ -+ (BIT_MASK_FLC_RPCT_8197F << BIT_SHIFT_FLC_RPCT_8197F) -+#define BIT_CLEAR_FLC_RPCT_8197F(x) ((x) & (~BITS_FLC_RPCT_8197F)) -+#define BIT_GET_FLC_RPCT_8197F(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPCT_8197F) & BIT_MASK_FLC_RPCT_8197F) -+#define BIT_SET_FLC_RPCT_8197F(x, v) \ -+ (BIT_CLEAR_FLC_RPCT_8197F(x) | BIT_FLC_RPCT_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#define BIT_SHIFT_FLC_RPC_8197F 0 -+#define BIT_MASK_FLC_RPC_8197F 0xff -+#define BIT_FLC_RPC_8197F(x) \ -+ (((x) & BIT_MASK_FLC_RPC_8197F) << BIT_SHIFT_FLC_RPC_8197F) -+#define BITS_FLC_RPC_8197F (BIT_MASK_FLC_RPC_8197F << BIT_SHIFT_FLC_RPC_8197F) -+#define BIT_CLEAR_FLC_RPC_8197F(x) ((x) & (~BITS_FLC_RPC_8197F)) -+#define BIT_GET_FLC_RPC_8197F(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPC_8197F) & BIT_MASK_FLC_RPC_8197F) -+#define BIT_SET_FLC_RPC_8197F(x, v) \ -+ (BIT_CLEAR_FLC_RPC_8197F(x) | BIT_FLC_RPC_8197F(v)) -+ -+/* 2 REG_RXPKTMON_CTRL_8197F */ -+ -+#define BIT_SHIFT_RXBKQPKT_SEQ_8197F 20 -+#define BIT_MASK_RXBKQPKT_SEQ_8197F 0xf -+#define BIT_RXBKQPKT_SEQ_8197F(x) \ -+ (((x) & BIT_MASK_RXBKQPKT_SEQ_8197F) << BIT_SHIFT_RXBKQPKT_SEQ_8197F) -+#define BITS_RXBKQPKT_SEQ_8197F \ -+ (BIT_MASK_RXBKQPKT_SEQ_8197F << BIT_SHIFT_RXBKQPKT_SEQ_8197F) -+#define BIT_CLEAR_RXBKQPKT_SEQ_8197F(x) ((x) & (~BITS_RXBKQPKT_SEQ_8197F)) -+#define BIT_GET_RXBKQPKT_SEQ_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXBKQPKT_SEQ_8197F) & BIT_MASK_RXBKQPKT_SEQ_8197F) -+#define BIT_SET_RXBKQPKT_SEQ_8197F(x, v) \ -+ (BIT_CLEAR_RXBKQPKT_SEQ_8197F(x) | BIT_RXBKQPKT_SEQ_8197F(v)) -+ -+#define BIT_SHIFT_RXBEQPKT_SEQ_8197F 16 -+#define BIT_MASK_RXBEQPKT_SEQ_8197F 0xf -+#define BIT_RXBEQPKT_SEQ_8197F(x) \ -+ (((x) & BIT_MASK_RXBEQPKT_SEQ_8197F) << BIT_SHIFT_RXBEQPKT_SEQ_8197F) -+#define BITS_RXBEQPKT_SEQ_8197F \ -+ (BIT_MASK_RXBEQPKT_SEQ_8197F << BIT_SHIFT_RXBEQPKT_SEQ_8197F) -+#define BIT_CLEAR_RXBEQPKT_SEQ_8197F(x) ((x) & (~BITS_RXBEQPKT_SEQ_8197F)) -+#define BIT_GET_RXBEQPKT_SEQ_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXBEQPKT_SEQ_8197F) & BIT_MASK_RXBEQPKT_SEQ_8197F) -+#define BIT_SET_RXBEQPKT_SEQ_8197F(x, v) \ -+ (BIT_CLEAR_RXBEQPKT_SEQ_8197F(x) | BIT_RXBEQPKT_SEQ_8197F(v)) -+ -+#define BIT_SHIFT_RXVIQPKT_SEQ_8197F 12 -+#define BIT_MASK_RXVIQPKT_SEQ_8197F 0xf -+#define BIT_RXVIQPKT_SEQ_8197F(x) \ -+ (((x) & BIT_MASK_RXVIQPKT_SEQ_8197F) << BIT_SHIFT_RXVIQPKT_SEQ_8197F) -+#define BITS_RXVIQPKT_SEQ_8197F \ -+ (BIT_MASK_RXVIQPKT_SEQ_8197F << BIT_SHIFT_RXVIQPKT_SEQ_8197F) -+#define BIT_CLEAR_RXVIQPKT_SEQ_8197F(x) ((x) & (~BITS_RXVIQPKT_SEQ_8197F)) -+#define BIT_GET_RXVIQPKT_SEQ_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXVIQPKT_SEQ_8197F) & BIT_MASK_RXVIQPKT_SEQ_8197F) -+#define BIT_SET_RXVIQPKT_SEQ_8197F(x, v) \ -+ (BIT_CLEAR_RXVIQPKT_SEQ_8197F(x) | BIT_RXVIQPKT_SEQ_8197F(v)) -+ -+#define BIT_SHIFT_RXVOQPKT_SEQ_8197F 8 -+#define BIT_MASK_RXVOQPKT_SEQ_8197F 0xf -+#define BIT_RXVOQPKT_SEQ_8197F(x) \ -+ (((x) & BIT_MASK_RXVOQPKT_SEQ_8197F) << BIT_SHIFT_RXVOQPKT_SEQ_8197F) -+#define BITS_RXVOQPKT_SEQ_8197F \ -+ (BIT_MASK_RXVOQPKT_SEQ_8197F << BIT_SHIFT_RXVOQPKT_SEQ_8197F) -+#define BIT_CLEAR_RXVOQPKT_SEQ_8197F(x) ((x) & (~BITS_RXVOQPKT_SEQ_8197F)) -+#define BIT_GET_RXVOQPKT_SEQ_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXVOQPKT_SEQ_8197F) & BIT_MASK_RXVOQPKT_SEQ_8197F) -+#define BIT_SET_RXVOQPKT_SEQ_8197F(x, v) \ -+ (BIT_CLEAR_RXVOQPKT_SEQ_8197F(x) | BIT_RXVOQPKT_SEQ_8197F(v)) -+ -+#define BIT_RXBKQPKT_ERR_8197F BIT(7) -+#define BIT_RXBEQPKT_ERR_8197F BIT(6) -+#define BIT_RXVIQPKT_ERR_8197F BIT(5) -+#define BIT_RXVOQPKT_ERR_8197F BIT(4) -+#define BIT_RXDMA_MON_EN_8197F BIT(2) -+#define BIT_RXPKT_MON_RST_8197F BIT(1) -+#define BIT_RXPKT_MON_EN_8197F BIT(0) -+ -+/* 2 REG_STATE_MON_8197F */ -+ -+#define BIT_SHIFT_STATE_SEL_8197F 24 -+#define BIT_MASK_STATE_SEL_8197F 0x1f -+#define BIT_STATE_SEL_8197F(x) \ -+ (((x) & BIT_MASK_STATE_SEL_8197F) << BIT_SHIFT_STATE_SEL_8197F) -+#define BITS_STATE_SEL_8197F \ -+ (BIT_MASK_STATE_SEL_8197F << BIT_SHIFT_STATE_SEL_8197F) -+#define BIT_CLEAR_STATE_SEL_8197F(x) ((x) & (~BITS_STATE_SEL_8197F)) -+#define BIT_GET_STATE_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_STATE_SEL_8197F) & BIT_MASK_STATE_SEL_8197F) -+#define BIT_SET_STATE_SEL_8197F(x, v) \ -+ (BIT_CLEAR_STATE_SEL_8197F(x) | BIT_STATE_SEL_8197F(v)) -+ -+#define BIT_SHIFT_STATE_INFO_8197F 8 -+#define BIT_MASK_STATE_INFO_8197F 0xff -+#define BIT_STATE_INFO_8197F(x) \ -+ (((x) & BIT_MASK_STATE_INFO_8197F) << BIT_SHIFT_STATE_INFO_8197F) -+#define BITS_STATE_INFO_8197F \ -+ (BIT_MASK_STATE_INFO_8197F << BIT_SHIFT_STATE_INFO_8197F) -+#define BIT_CLEAR_STATE_INFO_8197F(x) ((x) & (~BITS_STATE_INFO_8197F)) -+#define BIT_GET_STATE_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_STATE_INFO_8197F) & BIT_MASK_STATE_INFO_8197F) -+#define BIT_SET_STATE_INFO_8197F(x, v) \ -+ (BIT_CLEAR_STATE_INFO_8197F(x) | BIT_STATE_INFO_8197F(v)) -+ -+#define BIT_UPD_NXT_STATE_8197F BIT(7) -+ -+#define BIT_SHIFT_CUR_STATE_8197F 0 -+#define BIT_MASK_CUR_STATE_8197F 0x7f -+#define BIT_CUR_STATE_8197F(x) \ -+ (((x) & BIT_MASK_CUR_STATE_8197F) << BIT_SHIFT_CUR_STATE_8197F) -+#define BITS_CUR_STATE_8197F \ -+ (BIT_MASK_CUR_STATE_8197F << BIT_SHIFT_CUR_STATE_8197F) -+#define BIT_CLEAR_CUR_STATE_8197F(x) ((x) & (~BITS_CUR_STATE_8197F)) -+#define BIT_GET_CUR_STATE_8197F(x) \ -+ (((x) >> BIT_SHIFT_CUR_STATE_8197F) & BIT_MASK_CUR_STATE_8197F) -+#define BIT_SET_CUR_STATE_8197F(x, v) \ -+ (BIT_CLEAR_CUR_STATE_8197F(x) | BIT_CUR_STATE_8197F(v)) -+ -+/* 2 REG_ERROR_MON_8197F */ -+#define BIT_MACRX_ERR_1_8197F BIT(17) -+#define BIT_MACRX_ERR_0_8197F BIT(16) -+#define BIT_MACTX_ERR_3_8197F BIT(3) -+#define BIT_MACTX_ERR_2_8197F BIT(2) -+#define BIT_MACTX_ERR_1_8197F BIT(1) -+#define BIT_MACTX_ERR_0_8197F BIT(0) -+ -+/* 2 REG_SEARCH_MACID_8197F */ -+#define BIT_EN_TXRPTBUF_CLK_8197F BIT(31) -+ -+#define BIT_SHIFT_INFO_INDEX_OFFSET_8197F 16 -+#define BIT_MASK_INFO_INDEX_OFFSET_8197F 0x1fff -+#define BIT_INFO_INDEX_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_INFO_INDEX_OFFSET_8197F) \ -+ << BIT_SHIFT_INFO_INDEX_OFFSET_8197F) -+#define BITS_INFO_INDEX_OFFSET_8197F \ -+ (BIT_MASK_INFO_INDEX_OFFSET_8197F << BIT_SHIFT_INFO_INDEX_OFFSET_8197F) -+#define BIT_CLEAR_INFO_INDEX_OFFSET_8197F(x) \ -+ ((x) & (~BITS_INFO_INDEX_OFFSET_8197F)) -+#define BIT_GET_INFO_INDEX_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_INFO_INDEX_OFFSET_8197F) & \ -+ BIT_MASK_INFO_INDEX_OFFSET_8197F) -+#define BIT_SET_INFO_INDEX_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_INFO_INDEX_OFFSET_8197F(x) | BIT_INFO_INDEX_OFFSET_8197F(v)) -+ -+#define BIT_DIS_INFOSRCH_8197F BIT(14) -+#define BIT_DISABLE_B0_8197F BIT(13) -+ -+#define BIT_SHIFT_INFO_ADDR_OFFSET_8197F 0 -+#define BIT_MASK_INFO_ADDR_OFFSET_8197F 0x1fff -+#define BIT_INFO_ADDR_OFFSET_8197F(x) \ -+ (((x) & BIT_MASK_INFO_ADDR_OFFSET_8197F) \ -+ << BIT_SHIFT_INFO_ADDR_OFFSET_8197F) -+#define BITS_INFO_ADDR_OFFSET_8197F \ -+ (BIT_MASK_INFO_ADDR_OFFSET_8197F << BIT_SHIFT_INFO_ADDR_OFFSET_8197F) -+#define BIT_CLEAR_INFO_ADDR_OFFSET_8197F(x) \ -+ ((x) & (~BITS_INFO_ADDR_OFFSET_8197F)) -+#define BIT_GET_INFO_ADDR_OFFSET_8197F(x) \ -+ (((x) >> BIT_SHIFT_INFO_ADDR_OFFSET_8197F) & \ -+ BIT_MASK_INFO_ADDR_OFFSET_8197F) -+#define BIT_SET_INFO_ADDR_OFFSET_8197F(x, v) \ -+ (BIT_CLEAR_INFO_ADDR_OFFSET_8197F(x) | BIT_INFO_ADDR_OFFSET_8197F(v)) -+ -+/* 2 REG_BT_COEX_TABLE_8197F (BT-COEXISTENCE CONTROL REGISTER) */ -+#define BIT_PRI_MASK_RX_RESP_8197F BIT(126) -+#define BIT_PRI_MASK_RXOFDM_8197F BIT(125) -+#define BIT_PRI_MASK_RXCCK_8197F BIT(124) -+ -+#define BIT_SHIFT_PRI_MASK_TXAC_8197F (117 & CPU_OPT_WIDTH) -+#define BIT_MASK_PRI_MASK_TXAC_8197F 0x7f -+#define BIT_PRI_MASK_TXAC_8197F(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TXAC_8197F) << BIT_SHIFT_PRI_MASK_TXAC_8197F) -+#define BITS_PRI_MASK_TXAC_8197F \ -+ (BIT_MASK_PRI_MASK_TXAC_8197F << BIT_SHIFT_PRI_MASK_TXAC_8197F) -+#define BIT_CLEAR_PRI_MASK_TXAC_8197F(x) ((x) & (~BITS_PRI_MASK_TXAC_8197F)) -+#define BIT_GET_PRI_MASK_TXAC_8197F(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TXAC_8197F) & BIT_MASK_PRI_MASK_TXAC_8197F) -+#define BIT_SET_PRI_MASK_TXAC_8197F(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TXAC_8197F(x) | BIT_PRI_MASK_TXAC_8197F(v)) -+ -+#define BIT_SHIFT_PRI_MASK_NAV_8197F (109 & CPU_OPT_WIDTH) -+#define BIT_MASK_PRI_MASK_NAV_8197F 0xff -+#define BIT_PRI_MASK_NAV_8197F(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NAV_8197F) << BIT_SHIFT_PRI_MASK_NAV_8197F) -+#define BITS_PRI_MASK_NAV_8197F \ -+ (BIT_MASK_PRI_MASK_NAV_8197F << BIT_SHIFT_PRI_MASK_NAV_8197F) -+#define BIT_CLEAR_PRI_MASK_NAV_8197F(x) ((x) & (~BITS_PRI_MASK_NAV_8197F)) -+#define BIT_GET_PRI_MASK_NAV_8197F(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NAV_8197F) & BIT_MASK_PRI_MASK_NAV_8197F) -+#define BIT_SET_PRI_MASK_NAV_8197F(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NAV_8197F(x) | BIT_PRI_MASK_NAV_8197F(v)) -+ -+#define BIT_PRI_MASK_CCK_8197F BIT(108) -+#define BIT_PRI_MASK_OFDM_8197F BIT(107) -+#define BIT_PRI_MASK_RTY_8197F BIT(106) -+ -+#define BIT_SHIFT_PRI_MASK_NUM_8197F (102 & CPU_OPT_WIDTH) -+#define BIT_MASK_PRI_MASK_NUM_8197F 0xf -+#define BIT_PRI_MASK_NUM_8197F(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NUM_8197F) << BIT_SHIFT_PRI_MASK_NUM_8197F) -+#define BITS_PRI_MASK_NUM_8197F \ -+ (BIT_MASK_PRI_MASK_NUM_8197F << BIT_SHIFT_PRI_MASK_NUM_8197F) -+#define BIT_CLEAR_PRI_MASK_NUM_8197F(x) ((x) & (~BITS_PRI_MASK_NUM_8197F)) -+#define BIT_GET_PRI_MASK_NUM_8197F(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NUM_8197F) & BIT_MASK_PRI_MASK_NUM_8197F) -+#define BIT_SET_PRI_MASK_NUM_8197F(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NUM_8197F(x) | BIT_PRI_MASK_NUM_8197F(v)) -+ -+#define BIT_SHIFT_PRI_MASK_TYPE_8197F (98 & CPU_OPT_WIDTH) -+#define BIT_MASK_PRI_MASK_TYPE_8197F 0xf -+#define BIT_PRI_MASK_TYPE_8197F(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TYPE_8197F) << BIT_SHIFT_PRI_MASK_TYPE_8197F) -+#define BITS_PRI_MASK_TYPE_8197F \ -+ (BIT_MASK_PRI_MASK_TYPE_8197F << BIT_SHIFT_PRI_MASK_TYPE_8197F) -+#define BIT_CLEAR_PRI_MASK_TYPE_8197F(x) ((x) & (~BITS_PRI_MASK_TYPE_8197F)) -+#define BIT_GET_PRI_MASK_TYPE_8197F(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TYPE_8197F) & BIT_MASK_PRI_MASK_TYPE_8197F) -+#define BIT_SET_PRI_MASK_TYPE_8197F(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TYPE_8197F(x) | BIT_PRI_MASK_TYPE_8197F(v)) -+ -+#define BIT_OOB_8197F BIT(97) -+#define BIT_ANT_SEL_8197F BIT(96) -+ -+#define BIT_SHIFT_BREAK_TABLE_2_8197F (80 & CPU_OPT_WIDTH) -+#define BIT_MASK_BREAK_TABLE_2_8197F 0xffff -+#define BIT_BREAK_TABLE_2_8197F(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_2_8197F) << BIT_SHIFT_BREAK_TABLE_2_8197F) -+#define BITS_BREAK_TABLE_2_8197F \ -+ (BIT_MASK_BREAK_TABLE_2_8197F << BIT_SHIFT_BREAK_TABLE_2_8197F) -+#define BIT_CLEAR_BREAK_TABLE_2_8197F(x) ((x) & (~BITS_BREAK_TABLE_2_8197F)) -+#define BIT_GET_BREAK_TABLE_2_8197F(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_2_8197F) & BIT_MASK_BREAK_TABLE_2_8197F) -+#define BIT_SET_BREAK_TABLE_2_8197F(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_2_8197F(x) | BIT_BREAK_TABLE_2_8197F(v)) -+ -+#define BIT_SHIFT_BREAK_TABLE_1_8197F (64 & CPU_OPT_WIDTH) -+#define BIT_MASK_BREAK_TABLE_1_8197F 0xffff -+#define BIT_BREAK_TABLE_1_8197F(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_1_8197F) << BIT_SHIFT_BREAK_TABLE_1_8197F) -+#define BITS_BREAK_TABLE_1_8197F \ -+ (BIT_MASK_BREAK_TABLE_1_8197F << BIT_SHIFT_BREAK_TABLE_1_8197F) -+#define BIT_CLEAR_BREAK_TABLE_1_8197F(x) ((x) & (~BITS_BREAK_TABLE_1_8197F)) -+#define BIT_GET_BREAK_TABLE_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_1_8197F) & BIT_MASK_BREAK_TABLE_1_8197F) -+#define BIT_SET_BREAK_TABLE_1_8197F(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_1_8197F(x) | BIT_BREAK_TABLE_1_8197F(v)) -+ -+#define BIT_SHIFT_COEX_TABLE_2_8197F (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_COEX_TABLE_2_8197F 0xffffffffL -+#define BIT_COEX_TABLE_2_8197F(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_2_8197F) << BIT_SHIFT_COEX_TABLE_2_8197F) -+#define BITS_COEX_TABLE_2_8197F \ -+ (BIT_MASK_COEX_TABLE_2_8197F << BIT_SHIFT_COEX_TABLE_2_8197F) -+#define BIT_CLEAR_COEX_TABLE_2_8197F(x) ((x) & (~BITS_COEX_TABLE_2_8197F)) -+#define BIT_GET_COEX_TABLE_2_8197F(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_2_8197F) & BIT_MASK_COEX_TABLE_2_8197F) -+#define BIT_SET_COEX_TABLE_2_8197F(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_2_8197F(x) | BIT_COEX_TABLE_2_8197F(v)) -+ -+#define BIT_SHIFT_COEX_TABLE_1_8197F 0 -+#define BIT_MASK_COEX_TABLE_1_8197F 0xffffffffL -+#define BIT_COEX_TABLE_1_8197F(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_1_8197F) << BIT_SHIFT_COEX_TABLE_1_8197F) -+#define BITS_COEX_TABLE_1_8197F \ -+ (BIT_MASK_COEX_TABLE_1_8197F << BIT_SHIFT_COEX_TABLE_1_8197F) -+#define BIT_CLEAR_COEX_TABLE_1_8197F(x) ((x) & (~BITS_COEX_TABLE_1_8197F)) -+#define BIT_GET_COEX_TABLE_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_1_8197F) & BIT_MASK_COEX_TABLE_1_8197F) -+#define BIT_SET_COEX_TABLE_1_8197F(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_1_8197F(x) | BIT_COEX_TABLE_1_8197F(v)) -+ -+/* 2 REG_RXCMD_0_8197F */ -+#define BIT_RXCMD_EN_8197F BIT(31) -+ -+#define BIT_SHIFT_RXCMD_INFO_8197F 0 -+#define BIT_MASK_RXCMD_INFO_8197F 0x7fffffffL -+#define BIT_RXCMD_INFO_8197F(x) \ -+ (((x) & BIT_MASK_RXCMD_INFO_8197F) << BIT_SHIFT_RXCMD_INFO_8197F) -+#define BITS_RXCMD_INFO_8197F \ -+ (BIT_MASK_RXCMD_INFO_8197F << BIT_SHIFT_RXCMD_INFO_8197F) -+#define BIT_CLEAR_RXCMD_INFO_8197F(x) ((x) & (~BITS_RXCMD_INFO_8197F)) -+#define BIT_GET_RXCMD_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_INFO_8197F) & BIT_MASK_RXCMD_INFO_8197F) -+#define BIT_SET_RXCMD_INFO_8197F(x, v) \ -+ (BIT_CLEAR_RXCMD_INFO_8197F(x) | BIT_RXCMD_INFO_8197F(v)) -+ -+/* 2 REG_RXCMD_1_8197F */ -+ -+#define BIT_SHIFT_RXCMD_PRD_8197F 0 -+#define BIT_MASK_RXCMD_PRD_8197F 0xffff -+#define BIT_RXCMD_PRD_8197F(x) \ -+ (((x) & BIT_MASK_RXCMD_PRD_8197F) << BIT_SHIFT_RXCMD_PRD_8197F) -+#define BITS_RXCMD_PRD_8197F \ -+ (BIT_MASK_RXCMD_PRD_8197F << BIT_SHIFT_RXCMD_PRD_8197F) -+#define BIT_CLEAR_RXCMD_PRD_8197F(x) ((x) & (~BITS_RXCMD_PRD_8197F)) -+#define BIT_GET_RXCMD_PRD_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_PRD_8197F) & BIT_MASK_RXCMD_PRD_8197F) -+#define BIT_SET_RXCMD_PRD_8197F(x, v) \ -+ (BIT_CLEAR_RXCMD_PRD_8197F(x) | BIT_RXCMD_PRD_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_WMAC_RESP_TXINFO_8197F (RESPONSE TXINFO REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_MFB_8197F 25 -+#define BIT_MASK_WMAC_RESP_MFB_8197F 0x7f -+#define BIT_WMAC_RESP_MFB_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_MFB_8197F) << BIT_SHIFT_WMAC_RESP_MFB_8197F) -+#define BITS_WMAC_RESP_MFB_8197F \ -+ (BIT_MASK_WMAC_RESP_MFB_8197F << BIT_SHIFT_WMAC_RESP_MFB_8197F) -+#define BIT_CLEAR_WMAC_RESP_MFB_8197F(x) ((x) & (~BITS_WMAC_RESP_MFB_8197F)) -+#define BIT_GET_WMAC_RESP_MFB_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_MFB_8197F) & BIT_MASK_WMAC_RESP_MFB_8197F) -+#define BIT_SET_WMAC_RESP_MFB_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_MFB_8197F(x) | BIT_WMAC_RESP_MFB_8197F(v)) -+ -+#define BIT_SHIFT_WMAC_ANTINF_SEL_8197F 23 -+#define BIT_MASK_WMAC_ANTINF_SEL_8197F 0x3 -+#define BIT_WMAC_ANTINF_SEL_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_ANTINF_SEL_8197F) \ -+ << BIT_SHIFT_WMAC_ANTINF_SEL_8197F) -+#define BITS_WMAC_ANTINF_SEL_8197F \ -+ (BIT_MASK_WMAC_ANTINF_SEL_8197F << BIT_SHIFT_WMAC_ANTINF_SEL_8197F) -+#define BIT_CLEAR_WMAC_ANTINF_SEL_8197F(x) ((x) & (~BITS_WMAC_ANTINF_SEL_8197F)) -+#define BIT_GET_WMAC_ANTINF_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTINF_SEL_8197F) & \ -+ BIT_MASK_WMAC_ANTINF_SEL_8197F) -+#define BIT_SET_WMAC_ANTINF_SEL_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_ANTINF_SEL_8197F(x) | BIT_WMAC_ANTINF_SEL_8197F(v)) -+ -+#define BIT_SHIFT_WMAC_ANTSEL_SEL_8197F 21 -+#define BIT_MASK_WMAC_ANTSEL_SEL_8197F 0x3 -+#define BIT_WMAC_ANTSEL_SEL_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_ANTSEL_SEL_8197F) \ -+ << BIT_SHIFT_WMAC_ANTSEL_SEL_8197F) -+#define BITS_WMAC_ANTSEL_SEL_8197F \ -+ (BIT_MASK_WMAC_ANTSEL_SEL_8197F << BIT_SHIFT_WMAC_ANTSEL_SEL_8197F) -+#define BIT_CLEAR_WMAC_ANTSEL_SEL_8197F(x) ((x) & (~BITS_WMAC_ANTSEL_SEL_8197F)) -+#define BIT_GET_WMAC_ANTSEL_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTSEL_SEL_8197F) & \ -+ BIT_MASK_WMAC_ANTSEL_SEL_8197F) -+#define BIT_SET_WMAC_ANTSEL_SEL_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_ANTSEL_SEL_8197F(x) | BIT_WMAC_ANTSEL_SEL_8197F(v)) -+ -+#define BIT_SHIFT_R_WMAC_RESP_TXPOWER_8197F 18 -+#define BIT_MASK_R_WMAC_RESP_TXPOWER_8197F 0x7 -+#define BIT_R_WMAC_RESP_TXPOWER_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_RESP_TXPOWER_8197F) \ -+ << BIT_SHIFT_R_WMAC_RESP_TXPOWER_8197F) -+#define BITS_R_WMAC_RESP_TXPOWER_8197F \ -+ (BIT_MASK_R_WMAC_RESP_TXPOWER_8197F \ -+ << BIT_SHIFT_R_WMAC_RESP_TXPOWER_8197F) -+#define BIT_CLEAR_R_WMAC_RESP_TXPOWER_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_RESP_TXPOWER_8197F)) -+#define BIT_GET_R_WMAC_RESP_TXPOWER_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RESP_TXPOWER_8197F) & \ -+ BIT_MASK_R_WMAC_RESP_TXPOWER_8197F) -+#define BIT_SET_R_WMAC_RESP_TXPOWER_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_RESP_TXPOWER_8197F(x) | \ -+ BIT_R_WMAC_RESP_TXPOWER_8197F(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXANT_8197F 0 -+#define BIT_MASK_WMAC_RESP_TXANT_8197F 0x3ffff -+#define BIT_WMAC_RESP_TXANT_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXANT_8197F) \ -+ << BIT_SHIFT_WMAC_RESP_TXANT_8197F) -+#define BITS_WMAC_RESP_TXANT_8197F \ -+ (BIT_MASK_WMAC_RESP_TXANT_8197F << BIT_SHIFT_WMAC_RESP_TXANT_8197F) -+#define BIT_CLEAR_WMAC_RESP_TXANT_8197F(x) ((x) & (~BITS_WMAC_RESP_TXANT_8197F)) -+#define BIT_GET_WMAC_RESP_TXANT_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXANT_8197F) & \ -+ BIT_MASK_WMAC_RESP_TXANT_8197F) -+#define BIT_SET_WMAC_RESP_TXANT_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXANT_8197F(x) | BIT_WMAC_RESP_TXANT_8197F(v)) -+ -+/* 2 REG_BBPSF_CTRL_8197F */ -+#define BIT_CTL_IDLE_CLR_CSI_RPT_8197F BIT(31) -+#define BIT_WMAC_USE_NDPARATE_8197F BIT(30) -+ -+#define BIT_SHIFT_WMAC_CSI_RATE_8197F 24 -+#define BIT_MASK_WMAC_CSI_RATE_8197F 0x3f -+#define BIT_WMAC_CSI_RATE_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_CSI_RATE_8197F) << BIT_SHIFT_WMAC_CSI_RATE_8197F) -+#define BITS_WMAC_CSI_RATE_8197F \ -+ (BIT_MASK_WMAC_CSI_RATE_8197F << BIT_SHIFT_WMAC_CSI_RATE_8197F) -+#define BIT_CLEAR_WMAC_CSI_RATE_8197F(x) ((x) & (~BITS_WMAC_CSI_RATE_8197F)) -+#define BIT_GET_WMAC_CSI_RATE_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_CSI_RATE_8197F) & BIT_MASK_WMAC_CSI_RATE_8197F) -+#define BIT_SET_WMAC_CSI_RATE_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_CSI_RATE_8197F(x) | BIT_WMAC_CSI_RATE_8197F(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXRATE_8197F 16 -+#define BIT_MASK_WMAC_RESP_TXRATE_8197F 0xff -+#define BIT_WMAC_RESP_TXRATE_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXRATE_8197F) \ -+ << BIT_SHIFT_WMAC_RESP_TXRATE_8197F) -+#define BITS_WMAC_RESP_TXRATE_8197F \ -+ (BIT_MASK_WMAC_RESP_TXRATE_8197F << BIT_SHIFT_WMAC_RESP_TXRATE_8197F) -+#define BIT_CLEAR_WMAC_RESP_TXRATE_8197F(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXRATE_8197F)) -+#define BIT_GET_WMAC_RESP_TXRATE_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXRATE_8197F) & \ -+ BIT_MASK_WMAC_RESP_TXRATE_8197F) -+#define BIT_SET_WMAC_RESP_TXRATE_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXRATE_8197F(x) | BIT_WMAC_RESP_TXRATE_8197F(v)) -+ -+#define BIT_BBPSF_MPDUCHKEN_8197F BIT(5) -+#define BIT_BBPSF_MHCHKEN_8197F BIT(4) -+#define BIT_BBPSF_ERRCHKEN_8197F BIT(3) -+ -+#define BIT_SHIFT_BBPSF_ERRTHR_8197F 0 -+#define BIT_MASK_BBPSF_ERRTHR_8197F 0x7 -+#define BIT_BBPSF_ERRTHR_8197F(x) \ -+ (((x) & BIT_MASK_BBPSF_ERRTHR_8197F) << BIT_SHIFT_BBPSF_ERRTHR_8197F) -+#define BITS_BBPSF_ERRTHR_8197F \ -+ (BIT_MASK_BBPSF_ERRTHR_8197F << BIT_SHIFT_BBPSF_ERRTHR_8197F) -+#define BIT_CLEAR_BBPSF_ERRTHR_8197F(x) ((x) & (~BITS_BBPSF_ERRTHR_8197F)) -+#define BIT_GET_BBPSF_ERRTHR_8197F(x) \ -+ (((x) >> BIT_SHIFT_BBPSF_ERRTHR_8197F) & BIT_MASK_BBPSF_ERRTHR_8197F) -+#define BIT_SET_BBPSF_ERRTHR_8197F(x, v) \ -+ (BIT_CLEAR_BBPSF_ERRTHR_8197F(x) | BIT_BBPSF_ERRTHR_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_P2P_RX_BCN_NOA_8197F (P2P RX BEACON NOA REGISTER) */ -+#define BIT_NOA_PARSER_EN_8197F BIT(15) -+ -+#define BIT_SHIFT_BSSID_SEL_V1_8197F 12 -+#define BIT_MASK_BSSID_SEL_V1_8197F 0x7 -+#define BIT_BSSID_SEL_V1_8197F(x) \ -+ (((x) & BIT_MASK_BSSID_SEL_V1_8197F) << BIT_SHIFT_BSSID_SEL_V1_8197F) -+#define BITS_BSSID_SEL_V1_8197F \ -+ (BIT_MASK_BSSID_SEL_V1_8197F << BIT_SHIFT_BSSID_SEL_V1_8197F) -+#define BIT_CLEAR_BSSID_SEL_V1_8197F(x) ((x) & (~BITS_BSSID_SEL_V1_8197F)) -+#define BIT_GET_BSSID_SEL_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BSSID_SEL_V1_8197F) & BIT_MASK_BSSID_SEL_V1_8197F) -+#define BIT_SET_BSSID_SEL_V1_8197F(x, v) \ -+ (BIT_CLEAR_BSSID_SEL_V1_8197F(x) | BIT_BSSID_SEL_V1_8197F(v)) -+ -+#define BIT_SHIFT_P2P_OUI_TYPE_8197F 0 -+#define BIT_MASK_P2P_OUI_TYPE_8197F 0xff -+#define BIT_P2P_OUI_TYPE_8197F(x) \ -+ (((x) & BIT_MASK_P2P_OUI_TYPE_8197F) << BIT_SHIFT_P2P_OUI_TYPE_8197F) -+#define BITS_P2P_OUI_TYPE_8197F \ -+ (BIT_MASK_P2P_OUI_TYPE_8197F << BIT_SHIFT_P2P_OUI_TYPE_8197F) -+#define BIT_CLEAR_P2P_OUI_TYPE_8197F(x) ((x) & (~BITS_P2P_OUI_TYPE_8197F)) -+#define BIT_GET_P2P_OUI_TYPE_8197F(x) \ -+ (((x) >> BIT_SHIFT_P2P_OUI_TYPE_8197F) & BIT_MASK_P2P_OUI_TYPE_8197F) -+#define BIT_SET_P2P_OUI_TYPE_8197F(x, v) \ -+ (BIT_CLEAR_P2P_OUI_TYPE_8197F(x) | BIT_P2P_OUI_TYPE_8197F(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_8197F (ASSOCIATED BEAMFORMER0 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID0_8197F (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_TXCSI_AID0_8197F 0x1ff -+#define BIT_R_WMAC_TXCSI_AID0_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID0_8197F) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID0_8197F) -+#define BITS_R_WMAC_TXCSI_AID0_8197F \ -+ (BIT_MASK_R_WMAC_TXCSI_AID0_8197F << BIT_SHIFT_R_WMAC_TXCSI_AID0_8197F) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID0_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID0_8197F)) -+#define BIT_GET_R_WMAC_TXCSI_AID0_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID0_8197F) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID0_8197F) -+#define BIT_SET_R_WMAC_TXCSI_AID0_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID0_8197F(x) | BIT_R_WMAC_TXCSI_AID0_8197F(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_8197F 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_8197F 0xffffffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_8197F) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_8197F) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_8197F \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_8197F \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_8197F) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_8197F)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_8197F) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_8197F) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_8197F(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_8197F(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_8197F (ASSOCIATED BEAMFORMER1 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID1_8197F (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_TXCSI_AID1_8197F 0x1ff -+#define BIT_R_WMAC_TXCSI_AID1_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID1_8197F) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID1_8197F) -+#define BITS_R_WMAC_TXCSI_AID1_8197F \ -+ (BIT_MASK_R_WMAC_TXCSI_AID1_8197F << BIT_SHIFT_R_WMAC_TXCSI_AID1_8197F) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID1_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID1_8197F)) -+#define BIT_GET_R_WMAC_TXCSI_AID1_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID1_8197F) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID1_8197F) -+#define BIT_SET_R_WMAC_TXCSI_AID1_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID1_8197F(x) | BIT_R_WMAC_TXCSI_AID1_8197F(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_8197F 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_8197F 0xffffffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_8197F) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_8197F) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_8197F \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_8197F \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_8197F) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_8197F)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_8197F) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_8197F) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_8197F(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW20_8197F (TX CSI REPORT PARAMETER_BW20 REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_1_8197F 16 -+#define BIT_MASK_R_WMAC_BFINFO_20M_1_8197F 0xfff -+#define BIT_R_WMAC_BFINFO_20M_1_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_1_8197F) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8197F) -+#define BITS_R_WMAC_BFINFO_20M_1_8197F \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_1_8197F \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8197F) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_1_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_1_8197F)) -+#define BIT_GET_R_WMAC_BFINFO_20M_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_1_8197F) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_1_8197F) -+#define BIT_SET_R_WMAC_BFINFO_20M_1_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_1_8197F(x) | \ -+ BIT_R_WMAC_BFINFO_20M_1_8197F(v)) -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_0_8197F 0 -+#define BIT_MASK_R_WMAC_BFINFO_20M_0_8197F 0xfff -+#define BIT_R_WMAC_BFINFO_20M_0_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_0_8197F) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8197F) -+#define BITS_R_WMAC_BFINFO_20M_0_8197F \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_0_8197F \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8197F) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_0_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_0_8197F)) -+#define BIT_GET_R_WMAC_BFINFO_20M_0_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_0_8197F) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_0_8197F) -+#define BIT_SET_R_WMAC_BFINFO_20M_0_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_0_8197F(x) | \ -+ BIT_R_WMAC_BFINFO_20M_0_8197F(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW40_8197F (TX CSI REPORT PARAMETER_BW40 REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_ANTCD_8197F 0 -+#define BIT_MASK_WMAC_RESP_ANTCD_8197F 0xf -+#define BIT_WMAC_RESP_ANTCD_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTCD_8197F) \ -+ << BIT_SHIFT_WMAC_RESP_ANTCD_8197F) -+#define BITS_WMAC_RESP_ANTCD_8197F \ -+ (BIT_MASK_WMAC_RESP_ANTCD_8197F << BIT_SHIFT_WMAC_RESP_ANTCD_8197F) -+#define BIT_CLEAR_WMAC_RESP_ANTCD_8197F(x) ((x) & (~BITS_WMAC_RESP_ANTCD_8197F)) -+#define BIT_GET_WMAC_RESP_ANTCD_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTCD_8197F) & \ -+ BIT_MASK_WMAC_RESP_ANTCD_8197F) -+#define BIT_SET_WMAC_RESP_ANTCD_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTCD_8197F(x) | BIT_WMAC_RESP_ANTCD_8197F(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW80_8197F (TX CSI REPORT PARAMETER_BW80 REGISTER) */ -+ -+/* 2 REG_BCN_PSR_RPT2_8197F (BEACON PARSER REPORT REGISTER2) */ -+ -+#define BIT_SHIFT_DTIM_CNT2_8197F 24 -+#define BIT_MASK_DTIM_CNT2_8197F 0xff -+#define BIT_DTIM_CNT2_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_CNT2_8197F) << BIT_SHIFT_DTIM_CNT2_8197F) -+#define BITS_DTIM_CNT2_8197F \ -+ (BIT_MASK_DTIM_CNT2_8197F << BIT_SHIFT_DTIM_CNT2_8197F) -+#define BIT_CLEAR_DTIM_CNT2_8197F(x) ((x) & (~BITS_DTIM_CNT2_8197F)) -+#define BIT_GET_DTIM_CNT2_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT2_8197F) & BIT_MASK_DTIM_CNT2_8197F) -+#define BIT_SET_DTIM_CNT2_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_CNT2_8197F(x) | BIT_DTIM_CNT2_8197F(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD2_8197F 16 -+#define BIT_MASK_DTIM_PERIOD2_8197F 0xff -+#define BIT_DTIM_PERIOD2_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD2_8197F) << BIT_SHIFT_DTIM_PERIOD2_8197F) -+#define BITS_DTIM_PERIOD2_8197F \ -+ (BIT_MASK_DTIM_PERIOD2_8197F << BIT_SHIFT_DTIM_PERIOD2_8197F) -+#define BIT_CLEAR_DTIM_PERIOD2_8197F(x) ((x) & (~BITS_DTIM_PERIOD2_8197F)) -+#define BIT_GET_DTIM_PERIOD2_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD2_8197F) & BIT_MASK_DTIM_PERIOD2_8197F) -+#define BIT_SET_DTIM_PERIOD2_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD2_8197F(x) | BIT_DTIM_PERIOD2_8197F(v)) -+ -+#define BIT_DTIM2_8197F BIT(15) -+#define BIT_TIM2_8197F BIT(14) -+ -+#define BIT_SHIFT_PS_AID_2_8197F 0 -+#define BIT_MASK_PS_AID_2_8197F 0x7ff -+#define BIT_PS_AID_2_8197F(x) \ -+ (((x) & BIT_MASK_PS_AID_2_8197F) << BIT_SHIFT_PS_AID_2_8197F) -+#define BITS_PS_AID_2_8197F \ -+ (BIT_MASK_PS_AID_2_8197F << BIT_SHIFT_PS_AID_2_8197F) -+#define BIT_CLEAR_PS_AID_2_8197F(x) ((x) & (~BITS_PS_AID_2_8197F)) -+#define BIT_GET_PS_AID_2_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_2_8197F) & BIT_MASK_PS_AID_2_8197F) -+#define BIT_SET_PS_AID_2_8197F(x, v) \ -+ (BIT_CLEAR_PS_AID_2_8197F(x) | BIT_PS_AID_2_8197F(v)) -+ -+/* 2 REG_BCN_PSR_RPT3_8197F (BEACON PARSER REPORT REGISTER3) */ -+ -+#define BIT_SHIFT_DTIM_CNT3_8197F 24 -+#define BIT_MASK_DTIM_CNT3_8197F 0xff -+#define BIT_DTIM_CNT3_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_CNT3_8197F) << BIT_SHIFT_DTIM_CNT3_8197F) -+#define BITS_DTIM_CNT3_8197F \ -+ (BIT_MASK_DTIM_CNT3_8197F << BIT_SHIFT_DTIM_CNT3_8197F) -+#define BIT_CLEAR_DTIM_CNT3_8197F(x) ((x) & (~BITS_DTIM_CNT3_8197F)) -+#define BIT_GET_DTIM_CNT3_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT3_8197F) & BIT_MASK_DTIM_CNT3_8197F) -+#define BIT_SET_DTIM_CNT3_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_CNT3_8197F(x) | BIT_DTIM_CNT3_8197F(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD3_8197F 16 -+#define BIT_MASK_DTIM_PERIOD3_8197F 0xff -+#define BIT_DTIM_PERIOD3_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD3_8197F) << BIT_SHIFT_DTIM_PERIOD3_8197F) -+#define BITS_DTIM_PERIOD3_8197F \ -+ (BIT_MASK_DTIM_PERIOD3_8197F << BIT_SHIFT_DTIM_PERIOD3_8197F) -+#define BIT_CLEAR_DTIM_PERIOD3_8197F(x) ((x) & (~BITS_DTIM_PERIOD3_8197F)) -+#define BIT_GET_DTIM_PERIOD3_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD3_8197F) & BIT_MASK_DTIM_PERIOD3_8197F) -+#define BIT_SET_DTIM_PERIOD3_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD3_8197F(x) | BIT_DTIM_PERIOD3_8197F(v)) -+ -+#define BIT_DTIM3_8197F BIT(15) -+#define BIT_TIM3_8197F BIT(14) -+ -+#define BIT_SHIFT_PS_AID_3_8197F 0 -+#define BIT_MASK_PS_AID_3_8197F 0x7ff -+#define BIT_PS_AID_3_8197F(x) \ -+ (((x) & BIT_MASK_PS_AID_3_8197F) << BIT_SHIFT_PS_AID_3_8197F) -+#define BITS_PS_AID_3_8197F \ -+ (BIT_MASK_PS_AID_3_8197F << BIT_SHIFT_PS_AID_3_8197F) -+#define BIT_CLEAR_PS_AID_3_8197F(x) ((x) & (~BITS_PS_AID_3_8197F)) -+#define BIT_GET_PS_AID_3_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_3_8197F) & BIT_MASK_PS_AID_3_8197F) -+#define BIT_SET_PS_AID_3_8197F(x, v) \ -+ (BIT_CLEAR_PS_AID_3_8197F(x) | BIT_PS_AID_3_8197F(v)) -+ -+/* 2 REG_BCN_PSR_RPT4_8197F (BEACON PARSER REPORT REGISTER4) */ -+ -+#define BIT_SHIFT_DTIM_CNT4_8197F 24 -+#define BIT_MASK_DTIM_CNT4_8197F 0xff -+#define BIT_DTIM_CNT4_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_CNT4_8197F) << BIT_SHIFT_DTIM_CNT4_8197F) -+#define BITS_DTIM_CNT4_8197F \ -+ (BIT_MASK_DTIM_CNT4_8197F << BIT_SHIFT_DTIM_CNT4_8197F) -+#define BIT_CLEAR_DTIM_CNT4_8197F(x) ((x) & (~BITS_DTIM_CNT4_8197F)) -+#define BIT_GET_DTIM_CNT4_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT4_8197F) & BIT_MASK_DTIM_CNT4_8197F) -+#define BIT_SET_DTIM_CNT4_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_CNT4_8197F(x) | BIT_DTIM_CNT4_8197F(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD4_8197F 16 -+#define BIT_MASK_DTIM_PERIOD4_8197F 0xff -+#define BIT_DTIM_PERIOD4_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD4_8197F) << BIT_SHIFT_DTIM_PERIOD4_8197F) -+#define BITS_DTIM_PERIOD4_8197F \ -+ (BIT_MASK_DTIM_PERIOD4_8197F << BIT_SHIFT_DTIM_PERIOD4_8197F) -+#define BIT_CLEAR_DTIM_PERIOD4_8197F(x) ((x) & (~BITS_DTIM_PERIOD4_8197F)) -+#define BIT_GET_DTIM_PERIOD4_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD4_8197F) & BIT_MASK_DTIM_PERIOD4_8197F) -+#define BIT_SET_DTIM_PERIOD4_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD4_8197F(x) | BIT_DTIM_PERIOD4_8197F(v)) -+ -+#define BIT_DTIM4_8197F BIT(15) -+#define BIT_TIM4_8197F BIT(14) -+ -+#define BIT_SHIFT_PS_AID_4_8197F 0 -+#define BIT_MASK_PS_AID_4_8197F 0x7ff -+#define BIT_PS_AID_4_8197F(x) \ -+ (((x) & BIT_MASK_PS_AID_4_8197F) << BIT_SHIFT_PS_AID_4_8197F) -+#define BITS_PS_AID_4_8197F \ -+ (BIT_MASK_PS_AID_4_8197F << BIT_SHIFT_PS_AID_4_8197F) -+#define BIT_CLEAR_PS_AID_4_8197F(x) ((x) & (~BITS_PS_AID_4_8197F)) -+#define BIT_GET_PS_AID_4_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_4_8197F) & BIT_MASK_PS_AID_4_8197F) -+#define BIT_SET_PS_AID_4_8197F(x, v) \ -+ (BIT_CLEAR_PS_AID_4_8197F(x) | BIT_PS_AID_4_8197F(v)) -+ -+/* 2 REG_A1_ADDR_MASK_8197F (A1 ADDR MASK REGISTER) */ -+ -+#define BIT_SHIFT_A1_ADDR_MASK_8197F 0 -+#define BIT_MASK_A1_ADDR_MASK_8197F 0xffffffffL -+#define BIT_A1_ADDR_MASK_8197F(x) \ -+ (((x) & BIT_MASK_A1_ADDR_MASK_8197F) << BIT_SHIFT_A1_ADDR_MASK_8197F) -+#define BITS_A1_ADDR_MASK_8197F \ -+ (BIT_MASK_A1_ADDR_MASK_8197F << BIT_SHIFT_A1_ADDR_MASK_8197F) -+#define BIT_CLEAR_A1_ADDR_MASK_8197F(x) ((x) & (~BITS_A1_ADDR_MASK_8197F)) -+#define BIT_GET_A1_ADDR_MASK_8197F(x) \ -+ (((x) >> BIT_SHIFT_A1_ADDR_MASK_8197F) & BIT_MASK_A1_ADDR_MASK_8197F) -+#define BIT_SET_A1_ADDR_MASK_8197F(x, v) \ -+ (BIT_CLEAR_A1_ADDR_MASK_8197F(x) | BIT_A1_ADDR_MASK_8197F(v)) -+ -+/* 2 REG_MACID2_8197F (MAC ID2 REGISTER) */ -+ -+#define BIT_SHIFT_MACID2_8197F 0 -+#define BIT_MASK_MACID2_8197F 0xffffffffffffL -+#define BIT_MACID2_8197F(x) \ -+ (((x) & BIT_MASK_MACID2_8197F) << BIT_SHIFT_MACID2_8197F) -+#define BITS_MACID2_8197F (BIT_MASK_MACID2_8197F << BIT_SHIFT_MACID2_8197F) -+#define BIT_CLEAR_MACID2_8197F(x) ((x) & (~BITS_MACID2_8197F)) -+#define BIT_GET_MACID2_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID2_8197F) & BIT_MASK_MACID2_8197F) -+#define BIT_SET_MACID2_8197F(x, v) \ -+ (BIT_CLEAR_MACID2_8197F(x) | BIT_MACID2_8197F(v)) -+ -+/* 2 REG_BSSID2_8197F (BSSID2 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID2_8197F 0 -+#define BIT_MASK_BSSID2_8197F 0xffffffffffffL -+#define BIT_BSSID2_8197F(x) \ -+ (((x) & BIT_MASK_BSSID2_8197F) << BIT_SHIFT_BSSID2_8197F) -+#define BITS_BSSID2_8197F (BIT_MASK_BSSID2_8197F << BIT_SHIFT_BSSID2_8197F) -+#define BIT_CLEAR_BSSID2_8197F(x) ((x) & (~BITS_BSSID2_8197F)) -+#define BIT_GET_BSSID2_8197F(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_8197F) & BIT_MASK_BSSID2_8197F) -+#define BIT_SET_BSSID2_8197F(x, v) \ -+ (BIT_CLEAR_BSSID2_8197F(x) | BIT_BSSID2_8197F(v)) -+ -+/* 2 REG_MACID3_8197F (MAC ID3 REGISTER) */ -+ -+#define BIT_SHIFT_MACID3_8197F 0 -+#define BIT_MASK_MACID3_8197F 0xffffffffffffL -+#define BIT_MACID3_8197F(x) \ -+ (((x) & BIT_MASK_MACID3_8197F) << BIT_SHIFT_MACID3_8197F) -+#define BITS_MACID3_8197F (BIT_MASK_MACID3_8197F << BIT_SHIFT_MACID3_8197F) -+#define BIT_CLEAR_MACID3_8197F(x) ((x) & (~BITS_MACID3_8197F)) -+#define BIT_GET_MACID3_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID3_8197F) & BIT_MASK_MACID3_8197F) -+#define BIT_SET_MACID3_8197F(x, v) \ -+ (BIT_CLEAR_MACID3_8197F(x) | BIT_MACID3_8197F(v)) -+ -+/* 2 REG_BSSID3_8197F (BSSID3 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID3_8197F 0 -+#define BIT_MASK_BSSID3_8197F 0xffffffffffffL -+#define BIT_BSSID3_8197F(x) \ -+ (((x) & BIT_MASK_BSSID3_8197F) << BIT_SHIFT_BSSID3_8197F) -+#define BITS_BSSID3_8197F (BIT_MASK_BSSID3_8197F << BIT_SHIFT_BSSID3_8197F) -+#define BIT_CLEAR_BSSID3_8197F(x) ((x) & (~BITS_BSSID3_8197F)) -+#define BIT_GET_BSSID3_8197F(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_8197F) & BIT_MASK_BSSID3_8197F) -+#define BIT_SET_BSSID3_8197F(x, v) \ -+ (BIT_CLEAR_BSSID3_8197F(x) | BIT_BSSID3_8197F(v)) -+ -+/* 2 REG_MACID4_8197F (MAC ID4 REGISTER) */ -+ -+#define BIT_SHIFT_MACID4_8197F 0 -+#define BIT_MASK_MACID4_8197F 0xffffffffffffL -+#define BIT_MACID4_8197F(x) \ -+ (((x) & BIT_MASK_MACID4_8197F) << BIT_SHIFT_MACID4_8197F) -+#define BITS_MACID4_8197F (BIT_MASK_MACID4_8197F << BIT_SHIFT_MACID4_8197F) -+#define BIT_CLEAR_MACID4_8197F(x) ((x) & (~BITS_MACID4_8197F)) -+#define BIT_GET_MACID4_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID4_8197F) & BIT_MASK_MACID4_8197F) -+#define BIT_SET_MACID4_8197F(x, v) \ -+ (BIT_CLEAR_MACID4_8197F(x) | BIT_MACID4_8197F(v)) -+ -+/* 2 REG_BSSID4_8197F (BSSID4 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID4_8197F 0 -+#define BIT_MASK_BSSID4_8197F 0xffffffffffffL -+#define BIT_BSSID4_8197F(x) \ -+ (((x) & BIT_MASK_BSSID4_8197F) << BIT_SHIFT_BSSID4_8197F) -+#define BITS_BSSID4_8197F (BIT_MASK_BSSID4_8197F << BIT_SHIFT_BSSID4_8197F) -+#define BIT_CLEAR_BSSID4_8197F(x) ((x) & (~BITS_BSSID4_8197F)) -+#define BIT_GET_BSSID4_8197F(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_8197F) & BIT_MASK_BSSID4_8197F) -+#define BIT_SET_BSSID4_8197F(x, v) \ -+ (BIT_CLEAR_BSSID4_8197F(x) | BIT_BSSID4_8197F(v)) -+ -+/* 2 REG_NOA_REPORT_8197F */ -+ -+/* 2 REG_PWRBIT_SETTING_8197F */ -+#define BIT_CLI3_PWRBIT_OW_EN_8197F BIT(7) -+#define BIT_CLI3_PWR_ST_8197F BIT(6) -+#define BIT_CLI2_PWRBIT_OW_EN_8197F BIT(5) -+#define BIT_CLI2_PWR_ST_8197F BIT(4) -+#define BIT_CLI1_PWRBIT_OW_EN_8197F BIT(3) -+#define BIT_CLI1_PWR_ST_8197F BIT(2) -+#define BIT_CLI0_PWRBIT_OW_EN_8197F BIT(1) -+#define BIT_CLI0_PWR_ST_8197F BIT(0) -+ -+/* 2 REG_WMAC_MU_BF_OPTION_8197F */ -+#define BIT_WMAC_RESP_NONSTA1_DIS_8197F BIT(7) -+#define BIT_BIT_WMAC_TXMU_ACKPOLICY_EN_8197F BIT(6) -+ -+#define BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8197F 4 -+#define BIT_MASK_WMAC_TXMU_ACKPOLICY_8197F 0x3 -+#define BIT_WMAC_TXMU_ACKPOLICY_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_TXMU_ACKPOLICY_8197F) \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8197F) -+#define BITS_WMAC_TXMU_ACKPOLICY_8197F \ -+ (BIT_MASK_WMAC_TXMU_ACKPOLICY_8197F \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8197F) -+#define BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8197F(x) \ -+ ((x) & (~BITS_WMAC_TXMU_ACKPOLICY_8197F)) -+#define BIT_GET_WMAC_TXMU_ACKPOLICY_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8197F) & \ -+ BIT_MASK_WMAC_TXMU_ACKPOLICY_8197F) -+#define BIT_SET_WMAC_TXMU_ACKPOLICY_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8197F(x) | \ -+ BIT_WMAC_TXMU_ACKPOLICY_8197F(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8197F 1 -+#define BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8197F 0x7 -+#define BIT_WMAC_MU_BFEE_PORT_SEL_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8197F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8197F) -+#define BITS_WMAC_MU_BFEE_PORT_SEL_8197F \ -+ (BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8197F \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8197F) -+#define BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8197F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE_PORT_SEL_8197F)) -+#define BIT_GET_WMAC_MU_BFEE_PORT_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8197F) & \ -+ BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8197F) -+#define BIT_SET_WMAC_MU_BFEE_PORT_SEL_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8197F(x) | \ -+ BIT_WMAC_MU_BFEE_PORT_SEL_8197F(v)) -+ -+#define BIT_WMAC_MU_BFEE_DIS_8197F BIT(0) -+ -+/* 2 REG_WMAC_PAUSE_BB_CLR_TH_8197F */ -+ -+#define BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8197F 0 -+#define BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8197F 0xff -+#define BIT_WMAC_PAUSE_BB_CLR_TH_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8197F) \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8197F) -+#define BITS_WMAC_PAUSE_BB_CLR_TH_8197F \ -+ (BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8197F \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8197F) -+#define BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8197F(x) \ -+ ((x) & (~BITS_WMAC_PAUSE_BB_CLR_TH_8197F)) -+#define BIT_GET_WMAC_PAUSE_BB_CLR_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8197F) & \ -+ BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8197F) -+#define BIT_SET_WMAC_PAUSE_BB_CLR_TH_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8197F(x) | \ -+ BIT_WMAC_PAUSE_BB_CLR_TH_8197F(v)) -+ -+/* 2 REG_WMAC_MU_ARB_8197F */ -+#define BIT_WMAC_ARB_HW_ADAPT_EN_8197F BIT(7) -+#define BIT_WMAC_ARB_SW_EN_8197F BIT(6) -+ -+#define BIT_SHIFT_WMAC_ARB_SW_STATE_8197F 0 -+#define BIT_MASK_WMAC_ARB_SW_STATE_8197F 0x3f -+#define BIT_WMAC_ARB_SW_STATE_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_ARB_SW_STATE_8197F) \ -+ << BIT_SHIFT_WMAC_ARB_SW_STATE_8197F) -+#define BITS_WMAC_ARB_SW_STATE_8197F \ -+ (BIT_MASK_WMAC_ARB_SW_STATE_8197F << BIT_SHIFT_WMAC_ARB_SW_STATE_8197F) -+#define BIT_CLEAR_WMAC_ARB_SW_STATE_8197F(x) \ -+ ((x) & (~BITS_WMAC_ARB_SW_STATE_8197F)) -+#define BIT_GET_WMAC_ARB_SW_STATE_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARB_SW_STATE_8197F) & \ -+ BIT_MASK_WMAC_ARB_SW_STATE_8197F) -+#define BIT_SET_WMAC_ARB_SW_STATE_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_ARB_SW_STATE_8197F(x) | BIT_WMAC_ARB_SW_STATE_8197F(v)) -+ -+/* 2 REG_WMAC_MU_OPTION_8197F */ -+ -+#define BIT_SHIFT_WMAC_MU_DBGSEL_8197F 5 -+#define BIT_MASK_WMAC_MU_DBGSEL_8197F 0x3 -+#define BIT_WMAC_MU_DBGSEL_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_DBGSEL_8197F) \ -+ << BIT_SHIFT_WMAC_MU_DBGSEL_8197F) -+#define BITS_WMAC_MU_DBGSEL_8197F \ -+ (BIT_MASK_WMAC_MU_DBGSEL_8197F << BIT_SHIFT_WMAC_MU_DBGSEL_8197F) -+#define BIT_CLEAR_WMAC_MU_DBGSEL_8197F(x) ((x) & (~BITS_WMAC_MU_DBGSEL_8197F)) -+#define BIT_GET_WMAC_MU_DBGSEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_DBGSEL_8197F) & \ -+ BIT_MASK_WMAC_MU_DBGSEL_8197F) -+#define BIT_SET_WMAC_MU_DBGSEL_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_DBGSEL_8197F(x) | BIT_WMAC_MU_DBGSEL_8197F(v)) -+ -+#define BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8197F 0 -+#define BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8197F 0x1f -+#define BIT_WMAC_MU_CPRD_TIMEOUT_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8197F) \ -+ << BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8197F) -+#define BITS_WMAC_MU_CPRD_TIMEOUT_8197F \ -+ (BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8197F \ -+ << BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8197F) -+#define BIT_CLEAR_WMAC_MU_CPRD_TIMEOUT_8197F(x) \ -+ ((x) & (~BITS_WMAC_MU_CPRD_TIMEOUT_8197F)) -+#define BIT_GET_WMAC_MU_CPRD_TIMEOUT_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8197F) & \ -+ BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8197F) -+#define BIT_SET_WMAC_MU_CPRD_TIMEOUT_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_CPRD_TIMEOUT_8197F(x) | \ -+ BIT_WMAC_MU_CPRD_TIMEOUT_8197F(v)) -+ -+/* 2 REG_WMAC_MU_BF_CTL_8197F */ -+#define BIT_WMAC_INVLD_BFPRT_CHK_8197F BIT(15) -+#define BIT_WMAC_RETXBFRPTSEQ_UPD_8197F BIT(14) -+ -+#define BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8197F 12 -+#define BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8197F 0x3 -+#define BIT_WMAC_MU_BFRPTSEG_SEL_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8197F) \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8197F) -+#define BITS_WMAC_MU_BFRPTSEG_SEL_8197F \ -+ (BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8197F \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8197F) -+#define BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8197F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFRPTSEG_SEL_8197F)) -+#define BIT_GET_WMAC_MU_BFRPTSEG_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8197F) & \ -+ BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8197F) -+#define BIT_SET_WMAC_MU_BFRPTSEG_SEL_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8197F(x) | \ -+ BIT_WMAC_MU_BFRPTSEG_SEL_8197F(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BF_MYAID_8197F 0 -+#define BIT_MASK_WMAC_MU_BF_MYAID_8197F 0xfff -+#define BIT_WMAC_MU_BF_MYAID_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BF_MYAID_8197F) \ -+ << BIT_SHIFT_WMAC_MU_BF_MYAID_8197F) -+#define BITS_WMAC_MU_BF_MYAID_8197F \ -+ (BIT_MASK_WMAC_MU_BF_MYAID_8197F << BIT_SHIFT_WMAC_MU_BF_MYAID_8197F) -+#define BIT_CLEAR_WMAC_MU_BF_MYAID_8197F(x) \ -+ ((x) & (~BITS_WMAC_MU_BF_MYAID_8197F)) -+#define BIT_GET_WMAC_MU_BF_MYAID_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BF_MYAID_8197F) & \ -+ BIT_MASK_WMAC_MU_BF_MYAID_8197F) -+#define BIT_SET_WMAC_MU_BF_MYAID_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BF_MYAID_8197F(x) | BIT_WMAC_MU_BF_MYAID_8197F(v)) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA_8197F */ -+ -+#define BIT_SHIFT_BFRPT_PARA_USERID_SEL_8197F 12 -+#define BIT_MASK_BFRPT_PARA_USERID_SEL_8197F 0x7 -+#define BIT_BFRPT_PARA_USERID_SEL_8197F(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_USERID_SEL_8197F) \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_8197F) -+#define BITS_BFRPT_PARA_USERID_SEL_8197F \ -+ (BIT_MASK_BFRPT_PARA_USERID_SEL_8197F \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_8197F) -+#define BIT_CLEAR_BFRPT_PARA_USERID_SEL_8197F(x) \ -+ ((x) & (~BITS_BFRPT_PARA_USERID_SEL_8197F)) -+#define BIT_GET_BFRPT_PARA_USERID_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_USERID_SEL_8197F) & \ -+ BIT_MASK_BFRPT_PARA_USERID_SEL_8197F) -+#define BIT_SET_BFRPT_PARA_USERID_SEL_8197F(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_USERID_SEL_8197F(x) | \ -+ BIT_BFRPT_PARA_USERID_SEL_8197F(v)) -+ -+#define BIT_SHIFT_BFRPT_PARA_8197F 0 -+#define BIT_MASK_BFRPT_PARA_8197F 0xfff -+#define BIT_BFRPT_PARA_8197F(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_8197F) << BIT_SHIFT_BFRPT_PARA_8197F) -+#define BITS_BFRPT_PARA_8197F \ -+ (BIT_MASK_BFRPT_PARA_8197F << BIT_SHIFT_BFRPT_PARA_8197F) -+#define BIT_CLEAR_BFRPT_PARA_8197F(x) ((x) & (~BITS_BFRPT_PARA_8197F)) -+#define BIT_GET_BFRPT_PARA_8197F(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_8197F) & BIT_MASK_BFRPT_PARA_8197F) -+#define BIT_SET_BFRPT_PARA_8197F(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_8197F(x) | BIT_BFRPT_PARA_8197F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE2_8197F */ -+#define BIT_STATUS_BFEE2_8197F BIT(10) -+#define BIT_WMAC_MU_BFEE2_EN_8197F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE2_AID_8197F 0 -+#define BIT_MASK_WMAC_MU_BFEE2_AID_8197F 0x1ff -+#define BIT_WMAC_MU_BFEE2_AID_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE2_AID_8197F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE2_AID_8197F) -+#define BITS_WMAC_MU_BFEE2_AID_8197F \ -+ (BIT_MASK_WMAC_MU_BFEE2_AID_8197F << BIT_SHIFT_WMAC_MU_BFEE2_AID_8197F) -+#define BIT_CLEAR_WMAC_MU_BFEE2_AID_8197F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE2_AID_8197F)) -+#define BIT_GET_WMAC_MU_BFEE2_AID_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE2_AID_8197F) & \ -+ BIT_MASK_WMAC_MU_BFEE2_AID_8197F) -+#define BIT_SET_WMAC_MU_BFEE2_AID_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE2_AID_8197F(x) | BIT_WMAC_MU_BFEE2_AID_8197F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE3_8197F */ -+#define BIT_STATUS_BFEE3_8197F BIT(10) -+#define BIT_WMAC_MU_BFEE3_EN_8197F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE3_AID_8197F 0 -+#define BIT_MASK_WMAC_MU_BFEE3_AID_8197F 0x1ff -+#define BIT_WMAC_MU_BFEE3_AID_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE3_AID_8197F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE3_AID_8197F) -+#define BITS_WMAC_MU_BFEE3_AID_8197F \ -+ (BIT_MASK_WMAC_MU_BFEE3_AID_8197F << BIT_SHIFT_WMAC_MU_BFEE3_AID_8197F) -+#define BIT_CLEAR_WMAC_MU_BFEE3_AID_8197F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE3_AID_8197F)) -+#define BIT_GET_WMAC_MU_BFEE3_AID_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE3_AID_8197F) & \ -+ BIT_MASK_WMAC_MU_BFEE3_AID_8197F) -+#define BIT_SET_WMAC_MU_BFEE3_AID_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE3_AID_8197F(x) | BIT_WMAC_MU_BFEE3_AID_8197F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE4_8197F */ -+#define BIT_STATUS_BFEE4_8197F BIT(10) -+#define BIT_WMAC_MU_BFEE4_EN_8197F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE4_AID_8197F 0 -+#define BIT_MASK_WMAC_MU_BFEE4_AID_8197F 0x1ff -+#define BIT_WMAC_MU_BFEE4_AID_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE4_AID_8197F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE4_AID_8197F) -+#define BITS_WMAC_MU_BFEE4_AID_8197F \ -+ (BIT_MASK_WMAC_MU_BFEE4_AID_8197F << BIT_SHIFT_WMAC_MU_BFEE4_AID_8197F) -+#define BIT_CLEAR_WMAC_MU_BFEE4_AID_8197F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE4_AID_8197F)) -+#define BIT_GET_WMAC_MU_BFEE4_AID_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE4_AID_8197F) & \ -+ BIT_MASK_WMAC_MU_BFEE4_AID_8197F) -+#define BIT_SET_WMAC_MU_BFEE4_AID_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE4_AID_8197F(x) | BIT_WMAC_MU_BFEE4_AID_8197F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE5_8197F */ -+#define BIT_STATUS_BFEE5_8197F BIT(10) -+#define BIT_WMAC_MU_BFEE5_EN_8197F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE5_AID_8197F 0 -+#define BIT_MASK_WMAC_MU_BFEE5_AID_8197F 0x1ff -+#define BIT_WMAC_MU_BFEE5_AID_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE5_AID_8197F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE5_AID_8197F) -+#define BITS_WMAC_MU_BFEE5_AID_8197F \ -+ (BIT_MASK_WMAC_MU_BFEE5_AID_8197F << BIT_SHIFT_WMAC_MU_BFEE5_AID_8197F) -+#define BIT_CLEAR_WMAC_MU_BFEE5_AID_8197F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE5_AID_8197F)) -+#define BIT_GET_WMAC_MU_BFEE5_AID_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE5_AID_8197F) & \ -+ BIT_MASK_WMAC_MU_BFEE5_AID_8197F) -+#define BIT_SET_WMAC_MU_BFEE5_AID_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE5_AID_8197F(x) | BIT_WMAC_MU_BFEE5_AID_8197F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE6_8197F */ -+#define BIT_STATUS_BFEE6_8197F BIT(10) -+#define BIT_WMAC_MU_BFEE6_EN_8197F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE6_AID_8197F 0 -+#define BIT_MASK_WMAC_MU_BFEE6_AID_8197F 0x1ff -+#define BIT_WMAC_MU_BFEE6_AID_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE6_AID_8197F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE6_AID_8197F) -+#define BITS_WMAC_MU_BFEE6_AID_8197F \ -+ (BIT_MASK_WMAC_MU_BFEE6_AID_8197F << BIT_SHIFT_WMAC_MU_BFEE6_AID_8197F) -+#define BIT_CLEAR_WMAC_MU_BFEE6_AID_8197F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE6_AID_8197F)) -+#define BIT_GET_WMAC_MU_BFEE6_AID_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE6_AID_8197F) & \ -+ BIT_MASK_WMAC_MU_BFEE6_AID_8197F) -+#define BIT_SET_WMAC_MU_BFEE6_AID_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE6_AID_8197F(x) | BIT_WMAC_MU_BFEE6_AID_8197F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE7_8197F */ -+#define BIT_BIT_STATUS_BFEE4_8197F BIT(10) -+#define BIT_WMAC_MU_BFEE7_EN_8197F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE7_AID_8197F 0 -+#define BIT_MASK_WMAC_MU_BFEE7_AID_8197F 0x1ff -+#define BIT_WMAC_MU_BFEE7_AID_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE7_AID_8197F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE7_AID_8197F) -+#define BITS_WMAC_MU_BFEE7_AID_8197F \ -+ (BIT_MASK_WMAC_MU_BFEE7_AID_8197F << BIT_SHIFT_WMAC_MU_BFEE7_AID_8197F) -+#define BIT_CLEAR_WMAC_MU_BFEE7_AID_8197F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE7_AID_8197F)) -+#define BIT_GET_WMAC_MU_BFEE7_AID_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE7_AID_8197F) & \ -+ BIT_MASK_WMAC_MU_BFEE7_AID_8197F) -+#define BIT_SET_WMAC_MU_BFEE7_AID_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE7_AID_8197F(x) | BIT_WMAC_MU_BFEE7_AID_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_RST_ALL_COUNTER_8197F BIT(31) -+ -+#define BIT_SHIFT_ABORT_RX_VBON_COUNTER_8197F 16 -+#define BIT_MASK_ABORT_RX_VBON_COUNTER_8197F 0xff -+#define BIT_ABORT_RX_VBON_COUNTER_8197F(x) \ -+ (((x) & BIT_MASK_ABORT_RX_VBON_COUNTER_8197F) \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8197F) -+#define BITS_ABORT_RX_VBON_COUNTER_8197F \ -+ (BIT_MASK_ABORT_RX_VBON_COUNTER_8197F \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8197F) -+#define BIT_CLEAR_ABORT_RX_VBON_COUNTER_8197F(x) \ -+ ((x) & (~BITS_ABORT_RX_VBON_COUNTER_8197F)) -+#define BIT_GET_ABORT_RX_VBON_COUNTER_8197F(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_VBON_COUNTER_8197F) & \ -+ BIT_MASK_ABORT_RX_VBON_COUNTER_8197F) -+#define BIT_SET_ABORT_RX_VBON_COUNTER_8197F(x, v) \ -+ (BIT_CLEAR_ABORT_RX_VBON_COUNTER_8197F(x) | \ -+ BIT_ABORT_RX_VBON_COUNTER_8197F(v)) -+ -+#define BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8197F 8 -+#define BIT_MASK_ABORT_RX_RDRDY_COUNTER_8197F 0xff -+#define BIT_ABORT_RX_RDRDY_COUNTER_8197F(x) \ -+ (((x) & BIT_MASK_ABORT_RX_RDRDY_COUNTER_8197F) \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8197F) -+#define BITS_ABORT_RX_RDRDY_COUNTER_8197F \ -+ (BIT_MASK_ABORT_RX_RDRDY_COUNTER_8197F \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8197F) -+#define BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8197F(x) \ -+ ((x) & (~BITS_ABORT_RX_RDRDY_COUNTER_8197F)) -+#define BIT_GET_ABORT_RX_RDRDY_COUNTER_8197F(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8197F) & \ -+ BIT_MASK_ABORT_RX_RDRDY_COUNTER_8197F) -+#define BIT_SET_ABORT_RX_RDRDY_COUNTER_8197F(x, v) \ -+ (BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8197F(x) | \ -+ BIT_ABORT_RX_RDRDY_COUNTER_8197F(v)) -+ -+#define BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8197F 0 -+#define BIT_MASK_VBON_EARLY_FALLING_COUNTER_8197F 0xff -+#define BIT_VBON_EARLY_FALLING_COUNTER_8197F(x) \ -+ (((x) & BIT_MASK_VBON_EARLY_FALLING_COUNTER_8197F) \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8197F) -+#define BITS_VBON_EARLY_FALLING_COUNTER_8197F \ -+ (BIT_MASK_VBON_EARLY_FALLING_COUNTER_8197F \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8197F) -+#define BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8197F(x) \ -+ ((x) & (~BITS_VBON_EARLY_FALLING_COUNTER_8197F)) -+#define BIT_GET_VBON_EARLY_FALLING_COUNTER_8197F(x) \ -+ (((x) >> BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8197F) & \ -+ BIT_MASK_VBON_EARLY_FALLING_COUNTER_8197F) -+#define BIT_SET_VBON_EARLY_FALLING_COUNTER_8197F(x, v) \ -+ (BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8197F(x) | \ -+ BIT_VBON_EARLY_FALLING_COUNTER_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+#define BIT_WMAC_PLCP_TRX_SEL_8197F BIT(31) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8197F 28 -+#define BIT_MASK_WMAC_PLCP_RDSIG_SEL_8197F 0x7 -+#define BIT_WMAC_PLCP_RDSIG_SEL_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_SEL_8197F) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8197F) -+#define BITS_WMAC_PLCP_RDSIG_SEL_8197F \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_SEL_8197F \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8197F) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8197F(x) \ -+ ((x) & (~BITS_WMAC_PLCP_RDSIG_SEL_8197F)) -+#define BIT_GET_WMAC_PLCP_RDSIG_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8197F) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_SEL_8197F) -+#define BIT_SET_WMAC_PLCP_RDSIG_SEL_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8197F(x) | \ -+ BIT_WMAC_PLCP_RDSIG_SEL_8197F(v)) -+ -+#define BIT_SHIFT_WMAC_RATE_IDX_8197F 24 -+#define BIT_MASK_WMAC_RATE_IDX_8197F 0xf -+#define BIT_WMAC_RATE_IDX_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_RATE_IDX_8197F) << BIT_SHIFT_WMAC_RATE_IDX_8197F) -+#define BITS_WMAC_RATE_IDX_8197F \ -+ (BIT_MASK_WMAC_RATE_IDX_8197F << BIT_SHIFT_WMAC_RATE_IDX_8197F) -+#define BIT_CLEAR_WMAC_RATE_IDX_8197F(x) ((x) & (~BITS_WMAC_RATE_IDX_8197F)) -+#define BIT_GET_WMAC_RATE_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RATE_IDX_8197F) & BIT_MASK_WMAC_RATE_IDX_8197F) -+#define BIT_SET_WMAC_RATE_IDX_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_RATE_IDX_8197F(x) | BIT_WMAC_RATE_IDX_8197F(v)) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_8197F 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG_8197F 0xffffff -+#define BIT_WMAC_PLCP_RDSIG_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_8197F) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_8197F) -+#define BITS_WMAC_PLCP_RDSIG_8197F \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_8197F << BIT_SHIFT_WMAC_PLCP_RDSIG_8197F) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_8197F(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_8197F)) -+#define BIT_GET_WMAC_PLCP_RDSIG_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_8197F) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_8197F) -+#define BIT_SET_WMAC_PLCP_RDSIG_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_8197F(x) | BIT_WMAC_PLCP_RDSIG_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_8197F (TA0 REGISTER) */ -+ -+#define BIT_SHIFT_TA0_8197F 0 -+#define BIT_MASK_TA0_8197F 0xffffffffffffL -+#define BIT_TA0_8197F(x) (((x) & BIT_MASK_TA0_8197F) << BIT_SHIFT_TA0_8197F) -+#define BITS_TA0_8197F (BIT_MASK_TA0_8197F << BIT_SHIFT_TA0_8197F) -+#define BIT_CLEAR_TA0_8197F(x) ((x) & (~BITS_TA0_8197F)) -+#define BIT_GET_TA0_8197F(x) (((x) >> BIT_SHIFT_TA0_8197F) & BIT_MASK_TA0_8197F) -+#define BIT_SET_TA0_8197F(x, v) (BIT_CLEAR_TA0_8197F(x) | BIT_TA0_8197F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_8197F (TA1 REGISTER) */ -+ -+#define BIT_SHIFT_TA1_8197F 0 -+#define BIT_MASK_TA1_8197F 0xffffffffffffL -+#define BIT_TA1_8197F(x) (((x) & BIT_MASK_TA1_8197F) << BIT_SHIFT_TA1_8197F) -+#define BITS_TA1_8197F (BIT_MASK_TA1_8197F << BIT_SHIFT_TA1_8197F) -+#define BIT_CLEAR_TA1_8197F(x) ((x) & (~BITS_TA1_8197F)) -+#define BIT_GET_TA1_8197F(x) (((x) >> BIT_SHIFT_TA1_8197F) & BIT_MASK_TA1_8197F) -+#define BIT_SET_TA1_8197F(x, v) (BIT_CLEAR_TA1_8197F(x) | BIT_TA1_8197F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_8197F (TA2 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_8197F 0 -+#define BIT_MASK_TA2_8197F 0xffffffffffffL -+#define BIT_TA2_8197F(x) (((x) & BIT_MASK_TA2_8197F) << BIT_SHIFT_TA2_8197F) -+#define BITS_TA2_8197F (BIT_MASK_TA2_8197F << BIT_SHIFT_TA2_8197F) -+#define BIT_CLEAR_TA2_8197F(x) ((x) & (~BITS_TA2_8197F)) -+#define BIT_GET_TA2_8197F(x) (((x) >> BIT_SHIFT_TA2_8197F) & BIT_MASK_TA2_8197F) -+#define BIT_SET_TA2_8197F(x, v) (BIT_CLEAR_TA2_8197F(x) | BIT_TA2_8197F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_8197F (TA3 REGISTER) */ -+ -+#define BIT_SHIFT_TA3_8197F 0 -+#define BIT_MASK_TA3_8197F 0xffffffffffffL -+#define BIT_TA3_8197F(x) (((x) & BIT_MASK_TA3_8197F) << BIT_SHIFT_TA3_8197F) -+#define BITS_TA3_8197F (BIT_MASK_TA3_8197F << BIT_SHIFT_TA3_8197F) -+#define BIT_CLEAR_TA3_8197F(x) ((x) & (~BITS_TA3_8197F)) -+#define BIT_GET_TA3_8197F(x) (((x) >> BIT_SHIFT_TA3_8197F) & BIT_MASK_TA3_8197F) -+#define BIT_SET_TA3_8197F(x, v) (BIT_CLEAR_TA3_8197F(x) | BIT_TA3_8197F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_8197F (TA4 REGISTER) */ -+ -+#define BIT_SHIFT_TA4_8197F 0 -+#define BIT_MASK_TA4_8197F 0xffffffffffffL -+#define BIT_TA4_8197F(x) (((x) & BIT_MASK_TA4_8197F) << BIT_SHIFT_TA4_8197F) -+#define BITS_TA4_8197F (BIT_MASK_TA4_8197F << BIT_SHIFT_TA4_8197F) -+#define BIT_CLEAR_TA4_8197F(x) ((x) & (~BITS_TA4_8197F)) -+#define BIT_GET_TA4_8197F(x) (((x) >> BIT_SHIFT_TA4_8197F) & BIT_MASK_TA4_8197F) -+#define BIT_SET_TA4_8197F(x, v) (BIT_CLEAR_TA4_8197F(x) | BIT_TA4_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_MACID1_8197F */ -+ -+#define BIT_SHIFT_MACID1_8197F 0 -+#define BIT_MASK_MACID1_8197F 0xffffffffffffL -+#define BIT_MACID1_8197F(x) \ -+ (((x) & BIT_MASK_MACID1_8197F) << BIT_SHIFT_MACID1_8197F) -+#define BITS_MACID1_8197F (BIT_MASK_MACID1_8197F << BIT_SHIFT_MACID1_8197F) -+#define BIT_CLEAR_MACID1_8197F(x) ((x) & (~BITS_MACID1_8197F)) -+#define BIT_GET_MACID1_8197F(x) \ -+ (((x) >> BIT_SHIFT_MACID1_8197F) & BIT_MASK_MACID1_8197F) -+#define BIT_SET_MACID1_8197F(x, v) \ -+ (BIT_CLEAR_MACID1_8197F(x) | BIT_MACID1_8197F(v)) -+ -+/* 2 REG_BSSID1_8197F */ -+ -+#define BIT_SHIFT_BSSID1_8197F 0 -+#define BIT_MASK_BSSID1_8197F 0xffffffffffffL -+#define BIT_BSSID1_8197F(x) \ -+ (((x) & BIT_MASK_BSSID1_8197F) << BIT_SHIFT_BSSID1_8197F) -+#define BITS_BSSID1_8197F (BIT_MASK_BSSID1_8197F << BIT_SHIFT_BSSID1_8197F) -+#define BIT_CLEAR_BSSID1_8197F(x) ((x) & (~BITS_BSSID1_8197F)) -+#define BIT_GET_BSSID1_8197F(x) \ -+ (((x) >> BIT_SHIFT_BSSID1_8197F) & BIT_MASK_BSSID1_8197F) -+#define BIT_SET_BSSID1_8197F(x, v) \ -+ (BIT_CLEAR_BSSID1_8197F(x) | BIT_BSSID1_8197F(v)) -+ -+/* 2 REG_BCN_PSR_RPT1_8197F */ -+ -+#define BIT_SHIFT_DTIM_CNT1_8197F 24 -+#define BIT_MASK_DTIM_CNT1_8197F 0xff -+#define BIT_DTIM_CNT1_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_CNT1_8197F) << BIT_SHIFT_DTIM_CNT1_8197F) -+#define BITS_DTIM_CNT1_8197F \ -+ (BIT_MASK_DTIM_CNT1_8197F << BIT_SHIFT_DTIM_CNT1_8197F) -+#define BIT_CLEAR_DTIM_CNT1_8197F(x) ((x) & (~BITS_DTIM_CNT1_8197F)) -+#define BIT_GET_DTIM_CNT1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT1_8197F) & BIT_MASK_DTIM_CNT1_8197F) -+#define BIT_SET_DTIM_CNT1_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_CNT1_8197F(x) | BIT_DTIM_CNT1_8197F(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD1_8197F 16 -+#define BIT_MASK_DTIM_PERIOD1_8197F 0xff -+#define BIT_DTIM_PERIOD1_8197F(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD1_8197F) << BIT_SHIFT_DTIM_PERIOD1_8197F) -+#define BITS_DTIM_PERIOD1_8197F \ -+ (BIT_MASK_DTIM_PERIOD1_8197F << BIT_SHIFT_DTIM_PERIOD1_8197F) -+#define BIT_CLEAR_DTIM_PERIOD1_8197F(x) ((x) & (~BITS_DTIM_PERIOD1_8197F)) -+#define BIT_GET_DTIM_PERIOD1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD1_8197F) & BIT_MASK_DTIM_PERIOD1_8197F) -+#define BIT_SET_DTIM_PERIOD1_8197F(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD1_8197F(x) | BIT_DTIM_PERIOD1_8197F(v)) -+ -+#define BIT_DTIM1_8197F BIT(15) -+#define BIT_TIM1_8197F BIT(14) -+ -+#define BIT_SHIFT_PS_AID_1_8197F 0 -+#define BIT_MASK_PS_AID_1_8197F 0x7ff -+#define BIT_PS_AID_1_8197F(x) \ -+ (((x) & BIT_MASK_PS_AID_1_8197F) << BIT_SHIFT_PS_AID_1_8197F) -+#define BITS_PS_AID_1_8197F \ -+ (BIT_MASK_PS_AID_1_8197F << BIT_SHIFT_PS_AID_1_8197F) -+#define BIT_CLEAR_PS_AID_1_8197F(x) ((x) & (~BITS_PS_AID_1_8197F)) -+#define BIT_GET_PS_AID_1_8197F(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_1_8197F) & BIT_MASK_PS_AID_1_8197F) -+#define BIT_SET_PS_AID_1_8197F(x, v) \ -+ (BIT_CLEAR_PS_AID_1_8197F(x) | BIT_PS_AID_1_8197F(v)) -+ -+/* 2 REG_ASSOCIATED_BFMEE_SEL_8197F */ -+#define BIT_TXUSER_ID1_8197F BIT(25) -+ -+#define BIT_SHIFT_AID1_8197F 16 -+#define BIT_MASK_AID1_8197F 0x1ff -+#define BIT_AID1_8197F(x) (((x) & BIT_MASK_AID1_8197F) << BIT_SHIFT_AID1_8197F) -+#define BITS_AID1_8197F (BIT_MASK_AID1_8197F << BIT_SHIFT_AID1_8197F) -+#define BIT_CLEAR_AID1_8197F(x) ((x) & (~BITS_AID1_8197F)) -+#define BIT_GET_AID1_8197F(x) \ -+ (((x) >> BIT_SHIFT_AID1_8197F) & BIT_MASK_AID1_8197F) -+#define BIT_SET_AID1_8197F(x, v) (BIT_CLEAR_AID1_8197F(x) | BIT_AID1_8197F(v)) -+ -+#define BIT_TXUSER_ID0_8197F BIT(9) -+ -+#define BIT_SHIFT_AID0_8197F 0 -+#define BIT_MASK_AID0_8197F 0x1ff -+#define BIT_AID0_8197F(x) (((x) & BIT_MASK_AID0_8197F) << BIT_SHIFT_AID0_8197F) -+#define BITS_AID0_8197F (BIT_MASK_AID0_8197F << BIT_SHIFT_AID0_8197F) -+#define BIT_CLEAR_AID0_8197F(x) ((x) & (~BITS_AID0_8197F)) -+#define BIT_GET_AID0_8197F(x) \ -+ (((x) >> BIT_SHIFT_AID0_8197F) & BIT_MASK_AID0_8197F) -+#define BIT_SET_AID0_8197F(x, v) (BIT_CLEAR_AID0_8197F(x) | BIT_AID0_8197F(v)) -+ -+/* 2 REG_SND_PTCL_CTRL_8197F */ -+ -+#define BIT_SHIFT_NDP_RX_STANDBY_TIMER_8197F 24 -+#define BIT_MASK_NDP_RX_STANDBY_TIMER_8197F 0xff -+#define BIT_NDP_RX_STANDBY_TIMER_8197F(x) \ -+ (((x) & BIT_MASK_NDP_RX_STANDBY_TIMER_8197F) \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8197F) -+#define BITS_NDP_RX_STANDBY_TIMER_8197F \ -+ (BIT_MASK_NDP_RX_STANDBY_TIMER_8197F \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8197F) -+#define BIT_CLEAR_NDP_RX_STANDBY_TIMER_8197F(x) \ -+ ((x) & (~BITS_NDP_RX_STANDBY_TIMER_8197F)) -+#define BIT_GET_NDP_RX_STANDBY_TIMER_8197F(x) \ -+ (((x) >> BIT_SHIFT_NDP_RX_STANDBY_TIMER_8197F) & \ -+ BIT_MASK_NDP_RX_STANDBY_TIMER_8197F) -+#define BIT_SET_NDP_RX_STANDBY_TIMER_8197F(x, v) \ -+ (BIT_CLEAR_NDP_RX_STANDBY_TIMER_8197F(x) | \ -+ BIT_NDP_RX_STANDBY_TIMER_8197F(v)) -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_HT_8197F 16 -+#define BIT_MASK_CSI_RPT_OFFSET_HT_8197F 0xff -+#define BIT_CSI_RPT_OFFSET_HT_8197F(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_HT_8197F) \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_HT_8197F) -+#define BITS_CSI_RPT_OFFSET_HT_8197F \ -+ (BIT_MASK_CSI_RPT_OFFSET_HT_8197F << BIT_SHIFT_CSI_RPT_OFFSET_HT_8197F) -+#define BIT_CLEAR_CSI_RPT_OFFSET_HT_8197F(x) \ -+ ((x) & (~BITS_CSI_RPT_OFFSET_HT_8197F)) -+#define BIT_GET_CSI_RPT_OFFSET_HT_8197F(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_HT_8197F) & \ -+ BIT_MASK_CSI_RPT_OFFSET_HT_8197F) -+#define BIT_SET_CSI_RPT_OFFSET_HT_8197F(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_HT_8197F(x) | BIT_CSI_RPT_OFFSET_HT_8197F(v)) -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_VHT_8197F 8 -+#define BIT_MASK_CSI_RPT_OFFSET_VHT_8197F 0xff -+#define BIT_CSI_RPT_OFFSET_VHT_8197F(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_VHT_8197F) \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_VHT_8197F) -+#define BITS_CSI_RPT_OFFSET_VHT_8197F \ -+ (BIT_MASK_CSI_RPT_OFFSET_VHT_8197F \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_VHT_8197F) -+#define BIT_CLEAR_CSI_RPT_OFFSET_VHT_8197F(x) \ -+ ((x) & (~BITS_CSI_RPT_OFFSET_VHT_8197F)) -+#define BIT_GET_CSI_RPT_OFFSET_VHT_8197F(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_VHT_8197F) & \ -+ BIT_MASK_CSI_RPT_OFFSET_VHT_8197F) -+#define BIT_SET_CSI_RPT_OFFSET_VHT_8197F(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_VHT_8197F(x) | \ -+ BIT_CSI_RPT_OFFSET_VHT_8197F(v)) -+ -+#define BIT_R_WMAC_USE_NSTS_8197F BIT(7) -+#define BIT_R_DISABLE_CHECK_VHTSIGB_CRC_8197F BIT(6) -+#define BIT_R_DISABLE_CHECK_VHTSIGA_CRC_8197F BIT(5) -+#define BIT_R_WMAC_BFPARAM_SEL_8197F BIT(4) -+#define BIT_R_WMAC_CSISEQ_SEL_8197F BIT(3) -+#define BIT_R_WMAC_CSI_WITHHTC_EN_8197F BIT(2) -+#define BIT_R_WMAC_HT_NDPA_EN_8197F BIT(1) -+#define BIT_R_WMAC_VHT_NDPA_EN_8197F BIT(0) -+ -+/* 2 REG_RX_CSI_RPT_INFO_8197F */ -+ -+/* 2 REG_NS_ARP_CTRL_8197F */ -+#define BIT_R_WMAC_NSARP_RSPEN_8197F BIT(15) -+#define BIT_R_WMAC_NSARP_RARP_8197F BIT(9) -+#define BIT_R_WMAC_NSARP_RIPV6_8197F BIT(8) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_MODEN_8197F 6 -+#define BIT_MASK_R_WMAC_NSARP_MODEN_8197F 0x3 -+#define BIT_R_WMAC_NSARP_MODEN_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_MODEN_8197F) \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8197F) -+#define BITS_R_WMAC_NSARP_MODEN_8197F \ -+ (BIT_MASK_R_WMAC_NSARP_MODEN_8197F \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8197F) -+#define BIT_CLEAR_R_WMAC_NSARP_MODEN_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_MODEN_8197F)) -+#define BIT_GET_R_WMAC_NSARP_MODEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_MODEN_8197F) & \ -+ BIT_MASK_R_WMAC_NSARP_MODEN_8197F) -+#define BIT_SET_R_WMAC_NSARP_MODEN_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_MODEN_8197F(x) | \ -+ BIT_R_WMAC_NSARP_MODEN_8197F(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8197F 4 -+#define BIT_MASK_R_WMAC_NSARP_RSPFTP_8197F 0x3 -+#define BIT_R_WMAC_NSARP_RSPFTP_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPFTP_8197F) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8197F) -+#define BITS_R_WMAC_NSARP_RSPFTP_8197F \ -+ (BIT_MASK_R_WMAC_NSARP_RSPFTP_8197F \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8197F) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPFTP_8197F)) -+#define BIT_GET_R_WMAC_NSARP_RSPFTP_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8197F) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPFTP_8197F) -+#define BIT_SET_R_WMAC_NSARP_RSPFTP_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8197F(x) | \ -+ BIT_R_WMAC_NSARP_RSPFTP_8197F(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8197F 0 -+#define BIT_MASK_R_WMAC_NSARP_RSPSEC_8197F 0xf -+#define BIT_R_WMAC_NSARP_RSPSEC_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPSEC_8197F) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8197F) -+#define BITS_R_WMAC_NSARP_RSPSEC_8197F \ -+ (BIT_MASK_R_WMAC_NSARP_RSPSEC_8197F \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8197F) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPSEC_8197F)) -+#define BIT_GET_R_WMAC_NSARP_RSPSEC_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8197F) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPSEC_8197F) -+#define BIT_SET_R_WMAC_NSARP_RSPSEC_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8197F(x) | \ -+ BIT_R_WMAC_NSARP_RSPSEC_8197F(v)) -+ -+/* 2 REG_NS_ARP_INFO_8197F */ -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_V1_8197F */ -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_8197F */ -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+/* 2 REG_RSVD_0X740_8197F */ -+ -+/* 2 REG_WMAC_RTX_CTX_SUBTYPE_CFG_8197F */ -+ -+#define BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8197F 4 -+#define BIT_MASK_R_WMAC_CTX_SUBTYPE_8197F 0xf -+#define BIT_R_WMAC_CTX_SUBTYPE_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_CTX_SUBTYPE_8197F) \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8197F) -+#define BITS_R_WMAC_CTX_SUBTYPE_8197F \ -+ (BIT_MASK_R_WMAC_CTX_SUBTYPE_8197F \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8197F) -+#define BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_CTX_SUBTYPE_8197F)) -+#define BIT_GET_R_WMAC_CTX_SUBTYPE_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8197F) & \ -+ BIT_MASK_R_WMAC_CTX_SUBTYPE_8197F) -+#define BIT_SET_R_WMAC_CTX_SUBTYPE_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8197F(x) | \ -+ BIT_R_WMAC_CTX_SUBTYPE_8197F(v)) -+ -+#define BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8197F 0 -+#define BIT_MASK_R_WMAC_RTX_SUBTYPE_8197F 0xf -+#define BIT_R_WMAC_RTX_SUBTYPE_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_RTX_SUBTYPE_8197F) \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8197F) -+#define BITS_R_WMAC_RTX_SUBTYPE_8197F \ -+ (BIT_MASK_R_WMAC_RTX_SUBTYPE_8197F \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8197F) -+#define BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_RTX_SUBTYPE_8197F)) -+#define BIT_GET_R_WMAC_RTX_SUBTYPE_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8197F) & \ -+ BIT_MASK_R_WMAC_RTX_SUBTYPE_8197F) -+#define BIT_SET_R_WMAC_RTX_SUBTYPE_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8197F(x) | \ -+ BIT_R_WMAC_RTX_SUBTYPE_8197F(v)) -+ -+/* 2 REG_WMAC_SWAES_CFG_8197F */ -+ -+/* 2 REG_BT_COEX_V2_8197F */ -+#define BIT_GNT_BT_POLARITY_8197F BIT(12) -+#define BIT_GNT_BT_BYPASS_PRIORITY_8197F BIT(8) -+ -+#define BIT_SHIFT_TIMER_8197F 0 -+#define BIT_MASK_TIMER_8197F 0xff -+#define BIT_TIMER_8197F(x) \ -+ (((x) & BIT_MASK_TIMER_8197F) << BIT_SHIFT_TIMER_8197F) -+#define BITS_TIMER_8197F (BIT_MASK_TIMER_8197F << BIT_SHIFT_TIMER_8197F) -+#define BIT_CLEAR_TIMER_8197F(x) ((x) & (~BITS_TIMER_8197F)) -+#define BIT_GET_TIMER_8197F(x) \ -+ (((x) >> BIT_SHIFT_TIMER_8197F) & BIT_MASK_TIMER_8197F) -+#define BIT_SET_TIMER_8197F(x, v) \ -+ (BIT_CLEAR_TIMER_8197F(x) | BIT_TIMER_8197F(v)) -+ -+/* 2 REG_BT_COEX_8197F */ -+#define BIT_R_GNT_BT_RFC_SW_8197F BIT(12) -+#define BIT_R_GNT_BT_RFC_SW_EN_8197F BIT(11) -+#define BIT_R_GNT_BT_BB_SW_8197F BIT(10) -+#define BIT_R_GNT_BT_BB_SW_EN_8197F BIT(9) -+#define BIT_R_BT_CNT_THREN_8197F BIT(8) -+ -+#define BIT_SHIFT_R_BT_CNT_THR_8197F 0 -+#define BIT_MASK_R_BT_CNT_THR_8197F 0xff -+#define BIT_R_BT_CNT_THR_8197F(x) \ -+ (((x) & BIT_MASK_R_BT_CNT_THR_8197F) << BIT_SHIFT_R_BT_CNT_THR_8197F) -+#define BITS_R_BT_CNT_THR_8197F \ -+ (BIT_MASK_R_BT_CNT_THR_8197F << BIT_SHIFT_R_BT_CNT_THR_8197F) -+#define BIT_CLEAR_R_BT_CNT_THR_8197F(x) ((x) & (~BITS_R_BT_CNT_THR_8197F)) -+#define BIT_GET_R_BT_CNT_THR_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CNT_THR_8197F) & BIT_MASK_R_BT_CNT_THR_8197F) -+#define BIT_SET_R_BT_CNT_THR_8197F(x, v) \ -+ (BIT_CLEAR_R_BT_CNT_THR_8197F(x) | BIT_R_BT_CNT_THR_8197F(v)) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_8197F */ -+#define BIT_WLRX_TER_BY_CTL_8197F BIT(43) -+#define BIT_WLRX_TER_BY_AD_8197F BIT(42) -+#define BIT_ANT_DIVERSITY_SEL_8197F BIT(41) -+#define BIT_ANTSEL_FOR_BT_CTRL_EN_8197F BIT(40) -+#define BIT_WLACT_LOW_GNTWL_EN_8197F BIT(34) -+#define BIT_WLACT_HIGH_GNTBT_EN_8197F BIT(33) -+ -+#define BIT_SHIFT_RXMYRTS_NAV_V1_8197F 8 -+#define BIT_MASK_RXMYRTS_NAV_V1_8197F 0xff -+#define BIT_RXMYRTS_NAV_V1_8197F(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_V1_8197F) \ -+ << BIT_SHIFT_RXMYRTS_NAV_V1_8197F) -+#define BITS_RXMYRTS_NAV_V1_8197F \ -+ (BIT_MASK_RXMYRTS_NAV_V1_8197F << BIT_SHIFT_RXMYRTS_NAV_V1_8197F) -+#define BIT_CLEAR_RXMYRTS_NAV_V1_8197F(x) ((x) & (~BITS_RXMYRTS_NAV_V1_8197F)) -+#define BIT_GET_RXMYRTS_NAV_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_V1_8197F) & \ -+ BIT_MASK_RXMYRTS_NAV_V1_8197F) -+#define BIT_SET_RXMYRTS_NAV_V1_8197F(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_V1_8197F(x) | BIT_RXMYRTS_NAV_V1_8197F(v)) -+ -+#define BIT_SHIFT_RTSRST_V1_8197F 0 -+#define BIT_MASK_RTSRST_V1_8197F 0xff -+#define BIT_RTSRST_V1_8197F(x) \ -+ (((x) & BIT_MASK_RTSRST_V1_8197F) << BIT_SHIFT_RTSRST_V1_8197F) -+#define BITS_RTSRST_V1_8197F \ -+ (BIT_MASK_RTSRST_V1_8197F << BIT_SHIFT_RTSRST_V1_8197F) -+#define BIT_CLEAR_RTSRST_V1_8197F(x) ((x) & (~BITS_RTSRST_V1_8197F)) -+#define BIT_GET_RTSRST_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_V1_8197F) & BIT_MASK_RTSRST_V1_8197F) -+#define BIT_SET_RTSRST_V1_8197F(x, v) \ -+ (BIT_CLEAR_RTSRST_V1_8197F(x) | BIT_RTSRST_V1_8197F(v)) -+ -+/* 2 REG_BT_COEX_ENHANCED_INTR_CTRL_8197F */ -+ -+#define BIT_SHIFT_BT_STAT_DELAY_8197F 12 -+#define BIT_MASK_BT_STAT_DELAY_8197F 0xf -+#define BIT_BT_STAT_DELAY_8197F(x) \ -+ (((x) & BIT_MASK_BT_STAT_DELAY_8197F) << BIT_SHIFT_BT_STAT_DELAY_8197F) -+#define BITS_BT_STAT_DELAY_8197F \ -+ (BIT_MASK_BT_STAT_DELAY_8197F << BIT_SHIFT_BT_STAT_DELAY_8197F) -+#define BIT_CLEAR_BT_STAT_DELAY_8197F(x) ((x) & (~BITS_BT_STAT_DELAY_8197F)) -+#define BIT_GET_BT_STAT_DELAY_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_STAT_DELAY_8197F) & BIT_MASK_BT_STAT_DELAY_8197F) -+#define BIT_SET_BT_STAT_DELAY_8197F(x, v) \ -+ (BIT_CLEAR_BT_STAT_DELAY_8197F(x) | BIT_BT_STAT_DELAY_8197F(v)) -+ -+#define BIT_SHIFT_BT_TRX_INIT_DETECT_8197F 8 -+#define BIT_MASK_BT_TRX_INIT_DETECT_8197F 0xf -+#define BIT_BT_TRX_INIT_DETECT_8197F(x) \ -+ (((x) & BIT_MASK_BT_TRX_INIT_DETECT_8197F) \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8197F) -+#define BITS_BT_TRX_INIT_DETECT_8197F \ -+ (BIT_MASK_BT_TRX_INIT_DETECT_8197F \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8197F) -+#define BIT_CLEAR_BT_TRX_INIT_DETECT_8197F(x) \ -+ ((x) & (~BITS_BT_TRX_INIT_DETECT_8197F)) -+#define BIT_GET_BT_TRX_INIT_DETECT_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_TRX_INIT_DETECT_8197F) & \ -+ BIT_MASK_BT_TRX_INIT_DETECT_8197F) -+#define BIT_SET_BT_TRX_INIT_DETECT_8197F(x, v) \ -+ (BIT_CLEAR_BT_TRX_INIT_DETECT_8197F(x) | \ -+ BIT_BT_TRX_INIT_DETECT_8197F(v)) -+ -+#define BIT_SHIFT_BT_PRI_DETECT_TO_8197F 4 -+#define BIT_MASK_BT_PRI_DETECT_TO_8197F 0xf -+#define BIT_BT_PRI_DETECT_TO_8197F(x) \ -+ (((x) & BIT_MASK_BT_PRI_DETECT_TO_8197F) \ -+ << BIT_SHIFT_BT_PRI_DETECT_TO_8197F) -+#define BITS_BT_PRI_DETECT_TO_8197F \ -+ (BIT_MASK_BT_PRI_DETECT_TO_8197F << BIT_SHIFT_BT_PRI_DETECT_TO_8197F) -+#define BIT_CLEAR_BT_PRI_DETECT_TO_8197F(x) \ -+ ((x) & (~BITS_BT_PRI_DETECT_TO_8197F)) -+#define BIT_GET_BT_PRI_DETECT_TO_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_PRI_DETECT_TO_8197F) & \ -+ BIT_MASK_BT_PRI_DETECT_TO_8197F) -+#define BIT_SET_BT_PRI_DETECT_TO_8197F(x, v) \ -+ (BIT_CLEAR_BT_PRI_DETECT_TO_8197F(x) | BIT_BT_PRI_DETECT_TO_8197F(v)) -+ -+#define BIT_R_GRANTALL_WLMASK_8197F BIT(3) -+#define BIT_STATIS_BT_EN_8197F BIT(2) -+#define BIT_WL_ACT_MASK_ENABLE_8197F BIT(1) -+#define BIT_ENHANCED_BT_8197F BIT(0) -+ -+/* 2 REG_BT_ACT_STATISTICS_8197F */ -+ -+#define BIT_SHIFT_STATIS_BT_LO_RX_8197F (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_STATIS_BT_LO_RX_8197F 0xffff -+#define BIT_STATIS_BT_LO_RX_8197F(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_RX_8197F) \ -+ << BIT_SHIFT_STATIS_BT_LO_RX_8197F) -+#define BITS_STATIS_BT_LO_RX_8197F \ -+ (BIT_MASK_STATIS_BT_LO_RX_8197F << BIT_SHIFT_STATIS_BT_LO_RX_8197F) -+#define BIT_CLEAR_STATIS_BT_LO_RX_8197F(x) ((x) & (~BITS_STATIS_BT_LO_RX_8197F)) -+#define BIT_GET_STATIS_BT_LO_RX_8197F(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_RX_8197F) & \ -+ BIT_MASK_STATIS_BT_LO_RX_8197F) -+#define BIT_SET_STATIS_BT_LO_RX_8197F(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_RX_8197F(x) | BIT_STATIS_BT_LO_RX_8197F(v)) -+ -+#define BIT_SHIFT_STATIS_BT_LO_TX_8197F (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_STATIS_BT_LO_TX_8197F 0xffff -+#define BIT_STATIS_BT_LO_TX_8197F(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_TX_8197F) \ -+ << BIT_SHIFT_STATIS_BT_LO_TX_8197F) -+#define BITS_STATIS_BT_LO_TX_8197F \ -+ (BIT_MASK_STATIS_BT_LO_TX_8197F << BIT_SHIFT_STATIS_BT_LO_TX_8197F) -+#define BIT_CLEAR_STATIS_BT_LO_TX_8197F(x) ((x) & (~BITS_STATIS_BT_LO_TX_8197F)) -+#define BIT_GET_STATIS_BT_LO_TX_8197F(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_TX_8197F) & \ -+ BIT_MASK_STATIS_BT_LO_TX_8197F) -+#define BIT_SET_STATIS_BT_LO_TX_8197F(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_TX_8197F(x) | BIT_STATIS_BT_LO_TX_8197F(v)) -+ -+#define BIT_SHIFT_STATIS_BT_HI_RX_8197F 16 -+#define BIT_MASK_STATIS_BT_HI_RX_8197F 0xffff -+#define BIT_STATIS_BT_HI_RX_8197F(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_RX_8197F) \ -+ << BIT_SHIFT_STATIS_BT_HI_RX_8197F) -+#define BITS_STATIS_BT_HI_RX_8197F \ -+ (BIT_MASK_STATIS_BT_HI_RX_8197F << BIT_SHIFT_STATIS_BT_HI_RX_8197F) -+#define BIT_CLEAR_STATIS_BT_HI_RX_8197F(x) ((x) & (~BITS_STATIS_BT_HI_RX_8197F)) -+#define BIT_GET_STATIS_BT_HI_RX_8197F(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_RX_8197F) & \ -+ BIT_MASK_STATIS_BT_HI_RX_8197F) -+#define BIT_SET_STATIS_BT_HI_RX_8197F(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_RX_8197F(x) | BIT_STATIS_BT_HI_RX_8197F(v)) -+ -+#define BIT_SHIFT_STATIS_BT_HI_TX_8197F 0 -+#define BIT_MASK_STATIS_BT_HI_TX_8197F 0xffff -+#define BIT_STATIS_BT_HI_TX_8197F(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_TX_8197F) \ -+ << BIT_SHIFT_STATIS_BT_HI_TX_8197F) -+#define BITS_STATIS_BT_HI_TX_8197F \ -+ (BIT_MASK_STATIS_BT_HI_TX_8197F << BIT_SHIFT_STATIS_BT_HI_TX_8197F) -+#define BIT_CLEAR_STATIS_BT_HI_TX_8197F(x) ((x) & (~BITS_STATIS_BT_HI_TX_8197F)) -+#define BIT_GET_STATIS_BT_HI_TX_8197F(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_TX_8197F) & \ -+ BIT_MASK_STATIS_BT_HI_TX_8197F) -+#define BIT_SET_STATIS_BT_HI_TX_8197F(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_TX_8197F(x) | BIT_STATIS_BT_HI_TX_8197F(v)) -+ -+/* 2 REG_BT_STATISTICS_CONTROL_REGISTER_8197F */ -+ -+#define BIT_SHIFT_R_BT_CMD_RPT_8197F 16 -+#define BIT_MASK_R_BT_CMD_RPT_8197F 0xffff -+#define BIT_R_BT_CMD_RPT_8197F(x) \ -+ (((x) & BIT_MASK_R_BT_CMD_RPT_8197F) << BIT_SHIFT_R_BT_CMD_RPT_8197F) -+#define BITS_R_BT_CMD_RPT_8197F \ -+ (BIT_MASK_R_BT_CMD_RPT_8197F << BIT_SHIFT_R_BT_CMD_RPT_8197F) -+#define BIT_CLEAR_R_BT_CMD_RPT_8197F(x) ((x) & (~BITS_R_BT_CMD_RPT_8197F)) -+#define BIT_GET_R_BT_CMD_RPT_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CMD_RPT_8197F) & BIT_MASK_R_BT_CMD_RPT_8197F) -+#define BIT_SET_R_BT_CMD_RPT_8197F(x, v) \ -+ (BIT_CLEAR_R_BT_CMD_RPT_8197F(x) | BIT_R_BT_CMD_RPT_8197F(v)) -+ -+#define BIT_SHIFT_R_RPT_FROM_BT_8197F 8 -+#define BIT_MASK_R_RPT_FROM_BT_8197F 0xff -+#define BIT_R_RPT_FROM_BT_8197F(x) \ -+ (((x) & BIT_MASK_R_RPT_FROM_BT_8197F) << BIT_SHIFT_R_RPT_FROM_BT_8197F) -+#define BITS_R_RPT_FROM_BT_8197F \ -+ (BIT_MASK_R_RPT_FROM_BT_8197F << BIT_SHIFT_R_RPT_FROM_BT_8197F) -+#define BIT_CLEAR_R_RPT_FROM_BT_8197F(x) ((x) & (~BITS_R_RPT_FROM_BT_8197F)) -+#define BIT_GET_R_RPT_FROM_BT_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_RPT_FROM_BT_8197F) & BIT_MASK_R_RPT_FROM_BT_8197F) -+#define BIT_SET_R_RPT_FROM_BT_8197F(x, v) \ -+ (BIT_CLEAR_R_RPT_FROM_BT_8197F(x) | BIT_R_RPT_FROM_BT_8197F(v)) -+ -+#define BIT_SHIFT_BT_HID_ISR_SET_8197F 6 -+#define BIT_MASK_BT_HID_ISR_SET_8197F 0x3 -+#define BIT_BT_HID_ISR_SET_8197F(x) \ -+ (((x) & BIT_MASK_BT_HID_ISR_SET_8197F) \ -+ << BIT_SHIFT_BT_HID_ISR_SET_8197F) -+#define BITS_BT_HID_ISR_SET_8197F \ -+ (BIT_MASK_BT_HID_ISR_SET_8197F << BIT_SHIFT_BT_HID_ISR_SET_8197F) -+#define BIT_CLEAR_BT_HID_ISR_SET_8197F(x) ((x) & (~BITS_BT_HID_ISR_SET_8197F)) -+#define BIT_GET_BT_HID_ISR_SET_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_HID_ISR_SET_8197F) & \ -+ BIT_MASK_BT_HID_ISR_SET_8197F) -+#define BIT_SET_BT_HID_ISR_SET_8197F(x, v) \ -+ (BIT_CLEAR_BT_HID_ISR_SET_8197F(x) | BIT_BT_HID_ISR_SET_8197F(v)) -+ -+#define BIT_TDMA_BT_START_NOTIFY_8197F BIT(5) -+#define BIT_ENABLE_TDMA_FW_MODE_8197F BIT(4) -+#define BIT_ENABLE_PTA_TDMA_MODE_8197F BIT(3) -+#define BIT_ENABLE_COEXIST_TAB_IN_TDMA_8197F BIT(2) -+#define BIT_GPIO2_GPIO3_EXANGE_OR_NO_BT_CCA_8197F BIT(1) -+#define BIT_RTK_BT_ENABLE_8197F BIT(0) -+ -+/* 2 REG_BT_STATUS_REPORT_REGISTER_8197F */ -+ -+#define BIT_SHIFT_BT_PROFILE_8197F 24 -+#define BIT_MASK_BT_PROFILE_8197F 0xff -+#define BIT_BT_PROFILE_8197F(x) \ -+ (((x) & BIT_MASK_BT_PROFILE_8197F) << BIT_SHIFT_BT_PROFILE_8197F) -+#define BITS_BT_PROFILE_8197F \ -+ (BIT_MASK_BT_PROFILE_8197F << BIT_SHIFT_BT_PROFILE_8197F) -+#define BIT_CLEAR_BT_PROFILE_8197F(x) ((x) & (~BITS_BT_PROFILE_8197F)) -+#define BIT_GET_BT_PROFILE_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_PROFILE_8197F) & BIT_MASK_BT_PROFILE_8197F) -+#define BIT_SET_BT_PROFILE_8197F(x, v) \ -+ (BIT_CLEAR_BT_PROFILE_8197F(x) | BIT_BT_PROFILE_8197F(v)) -+ -+#define BIT_SHIFT_BT_POWER_8197F 16 -+#define BIT_MASK_BT_POWER_8197F 0xff -+#define BIT_BT_POWER_8197F(x) \ -+ (((x) & BIT_MASK_BT_POWER_8197F) << BIT_SHIFT_BT_POWER_8197F) -+#define BITS_BT_POWER_8197F \ -+ (BIT_MASK_BT_POWER_8197F << BIT_SHIFT_BT_POWER_8197F) -+#define BIT_CLEAR_BT_POWER_8197F(x) ((x) & (~BITS_BT_POWER_8197F)) -+#define BIT_GET_BT_POWER_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_POWER_8197F) & BIT_MASK_BT_POWER_8197F) -+#define BIT_SET_BT_POWER_8197F(x, v) \ -+ (BIT_CLEAR_BT_POWER_8197F(x) | BIT_BT_POWER_8197F(v)) -+ -+#define BIT_SHIFT_BT_PREDECT_STATUS_8197F 8 -+#define BIT_MASK_BT_PREDECT_STATUS_8197F 0xff -+#define BIT_BT_PREDECT_STATUS_8197F(x) \ -+ (((x) & BIT_MASK_BT_PREDECT_STATUS_8197F) \ -+ << BIT_SHIFT_BT_PREDECT_STATUS_8197F) -+#define BITS_BT_PREDECT_STATUS_8197F \ -+ (BIT_MASK_BT_PREDECT_STATUS_8197F << BIT_SHIFT_BT_PREDECT_STATUS_8197F) -+#define BIT_CLEAR_BT_PREDECT_STATUS_8197F(x) \ -+ ((x) & (~BITS_BT_PREDECT_STATUS_8197F)) -+#define BIT_GET_BT_PREDECT_STATUS_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_PREDECT_STATUS_8197F) & \ -+ BIT_MASK_BT_PREDECT_STATUS_8197F) -+#define BIT_SET_BT_PREDECT_STATUS_8197F(x, v) \ -+ (BIT_CLEAR_BT_PREDECT_STATUS_8197F(x) | BIT_BT_PREDECT_STATUS_8197F(v)) -+ -+#define BIT_SHIFT_BT_CMD_INFO_8197F 0 -+#define BIT_MASK_BT_CMD_INFO_8197F 0xff -+#define BIT_BT_CMD_INFO_8197F(x) \ -+ (((x) & BIT_MASK_BT_CMD_INFO_8197F) << BIT_SHIFT_BT_CMD_INFO_8197F) -+#define BITS_BT_CMD_INFO_8197F \ -+ (BIT_MASK_BT_CMD_INFO_8197F << BIT_SHIFT_BT_CMD_INFO_8197F) -+#define BIT_CLEAR_BT_CMD_INFO_8197F(x) ((x) & (~BITS_BT_CMD_INFO_8197F)) -+#define BIT_GET_BT_CMD_INFO_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_CMD_INFO_8197F) & BIT_MASK_BT_CMD_INFO_8197F) -+#define BIT_SET_BT_CMD_INFO_8197F(x, v) \ -+ (BIT_CLEAR_BT_CMD_INFO_8197F(x) | BIT_BT_CMD_INFO_8197F(v)) -+ -+/* 2 REG_BT_INTERRUPT_CONTROL_REGISTER_8197F */ -+#define BIT_EN_MAC_NULL_PKT_NOTIFY_8197F BIT(31) -+#define BIT_EN_WLAN_RPT_AND_BT_QUERY_8197F BIT(30) -+#define BIT_EN_BT_STSTUS_RPT_8197F BIT(29) -+#define BIT_EN_BT_POWER_8197F BIT(28) -+#define BIT_EN_BT_CHANNEL_8197F BIT(27) -+#define BIT_EN_BT_SLOT_CHANGE_8197F BIT(26) -+#define BIT_EN_BT_PROFILE_OR_HID_8197F BIT(25) -+#define BIT_WLAN_RPT_NOTIFY_8197F BIT(24) -+ -+#define BIT_SHIFT_WLAN_RPT_DATA_8197F 16 -+#define BIT_MASK_WLAN_RPT_DATA_8197F 0xff -+#define BIT_WLAN_RPT_DATA_8197F(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_DATA_8197F) << BIT_SHIFT_WLAN_RPT_DATA_8197F) -+#define BITS_WLAN_RPT_DATA_8197F \ -+ (BIT_MASK_WLAN_RPT_DATA_8197F << BIT_SHIFT_WLAN_RPT_DATA_8197F) -+#define BIT_CLEAR_WLAN_RPT_DATA_8197F(x) ((x) & (~BITS_WLAN_RPT_DATA_8197F)) -+#define BIT_GET_WLAN_RPT_DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_DATA_8197F) & BIT_MASK_WLAN_RPT_DATA_8197F) -+#define BIT_SET_WLAN_RPT_DATA_8197F(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_DATA_8197F(x) | BIT_WLAN_RPT_DATA_8197F(v)) -+ -+#define BIT_SHIFT_CMD_ID_8197F 8 -+#define BIT_MASK_CMD_ID_8197F 0xff -+#define BIT_CMD_ID_8197F(x) \ -+ (((x) & BIT_MASK_CMD_ID_8197F) << BIT_SHIFT_CMD_ID_8197F) -+#define BITS_CMD_ID_8197F (BIT_MASK_CMD_ID_8197F << BIT_SHIFT_CMD_ID_8197F) -+#define BIT_CLEAR_CMD_ID_8197F(x) ((x) & (~BITS_CMD_ID_8197F)) -+#define BIT_GET_CMD_ID_8197F(x) \ -+ (((x) >> BIT_SHIFT_CMD_ID_8197F) & BIT_MASK_CMD_ID_8197F) -+#define BIT_SET_CMD_ID_8197F(x, v) \ -+ (BIT_CLEAR_CMD_ID_8197F(x) | BIT_CMD_ID_8197F(v)) -+ -+#define BIT_SHIFT_BT_DATA_8197F 0 -+#define BIT_MASK_BT_DATA_8197F 0xff -+#define BIT_BT_DATA_8197F(x) \ -+ (((x) & BIT_MASK_BT_DATA_8197F) << BIT_SHIFT_BT_DATA_8197F) -+#define BITS_BT_DATA_8197F (BIT_MASK_BT_DATA_8197F << BIT_SHIFT_BT_DATA_8197F) -+#define BIT_CLEAR_BT_DATA_8197F(x) ((x) & (~BITS_BT_DATA_8197F)) -+#define BIT_GET_BT_DATA_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_DATA_8197F) & BIT_MASK_BT_DATA_8197F) -+#define BIT_SET_BT_DATA_8197F(x, v) \ -+ (BIT_CLEAR_BT_DATA_8197F(x) | BIT_BT_DATA_8197F(v)) -+ -+/* 2 REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8197F */ -+ -+#define BIT_SHIFT_WLAN_RPT_TO_8197F 0 -+#define BIT_MASK_WLAN_RPT_TO_8197F 0xff -+#define BIT_WLAN_RPT_TO_8197F(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_TO_8197F) << BIT_SHIFT_WLAN_RPT_TO_8197F) -+#define BITS_WLAN_RPT_TO_8197F \ -+ (BIT_MASK_WLAN_RPT_TO_8197F << BIT_SHIFT_WLAN_RPT_TO_8197F) -+#define BIT_CLEAR_WLAN_RPT_TO_8197F(x) ((x) & (~BITS_WLAN_RPT_TO_8197F)) -+#define BIT_GET_WLAN_RPT_TO_8197F(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_TO_8197F) & BIT_MASK_WLAN_RPT_TO_8197F) -+#define BIT_SET_WLAN_RPT_TO_8197F(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_TO_8197F(x) | BIT_WLAN_RPT_TO_8197F(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8197F */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_8197F 1 -+#define BIT_MASK_ISOLATION_CHK_8197F 0x7fffffffffffffffffffL -+#define BIT_ISOLATION_CHK_8197F(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_8197F) << BIT_SHIFT_ISOLATION_CHK_8197F) -+#define BITS_ISOLATION_CHK_8197F \ -+ (BIT_MASK_ISOLATION_CHK_8197F << BIT_SHIFT_ISOLATION_CHK_8197F) -+#define BIT_CLEAR_ISOLATION_CHK_8197F(x) ((x) & (~BITS_ISOLATION_CHK_8197F)) -+#define BIT_GET_ISOLATION_CHK_8197F(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_8197F) & BIT_MASK_ISOLATION_CHK_8197F) -+#define BIT_SET_ISOLATION_CHK_8197F(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_8197F(x) | BIT_ISOLATION_CHK_8197F(v)) -+ -+#define BIT_ISOLATION_EN_8197F BIT(0) -+ -+/* 2 REG_BT_INTERRUPT_STATUS_REGISTER_8197F */ -+#define BIT_BT_HID_ISR_8197F BIT(7) -+#define BIT_BT_QUERY_ISR_8197F BIT(6) -+#define BIT_MAC_NULL_PKT_NOTIFY_ISR_8197F BIT(5) -+#define BIT_WLAN_RPT_ISR_8197F BIT(4) -+#define BIT_BT_POWER_ISR_8197F BIT(3) -+#define BIT_BT_CHANNEL_ISR_8197F BIT(2) -+#define BIT_BT_SLOT_CHANGE_ISR_8197F BIT(1) -+#define BIT_BT_PROFILE_ISR_8197F BIT(0) -+ -+/* 2 REG_BT_TDMA_TIME_REGISTER_8197F */ -+ -+#define BIT_SHIFT_BT_TIME_8197F 6 -+#define BIT_MASK_BT_TIME_8197F 0x3ffffff -+#define BIT_BT_TIME_8197F(x) \ -+ (((x) & BIT_MASK_BT_TIME_8197F) << BIT_SHIFT_BT_TIME_8197F) -+#define BITS_BT_TIME_8197F (BIT_MASK_BT_TIME_8197F << BIT_SHIFT_BT_TIME_8197F) -+#define BIT_CLEAR_BT_TIME_8197F(x) ((x) & (~BITS_BT_TIME_8197F)) -+#define BIT_GET_BT_TIME_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_TIME_8197F) & BIT_MASK_BT_TIME_8197F) -+#define BIT_SET_BT_TIME_8197F(x, v) \ -+ (BIT_CLEAR_BT_TIME_8197F(x) | BIT_BT_TIME_8197F(v)) -+ -+#define BIT_SHIFT_BT_RPT_SAMPLE_RATE_8197F 0 -+#define BIT_MASK_BT_RPT_SAMPLE_RATE_8197F 0x3f -+#define BIT_BT_RPT_SAMPLE_RATE_8197F(x) \ -+ (((x) & BIT_MASK_BT_RPT_SAMPLE_RATE_8197F) \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8197F) -+#define BITS_BT_RPT_SAMPLE_RATE_8197F \ -+ (BIT_MASK_BT_RPT_SAMPLE_RATE_8197F \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8197F) -+#define BIT_CLEAR_BT_RPT_SAMPLE_RATE_8197F(x) \ -+ ((x) & (~BITS_BT_RPT_SAMPLE_RATE_8197F)) -+#define BIT_GET_BT_RPT_SAMPLE_RATE_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_RPT_SAMPLE_RATE_8197F) & \ -+ BIT_MASK_BT_RPT_SAMPLE_RATE_8197F) -+#define BIT_SET_BT_RPT_SAMPLE_RATE_8197F(x, v) \ -+ (BIT_CLEAR_BT_RPT_SAMPLE_RATE_8197F(x) | \ -+ BIT_BT_RPT_SAMPLE_RATE_8197F(v)) -+ -+/* 2 REG_BT_ACT_REGISTER_8197F */ -+ -+#define BIT_SHIFT_BT_EISR_EN_8197F 16 -+#define BIT_MASK_BT_EISR_EN_8197F 0xff -+#define BIT_BT_EISR_EN_8197F(x) \ -+ (((x) & BIT_MASK_BT_EISR_EN_8197F) << BIT_SHIFT_BT_EISR_EN_8197F) -+#define BITS_BT_EISR_EN_8197F \ -+ (BIT_MASK_BT_EISR_EN_8197F << BIT_SHIFT_BT_EISR_EN_8197F) -+#define BIT_CLEAR_BT_EISR_EN_8197F(x) ((x) & (~BITS_BT_EISR_EN_8197F)) -+#define BIT_GET_BT_EISR_EN_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_EISR_EN_8197F) & BIT_MASK_BT_EISR_EN_8197F) -+#define BIT_SET_BT_EISR_EN_8197F(x, v) \ -+ (BIT_CLEAR_BT_EISR_EN_8197F(x) | BIT_BT_EISR_EN_8197F(v)) -+ -+#define BIT_BT_ACT_FALLING_ISR_8197F BIT(10) -+#define BIT_BT_ACT_RISING_ISR_8197F BIT(9) -+#define BIT_TDMA_TO_ISR_8197F BIT(8) -+ -+#define BIT_SHIFT_BT_CH_8197F 0 -+#define BIT_MASK_BT_CH_8197F 0xff -+#define BIT_BT_CH_8197F(x) \ -+ (((x) & BIT_MASK_BT_CH_8197F) << BIT_SHIFT_BT_CH_8197F) -+#define BITS_BT_CH_8197F (BIT_MASK_BT_CH_8197F << BIT_SHIFT_BT_CH_8197F) -+#define BIT_CLEAR_BT_CH_8197F(x) ((x) & (~BITS_BT_CH_8197F)) -+#define BIT_GET_BT_CH_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_CH_8197F) & BIT_MASK_BT_CH_8197F) -+#define BIT_SET_BT_CH_8197F(x, v) \ -+ (BIT_CLEAR_BT_CH_8197F(x) | BIT_BT_CH_8197F(v)) -+ -+/* 2 REG_OBFF_CTRL_BASIC_8197F */ -+#define BIT_OBFF_EN_V1_8197F BIT(31) -+ -+#define BIT_SHIFT_OBFF_STATE_V1_8197F 28 -+#define BIT_MASK_OBFF_STATE_V1_8197F 0x3 -+#define BIT_OBFF_STATE_V1_8197F(x) \ -+ (((x) & BIT_MASK_OBFF_STATE_V1_8197F) << BIT_SHIFT_OBFF_STATE_V1_8197F) -+#define BITS_OBFF_STATE_V1_8197F \ -+ (BIT_MASK_OBFF_STATE_V1_8197F << BIT_SHIFT_OBFF_STATE_V1_8197F) -+#define BIT_CLEAR_OBFF_STATE_V1_8197F(x) ((x) & (~BITS_OBFF_STATE_V1_8197F)) -+#define BIT_GET_OBFF_STATE_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_OBFF_STATE_V1_8197F) & BIT_MASK_OBFF_STATE_V1_8197F) -+#define BIT_SET_OBFF_STATE_V1_8197F(x, v) \ -+ (BIT_CLEAR_OBFF_STATE_V1_8197F(x) | BIT_OBFF_STATE_V1_8197F(v)) -+ -+#define BIT_OBFF_ACT_RXDMA_EN_8197F BIT(27) -+#define BIT_OBFF_BLOCK_INT_EN_8197F BIT(26) -+#define BIT_OBFF_AUTOACT_EN_8197F BIT(25) -+#define BIT_OBFF_AUTOIDLE_EN_8197F BIT(24) -+ -+#define BIT_SHIFT_WAKE_MAX_PLS_8197F 20 -+#define BIT_MASK_WAKE_MAX_PLS_8197F 0x7 -+#define BIT_WAKE_MAX_PLS_8197F(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_PLS_8197F) << BIT_SHIFT_WAKE_MAX_PLS_8197F) -+#define BITS_WAKE_MAX_PLS_8197F \ -+ (BIT_MASK_WAKE_MAX_PLS_8197F << BIT_SHIFT_WAKE_MAX_PLS_8197F) -+#define BIT_CLEAR_WAKE_MAX_PLS_8197F(x) ((x) & (~BITS_WAKE_MAX_PLS_8197F)) -+#define BIT_GET_WAKE_MAX_PLS_8197F(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_PLS_8197F) & BIT_MASK_WAKE_MAX_PLS_8197F) -+#define BIT_SET_WAKE_MAX_PLS_8197F(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_PLS_8197F(x) | BIT_WAKE_MAX_PLS_8197F(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_PLS_8197F 16 -+#define BIT_MASK_WAKE_MIN_PLS_8197F 0x7 -+#define BIT_WAKE_MIN_PLS_8197F(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_PLS_8197F) << BIT_SHIFT_WAKE_MIN_PLS_8197F) -+#define BITS_WAKE_MIN_PLS_8197F \ -+ (BIT_MASK_WAKE_MIN_PLS_8197F << BIT_SHIFT_WAKE_MIN_PLS_8197F) -+#define BIT_CLEAR_WAKE_MIN_PLS_8197F(x) ((x) & (~BITS_WAKE_MIN_PLS_8197F)) -+#define BIT_GET_WAKE_MIN_PLS_8197F(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_PLS_8197F) & BIT_MASK_WAKE_MIN_PLS_8197F) -+#define BIT_SET_WAKE_MIN_PLS_8197F(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_PLS_8197F(x) | BIT_WAKE_MIN_PLS_8197F(v)) -+ -+#define BIT_SHIFT_WAKE_MAX_F2F_8197F 12 -+#define BIT_MASK_WAKE_MAX_F2F_8197F 0x7 -+#define BIT_WAKE_MAX_F2F_8197F(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_F2F_8197F) << BIT_SHIFT_WAKE_MAX_F2F_8197F) -+#define BITS_WAKE_MAX_F2F_8197F \ -+ (BIT_MASK_WAKE_MAX_F2F_8197F << BIT_SHIFT_WAKE_MAX_F2F_8197F) -+#define BIT_CLEAR_WAKE_MAX_F2F_8197F(x) ((x) & (~BITS_WAKE_MAX_F2F_8197F)) -+#define BIT_GET_WAKE_MAX_F2F_8197F(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_F2F_8197F) & BIT_MASK_WAKE_MAX_F2F_8197F) -+#define BIT_SET_WAKE_MAX_F2F_8197F(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_F2F_8197F(x) | BIT_WAKE_MAX_F2F_8197F(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_F2F_8197F 8 -+#define BIT_MASK_WAKE_MIN_F2F_8197F 0x7 -+#define BIT_WAKE_MIN_F2F_8197F(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_F2F_8197F) << BIT_SHIFT_WAKE_MIN_F2F_8197F) -+#define BITS_WAKE_MIN_F2F_8197F \ -+ (BIT_MASK_WAKE_MIN_F2F_8197F << BIT_SHIFT_WAKE_MIN_F2F_8197F) -+#define BIT_CLEAR_WAKE_MIN_F2F_8197F(x) ((x) & (~BITS_WAKE_MIN_F2F_8197F)) -+#define BIT_GET_WAKE_MIN_F2F_8197F(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_F2F_8197F) & BIT_MASK_WAKE_MIN_F2F_8197F) -+#define BIT_SET_WAKE_MIN_F2F_8197F(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_F2F_8197F(x) | BIT_WAKE_MIN_F2F_8197F(v)) -+ -+#define BIT_APP_CPU_ACT_V1_8197F BIT(3) -+#define BIT_APP_OBFF_V1_8197F BIT(2) -+#define BIT_APP_IDLE_V1_8197F BIT(1) -+#define BIT_APP_INIT_V1_8197F BIT(0) -+ -+/* 2 REG_OBFF_CTRL2_TIMER_8197F */ -+ -+#define BIT_SHIFT_RX_HIGH_TIMER_IDX_8197F 24 -+#define BIT_MASK_RX_HIGH_TIMER_IDX_8197F 0x7 -+#define BIT_RX_HIGH_TIMER_IDX_8197F(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TIMER_IDX_8197F) \ -+ << BIT_SHIFT_RX_HIGH_TIMER_IDX_8197F) -+#define BITS_RX_HIGH_TIMER_IDX_8197F \ -+ (BIT_MASK_RX_HIGH_TIMER_IDX_8197F << BIT_SHIFT_RX_HIGH_TIMER_IDX_8197F) -+#define BIT_CLEAR_RX_HIGH_TIMER_IDX_8197F(x) \ -+ ((x) & (~BITS_RX_HIGH_TIMER_IDX_8197F)) -+#define BIT_GET_RX_HIGH_TIMER_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TIMER_IDX_8197F) & \ -+ BIT_MASK_RX_HIGH_TIMER_IDX_8197F) -+#define BIT_SET_RX_HIGH_TIMER_IDX_8197F(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TIMER_IDX_8197F(x) | BIT_RX_HIGH_TIMER_IDX_8197F(v)) -+ -+#define BIT_SHIFT_RX_MED_TIMER_IDX_8197F 16 -+#define BIT_MASK_RX_MED_TIMER_IDX_8197F 0x7 -+#define BIT_RX_MED_TIMER_IDX_8197F(x) \ -+ (((x) & BIT_MASK_RX_MED_TIMER_IDX_8197F) \ -+ << BIT_SHIFT_RX_MED_TIMER_IDX_8197F) -+#define BITS_RX_MED_TIMER_IDX_8197F \ -+ (BIT_MASK_RX_MED_TIMER_IDX_8197F << BIT_SHIFT_RX_MED_TIMER_IDX_8197F) -+#define BIT_CLEAR_RX_MED_TIMER_IDX_8197F(x) \ -+ ((x) & (~BITS_RX_MED_TIMER_IDX_8197F)) -+#define BIT_GET_RX_MED_TIMER_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TIMER_IDX_8197F) & \ -+ BIT_MASK_RX_MED_TIMER_IDX_8197F) -+#define BIT_SET_RX_MED_TIMER_IDX_8197F(x, v) \ -+ (BIT_CLEAR_RX_MED_TIMER_IDX_8197F(x) | BIT_RX_MED_TIMER_IDX_8197F(v)) -+ -+#define BIT_SHIFT_RX_LOW_TIMER_IDX_8197F 8 -+#define BIT_MASK_RX_LOW_TIMER_IDX_8197F 0x7 -+#define BIT_RX_LOW_TIMER_IDX_8197F(x) \ -+ (((x) & BIT_MASK_RX_LOW_TIMER_IDX_8197F) \ -+ << BIT_SHIFT_RX_LOW_TIMER_IDX_8197F) -+#define BITS_RX_LOW_TIMER_IDX_8197F \ -+ (BIT_MASK_RX_LOW_TIMER_IDX_8197F << BIT_SHIFT_RX_LOW_TIMER_IDX_8197F) -+#define BIT_CLEAR_RX_LOW_TIMER_IDX_8197F(x) \ -+ ((x) & (~BITS_RX_LOW_TIMER_IDX_8197F)) -+#define BIT_GET_RX_LOW_TIMER_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TIMER_IDX_8197F) & \ -+ BIT_MASK_RX_LOW_TIMER_IDX_8197F) -+#define BIT_SET_RX_LOW_TIMER_IDX_8197F(x, v) \ -+ (BIT_CLEAR_RX_LOW_TIMER_IDX_8197F(x) | BIT_RX_LOW_TIMER_IDX_8197F(v)) -+ -+#define BIT_SHIFT_OBFF_INT_TIMER_IDX_8197F 0 -+#define BIT_MASK_OBFF_INT_TIMER_IDX_8197F 0x7 -+#define BIT_OBFF_INT_TIMER_IDX_8197F(x) \ -+ (((x) & BIT_MASK_OBFF_INT_TIMER_IDX_8197F) \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8197F) -+#define BITS_OBFF_INT_TIMER_IDX_8197F \ -+ (BIT_MASK_OBFF_INT_TIMER_IDX_8197F \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8197F) -+#define BIT_CLEAR_OBFF_INT_TIMER_IDX_8197F(x) \ -+ ((x) & (~BITS_OBFF_INT_TIMER_IDX_8197F)) -+#define BIT_GET_OBFF_INT_TIMER_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_OBFF_INT_TIMER_IDX_8197F) & \ -+ BIT_MASK_OBFF_INT_TIMER_IDX_8197F) -+#define BIT_SET_OBFF_INT_TIMER_IDX_8197F(x, v) \ -+ (BIT_CLEAR_OBFF_INT_TIMER_IDX_8197F(x) | \ -+ BIT_OBFF_INT_TIMER_IDX_8197F(v)) -+ -+/* 2 REG_LTR_CTRL_BASIC_8197F */ -+#define BIT_LTR_EN_V1_8197F BIT(31) -+#define BIT_LTR_HW_EN_V1_8197F BIT(30) -+#define BIT_LRT_ACT_CTS_EN_8197F BIT(29) -+#define BIT_LTR_ACT_RXPKT_EN_8197F BIT(28) -+#define BIT_LTR_ACT_RXDMA_EN_8197F BIT(27) -+#define BIT_LTR_IDLE_NO_SNOOP_8197F BIT(26) -+#define BIT_SPDUP_MGTPKT_8197F BIT(25) -+#define BIT_RX_AGG_EN_8197F BIT(24) -+#define BIT_APP_LTR_ACT_8197F BIT(23) -+#define BIT_APP_LTR_IDLE_8197F BIT(22) -+ -+#define BIT_SHIFT_HIGH_RATE_TRIG_SEL_8197F 20 -+#define BIT_MASK_HIGH_RATE_TRIG_SEL_8197F 0x3 -+#define BIT_HIGH_RATE_TRIG_SEL_8197F(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_TRIG_SEL_8197F) \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8197F) -+#define BITS_HIGH_RATE_TRIG_SEL_8197F \ -+ (BIT_MASK_HIGH_RATE_TRIG_SEL_8197F \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8197F) -+#define BIT_CLEAR_HIGH_RATE_TRIG_SEL_8197F(x) \ -+ ((x) & (~BITS_HIGH_RATE_TRIG_SEL_8197F)) -+#define BIT_GET_HIGH_RATE_TRIG_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_TRIG_SEL_8197F) & \ -+ BIT_MASK_HIGH_RATE_TRIG_SEL_8197F) -+#define BIT_SET_HIGH_RATE_TRIG_SEL_8197F(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_TRIG_SEL_8197F(x) | \ -+ BIT_HIGH_RATE_TRIG_SEL_8197F(v)) -+ -+#define BIT_SHIFT_MED_RATE_TRIG_SEL_8197F 18 -+#define BIT_MASK_MED_RATE_TRIG_SEL_8197F 0x3 -+#define BIT_MED_RATE_TRIG_SEL_8197F(x) \ -+ (((x) & BIT_MASK_MED_RATE_TRIG_SEL_8197F) \ -+ << BIT_SHIFT_MED_RATE_TRIG_SEL_8197F) -+#define BITS_MED_RATE_TRIG_SEL_8197F \ -+ (BIT_MASK_MED_RATE_TRIG_SEL_8197F << BIT_SHIFT_MED_RATE_TRIG_SEL_8197F) -+#define BIT_CLEAR_MED_RATE_TRIG_SEL_8197F(x) \ -+ ((x) & (~BITS_MED_RATE_TRIG_SEL_8197F)) -+#define BIT_GET_MED_RATE_TRIG_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_MED_RATE_TRIG_SEL_8197F) & \ -+ BIT_MASK_MED_RATE_TRIG_SEL_8197F) -+#define BIT_SET_MED_RATE_TRIG_SEL_8197F(x, v) \ -+ (BIT_CLEAR_MED_RATE_TRIG_SEL_8197F(x) | BIT_MED_RATE_TRIG_SEL_8197F(v)) -+ -+#define BIT_SHIFT_LOW_RATE_TRIG_SEL_8197F 16 -+#define BIT_MASK_LOW_RATE_TRIG_SEL_8197F 0x3 -+#define BIT_LOW_RATE_TRIG_SEL_8197F(x) \ -+ (((x) & BIT_MASK_LOW_RATE_TRIG_SEL_8197F) \ -+ << BIT_SHIFT_LOW_RATE_TRIG_SEL_8197F) -+#define BITS_LOW_RATE_TRIG_SEL_8197F \ -+ (BIT_MASK_LOW_RATE_TRIG_SEL_8197F << BIT_SHIFT_LOW_RATE_TRIG_SEL_8197F) -+#define BIT_CLEAR_LOW_RATE_TRIG_SEL_8197F(x) \ -+ ((x) & (~BITS_LOW_RATE_TRIG_SEL_8197F)) -+#define BIT_GET_LOW_RATE_TRIG_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_TRIG_SEL_8197F) & \ -+ BIT_MASK_LOW_RATE_TRIG_SEL_8197F) -+#define BIT_SET_LOW_RATE_TRIG_SEL_8197F(x, v) \ -+ (BIT_CLEAR_LOW_RATE_TRIG_SEL_8197F(x) | BIT_LOW_RATE_TRIG_SEL_8197F(v)) -+ -+#define BIT_SHIFT_HIGH_RATE_BD_IDX_8197F 8 -+#define BIT_MASK_HIGH_RATE_BD_IDX_8197F 0x7f -+#define BIT_HIGH_RATE_BD_IDX_8197F(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_BD_IDX_8197F) \ -+ << BIT_SHIFT_HIGH_RATE_BD_IDX_8197F) -+#define BITS_HIGH_RATE_BD_IDX_8197F \ -+ (BIT_MASK_HIGH_RATE_BD_IDX_8197F << BIT_SHIFT_HIGH_RATE_BD_IDX_8197F) -+#define BIT_CLEAR_HIGH_RATE_BD_IDX_8197F(x) \ -+ ((x) & (~BITS_HIGH_RATE_BD_IDX_8197F)) -+#define BIT_GET_HIGH_RATE_BD_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_BD_IDX_8197F) & \ -+ BIT_MASK_HIGH_RATE_BD_IDX_8197F) -+#define BIT_SET_HIGH_RATE_BD_IDX_8197F(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_BD_IDX_8197F(x) | BIT_HIGH_RATE_BD_IDX_8197F(v)) -+ -+#define BIT_SHIFT_LOW_RATE_BD_IDX_8197F 0 -+#define BIT_MASK_LOW_RATE_BD_IDX_8197F 0x7f -+#define BIT_LOW_RATE_BD_IDX_8197F(x) \ -+ (((x) & BIT_MASK_LOW_RATE_BD_IDX_8197F) \ -+ << BIT_SHIFT_LOW_RATE_BD_IDX_8197F) -+#define BITS_LOW_RATE_BD_IDX_8197F \ -+ (BIT_MASK_LOW_RATE_BD_IDX_8197F << BIT_SHIFT_LOW_RATE_BD_IDX_8197F) -+#define BIT_CLEAR_LOW_RATE_BD_IDX_8197F(x) ((x) & (~BITS_LOW_RATE_BD_IDX_8197F)) -+#define BIT_GET_LOW_RATE_BD_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_BD_IDX_8197F) & \ -+ BIT_MASK_LOW_RATE_BD_IDX_8197F) -+#define BIT_SET_LOW_RATE_BD_IDX_8197F(x, v) \ -+ (BIT_CLEAR_LOW_RATE_BD_IDX_8197F(x) | BIT_LOW_RATE_BD_IDX_8197F(v)) -+ -+/* 2 REG_LTR_CTRL2_TIMER_THRESHOLD_8197F */ -+ -+#define BIT_SHIFT_RX_EMPTY_TIMER_IDX_8197F 24 -+#define BIT_MASK_RX_EMPTY_TIMER_IDX_8197F 0x7 -+#define BIT_RX_EMPTY_TIMER_IDX_8197F(x) \ -+ (((x) & BIT_MASK_RX_EMPTY_TIMER_IDX_8197F) \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8197F) -+#define BITS_RX_EMPTY_TIMER_IDX_8197F \ -+ (BIT_MASK_RX_EMPTY_TIMER_IDX_8197F \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8197F) -+#define BIT_CLEAR_RX_EMPTY_TIMER_IDX_8197F(x) \ -+ ((x) & (~BITS_RX_EMPTY_TIMER_IDX_8197F)) -+#define BIT_GET_RX_EMPTY_TIMER_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_RX_EMPTY_TIMER_IDX_8197F) & \ -+ BIT_MASK_RX_EMPTY_TIMER_IDX_8197F) -+#define BIT_SET_RX_EMPTY_TIMER_IDX_8197F(x, v) \ -+ (BIT_CLEAR_RX_EMPTY_TIMER_IDX_8197F(x) | \ -+ BIT_RX_EMPTY_TIMER_IDX_8197F(v)) -+ -+#define BIT_SHIFT_RX_AFULL_TH_IDX_8197F 20 -+#define BIT_MASK_RX_AFULL_TH_IDX_8197F 0x7 -+#define BIT_RX_AFULL_TH_IDX_8197F(x) \ -+ (((x) & BIT_MASK_RX_AFULL_TH_IDX_8197F) \ -+ << BIT_SHIFT_RX_AFULL_TH_IDX_8197F) -+#define BITS_RX_AFULL_TH_IDX_8197F \ -+ (BIT_MASK_RX_AFULL_TH_IDX_8197F << BIT_SHIFT_RX_AFULL_TH_IDX_8197F) -+#define BIT_CLEAR_RX_AFULL_TH_IDX_8197F(x) ((x) & (~BITS_RX_AFULL_TH_IDX_8197F)) -+#define BIT_GET_RX_AFULL_TH_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_RX_AFULL_TH_IDX_8197F) & \ -+ BIT_MASK_RX_AFULL_TH_IDX_8197F) -+#define BIT_SET_RX_AFULL_TH_IDX_8197F(x, v) \ -+ (BIT_CLEAR_RX_AFULL_TH_IDX_8197F(x) | BIT_RX_AFULL_TH_IDX_8197F(v)) -+ -+#define BIT_SHIFT_RX_HIGH_TH_IDX_8197F 16 -+#define BIT_MASK_RX_HIGH_TH_IDX_8197F 0x7 -+#define BIT_RX_HIGH_TH_IDX_8197F(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TH_IDX_8197F) \ -+ << BIT_SHIFT_RX_HIGH_TH_IDX_8197F) -+#define BITS_RX_HIGH_TH_IDX_8197F \ -+ (BIT_MASK_RX_HIGH_TH_IDX_8197F << BIT_SHIFT_RX_HIGH_TH_IDX_8197F) -+#define BIT_CLEAR_RX_HIGH_TH_IDX_8197F(x) ((x) & (~BITS_RX_HIGH_TH_IDX_8197F)) -+#define BIT_GET_RX_HIGH_TH_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TH_IDX_8197F) & \ -+ BIT_MASK_RX_HIGH_TH_IDX_8197F) -+#define BIT_SET_RX_HIGH_TH_IDX_8197F(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TH_IDX_8197F(x) | BIT_RX_HIGH_TH_IDX_8197F(v)) -+ -+#define BIT_SHIFT_RX_MED_TH_IDX_8197F 12 -+#define BIT_MASK_RX_MED_TH_IDX_8197F 0x7 -+#define BIT_RX_MED_TH_IDX_8197F(x) \ -+ (((x) & BIT_MASK_RX_MED_TH_IDX_8197F) << BIT_SHIFT_RX_MED_TH_IDX_8197F) -+#define BITS_RX_MED_TH_IDX_8197F \ -+ (BIT_MASK_RX_MED_TH_IDX_8197F << BIT_SHIFT_RX_MED_TH_IDX_8197F) -+#define BIT_CLEAR_RX_MED_TH_IDX_8197F(x) ((x) & (~BITS_RX_MED_TH_IDX_8197F)) -+#define BIT_GET_RX_MED_TH_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TH_IDX_8197F) & BIT_MASK_RX_MED_TH_IDX_8197F) -+#define BIT_SET_RX_MED_TH_IDX_8197F(x, v) \ -+ (BIT_CLEAR_RX_MED_TH_IDX_8197F(x) | BIT_RX_MED_TH_IDX_8197F(v)) -+ -+#define BIT_SHIFT_RX_LOW_TH_IDX_8197F 8 -+#define BIT_MASK_RX_LOW_TH_IDX_8197F 0x7 -+#define BIT_RX_LOW_TH_IDX_8197F(x) \ -+ (((x) & BIT_MASK_RX_LOW_TH_IDX_8197F) << BIT_SHIFT_RX_LOW_TH_IDX_8197F) -+#define BITS_RX_LOW_TH_IDX_8197F \ -+ (BIT_MASK_RX_LOW_TH_IDX_8197F << BIT_SHIFT_RX_LOW_TH_IDX_8197F) -+#define BIT_CLEAR_RX_LOW_TH_IDX_8197F(x) ((x) & (~BITS_RX_LOW_TH_IDX_8197F)) -+#define BIT_GET_RX_LOW_TH_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TH_IDX_8197F) & BIT_MASK_RX_LOW_TH_IDX_8197F) -+#define BIT_SET_RX_LOW_TH_IDX_8197F(x, v) \ -+ (BIT_CLEAR_RX_LOW_TH_IDX_8197F(x) | BIT_RX_LOW_TH_IDX_8197F(v)) -+ -+#define BIT_SHIFT_LTR_SPACE_IDX_8197F 4 -+#define BIT_MASK_LTR_SPACE_IDX_8197F 0x3 -+#define BIT_LTR_SPACE_IDX_8197F(x) \ -+ (((x) & BIT_MASK_LTR_SPACE_IDX_8197F) << BIT_SHIFT_LTR_SPACE_IDX_8197F) -+#define BITS_LTR_SPACE_IDX_8197F \ -+ (BIT_MASK_LTR_SPACE_IDX_8197F << BIT_SHIFT_LTR_SPACE_IDX_8197F) -+#define BIT_CLEAR_LTR_SPACE_IDX_8197F(x) ((x) & (~BITS_LTR_SPACE_IDX_8197F)) -+#define BIT_GET_LTR_SPACE_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_LTR_SPACE_IDX_8197F) & BIT_MASK_LTR_SPACE_IDX_8197F) -+#define BIT_SET_LTR_SPACE_IDX_8197F(x, v) \ -+ (BIT_CLEAR_LTR_SPACE_IDX_8197F(x) | BIT_LTR_SPACE_IDX_8197F(v)) -+ -+#define BIT_SHIFT_LTR_IDLE_TIMER_IDX_8197F 0 -+#define BIT_MASK_LTR_IDLE_TIMER_IDX_8197F 0x7 -+#define BIT_LTR_IDLE_TIMER_IDX_8197F(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_TIMER_IDX_8197F) \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8197F) -+#define BITS_LTR_IDLE_TIMER_IDX_8197F \ -+ (BIT_MASK_LTR_IDLE_TIMER_IDX_8197F \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8197F) -+#define BIT_CLEAR_LTR_IDLE_TIMER_IDX_8197F(x) \ -+ ((x) & (~BITS_LTR_IDLE_TIMER_IDX_8197F)) -+#define BIT_GET_LTR_IDLE_TIMER_IDX_8197F(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_TIMER_IDX_8197F) & \ -+ BIT_MASK_LTR_IDLE_TIMER_IDX_8197F) -+#define BIT_SET_LTR_IDLE_TIMER_IDX_8197F(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_TIMER_IDX_8197F(x) | \ -+ BIT_LTR_IDLE_TIMER_IDX_8197F(v)) -+ -+/* 2 REG_LTR_IDLE_LATENCY_V1_8197F */ -+ -+#define BIT_SHIFT_LTR_IDLE_L_8197F 0 -+#define BIT_MASK_LTR_IDLE_L_8197F 0xffffffffL -+#define BIT_LTR_IDLE_L_8197F(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_L_8197F) << BIT_SHIFT_LTR_IDLE_L_8197F) -+#define BITS_LTR_IDLE_L_8197F \ -+ (BIT_MASK_LTR_IDLE_L_8197F << BIT_SHIFT_LTR_IDLE_L_8197F) -+#define BIT_CLEAR_LTR_IDLE_L_8197F(x) ((x) & (~BITS_LTR_IDLE_L_8197F)) -+#define BIT_GET_LTR_IDLE_L_8197F(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_L_8197F) & BIT_MASK_LTR_IDLE_L_8197F) -+#define BIT_SET_LTR_IDLE_L_8197F(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_L_8197F(x) | BIT_LTR_IDLE_L_8197F(v)) -+ -+/* 2 REG_LTR_ACTIVE_LATENCY_V1_8197F */ -+ -+#define BIT_SHIFT_LTR_ACT_L_8197F 0 -+#define BIT_MASK_LTR_ACT_L_8197F 0xffffffffL -+#define BIT_LTR_ACT_L_8197F(x) \ -+ (((x) & BIT_MASK_LTR_ACT_L_8197F) << BIT_SHIFT_LTR_ACT_L_8197F) -+#define BITS_LTR_ACT_L_8197F \ -+ (BIT_MASK_LTR_ACT_L_8197F << BIT_SHIFT_LTR_ACT_L_8197F) -+#define BIT_CLEAR_LTR_ACT_L_8197F(x) ((x) & (~BITS_LTR_ACT_L_8197F)) -+#define BIT_GET_LTR_ACT_L_8197F(x) \ -+ (((x) >> BIT_SHIFT_LTR_ACT_L_8197F) & BIT_MASK_LTR_ACT_L_8197F) -+#define BIT_SET_LTR_ACT_L_8197F(x, v) \ -+ (BIT_CLEAR_LTR_ACT_L_8197F(x) | BIT_LTR_ACT_L_8197F(v)) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER_8197F */ -+#define BIT_APPEND_MACID_IN_RESP_EN_8197F BIT(50) -+#define BIT_ADDR2_MATCH_EN_8197F BIT(49) -+#define BIT_ANTTRN_EN_8197F BIT(48) -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR_8197F 0 -+#define BIT_MASK_TRAIN_STA_ADDR_8197F 0xffffffffffffL -+#define BIT_TRAIN_STA_ADDR_8197F(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR_8197F) \ -+ << BIT_SHIFT_TRAIN_STA_ADDR_8197F) -+#define BITS_TRAIN_STA_ADDR_8197F \ -+ (BIT_MASK_TRAIN_STA_ADDR_8197F << BIT_SHIFT_TRAIN_STA_ADDR_8197F) -+#define BIT_CLEAR_TRAIN_STA_ADDR_8197F(x) ((x) & (~BITS_TRAIN_STA_ADDR_8197F)) -+#define BIT_GET_TRAIN_STA_ADDR_8197F(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR_8197F) & \ -+ BIT_MASK_TRAIN_STA_ADDR_8197F) -+#define BIT_SET_TRAIN_STA_ADDR_8197F(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR_8197F(x) | BIT_TRAIN_STA_ADDR_8197F(v)) -+ -+/* 2 REG_RSVD_0X7B4_8197F */ -+ -+/* 2 REG_WMAC_PKTCNT_RWD_8197F */ -+ -+#define BIT_SHIFT_PKTCNT_BSSIDMAP_8197F 4 -+#define BIT_MASK_PKTCNT_BSSIDMAP_8197F 0xf -+#define BIT_PKTCNT_BSSIDMAP_8197F(x) \ -+ (((x) & BIT_MASK_PKTCNT_BSSIDMAP_8197F) \ -+ << BIT_SHIFT_PKTCNT_BSSIDMAP_8197F) -+#define BITS_PKTCNT_BSSIDMAP_8197F \ -+ (BIT_MASK_PKTCNT_BSSIDMAP_8197F << BIT_SHIFT_PKTCNT_BSSIDMAP_8197F) -+#define BIT_CLEAR_PKTCNT_BSSIDMAP_8197F(x) ((x) & (~BITS_PKTCNT_BSSIDMAP_8197F)) -+#define BIT_GET_PKTCNT_BSSIDMAP_8197F(x) \ -+ (((x) >> BIT_SHIFT_PKTCNT_BSSIDMAP_8197F) & \ -+ BIT_MASK_PKTCNT_BSSIDMAP_8197F) -+#define BIT_SET_PKTCNT_BSSIDMAP_8197F(x, v) \ -+ (BIT_CLEAR_PKTCNT_BSSIDMAP_8197F(x) | BIT_PKTCNT_BSSIDMAP_8197F(v)) -+ -+#define BIT_PKTCNT_CNTRST_8197F BIT(1) -+#define BIT_PKTCNT_CNTEN_8197F BIT(0) -+ -+/* 2 REG_WMAC_PKTCNT_CTRL_8197F */ -+#define BIT_WMAC_PKTCNT_TRST_8197F BIT(9) -+#define BIT_WMAC_PKTCNT_FEN_8197F BIT(8) -+ -+#define BIT_SHIFT_WMAC_PKTCNT_CFGAD_8197F 0 -+#define BIT_MASK_WMAC_PKTCNT_CFGAD_8197F 0xff -+#define BIT_WMAC_PKTCNT_CFGAD_8197F(x) \ -+ (((x) & BIT_MASK_WMAC_PKTCNT_CFGAD_8197F) \ -+ << BIT_SHIFT_WMAC_PKTCNT_CFGAD_8197F) -+#define BITS_WMAC_PKTCNT_CFGAD_8197F \ -+ (BIT_MASK_WMAC_PKTCNT_CFGAD_8197F << BIT_SHIFT_WMAC_PKTCNT_CFGAD_8197F) -+#define BIT_CLEAR_WMAC_PKTCNT_CFGAD_8197F(x) \ -+ ((x) & (~BITS_WMAC_PKTCNT_CFGAD_8197F)) -+#define BIT_GET_WMAC_PKTCNT_CFGAD_8197F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PKTCNT_CFGAD_8197F) & \ -+ BIT_MASK_WMAC_PKTCNT_CFGAD_8197F) -+#define BIT_SET_WMAC_PKTCNT_CFGAD_8197F(x, v) \ -+ (BIT_CLEAR_WMAC_PKTCNT_CFGAD_8197F(x) | BIT_WMAC_PKTCNT_CFGAD_8197F(v)) -+ -+/* 2 REG_IQ_DUMP_8197F */ -+ -+#define BIT_SHIFT_R_WMAC_MATCH_REF_MAC_8197F (64 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_MATCH_REF_MAC_8197F 0xffffffffL -+#define BIT_R_WMAC_MATCH_REF_MAC_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_MATCH_REF_MAC_8197F) \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_8197F) -+#define BITS_R_WMAC_MATCH_REF_MAC_8197F \ -+ (BIT_MASK_R_WMAC_MATCH_REF_MAC_8197F \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_8197F) -+#define BIT_CLEAR_R_WMAC_MATCH_REF_MAC_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_MATCH_REF_MAC_8197F)) -+#define BIT_GET_R_WMAC_MATCH_REF_MAC_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MATCH_REF_MAC_8197F) & \ -+ BIT_MASK_R_WMAC_MATCH_REF_MAC_8197F) -+#define BIT_SET_R_WMAC_MATCH_REF_MAC_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_MATCH_REF_MAC_8197F(x) | \ -+ BIT_R_WMAC_MATCH_REF_MAC_8197F(v)) -+ -+#define BIT_SHIFT_R_WMAC_MASK_LA_MAC_8197F (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_MASK_LA_MAC_8197F 0xffffffffL -+#define BIT_R_WMAC_MASK_LA_MAC_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_MASK_LA_MAC_8197F) \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_8197F) -+#define BITS_R_WMAC_MASK_LA_MAC_8197F \ -+ (BIT_MASK_R_WMAC_MASK_LA_MAC_8197F \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_8197F) -+#define BIT_CLEAR_R_WMAC_MASK_LA_MAC_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_MASK_LA_MAC_8197F)) -+#define BIT_GET_R_WMAC_MASK_LA_MAC_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MASK_LA_MAC_8197F) & \ -+ BIT_MASK_R_WMAC_MASK_LA_MAC_8197F) -+#define BIT_SET_R_WMAC_MASK_LA_MAC_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_MASK_LA_MAC_8197F(x) | \ -+ BIT_R_WMAC_MASK_LA_MAC_8197F(v)) -+ -+#define BIT_SHIFT_DUMP_OK_ADDR_V1_8197F 15 -+#define BIT_MASK_DUMP_OK_ADDR_V1_8197F 0x1ffff -+#define BIT_DUMP_OK_ADDR_V1_8197F(x) \ -+ (((x) & BIT_MASK_DUMP_OK_ADDR_V1_8197F) \ -+ << BIT_SHIFT_DUMP_OK_ADDR_V1_8197F) -+#define BITS_DUMP_OK_ADDR_V1_8197F \ -+ (BIT_MASK_DUMP_OK_ADDR_V1_8197F << BIT_SHIFT_DUMP_OK_ADDR_V1_8197F) -+#define BIT_CLEAR_DUMP_OK_ADDR_V1_8197F(x) ((x) & (~BITS_DUMP_OK_ADDR_V1_8197F)) -+#define BIT_GET_DUMP_OK_ADDR_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_DUMP_OK_ADDR_V1_8197F) & \ -+ BIT_MASK_DUMP_OK_ADDR_V1_8197F) -+#define BIT_SET_DUMP_OK_ADDR_V1_8197F(x, v) \ -+ (BIT_CLEAR_DUMP_OK_ADDR_V1_8197F(x) | BIT_DUMP_OK_ADDR_V1_8197F(v)) -+ -+#define BIT_SHIFT_R_TRIG_TIME_SEL_8197F 8 -+#define BIT_MASK_R_TRIG_TIME_SEL_8197F 0x7f -+#define BIT_R_TRIG_TIME_SEL_8197F(x) \ -+ (((x) & BIT_MASK_R_TRIG_TIME_SEL_8197F) \ -+ << BIT_SHIFT_R_TRIG_TIME_SEL_8197F) -+#define BITS_R_TRIG_TIME_SEL_8197F \ -+ (BIT_MASK_R_TRIG_TIME_SEL_8197F << BIT_SHIFT_R_TRIG_TIME_SEL_8197F) -+#define BIT_CLEAR_R_TRIG_TIME_SEL_8197F(x) ((x) & (~BITS_R_TRIG_TIME_SEL_8197F)) -+#define BIT_GET_R_TRIG_TIME_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_TRIG_TIME_SEL_8197F) & \ -+ BIT_MASK_R_TRIG_TIME_SEL_8197F) -+#define BIT_SET_R_TRIG_TIME_SEL_8197F(x, v) \ -+ (BIT_CLEAR_R_TRIG_TIME_SEL_8197F(x) | BIT_R_TRIG_TIME_SEL_8197F(v)) -+ -+#define BIT_SHIFT_R_MAC_TRIG_SEL_8197F 6 -+#define BIT_MASK_R_MAC_TRIG_SEL_8197F 0x3 -+#define BIT_R_MAC_TRIG_SEL_8197F(x) \ -+ (((x) & BIT_MASK_R_MAC_TRIG_SEL_8197F) \ -+ << BIT_SHIFT_R_MAC_TRIG_SEL_8197F) -+#define BITS_R_MAC_TRIG_SEL_8197F \ -+ (BIT_MASK_R_MAC_TRIG_SEL_8197F << BIT_SHIFT_R_MAC_TRIG_SEL_8197F) -+#define BIT_CLEAR_R_MAC_TRIG_SEL_8197F(x) ((x) & (~BITS_R_MAC_TRIG_SEL_8197F)) -+#define BIT_GET_R_MAC_TRIG_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_TRIG_SEL_8197F) & \ -+ BIT_MASK_R_MAC_TRIG_SEL_8197F) -+#define BIT_SET_R_MAC_TRIG_SEL_8197F(x, v) \ -+ (BIT_CLEAR_R_MAC_TRIG_SEL_8197F(x) | BIT_R_MAC_TRIG_SEL_8197F(v)) -+ -+#define BIT_MAC_TRIG_REG_8197F BIT(5) -+ -+#define BIT_SHIFT_R_LEVEL_PULSE_SEL_8197F 3 -+#define BIT_MASK_R_LEVEL_PULSE_SEL_8197F 0x3 -+#define BIT_R_LEVEL_PULSE_SEL_8197F(x) \ -+ (((x) & BIT_MASK_R_LEVEL_PULSE_SEL_8197F) \ -+ << BIT_SHIFT_R_LEVEL_PULSE_SEL_8197F) -+#define BITS_R_LEVEL_PULSE_SEL_8197F \ -+ (BIT_MASK_R_LEVEL_PULSE_SEL_8197F << BIT_SHIFT_R_LEVEL_PULSE_SEL_8197F) -+#define BIT_CLEAR_R_LEVEL_PULSE_SEL_8197F(x) \ -+ ((x) & (~BITS_R_LEVEL_PULSE_SEL_8197F)) -+#define BIT_GET_R_LEVEL_PULSE_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_LEVEL_PULSE_SEL_8197F) & \ -+ BIT_MASK_R_LEVEL_PULSE_SEL_8197F) -+#define BIT_SET_R_LEVEL_PULSE_SEL_8197F(x, v) \ -+ (BIT_CLEAR_R_LEVEL_PULSE_SEL_8197F(x) | BIT_R_LEVEL_PULSE_SEL_8197F(v)) -+ -+#define BIT_EN_LA_MAC_8197F BIT(2) -+#define BIT_R_EN_IQDUMP_8197F BIT(1) -+#define BIT_R_IQDATA_DUMP_8197F BIT(0) -+ -+/* 2 REG_WMAC_FTM_CTL_8197F */ -+#define BIT_RXFTM_TXACK_SC_8197F BIT(6) -+#define BIT_RXFTM_TXACK_BW_8197F BIT(5) -+#define BIT_RXFTM_EN_8197F BIT(3) -+#define BIT_RXFTMREQ_BYDRV_8197F BIT(2) -+#define BIT_RXFTMREQ_EN_8197F BIT(1) -+#define BIT_FTM_EN_8197F BIT(0) -+ -+/* 2 REG_IQ_DUMP_EXT_8197F */ -+ -+#define BIT_SHIFT_R_TIME_UNIT_SEL_8197F 0 -+#define BIT_MASK_R_TIME_UNIT_SEL_8197F 0x7 -+#define BIT_R_TIME_UNIT_SEL_8197F(x) \ -+ (((x) & BIT_MASK_R_TIME_UNIT_SEL_8197F) \ -+ << BIT_SHIFT_R_TIME_UNIT_SEL_8197F) -+#define BITS_R_TIME_UNIT_SEL_8197F \ -+ (BIT_MASK_R_TIME_UNIT_SEL_8197F << BIT_SHIFT_R_TIME_UNIT_SEL_8197F) -+#define BIT_CLEAR_R_TIME_UNIT_SEL_8197F(x) ((x) & (~BITS_R_TIME_UNIT_SEL_8197F)) -+#define BIT_GET_R_TIME_UNIT_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_TIME_UNIT_SEL_8197F) & \ -+ BIT_MASK_R_TIME_UNIT_SEL_8197F) -+#define BIT_SET_R_TIME_UNIT_SEL_8197F(x, v) \ -+ (BIT_CLEAR_R_TIME_UNIT_SEL_8197F(x) | BIT_R_TIME_UNIT_SEL_8197F(v)) -+ -+/* 2 REG_OFDM_CCK_LEN_MASK_8197F */ -+ -+#define BIT_SHIFT_R_WMAC_RX_FIL_LEN_8197F (64 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_RX_FIL_LEN_8197F 0xffff -+#define BIT_R_WMAC_RX_FIL_LEN_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_RX_FIL_LEN_8197F) \ -+ << BIT_SHIFT_R_WMAC_RX_FIL_LEN_8197F) -+#define BITS_R_WMAC_RX_FIL_LEN_8197F \ -+ (BIT_MASK_R_WMAC_RX_FIL_LEN_8197F << BIT_SHIFT_R_WMAC_RX_FIL_LEN_8197F) -+#define BIT_CLEAR_R_WMAC_RX_FIL_LEN_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_RX_FIL_LEN_8197F)) -+#define BIT_GET_R_WMAC_RX_FIL_LEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RX_FIL_LEN_8197F) & \ -+ BIT_MASK_R_WMAC_RX_FIL_LEN_8197F) -+#define BIT_SET_R_WMAC_RX_FIL_LEN_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_RX_FIL_LEN_8197F(x) | BIT_R_WMAC_RX_FIL_LEN_8197F(v)) -+ -+#define BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_8197F (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_RXFIFO_FULL_TH_8197F 0xff -+#define BIT_R_WMAC_RXFIFO_FULL_TH_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_RXFIFO_FULL_TH_8197F) \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_8197F) -+#define BITS_R_WMAC_RXFIFO_FULL_TH_8197F \ -+ (BIT_MASK_R_WMAC_RXFIFO_FULL_TH_8197F \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_8197F) -+#define BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_RXFIFO_FULL_TH_8197F)) -+#define BIT_GET_R_WMAC_RXFIFO_FULL_TH_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_8197F) & \ -+ BIT_MASK_R_WMAC_RXFIFO_FULL_TH_8197F) -+#define BIT_SET_R_WMAC_RXFIFO_FULL_TH_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_8197F(x) | \ -+ BIT_R_WMAC_RXFIFO_FULL_TH_8197F(v)) -+ -+#define BIT_R_WMAC_RX_SYNCFIFO_SYNC_8197F BIT(55) -+#define BIT_R_WMAC_RXRST_DLY_8197F BIT(54) -+#define BIT_R_WMAC_SRCH_TXRPT_REF_DROP_8197F BIT(53) -+#define BIT_R_WMAC_SRCH_TXRPT_UA1_8197F BIT(52) -+#define BIT_R_WMAC_SRCH_TXRPT_TYPE_8197F BIT(51) -+#define BIT_R_WMAC_NDP_RST_8197F BIT(50) -+#define BIT_R_WMAC_POWINT_EN_8197F BIT(49) -+#define BIT_R_WMAC_SRCH_TXRPT_PERPKT_8197F BIT(48) -+#define BIT_R_WMAC_SRCH_TXRPT_MID_8197F BIT(47) -+#define BIT_R_WMAC_PFIN_TOEN_8197F BIT(46) -+#define BIT_R_WMAC_FIL_SECERR_8197F BIT(45) -+#define BIT_R_WMAC_FIL_CTLPKTLEN_8197F BIT(44) -+#define BIT_R_WMAC_FIL_FCTYPE_8197F BIT(43) -+#define BIT_R_WMAC_FIL_FCPROVER_8197F BIT(42) -+#define BIT_R_WMAC_PHYSTS_SNIF_8197F BIT(41) -+#define BIT_R_WMAC_PHYSTS_PLCP_8197F BIT(40) -+#define BIT_R_MAC_TCR_VBONF_RD_8197F BIT(39) -+#define BIT_R_WMAC_TCR_MPAR_NDP_8197F BIT(38) -+#define BIT_R_WMAC_NDP_FILTER_8197F BIT(37) -+#define BIT_R_WMAC_RXLEN_SEL_8197F BIT(36) -+#define BIT_R_WMAC_RXLEN_SEL1_8197F BIT(35) -+#define BIT_R_OFDM_FILTER_8197F BIT(34) -+#define BIT_R_WMAC_CHK_OFDM_LEN_8197F BIT(33) -+#define BIT_R_WMAC_CHK_CCK_LEN_8197F BIT(32) -+ -+#define BIT_SHIFT_R_OFDM_LEN_8197F 26 -+#define BIT_MASK_R_OFDM_LEN_8197F 0x3f -+#define BIT_R_OFDM_LEN_8197F(x) \ -+ (((x) & BIT_MASK_R_OFDM_LEN_8197F) << BIT_SHIFT_R_OFDM_LEN_8197F) -+#define BITS_R_OFDM_LEN_8197F \ -+ (BIT_MASK_R_OFDM_LEN_8197F << BIT_SHIFT_R_OFDM_LEN_8197F) -+#define BIT_CLEAR_R_OFDM_LEN_8197F(x) ((x) & (~BITS_R_OFDM_LEN_8197F)) -+#define BIT_GET_R_OFDM_LEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_OFDM_LEN_8197F) & BIT_MASK_R_OFDM_LEN_8197F) -+#define BIT_SET_R_OFDM_LEN_8197F(x, v) \ -+ (BIT_CLEAR_R_OFDM_LEN_8197F(x) | BIT_R_OFDM_LEN_8197F(v)) -+ -+#define BIT_SHIFT_R_CCK_LEN_8197F 0 -+#define BIT_MASK_R_CCK_LEN_8197F 0xffff -+#define BIT_R_CCK_LEN_8197F(x) \ -+ (((x) & BIT_MASK_R_CCK_LEN_8197F) << BIT_SHIFT_R_CCK_LEN_8197F) -+#define BITS_R_CCK_LEN_8197F \ -+ (BIT_MASK_R_CCK_LEN_8197F << BIT_SHIFT_R_CCK_LEN_8197F) -+#define BIT_CLEAR_R_CCK_LEN_8197F(x) ((x) & (~BITS_R_CCK_LEN_8197F)) -+#define BIT_GET_R_CCK_LEN_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_CCK_LEN_8197F) & BIT_MASK_R_CCK_LEN_8197F) -+#define BIT_SET_R_CCK_LEN_8197F(x, v) \ -+ (BIT_CLEAR_R_CCK_LEN_8197F(x) | BIT_R_CCK_LEN_8197F(v)) -+ -+/* 2 REG_RX_FILTER_FUNCTION_8197F */ -+#define BIT_R_WMAC_RXHANG_EN_8197F BIT(15) -+#define BIT_R_WMAC_MHRDDY_LATCH_8197F BIT(14) -+#define BIT_R_MHRDDY_CLR_8197F BIT(13) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY1_8197F BIT(12) -+#define BIT_R_WMAC_DIS_VHT_PLCP_CHK_MU_8197F BIT(11) -+#define BIT_R_CHK_DELIMIT_LEN_8197F BIT(10) -+#define BIT_R_REAPTER_ADDR_MATCH_8197F BIT(9) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY_8197F BIT(8) -+#define BIT_R_LATCH_MACHRDY_8197F BIT(7) -+#define BIT_R_WMAC_RXFIL_REND_8197F BIT(6) -+#define BIT_R_WMAC_MPDURDY_CLR_8197F BIT(5) -+#define BIT_R_WMAC_CLRRXSEC_8197F BIT(4) -+#define BIT_R_WMAC_RXFIL_RDEL_8197F BIT(3) -+#define BIT_R_WMAC_RXFIL_FCSE_8197F BIT(2) -+#define BIT_R_WMAC_RXFIL_MESH_DEL_8197F BIT(1) -+#define BIT_R_WMAC_RXFIL_MASKM_8197F BIT(0) -+ -+/* 2 REG_NDP_SIG_8197F */ -+ -+#define BIT_SHIFT_R_WMAC_TXNDP_SIGB_8197F 0 -+#define BIT_MASK_R_WMAC_TXNDP_SIGB_8197F 0x1fffff -+#define BIT_R_WMAC_TXNDP_SIGB_8197F(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXNDP_SIGB_8197F) \ -+ << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8197F) -+#define BITS_R_WMAC_TXNDP_SIGB_8197F \ -+ (BIT_MASK_R_WMAC_TXNDP_SIGB_8197F << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8197F) -+#define BIT_CLEAR_R_WMAC_TXNDP_SIGB_8197F(x) \ -+ ((x) & (~BITS_R_WMAC_TXNDP_SIGB_8197F)) -+#define BIT_GET_R_WMAC_TXNDP_SIGB_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXNDP_SIGB_8197F) & \ -+ BIT_MASK_R_WMAC_TXNDP_SIGB_8197F) -+#define BIT_SET_R_WMAC_TXNDP_SIGB_8197F(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXNDP_SIGB_8197F(x) | BIT_R_WMAC_TXNDP_SIGB_8197F(v)) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_8197F */ -+ -+#define BIT_SHIFT_R_MAC_DEBUG_8197F (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_MAC_DEBUG_8197F 0xffffffffL -+#define BIT_R_MAC_DEBUG_8197F(x) \ -+ (((x) & BIT_MASK_R_MAC_DEBUG_8197F) << BIT_SHIFT_R_MAC_DEBUG_8197F) -+#define BITS_R_MAC_DEBUG_8197F \ -+ (BIT_MASK_R_MAC_DEBUG_8197F << BIT_SHIFT_R_MAC_DEBUG_8197F) -+#define BIT_CLEAR_R_MAC_DEBUG_8197F(x) ((x) & (~BITS_R_MAC_DEBUG_8197F)) -+#define BIT_GET_R_MAC_DEBUG_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DEBUG_8197F) & BIT_MASK_R_MAC_DEBUG_8197F) -+#define BIT_SET_R_MAC_DEBUG_8197F(x, v) \ -+ (BIT_CLEAR_R_MAC_DEBUG_8197F(x) | BIT_R_MAC_DEBUG_8197F(v)) -+ -+#define BIT_SHIFT_R_MAC_DBG_SHIFT_8197F 8 -+#define BIT_MASK_R_MAC_DBG_SHIFT_8197F 0x7 -+#define BIT_R_MAC_DBG_SHIFT_8197F(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SHIFT_8197F) \ -+ << BIT_SHIFT_R_MAC_DBG_SHIFT_8197F) -+#define BITS_R_MAC_DBG_SHIFT_8197F \ -+ (BIT_MASK_R_MAC_DBG_SHIFT_8197F << BIT_SHIFT_R_MAC_DBG_SHIFT_8197F) -+#define BIT_CLEAR_R_MAC_DBG_SHIFT_8197F(x) ((x) & (~BITS_R_MAC_DBG_SHIFT_8197F)) -+#define BIT_GET_R_MAC_DBG_SHIFT_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SHIFT_8197F) & \ -+ BIT_MASK_R_MAC_DBG_SHIFT_8197F) -+#define BIT_SET_R_MAC_DBG_SHIFT_8197F(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SHIFT_8197F(x) | BIT_R_MAC_DBG_SHIFT_8197F(v)) -+ -+#define BIT_SHIFT_R_MAC_DBG_SEL_8197F 0 -+#define BIT_MASK_R_MAC_DBG_SEL_8197F 0x3 -+#define BIT_R_MAC_DBG_SEL_8197F(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SEL_8197F) << BIT_SHIFT_R_MAC_DBG_SEL_8197F) -+#define BITS_R_MAC_DBG_SEL_8197F \ -+ (BIT_MASK_R_MAC_DBG_SEL_8197F << BIT_SHIFT_R_MAC_DBG_SEL_8197F) -+#define BIT_CLEAR_R_MAC_DBG_SEL_8197F(x) ((x) & (~BITS_R_MAC_DBG_SEL_8197F)) -+#define BIT_GET_R_MAC_DBG_SEL_8197F(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SEL_8197F) & BIT_MASK_R_MAC_DBG_SEL_8197F) -+#define BIT_SET_R_MAC_DBG_SEL_8197F(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SEL_8197F(x) | BIT_R_MAC_DBG_SEL_8197F(v)) -+ -+/* 2 REG_SEC_OPT_V2_8197F */ -+#define BIT_MASK_IV_8197F BIT(18) -+#define BIT_EIVL_ENDIAN_8197F BIT(17) -+#define BIT_EIVH_ENDIAN_8197F BIT(16) -+ -+#define BIT_SHIFT_BT_TIME_CNT_8197F 0 -+#define BIT_MASK_BT_TIME_CNT_8197F 0xff -+#define BIT_BT_TIME_CNT_8197F(x) \ -+ (((x) & BIT_MASK_BT_TIME_CNT_8197F) << BIT_SHIFT_BT_TIME_CNT_8197F) -+#define BITS_BT_TIME_CNT_8197F \ -+ (BIT_MASK_BT_TIME_CNT_8197F << BIT_SHIFT_BT_TIME_CNT_8197F) -+#define BIT_CLEAR_BT_TIME_CNT_8197F(x) ((x) & (~BITS_BT_TIME_CNT_8197F)) -+#define BIT_GET_BT_TIME_CNT_8197F(x) \ -+ (((x) >> BIT_SHIFT_BT_TIME_CNT_8197F) & BIT_MASK_BT_TIME_CNT_8197F) -+#define BIT_SET_BT_TIME_CNT_8197F(x, v) \ -+ (BIT_CLEAR_BT_TIME_CNT_8197F(x) | BIT_BT_TIME_CNT_8197F(v)) -+ -+/* 2 REG_RTS_ADDRESS_0_8197F */ -+ -+/* 2 REG_RTS_ADDRESS_1_8197F */ -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8197F */ -+#define BIT_LTECOEX_ACCESS_START_V1_8197F BIT(31) -+#define BIT_LTECOEX_WRITE_MODE_V1_8197F BIT(30) -+#define BIT_LTECOEX_READY_BIT_V1_8197F BIT(29) -+ -+#define BIT_SHIFT_WRITE_BYTE_EN_V1_8197F 16 -+#define BIT_MASK_WRITE_BYTE_EN_V1_8197F 0xf -+#define BIT_WRITE_BYTE_EN_V1_8197F(x) \ -+ (((x) & BIT_MASK_WRITE_BYTE_EN_V1_8197F) \ -+ << BIT_SHIFT_WRITE_BYTE_EN_V1_8197F) -+#define BITS_WRITE_BYTE_EN_V1_8197F \ -+ (BIT_MASK_WRITE_BYTE_EN_V1_8197F << BIT_SHIFT_WRITE_BYTE_EN_V1_8197F) -+#define BIT_CLEAR_WRITE_BYTE_EN_V1_8197F(x) \ -+ ((x) & (~BITS_WRITE_BYTE_EN_V1_8197F)) -+#define BIT_GET_WRITE_BYTE_EN_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_WRITE_BYTE_EN_V1_8197F) & \ -+ BIT_MASK_WRITE_BYTE_EN_V1_8197F) -+#define BIT_SET_WRITE_BYTE_EN_V1_8197F(x, v) \ -+ (BIT_CLEAR_WRITE_BYTE_EN_V1_8197F(x) | BIT_WRITE_BYTE_EN_V1_8197F(v)) -+ -+#define BIT_SHIFT_LTECOEX_REG_ADDR_V1_8197F 0 -+#define BIT_MASK_LTECOEX_REG_ADDR_V1_8197F 0xffff -+#define BIT_LTECOEX_REG_ADDR_V1_8197F(x) \ -+ (((x) & BIT_MASK_LTECOEX_REG_ADDR_V1_8197F) \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8197F) -+#define BITS_LTECOEX_REG_ADDR_V1_8197F \ -+ (BIT_MASK_LTECOEX_REG_ADDR_V1_8197F \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8197F) -+#define BIT_CLEAR_LTECOEX_REG_ADDR_V1_8197F(x) \ -+ ((x) & (~BITS_LTECOEX_REG_ADDR_V1_8197F)) -+#define BIT_GET_LTECOEX_REG_ADDR_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_REG_ADDR_V1_8197F) & \ -+ BIT_MASK_LTECOEX_REG_ADDR_V1_8197F) -+#define BIT_SET_LTECOEX_REG_ADDR_V1_8197F(x, v) \ -+ (BIT_CLEAR_LTECOEX_REG_ADDR_V1_8197F(x) | \ -+ BIT_LTECOEX_REG_ADDR_V1_8197F(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8197F */ -+ -+#define BIT_SHIFT_LTECOEX_W_DATA_V1_8197F 0 -+#define BIT_MASK_LTECOEX_W_DATA_V1_8197F 0xffffffffL -+#define BIT_LTECOEX_W_DATA_V1_8197F(x) \ -+ (((x) & BIT_MASK_LTECOEX_W_DATA_V1_8197F) \ -+ << BIT_SHIFT_LTECOEX_W_DATA_V1_8197F) -+#define BITS_LTECOEX_W_DATA_V1_8197F \ -+ (BIT_MASK_LTECOEX_W_DATA_V1_8197F << BIT_SHIFT_LTECOEX_W_DATA_V1_8197F) -+#define BIT_CLEAR_LTECOEX_W_DATA_V1_8197F(x) \ -+ ((x) & (~BITS_LTECOEX_W_DATA_V1_8197F)) -+#define BIT_GET_LTECOEX_W_DATA_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_W_DATA_V1_8197F) & \ -+ BIT_MASK_LTECOEX_W_DATA_V1_8197F) -+#define BIT_SET_LTECOEX_W_DATA_V1_8197F(x, v) \ -+ (BIT_CLEAR_LTECOEX_W_DATA_V1_8197F(x) | BIT_LTECOEX_W_DATA_V1_8197F(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8197F */ -+ -+#define BIT_SHIFT_LTECOEX_R_DATA_V1_8197F 0 -+#define BIT_MASK_LTECOEX_R_DATA_V1_8197F 0xffffffffL -+#define BIT_LTECOEX_R_DATA_V1_8197F(x) \ -+ (((x) & BIT_MASK_LTECOEX_R_DATA_V1_8197F) \ -+ << BIT_SHIFT_LTECOEX_R_DATA_V1_8197F) -+#define BITS_LTECOEX_R_DATA_V1_8197F \ -+ (BIT_MASK_LTECOEX_R_DATA_V1_8197F << BIT_SHIFT_LTECOEX_R_DATA_V1_8197F) -+#define BIT_CLEAR_LTECOEX_R_DATA_V1_8197F(x) \ -+ ((x) & (~BITS_LTECOEX_R_DATA_V1_8197F)) -+#define BIT_GET_LTECOEX_R_DATA_V1_8197F(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_R_DATA_V1_8197F) & \ -+ BIT_MASK_LTECOEX_R_DATA_V1_8197F) -+#define BIT_SET_LTECOEX_R_DATA_V1_8197F(x, v) \ -+ (BIT_CLEAR_LTECOEX_R_DATA_V1_8197F(x) | BIT_LTECOEX_R_DATA_V1_8197F(v)) -+ -+/* 2 REG_NOT_VALID_8197F */ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8812f.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8812f.h -new file mode 100644 -index 000000000..a2cb34b8e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8812f.h -@@ -0,0 +1,22057 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2018 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_BIT_8812F_H -+#define __INC_HALMAC_BIT_8812F_H -+ -+#define CPU_OPT_WIDTH 0x1F -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_SYS_ISO_CTRL_8812F */ -+#define BIT_PWC_EV12V_8812F BIT(15) -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_PA33V_EN_8812F BIT(13) -+#define BIT_PA12V_EN_8812F BIT(12) -+#define BIT_UA33V_EN_8812F BIT(11) -+#define BIT_UA12V_EN_8812F BIT(10) -+#define BIT_ISO_RFDIO_8812F BIT(9) -+#define BIT_ISO_EB2CORE_8812F BIT(8) -+#define BIT_ISO_DIOE_8812F BIT(7) -+#define BIT_ISO_WLPON2PP_8812F BIT(6) -+#define BIT_ISO_IP2MAC_WA2PP_8812F BIT(5) -+#define BIT_ISO_PD2CORE_8812F BIT(4) -+#define BIT_ISO_PA2PCIE_8812F BIT(3) -+#define BIT_ISO_UD2CORE_8812F BIT(2) -+#define BIT_ISO_UA2USB_8812F BIT(1) -+#define BIT_ISO_WD2PP_8812F BIT(0) -+ -+/* 2 REG_SYS_FUNC_EN_8812F */ -+#define BIT_FEN_MREGEN_8812F BIT(15) -+#define BIT_FEN_HWPDN_8812F BIT(14) -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_FEN_ELDR_8812F BIT(12) -+#define BIT_FEN_DCORE_8812F BIT(11) -+#define BIT_FEN_CPUEN_8812F BIT(10) -+#define BIT_FEN_DIOE_8812F BIT(9) -+#define BIT_FEN_PCIED_8812F BIT(8) -+#define BIT_FEN_PPLL_8812F BIT(7) -+#define BIT_FEN_PCIEA_8812F BIT(6) -+#define BIT_FEN_DIO_PCIE_8812F BIT(5) -+#define BIT_FEN_USBD_8812F BIT(4) -+#define BIT_FEN_UPLL_8812F BIT(3) -+#define BIT_FEN_USBA_8812F BIT(2) -+#define BIT_FEN_BB_GLB_RSTN_8812F BIT(1) -+#define BIT_FEN_BBRSTB_8812F BIT(0) -+ -+/* 2 REG_SYS_PW_CTRL_8812F */ -+#define BIT_SOP_EABM_8812F BIT(31) -+#define BIT_SOP_ACKF_8812F BIT(30) -+#define BIT_SOP_ERCK_8812F BIT(29) -+#define BIT_SOP_ESWR_8812F BIT(28) -+#define BIT_SOP_PWMM_8812F BIT(27) -+#define BIT_SOP_EECK_8812F BIT(26) -+#define BIT_SOP_ANA_CLK_DIVISION_2_8812F BIT(25) -+#define BIT_SOP_EXTL_8812F BIT(24) -+#define BIT_SYM_OP_RING_12M_8812F BIT(22) -+#define BIT_ROP_SWPR_8812F BIT(21) -+#define BIT_DIS_HW_LPLDM_8812F BIT(20) -+#define BIT_OPT_SWRST_WLMCU_8812F BIT(19) -+#define BIT_RDY_SYSPWR_8812F BIT(17) -+#define BIT_EN_WLON_8812F BIT(16) -+#define BIT_APDM_HPDN_8812F BIT(15) -+#define BIT_AFSM_PCIE_SUS_EN_8812F BIT(12) -+#define BIT_AFSM_WLSUS_EN_8812F BIT(11) -+#define BIT_APFM_SWLPS_8812F BIT(10) -+#define BIT_APFM_OFFMAC_8812F BIT(9) -+#define BIT_APFN_ONMAC_8812F BIT(8) -+#define BIT_CHIP_PDN_EN_8812F BIT(7) -+#define BIT_RDY_MACDIS_8812F BIT(6) -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_PFM_WOWL_8812F BIT(3) -+#define BIT_PFM_LDKP_8812F BIT(2) -+#define BIT_WL_HCI_ALD_8812F BIT(1) -+#define BIT_PFM_LDALL_8812F BIT(0) -+ -+/* 2 REG_SYS_CLK_CTRL_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_CPU_CLK_EN_8812F BIT(14) -+#define BIT_SYMREG_CLK_EN_8812F BIT(13) -+#define BIT_HCI_CLK_EN_8812F BIT(12) -+#define BIT_MAC_CLK_EN_8812F BIT(11) -+#define BIT_SEC_CLK_EN_8812F BIT(10) -+#define BIT_PHY_SSC_RSTB_8812F BIT(9) -+#define BIT_EXT_32K_EN_8812F BIT(8) -+#define BIT_WL_CLK_TEST_8812F BIT(7) -+#define BIT_OP_SPS_PWM_EN_8812F BIT(6) -+#define BIT_LOADER_CLK_EN_8812F BIT(5) -+#define BIT_MACSLP_8812F BIT(4) -+#define BIT_WAKEPAD_EN_8812F BIT(3) -+#define BIT_ROMD16V_EN_8812F BIT(2) -+#define BIT_ANA_CLK_DIVISION_2_8812F BIT(1) -+#define BIT_CNTD16V_EN_8812F BIT(0) -+ -+/* 2 REG_SYS_EEPROM_CTRL_8812F */ -+ -+#define BIT_SHIFT_VPDIDX_8812F 8 -+#define BIT_MASK_VPDIDX_8812F 0xff -+#define BIT_VPDIDX_8812F(x) \ -+ (((x) & BIT_MASK_VPDIDX_8812F) << BIT_SHIFT_VPDIDX_8812F) -+#define BITS_VPDIDX_8812F (BIT_MASK_VPDIDX_8812F << BIT_SHIFT_VPDIDX_8812F) -+#define BIT_CLEAR_VPDIDX_8812F(x) ((x) & (~BITS_VPDIDX_8812F)) -+#define BIT_GET_VPDIDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_VPDIDX_8812F) & BIT_MASK_VPDIDX_8812F) -+#define BIT_SET_VPDIDX_8812F(x, v) \ -+ (BIT_CLEAR_VPDIDX_8812F(x) | BIT_VPDIDX_8812F(v)) -+ -+#define BIT_SHIFT_EEM1_0_8812F 6 -+#define BIT_MASK_EEM1_0_8812F 0x3 -+#define BIT_EEM1_0_8812F(x) \ -+ (((x) & BIT_MASK_EEM1_0_8812F) << BIT_SHIFT_EEM1_0_8812F) -+#define BITS_EEM1_0_8812F (BIT_MASK_EEM1_0_8812F << BIT_SHIFT_EEM1_0_8812F) -+#define BIT_CLEAR_EEM1_0_8812F(x) ((x) & (~BITS_EEM1_0_8812F)) -+#define BIT_GET_EEM1_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_EEM1_0_8812F) & BIT_MASK_EEM1_0_8812F) -+#define BIT_SET_EEM1_0_8812F(x, v) \ -+ (BIT_CLEAR_EEM1_0_8812F(x) | BIT_EEM1_0_8812F(v)) -+ -+#define BIT_AUTOLOAD_SUS_8812F BIT(5) -+#define BIT_EERPOMSEL_8812F BIT(4) -+#define BIT_EECS_V1_8812F BIT(3) -+#define BIT_EESK_V1_8812F BIT(2) -+#define BIT_EEDI_V1_8812F BIT(1) -+#define BIT_EEDO_V1_8812F BIT(0) -+ -+/* 2 REG_EE_VPD_8812F */ -+ -+#define BIT_SHIFT_VPD_DATA_8812F 0 -+#define BIT_MASK_VPD_DATA_8812F 0xffffffffL -+#define BIT_VPD_DATA_8812F(x) \ -+ (((x) & BIT_MASK_VPD_DATA_8812F) << BIT_SHIFT_VPD_DATA_8812F) -+#define BITS_VPD_DATA_8812F \ -+ (BIT_MASK_VPD_DATA_8812F << BIT_SHIFT_VPD_DATA_8812F) -+#define BIT_CLEAR_VPD_DATA_8812F(x) ((x) & (~BITS_VPD_DATA_8812F)) -+#define BIT_GET_VPD_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_VPD_DATA_8812F) & BIT_MASK_VPD_DATA_8812F) -+#define BIT_SET_VPD_DATA_8812F(x, v) \ -+ (BIT_CLEAR_VPD_DATA_8812F(x) | BIT_VPD_DATA_8812F(v)) -+ -+/* 2 REG_SYS_SWR_CTRL1_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_HW_AUTO_CTRL_EXT_SWR_8812F BIT(9) -+#define BIT_USE_INTERNAL_SWR_AND_LDO_8812F BIT(8) -+#define BIT_MAC_ID_EN_8812F BIT(7) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_SYS_SWR_CTRL2_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_SW18_SEL_8812F BIT(13) -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_SW18_SD_8812F BIT(10) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_SYS_SWR_CTRL3_8812F */ -+#define BIT_SPS18_OCP_DIS_8812F BIT(31) -+ -+#define BIT_SHIFT_SPS18_OCP_TH_8812F 16 -+#define BIT_MASK_SPS18_OCP_TH_8812F 0x7fff -+#define BIT_SPS18_OCP_TH_8812F(x) \ -+ (((x) & BIT_MASK_SPS18_OCP_TH_8812F) << BIT_SHIFT_SPS18_OCP_TH_8812F) -+#define BITS_SPS18_OCP_TH_8812F \ -+ (BIT_MASK_SPS18_OCP_TH_8812F << BIT_SHIFT_SPS18_OCP_TH_8812F) -+#define BIT_CLEAR_SPS18_OCP_TH_8812F(x) ((x) & (~BITS_SPS18_OCP_TH_8812F)) -+#define BIT_GET_SPS18_OCP_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_SPS18_OCP_TH_8812F) & BIT_MASK_SPS18_OCP_TH_8812F) -+#define BIT_SET_SPS18_OCP_TH_8812F(x, v) \ -+ (BIT_CLEAR_SPS18_OCP_TH_8812F(x) | BIT_SPS18_OCP_TH_8812F(v)) -+ -+#define BIT_SHIFT_OCP_WINDOW_8812F 0 -+#define BIT_MASK_OCP_WINDOW_8812F 0xffff -+#define BIT_OCP_WINDOW_8812F(x) \ -+ (((x) & BIT_MASK_OCP_WINDOW_8812F) << BIT_SHIFT_OCP_WINDOW_8812F) -+#define BITS_OCP_WINDOW_8812F \ -+ (BIT_MASK_OCP_WINDOW_8812F << BIT_SHIFT_OCP_WINDOW_8812F) -+#define BIT_CLEAR_OCP_WINDOW_8812F(x) ((x) & (~BITS_OCP_WINDOW_8812F)) -+#define BIT_GET_OCP_WINDOW_8812F(x) \ -+ (((x) >> BIT_SHIFT_OCP_WINDOW_8812F) & BIT_MASK_OCP_WINDOW_8812F) -+#define BIT_SET_OCP_WINDOW_8812F(x, v) \ -+ (BIT_CLEAR_OCP_WINDOW_8812F(x) | BIT_OCP_WINDOW_8812F(v)) -+ -+/* 2 REG_RSV_CTRL_8812F */ -+#define BIT_HREG_DBG_8812F BIT(23) -+#define BIT_WLMCUIOIF_8812F BIT(8) -+#define BIT_LOCK_ALL_EN_8812F BIT(7) -+#define BIT_R_DIS_PRST_8812F BIT(6) -+#define BIT_WLOCK_1C_B6_8812F BIT(5) -+#define BIT_WLOCK_40_8812F BIT(4) -+#define BIT_WLOCK_08_8812F BIT(3) -+#define BIT_WLOCK_04_8812F BIT(2) -+#define BIT_WLOCK_00_8812F BIT(1) -+#define BIT_WLOCK_ALL_8812F BIT(0) -+ -+/* 2 REG_RF_CTRL_8812F */ -+#define BIT_RF_SDMRSTB_8812F BIT(2) -+#define BIT_RF_RSTB_8812F BIT(1) -+#define BIT_RF_EN_8812F BIT(0) -+ -+/* 2 REG_AFE_LDO_CTRL_8812F */ -+#define BIT_R_SYM_WLPON_EMEM1_EN_8812F BIT(31) -+#define BIT_R_SYM_WLPON_EMEM0_EN_8812F BIT(30) -+#define BIT_R_SYM_WLPOFF_P4EN_8812F BIT(28) -+#define BIT_R_SYM_WLPOFF_P3EN_8812F BIT(27) -+#define BIT_R_SYM_WLPOFF_P2EN_8812F BIT(26) -+#define BIT_R_SYM_WLPOFF_P1EN_8812F BIT(25) -+#define BIT_R_SYM_WLPOFF_EN_8812F BIT(24) -+#define BIT_R_SYM_WLPON_P3EN_8812F BIT(21) -+#define BIT_R_SYM_WLPON_P2EN_8812F BIT(20) -+#define BIT_R_SYM_WLPON_P1EN_8812F BIT(19) -+#define BIT_R_SYM_WLPON_EN_8812F BIT(18) -+#define BIT_R_SYM_LDOV12D_STBY_8812F BIT(16) -+#define BIT_BB_POWER_CUT_CTRL_BY_BB_8812F BIT(15) -+#define BIT_R_SYM_WLBBOFF1_P4_EN_8812F BIT(9) -+#define BIT_R_SYM_WLBBOFF1_P3_EN_8812F BIT(8) -+#define BIT_R_SYM_WLBBOFF1_P2_EN_8812F BIT(7) -+#define BIT_R_SYM_WLBBOFF1_P1_EN_8812F BIT(6) -+#define BIT_R_SYM_WLBBOFF_P4_EN_8812F BIT(4) -+#define BIT_R_SYM_WLBBOFF_P3_EN_8812F BIT(3) -+#define BIT_R_SYM_WLBBOFF_P2_EN_8812F BIT(2) -+#define BIT_R_SYM_WLBBOFF_P1_EN_8812F BIT(1) -+#define BIT_R_SYM_WLBBOFF_EN_8812F BIT(0) -+ -+/* 2 REG_AFE_CTRL1_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_MAC_CLK_SEL_8812F 20 -+#define BIT_MASK_MAC_CLK_SEL_8812F 0x3 -+#define BIT_MAC_CLK_SEL_8812F(x) \ -+ (((x) & BIT_MASK_MAC_CLK_SEL_8812F) << BIT_SHIFT_MAC_CLK_SEL_8812F) -+#define BITS_MAC_CLK_SEL_8812F \ -+ (BIT_MASK_MAC_CLK_SEL_8812F << BIT_SHIFT_MAC_CLK_SEL_8812F) -+#define BIT_CLEAR_MAC_CLK_SEL_8812F(x) ((x) & (~BITS_MAC_CLK_SEL_8812F)) -+#define BIT_GET_MAC_CLK_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAC_CLK_SEL_8812F) & BIT_MASK_MAC_CLK_SEL_8812F) -+#define BIT_SET_MAC_CLK_SEL_8812F(x, v) \ -+ (BIT_CLEAR_MAC_CLK_SEL_8812F(x) | BIT_MAC_CLK_SEL_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_ANAPARSW_POW_MAC_8812F */ -+#define BIT_POW_LDO15_8812F BIT(2) -+#define BIT_POW_SW_8812F BIT(1) -+#define BIT_POW_LDO14_8812F BIT(0) -+ -+/* 2 REG_ANAPARLDO_POW_MAC_8812F */ -+#define BIT_LDOE25_POW_L_8812F BIT(0) -+ -+/* 2 REG_ANAPAR_POW_MAC_8812F */ -+#define BIT_DUMMY_V4_8812F BIT(7) -+#define BIT_DUMMY_V3_8812F BIT(6) -+#define BIT_DUMMY_V2_8812F BIT(5) -+#define BIT_DUMMY_V1_8812F BIT(4) -+#define BIT_POW_PC_LDO_PORT1_8812F BIT(3) -+#define BIT_POW_PC_LDO_PORT0_8812F BIT(2) -+#define BIT_POW_PLL_V1_8812F BIT(1) -+#define BIT_POW_POWER_CUT_POW_LDO_8812F BIT(0) -+ -+/* 2 REG_ANAPAR_POW_XTAL_8812F */ -+#define BIT_POW_XTAL_8812F BIT(1) -+#define BIT_POW_BG_8812F BIT(0) -+ -+/* 2 REG_ANAPARLDO_MAC_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_REG_STANDBY_L_8812F BIT(19) -+#define BIT_PD_REGU_L_8812F BIT(18) -+#define BIT_EN_PC_BT_L_8812F BIT(17) -+ -+#define BIT_SHIFT_REG_LDOADJ_L_8812F 13 -+#define BIT_MASK_REG_LDOADJ_L_8812F 0xf -+#define BIT_REG_LDOADJ_L_8812F(x) \ -+ (((x) & BIT_MASK_REG_LDOADJ_L_8812F) << BIT_SHIFT_REG_LDOADJ_L_8812F) -+#define BITS_REG_LDOADJ_L_8812F \ -+ (BIT_MASK_REG_LDOADJ_L_8812F << BIT_SHIFT_REG_LDOADJ_L_8812F) -+#define BIT_CLEAR_REG_LDOADJ_L_8812F(x) ((x) & (~BITS_REG_LDOADJ_L_8812F)) -+#define BIT_GET_REG_LDOADJ_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LDOADJ_L_8812F) & BIT_MASK_REG_LDOADJ_L_8812F) -+#define BIT_SET_REG_LDOADJ_L_8812F(x, v) \ -+ (BIT_CLEAR_REG_LDOADJ_L_8812F(x) | BIT_REG_LDOADJ_L_8812F(v)) -+ -+#define BIT_CK12M_EN_8812F BIT(11) -+#define BIT_CK12M_SEL_8812F BIT(10) -+#define BIT_EN_25_L_8812F BIT(9) -+#define BIT_EN_SLEEP_8812F BIT(8) -+ -+#define BIT_SHIFT_LDOH12_V12ADJ_L_8812F 4 -+#define BIT_MASK_LDOH12_V12ADJ_L_8812F 0xf -+#define BIT_LDOH12_V12ADJ_L_8812F(x) \ -+ (((x) & BIT_MASK_LDOH12_V12ADJ_L_8812F) \ -+ << BIT_SHIFT_LDOH12_V12ADJ_L_8812F) -+#define BITS_LDOH12_V12ADJ_L_8812F \ -+ (BIT_MASK_LDOH12_V12ADJ_L_8812F << BIT_SHIFT_LDOH12_V12ADJ_L_8812F) -+#define BIT_CLEAR_LDOH12_V12ADJ_L_8812F(x) ((x) & (~BITS_LDOH12_V12ADJ_L_8812F)) -+#define BIT_GET_LDOH12_V12ADJ_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_LDOH12_V12ADJ_L_8812F) & \ -+ BIT_MASK_LDOH12_V12ADJ_L_8812F) -+#define BIT_SET_LDOH12_V12ADJ_L_8812F(x, v) \ -+ (BIT_CLEAR_LDOH12_V12ADJ_L_8812F(x) | BIT_LDOH12_V12ADJ_L_8812F(v)) -+ -+#define BIT_SHIFT_LDOE25_V12ADJ_L_V1_8812F 0 -+#define BIT_MASK_LDOE25_V12ADJ_L_V1_8812F 0xf -+#define BIT_LDOE25_V12ADJ_L_V1_8812F(x) \ -+ (((x) & BIT_MASK_LDOE25_V12ADJ_L_V1_8812F) \ -+ << BIT_SHIFT_LDOE25_V12ADJ_L_V1_8812F) -+#define BITS_LDOE25_V12ADJ_L_V1_8812F \ -+ (BIT_MASK_LDOE25_V12ADJ_L_V1_8812F \ -+ << BIT_SHIFT_LDOE25_V12ADJ_L_V1_8812F) -+#define BIT_CLEAR_LDOE25_V12ADJ_L_V1_8812F(x) \ -+ ((x) & (~BITS_LDOE25_V12ADJ_L_V1_8812F)) -+#define BIT_GET_LDOE25_V12ADJ_L_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_LDOE25_V12ADJ_L_V1_8812F) & \ -+ BIT_MASK_LDOE25_V12ADJ_L_V1_8812F) -+#define BIT_SET_LDOE25_V12ADJ_L_V1_8812F(x, v) \ -+ (BIT_CLEAR_LDOE25_V12ADJ_L_V1_8812F(x) | \ -+ BIT_LDOE25_V12ADJ_L_V1_8812F(v)) -+ -+/* 2 REG_EFUSE_CTRL_8812F */ -+#define BIT_EF_FLAG_8812F BIT(31) -+ -+#define BIT_SHIFT_EF_PGPD_8812F 28 -+#define BIT_MASK_EF_PGPD_8812F 0x7 -+#define BIT_EF_PGPD_8812F(x) \ -+ (((x) & BIT_MASK_EF_PGPD_8812F) << BIT_SHIFT_EF_PGPD_8812F) -+#define BITS_EF_PGPD_8812F (BIT_MASK_EF_PGPD_8812F << BIT_SHIFT_EF_PGPD_8812F) -+#define BIT_CLEAR_EF_PGPD_8812F(x) ((x) & (~BITS_EF_PGPD_8812F)) -+#define BIT_GET_EF_PGPD_8812F(x) \ -+ (((x) >> BIT_SHIFT_EF_PGPD_8812F) & BIT_MASK_EF_PGPD_8812F) -+#define BIT_SET_EF_PGPD_8812F(x, v) \ -+ (BIT_CLEAR_EF_PGPD_8812F(x) | BIT_EF_PGPD_8812F(v)) -+ -+#define BIT_SHIFT_EF_RDT_8812F 24 -+#define BIT_MASK_EF_RDT_8812F 0xf -+#define BIT_EF_RDT_8812F(x) \ -+ (((x) & BIT_MASK_EF_RDT_8812F) << BIT_SHIFT_EF_RDT_8812F) -+#define BITS_EF_RDT_8812F (BIT_MASK_EF_RDT_8812F << BIT_SHIFT_EF_RDT_8812F) -+#define BIT_CLEAR_EF_RDT_8812F(x) ((x) & (~BITS_EF_RDT_8812F)) -+#define BIT_GET_EF_RDT_8812F(x) \ -+ (((x) >> BIT_SHIFT_EF_RDT_8812F) & BIT_MASK_EF_RDT_8812F) -+#define BIT_SET_EF_RDT_8812F(x, v) \ -+ (BIT_CLEAR_EF_RDT_8812F(x) | BIT_EF_RDT_8812F(v)) -+ -+#define BIT_SHIFT_EF_PGTS_8812F 20 -+#define BIT_MASK_EF_PGTS_8812F 0xf -+#define BIT_EF_PGTS_8812F(x) \ -+ (((x) & BIT_MASK_EF_PGTS_8812F) << BIT_SHIFT_EF_PGTS_8812F) -+#define BITS_EF_PGTS_8812F (BIT_MASK_EF_PGTS_8812F << BIT_SHIFT_EF_PGTS_8812F) -+#define BIT_CLEAR_EF_PGTS_8812F(x) ((x) & (~BITS_EF_PGTS_8812F)) -+#define BIT_GET_EF_PGTS_8812F(x) \ -+ (((x) >> BIT_SHIFT_EF_PGTS_8812F) & BIT_MASK_EF_PGTS_8812F) -+#define BIT_SET_EF_PGTS_8812F(x, v) \ -+ (BIT_CLEAR_EF_PGTS_8812F(x) | BIT_EF_PGTS_8812F(v)) -+ -+#define BIT_EF_PDWN_8812F BIT(19) -+#define BIT_EF_ALDEN_8812F BIT(18) -+ -+#define BIT_SHIFT_EF_ADDR_8812F 8 -+#define BIT_MASK_EF_ADDR_8812F 0x3ff -+#define BIT_EF_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_EF_ADDR_8812F) << BIT_SHIFT_EF_ADDR_8812F) -+#define BITS_EF_ADDR_8812F (BIT_MASK_EF_ADDR_8812F << BIT_SHIFT_EF_ADDR_8812F) -+#define BIT_CLEAR_EF_ADDR_8812F(x) ((x) & (~BITS_EF_ADDR_8812F)) -+#define BIT_GET_EF_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_EF_ADDR_8812F) & BIT_MASK_EF_ADDR_8812F) -+#define BIT_SET_EF_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_EF_ADDR_8812F(x) | BIT_EF_ADDR_8812F(v)) -+ -+#define BIT_SHIFT_EF_DATA_8812F 0 -+#define BIT_MASK_EF_DATA_8812F 0xff -+#define BIT_EF_DATA_8812F(x) \ -+ (((x) & BIT_MASK_EF_DATA_8812F) << BIT_SHIFT_EF_DATA_8812F) -+#define BITS_EF_DATA_8812F (BIT_MASK_EF_DATA_8812F << BIT_SHIFT_EF_DATA_8812F) -+#define BIT_CLEAR_EF_DATA_8812F(x) ((x) & (~BITS_EF_DATA_8812F)) -+#define BIT_GET_EF_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_EF_DATA_8812F) & BIT_MASK_EF_DATA_8812F) -+#define BIT_SET_EF_DATA_8812F(x, v) \ -+ (BIT_CLEAR_EF_DATA_8812F(x) | BIT_EF_DATA_8812F(v)) -+ -+/* 2 REG_LDO_EFUSE_CTRL_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_EF_CRES_SEL_8812F BIT(26) -+ -+#define BIT_SHIFT_EF_SCAN_START_V1_8812F 16 -+#define BIT_MASK_EF_SCAN_START_V1_8812F 0x3ff -+#define BIT_EF_SCAN_START_V1_8812F(x) \ -+ (((x) & BIT_MASK_EF_SCAN_START_V1_8812F) \ -+ << BIT_SHIFT_EF_SCAN_START_V1_8812F) -+#define BITS_EF_SCAN_START_V1_8812F \ -+ (BIT_MASK_EF_SCAN_START_V1_8812F << BIT_SHIFT_EF_SCAN_START_V1_8812F) -+#define BIT_CLEAR_EF_SCAN_START_V1_8812F(x) \ -+ ((x) & (~BITS_EF_SCAN_START_V1_8812F)) -+#define BIT_GET_EF_SCAN_START_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_START_V1_8812F) & \ -+ BIT_MASK_EF_SCAN_START_V1_8812F) -+#define BIT_SET_EF_SCAN_START_V1_8812F(x, v) \ -+ (BIT_CLEAR_EF_SCAN_START_V1_8812F(x) | BIT_EF_SCAN_START_V1_8812F(v)) -+ -+#define BIT_SHIFT_EF_SCAN_END_8812F 12 -+#define BIT_MASK_EF_SCAN_END_8812F 0xf -+#define BIT_EF_SCAN_END_8812F(x) \ -+ (((x) & BIT_MASK_EF_SCAN_END_8812F) << BIT_SHIFT_EF_SCAN_END_8812F) -+#define BITS_EF_SCAN_END_8812F \ -+ (BIT_MASK_EF_SCAN_END_8812F << BIT_SHIFT_EF_SCAN_END_8812F) -+#define BIT_CLEAR_EF_SCAN_END_8812F(x) ((x) & (~BITS_EF_SCAN_END_8812F)) -+#define BIT_GET_EF_SCAN_END_8812F(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_END_8812F) & BIT_MASK_EF_SCAN_END_8812F) -+#define BIT_SET_EF_SCAN_END_8812F(x, v) \ -+ (BIT_CLEAR_EF_SCAN_END_8812F(x) | BIT_EF_SCAN_END_8812F(v)) -+ -+#define BIT_EF_PD_DIS_8812F BIT(11) -+ -+#define BIT_SHIFT_EF_CELL_SEL_8812F 8 -+#define BIT_MASK_EF_CELL_SEL_8812F 0x3 -+#define BIT_EF_CELL_SEL_8812F(x) \ -+ (((x) & BIT_MASK_EF_CELL_SEL_8812F) << BIT_SHIFT_EF_CELL_SEL_8812F) -+#define BITS_EF_CELL_SEL_8812F \ -+ (BIT_MASK_EF_CELL_SEL_8812F << BIT_SHIFT_EF_CELL_SEL_8812F) -+#define BIT_CLEAR_EF_CELL_SEL_8812F(x) ((x) & (~BITS_EF_CELL_SEL_8812F)) -+#define BIT_GET_EF_CELL_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_EF_CELL_SEL_8812F) & BIT_MASK_EF_CELL_SEL_8812F) -+#define BIT_SET_EF_CELL_SEL_8812F(x, v) \ -+ (BIT_CLEAR_EF_CELL_SEL_8812F(x) | BIT_EF_CELL_SEL_8812F(v)) -+ -+#define BIT_EF_TRPT_8812F BIT(7) -+ -+#define BIT_SHIFT_EF_TTHD_8812F 0 -+#define BIT_MASK_EF_TTHD_8812F 0x7f -+#define BIT_EF_TTHD_8812F(x) \ -+ (((x) & BIT_MASK_EF_TTHD_8812F) << BIT_SHIFT_EF_TTHD_8812F) -+#define BITS_EF_TTHD_8812F (BIT_MASK_EF_TTHD_8812F << BIT_SHIFT_EF_TTHD_8812F) -+#define BIT_CLEAR_EF_TTHD_8812F(x) ((x) & (~BITS_EF_TTHD_8812F)) -+#define BIT_GET_EF_TTHD_8812F(x) \ -+ (((x) >> BIT_SHIFT_EF_TTHD_8812F) & BIT_MASK_EF_TTHD_8812F) -+#define BIT_SET_EF_TTHD_8812F(x, v) \ -+ (BIT_CLEAR_EF_TTHD_8812F(x) | BIT_EF_TTHD_8812F(v)) -+ -+/* 2 REG_PWR_OPTION_CTRL_8812F */ -+ -+#define BIT_SHIFT_DBG_SEL_V1_8812F 16 -+#define BIT_MASK_DBG_SEL_V1_8812F 0xff -+#define BIT_DBG_SEL_V1_8812F(x) \ -+ (((x) & BIT_MASK_DBG_SEL_V1_8812F) << BIT_SHIFT_DBG_SEL_V1_8812F) -+#define BITS_DBG_SEL_V1_8812F \ -+ (BIT_MASK_DBG_SEL_V1_8812F << BIT_SHIFT_DBG_SEL_V1_8812F) -+#define BIT_CLEAR_DBG_SEL_V1_8812F(x) ((x) & (~BITS_DBG_SEL_V1_8812F)) -+#define BIT_GET_DBG_SEL_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_V1_8812F) & BIT_MASK_DBG_SEL_V1_8812F) -+#define BIT_SET_DBG_SEL_V1_8812F(x, v) \ -+ (BIT_CLEAR_DBG_SEL_V1_8812F(x) | BIT_DBG_SEL_V1_8812F(v)) -+ -+#define BIT_SHIFT_DBG_SEL_BYTE_8812F 14 -+#define BIT_MASK_DBG_SEL_BYTE_8812F 0x3 -+#define BIT_DBG_SEL_BYTE_8812F(x) \ -+ (((x) & BIT_MASK_DBG_SEL_BYTE_8812F) << BIT_SHIFT_DBG_SEL_BYTE_8812F) -+#define BITS_DBG_SEL_BYTE_8812F \ -+ (BIT_MASK_DBG_SEL_BYTE_8812F << BIT_SHIFT_DBG_SEL_BYTE_8812F) -+#define BIT_CLEAR_DBG_SEL_BYTE_8812F(x) ((x) & (~BITS_DBG_SEL_BYTE_8812F)) -+#define BIT_GET_DBG_SEL_BYTE_8812F(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_BYTE_8812F) & BIT_MASK_DBG_SEL_BYTE_8812F) -+#define BIT_SET_DBG_SEL_BYTE_8812F(x, v) \ -+ (BIT_CLEAR_DBG_SEL_BYTE_8812F(x) | BIT_DBG_SEL_BYTE_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_SYSON_DBG_PAD_E2_8812F BIT(11) -+#define BIT_SYSON_LED_PAD_E2_8812F BIT(10) -+#define BIT_SYSON_GPEE_PAD_E2_8812F BIT(9) -+#define BIT_SYSON_PCI_PAD_E2_8812F BIT(8) -+#define BIT_AUTO_SW_LDO_VOL_EN_8812F BIT(7) -+ -+#define BIT_SHIFT_SYSON_SPS0WWV_WT_8812F 4 -+#define BIT_MASK_SYSON_SPS0WWV_WT_8812F 0x3 -+#define BIT_SYSON_SPS0WWV_WT_8812F(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0WWV_WT_8812F) \ -+ << BIT_SHIFT_SYSON_SPS0WWV_WT_8812F) -+#define BITS_SYSON_SPS0WWV_WT_8812F \ -+ (BIT_MASK_SYSON_SPS0WWV_WT_8812F << BIT_SHIFT_SYSON_SPS0WWV_WT_8812F) -+#define BIT_CLEAR_SYSON_SPS0WWV_WT_8812F(x) \ -+ ((x) & (~BITS_SYSON_SPS0WWV_WT_8812F)) -+#define BIT_GET_SYSON_SPS0WWV_WT_8812F(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0WWV_WT_8812F) & \ -+ BIT_MASK_SYSON_SPS0WWV_WT_8812F) -+#define BIT_SET_SYSON_SPS0WWV_WT_8812F(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0WWV_WT_8812F(x) | BIT_SYSON_SPS0WWV_WT_8812F(v)) -+ -+#define BIT_SHIFT_SYSON_SPS0LDO_WT_8812F 2 -+#define BIT_MASK_SYSON_SPS0LDO_WT_8812F 0x3 -+#define BIT_SYSON_SPS0LDO_WT_8812F(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0LDO_WT_8812F) \ -+ << BIT_SHIFT_SYSON_SPS0LDO_WT_8812F) -+#define BITS_SYSON_SPS0LDO_WT_8812F \ -+ (BIT_MASK_SYSON_SPS0LDO_WT_8812F << BIT_SHIFT_SYSON_SPS0LDO_WT_8812F) -+#define BIT_CLEAR_SYSON_SPS0LDO_WT_8812F(x) \ -+ ((x) & (~BITS_SYSON_SPS0LDO_WT_8812F)) -+#define BIT_GET_SYSON_SPS0LDO_WT_8812F(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0LDO_WT_8812F) & \ -+ BIT_MASK_SYSON_SPS0LDO_WT_8812F) -+#define BIT_SET_SYSON_SPS0LDO_WT_8812F(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0LDO_WT_8812F(x) | BIT_SYSON_SPS0LDO_WT_8812F(v)) -+ -+#define BIT_SHIFT_SYSON_RCLK_SCALE_8812F 0 -+#define BIT_MASK_SYSON_RCLK_SCALE_8812F 0x3 -+#define BIT_SYSON_RCLK_SCALE_8812F(x) \ -+ (((x) & BIT_MASK_SYSON_RCLK_SCALE_8812F) \ -+ << BIT_SHIFT_SYSON_RCLK_SCALE_8812F) -+#define BITS_SYSON_RCLK_SCALE_8812F \ -+ (BIT_MASK_SYSON_RCLK_SCALE_8812F << BIT_SHIFT_SYSON_RCLK_SCALE_8812F) -+#define BIT_CLEAR_SYSON_RCLK_SCALE_8812F(x) \ -+ ((x) & (~BITS_SYSON_RCLK_SCALE_8812F)) -+#define BIT_GET_SYSON_RCLK_SCALE_8812F(x) \ -+ (((x) >> BIT_SHIFT_SYSON_RCLK_SCALE_8812F) & \ -+ BIT_MASK_SYSON_RCLK_SCALE_8812F) -+#define BIT_SET_SYSON_RCLK_SCALE_8812F(x, v) \ -+ (BIT_CLEAR_SYSON_RCLK_SCALE_8812F(x) | BIT_SYSON_RCLK_SCALE_8812F(v)) -+ -+/* 2 REG_CAL_TIMER_8812F */ -+ -+#define BIT_SHIFT_MATCH_CNT_8812F 8 -+#define BIT_MASK_MATCH_CNT_8812F 0xff -+#define BIT_MATCH_CNT_8812F(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8812F) << BIT_SHIFT_MATCH_CNT_8812F) -+#define BITS_MATCH_CNT_8812F \ -+ (BIT_MASK_MATCH_CNT_8812F << BIT_SHIFT_MATCH_CNT_8812F) -+#define BIT_CLEAR_MATCH_CNT_8812F(x) ((x) & (~BITS_MATCH_CNT_8812F)) -+#define BIT_GET_MATCH_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8812F) & BIT_MASK_MATCH_CNT_8812F) -+#define BIT_SET_MATCH_CNT_8812F(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8812F(x) | BIT_MATCH_CNT_8812F(v)) -+ -+#define BIT_SHIFT_CAL_SCAL_8812F 0 -+#define BIT_MASK_CAL_SCAL_8812F 0xff -+#define BIT_CAL_SCAL_8812F(x) \ -+ (((x) & BIT_MASK_CAL_SCAL_8812F) << BIT_SHIFT_CAL_SCAL_8812F) -+#define BITS_CAL_SCAL_8812F \ -+ (BIT_MASK_CAL_SCAL_8812F << BIT_SHIFT_CAL_SCAL_8812F) -+#define BIT_CLEAR_CAL_SCAL_8812F(x) ((x) & (~BITS_CAL_SCAL_8812F)) -+#define BIT_GET_CAL_SCAL_8812F(x) \ -+ (((x) >> BIT_SHIFT_CAL_SCAL_8812F) & BIT_MASK_CAL_SCAL_8812F) -+#define BIT_SET_CAL_SCAL_8812F(x, v) \ -+ (BIT_CLEAR_CAL_SCAL_8812F(x) | BIT_CAL_SCAL_8812F(v)) -+ -+/* 2 REG_ACLK_MON_8812F */ -+ -+#define BIT_SHIFT_RCLK_MON_8812F 5 -+#define BIT_MASK_RCLK_MON_8812F 0x7ff -+#define BIT_RCLK_MON_8812F(x) \ -+ (((x) & BIT_MASK_RCLK_MON_8812F) << BIT_SHIFT_RCLK_MON_8812F) -+#define BITS_RCLK_MON_8812F \ -+ (BIT_MASK_RCLK_MON_8812F << BIT_SHIFT_RCLK_MON_8812F) -+#define BIT_CLEAR_RCLK_MON_8812F(x) ((x) & (~BITS_RCLK_MON_8812F)) -+#define BIT_GET_RCLK_MON_8812F(x) \ -+ (((x) >> BIT_SHIFT_RCLK_MON_8812F) & BIT_MASK_RCLK_MON_8812F) -+#define BIT_SET_RCLK_MON_8812F(x, v) \ -+ (BIT_CLEAR_RCLK_MON_8812F(x) | BIT_RCLK_MON_8812F(v)) -+ -+#define BIT_CAL_EN_8812F BIT(4) -+ -+#define BIT_SHIFT_DPSTU_8812F 2 -+#define BIT_MASK_DPSTU_8812F 0x3 -+#define BIT_DPSTU_8812F(x) \ -+ (((x) & BIT_MASK_DPSTU_8812F) << BIT_SHIFT_DPSTU_8812F) -+#define BITS_DPSTU_8812F (BIT_MASK_DPSTU_8812F << BIT_SHIFT_DPSTU_8812F) -+#define BIT_CLEAR_DPSTU_8812F(x) ((x) & (~BITS_DPSTU_8812F)) -+#define BIT_GET_DPSTU_8812F(x) \ -+ (((x) >> BIT_SHIFT_DPSTU_8812F) & BIT_MASK_DPSTU_8812F) -+#define BIT_SET_DPSTU_8812F(x, v) \ -+ (BIT_CLEAR_DPSTU_8812F(x) | BIT_DPSTU_8812F(v)) -+ -+#define BIT_SUS_16X_8812F BIT(1) -+ -+/* 2 REG_GPIO_MUXCFG_2_8812F */ -+#define BIT_SOUT_GPIO8_8812F BIT(7) -+#define BIT_SOUT_GPIO5_8812F BIT(6) -+#define BIT_RFE_CTRL_5_GPIO14_V1_8812F BIT(5) -+#define BIT_RFE_CTRL_10_GPIO13_V1_8812F BIT(4) -+#define BIT_RFE_CTRL_11_GPIO4_V1_8812F BIT(3) -+#define BIT_RFE_CTRL_5_GPIO14_8812F BIT(2) -+#define BIT_RFE_CTRL_10_GPIO13_8812F BIT(1) -+#define BIT_RFE_CTRL_11_GPIO4_8812F BIT(0) -+ -+/* 2 REG_GPIO_MUXCFG_8812F */ -+#define BIT_RFE_CTRL_3_GPIO12_8812F BIT(31) -+#define BIT_BT_RFE_CTRL_5_GPIO12_8812F BIT(30) -+#define BIT_S0_TRSW_GPIO12_8812F BIT(29) -+#define BIT_RFE_CTRL_9_GPIO13_8812F BIT(28) -+#define BIT_RFE_CTRL_9_GPIO12_8812F BIT(27) -+#define BIT_RFE_CTRL_8_GPIO4_8812F BIT(26) -+#define BIT_BT_RFE_CTRL_1_GPIO13_8812F BIT(25) -+#define BIT_BT_RFE_CTRL_1_GPIO12_8812F BIT(24) -+#define BIT_BT_RFE_CTRL_0_GPIO4_8812F BIT(23) -+#define BIT_ANTSW_GPIO13_8812F BIT(22) -+#define BIT_ANTSW_GPIO12_8812F BIT(21) -+#define BIT_ANTSWB_GPIO4_8812F BIT(20) -+#define BIT_FSPI_EN_8812F BIT(19) -+#define BIT_WL_RTS_EXT_32K_SEL_8812F BIT(18) -+#define BIT_WLBT_DPDT_SEL_EN_8812F BIT(17) -+#define BIT_WLBT_LNAON_SEL_EN_8812F BIT(16) -+#define BIT_SIC_LBK_8812F BIT(15) -+#define BIT_ENHTP_8812F BIT(14) -+#define BIT_BT_AOD_GPIO3_8812F BIT(13) -+#define BIT_ENSIC_8812F BIT(12) -+#define BIT_SIC_SWRST_8812F BIT(11) -+#define BIT_PO_WIFI_PTA_PINS_8812F BIT(10) -+#define BIT_PO_BT_PTA_PINS_8812F BIT(9) -+#define BIT_ENUART_8812F BIT(8) -+ -+#define BIT_SHIFT_BTMODE_8812F 6 -+#define BIT_MASK_BTMODE_8812F 0x3 -+#define BIT_BTMODE_8812F(x) \ -+ (((x) & BIT_MASK_BTMODE_8812F) << BIT_SHIFT_BTMODE_8812F) -+#define BITS_BTMODE_8812F (BIT_MASK_BTMODE_8812F << BIT_SHIFT_BTMODE_8812F) -+#define BIT_CLEAR_BTMODE_8812F(x) ((x) & (~BITS_BTMODE_8812F)) -+#define BIT_GET_BTMODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_BTMODE_8812F) & BIT_MASK_BTMODE_8812F) -+#define BIT_SET_BTMODE_8812F(x, v) \ -+ (BIT_CLEAR_BTMODE_8812F(x) | BIT_BTMODE_8812F(v)) -+ -+#define BIT_ENBT_8812F BIT(5) -+#define BIT_EROM_EN_8812F BIT(4) -+#define BIT_WLRFE_6_7_EN_8812F BIT(3) -+#define BIT_WLRFE_4_5_EN_8812F BIT(2) -+ -+#define BIT_SHIFT_GPIOSEL_8812F 0 -+#define BIT_MASK_GPIOSEL_8812F 0x3 -+#define BIT_GPIOSEL_8812F(x) \ -+ (((x) & BIT_MASK_GPIOSEL_8812F) << BIT_SHIFT_GPIOSEL_8812F) -+#define BITS_GPIOSEL_8812F (BIT_MASK_GPIOSEL_8812F << BIT_SHIFT_GPIOSEL_8812F) -+#define BIT_CLEAR_GPIOSEL_8812F(x) ((x) & (~BITS_GPIOSEL_8812F)) -+#define BIT_GET_GPIOSEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_GPIOSEL_8812F) & BIT_MASK_GPIOSEL_8812F) -+#define BIT_SET_GPIOSEL_8812F(x, v) \ -+ (BIT_CLEAR_GPIOSEL_8812F(x) | BIT_GPIOSEL_8812F(v)) -+ -+/* 2 REG_GPIO_PIN_CTRL_8812F */ -+ -+#define BIT_SHIFT_GPIO_MOD_7_TO_0_8812F 24 -+#define BIT_MASK_GPIO_MOD_7_TO_0_8812F 0xff -+#define BIT_GPIO_MOD_7_TO_0_8812F(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_7_TO_0_8812F) \ -+ << BIT_SHIFT_GPIO_MOD_7_TO_0_8812F) -+#define BITS_GPIO_MOD_7_TO_0_8812F \ -+ (BIT_MASK_GPIO_MOD_7_TO_0_8812F << BIT_SHIFT_GPIO_MOD_7_TO_0_8812F) -+#define BIT_CLEAR_GPIO_MOD_7_TO_0_8812F(x) ((x) & (~BITS_GPIO_MOD_7_TO_0_8812F)) -+#define BIT_GET_GPIO_MOD_7_TO_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_7_TO_0_8812F) & \ -+ BIT_MASK_GPIO_MOD_7_TO_0_8812F) -+#define BIT_SET_GPIO_MOD_7_TO_0_8812F(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_7_TO_0_8812F(x) | BIT_GPIO_MOD_7_TO_0_8812F(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8812F 16 -+#define BIT_MASK_GPIO_IO_SEL_7_TO_0_8812F 0xff -+#define BIT_GPIO_IO_SEL_7_TO_0_8812F(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_7_TO_0_8812F) \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8812F) -+#define BITS_GPIO_IO_SEL_7_TO_0_8812F \ -+ (BIT_MASK_GPIO_IO_SEL_7_TO_0_8812F \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8812F) -+#define BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8812F(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_7_TO_0_8812F)) -+#define BIT_GET_GPIO_IO_SEL_7_TO_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8812F) & \ -+ BIT_MASK_GPIO_IO_SEL_7_TO_0_8812F) -+#define BIT_SET_GPIO_IO_SEL_7_TO_0_8812F(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8812F(x) | \ -+ BIT_GPIO_IO_SEL_7_TO_0_8812F(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_7_TO_0_8812F 8 -+#define BIT_MASK_GPIO_OUT_7_TO_0_8812F 0xff -+#define BIT_GPIO_OUT_7_TO_0_8812F(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_7_TO_0_8812F) \ -+ << BIT_SHIFT_GPIO_OUT_7_TO_0_8812F) -+#define BITS_GPIO_OUT_7_TO_0_8812F \ -+ (BIT_MASK_GPIO_OUT_7_TO_0_8812F << BIT_SHIFT_GPIO_OUT_7_TO_0_8812F) -+#define BIT_CLEAR_GPIO_OUT_7_TO_0_8812F(x) ((x) & (~BITS_GPIO_OUT_7_TO_0_8812F)) -+#define BIT_GET_GPIO_OUT_7_TO_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_7_TO_0_8812F) & \ -+ BIT_MASK_GPIO_OUT_7_TO_0_8812F) -+#define BIT_SET_GPIO_OUT_7_TO_0_8812F(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_7_TO_0_8812F(x) | BIT_GPIO_OUT_7_TO_0_8812F(v)) -+ -+#define BIT_SHIFT_GPIO_IN_7_TO_0_8812F 0 -+#define BIT_MASK_GPIO_IN_7_TO_0_8812F 0xff -+#define BIT_GPIO_IN_7_TO_0_8812F(x) \ -+ (((x) & BIT_MASK_GPIO_IN_7_TO_0_8812F) \ -+ << BIT_SHIFT_GPIO_IN_7_TO_0_8812F) -+#define BITS_GPIO_IN_7_TO_0_8812F \ -+ (BIT_MASK_GPIO_IN_7_TO_0_8812F << BIT_SHIFT_GPIO_IN_7_TO_0_8812F) -+#define BIT_CLEAR_GPIO_IN_7_TO_0_8812F(x) ((x) & (~BITS_GPIO_IN_7_TO_0_8812F)) -+#define BIT_GET_GPIO_IN_7_TO_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_7_TO_0_8812F) & \ -+ BIT_MASK_GPIO_IN_7_TO_0_8812F) -+#define BIT_SET_GPIO_IN_7_TO_0_8812F(x, v) \ -+ (BIT_CLEAR_GPIO_IN_7_TO_0_8812F(x) | BIT_GPIO_IN_7_TO_0_8812F(v)) -+ -+/* 2 REG_GPIO_INTM_8812F */ -+ -+#define BIT_SHIFT_MUXDBG_SEL_8812F 30 -+#define BIT_MASK_MUXDBG_SEL_8812F 0x3 -+#define BIT_MUXDBG_SEL_8812F(x) \ -+ (((x) & BIT_MASK_MUXDBG_SEL_8812F) << BIT_SHIFT_MUXDBG_SEL_8812F) -+#define BITS_MUXDBG_SEL_8812F \ -+ (BIT_MASK_MUXDBG_SEL_8812F << BIT_SHIFT_MUXDBG_SEL_8812F) -+#define BIT_CLEAR_MUXDBG_SEL_8812F(x) ((x) & (~BITS_MUXDBG_SEL_8812F)) -+#define BIT_GET_MUXDBG_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_MUXDBG_SEL_8812F) & BIT_MASK_MUXDBG_SEL_8812F) -+#define BIT_SET_MUXDBG_SEL_8812F(x, v) \ -+ (BIT_CLEAR_MUXDBG_SEL_8812F(x) | BIT_MUXDBG_SEL_8812F(v)) -+ -+#define BIT_EXTWOL_SEL_8812F BIT(17) -+#define BIT_EXTWOL_EN_8812F BIT(16) -+#define BIT_GPIOF_INT_MD_8812F BIT(15) -+#define BIT_GPIOE_INT_MD_8812F BIT(14) -+#define BIT_GPIOD_INT_MD_8812F BIT(13) -+#define BIT_GPIOF_INT_MD_8812F BIT(15) -+#define BIT_GPIOE_INT_MD_8812F BIT(14) -+#define BIT_GPIOD_INT_MD_8812F BIT(13) -+#define BIT_GPIOC_INT_MD_8812F BIT(12) -+#define BIT_GPIOB_INT_MD_8812F BIT(11) -+#define BIT_GPIOA_INT_MD_8812F BIT(10) -+#define BIT_GPIO9_INT_MD_8812F BIT(9) -+#define BIT_GPIO8_INT_MD_8812F BIT(8) -+#define BIT_GPIO7_INT_MD_8812F BIT(7) -+#define BIT_GPIO6_INT_MD_8812F BIT(6) -+#define BIT_GPIO5_INT_MD_8812F BIT(5) -+#define BIT_GPIO4_INT_MD_8812F BIT(4) -+#define BIT_GPIO3_INT_MD_8812F BIT(3) -+#define BIT_GPIO2_INT_MD_8812F BIT(2) -+#define BIT_GPIO1_INT_MD_8812F BIT(1) -+#define BIT_GPIO0_INT_MD_8812F BIT(0) -+ -+/* 2 REG_LED_CFG_8812F */ -+#define BIT_MAILBOX_1WIRE_GPIO_CFG_8812F BIT(31) -+#define BIT_BT_RF_GPIO_CFG_8812F BIT(30) -+#define BIT_BT_SDIO_INT_GPIO_CFG_8812F BIT(29) -+#define BIT_MAILBOX_3WIRE_GPIO_CFG_8812F BIT(28) -+#define BIT_WLBT_PAPE_SEL_EN_8812F BIT(27) -+#define BIT_LNAON_SEL_EN_8812F BIT(26) -+#define BIT_PAPE_SEL_EN_8812F BIT(25) -+#define BIT_DPDT_WLBT_SEL_8812F BIT(24) -+#define BIT_DPDT_SEL_EN_8812F BIT(23) -+#define BIT_GPIO13_14_WL_CTRL_EN_8812F BIT(22) -+#define BIT_LED2DIS_8812F BIT(21) -+#define BIT_LED2PL_8812F BIT(20) -+#define BIT_LED2SV_8812F BIT(19) -+ -+#define BIT_SHIFT_LED2CM_8812F 16 -+#define BIT_MASK_LED2CM_8812F 0x7 -+#define BIT_LED2CM_8812F(x) \ -+ (((x) & BIT_MASK_LED2CM_8812F) << BIT_SHIFT_LED2CM_8812F) -+#define BITS_LED2CM_8812F (BIT_MASK_LED2CM_8812F << BIT_SHIFT_LED2CM_8812F) -+#define BIT_CLEAR_LED2CM_8812F(x) ((x) & (~BITS_LED2CM_8812F)) -+#define BIT_GET_LED2CM_8812F(x) \ -+ (((x) >> BIT_SHIFT_LED2CM_8812F) & BIT_MASK_LED2CM_8812F) -+#define BIT_SET_LED2CM_8812F(x, v) \ -+ (BIT_CLEAR_LED2CM_8812F(x) | BIT_LED2CM_8812F(v)) -+ -+#define BIT_LED1DIS_8812F BIT(15) -+#define BIT_LED1PL_8812F BIT(12) -+#define BIT_LED1SV_8812F BIT(11) -+ -+#define BIT_SHIFT_LED1CM_8812F 8 -+#define BIT_MASK_LED1CM_8812F 0x7 -+#define BIT_LED1CM_8812F(x) \ -+ (((x) & BIT_MASK_LED1CM_8812F) << BIT_SHIFT_LED1CM_8812F) -+#define BITS_LED1CM_8812F (BIT_MASK_LED1CM_8812F << BIT_SHIFT_LED1CM_8812F) -+#define BIT_CLEAR_LED1CM_8812F(x) ((x) & (~BITS_LED1CM_8812F)) -+#define BIT_GET_LED1CM_8812F(x) \ -+ (((x) >> BIT_SHIFT_LED1CM_8812F) & BIT_MASK_LED1CM_8812F) -+#define BIT_SET_LED1CM_8812F(x, v) \ -+ (BIT_CLEAR_LED1CM_8812F(x) | BIT_LED1CM_8812F(v)) -+ -+#define BIT_LED0DIS_8812F BIT(7) -+ -+#define BIT_SHIFT_AFE_LDO_SWR_CHECK_8812F 5 -+#define BIT_MASK_AFE_LDO_SWR_CHECK_8812F 0x3 -+#define BIT_AFE_LDO_SWR_CHECK_8812F(x) \ -+ (((x) & BIT_MASK_AFE_LDO_SWR_CHECK_8812F) \ -+ << BIT_SHIFT_AFE_LDO_SWR_CHECK_8812F) -+#define BITS_AFE_LDO_SWR_CHECK_8812F \ -+ (BIT_MASK_AFE_LDO_SWR_CHECK_8812F << BIT_SHIFT_AFE_LDO_SWR_CHECK_8812F) -+#define BIT_CLEAR_AFE_LDO_SWR_CHECK_8812F(x) \ -+ ((x) & (~BITS_AFE_LDO_SWR_CHECK_8812F)) -+#define BIT_GET_AFE_LDO_SWR_CHECK_8812F(x) \ -+ (((x) >> BIT_SHIFT_AFE_LDO_SWR_CHECK_8812F) & \ -+ BIT_MASK_AFE_LDO_SWR_CHECK_8812F) -+#define BIT_SET_AFE_LDO_SWR_CHECK_8812F(x, v) \ -+ (BIT_CLEAR_AFE_LDO_SWR_CHECK_8812F(x) | BIT_AFE_LDO_SWR_CHECK_8812F(v)) -+ -+#define BIT_LED0PL_8812F BIT(4) -+#define BIT_LED0SV_8812F BIT(3) -+ -+#define BIT_SHIFT_LED0CM_8812F 0 -+#define BIT_MASK_LED0CM_8812F 0x7 -+#define BIT_LED0CM_8812F(x) \ -+ (((x) & BIT_MASK_LED0CM_8812F) << BIT_SHIFT_LED0CM_8812F) -+#define BITS_LED0CM_8812F (BIT_MASK_LED0CM_8812F << BIT_SHIFT_LED0CM_8812F) -+#define BIT_CLEAR_LED0CM_8812F(x) ((x) & (~BITS_LED0CM_8812F)) -+#define BIT_GET_LED0CM_8812F(x) \ -+ (((x) >> BIT_SHIFT_LED0CM_8812F) & BIT_MASK_LED0CM_8812F) -+#define BIT_SET_LED0CM_8812F(x, v) \ -+ (BIT_CLEAR_LED0CM_8812F(x) | BIT_LED0CM_8812F(v)) -+ -+/* 2 REG_FSIMR_8812F */ -+#define BIT_FS_PDNINT_EN_8812F BIT(31) -+#define BIT_FS_SPS_OCP_INT_EN_8812F BIT(29) -+#define BIT_FS_PWMERR_INT_EN_8812F BIT(28) -+#define BIT_FS_GPIOF_INT_EN_8812F BIT(27) -+#define BIT_FS_GPIOE_INT_EN_8812F BIT(26) -+#define BIT_FS_GPIOD_INT_EN_8812F BIT(25) -+#define BIT_FS_GPIOC_INT_EN_8812F BIT(24) -+#define BIT_FS_GPIOB_INT_EN_8812F BIT(23) -+#define BIT_FS_GPIOA_INT_EN_8812F BIT(22) -+#define BIT_FS_GPIO9_INT_EN_8812F BIT(21) -+#define BIT_FS_GPIO8_INT_EN_8812F BIT(20) -+#define BIT_FS_GPIO7_INT_EN_8812F BIT(19) -+#define BIT_FS_GPIO6_INT_EN_8812F BIT(18) -+#define BIT_FS_GPIO5_INT_EN_8812F BIT(17) -+#define BIT_FS_GPIO4_INT_EN_8812F BIT(16) -+#define BIT_FS_GPIO3_INT_EN_8812F BIT(15) -+#define BIT_FS_GPIO2_INT_EN_8812F BIT(14) -+#define BIT_FS_GPIO1_INT_EN_8812F BIT(13) -+#define BIT_FS_GPIO0_INT_EN_8812F BIT(12) -+#define BIT_FS_HCI_SUS_EN_8812F BIT(11) -+#define BIT_FS_HCI_RES_EN_8812F BIT(10) -+#define BIT_FS_HCI_RESET_EN_8812F BIT(9) -+#define BIT_USB_SCSI_CMD_EN_8812F BIT(8) -+#define BIT_FS_BTON_STS_UPDATE_MSK_EN_8812F BIT(7) -+#define BIT_ACT2RECOVERY_INT_EN_V1_8812F BIT(6) -+#define BIT_GEN1GEN2_SWITCH_8812F BIT(5) -+#define BIT_HCI_TXDMA_REQ_HIMR_8812F BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_MAK_8812F BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_MAK_8812F BIT(2) -+#define BIT_FS_USB_LPMRSM_MSK_8812F BIT(1) -+#define BIT_FS_USB_LPMINT_MSK_8812F BIT(0) -+ -+/* 2 REG_FSISR_8812F */ -+#define BIT_FS_PDNINT_8812F BIT(31) -+#define BIT_FS_SPS_OCP_INT_8812F BIT(29) -+#define BIT_FS_PWMERR_INT_8812F BIT(28) -+#define BIT_FS_GPIOF_INT_8812F BIT(27) -+#define BIT_FS_GPIOE_INT_8812F BIT(26) -+#define BIT_FS_GPIOD_INT_8812F BIT(25) -+#define BIT_FS_GPIOC_INT_8812F BIT(24) -+#define BIT_FS_GPIOB_INT_8812F BIT(23) -+#define BIT_FS_GPIOA_INT_8812F BIT(22) -+#define BIT_FS_GPIO9_INT_8812F BIT(21) -+#define BIT_FS_GPIO8_INT_8812F BIT(20) -+#define BIT_FS_GPIO7_INT_8812F BIT(19) -+#define BIT_FS_GPIO6_INT_8812F BIT(18) -+#define BIT_FS_GPIO5_INT_8812F BIT(17) -+#define BIT_FS_GPIO4_INT_8812F BIT(16) -+#define BIT_FS_GPIO3_INT_8812F BIT(15) -+#define BIT_FS_GPIO2_INT_8812F BIT(14) -+#define BIT_FS_GPIO1_INT_8812F BIT(13) -+#define BIT_FS_GPIO0_INT_8812F BIT(12) -+#define BIT_FS_HCI_SUS_INT_8812F BIT(11) -+#define BIT_FS_HCI_RES_INT_8812F BIT(10) -+#define BIT_FS_HCI_RESET_INT_8812F BIT(9) -+#define BIT_USB_SCSI_CMD_INT_8812F BIT(8) -+#define BIT_ACT2RECOVERY_8812F BIT(6) -+#define BIT_GEN1GEN2_SWITCH_8812F BIT(5) -+#define BIT_HCI_TXDMA_REQ_HISR_8812F BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_INT_8812F BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_INT_8812F BIT(2) -+#define BIT_FS_USB_LPMRSM_INT_8812F BIT(1) -+#define BIT_FS_USB_LPMINT_INT_8812F BIT(0) -+ -+/* 2 REG_HSIMR_8812F */ -+#define BIT_GPIOF_INT_EN_8812F BIT(31) -+#define BIT_GPIOE_INT_EN_8812F BIT(30) -+#define BIT_GPIOD_INT_EN_8812F BIT(29) -+#define BIT_GPIOC_INT_EN_8812F BIT(28) -+#define BIT_GPIOB_INT_EN_8812F BIT(27) -+#define BIT_GPIOA_INT_EN_8812F BIT(26) -+#define BIT_GPIO9_INT_EN_8812F BIT(25) -+#define BIT_GPIO8_INT_EN_8812F BIT(24) -+#define BIT_GPIO7_INT_EN_8812F BIT(23) -+#define BIT_GPIO6_INT_EN_8812F BIT(22) -+#define BIT_GPIO5_INT_EN_8812F BIT(21) -+#define BIT_GPIO4_INT_EN_8812F BIT(20) -+#define BIT_GPIO3_INT_EN_8812F BIT(19) -+#define BIT_GPIO2_INT_EN_V1_8812F BIT(18) -+#define BIT_GPIO1_INT_EN_8812F BIT(17) -+#define BIT_GPIO0_INT_EN_8812F BIT(16) -+#define BIT_PDNINT_EN_8812F BIT(7) -+#define BIT_RON_INT_EN_8812F BIT(6) -+#define BIT_SPS_OCP_INT_EN_8812F BIT(5) -+#define BIT_GPIO15_0_INT_EN_8812F BIT(0) -+ -+/* 2 REG_HSISR_8812F */ -+#define BIT_GPIOF_INT_8812F BIT(31) -+#define BIT_GPIOE_INT_8812F BIT(30) -+#define BIT_GPIOD_INT_8812F BIT(29) -+#define BIT_GPIOC_INT_8812F BIT(28) -+#define BIT_GPIOB_INT_8812F BIT(27) -+#define BIT_GPIOA_INT_8812F BIT(26) -+#define BIT_GPIO9_INT_8812F BIT(25) -+#define BIT_GPIO8_INT_8812F BIT(24) -+#define BIT_GPIO7_INT_8812F BIT(23) -+#define BIT_GPIO6_INT_8812F BIT(22) -+#define BIT_GPIO5_INT_8812F BIT(21) -+#define BIT_GPIO4_INT_8812F BIT(20) -+#define BIT_GPIO3_INT_8812F BIT(19) -+#define BIT_GPIO2_INT_V1_8812F BIT(18) -+#define BIT_GPIO1_INT_8812F BIT(17) -+#define BIT_GPIO0_INT_8812F BIT(16) -+#define BIT_PDNINT_8812F BIT(7) -+#define BIT_RON_INT_8812F BIT(6) -+#define BIT_SPS_OCP_INT_8812F BIT(5) -+#define BIT_GPIO15_0_INT_8812F BIT(0) -+ -+/* 2 REG_GPIO_EXT_CTRL_8812F */ -+ -+#define BIT_SHIFT_GPIO_MOD_15_TO_8_8812F 24 -+#define BIT_MASK_GPIO_MOD_15_TO_8_8812F 0xff -+#define BIT_GPIO_MOD_15_TO_8_8812F(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_15_TO_8_8812F) \ -+ << BIT_SHIFT_GPIO_MOD_15_TO_8_8812F) -+#define BITS_GPIO_MOD_15_TO_8_8812F \ -+ (BIT_MASK_GPIO_MOD_15_TO_8_8812F << BIT_SHIFT_GPIO_MOD_15_TO_8_8812F) -+#define BIT_CLEAR_GPIO_MOD_15_TO_8_8812F(x) \ -+ ((x) & (~BITS_GPIO_MOD_15_TO_8_8812F)) -+#define BIT_GET_GPIO_MOD_15_TO_8_8812F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_15_TO_8_8812F) & \ -+ BIT_MASK_GPIO_MOD_15_TO_8_8812F) -+#define BIT_SET_GPIO_MOD_15_TO_8_8812F(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_15_TO_8_8812F(x) | BIT_GPIO_MOD_15_TO_8_8812F(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8812F 16 -+#define BIT_MASK_GPIO_IO_SEL_15_TO_8_8812F 0xff -+#define BIT_GPIO_IO_SEL_15_TO_8_8812F(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_15_TO_8_8812F) \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8812F) -+#define BITS_GPIO_IO_SEL_15_TO_8_8812F \ -+ (BIT_MASK_GPIO_IO_SEL_15_TO_8_8812F \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8812F) -+#define BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8812F(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_15_TO_8_8812F)) -+#define BIT_GET_GPIO_IO_SEL_15_TO_8_8812F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8812F) & \ -+ BIT_MASK_GPIO_IO_SEL_15_TO_8_8812F) -+#define BIT_SET_GPIO_IO_SEL_15_TO_8_8812F(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8812F(x) | \ -+ BIT_GPIO_IO_SEL_15_TO_8_8812F(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_15_TO_8_8812F 8 -+#define BIT_MASK_GPIO_OUT_15_TO_8_8812F 0xff -+#define BIT_GPIO_OUT_15_TO_8_8812F(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_15_TO_8_8812F) \ -+ << BIT_SHIFT_GPIO_OUT_15_TO_8_8812F) -+#define BITS_GPIO_OUT_15_TO_8_8812F \ -+ (BIT_MASK_GPIO_OUT_15_TO_8_8812F << BIT_SHIFT_GPIO_OUT_15_TO_8_8812F) -+#define BIT_CLEAR_GPIO_OUT_15_TO_8_8812F(x) \ -+ ((x) & (~BITS_GPIO_OUT_15_TO_8_8812F)) -+#define BIT_GET_GPIO_OUT_15_TO_8_8812F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_15_TO_8_8812F) & \ -+ BIT_MASK_GPIO_OUT_15_TO_8_8812F) -+#define BIT_SET_GPIO_OUT_15_TO_8_8812F(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_15_TO_8_8812F(x) | BIT_GPIO_OUT_15_TO_8_8812F(v)) -+ -+#define BIT_SHIFT_GPIO_IN_15_TO_8_8812F 0 -+#define BIT_MASK_GPIO_IN_15_TO_8_8812F 0xff -+#define BIT_GPIO_IN_15_TO_8_8812F(x) \ -+ (((x) & BIT_MASK_GPIO_IN_15_TO_8_8812F) \ -+ << BIT_SHIFT_GPIO_IN_15_TO_8_8812F) -+#define BITS_GPIO_IN_15_TO_8_8812F \ -+ (BIT_MASK_GPIO_IN_15_TO_8_8812F << BIT_SHIFT_GPIO_IN_15_TO_8_8812F) -+#define BIT_CLEAR_GPIO_IN_15_TO_8_8812F(x) ((x) & (~BITS_GPIO_IN_15_TO_8_8812F)) -+#define BIT_GET_GPIO_IN_15_TO_8_8812F(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_15_TO_8_8812F) & \ -+ BIT_MASK_GPIO_IN_15_TO_8_8812F) -+#define BIT_SET_GPIO_IN_15_TO_8_8812F(x, v) \ -+ (BIT_CLEAR_GPIO_IN_15_TO_8_8812F(x) | BIT_GPIO_IN_15_TO_8_8812F(v)) -+ -+/* 2 REG_PAD_CTRL1_8812F */ -+#define BIT_PAPE_WLBT_SEL_8812F BIT(29) -+#define BIT_LNAON_WLBT_SEL_8812F BIT(28) -+#define BIT_BT_BQB_GPIO_SEL_8812F BIT(27) -+#define BIT_BTGP_GPG3_FEN_8812F BIT(26) -+#define BIT_BTGP_GPG2_FEN_8812F BIT(25) -+#define BIT_BTGP_JTAG_EN_8812F BIT(24) -+#define BIT_XTAL_CLK_EXTARNAL_EN_8812F BIT(23) -+#define BIT_BTGP_UART0_EN_8812F BIT(22) -+#define BIT_BTGP_UART1_EN_8812F BIT(21) -+#define BIT_BTGP_SPI_EN_8812F BIT(20) -+#define BIT_BTGP_GPIO_E2_8812F BIT(19) -+#define BIT_BTGP_GPIO_EN_8812F BIT(18) -+ -+#define BIT_SHIFT_BTGP_GPIO_SL_8812F 16 -+#define BIT_MASK_BTGP_GPIO_SL_8812F 0x3 -+#define BIT_BTGP_GPIO_SL_8812F(x) \ -+ (((x) & BIT_MASK_BTGP_GPIO_SL_8812F) << BIT_SHIFT_BTGP_GPIO_SL_8812F) -+#define BITS_BTGP_GPIO_SL_8812F \ -+ (BIT_MASK_BTGP_GPIO_SL_8812F << BIT_SHIFT_BTGP_GPIO_SL_8812F) -+#define BIT_CLEAR_BTGP_GPIO_SL_8812F(x) ((x) & (~BITS_BTGP_GPIO_SL_8812F)) -+#define BIT_GET_BTGP_GPIO_SL_8812F(x) \ -+ (((x) >> BIT_SHIFT_BTGP_GPIO_SL_8812F) & BIT_MASK_BTGP_GPIO_SL_8812F) -+#define BIT_SET_BTGP_GPIO_SL_8812F(x, v) \ -+ (BIT_CLEAR_BTGP_GPIO_SL_8812F(x) | BIT_BTGP_GPIO_SL_8812F(v)) -+ -+#define BIT_PAD_SDIO_SR_8812F BIT(14) -+#define BIT_GPIO14_OUTPUT_PL_8812F BIT(13) -+#define BIT_HOST_WAKE_PAD_PULL_EN_8812F BIT(12) -+#define BIT_HOST_WAKE_PAD_SL_8812F BIT(11) -+#define BIT_PAD_LNAON_SR_8812F BIT(10) -+#define BIT_PAD_LNAON_E2_8812F BIT(9) -+#define BIT_SW_LNAON_G_SEL_DATA_8812F BIT(8) -+#define BIT_SW_LNAON_A_SEL_DATA_8812F BIT(7) -+#define BIT_PAD_PAPE_SR_8812F BIT(6) -+#define BIT_PAD_PAPE_E2_8812F BIT(5) -+#define BIT_SW_PAPE_G_SEL_DATA_8812F BIT(4) -+#define BIT_SW_PAPE_A_SEL_DATA_8812F BIT(3) -+#define BIT_PAD_DPDT_SR_8812F BIT(2) -+#define BIT_PAD_DPDT_PAD_E2_8812F BIT(1) -+#define BIT_SW_DPDT_SEL_DATA_8812F BIT(0) -+ -+/* 2 REG_WL_BT_PWR_CTRL_8812F */ -+#define BIT_ISO_BD2PP_8812F BIT(31) -+#define BIT_LDOV12B_EN_8812F BIT(30) -+#define BIT_CKEN_BTGPS_8812F BIT(29) -+#define BIT_FEN_BTGPS_8812F BIT(28) -+#define BIT_BTCPU_BOOTSEL_8812F BIT(27) -+#define BIT_SPI_SPEEDUP_8812F BIT(26) -+#define BIT_BT_LDO_MODE_8812F BIT(25) -+#define BIT_DEVWAKE_PAD_TYPE_SEL_8812F BIT(24) -+#define BIT_CLKREQ_PAD_TYPE_SEL_8812F BIT(23) -+#define BIT_ISO_BTPON2PP_8812F BIT(22) -+#define BIT_BT_HWROF_EN_8812F BIT(19) -+#define BIT_BT_FUNC_EN_8812F BIT(18) -+#define BIT_BT_HWPDN_SL_8812F BIT(17) -+#define BIT_BT_DISN_EN_8812F BIT(16) -+#define BIT_BT_PDN_PULL_EN_8812F BIT(15) -+#define BIT_WL_PDN_PULL_EN_8812F BIT(14) -+#define BIT_EXTERNAL_REQUEST_PL_8812F BIT(13) -+#define BIT_GPIO0_2_3_PULL_LOW_EN_8812F BIT(12) -+#define BIT_ISO_BA2PP_8812F BIT(11) -+#define BIT_BT_AFE_LDO_EN_8812F BIT(10) -+#define BIT_BT_AFE_PLL_EN_8812F BIT(9) -+#define BIT_BT_DIG_CLK_EN_8812F BIT(8) -+#define BIT_WLAN_32K_SEL_8812F BIT(6) -+#define BIT_WL_DRV_EXIST_IDX_8812F BIT(5) -+#define BIT_DOP_EHPAD_8812F BIT(4) -+#define BIT_WL_HWROF_EN_8812F BIT(3) -+#define BIT_WL_FUNC_EN_8812F BIT(2) -+#define BIT_WL_HWPDN_SL_8812F BIT(1) -+#define BIT_WL_HWPDN_EN_8812F BIT(0) -+ -+/* 2 REG_SDM_DEBUG_8812F */ -+#define BIT_GPIO_IE_V18_8812F BIT(10) -+#define BIT_PCIE_IE_V18_8812F BIT(9) -+#define BIT_UART_IE_V18_8812F BIT(8) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_WLCLK_PHASE_8812F 0 -+#define BIT_MASK_WLCLK_PHASE_8812F 0x1f -+#define BIT_WLCLK_PHASE_8812F(x) \ -+ (((x) & BIT_MASK_WLCLK_PHASE_8812F) << BIT_SHIFT_WLCLK_PHASE_8812F) -+#define BITS_WLCLK_PHASE_8812F \ -+ (BIT_MASK_WLCLK_PHASE_8812F << BIT_SHIFT_WLCLK_PHASE_8812F) -+#define BIT_CLEAR_WLCLK_PHASE_8812F(x) ((x) & (~BITS_WLCLK_PHASE_8812F)) -+#define BIT_GET_WLCLK_PHASE_8812F(x) \ -+ (((x) >> BIT_SHIFT_WLCLK_PHASE_8812F) & BIT_MASK_WLCLK_PHASE_8812F) -+#define BIT_SET_WLCLK_PHASE_8812F(x, v) \ -+ (BIT_CLEAR_WLCLK_PHASE_8812F(x) | BIT_WLCLK_PHASE_8812F(v)) -+ -+/* 2 REG_SYS_SDIO_CTRL_8812F */ -+#define BIT_DBG_GNT_WL_BT_8812F BIT(27) -+#define BIT_LTE_MUX_CTRL_PATH_8812F BIT(26) -+#define BIT_LTE_COEX_UART_8812F BIT(25) -+#define BIT_3W_LTE_WL_GPIO_8812F BIT(24) -+#define BIT_SDIO_INT_POLARITY_8812F BIT(19) -+#define BIT_SDIO_INT_8812F BIT(18) -+#define BIT_SDIO_OFF_EN_8812F BIT(17) -+#define BIT_SDIO_ON_EN_8812F BIT(16) -+#define BIT_PCIE_FORCE_PWR_NGAT_8812F BIT(13) -+#define BIT_PCIE_CALIB_EN_V1_8812F BIT(12) -+#define BIT_PAGE3_AUXCLK_GATE_8812F BIT(11) -+#define BIT_PCIE_WAIT_TIMEOUT_EVENT_8812F BIT(10) -+#define BIT_PCIE_WAIT_TIME_8812F BIT(9) -+#define BIT_MPCIE_REFCLK_XTAL_SEL_8812F BIT(8) -+#define BIT_BT_CTRL_USB_PWR_BACKDOOR_8812F BIT(5) -+#define BIT_USB_D_STATE_HOLD_8812F BIT(4) -+#define BIT_REG_FORCE_DP_8812F BIT(3) -+#define BIT_REG_DP_MODE_8812F BIT(2) -+#define BIT_RES_USB_MASS_STORAGE_DESC_8812F BIT(1) -+#define BIT_USB_WAIT_TIME_8812F BIT(0) -+ -+/* 2 REG_HCI_OPT_CTRL_8812F */ -+ -+#define BIT_SHIFT_TSFT_SEL_8812F 29 -+#define BIT_MASK_TSFT_SEL_8812F 0x7 -+#define BIT_TSFT_SEL_8812F(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_8812F) << BIT_SHIFT_TSFT_SEL_8812F) -+#define BITS_TSFT_SEL_8812F \ -+ (BIT_MASK_TSFT_SEL_8812F << BIT_SHIFT_TSFT_SEL_8812F) -+#define BIT_CLEAR_TSFT_SEL_8812F(x) ((x) & (~BITS_TSFT_SEL_8812F)) -+#define BIT_GET_TSFT_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_8812F) & BIT_MASK_TSFT_SEL_8812F) -+#define BIT_SET_TSFT_SEL_8812F(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_8812F(x) | BIT_TSFT_SEL_8812F(v)) -+ -+#define BIT_SDIO_PAD_E5_8812F BIT(18) -+#define BIT_USB_HOST_PWR_OFF_EN_8812F BIT(12) -+#define BIT_SYM_LPS_BLOCK_EN_8812F BIT(11) -+#define BIT_USB_LPM_ACT_EN_8812F BIT(10) -+#define BIT_USB_LPM_NY_8812F BIT(9) -+#define BIT_USB_SUS_DIS_8812F BIT(8) -+ -+#define BIT_SHIFT_SDIO_PAD_E_8812F 5 -+#define BIT_MASK_SDIO_PAD_E_8812F 0x7 -+#define BIT_SDIO_PAD_E_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_PAD_E_8812F) << BIT_SHIFT_SDIO_PAD_E_8812F) -+#define BITS_SDIO_PAD_E_8812F \ -+ (BIT_MASK_SDIO_PAD_E_8812F << BIT_SHIFT_SDIO_PAD_E_8812F) -+#define BIT_CLEAR_SDIO_PAD_E_8812F(x) ((x) & (~BITS_SDIO_PAD_E_8812F)) -+#define BIT_GET_SDIO_PAD_E_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_PAD_E_8812F) & BIT_MASK_SDIO_PAD_E_8812F) -+#define BIT_SET_SDIO_PAD_E_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_PAD_E_8812F(x) | BIT_SDIO_PAD_E_8812F(v)) -+ -+#define BIT_USB_LPPLL_EN_8812F BIT(4) -+#define BIT_USB1_1_USB2_0_DECISION_8812F BIT(3) -+#define BIT_ROP_SW15_8812F BIT(2) -+#define BIT_PCI_CKRDY_OPT_8812F BIT(1) -+#define BIT_PCI_VAUX_EN_8812F BIT(0) -+ -+/* 2 REG_HCI_BG_CTRL_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_IBX_EN_VALUE_8812F BIT(9) -+#define BIT_IB_EN_VALUE_8812F BIT(8) -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_FORCED_IB_EN_8812F BIT(4) -+#define BIT_EN_REGBG_8812F BIT(3) -+#define BIT_REG_BG_LPF_8812F BIT(2) -+ -+#define BIT_SHIFT_REG_BG_8812F 0 -+#define BIT_MASK_REG_BG_8812F 0x3 -+#define BIT_REG_BG_8812F(x) \ -+ (((x) & BIT_MASK_REG_BG_8812F) << BIT_SHIFT_REG_BG_8812F) -+#define BITS_REG_BG_8812F (BIT_MASK_REG_BG_8812F << BIT_SHIFT_REG_BG_8812F) -+#define BIT_CLEAR_REG_BG_8812F(x) ((x) & (~BITS_REG_BG_8812F)) -+#define BIT_GET_REG_BG_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_BG_8812F) & BIT_MASK_REG_BG_8812F) -+#define BIT_SET_REG_BG_8812F(x, v) \ -+ (BIT_CLEAR_REG_BG_8812F(x) | BIT_REG_BG_8812F(v)) -+ -+/* 2 REG_HCI_LDO_CTRL_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_EN_LW_PWR_8812F BIT(6) -+#define BIT_EN_REGU_8812F BIT(5) -+#define BIT_EN_PC_8812F BIT(4) -+ -+#define BIT_SHIFT_REG_VADJ_8812F 0 -+#define BIT_MASK_REG_VADJ_8812F 0xf -+#define BIT_REG_VADJ_8812F(x) \ -+ (((x) & BIT_MASK_REG_VADJ_8812F) << BIT_SHIFT_REG_VADJ_8812F) -+#define BITS_REG_VADJ_8812F \ -+ (BIT_MASK_REG_VADJ_8812F << BIT_SHIFT_REG_VADJ_8812F) -+#define BIT_CLEAR_REG_VADJ_8812F(x) ((x) & (~BITS_REG_VADJ_8812F)) -+#define BIT_GET_REG_VADJ_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_VADJ_8812F) & BIT_MASK_REG_VADJ_8812F) -+#define BIT_SET_REG_VADJ_8812F(x, v) \ -+ (BIT_CLEAR_REG_VADJ_8812F(x) | BIT_REG_VADJ_8812F(v)) -+ -+/* 2 REG_LDO_SWR_CTRL_8812F */ -+#define BIT_EXT_SWR_CTRL_EN_8812F BIT(31) -+#define BIT_ZCD_HW_AUTO_EN_8812F BIT(27) -+#define BIT_ZCD_REGSEL_8812F BIT(26) -+ -+#define BIT_SHIFT_AUTO_ZCD_IN_CODE_8812F 21 -+#define BIT_MASK_AUTO_ZCD_IN_CODE_8812F 0x1f -+#define BIT_AUTO_ZCD_IN_CODE_8812F(x) \ -+ (((x) & BIT_MASK_AUTO_ZCD_IN_CODE_8812F) \ -+ << BIT_SHIFT_AUTO_ZCD_IN_CODE_8812F) -+#define BITS_AUTO_ZCD_IN_CODE_8812F \ -+ (BIT_MASK_AUTO_ZCD_IN_CODE_8812F << BIT_SHIFT_AUTO_ZCD_IN_CODE_8812F) -+#define BIT_CLEAR_AUTO_ZCD_IN_CODE_8812F(x) \ -+ ((x) & (~BITS_AUTO_ZCD_IN_CODE_8812F)) -+#define BIT_GET_AUTO_ZCD_IN_CODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_AUTO_ZCD_IN_CODE_8812F) & \ -+ BIT_MASK_AUTO_ZCD_IN_CODE_8812F) -+#define BIT_SET_AUTO_ZCD_IN_CODE_8812F(x, v) \ -+ (BIT_CLEAR_AUTO_ZCD_IN_CODE_8812F(x) | BIT_AUTO_ZCD_IN_CODE_8812F(v)) -+ -+#define BIT_SHIFT_ZCD_CODE_IN_L_8812F 16 -+#define BIT_MASK_ZCD_CODE_IN_L_8812F 0x1f -+#define BIT_ZCD_CODE_IN_L_8812F(x) \ -+ (((x) & BIT_MASK_ZCD_CODE_IN_L_8812F) << BIT_SHIFT_ZCD_CODE_IN_L_8812F) -+#define BITS_ZCD_CODE_IN_L_8812F \ -+ (BIT_MASK_ZCD_CODE_IN_L_8812F << BIT_SHIFT_ZCD_CODE_IN_L_8812F) -+#define BIT_CLEAR_ZCD_CODE_IN_L_8812F(x) ((x) & (~BITS_ZCD_CODE_IN_L_8812F)) -+#define BIT_GET_ZCD_CODE_IN_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_ZCD_CODE_IN_L_8812F) & BIT_MASK_ZCD_CODE_IN_L_8812F) -+#define BIT_SET_ZCD_CODE_IN_L_8812F(x, v) \ -+ (BIT_CLEAR_ZCD_CODE_IN_L_8812F(x) | BIT_ZCD_CODE_IN_L_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_MCUFW_CTRL_8812F */ -+ -+#define BIT_SHIFT_RPWM_8812F 24 -+#define BIT_MASK_RPWM_8812F 0xff -+#define BIT_RPWM_8812F(x) (((x) & BIT_MASK_RPWM_8812F) << BIT_SHIFT_RPWM_8812F) -+#define BITS_RPWM_8812F (BIT_MASK_RPWM_8812F << BIT_SHIFT_RPWM_8812F) -+#define BIT_CLEAR_RPWM_8812F(x) ((x) & (~BITS_RPWM_8812F)) -+#define BIT_GET_RPWM_8812F(x) \ -+ (((x) >> BIT_SHIFT_RPWM_8812F) & BIT_MASK_RPWM_8812F) -+#define BIT_SET_RPWM_8812F(x, v) (BIT_CLEAR_RPWM_8812F(x) | BIT_RPWM_8812F(v)) -+ -+#define BIT_ANA_PORT_EN_8812F BIT(22) -+#define BIT_MAC_PORT_EN_8812F BIT(21) -+#define BIT_BOOT_FSPI_EN_8812F BIT(20) -+#define BIT_ROM_DLEN_8812F BIT(19) -+ -+#define BIT_SHIFT_ROM_PGE_8812F 16 -+#define BIT_MASK_ROM_PGE_8812F 0x7 -+#define BIT_ROM_PGE_8812F(x) \ -+ (((x) & BIT_MASK_ROM_PGE_8812F) << BIT_SHIFT_ROM_PGE_8812F) -+#define BITS_ROM_PGE_8812F (BIT_MASK_ROM_PGE_8812F << BIT_SHIFT_ROM_PGE_8812F) -+#define BIT_CLEAR_ROM_PGE_8812F(x) ((x) & (~BITS_ROM_PGE_8812F)) -+#define BIT_GET_ROM_PGE_8812F(x) \ -+ (((x) >> BIT_SHIFT_ROM_PGE_8812F) & BIT_MASK_ROM_PGE_8812F) -+#define BIT_SET_ROM_PGE_8812F(x, v) \ -+ (BIT_CLEAR_ROM_PGE_8812F(x) | BIT_ROM_PGE_8812F(v)) -+ -+#define BIT_FW_INIT_RDY_8812F BIT(15) -+#define BIT_FW_DW_RDY_8812F BIT(14) -+ -+#define BIT_SHIFT_CPU_CLK_SEL_8812F 12 -+#define BIT_MASK_CPU_CLK_SEL_8812F 0x3 -+#define BIT_CPU_CLK_SEL_8812F(x) \ -+ (((x) & BIT_MASK_CPU_CLK_SEL_8812F) << BIT_SHIFT_CPU_CLK_SEL_8812F) -+#define BITS_CPU_CLK_SEL_8812F \ -+ (BIT_MASK_CPU_CLK_SEL_8812F << BIT_SHIFT_CPU_CLK_SEL_8812F) -+#define BIT_CLEAR_CPU_CLK_SEL_8812F(x) ((x) & (~BITS_CPU_CLK_SEL_8812F)) -+#define BIT_GET_CPU_CLK_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_CPU_CLK_SEL_8812F) & BIT_MASK_CPU_CLK_SEL_8812F) -+#define BIT_SET_CPU_CLK_SEL_8812F(x, v) \ -+ (BIT_CLEAR_CPU_CLK_SEL_8812F(x) | BIT_CPU_CLK_SEL_8812F(v)) -+ -+#define BIT_CCLK_CHG_MASK_8812F BIT(11) -+#define BIT_EMEM__TXBUF_CHKSUM_OK_8812F BIT(10) -+#define BIT_EMEM_TXBUF_DW_RDY_8812F BIT(9) -+#define BIT_EMEM_CHKSUM_OK_8812F BIT(8) -+#define BIT_EMEM_DW_OK_8812F BIT(7) -+#define BIT_DMEM_CHKSUM_OK_8812F BIT(6) -+#define BIT_DMEM_DW_OK_8812F BIT(5) -+#define BIT_IMEM_CHKSUM_OK_8812F BIT(4) -+#define BIT_IMEM_DW_OK_8812F BIT(3) -+#define BIT_IMEM_BOOT_LOAD_CHKSUM_OK_8812F BIT(2) -+#define BIT_IMEM_BOOT_LOAD_DW_OK_8812F BIT(1) -+#define BIT_MCUFWDL_EN_8812F BIT(0) -+ -+/* 2 REG_MCU_TST_CFG_8812F */ -+ -+#define BIT_SHIFT_LBKTST_8812F 0 -+#define BIT_MASK_LBKTST_8812F 0xffff -+#define BIT_LBKTST_8812F(x) \ -+ (((x) & BIT_MASK_LBKTST_8812F) << BIT_SHIFT_LBKTST_8812F) -+#define BITS_LBKTST_8812F (BIT_MASK_LBKTST_8812F << BIT_SHIFT_LBKTST_8812F) -+#define BIT_CLEAR_LBKTST_8812F(x) ((x) & (~BITS_LBKTST_8812F)) -+#define BIT_GET_LBKTST_8812F(x) \ -+ (((x) >> BIT_SHIFT_LBKTST_8812F) & BIT_MASK_LBKTST_8812F) -+#define BIT_SET_LBKTST_8812F(x, v) \ -+ (BIT_CLEAR_LBKTST_8812F(x) | BIT_LBKTST_8812F(v)) -+ -+/* 2 REG_HMEBOX_E0_E1_8812F */ -+ -+#define BIT_SHIFT_HOST_MSG_E1_8812F 16 -+#define BIT_MASK_HOST_MSG_E1_8812F 0xffff -+#define BIT_HOST_MSG_E1_8812F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E1_8812F) << BIT_SHIFT_HOST_MSG_E1_8812F) -+#define BITS_HOST_MSG_E1_8812F \ -+ (BIT_MASK_HOST_MSG_E1_8812F << BIT_SHIFT_HOST_MSG_E1_8812F) -+#define BIT_CLEAR_HOST_MSG_E1_8812F(x) ((x) & (~BITS_HOST_MSG_E1_8812F)) -+#define BIT_GET_HOST_MSG_E1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E1_8812F) & BIT_MASK_HOST_MSG_E1_8812F) -+#define BIT_SET_HOST_MSG_E1_8812F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E1_8812F(x) | BIT_HOST_MSG_E1_8812F(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E0_8812F 0 -+#define BIT_MASK_HOST_MSG_E0_8812F 0xffff -+#define BIT_HOST_MSG_E0_8812F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E0_8812F) << BIT_SHIFT_HOST_MSG_E0_8812F) -+#define BITS_HOST_MSG_E0_8812F \ -+ (BIT_MASK_HOST_MSG_E0_8812F << BIT_SHIFT_HOST_MSG_E0_8812F) -+#define BIT_CLEAR_HOST_MSG_E0_8812F(x) ((x) & (~BITS_HOST_MSG_E0_8812F)) -+#define BIT_GET_HOST_MSG_E0_8812F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E0_8812F) & BIT_MASK_HOST_MSG_E0_8812F) -+#define BIT_SET_HOST_MSG_E0_8812F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E0_8812F(x) | BIT_HOST_MSG_E0_8812F(v)) -+ -+/* 2 REG_HMEBOX_E2_E3_8812F */ -+ -+#define BIT_SHIFT_HOST_MSG_E3_8812F 16 -+#define BIT_MASK_HOST_MSG_E3_8812F 0xffff -+#define BIT_HOST_MSG_E3_8812F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E3_8812F) << BIT_SHIFT_HOST_MSG_E3_8812F) -+#define BITS_HOST_MSG_E3_8812F \ -+ (BIT_MASK_HOST_MSG_E3_8812F << BIT_SHIFT_HOST_MSG_E3_8812F) -+#define BIT_CLEAR_HOST_MSG_E3_8812F(x) ((x) & (~BITS_HOST_MSG_E3_8812F)) -+#define BIT_GET_HOST_MSG_E3_8812F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E3_8812F) & BIT_MASK_HOST_MSG_E3_8812F) -+#define BIT_SET_HOST_MSG_E3_8812F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E3_8812F(x) | BIT_HOST_MSG_E3_8812F(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E2_8812F 0 -+#define BIT_MASK_HOST_MSG_E2_8812F 0xffff -+#define BIT_HOST_MSG_E2_8812F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E2_8812F) << BIT_SHIFT_HOST_MSG_E2_8812F) -+#define BITS_HOST_MSG_E2_8812F \ -+ (BIT_MASK_HOST_MSG_E2_8812F << BIT_SHIFT_HOST_MSG_E2_8812F) -+#define BIT_CLEAR_HOST_MSG_E2_8812F(x) ((x) & (~BITS_HOST_MSG_E2_8812F)) -+#define BIT_GET_HOST_MSG_E2_8812F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E2_8812F) & BIT_MASK_HOST_MSG_E2_8812F) -+#define BIT_SET_HOST_MSG_E2_8812F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E2_8812F(x) | BIT_HOST_MSG_E2_8812F(v)) -+ -+/* 2 REG_WLLPS_CTRL_8812F */ -+#define BIT_WLLPSOP_EABM_8812F BIT(31) -+#define BIT_WLLPSOP_ACKF_8812F BIT(30) -+#define BIT_WLLPSOP_DLDM_8812F BIT(29) -+#define BIT_WLLPSOP_ESWR_8812F BIT(28) -+#define BIT_WLLPSOP_PWMM_8812F BIT(27) -+#define BIT_WLLPSOP_EECK_8812F BIT(26) -+#define BIT_WLLPSOP_WLMACOFF_8812F BIT(25) -+#define BIT_WLLPSOP_EXTAL_8812F BIT(24) -+#define BIT_WL_SYNPON_VOLTSPDN_8812F BIT(23) -+#define BIT_WLLPSOP_WLBBOFF_8812F BIT(22) -+#define BIT_WLLPSOP_WLMEM_DS_8812F BIT(21) -+#define BIT_WLLPSOP_LDO_WAIT_TIME_8812F BIT(20) -+#define BIT_WLLPSOP_ANA_CLK_DIVISION_2_8812F BIT(19) -+#define BIT_AFE_BCN_8812F BIT(18) -+ -+#define BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8812F 12 -+#define BIT_MASK_LPLDH12_VADJ_STEP_DN_8812F 0xf -+#define BIT_LPLDH12_VADJ_STEP_DN_8812F(x) \ -+ (((x) & BIT_MASK_LPLDH12_VADJ_STEP_DN_8812F) \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8812F) -+#define BITS_LPLDH12_VADJ_STEP_DN_8812F \ -+ (BIT_MASK_LPLDH12_VADJ_STEP_DN_8812F \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8812F) -+#define BIT_CLEAR_LPLDH12_VADJ_STEP_DN_8812F(x) \ -+ ((x) & (~BITS_LPLDH12_VADJ_STEP_DN_8812F)) -+#define BIT_GET_LPLDH12_VADJ_STEP_DN_8812F(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8812F) & \ -+ BIT_MASK_LPLDH12_VADJ_STEP_DN_8812F) -+#define BIT_SET_LPLDH12_VADJ_STEP_DN_8812F(x, v) \ -+ (BIT_CLEAR_LPLDH12_VADJ_STEP_DN_8812F(x) | \ -+ BIT_LPLDH12_VADJ_STEP_DN_8812F(v)) -+ -+#define BIT_SHIFT_V15ADJ_L1_STEP_DN_V1_8812F 8 -+#define BIT_MASK_V15ADJ_L1_STEP_DN_V1_8812F 0xf -+#define BIT_V15ADJ_L1_STEP_DN_V1_8812F(x) \ -+ (((x) & BIT_MASK_V15ADJ_L1_STEP_DN_V1_8812F) \ -+ << BIT_SHIFT_V15ADJ_L1_STEP_DN_V1_8812F) -+#define BITS_V15ADJ_L1_STEP_DN_V1_8812F \ -+ (BIT_MASK_V15ADJ_L1_STEP_DN_V1_8812F \ -+ << BIT_SHIFT_V15ADJ_L1_STEP_DN_V1_8812F) -+#define BIT_CLEAR_V15ADJ_L1_STEP_DN_V1_8812F(x) \ -+ ((x) & (~BITS_V15ADJ_L1_STEP_DN_V1_8812F)) -+#define BIT_GET_V15ADJ_L1_STEP_DN_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L1_STEP_DN_V1_8812F) & \ -+ BIT_MASK_V15ADJ_L1_STEP_DN_V1_8812F) -+#define BIT_SET_V15ADJ_L1_STEP_DN_V1_8812F(x, v) \ -+ (BIT_CLEAR_V15ADJ_L1_STEP_DN_V1_8812F(x) | \ -+ BIT_V15ADJ_L1_STEP_DN_V1_8812F(v)) -+ -+#define BIT_FORCE_LEAVE_LPS_8812F BIT(3) -+#define BIT_SW_AFE_MODE_8812F BIT(2) -+#define BIT_REGU_32K_CLK_EN_8812F BIT(1) -+#define BIT_WL_LPS_EN_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_GPIO_DEBOUNCE_CTRL_8812F */ -+#define BIT_WLGP_DBC1EN_8812F BIT(15) -+ -+#define BIT_SHIFT_WLGP_DBC1_8812F 8 -+#define BIT_MASK_WLGP_DBC1_8812F 0xf -+#define BIT_WLGP_DBC1_8812F(x) \ -+ (((x) & BIT_MASK_WLGP_DBC1_8812F) << BIT_SHIFT_WLGP_DBC1_8812F) -+#define BITS_WLGP_DBC1_8812F \ -+ (BIT_MASK_WLGP_DBC1_8812F << BIT_SHIFT_WLGP_DBC1_8812F) -+#define BIT_CLEAR_WLGP_DBC1_8812F(x) ((x) & (~BITS_WLGP_DBC1_8812F)) -+#define BIT_GET_WLGP_DBC1_8812F(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC1_8812F) & BIT_MASK_WLGP_DBC1_8812F) -+#define BIT_SET_WLGP_DBC1_8812F(x, v) \ -+ (BIT_CLEAR_WLGP_DBC1_8812F(x) | BIT_WLGP_DBC1_8812F(v)) -+ -+#define BIT_WLGP_DBC0EN_8812F BIT(7) -+ -+#define BIT_SHIFT_WLGP_DBC0_8812F 0 -+#define BIT_MASK_WLGP_DBC0_8812F 0xf -+#define BIT_WLGP_DBC0_8812F(x) \ -+ (((x) & BIT_MASK_WLGP_DBC0_8812F) << BIT_SHIFT_WLGP_DBC0_8812F) -+#define BITS_WLGP_DBC0_8812F \ -+ (BIT_MASK_WLGP_DBC0_8812F << BIT_SHIFT_WLGP_DBC0_8812F) -+#define BIT_CLEAR_WLGP_DBC0_8812F(x) ((x) & (~BITS_WLGP_DBC0_8812F)) -+#define BIT_GET_WLGP_DBC0_8812F(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC0_8812F) & BIT_MASK_WLGP_DBC0_8812F) -+#define BIT_SET_WLGP_DBC0_8812F(x, v) \ -+ (BIT_CLEAR_WLGP_DBC0_8812F(x) | BIT_WLGP_DBC0_8812F(v)) -+ -+/* 2 REG_RPWM2_8812F */ -+ -+#define BIT_SHIFT_RPWM2_8812F 16 -+#define BIT_MASK_RPWM2_8812F 0xffff -+#define BIT_RPWM2_8812F(x) \ -+ (((x) & BIT_MASK_RPWM2_8812F) << BIT_SHIFT_RPWM2_8812F) -+#define BITS_RPWM2_8812F (BIT_MASK_RPWM2_8812F << BIT_SHIFT_RPWM2_8812F) -+#define BIT_CLEAR_RPWM2_8812F(x) ((x) & (~BITS_RPWM2_8812F)) -+#define BIT_GET_RPWM2_8812F(x) \ -+ (((x) >> BIT_SHIFT_RPWM2_8812F) & BIT_MASK_RPWM2_8812F) -+#define BIT_SET_RPWM2_8812F(x, v) \ -+ (BIT_CLEAR_RPWM2_8812F(x) | BIT_RPWM2_8812F(v)) -+ -+/* 2 REG_SYSON_FSM_MON_8812F */ -+ -+#define BIT_SHIFT_FSM_MON_SEL_8812F 24 -+#define BIT_MASK_FSM_MON_SEL_8812F 0x7 -+#define BIT_FSM_MON_SEL_8812F(x) \ -+ (((x) & BIT_MASK_FSM_MON_SEL_8812F) << BIT_SHIFT_FSM_MON_SEL_8812F) -+#define BITS_FSM_MON_SEL_8812F \ -+ (BIT_MASK_FSM_MON_SEL_8812F << BIT_SHIFT_FSM_MON_SEL_8812F) -+#define BIT_CLEAR_FSM_MON_SEL_8812F(x) ((x) & (~BITS_FSM_MON_SEL_8812F)) -+#define BIT_GET_FSM_MON_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_FSM_MON_SEL_8812F) & BIT_MASK_FSM_MON_SEL_8812F) -+#define BIT_SET_FSM_MON_SEL_8812F(x, v) \ -+ (BIT_CLEAR_FSM_MON_SEL_8812F(x) | BIT_FSM_MON_SEL_8812F(v)) -+ -+#define BIT_DOP_ELDO_8812F BIT(23) -+#define BIT_FSM_MON_UPD_8812F BIT(15) -+ -+#define BIT_SHIFT_FSM_PAR_8812F 0 -+#define BIT_MASK_FSM_PAR_8812F 0x7fff -+#define BIT_FSM_PAR_8812F(x) \ -+ (((x) & BIT_MASK_FSM_PAR_8812F) << BIT_SHIFT_FSM_PAR_8812F) -+#define BITS_FSM_PAR_8812F (BIT_MASK_FSM_PAR_8812F << BIT_SHIFT_FSM_PAR_8812F) -+#define BIT_CLEAR_FSM_PAR_8812F(x) ((x) & (~BITS_FSM_PAR_8812F)) -+#define BIT_GET_FSM_PAR_8812F(x) \ -+ (((x) >> BIT_SHIFT_FSM_PAR_8812F) & BIT_MASK_FSM_PAR_8812F) -+#define BIT_SET_FSM_PAR_8812F(x, v) \ -+ (BIT_CLEAR_FSM_PAR_8812F(x) | BIT_FSM_PAR_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_PMC_DBG_CTRL1_8812F */ -+#define BIT_BT_INT_EN_8812F BIT(31) -+ -+#define BIT_SHIFT_RD_WR_WIFI_BT_INFO_8812F 16 -+#define BIT_MASK_RD_WR_WIFI_BT_INFO_8812F 0x7fff -+#define BIT_RD_WR_WIFI_BT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_RD_WR_WIFI_BT_INFO_8812F) \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8812F) -+#define BITS_RD_WR_WIFI_BT_INFO_8812F \ -+ (BIT_MASK_RD_WR_WIFI_BT_INFO_8812F \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8812F) -+#define BIT_CLEAR_RD_WR_WIFI_BT_INFO_8812F(x) \ -+ ((x) & (~BITS_RD_WR_WIFI_BT_INFO_8812F)) -+#define BIT_GET_RD_WR_WIFI_BT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_RD_WR_WIFI_BT_INFO_8812F) & \ -+ BIT_MASK_RD_WR_WIFI_BT_INFO_8812F) -+#define BIT_SET_RD_WR_WIFI_BT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_RD_WR_WIFI_BT_INFO_8812F(x) | \ -+ BIT_RD_WR_WIFI_BT_INFO_8812F(v)) -+ -+#define BIT_PMC_WR_OVF_8812F BIT(8) -+ -+#define BIT_SHIFT_WLPMC_ERRINT_8812F 0 -+#define BIT_MASK_WLPMC_ERRINT_8812F 0xff -+#define BIT_WLPMC_ERRINT_8812F(x) \ -+ (((x) & BIT_MASK_WLPMC_ERRINT_8812F) << BIT_SHIFT_WLPMC_ERRINT_8812F) -+#define BITS_WLPMC_ERRINT_8812F \ -+ (BIT_MASK_WLPMC_ERRINT_8812F << BIT_SHIFT_WLPMC_ERRINT_8812F) -+#define BIT_CLEAR_WLPMC_ERRINT_8812F(x) ((x) & (~BITS_WLPMC_ERRINT_8812F)) -+#define BIT_GET_WLPMC_ERRINT_8812F(x) \ -+ (((x) >> BIT_SHIFT_WLPMC_ERRINT_8812F) & BIT_MASK_WLPMC_ERRINT_8812F) -+#define BIT_SET_WLPMC_ERRINT_8812F(x, v) \ -+ (BIT_CLEAR_WLPMC_ERRINT_8812F(x) | BIT_WLPMC_ERRINT_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_HIMR0_8812F */ -+#define BIT_TIMEOUT_INTERRUPT2_MASK_8812F BIT(31) -+#define BIT_TIMEOUT_INTERRUTP1_MASK_8812F BIT(30) -+#define BIT_PSTIMEOUT_MSK_8812F BIT(29) -+#define BIT_GTINT4_MSK_8812F BIT(28) -+#define BIT_GTINT3_MSK_8812F BIT(27) -+#define BIT_TXBCN0ERR_MSK_8812F BIT(26) -+#define BIT_TXBCN0OK_MSK_8812F BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_MSK_8812F BIT(24) -+#define BIT_BCNDMAINT0_MSK_8812F BIT(20) -+#define BIT_BCNDERR0_MSK_8812F BIT(16) -+#define BIT_HSISR_IND_ON_INT_MSK_8812F BIT(15) -+#define BIT_BCNDMAINT_E_MSK_8812F BIT(14) -+#define BIT_CTWEND_MSK_8812F BIT(12) -+#define BIT_HISR1_IND_MSK_8812F BIT(11) -+#define BIT_C2HCMD_MSK_8812F BIT(10) -+#define BIT_CPWM2_MSK_8812F BIT(9) -+#define BIT_CPWM_MSK_8812F BIT(8) -+#define BIT_HIGHDOK_MSK_8812F BIT(7) -+#define BIT_MGTDOK_MSK_8812F BIT(6) -+#define BIT_BKDOK_MSK_8812F BIT(5) -+#define BIT_BEDOK_MSK_8812F BIT(4) -+#define BIT_VIDOK_MSK_8812F BIT(3) -+#define BIT_VODOK_MSK_8812F BIT(2) -+#define BIT_RDU_MSK_8812F BIT(1) -+#define BIT_RXOK_MSK_8812F BIT(0) -+ -+/* 2 REG_HISR0_8812F */ -+#define BIT_PSTIMEOUT2_8812F BIT(31) -+#define BIT_PSTIMEOUT1_8812F BIT(30) -+#define BIT_PSTIMEOUT_8812F BIT(29) -+#define BIT_GTINT4_8812F BIT(28) -+#define BIT_GTINT3_8812F BIT(27) -+#define BIT_TXBCN0ERR_8812F BIT(26) -+#define BIT_TXBCN0OK_8812F BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_8812F BIT(24) -+#define BIT_BCNDMAINT0_8812F BIT(20) -+#define BIT_BCNDERR0_8812F BIT(16) -+#define BIT_HSISR_IND_ON_INT_8812F BIT(15) -+#define BIT_BCNDMAINT_E_8812F BIT(14) -+#define BIT_CTWEND_8812F BIT(12) -+#define BIT_HISR1_IND_INT_8812F BIT(11) -+#define BIT_C2HCMD_8812F BIT(10) -+#define BIT_CPWM2_8812F BIT(9) -+#define BIT_CPWM_8812F BIT(8) -+#define BIT_HIGHDOK_8812F BIT(7) -+#define BIT_MGTDOK_8812F BIT(6) -+#define BIT_BKDOK_8812F BIT(5) -+#define BIT_BEDOK_8812F BIT(4) -+#define BIT_VIDOK_8812F BIT(3) -+#define BIT_VODOK_8812F BIT(2) -+#define BIT_RDU_8812F BIT(1) -+#define BIT_RXOK_8812F BIT(0) -+ -+/* 2 REG_HIMR1_8812F */ -+#define BIT_TXFIFO_TH_INT_8812F BIT(30) -+#define BIT_BTON_STS_UPDATE_MASK_8812F BIT(29) -+#define BIT_MCU_ERR_MASK_8812F BIT(28) -+#define BIT_BCNDMAINT7__MSK_8812F BIT(27) -+#define BIT_BCNDMAINT6__MSK_8812F BIT(26) -+#define BIT_BCNDMAINT5__MSK_8812F BIT(25) -+#define BIT_BCNDMAINT4__MSK_8812F BIT(24) -+#define BIT_BCNDMAINT3_MSK_8812F BIT(23) -+#define BIT_BCNDMAINT2_MSK_8812F BIT(22) -+#define BIT_BCNDMAINT1_MSK_8812F BIT(21) -+#define BIT_BCNDERR7_MSK_8812F BIT(20) -+#define BIT_BCNDERR6_MSK_8812F BIT(19) -+#define BIT_BCNDERR5_MSK_8812F BIT(18) -+#define BIT_BCNDERR4_MSK_8812F BIT(17) -+#define BIT_BCNDERR3_MSK_8812F BIT(16) -+#define BIT_BCNDERR2_MSK_8812F BIT(15) -+#define BIT_BCNDERR1_MSK_8812F BIT(14) -+#define BIT_ATIMEND_E_MSK_8812F BIT(13) -+#define BIT_ATIMEND__MSK_8812F BIT(12) -+#define BIT_TXERR_MSK_8812F BIT(11) -+#define BIT_RXERR_MSK_8812F BIT(10) -+#define BIT_TXFOVW_MSK_8812F BIT(9) -+#define BIT_FOVW_MSK_8812F BIT(8) -+#define BIT_CPU_MGQ_TXDONE_MSK_8812F BIT(5) -+#define BIT_PS_TIMER_C_MSK_8812F BIT(4) -+#define BIT_PS_TIMER_B_MSK_8812F BIT(3) -+#define BIT_PS_TIMER_A_MSK_8812F BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_MSK_8812F BIT(1) -+ -+/* 2 REG_HISR1_8812F */ -+#define BIT_TXFIFO_TH_INT_8812F BIT(30) -+#define BIT_BTON_STS_UPDATE_INT_8812F BIT(29) -+#define BIT_MCU_ERR_8812F BIT(28) -+#define BIT_BCNDMAINT7_8812F BIT(27) -+#define BIT_BCNDMAINT6_8812F BIT(26) -+#define BIT_BCNDMAINT5_8812F BIT(25) -+#define BIT_BCNDMAINT4_8812F BIT(24) -+#define BIT_BCNDMAINT3_8812F BIT(23) -+#define BIT_BCNDMAINT2_8812F BIT(22) -+#define BIT_BCNDMAINT1_8812F BIT(21) -+#define BIT_BCNDERR7_8812F BIT(20) -+#define BIT_BCNDERR6_8812F BIT(19) -+#define BIT_BCNDERR5_8812F BIT(18) -+#define BIT_BCNDERR4_8812F BIT(17) -+#define BIT_BCNDERR3_8812F BIT(16) -+#define BIT_BCNDERR2_8812F BIT(15) -+#define BIT_BCNDERR1_8812F BIT(14) -+#define BIT_ATIMEND_E_8812F BIT(13) -+#define BIT_ATIMEND_8812F BIT(12) -+#define BIT_TXERR_INT_8812F BIT(11) -+#define BIT_RXERR_INT_8812F BIT(10) -+#define BIT_TXFOVW_8812F BIT(9) -+#define BIT_FOVW_8812F BIT(8) -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_CPU_MGQ_TXDONE_8812F BIT(5) -+#define BIT_PS_TIMER_C_8812F BIT(4) -+#define BIT_PS_TIMER_B_8812F BIT(3) -+#define BIT_PS_TIMER_A_8812F BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_8812F BIT(1) -+ -+/* 2 REG_DBG_PORT_SEL_8812F */ -+ -+#define BIT_SHIFT_DEBUG_ST_8812F 0 -+#define BIT_MASK_DEBUG_ST_8812F 0xffffffffL -+#define BIT_DEBUG_ST_8812F(x) \ -+ (((x) & BIT_MASK_DEBUG_ST_8812F) << BIT_SHIFT_DEBUG_ST_8812F) -+#define BITS_DEBUG_ST_8812F \ -+ (BIT_MASK_DEBUG_ST_8812F << BIT_SHIFT_DEBUG_ST_8812F) -+#define BIT_CLEAR_DEBUG_ST_8812F(x) ((x) & (~BITS_DEBUG_ST_8812F)) -+#define BIT_GET_DEBUG_ST_8812F(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_ST_8812F) & BIT_MASK_DEBUG_ST_8812F) -+#define BIT_SET_DEBUG_ST_8812F(x, v) \ -+ (BIT_CLEAR_DEBUG_ST_8812F(x) | BIT_DEBUG_ST_8812F(v)) -+ -+/* 2 REG_PAD_CTRL2_8812F */ -+#define BIT_USB3_USB2_TRANSITION_8812F BIT(20) -+ -+#define BIT_SHIFT_USB23_SW_MODE_V1_8812F 18 -+#define BIT_MASK_USB23_SW_MODE_V1_8812F 0x3 -+#define BIT_USB23_SW_MODE_V1_8812F(x) \ -+ (((x) & BIT_MASK_USB23_SW_MODE_V1_8812F) \ -+ << BIT_SHIFT_USB23_SW_MODE_V1_8812F) -+#define BITS_USB23_SW_MODE_V1_8812F \ -+ (BIT_MASK_USB23_SW_MODE_V1_8812F << BIT_SHIFT_USB23_SW_MODE_V1_8812F) -+#define BIT_CLEAR_USB23_SW_MODE_V1_8812F(x) \ -+ ((x) & (~BITS_USB23_SW_MODE_V1_8812F)) -+#define BIT_GET_USB23_SW_MODE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_USB23_SW_MODE_V1_8812F) & \ -+ BIT_MASK_USB23_SW_MODE_V1_8812F) -+#define BIT_SET_USB23_SW_MODE_V1_8812F(x, v) \ -+ (BIT_CLEAR_USB23_SW_MODE_V1_8812F(x) | BIT_USB23_SW_MODE_V1_8812F(v)) -+ -+#define BIT_NO_PDN_CHIPOFF_V1_8812F BIT(17) -+#define BIT_RSM_EN_V1_8812F BIT(16) -+ -+#define BIT_SHIFT_MATCH_CNT_8812F 8 -+#define BIT_MASK_MATCH_CNT_8812F 0xff -+#define BIT_MATCH_CNT_8812F(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8812F) << BIT_SHIFT_MATCH_CNT_8812F) -+#define BITS_MATCH_CNT_8812F \ -+ (BIT_MASK_MATCH_CNT_8812F << BIT_SHIFT_MATCH_CNT_8812F) -+#define BIT_CLEAR_MATCH_CNT_8812F(x) ((x) & (~BITS_MATCH_CNT_8812F)) -+#define BIT_GET_MATCH_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8812F) & BIT_MASK_MATCH_CNT_8812F) -+#define BIT_SET_MATCH_CNT_8812F(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8812F(x) | BIT_MATCH_CNT_8812F(v)) -+ -+#define BIT_LD_B12V_EN_8812F BIT(7) -+#define BIT_EECS_IOSEL_V1_8812F BIT(6) -+#define BIT_EECS_DATA_O_V1_8812F BIT(5) -+#define BIT_EECS_DATA_I_V1_8812F BIT(4) -+#define BIT_EESK_IOSEL_V1_8812F BIT(2) -+#define BIT_EESK_DATA_O_V1_8812F BIT(1) -+#define BIT_EESK_DATA_I_V1_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_PMC_DBG_CTRL2_8812F */ -+ -+#define BIT_SHIFT_EFUSE_BURN_GNT_8812F 24 -+#define BIT_MASK_EFUSE_BURN_GNT_8812F 0xff -+#define BIT_EFUSE_BURN_GNT_8812F(x) \ -+ (((x) & BIT_MASK_EFUSE_BURN_GNT_8812F) \ -+ << BIT_SHIFT_EFUSE_BURN_GNT_8812F) -+#define BITS_EFUSE_BURN_GNT_8812F \ -+ (BIT_MASK_EFUSE_BURN_GNT_8812F << BIT_SHIFT_EFUSE_BURN_GNT_8812F) -+#define BIT_CLEAR_EFUSE_BURN_GNT_8812F(x) ((x) & (~BITS_EFUSE_BURN_GNT_8812F)) -+#define BIT_GET_EFUSE_BURN_GNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_EFUSE_BURN_GNT_8812F) & \ -+ BIT_MASK_EFUSE_BURN_GNT_8812F) -+#define BIT_SET_EFUSE_BURN_GNT_8812F(x, v) \ -+ (BIT_CLEAR_EFUSE_BURN_GNT_8812F(x) | BIT_EFUSE_BURN_GNT_8812F(v)) -+ -+#define BIT_STOP_WL_PMC_8812F BIT(9) -+#define BIT_STOP_SYM_PMC_8812F BIT(8) -+#define BIT_BT_ACCESS_WL_PAGE0_8812F BIT(6) -+#define BIT_REG_RST_WLPMC_8812F BIT(5) -+#define BIT_REG_RST_PD12N_8812F BIT(4) -+#define BIT_SYSON_DIS_WLREG_WRMSK_8812F BIT(3) -+#define BIT_SYSON_DIS_PMCREG_WRMSK_8812F BIT(2) -+ -+#define BIT_SHIFT_SYSON_REG_ARB_8812F 0 -+#define BIT_MASK_SYSON_REG_ARB_8812F 0x3 -+#define BIT_SYSON_REG_ARB_8812F(x) \ -+ (((x) & BIT_MASK_SYSON_REG_ARB_8812F) << BIT_SHIFT_SYSON_REG_ARB_8812F) -+#define BITS_SYSON_REG_ARB_8812F \ -+ (BIT_MASK_SYSON_REG_ARB_8812F << BIT_SHIFT_SYSON_REG_ARB_8812F) -+#define BIT_CLEAR_SYSON_REG_ARB_8812F(x) ((x) & (~BITS_SYSON_REG_ARB_8812F)) -+#define BIT_GET_SYSON_REG_ARB_8812F(x) \ -+ (((x) >> BIT_SHIFT_SYSON_REG_ARB_8812F) & BIT_MASK_SYSON_REG_ARB_8812F) -+#define BIT_SET_SYSON_REG_ARB_8812F(x, v) \ -+ (BIT_CLEAR_SYSON_REG_ARB_8812F(x) | BIT_SYSON_REG_ARB_8812F(v)) -+ -+/* 2 REG_BIST_CTRL_8812F */ -+#define BIT_BIST_USB_DIS_8812F BIT(27) -+#define BIT_BIST_PCI_DIS_8812F BIT(26) -+#define BIT_BIST_BT_DIS_8812F BIT(25) -+#define BIT_BIST_WL_DIS_8812F BIT(24) -+ -+#define BIT_SHIFT_BIST_RPT_SEL_8812F 16 -+#define BIT_MASK_BIST_RPT_SEL_8812F 0xf -+#define BIT_BIST_RPT_SEL_8812F(x) \ -+ (((x) & BIT_MASK_BIST_RPT_SEL_8812F) << BIT_SHIFT_BIST_RPT_SEL_8812F) -+#define BITS_BIST_RPT_SEL_8812F \ -+ (BIT_MASK_BIST_RPT_SEL_8812F << BIT_SHIFT_BIST_RPT_SEL_8812F) -+#define BIT_CLEAR_BIST_RPT_SEL_8812F(x) ((x) & (~BITS_BIST_RPT_SEL_8812F)) -+#define BIT_GET_BIST_RPT_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_BIST_RPT_SEL_8812F) & BIT_MASK_BIST_RPT_SEL_8812F) -+#define BIT_SET_BIST_RPT_SEL_8812F(x, v) \ -+ (BIT_CLEAR_BIST_RPT_SEL_8812F(x) | BIT_BIST_RPT_SEL_8812F(v)) -+ -+#define BIT_BIST_RESUME_PS_8812F BIT(4) -+#define BIT_BIST_RESUME_8812F BIT(3) -+#define BIT_BIST_NORMAL_8812F BIT(2) -+#define BIT_BIST_RSTN_8812F BIT(1) -+#define BIT_BIST_CLK_EN_8812F BIT(0) -+ -+/* 2 REG_BIST_RPT_8812F */ -+ -+#define BIT_SHIFT_MBIST_REPORT_8812F 0 -+#define BIT_MASK_MBIST_REPORT_8812F 0xffffffffL -+#define BIT_MBIST_REPORT_8812F(x) \ -+ (((x) & BIT_MASK_MBIST_REPORT_8812F) << BIT_SHIFT_MBIST_REPORT_8812F) -+#define BITS_MBIST_REPORT_8812F \ -+ (BIT_MASK_MBIST_REPORT_8812F << BIT_SHIFT_MBIST_REPORT_8812F) -+#define BIT_CLEAR_MBIST_REPORT_8812F(x) ((x) & (~BITS_MBIST_REPORT_8812F)) -+#define BIT_GET_MBIST_REPORT_8812F(x) \ -+ (((x) >> BIT_SHIFT_MBIST_REPORT_8812F) & BIT_MASK_MBIST_REPORT_8812F) -+#define BIT_SET_MBIST_REPORT_8812F(x, v) \ -+ (BIT_CLEAR_MBIST_REPORT_8812F(x) | BIT_MBIST_REPORT_8812F(v)) -+ -+/* 2 REG_MEM_CTRL_8812F */ -+#define BIT_UMEM_RME_8812F BIT(31) -+ -+#define BIT_SHIFT_BT_SPRAM_8812F 28 -+#define BIT_MASK_BT_SPRAM_8812F 0x3 -+#define BIT_BT_SPRAM_8812F(x) \ -+ (((x) & BIT_MASK_BT_SPRAM_8812F) << BIT_SHIFT_BT_SPRAM_8812F) -+#define BITS_BT_SPRAM_8812F \ -+ (BIT_MASK_BT_SPRAM_8812F << BIT_SHIFT_BT_SPRAM_8812F) -+#define BIT_CLEAR_BT_SPRAM_8812F(x) ((x) & (~BITS_BT_SPRAM_8812F)) -+#define BIT_GET_BT_SPRAM_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_SPRAM_8812F) & BIT_MASK_BT_SPRAM_8812F) -+#define BIT_SET_BT_SPRAM_8812F(x, v) \ -+ (BIT_CLEAR_BT_SPRAM_8812F(x) | BIT_BT_SPRAM_8812F(v)) -+ -+#define BIT_SHIFT_BT_ROM_8812F 24 -+#define BIT_MASK_BT_ROM_8812F 0xf -+#define BIT_BT_ROM_8812F(x) \ -+ (((x) & BIT_MASK_BT_ROM_8812F) << BIT_SHIFT_BT_ROM_8812F) -+#define BITS_BT_ROM_8812F (BIT_MASK_BT_ROM_8812F << BIT_SHIFT_BT_ROM_8812F) -+#define BIT_CLEAR_BT_ROM_8812F(x) ((x) & (~BITS_BT_ROM_8812F)) -+#define BIT_GET_BT_ROM_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_ROM_8812F) & BIT_MASK_BT_ROM_8812F) -+#define BIT_SET_BT_ROM_8812F(x, v) \ -+ (BIT_CLEAR_BT_ROM_8812F(x) | BIT_BT_ROM_8812F(v)) -+ -+#define BIT_SHIFT_PCI_DPRAM_8812F 10 -+#define BIT_MASK_PCI_DPRAM_8812F 0x3 -+#define BIT_PCI_DPRAM_8812F(x) \ -+ (((x) & BIT_MASK_PCI_DPRAM_8812F) << BIT_SHIFT_PCI_DPRAM_8812F) -+#define BITS_PCI_DPRAM_8812F \ -+ (BIT_MASK_PCI_DPRAM_8812F << BIT_SHIFT_PCI_DPRAM_8812F) -+#define BIT_CLEAR_PCI_DPRAM_8812F(x) ((x) & (~BITS_PCI_DPRAM_8812F)) -+#define BIT_GET_PCI_DPRAM_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCI_DPRAM_8812F) & BIT_MASK_PCI_DPRAM_8812F) -+#define BIT_SET_PCI_DPRAM_8812F(x, v) \ -+ (BIT_CLEAR_PCI_DPRAM_8812F(x) | BIT_PCI_DPRAM_8812F(v)) -+ -+#define BIT_SHIFT_PCI_SPRAM_8812F 8 -+#define BIT_MASK_PCI_SPRAM_8812F 0x3 -+#define BIT_PCI_SPRAM_8812F(x) \ -+ (((x) & BIT_MASK_PCI_SPRAM_8812F) << BIT_SHIFT_PCI_SPRAM_8812F) -+#define BITS_PCI_SPRAM_8812F \ -+ (BIT_MASK_PCI_SPRAM_8812F << BIT_SHIFT_PCI_SPRAM_8812F) -+#define BIT_CLEAR_PCI_SPRAM_8812F(x) ((x) & (~BITS_PCI_SPRAM_8812F)) -+#define BIT_GET_PCI_SPRAM_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCI_SPRAM_8812F) & BIT_MASK_PCI_SPRAM_8812F) -+#define BIT_SET_PCI_SPRAM_8812F(x, v) \ -+ (BIT_CLEAR_PCI_SPRAM_8812F(x) | BIT_PCI_SPRAM_8812F(v)) -+ -+#define BIT_SHIFT_USB_SPRAM_8812F 6 -+#define BIT_MASK_USB_SPRAM_8812F 0x3 -+#define BIT_USB_SPRAM_8812F(x) \ -+ (((x) & BIT_MASK_USB_SPRAM_8812F) << BIT_SHIFT_USB_SPRAM_8812F) -+#define BITS_USB_SPRAM_8812F \ -+ (BIT_MASK_USB_SPRAM_8812F << BIT_SHIFT_USB_SPRAM_8812F) -+#define BIT_CLEAR_USB_SPRAM_8812F(x) ((x) & (~BITS_USB_SPRAM_8812F)) -+#define BIT_GET_USB_SPRAM_8812F(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRAM_8812F) & BIT_MASK_USB_SPRAM_8812F) -+#define BIT_SET_USB_SPRAM_8812F(x, v) \ -+ (BIT_CLEAR_USB_SPRAM_8812F(x) | BIT_USB_SPRAM_8812F(v)) -+ -+#define BIT_SHIFT_USB_SPRF_8812F 4 -+#define BIT_MASK_USB_SPRF_8812F 0x3 -+#define BIT_USB_SPRF_8812F(x) \ -+ (((x) & BIT_MASK_USB_SPRF_8812F) << BIT_SHIFT_USB_SPRF_8812F) -+#define BITS_USB_SPRF_8812F \ -+ (BIT_MASK_USB_SPRF_8812F << BIT_SHIFT_USB_SPRF_8812F) -+#define BIT_CLEAR_USB_SPRF_8812F(x) ((x) & (~BITS_USB_SPRF_8812F)) -+#define BIT_GET_USB_SPRF_8812F(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRF_8812F) & BIT_MASK_USB_SPRF_8812F) -+#define BIT_SET_USB_SPRF_8812F(x, v) \ -+ (BIT_CLEAR_USB_SPRF_8812F(x) | BIT_USB_SPRF_8812F(v)) -+ -+#define BIT_SHIFT_MCU_ROM_8812F 0 -+#define BIT_MASK_MCU_ROM_8812F 0xf -+#define BIT_MCU_ROM_8812F(x) \ -+ (((x) & BIT_MASK_MCU_ROM_8812F) << BIT_SHIFT_MCU_ROM_8812F) -+#define BITS_MCU_ROM_8812F (BIT_MASK_MCU_ROM_8812F << BIT_SHIFT_MCU_ROM_8812F) -+#define BIT_CLEAR_MCU_ROM_8812F(x) ((x) & (~BITS_MCU_ROM_8812F)) -+#define BIT_GET_MCU_ROM_8812F(x) \ -+ (((x) >> BIT_SHIFT_MCU_ROM_8812F) & BIT_MASK_MCU_ROM_8812F) -+#define BIT_SET_MCU_ROM_8812F(x, v) \ -+ (BIT_CLEAR_MCU_ROM_8812F(x) | BIT_MCU_ROM_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_USB_SIE_INTF_8812F */ -+#define BIT_RD_SEL_8812F BIT(31) -+#define BIT_USB_SIE_INTF_WE_V1_8812F BIT(30) -+#define BIT_USB_SIE_INTF_BYIOREG_V1_8812F BIT(29) -+#define BIT_USB_SIE_SELECT_8812F BIT(28) -+ -+#define BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8812F 16 -+#define BIT_MASK_USB_SIE_INTF_ADDR_V1_8812F 0x1ff -+#define BIT_USB_SIE_INTF_ADDR_V1_8812F(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_ADDR_V1_8812F) \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8812F) -+#define BITS_USB_SIE_INTF_ADDR_V1_8812F \ -+ (BIT_MASK_USB_SIE_INTF_ADDR_V1_8812F \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8812F) -+#define BIT_CLEAR_USB_SIE_INTF_ADDR_V1_8812F(x) \ -+ ((x) & (~BITS_USB_SIE_INTF_ADDR_V1_8812F)) -+#define BIT_GET_USB_SIE_INTF_ADDR_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8812F) & \ -+ BIT_MASK_USB_SIE_INTF_ADDR_V1_8812F) -+#define BIT_SET_USB_SIE_INTF_ADDR_V1_8812F(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_ADDR_V1_8812F(x) | \ -+ BIT_USB_SIE_INTF_ADDR_V1_8812F(v)) -+ -+#define BIT_SHIFT_USB_SIE_INTF_RD_8812F 8 -+#define BIT_MASK_USB_SIE_INTF_RD_8812F 0xff -+#define BIT_USB_SIE_INTF_RD_8812F(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_RD_8812F) \ -+ << BIT_SHIFT_USB_SIE_INTF_RD_8812F) -+#define BITS_USB_SIE_INTF_RD_8812F \ -+ (BIT_MASK_USB_SIE_INTF_RD_8812F << BIT_SHIFT_USB_SIE_INTF_RD_8812F) -+#define BIT_CLEAR_USB_SIE_INTF_RD_8812F(x) ((x) & (~BITS_USB_SIE_INTF_RD_8812F)) -+#define BIT_GET_USB_SIE_INTF_RD_8812F(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_RD_8812F) & \ -+ BIT_MASK_USB_SIE_INTF_RD_8812F) -+#define BIT_SET_USB_SIE_INTF_RD_8812F(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_RD_8812F(x) | BIT_USB_SIE_INTF_RD_8812F(v)) -+ -+#define BIT_SHIFT_USB_SIE_INTF_WD_8812F 0 -+#define BIT_MASK_USB_SIE_INTF_WD_8812F 0xff -+#define BIT_USB_SIE_INTF_WD_8812F(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_WD_8812F) \ -+ << BIT_SHIFT_USB_SIE_INTF_WD_8812F) -+#define BITS_USB_SIE_INTF_WD_8812F \ -+ (BIT_MASK_USB_SIE_INTF_WD_8812F << BIT_SHIFT_USB_SIE_INTF_WD_8812F) -+#define BIT_CLEAR_USB_SIE_INTF_WD_8812F(x) ((x) & (~BITS_USB_SIE_INTF_WD_8812F)) -+#define BIT_GET_USB_SIE_INTF_WD_8812F(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_WD_8812F) & \ -+ BIT_MASK_USB_SIE_INTF_WD_8812F) -+#define BIT_SET_USB_SIE_INTF_WD_8812F(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_WD_8812F(x) | BIT_USB_SIE_INTF_WD_8812F(v)) -+ -+/* 2 REG_PCIE_MIO_INTF_8812F */ -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8812F 16 -+#define BIT_MASK_PCIE_MIO_ADDR_PAGE_8812F 0x3 -+#define BIT_PCIE_MIO_ADDR_PAGE_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_PAGE_8812F) \ -+ << BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8812F) -+#define BITS_PCIE_MIO_ADDR_PAGE_8812F \ -+ (BIT_MASK_PCIE_MIO_ADDR_PAGE_8812F \ -+ << BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8812F) -+#define BIT_CLEAR_PCIE_MIO_ADDR_PAGE_8812F(x) \ -+ ((x) & (~BITS_PCIE_MIO_ADDR_PAGE_8812F)) -+#define BIT_GET_PCIE_MIO_ADDR_PAGE_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8812F) & \ -+ BIT_MASK_PCIE_MIO_ADDR_PAGE_8812F) -+#define BIT_SET_PCIE_MIO_ADDR_PAGE_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_PAGE_8812F(x) | \ -+ BIT_PCIE_MIO_ADDR_PAGE_8812F(v)) -+ -+#define BIT_PCIE_MIO_BYIOREG_8812F BIT(13) -+#define BIT_PCIE_MIO_RE_8812F BIT(12) -+ -+#define BIT_SHIFT_PCIE_MIO_WE_8812F 8 -+#define BIT_MASK_PCIE_MIO_WE_8812F 0xf -+#define BIT_PCIE_MIO_WE_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_WE_8812F) << BIT_SHIFT_PCIE_MIO_WE_8812F) -+#define BITS_PCIE_MIO_WE_8812F \ -+ (BIT_MASK_PCIE_MIO_WE_8812F << BIT_SHIFT_PCIE_MIO_WE_8812F) -+#define BIT_CLEAR_PCIE_MIO_WE_8812F(x) ((x) & (~BITS_PCIE_MIO_WE_8812F)) -+#define BIT_GET_PCIE_MIO_WE_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_WE_8812F) & BIT_MASK_PCIE_MIO_WE_8812F) -+#define BIT_SET_PCIE_MIO_WE_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_WE_8812F(x) | BIT_PCIE_MIO_WE_8812F(v)) -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_8812F 0 -+#define BIT_MASK_PCIE_MIO_ADDR_8812F 0xff -+#define BIT_PCIE_MIO_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_8812F) << BIT_SHIFT_PCIE_MIO_ADDR_8812F) -+#define BITS_PCIE_MIO_ADDR_8812F \ -+ (BIT_MASK_PCIE_MIO_ADDR_8812F << BIT_SHIFT_PCIE_MIO_ADDR_8812F) -+#define BIT_CLEAR_PCIE_MIO_ADDR_8812F(x) ((x) & (~BITS_PCIE_MIO_ADDR_8812F)) -+#define BIT_GET_PCIE_MIO_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_8812F) & BIT_MASK_PCIE_MIO_ADDR_8812F) -+#define BIT_SET_PCIE_MIO_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_8812F(x) | BIT_PCIE_MIO_ADDR_8812F(v)) -+ -+/* 2 REG_PCIE_MIO_INTD_8812F */ -+ -+#define BIT_SHIFT_PCIE_MIO_DATA_8812F 0 -+#define BIT_MASK_PCIE_MIO_DATA_8812F 0xffffffffL -+#define BIT_PCIE_MIO_DATA_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_DATA_8812F) << BIT_SHIFT_PCIE_MIO_DATA_8812F) -+#define BITS_PCIE_MIO_DATA_8812F \ -+ (BIT_MASK_PCIE_MIO_DATA_8812F << BIT_SHIFT_PCIE_MIO_DATA_8812F) -+#define BIT_CLEAR_PCIE_MIO_DATA_8812F(x) ((x) & (~BITS_PCIE_MIO_DATA_8812F)) -+#define BIT_GET_PCIE_MIO_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_DATA_8812F) & BIT_MASK_PCIE_MIO_DATA_8812F) -+#define BIT_SET_PCIE_MIO_DATA_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_DATA_8812F(x) | BIT_PCIE_MIO_DATA_8812F(v)) -+ -+/* 2 REG_WLRF1_8812F */ -+ -+#define BIT_SHIFT_WLRF1_CTRL_8812F 24 -+#define BIT_MASK_WLRF1_CTRL_8812F 0xff -+#define BIT_WLRF1_CTRL_8812F(x) \ -+ (((x) & BIT_MASK_WLRF1_CTRL_8812F) << BIT_SHIFT_WLRF1_CTRL_8812F) -+#define BITS_WLRF1_CTRL_8812F \ -+ (BIT_MASK_WLRF1_CTRL_8812F << BIT_SHIFT_WLRF1_CTRL_8812F) -+#define BIT_CLEAR_WLRF1_CTRL_8812F(x) ((x) & (~BITS_WLRF1_CTRL_8812F)) -+#define BIT_GET_WLRF1_CTRL_8812F(x) \ -+ (((x) >> BIT_SHIFT_WLRF1_CTRL_8812F) & BIT_MASK_WLRF1_CTRL_8812F) -+#define BIT_SET_WLRF1_CTRL_8812F(x, v) \ -+ (BIT_CLEAR_WLRF1_CTRL_8812F(x) | BIT_WLRF1_CTRL_8812F(v)) -+ -+/* 2 REG_SYS_CFG1_8812F */ -+ -+#define BIT_SHIFT_TRP_ICFG_8812F 28 -+#define BIT_MASK_TRP_ICFG_8812F 0xf -+#define BIT_TRP_ICFG_8812F(x) \ -+ (((x) & BIT_MASK_TRP_ICFG_8812F) << BIT_SHIFT_TRP_ICFG_8812F) -+#define BITS_TRP_ICFG_8812F \ -+ (BIT_MASK_TRP_ICFG_8812F << BIT_SHIFT_TRP_ICFG_8812F) -+#define BIT_CLEAR_TRP_ICFG_8812F(x) ((x) & (~BITS_TRP_ICFG_8812F)) -+#define BIT_GET_TRP_ICFG_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRP_ICFG_8812F) & BIT_MASK_TRP_ICFG_8812F) -+#define BIT_SET_TRP_ICFG_8812F(x, v) \ -+ (BIT_CLEAR_TRP_ICFG_8812F(x) | BIT_TRP_ICFG_8812F(v)) -+ -+#define BIT_RF_TYPE_ID_8812F BIT(27) -+#define BIT_BD_HCI_SEL_8812F BIT(26) -+#define BIT_BD_PKG_SEL_8812F BIT(25) -+#define BIT_INTERNAL_EXTERNAL_SWR_8812F BIT(24) -+#define BIT_RTL_ID_8812F BIT(23) -+#define BIT_PAD_HWPD_IDN_8812F BIT(22) -+#define BIT_TESTMODE_8812F BIT(20) -+ -+#define BIT_SHIFT_VENDOR_ID_8812F 16 -+#define BIT_MASK_VENDOR_ID_8812F 0xf -+#define BIT_VENDOR_ID_8812F(x) \ -+ (((x) & BIT_MASK_VENDOR_ID_8812F) << BIT_SHIFT_VENDOR_ID_8812F) -+#define BITS_VENDOR_ID_8812F \ -+ (BIT_MASK_VENDOR_ID_8812F << BIT_SHIFT_VENDOR_ID_8812F) -+#define BIT_CLEAR_VENDOR_ID_8812F(x) ((x) & (~BITS_VENDOR_ID_8812F)) -+#define BIT_GET_VENDOR_ID_8812F(x) \ -+ (((x) >> BIT_SHIFT_VENDOR_ID_8812F) & BIT_MASK_VENDOR_ID_8812F) -+#define BIT_SET_VENDOR_ID_8812F(x, v) \ -+ (BIT_CLEAR_VENDOR_ID_8812F(x) | BIT_VENDOR_ID_8812F(v)) -+ -+#define BIT_SHIFT_CHIP_VER_8812F 12 -+#define BIT_MASK_CHIP_VER_8812F 0xf -+#define BIT_CHIP_VER_8812F(x) \ -+ (((x) & BIT_MASK_CHIP_VER_8812F) << BIT_SHIFT_CHIP_VER_8812F) -+#define BITS_CHIP_VER_8812F \ -+ (BIT_MASK_CHIP_VER_8812F << BIT_SHIFT_CHIP_VER_8812F) -+#define BIT_CLEAR_CHIP_VER_8812F(x) ((x) & (~BITS_CHIP_VER_8812F)) -+#define BIT_GET_CHIP_VER_8812F(x) \ -+ (((x) >> BIT_SHIFT_CHIP_VER_8812F) & BIT_MASK_CHIP_VER_8812F) -+#define BIT_SET_CHIP_VER_8812F(x, v) \ -+ (BIT_CLEAR_CHIP_VER_8812F(x) | BIT_CHIP_VER_8812F(v)) -+ -+#define BIT_BD_MAC3_8812F BIT(11) -+#define BIT_BD_MAC1_8812F BIT(10) -+#define BIT_BD_MAC2_8812F BIT(9) -+#define BIT_SIC_IDLE_8812F BIT(8) -+#define BIT_SW_OFFLOAD_EN_8812F BIT(7) -+#define BIT_OCP_SHUTDN_8812F BIT(6) -+#define BIT_V15_VLD_8812F BIT(5) -+#define BIT_PCIRSTB_8812F BIT(4) -+#define BIT_PCLK_VLD_8812F BIT(3) -+#define BIT_UCLK_VLD_8812F BIT(2) -+#define BIT_ACLK_VLD_8812F BIT(1) -+#define BIT_XCLK_VLD_8812F BIT(0) -+ -+/* 2 REG_SYS_STATUS1_8812F */ -+ -+#define BIT_SHIFT_RF_RL_ID_8812F 28 -+#define BIT_MASK_RF_RL_ID_8812F 0xf -+#define BIT_RF_RL_ID_8812F(x) \ -+ (((x) & BIT_MASK_RF_RL_ID_8812F) << BIT_SHIFT_RF_RL_ID_8812F) -+#define BITS_RF_RL_ID_8812F \ -+ (BIT_MASK_RF_RL_ID_8812F << BIT_SHIFT_RF_RL_ID_8812F) -+#define BIT_CLEAR_RF_RL_ID_8812F(x) ((x) & (~BITS_RF_RL_ID_8812F)) -+#define BIT_GET_RF_RL_ID_8812F(x) \ -+ (((x) >> BIT_SHIFT_RF_RL_ID_8812F) & BIT_MASK_RF_RL_ID_8812F) -+#define BIT_SET_RF_RL_ID_8812F(x, v) \ -+ (BIT_CLEAR_RF_RL_ID_8812F(x) | BIT_RF_RL_ID_8812F(v)) -+ -+#define BIT_HPHY_ICFG_8812F BIT(19) -+ -+#define BIT_SHIFT_SEL_0XC0_8812F 16 -+#define BIT_MASK_SEL_0XC0_8812F 0x3 -+#define BIT_SEL_0XC0_8812F(x) \ -+ (((x) & BIT_MASK_SEL_0XC0_8812F) << BIT_SHIFT_SEL_0XC0_8812F) -+#define BITS_SEL_0XC0_8812F \ -+ (BIT_MASK_SEL_0XC0_8812F << BIT_SHIFT_SEL_0XC0_8812F) -+#define BIT_CLEAR_SEL_0XC0_8812F(x) ((x) & (~BITS_SEL_0XC0_8812F)) -+#define BIT_GET_SEL_0XC0_8812F(x) \ -+ (((x) >> BIT_SHIFT_SEL_0XC0_8812F) & BIT_MASK_SEL_0XC0_8812F) -+#define BIT_SET_SEL_0XC0_8812F(x, v) \ -+ (BIT_CLEAR_SEL_0XC0_8812F(x) | BIT_SEL_0XC0_8812F(v)) -+ -+#define BIT_SHIFT_HCI_SEL_V4_8812F 12 -+#define BIT_MASK_HCI_SEL_V4_8812F 0x3 -+#define BIT_HCI_SEL_V4_8812F(x) \ -+ (((x) & BIT_MASK_HCI_SEL_V4_8812F) << BIT_SHIFT_HCI_SEL_V4_8812F) -+#define BITS_HCI_SEL_V4_8812F \ -+ (BIT_MASK_HCI_SEL_V4_8812F << BIT_SHIFT_HCI_SEL_V4_8812F) -+#define BIT_CLEAR_HCI_SEL_V4_8812F(x) ((x) & (~BITS_HCI_SEL_V4_8812F)) -+#define BIT_GET_HCI_SEL_V4_8812F(x) \ -+ (((x) >> BIT_SHIFT_HCI_SEL_V4_8812F) & BIT_MASK_HCI_SEL_V4_8812F) -+#define BIT_SET_HCI_SEL_V4_8812F(x, v) \ -+ (BIT_CLEAR_HCI_SEL_V4_8812F(x) | BIT_HCI_SEL_V4_8812F(v)) -+ -+#define BIT_USB_OPERATION_MODE_8812F BIT(10) -+#define BIT_BT_PDN_8812F BIT(9) -+#define BIT_AUTO_WLPON_8812F BIT(8) -+#define BIT_WL_MODE_8812F BIT(7) -+#define BIT_PKG_SEL_HCI_8812F BIT(6) -+ -+#define BIT_SHIFT_PAD_HCI_SEL_V2_8812F 3 -+#define BIT_MASK_PAD_HCI_SEL_V2_8812F 0x3 -+#define BIT_PAD_HCI_SEL_V2_8812F(x) \ -+ (((x) & BIT_MASK_PAD_HCI_SEL_V2_8812F) \ -+ << BIT_SHIFT_PAD_HCI_SEL_V2_8812F) -+#define BITS_PAD_HCI_SEL_V2_8812F \ -+ (BIT_MASK_PAD_HCI_SEL_V2_8812F << BIT_SHIFT_PAD_HCI_SEL_V2_8812F) -+#define BIT_CLEAR_PAD_HCI_SEL_V2_8812F(x) ((x) & (~BITS_PAD_HCI_SEL_V2_8812F)) -+#define BIT_GET_PAD_HCI_SEL_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_PAD_HCI_SEL_V2_8812F) & \ -+ BIT_MASK_PAD_HCI_SEL_V2_8812F) -+#define BIT_SET_PAD_HCI_SEL_V2_8812F(x, v) \ -+ (BIT_CLEAR_PAD_HCI_SEL_V2_8812F(x) | BIT_PAD_HCI_SEL_V2_8812F(v)) -+ -+#define BIT_SHIFT_EFS_HCI_SEL_V1_8812F 0 -+#define BIT_MASK_EFS_HCI_SEL_V1_8812F 0x7 -+#define BIT_EFS_HCI_SEL_V1_8812F(x) \ -+ (((x) & BIT_MASK_EFS_HCI_SEL_V1_8812F) \ -+ << BIT_SHIFT_EFS_HCI_SEL_V1_8812F) -+#define BITS_EFS_HCI_SEL_V1_8812F \ -+ (BIT_MASK_EFS_HCI_SEL_V1_8812F << BIT_SHIFT_EFS_HCI_SEL_V1_8812F) -+#define BIT_CLEAR_EFS_HCI_SEL_V1_8812F(x) ((x) & (~BITS_EFS_HCI_SEL_V1_8812F)) -+#define BIT_GET_EFS_HCI_SEL_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_EFS_HCI_SEL_V1_8812F) & \ -+ BIT_MASK_EFS_HCI_SEL_V1_8812F) -+#define BIT_SET_EFS_HCI_SEL_V1_8812F(x, v) \ -+ (BIT_CLEAR_EFS_HCI_SEL_V1_8812F(x) | BIT_EFS_HCI_SEL_V1_8812F(v)) -+ -+/* 2 REG_SYS_STATUS2_8812F */ -+#define BIT_HIOE_ON_TIMEOUT_8812F BIT(23) -+#define BIT_SIC_ON_TIMEOUT_8812F BIT(22) -+#define BIT_CPU_ON_TIMEOUT_8812F BIT(21) -+#define BIT_HCI_ON_TIMEOUT_8812F BIT(20) -+#define BIT_SIO_ALDN_8812F BIT(19) -+#define BIT_USB_ALDN_8812F BIT(18) -+#define BIT_PCI_ALDN_8812F BIT(17) -+#define BIT_SYS_ALDN_8812F BIT(16) -+ -+#define BIT_SHIFT_EPVID1_8812F 8 -+#define BIT_MASK_EPVID1_8812F 0xff -+#define BIT_EPVID1_8812F(x) \ -+ (((x) & BIT_MASK_EPVID1_8812F) << BIT_SHIFT_EPVID1_8812F) -+#define BITS_EPVID1_8812F (BIT_MASK_EPVID1_8812F << BIT_SHIFT_EPVID1_8812F) -+#define BIT_CLEAR_EPVID1_8812F(x) ((x) & (~BITS_EPVID1_8812F)) -+#define BIT_GET_EPVID1_8812F(x) \ -+ (((x) >> BIT_SHIFT_EPVID1_8812F) & BIT_MASK_EPVID1_8812F) -+#define BIT_SET_EPVID1_8812F(x, v) \ -+ (BIT_CLEAR_EPVID1_8812F(x) | BIT_EPVID1_8812F(v)) -+ -+#define BIT_SHIFT_EPVID0_8812F 0 -+#define BIT_MASK_EPVID0_8812F 0xff -+#define BIT_EPVID0_8812F(x) \ -+ (((x) & BIT_MASK_EPVID0_8812F) << BIT_SHIFT_EPVID0_8812F) -+#define BITS_EPVID0_8812F (BIT_MASK_EPVID0_8812F << BIT_SHIFT_EPVID0_8812F) -+#define BIT_CLEAR_EPVID0_8812F(x) ((x) & (~BITS_EPVID0_8812F)) -+#define BIT_GET_EPVID0_8812F(x) \ -+ (((x) >> BIT_SHIFT_EPVID0_8812F) & BIT_MASK_EPVID0_8812F) -+#define BIT_SET_EPVID0_8812F(x, v) \ -+ (BIT_CLEAR_EPVID0_8812F(x) | BIT_EPVID0_8812F(v)) -+ -+/* 2 REG_SYS_CFG2_8812F */ -+#define BIT_HCI_SEL_EMBEDDED_8812F BIT(8) -+ -+#define BIT_SHIFT_HW_ID_8812F 0 -+#define BIT_MASK_HW_ID_8812F 0xff -+#define BIT_HW_ID_8812F(x) \ -+ (((x) & BIT_MASK_HW_ID_8812F) << BIT_SHIFT_HW_ID_8812F) -+#define BITS_HW_ID_8812F (BIT_MASK_HW_ID_8812F << BIT_SHIFT_HW_ID_8812F) -+#define BIT_CLEAR_HW_ID_8812F(x) ((x) & (~BITS_HW_ID_8812F)) -+#define BIT_GET_HW_ID_8812F(x) \ -+ (((x) >> BIT_SHIFT_HW_ID_8812F) & BIT_MASK_HW_ID_8812F) -+#define BIT_SET_HW_ID_8812F(x, v) \ -+ (BIT_CLEAR_HW_ID_8812F(x) | BIT_HW_ID_8812F(v)) -+ -+/* 2 REG_SYS_CFG3_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_ANAPARSW_MAC_0_8812F */ -+#define BIT_OCP_L_8812F BIT(31) -+#define BIT_POWOCP_L_8812F BIT(30) -+ -+#define BIT_SHIFT_CF_L_V2_8812F 28 -+#define BIT_MASK_CF_L_V2_8812F 0x3 -+#define BIT_CF_L_V2_8812F(x) \ -+ (((x) & BIT_MASK_CF_L_V2_8812F) << BIT_SHIFT_CF_L_V2_8812F) -+#define BITS_CF_L_V2_8812F (BIT_MASK_CF_L_V2_8812F << BIT_SHIFT_CF_L_V2_8812F) -+#define BIT_CLEAR_CF_L_V2_8812F(x) ((x) & (~BITS_CF_L_V2_8812F)) -+#define BIT_GET_CF_L_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_CF_L_V2_8812F) & BIT_MASK_CF_L_V2_8812F) -+#define BIT_SET_CF_L_V2_8812F(x, v) \ -+ (BIT_CLEAR_CF_L_V2_8812F(x) | BIT_CF_L_V2_8812F(v)) -+ -+#define BIT_SHIFT_CFC_L_V2_8812F 26 -+#define BIT_MASK_CFC_L_V2_8812F 0x3 -+#define BIT_CFC_L_V2_8812F(x) \ -+ (((x) & BIT_MASK_CFC_L_V2_8812F) << BIT_SHIFT_CFC_L_V2_8812F) -+#define BITS_CFC_L_V2_8812F \ -+ (BIT_MASK_CFC_L_V2_8812F << BIT_SHIFT_CFC_L_V2_8812F) -+#define BIT_CLEAR_CFC_L_V2_8812F(x) ((x) & (~BITS_CFC_L_V2_8812F)) -+#define BIT_GET_CFC_L_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_CFC_L_V2_8812F) & BIT_MASK_CFC_L_V2_8812F) -+#define BIT_SET_CFC_L_V2_8812F(x, v) \ -+ (BIT_CLEAR_CFC_L_V2_8812F(x) | BIT_CFC_L_V2_8812F(v)) -+ -+#define BIT_SHIFT_R3_L_V2_8812F 24 -+#define BIT_MASK_R3_L_V2_8812F 0x3 -+#define BIT_R3_L_V2_8812F(x) \ -+ (((x) & BIT_MASK_R3_L_V2_8812F) << BIT_SHIFT_R3_L_V2_8812F) -+#define BITS_R3_L_V2_8812F (BIT_MASK_R3_L_V2_8812F << BIT_SHIFT_R3_L_V2_8812F) -+#define BIT_CLEAR_R3_L_V2_8812F(x) ((x) & (~BITS_R3_L_V2_8812F)) -+#define BIT_GET_R3_L_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_R3_L_V2_8812F) & BIT_MASK_R3_L_V2_8812F) -+#define BIT_SET_R3_L_V2_8812F(x, v) \ -+ (BIT_CLEAR_R3_L_V2_8812F(x) | BIT_R3_L_V2_8812F(v)) -+ -+#define BIT_SHIFT_R2_L_8812F 22 -+#define BIT_MASK_R2_L_8812F 0x3 -+#define BIT_R2_L_8812F(x) (((x) & BIT_MASK_R2_L_8812F) << BIT_SHIFT_R2_L_8812F) -+#define BITS_R2_L_8812F (BIT_MASK_R2_L_8812F << BIT_SHIFT_R2_L_8812F) -+#define BIT_CLEAR_R2_L_8812F(x) ((x) & (~BITS_R2_L_8812F)) -+#define BIT_GET_R2_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_R2_L_8812F) & BIT_MASK_R2_L_8812F) -+#define BIT_SET_R2_L_8812F(x, v) (BIT_CLEAR_R2_L_8812F(x) | BIT_R2_L_8812F(v)) -+ -+#define BIT_SHIFT_R1_L_8812F 20 -+#define BIT_MASK_R1_L_8812F 0x3 -+#define BIT_R1_L_8812F(x) (((x) & BIT_MASK_R1_L_8812F) << BIT_SHIFT_R1_L_8812F) -+#define BITS_R1_L_8812F (BIT_MASK_R1_L_8812F << BIT_SHIFT_R1_L_8812F) -+#define BIT_CLEAR_R1_L_8812F(x) ((x) & (~BITS_R1_L_8812F)) -+#define BIT_GET_R1_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_R1_L_8812F) & BIT_MASK_R1_L_8812F) -+#define BIT_SET_R1_L_8812F(x, v) (BIT_CLEAR_R1_L_8812F(x) | BIT_R1_L_8812F(v)) -+ -+#define BIT_SHIFT_C3_L_8812F 18 -+#define BIT_MASK_C3_L_8812F 0x3 -+#define BIT_C3_L_8812F(x) (((x) & BIT_MASK_C3_L_8812F) << BIT_SHIFT_C3_L_8812F) -+#define BITS_C3_L_8812F (BIT_MASK_C3_L_8812F << BIT_SHIFT_C3_L_8812F) -+#define BIT_CLEAR_C3_L_8812F(x) ((x) & (~BITS_C3_L_8812F)) -+#define BIT_GET_C3_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_C3_L_8812F) & BIT_MASK_C3_L_8812F) -+#define BIT_SET_C3_L_8812F(x, v) (BIT_CLEAR_C3_L_8812F(x) | BIT_C3_L_8812F(v)) -+ -+#define BIT_SHIFT_C2_L_8812F 16 -+#define BIT_MASK_C2_L_8812F 0x3 -+#define BIT_C2_L_8812F(x) (((x) & BIT_MASK_C2_L_8812F) << BIT_SHIFT_C2_L_8812F) -+#define BITS_C2_L_8812F (BIT_MASK_C2_L_8812F << BIT_SHIFT_C2_L_8812F) -+#define BIT_CLEAR_C2_L_8812F(x) ((x) & (~BITS_C2_L_8812F)) -+#define BIT_GET_C2_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_C2_L_8812F) & BIT_MASK_C2_L_8812F) -+#define BIT_SET_C2_L_8812F(x, v) (BIT_CLEAR_C2_L_8812F(x) | BIT_C2_L_8812F(v)) -+ -+#define BIT_SHIFT_C1_L_V2_8812F 14 -+#define BIT_MASK_C1_L_V2_8812F 0x3 -+#define BIT_C1_L_V2_8812F(x) \ -+ (((x) & BIT_MASK_C1_L_V2_8812F) << BIT_SHIFT_C1_L_V2_8812F) -+#define BITS_C1_L_V2_8812F (BIT_MASK_C1_L_V2_8812F << BIT_SHIFT_C1_L_V2_8812F) -+#define BIT_CLEAR_C1_L_V2_8812F(x) ((x) & (~BITS_C1_L_V2_8812F)) -+#define BIT_GET_C1_L_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_C1_L_V2_8812F) & BIT_MASK_C1_L_V2_8812F) -+#define BIT_SET_C1_L_V2_8812F(x, v) \ -+ (BIT_CLEAR_C1_L_V2_8812F(x) | BIT_C1_L_V2_8812F(v)) -+ -+#define BIT_REG_OCPS_L_V2_8812F BIT(13) -+#define BIT_REG_PWM_L_8812F BIT(12) -+ -+#define BIT_SHIFT_V15ADJ_L_8812F 9 -+#define BIT_MASK_V15ADJ_L_8812F 0x7 -+#define BIT_V15ADJ_L_8812F(x) \ -+ (((x) & BIT_MASK_V15ADJ_L_8812F) << BIT_SHIFT_V15ADJ_L_8812F) -+#define BITS_V15ADJ_L_8812F \ -+ (BIT_MASK_V15ADJ_L_8812F << BIT_SHIFT_V15ADJ_L_8812F) -+#define BIT_CLEAR_V15ADJ_L_8812F(x) ((x) & (~BITS_V15ADJ_L_8812F)) -+#define BIT_GET_V15ADJ_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L_8812F) & BIT_MASK_V15ADJ_L_8812F) -+#define BIT_SET_V15ADJ_L_8812F(x, v) \ -+ (BIT_CLEAR_V15ADJ_L_8812F(x) | BIT_V15ADJ_L_8812F(v)) -+ -+#define BIT_SHIFT_IN_L_8812F 6 -+#define BIT_MASK_IN_L_8812F 0x7 -+#define BIT_IN_L_8812F(x) (((x) & BIT_MASK_IN_L_8812F) << BIT_SHIFT_IN_L_8812F) -+#define BITS_IN_L_8812F (BIT_MASK_IN_L_8812F << BIT_SHIFT_IN_L_8812F) -+#define BIT_CLEAR_IN_L_8812F(x) ((x) & (~BITS_IN_L_8812F)) -+#define BIT_GET_IN_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_IN_L_8812F) & BIT_MASK_IN_L_8812F) -+#define BIT_SET_IN_L_8812F(x, v) (BIT_CLEAR_IN_L_8812F(x) | BIT_IN_L_8812F(v)) -+ -+#define BIT_SHIFT_STD_L_8812F 4 -+#define BIT_MASK_STD_L_8812F 0x3 -+#define BIT_STD_L_8812F(x) \ -+ (((x) & BIT_MASK_STD_L_8812F) << BIT_SHIFT_STD_L_8812F) -+#define BITS_STD_L_8812F (BIT_MASK_STD_L_8812F << BIT_SHIFT_STD_L_8812F) -+#define BIT_CLEAR_STD_L_8812F(x) ((x) & (~BITS_STD_L_8812F)) -+#define BIT_GET_STD_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_STD_L_8812F) & BIT_MASK_STD_L_8812F) -+#define BIT_SET_STD_L_8812F(x, v) \ -+ (BIT_CLEAR_STD_L_8812F(x) | BIT_STD_L_8812F(v)) -+ -+#define BIT_SHIFT_VOL_L_8812F 0 -+#define BIT_MASK_VOL_L_8812F 0xf -+#define BIT_VOL_L_8812F(x) \ -+ (((x) & BIT_MASK_VOL_L_8812F) << BIT_SHIFT_VOL_L_8812F) -+#define BITS_VOL_L_8812F (BIT_MASK_VOL_L_8812F << BIT_SHIFT_VOL_L_8812F) -+#define BIT_CLEAR_VOL_L_8812F(x) ((x) & (~BITS_VOL_L_8812F)) -+#define BIT_GET_VOL_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_VOL_L_8812F) & BIT_MASK_VOL_L_8812F) -+#define BIT_SET_VOL_L_8812F(x, v) \ -+ (BIT_CLEAR_VOL_L_8812F(x) | BIT_VOL_L_8812F(v)) -+ -+/* 2 REG_ANAPARSW_MAC_1_8812F */ -+ -+#define BIT_SHIFT_OCP_L_PFM_8812F 29 -+#define BIT_MASK_OCP_L_PFM_8812F 0x7 -+#define BIT_OCP_L_PFM_8812F(x) \ -+ (((x) & BIT_MASK_OCP_L_PFM_8812F) << BIT_SHIFT_OCP_L_PFM_8812F) -+#define BITS_OCP_L_PFM_8812F \ -+ (BIT_MASK_OCP_L_PFM_8812F << BIT_SHIFT_OCP_L_PFM_8812F) -+#define BIT_CLEAR_OCP_L_PFM_8812F(x) ((x) & (~BITS_OCP_L_PFM_8812F)) -+#define BIT_GET_OCP_L_PFM_8812F(x) \ -+ (((x) >> BIT_SHIFT_OCP_L_PFM_8812F) & BIT_MASK_OCP_L_PFM_8812F) -+#define BIT_SET_OCP_L_PFM_8812F(x, v) \ -+ (BIT_CLEAR_OCP_L_PFM_8812F(x) | BIT_OCP_L_PFM_8812F(v)) -+ -+#define BIT_SHIFT_CFC_L_PFM_8812F 27 -+#define BIT_MASK_CFC_L_PFM_8812F 0x3 -+#define BIT_CFC_L_PFM_8812F(x) \ -+ (((x) & BIT_MASK_CFC_L_PFM_8812F) << BIT_SHIFT_CFC_L_PFM_8812F) -+#define BITS_CFC_L_PFM_8812F \ -+ (BIT_MASK_CFC_L_PFM_8812F << BIT_SHIFT_CFC_L_PFM_8812F) -+#define BIT_CLEAR_CFC_L_PFM_8812F(x) ((x) & (~BITS_CFC_L_PFM_8812F)) -+#define BIT_GET_CFC_L_PFM_8812F(x) \ -+ (((x) >> BIT_SHIFT_CFC_L_PFM_8812F) & BIT_MASK_CFC_L_PFM_8812F) -+#define BIT_SET_CFC_L_PFM_8812F(x, v) \ -+ (BIT_CLEAR_CFC_L_PFM_8812F(x) | BIT_CFC_L_PFM_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_REG_FREQ_L_V1_8812F 20 -+#define BIT_MASK_REG_FREQ_L_V1_8812F 0x7 -+#define BIT_REG_FREQ_L_V1_8812F(x) \ -+ (((x) & BIT_MASK_REG_FREQ_L_V1_8812F) << BIT_SHIFT_REG_FREQ_L_V1_8812F) -+#define BITS_REG_FREQ_L_V1_8812F \ -+ (BIT_MASK_REG_FREQ_L_V1_8812F << BIT_SHIFT_REG_FREQ_L_V1_8812F) -+#define BIT_CLEAR_REG_FREQ_L_V1_8812F(x) ((x) & (~BITS_REG_FREQ_L_V1_8812F)) -+#define BIT_GET_REG_FREQ_L_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_FREQ_L_V1_8812F) & BIT_MASK_REG_FREQ_L_V1_8812F) -+#define BIT_SET_REG_FREQ_L_V1_8812F(x, v) \ -+ (BIT_CLEAR_REG_FREQ_L_V1_8812F(x) | BIT_REG_FREQ_L_V1_8812F(v)) -+ -+#define BIT_EN_DUTY_8812F BIT(19) -+ -+#define BIT_SHIFT_REG_MODE_V2_8812F 17 -+#define BIT_MASK_REG_MODE_V2_8812F 0x3 -+#define BIT_REG_MODE_V2_8812F(x) \ -+ (((x) & BIT_MASK_REG_MODE_V2_8812F) << BIT_SHIFT_REG_MODE_V2_8812F) -+#define BITS_REG_MODE_V2_8812F \ -+ (BIT_MASK_REG_MODE_V2_8812F << BIT_SHIFT_REG_MODE_V2_8812F) -+#define BIT_CLEAR_REG_MODE_V2_8812F(x) ((x) & (~BITS_REG_MODE_V2_8812F)) -+#define BIT_GET_REG_MODE_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_MODE_V2_8812F) & BIT_MASK_REG_MODE_V2_8812F) -+#define BIT_SET_REG_MODE_V2_8812F(x, v) \ -+ (BIT_CLEAR_REG_MODE_V2_8812F(x) | BIT_REG_MODE_V2_8812F(v)) -+ -+#define BIT_EN_SP_8812F BIT(16) -+#define BIT_REG_AUTO_L_V2_8812F BIT(15) -+#define BIT_REG_LDOF_L_V2_8812F BIT(14) -+#define BIT_REG_TYPE_L_V2_8812F BIT(13) -+#define BIT_VO15_V1P05_H_8812F BIT(12) -+#define BIT_ARENB_L_V2_8812F BIT(11) -+ -+#define BIT_SHIFT_TBOX_L1_V2_8812F 9 -+#define BIT_MASK_TBOX_L1_V2_8812F 0x3 -+#define BIT_TBOX_L1_V2_8812F(x) \ -+ (((x) & BIT_MASK_TBOX_L1_V2_8812F) << BIT_SHIFT_TBOX_L1_V2_8812F) -+#define BITS_TBOX_L1_V2_8812F \ -+ (BIT_MASK_TBOX_L1_V2_8812F << BIT_SHIFT_TBOX_L1_V2_8812F) -+#define BIT_CLEAR_TBOX_L1_V2_8812F(x) ((x) & (~BITS_TBOX_L1_V2_8812F)) -+#define BIT_GET_TBOX_L1_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TBOX_L1_V2_8812F) & BIT_MASK_TBOX_L1_V2_8812F) -+#define BIT_SET_TBOX_L1_V2_8812F(x, v) \ -+ (BIT_CLEAR_TBOX_L1_V2_8812F(x) | BIT_TBOX_L1_V2_8812F(v)) -+ -+#define BIT_SHIFT_REG_DELAY_L_8812F 7 -+#define BIT_MASK_REG_DELAY_L_8812F 0x3 -+#define BIT_REG_DELAY_L_8812F(x) \ -+ (((x) & BIT_MASK_REG_DELAY_L_8812F) << BIT_SHIFT_REG_DELAY_L_8812F) -+#define BITS_REG_DELAY_L_8812F \ -+ (BIT_MASK_REG_DELAY_L_8812F << BIT_SHIFT_REG_DELAY_L_8812F) -+#define BIT_CLEAR_REG_DELAY_L_8812F(x) ((x) & (~BITS_REG_DELAY_L_8812F)) -+#define BIT_GET_REG_DELAY_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_DELAY_L_8812F) & BIT_MASK_REG_DELAY_L_8812F) -+#define BIT_SET_REG_DELAY_L_8812F(x, v) \ -+ (BIT_CLEAR_REG_DELAY_L_8812F(x) | BIT_REG_DELAY_L_8812F(v)) -+ -+#define BIT_REG_CLAMP_D_L_8812F BIT(6) -+#define BIT_REG_BYPASS_L_V2_8812F BIT(5) -+#define BIT_REG_AUTOZCD_L_8812F BIT(4) -+#define BIT_POW_ZCD_L_V2_8812F BIT(3) -+#define BIT_REG_HALF_L_8812F BIT(2) -+ -+#define BIT_SHIFT_OCP_L_V2_8812F 0 -+#define BIT_MASK_OCP_L_V2_8812F 0x3 -+#define BIT_OCP_L_V2_8812F(x) \ -+ (((x) & BIT_MASK_OCP_L_V2_8812F) << BIT_SHIFT_OCP_L_V2_8812F) -+#define BITS_OCP_L_V2_8812F \ -+ (BIT_MASK_OCP_L_V2_8812F << BIT_SHIFT_OCP_L_V2_8812F) -+#define BIT_CLEAR_OCP_L_V2_8812F(x) ((x) & (~BITS_OCP_L_V2_8812F)) -+#define BIT_GET_OCP_L_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_OCP_L_V2_8812F) & BIT_MASK_OCP_L_V2_8812F) -+#define BIT_SET_OCP_L_V2_8812F(x, v) \ -+ (BIT_CLEAR_OCP_L_V2_8812F(x) | BIT_OCP_L_V2_8812F(v)) -+ -+/* 2 REG_ANAPAR_MAC_0_8812F */ -+ -+#define BIT_SHIFT_REG_LPF_R3_8812F 29 -+#define BIT_MASK_REG_LPF_R3_8812F 0x7 -+#define BIT_REG_LPF_R3_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_R3_8812F) << BIT_SHIFT_REG_LPF_R3_8812F) -+#define BITS_REG_LPF_R3_8812F \ -+ (BIT_MASK_REG_LPF_R3_8812F << BIT_SHIFT_REG_LPF_R3_8812F) -+#define BIT_CLEAR_REG_LPF_R3_8812F(x) ((x) & (~BITS_REG_LPF_R3_8812F)) -+#define BIT_GET_REG_LPF_R3_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R3_8812F) & BIT_MASK_REG_LPF_R3_8812F) -+#define BIT_SET_REG_LPF_R3_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_R3_8812F(x) | BIT_REG_LPF_R3_8812F(v)) -+ -+#define BIT_SHIFT_REG_LPF_R2_8812F 24 -+#define BIT_MASK_REG_LPF_R2_8812F 0x1f -+#define BIT_REG_LPF_R2_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_R2_8812F) << BIT_SHIFT_REG_LPF_R2_8812F) -+#define BITS_REG_LPF_R2_8812F \ -+ (BIT_MASK_REG_LPF_R2_8812F << BIT_SHIFT_REG_LPF_R2_8812F) -+#define BIT_CLEAR_REG_LPF_R2_8812F(x) ((x) & (~BITS_REG_LPF_R2_8812F)) -+#define BIT_GET_REG_LPF_R2_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R2_8812F) & BIT_MASK_REG_LPF_R2_8812F) -+#define BIT_SET_REG_LPF_R2_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_R2_8812F(x) | BIT_REG_LPF_R2_8812F(v)) -+ -+#define BIT_SHIFT_REG_LPF_C3_8812F 21 -+#define BIT_MASK_REG_LPF_C3_8812F 0x7 -+#define BIT_REG_LPF_C3_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_C3_8812F) << BIT_SHIFT_REG_LPF_C3_8812F) -+#define BITS_REG_LPF_C3_8812F \ -+ (BIT_MASK_REG_LPF_C3_8812F << BIT_SHIFT_REG_LPF_C3_8812F) -+#define BIT_CLEAR_REG_LPF_C3_8812F(x) ((x) & (~BITS_REG_LPF_C3_8812F)) -+#define BIT_GET_REG_LPF_C3_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C3_8812F) & BIT_MASK_REG_LPF_C3_8812F) -+#define BIT_SET_REG_LPF_C3_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_C3_8812F(x) | BIT_REG_LPF_C3_8812F(v)) -+ -+#define BIT_SHIFT_REG_LPF_C2_8812F 18 -+#define BIT_MASK_REG_LPF_C2_8812F 0x7 -+#define BIT_REG_LPF_C2_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_C2_8812F) << BIT_SHIFT_REG_LPF_C2_8812F) -+#define BITS_REG_LPF_C2_8812F \ -+ (BIT_MASK_REG_LPF_C2_8812F << BIT_SHIFT_REG_LPF_C2_8812F) -+#define BIT_CLEAR_REG_LPF_C2_8812F(x) ((x) & (~BITS_REG_LPF_C2_8812F)) -+#define BIT_GET_REG_LPF_C2_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C2_8812F) & BIT_MASK_REG_LPF_C2_8812F) -+#define BIT_SET_REG_LPF_C2_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_C2_8812F(x) | BIT_REG_LPF_C2_8812F(v)) -+ -+#define BIT_SHIFT_REG_LPF_C1_8812F 15 -+#define BIT_MASK_REG_LPF_C1_8812F 0x7 -+#define BIT_REG_LPF_C1_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_C1_8812F) << BIT_SHIFT_REG_LPF_C1_8812F) -+#define BITS_REG_LPF_C1_8812F \ -+ (BIT_MASK_REG_LPF_C1_8812F << BIT_SHIFT_REG_LPF_C1_8812F) -+#define BIT_CLEAR_REG_LPF_C1_8812F(x) ((x) & (~BITS_REG_LPF_C1_8812F)) -+#define BIT_GET_REG_LPF_C1_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C1_8812F) & BIT_MASK_REG_LPF_C1_8812F) -+#define BIT_SET_REG_LPF_C1_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_C1_8812F(x) | BIT_REG_LPF_C1_8812F(v)) -+ -+#define BIT_SHIFT_REG_LDO_SEL_V1_8812F 13 -+#define BIT_MASK_REG_LDO_SEL_V1_8812F 0x3 -+#define BIT_REG_LDO_SEL_V1_8812F(x) \ -+ (((x) & BIT_MASK_REG_LDO_SEL_V1_8812F) \ -+ << BIT_SHIFT_REG_LDO_SEL_V1_8812F) -+#define BITS_REG_LDO_SEL_V1_8812F \ -+ (BIT_MASK_REG_LDO_SEL_V1_8812F << BIT_SHIFT_REG_LDO_SEL_V1_8812F) -+#define BIT_CLEAR_REG_LDO_SEL_V1_8812F(x) ((x) & (~BITS_REG_LDO_SEL_V1_8812F)) -+#define BIT_GET_REG_LDO_SEL_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LDO_SEL_V1_8812F) & \ -+ BIT_MASK_REG_LDO_SEL_V1_8812F) -+#define BIT_SET_REG_LDO_SEL_V1_8812F(x, v) \ -+ (BIT_CLEAR_REG_LDO_SEL_V1_8812F(x) | BIT_REG_LDO_SEL_V1_8812F(v)) -+ -+#define BIT_REG_CP_ICPX2_8812F BIT(12) -+ -+#define BIT_SHIFT_REG_CP_ICP_SEL_FAST_8812F 9 -+#define BIT_MASK_REG_CP_ICP_SEL_FAST_8812F 0x7 -+#define BIT_REG_CP_ICP_SEL_FAST_8812F(x) \ -+ (((x) & BIT_MASK_REG_CP_ICP_SEL_FAST_8812F) \ -+ << BIT_SHIFT_REG_CP_ICP_SEL_FAST_8812F) -+#define BITS_REG_CP_ICP_SEL_FAST_8812F \ -+ (BIT_MASK_REG_CP_ICP_SEL_FAST_8812F \ -+ << BIT_SHIFT_REG_CP_ICP_SEL_FAST_8812F) -+#define BIT_CLEAR_REG_CP_ICP_SEL_FAST_8812F(x) \ -+ ((x) & (~BITS_REG_CP_ICP_SEL_FAST_8812F)) -+#define BIT_GET_REG_CP_ICP_SEL_FAST_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_ICP_SEL_FAST_8812F) & \ -+ BIT_MASK_REG_CP_ICP_SEL_FAST_8812F) -+#define BIT_SET_REG_CP_ICP_SEL_FAST_8812F(x, v) \ -+ (BIT_CLEAR_REG_CP_ICP_SEL_FAST_8812F(x) | \ -+ BIT_REG_CP_ICP_SEL_FAST_8812F(v)) -+ -+#define BIT_SHIFT_REG_CP_ICP_SEL_8812F 6 -+#define BIT_MASK_REG_CP_ICP_SEL_8812F 0x7 -+#define BIT_REG_CP_ICP_SEL_8812F(x) \ -+ (((x) & BIT_MASK_REG_CP_ICP_SEL_8812F) \ -+ << BIT_SHIFT_REG_CP_ICP_SEL_8812F) -+#define BITS_REG_CP_ICP_SEL_8812F \ -+ (BIT_MASK_REG_CP_ICP_SEL_8812F << BIT_SHIFT_REG_CP_ICP_SEL_8812F) -+#define BIT_CLEAR_REG_CP_ICP_SEL_8812F(x) ((x) & (~BITS_REG_CP_ICP_SEL_8812F)) -+#define BIT_GET_REG_CP_ICP_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_ICP_SEL_8812F) & \ -+ BIT_MASK_REG_CP_ICP_SEL_8812F) -+#define BIT_SET_REG_CP_ICP_SEL_8812F(x, v) \ -+ (BIT_CLEAR_REG_CP_ICP_SEL_8812F(x) | BIT_REG_CP_ICP_SEL_8812F(v)) -+ -+#define BIT_SHIFT_REG_IB_PI_8812F 4 -+#define BIT_MASK_REG_IB_PI_8812F 0x3 -+#define BIT_REG_IB_PI_8812F(x) \ -+ (((x) & BIT_MASK_REG_IB_PI_8812F) << BIT_SHIFT_REG_IB_PI_8812F) -+#define BITS_REG_IB_PI_8812F \ -+ (BIT_MASK_REG_IB_PI_8812F << BIT_SHIFT_REG_IB_PI_8812F) -+#define BIT_CLEAR_REG_IB_PI_8812F(x) ((x) & (~BITS_REG_IB_PI_8812F)) -+#define BIT_GET_REG_IB_PI_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_IB_PI_8812F) & BIT_MASK_REG_IB_PI_8812F) -+#define BIT_SET_REG_IB_PI_8812F(x, v) \ -+ (BIT_CLEAR_REG_IB_PI_8812F(x) | BIT_REG_IB_PI_8812F(v)) -+ -+#define BIT_LDO2PWRCUT_8812F BIT(3) -+#define BIT_VPULSE_LDO_8812F BIT(2) -+ -+#define BIT_SHIFT_LDO_VSEL_8812F 0 -+#define BIT_MASK_LDO_VSEL_8812F 0x3 -+#define BIT_LDO_VSEL_8812F(x) \ -+ (((x) & BIT_MASK_LDO_VSEL_8812F) << BIT_SHIFT_LDO_VSEL_8812F) -+#define BITS_LDO_VSEL_8812F \ -+ (BIT_MASK_LDO_VSEL_8812F << BIT_SHIFT_LDO_VSEL_8812F) -+#define BIT_CLEAR_LDO_VSEL_8812F(x) ((x) & (~BITS_LDO_VSEL_8812F)) -+#define BIT_GET_LDO_VSEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_LDO_VSEL_8812F) & BIT_MASK_LDO_VSEL_8812F) -+#define BIT_SET_LDO_VSEL_8812F(x, v) \ -+ (BIT_CLEAR_LDO_VSEL_8812F(x) | BIT_LDO_VSEL_8812F(v)) -+ -+/* 2 REG_ANAPAR_MAC_1_8812F */ -+ -+#define BIT_SHIFT_REG_CK_MON_SEL_8812F 29 -+#define BIT_MASK_REG_CK_MON_SEL_8812F 0x7 -+#define BIT_REG_CK_MON_SEL_8812F(x) \ -+ (((x) & BIT_MASK_REG_CK_MON_SEL_8812F) \ -+ << BIT_SHIFT_REG_CK_MON_SEL_8812F) -+#define BITS_REG_CK_MON_SEL_8812F \ -+ (BIT_MASK_REG_CK_MON_SEL_8812F << BIT_SHIFT_REG_CK_MON_SEL_8812F) -+#define BIT_CLEAR_REG_CK_MON_SEL_8812F(x) ((x) & (~BITS_REG_CK_MON_SEL_8812F)) -+#define BIT_GET_REG_CK_MON_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_CK_MON_SEL_8812F) & \ -+ BIT_MASK_REG_CK_MON_SEL_8812F) -+#define BIT_SET_REG_CK_MON_SEL_8812F(x, v) \ -+ (BIT_CLEAR_REG_CK_MON_SEL_8812F(x) | BIT_REG_CK_MON_SEL_8812F(v)) -+ -+#define BIT_REG_CK_MON_EN_8812F BIT(28) -+#define BIT_REG_XTAL_FREQ_SEL_8812F BIT(27) -+#define BIT_REG_XTAL_EDGE_SEL_8812F BIT(26) -+#define BIT_REG_VCO_KVCO_8812F BIT(25) -+#define BIT_REG_SDM_EDGE_SEL_8812F BIT(24) -+#define BIT_REG_SDM_CK_SEL_8812F BIT(23) -+#define BIT_REG_SDM_CK_GATED_8812F BIT(22) -+#define BIT_REG_PFD_RESET_GATED_8812F BIT(21) -+ -+#define BIT_SHIFT_REG_LPF_R3_FAST_8812F 16 -+#define BIT_MASK_REG_LPF_R3_FAST_8812F 0x1f -+#define BIT_REG_LPF_R3_FAST_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_R3_FAST_8812F) \ -+ << BIT_SHIFT_REG_LPF_R3_FAST_8812F) -+#define BITS_REG_LPF_R3_FAST_8812F \ -+ (BIT_MASK_REG_LPF_R3_FAST_8812F << BIT_SHIFT_REG_LPF_R3_FAST_8812F) -+#define BIT_CLEAR_REG_LPF_R3_FAST_8812F(x) ((x) & (~BITS_REG_LPF_R3_FAST_8812F)) -+#define BIT_GET_REG_LPF_R3_FAST_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R3_FAST_8812F) & \ -+ BIT_MASK_REG_LPF_R3_FAST_8812F) -+#define BIT_SET_REG_LPF_R3_FAST_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_R3_FAST_8812F(x) | BIT_REG_LPF_R3_FAST_8812F(v)) -+ -+#define BIT_SHIFT_REG_LPF_R2_FAST_8812F 11 -+#define BIT_MASK_REG_LPF_R2_FAST_8812F 0x1f -+#define BIT_REG_LPF_R2_FAST_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_R2_FAST_8812F) \ -+ << BIT_SHIFT_REG_LPF_R2_FAST_8812F) -+#define BITS_REG_LPF_R2_FAST_8812F \ -+ (BIT_MASK_REG_LPF_R2_FAST_8812F << BIT_SHIFT_REG_LPF_R2_FAST_8812F) -+#define BIT_CLEAR_REG_LPF_R2_FAST_8812F(x) ((x) & (~BITS_REG_LPF_R2_FAST_8812F)) -+#define BIT_GET_REG_LPF_R2_FAST_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R2_FAST_8812F) & \ -+ BIT_MASK_REG_LPF_R2_FAST_8812F) -+#define BIT_SET_REG_LPF_R2_FAST_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_R2_FAST_8812F(x) | BIT_REG_LPF_R2_FAST_8812F(v)) -+ -+#define BIT_SHIFT_REG_LPF_C3_FAST_8812F 8 -+#define BIT_MASK_REG_LPF_C3_FAST_8812F 0x7 -+#define BIT_REG_LPF_C3_FAST_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_C3_FAST_8812F) \ -+ << BIT_SHIFT_REG_LPF_C3_FAST_8812F) -+#define BITS_REG_LPF_C3_FAST_8812F \ -+ (BIT_MASK_REG_LPF_C3_FAST_8812F << BIT_SHIFT_REG_LPF_C3_FAST_8812F) -+#define BIT_CLEAR_REG_LPF_C3_FAST_8812F(x) ((x) & (~BITS_REG_LPF_C3_FAST_8812F)) -+#define BIT_GET_REG_LPF_C3_FAST_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C3_FAST_8812F) & \ -+ BIT_MASK_REG_LPF_C3_FAST_8812F) -+#define BIT_SET_REG_LPF_C3_FAST_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_C3_FAST_8812F(x) | BIT_REG_LPF_C3_FAST_8812F(v)) -+ -+#define BIT_SHIFT_REG_LPF_C2_FAST_8812F 5 -+#define BIT_MASK_REG_LPF_C2_FAST_8812F 0x7 -+#define BIT_REG_LPF_C2_FAST_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_C2_FAST_8812F) \ -+ << BIT_SHIFT_REG_LPF_C2_FAST_8812F) -+#define BITS_REG_LPF_C2_FAST_8812F \ -+ (BIT_MASK_REG_LPF_C2_FAST_8812F << BIT_SHIFT_REG_LPF_C2_FAST_8812F) -+#define BIT_CLEAR_REG_LPF_C2_FAST_8812F(x) ((x) & (~BITS_REG_LPF_C2_FAST_8812F)) -+#define BIT_GET_REG_LPF_C2_FAST_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C2_FAST_8812F) & \ -+ BIT_MASK_REG_LPF_C2_FAST_8812F) -+#define BIT_SET_REG_LPF_C2_FAST_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_C2_FAST_8812F(x) | BIT_REG_LPF_C2_FAST_8812F(v)) -+ -+#define BIT_SHIFT_REG_LPF_C1_FAST_8812F 2 -+#define BIT_MASK_REG_LPF_C1_FAST_8812F 0x7 -+#define BIT_REG_LPF_C1_FAST_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_C1_FAST_8812F) \ -+ << BIT_SHIFT_REG_LPF_C1_FAST_8812F) -+#define BITS_REG_LPF_C1_FAST_8812F \ -+ (BIT_MASK_REG_LPF_C1_FAST_8812F << BIT_SHIFT_REG_LPF_C1_FAST_8812F) -+#define BIT_CLEAR_REG_LPF_C1_FAST_8812F(x) ((x) & (~BITS_REG_LPF_C1_FAST_8812F)) -+#define BIT_GET_REG_LPF_C1_FAST_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C1_FAST_8812F) & \ -+ BIT_MASK_REG_LPF_C1_FAST_8812F) -+#define BIT_SET_REG_LPF_C1_FAST_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_C1_FAST_8812F(x) | BIT_REG_LPF_C1_FAST_8812F(v)) -+ -+#define BIT_SHIFT_REG_LPF_R3_V1_8812F 0 -+#define BIT_MASK_REG_LPF_R3_V1_8812F 0x3 -+#define BIT_REG_LPF_R3_V1_8812F(x) \ -+ (((x) & BIT_MASK_REG_LPF_R3_V1_8812F) << BIT_SHIFT_REG_LPF_R3_V1_8812F) -+#define BITS_REG_LPF_R3_V1_8812F \ -+ (BIT_MASK_REG_LPF_R3_V1_8812F << BIT_SHIFT_REG_LPF_R3_V1_8812F) -+#define BIT_CLEAR_REG_LPF_R3_V1_8812F(x) ((x) & (~BITS_REG_LPF_R3_V1_8812F)) -+#define BIT_GET_REG_LPF_R3_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R3_V1_8812F) & BIT_MASK_REG_LPF_R3_V1_8812F) -+#define BIT_SET_REG_LPF_R3_V1_8812F(x, v) \ -+ (BIT_CLEAR_REG_LPF_R3_V1_8812F(x) | BIT_REG_LPF_R3_V1_8812F(v)) -+ -+/* 2 REG_ANAPAR_MAC_2_8812F */ -+ -+#define BIT_SHIFT_AGPIO_DRV_V1_8812F 30 -+#define BIT_MASK_AGPIO_DRV_V1_8812F 0x3 -+#define BIT_AGPIO_DRV_V1_8812F(x) \ -+ (((x) & BIT_MASK_AGPIO_DRV_V1_8812F) << BIT_SHIFT_AGPIO_DRV_V1_8812F) -+#define BITS_AGPIO_DRV_V1_8812F \ -+ (BIT_MASK_AGPIO_DRV_V1_8812F << BIT_SHIFT_AGPIO_DRV_V1_8812F) -+#define BIT_CLEAR_AGPIO_DRV_V1_8812F(x) ((x) & (~BITS_AGPIO_DRV_V1_8812F)) -+#define BIT_GET_AGPIO_DRV_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_AGPIO_DRV_V1_8812F) & BIT_MASK_AGPIO_DRV_V1_8812F) -+#define BIT_SET_AGPIO_DRV_V1_8812F(x, v) \ -+ (BIT_CLEAR_AGPIO_DRV_V1_8812F(x) | BIT_AGPIO_DRV_V1_8812F(v)) -+ -+#define BIT_AGPIO_GPO_V1_8812F BIT(29) -+#define BIT_AGPIO_GPE_V1_8812F BIT(28) -+#define BIT_SEL_CLK_8812F BIT(27) -+ -+#define BIT_SHIFT_LS_XTAL_SEL_8812F 23 -+#define BIT_MASK_LS_XTAL_SEL_8812F 0xf -+#define BIT_LS_XTAL_SEL_8812F(x) \ -+ (((x) & BIT_MASK_LS_XTAL_SEL_8812F) << BIT_SHIFT_LS_XTAL_SEL_8812F) -+#define BITS_LS_XTAL_SEL_8812F \ -+ (BIT_MASK_LS_XTAL_SEL_8812F << BIT_SHIFT_LS_XTAL_SEL_8812F) -+#define BIT_CLEAR_LS_XTAL_SEL_8812F(x) ((x) & (~BITS_LS_XTAL_SEL_8812F)) -+#define BIT_GET_LS_XTAL_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_LS_XTAL_SEL_8812F) & BIT_MASK_LS_XTAL_SEL_8812F) -+#define BIT_SET_LS_XTAL_SEL_8812F(x, v) \ -+ (BIT_CLEAR_LS_XTAL_SEL_8812F(x) | BIT_LS_XTAL_SEL_8812F(v)) -+ -+#define BIT_LS_SDM_ORDER_V1_8812F BIT(22) -+#define BIT_LS_DELAY_PH_8812F BIT(21) -+#define BIT_DIVIDER_SEL_8812F BIT(20) -+ -+#define BIT_SHIFT_PCODE_8812F 15 -+#define BIT_MASK_PCODE_8812F 0x1f -+#define BIT_PCODE_8812F(x) \ -+ (((x) & BIT_MASK_PCODE_8812F) << BIT_SHIFT_PCODE_8812F) -+#define BITS_PCODE_8812F (BIT_MASK_PCODE_8812F << BIT_SHIFT_PCODE_8812F) -+#define BIT_CLEAR_PCODE_8812F(x) ((x) & (~BITS_PCODE_8812F)) -+#define BIT_GET_PCODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCODE_8812F) & BIT_MASK_PCODE_8812F) -+#define BIT_SET_PCODE_8812F(x, v) \ -+ (BIT_CLEAR_PCODE_8812F(x) | BIT_PCODE_8812F(v)) -+ -+#define BIT_SHIFT_NCODE_8812F 7 -+#define BIT_MASK_NCODE_8812F 0xff -+#define BIT_NCODE_8812F(x) \ -+ (((x) & BIT_MASK_NCODE_8812F) << BIT_SHIFT_NCODE_8812F) -+#define BITS_NCODE_8812F (BIT_MASK_NCODE_8812F << BIT_SHIFT_NCODE_8812F) -+#define BIT_CLEAR_NCODE_8812F(x) ((x) & (~BITS_NCODE_8812F)) -+#define BIT_GET_NCODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_NCODE_8812F) & BIT_MASK_NCODE_8812F) -+#define BIT_SET_NCODE_8812F(x, v) \ -+ (BIT_CLEAR_NCODE_8812F(x) | BIT_NCODE_8812F(v)) -+ -+#define BIT_REG_BEACON_8812F BIT(6) -+#define BIT_REG_MBIASE_8812F BIT(5) -+ -+#define BIT_SHIFT_REG_FAST_SEL_8812F 3 -+#define BIT_MASK_REG_FAST_SEL_8812F 0x3 -+#define BIT_REG_FAST_SEL_8812F(x) \ -+ (((x) & BIT_MASK_REG_FAST_SEL_8812F) << BIT_SHIFT_REG_FAST_SEL_8812F) -+#define BITS_REG_FAST_SEL_8812F \ -+ (BIT_MASK_REG_FAST_SEL_8812F << BIT_SHIFT_REG_FAST_SEL_8812F) -+#define BIT_CLEAR_REG_FAST_SEL_8812F(x) ((x) & (~BITS_REG_FAST_SEL_8812F)) -+#define BIT_GET_REG_FAST_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_FAST_SEL_8812F) & BIT_MASK_REG_FAST_SEL_8812F) -+#define BIT_SET_REG_FAST_SEL_8812F(x, v) \ -+ (BIT_CLEAR_REG_FAST_SEL_8812F(x) | BIT_REG_FAST_SEL_8812F(v)) -+ -+#define BIT_REG_CK960M_EN_8812F BIT(2) -+#define BIT_REG_CK320M_EN_8812F BIT(1) -+#define BIT_REG_CK_5M_EN_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_ANAPAR_XTAL_0_8812F */ -+#define BIT_XTAL_SC_LPS_8812F BIT(31) -+ -+#define BIT_SHIFT_XTAL_SC_INIT_8812F 24 -+#define BIT_MASK_XTAL_SC_INIT_8812F 0x7f -+#define BIT_XTAL_SC_INIT_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_SC_INIT_8812F) << BIT_SHIFT_XTAL_SC_INIT_8812F) -+#define BITS_XTAL_SC_INIT_8812F \ -+ (BIT_MASK_XTAL_SC_INIT_8812F << BIT_SHIFT_XTAL_SC_INIT_8812F) -+#define BIT_CLEAR_XTAL_SC_INIT_8812F(x) ((x) & (~BITS_XTAL_SC_INIT_8812F)) -+#define BIT_GET_XTAL_SC_INIT_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_INIT_8812F) & BIT_MASK_XTAL_SC_INIT_8812F) -+#define BIT_SET_XTAL_SC_INIT_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_SC_INIT_8812F(x) | BIT_XTAL_SC_INIT_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_SC_XO_8812F 17 -+#define BIT_MASK_XTAL_SC_XO_8812F 0x7f -+#define BIT_XTAL_SC_XO_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_SC_XO_8812F) << BIT_SHIFT_XTAL_SC_XO_8812F) -+#define BITS_XTAL_SC_XO_8812F \ -+ (BIT_MASK_XTAL_SC_XO_8812F << BIT_SHIFT_XTAL_SC_XO_8812F) -+#define BIT_CLEAR_XTAL_SC_XO_8812F(x) ((x) & (~BITS_XTAL_SC_XO_8812F)) -+#define BIT_GET_XTAL_SC_XO_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_XO_8812F) & BIT_MASK_XTAL_SC_XO_8812F) -+#define BIT_SET_XTAL_SC_XO_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_SC_XO_8812F(x) | BIT_XTAL_SC_XO_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_SC_XI_8812F 10 -+#define BIT_MASK_XTAL_SC_XI_8812F 0x7f -+#define BIT_XTAL_SC_XI_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_SC_XI_8812F) << BIT_SHIFT_XTAL_SC_XI_8812F) -+#define BITS_XTAL_SC_XI_8812F \ -+ (BIT_MASK_XTAL_SC_XI_8812F << BIT_SHIFT_XTAL_SC_XI_8812F) -+#define BIT_CLEAR_XTAL_SC_XI_8812F(x) ((x) & (~BITS_XTAL_SC_XI_8812F)) -+#define BIT_GET_XTAL_SC_XI_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_XI_8812F) & BIT_MASK_XTAL_SC_XI_8812F) -+#define BIT_SET_XTAL_SC_XI_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_SC_XI_8812F(x) | BIT_XTAL_SC_XI_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_GMN_V3_8812F 5 -+#define BIT_MASK_XTAL_GMN_V3_8812F 0x1f -+#define BIT_XTAL_GMN_V3_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_V3_8812F) << BIT_SHIFT_XTAL_GMN_V3_8812F) -+#define BITS_XTAL_GMN_V3_8812F \ -+ (BIT_MASK_XTAL_GMN_V3_8812F << BIT_SHIFT_XTAL_GMN_V3_8812F) -+#define BIT_CLEAR_XTAL_GMN_V3_8812F(x) ((x) & (~BITS_XTAL_GMN_V3_8812F)) -+#define BIT_GET_XTAL_GMN_V3_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_V3_8812F) & BIT_MASK_XTAL_GMN_V3_8812F) -+#define BIT_SET_XTAL_GMN_V3_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_V3_8812F(x) | BIT_XTAL_GMN_V3_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_GMP_V3_8812F 0 -+#define BIT_MASK_XTAL_GMP_V3_8812F 0x1f -+#define BIT_XTAL_GMP_V3_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_V3_8812F) << BIT_SHIFT_XTAL_GMP_V3_8812F) -+#define BITS_XTAL_GMP_V3_8812F \ -+ (BIT_MASK_XTAL_GMP_V3_8812F << BIT_SHIFT_XTAL_GMP_V3_8812F) -+#define BIT_CLEAR_XTAL_GMP_V3_8812F(x) ((x) & (~BITS_XTAL_GMP_V3_8812F)) -+#define BIT_GET_XTAL_GMP_V3_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_V3_8812F) & BIT_MASK_XTAL_GMP_V3_8812F) -+#define BIT_SET_XTAL_GMP_V3_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_V3_8812F(x) | BIT_XTAL_GMP_V3_8812F(v)) -+ -+/* 2 REG_ANAPAR_XTAL_1_8812F */ -+#define BIT_XTAL_SEL_TOK_V1_8812F BIT(31) -+#define BIT_XTAL_DELAY_DIGI_V2_8812F BIT(30) -+#define BIT_XTAL_DELAY_USB_V2_8812F BIT(29) -+#define BIT_XTAL_DELAY_AFE_V2_8812F BIT(28) -+ -+#define BIT_SHIFT_XTAL_DRV_DIGI_V2_8812F 26 -+#define BIT_MASK_XTAL_DRV_DIGI_V2_8812F 0x3 -+#define BIT_XTAL_DRV_DIGI_V2_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_DIGI_V2_8812F) \ -+ << BIT_SHIFT_XTAL_DRV_DIGI_V2_8812F) -+#define BITS_XTAL_DRV_DIGI_V2_8812F \ -+ (BIT_MASK_XTAL_DRV_DIGI_V2_8812F << BIT_SHIFT_XTAL_DRV_DIGI_V2_8812F) -+#define BIT_CLEAR_XTAL_DRV_DIGI_V2_8812F(x) \ -+ ((x) & (~BITS_XTAL_DRV_DIGI_V2_8812F)) -+#define BIT_GET_XTAL_DRV_DIGI_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_DIGI_V2_8812F) & \ -+ BIT_MASK_XTAL_DRV_DIGI_V2_8812F) -+#define BIT_SET_XTAL_DRV_DIGI_V2_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_DIGI_V2_8812F(x) | BIT_XTAL_DRV_DIGI_V2_8812F(v)) -+ -+#define BIT_EN_XTAL_DRV_LPS_8812F BIT(25) -+#define BIT_EN_XTAL_DRV_DIGI_V2_8812F BIT(24) -+ -+#define BIT_SHIFT_XTAL_DRV_USB_8812F 22 -+#define BIT_MASK_XTAL_DRV_USB_8812F 0x3 -+#define BIT_XTAL_DRV_USB_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_USB_8812F) << BIT_SHIFT_XTAL_DRV_USB_8812F) -+#define BITS_XTAL_DRV_USB_8812F \ -+ (BIT_MASK_XTAL_DRV_USB_8812F << BIT_SHIFT_XTAL_DRV_USB_8812F) -+#define BIT_CLEAR_XTAL_DRV_USB_8812F(x) ((x) & (~BITS_XTAL_DRV_USB_8812F)) -+#define BIT_GET_XTAL_DRV_USB_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_USB_8812F) & BIT_MASK_XTAL_DRV_USB_8812F) -+#define BIT_SET_XTAL_DRV_USB_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_USB_8812F(x) | BIT_XTAL_DRV_USB_8812F(v)) -+ -+#define BIT_EN_XTAL_DRV_USB_8812F BIT(21) -+ -+#define BIT_SHIFT_XTAL_DRV_AFE_V2_8812F 19 -+#define BIT_MASK_XTAL_DRV_AFE_V2_8812F 0x3 -+#define BIT_XTAL_DRV_AFE_V2_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_AFE_V2_8812F) \ -+ << BIT_SHIFT_XTAL_DRV_AFE_V2_8812F) -+#define BITS_XTAL_DRV_AFE_V2_8812F \ -+ (BIT_MASK_XTAL_DRV_AFE_V2_8812F << BIT_SHIFT_XTAL_DRV_AFE_V2_8812F) -+#define BIT_CLEAR_XTAL_DRV_AFE_V2_8812F(x) ((x) & (~BITS_XTAL_DRV_AFE_V2_8812F)) -+#define BIT_GET_XTAL_DRV_AFE_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_AFE_V2_8812F) & \ -+ BIT_MASK_XTAL_DRV_AFE_V2_8812F) -+#define BIT_SET_XTAL_DRV_AFE_V2_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_AFE_V2_8812F(x) | BIT_XTAL_DRV_AFE_V2_8812F(v)) -+ -+#define BIT_EN_XTAL_DRV_AFE_8812F BIT(18) -+ -+#define BIT_SHIFT_XTAL_DRV_RF2_V2_8812F 16 -+#define BIT_MASK_XTAL_DRV_RF2_V2_8812F 0x3 -+#define BIT_XTAL_DRV_RF2_V2_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF2_V2_8812F) \ -+ << BIT_SHIFT_XTAL_DRV_RF2_V2_8812F) -+#define BITS_XTAL_DRV_RF2_V2_8812F \ -+ (BIT_MASK_XTAL_DRV_RF2_V2_8812F << BIT_SHIFT_XTAL_DRV_RF2_V2_8812F) -+#define BIT_CLEAR_XTAL_DRV_RF2_V2_8812F(x) ((x) & (~BITS_XTAL_DRV_RF2_V2_8812F)) -+#define BIT_GET_XTAL_DRV_RF2_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF2_V2_8812F) & \ -+ BIT_MASK_XTAL_DRV_RF2_V2_8812F) -+#define BIT_SET_XTAL_DRV_RF2_V2_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF2_V2_8812F(x) | BIT_XTAL_DRV_RF2_V2_8812F(v)) -+ -+#define BIT_EN_XTAL_DRV_RF2_8812F BIT(15) -+ -+#define BIT_SHIFT_XTAL_DRV_RF1_8812F 13 -+#define BIT_MASK_XTAL_DRV_RF1_8812F 0x3 -+#define BIT_XTAL_DRV_RF1_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF1_8812F) << BIT_SHIFT_XTAL_DRV_RF1_8812F) -+#define BITS_XTAL_DRV_RF1_8812F \ -+ (BIT_MASK_XTAL_DRV_RF1_8812F << BIT_SHIFT_XTAL_DRV_RF1_8812F) -+#define BIT_CLEAR_XTAL_DRV_RF1_8812F(x) ((x) & (~BITS_XTAL_DRV_RF1_8812F)) -+#define BIT_GET_XTAL_DRV_RF1_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF1_8812F) & BIT_MASK_XTAL_DRV_RF1_8812F) -+#define BIT_SET_XTAL_DRV_RF1_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF1_8812F(x) | BIT_XTAL_DRV_RF1_8812F(v)) -+ -+#define BIT_EN_XTAL_DRV_RF1_8812F BIT(12) -+#define BIT_XTAL_DRV_RF_LATCH_V4_8812F BIT(11) -+#define BIT_XTAL_GM_SEP_V3_8812F BIT(10) -+#define BIT_XQSEL_RF_AWAKE_V3_8812F BIT(9) -+#define BIT_XQSEL_RF_INITIAL_V3_8812F BIT(8) -+#define BIT_XQSEL_V2_8812F BIT(7) -+#define BIT_GATED_XTAL_OK0_V2_8812F BIT(6) -+ -+#define BIT_SHIFT_XTAL_SC_LPS_V2_8812F 0 -+#define BIT_MASK_XTAL_SC_LPS_V2_8812F 0x3f -+#define BIT_XTAL_SC_LPS_V2_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_SC_LPS_V2_8812F) \ -+ << BIT_SHIFT_XTAL_SC_LPS_V2_8812F) -+#define BITS_XTAL_SC_LPS_V2_8812F \ -+ (BIT_MASK_XTAL_SC_LPS_V2_8812F << BIT_SHIFT_XTAL_SC_LPS_V2_8812F) -+#define BIT_CLEAR_XTAL_SC_LPS_V2_8812F(x) ((x) & (~BITS_XTAL_SC_LPS_V2_8812F)) -+#define BIT_GET_XTAL_SC_LPS_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_LPS_V2_8812F) & \ -+ BIT_MASK_XTAL_SC_LPS_V2_8812F) -+#define BIT_SET_XTAL_SC_LPS_V2_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_SC_LPS_V2_8812F(x) | BIT_XTAL_SC_LPS_V2_8812F(v)) -+ -+/* 2 REG_ANAPAR_XTAL_2_8812F */ -+#define BIT_XTAL_AAC_CAP_8812F BIT(31) -+ -+#define BIT_SHIFT_XTAL_PDSW_8812F 29 -+#define BIT_MASK_XTAL_PDSW_8812F 0x3 -+#define BIT_XTAL_PDSW_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_PDSW_8812F) << BIT_SHIFT_XTAL_PDSW_8812F) -+#define BITS_XTAL_PDSW_8812F \ -+ (BIT_MASK_XTAL_PDSW_8812F << BIT_SHIFT_XTAL_PDSW_8812F) -+#define BIT_CLEAR_XTAL_PDSW_8812F(x) ((x) & (~BITS_XTAL_PDSW_8812F)) -+#define BIT_GET_XTAL_PDSW_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_PDSW_8812F) & BIT_MASK_XTAL_PDSW_8812F) -+#define BIT_SET_XTAL_PDSW_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_PDSW_8812F(x) | BIT_XTAL_PDSW_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_LPS_BUF_VB_8812F 27 -+#define BIT_MASK_XTAL_LPS_BUF_VB_8812F 0x3 -+#define BIT_XTAL_LPS_BUF_VB_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_LPS_BUF_VB_8812F) \ -+ << BIT_SHIFT_XTAL_LPS_BUF_VB_8812F) -+#define BITS_XTAL_LPS_BUF_VB_8812F \ -+ (BIT_MASK_XTAL_LPS_BUF_VB_8812F << BIT_SHIFT_XTAL_LPS_BUF_VB_8812F) -+#define BIT_CLEAR_XTAL_LPS_BUF_VB_8812F(x) ((x) & (~BITS_XTAL_LPS_BUF_VB_8812F)) -+#define BIT_GET_XTAL_LPS_BUF_VB_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LPS_BUF_VB_8812F) & \ -+ BIT_MASK_XTAL_LPS_BUF_VB_8812F) -+#define BIT_SET_XTAL_LPS_BUF_VB_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_LPS_BUF_VB_8812F(x) | BIT_XTAL_LPS_BUF_VB_8812F(v)) -+ -+#define BIT_XTAL_PDCK_MANU_8812F BIT(26) -+#define BIT_XTAL_PDCK_OK_MANU_8812F BIT(25) -+ -+#define BIT_SHIFT_XTAL_VREF_SEL_8812F 20 -+#define BIT_MASK_XTAL_VREF_SEL_8812F 0x1f -+#define BIT_XTAL_VREF_SEL_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_VREF_SEL_8812F) << BIT_SHIFT_XTAL_VREF_SEL_8812F) -+#define BITS_XTAL_VREF_SEL_8812F \ -+ (BIT_MASK_XTAL_VREF_SEL_8812F << BIT_SHIFT_XTAL_VREF_SEL_8812F) -+#define BIT_CLEAR_XTAL_VREF_SEL_8812F(x) ((x) & (~BITS_XTAL_VREF_SEL_8812F)) -+#define BIT_GET_XTAL_VREF_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_VREF_SEL_8812F) & BIT_MASK_XTAL_VREF_SEL_8812F) -+#define BIT_SET_XTAL_VREF_SEL_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_VREF_SEL_8812F(x) | BIT_XTAL_VREF_SEL_8812F(v)) -+ -+#define BIT_EN_XTAL_PDCK_VREF_8812F BIT(19) -+#define BIT_XTAL_SEL_PWR_V1_8812F BIT(18) -+#define BIT_XTAL_LPS_DIVISOR_8812F BIT(17) -+#define BIT_XTAL_CKDIGI_SEL_8812F BIT(16) -+#define BIT_EN_XTAL_LPS_CLK_8812F BIT(15) -+#define BIT_EN_XTAL_SCHMITT_8812F BIT(14) -+#define BIT_XTAL_PK_SEL_OFFSET_8812F BIT(13) -+ -+#define BIT_SHIFT_XTAL_MANU_PK_SEL_8812F 11 -+#define BIT_MASK_XTAL_MANU_PK_SEL_8812F 0x3 -+#define BIT_XTAL_MANU_PK_SEL_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_MANU_PK_SEL_8812F) \ -+ << BIT_SHIFT_XTAL_MANU_PK_SEL_8812F) -+#define BITS_XTAL_MANU_PK_SEL_8812F \ -+ (BIT_MASK_XTAL_MANU_PK_SEL_8812F << BIT_SHIFT_XTAL_MANU_PK_SEL_8812F) -+#define BIT_CLEAR_XTAL_MANU_PK_SEL_8812F(x) \ -+ ((x) & (~BITS_XTAL_MANU_PK_SEL_8812F)) -+#define BIT_GET_XTAL_MANU_PK_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_MANU_PK_SEL_8812F) & \ -+ BIT_MASK_XTAL_MANU_PK_SEL_8812F) -+#define BIT_SET_XTAL_MANU_PK_SEL_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_MANU_PK_SEL_8812F(x) | BIT_XTAL_MANU_PK_SEL_8812F(v)) -+ -+#define BIT_XTAL_AACK_PK_MANU_8812F BIT(10) -+#define BIT_EN_XTAL_AAC_PKDET_V1_8812F BIT(9) -+#define BIT_EN_XTAL_AAC_GM_V1_8812F BIT(8) -+#define BIT_XTAL_LDO_OPVB_SEL_8812F BIT(7) -+#define BIT_XTAL_LDO_NC_8812F BIT(6) -+ -+#define BIT_SHIFT_XTAL_LDO_VREF_V2_8812F 3 -+#define BIT_MASK_XTAL_LDO_VREF_V2_8812F 0x7 -+#define BIT_XTAL_LDO_VREF_V2_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_VREF_V2_8812F) \ -+ << BIT_SHIFT_XTAL_LDO_VREF_V2_8812F) -+#define BITS_XTAL_LDO_VREF_V2_8812F \ -+ (BIT_MASK_XTAL_LDO_VREF_V2_8812F << BIT_SHIFT_XTAL_LDO_VREF_V2_8812F) -+#define BIT_CLEAR_XTAL_LDO_VREF_V2_8812F(x) \ -+ ((x) & (~BITS_XTAL_LDO_VREF_V2_8812F)) -+#define BIT_GET_XTAL_LDO_VREF_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_VREF_V2_8812F) & \ -+ BIT_MASK_XTAL_LDO_VREF_V2_8812F) -+#define BIT_SET_XTAL_LDO_VREF_V2_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_VREF_V2_8812F(x) | BIT_XTAL_LDO_VREF_V2_8812F(v)) -+ -+#define BIT_XTAL_LPMODE_V1_8812F BIT(2) -+ -+#define BIT_SHIFT_XTAL_SEL_TOK_V3_8812F 0 -+#define BIT_MASK_XTAL_SEL_TOK_V3_8812F 0x3 -+#define BIT_XTAL_SEL_TOK_V3_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_TOK_V3_8812F) \ -+ << BIT_SHIFT_XTAL_SEL_TOK_V3_8812F) -+#define BITS_XTAL_SEL_TOK_V3_8812F \ -+ (BIT_MASK_XTAL_SEL_TOK_V3_8812F << BIT_SHIFT_XTAL_SEL_TOK_V3_8812F) -+#define BIT_CLEAR_XTAL_SEL_TOK_V3_8812F(x) ((x) & (~BITS_XTAL_SEL_TOK_V3_8812F)) -+#define BIT_GET_XTAL_SEL_TOK_V3_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_TOK_V3_8812F) & \ -+ BIT_MASK_XTAL_SEL_TOK_V3_8812F) -+#define BIT_SET_XTAL_SEL_TOK_V3_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_TOK_V3_8812F(x) | BIT_XTAL_SEL_TOK_V3_8812F(v)) -+ -+/* 2 REG_ANAPAR_XTAL_3_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_XTAL_DUMMY_V1_8812F 7 -+#define BIT_MASK_XTAL_DUMMY_V1_8812F 0x3f -+#define BIT_XTAL_DUMMY_V1_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_DUMMY_V1_8812F) << BIT_SHIFT_XTAL_DUMMY_V1_8812F) -+#define BITS_XTAL_DUMMY_V1_8812F \ -+ (BIT_MASK_XTAL_DUMMY_V1_8812F << BIT_SHIFT_XTAL_DUMMY_V1_8812F) -+#define BIT_CLEAR_XTAL_DUMMY_V1_8812F(x) ((x) & (~BITS_XTAL_DUMMY_V1_8812F)) -+#define BIT_GET_XTAL_DUMMY_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DUMMY_V1_8812F) & BIT_MASK_XTAL_DUMMY_V1_8812F) -+#define BIT_SET_XTAL_DUMMY_V1_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_DUMMY_V1_8812F(x) | BIT_XTAL_DUMMY_V1_8812F(v)) -+ -+#define BIT_XTAL_EN_LNBUF_8812F BIT(6) -+#define BIT_XTAL__AAC_TIE_MID_8812F BIT(5) -+ -+#define BIT_SHIFT_XTAL_AAC_OPCUR_8812F 3 -+#define BIT_MASK_XTAL_AAC_OPCUR_8812F 0x3 -+#define BIT_XTAL_AAC_OPCUR_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_AAC_OPCUR_8812F) \ -+ << BIT_SHIFT_XTAL_AAC_OPCUR_8812F) -+#define BITS_XTAL_AAC_OPCUR_8812F \ -+ (BIT_MASK_XTAL_AAC_OPCUR_8812F << BIT_SHIFT_XTAL_AAC_OPCUR_8812F) -+#define BIT_CLEAR_XTAL_AAC_OPCUR_8812F(x) ((x) & (~BITS_XTAL_AAC_OPCUR_8812F)) -+#define BIT_GET_XTAL_AAC_OPCUR_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_AAC_OPCUR_8812F) & \ -+ BIT_MASK_XTAL_AAC_OPCUR_8812F) -+#define BIT_SET_XTAL_AAC_OPCUR_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_AAC_OPCUR_8812F(x) | BIT_XTAL_AAC_OPCUR_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_AAC_IOFFSET_8812F 1 -+#define BIT_MASK_XTAL_AAC_IOFFSET_8812F 0x3 -+#define BIT_XTAL_AAC_IOFFSET_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_AAC_IOFFSET_8812F) \ -+ << BIT_SHIFT_XTAL_AAC_IOFFSET_8812F) -+#define BITS_XTAL_AAC_IOFFSET_8812F \ -+ (BIT_MASK_XTAL_AAC_IOFFSET_8812F << BIT_SHIFT_XTAL_AAC_IOFFSET_8812F) -+#define BIT_CLEAR_XTAL_AAC_IOFFSET_8812F(x) \ -+ ((x) & (~BITS_XTAL_AAC_IOFFSET_8812F)) -+#define BIT_GET_XTAL_AAC_IOFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_AAC_IOFFSET_8812F) & \ -+ BIT_MASK_XTAL_AAC_IOFFSET_8812F) -+#define BIT_SET_XTAL_AAC_IOFFSET_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_AAC_IOFFSET_8812F(x) | BIT_XTAL_AAC_IOFFSET_8812F(v)) -+ -+#define BIT_XTAL_AAC_CAP_V1_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_ANAPAR_XTAL_AACK_0_8812F */ -+#define BIT_XAAC_LPOW_8812F BIT(31) -+ -+#define BIT_SHIFT_AAC_MODE_8812F 29 -+#define BIT_MASK_AAC_MODE_8812F 0x3 -+#define BIT_AAC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_AAC_MODE_8812F) << BIT_SHIFT_AAC_MODE_8812F) -+#define BITS_AAC_MODE_8812F \ -+ (BIT_MASK_AAC_MODE_8812F << BIT_SHIFT_AAC_MODE_8812F) -+#define BIT_CLEAR_AAC_MODE_8812F(x) ((x) & (~BITS_AAC_MODE_8812F)) -+#define BIT_GET_AAC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_AAC_MODE_8812F) & BIT_MASK_AAC_MODE_8812F) -+#define BIT_SET_AAC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_AAC_MODE_8812F(x) | BIT_AAC_MODE_8812F(v)) -+ -+#define BIT_EN_XTAL_AAC_TRIG_8812F BIT(28) -+#define BIT_EN_XTAL_AAC_8812F BIT(27) -+#define BIT_EN_XTAL_AAC_DIGI_8812F BIT(26) -+ -+#define BIT_SHIFT_GM_MANUAL_8812F 21 -+#define BIT_MASK_GM_MANUAL_8812F 0x1f -+#define BIT_GM_MANUAL_8812F(x) \ -+ (((x) & BIT_MASK_GM_MANUAL_8812F) << BIT_SHIFT_GM_MANUAL_8812F) -+#define BITS_GM_MANUAL_8812F \ -+ (BIT_MASK_GM_MANUAL_8812F << BIT_SHIFT_GM_MANUAL_8812F) -+#define BIT_CLEAR_GM_MANUAL_8812F(x) ((x) & (~BITS_GM_MANUAL_8812F)) -+#define BIT_GET_GM_MANUAL_8812F(x) \ -+ (((x) >> BIT_SHIFT_GM_MANUAL_8812F) & BIT_MASK_GM_MANUAL_8812F) -+#define BIT_SET_GM_MANUAL_8812F(x, v) \ -+ (BIT_CLEAR_GM_MANUAL_8812F(x) | BIT_GM_MANUAL_8812F(v)) -+ -+#define BIT_SHIFT_GM_STUP_8812F 16 -+#define BIT_MASK_GM_STUP_8812F 0x1f -+#define BIT_GM_STUP_8812F(x) \ -+ (((x) & BIT_MASK_GM_STUP_8812F) << BIT_SHIFT_GM_STUP_8812F) -+#define BITS_GM_STUP_8812F (BIT_MASK_GM_STUP_8812F << BIT_SHIFT_GM_STUP_8812F) -+#define BIT_CLEAR_GM_STUP_8812F(x) ((x) & (~BITS_GM_STUP_8812F)) -+#define BIT_GET_GM_STUP_8812F(x) \ -+ (((x) >> BIT_SHIFT_GM_STUP_8812F) & BIT_MASK_GM_STUP_8812F) -+#define BIT_SET_GM_STUP_8812F(x, v) \ -+ (BIT_CLEAR_GM_STUP_8812F(x) | BIT_GM_STUP_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_CK_SET_8812F 13 -+#define BIT_MASK_XTAL_CK_SET_8812F 0x7 -+#define BIT_XTAL_CK_SET_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_CK_SET_8812F) << BIT_SHIFT_XTAL_CK_SET_8812F) -+#define BITS_XTAL_CK_SET_8812F \ -+ (BIT_MASK_XTAL_CK_SET_8812F << BIT_SHIFT_XTAL_CK_SET_8812F) -+#define BIT_CLEAR_XTAL_CK_SET_8812F(x) ((x) & (~BITS_XTAL_CK_SET_8812F)) -+#define BIT_GET_XTAL_CK_SET_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CK_SET_8812F) & BIT_MASK_XTAL_CK_SET_8812F) -+#define BIT_SET_XTAL_CK_SET_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_CK_SET_8812F(x) | BIT_XTAL_CK_SET_8812F(v)) -+ -+#define BIT_SHIFT_GM_INIT_8812F 8 -+#define BIT_MASK_GM_INIT_8812F 0x1f -+#define BIT_GM_INIT_8812F(x) \ -+ (((x) & BIT_MASK_GM_INIT_8812F) << BIT_SHIFT_GM_INIT_8812F) -+#define BITS_GM_INIT_8812F (BIT_MASK_GM_INIT_8812F << BIT_SHIFT_GM_INIT_8812F) -+#define BIT_CLEAR_GM_INIT_8812F(x) ((x) & (~BITS_GM_INIT_8812F)) -+#define BIT_GET_GM_INIT_8812F(x) \ -+ (((x) >> BIT_SHIFT_GM_INIT_8812F) & BIT_MASK_GM_INIT_8812F) -+#define BIT_SET_GM_INIT_8812F(x, v) \ -+ (BIT_CLEAR_GM_INIT_8812F(x) | BIT_GM_INIT_8812F(v)) -+ -+#define BIT_GM_STEP_8812F BIT(7) -+ -+#define BIT_SHIFT_XAAC_GM_OFFSET_8812F 2 -+#define BIT_MASK_XAAC_GM_OFFSET_8812F 0x1f -+#define BIT_XAAC_GM_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_XAAC_GM_OFFSET_8812F) \ -+ << BIT_SHIFT_XAAC_GM_OFFSET_8812F) -+#define BITS_XAAC_GM_OFFSET_8812F \ -+ (BIT_MASK_XAAC_GM_OFFSET_8812F << BIT_SHIFT_XAAC_GM_OFFSET_8812F) -+#define BIT_CLEAR_XAAC_GM_OFFSET_8812F(x) ((x) & (~BITS_XAAC_GM_OFFSET_8812F)) -+#define BIT_GET_XAAC_GM_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_XAAC_GM_OFFSET_8812F) & \ -+ BIT_MASK_XAAC_GM_OFFSET_8812F) -+#define BIT_SET_XAAC_GM_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_XAAC_GM_OFFSET_8812F(x) | BIT_XAAC_GM_OFFSET_8812F(v)) -+ -+#define BIT_OFFSET_PLUS_8812F BIT(1) -+#define BIT_RESET_N_8812F BIT(0) -+ -+/* 2 REG_ANAPAR_XTAL_AACK_1_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_PK_END_AR_8812F 3 -+#define BIT_MASK_PK_END_AR_8812F 0x3 -+#define BIT_PK_END_AR_8812F(x) \ -+ (((x) & BIT_MASK_PK_END_AR_8812F) << BIT_SHIFT_PK_END_AR_8812F) -+#define BITS_PK_END_AR_8812F \ -+ (BIT_MASK_PK_END_AR_8812F << BIT_SHIFT_PK_END_AR_8812F) -+#define BIT_CLEAR_PK_END_AR_8812F(x) ((x) & (~BITS_PK_END_AR_8812F)) -+#define BIT_GET_PK_END_AR_8812F(x) \ -+ (((x) >> BIT_SHIFT_PK_END_AR_8812F) & BIT_MASK_PK_END_AR_8812F) -+#define BIT_SET_PK_END_AR_8812F(x, v) \ -+ (BIT_CLEAR_PK_END_AR_8812F(x) | BIT_PK_END_AR_8812F(v)) -+ -+#define BIT_SHIFT_PK_START_AR_8812F 1 -+#define BIT_MASK_PK_START_AR_8812F 0x3 -+#define BIT_PK_START_AR_8812F(x) \ -+ (((x) & BIT_MASK_PK_START_AR_8812F) << BIT_SHIFT_PK_START_AR_8812F) -+#define BITS_PK_START_AR_8812F \ -+ (BIT_MASK_PK_START_AR_8812F << BIT_SHIFT_PK_START_AR_8812F) -+#define BIT_CLEAR_PK_START_AR_8812F(x) ((x) & (~BITS_PK_START_AR_8812F)) -+#define BIT_GET_PK_START_AR_8812F(x) \ -+ (((x) >> BIT_SHIFT_PK_START_AR_8812F) & BIT_MASK_PK_START_AR_8812F) -+#define BIT_SET_PK_START_AR_8812F(x, v) \ -+ (BIT_CLEAR_PK_START_AR_8812F(x) | BIT_PK_START_AR_8812F(v)) -+ -+#define BIT_XAAC_LUT_MANUAL_EN_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_ANAPAR_XTAL_MODE_DECODER_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_XTAL_LDO_LPS_8812F 21 -+#define BIT_MASK_XTAL_LDO_LPS_8812F 0x7 -+#define BIT_XTAL_LDO_LPS_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_LPS_8812F) << BIT_SHIFT_XTAL_LDO_LPS_8812F) -+#define BITS_XTAL_LDO_LPS_8812F \ -+ (BIT_MASK_XTAL_LDO_LPS_8812F << BIT_SHIFT_XTAL_LDO_LPS_8812F) -+#define BIT_CLEAR_XTAL_LDO_LPS_8812F(x) ((x) & (~BITS_XTAL_LDO_LPS_8812F)) -+#define BIT_GET_XTAL_LDO_LPS_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_LPS_8812F) & BIT_MASK_XTAL_LDO_LPS_8812F) -+#define BIT_SET_XTAL_LDO_LPS_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_LPS_8812F(x) | BIT_XTAL_LDO_LPS_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_WAIT_CYC_8812F 15 -+#define BIT_MASK_XTAL_WAIT_CYC_8812F 0x3f -+#define BIT_XTAL_WAIT_CYC_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_WAIT_CYC_8812F) << BIT_SHIFT_XTAL_WAIT_CYC_8812F) -+#define BITS_XTAL_WAIT_CYC_8812F \ -+ (BIT_MASK_XTAL_WAIT_CYC_8812F << BIT_SHIFT_XTAL_WAIT_CYC_8812F) -+#define BIT_CLEAR_XTAL_WAIT_CYC_8812F(x) ((x) & (~BITS_XTAL_WAIT_CYC_8812F)) -+#define BIT_GET_XTAL_WAIT_CYC_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_WAIT_CYC_8812F) & BIT_MASK_XTAL_WAIT_CYC_8812F) -+#define BIT_SET_XTAL_WAIT_CYC_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_WAIT_CYC_8812F(x) | BIT_XTAL_WAIT_CYC_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_LDO_OK_8812F 12 -+#define BIT_MASK_XTAL_LDO_OK_8812F 0x7 -+#define BIT_XTAL_LDO_OK_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_OK_8812F) << BIT_SHIFT_XTAL_LDO_OK_8812F) -+#define BITS_XTAL_LDO_OK_8812F \ -+ (BIT_MASK_XTAL_LDO_OK_8812F << BIT_SHIFT_XTAL_LDO_OK_8812F) -+#define BIT_CLEAR_XTAL_LDO_OK_8812F(x) ((x) & (~BITS_XTAL_LDO_OK_8812F)) -+#define BIT_GET_XTAL_LDO_OK_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_OK_8812F) & BIT_MASK_XTAL_LDO_OK_8812F) -+#define BIT_SET_XTAL_LDO_OK_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_OK_8812F(x) | BIT_XTAL_LDO_OK_8812F(v)) -+ -+#define BIT_XTAL_MD_LPOW_8812F BIT(11) -+ -+#define BIT_SHIFT_XTAL_OV_RATIO_8812F 9 -+#define BIT_MASK_XTAL_OV_RATIO_8812F 0x3 -+#define BIT_XTAL_OV_RATIO_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_OV_RATIO_8812F) << BIT_SHIFT_XTAL_OV_RATIO_8812F) -+#define BITS_XTAL_OV_RATIO_8812F \ -+ (BIT_MASK_XTAL_OV_RATIO_8812F << BIT_SHIFT_XTAL_OV_RATIO_8812F) -+#define BIT_CLEAR_XTAL_OV_RATIO_8812F(x) ((x) & (~BITS_XTAL_OV_RATIO_8812F)) -+#define BIT_GET_XTAL_OV_RATIO_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_OV_RATIO_8812F) & BIT_MASK_XTAL_OV_RATIO_8812F) -+#define BIT_SET_XTAL_OV_RATIO_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_OV_RATIO_8812F(x) | BIT_XTAL_OV_RATIO_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_OV_UNIT_8812F 6 -+#define BIT_MASK_XTAL_OV_UNIT_8812F 0x7 -+#define BIT_XTAL_OV_UNIT_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_OV_UNIT_8812F) << BIT_SHIFT_XTAL_OV_UNIT_8812F) -+#define BITS_XTAL_OV_UNIT_8812F \ -+ (BIT_MASK_XTAL_OV_UNIT_8812F << BIT_SHIFT_XTAL_OV_UNIT_8812F) -+#define BIT_CLEAR_XTAL_OV_UNIT_8812F(x) ((x) & (~BITS_XTAL_OV_UNIT_8812F)) -+#define BIT_GET_XTAL_OV_UNIT_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_OV_UNIT_8812F) & BIT_MASK_XTAL_OV_UNIT_8812F) -+#define BIT_SET_XTAL_OV_UNIT_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_OV_UNIT_8812F(x) | BIT_XTAL_OV_UNIT_8812F(v)) -+ -+#define BIT_SHIFT_XTAL_MODE_MANUAL_8812F 4 -+#define BIT_MASK_XTAL_MODE_MANUAL_8812F 0x3 -+#define BIT_XTAL_MODE_MANUAL_8812F(x) \ -+ (((x) & BIT_MASK_XTAL_MODE_MANUAL_8812F) \ -+ << BIT_SHIFT_XTAL_MODE_MANUAL_8812F) -+#define BITS_XTAL_MODE_MANUAL_8812F \ -+ (BIT_MASK_XTAL_MODE_MANUAL_8812F << BIT_SHIFT_XTAL_MODE_MANUAL_8812F) -+#define BIT_CLEAR_XTAL_MODE_MANUAL_8812F(x) \ -+ ((x) & (~BITS_XTAL_MODE_MANUAL_8812F)) -+#define BIT_GET_XTAL_MODE_MANUAL_8812F(x) \ -+ (((x) >> BIT_SHIFT_XTAL_MODE_MANUAL_8812F) & \ -+ BIT_MASK_XTAL_MODE_MANUAL_8812F) -+#define BIT_SET_XTAL_MODE_MANUAL_8812F(x, v) \ -+ (BIT_CLEAR_XTAL_MODE_MANUAL_8812F(x) | BIT_XTAL_MODE_MANUAL_8812F(v)) -+ -+#define BIT_XTAL_MANU_SEL_8812F BIT(3) -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_XTAL_MODE_8812F BIT(1) -+#define BIT_RESET_N_DECODER_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_SYS_CFG5_8812F */ -+#define BIT_LPS_STATUS_8812F BIT(3) -+#define BIT_HCI_TXDMA_BUSY_8812F BIT(2) -+#define BIT_HCI_TXDMA_ALLOW_8812F BIT(1) -+#define BIT_FW_CTRL_HCI_TXDMA_EN_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_REGU_32K_1_8812F */ -+#define BIT_OUT_SEL_8812F BIT(26) -+ -+#define BIT_SHIFT_FREQ_SEL_8812F 24 -+#define BIT_MASK_FREQ_SEL_8812F 0x3 -+#define BIT_FREQ_SEL_8812F(x) \ -+ (((x) & BIT_MASK_FREQ_SEL_8812F) << BIT_SHIFT_FREQ_SEL_8812F) -+#define BITS_FREQ_SEL_8812F \ -+ (BIT_MASK_FREQ_SEL_8812F << BIT_SHIFT_FREQ_SEL_8812F) -+#define BIT_CLEAR_FREQ_SEL_8812F(x) ((x) & (~BITS_FREQ_SEL_8812F)) -+#define BIT_GET_FREQ_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_FREQ_SEL_8812F) & BIT_MASK_FREQ_SEL_8812F) -+#define BIT_SET_FREQ_SEL_8812F(x, v) \ -+ (BIT_CLEAR_FREQ_SEL_8812F(x) | BIT_FREQ_SEL_8812F(v)) -+ -+#define BIT_SHIFT_CLKGEN0_8812F 16 -+#define BIT_MASK_CLKGEN0_8812F 0xff -+#define BIT_CLKGEN0_8812F(x) \ -+ (((x) & BIT_MASK_CLKGEN0_8812F) << BIT_SHIFT_CLKGEN0_8812F) -+#define BITS_CLKGEN0_8812F (BIT_MASK_CLKGEN0_8812F << BIT_SHIFT_CLKGEN0_8812F) -+#define BIT_CLEAR_CLKGEN0_8812F(x) ((x) & (~BITS_CLKGEN0_8812F)) -+#define BIT_GET_CLKGEN0_8812F(x) \ -+ (((x) >> BIT_SHIFT_CLKGEN0_8812F) & BIT_MASK_CLKGEN0_8812F) -+#define BIT_SET_CLKGEN0_8812F(x, v) \ -+ (BIT_CLEAR_CLKGEN0_8812F(x) | BIT_CLKGEN0_8812F(v)) -+ -+#define BIT_SHIFT_TEMP_COMP_8812F 12 -+#define BIT_MASK_TEMP_COMP_8812F 0xf -+#define BIT_TEMP_COMP_8812F(x) \ -+ (((x) & BIT_MASK_TEMP_COMP_8812F) << BIT_SHIFT_TEMP_COMP_8812F) -+#define BITS_TEMP_COMP_8812F \ -+ (BIT_MASK_TEMP_COMP_8812F << BIT_SHIFT_TEMP_COMP_8812F) -+#define BIT_CLEAR_TEMP_COMP_8812F(x) ((x) & (~BITS_TEMP_COMP_8812F)) -+#define BIT_GET_TEMP_COMP_8812F(x) \ -+ (((x) >> BIT_SHIFT_TEMP_COMP_8812F) & BIT_MASK_TEMP_COMP_8812F) -+#define BIT_SET_TEMP_COMP_8812F(x, v) \ -+ (BIT_CLEAR_TEMP_COMP_8812F(x) | BIT_TEMP_COMP_8812F(v)) -+ -+#define BIT_SHIFT_LDO_V18ADJ_8812F 8 -+#define BIT_MASK_LDO_V18ADJ_8812F 0xf -+#define BIT_LDO_V18ADJ_8812F(x) \ -+ (((x) & BIT_MASK_LDO_V18ADJ_8812F) << BIT_SHIFT_LDO_V18ADJ_8812F) -+#define BITS_LDO_V18ADJ_8812F \ -+ (BIT_MASK_LDO_V18ADJ_8812F << BIT_SHIFT_LDO_V18ADJ_8812F) -+#define BIT_CLEAR_LDO_V18ADJ_8812F(x) ((x) & (~BITS_LDO_V18ADJ_8812F)) -+#define BIT_GET_LDO_V18ADJ_8812F(x) \ -+ (((x) >> BIT_SHIFT_LDO_V18ADJ_8812F) & BIT_MASK_LDO_V18ADJ_8812F) -+#define BIT_SET_LDO_V18ADJ_8812F(x, v) \ -+ (BIT_CLEAR_LDO_V18ADJ_8812F(x) | BIT_LDO_V18ADJ_8812F(v)) -+ -+#define BIT_SHIFT_COMP_LOAD_CUR_8812F 5 -+#define BIT_MASK_COMP_LOAD_CUR_8812F 0x3 -+#define BIT_COMP_LOAD_CUR_8812F(x) \ -+ (((x) & BIT_MASK_COMP_LOAD_CUR_8812F) << BIT_SHIFT_COMP_LOAD_CUR_8812F) -+#define BITS_COMP_LOAD_CUR_8812F \ -+ (BIT_MASK_COMP_LOAD_CUR_8812F << BIT_SHIFT_COMP_LOAD_CUR_8812F) -+#define BIT_CLEAR_COMP_LOAD_CUR_8812F(x) ((x) & (~BITS_COMP_LOAD_CUR_8812F)) -+#define BIT_GET_COMP_LOAD_CUR_8812F(x) \ -+ (((x) >> BIT_SHIFT_COMP_LOAD_CUR_8812F) & BIT_MASK_COMP_LOAD_CUR_8812F) -+#define BIT_SET_COMP_LOAD_CUR_8812F(x, v) \ -+ (BIT_CLEAR_COMP_LOAD_CUR_8812F(x) | BIT_COMP_LOAD_CUR_8812F(v)) -+ -+#define BIT_SHIFT_COMP_LATCH_CUR_8812F 3 -+#define BIT_MASK_COMP_LATCH_CUR_8812F 0x3 -+#define BIT_COMP_LATCH_CUR_8812F(x) \ -+ (((x) & BIT_MASK_COMP_LATCH_CUR_8812F) \ -+ << BIT_SHIFT_COMP_LATCH_CUR_8812F) -+#define BITS_COMP_LATCH_CUR_8812F \ -+ (BIT_MASK_COMP_LATCH_CUR_8812F << BIT_SHIFT_COMP_LATCH_CUR_8812F) -+#define BIT_CLEAR_COMP_LATCH_CUR_8812F(x) ((x) & (~BITS_COMP_LATCH_CUR_8812F)) -+#define BIT_GET_COMP_LATCH_CUR_8812F(x) \ -+ (((x) >> BIT_SHIFT_COMP_LATCH_CUR_8812F) & \ -+ BIT_MASK_COMP_LATCH_CUR_8812F) -+#define BIT_SET_COMP_LATCH_CUR_8812F(x, v) \ -+ (BIT_CLEAR_COMP_LATCH_CUR_8812F(x) | BIT_COMP_LATCH_CUR_8812F(v)) -+ -+#define BIT_SHIFT_COMP_GM_CUR_8812F 1 -+#define BIT_MASK_COMP_GM_CUR_8812F 0x3 -+#define BIT_COMP_GM_CUR_8812F(x) \ -+ (((x) & BIT_MASK_COMP_GM_CUR_8812F) << BIT_SHIFT_COMP_GM_CUR_8812F) -+#define BITS_COMP_GM_CUR_8812F \ -+ (BIT_MASK_COMP_GM_CUR_8812F << BIT_SHIFT_COMP_GM_CUR_8812F) -+#define BIT_CLEAR_COMP_GM_CUR_8812F(x) ((x) & (~BITS_COMP_GM_CUR_8812F)) -+#define BIT_GET_COMP_GM_CUR_8812F(x) \ -+ (((x) >> BIT_SHIFT_COMP_GM_CUR_8812F) & BIT_MASK_COMP_GM_CUR_8812F) -+#define BIT_SET_COMP_GM_CUR_8812F(x, v) \ -+ (BIT_CLEAR_COMP_GM_CUR_8812F(x) | BIT_COMP_GM_CUR_8812F(v)) -+ -+/* 2 REG_REGU_32K_2_8812F */ -+#define BIT_SEL_RCAL_SOURCE_8812F BIT(16) -+ -+#define BIT_SHIFT_RCAL_8812F 0 -+#define BIT_MASK_RCAL_8812F 0x3f -+#define BIT_RCAL_8812F(x) (((x) & BIT_MASK_RCAL_8812F) << BIT_SHIFT_RCAL_8812F) -+#define BITS_RCAL_8812F (BIT_MASK_RCAL_8812F << BIT_SHIFT_RCAL_8812F) -+#define BIT_CLEAR_RCAL_8812F(x) ((x) & (~BITS_RCAL_8812F)) -+#define BIT_GET_RCAL_8812F(x) \ -+ (((x) >> BIT_SHIFT_RCAL_8812F) & BIT_MASK_RCAL_8812F) -+#define BIT_SET_RCAL_8812F(x, v) (BIT_CLEAR_RCAL_8812F(x) | BIT_RCAL_8812F(v)) -+ -+/* 2 REG_CPU_DMEM_CON_8812F */ -+#define BIT_WDT_AUTO_MODE_8812F BIT(22) -+#define BIT_WDT_PLATFORM_EN_8812F BIT(21) -+#define BIT_WDT_CPU_EN_8812F BIT(20) -+#define BIT_WDT_OPT_IOWRAPPER_8812F BIT(19) -+#define BIT_ANA_PORT_IDLE_8812F BIT(18) -+#define BIT_MAC_PORT_IDLE_8812F BIT(17) -+#define BIT_WL_PLATFORM_RST_8812F BIT(16) -+#define BIT_WL_SECURITY_CLK_8812F BIT(15) -+#define BIT_DDMA_EN_8812F BIT(8) -+ -+#define BIT_SHIFT_CPU_DMEM_CON_8812F 0 -+#define BIT_MASK_CPU_DMEM_CON_8812F 0xff -+#define BIT_CPU_DMEM_CON_8812F(x) \ -+ (((x) & BIT_MASK_CPU_DMEM_CON_8812F) << BIT_SHIFT_CPU_DMEM_CON_8812F) -+#define BITS_CPU_DMEM_CON_8812F \ -+ (BIT_MASK_CPU_DMEM_CON_8812F << BIT_SHIFT_CPU_DMEM_CON_8812F) -+#define BIT_CLEAR_CPU_DMEM_CON_8812F(x) ((x) & (~BITS_CPU_DMEM_CON_8812F)) -+#define BIT_GET_CPU_DMEM_CON_8812F(x) \ -+ (((x) >> BIT_SHIFT_CPU_DMEM_CON_8812F) & BIT_MASK_CPU_DMEM_CON_8812F) -+#define BIT_SET_CPU_DMEM_CON_8812F(x, v) \ -+ (BIT_CLEAR_CPU_DMEM_CON_8812F(x) | BIT_CPU_DMEM_CON_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_BOOT_REASON_8812F */ -+ -+#define BIT_SHIFT_BOOT_REASON_V1_8812F 0 -+#define BIT_MASK_BOOT_REASON_V1_8812F 0x7 -+#define BIT_BOOT_REASON_V1_8812F(x) \ -+ (((x) & BIT_MASK_BOOT_REASON_V1_8812F) \ -+ << BIT_SHIFT_BOOT_REASON_V1_8812F) -+#define BITS_BOOT_REASON_V1_8812F \ -+ (BIT_MASK_BOOT_REASON_V1_8812F << BIT_SHIFT_BOOT_REASON_V1_8812F) -+#define BIT_CLEAR_BOOT_REASON_V1_8812F(x) ((x) & (~BITS_BOOT_REASON_V1_8812F)) -+#define BIT_GET_BOOT_REASON_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BOOT_REASON_V1_8812F) & \ -+ BIT_MASK_BOOT_REASON_V1_8812F) -+#define BIT_SET_BOOT_REASON_V1_8812F(x, v) \ -+ (BIT_CLEAR_BOOT_REASON_V1_8812F(x) | BIT_BOOT_REASON_V1_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_HIMR2_8812F */ -+#define BIT_BCNDMAINT_P4_MSK_8812F BIT(31) -+#define BIT_BCNDMAINT_P3_MSK_8812F BIT(30) -+#define BIT_BCNDMAINT_P2_MSK_8812F BIT(29) -+#define BIT_BCNDMAINT_P1_MSK_8812F BIT(28) -+#define BIT_ATIMEND7_MSK_8812F BIT(22) -+#define BIT_ATIMEND6_MSK_8812F BIT(21) -+#define BIT_ATIMEND5_MSK_8812F BIT(20) -+#define BIT_ATIMEND4_MSK_8812F BIT(19) -+#define BIT_ATIMEND3_MSK_8812F BIT(18) -+#define BIT_ATIMEND2_MSK_8812F BIT(17) -+#define BIT_ATIMEND1_MSK_8812F BIT(16) -+#define BIT_TXBCN7OK_MSK_8812F BIT(14) -+#define BIT_TXBCN6OK_MSK_8812F BIT(13) -+#define BIT_TXBCN5OK_MSK_8812F BIT(12) -+#define BIT_TXBCN4OK_MSK_8812F BIT(11) -+#define BIT_TXBCN3OK_MSK_8812F BIT(10) -+#define BIT_TXBCN2OK_MSK_8812F BIT(9) -+#define BIT_TXBCN1OK_MSK_V1_8812F BIT(8) -+#define BIT_TXBCN7ERR_MSK_8812F BIT(6) -+#define BIT_TXBCN6ERR_MSK_8812F BIT(5) -+#define BIT_TXBCN5ERR_MSK_8812F BIT(4) -+#define BIT_TXBCN4ERR_MSK_8812F BIT(3) -+#define BIT_TXBCN3ERR_MSK_8812F BIT(2) -+#define BIT_TXBCN2ERR_MSK_8812F BIT(1) -+#define BIT_TXBCN1ERR_MSK_V1_8812F BIT(0) -+ -+/* 2 REG_HISR2_8812F */ -+#define BIT_BCNDMAINT_P4_8812F BIT(31) -+#define BIT_BCNDMAINT_P3_8812F BIT(30) -+#define BIT_BCNDMAINT_P2_8812F BIT(29) -+#define BIT_BCNDMAINT_P1_8812F BIT(28) -+#define BIT_ATIMEND7_8812F BIT(22) -+#define BIT_ATIMEND6_8812F BIT(21) -+#define BIT_ATIMEND5_8812F BIT(20) -+#define BIT_ATIMEND4_8812F BIT(19) -+#define BIT_ATIMEND3_8812F BIT(18) -+#define BIT_ATIMEND2_8812F BIT(17) -+#define BIT_ATIMEND1_8812F BIT(16) -+#define BIT_TXBCN7OK_8812F BIT(14) -+#define BIT_TXBCN6OK_8812F BIT(13) -+#define BIT_TXBCN5OK_8812F BIT(12) -+#define BIT_TXBCN4OK_8812F BIT(11) -+#define BIT_TXBCN3OK_8812F BIT(10) -+#define BIT_TXBCN2OK_8812F BIT(9) -+#define BIT_TXBCN1OK_8812F BIT(8) -+#define BIT_TXBCN7ERR_8812F BIT(6) -+#define BIT_TXBCN6ERR_8812F BIT(5) -+#define BIT_TXBCN5ERR_8812F BIT(4) -+#define BIT_TXBCN4ERR_8812F BIT(3) -+#define BIT_TXBCN3ERR_8812F BIT(2) -+#define BIT_TXBCN2ERR_8812F BIT(1) -+#define BIT_TXBCN1ERR_8812F BIT(0) -+ -+/* 2 REG_HIMR3_8812F */ -+#define BIT_WDT_PLATFORM_INT_MSK_8812F BIT(18) -+#define BIT_WDT_CPU_INT_MSK_8812F BIT(17) -+#define BIT_SETH2CDOK_MASK_8812F BIT(16) -+#define BIT_H2C_CMD_FULL_MASK_8812F BIT(15) -+#define BIT_PWR_INT_127_MASK_8812F BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_MASK_8812F BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_MASK_8812F BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_MASK_8812F BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_MAS_8812F BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_MASK_8812F BIT(9) -+#define BIT_PWR_INT_127_MASK_V1_8812F BIT(8) -+#define BIT_PWR_INT_126TO96_MASK_8812F BIT(7) -+#define BIT_PWR_INT_95TO64_MASK_8812F BIT(6) -+#define BIT_PWR_INT_63TO32_MASK_8812F BIT(5) -+#define BIT_PWR_INT_31TO0_MASK_8812F BIT(4) -+#define BIT_RX_DMA_STUCK_MSK_8812F BIT(3) -+#define BIT_TX_DMA_STUCK_MSK_8812F BIT(2) -+#define BIT_DDMA0_LP_INT_MSK_8812F BIT(1) -+#define BIT_DDMA0_HP_INT_MSK_8812F BIT(0) -+ -+/* 2 REG_HISR3_8812F */ -+#define BIT_WDT_PLATFORM_INT_8812F BIT(18) -+#define BIT_WDT_CPU_INT_8812F BIT(17) -+#define BIT_SETH2CDOK_8812F BIT(16) -+#define BIT_H2C_CMD_FULL_8812F BIT(15) -+#define BIT_PWR_INT_127_8812F BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_8812F BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_8812F BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_8812F BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_8812F BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_8812F BIT(9) -+#define BIT_PWR_INT_127_V1_8812F BIT(8) -+#define BIT_PWR_INT_126TO96_8812F BIT(7) -+#define BIT_PWR_INT_95TO64_8812F BIT(6) -+#define BIT_PWR_INT_63TO32_8812F BIT(5) -+#define BIT_PWR_INT_31TO0_8812F BIT(4) -+#define BIT_RX_DMA_STUCK_8812F BIT(3) -+#define BIT_TX_DMA_STUCK_8812F BIT(2) -+#define BIT_DDMA0_LP_INT_8812F BIT(1) -+#define BIT_DDMA0_HP_INT_8812F BIT(0) -+ -+/* 2 REG_SW_MDIO_8812F */ -+#define BIT_DIS_TIMEOUT_IO_8812F BIT(24) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_H2C_PKT_READADDR_8812F */ -+ -+#define BIT_SHIFT_H2C_PKT_READADDR_8812F 0 -+#define BIT_MASK_H2C_PKT_READADDR_8812F 0x3ffff -+#define BIT_H2C_PKT_READADDR_8812F(x) \ -+ (((x) & BIT_MASK_H2C_PKT_READADDR_8812F) \ -+ << BIT_SHIFT_H2C_PKT_READADDR_8812F) -+#define BITS_H2C_PKT_READADDR_8812F \ -+ (BIT_MASK_H2C_PKT_READADDR_8812F << BIT_SHIFT_H2C_PKT_READADDR_8812F) -+#define BIT_CLEAR_H2C_PKT_READADDR_8812F(x) \ -+ ((x) & (~BITS_H2C_PKT_READADDR_8812F)) -+#define BIT_GET_H2C_PKT_READADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_READADDR_8812F) & \ -+ BIT_MASK_H2C_PKT_READADDR_8812F) -+#define BIT_SET_H2C_PKT_READADDR_8812F(x, v) \ -+ (BIT_CLEAR_H2C_PKT_READADDR_8812F(x) | BIT_H2C_PKT_READADDR_8812F(v)) -+ -+/* 2 REG_H2C_PKT_WRITEADDR_8812F */ -+ -+#define BIT_SHIFT_H2C_PKT_WRITEADDR_8812F 0 -+#define BIT_MASK_H2C_PKT_WRITEADDR_8812F 0x3ffff -+#define BIT_H2C_PKT_WRITEADDR_8812F(x) \ -+ (((x) & BIT_MASK_H2C_PKT_WRITEADDR_8812F) \ -+ << BIT_SHIFT_H2C_PKT_WRITEADDR_8812F) -+#define BITS_H2C_PKT_WRITEADDR_8812F \ -+ (BIT_MASK_H2C_PKT_WRITEADDR_8812F << BIT_SHIFT_H2C_PKT_WRITEADDR_8812F) -+#define BIT_CLEAR_H2C_PKT_WRITEADDR_8812F(x) \ -+ ((x) & (~BITS_H2C_PKT_WRITEADDR_8812F)) -+#define BIT_GET_H2C_PKT_WRITEADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_WRITEADDR_8812F) & \ -+ BIT_MASK_H2C_PKT_WRITEADDR_8812F) -+#define BIT_SET_H2C_PKT_WRITEADDR_8812F(x, v) \ -+ (BIT_CLEAR_H2C_PKT_WRITEADDR_8812F(x) | BIT_H2C_PKT_WRITEADDR_8812F(v)) -+ -+/* 2 REG_MEM_PWR_CRTL_8812F */ -+#define BIT_MEM_BB_SD_8812F BIT(17) -+#define BIT_MEM_BB_DS_8812F BIT(16) -+#define BIT_MEM_BT_DS_8812F BIT(10) -+#define BIT_MEM_SDIO_LS_8812F BIT(9) -+#define BIT_MEM_SDIO_DS_8812F BIT(8) -+#define BIT_MEM_USB_LS_8812F BIT(7) -+#define BIT_MEM_USB_DS_8812F BIT(6) -+#define BIT_MEM_PCI_LS_8812F BIT(5) -+#define BIT_MEM_PCI_DS_8812F BIT(4) -+#define BIT_MEM_WLMAC_LS_8812F BIT(3) -+#define BIT_MEM_WLMAC_DS_8812F BIT(2) -+#define BIT_MEM_WLMCU_LS_8812F BIT(1) -+#define BIT_MEM_WLMCU_DS_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_FW_DBG6_8812F */ -+ -+#define BIT_SHIFT_FW_DBG6_8812F 0 -+#define BIT_MASK_FW_DBG6_8812F 0xffffffffL -+#define BIT_FW_DBG6_8812F(x) \ -+ (((x) & BIT_MASK_FW_DBG6_8812F) << BIT_SHIFT_FW_DBG6_8812F) -+#define BITS_FW_DBG6_8812F (BIT_MASK_FW_DBG6_8812F << BIT_SHIFT_FW_DBG6_8812F) -+#define BIT_CLEAR_FW_DBG6_8812F(x) ((x) & (~BITS_FW_DBG6_8812F)) -+#define BIT_GET_FW_DBG6_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG6_8812F) & BIT_MASK_FW_DBG6_8812F) -+#define BIT_SET_FW_DBG6_8812F(x, v) \ -+ (BIT_CLEAR_FW_DBG6_8812F(x) | BIT_FW_DBG6_8812F(v)) -+ -+/* 2 REG_FW_DBG7_8812F */ -+ -+#define BIT_SHIFT_FW_DBG7_8812F 0 -+#define BIT_MASK_FW_DBG7_8812F 0xffffffffL -+#define BIT_FW_DBG7_8812F(x) \ -+ (((x) & BIT_MASK_FW_DBG7_8812F) << BIT_SHIFT_FW_DBG7_8812F) -+#define BITS_FW_DBG7_8812F (BIT_MASK_FW_DBG7_8812F << BIT_SHIFT_FW_DBG7_8812F) -+#define BIT_CLEAR_FW_DBG7_8812F(x) ((x) & (~BITS_FW_DBG7_8812F)) -+#define BIT_GET_FW_DBG7_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG7_8812F) & BIT_MASK_FW_DBG7_8812F) -+#define BIT_SET_FW_DBG7_8812F(x, v) \ -+ (BIT_CLEAR_FW_DBG7_8812F(x) | BIT_FW_DBG7_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_CR_8812F */ -+ -+#define BIT_SHIFT_LBMODE_8812F 24 -+#define BIT_MASK_LBMODE_8812F 0x1f -+#define BIT_LBMODE_8812F(x) \ -+ (((x) & BIT_MASK_LBMODE_8812F) << BIT_SHIFT_LBMODE_8812F) -+#define BITS_LBMODE_8812F (BIT_MASK_LBMODE_8812F << BIT_SHIFT_LBMODE_8812F) -+#define BIT_CLEAR_LBMODE_8812F(x) ((x) & (~BITS_LBMODE_8812F)) -+#define BIT_GET_LBMODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_LBMODE_8812F) & BIT_MASK_LBMODE_8812F) -+#define BIT_SET_LBMODE_8812F(x, v) \ -+ (BIT_CLEAR_LBMODE_8812F(x) | BIT_LBMODE_8812F(v)) -+ -+#define BIT_SHIFT_NETYPE1_8812F 18 -+#define BIT_MASK_NETYPE1_8812F 0x3 -+#define BIT_NETYPE1_8812F(x) \ -+ (((x) & BIT_MASK_NETYPE1_8812F) << BIT_SHIFT_NETYPE1_8812F) -+#define BITS_NETYPE1_8812F (BIT_MASK_NETYPE1_8812F << BIT_SHIFT_NETYPE1_8812F) -+#define BIT_CLEAR_NETYPE1_8812F(x) ((x) & (~BITS_NETYPE1_8812F)) -+#define BIT_GET_NETYPE1_8812F(x) \ -+ (((x) >> BIT_SHIFT_NETYPE1_8812F) & BIT_MASK_NETYPE1_8812F) -+#define BIT_SET_NETYPE1_8812F(x, v) \ -+ (BIT_CLEAR_NETYPE1_8812F(x) | BIT_NETYPE1_8812F(v)) -+ -+#define BIT_SHIFT_NETYPE0_8812F 16 -+#define BIT_MASK_NETYPE0_8812F 0x3 -+#define BIT_NETYPE0_8812F(x) \ -+ (((x) & BIT_MASK_NETYPE0_8812F) << BIT_SHIFT_NETYPE0_8812F) -+#define BITS_NETYPE0_8812F (BIT_MASK_NETYPE0_8812F << BIT_SHIFT_NETYPE0_8812F) -+#define BIT_CLEAR_NETYPE0_8812F(x) ((x) & (~BITS_NETYPE0_8812F)) -+#define BIT_GET_NETYPE0_8812F(x) \ -+ (((x) >> BIT_SHIFT_NETYPE0_8812F) & BIT_MASK_NETYPE0_8812F) -+#define BIT_SET_NETYPE0_8812F(x, v) \ -+ (BIT_CLEAR_NETYPE0_8812F(x) | BIT_NETYPE0_8812F(v)) -+ -+#define BIT_COUNTER_STS_EN_8812F BIT(13) -+#define BIT_I2C_MAILBOX_EN_8812F BIT(12) -+#define BIT_SHCUT_EN_8812F BIT(11) -+#define BIT_32K_CAL_TMR_EN_8812F BIT(10) -+#define BIT_MAC_SEC_EN_8812F BIT(9) -+#define BIT_ENSWBCN_8812F BIT(8) -+#define BIT_MACRXEN_8812F BIT(7) -+#define BIT_MACTXEN_8812F BIT(6) -+#define BIT_SCHEDULE_EN_8812F BIT(5) -+#define BIT_PROTOCOL_EN_8812F BIT(4) -+#define BIT_RXDMA_EN_8812F BIT(3) -+#define BIT_TXDMA_EN_8812F BIT(2) -+#define BIT_HCI_RXDMA_EN_8812F BIT(1) -+#define BIT_HCI_TXDMA_EN_8812F BIT(0) -+ -+/* 2 REG_PG_SIZE_8812F */ -+ -+#define BIT_SHIFT_DBG_FIFO_SEL_8812F 16 -+#define BIT_MASK_DBG_FIFO_SEL_8812F 0xff -+#define BIT_DBG_FIFO_SEL_8812F(x) \ -+ (((x) & BIT_MASK_DBG_FIFO_SEL_8812F) << BIT_SHIFT_DBG_FIFO_SEL_8812F) -+#define BITS_DBG_FIFO_SEL_8812F \ -+ (BIT_MASK_DBG_FIFO_SEL_8812F << BIT_SHIFT_DBG_FIFO_SEL_8812F) -+#define BIT_CLEAR_DBG_FIFO_SEL_8812F(x) ((x) & (~BITS_DBG_FIFO_SEL_8812F)) -+#define BIT_GET_DBG_FIFO_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_DBG_FIFO_SEL_8812F) & BIT_MASK_DBG_FIFO_SEL_8812F) -+#define BIT_SET_DBG_FIFO_SEL_8812F(x, v) \ -+ (BIT_CLEAR_DBG_FIFO_SEL_8812F(x) | BIT_DBG_FIFO_SEL_8812F(v)) -+ -+/* 2 REG_PKT_BUFF_ACCESS_CTRL_8812F */ -+ -+#define BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8812F 0 -+#define BIT_MASK_PKT_BUFF_ACCESS_CTRL_8812F 0xff -+#define BIT_PKT_BUFF_ACCESS_CTRL_8812F(x) \ -+ (((x) & BIT_MASK_PKT_BUFF_ACCESS_CTRL_8812F) \ -+ << BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8812F) -+#define BITS_PKT_BUFF_ACCESS_CTRL_8812F \ -+ (BIT_MASK_PKT_BUFF_ACCESS_CTRL_8812F \ -+ << BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8812F) -+#define BIT_CLEAR_PKT_BUFF_ACCESS_CTRL_8812F(x) \ -+ ((x) & (~BITS_PKT_BUFF_ACCESS_CTRL_8812F)) -+#define BIT_GET_PKT_BUFF_ACCESS_CTRL_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8812F) & \ -+ BIT_MASK_PKT_BUFF_ACCESS_CTRL_8812F) -+#define BIT_SET_PKT_BUFF_ACCESS_CTRL_8812F(x, v) \ -+ (BIT_CLEAR_PKT_BUFF_ACCESS_CTRL_8812F(x) | \ -+ BIT_PKT_BUFF_ACCESS_CTRL_8812F(v)) -+ -+/* 2 REG_TSF_CLK_STATE_8812F */ -+#define BIT_TSF_CLK_STABLE_8812F BIT(15) -+ -+/* 2 REG_TXDMA_PQ_MAP_8812F */ -+#define BIT_CSI_BW_EN_8812F BIT(31) -+ -+#define BIT_SHIFT_TXDMA_H2C_MAP_8812F 16 -+#define BIT_MASK_TXDMA_H2C_MAP_8812F 0x3 -+#define BIT_TXDMA_H2C_MAP_8812F(x) \ -+ (((x) & BIT_MASK_TXDMA_H2C_MAP_8812F) << BIT_SHIFT_TXDMA_H2C_MAP_8812F) -+#define BITS_TXDMA_H2C_MAP_8812F \ -+ (BIT_MASK_TXDMA_H2C_MAP_8812F << BIT_SHIFT_TXDMA_H2C_MAP_8812F) -+#define BIT_CLEAR_TXDMA_H2C_MAP_8812F(x) ((x) & (~BITS_TXDMA_H2C_MAP_8812F)) -+#define BIT_GET_TXDMA_H2C_MAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_H2C_MAP_8812F) & BIT_MASK_TXDMA_H2C_MAP_8812F) -+#define BIT_SET_TXDMA_H2C_MAP_8812F(x, v) \ -+ (BIT_CLEAR_TXDMA_H2C_MAP_8812F(x) | BIT_TXDMA_H2C_MAP_8812F(v)) -+ -+#define BIT_SHIFT_TXDMA_HIQ_MAP_8812F 14 -+#define BIT_MASK_TXDMA_HIQ_MAP_8812F 0x3 -+#define BIT_TXDMA_HIQ_MAP_8812F(x) \ -+ (((x) & BIT_MASK_TXDMA_HIQ_MAP_8812F) << BIT_SHIFT_TXDMA_HIQ_MAP_8812F) -+#define BITS_TXDMA_HIQ_MAP_8812F \ -+ (BIT_MASK_TXDMA_HIQ_MAP_8812F << BIT_SHIFT_TXDMA_HIQ_MAP_8812F) -+#define BIT_CLEAR_TXDMA_HIQ_MAP_8812F(x) ((x) & (~BITS_TXDMA_HIQ_MAP_8812F)) -+#define BIT_GET_TXDMA_HIQ_MAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_HIQ_MAP_8812F) & BIT_MASK_TXDMA_HIQ_MAP_8812F) -+#define BIT_SET_TXDMA_HIQ_MAP_8812F(x, v) \ -+ (BIT_CLEAR_TXDMA_HIQ_MAP_8812F(x) | BIT_TXDMA_HIQ_MAP_8812F(v)) -+ -+#define BIT_SHIFT_TXDMA_MGQ_MAP_8812F 12 -+#define BIT_MASK_TXDMA_MGQ_MAP_8812F 0x3 -+#define BIT_TXDMA_MGQ_MAP_8812F(x) \ -+ (((x) & BIT_MASK_TXDMA_MGQ_MAP_8812F) << BIT_SHIFT_TXDMA_MGQ_MAP_8812F) -+#define BITS_TXDMA_MGQ_MAP_8812F \ -+ (BIT_MASK_TXDMA_MGQ_MAP_8812F << BIT_SHIFT_TXDMA_MGQ_MAP_8812F) -+#define BIT_CLEAR_TXDMA_MGQ_MAP_8812F(x) ((x) & (~BITS_TXDMA_MGQ_MAP_8812F)) -+#define BIT_GET_TXDMA_MGQ_MAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_MGQ_MAP_8812F) & BIT_MASK_TXDMA_MGQ_MAP_8812F) -+#define BIT_SET_TXDMA_MGQ_MAP_8812F(x, v) \ -+ (BIT_CLEAR_TXDMA_MGQ_MAP_8812F(x) | BIT_TXDMA_MGQ_MAP_8812F(v)) -+ -+#define BIT_SHIFT_TXDMA_BKQ_MAP_8812F 10 -+#define BIT_MASK_TXDMA_BKQ_MAP_8812F 0x3 -+#define BIT_TXDMA_BKQ_MAP_8812F(x) \ -+ (((x) & BIT_MASK_TXDMA_BKQ_MAP_8812F) << BIT_SHIFT_TXDMA_BKQ_MAP_8812F) -+#define BITS_TXDMA_BKQ_MAP_8812F \ -+ (BIT_MASK_TXDMA_BKQ_MAP_8812F << BIT_SHIFT_TXDMA_BKQ_MAP_8812F) -+#define BIT_CLEAR_TXDMA_BKQ_MAP_8812F(x) ((x) & (~BITS_TXDMA_BKQ_MAP_8812F)) -+#define BIT_GET_TXDMA_BKQ_MAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BKQ_MAP_8812F) & BIT_MASK_TXDMA_BKQ_MAP_8812F) -+#define BIT_SET_TXDMA_BKQ_MAP_8812F(x, v) \ -+ (BIT_CLEAR_TXDMA_BKQ_MAP_8812F(x) | BIT_TXDMA_BKQ_MAP_8812F(v)) -+ -+#define BIT_SHIFT_TXDMA_BEQ_MAP_8812F 8 -+#define BIT_MASK_TXDMA_BEQ_MAP_8812F 0x3 -+#define BIT_TXDMA_BEQ_MAP_8812F(x) \ -+ (((x) & BIT_MASK_TXDMA_BEQ_MAP_8812F) << BIT_SHIFT_TXDMA_BEQ_MAP_8812F) -+#define BITS_TXDMA_BEQ_MAP_8812F \ -+ (BIT_MASK_TXDMA_BEQ_MAP_8812F << BIT_SHIFT_TXDMA_BEQ_MAP_8812F) -+#define BIT_CLEAR_TXDMA_BEQ_MAP_8812F(x) ((x) & (~BITS_TXDMA_BEQ_MAP_8812F)) -+#define BIT_GET_TXDMA_BEQ_MAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BEQ_MAP_8812F) & BIT_MASK_TXDMA_BEQ_MAP_8812F) -+#define BIT_SET_TXDMA_BEQ_MAP_8812F(x, v) \ -+ (BIT_CLEAR_TXDMA_BEQ_MAP_8812F(x) | BIT_TXDMA_BEQ_MAP_8812F(v)) -+ -+#define BIT_SHIFT_TXDMA_VIQ_MAP_8812F 6 -+#define BIT_MASK_TXDMA_VIQ_MAP_8812F 0x3 -+#define BIT_TXDMA_VIQ_MAP_8812F(x) \ -+ (((x) & BIT_MASK_TXDMA_VIQ_MAP_8812F) << BIT_SHIFT_TXDMA_VIQ_MAP_8812F) -+#define BITS_TXDMA_VIQ_MAP_8812F \ -+ (BIT_MASK_TXDMA_VIQ_MAP_8812F << BIT_SHIFT_TXDMA_VIQ_MAP_8812F) -+#define BIT_CLEAR_TXDMA_VIQ_MAP_8812F(x) ((x) & (~BITS_TXDMA_VIQ_MAP_8812F)) -+#define BIT_GET_TXDMA_VIQ_MAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VIQ_MAP_8812F) & BIT_MASK_TXDMA_VIQ_MAP_8812F) -+#define BIT_SET_TXDMA_VIQ_MAP_8812F(x, v) \ -+ (BIT_CLEAR_TXDMA_VIQ_MAP_8812F(x) | BIT_TXDMA_VIQ_MAP_8812F(v)) -+ -+#define BIT_SHIFT_TXDMA_VOQ_MAP_8812F 4 -+#define BIT_MASK_TXDMA_VOQ_MAP_8812F 0x3 -+#define BIT_TXDMA_VOQ_MAP_8812F(x) \ -+ (((x) & BIT_MASK_TXDMA_VOQ_MAP_8812F) << BIT_SHIFT_TXDMA_VOQ_MAP_8812F) -+#define BITS_TXDMA_VOQ_MAP_8812F \ -+ (BIT_MASK_TXDMA_VOQ_MAP_8812F << BIT_SHIFT_TXDMA_VOQ_MAP_8812F) -+#define BIT_CLEAR_TXDMA_VOQ_MAP_8812F(x) ((x) & (~BITS_TXDMA_VOQ_MAP_8812F)) -+#define BIT_GET_TXDMA_VOQ_MAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VOQ_MAP_8812F) & BIT_MASK_TXDMA_VOQ_MAP_8812F) -+#define BIT_SET_TXDMA_VOQ_MAP_8812F(x, v) \ -+ (BIT_CLEAR_TXDMA_VOQ_MAP_8812F(x) | BIT_TXDMA_VOQ_MAP_8812F(v)) -+ -+#define BIT_TXDMA_BW_EN_8812F BIT(3) -+#define BIT_RXDMA_AGG_EN_8812F BIT(2) -+#define BIT_RXSHFT_EN_8812F BIT(1) -+#define BIT_RXDMA_ARBBW_EN_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_TRXFF_BNDY_8812F */ -+ -+#define BIT_SHIFT_FWFFOVFL_RSV_8812F 16 -+#define BIT_MASK_FWFFOVFL_RSV_8812F 0xf -+#define BIT_FWFFOVFL_RSV_8812F(x) \ -+ (((x) & BIT_MASK_FWFFOVFL_RSV_8812F) << BIT_SHIFT_FWFFOVFL_RSV_8812F) -+#define BITS_FWFFOVFL_RSV_8812F \ -+ (BIT_MASK_FWFFOVFL_RSV_8812F << BIT_SHIFT_FWFFOVFL_RSV_8812F) -+#define BIT_CLEAR_FWFFOVFL_RSV_8812F(x) ((x) & (~BITS_FWFFOVFL_RSV_8812F)) -+#define BIT_GET_FWFFOVFL_RSV_8812F(x) \ -+ (((x) >> BIT_SHIFT_FWFFOVFL_RSV_8812F) & BIT_MASK_FWFFOVFL_RSV_8812F) -+#define BIT_SET_FWFFOVFL_RSV_8812F(x, v) \ -+ (BIT_CLEAR_FWFFOVFL_RSV_8812F(x) | BIT_FWFFOVFL_RSV_8812F(v)) -+ -+#define BIT_SHIFT_RXFFOVFL_RSV_V2_8812F 8 -+#define BIT_MASK_RXFFOVFL_RSV_V2_8812F 0xf -+#define BIT_RXFFOVFL_RSV_V2_8812F(x) \ -+ (((x) & BIT_MASK_RXFFOVFL_RSV_V2_8812F) \ -+ << BIT_SHIFT_RXFFOVFL_RSV_V2_8812F) -+#define BITS_RXFFOVFL_RSV_V2_8812F \ -+ (BIT_MASK_RXFFOVFL_RSV_V2_8812F << BIT_SHIFT_RXFFOVFL_RSV_V2_8812F) -+#define BIT_CLEAR_RXFFOVFL_RSV_V2_8812F(x) ((x) & (~BITS_RXFFOVFL_RSV_V2_8812F)) -+#define BIT_GET_RXFFOVFL_RSV_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXFFOVFL_RSV_V2_8812F) & \ -+ BIT_MASK_RXFFOVFL_RSV_V2_8812F) -+#define BIT_SET_RXFFOVFL_RSV_V2_8812F(x, v) \ -+ (BIT_CLEAR_RXFFOVFL_RSV_V2_8812F(x) | BIT_RXFFOVFL_RSV_V2_8812F(v)) -+ -+/* 2 REG_PTA_I2C_MBOX_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_I2C_M_STATUS_8812F 8 -+#define BIT_MASK_I2C_M_STATUS_8812F 0xf -+#define BIT_I2C_M_STATUS_8812F(x) \ -+ (((x) & BIT_MASK_I2C_M_STATUS_8812F) << BIT_SHIFT_I2C_M_STATUS_8812F) -+#define BITS_I2C_M_STATUS_8812F \ -+ (BIT_MASK_I2C_M_STATUS_8812F << BIT_SHIFT_I2C_M_STATUS_8812F) -+#define BIT_CLEAR_I2C_M_STATUS_8812F(x) ((x) & (~BITS_I2C_M_STATUS_8812F)) -+#define BIT_GET_I2C_M_STATUS_8812F(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_STATUS_8812F) & BIT_MASK_I2C_M_STATUS_8812F) -+#define BIT_SET_I2C_M_STATUS_8812F(x, v) \ -+ (BIT_CLEAR_I2C_M_STATUS_8812F(x) | BIT_I2C_M_STATUS_8812F(v)) -+ -+#define BIT_SHIFT_I2C_M_BUS_GNT_FW_8812F 4 -+#define BIT_MASK_I2C_M_BUS_GNT_FW_8812F 0x7 -+#define BIT_I2C_M_BUS_GNT_FW_8812F(x) \ -+ (((x) & BIT_MASK_I2C_M_BUS_GNT_FW_8812F) \ -+ << BIT_SHIFT_I2C_M_BUS_GNT_FW_8812F) -+#define BITS_I2C_M_BUS_GNT_FW_8812F \ -+ (BIT_MASK_I2C_M_BUS_GNT_FW_8812F << BIT_SHIFT_I2C_M_BUS_GNT_FW_8812F) -+#define BIT_CLEAR_I2C_M_BUS_GNT_FW_8812F(x) \ -+ ((x) & (~BITS_I2C_M_BUS_GNT_FW_8812F)) -+#define BIT_GET_I2C_M_BUS_GNT_FW_8812F(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_BUS_GNT_FW_8812F) & \ -+ BIT_MASK_I2C_M_BUS_GNT_FW_8812F) -+#define BIT_SET_I2C_M_BUS_GNT_FW_8812F(x, v) \ -+ (BIT_CLEAR_I2C_M_BUS_GNT_FW_8812F(x) | BIT_I2C_M_BUS_GNT_FW_8812F(v)) -+ -+#define BIT_I2C_M_GNT_FW_8812F BIT(3) -+ -+#define BIT_SHIFT_I2C_M_SPEED_8812F 1 -+#define BIT_MASK_I2C_M_SPEED_8812F 0x3 -+#define BIT_I2C_M_SPEED_8812F(x) \ -+ (((x) & BIT_MASK_I2C_M_SPEED_8812F) << BIT_SHIFT_I2C_M_SPEED_8812F) -+#define BITS_I2C_M_SPEED_8812F \ -+ (BIT_MASK_I2C_M_SPEED_8812F << BIT_SHIFT_I2C_M_SPEED_8812F) -+#define BIT_CLEAR_I2C_M_SPEED_8812F(x) ((x) & (~BITS_I2C_M_SPEED_8812F)) -+#define BIT_GET_I2C_M_SPEED_8812F(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_SPEED_8812F) & BIT_MASK_I2C_M_SPEED_8812F) -+#define BIT_SET_I2C_M_SPEED_8812F(x, v) \ -+ (BIT_CLEAR_I2C_M_SPEED_8812F(x) | BIT_I2C_M_SPEED_8812F(v)) -+ -+#define BIT_I2C_M_UNLOCK_8812F BIT(0) -+ -+/* 2 REG_RXFF_BNDY_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_RXFF0_BNDY_V2_8812F 0 -+#define BIT_MASK_RXFF0_BNDY_V2_8812F 0x3ffff -+#define BIT_RXFF0_BNDY_V2_8812F(x) \ -+ (((x) & BIT_MASK_RXFF0_BNDY_V2_8812F) << BIT_SHIFT_RXFF0_BNDY_V2_8812F) -+#define BITS_RXFF0_BNDY_V2_8812F \ -+ (BIT_MASK_RXFF0_BNDY_V2_8812F << BIT_SHIFT_RXFF0_BNDY_V2_8812F) -+#define BIT_CLEAR_RXFF0_BNDY_V2_8812F(x) ((x) & (~BITS_RXFF0_BNDY_V2_8812F)) -+#define BIT_GET_RXFF0_BNDY_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_BNDY_V2_8812F) & BIT_MASK_RXFF0_BNDY_V2_8812F) -+#define BIT_SET_RXFF0_BNDY_V2_8812F(x, v) \ -+ (BIT_CLEAR_RXFF0_BNDY_V2_8812F(x) | BIT_RXFF0_BNDY_V2_8812F(v)) -+ -+/* 2 REG_FE1IMR_8812F */ -+#define BIT_FS_SW_PLL_LEAVE_32K_INT_EN_8812F BIT(31) -+#define BIT_FS_FWFF_FULL_INT_EN_8812F BIT(30) -+#define BIT_FS_BB_STOP_RX_INT_EN_8812F BIT(29) -+#define BIT_FS_RXDMA2_DONE_INT_EN_8812F BIT(28) -+#define BIT_FS_RXDONE2_INT_EN_8812F BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_EN_8812F BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_EN_8812F BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_EN_8812F BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_EN_8812F BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_EN_8812F BIT(21) -+#define BIT_FS_RX_UMD0_INT_EN_8812F BIT(20) -+#define BIT_FS_RX_UMD1_INT_EN_8812F BIT(19) -+#define BIT_FS_RX_BMD0_INT_EN_8812F BIT(18) -+#define BIT_FS_RX_BMD1_INT_EN_8812F BIT(17) -+#define BIT_FS_RXDONE_INT_EN_8812F BIT(16) -+#define BIT_FS_WWLAN_INT_EN_8812F BIT(15) -+#define BIT_FS_SOUND_DONE_INT_EN_8812F BIT(14) -+#define BIT_FS_BF1_PRETO_INT_EN_8812F BIT(11) -+#define BIT_FS_BF0_PRETO_INT_EN_8812F BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_EN_8812F BIT(9) -+#define BIT_FS_PRETX_ERRHLD_INT_EN_8812F BIT(8) -+#define BIT_FS_LTE_COEX_EN_8812F BIT(6) -+#define BIT_FS_WLACTOFF_INT_EN_8812F BIT(5) -+#define BIT_FS_WLACTON_INT_EN_8812F BIT(4) -+#define BIT_FS_BTCMD_INT_EN_8812F BIT(3) -+#define BIT_FS_REG_MAILBOX_TO_I2C_INT_EN_8812F BIT(2) -+#define BIT_FS_TRPC_TO_INT_EN_V1_8812F BIT(1) -+#define BIT_FS_RPC_O_T_INT_EN_V1_8812F BIT(0) -+ -+/* 2 REG_FE1ISR_8812F */ -+#define BIT_FS_SW_PLL_LEAVE_32K_INT_8812F BIT(31) -+#define BIT_FS_FS_FWFF_FULL_INT_8812F BIT(30) -+#define BIT_FS_BB_STOP_RX_INT_8812F BIT(29) -+#define BIT_FS_RXDMA2_DONE_INT_8812F BIT(28) -+#define BIT_FS_RXDONE2_INT_8812F BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_8812F BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_8812F BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_8812F BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_8812F BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_8812F BIT(21) -+#define BIT_FS_RX_UMD0_INT_8812F BIT(20) -+#define BIT_FS_RX_UMD1_INT_8812F BIT(19) -+#define BIT_FS_RX_BMD0_INT_8812F BIT(18) -+#define BIT_FS_RX_BMD1_INT_8812F BIT(17) -+#define BIT_FS_RXDONE_INT_8812F BIT(16) -+#define BIT_FS_WWLAN_INT_8812F BIT(15) -+#define BIT_FS_SOUND_DONE_INT_8812F BIT(14) -+#define BIT_FS_BF1_PRETO_INT_8812F BIT(11) -+#define BIT_FS_BF0_PRETO_INT_8812F BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_8812F BIT(9) -+#define BIT_FS_PRETX_ERRHLD_INT_8812F BIT(8) -+#define BIT_FS_LTE_COEX_INT_8812F BIT(6) -+#define BIT_FS_WLACTOFF_INT_8812F BIT(5) -+#define BIT_FS_WLACTON_INT_8812F BIT(4) -+#define BIT_FS_BCN_RX_INT_INT_8812F BIT(3) -+#define BIT_FS_MAILBOX_TO_I2C_INT_8812F BIT(2) -+#define BIT_FS_TRPC_TO_INT_8812F BIT(1) -+#define BIT_FS_RPC_O_T_INT_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_CPWM_8812F */ -+#define BIT_CPWM_TOGGLING_8812F BIT(31) -+ -+#define BIT_SHIFT_CPWM_MOD_8812F 24 -+#define BIT_MASK_CPWM_MOD_8812F 0x7f -+#define BIT_CPWM_MOD_8812F(x) \ -+ (((x) & BIT_MASK_CPWM_MOD_8812F) << BIT_SHIFT_CPWM_MOD_8812F) -+#define BITS_CPWM_MOD_8812F \ -+ (BIT_MASK_CPWM_MOD_8812F << BIT_SHIFT_CPWM_MOD_8812F) -+#define BIT_CLEAR_CPWM_MOD_8812F(x) ((x) & (~BITS_CPWM_MOD_8812F)) -+#define BIT_GET_CPWM_MOD_8812F(x) \ -+ (((x) >> BIT_SHIFT_CPWM_MOD_8812F) & BIT_MASK_CPWM_MOD_8812F) -+#define BIT_SET_CPWM_MOD_8812F(x, v) \ -+ (BIT_CLEAR_CPWM_MOD_8812F(x) | BIT_CPWM_MOD_8812F(v)) -+ -+/* 2 REG_FWIMR_8812F */ -+#define BIT_FS_TXBCNOK_MB7_INT_EN_8812F BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_EN_8812F BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_EN_8812F BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_EN_8812F BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_EN_8812F BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_EN_8812F BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_EN_8812F BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_EN_8812F BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_EN_8812F BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_EN_8812F BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_EN_8812F BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_EN_8812F BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_EN_8812F BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_EN_8812F BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_EN_8812F BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_EN_8812F BIT(16) -+#define BIT_CPU_MGQ_TXDONE_INT_EN_8812F BIT(15) -+#define BIT_SIFS_OVERSPEC_INT_EN_8812F BIT(14) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_EN_8812F BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_EN_8812F BIT(12) -+#define BIT_FS_CPUMGQ_ERR_INT_EN_8812F BIT(11) -+#define BIT_FS_DDMA0_LP_INT_EN_8812F BIT(9) -+#define BIT_FS_DDMA0_HP_INT_EN_8812F BIT(8) -+#define BIT_FS_TRXRPT_INT_EN_8812F BIT(7) -+#define BIT_FS_C2H_W_READY_INT_EN_8812F BIT(6) -+#define BIT_FS_HRCV_INT_EN_8812F BIT(5) -+#define BIT_FS_H2CCMD_INT_EN_8812F BIT(4) -+#define BIT_FS_TXPKTIN_INT_EN_8812F BIT(3) -+#define BIT_FS_ERRORHDL_INT_EN_8812F BIT(2) -+#define BIT_FS_TXCCX_INT_EN_8812F BIT(1) -+#define BIT_FS_TXCLOSE_INT_EN_8812F BIT(0) -+ -+/* 2 REG_FWISR_8812F */ -+#define BIT_FS_TXBCNOK_MB7_INT_8812F BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_8812F BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_8812F BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_8812F BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_8812F BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_8812F BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_8812F BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_8812F BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_8812F BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_8812F BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_8812F BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_8812F BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_8812F BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_8812F BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_8812F BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_8812F BIT(16) -+#define BIT_CPU_MGQ_TXDONE_INT_8812F BIT(15) -+#define BIT_SIFS_OVERSPEC_INT_8812F BIT(14) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_8812F BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_8812F BIT(12) -+#define BIT_FS_CPUMGQ_ERR_INT_8812F BIT(11) -+#define BIT_FS_DDMA0_LP_INT_8812F BIT(9) -+#define BIT_FS_DDMA0_HP_INT_8812F BIT(8) -+#define BIT_FS_TRXRPT_INT_8812F BIT(7) -+#define BIT_FS_C2H_W_READY_INT_8812F BIT(6) -+#define BIT_FS_HRCV_INT_8812F BIT(5) -+#define BIT_FS_H2CCMD_INT_8812F BIT(4) -+#define BIT_FS_TXPKTIN_INT_8812F BIT(3) -+#define BIT_FS_ERRORHDL_INT_8812F BIT(2) -+#define BIT_FS_TXCCX_INT_8812F BIT(1) -+#define BIT_FS_TXCLOSE_INT_8812F BIT(0) -+ -+/* 2 REG_FTIMR_8812F */ -+#define BIT_PS_TIMER_C_EARLY_INT_EN_8812F BIT(23) -+#define BIT_PS_TIMER_B_EARLY_INT_EN_8812F BIT(22) -+#define BIT_PS_TIMER_A_EARLY_INT_EN_8812F BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_EN_8812F BIT(20) -+#define BIT_PS_TIMER_C_INT_EN_8812F BIT(19) -+#define BIT_PS_TIMER_B_INT_EN_8812F BIT(18) -+#define BIT_PS_TIMER_A_INT_EN_8812F BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_EN_8812F BIT(16) -+#define BIT_FS_PS_TIMEOUT2_EN_8812F BIT(15) -+#define BIT_FS_PS_TIMEOUT1_EN_8812F BIT(14) -+#define BIT_FS_PS_TIMEOUT0_EN_8812F BIT(13) -+#define BIT_FS_GTINT8_EN_8812F BIT(8) -+#define BIT_FS_GTINT7_EN_8812F BIT(7) -+#define BIT_FS_GTINT6_EN_8812F BIT(6) -+#define BIT_FS_GTINT5_EN_8812F BIT(5) -+#define BIT_FS_GTINT4_EN_8812F BIT(4) -+#define BIT_FS_GTINT3_EN_8812F BIT(3) -+#define BIT_FS_GTINT2_EN_8812F BIT(2) -+#define BIT_FS_GTINT1_EN_8812F BIT(1) -+#define BIT_FS_GTINT0_EN_8812F BIT(0) -+ -+/* 2 REG_FTISR_8812F */ -+#define BIT_PS_TIMER_C_EARLY__INT_8812F BIT(23) -+#define BIT_PS_TIMER_B_EARLY__INT_8812F BIT(22) -+#define BIT_PS_TIMER_A_EARLY__INT_8812F BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_8812F BIT(20) -+#define BIT_PS_TIMER_C_INT_8812F BIT(19) -+#define BIT_PS_TIMER_B_INT_8812F BIT(18) -+#define BIT_PS_TIMER_A_INT_8812F BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_8812F BIT(16) -+#define BIT_FS_PS_TIMEOUT2_INT_8812F BIT(15) -+#define BIT_FS_PS_TIMEOUT1_INT_8812F BIT(14) -+#define BIT_FS_PS_TIMEOUT0_INT_8812F BIT(13) -+#define BIT_FS_GTINT8_INT_8812F BIT(8) -+#define BIT_FS_GTINT7_INT_8812F BIT(7) -+#define BIT_FS_GTINT6_INT_8812F BIT(6) -+#define BIT_FS_GTINT5_INT_8812F BIT(5) -+#define BIT_FS_GTINT4_INT_8812F BIT(4) -+#define BIT_FS_GTINT3_INT_8812F BIT(3) -+#define BIT_FS_GTINT2_INT_8812F BIT(2) -+#define BIT_FS_GTINT1_INT_8812F BIT(1) -+#define BIT_FS_GTINT0_INT_8812F BIT(0) -+ -+/* 2 REG_PKTBUF_DBG_CTRL_8812F */ -+ -+#define BIT_SHIFT_PKTBUF_WRITE_EN_8812F 24 -+#define BIT_MASK_PKTBUF_WRITE_EN_8812F 0xff -+#define BIT_PKTBUF_WRITE_EN_8812F(x) \ -+ (((x) & BIT_MASK_PKTBUF_WRITE_EN_8812F) \ -+ << BIT_SHIFT_PKTBUF_WRITE_EN_8812F) -+#define BITS_PKTBUF_WRITE_EN_8812F \ -+ (BIT_MASK_PKTBUF_WRITE_EN_8812F << BIT_SHIFT_PKTBUF_WRITE_EN_8812F) -+#define BIT_CLEAR_PKTBUF_WRITE_EN_8812F(x) ((x) & (~BITS_PKTBUF_WRITE_EN_8812F)) -+#define BIT_GET_PKTBUF_WRITE_EN_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_WRITE_EN_8812F) & \ -+ BIT_MASK_PKTBUF_WRITE_EN_8812F) -+#define BIT_SET_PKTBUF_WRITE_EN_8812F(x, v) \ -+ (BIT_CLEAR_PKTBUF_WRITE_EN_8812F(x) | BIT_PKTBUF_WRITE_EN_8812F(v)) -+ -+#define BIT_TXRPTBUF_DBG_8812F BIT(23) -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_TXPKTBUF_DBG_V2_8812F BIT(20) -+#define BIT_RXPKTBUF_DBG_8812F BIT(16) -+ -+#define BIT_SHIFT_PKTBUF_DBG_ADDR_8812F 0 -+#define BIT_MASK_PKTBUF_DBG_ADDR_8812F 0x1fff -+#define BIT_PKTBUF_DBG_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_ADDR_8812F) \ -+ << BIT_SHIFT_PKTBUF_DBG_ADDR_8812F) -+#define BITS_PKTBUF_DBG_ADDR_8812F \ -+ (BIT_MASK_PKTBUF_DBG_ADDR_8812F << BIT_SHIFT_PKTBUF_DBG_ADDR_8812F) -+#define BIT_CLEAR_PKTBUF_DBG_ADDR_8812F(x) ((x) & (~BITS_PKTBUF_DBG_ADDR_8812F)) -+#define BIT_GET_PKTBUF_DBG_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_ADDR_8812F) & \ -+ BIT_MASK_PKTBUF_DBG_ADDR_8812F) -+#define BIT_SET_PKTBUF_DBG_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_ADDR_8812F(x) | BIT_PKTBUF_DBG_ADDR_8812F(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_L_8812F */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_L_8812F 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_L_8812F 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_L_8812F(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_L_8812F) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_L_8812F) -+#define BITS_PKTBUF_DBG_DATA_L_8812F \ -+ (BIT_MASK_PKTBUF_DBG_DATA_L_8812F << BIT_SHIFT_PKTBUF_DBG_DATA_L_8812F) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_L_8812F(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_L_8812F)) -+#define BIT_GET_PKTBUF_DBG_DATA_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_L_8812F) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_L_8812F) -+#define BIT_SET_PKTBUF_DBG_DATA_L_8812F(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_L_8812F(x) | BIT_PKTBUF_DBG_DATA_L_8812F(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_H_8812F */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_H_8812F 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_H_8812F 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_H_8812F(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_H_8812F) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_H_8812F) -+#define BITS_PKTBUF_DBG_DATA_H_8812F \ -+ (BIT_MASK_PKTBUF_DBG_DATA_H_8812F << BIT_SHIFT_PKTBUF_DBG_DATA_H_8812F) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_H_8812F(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_H_8812F)) -+#define BIT_GET_PKTBUF_DBG_DATA_H_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_H_8812F) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_H_8812F) -+#define BIT_SET_PKTBUF_DBG_DATA_H_8812F(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_H_8812F(x) | BIT_PKTBUF_DBG_DATA_H_8812F(v)) -+ -+/* 2 REG_CPWM2_8812F */ -+ -+#define BIT_SHIFT_L0S_TO_RCVY_NUM_8812F 16 -+#define BIT_MASK_L0S_TO_RCVY_NUM_8812F 0xff -+#define BIT_L0S_TO_RCVY_NUM_8812F(x) \ -+ (((x) & BIT_MASK_L0S_TO_RCVY_NUM_8812F) \ -+ << BIT_SHIFT_L0S_TO_RCVY_NUM_8812F) -+#define BITS_L0S_TO_RCVY_NUM_8812F \ -+ (BIT_MASK_L0S_TO_RCVY_NUM_8812F << BIT_SHIFT_L0S_TO_RCVY_NUM_8812F) -+#define BIT_CLEAR_L0S_TO_RCVY_NUM_8812F(x) ((x) & (~BITS_L0S_TO_RCVY_NUM_8812F)) -+#define BIT_GET_L0S_TO_RCVY_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_L0S_TO_RCVY_NUM_8812F) & \ -+ BIT_MASK_L0S_TO_RCVY_NUM_8812F) -+#define BIT_SET_L0S_TO_RCVY_NUM_8812F(x, v) \ -+ (BIT_CLEAR_L0S_TO_RCVY_NUM_8812F(x) | BIT_L0S_TO_RCVY_NUM_8812F(v)) -+ -+#define BIT_CPWM2_TOGGLING_8812F BIT(15) -+ -+#define BIT_SHIFT_CPWM2_MOD_8812F 0 -+#define BIT_MASK_CPWM2_MOD_8812F 0x7fff -+#define BIT_CPWM2_MOD_8812F(x) \ -+ (((x) & BIT_MASK_CPWM2_MOD_8812F) << BIT_SHIFT_CPWM2_MOD_8812F) -+#define BITS_CPWM2_MOD_8812F \ -+ (BIT_MASK_CPWM2_MOD_8812F << BIT_SHIFT_CPWM2_MOD_8812F) -+#define BIT_CLEAR_CPWM2_MOD_8812F(x) ((x) & (~BITS_CPWM2_MOD_8812F)) -+#define BIT_GET_CPWM2_MOD_8812F(x) \ -+ (((x) >> BIT_SHIFT_CPWM2_MOD_8812F) & BIT_MASK_CPWM2_MOD_8812F) -+#define BIT_SET_CPWM2_MOD_8812F(x, v) \ -+ (BIT_CLEAR_CPWM2_MOD_8812F(x) | BIT_CPWM2_MOD_8812F(v)) -+ -+/* 2 REG_TC0_CTRL_8812F */ -+#define BIT_TC0INT_EN_8812F BIT(26) -+#define BIT_TC0MODE_8812F BIT(25) -+#define BIT_TC0EN_8812F BIT(24) -+ -+#define BIT_SHIFT_TC0DATA_8812F 0 -+#define BIT_MASK_TC0DATA_8812F 0xffffff -+#define BIT_TC0DATA_8812F(x) \ -+ (((x) & BIT_MASK_TC0DATA_8812F) << BIT_SHIFT_TC0DATA_8812F) -+#define BITS_TC0DATA_8812F (BIT_MASK_TC0DATA_8812F << BIT_SHIFT_TC0DATA_8812F) -+#define BIT_CLEAR_TC0DATA_8812F(x) ((x) & (~BITS_TC0DATA_8812F)) -+#define BIT_GET_TC0DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TC0DATA_8812F) & BIT_MASK_TC0DATA_8812F) -+#define BIT_SET_TC0DATA_8812F(x, v) \ -+ (BIT_CLEAR_TC0DATA_8812F(x) | BIT_TC0DATA_8812F(v)) -+ -+/* 2 REG_TC1_CTRL_8812F */ -+#define BIT_TC1INT_EN_8812F BIT(26) -+#define BIT_TC1MODE_8812F BIT(25) -+#define BIT_TC1EN_8812F BIT(24) -+ -+#define BIT_SHIFT_TC1DATA_8812F 0 -+#define BIT_MASK_TC1DATA_8812F 0xffffff -+#define BIT_TC1DATA_8812F(x) \ -+ (((x) & BIT_MASK_TC1DATA_8812F) << BIT_SHIFT_TC1DATA_8812F) -+#define BITS_TC1DATA_8812F (BIT_MASK_TC1DATA_8812F << BIT_SHIFT_TC1DATA_8812F) -+#define BIT_CLEAR_TC1DATA_8812F(x) ((x) & (~BITS_TC1DATA_8812F)) -+#define BIT_GET_TC1DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TC1DATA_8812F) & BIT_MASK_TC1DATA_8812F) -+#define BIT_SET_TC1DATA_8812F(x, v) \ -+ (BIT_CLEAR_TC1DATA_8812F(x) | BIT_TC1DATA_8812F(v)) -+ -+/* 2 REG_TC2_CTRL_8812F */ -+#define BIT_TC2INT_EN_8812F BIT(26) -+#define BIT_TC2MODE_8812F BIT(25) -+#define BIT_TC2EN_8812F BIT(24) -+ -+#define BIT_SHIFT_TC2DATA_8812F 0 -+#define BIT_MASK_TC2DATA_8812F 0xffffff -+#define BIT_TC2DATA_8812F(x) \ -+ (((x) & BIT_MASK_TC2DATA_8812F) << BIT_SHIFT_TC2DATA_8812F) -+#define BITS_TC2DATA_8812F (BIT_MASK_TC2DATA_8812F << BIT_SHIFT_TC2DATA_8812F) -+#define BIT_CLEAR_TC2DATA_8812F(x) ((x) & (~BITS_TC2DATA_8812F)) -+#define BIT_GET_TC2DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TC2DATA_8812F) & BIT_MASK_TC2DATA_8812F) -+#define BIT_SET_TC2DATA_8812F(x, v) \ -+ (BIT_CLEAR_TC2DATA_8812F(x) | BIT_TC2DATA_8812F(v)) -+ -+/* 2 REG_TC3_CTRL_8812F */ -+#define BIT_TC3INT_EN_8812F BIT(26) -+#define BIT_TC3MODE_8812F BIT(25) -+#define BIT_TC3EN_8812F BIT(24) -+ -+#define BIT_SHIFT_TC3DATA_8812F 0 -+#define BIT_MASK_TC3DATA_8812F 0xffffff -+#define BIT_TC3DATA_8812F(x) \ -+ (((x) & BIT_MASK_TC3DATA_8812F) << BIT_SHIFT_TC3DATA_8812F) -+#define BITS_TC3DATA_8812F (BIT_MASK_TC3DATA_8812F << BIT_SHIFT_TC3DATA_8812F) -+#define BIT_CLEAR_TC3DATA_8812F(x) ((x) & (~BITS_TC3DATA_8812F)) -+#define BIT_GET_TC3DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TC3DATA_8812F) & BIT_MASK_TC3DATA_8812F) -+#define BIT_SET_TC3DATA_8812F(x, v) \ -+ (BIT_CLEAR_TC3DATA_8812F(x) | BIT_TC3DATA_8812F(v)) -+ -+/* 2 REG_TC4_CTRL_8812F */ -+#define BIT_TC4INT_EN_8812F BIT(26) -+#define BIT_TC4MODE_8812F BIT(25) -+#define BIT_TC4EN_8812F BIT(24) -+ -+#define BIT_SHIFT_TC4DATA_8812F 0 -+#define BIT_MASK_TC4DATA_8812F 0xffffff -+#define BIT_TC4DATA_8812F(x) \ -+ (((x) & BIT_MASK_TC4DATA_8812F) << BIT_SHIFT_TC4DATA_8812F) -+#define BITS_TC4DATA_8812F (BIT_MASK_TC4DATA_8812F << BIT_SHIFT_TC4DATA_8812F) -+#define BIT_CLEAR_TC4DATA_8812F(x) ((x) & (~BITS_TC4DATA_8812F)) -+#define BIT_GET_TC4DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TC4DATA_8812F) & BIT_MASK_TC4DATA_8812F) -+#define BIT_SET_TC4DATA_8812F(x, v) \ -+ (BIT_CLEAR_TC4DATA_8812F(x) | BIT_TC4DATA_8812F(v)) -+ -+/* 2 REG_TCUNIT_BASE_8812F */ -+ -+#define BIT_SHIFT_TCUNIT_BASE_8812F 0 -+#define BIT_MASK_TCUNIT_BASE_8812F 0x3fff -+#define BIT_TCUNIT_BASE_8812F(x) \ -+ (((x) & BIT_MASK_TCUNIT_BASE_8812F) << BIT_SHIFT_TCUNIT_BASE_8812F) -+#define BITS_TCUNIT_BASE_8812F \ -+ (BIT_MASK_TCUNIT_BASE_8812F << BIT_SHIFT_TCUNIT_BASE_8812F) -+#define BIT_CLEAR_TCUNIT_BASE_8812F(x) ((x) & (~BITS_TCUNIT_BASE_8812F)) -+#define BIT_GET_TCUNIT_BASE_8812F(x) \ -+ (((x) >> BIT_SHIFT_TCUNIT_BASE_8812F) & BIT_MASK_TCUNIT_BASE_8812F) -+#define BIT_SET_TCUNIT_BASE_8812F(x, v) \ -+ (BIT_CLEAR_TCUNIT_BASE_8812F(x) | BIT_TCUNIT_BASE_8812F(v)) -+ -+/* 2 REG_TC5_CTRL_8812F */ -+#define BIT_TC5INT_EN_8812F BIT(26) -+#define BIT_TC5MODE_8812F BIT(25) -+#define BIT_TC5EN_8812F BIT(24) -+ -+#define BIT_SHIFT_TC5DATA_8812F 0 -+#define BIT_MASK_TC5DATA_8812F 0xffffff -+#define BIT_TC5DATA_8812F(x) \ -+ (((x) & BIT_MASK_TC5DATA_8812F) << BIT_SHIFT_TC5DATA_8812F) -+#define BITS_TC5DATA_8812F (BIT_MASK_TC5DATA_8812F << BIT_SHIFT_TC5DATA_8812F) -+#define BIT_CLEAR_TC5DATA_8812F(x) ((x) & (~BITS_TC5DATA_8812F)) -+#define BIT_GET_TC5DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TC5DATA_8812F) & BIT_MASK_TC5DATA_8812F) -+#define BIT_SET_TC5DATA_8812F(x, v) \ -+ (BIT_CLEAR_TC5DATA_8812F(x) | BIT_TC5DATA_8812F(v)) -+ -+/* 2 REG_TC6_CTRL_8812F */ -+#define BIT_TC6INT_EN_8812F BIT(26) -+#define BIT_TC6MODE_8812F BIT(25) -+#define BIT_TC6EN_8812F BIT(24) -+ -+#define BIT_SHIFT_TC6DATA_8812F 0 -+#define BIT_MASK_TC6DATA_8812F 0xffffff -+#define BIT_TC6DATA_8812F(x) \ -+ (((x) & BIT_MASK_TC6DATA_8812F) << BIT_SHIFT_TC6DATA_8812F) -+#define BITS_TC6DATA_8812F (BIT_MASK_TC6DATA_8812F << BIT_SHIFT_TC6DATA_8812F) -+#define BIT_CLEAR_TC6DATA_8812F(x) ((x) & (~BITS_TC6DATA_8812F)) -+#define BIT_GET_TC6DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TC6DATA_8812F) & BIT_MASK_TC6DATA_8812F) -+#define BIT_SET_TC6DATA_8812F(x, v) \ -+ (BIT_CLEAR_TC6DATA_8812F(x) | BIT_TC6DATA_8812F(v)) -+ -+/* 2 REG_MBIST_DRF_FAIL_8812F */ -+ -+#define BIT_SHIFT_8051_MBIST_DRF_FAIL_8812F 26 -+#define BIT_MASK_8051_MBIST_DRF_FAIL_8812F 0x3f -+#define BIT_8051_MBIST_DRF_FAIL_8812F(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DRF_FAIL_8812F) \ -+ << BIT_SHIFT_8051_MBIST_DRF_FAIL_8812F) -+#define BITS_8051_MBIST_DRF_FAIL_8812F \ -+ (BIT_MASK_8051_MBIST_DRF_FAIL_8812F \ -+ << BIT_SHIFT_8051_MBIST_DRF_FAIL_8812F) -+#define BIT_CLEAR_8051_MBIST_DRF_FAIL_8812F(x) \ -+ ((x) & (~BITS_8051_MBIST_DRF_FAIL_8812F)) -+#define BIT_GET_8051_MBIST_DRF_FAIL_8812F(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DRF_FAIL_8812F) & \ -+ BIT_MASK_8051_MBIST_DRF_FAIL_8812F) -+#define BIT_SET_8051_MBIST_DRF_FAIL_8812F(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DRF_FAIL_8812F(x) | \ -+ BIT_8051_MBIST_DRF_FAIL_8812F(v)) -+ -+#define BIT_SHIFT_USB_MBIST_DRF_FAIL_8812F 24 -+#define BIT_MASK_USB_MBIST_DRF_FAIL_8812F 0x3 -+#define BIT_USB_MBIST_DRF_FAIL_8812F(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DRF_FAIL_8812F) \ -+ << BIT_SHIFT_USB_MBIST_DRF_FAIL_8812F) -+#define BITS_USB_MBIST_DRF_FAIL_8812F \ -+ (BIT_MASK_USB_MBIST_DRF_FAIL_8812F \ -+ << BIT_SHIFT_USB_MBIST_DRF_FAIL_8812F) -+#define BIT_CLEAR_USB_MBIST_DRF_FAIL_8812F(x) \ -+ ((x) & (~BITS_USB_MBIST_DRF_FAIL_8812F)) -+#define BIT_GET_USB_MBIST_DRF_FAIL_8812F(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DRF_FAIL_8812F) & \ -+ BIT_MASK_USB_MBIST_DRF_FAIL_8812F) -+#define BIT_SET_USB_MBIST_DRF_FAIL_8812F(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DRF_FAIL_8812F(x) | \ -+ BIT_USB_MBIST_DRF_FAIL_8812F(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8812F 18 -+#define BIT_MASK_PCIE_MBIST_DRF_FAIL_8812F 0x3f -+#define BIT_PCIE_MBIST_DRF_FAIL_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DRF_FAIL_8812F) \ -+ << BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8812F) -+#define BITS_PCIE_MBIST_DRF_FAIL_8812F \ -+ (BIT_MASK_PCIE_MBIST_DRF_FAIL_8812F \ -+ << BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8812F) -+#define BIT_CLEAR_PCIE_MBIST_DRF_FAIL_8812F(x) \ -+ ((x) & (~BITS_PCIE_MBIST_DRF_FAIL_8812F)) -+#define BIT_GET_PCIE_MBIST_DRF_FAIL_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8812F) & \ -+ BIT_MASK_PCIE_MBIST_DRF_FAIL_8812F) -+#define BIT_SET_PCIE_MBIST_DRF_FAIL_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DRF_FAIL_8812F(x) | \ -+ BIT_PCIE_MBIST_DRF_FAIL_8812F(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_DRF_FAIL_8812F 0 -+#define BIT_MASK_MAC_MBIST_DRF_FAIL_8812F 0x3ffff -+#define BIT_MAC_MBIST_DRF_FAIL_8812F(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DRF_FAIL_8812F) \ -+ << BIT_SHIFT_MAC_MBIST_DRF_FAIL_8812F) -+#define BITS_MAC_MBIST_DRF_FAIL_8812F \ -+ (BIT_MASK_MAC_MBIST_DRF_FAIL_8812F \ -+ << BIT_SHIFT_MAC_MBIST_DRF_FAIL_8812F) -+#define BIT_CLEAR_MAC_MBIST_DRF_FAIL_8812F(x) \ -+ ((x) & (~BITS_MAC_MBIST_DRF_FAIL_8812F)) -+#define BIT_GET_MAC_MBIST_DRF_FAIL_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DRF_FAIL_8812F) & \ -+ BIT_MASK_MAC_MBIST_DRF_FAIL_8812F) -+#define BIT_SET_MAC_MBIST_DRF_FAIL_8812F(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DRF_FAIL_8812F(x) | \ -+ BIT_MAC_MBIST_DRF_FAIL_8812F(v)) -+ -+/* 2 REG_MBIST_START_PAUSE_8812F */ -+ -+#define BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8812F 26 -+#define BIT_MASK_8051_MBIST_START_PAUSE_V1_8812F 0x3f -+#define BIT_8051_MBIST_START_PAUSE_V1_8812F(x) \ -+ (((x) & BIT_MASK_8051_MBIST_START_PAUSE_V1_8812F) \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8812F) -+#define BITS_8051_MBIST_START_PAUSE_V1_8812F \ -+ (BIT_MASK_8051_MBIST_START_PAUSE_V1_8812F \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8812F) -+#define BIT_CLEAR_8051_MBIST_START_PAUSE_V1_8812F(x) \ -+ ((x) & (~BITS_8051_MBIST_START_PAUSE_V1_8812F)) -+#define BIT_GET_8051_MBIST_START_PAUSE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8812F) & \ -+ BIT_MASK_8051_MBIST_START_PAUSE_V1_8812F) -+#define BIT_SET_8051_MBIST_START_PAUSE_V1_8812F(x, v) \ -+ (BIT_CLEAR_8051_MBIST_START_PAUSE_V1_8812F(x) | \ -+ BIT_8051_MBIST_START_PAUSE_V1_8812F(v)) -+ -+#define BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8812F 24 -+#define BIT_MASK_USB_MBIST_START_PAUSE_V1_8812F 0x3 -+#define BIT_USB_MBIST_START_PAUSE_V1_8812F(x) \ -+ (((x) & BIT_MASK_USB_MBIST_START_PAUSE_V1_8812F) \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8812F) -+#define BITS_USB_MBIST_START_PAUSE_V1_8812F \ -+ (BIT_MASK_USB_MBIST_START_PAUSE_V1_8812F \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8812F) -+#define BIT_CLEAR_USB_MBIST_START_PAUSE_V1_8812F(x) \ -+ ((x) & (~BITS_USB_MBIST_START_PAUSE_V1_8812F)) -+#define BIT_GET_USB_MBIST_START_PAUSE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8812F) & \ -+ BIT_MASK_USB_MBIST_START_PAUSE_V1_8812F) -+#define BIT_SET_USB_MBIST_START_PAUSE_V1_8812F(x, v) \ -+ (BIT_CLEAR_USB_MBIST_START_PAUSE_V1_8812F(x) | \ -+ BIT_USB_MBIST_START_PAUSE_V1_8812F(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8812F 18 -+#define BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8812F 0x3f -+#define BIT_PCIE_MBIST_START_PAUSE_V1_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8812F) \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8812F) -+#define BITS_PCIE_MBIST_START_PAUSE_V1_8812F \ -+ (BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8812F \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8812F) -+#define BIT_CLEAR_PCIE_MBIST_START_PAUSE_V1_8812F(x) \ -+ ((x) & (~BITS_PCIE_MBIST_START_PAUSE_V1_8812F)) -+#define BIT_GET_PCIE_MBIST_START_PAUSE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8812F) & \ -+ BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8812F) -+#define BIT_SET_PCIE_MBIST_START_PAUSE_V1_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_START_PAUSE_V1_8812F(x) | \ -+ BIT_PCIE_MBIST_START_PAUSE_V1_8812F(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8812F 0 -+#define BIT_MASK_MAC_MBIST_START_PAUSE_V1_8812F 0x3ffff -+#define BIT_MAC_MBIST_START_PAUSE_V1_8812F(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_START_PAUSE_V1_8812F) \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8812F) -+#define BITS_MAC_MBIST_START_PAUSE_V1_8812F \ -+ (BIT_MASK_MAC_MBIST_START_PAUSE_V1_8812F \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8812F) -+#define BIT_CLEAR_MAC_MBIST_START_PAUSE_V1_8812F(x) \ -+ ((x) & (~BITS_MAC_MBIST_START_PAUSE_V1_8812F)) -+#define BIT_GET_MAC_MBIST_START_PAUSE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8812F) & \ -+ BIT_MASK_MAC_MBIST_START_PAUSE_V1_8812F) -+#define BIT_SET_MAC_MBIST_START_PAUSE_V1_8812F(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_START_PAUSE_V1_8812F(x) | \ -+ BIT_MAC_MBIST_START_PAUSE_V1_8812F(v)) -+ -+/* 2 REG_MBIST_DONE_8812F */ -+ -+#define BIT_SHIFT_8051_MBIST_DONE_V1_8812F 26 -+#define BIT_MASK_8051_MBIST_DONE_V1_8812F 0x3f -+#define BIT_8051_MBIST_DONE_V1_8812F(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DONE_V1_8812F) \ -+ << BIT_SHIFT_8051_MBIST_DONE_V1_8812F) -+#define BITS_8051_MBIST_DONE_V1_8812F \ -+ (BIT_MASK_8051_MBIST_DONE_V1_8812F \ -+ << BIT_SHIFT_8051_MBIST_DONE_V1_8812F) -+#define BIT_CLEAR_8051_MBIST_DONE_V1_8812F(x) \ -+ ((x) & (~BITS_8051_MBIST_DONE_V1_8812F)) -+#define BIT_GET_8051_MBIST_DONE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DONE_V1_8812F) & \ -+ BIT_MASK_8051_MBIST_DONE_V1_8812F) -+#define BIT_SET_8051_MBIST_DONE_V1_8812F(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DONE_V1_8812F(x) | \ -+ BIT_8051_MBIST_DONE_V1_8812F(v)) -+ -+#define BIT_SHIFT_USB_MBIST_DONE_V1_8812F 24 -+#define BIT_MASK_USB_MBIST_DONE_V1_8812F 0x3 -+#define BIT_USB_MBIST_DONE_V1_8812F(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DONE_V1_8812F) \ -+ << BIT_SHIFT_USB_MBIST_DONE_V1_8812F) -+#define BITS_USB_MBIST_DONE_V1_8812F \ -+ (BIT_MASK_USB_MBIST_DONE_V1_8812F << BIT_SHIFT_USB_MBIST_DONE_V1_8812F) -+#define BIT_CLEAR_USB_MBIST_DONE_V1_8812F(x) \ -+ ((x) & (~BITS_USB_MBIST_DONE_V1_8812F)) -+#define BIT_GET_USB_MBIST_DONE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DONE_V1_8812F) & \ -+ BIT_MASK_USB_MBIST_DONE_V1_8812F) -+#define BIT_SET_USB_MBIST_DONE_V1_8812F(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DONE_V1_8812F(x) | BIT_USB_MBIST_DONE_V1_8812F(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DONE_V1_8812F 18 -+#define BIT_MASK_PCIE_MBIST_DONE_V1_8812F 0x3f -+#define BIT_PCIE_MBIST_DONE_V1_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DONE_V1_8812F) \ -+ << BIT_SHIFT_PCIE_MBIST_DONE_V1_8812F) -+#define BITS_PCIE_MBIST_DONE_V1_8812F \ -+ (BIT_MASK_PCIE_MBIST_DONE_V1_8812F \ -+ << BIT_SHIFT_PCIE_MBIST_DONE_V1_8812F) -+#define BIT_CLEAR_PCIE_MBIST_DONE_V1_8812F(x) \ -+ ((x) & (~BITS_PCIE_MBIST_DONE_V1_8812F)) -+#define BIT_GET_PCIE_MBIST_DONE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DONE_V1_8812F) & \ -+ BIT_MASK_PCIE_MBIST_DONE_V1_8812F) -+#define BIT_SET_PCIE_MBIST_DONE_V1_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DONE_V1_8812F(x) | \ -+ BIT_PCIE_MBIST_DONE_V1_8812F(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_DONE_V1_8812F 0 -+#define BIT_MASK_MAC_MBIST_DONE_V1_8812F 0x3ffff -+#define BIT_MAC_MBIST_DONE_V1_8812F(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DONE_V1_8812F) \ -+ << BIT_SHIFT_MAC_MBIST_DONE_V1_8812F) -+#define BITS_MAC_MBIST_DONE_V1_8812F \ -+ (BIT_MASK_MAC_MBIST_DONE_V1_8812F << BIT_SHIFT_MAC_MBIST_DONE_V1_8812F) -+#define BIT_CLEAR_MAC_MBIST_DONE_V1_8812F(x) \ -+ ((x) & (~BITS_MAC_MBIST_DONE_V1_8812F)) -+#define BIT_GET_MAC_MBIST_DONE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DONE_V1_8812F) & \ -+ BIT_MASK_MAC_MBIST_DONE_V1_8812F) -+#define BIT_SET_MAC_MBIST_DONE_V1_8812F(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DONE_V1_8812F(x) | BIT_MAC_MBIST_DONE_V1_8812F(v)) -+ -+/* 2 REG_MBIST_READ_BIST_RPT_8812F */ -+ -+#define BIT_SHIFT_MBIST_READ_BIST_RPT_8812F 0 -+#define BIT_MASK_MBIST_READ_BIST_RPT_8812F 0xffffffffL -+#define BIT_MBIST_READ_BIST_RPT_8812F(x) \ -+ (((x) & BIT_MASK_MBIST_READ_BIST_RPT_8812F) \ -+ << BIT_SHIFT_MBIST_READ_BIST_RPT_8812F) -+#define BITS_MBIST_READ_BIST_RPT_8812F \ -+ (BIT_MASK_MBIST_READ_BIST_RPT_8812F \ -+ << BIT_SHIFT_MBIST_READ_BIST_RPT_8812F) -+#define BIT_CLEAR_MBIST_READ_BIST_RPT_8812F(x) \ -+ ((x) & (~BITS_MBIST_READ_BIST_RPT_8812F)) -+#define BIT_GET_MBIST_READ_BIST_RPT_8812F(x) \ -+ (((x) >> BIT_SHIFT_MBIST_READ_BIST_RPT_8812F) & \ -+ BIT_MASK_MBIST_READ_BIST_RPT_8812F) -+#define BIT_SET_MBIST_READ_BIST_RPT_8812F(x, v) \ -+ (BIT_CLEAR_MBIST_READ_BIST_RPT_8812F(x) | \ -+ BIT_MBIST_READ_BIST_RPT_8812F(v)) -+ -+/* 2 REG_AES_DECRPT_DATA_8812F */ -+ -+#define BIT_SHIFT_IPS_CFG_ADDR_8812F 0 -+#define BIT_MASK_IPS_CFG_ADDR_8812F 0xff -+#define BIT_IPS_CFG_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_IPS_CFG_ADDR_8812F) << BIT_SHIFT_IPS_CFG_ADDR_8812F) -+#define BITS_IPS_CFG_ADDR_8812F \ -+ (BIT_MASK_IPS_CFG_ADDR_8812F << BIT_SHIFT_IPS_CFG_ADDR_8812F) -+#define BIT_CLEAR_IPS_CFG_ADDR_8812F(x) ((x) & (~BITS_IPS_CFG_ADDR_8812F)) -+#define BIT_GET_IPS_CFG_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_ADDR_8812F) & BIT_MASK_IPS_CFG_ADDR_8812F) -+#define BIT_SET_IPS_CFG_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_IPS_CFG_ADDR_8812F(x) | BIT_IPS_CFG_ADDR_8812F(v)) -+ -+/* 2 REG_AES_DECRPT_CFG_8812F */ -+ -+#define BIT_SHIFT_IPS_CFG_DATA_8812F 0 -+#define BIT_MASK_IPS_CFG_DATA_8812F 0xffffffffL -+#define BIT_IPS_CFG_DATA_8812F(x) \ -+ (((x) & BIT_MASK_IPS_CFG_DATA_8812F) << BIT_SHIFT_IPS_CFG_DATA_8812F) -+#define BITS_IPS_CFG_DATA_8812F \ -+ (BIT_MASK_IPS_CFG_DATA_8812F << BIT_SHIFT_IPS_CFG_DATA_8812F) -+#define BIT_CLEAR_IPS_CFG_DATA_8812F(x) ((x) & (~BITS_IPS_CFG_DATA_8812F)) -+#define BIT_GET_IPS_CFG_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_DATA_8812F) & BIT_MASK_IPS_CFG_DATA_8812F) -+#define BIT_SET_IPS_CFG_DATA_8812F(x, v) \ -+ (BIT_CLEAR_IPS_CFG_DATA_8812F(x) | BIT_IPS_CFG_DATA_8812F(v)) -+ -+/* 2 REG_HIOE_CTRL_8812F */ -+#define BIT_HIOE_CFG_FILE_LOC_SEL_8812F BIT(31) -+#define BIT_HIOE_WRITE_REQ_8812F BIT(30) -+#define BIT_HIOE_READ_REQ_8812F BIT(29) -+#define BIT_INST_FORMAT_ERR_8812F BIT(25) -+#define BIT_OP_TIMEOUT_ERR_8812F BIT(24) -+ -+#define BIT_SHIFT_HIOE_OP_TIMEOUT_8812F 16 -+#define BIT_MASK_HIOE_OP_TIMEOUT_8812F 0xff -+#define BIT_HIOE_OP_TIMEOUT_8812F(x) \ -+ (((x) & BIT_MASK_HIOE_OP_TIMEOUT_8812F) \ -+ << BIT_SHIFT_HIOE_OP_TIMEOUT_8812F) -+#define BITS_HIOE_OP_TIMEOUT_8812F \ -+ (BIT_MASK_HIOE_OP_TIMEOUT_8812F << BIT_SHIFT_HIOE_OP_TIMEOUT_8812F) -+#define BIT_CLEAR_HIOE_OP_TIMEOUT_8812F(x) ((x) & (~BITS_HIOE_OP_TIMEOUT_8812F)) -+#define BIT_GET_HIOE_OP_TIMEOUT_8812F(x) \ -+ (((x) >> BIT_SHIFT_HIOE_OP_TIMEOUT_8812F) & \ -+ BIT_MASK_HIOE_OP_TIMEOUT_8812F) -+#define BIT_SET_HIOE_OP_TIMEOUT_8812F(x, v) \ -+ (BIT_CLEAR_HIOE_OP_TIMEOUT_8812F(x) | BIT_HIOE_OP_TIMEOUT_8812F(v)) -+ -+#define BIT_SHIFT_BITDATA_CHECKSUM_8812F 0 -+#define BIT_MASK_BITDATA_CHECKSUM_8812F 0xffff -+#define BIT_BITDATA_CHECKSUM_8812F(x) \ -+ (((x) & BIT_MASK_BITDATA_CHECKSUM_8812F) \ -+ << BIT_SHIFT_BITDATA_CHECKSUM_8812F) -+#define BITS_BITDATA_CHECKSUM_8812F \ -+ (BIT_MASK_BITDATA_CHECKSUM_8812F << BIT_SHIFT_BITDATA_CHECKSUM_8812F) -+#define BIT_CLEAR_BITDATA_CHECKSUM_8812F(x) \ -+ ((x) & (~BITS_BITDATA_CHECKSUM_8812F)) -+#define BIT_GET_BITDATA_CHECKSUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_BITDATA_CHECKSUM_8812F) & \ -+ BIT_MASK_BITDATA_CHECKSUM_8812F) -+#define BIT_SET_BITDATA_CHECKSUM_8812F(x, v) \ -+ (BIT_CLEAR_BITDATA_CHECKSUM_8812F(x) | BIT_BITDATA_CHECKSUM_8812F(v)) -+ -+/* 2 REG_HIOE_CFG_FILE_8812F */ -+ -+#define BIT_SHIFT_TXBF_END_ADDR_8812F 16 -+#define BIT_MASK_TXBF_END_ADDR_8812F 0xffff -+#define BIT_TXBF_END_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_TXBF_END_ADDR_8812F) << BIT_SHIFT_TXBF_END_ADDR_8812F) -+#define BITS_TXBF_END_ADDR_8812F \ -+ (BIT_MASK_TXBF_END_ADDR_8812F << BIT_SHIFT_TXBF_END_ADDR_8812F) -+#define BIT_CLEAR_TXBF_END_ADDR_8812F(x) ((x) & (~BITS_TXBF_END_ADDR_8812F)) -+#define BIT_GET_TXBF_END_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXBF_END_ADDR_8812F) & BIT_MASK_TXBF_END_ADDR_8812F) -+#define BIT_SET_TXBF_END_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_TXBF_END_ADDR_8812F(x) | BIT_TXBF_END_ADDR_8812F(v)) -+ -+#define BIT_SHIFT_TXBF_STR_ADDR_8812F 0 -+#define BIT_MASK_TXBF_STR_ADDR_8812F 0xffff -+#define BIT_TXBF_STR_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_TXBF_STR_ADDR_8812F) << BIT_SHIFT_TXBF_STR_ADDR_8812F) -+#define BITS_TXBF_STR_ADDR_8812F \ -+ (BIT_MASK_TXBF_STR_ADDR_8812F << BIT_SHIFT_TXBF_STR_ADDR_8812F) -+#define BIT_CLEAR_TXBF_STR_ADDR_8812F(x) ((x) & (~BITS_TXBF_STR_ADDR_8812F)) -+#define BIT_GET_TXBF_STR_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXBF_STR_ADDR_8812F) & BIT_MASK_TXBF_STR_ADDR_8812F) -+#define BIT_SET_TXBF_STR_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_TXBF_STR_ADDR_8812F(x) | BIT_TXBF_STR_ADDR_8812F(v)) -+ -+/* 2 REG_TMETER_8812F */ -+#define BIT_TEMP_VALID_8812F BIT(31) -+ -+#define BIT_SHIFT_TEMP_VALUE_8812F 24 -+#define BIT_MASK_TEMP_VALUE_8812F 0x3f -+#define BIT_TEMP_VALUE_8812F(x) \ -+ (((x) & BIT_MASK_TEMP_VALUE_8812F) << BIT_SHIFT_TEMP_VALUE_8812F) -+#define BITS_TEMP_VALUE_8812F \ -+ (BIT_MASK_TEMP_VALUE_8812F << BIT_SHIFT_TEMP_VALUE_8812F) -+#define BIT_CLEAR_TEMP_VALUE_8812F(x) ((x) & (~BITS_TEMP_VALUE_8812F)) -+#define BIT_GET_TEMP_VALUE_8812F(x) \ -+ (((x) >> BIT_SHIFT_TEMP_VALUE_8812F) & BIT_MASK_TEMP_VALUE_8812F) -+#define BIT_SET_TEMP_VALUE_8812F(x, v) \ -+ (BIT_CLEAR_TEMP_VALUE_8812F(x) | BIT_TEMP_VALUE_8812F(v)) -+ -+#define BIT_SHIFT_REG_TMETER_TIMER_8812F 8 -+#define BIT_MASK_REG_TMETER_TIMER_8812F 0xfff -+#define BIT_REG_TMETER_TIMER_8812F(x) \ -+ (((x) & BIT_MASK_REG_TMETER_TIMER_8812F) \ -+ << BIT_SHIFT_REG_TMETER_TIMER_8812F) -+#define BITS_REG_TMETER_TIMER_8812F \ -+ (BIT_MASK_REG_TMETER_TIMER_8812F << BIT_SHIFT_REG_TMETER_TIMER_8812F) -+#define BIT_CLEAR_REG_TMETER_TIMER_8812F(x) \ -+ ((x) & (~BITS_REG_TMETER_TIMER_8812F)) -+#define BIT_GET_REG_TMETER_TIMER_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_TMETER_TIMER_8812F) & \ -+ BIT_MASK_REG_TMETER_TIMER_8812F) -+#define BIT_SET_REG_TMETER_TIMER_8812F(x, v) \ -+ (BIT_CLEAR_REG_TMETER_TIMER_8812F(x) | BIT_REG_TMETER_TIMER_8812F(v)) -+ -+#define BIT_SHIFT_REG_TEMP_DELTA_8812F 2 -+#define BIT_MASK_REG_TEMP_DELTA_8812F 0x3f -+#define BIT_REG_TEMP_DELTA_8812F(x) \ -+ (((x) & BIT_MASK_REG_TEMP_DELTA_8812F) \ -+ << BIT_SHIFT_REG_TEMP_DELTA_8812F) -+#define BITS_REG_TEMP_DELTA_8812F \ -+ (BIT_MASK_REG_TEMP_DELTA_8812F << BIT_SHIFT_REG_TEMP_DELTA_8812F) -+#define BIT_CLEAR_REG_TEMP_DELTA_8812F(x) ((x) & (~BITS_REG_TEMP_DELTA_8812F)) -+#define BIT_GET_REG_TEMP_DELTA_8812F(x) \ -+ (((x) >> BIT_SHIFT_REG_TEMP_DELTA_8812F) & \ -+ BIT_MASK_REG_TEMP_DELTA_8812F) -+#define BIT_SET_REG_TEMP_DELTA_8812F(x, v) \ -+ (BIT_CLEAR_REG_TEMP_DELTA_8812F(x) | BIT_REG_TEMP_DELTA_8812F(v)) -+ -+#define BIT_REG_TMETER_EN_8812F BIT(0) -+ -+/* 2 REG_OSC_32K_CTRL_8812F */ -+ -+#define BIT_SHIFT_OSC_32K_CLKGEN_0_8812F 16 -+#define BIT_MASK_OSC_32K_CLKGEN_0_8812F 0xffff -+#define BIT_OSC_32K_CLKGEN_0_8812F(x) \ -+ (((x) & BIT_MASK_OSC_32K_CLKGEN_0_8812F) \ -+ << BIT_SHIFT_OSC_32K_CLKGEN_0_8812F) -+#define BITS_OSC_32K_CLKGEN_0_8812F \ -+ (BIT_MASK_OSC_32K_CLKGEN_0_8812F << BIT_SHIFT_OSC_32K_CLKGEN_0_8812F) -+#define BIT_CLEAR_OSC_32K_CLKGEN_0_8812F(x) \ -+ ((x) & (~BITS_OSC_32K_CLKGEN_0_8812F)) -+#define BIT_GET_OSC_32K_CLKGEN_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_CLKGEN_0_8812F) & \ -+ BIT_MASK_OSC_32K_CLKGEN_0_8812F) -+#define BIT_SET_OSC_32K_CLKGEN_0_8812F(x, v) \ -+ (BIT_CLEAR_OSC_32K_CLKGEN_0_8812F(x) | BIT_OSC_32K_CLKGEN_0_8812F(v)) -+ -+#define BIT_SHIFT_OSC_32K_RES_COMP_8812F 4 -+#define BIT_MASK_OSC_32K_RES_COMP_8812F 0x3 -+#define BIT_OSC_32K_RES_COMP_8812F(x) \ -+ (((x) & BIT_MASK_OSC_32K_RES_COMP_8812F) \ -+ << BIT_SHIFT_OSC_32K_RES_COMP_8812F) -+#define BITS_OSC_32K_RES_COMP_8812F \ -+ (BIT_MASK_OSC_32K_RES_COMP_8812F << BIT_SHIFT_OSC_32K_RES_COMP_8812F) -+#define BIT_CLEAR_OSC_32K_RES_COMP_8812F(x) \ -+ ((x) & (~BITS_OSC_32K_RES_COMP_8812F)) -+#define BIT_GET_OSC_32K_RES_COMP_8812F(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_RES_COMP_8812F) & \ -+ BIT_MASK_OSC_32K_RES_COMP_8812F) -+#define BIT_SET_OSC_32K_RES_COMP_8812F(x, v) \ -+ (BIT_CLEAR_OSC_32K_RES_COMP_8812F(x) | BIT_OSC_32K_RES_COMP_8812F(v)) -+ -+#define BIT_OSC_32K_OUT_SEL_8812F BIT(3) -+#define BIT_ISO_WL_2_OSC_32K_8812F BIT(1) -+#define BIT_POW_CKGEN_8812F BIT(0) -+ -+/* 2 REG_32K_CAL_REG1_8812F */ -+#define BIT_CAL_32K_REG_WR_8812F BIT(31) -+#define BIT_CAL_32K_DBG_SEL_8812F BIT(22) -+ -+#define BIT_SHIFT_CAL_32K_REG_ADDR_8812F 16 -+#define BIT_MASK_CAL_32K_REG_ADDR_8812F 0x3f -+#define BIT_CAL_32K_REG_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_ADDR_8812F) \ -+ << BIT_SHIFT_CAL_32K_REG_ADDR_8812F) -+#define BITS_CAL_32K_REG_ADDR_8812F \ -+ (BIT_MASK_CAL_32K_REG_ADDR_8812F << BIT_SHIFT_CAL_32K_REG_ADDR_8812F) -+#define BIT_CLEAR_CAL_32K_REG_ADDR_8812F(x) \ -+ ((x) & (~BITS_CAL_32K_REG_ADDR_8812F)) -+#define BIT_GET_CAL_32K_REG_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_ADDR_8812F) & \ -+ BIT_MASK_CAL_32K_REG_ADDR_8812F) -+#define BIT_SET_CAL_32K_REG_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_ADDR_8812F(x) | BIT_CAL_32K_REG_ADDR_8812F(v)) -+ -+#define BIT_SHIFT_CAL_32K_REG_DATA_8812F 0 -+#define BIT_MASK_CAL_32K_REG_DATA_8812F 0xffff -+#define BIT_CAL_32K_REG_DATA_8812F(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_DATA_8812F) \ -+ << BIT_SHIFT_CAL_32K_REG_DATA_8812F) -+#define BITS_CAL_32K_REG_DATA_8812F \ -+ (BIT_MASK_CAL_32K_REG_DATA_8812F << BIT_SHIFT_CAL_32K_REG_DATA_8812F) -+#define BIT_CLEAR_CAL_32K_REG_DATA_8812F(x) \ -+ ((x) & (~BITS_CAL_32K_REG_DATA_8812F)) -+#define BIT_GET_CAL_32K_REG_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_DATA_8812F) & \ -+ BIT_MASK_CAL_32K_REG_DATA_8812F) -+#define BIT_SET_CAL_32K_REG_DATA_8812F(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_DATA_8812F(x) | BIT_CAL_32K_REG_DATA_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_C2HEVT_8812F */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_V1_8812F 0 -+#define BIT_MASK_C2HEVT_MSG_V1_8812F 0xffffffffL -+#define BIT_C2HEVT_MSG_V1_8812F(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_V1_8812F) << BIT_SHIFT_C2HEVT_MSG_V1_8812F) -+#define BITS_C2HEVT_MSG_V1_8812F \ -+ (BIT_MASK_C2HEVT_MSG_V1_8812F << BIT_SHIFT_C2HEVT_MSG_V1_8812F) -+#define BIT_CLEAR_C2HEVT_MSG_V1_8812F(x) ((x) & (~BITS_C2HEVT_MSG_V1_8812F)) -+#define BIT_GET_C2HEVT_MSG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_V1_8812F) & BIT_MASK_C2HEVT_MSG_V1_8812F) -+#define BIT_SET_C2HEVT_MSG_V1_8812F(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_V1_8812F(x) | BIT_C2HEVT_MSG_V1_8812F(v)) -+ -+/* 2 REG_C2HEVT_1_8812F */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_1_8812F 0 -+#define BIT_MASK_C2HEVT_MSG_1_8812F 0xffffffffL -+#define BIT_C2HEVT_MSG_1_8812F(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_1_8812F) << BIT_SHIFT_C2HEVT_MSG_1_8812F) -+#define BITS_C2HEVT_MSG_1_8812F \ -+ (BIT_MASK_C2HEVT_MSG_1_8812F << BIT_SHIFT_C2HEVT_MSG_1_8812F) -+#define BIT_CLEAR_C2HEVT_MSG_1_8812F(x) ((x) & (~BITS_C2HEVT_MSG_1_8812F)) -+#define BIT_GET_C2HEVT_MSG_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_1_8812F) & BIT_MASK_C2HEVT_MSG_1_8812F) -+#define BIT_SET_C2HEVT_MSG_1_8812F(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_1_8812F(x) | BIT_C2HEVT_MSG_1_8812F(v)) -+ -+/* 2 REG_C2HEVT_2_8812F */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_2_8812F 0 -+#define BIT_MASK_C2HEVT_MSG_2_8812F 0xffffffffL -+#define BIT_C2HEVT_MSG_2_8812F(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_2_8812F) << BIT_SHIFT_C2HEVT_MSG_2_8812F) -+#define BITS_C2HEVT_MSG_2_8812F \ -+ (BIT_MASK_C2HEVT_MSG_2_8812F << BIT_SHIFT_C2HEVT_MSG_2_8812F) -+#define BIT_CLEAR_C2HEVT_MSG_2_8812F(x) ((x) & (~BITS_C2HEVT_MSG_2_8812F)) -+#define BIT_GET_C2HEVT_MSG_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_2_8812F) & BIT_MASK_C2HEVT_MSG_2_8812F) -+#define BIT_SET_C2HEVT_MSG_2_8812F(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_2_8812F(x) | BIT_C2HEVT_MSG_2_8812F(v)) -+ -+/* 2 REG_C2HEVT_3_8812F */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_3_8812F 0 -+#define BIT_MASK_C2HEVT_MSG_3_8812F 0xffffffffL -+#define BIT_C2HEVT_MSG_3_8812F(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_3_8812F) << BIT_SHIFT_C2HEVT_MSG_3_8812F) -+#define BITS_C2HEVT_MSG_3_8812F \ -+ (BIT_MASK_C2HEVT_MSG_3_8812F << BIT_SHIFT_C2HEVT_MSG_3_8812F) -+#define BIT_CLEAR_C2HEVT_MSG_3_8812F(x) ((x) & (~BITS_C2HEVT_MSG_3_8812F)) -+#define BIT_GET_C2HEVT_MSG_3_8812F(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_3_8812F) & BIT_MASK_C2HEVT_MSG_3_8812F) -+#define BIT_SET_C2HEVT_MSG_3_8812F(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_3_8812F(x) | BIT_C2HEVT_MSG_3_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_SW_DEFINED_PAGE1_8812F */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE1_V1_8812F 0 -+#define BIT_MASK_SW_DEFINED_PAGE1_V1_8812F 0xffffffffL -+#define BIT_SW_DEFINED_PAGE1_V1_8812F(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE1_V1_8812F) \ -+ << BIT_SHIFT_SW_DEFINED_PAGE1_V1_8812F) -+#define BITS_SW_DEFINED_PAGE1_V1_8812F \ -+ (BIT_MASK_SW_DEFINED_PAGE1_V1_8812F \ -+ << BIT_SHIFT_SW_DEFINED_PAGE1_V1_8812F) -+#define BIT_CLEAR_SW_DEFINED_PAGE1_V1_8812F(x) \ -+ ((x) & (~BITS_SW_DEFINED_PAGE1_V1_8812F)) -+#define BIT_GET_SW_DEFINED_PAGE1_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE1_V1_8812F) & \ -+ BIT_MASK_SW_DEFINED_PAGE1_V1_8812F) -+#define BIT_SET_SW_DEFINED_PAGE1_V1_8812F(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE1_V1_8812F(x) | \ -+ BIT_SW_DEFINED_PAGE1_V1_8812F(v)) -+ -+/* 2 REG_SW_DEFINED_PAGE2_8812F */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE2_8812F 0 -+#define BIT_MASK_SW_DEFINED_PAGE2_8812F 0xffffffffL -+#define BIT_SW_DEFINED_PAGE2_8812F(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE2_8812F) \ -+ << BIT_SHIFT_SW_DEFINED_PAGE2_8812F) -+#define BITS_SW_DEFINED_PAGE2_8812F \ -+ (BIT_MASK_SW_DEFINED_PAGE2_8812F << BIT_SHIFT_SW_DEFINED_PAGE2_8812F) -+#define BIT_CLEAR_SW_DEFINED_PAGE2_8812F(x) \ -+ ((x) & (~BITS_SW_DEFINED_PAGE2_8812F)) -+#define BIT_GET_SW_DEFINED_PAGE2_8812F(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE2_8812F) & \ -+ BIT_MASK_SW_DEFINED_PAGE2_8812F) -+#define BIT_SET_SW_DEFINED_PAGE2_8812F(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE2_8812F(x) | BIT_SW_DEFINED_PAGE2_8812F(v)) -+ -+/* 2 REG_MCUTST_I_8812F */ -+ -+#define BIT_SHIFT_MCUDMSG_I_8812F 0 -+#define BIT_MASK_MCUDMSG_I_8812F 0xffffffffL -+#define BIT_MCUDMSG_I_8812F(x) \ -+ (((x) & BIT_MASK_MCUDMSG_I_8812F) << BIT_SHIFT_MCUDMSG_I_8812F) -+#define BITS_MCUDMSG_I_8812F \ -+ (BIT_MASK_MCUDMSG_I_8812F << BIT_SHIFT_MCUDMSG_I_8812F) -+#define BIT_CLEAR_MCUDMSG_I_8812F(x) ((x) & (~BITS_MCUDMSG_I_8812F)) -+#define BIT_GET_MCUDMSG_I_8812F(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_I_8812F) & BIT_MASK_MCUDMSG_I_8812F) -+#define BIT_SET_MCUDMSG_I_8812F(x, v) \ -+ (BIT_CLEAR_MCUDMSG_I_8812F(x) | BIT_MCUDMSG_I_8812F(v)) -+ -+/* 2 REG_MCUTST_II_8812F */ -+ -+#define BIT_SHIFT_MCUDMSG_II_8812F 0 -+#define BIT_MASK_MCUDMSG_II_8812F 0xffffffffL -+#define BIT_MCUDMSG_II_8812F(x) \ -+ (((x) & BIT_MASK_MCUDMSG_II_8812F) << BIT_SHIFT_MCUDMSG_II_8812F) -+#define BITS_MCUDMSG_II_8812F \ -+ (BIT_MASK_MCUDMSG_II_8812F << BIT_SHIFT_MCUDMSG_II_8812F) -+#define BIT_CLEAR_MCUDMSG_II_8812F(x) ((x) & (~BITS_MCUDMSG_II_8812F)) -+#define BIT_GET_MCUDMSG_II_8812F(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_II_8812F) & BIT_MASK_MCUDMSG_II_8812F) -+#define BIT_SET_MCUDMSG_II_8812F(x, v) \ -+ (BIT_CLEAR_MCUDMSG_II_8812F(x) | BIT_MCUDMSG_II_8812F(v)) -+ -+/* 2 REG_FMETHR_8812F */ -+#define BIT_FMSG_INT_8812F BIT(31) -+ -+#define BIT_SHIFT_FW_MSG_8812F 0 -+#define BIT_MASK_FW_MSG_8812F 0xffffffffL -+#define BIT_FW_MSG_8812F(x) \ -+ (((x) & BIT_MASK_FW_MSG_8812F) << BIT_SHIFT_FW_MSG_8812F) -+#define BITS_FW_MSG_8812F (BIT_MASK_FW_MSG_8812F << BIT_SHIFT_FW_MSG_8812F) -+#define BIT_CLEAR_FW_MSG_8812F(x) ((x) & (~BITS_FW_MSG_8812F)) -+#define BIT_GET_FW_MSG_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_8812F) & BIT_MASK_FW_MSG_8812F) -+#define BIT_SET_FW_MSG_8812F(x, v) \ -+ (BIT_CLEAR_FW_MSG_8812F(x) | BIT_FW_MSG_8812F(v)) -+ -+/* 2 REG_HMETFR_8812F */ -+ -+#define BIT_SHIFT_HRCV_MSG_8812F 24 -+#define BIT_MASK_HRCV_MSG_8812F 0xff -+#define BIT_HRCV_MSG_8812F(x) \ -+ (((x) & BIT_MASK_HRCV_MSG_8812F) << BIT_SHIFT_HRCV_MSG_8812F) -+#define BITS_HRCV_MSG_8812F \ -+ (BIT_MASK_HRCV_MSG_8812F << BIT_SHIFT_HRCV_MSG_8812F) -+#define BIT_CLEAR_HRCV_MSG_8812F(x) ((x) & (~BITS_HRCV_MSG_8812F)) -+#define BIT_GET_HRCV_MSG_8812F(x) \ -+ (((x) >> BIT_SHIFT_HRCV_MSG_8812F) & BIT_MASK_HRCV_MSG_8812F) -+#define BIT_SET_HRCV_MSG_8812F(x, v) \ -+ (BIT_CLEAR_HRCV_MSG_8812F(x) | BIT_HRCV_MSG_8812F(v)) -+ -+#define BIT_INT_BOX3_8812F BIT(3) -+#define BIT_INT_BOX2_8812F BIT(2) -+#define BIT_INT_BOX1_8812F BIT(1) -+#define BIT_INT_BOX0_8812F BIT(0) -+ -+/* 2 REG_HMEBOX0_8812F */ -+ -+#define BIT_SHIFT_HOST_MSG_0_8812F 0 -+#define BIT_MASK_HOST_MSG_0_8812F 0xffffffffL -+#define BIT_HOST_MSG_0_8812F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_0_8812F) << BIT_SHIFT_HOST_MSG_0_8812F) -+#define BITS_HOST_MSG_0_8812F \ -+ (BIT_MASK_HOST_MSG_0_8812F << BIT_SHIFT_HOST_MSG_0_8812F) -+#define BIT_CLEAR_HOST_MSG_0_8812F(x) ((x) & (~BITS_HOST_MSG_0_8812F)) -+#define BIT_GET_HOST_MSG_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_0_8812F) & BIT_MASK_HOST_MSG_0_8812F) -+#define BIT_SET_HOST_MSG_0_8812F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_0_8812F(x) | BIT_HOST_MSG_0_8812F(v)) -+ -+/* 2 REG_HMEBOX1_8812F */ -+ -+#define BIT_SHIFT_HOST_MSG_1_8812F 0 -+#define BIT_MASK_HOST_MSG_1_8812F 0xffffffffL -+#define BIT_HOST_MSG_1_8812F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_1_8812F) << BIT_SHIFT_HOST_MSG_1_8812F) -+#define BITS_HOST_MSG_1_8812F \ -+ (BIT_MASK_HOST_MSG_1_8812F << BIT_SHIFT_HOST_MSG_1_8812F) -+#define BIT_CLEAR_HOST_MSG_1_8812F(x) ((x) & (~BITS_HOST_MSG_1_8812F)) -+#define BIT_GET_HOST_MSG_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_1_8812F) & BIT_MASK_HOST_MSG_1_8812F) -+#define BIT_SET_HOST_MSG_1_8812F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_1_8812F(x) | BIT_HOST_MSG_1_8812F(v)) -+ -+/* 2 REG_HMEBOX2_8812F */ -+ -+#define BIT_SHIFT_HOST_MSG_2_8812F 0 -+#define BIT_MASK_HOST_MSG_2_8812F 0xffffffffL -+#define BIT_HOST_MSG_2_8812F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_2_8812F) << BIT_SHIFT_HOST_MSG_2_8812F) -+#define BITS_HOST_MSG_2_8812F \ -+ (BIT_MASK_HOST_MSG_2_8812F << BIT_SHIFT_HOST_MSG_2_8812F) -+#define BIT_CLEAR_HOST_MSG_2_8812F(x) ((x) & (~BITS_HOST_MSG_2_8812F)) -+#define BIT_GET_HOST_MSG_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_2_8812F) & BIT_MASK_HOST_MSG_2_8812F) -+#define BIT_SET_HOST_MSG_2_8812F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_2_8812F(x) | BIT_HOST_MSG_2_8812F(v)) -+ -+/* 2 REG_HMEBOX3_8812F */ -+ -+#define BIT_SHIFT_HOST_MSG_3_8812F 0 -+#define BIT_MASK_HOST_MSG_3_8812F 0xffffffffL -+#define BIT_HOST_MSG_3_8812F(x) \ -+ (((x) & BIT_MASK_HOST_MSG_3_8812F) << BIT_SHIFT_HOST_MSG_3_8812F) -+#define BITS_HOST_MSG_3_8812F \ -+ (BIT_MASK_HOST_MSG_3_8812F << BIT_SHIFT_HOST_MSG_3_8812F) -+#define BIT_CLEAR_HOST_MSG_3_8812F(x) ((x) & (~BITS_HOST_MSG_3_8812F)) -+#define BIT_GET_HOST_MSG_3_8812F(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_3_8812F) & BIT_MASK_HOST_MSG_3_8812F) -+#define BIT_SET_HOST_MSG_3_8812F(x, v) \ -+ (BIT_CLEAR_HOST_MSG_3_8812F(x) | BIT_HOST_MSG_3_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_BB_ACCESS_CTRL_8812F */ -+ -+#define BIT_SHIFT_BB_WRITE_READ_8812F 30 -+#define BIT_MASK_BB_WRITE_READ_8812F 0x3 -+#define BIT_BB_WRITE_READ_8812F(x) \ -+ (((x) & BIT_MASK_BB_WRITE_READ_8812F) << BIT_SHIFT_BB_WRITE_READ_8812F) -+#define BITS_BB_WRITE_READ_8812F \ -+ (BIT_MASK_BB_WRITE_READ_8812F << BIT_SHIFT_BB_WRITE_READ_8812F) -+#define BIT_CLEAR_BB_WRITE_READ_8812F(x) ((x) & (~BITS_BB_WRITE_READ_8812F)) -+#define BIT_GET_BB_WRITE_READ_8812F(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_READ_8812F) & BIT_MASK_BB_WRITE_READ_8812F) -+#define BIT_SET_BB_WRITE_READ_8812F(x, v) \ -+ (BIT_CLEAR_BB_WRITE_READ_8812F(x) | BIT_BB_WRITE_READ_8812F(v)) -+ -+#define BIT_SHIFT_BB_WRITE_EN_8812F 12 -+#define BIT_MASK_BB_WRITE_EN_8812F 0xf -+#define BIT_BB_WRITE_EN_8812F(x) \ -+ (((x) & BIT_MASK_BB_WRITE_EN_8812F) << BIT_SHIFT_BB_WRITE_EN_8812F) -+#define BITS_BB_WRITE_EN_8812F \ -+ (BIT_MASK_BB_WRITE_EN_8812F << BIT_SHIFT_BB_WRITE_EN_8812F) -+#define BIT_CLEAR_BB_WRITE_EN_8812F(x) ((x) & (~BITS_BB_WRITE_EN_8812F)) -+#define BIT_GET_BB_WRITE_EN_8812F(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_EN_8812F) & BIT_MASK_BB_WRITE_EN_8812F) -+#define BIT_SET_BB_WRITE_EN_8812F(x, v) \ -+ (BIT_CLEAR_BB_WRITE_EN_8812F(x) | BIT_BB_WRITE_EN_8812F(v)) -+ -+#define BIT_SHIFT_BB_ADDR_8812F 2 -+#define BIT_MASK_BB_ADDR_8812F 0x1ff -+#define BIT_BB_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_BB_ADDR_8812F) << BIT_SHIFT_BB_ADDR_8812F) -+#define BITS_BB_ADDR_8812F (BIT_MASK_BB_ADDR_8812F << BIT_SHIFT_BB_ADDR_8812F) -+#define BIT_CLEAR_BB_ADDR_8812F(x) ((x) & (~BITS_BB_ADDR_8812F)) -+#define BIT_GET_BB_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_BB_ADDR_8812F) & BIT_MASK_BB_ADDR_8812F) -+#define BIT_SET_BB_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_BB_ADDR_8812F(x) | BIT_BB_ADDR_8812F(v)) -+ -+#define BIT_BB_ERRACC_8812F BIT(0) -+ -+/* 2 REG_BB_ACCESS_DATA_8812F */ -+ -+#define BIT_SHIFT_BB_DATA_8812F 0 -+#define BIT_MASK_BB_DATA_8812F 0xffffffffL -+#define BIT_BB_DATA_8812F(x) \ -+ (((x) & BIT_MASK_BB_DATA_8812F) << BIT_SHIFT_BB_DATA_8812F) -+#define BITS_BB_DATA_8812F (BIT_MASK_BB_DATA_8812F << BIT_SHIFT_BB_DATA_8812F) -+#define BIT_CLEAR_BB_DATA_8812F(x) ((x) & (~BITS_BB_DATA_8812F)) -+#define BIT_GET_BB_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_BB_DATA_8812F) & BIT_MASK_BB_DATA_8812F) -+#define BIT_SET_BB_DATA_8812F(x, v) \ -+ (BIT_CLEAR_BB_DATA_8812F(x) | BIT_BB_DATA_8812F(v)) -+ -+/* 2 REG_HMEBOX_E0_8812F */ -+ -+#define BIT_SHIFT_HMEBOX_E0_8812F 0 -+#define BIT_MASK_HMEBOX_E0_8812F 0xffffffffL -+#define BIT_HMEBOX_E0_8812F(x) \ -+ (((x) & BIT_MASK_HMEBOX_E0_8812F) << BIT_SHIFT_HMEBOX_E0_8812F) -+#define BITS_HMEBOX_E0_8812F \ -+ (BIT_MASK_HMEBOX_E0_8812F << BIT_SHIFT_HMEBOX_E0_8812F) -+#define BIT_CLEAR_HMEBOX_E0_8812F(x) ((x) & (~BITS_HMEBOX_E0_8812F)) -+#define BIT_GET_HMEBOX_E0_8812F(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E0_8812F) & BIT_MASK_HMEBOX_E0_8812F) -+#define BIT_SET_HMEBOX_E0_8812F(x, v) \ -+ (BIT_CLEAR_HMEBOX_E0_8812F(x) | BIT_HMEBOX_E0_8812F(v)) -+ -+/* 2 REG_HMEBOX_E1_8812F */ -+ -+#define BIT_SHIFT_HMEBOX_E1_8812F 0 -+#define BIT_MASK_HMEBOX_E1_8812F 0xffffffffL -+#define BIT_HMEBOX_E1_8812F(x) \ -+ (((x) & BIT_MASK_HMEBOX_E1_8812F) << BIT_SHIFT_HMEBOX_E1_8812F) -+#define BITS_HMEBOX_E1_8812F \ -+ (BIT_MASK_HMEBOX_E1_8812F << BIT_SHIFT_HMEBOX_E1_8812F) -+#define BIT_CLEAR_HMEBOX_E1_8812F(x) ((x) & (~BITS_HMEBOX_E1_8812F)) -+#define BIT_GET_HMEBOX_E1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E1_8812F) & BIT_MASK_HMEBOX_E1_8812F) -+#define BIT_SET_HMEBOX_E1_8812F(x, v) \ -+ (BIT_CLEAR_HMEBOX_E1_8812F(x) | BIT_HMEBOX_E1_8812F(v)) -+ -+/* 2 REG_HMEBOX_E2_8812F */ -+ -+#define BIT_SHIFT_HMEBOX_E2_8812F 0 -+#define BIT_MASK_HMEBOX_E2_8812F 0xffffffffL -+#define BIT_HMEBOX_E2_8812F(x) \ -+ (((x) & BIT_MASK_HMEBOX_E2_8812F) << BIT_SHIFT_HMEBOX_E2_8812F) -+#define BITS_HMEBOX_E2_8812F \ -+ (BIT_MASK_HMEBOX_E2_8812F << BIT_SHIFT_HMEBOX_E2_8812F) -+#define BIT_CLEAR_HMEBOX_E2_8812F(x) ((x) & (~BITS_HMEBOX_E2_8812F)) -+#define BIT_GET_HMEBOX_E2_8812F(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E2_8812F) & BIT_MASK_HMEBOX_E2_8812F) -+#define BIT_SET_HMEBOX_E2_8812F(x, v) \ -+ (BIT_CLEAR_HMEBOX_E2_8812F(x) | BIT_HMEBOX_E2_8812F(v)) -+ -+/* 2 REG_HMEBOX_E3_8812F */ -+ -+#define BIT_SHIFT_HMEBOX_E3_8812F 0 -+#define BIT_MASK_HMEBOX_E3_8812F 0xffffffffL -+#define BIT_HMEBOX_E3_8812F(x) \ -+ (((x) & BIT_MASK_HMEBOX_E3_8812F) << BIT_SHIFT_HMEBOX_E3_8812F) -+#define BITS_HMEBOX_E3_8812F \ -+ (BIT_MASK_HMEBOX_E3_8812F << BIT_SHIFT_HMEBOX_E3_8812F) -+#define BIT_CLEAR_HMEBOX_E3_8812F(x) ((x) & (~BITS_HMEBOX_E3_8812F)) -+#define BIT_GET_HMEBOX_E3_8812F(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E3_8812F) & BIT_MASK_HMEBOX_E3_8812F) -+#define BIT_SET_HMEBOX_E3_8812F(x, v) \ -+ (BIT_CLEAR_HMEBOX_E3_8812F(x) | BIT_HMEBOX_E3_8812F(v)) -+ -+/* 2 REG_CR_EXT_8812F */ -+ -+#define BIT_SHIFT_PHY_REQ_DELAY_8812F 24 -+#define BIT_MASK_PHY_REQ_DELAY_8812F 0xf -+#define BIT_PHY_REQ_DELAY_8812F(x) \ -+ (((x) & BIT_MASK_PHY_REQ_DELAY_8812F) << BIT_SHIFT_PHY_REQ_DELAY_8812F) -+#define BITS_PHY_REQ_DELAY_8812F \ -+ (BIT_MASK_PHY_REQ_DELAY_8812F << BIT_SHIFT_PHY_REQ_DELAY_8812F) -+#define BIT_CLEAR_PHY_REQ_DELAY_8812F(x) ((x) & (~BITS_PHY_REQ_DELAY_8812F)) -+#define BIT_GET_PHY_REQ_DELAY_8812F(x) \ -+ (((x) >> BIT_SHIFT_PHY_REQ_DELAY_8812F) & BIT_MASK_PHY_REQ_DELAY_8812F) -+#define BIT_SET_PHY_REQ_DELAY_8812F(x, v) \ -+ (BIT_CLEAR_PHY_REQ_DELAY_8812F(x) | BIT_PHY_REQ_DELAY_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_SPD_DOWN_8812F BIT(16) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_NETYPE4_8812F 4 -+#define BIT_MASK_NETYPE4_8812F 0x3 -+#define BIT_NETYPE4_8812F(x) \ -+ (((x) & BIT_MASK_NETYPE4_8812F) << BIT_SHIFT_NETYPE4_8812F) -+#define BITS_NETYPE4_8812F (BIT_MASK_NETYPE4_8812F << BIT_SHIFT_NETYPE4_8812F) -+#define BIT_CLEAR_NETYPE4_8812F(x) ((x) & (~BITS_NETYPE4_8812F)) -+#define BIT_GET_NETYPE4_8812F(x) \ -+ (((x) >> BIT_SHIFT_NETYPE4_8812F) & BIT_MASK_NETYPE4_8812F) -+#define BIT_SET_NETYPE4_8812F(x, v) \ -+ (BIT_CLEAR_NETYPE4_8812F(x) | BIT_NETYPE4_8812F(v)) -+ -+#define BIT_SHIFT_NETYPE3_8812F 2 -+#define BIT_MASK_NETYPE3_8812F 0x3 -+#define BIT_NETYPE3_8812F(x) \ -+ (((x) & BIT_MASK_NETYPE3_8812F) << BIT_SHIFT_NETYPE3_8812F) -+#define BITS_NETYPE3_8812F (BIT_MASK_NETYPE3_8812F << BIT_SHIFT_NETYPE3_8812F) -+#define BIT_CLEAR_NETYPE3_8812F(x) ((x) & (~BITS_NETYPE3_8812F)) -+#define BIT_GET_NETYPE3_8812F(x) \ -+ (((x) >> BIT_SHIFT_NETYPE3_8812F) & BIT_MASK_NETYPE3_8812F) -+#define BIT_SET_NETYPE3_8812F(x, v) \ -+ (BIT_CLEAR_NETYPE3_8812F(x) | BIT_NETYPE3_8812F(v)) -+ -+#define BIT_SHIFT_NETYPE2_8812F 0 -+#define BIT_MASK_NETYPE2_8812F 0x3 -+#define BIT_NETYPE2_8812F(x) \ -+ (((x) & BIT_MASK_NETYPE2_8812F) << BIT_SHIFT_NETYPE2_8812F) -+#define BITS_NETYPE2_8812F (BIT_MASK_NETYPE2_8812F << BIT_SHIFT_NETYPE2_8812F) -+#define BIT_CLEAR_NETYPE2_8812F(x) ((x) & (~BITS_NETYPE2_8812F)) -+#define BIT_GET_NETYPE2_8812F(x) \ -+ (((x) >> BIT_SHIFT_NETYPE2_8812F) & BIT_MASK_NETYPE2_8812F) -+#define BIT_SET_NETYPE2_8812F(x, v) \ -+ (BIT_CLEAR_NETYPE2_8812F(x) | BIT_NETYPE2_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_FWFF_8812F */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V1_8812F 24 -+#define BIT_MASK_PKTNUM_TH_V1_8812F 0xff -+#define BIT_PKTNUM_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V1_8812F) << BIT_SHIFT_PKTNUM_TH_V1_8812F) -+#define BITS_PKTNUM_TH_V1_8812F \ -+ (BIT_MASK_PKTNUM_TH_V1_8812F << BIT_SHIFT_PKTNUM_TH_V1_8812F) -+#define BIT_CLEAR_PKTNUM_TH_V1_8812F(x) ((x) & (~BITS_PKTNUM_TH_V1_8812F)) -+#define BIT_GET_PKTNUM_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V1_8812F) & BIT_MASK_PKTNUM_TH_V1_8812F) -+#define BIT_SET_PKTNUM_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V1_8812F(x) | BIT_PKTNUM_TH_V1_8812F(v)) -+ -+#define BIT_SHIFT_TIMER_TH_8812F 16 -+#define BIT_MASK_TIMER_TH_8812F 0xff -+#define BIT_TIMER_TH_8812F(x) \ -+ (((x) & BIT_MASK_TIMER_TH_8812F) << BIT_SHIFT_TIMER_TH_8812F) -+#define BITS_TIMER_TH_8812F \ -+ (BIT_MASK_TIMER_TH_8812F << BIT_SHIFT_TIMER_TH_8812F) -+#define BIT_CLEAR_TIMER_TH_8812F(x) ((x) & (~BITS_TIMER_TH_8812F)) -+#define BIT_GET_TIMER_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_TIMER_TH_8812F) & BIT_MASK_TIMER_TH_8812F) -+#define BIT_SET_TIMER_TH_8812F(x, v) \ -+ (BIT_CLEAR_TIMER_TH_8812F(x) | BIT_TIMER_TH_8812F(v)) -+ -+#define BIT_SHIFT_RXPKT1ENADDR_8812F 0 -+#define BIT_MASK_RXPKT1ENADDR_8812F 0xffff -+#define BIT_RXPKT1ENADDR_8812F(x) \ -+ (((x) & BIT_MASK_RXPKT1ENADDR_8812F) << BIT_SHIFT_RXPKT1ENADDR_8812F) -+#define BITS_RXPKT1ENADDR_8812F \ -+ (BIT_MASK_RXPKT1ENADDR_8812F << BIT_SHIFT_RXPKT1ENADDR_8812F) -+#define BIT_CLEAR_RXPKT1ENADDR_8812F(x) ((x) & (~BITS_RXPKT1ENADDR_8812F)) -+#define BIT_GET_RXPKT1ENADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXPKT1ENADDR_8812F) & BIT_MASK_RXPKT1ENADDR_8812F) -+#define BIT_SET_RXPKT1ENADDR_8812F(x, v) \ -+ (BIT_CLEAR_RXPKT1ENADDR_8812F(x) | BIT_RXPKT1ENADDR_8812F(v)) -+ -+/* 2 REG_RXFF_PTR_V1_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_RXFF0_RDPTR_V2_8812F 0 -+#define BIT_MASK_RXFF0_RDPTR_V2_8812F 0x3ffff -+#define BIT_RXFF0_RDPTR_V2_8812F(x) \ -+ (((x) & BIT_MASK_RXFF0_RDPTR_V2_8812F) \ -+ << BIT_SHIFT_RXFF0_RDPTR_V2_8812F) -+#define BITS_RXFF0_RDPTR_V2_8812F \ -+ (BIT_MASK_RXFF0_RDPTR_V2_8812F << BIT_SHIFT_RXFF0_RDPTR_V2_8812F) -+#define BIT_CLEAR_RXFF0_RDPTR_V2_8812F(x) ((x) & (~BITS_RXFF0_RDPTR_V2_8812F)) -+#define BIT_GET_RXFF0_RDPTR_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_RDPTR_V2_8812F) & \ -+ BIT_MASK_RXFF0_RDPTR_V2_8812F) -+#define BIT_SET_RXFF0_RDPTR_V2_8812F(x, v) \ -+ (BIT_CLEAR_RXFF0_RDPTR_V2_8812F(x) | BIT_RXFF0_RDPTR_V2_8812F(v)) -+ -+/* 2 REG_RXFF_WTR_V1_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_RXFF0_WTPTR_V2_8812F 0 -+#define BIT_MASK_RXFF0_WTPTR_V2_8812F 0x3ffff -+#define BIT_RXFF0_WTPTR_V2_8812F(x) \ -+ (((x) & BIT_MASK_RXFF0_WTPTR_V2_8812F) \ -+ << BIT_SHIFT_RXFF0_WTPTR_V2_8812F) -+#define BITS_RXFF0_WTPTR_V2_8812F \ -+ (BIT_MASK_RXFF0_WTPTR_V2_8812F << BIT_SHIFT_RXFF0_WTPTR_V2_8812F) -+#define BIT_CLEAR_RXFF0_WTPTR_V2_8812F(x) ((x) & (~BITS_RXFF0_WTPTR_V2_8812F)) -+#define BIT_GET_RXFF0_WTPTR_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_WTPTR_V2_8812F) & \ -+ BIT_MASK_RXFF0_WTPTR_V2_8812F) -+#define BIT_SET_RXFF0_WTPTR_V2_8812F(x, v) \ -+ (BIT_CLEAR_RXFF0_WTPTR_V2_8812F(x) | BIT_RXFF0_WTPTR_V2_8812F(v)) -+ -+/* 2 REG_FE2IMR_8812F */ -+#define BIT__FE4ISR__IND_MSK_8812F BIT(29) -+#define BIT_FS_TXSC_DESC_DONE_INT_EN_8812F BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_EN_8812F BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_EN_8812F BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_EN_8812F BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_EN_8812F BIT(24) -+#define BIT_FS_ATIM_MB7_INT_EN_8812F BIT(23) -+#define BIT_FS_ATIM_MB6_INT_EN_8812F BIT(22) -+#define BIT_FS_ATIM_MB5_INT_EN_8812F BIT(21) -+#define BIT_FS_ATIM_MB4_INT_EN_8812F BIT(20) -+#define BIT_FS_ATIM_MB3_INT_EN_8812F BIT(19) -+#define BIT_FS_ATIM_MB2_INT_EN_8812F BIT(18) -+#define BIT_FS_ATIM_MB1_INT_EN_8812F BIT(17) -+#define BIT_FS_ATIM_MB0_INT_EN_8812F BIT(16) -+#define BIT_FS_TBTT4INT_EN_8812F BIT(11) -+#define BIT_FS_TBTT3INT_EN_8812F BIT(10) -+#define BIT_FS_TBTT2INT_EN_8812F BIT(9) -+#define BIT_FS_TBTT1INT_EN_8812F BIT(8) -+#define BIT_FS_TBTT0_MB7INT_EN_8812F BIT(7) -+#define BIT_FS_TBTT0_MB6INT_EN_8812F BIT(6) -+#define BIT_FS_TBTT0_MB5INT_EN_8812F BIT(5) -+#define BIT_FS_TBTT0_MB4INT_EN_8812F BIT(4) -+#define BIT_FS_TBTT0_MB3INT_EN_8812F BIT(3) -+#define BIT_FS_TBTT0_MB2INT_EN_8812F BIT(2) -+#define BIT_FS_TBTT0_MB1INT_EN_8812F BIT(1) -+#define BIT_FS_TBTT0_INT_EN_8812F BIT(0) -+ -+/* 2 REG_FE2ISR_8812F */ -+#define BIT__FE4ISR__IND_INT_8812F BIT(29) -+#define BIT_FS_TXSC_DESC_DONE_INT_8812F BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_8812F BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_8812F BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_8812F BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_8812F BIT(24) -+#define BIT_FS_ATIM_MB7_INT_8812F BIT(23) -+#define BIT_FS_ATIM_MB6_INT_8812F BIT(22) -+#define BIT_FS_ATIM_MB5_INT_8812F BIT(21) -+#define BIT_FS_ATIM_MB4_INT_8812F BIT(20) -+#define BIT_FS_ATIM_MB3_INT_8812F BIT(19) -+#define BIT_FS_ATIM_MB2_INT_8812F BIT(18) -+#define BIT_FS_ATIM_MB1_INT_8812F BIT(17) -+#define BIT_FS_ATIM_MB0_INT_8812F BIT(16) -+#define BIT_FS_TBTT4INT_8812F BIT(11) -+#define BIT_FS_TBTT3INT_8812F BIT(10) -+#define BIT_FS_TBTT2INT_8812F BIT(9) -+#define BIT_FS_TBTT1INT_8812F BIT(8) -+#define BIT_FS_TBTT0_MB7INT_8812F BIT(7) -+#define BIT_FS_TBTT0_MB6INT_8812F BIT(6) -+#define BIT_FS_TBTT0_MB5INT_8812F BIT(5) -+#define BIT_FS_TBTT0_MB4INT_8812F BIT(4) -+#define BIT_FS_TBTT0_MB3INT_8812F BIT(3) -+#define BIT_FS_TBTT0_MB2INT_8812F BIT(2) -+#define BIT_FS_TBTT0_MB1INT_8812F BIT(1) -+#define BIT_FS_TBTT0_INT_8812F BIT(0) -+ -+/* 2 REG_FE3IMR_8812F */ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT__EN_8812F BIT(31) -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT__EN_8812F BIT(30) -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT__EN_8812F BIT(29) -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT__EN_8812F BIT(28) -+#define BIT_FS_BCNDMA4_INT_EN_8812F BIT(27) -+#define BIT_FS_BCNDMA3_INT_EN_8812F BIT(26) -+#define BIT_FS_BCNDMA2_INT_EN_8812F BIT(25) -+#define BIT_FS_BCNDMA1_INT_EN_8812F BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_EN_8812F BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_EN_8812F BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_EN_8812F BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_EN_8812F BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_EN_8812F BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_EN_8812F BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_EN_8812F BIT(17) -+#define BIT_FS_BCNDMA0_INT_EN_8812F BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT__EN_8812F BIT(15) -+#define BIT_FS_BCNERLY4_INT_EN_8812F BIT(11) -+#define BIT_FS_BCNERLY3_INT_EN_8812F BIT(10) -+#define BIT_FS_BCNERLY2_INT_EN_8812F BIT(9) -+#define BIT_FS_BCNERLY1_INT_EN_8812F BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_EN_8812F BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_EN_8812F BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_EN_8812F BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_EN_8812F BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_EN_8812F BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_EN_8812F BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_EN_8812F BIT(1) -+#define BIT_FS_BCNERLY0_INT_EN_8812F BIT(0) -+ -+/* 2 REG_FE3ISR_8812F */ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT_8812F BIT(31) -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT_8812F BIT(30) -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT_8812F BIT(29) -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT_8812F BIT(28) -+#define BIT_FS_BCNDMA4_INT_8812F BIT(27) -+#define BIT_FS_BCNDMA3_INT_8812F BIT(26) -+#define BIT_FS_BCNDMA2_INT_8812F BIT(25) -+#define BIT_FS_BCNDMA1_INT_8812F BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_8812F BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_8812F BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_8812F BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_8812F BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_8812F BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_8812F BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_8812F BIT(17) -+#define BIT_FS_BCNDMA0_INT_8812F BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT_8812F BIT(15) -+#define BIT_FS_BCNERLY4_INT_8812F BIT(11) -+#define BIT_FS_BCNERLY3_INT_8812F BIT(10) -+#define BIT_FS_BCNERLY2_INT_8812F BIT(9) -+#define BIT_FS_BCNERLY1_INT_8812F BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_8812F BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_8812F BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_8812F BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_8812F BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_8812F BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_8812F BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_8812F BIT(1) -+#define BIT_FS_BCNERLY0_INT_8812F BIT(0) -+ -+/* 2 REG_FE4IMR_8812F */ -+#define BIT_FS_CLI3_TXPKTIN_INT_EN_8812F BIT(19) -+#define BIT_FS_CLI2_TXPKTIN_INT_EN_8812F BIT(18) -+#define BIT_FS_CLI1_TXPKTIN_INT_EN_8812F BIT(17) -+#define BIT_FS_CLI0_TXPKTIN_INT_EN_8812F BIT(16) -+#define BIT_FS_CLI3_RX_UMD0_INT_EN_8812F BIT(15) -+#define BIT_FS_CLI3_RX_UMD1_INT_EN_8812F BIT(14) -+#define BIT_FS_CLI3_RX_BMD0_INT_EN_8812F BIT(13) -+#define BIT_FS_CLI3_RX_BMD1_INT_EN_8812F BIT(12) -+#define BIT_FS_CLI2_RX_UMD0_INT_EN_8812F BIT(11) -+#define BIT_FS_CLI2_RX_UMD1_INT_EN_8812F BIT(10) -+#define BIT_FS_CLI2_RX_BMD0_INT_EN_8812F BIT(9) -+#define BIT_FS_CLI2_RX_BMD1_INT_EN_8812F BIT(8) -+#define BIT_FS_CLI1_RX_UMD0_INT_EN_8812F BIT(7) -+#define BIT_FS_CLI1_RX_UMD1_INT_EN_8812F BIT(6) -+#define BIT_FS_CLI1_RX_BMD0_INT_EN_8812F BIT(5) -+#define BIT_FS_CLI1_RX_BMD1_INT_EN_8812F BIT(4) -+#define BIT_FS_CLI0_RX_UMD0_INT_EN_8812F BIT(3) -+#define BIT_FS_CLI0_RX_UMD1_INT_EN_8812F BIT(2) -+#define BIT_FS_CLI0_RX_BMD0_INT_EN_8812F BIT(1) -+#define BIT_FS_CLI0_RX_BMD1_INT_EN_8812F BIT(0) -+ -+/* 2 REG_FE4ISR_8812F */ -+#define BIT_FS_CLI3_TXPKTIN_INT_8812F BIT(19) -+#define BIT_FS_CLI2_TXPKTIN_INT_8812F BIT(18) -+#define BIT_FS_CLI1_TXPKTIN_INT_8812F BIT(17) -+#define BIT_FS_CLI0_TXPKTIN_INT_8812F BIT(16) -+#define BIT_FS_CLI3_RX_UMD0_INT_8812F BIT(15) -+#define BIT_FS_CLI3_RX_UMD1_INT_8812F BIT(14) -+#define BIT_FS_CLI3_RX_BMD0_INT_8812F BIT(13) -+#define BIT_FS_CLI3_RX_BMD1_INT_8812F BIT(12) -+#define BIT_FS_CLI2_RX_UMD0_INT_8812F BIT(11) -+#define BIT_FS_CLI2_RX_UMD1_INT_8812F BIT(10) -+#define BIT_FS_CLI2_RX_BMD0_INT_8812F BIT(9) -+#define BIT_FS_CLI2_RX_BMD1_INT_8812F BIT(8) -+#define BIT_FS_CLI1_RX_UMD0_INT_8812F BIT(7) -+#define BIT_FS_CLI1_RX_UMD1_INT_8812F BIT(6) -+#define BIT_FS_CLI1_RX_BMD0_INT_8812F BIT(5) -+#define BIT_FS_CLI1_RX_BMD1_INT_8812F BIT(4) -+#define BIT_FS_CLI0_RX_UMD0_INT_8812F BIT(3) -+#define BIT_FS_CLI0_RX_UMD1_INT_8812F BIT(2) -+#define BIT_FS_CLI0_RX_BMD0_INT_8812F BIT(1) -+#define BIT_FS_CLI0_RX_BMD1_INT_8812F BIT(0) -+ -+/* 2 REG_FT1IMR_8812F */ -+#define BIT__FT2ISR__IND_MSK_8812F BIT(30) -+#define BIT_FTM_PTT_INT_EN_8812F BIT(29) -+#define BIT_RXFTMREQ_INT_EN_8812F BIT(28) -+#define BIT_RXFTM_INT_EN_8812F BIT(27) -+#define BIT_TXFTM_INT_EN_8812F BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_EN_8812F BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_EN_8812F BIT(24) -+#define BIT_FS_MACID_PWRCHANGE5_INT_EN_8812F BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_EN_8812F BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_EN_8812F BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_EN_8812F BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_EN_8812F BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_EN_8812F BIT(18) -+#define BIT_FS_CTWEND2_INT_EN_8812F BIT(17) -+#define BIT_FS_CTWEND1_INT_EN_8812F BIT(16) -+#define BIT_FS_CTWEND0_INT_EN_8812F BIT(15) -+#define BIT_FS_TX_NULL1_INT_EN_8812F BIT(14) -+#define BIT_FS_TX_NULL0_INT_EN_8812F BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_EN_8812F BIT(12) -+#define BIT_FS_P2P_RFON2_INT_EN_8812F BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_EN_8812F BIT(10) -+#define BIT_FS_P2P_RFON1_INT_EN_8812F BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_EN_8812F BIT(8) -+#define BIT_FS_P2P_RFON0_INT_EN_8812F BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_EN_8812F BIT(6) -+#define BIT_FS_RX_UAPSDMD1_EN_8812F BIT(5) -+#define BIT_FS_RX_UAPSDMD0_EN_8812F BIT(4) -+#define BIT_FS_TRIGGER_PKT_EN_8812F BIT(3) -+#define BIT_FS_EOSP_INT_EN_8812F BIT(2) -+#define BIT_FS_RPWM2_INT_EN_8812F BIT(1) -+#define BIT_FS_RPWM_INT_EN_8812F BIT(0) -+ -+/* 2 REG_FT1ISR_8812F */ -+#define BIT__FT2ISR__IND_INT_8812F BIT(30) -+#define BIT_FTM_PTT_INT_8812F BIT(29) -+#define BIT_RXFTMREQ_INT_8812F BIT(28) -+#define BIT_RXFTM_INT_8812F BIT(27) -+#define BIT_TXFTM_INT_8812F BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_8812F BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_8812F BIT(24) -+#define BIT_FS_MACID_PWRCHANGE5_INT_8812F BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_8812F BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_8812F BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_8812F BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_8812F BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_8812F BIT(18) -+#define BIT_FS_CTWEND2_INT_8812F BIT(17) -+#define BIT_FS_CTWEND1_INT_8812F BIT(16) -+#define BIT_FS_CTWEND0_INT_8812F BIT(15) -+#define BIT_FS_TX_NULL1_INT_8812F BIT(14) -+#define BIT_FS_TX_NULL0_INT_8812F BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_INT_8812F BIT(12) -+#define BIT_FS_P2P_RFON2_INT_8812F BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_8812F BIT(10) -+#define BIT_FS_P2P_RFON1_INT_8812F BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_8812F BIT(8) -+#define BIT_FS_P2P_RFON0_INT_8812F BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_8812F BIT(6) -+#define BIT_FS_RX_UAPSDMD1_INT_8812F BIT(5) -+#define BIT_FS_RX_UAPSDMD0_INT_8812F BIT(4) -+#define BIT_FS_TRIGGER_PKT_INT_8812F BIT(3) -+#define BIT_FS_EOSP_INT_8812F BIT(2) -+#define BIT_FS_RPWM2_INT_8812F BIT(1) -+#define BIT_FS_RPWM_INT_8812F BIT(0) -+ -+/* 2 REG_SPWR0_8812F */ -+ -+#define BIT_SHIFT_MID_31TO0_8812F 0 -+#define BIT_MASK_MID_31TO0_8812F 0xffffffffL -+#define BIT_MID_31TO0_8812F(x) \ -+ (((x) & BIT_MASK_MID_31TO0_8812F) << BIT_SHIFT_MID_31TO0_8812F) -+#define BITS_MID_31TO0_8812F \ -+ (BIT_MASK_MID_31TO0_8812F << BIT_SHIFT_MID_31TO0_8812F) -+#define BIT_CLEAR_MID_31TO0_8812F(x) ((x) & (~BITS_MID_31TO0_8812F)) -+#define BIT_GET_MID_31TO0_8812F(x) \ -+ (((x) >> BIT_SHIFT_MID_31TO0_8812F) & BIT_MASK_MID_31TO0_8812F) -+#define BIT_SET_MID_31TO0_8812F(x, v) \ -+ (BIT_CLEAR_MID_31TO0_8812F(x) | BIT_MID_31TO0_8812F(v)) -+ -+/* 2 REG_SPWR1_8812F */ -+ -+#define BIT_SHIFT_MID_63TO32_8812F 0 -+#define BIT_MASK_MID_63TO32_8812F 0xffffffffL -+#define BIT_MID_63TO32_8812F(x) \ -+ (((x) & BIT_MASK_MID_63TO32_8812F) << BIT_SHIFT_MID_63TO32_8812F) -+#define BITS_MID_63TO32_8812F \ -+ (BIT_MASK_MID_63TO32_8812F << BIT_SHIFT_MID_63TO32_8812F) -+#define BIT_CLEAR_MID_63TO32_8812F(x) ((x) & (~BITS_MID_63TO32_8812F)) -+#define BIT_GET_MID_63TO32_8812F(x) \ -+ (((x) >> BIT_SHIFT_MID_63TO32_8812F) & BIT_MASK_MID_63TO32_8812F) -+#define BIT_SET_MID_63TO32_8812F(x, v) \ -+ (BIT_CLEAR_MID_63TO32_8812F(x) | BIT_MID_63TO32_8812F(v)) -+ -+/* 2 REG_SPWR2_8812F */ -+ -+#define BIT_SHIFT_MID_95O64_8812F 0 -+#define BIT_MASK_MID_95O64_8812F 0xffffffffL -+#define BIT_MID_95O64_8812F(x) \ -+ (((x) & BIT_MASK_MID_95O64_8812F) << BIT_SHIFT_MID_95O64_8812F) -+#define BITS_MID_95O64_8812F \ -+ (BIT_MASK_MID_95O64_8812F << BIT_SHIFT_MID_95O64_8812F) -+#define BIT_CLEAR_MID_95O64_8812F(x) ((x) & (~BITS_MID_95O64_8812F)) -+#define BIT_GET_MID_95O64_8812F(x) \ -+ (((x) >> BIT_SHIFT_MID_95O64_8812F) & BIT_MASK_MID_95O64_8812F) -+#define BIT_SET_MID_95O64_8812F(x, v) \ -+ (BIT_CLEAR_MID_95O64_8812F(x) | BIT_MID_95O64_8812F(v)) -+ -+/* 2 REG_SPWR3_8812F */ -+ -+#define BIT_SHIFT_MID_127TO96_8812F 0 -+#define BIT_MASK_MID_127TO96_8812F 0xffffffffL -+#define BIT_MID_127TO96_8812F(x) \ -+ (((x) & BIT_MASK_MID_127TO96_8812F) << BIT_SHIFT_MID_127TO96_8812F) -+#define BITS_MID_127TO96_8812F \ -+ (BIT_MASK_MID_127TO96_8812F << BIT_SHIFT_MID_127TO96_8812F) -+#define BIT_CLEAR_MID_127TO96_8812F(x) ((x) & (~BITS_MID_127TO96_8812F)) -+#define BIT_GET_MID_127TO96_8812F(x) \ -+ (((x) >> BIT_SHIFT_MID_127TO96_8812F) & BIT_MASK_MID_127TO96_8812F) -+#define BIT_SET_MID_127TO96_8812F(x, v) \ -+ (BIT_CLEAR_MID_127TO96_8812F(x) | BIT_MID_127TO96_8812F(v)) -+ -+/* 2 REG_POWSEQ_8812F */ -+ -+#define BIT_SHIFT_SEQNUM_MID_8812F 16 -+#define BIT_MASK_SEQNUM_MID_8812F 0xffff -+#define BIT_SEQNUM_MID_8812F(x) \ -+ (((x) & BIT_MASK_SEQNUM_MID_8812F) << BIT_SHIFT_SEQNUM_MID_8812F) -+#define BITS_SEQNUM_MID_8812F \ -+ (BIT_MASK_SEQNUM_MID_8812F << BIT_SHIFT_SEQNUM_MID_8812F) -+#define BIT_CLEAR_SEQNUM_MID_8812F(x) ((x) & (~BITS_SEQNUM_MID_8812F)) -+#define BIT_GET_SEQNUM_MID_8812F(x) \ -+ (((x) >> BIT_SHIFT_SEQNUM_MID_8812F) & BIT_MASK_SEQNUM_MID_8812F) -+#define BIT_SET_SEQNUM_MID_8812F(x, v) \ -+ (BIT_CLEAR_SEQNUM_MID_8812F(x) | BIT_SEQNUM_MID_8812F(v)) -+ -+#define BIT_SHIFT_REF_MID_8812F 0 -+#define BIT_MASK_REF_MID_8812F 0x7f -+#define BIT_REF_MID_8812F(x) \ -+ (((x) & BIT_MASK_REF_MID_8812F) << BIT_SHIFT_REF_MID_8812F) -+#define BITS_REF_MID_8812F (BIT_MASK_REF_MID_8812F << BIT_SHIFT_REF_MID_8812F) -+#define BIT_CLEAR_REF_MID_8812F(x) ((x) & (~BITS_REF_MID_8812F)) -+#define BIT_GET_REF_MID_8812F(x) \ -+ (((x) >> BIT_SHIFT_REF_MID_8812F) & BIT_MASK_REF_MID_8812F) -+#define BIT_SET_REF_MID_8812F(x, v) \ -+ (BIT_CLEAR_REF_MID_8812F(x) | BIT_REF_MID_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_TC7_CTRL_V1_8812F */ -+#define BIT_TC7INT_EN_8812F BIT(26) -+#define BIT_TC7MODE_8812F BIT(25) -+#define BIT_TC7EN_8812F BIT(24) -+ -+#define BIT_SHIFT_TC7DATA_8812F 0 -+#define BIT_MASK_TC7DATA_8812F 0xffffff -+#define BIT_TC7DATA_8812F(x) \ -+ (((x) & BIT_MASK_TC7DATA_8812F) << BIT_SHIFT_TC7DATA_8812F) -+#define BITS_TC7DATA_8812F (BIT_MASK_TC7DATA_8812F << BIT_SHIFT_TC7DATA_8812F) -+#define BIT_CLEAR_TC7DATA_8812F(x) ((x) & (~BITS_TC7DATA_8812F)) -+#define BIT_GET_TC7DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TC7DATA_8812F) & BIT_MASK_TC7DATA_8812F) -+#define BIT_SET_TC7DATA_8812F(x, v) \ -+ (BIT_CLEAR_TC7DATA_8812F(x) | BIT_TC7DATA_8812F(v)) -+ -+/* 2 REG_TC8_CTRL_V1_8812F */ -+#define BIT_TC8INT_EN_8812F BIT(26) -+#define BIT_TC8MODE_8812F BIT(25) -+#define BIT_TC8EN_8812F BIT(24) -+ -+#define BIT_SHIFT_TC8DATA_8812F 0 -+#define BIT_MASK_TC8DATA_8812F 0xffffff -+#define BIT_TC8DATA_8812F(x) \ -+ (((x) & BIT_MASK_TC8DATA_8812F) << BIT_SHIFT_TC8DATA_8812F) -+#define BITS_TC8DATA_8812F (BIT_MASK_TC8DATA_8812F << BIT_SHIFT_TC8DATA_8812F) -+#define BIT_CLEAR_TC8DATA_8812F(x) ((x) & (~BITS_TC8DATA_8812F)) -+#define BIT_GET_TC8DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TC8DATA_8812F) & BIT_MASK_TC8DATA_8812F) -+#define BIT_SET_TC8DATA_8812F(x, v) \ -+ (BIT_CLEAR_TC8DATA_8812F(x) | BIT_TC8DATA_8812F(v)) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL0_8812F */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8812F 24 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8812F 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT2_8812F(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8812F) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8812F) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT2_8812F \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8812F \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8812F) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT2_8812F(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT2_8812F)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT2_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8812F) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8812F) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT2_8812F(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT2_8812F(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT2_8812F(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8812F 16 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8812F 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT1_8812F(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8812F) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8812F) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT1_8812F \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8812F \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8812F) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT1_8812F(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT1_8812F)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8812F) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8812F) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT1_8812F(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT1_8812F(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT1_8812F(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8812F 8 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8812F 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT0_8812F(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8812F) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8812F) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT0_8812F \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8812F \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8812F) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT0_8812F(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT0_8812F)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT0_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8812F) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8812F) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT0_8812F(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT0_8812F(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT0_8812F(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8812F 0 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8812F 0xff -+#define BIT_RX_BCN_TBTT_ITVL_PORT0_8812F(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8812F) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8812F) -+#define BITS_RX_BCN_TBTT_ITVL_PORT0_8812F \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8812F \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8812F) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_PORT0_8812F(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_PORT0_8812F)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_PORT0_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8812F) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8812F) -+#define BIT_SET_RX_BCN_TBTT_ITVL_PORT0_8812F(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_PORT0_8812F(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_PORT0_8812F(v)) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL1_8812F */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8812F 0 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8812F 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT3_8812F(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8812F) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8812F) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT3_8812F \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8812F \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8812F) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT3_8812F(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT3_8812F)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT3_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8812F) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8812F) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT3_8812F(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT3_8812F(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT3_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_IO_WRAP_ERR_FLAG_8812F */ -+#define BIT_IO_WRAP_ERR_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_SPEED_SENSOR_8812F */ -+#define BIT_DSS_1_RST_N_8812F BIT(31) -+#define BIT_DSS_1_SPEED_EN_8812F BIT(30) -+#define BIT_DSS_1_WIRE_SEL_8812F BIT(29) -+#define BIT_DSS_ENCLK_8812F BIT(28) -+ -+#define BIT_SHIFT_DSS_1_RO_SEL_8812F 24 -+#define BIT_MASK_DSS_1_RO_SEL_8812F 0x7 -+#define BIT_DSS_1_RO_SEL_8812F(x) \ -+ (((x) & BIT_MASK_DSS_1_RO_SEL_8812F) << BIT_SHIFT_DSS_1_RO_SEL_8812F) -+#define BITS_DSS_1_RO_SEL_8812F \ -+ (BIT_MASK_DSS_1_RO_SEL_8812F << BIT_SHIFT_DSS_1_RO_SEL_8812F) -+#define BIT_CLEAR_DSS_1_RO_SEL_8812F(x) ((x) & (~BITS_DSS_1_RO_SEL_8812F)) -+#define BIT_GET_DSS_1_RO_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_RO_SEL_8812F) & BIT_MASK_DSS_1_RO_SEL_8812F) -+#define BIT_SET_DSS_1_RO_SEL_8812F(x, v) \ -+ (BIT_CLEAR_DSS_1_RO_SEL_8812F(x) | BIT_DSS_1_RO_SEL_8812F(v)) -+ -+#define BIT_SHIFT_DSS_1_DATA_IN_8812F 0 -+#define BIT_MASK_DSS_1_DATA_IN_8812F 0xfffff -+#define BIT_DSS_1_DATA_IN_8812F(x) \ -+ (((x) & BIT_MASK_DSS_1_DATA_IN_8812F) << BIT_SHIFT_DSS_1_DATA_IN_8812F) -+#define BITS_DSS_1_DATA_IN_8812F \ -+ (BIT_MASK_DSS_1_DATA_IN_8812F << BIT_SHIFT_DSS_1_DATA_IN_8812F) -+#define BIT_CLEAR_DSS_1_DATA_IN_8812F(x) ((x) & (~BITS_DSS_1_DATA_IN_8812F)) -+#define BIT_GET_DSS_1_DATA_IN_8812F(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_DATA_IN_8812F) & BIT_MASK_DSS_1_DATA_IN_8812F) -+#define BIT_SET_DSS_1_DATA_IN_8812F(x, v) \ -+ (BIT_CLEAR_DSS_1_DATA_IN_8812F(x) | BIT_DSS_1_DATA_IN_8812F(v)) -+ -+/* 2 REG_SPEED_SENSOR1_8812F */ -+#define BIT_DSS_1_READY_8812F BIT(31) -+#define BIT_DSS_1_WSORT_GO_8812F BIT(30) -+ -+#define BIT_SHIFT_DSS_1_COUNT_OUT_8812F 0 -+#define BIT_MASK_DSS_1_COUNT_OUT_8812F 0xfffff -+#define BIT_DSS_1_COUNT_OUT_8812F(x) \ -+ (((x) & BIT_MASK_DSS_1_COUNT_OUT_8812F) \ -+ << BIT_SHIFT_DSS_1_COUNT_OUT_8812F) -+#define BITS_DSS_1_COUNT_OUT_8812F \ -+ (BIT_MASK_DSS_1_COUNT_OUT_8812F << BIT_SHIFT_DSS_1_COUNT_OUT_8812F) -+#define BIT_CLEAR_DSS_1_COUNT_OUT_8812F(x) ((x) & (~BITS_DSS_1_COUNT_OUT_8812F)) -+#define BIT_GET_DSS_1_COUNT_OUT_8812F(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_COUNT_OUT_8812F) & \ -+ BIT_MASK_DSS_1_COUNT_OUT_8812F) -+#define BIT_SET_DSS_1_COUNT_OUT_8812F(x, v) \ -+ (BIT_CLEAR_DSS_1_COUNT_OUT_8812F(x) | BIT_DSS_1_COUNT_OUT_8812F(v)) -+ -+/* 2 REG_SPEED_SENSOR2_8812F */ -+#define BIT_DSS_2_RST_N_8812F BIT(31) -+#define BIT_DSS_2_SPEED_EN_8812F BIT(30) -+#define BIT_DSS_2_WIRE_SEL_8812F BIT(29) -+#define BIT_DSS_ENCLK_8812F BIT(28) -+ -+#define BIT_SHIFT_DSS_2_RO_SEL_8812F 24 -+#define BIT_MASK_DSS_2_RO_SEL_8812F 0x7 -+#define BIT_DSS_2_RO_SEL_8812F(x) \ -+ (((x) & BIT_MASK_DSS_2_RO_SEL_8812F) << BIT_SHIFT_DSS_2_RO_SEL_8812F) -+#define BITS_DSS_2_RO_SEL_8812F \ -+ (BIT_MASK_DSS_2_RO_SEL_8812F << BIT_SHIFT_DSS_2_RO_SEL_8812F) -+#define BIT_CLEAR_DSS_2_RO_SEL_8812F(x) ((x) & (~BITS_DSS_2_RO_SEL_8812F)) -+#define BIT_GET_DSS_2_RO_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_RO_SEL_8812F) & BIT_MASK_DSS_2_RO_SEL_8812F) -+#define BIT_SET_DSS_2_RO_SEL_8812F(x, v) \ -+ (BIT_CLEAR_DSS_2_RO_SEL_8812F(x) | BIT_DSS_2_RO_SEL_8812F(v)) -+ -+#define BIT_SHIFT_DSS_2_DATA_IN_8812F 0 -+#define BIT_MASK_DSS_2_DATA_IN_8812F 0xfffff -+#define BIT_DSS_2_DATA_IN_8812F(x) \ -+ (((x) & BIT_MASK_DSS_2_DATA_IN_8812F) << BIT_SHIFT_DSS_2_DATA_IN_8812F) -+#define BITS_DSS_2_DATA_IN_8812F \ -+ (BIT_MASK_DSS_2_DATA_IN_8812F << BIT_SHIFT_DSS_2_DATA_IN_8812F) -+#define BIT_CLEAR_DSS_2_DATA_IN_8812F(x) ((x) & (~BITS_DSS_2_DATA_IN_8812F)) -+#define BIT_GET_DSS_2_DATA_IN_8812F(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_DATA_IN_8812F) & BIT_MASK_DSS_2_DATA_IN_8812F) -+#define BIT_SET_DSS_2_DATA_IN_8812F(x, v) \ -+ (BIT_CLEAR_DSS_2_DATA_IN_8812F(x) | BIT_DSS_2_DATA_IN_8812F(v)) -+ -+/* 2 REG_SPEED_SENSOR3_8812F */ -+#define BIT_DSS_2_READY_8812F BIT(31) -+#define BIT_DSS_2_WSORT_GO_8812F BIT(30) -+ -+#define BIT_SHIFT_DSS_2_COUNT_OUT_8812F 0 -+#define BIT_MASK_DSS_2_COUNT_OUT_8812F 0xfffff -+#define BIT_DSS_2_COUNT_OUT_8812F(x) \ -+ (((x) & BIT_MASK_DSS_2_COUNT_OUT_8812F) \ -+ << BIT_SHIFT_DSS_2_COUNT_OUT_8812F) -+#define BITS_DSS_2_COUNT_OUT_8812F \ -+ (BIT_MASK_DSS_2_COUNT_OUT_8812F << BIT_SHIFT_DSS_2_COUNT_OUT_8812F) -+#define BIT_CLEAR_DSS_2_COUNT_OUT_8812F(x) ((x) & (~BITS_DSS_2_COUNT_OUT_8812F)) -+#define BIT_GET_DSS_2_COUNT_OUT_8812F(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_COUNT_OUT_8812F) & \ -+ BIT_MASK_DSS_2_COUNT_OUT_8812F) -+#define BIT_SET_DSS_2_COUNT_OUT_8812F(x, v) \ -+ (BIT_CLEAR_DSS_2_COUNT_OUT_8812F(x) | BIT_DSS_2_COUNT_OUT_8812F(v)) -+ -+/* 2 REG_SPEED_SENSOR4_8812F */ -+#define BIT_DSS_3_RST_N_8812F BIT(31) -+#define BIT_DSS_3_SPEED_EN_8812F BIT(30) -+#define BIT_DSS_3_WIRE_SEL_8812F BIT(29) -+#define BIT_DSS_ENCLK_8812F BIT(28) -+ -+#define BIT_SHIFT_DSS_3_RO_SEL_8812F 24 -+#define BIT_MASK_DSS_3_RO_SEL_8812F 0x7 -+#define BIT_DSS_3_RO_SEL_8812F(x) \ -+ (((x) & BIT_MASK_DSS_3_RO_SEL_8812F) << BIT_SHIFT_DSS_3_RO_SEL_8812F) -+#define BITS_DSS_3_RO_SEL_8812F \ -+ (BIT_MASK_DSS_3_RO_SEL_8812F << BIT_SHIFT_DSS_3_RO_SEL_8812F) -+#define BIT_CLEAR_DSS_3_RO_SEL_8812F(x) ((x) & (~BITS_DSS_3_RO_SEL_8812F)) -+#define BIT_GET_DSS_3_RO_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_RO_SEL_8812F) & BIT_MASK_DSS_3_RO_SEL_8812F) -+#define BIT_SET_DSS_3_RO_SEL_8812F(x, v) \ -+ (BIT_CLEAR_DSS_3_RO_SEL_8812F(x) | BIT_DSS_3_RO_SEL_8812F(v)) -+ -+#define BIT_SHIFT_DSS_3_DATA_IN_8812F 0 -+#define BIT_MASK_DSS_3_DATA_IN_8812F 0xfffff -+#define BIT_DSS_3_DATA_IN_8812F(x) \ -+ (((x) & BIT_MASK_DSS_3_DATA_IN_8812F) << BIT_SHIFT_DSS_3_DATA_IN_8812F) -+#define BITS_DSS_3_DATA_IN_8812F \ -+ (BIT_MASK_DSS_3_DATA_IN_8812F << BIT_SHIFT_DSS_3_DATA_IN_8812F) -+#define BIT_CLEAR_DSS_3_DATA_IN_8812F(x) ((x) & (~BITS_DSS_3_DATA_IN_8812F)) -+#define BIT_GET_DSS_3_DATA_IN_8812F(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_DATA_IN_8812F) & BIT_MASK_DSS_3_DATA_IN_8812F) -+#define BIT_SET_DSS_3_DATA_IN_8812F(x, v) \ -+ (BIT_CLEAR_DSS_3_DATA_IN_8812F(x) | BIT_DSS_3_DATA_IN_8812F(v)) -+ -+/* 2 REG_SPEED_SENSOR5_8812F */ -+#define BIT_DSS_3_READY_8812F BIT(31) -+#define BIT_DSS_3_WSORT_GO_8812F BIT(30) -+ -+#define BIT_SHIFT_DSS_3_COUNT_OUT_8812F 0 -+#define BIT_MASK_DSS_3_COUNT_OUT_8812F 0xfffff -+#define BIT_DSS_3_COUNT_OUT_8812F(x) \ -+ (((x) & BIT_MASK_DSS_3_COUNT_OUT_8812F) \ -+ << BIT_SHIFT_DSS_3_COUNT_OUT_8812F) -+#define BITS_DSS_3_COUNT_OUT_8812F \ -+ (BIT_MASK_DSS_3_COUNT_OUT_8812F << BIT_SHIFT_DSS_3_COUNT_OUT_8812F) -+#define BIT_CLEAR_DSS_3_COUNT_OUT_8812F(x) ((x) & (~BITS_DSS_3_COUNT_OUT_8812F)) -+#define BIT_GET_DSS_3_COUNT_OUT_8812F(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_COUNT_OUT_8812F) & \ -+ BIT_MASK_DSS_3_COUNT_OUT_8812F) -+#define BIT_SET_DSS_3_COUNT_OUT_8812F(x, v) \ -+ (BIT_CLEAR_DSS_3_COUNT_OUT_8812F(x) | BIT_DSS_3_COUNT_OUT_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_COUNTER_CTRL_8812F */ -+ -+#define BIT_SHIFT_COUNTER_BASE_8812F 16 -+#define BIT_MASK_COUNTER_BASE_8812F 0x1fff -+#define BIT_COUNTER_BASE_8812F(x) \ -+ (((x) & BIT_MASK_COUNTER_BASE_8812F) << BIT_SHIFT_COUNTER_BASE_8812F) -+#define BITS_COUNTER_BASE_8812F \ -+ (BIT_MASK_COUNTER_BASE_8812F << BIT_SHIFT_COUNTER_BASE_8812F) -+#define BIT_CLEAR_COUNTER_BASE_8812F(x) ((x) & (~BITS_COUNTER_BASE_8812F)) -+#define BIT_GET_COUNTER_BASE_8812F(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_BASE_8812F) & BIT_MASK_COUNTER_BASE_8812F) -+#define BIT_SET_COUNTER_BASE_8812F(x, v) \ -+ (BIT_CLEAR_COUNTER_BASE_8812F(x) | BIT_COUNTER_BASE_8812F(v)) -+ -+#define BIT_EN_RTS_REQ_8812F BIT(9) -+#define BIT_EN_EDCA_REQ_8812F BIT(8) -+#define BIT_EN_PTCL_REQ_8812F BIT(7) -+#define BIT_EN_SCH_REQ_8812F BIT(6) -+#define BIT_USB_COUNT_EN_8812F BIT(5) -+#define BIT_PCIE_COUNT_EN_8812F BIT(4) -+#define BIT_RQPN_COUNT_EN_8812F BIT(3) -+#define BIT_RDE_COUNT_EN_8812F BIT(2) -+#define BIT_TDE_COUNT_EN_8812F BIT(1) -+#define BIT_DISABLE_COUNTER_8812F BIT(0) -+ -+/* 2 REG_COUNTER_THRESHOLD_8812F */ -+#define BIT_SEL_ALL_MACID_8812F BIT(31) -+ -+#define BIT_SHIFT_COUNTER_MACID_8812F 24 -+#define BIT_MASK_COUNTER_MACID_8812F 0x7f -+#define BIT_COUNTER_MACID_8812F(x) \ -+ (((x) & BIT_MASK_COUNTER_MACID_8812F) << BIT_SHIFT_COUNTER_MACID_8812F) -+#define BITS_COUNTER_MACID_8812F \ -+ (BIT_MASK_COUNTER_MACID_8812F << BIT_SHIFT_COUNTER_MACID_8812F) -+#define BIT_CLEAR_COUNTER_MACID_8812F(x) ((x) & (~BITS_COUNTER_MACID_8812F)) -+#define BIT_GET_COUNTER_MACID_8812F(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_MACID_8812F) & BIT_MASK_COUNTER_MACID_8812F) -+#define BIT_SET_COUNTER_MACID_8812F(x, v) \ -+ (BIT_CLEAR_COUNTER_MACID_8812F(x) | BIT_COUNTER_MACID_8812F(v)) -+ -+#define BIT_SHIFT_AGG_VALUE2_8812F 16 -+#define BIT_MASK_AGG_VALUE2_8812F 0x7f -+#define BIT_AGG_VALUE2_8812F(x) \ -+ (((x) & BIT_MASK_AGG_VALUE2_8812F) << BIT_SHIFT_AGG_VALUE2_8812F) -+#define BITS_AGG_VALUE2_8812F \ -+ (BIT_MASK_AGG_VALUE2_8812F << BIT_SHIFT_AGG_VALUE2_8812F) -+#define BIT_CLEAR_AGG_VALUE2_8812F(x) ((x) & (~BITS_AGG_VALUE2_8812F)) -+#define BIT_GET_AGG_VALUE2_8812F(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE2_8812F) & BIT_MASK_AGG_VALUE2_8812F) -+#define BIT_SET_AGG_VALUE2_8812F(x, v) \ -+ (BIT_CLEAR_AGG_VALUE2_8812F(x) | BIT_AGG_VALUE2_8812F(v)) -+ -+#define BIT_SHIFT_AGG_VALUE1_8812F 8 -+#define BIT_MASK_AGG_VALUE1_8812F 0x7f -+#define BIT_AGG_VALUE1_8812F(x) \ -+ (((x) & BIT_MASK_AGG_VALUE1_8812F) << BIT_SHIFT_AGG_VALUE1_8812F) -+#define BITS_AGG_VALUE1_8812F \ -+ (BIT_MASK_AGG_VALUE1_8812F << BIT_SHIFT_AGG_VALUE1_8812F) -+#define BIT_CLEAR_AGG_VALUE1_8812F(x) ((x) & (~BITS_AGG_VALUE1_8812F)) -+#define BIT_GET_AGG_VALUE1_8812F(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE1_8812F) & BIT_MASK_AGG_VALUE1_8812F) -+#define BIT_SET_AGG_VALUE1_8812F(x, v) \ -+ (BIT_CLEAR_AGG_VALUE1_8812F(x) | BIT_AGG_VALUE1_8812F(v)) -+ -+#define BIT_SHIFT_AGG_VALUE0_8812F 0 -+#define BIT_MASK_AGG_VALUE0_8812F 0x7f -+#define BIT_AGG_VALUE0_8812F(x) \ -+ (((x) & BIT_MASK_AGG_VALUE0_8812F) << BIT_SHIFT_AGG_VALUE0_8812F) -+#define BITS_AGG_VALUE0_8812F \ -+ (BIT_MASK_AGG_VALUE0_8812F << BIT_SHIFT_AGG_VALUE0_8812F) -+#define BIT_CLEAR_AGG_VALUE0_8812F(x) ((x) & (~BITS_AGG_VALUE0_8812F)) -+#define BIT_GET_AGG_VALUE0_8812F(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE0_8812F) & BIT_MASK_AGG_VALUE0_8812F) -+#define BIT_SET_AGG_VALUE0_8812F(x, v) \ -+ (BIT_CLEAR_AGG_VALUE0_8812F(x) | BIT_AGG_VALUE0_8812F(v)) -+ -+/* 2 REG_COUNTER_SET_8812F */ -+ -+#define BIT_SHIFT_REQUEST_RESET_8812F 16 -+#define BIT_MASK_REQUEST_RESET_8812F 0xffff -+#define BIT_REQUEST_RESET_8812F(x) \ -+ (((x) & BIT_MASK_REQUEST_RESET_8812F) << BIT_SHIFT_REQUEST_RESET_8812F) -+#define BITS_REQUEST_RESET_8812F \ -+ (BIT_MASK_REQUEST_RESET_8812F << BIT_SHIFT_REQUEST_RESET_8812F) -+#define BIT_CLEAR_REQUEST_RESET_8812F(x) ((x) & (~BITS_REQUEST_RESET_8812F)) -+#define BIT_GET_REQUEST_RESET_8812F(x) \ -+ (((x) >> BIT_SHIFT_REQUEST_RESET_8812F) & BIT_MASK_REQUEST_RESET_8812F) -+#define BIT_SET_REQUEST_RESET_8812F(x, v) \ -+ (BIT_CLEAR_REQUEST_RESET_8812F(x) | BIT_REQUEST_RESET_8812F(v)) -+ -+#define BIT_SHIFT_REQUEST_START_8812F 0 -+#define BIT_MASK_REQUEST_START_8812F 0xffff -+#define BIT_REQUEST_START_8812F(x) \ -+ (((x) & BIT_MASK_REQUEST_START_8812F) << BIT_SHIFT_REQUEST_START_8812F) -+#define BITS_REQUEST_START_8812F \ -+ (BIT_MASK_REQUEST_START_8812F << BIT_SHIFT_REQUEST_START_8812F) -+#define BIT_CLEAR_REQUEST_START_8812F(x) ((x) & (~BITS_REQUEST_START_8812F)) -+#define BIT_GET_REQUEST_START_8812F(x) \ -+ (((x) >> BIT_SHIFT_REQUEST_START_8812F) & BIT_MASK_REQUEST_START_8812F) -+#define BIT_SET_REQUEST_START_8812F(x, v) \ -+ (BIT_CLEAR_REQUEST_START_8812F(x) | BIT_REQUEST_START_8812F(v)) -+ -+/* 2 REG_COUNTER_OVERFLOW_8812F */ -+ -+#define BIT_SHIFT_CNT_OVF_REG_8812F 0 -+#define BIT_MASK_CNT_OVF_REG_8812F 0xffff -+#define BIT_CNT_OVF_REG_8812F(x) \ -+ (((x) & BIT_MASK_CNT_OVF_REG_8812F) << BIT_SHIFT_CNT_OVF_REG_8812F) -+#define BITS_CNT_OVF_REG_8812F \ -+ (BIT_MASK_CNT_OVF_REG_8812F << BIT_SHIFT_CNT_OVF_REG_8812F) -+#define BIT_CLEAR_CNT_OVF_REG_8812F(x) ((x) & (~BITS_CNT_OVF_REG_8812F)) -+#define BIT_GET_CNT_OVF_REG_8812F(x) \ -+ (((x) >> BIT_SHIFT_CNT_OVF_REG_8812F) & BIT_MASK_CNT_OVF_REG_8812F) -+#define BIT_SET_CNT_OVF_REG_8812F(x, v) \ -+ (BIT_CLEAR_CNT_OVF_REG_8812F(x) | BIT_CNT_OVF_REG_8812F(v)) -+ -+/* 2 REG_TXDMA_LEN_THRESHOLD_8812F */ -+ -+#define BIT_SHIFT_TDE_LEN_TH1_8812F 16 -+#define BIT_MASK_TDE_LEN_TH1_8812F 0xffff -+#define BIT_TDE_LEN_TH1_8812F(x) \ -+ (((x) & BIT_MASK_TDE_LEN_TH1_8812F) << BIT_SHIFT_TDE_LEN_TH1_8812F) -+#define BITS_TDE_LEN_TH1_8812F \ -+ (BIT_MASK_TDE_LEN_TH1_8812F << BIT_SHIFT_TDE_LEN_TH1_8812F) -+#define BIT_CLEAR_TDE_LEN_TH1_8812F(x) ((x) & (~BITS_TDE_LEN_TH1_8812F)) -+#define BIT_GET_TDE_LEN_TH1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TDE_LEN_TH1_8812F) & BIT_MASK_TDE_LEN_TH1_8812F) -+#define BIT_SET_TDE_LEN_TH1_8812F(x, v) \ -+ (BIT_CLEAR_TDE_LEN_TH1_8812F(x) | BIT_TDE_LEN_TH1_8812F(v)) -+ -+#define BIT_SHIFT_TDE_LEN_TH0_8812F 0 -+#define BIT_MASK_TDE_LEN_TH0_8812F 0xffff -+#define BIT_TDE_LEN_TH0_8812F(x) \ -+ (((x) & BIT_MASK_TDE_LEN_TH0_8812F) << BIT_SHIFT_TDE_LEN_TH0_8812F) -+#define BITS_TDE_LEN_TH0_8812F \ -+ (BIT_MASK_TDE_LEN_TH0_8812F << BIT_SHIFT_TDE_LEN_TH0_8812F) -+#define BIT_CLEAR_TDE_LEN_TH0_8812F(x) ((x) & (~BITS_TDE_LEN_TH0_8812F)) -+#define BIT_GET_TDE_LEN_TH0_8812F(x) \ -+ (((x) >> BIT_SHIFT_TDE_LEN_TH0_8812F) & BIT_MASK_TDE_LEN_TH0_8812F) -+#define BIT_SET_TDE_LEN_TH0_8812F(x, v) \ -+ (BIT_CLEAR_TDE_LEN_TH0_8812F(x) | BIT_TDE_LEN_TH0_8812F(v)) -+ -+/* 2 REG_RXDMA_LEN_THRESHOLD_8812F */ -+ -+#define BIT_SHIFT_RDE_LEN_TH1_8812F 16 -+#define BIT_MASK_RDE_LEN_TH1_8812F 0xffff -+#define BIT_RDE_LEN_TH1_8812F(x) \ -+ (((x) & BIT_MASK_RDE_LEN_TH1_8812F) << BIT_SHIFT_RDE_LEN_TH1_8812F) -+#define BITS_RDE_LEN_TH1_8812F \ -+ (BIT_MASK_RDE_LEN_TH1_8812F << BIT_SHIFT_RDE_LEN_TH1_8812F) -+#define BIT_CLEAR_RDE_LEN_TH1_8812F(x) ((x) & (~BITS_RDE_LEN_TH1_8812F)) -+#define BIT_GET_RDE_LEN_TH1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RDE_LEN_TH1_8812F) & BIT_MASK_RDE_LEN_TH1_8812F) -+#define BIT_SET_RDE_LEN_TH1_8812F(x, v) \ -+ (BIT_CLEAR_RDE_LEN_TH1_8812F(x) | BIT_RDE_LEN_TH1_8812F(v)) -+ -+#define BIT_SHIFT_RDE_LEN_TH0_8812F 0 -+#define BIT_MASK_RDE_LEN_TH0_8812F 0xffff -+#define BIT_RDE_LEN_TH0_8812F(x) \ -+ (((x) & BIT_MASK_RDE_LEN_TH0_8812F) << BIT_SHIFT_RDE_LEN_TH0_8812F) -+#define BITS_RDE_LEN_TH0_8812F \ -+ (BIT_MASK_RDE_LEN_TH0_8812F << BIT_SHIFT_RDE_LEN_TH0_8812F) -+#define BIT_CLEAR_RDE_LEN_TH0_8812F(x) ((x) & (~BITS_RDE_LEN_TH0_8812F)) -+#define BIT_GET_RDE_LEN_TH0_8812F(x) \ -+ (((x) >> BIT_SHIFT_RDE_LEN_TH0_8812F) & BIT_MASK_RDE_LEN_TH0_8812F) -+#define BIT_SET_RDE_LEN_TH0_8812F(x, v) \ -+ (BIT_CLEAR_RDE_LEN_TH0_8812F(x) | BIT_RDE_LEN_TH0_8812F(v)) -+ -+/* 2 REG_PCIE_EXEC_TIME_THRESHOLD_8812F */ -+ -+#define BIT_SHIFT_COUNT_INT_SEL_8812F 16 -+#define BIT_MASK_COUNT_INT_SEL_8812F 0x3 -+#define BIT_COUNT_INT_SEL_8812F(x) \ -+ (((x) & BIT_MASK_COUNT_INT_SEL_8812F) << BIT_SHIFT_COUNT_INT_SEL_8812F) -+#define BITS_COUNT_INT_SEL_8812F \ -+ (BIT_MASK_COUNT_INT_SEL_8812F << BIT_SHIFT_COUNT_INT_SEL_8812F) -+#define BIT_CLEAR_COUNT_INT_SEL_8812F(x) ((x) & (~BITS_COUNT_INT_SEL_8812F)) -+#define BIT_GET_COUNT_INT_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_COUNT_INT_SEL_8812F) & BIT_MASK_COUNT_INT_SEL_8812F) -+#define BIT_SET_COUNT_INT_SEL_8812F(x, v) \ -+ (BIT_CLEAR_COUNT_INT_SEL_8812F(x) | BIT_COUNT_INT_SEL_8812F(v)) -+ -+#define BIT_SHIFT_EXEC_TIME_TH_8812F 0 -+#define BIT_MASK_EXEC_TIME_TH_8812F 0xffff -+#define BIT_EXEC_TIME_TH_8812F(x) \ -+ (((x) & BIT_MASK_EXEC_TIME_TH_8812F) << BIT_SHIFT_EXEC_TIME_TH_8812F) -+#define BITS_EXEC_TIME_TH_8812F \ -+ (BIT_MASK_EXEC_TIME_TH_8812F << BIT_SHIFT_EXEC_TIME_TH_8812F) -+#define BIT_CLEAR_EXEC_TIME_TH_8812F(x) ((x) & (~BITS_EXEC_TIME_TH_8812F)) -+#define BIT_GET_EXEC_TIME_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_EXEC_TIME_TH_8812F) & BIT_MASK_EXEC_TIME_TH_8812F) -+#define BIT_SET_EXEC_TIME_TH_8812F(x, v) \ -+ (BIT_CLEAR_EXEC_TIME_TH_8812F(x) | BIT_EXEC_TIME_TH_8812F(v)) -+ -+/* 2 REG_FT2IMR_8812F */ -+#define BIT_FS_CLI3_RX_UAPSDMD1_EN_8812F BIT(31) -+#define BIT_FS_CLI3_RX_UAPSDMD0_EN_8812F BIT(30) -+#define BIT_FS_CLI3_TRIGGER_PKT_EN_8812F BIT(29) -+#define BIT_FS_CLI3_EOSP_INT_EN_8812F BIT(28) -+#define BIT_FS_CLI2_RX_UAPSDMD1_EN_8812F BIT(27) -+#define BIT_FS_CLI2_RX_UAPSDMD0_EN_8812F BIT(26) -+#define BIT_FS_CLI2_TRIGGER_PKT_EN_8812F BIT(25) -+#define BIT_FS_CLI2_EOSP_INT_EN_8812F BIT(24) -+#define BIT_FS_CLI1_RX_UAPSDMD1_EN_8812F BIT(23) -+#define BIT_FS_CLI1_RX_UAPSDMD0_EN_8812F BIT(22) -+#define BIT_FS_CLI1_TRIGGER_PKT_EN_8812F BIT(21) -+#define BIT_FS_CLI1_EOSP_INT_EN_8812F BIT(20) -+#define BIT_FS_CLI0_RX_UAPSDMD1_EN_8812F BIT(19) -+#define BIT_FS_CLI0_RX_UAPSDMD0_EN_8812F BIT(18) -+#define BIT_FS_CLI0_TRIGGER_PKT_EN_8812F BIT(17) -+#define BIT_FS_CLI0_EOSP_INT_EN_8812F BIT(16) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_EN_8812F BIT(9) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_EN_8812F BIT(8) -+#define BIT_FS_CLI3_TX_NULL1_INT_EN_8812F BIT(7) -+#define BIT_FS_CLI3_TX_NULL0_INT_EN_8812F BIT(6) -+#define BIT_FS_CLI2_TX_NULL1_INT_EN_8812F BIT(5) -+#define BIT_FS_CLI2_TX_NULL0_INT_EN_8812F BIT(4) -+#define BIT_FS_CLI1_TX_NULL1_INT_EN_8812F BIT(3) -+#define BIT_FS_CLI1_TX_NULL0_INT_EN_8812F BIT(2) -+#define BIT_FS_CLI0_TX_NULL1_INT_EN_8812F BIT(1) -+#define BIT_FS_CLI0_TX_NULL0_INT_EN_8812F BIT(0) -+ -+/* 2 REG_FT2ISR_8812F */ -+#define BIT_FS_CLI3_RX_UAPSDMD1_INT_8812F BIT(31) -+#define BIT_FS_CLI3_RX_UAPSDMD0_INT_8812F BIT(30) -+#define BIT_FS_CLI3_TRIGGER_PKT_INT_8812F BIT(29) -+#define BIT_FS_CLI3_EOSP_INT_8812F BIT(28) -+#define BIT_FS_CLI2_RX_UAPSDMD1_INT_8812F BIT(27) -+#define BIT_FS_CLI2_RX_UAPSDMD0_INT_8812F BIT(26) -+#define BIT_FS_CLI2_TRIGGER_PKT_INT_8812F BIT(25) -+#define BIT_FS_CLI2_EOSP_INT_8812F BIT(24) -+#define BIT_FS_CLI1_RX_UAPSDMD1_INT_8812F BIT(23) -+#define BIT_FS_CLI1_RX_UAPSDMD0_INT_8812F BIT(22) -+#define BIT_FS_CLI1_TRIGGER_PKT_INT_8812F BIT(21) -+#define BIT_FS_CLI1_EOSP_INT_8812F BIT(20) -+#define BIT_FS_CLI0_RX_UAPSDMD1_INT_8812F BIT(19) -+#define BIT_FS_CLI0_RX_UAPSDMD0_INT_8812F BIT(18) -+#define BIT_FS_CLI0_TRIGGER_PKT_INT_8812F BIT(17) -+#define BIT_FS_CLI0_EOSP_INT_8812F BIT(16) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_INT_8812F BIT(9) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_INT_8812F BIT(8) -+#define BIT_FS_CLI3_TX_NULL1_INT_8812F BIT(7) -+#define BIT_FS_CLI3_TX_NULL0_INT_8812F BIT(6) -+#define BIT_FS_CLI2_TX_NULL1_INT_8812F BIT(5) -+#define BIT_FS_CLI2_TX_NULL0_INT_8812F BIT(4) -+#define BIT_FS_CLI1_TX_NULL1_INT_8812F BIT(3) -+#define BIT_FS_CLI1_TX_NULL0_INT_8812F BIT(2) -+#define BIT_FS_CLI0_TX_NULL1_INT_8812F BIT(1) -+#define BIT_FS_CLI0_TX_NULL0_INT_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_MSG2_8812F */ -+ -+#define BIT_SHIFT_FW_MSG2_8812F 0 -+#define BIT_MASK_FW_MSG2_8812F 0xffffffffL -+#define BIT_FW_MSG2_8812F(x) \ -+ (((x) & BIT_MASK_FW_MSG2_8812F) << BIT_SHIFT_FW_MSG2_8812F) -+#define BITS_FW_MSG2_8812F (BIT_MASK_FW_MSG2_8812F << BIT_SHIFT_FW_MSG2_8812F) -+#define BIT_CLEAR_FW_MSG2_8812F(x) ((x) & (~BITS_FW_MSG2_8812F)) -+#define BIT_GET_FW_MSG2_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG2_8812F) & BIT_MASK_FW_MSG2_8812F) -+#define BIT_SET_FW_MSG2_8812F(x, v) \ -+ (BIT_CLEAR_FW_MSG2_8812F(x) | BIT_FW_MSG2_8812F(v)) -+ -+/* 2 REG_MSG3_8812F */ -+ -+#define BIT_SHIFT_FW_MSG3_8812F 0 -+#define BIT_MASK_FW_MSG3_8812F 0xffffffffL -+#define BIT_FW_MSG3_8812F(x) \ -+ (((x) & BIT_MASK_FW_MSG3_8812F) << BIT_SHIFT_FW_MSG3_8812F) -+#define BITS_FW_MSG3_8812F (BIT_MASK_FW_MSG3_8812F << BIT_SHIFT_FW_MSG3_8812F) -+#define BIT_CLEAR_FW_MSG3_8812F(x) ((x) & (~BITS_FW_MSG3_8812F)) -+#define BIT_GET_FW_MSG3_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG3_8812F) & BIT_MASK_FW_MSG3_8812F) -+#define BIT_SET_FW_MSG3_8812F(x, v) \ -+ (BIT_CLEAR_FW_MSG3_8812F(x) | BIT_FW_MSG3_8812F(v)) -+ -+/* 2 REG_MSG4_8812F */ -+ -+#define BIT_SHIFT_FW_MSG4_8812F 0 -+#define BIT_MASK_FW_MSG4_8812F 0xffffffffL -+#define BIT_FW_MSG4_8812F(x) \ -+ (((x) & BIT_MASK_FW_MSG4_8812F) << BIT_SHIFT_FW_MSG4_8812F) -+#define BITS_FW_MSG4_8812F (BIT_MASK_FW_MSG4_8812F << BIT_SHIFT_FW_MSG4_8812F) -+#define BIT_CLEAR_FW_MSG4_8812F(x) ((x) & (~BITS_FW_MSG4_8812F)) -+#define BIT_GET_FW_MSG4_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG4_8812F) & BIT_MASK_FW_MSG4_8812F) -+#define BIT_SET_FW_MSG4_8812F(x, v) \ -+ (BIT_CLEAR_FW_MSG4_8812F(x) | BIT_FW_MSG4_8812F(v)) -+ -+/* 2 REG_MSG5_8812F */ -+ -+#define BIT_SHIFT_FW_MSG5_8812F 0 -+#define BIT_MASK_FW_MSG5_8812F 0xffffffffL -+#define BIT_FW_MSG5_8812F(x) \ -+ (((x) & BIT_MASK_FW_MSG5_8812F) << BIT_SHIFT_FW_MSG5_8812F) -+#define BITS_FW_MSG5_8812F (BIT_MASK_FW_MSG5_8812F << BIT_SHIFT_FW_MSG5_8812F) -+#define BIT_CLEAR_FW_MSG5_8812F(x) ((x) & (~BITS_FW_MSG5_8812F)) -+#define BIT_GET_FW_MSG5_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG5_8812F) & BIT_MASK_FW_MSG5_8812F) -+#define BIT_SET_FW_MSG5_8812F(x, v) \ -+ (BIT_CLEAR_FW_MSG5_8812F(x) | BIT_FW_MSG5_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_FIFOPAGE_CTRL_1_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8812F 16 -+#define BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8812F 0xff -+#define BIT_TX_OQT_HE_FREE_SPACE_V1_8812F(x) \ -+ (((x) & BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8812F) \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8812F) -+#define BITS_TX_OQT_HE_FREE_SPACE_V1_8812F \ -+ (BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8812F \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8812F) -+#define BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1_8812F(x) \ -+ ((x) & (~BITS_TX_OQT_HE_FREE_SPACE_V1_8812F)) -+#define BIT_GET_TX_OQT_HE_FREE_SPACE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8812F) & \ -+ BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8812F) -+#define BIT_SET_TX_OQT_HE_FREE_SPACE_V1_8812F(x, v) \ -+ (BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1_8812F(x) | \ -+ BIT_TX_OQT_HE_FREE_SPACE_V1_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8812F 0 -+#define BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8812F 0xff -+#define BIT_TX_OQT_NL_FREE_SPACE_V1_8812F(x) \ -+ (((x) & BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8812F) \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8812F) -+#define BITS_TX_OQT_NL_FREE_SPACE_V1_8812F \ -+ (BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8812F \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8812F) -+#define BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1_8812F(x) \ -+ ((x) & (~BITS_TX_OQT_NL_FREE_SPACE_V1_8812F)) -+#define BIT_GET_TX_OQT_NL_FREE_SPACE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8812F) & \ -+ BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8812F) -+#define BIT_SET_TX_OQT_NL_FREE_SPACE_V1_8812F(x, v) \ -+ (BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1_8812F(x) | \ -+ BIT_TX_OQT_NL_FREE_SPACE_V1_8812F(v)) -+ -+/* 2 REG_FIFOPAGE_CTRL_2_8812F */ -+#define BIT_BCN_VALID_1_V1_8812F BIT(31) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_BCN_HEAD_1_V1_8812F 16 -+#define BIT_MASK_BCN_HEAD_1_V1_8812F 0xfff -+#define BIT_BCN_HEAD_1_V1_8812F(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_1_V1_8812F) << BIT_SHIFT_BCN_HEAD_1_V1_8812F) -+#define BITS_BCN_HEAD_1_V1_8812F \ -+ (BIT_MASK_BCN_HEAD_1_V1_8812F << BIT_SHIFT_BCN_HEAD_1_V1_8812F) -+#define BIT_CLEAR_BCN_HEAD_1_V1_8812F(x) ((x) & (~BITS_BCN_HEAD_1_V1_8812F)) -+#define BIT_GET_BCN_HEAD_1_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_1_V1_8812F) & BIT_MASK_BCN_HEAD_1_V1_8812F) -+#define BIT_SET_BCN_HEAD_1_V1_8812F(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_1_V1_8812F(x) | BIT_BCN_HEAD_1_V1_8812F(v)) -+ -+#define BIT_BCN_VALID_V1_8812F BIT(15) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_BCN_HEAD_V1_8812F 0 -+#define BIT_MASK_BCN_HEAD_V1_8812F 0xfff -+#define BIT_BCN_HEAD_V1_8812F(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_V1_8812F) << BIT_SHIFT_BCN_HEAD_V1_8812F) -+#define BITS_BCN_HEAD_V1_8812F \ -+ (BIT_MASK_BCN_HEAD_V1_8812F << BIT_SHIFT_BCN_HEAD_V1_8812F) -+#define BIT_CLEAR_BCN_HEAD_V1_8812F(x) ((x) & (~BITS_BCN_HEAD_V1_8812F)) -+#define BIT_GET_BCN_HEAD_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_V1_8812F) & BIT_MASK_BCN_HEAD_V1_8812F) -+#define BIT_SET_BCN_HEAD_V1_8812F(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_V1_8812F(x) | BIT_BCN_HEAD_V1_8812F(v)) -+ -+/* 2 REG_AUTO_LLT_V1_8812F */ -+ -+#define BIT_SHIFT_MAX_TX_PKT_V1_8812F 24 -+#define BIT_MASK_MAX_TX_PKT_V1_8812F 0xff -+#define BIT_MAX_TX_PKT_V1_8812F(x) \ -+ (((x) & BIT_MASK_MAX_TX_PKT_V1_8812F) << BIT_SHIFT_MAX_TX_PKT_V1_8812F) -+#define BITS_MAX_TX_PKT_V1_8812F \ -+ (BIT_MASK_MAX_TX_PKT_V1_8812F << BIT_SHIFT_MAX_TX_PKT_V1_8812F) -+#define BIT_CLEAR_MAX_TX_PKT_V1_8812F(x) ((x) & (~BITS_MAX_TX_PKT_V1_8812F)) -+#define BIT_GET_MAX_TX_PKT_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAX_TX_PKT_V1_8812F) & BIT_MASK_MAX_TX_PKT_V1_8812F) -+#define BIT_SET_MAX_TX_PKT_V1_8812F(x, v) \ -+ (BIT_CLEAR_MAX_TX_PKT_V1_8812F(x) | BIT_MAX_TX_PKT_V1_8812F(v)) -+ -+#define BIT_TDE_ERROR_STOP_V1_8812F BIT(23) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_LLT_FREE_PAGE_V2_8812F 8 -+#define BIT_MASK_LLT_FREE_PAGE_V2_8812F 0xfff -+#define BIT_LLT_FREE_PAGE_V2_8812F(x) \ -+ (((x) & BIT_MASK_LLT_FREE_PAGE_V2_8812F) \ -+ << BIT_SHIFT_LLT_FREE_PAGE_V2_8812F) -+#define BITS_LLT_FREE_PAGE_V2_8812F \ -+ (BIT_MASK_LLT_FREE_PAGE_V2_8812F << BIT_SHIFT_LLT_FREE_PAGE_V2_8812F) -+#define BIT_CLEAR_LLT_FREE_PAGE_V2_8812F(x) \ -+ ((x) & (~BITS_LLT_FREE_PAGE_V2_8812F)) -+#define BIT_GET_LLT_FREE_PAGE_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_LLT_FREE_PAGE_V2_8812F) & \ -+ BIT_MASK_LLT_FREE_PAGE_V2_8812F) -+#define BIT_SET_LLT_FREE_PAGE_V2_8812F(x, v) \ -+ (BIT_CLEAR_LLT_FREE_PAGE_V2_8812F(x) | BIT_LLT_FREE_PAGE_V2_8812F(v)) -+ -+#define BIT_SHIFT_BLK_DESC_NUM_8812F 4 -+#define BIT_MASK_BLK_DESC_NUM_8812F 0xf -+#define BIT_BLK_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_BLK_DESC_NUM_8812F) << BIT_SHIFT_BLK_DESC_NUM_8812F) -+#define BITS_BLK_DESC_NUM_8812F \ -+ (BIT_MASK_BLK_DESC_NUM_8812F << BIT_SHIFT_BLK_DESC_NUM_8812F) -+#define BIT_CLEAR_BLK_DESC_NUM_8812F(x) ((x) & (~BITS_BLK_DESC_NUM_8812F)) -+#define BIT_GET_BLK_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_BLK_DESC_NUM_8812F) & BIT_MASK_BLK_DESC_NUM_8812F) -+#define BIT_SET_BLK_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_BLK_DESC_NUM_8812F(x) | BIT_BLK_DESC_NUM_8812F(v)) -+ -+#define BIT_R_BCN_HEAD_SEL_8812F BIT(3) -+#define BIT_R_EN_BCN_SW_HEAD_SEL_8812F BIT(2) -+#define BIT_LLT_DBG_SEL_8812F BIT(1) -+#define BIT_AUTO_INIT_LLT_V1_8812F BIT(0) -+ -+/* 2 REG_TXDMA_OFFSET_CHK_8812F */ -+#define BIT_EM_CHKSUM_FIN_8812F BIT(31) -+#define BIT_EMN_PCIE_DMA_MOD_8812F BIT(30) -+#define BIT_EN_TXQUE_CLR_8812F BIT(29) -+#define BIT_EN_PCIE_FIFO_MODE_8812F BIT(28) -+ -+#define BIT_SHIFT_PG_UNDER_TH_V1_8812F 16 -+#define BIT_MASK_PG_UNDER_TH_V1_8812F 0xfff -+#define BIT_PG_UNDER_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_PG_UNDER_TH_V1_8812F) \ -+ << BIT_SHIFT_PG_UNDER_TH_V1_8812F) -+#define BITS_PG_UNDER_TH_V1_8812F \ -+ (BIT_MASK_PG_UNDER_TH_V1_8812F << BIT_SHIFT_PG_UNDER_TH_V1_8812F) -+#define BIT_CLEAR_PG_UNDER_TH_V1_8812F(x) ((x) & (~BITS_PG_UNDER_TH_V1_8812F)) -+#define BIT_GET_PG_UNDER_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PG_UNDER_TH_V1_8812F) & \ -+ BIT_MASK_PG_UNDER_TH_V1_8812F) -+#define BIT_SET_PG_UNDER_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_PG_UNDER_TH_V1_8812F(x) | BIT_PG_UNDER_TH_V1_8812F(v)) -+ -+#define BIT_R_EN_RESET_RESTORE_H2C_8812F BIT(15) -+#define BIT_SDIO_TDE_FINISH_8812F BIT(14) -+#define BIT_SDIO_TXDESC_CHKSUM_EN_8812F BIT(13) -+#define BIT_RST_RDPTR_8812F BIT(12) -+#define BIT_RST_WRPTR_8812F BIT(11) -+#define BIT_CHK_PG_TH_EN_8812F BIT(10) -+#define BIT_DROP_DATA_EN_8812F BIT(9) -+#define BIT_CHECK_OFFSET_EN_8812F BIT(8) -+ -+#define BIT_SHIFT_CHECK_OFFSET_8812F 0 -+#define BIT_MASK_CHECK_OFFSET_8812F 0xff -+#define BIT_CHECK_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_CHECK_OFFSET_8812F) << BIT_SHIFT_CHECK_OFFSET_8812F) -+#define BITS_CHECK_OFFSET_8812F \ -+ (BIT_MASK_CHECK_OFFSET_8812F << BIT_SHIFT_CHECK_OFFSET_8812F) -+#define BIT_CLEAR_CHECK_OFFSET_8812F(x) ((x) & (~BITS_CHECK_OFFSET_8812F)) -+#define BIT_GET_CHECK_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_CHECK_OFFSET_8812F) & BIT_MASK_CHECK_OFFSET_8812F) -+#define BIT_SET_CHECK_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_CHECK_OFFSET_8812F(x) | BIT_CHECK_OFFSET_8812F(v)) -+ -+/* 2 REG_TXDMA_STATUS_8812F */ -+#define BIT_TXPKTBUF_REQ_ERR_8812F BIT(18) -+#define BIT_HI_OQT_UDN_8812F BIT(17) -+#define BIT_HI_OQT_OVF_8812F BIT(16) -+#define BIT_PAYLOAD_CHKSUM_ERR_8812F BIT(15) -+#define BIT_PAYLOAD_UDN_8812F BIT(14) -+#define BIT_PAYLOAD_OVF_8812F BIT(13) -+#define BIT_DSC_CHKSUM_FAIL_8812F BIT(12) -+#define BIT_UNKNOWN_QSEL_8812F BIT(11) -+#define BIT_EP_QSEL_DIFF_8812F BIT(10) -+#define BIT_TX_OFFS_UNMATCH_8812F BIT(9) -+#define BIT_TXOQT_UDN_8812F BIT(8) -+#define BIT_TXOQT_OVF_8812F BIT(7) -+#define BIT_TXDMA_SFF_UDN_8812F BIT(6) -+#define BIT_TXDMA_SFF_OVF_8812F BIT(5) -+#define BIT_LLT_NULL_PG_8812F BIT(4) -+#define BIT_PAGE_UDN_8812F BIT(3) -+#define BIT_PAGE_OVF_8812F BIT(2) -+#define BIT_TXFF_PG_UDN_8812F BIT(1) -+#define BIT_TXFF_PG_OVF_8812F BIT(0) -+ -+/* 2 REG_TX_DMA_DBG_8812F */ -+ -+/* 2 REG_TQPNT1_8812F */ -+#define BIT_HPQ_INT_EN_8812F BIT(31) -+ -+#define BIT_SHIFT_HPQ_HIGH_TH_V1_8812F 16 -+#define BIT_MASK_HPQ_HIGH_TH_V1_8812F 0xfff -+#define BIT_HPQ_HIGH_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_HPQ_HIGH_TH_V1_8812F) \ -+ << BIT_SHIFT_HPQ_HIGH_TH_V1_8812F) -+#define BITS_HPQ_HIGH_TH_V1_8812F \ -+ (BIT_MASK_HPQ_HIGH_TH_V1_8812F << BIT_SHIFT_HPQ_HIGH_TH_V1_8812F) -+#define BIT_CLEAR_HPQ_HIGH_TH_V1_8812F(x) ((x) & (~BITS_HPQ_HIGH_TH_V1_8812F)) -+#define BIT_GET_HPQ_HIGH_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HPQ_HIGH_TH_V1_8812F) & \ -+ BIT_MASK_HPQ_HIGH_TH_V1_8812F) -+#define BIT_SET_HPQ_HIGH_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_HPQ_HIGH_TH_V1_8812F(x) | BIT_HPQ_HIGH_TH_V1_8812F(v)) -+ -+#define BIT_SHIFT_HPQ_LOW_TH_V1_8812F 0 -+#define BIT_MASK_HPQ_LOW_TH_V1_8812F 0xfff -+#define BIT_HPQ_LOW_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_HPQ_LOW_TH_V1_8812F) << BIT_SHIFT_HPQ_LOW_TH_V1_8812F) -+#define BITS_HPQ_LOW_TH_V1_8812F \ -+ (BIT_MASK_HPQ_LOW_TH_V1_8812F << BIT_SHIFT_HPQ_LOW_TH_V1_8812F) -+#define BIT_CLEAR_HPQ_LOW_TH_V1_8812F(x) ((x) & (~BITS_HPQ_LOW_TH_V1_8812F)) -+#define BIT_GET_HPQ_LOW_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HPQ_LOW_TH_V1_8812F) & BIT_MASK_HPQ_LOW_TH_V1_8812F) -+#define BIT_SET_HPQ_LOW_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_HPQ_LOW_TH_V1_8812F(x) | BIT_HPQ_LOW_TH_V1_8812F(v)) -+ -+/* 2 REG_TQPNT2_8812F */ -+#define BIT_NPQ_INT_EN_8812F BIT(31) -+ -+#define BIT_SHIFT_NPQ_HIGH_TH_V1_8812F 16 -+#define BIT_MASK_NPQ_HIGH_TH_V1_8812F 0xfff -+#define BIT_NPQ_HIGH_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_NPQ_HIGH_TH_V1_8812F) \ -+ << BIT_SHIFT_NPQ_HIGH_TH_V1_8812F) -+#define BITS_NPQ_HIGH_TH_V1_8812F \ -+ (BIT_MASK_NPQ_HIGH_TH_V1_8812F << BIT_SHIFT_NPQ_HIGH_TH_V1_8812F) -+#define BIT_CLEAR_NPQ_HIGH_TH_V1_8812F(x) ((x) & (~BITS_NPQ_HIGH_TH_V1_8812F)) -+#define BIT_GET_NPQ_HIGH_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_NPQ_HIGH_TH_V1_8812F) & \ -+ BIT_MASK_NPQ_HIGH_TH_V1_8812F) -+#define BIT_SET_NPQ_HIGH_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_NPQ_HIGH_TH_V1_8812F(x) | BIT_NPQ_HIGH_TH_V1_8812F(v)) -+ -+#define BIT_SHIFT_NPQ_LOW_TH_V1_8812F 0 -+#define BIT_MASK_NPQ_LOW_TH_V1_8812F 0xfff -+#define BIT_NPQ_LOW_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_NPQ_LOW_TH_V1_8812F) << BIT_SHIFT_NPQ_LOW_TH_V1_8812F) -+#define BITS_NPQ_LOW_TH_V1_8812F \ -+ (BIT_MASK_NPQ_LOW_TH_V1_8812F << BIT_SHIFT_NPQ_LOW_TH_V1_8812F) -+#define BIT_CLEAR_NPQ_LOW_TH_V1_8812F(x) ((x) & (~BITS_NPQ_LOW_TH_V1_8812F)) -+#define BIT_GET_NPQ_LOW_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_NPQ_LOW_TH_V1_8812F) & BIT_MASK_NPQ_LOW_TH_V1_8812F) -+#define BIT_SET_NPQ_LOW_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_NPQ_LOW_TH_V1_8812F(x) | BIT_NPQ_LOW_TH_V1_8812F(v)) -+ -+/* 2 REG_TQPNT3_8812F */ -+#define BIT_LPQ_INT_EN_8812F BIT(31) -+ -+#define BIT_SHIFT_LPQ_HIGH_TH_V1_8812F 16 -+#define BIT_MASK_LPQ_HIGH_TH_V1_8812F 0xfff -+#define BIT_LPQ_HIGH_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_LPQ_HIGH_TH_V1_8812F) \ -+ << BIT_SHIFT_LPQ_HIGH_TH_V1_8812F) -+#define BITS_LPQ_HIGH_TH_V1_8812F \ -+ (BIT_MASK_LPQ_HIGH_TH_V1_8812F << BIT_SHIFT_LPQ_HIGH_TH_V1_8812F) -+#define BIT_CLEAR_LPQ_HIGH_TH_V1_8812F(x) ((x) & (~BITS_LPQ_HIGH_TH_V1_8812F)) -+#define BIT_GET_LPQ_HIGH_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_LPQ_HIGH_TH_V1_8812F) & \ -+ BIT_MASK_LPQ_HIGH_TH_V1_8812F) -+#define BIT_SET_LPQ_HIGH_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_LPQ_HIGH_TH_V1_8812F(x) | BIT_LPQ_HIGH_TH_V1_8812F(v)) -+ -+#define BIT_SHIFT_LPQ_LOW_TH_V1_8812F 0 -+#define BIT_MASK_LPQ_LOW_TH_V1_8812F 0xfff -+#define BIT_LPQ_LOW_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_LPQ_LOW_TH_V1_8812F) << BIT_SHIFT_LPQ_LOW_TH_V1_8812F) -+#define BITS_LPQ_LOW_TH_V1_8812F \ -+ (BIT_MASK_LPQ_LOW_TH_V1_8812F << BIT_SHIFT_LPQ_LOW_TH_V1_8812F) -+#define BIT_CLEAR_LPQ_LOW_TH_V1_8812F(x) ((x) & (~BITS_LPQ_LOW_TH_V1_8812F)) -+#define BIT_GET_LPQ_LOW_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_LPQ_LOW_TH_V1_8812F) & BIT_MASK_LPQ_LOW_TH_V1_8812F) -+#define BIT_SET_LPQ_LOW_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_LPQ_LOW_TH_V1_8812F(x) | BIT_LPQ_LOW_TH_V1_8812F(v)) -+ -+/* 2 REG_TQPNT4_8812F */ -+#define BIT_EXQ_INT_EN_8812F BIT(31) -+ -+#define BIT_SHIFT_EXQ_HIGH_TH_V1_8812F 16 -+#define BIT_MASK_EXQ_HIGH_TH_V1_8812F 0xfff -+#define BIT_EXQ_HIGH_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_EXQ_HIGH_TH_V1_8812F) \ -+ << BIT_SHIFT_EXQ_HIGH_TH_V1_8812F) -+#define BITS_EXQ_HIGH_TH_V1_8812F \ -+ (BIT_MASK_EXQ_HIGH_TH_V1_8812F << BIT_SHIFT_EXQ_HIGH_TH_V1_8812F) -+#define BIT_CLEAR_EXQ_HIGH_TH_V1_8812F(x) ((x) & (~BITS_EXQ_HIGH_TH_V1_8812F)) -+#define BIT_GET_EXQ_HIGH_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_EXQ_HIGH_TH_V1_8812F) & \ -+ BIT_MASK_EXQ_HIGH_TH_V1_8812F) -+#define BIT_SET_EXQ_HIGH_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_EXQ_HIGH_TH_V1_8812F(x) | BIT_EXQ_HIGH_TH_V1_8812F(v)) -+ -+#define BIT_SHIFT_EXQ_LOW_TH_V1_8812F 0 -+#define BIT_MASK_EXQ_LOW_TH_V1_8812F 0xfff -+#define BIT_EXQ_LOW_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_EXQ_LOW_TH_V1_8812F) << BIT_SHIFT_EXQ_LOW_TH_V1_8812F) -+#define BITS_EXQ_LOW_TH_V1_8812F \ -+ (BIT_MASK_EXQ_LOW_TH_V1_8812F << BIT_SHIFT_EXQ_LOW_TH_V1_8812F) -+#define BIT_CLEAR_EXQ_LOW_TH_V1_8812F(x) ((x) & (~BITS_EXQ_LOW_TH_V1_8812F)) -+#define BIT_GET_EXQ_LOW_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_EXQ_LOW_TH_V1_8812F) & BIT_MASK_EXQ_LOW_TH_V1_8812F) -+#define BIT_SET_EXQ_LOW_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_EXQ_LOW_TH_V1_8812F(x) | BIT_EXQ_LOW_TH_V1_8812F(v)) -+ -+/* 2 REG_RQPN_CTRL_1_8812F */ -+ -+#define BIT_SHIFT_TXPKTNUM_H_V2_8812F 16 -+#define BIT_MASK_TXPKTNUM_H_V2_8812F 0xfff -+#define BIT_TXPKTNUM_H_V2_8812F(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_H_V2_8812F) << BIT_SHIFT_TXPKTNUM_H_V2_8812F) -+#define BITS_TXPKTNUM_H_V2_8812F \ -+ (BIT_MASK_TXPKTNUM_H_V2_8812F << BIT_SHIFT_TXPKTNUM_H_V2_8812F) -+#define BIT_CLEAR_TXPKTNUM_H_V2_8812F(x) ((x) & (~BITS_TXPKTNUM_H_V2_8812F)) -+#define BIT_GET_TXPKTNUM_H_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_H_V2_8812F) & BIT_MASK_TXPKTNUM_H_V2_8812F) -+#define BIT_SET_TXPKTNUM_H_V2_8812F(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_H_V2_8812F(x) | BIT_TXPKTNUM_H_V2_8812F(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_V3_8812F 0 -+#define BIT_MASK_TXPKTNUM_V3_8812F 0xfff -+#define BIT_TXPKTNUM_V3_8812F(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_V3_8812F) << BIT_SHIFT_TXPKTNUM_V3_8812F) -+#define BITS_TXPKTNUM_V3_8812F \ -+ (BIT_MASK_TXPKTNUM_V3_8812F << BIT_SHIFT_TXPKTNUM_V3_8812F) -+#define BIT_CLEAR_TXPKTNUM_V3_8812F(x) ((x) & (~BITS_TXPKTNUM_V3_8812F)) -+#define BIT_GET_TXPKTNUM_V3_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_V3_8812F) & BIT_MASK_TXPKTNUM_V3_8812F) -+#define BIT_SET_TXPKTNUM_V3_8812F(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_V3_8812F(x) | BIT_TXPKTNUM_V3_8812F(v)) -+ -+/* 2 REG_RQPN_CTRL_2_8812F */ -+#define BIT_LD_RQPN_8812F BIT(31) -+#define BIT_EXQ_PUBLIC_DIS_V1_8812F BIT(19) -+#define BIT_NPQ_PUBLIC_DIS_V1_8812F BIT(18) -+#define BIT_LPQ_PUBLIC_DIS_V1_8812F BIT(17) -+#define BIT_HPQ_PUBLIC_DIS_V1_8812F BIT(16) -+#define BIT_SDIO_TXAGG_ALIGN_ADJUST_EN_8812F BIT(15) -+ -+#define BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8812F 0 -+#define BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8812F 0xfff -+#define BIT_SDIO_TXAGG_ALIGN_SIZE_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8812F) \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8812F) -+#define BITS_SDIO_TXAGG_ALIGN_SIZE_8812F \ -+ (BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8812F \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8812F) -+#define BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE_8812F(x) \ -+ ((x) & (~BITS_SDIO_TXAGG_ALIGN_SIZE_8812F)) -+#define BIT_GET_SDIO_TXAGG_ALIGN_SIZE_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8812F) & \ -+ BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8812F) -+#define BIT_SET_SDIO_TXAGG_ALIGN_SIZE_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE_8812F(x) | \ -+ BIT_SDIO_TXAGG_ALIGN_SIZE_8812F(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_1_8812F */ -+ -+#define BIT_SHIFT_HPQ_AVAL_PG_V1_8812F 16 -+#define BIT_MASK_HPQ_AVAL_PG_V1_8812F 0xfff -+#define BIT_HPQ_AVAL_PG_V1_8812F(x) \ -+ (((x) & BIT_MASK_HPQ_AVAL_PG_V1_8812F) \ -+ << BIT_SHIFT_HPQ_AVAL_PG_V1_8812F) -+#define BITS_HPQ_AVAL_PG_V1_8812F \ -+ (BIT_MASK_HPQ_AVAL_PG_V1_8812F << BIT_SHIFT_HPQ_AVAL_PG_V1_8812F) -+#define BIT_CLEAR_HPQ_AVAL_PG_V1_8812F(x) ((x) & (~BITS_HPQ_AVAL_PG_V1_8812F)) -+#define BIT_GET_HPQ_AVAL_PG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HPQ_AVAL_PG_V1_8812F) & \ -+ BIT_MASK_HPQ_AVAL_PG_V1_8812F) -+#define BIT_SET_HPQ_AVAL_PG_V1_8812F(x, v) \ -+ (BIT_CLEAR_HPQ_AVAL_PG_V1_8812F(x) | BIT_HPQ_AVAL_PG_V1_8812F(v)) -+ -+#define BIT_SHIFT_HPQ_V1_8812F 0 -+#define BIT_MASK_HPQ_V1_8812F 0xfff -+#define BIT_HPQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_HPQ_V1_8812F) << BIT_SHIFT_HPQ_V1_8812F) -+#define BITS_HPQ_V1_8812F (BIT_MASK_HPQ_V1_8812F << BIT_SHIFT_HPQ_V1_8812F) -+#define BIT_CLEAR_HPQ_V1_8812F(x) ((x) & (~BITS_HPQ_V1_8812F)) -+#define BIT_GET_HPQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HPQ_V1_8812F) & BIT_MASK_HPQ_V1_8812F) -+#define BIT_SET_HPQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_HPQ_V1_8812F(x) | BIT_HPQ_V1_8812F(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_2_8812F */ -+ -+#define BIT_SHIFT_LPQ_AVAL_PG_V1_8812F 16 -+#define BIT_MASK_LPQ_AVAL_PG_V1_8812F 0xfff -+#define BIT_LPQ_AVAL_PG_V1_8812F(x) \ -+ (((x) & BIT_MASK_LPQ_AVAL_PG_V1_8812F) \ -+ << BIT_SHIFT_LPQ_AVAL_PG_V1_8812F) -+#define BITS_LPQ_AVAL_PG_V1_8812F \ -+ (BIT_MASK_LPQ_AVAL_PG_V1_8812F << BIT_SHIFT_LPQ_AVAL_PG_V1_8812F) -+#define BIT_CLEAR_LPQ_AVAL_PG_V1_8812F(x) ((x) & (~BITS_LPQ_AVAL_PG_V1_8812F)) -+#define BIT_GET_LPQ_AVAL_PG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_LPQ_AVAL_PG_V1_8812F) & \ -+ BIT_MASK_LPQ_AVAL_PG_V1_8812F) -+#define BIT_SET_LPQ_AVAL_PG_V1_8812F(x, v) \ -+ (BIT_CLEAR_LPQ_AVAL_PG_V1_8812F(x) | BIT_LPQ_AVAL_PG_V1_8812F(v)) -+ -+#define BIT_SHIFT_LPQ_V1_8812F 0 -+#define BIT_MASK_LPQ_V1_8812F 0xfff -+#define BIT_LPQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_LPQ_V1_8812F) << BIT_SHIFT_LPQ_V1_8812F) -+#define BITS_LPQ_V1_8812F (BIT_MASK_LPQ_V1_8812F << BIT_SHIFT_LPQ_V1_8812F) -+#define BIT_CLEAR_LPQ_V1_8812F(x) ((x) & (~BITS_LPQ_V1_8812F)) -+#define BIT_GET_LPQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_LPQ_V1_8812F) & BIT_MASK_LPQ_V1_8812F) -+#define BIT_SET_LPQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_LPQ_V1_8812F(x) | BIT_LPQ_V1_8812F(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_3_8812F */ -+ -+#define BIT_SHIFT_NPQ_AVAL_PG_V1_8812F 16 -+#define BIT_MASK_NPQ_AVAL_PG_V1_8812F 0xfff -+#define BIT_NPQ_AVAL_PG_V1_8812F(x) \ -+ (((x) & BIT_MASK_NPQ_AVAL_PG_V1_8812F) \ -+ << BIT_SHIFT_NPQ_AVAL_PG_V1_8812F) -+#define BITS_NPQ_AVAL_PG_V1_8812F \ -+ (BIT_MASK_NPQ_AVAL_PG_V1_8812F << BIT_SHIFT_NPQ_AVAL_PG_V1_8812F) -+#define BIT_CLEAR_NPQ_AVAL_PG_V1_8812F(x) ((x) & (~BITS_NPQ_AVAL_PG_V1_8812F)) -+#define BIT_GET_NPQ_AVAL_PG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_NPQ_AVAL_PG_V1_8812F) & \ -+ BIT_MASK_NPQ_AVAL_PG_V1_8812F) -+#define BIT_SET_NPQ_AVAL_PG_V1_8812F(x, v) \ -+ (BIT_CLEAR_NPQ_AVAL_PG_V1_8812F(x) | BIT_NPQ_AVAL_PG_V1_8812F(v)) -+ -+#define BIT_SHIFT_NPQ_V1_8812F 0 -+#define BIT_MASK_NPQ_V1_8812F 0xfff -+#define BIT_NPQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_NPQ_V1_8812F) << BIT_SHIFT_NPQ_V1_8812F) -+#define BITS_NPQ_V1_8812F (BIT_MASK_NPQ_V1_8812F << BIT_SHIFT_NPQ_V1_8812F) -+#define BIT_CLEAR_NPQ_V1_8812F(x) ((x) & (~BITS_NPQ_V1_8812F)) -+#define BIT_GET_NPQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_NPQ_V1_8812F) & BIT_MASK_NPQ_V1_8812F) -+#define BIT_SET_NPQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_NPQ_V1_8812F(x) | BIT_NPQ_V1_8812F(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_4_8812F */ -+ -+#define BIT_SHIFT_EXQ_AVAL_PG_V1_8812F 16 -+#define BIT_MASK_EXQ_AVAL_PG_V1_8812F 0xfff -+#define BIT_EXQ_AVAL_PG_V1_8812F(x) \ -+ (((x) & BIT_MASK_EXQ_AVAL_PG_V1_8812F) \ -+ << BIT_SHIFT_EXQ_AVAL_PG_V1_8812F) -+#define BITS_EXQ_AVAL_PG_V1_8812F \ -+ (BIT_MASK_EXQ_AVAL_PG_V1_8812F << BIT_SHIFT_EXQ_AVAL_PG_V1_8812F) -+#define BIT_CLEAR_EXQ_AVAL_PG_V1_8812F(x) ((x) & (~BITS_EXQ_AVAL_PG_V1_8812F)) -+#define BIT_GET_EXQ_AVAL_PG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_EXQ_AVAL_PG_V1_8812F) & \ -+ BIT_MASK_EXQ_AVAL_PG_V1_8812F) -+#define BIT_SET_EXQ_AVAL_PG_V1_8812F(x, v) \ -+ (BIT_CLEAR_EXQ_AVAL_PG_V1_8812F(x) | BIT_EXQ_AVAL_PG_V1_8812F(v)) -+ -+#define BIT_SHIFT_EXQ_V1_8812F 0 -+#define BIT_MASK_EXQ_V1_8812F 0xfff -+#define BIT_EXQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_EXQ_V1_8812F) << BIT_SHIFT_EXQ_V1_8812F) -+#define BITS_EXQ_V1_8812F (BIT_MASK_EXQ_V1_8812F << BIT_SHIFT_EXQ_V1_8812F) -+#define BIT_CLEAR_EXQ_V1_8812F(x) ((x) & (~BITS_EXQ_V1_8812F)) -+#define BIT_GET_EXQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_EXQ_V1_8812F) & BIT_MASK_EXQ_V1_8812F) -+#define BIT_SET_EXQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_EXQ_V1_8812F(x) | BIT_EXQ_V1_8812F(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_5_8812F */ -+ -+#define BIT_SHIFT_PUBQ_AVAL_PG_V1_8812F 16 -+#define BIT_MASK_PUBQ_AVAL_PG_V1_8812F 0xfff -+#define BIT_PUBQ_AVAL_PG_V1_8812F(x) \ -+ (((x) & BIT_MASK_PUBQ_AVAL_PG_V1_8812F) \ -+ << BIT_SHIFT_PUBQ_AVAL_PG_V1_8812F) -+#define BITS_PUBQ_AVAL_PG_V1_8812F \ -+ (BIT_MASK_PUBQ_AVAL_PG_V1_8812F << BIT_SHIFT_PUBQ_AVAL_PG_V1_8812F) -+#define BIT_CLEAR_PUBQ_AVAL_PG_V1_8812F(x) ((x) & (~BITS_PUBQ_AVAL_PG_V1_8812F)) -+#define BIT_GET_PUBQ_AVAL_PG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_AVAL_PG_V1_8812F) & \ -+ BIT_MASK_PUBQ_AVAL_PG_V1_8812F) -+#define BIT_SET_PUBQ_AVAL_PG_V1_8812F(x, v) \ -+ (BIT_CLEAR_PUBQ_AVAL_PG_V1_8812F(x) | BIT_PUBQ_AVAL_PG_V1_8812F(v)) -+ -+#define BIT_SHIFT_PUBQ_V1_8812F 0 -+#define BIT_MASK_PUBQ_V1_8812F 0xfff -+#define BIT_PUBQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_PUBQ_V1_8812F) << BIT_SHIFT_PUBQ_V1_8812F) -+#define BITS_PUBQ_V1_8812F (BIT_MASK_PUBQ_V1_8812F << BIT_SHIFT_PUBQ_V1_8812F) -+#define BIT_CLEAR_PUBQ_V1_8812F(x) ((x) & (~BITS_PUBQ_V1_8812F)) -+#define BIT_GET_PUBQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_V1_8812F) & BIT_MASK_PUBQ_V1_8812F) -+#define BIT_SET_PUBQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_PUBQ_V1_8812F(x) | BIT_PUBQ_V1_8812F(v)) -+ -+/* 2 REG_H2C_HEAD_8812F */ -+ -+#define BIT_SHIFT_H2C_HEAD_8812F 0 -+#define BIT_MASK_H2C_HEAD_8812F 0x3ffff -+#define BIT_H2C_HEAD_8812F(x) \ -+ (((x) & BIT_MASK_H2C_HEAD_8812F) << BIT_SHIFT_H2C_HEAD_8812F) -+#define BITS_H2C_HEAD_8812F \ -+ (BIT_MASK_H2C_HEAD_8812F << BIT_SHIFT_H2C_HEAD_8812F) -+#define BIT_CLEAR_H2C_HEAD_8812F(x) ((x) & (~BITS_H2C_HEAD_8812F)) -+#define BIT_GET_H2C_HEAD_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2C_HEAD_8812F) & BIT_MASK_H2C_HEAD_8812F) -+#define BIT_SET_H2C_HEAD_8812F(x, v) \ -+ (BIT_CLEAR_H2C_HEAD_8812F(x) | BIT_H2C_HEAD_8812F(v)) -+ -+/* 2 REG_H2C_TAIL_8812F */ -+ -+#define BIT_SHIFT_H2C_TAIL_8812F 0 -+#define BIT_MASK_H2C_TAIL_8812F 0x3ffff -+#define BIT_H2C_TAIL_8812F(x) \ -+ (((x) & BIT_MASK_H2C_TAIL_8812F) << BIT_SHIFT_H2C_TAIL_8812F) -+#define BITS_H2C_TAIL_8812F \ -+ (BIT_MASK_H2C_TAIL_8812F << BIT_SHIFT_H2C_TAIL_8812F) -+#define BIT_CLEAR_H2C_TAIL_8812F(x) ((x) & (~BITS_H2C_TAIL_8812F)) -+#define BIT_GET_H2C_TAIL_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2C_TAIL_8812F) & BIT_MASK_H2C_TAIL_8812F) -+#define BIT_SET_H2C_TAIL_8812F(x, v) \ -+ (BIT_CLEAR_H2C_TAIL_8812F(x) | BIT_H2C_TAIL_8812F(v)) -+ -+/* 2 REG_H2C_READ_ADDR_8812F */ -+ -+#define BIT_SHIFT_H2C_READ_ADDR_8812F 0 -+#define BIT_MASK_H2C_READ_ADDR_8812F 0x3ffff -+#define BIT_H2C_READ_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_H2C_READ_ADDR_8812F) << BIT_SHIFT_H2C_READ_ADDR_8812F) -+#define BITS_H2C_READ_ADDR_8812F \ -+ (BIT_MASK_H2C_READ_ADDR_8812F << BIT_SHIFT_H2C_READ_ADDR_8812F) -+#define BIT_CLEAR_H2C_READ_ADDR_8812F(x) ((x) & (~BITS_H2C_READ_ADDR_8812F)) -+#define BIT_GET_H2C_READ_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2C_READ_ADDR_8812F) & BIT_MASK_H2C_READ_ADDR_8812F) -+#define BIT_SET_H2C_READ_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_H2C_READ_ADDR_8812F(x) | BIT_H2C_READ_ADDR_8812F(v)) -+ -+/* 2 REG_H2C_WR_ADDR_8812F */ -+ -+#define BIT_SHIFT_H2C_WR_ADDR_8812F 0 -+#define BIT_MASK_H2C_WR_ADDR_8812F 0x3ffff -+#define BIT_H2C_WR_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_H2C_WR_ADDR_8812F) << BIT_SHIFT_H2C_WR_ADDR_8812F) -+#define BITS_H2C_WR_ADDR_8812F \ -+ (BIT_MASK_H2C_WR_ADDR_8812F << BIT_SHIFT_H2C_WR_ADDR_8812F) -+#define BIT_CLEAR_H2C_WR_ADDR_8812F(x) ((x) & (~BITS_H2C_WR_ADDR_8812F)) -+#define BIT_GET_H2C_WR_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2C_WR_ADDR_8812F) & BIT_MASK_H2C_WR_ADDR_8812F) -+#define BIT_SET_H2C_WR_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_H2C_WR_ADDR_8812F(x) | BIT_H2C_WR_ADDR_8812F(v)) -+ -+/* 2 REG_H2C_INFO_8812F */ -+#define BIT_H2C_SPACE_VLD_8812F BIT(3) -+#define BIT_H2C_WR_ADDR_RST_8812F BIT(2) -+ -+#define BIT_SHIFT_H2C_LEN_SEL_8812F 0 -+#define BIT_MASK_H2C_LEN_SEL_8812F 0x3 -+#define BIT_H2C_LEN_SEL_8812F(x) \ -+ (((x) & BIT_MASK_H2C_LEN_SEL_8812F) << BIT_SHIFT_H2C_LEN_SEL_8812F) -+#define BITS_H2C_LEN_SEL_8812F \ -+ (BIT_MASK_H2C_LEN_SEL_8812F << BIT_SHIFT_H2C_LEN_SEL_8812F) -+#define BIT_CLEAR_H2C_LEN_SEL_8812F(x) ((x) & (~BITS_H2C_LEN_SEL_8812F)) -+#define BIT_GET_H2C_LEN_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2C_LEN_SEL_8812F) & BIT_MASK_H2C_LEN_SEL_8812F) -+#define BIT_SET_H2C_LEN_SEL_8812F(x, v) \ -+ (BIT_CLEAR_H2C_LEN_SEL_8812F(x) | BIT_H2C_LEN_SEL_8812F(v)) -+ -+/* 2 REG_PGSUB_CNT_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_RST_PGSUB_CNT_8812F BIT(1) -+#define BIT_PGSUB_CNT_EN_8812F BIT(0) -+ -+/* 2 REG_PGSUB_H_8812F */ -+ -+#define BIT_SHIFT_HPQ_PGSUB_CNT_8812F 0 -+#define BIT_MASK_HPQ_PGSUB_CNT_8812F 0xffffffffL -+#define BIT_HPQ_PGSUB_CNT_8812F(x) \ -+ (((x) & BIT_MASK_HPQ_PGSUB_CNT_8812F) << BIT_SHIFT_HPQ_PGSUB_CNT_8812F) -+#define BITS_HPQ_PGSUB_CNT_8812F \ -+ (BIT_MASK_HPQ_PGSUB_CNT_8812F << BIT_SHIFT_HPQ_PGSUB_CNT_8812F) -+#define BIT_CLEAR_HPQ_PGSUB_CNT_8812F(x) ((x) & (~BITS_HPQ_PGSUB_CNT_8812F)) -+#define BIT_GET_HPQ_PGSUB_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_HPQ_PGSUB_CNT_8812F) & BIT_MASK_HPQ_PGSUB_CNT_8812F) -+#define BIT_SET_HPQ_PGSUB_CNT_8812F(x, v) \ -+ (BIT_CLEAR_HPQ_PGSUB_CNT_8812F(x) | BIT_HPQ_PGSUB_CNT_8812F(v)) -+ -+/* 2 REG_PGSUB_N_8812F */ -+ -+#define BIT_SHIFT_NPQ_PGSUB_CNT_8812F 0 -+#define BIT_MASK_NPQ_PGSUB_CNT_8812F 0xffffffffL -+#define BIT_NPQ_PGSUB_CNT_8812F(x) \ -+ (((x) & BIT_MASK_NPQ_PGSUB_CNT_8812F) << BIT_SHIFT_NPQ_PGSUB_CNT_8812F) -+#define BITS_NPQ_PGSUB_CNT_8812F \ -+ (BIT_MASK_NPQ_PGSUB_CNT_8812F << BIT_SHIFT_NPQ_PGSUB_CNT_8812F) -+#define BIT_CLEAR_NPQ_PGSUB_CNT_8812F(x) ((x) & (~BITS_NPQ_PGSUB_CNT_8812F)) -+#define BIT_GET_NPQ_PGSUB_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_NPQ_PGSUB_CNT_8812F) & BIT_MASK_NPQ_PGSUB_CNT_8812F) -+#define BIT_SET_NPQ_PGSUB_CNT_8812F(x, v) \ -+ (BIT_CLEAR_NPQ_PGSUB_CNT_8812F(x) | BIT_NPQ_PGSUB_CNT_8812F(v)) -+ -+/* 2 REG_PGSUB_L_8812F */ -+ -+#define BIT_SHIFT_LPQ_PGSUB_CNT_8812F 0 -+#define BIT_MASK_LPQ_PGSUB_CNT_8812F 0xffffffffL -+#define BIT_LPQ_PGSUB_CNT_8812F(x) \ -+ (((x) & BIT_MASK_LPQ_PGSUB_CNT_8812F) << BIT_SHIFT_LPQ_PGSUB_CNT_8812F) -+#define BITS_LPQ_PGSUB_CNT_8812F \ -+ (BIT_MASK_LPQ_PGSUB_CNT_8812F << BIT_SHIFT_LPQ_PGSUB_CNT_8812F) -+#define BIT_CLEAR_LPQ_PGSUB_CNT_8812F(x) ((x) & (~BITS_LPQ_PGSUB_CNT_8812F)) -+#define BIT_GET_LPQ_PGSUB_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_LPQ_PGSUB_CNT_8812F) & BIT_MASK_LPQ_PGSUB_CNT_8812F) -+#define BIT_SET_LPQ_PGSUB_CNT_8812F(x, v) \ -+ (BIT_CLEAR_LPQ_PGSUB_CNT_8812F(x) | BIT_LPQ_PGSUB_CNT_8812F(v)) -+ -+/* 2 REG_PGSUB_E_8812F */ -+ -+#define BIT_SHIFT_EPQ_PGSUB_CNT_8812F 0 -+#define BIT_MASK_EPQ_PGSUB_CNT_8812F 0xffffffffL -+#define BIT_EPQ_PGSUB_CNT_8812F(x) \ -+ (((x) & BIT_MASK_EPQ_PGSUB_CNT_8812F) << BIT_SHIFT_EPQ_PGSUB_CNT_8812F) -+#define BITS_EPQ_PGSUB_CNT_8812F \ -+ (BIT_MASK_EPQ_PGSUB_CNT_8812F << BIT_SHIFT_EPQ_PGSUB_CNT_8812F) -+#define BIT_CLEAR_EPQ_PGSUB_CNT_8812F(x) ((x) & (~BITS_EPQ_PGSUB_CNT_8812F)) -+#define BIT_GET_EPQ_PGSUB_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_EPQ_PGSUB_CNT_8812F) & BIT_MASK_EPQ_PGSUB_CNT_8812F) -+#define BIT_SET_EPQ_PGSUB_CNT_8812F(x, v) \ -+ (BIT_CLEAR_EPQ_PGSUB_CNT_8812F(x) | BIT_EPQ_PGSUB_CNT_8812F(v)) -+ -+/* 2 REG_RXDMA_AGG_PG_TH_8812F */ -+#define BIT_USB_RXDMA_AGG_EN_8812F BIT(31) -+#define BIT_EN_FW_ADD_8812F BIT(30) -+#define BIT_EN_PRE_CALC_8812F BIT(29) -+#define BIT_RXAGG_SW_EN_8812F BIT(28) -+#define BIT_RXAGG_SW_TRIG_8812F BIT(27) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_DMA_AGG_TO_V1_8812F 8 -+#define BIT_MASK_DMA_AGG_TO_V1_8812F 0xff -+#define BIT_DMA_AGG_TO_V1_8812F(x) \ -+ (((x) & BIT_MASK_DMA_AGG_TO_V1_8812F) << BIT_SHIFT_DMA_AGG_TO_V1_8812F) -+#define BITS_DMA_AGG_TO_V1_8812F \ -+ (BIT_MASK_DMA_AGG_TO_V1_8812F << BIT_SHIFT_DMA_AGG_TO_V1_8812F) -+#define BIT_CLEAR_DMA_AGG_TO_V1_8812F(x) ((x) & (~BITS_DMA_AGG_TO_V1_8812F)) -+#define BIT_GET_DMA_AGG_TO_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DMA_AGG_TO_V1_8812F) & BIT_MASK_DMA_AGG_TO_V1_8812F) -+#define BIT_SET_DMA_AGG_TO_V1_8812F(x, v) \ -+ (BIT_CLEAR_DMA_AGG_TO_V1_8812F(x) | BIT_DMA_AGG_TO_V1_8812F(v)) -+ -+#define BIT_SHIFT_RXDMA_AGG_PG_TH_8812F 0 -+#define BIT_MASK_RXDMA_AGG_PG_TH_8812F 0xff -+#define BIT_RXDMA_AGG_PG_TH_8812F(x) \ -+ (((x) & BIT_MASK_RXDMA_AGG_PG_TH_8812F) \ -+ << BIT_SHIFT_RXDMA_AGG_PG_TH_8812F) -+#define BITS_RXDMA_AGG_PG_TH_8812F \ -+ (BIT_MASK_RXDMA_AGG_PG_TH_8812F << BIT_SHIFT_RXDMA_AGG_PG_TH_8812F) -+#define BIT_CLEAR_RXDMA_AGG_PG_TH_8812F(x) ((x) & (~BITS_RXDMA_AGG_PG_TH_8812F)) -+#define BIT_GET_RXDMA_AGG_PG_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_AGG_PG_TH_8812F) & \ -+ BIT_MASK_RXDMA_AGG_PG_TH_8812F) -+#define BIT_SET_RXDMA_AGG_PG_TH_8812F(x, v) \ -+ (BIT_CLEAR_RXDMA_AGG_PG_TH_8812F(x) | BIT_RXDMA_AGG_PG_TH_8812F(v)) -+ -+/* 2 REG_RXPKT_NUM_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8812F 20 -+#define BIT_MASK_FW_UPD_RDPTR19_TO_16_8812F 0xf -+#define BIT_FW_UPD_RDPTR19_TO_16_8812F(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR19_TO_16_8812F) \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8812F) -+#define BITS_FW_UPD_RDPTR19_TO_16_8812F \ -+ (BIT_MASK_FW_UPD_RDPTR19_TO_16_8812F \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8812F) -+#define BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8812F(x) \ -+ ((x) & (~BITS_FW_UPD_RDPTR19_TO_16_8812F)) -+#define BIT_GET_FW_UPD_RDPTR19_TO_16_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8812F) & \ -+ BIT_MASK_FW_UPD_RDPTR19_TO_16_8812F) -+#define BIT_SET_FW_UPD_RDPTR19_TO_16_8812F(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8812F(x) | \ -+ BIT_FW_UPD_RDPTR19_TO_16_8812F(v)) -+ -+#define BIT_RXDMA_REQ_8812F BIT(19) -+#define BIT_RW_RELEASE_EN_8812F BIT(18) -+#define BIT_RXDMA_IDLE_8812F BIT(17) -+#define BIT_RXPKT_RELEASE_POLL_8812F BIT(16) -+ -+#define BIT_SHIFT_FW_UPD_RDPTR_8812F 0 -+#define BIT_MASK_FW_UPD_RDPTR_8812F 0xffff -+#define BIT_FW_UPD_RDPTR_8812F(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR_8812F) << BIT_SHIFT_FW_UPD_RDPTR_8812F) -+#define BITS_FW_UPD_RDPTR_8812F \ -+ (BIT_MASK_FW_UPD_RDPTR_8812F << BIT_SHIFT_FW_UPD_RDPTR_8812F) -+#define BIT_CLEAR_FW_UPD_RDPTR_8812F(x) ((x) & (~BITS_FW_UPD_RDPTR_8812F)) -+#define BIT_GET_FW_UPD_RDPTR_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR_8812F) & BIT_MASK_FW_UPD_RDPTR_8812F) -+#define BIT_SET_FW_UPD_RDPTR_8812F(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR_8812F(x) | BIT_FW_UPD_RDPTR_8812F(v)) -+ -+/* 2 REG_RXDMA_STATUS_8812F */ -+#define BIT_C2H_PKT_OVF_8812F BIT(7) -+#define BIT_AGG_CONFGI_ISSUE_8812F BIT(6) -+#define BIT_FW_POLL_ISSUE_8812F BIT(5) -+#define BIT_RX_DATA_UDN_8812F BIT(4) -+#define BIT_RX_SFF_UDN_8812F BIT(3) -+#define BIT_RX_SFF_OVF_8812F BIT(2) -+#define BIT_RXPKT_OVF_8812F BIT(0) -+ -+/* 2 REG_RXDMA_DPR_8812F */ -+ -+#define BIT_SHIFT_RDE_DEBUG_8812F 0 -+#define BIT_MASK_RDE_DEBUG_8812F 0xffffffffL -+#define BIT_RDE_DEBUG_8812F(x) \ -+ (((x) & BIT_MASK_RDE_DEBUG_8812F) << BIT_SHIFT_RDE_DEBUG_8812F) -+#define BITS_RDE_DEBUG_8812F \ -+ (BIT_MASK_RDE_DEBUG_8812F << BIT_SHIFT_RDE_DEBUG_8812F) -+#define BIT_CLEAR_RDE_DEBUG_8812F(x) ((x) & (~BITS_RDE_DEBUG_8812F)) -+#define BIT_GET_RDE_DEBUG_8812F(x) \ -+ (((x) >> BIT_SHIFT_RDE_DEBUG_8812F) & BIT_MASK_RDE_DEBUG_8812F) -+#define BIT_SET_RDE_DEBUG_8812F(x, v) \ -+ (BIT_CLEAR_RDE_DEBUG_8812F(x) | BIT_RDE_DEBUG_8812F(v)) -+ -+/* 2 REG_RXDMA_MODE_8812F */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V2_8812F 24 -+#define BIT_MASK_PKTNUM_TH_V2_8812F 0x1f -+#define BIT_PKTNUM_TH_V2_8812F(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V2_8812F) << BIT_SHIFT_PKTNUM_TH_V2_8812F) -+#define BITS_PKTNUM_TH_V2_8812F \ -+ (BIT_MASK_PKTNUM_TH_V2_8812F << BIT_SHIFT_PKTNUM_TH_V2_8812F) -+#define BIT_CLEAR_PKTNUM_TH_V2_8812F(x) ((x) & (~BITS_PKTNUM_TH_V2_8812F)) -+#define BIT_GET_PKTNUM_TH_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V2_8812F) & BIT_MASK_PKTNUM_TH_V2_8812F) -+#define BIT_SET_PKTNUM_TH_V2_8812F(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V2_8812F(x) | BIT_PKTNUM_TH_V2_8812F(v)) -+ -+#define BIT_TXBA_BREAK_USBAGG_8812F BIT(23) -+ -+#define BIT_SHIFT_PKTLEN_PARA_8812F 16 -+#define BIT_MASK_PKTLEN_PARA_8812F 0x7 -+#define BIT_PKTLEN_PARA_8812F(x) \ -+ (((x) & BIT_MASK_PKTLEN_PARA_8812F) << BIT_SHIFT_PKTLEN_PARA_8812F) -+#define BITS_PKTLEN_PARA_8812F \ -+ (BIT_MASK_PKTLEN_PARA_8812F << BIT_SHIFT_PKTLEN_PARA_8812F) -+#define BIT_CLEAR_PKTLEN_PARA_8812F(x) ((x) & (~BITS_PKTLEN_PARA_8812F)) -+#define BIT_GET_PKTLEN_PARA_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKTLEN_PARA_8812F) & BIT_MASK_PKTLEN_PARA_8812F) -+#define BIT_SET_PKTLEN_PARA_8812F(x, v) \ -+ (BIT_CLEAR_PKTLEN_PARA_8812F(x) | BIT_PKTLEN_PARA_8812F(v)) -+ -+#define BIT_RX_DBG_SEL_8812F BIT(7) -+#define BIT_EN_SPD_8812F BIT(6) -+ -+#define BIT_SHIFT_BURST_SIZE_8812F 4 -+#define BIT_MASK_BURST_SIZE_8812F 0x3 -+#define BIT_BURST_SIZE_8812F(x) \ -+ (((x) & BIT_MASK_BURST_SIZE_8812F) << BIT_SHIFT_BURST_SIZE_8812F) -+#define BITS_BURST_SIZE_8812F \ -+ (BIT_MASK_BURST_SIZE_8812F << BIT_SHIFT_BURST_SIZE_8812F) -+#define BIT_CLEAR_BURST_SIZE_8812F(x) ((x) & (~BITS_BURST_SIZE_8812F)) -+#define BIT_GET_BURST_SIZE_8812F(x) \ -+ (((x) >> BIT_SHIFT_BURST_SIZE_8812F) & BIT_MASK_BURST_SIZE_8812F) -+#define BIT_SET_BURST_SIZE_8812F(x, v) \ -+ (BIT_CLEAR_BURST_SIZE_8812F(x) | BIT_BURST_SIZE_8812F(v)) -+ -+#define BIT_SHIFT_BURST_CNT_8812F 2 -+#define BIT_MASK_BURST_CNT_8812F 0x3 -+#define BIT_BURST_CNT_8812F(x) \ -+ (((x) & BIT_MASK_BURST_CNT_8812F) << BIT_SHIFT_BURST_CNT_8812F) -+#define BITS_BURST_CNT_8812F \ -+ (BIT_MASK_BURST_CNT_8812F << BIT_SHIFT_BURST_CNT_8812F) -+#define BIT_CLEAR_BURST_CNT_8812F(x) ((x) & (~BITS_BURST_CNT_8812F)) -+#define BIT_GET_BURST_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_BURST_CNT_8812F) & BIT_MASK_BURST_CNT_8812F) -+#define BIT_SET_BURST_CNT_8812F(x, v) \ -+ (BIT_CLEAR_BURST_CNT_8812F(x) | BIT_BURST_CNT_8812F(v)) -+ -+#define BIT_DMA_MODE_8812F BIT(1) -+ -+/* 2 REG_C2H_PKT_8812F */ -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8812F 24 -+#define BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8812F 0xf -+#define BIT_R_C2H_STR_ADDR_16_TO_19_8812F(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8812F) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8812F) -+#define BITS_R_C2H_STR_ADDR_16_TO_19_8812F \ -+ (BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8812F \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8812F) -+#define BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8812F(x) \ -+ ((x) & (~BITS_R_C2H_STR_ADDR_16_TO_19_8812F)) -+#define BIT_GET_R_C2H_STR_ADDR_16_TO_19_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8812F) & \ -+ BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8812F) -+#define BIT_SET_R_C2H_STR_ADDR_16_TO_19_8812F(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8812F(x) | \ -+ BIT_R_C2H_STR_ADDR_16_TO_19_8812F(v)) -+ -+#define BIT_R_C2H_PKT_REQ_8812F BIT(16) -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_8812F 0 -+#define BIT_MASK_R_C2H_STR_ADDR_8812F 0xffff -+#define BIT_R_C2H_STR_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_8812F) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_8812F) -+#define BITS_R_C2H_STR_ADDR_8812F \ -+ (BIT_MASK_R_C2H_STR_ADDR_8812F << BIT_SHIFT_R_C2H_STR_ADDR_8812F) -+#define BIT_CLEAR_R_C2H_STR_ADDR_8812F(x) ((x) & (~BITS_R_C2H_STR_ADDR_8812F)) -+#define BIT_GET_R_C2H_STR_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_8812F) & \ -+ BIT_MASK_R_C2H_STR_ADDR_8812F) -+#define BIT_SET_R_C2H_STR_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_8812F(x) | BIT_R_C2H_STR_ADDR_8812F(v)) -+ -+/* 2 REG_FWFF_C2H_8812F */ -+ -+#define BIT_SHIFT_C2H_DMA_ADDR_8812F 0 -+#define BIT_MASK_C2H_DMA_ADDR_8812F 0x3ffff -+#define BIT_C2H_DMA_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_C2H_DMA_ADDR_8812F) << BIT_SHIFT_C2H_DMA_ADDR_8812F) -+#define BITS_C2H_DMA_ADDR_8812F \ -+ (BIT_MASK_C2H_DMA_ADDR_8812F << BIT_SHIFT_C2H_DMA_ADDR_8812F) -+#define BIT_CLEAR_C2H_DMA_ADDR_8812F(x) ((x) & (~BITS_C2H_DMA_ADDR_8812F)) -+#define BIT_GET_C2H_DMA_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_C2H_DMA_ADDR_8812F) & BIT_MASK_C2H_DMA_ADDR_8812F) -+#define BIT_SET_C2H_DMA_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_C2H_DMA_ADDR_8812F(x) | BIT_C2H_DMA_ADDR_8812F(v)) -+ -+/* 2 REG_FWFF_CTRL_8812F */ -+#define BIT_FWFF_DMAPKT_REQ_8812F BIT(31) -+ -+#define BIT_SHIFT_FWFF_DMA_PKT_NUM_8812F 16 -+#define BIT_MASK_FWFF_DMA_PKT_NUM_8812F 0xff -+#define BIT_FWFF_DMA_PKT_NUM_8812F(x) \ -+ (((x) & BIT_MASK_FWFF_DMA_PKT_NUM_8812F) \ -+ << BIT_SHIFT_FWFF_DMA_PKT_NUM_8812F) -+#define BITS_FWFF_DMA_PKT_NUM_8812F \ -+ (BIT_MASK_FWFF_DMA_PKT_NUM_8812F << BIT_SHIFT_FWFF_DMA_PKT_NUM_8812F) -+#define BIT_CLEAR_FWFF_DMA_PKT_NUM_8812F(x) \ -+ ((x) & (~BITS_FWFF_DMA_PKT_NUM_8812F)) -+#define BIT_GET_FWFF_DMA_PKT_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_FWFF_DMA_PKT_NUM_8812F) & \ -+ BIT_MASK_FWFF_DMA_PKT_NUM_8812F) -+#define BIT_SET_FWFF_DMA_PKT_NUM_8812F(x, v) \ -+ (BIT_CLEAR_FWFF_DMA_PKT_NUM_8812F(x) | BIT_FWFF_DMA_PKT_NUM_8812F(v)) -+ -+#define BIT_SHIFT_FWFF_STR_ADDR_8812F 0 -+#define BIT_MASK_FWFF_STR_ADDR_8812F 0xffff -+#define BIT_FWFF_STR_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_FWFF_STR_ADDR_8812F) << BIT_SHIFT_FWFF_STR_ADDR_8812F) -+#define BITS_FWFF_STR_ADDR_8812F \ -+ (BIT_MASK_FWFF_STR_ADDR_8812F << BIT_SHIFT_FWFF_STR_ADDR_8812F) -+#define BIT_CLEAR_FWFF_STR_ADDR_8812F(x) ((x) & (~BITS_FWFF_STR_ADDR_8812F)) -+#define BIT_GET_FWFF_STR_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_FWFF_STR_ADDR_8812F) & BIT_MASK_FWFF_STR_ADDR_8812F) -+#define BIT_SET_FWFF_STR_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_FWFF_STR_ADDR_8812F(x) | BIT_FWFF_STR_ADDR_8812F(v)) -+ -+/* 2 REG_FWFF_PKT_INFO_8812F */ -+ -+#define BIT_SHIFT_FWFF_PKT_QUEUED_8812F 16 -+#define BIT_MASK_FWFF_PKT_QUEUED_8812F 0xff -+#define BIT_FWFF_PKT_QUEUED_8812F(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_QUEUED_8812F) \ -+ << BIT_SHIFT_FWFF_PKT_QUEUED_8812F) -+#define BITS_FWFF_PKT_QUEUED_8812F \ -+ (BIT_MASK_FWFF_PKT_QUEUED_8812F << BIT_SHIFT_FWFF_PKT_QUEUED_8812F) -+#define BIT_CLEAR_FWFF_PKT_QUEUED_8812F(x) ((x) & (~BITS_FWFF_PKT_QUEUED_8812F)) -+#define BIT_GET_FWFF_PKT_QUEUED_8812F(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_QUEUED_8812F) & \ -+ BIT_MASK_FWFF_PKT_QUEUED_8812F) -+#define BIT_SET_FWFF_PKT_QUEUED_8812F(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_QUEUED_8812F(x) | BIT_FWFF_PKT_QUEUED_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_FWFF_PKT_STR_ADDR_V2_8812F 0 -+#define BIT_MASK_FWFF_PKT_STR_ADDR_V2_8812F 0x3fff -+#define BIT_FWFF_PKT_STR_ADDR_V2_8812F(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_STR_ADDR_V2_8812F) \ -+ << BIT_SHIFT_FWFF_PKT_STR_ADDR_V2_8812F) -+#define BITS_FWFF_PKT_STR_ADDR_V2_8812F \ -+ (BIT_MASK_FWFF_PKT_STR_ADDR_V2_8812F \ -+ << BIT_SHIFT_FWFF_PKT_STR_ADDR_V2_8812F) -+#define BIT_CLEAR_FWFF_PKT_STR_ADDR_V2_8812F(x) \ -+ ((x) & (~BITS_FWFF_PKT_STR_ADDR_V2_8812F)) -+#define BIT_GET_FWFF_PKT_STR_ADDR_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_STR_ADDR_V2_8812F) & \ -+ BIT_MASK_FWFF_PKT_STR_ADDR_V2_8812F) -+#define BIT_SET_FWFF_PKT_STR_ADDR_V2_8812F(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_STR_ADDR_V2_8812F(x) | \ -+ BIT_FWFF_PKT_STR_ADDR_V2_8812F(v)) -+ -+/* 2 REG_RXPKTNUM_8812F */ -+ -+#define BIT_SHIFT_PKT_NUM_WOL_V1_8812F 16 -+#define BIT_MASK_PKT_NUM_WOL_V1_8812F 0xffff -+#define BIT_PKT_NUM_WOL_V1_8812F(x) \ -+ (((x) & BIT_MASK_PKT_NUM_WOL_V1_8812F) \ -+ << BIT_SHIFT_PKT_NUM_WOL_V1_8812F) -+#define BITS_PKT_NUM_WOL_V1_8812F \ -+ (BIT_MASK_PKT_NUM_WOL_V1_8812F << BIT_SHIFT_PKT_NUM_WOL_V1_8812F) -+#define BIT_CLEAR_PKT_NUM_WOL_V1_8812F(x) ((x) & (~BITS_PKT_NUM_WOL_V1_8812F)) -+#define BIT_GET_PKT_NUM_WOL_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_WOL_V1_8812F) & \ -+ BIT_MASK_PKT_NUM_WOL_V1_8812F) -+#define BIT_SET_PKT_NUM_WOL_V1_8812F(x, v) \ -+ (BIT_CLEAR_PKT_NUM_WOL_V1_8812F(x) | BIT_PKT_NUM_WOL_V1_8812F(v)) -+ -+#define BIT_SHIFT_RXPKT_NUM_V1_8812F 0 -+#define BIT_MASK_RXPKT_NUM_V1_8812F 0xffff -+#define BIT_RXPKT_NUM_V1_8812F(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_V1_8812F) << BIT_SHIFT_RXPKT_NUM_V1_8812F) -+#define BITS_RXPKT_NUM_V1_8812F \ -+ (BIT_MASK_RXPKT_NUM_V1_8812F << BIT_SHIFT_RXPKT_NUM_V1_8812F) -+#define BIT_CLEAR_RXPKT_NUM_V1_8812F(x) ((x) & (~BITS_RXPKT_NUM_V1_8812F)) -+#define BIT_GET_RXPKT_NUM_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_V1_8812F) & BIT_MASK_RXPKT_NUM_V1_8812F) -+#define BIT_SET_RXPKT_NUM_V1_8812F(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_V1_8812F(x) | BIT_RXPKT_NUM_V1_8812F(v)) -+ -+/* 2 REG_RXPKTNUM_TH_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_RXPKT_NUM_TH_8812F 0 -+#define BIT_MASK_RXPKT_NUM_TH_8812F 0xff -+#define BIT_RXPKT_NUM_TH_8812F(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_TH_8812F) << BIT_SHIFT_RXPKT_NUM_TH_8812F) -+#define BITS_RXPKT_NUM_TH_8812F \ -+ (BIT_MASK_RXPKT_NUM_TH_8812F << BIT_SHIFT_RXPKT_NUM_TH_8812F) -+#define BIT_CLEAR_RXPKT_NUM_TH_8812F(x) ((x) & (~BITS_RXPKT_NUM_TH_8812F)) -+#define BIT_GET_RXPKT_NUM_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_TH_8812F) & BIT_MASK_RXPKT_NUM_TH_8812F) -+#define BIT_SET_RXPKT_NUM_TH_8812F(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_TH_8812F(x) | BIT_RXPKT_NUM_TH_8812F(v)) -+ -+/* 2 REG_FW_MSG1_8812F */ -+ -+#define BIT_SHIFT_FW_MSG_REG1_8812F 0 -+#define BIT_MASK_FW_MSG_REG1_8812F 0xffffffffL -+#define BIT_FW_MSG_REG1_8812F(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG1_8812F) << BIT_SHIFT_FW_MSG_REG1_8812F) -+#define BITS_FW_MSG_REG1_8812F \ -+ (BIT_MASK_FW_MSG_REG1_8812F << BIT_SHIFT_FW_MSG_REG1_8812F) -+#define BIT_CLEAR_FW_MSG_REG1_8812F(x) ((x) & (~BITS_FW_MSG_REG1_8812F)) -+#define BIT_GET_FW_MSG_REG1_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG1_8812F) & BIT_MASK_FW_MSG_REG1_8812F) -+#define BIT_SET_FW_MSG_REG1_8812F(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG1_8812F(x) | BIT_FW_MSG_REG1_8812F(v)) -+ -+/* 2 REG_FW_MSG2_8812F */ -+ -+#define BIT_SHIFT_FW_MSG_REG2_8812F 0 -+#define BIT_MASK_FW_MSG_REG2_8812F 0xffffffffL -+#define BIT_FW_MSG_REG2_8812F(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG2_8812F) << BIT_SHIFT_FW_MSG_REG2_8812F) -+#define BITS_FW_MSG_REG2_8812F \ -+ (BIT_MASK_FW_MSG_REG2_8812F << BIT_SHIFT_FW_MSG_REG2_8812F) -+#define BIT_CLEAR_FW_MSG_REG2_8812F(x) ((x) & (~BITS_FW_MSG_REG2_8812F)) -+#define BIT_GET_FW_MSG_REG2_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG2_8812F) & BIT_MASK_FW_MSG_REG2_8812F) -+#define BIT_SET_FW_MSG_REG2_8812F(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG2_8812F(x) | BIT_FW_MSG_REG2_8812F(v)) -+ -+/* 2 REG_FW_MSG3_8812F */ -+ -+#define BIT_SHIFT_FW_MSG_REG3_8812F 0 -+#define BIT_MASK_FW_MSG_REG3_8812F 0xffffffffL -+#define BIT_FW_MSG_REG3_8812F(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG3_8812F) << BIT_SHIFT_FW_MSG_REG3_8812F) -+#define BITS_FW_MSG_REG3_8812F \ -+ (BIT_MASK_FW_MSG_REG3_8812F << BIT_SHIFT_FW_MSG_REG3_8812F) -+#define BIT_CLEAR_FW_MSG_REG3_8812F(x) ((x) & (~BITS_FW_MSG_REG3_8812F)) -+#define BIT_GET_FW_MSG_REG3_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG3_8812F) & BIT_MASK_FW_MSG_REG3_8812F) -+#define BIT_SET_FW_MSG_REG3_8812F(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG3_8812F(x) | BIT_FW_MSG_REG3_8812F(v)) -+ -+/* 2 REG_FW_MSG4_8812F */ -+ -+#define BIT_SHIFT_FW_MSG_REG4_8812F 0 -+#define BIT_MASK_FW_MSG_REG4_8812F 0xffffffffL -+#define BIT_FW_MSG_REG4_8812F(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG4_8812F) << BIT_SHIFT_FW_MSG_REG4_8812F) -+#define BITS_FW_MSG_REG4_8812F \ -+ (BIT_MASK_FW_MSG_REG4_8812F << BIT_SHIFT_FW_MSG_REG4_8812F) -+#define BIT_CLEAR_FW_MSG_REG4_8812F(x) ((x) & (~BITS_FW_MSG_REG4_8812F)) -+#define BIT_GET_FW_MSG_REG4_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG4_8812F) & BIT_MASK_FW_MSG_REG4_8812F) -+#define BIT_SET_FW_MSG_REG4_8812F(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG4_8812F(x) | BIT_FW_MSG_REG4_8812F(v)) -+ -+/* 2 REG_DDMA_CH0SA_8812F */ -+ -+#define BIT_SHIFT_DDMACH0_SA_8812F 0 -+#define BIT_MASK_DDMACH0_SA_8812F 0xffffffffL -+#define BIT_DDMACH0_SA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH0_SA_8812F) << BIT_SHIFT_DDMACH0_SA_8812F) -+#define BITS_DDMACH0_SA_8812F \ -+ (BIT_MASK_DDMACH0_SA_8812F << BIT_SHIFT_DDMACH0_SA_8812F) -+#define BIT_CLEAR_DDMACH0_SA_8812F(x) ((x) & (~BITS_DDMACH0_SA_8812F)) -+#define BIT_GET_DDMACH0_SA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_SA_8812F) & BIT_MASK_DDMACH0_SA_8812F) -+#define BIT_SET_DDMACH0_SA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH0_SA_8812F(x) | BIT_DDMACH0_SA_8812F(v)) -+ -+/* 2 REG_DDMA_CH0DA_8812F */ -+ -+#define BIT_SHIFT_DDMACH0_DA_8812F 0 -+#define BIT_MASK_DDMACH0_DA_8812F 0xffffffffL -+#define BIT_DDMACH0_DA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH0_DA_8812F) << BIT_SHIFT_DDMACH0_DA_8812F) -+#define BITS_DDMACH0_DA_8812F \ -+ (BIT_MASK_DDMACH0_DA_8812F << BIT_SHIFT_DDMACH0_DA_8812F) -+#define BIT_CLEAR_DDMACH0_DA_8812F(x) ((x) & (~BITS_DDMACH0_DA_8812F)) -+#define BIT_GET_DDMACH0_DA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DA_8812F) & BIT_MASK_DDMACH0_DA_8812F) -+#define BIT_SET_DDMACH0_DA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH0_DA_8812F(x) | BIT_DDMACH0_DA_8812F(v)) -+ -+/* 2 REG_DDMA_CH0CTRL_8812F */ -+#define BIT_DDMACH0_OWN_8812F BIT(31) -+#define BIT_DDMACH0_IDMEM_ERR_8812F BIT(30) -+#define BIT_DDMACH0_CHKSUM_EN_8812F BIT(29) -+#define BIT_DDMACH0_DA_W_DISABLE_8812F BIT(28) -+#define BIT_DDMACH0_CHKSUM_STS_8812F BIT(27) -+#define BIT_DDMACH0_DDMA_MODE_8812F BIT(26) -+#define BIT_DDMACH0_RESET_CHKSUM_STS_8812F BIT(25) -+#define BIT_DDMACH0_CHKSUM_CONT_8812F BIT(24) -+ -+#define BIT_SHIFT_DDMACH0_DLEN_8812F 0 -+#define BIT_MASK_DDMACH0_DLEN_8812F 0x3ffff -+#define BIT_DDMACH0_DLEN_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH0_DLEN_8812F) << BIT_SHIFT_DDMACH0_DLEN_8812F) -+#define BITS_DDMACH0_DLEN_8812F \ -+ (BIT_MASK_DDMACH0_DLEN_8812F << BIT_SHIFT_DDMACH0_DLEN_8812F) -+#define BIT_CLEAR_DDMACH0_DLEN_8812F(x) ((x) & (~BITS_DDMACH0_DLEN_8812F)) -+#define BIT_GET_DDMACH0_DLEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DLEN_8812F) & BIT_MASK_DDMACH0_DLEN_8812F) -+#define BIT_SET_DDMACH0_DLEN_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH0_DLEN_8812F(x) | BIT_DDMACH0_DLEN_8812F(v)) -+ -+/* 2 REG_DDMA_CH1SA_8812F */ -+ -+#define BIT_SHIFT_DDMACH1_SA_8812F 0 -+#define BIT_MASK_DDMACH1_SA_8812F 0xffffffffL -+#define BIT_DDMACH1_SA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH1_SA_8812F) << BIT_SHIFT_DDMACH1_SA_8812F) -+#define BITS_DDMACH1_SA_8812F \ -+ (BIT_MASK_DDMACH1_SA_8812F << BIT_SHIFT_DDMACH1_SA_8812F) -+#define BIT_CLEAR_DDMACH1_SA_8812F(x) ((x) & (~BITS_DDMACH1_SA_8812F)) -+#define BIT_GET_DDMACH1_SA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_SA_8812F) & BIT_MASK_DDMACH1_SA_8812F) -+#define BIT_SET_DDMACH1_SA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH1_SA_8812F(x) | BIT_DDMACH1_SA_8812F(v)) -+ -+/* 2 REG_DDMA_CH1DA_8812F */ -+ -+#define BIT_SHIFT_DDMACH1_DA_8812F 0 -+#define BIT_MASK_DDMACH1_DA_8812F 0xffffffffL -+#define BIT_DDMACH1_DA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH1_DA_8812F) << BIT_SHIFT_DDMACH1_DA_8812F) -+#define BITS_DDMACH1_DA_8812F \ -+ (BIT_MASK_DDMACH1_DA_8812F << BIT_SHIFT_DDMACH1_DA_8812F) -+#define BIT_CLEAR_DDMACH1_DA_8812F(x) ((x) & (~BITS_DDMACH1_DA_8812F)) -+#define BIT_GET_DDMACH1_DA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DA_8812F) & BIT_MASK_DDMACH1_DA_8812F) -+#define BIT_SET_DDMACH1_DA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH1_DA_8812F(x) | BIT_DDMACH1_DA_8812F(v)) -+ -+/* 2 REG_DDMA_CH1CTRL_8812F */ -+#define BIT_DDMACH1_OWN_8812F BIT(31) -+#define BIT_DDMACH1_IDMEM_ERR_8812F BIT(30) -+#define BIT_DDMACH1_CHKSUM_EN_8812F BIT(29) -+#define BIT_DDMACH1_DA_W_DISABLE_8812F BIT(28) -+#define BIT_DDMACH1_CHKSUM_STS_8812F BIT(27) -+#define BIT_DDMACH1_DDMA_MODE_8812F BIT(26) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_DDMACH1_DLEN_8812F 0 -+#define BIT_MASK_DDMACH1_DLEN_8812F 0x3ffff -+#define BIT_DDMACH1_DLEN_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH1_DLEN_8812F) << BIT_SHIFT_DDMACH1_DLEN_8812F) -+#define BITS_DDMACH1_DLEN_8812F \ -+ (BIT_MASK_DDMACH1_DLEN_8812F << BIT_SHIFT_DDMACH1_DLEN_8812F) -+#define BIT_CLEAR_DDMACH1_DLEN_8812F(x) ((x) & (~BITS_DDMACH1_DLEN_8812F)) -+#define BIT_GET_DDMACH1_DLEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DLEN_8812F) & BIT_MASK_DDMACH1_DLEN_8812F) -+#define BIT_SET_DDMACH1_DLEN_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH1_DLEN_8812F(x) | BIT_DDMACH1_DLEN_8812F(v)) -+ -+/* 2 REG_DDMA_CH2SA_8812F */ -+ -+#define BIT_SHIFT_DDMACH2_SA_8812F 0 -+#define BIT_MASK_DDMACH2_SA_8812F 0xffffffffL -+#define BIT_DDMACH2_SA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH2_SA_8812F) << BIT_SHIFT_DDMACH2_SA_8812F) -+#define BITS_DDMACH2_SA_8812F \ -+ (BIT_MASK_DDMACH2_SA_8812F << BIT_SHIFT_DDMACH2_SA_8812F) -+#define BIT_CLEAR_DDMACH2_SA_8812F(x) ((x) & (~BITS_DDMACH2_SA_8812F)) -+#define BIT_GET_DDMACH2_SA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_SA_8812F) & BIT_MASK_DDMACH2_SA_8812F) -+#define BIT_SET_DDMACH2_SA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH2_SA_8812F(x) | BIT_DDMACH2_SA_8812F(v)) -+ -+/* 2 REG_DDMA_CH2DA_8812F */ -+ -+#define BIT_SHIFT_DDMACH2_DA_8812F 0 -+#define BIT_MASK_DDMACH2_DA_8812F 0xffffffffL -+#define BIT_DDMACH2_DA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH2_DA_8812F) << BIT_SHIFT_DDMACH2_DA_8812F) -+#define BITS_DDMACH2_DA_8812F \ -+ (BIT_MASK_DDMACH2_DA_8812F << BIT_SHIFT_DDMACH2_DA_8812F) -+#define BIT_CLEAR_DDMACH2_DA_8812F(x) ((x) & (~BITS_DDMACH2_DA_8812F)) -+#define BIT_GET_DDMACH2_DA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DA_8812F) & BIT_MASK_DDMACH2_DA_8812F) -+#define BIT_SET_DDMACH2_DA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH2_DA_8812F(x) | BIT_DDMACH2_DA_8812F(v)) -+ -+/* 2 REG_DDMA_CH2CTRL_8812F */ -+#define BIT_DDMACH2_OWN_8812F BIT(31) -+#define BIT_DDMACH2_IDMEM_ERR_8812F BIT(30) -+#define BIT_DDMACH2_CHKSUM_EN_8812F BIT(29) -+#define BIT_DDMACH2_DA_W_DISABLE_8812F BIT(28) -+#define BIT_DDMACH2_CHKSUM_STS_8812F BIT(27) -+#define BIT_DDMACH2_DDMA_MODE_8812F BIT(26) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_DDMACH2_DLEN_8812F 0 -+#define BIT_MASK_DDMACH2_DLEN_8812F 0x3ffff -+#define BIT_DDMACH2_DLEN_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH2_DLEN_8812F) << BIT_SHIFT_DDMACH2_DLEN_8812F) -+#define BITS_DDMACH2_DLEN_8812F \ -+ (BIT_MASK_DDMACH2_DLEN_8812F << BIT_SHIFT_DDMACH2_DLEN_8812F) -+#define BIT_CLEAR_DDMACH2_DLEN_8812F(x) ((x) & (~BITS_DDMACH2_DLEN_8812F)) -+#define BIT_GET_DDMACH2_DLEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DLEN_8812F) & BIT_MASK_DDMACH2_DLEN_8812F) -+#define BIT_SET_DDMACH2_DLEN_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH2_DLEN_8812F(x) | BIT_DDMACH2_DLEN_8812F(v)) -+ -+/* 2 REG_DDMA_CH3SA_8812F */ -+ -+#define BIT_SHIFT_DDMACH3_SA_8812F 0 -+#define BIT_MASK_DDMACH3_SA_8812F 0xffffffffL -+#define BIT_DDMACH3_SA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH3_SA_8812F) << BIT_SHIFT_DDMACH3_SA_8812F) -+#define BITS_DDMACH3_SA_8812F \ -+ (BIT_MASK_DDMACH3_SA_8812F << BIT_SHIFT_DDMACH3_SA_8812F) -+#define BIT_CLEAR_DDMACH3_SA_8812F(x) ((x) & (~BITS_DDMACH3_SA_8812F)) -+#define BIT_GET_DDMACH3_SA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_SA_8812F) & BIT_MASK_DDMACH3_SA_8812F) -+#define BIT_SET_DDMACH3_SA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH3_SA_8812F(x) | BIT_DDMACH3_SA_8812F(v)) -+ -+/* 2 REG_DDMA_CH3DA_8812F */ -+ -+#define BIT_SHIFT_DDMACH3_DA_8812F 0 -+#define BIT_MASK_DDMACH3_DA_8812F 0xffffffffL -+#define BIT_DDMACH3_DA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH3_DA_8812F) << BIT_SHIFT_DDMACH3_DA_8812F) -+#define BITS_DDMACH3_DA_8812F \ -+ (BIT_MASK_DDMACH3_DA_8812F << BIT_SHIFT_DDMACH3_DA_8812F) -+#define BIT_CLEAR_DDMACH3_DA_8812F(x) ((x) & (~BITS_DDMACH3_DA_8812F)) -+#define BIT_GET_DDMACH3_DA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DA_8812F) & BIT_MASK_DDMACH3_DA_8812F) -+#define BIT_SET_DDMACH3_DA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH3_DA_8812F(x) | BIT_DDMACH3_DA_8812F(v)) -+ -+/* 2 REG_DDMA_CH3CTRL_8812F */ -+#define BIT_DDMACH3_OWN_8812F BIT(31) -+#define BIT_DDMACH3_IDMEM_ERR_8812F BIT(30) -+#define BIT_DDMACH3_CHKSUM_EN_8812F BIT(29) -+#define BIT_DDMACH3_DA_W_DISABLE_8812F BIT(28) -+#define BIT_DDMACH3_CHKSUM_STS_8812F BIT(27) -+#define BIT_DDMACH3_DDMA_MODE_8812F BIT(26) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_DDMACH3_DLEN_8812F 0 -+#define BIT_MASK_DDMACH3_DLEN_8812F 0x3ffff -+#define BIT_DDMACH3_DLEN_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH3_DLEN_8812F) << BIT_SHIFT_DDMACH3_DLEN_8812F) -+#define BITS_DDMACH3_DLEN_8812F \ -+ (BIT_MASK_DDMACH3_DLEN_8812F << BIT_SHIFT_DDMACH3_DLEN_8812F) -+#define BIT_CLEAR_DDMACH3_DLEN_8812F(x) ((x) & (~BITS_DDMACH3_DLEN_8812F)) -+#define BIT_GET_DDMACH3_DLEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DLEN_8812F) & BIT_MASK_DDMACH3_DLEN_8812F) -+#define BIT_SET_DDMACH3_DLEN_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH3_DLEN_8812F(x) | BIT_DDMACH3_DLEN_8812F(v)) -+ -+/* 2 REG_DDMA_CH4SA_8812F */ -+ -+#define BIT_SHIFT_DDMACH4_SA_8812F 0 -+#define BIT_MASK_DDMACH4_SA_8812F 0xffffffffL -+#define BIT_DDMACH4_SA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH4_SA_8812F) << BIT_SHIFT_DDMACH4_SA_8812F) -+#define BITS_DDMACH4_SA_8812F \ -+ (BIT_MASK_DDMACH4_SA_8812F << BIT_SHIFT_DDMACH4_SA_8812F) -+#define BIT_CLEAR_DDMACH4_SA_8812F(x) ((x) & (~BITS_DDMACH4_SA_8812F)) -+#define BIT_GET_DDMACH4_SA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_SA_8812F) & BIT_MASK_DDMACH4_SA_8812F) -+#define BIT_SET_DDMACH4_SA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH4_SA_8812F(x) | BIT_DDMACH4_SA_8812F(v)) -+ -+/* 2 REG_DDMA_CH4DA_8812F */ -+ -+#define BIT_SHIFT_DDMACH4_DA_8812F 0 -+#define BIT_MASK_DDMACH4_DA_8812F 0xffffffffL -+#define BIT_DDMACH4_DA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH4_DA_8812F) << BIT_SHIFT_DDMACH4_DA_8812F) -+#define BITS_DDMACH4_DA_8812F \ -+ (BIT_MASK_DDMACH4_DA_8812F << BIT_SHIFT_DDMACH4_DA_8812F) -+#define BIT_CLEAR_DDMACH4_DA_8812F(x) ((x) & (~BITS_DDMACH4_DA_8812F)) -+#define BIT_GET_DDMACH4_DA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DA_8812F) & BIT_MASK_DDMACH4_DA_8812F) -+#define BIT_SET_DDMACH4_DA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH4_DA_8812F(x) | BIT_DDMACH4_DA_8812F(v)) -+ -+/* 2 REG_DDMA_CH4CTRL_8812F */ -+#define BIT_DDMACH4_OWN_8812F BIT(31) -+#define BIT_DDMACH4_IDMEM_ERR_8812F BIT(30) -+#define BIT_DDMACH4_CHKSUM_EN_8812F BIT(29) -+#define BIT_DDMACH4_DA_W_DISABLE_8812F BIT(28) -+#define BIT_DDMACH4_CHKSUM_STS_8812F BIT(27) -+#define BIT_DDMACH4_DDMA_MODE_8812F BIT(26) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_DDMACH4_DLEN_8812F 0 -+#define BIT_MASK_DDMACH4_DLEN_8812F 0x3ffff -+#define BIT_DDMACH4_DLEN_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH4_DLEN_8812F) << BIT_SHIFT_DDMACH4_DLEN_8812F) -+#define BITS_DDMACH4_DLEN_8812F \ -+ (BIT_MASK_DDMACH4_DLEN_8812F << BIT_SHIFT_DDMACH4_DLEN_8812F) -+#define BIT_CLEAR_DDMACH4_DLEN_8812F(x) ((x) & (~BITS_DDMACH4_DLEN_8812F)) -+#define BIT_GET_DDMACH4_DLEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DLEN_8812F) & BIT_MASK_DDMACH4_DLEN_8812F) -+#define BIT_SET_DDMACH4_DLEN_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH4_DLEN_8812F(x) | BIT_DDMACH4_DLEN_8812F(v)) -+ -+/* 2 REG_DDMA_CH5SA_8812F */ -+ -+#define BIT_SHIFT_DDMACH5_SA_8812F 0 -+#define BIT_MASK_DDMACH5_SA_8812F 0xffffffffL -+#define BIT_DDMACH5_SA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH5_SA_8812F) << BIT_SHIFT_DDMACH5_SA_8812F) -+#define BITS_DDMACH5_SA_8812F \ -+ (BIT_MASK_DDMACH5_SA_8812F << BIT_SHIFT_DDMACH5_SA_8812F) -+#define BIT_CLEAR_DDMACH5_SA_8812F(x) ((x) & (~BITS_DDMACH5_SA_8812F)) -+#define BIT_GET_DDMACH5_SA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_SA_8812F) & BIT_MASK_DDMACH5_SA_8812F) -+#define BIT_SET_DDMACH5_SA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH5_SA_8812F(x) | BIT_DDMACH5_SA_8812F(v)) -+ -+/* 2 REG_DDMA_CH5DA_8812F */ -+ -+#define BIT_SHIFT_DDMACH5_DA_8812F 0 -+#define BIT_MASK_DDMACH5_DA_8812F 0xffffffffL -+#define BIT_DDMACH5_DA_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH5_DA_8812F) << BIT_SHIFT_DDMACH5_DA_8812F) -+#define BITS_DDMACH5_DA_8812F \ -+ (BIT_MASK_DDMACH5_DA_8812F << BIT_SHIFT_DDMACH5_DA_8812F) -+#define BIT_CLEAR_DDMACH5_DA_8812F(x) ((x) & (~BITS_DDMACH5_DA_8812F)) -+#define BIT_GET_DDMACH5_DA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DA_8812F) & BIT_MASK_DDMACH5_DA_8812F) -+#define BIT_SET_DDMACH5_DA_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH5_DA_8812F(x) | BIT_DDMACH5_DA_8812F(v)) -+ -+/* 2 REG_DDMA_CH5CTRL_8812F */ -+#define BIT_DDMACH5_OWN_8812F BIT(31) -+#define BIT_DDMACH5_IDMEM_ERR_8812F BIT(30) -+#define BIT_DDMACH5_CHKSUM_EN_8812F BIT(29) -+#define BIT_DDMACH5_DA_W_DISABLE_8812F BIT(28) -+#define BIT_DDMACH5_CHKSUM_STS_8812F BIT(27) -+#define BIT_DDMACH5_DDMA_MODE_8812F BIT(26) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_DDMACH5_DLEN_8812F 0 -+#define BIT_MASK_DDMACH5_DLEN_8812F 0x3ffff -+#define BIT_DDMACH5_DLEN_8812F(x) \ -+ (((x) & BIT_MASK_DDMACH5_DLEN_8812F) << BIT_SHIFT_DDMACH5_DLEN_8812F) -+#define BITS_DDMACH5_DLEN_8812F \ -+ (BIT_MASK_DDMACH5_DLEN_8812F << BIT_SHIFT_DDMACH5_DLEN_8812F) -+#define BIT_CLEAR_DDMACH5_DLEN_8812F(x) ((x) & (~BITS_DDMACH5_DLEN_8812F)) -+#define BIT_GET_DDMACH5_DLEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DLEN_8812F) & BIT_MASK_DDMACH5_DLEN_8812F) -+#define BIT_SET_DDMACH5_DLEN_8812F(x, v) \ -+ (BIT_CLEAR_DDMACH5_DLEN_8812F(x) | BIT_DDMACH5_DLEN_8812F(v)) -+ -+/* 2 REG_DDMA_INT_MSK_8812F */ -+#define BIT_DDMACH5_MSK_8812F BIT(5) -+#define BIT_DDMACH4_MSK_8812F BIT(4) -+#define BIT_DDMACH3_MSK_8812F BIT(3) -+#define BIT_DDMACH2_MSK_8812F BIT(2) -+#define BIT_DDMACH1_MSK_8812F BIT(1) -+#define BIT_DDMACH0_MSK_8812F BIT(0) -+ -+/* 2 REG_DDMA_CHSTATUS_8812F */ -+#define BIT_DDMACH5_BUSY_8812F BIT(5) -+#define BIT_DDMACH4_BUSY_8812F BIT(4) -+#define BIT_DDMACH3_BUSY_8812F BIT(3) -+#define BIT_DDMACH2_BUSY_8812F BIT(2) -+#define BIT_DDMACH1_BUSY_8812F BIT(1) -+#define BIT_DDMACH0_BUSY_8812F BIT(0) -+ -+/* 2 REG_DDMA_CHKSUM_8812F */ -+ -+#define BIT_SHIFT_IDDMA0_CHKSUM_8812F 0 -+#define BIT_MASK_IDDMA0_CHKSUM_8812F 0xffff -+#define BIT_IDDMA0_CHKSUM_8812F(x) \ -+ (((x) & BIT_MASK_IDDMA0_CHKSUM_8812F) << BIT_SHIFT_IDDMA0_CHKSUM_8812F) -+#define BITS_IDDMA0_CHKSUM_8812F \ -+ (BIT_MASK_IDDMA0_CHKSUM_8812F << BIT_SHIFT_IDDMA0_CHKSUM_8812F) -+#define BIT_CLEAR_IDDMA0_CHKSUM_8812F(x) ((x) & (~BITS_IDDMA0_CHKSUM_8812F)) -+#define BIT_GET_IDDMA0_CHKSUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_IDDMA0_CHKSUM_8812F) & BIT_MASK_IDDMA0_CHKSUM_8812F) -+#define BIT_SET_IDDMA0_CHKSUM_8812F(x, v) \ -+ (BIT_CLEAR_IDDMA0_CHKSUM_8812F(x) | BIT_IDDMA0_CHKSUM_8812F(v)) -+ -+/* 2 REG_DDMA_MONITOR_8812F */ -+#define BIT_IDDMA0_PERMU_UNDERFLOW_8812F BIT(14) -+#define BIT_IDDMA0_FIFO_UNDERFLOW_8812F BIT(13) -+#define BIT_IDDMA0_FIFO_OVERFLOW_8812F BIT(12) -+#define BIT_CH5_ERR_8812F BIT(5) -+#define BIT_CH4_ERR_8812F BIT(4) -+#define BIT_CH3_ERR_8812F BIT(3) -+#define BIT_CH2_ERR_8812F BIT(2) -+#define BIT_CH1_ERR_8812F BIT(1) -+#define BIT_CH0_ERR_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_PCIE_CTRL_8812F */ -+#define BIT_PCIEIO_PERSTB_SEL_8812F BIT(31) -+ -+#define BIT_SHIFT_PCIE_MAX_RXDMA_8812F 28 -+#define BIT_MASK_PCIE_MAX_RXDMA_8812F 0x7 -+#define BIT_PCIE_MAX_RXDMA_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_RXDMA_8812F) \ -+ << BIT_SHIFT_PCIE_MAX_RXDMA_8812F) -+#define BITS_PCIE_MAX_RXDMA_8812F \ -+ (BIT_MASK_PCIE_MAX_RXDMA_8812F << BIT_SHIFT_PCIE_MAX_RXDMA_8812F) -+#define BIT_CLEAR_PCIE_MAX_RXDMA_8812F(x) ((x) & (~BITS_PCIE_MAX_RXDMA_8812F)) -+#define BIT_GET_PCIE_MAX_RXDMA_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_RXDMA_8812F) & \ -+ BIT_MASK_PCIE_MAX_RXDMA_8812F) -+#define BIT_SET_PCIE_MAX_RXDMA_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_RXDMA_8812F(x) | BIT_PCIE_MAX_RXDMA_8812F(v)) -+ -+#define BIT_SHIFT_PCIE_MAX_TXDMA_8812F 24 -+#define BIT_MASK_PCIE_MAX_TXDMA_8812F 0x7 -+#define BIT_PCIE_MAX_TXDMA_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_TXDMA_8812F) \ -+ << BIT_SHIFT_PCIE_MAX_TXDMA_8812F) -+#define BITS_PCIE_MAX_TXDMA_8812F \ -+ (BIT_MASK_PCIE_MAX_TXDMA_8812F << BIT_SHIFT_PCIE_MAX_TXDMA_8812F) -+#define BIT_CLEAR_PCIE_MAX_TXDMA_8812F(x) ((x) & (~BITS_PCIE_MAX_TXDMA_8812F)) -+#define BIT_GET_PCIE_MAX_TXDMA_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_TXDMA_8812F) & \ -+ BIT_MASK_PCIE_MAX_TXDMA_8812F) -+#define BIT_SET_PCIE_MAX_TXDMA_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_TXDMA_8812F(x) | BIT_PCIE_MAX_TXDMA_8812F(v)) -+ -+#define BIT_EN_CPL_TIMEOUT_PS_8812F BIT(22) -+#define BIT_REG_TXDMA_FAIL_PS_8812F BIT(21) -+#define BIT_PCIE_RST_TRXDMA_INTF_8812F BIT(20) -+#define BIT_EN_HWENTR_L1_8812F BIT(19) -+#define BIT_EN_ADV_CLKGATE_8812F BIT(18) -+#define BIT_PCIE_EN_SWENT_L23_8812F BIT(17) -+#define BIT_PCIE_EN_HWEXT_L1_8812F BIT(16) -+#define BIT_RX_CLOSE_EN_8812F BIT(15) -+#define BIT_STOP_BCNQ_8812F BIT(14) -+#define BIT_STOP_MGQ_8812F BIT(13) -+#define BIT_STOP_VOQ_8812F BIT(12) -+#define BIT_STOP_VIQ_8812F BIT(11) -+#define BIT_STOP_BEQ_8812F BIT(10) -+#define BIT_STOP_BKQ_8812F BIT(9) -+#define BIT_STOP_RXQ_8812F BIT(8) -+#define BIT_STOP_HI7Q_8812F BIT(7) -+#define BIT_STOP_HI6Q_8812F BIT(6) -+#define BIT_STOP_HI5Q_8812F BIT(5) -+#define BIT_STOP_HI4Q_8812F BIT(4) -+#define BIT_STOP_HI3Q_8812F BIT(3) -+#define BIT_STOP_HI2Q_8812F BIT(2) -+#define BIT_STOP_HI1Q_8812F BIT(1) -+#define BIT_STOP_HI0Q_8812F BIT(0) -+ -+/* 2 REG_INT_MIG_8812F */ -+ -+#define BIT_SHIFT_TRXCOUNTER_MATCH_8812F 24 -+#define BIT_MASK_TRXCOUNTER_MATCH_8812F 0xff -+#define BIT_TRXCOUNTER_MATCH_8812F(x) \ -+ (((x) & BIT_MASK_TRXCOUNTER_MATCH_8812F) \ -+ << BIT_SHIFT_TRXCOUNTER_MATCH_8812F) -+#define BITS_TRXCOUNTER_MATCH_8812F \ -+ (BIT_MASK_TRXCOUNTER_MATCH_8812F << BIT_SHIFT_TRXCOUNTER_MATCH_8812F) -+#define BIT_CLEAR_TRXCOUNTER_MATCH_8812F(x) \ -+ ((x) & (~BITS_TRXCOUNTER_MATCH_8812F)) -+#define BIT_GET_TRXCOUNTER_MATCH_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRXCOUNTER_MATCH_8812F) & \ -+ BIT_MASK_TRXCOUNTER_MATCH_8812F) -+#define BIT_SET_TRXCOUNTER_MATCH_8812F(x, v) \ -+ (BIT_CLEAR_TRXCOUNTER_MATCH_8812F(x) | BIT_TRXCOUNTER_MATCH_8812F(v)) -+ -+#define BIT_SHIFT_TRXTIMER_MATCH_8812F 16 -+#define BIT_MASK_TRXTIMER_MATCH_8812F 0xff -+#define BIT_TRXTIMER_MATCH_8812F(x) \ -+ (((x) & BIT_MASK_TRXTIMER_MATCH_8812F) \ -+ << BIT_SHIFT_TRXTIMER_MATCH_8812F) -+#define BITS_TRXTIMER_MATCH_8812F \ -+ (BIT_MASK_TRXTIMER_MATCH_8812F << BIT_SHIFT_TRXTIMER_MATCH_8812F) -+#define BIT_CLEAR_TRXTIMER_MATCH_8812F(x) ((x) & (~BITS_TRXTIMER_MATCH_8812F)) -+#define BIT_GET_TRXTIMER_MATCH_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRXTIMER_MATCH_8812F) & \ -+ BIT_MASK_TRXTIMER_MATCH_8812F) -+#define BIT_SET_TRXTIMER_MATCH_8812F(x, v) \ -+ (BIT_CLEAR_TRXTIMER_MATCH_8812F(x) | BIT_TRXTIMER_MATCH_8812F(v)) -+ -+#define BIT_SHIFT_TRXTIMER_UNIT_8812F 0 -+#define BIT_MASK_TRXTIMER_UNIT_8812F 0x3 -+#define BIT_TRXTIMER_UNIT_8812F(x) \ -+ (((x) & BIT_MASK_TRXTIMER_UNIT_8812F) << BIT_SHIFT_TRXTIMER_UNIT_8812F) -+#define BITS_TRXTIMER_UNIT_8812F \ -+ (BIT_MASK_TRXTIMER_UNIT_8812F << BIT_SHIFT_TRXTIMER_UNIT_8812F) -+#define BIT_CLEAR_TRXTIMER_UNIT_8812F(x) ((x) & (~BITS_TRXTIMER_UNIT_8812F)) -+#define BIT_GET_TRXTIMER_UNIT_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRXTIMER_UNIT_8812F) & BIT_MASK_TRXTIMER_UNIT_8812F) -+#define BIT_SET_TRXTIMER_UNIT_8812F(x, v) \ -+ (BIT_CLEAR_TRXTIMER_UNIT_8812F(x) | BIT_TRXTIMER_UNIT_8812F(v)) -+ -+/* 2 REG_BCNQ_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_BCNQ_TXBD_DESA_8812F 0 -+#define BIT_MASK_BCNQ_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_BCNQ_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_BCNQ_TXBD_DESA_8812F) \ -+ << BIT_SHIFT_BCNQ_TXBD_DESA_8812F) -+#define BITS_BCNQ_TXBD_DESA_8812F \ -+ (BIT_MASK_BCNQ_TXBD_DESA_8812F << BIT_SHIFT_BCNQ_TXBD_DESA_8812F) -+#define BIT_CLEAR_BCNQ_TXBD_DESA_8812F(x) ((x) & (~BITS_BCNQ_TXBD_DESA_8812F)) -+#define BIT_GET_BCNQ_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_TXBD_DESA_8812F) & \ -+ BIT_MASK_BCNQ_TXBD_DESA_8812F) -+#define BIT_SET_BCNQ_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_BCNQ_TXBD_DESA_8812F(x) | BIT_BCNQ_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_MGQ_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_MGQ_TXBD_DESA_8812F 0 -+#define BIT_MASK_MGQ_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_MGQ_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_TXBD_DESA_8812F) << BIT_SHIFT_MGQ_TXBD_DESA_8812F) -+#define BITS_MGQ_TXBD_DESA_8812F \ -+ (BIT_MASK_MGQ_TXBD_DESA_8812F << BIT_SHIFT_MGQ_TXBD_DESA_8812F) -+#define BIT_CLEAR_MGQ_TXBD_DESA_8812F(x) ((x) & (~BITS_MGQ_TXBD_DESA_8812F)) -+#define BIT_GET_MGQ_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_TXBD_DESA_8812F) & BIT_MASK_MGQ_TXBD_DESA_8812F) -+#define BIT_SET_MGQ_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_TXBD_DESA_8812F(x) | BIT_MGQ_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_VOQ_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_VOQ_TXBD_DESA_8812F 0 -+#define BIT_MASK_VOQ_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_VOQ_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_VOQ_TXBD_DESA_8812F) << BIT_SHIFT_VOQ_TXBD_DESA_8812F) -+#define BITS_VOQ_TXBD_DESA_8812F \ -+ (BIT_MASK_VOQ_TXBD_DESA_8812F << BIT_SHIFT_VOQ_TXBD_DESA_8812F) -+#define BIT_CLEAR_VOQ_TXBD_DESA_8812F(x) ((x) & (~BITS_VOQ_TXBD_DESA_8812F)) -+#define BIT_GET_VOQ_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_VOQ_TXBD_DESA_8812F) & BIT_MASK_VOQ_TXBD_DESA_8812F) -+#define BIT_SET_VOQ_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_VOQ_TXBD_DESA_8812F(x) | BIT_VOQ_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_VIQ_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_VIQ_TXBD_DESA_8812F 0 -+#define BIT_MASK_VIQ_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_VIQ_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_VIQ_TXBD_DESA_8812F) << BIT_SHIFT_VIQ_TXBD_DESA_8812F) -+#define BITS_VIQ_TXBD_DESA_8812F \ -+ (BIT_MASK_VIQ_TXBD_DESA_8812F << BIT_SHIFT_VIQ_TXBD_DESA_8812F) -+#define BIT_CLEAR_VIQ_TXBD_DESA_8812F(x) ((x) & (~BITS_VIQ_TXBD_DESA_8812F)) -+#define BIT_GET_VIQ_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_VIQ_TXBD_DESA_8812F) & BIT_MASK_VIQ_TXBD_DESA_8812F) -+#define BIT_SET_VIQ_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_VIQ_TXBD_DESA_8812F(x) | BIT_VIQ_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_BEQ_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_BEQ_TXBD_DESA_8812F 0 -+#define BIT_MASK_BEQ_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_BEQ_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_BEQ_TXBD_DESA_8812F) << BIT_SHIFT_BEQ_TXBD_DESA_8812F) -+#define BITS_BEQ_TXBD_DESA_8812F \ -+ (BIT_MASK_BEQ_TXBD_DESA_8812F << BIT_SHIFT_BEQ_TXBD_DESA_8812F) -+#define BIT_CLEAR_BEQ_TXBD_DESA_8812F(x) ((x) & (~BITS_BEQ_TXBD_DESA_8812F)) -+#define BIT_GET_BEQ_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_BEQ_TXBD_DESA_8812F) & BIT_MASK_BEQ_TXBD_DESA_8812F) -+#define BIT_SET_BEQ_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_BEQ_TXBD_DESA_8812F(x) | BIT_BEQ_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_BKQ_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_BKQ_TXBD_DESA_8812F 0 -+#define BIT_MASK_BKQ_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_BKQ_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_BKQ_TXBD_DESA_8812F) << BIT_SHIFT_BKQ_TXBD_DESA_8812F) -+#define BITS_BKQ_TXBD_DESA_8812F \ -+ (BIT_MASK_BKQ_TXBD_DESA_8812F << BIT_SHIFT_BKQ_TXBD_DESA_8812F) -+#define BIT_CLEAR_BKQ_TXBD_DESA_8812F(x) ((x) & (~BITS_BKQ_TXBD_DESA_8812F)) -+#define BIT_GET_BKQ_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_BKQ_TXBD_DESA_8812F) & BIT_MASK_BKQ_TXBD_DESA_8812F) -+#define BIT_SET_BKQ_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_BKQ_TXBD_DESA_8812F(x) | BIT_BKQ_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_RXQ_RXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_RXQ_RXBD_DESA_8812F 0 -+#define BIT_MASK_RXQ_RXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_RXQ_RXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_RXQ_RXBD_DESA_8812F) << BIT_SHIFT_RXQ_RXBD_DESA_8812F) -+#define BITS_RXQ_RXBD_DESA_8812F \ -+ (BIT_MASK_RXQ_RXBD_DESA_8812F << BIT_SHIFT_RXQ_RXBD_DESA_8812F) -+#define BIT_CLEAR_RXQ_RXBD_DESA_8812F(x) ((x) & (~BITS_RXQ_RXBD_DESA_8812F)) -+#define BIT_GET_RXQ_RXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXQ_RXBD_DESA_8812F) & BIT_MASK_RXQ_RXBD_DESA_8812F) -+#define BIT_SET_RXQ_RXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_RXQ_RXBD_DESA_8812F(x) | BIT_RXQ_RXBD_DESA_8812F(v)) -+ -+/* 2 REG_HI0Q_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_HI0Q_TXBD_DESA_8812F 0 -+#define BIT_MASK_HI0Q_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_HI0Q_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_HI0Q_TXBD_DESA_8812F) \ -+ << BIT_SHIFT_HI0Q_TXBD_DESA_8812F) -+#define BITS_HI0Q_TXBD_DESA_8812F \ -+ (BIT_MASK_HI0Q_TXBD_DESA_8812F << BIT_SHIFT_HI0Q_TXBD_DESA_8812F) -+#define BIT_CLEAR_HI0Q_TXBD_DESA_8812F(x) ((x) & (~BITS_HI0Q_TXBD_DESA_8812F)) -+#define BIT_GET_HI0Q_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_TXBD_DESA_8812F) & \ -+ BIT_MASK_HI0Q_TXBD_DESA_8812F) -+#define BIT_SET_HI0Q_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_HI0Q_TXBD_DESA_8812F(x) | BIT_HI0Q_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_HI1Q_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_HI1Q_TXBD_DESA_8812F 0 -+#define BIT_MASK_HI1Q_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_HI1Q_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_HI1Q_TXBD_DESA_8812F) \ -+ << BIT_SHIFT_HI1Q_TXBD_DESA_8812F) -+#define BITS_HI1Q_TXBD_DESA_8812F \ -+ (BIT_MASK_HI1Q_TXBD_DESA_8812F << BIT_SHIFT_HI1Q_TXBD_DESA_8812F) -+#define BIT_CLEAR_HI1Q_TXBD_DESA_8812F(x) ((x) & (~BITS_HI1Q_TXBD_DESA_8812F)) -+#define BIT_GET_HI1Q_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_TXBD_DESA_8812F) & \ -+ BIT_MASK_HI1Q_TXBD_DESA_8812F) -+#define BIT_SET_HI1Q_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_HI1Q_TXBD_DESA_8812F(x) | BIT_HI1Q_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_HI2Q_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_HI2Q_TXBD_DESA_8812F 0 -+#define BIT_MASK_HI2Q_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_HI2Q_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_HI2Q_TXBD_DESA_8812F) \ -+ << BIT_SHIFT_HI2Q_TXBD_DESA_8812F) -+#define BITS_HI2Q_TXBD_DESA_8812F \ -+ (BIT_MASK_HI2Q_TXBD_DESA_8812F << BIT_SHIFT_HI2Q_TXBD_DESA_8812F) -+#define BIT_CLEAR_HI2Q_TXBD_DESA_8812F(x) ((x) & (~BITS_HI2Q_TXBD_DESA_8812F)) -+#define BIT_GET_HI2Q_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_TXBD_DESA_8812F) & \ -+ BIT_MASK_HI2Q_TXBD_DESA_8812F) -+#define BIT_SET_HI2Q_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_HI2Q_TXBD_DESA_8812F(x) | BIT_HI2Q_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_HI3Q_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_HI3Q_TXBD_DESA_8812F 0 -+#define BIT_MASK_HI3Q_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_HI3Q_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_HI3Q_TXBD_DESA_8812F) \ -+ << BIT_SHIFT_HI3Q_TXBD_DESA_8812F) -+#define BITS_HI3Q_TXBD_DESA_8812F \ -+ (BIT_MASK_HI3Q_TXBD_DESA_8812F << BIT_SHIFT_HI3Q_TXBD_DESA_8812F) -+#define BIT_CLEAR_HI3Q_TXBD_DESA_8812F(x) ((x) & (~BITS_HI3Q_TXBD_DESA_8812F)) -+#define BIT_GET_HI3Q_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_TXBD_DESA_8812F) & \ -+ BIT_MASK_HI3Q_TXBD_DESA_8812F) -+#define BIT_SET_HI3Q_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_HI3Q_TXBD_DESA_8812F(x) | BIT_HI3Q_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_HI4Q_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_HI4Q_TXBD_DESA_8812F 0 -+#define BIT_MASK_HI4Q_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_HI4Q_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_HI4Q_TXBD_DESA_8812F) \ -+ << BIT_SHIFT_HI4Q_TXBD_DESA_8812F) -+#define BITS_HI4Q_TXBD_DESA_8812F \ -+ (BIT_MASK_HI4Q_TXBD_DESA_8812F << BIT_SHIFT_HI4Q_TXBD_DESA_8812F) -+#define BIT_CLEAR_HI4Q_TXBD_DESA_8812F(x) ((x) & (~BITS_HI4Q_TXBD_DESA_8812F)) -+#define BIT_GET_HI4Q_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_TXBD_DESA_8812F) & \ -+ BIT_MASK_HI4Q_TXBD_DESA_8812F) -+#define BIT_SET_HI4Q_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_HI4Q_TXBD_DESA_8812F(x) | BIT_HI4Q_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_HI5Q_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_HI5Q_TXBD_DESA_8812F 0 -+#define BIT_MASK_HI5Q_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_HI5Q_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_HI5Q_TXBD_DESA_8812F) \ -+ << BIT_SHIFT_HI5Q_TXBD_DESA_8812F) -+#define BITS_HI5Q_TXBD_DESA_8812F \ -+ (BIT_MASK_HI5Q_TXBD_DESA_8812F << BIT_SHIFT_HI5Q_TXBD_DESA_8812F) -+#define BIT_CLEAR_HI5Q_TXBD_DESA_8812F(x) ((x) & (~BITS_HI5Q_TXBD_DESA_8812F)) -+#define BIT_GET_HI5Q_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_TXBD_DESA_8812F) & \ -+ BIT_MASK_HI5Q_TXBD_DESA_8812F) -+#define BIT_SET_HI5Q_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_HI5Q_TXBD_DESA_8812F(x) | BIT_HI5Q_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_HI6Q_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_HI6Q_TXBD_DESA_8812F 0 -+#define BIT_MASK_HI6Q_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_HI6Q_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_HI6Q_TXBD_DESA_8812F) \ -+ << BIT_SHIFT_HI6Q_TXBD_DESA_8812F) -+#define BITS_HI6Q_TXBD_DESA_8812F \ -+ (BIT_MASK_HI6Q_TXBD_DESA_8812F << BIT_SHIFT_HI6Q_TXBD_DESA_8812F) -+#define BIT_CLEAR_HI6Q_TXBD_DESA_8812F(x) ((x) & (~BITS_HI6Q_TXBD_DESA_8812F)) -+#define BIT_GET_HI6Q_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_TXBD_DESA_8812F) & \ -+ BIT_MASK_HI6Q_TXBD_DESA_8812F) -+#define BIT_SET_HI6Q_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_HI6Q_TXBD_DESA_8812F(x) | BIT_HI6Q_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_HI7Q_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_HI7Q_TXBD_DESA_8812F 0 -+#define BIT_MASK_HI7Q_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_HI7Q_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_HI7Q_TXBD_DESA_8812F) \ -+ << BIT_SHIFT_HI7Q_TXBD_DESA_8812F) -+#define BITS_HI7Q_TXBD_DESA_8812F \ -+ (BIT_MASK_HI7Q_TXBD_DESA_8812F << BIT_SHIFT_HI7Q_TXBD_DESA_8812F) -+#define BIT_CLEAR_HI7Q_TXBD_DESA_8812F(x) ((x) & (~BITS_HI7Q_TXBD_DESA_8812F)) -+#define BIT_GET_HI7Q_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_TXBD_DESA_8812F) & \ -+ BIT_MASK_HI7Q_TXBD_DESA_8812F) -+#define BIT_SET_HI7Q_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_HI7Q_TXBD_DESA_8812F(x) | BIT_HI7Q_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_MGQ_TXBD_NUM_8812F */ -+#define BIT_PCIE_MGQ_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_MGQ_DESC_MODE_8812F 12 -+#define BIT_MASK_MGQ_DESC_MODE_8812F 0x3 -+#define BIT_MGQ_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_MODE_8812F) << BIT_SHIFT_MGQ_DESC_MODE_8812F) -+#define BITS_MGQ_DESC_MODE_8812F \ -+ (BIT_MASK_MGQ_DESC_MODE_8812F << BIT_SHIFT_MGQ_DESC_MODE_8812F) -+#define BIT_CLEAR_MGQ_DESC_MODE_8812F(x) ((x) & (~BITS_MGQ_DESC_MODE_8812F)) -+#define BIT_GET_MGQ_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_MODE_8812F) & BIT_MASK_MGQ_DESC_MODE_8812F) -+#define BIT_SET_MGQ_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_MODE_8812F(x) | BIT_MGQ_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_MGQ_DESC_NUM_8812F 0 -+#define BIT_MASK_MGQ_DESC_NUM_8812F 0xfff -+#define BIT_MGQ_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_NUM_8812F) << BIT_SHIFT_MGQ_DESC_NUM_8812F) -+#define BITS_MGQ_DESC_NUM_8812F \ -+ (BIT_MASK_MGQ_DESC_NUM_8812F << BIT_SHIFT_MGQ_DESC_NUM_8812F) -+#define BIT_CLEAR_MGQ_DESC_NUM_8812F(x) ((x) & (~BITS_MGQ_DESC_NUM_8812F)) -+#define BIT_GET_MGQ_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_NUM_8812F) & BIT_MASK_MGQ_DESC_NUM_8812F) -+#define BIT_SET_MGQ_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_NUM_8812F(x) | BIT_MGQ_DESC_NUM_8812F(v)) -+ -+/* 2 REG_RX_RXBD_NUM_8812F */ -+#define BIT_SYS_32_64_8812F BIT(15) -+ -+#define BIT_SHIFT_BCNQ_DESC_MODE_8812F 13 -+#define BIT_MASK_BCNQ_DESC_MODE_8812F 0x3 -+#define BIT_BCNQ_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_BCNQ_DESC_MODE_8812F) \ -+ << BIT_SHIFT_BCNQ_DESC_MODE_8812F) -+#define BITS_BCNQ_DESC_MODE_8812F \ -+ (BIT_MASK_BCNQ_DESC_MODE_8812F << BIT_SHIFT_BCNQ_DESC_MODE_8812F) -+#define BIT_CLEAR_BCNQ_DESC_MODE_8812F(x) ((x) & (~BITS_BCNQ_DESC_MODE_8812F)) -+#define BIT_GET_BCNQ_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_DESC_MODE_8812F) & \ -+ BIT_MASK_BCNQ_DESC_MODE_8812F) -+#define BIT_SET_BCNQ_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_BCNQ_DESC_MODE_8812F(x) | BIT_BCNQ_DESC_MODE_8812F(v)) -+ -+#define BIT_PCIE_BCNQ_FLAG_8812F BIT(12) -+ -+#define BIT_SHIFT_RXQ_DESC_NUM_8812F 0 -+#define BIT_MASK_RXQ_DESC_NUM_8812F 0xfff -+#define BIT_RXQ_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_RXQ_DESC_NUM_8812F) << BIT_SHIFT_RXQ_DESC_NUM_8812F) -+#define BITS_RXQ_DESC_NUM_8812F \ -+ (BIT_MASK_RXQ_DESC_NUM_8812F << BIT_SHIFT_RXQ_DESC_NUM_8812F) -+#define BIT_CLEAR_RXQ_DESC_NUM_8812F(x) ((x) & (~BITS_RXQ_DESC_NUM_8812F)) -+#define BIT_GET_RXQ_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXQ_DESC_NUM_8812F) & BIT_MASK_RXQ_DESC_NUM_8812F) -+#define BIT_SET_RXQ_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_RXQ_DESC_NUM_8812F(x) | BIT_RXQ_DESC_NUM_8812F(v)) -+ -+/* 2 REG_VOQ_TXBD_NUM_8812F */ -+#define BIT_PCIE_VOQ_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_VOQ_DESC_MODE_8812F 12 -+#define BIT_MASK_VOQ_DESC_MODE_8812F 0x3 -+#define BIT_VOQ_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_MODE_8812F) << BIT_SHIFT_VOQ_DESC_MODE_8812F) -+#define BITS_VOQ_DESC_MODE_8812F \ -+ (BIT_MASK_VOQ_DESC_MODE_8812F << BIT_SHIFT_VOQ_DESC_MODE_8812F) -+#define BIT_CLEAR_VOQ_DESC_MODE_8812F(x) ((x) & (~BITS_VOQ_DESC_MODE_8812F)) -+#define BIT_GET_VOQ_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_MODE_8812F) & BIT_MASK_VOQ_DESC_MODE_8812F) -+#define BIT_SET_VOQ_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_MODE_8812F(x) | BIT_VOQ_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_VOQ_DESC_NUM_8812F 0 -+#define BIT_MASK_VOQ_DESC_NUM_8812F 0xfff -+#define BIT_VOQ_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_NUM_8812F) << BIT_SHIFT_VOQ_DESC_NUM_8812F) -+#define BITS_VOQ_DESC_NUM_8812F \ -+ (BIT_MASK_VOQ_DESC_NUM_8812F << BIT_SHIFT_VOQ_DESC_NUM_8812F) -+#define BIT_CLEAR_VOQ_DESC_NUM_8812F(x) ((x) & (~BITS_VOQ_DESC_NUM_8812F)) -+#define BIT_GET_VOQ_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_NUM_8812F) & BIT_MASK_VOQ_DESC_NUM_8812F) -+#define BIT_SET_VOQ_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_NUM_8812F(x) | BIT_VOQ_DESC_NUM_8812F(v)) -+ -+/* 2 REG_VIQ_TXBD_NUM_8812F */ -+#define BIT_PCIE_VIQ_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_VIQ_DESC_MODE_8812F 12 -+#define BIT_MASK_VIQ_DESC_MODE_8812F 0x3 -+#define BIT_VIQ_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_MODE_8812F) << BIT_SHIFT_VIQ_DESC_MODE_8812F) -+#define BITS_VIQ_DESC_MODE_8812F \ -+ (BIT_MASK_VIQ_DESC_MODE_8812F << BIT_SHIFT_VIQ_DESC_MODE_8812F) -+#define BIT_CLEAR_VIQ_DESC_MODE_8812F(x) ((x) & (~BITS_VIQ_DESC_MODE_8812F)) -+#define BIT_GET_VIQ_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_MODE_8812F) & BIT_MASK_VIQ_DESC_MODE_8812F) -+#define BIT_SET_VIQ_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_MODE_8812F(x) | BIT_VIQ_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_VIQ_DESC_NUM_8812F 0 -+#define BIT_MASK_VIQ_DESC_NUM_8812F 0xfff -+#define BIT_VIQ_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_NUM_8812F) << BIT_SHIFT_VIQ_DESC_NUM_8812F) -+#define BITS_VIQ_DESC_NUM_8812F \ -+ (BIT_MASK_VIQ_DESC_NUM_8812F << BIT_SHIFT_VIQ_DESC_NUM_8812F) -+#define BIT_CLEAR_VIQ_DESC_NUM_8812F(x) ((x) & (~BITS_VIQ_DESC_NUM_8812F)) -+#define BIT_GET_VIQ_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_NUM_8812F) & BIT_MASK_VIQ_DESC_NUM_8812F) -+#define BIT_SET_VIQ_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_NUM_8812F(x) | BIT_VIQ_DESC_NUM_8812F(v)) -+ -+/* 2 REG_BEQ_TXBD_NUM_8812F */ -+#define BIT_PCIE_BEQ_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_BEQ_DESC_MODE_8812F 12 -+#define BIT_MASK_BEQ_DESC_MODE_8812F 0x3 -+#define BIT_BEQ_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_MODE_8812F) << BIT_SHIFT_BEQ_DESC_MODE_8812F) -+#define BITS_BEQ_DESC_MODE_8812F \ -+ (BIT_MASK_BEQ_DESC_MODE_8812F << BIT_SHIFT_BEQ_DESC_MODE_8812F) -+#define BIT_CLEAR_BEQ_DESC_MODE_8812F(x) ((x) & (~BITS_BEQ_DESC_MODE_8812F)) -+#define BIT_GET_BEQ_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_MODE_8812F) & BIT_MASK_BEQ_DESC_MODE_8812F) -+#define BIT_SET_BEQ_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_MODE_8812F(x) | BIT_BEQ_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_BEQ_DESC_NUM_8812F 0 -+#define BIT_MASK_BEQ_DESC_NUM_8812F 0xfff -+#define BIT_BEQ_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_NUM_8812F) << BIT_SHIFT_BEQ_DESC_NUM_8812F) -+#define BITS_BEQ_DESC_NUM_8812F \ -+ (BIT_MASK_BEQ_DESC_NUM_8812F << BIT_SHIFT_BEQ_DESC_NUM_8812F) -+#define BIT_CLEAR_BEQ_DESC_NUM_8812F(x) ((x) & (~BITS_BEQ_DESC_NUM_8812F)) -+#define BIT_GET_BEQ_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_NUM_8812F) & BIT_MASK_BEQ_DESC_NUM_8812F) -+#define BIT_SET_BEQ_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_NUM_8812F(x) | BIT_BEQ_DESC_NUM_8812F(v)) -+ -+/* 2 REG_BKQ_TXBD_NUM_8812F */ -+#define BIT_PCIE_BKQ_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_BKQ_DESC_MODE_8812F 12 -+#define BIT_MASK_BKQ_DESC_MODE_8812F 0x3 -+#define BIT_BKQ_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_MODE_8812F) << BIT_SHIFT_BKQ_DESC_MODE_8812F) -+#define BITS_BKQ_DESC_MODE_8812F \ -+ (BIT_MASK_BKQ_DESC_MODE_8812F << BIT_SHIFT_BKQ_DESC_MODE_8812F) -+#define BIT_CLEAR_BKQ_DESC_MODE_8812F(x) ((x) & (~BITS_BKQ_DESC_MODE_8812F)) -+#define BIT_GET_BKQ_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_MODE_8812F) & BIT_MASK_BKQ_DESC_MODE_8812F) -+#define BIT_SET_BKQ_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_MODE_8812F(x) | BIT_BKQ_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_BKQ_DESC_NUM_8812F 0 -+#define BIT_MASK_BKQ_DESC_NUM_8812F 0xfff -+#define BIT_BKQ_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_NUM_8812F) << BIT_SHIFT_BKQ_DESC_NUM_8812F) -+#define BITS_BKQ_DESC_NUM_8812F \ -+ (BIT_MASK_BKQ_DESC_NUM_8812F << BIT_SHIFT_BKQ_DESC_NUM_8812F) -+#define BIT_CLEAR_BKQ_DESC_NUM_8812F(x) ((x) & (~BITS_BKQ_DESC_NUM_8812F)) -+#define BIT_GET_BKQ_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_NUM_8812F) & BIT_MASK_BKQ_DESC_NUM_8812F) -+#define BIT_SET_BKQ_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_NUM_8812F(x) | BIT_BKQ_DESC_NUM_8812F(v)) -+ -+/* 2 REG_HI0Q_TXBD_NUM_8812F */ -+#define BIT_HI0Q_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_HI0Q_DESC_MODE_8812F 12 -+#define BIT_MASK_HI0Q_DESC_MODE_8812F 0x3 -+#define BIT_HI0Q_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_MODE_8812F) \ -+ << BIT_SHIFT_HI0Q_DESC_MODE_8812F) -+#define BITS_HI0Q_DESC_MODE_8812F \ -+ (BIT_MASK_HI0Q_DESC_MODE_8812F << BIT_SHIFT_HI0Q_DESC_MODE_8812F) -+#define BIT_CLEAR_HI0Q_DESC_MODE_8812F(x) ((x) & (~BITS_HI0Q_DESC_MODE_8812F)) -+#define BIT_GET_HI0Q_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_MODE_8812F) & \ -+ BIT_MASK_HI0Q_DESC_MODE_8812F) -+#define BIT_SET_HI0Q_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_MODE_8812F(x) | BIT_HI0Q_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_HI0Q_DESC_NUM_8812F 0 -+#define BIT_MASK_HI0Q_DESC_NUM_8812F 0xfff -+#define BIT_HI0Q_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_NUM_8812F) << BIT_SHIFT_HI0Q_DESC_NUM_8812F) -+#define BITS_HI0Q_DESC_NUM_8812F \ -+ (BIT_MASK_HI0Q_DESC_NUM_8812F << BIT_SHIFT_HI0Q_DESC_NUM_8812F) -+#define BIT_CLEAR_HI0Q_DESC_NUM_8812F(x) ((x) & (~BITS_HI0Q_DESC_NUM_8812F)) -+#define BIT_GET_HI0Q_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_NUM_8812F) & BIT_MASK_HI0Q_DESC_NUM_8812F) -+#define BIT_SET_HI0Q_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_NUM_8812F(x) | BIT_HI0Q_DESC_NUM_8812F(v)) -+ -+/* 2 REG_HI1Q_TXBD_NUM_8812F */ -+#define BIT_HI1Q_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_HI1Q_DESC_MODE_8812F 12 -+#define BIT_MASK_HI1Q_DESC_MODE_8812F 0x3 -+#define BIT_HI1Q_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_MODE_8812F) \ -+ << BIT_SHIFT_HI1Q_DESC_MODE_8812F) -+#define BITS_HI1Q_DESC_MODE_8812F \ -+ (BIT_MASK_HI1Q_DESC_MODE_8812F << BIT_SHIFT_HI1Q_DESC_MODE_8812F) -+#define BIT_CLEAR_HI1Q_DESC_MODE_8812F(x) ((x) & (~BITS_HI1Q_DESC_MODE_8812F)) -+#define BIT_GET_HI1Q_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_MODE_8812F) & \ -+ BIT_MASK_HI1Q_DESC_MODE_8812F) -+#define BIT_SET_HI1Q_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_MODE_8812F(x) | BIT_HI1Q_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_HI1Q_DESC_NUM_8812F 0 -+#define BIT_MASK_HI1Q_DESC_NUM_8812F 0xfff -+#define BIT_HI1Q_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_NUM_8812F) << BIT_SHIFT_HI1Q_DESC_NUM_8812F) -+#define BITS_HI1Q_DESC_NUM_8812F \ -+ (BIT_MASK_HI1Q_DESC_NUM_8812F << BIT_SHIFT_HI1Q_DESC_NUM_8812F) -+#define BIT_CLEAR_HI1Q_DESC_NUM_8812F(x) ((x) & (~BITS_HI1Q_DESC_NUM_8812F)) -+#define BIT_GET_HI1Q_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_NUM_8812F) & BIT_MASK_HI1Q_DESC_NUM_8812F) -+#define BIT_SET_HI1Q_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_NUM_8812F(x) | BIT_HI1Q_DESC_NUM_8812F(v)) -+ -+/* 2 REG_HI2Q_TXBD_NUM_8812F */ -+#define BIT_HI2Q_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_HI2Q_DESC_MODE_8812F 12 -+#define BIT_MASK_HI2Q_DESC_MODE_8812F 0x3 -+#define BIT_HI2Q_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_MODE_8812F) \ -+ << BIT_SHIFT_HI2Q_DESC_MODE_8812F) -+#define BITS_HI2Q_DESC_MODE_8812F \ -+ (BIT_MASK_HI2Q_DESC_MODE_8812F << BIT_SHIFT_HI2Q_DESC_MODE_8812F) -+#define BIT_CLEAR_HI2Q_DESC_MODE_8812F(x) ((x) & (~BITS_HI2Q_DESC_MODE_8812F)) -+#define BIT_GET_HI2Q_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_MODE_8812F) & \ -+ BIT_MASK_HI2Q_DESC_MODE_8812F) -+#define BIT_SET_HI2Q_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_MODE_8812F(x) | BIT_HI2Q_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_HI2Q_DESC_NUM_8812F 0 -+#define BIT_MASK_HI2Q_DESC_NUM_8812F 0xfff -+#define BIT_HI2Q_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_NUM_8812F) << BIT_SHIFT_HI2Q_DESC_NUM_8812F) -+#define BITS_HI2Q_DESC_NUM_8812F \ -+ (BIT_MASK_HI2Q_DESC_NUM_8812F << BIT_SHIFT_HI2Q_DESC_NUM_8812F) -+#define BIT_CLEAR_HI2Q_DESC_NUM_8812F(x) ((x) & (~BITS_HI2Q_DESC_NUM_8812F)) -+#define BIT_GET_HI2Q_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_NUM_8812F) & BIT_MASK_HI2Q_DESC_NUM_8812F) -+#define BIT_SET_HI2Q_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_NUM_8812F(x) | BIT_HI2Q_DESC_NUM_8812F(v)) -+ -+/* 2 REG_HI3Q_TXBD_NUM_8812F */ -+#define BIT_HI3Q_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_HI3Q_DESC_MODE_8812F 12 -+#define BIT_MASK_HI3Q_DESC_MODE_8812F 0x3 -+#define BIT_HI3Q_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_MODE_8812F) \ -+ << BIT_SHIFT_HI3Q_DESC_MODE_8812F) -+#define BITS_HI3Q_DESC_MODE_8812F \ -+ (BIT_MASK_HI3Q_DESC_MODE_8812F << BIT_SHIFT_HI3Q_DESC_MODE_8812F) -+#define BIT_CLEAR_HI3Q_DESC_MODE_8812F(x) ((x) & (~BITS_HI3Q_DESC_MODE_8812F)) -+#define BIT_GET_HI3Q_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_MODE_8812F) & \ -+ BIT_MASK_HI3Q_DESC_MODE_8812F) -+#define BIT_SET_HI3Q_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_MODE_8812F(x) | BIT_HI3Q_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_HI3Q_DESC_NUM_8812F 0 -+#define BIT_MASK_HI3Q_DESC_NUM_8812F 0xfff -+#define BIT_HI3Q_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_NUM_8812F) << BIT_SHIFT_HI3Q_DESC_NUM_8812F) -+#define BITS_HI3Q_DESC_NUM_8812F \ -+ (BIT_MASK_HI3Q_DESC_NUM_8812F << BIT_SHIFT_HI3Q_DESC_NUM_8812F) -+#define BIT_CLEAR_HI3Q_DESC_NUM_8812F(x) ((x) & (~BITS_HI3Q_DESC_NUM_8812F)) -+#define BIT_GET_HI3Q_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_NUM_8812F) & BIT_MASK_HI3Q_DESC_NUM_8812F) -+#define BIT_SET_HI3Q_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_NUM_8812F(x) | BIT_HI3Q_DESC_NUM_8812F(v)) -+ -+/* 2 REG_HI4Q_TXBD_NUM_8812F */ -+#define BIT_HI4Q_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_HI4Q_DESC_MODE_8812F 12 -+#define BIT_MASK_HI4Q_DESC_MODE_8812F 0x3 -+#define BIT_HI4Q_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_MODE_8812F) \ -+ << BIT_SHIFT_HI4Q_DESC_MODE_8812F) -+#define BITS_HI4Q_DESC_MODE_8812F \ -+ (BIT_MASK_HI4Q_DESC_MODE_8812F << BIT_SHIFT_HI4Q_DESC_MODE_8812F) -+#define BIT_CLEAR_HI4Q_DESC_MODE_8812F(x) ((x) & (~BITS_HI4Q_DESC_MODE_8812F)) -+#define BIT_GET_HI4Q_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_MODE_8812F) & \ -+ BIT_MASK_HI4Q_DESC_MODE_8812F) -+#define BIT_SET_HI4Q_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_MODE_8812F(x) | BIT_HI4Q_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_HI4Q_DESC_NUM_8812F 0 -+#define BIT_MASK_HI4Q_DESC_NUM_8812F 0xfff -+#define BIT_HI4Q_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_NUM_8812F) << BIT_SHIFT_HI4Q_DESC_NUM_8812F) -+#define BITS_HI4Q_DESC_NUM_8812F \ -+ (BIT_MASK_HI4Q_DESC_NUM_8812F << BIT_SHIFT_HI4Q_DESC_NUM_8812F) -+#define BIT_CLEAR_HI4Q_DESC_NUM_8812F(x) ((x) & (~BITS_HI4Q_DESC_NUM_8812F)) -+#define BIT_GET_HI4Q_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_NUM_8812F) & BIT_MASK_HI4Q_DESC_NUM_8812F) -+#define BIT_SET_HI4Q_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_NUM_8812F(x) | BIT_HI4Q_DESC_NUM_8812F(v)) -+ -+/* 2 REG_HI5Q_TXBD_NUM_8812F */ -+#define BIT_HI5Q_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_HI5Q_DESC_MODE_8812F 12 -+#define BIT_MASK_HI5Q_DESC_MODE_8812F 0x3 -+#define BIT_HI5Q_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_MODE_8812F) \ -+ << BIT_SHIFT_HI5Q_DESC_MODE_8812F) -+#define BITS_HI5Q_DESC_MODE_8812F \ -+ (BIT_MASK_HI5Q_DESC_MODE_8812F << BIT_SHIFT_HI5Q_DESC_MODE_8812F) -+#define BIT_CLEAR_HI5Q_DESC_MODE_8812F(x) ((x) & (~BITS_HI5Q_DESC_MODE_8812F)) -+#define BIT_GET_HI5Q_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_MODE_8812F) & \ -+ BIT_MASK_HI5Q_DESC_MODE_8812F) -+#define BIT_SET_HI5Q_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_MODE_8812F(x) | BIT_HI5Q_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_HI5Q_DESC_NUM_8812F 0 -+#define BIT_MASK_HI5Q_DESC_NUM_8812F 0xfff -+#define BIT_HI5Q_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_NUM_8812F) << BIT_SHIFT_HI5Q_DESC_NUM_8812F) -+#define BITS_HI5Q_DESC_NUM_8812F \ -+ (BIT_MASK_HI5Q_DESC_NUM_8812F << BIT_SHIFT_HI5Q_DESC_NUM_8812F) -+#define BIT_CLEAR_HI5Q_DESC_NUM_8812F(x) ((x) & (~BITS_HI5Q_DESC_NUM_8812F)) -+#define BIT_GET_HI5Q_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_NUM_8812F) & BIT_MASK_HI5Q_DESC_NUM_8812F) -+#define BIT_SET_HI5Q_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_NUM_8812F(x) | BIT_HI5Q_DESC_NUM_8812F(v)) -+ -+/* 2 REG_HI6Q_TXBD_NUM_8812F */ -+#define BIT_HI6Q_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_HI6Q_DESC_MODE_8812F 12 -+#define BIT_MASK_HI6Q_DESC_MODE_8812F 0x3 -+#define BIT_HI6Q_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_MODE_8812F) \ -+ << BIT_SHIFT_HI6Q_DESC_MODE_8812F) -+#define BITS_HI6Q_DESC_MODE_8812F \ -+ (BIT_MASK_HI6Q_DESC_MODE_8812F << BIT_SHIFT_HI6Q_DESC_MODE_8812F) -+#define BIT_CLEAR_HI6Q_DESC_MODE_8812F(x) ((x) & (~BITS_HI6Q_DESC_MODE_8812F)) -+#define BIT_GET_HI6Q_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_MODE_8812F) & \ -+ BIT_MASK_HI6Q_DESC_MODE_8812F) -+#define BIT_SET_HI6Q_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_MODE_8812F(x) | BIT_HI6Q_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_HI6Q_DESC_NUM_8812F 0 -+#define BIT_MASK_HI6Q_DESC_NUM_8812F 0xfff -+#define BIT_HI6Q_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_NUM_8812F) << BIT_SHIFT_HI6Q_DESC_NUM_8812F) -+#define BITS_HI6Q_DESC_NUM_8812F \ -+ (BIT_MASK_HI6Q_DESC_NUM_8812F << BIT_SHIFT_HI6Q_DESC_NUM_8812F) -+#define BIT_CLEAR_HI6Q_DESC_NUM_8812F(x) ((x) & (~BITS_HI6Q_DESC_NUM_8812F)) -+#define BIT_GET_HI6Q_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_NUM_8812F) & BIT_MASK_HI6Q_DESC_NUM_8812F) -+#define BIT_SET_HI6Q_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_NUM_8812F(x) | BIT_HI6Q_DESC_NUM_8812F(v)) -+ -+/* 2 REG_HI7Q_TXBD_NUM_8812F */ -+#define BIT_HI7Q_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_HI7Q_DESC_MODE_8812F 12 -+#define BIT_MASK_HI7Q_DESC_MODE_8812F 0x3 -+#define BIT_HI7Q_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_MODE_8812F) \ -+ << BIT_SHIFT_HI7Q_DESC_MODE_8812F) -+#define BITS_HI7Q_DESC_MODE_8812F \ -+ (BIT_MASK_HI7Q_DESC_MODE_8812F << BIT_SHIFT_HI7Q_DESC_MODE_8812F) -+#define BIT_CLEAR_HI7Q_DESC_MODE_8812F(x) ((x) & (~BITS_HI7Q_DESC_MODE_8812F)) -+#define BIT_GET_HI7Q_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_MODE_8812F) & \ -+ BIT_MASK_HI7Q_DESC_MODE_8812F) -+#define BIT_SET_HI7Q_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_MODE_8812F(x) | BIT_HI7Q_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_HI7Q_DESC_NUM_8812F 0 -+#define BIT_MASK_HI7Q_DESC_NUM_8812F 0xfff -+#define BIT_HI7Q_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_NUM_8812F) << BIT_SHIFT_HI7Q_DESC_NUM_8812F) -+#define BITS_HI7Q_DESC_NUM_8812F \ -+ (BIT_MASK_HI7Q_DESC_NUM_8812F << BIT_SHIFT_HI7Q_DESC_NUM_8812F) -+#define BIT_CLEAR_HI7Q_DESC_NUM_8812F(x) ((x) & (~BITS_HI7Q_DESC_NUM_8812F)) -+#define BIT_GET_HI7Q_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_NUM_8812F) & BIT_MASK_HI7Q_DESC_NUM_8812F) -+#define BIT_SET_HI7Q_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_NUM_8812F(x) | BIT_HI7Q_DESC_NUM_8812F(v)) -+ -+/* 2 REG_TSFTIMER_HCI_8812F */ -+ -+#define BIT_SHIFT_TSFT2_HCI_8812F 16 -+#define BIT_MASK_TSFT2_HCI_8812F 0xffff -+#define BIT_TSFT2_HCI_8812F(x) \ -+ (((x) & BIT_MASK_TSFT2_HCI_8812F) << BIT_SHIFT_TSFT2_HCI_8812F) -+#define BITS_TSFT2_HCI_8812F \ -+ (BIT_MASK_TSFT2_HCI_8812F << BIT_SHIFT_TSFT2_HCI_8812F) -+#define BIT_CLEAR_TSFT2_HCI_8812F(x) ((x) & (~BITS_TSFT2_HCI_8812F)) -+#define BIT_GET_TSFT2_HCI_8812F(x) \ -+ (((x) >> BIT_SHIFT_TSFT2_HCI_8812F) & BIT_MASK_TSFT2_HCI_8812F) -+#define BIT_SET_TSFT2_HCI_8812F(x, v) \ -+ (BIT_CLEAR_TSFT2_HCI_8812F(x) | BIT_TSFT2_HCI_8812F(v)) -+ -+#define BIT_SHIFT_TSFT1_HCI_8812F 0 -+#define BIT_MASK_TSFT1_HCI_8812F 0xffff -+#define BIT_TSFT1_HCI_8812F(x) \ -+ (((x) & BIT_MASK_TSFT1_HCI_8812F) << BIT_SHIFT_TSFT1_HCI_8812F) -+#define BITS_TSFT1_HCI_8812F \ -+ (BIT_MASK_TSFT1_HCI_8812F << BIT_SHIFT_TSFT1_HCI_8812F) -+#define BIT_CLEAR_TSFT1_HCI_8812F(x) ((x) & (~BITS_TSFT1_HCI_8812F)) -+#define BIT_GET_TSFT1_HCI_8812F(x) \ -+ (((x) >> BIT_SHIFT_TSFT1_HCI_8812F) & BIT_MASK_TSFT1_HCI_8812F) -+#define BIT_SET_TSFT1_HCI_8812F(x, v) \ -+ (BIT_CLEAR_TSFT1_HCI_8812F(x) | BIT_TSFT1_HCI_8812F(v)) -+ -+/* 2 REG_BD_RWPTR_CLR_8812F */ -+#define BIT_CLR_HI7Q_HW_IDX_8812F BIT(29) -+#define BIT_CLR_HI6Q_HW_IDX_8812F BIT(28) -+#define BIT_CLR_HI5Q_HW_IDX_8812F BIT(27) -+#define BIT_CLR_HI4Q_HW_IDX_8812F BIT(26) -+#define BIT_CLR_HI3Q_HW_IDX_8812F BIT(25) -+#define BIT_CLR_HI2Q_HW_IDX_8812F BIT(24) -+#define BIT_CLR_HI1Q_HW_IDX_8812F BIT(23) -+#define BIT_CLR_HI0Q_HW_IDX_8812F BIT(22) -+#define BIT_CLR_BKQ_HW_IDX_8812F BIT(21) -+#define BIT_CLR_BEQ_HW_IDX_8812F BIT(20) -+#define BIT_CLR_VIQ_HW_IDX_8812F BIT(19) -+#define BIT_CLR_VOQ_HW_IDX_8812F BIT(18) -+#define BIT_CLR_MGQ_HW_IDX_8812F BIT(17) -+#define BIT_CLR_RXQ_HW_IDX_8812F BIT(16) -+#define BIT_CLR_HI7Q_HOST_IDX_8812F BIT(13) -+#define BIT_CLR_HI6Q_HOST_IDX_8812F BIT(12) -+#define BIT_CLR_HI5Q_HOST_IDX_8812F BIT(11) -+#define BIT_CLR_HI4Q_HOST_IDX_8812F BIT(10) -+#define BIT_CLR_HI3Q_HOST_IDX_8812F BIT(9) -+#define BIT_CLR_HI2Q_HOST_IDX_8812F BIT(8) -+#define BIT_CLR_HI1Q_HOST_IDX_8812F BIT(7) -+#define BIT_CLR_HI0Q_HOST_IDX_8812F BIT(6) -+#define BIT_CLR_BKQ_HOST_IDX_8812F BIT(5) -+#define BIT_CLR_BEQ_HOST_IDX_8812F BIT(4) -+#define BIT_CLR_VIQ_HOST_IDX_8812F BIT(3) -+#define BIT_CLR_VOQ_HOST_IDX_8812F BIT(2) -+#define BIT_CLR_MGQ_HOST_IDX_8812F BIT(1) -+#define BIT_CLR_RXQ_HOST_IDX_8812F BIT(0) -+ -+/* 2 REG_VOQ_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_VOQ_HW_IDX_8812F 16 -+#define BIT_MASK_VOQ_HW_IDX_8812F 0xfff -+#define BIT_VOQ_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_VOQ_HW_IDX_8812F) << BIT_SHIFT_VOQ_HW_IDX_8812F) -+#define BITS_VOQ_HW_IDX_8812F \ -+ (BIT_MASK_VOQ_HW_IDX_8812F << BIT_SHIFT_VOQ_HW_IDX_8812F) -+#define BIT_CLEAR_VOQ_HW_IDX_8812F(x) ((x) & (~BITS_VOQ_HW_IDX_8812F)) -+#define BIT_GET_VOQ_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HW_IDX_8812F) & BIT_MASK_VOQ_HW_IDX_8812F) -+#define BIT_SET_VOQ_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_VOQ_HW_IDX_8812F(x) | BIT_VOQ_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_VOQ_HOST_IDX_8812F 0 -+#define BIT_MASK_VOQ_HOST_IDX_8812F 0xfff -+#define BIT_VOQ_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_VOQ_HOST_IDX_8812F) << BIT_SHIFT_VOQ_HOST_IDX_8812F) -+#define BITS_VOQ_HOST_IDX_8812F \ -+ (BIT_MASK_VOQ_HOST_IDX_8812F << BIT_SHIFT_VOQ_HOST_IDX_8812F) -+#define BIT_CLEAR_VOQ_HOST_IDX_8812F(x) ((x) & (~BITS_VOQ_HOST_IDX_8812F)) -+#define BIT_GET_VOQ_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HOST_IDX_8812F) & BIT_MASK_VOQ_HOST_IDX_8812F) -+#define BIT_SET_VOQ_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_VOQ_HOST_IDX_8812F(x) | BIT_VOQ_HOST_IDX_8812F(v)) -+ -+/* 2 REG_VIQ_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_VIQ_HW_IDX_8812F 16 -+#define BIT_MASK_VIQ_HW_IDX_8812F 0xfff -+#define BIT_VIQ_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_VIQ_HW_IDX_8812F) << BIT_SHIFT_VIQ_HW_IDX_8812F) -+#define BITS_VIQ_HW_IDX_8812F \ -+ (BIT_MASK_VIQ_HW_IDX_8812F << BIT_SHIFT_VIQ_HW_IDX_8812F) -+#define BIT_CLEAR_VIQ_HW_IDX_8812F(x) ((x) & (~BITS_VIQ_HW_IDX_8812F)) -+#define BIT_GET_VIQ_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HW_IDX_8812F) & BIT_MASK_VIQ_HW_IDX_8812F) -+#define BIT_SET_VIQ_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_VIQ_HW_IDX_8812F(x) | BIT_VIQ_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_VIQ_HOST_IDX_8812F 0 -+#define BIT_MASK_VIQ_HOST_IDX_8812F 0xfff -+#define BIT_VIQ_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_VIQ_HOST_IDX_8812F) << BIT_SHIFT_VIQ_HOST_IDX_8812F) -+#define BITS_VIQ_HOST_IDX_8812F \ -+ (BIT_MASK_VIQ_HOST_IDX_8812F << BIT_SHIFT_VIQ_HOST_IDX_8812F) -+#define BIT_CLEAR_VIQ_HOST_IDX_8812F(x) ((x) & (~BITS_VIQ_HOST_IDX_8812F)) -+#define BIT_GET_VIQ_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HOST_IDX_8812F) & BIT_MASK_VIQ_HOST_IDX_8812F) -+#define BIT_SET_VIQ_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_VIQ_HOST_IDX_8812F(x) | BIT_VIQ_HOST_IDX_8812F(v)) -+ -+/* 2 REG_BEQ_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_BEQ_HW_IDX_8812F 16 -+#define BIT_MASK_BEQ_HW_IDX_8812F 0xfff -+#define BIT_BEQ_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_BEQ_HW_IDX_8812F) << BIT_SHIFT_BEQ_HW_IDX_8812F) -+#define BITS_BEQ_HW_IDX_8812F \ -+ (BIT_MASK_BEQ_HW_IDX_8812F << BIT_SHIFT_BEQ_HW_IDX_8812F) -+#define BIT_CLEAR_BEQ_HW_IDX_8812F(x) ((x) & (~BITS_BEQ_HW_IDX_8812F)) -+#define BIT_GET_BEQ_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HW_IDX_8812F) & BIT_MASK_BEQ_HW_IDX_8812F) -+#define BIT_SET_BEQ_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_BEQ_HW_IDX_8812F(x) | BIT_BEQ_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_BEQ_HOST_IDX_8812F 0 -+#define BIT_MASK_BEQ_HOST_IDX_8812F 0xfff -+#define BIT_BEQ_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_BEQ_HOST_IDX_8812F) << BIT_SHIFT_BEQ_HOST_IDX_8812F) -+#define BITS_BEQ_HOST_IDX_8812F \ -+ (BIT_MASK_BEQ_HOST_IDX_8812F << BIT_SHIFT_BEQ_HOST_IDX_8812F) -+#define BIT_CLEAR_BEQ_HOST_IDX_8812F(x) ((x) & (~BITS_BEQ_HOST_IDX_8812F)) -+#define BIT_GET_BEQ_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HOST_IDX_8812F) & BIT_MASK_BEQ_HOST_IDX_8812F) -+#define BIT_SET_BEQ_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_BEQ_HOST_IDX_8812F(x) | BIT_BEQ_HOST_IDX_8812F(v)) -+ -+/* 2 REG_BKQ_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_BKQ_HW_IDX_8812F 16 -+#define BIT_MASK_BKQ_HW_IDX_8812F 0xfff -+#define BIT_BKQ_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_BKQ_HW_IDX_8812F) << BIT_SHIFT_BKQ_HW_IDX_8812F) -+#define BITS_BKQ_HW_IDX_8812F \ -+ (BIT_MASK_BKQ_HW_IDX_8812F << BIT_SHIFT_BKQ_HW_IDX_8812F) -+#define BIT_CLEAR_BKQ_HW_IDX_8812F(x) ((x) & (~BITS_BKQ_HW_IDX_8812F)) -+#define BIT_GET_BKQ_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HW_IDX_8812F) & BIT_MASK_BKQ_HW_IDX_8812F) -+#define BIT_SET_BKQ_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_BKQ_HW_IDX_8812F(x) | BIT_BKQ_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_BKQ_HOST_IDX_8812F 0 -+#define BIT_MASK_BKQ_HOST_IDX_8812F 0xfff -+#define BIT_BKQ_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_BKQ_HOST_IDX_8812F) << BIT_SHIFT_BKQ_HOST_IDX_8812F) -+#define BITS_BKQ_HOST_IDX_8812F \ -+ (BIT_MASK_BKQ_HOST_IDX_8812F << BIT_SHIFT_BKQ_HOST_IDX_8812F) -+#define BIT_CLEAR_BKQ_HOST_IDX_8812F(x) ((x) & (~BITS_BKQ_HOST_IDX_8812F)) -+#define BIT_GET_BKQ_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HOST_IDX_8812F) & BIT_MASK_BKQ_HOST_IDX_8812F) -+#define BIT_SET_BKQ_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_BKQ_HOST_IDX_8812F(x) | BIT_BKQ_HOST_IDX_8812F(v)) -+ -+/* 2 REG_MGQ_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_MGQ_HW_IDX_8812F 16 -+#define BIT_MASK_MGQ_HW_IDX_8812F 0xfff -+#define BIT_MGQ_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_HW_IDX_8812F) << BIT_SHIFT_MGQ_HW_IDX_8812F) -+#define BITS_MGQ_HW_IDX_8812F \ -+ (BIT_MASK_MGQ_HW_IDX_8812F << BIT_SHIFT_MGQ_HW_IDX_8812F) -+#define BIT_CLEAR_MGQ_HW_IDX_8812F(x) ((x) & (~BITS_MGQ_HW_IDX_8812F)) -+#define BIT_GET_MGQ_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HW_IDX_8812F) & BIT_MASK_MGQ_HW_IDX_8812F) -+#define BIT_SET_MGQ_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_HW_IDX_8812F(x) | BIT_MGQ_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_MGQ_HOST_IDX_8812F 0 -+#define BIT_MASK_MGQ_HOST_IDX_8812F 0xfff -+#define BIT_MGQ_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_HOST_IDX_8812F) << BIT_SHIFT_MGQ_HOST_IDX_8812F) -+#define BITS_MGQ_HOST_IDX_8812F \ -+ (BIT_MASK_MGQ_HOST_IDX_8812F << BIT_SHIFT_MGQ_HOST_IDX_8812F) -+#define BIT_CLEAR_MGQ_HOST_IDX_8812F(x) ((x) & (~BITS_MGQ_HOST_IDX_8812F)) -+#define BIT_GET_MGQ_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HOST_IDX_8812F) & BIT_MASK_MGQ_HOST_IDX_8812F) -+#define BIT_SET_MGQ_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_HOST_IDX_8812F(x) | BIT_MGQ_HOST_IDX_8812F(v)) -+ -+/* 2 REG_RXQ_RXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_RXQ_HW_IDX_8812F 16 -+#define BIT_MASK_RXQ_HW_IDX_8812F 0xfff -+#define BIT_RXQ_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_RXQ_HW_IDX_8812F) << BIT_SHIFT_RXQ_HW_IDX_8812F) -+#define BITS_RXQ_HW_IDX_8812F \ -+ (BIT_MASK_RXQ_HW_IDX_8812F << BIT_SHIFT_RXQ_HW_IDX_8812F) -+#define BIT_CLEAR_RXQ_HW_IDX_8812F(x) ((x) & (~BITS_RXQ_HW_IDX_8812F)) -+#define BIT_GET_RXQ_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HW_IDX_8812F) & BIT_MASK_RXQ_HW_IDX_8812F) -+#define BIT_SET_RXQ_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_RXQ_HW_IDX_8812F(x) | BIT_RXQ_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_RXQ_HOST_IDX_8812F 0 -+#define BIT_MASK_RXQ_HOST_IDX_8812F 0xfff -+#define BIT_RXQ_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_RXQ_HOST_IDX_8812F) << BIT_SHIFT_RXQ_HOST_IDX_8812F) -+#define BITS_RXQ_HOST_IDX_8812F \ -+ (BIT_MASK_RXQ_HOST_IDX_8812F << BIT_SHIFT_RXQ_HOST_IDX_8812F) -+#define BIT_CLEAR_RXQ_HOST_IDX_8812F(x) ((x) & (~BITS_RXQ_HOST_IDX_8812F)) -+#define BIT_GET_RXQ_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HOST_IDX_8812F) & BIT_MASK_RXQ_HOST_IDX_8812F) -+#define BIT_SET_RXQ_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_RXQ_HOST_IDX_8812F(x) | BIT_RXQ_HOST_IDX_8812F(v)) -+ -+/* 2 REG_HI0Q_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_HI0Q_HW_IDX_8812F 16 -+#define BIT_MASK_HI0Q_HW_IDX_8812F 0xfff -+#define BIT_HI0Q_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI0Q_HW_IDX_8812F) << BIT_SHIFT_HI0Q_HW_IDX_8812F) -+#define BITS_HI0Q_HW_IDX_8812F \ -+ (BIT_MASK_HI0Q_HW_IDX_8812F << BIT_SHIFT_HI0Q_HW_IDX_8812F) -+#define BIT_CLEAR_HI0Q_HW_IDX_8812F(x) ((x) & (~BITS_HI0Q_HW_IDX_8812F)) -+#define BIT_GET_HI0Q_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HW_IDX_8812F) & BIT_MASK_HI0Q_HW_IDX_8812F) -+#define BIT_SET_HI0Q_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI0Q_HW_IDX_8812F(x) | BIT_HI0Q_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_HI0Q_HOST_IDX_8812F 0 -+#define BIT_MASK_HI0Q_HOST_IDX_8812F 0xfff -+#define BIT_HI0Q_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI0Q_HOST_IDX_8812F) << BIT_SHIFT_HI0Q_HOST_IDX_8812F) -+#define BITS_HI0Q_HOST_IDX_8812F \ -+ (BIT_MASK_HI0Q_HOST_IDX_8812F << BIT_SHIFT_HI0Q_HOST_IDX_8812F) -+#define BIT_CLEAR_HI0Q_HOST_IDX_8812F(x) ((x) & (~BITS_HI0Q_HOST_IDX_8812F)) -+#define BIT_GET_HI0Q_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HOST_IDX_8812F) & BIT_MASK_HI0Q_HOST_IDX_8812F) -+#define BIT_SET_HI0Q_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI0Q_HOST_IDX_8812F(x) | BIT_HI0Q_HOST_IDX_8812F(v)) -+ -+/* 2 REG_HI1Q_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_HI1Q_HW_IDX_8812F 16 -+#define BIT_MASK_HI1Q_HW_IDX_8812F 0xfff -+#define BIT_HI1Q_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI1Q_HW_IDX_8812F) << BIT_SHIFT_HI1Q_HW_IDX_8812F) -+#define BITS_HI1Q_HW_IDX_8812F \ -+ (BIT_MASK_HI1Q_HW_IDX_8812F << BIT_SHIFT_HI1Q_HW_IDX_8812F) -+#define BIT_CLEAR_HI1Q_HW_IDX_8812F(x) ((x) & (~BITS_HI1Q_HW_IDX_8812F)) -+#define BIT_GET_HI1Q_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HW_IDX_8812F) & BIT_MASK_HI1Q_HW_IDX_8812F) -+#define BIT_SET_HI1Q_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI1Q_HW_IDX_8812F(x) | BIT_HI1Q_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_HI1Q_HOST_IDX_8812F 0 -+#define BIT_MASK_HI1Q_HOST_IDX_8812F 0xfff -+#define BIT_HI1Q_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI1Q_HOST_IDX_8812F) << BIT_SHIFT_HI1Q_HOST_IDX_8812F) -+#define BITS_HI1Q_HOST_IDX_8812F \ -+ (BIT_MASK_HI1Q_HOST_IDX_8812F << BIT_SHIFT_HI1Q_HOST_IDX_8812F) -+#define BIT_CLEAR_HI1Q_HOST_IDX_8812F(x) ((x) & (~BITS_HI1Q_HOST_IDX_8812F)) -+#define BIT_GET_HI1Q_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HOST_IDX_8812F) & BIT_MASK_HI1Q_HOST_IDX_8812F) -+#define BIT_SET_HI1Q_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI1Q_HOST_IDX_8812F(x) | BIT_HI1Q_HOST_IDX_8812F(v)) -+ -+/* 2 REG_HI2Q_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_HI2Q_HW_IDX_8812F 16 -+#define BIT_MASK_HI2Q_HW_IDX_8812F 0xfff -+#define BIT_HI2Q_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI2Q_HW_IDX_8812F) << BIT_SHIFT_HI2Q_HW_IDX_8812F) -+#define BITS_HI2Q_HW_IDX_8812F \ -+ (BIT_MASK_HI2Q_HW_IDX_8812F << BIT_SHIFT_HI2Q_HW_IDX_8812F) -+#define BIT_CLEAR_HI2Q_HW_IDX_8812F(x) ((x) & (~BITS_HI2Q_HW_IDX_8812F)) -+#define BIT_GET_HI2Q_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HW_IDX_8812F) & BIT_MASK_HI2Q_HW_IDX_8812F) -+#define BIT_SET_HI2Q_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI2Q_HW_IDX_8812F(x) | BIT_HI2Q_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_HI2Q_HOST_IDX_8812F 0 -+#define BIT_MASK_HI2Q_HOST_IDX_8812F 0xfff -+#define BIT_HI2Q_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI2Q_HOST_IDX_8812F) << BIT_SHIFT_HI2Q_HOST_IDX_8812F) -+#define BITS_HI2Q_HOST_IDX_8812F \ -+ (BIT_MASK_HI2Q_HOST_IDX_8812F << BIT_SHIFT_HI2Q_HOST_IDX_8812F) -+#define BIT_CLEAR_HI2Q_HOST_IDX_8812F(x) ((x) & (~BITS_HI2Q_HOST_IDX_8812F)) -+#define BIT_GET_HI2Q_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HOST_IDX_8812F) & BIT_MASK_HI2Q_HOST_IDX_8812F) -+#define BIT_SET_HI2Q_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI2Q_HOST_IDX_8812F(x) | BIT_HI2Q_HOST_IDX_8812F(v)) -+ -+/* 2 REG_HI3Q_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_HI3Q_HW_IDX_8812F 16 -+#define BIT_MASK_HI3Q_HW_IDX_8812F 0xfff -+#define BIT_HI3Q_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI3Q_HW_IDX_8812F) << BIT_SHIFT_HI3Q_HW_IDX_8812F) -+#define BITS_HI3Q_HW_IDX_8812F \ -+ (BIT_MASK_HI3Q_HW_IDX_8812F << BIT_SHIFT_HI3Q_HW_IDX_8812F) -+#define BIT_CLEAR_HI3Q_HW_IDX_8812F(x) ((x) & (~BITS_HI3Q_HW_IDX_8812F)) -+#define BIT_GET_HI3Q_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HW_IDX_8812F) & BIT_MASK_HI3Q_HW_IDX_8812F) -+#define BIT_SET_HI3Q_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI3Q_HW_IDX_8812F(x) | BIT_HI3Q_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_HI3Q_HOST_IDX_8812F 0 -+#define BIT_MASK_HI3Q_HOST_IDX_8812F 0xfff -+#define BIT_HI3Q_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI3Q_HOST_IDX_8812F) << BIT_SHIFT_HI3Q_HOST_IDX_8812F) -+#define BITS_HI3Q_HOST_IDX_8812F \ -+ (BIT_MASK_HI3Q_HOST_IDX_8812F << BIT_SHIFT_HI3Q_HOST_IDX_8812F) -+#define BIT_CLEAR_HI3Q_HOST_IDX_8812F(x) ((x) & (~BITS_HI3Q_HOST_IDX_8812F)) -+#define BIT_GET_HI3Q_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HOST_IDX_8812F) & BIT_MASK_HI3Q_HOST_IDX_8812F) -+#define BIT_SET_HI3Q_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI3Q_HOST_IDX_8812F(x) | BIT_HI3Q_HOST_IDX_8812F(v)) -+ -+/* 2 REG_HI4Q_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_HI4Q_HW_IDX_8812F 16 -+#define BIT_MASK_HI4Q_HW_IDX_8812F 0xfff -+#define BIT_HI4Q_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI4Q_HW_IDX_8812F) << BIT_SHIFT_HI4Q_HW_IDX_8812F) -+#define BITS_HI4Q_HW_IDX_8812F \ -+ (BIT_MASK_HI4Q_HW_IDX_8812F << BIT_SHIFT_HI4Q_HW_IDX_8812F) -+#define BIT_CLEAR_HI4Q_HW_IDX_8812F(x) ((x) & (~BITS_HI4Q_HW_IDX_8812F)) -+#define BIT_GET_HI4Q_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HW_IDX_8812F) & BIT_MASK_HI4Q_HW_IDX_8812F) -+#define BIT_SET_HI4Q_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI4Q_HW_IDX_8812F(x) | BIT_HI4Q_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_HI4Q_HOST_IDX_8812F 0 -+#define BIT_MASK_HI4Q_HOST_IDX_8812F 0xfff -+#define BIT_HI4Q_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI4Q_HOST_IDX_8812F) << BIT_SHIFT_HI4Q_HOST_IDX_8812F) -+#define BITS_HI4Q_HOST_IDX_8812F \ -+ (BIT_MASK_HI4Q_HOST_IDX_8812F << BIT_SHIFT_HI4Q_HOST_IDX_8812F) -+#define BIT_CLEAR_HI4Q_HOST_IDX_8812F(x) ((x) & (~BITS_HI4Q_HOST_IDX_8812F)) -+#define BIT_GET_HI4Q_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HOST_IDX_8812F) & BIT_MASK_HI4Q_HOST_IDX_8812F) -+#define BIT_SET_HI4Q_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI4Q_HOST_IDX_8812F(x) | BIT_HI4Q_HOST_IDX_8812F(v)) -+ -+/* 2 REG_HI5Q_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_HI5Q_HW_IDX_8812F 16 -+#define BIT_MASK_HI5Q_HW_IDX_8812F 0xfff -+#define BIT_HI5Q_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI5Q_HW_IDX_8812F) << BIT_SHIFT_HI5Q_HW_IDX_8812F) -+#define BITS_HI5Q_HW_IDX_8812F \ -+ (BIT_MASK_HI5Q_HW_IDX_8812F << BIT_SHIFT_HI5Q_HW_IDX_8812F) -+#define BIT_CLEAR_HI5Q_HW_IDX_8812F(x) ((x) & (~BITS_HI5Q_HW_IDX_8812F)) -+#define BIT_GET_HI5Q_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HW_IDX_8812F) & BIT_MASK_HI5Q_HW_IDX_8812F) -+#define BIT_SET_HI5Q_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI5Q_HW_IDX_8812F(x) | BIT_HI5Q_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_HI5Q_HOST_IDX_8812F 0 -+#define BIT_MASK_HI5Q_HOST_IDX_8812F 0xfff -+#define BIT_HI5Q_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI5Q_HOST_IDX_8812F) << BIT_SHIFT_HI5Q_HOST_IDX_8812F) -+#define BITS_HI5Q_HOST_IDX_8812F \ -+ (BIT_MASK_HI5Q_HOST_IDX_8812F << BIT_SHIFT_HI5Q_HOST_IDX_8812F) -+#define BIT_CLEAR_HI5Q_HOST_IDX_8812F(x) ((x) & (~BITS_HI5Q_HOST_IDX_8812F)) -+#define BIT_GET_HI5Q_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HOST_IDX_8812F) & BIT_MASK_HI5Q_HOST_IDX_8812F) -+#define BIT_SET_HI5Q_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI5Q_HOST_IDX_8812F(x) | BIT_HI5Q_HOST_IDX_8812F(v)) -+ -+/* 2 REG_HI6Q_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_HI6Q_HW_IDX_8812F 16 -+#define BIT_MASK_HI6Q_HW_IDX_8812F 0xfff -+#define BIT_HI6Q_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI6Q_HW_IDX_8812F) << BIT_SHIFT_HI6Q_HW_IDX_8812F) -+#define BITS_HI6Q_HW_IDX_8812F \ -+ (BIT_MASK_HI6Q_HW_IDX_8812F << BIT_SHIFT_HI6Q_HW_IDX_8812F) -+#define BIT_CLEAR_HI6Q_HW_IDX_8812F(x) ((x) & (~BITS_HI6Q_HW_IDX_8812F)) -+#define BIT_GET_HI6Q_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HW_IDX_8812F) & BIT_MASK_HI6Q_HW_IDX_8812F) -+#define BIT_SET_HI6Q_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI6Q_HW_IDX_8812F(x) | BIT_HI6Q_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_HI6Q_HOST_IDX_8812F 0 -+#define BIT_MASK_HI6Q_HOST_IDX_8812F 0xfff -+#define BIT_HI6Q_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI6Q_HOST_IDX_8812F) << BIT_SHIFT_HI6Q_HOST_IDX_8812F) -+#define BITS_HI6Q_HOST_IDX_8812F \ -+ (BIT_MASK_HI6Q_HOST_IDX_8812F << BIT_SHIFT_HI6Q_HOST_IDX_8812F) -+#define BIT_CLEAR_HI6Q_HOST_IDX_8812F(x) ((x) & (~BITS_HI6Q_HOST_IDX_8812F)) -+#define BIT_GET_HI6Q_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HOST_IDX_8812F) & BIT_MASK_HI6Q_HOST_IDX_8812F) -+#define BIT_SET_HI6Q_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI6Q_HOST_IDX_8812F(x) | BIT_HI6Q_HOST_IDX_8812F(v)) -+ -+/* 2 REG_HI7Q_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_HI7Q_HW_IDX_8812F 16 -+#define BIT_MASK_HI7Q_HW_IDX_8812F 0xfff -+#define BIT_HI7Q_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI7Q_HW_IDX_8812F) << BIT_SHIFT_HI7Q_HW_IDX_8812F) -+#define BITS_HI7Q_HW_IDX_8812F \ -+ (BIT_MASK_HI7Q_HW_IDX_8812F << BIT_SHIFT_HI7Q_HW_IDX_8812F) -+#define BIT_CLEAR_HI7Q_HW_IDX_8812F(x) ((x) & (~BITS_HI7Q_HW_IDX_8812F)) -+#define BIT_GET_HI7Q_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HW_IDX_8812F) & BIT_MASK_HI7Q_HW_IDX_8812F) -+#define BIT_SET_HI7Q_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI7Q_HW_IDX_8812F(x) | BIT_HI7Q_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_HI7Q_HOST_IDX_8812F 0 -+#define BIT_MASK_HI7Q_HOST_IDX_8812F 0xfff -+#define BIT_HI7Q_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HI7Q_HOST_IDX_8812F) << BIT_SHIFT_HI7Q_HOST_IDX_8812F) -+#define BITS_HI7Q_HOST_IDX_8812F \ -+ (BIT_MASK_HI7Q_HOST_IDX_8812F << BIT_SHIFT_HI7Q_HOST_IDX_8812F) -+#define BIT_CLEAR_HI7Q_HOST_IDX_8812F(x) ((x) & (~BITS_HI7Q_HOST_IDX_8812F)) -+#define BIT_GET_HI7Q_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HOST_IDX_8812F) & BIT_MASK_HI7Q_HOST_IDX_8812F) -+#define BIT_SET_HI7Q_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HI7Q_HOST_IDX_8812F(x) | BIT_HI7Q_HOST_IDX_8812F(v)) -+ -+/* 2 REG_DBG_SEL_V1_8812F */ -+ -+#define BIT_SHIFT_DBG_SEL_8812F 0 -+#define BIT_MASK_DBG_SEL_8812F 0xff -+#define BIT_DBG_SEL_8812F(x) \ -+ (((x) & BIT_MASK_DBG_SEL_8812F) << BIT_SHIFT_DBG_SEL_8812F) -+#define BITS_DBG_SEL_8812F (BIT_MASK_DBG_SEL_8812F << BIT_SHIFT_DBG_SEL_8812F) -+#define BIT_CLEAR_DBG_SEL_8812F(x) ((x) & (~BITS_DBG_SEL_8812F)) -+#define BIT_GET_DBG_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_8812F) & BIT_MASK_DBG_SEL_8812F) -+#define BIT_SET_DBG_SEL_8812F(x, v) \ -+ (BIT_CLEAR_DBG_SEL_8812F(x) | BIT_DBG_SEL_8812F(v)) -+ -+/* 2 REG_PCIE_HRPWM1_V1_8812F */ -+ -+#define BIT_SHIFT_PCIE_HRPWM_8812F 0 -+#define BIT_MASK_PCIE_HRPWM_8812F 0xff -+#define BIT_PCIE_HRPWM_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM_8812F) << BIT_SHIFT_PCIE_HRPWM_8812F) -+#define BITS_PCIE_HRPWM_8812F \ -+ (BIT_MASK_PCIE_HRPWM_8812F << BIT_SHIFT_PCIE_HRPWM_8812F) -+#define BIT_CLEAR_PCIE_HRPWM_8812F(x) ((x) & (~BITS_PCIE_HRPWM_8812F)) -+#define BIT_GET_PCIE_HRPWM_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM_8812F) & BIT_MASK_PCIE_HRPWM_8812F) -+#define BIT_SET_PCIE_HRPWM_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM_8812F(x) | BIT_PCIE_HRPWM_8812F(v)) -+ -+/* 2 REG_PCIE_HCPWM1_V1_8812F */ -+ -+#define BIT_SHIFT_PCIE_HCPWM_8812F 0 -+#define BIT_MASK_PCIE_HCPWM_8812F 0xff -+#define BIT_PCIE_HCPWM_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM_8812F) << BIT_SHIFT_PCIE_HCPWM_8812F) -+#define BITS_PCIE_HCPWM_8812F \ -+ (BIT_MASK_PCIE_HCPWM_8812F << BIT_SHIFT_PCIE_HCPWM_8812F) -+#define BIT_CLEAR_PCIE_HCPWM_8812F(x) ((x) & (~BITS_PCIE_HCPWM_8812F)) -+#define BIT_GET_PCIE_HCPWM_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM_8812F) & BIT_MASK_PCIE_HCPWM_8812F) -+#define BIT_SET_PCIE_HCPWM_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM_8812F(x) | BIT_PCIE_HCPWM_8812F(v)) -+ -+/* 2 REG_PCIE_CTRL2_8812F */ -+#define BIT_DIS_TXDMA_PRE_8812F BIT(7) -+#define BIT_DIS_RXDMA_PRE_8812F BIT(6) -+ -+#define BIT_SHIFT_HPS_CLKR_PCIE_8812F 4 -+#define BIT_MASK_HPS_CLKR_PCIE_8812F 0x3 -+#define BIT_HPS_CLKR_PCIE_8812F(x) \ -+ (((x) & BIT_MASK_HPS_CLKR_PCIE_8812F) << BIT_SHIFT_HPS_CLKR_PCIE_8812F) -+#define BITS_HPS_CLKR_PCIE_8812F \ -+ (BIT_MASK_HPS_CLKR_PCIE_8812F << BIT_SHIFT_HPS_CLKR_PCIE_8812F) -+#define BIT_CLEAR_HPS_CLKR_PCIE_8812F(x) ((x) & (~BITS_HPS_CLKR_PCIE_8812F)) -+#define BIT_GET_HPS_CLKR_PCIE_8812F(x) \ -+ (((x) >> BIT_SHIFT_HPS_CLKR_PCIE_8812F) & BIT_MASK_HPS_CLKR_PCIE_8812F) -+#define BIT_SET_HPS_CLKR_PCIE_8812F(x, v) \ -+ (BIT_CLEAR_HPS_CLKR_PCIE_8812F(x) | BIT_HPS_CLKR_PCIE_8812F(v)) -+ -+#define BIT_PCIE_INT_8812F BIT(3) -+#define BIT_TXFLAG_EXIT_L1_EN_8812F BIT(2) -+#define BIT_EN_RXDMA_ALIGN_8812F BIT(1) -+#define BIT_EN_TXDMA_ALIGN_8812F BIT(0) -+ -+/* 2 REG_PCIE_HRPWM2_V1_8812F */ -+ -+#define BIT_SHIFT_PCIE_HRPWM2_8812F 0 -+#define BIT_MASK_PCIE_HRPWM2_8812F 0xffff -+#define BIT_PCIE_HRPWM2_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM2_8812F) << BIT_SHIFT_PCIE_HRPWM2_8812F) -+#define BITS_PCIE_HRPWM2_8812F \ -+ (BIT_MASK_PCIE_HRPWM2_8812F << BIT_SHIFT_PCIE_HRPWM2_8812F) -+#define BIT_CLEAR_PCIE_HRPWM2_8812F(x) ((x) & (~BITS_PCIE_HRPWM2_8812F)) -+#define BIT_GET_PCIE_HRPWM2_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM2_8812F) & BIT_MASK_PCIE_HRPWM2_8812F) -+#define BIT_SET_PCIE_HRPWM2_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM2_8812F(x) | BIT_PCIE_HRPWM2_8812F(v)) -+ -+/* 2 REG_PCIE_HCPWM2_V1_8812F */ -+ -+#define BIT_SHIFT_PCIE_HCPWM2_8812F 0 -+#define BIT_MASK_PCIE_HCPWM2_8812F 0xffff -+#define BIT_PCIE_HCPWM2_8812F(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM2_8812F) << BIT_SHIFT_PCIE_HCPWM2_8812F) -+#define BITS_PCIE_HCPWM2_8812F \ -+ (BIT_MASK_PCIE_HCPWM2_8812F << BIT_SHIFT_PCIE_HCPWM2_8812F) -+#define BIT_CLEAR_PCIE_HCPWM2_8812F(x) ((x) & (~BITS_PCIE_HCPWM2_8812F)) -+#define BIT_GET_PCIE_HCPWM2_8812F(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM2_8812F) & BIT_MASK_PCIE_HCPWM2_8812F) -+#define BIT_SET_PCIE_HCPWM2_8812F(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM2_8812F(x) | BIT_PCIE_HCPWM2_8812F(v)) -+ -+/* 2 REG_PCIE_H2C_MSG_V1_8812F */ -+ -+#define BIT_SHIFT_DRV2FW_INFO_8812F 0 -+#define BIT_MASK_DRV2FW_INFO_8812F 0xffffffffL -+#define BIT_DRV2FW_INFO_8812F(x) \ -+ (((x) & BIT_MASK_DRV2FW_INFO_8812F) << BIT_SHIFT_DRV2FW_INFO_8812F) -+#define BITS_DRV2FW_INFO_8812F \ -+ (BIT_MASK_DRV2FW_INFO_8812F << BIT_SHIFT_DRV2FW_INFO_8812F) -+#define BIT_CLEAR_DRV2FW_INFO_8812F(x) ((x) & (~BITS_DRV2FW_INFO_8812F)) -+#define BIT_GET_DRV2FW_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_DRV2FW_INFO_8812F) & BIT_MASK_DRV2FW_INFO_8812F) -+#define BIT_SET_DRV2FW_INFO_8812F(x, v) \ -+ (BIT_CLEAR_DRV2FW_INFO_8812F(x) | BIT_DRV2FW_INFO_8812F(v)) -+ -+/* 2 REG_PCIE_C2H_MSG_V1_8812F */ -+ -+#define BIT_SHIFT_HCI_PCIE_C2H_MSG_8812F 0 -+#define BIT_MASK_HCI_PCIE_C2H_MSG_8812F 0xffffffffL -+#define BIT_HCI_PCIE_C2H_MSG_8812F(x) \ -+ (((x) & BIT_MASK_HCI_PCIE_C2H_MSG_8812F) \ -+ << BIT_SHIFT_HCI_PCIE_C2H_MSG_8812F) -+#define BITS_HCI_PCIE_C2H_MSG_8812F \ -+ (BIT_MASK_HCI_PCIE_C2H_MSG_8812F << BIT_SHIFT_HCI_PCIE_C2H_MSG_8812F) -+#define BIT_CLEAR_HCI_PCIE_C2H_MSG_8812F(x) \ -+ ((x) & (~BITS_HCI_PCIE_C2H_MSG_8812F)) -+#define BIT_GET_HCI_PCIE_C2H_MSG_8812F(x) \ -+ (((x) >> BIT_SHIFT_HCI_PCIE_C2H_MSG_8812F) & \ -+ BIT_MASK_HCI_PCIE_C2H_MSG_8812F) -+#define BIT_SET_HCI_PCIE_C2H_MSG_8812F(x, v) \ -+ (BIT_CLEAR_HCI_PCIE_C2H_MSG_8812F(x) | BIT_HCI_PCIE_C2H_MSG_8812F(v)) -+ -+/* 2 REG_DBI_WDATA_V1_8812F */ -+ -+#define BIT_SHIFT_DBI_WDATA_8812F 0 -+#define BIT_MASK_DBI_WDATA_8812F 0xffffffffL -+#define BIT_DBI_WDATA_8812F(x) \ -+ (((x) & BIT_MASK_DBI_WDATA_8812F) << BIT_SHIFT_DBI_WDATA_8812F) -+#define BITS_DBI_WDATA_8812F \ -+ (BIT_MASK_DBI_WDATA_8812F << BIT_SHIFT_DBI_WDATA_8812F) -+#define BIT_CLEAR_DBI_WDATA_8812F(x) ((x) & (~BITS_DBI_WDATA_8812F)) -+#define BIT_GET_DBI_WDATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DBI_WDATA_8812F) & BIT_MASK_DBI_WDATA_8812F) -+#define BIT_SET_DBI_WDATA_8812F(x, v) \ -+ (BIT_CLEAR_DBI_WDATA_8812F(x) | BIT_DBI_WDATA_8812F(v)) -+ -+/* 2 REG_DBI_RDATA_V1_8812F */ -+ -+#define BIT_SHIFT_DBI_RDATA_8812F 0 -+#define BIT_MASK_DBI_RDATA_8812F 0xffffffffL -+#define BIT_DBI_RDATA_8812F(x) \ -+ (((x) & BIT_MASK_DBI_RDATA_8812F) << BIT_SHIFT_DBI_RDATA_8812F) -+#define BITS_DBI_RDATA_8812F \ -+ (BIT_MASK_DBI_RDATA_8812F << BIT_SHIFT_DBI_RDATA_8812F) -+#define BIT_CLEAR_DBI_RDATA_8812F(x) ((x) & (~BITS_DBI_RDATA_8812F)) -+#define BIT_GET_DBI_RDATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DBI_RDATA_8812F) & BIT_MASK_DBI_RDATA_8812F) -+#define BIT_SET_DBI_RDATA_8812F(x, v) \ -+ (BIT_CLEAR_DBI_RDATA_8812F(x) | BIT_DBI_RDATA_8812F(v)) -+ -+/* 2 REG_DBI_FLAG_V1_8812F */ -+#define BIT_EN_STUCK_DBG_8812F BIT(26) -+#define BIT_RX_STUCK_8812F BIT(25) -+#define BIT_TX_STUCK_8812F BIT(24) -+#define BIT_DBI_RFLAG_8812F BIT(17) -+#define BIT_DBI_WFLAG_8812F BIT(16) -+ -+#define BIT_SHIFT_DBI_WREN_8812F 12 -+#define BIT_MASK_DBI_WREN_8812F 0xf -+#define BIT_DBI_WREN_8812F(x) \ -+ (((x) & BIT_MASK_DBI_WREN_8812F) << BIT_SHIFT_DBI_WREN_8812F) -+#define BITS_DBI_WREN_8812F \ -+ (BIT_MASK_DBI_WREN_8812F << BIT_SHIFT_DBI_WREN_8812F) -+#define BIT_CLEAR_DBI_WREN_8812F(x) ((x) & (~BITS_DBI_WREN_8812F)) -+#define BIT_GET_DBI_WREN_8812F(x) \ -+ (((x) >> BIT_SHIFT_DBI_WREN_8812F) & BIT_MASK_DBI_WREN_8812F) -+#define BIT_SET_DBI_WREN_8812F(x, v) \ -+ (BIT_CLEAR_DBI_WREN_8812F(x) | BIT_DBI_WREN_8812F(v)) -+ -+#define BIT_SHIFT_DBI_ADDR_8812F 0 -+#define BIT_MASK_DBI_ADDR_8812F 0xfff -+#define BIT_DBI_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_DBI_ADDR_8812F) << BIT_SHIFT_DBI_ADDR_8812F) -+#define BITS_DBI_ADDR_8812F \ -+ (BIT_MASK_DBI_ADDR_8812F << BIT_SHIFT_DBI_ADDR_8812F) -+#define BIT_CLEAR_DBI_ADDR_8812F(x) ((x) & (~BITS_DBI_ADDR_8812F)) -+#define BIT_GET_DBI_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_DBI_ADDR_8812F) & BIT_MASK_DBI_ADDR_8812F) -+#define BIT_SET_DBI_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_DBI_ADDR_8812F(x) | BIT_DBI_ADDR_8812F(v)) -+ -+/* 2 REG_MDIO_V1_8812F */ -+ -+#define BIT_SHIFT_MDIO_RDATA_8812F 16 -+#define BIT_MASK_MDIO_RDATA_8812F 0xffff -+#define BIT_MDIO_RDATA_8812F(x) \ -+ (((x) & BIT_MASK_MDIO_RDATA_8812F) << BIT_SHIFT_MDIO_RDATA_8812F) -+#define BITS_MDIO_RDATA_8812F \ -+ (BIT_MASK_MDIO_RDATA_8812F << BIT_SHIFT_MDIO_RDATA_8812F) -+#define BIT_CLEAR_MDIO_RDATA_8812F(x) ((x) & (~BITS_MDIO_RDATA_8812F)) -+#define BIT_GET_MDIO_RDATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_MDIO_RDATA_8812F) & BIT_MASK_MDIO_RDATA_8812F) -+#define BIT_SET_MDIO_RDATA_8812F(x, v) \ -+ (BIT_CLEAR_MDIO_RDATA_8812F(x) | BIT_MDIO_RDATA_8812F(v)) -+ -+#define BIT_SHIFT_MDIO_WDATA_8812F 0 -+#define BIT_MASK_MDIO_WDATA_8812F 0xffff -+#define BIT_MDIO_WDATA_8812F(x) \ -+ (((x) & BIT_MASK_MDIO_WDATA_8812F) << BIT_SHIFT_MDIO_WDATA_8812F) -+#define BITS_MDIO_WDATA_8812F \ -+ (BIT_MASK_MDIO_WDATA_8812F << BIT_SHIFT_MDIO_WDATA_8812F) -+#define BIT_CLEAR_MDIO_WDATA_8812F(x) ((x) & (~BITS_MDIO_WDATA_8812F)) -+#define BIT_GET_MDIO_WDATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_MDIO_WDATA_8812F) & BIT_MASK_MDIO_WDATA_8812F) -+#define BIT_SET_MDIO_WDATA_8812F(x, v) \ -+ (BIT_CLEAR_MDIO_WDATA_8812F(x) | BIT_MDIO_WDATA_8812F(v)) -+ -+/* 2 REG_PCIE_MIX_CFG_8812F */ -+ -+#define BIT_SHIFT_MDIO_PHY_ADDR_8812F 24 -+#define BIT_MASK_MDIO_PHY_ADDR_8812F 0x1f -+#define BIT_MDIO_PHY_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_MDIO_PHY_ADDR_8812F) << BIT_SHIFT_MDIO_PHY_ADDR_8812F) -+#define BITS_MDIO_PHY_ADDR_8812F \ -+ (BIT_MASK_MDIO_PHY_ADDR_8812F << BIT_SHIFT_MDIO_PHY_ADDR_8812F) -+#define BIT_CLEAR_MDIO_PHY_ADDR_8812F(x) ((x) & (~BITS_MDIO_PHY_ADDR_8812F)) -+#define BIT_GET_MDIO_PHY_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_MDIO_PHY_ADDR_8812F) & BIT_MASK_MDIO_PHY_ADDR_8812F) -+#define BIT_SET_MDIO_PHY_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_MDIO_PHY_ADDR_8812F(x) | BIT_MDIO_PHY_ADDR_8812F(v)) -+ -+#define BIT_SHIFT_WATCH_DOG_RECORD_V1_8812F 10 -+#define BIT_MASK_WATCH_DOG_RECORD_V1_8812F 0x3fff -+#define BIT_WATCH_DOG_RECORD_V1_8812F(x) \ -+ (((x) & BIT_MASK_WATCH_DOG_RECORD_V1_8812F) \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8812F) -+#define BITS_WATCH_DOG_RECORD_V1_8812F \ -+ (BIT_MASK_WATCH_DOG_RECORD_V1_8812F \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8812F) -+#define BIT_CLEAR_WATCH_DOG_RECORD_V1_8812F(x) \ -+ ((x) & (~BITS_WATCH_DOG_RECORD_V1_8812F)) -+#define BIT_GET_WATCH_DOG_RECORD_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_WATCH_DOG_RECORD_V1_8812F) & \ -+ BIT_MASK_WATCH_DOG_RECORD_V1_8812F) -+#define BIT_SET_WATCH_DOG_RECORD_V1_8812F(x, v) \ -+ (BIT_CLEAR_WATCH_DOG_RECORD_V1_8812F(x) | \ -+ BIT_WATCH_DOG_RECORD_V1_8812F(v)) -+ -+#define BIT_R_IO_TIMEOUT_FLAG_V1_8812F BIT(9) -+#define BIT_EN_WATCH_DOG_8812F BIT(8) -+#define BIT_ECRC_EN_V1_8812F BIT(7) -+#define BIT_MDIO_RFLAG_V1_8812F BIT(6) -+#define BIT_MDIO_WFLAG_V1_8812F BIT(5) -+ -+#define BIT_SHIFT_MDIO_REG_ADDR_V1_8812F 0 -+#define BIT_MASK_MDIO_REG_ADDR_V1_8812F 0x1f -+#define BIT_MDIO_REG_ADDR_V1_8812F(x) \ -+ (((x) & BIT_MASK_MDIO_REG_ADDR_V1_8812F) \ -+ << BIT_SHIFT_MDIO_REG_ADDR_V1_8812F) -+#define BITS_MDIO_REG_ADDR_V1_8812F \ -+ (BIT_MASK_MDIO_REG_ADDR_V1_8812F << BIT_SHIFT_MDIO_REG_ADDR_V1_8812F) -+#define BIT_CLEAR_MDIO_REG_ADDR_V1_8812F(x) \ -+ ((x) & (~BITS_MDIO_REG_ADDR_V1_8812F)) -+#define BIT_GET_MDIO_REG_ADDR_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MDIO_REG_ADDR_V1_8812F) & \ -+ BIT_MASK_MDIO_REG_ADDR_V1_8812F) -+#define BIT_SET_MDIO_REG_ADDR_V1_8812F(x, v) \ -+ (BIT_CLEAR_MDIO_REG_ADDR_V1_8812F(x) | BIT_MDIO_REG_ADDR_V1_8812F(v)) -+ -+/* 2 REG_HCI_MIX_CFG_8812F */ -+ -+#define BIT_SHIFT_WATCH_DOG_TIMER_8812F 28 -+#define BIT_MASK_WATCH_DOG_TIMER_8812F 0xf -+#define BIT_WATCH_DOG_TIMER_8812F(x) \ -+ (((x) & BIT_MASK_WATCH_DOG_TIMER_8812F) \ -+ << BIT_SHIFT_WATCH_DOG_TIMER_8812F) -+#define BITS_WATCH_DOG_TIMER_8812F \ -+ (BIT_MASK_WATCH_DOG_TIMER_8812F << BIT_SHIFT_WATCH_DOG_TIMER_8812F) -+#define BIT_CLEAR_WATCH_DOG_TIMER_8812F(x) ((x) & (~BITS_WATCH_DOG_TIMER_8812F)) -+#define BIT_GET_WATCH_DOG_TIMER_8812F(x) \ -+ (((x) >> BIT_SHIFT_WATCH_DOG_TIMER_8812F) & \ -+ BIT_MASK_WATCH_DOG_TIMER_8812F) -+#define BIT_SET_WATCH_DOG_TIMER_8812F(x, v) \ -+ (BIT_CLEAR_WATCH_DOG_TIMER_8812F(x) | BIT_WATCH_DOG_TIMER_8812F(v)) -+ -+#define BIT_EN_ALIGN_MTU_8812F BIT(23) -+ -+#define BIT_SHIFT_LATENCY_CONTROL_8812F 21 -+#define BIT_MASK_LATENCY_CONTROL_8812F 0x3 -+#define BIT_LATENCY_CONTROL_8812F(x) \ -+ (((x) & BIT_MASK_LATENCY_CONTROL_8812F) \ -+ << BIT_SHIFT_LATENCY_CONTROL_8812F) -+#define BITS_LATENCY_CONTROL_8812F \ -+ (BIT_MASK_LATENCY_CONTROL_8812F << BIT_SHIFT_LATENCY_CONTROL_8812F) -+#define BIT_CLEAR_LATENCY_CONTROL_8812F(x) ((x) & (~BITS_LATENCY_CONTROL_8812F)) -+#define BIT_GET_LATENCY_CONTROL_8812F(x) \ -+ (((x) >> BIT_SHIFT_LATENCY_CONTROL_8812F) & \ -+ BIT_MASK_LATENCY_CONTROL_8812F) -+#define BIT_SET_LATENCY_CONTROL_8812F(x, v) \ -+ (BIT_CLEAR_LATENCY_CONTROL_8812F(x) | BIT_LATENCY_CONTROL_8812F(v)) -+ -+#define BIT_HOST_GEN2_SUPPORT_8812F BIT(20) -+ -+#define BIT_SHIFT_TXDMA_ERR_FLAG_V1_8812F 15 -+#define BIT_MASK_TXDMA_ERR_FLAG_V1_8812F 0x1f -+#define BIT_TXDMA_ERR_FLAG_V1_8812F(x) \ -+ (((x) & BIT_MASK_TXDMA_ERR_FLAG_V1_8812F) \ -+ << BIT_SHIFT_TXDMA_ERR_FLAG_V1_8812F) -+#define BITS_TXDMA_ERR_FLAG_V1_8812F \ -+ (BIT_MASK_TXDMA_ERR_FLAG_V1_8812F << BIT_SHIFT_TXDMA_ERR_FLAG_V1_8812F) -+#define BIT_CLEAR_TXDMA_ERR_FLAG_V1_8812F(x) \ -+ ((x) & (~BITS_TXDMA_ERR_FLAG_V1_8812F)) -+#define BIT_GET_TXDMA_ERR_FLAG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_ERR_FLAG_V1_8812F) & \ -+ BIT_MASK_TXDMA_ERR_FLAG_V1_8812F) -+#define BIT_SET_TXDMA_ERR_FLAG_V1_8812F(x, v) \ -+ (BIT_CLEAR_TXDMA_ERR_FLAG_V1_8812F(x) | BIT_TXDMA_ERR_FLAG_V1_8812F(v)) -+ -+#define BIT_EPHY_RX50_EN_8812F BIT(11) -+ -+#define BIT_SHIFT_MSI_TIMEOUT_ID_V1_8812F 8 -+#define BIT_MASK_MSI_TIMEOUT_ID_V1_8812F 0x7 -+#define BIT_MSI_TIMEOUT_ID_V1_8812F(x) \ -+ (((x) & BIT_MASK_MSI_TIMEOUT_ID_V1_8812F) \ -+ << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8812F) -+#define BITS_MSI_TIMEOUT_ID_V1_8812F \ -+ (BIT_MASK_MSI_TIMEOUT_ID_V1_8812F << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8812F) -+#define BIT_CLEAR_MSI_TIMEOUT_ID_V1_8812F(x) \ -+ ((x) & (~BITS_MSI_TIMEOUT_ID_V1_8812F)) -+#define BIT_GET_MSI_TIMEOUT_ID_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MSI_TIMEOUT_ID_V1_8812F) & \ -+ BIT_MASK_MSI_TIMEOUT_ID_V1_8812F) -+#define BIT_SET_MSI_TIMEOUT_ID_V1_8812F(x, v) \ -+ (BIT_CLEAR_MSI_TIMEOUT_ID_V1_8812F(x) | BIT_MSI_TIMEOUT_ID_V1_8812F(v)) -+ -+#define BIT_RADDR_RD_8812F BIT(7) -+#define BIT_L1OFF_PWR_OFF_EN_8812F BIT(6) -+#define BIT_L0S_LINK_OFF_8812F BIT(4) -+#define BIT_ACT_LINK_OFF_8812F BIT(3) -+#define BIT_EN_SLOW_MAC_TX_8812F BIT(2) -+#define BIT_EN_SLOW_MAC_RX_8812F BIT(1) -+#define BIT_EN_SLOW_MAC_HW_8812F BIT(0) -+ -+/* 2 REG_STC_INT_CS_8812F(PCIE STATE CHANGE INTERRUPT CONTROL AND STATUS) */ -+#define BIT_STC_INT_EN_8812F BIT(31) -+ -+#define BIT_SHIFT_STC_INT_FLAG_8812F 16 -+#define BIT_MASK_STC_INT_FLAG_8812F 0xff -+#define BIT_STC_INT_FLAG_8812F(x) \ -+ (((x) & BIT_MASK_STC_INT_FLAG_8812F) << BIT_SHIFT_STC_INT_FLAG_8812F) -+#define BITS_STC_INT_FLAG_8812F \ -+ (BIT_MASK_STC_INT_FLAG_8812F << BIT_SHIFT_STC_INT_FLAG_8812F) -+#define BIT_CLEAR_STC_INT_FLAG_8812F(x) ((x) & (~BITS_STC_INT_FLAG_8812F)) -+#define BIT_GET_STC_INT_FLAG_8812F(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_FLAG_8812F) & BIT_MASK_STC_INT_FLAG_8812F) -+#define BIT_SET_STC_INT_FLAG_8812F(x, v) \ -+ (BIT_CLEAR_STC_INT_FLAG_8812F(x) | BIT_STC_INT_FLAG_8812F(v)) -+ -+#define BIT_SHIFT_STC_INT_IDX_8812F 8 -+#define BIT_MASK_STC_INT_IDX_8812F 0x7 -+#define BIT_STC_INT_IDX_8812F(x) \ -+ (((x) & BIT_MASK_STC_INT_IDX_8812F) << BIT_SHIFT_STC_INT_IDX_8812F) -+#define BITS_STC_INT_IDX_8812F \ -+ (BIT_MASK_STC_INT_IDX_8812F << BIT_SHIFT_STC_INT_IDX_8812F) -+#define BIT_CLEAR_STC_INT_IDX_8812F(x) ((x) & (~BITS_STC_INT_IDX_8812F)) -+#define BIT_GET_STC_INT_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_IDX_8812F) & BIT_MASK_STC_INT_IDX_8812F) -+#define BIT_SET_STC_INT_IDX_8812F(x, v) \ -+ (BIT_CLEAR_STC_INT_IDX_8812F(x) | BIT_STC_INT_IDX_8812F(v)) -+ -+#define BIT_SHIFT_STC_INT_REALTIME_CS_8812F 0 -+#define BIT_MASK_STC_INT_REALTIME_CS_8812F 0x3f -+#define BIT_STC_INT_REALTIME_CS_8812F(x) \ -+ (((x) & BIT_MASK_STC_INT_REALTIME_CS_8812F) \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8812F) -+#define BITS_STC_INT_REALTIME_CS_8812F \ -+ (BIT_MASK_STC_INT_REALTIME_CS_8812F \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8812F) -+#define BIT_CLEAR_STC_INT_REALTIME_CS_8812F(x) \ -+ ((x) & (~BITS_STC_INT_REALTIME_CS_8812F)) -+#define BIT_GET_STC_INT_REALTIME_CS_8812F(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_REALTIME_CS_8812F) & \ -+ BIT_MASK_STC_INT_REALTIME_CS_8812F) -+#define BIT_SET_STC_INT_REALTIME_CS_8812F(x, v) \ -+ (BIT_CLEAR_STC_INT_REALTIME_CS_8812F(x) | \ -+ BIT_STC_INT_REALTIME_CS_8812F(v)) -+ -+#define BIT_STC_INT_GRP_EN_8812F BIT(31) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_LS_8812F 8 -+#define BIT_MASK_STC_INT_EXPECT_LS_8812F 0x3f -+#define BIT_STC_INT_EXPECT_LS_8812F(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_LS_8812F) \ -+ << BIT_SHIFT_STC_INT_EXPECT_LS_8812F) -+#define BITS_STC_INT_EXPECT_LS_8812F \ -+ (BIT_MASK_STC_INT_EXPECT_LS_8812F << BIT_SHIFT_STC_INT_EXPECT_LS_8812F) -+#define BIT_CLEAR_STC_INT_EXPECT_LS_8812F(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_LS_8812F)) -+#define BIT_GET_STC_INT_EXPECT_LS_8812F(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_LS_8812F) & \ -+ BIT_MASK_STC_INT_EXPECT_LS_8812F) -+#define BIT_SET_STC_INT_EXPECT_LS_8812F(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_LS_8812F(x) | BIT_STC_INT_EXPECT_LS_8812F(v)) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_CS_8812F 0 -+#define BIT_MASK_STC_INT_EXPECT_CS_8812F 0x3f -+#define BIT_STC_INT_EXPECT_CS_8812F(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_CS_8812F) \ -+ << BIT_SHIFT_STC_INT_EXPECT_CS_8812F) -+#define BITS_STC_INT_EXPECT_CS_8812F \ -+ (BIT_MASK_STC_INT_EXPECT_CS_8812F << BIT_SHIFT_STC_INT_EXPECT_CS_8812F) -+#define BIT_CLEAR_STC_INT_EXPECT_CS_8812F(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_CS_8812F)) -+#define BIT_GET_STC_INT_EXPECT_CS_8812F(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_CS_8812F) & \ -+ BIT_MASK_STC_INT_EXPECT_CS_8812F) -+#define BIT_SET_STC_INT_EXPECT_CS_8812F(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_CS_8812F(x) | BIT_STC_INT_EXPECT_CS_8812F(v)) -+ -+/* 2 REG_H2CQ_TXBD_DESA_8812F */ -+ -+#define BIT_SHIFT_H2CQ_TXBD_DESA_8812F 0 -+#define BIT_MASK_H2CQ_TXBD_DESA_8812F 0xffffffffffffffffL -+#define BIT_H2CQ_TXBD_DESA_8812F(x) \ -+ (((x) & BIT_MASK_H2CQ_TXBD_DESA_8812F) \ -+ << BIT_SHIFT_H2CQ_TXBD_DESA_8812F) -+#define BITS_H2CQ_TXBD_DESA_8812F \ -+ (BIT_MASK_H2CQ_TXBD_DESA_8812F << BIT_SHIFT_H2CQ_TXBD_DESA_8812F) -+#define BIT_CLEAR_H2CQ_TXBD_DESA_8812F(x) ((x) & (~BITS_H2CQ_TXBD_DESA_8812F)) -+#define BIT_GET_H2CQ_TXBD_DESA_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_TXBD_DESA_8812F) & \ -+ BIT_MASK_H2CQ_TXBD_DESA_8812F) -+#define BIT_SET_H2CQ_TXBD_DESA_8812F(x, v) \ -+ (BIT_CLEAR_H2CQ_TXBD_DESA_8812F(x) | BIT_H2CQ_TXBD_DESA_8812F(v)) -+ -+/* 2 REG_H2CQ_TXBD_NUM_8812F */ -+#define BIT_PCIE_H2CQ_FLAG_8812F BIT(14) -+ -+#define BIT_SHIFT_H2CQ_DESC_MODE_8812F 12 -+#define BIT_MASK_H2CQ_DESC_MODE_8812F 0x3 -+#define BIT_H2CQ_DESC_MODE_8812F(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_MODE_8812F) \ -+ << BIT_SHIFT_H2CQ_DESC_MODE_8812F) -+#define BITS_H2CQ_DESC_MODE_8812F \ -+ (BIT_MASK_H2CQ_DESC_MODE_8812F << BIT_SHIFT_H2CQ_DESC_MODE_8812F) -+#define BIT_CLEAR_H2CQ_DESC_MODE_8812F(x) ((x) & (~BITS_H2CQ_DESC_MODE_8812F)) -+#define BIT_GET_H2CQ_DESC_MODE_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_MODE_8812F) & \ -+ BIT_MASK_H2CQ_DESC_MODE_8812F) -+#define BIT_SET_H2CQ_DESC_MODE_8812F(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_MODE_8812F(x) | BIT_H2CQ_DESC_MODE_8812F(v)) -+ -+#define BIT_SHIFT_H2CQ_DESC_NUM_8812F 0 -+#define BIT_MASK_H2CQ_DESC_NUM_8812F 0xfff -+#define BIT_H2CQ_DESC_NUM_8812F(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_NUM_8812F) << BIT_SHIFT_H2CQ_DESC_NUM_8812F) -+#define BITS_H2CQ_DESC_NUM_8812F \ -+ (BIT_MASK_H2CQ_DESC_NUM_8812F << BIT_SHIFT_H2CQ_DESC_NUM_8812F) -+#define BIT_CLEAR_H2CQ_DESC_NUM_8812F(x) ((x) & (~BITS_H2CQ_DESC_NUM_8812F)) -+#define BIT_GET_H2CQ_DESC_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_NUM_8812F) & BIT_MASK_H2CQ_DESC_NUM_8812F) -+#define BIT_SET_H2CQ_DESC_NUM_8812F(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_NUM_8812F(x) | BIT_H2CQ_DESC_NUM_8812F(v)) -+ -+/* 2 REG_H2CQ_TXBD_IDX_8812F */ -+ -+#define BIT_SHIFT_H2CQ_HW_IDX_8812F 16 -+#define BIT_MASK_H2CQ_HW_IDX_8812F 0xfff -+#define BIT_H2CQ_HW_IDX_8812F(x) \ -+ (((x) & BIT_MASK_H2CQ_HW_IDX_8812F) << BIT_SHIFT_H2CQ_HW_IDX_8812F) -+#define BITS_H2CQ_HW_IDX_8812F \ -+ (BIT_MASK_H2CQ_HW_IDX_8812F << BIT_SHIFT_H2CQ_HW_IDX_8812F) -+#define BIT_CLEAR_H2CQ_HW_IDX_8812F(x) ((x) & (~BITS_H2CQ_HW_IDX_8812F)) -+#define BIT_GET_H2CQ_HW_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HW_IDX_8812F) & BIT_MASK_H2CQ_HW_IDX_8812F) -+#define BIT_SET_H2CQ_HW_IDX_8812F(x, v) \ -+ (BIT_CLEAR_H2CQ_HW_IDX_8812F(x) | BIT_H2CQ_HW_IDX_8812F(v)) -+ -+#define BIT_SHIFT_H2CQ_HOST_IDX_8812F 0 -+#define BIT_MASK_H2CQ_HOST_IDX_8812F 0xfff -+#define BIT_H2CQ_HOST_IDX_8812F(x) \ -+ (((x) & BIT_MASK_H2CQ_HOST_IDX_8812F) << BIT_SHIFT_H2CQ_HOST_IDX_8812F) -+#define BITS_H2CQ_HOST_IDX_8812F \ -+ (BIT_MASK_H2CQ_HOST_IDX_8812F << BIT_SHIFT_H2CQ_HOST_IDX_8812F) -+#define BIT_CLEAR_H2CQ_HOST_IDX_8812F(x) ((x) & (~BITS_H2CQ_HOST_IDX_8812F)) -+#define BIT_GET_H2CQ_HOST_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HOST_IDX_8812F) & BIT_MASK_H2CQ_HOST_IDX_8812F) -+#define BIT_SET_H2CQ_HOST_IDX_8812F(x, v) \ -+ (BIT_CLEAR_H2CQ_HOST_IDX_8812F(x) | BIT_H2CQ_HOST_IDX_8812F(v)) -+ -+/* 2 REG_H2CQ_CSR_8812F[31:0] (H2CQ CONTROL AND STATUS) */ -+#define BIT_H2CQ_FULL_8812F BIT(31) -+#define BIT_CLR_H2CQ_HOST_IDX_8812F BIT(16) -+#define BIT_CLR_H2CQ_HW_IDX_8812F BIT(8) -+#define BIT_STOP_H2CQ_8812F BIT(0) -+ -+/* 2 REG_CHANGE_PCIE_SPEED_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_RXDMA_ERR_CNT_8812F 8 -+#define BIT_MASK_RXDMA_ERR_CNT_8812F 0xff -+#define BIT_RXDMA_ERR_CNT_8812F(x) \ -+ (((x) & BIT_MASK_RXDMA_ERR_CNT_8812F) << BIT_SHIFT_RXDMA_ERR_CNT_8812F) -+#define BITS_RXDMA_ERR_CNT_8812F \ -+ (BIT_MASK_RXDMA_ERR_CNT_8812F << BIT_SHIFT_RXDMA_ERR_CNT_8812F) -+#define BIT_CLEAR_RXDMA_ERR_CNT_8812F(x) ((x) & (~BITS_RXDMA_ERR_CNT_8812F)) -+#define BIT_GET_RXDMA_ERR_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_ERR_CNT_8812F) & BIT_MASK_RXDMA_ERR_CNT_8812F) -+#define BIT_SET_RXDMA_ERR_CNT_8812F(x, v) \ -+ (BIT_CLEAR_RXDMA_ERR_CNT_8812F(x) | BIT_RXDMA_ERR_CNT_8812F(v)) -+ -+#define BIT_TXDMA_ERR_HANDLE_REQ_8812F BIT(7) -+#define BIT_TXDMA_ERROR_PS_8812F BIT(6) -+#define BIT_EN_TXDMA_STUCK_ERR_HANDLE_8812F BIT(5) -+#define BIT_EN_TXDMA_RTN_ERR_HANDLE_8812F BIT(4) -+#define BIT_RXDMA_ERR_HANDLE_REQ_8812F BIT(3) -+#define BIT_RXDMA_ERROR_PS_8812F BIT(2) -+#define BIT_EN_RXDMA_STUCK_ERR_HANDLE_8812F BIT(1) -+#define BIT_EN_RXDMA_RTN_ERR_HANDLE_8812F BIT(0) -+ -+/* 2 REG_DEBUG_STATE1_8812F */ -+ -+#define BIT_SHIFT_DEBUG_STATE1_8812F 0 -+#define BIT_MASK_DEBUG_STATE1_8812F 0xffffffffL -+#define BIT_DEBUG_STATE1_8812F(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE1_8812F) << BIT_SHIFT_DEBUG_STATE1_8812F) -+#define BITS_DEBUG_STATE1_8812F \ -+ (BIT_MASK_DEBUG_STATE1_8812F << BIT_SHIFT_DEBUG_STATE1_8812F) -+#define BIT_CLEAR_DEBUG_STATE1_8812F(x) ((x) & (~BITS_DEBUG_STATE1_8812F)) -+#define BIT_GET_DEBUG_STATE1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE1_8812F) & BIT_MASK_DEBUG_STATE1_8812F) -+#define BIT_SET_DEBUG_STATE1_8812F(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE1_8812F(x) | BIT_DEBUG_STATE1_8812F(v)) -+ -+/* 2 REG_DEBUG_STATE2_8812F */ -+ -+#define BIT_SHIFT_DEBUG_STATE2_8812F 0 -+#define BIT_MASK_DEBUG_STATE2_8812F 0xffffffffL -+#define BIT_DEBUG_STATE2_8812F(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE2_8812F) << BIT_SHIFT_DEBUG_STATE2_8812F) -+#define BITS_DEBUG_STATE2_8812F \ -+ (BIT_MASK_DEBUG_STATE2_8812F << BIT_SHIFT_DEBUG_STATE2_8812F) -+#define BIT_CLEAR_DEBUG_STATE2_8812F(x) ((x) & (~BITS_DEBUG_STATE2_8812F)) -+#define BIT_GET_DEBUG_STATE2_8812F(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE2_8812F) & BIT_MASK_DEBUG_STATE2_8812F) -+#define BIT_SET_DEBUG_STATE2_8812F(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE2_8812F(x) | BIT_DEBUG_STATE2_8812F(v)) -+ -+/* 2 REG_DEBUG_STATE3_8812F */ -+ -+#define BIT_SHIFT_DEBUG_STATE3_8812F 0 -+#define BIT_MASK_DEBUG_STATE3_8812F 0xffffffffL -+#define BIT_DEBUG_STATE3_8812F(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE3_8812F) << BIT_SHIFT_DEBUG_STATE3_8812F) -+#define BITS_DEBUG_STATE3_8812F \ -+ (BIT_MASK_DEBUG_STATE3_8812F << BIT_SHIFT_DEBUG_STATE3_8812F) -+#define BIT_CLEAR_DEBUG_STATE3_8812F(x) ((x) & (~BITS_DEBUG_STATE3_8812F)) -+#define BIT_GET_DEBUG_STATE3_8812F(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE3_8812F) & BIT_MASK_DEBUG_STATE3_8812F) -+#define BIT_SET_DEBUG_STATE3_8812F(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE3_8812F(x) | BIT_DEBUG_STATE3_8812F(v)) -+ -+/* 2 REG_CHNL_DMA_CFG_V1_8812F */ -+#define BIT_TXHCI_EN_V1_8812F BIT(26) -+#define BIT_TXHCI_IDLE_V1_8812F BIT(25) -+#define BIT_DMA_PRI_EN_V1_8812F BIT(24) -+ -+/* 2 REG_PCIE_HISR0_V1_8812F */ -+#define BIT_PSTIMER_2_8812F BIT(31) -+#define BIT_PSTIMER_1_8812F BIT(30) -+#define BIT_PSTIMER_0_8812F BIT(29) -+#define BIT_GTINT4_8812F BIT(28) -+#define BIT_GTINT3_8812F BIT(27) -+#define BIT_TXBCN0ERR_8812F BIT(26) -+#define BIT_TXBCN0OK_8812F BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_8812F BIT(24) -+#define BIT_TXDMA_START_INT_8812F BIT(23) -+#define BIT_TXDMA_STOP_INT_8812F BIT(22) -+#define BIT_HISR7_IND_8812F BIT(21) -+#define BIT_BCNDMAINT0_8812F BIT(20) -+#define BIT_HISR6_IND_8812F BIT(19) -+#define BIT_HISR5_IND_8812F BIT(18) -+#define BIT_HISR4_IND_8812F BIT(17) -+#define BIT_BCNDERR0_8812F BIT(16) -+#define BIT_HSISR_IND_ON_INT_8812F BIT(15) -+#define BIT_HISR3_IND_8812F BIT(14) -+#define BIT_HISR2_IND_8812F BIT(13) -+#define BIT_HISR1_IND_8812F BIT(11) -+#define BIT_C2HCMD_8812F BIT(10) -+#define BIT_CPWM2_8812F BIT(9) -+#define BIT_CPWM_8812F BIT(8) -+#define BIT_TXDMAOK_CHANNEL15_8812F BIT(7) -+#define BIT_TXDMAOK_CHANNEL14_8812F BIT(6) -+#define BIT_TXDMAOK_CHANNEL3_8812F BIT(5) -+#define BIT_TXDMAOK_CHANNEL2_8812F BIT(4) -+#define BIT_TXDMAOK_CHANNEL1_8812F BIT(3) -+#define BIT_TXDMAOK_CHANNEL0_8812F BIT(2) -+#define BIT_RDU_8812F BIT(1) -+#define BIT_RXOK_8812F BIT(0) -+ -+/* 2 REG_PCIE_HISR1_V1_8812F */ -+#define BIT_PRE_TX_ERR_INT_8812F BIT(31) -+#define BIT_TXFIFO_TH_INT_8812F BIT(30) -+#define BIT_BTON_STS_UPDATE_INT_8812F BIT(29) -+#define BIT_BCNDMAINT7_8812F BIT(27) -+#define BIT_BCNDMAINT6_8812F BIT(26) -+#define BIT_BCNDMAINT5_8812F BIT(25) -+#define BIT_BCNDMAINT4_8812F BIT(24) -+#define BIT_BCNDMAINT3_8812F BIT(23) -+#define BIT_BCNDMAINT2_8812F BIT(22) -+#define BIT_BCNDMAINT1_8812F BIT(21) -+#define BIT_BCNDERR7_8812F BIT(20) -+#define BIT_BCNDERR6_8812F BIT(19) -+#define BIT_BCNDERR5_8812F BIT(18) -+#define BIT_BCNDERR4_8812F BIT(17) -+#define BIT_BCNDERR3_8812F BIT(16) -+#define BIT_BCNDERR2_8812F BIT(15) -+#define BIT_BCNDERR1_8812F BIT(14) -+#define BIT_ATIMEND_8812F BIT(12) -+#define BIT_TXERR_INT_8812F BIT(11) -+#define BIT_RXERR_INT_8812F BIT(10) -+#define BIT_TXFOVW_8812F BIT(9) -+#define BIT_FOVW_8812F BIT(8) -+#define BIT_CPU_MGQ_EARLY_INT_8812F BIT(6) -+#define BIT_CPU_MGQ_TXDONE_8812F BIT(5) -+#define BIT_PSTIMER_5_8812F BIT(4) -+#define BIT_PSTIMER_4_8812F BIT(3) -+#define BIT_PSTIMER_3_8812F BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_8812F BIT(1) -+#define BIT_BB_STOPRX_INT_8812F BIT(0) -+ -+/* 2 REG_PCIE_HISR2_V1_8812F */ -+#define BIT_BCNDMAINT_P4_8812F BIT(31) -+#define BIT_BCNDMAINT_P3_8812F BIT(30) -+#define BIT_BCNDMAINT_P2_8812F BIT(29) -+#define BIT_BCNDMAINT_P1_8812F BIT(28) -+#define BIT_SCH_PHY_TXOP_SIFS_INT_8812F BIT(23) -+#define BIT_ATIMEND7_8812F BIT(22) -+#define BIT_ATIMEND6_8812F BIT(21) -+#define BIT_ATIMEND5_8812F BIT(20) -+#define BIT_ATIMEND4_8812F BIT(19) -+#define BIT_ATIMEND3_8812F BIT(18) -+#define BIT_ATIMEND2_8812F BIT(17) -+#define BIT_ATIMEND1_8812F BIT(16) -+#define BIT_TXBCN7OK_8812F BIT(14) -+#define BIT_TXBCN6OK_8812F BIT(13) -+#define BIT_TXBCN5OK_8812F BIT(12) -+#define BIT_TXBCN4OK_8812F BIT(11) -+#define BIT_TXBCN3OK_8812F BIT(10) -+#define BIT_TXBCN2OK_8812F BIT(9) -+#define BIT_TXBCN1OK_8812F BIT(8) -+#define BIT_TXBCN7ERR_8812F BIT(6) -+#define BIT_TXBCN6ERR_8812F BIT(5) -+#define BIT_TXBCN5ERR_8812F BIT(4) -+#define BIT_TXBCN4ERR_8812F BIT(3) -+#define BIT_TXBCN3ERR_8812F BIT(2) -+#define BIT_TXBCN2ERR_8812F BIT(1) -+#define BIT_TXBCN1ERR_8812F BIT(0) -+ -+/* 2 REG_PCIE_HISR3_V1_8812F */ -+#define BIT_GTINT12_8812F BIT(24) -+#define BIT_GTINT11_8812F BIT(23) -+#define BIT_GTINT10_8812F BIT(22) -+#define BIT_GTINT9_8812F BIT(21) -+#define BIT_RX_DESC_BUF_FULL_8812F BIT(20) -+#define BIT_CPHY_LDO_OCP_DET_INT_8812F BIT(19) -+#define BIT_WDT_PLATFORM_INT_8812F BIT(18) -+#define BIT_WDT_CPU_INT_8812F BIT(17) -+#define BIT_SETH2CDOK_8812F BIT(16) -+#define BIT_H2C_CMD_FULL_8812F BIT(15) -+#define BIT_PKT_TRANS_ERR_8812F BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_8812F BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_8812F BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_8812F BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_8812F BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_8812F BIT(9) -+#define BIT_SEARCH_FAIL_8812F BIT(8) -+#define BIT_PWR_INT_127TO96_8812F BIT(7) -+#define BIT_PWR_INT_95TO64_8812F BIT(6) -+#define BIT_PWR_INT_63TO32_8812F BIT(5) -+#define BIT_PWR_INT_31TO0_8812F BIT(4) -+#define BIT_RX_DMA_STUCK_8812F BIT(3) -+#define BIT_TX_DMA_STUCK_8812F BIT(2) -+#define BIT_DDMA0_LP_INT_8812F BIT(1) -+#define BIT_DDMA0_HP_INT_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_Q0_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q0_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_Q0_V1_8812F 0x7f -+#define BIT_QUEUEMACID_Q0_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q0_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_Q0_V1_8812F) -+#define BITS_QUEUEMACID_Q0_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_Q0_V1_8812F << BIT_SHIFT_QUEUEMACID_Q0_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_Q0_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q0_V1_8812F)) -+#define BIT_GET_QUEUEMACID_Q0_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q0_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_Q0_V1_8812F) -+#define BIT_SET_QUEUEMACID_Q0_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q0_V1_8812F(x) | BIT_QUEUEMACID_Q0_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q0_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_Q0_V1_8812F 0x3 -+#define BIT_QUEUEAC_Q0_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q0_V1_8812F) << BIT_SHIFT_QUEUEAC_Q0_V1_8812F) -+#define BITS_QUEUEAC_Q0_V1_8812F \ -+ (BIT_MASK_QUEUEAC_Q0_V1_8812F << BIT_SHIFT_QUEUEAC_Q0_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_Q0_V1_8812F(x) ((x) & (~BITS_QUEUEAC_Q0_V1_8812F)) -+#define BIT_GET_QUEUEAC_Q0_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q0_V1_8812F) & BIT_MASK_QUEUEAC_Q0_V1_8812F) -+#define BIT_SET_QUEUEAC_Q0_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q0_V1_8812F(x) | BIT_QUEUEAC_Q0_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_Q0_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q0_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_Q0_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_Q0_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q0_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_Q0_V2_8812F) -+#define BITS_TAIL_PKT_Q0_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_Q0_V2_8812F << BIT_SHIFT_TAIL_PKT_Q0_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_Q0_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_Q0_V2_8812F)) -+#define BIT_GET_TAIL_PKT_Q0_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q0_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_Q0_V2_8812F) -+#define BIT_SET_TAIL_PKT_Q0_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q0_V2_8812F(x) | BIT_TAIL_PKT_Q0_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q0_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_Q0_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_Q0_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q0_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_Q0_V1_8812F) -+#define BITS_HEAD_PKT_Q0_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_Q0_V1_8812F << BIT_SHIFT_HEAD_PKT_Q0_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_Q0_V1_8812F(x) ((x) & (~BITS_HEAD_PKT_Q0_V1_8812F)) -+#define BIT_GET_HEAD_PKT_Q0_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q0_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_Q0_V1_8812F) -+#define BIT_SET_HEAD_PKT_Q0_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q0_V1_8812F(x) | BIT_HEAD_PKT_Q0_V1_8812F(v)) -+ -+/* 2 REG_Q1_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q1_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_Q1_V1_8812F 0x7f -+#define BIT_QUEUEMACID_Q1_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q1_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_Q1_V1_8812F) -+#define BITS_QUEUEMACID_Q1_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_Q1_V1_8812F << BIT_SHIFT_QUEUEMACID_Q1_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_Q1_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q1_V1_8812F)) -+#define BIT_GET_QUEUEMACID_Q1_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q1_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_Q1_V1_8812F) -+#define BIT_SET_QUEUEMACID_Q1_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q1_V1_8812F(x) | BIT_QUEUEMACID_Q1_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q1_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_Q1_V1_8812F 0x3 -+#define BIT_QUEUEAC_Q1_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q1_V1_8812F) << BIT_SHIFT_QUEUEAC_Q1_V1_8812F) -+#define BITS_QUEUEAC_Q1_V1_8812F \ -+ (BIT_MASK_QUEUEAC_Q1_V1_8812F << BIT_SHIFT_QUEUEAC_Q1_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_Q1_V1_8812F(x) ((x) & (~BITS_QUEUEAC_Q1_V1_8812F)) -+#define BIT_GET_QUEUEAC_Q1_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q1_V1_8812F) & BIT_MASK_QUEUEAC_Q1_V1_8812F) -+#define BIT_SET_QUEUEAC_Q1_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q1_V1_8812F(x) | BIT_QUEUEAC_Q1_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_Q1_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q1_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_Q1_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_Q1_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q1_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_Q1_V2_8812F) -+#define BITS_TAIL_PKT_Q1_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_Q1_V2_8812F << BIT_SHIFT_TAIL_PKT_Q1_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_Q1_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_Q1_V2_8812F)) -+#define BIT_GET_TAIL_PKT_Q1_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q1_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_Q1_V2_8812F) -+#define BIT_SET_TAIL_PKT_Q1_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q1_V2_8812F(x) | BIT_TAIL_PKT_Q1_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q1_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_Q1_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_Q1_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q1_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_Q1_V1_8812F) -+#define BITS_HEAD_PKT_Q1_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_Q1_V1_8812F << BIT_SHIFT_HEAD_PKT_Q1_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_Q1_V1_8812F(x) ((x) & (~BITS_HEAD_PKT_Q1_V1_8812F)) -+#define BIT_GET_HEAD_PKT_Q1_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q1_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_Q1_V1_8812F) -+#define BIT_SET_HEAD_PKT_Q1_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q1_V1_8812F(x) | BIT_HEAD_PKT_Q1_V1_8812F(v)) -+ -+/* 2 REG_Q2_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q2_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_Q2_V1_8812F 0x7f -+#define BIT_QUEUEMACID_Q2_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q2_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_Q2_V1_8812F) -+#define BITS_QUEUEMACID_Q2_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_Q2_V1_8812F << BIT_SHIFT_QUEUEMACID_Q2_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_Q2_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q2_V1_8812F)) -+#define BIT_GET_QUEUEMACID_Q2_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q2_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_Q2_V1_8812F) -+#define BIT_SET_QUEUEMACID_Q2_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q2_V1_8812F(x) | BIT_QUEUEMACID_Q2_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q2_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_Q2_V1_8812F 0x3 -+#define BIT_QUEUEAC_Q2_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q2_V1_8812F) << BIT_SHIFT_QUEUEAC_Q2_V1_8812F) -+#define BITS_QUEUEAC_Q2_V1_8812F \ -+ (BIT_MASK_QUEUEAC_Q2_V1_8812F << BIT_SHIFT_QUEUEAC_Q2_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_Q2_V1_8812F(x) ((x) & (~BITS_QUEUEAC_Q2_V1_8812F)) -+#define BIT_GET_QUEUEAC_Q2_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q2_V1_8812F) & BIT_MASK_QUEUEAC_Q2_V1_8812F) -+#define BIT_SET_QUEUEAC_Q2_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q2_V1_8812F(x) | BIT_QUEUEAC_Q2_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_Q2_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q2_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_Q2_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_Q2_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q2_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_Q2_V2_8812F) -+#define BITS_TAIL_PKT_Q2_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_Q2_V2_8812F << BIT_SHIFT_TAIL_PKT_Q2_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_Q2_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_Q2_V2_8812F)) -+#define BIT_GET_TAIL_PKT_Q2_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q2_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_Q2_V2_8812F) -+#define BIT_SET_TAIL_PKT_Q2_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q2_V2_8812F(x) | BIT_TAIL_PKT_Q2_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q2_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_Q2_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_Q2_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q2_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_Q2_V1_8812F) -+#define BITS_HEAD_PKT_Q2_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_Q2_V1_8812F << BIT_SHIFT_HEAD_PKT_Q2_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_Q2_V1_8812F(x) ((x) & (~BITS_HEAD_PKT_Q2_V1_8812F)) -+#define BIT_GET_HEAD_PKT_Q2_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q2_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_Q2_V1_8812F) -+#define BIT_SET_HEAD_PKT_Q2_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q2_V1_8812F(x) | BIT_HEAD_PKT_Q2_V1_8812F(v)) -+ -+/* 2 REG_Q3_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q3_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_Q3_V1_8812F 0x7f -+#define BIT_QUEUEMACID_Q3_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q3_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_Q3_V1_8812F) -+#define BITS_QUEUEMACID_Q3_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_Q3_V1_8812F << BIT_SHIFT_QUEUEMACID_Q3_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_Q3_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q3_V1_8812F)) -+#define BIT_GET_QUEUEMACID_Q3_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q3_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_Q3_V1_8812F) -+#define BIT_SET_QUEUEMACID_Q3_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q3_V1_8812F(x) | BIT_QUEUEMACID_Q3_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q3_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_Q3_V1_8812F 0x3 -+#define BIT_QUEUEAC_Q3_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q3_V1_8812F) << BIT_SHIFT_QUEUEAC_Q3_V1_8812F) -+#define BITS_QUEUEAC_Q3_V1_8812F \ -+ (BIT_MASK_QUEUEAC_Q3_V1_8812F << BIT_SHIFT_QUEUEAC_Q3_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_Q3_V1_8812F(x) ((x) & (~BITS_QUEUEAC_Q3_V1_8812F)) -+#define BIT_GET_QUEUEAC_Q3_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q3_V1_8812F) & BIT_MASK_QUEUEAC_Q3_V1_8812F) -+#define BIT_SET_QUEUEAC_Q3_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q3_V1_8812F(x) | BIT_QUEUEAC_Q3_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_Q3_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q3_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_Q3_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_Q3_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q3_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_Q3_V2_8812F) -+#define BITS_TAIL_PKT_Q3_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_Q3_V2_8812F << BIT_SHIFT_TAIL_PKT_Q3_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_Q3_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_Q3_V2_8812F)) -+#define BIT_GET_TAIL_PKT_Q3_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q3_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_Q3_V2_8812F) -+#define BIT_SET_TAIL_PKT_Q3_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q3_V2_8812F(x) | BIT_TAIL_PKT_Q3_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q3_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_Q3_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_Q3_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q3_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_Q3_V1_8812F) -+#define BITS_HEAD_PKT_Q3_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_Q3_V1_8812F << BIT_SHIFT_HEAD_PKT_Q3_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_Q3_V1_8812F(x) ((x) & (~BITS_HEAD_PKT_Q3_V1_8812F)) -+#define BIT_GET_HEAD_PKT_Q3_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q3_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_Q3_V1_8812F) -+#define BIT_SET_HEAD_PKT_Q3_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q3_V1_8812F(x) | BIT_HEAD_PKT_Q3_V1_8812F(v)) -+ -+/* 2 REG_MGQ_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_MGQ_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_MGQ_V1_8812F 0x7f -+#define BIT_QUEUEMACID_MGQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_MGQ_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_MGQ_V1_8812F) -+#define BITS_QUEUEMACID_MGQ_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_MGQ_V1_8812F << BIT_SHIFT_QUEUEMACID_MGQ_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_MGQ_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_MGQ_V1_8812F)) -+#define BIT_GET_QUEUEMACID_MGQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_MGQ_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_MGQ_V1_8812F) -+#define BIT_SET_QUEUEMACID_MGQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_MGQ_V1_8812F(x) | BIT_QUEUEMACID_MGQ_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_MGQ_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_MGQ_V1_8812F 0x3 -+#define BIT_QUEUEAC_MGQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_MGQ_V1_8812F) \ -+ << BIT_SHIFT_QUEUEAC_MGQ_V1_8812F) -+#define BITS_QUEUEAC_MGQ_V1_8812F \ -+ (BIT_MASK_QUEUEAC_MGQ_V1_8812F << BIT_SHIFT_QUEUEAC_MGQ_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_MGQ_V1_8812F(x) ((x) & (~BITS_QUEUEAC_MGQ_V1_8812F)) -+#define BIT_GET_QUEUEAC_MGQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_MGQ_V1_8812F) & \ -+ BIT_MASK_QUEUEAC_MGQ_V1_8812F) -+#define BIT_SET_QUEUEAC_MGQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_MGQ_V1_8812F(x) | BIT_QUEUEAC_MGQ_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_MGQ_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_MGQ_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_MGQ_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_MGQ_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_MGQ_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_MGQ_V2_8812F) -+#define BITS_TAIL_PKT_MGQ_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_MGQ_V2_8812F << BIT_SHIFT_TAIL_PKT_MGQ_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_MGQ_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_MGQ_V2_8812F)) -+#define BIT_GET_TAIL_PKT_MGQ_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_MGQ_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_MGQ_V2_8812F) -+#define BIT_SET_TAIL_PKT_MGQ_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_MGQ_V2_8812F(x) | BIT_TAIL_PKT_MGQ_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_MGQ_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_MGQ_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_MGQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_MGQ_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_MGQ_V1_8812F) -+#define BITS_HEAD_PKT_MGQ_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_MGQ_V1_8812F << BIT_SHIFT_HEAD_PKT_MGQ_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_MGQ_V1_8812F(x) ((x) & (~BITS_HEAD_PKT_MGQ_V1_8812F)) -+#define BIT_GET_HEAD_PKT_MGQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_MGQ_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_MGQ_V1_8812F) -+#define BIT_SET_HEAD_PKT_MGQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_MGQ_V1_8812F(x) | BIT_HEAD_PKT_MGQ_V1_8812F(v)) -+ -+/* 2 REG_HIQ_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_HIQ_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_HIQ_V1_8812F 0x7f -+#define BIT_QUEUEMACID_HIQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_HIQ_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_HIQ_V1_8812F) -+#define BITS_QUEUEMACID_HIQ_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_HIQ_V1_8812F << BIT_SHIFT_QUEUEMACID_HIQ_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_HIQ_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_HIQ_V1_8812F)) -+#define BIT_GET_QUEUEMACID_HIQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_HIQ_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_HIQ_V1_8812F) -+#define BIT_SET_QUEUEMACID_HIQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_HIQ_V1_8812F(x) | BIT_QUEUEMACID_HIQ_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_HIQ_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_HIQ_V1_8812F 0x3 -+#define BIT_QUEUEAC_HIQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_HIQ_V1_8812F) \ -+ << BIT_SHIFT_QUEUEAC_HIQ_V1_8812F) -+#define BITS_QUEUEAC_HIQ_V1_8812F \ -+ (BIT_MASK_QUEUEAC_HIQ_V1_8812F << BIT_SHIFT_QUEUEAC_HIQ_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_HIQ_V1_8812F(x) ((x) & (~BITS_QUEUEAC_HIQ_V1_8812F)) -+#define BIT_GET_QUEUEAC_HIQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_HIQ_V1_8812F) & \ -+ BIT_MASK_QUEUEAC_HIQ_V1_8812F) -+#define BIT_SET_QUEUEAC_HIQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_HIQ_V1_8812F(x) | BIT_QUEUEAC_HIQ_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_HIQ_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_HIQ_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_HIQ_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_HIQ_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_HIQ_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_HIQ_V2_8812F) -+#define BITS_TAIL_PKT_HIQ_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_HIQ_V2_8812F << BIT_SHIFT_TAIL_PKT_HIQ_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_HIQ_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_HIQ_V2_8812F)) -+#define BIT_GET_TAIL_PKT_HIQ_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_HIQ_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_HIQ_V2_8812F) -+#define BIT_SET_TAIL_PKT_HIQ_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_HIQ_V2_8812F(x) | BIT_TAIL_PKT_HIQ_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_HIQ_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_HIQ_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_HIQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_HIQ_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_HIQ_V1_8812F) -+#define BITS_HEAD_PKT_HIQ_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_HIQ_V1_8812F << BIT_SHIFT_HEAD_PKT_HIQ_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_HIQ_V1_8812F(x) ((x) & (~BITS_HEAD_PKT_HIQ_V1_8812F)) -+#define BIT_GET_HEAD_PKT_HIQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_HIQ_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_HIQ_V1_8812F) -+#define BIT_SET_HEAD_PKT_HIQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_HIQ_V1_8812F(x) | BIT_HEAD_PKT_HIQ_V1_8812F(v)) -+ -+/* 2 REG_BCNQ_INFO_8812F */ -+ -+#define BIT_SHIFT_BCNQ_HEAD_PG_V1_8812F 0 -+#define BIT_MASK_BCNQ_HEAD_PG_V1_8812F 0xfff -+#define BIT_BCNQ_HEAD_PG_V1_8812F(x) \ -+ (((x) & BIT_MASK_BCNQ_HEAD_PG_V1_8812F) \ -+ << BIT_SHIFT_BCNQ_HEAD_PG_V1_8812F) -+#define BITS_BCNQ_HEAD_PG_V1_8812F \ -+ (BIT_MASK_BCNQ_HEAD_PG_V1_8812F << BIT_SHIFT_BCNQ_HEAD_PG_V1_8812F) -+#define BIT_CLEAR_BCNQ_HEAD_PG_V1_8812F(x) ((x) & (~BITS_BCNQ_HEAD_PG_V1_8812F)) -+#define BIT_GET_BCNQ_HEAD_PG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_HEAD_PG_V1_8812F) & \ -+ BIT_MASK_BCNQ_HEAD_PG_V1_8812F) -+#define BIT_SET_BCNQ_HEAD_PG_V1_8812F(x, v) \ -+ (BIT_CLEAR_BCNQ_HEAD_PG_V1_8812F(x) | BIT_BCNQ_HEAD_PG_V1_8812F(v)) -+ -+/* 2 REG_TXPKT_EMPTY_8812F */ -+#define BIT_BCNQ_EMPTY_8812F BIT(11) -+#define BIT_HQQ_EMPTY_8812F BIT(10) -+#define BIT_MQQ_EMPTY_8812F BIT(9) -+#define BIT_MGQ_CPU_EMPTY_8812F BIT(8) -+#define BIT_AC7Q_EMPTY_8812F BIT(7) -+#define BIT_AC6Q_EMPTY_8812F BIT(6) -+#define BIT_AC5Q_EMPTY_8812F BIT(5) -+#define BIT_AC4Q_EMPTY_8812F BIT(4) -+#define BIT_AC3Q_EMPTY_8812F BIT(3) -+#define BIT_AC2Q_EMPTY_8812F BIT(2) -+#define BIT_AC1Q_EMPTY_8812F BIT(1) -+#define BIT_AC0Q_EMPTY_8812F BIT(0) -+ -+/* 2 REG_CPU_MGQ_INFO_8812F */ -+#define BIT_BCN1_POLL_8812F BIT(30) -+#define BIT_CPUMGT_POLL_8812F BIT(29) -+#define BIT_BCN_POLL_8812F BIT(28) -+#define BIT_CPUMGQ_FW_NUM_V1_8812F BIT(12) -+ -+#define BIT_SHIFT_FW_FREE_TAIL_V1_8812F 0 -+#define BIT_MASK_FW_FREE_TAIL_V1_8812F 0xfff -+#define BIT_FW_FREE_TAIL_V1_8812F(x) \ -+ (((x) & BIT_MASK_FW_FREE_TAIL_V1_8812F) \ -+ << BIT_SHIFT_FW_FREE_TAIL_V1_8812F) -+#define BITS_FW_FREE_TAIL_V1_8812F \ -+ (BIT_MASK_FW_FREE_TAIL_V1_8812F << BIT_SHIFT_FW_FREE_TAIL_V1_8812F) -+#define BIT_CLEAR_FW_FREE_TAIL_V1_8812F(x) ((x) & (~BITS_FW_FREE_TAIL_V1_8812F)) -+#define BIT_GET_FW_FREE_TAIL_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_FW_FREE_TAIL_V1_8812F) & \ -+ BIT_MASK_FW_FREE_TAIL_V1_8812F) -+#define BIT_SET_FW_FREE_TAIL_V1_8812F(x, v) \ -+ (BIT_CLEAR_FW_FREE_TAIL_V1_8812F(x) | BIT_FW_FREE_TAIL_V1_8812F(v)) -+ -+/* 2 REG_FWHW_TXQ_CTRL_8812F */ -+#define BIT_RTS_LIMIT_IN_OFDM_8812F BIT(23) -+#define BIT_EN_BCNQ_DL_8812F BIT(22) -+#define BIT_EN_RD_RESP_NAV_BK_8812F BIT(21) -+#define BIT_EN_WR_FREE_TAIL_8812F BIT(20) -+#define BIT_NOTXRPT_USERATE_EN_8812F BIT(19) -+#define BIT_DIS_TXFAIL_RPT_8812F BIT(18) -+#define BIT_FTM_TIMEOUT_BYPASS_8812F BIT(16) -+ -+#define BIT_SHIFT_EN_QUEUE_RPT_8812F 8 -+#define BIT_MASK_EN_QUEUE_RPT_8812F 0xff -+#define BIT_EN_QUEUE_RPT_8812F(x) \ -+ (((x) & BIT_MASK_EN_QUEUE_RPT_8812F) << BIT_SHIFT_EN_QUEUE_RPT_8812F) -+#define BITS_EN_QUEUE_RPT_8812F \ -+ (BIT_MASK_EN_QUEUE_RPT_8812F << BIT_SHIFT_EN_QUEUE_RPT_8812F) -+#define BIT_CLEAR_EN_QUEUE_RPT_8812F(x) ((x) & (~BITS_EN_QUEUE_RPT_8812F)) -+#define BIT_GET_EN_QUEUE_RPT_8812F(x) \ -+ (((x) >> BIT_SHIFT_EN_QUEUE_RPT_8812F) & BIT_MASK_EN_QUEUE_RPT_8812F) -+#define BIT_SET_EN_QUEUE_RPT_8812F(x, v) \ -+ (BIT_CLEAR_EN_QUEUE_RPT_8812F(x) | BIT_EN_QUEUE_RPT_8812F(v)) -+ -+#define BIT_EN_RTY_BK_8812F BIT(7) -+#define BIT_EN_USE_INI_RAT_8812F BIT(6) -+#define BIT_EN_RTS_NAV_BK_8812F BIT(5) -+#define BIT_DIS_SSN_CHECK_8812F BIT(4) -+#define BIT_MACID_MATCH_RTS_8812F BIT(3) -+#define BIT_EN_BCN_TRXRPT_V1_8812F BIT(2) -+#define BIT_R_EN_FTMRPT_V1_8812F BIT(1) -+#define BIT_R_BMC_NAV_PROTECT_8812F BIT(0) -+ -+/* 2 REG_DATAFB_SEL_8812F */ -+#define BIT_BROADCAST_RTY_EN_8812F BIT(3) -+#define BIT_EN_RTY_BK_COD_8812F BIT(2) -+ -+#define BIT_SHIFT__R_DATA_FALLBACK_SEL_8812F 0 -+#define BIT_MASK__R_DATA_FALLBACK_SEL_8812F 0x3 -+#define BIT__R_DATA_FALLBACK_SEL_8812F(x) \ -+ (((x) & BIT_MASK__R_DATA_FALLBACK_SEL_8812F) \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL_8812F) -+#define BITS__R_DATA_FALLBACK_SEL_8812F \ -+ (BIT_MASK__R_DATA_FALLBACK_SEL_8812F \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL_8812F) -+#define BIT_CLEAR__R_DATA_FALLBACK_SEL_8812F(x) \ -+ ((x) & (~BITS__R_DATA_FALLBACK_SEL_8812F)) -+#define BIT_GET__R_DATA_FALLBACK_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT__R_DATA_FALLBACK_SEL_8812F) & \ -+ BIT_MASK__R_DATA_FALLBACK_SEL_8812F) -+#define BIT_SET__R_DATA_FALLBACK_SEL_8812F(x, v) \ -+ (BIT_CLEAR__R_DATA_FALLBACK_SEL_8812F(x) | \ -+ BIT__R_DATA_FALLBACK_SEL_8812F(v)) -+ -+/* 2 REG_BCNQ_BDNY_V1_8812F */ -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_V1_8812F 0 -+#define BIT_MASK_BCNQ_PGBNDY_V1_8812F 0xfff -+#define BIT_BCNQ_PGBNDY_V1_8812F(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_V1_8812F) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_V1_8812F) -+#define BITS_BCNQ_PGBNDY_V1_8812F \ -+ (BIT_MASK_BCNQ_PGBNDY_V1_8812F << BIT_SHIFT_BCNQ_PGBNDY_V1_8812F) -+#define BIT_CLEAR_BCNQ_PGBNDY_V1_8812F(x) ((x) & (~BITS_BCNQ_PGBNDY_V1_8812F)) -+#define BIT_GET_BCNQ_PGBNDY_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_V1_8812F) & \ -+ BIT_MASK_BCNQ_PGBNDY_V1_8812F) -+#define BIT_SET_BCNQ_PGBNDY_V1_8812F(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_V1_8812F(x) | BIT_BCNQ_PGBNDY_V1_8812F(v)) -+ -+/* 2 REG_LIFETIME_EN_8812F */ -+#define BIT_BT_INT_CPU_8812F BIT(7) -+#define BIT_BT_INT_PTA_8812F BIT(6) -+#define BIT_BA_PARSER_EN_8812F BIT(5) -+#define BIT_EN_CTRL_RTYBIT_8812F BIT(4) -+#define BIT_LIFETIME_BK_EN_8812F BIT(3) -+#define BIT_LIFETIME_BE_EN_8812F BIT(2) -+#define BIT_LIFETIME_VI_EN_8812F BIT(1) -+#define BIT_LIFETIME_VO_EN_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_SPEC_SIFS_8812F */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8812F 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_PTCL_8812F 0xff -+#define BIT_SPEC_SIFS_OFDM_PTCL_8812F(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_PTCL_8812F) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8812F) -+#define BITS_SPEC_SIFS_OFDM_PTCL_8812F \ -+ (BIT_MASK_SPEC_SIFS_OFDM_PTCL_8812F \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8812F) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8812F(x) \ -+ ((x) & (~BITS_SPEC_SIFS_OFDM_PTCL_8812F)) -+#define BIT_GET_SPEC_SIFS_OFDM_PTCL_8812F(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8812F) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_PTCL_8812F) -+#define BIT_SET_SPEC_SIFS_OFDM_PTCL_8812F(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8812F(x) | \ -+ BIT_SPEC_SIFS_OFDM_PTCL_8812F(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8812F 0 -+#define BIT_MASK_SPEC_SIFS_CCK_PTCL_8812F 0xff -+#define BIT_SPEC_SIFS_CCK_PTCL_8812F(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_PTCL_8812F) \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8812F) -+#define BITS_SPEC_SIFS_CCK_PTCL_8812F \ -+ (BIT_MASK_SPEC_SIFS_CCK_PTCL_8812F \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8812F) -+#define BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8812F(x) \ -+ ((x) & (~BITS_SPEC_SIFS_CCK_PTCL_8812F)) -+#define BIT_GET_SPEC_SIFS_CCK_PTCL_8812F(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8812F) & \ -+ BIT_MASK_SPEC_SIFS_CCK_PTCL_8812F) -+#define BIT_SET_SPEC_SIFS_CCK_PTCL_8812F(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8812F(x) | \ -+ BIT_SPEC_SIFS_CCK_PTCL_8812F(v)) -+ -+/* 2 REG_RETRY_LIMIT_8812F */ -+ -+#define BIT_SHIFT_SRL_8812F 8 -+#define BIT_MASK_SRL_8812F 0x3f -+#define BIT_SRL_8812F(x) (((x) & BIT_MASK_SRL_8812F) << BIT_SHIFT_SRL_8812F) -+#define BITS_SRL_8812F (BIT_MASK_SRL_8812F << BIT_SHIFT_SRL_8812F) -+#define BIT_CLEAR_SRL_8812F(x) ((x) & (~BITS_SRL_8812F)) -+#define BIT_GET_SRL_8812F(x) (((x) >> BIT_SHIFT_SRL_8812F) & BIT_MASK_SRL_8812F) -+#define BIT_SET_SRL_8812F(x, v) (BIT_CLEAR_SRL_8812F(x) | BIT_SRL_8812F(v)) -+ -+#define BIT_SHIFT_LRL_8812F 0 -+#define BIT_MASK_LRL_8812F 0x3f -+#define BIT_LRL_8812F(x) (((x) & BIT_MASK_LRL_8812F) << BIT_SHIFT_LRL_8812F) -+#define BITS_LRL_8812F (BIT_MASK_LRL_8812F << BIT_SHIFT_LRL_8812F) -+#define BIT_CLEAR_LRL_8812F(x) ((x) & (~BITS_LRL_8812F)) -+#define BIT_GET_LRL_8812F(x) (((x) >> BIT_SHIFT_LRL_8812F) & BIT_MASK_LRL_8812F) -+#define BIT_SET_LRL_8812F(x, v) (BIT_CLEAR_LRL_8812F(x) | BIT_LRL_8812F(v)) -+ -+/* 2 REG_TXBF_CTRL_8812F */ -+#define BIT_R_ENABLE_NDPA_8812F BIT(31) -+#define BIT_USE_NDPA_PARAMETER_8812F BIT(30) -+#define BIT_R_PROP_TXBF_8812F BIT(29) -+#define BIT_R_EN_NDPA_INT_8812F BIT(28) -+#define BIT_R_TXBF1_80M_8812F BIT(27) -+#define BIT_R_TXBF1_40M_8812F BIT(26) -+#define BIT_R_TXBF1_20M_8812F BIT(25) -+ -+#define BIT_SHIFT_R_TXBF1_AID_8812F 16 -+#define BIT_MASK_R_TXBF1_AID_8812F 0x1ff -+#define BIT_R_TXBF1_AID_8812F(x) \ -+ (((x) & BIT_MASK_R_TXBF1_AID_8812F) << BIT_SHIFT_R_TXBF1_AID_8812F) -+#define BITS_R_TXBF1_AID_8812F \ -+ (BIT_MASK_R_TXBF1_AID_8812F << BIT_SHIFT_R_TXBF1_AID_8812F) -+#define BIT_CLEAR_R_TXBF1_AID_8812F(x) ((x) & (~BITS_R_TXBF1_AID_8812F)) -+#define BIT_GET_R_TXBF1_AID_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF1_AID_8812F) & BIT_MASK_R_TXBF1_AID_8812F) -+#define BIT_SET_R_TXBF1_AID_8812F(x, v) \ -+ (BIT_CLEAR_R_TXBF1_AID_8812F(x) | BIT_R_TXBF1_AID_8812F(v)) -+ -+#define BIT_DIS_NDP_BFEN_8812F BIT(15) -+#define BIT_R_TXBCN_NOBLOCK_NDP_8812F BIT(14) -+#define BIT_R_TXBF0_80M_8812F BIT(11) -+#define BIT_R_TXBF0_40M_8812F BIT(10) -+#define BIT_R_TXBF0_20M_8812F BIT(9) -+ -+#define BIT_SHIFT_R_TXBF0_AID_8812F 0 -+#define BIT_MASK_R_TXBF0_AID_8812F 0x1ff -+#define BIT_R_TXBF0_AID_8812F(x) \ -+ (((x) & BIT_MASK_R_TXBF0_AID_8812F) << BIT_SHIFT_R_TXBF0_AID_8812F) -+#define BITS_R_TXBF0_AID_8812F \ -+ (BIT_MASK_R_TXBF0_AID_8812F << BIT_SHIFT_R_TXBF0_AID_8812F) -+#define BIT_CLEAR_R_TXBF0_AID_8812F(x) ((x) & (~BITS_R_TXBF0_AID_8812F)) -+#define BIT_GET_R_TXBF0_AID_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF0_AID_8812F) & BIT_MASK_R_TXBF0_AID_8812F) -+#define BIT_SET_R_TXBF0_AID_8812F(x, v) \ -+ (BIT_CLEAR_R_TXBF0_AID_8812F(x) | BIT_R_TXBF0_AID_8812F(v)) -+ -+/* 2 REG_DARFRC_8812F */ -+ -+#define BIT_SHIFT_DARF_RC4_8812F 24 -+#define BIT_MASK_DARF_RC4_8812F 0x1f -+#define BIT_DARF_RC4_8812F(x) \ -+ (((x) & BIT_MASK_DARF_RC4_8812F) << BIT_SHIFT_DARF_RC4_8812F) -+#define BITS_DARF_RC4_8812F \ -+ (BIT_MASK_DARF_RC4_8812F << BIT_SHIFT_DARF_RC4_8812F) -+#define BIT_CLEAR_DARF_RC4_8812F(x) ((x) & (~BITS_DARF_RC4_8812F)) -+#define BIT_GET_DARF_RC4_8812F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC4_8812F) & BIT_MASK_DARF_RC4_8812F) -+#define BIT_SET_DARF_RC4_8812F(x, v) \ -+ (BIT_CLEAR_DARF_RC4_8812F(x) | BIT_DARF_RC4_8812F(v)) -+ -+#define BIT_SHIFT_DARF_RC3_8812F 16 -+#define BIT_MASK_DARF_RC3_8812F 0x1f -+#define BIT_DARF_RC3_8812F(x) \ -+ (((x) & BIT_MASK_DARF_RC3_8812F) << BIT_SHIFT_DARF_RC3_8812F) -+#define BITS_DARF_RC3_8812F \ -+ (BIT_MASK_DARF_RC3_8812F << BIT_SHIFT_DARF_RC3_8812F) -+#define BIT_CLEAR_DARF_RC3_8812F(x) ((x) & (~BITS_DARF_RC3_8812F)) -+#define BIT_GET_DARF_RC3_8812F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC3_8812F) & BIT_MASK_DARF_RC3_8812F) -+#define BIT_SET_DARF_RC3_8812F(x, v) \ -+ (BIT_CLEAR_DARF_RC3_8812F(x) | BIT_DARF_RC3_8812F(v)) -+ -+#define BIT_SHIFT_DARF_RC2_8812F 8 -+#define BIT_MASK_DARF_RC2_8812F 0x1f -+#define BIT_DARF_RC2_8812F(x) \ -+ (((x) & BIT_MASK_DARF_RC2_8812F) << BIT_SHIFT_DARF_RC2_8812F) -+#define BITS_DARF_RC2_8812F \ -+ (BIT_MASK_DARF_RC2_8812F << BIT_SHIFT_DARF_RC2_8812F) -+#define BIT_CLEAR_DARF_RC2_8812F(x) ((x) & (~BITS_DARF_RC2_8812F)) -+#define BIT_GET_DARF_RC2_8812F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC2_8812F) & BIT_MASK_DARF_RC2_8812F) -+#define BIT_SET_DARF_RC2_8812F(x, v) \ -+ (BIT_CLEAR_DARF_RC2_8812F(x) | BIT_DARF_RC2_8812F(v)) -+ -+#define BIT_SHIFT_DARF_RC1_8812F 0 -+#define BIT_MASK_DARF_RC1_8812F 0x1f -+#define BIT_DARF_RC1_8812F(x) \ -+ (((x) & BIT_MASK_DARF_RC1_8812F) << BIT_SHIFT_DARF_RC1_8812F) -+#define BITS_DARF_RC1_8812F \ -+ (BIT_MASK_DARF_RC1_8812F << BIT_SHIFT_DARF_RC1_8812F) -+#define BIT_CLEAR_DARF_RC1_8812F(x) ((x) & (~BITS_DARF_RC1_8812F)) -+#define BIT_GET_DARF_RC1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC1_8812F) & BIT_MASK_DARF_RC1_8812F) -+#define BIT_SET_DARF_RC1_8812F(x, v) \ -+ (BIT_CLEAR_DARF_RC1_8812F(x) | BIT_DARF_RC1_8812F(v)) -+ -+/* 2 REG_DARFRCH_8812F */ -+ -+#define BIT_SHIFT_DARF_RC8_V1_8812F 24 -+#define BIT_MASK_DARF_RC8_V1_8812F 0x1f -+#define BIT_DARF_RC8_V1_8812F(x) \ -+ (((x) & BIT_MASK_DARF_RC8_V1_8812F) << BIT_SHIFT_DARF_RC8_V1_8812F) -+#define BITS_DARF_RC8_V1_8812F \ -+ (BIT_MASK_DARF_RC8_V1_8812F << BIT_SHIFT_DARF_RC8_V1_8812F) -+#define BIT_CLEAR_DARF_RC8_V1_8812F(x) ((x) & (~BITS_DARF_RC8_V1_8812F)) -+#define BIT_GET_DARF_RC8_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC8_V1_8812F) & BIT_MASK_DARF_RC8_V1_8812F) -+#define BIT_SET_DARF_RC8_V1_8812F(x, v) \ -+ (BIT_CLEAR_DARF_RC8_V1_8812F(x) | BIT_DARF_RC8_V1_8812F(v)) -+ -+#define BIT_SHIFT_DARF_RC7_V1_8812F 16 -+#define BIT_MASK_DARF_RC7_V1_8812F 0x1f -+#define BIT_DARF_RC7_V1_8812F(x) \ -+ (((x) & BIT_MASK_DARF_RC7_V1_8812F) << BIT_SHIFT_DARF_RC7_V1_8812F) -+#define BITS_DARF_RC7_V1_8812F \ -+ (BIT_MASK_DARF_RC7_V1_8812F << BIT_SHIFT_DARF_RC7_V1_8812F) -+#define BIT_CLEAR_DARF_RC7_V1_8812F(x) ((x) & (~BITS_DARF_RC7_V1_8812F)) -+#define BIT_GET_DARF_RC7_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC7_V1_8812F) & BIT_MASK_DARF_RC7_V1_8812F) -+#define BIT_SET_DARF_RC7_V1_8812F(x, v) \ -+ (BIT_CLEAR_DARF_RC7_V1_8812F(x) | BIT_DARF_RC7_V1_8812F(v)) -+ -+#define BIT_SHIFT_DARF_RC6_V1_8812F 8 -+#define BIT_MASK_DARF_RC6_V1_8812F 0x1f -+#define BIT_DARF_RC6_V1_8812F(x) \ -+ (((x) & BIT_MASK_DARF_RC6_V1_8812F) << BIT_SHIFT_DARF_RC6_V1_8812F) -+#define BITS_DARF_RC6_V1_8812F \ -+ (BIT_MASK_DARF_RC6_V1_8812F << BIT_SHIFT_DARF_RC6_V1_8812F) -+#define BIT_CLEAR_DARF_RC6_V1_8812F(x) ((x) & (~BITS_DARF_RC6_V1_8812F)) -+#define BIT_GET_DARF_RC6_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC6_V1_8812F) & BIT_MASK_DARF_RC6_V1_8812F) -+#define BIT_SET_DARF_RC6_V1_8812F(x, v) \ -+ (BIT_CLEAR_DARF_RC6_V1_8812F(x) | BIT_DARF_RC6_V1_8812F(v)) -+ -+#define BIT_SHIFT_DARF_RC5_V1_8812F 0 -+#define BIT_MASK_DARF_RC5_V1_8812F 0x1f -+#define BIT_DARF_RC5_V1_8812F(x) \ -+ (((x) & BIT_MASK_DARF_RC5_V1_8812F) << BIT_SHIFT_DARF_RC5_V1_8812F) -+#define BITS_DARF_RC5_V1_8812F \ -+ (BIT_MASK_DARF_RC5_V1_8812F << BIT_SHIFT_DARF_RC5_V1_8812F) -+#define BIT_CLEAR_DARF_RC5_V1_8812F(x) ((x) & (~BITS_DARF_RC5_V1_8812F)) -+#define BIT_GET_DARF_RC5_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC5_V1_8812F) & BIT_MASK_DARF_RC5_V1_8812F) -+#define BIT_SET_DARF_RC5_V1_8812F(x, v) \ -+ (BIT_CLEAR_DARF_RC5_V1_8812F(x) | BIT_DARF_RC5_V1_8812F(v)) -+ -+/* 2 REG_RARFRC_8812F */ -+ -+#define BIT_SHIFT_RARF_RC4_8812F 24 -+#define BIT_MASK_RARF_RC4_8812F 0x1f -+#define BIT_RARF_RC4_8812F(x) \ -+ (((x) & BIT_MASK_RARF_RC4_8812F) << BIT_SHIFT_RARF_RC4_8812F) -+#define BITS_RARF_RC4_8812F \ -+ (BIT_MASK_RARF_RC4_8812F << BIT_SHIFT_RARF_RC4_8812F) -+#define BIT_CLEAR_RARF_RC4_8812F(x) ((x) & (~BITS_RARF_RC4_8812F)) -+#define BIT_GET_RARF_RC4_8812F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC4_8812F) & BIT_MASK_RARF_RC4_8812F) -+#define BIT_SET_RARF_RC4_8812F(x, v) \ -+ (BIT_CLEAR_RARF_RC4_8812F(x) | BIT_RARF_RC4_8812F(v)) -+ -+#define BIT_SHIFT_RARF_RC3_8812F 16 -+#define BIT_MASK_RARF_RC3_8812F 0x1f -+#define BIT_RARF_RC3_8812F(x) \ -+ (((x) & BIT_MASK_RARF_RC3_8812F) << BIT_SHIFT_RARF_RC3_8812F) -+#define BITS_RARF_RC3_8812F \ -+ (BIT_MASK_RARF_RC3_8812F << BIT_SHIFT_RARF_RC3_8812F) -+#define BIT_CLEAR_RARF_RC3_8812F(x) ((x) & (~BITS_RARF_RC3_8812F)) -+#define BIT_GET_RARF_RC3_8812F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC3_8812F) & BIT_MASK_RARF_RC3_8812F) -+#define BIT_SET_RARF_RC3_8812F(x, v) \ -+ (BIT_CLEAR_RARF_RC3_8812F(x) | BIT_RARF_RC3_8812F(v)) -+ -+#define BIT_SHIFT_RARF_RC2_8812F 8 -+#define BIT_MASK_RARF_RC2_8812F 0x1f -+#define BIT_RARF_RC2_8812F(x) \ -+ (((x) & BIT_MASK_RARF_RC2_8812F) << BIT_SHIFT_RARF_RC2_8812F) -+#define BITS_RARF_RC2_8812F \ -+ (BIT_MASK_RARF_RC2_8812F << BIT_SHIFT_RARF_RC2_8812F) -+#define BIT_CLEAR_RARF_RC2_8812F(x) ((x) & (~BITS_RARF_RC2_8812F)) -+#define BIT_GET_RARF_RC2_8812F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC2_8812F) & BIT_MASK_RARF_RC2_8812F) -+#define BIT_SET_RARF_RC2_8812F(x, v) \ -+ (BIT_CLEAR_RARF_RC2_8812F(x) | BIT_RARF_RC2_8812F(v)) -+ -+#define BIT_SHIFT_RARF_RC1_8812F 0 -+#define BIT_MASK_RARF_RC1_8812F 0x1f -+#define BIT_RARF_RC1_8812F(x) \ -+ (((x) & BIT_MASK_RARF_RC1_8812F) << BIT_SHIFT_RARF_RC1_8812F) -+#define BITS_RARF_RC1_8812F \ -+ (BIT_MASK_RARF_RC1_8812F << BIT_SHIFT_RARF_RC1_8812F) -+#define BIT_CLEAR_RARF_RC1_8812F(x) ((x) & (~BITS_RARF_RC1_8812F)) -+#define BIT_GET_RARF_RC1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC1_8812F) & BIT_MASK_RARF_RC1_8812F) -+#define BIT_SET_RARF_RC1_8812F(x, v) \ -+ (BIT_CLEAR_RARF_RC1_8812F(x) | BIT_RARF_RC1_8812F(v)) -+ -+/* 2 REG_RARFRCH_8812F */ -+ -+#define BIT_SHIFT_RARF_RC8_V1_8812F 24 -+#define BIT_MASK_RARF_RC8_V1_8812F 0x1f -+#define BIT_RARF_RC8_V1_8812F(x) \ -+ (((x) & BIT_MASK_RARF_RC8_V1_8812F) << BIT_SHIFT_RARF_RC8_V1_8812F) -+#define BITS_RARF_RC8_V1_8812F \ -+ (BIT_MASK_RARF_RC8_V1_8812F << BIT_SHIFT_RARF_RC8_V1_8812F) -+#define BIT_CLEAR_RARF_RC8_V1_8812F(x) ((x) & (~BITS_RARF_RC8_V1_8812F)) -+#define BIT_GET_RARF_RC8_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC8_V1_8812F) & BIT_MASK_RARF_RC8_V1_8812F) -+#define BIT_SET_RARF_RC8_V1_8812F(x, v) \ -+ (BIT_CLEAR_RARF_RC8_V1_8812F(x) | BIT_RARF_RC8_V1_8812F(v)) -+ -+#define BIT_SHIFT_RARF_RC7_V1_8812F 16 -+#define BIT_MASK_RARF_RC7_V1_8812F 0x1f -+#define BIT_RARF_RC7_V1_8812F(x) \ -+ (((x) & BIT_MASK_RARF_RC7_V1_8812F) << BIT_SHIFT_RARF_RC7_V1_8812F) -+#define BITS_RARF_RC7_V1_8812F \ -+ (BIT_MASK_RARF_RC7_V1_8812F << BIT_SHIFT_RARF_RC7_V1_8812F) -+#define BIT_CLEAR_RARF_RC7_V1_8812F(x) ((x) & (~BITS_RARF_RC7_V1_8812F)) -+#define BIT_GET_RARF_RC7_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC7_V1_8812F) & BIT_MASK_RARF_RC7_V1_8812F) -+#define BIT_SET_RARF_RC7_V1_8812F(x, v) \ -+ (BIT_CLEAR_RARF_RC7_V1_8812F(x) | BIT_RARF_RC7_V1_8812F(v)) -+ -+#define BIT_SHIFT_RARF_RC6_V1_8812F 8 -+#define BIT_MASK_RARF_RC6_V1_8812F 0x1f -+#define BIT_RARF_RC6_V1_8812F(x) \ -+ (((x) & BIT_MASK_RARF_RC6_V1_8812F) << BIT_SHIFT_RARF_RC6_V1_8812F) -+#define BITS_RARF_RC6_V1_8812F \ -+ (BIT_MASK_RARF_RC6_V1_8812F << BIT_SHIFT_RARF_RC6_V1_8812F) -+#define BIT_CLEAR_RARF_RC6_V1_8812F(x) ((x) & (~BITS_RARF_RC6_V1_8812F)) -+#define BIT_GET_RARF_RC6_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC6_V1_8812F) & BIT_MASK_RARF_RC6_V1_8812F) -+#define BIT_SET_RARF_RC6_V1_8812F(x, v) \ -+ (BIT_CLEAR_RARF_RC6_V1_8812F(x) | BIT_RARF_RC6_V1_8812F(v)) -+ -+#define BIT_SHIFT_RARF_RC5_V1_8812F 0 -+#define BIT_MASK_RARF_RC5_V1_8812F 0x1f -+#define BIT_RARF_RC5_V1_8812F(x) \ -+ (((x) & BIT_MASK_RARF_RC5_V1_8812F) << BIT_SHIFT_RARF_RC5_V1_8812F) -+#define BITS_RARF_RC5_V1_8812F \ -+ (BIT_MASK_RARF_RC5_V1_8812F << BIT_SHIFT_RARF_RC5_V1_8812F) -+#define BIT_CLEAR_RARF_RC5_V1_8812F(x) ((x) & (~BITS_RARF_RC5_V1_8812F)) -+#define BIT_GET_RARF_RC5_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC5_V1_8812F) & BIT_MASK_RARF_RC5_V1_8812F) -+#define BIT_SET_RARF_RC5_V1_8812F(x, v) \ -+ (BIT_CLEAR_RARF_RC5_V1_8812F(x) | BIT_RARF_RC5_V1_8812F(v)) -+ -+/* 2 REG_RRSR_8812F */ -+ -+#define BIT_SHIFT_RRSR_RSC_8812F 21 -+#define BIT_MASK_RRSR_RSC_8812F 0x3 -+#define BIT_RRSR_RSC_8812F(x) \ -+ (((x) & BIT_MASK_RRSR_RSC_8812F) << BIT_SHIFT_RRSR_RSC_8812F) -+#define BITS_RRSR_RSC_8812F \ -+ (BIT_MASK_RRSR_RSC_8812F << BIT_SHIFT_RRSR_RSC_8812F) -+#define BIT_CLEAR_RRSR_RSC_8812F(x) ((x) & (~BITS_RRSR_RSC_8812F)) -+#define BIT_GET_RRSR_RSC_8812F(x) \ -+ (((x) >> BIT_SHIFT_RRSR_RSC_8812F) & BIT_MASK_RRSR_RSC_8812F) -+#define BIT_SET_RRSR_RSC_8812F(x, v) \ -+ (BIT_CLEAR_RRSR_RSC_8812F(x) | BIT_RRSR_RSC_8812F(v)) -+ -+#define BIT_SHIFT_RRSC_BITMAP_8812F 0 -+#define BIT_MASK_RRSC_BITMAP_8812F 0xfffff -+#define BIT_RRSC_BITMAP_8812F(x) \ -+ (((x) & BIT_MASK_RRSC_BITMAP_8812F) << BIT_SHIFT_RRSC_BITMAP_8812F) -+#define BITS_RRSC_BITMAP_8812F \ -+ (BIT_MASK_RRSC_BITMAP_8812F << BIT_SHIFT_RRSC_BITMAP_8812F) -+#define BIT_CLEAR_RRSC_BITMAP_8812F(x) ((x) & (~BITS_RRSC_BITMAP_8812F)) -+#define BIT_GET_RRSC_BITMAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_RRSC_BITMAP_8812F) & BIT_MASK_RRSC_BITMAP_8812F) -+#define BIT_SET_RRSC_BITMAP_8812F(x, v) \ -+ (BIT_CLEAR_RRSC_BITMAP_8812F(x) | BIT_RRSC_BITMAP_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_ARFR0_8812F */ -+ -+#define BIT_SHIFT_ARFRL0_8812F 0 -+#define BIT_MASK_ARFRL0_8812F 0xffffffffL -+#define BIT_ARFRL0_8812F(x) \ -+ (((x) & BIT_MASK_ARFRL0_8812F) << BIT_SHIFT_ARFRL0_8812F) -+#define BITS_ARFRL0_8812F (BIT_MASK_ARFRL0_8812F << BIT_SHIFT_ARFRL0_8812F) -+#define BIT_CLEAR_ARFRL0_8812F(x) ((x) & (~BITS_ARFRL0_8812F)) -+#define BIT_GET_ARFRL0_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRL0_8812F) & BIT_MASK_ARFRL0_8812F) -+#define BIT_SET_ARFRL0_8812F(x, v) \ -+ (BIT_CLEAR_ARFRL0_8812F(x) | BIT_ARFRL0_8812F(v)) -+ -+/* 2 REG_ARFRH0_8812F */ -+ -+#define BIT_SHIFT_ARFRH0_8812F 0 -+#define BIT_MASK_ARFRH0_8812F 0xffffffffL -+#define BIT_ARFRH0_8812F(x) \ -+ (((x) & BIT_MASK_ARFRH0_8812F) << BIT_SHIFT_ARFRH0_8812F) -+#define BITS_ARFRH0_8812F (BIT_MASK_ARFRH0_8812F << BIT_SHIFT_ARFRH0_8812F) -+#define BIT_CLEAR_ARFRH0_8812F(x) ((x) & (~BITS_ARFRH0_8812F)) -+#define BIT_GET_ARFRH0_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRH0_8812F) & BIT_MASK_ARFRH0_8812F) -+#define BIT_SET_ARFRH0_8812F(x, v) \ -+ (BIT_CLEAR_ARFRH0_8812F(x) | BIT_ARFRH0_8812F(v)) -+ -+/* 2 REG_ARFR1_V1_8812F */ -+ -+#define BIT_SHIFT_ARFRL1_8812F 0 -+#define BIT_MASK_ARFRL1_8812F 0xffffffffL -+#define BIT_ARFRL1_8812F(x) \ -+ (((x) & BIT_MASK_ARFRL1_8812F) << BIT_SHIFT_ARFRL1_8812F) -+#define BITS_ARFRL1_8812F (BIT_MASK_ARFRL1_8812F << BIT_SHIFT_ARFRL1_8812F) -+#define BIT_CLEAR_ARFRL1_8812F(x) ((x) & (~BITS_ARFRL1_8812F)) -+#define BIT_GET_ARFRL1_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRL1_8812F) & BIT_MASK_ARFRL1_8812F) -+#define BIT_SET_ARFRL1_8812F(x, v) \ -+ (BIT_CLEAR_ARFRL1_8812F(x) | BIT_ARFRL1_8812F(v)) -+ -+/* 2 REG_ARFRH1_V1_8812F */ -+ -+#define BIT_SHIFT_ARFRH1_8812F 0 -+#define BIT_MASK_ARFRH1_8812F 0xffffffffL -+#define BIT_ARFRH1_8812F(x) \ -+ (((x) & BIT_MASK_ARFRH1_8812F) << BIT_SHIFT_ARFRH1_8812F) -+#define BITS_ARFRH1_8812F (BIT_MASK_ARFRH1_8812F << BIT_SHIFT_ARFRH1_8812F) -+#define BIT_CLEAR_ARFRH1_8812F(x) ((x) & (~BITS_ARFRH1_8812F)) -+#define BIT_GET_ARFRH1_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRH1_8812F) & BIT_MASK_ARFRH1_8812F) -+#define BIT_SET_ARFRH1_8812F(x, v) \ -+ (BIT_CLEAR_ARFRH1_8812F(x) | BIT_ARFRH1_8812F(v)) -+ -+/* 2 REG_CCK_CHECK_8812F */ -+#define BIT_CHECK_CCK_EN_8812F BIT(7) -+#define BIT_EN_BCN_PKT_REL_8812F BIT(6) -+#define BIT_BCN_PORT_SEL_8812F BIT(5) -+#define BIT_MOREDATA_BYPASS_8812F BIT(4) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_8812F BIT(3) -+#define BIT_R_EN_SET_MOREDATA_8812F BIT(2) -+#define BIT__R_DIS_CLEAR_MACID_RELEASE_8812F BIT(1) -+#define BIT__R_MACID_RELEASE_EN_8812F BIT(0) -+ -+/* 2 REG_AMPDU_MAX_TIME_V1_8812F */ -+ -+#define BIT_SHIFT_AMPDU_MAX_TIME_8812F 0 -+#define BIT_MASK_AMPDU_MAX_TIME_8812F 0xff -+#define BIT_AMPDU_MAX_TIME_8812F(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_TIME_8812F) \ -+ << BIT_SHIFT_AMPDU_MAX_TIME_8812F) -+#define BITS_AMPDU_MAX_TIME_8812F \ -+ (BIT_MASK_AMPDU_MAX_TIME_8812F << BIT_SHIFT_AMPDU_MAX_TIME_8812F) -+#define BIT_CLEAR_AMPDU_MAX_TIME_8812F(x) ((x) & (~BITS_AMPDU_MAX_TIME_8812F)) -+#define BIT_GET_AMPDU_MAX_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_TIME_8812F) & \ -+ BIT_MASK_AMPDU_MAX_TIME_8812F) -+#define BIT_SET_AMPDU_MAX_TIME_8812F(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_TIME_8812F(x) | BIT_AMPDU_MAX_TIME_8812F(v)) -+ -+/* 2 REG_BCNQ1_BDNY_V1_8812F */ -+ -+#define BIT_SHIFT_BCNQ1_PGBNDY_V1_8812F 0 -+#define BIT_MASK_BCNQ1_PGBNDY_V1_8812F 0xfff -+#define BIT_BCNQ1_PGBNDY_V1_8812F(x) \ -+ (((x) & BIT_MASK_BCNQ1_PGBNDY_V1_8812F) \ -+ << BIT_SHIFT_BCNQ1_PGBNDY_V1_8812F) -+#define BITS_BCNQ1_PGBNDY_V1_8812F \ -+ (BIT_MASK_BCNQ1_PGBNDY_V1_8812F << BIT_SHIFT_BCNQ1_PGBNDY_V1_8812F) -+#define BIT_CLEAR_BCNQ1_PGBNDY_V1_8812F(x) ((x) & (~BITS_BCNQ1_PGBNDY_V1_8812F)) -+#define BIT_GET_BCNQ1_PGBNDY_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ1_PGBNDY_V1_8812F) & \ -+ BIT_MASK_BCNQ1_PGBNDY_V1_8812F) -+#define BIT_SET_BCNQ1_PGBNDY_V1_8812F(x, v) \ -+ (BIT_CLEAR_BCNQ1_PGBNDY_V1_8812F(x) | BIT_BCNQ1_PGBNDY_V1_8812F(v)) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_AMPDU_MAX_LENGTH_HT_8812F */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8812F 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_HT_8812F 0xffff -+#define BIT_AMPDU_MAX_LENGTH_HT_8812F(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_HT_8812F) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8812F) -+#define BITS_AMPDU_MAX_LENGTH_HT_8812F \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_HT_8812F \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8812F) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_HT_8812F(x) \ -+ ((x) & (~BITS_AMPDU_MAX_LENGTH_HT_8812F)) -+#define BIT_GET_AMPDU_MAX_LENGTH_HT_8812F(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8812F) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_HT_8812F) -+#define BIT_SET_AMPDU_MAX_LENGTH_HT_8812F(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_HT_8812F(x) | \ -+ BIT_AMPDU_MAX_LENGTH_HT_8812F(v)) -+ -+/* 2 REG_ACQ_STOP_8812F */ -+#define BIT_AC7Q_STOP_8812F BIT(7) -+#define BIT_AC6Q_STOP_8812F BIT(6) -+#define BIT_AC5Q_STOP_8812F BIT(5) -+#define BIT_AC4Q_STOP_8812F BIT(4) -+#define BIT_AC3Q_STOP_8812F BIT(3) -+#define BIT_AC2Q_STOP_8812F BIT(2) -+#define BIT_AC1Q_STOP_8812F BIT(1) -+#define BIT_AC0Q_STOP_8812F BIT(0) -+ -+/* 2 REG_NDPA_RATE_8812F */ -+ -+#define BIT_SHIFT_R_NDPA_RATE_V1_8812F 0 -+#define BIT_MASK_R_NDPA_RATE_V1_8812F 0xff -+#define BIT_R_NDPA_RATE_V1_8812F(x) \ -+ (((x) & BIT_MASK_R_NDPA_RATE_V1_8812F) \ -+ << BIT_SHIFT_R_NDPA_RATE_V1_8812F) -+#define BITS_R_NDPA_RATE_V1_8812F \ -+ (BIT_MASK_R_NDPA_RATE_V1_8812F << BIT_SHIFT_R_NDPA_RATE_V1_8812F) -+#define BIT_CLEAR_R_NDPA_RATE_V1_8812F(x) ((x) & (~BITS_R_NDPA_RATE_V1_8812F)) -+#define BIT_GET_R_NDPA_RATE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_RATE_V1_8812F) & \ -+ BIT_MASK_R_NDPA_RATE_V1_8812F) -+#define BIT_SET_R_NDPA_RATE_V1_8812F(x, v) \ -+ (BIT_CLEAR_R_NDPA_RATE_V1_8812F(x) | BIT_R_NDPA_RATE_V1_8812F(v)) -+ -+/* 2 REG_TX_HANG_CTRL_8812F */ -+#define BIT_R_EN_GNT_BT_AWAKE_8812F BIT(3) -+#define BIT_EN_EOF_V1_8812F BIT(2) -+#define BIT_DIS_OQT_BLOCK_8812F BIT(1) -+#define BIT_SEARCH_QUEUE_EN_8812F BIT(0) -+ -+/* 2 REG_NDPA_OPT_CTRL_8812F */ -+#define BIT_R_DIS_MACID_RELEASE_RTY_8812F BIT(5) -+ -+#define BIT_SHIFT_BW_SIGTA_8812F 3 -+#define BIT_MASK_BW_SIGTA_8812F 0x3 -+#define BIT_BW_SIGTA_8812F(x) \ -+ (((x) & BIT_MASK_BW_SIGTA_8812F) << BIT_SHIFT_BW_SIGTA_8812F) -+#define BITS_BW_SIGTA_8812F \ -+ (BIT_MASK_BW_SIGTA_8812F << BIT_SHIFT_BW_SIGTA_8812F) -+#define BIT_CLEAR_BW_SIGTA_8812F(x) ((x) & (~BITS_BW_SIGTA_8812F)) -+#define BIT_GET_BW_SIGTA_8812F(x) \ -+ (((x) >> BIT_SHIFT_BW_SIGTA_8812F) & BIT_MASK_BW_SIGTA_8812F) -+#define BIT_SET_BW_SIGTA_8812F(x, v) \ -+ (BIT_CLEAR_BW_SIGTA_8812F(x) | BIT_BW_SIGTA_8812F(v)) -+ -+#define BIT_EN_BAR_SIGTA_8812F BIT(2) -+ -+#define BIT_SHIFT_R_NDPA_BW_8812F 0 -+#define BIT_MASK_R_NDPA_BW_8812F 0x3 -+#define BIT_R_NDPA_BW_8812F(x) \ -+ (((x) & BIT_MASK_R_NDPA_BW_8812F) << BIT_SHIFT_R_NDPA_BW_8812F) -+#define BITS_R_NDPA_BW_8812F \ -+ (BIT_MASK_R_NDPA_BW_8812F << BIT_SHIFT_R_NDPA_BW_8812F) -+#define BIT_CLEAR_R_NDPA_BW_8812F(x) ((x) & (~BITS_R_NDPA_BW_8812F)) -+#define BIT_GET_R_NDPA_BW_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_BW_8812F) & BIT_MASK_R_NDPA_BW_8812F) -+#define BIT_SET_R_NDPA_BW_8812F(x, v) \ -+ (BIT_CLEAR_R_NDPA_BW_8812F(x) | BIT_R_NDPA_BW_8812F(v)) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_VHT_8812F */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1_8812F 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1_8812F 0xfffff -+#define BIT_AMPDU_MAX_LENGTH_VHT_V1_8812F(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1_8812F) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1_8812F) -+#define BITS_AMPDU_MAX_LENGTH_VHT_V1_8812F \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1_8812F \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1_8812F) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_VHT_V1_8812F(x) \ -+ ((x) & (~BITS_AMPDU_MAX_LENGTH_VHT_V1_8812F)) -+#define BIT_GET_AMPDU_MAX_LENGTH_VHT_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1_8812F) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1_8812F) -+#define BIT_SET_AMPDU_MAX_LENGTH_VHT_V1_8812F(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_VHT_V1_8812F(x) | \ -+ BIT_AMPDU_MAX_LENGTH_VHT_V1_8812F(v)) -+ -+/* 2 REG_RD_RESP_PKT_TH_8812F */ -+ -+#define BIT_SHIFT_RD_RESP_PKT_TH_V1_8812F 0 -+#define BIT_MASK_RD_RESP_PKT_TH_V1_8812F 0x3f -+#define BIT_RD_RESP_PKT_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_RD_RESP_PKT_TH_V1_8812F) \ -+ << BIT_SHIFT_RD_RESP_PKT_TH_V1_8812F) -+#define BITS_RD_RESP_PKT_TH_V1_8812F \ -+ (BIT_MASK_RD_RESP_PKT_TH_V1_8812F << BIT_SHIFT_RD_RESP_PKT_TH_V1_8812F) -+#define BIT_CLEAR_RD_RESP_PKT_TH_V1_8812F(x) \ -+ ((x) & (~BITS_RD_RESP_PKT_TH_V1_8812F)) -+#define BIT_GET_RD_RESP_PKT_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RD_RESP_PKT_TH_V1_8812F) & \ -+ BIT_MASK_RD_RESP_PKT_TH_V1_8812F) -+#define BIT_SET_RD_RESP_PKT_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_RD_RESP_PKT_TH_V1_8812F(x) | BIT_RD_RESP_PKT_TH_V1_8812F(v)) -+ -+/* 2 REG_CMDQ_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_CMDQ_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_CMDQ_V1_8812F 0x7f -+#define BIT_QUEUEMACID_CMDQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_CMDQ_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_CMDQ_V1_8812F) -+#define BITS_QUEUEMACID_CMDQ_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_CMDQ_V1_8812F \ -+ << BIT_SHIFT_QUEUEMACID_CMDQ_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_CMDQ_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_CMDQ_V1_8812F)) -+#define BIT_GET_QUEUEMACID_CMDQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_CMDQ_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_CMDQ_V1_8812F) -+#define BIT_SET_QUEUEMACID_CMDQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_CMDQ_V1_8812F(x) | \ -+ BIT_QUEUEMACID_CMDQ_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_CMDQ_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_CMDQ_V1_8812F 0x3 -+#define BIT_QUEUEAC_CMDQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_CMDQ_V1_8812F) \ -+ << BIT_SHIFT_QUEUEAC_CMDQ_V1_8812F) -+#define BITS_QUEUEAC_CMDQ_V1_8812F \ -+ (BIT_MASK_QUEUEAC_CMDQ_V1_8812F << BIT_SHIFT_QUEUEAC_CMDQ_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_CMDQ_V1_8812F(x) ((x) & (~BITS_QUEUEAC_CMDQ_V1_8812F)) -+#define BIT_GET_QUEUEAC_CMDQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_CMDQ_V1_8812F) & \ -+ BIT_MASK_QUEUEAC_CMDQ_V1_8812F) -+#define BIT_SET_QUEUEAC_CMDQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_CMDQ_V1_8812F(x) | BIT_QUEUEAC_CMDQ_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_CMDQ_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q4_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_Q4_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_Q4_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q4_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_Q4_V2_8812F) -+#define BITS_TAIL_PKT_Q4_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_Q4_V2_8812F << BIT_SHIFT_TAIL_PKT_Q4_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_Q4_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_Q4_V2_8812F)) -+#define BIT_GET_TAIL_PKT_Q4_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q4_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_Q4_V2_8812F) -+#define BIT_SET_TAIL_PKT_Q4_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q4_V2_8812F(x) | BIT_TAIL_PKT_Q4_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_CMDQ_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_CMDQ_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_CMDQ_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_CMDQ_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_CMDQ_V1_8812F) -+#define BITS_HEAD_PKT_CMDQ_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_CMDQ_V1_8812F << BIT_SHIFT_HEAD_PKT_CMDQ_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_CMDQ_V1_8812F(x) \ -+ ((x) & (~BITS_HEAD_PKT_CMDQ_V1_8812F)) -+#define BIT_GET_HEAD_PKT_CMDQ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_CMDQ_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_CMDQ_V1_8812F) -+#define BIT_SET_HEAD_PKT_CMDQ_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_CMDQ_V1_8812F(x) | BIT_HEAD_PKT_CMDQ_V1_8812F(v)) -+ -+/* 2 REG_Q4_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q4_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_Q4_V1_8812F 0x7f -+#define BIT_QUEUEMACID_Q4_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q4_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_Q4_V1_8812F) -+#define BITS_QUEUEMACID_Q4_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_Q4_V1_8812F << BIT_SHIFT_QUEUEMACID_Q4_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_Q4_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q4_V1_8812F)) -+#define BIT_GET_QUEUEMACID_Q4_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q4_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_Q4_V1_8812F) -+#define BIT_SET_QUEUEMACID_Q4_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q4_V1_8812F(x) | BIT_QUEUEMACID_Q4_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q4_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_Q4_V1_8812F 0x3 -+#define BIT_QUEUEAC_Q4_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q4_V1_8812F) << BIT_SHIFT_QUEUEAC_Q4_V1_8812F) -+#define BITS_QUEUEAC_Q4_V1_8812F \ -+ (BIT_MASK_QUEUEAC_Q4_V1_8812F << BIT_SHIFT_QUEUEAC_Q4_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_Q4_V1_8812F(x) ((x) & (~BITS_QUEUEAC_Q4_V1_8812F)) -+#define BIT_GET_QUEUEAC_Q4_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q4_V1_8812F) & BIT_MASK_QUEUEAC_Q4_V1_8812F) -+#define BIT_SET_QUEUEAC_Q4_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q4_V1_8812F(x) | BIT_QUEUEAC_Q4_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_Q4_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q4_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_Q4_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_Q4_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q4_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_Q4_V2_8812F) -+#define BITS_TAIL_PKT_Q4_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_Q4_V2_8812F << BIT_SHIFT_TAIL_PKT_Q4_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_Q4_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_Q4_V2_8812F)) -+#define BIT_GET_TAIL_PKT_Q4_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q4_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_Q4_V2_8812F) -+#define BIT_SET_TAIL_PKT_Q4_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q4_V2_8812F(x) | BIT_TAIL_PKT_Q4_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q4_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_Q4_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_Q4_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q4_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_Q4_V1_8812F) -+#define BITS_HEAD_PKT_Q4_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_Q4_V1_8812F << BIT_SHIFT_HEAD_PKT_Q4_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_Q4_V1_8812F(x) ((x) & (~BITS_HEAD_PKT_Q4_V1_8812F)) -+#define BIT_GET_HEAD_PKT_Q4_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q4_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_Q4_V1_8812F) -+#define BIT_SET_HEAD_PKT_Q4_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q4_V1_8812F(x) | BIT_HEAD_PKT_Q4_V1_8812F(v)) -+ -+/* 2 REG_Q5_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q5_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_Q5_V1_8812F 0x7f -+#define BIT_QUEUEMACID_Q5_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q5_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_Q5_V1_8812F) -+#define BITS_QUEUEMACID_Q5_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_Q5_V1_8812F << BIT_SHIFT_QUEUEMACID_Q5_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_Q5_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q5_V1_8812F)) -+#define BIT_GET_QUEUEMACID_Q5_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q5_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_Q5_V1_8812F) -+#define BIT_SET_QUEUEMACID_Q5_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q5_V1_8812F(x) | BIT_QUEUEMACID_Q5_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q5_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_Q5_V1_8812F 0x3 -+#define BIT_QUEUEAC_Q5_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q5_V1_8812F) << BIT_SHIFT_QUEUEAC_Q5_V1_8812F) -+#define BITS_QUEUEAC_Q5_V1_8812F \ -+ (BIT_MASK_QUEUEAC_Q5_V1_8812F << BIT_SHIFT_QUEUEAC_Q5_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_Q5_V1_8812F(x) ((x) & (~BITS_QUEUEAC_Q5_V1_8812F)) -+#define BIT_GET_QUEUEAC_Q5_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q5_V1_8812F) & BIT_MASK_QUEUEAC_Q5_V1_8812F) -+#define BIT_SET_QUEUEAC_Q5_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q5_V1_8812F(x) | BIT_QUEUEAC_Q5_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_Q5_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q5_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_Q5_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_Q5_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q5_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_Q5_V2_8812F) -+#define BITS_TAIL_PKT_Q5_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_Q5_V2_8812F << BIT_SHIFT_TAIL_PKT_Q5_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_Q5_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_Q5_V2_8812F)) -+#define BIT_GET_TAIL_PKT_Q5_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q5_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_Q5_V2_8812F) -+#define BIT_SET_TAIL_PKT_Q5_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q5_V2_8812F(x) | BIT_TAIL_PKT_Q5_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q5_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_Q5_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_Q5_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q5_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_Q5_V1_8812F) -+#define BITS_HEAD_PKT_Q5_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_Q5_V1_8812F << BIT_SHIFT_HEAD_PKT_Q5_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_Q5_V1_8812F(x) ((x) & (~BITS_HEAD_PKT_Q5_V1_8812F)) -+#define BIT_GET_HEAD_PKT_Q5_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q5_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_Q5_V1_8812F) -+#define BIT_SET_HEAD_PKT_Q5_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q5_V1_8812F(x) | BIT_HEAD_PKT_Q5_V1_8812F(v)) -+ -+/* 2 REG_Q6_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q6_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_Q6_V1_8812F 0x7f -+#define BIT_QUEUEMACID_Q6_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q6_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_Q6_V1_8812F) -+#define BITS_QUEUEMACID_Q6_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_Q6_V1_8812F << BIT_SHIFT_QUEUEMACID_Q6_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_Q6_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q6_V1_8812F)) -+#define BIT_GET_QUEUEMACID_Q6_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q6_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_Q6_V1_8812F) -+#define BIT_SET_QUEUEMACID_Q6_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q6_V1_8812F(x) | BIT_QUEUEMACID_Q6_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q6_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_Q6_V1_8812F 0x3 -+#define BIT_QUEUEAC_Q6_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q6_V1_8812F) << BIT_SHIFT_QUEUEAC_Q6_V1_8812F) -+#define BITS_QUEUEAC_Q6_V1_8812F \ -+ (BIT_MASK_QUEUEAC_Q6_V1_8812F << BIT_SHIFT_QUEUEAC_Q6_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_Q6_V1_8812F(x) ((x) & (~BITS_QUEUEAC_Q6_V1_8812F)) -+#define BIT_GET_QUEUEAC_Q6_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q6_V1_8812F) & BIT_MASK_QUEUEAC_Q6_V1_8812F) -+#define BIT_SET_QUEUEAC_Q6_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q6_V1_8812F(x) | BIT_QUEUEAC_Q6_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_Q6_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q6_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_Q6_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_Q6_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q6_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_Q6_V2_8812F) -+#define BITS_TAIL_PKT_Q6_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_Q6_V2_8812F << BIT_SHIFT_TAIL_PKT_Q6_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_Q6_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_Q6_V2_8812F)) -+#define BIT_GET_TAIL_PKT_Q6_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q6_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_Q6_V2_8812F) -+#define BIT_SET_TAIL_PKT_Q6_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q6_V2_8812F(x) | BIT_TAIL_PKT_Q6_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q6_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_Q6_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_Q6_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q6_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_Q6_V1_8812F) -+#define BITS_HEAD_PKT_Q6_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_Q6_V1_8812F << BIT_SHIFT_HEAD_PKT_Q6_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_Q6_V1_8812F(x) ((x) & (~BITS_HEAD_PKT_Q6_V1_8812F)) -+#define BIT_GET_HEAD_PKT_Q6_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q6_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_Q6_V1_8812F) -+#define BIT_SET_HEAD_PKT_Q6_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q6_V1_8812F(x) | BIT_HEAD_PKT_Q6_V1_8812F(v)) -+ -+/* 2 REG_Q7_INFO_8812F */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q7_V1_8812F 25 -+#define BIT_MASK_QUEUEMACID_Q7_V1_8812F 0x7f -+#define BIT_QUEUEMACID_Q7_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q7_V1_8812F) \ -+ << BIT_SHIFT_QUEUEMACID_Q7_V1_8812F) -+#define BITS_QUEUEMACID_Q7_V1_8812F \ -+ (BIT_MASK_QUEUEMACID_Q7_V1_8812F << BIT_SHIFT_QUEUEMACID_Q7_V1_8812F) -+#define BIT_CLEAR_QUEUEMACID_Q7_V1_8812F(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q7_V1_8812F)) -+#define BIT_GET_QUEUEMACID_Q7_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q7_V1_8812F) & \ -+ BIT_MASK_QUEUEMACID_Q7_V1_8812F) -+#define BIT_SET_QUEUEMACID_Q7_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q7_V1_8812F(x) | BIT_QUEUEMACID_Q7_V1_8812F(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q7_V1_8812F 23 -+#define BIT_MASK_QUEUEAC_Q7_V1_8812F 0x3 -+#define BIT_QUEUEAC_Q7_V1_8812F(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q7_V1_8812F) << BIT_SHIFT_QUEUEAC_Q7_V1_8812F) -+#define BITS_QUEUEAC_Q7_V1_8812F \ -+ (BIT_MASK_QUEUEAC_Q7_V1_8812F << BIT_SHIFT_QUEUEAC_Q7_V1_8812F) -+#define BIT_CLEAR_QUEUEAC_Q7_V1_8812F(x) ((x) & (~BITS_QUEUEAC_Q7_V1_8812F)) -+#define BIT_GET_QUEUEAC_Q7_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q7_V1_8812F) & BIT_MASK_QUEUEAC_Q7_V1_8812F) -+#define BIT_SET_QUEUEAC_Q7_V1_8812F(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q7_V1_8812F(x) | BIT_QUEUEAC_Q7_V1_8812F(v)) -+ -+#define BIT_TIDEMPTY_Q7_V1_8812F BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q7_V2_8812F 11 -+#define BIT_MASK_TAIL_PKT_Q7_V2_8812F 0x7ff -+#define BIT_TAIL_PKT_Q7_V2_8812F(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q7_V2_8812F) \ -+ << BIT_SHIFT_TAIL_PKT_Q7_V2_8812F) -+#define BITS_TAIL_PKT_Q7_V2_8812F \ -+ (BIT_MASK_TAIL_PKT_Q7_V2_8812F << BIT_SHIFT_TAIL_PKT_Q7_V2_8812F) -+#define BIT_CLEAR_TAIL_PKT_Q7_V2_8812F(x) ((x) & (~BITS_TAIL_PKT_Q7_V2_8812F)) -+#define BIT_GET_TAIL_PKT_Q7_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q7_V2_8812F) & \ -+ BIT_MASK_TAIL_PKT_Q7_V2_8812F) -+#define BIT_SET_TAIL_PKT_Q7_V2_8812F(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q7_V2_8812F(x) | BIT_TAIL_PKT_Q7_V2_8812F(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q7_V1_8812F 0 -+#define BIT_MASK_HEAD_PKT_Q7_V1_8812F 0x7ff -+#define BIT_HEAD_PKT_Q7_V1_8812F(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q7_V1_8812F) \ -+ << BIT_SHIFT_HEAD_PKT_Q7_V1_8812F) -+#define BITS_HEAD_PKT_Q7_V1_8812F \ -+ (BIT_MASK_HEAD_PKT_Q7_V1_8812F << BIT_SHIFT_HEAD_PKT_Q7_V1_8812F) -+#define BIT_CLEAR_HEAD_PKT_Q7_V1_8812F(x) ((x) & (~BITS_HEAD_PKT_Q7_V1_8812F)) -+#define BIT_GET_HEAD_PKT_Q7_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q7_V1_8812F) & \ -+ BIT_MASK_HEAD_PKT_Q7_V1_8812F) -+#define BIT_SET_HEAD_PKT_Q7_V1_8812F(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q7_V1_8812F(x) | BIT_HEAD_PKT_Q7_V1_8812F(v)) -+ -+/* 2 REG_WMAC_LBK_BUF_HD_V1_8812F */ -+ -+#define BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8812F 0 -+#define BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8812F 0xfff -+#define BIT_WMAC_LBK_BUF_HEAD_V1_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8812F) \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8812F) -+#define BITS_WMAC_LBK_BUF_HEAD_V1_8812F \ -+ (BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8812F \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8812F) -+#define BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8812F(x) \ -+ ((x) & (~BITS_WMAC_LBK_BUF_HEAD_V1_8812F)) -+#define BIT_GET_WMAC_LBK_BUF_HEAD_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8812F) & \ -+ BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8812F) -+#define BIT_SET_WMAC_LBK_BUF_HEAD_V1_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8812F(x) | \ -+ BIT_WMAC_LBK_BUF_HEAD_V1_8812F(v)) -+ -+/* 2 REG_MGQ_BDNY_V1_8812F */ -+ -+#define BIT_SHIFT_MGQ_PGBNDY_V1_8812F 0 -+#define BIT_MASK_MGQ_PGBNDY_V1_8812F 0xfff -+#define BIT_MGQ_PGBNDY_V1_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_PGBNDY_V1_8812F) << BIT_SHIFT_MGQ_PGBNDY_V1_8812F) -+#define BITS_MGQ_PGBNDY_V1_8812F \ -+ (BIT_MASK_MGQ_PGBNDY_V1_8812F << BIT_SHIFT_MGQ_PGBNDY_V1_8812F) -+#define BIT_CLEAR_MGQ_PGBNDY_V1_8812F(x) ((x) & (~BITS_MGQ_PGBNDY_V1_8812F)) -+#define BIT_GET_MGQ_PGBNDY_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PGBNDY_V1_8812F) & BIT_MASK_MGQ_PGBNDY_V1_8812F) -+#define BIT_SET_MGQ_PGBNDY_V1_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_PGBNDY_V1_8812F(x) | BIT_MGQ_PGBNDY_V1_8812F(v)) -+ -+/* 2 REG_TXRPT_CTRL_8812F */ -+ -+#define BIT_SHIFT_TRXRPT_TIMER_TH_8812F 24 -+#define BIT_MASK_TRXRPT_TIMER_TH_8812F 0xff -+#define BIT_TRXRPT_TIMER_TH_8812F(x) \ -+ (((x) & BIT_MASK_TRXRPT_TIMER_TH_8812F) \ -+ << BIT_SHIFT_TRXRPT_TIMER_TH_8812F) -+#define BITS_TRXRPT_TIMER_TH_8812F \ -+ (BIT_MASK_TRXRPT_TIMER_TH_8812F << BIT_SHIFT_TRXRPT_TIMER_TH_8812F) -+#define BIT_CLEAR_TRXRPT_TIMER_TH_8812F(x) ((x) & (~BITS_TRXRPT_TIMER_TH_8812F)) -+#define BIT_GET_TRXRPT_TIMER_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_TIMER_TH_8812F) & \ -+ BIT_MASK_TRXRPT_TIMER_TH_8812F) -+#define BIT_SET_TRXRPT_TIMER_TH_8812F(x, v) \ -+ (BIT_CLEAR_TRXRPT_TIMER_TH_8812F(x) | BIT_TRXRPT_TIMER_TH_8812F(v)) -+ -+#define BIT_SHIFT_TRXRPT_LEN_TH_8812F 16 -+#define BIT_MASK_TRXRPT_LEN_TH_8812F 0xff -+#define BIT_TRXRPT_LEN_TH_8812F(x) \ -+ (((x) & BIT_MASK_TRXRPT_LEN_TH_8812F) << BIT_SHIFT_TRXRPT_LEN_TH_8812F) -+#define BITS_TRXRPT_LEN_TH_8812F \ -+ (BIT_MASK_TRXRPT_LEN_TH_8812F << BIT_SHIFT_TRXRPT_LEN_TH_8812F) -+#define BIT_CLEAR_TRXRPT_LEN_TH_8812F(x) ((x) & (~BITS_TRXRPT_LEN_TH_8812F)) -+#define BIT_GET_TRXRPT_LEN_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_LEN_TH_8812F) & BIT_MASK_TRXRPT_LEN_TH_8812F) -+#define BIT_SET_TRXRPT_LEN_TH_8812F(x, v) \ -+ (BIT_CLEAR_TRXRPT_LEN_TH_8812F(x) | BIT_TRXRPT_LEN_TH_8812F(v)) -+ -+#define BIT_SHIFT_TRXRPT_READ_PTR_8812F 8 -+#define BIT_MASK_TRXRPT_READ_PTR_8812F 0xff -+#define BIT_TRXRPT_READ_PTR_8812F(x) \ -+ (((x) & BIT_MASK_TRXRPT_READ_PTR_8812F) \ -+ << BIT_SHIFT_TRXRPT_READ_PTR_8812F) -+#define BITS_TRXRPT_READ_PTR_8812F \ -+ (BIT_MASK_TRXRPT_READ_PTR_8812F << BIT_SHIFT_TRXRPT_READ_PTR_8812F) -+#define BIT_CLEAR_TRXRPT_READ_PTR_8812F(x) ((x) & (~BITS_TRXRPT_READ_PTR_8812F)) -+#define BIT_GET_TRXRPT_READ_PTR_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_READ_PTR_8812F) & \ -+ BIT_MASK_TRXRPT_READ_PTR_8812F) -+#define BIT_SET_TRXRPT_READ_PTR_8812F(x, v) \ -+ (BIT_CLEAR_TRXRPT_READ_PTR_8812F(x) | BIT_TRXRPT_READ_PTR_8812F(v)) -+ -+#define BIT_SHIFT_TRXRPT_WRITE_PTR_8812F 0 -+#define BIT_MASK_TRXRPT_WRITE_PTR_8812F 0xff -+#define BIT_TRXRPT_WRITE_PTR_8812F(x) \ -+ (((x) & BIT_MASK_TRXRPT_WRITE_PTR_8812F) \ -+ << BIT_SHIFT_TRXRPT_WRITE_PTR_8812F) -+#define BITS_TRXRPT_WRITE_PTR_8812F \ -+ (BIT_MASK_TRXRPT_WRITE_PTR_8812F << BIT_SHIFT_TRXRPT_WRITE_PTR_8812F) -+#define BIT_CLEAR_TRXRPT_WRITE_PTR_8812F(x) \ -+ ((x) & (~BITS_TRXRPT_WRITE_PTR_8812F)) -+#define BIT_GET_TRXRPT_WRITE_PTR_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_WRITE_PTR_8812F) & \ -+ BIT_MASK_TRXRPT_WRITE_PTR_8812F) -+#define BIT_SET_TRXRPT_WRITE_PTR_8812F(x, v) \ -+ (BIT_CLEAR_TRXRPT_WRITE_PTR_8812F(x) | BIT_TRXRPT_WRITE_PTR_8812F(v)) -+ -+/* 2 REG_INIRTS_RATE_SEL_8812F */ -+#define BIT_LEAG_RTS_BW_DUP_8812F BIT(5) -+ -+/* 2 REG_BASIC_CFEND_RATE_8812F */ -+ -+#define BIT_SHIFT_BASIC_CFEND_RATE_8812F 0 -+#define BIT_MASK_BASIC_CFEND_RATE_8812F 0x1f -+#define BIT_BASIC_CFEND_RATE_8812F(x) \ -+ (((x) & BIT_MASK_BASIC_CFEND_RATE_8812F) \ -+ << BIT_SHIFT_BASIC_CFEND_RATE_8812F) -+#define BITS_BASIC_CFEND_RATE_8812F \ -+ (BIT_MASK_BASIC_CFEND_RATE_8812F << BIT_SHIFT_BASIC_CFEND_RATE_8812F) -+#define BIT_CLEAR_BASIC_CFEND_RATE_8812F(x) \ -+ ((x) & (~BITS_BASIC_CFEND_RATE_8812F)) -+#define BIT_GET_BASIC_CFEND_RATE_8812F(x) \ -+ (((x) >> BIT_SHIFT_BASIC_CFEND_RATE_8812F) & \ -+ BIT_MASK_BASIC_CFEND_RATE_8812F) -+#define BIT_SET_BASIC_CFEND_RATE_8812F(x, v) \ -+ (BIT_CLEAR_BASIC_CFEND_RATE_8812F(x) | BIT_BASIC_CFEND_RATE_8812F(v)) -+ -+/* 2 REG_STBC_CFEND_RATE_8812F */ -+ -+#define BIT_SHIFT_STBC_CFEND_RATE_8812F 0 -+#define BIT_MASK_STBC_CFEND_RATE_8812F 0x1f -+#define BIT_STBC_CFEND_RATE_8812F(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_RATE_8812F) \ -+ << BIT_SHIFT_STBC_CFEND_RATE_8812F) -+#define BITS_STBC_CFEND_RATE_8812F \ -+ (BIT_MASK_STBC_CFEND_RATE_8812F << BIT_SHIFT_STBC_CFEND_RATE_8812F) -+#define BIT_CLEAR_STBC_CFEND_RATE_8812F(x) ((x) & (~BITS_STBC_CFEND_RATE_8812F)) -+#define BIT_GET_STBC_CFEND_RATE_8812F(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_RATE_8812F) & \ -+ BIT_MASK_STBC_CFEND_RATE_8812F) -+#define BIT_SET_STBC_CFEND_RATE_8812F(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_RATE_8812F(x) | BIT_STBC_CFEND_RATE_8812F(v)) -+ -+/* 2 REG_DATA_SC_8812F */ -+ -+#define BIT_SHIFT_TXSC_40M_8812F 4 -+#define BIT_MASK_TXSC_40M_8812F 0xf -+#define BIT_TXSC_40M_8812F(x) \ -+ (((x) & BIT_MASK_TXSC_40M_8812F) << BIT_SHIFT_TXSC_40M_8812F) -+#define BITS_TXSC_40M_8812F \ -+ (BIT_MASK_TXSC_40M_8812F << BIT_SHIFT_TXSC_40M_8812F) -+#define BIT_CLEAR_TXSC_40M_8812F(x) ((x) & (~BITS_TXSC_40M_8812F)) -+#define BIT_GET_TXSC_40M_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXSC_40M_8812F) & BIT_MASK_TXSC_40M_8812F) -+#define BIT_SET_TXSC_40M_8812F(x, v) \ -+ (BIT_CLEAR_TXSC_40M_8812F(x) | BIT_TXSC_40M_8812F(v)) -+ -+#define BIT_SHIFT_TXSC_20M_8812F 0 -+#define BIT_MASK_TXSC_20M_8812F 0xf -+#define BIT_TXSC_20M_8812F(x) \ -+ (((x) & BIT_MASK_TXSC_20M_8812F) << BIT_SHIFT_TXSC_20M_8812F) -+#define BITS_TXSC_20M_8812F \ -+ (BIT_MASK_TXSC_20M_8812F << BIT_SHIFT_TXSC_20M_8812F) -+#define BIT_CLEAR_TXSC_20M_8812F(x) ((x) & (~BITS_TXSC_20M_8812F)) -+#define BIT_GET_TXSC_20M_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXSC_20M_8812F) & BIT_MASK_TXSC_20M_8812F) -+#define BIT_SET_TXSC_20M_8812F(x, v) \ -+ (BIT_CLEAR_TXSC_20M_8812F(x) | BIT_TXSC_20M_8812F(v)) -+ -+/* 2 REG_MACID_SLEEP3_8812F */ -+ -+#define BIT_SHIFT_MACID127_96_PKTSLEEP_8812F 0 -+#define BIT_MASK_MACID127_96_PKTSLEEP_8812F 0xffffffffL -+#define BIT_MACID127_96_PKTSLEEP_8812F(x) \ -+ (((x) & BIT_MASK_MACID127_96_PKTSLEEP_8812F) \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP_8812F) -+#define BITS_MACID127_96_PKTSLEEP_8812F \ -+ (BIT_MASK_MACID127_96_PKTSLEEP_8812F \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP_8812F) -+#define BIT_CLEAR_MACID127_96_PKTSLEEP_8812F(x) \ -+ ((x) & (~BITS_MACID127_96_PKTSLEEP_8812F)) -+#define BIT_GET_MACID127_96_PKTSLEEP_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_PKTSLEEP_8812F) & \ -+ BIT_MASK_MACID127_96_PKTSLEEP_8812F) -+#define BIT_SET_MACID127_96_PKTSLEEP_8812F(x, v) \ -+ (BIT_CLEAR_MACID127_96_PKTSLEEP_8812F(x) | \ -+ BIT_MACID127_96_PKTSLEEP_8812F(v)) -+ -+/* 2 REG_MACID_SLEEP1_8812F */ -+ -+#define BIT_SHIFT_MACID63_32_PKTSLEEP_8812F 0 -+#define BIT_MASK_MACID63_32_PKTSLEEP_8812F 0xffffffffL -+#define BIT_MACID63_32_PKTSLEEP_8812F(x) \ -+ (((x) & BIT_MASK_MACID63_32_PKTSLEEP_8812F) \ -+ << BIT_SHIFT_MACID63_32_PKTSLEEP_8812F) -+#define BITS_MACID63_32_PKTSLEEP_8812F \ -+ (BIT_MASK_MACID63_32_PKTSLEEP_8812F \ -+ << BIT_SHIFT_MACID63_32_PKTSLEEP_8812F) -+#define BIT_CLEAR_MACID63_32_PKTSLEEP_8812F(x) \ -+ ((x) & (~BITS_MACID63_32_PKTSLEEP_8812F)) -+#define BIT_GET_MACID63_32_PKTSLEEP_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_PKTSLEEP_8812F) & \ -+ BIT_MASK_MACID63_32_PKTSLEEP_8812F) -+#define BIT_SET_MACID63_32_PKTSLEEP_8812F(x, v) \ -+ (BIT_CLEAR_MACID63_32_PKTSLEEP_8812F(x) | \ -+ BIT_MACID63_32_PKTSLEEP_8812F(v)) -+ -+/* 2 REG_ARFR2_V1_8812F */ -+ -+#define BIT_SHIFT_ARFRL2_8812F 0 -+#define BIT_MASK_ARFRL2_8812F 0xffffffffL -+#define BIT_ARFRL2_8812F(x) \ -+ (((x) & BIT_MASK_ARFRL2_8812F) << BIT_SHIFT_ARFRL2_8812F) -+#define BITS_ARFRL2_8812F (BIT_MASK_ARFRL2_8812F << BIT_SHIFT_ARFRL2_8812F) -+#define BIT_CLEAR_ARFRL2_8812F(x) ((x) & (~BITS_ARFRL2_8812F)) -+#define BIT_GET_ARFRL2_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRL2_8812F) & BIT_MASK_ARFRL2_8812F) -+#define BIT_SET_ARFRL2_8812F(x, v) \ -+ (BIT_CLEAR_ARFRL2_8812F(x) | BIT_ARFRL2_8812F(v)) -+ -+/* 2 REG_ARFRH2_V1_8812F */ -+ -+#define BIT_SHIFT_ARFRH2_8812F 0 -+#define BIT_MASK_ARFRH2_8812F 0xffffffffL -+#define BIT_ARFRH2_8812F(x) \ -+ (((x) & BIT_MASK_ARFRH2_8812F) << BIT_SHIFT_ARFRH2_8812F) -+#define BITS_ARFRH2_8812F (BIT_MASK_ARFRH2_8812F << BIT_SHIFT_ARFRH2_8812F) -+#define BIT_CLEAR_ARFRH2_8812F(x) ((x) & (~BITS_ARFRH2_8812F)) -+#define BIT_GET_ARFRH2_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRH2_8812F) & BIT_MASK_ARFRH2_8812F) -+#define BIT_SET_ARFRH2_8812F(x, v) \ -+ (BIT_CLEAR_ARFRH2_8812F(x) | BIT_ARFRH2_8812F(v)) -+ -+/* 2 REG_ARFR3_V1_8812F */ -+ -+#define BIT_SHIFT_ARFRL3_8812F 0 -+#define BIT_MASK_ARFRL3_8812F 0xffffffffL -+#define BIT_ARFRL3_8812F(x) \ -+ (((x) & BIT_MASK_ARFRL3_8812F) << BIT_SHIFT_ARFRL3_8812F) -+#define BITS_ARFRL3_8812F (BIT_MASK_ARFRL3_8812F << BIT_SHIFT_ARFRL3_8812F) -+#define BIT_CLEAR_ARFRL3_8812F(x) ((x) & (~BITS_ARFRL3_8812F)) -+#define BIT_GET_ARFRL3_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRL3_8812F) & BIT_MASK_ARFRL3_8812F) -+#define BIT_SET_ARFRL3_8812F(x, v) \ -+ (BIT_CLEAR_ARFRL3_8812F(x) | BIT_ARFRL3_8812F(v)) -+ -+/* 2 REG_ARFRH3_V1_8812F */ -+ -+#define BIT_SHIFT_ARFRH3_8812F 0 -+#define BIT_MASK_ARFRH3_8812F 0xffffffffL -+#define BIT_ARFRH3_8812F(x) \ -+ (((x) & BIT_MASK_ARFRH3_8812F) << BIT_SHIFT_ARFRH3_8812F) -+#define BITS_ARFRH3_8812F (BIT_MASK_ARFRH3_8812F << BIT_SHIFT_ARFRH3_8812F) -+#define BIT_CLEAR_ARFRH3_8812F(x) ((x) & (~BITS_ARFRH3_8812F)) -+#define BIT_GET_ARFRH3_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRH3_8812F) & BIT_MASK_ARFRH3_8812F) -+#define BIT_SET_ARFRH3_8812F(x, v) \ -+ (BIT_CLEAR_ARFRH3_8812F(x) | BIT_ARFRH3_8812F(v)) -+ -+/* 2 REG_ARFR4_8812F */ -+ -+#define BIT_SHIFT_ARFRL4_8812F 0 -+#define BIT_MASK_ARFRL4_8812F 0xffffffffL -+#define BIT_ARFRL4_8812F(x) \ -+ (((x) & BIT_MASK_ARFRL4_8812F) << BIT_SHIFT_ARFRL4_8812F) -+#define BITS_ARFRL4_8812F (BIT_MASK_ARFRL4_8812F << BIT_SHIFT_ARFRL4_8812F) -+#define BIT_CLEAR_ARFRL4_8812F(x) ((x) & (~BITS_ARFRL4_8812F)) -+#define BIT_GET_ARFRL4_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRL4_8812F) & BIT_MASK_ARFRL4_8812F) -+#define BIT_SET_ARFRL4_8812F(x, v) \ -+ (BIT_CLEAR_ARFRL4_8812F(x) | BIT_ARFRL4_8812F(v)) -+ -+/* 2 REG_ARFRH4_8812F */ -+ -+#define BIT_SHIFT_ARFRH4_8812F 0 -+#define BIT_MASK_ARFRH4_8812F 0xffffffffL -+#define BIT_ARFRH4_8812F(x) \ -+ (((x) & BIT_MASK_ARFRH4_8812F) << BIT_SHIFT_ARFRH4_8812F) -+#define BITS_ARFRH4_8812F (BIT_MASK_ARFRH4_8812F << BIT_SHIFT_ARFRH4_8812F) -+#define BIT_CLEAR_ARFRH4_8812F(x) ((x) & (~BITS_ARFRH4_8812F)) -+#define BIT_GET_ARFRH4_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRH4_8812F) & BIT_MASK_ARFRH4_8812F) -+#define BIT_SET_ARFRH4_8812F(x, v) \ -+ (BIT_CLEAR_ARFRH4_8812F(x) | BIT_ARFRH4_8812F(v)) -+ -+/* 2 REG_ARFR5_8812F */ -+ -+#define BIT_SHIFT_ARFRL5_8812F 0 -+#define BIT_MASK_ARFRL5_8812F 0xffffffffL -+#define BIT_ARFRL5_8812F(x) \ -+ (((x) & BIT_MASK_ARFRL5_8812F) << BIT_SHIFT_ARFRL5_8812F) -+#define BITS_ARFRL5_8812F (BIT_MASK_ARFRL5_8812F << BIT_SHIFT_ARFRL5_8812F) -+#define BIT_CLEAR_ARFRL5_8812F(x) ((x) & (~BITS_ARFRL5_8812F)) -+#define BIT_GET_ARFRL5_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRL5_8812F) & BIT_MASK_ARFRL5_8812F) -+#define BIT_SET_ARFRL5_8812F(x, v) \ -+ (BIT_CLEAR_ARFRL5_8812F(x) | BIT_ARFRL5_8812F(v)) -+ -+/* 2 REG_ARFRH5_8812F */ -+ -+#define BIT_SHIFT_ARFRH5_8812F 0 -+#define BIT_MASK_ARFRH5_8812F 0xffffffffL -+#define BIT_ARFRH5_8812F(x) \ -+ (((x) & BIT_MASK_ARFRH5_8812F) << BIT_SHIFT_ARFRH5_8812F) -+#define BITS_ARFRH5_8812F (BIT_MASK_ARFRH5_8812F << BIT_SHIFT_ARFRH5_8812F) -+#define BIT_CLEAR_ARFRH5_8812F(x) ((x) & (~BITS_ARFRH5_8812F)) -+#define BIT_GET_ARFRH5_8812F(x) \ -+ (((x) >> BIT_SHIFT_ARFRH5_8812F) & BIT_MASK_ARFRH5_8812F) -+#define BIT_SET_ARFRH5_8812F(x, v) \ -+ (BIT_CLEAR_ARFRH5_8812F(x) | BIT_ARFRH5_8812F(v)) -+ -+/* 2 REG_TXRPT_START_OFFSET_8812F */ -+ -+#define BIT_SHIFT_MACID_MURATE_OFFSET_8812F 24 -+#define BIT_MASK_MACID_MURATE_OFFSET_8812F 0xff -+#define BIT_MACID_MURATE_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_MACID_MURATE_OFFSET_8812F) \ -+ << BIT_SHIFT_MACID_MURATE_OFFSET_8812F) -+#define BITS_MACID_MURATE_OFFSET_8812F \ -+ (BIT_MASK_MACID_MURATE_OFFSET_8812F \ -+ << BIT_SHIFT_MACID_MURATE_OFFSET_8812F) -+#define BIT_CLEAR_MACID_MURATE_OFFSET_8812F(x) \ -+ ((x) & (~BITS_MACID_MURATE_OFFSET_8812F)) -+#define BIT_GET_MACID_MURATE_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID_MURATE_OFFSET_8812F) & \ -+ BIT_MASK_MACID_MURATE_OFFSET_8812F) -+#define BIT_SET_MACID_MURATE_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_MACID_MURATE_OFFSET_8812F(x) | \ -+ BIT_MACID_MURATE_OFFSET_8812F(v)) -+ -+#define BIT_SHIFT_TXRPT_MISS_COUNT_8812F 17 -+#define BIT_MASK_TXRPT_MISS_COUNT_8812F 0x7 -+#define BIT_TXRPT_MISS_COUNT_8812F(x) \ -+ (((x) & BIT_MASK_TXRPT_MISS_COUNT_8812F) \ -+ << BIT_SHIFT_TXRPT_MISS_COUNT_8812F) -+#define BITS_TXRPT_MISS_COUNT_8812F \ -+ (BIT_MASK_TXRPT_MISS_COUNT_8812F << BIT_SHIFT_TXRPT_MISS_COUNT_8812F) -+#define BIT_CLEAR_TXRPT_MISS_COUNT_8812F(x) \ -+ ((x) & (~BITS_TXRPT_MISS_COUNT_8812F)) -+#define BIT_GET_TXRPT_MISS_COUNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXRPT_MISS_COUNT_8812F) & \ -+ BIT_MASK_TXRPT_MISS_COUNT_8812F) -+#define BIT_SET_TXRPT_MISS_COUNT_8812F(x, v) \ -+ (BIT_CLEAR_TXRPT_MISS_COUNT_8812F(x) | BIT_TXRPT_MISS_COUNT_8812F(v)) -+ -+#define BIT_RPTFIFO_SIZE_OPT_8812F BIT(16) -+ -+#define BIT_SHIFT_MACID_CTRL_OFFSET_8812F 8 -+#define BIT_MASK_MACID_CTRL_OFFSET_8812F 0xff -+#define BIT_MACID_CTRL_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_MACID_CTRL_OFFSET_8812F) \ -+ << BIT_SHIFT_MACID_CTRL_OFFSET_8812F) -+#define BITS_MACID_CTRL_OFFSET_8812F \ -+ (BIT_MASK_MACID_CTRL_OFFSET_8812F << BIT_SHIFT_MACID_CTRL_OFFSET_8812F) -+#define BIT_CLEAR_MACID_CTRL_OFFSET_8812F(x) \ -+ ((x) & (~BITS_MACID_CTRL_OFFSET_8812F)) -+#define BIT_GET_MACID_CTRL_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID_CTRL_OFFSET_8812F) & \ -+ BIT_MASK_MACID_CTRL_OFFSET_8812F) -+#define BIT_SET_MACID_CTRL_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_MACID_CTRL_OFFSET_8812F(x) | BIT_MACID_CTRL_OFFSET_8812F(v)) -+ -+#define BIT_SHIFT_AMPDU_TXRPT_OFFSET_8812F 0 -+#define BIT_MASK_AMPDU_TXRPT_OFFSET_8812F 0xff -+#define BIT_AMPDU_TXRPT_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_AMPDU_TXRPT_OFFSET_8812F) \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_8812F) -+#define BITS_AMPDU_TXRPT_OFFSET_8812F \ -+ (BIT_MASK_AMPDU_TXRPT_OFFSET_8812F \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_8812F) -+#define BIT_CLEAR_AMPDU_TXRPT_OFFSET_8812F(x) \ -+ ((x) & (~BITS_AMPDU_TXRPT_OFFSET_8812F)) -+#define BIT_GET_AMPDU_TXRPT_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_TXRPT_OFFSET_8812F) & \ -+ BIT_MASK_AMPDU_TXRPT_OFFSET_8812F) -+#define BIT_SET_AMPDU_TXRPT_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_AMPDU_TXRPT_OFFSET_8812F(x) | \ -+ BIT_AMPDU_TXRPT_OFFSET_8812F(v)) -+ -+/* 2 REG_RRSR_CTS_8812F */ -+ -+#define BIT_SHIFT_RRCTSSR_RSC_8812F 21 -+#define BIT_MASK_RRCTSSR_RSC_8812F 0x3 -+#define BIT_RRCTSSR_RSC_8812F(x) \ -+ (((x) & BIT_MASK_RRCTSSR_RSC_8812F) << BIT_SHIFT_RRCTSSR_RSC_8812F) -+#define BITS_RRCTSSR_RSC_8812F \ -+ (BIT_MASK_RRCTSSR_RSC_8812F << BIT_SHIFT_RRCTSSR_RSC_8812F) -+#define BIT_CLEAR_RRCTSSR_RSC_8812F(x) ((x) & (~BITS_RRCTSSR_RSC_8812F)) -+#define BIT_GET_RRCTSSR_RSC_8812F(x) \ -+ (((x) >> BIT_SHIFT_RRCTSSR_RSC_8812F) & BIT_MASK_RRCTSSR_RSC_8812F) -+#define BIT_SET_RRCTSSR_RSC_8812F(x, v) \ -+ (BIT_CLEAR_RRCTSSR_RSC_8812F(x) | BIT_RRCTSSR_RSC_8812F(v)) -+ -+#define BIT_SHIFT_RRCTSSC_BITMAP_8812F 0 -+#define BIT_MASK_RRCTSSC_BITMAP_8812F 0xfffff -+#define BIT_RRCTSSC_BITMAP_8812F(x) \ -+ (((x) & BIT_MASK_RRCTSSC_BITMAP_8812F) \ -+ << BIT_SHIFT_RRCTSSC_BITMAP_8812F) -+#define BITS_RRCTSSC_BITMAP_8812F \ -+ (BIT_MASK_RRCTSSC_BITMAP_8812F << BIT_SHIFT_RRCTSSC_BITMAP_8812F) -+#define BIT_CLEAR_RRCTSSC_BITMAP_8812F(x) ((x) & (~BITS_RRCTSSC_BITMAP_8812F)) -+#define BIT_GET_RRCTSSC_BITMAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_RRCTSSC_BITMAP_8812F) & \ -+ BIT_MASK_RRCTSSC_BITMAP_8812F) -+#define BIT_SET_RRCTSSC_BITMAP_8812F(x, v) \ -+ (BIT_CLEAR_RRCTSSC_BITMAP_8812F(x) | BIT_RRCTSSC_BITMAP_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_POWER_STAGE1_8812F */ -+#define BIT_PTA_WL_PRI_MASK_CPU_MGQ_8812F BIT(31) -+#define BIT_PTA_WL_PRI_MASK_BCNQ_8812F BIT(30) -+#define BIT_PTA_WL_PRI_MASK_HIQ_8812F BIT(29) -+#define BIT_PTA_WL_PRI_MASK_MGQ_8812F BIT(28) -+#define BIT_PTA_WL_PRI_MASK_BK_8812F BIT(27) -+#define BIT_PTA_WL_PRI_MASK_BE_8812F BIT(26) -+#define BIT_PTA_WL_PRI_MASK_VI_8812F BIT(25) -+#define BIT_PTA_WL_PRI_MASK_VO_8812F BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE1_8812F 0 -+#define BIT_MASK_POWER_STAGE1_8812F 0xffffff -+#define BIT_POWER_STAGE1_8812F(x) \ -+ (((x) & BIT_MASK_POWER_STAGE1_8812F) << BIT_SHIFT_POWER_STAGE1_8812F) -+#define BITS_POWER_STAGE1_8812F \ -+ (BIT_MASK_POWER_STAGE1_8812F << BIT_SHIFT_POWER_STAGE1_8812F) -+#define BIT_CLEAR_POWER_STAGE1_8812F(x) ((x) & (~BITS_POWER_STAGE1_8812F)) -+#define BIT_GET_POWER_STAGE1_8812F(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE1_8812F) & BIT_MASK_POWER_STAGE1_8812F) -+#define BIT_SET_POWER_STAGE1_8812F(x, v) \ -+ (BIT_CLEAR_POWER_STAGE1_8812F(x) | BIT_POWER_STAGE1_8812F(v)) -+ -+/* 2 REG_POWER_STAGE2_8812F */ -+#define BIT__R_CTRL_PKT_POW_ADJ_8812F BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE2_8812F 0 -+#define BIT_MASK_POWER_STAGE2_8812F 0xffffff -+#define BIT_POWER_STAGE2_8812F(x) \ -+ (((x) & BIT_MASK_POWER_STAGE2_8812F) << BIT_SHIFT_POWER_STAGE2_8812F) -+#define BITS_POWER_STAGE2_8812F \ -+ (BIT_MASK_POWER_STAGE2_8812F << BIT_SHIFT_POWER_STAGE2_8812F) -+#define BIT_CLEAR_POWER_STAGE2_8812F(x) ((x) & (~BITS_POWER_STAGE2_8812F)) -+#define BIT_GET_POWER_STAGE2_8812F(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE2_8812F) & BIT_MASK_POWER_STAGE2_8812F) -+#define BIT_SET_POWER_STAGE2_8812F(x, v) \ -+ (BIT_CLEAR_POWER_STAGE2_8812F(x) | BIT_POWER_STAGE2_8812F(v)) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL_8812F */ -+ -+#define BIT_SHIFT_PAD_NUM_THRES_8812F 24 -+#define BIT_MASK_PAD_NUM_THRES_8812F 0x3f -+#define BIT_PAD_NUM_THRES_8812F(x) \ -+ (((x) & BIT_MASK_PAD_NUM_THRES_8812F) << BIT_SHIFT_PAD_NUM_THRES_8812F) -+#define BITS_PAD_NUM_THRES_8812F \ -+ (BIT_MASK_PAD_NUM_THRES_8812F << BIT_SHIFT_PAD_NUM_THRES_8812F) -+#define BIT_CLEAR_PAD_NUM_THRES_8812F(x) ((x) & (~BITS_PAD_NUM_THRES_8812F)) -+#define BIT_GET_PAD_NUM_THRES_8812F(x) \ -+ (((x) >> BIT_SHIFT_PAD_NUM_THRES_8812F) & BIT_MASK_PAD_NUM_THRES_8812F) -+#define BIT_SET_PAD_NUM_THRES_8812F(x, v) \ -+ (BIT_CLEAR_PAD_NUM_THRES_8812F(x) | BIT_PAD_NUM_THRES_8812F(v)) -+ -+#define BIT_R_DMA_THIS_QUEUE_BK_8812F BIT(23) -+#define BIT_R_DMA_THIS_QUEUE_BE_8812F BIT(22) -+#define BIT_R_DMA_THIS_QUEUE_VI_8812F BIT(21) -+#define BIT_R_DMA_THIS_QUEUE_VO_8812F BIT(20) -+ -+#define BIT_SHIFT_R_TOTAL_LEN_TH_8812F 8 -+#define BIT_MASK_R_TOTAL_LEN_TH_8812F 0xfff -+#define BIT_R_TOTAL_LEN_TH_8812F(x) \ -+ (((x) & BIT_MASK_R_TOTAL_LEN_TH_8812F) \ -+ << BIT_SHIFT_R_TOTAL_LEN_TH_8812F) -+#define BITS_R_TOTAL_LEN_TH_8812F \ -+ (BIT_MASK_R_TOTAL_LEN_TH_8812F << BIT_SHIFT_R_TOTAL_LEN_TH_8812F) -+#define BIT_CLEAR_R_TOTAL_LEN_TH_8812F(x) ((x) & (~BITS_R_TOTAL_LEN_TH_8812F)) -+#define BIT_GET_R_TOTAL_LEN_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_TOTAL_LEN_TH_8812F) & \ -+ BIT_MASK_R_TOTAL_LEN_TH_8812F) -+#define BIT_SET_R_TOTAL_LEN_TH_8812F(x, v) \ -+ (BIT_CLEAR_R_TOTAL_LEN_TH_8812F(x) | BIT_R_TOTAL_LEN_TH_8812F(v)) -+ -+#define BIT_EN_NEW_EARLY_8812F BIT(7) -+#define BIT_PRE_TX_CMD_8812F BIT(6) -+ -+#define BIT_SHIFT_NUM_SCL_EN_8812F 4 -+#define BIT_MASK_NUM_SCL_EN_8812F 0x3 -+#define BIT_NUM_SCL_EN_8812F(x) \ -+ (((x) & BIT_MASK_NUM_SCL_EN_8812F) << BIT_SHIFT_NUM_SCL_EN_8812F) -+#define BITS_NUM_SCL_EN_8812F \ -+ (BIT_MASK_NUM_SCL_EN_8812F << BIT_SHIFT_NUM_SCL_EN_8812F) -+#define BIT_CLEAR_NUM_SCL_EN_8812F(x) ((x) & (~BITS_NUM_SCL_EN_8812F)) -+#define BIT_GET_NUM_SCL_EN_8812F(x) \ -+ (((x) >> BIT_SHIFT_NUM_SCL_EN_8812F) & BIT_MASK_NUM_SCL_EN_8812F) -+#define BIT_SET_NUM_SCL_EN_8812F(x, v) \ -+ (BIT_CLEAR_NUM_SCL_EN_8812F(x) | BIT_NUM_SCL_EN_8812F(v)) -+ -+#define BIT_BK_EN_8812F BIT(3) -+#define BIT_BE_EN_8812F BIT(2) -+#define BIT_VI_EN_8812F BIT(1) -+#define BIT_VO_EN_8812F BIT(0) -+ -+/* 2 REG_PKT_LIFE_TIME_8812F */ -+ -+#define BIT_SHIFT_PKT_LIFTIME_BEBK_8812F 16 -+#define BIT_MASK_PKT_LIFTIME_BEBK_8812F 0xffff -+#define BIT_PKT_LIFTIME_BEBK_8812F(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_BEBK_8812F) \ -+ << BIT_SHIFT_PKT_LIFTIME_BEBK_8812F) -+#define BITS_PKT_LIFTIME_BEBK_8812F \ -+ (BIT_MASK_PKT_LIFTIME_BEBK_8812F << BIT_SHIFT_PKT_LIFTIME_BEBK_8812F) -+#define BIT_CLEAR_PKT_LIFTIME_BEBK_8812F(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_BEBK_8812F)) -+#define BIT_GET_PKT_LIFTIME_BEBK_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_BEBK_8812F) & \ -+ BIT_MASK_PKT_LIFTIME_BEBK_8812F) -+#define BIT_SET_PKT_LIFTIME_BEBK_8812F(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_BEBK_8812F(x) | BIT_PKT_LIFTIME_BEBK_8812F(v)) -+ -+#define BIT_SHIFT_PKT_LIFTIME_VOVI_8812F 0 -+#define BIT_MASK_PKT_LIFTIME_VOVI_8812F 0xffff -+#define BIT_PKT_LIFTIME_VOVI_8812F(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_VOVI_8812F) \ -+ << BIT_SHIFT_PKT_LIFTIME_VOVI_8812F) -+#define BITS_PKT_LIFTIME_VOVI_8812F \ -+ (BIT_MASK_PKT_LIFTIME_VOVI_8812F << BIT_SHIFT_PKT_LIFTIME_VOVI_8812F) -+#define BIT_CLEAR_PKT_LIFTIME_VOVI_8812F(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_VOVI_8812F)) -+#define BIT_GET_PKT_LIFTIME_VOVI_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_VOVI_8812F) & \ -+ BIT_MASK_PKT_LIFTIME_VOVI_8812F) -+#define BIT_SET_PKT_LIFTIME_VOVI_8812F(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_VOVI_8812F(x) | BIT_PKT_LIFTIME_VOVI_8812F(v)) -+ -+/* 2 REG_STBC_SETTING_8812F */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_L_8812F 4 -+#define BIT_MASK_CDEND_TXTIME_L_8812F 0xf -+#define BIT_CDEND_TXTIME_L_8812F(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_L_8812F) \ -+ << BIT_SHIFT_CDEND_TXTIME_L_8812F) -+#define BITS_CDEND_TXTIME_L_8812F \ -+ (BIT_MASK_CDEND_TXTIME_L_8812F << BIT_SHIFT_CDEND_TXTIME_L_8812F) -+#define BIT_CLEAR_CDEND_TXTIME_L_8812F(x) ((x) & (~BITS_CDEND_TXTIME_L_8812F)) -+#define BIT_GET_CDEND_TXTIME_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_L_8812F) & \ -+ BIT_MASK_CDEND_TXTIME_L_8812F) -+#define BIT_SET_CDEND_TXTIME_L_8812F(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_L_8812F(x) | BIT_CDEND_TXTIME_L_8812F(v)) -+ -+#define BIT_SHIFT_NESS_8812F 2 -+#define BIT_MASK_NESS_8812F 0x3 -+#define BIT_NESS_8812F(x) (((x) & BIT_MASK_NESS_8812F) << BIT_SHIFT_NESS_8812F) -+#define BITS_NESS_8812F (BIT_MASK_NESS_8812F << BIT_SHIFT_NESS_8812F) -+#define BIT_CLEAR_NESS_8812F(x) ((x) & (~BITS_NESS_8812F)) -+#define BIT_GET_NESS_8812F(x) \ -+ (((x) >> BIT_SHIFT_NESS_8812F) & BIT_MASK_NESS_8812F) -+#define BIT_SET_NESS_8812F(x, v) (BIT_CLEAR_NESS_8812F(x) | BIT_NESS_8812F(v)) -+ -+#define BIT_SHIFT_STBC_CFEND_8812F 0 -+#define BIT_MASK_STBC_CFEND_8812F 0x3 -+#define BIT_STBC_CFEND_8812F(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_8812F) << BIT_SHIFT_STBC_CFEND_8812F) -+#define BITS_STBC_CFEND_8812F \ -+ (BIT_MASK_STBC_CFEND_8812F << BIT_SHIFT_STBC_CFEND_8812F) -+#define BIT_CLEAR_STBC_CFEND_8812F(x) ((x) & (~BITS_STBC_CFEND_8812F)) -+#define BIT_GET_STBC_CFEND_8812F(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_8812F) & BIT_MASK_STBC_CFEND_8812F) -+#define BIT_SET_STBC_CFEND_8812F(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_8812F(x) | BIT_STBC_CFEND_8812F(v)) -+ -+/* 2 REG_STBC_SETTING2_8812F */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_H_8812F 0 -+#define BIT_MASK_CDEND_TXTIME_H_8812F 0x1f -+#define BIT_CDEND_TXTIME_H_8812F(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_H_8812F) \ -+ << BIT_SHIFT_CDEND_TXTIME_H_8812F) -+#define BITS_CDEND_TXTIME_H_8812F \ -+ (BIT_MASK_CDEND_TXTIME_H_8812F << BIT_SHIFT_CDEND_TXTIME_H_8812F) -+#define BIT_CLEAR_CDEND_TXTIME_H_8812F(x) ((x) & (~BITS_CDEND_TXTIME_H_8812F)) -+#define BIT_GET_CDEND_TXTIME_H_8812F(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_H_8812F) & \ -+ BIT_MASK_CDEND_TXTIME_H_8812F) -+#define BIT_SET_CDEND_TXTIME_H_8812F(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_H_8812F(x) | BIT_CDEND_TXTIME_H_8812F(v)) -+ -+/* 2 REG_QUEUE_CTRL_8812F */ -+#define BIT_FORCE_RND_PRI_8812F BIT(6) -+#define BIT_PTA_EDCCA_EN_8812F BIT(5) -+#define BIT_PTA_WL_TX_EN_8812F BIT(4) -+#define BIT_R_USE_DATA_BW_8812F BIT(3) -+#define BIT_TRI_PKT_INT_MODE1_8812F BIT(2) -+#define BIT_TRI_PKT_INT_MODE0_8812F BIT(1) -+#define BIT_ACQ_MODE_SEL_8812F BIT(0) -+ -+/* 2 REG_SINGLE_AMPDU_CTRL_8812F */ -+#define BIT_EN_SINGLE_APMDU_8812F BIT(7) -+ -+#define BIT_SHIFT_SNDTX_MAXTIME_8812F 0 -+#define BIT_MASK_SNDTX_MAXTIME_8812F 0x7f -+#define BIT_SNDTX_MAXTIME_8812F(x) \ -+ (((x) & BIT_MASK_SNDTX_MAXTIME_8812F) << BIT_SHIFT_SNDTX_MAXTIME_8812F) -+#define BITS_SNDTX_MAXTIME_8812F \ -+ (BIT_MASK_SNDTX_MAXTIME_8812F << BIT_SHIFT_SNDTX_MAXTIME_8812F) -+#define BIT_CLEAR_SNDTX_MAXTIME_8812F(x) ((x) & (~BITS_SNDTX_MAXTIME_8812F)) -+#define BIT_GET_SNDTX_MAXTIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_SNDTX_MAXTIME_8812F) & BIT_MASK_SNDTX_MAXTIME_8812F) -+#define BIT_SET_SNDTX_MAXTIME_8812F(x, v) \ -+ (BIT_CLEAR_SNDTX_MAXTIME_8812F(x) | BIT_SNDTX_MAXTIME_8812F(v)) -+ -+/* 2 REG_PROT_MODE_CTRL_8812F */ -+#define BIT_SND_SIFS_TXDATA_8812F BIT(31) -+#define BIT_TX_SND_MATCH_MACID_8812F BIT(30) -+ -+#define BIT_SHIFT_RTS_MAX_AGG_NUM_8812F 24 -+#define BIT_MASK_RTS_MAX_AGG_NUM_8812F 0x3f -+#define BIT_RTS_MAX_AGG_NUM_8812F(x) \ -+ (((x) & BIT_MASK_RTS_MAX_AGG_NUM_8812F) \ -+ << BIT_SHIFT_RTS_MAX_AGG_NUM_8812F) -+#define BITS_RTS_MAX_AGG_NUM_8812F \ -+ (BIT_MASK_RTS_MAX_AGG_NUM_8812F << BIT_SHIFT_RTS_MAX_AGG_NUM_8812F) -+#define BIT_CLEAR_RTS_MAX_AGG_NUM_8812F(x) ((x) & (~BITS_RTS_MAX_AGG_NUM_8812F)) -+#define BIT_GET_RTS_MAX_AGG_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_RTS_MAX_AGG_NUM_8812F) & \ -+ BIT_MASK_RTS_MAX_AGG_NUM_8812F) -+#define BIT_SET_RTS_MAX_AGG_NUM_8812F(x, v) \ -+ (BIT_CLEAR_RTS_MAX_AGG_NUM_8812F(x) | BIT_RTS_MAX_AGG_NUM_8812F(v)) -+ -+#define BIT_SHIFT_MAX_AGG_NUM_8812F 16 -+#define BIT_MASK_MAX_AGG_NUM_8812F 0x3f -+#define BIT_MAX_AGG_NUM_8812F(x) \ -+ (((x) & BIT_MASK_MAX_AGG_NUM_8812F) << BIT_SHIFT_MAX_AGG_NUM_8812F) -+#define BITS_MAX_AGG_NUM_8812F \ -+ (BIT_MASK_MAX_AGG_NUM_8812F << BIT_SHIFT_MAX_AGG_NUM_8812F) -+#define BIT_CLEAR_MAX_AGG_NUM_8812F(x) ((x) & (~BITS_MAX_AGG_NUM_8812F)) -+#define BIT_GET_MAX_AGG_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAX_AGG_NUM_8812F) & BIT_MASK_MAX_AGG_NUM_8812F) -+#define BIT_SET_MAX_AGG_NUM_8812F(x, v) \ -+ (BIT_CLEAR_MAX_AGG_NUM_8812F(x) | BIT_MAX_AGG_NUM_8812F(v)) -+ -+#define BIT_SHIFT_RTS_TXTIME_TH_8812F 8 -+#define BIT_MASK_RTS_TXTIME_TH_8812F 0xff -+#define BIT_RTS_TXTIME_TH_8812F(x) \ -+ (((x) & BIT_MASK_RTS_TXTIME_TH_8812F) << BIT_SHIFT_RTS_TXTIME_TH_8812F) -+#define BITS_RTS_TXTIME_TH_8812F \ -+ (BIT_MASK_RTS_TXTIME_TH_8812F << BIT_SHIFT_RTS_TXTIME_TH_8812F) -+#define BIT_CLEAR_RTS_TXTIME_TH_8812F(x) ((x) & (~BITS_RTS_TXTIME_TH_8812F)) -+#define BIT_GET_RTS_TXTIME_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_RTS_TXTIME_TH_8812F) & BIT_MASK_RTS_TXTIME_TH_8812F) -+#define BIT_SET_RTS_TXTIME_TH_8812F(x, v) \ -+ (BIT_CLEAR_RTS_TXTIME_TH_8812F(x) | BIT_RTS_TXTIME_TH_8812F(v)) -+ -+#define BIT_SHIFT_RTS_LEN_TH_8812F 0 -+#define BIT_MASK_RTS_LEN_TH_8812F 0xff -+#define BIT_RTS_LEN_TH_8812F(x) \ -+ (((x) & BIT_MASK_RTS_LEN_TH_8812F) << BIT_SHIFT_RTS_LEN_TH_8812F) -+#define BITS_RTS_LEN_TH_8812F \ -+ (BIT_MASK_RTS_LEN_TH_8812F << BIT_SHIFT_RTS_LEN_TH_8812F) -+#define BIT_CLEAR_RTS_LEN_TH_8812F(x) ((x) & (~BITS_RTS_LEN_TH_8812F)) -+#define BIT_GET_RTS_LEN_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_RTS_LEN_TH_8812F) & BIT_MASK_RTS_LEN_TH_8812F) -+#define BIT_SET_RTS_LEN_TH_8812F(x, v) \ -+ (BIT_CLEAR_RTS_LEN_TH_8812F(x) | BIT_RTS_LEN_TH_8812F(v)) -+ -+/* 2 REG_BAR_MODE_CTRL_8812F */ -+ -+#define BIT_SHIFT_BAR_RTY_LMT_8812F 16 -+#define BIT_MASK_BAR_RTY_LMT_8812F 0x3 -+#define BIT_BAR_RTY_LMT_8812F(x) \ -+ (((x) & BIT_MASK_BAR_RTY_LMT_8812F) << BIT_SHIFT_BAR_RTY_LMT_8812F) -+#define BITS_BAR_RTY_LMT_8812F \ -+ (BIT_MASK_BAR_RTY_LMT_8812F << BIT_SHIFT_BAR_RTY_LMT_8812F) -+#define BIT_CLEAR_BAR_RTY_LMT_8812F(x) ((x) & (~BITS_BAR_RTY_LMT_8812F)) -+#define BIT_GET_BAR_RTY_LMT_8812F(x) \ -+ (((x) >> BIT_SHIFT_BAR_RTY_LMT_8812F) & BIT_MASK_BAR_RTY_LMT_8812F) -+#define BIT_SET_BAR_RTY_LMT_8812F(x, v) \ -+ (BIT_CLEAR_BAR_RTY_LMT_8812F(x) | BIT_BAR_RTY_LMT_8812F(v)) -+ -+#define BIT_SHIFT_BAR_PKT_TXTIME_TH_8812F 8 -+#define BIT_MASK_BAR_PKT_TXTIME_TH_8812F 0xff -+#define BIT_BAR_PKT_TXTIME_TH_8812F(x) \ -+ (((x) & BIT_MASK_BAR_PKT_TXTIME_TH_8812F) \ -+ << BIT_SHIFT_BAR_PKT_TXTIME_TH_8812F) -+#define BITS_BAR_PKT_TXTIME_TH_8812F \ -+ (BIT_MASK_BAR_PKT_TXTIME_TH_8812F << BIT_SHIFT_BAR_PKT_TXTIME_TH_8812F) -+#define BIT_CLEAR_BAR_PKT_TXTIME_TH_8812F(x) \ -+ ((x) & (~BITS_BAR_PKT_TXTIME_TH_8812F)) -+#define BIT_GET_BAR_PKT_TXTIME_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKT_TXTIME_TH_8812F) & \ -+ BIT_MASK_BAR_PKT_TXTIME_TH_8812F) -+#define BIT_SET_BAR_PKT_TXTIME_TH_8812F(x, v) \ -+ (BIT_CLEAR_BAR_PKT_TXTIME_TH_8812F(x) | BIT_BAR_PKT_TXTIME_TH_8812F(v)) -+ -+#define BIT_BAR_EN_V1_8812F BIT(6) -+ -+#define BIT_SHIFT_BAR_PKTNUM_TH_V1_8812F 0 -+#define BIT_MASK_BAR_PKTNUM_TH_V1_8812F 0x3f -+#define BIT_BAR_PKTNUM_TH_V1_8812F(x) \ -+ (((x) & BIT_MASK_BAR_PKTNUM_TH_V1_8812F) \ -+ << BIT_SHIFT_BAR_PKTNUM_TH_V1_8812F) -+#define BITS_BAR_PKTNUM_TH_V1_8812F \ -+ (BIT_MASK_BAR_PKTNUM_TH_V1_8812F << BIT_SHIFT_BAR_PKTNUM_TH_V1_8812F) -+#define BIT_CLEAR_BAR_PKTNUM_TH_V1_8812F(x) \ -+ ((x) & (~BITS_BAR_PKTNUM_TH_V1_8812F)) -+#define BIT_GET_BAR_PKTNUM_TH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKTNUM_TH_V1_8812F) & \ -+ BIT_MASK_BAR_PKTNUM_TH_V1_8812F) -+#define BIT_SET_BAR_PKTNUM_TH_V1_8812F(x, v) \ -+ (BIT_CLEAR_BAR_PKTNUM_TH_V1_8812F(x) | BIT_BAR_PKTNUM_TH_V1_8812F(v)) -+ -+/* 2 REG_RA_TRY_RATE_AGG_LMT_8812F */ -+ -+#define BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8812F 0 -+#define BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8812F 0x3f -+#define BIT_RA_TRY_RATE_AGG_LMT_V1_8812F(x) \ -+ (((x) & BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8812F) \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8812F) -+#define BITS_RA_TRY_RATE_AGG_LMT_V1_8812F \ -+ (BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8812F \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8812F) -+#define BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8812F(x) \ -+ ((x) & (~BITS_RA_TRY_RATE_AGG_LMT_V1_8812F)) -+#define BIT_GET_RA_TRY_RATE_AGG_LMT_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8812F) & \ -+ BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8812F) -+#define BIT_SET_RA_TRY_RATE_AGG_LMT_V1_8812F(x, v) \ -+ (BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8812F(x) | \ -+ BIT_RA_TRY_RATE_AGG_LMT_V1_8812F(v)) -+ -+/* 2 REG_MACID_SLEEP2_8812F */ -+ -+#define BIT_SHIFT_MACID95_64PKTSLEEP_8812F 0 -+#define BIT_MASK_MACID95_64PKTSLEEP_8812F 0xffffffffL -+#define BIT_MACID95_64PKTSLEEP_8812F(x) \ -+ (((x) & BIT_MASK_MACID95_64PKTSLEEP_8812F) \ -+ << BIT_SHIFT_MACID95_64PKTSLEEP_8812F) -+#define BITS_MACID95_64PKTSLEEP_8812F \ -+ (BIT_MASK_MACID95_64PKTSLEEP_8812F \ -+ << BIT_SHIFT_MACID95_64PKTSLEEP_8812F) -+#define BIT_CLEAR_MACID95_64PKTSLEEP_8812F(x) \ -+ ((x) & (~BITS_MACID95_64PKTSLEEP_8812F)) -+#define BIT_GET_MACID95_64PKTSLEEP_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64PKTSLEEP_8812F) & \ -+ BIT_MASK_MACID95_64PKTSLEEP_8812F) -+#define BIT_SET_MACID95_64PKTSLEEP_8812F(x, v) \ -+ (BIT_CLEAR_MACID95_64PKTSLEEP_8812F(x) | \ -+ BIT_MACID95_64PKTSLEEP_8812F(v)) -+ -+/* 2 REG_MACID_SLEEP_8812F */ -+ -+#define BIT_SHIFT_MACID31_0_PKTSLEEP_8812F 0 -+#define BIT_MASK_MACID31_0_PKTSLEEP_8812F 0xffffffffL -+#define BIT_MACID31_0_PKTSLEEP_8812F(x) \ -+ (((x) & BIT_MASK_MACID31_0_PKTSLEEP_8812F) \ -+ << BIT_SHIFT_MACID31_0_PKTSLEEP_8812F) -+#define BITS_MACID31_0_PKTSLEEP_8812F \ -+ (BIT_MASK_MACID31_0_PKTSLEEP_8812F \ -+ << BIT_SHIFT_MACID31_0_PKTSLEEP_8812F) -+#define BIT_CLEAR_MACID31_0_PKTSLEEP_8812F(x) \ -+ ((x) & (~BITS_MACID31_0_PKTSLEEP_8812F)) -+#define BIT_GET_MACID31_0_PKTSLEEP_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_PKTSLEEP_8812F) & \ -+ BIT_MASK_MACID31_0_PKTSLEEP_8812F) -+#define BIT_SET_MACID31_0_PKTSLEEP_8812F(x, v) \ -+ (BIT_CLEAR_MACID31_0_PKTSLEEP_8812F(x) | \ -+ BIT_MACID31_0_PKTSLEEP_8812F(v)) -+ -+/* 2 REG_HW_SEQ0_8812F */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ0_8812F 0 -+#define BIT_MASK_HW_SSN_SEQ0_8812F 0xfff -+#define BIT_HW_SSN_SEQ0_8812F(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ0_8812F) << BIT_SHIFT_HW_SSN_SEQ0_8812F) -+#define BITS_HW_SSN_SEQ0_8812F \ -+ (BIT_MASK_HW_SSN_SEQ0_8812F << BIT_SHIFT_HW_SSN_SEQ0_8812F) -+#define BIT_CLEAR_HW_SSN_SEQ0_8812F(x) ((x) & (~BITS_HW_SSN_SEQ0_8812F)) -+#define BIT_GET_HW_SSN_SEQ0_8812F(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ0_8812F) & BIT_MASK_HW_SSN_SEQ0_8812F) -+#define BIT_SET_HW_SSN_SEQ0_8812F(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ0_8812F(x) | BIT_HW_SSN_SEQ0_8812F(v)) -+ -+/* 2 REG_HW_SEQ1_8812F */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ1_8812F 0 -+#define BIT_MASK_HW_SSN_SEQ1_8812F 0xfff -+#define BIT_HW_SSN_SEQ1_8812F(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ1_8812F) << BIT_SHIFT_HW_SSN_SEQ1_8812F) -+#define BITS_HW_SSN_SEQ1_8812F \ -+ (BIT_MASK_HW_SSN_SEQ1_8812F << BIT_SHIFT_HW_SSN_SEQ1_8812F) -+#define BIT_CLEAR_HW_SSN_SEQ1_8812F(x) ((x) & (~BITS_HW_SSN_SEQ1_8812F)) -+#define BIT_GET_HW_SSN_SEQ1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ1_8812F) & BIT_MASK_HW_SSN_SEQ1_8812F) -+#define BIT_SET_HW_SSN_SEQ1_8812F(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ1_8812F(x) | BIT_HW_SSN_SEQ1_8812F(v)) -+ -+/* 2 REG_HW_SEQ2_8812F */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ2_8812F 0 -+#define BIT_MASK_HW_SSN_SEQ2_8812F 0xfff -+#define BIT_HW_SSN_SEQ2_8812F(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ2_8812F) << BIT_SHIFT_HW_SSN_SEQ2_8812F) -+#define BITS_HW_SSN_SEQ2_8812F \ -+ (BIT_MASK_HW_SSN_SEQ2_8812F << BIT_SHIFT_HW_SSN_SEQ2_8812F) -+#define BIT_CLEAR_HW_SSN_SEQ2_8812F(x) ((x) & (~BITS_HW_SSN_SEQ2_8812F)) -+#define BIT_GET_HW_SSN_SEQ2_8812F(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ2_8812F) & BIT_MASK_HW_SSN_SEQ2_8812F) -+#define BIT_SET_HW_SSN_SEQ2_8812F(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ2_8812F(x) | BIT_HW_SSN_SEQ2_8812F(v)) -+ -+/* 2 REG_HW_SEQ3_8812F */ -+ -+#define BIT_SHIFT_CSI_HWSEQ_SEL_8812F 12 -+#define BIT_MASK_CSI_HWSEQ_SEL_8812F 0x3 -+#define BIT_CSI_HWSEQ_SEL_8812F(x) \ -+ (((x) & BIT_MASK_CSI_HWSEQ_SEL_8812F) << BIT_SHIFT_CSI_HWSEQ_SEL_8812F) -+#define BITS_CSI_HWSEQ_SEL_8812F \ -+ (BIT_MASK_CSI_HWSEQ_SEL_8812F << BIT_SHIFT_CSI_HWSEQ_SEL_8812F) -+#define BIT_CLEAR_CSI_HWSEQ_SEL_8812F(x) ((x) & (~BITS_CSI_HWSEQ_SEL_8812F)) -+#define BIT_GET_CSI_HWSEQ_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_CSI_HWSEQ_SEL_8812F) & BIT_MASK_CSI_HWSEQ_SEL_8812F) -+#define BIT_SET_CSI_HWSEQ_SEL_8812F(x, v) \ -+ (BIT_CLEAR_CSI_HWSEQ_SEL_8812F(x) | BIT_CSI_HWSEQ_SEL_8812F(v)) -+ -+#define BIT_SHIFT_HW_SSN_SEQ3_8812F 0 -+#define BIT_MASK_HW_SSN_SEQ3_8812F 0xfff -+#define BIT_HW_SSN_SEQ3_8812F(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ3_8812F) << BIT_SHIFT_HW_SSN_SEQ3_8812F) -+#define BITS_HW_SSN_SEQ3_8812F \ -+ (BIT_MASK_HW_SSN_SEQ3_8812F << BIT_SHIFT_HW_SSN_SEQ3_8812F) -+#define BIT_CLEAR_HW_SSN_SEQ3_8812F(x) ((x) & (~BITS_HW_SSN_SEQ3_8812F)) -+#define BIT_GET_HW_SSN_SEQ3_8812F(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ3_8812F) & BIT_MASK_HW_SSN_SEQ3_8812F) -+#define BIT_SET_HW_SSN_SEQ3_8812F(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ3_8812F(x) | BIT_HW_SSN_SEQ3_8812F(v)) -+ -+/* 2 REG_NULL_PKT_STATUS_V1_8812F */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V2_8812F 2 -+#define BIT_MASK_PTCL_TOTAL_PG_V2_8812F 0x3fff -+#define BIT_PTCL_TOTAL_PG_V2_8812F(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V2_8812F) \ -+ << BIT_SHIFT_PTCL_TOTAL_PG_V2_8812F) -+#define BITS_PTCL_TOTAL_PG_V2_8812F \ -+ (BIT_MASK_PTCL_TOTAL_PG_V2_8812F << BIT_SHIFT_PTCL_TOTAL_PG_V2_8812F) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V2_8812F(x) \ -+ ((x) & (~BITS_PTCL_TOTAL_PG_V2_8812F)) -+#define BIT_GET_PTCL_TOTAL_PG_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V2_8812F) & \ -+ BIT_MASK_PTCL_TOTAL_PG_V2_8812F) -+#define BIT_SET_PTCL_TOTAL_PG_V2_8812F(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V2_8812F(x) | BIT_PTCL_TOTAL_PG_V2_8812F(v)) -+ -+#define BIT_TX_NULL_1_8812F BIT(1) -+#define BIT_TX_NULL_0_8812F BIT(0) -+ -+/* 2 REG_PTCL_ERR_STATUS_8812F */ -+#define BIT_PTCL_RATE_TABLE_INVALID_8812F BIT(7) -+#define BIT_FTM_T2R_ERROR_8812F BIT(6) -+#define BIT_PTCL_ERR0_8812F BIT(5) -+#define BIT_PTCL_ERR1_8812F BIT(4) -+#define BIT_PTCL_ERR2_8812F BIT(3) -+#define BIT_PTCL_ERR3_8812F BIT(2) -+#define BIT_PTCL_ERR4_8812F BIT(1) -+#define BIT_PTCL_ERR5_8812F BIT(0) -+ -+/* 2 REG_NULL_PKT_STATUS_EXTEND_8812F */ -+#define BIT_CLI3_TX_NULL_1_8812F BIT(7) -+#define BIT_CLI3_TX_NULL_0_8812F BIT(6) -+#define BIT_CLI2_TX_NULL_1_8812F BIT(5) -+#define BIT_CLI2_TX_NULL_0_8812F BIT(4) -+#define BIT_CLI1_TX_NULL_1_8812F BIT(3) -+#define BIT_CLI1_TX_NULL_0_8812F BIT(2) -+#define BIT_CLI0_TX_NULL_1_8812F BIT(1) -+#define BIT_CLI0_TX_NULL_0_8812F BIT(0) -+ -+/* 2 REG_HQMGQ_DROP_8812F */ -+#define BIT_HIQ_DROP_8812F BIT(7) -+#define BIT_MGQ_DROP_8812F BIT(6) -+#define BIT_CLR_HGQ_REQ_BLOCK_8812F BIT(5) -+ -+/* 2 REG_PRECNT_CTRL_8812F */ -+ -+#define BIT_SHIFT_COLLISION_DETECT_TIME_8812F 12 -+#define BIT_MASK_COLLISION_DETECT_TIME_8812F 0xf -+#define BIT_COLLISION_DETECT_TIME_8812F(x) \ -+ (((x) & BIT_MASK_COLLISION_DETECT_TIME_8812F) \ -+ << BIT_SHIFT_COLLISION_DETECT_TIME_8812F) -+#define BITS_COLLISION_DETECT_TIME_8812F \ -+ (BIT_MASK_COLLISION_DETECT_TIME_8812F \ -+ << BIT_SHIFT_COLLISION_DETECT_TIME_8812F) -+#define BIT_CLEAR_COLLISION_DETECT_TIME_8812F(x) \ -+ ((x) & (~BITS_COLLISION_DETECT_TIME_8812F)) -+#define BIT_GET_COLLISION_DETECT_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_COLLISION_DETECT_TIME_8812F) & \ -+ BIT_MASK_COLLISION_DETECT_TIME_8812F) -+#define BIT_SET_COLLISION_DETECT_TIME_8812F(x, v) \ -+ (BIT_CLEAR_COLLISION_DETECT_TIME_8812F(x) | \ -+ BIT_COLLISION_DETECT_TIME_8812F(v)) -+ -+#define BIT_EN_PRECNT_8812F BIT(11) -+ -+#define BIT_SHIFT_PRECNT_TH_8812F 0 -+#define BIT_MASK_PRECNT_TH_8812F 0x7ff -+#define BIT_PRECNT_TH_8812F(x) \ -+ (((x) & BIT_MASK_PRECNT_TH_8812F) << BIT_SHIFT_PRECNT_TH_8812F) -+#define BITS_PRECNT_TH_8812F \ -+ (BIT_MASK_PRECNT_TH_8812F << BIT_SHIFT_PRECNT_TH_8812F) -+#define BIT_CLEAR_PRECNT_TH_8812F(x) ((x) & (~BITS_PRECNT_TH_8812F)) -+#define BIT_GET_PRECNT_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_PRECNT_TH_8812F) & BIT_MASK_PRECNT_TH_8812F) -+#define BIT_SET_PRECNT_TH_8812F(x, v) \ -+ (BIT_CLEAR_PRECNT_TH_8812F(x) | BIT_PRECNT_TH_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_BT_POLLUTE_PKT_CNT_8812F */ -+ -+#define BIT_SHIFT_BT_POLLUTE_PKT_CNT_8812F 0 -+#define BIT_MASK_BT_POLLUTE_PKT_CNT_8812F 0xffff -+#define BIT_BT_POLLUTE_PKT_CNT_8812F(x) \ -+ (((x) & BIT_MASK_BT_POLLUTE_PKT_CNT_8812F) \ -+ << BIT_SHIFT_BT_POLLUTE_PKT_CNT_8812F) -+#define BITS_BT_POLLUTE_PKT_CNT_8812F \ -+ (BIT_MASK_BT_POLLUTE_PKT_CNT_8812F \ -+ << BIT_SHIFT_BT_POLLUTE_PKT_CNT_8812F) -+#define BIT_CLEAR_BT_POLLUTE_PKT_CNT_8812F(x) \ -+ ((x) & (~BITS_BT_POLLUTE_PKT_CNT_8812F)) -+#define BIT_GET_BT_POLLUTE_PKT_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_POLLUTE_PKT_CNT_8812F) & \ -+ BIT_MASK_BT_POLLUTE_PKT_CNT_8812F) -+#define BIT_SET_BT_POLLUTE_PKT_CNT_8812F(x, v) \ -+ (BIT_CLEAR_BT_POLLUTE_PKT_CNT_8812F(x) | \ -+ BIT_BT_POLLUTE_PKT_CNT_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_PTCL_DBG_8812F */ -+ -+#define BIT_SHIFT_PTCL_DBG_8812F 0 -+#define BIT_MASK_PTCL_DBG_8812F 0xffffffffL -+#define BIT_PTCL_DBG_8812F(x) \ -+ (((x) & BIT_MASK_PTCL_DBG_8812F) << BIT_SHIFT_PTCL_DBG_8812F) -+#define BITS_PTCL_DBG_8812F \ -+ (BIT_MASK_PTCL_DBG_8812F << BIT_SHIFT_PTCL_DBG_8812F) -+#define BIT_CLEAR_PTCL_DBG_8812F(x) ((x) & (~BITS_PTCL_DBG_8812F)) -+#define BIT_GET_PTCL_DBG_8812F(x) \ -+ (((x) >> BIT_SHIFT_PTCL_DBG_8812F) & BIT_MASK_PTCL_DBG_8812F) -+#define BIT_SET_PTCL_DBG_8812F(x, v) \ -+ (BIT_CLEAR_PTCL_DBG_8812F(x) | BIT_PTCL_DBG_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_CPUMGQ_TIMER_CTRL2_8812F */ -+ -+#define BIT_SHIFT_TRI_HEAD_ADDR_8812F 16 -+#define BIT_MASK_TRI_HEAD_ADDR_8812F 0xfff -+#define BIT_TRI_HEAD_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_TRI_HEAD_ADDR_8812F) << BIT_SHIFT_TRI_HEAD_ADDR_8812F) -+#define BITS_TRI_HEAD_ADDR_8812F \ -+ (BIT_MASK_TRI_HEAD_ADDR_8812F << BIT_SHIFT_TRI_HEAD_ADDR_8812F) -+#define BIT_CLEAR_TRI_HEAD_ADDR_8812F(x) ((x) & (~BITS_TRI_HEAD_ADDR_8812F)) -+#define BIT_GET_TRI_HEAD_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRI_HEAD_ADDR_8812F) & BIT_MASK_TRI_HEAD_ADDR_8812F) -+#define BIT_SET_TRI_HEAD_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_TRI_HEAD_ADDR_8812F(x) | BIT_TRI_HEAD_ADDR_8812F(v)) -+ -+#define BIT_DROP_TH_EN_8812F BIT(8) -+ -+#define BIT_SHIFT_DROP_TH_8812F 0 -+#define BIT_MASK_DROP_TH_8812F 0xff -+#define BIT_DROP_TH_8812F(x) \ -+ (((x) & BIT_MASK_DROP_TH_8812F) << BIT_SHIFT_DROP_TH_8812F) -+#define BITS_DROP_TH_8812F (BIT_MASK_DROP_TH_8812F << BIT_SHIFT_DROP_TH_8812F) -+#define BIT_CLEAR_DROP_TH_8812F(x) ((x) & (~BITS_DROP_TH_8812F)) -+#define BIT_GET_DROP_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_DROP_TH_8812F) & BIT_MASK_DROP_TH_8812F) -+#define BIT_SET_DROP_TH_8812F(x, v) \ -+ (BIT_CLEAR_DROP_TH_8812F(x) | BIT_DROP_TH_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_DUMMY_PAGE4_V1_8812F */ -+ -+/* 2 REG_MOREDATA_8812F */ -+#define BIT_MOREDATA_CTRL2_EN_V1_8812F BIT(3) -+#define BIT_MOREDATA_CTRL1_EN_V1_8812F BIT(2) -+#define BIT_PKTIN_MOREDATA_REPLACE_ENABLE_V1_8812F BIT(0) -+ -+/* 2 REG_Q0_Q1_INFO_8812F */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8812F BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8812F 28 -+#define BIT_MASK_GTAB_ID_8812F 0x7 -+#define BIT_GTAB_ID_8812F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8812F) << BIT_SHIFT_GTAB_ID_8812F) -+#define BITS_GTAB_ID_8812F (BIT_MASK_GTAB_ID_8812F << BIT_SHIFT_GTAB_ID_8812F) -+#define BIT_CLEAR_GTAB_ID_8812F(x) ((x) & (~BITS_GTAB_ID_8812F)) -+#define BIT_GET_GTAB_ID_8812F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8812F) & BIT_MASK_GTAB_ID_8812F) -+#define BIT_SET_GTAB_ID_8812F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8812F(x) | BIT_GTAB_ID_8812F(v)) -+ -+#define BIT_SHIFT_AC1_PKT_INFO_8812F 16 -+#define BIT_MASK_AC1_PKT_INFO_8812F 0xfff -+#define BIT_AC1_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_AC1_PKT_INFO_8812F) << BIT_SHIFT_AC1_PKT_INFO_8812F) -+#define BITS_AC1_PKT_INFO_8812F \ -+ (BIT_MASK_AC1_PKT_INFO_8812F << BIT_SHIFT_AC1_PKT_INFO_8812F) -+#define BIT_CLEAR_AC1_PKT_INFO_8812F(x) ((x) & (~BITS_AC1_PKT_INFO_8812F)) -+#define BIT_GET_AC1_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_AC1_PKT_INFO_8812F) & BIT_MASK_AC1_PKT_INFO_8812F) -+#define BIT_SET_AC1_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_AC1_PKT_INFO_8812F(x) | BIT_AC1_PKT_INFO_8812F(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8812F BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8812F 12 -+#define BIT_MASK_GTAB_ID_V1_8812F 0x7 -+#define BIT_GTAB_ID_V1_8812F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8812F) << BIT_SHIFT_GTAB_ID_V1_8812F) -+#define BITS_GTAB_ID_V1_8812F \ -+ (BIT_MASK_GTAB_ID_V1_8812F << BIT_SHIFT_GTAB_ID_V1_8812F) -+#define BIT_CLEAR_GTAB_ID_V1_8812F(x) ((x) & (~BITS_GTAB_ID_V1_8812F)) -+#define BIT_GET_GTAB_ID_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8812F) & BIT_MASK_GTAB_ID_V1_8812F) -+#define BIT_SET_GTAB_ID_V1_8812F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8812F(x) | BIT_GTAB_ID_V1_8812F(v)) -+ -+#define BIT_SHIFT_AC0_PKT_INFO_8812F 0 -+#define BIT_MASK_AC0_PKT_INFO_8812F 0xfff -+#define BIT_AC0_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_AC0_PKT_INFO_8812F) << BIT_SHIFT_AC0_PKT_INFO_8812F) -+#define BITS_AC0_PKT_INFO_8812F \ -+ (BIT_MASK_AC0_PKT_INFO_8812F << BIT_SHIFT_AC0_PKT_INFO_8812F) -+#define BIT_CLEAR_AC0_PKT_INFO_8812F(x) ((x) & (~BITS_AC0_PKT_INFO_8812F)) -+#define BIT_GET_AC0_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_AC0_PKT_INFO_8812F) & BIT_MASK_AC0_PKT_INFO_8812F) -+#define BIT_SET_AC0_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_AC0_PKT_INFO_8812F(x) | BIT_AC0_PKT_INFO_8812F(v)) -+ -+/* 2 REG_Q2_Q3_INFO_8812F */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8812F BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8812F 28 -+#define BIT_MASK_GTAB_ID_8812F 0x7 -+#define BIT_GTAB_ID_8812F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8812F) << BIT_SHIFT_GTAB_ID_8812F) -+#define BITS_GTAB_ID_8812F (BIT_MASK_GTAB_ID_8812F << BIT_SHIFT_GTAB_ID_8812F) -+#define BIT_CLEAR_GTAB_ID_8812F(x) ((x) & (~BITS_GTAB_ID_8812F)) -+#define BIT_GET_GTAB_ID_8812F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8812F) & BIT_MASK_GTAB_ID_8812F) -+#define BIT_SET_GTAB_ID_8812F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8812F(x) | BIT_GTAB_ID_8812F(v)) -+ -+#define BIT_SHIFT_AC3_PKT_INFO_8812F 16 -+#define BIT_MASK_AC3_PKT_INFO_8812F 0xfff -+#define BIT_AC3_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_AC3_PKT_INFO_8812F) << BIT_SHIFT_AC3_PKT_INFO_8812F) -+#define BITS_AC3_PKT_INFO_8812F \ -+ (BIT_MASK_AC3_PKT_INFO_8812F << BIT_SHIFT_AC3_PKT_INFO_8812F) -+#define BIT_CLEAR_AC3_PKT_INFO_8812F(x) ((x) & (~BITS_AC3_PKT_INFO_8812F)) -+#define BIT_GET_AC3_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_AC3_PKT_INFO_8812F) & BIT_MASK_AC3_PKT_INFO_8812F) -+#define BIT_SET_AC3_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_AC3_PKT_INFO_8812F(x) | BIT_AC3_PKT_INFO_8812F(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8812F BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8812F 12 -+#define BIT_MASK_GTAB_ID_V1_8812F 0x7 -+#define BIT_GTAB_ID_V1_8812F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8812F) << BIT_SHIFT_GTAB_ID_V1_8812F) -+#define BITS_GTAB_ID_V1_8812F \ -+ (BIT_MASK_GTAB_ID_V1_8812F << BIT_SHIFT_GTAB_ID_V1_8812F) -+#define BIT_CLEAR_GTAB_ID_V1_8812F(x) ((x) & (~BITS_GTAB_ID_V1_8812F)) -+#define BIT_GET_GTAB_ID_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8812F) & BIT_MASK_GTAB_ID_V1_8812F) -+#define BIT_SET_GTAB_ID_V1_8812F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8812F(x) | BIT_GTAB_ID_V1_8812F(v)) -+ -+#define BIT_SHIFT_AC2_PKT_INFO_8812F 0 -+#define BIT_MASK_AC2_PKT_INFO_8812F 0xfff -+#define BIT_AC2_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_AC2_PKT_INFO_8812F) << BIT_SHIFT_AC2_PKT_INFO_8812F) -+#define BITS_AC2_PKT_INFO_8812F \ -+ (BIT_MASK_AC2_PKT_INFO_8812F << BIT_SHIFT_AC2_PKT_INFO_8812F) -+#define BIT_CLEAR_AC2_PKT_INFO_8812F(x) ((x) & (~BITS_AC2_PKT_INFO_8812F)) -+#define BIT_GET_AC2_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_AC2_PKT_INFO_8812F) & BIT_MASK_AC2_PKT_INFO_8812F) -+#define BIT_SET_AC2_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_AC2_PKT_INFO_8812F(x) | BIT_AC2_PKT_INFO_8812F(v)) -+ -+/* 2 REG_Q4_Q5_INFO_8812F */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8812F BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8812F 28 -+#define BIT_MASK_GTAB_ID_8812F 0x7 -+#define BIT_GTAB_ID_8812F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8812F) << BIT_SHIFT_GTAB_ID_8812F) -+#define BITS_GTAB_ID_8812F (BIT_MASK_GTAB_ID_8812F << BIT_SHIFT_GTAB_ID_8812F) -+#define BIT_CLEAR_GTAB_ID_8812F(x) ((x) & (~BITS_GTAB_ID_8812F)) -+#define BIT_GET_GTAB_ID_8812F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8812F) & BIT_MASK_GTAB_ID_8812F) -+#define BIT_SET_GTAB_ID_8812F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8812F(x) | BIT_GTAB_ID_8812F(v)) -+ -+#define BIT_SHIFT_AC5_PKT_INFO_8812F 16 -+#define BIT_MASK_AC5_PKT_INFO_8812F 0xfff -+#define BIT_AC5_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_AC5_PKT_INFO_8812F) << BIT_SHIFT_AC5_PKT_INFO_8812F) -+#define BITS_AC5_PKT_INFO_8812F \ -+ (BIT_MASK_AC5_PKT_INFO_8812F << BIT_SHIFT_AC5_PKT_INFO_8812F) -+#define BIT_CLEAR_AC5_PKT_INFO_8812F(x) ((x) & (~BITS_AC5_PKT_INFO_8812F)) -+#define BIT_GET_AC5_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_AC5_PKT_INFO_8812F) & BIT_MASK_AC5_PKT_INFO_8812F) -+#define BIT_SET_AC5_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_AC5_PKT_INFO_8812F(x) | BIT_AC5_PKT_INFO_8812F(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8812F BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8812F 12 -+#define BIT_MASK_GTAB_ID_V1_8812F 0x7 -+#define BIT_GTAB_ID_V1_8812F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8812F) << BIT_SHIFT_GTAB_ID_V1_8812F) -+#define BITS_GTAB_ID_V1_8812F \ -+ (BIT_MASK_GTAB_ID_V1_8812F << BIT_SHIFT_GTAB_ID_V1_8812F) -+#define BIT_CLEAR_GTAB_ID_V1_8812F(x) ((x) & (~BITS_GTAB_ID_V1_8812F)) -+#define BIT_GET_GTAB_ID_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8812F) & BIT_MASK_GTAB_ID_V1_8812F) -+#define BIT_SET_GTAB_ID_V1_8812F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8812F(x) | BIT_GTAB_ID_V1_8812F(v)) -+ -+#define BIT_SHIFT_AC4_PKT_INFO_8812F 0 -+#define BIT_MASK_AC4_PKT_INFO_8812F 0xfff -+#define BIT_AC4_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_AC4_PKT_INFO_8812F) << BIT_SHIFT_AC4_PKT_INFO_8812F) -+#define BITS_AC4_PKT_INFO_8812F \ -+ (BIT_MASK_AC4_PKT_INFO_8812F << BIT_SHIFT_AC4_PKT_INFO_8812F) -+#define BIT_CLEAR_AC4_PKT_INFO_8812F(x) ((x) & (~BITS_AC4_PKT_INFO_8812F)) -+#define BIT_GET_AC4_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_AC4_PKT_INFO_8812F) & BIT_MASK_AC4_PKT_INFO_8812F) -+#define BIT_SET_AC4_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_AC4_PKT_INFO_8812F(x) | BIT_AC4_PKT_INFO_8812F(v)) -+ -+/* 2 REG_Q6_Q7_INFO_8812F */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8812F BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8812F 28 -+#define BIT_MASK_GTAB_ID_8812F 0x7 -+#define BIT_GTAB_ID_8812F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8812F) << BIT_SHIFT_GTAB_ID_8812F) -+#define BITS_GTAB_ID_8812F (BIT_MASK_GTAB_ID_8812F << BIT_SHIFT_GTAB_ID_8812F) -+#define BIT_CLEAR_GTAB_ID_8812F(x) ((x) & (~BITS_GTAB_ID_8812F)) -+#define BIT_GET_GTAB_ID_8812F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8812F) & BIT_MASK_GTAB_ID_8812F) -+#define BIT_SET_GTAB_ID_8812F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8812F(x) | BIT_GTAB_ID_8812F(v)) -+ -+#define BIT_SHIFT_AC7_PKT_INFO_8812F 16 -+#define BIT_MASK_AC7_PKT_INFO_8812F 0xfff -+#define BIT_AC7_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_AC7_PKT_INFO_8812F) << BIT_SHIFT_AC7_PKT_INFO_8812F) -+#define BITS_AC7_PKT_INFO_8812F \ -+ (BIT_MASK_AC7_PKT_INFO_8812F << BIT_SHIFT_AC7_PKT_INFO_8812F) -+#define BIT_CLEAR_AC7_PKT_INFO_8812F(x) ((x) & (~BITS_AC7_PKT_INFO_8812F)) -+#define BIT_GET_AC7_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_AC7_PKT_INFO_8812F) & BIT_MASK_AC7_PKT_INFO_8812F) -+#define BIT_SET_AC7_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_AC7_PKT_INFO_8812F(x) | BIT_AC7_PKT_INFO_8812F(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8812F BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8812F 12 -+#define BIT_MASK_GTAB_ID_V1_8812F 0x7 -+#define BIT_GTAB_ID_V1_8812F(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8812F) << BIT_SHIFT_GTAB_ID_V1_8812F) -+#define BITS_GTAB_ID_V1_8812F \ -+ (BIT_MASK_GTAB_ID_V1_8812F << BIT_SHIFT_GTAB_ID_V1_8812F) -+#define BIT_CLEAR_GTAB_ID_V1_8812F(x) ((x) & (~BITS_GTAB_ID_V1_8812F)) -+#define BIT_GET_GTAB_ID_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8812F) & BIT_MASK_GTAB_ID_V1_8812F) -+#define BIT_SET_GTAB_ID_V1_8812F(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8812F(x) | BIT_GTAB_ID_V1_8812F(v)) -+ -+#define BIT_SHIFT_AC6_PKT_INFO_8812F 0 -+#define BIT_MASK_AC6_PKT_INFO_8812F 0xfff -+#define BIT_AC6_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_AC6_PKT_INFO_8812F) << BIT_SHIFT_AC6_PKT_INFO_8812F) -+#define BITS_AC6_PKT_INFO_8812F \ -+ (BIT_MASK_AC6_PKT_INFO_8812F << BIT_SHIFT_AC6_PKT_INFO_8812F) -+#define BIT_CLEAR_AC6_PKT_INFO_8812F(x) ((x) & (~BITS_AC6_PKT_INFO_8812F)) -+#define BIT_GET_AC6_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_AC6_PKT_INFO_8812F) & BIT_MASK_AC6_PKT_INFO_8812F) -+#define BIT_SET_AC6_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_AC6_PKT_INFO_8812F(x) | BIT_AC6_PKT_INFO_8812F(v)) -+ -+/* 2 REG_MGQ_HIQ_INFO_8812F */ -+ -+#define BIT_SHIFT_HIQ_PKT_INFO_8812F 16 -+#define BIT_MASK_HIQ_PKT_INFO_8812F 0xfff -+#define BIT_HIQ_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_HIQ_PKT_INFO_8812F) << BIT_SHIFT_HIQ_PKT_INFO_8812F) -+#define BITS_HIQ_PKT_INFO_8812F \ -+ (BIT_MASK_HIQ_PKT_INFO_8812F << BIT_SHIFT_HIQ_PKT_INFO_8812F) -+#define BIT_CLEAR_HIQ_PKT_INFO_8812F(x) ((x) & (~BITS_HIQ_PKT_INFO_8812F)) -+#define BIT_GET_HIQ_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_HIQ_PKT_INFO_8812F) & BIT_MASK_HIQ_PKT_INFO_8812F) -+#define BIT_SET_HIQ_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_HIQ_PKT_INFO_8812F(x) | BIT_HIQ_PKT_INFO_8812F(v)) -+ -+#define BIT_SHIFT_MGQ_PKT_INFO_8812F 0 -+#define BIT_MASK_MGQ_PKT_INFO_8812F 0xfff -+#define BIT_MGQ_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_PKT_INFO_8812F) << BIT_SHIFT_MGQ_PKT_INFO_8812F) -+#define BITS_MGQ_PKT_INFO_8812F \ -+ (BIT_MASK_MGQ_PKT_INFO_8812F << BIT_SHIFT_MGQ_PKT_INFO_8812F) -+#define BIT_CLEAR_MGQ_PKT_INFO_8812F(x) ((x) & (~BITS_MGQ_PKT_INFO_8812F)) -+#define BIT_GET_MGQ_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PKT_INFO_8812F) & BIT_MASK_MGQ_PKT_INFO_8812F) -+#define BIT_SET_MGQ_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_PKT_INFO_8812F(x) | BIT_MGQ_PKT_INFO_8812F(v)) -+ -+/* 2 REG_CMDQ_BCNQ_INFO_8812F */ -+ -+#define BIT_SHIFT_CMDQ_PKT_INFO_8812F 16 -+#define BIT_MASK_CMDQ_PKT_INFO_8812F 0xfff -+#define BIT_CMDQ_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_CMDQ_PKT_INFO_8812F) << BIT_SHIFT_CMDQ_PKT_INFO_8812F) -+#define BITS_CMDQ_PKT_INFO_8812F \ -+ (BIT_MASK_CMDQ_PKT_INFO_8812F << BIT_SHIFT_CMDQ_PKT_INFO_8812F) -+#define BIT_CLEAR_CMDQ_PKT_INFO_8812F(x) ((x) & (~BITS_CMDQ_PKT_INFO_8812F)) -+#define BIT_GET_CMDQ_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_CMDQ_PKT_INFO_8812F) & BIT_MASK_CMDQ_PKT_INFO_8812F) -+#define BIT_SET_CMDQ_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_CMDQ_PKT_INFO_8812F(x) | BIT_CMDQ_PKT_INFO_8812F(v)) -+ -+#define BIT_SHIFT_BCNQ_PKT_INFO_8812F 0 -+#define BIT_MASK_BCNQ_PKT_INFO_8812F 0xfff -+#define BIT_BCNQ_PKT_INFO_8812F(x) \ -+ (((x) & BIT_MASK_BCNQ_PKT_INFO_8812F) << BIT_SHIFT_BCNQ_PKT_INFO_8812F) -+#define BITS_BCNQ_PKT_INFO_8812F \ -+ (BIT_MASK_BCNQ_PKT_INFO_8812F << BIT_SHIFT_BCNQ_PKT_INFO_8812F) -+#define BIT_CLEAR_BCNQ_PKT_INFO_8812F(x) ((x) & (~BITS_BCNQ_PKT_INFO_8812F)) -+#define BIT_GET_BCNQ_PKT_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PKT_INFO_8812F) & BIT_MASK_BCNQ_PKT_INFO_8812F) -+#define BIT_SET_BCNQ_PKT_INFO_8812F(x, v) \ -+ (BIT_CLEAR_BCNQ_PKT_INFO_8812F(x) | BIT_BCNQ_PKT_INFO_8812F(v)) -+ -+/* 2 REG_LOOPBACK_OPTION_8812F */ -+#define BIT_LOOPACK_FAST_EDCA_EN_8812F BIT(24) -+ -+/* 2 REG_AESIV_SETTING_8812F */ -+ -+#define BIT_SHIFT_AESIV_OFFSET_8812F 0 -+#define BIT_MASK_AESIV_OFFSET_8812F 0xfff -+#define BIT_AESIV_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_AESIV_OFFSET_8812F) << BIT_SHIFT_AESIV_OFFSET_8812F) -+#define BITS_AESIV_OFFSET_8812F \ -+ (BIT_MASK_AESIV_OFFSET_8812F << BIT_SHIFT_AESIV_OFFSET_8812F) -+#define BIT_CLEAR_AESIV_OFFSET_8812F(x) ((x) & (~BITS_AESIV_OFFSET_8812F)) -+#define BIT_GET_AESIV_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_AESIV_OFFSET_8812F) & BIT_MASK_AESIV_OFFSET_8812F) -+#define BIT_SET_AESIV_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_AESIV_OFFSET_8812F(x) | BIT_AESIV_OFFSET_8812F(v)) -+ -+/* 2 REG_BF0_TIME_SETTING_8812F */ -+#define BIT_BF0_TIMER_SET_8812F BIT(31) -+#define BIT_BF0_TIMER_CLR_8812F BIT(30) -+#define BIT_BF0_UPDATE_EN_8812F BIT(29) -+#define BIT_BF0_TIMER_EN_8812F BIT(28) -+ -+#define BIT_SHIFT_BF0_PRETIME_OVER_8812F 16 -+#define BIT_MASK_BF0_PRETIME_OVER_8812F 0xfff -+#define BIT_BF0_PRETIME_OVER_8812F(x) \ -+ (((x) & BIT_MASK_BF0_PRETIME_OVER_8812F) \ -+ << BIT_SHIFT_BF0_PRETIME_OVER_8812F) -+#define BITS_BF0_PRETIME_OVER_8812F \ -+ (BIT_MASK_BF0_PRETIME_OVER_8812F << BIT_SHIFT_BF0_PRETIME_OVER_8812F) -+#define BIT_CLEAR_BF0_PRETIME_OVER_8812F(x) \ -+ ((x) & (~BITS_BF0_PRETIME_OVER_8812F)) -+#define BIT_GET_BF0_PRETIME_OVER_8812F(x) \ -+ (((x) >> BIT_SHIFT_BF0_PRETIME_OVER_8812F) & \ -+ BIT_MASK_BF0_PRETIME_OVER_8812F) -+#define BIT_SET_BF0_PRETIME_OVER_8812F(x, v) \ -+ (BIT_CLEAR_BF0_PRETIME_OVER_8812F(x) | BIT_BF0_PRETIME_OVER_8812F(v)) -+ -+#define BIT_SHIFT_BF0_LIFETIME_8812F 0 -+#define BIT_MASK_BF0_LIFETIME_8812F 0xffff -+#define BIT_BF0_LIFETIME_8812F(x) \ -+ (((x) & BIT_MASK_BF0_LIFETIME_8812F) << BIT_SHIFT_BF0_LIFETIME_8812F) -+#define BITS_BF0_LIFETIME_8812F \ -+ (BIT_MASK_BF0_LIFETIME_8812F << BIT_SHIFT_BF0_LIFETIME_8812F) -+#define BIT_CLEAR_BF0_LIFETIME_8812F(x) ((x) & (~BITS_BF0_LIFETIME_8812F)) -+#define BIT_GET_BF0_LIFETIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_BF0_LIFETIME_8812F) & BIT_MASK_BF0_LIFETIME_8812F) -+#define BIT_SET_BF0_LIFETIME_8812F(x, v) \ -+ (BIT_CLEAR_BF0_LIFETIME_8812F(x) | BIT_BF0_LIFETIME_8812F(v)) -+ -+/* 2 REG_BF1_TIME_SETTING_8812F */ -+#define BIT_BF1_TIMER_SET_8812F BIT(31) -+#define BIT_BF1_TIMER_CLR_8812F BIT(30) -+#define BIT_BF1_UPDATE_EN_8812F BIT(29) -+#define BIT_BF1_TIMER_EN_8812F BIT(28) -+ -+#define BIT_SHIFT_BF1_PRETIME_OVER_8812F 16 -+#define BIT_MASK_BF1_PRETIME_OVER_8812F 0xfff -+#define BIT_BF1_PRETIME_OVER_8812F(x) \ -+ (((x) & BIT_MASK_BF1_PRETIME_OVER_8812F) \ -+ << BIT_SHIFT_BF1_PRETIME_OVER_8812F) -+#define BITS_BF1_PRETIME_OVER_8812F \ -+ (BIT_MASK_BF1_PRETIME_OVER_8812F << BIT_SHIFT_BF1_PRETIME_OVER_8812F) -+#define BIT_CLEAR_BF1_PRETIME_OVER_8812F(x) \ -+ ((x) & (~BITS_BF1_PRETIME_OVER_8812F)) -+#define BIT_GET_BF1_PRETIME_OVER_8812F(x) \ -+ (((x) >> BIT_SHIFT_BF1_PRETIME_OVER_8812F) & \ -+ BIT_MASK_BF1_PRETIME_OVER_8812F) -+#define BIT_SET_BF1_PRETIME_OVER_8812F(x, v) \ -+ (BIT_CLEAR_BF1_PRETIME_OVER_8812F(x) | BIT_BF1_PRETIME_OVER_8812F(v)) -+ -+#define BIT_SHIFT_BF1_LIFETIME_8812F 0 -+#define BIT_MASK_BF1_LIFETIME_8812F 0xffff -+#define BIT_BF1_LIFETIME_8812F(x) \ -+ (((x) & BIT_MASK_BF1_LIFETIME_8812F) << BIT_SHIFT_BF1_LIFETIME_8812F) -+#define BITS_BF1_LIFETIME_8812F \ -+ (BIT_MASK_BF1_LIFETIME_8812F << BIT_SHIFT_BF1_LIFETIME_8812F) -+#define BIT_CLEAR_BF1_LIFETIME_8812F(x) ((x) & (~BITS_BF1_LIFETIME_8812F)) -+#define BIT_GET_BF1_LIFETIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_BF1_LIFETIME_8812F) & BIT_MASK_BF1_LIFETIME_8812F) -+#define BIT_SET_BF1_LIFETIME_8812F(x, v) \ -+ (BIT_CLEAR_BF1_LIFETIME_8812F(x) | BIT_BF1_LIFETIME_8812F(v)) -+ -+/* 2 REG_BF_TIMEOUT_EN_8812F */ -+#define BIT_EN_VHT_LDPC_8812F BIT(9) -+#define BIT_EN_HT_LDPC_8812F BIT(8) -+#define BIT_BF1_TIMEOUT_EN_8812F BIT(1) -+#define BIT_BF0_TIMEOUT_EN_8812F BIT(0) -+ -+/* 2 REG_MACID_RELEASE0_8812F */ -+ -+#define BIT_SHIFT_MACID31_0_RELEASE_8812F 0 -+#define BIT_MASK_MACID31_0_RELEASE_8812F 0xffffffffL -+#define BIT_MACID31_0_RELEASE_8812F(x) \ -+ (((x) & BIT_MASK_MACID31_0_RELEASE_8812F) \ -+ << BIT_SHIFT_MACID31_0_RELEASE_8812F) -+#define BITS_MACID31_0_RELEASE_8812F \ -+ (BIT_MASK_MACID31_0_RELEASE_8812F << BIT_SHIFT_MACID31_0_RELEASE_8812F) -+#define BIT_CLEAR_MACID31_0_RELEASE_8812F(x) \ -+ ((x) & (~BITS_MACID31_0_RELEASE_8812F)) -+#define BIT_GET_MACID31_0_RELEASE_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_RELEASE_8812F) & \ -+ BIT_MASK_MACID31_0_RELEASE_8812F) -+#define BIT_SET_MACID31_0_RELEASE_8812F(x, v) \ -+ (BIT_CLEAR_MACID31_0_RELEASE_8812F(x) | BIT_MACID31_0_RELEASE_8812F(v)) -+ -+/* 2 REG_MACID_RELEASE1_8812F */ -+ -+#define BIT_SHIFT_MACID63_32_RELEASE_8812F 0 -+#define BIT_MASK_MACID63_32_RELEASE_8812F 0xffffffffL -+#define BIT_MACID63_32_RELEASE_8812F(x) \ -+ (((x) & BIT_MASK_MACID63_32_RELEASE_8812F) \ -+ << BIT_SHIFT_MACID63_32_RELEASE_8812F) -+#define BITS_MACID63_32_RELEASE_8812F \ -+ (BIT_MASK_MACID63_32_RELEASE_8812F \ -+ << BIT_SHIFT_MACID63_32_RELEASE_8812F) -+#define BIT_CLEAR_MACID63_32_RELEASE_8812F(x) \ -+ ((x) & (~BITS_MACID63_32_RELEASE_8812F)) -+#define BIT_GET_MACID63_32_RELEASE_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_RELEASE_8812F) & \ -+ BIT_MASK_MACID63_32_RELEASE_8812F) -+#define BIT_SET_MACID63_32_RELEASE_8812F(x, v) \ -+ (BIT_CLEAR_MACID63_32_RELEASE_8812F(x) | \ -+ BIT_MACID63_32_RELEASE_8812F(v)) -+ -+/* 2 REG_MACID_RELEASE2_8812F */ -+ -+#define BIT_SHIFT_MACID95_64_RELEASE_8812F 0 -+#define BIT_MASK_MACID95_64_RELEASE_8812F 0xffffffffL -+#define BIT_MACID95_64_RELEASE_8812F(x) \ -+ (((x) & BIT_MASK_MACID95_64_RELEASE_8812F) \ -+ << BIT_SHIFT_MACID95_64_RELEASE_8812F) -+#define BITS_MACID95_64_RELEASE_8812F \ -+ (BIT_MASK_MACID95_64_RELEASE_8812F \ -+ << BIT_SHIFT_MACID95_64_RELEASE_8812F) -+#define BIT_CLEAR_MACID95_64_RELEASE_8812F(x) \ -+ ((x) & (~BITS_MACID95_64_RELEASE_8812F)) -+#define BIT_GET_MACID95_64_RELEASE_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_RELEASE_8812F) & \ -+ BIT_MASK_MACID95_64_RELEASE_8812F) -+#define BIT_SET_MACID95_64_RELEASE_8812F(x, v) \ -+ (BIT_CLEAR_MACID95_64_RELEASE_8812F(x) | \ -+ BIT_MACID95_64_RELEASE_8812F(v)) -+ -+/* 2 REG_MACID_RELEASE3_8812F */ -+ -+#define BIT_SHIFT_MACID127_96_RELEASE_8812F 0 -+#define BIT_MASK_MACID127_96_RELEASE_8812F 0xffffffffL -+#define BIT_MACID127_96_RELEASE_8812F(x) \ -+ (((x) & BIT_MASK_MACID127_96_RELEASE_8812F) \ -+ << BIT_SHIFT_MACID127_96_RELEASE_8812F) -+#define BITS_MACID127_96_RELEASE_8812F \ -+ (BIT_MASK_MACID127_96_RELEASE_8812F \ -+ << BIT_SHIFT_MACID127_96_RELEASE_8812F) -+#define BIT_CLEAR_MACID127_96_RELEASE_8812F(x) \ -+ ((x) & (~BITS_MACID127_96_RELEASE_8812F)) -+#define BIT_GET_MACID127_96_RELEASE_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_RELEASE_8812F) & \ -+ BIT_MASK_MACID127_96_RELEASE_8812F) -+#define BIT_SET_MACID127_96_RELEASE_8812F(x, v) \ -+ (BIT_CLEAR_MACID127_96_RELEASE_8812F(x) | \ -+ BIT_MACID127_96_RELEASE_8812F(v)) -+ -+/* 2 REG_MACID_RELEASE_SETTING_8812F */ -+#define BIT_MACID_VALUE_8812F BIT(7) -+ -+#define BIT_SHIFT_MACID_OFFSET_8812F 0 -+#define BIT_MASK_MACID_OFFSET_8812F 0x7f -+#define BIT_MACID_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_MACID_OFFSET_8812F) << BIT_SHIFT_MACID_OFFSET_8812F) -+#define BITS_MACID_OFFSET_8812F \ -+ (BIT_MASK_MACID_OFFSET_8812F << BIT_SHIFT_MACID_OFFSET_8812F) -+#define BIT_CLEAR_MACID_OFFSET_8812F(x) ((x) & (~BITS_MACID_OFFSET_8812F)) -+#define BIT_GET_MACID_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID_OFFSET_8812F) & BIT_MASK_MACID_OFFSET_8812F) -+#define BIT_SET_MACID_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_MACID_OFFSET_8812F(x) | BIT_MACID_OFFSET_8812F(v)) -+ -+/* 2 REG_FAST_EDCA_VOVI_SETTING_8812F */ -+ -+#define BIT_SHIFT_VI_FAST_EDCA_TO_8812F 24 -+#define BIT_MASK_VI_FAST_EDCA_TO_8812F 0xff -+#define BIT_VI_FAST_EDCA_TO_8812F(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_TO_8812F) \ -+ << BIT_SHIFT_VI_FAST_EDCA_TO_8812F) -+#define BITS_VI_FAST_EDCA_TO_8812F \ -+ (BIT_MASK_VI_FAST_EDCA_TO_8812F << BIT_SHIFT_VI_FAST_EDCA_TO_8812F) -+#define BIT_CLEAR_VI_FAST_EDCA_TO_8812F(x) ((x) & (~BITS_VI_FAST_EDCA_TO_8812F)) -+#define BIT_GET_VI_FAST_EDCA_TO_8812F(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_TO_8812F) & \ -+ BIT_MASK_VI_FAST_EDCA_TO_8812F) -+#define BIT_SET_VI_FAST_EDCA_TO_8812F(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_TO_8812F(x) | BIT_VI_FAST_EDCA_TO_8812F(v)) -+ -+#define BIT_VI_THRESHOLD_SEL_8812F BIT(23) -+ -+#define BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8812F 16 -+#define BIT_MASK_VI_FAST_EDCA_PKT_TH_8812F 0x7f -+#define BIT_VI_FAST_EDCA_PKT_TH_8812F(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_PKT_TH_8812F) \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8812F) -+#define BITS_VI_FAST_EDCA_PKT_TH_8812F \ -+ (BIT_MASK_VI_FAST_EDCA_PKT_TH_8812F \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8812F) -+#define BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8812F(x) \ -+ ((x) & (~BITS_VI_FAST_EDCA_PKT_TH_8812F)) -+#define BIT_GET_VI_FAST_EDCA_PKT_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8812F) & \ -+ BIT_MASK_VI_FAST_EDCA_PKT_TH_8812F) -+#define BIT_SET_VI_FAST_EDCA_PKT_TH_8812F(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8812F(x) | \ -+ BIT_VI_FAST_EDCA_PKT_TH_8812F(v)) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_TO_8812F 8 -+#define BIT_MASK_VO_FAST_EDCA_TO_8812F 0xff -+#define BIT_VO_FAST_EDCA_TO_8812F(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_TO_8812F) \ -+ << BIT_SHIFT_VO_FAST_EDCA_TO_8812F) -+#define BITS_VO_FAST_EDCA_TO_8812F \ -+ (BIT_MASK_VO_FAST_EDCA_TO_8812F << BIT_SHIFT_VO_FAST_EDCA_TO_8812F) -+#define BIT_CLEAR_VO_FAST_EDCA_TO_8812F(x) ((x) & (~BITS_VO_FAST_EDCA_TO_8812F)) -+#define BIT_GET_VO_FAST_EDCA_TO_8812F(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_TO_8812F) & \ -+ BIT_MASK_VO_FAST_EDCA_TO_8812F) -+#define BIT_SET_VO_FAST_EDCA_TO_8812F(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_TO_8812F(x) | BIT_VO_FAST_EDCA_TO_8812F(v)) -+ -+#define BIT_VO_THRESHOLD_SEL_8812F BIT(7) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8812F 0 -+#define BIT_MASK_VO_FAST_EDCA_PKT_TH_8812F 0x7f -+#define BIT_VO_FAST_EDCA_PKT_TH_8812F(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_PKT_TH_8812F) \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8812F) -+#define BITS_VO_FAST_EDCA_PKT_TH_8812F \ -+ (BIT_MASK_VO_FAST_EDCA_PKT_TH_8812F \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8812F) -+#define BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8812F(x) \ -+ ((x) & (~BITS_VO_FAST_EDCA_PKT_TH_8812F)) -+#define BIT_GET_VO_FAST_EDCA_PKT_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8812F) & \ -+ BIT_MASK_VO_FAST_EDCA_PKT_TH_8812F) -+#define BIT_SET_VO_FAST_EDCA_PKT_TH_8812F(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8812F(x) | \ -+ BIT_VO_FAST_EDCA_PKT_TH_8812F(v)) -+ -+/* 2 REG_FAST_EDCA_BEBK_SETTING_8812F */ -+ -+#define BIT_SHIFT_BK_FAST_EDCA_TO_8812F 24 -+#define BIT_MASK_BK_FAST_EDCA_TO_8812F 0xff -+#define BIT_BK_FAST_EDCA_TO_8812F(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_TO_8812F) \ -+ << BIT_SHIFT_BK_FAST_EDCA_TO_8812F) -+#define BITS_BK_FAST_EDCA_TO_8812F \ -+ (BIT_MASK_BK_FAST_EDCA_TO_8812F << BIT_SHIFT_BK_FAST_EDCA_TO_8812F) -+#define BIT_CLEAR_BK_FAST_EDCA_TO_8812F(x) ((x) & (~BITS_BK_FAST_EDCA_TO_8812F)) -+#define BIT_GET_BK_FAST_EDCA_TO_8812F(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_TO_8812F) & \ -+ BIT_MASK_BK_FAST_EDCA_TO_8812F) -+#define BIT_SET_BK_FAST_EDCA_TO_8812F(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_TO_8812F(x) | BIT_BK_FAST_EDCA_TO_8812F(v)) -+ -+#define BIT_BK_THRESHOLD_SEL_8812F BIT(23) -+ -+#define BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8812F 16 -+#define BIT_MASK_BK_FAST_EDCA_PKT_TH_8812F 0x7f -+#define BIT_BK_FAST_EDCA_PKT_TH_8812F(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_PKT_TH_8812F) \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8812F) -+#define BITS_BK_FAST_EDCA_PKT_TH_8812F \ -+ (BIT_MASK_BK_FAST_EDCA_PKT_TH_8812F \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8812F) -+#define BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8812F(x) \ -+ ((x) & (~BITS_BK_FAST_EDCA_PKT_TH_8812F)) -+#define BIT_GET_BK_FAST_EDCA_PKT_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8812F) & \ -+ BIT_MASK_BK_FAST_EDCA_PKT_TH_8812F) -+#define BIT_SET_BK_FAST_EDCA_PKT_TH_8812F(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8812F(x) | \ -+ BIT_BK_FAST_EDCA_PKT_TH_8812F(v)) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_TO_8812F 8 -+#define BIT_MASK_BE_FAST_EDCA_TO_8812F 0xff -+#define BIT_BE_FAST_EDCA_TO_8812F(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_TO_8812F) \ -+ << BIT_SHIFT_BE_FAST_EDCA_TO_8812F) -+#define BITS_BE_FAST_EDCA_TO_8812F \ -+ (BIT_MASK_BE_FAST_EDCA_TO_8812F << BIT_SHIFT_BE_FAST_EDCA_TO_8812F) -+#define BIT_CLEAR_BE_FAST_EDCA_TO_8812F(x) ((x) & (~BITS_BE_FAST_EDCA_TO_8812F)) -+#define BIT_GET_BE_FAST_EDCA_TO_8812F(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_TO_8812F) & \ -+ BIT_MASK_BE_FAST_EDCA_TO_8812F) -+#define BIT_SET_BE_FAST_EDCA_TO_8812F(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_TO_8812F(x) | BIT_BE_FAST_EDCA_TO_8812F(v)) -+ -+#define BIT_BE_THRESHOLD_SEL_8812F BIT(7) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8812F 0 -+#define BIT_MASK_BE_FAST_EDCA_PKT_TH_8812F 0x7f -+#define BIT_BE_FAST_EDCA_PKT_TH_8812F(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_PKT_TH_8812F) \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8812F) -+#define BITS_BE_FAST_EDCA_PKT_TH_8812F \ -+ (BIT_MASK_BE_FAST_EDCA_PKT_TH_8812F \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8812F) -+#define BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8812F(x) \ -+ ((x) & (~BITS_BE_FAST_EDCA_PKT_TH_8812F)) -+#define BIT_GET_BE_FAST_EDCA_PKT_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8812F) & \ -+ BIT_MASK_BE_FAST_EDCA_PKT_TH_8812F) -+#define BIT_SET_BE_FAST_EDCA_PKT_TH_8812F(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8812F(x) | \ -+ BIT_BE_FAST_EDCA_PKT_TH_8812F(v)) -+ -+/* 2 REG_MACID_DROP0_8812F */ -+ -+#define BIT_SHIFT_MACID31_0_DROP_8812F 0 -+#define BIT_MASK_MACID31_0_DROP_8812F 0xffffffffL -+#define BIT_MACID31_0_DROP_8812F(x) \ -+ (((x) & BIT_MASK_MACID31_0_DROP_8812F) \ -+ << BIT_SHIFT_MACID31_0_DROP_8812F) -+#define BITS_MACID31_0_DROP_8812F \ -+ (BIT_MASK_MACID31_0_DROP_8812F << BIT_SHIFT_MACID31_0_DROP_8812F) -+#define BIT_CLEAR_MACID31_0_DROP_8812F(x) ((x) & (~BITS_MACID31_0_DROP_8812F)) -+#define BIT_GET_MACID31_0_DROP_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_DROP_8812F) & \ -+ BIT_MASK_MACID31_0_DROP_8812F) -+#define BIT_SET_MACID31_0_DROP_8812F(x, v) \ -+ (BIT_CLEAR_MACID31_0_DROP_8812F(x) | BIT_MACID31_0_DROP_8812F(v)) -+ -+/* 2 REG_MACID_DROP1_8812F */ -+ -+#define BIT_SHIFT_MACID63_32_DROP_8812F 0 -+#define BIT_MASK_MACID63_32_DROP_8812F 0xffffffffL -+#define BIT_MACID63_32_DROP_8812F(x) \ -+ (((x) & BIT_MASK_MACID63_32_DROP_8812F) \ -+ << BIT_SHIFT_MACID63_32_DROP_8812F) -+#define BITS_MACID63_32_DROP_8812F \ -+ (BIT_MASK_MACID63_32_DROP_8812F << BIT_SHIFT_MACID63_32_DROP_8812F) -+#define BIT_CLEAR_MACID63_32_DROP_8812F(x) ((x) & (~BITS_MACID63_32_DROP_8812F)) -+#define BIT_GET_MACID63_32_DROP_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_DROP_8812F) & \ -+ BIT_MASK_MACID63_32_DROP_8812F) -+#define BIT_SET_MACID63_32_DROP_8812F(x, v) \ -+ (BIT_CLEAR_MACID63_32_DROP_8812F(x) | BIT_MACID63_32_DROP_8812F(v)) -+ -+/* 2 REG_MACID_DROP2_8812F */ -+ -+#define BIT_SHIFT_MACID95_64_DROP_8812F 0 -+#define BIT_MASK_MACID95_64_DROP_8812F 0xffffffffL -+#define BIT_MACID95_64_DROP_8812F(x) \ -+ (((x) & BIT_MASK_MACID95_64_DROP_8812F) \ -+ << BIT_SHIFT_MACID95_64_DROP_8812F) -+#define BITS_MACID95_64_DROP_8812F \ -+ (BIT_MASK_MACID95_64_DROP_8812F << BIT_SHIFT_MACID95_64_DROP_8812F) -+#define BIT_CLEAR_MACID95_64_DROP_8812F(x) ((x) & (~BITS_MACID95_64_DROP_8812F)) -+#define BIT_GET_MACID95_64_DROP_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_DROP_8812F) & \ -+ BIT_MASK_MACID95_64_DROP_8812F) -+#define BIT_SET_MACID95_64_DROP_8812F(x, v) \ -+ (BIT_CLEAR_MACID95_64_DROP_8812F(x) | BIT_MACID95_64_DROP_8812F(v)) -+ -+/* 2 REG_MACID_DROP3_8812F */ -+ -+#define BIT_SHIFT_MACID127_96_DROP_8812F 0 -+#define BIT_MASK_MACID127_96_DROP_8812F 0xffffffffL -+#define BIT_MACID127_96_DROP_8812F(x) \ -+ (((x) & BIT_MASK_MACID127_96_DROP_8812F) \ -+ << BIT_SHIFT_MACID127_96_DROP_8812F) -+#define BITS_MACID127_96_DROP_8812F \ -+ (BIT_MASK_MACID127_96_DROP_8812F << BIT_SHIFT_MACID127_96_DROP_8812F) -+#define BIT_CLEAR_MACID127_96_DROP_8812F(x) \ -+ ((x) & (~BITS_MACID127_96_DROP_8812F)) -+#define BIT_GET_MACID127_96_DROP_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_DROP_8812F) & \ -+ BIT_MASK_MACID127_96_DROP_8812F) -+#define BIT_SET_MACID127_96_DROP_8812F(x, v) \ -+ (BIT_CLEAR_MACID127_96_DROP_8812F(x) | BIT_MACID127_96_DROP_8812F(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_0_8812F */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8812F 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8812F 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_0_8812F(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8812F) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8812F) -+#define BITS_R_MACID_RELEASE_SUCCESS_0_8812F \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8812F \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8812F) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0_8812F(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_0_8812F)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8812F) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8812F) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_0_8812F(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0_8812F(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_0_8812F(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_1_8812F */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8812F 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8812F 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_1_8812F(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8812F) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8812F) -+#define BITS_R_MACID_RELEASE_SUCCESS_1_8812F \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8812F \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8812F) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1_8812F(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_1_8812F)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8812F) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8812F) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_1_8812F(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1_8812F(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_1_8812F(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_2_8812F */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8812F 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8812F 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_2_8812F(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8812F) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8812F) -+#define BITS_R_MACID_RELEASE_SUCCESS_2_8812F \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8812F \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8812F) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2_8812F(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_2_8812F)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8812F) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8812F) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_2_8812F(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2_8812F(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_2_8812F(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_3_8812F */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8812F 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8812F 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_3_8812F(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8812F) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8812F) -+#define BITS_R_MACID_RELEASE_SUCCESS_3_8812F \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8812F \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8812F) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3_8812F(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_3_8812F)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_3_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8812F) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8812F) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_3_8812F(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3_8812F(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_3_8812F(v)) -+ -+/* 2 REG_MGQ_FIFO_WRITE_POINTER_8812F */ -+#define BIT_MGQ_FIFO_OV_8812F BIT(7) -+#define BIT_MGQ_FIFO_WPTR_ERROR_8812F BIT(6) -+#define BIT_EN_MGQ_FIFO_LIFETIME_8812F BIT(5) -+ -+#define BIT_SHIFT_MGQ_FIFO_WPTR_8812F 0 -+#define BIT_MASK_MGQ_FIFO_WPTR_8812F 0x1f -+#define BIT_MGQ_FIFO_WPTR_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_WPTR_8812F) << BIT_SHIFT_MGQ_FIFO_WPTR_8812F) -+#define BITS_MGQ_FIFO_WPTR_8812F \ -+ (BIT_MASK_MGQ_FIFO_WPTR_8812F << BIT_SHIFT_MGQ_FIFO_WPTR_8812F) -+#define BIT_CLEAR_MGQ_FIFO_WPTR_8812F(x) ((x) & (~BITS_MGQ_FIFO_WPTR_8812F)) -+#define BIT_GET_MGQ_FIFO_WPTR_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_WPTR_8812F) & BIT_MASK_MGQ_FIFO_WPTR_8812F) -+#define BIT_SET_MGQ_FIFO_WPTR_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_WPTR_8812F(x) | BIT_MGQ_FIFO_WPTR_8812F(v)) -+ -+/* 2 REG_MGQ_FIFO_READ_POINTER_8812F */ -+ -+#define BIT_SHIFT_MGQ_FIFO_SIZE_8812F 14 -+#define BIT_MASK_MGQ_FIFO_SIZE_8812F 0x3 -+#define BIT_MGQ_FIFO_SIZE_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_SIZE_8812F) << BIT_SHIFT_MGQ_FIFO_SIZE_8812F) -+#define BITS_MGQ_FIFO_SIZE_8812F \ -+ (BIT_MASK_MGQ_FIFO_SIZE_8812F << BIT_SHIFT_MGQ_FIFO_SIZE_8812F) -+#define BIT_CLEAR_MGQ_FIFO_SIZE_8812F(x) ((x) & (~BITS_MGQ_FIFO_SIZE_8812F)) -+#define BIT_GET_MGQ_FIFO_SIZE_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_SIZE_8812F) & BIT_MASK_MGQ_FIFO_SIZE_8812F) -+#define BIT_SET_MGQ_FIFO_SIZE_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_SIZE_8812F(x) | BIT_MGQ_FIFO_SIZE_8812F(v)) -+ -+#define BIT_MGQ_FIFO_PAUSE_8812F BIT(13) -+ -+#define BIT_SHIFT_MGQ_FIFO_RPTR_8812F 8 -+#define BIT_MASK_MGQ_FIFO_RPTR_8812F 0x1f -+#define BIT_MGQ_FIFO_RPTR_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_RPTR_8812F) << BIT_SHIFT_MGQ_FIFO_RPTR_8812F) -+#define BITS_MGQ_FIFO_RPTR_8812F \ -+ (BIT_MASK_MGQ_FIFO_RPTR_8812F << BIT_SHIFT_MGQ_FIFO_RPTR_8812F) -+#define BIT_CLEAR_MGQ_FIFO_RPTR_8812F(x) ((x) & (~BITS_MGQ_FIFO_RPTR_8812F)) -+#define BIT_GET_MGQ_FIFO_RPTR_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_RPTR_8812F) & BIT_MASK_MGQ_FIFO_RPTR_8812F) -+#define BIT_SET_MGQ_FIFO_RPTR_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_RPTR_8812F(x) | BIT_MGQ_FIFO_RPTR_8812F(v)) -+ -+/* 2 REG_MGQ_FIFO_ENABLE_8812F */ -+#define BIT_MGQ_FIFO_EN_8812F BIT(15) -+ -+#define BIT_SHIFT_MGQ_FIFO_PG_SIZE_8812F 12 -+#define BIT_MASK_MGQ_FIFO_PG_SIZE_8812F 0x7 -+#define BIT_MGQ_FIFO_PG_SIZE_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_PG_SIZE_8812F) \ -+ << BIT_SHIFT_MGQ_FIFO_PG_SIZE_8812F) -+#define BITS_MGQ_FIFO_PG_SIZE_8812F \ -+ (BIT_MASK_MGQ_FIFO_PG_SIZE_8812F << BIT_SHIFT_MGQ_FIFO_PG_SIZE_8812F) -+#define BIT_CLEAR_MGQ_FIFO_PG_SIZE_8812F(x) \ -+ ((x) & (~BITS_MGQ_FIFO_PG_SIZE_8812F)) -+#define BIT_GET_MGQ_FIFO_PG_SIZE_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_PG_SIZE_8812F) & \ -+ BIT_MASK_MGQ_FIFO_PG_SIZE_8812F) -+#define BIT_SET_MGQ_FIFO_PG_SIZE_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_PG_SIZE_8812F(x) | BIT_MGQ_FIFO_PG_SIZE_8812F(v)) -+ -+#define BIT_SHIFT_MGQ_FIFO_START_PG_8812F 0 -+#define BIT_MASK_MGQ_FIFO_START_PG_8812F 0xfff -+#define BIT_MGQ_FIFO_START_PG_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_START_PG_8812F) \ -+ << BIT_SHIFT_MGQ_FIFO_START_PG_8812F) -+#define BITS_MGQ_FIFO_START_PG_8812F \ -+ (BIT_MASK_MGQ_FIFO_START_PG_8812F << BIT_SHIFT_MGQ_FIFO_START_PG_8812F) -+#define BIT_CLEAR_MGQ_FIFO_START_PG_8812F(x) \ -+ ((x) & (~BITS_MGQ_FIFO_START_PG_8812F)) -+#define BIT_GET_MGQ_FIFO_START_PG_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_START_PG_8812F) & \ -+ BIT_MASK_MGQ_FIFO_START_PG_8812F) -+#define BIT_SET_MGQ_FIFO_START_PG_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_START_PG_8812F(x) | BIT_MGQ_FIFO_START_PG_8812F(v)) -+ -+/* 2 REG_MGQ_FIFO_RELEASE_INT_MASK_8812F */ -+ -+#define BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8812F 0 -+#define BIT_MASK_MGQ_FIFO_REL_INT_MASK_8812F 0xffff -+#define BIT_MGQ_FIFO_REL_INT_MASK_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_REL_INT_MASK_8812F) \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8812F) -+#define BITS_MGQ_FIFO_REL_INT_MASK_8812F \ -+ (BIT_MASK_MGQ_FIFO_REL_INT_MASK_8812F \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8812F) -+#define BIT_CLEAR_MGQ_FIFO_REL_INT_MASK_8812F(x) \ -+ ((x) & (~BITS_MGQ_FIFO_REL_INT_MASK_8812F)) -+#define BIT_GET_MGQ_FIFO_REL_INT_MASK_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8812F) & \ -+ BIT_MASK_MGQ_FIFO_REL_INT_MASK_8812F) -+#define BIT_SET_MGQ_FIFO_REL_INT_MASK_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_REL_INT_MASK_8812F(x) | \ -+ BIT_MGQ_FIFO_REL_INT_MASK_8812F(v)) -+ -+/* 2 REG_MGQ_FIFO_RELEASE_INT_FLAG_8812F */ -+ -+#define BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8812F 0 -+#define BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8812F 0xffff -+#define BIT_MGQ_FIFO_REL_INT_FLAG_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8812F) \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8812F) -+#define BITS_MGQ_FIFO_REL_INT_FLAG_8812F \ -+ (BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8812F \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8812F) -+#define BIT_CLEAR_MGQ_FIFO_REL_INT_FLAG_8812F(x) \ -+ ((x) & (~BITS_MGQ_FIFO_REL_INT_FLAG_8812F)) -+#define BIT_GET_MGQ_FIFO_REL_INT_FLAG_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8812F) & \ -+ BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8812F) -+#define BIT_SET_MGQ_FIFO_REL_INT_FLAG_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_REL_INT_FLAG_8812F(x) | \ -+ BIT_MGQ_FIFO_REL_INT_FLAG_8812F(v)) -+ -+/* 2 REG_MGQ_FIFO_VALID_MAP_8812F */ -+ -+#define BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8812F 0 -+#define BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8812F 0xffff -+#define BIT_MGQ_FIFO_PKT_VALID_MAP_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8812F) \ -+ << BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8812F) -+#define BITS_MGQ_FIFO_PKT_VALID_MAP_8812F \ -+ (BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8812F \ -+ << BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8812F) -+#define BIT_CLEAR_MGQ_FIFO_PKT_VALID_MAP_8812F(x) \ -+ ((x) & (~BITS_MGQ_FIFO_PKT_VALID_MAP_8812F)) -+#define BIT_GET_MGQ_FIFO_PKT_VALID_MAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8812F) & \ -+ BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8812F) -+#define BIT_SET_MGQ_FIFO_PKT_VALID_MAP_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_PKT_VALID_MAP_8812F(x) | \ -+ BIT_MGQ_FIFO_PKT_VALID_MAP_8812F(v)) -+ -+/* 2 REG_MGQ_FIFO_LIFETIME_8812F */ -+ -+#define BIT_SHIFT_MGQ_FIFO_LIFETIME_8812F 0 -+#define BIT_MASK_MGQ_FIFO_LIFETIME_8812F 0xffff -+#define BIT_MGQ_FIFO_LIFETIME_8812F(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_LIFETIME_8812F) \ -+ << BIT_SHIFT_MGQ_FIFO_LIFETIME_8812F) -+#define BITS_MGQ_FIFO_LIFETIME_8812F \ -+ (BIT_MASK_MGQ_FIFO_LIFETIME_8812F << BIT_SHIFT_MGQ_FIFO_LIFETIME_8812F) -+#define BIT_CLEAR_MGQ_FIFO_LIFETIME_8812F(x) \ -+ ((x) & (~BITS_MGQ_FIFO_LIFETIME_8812F)) -+#define BIT_GET_MGQ_FIFO_LIFETIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_LIFETIME_8812F) & \ -+ BIT_MASK_MGQ_FIFO_LIFETIME_8812F) -+#define BIT_SET_MGQ_FIFO_LIFETIME_8812F(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_LIFETIME_8812F(x) | BIT_MGQ_FIFO_LIFETIME_8812F(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F 0x7f -+#define BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F) -+#define BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F(v)) -+ -+/* 2 REG_SHCUT_SETTING_8812F */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE0_8812F */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE1_8812F */ -+ -+/* 2 REG_SHCUT_LLC_OUI0_8812F */ -+ -+/* 2 REG_SHCUT_LLC_OUI1_8812F */ -+ -+/* 2 REG_SHCUT_LLC_OUI2_8812F */ -+ -+/* 2 REG_MU_TX_CTL_8812F */ -+#define BIT_R_MU_P1_WAIT_STATE_EN_8812F BIT(16) -+ -+#define BIT_SHIFT_R_MU_RL_8812F 12 -+#define BIT_MASK_R_MU_RL_8812F 0xf -+#define BIT_R_MU_RL_8812F(x) \ -+ (((x) & BIT_MASK_R_MU_RL_8812F) << BIT_SHIFT_R_MU_RL_8812F) -+#define BITS_R_MU_RL_8812F (BIT_MASK_R_MU_RL_8812F << BIT_SHIFT_R_MU_RL_8812F) -+#define BIT_CLEAR_R_MU_RL_8812F(x) ((x) & (~BITS_R_MU_RL_8812F)) -+#define BIT_GET_R_MU_RL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MU_RL_8812F) & BIT_MASK_R_MU_RL_8812F) -+#define BIT_SET_R_MU_RL_8812F(x, v) \ -+ (BIT_CLEAR_R_MU_RL_8812F(x) | BIT_R_MU_RL_8812F(v)) -+ -+#define BIT_R_FORCE_P1_RATEDOWN_8812F BIT(11) -+ -+#define BIT_SHIFT_R_MU_TAB_SEL_8812F 8 -+#define BIT_MASK_R_MU_TAB_SEL_8812F 0x7 -+#define BIT_R_MU_TAB_SEL_8812F(x) \ -+ (((x) & BIT_MASK_R_MU_TAB_SEL_8812F) << BIT_SHIFT_R_MU_TAB_SEL_8812F) -+#define BITS_R_MU_TAB_SEL_8812F \ -+ (BIT_MASK_R_MU_TAB_SEL_8812F << BIT_SHIFT_R_MU_TAB_SEL_8812F) -+#define BIT_CLEAR_R_MU_TAB_SEL_8812F(x) ((x) & (~BITS_R_MU_TAB_SEL_8812F)) -+#define BIT_GET_R_MU_TAB_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MU_TAB_SEL_8812F) & BIT_MASK_R_MU_TAB_SEL_8812F) -+#define BIT_SET_R_MU_TAB_SEL_8812F(x, v) \ -+ (BIT_CLEAR_R_MU_TAB_SEL_8812F(x) | BIT_R_MU_TAB_SEL_8812F(v)) -+ -+#define BIT_R_EN_MU_MIMO_8812F BIT(7) -+#define BIT_R_EN_REVERS_GTAB_8812F BIT(6) -+ -+#define BIT_SHIFT_R_MU_TABLE_VALID_8812F 0 -+#define BIT_MASK_R_MU_TABLE_VALID_8812F 0x3f -+#define BIT_R_MU_TABLE_VALID_8812F(x) \ -+ (((x) & BIT_MASK_R_MU_TABLE_VALID_8812F) \ -+ << BIT_SHIFT_R_MU_TABLE_VALID_8812F) -+#define BITS_R_MU_TABLE_VALID_8812F \ -+ (BIT_MASK_R_MU_TABLE_VALID_8812F << BIT_SHIFT_R_MU_TABLE_VALID_8812F) -+#define BIT_CLEAR_R_MU_TABLE_VALID_8812F(x) \ -+ ((x) & (~BITS_R_MU_TABLE_VALID_8812F)) -+#define BIT_GET_R_MU_TABLE_VALID_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MU_TABLE_VALID_8812F) & \ -+ BIT_MASK_R_MU_TABLE_VALID_8812F) -+#define BIT_SET_R_MU_TABLE_VALID_8812F(x, v) \ -+ (BIT_CLEAR_R_MU_TABLE_VALID_8812F(x) | BIT_R_MU_TABLE_VALID_8812F(v)) -+ -+/* 2 REG_MU_STA_GID_VLD_8812F */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_VALID_8812F 0 -+#define BIT_MASK_R_MU_STA_GTAB_VALID_8812F 0xffffffffL -+#define BIT_R_MU_STA_GTAB_VALID_8812F(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_VALID_8812F) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8812F) -+#define BITS_R_MU_STA_GTAB_VALID_8812F \ -+ (BIT_MASK_R_MU_STA_GTAB_VALID_8812F \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8812F) -+#define BIT_CLEAR_R_MU_STA_GTAB_VALID_8812F(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_VALID_8812F)) -+#define BIT_GET_R_MU_STA_GTAB_VALID_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_VALID_8812F) & \ -+ BIT_MASK_R_MU_STA_GTAB_VALID_8812F) -+#define BIT_SET_R_MU_STA_GTAB_VALID_8812F(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_VALID_8812F(x) | \ -+ BIT_R_MU_STA_GTAB_VALID_8812F(v)) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_8812F */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8812F 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_L_8812F 0xffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_L_8812F(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_L_8812F) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8812F) -+#define BITS_R_MU_STA_GTAB_POSITION_L_8812F \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_L_8812F \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8812F) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_L_8812F(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_L_8812F)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8812F) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_L_8812F) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_L_8812F(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_L_8812F(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_L_8812F(v)) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_H_8812F */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8812F 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_H_8812F 0xffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_H_8812F(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_H_8812F) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8812F) -+#define BITS_R_MU_STA_GTAB_POSITION_H_8812F \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_H_8812F \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8812F) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_H_8812F(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_H_8812F)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_H_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8812F) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_H_8812F) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_H_8812F(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_H_8812F(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_H_8812F(v)) -+ -+/* 2 REG_CHNL_INFO_CTRL_8812F */ -+#define BIT_CHNL_REF_RXNAV_8812F BIT(7) -+#define BIT_CHNL_REF_VBON_8812F BIT(6) -+#define BIT_CHNL_REF_EDCA_8812F BIT(5) -+#define BIT_CHNL_REF_CCA_8812F BIT(4) -+#define BIT_RST_CHNL_BUSY_8812F BIT(3) -+#define BIT_RST_CHNL_IDLE_8812F BIT(2) -+#define BIT_CHNL_INFO_RST_8812F BIT(1) -+#define BIT_ATM_AIRTIME_EN_8812F BIT(0) -+ -+/* 2 REG_CHNL_IDLE_TIME_8812F */ -+ -+#define BIT_SHIFT_CHNL_IDLE_TIME_8812F 0 -+#define BIT_MASK_CHNL_IDLE_TIME_8812F 0xffffffffL -+#define BIT_CHNL_IDLE_TIME_8812F(x) \ -+ (((x) & BIT_MASK_CHNL_IDLE_TIME_8812F) \ -+ << BIT_SHIFT_CHNL_IDLE_TIME_8812F) -+#define BITS_CHNL_IDLE_TIME_8812F \ -+ (BIT_MASK_CHNL_IDLE_TIME_8812F << BIT_SHIFT_CHNL_IDLE_TIME_8812F) -+#define BIT_CLEAR_CHNL_IDLE_TIME_8812F(x) ((x) & (~BITS_CHNL_IDLE_TIME_8812F)) -+#define BIT_GET_CHNL_IDLE_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_CHNL_IDLE_TIME_8812F) & \ -+ BIT_MASK_CHNL_IDLE_TIME_8812F) -+#define BIT_SET_CHNL_IDLE_TIME_8812F(x, v) \ -+ (BIT_CLEAR_CHNL_IDLE_TIME_8812F(x) | BIT_CHNL_IDLE_TIME_8812F(v)) -+ -+/* 2 REG_CHNL_BUSY_TIME_8812F */ -+ -+#define BIT_SHIFT_CHNL_BUSY_TIME_8812F 0 -+#define BIT_MASK_CHNL_BUSY_TIME_8812F 0xffffffffL -+#define BIT_CHNL_BUSY_TIME_8812F(x) \ -+ (((x) & BIT_MASK_CHNL_BUSY_TIME_8812F) \ -+ << BIT_SHIFT_CHNL_BUSY_TIME_8812F) -+#define BITS_CHNL_BUSY_TIME_8812F \ -+ (BIT_MASK_CHNL_BUSY_TIME_8812F << BIT_SHIFT_CHNL_BUSY_TIME_8812F) -+#define BIT_CLEAR_CHNL_BUSY_TIME_8812F(x) ((x) & (~BITS_CHNL_BUSY_TIME_8812F)) -+#define BIT_GET_CHNL_BUSY_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_CHNL_BUSY_TIME_8812F) & \ -+ BIT_MASK_CHNL_BUSY_TIME_8812F) -+#define BIT_SET_CHNL_BUSY_TIME_8812F(x, v) \ -+ (BIT_CLEAR_CHNL_BUSY_TIME_8812F(x) | BIT_CHNL_BUSY_TIME_8812F(v)) -+ -+/* 2 REG_MU_TRX_DBG_CNT_V1_8812F */ -+#define BIT_MU_DNGCNT_RST_8812F BIT(20) -+ -+#define BIT_SHIFT_MU_DNGCNT_SEL_8812F 16 -+#define BIT_MASK_MU_DNGCNT_SEL_8812F 0xf -+#define BIT_MU_DNGCNT_SEL_8812F(x) \ -+ (((x) & BIT_MASK_MU_DNGCNT_SEL_8812F) << BIT_SHIFT_MU_DNGCNT_SEL_8812F) -+#define BITS_MU_DNGCNT_SEL_8812F \ -+ (BIT_MASK_MU_DNGCNT_SEL_8812F << BIT_SHIFT_MU_DNGCNT_SEL_8812F) -+#define BIT_CLEAR_MU_DNGCNT_SEL_8812F(x) ((x) & (~BITS_MU_DNGCNT_SEL_8812F)) -+#define BIT_GET_MU_DNGCNT_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_MU_DNGCNT_SEL_8812F) & BIT_MASK_MU_DNGCNT_SEL_8812F) -+#define BIT_SET_MU_DNGCNT_SEL_8812F(x, v) \ -+ (BIT_CLEAR_MU_DNGCNT_SEL_8812F(x) | BIT_MU_DNGCNT_SEL_8812F(v)) -+ -+#define BIT_SHIFT_MU_DNGCNT_8812F 0 -+#define BIT_MASK_MU_DNGCNT_8812F 0xffff -+#define BIT_MU_DNGCNT_8812F(x) \ -+ (((x) & BIT_MASK_MU_DNGCNT_8812F) << BIT_SHIFT_MU_DNGCNT_8812F) -+#define BITS_MU_DNGCNT_8812F \ -+ (BIT_MASK_MU_DNGCNT_8812F << BIT_SHIFT_MU_DNGCNT_8812F) -+#define BIT_CLEAR_MU_DNGCNT_8812F(x) ((x) & (~BITS_MU_DNGCNT_8812F)) -+#define BIT_GET_MU_DNGCNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_MU_DNGCNT_8812F) & BIT_MASK_MU_DNGCNT_8812F) -+#define BIT_SET_MU_DNGCNT_8812F(x, v) \ -+ (BIT_CLEAR_MU_DNGCNT_8812F(x) | BIT_MU_DNGCNT_8812F(v)) -+ -+/* 2 REG_SU_DURATION_8812F */ -+ -+#define BIT_SHIFT_SU_DURATION_8812F 0 -+#define BIT_MASK_SU_DURATION_8812F 0xffff -+#define BIT_SU_DURATION_8812F(x) \ -+ (((x) & BIT_MASK_SU_DURATION_8812F) << BIT_SHIFT_SU_DURATION_8812F) -+#define BITS_SU_DURATION_8812F \ -+ (BIT_MASK_SU_DURATION_8812F << BIT_SHIFT_SU_DURATION_8812F) -+#define BIT_CLEAR_SU_DURATION_8812F(x) ((x) & (~BITS_SU_DURATION_8812F)) -+#define BIT_GET_SU_DURATION_8812F(x) \ -+ (((x) >> BIT_SHIFT_SU_DURATION_8812F) & BIT_MASK_SU_DURATION_8812F) -+#define BIT_SET_SU_DURATION_8812F(x, v) \ -+ (BIT_CLEAR_SU_DURATION_8812F(x) | BIT_SU_DURATION_8812F(v)) -+ -+/* 2 REG_MU_DURATION_8812F */ -+ -+#define BIT_SHIFT_MU_DURATION_8812F 0 -+#define BIT_MASK_MU_DURATION_8812F 0xffff -+#define BIT_MU_DURATION_8812F(x) \ -+ (((x) & BIT_MASK_MU_DURATION_8812F) << BIT_SHIFT_MU_DURATION_8812F) -+#define BITS_MU_DURATION_8812F \ -+ (BIT_MASK_MU_DURATION_8812F << BIT_SHIFT_MU_DURATION_8812F) -+#define BIT_CLEAR_MU_DURATION_8812F(x) ((x) & (~BITS_MU_DURATION_8812F)) -+#define BIT_GET_MU_DURATION_8812F(x) \ -+ (((x) >> BIT_SHIFT_MU_DURATION_8812F) & BIT_MASK_MU_DURATION_8812F) -+#define BIT_SET_MU_DURATION_8812F(x, v) \ -+ (BIT_CLEAR_MU_DURATION_8812F(x) | BIT_MU_DURATION_8812F(v)) -+ -+/* 2 REG_HW_NDPA_RTY_LIMIT_8812F */ -+ -+#define BIT_SHIFT_HW_NDPA_RTY_LIMIT_8812F 0 -+#define BIT_MASK_HW_NDPA_RTY_LIMIT_8812F 0xf -+#define BIT_HW_NDPA_RTY_LIMIT_8812F(x) \ -+ (((x) & BIT_MASK_HW_NDPA_RTY_LIMIT_8812F) \ -+ << BIT_SHIFT_HW_NDPA_RTY_LIMIT_8812F) -+#define BITS_HW_NDPA_RTY_LIMIT_8812F \ -+ (BIT_MASK_HW_NDPA_RTY_LIMIT_8812F << BIT_SHIFT_HW_NDPA_RTY_LIMIT_8812F) -+#define BIT_CLEAR_HW_NDPA_RTY_LIMIT_8812F(x) \ -+ ((x) & (~BITS_HW_NDPA_RTY_LIMIT_8812F)) -+#define BIT_GET_HW_NDPA_RTY_LIMIT_8812F(x) \ -+ (((x) >> BIT_SHIFT_HW_NDPA_RTY_LIMIT_8812F) & \ -+ BIT_MASK_HW_NDPA_RTY_LIMIT_8812F) -+#define BIT_SET_HW_NDPA_RTY_LIMIT_8812F(x, v) \ -+ (BIT_CLEAR_HW_NDPA_RTY_LIMIT_8812F(x) | BIT_HW_NDPA_RTY_LIMIT_8812F(v)) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_EDCA_VO_PARAM_8812F */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8812F 16 -+#define BIT_MASK_TXOPLIMIT_8812F 0x7ff -+#define BIT_TXOPLIMIT_8812F(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8812F) << BIT_SHIFT_TXOPLIMIT_8812F) -+#define BITS_TXOPLIMIT_8812F \ -+ (BIT_MASK_TXOPLIMIT_8812F << BIT_SHIFT_TXOPLIMIT_8812F) -+#define BIT_CLEAR_TXOPLIMIT_8812F(x) ((x) & (~BITS_TXOPLIMIT_8812F)) -+#define BIT_GET_TXOPLIMIT_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8812F) & BIT_MASK_TXOPLIMIT_8812F) -+#define BIT_SET_TXOPLIMIT_8812F(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8812F(x) | BIT_TXOPLIMIT_8812F(v)) -+ -+#define BIT_SHIFT_CW_8812F 8 -+#define BIT_MASK_CW_8812F 0xff -+#define BIT_CW_8812F(x) (((x) & BIT_MASK_CW_8812F) << BIT_SHIFT_CW_8812F) -+#define BITS_CW_8812F (BIT_MASK_CW_8812F << BIT_SHIFT_CW_8812F) -+#define BIT_CLEAR_CW_8812F(x) ((x) & (~BITS_CW_8812F)) -+#define BIT_GET_CW_8812F(x) (((x) >> BIT_SHIFT_CW_8812F) & BIT_MASK_CW_8812F) -+#define BIT_SET_CW_8812F(x, v) (BIT_CLEAR_CW_8812F(x) | BIT_CW_8812F(v)) -+ -+#define BIT_SHIFT_AIFS_8812F 0 -+#define BIT_MASK_AIFS_8812F 0xff -+#define BIT_AIFS_8812F(x) (((x) & BIT_MASK_AIFS_8812F) << BIT_SHIFT_AIFS_8812F) -+#define BITS_AIFS_8812F (BIT_MASK_AIFS_8812F << BIT_SHIFT_AIFS_8812F) -+#define BIT_CLEAR_AIFS_8812F(x) ((x) & (~BITS_AIFS_8812F)) -+#define BIT_GET_AIFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8812F) & BIT_MASK_AIFS_8812F) -+#define BIT_SET_AIFS_8812F(x, v) (BIT_CLEAR_AIFS_8812F(x) | BIT_AIFS_8812F(v)) -+ -+/* 2 REG_EDCA_VI_PARAM_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8812F 16 -+#define BIT_MASK_TXOPLIMIT_8812F 0x7ff -+#define BIT_TXOPLIMIT_8812F(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8812F) << BIT_SHIFT_TXOPLIMIT_8812F) -+#define BITS_TXOPLIMIT_8812F \ -+ (BIT_MASK_TXOPLIMIT_8812F << BIT_SHIFT_TXOPLIMIT_8812F) -+#define BIT_CLEAR_TXOPLIMIT_8812F(x) ((x) & (~BITS_TXOPLIMIT_8812F)) -+#define BIT_GET_TXOPLIMIT_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8812F) & BIT_MASK_TXOPLIMIT_8812F) -+#define BIT_SET_TXOPLIMIT_8812F(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8812F(x) | BIT_TXOPLIMIT_8812F(v)) -+ -+#define BIT_SHIFT_CW_8812F 8 -+#define BIT_MASK_CW_8812F 0xff -+#define BIT_CW_8812F(x) (((x) & BIT_MASK_CW_8812F) << BIT_SHIFT_CW_8812F) -+#define BITS_CW_8812F (BIT_MASK_CW_8812F << BIT_SHIFT_CW_8812F) -+#define BIT_CLEAR_CW_8812F(x) ((x) & (~BITS_CW_8812F)) -+#define BIT_GET_CW_8812F(x) (((x) >> BIT_SHIFT_CW_8812F) & BIT_MASK_CW_8812F) -+#define BIT_SET_CW_8812F(x, v) (BIT_CLEAR_CW_8812F(x) | BIT_CW_8812F(v)) -+ -+#define BIT_SHIFT_AIFS_8812F 0 -+#define BIT_MASK_AIFS_8812F 0xff -+#define BIT_AIFS_8812F(x) (((x) & BIT_MASK_AIFS_8812F) << BIT_SHIFT_AIFS_8812F) -+#define BITS_AIFS_8812F (BIT_MASK_AIFS_8812F << BIT_SHIFT_AIFS_8812F) -+#define BIT_CLEAR_AIFS_8812F(x) ((x) & (~BITS_AIFS_8812F)) -+#define BIT_GET_AIFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8812F) & BIT_MASK_AIFS_8812F) -+#define BIT_SET_AIFS_8812F(x, v) (BIT_CLEAR_AIFS_8812F(x) | BIT_AIFS_8812F(v)) -+ -+/* 2 REG_EDCA_BE_PARAM_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8812F 16 -+#define BIT_MASK_TXOPLIMIT_8812F 0x7ff -+#define BIT_TXOPLIMIT_8812F(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8812F) << BIT_SHIFT_TXOPLIMIT_8812F) -+#define BITS_TXOPLIMIT_8812F \ -+ (BIT_MASK_TXOPLIMIT_8812F << BIT_SHIFT_TXOPLIMIT_8812F) -+#define BIT_CLEAR_TXOPLIMIT_8812F(x) ((x) & (~BITS_TXOPLIMIT_8812F)) -+#define BIT_GET_TXOPLIMIT_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8812F) & BIT_MASK_TXOPLIMIT_8812F) -+#define BIT_SET_TXOPLIMIT_8812F(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8812F(x) | BIT_TXOPLIMIT_8812F(v)) -+ -+#define BIT_SHIFT_CW_8812F 8 -+#define BIT_MASK_CW_8812F 0xff -+#define BIT_CW_8812F(x) (((x) & BIT_MASK_CW_8812F) << BIT_SHIFT_CW_8812F) -+#define BITS_CW_8812F (BIT_MASK_CW_8812F << BIT_SHIFT_CW_8812F) -+#define BIT_CLEAR_CW_8812F(x) ((x) & (~BITS_CW_8812F)) -+#define BIT_GET_CW_8812F(x) (((x) >> BIT_SHIFT_CW_8812F) & BIT_MASK_CW_8812F) -+#define BIT_SET_CW_8812F(x, v) (BIT_CLEAR_CW_8812F(x) | BIT_CW_8812F(v)) -+ -+#define BIT_SHIFT_AIFS_8812F 0 -+#define BIT_MASK_AIFS_8812F 0xff -+#define BIT_AIFS_8812F(x) (((x) & BIT_MASK_AIFS_8812F) << BIT_SHIFT_AIFS_8812F) -+#define BITS_AIFS_8812F (BIT_MASK_AIFS_8812F << BIT_SHIFT_AIFS_8812F) -+#define BIT_CLEAR_AIFS_8812F(x) ((x) & (~BITS_AIFS_8812F)) -+#define BIT_GET_AIFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8812F) & BIT_MASK_AIFS_8812F) -+#define BIT_SET_AIFS_8812F(x, v) (BIT_CLEAR_AIFS_8812F(x) | BIT_AIFS_8812F(v)) -+ -+/* 2 REG_EDCA_BK_PARAM_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8812F 16 -+#define BIT_MASK_TXOPLIMIT_8812F 0x7ff -+#define BIT_TXOPLIMIT_8812F(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8812F) << BIT_SHIFT_TXOPLIMIT_8812F) -+#define BITS_TXOPLIMIT_8812F \ -+ (BIT_MASK_TXOPLIMIT_8812F << BIT_SHIFT_TXOPLIMIT_8812F) -+#define BIT_CLEAR_TXOPLIMIT_8812F(x) ((x) & (~BITS_TXOPLIMIT_8812F)) -+#define BIT_GET_TXOPLIMIT_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8812F) & BIT_MASK_TXOPLIMIT_8812F) -+#define BIT_SET_TXOPLIMIT_8812F(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8812F(x) | BIT_TXOPLIMIT_8812F(v)) -+ -+#define BIT_SHIFT_CW_8812F 8 -+#define BIT_MASK_CW_8812F 0xff -+#define BIT_CW_8812F(x) (((x) & BIT_MASK_CW_8812F) << BIT_SHIFT_CW_8812F) -+#define BITS_CW_8812F (BIT_MASK_CW_8812F << BIT_SHIFT_CW_8812F) -+#define BIT_CLEAR_CW_8812F(x) ((x) & (~BITS_CW_8812F)) -+#define BIT_GET_CW_8812F(x) (((x) >> BIT_SHIFT_CW_8812F) & BIT_MASK_CW_8812F) -+#define BIT_SET_CW_8812F(x, v) (BIT_CLEAR_CW_8812F(x) | BIT_CW_8812F(v)) -+ -+#define BIT_SHIFT_AIFS_8812F 0 -+#define BIT_MASK_AIFS_8812F 0xff -+#define BIT_AIFS_8812F(x) (((x) & BIT_MASK_AIFS_8812F) << BIT_SHIFT_AIFS_8812F) -+#define BITS_AIFS_8812F (BIT_MASK_AIFS_8812F << BIT_SHIFT_AIFS_8812F) -+#define BIT_CLEAR_AIFS_8812F(x) ((x) & (~BITS_AIFS_8812F)) -+#define BIT_GET_AIFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8812F) & BIT_MASK_AIFS_8812F) -+#define BIT_SET_AIFS_8812F(x, v) (BIT_CLEAR_AIFS_8812F(x) | BIT_AIFS_8812F(v)) -+ -+/* 2 REG_BCNTCFG_8812F */ -+ -+#define BIT_SHIFT_BCNCW_MAX_8812F 12 -+#define BIT_MASK_BCNCW_MAX_8812F 0xf -+#define BIT_BCNCW_MAX_8812F(x) \ -+ (((x) & BIT_MASK_BCNCW_MAX_8812F) << BIT_SHIFT_BCNCW_MAX_8812F) -+#define BITS_BCNCW_MAX_8812F \ -+ (BIT_MASK_BCNCW_MAX_8812F << BIT_SHIFT_BCNCW_MAX_8812F) -+#define BIT_CLEAR_BCNCW_MAX_8812F(x) ((x) & (~BITS_BCNCW_MAX_8812F)) -+#define BIT_GET_BCNCW_MAX_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MAX_8812F) & BIT_MASK_BCNCW_MAX_8812F) -+#define BIT_SET_BCNCW_MAX_8812F(x, v) \ -+ (BIT_CLEAR_BCNCW_MAX_8812F(x) | BIT_BCNCW_MAX_8812F(v)) -+ -+#define BIT_SHIFT_BCNCW_MIN_8812F 8 -+#define BIT_MASK_BCNCW_MIN_8812F 0xf -+#define BIT_BCNCW_MIN_8812F(x) \ -+ (((x) & BIT_MASK_BCNCW_MIN_8812F) << BIT_SHIFT_BCNCW_MIN_8812F) -+#define BITS_BCNCW_MIN_8812F \ -+ (BIT_MASK_BCNCW_MIN_8812F << BIT_SHIFT_BCNCW_MIN_8812F) -+#define BIT_CLEAR_BCNCW_MIN_8812F(x) ((x) & (~BITS_BCNCW_MIN_8812F)) -+#define BIT_GET_BCNCW_MIN_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MIN_8812F) & BIT_MASK_BCNCW_MIN_8812F) -+#define BIT_SET_BCNCW_MIN_8812F(x, v) \ -+ (BIT_CLEAR_BCNCW_MIN_8812F(x) | BIT_BCNCW_MIN_8812F(v)) -+ -+#define BIT_SHIFT_BCNIFS_8812F 0 -+#define BIT_MASK_BCNIFS_8812F 0xff -+#define BIT_BCNIFS_8812F(x) \ -+ (((x) & BIT_MASK_BCNIFS_8812F) << BIT_SHIFT_BCNIFS_8812F) -+#define BITS_BCNIFS_8812F (BIT_MASK_BCNIFS_8812F << BIT_SHIFT_BCNIFS_8812F) -+#define BIT_CLEAR_BCNIFS_8812F(x) ((x) & (~BITS_BCNIFS_8812F)) -+#define BIT_GET_BCNIFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNIFS_8812F) & BIT_MASK_BCNIFS_8812F) -+#define BIT_SET_BCNIFS_8812F(x, v) \ -+ (BIT_CLEAR_BCNIFS_8812F(x) | BIT_BCNIFS_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_PIFS_8812F */ -+ -+#define BIT_SHIFT_PIFS_8812F 0 -+#define BIT_MASK_PIFS_8812F 0xff -+#define BIT_PIFS_8812F(x) (((x) & BIT_MASK_PIFS_8812F) << BIT_SHIFT_PIFS_8812F) -+#define BITS_PIFS_8812F (BIT_MASK_PIFS_8812F << BIT_SHIFT_PIFS_8812F) -+#define BIT_CLEAR_PIFS_8812F(x) ((x) & (~BITS_PIFS_8812F)) -+#define BIT_GET_PIFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_PIFS_8812F) & BIT_MASK_PIFS_8812F) -+#define BIT_SET_PIFS_8812F(x, v) (BIT_CLEAR_PIFS_8812F(x) | BIT_PIFS_8812F(v)) -+ -+/* 2 REG_RDG_PIFS_8812F */ -+ -+#define BIT_SHIFT_RDG_PIFS_8812F 0 -+#define BIT_MASK_RDG_PIFS_8812F 0xff -+#define BIT_RDG_PIFS_8812F(x) \ -+ (((x) & BIT_MASK_RDG_PIFS_8812F) << BIT_SHIFT_RDG_PIFS_8812F) -+#define BITS_RDG_PIFS_8812F \ -+ (BIT_MASK_RDG_PIFS_8812F << BIT_SHIFT_RDG_PIFS_8812F) -+#define BIT_CLEAR_RDG_PIFS_8812F(x) ((x) & (~BITS_RDG_PIFS_8812F)) -+#define BIT_GET_RDG_PIFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_RDG_PIFS_8812F) & BIT_MASK_RDG_PIFS_8812F) -+#define BIT_SET_RDG_PIFS_8812F(x, v) \ -+ (BIT_CLEAR_RDG_PIFS_8812F(x) | BIT_RDG_PIFS_8812F(v)) -+ -+/* 2 REG_SIFS_8812F */ -+ -+#define BIT_SHIFT_SIFS_OFDM_TRX_8812F 24 -+#define BIT_MASK_SIFS_OFDM_TRX_8812F 0xff -+#define BIT_SIFS_OFDM_TRX_8812F(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_TRX_8812F) << BIT_SHIFT_SIFS_OFDM_TRX_8812F) -+#define BITS_SIFS_OFDM_TRX_8812F \ -+ (BIT_MASK_SIFS_OFDM_TRX_8812F << BIT_SHIFT_SIFS_OFDM_TRX_8812F) -+#define BIT_CLEAR_SIFS_OFDM_TRX_8812F(x) ((x) & (~BITS_SIFS_OFDM_TRX_8812F)) -+#define BIT_GET_SIFS_OFDM_TRX_8812F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_TRX_8812F) & BIT_MASK_SIFS_OFDM_TRX_8812F) -+#define BIT_SET_SIFS_OFDM_TRX_8812F(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_TRX_8812F(x) | BIT_SIFS_OFDM_TRX_8812F(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_TRX_8812F 16 -+#define BIT_MASK_SIFS_CCK_TRX_8812F 0xff -+#define BIT_SIFS_CCK_TRX_8812F(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_TRX_8812F) << BIT_SHIFT_SIFS_CCK_TRX_8812F) -+#define BITS_SIFS_CCK_TRX_8812F \ -+ (BIT_MASK_SIFS_CCK_TRX_8812F << BIT_SHIFT_SIFS_CCK_TRX_8812F) -+#define BIT_CLEAR_SIFS_CCK_TRX_8812F(x) ((x) & (~BITS_SIFS_CCK_TRX_8812F)) -+#define BIT_GET_SIFS_CCK_TRX_8812F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_TRX_8812F) & BIT_MASK_SIFS_CCK_TRX_8812F) -+#define BIT_SET_SIFS_CCK_TRX_8812F(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_TRX_8812F(x) | BIT_SIFS_CCK_TRX_8812F(v)) -+ -+#define BIT_SHIFT_SIFS_OFDM_CTX_8812F 8 -+#define BIT_MASK_SIFS_OFDM_CTX_8812F 0xff -+#define BIT_SIFS_OFDM_CTX_8812F(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_CTX_8812F) << BIT_SHIFT_SIFS_OFDM_CTX_8812F) -+#define BITS_SIFS_OFDM_CTX_8812F \ -+ (BIT_MASK_SIFS_OFDM_CTX_8812F << BIT_SHIFT_SIFS_OFDM_CTX_8812F) -+#define BIT_CLEAR_SIFS_OFDM_CTX_8812F(x) ((x) & (~BITS_SIFS_OFDM_CTX_8812F)) -+#define BIT_GET_SIFS_OFDM_CTX_8812F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_CTX_8812F) & BIT_MASK_SIFS_OFDM_CTX_8812F) -+#define BIT_SET_SIFS_OFDM_CTX_8812F(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_CTX_8812F(x) | BIT_SIFS_OFDM_CTX_8812F(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_CTX_8812F 0 -+#define BIT_MASK_SIFS_CCK_CTX_8812F 0xff -+#define BIT_SIFS_CCK_CTX_8812F(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_CTX_8812F) << BIT_SHIFT_SIFS_CCK_CTX_8812F) -+#define BITS_SIFS_CCK_CTX_8812F \ -+ (BIT_MASK_SIFS_CCK_CTX_8812F << BIT_SHIFT_SIFS_CCK_CTX_8812F) -+#define BIT_CLEAR_SIFS_CCK_CTX_8812F(x) ((x) & (~BITS_SIFS_CCK_CTX_8812F)) -+#define BIT_GET_SIFS_CCK_CTX_8812F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_CTX_8812F) & BIT_MASK_SIFS_CCK_CTX_8812F) -+#define BIT_SET_SIFS_CCK_CTX_8812F(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_CTX_8812F(x) | BIT_SIFS_CCK_CTX_8812F(v)) -+ -+/* 2 REG_TSFTR_SYN_OFFSET_8812F */ -+ -+#define BIT_SHIFT_TSFTR_SNC_OFFSET_8812F 0 -+#define BIT_MASK_TSFTR_SNC_OFFSET_8812F 0xffff -+#define BIT_TSFTR_SNC_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_TSFTR_SNC_OFFSET_8812F) \ -+ << BIT_SHIFT_TSFTR_SNC_OFFSET_8812F) -+#define BITS_TSFTR_SNC_OFFSET_8812F \ -+ (BIT_MASK_TSFTR_SNC_OFFSET_8812F << BIT_SHIFT_TSFTR_SNC_OFFSET_8812F) -+#define BIT_CLEAR_TSFTR_SNC_OFFSET_8812F(x) \ -+ ((x) & (~BITS_TSFTR_SNC_OFFSET_8812F)) -+#define BIT_GET_TSFTR_SNC_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_TSFTR_SNC_OFFSET_8812F) & \ -+ BIT_MASK_TSFTR_SNC_OFFSET_8812F) -+#define BIT_SET_TSFTR_SNC_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_TSFTR_SNC_OFFSET_8812F(x) | BIT_TSFTR_SNC_OFFSET_8812F(v)) -+ -+/* 2 REG_AGGR_BREAK_TIME_8812F */ -+ -+#define BIT_SHIFT_AGGR_BK_TIME_8812F 0 -+#define BIT_MASK_AGGR_BK_TIME_8812F 0xff -+#define BIT_AGGR_BK_TIME_8812F(x) \ -+ (((x) & BIT_MASK_AGGR_BK_TIME_8812F) << BIT_SHIFT_AGGR_BK_TIME_8812F) -+#define BITS_AGGR_BK_TIME_8812F \ -+ (BIT_MASK_AGGR_BK_TIME_8812F << BIT_SHIFT_AGGR_BK_TIME_8812F) -+#define BIT_CLEAR_AGGR_BK_TIME_8812F(x) ((x) & (~BITS_AGGR_BK_TIME_8812F)) -+#define BIT_GET_AGGR_BK_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_AGGR_BK_TIME_8812F) & BIT_MASK_AGGR_BK_TIME_8812F) -+#define BIT_SET_AGGR_BK_TIME_8812F(x, v) \ -+ (BIT_CLEAR_AGGR_BK_TIME_8812F(x) | BIT_AGGR_BK_TIME_8812F(v)) -+ -+/* 2 REG_SLOT_8812F */ -+ -+#define BIT_SHIFT_SLOT_8812F 0 -+#define BIT_MASK_SLOT_8812F 0xff -+#define BIT_SLOT_8812F(x) (((x) & BIT_MASK_SLOT_8812F) << BIT_SHIFT_SLOT_8812F) -+#define BITS_SLOT_8812F (BIT_MASK_SLOT_8812F << BIT_SHIFT_SLOT_8812F) -+#define BIT_CLEAR_SLOT_8812F(x) ((x) & (~BITS_SLOT_8812F)) -+#define BIT_GET_SLOT_8812F(x) \ -+ (((x) >> BIT_SHIFT_SLOT_8812F) & BIT_MASK_SLOT_8812F) -+#define BIT_SET_SLOT_8812F(x, v) (BIT_CLEAR_SLOT_8812F(x) | BIT_SLOT_8812F(v)) -+ -+/* 2 REG_NOA_ON_ERLY_TIME_8812F */ -+ -+#define BIT_SHIFT__NOA_ON_ERLY_TIME_8812F 0 -+#define BIT_MASK__NOA_ON_ERLY_TIME_8812F 0xff -+#define BIT__NOA_ON_ERLY_TIME_8812F(x) \ -+ (((x) & BIT_MASK__NOA_ON_ERLY_TIME_8812F) \ -+ << BIT_SHIFT__NOA_ON_ERLY_TIME_8812F) -+#define BITS__NOA_ON_ERLY_TIME_8812F \ -+ (BIT_MASK__NOA_ON_ERLY_TIME_8812F << BIT_SHIFT__NOA_ON_ERLY_TIME_8812F) -+#define BIT_CLEAR__NOA_ON_ERLY_TIME_8812F(x) \ -+ ((x) & (~BITS__NOA_ON_ERLY_TIME_8812F)) -+#define BIT_GET__NOA_ON_ERLY_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT__NOA_ON_ERLY_TIME_8812F) & \ -+ BIT_MASK__NOA_ON_ERLY_TIME_8812F) -+#define BIT_SET__NOA_ON_ERLY_TIME_8812F(x, v) \ -+ (BIT_CLEAR__NOA_ON_ERLY_TIME_8812F(x) | BIT__NOA_ON_ERLY_TIME_8812F(v)) -+ -+/* 2 REG_NOA_OFF_ERLY_TIME_8812F */ -+ -+#define BIT_SHIFT__NOA_OFF_ERLY_TIME_8812F 0 -+#define BIT_MASK__NOA_OFF_ERLY_TIME_8812F 0xff -+#define BIT__NOA_OFF_ERLY_TIME_8812F(x) \ -+ (((x) & BIT_MASK__NOA_OFF_ERLY_TIME_8812F) \ -+ << BIT_SHIFT__NOA_OFF_ERLY_TIME_8812F) -+#define BITS__NOA_OFF_ERLY_TIME_8812F \ -+ (BIT_MASK__NOA_OFF_ERLY_TIME_8812F \ -+ << BIT_SHIFT__NOA_OFF_ERLY_TIME_8812F) -+#define BIT_CLEAR__NOA_OFF_ERLY_TIME_8812F(x) \ -+ ((x) & (~BITS__NOA_OFF_ERLY_TIME_8812F)) -+#define BIT_GET__NOA_OFF_ERLY_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT__NOA_OFF_ERLY_TIME_8812F) & \ -+ BIT_MASK__NOA_OFF_ERLY_TIME_8812F) -+#define BIT_SET__NOA_OFF_ERLY_TIME_8812F(x, v) \ -+ (BIT_CLEAR__NOA_OFF_ERLY_TIME_8812F(x) | \ -+ BIT__NOA_OFF_ERLY_TIME_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_TX_PTCL_CTRL_8812F */ -+#define BIT_DIS_EDCCA_8812F BIT(15) -+#define BIT_DIS_CCA_8812F BIT(14) -+#define BIT_LSIG_TXOP_TXCMD_NAV_8812F BIT(13) -+#define BIT_SIFS_BK_EN_8812F BIT(12) -+ -+#define BIT_SHIFT_TXQ_NAV_MSK_8812F 8 -+#define BIT_MASK_TXQ_NAV_MSK_8812F 0xf -+#define BIT_TXQ_NAV_MSK_8812F(x) \ -+ (((x) & BIT_MASK_TXQ_NAV_MSK_8812F) << BIT_SHIFT_TXQ_NAV_MSK_8812F) -+#define BITS_TXQ_NAV_MSK_8812F \ -+ (BIT_MASK_TXQ_NAV_MSK_8812F << BIT_SHIFT_TXQ_NAV_MSK_8812F) -+#define BIT_CLEAR_TXQ_NAV_MSK_8812F(x) ((x) & (~BITS_TXQ_NAV_MSK_8812F)) -+#define BIT_GET_TXQ_NAV_MSK_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXQ_NAV_MSK_8812F) & BIT_MASK_TXQ_NAV_MSK_8812F) -+#define BIT_SET_TXQ_NAV_MSK_8812F(x, v) \ -+ (BIT_CLEAR_TXQ_NAV_MSK_8812F(x) | BIT_TXQ_NAV_MSK_8812F(v)) -+ -+#define BIT_DIS_CW_8812F BIT(7) -+#define BIT_NAV_END_TXOP_8812F BIT(6) -+#define BIT_RDG_END_TXOP_8812F BIT(5) -+#define BIT_AC_INBCN_HOLD_8812F BIT(4) -+#define BIT_MGTQ_TXOP_EN_8812F BIT(3) -+#define BIT_MGTQ_RTSMF_EN_8812F BIT(2) -+#define BIT_HIQ_RTSMF_EN_8812F BIT(1) -+#define BIT_BCN_RTSMF_EN_8812F BIT(0) -+ -+/* 2 REG_TXPAUSE_8812F */ -+#define BIT_STOP_BCN_HI_MGT_8812F BIT(7) -+#define BIT_MAC_STOPBCNQ_8812F BIT(6) -+#define BIT_MAC_STOPHIQ_8812F BIT(5) -+#define BIT_MAC_STOPMGQ_8812F BIT(4) -+#define BIT_MAC_STOPBK_8812F BIT(3) -+#define BIT_MAC_STOPBE_8812F BIT(2) -+#define BIT_MAC_STOPVI_8812F BIT(1) -+#define BIT_MAC_STOPVO_8812F BIT(0) -+ -+/* 2 REG_DIS_TXREQ_CLR_8812F */ -+#define BIT_DIS_BT_CCA_8812F BIT(7) -+#define BIT_DIS_TXREQ_CLR_HI_8812F BIT(5) -+#define BIT_DIS_TXREQ_CLR_MGQ_8812F BIT(4) -+#define BIT_DIS_TXREQ_CLR_VO_8812F BIT(3) -+#define BIT_DIS_TXREQ_CLR_VI_8812F BIT(2) -+#define BIT_DIS_TXREQ_CLR_BE_8812F BIT(1) -+#define BIT_DIS_TXREQ_CLR_BK_8812F BIT(0) -+ -+/* 2 REG_RD_CTRL_8812F */ -+#define BIT_EN_CLR_TXREQ_INCCA_8812F BIT(15) -+#define BIT_DIS_TX_OVER_BCNQ_8812F BIT(14) -+#define BIT_EN_BCNERR_INCCCA_8812F BIT(13) -+#define BIT_EDCCA_MSK_CNTDOWN_EN_8812F BIT(11) -+#define BIT_DIS_TXOP_CFE_8812F BIT(10) -+#define BIT_DIS_LSIG_CFE_8812F BIT(9) -+#define BIT_DIS_STBC_CFE_8812F BIT(8) -+#define BIT_BKQ_RD_INIT_EN_8812F BIT(7) -+#define BIT_BEQ_RD_INIT_EN_8812F BIT(6) -+#define BIT_VIQ_RD_INIT_EN_8812F BIT(5) -+#define BIT_VOQ_RD_INIT_EN_8812F BIT(4) -+#define BIT_BKQ_RD_RESP_EN_8812F BIT(3) -+#define BIT_BEQ_RD_RESP_EN_8812F BIT(2) -+#define BIT_VIQ_RD_RESP_EN_8812F BIT(1) -+#define BIT_VOQ_RD_RESP_EN_8812F BIT(0) -+ -+/* 2 REG_MBSSID_CTRL_8812F */ -+#define BIT_MBID_BCNQ7_EN_8812F BIT(7) -+#define BIT_MBID_BCNQ6_EN_8812F BIT(6) -+#define BIT_MBID_BCNQ5_EN_8812F BIT(5) -+#define BIT_MBID_BCNQ4_EN_8812F BIT(4) -+#define BIT_MBID_BCNQ3_EN_8812F BIT(3) -+#define BIT_MBID_BCNQ2_EN_8812F BIT(2) -+#define BIT_MBID_BCNQ1_EN_8812F BIT(1) -+#define BIT_MBID_BCNQ0_EN_8812F BIT(0) -+ -+/* 2 REG_P2PPS_CTRL_8812F */ -+#define BIT_P2P_CTW_ALLSTASLEEP_8812F BIT(7) -+#define BIT_P2P_OFF_DISTX_EN_8812F BIT(6) -+#define BIT_PWR_MGT_EN_8812F BIT(5) -+#define BIT_P2P_NOA1_EN_8812F BIT(2) -+#define BIT_P2P_NOA0_EN_8812F BIT(1) -+ -+/* 2 REG_PKT_LIFETIME_CTRL_8812F */ -+#define BIT_EN_P2P_CTWND1_8812F BIT(23) -+#define BIT_EN_BKF_CLR_TXREQ_8812F BIT(22) -+#define BIT_EN_TSFBIT32_RST_P2P_8812F BIT(21) -+#define BIT_EN_BCN_TX_BTCCA_8812F BIT(20) -+#define BIT_DIS_PKT_TX_ATIM_8812F BIT(19) -+#define BIT_DIS_BCN_DIS_CTN_8812F BIT(18) -+#define BIT_EN_NAVEND_RST_TXOP_8812F BIT(17) -+#define BIT_EN_FILTER_CCA_8812F BIT(16) -+ -+#define BIT_SHIFT_CCA_FILTER_THRS_8812F 8 -+#define BIT_MASK_CCA_FILTER_THRS_8812F 0xff -+#define BIT_CCA_FILTER_THRS_8812F(x) \ -+ (((x) & BIT_MASK_CCA_FILTER_THRS_8812F) \ -+ << BIT_SHIFT_CCA_FILTER_THRS_8812F) -+#define BITS_CCA_FILTER_THRS_8812F \ -+ (BIT_MASK_CCA_FILTER_THRS_8812F << BIT_SHIFT_CCA_FILTER_THRS_8812F) -+#define BIT_CLEAR_CCA_FILTER_THRS_8812F(x) ((x) & (~BITS_CCA_FILTER_THRS_8812F)) -+#define BIT_GET_CCA_FILTER_THRS_8812F(x) \ -+ (((x) >> BIT_SHIFT_CCA_FILTER_THRS_8812F) & \ -+ BIT_MASK_CCA_FILTER_THRS_8812F) -+#define BIT_SET_CCA_FILTER_THRS_8812F(x, v) \ -+ (BIT_CLEAR_CCA_FILTER_THRS_8812F(x) | BIT_CCA_FILTER_THRS_8812F(v)) -+ -+#define BIT_SHIFT_EDCCA_THRS_8812F 0 -+#define BIT_MASK_EDCCA_THRS_8812F 0xff -+#define BIT_EDCCA_THRS_8812F(x) \ -+ (((x) & BIT_MASK_EDCCA_THRS_8812F) << BIT_SHIFT_EDCCA_THRS_8812F) -+#define BITS_EDCCA_THRS_8812F \ -+ (BIT_MASK_EDCCA_THRS_8812F << BIT_SHIFT_EDCCA_THRS_8812F) -+#define BIT_CLEAR_EDCCA_THRS_8812F(x) ((x) & (~BITS_EDCCA_THRS_8812F)) -+#define BIT_GET_EDCCA_THRS_8812F(x) \ -+ (((x) >> BIT_SHIFT_EDCCA_THRS_8812F) & BIT_MASK_EDCCA_THRS_8812F) -+#define BIT_SET_EDCCA_THRS_8812F(x, v) \ -+ (BIT_CLEAR_EDCCA_THRS_8812F(x) | BIT_EDCCA_THRS_8812F(v)) -+ -+/* 2 REG_P2PPS_SPEC_STATE_8812F */ -+#define BIT_SPEC_POWER_STATE_8812F BIT(7) -+#define BIT_SPEC_CTWINDOW_ON_8812F BIT(6) -+#define BIT_SPEC_BEACON_AREA_ON_8812F BIT(5) -+#define BIT_SPEC_CTWIN_EARLY_DISTX_8812F BIT(4) -+#define BIT_SPEC_NOA1_OFF_PERIOD_8812F BIT(3) -+#define BIT_SPEC_FORCE_DOZE1_8812F BIT(2) -+#define BIT_SPEC_NOA0_OFF_PERIOD_8812F BIT(1) -+#define BIT_SPEC_FORCE_DOZE0_8812F BIT(0) -+ -+/* 2 REG_TXOP_LIMIT_CTRL_8812F */ -+ -+#define BIT_SHIFT_TXOP_TBTT_CNT_8812F 24 -+#define BIT_MASK_TXOP_TBTT_CNT_8812F 0xff -+#define BIT_TXOP_TBTT_CNT_8812F(x) \ -+ (((x) & BIT_MASK_TXOP_TBTT_CNT_8812F) << BIT_SHIFT_TXOP_TBTT_CNT_8812F) -+#define BITS_TXOP_TBTT_CNT_8812F \ -+ (BIT_MASK_TXOP_TBTT_CNT_8812F << BIT_SHIFT_TXOP_TBTT_CNT_8812F) -+#define BIT_CLEAR_TXOP_TBTT_CNT_8812F(x) ((x) & (~BITS_TXOP_TBTT_CNT_8812F)) -+#define BIT_GET_TXOP_TBTT_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXOP_TBTT_CNT_8812F) & BIT_MASK_TXOP_TBTT_CNT_8812F) -+#define BIT_SET_TXOP_TBTT_CNT_8812F(x, v) \ -+ (BIT_CLEAR_TXOP_TBTT_CNT_8812F(x) | BIT_TXOP_TBTT_CNT_8812F(v)) -+ -+#define BIT_SHIFT_TXOP_TBTT_CNT_SEL_8812F 20 -+#define BIT_MASK_TXOP_TBTT_CNT_SEL_8812F 0xf -+#define BIT_TXOP_TBTT_CNT_SEL_8812F(x) \ -+ (((x) & BIT_MASK_TXOP_TBTT_CNT_SEL_8812F) \ -+ << BIT_SHIFT_TXOP_TBTT_CNT_SEL_8812F) -+#define BITS_TXOP_TBTT_CNT_SEL_8812F \ -+ (BIT_MASK_TXOP_TBTT_CNT_SEL_8812F << BIT_SHIFT_TXOP_TBTT_CNT_SEL_8812F) -+#define BIT_CLEAR_TXOP_TBTT_CNT_SEL_8812F(x) \ -+ ((x) & (~BITS_TXOP_TBTT_CNT_SEL_8812F)) -+#define BIT_GET_TXOP_TBTT_CNT_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXOP_TBTT_CNT_SEL_8812F) & \ -+ BIT_MASK_TXOP_TBTT_CNT_SEL_8812F) -+#define BIT_SET_TXOP_TBTT_CNT_SEL_8812F(x, v) \ -+ (BIT_CLEAR_TXOP_TBTT_CNT_SEL_8812F(x) | BIT_TXOP_TBTT_CNT_SEL_8812F(v)) -+ -+#define BIT_SHIFT_TXOP_LMT_EN_8812F 16 -+#define BIT_MASK_TXOP_LMT_EN_8812F 0xf -+#define BIT_TXOP_LMT_EN_8812F(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_EN_8812F) << BIT_SHIFT_TXOP_LMT_EN_8812F) -+#define BITS_TXOP_LMT_EN_8812F \ -+ (BIT_MASK_TXOP_LMT_EN_8812F << BIT_SHIFT_TXOP_LMT_EN_8812F) -+#define BIT_CLEAR_TXOP_LMT_EN_8812F(x) ((x) & (~BITS_TXOP_LMT_EN_8812F)) -+#define BIT_GET_TXOP_LMT_EN_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_EN_8812F) & BIT_MASK_TXOP_LMT_EN_8812F) -+#define BIT_SET_TXOP_LMT_EN_8812F(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_EN_8812F(x) | BIT_TXOP_LMT_EN_8812F(v)) -+ -+#define BIT_SHIFT_TXOP_LMT_TX_TIME_8812F 8 -+#define BIT_MASK_TXOP_LMT_TX_TIME_8812F 0xff -+#define BIT_TXOP_LMT_TX_TIME_8812F(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_TX_TIME_8812F) \ -+ << BIT_SHIFT_TXOP_LMT_TX_TIME_8812F) -+#define BITS_TXOP_LMT_TX_TIME_8812F \ -+ (BIT_MASK_TXOP_LMT_TX_TIME_8812F << BIT_SHIFT_TXOP_LMT_TX_TIME_8812F) -+#define BIT_CLEAR_TXOP_LMT_TX_TIME_8812F(x) \ -+ ((x) & (~BITS_TXOP_LMT_TX_TIME_8812F)) -+#define BIT_GET_TXOP_LMT_TX_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_TX_TIME_8812F) & \ -+ BIT_MASK_TXOP_LMT_TX_TIME_8812F) -+#define BIT_SET_TXOP_LMT_TX_TIME_8812F(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_TX_TIME_8812F(x) | BIT_TXOP_LMT_TX_TIME_8812F(v)) -+ -+#define BIT_TXOP_CNT_TRIGGER_RESET_8812F BIT(7) -+ -+#define BIT_SHIFT_TXOP_LMT_PKT_NUM_8812F 0 -+#define BIT_MASK_TXOP_LMT_PKT_NUM_8812F 0x3f -+#define BIT_TXOP_LMT_PKT_NUM_8812F(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_PKT_NUM_8812F) \ -+ << BIT_SHIFT_TXOP_LMT_PKT_NUM_8812F) -+#define BITS_TXOP_LMT_PKT_NUM_8812F \ -+ (BIT_MASK_TXOP_LMT_PKT_NUM_8812F << BIT_SHIFT_TXOP_LMT_PKT_NUM_8812F) -+#define BIT_CLEAR_TXOP_LMT_PKT_NUM_8812F(x) \ -+ ((x) & (~BITS_TXOP_LMT_PKT_NUM_8812F)) -+#define BIT_GET_TXOP_LMT_PKT_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_PKT_NUM_8812F) & \ -+ BIT_MASK_TXOP_LMT_PKT_NUM_8812F) -+#define BIT_SET_TXOP_LMT_PKT_NUM_8812F(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_PKT_NUM_8812F(x) | BIT_TXOP_LMT_PKT_NUM_8812F(v)) -+ -+/* 2 REG_BAR_TX_CTRL_8812F */ -+ -+/* 2 REG_P2PON_DIS_TXTIME_8812F */ -+ -+#define BIT_SHIFT_P2PON_DIS_TXTIME_8812F 0 -+#define BIT_MASK_P2PON_DIS_TXTIME_8812F 0xff -+#define BIT_P2PON_DIS_TXTIME_8812F(x) \ -+ (((x) & BIT_MASK_P2PON_DIS_TXTIME_8812F) \ -+ << BIT_SHIFT_P2PON_DIS_TXTIME_8812F) -+#define BITS_P2PON_DIS_TXTIME_8812F \ -+ (BIT_MASK_P2PON_DIS_TXTIME_8812F << BIT_SHIFT_P2PON_DIS_TXTIME_8812F) -+#define BIT_CLEAR_P2PON_DIS_TXTIME_8812F(x) \ -+ ((x) & (~BITS_P2PON_DIS_TXTIME_8812F)) -+#define BIT_GET_P2PON_DIS_TXTIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_P2PON_DIS_TXTIME_8812F) & \ -+ BIT_MASK_P2PON_DIS_TXTIME_8812F) -+#define BIT_SET_P2PON_DIS_TXTIME_8812F(x, v) \ -+ (BIT_CLEAR_P2PON_DIS_TXTIME_8812F(x) | BIT_P2PON_DIS_TXTIME_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_CCA_TXEN_CNT_8812F */ -+#define BIT_ENABLE_STOP_UPDATE_NAV_8812F BIT(21) -+#define BIT_ENABLE_GEN_RANDON_SLOT_TX_8812F BIT(20) -+#define BIT_ENABLE_RANDOM_SHIFT_TX_8812F BIT(19) -+#define BIT_ENABLE_EDCA_REF_FUNCTION_8812F BIT(18) -+#define BIT_CCA_TXEN_CNT_SWITCH_8812F BIT(17) -+#define BIT_CCA_TXEN_CNT_EN_8812F BIT(16) -+ -+#define BIT_SHIFT_CCA_TXEN_BIG_CNT_8812F 8 -+#define BIT_MASK_CCA_TXEN_BIG_CNT_8812F 0xff -+#define BIT_CCA_TXEN_BIG_CNT_8812F(x) \ -+ (((x) & BIT_MASK_CCA_TXEN_BIG_CNT_8812F) \ -+ << BIT_SHIFT_CCA_TXEN_BIG_CNT_8812F) -+#define BITS_CCA_TXEN_BIG_CNT_8812F \ -+ (BIT_MASK_CCA_TXEN_BIG_CNT_8812F << BIT_SHIFT_CCA_TXEN_BIG_CNT_8812F) -+#define BIT_CLEAR_CCA_TXEN_BIG_CNT_8812F(x) \ -+ ((x) & (~BITS_CCA_TXEN_BIG_CNT_8812F)) -+#define BIT_GET_CCA_TXEN_BIG_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_CCA_TXEN_BIG_CNT_8812F) & \ -+ BIT_MASK_CCA_TXEN_BIG_CNT_8812F) -+#define BIT_SET_CCA_TXEN_BIG_CNT_8812F(x, v) \ -+ (BIT_CLEAR_CCA_TXEN_BIG_CNT_8812F(x) | BIT_CCA_TXEN_BIG_CNT_8812F(v)) -+ -+#define BIT_SHIFT_CCA_TXEN_SMALL_CNT_8812F 0 -+#define BIT_MASK_CCA_TXEN_SMALL_CNT_8812F 0xff -+#define BIT_CCA_TXEN_SMALL_CNT_8812F(x) \ -+ (((x) & BIT_MASK_CCA_TXEN_SMALL_CNT_8812F) \ -+ << BIT_SHIFT_CCA_TXEN_SMALL_CNT_8812F) -+#define BITS_CCA_TXEN_SMALL_CNT_8812F \ -+ (BIT_MASK_CCA_TXEN_SMALL_CNT_8812F \ -+ << BIT_SHIFT_CCA_TXEN_SMALL_CNT_8812F) -+#define BIT_CLEAR_CCA_TXEN_SMALL_CNT_8812F(x) \ -+ ((x) & (~BITS_CCA_TXEN_SMALL_CNT_8812F)) -+#define BIT_GET_CCA_TXEN_SMALL_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_CCA_TXEN_SMALL_CNT_8812F) & \ -+ BIT_MASK_CCA_TXEN_SMALL_CNT_8812F) -+#define BIT_SET_CCA_TXEN_SMALL_CNT_8812F(x, v) \ -+ (BIT_CLEAR_CCA_TXEN_SMALL_CNT_8812F(x) | \ -+ BIT_CCA_TXEN_SMALL_CNT_8812F(v)) -+ -+/* 2 REG_MAX_INTER_COLLISION_8812F */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_BK_8812F 24 -+#define BIT_MASK_MAX_INTER_COLLISION_BK_8812F 0xff -+#define BIT_MAX_INTER_COLLISION_BK_8812F(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_BK_8812F) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BK_8812F) -+#define BITS_MAX_INTER_COLLISION_BK_8812F \ -+ (BIT_MASK_MAX_INTER_COLLISION_BK_8812F \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BK_8812F) -+#define BIT_CLEAR_MAX_INTER_COLLISION_BK_8812F(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_BK_8812F)) -+#define BIT_GET_MAX_INTER_COLLISION_BK_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_BK_8812F) & \ -+ BIT_MASK_MAX_INTER_COLLISION_BK_8812F) -+#define BIT_SET_MAX_INTER_COLLISION_BK_8812F(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_BK_8812F(x) | \ -+ BIT_MAX_INTER_COLLISION_BK_8812F(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_BE_8812F 16 -+#define BIT_MASK_MAX_INTER_COLLISION_BE_8812F 0xff -+#define BIT_MAX_INTER_COLLISION_BE_8812F(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_BE_8812F) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BE_8812F) -+#define BITS_MAX_INTER_COLLISION_BE_8812F \ -+ (BIT_MASK_MAX_INTER_COLLISION_BE_8812F \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BE_8812F) -+#define BIT_CLEAR_MAX_INTER_COLLISION_BE_8812F(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_BE_8812F)) -+#define BIT_GET_MAX_INTER_COLLISION_BE_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_BE_8812F) & \ -+ BIT_MASK_MAX_INTER_COLLISION_BE_8812F) -+#define BIT_SET_MAX_INTER_COLLISION_BE_8812F(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_BE_8812F(x) | \ -+ BIT_MAX_INTER_COLLISION_BE_8812F(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_VI_8812F 8 -+#define BIT_MASK_MAX_INTER_COLLISION_VI_8812F 0xff -+#define BIT_MAX_INTER_COLLISION_VI_8812F(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_VI_8812F) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VI_8812F) -+#define BITS_MAX_INTER_COLLISION_VI_8812F \ -+ (BIT_MASK_MAX_INTER_COLLISION_VI_8812F \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VI_8812F) -+#define BIT_CLEAR_MAX_INTER_COLLISION_VI_8812F(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_VI_8812F)) -+#define BIT_GET_MAX_INTER_COLLISION_VI_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_VI_8812F) & \ -+ BIT_MASK_MAX_INTER_COLLISION_VI_8812F) -+#define BIT_SET_MAX_INTER_COLLISION_VI_8812F(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_VI_8812F(x) | \ -+ BIT_MAX_INTER_COLLISION_VI_8812F(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_VO_8812F 0 -+#define BIT_MASK_MAX_INTER_COLLISION_VO_8812F 0xff -+#define BIT_MAX_INTER_COLLISION_VO_8812F(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_VO_8812F) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VO_8812F) -+#define BITS_MAX_INTER_COLLISION_VO_8812F \ -+ (BIT_MASK_MAX_INTER_COLLISION_VO_8812F \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VO_8812F) -+#define BIT_CLEAR_MAX_INTER_COLLISION_VO_8812F(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_VO_8812F)) -+#define BIT_GET_MAX_INTER_COLLISION_VO_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_VO_8812F) & \ -+ BIT_MASK_MAX_INTER_COLLISION_VO_8812F) -+#define BIT_SET_MAX_INTER_COLLISION_VO_8812F(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_VO_8812F(x) | \ -+ BIT_MAX_INTER_COLLISION_VO_8812F(v)) -+ -+/* 2 REG_MAX_INTER_COLLISION_CNT_8812F */ -+#define BIT_MAX_INTER_COLLISION_EN_8812F BIT(16) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8812F 12 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8812F 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_BK_8812F(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8812F) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8812F) -+#define BITS_MAX_INTER_COLLISION_CNT_BK_8812F \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8812F \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8812F) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_BK_8812F(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_BK_8812F)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_BK_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8812F) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8812F) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_BK_8812F(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_BK_8812F(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_BK_8812F(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8812F 8 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8812F 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_BE_8812F(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8812F) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8812F) -+#define BITS_MAX_INTER_COLLISION_CNT_BE_8812F \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8812F \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8812F) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_BE_8812F(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_BE_8812F)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_BE_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8812F) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8812F) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_BE_8812F(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_BE_8812F(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_BE_8812F(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8812F 4 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8812F 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_VI_8812F(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8812F) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8812F) -+#define BITS_MAX_INTER_COLLISION_CNT_VI_8812F \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8812F \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8812F) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_VI_8812F(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_VI_8812F)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_VI_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8812F) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8812F) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_VI_8812F(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_VI_8812F(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_VI_8812F(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8812F 0 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8812F 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_VO_8812F(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8812F) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8812F) -+#define BITS_MAX_INTER_COLLISION_CNT_VO_8812F \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8812F \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8812F) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_VO_8812F(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_VO_8812F)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_VO_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8812F) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8812F) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_VO_8812F(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_VO_8812F(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_VO_8812F(v)) -+ -+/* 2 REG_TBTT_PROHIBIT_8812F */ -+ -+#define BIT_SHIFT_TBTT_HOLD_TIME_AP_8812F 8 -+#define BIT_MASK_TBTT_HOLD_TIME_AP_8812F 0xfff -+#define BIT_TBTT_HOLD_TIME_AP_8812F(x) \ -+ (((x) & BIT_MASK_TBTT_HOLD_TIME_AP_8812F) \ -+ << BIT_SHIFT_TBTT_HOLD_TIME_AP_8812F) -+#define BITS_TBTT_HOLD_TIME_AP_8812F \ -+ (BIT_MASK_TBTT_HOLD_TIME_AP_8812F << BIT_SHIFT_TBTT_HOLD_TIME_AP_8812F) -+#define BIT_CLEAR_TBTT_HOLD_TIME_AP_8812F(x) \ -+ ((x) & (~BITS_TBTT_HOLD_TIME_AP_8812F)) -+#define BIT_GET_TBTT_HOLD_TIME_AP_8812F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_HOLD_TIME_AP_8812F) & \ -+ BIT_MASK_TBTT_HOLD_TIME_AP_8812F) -+#define BIT_SET_TBTT_HOLD_TIME_AP_8812F(x, v) \ -+ (BIT_CLEAR_TBTT_HOLD_TIME_AP_8812F(x) | BIT_TBTT_HOLD_TIME_AP_8812F(v)) -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_SETUP_8812F 0 -+#define BIT_MASK_TBTT_PROHIBIT_SETUP_8812F 0xf -+#define BIT_TBTT_PROHIBIT_SETUP_8812F(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_SETUP_8812F) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8812F) -+#define BITS_TBTT_PROHIBIT_SETUP_8812F \ -+ (BIT_MASK_TBTT_PROHIBIT_SETUP_8812F \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8812F) -+#define BIT_CLEAR_TBTT_PROHIBIT_SETUP_8812F(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_SETUP_8812F)) -+#define BIT_GET_TBTT_PROHIBIT_SETUP_8812F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_SETUP_8812F) & \ -+ BIT_MASK_TBTT_PROHIBIT_SETUP_8812F) -+#define BIT_SET_TBTT_PROHIBIT_SETUP_8812F(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_SETUP_8812F(x) | \ -+ BIT_TBTT_PROHIBIT_SETUP_8812F(v)) -+ -+/* 2 REG_P2PPS_STATE_8812F */ -+#define BIT_POWER_STATE_8812F BIT(7) -+#define BIT_CTWINDOW_ON_8812F BIT(6) -+#define BIT_BEACON_AREA_ON_8812F BIT(5) -+#define BIT_CTWIN_EARLY_DISTX_8812F BIT(4) -+#define BIT_NOA1_OFF_PERIOD_8812F BIT(3) -+#define BIT_FORCE_DOZE1_8812F BIT(2) -+#define BIT_NOA0_OFF_PERIOD_8812F BIT(1) -+#define BIT_FORCE_DOZE0_8812F BIT(0) -+ -+/* 2 REG_RD_NAV_NXT_8812F */ -+ -+#define BIT_SHIFT_RD_NAV_PROT_NXT_8812F 0 -+#define BIT_MASK_RD_NAV_PROT_NXT_8812F 0xffff -+#define BIT_RD_NAV_PROT_NXT_8812F(x) \ -+ (((x) & BIT_MASK_RD_NAV_PROT_NXT_8812F) \ -+ << BIT_SHIFT_RD_NAV_PROT_NXT_8812F) -+#define BITS_RD_NAV_PROT_NXT_8812F \ -+ (BIT_MASK_RD_NAV_PROT_NXT_8812F << BIT_SHIFT_RD_NAV_PROT_NXT_8812F) -+#define BIT_CLEAR_RD_NAV_PROT_NXT_8812F(x) ((x) & (~BITS_RD_NAV_PROT_NXT_8812F)) -+#define BIT_GET_RD_NAV_PROT_NXT_8812F(x) \ -+ (((x) >> BIT_SHIFT_RD_NAV_PROT_NXT_8812F) & \ -+ BIT_MASK_RD_NAV_PROT_NXT_8812F) -+#define BIT_SET_RD_NAV_PROT_NXT_8812F(x, v) \ -+ (BIT_CLEAR_RD_NAV_PROT_NXT_8812F(x) | BIT_RD_NAV_PROT_NXT_8812F(v)) -+ -+/* 2 REG_NAV_PROT_LEN_8812F */ -+ -+#define BIT_SHIFT_NAV_PROT_LEN_8812F 0 -+#define BIT_MASK_NAV_PROT_LEN_8812F 0xffff -+#define BIT_NAV_PROT_LEN_8812F(x) \ -+ (((x) & BIT_MASK_NAV_PROT_LEN_8812F) << BIT_SHIFT_NAV_PROT_LEN_8812F) -+#define BITS_NAV_PROT_LEN_8812F \ -+ (BIT_MASK_NAV_PROT_LEN_8812F << BIT_SHIFT_NAV_PROT_LEN_8812F) -+#define BIT_CLEAR_NAV_PROT_LEN_8812F(x) ((x) & (~BITS_NAV_PROT_LEN_8812F)) -+#define BIT_GET_NAV_PROT_LEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_NAV_PROT_LEN_8812F) & BIT_MASK_NAV_PROT_LEN_8812F) -+#define BIT_SET_NAV_PROT_LEN_8812F(x, v) \ -+ (BIT_CLEAR_NAV_PROT_LEN_8812F(x) | BIT_NAV_PROT_LEN_8812F(v)) -+ -+/* 2 REG_FTM_PTT_8812F */ -+ -+#define BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8812F 22 -+#define BIT_MASK_FTM_PTT_TSF_R2T_SEL_8812F 0x7 -+#define BIT_FTM_PTT_TSF_R2T_SEL_8812F(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_R2T_SEL_8812F) \ -+ << BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8812F) -+#define BITS_FTM_PTT_TSF_R2T_SEL_8812F \ -+ (BIT_MASK_FTM_PTT_TSF_R2T_SEL_8812F \ -+ << BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8812F) -+#define BIT_CLEAR_FTM_PTT_TSF_R2T_SEL_8812F(x) \ -+ ((x) & (~BITS_FTM_PTT_TSF_R2T_SEL_8812F)) -+#define BIT_GET_FTM_PTT_TSF_R2T_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8812F) & \ -+ BIT_MASK_FTM_PTT_TSF_R2T_SEL_8812F) -+#define BIT_SET_FTM_PTT_TSF_R2T_SEL_8812F(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_R2T_SEL_8812F(x) | \ -+ BIT_FTM_PTT_TSF_R2T_SEL_8812F(v)) -+ -+#define BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8812F 19 -+#define BIT_MASK_FTM_PTT_TSF_T2R_SEL_8812F 0x7 -+#define BIT_FTM_PTT_TSF_T2R_SEL_8812F(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_T2R_SEL_8812F) \ -+ << BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8812F) -+#define BITS_FTM_PTT_TSF_T2R_SEL_8812F \ -+ (BIT_MASK_FTM_PTT_TSF_T2R_SEL_8812F \ -+ << BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8812F) -+#define BIT_CLEAR_FTM_PTT_TSF_T2R_SEL_8812F(x) \ -+ ((x) & (~BITS_FTM_PTT_TSF_T2R_SEL_8812F)) -+#define BIT_GET_FTM_PTT_TSF_T2R_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8812F) & \ -+ BIT_MASK_FTM_PTT_TSF_T2R_SEL_8812F) -+#define BIT_SET_FTM_PTT_TSF_T2R_SEL_8812F(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_T2R_SEL_8812F(x) | \ -+ BIT_FTM_PTT_TSF_T2R_SEL_8812F(v)) -+ -+#define BIT_SHIFT_FTM_PTT_TSF_SEL_8812F 16 -+#define BIT_MASK_FTM_PTT_TSF_SEL_8812F 0x7 -+#define BIT_FTM_PTT_TSF_SEL_8812F(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_SEL_8812F) \ -+ << BIT_SHIFT_FTM_PTT_TSF_SEL_8812F) -+#define BITS_FTM_PTT_TSF_SEL_8812F \ -+ (BIT_MASK_FTM_PTT_TSF_SEL_8812F << BIT_SHIFT_FTM_PTT_TSF_SEL_8812F) -+#define BIT_CLEAR_FTM_PTT_TSF_SEL_8812F(x) ((x) & (~BITS_FTM_PTT_TSF_SEL_8812F)) -+#define BIT_GET_FTM_PTT_TSF_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_SEL_8812F) & \ -+ BIT_MASK_FTM_PTT_TSF_SEL_8812F) -+#define BIT_SET_FTM_PTT_TSF_SEL_8812F(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_SEL_8812F(x) | BIT_FTM_PTT_TSF_SEL_8812F(v)) -+ -+#define BIT_SHIFT_FTM_PTT_VALUE_8812F 0 -+#define BIT_MASK_FTM_PTT_VALUE_8812F 0xffff -+#define BIT_FTM_PTT_VALUE_8812F(x) \ -+ (((x) & BIT_MASK_FTM_PTT_VALUE_8812F) << BIT_SHIFT_FTM_PTT_VALUE_8812F) -+#define BITS_FTM_PTT_VALUE_8812F \ -+ (BIT_MASK_FTM_PTT_VALUE_8812F << BIT_SHIFT_FTM_PTT_VALUE_8812F) -+#define BIT_CLEAR_FTM_PTT_VALUE_8812F(x) ((x) & (~BITS_FTM_PTT_VALUE_8812F)) -+#define BIT_GET_FTM_PTT_VALUE_8812F(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_VALUE_8812F) & BIT_MASK_FTM_PTT_VALUE_8812F) -+#define BIT_SET_FTM_PTT_VALUE_8812F(x, v) \ -+ (BIT_CLEAR_FTM_PTT_VALUE_8812F(x) | BIT_FTM_PTT_VALUE_8812F(v)) -+ -+/* 2 REG_FTM_TSF_8812F */ -+ -+#define BIT_SHIFT_FTM_T2_TSF_8812F 16 -+#define BIT_MASK_FTM_T2_TSF_8812F 0xffff -+#define BIT_FTM_T2_TSF_8812F(x) \ -+ (((x) & BIT_MASK_FTM_T2_TSF_8812F) << BIT_SHIFT_FTM_T2_TSF_8812F) -+#define BITS_FTM_T2_TSF_8812F \ -+ (BIT_MASK_FTM_T2_TSF_8812F << BIT_SHIFT_FTM_T2_TSF_8812F) -+#define BIT_CLEAR_FTM_T2_TSF_8812F(x) ((x) & (~BITS_FTM_T2_TSF_8812F)) -+#define BIT_GET_FTM_T2_TSF_8812F(x) \ -+ (((x) >> BIT_SHIFT_FTM_T2_TSF_8812F) & BIT_MASK_FTM_T2_TSF_8812F) -+#define BIT_SET_FTM_T2_TSF_8812F(x, v) \ -+ (BIT_CLEAR_FTM_T2_TSF_8812F(x) | BIT_FTM_T2_TSF_8812F(v)) -+ -+#define BIT_SHIFT_FTM_T1_TSF_8812F 0 -+#define BIT_MASK_FTM_T1_TSF_8812F 0xffff -+#define BIT_FTM_T1_TSF_8812F(x) \ -+ (((x) & BIT_MASK_FTM_T1_TSF_8812F) << BIT_SHIFT_FTM_T1_TSF_8812F) -+#define BITS_FTM_T1_TSF_8812F \ -+ (BIT_MASK_FTM_T1_TSF_8812F << BIT_SHIFT_FTM_T1_TSF_8812F) -+#define BIT_CLEAR_FTM_T1_TSF_8812F(x) ((x) & (~BITS_FTM_T1_TSF_8812F)) -+#define BIT_GET_FTM_T1_TSF_8812F(x) \ -+ (((x) >> BIT_SHIFT_FTM_T1_TSF_8812F) & BIT_MASK_FTM_T1_TSF_8812F) -+#define BIT_SET_FTM_T1_TSF_8812F(x, v) \ -+ (BIT_CLEAR_FTM_T1_TSF_8812F(x) | BIT_FTM_T1_TSF_8812F(v)) -+ -+/* 2 REG_BCN_CTRL_8812F */ -+#define BIT_DIS_RX_BSSID_FIT_8812F BIT(6) -+#define BIT_P0_EN_TXBCN_RPT_8812F BIT(5) -+#define BIT_DIS_TSF_UDT_8812F BIT(4) -+#define BIT_EN_BCN_FUNCTION_8812F BIT(3) -+#define BIT_P0_EN_RXBCN_RPT_8812F BIT(2) -+#define BIT_EN_P2P_CTWINDOW_8812F BIT(1) -+#define BIT_EN_P2P_BCNQ_AREA_8812F BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT0_8812F */ -+#define BIT_CLI0_DIS_RX_BSSID_FIT_8812F BIT(6) -+#define BIT_CLI0_DIS_TSF_UDT_8812F BIT(4) -+#define BIT_CLI0_EN_BCN_FUNCTION_8812F BIT(3) -+#define BIT_CLI0_EN_RXBCN_RPT_8812F BIT(2) -+#define BIT_CLI0_ENP2P_CTWINDOW_8812F BIT(1) -+#define BIT_CLI0_ENP2P_BCNQ_AREA_8812F BIT(0) -+ -+/* 2 REG_MBID_NUM_8812F */ -+#define BIT_EN_PRE_DL_BEACON_8812F BIT(3) -+ -+#define BIT_SHIFT_MBID_BCN_NUM_8812F 0 -+#define BIT_MASK_MBID_BCN_NUM_8812F 0x7 -+#define BIT_MBID_BCN_NUM_8812F(x) \ -+ (((x) & BIT_MASK_MBID_BCN_NUM_8812F) << BIT_SHIFT_MBID_BCN_NUM_8812F) -+#define BITS_MBID_BCN_NUM_8812F \ -+ (BIT_MASK_MBID_BCN_NUM_8812F << BIT_SHIFT_MBID_BCN_NUM_8812F) -+#define BIT_CLEAR_MBID_BCN_NUM_8812F(x) ((x) & (~BITS_MBID_BCN_NUM_8812F)) -+#define BIT_GET_MBID_BCN_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCN_NUM_8812F) & BIT_MASK_MBID_BCN_NUM_8812F) -+#define BIT_SET_MBID_BCN_NUM_8812F(x, v) \ -+ (BIT_CLEAR_MBID_BCN_NUM_8812F(x) | BIT_MBID_BCN_NUM_8812F(v)) -+ -+/* 2 REG_DUAL_TSF_RST_8812F */ -+#define BIT_FREECNT_RST_8812F BIT(5) -+#define BIT_TSFTR_CLI3_RST_8812F BIT(4) -+#define BIT_TSFTR_CLI2_RST_8812F BIT(3) -+#define BIT_TSFTR_CLI1_RST_8812F BIT(2) -+#define BIT_TSFTR_CLI0_RST_8812F BIT(1) -+#define BIT_TSFTR_RST_8812F BIT(0) -+ -+/* 2 REG_MBSSID_BCN_SPACE_8812F */ -+ -+#define BIT_SHIFT_BCN_TIMER_SEL_FWRD_8812F 28 -+#define BIT_MASK_BCN_TIMER_SEL_FWRD_8812F 0x7 -+#define BIT_BCN_TIMER_SEL_FWRD_8812F(x) \ -+ (((x) & BIT_MASK_BCN_TIMER_SEL_FWRD_8812F) \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_8812F) -+#define BITS_BCN_TIMER_SEL_FWRD_8812F \ -+ (BIT_MASK_BCN_TIMER_SEL_FWRD_8812F \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_8812F) -+#define BIT_CLEAR_BCN_TIMER_SEL_FWRD_8812F(x) \ -+ ((x) & (~BITS_BCN_TIMER_SEL_FWRD_8812F)) -+#define BIT_GET_BCN_TIMER_SEL_FWRD_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCN_TIMER_SEL_FWRD_8812F) & \ -+ BIT_MASK_BCN_TIMER_SEL_FWRD_8812F) -+#define BIT_SET_BCN_TIMER_SEL_FWRD_8812F(x, v) \ -+ (BIT_CLEAR_BCN_TIMER_SEL_FWRD_8812F(x) | \ -+ BIT_BCN_TIMER_SEL_FWRD_8812F(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT0_8812F 16 -+#define BIT_MASK_BCN_SPACE_CLINT0_8812F 0xfff -+#define BIT_BCN_SPACE_CLINT0_8812F(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT0_8812F) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT0_8812F) -+#define BITS_BCN_SPACE_CLINT0_8812F \ -+ (BIT_MASK_BCN_SPACE_CLINT0_8812F << BIT_SHIFT_BCN_SPACE_CLINT0_8812F) -+#define BIT_CLEAR_BCN_SPACE_CLINT0_8812F(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT0_8812F)) -+#define BIT_GET_BCN_SPACE_CLINT0_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT0_8812F) & \ -+ BIT_MASK_BCN_SPACE_CLINT0_8812F) -+#define BIT_SET_BCN_SPACE_CLINT0_8812F(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT0_8812F(x) | BIT_BCN_SPACE_CLINT0_8812F(v)) -+ -+#define BIT_SHIFT_BCN_SPACE0_8812F 0 -+#define BIT_MASK_BCN_SPACE0_8812F 0xffff -+#define BIT_BCN_SPACE0_8812F(x) \ -+ (((x) & BIT_MASK_BCN_SPACE0_8812F) << BIT_SHIFT_BCN_SPACE0_8812F) -+#define BITS_BCN_SPACE0_8812F \ -+ (BIT_MASK_BCN_SPACE0_8812F << BIT_SHIFT_BCN_SPACE0_8812F) -+#define BIT_CLEAR_BCN_SPACE0_8812F(x) ((x) & (~BITS_BCN_SPACE0_8812F)) -+#define BIT_GET_BCN_SPACE0_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE0_8812F) & BIT_MASK_BCN_SPACE0_8812F) -+#define BIT_SET_BCN_SPACE0_8812F(x, v) \ -+ (BIT_CLEAR_BCN_SPACE0_8812F(x) | BIT_BCN_SPACE0_8812F(v)) -+ -+/* 2 REG_DRVERLYINT_8812F */ -+ -+#define BIT_SHIFT_DRVERLYITV_8812F 0 -+#define BIT_MASK_DRVERLYITV_8812F 0xff -+#define BIT_DRVERLYITV_8812F(x) \ -+ (((x) & BIT_MASK_DRVERLYITV_8812F) << BIT_SHIFT_DRVERLYITV_8812F) -+#define BITS_DRVERLYITV_8812F \ -+ (BIT_MASK_DRVERLYITV_8812F << BIT_SHIFT_DRVERLYITV_8812F) -+#define BIT_CLEAR_DRVERLYITV_8812F(x) ((x) & (~BITS_DRVERLYITV_8812F)) -+#define BIT_GET_DRVERLYITV_8812F(x) \ -+ (((x) >> BIT_SHIFT_DRVERLYITV_8812F) & BIT_MASK_DRVERLYITV_8812F) -+#define BIT_SET_DRVERLYITV_8812F(x, v) \ -+ (BIT_CLEAR_DRVERLYITV_8812F(x) | BIT_DRVERLYITV_8812F(v)) -+ -+/* 2 REG_BCNDMATIM_8812F */ -+ -+#define BIT_SHIFT_BCNDMATIM_8812F 0 -+#define BIT_MASK_BCNDMATIM_8812F 0xff -+#define BIT_BCNDMATIM_8812F(x) \ -+ (((x) & BIT_MASK_BCNDMATIM_8812F) << BIT_SHIFT_BCNDMATIM_8812F) -+#define BITS_BCNDMATIM_8812F \ -+ (BIT_MASK_BCNDMATIM_8812F << BIT_SHIFT_BCNDMATIM_8812F) -+#define BIT_CLEAR_BCNDMATIM_8812F(x) ((x) & (~BITS_BCNDMATIM_8812F)) -+#define BIT_GET_BCNDMATIM_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNDMATIM_8812F) & BIT_MASK_BCNDMATIM_8812F) -+#define BIT_SET_BCNDMATIM_8812F(x, v) \ -+ (BIT_CLEAR_BCNDMATIM_8812F(x) | BIT_BCNDMATIM_8812F(v)) -+ -+/* 2 REG_ATIMWND_8812F */ -+ -+#define BIT_SHIFT_ATIMWND0_8812F 0 -+#define BIT_MASK_ATIMWND0_8812F 0xffff -+#define BIT_ATIMWND0_8812F(x) \ -+ (((x) & BIT_MASK_ATIMWND0_8812F) << BIT_SHIFT_ATIMWND0_8812F) -+#define BITS_ATIMWND0_8812F \ -+ (BIT_MASK_ATIMWND0_8812F << BIT_SHIFT_ATIMWND0_8812F) -+#define BIT_CLEAR_ATIMWND0_8812F(x) ((x) & (~BITS_ATIMWND0_8812F)) -+#define BIT_GET_ATIMWND0_8812F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND0_8812F) & BIT_MASK_ATIMWND0_8812F) -+#define BIT_SET_ATIMWND0_8812F(x, v) \ -+ (BIT_CLEAR_ATIMWND0_8812F(x) | BIT_ATIMWND0_8812F(v)) -+ -+/* 2 REG_USTIME_TSF_8812F */ -+ -+#define BIT_SHIFT_USTIME_TSF_V1_8812F 0 -+#define BIT_MASK_USTIME_TSF_V1_8812F 0xff -+#define BIT_USTIME_TSF_V1_8812F(x) \ -+ (((x) & BIT_MASK_USTIME_TSF_V1_8812F) << BIT_SHIFT_USTIME_TSF_V1_8812F) -+#define BITS_USTIME_TSF_V1_8812F \ -+ (BIT_MASK_USTIME_TSF_V1_8812F << BIT_SHIFT_USTIME_TSF_V1_8812F) -+#define BIT_CLEAR_USTIME_TSF_V1_8812F(x) ((x) & (~BITS_USTIME_TSF_V1_8812F)) -+#define BIT_GET_USTIME_TSF_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_USTIME_TSF_V1_8812F) & BIT_MASK_USTIME_TSF_V1_8812F) -+#define BIT_SET_USTIME_TSF_V1_8812F(x, v) \ -+ (BIT_CLEAR_USTIME_TSF_V1_8812F(x) | BIT_USTIME_TSF_V1_8812F(v)) -+ -+/* 2 REG_BCN_MAX_ERR_8812F */ -+ -+#define BIT_SHIFT_BCN_MAX_ERR_8812F 0 -+#define BIT_MASK_BCN_MAX_ERR_8812F 0xff -+#define BIT_BCN_MAX_ERR_8812F(x) \ -+ (((x) & BIT_MASK_BCN_MAX_ERR_8812F) << BIT_SHIFT_BCN_MAX_ERR_8812F) -+#define BITS_BCN_MAX_ERR_8812F \ -+ (BIT_MASK_BCN_MAX_ERR_8812F << BIT_SHIFT_BCN_MAX_ERR_8812F) -+#define BIT_CLEAR_BCN_MAX_ERR_8812F(x) ((x) & (~BITS_BCN_MAX_ERR_8812F)) -+#define BIT_GET_BCN_MAX_ERR_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCN_MAX_ERR_8812F) & BIT_MASK_BCN_MAX_ERR_8812F) -+#define BIT_SET_BCN_MAX_ERR_8812F(x, v) \ -+ (BIT_CLEAR_BCN_MAX_ERR_8812F(x) | BIT_BCN_MAX_ERR_8812F(v)) -+ -+/* 2 REG_RXTSF_OFFSET_CCK_8812F */ -+ -+#define BIT_SHIFT_CCK_RXTSF_OFFSET_8812F 0 -+#define BIT_MASK_CCK_RXTSF_OFFSET_8812F 0xff -+#define BIT_CCK_RXTSF_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_CCK_RXTSF_OFFSET_8812F) \ -+ << BIT_SHIFT_CCK_RXTSF_OFFSET_8812F) -+#define BITS_CCK_RXTSF_OFFSET_8812F \ -+ (BIT_MASK_CCK_RXTSF_OFFSET_8812F << BIT_SHIFT_CCK_RXTSF_OFFSET_8812F) -+#define BIT_CLEAR_CCK_RXTSF_OFFSET_8812F(x) \ -+ ((x) & (~BITS_CCK_RXTSF_OFFSET_8812F)) -+#define BIT_GET_CCK_RXTSF_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_CCK_RXTSF_OFFSET_8812F) & \ -+ BIT_MASK_CCK_RXTSF_OFFSET_8812F) -+#define BIT_SET_CCK_RXTSF_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_CCK_RXTSF_OFFSET_8812F(x) | BIT_CCK_RXTSF_OFFSET_8812F(v)) -+ -+/* 2 REG_RXTSF_OFFSET_OFDM_8812F */ -+ -+#define BIT_SHIFT_OFDM_RXTSF_OFFSET_8812F 0 -+#define BIT_MASK_OFDM_RXTSF_OFFSET_8812F 0xff -+#define BIT_OFDM_RXTSF_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_OFDM_RXTSF_OFFSET_8812F) \ -+ << BIT_SHIFT_OFDM_RXTSF_OFFSET_8812F) -+#define BITS_OFDM_RXTSF_OFFSET_8812F \ -+ (BIT_MASK_OFDM_RXTSF_OFFSET_8812F << BIT_SHIFT_OFDM_RXTSF_OFFSET_8812F) -+#define BIT_CLEAR_OFDM_RXTSF_OFFSET_8812F(x) \ -+ ((x) & (~BITS_OFDM_RXTSF_OFFSET_8812F)) -+#define BIT_GET_OFDM_RXTSF_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_OFDM_RXTSF_OFFSET_8812F) & \ -+ BIT_MASK_OFDM_RXTSF_OFFSET_8812F) -+#define BIT_SET_OFDM_RXTSF_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_OFDM_RXTSF_OFFSET_8812F(x) | BIT_OFDM_RXTSF_OFFSET_8812F(v)) -+ -+/* 2 REG_TSFTR_8812F */ -+ -+#define BIT_SHIFT_TSF_TIMER_V1_8812F 0 -+#define BIT_MASK_TSF_TIMER_V1_8812F 0xffffffffL -+#define BIT_TSF_TIMER_V1_8812F(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_V1_8812F) << BIT_SHIFT_TSF_TIMER_V1_8812F) -+#define BITS_TSF_TIMER_V1_8812F \ -+ (BIT_MASK_TSF_TIMER_V1_8812F << BIT_SHIFT_TSF_TIMER_V1_8812F) -+#define BIT_CLEAR_TSF_TIMER_V1_8812F(x) ((x) & (~BITS_TSF_TIMER_V1_8812F)) -+#define BIT_GET_TSF_TIMER_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_V1_8812F) & BIT_MASK_TSF_TIMER_V1_8812F) -+#define BIT_SET_TSF_TIMER_V1_8812F(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_V1_8812F(x) | BIT_TSF_TIMER_V1_8812F(v)) -+ -+/* 2 REG_TSFTR_1_8812F */ -+ -+#define BIT_SHIFT_TSF_TIMER_V2_8812F 0 -+#define BIT_MASK_TSF_TIMER_V2_8812F 0xffffffffL -+#define BIT_TSF_TIMER_V2_8812F(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_V2_8812F) << BIT_SHIFT_TSF_TIMER_V2_8812F) -+#define BITS_TSF_TIMER_V2_8812F \ -+ (BIT_MASK_TSF_TIMER_V2_8812F << BIT_SHIFT_TSF_TIMER_V2_8812F) -+#define BIT_CLEAR_TSF_TIMER_V2_8812F(x) ((x) & (~BITS_TSF_TIMER_V2_8812F)) -+#define BIT_GET_TSF_TIMER_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_V2_8812F) & BIT_MASK_TSF_TIMER_V2_8812F) -+#define BIT_SET_TSF_TIMER_V2_8812F(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_V2_8812F(x) | BIT_TSF_TIMER_V2_8812F(v)) -+ -+/* 2 REG_FREERUN_CNT_8812F */ -+ -+#define BIT_SHIFT_FREERUN_CNT_V1_8812F 0 -+#define BIT_MASK_FREERUN_CNT_V1_8812F 0xffffffffL -+#define BIT_FREERUN_CNT_V1_8812F(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_V1_8812F) \ -+ << BIT_SHIFT_FREERUN_CNT_V1_8812F) -+#define BITS_FREERUN_CNT_V1_8812F \ -+ (BIT_MASK_FREERUN_CNT_V1_8812F << BIT_SHIFT_FREERUN_CNT_V1_8812F) -+#define BIT_CLEAR_FREERUN_CNT_V1_8812F(x) ((x) & (~BITS_FREERUN_CNT_V1_8812F)) -+#define BIT_GET_FREERUN_CNT_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_V1_8812F) & \ -+ BIT_MASK_FREERUN_CNT_V1_8812F) -+#define BIT_SET_FREERUN_CNT_V1_8812F(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_V1_8812F(x) | BIT_FREERUN_CNT_V1_8812F(v)) -+ -+/* 2 REG_FREERUN_CNT_1_8812F */ -+ -+#define BIT_SHIFT_FREERUN_CNT_V2_8812F 0 -+#define BIT_MASK_FREERUN_CNT_V2_8812F 0xffffffffL -+#define BIT_FREERUN_CNT_V2_8812F(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_V2_8812F) \ -+ << BIT_SHIFT_FREERUN_CNT_V2_8812F) -+#define BITS_FREERUN_CNT_V2_8812F \ -+ (BIT_MASK_FREERUN_CNT_V2_8812F << BIT_SHIFT_FREERUN_CNT_V2_8812F) -+#define BIT_CLEAR_FREERUN_CNT_V2_8812F(x) ((x) & (~BITS_FREERUN_CNT_V2_8812F)) -+#define BIT_GET_FREERUN_CNT_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_V2_8812F) & \ -+ BIT_MASK_FREERUN_CNT_V2_8812F) -+#define BIT_SET_FREERUN_CNT_V2_8812F(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_V2_8812F(x) | BIT_FREERUN_CNT_V2_8812F(v)) -+ -+/* 2 REG_ATIMWND1_V1_8812F */ -+ -+#define BIT_SHIFT_ATIMWND1_V1_8812F 0 -+#define BIT_MASK_ATIMWND1_V1_8812F 0xff -+#define BIT_ATIMWND1_V1_8812F(x) \ -+ (((x) & BIT_MASK_ATIMWND1_V1_8812F) << BIT_SHIFT_ATIMWND1_V1_8812F) -+#define BITS_ATIMWND1_V1_8812F \ -+ (BIT_MASK_ATIMWND1_V1_8812F << BIT_SHIFT_ATIMWND1_V1_8812F) -+#define BIT_CLEAR_ATIMWND1_V1_8812F(x) ((x) & (~BITS_ATIMWND1_V1_8812F)) -+#define BIT_GET_ATIMWND1_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND1_V1_8812F) & BIT_MASK_ATIMWND1_V1_8812F) -+#define BIT_SET_ATIMWND1_V1_8812F(x, v) \ -+ (BIT_CLEAR_ATIMWND1_V1_8812F(x) | BIT_ATIMWND1_V1_8812F(v)) -+ -+/* 2 REG_TBTT_PROHIBIT_INFRA_8812F */ -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_INFRA_8812F 0 -+#define BIT_MASK_TBTT_PROHIBIT_INFRA_8812F 0xff -+#define BIT_TBTT_PROHIBIT_INFRA_8812F(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_INFRA_8812F) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_INFRA_8812F) -+#define BITS_TBTT_PROHIBIT_INFRA_8812F \ -+ (BIT_MASK_TBTT_PROHIBIT_INFRA_8812F \ -+ << BIT_SHIFT_TBTT_PROHIBIT_INFRA_8812F) -+#define BIT_CLEAR_TBTT_PROHIBIT_INFRA_8812F(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_INFRA_8812F)) -+#define BIT_GET_TBTT_PROHIBIT_INFRA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_INFRA_8812F) & \ -+ BIT_MASK_TBTT_PROHIBIT_INFRA_8812F) -+#define BIT_SET_TBTT_PROHIBIT_INFRA_8812F(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_INFRA_8812F(x) | \ -+ BIT_TBTT_PROHIBIT_INFRA_8812F(v)) -+ -+/* 2 REG_CTWND_8812F */ -+ -+#define BIT_SHIFT_CTWND_8812F 0 -+#define BIT_MASK_CTWND_8812F 0xff -+#define BIT_CTWND_8812F(x) \ -+ (((x) & BIT_MASK_CTWND_8812F) << BIT_SHIFT_CTWND_8812F) -+#define BITS_CTWND_8812F (BIT_MASK_CTWND_8812F << BIT_SHIFT_CTWND_8812F) -+#define BIT_CLEAR_CTWND_8812F(x) ((x) & (~BITS_CTWND_8812F)) -+#define BIT_GET_CTWND_8812F(x) \ -+ (((x) >> BIT_SHIFT_CTWND_8812F) & BIT_MASK_CTWND_8812F) -+#define BIT_SET_CTWND_8812F(x, v) \ -+ (BIT_CLEAR_CTWND_8812F(x) | BIT_CTWND_8812F(v)) -+ -+/* 2 REG_BCNIVLCUNT_8812F */ -+ -+#define BIT_SHIFT_BCNIVLCUNT_8812F 0 -+#define BIT_MASK_BCNIVLCUNT_8812F 0x7f -+#define BIT_BCNIVLCUNT_8812F(x) \ -+ (((x) & BIT_MASK_BCNIVLCUNT_8812F) << BIT_SHIFT_BCNIVLCUNT_8812F) -+#define BITS_BCNIVLCUNT_8812F \ -+ (BIT_MASK_BCNIVLCUNT_8812F << BIT_SHIFT_BCNIVLCUNT_8812F) -+#define BIT_CLEAR_BCNIVLCUNT_8812F(x) ((x) & (~BITS_BCNIVLCUNT_8812F)) -+#define BIT_GET_BCNIVLCUNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNIVLCUNT_8812F) & BIT_MASK_BCNIVLCUNT_8812F) -+#define BIT_SET_BCNIVLCUNT_8812F(x, v) \ -+ (BIT_CLEAR_BCNIVLCUNT_8812F(x) | BIT_BCNIVLCUNT_8812F(v)) -+ -+/* 2 REG_BCNDROPCTRL_8812F */ -+#define BIT_BEACON_DROP_EN_8812F BIT(7) -+ -+#define BIT_SHIFT_BEACON_DROP_IVL_8812F 0 -+#define BIT_MASK_BEACON_DROP_IVL_8812F 0x7f -+#define BIT_BEACON_DROP_IVL_8812F(x) \ -+ (((x) & BIT_MASK_BEACON_DROP_IVL_8812F) \ -+ << BIT_SHIFT_BEACON_DROP_IVL_8812F) -+#define BITS_BEACON_DROP_IVL_8812F \ -+ (BIT_MASK_BEACON_DROP_IVL_8812F << BIT_SHIFT_BEACON_DROP_IVL_8812F) -+#define BIT_CLEAR_BEACON_DROP_IVL_8812F(x) ((x) & (~BITS_BEACON_DROP_IVL_8812F)) -+#define BIT_GET_BEACON_DROP_IVL_8812F(x) \ -+ (((x) >> BIT_SHIFT_BEACON_DROP_IVL_8812F) & \ -+ BIT_MASK_BEACON_DROP_IVL_8812F) -+#define BIT_SET_BEACON_DROP_IVL_8812F(x, v) \ -+ (BIT_CLEAR_BEACON_DROP_IVL_8812F(x) | BIT_BEACON_DROP_IVL_8812F(v)) -+ -+/* 2 REG_HGQ_TIMEOUT_PERIOD_8812F */ -+ -+#define BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8812F 0 -+#define BIT_MASK_HGQ_TIMEOUT_PERIOD_8812F 0xff -+#define BIT_HGQ_TIMEOUT_PERIOD_8812F(x) \ -+ (((x) & BIT_MASK_HGQ_TIMEOUT_PERIOD_8812F) \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8812F) -+#define BITS_HGQ_TIMEOUT_PERIOD_8812F \ -+ (BIT_MASK_HGQ_TIMEOUT_PERIOD_8812F \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8812F) -+#define BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8812F(x) \ -+ ((x) & (~BITS_HGQ_TIMEOUT_PERIOD_8812F)) -+#define BIT_GET_HGQ_TIMEOUT_PERIOD_8812F(x) \ -+ (((x) >> BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8812F) & \ -+ BIT_MASK_HGQ_TIMEOUT_PERIOD_8812F) -+#define BIT_SET_HGQ_TIMEOUT_PERIOD_8812F(x, v) \ -+ (BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8812F(x) | \ -+ BIT_HGQ_TIMEOUT_PERIOD_8812F(v)) -+ -+/* 2 REG_TXCMD_TIMEOUT_PERIOD_8812F */ -+ -+#define BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8812F 0 -+#define BIT_MASK_TXCMD_TIMEOUT_PERIOD_8812F 0xff -+#define BIT_TXCMD_TIMEOUT_PERIOD_8812F(x) \ -+ (((x) & BIT_MASK_TXCMD_TIMEOUT_PERIOD_8812F) \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8812F) -+#define BITS_TXCMD_TIMEOUT_PERIOD_8812F \ -+ (BIT_MASK_TXCMD_TIMEOUT_PERIOD_8812F \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8812F) -+#define BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8812F(x) \ -+ ((x) & (~BITS_TXCMD_TIMEOUT_PERIOD_8812F)) -+#define BIT_GET_TXCMD_TIMEOUT_PERIOD_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8812F) & \ -+ BIT_MASK_TXCMD_TIMEOUT_PERIOD_8812F) -+#define BIT_SET_TXCMD_TIMEOUT_PERIOD_8812F(x, v) \ -+ (BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8812F(x) | \ -+ BIT_TXCMD_TIMEOUT_PERIOD_8812F(v)) -+ -+/* 2 REG_MISC_CTRL_8812F */ -+#define BIT_DIS_MARK_TSF_US_V2_8812F BIT(7) -+#define BIT_AUTO_SYNC_BY_TBTT_8812F BIT(6) -+#define BIT_DIS_TRX_CAL_BCN_8812F BIT(5) -+#define BIT_DIS_TX_CAL_TBTT_8812F BIT(4) -+#define BIT_EN_FREECNT_8812F BIT(3) -+#define BIT_BCN_AGGRESSION_8812F BIT(2) -+ -+#define BIT_SHIFT_DIS_SECONDARY_CCA_8812F 0 -+#define BIT_MASK_DIS_SECONDARY_CCA_8812F 0x3 -+#define BIT_DIS_SECONDARY_CCA_8812F(x) \ -+ (((x) & BIT_MASK_DIS_SECONDARY_CCA_8812F) \ -+ << BIT_SHIFT_DIS_SECONDARY_CCA_8812F) -+#define BITS_DIS_SECONDARY_CCA_8812F \ -+ (BIT_MASK_DIS_SECONDARY_CCA_8812F << BIT_SHIFT_DIS_SECONDARY_CCA_8812F) -+#define BIT_CLEAR_DIS_SECONDARY_CCA_8812F(x) \ -+ ((x) & (~BITS_DIS_SECONDARY_CCA_8812F)) -+#define BIT_GET_DIS_SECONDARY_CCA_8812F(x) \ -+ (((x) >> BIT_SHIFT_DIS_SECONDARY_CCA_8812F) & \ -+ BIT_MASK_DIS_SECONDARY_CCA_8812F) -+#define BIT_SET_DIS_SECONDARY_CCA_8812F(x, v) \ -+ (BIT_CLEAR_DIS_SECONDARY_CCA_8812F(x) | BIT_DIS_SECONDARY_CCA_8812F(v)) -+ -+/* 2 REG_BCN_CTRL_CLINT1_8812F */ -+#define BIT_CLI1_DIS_RX_BSSID_FIT_8812F BIT(6) -+#define BIT_CLI1_DIS_TSF_UDT_8812F BIT(4) -+#define BIT_CLI1_EN_BCN_FUNCTION_8812F BIT(3) -+#define BIT_CLI1_EN_RXBCN_RPT_8812F BIT(2) -+#define BIT_CLI1_ENP2P_CTWINDOW_8812F BIT(1) -+#define BIT_CLI1_ENP2P_BCNQ_AREA_8812F BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT2_8812F */ -+#define BIT_CLI2_DIS_RX_BSSID_FIT_8812F BIT(6) -+#define BIT_CLI2_DIS_TSF_UDT_8812F BIT(4) -+#define BIT_CLI2_EN_BCN_FUNCTION_8812F BIT(3) -+#define BIT_CLI2_EN_RXBCN_RPT_8812F BIT(2) -+#define BIT_CLI2_ENP2P_CTWINDOW_8812F BIT(1) -+#define BIT_CLI2_ENP2P_BCNQ_AREA_8812F BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT3_8812F */ -+#define BIT_CLI3_DIS_RX_BSSID_FIT_8812F BIT(6) -+#define BIT_CLI3_DIS_TSF_UDT_8812F BIT(4) -+#define BIT_CLI3_EN_BCN_FUNCTION_8812F BIT(3) -+#define BIT_CLI3_EN_RXBCN_RPT_8812F BIT(2) -+#define BIT_CLI3_ENP2P_CTWINDOW_8812F BIT(1) -+#define BIT_CLI3_ENP2P_BCNQ_AREA_8812F BIT(0) -+ -+/* 2 REG_EXTEND_CTRL_8812F */ -+#define BIT_EN_TSFBIT32_RST_P2P2_8812F BIT(5) -+#define BIT_EN_TSFBIT32_RST_P2P1_8812F BIT(4) -+ -+#define BIT_SHIFT_PORT_SEL_8812F 0 -+#define BIT_MASK_PORT_SEL_8812F 0x7 -+#define BIT_PORT_SEL_8812F(x) \ -+ (((x) & BIT_MASK_PORT_SEL_8812F) << BIT_SHIFT_PORT_SEL_8812F) -+#define BITS_PORT_SEL_8812F \ -+ (BIT_MASK_PORT_SEL_8812F << BIT_SHIFT_PORT_SEL_8812F) -+#define BIT_CLEAR_PORT_SEL_8812F(x) ((x) & (~BITS_PORT_SEL_8812F)) -+#define BIT_GET_PORT_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_PORT_SEL_8812F) & BIT_MASK_PORT_SEL_8812F) -+#define BIT_SET_PORT_SEL_8812F(x, v) \ -+ (BIT_CLEAR_PORT_SEL_8812F(x) | BIT_PORT_SEL_8812F(v)) -+ -+/* 2 REG_P2PPS1_SPEC_STATE_8812F */ -+#define BIT_P2P1_SPEC_POWER_STATE_8812F BIT(7) -+#define BIT_P2P1_SPEC_CTWINDOW_ON_8812F BIT(6) -+#define BIT_P2P1_SPEC_BCN_AREA_ON_8812F BIT(5) -+#define BIT_P2P1_SPEC_CTWIN_EARLY_DISTX_8812F BIT(4) -+#define BIT_P2P1_SPEC_NOA1_OFF_PERIOD_8812F BIT(3) -+#define BIT_P2P1_SPEC_FORCE_DOZE1_8812F BIT(2) -+#define BIT_P2P1_SPEC_NOA0_OFF_PERIOD_8812F BIT(1) -+#define BIT_P2P1_SPEC_FORCE_DOZE0_8812F BIT(0) -+ -+/* 2 REG_P2PPS1_STATE_8812F */ -+#define BIT_P2P1_POWER_STATE_8812F BIT(7) -+#define BIT_P2P1_CTWINDOW_ON_8812F BIT(6) -+#define BIT_P2P1_BEACON_AREA_ON_8812F BIT(5) -+#define BIT_P2P1_CTWIN_EARLY_DISTX_8812F BIT(4) -+#define BIT_P2P1_NOA1_OFF_PERIOD_8812F BIT(3) -+#define BIT_P2P1_FORCE_DOZE1_8812F BIT(2) -+#define BIT_P2P1_NOA0_OFF_PERIOD_8812F BIT(1) -+#define BIT_P2P1_FORCE_DOZE0_8812F BIT(0) -+ -+/* 2 REG_P2PPS2_SPEC_STATE_8812F */ -+#define BIT_P2P2_SPEC_POWER_STATE_8812F BIT(7) -+#define BIT_P2P2_SPEC_CTWINDOW_ON_8812F BIT(6) -+#define BIT_P2P2_SPEC_BCN_AREA_ON_8812F BIT(5) -+#define BIT_P2P2_SPEC_CTWIN_EARLY_DISTX_8812F BIT(4) -+#define BIT_P2P2_SPEC_NOA1_OFF_PERIOD_8812F BIT(3) -+#define BIT_P2P2_SPEC_FORCE_DOZE1_8812F BIT(2) -+#define BIT_P2P2_SPEC_NOA0_OFF_PERIOD_8812F BIT(1) -+#define BIT_P2P2_SPEC_FORCE_DOZE0_8812F BIT(0) -+ -+/* 2 REG_P2PPS2_STATE_8812F */ -+#define BIT_P2P2_POWER_STATE_8812F BIT(7) -+#define BIT_P2P2_CTWINDOW_ON_8812F BIT(6) -+#define BIT_P2P2_BEACON_AREA_ON_8812F BIT(5) -+#define BIT_P2P2_CTWIN_EARLY_DISTX_8812F BIT(4) -+#define BIT_P2P2_NOA1_OFF_PERIOD_8812F BIT(3) -+#define BIT_P2P2_FORCE_DOZE1_8812F BIT(2) -+#define BIT_P2P2_NOA0_OFF_PERIOD_8812F BIT(1) -+#define BIT_P2P2_FORCE_DOZE0_8812F BIT(0) -+ -+/* 2 REG_PS_TIMER0_8812F */ -+ -+#define BIT_SHIFT_PSTIMER0_INT_8812F 5 -+#define BIT_MASK_PSTIMER0_INT_8812F 0x7ffffff -+#define BIT_PSTIMER0_INT_8812F(x) \ -+ (((x) & BIT_MASK_PSTIMER0_INT_8812F) << BIT_SHIFT_PSTIMER0_INT_8812F) -+#define BITS_PSTIMER0_INT_8812F \ -+ (BIT_MASK_PSTIMER0_INT_8812F << BIT_SHIFT_PSTIMER0_INT_8812F) -+#define BIT_CLEAR_PSTIMER0_INT_8812F(x) ((x) & (~BITS_PSTIMER0_INT_8812F)) -+#define BIT_GET_PSTIMER0_INT_8812F(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER0_INT_8812F) & BIT_MASK_PSTIMER0_INT_8812F) -+#define BIT_SET_PSTIMER0_INT_8812F(x, v) \ -+ (BIT_CLEAR_PSTIMER0_INT_8812F(x) | BIT_PSTIMER0_INT_8812F(v)) -+ -+/* 2 REG_PS_TIMER1_8812F */ -+ -+#define BIT_SHIFT_PSTIMER1_INT_8812F 5 -+#define BIT_MASK_PSTIMER1_INT_8812F 0x7ffffff -+#define BIT_PSTIMER1_INT_8812F(x) \ -+ (((x) & BIT_MASK_PSTIMER1_INT_8812F) << BIT_SHIFT_PSTIMER1_INT_8812F) -+#define BITS_PSTIMER1_INT_8812F \ -+ (BIT_MASK_PSTIMER1_INT_8812F << BIT_SHIFT_PSTIMER1_INT_8812F) -+#define BIT_CLEAR_PSTIMER1_INT_8812F(x) ((x) & (~BITS_PSTIMER1_INT_8812F)) -+#define BIT_GET_PSTIMER1_INT_8812F(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER1_INT_8812F) & BIT_MASK_PSTIMER1_INT_8812F) -+#define BIT_SET_PSTIMER1_INT_8812F(x, v) \ -+ (BIT_CLEAR_PSTIMER1_INT_8812F(x) | BIT_PSTIMER1_INT_8812F(v)) -+ -+/* 2 REG_PS_TIMER2_8812F */ -+ -+#define BIT_SHIFT_PSTIMER2_INT_8812F 5 -+#define BIT_MASK_PSTIMER2_INT_8812F 0x7ffffff -+#define BIT_PSTIMER2_INT_8812F(x) \ -+ (((x) & BIT_MASK_PSTIMER2_INT_8812F) << BIT_SHIFT_PSTIMER2_INT_8812F) -+#define BITS_PSTIMER2_INT_8812F \ -+ (BIT_MASK_PSTIMER2_INT_8812F << BIT_SHIFT_PSTIMER2_INT_8812F) -+#define BIT_CLEAR_PSTIMER2_INT_8812F(x) ((x) & (~BITS_PSTIMER2_INT_8812F)) -+#define BIT_GET_PSTIMER2_INT_8812F(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER2_INT_8812F) & BIT_MASK_PSTIMER2_INT_8812F) -+#define BIT_SET_PSTIMER2_INT_8812F(x, v) \ -+ (BIT_CLEAR_PSTIMER2_INT_8812F(x) | BIT_PSTIMER2_INT_8812F(v)) -+ -+/* 2 REG_TBTT_CTN_AREA_8812F */ -+ -+#define BIT_SHIFT_TBTT_CTN_AREA_8812F 0 -+#define BIT_MASK_TBTT_CTN_AREA_8812F 0xff -+#define BIT_TBTT_CTN_AREA_8812F(x) \ -+ (((x) & BIT_MASK_TBTT_CTN_AREA_8812F) << BIT_SHIFT_TBTT_CTN_AREA_8812F) -+#define BITS_TBTT_CTN_AREA_8812F \ -+ (BIT_MASK_TBTT_CTN_AREA_8812F << BIT_SHIFT_TBTT_CTN_AREA_8812F) -+#define BIT_CLEAR_TBTT_CTN_AREA_8812F(x) ((x) & (~BITS_TBTT_CTN_AREA_8812F)) -+#define BIT_GET_TBTT_CTN_AREA_8812F(x) \ -+ (((x) >> BIT_SHIFT_TBTT_CTN_AREA_8812F) & BIT_MASK_TBTT_CTN_AREA_8812F) -+#define BIT_SET_TBTT_CTN_AREA_8812F(x, v) \ -+ (BIT_CLEAR_TBTT_CTN_AREA_8812F(x) | BIT_TBTT_CTN_AREA_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_FORCE_BCN_IFS_8812F */ -+ -+#define BIT_SHIFT_FORCE_BCN_IFS_8812F 0 -+#define BIT_MASK_FORCE_BCN_IFS_8812F 0xff -+#define BIT_FORCE_BCN_IFS_8812F(x) \ -+ (((x) & BIT_MASK_FORCE_BCN_IFS_8812F) << BIT_SHIFT_FORCE_BCN_IFS_8812F) -+#define BITS_FORCE_BCN_IFS_8812F \ -+ (BIT_MASK_FORCE_BCN_IFS_8812F << BIT_SHIFT_FORCE_BCN_IFS_8812F) -+#define BIT_CLEAR_FORCE_BCN_IFS_8812F(x) ((x) & (~BITS_FORCE_BCN_IFS_8812F)) -+#define BIT_GET_FORCE_BCN_IFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_FORCE_BCN_IFS_8812F) & BIT_MASK_FORCE_BCN_IFS_8812F) -+#define BIT_SET_FORCE_BCN_IFS_8812F(x, v) \ -+ (BIT_CLEAR_FORCE_BCN_IFS_8812F(x) | BIT_FORCE_BCN_IFS_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_TXOP_MIN_8812F */ -+#define BIT_HIQ_NAV_BREAK_EN_8812F BIT(15) -+#define BIT_MGQ_NAV_BREAK_EN_8812F BIT(14) -+ -+#define BIT_SHIFT_TXOP_MIN_8812F 0 -+#define BIT_MASK_TXOP_MIN_8812F 0x3fff -+#define BIT_TXOP_MIN_8812F(x) \ -+ (((x) & BIT_MASK_TXOP_MIN_8812F) << BIT_SHIFT_TXOP_MIN_8812F) -+#define BITS_TXOP_MIN_8812F \ -+ (BIT_MASK_TXOP_MIN_8812F << BIT_SHIFT_TXOP_MIN_8812F) -+#define BIT_CLEAR_TXOP_MIN_8812F(x) ((x) & (~BITS_TXOP_MIN_8812F)) -+#define BIT_GET_TXOP_MIN_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXOP_MIN_8812F) & BIT_MASK_TXOP_MIN_8812F) -+#define BIT_SET_TXOP_MIN_8812F(x, v) \ -+ (BIT_CLEAR_TXOP_MIN_8812F(x) | BIT_TXOP_MIN_8812F(v)) -+ -+/* 2 REG_PRE_BKF_TIME_8812F */ -+ -+#define BIT_SHIFT_PRE_BKF_TIME_8812F 0 -+#define BIT_MASK_PRE_BKF_TIME_8812F 0xff -+#define BIT_PRE_BKF_TIME_8812F(x) \ -+ (((x) & BIT_MASK_PRE_BKF_TIME_8812F) << BIT_SHIFT_PRE_BKF_TIME_8812F) -+#define BITS_PRE_BKF_TIME_8812F \ -+ (BIT_MASK_PRE_BKF_TIME_8812F << BIT_SHIFT_PRE_BKF_TIME_8812F) -+#define BIT_CLEAR_PRE_BKF_TIME_8812F(x) ((x) & (~BITS_PRE_BKF_TIME_8812F)) -+#define BIT_GET_PRE_BKF_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_PRE_BKF_TIME_8812F) & BIT_MASK_PRE_BKF_TIME_8812F) -+#define BIT_SET_PRE_BKF_TIME_8812F(x, v) \ -+ (BIT_CLEAR_PRE_BKF_TIME_8812F(x) | BIT_PRE_BKF_TIME_8812F(v)) -+ -+/* 2 REG_CROSS_TXOP_CTRL_8812F */ -+#define BIT_TXFAIL_BREACK_TXOP_EN_8812F BIT(3) -+#define BIT_DTIM_BYPASS_8812F BIT(2) -+#define BIT_RTS_NAV_TXOP_8812F BIT(1) -+#define BIT_NOT_CROSS_TXOP_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_RX_TBTT_SHIFT_V1_8812F */ -+#define BIT_RX_TBTT_SHIFT_RW_FLAG_V1_8812F BIT(31) -+ -+#define BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1_8812F 16 -+#define BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1_8812F 0xfff -+#define BIT_RX_TBTT_SHIFT_OFFSET_V1_8812F(x) \ -+ (((x) & BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1_8812F) \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1_8812F) -+#define BITS_RX_TBTT_SHIFT_OFFSET_V1_8812F \ -+ (BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1_8812F \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1_8812F) -+#define BIT_CLEAR_RX_TBTT_SHIFT_OFFSET_V1_8812F(x) \ -+ ((x) & (~BITS_RX_TBTT_SHIFT_OFFSET_V1_8812F)) -+#define BIT_GET_RX_TBTT_SHIFT_OFFSET_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1_8812F) & \ -+ BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1_8812F) -+#define BIT_SET_RX_TBTT_SHIFT_OFFSET_V1_8812F(x, v) \ -+ (BIT_CLEAR_RX_TBTT_SHIFT_OFFSET_V1_8812F(x) | \ -+ BIT_RX_TBTT_SHIFT_OFFSET_V1_8812F(v)) -+ -+#define BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1_8812F 8 -+#define BIT_MASK_RX_TBTT_SHIFT_SEL_V1_8812F 0x7 -+#define BIT_RX_TBTT_SHIFT_SEL_V1_8812F(x) \ -+ (((x) & BIT_MASK_RX_TBTT_SHIFT_SEL_V1_8812F) \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1_8812F) -+#define BITS_RX_TBTT_SHIFT_SEL_V1_8812F \ -+ (BIT_MASK_RX_TBTT_SHIFT_SEL_V1_8812F \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1_8812F) -+#define BIT_CLEAR_RX_TBTT_SHIFT_SEL_V1_8812F(x) \ -+ ((x) & (~BITS_RX_TBTT_SHIFT_SEL_V1_8812F)) -+#define BIT_GET_RX_TBTT_SHIFT_SEL_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1_8812F) & \ -+ BIT_MASK_RX_TBTT_SHIFT_SEL_V1_8812F) -+#define BIT_SET_RX_TBTT_SHIFT_SEL_V1_8812F(x, v) \ -+ (BIT_CLEAR_RX_TBTT_SHIFT_SEL_V1_8812F(x) | \ -+ BIT_RX_TBTT_SHIFT_SEL_V1_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_ATIMWND2_8812F */ -+ -+#define BIT_SHIFT_ATIMWND2_8812F 0 -+#define BIT_MASK_ATIMWND2_8812F 0xff -+#define BIT_ATIMWND2_8812F(x) \ -+ (((x) & BIT_MASK_ATIMWND2_8812F) << BIT_SHIFT_ATIMWND2_8812F) -+#define BITS_ATIMWND2_8812F \ -+ (BIT_MASK_ATIMWND2_8812F << BIT_SHIFT_ATIMWND2_8812F) -+#define BIT_CLEAR_ATIMWND2_8812F(x) ((x) & (~BITS_ATIMWND2_8812F)) -+#define BIT_GET_ATIMWND2_8812F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND2_8812F) & BIT_MASK_ATIMWND2_8812F) -+#define BIT_SET_ATIMWND2_8812F(x, v) \ -+ (BIT_CLEAR_ATIMWND2_8812F(x) | BIT_ATIMWND2_8812F(v)) -+ -+/* 2 REG_ATIMWND3_8812F */ -+ -+#define BIT_SHIFT_ATIMWND3_8812F 0 -+#define BIT_MASK_ATIMWND3_8812F 0xff -+#define BIT_ATIMWND3_8812F(x) \ -+ (((x) & BIT_MASK_ATIMWND3_8812F) << BIT_SHIFT_ATIMWND3_8812F) -+#define BITS_ATIMWND3_8812F \ -+ (BIT_MASK_ATIMWND3_8812F << BIT_SHIFT_ATIMWND3_8812F) -+#define BIT_CLEAR_ATIMWND3_8812F(x) ((x) & (~BITS_ATIMWND3_8812F)) -+#define BIT_GET_ATIMWND3_8812F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND3_8812F) & BIT_MASK_ATIMWND3_8812F) -+#define BIT_SET_ATIMWND3_8812F(x, v) \ -+ (BIT_CLEAR_ATIMWND3_8812F(x) | BIT_ATIMWND3_8812F(v)) -+ -+/* 2 REG_ATIMWND4_8812F */ -+ -+#define BIT_SHIFT_ATIMWND4_8812F 0 -+#define BIT_MASK_ATIMWND4_8812F 0xff -+#define BIT_ATIMWND4_8812F(x) \ -+ (((x) & BIT_MASK_ATIMWND4_8812F) << BIT_SHIFT_ATIMWND4_8812F) -+#define BITS_ATIMWND4_8812F \ -+ (BIT_MASK_ATIMWND4_8812F << BIT_SHIFT_ATIMWND4_8812F) -+#define BIT_CLEAR_ATIMWND4_8812F(x) ((x) & (~BITS_ATIMWND4_8812F)) -+#define BIT_GET_ATIMWND4_8812F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND4_8812F) & BIT_MASK_ATIMWND4_8812F) -+#define BIT_SET_ATIMWND4_8812F(x, v) \ -+ (BIT_CLEAR_ATIMWND4_8812F(x) | BIT_ATIMWND4_8812F(v)) -+ -+/* 2 REG_ATIMWND5_8812F */ -+ -+#define BIT_SHIFT_ATIMWND5_8812F 0 -+#define BIT_MASK_ATIMWND5_8812F 0xff -+#define BIT_ATIMWND5_8812F(x) \ -+ (((x) & BIT_MASK_ATIMWND5_8812F) << BIT_SHIFT_ATIMWND5_8812F) -+#define BITS_ATIMWND5_8812F \ -+ (BIT_MASK_ATIMWND5_8812F << BIT_SHIFT_ATIMWND5_8812F) -+#define BIT_CLEAR_ATIMWND5_8812F(x) ((x) & (~BITS_ATIMWND5_8812F)) -+#define BIT_GET_ATIMWND5_8812F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND5_8812F) & BIT_MASK_ATIMWND5_8812F) -+#define BIT_SET_ATIMWND5_8812F(x, v) \ -+ (BIT_CLEAR_ATIMWND5_8812F(x) | BIT_ATIMWND5_8812F(v)) -+ -+/* 2 REG_ATIMWND6_8812F */ -+ -+#define BIT_SHIFT_ATIMWND6_8812F 0 -+#define BIT_MASK_ATIMWND6_8812F 0xff -+#define BIT_ATIMWND6_8812F(x) \ -+ (((x) & BIT_MASK_ATIMWND6_8812F) << BIT_SHIFT_ATIMWND6_8812F) -+#define BITS_ATIMWND6_8812F \ -+ (BIT_MASK_ATIMWND6_8812F << BIT_SHIFT_ATIMWND6_8812F) -+#define BIT_CLEAR_ATIMWND6_8812F(x) ((x) & (~BITS_ATIMWND6_8812F)) -+#define BIT_GET_ATIMWND6_8812F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND6_8812F) & BIT_MASK_ATIMWND6_8812F) -+#define BIT_SET_ATIMWND6_8812F(x, v) \ -+ (BIT_CLEAR_ATIMWND6_8812F(x) | BIT_ATIMWND6_8812F(v)) -+ -+/* 2 REG_ATIMWND7_8812F */ -+ -+#define BIT_SHIFT_ATIMWND7_8812F 0 -+#define BIT_MASK_ATIMWND7_8812F 0xff -+#define BIT_ATIMWND7_8812F(x) \ -+ (((x) & BIT_MASK_ATIMWND7_8812F) << BIT_SHIFT_ATIMWND7_8812F) -+#define BITS_ATIMWND7_8812F \ -+ (BIT_MASK_ATIMWND7_8812F << BIT_SHIFT_ATIMWND7_8812F) -+#define BIT_CLEAR_ATIMWND7_8812F(x) ((x) & (~BITS_ATIMWND7_8812F)) -+#define BIT_GET_ATIMWND7_8812F(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND7_8812F) & BIT_MASK_ATIMWND7_8812F) -+#define BIT_SET_ATIMWND7_8812F(x, v) \ -+ (BIT_CLEAR_ATIMWND7_8812F(x) | BIT_ATIMWND7_8812F(v)) -+ -+/* 2 REG_ATIMUGT_8812F */ -+ -+#define BIT_SHIFT_ATIM_URGENT_8812F 0 -+#define BIT_MASK_ATIM_URGENT_8812F 0xff -+#define BIT_ATIM_URGENT_8812F(x) \ -+ (((x) & BIT_MASK_ATIM_URGENT_8812F) << BIT_SHIFT_ATIM_URGENT_8812F) -+#define BITS_ATIM_URGENT_8812F \ -+ (BIT_MASK_ATIM_URGENT_8812F << BIT_SHIFT_ATIM_URGENT_8812F) -+#define BIT_CLEAR_ATIM_URGENT_8812F(x) ((x) & (~BITS_ATIM_URGENT_8812F)) -+#define BIT_GET_ATIM_URGENT_8812F(x) \ -+ (((x) >> BIT_SHIFT_ATIM_URGENT_8812F) & BIT_MASK_ATIM_URGENT_8812F) -+#define BIT_SET_ATIM_URGENT_8812F(x, v) \ -+ (BIT_CLEAR_ATIM_URGENT_8812F(x) | BIT_ATIM_URGENT_8812F(v)) -+ -+/* 2 REG_HIQ_NO_LMT_EN_8812F */ -+#define BIT_HIQ_NO_LMT_EN_VAP7_8812F BIT(7) -+#define BIT_HIQ_NO_LMT_EN_VAP6_8812F BIT(6) -+#define BIT_HIQ_NO_LMT_EN_VAP5_8812F BIT(5) -+#define BIT_HIQ_NO_LMT_EN_VAP4_8812F BIT(4) -+#define BIT_HIQ_NO_LMT_EN_VAP3_8812F BIT(3) -+#define BIT_HIQ_NO_LMT_EN_VAP2_8812F BIT(2) -+#define BIT_HIQ_NO_LMT_EN_VAP1_8812F BIT(1) -+#define BIT_HIQ_NO_LMT_EN_ROOT_8812F BIT(0) -+ -+/* 2 REG_DTIM_COUNTER_ROOT_8812F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_ROOT_8812F 0 -+#define BIT_MASK_DTIM_COUNT_ROOT_8812F 0xff -+#define BIT_DTIM_COUNT_ROOT_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_ROOT_8812F) \ -+ << BIT_SHIFT_DTIM_COUNT_ROOT_8812F) -+#define BITS_DTIM_COUNT_ROOT_8812F \ -+ (BIT_MASK_DTIM_COUNT_ROOT_8812F << BIT_SHIFT_DTIM_COUNT_ROOT_8812F) -+#define BIT_CLEAR_DTIM_COUNT_ROOT_8812F(x) ((x) & (~BITS_DTIM_COUNT_ROOT_8812F)) -+#define BIT_GET_DTIM_COUNT_ROOT_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_ROOT_8812F) & \ -+ BIT_MASK_DTIM_COUNT_ROOT_8812F) -+#define BIT_SET_DTIM_COUNT_ROOT_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_ROOT_8812F(x) | BIT_DTIM_COUNT_ROOT_8812F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP1_8812F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP1_8812F 0 -+#define BIT_MASK_DTIM_COUNT_VAP1_8812F 0xff -+#define BIT_DTIM_COUNT_VAP1_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP1_8812F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP1_8812F) -+#define BITS_DTIM_COUNT_VAP1_8812F \ -+ (BIT_MASK_DTIM_COUNT_VAP1_8812F << BIT_SHIFT_DTIM_COUNT_VAP1_8812F) -+#define BIT_CLEAR_DTIM_COUNT_VAP1_8812F(x) ((x) & (~BITS_DTIM_COUNT_VAP1_8812F)) -+#define BIT_GET_DTIM_COUNT_VAP1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP1_8812F) & \ -+ BIT_MASK_DTIM_COUNT_VAP1_8812F) -+#define BIT_SET_DTIM_COUNT_VAP1_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP1_8812F(x) | BIT_DTIM_COUNT_VAP1_8812F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP2_8812F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP2_8812F 0 -+#define BIT_MASK_DTIM_COUNT_VAP2_8812F 0xff -+#define BIT_DTIM_COUNT_VAP2_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP2_8812F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP2_8812F) -+#define BITS_DTIM_COUNT_VAP2_8812F \ -+ (BIT_MASK_DTIM_COUNT_VAP2_8812F << BIT_SHIFT_DTIM_COUNT_VAP2_8812F) -+#define BIT_CLEAR_DTIM_COUNT_VAP2_8812F(x) ((x) & (~BITS_DTIM_COUNT_VAP2_8812F)) -+#define BIT_GET_DTIM_COUNT_VAP2_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP2_8812F) & \ -+ BIT_MASK_DTIM_COUNT_VAP2_8812F) -+#define BIT_SET_DTIM_COUNT_VAP2_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP2_8812F(x) | BIT_DTIM_COUNT_VAP2_8812F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP3_8812F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP3_8812F 0 -+#define BIT_MASK_DTIM_COUNT_VAP3_8812F 0xff -+#define BIT_DTIM_COUNT_VAP3_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP3_8812F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP3_8812F) -+#define BITS_DTIM_COUNT_VAP3_8812F \ -+ (BIT_MASK_DTIM_COUNT_VAP3_8812F << BIT_SHIFT_DTIM_COUNT_VAP3_8812F) -+#define BIT_CLEAR_DTIM_COUNT_VAP3_8812F(x) ((x) & (~BITS_DTIM_COUNT_VAP3_8812F)) -+#define BIT_GET_DTIM_COUNT_VAP3_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP3_8812F) & \ -+ BIT_MASK_DTIM_COUNT_VAP3_8812F) -+#define BIT_SET_DTIM_COUNT_VAP3_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP3_8812F(x) | BIT_DTIM_COUNT_VAP3_8812F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP4_8812F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP4_8812F 0 -+#define BIT_MASK_DTIM_COUNT_VAP4_8812F 0xff -+#define BIT_DTIM_COUNT_VAP4_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP4_8812F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP4_8812F) -+#define BITS_DTIM_COUNT_VAP4_8812F \ -+ (BIT_MASK_DTIM_COUNT_VAP4_8812F << BIT_SHIFT_DTIM_COUNT_VAP4_8812F) -+#define BIT_CLEAR_DTIM_COUNT_VAP4_8812F(x) ((x) & (~BITS_DTIM_COUNT_VAP4_8812F)) -+#define BIT_GET_DTIM_COUNT_VAP4_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP4_8812F) & \ -+ BIT_MASK_DTIM_COUNT_VAP4_8812F) -+#define BIT_SET_DTIM_COUNT_VAP4_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP4_8812F(x) | BIT_DTIM_COUNT_VAP4_8812F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP5_8812F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP5_8812F 0 -+#define BIT_MASK_DTIM_COUNT_VAP5_8812F 0xff -+#define BIT_DTIM_COUNT_VAP5_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP5_8812F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP5_8812F) -+#define BITS_DTIM_COUNT_VAP5_8812F \ -+ (BIT_MASK_DTIM_COUNT_VAP5_8812F << BIT_SHIFT_DTIM_COUNT_VAP5_8812F) -+#define BIT_CLEAR_DTIM_COUNT_VAP5_8812F(x) ((x) & (~BITS_DTIM_COUNT_VAP5_8812F)) -+#define BIT_GET_DTIM_COUNT_VAP5_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP5_8812F) & \ -+ BIT_MASK_DTIM_COUNT_VAP5_8812F) -+#define BIT_SET_DTIM_COUNT_VAP5_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP5_8812F(x) | BIT_DTIM_COUNT_VAP5_8812F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP6_8812F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP6_8812F 0 -+#define BIT_MASK_DTIM_COUNT_VAP6_8812F 0xff -+#define BIT_DTIM_COUNT_VAP6_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP6_8812F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP6_8812F) -+#define BITS_DTIM_COUNT_VAP6_8812F \ -+ (BIT_MASK_DTIM_COUNT_VAP6_8812F << BIT_SHIFT_DTIM_COUNT_VAP6_8812F) -+#define BIT_CLEAR_DTIM_COUNT_VAP6_8812F(x) ((x) & (~BITS_DTIM_COUNT_VAP6_8812F)) -+#define BIT_GET_DTIM_COUNT_VAP6_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP6_8812F) & \ -+ BIT_MASK_DTIM_COUNT_VAP6_8812F) -+#define BIT_SET_DTIM_COUNT_VAP6_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP6_8812F(x) | BIT_DTIM_COUNT_VAP6_8812F(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP7_8812F */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP7_8812F 0 -+#define BIT_MASK_DTIM_COUNT_VAP7_8812F 0xff -+#define BIT_DTIM_COUNT_VAP7_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP7_8812F) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP7_8812F) -+#define BITS_DTIM_COUNT_VAP7_8812F \ -+ (BIT_MASK_DTIM_COUNT_VAP7_8812F << BIT_SHIFT_DTIM_COUNT_VAP7_8812F) -+#define BIT_CLEAR_DTIM_COUNT_VAP7_8812F(x) ((x) & (~BITS_DTIM_COUNT_VAP7_8812F)) -+#define BIT_GET_DTIM_COUNT_VAP7_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP7_8812F) & \ -+ BIT_MASK_DTIM_COUNT_VAP7_8812F) -+#define BIT_SET_DTIM_COUNT_VAP7_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP7_8812F(x) | BIT_DTIM_COUNT_VAP7_8812F(v)) -+ -+/* 2 REG_DIS_ATIM_8812F */ -+#define BIT_DIS_ATIM_VAP7_8812F BIT(7) -+#define BIT_DIS_ATIM_VAP6_8812F BIT(6) -+#define BIT_DIS_ATIM_VAP5_8812F BIT(5) -+#define BIT_DIS_ATIM_VAP4_8812F BIT(4) -+#define BIT_DIS_ATIM_VAP3_8812F BIT(3) -+#define BIT_DIS_ATIM_VAP2_8812F BIT(2) -+#define BIT_DIS_ATIM_VAP1_8812F BIT(1) -+#define BIT_DIS_ATIM_ROOT_8812F BIT(0) -+ -+/* 2 REG_EARLY_128US_8812F */ -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER1_8812F 3 -+#define BIT_MASK_TSFT_SEL_TIMER1_8812F 0x7 -+#define BIT_TSFT_SEL_TIMER1_8812F(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER1_8812F) \ -+ << BIT_SHIFT_TSFT_SEL_TIMER1_8812F) -+#define BITS_TSFT_SEL_TIMER1_8812F \ -+ (BIT_MASK_TSFT_SEL_TIMER1_8812F << BIT_SHIFT_TSFT_SEL_TIMER1_8812F) -+#define BIT_CLEAR_TSFT_SEL_TIMER1_8812F(x) ((x) & (~BITS_TSFT_SEL_TIMER1_8812F)) -+#define BIT_GET_TSFT_SEL_TIMER1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER1_8812F) & \ -+ BIT_MASK_TSFT_SEL_TIMER1_8812F) -+#define BIT_SET_TSFT_SEL_TIMER1_8812F(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER1_8812F(x) | BIT_TSFT_SEL_TIMER1_8812F(v)) -+ -+#define BIT_SHIFT_EARLY_128US_8812F 0 -+#define BIT_MASK_EARLY_128US_8812F 0x7 -+#define BIT_EARLY_128US_8812F(x) \ -+ (((x) & BIT_MASK_EARLY_128US_8812F) << BIT_SHIFT_EARLY_128US_8812F) -+#define BITS_EARLY_128US_8812F \ -+ (BIT_MASK_EARLY_128US_8812F << BIT_SHIFT_EARLY_128US_8812F) -+#define BIT_CLEAR_EARLY_128US_8812F(x) ((x) & (~BITS_EARLY_128US_8812F)) -+#define BIT_GET_EARLY_128US_8812F(x) \ -+ (((x) >> BIT_SHIFT_EARLY_128US_8812F) & BIT_MASK_EARLY_128US_8812F) -+#define BIT_SET_EARLY_128US_8812F(x, v) \ -+ (BIT_CLEAR_EARLY_128US_8812F(x) | BIT_EARLY_128US_8812F(v)) -+ -+/* 2 REG_P2PPS1_CTRL_8812F */ -+#define BIT_P2P1_CTW_ALLSTASLEEP_8812F BIT(7) -+#define BIT_P2P1_OFF_DISTX_EN_8812F BIT(6) -+#define BIT_P2P1_PWR_MGT_EN_8812F BIT(5) -+#define BIT_P2P1_NOA1_EN_8812F BIT(2) -+#define BIT_P2P1_NOA0_EN_8812F BIT(1) -+ -+/* 2 REG_P2PPS2_CTRL_8812F */ -+#define BIT_P2P2_CTW_ALLSTASLEEP_8812F BIT(7) -+#define BIT_P2P2_OFF_DISTX_EN_8812F BIT(6) -+#define BIT_P2P2_PWR_MGT_EN_8812F BIT(5) -+#define BIT_P2P2_NOA1_EN_8812F BIT(2) -+#define BIT_P2P2_NOA0_EN_8812F BIT(1) -+ -+/* 2 REG_TIMER0_SRC_SEL_8812F */ -+ -+#define BIT_SHIFT_SYNC_CLI_SEL_8812F 4 -+#define BIT_MASK_SYNC_CLI_SEL_8812F 0x7 -+#define BIT_SYNC_CLI_SEL_8812F(x) \ -+ (((x) & BIT_MASK_SYNC_CLI_SEL_8812F) << BIT_SHIFT_SYNC_CLI_SEL_8812F) -+#define BITS_SYNC_CLI_SEL_8812F \ -+ (BIT_MASK_SYNC_CLI_SEL_8812F << BIT_SHIFT_SYNC_CLI_SEL_8812F) -+#define BIT_CLEAR_SYNC_CLI_SEL_8812F(x) ((x) & (~BITS_SYNC_CLI_SEL_8812F)) -+#define BIT_GET_SYNC_CLI_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_SYNC_CLI_SEL_8812F) & BIT_MASK_SYNC_CLI_SEL_8812F) -+#define BIT_SET_SYNC_CLI_SEL_8812F(x, v) \ -+ (BIT_CLEAR_SYNC_CLI_SEL_8812F(x) | BIT_SYNC_CLI_SEL_8812F(v)) -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER0_8812F 0 -+#define BIT_MASK_TSFT_SEL_TIMER0_8812F 0x7 -+#define BIT_TSFT_SEL_TIMER0_8812F(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER0_8812F) \ -+ << BIT_SHIFT_TSFT_SEL_TIMER0_8812F) -+#define BITS_TSFT_SEL_TIMER0_8812F \ -+ (BIT_MASK_TSFT_SEL_TIMER0_8812F << BIT_SHIFT_TSFT_SEL_TIMER0_8812F) -+#define BIT_CLEAR_TSFT_SEL_TIMER0_8812F(x) ((x) & (~BITS_TSFT_SEL_TIMER0_8812F)) -+#define BIT_GET_TSFT_SEL_TIMER0_8812F(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER0_8812F) & \ -+ BIT_MASK_TSFT_SEL_TIMER0_8812F) -+#define BIT_SET_TSFT_SEL_TIMER0_8812F(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER0_8812F(x) | BIT_TSFT_SEL_TIMER0_8812F(v)) -+ -+/* 2 REG_NOA_UNIT_SEL_8812F */ -+ -+#define BIT_SHIFT_NOA_UNIT2_SEL_8812F 8 -+#define BIT_MASK_NOA_UNIT2_SEL_8812F 0x7 -+#define BIT_NOA_UNIT2_SEL_8812F(x) \ -+ (((x) & BIT_MASK_NOA_UNIT2_SEL_8812F) << BIT_SHIFT_NOA_UNIT2_SEL_8812F) -+#define BITS_NOA_UNIT2_SEL_8812F \ -+ (BIT_MASK_NOA_UNIT2_SEL_8812F << BIT_SHIFT_NOA_UNIT2_SEL_8812F) -+#define BIT_CLEAR_NOA_UNIT2_SEL_8812F(x) ((x) & (~BITS_NOA_UNIT2_SEL_8812F)) -+#define BIT_GET_NOA_UNIT2_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT2_SEL_8812F) & BIT_MASK_NOA_UNIT2_SEL_8812F) -+#define BIT_SET_NOA_UNIT2_SEL_8812F(x, v) \ -+ (BIT_CLEAR_NOA_UNIT2_SEL_8812F(x) | BIT_NOA_UNIT2_SEL_8812F(v)) -+ -+#define BIT_SHIFT_NOA_UNIT1_SEL_8812F 4 -+#define BIT_MASK_NOA_UNIT1_SEL_8812F 0x7 -+#define BIT_NOA_UNIT1_SEL_8812F(x) \ -+ (((x) & BIT_MASK_NOA_UNIT1_SEL_8812F) << BIT_SHIFT_NOA_UNIT1_SEL_8812F) -+#define BITS_NOA_UNIT1_SEL_8812F \ -+ (BIT_MASK_NOA_UNIT1_SEL_8812F << BIT_SHIFT_NOA_UNIT1_SEL_8812F) -+#define BIT_CLEAR_NOA_UNIT1_SEL_8812F(x) ((x) & (~BITS_NOA_UNIT1_SEL_8812F)) -+#define BIT_GET_NOA_UNIT1_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT1_SEL_8812F) & BIT_MASK_NOA_UNIT1_SEL_8812F) -+#define BIT_SET_NOA_UNIT1_SEL_8812F(x, v) \ -+ (BIT_CLEAR_NOA_UNIT1_SEL_8812F(x) | BIT_NOA_UNIT1_SEL_8812F(v)) -+ -+#define BIT_SHIFT_NOA_UNIT0_SEL_8812F 0 -+#define BIT_MASK_NOA_UNIT0_SEL_8812F 0x7 -+#define BIT_NOA_UNIT0_SEL_8812F(x) \ -+ (((x) & BIT_MASK_NOA_UNIT0_SEL_8812F) << BIT_SHIFT_NOA_UNIT0_SEL_8812F) -+#define BITS_NOA_UNIT0_SEL_8812F \ -+ (BIT_MASK_NOA_UNIT0_SEL_8812F << BIT_SHIFT_NOA_UNIT0_SEL_8812F) -+#define BIT_CLEAR_NOA_UNIT0_SEL_8812F(x) ((x) & (~BITS_NOA_UNIT0_SEL_8812F)) -+#define BIT_GET_NOA_UNIT0_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT0_SEL_8812F) & BIT_MASK_NOA_UNIT0_SEL_8812F) -+#define BIT_SET_NOA_UNIT0_SEL_8812F(x, v) \ -+ (BIT_CLEAR_NOA_UNIT0_SEL_8812F(x) | BIT_NOA_UNIT0_SEL_8812F(v)) -+ -+/* 2 REG_P2POFF_DIS_TXTIME_8812F */ -+ -+#define BIT_SHIFT_P2POFF_DIS_TXTIME_8812F 0 -+#define BIT_MASK_P2POFF_DIS_TXTIME_8812F 0xff -+#define BIT_P2POFF_DIS_TXTIME_8812F(x) \ -+ (((x) & BIT_MASK_P2POFF_DIS_TXTIME_8812F) \ -+ << BIT_SHIFT_P2POFF_DIS_TXTIME_8812F) -+#define BITS_P2POFF_DIS_TXTIME_8812F \ -+ (BIT_MASK_P2POFF_DIS_TXTIME_8812F << BIT_SHIFT_P2POFF_DIS_TXTIME_8812F) -+#define BIT_CLEAR_P2POFF_DIS_TXTIME_8812F(x) \ -+ ((x) & (~BITS_P2POFF_DIS_TXTIME_8812F)) -+#define BIT_GET_P2POFF_DIS_TXTIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_P2POFF_DIS_TXTIME_8812F) & \ -+ BIT_MASK_P2POFF_DIS_TXTIME_8812F) -+#define BIT_SET_P2POFF_DIS_TXTIME_8812F(x, v) \ -+ (BIT_CLEAR_P2POFF_DIS_TXTIME_8812F(x) | BIT_P2POFF_DIS_TXTIME_8812F(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE2_8812F */ -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT2_8812F 16 -+#define BIT_MASK_BCN_SPACE_CLINT2_8812F 0xfff -+#define BIT_BCN_SPACE_CLINT2_8812F(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT2_8812F) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT2_8812F) -+#define BITS_BCN_SPACE_CLINT2_8812F \ -+ (BIT_MASK_BCN_SPACE_CLINT2_8812F << BIT_SHIFT_BCN_SPACE_CLINT2_8812F) -+#define BIT_CLEAR_BCN_SPACE_CLINT2_8812F(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT2_8812F)) -+#define BIT_GET_BCN_SPACE_CLINT2_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT2_8812F) & \ -+ BIT_MASK_BCN_SPACE_CLINT2_8812F) -+#define BIT_SET_BCN_SPACE_CLINT2_8812F(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT2_8812F(x) | BIT_BCN_SPACE_CLINT2_8812F(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT1_8812F 0 -+#define BIT_MASK_BCN_SPACE_CLINT1_8812F 0xfff -+#define BIT_BCN_SPACE_CLINT1_8812F(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT1_8812F) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT1_8812F) -+#define BITS_BCN_SPACE_CLINT1_8812F \ -+ (BIT_MASK_BCN_SPACE_CLINT1_8812F << BIT_SHIFT_BCN_SPACE_CLINT1_8812F) -+#define BIT_CLEAR_BCN_SPACE_CLINT1_8812F(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT1_8812F)) -+#define BIT_GET_BCN_SPACE_CLINT1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT1_8812F) & \ -+ BIT_MASK_BCN_SPACE_CLINT1_8812F) -+#define BIT_SET_BCN_SPACE_CLINT1_8812F(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT1_8812F(x) | BIT_BCN_SPACE_CLINT1_8812F(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE3_8812F */ -+ -+#define BIT_SHIFT_SUB_BCN_SPACE_8812F 16 -+#define BIT_MASK_SUB_BCN_SPACE_8812F 0xff -+#define BIT_SUB_BCN_SPACE_8812F(x) \ -+ (((x) & BIT_MASK_SUB_BCN_SPACE_8812F) << BIT_SHIFT_SUB_BCN_SPACE_8812F) -+#define BITS_SUB_BCN_SPACE_8812F \ -+ (BIT_MASK_SUB_BCN_SPACE_8812F << BIT_SHIFT_SUB_BCN_SPACE_8812F) -+#define BIT_CLEAR_SUB_BCN_SPACE_8812F(x) ((x) & (~BITS_SUB_BCN_SPACE_8812F)) -+#define BIT_GET_SUB_BCN_SPACE_8812F(x) \ -+ (((x) >> BIT_SHIFT_SUB_BCN_SPACE_8812F) & BIT_MASK_SUB_BCN_SPACE_8812F) -+#define BIT_SET_SUB_BCN_SPACE_8812F(x, v) \ -+ (BIT_CLEAR_SUB_BCN_SPACE_8812F(x) | BIT_SUB_BCN_SPACE_8812F(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT3_8812F 0 -+#define BIT_MASK_BCN_SPACE_CLINT3_8812F 0xfff -+#define BIT_BCN_SPACE_CLINT3_8812F(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT3_8812F) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT3_8812F) -+#define BITS_BCN_SPACE_CLINT3_8812F \ -+ (BIT_MASK_BCN_SPACE_CLINT3_8812F << BIT_SHIFT_BCN_SPACE_CLINT3_8812F) -+#define BIT_CLEAR_BCN_SPACE_CLINT3_8812F(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT3_8812F)) -+#define BIT_GET_BCN_SPACE_CLINT3_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT3_8812F) & \ -+ BIT_MASK_BCN_SPACE_CLINT3_8812F) -+#define BIT_SET_BCN_SPACE_CLINT3_8812F(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT3_8812F(x) | BIT_BCN_SPACE_CLINT3_8812F(v)) -+ -+/* 2 REG_ACMHWCTRL_8812F */ -+#define BIT_BEQ_ACM_STATUS_8812F BIT(7) -+#define BIT_VIQ_ACM_STATUS_8812F BIT(6) -+#define BIT_VOQ_ACM_STATUS_8812F BIT(5) -+#define BIT_BEQ_ACM_EN_8812F BIT(3) -+#define BIT_VIQ_ACM_EN_8812F BIT(2) -+#define BIT_VOQ_ACM_EN_8812F BIT(1) -+#define BIT_ACMHWEN_8812F BIT(0) -+ -+/* 2 REG_ACMRSTCTRL_8812F */ -+#define BIT_BE_ACM_RESET_USED_TIME_8812F BIT(2) -+#define BIT_VI_ACM_RESET_USED_TIME_8812F BIT(1) -+#define BIT_VO_ACM_RESET_USED_TIME_8812F BIT(0) -+ -+/* 2 REG_ACMAVG_8812F */ -+ -+#define BIT_SHIFT_AVGPERIOD_8812F 0 -+#define BIT_MASK_AVGPERIOD_8812F 0xffff -+#define BIT_AVGPERIOD_8812F(x) \ -+ (((x) & BIT_MASK_AVGPERIOD_8812F) << BIT_SHIFT_AVGPERIOD_8812F) -+#define BITS_AVGPERIOD_8812F \ -+ (BIT_MASK_AVGPERIOD_8812F << BIT_SHIFT_AVGPERIOD_8812F) -+#define BIT_CLEAR_AVGPERIOD_8812F(x) ((x) & (~BITS_AVGPERIOD_8812F)) -+#define BIT_GET_AVGPERIOD_8812F(x) \ -+ (((x) >> BIT_SHIFT_AVGPERIOD_8812F) & BIT_MASK_AVGPERIOD_8812F) -+#define BIT_SET_AVGPERIOD_8812F(x, v) \ -+ (BIT_CLEAR_AVGPERIOD_8812F(x) | BIT_AVGPERIOD_8812F(v)) -+ -+/* 2 REG_VO_ADMTIME_8812F */ -+ -+#define BIT_SHIFT_VO_ADMITTED_TIME_8812F 0 -+#define BIT_MASK_VO_ADMITTED_TIME_8812F 0xffff -+#define BIT_VO_ADMITTED_TIME_8812F(x) \ -+ (((x) & BIT_MASK_VO_ADMITTED_TIME_8812F) \ -+ << BIT_SHIFT_VO_ADMITTED_TIME_8812F) -+#define BITS_VO_ADMITTED_TIME_8812F \ -+ (BIT_MASK_VO_ADMITTED_TIME_8812F << BIT_SHIFT_VO_ADMITTED_TIME_8812F) -+#define BIT_CLEAR_VO_ADMITTED_TIME_8812F(x) \ -+ ((x) & (~BITS_VO_ADMITTED_TIME_8812F)) -+#define BIT_GET_VO_ADMITTED_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_VO_ADMITTED_TIME_8812F) & \ -+ BIT_MASK_VO_ADMITTED_TIME_8812F) -+#define BIT_SET_VO_ADMITTED_TIME_8812F(x, v) \ -+ (BIT_CLEAR_VO_ADMITTED_TIME_8812F(x) | BIT_VO_ADMITTED_TIME_8812F(v)) -+ -+/* 2 REG_VI_ADMTIME_8812F */ -+ -+#define BIT_SHIFT_VI_ADMITTED_TIME_8812F 0 -+#define BIT_MASK_VI_ADMITTED_TIME_8812F 0xffff -+#define BIT_VI_ADMITTED_TIME_8812F(x) \ -+ (((x) & BIT_MASK_VI_ADMITTED_TIME_8812F) \ -+ << BIT_SHIFT_VI_ADMITTED_TIME_8812F) -+#define BITS_VI_ADMITTED_TIME_8812F \ -+ (BIT_MASK_VI_ADMITTED_TIME_8812F << BIT_SHIFT_VI_ADMITTED_TIME_8812F) -+#define BIT_CLEAR_VI_ADMITTED_TIME_8812F(x) \ -+ ((x) & (~BITS_VI_ADMITTED_TIME_8812F)) -+#define BIT_GET_VI_ADMITTED_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_VI_ADMITTED_TIME_8812F) & \ -+ BIT_MASK_VI_ADMITTED_TIME_8812F) -+#define BIT_SET_VI_ADMITTED_TIME_8812F(x, v) \ -+ (BIT_CLEAR_VI_ADMITTED_TIME_8812F(x) | BIT_VI_ADMITTED_TIME_8812F(v)) -+ -+/* 2 REG_BE_ADMTIME_8812F */ -+ -+#define BIT_SHIFT_BE_ADMITTED_TIME_8812F 0 -+#define BIT_MASK_BE_ADMITTED_TIME_8812F 0xffff -+#define BIT_BE_ADMITTED_TIME_8812F(x) \ -+ (((x) & BIT_MASK_BE_ADMITTED_TIME_8812F) \ -+ << BIT_SHIFT_BE_ADMITTED_TIME_8812F) -+#define BITS_BE_ADMITTED_TIME_8812F \ -+ (BIT_MASK_BE_ADMITTED_TIME_8812F << BIT_SHIFT_BE_ADMITTED_TIME_8812F) -+#define BIT_CLEAR_BE_ADMITTED_TIME_8812F(x) \ -+ ((x) & (~BITS_BE_ADMITTED_TIME_8812F)) -+#define BIT_GET_BE_ADMITTED_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_BE_ADMITTED_TIME_8812F) & \ -+ BIT_MASK_BE_ADMITTED_TIME_8812F) -+#define BIT_SET_BE_ADMITTED_TIME_8812F(x, v) \ -+ (BIT_CLEAR_BE_ADMITTED_TIME_8812F(x) | BIT_BE_ADMITTED_TIME_8812F(v)) -+ -+/* 2 REG_MAC_HEADER_NAV_OFFSET_8812F */ -+ -+#define BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8812F 0 -+#define BIT_MASK_MAC_HEADER_NAV_OFFSET_8812F 0xff -+#define BIT_MAC_HEADER_NAV_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_MAC_HEADER_NAV_OFFSET_8812F) \ -+ << BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8812F) -+#define BITS_MAC_HEADER_NAV_OFFSET_8812F \ -+ (BIT_MASK_MAC_HEADER_NAV_OFFSET_8812F \ -+ << BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8812F) -+#define BIT_CLEAR_MAC_HEADER_NAV_OFFSET_8812F(x) \ -+ ((x) & (~BITS_MAC_HEADER_NAV_OFFSET_8812F)) -+#define BIT_GET_MAC_HEADER_NAV_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8812F) & \ -+ BIT_MASK_MAC_HEADER_NAV_OFFSET_8812F) -+#define BIT_SET_MAC_HEADER_NAV_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_MAC_HEADER_NAV_OFFSET_8812F(x) | \ -+ BIT_MAC_HEADER_NAV_OFFSET_8812F(v)) -+ -+/* 2 REG_DIS_NDPA_NAV_CHECK_8812F */ -+#define BIT_CHG_POWER_BCN_AREA_V1_8812F BIT(1) -+#define BIT_DIS_NDPA_NAV_CHECK_8812F BIT(0) -+ -+/* 2 REG_EDCA_RANDOM_GEN_8812F */ -+ -+#define BIT_SHIFT_RANDOM_GEN_8812F 0 -+#define BIT_MASK_RANDOM_GEN_8812F 0xffffff -+#define BIT_RANDOM_GEN_8812F(x) \ -+ (((x) & BIT_MASK_RANDOM_GEN_8812F) << BIT_SHIFT_RANDOM_GEN_8812F) -+#define BITS_RANDOM_GEN_8812F \ -+ (BIT_MASK_RANDOM_GEN_8812F << BIT_SHIFT_RANDOM_GEN_8812F) -+#define BIT_CLEAR_RANDOM_GEN_8812F(x) ((x) & (~BITS_RANDOM_GEN_8812F)) -+#define BIT_GET_RANDOM_GEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_RANDOM_GEN_8812F) & BIT_MASK_RANDOM_GEN_8812F) -+#define BIT_SET_RANDOM_GEN_8812F(x, v) \ -+ (BIT_CLEAR_RANDOM_GEN_8812F(x) | BIT_RANDOM_GEN_8812F(v)) -+ -+/* 2 REG_TXCMD_NOA_SEL_8812F */ -+ -+#define BIT_SHIFT_NOA_SEL_V2_8812F 4 -+#define BIT_MASK_NOA_SEL_V2_8812F 0x7 -+#define BIT_NOA_SEL_V2_8812F(x) \ -+ (((x) & BIT_MASK_NOA_SEL_V2_8812F) << BIT_SHIFT_NOA_SEL_V2_8812F) -+#define BITS_NOA_SEL_V2_8812F \ -+ (BIT_MASK_NOA_SEL_V2_8812F << BIT_SHIFT_NOA_SEL_V2_8812F) -+#define BIT_CLEAR_NOA_SEL_V2_8812F(x) ((x) & (~BITS_NOA_SEL_V2_8812F)) -+#define BIT_GET_NOA_SEL_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_NOA_SEL_V2_8812F) & BIT_MASK_NOA_SEL_V2_8812F) -+#define BIT_SET_NOA_SEL_V2_8812F(x, v) \ -+ (BIT_CLEAR_NOA_SEL_V2_8812F(x) | BIT_NOA_SEL_V2_8812F(v)) -+ -+#define BIT_SHIFT_TXCMD_SEG_SEL_8812F 0 -+#define BIT_MASK_TXCMD_SEG_SEL_8812F 0xf -+#define BIT_TXCMD_SEG_SEL_8812F(x) \ -+ (((x) & BIT_MASK_TXCMD_SEG_SEL_8812F) << BIT_SHIFT_TXCMD_SEG_SEL_8812F) -+#define BITS_TXCMD_SEG_SEL_8812F \ -+ (BIT_MASK_TXCMD_SEG_SEL_8812F << BIT_SHIFT_TXCMD_SEG_SEL_8812F) -+#define BIT_CLEAR_TXCMD_SEG_SEL_8812F(x) ((x) & (~BITS_TXCMD_SEG_SEL_8812F)) -+#define BIT_GET_TXCMD_SEG_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_SEG_SEL_8812F) & BIT_MASK_TXCMD_SEG_SEL_8812F) -+#define BIT_SET_TXCMD_SEG_SEL_8812F(x, v) \ -+ (BIT_CLEAR_TXCMD_SEG_SEL_8812F(x) | BIT_TXCMD_SEG_SEL_8812F(v)) -+ -+/* 2 REG_32K_CLK_SEL_8812F */ -+#define BIT_R_BCNERR_CNT_EN_8812F BIT(20) -+ -+#define BIT_SHIFT_R_BCNERR_PORT_SEL_8812F 16 -+#define BIT_MASK_R_BCNERR_PORT_SEL_8812F 0x7 -+#define BIT_R_BCNERR_PORT_SEL_8812F(x) \ -+ (((x) & BIT_MASK_R_BCNERR_PORT_SEL_8812F) \ -+ << BIT_SHIFT_R_BCNERR_PORT_SEL_8812F) -+#define BITS_R_BCNERR_PORT_SEL_8812F \ -+ (BIT_MASK_R_BCNERR_PORT_SEL_8812F << BIT_SHIFT_R_BCNERR_PORT_SEL_8812F) -+#define BIT_CLEAR_R_BCNERR_PORT_SEL_8812F(x) \ -+ ((x) & (~BITS_R_BCNERR_PORT_SEL_8812F)) -+#define BIT_GET_R_BCNERR_PORT_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_BCNERR_PORT_SEL_8812F) & \ -+ BIT_MASK_R_BCNERR_PORT_SEL_8812F) -+#define BIT_SET_R_BCNERR_PORT_SEL_8812F(x, v) \ -+ (BIT_CLEAR_R_BCNERR_PORT_SEL_8812F(x) | BIT_R_BCNERR_PORT_SEL_8812F(v)) -+ -+#define BIT_SHIFT_R_TXPAUSE1_8812F 8 -+#define BIT_MASK_R_TXPAUSE1_8812F 0xff -+#define BIT_R_TXPAUSE1_8812F(x) \ -+ (((x) & BIT_MASK_R_TXPAUSE1_8812F) << BIT_SHIFT_R_TXPAUSE1_8812F) -+#define BITS_R_TXPAUSE1_8812F \ -+ (BIT_MASK_R_TXPAUSE1_8812F << BIT_SHIFT_R_TXPAUSE1_8812F) -+#define BIT_CLEAR_R_TXPAUSE1_8812F(x) ((x) & (~BITS_R_TXPAUSE1_8812F)) -+#define BIT_GET_R_TXPAUSE1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_TXPAUSE1_8812F) & BIT_MASK_R_TXPAUSE1_8812F) -+#define BIT_SET_R_TXPAUSE1_8812F(x, v) \ -+ (BIT_CLEAR_R_TXPAUSE1_8812F(x) | BIT_R_TXPAUSE1_8812F(v)) -+ -+#define BIT_SLEEP_32K_EN_V1_8812F BIT(2) -+ -+#define BIT_SHIFT_BW_CFG_8812F 0 -+#define BIT_MASK_BW_CFG_8812F 0x3 -+#define BIT_BW_CFG_8812F(x) \ -+ (((x) & BIT_MASK_BW_CFG_8812F) << BIT_SHIFT_BW_CFG_8812F) -+#define BITS_BW_CFG_8812F (BIT_MASK_BW_CFG_8812F << BIT_SHIFT_BW_CFG_8812F) -+#define BIT_CLEAR_BW_CFG_8812F(x) ((x) & (~BITS_BW_CFG_8812F)) -+#define BIT_GET_BW_CFG_8812F(x) \ -+ (((x) >> BIT_SHIFT_BW_CFG_8812F) & BIT_MASK_BW_CFG_8812F) -+#define BIT_SET_BW_CFG_8812F(x, v) \ -+ (BIT_CLEAR_BW_CFG_8812F(x) | BIT_BW_CFG_8812F(v)) -+ -+/* 2 REG_EARLYINT_ADJUST_8812F */ -+ -+#define BIT_SHIFT_RXBCN_TIMER_8812F 16 -+#define BIT_MASK_RXBCN_TIMER_8812F 0xffff -+#define BIT_RXBCN_TIMER_8812F(x) \ -+ (((x) & BIT_MASK_RXBCN_TIMER_8812F) << BIT_SHIFT_RXBCN_TIMER_8812F) -+#define BITS_RXBCN_TIMER_8812F \ -+ (BIT_MASK_RXBCN_TIMER_8812F << BIT_SHIFT_RXBCN_TIMER_8812F) -+#define BIT_CLEAR_RXBCN_TIMER_8812F(x) ((x) & (~BITS_RXBCN_TIMER_8812F)) -+#define BIT_GET_RXBCN_TIMER_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXBCN_TIMER_8812F) & BIT_MASK_RXBCN_TIMER_8812F) -+#define BIT_SET_RXBCN_TIMER_8812F(x, v) \ -+ (BIT_CLEAR_RXBCN_TIMER_8812F(x) | BIT_RXBCN_TIMER_8812F(v)) -+ -+#define BIT_SHIFT_R_ERLYINTADJ_8812F 0 -+#define BIT_MASK_R_ERLYINTADJ_8812F 0xffff -+#define BIT_R_ERLYINTADJ_8812F(x) \ -+ (((x) & BIT_MASK_R_ERLYINTADJ_8812F) << BIT_SHIFT_R_ERLYINTADJ_8812F) -+#define BITS_R_ERLYINTADJ_8812F \ -+ (BIT_MASK_R_ERLYINTADJ_8812F << BIT_SHIFT_R_ERLYINTADJ_8812F) -+#define BIT_CLEAR_R_ERLYINTADJ_8812F(x) ((x) & (~BITS_R_ERLYINTADJ_8812F)) -+#define BIT_GET_R_ERLYINTADJ_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_ERLYINTADJ_8812F) & BIT_MASK_R_ERLYINTADJ_8812F) -+#define BIT_SET_R_ERLYINTADJ_8812F(x, v) \ -+ (BIT_CLEAR_R_ERLYINTADJ_8812F(x) | BIT_R_ERLYINTADJ_8812F(v)) -+ -+/* 2 REG_BCNERR_CNT_8812F */ -+ -+#define BIT_SHIFT_BCNERR_CNT_OTHERS_8812F 24 -+#define BIT_MASK_BCNERR_CNT_OTHERS_8812F 0xff -+#define BIT_BCNERR_CNT_OTHERS_8812F(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_OTHERS_8812F) \ -+ << BIT_SHIFT_BCNERR_CNT_OTHERS_8812F) -+#define BITS_BCNERR_CNT_OTHERS_8812F \ -+ (BIT_MASK_BCNERR_CNT_OTHERS_8812F << BIT_SHIFT_BCNERR_CNT_OTHERS_8812F) -+#define BIT_CLEAR_BCNERR_CNT_OTHERS_8812F(x) \ -+ ((x) & (~BITS_BCNERR_CNT_OTHERS_8812F)) -+#define BIT_GET_BCNERR_CNT_OTHERS_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_OTHERS_8812F) & \ -+ BIT_MASK_BCNERR_CNT_OTHERS_8812F) -+#define BIT_SET_BCNERR_CNT_OTHERS_8812F(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_OTHERS_8812F(x) | BIT_BCNERR_CNT_OTHERS_8812F(v)) -+ -+#define BIT_SHIFT_BCNERR_CNT_INVALID_8812F 16 -+#define BIT_MASK_BCNERR_CNT_INVALID_8812F 0xff -+#define BIT_BCNERR_CNT_INVALID_8812F(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_INVALID_8812F) \ -+ << BIT_SHIFT_BCNERR_CNT_INVALID_8812F) -+#define BITS_BCNERR_CNT_INVALID_8812F \ -+ (BIT_MASK_BCNERR_CNT_INVALID_8812F \ -+ << BIT_SHIFT_BCNERR_CNT_INVALID_8812F) -+#define BIT_CLEAR_BCNERR_CNT_INVALID_8812F(x) \ -+ ((x) & (~BITS_BCNERR_CNT_INVALID_8812F)) -+#define BIT_GET_BCNERR_CNT_INVALID_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_INVALID_8812F) & \ -+ BIT_MASK_BCNERR_CNT_INVALID_8812F) -+#define BIT_SET_BCNERR_CNT_INVALID_8812F(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_INVALID_8812F(x) | \ -+ BIT_BCNERR_CNT_INVALID_8812F(v)) -+ -+#define BIT_SHIFT_BCNERR_CNT_MAC_8812F 8 -+#define BIT_MASK_BCNERR_CNT_MAC_8812F 0xff -+#define BIT_BCNERR_CNT_MAC_8812F(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_MAC_8812F) \ -+ << BIT_SHIFT_BCNERR_CNT_MAC_8812F) -+#define BITS_BCNERR_CNT_MAC_8812F \ -+ (BIT_MASK_BCNERR_CNT_MAC_8812F << BIT_SHIFT_BCNERR_CNT_MAC_8812F) -+#define BIT_CLEAR_BCNERR_CNT_MAC_8812F(x) ((x) & (~BITS_BCNERR_CNT_MAC_8812F)) -+#define BIT_GET_BCNERR_CNT_MAC_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_MAC_8812F) & \ -+ BIT_MASK_BCNERR_CNT_MAC_8812F) -+#define BIT_SET_BCNERR_CNT_MAC_8812F(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_MAC_8812F(x) | BIT_BCNERR_CNT_MAC_8812F(v)) -+ -+#define BIT_SHIFT_BCNERR_CNT_CCA_8812F 0 -+#define BIT_MASK_BCNERR_CNT_CCA_8812F 0xff -+#define BIT_BCNERR_CNT_CCA_8812F(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_CCA_8812F) \ -+ << BIT_SHIFT_BCNERR_CNT_CCA_8812F) -+#define BITS_BCNERR_CNT_CCA_8812F \ -+ (BIT_MASK_BCNERR_CNT_CCA_8812F << BIT_SHIFT_BCNERR_CNT_CCA_8812F) -+#define BIT_CLEAR_BCNERR_CNT_CCA_8812F(x) ((x) & (~BITS_BCNERR_CNT_CCA_8812F)) -+#define BIT_GET_BCNERR_CNT_CCA_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_CCA_8812F) & \ -+ BIT_MASK_BCNERR_CNT_CCA_8812F) -+#define BIT_SET_BCNERR_CNT_CCA_8812F(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_CCA_8812F(x) | BIT_BCNERR_CNT_CCA_8812F(v)) -+ -+/* 2 REG_BCNERR_CNT_2_8812F */ -+ -+#define BIT_SHIFT_BCNERR_CNT_EDCCA_8812F 0 -+#define BIT_MASK_BCNERR_CNT_EDCCA_8812F 0xff -+#define BIT_BCNERR_CNT_EDCCA_8812F(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_EDCCA_8812F) \ -+ << BIT_SHIFT_BCNERR_CNT_EDCCA_8812F) -+#define BITS_BCNERR_CNT_EDCCA_8812F \ -+ (BIT_MASK_BCNERR_CNT_EDCCA_8812F << BIT_SHIFT_BCNERR_CNT_EDCCA_8812F) -+#define BIT_CLEAR_BCNERR_CNT_EDCCA_8812F(x) \ -+ ((x) & (~BITS_BCNERR_CNT_EDCCA_8812F)) -+#define BIT_GET_BCNERR_CNT_EDCCA_8812F(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_EDCCA_8812F) & \ -+ BIT_MASK_BCNERR_CNT_EDCCA_8812F) -+#define BIT_SET_BCNERR_CNT_EDCCA_8812F(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_EDCCA_8812F(x) | BIT_BCNERR_CNT_EDCCA_8812F(v)) -+ -+/* 2 REG_NOA_PARAM_8812F */ -+ -+#define BIT_SHIFT_NOA_DURATION_V1_8812F 0 -+#define BIT_MASK_NOA_DURATION_V1_8812F 0xffffffffL -+#define BIT_NOA_DURATION_V1_8812F(x) \ -+ (((x) & BIT_MASK_NOA_DURATION_V1_8812F) \ -+ << BIT_SHIFT_NOA_DURATION_V1_8812F) -+#define BITS_NOA_DURATION_V1_8812F \ -+ (BIT_MASK_NOA_DURATION_V1_8812F << BIT_SHIFT_NOA_DURATION_V1_8812F) -+#define BIT_CLEAR_NOA_DURATION_V1_8812F(x) ((x) & (~BITS_NOA_DURATION_V1_8812F)) -+#define BIT_GET_NOA_DURATION_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_NOA_DURATION_V1_8812F) & \ -+ BIT_MASK_NOA_DURATION_V1_8812F) -+#define BIT_SET_NOA_DURATION_V1_8812F(x, v) \ -+ (BIT_CLEAR_NOA_DURATION_V1_8812F(x) | BIT_NOA_DURATION_V1_8812F(v)) -+ -+/* 2 REG_NOA_PARAM_1_8812F */ -+ -+#define BIT_SHIFT_NOA_INTERVAL_V1_8812F 0 -+#define BIT_MASK_NOA_INTERVAL_V1_8812F 0xffffffffL -+#define BIT_NOA_INTERVAL_V1_8812F(x) \ -+ (((x) & BIT_MASK_NOA_INTERVAL_V1_8812F) \ -+ << BIT_SHIFT_NOA_INTERVAL_V1_8812F) -+#define BITS_NOA_INTERVAL_V1_8812F \ -+ (BIT_MASK_NOA_INTERVAL_V1_8812F << BIT_SHIFT_NOA_INTERVAL_V1_8812F) -+#define BIT_CLEAR_NOA_INTERVAL_V1_8812F(x) ((x) & (~BITS_NOA_INTERVAL_V1_8812F)) -+#define BIT_GET_NOA_INTERVAL_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_NOA_INTERVAL_V1_8812F) & \ -+ BIT_MASK_NOA_INTERVAL_V1_8812F) -+#define BIT_SET_NOA_INTERVAL_V1_8812F(x, v) \ -+ (BIT_CLEAR_NOA_INTERVAL_V1_8812F(x) | BIT_NOA_INTERVAL_V1_8812F(v)) -+ -+/* 2 REG_NOA_PARAM_2_8812F */ -+ -+#define BIT_SHIFT_NOA_START_TIME_V1_8812F 0 -+#define BIT_MASK_NOA_START_TIME_V1_8812F 0xffffffffL -+#define BIT_NOA_START_TIME_V1_8812F(x) \ -+ (((x) & BIT_MASK_NOA_START_TIME_V1_8812F) \ -+ << BIT_SHIFT_NOA_START_TIME_V1_8812F) -+#define BITS_NOA_START_TIME_V1_8812F \ -+ (BIT_MASK_NOA_START_TIME_V1_8812F << BIT_SHIFT_NOA_START_TIME_V1_8812F) -+#define BIT_CLEAR_NOA_START_TIME_V1_8812F(x) \ -+ ((x) & (~BITS_NOA_START_TIME_V1_8812F)) -+#define BIT_GET_NOA_START_TIME_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_NOA_START_TIME_V1_8812F) & \ -+ BIT_MASK_NOA_START_TIME_V1_8812F) -+#define BIT_SET_NOA_START_TIME_V1_8812F(x, v) \ -+ (BIT_CLEAR_NOA_START_TIME_V1_8812F(x) | BIT_NOA_START_TIME_V1_8812F(v)) -+ -+/* 2 REG_NOA_PARAM_3_8812F */ -+ -+#define BIT_SHIFT_NOA_COUNT_V1_8812F 0 -+#define BIT_MASK_NOA_COUNT_V1_8812F 0xffffffffL -+#define BIT_NOA_COUNT_V1_8812F(x) \ -+ (((x) & BIT_MASK_NOA_COUNT_V1_8812F) << BIT_SHIFT_NOA_COUNT_V1_8812F) -+#define BITS_NOA_COUNT_V1_8812F \ -+ (BIT_MASK_NOA_COUNT_V1_8812F << BIT_SHIFT_NOA_COUNT_V1_8812F) -+#define BIT_CLEAR_NOA_COUNT_V1_8812F(x) ((x) & (~BITS_NOA_COUNT_V1_8812F)) -+#define BIT_GET_NOA_COUNT_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_NOA_COUNT_V1_8812F) & BIT_MASK_NOA_COUNT_V1_8812F) -+#define BIT_SET_NOA_COUNT_V1_8812F(x, v) \ -+ (BIT_CLEAR_NOA_COUNT_V1_8812F(x) | BIT_NOA_COUNT_V1_8812F(v)) -+ -+/* 2 REG_P2P_RST_8812F */ -+#define BIT_P2P2_PWR_RST1_8812F BIT(5) -+#define BIT_P2P2_PWR_RST0_8812F BIT(4) -+#define BIT_P2P1_PWR_RST1_8812F BIT(3) -+#define BIT_P2P1_PWR_RST0_8812F BIT(2) -+#define BIT_P2P_PWR_RST1_V1_8812F BIT(1) -+#define BIT_P2P_PWR_RST0_V1_8812F BIT(0) -+ -+/* 2 REG_SCHEDULER_RST_8812F */ -+#define BIT_SYNC_CLI_ONCE_RIGHT_NOW_8812F BIT(2) -+#define BIT_SYNC_CLI_ONCE_BY_TBTT_8812F BIT(1) -+#define BIT_SCHEDULER_RST_V1_8812F BIT(0) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_SCH_DBG_VALUE_8812F */ -+ -+#define BIT_SHIFT_SCH_DBG_VALUE_8812F 0 -+#define BIT_MASK_SCH_DBG_VALUE_8812F 0xffffffffL -+#define BIT_SCH_DBG_VALUE_8812F(x) \ -+ (((x) & BIT_MASK_SCH_DBG_VALUE_8812F) << BIT_SHIFT_SCH_DBG_VALUE_8812F) -+#define BITS_SCH_DBG_VALUE_8812F \ -+ (BIT_MASK_SCH_DBG_VALUE_8812F << BIT_SHIFT_SCH_DBG_VALUE_8812F) -+#define BIT_CLEAR_SCH_DBG_VALUE_8812F(x) ((x) & (~BITS_SCH_DBG_VALUE_8812F)) -+#define BIT_GET_SCH_DBG_VALUE_8812F(x) \ -+ (((x) >> BIT_SHIFT_SCH_DBG_VALUE_8812F) & BIT_MASK_SCH_DBG_VALUE_8812F) -+#define BIT_SET_SCH_DBG_VALUE_8812F(x, v) \ -+ (BIT_CLEAR_SCH_DBG_VALUE_8812F(x) | BIT_SCH_DBG_VALUE_8812F(v)) -+ -+/* 2 REG_SCH_TXCMD_8812F */ -+ -+#define BIT_SHIFT_SCH_TXCMD_8812F 0 -+#define BIT_MASK_SCH_TXCMD_8812F 0xffffffffL -+#define BIT_SCH_TXCMD_8812F(x) \ -+ (((x) & BIT_MASK_SCH_TXCMD_8812F) << BIT_SHIFT_SCH_TXCMD_8812F) -+#define BITS_SCH_TXCMD_8812F \ -+ (BIT_MASK_SCH_TXCMD_8812F << BIT_SHIFT_SCH_TXCMD_8812F) -+#define BIT_CLEAR_SCH_TXCMD_8812F(x) ((x) & (~BITS_SCH_TXCMD_8812F)) -+#define BIT_GET_SCH_TXCMD_8812F(x) \ -+ (((x) >> BIT_SHIFT_SCH_TXCMD_8812F) & BIT_MASK_SCH_TXCMD_8812F) -+#define BIT_SET_SCH_TXCMD_8812F(x, v) \ -+ (BIT_CLEAR_SCH_TXCMD_8812F(x) | BIT_SCH_TXCMD_8812F(v)) -+ -+/* 2 REG_PAGE5_DUMMY_8812F */ -+ -+/* 2 REG_CPUMGQ_TX_TIMER_8812F */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8812F 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_V1_8812F 0xffffffffL -+#define BIT_CPUMGQ_TX_TIMER_V1_8812F(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_V1_8812F) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8812F) -+#define BITS_CPUMGQ_TX_TIMER_V1_8812F \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_V1_8812F \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8812F) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8812F(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_V1_8812F)) -+#define BIT_GET_CPUMGQ_TX_TIMER_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8812F) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_V1_8812F) -+#define BIT_SET_CPUMGQ_TX_TIMER_V1_8812F(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8812F(x) | \ -+ BIT_CPUMGQ_TX_TIMER_V1_8812F(v)) -+ -+/* 2 REG_PS_TIMER_A_8812F */ -+ -+#define BIT_SHIFT_PS_TIMER_A_V1_8812F 0 -+#define BIT_MASK_PS_TIMER_A_V1_8812F 0xffffffffL -+#define BIT_PS_TIMER_A_V1_8812F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_V1_8812F) << BIT_SHIFT_PS_TIMER_A_V1_8812F) -+#define BITS_PS_TIMER_A_V1_8812F \ -+ (BIT_MASK_PS_TIMER_A_V1_8812F << BIT_SHIFT_PS_TIMER_A_V1_8812F) -+#define BIT_CLEAR_PS_TIMER_A_V1_8812F(x) ((x) & (~BITS_PS_TIMER_A_V1_8812F)) -+#define BIT_GET_PS_TIMER_A_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_V1_8812F) & BIT_MASK_PS_TIMER_A_V1_8812F) -+#define BIT_SET_PS_TIMER_A_V1_8812F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_V1_8812F(x) | BIT_PS_TIMER_A_V1_8812F(v)) -+ -+/* 2 REG_PS_TIMER_B_8812F */ -+ -+#define BIT_SHIFT_PS_TIMER_B_V1_8812F 0 -+#define BIT_MASK_PS_TIMER_B_V1_8812F 0xffffffffL -+#define BIT_PS_TIMER_B_V1_8812F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_V1_8812F) << BIT_SHIFT_PS_TIMER_B_V1_8812F) -+#define BITS_PS_TIMER_B_V1_8812F \ -+ (BIT_MASK_PS_TIMER_B_V1_8812F << BIT_SHIFT_PS_TIMER_B_V1_8812F) -+#define BIT_CLEAR_PS_TIMER_B_V1_8812F(x) ((x) & (~BITS_PS_TIMER_B_V1_8812F)) -+#define BIT_GET_PS_TIMER_B_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_V1_8812F) & BIT_MASK_PS_TIMER_B_V1_8812F) -+#define BIT_SET_PS_TIMER_B_V1_8812F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_V1_8812F(x) | BIT_PS_TIMER_B_V1_8812F(v)) -+ -+/* 2 REG_PS_TIMER_C_8812F */ -+ -+#define BIT_SHIFT_PS_TIMER_C_V1_8812F 0 -+#define BIT_MASK_PS_TIMER_C_V1_8812F 0xffffffffL -+#define BIT_PS_TIMER_C_V1_8812F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_V1_8812F) << BIT_SHIFT_PS_TIMER_C_V1_8812F) -+#define BITS_PS_TIMER_C_V1_8812F \ -+ (BIT_MASK_PS_TIMER_C_V1_8812F << BIT_SHIFT_PS_TIMER_C_V1_8812F) -+#define BIT_CLEAR_PS_TIMER_C_V1_8812F(x) ((x) & (~BITS_PS_TIMER_C_V1_8812F)) -+#define BIT_GET_PS_TIMER_C_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_V1_8812F) & BIT_MASK_PS_TIMER_C_V1_8812F) -+#define BIT_SET_PS_TIMER_C_V1_8812F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_V1_8812F(x) | BIT_PS_TIMER_C_V1_8812F(v)) -+ -+/* 2 REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL_8812F */ -+#define BIT_CPUMGQ_TIMER_EN_8812F BIT(31) -+#define BIT_CPUMGQ_TX_EN_8812F BIT(28) -+ -+#define BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8812F 24 -+#define BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8812F 0x7 -+#define BIT_CPUMGQ_TIMER_TSF_SEL_8812F(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8812F) \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8812F) -+#define BITS_CPUMGQ_TIMER_TSF_SEL_8812F \ -+ (BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8812F \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8812F) -+#define BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_8812F(x) \ -+ ((x) & (~BITS_CPUMGQ_TIMER_TSF_SEL_8812F)) -+#define BIT_GET_CPUMGQ_TIMER_TSF_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8812F) & \ -+ BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8812F) -+#define BIT_SET_CPUMGQ_TIMER_TSF_SEL_8812F(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_8812F(x) | \ -+ BIT_CPUMGQ_TIMER_TSF_SEL_8812F(v)) -+ -+#define BIT_PS_TIMER_C_EN_8812F BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_C_TSF_SEL_8812F 16 -+#define BIT_MASK_PS_TIMER_C_TSF_SEL_8812F 0x7 -+#define BIT_PS_TIMER_C_TSF_SEL_8812F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_TSF_SEL_8812F) \ -+ << BIT_SHIFT_PS_TIMER_C_TSF_SEL_8812F) -+#define BITS_PS_TIMER_C_TSF_SEL_8812F \ -+ (BIT_MASK_PS_TIMER_C_TSF_SEL_8812F \ -+ << BIT_SHIFT_PS_TIMER_C_TSF_SEL_8812F) -+#define BIT_CLEAR_PS_TIMER_C_TSF_SEL_8812F(x) \ -+ ((x) & (~BITS_PS_TIMER_C_TSF_SEL_8812F)) -+#define BIT_GET_PS_TIMER_C_TSF_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_TSF_SEL_8812F) & \ -+ BIT_MASK_PS_TIMER_C_TSF_SEL_8812F) -+#define BIT_SET_PS_TIMER_C_TSF_SEL_8812F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_TSF_SEL_8812F(x) | \ -+ BIT_PS_TIMER_C_TSF_SEL_8812F(v)) -+ -+#define BIT_PS_TIMER_B_EN_8812F BIT(15) -+ -+#define BIT_SHIFT_PS_TIMER_B_TSF_SEL_8812F 8 -+#define BIT_MASK_PS_TIMER_B_TSF_SEL_8812F 0x7 -+#define BIT_PS_TIMER_B_TSF_SEL_8812F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_TSF_SEL_8812F) \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_8812F) -+#define BITS_PS_TIMER_B_TSF_SEL_8812F \ -+ (BIT_MASK_PS_TIMER_B_TSF_SEL_8812F \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_8812F) -+#define BIT_CLEAR_PS_TIMER_B_TSF_SEL_8812F(x) \ -+ ((x) & (~BITS_PS_TIMER_B_TSF_SEL_8812F)) -+#define BIT_GET_PS_TIMER_B_TSF_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_TSF_SEL_8812F) & \ -+ BIT_MASK_PS_TIMER_B_TSF_SEL_8812F) -+#define BIT_SET_PS_TIMER_B_TSF_SEL_8812F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_TSF_SEL_8812F(x) | \ -+ BIT_PS_TIMER_B_TSF_SEL_8812F(v)) -+ -+#define BIT_PS_TIMER_A_EN_8812F BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_A_TSF_SEL_8812F 0 -+#define BIT_MASK_PS_TIMER_A_TSF_SEL_8812F 0x7 -+#define BIT_PS_TIMER_A_TSF_SEL_8812F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_TSF_SEL_8812F) \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_8812F) -+#define BITS_PS_TIMER_A_TSF_SEL_8812F \ -+ (BIT_MASK_PS_TIMER_A_TSF_SEL_8812F \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_8812F) -+#define BIT_CLEAR_PS_TIMER_A_TSF_SEL_8812F(x) \ -+ ((x) & (~BITS_PS_TIMER_A_TSF_SEL_8812F)) -+#define BIT_GET_PS_TIMER_A_TSF_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_TSF_SEL_8812F) & \ -+ BIT_MASK_PS_TIMER_A_TSF_SEL_8812F) -+#define BIT_SET_PS_TIMER_A_TSF_SEL_8812F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_TSF_SEL_8812F(x) | \ -+ BIT_PS_TIMER_A_TSF_SEL_8812F(v)) -+ -+/* 2 REG_CPUMGQ_TX_TIMER_EARLY_8812F */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8812F 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8812F 0xff -+#define BIT_CPUMGQ_TX_TIMER_EARLY_8812F(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8812F) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8812F) -+#define BITS_CPUMGQ_TX_TIMER_EARLY_8812F \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8812F \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8812F) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_8812F(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_EARLY_8812F)) -+#define BIT_GET_CPUMGQ_TX_TIMER_EARLY_8812F(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8812F) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8812F) -+#define BIT_SET_CPUMGQ_TX_TIMER_EARLY_8812F(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_8812F(x) | \ -+ BIT_CPUMGQ_TX_TIMER_EARLY_8812F(v)) -+ -+/* 2 REG_PS_TIMER_A_EARLY_8812F */ -+ -+#define BIT_SHIFT_PS_TIMER_A_EARLY_8812F 0 -+#define BIT_MASK_PS_TIMER_A_EARLY_8812F 0xff -+#define BIT_PS_TIMER_A_EARLY_8812F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_EARLY_8812F) \ -+ << BIT_SHIFT_PS_TIMER_A_EARLY_8812F) -+#define BITS_PS_TIMER_A_EARLY_8812F \ -+ (BIT_MASK_PS_TIMER_A_EARLY_8812F << BIT_SHIFT_PS_TIMER_A_EARLY_8812F) -+#define BIT_CLEAR_PS_TIMER_A_EARLY_8812F(x) \ -+ ((x) & (~BITS_PS_TIMER_A_EARLY_8812F)) -+#define BIT_GET_PS_TIMER_A_EARLY_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_EARLY_8812F) & \ -+ BIT_MASK_PS_TIMER_A_EARLY_8812F) -+#define BIT_SET_PS_TIMER_A_EARLY_8812F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_EARLY_8812F(x) | BIT_PS_TIMER_A_EARLY_8812F(v)) -+ -+/* 2 REG_PS_TIMER_B_EARLY_8812F */ -+ -+#define BIT_SHIFT_PS_TIMER_B_EARLY_8812F 0 -+#define BIT_MASK_PS_TIMER_B_EARLY_8812F 0xff -+#define BIT_PS_TIMER_B_EARLY_8812F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_EARLY_8812F) \ -+ << BIT_SHIFT_PS_TIMER_B_EARLY_8812F) -+#define BITS_PS_TIMER_B_EARLY_8812F \ -+ (BIT_MASK_PS_TIMER_B_EARLY_8812F << BIT_SHIFT_PS_TIMER_B_EARLY_8812F) -+#define BIT_CLEAR_PS_TIMER_B_EARLY_8812F(x) \ -+ ((x) & (~BITS_PS_TIMER_B_EARLY_8812F)) -+#define BIT_GET_PS_TIMER_B_EARLY_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_EARLY_8812F) & \ -+ BIT_MASK_PS_TIMER_B_EARLY_8812F) -+#define BIT_SET_PS_TIMER_B_EARLY_8812F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_EARLY_8812F(x) | BIT_PS_TIMER_B_EARLY_8812F(v)) -+ -+/* 2 REG_PS_TIMER_C_EARLY_8812F */ -+ -+#define BIT_SHIFT_PS_TIMER_C_EARLY_8812F 0 -+#define BIT_MASK_PS_TIMER_C_EARLY_8812F 0xff -+#define BIT_PS_TIMER_C_EARLY_8812F(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_EARLY_8812F) \ -+ << BIT_SHIFT_PS_TIMER_C_EARLY_8812F) -+#define BITS_PS_TIMER_C_EARLY_8812F \ -+ (BIT_MASK_PS_TIMER_C_EARLY_8812F << BIT_SHIFT_PS_TIMER_C_EARLY_8812F) -+#define BIT_CLEAR_PS_TIMER_C_EARLY_8812F(x) \ -+ ((x) & (~BITS_PS_TIMER_C_EARLY_8812F)) -+#define BIT_GET_PS_TIMER_C_EARLY_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_EARLY_8812F) & \ -+ BIT_MASK_PS_TIMER_C_EARLY_8812F) -+#define BIT_SET_PS_TIMER_C_EARLY_8812F(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_EARLY_8812F(x) | BIT_PS_TIMER_C_EARLY_8812F(v)) -+ -+/* 2 REG_CPUMGQ_PARAMETER_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+#define BIT_MAC_STOP_CPUMGQ_8812F BIT(16) -+ -+#define BIT_SHIFT_CW_8812F 8 -+#define BIT_MASK_CW_8812F 0xff -+#define BIT_CW_8812F(x) (((x) & BIT_MASK_CW_8812F) << BIT_SHIFT_CW_8812F) -+#define BITS_CW_8812F (BIT_MASK_CW_8812F << BIT_SHIFT_CW_8812F) -+#define BIT_CLEAR_CW_8812F(x) ((x) & (~BITS_CW_8812F)) -+#define BIT_GET_CW_8812F(x) (((x) >> BIT_SHIFT_CW_8812F) & BIT_MASK_CW_8812F) -+#define BIT_SET_CW_8812F(x, v) (BIT_CLEAR_CW_8812F(x) | BIT_CW_8812F(v)) -+ -+#define BIT_SHIFT_AIFS_8812F 0 -+#define BIT_MASK_AIFS_8812F 0xff -+#define BIT_AIFS_8812F(x) (((x) & BIT_MASK_AIFS_8812F) << BIT_SHIFT_AIFS_8812F) -+#define BITS_AIFS_8812F (BIT_MASK_AIFS_8812F << BIT_SHIFT_AIFS_8812F) -+#define BIT_CLEAR_AIFS_8812F(x) ((x) & (~BITS_AIFS_8812F)) -+#define BIT_GET_AIFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8812F) & BIT_MASK_AIFS_8812F) -+#define BIT_SET_AIFS_8812F(x, v) (BIT_CLEAR_AIFS_8812F(x) | BIT_AIFS_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_TSF_SYNC_ADJ_8812F */ -+ -+#define BIT_SHIFT_R_P0_TSFT_ADJ_VAL_8812F 16 -+#define BIT_MASK_R_P0_TSFT_ADJ_VAL_8812F 0xffff -+#define BIT_R_P0_TSFT_ADJ_VAL_8812F(x) \ -+ (((x) & BIT_MASK_R_P0_TSFT_ADJ_VAL_8812F) \ -+ << BIT_SHIFT_R_P0_TSFT_ADJ_VAL_8812F) -+#define BITS_R_P0_TSFT_ADJ_VAL_8812F \ -+ (BIT_MASK_R_P0_TSFT_ADJ_VAL_8812F << BIT_SHIFT_R_P0_TSFT_ADJ_VAL_8812F) -+#define BIT_CLEAR_R_P0_TSFT_ADJ_VAL_8812F(x) \ -+ ((x) & (~BITS_R_P0_TSFT_ADJ_VAL_8812F)) -+#define BIT_GET_R_P0_TSFT_ADJ_VAL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_P0_TSFT_ADJ_VAL_8812F) & \ -+ BIT_MASK_R_P0_TSFT_ADJ_VAL_8812F) -+#define BIT_SET_R_P0_TSFT_ADJ_VAL_8812F(x, v) \ -+ (BIT_CLEAR_R_P0_TSFT_ADJ_VAL_8812F(x) | BIT_R_P0_TSFT_ADJ_VAL_8812F(v)) -+ -+#define BIT_R_X_COMP_Y_OVER_8812F BIT(8) -+ -+#define BIT_SHIFT_R_X_SYNC_SEL_8812F 3 -+#define BIT_MASK_R_X_SYNC_SEL_8812F 0x7 -+#define BIT_R_X_SYNC_SEL_8812F(x) \ -+ (((x) & BIT_MASK_R_X_SYNC_SEL_8812F) << BIT_SHIFT_R_X_SYNC_SEL_8812F) -+#define BITS_R_X_SYNC_SEL_8812F \ -+ (BIT_MASK_R_X_SYNC_SEL_8812F << BIT_SHIFT_R_X_SYNC_SEL_8812F) -+#define BIT_CLEAR_R_X_SYNC_SEL_8812F(x) ((x) & (~BITS_R_X_SYNC_SEL_8812F)) -+#define BIT_GET_R_X_SYNC_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_X_SYNC_SEL_8812F) & BIT_MASK_R_X_SYNC_SEL_8812F) -+#define BIT_SET_R_X_SYNC_SEL_8812F(x, v) \ -+ (BIT_CLEAR_R_X_SYNC_SEL_8812F(x) | BIT_R_X_SYNC_SEL_8812F(v)) -+ -+#define BIT_SHIFT_R_SYNC_Y_SEL_8812F 0 -+#define BIT_MASK_R_SYNC_Y_SEL_8812F 0x7 -+#define BIT_R_SYNC_Y_SEL_8812F(x) \ -+ (((x) & BIT_MASK_R_SYNC_Y_SEL_8812F) << BIT_SHIFT_R_SYNC_Y_SEL_8812F) -+#define BITS_R_SYNC_Y_SEL_8812F \ -+ (BIT_MASK_R_SYNC_Y_SEL_8812F << BIT_SHIFT_R_SYNC_Y_SEL_8812F) -+#define BIT_CLEAR_R_SYNC_Y_SEL_8812F(x) ((x) & (~BITS_R_SYNC_Y_SEL_8812F)) -+#define BIT_GET_R_SYNC_Y_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_SYNC_Y_SEL_8812F) & BIT_MASK_R_SYNC_Y_SEL_8812F) -+#define BIT_SET_R_SYNC_Y_SEL_8812F(x, v) \ -+ (BIT_CLEAR_R_SYNC_Y_SEL_8812F(x) | BIT_R_SYNC_Y_SEL_8812F(v)) -+ -+/* 2 REG_TSF_ADJ_VLAUE_8812F */ -+ -+#define BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL_8812F 16 -+#define BIT_MASK_R_CLI1_TSFT_ADJ_VAL_8812F 0xffff -+#define BIT_R_CLI1_TSFT_ADJ_VAL_8812F(x) \ -+ (((x) & BIT_MASK_R_CLI1_TSFT_ADJ_VAL_8812F) \ -+ << BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL_8812F) -+#define BITS_R_CLI1_TSFT_ADJ_VAL_8812F \ -+ (BIT_MASK_R_CLI1_TSFT_ADJ_VAL_8812F \ -+ << BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL_8812F) -+#define BIT_CLEAR_R_CLI1_TSFT_ADJ_VAL_8812F(x) \ -+ ((x) & (~BITS_R_CLI1_TSFT_ADJ_VAL_8812F)) -+#define BIT_GET_R_CLI1_TSFT_ADJ_VAL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL_8812F) & \ -+ BIT_MASK_R_CLI1_TSFT_ADJ_VAL_8812F) -+#define BIT_SET_R_CLI1_TSFT_ADJ_VAL_8812F(x, v) \ -+ (BIT_CLEAR_R_CLI1_TSFT_ADJ_VAL_8812F(x) | \ -+ BIT_R_CLI1_TSFT_ADJ_VAL_8812F(v)) -+ -+#define BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL_8812F 0 -+#define BIT_MASK_R_CLI0_TSFT_ADJ_VAL_8812F 0xffff -+#define BIT_R_CLI0_TSFT_ADJ_VAL_8812F(x) \ -+ (((x) & BIT_MASK_R_CLI0_TSFT_ADJ_VAL_8812F) \ -+ << BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL_8812F) -+#define BITS_R_CLI0_TSFT_ADJ_VAL_8812F \ -+ (BIT_MASK_R_CLI0_TSFT_ADJ_VAL_8812F \ -+ << BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL_8812F) -+#define BIT_CLEAR_R_CLI0_TSFT_ADJ_VAL_8812F(x) \ -+ ((x) & (~BITS_R_CLI0_TSFT_ADJ_VAL_8812F)) -+#define BIT_GET_R_CLI0_TSFT_ADJ_VAL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL_8812F) & \ -+ BIT_MASK_R_CLI0_TSFT_ADJ_VAL_8812F) -+#define BIT_SET_R_CLI0_TSFT_ADJ_VAL_8812F(x, v) \ -+ (BIT_CLEAR_R_CLI0_TSFT_ADJ_VAL_8812F(x) | \ -+ BIT_R_CLI0_TSFT_ADJ_VAL_8812F(v)) -+ -+/* 2 REG_TSF_ADJ_VLAUE_2_8812F */ -+ -+#define BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL_8812F 16 -+#define BIT_MASK_R_CLI3_TSFT_ADJ_VAL_8812F 0xffff -+#define BIT_R_CLI3_TSFT_ADJ_VAL_8812F(x) \ -+ (((x) & BIT_MASK_R_CLI3_TSFT_ADJ_VAL_8812F) \ -+ << BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL_8812F) -+#define BITS_R_CLI3_TSFT_ADJ_VAL_8812F \ -+ (BIT_MASK_R_CLI3_TSFT_ADJ_VAL_8812F \ -+ << BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL_8812F) -+#define BIT_CLEAR_R_CLI3_TSFT_ADJ_VAL_8812F(x) \ -+ ((x) & (~BITS_R_CLI3_TSFT_ADJ_VAL_8812F)) -+#define BIT_GET_R_CLI3_TSFT_ADJ_VAL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL_8812F) & \ -+ BIT_MASK_R_CLI3_TSFT_ADJ_VAL_8812F) -+#define BIT_SET_R_CLI3_TSFT_ADJ_VAL_8812F(x, v) \ -+ (BIT_CLEAR_R_CLI3_TSFT_ADJ_VAL_8812F(x) | \ -+ BIT_R_CLI3_TSFT_ADJ_VAL_8812F(v)) -+ -+#define BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL_8812F 0 -+#define BIT_MASK_R_CLI2_TSFT_ADJ_VAL_8812F 0xffff -+#define BIT_R_CLI2_TSFT_ADJ_VAL_8812F(x) \ -+ (((x) & BIT_MASK_R_CLI2_TSFT_ADJ_VAL_8812F) \ -+ << BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL_8812F) -+#define BITS_R_CLI2_TSFT_ADJ_VAL_8812F \ -+ (BIT_MASK_R_CLI2_TSFT_ADJ_VAL_8812F \ -+ << BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL_8812F) -+#define BIT_CLEAR_R_CLI2_TSFT_ADJ_VAL_8812F(x) \ -+ ((x) & (~BITS_R_CLI2_TSFT_ADJ_VAL_8812F)) -+#define BIT_GET_R_CLI2_TSFT_ADJ_VAL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL_8812F) & \ -+ BIT_MASK_R_CLI2_TSFT_ADJ_VAL_8812F) -+#define BIT_SET_R_CLI2_TSFT_ADJ_VAL_8812F(x, v) \ -+ (BIT_CLEAR_R_CLI2_TSFT_ADJ_VAL_8812F(x) | \ -+ BIT_R_CLI2_TSFT_ADJ_VAL_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_P2PPS_HW_AUTO_PAUSE_CTRL_8812F */ -+#define BIT_P2PPS_NOA_STOP_TX_HANG_8812F BIT(31) -+#define BIT_P2PPS_MACID_PAUSE_EN_8812F BIT(11) -+#define BIT_P2PPS__MGQ_PAUSE_8812F BIT(10) -+#define BIT_P2PPS__HIQ_PAUSE_8812F BIT(9) -+#define BIT_P2PPS__BCNQ_PAUSE_8812F BIT(8) -+ -+#define BIT_SHIFT_P2PPS_MACID_PAUSE_8812F 0 -+#define BIT_MASK_P2PPS_MACID_PAUSE_8812F 0xff -+#define BIT_P2PPS_MACID_PAUSE_8812F(x) \ -+ (((x) & BIT_MASK_P2PPS_MACID_PAUSE_8812F) \ -+ << BIT_SHIFT_P2PPS_MACID_PAUSE_8812F) -+#define BITS_P2PPS_MACID_PAUSE_8812F \ -+ (BIT_MASK_P2PPS_MACID_PAUSE_8812F << BIT_SHIFT_P2PPS_MACID_PAUSE_8812F) -+#define BIT_CLEAR_P2PPS_MACID_PAUSE_8812F(x) \ -+ ((x) & (~BITS_P2PPS_MACID_PAUSE_8812F)) -+#define BIT_GET_P2PPS_MACID_PAUSE_8812F(x) \ -+ (((x) >> BIT_SHIFT_P2PPS_MACID_PAUSE_8812F) & \ -+ BIT_MASK_P2PPS_MACID_PAUSE_8812F) -+#define BIT_SET_P2PPS_MACID_PAUSE_8812F(x, v) \ -+ (BIT_CLEAR_P2PPS_MACID_PAUSE_8812F(x) | BIT_P2PPS_MACID_PAUSE_8812F(v)) -+ -+/* 2 REG_P2PPS1_HW_AUTO_PAUSE_CTRL_8812F */ -+#define BIT_P2PPS1_NOA_STOP_TX_HANG_8812F BIT(31) -+#define BIT_P2PPS1_MACID_PAUSE_EN_8812F BIT(11) -+#define BIT_P2PPS1__MGQ_PAUSE_8812F BIT(10) -+#define BIT_P2PPS1__HIQ_PAUSE_8812F BIT(9) -+#define BIT_P2PPS1__BCNQ_PAUSE_8812F BIT(8) -+ -+#define BIT_SHIFT_P2PPS1_MACID_PAUSE_8812F 0 -+#define BIT_MASK_P2PPS1_MACID_PAUSE_8812F 0xff -+#define BIT_P2PPS1_MACID_PAUSE_8812F(x) \ -+ (((x) & BIT_MASK_P2PPS1_MACID_PAUSE_8812F) \ -+ << BIT_SHIFT_P2PPS1_MACID_PAUSE_8812F) -+#define BITS_P2PPS1_MACID_PAUSE_8812F \ -+ (BIT_MASK_P2PPS1_MACID_PAUSE_8812F \ -+ << BIT_SHIFT_P2PPS1_MACID_PAUSE_8812F) -+#define BIT_CLEAR_P2PPS1_MACID_PAUSE_8812F(x) \ -+ ((x) & (~BITS_P2PPS1_MACID_PAUSE_8812F)) -+#define BIT_GET_P2PPS1_MACID_PAUSE_8812F(x) \ -+ (((x) >> BIT_SHIFT_P2PPS1_MACID_PAUSE_8812F) & \ -+ BIT_MASK_P2PPS1_MACID_PAUSE_8812F) -+#define BIT_SET_P2PPS1_MACID_PAUSE_8812F(x, v) \ -+ (BIT_CLEAR_P2PPS1_MACID_PAUSE_8812F(x) | \ -+ BIT_P2PPS1_MACID_PAUSE_8812F(v)) -+ -+/* 2 REG_P2PPS2_HW_AUTO_PAUSE_CTRL_8812F */ -+#define BIT_P2PPS2_NOA_STOP_TX_HANG_8812F BIT(31) -+#define BIT_P2PPS2_MACID_PAUSE_EN_8812F BIT(11) -+#define BIT_P2PPS2__MGQ_PAUSE_8812F BIT(10) -+#define BIT_P2PPS2__HIQ_PAUSE_8812F BIT(9) -+#define BIT_P2PPS2__BCNQ_PAUSE_8812F BIT(8) -+ -+#define BIT_SHIFT_P2PPS2_MACID_PAUSE_8812F 0 -+#define BIT_MASK_P2PPS2_MACID_PAUSE_8812F 0xff -+#define BIT_P2PPS2_MACID_PAUSE_8812F(x) \ -+ (((x) & BIT_MASK_P2PPS2_MACID_PAUSE_8812F) \ -+ << BIT_SHIFT_P2PPS2_MACID_PAUSE_8812F) -+#define BITS_P2PPS2_MACID_PAUSE_8812F \ -+ (BIT_MASK_P2PPS2_MACID_PAUSE_8812F \ -+ << BIT_SHIFT_P2PPS2_MACID_PAUSE_8812F) -+#define BIT_CLEAR_P2PPS2_MACID_PAUSE_8812F(x) \ -+ ((x) & (~BITS_P2PPS2_MACID_PAUSE_8812F)) -+#define BIT_GET_P2PPS2_MACID_PAUSE_8812F(x) \ -+ (((x) >> BIT_SHIFT_P2PPS2_MACID_PAUSE_8812F) & \ -+ BIT_MASK_P2PPS2_MACID_PAUSE_8812F) -+#define BIT_SET_P2PPS2_MACID_PAUSE_8812F(x, v) \ -+ (BIT_CLEAR_P2PPS2_MACID_PAUSE_8812F(x) | \ -+ BIT_P2PPS2_MACID_PAUSE_8812F(v)) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_WMAC_CR_8812F (WMAC CR AND APSD CONTROL REGISTER) */ -+#define BIT_IC_MACPHY_M_8812F BIT(0) -+ -+/* 2 REG_WMAC_FWPKT_CR_8812F */ -+#define BIT_FWEN_8812F BIT(7) -+#define BIT_PHYSTS_PKT_CTRL_8812F BIT(6) -+#define BIT_APPHDR_MIDSRCH_FAIL_8812F BIT(4) -+#define BIT_FWPARSING_EN_8812F BIT(3) -+ -+#define BIT_SHIFT_APPEND_MHDR_LEN_8812F 0 -+#define BIT_MASK_APPEND_MHDR_LEN_8812F 0x7 -+#define BIT_APPEND_MHDR_LEN_8812F(x) \ -+ (((x) & BIT_MASK_APPEND_MHDR_LEN_8812F) \ -+ << BIT_SHIFT_APPEND_MHDR_LEN_8812F) -+#define BITS_APPEND_MHDR_LEN_8812F \ -+ (BIT_MASK_APPEND_MHDR_LEN_8812F << BIT_SHIFT_APPEND_MHDR_LEN_8812F) -+#define BIT_CLEAR_APPEND_MHDR_LEN_8812F(x) ((x) & (~BITS_APPEND_MHDR_LEN_8812F)) -+#define BIT_GET_APPEND_MHDR_LEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_APPEND_MHDR_LEN_8812F) & \ -+ BIT_MASK_APPEND_MHDR_LEN_8812F) -+#define BIT_SET_APPEND_MHDR_LEN_8812F(x, v) \ -+ (BIT_CLEAR_APPEND_MHDR_LEN_8812F(x) | BIT_APPEND_MHDR_LEN_8812F(v)) -+ -+/* 2 REG_FW_STS_FILTER_8812F */ -+#define BIT_DATA_FW_STS_FILTER_8812F BIT(2) -+#define BIT_CTRL_FW_STS_FILTER_8812F BIT(1) -+#define BIT_MGNT_FW_STS_FILTER_8812F BIT(0) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_TCR_8812F (TRANSMISSION CONFIGURATION REGISTER) */ -+#define BIT_WMAC_EN_RTS_ADDR_8812F BIT(31) -+#define BIT_WMAC_DISABLE_CCK_8812F BIT(30) -+#define BIT_WMAC_RAW_LEN_8812F BIT(29) -+#define BIT_WMAC_NOTX_IN_RXNDP_8812F BIT(28) -+#define BIT_WMAC_EN_EOF_8812F BIT(27) -+#define BIT_WMAC_BF_SEL_8812F BIT(26) -+#define BIT_WMAC_ANTMODE_SEL_8812F BIT(25) -+#define BIT_WMAC_TCRPWRMGT_HWCTL_8812F BIT(24) -+#define BIT_WMAC_SMOOTH_VAL_8812F BIT(23) -+#define BIT_WMAC_EN_SCRAM_INC_8812F BIT(22) -+#define BIT_UNDERFLOWEN_CMPLEN_SEL_8812F BIT(21) -+#define BIT_FETCH_MPDU_AFTER_WSEC_RDY_8812F BIT(20) -+#define BIT_WMAC_TCR_EN_20MST_8812F BIT(19) -+#define BIT_WMAC_DIS_SIGTA_8812F BIT(18) -+#define BIT_WMAC_DIS_A2B0_8812F BIT(17) -+#define BIT_WMAC_MSK_SIGBCRC_8812F BIT(16) -+#define BIT_WMAC_TCR_ERRSTEN_3_8812F BIT(15) -+#define BIT_WMAC_TCR_ERRSTEN_2_8812F BIT(14) -+#define BIT_WMAC_TCR_ERRSTEN_1_8812F BIT(13) -+#define BIT_WMAC_TCR_ERRSTEN_0_8812F BIT(12) -+#define BIT_WMAC_TCR_TXSK_PERPKT_8812F BIT(11) -+#define BIT_ICV_8812F BIT(10) -+#define BIT_CFEND_FORMAT_8812F BIT(9) -+#define BIT_CRC_8812F BIT(8) -+#define BIT_WMAC_TCRPWRMGT_HWDATA_EN_8812F BIT(7) -+#define BIT_PWR_ST_8812F BIT(6) -+#define BIT_WMAC_TCR_UPD_TIMIE_8812F BIT(5) -+#define BIT_WMAC_TCR_UPD_HGQMD_8812F BIT(4) -+#define BIT_VHTSIGA1_TXPS_8812F BIT(3) -+#define BIT_PAD_SEL_8812F BIT(2) -+#define BIT_DIS_GCLK_8812F BIT(1) -+#define BIT_WMAC_TCRPWRMGT_HWACT_EN_8812F BIT(0) -+ -+/* 2 REG_RCR_8812F (RECEIVE CONFIGURATION REGISTER) */ -+#define BIT_APP_FCS_8812F BIT(31) -+#define BIT_APP_MIC_8812F BIT(30) -+#define BIT_APP_ICV_8812F BIT(29) -+#define BIT_APP_PHYSTS_8812F BIT(28) -+#define BIT_APP_BASSN_8812F BIT(27) -+#define BIT_VHT_DACK_8812F BIT(26) -+#define BIT_TCPOFLD_EN_8812F BIT(25) -+#define BIT_ENMBID_8812F BIT(24) -+#define BIT_LSIGEN_8812F BIT(23) -+#define BIT_MFBEN_8812F BIT(22) -+#define BIT_DISCHKPPDLLEN_8812F BIT(21) -+#define BIT_PKTCTL_DLEN_8812F BIT(20) -+#define BIT_DISGCLK_8812F BIT(19) -+#define BIT_TIM_PARSER_EN_8812F BIT(18) -+#define BIT_BC_MD_EN_8812F BIT(17) -+#define BIT_UC_MD_EN_8812F BIT(16) -+#define BIT_RXSK_PERPKT_8812F BIT(15) -+#define BIT_HTC_LOC_CTRL_8812F BIT(14) -+#define BIT_ACK_WITH_CBSSID_DATA_OPTION_8812F BIT(13) -+#define BIT_RPFM_CAM_ENABLE_8812F BIT(12) -+#define BIT_TA_BCN_8812F BIT(11) -+#define BIT_DISDECMYPKT_8812F BIT(10) -+#define BIT_AICV_8812F BIT(9) -+#define BIT_ACRC32_8812F BIT(8) -+#define BIT_CBSSID_BCN_8812F BIT(7) -+#define BIT_CBSSID_DATA_8812F BIT(6) -+#define BIT_APWRMGT_8812F BIT(5) -+#define BIT_ADD3_8812F BIT(4) -+#define BIT_AB_8812F BIT(3) -+#define BIT_AM_8812F BIT(2) -+#define BIT_APM_8812F BIT(1) -+#define BIT_AAP_8812F BIT(0) -+ -+/* 2 REG_RX_PKT_LIMIT_8812F (RX PACKET LENGTH LIMIT REGISTER) */ -+ -+#define BIT_SHIFT_RXPKTLMT_8812F 0 -+#define BIT_MASK_RXPKTLMT_8812F 0x3f -+#define BIT_RXPKTLMT_8812F(x) \ -+ (((x) & BIT_MASK_RXPKTLMT_8812F) << BIT_SHIFT_RXPKTLMT_8812F) -+#define BITS_RXPKTLMT_8812F \ -+ (BIT_MASK_RXPKTLMT_8812F << BIT_SHIFT_RXPKTLMT_8812F) -+#define BIT_CLEAR_RXPKTLMT_8812F(x) ((x) & (~BITS_RXPKTLMT_8812F)) -+#define BIT_GET_RXPKTLMT_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXPKTLMT_8812F) & BIT_MASK_RXPKTLMT_8812F) -+#define BIT_SET_RXPKTLMT_8812F(x, v) \ -+ (BIT_CLEAR_RXPKTLMT_8812F(x) | BIT_RXPKTLMT_8812F(v)) -+ -+/* 2 REG_RX_DLK_TIME_8812F (RX DEADLOCK TIME REGISTER) */ -+ -+#define BIT_SHIFT_RX_DLK_TIME_8812F 0 -+#define BIT_MASK_RX_DLK_TIME_8812F 0xff -+#define BIT_RX_DLK_TIME_8812F(x) \ -+ (((x) & BIT_MASK_RX_DLK_TIME_8812F) << BIT_SHIFT_RX_DLK_TIME_8812F) -+#define BITS_RX_DLK_TIME_8812F \ -+ (BIT_MASK_RX_DLK_TIME_8812F << BIT_SHIFT_RX_DLK_TIME_8812F) -+#define BIT_CLEAR_RX_DLK_TIME_8812F(x) ((x) & (~BITS_RX_DLK_TIME_8812F)) -+#define BIT_GET_RX_DLK_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_DLK_TIME_8812F) & BIT_MASK_RX_DLK_TIME_8812F) -+#define BIT_SET_RX_DLK_TIME_8812F(x, v) \ -+ (BIT_CLEAR_RX_DLK_TIME_8812F(x) | BIT_RX_DLK_TIME_8812F(v)) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RX_DRVINFO_SZ_8812F (RX DRIVER INFO SIZE REGISTER) */ -+#define BIT_PHYSTS_PER_PKT_MODE_8812F BIT(7) -+ -+#define BIT_SHIFT_DRVINFO_SZ_V1_8812F 0 -+#define BIT_MASK_DRVINFO_SZ_V1_8812F 0xf -+#define BIT_DRVINFO_SZ_V1_8812F(x) \ -+ (((x) & BIT_MASK_DRVINFO_SZ_V1_8812F) << BIT_SHIFT_DRVINFO_SZ_V1_8812F) -+#define BITS_DRVINFO_SZ_V1_8812F \ -+ (BIT_MASK_DRVINFO_SZ_V1_8812F << BIT_SHIFT_DRVINFO_SZ_V1_8812F) -+#define BIT_CLEAR_DRVINFO_SZ_V1_8812F(x) ((x) & (~BITS_DRVINFO_SZ_V1_8812F)) -+#define BIT_GET_DRVINFO_SZ_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DRVINFO_SZ_V1_8812F) & BIT_MASK_DRVINFO_SZ_V1_8812F) -+#define BIT_SET_DRVINFO_SZ_V1_8812F(x, v) \ -+ (BIT_CLEAR_DRVINFO_SZ_V1_8812F(x) | BIT_DRVINFO_SZ_V1_8812F(v)) -+ -+/* 2 REG_MACID_8812F (MAC ID REGISTER) */ -+ -+#define BIT_SHIFT_MACID_V1_8812F 0 -+#define BIT_MASK_MACID_V1_8812F 0xffffffffL -+#define BIT_MACID_V1_8812F(x) \ -+ (((x) & BIT_MASK_MACID_V1_8812F) << BIT_SHIFT_MACID_V1_8812F) -+#define BITS_MACID_V1_8812F \ -+ (BIT_MASK_MACID_V1_8812F << BIT_SHIFT_MACID_V1_8812F) -+#define BIT_CLEAR_MACID_V1_8812F(x) ((x) & (~BITS_MACID_V1_8812F)) -+#define BIT_GET_MACID_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID_V1_8812F) & BIT_MASK_MACID_V1_8812F) -+#define BIT_SET_MACID_V1_8812F(x, v) \ -+ (BIT_CLEAR_MACID_V1_8812F(x) | BIT_MACID_V1_8812F(v)) -+ -+/* 2 REG_MACID_H_8812F (MAC ID REGISTER) */ -+ -+#define BIT_SHIFT_MACID_H_V1_8812F 0 -+#define BIT_MASK_MACID_H_V1_8812F 0xffff -+#define BIT_MACID_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_MACID_H_V1_8812F) << BIT_SHIFT_MACID_H_V1_8812F) -+#define BITS_MACID_H_V1_8812F \ -+ (BIT_MASK_MACID_H_V1_8812F << BIT_SHIFT_MACID_H_V1_8812F) -+#define BIT_CLEAR_MACID_H_V1_8812F(x) ((x) & (~BITS_MACID_H_V1_8812F)) -+#define BIT_GET_MACID_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID_H_V1_8812F) & BIT_MASK_MACID_H_V1_8812F) -+#define BIT_SET_MACID_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_MACID_H_V1_8812F(x) | BIT_MACID_H_V1_8812F(v)) -+ -+/* 2 REG_BSSID_8812F (BSSID REGISTER) */ -+ -+#define BIT_SHIFT_BSSID_V1_8812F 0 -+#define BIT_MASK_BSSID_V1_8812F 0xffffffffL -+#define BIT_BSSID_V1_8812F(x) \ -+ (((x) & BIT_MASK_BSSID_V1_8812F) << BIT_SHIFT_BSSID_V1_8812F) -+#define BITS_BSSID_V1_8812F \ -+ (BIT_MASK_BSSID_V1_8812F << BIT_SHIFT_BSSID_V1_8812F) -+#define BIT_CLEAR_BSSID_V1_8812F(x) ((x) & (~BITS_BSSID_V1_8812F)) -+#define BIT_GET_BSSID_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID_V1_8812F) & BIT_MASK_BSSID_V1_8812F) -+#define BIT_SET_BSSID_V1_8812F(x, v) \ -+ (BIT_CLEAR_BSSID_V1_8812F(x) | BIT_BSSID_V1_8812F(v)) -+ -+/* 2 REG_BSSID_H_8812F (BSSID REGISTER) */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+#define BIT_SHIFT_BSSID_H_V1_8812F 0 -+#define BIT_MASK_BSSID_H_V1_8812F 0xffff -+#define BIT_BSSID_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_BSSID_H_V1_8812F) << BIT_SHIFT_BSSID_H_V1_8812F) -+#define BITS_BSSID_H_V1_8812F \ -+ (BIT_MASK_BSSID_H_V1_8812F << BIT_SHIFT_BSSID_H_V1_8812F) -+#define BIT_CLEAR_BSSID_H_V1_8812F(x) ((x) & (~BITS_BSSID_H_V1_8812F)) -+#define BIT_GET_BSSID_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID_H_V1_8812F) & BIT_MASK_BSSID_H_V1_8812F) -+#define BIT_SET_BSSID_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_BSSID_H_V1_8812F(x) | BIT_BSSID_H_V1_8812F(v)) -+ -+/* 2 REG_MAR_8812F (MULTICAST ADDRESS REGISTER) */ -+ -+#define BIT_SHIFT_MAR_V1_8812F 0 -+#define BIT_MASK_MAR_V1_8812F 0xffffffffL -+#define BIT_MAR_V1_8812F(x) \ -+ (((x) & BIT_MASK_MAR_V1_8812F) << BIT_SHIFT_MAR_V1_8812F) -+#define BITS_MAR_V1_8812F (BIT_MASK_MAR_V1_8812F << BIT_SHIFT_MAR_V1_8812F) -+#define BIT_CLEAR_MAR_V1_8812F(x) ((x) & (~BITS_MAR_V1_8812F)) -+#define BIT_GET_MAR_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAR_V1_8812F) & BIT_MASK_MAR_V1_8812F) -+#define BIT_SET_MAR_V1_8812F(x, v) \ -+ (BIT_CLEAR_MAR_V1_8812F(x) | BIT_MAR_V1_8812F(v)) -+ -+/* 2 REG_MAR_H_8812F (MULTICAST ADDRESS REGISTER) */ -+ -+#define BIT_SHIFT_MAR_H_V1_8812F 0 -+#define BIT_MASK_MAR_H_V1_8812F 0xffffffffL -+#define BIT_MAR_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_MAR_H_V1_8812F) << BIT_SHIFT_MAR_H_V1_8812F) -+#define BITS_MAR_H_V1_8812F \ -+ (BIT_MASK_MAR_H_V1_8812F << BIT_SHIFT_MAR_H_V1_8812F) -+#define BIT_CLEAR_MAR_H_V1_8812F(x) ((x) & (~BITS_MAR_H_V1_8812F)) -+#define BIT_GET_MAR_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MAR_H_V1_8812F) & BIT_MASK_MAR_H_V1_8812F) -+#define BIT_SET_MAR_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_MAR_H_V1_8812F(x) | BIT_MAR_H_V1_8812F(v)) -+ -+/* 2 REG_MBIDCAMCFG_1_8812F (MBSSID CAM CONFIGURATION REGISTER) */ -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_L_8812F 0 -+#define BIT_MASK_MBIDCAM_RWDATA_L_8812F 0xffffffffL -+#define BIT_MBIDCAM_RWDATA_L_8812F(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_L_8812F) \ -+ << BIT_SHIFT_MBIDCAM_RWDATA_L_8812F) -+#define BITS_MBIDCAM_RWDATA_L_8812F \ -+ (BIT_MASK_MBIDCAM_RWDATA_L_8812F << BIT_SHIFT_MBIDCAM_RWDATA_L_8812F) -+#define BIT_CLEAR_MBIDCAM_RWDATA_L_8812F(x) \ -+ ((x) & (~BITS_MBIDCAM_RWDATA_L_8812F)) -+#define BIT_GET_MBIDCAM_RWDATA_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_L_8812F) & \ -+ BIT_MASK_MBIDCAM_RWDATA_L_8812F) -+#define BIT_SET_MBIDCAM_RWDATA_L_8812F(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_L_8812F(x) | BIT_MBIDCAM_RWDATA_L_8812F(v)) -+ -+/* 2 REG_MBIDCAMCFG_2_8812F (MBSSID CAM CONFIGURATION REGISTER) */ -+#define BIT_MBIDCAM_POLL_8812F BIT(31) -+#define BIT_MBIDCAM_WT_EN_8812F BIT(30) -+ -+#define BIT_SHIFT_MBIDCAM_ADDR_V1_8812F 24 -+#define BIT_MASK_MBIDCAM_ADDR_V1_8812F 0x3f -+#define BIT_MBIDCAM_ADDR_V1_8812F(x) \ -+ (((x) & BIT_MASK_MBIDCAM_ADDR_V1_8812F) \ -+ << BIT_SHIFT_MBIDCAM_ADDR_V1_8812F) -+#define BITS_MBIDCAM_ADDR_V1_8812F \ -+ (BIT_MASK_MBIDCAM_ADDR_V1_8812F << BIT_SHIFT_MBIDCAM_ADDR_V1_8812F) -+#define BIT_CLEAR_MBIDCAM_ADDR_V1_8812F(x) ((x) & (~BITS_MBIDCAM_ADDR_V1_8812F)) -+#define BIT_GET_MBIDCAM_ADDR_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_ADDR_V1_8812F) & \ -+ BIT_MASK_MBIDCAM_ADDR_V1_8812F) -+#define BIT_SET_MBIDCAM_ADDR_V1_8812F(x, v) \ -+ (BIT_CLEAR_MBIDCAM_ADDR_V1_8812F(x) | BIT_MBIDCAM_ADDR_V1_8812F(v)) -+ -+#define BIT_MBIDCAM_VALID_8812F BIT(23) -+#define BIT_LSIC_TXOP_EN_8812F BIT(17) -+#define BIT_CTS_EN_8812F BIT(16) -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_H_8812F 0 -+#define BIT_MASK_MBIDCAM_RWDATA_H_8812F 0xffff -+#define BIT_MBIDCAM_RWDATA_H_8812F(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_H_8812F) \ -+ << BIT_SHIFT_MBIDCAM_RWDATA_H_8812F) -+#define BITS_MBIDCAM_RWDATA_H_8812F \ -+ (BIT_MASK_MBIDCAM_RWDATA_H_8812F << BIT_SHIFT_MBIDCAM_RWDATA_H_8812F) -+#define BIT_CLEAR_MBIDCAM_RWDATA_H_8812F(x) \ -+ ((x) & (~BITS_MBIDCAM_RWDATA_H_8812F)) -+#define BIT_GET_MBIDCAM_RWDATA_H_8812F(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_H_8812F) & \ -+ BIT_MASK_MBIDCAM_RWDATA_H_8812F) -+#define BIT_SET_MBIDCAM_RWDATA_H_8812F(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_H_8812F(x) | BIT_MBIDCAM_RWDATA_H_8812F(v)) -+ -+/* 2 REG_WMAC_TCR_TSFT_OFS_8812F */ -+ -+#define BIT_SHIFT_WMAC_TCR_TSFT_OFS_8812F 0 -+#define BIT_MASK_WMAC_TCR_TSFT_OFS_8812F 0xffff -+#define BIT_WMAC_TCR_TSFT_OFS_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_TCR_TSFT_OFS_8812F) \ -+ << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8812F) -+#define BITS_WMAC_TCR_TSFT_OFS_8812F \ -+ (BIT_MASK_WMAC_TCR_TSFT_OFS_8812F << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8812F) -+#define BIT_CLEAR_WMAC_TCR_TSFT_OFS_8812F(x) \ -+ ((x) & (~BITS_WMAC_TCR_TSFT_OFS_8812F)) -+#define BIT_GET_WMAC_TCR_TSFT_OFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TCR_TSFT_OFS_8812F) & \ -+ BIT_MASK_WMAC_TCR_TSFT_OFS_8812F) -+#define BIT_SET_WMAC_TCR_TSFT_OFS_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_TCR_TSFT_OFS_8812F(x) | BIT_WMAC_TCR_TSFT_OFS_8812F(v)) -+ -+/* 2 REG_UDF_THSD_8812F */ -+#define BIT_UDF_THSD_V1_8812F BIT(7) -+ -+#define BIT_SHIFT_UDF_THSD_VALUE_8812F 0 -+#define BIT_MASK_UDF_THSD_VALUE_8812F 0x7f -+#define BIT_UDF_THSD_VALUE_8812F(x) \ -+ (((x) & BIT_MASK_UDF_THSD_VALUE_8812F) \ -+ << BIT_SHIFT_UDF_THSD_VALUE_8812F) -+#define BITS_UDF_THSD_VALUE_8812F \ -+ (BIT_MASK_UDF_THSD_VALUE_8812F << BIT_SHIFT_UDF_THSD_VALUE_8812F) -+#define BIT_CLEAR_UDF_THSD_VALUE_8812F(x) ((x) & (~BITS_UDF_THSD_VALUE_8812F)) -+#define BIT_GET_UDF_THSD_VALUE_8812F(x) \ -+ (((x) >> BIT_SHIFT_UDF_THSD_VALUE_8812F) & \ -+ BIT_MASK_UDF_THSD_VALUE_8812F) -+#define BIT_SET_UDF_THSD_VALUE_8812F(x, v) \ -+ (BIT_CLEAR_UDF_THSD_VALUE_8812F(x) | BIT_UDF_THSD_VALUE_8812F(v)) -+ -+/* 2 REG_ZLD_NUM_8812F */ -+ -+#define BIT_SHIFT_ZLD_NUM_8812F 0 -+#define BIT_MASK_ZLD_NUM_8812F 0xff -+#define BIT_ZLD_NUM_8812F(x) \ -+ (((x) & BIT_MASK_ZLD_NUM_8812F) << BIT_SHIFT_ZLD_NUM_8812F) -+#define BITS_ZLD_NUM_8812F (BIT_MASK_ZLD_NUM_8812F << BIT_SHIFT_ZLD_NUM_8812F) -+#define BIT_CLEAR_ZLD_NUM_8812F(x) ((x) & (~BITS_ZLD_NUM_8812F)) -+#define BIT_GET_ZLD_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_ZLD_NUM_8812F) & BIT_MASK_ZLD_NUM_8812F) -+#define BIT_SET_ZLD_NUM_8812F(x, v) \ -+ (BIT_CLEAR_ZLD_NUM_8812F(x) | BIT_ZLD_NUM_8812F(v)) -+ -+/* 2 REG_STMP_THSD_8812F */ -+ -+#define BIT_SHIFT_STMP_THSD_8812F 0 -+#define BIT_MASK_STMP_THSD_8812F 0xff -+#define BIT_STMP_THSD_8812F(x) \ -+ (((x) & BIT_MASK_STMP_THSD_8812F) << BIT_SHIFT_STMP_THSD_8812F) -+#define BITS_STMP_THSD_8812F \ -+ (BIT_MASK_STMP_THSD_8812F << BIT_SHIFT_STMP_THSD_8812F) -+#define BIT_CLEAR_STMP_THSD_8812F(x) ((x) & (~BITS_STMP_THSD_8812F)) -+#define BIT_GET_STMP_THSD_8812F(x) \ -+ (((x) >> BIT_SHIFT_STMP_THSD_8812F) & BIT_MASK_STMP_THSD_8812F) -+#define BIT_SET_STMP_THSD_8812F(x, v) \ -+ (BIT_CLEAR_STMP_THSD_8812F(x) | BIT_STMP_THSD_8812F(v)) -+ -+/* 2 REG_WMAC_TXTIMEOUT_8812F */ -+ -+#define BIT_SHIFT_WMAC_TXTIMEOUT_8812F 0 -+#define BIT_MASK_WMAC_TXTIMEOUT_8812F 0xff -+#define BIT_WMAC_TXTIMEOUT_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_TXTIMEOUT_8812F) \ -+ << BIT_SHIFT_WMAC_TXTIMEOUT_8812F) -+#define BITS_WMAC_TXTIMEOUT_8812F \ -+ (BIT_MASK_WMAC_TXTIMEOUT_8812F << BIT_SHIFT_WMAC_TXTIMEOUT_8812F) -+#define BIT_CLEAR_WMAC_TXTIMEOUT_8812F(x) ((x) & (~BITS_WMAC_TXTIMEOUT_8812F)) -+#define BIT_GET_WMAC_TXTIMEOUT_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXTIMEOUT_8812F) & \ -+ BIT_MASK_WMAC_TXTIMEOUT_8812F) -+#define BIT_SET_WMAC_TXTIMEOUT_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_TXTIMEOUT_8812F(x) | BIT_WMAC_TXTIMEOUT_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_USTIME_EDCA_8812F (US TIME TUNING FOR EDCA REGISTER) */ -+ -+#define BIT_SHIFT_USTIME_EDCA_8812F 0 -+#define BIT_MASK_USTIME_EDCA_8812F 0xff -+#define BIT_USTIME_EDCA_8812F(x) \ -+ (((x) & BIT_MASK_USTIME_EDCA_8812F) << BIT_SHIFT_USTIME_EDCA_8812F) -+#define BITS_USTIME_EDCA_8812F \ -+ (BIT_MASK_USTIME_EDCA_8812F << BIT_SHIFT_USTIME_EDCA_8812F) -+#define BIT_CLEAR_USTIME_EDCA_8812F(x) ((x) & (~BITS_USTIME_EDCA_8812F)) -+#define BIT_GET_USTIME_EDCA_8812F(x) \ -+ (((x) >> BIT_SHIFT_USTIME_EDCA_8812F) & BIT_MASK_USTIME_EDCA_8812F) -+#define BIT_SET_USTIME_EDCA_8812F(x, v) \ -+ (BIT_CLEAR_USTIME_EDCA_8812F(x) | BIT_USTIME_EDCA_8812F(v)) -+ -+/* 2 REG_ACKTO_CCK_8812F (ACK TIMEOUT REGISTER FOR CCK RATE) */ -+ -+#define BIT_SHIFT_ACKTO_CCK_8812F 0 -+#define BIT_MASK_ACKTO_CCK_8812F 0xff -+#define BIT_ACKTO_CCK_8812F(x) \ -+ (((x) & BIT_MASK_ACKTO_CCK_8812F) << BIT_SHIFT_ACKTO_CCK_8812F) -+#define BITS_ACKTO_CCK_8812F \ -+ (BIT_MASK_ACKTO_CCK_8812F << BIT_SHIFT_ACKTO_CCK_8812F) -+#define BIT_CLEAR_ACKTO_CCK_8812F(x) ((x) & (~BITS_ACKTO_CCK_8812F)) -+#define BIT_GET_ACKTO_CCK_8812F(x) \ -+ (((x) >> BIT_SHIFT_ACKTO_CCK_8812F) & BIT_MASK_ACKTO_CCK_8812F) -+#define BIT_SET_ACKTO_CCK_8812F(x, v) \ -+ (BIT_CLEAR_ACKTO_CCK_8812F(x) | BIT_ACKTO_CCK_8812F(v)) -+ -+/* 2 REG_MAC_SPEC_SIFS_8812F (SPECIFICATION SIFS REGISTER) */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_8812F 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_8812F 0xff -+#define BIT_SPEC_SIFS_OFDM_8812F(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_8812F) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_8812F) -+#define BITS_SPEC_SIFS_OFDM_8812F \ -+ (BIT_MASK_SPEC_SIFS_OFDM_8812F << BIT_SHIFT_SPEC_SIFS_OFDM_8812F) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_8812F(x) ((x) & (~BITS_SPEC_SIFS_OFDM_8812F)) -+#define BIT_GET_SPEC_SIFS_OFDM_8812F(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_8812F) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_8812F) -+#define BIT_SET_SPEC_SIFS_OFDM_8812F(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_8812F(x) | BIT_SPEC_SIFS_OFDM_8812F(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_8812F 0 -+#define BIT_MASK_SPEC_SIFS_CCK_8812F 0xff -+#define BIT_SPEC_SIFS_CCK_8812F(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_8812F) << BIT_SHIFT_SPEC_SIFS_CCK_8812F) -+#define BITS_SPEC_SIFS_CCK_8812F \ -+ (BIT_MASK_SPEC_SIFS_CCK_8812F << BIT_SHIFT_SPEC_SIFS_CCK_8812F) -+#define BIT_CLEAR_SPEC_SIFS_CCK_8812F(x) ((x) & (~BITS_SPEC_SIFS_CCK_8812F)) -+#define BIT_GET_SPEC_SIFS_CCK_8812F(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_8812F) & BIT_MASK_SPEC_SIFS_CCK_8812F) -+#define BIT_SET_SPEC_SIFS_CCK_8812F(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_8812F(x) | BIT_SPEC_SIFS_CCK_8812F(v)) -+ -+/* 2 REG_RESP_SIFS_CCK_8812F (RESPONSE SIFS FOR CCK REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_CCK_8812F 8 -+#define BIT_MASK_SIFS_R2T_CCK_8812F 0xff -+#define BIT_SIFS_R2T_CCK_8812F(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_CCK_8812F) << BIT_SHIFT_SIFS_R2T_CCK_8812F) -+#define BITS_SIFS_R2T_CCK_8812F \ -+ (BIT_MASK_SIFS_R2T_CCK_8812F << BIT_SHIFT_SIFS_R2T_CCK_8812F) -+#define BIT_CLEAR_SIFS_R2T_CCK_8812F(x) ((x) & (~BITS_SIFS_R2T_CCK_8812F)) -+#define BIT_GET_SIFS_R2T_CCK_8812F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_CCK_8812F) & BIT_MASK_SIFS_R2T_CCK_8812F) -+#define BIT_SET_SIFS_R2T_CCK_8812F(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_CCK_8812F(x) | BIT_SIFS_R2T_CCK_8812F(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_CCK_8812F 0 -+#define BIT_MASK_SIFS_T2T_CCK_8812F 0xff -+#define BIT_SIFS_T2T_CCK_8812F(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_CCK_8812F) << BIT_SHIFT_SIFS_T2T_CCK_8812F) -+#define BITS_SIFS_T2T_CCK_8812F \ -+ (BIT_MASK_SIFS_T2T_CCK_8812F << BIT_SHIFT_SIFS_T2T_CCK_8812F) -+#define BIT_CLEAR_SIFS_T2T_CCK_8812F(x) ((x) & (~BITS_SIFS_T2T_CCK_8812F)) -+#define BIT_GET_SIFS_T2T_CCK_8812F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_CCK_8812F) & BIT_MASK_SIFS_T2T_CCK_8812F) -+#define BIT_SET_SIFS_T2T_CCK_8812F(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_CCK_8812F(x) | BIT_SIFS_T2T_CCK_8812F(v)) -+ -+/* 2 REG_RESP_SIFS_OFDM_8812F (RESPONSE SIFS FOR OFDM REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_OFDM_8812F 8 -+#define BIT_MASK_SIFS_R2T_OFDM_8812F 0xff -+#define BIT_SIFS_R2T_OFDM_8812F(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_OFDM_8812F) << BIT_SHIFT_SIFS_R2T_OFDM_8812F) -+#define BITS_SIFS_R2T_OFDM_8812F \ -+ (BIT_MASK_SIFS_R2T_OFDM_8812F << BIT_SHIFT_SIFS_R2T_OFDM_8812F) -+#define BIT_CLEAR_SIFS_R2T_OFDM_8812F(x) ((x) & (~BITS_SIFS_R2T_OFDM_8812F)) -+#define BIT_GET_SIFS_R2T_OFDM_8812F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_OFDM_8812F) & BIT_MASK_SIFS_R2T_OFDM_8812F) -+#define BIT_SET_SIFS_R2T_OFDM_8812F(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_OFDM_8812F(x) | BIT_SIFS_R2T_OFDM_8812F(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_OFDM_8812F 0 -+#define BIT_MASK_SIFS_T2T_OFDM_8812F 0xff -+#define BIT_SIFS_T2T_OFDM_8812F(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_OFDM_8812F) << BIT_SHIFT_SIFS_T2T_OFDM_8812F) -+#define BITS_SIFS_T2T_OFDM_8812F \ -+ (BIT_MASK_SIFS_T2T_OFDM_8812F << BIT_SHIFT_SIFS_T2T_OFDM_8812F) -+#define BIT_CLEAR_SIFS_T2T_OFDM_8812F(x) ((x) & (~BITS_SIFS_T2T_OFDM_8812F)) -+#define BIT_GET_SIFS_T2T_OFDM_8812F(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_OFDM_8812F) & BIT_MASK_SIFS_T2T_OFDM_8812F) -+#define BIT_SET_SIFS_T2T_OFDM_8812F(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_OFDM_8812F(x) | BIT_SIFS_T2T_OFDM_8812F(v)) -+ -+/* 2 REG_ACKTO_8812F (ACK TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_ACKTO_8812F 0 -+#define BIT_MASK_ACKTO_8812F 0xff -+#define BIT_ACKTO_8812F(x) \ -+ (((x) & BIT_MASK_ACKTO_8812F) << BIT_SHIFT_ACKTO_8812F) -+#define BITS_ACKTO_8812F (BIT_MASK_ACKTO_8812F << BIT_SHIFT_ACKTO_8812F) -+#define BIT_CLEAR_ACKTO_8812F(x) ((x) & (~BITS_ACKTO_8812F)) -+#define BIT_GET_ACKTO_8812F(x) \ -+ (((x) >> BIT_SHIFT_ACKTO_8812F) & BIT_MASK_ACKTO_8812F) -+#define BIT_SET_ACKTO_8812F(x, v) \ -+ (BIT_CLEAR_ACKTO_8812F(x) | BIT_ACKTO_8812F(v)) -+ -+/* 2 REG_CTS2TO_8812F (CTS2 TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_CTS2TO_8812F 0 -+#define BIT_MASK_CTS2TO_8812F 0xff -+#define BIT_CTS2TO_8812F(x) \ -+ (((x) & BIT_MASK_CTS2TO_8812F) << BIT_SHIFT_CTS2TO_8812F) -+#define BITS_CTS2TO_8812F (BIT_MASK_CTS2TO_8812F << BIT_SHIFT_CTS2TO_8812F) -+#define BIT_CLEAR_CTS2TO_8812F(x) ((x) & (~BITS_CTS2TO_8812F)) -+#define BIT_GET_CTS2TO_8812F(x) \ -+ (((x) >> BIT_SHIFT_CTS2TO_8812F) & BIT_MASK_CTS2TO_8812F) -+#define BIT_SET_CTS2TO_8812F(x, v) \ -+ (BIT_CLEAR_CTS2TO_8812F(x) | BIT_CTS2TO_8812F(v)) -+ -+/* 2 REG_EIFS_8812F (EIFS REGISTER) */ -+ -+#define BIT_SHIFT_EIFS_8812F 0 -+#define BIT_MASK_EIFS_8812F 0xffff -+#define BIT_EIFS_8812F(x) (((x) & BIT_MASK_EIFS_8812F) << BIT_SHIFT_EIFS_8812F) -+#define BITS_EIFS_8812F (BIT_MASK_EIFS_8812F << BIT_SHIFT_EIFS_8812F) -+#define BIT_CLEAR_EIFS_8812F(x) ((x) & (~BITS_EIFS_8812F)) -+#define BIT_GET_EIFS_8812F(x) \ -+ (((x) >> BIT_SHIFT_EIFS_8812F) & BIT_MASK_EIFS_8812F) -+#define BIT_SET_EIFS_8812F(x, v) (BIT_CLEAR_EIFS_8812F(x) | BIT_EIFS_8812F(v)) -+ -+/* 2 REG_RPFM_MAP0_8812F */ -+#define BIT_MGT_RPFM15EN_8812F BIT(15) -+#define BIT_MGT_RPFM14EN_8812F BIT(14) -+#define BIT_MGT_RPFM13EN_8812F BIT(13) -+#define BIT_MGT_RPFM12EN_8812F BIT(12) -+#define BIT_MGT_RPFM11EN_8812F BIT(11) -+#define BIT_MGT_RPFM10EN_8812F BIT(10) -+#define BIT_MGT_RPFM9EN_8812F BIT(9) -+#define BIT_MGT_RPFM8EN_8812F BIT(8) -+#define BIT_MGT_RPFM7EN_8812F BIT(7) -+#define BIT_MGT_RPFM6EN_8812F BIT(6) -+#define BIT_MGT_RPFM5EN_8812F BIT(5) -+#define BIT_MGT_RPFM4EN_8812F BIT(4) -+#define BIT_MGT_RPFM3EN_8812F BIT(3) -+#define BIT_MGT_RPFM2EN_8812F BIT(2) -+#define BIT_MGT_RPFM1EN_8812F BIT(1) -+#define BIT_MGT_RPFM0EN_8812F BIT(0) -+ -+/* 2 REG_RPFM_MAP1_V1_8812F */ -+#define BIT_DATA_RPFM15EN_8812F BIT(15) -+#define BIT_DATA_RPFM14EN_8812F BIT(14) -+#define BIT_DATA_RPFM13EN_8812F BIT(13) -+#define BIT_DATA_RPFM12EN_8812F BIT(12) -+#define BIT_DATA_RPFM11EN_8812F BIT(11) -+#define BIT_DATA_RPFM10EN_8812F BIT(10) -+#define BIT_DATA_RPFM9EN_8812F BIT(9) -+#define BIT_DATA_RPFM8EN_8812F BIT(8) -+#define BIT_DATA_RPFM7EN_8812F BIT(7) -+#define BIT_DATA_RPFM6EN_8812F BIT(6) -+#define BIT_DATA_RPFM5EN_8812F BIT(5) -+#define BIT_DATA_RPFM4EN_8812F BIT(4) -+#define BIT_DATA_RPFM3EN_8812F BIT(3) -+#define BIT_DATA_RPFM2EN_8812F BIT(2) -+#define BIT_DATA_RPFM1EN_8812F BIT(1) -+#define BIT_DATA_RPFM0EN_8812F BIT(0) -+ -+/* 2 REG_RPFM_CAM_CMD_8812F (RX PAYLOAD FRAME MASK CAM COMMAND REGISTER) */ -+#define BIT_RPFM_CAM_POLLING_8812F BIT(31) -+#define BIT_RPFM_CAM_CLR_8812F BIT(30) -+#define BIT_RPFM_CAM_WE_8812F BIT(16) -+ -+#define BIT_SHIFT_RPFM_CAM_ADDR_8812F 0 -+#define BIT_MASK_RPFM_CAM_ADDR_8812F 0x7f -+#define BIT_RPFM_CAM_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_RPFM_CAM_ADDR_8812F) << BIT_SHIFT_RPFM_CAM_ADDR_8812F) -+#define BITS_RPFM_CAM_ADDR_8812F \ -+ (BIT_MASK_RPFM_CAM_ADDR_8812F << BIT_SHIFT_RPFM_CAM_ADDR_8812F) -+#define BIT_CLEAR_RPFM_CAM_ADDR_8812F(x) ((x) & (~BITS_RPFM_CAM_ADDR_8812F)) -+#define BIT_GET_RPFM_CAM_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_RPFM_CAM_ADDR_8812F) & BIT_MASK_RPFM_CAM_ADDR_8812F) -+#define BIT_SET_RPFM_CAM_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_RPFM_CAM_ADDR_8812F(x) | BIT_RPFM_CAM_ADDR_8812F(v)) -+ -+/* 2 REG_RPFM_CAM_RWD_8812F (ACK TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_RPFM_CAM_RWD_8812F 0 -+#define BIT_MASK_RPFM_CAM_RWD_8812F 0xffffffffL -+#define BIT_RPFM_CAM_RWD_8812F(x) \ -+ (((x) & BIT_MASK_RPFM_CAM_RWD_8812F) << BIT_SHIFT_RPFM_CAM_RWD_8812F) -+#define BITS_RPFM_CAM_RWD_8812F \ -+ (BIT_MASK_RPFM_CAM_RWD_8812F << BIT_SHIFT_RPFM_CAM_RWD_8812F) -+#define BIT_CLEAR_RPFM_CAM_RWD_8812F(x) ((x) & (~BITS_RPFM_CAM_RWD_8812F)) -+#define BIT_GET_RPFM_CAM_RWD_8812F(x) \ -+ (((x) >> BIT_SHIFT_RPFM_CAM_RWD_8812F) & BIT_MASK_RPFM_CAM_RWD_8812F) -+#define BIT_SET_RPFM_CAM_RWD_8812F(x, v) \ -+ (BIT_CLEAR_RPFM_CAM_RWD_8812F(x) | BIT_RPFM_CAM_RWD_8812F(v)) -+ -+/* 2 REG_NAV_CTRL_8812F (NAV CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_NAV_UPPER_8812F 16 -+#define BIT_MASK_NAV_UPPER_8812F 0xff -+#define BIT_NAV_UPPER_8812F(x) \ -+ (((x) & BIT_MASK_NAV_UPPER_8812F) << BIT_SHIFT_NAV_UPPER_8812F) -+#define BITS_NAV_UPPER_8812F \ -+ (BIT_MASK_NAV_UPPER_8812F << BIT_SHIFT_NAV_UPPER_8812F) -+#define BIT_CLEAR_NAV_UPPER_8812F(x) ((x) & (~BITS_NAV_UPPER_8812F)) -+#define BIT_GET_NAV_UPPER_8812F(x) \ -+ (((x) >> BIT_SHIFT_NAV_UPPER_8812F) & BIT_MASK_NAV_UPPER_8812F) -+#define BIT_SET_NAV_UPPER_8812F(x, v) \ -+ (BIT_CLEAR_NAV_UPPER_8812F(x) | BIT_NAV_UPPER_8812F(v)) -+ -+#define BIT_SHIFT_RXMYRTS_NAV_8812F 8 -+#define BIT_MASK_RXMYRTS_NAV_8812F 0xf -+#define BIT_RXMYRTS_NAV_8812F(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_8812F) << BIT_SHIFT_RXMYRTS_NAV_8812F) -+#define BITS_RXMYRTS_NAV_8812F \ -+ (BIT_MASK_RXMYRTS_NAV_8812F << BIT_SHIFT_RXMYRTS_NAV_8812F) -+#define BIT_CLEAR_RXMYRTS_NAV_8812F(x) ((x) & (~BITS_RXMYRTS_NAV_8812F)) -+#define BIT_GET_RXMYRTS_NAV_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_8812F) & BIT_MASK_RXMYRTS_NAV_8812F) -+#define BIT_SET_RXMYRTS_NAV_8812F(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_8812F(x) | BIT_RXMYRTS_NAV_8812F(v)) -+ -+#define BIT_SHIFT_RTSRST_8812F 0 -+#define BIT_MASK_RTSRST_8812F 0xff -+#define BIT_RTSRST_8812F(x) \ -+ (((x) & BIT_MASK_RTSRST_8812F) << BIT_SHIFT_RTSRST_8812F) -+#define BITS_RTSRST_8812F (BIT_MASK_RTSRST_8812F << BIT_SHIFT_RTSRST_8812F) -+#define BIT_CLEAR_RTSRST_8812F(x) ((x) & (~BITS_RTSRST_8812F)) -+#define BIT_GET_RTSRST_8812F(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_8812F) & BIT_MASK_RTSRST_8812F) -+#define BIT_SET_RTSRST_8812F(x, v) \ -+ (BIT_CLEAR_RTSRST_8812F(x) | BIT_RTSRST_8812F(v)) -+ -+/* 2 REG_BACAMCMD_8812F (BLOCK ACK CAM COMMAND REGISTER) */ -+#define BIT_BACAM_POLL_8812F BIT(31) -+#define BIT_BACAM_RST_8812F BIT(17) -+#define BIT_BACAM_RW_8812F BIT(16) -+ -+#define BIT_SHIFT_TXSBM_8812F 14 -+#define BIT_MASK_TXSBM_8812F 0x3 -+#define BIT_TXSBM_8812F(x) \ -+ (((x) & BIT_MASK_TXSBM_8812F) << BIT_SHIFT_TXSBM_8812F) -+#define BITS_TXSBM_8812F (BIT_MASK_TXSBM_8812F << BIT_SHIFT_TXSBM_8812F) -+#define BIT_CLEAR_TXSBM_8812F(x) ((x) & (~BITS_TXSBM_8812F)) -+#define BIT_GET_TXSBM_8812F(x) \ -+ (((x) >> BIT_SHIFT_TXSBM_8812F) & BIT_MASK_TXSBM_8812F) -+#define BIT_SET_TXSBM_8812F(x, v) \ -+ (BIT_CLEAR_TXSBM_8812F(x) | BIT_TXSBM_8812F(v)) -+ -+#define BIT_SHIFT_BACAM_ADDR_8812F 0 -+#define BIT_MASK_BACAM_ADDR_8812F 0x3f -+#define BIT_BACAM_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_BACAM_ADDR_8812F) << BIT_SHIFT_BACAM_ADDR_8812F) -+#define BITS_BACAM_ADDR_8812F \ -+ (BIT_MASK_BACAM_ADDR_8812F << BIT_SHIFT_BACAM_ADDR_8812F) -+#define BIT_CLEAR_BACAM_ADDR_8812F(x) ((x) & (~BITS_BACAM_ADDR_8812F)) -+#define BIT_GET_BACAM_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_BACAM_ADDR_8812F) & BIT_MASK_BACAM_ADDR_8812F) -+#define BIT_SET_BACAM_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_BACAM_ADDR_8812F(x) | BIT_BACAM_ADDR_8812F(v)) -+ -+/* 2 REG_BACAMCONTENT_8812F (BLOCK ACK CAM CONTENT REGISTER) */ -+ -+#define BIT_SHIFT_BA_CONTENT_L_8812F 0 -+#define BIT_MASK_BA_CONTENT_L_8812F 0xffffffffL -+#define BIT_BA_CONTENT_L_8812F(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_L_8812F) << BIT_SHIFT_BA_CONTENT_L_8812F) -+#define BITS_BA_CONTENT_L_8812F \ -+ (BIT_MASK_BA_CONTENT_L_8812F << BIT_SHIFT_BA_CONTENT_L_8812F) -+#define BIT_CLEAR_BA_CONTENT_L_8812F(x) ((x) & (~BITS_BA_CONTENT_L_8812F)) -+#define BIT_GET_BA_CONTENT_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_L_8812F) & BIT_MASK_BA_CONTENT_L_8812F) -+#define BIT_SET_BA_CONTENT_L_8812F(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_L_8812F(x) | BIT_BA_CONTENT_L_8812F(v)) -+ -+/* 2 REG_BACAMCONTENT_H_8812F (BLOCK ACK CAM CONTENT REGISTER) */ -+ -+#define BIT_SHIFT_BA_CONTENT_H_8812F 0 -+#define BIT_MASK_BA_CONTENT_H_8812F 0xffffffffL -+#define BIT_BA_CONTENT_H_8812F(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_H_8812F) << BIT_SHIFT_BA_CONTENT_H_8812F) -+#define BITS_BA_CONTENT_H_8812F \ -+ (BIT_MASK_BA_CONTENT_H_8812F << BIT_SHIFT_BA_CONTENT_H_8812F) -+#define BIT_CLEAR_BA_CONTENT_H_8812F(x) ((x) & (~BITS_BA_CONTENT_H_8812F)) -+#define BIT_GET_BA_CONTENT_H_8812F(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_H_8812F) & BIT_MASK_BA_CONTENT_H_8812F) -+#define BIT_SET_BA_CONTENT_H_8812F(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_H_8812F(x) | BIT_BA_CONTENT_H_8812F(v)) -+ -+/* 2 REG_LBDLY_8812F (LOOPBACK DELAY REGISTER) */ -+ -+#define BIT_SHIFT_LBDLY_8812F 0 -+#define BIT_MASK_LBDLY_8812F 0x1f -+#define BIT_LBDLY_8812F(x) \ -+ (((x) & BIT_MASK_LBDLY_8812F) << BIT_SHIFT_LBDLY_8812F) -+#define BITS_LBDLY_8812F (BIT_MASK_LBDLY_8812F << BIT_SHIFT_LBDLY_8812F) -+#define BIT_CLEAR_LBDLY_8812F(x) ((x) & (~BITS_LBDLY_8812F)) -+#define BIT_GET_LBDLY_8812F(x) \ -+ (((x) >> BIT_SHIFT_LBDLY_8812F) & BIT_MASK_LBDLY_8812F) -+#define BIT_SET_LBDLY_8812F(x, v) \ -+ (BIT_CLEAR_LBDLY_8812F(x) | BIT_LBDLY_8812F(v)) -+ -+/* 2 REG_WMAC_BACAM_RPMEN_8812F */ -+ -+#define BIT_SHIFT_BITMAP_SSNBK_COUNTER_8812F 2 -+#define BIT_MASK_BITMAP_SSNBK_COUNTER_8812F 0x3f -+#define BIT_BITMAP_SSNBK_COUNTER_8812F(x) \ -+ (((x) & BIT_MASK_BITMAP_SSNBK_COUNTER_8812F) \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8812F) -+#define BITS_BITMAP_SSNBK_COUNTER_8812F \ -+ (BIT_MASK_BITMAP_SSNBK_COUNTER_8812F \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8812F) -+#define BIT_CLEAR_BITMAP_SSNBK_COUNTER_8812F(x) \ -+ ((x) & (~BITS_BITMAP_SSNBK_COUNTER_8812F)) -+#define BIT_GET_BITMAP_SSNBK_COUNTER_8812F(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_SSNBK_COUNTER_8812F) & \ -+ BIT_MASK_BITMAP_SSNBK_COUNTER_8812F) -+#define BIT_SET_BITMAP_SSNBK_COUNTER_8812F(x, v) \ -+ (BIT_CLEAR_BITMAP_SSNBK_COUNTER_8812F(x) | \ -+ BIT_BITMAP_SSNBK_COUNTER_8812F(v)) -+ -+#define BIT_BITMAP_EN_8812F BIT(1) -+#define BIT_WMAC_BACAM_RPMEN_8812F BIT(0) -+ -+/* 2 REG_TX_RX_8812F STATUS */ -+ -+#define BIT_SHIFT_RXPKT_TYPE_8812F 2 -+#define BIT_MASK_RXPKT_TYPE_8812F 0x3f -+#define BIT_RXPKT_TYPE_8812F(x) \ -+ (((x) & BIT_MASK_RXPKT_TYPE_8812F) << BIT_SHIFT_RXPKT_TYPE_8812F) -+#define BITS_RXPKT_TYPE_8812F \ -+ (BIT_MASK_RXPKT_TYPE_8812F << BIT_SHIFT_RXPKT_TYPE_8812F) -+#define BIT_CLEAR_RXPKT_TYPE_8812F(x) ((x) & (~BITS_RXPKT_TYPE_8812F)) -+#define BIT_GET_RXPKT_TYPE_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_TYPE_8812F) & BIT_MASK_RXPKT_TYPE_8812F) -+#define BIT_SET_RXPKT_TYPE_8812F(x, v) \ -+ (BIT_CLEAR_RXPKT_TYPE_8812F(x) | BIT_RXPKT_TYPE_8812F(v)) -+ -+#define BIT_TXACT_IND_8812F BIT(1) -+#define BIT_RXACT_IND_8812F BIT(0) -+ -+/* 2 REG_WMAC_BITMAP_CTL_8812F */ -+#define BIT_BITMAP_VO_8812F BIT(7) -+#define BIT_BITMAP_VI_8812F BIT(6) -+#define BIT_BITMAP_BE_8812F BIT(5) -+#define BIT_BITMAP_BK_8812F BIT(4) -+ -+#define BIT_SHIFT_BITMAP_CONDITION_8812F 2 -+#define BIT_MASK_BITMAP_CONDITION_8812F 0x3 -+#define BIT_BITMAP_CONDITION_8812F(x) \ -+ (((x) & BIT_MASK_BITMAP_CONDITION_8812F) \ -+ << BIT_SHIFT_BITMAP_CONDITION_8812F) -+#define BITS_BITMAP_CONDITION_8812F \ -+ (BIT_MASK_BITMAP_CONDITION_8812F << BIT_SHIFT_BITMAP_CONDITION_8812F) -+#define BIT_CLEAR_BITMAP_CONDITION_8812F(x) \ -+ ((x) & (~BITS_BITMAP_CONDITION_8812F)) -+#define BIT_GET_BITMAP_CONDITION_8812F(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_CONDITION_8812F) & \ -+ BIT_MASK_BITMAP_CONDITION_8812F) -+#define BIT_SET_BITMAP_CONDITION_8812F(x, v) \ -+ (BIT_CLEAR_BITMAP_CONDITION_8812F(x) | BIT_BITMAP_CONDITION_8812F(v)) -+ -+#define BIT_BITMAP_SSNBK_COUNTER_CLR_8812F BIT(1) -+#define BIT_BITMAP_FORCE_8812F BIT(0) -+ -+/* 2 REG_RXERR_RPT_8812F (RX ERROR REPORT REGISTER) */ -+ -+#define BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8812F 28 -+#define BIT_MASK_RXERR_RPT_SEL_V1_3_0_8812F 0xf -+#define BIT_RXERR_RPT_SEL_V1_3_0_8812F(x) \ -+ (((x) & BIT_MASK_RXERR_RPT_SEL_V1_3_0_8812F) \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8812F) -+#define BITS_RXERR_RPT_SEL_V1_3_0_8812F \ -+ (BIT_MASK_RXERR_RPT_SEL_V1_3_0_8812F \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8812F) -+#define BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8812F(x) \ -+ ((x) & (~BITS_RXERR_RPT_SEL_V1_3_0_8812F)) -+#define BIT_GET_RXERR_RPT_SEL_V1_3_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8812F) & \ -+ BIT_MASK_RXERR_RPT_SEL_V1_3_0_8812F) -+#define BIT_SET_RXERR_RPT_SEL_V1_3_0_8812F(x, v) \ -+ (BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8812F(x) | \ -+ BIT_RXERR_RPT_SEL_V1_3_0_8812F(v)) -+ -+#define BIT_RXERR_RPT_RST_8812F BIT(27) -+#define BIT_RXERR_RPT_SEL_V1_4_8812F BIT(26) -+ -+#define BIT_SHIFT_UD_SELECT_BSSID_2_1_8812F 24 -+#define BIT_MASK_UD_SELECT_BSSID_2_1_8812F 0x3 -+#define BIT_UD_SELECT_BSSID_2_1_8812F(x) \ -+ (((x) & BIT_MASK_UD_SELECT_BSSID_2_1_8812F) \ -+ << BIT_SHIFT_UD_SELECT_BSSID_2_1_8812F) -+#define BITS_UD_SELECT_BSSID_2_1_8812F \ -+ (BIT_MASK_UD_SELECT_BSSID_2_1_8812F \ -+ << BIT_SHIFT_UD_SELECT_BSSID_2_1_8812F) -+#define BIT_CLEAR_UD_SELECT_BSSID_2_1_8812F(x) \ -+ ((x) & (~BITS_UD_SELECT_BSSID_2_1_8812F)) -+#define BIT_GET_UD_SELECT_BSSID_2_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_UD_SELECT_BSSID_2_1_8812F) & \ -+ BIT_MASK_UD_SELECT_BSSID_2_1_8812F) -+#define BIT_SET_UD_SELECT_BSSID_2_1_8812F(x, v) \ -+ (BIT_CLEAR_UD_SELECT_BSSID_2_1_8812F(x) | \ -+ BIT_UD_SELECT_BSSID_2_1_8812F(v)) -+ -+#define BIT_W1S_8812F BIT(23) -+#define BIT_UD_SELECT_BSSID_0_8812F BIT(22) -+ -+#define BIT_SHIFT_UD_SUB_TYPE_8812F 18 -+#define BIT_MASK_UD_SUB_TYPE_8812F 0xf -+#define BIT_UD_SUB_TYPE_8812F(x) \ -+ (((x) & BIT_MASK_UD_SUB_TYPE_8812F) << BIT_SHIFT_UD_SUB_TYPE_8812F) -+#define BITS_UD_SUB_TYPE_8812F \ -+ (BIT_MASK_UD_SUB_TYPE_8812F << BIT_SHIFT_UD_SUB_TYPE_8812F) -+#define BIT_CLEAR_UD_SUB_TYPE_8812F(x) ((x) & (~BITS_UD_SUB_TYPE_8812F)) -+#define BIT_GET_UD_SUB_TYPE_8812F(x) \ -+ (((x) >> BIT_SHIFT_UD_SUB_TYPE_8812F) & BIT_MASK_UD_SUB_TYPE_8812F) -+#define BIT_SET_UD_SUB_TYPE_8812F(x, v) \ -+ (BIT_CLEAR_UD_SUB_TYPE_8812F(x) | BIT_UD_SUB_TYPE_8812F(v)) -+ -+#define BIT_SHIFT_UD_TYPE_8812F 16 -+#define BIT_MASK_UD_TYPE_8812F 0x3 -+#define BIT_UD_TYPE_8812F(x) \ -+ (((x) & BIT_MASK_UD_TYPE_8812F) << BIT_SHIFT_UD_TYPE_8812F) -+#define BITS_UD_TYPE_8812F (BIT_MASK_UD_TYPE_8812F << BIT_SHIFT_UD_TYPE_8812F) -+#define BIT_CLEAR_UD_TYPE_8812F(x) ((x) & (~BITS_UD_TYPE_8812F)) -+#define BIT_GET_UD_TYPE_8812F(x) \ -+ (((x) >> BIT_SHIFT_UD_TYPE_8812F) & BIT_MASK_UD_TYPE_8812F) -+#define BIT_SET_UD_TYPE_8812F(x, v) \ -+ (BIT_CLEAR_UD_TYPE_8812F(x) | BIT_UD_TYPE_8812F(v)) -+ -+#define BIT_SHIFT_RPT_COUNTER_8812F 0 -+#define BIT_MASK_RPT_COUNTER_8812F 0xffff -+#define BIT_RPT_COUNTER_8812F(x) \ -+ (((x) & BIT_MASK_RPT_COUNTER_8812F) << BIT_SHIFT_RPT_COUNTER_8812F) -+#define BITS_RPT_COUNTER_8812F \ -+ (BIT_MASK_RPT_COUNTER_8812F << BIT_SHIFT_RPT_COUNTER_8812F) -+#define BIT_CLEAR_RPT_COUNTER_8812F(x) ((x) & (~BITS_RPT_COUNTER_8812F)) -+#define BIT_GET_RPT_COUNTER_8812F(x) \ -+ (((x) >> BIT_SHIFT_RPT_COUNTER_8812F) & BIT_MASK_RPT_COUNTER_8812F) -+#define BIT_SET_RPT_COUNTER_8812F(x, v) \ -+ (BIT_CLEAR_RPT_COUNTER_8812F(x) | BIT_RPT_COUNTER_8812F(v)) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_8812F (WMAC TX/RX PROTOCOL CONTROL REGISTER) */ -+#define BIT_ACKTO_BLOCK_SCH_EN_8812F BIT(27) -+#define BIT_EIFS_BLOCK_SCH_EN_8812F BIT(26) -+#define BIT_PLCPCHK_RST_EIFS_8812F BIT(25) -+#define BIT_CCA_RST_EIFS_8812F BIT(24) -+#define BIT_DIS_UPD_MYRXPKTNAV_8812F BIT(23) -+#define BIT_EARLY_TXBA_8812F BIT(22) -+ -+#define BIT_SHIFT_RESP_CHNBUSY_8812F 20 -+#define BIT_MASK_RESP_CHNBUSY_8812F 0x3 -+#define BIT_RESP_CHNBUSY_8812F(x) \ -+ (((x) & BIT_MASK_RESP_CHNBUSY_8812F) << BIT_SHIFT_RESP_CHNBUSY_8812F) -+#define BITS_RESP_CHNBUSY_8812F \ -+ (BIT_MASK_RESP_CHNBUSY_8812F << BIT_SHIFT_RESP_CHNBUSY_8812F) -+#define BIT_CLEAR_RESP_CHNBUSY_8812F(x) ((x) & (~BITS_RESP_CHNBUSY_8812F)) -+#define BIT_GET_RESP_CHNBUSY_8812F(x) \ -+ (((x) >> BIT_SHIFT_RESP_CHNBUSY_8812F) & BIT_MASK_RESP_CHNBUSY_8812F) -+#define BIT_SET_RESP_CHNBUSY_8812F(x, v) \ -+ (BIT_CLEAR_RESP_CHNBUSY_8812F(x) | BIT_RESP_CHNBUSY_8812F(v)) -+ -+#define BIT_RESP_DCTS_EN_8812F BIT(19) -+#define BIT_RESP_DCFE_EN_8812F BIT(18) -+#define BIT_RESP_SPLCPEN_8812F BIT(17) -+#define BIT_RESP_SGIEN_8812F BIT(16) -+#define BIT_RESP_LDPC_EN_8812F BIT(15) -+#define BIT_DIS_RESP_ACKINCCA_8812F BIT(14) -+#define BIT_DIS_RESP_CTSINCCA_8812F BIT(13) -+ -+#define BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8812F 10 -+#define BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8812F 0x7 -+#define BIT_R_WMAC_SECOND_CCA_TIMER_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8812F) \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8812F) -+#define BITS_R_WMAC_SECOND_CCA_TIMER_8812F \ -+ (BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8812F \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8812F) -+#define BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_SECOND_CCA_TIMER_8812F)) -+#define BIT_GET_R_WMAC_SECOND_CCA_TIMER_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8812F) & \ -+ BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8812F) -+#define BIT_SET_R_WMAC_SECOND_CCA_TIMER_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8812F(x) | \ -+ BIT_R_WMAC_SECOND_CCA_TIMER_8812F(v)) -+ -+#define BIT_SHIFT_RFMOD_8812F 7 -+#define BIT_MASK_RFMOD_8812F 0x3 -+#define BIT_RFMOD_8812F(x) \ -+ (((x) & BIT_MASK_RFMOD_8812F) << BIT_SHIFT_RFMOD_8812F) -+#define BITS_RFMOD_8812F (BIT_MASK_RFMOD_8812F << BIT_SHIFT_RFMOD_8812F) -+#define BIT_CLEAR_RFMOD_8812F(x) ((x) & (~BITS_RFMOD_8812F)) -+#define BIT_GET_RFMOD_8812F(x) \ -+ (((x) >> BIT_SHIFT_RFMOD_8812F) & BIT_MASK_RFMOD_8812F) -+#define BIT_SET_RFMOD_8812F(x, v) \ -+ (BIT_CLEAR_RFMOD_8812F(x) | BIT_RFMOD_8812F(v)) -+ -+#define BIT_SHIFT_RESP_CTS_DYNBW_SEL_8812F 5 -+#define BIT_MASK_RESP_CTS_DYNBW_SEL_8812F 0x3 -+#define BIT_RESP_CTS_DYNBW_SEL_8812F(x) \ -+ (((x) & BIT_MASK_RESP_CTS_DYNBW_SEL_8812F) \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8812F) -+#define BITS_RESP_CTS_DYNBW_SEL_8812F \ -+ (BIT_MASK_RESP_CTS_DYNBW_SEL_8812F \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8812F) -+#define BIT_CLEAR_RESP_CTS_DYNBW_SEL_8812F(x) \ -+ ((x) & (~BITS_RESP_CTS_DYNBW_SEL_8812F)) -+#define BIT_GET_RESP_CTS_DYNBW_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_RESP_CTS_DYNBW_SEL_8812F) & \ -+ BIT_MASK_RESP_CTS_DYNBW_SEL_8812F) -+#define BIT_SET_RESP_CTS_DYNBW_SEL_8812F(x, v) \ -+ (BIT_CLEAR_RESP_CTS_DYNBW_SEL_8812F(x) | \ -+ BIT_RESP_CTS_DYNBW_SEL_8812F(v)) -+ -+#define BIT_DLY_TX_WAIT_RXANTSEL_8812F BIT(4) -+#define BIT_TXRESP_BY_RXANTSEL_8812F BIT(3) -+ -+#define BIT_SHIFT_ORIG_DCTS_CHK_8812F 0 -+#define BIT_MASK_ORIG_DCTS_CHK_8812F 0x3 -+#define BIT_ORIG_DCTS_CHK_8812F(x) \ -+ (((x) & BIT_MASK_ORIG_DCTS_CHK_8812F) << BIT_SHIFT_ORIG_DCTS_CHK_8812F) -+#define BITS_ORIG_DCTS_CHK_8812F \ -+ (BIT_MASK_ORIG_DCTS_CHK_8812F << BIT_SHIFT_ORIG_DCTS_CHK_8812F) -+#define BIT_CLEAR_ORIG_DCTS_CHK_8812F(x) ((x) & (~BITS_ORIG_DCTS_CHK_8812F)) -+#define BIT_GET_ORIG_DCTS_CHK_8812F(x) \ -+ (((x) >> BIT_SHIFT_ORIG_DCTS_CHK_8812F) & BIT_MASK_ORIG_DCTS_CHK_8812F) -+#define BIT_SET_ORIG_DCTS_CHK_8812F(x, v) \ -+ (BIT_CLEAR_ORIG_DCTS_CHK_8812F(x) | BIT_ORIG_DCTS_CHK_8812F(v)) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_H_8812F */ -+ -+#define BIT_SHIFT_ACKBA_TYPSEL_8812F 28 -+#define BIT_MASK_ACKBA_TYPSEL_8812F 0xf -+#define BIT_ACKBA_TYPSEL_8812F(x) \ -+ (((x) & BIT_MASK_ACKBA_TYPSEL_8812F) << BIT_SHIFT_ACKBA_TYPSEL_8812F) -+#define BITS_ACKBA_TYPSEL_8812F \ -+ (BIT_MASK_ACKBA_TYPSEL_8812F << BIT_SHIFT_ACKBA_TYPSEL_8812F) -+#define BIT_CLEAR_ACKBA_TYPSEL_8812F(x) ((x) & (~BITS_ACKBA_TYPSEL_8812F)) -+#define BIT_GET_ACKBA_TYPSEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_TYPSEL_8812F) & BIT_MASK_ACKBA_TYPSEL_8812F) -+#define BIT_SET_ACKBA_TYPSEL_8812F(x, v) \ -+ (BIT_CLEAR_ACKBA_TYPSEL_8812F(x) | BIT_ACKBA_TYPSEL_8812F(v)) -+ -+#define BIT_SHIFT_ACKBA_ACKPCHK_8812F 24 -+#define BIT_MASK_ACKBA_ACKPCHK_8812F 0xf -+#define BIT_ACKBA_ACKPCHK_8812F(x) \ -+ (((x) & BIT_MASK_ACKBA_ACKPCHK_8812F) << BIT_SHIFT_ACKBA_ACKPCHK_8812F) -+#define BITS_ACKBA_ACKPCHK_8812F \ -+ (BIT_MASK_ACKBA_ACKPCHK_8812F << BIT_SHIFT_ACKBA_ACKPCHK_8812F) -+#define BIT_CLEAR_ACKBA_ACKPCHK_8812F(x) ((x) & (~BITS_ACKBA_ACKPCHK_8812F)) -+#define BIT_GET_ACKBA_ACKPCHK_8812F(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_ACKPCHK_8812F) & BIT_MASK_ACKBA_ACKPCHK_8812F) -+#define BIT_SET_ACKBA_ACKPCHK_8812F(x, v) \ -+ (BIT_CLEAR_ACKBA_ACKPCHK_8812F(x) | BIT_ACKBA_ACKPCHK_8812F(v)) -+ -+#define BIT_SHIFT_ACKBAR_TYPESEL_8812F 16 -+#define BIT_MASK_ACKBAR_TYPESEL_8812F 0xff -+#define BIT_ACKBAR_TYPESEL_8812F(x) \ -+ (((x) & BIT_MASK_ACKBAR_TYPESEL_8812F) \ -+ << BIT_SHIFT_ACKBAR_TYPESEL_8812F) -+#define BITS_ACKBAR_TYPESEL_8812F \ -+ (BIT_MASK_ACKBAR_TYPESEL_8812F << BIT_SHIFT_ACKBAR_TYPESEL_8812F) -+#define BIT_CLEAR_ACKBAR_TYPESEL_8812F(x) ((x) & (~BITS_ACKBAR_TYPESEL_8812F)) -+#define BIT_GET_ACKBAR_TYPESEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_TYPESEL_8812F) & \ -+ BIT_MASK_ACKBAR_TYPESEL_8812F) -+#define BIT_SET_ACKBAR_TYPESEL_8812F(x, v) \ -+ (BIT_CLEAR_ACKBAR_TYPESEL_8812F(x) | BIT_ACKBAR_TYPESEL_8812F(v)) -+ -+#define BIT_SHIFT_ACKBAR_ACKPCHK_8812F 12 -+#define BIT_MASK_ACKBAR_ACKPCHK_8812F 0xf -+#define BIT_ACKBAR_ACKPCHK_8812F(x) \ -+ (((x) & BIT_MASK_ACKBAR_ACKPCHK_8812F) \ -+ << BIT_SHIFT_ACKBAR_ACKPCHK_8812F) -+#define BITS_ACKBAR_ACKPCHK_8812F \ -+ (BIT_MASK_ACKBAR_ACKPCHK_8812F << BIT_SHIFT_ACKBAR_ACKPCHK_8812F) -+#define BIT_CLEAR_ACKBAR_ACKPCHK_8812F(x) ((x) & (~BITS_ACKBAR_ACKPCHK_8812F)) -+#define BIT_GET_ACKBAR_ACKPCHK_8812F(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_ACKPCHK_8812F) & \ -+ BIT_MASK_ACKBAR_ACKPCHK_8812F) -+#define BIT_SET_ACKBAR_ACKPCHK_8812F(x, v) \ -+ (BIT_CLEAR_ACKBAR_ACKPCHK_8812F(x) | BIT_ACKBAR_ACKPCHK_8812F(v)) -+ -+#define BIT_RXBA_IGNOREA2_V1_8812F BIT(10) -+#define BIT_EN_SAVE_ALL_TXOPADDR_V1_8812F BIT(9) -+#define BIT_EN_TXCTS_TO_TXOPOWNER_INRXNAV_V1_8812F BIT(8) -+#define BIT_DIS_TXBA_AMPDUFCSERR_V1_8812F BIT(7) -+#define BIT_DIS_TXBA_RXBARINFULL_V1_8812F BIT(6) -+#define BIT_DIS_TXCFE_INFULL_V1_8812F BIT(5) -+#define BIT_DIS_TXCTS_INFULL_V1_8812F BIT(4) -+#define BIT_EN_TXACKBA_IN_TX_RDG_V1_8812F BIT(3) -+#define BIT_EN_TXACKBA_IN_TXOP_V1_8812F BIT(2) -+#define BIT_EN_TXCTS_IN_RXNAV_V1_8812F BIT(1) -+#define BIT_EN_TXCTS_INTXOP_V1_8812F BIT(0) -+ -+/* 2 REG_CAMCMD_8812F (CAM COMMAND REGISTER) */ -+#define BIT_SECCAM_POLLING_8812F BIT(31) -+#define BIT_SECCAM_CLR_8812F BIT(30) -+#define BIT_SECCAM_WE_8812F BIT(16) -+ -+#define BIT_SHIFT_SECCAM_ADDR_V2_8812F 0 -+#define BIT_MASK_SECCAM_ADDR_V2_8812F 0x3ff -+#define BIT_SECCAM_ADDR_V2_8812F(x) \ -+ (((x) & BIT_MASK_SECCAM_ADDR_V2_8812F) \ -+ << BIT_SHIFT_SECCAM_ADDR_V2_8812F) -+#define BITS_SECCAM_ADDR_V2_8812F \ -+ (BIT_MASK_SECCAM_ADDR_V2_8812F << BIT_SHIFT_SECCAM_ADDR_V2_8812F) -+#define BIT_CLEAR_SECCAM_ADDR_V2_8812F(x) ((x) & (~BITS_SECCAM_ADDR_V2_8812F)) -+#define BIT_GET_SECCAM_ADDR_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_SECCAM_ADDR_V2_8812F) & \ -+ BIT_MASK_SECCAM_ADDR_V2_8812F) -+#define BIT_SET_SECCAM_ADDR_V2_8812F(x, v) \ -+ (BIT_CLEAR_SECCAM_ADDR_V2_8812F(x) | BIT_SECCAM_ADDR_V2_8812F(v)) -+ -+/* 2 REG_CAMWRITE_8812F (CAM WRITE REGISTER) */ -+ -+#define BIT_SHIFT_CAMW_DATA_8812F 0 -+#define BIT_MASK_CAMW_DATA_8812F 0xffffffffL -+#define BIT_CAMW_DATA_8812F(x) \ -+ (((x) & BIT_MASK_CAMW_DATA_8812F) << BIT_SHIFT_CAMW_DATA_8812F) -+#define BITS_CAMW_DATA_8812F \ -+ (BIT_MASK_CAMW_DATA_8812F << BIT_SHIFT_CAMW_DATA_8812F) -+#define BIT_CLEAR_CAMW_DATA_8812F(x) ((x) & (~BITS_CAMW_DATA_8812F)) -+#define BIT_GET_CAMW_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_CAMW_DATA_8812F) & BIT_MASK_CAMW_DATA_8812F) -+#define BIT_SET_CAMW_DATA_8812F(x, v) \ -+ (BIT_CLEAR_CAMW_DATA_8812F(x) | BIT_CAMW_DATA_8812F(v)) -+ -+/* 2 REG_CAMREAD_8812F (CAM READ REGISTER) */ -+ -+#define BIT_SHIFT_CAMR_DATA_8812F 0 -+#define BIT_MASK_CAMR_DATA_8812F 0xffffffffL -+#define BIT_CAMR_DATA_8812F(x) \ -+ (((x) & BIT_MASK_CAMR_DATA_8812F) << BIT_SHIFT_CAMR_DATA_8812F) -+#define BITS_CAMR_DATA_8812F \ -+ (BIT_MASK_CAMR_DATA_8812F << BIT_SHIFT_CAMR_DATA_8812F) -+#define BIT_CLEAR_CAMR_DATA_8812F(x) ((x) & (~BITS_CAMR_DATA_8812F)) -+#define BIT_GET_CAMR_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_CAMR_DATA_8812F) & BIT_MASK_CAMR_DATA_8812F) -+#define BIT_SET_CAMR_DATA_8812F(x, v) \ -+ (BIT_CLEAR_CAMR_DATA_8812F(x) | BIT_CAMR_DATA_8812F(v)) -+ -+/* 2 REG_CAMDBG_8812F (CAM DEBUG REGISTER) */ -+#define BIT_SECCAM_INFO_8812F BIT(31) -+#define BIT_SEC_KEYFOUND_8812F BIT(15) -+ -+#define BIT_SHIFT_CAMDBG_SEC_TYPE_8812F 12 -+#define BIT_MASK_CAMDBG_SEC_TYPE_8812F 0x7 -+#define BIT_CAMDBG_SEC_TYPE_8812F(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_TYPE_8812F) \ -+ << BIT_SHIFT_CAMDBG_SEC_TYPE_8812F) -+#define BITS_CAMDBG_SEC_TYPE_8812F \ -+ (BIT_MASK_CAMDBG_SEC_TYPE_8812F << BIT_SHIFT_CAMDBG_SEC_TYPE_8812F) -+#define BIT_CLEAR_CAMDBG_SEC_TYPE_8812F(x) ((x) & (~BITS_CAMDBG_SEC_TYPE_8812F)) -+#define BIT_GET_CAMDBG_SEC_TYPE_8812F(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_TYPE_8812F) & \ -+ BIT_MASK_CAMDBG_SEC_TYPE_8812F) -+#define BIT_SET_CAMDBG_SEC_TYPE_8812F(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_TYPE_8812F(x) | BIT_CAMDBG_SEC_TYPE_8812F(v)) -+ -+#define BIT_CAMDBG_EXT_SECTYPE_8812F BIT(11) -+ -+#define BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8812F 5 -+#define BIT_MASK_CAMDBG_MIC_KEY_IDX_8812F 0x1f -+#define BIT_CAMDBG_MIC_KEY_IDX_8812F(x) \ -+ (((x) & BIT_MASK_CAMDBG_MIC_KEY_IDX_8812F) \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8812F) -+#define BITS_CAMDBG_MIC_KEY_IDX_8812F \ -+ (BIT_MASK_CAMDBG_MIC_KEY_IDX_8812F \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8812F) -+#define BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8812F(x) \ -+ ((x) & (~BITS_CAMDBG_MIC_KEY_IDX_8812F)) -+#define BIT_GET_CAMDBG_MIC_KEY_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8812F) & \ -+ BIT_MASK_CAMDBG_MIC_KEY_IDX_8812F) -+#define BIT_SET_CAMDBG_MIC_KEY_IDX_8812F(x, v) \ -+ (BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8812F(x) | \ -+ BIT_CAMDBG_MIC_KEY_IDX_8812F(v)) -+ -+#define BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8812F 0 -+#define BIT_MASK_CAMDBG_SEC_KEY_IDX_8812F 0x1f -+#define BIT_CAMDBG_SEC_KEY_IDX_8812F(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_KEY_IDX_8812F) \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8812F) -+#define BITS_CAMDBG_SEC_KEY_IDX_8812F \ -+ (BIT_MASK_CAMDBG_SEC_KEY_IDX_8812F \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8812F) -+#define BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8812F(x) \ -+ ((x) & (~BITS_CAMDBG_SEC_KEY_IDX_8812F)) -+#define BIT_GET_CAMDBG_SEC_KEY_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8812F) & \ -+ BIT_MASK_CAMDBG_SEC_KEY_IDX_8812F) -+#define BIT_SET_CAMDBG_SEC_KEY_IDX_8812F(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8812F(x) | \ -+ BIT_CAMDBG_SEC_KEY_IDX_8812F(v)) -+ -+/* 2 REG_SECCFG_8812F (SECURITY CONFIGURATION REGISTER) */ -+#define BIT_DIS_GCLK_WAPI_8812F BIT(15) -+#define BIT_DIS_GCLK_AES_8812F BIT(14) -+#define BIT_DIS_GCLK_TKIP_8812F BIT(13) -+#define BIT_AES_SEL_QC_1_8812F BIT(12) -+#define BIT_AES_SEL_QC_0_8812F BIT(11) -+#define BIT_CHK_BMC_8812F BIT(9) -+#define BIT_CHK_KEYID_8812F BIT(8) -+#define BIT_RXBCUSEDK_8812F BIT(7) -+#define BIT_TXBCUSEDK_8812F BIT(6) -+#define BIT_NOSKMC_8812F BIT(5) -+#define BIT_SKBYA2_8812F BIT(4) -+#define BIT_RXDEC_8812F BIT(3) -+#define BIT_TXENC_8812F BIT(2) -+#define BIT_RXUHUSEDK_8812F BIT(1) -+#define BIT_TXUHUSEDK_8812F BIT(0) -+ -+/* 2 REG_RXFILTER_CATEGORY_1_8812F */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_1_8812F 0 -+#define BIT_MASK_RXFILTER_CATEGORY_1_8812F 0xff -+#define BIT_RXFILTER_CATEGORY_1_8812F(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_1_8812F) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8812F) -+#define BITS_RXFILTER_CATEGORY_1_8812F \ -+ (BIT_MASK_RXFILTER_CATEGORY_1_8812F \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8812F) -+#define BIT_CLEAR_RXFILTER_CATEGORY_1_8812F(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_1_8812F)) -+#define BIT_GET_RXFILTER_CATEGORY_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_1_8812F) & \ -+ BIT_MASK_RXFILTER_CATEGORY_1_8812F) -+#define BIT_SET_RXFILTER_CATEGORY_1_8812F(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_1_8812F(x) | \ -+ BIT_RXFILTER_CATEGORY_1_8812F(v)) -+ -+/* 2 REG_RXFILTER_ACTION_1_8812F */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_1_8812F 0 -+#define BIT_MASK_RXFILTER_ACTION_1_8812F 0xff -+#define BIT_RXFILTER_ACTION_1_8812F(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_1_8812F) \ -+ << BIT_SHIFT_RXFILTER_ACTION_1_8812F) -+#define BITS_RXFILTER_ACTION_1_8812F \ -+ (BIT_MASK_RXFILTER_ACTION_1_8812F << BIT_SHIFT_RXFILTER_ACTION_1_8812F) -+#define BIT_CLEAR_RXFILTER_ACTION_1_8812F(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_1_8812F)) -+#define BIT_GET_RXFILTER_ACTION_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_1_8812F) & \ -+ BIT_MASK_RXFILTER_ACTION_1_8812F) -+#define BIT_SET_RXFILTER_ACTION_1_8812F(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_1_8812F(x) | BIT_RXFILTER_ACTION_1_8812F(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_2_8812F */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_2_8812F 0 -+#define BIT_MASK_RXFILTER_CATEGORY_2_8812F 0xff -+#define BIT_RXFILTER_CATEGORY_2_8812F(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_2_8812F) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8812F) -+#define BITS_RXFILTER_CATEGORY_2_8812F \ -+ (BIT_MASK_RXFILTER_CATEGORY_2_8812F \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8812F) -+#define BIT_CLEAR_RXFILTER_CATEGORY_2_8812F(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_2_8812F)) -+#define BIT_GET_RXFILTER_CATEGORY_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_2_8812F) & \ -+ BIT_MASK_RXFILTER_CATEGORY_2_8812F) -+#define BIT_SET_RXFILTER_CATEGORY_2_8812F(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_2_8812F(x) | \ -+ BIT_RXFILTER_CATEGORY_2_8812F(v)) -+ -+/* 2 REG_RXFILTER_ACTION_2_8812F */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_2_8812F 0 -+#define BIT_MASK_RXFILTER_ACTION_2_8812F 0xff -+#define BIT_RXFILTER_ACTION_2_8812F(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_2_8812F) \ -+ << BIT_SHIFT_RXFILTER_ACTION_2_8812F) -+#define BITS_RXFILTER_ACTION_2_8812F \ -+ (BIT_MASK_RXFILTER_ACTION_2_8812F << BIT_SHIFT_RXFILTER_ACTION_2_8812F) -+#define BIT_CLEAR_RXFILTER_ACTION_2_8812F(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_2_8812F)) -+#define BIT_GET_RXFILTER_ACTION_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_2_8812F) & \ -+ BIT_MASK_RXFILTER_ACTION_2_8812F) -+#define BIT_SET_RXFILTER_ACTION_2_8812F(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_2_8812F(x) | BIT_RXFILTER_ACTION_2_8812F(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_3_8812F */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_3_8812F 0 -+#define BIT_MASK_RXFILTER_CATEGORY_3_8812F 0xff -+#define BIT_RXFILTER_CATEGORY_3_8812F(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_3_8812F) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8812F) -+#define BITS_RXFILTER_CATEGORY_3_8812F \ -+ (BIT_MASK_RXFILTER_CATEGORY_3_8812F \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8812F) -+#define BIT_CLEAR_RXFILTER_CATEGORY_3_8812F(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_3_8812F)) -+#define BIT_GET_RXFILTER_CATEGORY_3_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_3_8812F) & \ -+ BIT_MASK_RXFILTER_CATEGORY_3_8812F) -+#define BIT_SET_RXFILTER_CATEGORY_3_8812F(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_3_8812F(x) | \ -+ BIT_RXFILTER_CATEGORY_3_8812F(v)) -+ -+/* 2 REG_RXFILTER_ACTION_3_8812F */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_3_8812F 0 -+#define BIT_MASK_RXFILTER_ACTION_3_8812F 0xff -+#define BIT_RXFILTER_ACTION_3_8812F(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_3_8812F) \ -+ << BIT_SHIFT_RXFILTER_ACTION_3_8812F) -+#define BITS_RXFILTER_ACTION_3_8812F \ -+ (BIT_MASK_RXFILTER_ACTION_3_8812F << BIT_SHIFT_RXFILTER_ACTION_3_8812F) -+#define BIT_CLEAR_RXFILTER_ACTION_3_8812F(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_3_8812F)) -+#define BIT_GET_RXFILTER_ACTION_3_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_3_8812F) & \ -+ BIT_MASK_RXFILTER_ACTION_3_8812F) -+#define BIT_SET_RXFILTER_ACTION_3_8812F(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_3_8812F(x) | BIT_RXFILTER_ACTION_3_8812F(v)) -+ -+/* 2 REG_RXFLTMAP3_8812F (RX FILTER MAP GROUP 3) */ -+#define BIT_MGTFLT15EN_FW_8812F BIT(15) -+#define BIT_MGTFLT14EN_FW_8812F BIT(14) -+#define BIT_MGTFLT13EN_FW_8812F BIT(13) -+#define BIT_MGTFLT12EN_FW_8812F BIT(12) -+#define BIT_MGTFLT11EN_FW_8812F BIT(11) -+#define BIT_MGTFLT10EN_FW_8812F BIT(10) -+#define BIT_MGTFLT9EN_FW_8812F BIT(9) -+#define BIT_MGTFLT8EN_FW_8812F BIT(8) -+#define BIT_MGTFLT7EN_FW_8812F BIT(7) -+#define BIT_MGTFLT6EN_FW_8812F BIT(6) -+#define BIT_MGTFLT5EN_FW_8812F BIT(5) -+#define BIT_MGTFLT4EN_FW_8812F BIT(4) -+#define BIT_MGTFLT3EN_FW_8812F BIT(3) -+#define BIT_MGTFLT2EN_FW_8812F BIT(2) -+#define BIT_MGTFLT1EN_FW_8812F BIT(1) -+#define BIT_MGTFLT0EN_FW_8812F BIT(0) -+ -+/* 2 REG_RXFLTMAP4_8812F (RX FILTER MAP GROUP 4) */ -+#define BIT_CTRLFLT15EN_FW_8812F BIT(15) -+#define BIT_CTRLFLT14EN_FW_8812F BIT(14) -+#define BIT_CTRLFLT13EN_FW_8812F BIT(13) -+#define BIT_CTRLFLT12EN_FW_8812F BIT(12) -+#define BIT_CTRLFLT11EN_FW_8812F BIT(11) -+#define BIT_CTRLFLT10EN_FW_8812F BIT(10) -+#define BIT_CTRLFLT9EN_FW_8812F BIT(9) -+#define BIT_CTRLFLT8EN_FW_8812F BIT(8) -+#define BIT_CTRLFLT7EN_FW_8812F BIT(7) -+#define BIT_CTRLFLT6EN_FW_8812F BIT(6) -+#define BIT_CTRLFLT5EN_FW_8812F BIT(5) -+#define BIT_CTRLFLT4EN_FW_8812F BIT(4) -+#define BIT_CTRLFLT3EN_FW_8812F BIT(3) -+#define BIT_CTRLFLT2EN_FW_8812F BIT(2) -+#define BIT_CTRLFLT1EN_FW_8812F BIT(1) -+#define BIT_CTRLFLT0EN_FW_8812F BIT(0) -+ -+/* 2 REG_RXFLTMAP5_8812F (RX FILTER MAP GROUP 5) */ -+#define BIT_DATAFLT15EN_FW_8812F BIT(15) -+#define BIT_DATAFLT14EN_FW_8812F BIT(14) -+#define BIT_DATAFLT13EN_FW_8812F BIT(13) -+#define BIT_DATAFLT12EN_FW_8812F BIT(12) -+#define BIT_DATAFLT11EN_FW_8812F BIT(11) -+#define BIT_DATAFLT10EN_FW_8812F BIT(10) -+#define BIT_DATAFLT9EN_FW_8812F BIT(9) -+#define BIT_DATAFLT8EN_FW_8812F BIT(8) -+#define BIT_DATAFLT7EN_FW_8812F BIT(7) -+#define BIT_DATAFLT6EN_FW_8812F BIT(6) -+#define BIT_DATAFLT5EN_FW_8812F BIT(5) -+#define BIT_DATAFLT4EN_FW_8812F BIT(4) -+#define BIT_DATAFLT3EN_FW_8812F BIT(3) -+#define BIT_DATAFLT2EN_FW_8812F BIT(2) -+#define BIT_DATAFLT1EN_FW_8812F BIT(1) -+#define BIT_DATAFLT0EN_FW_8812F BIT(0) -+ -+/* 2 REG_RXFLTMAP6_8812F (RX FILTER MAP GROUP 6) */ -+#define BIT_ACTIONFLT15EN_FW_8812F BIT(15) -+#define BIT_ACTIONFLT14EN_FW_8812F BIT(14) -+#define BIT_ACTIONFLT13EN_FW_8812F BIT(13) -+#define BIT_ACTIONFLT12EN_FW_8812F BIT(12) -+#define BIT_ACTIONFLT11EN_FW_8812F BIT(11) -+#define BIT_ACTIONFLT10EN_FW_8812F BIT(10) -+#define BIT_ACTIONFLT9EN_FW_8812F BIT(9) -+#define BIT_ACTIONFLT8EN_FW_8812F BIT(8) -+#define BIT_ACTIONFLT7EN_FW_8812F BIT(7) -+#define BIT_ACTIONFLT6EN_FW_8812F BIT(6) -+#define BIT_ACTIONFLT5EN_FW_8812F BIT(5) -+#define BIT_ACTIONFLT4EN_FW_8812F BIT(4) -+#define BIT_ACTIONFLT3EN_FW_8812F BIT(3) -+#define BIT_ACTIONFLT2EN_FW_8812F BIT(2) -+#define BIT_ACTIONFLT1EN_FW_8812F BIT(1) -+#define BIT_ACTIONFLT0EN_FW_8812F BIT(0) -+ -+/* 2 REG_WOW_CTRL_8812F (WAKE ON WLAN CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_PSF_BSSIDSEL_B2B1_8812F 6 -+#define BIT_MASK_PSF_BSSIDSEL_B2B1_8812F 0x3 -+#define BIT_PSF_BSSIDSEL_B2B1_8812F(x) \ -+ (((x) & BIT_MASK_PSF_BSSIDSEL_B2B1_8812F) \ -+ << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8812F) -+#define BITS_PSF_BSSIDSEL_B2B1_8812F \ -+ (BIT_MASK_PSF_BSSIDSEL_B2B1_8812F << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8812F) -+#define BIT_CLEAR_PSF_BSSIDSEL_B2B1_8812F(x) \ -+ ((x) & (~BITS_PSF_BSSIDSEL_B2B1_8812F)) -+#define BIT_GET_PSF_BSSIDSEL_B2B1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PSF_BSSIDSEL_B2B1_8812F) & \ -+ BIT_MASK_PSF_BSSIDSEL_B2B1_8812F) -+#define BIT_SET_PSF_BSSIDSEL_B2B1_8812F(x, v) \ -+ (BIT_CLEAR_PSF_BSSIDSEL_B2B1_8812F(x) | BIT_PSF_BSSIDSEL_B2B1_8812F(v)) -+ -+#define BIT_WOWHCI_8812F BIT(5) -+#define BIT_PSF_BSSIDSEL_B0_8812F BIT(4) -+#define BIT_UWF_8812F BIT(3) -+#define BIT_MAGIC_8812F BIT(2) -+#define BIT_WOWEN_8812F BIT(1) -+#define BIT_FORCE_WAKEUP_8812F BIT(0) -+ -+/* 2 REG_NAN_RX_TSF_FILTER_8812F(NAN_RX_TSF_ADDRESS_FILTER) */ -+#define BIT_CHK_TSF_TA_8812F BIT(2) -+#define BIT_CHK_TSF_CBSSID_8812F BIT(1) -+#define BIT_CHK_TSF_EN_8812F BIT(0) -+ -+/* 2 REG_PS_RX_INFO_8812F (POWER SAVE RX INFORMATION REGISTER) */ -+ -+#define BIT_SHIFT_PORTSEL__PS_RX_INFO_8812F 5 -+#define BIT_MASK_PORTSEL__PS_RX_INFO_8812F 0x7 -+#define BIT_PORTSEL__PS_RX_INFO_8812F(x) \ -+ (((x) & BIT_MASK_PORTSEL__PS_RX_INFO_8812F) \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8812F) -+#define BITS_PORTSEL__PS_RX_INFO_8812F \ -+ (BIT_MASK_PORTSEL__PS_RX_INFO_8812F \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8812F) -+#define BIT_CLEAR_PORTSEL__PS_RX_INFO_8812F(x) \ -+ ((x) & (~BITS_PORTSEL__PS_RX_INFO_8812F)) -+#define BIT_GET_PORTSEL__PS_RX_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_PORTSEL__PS_RX_INFO_8812F) & \ -+ BIT_MASK_PORTSEL__PS_RX_INFO_8812F) -+#define BIT_SET_PORTSEL__PS_RX_INFO_8812F(x, v) \ -+ (BIT_CLEAR_PORTSEL__PS_RX_INFO_8812F(x) | \ -+ BIT_PORTSEL__PS_RX_INFO_8812F(v)) -+ -+#define BIT_RXCTRLIN0_8812F BIT(4) -+#define BIT_RXMGTIN0_8812F BIT(3) -+#define BIT_RXDATAIN2_8812F BIT(2) -+#define BIT_RXDATAIN1_8812F BIT(1) -+#define BIT_RXDATAIN0_8812F BIT(0) -+ -+/* 2 REG_WMMPS_UAPSD_TID_8812F (WMM POWER SAVE UAPSD TID REGISTER) */ -+#define BIT_WMMPS_UAPSD_TID7_8812F BIT(7) -+#define BIT_WMMPS_UAPSD_TID6_8812F BIT(6) -+#define BIT_WMMPS_UAPSD_TID5_8812F BIT(5) -+#define BIT_WMMPS_UAPSD_TID4_8812F BIT(4) -+#define BIT_WMMPS_UAPSD_TID3_8812F BIT(3) -+#define BIT_WMMPS_UAPSD_TID2_8812F BIT(2) -+#define BIT_WMMPS_UAPSD_TID1_8812F BIT(1) -+#define BIT_WMMPS_UAPSD_TID0_8812F BIT(0) -+ -+/* 2 REG_LPNAV_CTRL_8812F (LOW POWER NAV CONTROL REGISTER) */ -+ -+/* 2 REG_WKFMCAM_CMD_8812F (WAKEUP FRAME CAM COMMAND REGISTER) */ -+#define BIT_WKFCAM_POLLING_V1_8812F BIT(31) -+#define BIT_WKFCAM_CLR_V1_8812F BIT(30) -+#define BIT_WKFCAM_WE_8812F BIT(16) -+ -+#define BIT_SHIFT_WKFCAM_ADDR_V2_8812F 8 -+#define BIT_MASK_WKFCAM_ADDR_V2_8812F 0xff -+#define BIT_WKFCAM_ADDR_V2_8812F(x) \ -+ (((x) & BIT_MASK_WKFCAM_ADDR_V2_8812F) \ -+ << BIT_SHIFT_WKFCAM_ADDR_V2_8812F) -+#define BITS_WKFCAM_ADDR_V2_8812F \ -+ (BIT_MASK_WKFCAM_ADDR_V2_8812F << BIT_SHIFT_WKFCAM_ADDR_V2_8812F) -+#define BIT_CLEAR_WKFCAM_ADDR_V2_8812F(x) ((x) & (~BITS_WKFCAM_ADDR_V2_8812F)) -+#define BIT_GET_WKFCAM_ADDR_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_ADDR_V2_8812F) & \ -+ BIT_MASK_WKFCAM_ADDR_V2_8812F) -+#define BIT_SET_WKFCAM_ADDR_V2_8812F(x, v) \ -+ (BIT_CLEAR_WKFCAM_ADDR_V2_8812F(x) | BIT_WKFCAM_ADDR_V2_8812F(v)) -+ -+#define BIT_SHIFT_WKFCAM_CAM_NUM_V1_8812F 0 -+#define BIT_MASK_WKFCAM_CAM_NUM_V1_8812F 0xff -+#define BIT_WKFCAM_CAM_NUM_V1_8812F(x) \ -+ (((x) & BIT_MASK_WKFCAM_CAM_NUM_V1_8812F) \ -+ << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8812F) -+#define BITS_WKFCAM_CAM_NUM_V1_8812F \ -+ (BIT_MASK_WKFCAM_CAM_NUM_V1_8812F << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8812F) -+#define BIT_CLEAR_WKFCAM_CAM_NUM_V1_8812F(x) \ -+ ((x) & (~BITS_WKFCAM_CAM_NUM_V1_8812F)) -+#define BIT_GET_WKFCAM_CAM_NUM_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_CAM_NUM_V1_8812F) & \ -+ BIT_MASK_WKFCAM_CAM_NUM_V1_8812F) -+#define BIT_SET_WKFCAM_CAM_NUM_V1_8812F(x, v) \ -+ (BIT_CLEAR_WKFCAM_CAM_NUM_V1_8812F(x) | BIT_WKFCAM_CAM_NUM_V1_8812F(v)) -+ -+/* 2 REG_WKFMCAM_RWD_8812F (WAKEUP FRAME READ/WRITE DATA) */ -+ -+#define BIT_SHIFT_WKFMCAM_RWD_8812F 0 -+#define BIT_MASK_WKFMCAM_RWD_8812F 0xffffffffL -+#define BIT_WKFMCAM_RWD_8812F(x) \ -+ (((x) & BIT_MASK_WKFMCAM_RWD_8812F) << BIT_SHIFT_WKFMCAM_RWD_8812F) -+#define BITS_WKFMCAM_RWD_8812F \ -+ (BIT_MASK_WKFMCAM_RWD_8812F << BIT_SHIFT_WKFMCAM_RWD_8812F) -+#define BIT_CLEAR_WKFMCAM_RWD_8812F(x) ((x) & (~BITS_WKFMCAM_RWD_8812F)) -+#define BIT_GET_WKFMCAM_RWD_8812F(x) \ -+ (((x) >> BIT_SHIFT_WKFMCAM_RWD_8812F) & BIT_MASK_WKFMCAM_RWD_8812F) -+#define BIT_SET_WKFMCAM_RWD_8812F(x, v) \ -+ (BIT_CLEAR_WKFMCAM_RWD_8812F(x) | BIT_WKFMCAM_RWD_8812F(v)) -+ -+/* 2 REG_RXFLTMAP0_8812F (RX FILTER MAP GROUP 0) */ -+#define BIT_MGTFLT15EN_8812F BIT(15) -+#define BIT_MGTFLT14EN_8812F BIT(14) -+#define BIT_MGTFLT13EN_8812F BIT(13) -+#define BIT_MGTFLT12EN_8812F BIT(12) -+#define BIT_MGTFLT11EN_8812F BIT(11) -+#define BIT_MGTFLT10EN_8812F BIT(10) -+#define BIT_MGTFLT9EN_8812F BIT(9) -+#define BIT_MGTFLT8EN_8812F BIT(8) -+#define BIT_MGTFLT7EN_8812F BIT(7) -+#define BIT_MGTFLT6EN_8812F BIT(6) -+#define BIT_MGTFLT5EN_8812F BIT(5) -+#define BIT_MGTFLT4EN_8812F BIT(4) -+#define BIT_MGTFLT3EN_8812F BIT(3) -+#define BIT_MGTFLT2EN_8812F BIT(2) -+#define BIT_MGTFLT1EN_8812F BIT(1) -+#define BIT_MGTFLT0EN_8812F BIT(0) -+ -+/* 2 REG_RXFLTMAP1_8812F (RX FILTER MAP GROUP 1) */ -+#define BIT_CTRLFLT15EN_8812F BIT(15) -+#define BIT_CTRLFLT14EN_8812F BIT(14) -+#define BIT_CTRLFLT13EN_8812F BIT(13) -+#define BIT_CTRLFLT12EN_8812F BIT(12) -+#define BIT_CTRLFLT11EN_8812F BIT(11) -+#define BIT_CTRLFLT10EN_8812F BIT(10) -+#define BIT_CTRLFLT9EN_8812F BIT(9) -+#define BIT_CTRLFLT8EN_8812F BIT(8) -+#define BIT_CTRLFLT7EN_8812F BIT(7) -+#define BIT_CTRLFLT6EN_8812F BIT(6) -+#define BIT_CTRLFLT5EN_8812F BIT(5) -+#define BIT_CTRLFLT4EN_8812F BIT(4) -+#define BIT_CTRLFLT3EN_8812F BIT(3) -+#define BIT_CTRLFLT2EN_8812F BIT(2) -+#define BIT_CTRLFLT1EN_8812F BIT(1) -+#define BIT_CTRLFLT0EN_8812F BIT(0) -+ -+/* 2 REG_RXFLTMAP2_8812F (RX FILTER MAP GROUP 2) */ -+#define BIT_DATAFLT15EN_8812F BIT(15) -+#define BIT_DATAFLT14EN_8812F BIT(14) -+#define BIT_DATAFLT13EN_8812F BIT(13) -+#define BIT_DATAFLT12EN_8812F BIT(12) -+#define BIT_DATAFLT11EN_8812F BIT(11) -+#define BIT_DATAFLT10EN_8812F BIT(10) -+#define BIT_DATAFLT9EN_8812F BIT(9) -+#define BIT_DATAFLT8EN_8812F BIT(8) -+#define BIT_DATAFLT7EN_8812F BIT(7) -+#define BIT_DATAFLT6EN_8812F BIT(6) -+#define BIT_DATAFLT5EN_8812F BIT(5) -+#define BIT_DATAFLT4EN_8812F BIT(4) -+#define BIT_DATAFLT3EN_8812F BIT(3) -+#define BIT_DATAFLT2EN_8812F BIT(2) -+#define BIT_DATAFLT1EN_8812F BIT(1) -+#define BIT_DATAFLT0EN_8812F BIT(0) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_BCN_PSR_RPT_8812F (BEACON PARSER REPORT REGISTER) */ -+ -+#define BIT_SHIFT_DTIM_CNT_8812F 24 -+#define BIT_MASK_DTIM_CNT_8812F 0xff -+#define BIT_DTIM_CNT_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_CNT_8812F) << BIT_SHIFT_DTIM_CNT_8812F) -+#define BITS_DTIM_CNT_8812F \ -+ (BIT_MASK_DTIM_CNT_8812F << BIT_SHIFT_DTIM_CNT_8812F) -+#define BIT_CLEAR_DTIM_CNT_8812F(x) ((x) & (~BITS_DTIM_CNT_8812F)) -+#define BIT_GET_DTIM_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT_8812F) & BIT_MASK_DTIM_CNT_8812F) -+#define BIT_SET_DTIM_CNT_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_CNT_8812F(x) | BIT_DTIM_CNT_8812F(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD_8812F 16 -+#define BIT_MASK_DTIM_PERIOD_8812F 0xff -+#define BIT_DTIM_PERIOD_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD_8812F) << BIT_SHIFT_DTIM_PERIOD_8812F) -+#define BITS_DTIM_PERIOD_8812F \ -+ (BIT_MASK_DTIM_PERIOD_8812F << BIT_SHIFT_DTIM_PERIOD_8812F) -+#define BIT_CLEAR_DTIM_PERIOD_8812F(x) ((x) & (~BITS_DTIM_PERIOD_8812F)) -+#define BIT_GET_DTIM_PERIOD_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD_8812F) & BIT_MASK_DTIM_PERIOD_8812F) -+#define BIT_SET_DTIM_PERIOD_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD_8812F(x) | BIT_DTIM_PERIOD_8812F(v)) -+ -+#define BIT_DTIM_8812F BIT(15) -+#define BIT_TIM_8812F BIT(14) -+#define BIT_RPT_VALID_8812F BIT(13) -+ -+#define BIT_SHIFT_PS_AID_0_8812F 0 -+#define BIT_MASK_PS_AID_0_8812F 0x7ff -+#define BIT_PS_AID_0_8812F(x) \ -+ (((x) & BIT_MASK_PS_AID_0_8812F) << BIT_SHIFT_PS_AID_0_8812F) -+#define BITS_PS_AID_0_8812F \ -+ (BIT_MASK_PS_AID_0_8812F << BIT_SHIFT_PS_AID_0_8812F) -+#define BIT_CLEAR_PS_AID_0_8812F(x) ((x) & (~BITS_PS_AID_0_8812F)) -+#define BIT_GET_PS_AID_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_0_8812F) & BIT_MASK_PS_AID_0_8812F) -+#define BIT_SET_PS_AID_0_8812F(x, v) \ -+ (BIT_CLEAR_PS_AID_0_8812F(x) | BIT_PS_AID_0_8812F(v)) -+ -+/* 2 REG_FLC_RPC_8812F (FW LPS CONDITION -- RX PKT COUNTER) */ -+ -+#define BIT_SHIFT_FLC_RPC_8812F 0 -+#define BIT_MASK_FLC_RPC_8812F 0xff -+#define BIT_FLC_RPC_8812F(x) \ -+ (((x) & BIT_MASK_FLC_RPC_8812F) << BIT_SHIFT_FLC_RPC_8812F) -+#define BITS_FLC_RPC_8812F (BIT_MASK_FLC_RPC_8812F << BIT_SHIFT_FLC_RPC_8812F) -+#define BIT_CLEAR_FLC_RPC_8812F(x) ((x) & (~BITS_FLC_RPC_8812F)) -+#define BIT_GET_FLC_RPC_8812F(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPC_8812F) & BIT_MASK_FLC_RPC_8812F) -+#define BIT_SET_FLC_RPC_8812F(x, v) \ -+ (BIT_CLEAR_FLC_RPC_8812F(x) | BIT_FLC_RPC_8812F(v)) -+ -+/* 2 REG_FLC_RPCT_8812F (FLC_RPC THRESHOLD) */ -+ -+#define BIT_SHIFT_FLC_RPCT_8812F 0 -+#define BIT_MASK_FLC_RPCT_8812F 0xff -+#define BIT_FLC_RPCT_8812F(x) \ -+ (((x) & BIT_MASK_FLC_RPCT_8812F) << BIT_SHIFT_FLC_RPCT_8812F) -+#define BITS_FLC_RPCT_8812F \ -+ (BIT_MASK_FLC_RPCT_8812F << BIT_SHIFT_FLC_RPCT_8812F) -+#define BIT_CLEAR_FLC_RPCT_8812F(x) ((x) & (~BITS_FLC_RPCT_8812F)) -+#define BIT_GET_FLC_RPCT_8812F(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPCT_8812F) & BIT_MASK_FLC_RPCT_8812F) -+#define BIT_SET_FLC_RPCT_8812F(x, v) \ -+ (BIT_CLEAR_FLC_RPCT_8812F(x) | BIT_FLC_RPCT_8812F(v)) -+ -+/* 2 REG_FLC_PTS_8812F (PKT TYPE SELECTION OF FLC_RPC T) */ -+#define BIT_CMF_8812F BIT(2) -+#define BIT_CCF_8812F BIT(1) -+#define BIT_CDF_8812F BIT(0) -+ -+/* 2 REG_FLC_TRPC_8812F (TIMER OF FLC_RPC) */ -+#define BIT_FLC_RPCT_V1_8812F BIT(7) -+#define BIT_MODE_8812F BIT(6) -+ -+#define BIT_SHIFT_TRPCD_8812F 0 -+#define BIT_MASK_TRPCD_8812F 0x3f -+#define BIT_TRPCD_8812F(x) \ -+ (((x) & BIT_MASK_TRPCD_8812F) << BIT_SHIFT_TRPCD_8812F) -+#define BITS_TRPCD_8812F (BIT_MASK_TRPCD_8812F << BIT_SHIFT_TRPCD_8812F) -+#define BIT_CLEAR_TRPCD_8812F(x) ((x) & (~BITS_TRPCD_8812F)) -+#define BIT_GET_TRPCD_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRPCD_8812F) & BIT_MASK_TRPCD_8812F) -+#define BIT_SET_TRPCD_8812F(x, v) \ -+ (BIT_CLEAR_TRPCD_8812F(x) | BIT_TRPCD_8812F(v)) -+ -+/* 2 REG_RXPKTMON_CTRL_8812F */ -+ -+#define BIT_SHIFT_RXBKQPKT_SEQ_8812F 20 -+#define BIT_MASK_RXBKQPKT_SEQ_8812F 0xf -+#define BIT_RXBKQPKT_SEQ_8812F(x) \ -+ (((x) & BIT_MASK_RXBKQPKT_SEQ_8812F) << BIT_SHIFT_RXBKQPKT_SEQ_8812F) -+#define BITS_RXBKQPKT_SEQ_8812F \ -+ (BIT_MASK_RXBKQPKT_SEQ_8812F << BIT_SHIFT_RXBKQPKT_SEQ_8812F) -+#define BIT_CLEAR_RXBKQPKT_SEQ_8812F(x) ((x) & (~BITS_RXBKQPKT_SEQ_8812F)) -+#define BIT_GET_RXBKQPKT_SEQ_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXBKQPKT_SEQ_8812F) & BIT_MASK_RXBKQPKT_SEQ_8812F) -+#define BIT_SET_RXBKQPKT_SEQ_8812F(x, v) \ -+ (BIT_CLEAR_RXBKQPKT_SEQ_8812F(x) | BIT_RXBKQPKT_SEQ_8812F(v)) -+ -+#define BIT_SHIFT_RXBEQPKT_SEQ_8812F 16 -+#define BIT_MASK_RXBEQPKT_SEQ_8812F 0xf -+#define BIT_RXBEQPKT_SEQ_8812F(x) \ -+ (((x) & BIT_MASK_RXBEQPKT_SEQ_8812F) << BIT_SHIFT_RXBEQPKT_SEQ_8812F) -+#define BITS_RXBEQPKT_SEQ_8812F \ -+ (BIT_MASK_RXBEQPKT_SEQ_8812F << BIT_SHIFT_RXBEQPKT_SEQ_8812F) -+#define BIT_CLEAR_RXBEQPKT_SEQ_8812F(x) ((x) & (~BITS_RXBEQPKT_SEQ_8812F)) -+#define BIT_GET_RXBEQPKT_SEQ_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXBEQPKT_SEQ_8812F) & BIT_MASK_RXBEQPKT_SEQ_8812F) -+#define BIT_SET_RXBEQPKT_SEQ_8812F(x, v) \ -+ (BIT_CLEAR_RXBEQPKT_SEQ_8812F(x) | BIT_RXBEQPKT_SEQ_8812F(v)) -+ -+#define BIT_SHIFT_RXVIQPKT_SEQ_8812F 12 -+#define BIT_MASK_RXVIQPKT_SEQ_8812F 0xf -+#define BIT_RXVIQPKT_SEQ_8812F(x) \ -+ (((x) & BIT_MASK_RXVIQPKT_SEQ_8812F) << BIT_SHIFT_RXVIQPKT_SEQ_8812F) -+#define BITS_RXVIQPKT_SEQ_8812F \ -+ (BIT_MASK_RXVIQPKT_SEQ_8812F << BIT_SHIFT_RXVIQPKT_SEQ_8812F) -+#define BIT_CLEAR_RXVIQPKT_SEQ_8812F(x) ((x) & (~BITS_RXVIQPKT_SEQ_8812F)) -+#define BIT_GET_RXVIQPKT_SEQ_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXVIQPKT_SEQ_8812F) & BIT_MASK_RXVIQPKT_SEQ_8812F) -+#define BIT_SET_RXVIQPKT_SEQ_8812F(x, v) \ -+ (BIT_CLEAR_RXVIQPKT_SEQ_8812F(x) | BIT_RXVIQPKT_SEQ_8812F(v)) -+ -+#define BIT_SHIFT_RXVOQPKT_SEQ_8812F 8 -+#define BIT_MASK_RXVOQPKT_SEQ_8812F 0xf -+#define BIT_RXVOQPKT_SEQ_8812F(x) \ -+ (((x) & BIT_MASK_RXVOQPKT_SEQ_8812F) << BIT_SHIFT_RXVOQPKT_SEQ_8812F) -+#define BITS_RXVOQPKT_SEQ_8812F \ -+ (BIT_MASK_RXVOQPKT_SEQ_8812F << BIT_SHIFT_RXVOQPKT_SEQ_8812F) -+#define BIT_CLEAR_RXVOQPKT_SEQ_8812F(x) ((x) & (~BITS_RXVOQPKT_SEQ_8812F)) -+#define BIT_GET_RXVOQPKT_SEQ_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXVOQPKT_SEQ_8812F) & BIT_MASK_RXVOQPKT_SEQ_8812F) -+#define BIT_SET_RXVOQPKT_SEQ_8812F(x, v) \ -+ (BIT_CLEAR_RXVOQPKT_SEQ_8812F(x) | BIT_RXVOQPKT_SEQ_8812F(v)) -+ -+#define BIT_RXBKQPKT_ERR_8812F BIT(7) -+#define BIT_RXBEQPKT_ERR_8812F BIT(6) -+#define BIT_RXVIQPKT_ERR_8812F BIT(5) -+#define BIT_RXVOQPKT_ERR_8812F BIT(4) -+#define BIT_RXDMA_MON_EN_8812F BIT(2) -+#define BIT_RXPKT_MON_RST_8812F BIT(1) -+#define BIT_RXPKT_MON_EN_8812F BIT(0) -+ -+/* 2 REG_STATE_MON_8812F */ -+ -+#define BIT_SHIFT_STATE_SEL_8812F 24 -+#define BIT_MASK_STATE_SEL_8812F 0x1f -+#define BIT_STATE_SEL_8812F(x) \ -+ (((x) & BIT_MASK_STATE_SEL_8812F) << BIT_SHIFT_STATE_SEL_8812F) -+#define BITS_STATE_SEL_8812F \ -+ (BIT_MASK_STATE_SEL_8812F << BIT_SHIFT_STATE_SEL_8812F) -+#define BIT_CLEAR_STATE_SEL_8812F(x) ((x) & (~BITS_STATE_SEL_8812F)) -+#define BIT_GET_STATE_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_STATE_SEL_8812F) & BIT_MASK_STATE_SEL_8812F) -+#define BIT_SET_STATE_SEL_8812F(x, v) \ -+ (BIT_CLEAR_STATE_SEL_8812F(x) | BIT_STATE_SEL_8812F(v)) -+ -+#define BIT_SHIFT_STATE_INFO_8812F 8 -+#define BIT_MASK_STATE_INFO_8812F 0xff -+#define BIT_STATE_INFO_8812F(x) \ -+ (((x) & BIT_MASK_STATE_INFO_8812F) << BIT_SHIFT_STATE_INFO_8812F) -+#define BITS_STATE_INFO_8812F \ -+ (BIT_MASK_STATE_INFO_8812F << BIT_SHIFT_STATE_INFO_8812F) -+#define BIT_CLEAR_STATE_INFO_8812F(x) ((x) & (~BITS_STATE_INFO_8812F)) -+#define BIT_GET_STATE_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_STATE_INFO_8812F) & BIT_MASK_STATE_INFO_8812F) -+#define BIT_SET_STATE_INFO_8812F(x, v) \ -+ (BIT_CLEAR_STATE_INFO_8812F(x) | BIT_STATE_INFO_8812F(v)) -+ -+#define BIT_UPD_NXT_STATE_8812F BIT(7) -+ -+#define BIT_SHIFT_CUR_STATE_8812F 0 -+#define BIT_MASK_CUR_STATE_8812F 0x7f -+#define BIT_CUR_STATE_8812F(x) \ -+ (((x) & BIT_MASK_CUR_STATE_8812F) << BIT_SHIFT_CUR_STATE_8812F) -+#define BITS_CUR_STATE_8812F \ -+ (BIT_MASK_CUR_STATE_8812F << BIT_SHIFT_CUR_STATE_8812F) -+#define BIT_CLEAR_CUR_STATE_8812F(x) ((x) & (~BITS_CUR_STATE_8812F)) -+#define BIT_GET_CUR_STATE_8812F(x) \ -+ (((x) >> BIT_SHIFT_CUR_STATE_8812F) & BIT_MASK_CUR_STATE_8812F) -+#define BIT_SET_CUR_STATE_8812F(x, v) \ -+ (BIT_CLEAR_CUR_STATE_8812F(x) | BIT_CUR_STATE_8812F(v)) -+ -+/* 2 REG_ERROR_MON_8812F */ -+#define BIT_CSIRPT_LEN_BB_MORE_THAN_MAC_8812F BIT(23) -+#define BIT_CSI_CHKSUM_ERROR_8812F BIT(22) -+#define BIT_MACRX_ERR_4_8812F BIT(20) -+#define BIT_MACRX_ERR_3_8812F BIT(19) -+#define BIT_MACRX_ERR_2_8812F BIT(18) -+#define BIT_MACRX_ERR_1_8812F BIT(17) -+#define BIT_MACRX_ERR_0_8812F BIT(16) -+#define BIT_WMAC_PRETX_ERRHDL_EN_8812F BIT(15) -+#define BIT_MACTX_ERR_5_8812F BIT(5) -+#define BIT_MACTX_ERR_4_8812F BIT(4) -+#define BIT_MACTX_ERR_3_8812F BIT(3) -+#define BIT_MACTX_ERR_2_8812F BIT(2) -+#define BIT_MACTX_ERR_1_8812F BIT(1) -+#define BIT_MACTX_ERR_0_8812F BIT(0) -+ -+/* 2 REG_SEARCH_MACID_8812F */ -+#define BIT_EN_TXRPTBUF_CLK_8812F BIT(31) -+ -+#define BIT_SHIFT_INFO_INDEX_OFFSET_8812F 16 -+#define BIT_MASK_INFO_INDEX_OFFSET_8812F 0x1fff -+#define BIT_INFO_INDEX_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_INFO_INDEX_OFFSET_8812F) \ -+ << BIT_SHIFT_INFO_INDEX_OFFSET_8812F) -+#define BITS_INFO_INDEX_OFFSET_8812F \ -+ (BIT_MASK_INFO_INDEX_OFFSET_8812F << BIT_SHIFT_INFO_INDEX_OFFSET_8812F) -+#define BIT_CLEAR_INFO_INDEX_OFFSET_8812F(x) \ -+ ((x) & (~BITS_INFO_INDEX_OFFSET_8812F)) -+#define BIT_GET_INFO_INDEX_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_INFO_INDEX_OFFSET_8812F) & \ -+ BIT_MASK_INFO_INDEX_OFFSET_8812F) -+#define BIT_SET_INFO_INDEX_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_INFO_INDEX_OFFSET_8812F(x) | BIT_INFO_INDEX_OFFSET_8812F(v)) -+ -+#define BIT_WMAC_SRCH_FIFOFULL_8812F BIT(15) -+#define BIT_DIS_INFOSRCH_8812F BIT(14) -+ -+#define BIT_SHIFT_INFO_ADDR_OFFSET_8812F 0 -+#define BIT_MASK_INFO_ADDR_OFFSET_8812F 0x1fff -+#define BIT_INFO_ADDR_OFFSET_8812F(x) \ -+ (((x) & BIT_MASK_INFO_ADDR_OFFSET_8812F) \ -+ << BIT_SHIFT_INFO_ADDR_OFFSET_8812F) -+#define BITS_INFO_ADDR_OFFSET_8812F \ -+ (BIT_MASK_INFO_ADDR_OFFSET_8812F << BIT_SHIFT_INFO_ADDR_OFFSET_8812F) -+#define BIT_CLEAR_INFO_ADDR_OFFSET_8812F(x) \ -+ ((x) & (~BITS_INFO_ADDR_OFFSET_8812F)) -+#define BIT_GET_INFO_ADDR_OFFSET_8812F(x) \ -+ (((x) >> BIT_SHIFT_INFO_ADDR_OFFSET_8812F) & \ -+ BIT_MASK_INFO_ADDR_OFFSET_8812F) -+#define BIT_SET_INFO_ADDR_OFFSET_8812F(x, v) \ -+ (BIT_CLEAR_INFO_ADDR_OFFSET_8812F(x) | BIT_INFO_ADDR_OFFSET_8812F(v)) -+ -+/* 2 REG_BT_COEX_TABLE_8812F (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_COEX_TABLE_1_8812F 0 -+#define BIT_MASK_COEX_TABLE_1_8812F 0xffffffffL -+#define BIT_COEX_TABLE_1_8812F(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_1_8812F) << BIT_SHIFT_COEX_TABLE_1_8812F) -+#define BITS_COEX_TABLE_1_8812F \ -+ (BIT_MASK_COEX_TABLE_1_8812F << BIT_SHIFT_COEX_TABLE_1_8812F) -+#define BIT_CLEAR_COEX_TABLE_1_8812F(x) ((x) & (~BITS_COEX_TABLE_1_8812F)) -+#define BIT_GET_COEX_TABLE_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_1_8812F) & BIT_MASK_COEX_TABLE_1_8812F) -+#define BIT_SET_COEX_TABLE_1_8812F(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_1_8812F(x) | BIT_COEX_TABLE_1_8812F(v)) -+ -+/* 2 REG_BT_COEX_TABLE2_8812F (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_COEX_TABLE_2_8812F 0 -+#define BIT_MASK_COEX_TABLE_2_8812F 0xffffffffL -+#define BIT_COEX_TABLE_2_8812F(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_2_8812F) << BIT_SHIFT_COEX_TABLE_2_8812F) -+#define BITS_COEX_TABLE_2_8812F \ -+ (BIT_MASK_COEX_TABLE_2_8812F << BIT_SHIFT_COEX_TABLE_2_8812F) -+#define BIT_CLEAR_COEX_TABLE_2_8812F(x) ((x) & (~BITS_COEX_TABLE_2_8812F)) -+#define BIT_GET_COEX_TABLE_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_2_8812F) & BIT_MASK_COEX_TABLE_2_8812F) -+#define BIT_SET_COEX_TABLE_2_8812F(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_2_8812F(x) | BIT_COEX_TABLE_2_8812F(v)) -+ -+/* 2 REG_BT_COEX_BREAK_TABLE_8812F (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_BREAK_TABLE_2_8812F 16 -+#define BIT_MASK_BREAK_TABLE_2_8812F 0xffff -+#define BIT_BREAK_TABLE_2_8812F(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_2_8812F) << BIT_SHIFT_BREAK_TABLE_2_8812F) -+#define BITS_BREAK_TABLE_2_8812F \ -+ (BIT_MASK_BREAK_TABLE_2_8812F << BIT_SHIFT_BREAK_TABLE_2_8812F) -+#define BIT_CLEAR_BREAK_TABLE_2_8812F(x) ((x) & (~BITS_BREAK_TABLE_2_8812F)) -+#define BIT_GET_BREAK_TABLE_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_2_8812F) & BIT_MASK_BREAK_TABLE_2_8812F) -+#define BIT_SET_BREAK_TABLE_2_8812F(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_2_8812F(x) | BIT_BREAK_TABLE_2_8812F(v)) -+ -+#define BIT_SHIFT_BREAK_TABLE_1_8812F 0 -+#define BIT_MASK_BREAK_TABLE_1_8812F 0xffff -+#define BIT_BREAK_TABLE_1_8812F(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_1_8812F) << BIT_SHIFT_BREAK_TABLE_1_8812F) -+#define BITS_BREAK_TABLE_1_8812F \ -+ (BIT_MASK_BREAK_TABLE_1_8812F << BIT_SHIFT_BREAK_TABLE_1_8812F) -+#define BIT_CLEAR_BREAK_TABLE_1_8812F(x) ((x) & (~BITS_BREAK_TABLE_1_8812F)) -+#define BIT_GET_BREAK_TABLE_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_1_8812F) & BIT_MASK_BREAK_TABLE_1_8812F) -+#define BIT_SET_BREAK_TABLE_1_8812F(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_1_8812F(x) | BIT_BREAK_TABLE_1_8812F(v)) -+ -+/* 2 REG_BT_COEX_TABLE_H_8812F (BT-COEXISTENCE CONTROL REGISTER) */ -+#define BIT_PRI_MASK_RX_RESP_V1_8812F BIT(30) -+#define BIT_PRI_MASK_RXOFDM_V1_8812F BIT(29) -+#define BIT_PRI_MASK_RXCCK_V1_8812F BIT(28) -+ -+#define BIT_SHIFT_PRI_MASK_TXAC_8812F 21 -+#define BIT_MASK_PRI_MASK_TXAC_8812F 0x7f -+#define BIT_PRI_MASK_TXAC_8812F(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TXAC_8812F) << BIT_SHIFT_PRI_MASK_TXAC_8812F) -+#define BITS_PRI_MASK_TXAC_8812F \ -+ (BIT_MASK_PRI_MASK_TXAC_8812F << BIT_SHIFT_PRI_MASK_TXAC_8812F) -+#define BIT_CLEAR_PRI_MASK_TXAC_8812F(x) ((x) & (~BITS_PRI_MASK_TXAC_8812F)) -+#define BIT_GET_PRI_MASK_TXAC_8812F(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TXAC_8812F) & BIT_MASK_PRI_MASK_TXAC_8812F) -+#define BIT_SET_PRI_MASK_TXAC_8812F(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TXAC_8812F(x) | BIT_PRI_MASK_TXAC_8812F(v)) -+ -+#define BIT_SHIFT_PRI_MASK_NAV_8812F 13 -+#define BIT_MASK_PRI_MASK_NAV_8812F 0xff -+#define BIT_PRI_MASK_NAV_8812F(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NAV_8812F) << BIT_SHIFT_PRI_MASK_NAV_8812F) -+#define BITS_PRI_MASK_NAV_8812F \ -+ (BIT_MASK_PRI_MASK_NAV_8812F << BIT_SHIFT_PRI_MASK_NAV_8812F) -+#define BIT_CLEAR_PRI_MASK_NAV_8812F(x) ((x) & (~BITS_PRI_MASK_NAV_8812F)) -+#define BIT_GET_PRI_MASK_NAV_8812F(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NAV_8812F) & BIT_MASK_PRI_MASK_NAV_8812F) -+#define BIT_SET_PRI_MASK_NAV_8812F(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NAV_8812F(x) | BIT_PRI_MASK_NAV_8812F(v)) -+ -+#define BIT_PRI_MASK_CCK_V1_8812F BIT(12) -+#define BIT_PRI_MASK_OFDM_V1_8812F BIT(11) -+#define BIT_PRI_MASK_RTY_V1_8812F BIT(10) -+ -+#define BIT_SHIFT_PRI_MASK_NUM_8812F 6 -+#define BIT_MASK_PRI_MASK_NUM_8812F 0xf -+#define BIT_PRI_MASK_NUM_8812F(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NUM_8812F) << BIT_SHIFT_PRI_MASK_NUM_8812F) -+#define BITS_PRI_MASK_NUM_8812F \ -+ (BIT_MASK_PRI_MASK_NUM_8812F << BIT_SHIFT_PRI_MASK_NUM_8812F) -+#define BIT_CLEAR_PRI_MASK_NUM_8812F(x) ((x) & (~BITS_PRI_MASK_NUM_8812F)) -+#define BIT_GET_PRI_MASK_NUM_8812F(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NUM_8812F) & BIT_MASK_PRI_MASK_NUM_8812F) -+#define BIT_SET_PRI_MASK_NUM_8812F(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NUM_8812F(x) | BIT_PRI_MASK_NUM_8812F(v)) -+ -+#define BIT_SHIFT_PRI_MASK_TYPE_8812F 2 -+#define BIT_MASK_PRI_MASK_TYPE_8812F 0xf -+#define BIT_PRI_MASK_TYPE_8812F(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TYPE_8812F) << BIT_SHIFT_PRI_MASK_TYPE_8812F) -+#define BITS_PRI_MASK_TYPE_8812F \ -+ (BIT_MASK_PRI_MASK_TYPE_8812F << BIT_SHIFT_PRI_MASK_TYPE_8812F) -+#define BIT_CLEAR_PRI_MASK_TYPE_8812F(x) ((x) & (~BITS_PRI_MASK_TYPE_8812F)) -+#define BIT_GET_PRI_MASK_TYPE_8812F(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TYPE_8812F) & BIT_MASK_PRI_MASK_TYPE_8812F) -+#define BIT_SET_PRI_MASK_TYPE_8812F(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TYPE_8812F(x) | BIT_PRI_MASK_TYPE_8812F(v)) -+ -+#define BIT_OOB_V1_8812F BIT(1) -+#define BIT_ANT_SEL_V1_8812F BIT(0) -+ -+/* 2 REG_RXCMD_0_8812F */ -+#define BIT_RXCMD_EN_8812F BIT(31) -+ -+#define BIT_SHIFT_RXCMD_INFO_8812F 0 -+#define BIT_MASK_RXCMD_INFO_8812F 0x7fffffffL -+#define BIT_RXCMD_INFO_8812F(x) \ -+ (((x) & BIT_MASK_RXCMD_INFO_8812F) << BIT_SHIFT_RXCMD_INFO_8812F) -+#define BITS_RXCMD_INFO_8812F \ -+ (BIT_MASK_RXCMD_INFO_8812F << BIT_SHIFT_RXCMD_INFO_8812F) -+#define BIT_CLEAR_RXCMD_INFO_8812F(x) ((x) & (~BITS_RXCMD_INFO_8812F)) -+#define BIT_GET_RXCMD_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_INFO_8812F) & BIT_MASK_RXCMD_INFO_8812F) -+#define BIT_SET_RXCMD_INFO_8812F(x, v) \ -+ (BIT_CLEAR_RXCMD_INFO_8812F(x) | BIT_RXCMD_INFO_8812F(v)) -+ -+/* 2 REG_RXCMD_1_8812F */ -+ -+#define BIT_SHIFT_RXCMD_PRD_8812F 0 -+#define BIT_MASK_RXCMD_PRD_8812F 0xffff -+#define BIT_RXCMD_PRD_8812F(x) \ -+ (((x) & BIT_MASK_RXCMD_PRD_8812F) << BIT_SHIFT_RXCMD_PRD_8812F) -+#define BITS_RXCMD_PRD_8812F \ -+ (BIT_MASK_RXCMD_PRD_8812F << BIT_SHIFT_RXCMD_PRD_8812F) -+#define BIT_CLEAR_RXCMD_PRD_8812F(x) ((x) & (~BITS_RXCMD_PRD_8812F)) -+#define BIT_GET_RXCMD_PRD_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_PRD_8812F) & BIT_MASK_RXCMD_PRD_8812F) -+#define BIT_SET_RXCMD_PRD_8812F(x, v) \ -+ (BIT_CLEAR_RXCMD_PRD_8812F(x) | BIT_RXCMD_PRD_8812F(v)) -+ -+/* 2 REG_WMAC_RESP_TXINFO_8812F (RESPONSE TXINFO REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_MFB_8812F 25 -+#define BIT_MASK_WMAC_RESP_MFB_8812F 0x7f -+#define BIT_WMAC_RESP_MFB_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_MFB_8812F) << BIT_SHIFT_WMAC_RESP_MFB_8812F) -+#define BITS_WMAC_RESP_MFB_8812F \ -+ (BIT_MASK_WMAC_RESP_MFB_8812F << BIT_SHIFT_WMAC_RESP_MFB_8812F) -+#define BIT_CLEAR_WMAC_RESP_MFB_8812F(x) ((x) & (~BITS_WMAC_RESP_MFB_8812F)) -+#define BIT_GET_WMAC_RESP_MFB_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_MFB_8812F) & BIT_MASK_WMAC_RESP_MFB_8812F) -+#define BIT_SET_WMAC_RESP_MFB_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_MFB_8812F(x) | BIT_WMAC_RESP_MFB_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_ANTINF_SEL_8812F 23 -+#define BIT_MASK_WMAC_ANTINF_SEL_8812F 0x3 -+#define BIT_WMAC_ANTINF_SEL_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_ANTINF_SEL_8812F) \ -+ << BIT_SHIFT_WMAC_ANTINF_SEL_8812F) -+#define BITS_WMAC_ANTINF_SEL_8812F \ -+ (BIT_MASK_WMAC_ANTINF_SEL_8812F << BIT_SHIFT_WMAC_ANTINF_SEL_8812F) -+#define BIT_CLEAR_WMAC_ANTINF_SEL_8812F(x) ((x) & (~BITS_WMAC_ANTINF_SEL_8812F)) -+#define BIT_GET_WMAC_ANTINF_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTINF_SEL_8812F) & \ -+ BIT_MASK_WMAC_ANTINF_SEL_8812F) -+#define BIT_SET_WMAC_ANTINF_SEL_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_ANTINF_SEL_8812F(x) | BIT_WMAC_ANTINF_SEL_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_ANTSEL_SEL_8812F 21 -+#define BIT_MASK_WMAC_ANTSEL_SEL_8812F 0x3 -+#define BIT_WMAC_ANTSEL_SEL_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_ANTSEL_SEL_8812F) \ -+ << BIT_SHIFT_WMAC_ANTSEL_SEL_8812F) -+#define BITS_WMAC_ANTSEL_SEL_8812F \ -+ (BIT_MASK_WMAC_ANTSEL_SEL_8812F << BIT_SHIFT_WMAC_ANTSEL_SEL_8812F) -+#define BIT_CLEAR_WMAC_ANTSEL_SEL_8812F(x) ((x) & (~BITS_WMAC_ANTSEL_SEL_8812F)) -+#define BIT_GET_WMAC_ANTSEL_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTSEL_SEL_8812F) & \ -+ BIT_MASK_WMAC_ANTSEL_SEL_8812F) -+#define BIT_SET_WMAC_ANTSEL_SEL_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_ANTSEL_SEL_8812F(x) | BIT_WMAC_ANTSEL_SEL_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F 18 -+#define BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F 0x3 -+#define BIT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F) \ -+ << BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F) -+#define BITS_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F \ -+ (BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F \ -+ << BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F) -+#define BIT_CLEAR_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F)) -+#define BIT_GET_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F) & \ -+ BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F) -+#define BIT_SET_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F(x) | \ -+ BIT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXANT_V1_8812F 6 -+#define BIT_MASK_WMAC_RESP_TXANT_V1_8812F 0xfff -+#define BIT_WMAC_RESP_TXANT_V1_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXANT_V1_8812F) \ -+ << BIT_SHIFT_WMAC_RESP_TXANT_V1_8812F) -+#define BITS_WMAC_RESP_TXANT_V1_8812F \ -+ (BIT_MASK_WMAC_RESP_TXANT_V1_8812F \ -+ << BIT_SHIFT_WMAC_RESP_TXANT_V1_8812F) -+#define BIT_CLEAR_WMAC_RESP_TXANT_V1_8812F(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXANT_V1_8812F)) -+#define BIT_GET_WMAC_RESP_TXANT_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXANT_V1_8812F) & \ -+ BIT_MASK_WMAC_RESP_TXANT_V1_8812F) -+#define BIT_SET_WMAC_RESP_TXANT_V1_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXANT_V1_8812F(x) | \ -+ BIT_WMAC_RESP_TXANT_V1_8812F(v)) -+ -+/* 2 REG_BBPSF_CTRL_8812F */ -+#define BIT_CTL_IDLE_CLR_CSI_RPT_8812F BIT(31) -+#define BIT_WMAC_USE_NDPARATE_8812F BIT(30) -+ -+#define BIT_SHIFT_WMAC_CSI_RATE_8812F 24 -+#define BIT_MASK_WMAC_CSI_RATE_8812F 0x3f -+#define BIT_WMAC_CSI_RATE_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_CSI_RATE_8812F) << BIT_SHIFT_WMAC_CSI_RATE_8812F) -+#define BITS_WMAC_CSI_RATE_8812F \ -+ (BIT_MASK_WMAC_CSI_RATE_8812F << BIT_SHIFT_WMAC_CSI_RATE_8812F) -+#define BIT_CLEAR_WMAC_CSI_RATE_8812F(x) ((x) & (~BITS_WMAC_CSI_RATE_8812F)) -+#define BIT_GET_WMAC_CSI_RATE_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_CSI_RATE_8812F) & BIT_MASK_WMAC_CSI_RATE_8812F) -+#define BIT_SET_WMAC_CSI_RATE_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_CSI_RATE_8812F(x) | BIT_WMAC_CSI_RATE_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXRATE_8812F 16 -+#define BIT_MASK_WMAC_RESP_TXRATE_8812F 0xff -+#define BIT_WMAC_RESP_TXRATE_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXRATE_8812F) \ -+ << BIT_SHIFT_WMAC_RESP_TXRATE_8812F) -+#define BITS_WMAC_RESP_TXRATE_8812F \ -+ (BIT_MASK_WMAC_RESP_TXRATE_8812F << BIT_SHIFT_WMAC_RESP_TXRATE_8812F) -+#define BIT_CLEAR_WMAC_RESP_TXRATE_8812F(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXRATE_8812F)) -+#define BIT_GET_WMAC_RESP_TXRATE_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXRATE_8812F) & \ -+ BIT_MASK_WMAC_RESP_TXRATE_8812F) -+#define BIT_SET_WMAC_RESP_TXRATE_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXRATE_8812F(x) | BIT_WMAC_RESP_TXRATE_8812F(v)) -+ -+#define BIT_SHIFT_CSI_RSC_8812F 13 -+#define BIT_MASK_CSI_RSC_8812F 0x3 -+#define BIT_CSI_RSC_8812F(x) \ -+ (((x) & BIT_MASK_CSI_RSC_8812F) << BIT_SHIFT_CSI_RSC_8812F) -+#define BITS_CSI_RSC_8812F (BIT_MASK_CSI_RSC_8812F << BIT_SHIFT_CSI_RSC_8812F) -+#define BIT_CLEAR_CSI_RSC_8812F(x) ((x) & (~BITS_CSI_RSC_8812F)) -+#define BIT_GET_CSI_RSC_8812F(x) \ -+ (((x) >> BIT_SHIFT_CSI_RSC_8812F) & BIT_MASK_CSI_RSC_8812F) -+#define BIT_SET_CSI_RSC_8812F(x, v) \ -+ (BIT_CLEAR_CSI_RSC_8812F(x) | BIT_CSI_RSC_8812F(v)) -+ -+#define BIT_CSI_GID_SEL_8812F BIT(12) -+#define BIT_NDPVLD_PROTECT_RDRDY_DIS_8812F BIT(9) -+#define BIT_RDCSI_EMPTY_APPZERO_8812F BIT(8) -+#define BIT_CSI_RATE_FB_EN_8812F BIT(7) -+#define BIT_RXFIFO_WRPTR_WO_CHKSUM_8812F BIT(6) -+ -+/* 2 REG_P2P_RX_BCN_NOA_8812F (P2P RX BEACON NOA REGISTER) */ -+#define BIT_NOA_PARSER_EN_8812F BIT(15) -+ -+#define BIT_SHIFT_BSSID_SEL_V1_8812F 12 -+#define BIT_MASK_BSSID_SEL_V1_8812F 0x7 -+#define BIT_BSSID_SEL_V1_8812F(x) \ -+ (((x) & BIT_MASK_BSSID_SEL_V1_8812F) << BIT_SHIFT_BSSID_SEL_V1_8812F) -+#define BITS_BSSID_SEL_V1_8812F \ -+ (BIT_MASK_BSSID_SEL_V1_8812F << BIT_SHIFT_BSSID_SEL_V1_8812F) -+#define BIT_CLEAR_BSSID_SEL_V1_8812F(x) ((x) & (~BITS_BSSID_SEL_V1_8812F)) -+#define BIT_GET_BSSID_SEL_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID_SEL_V1_8812F) & BIT_MASK_BSSID_SEL_V1_8812F) -+#define BIT_SET_BSSID_SEL_V1_8812F(x, v) \ -+ (BIT_CLEAR_BSSID_SEL_V1_8812F(x) | BIT_BSSID_SEL_V1_8812F(v)) -+ -+#define BIT_SHIFT_P2P_OUI_TYPE_8812F 0 -+#define BIT_MASK_P2P_OUI_TYPE_8812F 0xff -+#define BIT_P2P_OUI_TYPE_8812F(x) \ -+ (((x) & BIT_MASK_P2P_OUI_TYPE_8812F) << BIT_SHIFT_P2P_OUI_TYPE_8812F) -+#define BITS_P2P_OUI_TYPE_8812F \ -+ (BIT_MASK_P2P_OUI_TYPE_8812F << BIT_SHIFT_P2P_OUI_TYPE_8812F) -+#define BIT_CLEAR_P2P_OUI_TYPE_8812F(x) ((x) & (~BITS_P2P_OUI_TYPE_8812F)) -+#define BIT_GET_P2P_OUI_TYPE_8812F(x) \ -+ (((x) >> BIT_SHIFT_P2P_OUI_TYPE_8812F) & BIT_MASK_P2P_OUI_TYPE_8812F) -+#define BIT_SET_P2P_OUI_TYPE_8812F(x, v) \ -+ (BIT_CLEAR_P2P_OUI_TYPE_8812F(x) | BIT_P2P_OUI_TYPE_8812F(v)) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_8812F (ASSOCIATED BEAMFORMER0 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8812F 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8812F 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_V1_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8812F) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8812F) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_V1_8812F \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8812F \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8812F) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_V1_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_V1_8812F)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8812F) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8812F) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_V1_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_V1_8812F(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_V1_8812F(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_H_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID0_8812F 16 -+#define BIT_MASK_R_WMAC_TXCSI_AID0_8812F 0x1ff -+#define BIT_R_WMAC_TXCSI_AID0_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID0_8812F) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID0_8812F) -+#define BITS_R_WMAC_TXCSI_AID0_8812F \ -+ (BIT_MASK_R_WMAC_TXCSI_AID0_8812F << BIT_SHIFT_R_WMAC_TXCSI_AID0_8812F) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID0_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID0_8812F)) -+#define BIT_GET_R_WMAC_TXCSI_AID0_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID0_8812F) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID0_8812F) -+#define BIT_SET_R_WMAC_TXCSI_AID0_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID0_8812F(x) | BIT_R_WMAC_TXCSI_AID0_8812F(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8812F(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8812F 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8812F 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_V1_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8812F) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8812F) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_V1_8812F \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8812F \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8812F) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V1_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_V1_8812F)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8812F) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8812F) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_V1_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V1_8812F(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_V1_8812F(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_H_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID1_8812F 16 -+#define BIT_MASK_R_WMAC_TXCSI_AID1_8812F 0x1ff -+#define BIT_R_WMAC_TXCSI_AID1_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID1_8812F) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID1_8812F) -+#define BITS_R_WMAC_TXCSI_AID1_8812F \ -+ (BIT_MASK_R_WMAC_TXCSI_AID1_8812F << BIT_SHIFT_R_WMAC_TXCSI_AID1_8812F) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID1_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID1_8812F)) -+#define BIT_GET_R_WMAC_TXCSI_AID1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID1_8812F) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID1_8812F) -+#define BIT_SET_R_WMAC_TXCSI_AID1_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID1_8812F(x) | BIT_R_WMAC_TXCSI_AID1_8812F(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8812F(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW20_8812F (TX CSI REPORT PARAMETER REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_1_8812F 16 -+#define BIT_MASK_R_WMAC_BFINFO_20M_1_8812F 0xfff -+#define BIT_R_WMAC_BFINFO_20M_1_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_1_8812F) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8812F) -+#define BITS_R_WMAC_BFINFO_20M_1_8812F \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_1_8812F \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8812F) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_1_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_1_8812F)) -+#define BIT_GET_R_WMAC_BFINFO_20M_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_1_8812F) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_1_8812F) -+#define BIT_SET_R_WMAC_BFINFO_20M_1_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_1_8812F(x) | \ -+ BIT_R_WMAC_BFINFO_20M_1_8812F(v)) -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_0_8812F 0 -+#define BIT_MASK_R_WMAC_BFINFO_20M_0_8812F 0xfff -+#define BIT_R_WMAC_BFINFO_20M_0_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_0_8812F) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8812F) -+#define BITS_R_WMAC_BFINFO_20M_0_8812F \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_0_8812F \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8812F) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_0_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_0_8812F)) -+#define BIT_GET_R_WMAC_BFINFO_20M_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_0_8812F) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_0_8812F) -+#define BIT_SET_R_WMAC_BFINFO_20M_0_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_0_8812F(x) | \ -+ BIT_R_WMAC_BFINFO_20M_0_8812F(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW40_8812F (TX CSI REPORT PARAMETER_BW40 REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_ANTD_8812F 12 -+#define BIT_MASK_WMAC_RESP_ANTD_8812F 0xf -+#define BIT_WMAC_RESP_ANTD_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTD_8812F) \ -+ << BIT_SHIFT_WMAC_RESP_ANTD_8812F) -+#define BITS_WMAC_RESP_ANTD_8812F \ -+ (BIT_MASK_WMAC_RESP_ANTD_8812F << BIT_SHIFT_WMAC_RESP_ANTD_8812F) -+#define BIT_CLEAR_WMAC_RESP_ANTD_8812F(x) ((x) & (~BITS_WMAC_RESP_ANTD_8812F)) -+#define BIT_GET_WMAC_RESP_ANTD_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTD_8812F) & \ -+ BIT_MASK_WMAC_RESP_ANTD_8812F) -+#define BIT_SET_WMAC_RESP_ANTD_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTD_8812F(x) | BIT_WMAC_RESP_ANTD_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTC_8812F 8 -+#define BIT_MASK_WMAC_RESP_ANTC_8812F 0xf -+#define BIT_WMAC_RESP_ANTC_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTC_8812F) \ -+ << BIT_SHIFT_WMAC_RESP_ANTC_8812F) -+#define BITS_WMAC_RESP_ANTC_8812F \ -+ (BIT_MASK_WMAC_RESP_ANTC_8812F << BIT_SHIFT_WMAC_RESP_ANTC_8812F) -+#define BIT_CLEAR_WMAC_RESP_ANTC_8812F(x) ((x) & (~BITS_WMAC_RESP_ANTC_8812F)) -+#define BIT_GET_WMAC_RESP_ANTC_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTC_8812F) & \ -+ BIT_MASK_WMAC_RESP_ANTC_8812F) -+#define BIT_SET_WMAC_RESP_ANTC_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTC_8812F(x) | BIT_WMAC_RESP_ANTC_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTB_8812F 4 -+#define BIT_MASK_WMAC_RESP_ANTB_8812F 0xf -+#define BIT_WMAC_RESP_ANTB_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTB_8812F) \ -+ << BIT_SHIFT_WMAC_RESP_ANTB_8812F) -+#define BITS_WMAC_RESP_ANTB_8812F \ -+ (BIT_MASK_WMAC_RESP_ANTB_8812F << BIT_SHIFT_WMAC_RESP_ANTB_8812F) -+#define BIT_CLEAR_WMAC_RESP_ANTB_8812F(x) ((x) & (~BITS_WMAC_RESP_ANTB_8812F)) -+#define BIT_GET_WMAC_RESP_ANTB_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTB_8812F) & \ -+ BIT_MASK_WMAC_RESP_ANTB_8812F) -+#define BIT_SET_WMAC_RESP_ANTB_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTB_8812F(x) | BIT_WMAC_RESP_ANTB_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTA_8812F 0 -+#define BIT_MASK_WMAC_RESP_ANTA_8812F 0xf -+#define BIT_WMAC_RESP_ANTA_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTA_8812F) \ -+ << BIT_SHIFT_WMAC_RESP_ANTA_8812F) -+#define BITS_WMAC_RESP_ANTA_8812F \ -+ (BIT_MASK_WMAC_RESP_ANTA_8812F << BIT_SHIFT_WMAC_RESP_ANTA_8812F) -+#define BIT_CLEAR_WMAC_RESP_ANTA_8812F(x) ((x) & (~BITS_WMAC_RESP_ANTA_8812F)) -+#define BIT_GET_WMAC_RESP_ANTA_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTA_8812F) & \ -+ BIT_MASK_WMAC_RESP_ANTA_8812F) -+#define BIT_SET_WMAC_RESP_ANTA_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTA_8812F(x) | BIT_WMAC_RESP_ANTA_8812F(v)) -+ -+/* 2 REG_CSI_PTR_8812F */ -+ -+#define BIT_SHIFT_CSI_RADDR_LATCH_V2_8812F 16 -+#define BIT_MASK_CSI_RADDR_LATCH_V2_8812F 0xffff -+#define BIT_CSI_RADDR_LATCH_V2_8812F(x) \ -+ (((x) & BIT_MASK_CSI_RADDR_LATCH_V2_8812F) \ -+ << BIT_SHIFT_CSI_RADDR_LATCH_V2_8812F) -+#define BITS_CSI_RADDR_LATCH_V2_8812F \ -+ (BIT_MASK_CSI_RADDR_LATCH_V2_8812F \ -+ << BIT_SHIFT_CSI_RADDR_LATCH_V2_8812F) -+#define BIT_CLEAR_CSI_RADDR_LATCH_V2_8812F(x) \ -+ ((x) & (~BITS_CSI_RADDR_LATCH_V2_8812F)) -+#define BIT_GET_CSI_RADDR_LATCH_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_CSI_RADDR_LATCH_V2_8812F) & \ -+ BIT_MASK_CSI_RADDR_LATCH_V2_8812F) -+#define BIT_SET_CSI_RADDR_LATCH_V2_8812F(x, v) \ -+ (BIT_CLEAR_CSI_RADDR_LATCH_V2_8812F(x) | \ -+ BIT_CSI_RADDR_LATCH_V2_8812F(v)) -+ -+#define BIT_SHIFT_CSI_WADDR_LATCH_V2_8812F 0 -+#define BIT_MASK_CSI_WADDR_LATCH_V2_8812F 0xffff -+#define BIT_CSI_WADDR_LATCH_V2_8812F(x) \ -+ (((x) & BIT_MASK_CSI_WADDR_LATCH_V2_8812F) \ -+ << BIT_SHIFT_CSI_WADDR_LATCH_V2_8812F) -+#define BITS_CSI_WADDR_LATCH_V2_8812F \ -+ (BIT_MASK_CSI_WADDR_LATCH_V2_8812F \ -+ << BIT_SHIFT_CSI_WADDR_LATCH_V2_8812F) -+#define BIT_CLEAR_CSI_WADDR_LATCH_V2_8812F(x) \ -+ ((x) & (~BITS_CSI_WADDR_LATCH_V2_8812F)) -+#define BIT_GET_CSI_WADDR_LATCH_V2_8812F(x) \ -+ (((x) >> BIT_SHIFT_CSI_WADDR_LATCH_V2_8812F) & \ -+ BIT_MASK_CSI_WADDR_LATCH_V2_8812F) -+#define BIT_SET_CSI_WADDR_LATCH_V2_8812F(x, v) \ -+ (BIT_CLEAR_CSI_WADDR_LATCH_V2_8812F(x) | \ -+ BIT_CSI_WADDR_LATCH_V2_8812F(v)) -+ -+/* 2 REG_BCN_PSR_RPT2_8812F (BEACON PARSER REPORT REGISTER2) */ -+ -+#define BIT_SHIFT_DTIM_CNT2_8812F 24 -+#define BIT_MASK_DTIM_CNT2_8812F 0xff -+#define BIT_DTIM_CNT2_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_CNT2_8812F) << BIT_SHIFT_DTIM_CNT2_8812F) -+#define BITS_DTIM_CNT2_8812F \ -+ (BIT_MASK_DTIM_CNT2_8812F << BIT_SHIFT_DTIM_CNT2_8812F) -+#define BIT_CLEAR_DTIM_CNT2_8812F(x) ((x) & (~BITS_DTIM_CNT2_8812F)) -+#define BIT_GET_DTIM_CNT2_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT2_8812F) & BIT_MASK_DTIM_CNT2_8812F) -+#define BIT_SET_DTIM_CNT2_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_CNT2_8812F(x) | BIT_DTIM_CNT2_8812F(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD2_8812F 16 -+#define BIT_MASK_DTIM_PERIOD2_8812F 0xff -+#define BIT_DTIM_PERIOD2_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD2_8812F) << BIT_SHIFT_DTIM_PERIOD2_8812F) -+#define BITS_DTIM_PERIOD2_8812F \ -+ (BIT_MASK_DTIM_PERIOD2_8812F << BIT_SHIFT_DTIM_PERIOD2_8812F) -+#define BIT_CLEAR_DTIM_PERIOD2_8812F(x) ((x) & (~BITS_DTIM_PERIOD2_8812F)) -+#define BIT_GET_DTIM_PERIOD2_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD2_8812F) & BIT_MASK_DTIM_PERIOD2_8812F) -+#define BIT_SET_DTIM_PERIOD2_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD2_8812F(x) | BIT_DTIM_PERIOD2_8812F(v)) -+ -+#define BIT_DTIM2_8812F BIT(15) -+#define BIT_TIM2_8812F BIT(14) -+#define BIT_RPT_VALID_8812F BIT(13) -+ -+#define BIT_SHIFT_PS_AID_2_8812F 0 -+#define BIT_MASK_PS_AID_2_8812F 0x7ff -+#define BIT_PS_AID_2_8812F(x) \ -+ (((x) & BIT_MASK_PS_AID_2_8812F) << BIT_SHIFT_PS_AID_2_8812F) -+#define BITS_PS_AID_2_8812F \ -+ (BIT_MASK_PS_AID_2_8812F << BIT_SHIFT_PS_AID_2_8812F) -+#define BIT_CLEAR_PS_AID_2_8812F(x) ((x) & (~BITS_PS_AID_2_8812F)) -+#define BIT_GET_PS_AID_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_2_8812F) & BIT_MASK_PS_AID_2_8812F) -+#define BIT_SET_PS_AID_2_8812F(x, v) \ -+ (BIT_CLEAR_PS_AID_2_8812F(x) | BIT_PS_AID_2_8812F(v)) -+ -+/* 2 REG_BCN_PSR_RPT3_8812F (BEACON PARSER REPORT REGISTER3) */ -+ -+#define BIT_SHIFT_DTIM_CNT3_8812F 24 -+#define BIT_MASK_DTIM_CNT3_8812F 0xff -+#define BIT_DTIM_CNT3_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_CNT3_8812F) << BIT_SHIFT_DTIM_CNT3_8812F) -+#define BITS_DTIM_CNT3_8812F \ -+ (BIT_MASK_DTIM_CNT3_8812F << BIT_SHIFT_DTIM_CNT3_8812F) -+#define BIT_CLEAR_DTIM_CNT3_8812F(x) ((x) & (~BITS_DTIM_CNT3_8812F)) -+#define BIT_GET_DTIM_CNT3_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT3_8812F) & BIT_MASK_DTIM_CNT3_8812F) -+#define BIT_SET_DTIM_CNT3_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_CNT3_8812F(x) | BIT_DTIM_CNT3_8812F(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD3_8812F 16 -+#define BIT_MASK_DTIM_PERIOD3_8812F 0xff -+#define BIT_DTIM_PERIOD3_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD3_8812F) << BIT_SHIFT_DTIM_PERIOD3_8812F) -+#define BITS_DTIM_PERIOD3_8812F \ -+ (BIT_MASK_DTIM_PERIOD3_8812F << BIT_SHIFT_DTIM_PERIOD3_8812F) -+#define BIT_CLEAR_DTIM_PERIOD3_8812F(x) ((x) & (~BITS_DTIM_PERIOD3_8812F)) -+#define BIT_GET_DTIM_PERIOD3_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD3_8812F) & BIT_MASK_DTIM_PERIOD3_8812F) -+#define BIT_SET_DTIM_PERIOD3_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD3_8812F(x) | BIT_DTIM_PERIOD3_8812F(v)) -+ -+#define BIT_DTIM3_8812F BIT(15) -+#define BIT_TIM3_8812F BIT(14) -+#define BIT_RPT_VALID_8812F BIT(13) -+ -+#define BIT_SHIFT_PS_AID_3_8812F 0 -+#define BIT_MASK_PS_AID_3_8812F 0x7ff -+#define BIT_PS_AID_3_8812F(x) \ -+ (((x) & BIT_MASK_PS_AID_3_8812F) << BIT_SHIFT_PS_AID_3_8812F) -+#define BITS_PS_AID_3_8812F \ -+ (BIT_MASK_PS_AID_3_8812F << BIT_SHIFT_PS_AID_3_8812F) -+#define BIT_CLEAR_PS_AID_3_8812F(x) ((x) & (~BITS_PS_AID_3_8812F)) -+#define BIT_GET_PS_AID_3_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_3_8812F) & BIT_MASK_PS_AID_3_8812F) -+#define BIT_SET_PS_AID_3_8812F(x, v) \ -+ (BIT_CLEAR_PS_AID_3_8812F(x) | BIT_PS_AID_3_8812F(v)) -+ -+/* 2 REG_BCN_PSR_RPT4_8812F (BEACON PARSER REPORT REGISTER4) */ -+ -+#define BIT_SHIFT_DTIM_CNT4_8812F 24 -+#define BIT_MASK_DTIM_CNT4_8812F 0xff -+#define BIT_DTIM_CNT4_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_CNT4_8812F) << BIT_SHIFT_DTIM_CNT4_8812F) -+#define BITS_DTIM_CNT4_8812F \ -+ (BIT_MASK_DTIM_CNT4_8812F << BIT_SHIFT_DTIM_CNT4_8812F) -+#define BIT_CLEAR_DTIM_CNT4_8812F(x) ((x) & (~BITS_DTIM_CNT4_8812F)) -+#define BIT_GET_DTIM_CNT4_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT4_8812F) & BIT_MASK_DTIM_CNT4_8812F) -+#define BIT_SET_DTIM_CNT4_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_CNT4_8812F(x) | BIT_DTIM_CNT4_8812F(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD4_8812F 16 -+#define BIT_MASK_DTIM_PERIOD4_8812F 0xff -+#define BIT_DTIM_PERIOD4_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD4_8812F) << BIT_SHIFT_DTIM_PERIOD4_8812F) -+#define BITS_DTIM_PERIOD4_8812F \ -+ (BIT_MASK_DTIM_PERIOD4_8812F << BIT_SHIFT_DTIM_PERIOD4_8812F) -+#define BIT_CLEAR_DTIM_PERIOD4_8812F(x) ((x) & (~BITS_DTIM_PERIOD4_8812F)) -+#define BIT_GET_DTIM_PERIOD4_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD4_8812F) & BIT_MASK_DTIM_PERIOD4_8812F) -+#define BIT_SET_DTIM_PERIOD4_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD4_8812F(x) | BIT_DTIM_PERIOD4_8812F(v)) -+ -+#define BIT_DTIM4_8812F BIT(15) -+#define BIT_TIM4_8812F BIT(14) -+#define BIT_RPT_VALID_8812F BIT(13) -+ -+#define BIT_SHIFT_PS_AID_4_8812F 0 -+#define BIT_MASK_PS_AID_4_8812F 0x7ff -+#define BIT_PS_AID_4_8812F(x) \ -+ (((x) & BIT_MASK_PS_AID_4_8812F) << BIT_SHIFT_PS_AID_4_8812F) -+#define BITS_PS_AID_4_8812F \ -+ (BIT_MASK_PS_AID_4_8812F << BIT_SHIFT_PS_AID_4_8812F) -+#define BIT_CLEAR_PS_AID_4_8812F(x) ((x) & (~BITS_PS_AID_4_8812F)) -+#define BIT_GET_PS_AID_4_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_4_8812F) & BIT_MASK_PS_AID_4_8812F) -+#define BIT_SET_PS_AID_4_8812F(x, v) \ -+ (BIT_CLEAR_PS_AID_4_8812F(x) | BIT_PS_AID_4_8812F(v)) -+ -+/* 2 REG_A1_ADDR_MASK_8812F (A1 ADDR MASK REGISTER) */ -+ -+#define BIT_SHIFT_A1_ADDR_MASK_8812F 0 -+#define BIT_MASK_A1_ADDR_MASK_8812F 0xffffffffL -+#define BIT_A1_ADDR_MASK_8812F(x) \ -+ (((x) & BIT_MASK_A1_ADDR_MASK_8812F) << BIT_SHIFT_A1_ADDR_MASK_8812F) -+#define BITS_A1_ADDR_MASK_8812F \ -+ (BIT_MASK_A1_ADDR_MASK_8812F << BIT_SHIFT_A1_ADDR_MASK_8812F) -+#define BIT_CLEAR_A1_ADDR_MASK_8812F(x) ((x) & (~BITS_A1_ADDR_MASK_8812F)) -+#define BIT_GET_A1_ADDR_MASK_8812F(x) \ -+ (((x) >> BIT_SHIFT_A1_ADDR_MASK_8812F) & BIT_MASK_A1_ADDR_MASK_8812F) -+#define BIT_SET_A1_ADDR_MASK_8812F(x, v) \ -+ (BIT_CLEAR_A1_ADDR_MASK_8812F(x) | BIT_A1_ADDR_MASK_8812F(v)) -+ -+/* 2 REG_RXPSF_CTRL_8812F */ -+#define BIT_RXGCK_FIFOTHR_EN_8812F BIT(28) -+ -+#define BIT_SHIFT_RXGCK_VHT_FIFOTHR_8812F 26 -+#define BIT_MASK_RXGCK_VHT_FIFOTHR_8812F 0x3 -+#define BIT_RXGCK_VHT_FIFOTHR_8812F(x) \ -+ (((x) & BIT_MASK_RXGCK_VHT_FIFOTHR_8812F) \ -+ << BIT_SHIFT_RXGCK_VHT_FIFOTHR_8812F) -+#define BITS_RXGCK_VHT_FIFOTHR_8812F \ -+ (BIT_MASK_RXGCK_VHT_FIFOTHR_8812F << BIT_SHIFT_RXGCK_VHT_FIFOTHR_8812F) -+#define BIT_CLEAR_RXGCK_VHT_FIFOTHR_8812F(x) \ -+ ((x) & (~BITS_RXGCK_VHT_FIFOTHR_8812F)) -+#define BIT_GET_RXGCK_VHT_FIFOTHR_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_VHT_FIFOTHR_8812F) & \ -+ BIT_MASK_RXGCK_VHT_FIFOTHR_8812F) -+#define BIT_SET_RXGCK_VHT_FIFOTHR_8812F(x, v) \ -+ (BIT_CLEAR_RXGCK_VHT_FIFOTHR_8812F(x) | BIT_RXGCK_VHT_FIFOTHR_8812F(v)) -+ -+#define BIT_SHIFT_RXGCK_HT_FIFOTHR_8812F 24 -+#define BIT_MASK_RXGCK_HT_FIFOTHR_8812F 0x3 -+#define BIT_RXGCK_HT_FIFOTHR_8812F(x) \ -+ (((x) & BIT_MASK_RXGCK_HT_FIFOTHR_8812F) \ -+ << BIT_SHIFT_RXGCK_HT_FIFOTHR_8812F) -+#define BITS_RXGCK_HT_FIFOTHR_8812F \ -+ (BIT_MASK_RXGCK_HT_FIFOTHR_8812F << BIT_SHIFT_RXGCK_HT_FIFOTHR_8812F) -+#define BIT_CLEAR_RXGCK_HT_FIFOTHR_8812F(x) \ -+ ((x) & (~BITS_RXGCK_HT_FIFOTHR_8812F)) -+#define BIT_GET_RXGCK_HT_FIFOTHR_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_HT_FIFOTHR_8812F) & \ -+ BIT_MASK_RXGCK_HT_FIFOTHR_8812F) -+#define BIT_SET_RXGCK_HT_FIFOTHR_8812F(x, v) \ -+ (BIT_CLEAR_RXGCK_HT_FIFOTHR_8812F(x) | BIT_RXGCK_HT_FIFOTHR_8812F(v)) -+ -+#define BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8812F 22 -+#define BIT_MASK_RXGCK_OFDM_FIFOTHR_8812F 0x3 -+#define BIT_RXGCK_OFDM_FIFOTHR_8812F(x) \ -+ (((x) & BIT_MASK_RXGCK_OFDM_FIFOTHR_8812F) \ -+ << BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8812F) -+#define BITS_RXGCK_OFDM_FIFOTHR_8812F \ -+ (BIT_MASK_RXGCK_OFDM_FIFOTHR_8812F \ -+ << BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8812F) -+#define BIT_CLEAR_RXGCK_OFDM_FIFOTHR_8812F(x) \ -+ ((x) & (~BITS_RXGCK_OFDM_FIFOTHR_8812F)) -+#define BIT_GET_RXGCK_OFDM_FIFOTHR_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8812F) & \ -+ BIT_MASK_RXGCK_OFDM_FIFOTHR_8812F) -+#define BIT_SET_RXGCK_OFDM_FIFOTHR_8812F(x, v) \ -+ (BIT_CLEAR_RXGCK_OFDM_FIFOTHR_8812F(x) | \ -+ BIT_RXGCK_OFDM_FIFOTHR_8812F(v)) -+ -+#define BIT_SHIFT_RXGCK_CCK_FIFOTHR_8812F 20 -+#define BIT_MASK_RXGCK_CCK_FIFOTHR_8812F 0x3 -+#define BIT_RXGCK_CCK_FIFOTHR_8812F(x) \ -+ (((x) & BIT_MASK_RXGCK_CCK_FIFOTHR_8812F) \ -+ << BIT_SHIFT_RXGCK_CCK_FIFOTHR_8812F) -+#define BITS_RXGCK_CCK_FIFOTHR_8812F \ -+ (BIT_MASK_RXGCK_CCK_FIFOTHR_8812F << BIT_SHIFT_RXGCK_CCK_FIFOTHR_8812F) -+#define BIT_CLEAR_RXGCK_CCK_FIFOTHR_8812F(x) \ -+ ((x) & (~BITS_RXGCK_CCK_FIFOTHR_8812F)) -+#define BIT_GET_RXGCK_CCK_FIFOTHR_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_CCK_FIFOTHR_8812F) & \ -+ BIT_MASK_RXGCK_CCK_FIFOTHR_8812F) -+#define BIT_SET_RXGCK_CCK_FIFOTHR_8812F(x, v) \ -+ (BIT_CLEAR_RXGCK_CCK_FIFOTHR_8812F(x) | BIT_RXGCK_CCK_FIFOTHR_8812F(v)) -+ -+#define BIT_SHIFT_RXGCK_ENTRY_DELAY_8812F 17 -+#define BIT_MASK_RXGCK_ENTRY_DELAY_8812F 0x7 -+#define BIT_RXGCK_ENTRY_DELAY_8812F(x) \ -+ (((x) & BIT_MASK_RXGCK_ENTRY_DELAY_8812F) \ -+ << BIT_SHIFT_RXGCK_ENTRY_DELAY_8812F) -+#define BITS_RXGCK_ENTRY_DELAY_8812F \ -+ (BIT_MASK_RXGCK_ENTRY_DELAY_8812F << BIT_SHIFT_RXGCK_ENTRY_DELAY_8812F) -+#define BIT_CLEAR_RXGCK_ENTRY_DELAY_8812F(x) \ -+ ((x) & (~BITS_RXGCK_ENTRY_DELAY_8812F)) -+#define BIT_GET_RXGCK_ENTRY_DELAY_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_ENTRY_DELAY_8812F) & \ -+ BIT_MASK_RXGCK_ENTRY_DELAY_8812F) -+#define BIT_SET_RXGCK_ENTRY_DELAY_8812F(x, v) \ -+ (BIT_CLEAR_RXGCK_ENTRY_DELAY_8812F(x) | BIT_RXGCK_ENTRY_DELAY_8812F(v)) -+ -+#define BIT_RXGCK_OFDMCCA_EN_8812F BIT(16) -+ -+#define BIT_SHIFT_RXPSF_PKTLENTHR_8812F 13 -+#define BIT_MASK_RXPSF_PKTLENTHR_8812F 0x7 -+#define BIT_RXPSF_PKTLENTHR_8812F(x) \ -+ (((x) & BIT_MASK_RXPSF_PKTLENTHR_8812F) \ -+ << BIT_SHIFT_RXPSF_PKTLENTHR_8812F) -+#define BITS_RXPSF_PKTLENTHR_8812F \ -+ (BIT_MASK_RXPSF_PKTLENTHR_8812F << BIT_SHIFT_RXPSF_PKTLENTHR_8812F) -+#define BIT_CLEAR_RXPSF_PKTLENTHR_8812F(x) ((x) & (~BITS_RXPSF_PKTLENTHR_8812F)) -+#define BIT_GET_RXPSF_PKTLENTHR_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXPSF_PKTLENTHR_8812F) & \ -+ BIT_MASK_RXPSF_PKTLENTHR_8812F) -+#define BIT_SET_RXPSF_PKTLENTHR_8812F(x, v) \ -+ (BIT_CLEAR_RXPSF_PKTLENTHR_8812F(x) | BIT_RXPSF_PKTLENTHR_8812F(v)) -+ -+#define BIT_RXPSF_CTRLEN_8812F BIT(12) -+#define BIT_RXPSF_VHTCHKEN_8812F BIT(11) -+#define BIT_RXPSF_HTCHKEN_8812F BIT(10) -+#define BIT_RXPSF_OFDMCHKEN_8812F BIT(9) -+#define BIT_RXPSF_CCKCHKEN_8812F BIT(8) -+#define BIT_RXPSF_OFDMRST_8812F BIT(7) -+#define BIT_RXPSF_CCKRST_8812F BIT(6) -+#define BIT_RXPSF_MHCHKEN_8812F BIT(5) -+#define BIT_RXPSF_CONT_ERRCHKEN_8812F BIT(4) -+#define BIT_RXPSF_ALL_ERRCHKEN_8812F BIT(3) -+ -+#define BIT_SHIFT_RXPSF_ERRTHR_8812F 0 -+#define BIT_MASK_RXPSF_ERRTHR_8812F 0x7 -+#define BIT_RXPSF_ERRTHR_8812F(x) \ -+ (((x) & BIT_MASK_RXPSF_ERRTHR_8812F) << BIT_SHIFT_RXPSF_ERRTHR_8812F) -+#define BITS_RXPSF_ERRTHR_8812F \ -+ (BIT_MASK_RXPSF_ERRTHR_8812F << BIT_SHIFT_RXPSF_ERRTHR_8812F) -+#define BIT_CLEAR_RXPSF_ERRTHR_8812F(x) ((x) & (~BITS_RXPSF_ERRTHR_8812F)) -+#define BIT_GET_RXPSF_ERRTHR_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXPSF_ERRTHR_8812F) & BIT_MASK_RXPSF_ERRTHR_8812F) -+#define BIT_SET_RXPSF_ERRTHR_8812F(x, v) \ -+ (BIT_CLEAR_RXPSF_ERRTHR_8812F(x) | BIT_RXPSF_ERRTHR_8812F(v)) -+ -+/* 2 REG_RXPSF_TYPE_CTRL_8812F */ -+#define BIT_RXPSF_DATA15EN_8812F BIT(31) -+#define BIT_RXPSF_DATA14EN_8812F BIT(30) -+#define BIT_RXPSF_DATA13EN_8812F BIT(29) -+#define BIT_RXPSF_DATA12EN_8812F BIT(28) -+#define BIT_RXPSF_DATA11EN_8812F BIT(27) -+#define BIT_RXPSF_DATA10EN_8812F BIT(26) -+#define BIT_RXPSF_DATA9EN_8812F BIT(25) -+#define BIT_RXPSF_DATA8EN_8812F BIT(24) -+#define BIT_RXPSF_DATA7EN_8812F BIT(23) -+#define BIT_RXPSF_DATA6EN_8812F BIT(22) -+#define BIT_RXPSF_DATA5EN_8812F BIT(21) -+#define BIT_RXPSF_DATA4EN_8812F BIT(20) -+#define BIT_RXPSF_DATA3EN_8812F BIT(19) -+#define BIT_RXPSF_DATA2EN_8812F BIT(18) -+#define BIT_RXPSF_DATA1EN_8812F BIT(17) -+#define BIT_RXPSF_DATA0EN_8812F BIT(16) -+#define BIT_RXPSF_MGT15EN_8812F BIT(15) -+#define BIT_RXPSF_MGT14EN_8812F BIT(14) -+#define BIT_RXPSF_MGT13EN_8812F BIT(13) -+#define BIT_RXPSF_MGT12EN_8812F BIT(12) -+#define BIT_RXPSF_MGT11EN_8812F BIT(11) -+#define BIT_RXPSF_MGT10EN_8812F BIT(10) -+#define BIT_RXPSF_MGT9EN_8812F BIT(9) -+#define BIT_RXPSF_MGT8EN_8812F BIT(8) -+#define BIT_RXPSF_MGT7EN_8812F BIT(7) -+#define BIT_RXPSF_MGT6EN_8812F BIT(6) -+#define BIT_RXPSF_MGT5EN_8812F BIT(5) -+#define BIT_RXPSF_MGT4EN_8812F BIT(4) -+#define BIT_RXPSF_MGT3EN_8812F BIT(3) -+#define BIT_RXPSF_MGT2EN_8812F BIT(2) -+#define BIT_RXPSF_MGT1EN_8812F BIT(1) -+#define BIT_RXPSF_MGT0EN_8812F BIT(0) -+ -+/* 2 REG_CAM_ACCESS_CTRL_8812F */ -+#define BIT_INDIRECT_ERR_8812F BIT(6) -+#define BIT_DIRECT_ERR_8812F BIT(5) -+#define BIT_DIR_ACCESS_EN_RX_BA_8812F BIT(4) -+#define BIT_DIR_ACCESS_EN_MBSSIDCAM_8812F BIT(3) -+#define BIT_DIR_ACCESS_EN_KEY_8812F BIT(2) -+#define BIT_DIR_ACCESS_EN_WOWLAN_8812F BIT(1) -+#define BIT_DIR_ACCESS_EN_FW_FILTER_8812F BIT(0) -+ -+/* 2 REG_HT_SND_REF_RATE_8812F */ -+ -+#define BIT_SHIFT_WMAC_HT_CSI_RATE_8812F 0 -+#define BIT_MASK_WMAC_HT_CSI_RATE_8812F 0x3f -+#define BIT_WMAC_HT_CSI_RATE_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_HT_CSI_RATE_8812F) \ -+ << BIT_SHIFT_WMAC_HT_CSI_RATE_8812F) -+#define BITS_WMAC_HT_CSI_RATE_8812F \ -+ (BIT_MASK_WMAC_HT_CSI_RATE_8812F << BIT_SHIFT_WMAC_HT_CSI_RATE_8812F) -+#define BIT_CLEAR_WMAC_HT_CSI_RATE_8812F(x) \ -+ ((x) & (~BITS_WMAC_HT_CSI_RATE_8812F)) -+#define BIT_GET_WMAC_HT_CSI_RATE_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_HT_CSI_RATE_8812F) & \ -+ BIT_MASK_WMAC_HT_CSI_RATE_8812F) -+#define BIT_SET_WMAC_HT_CSI_RATE_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_HT_CSI_RATE_8812F(x) | BIT_WMAC_HT_CSI_RATE_8812F(v)) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_MACID2_8812F (MAC ID2 REGISTER) */ -+ -+#define BIT_SHIFT_MACID2_V1_8812F 0 -+#define BIT_MASK_MACID2_V1_8812F 0xffffffffL -+#define BIT_MACID2_V1_8812F(x) \ -+ (((x) & BIT_MASK_MACID2_V1_8812F) << BIT_SHIFT_MACID2_V1_8812F) -+#define BITS_MACID2_V1_8812F \ -+ (BIT_MASK_MACID2_V1_8812F << BIT_SHIFT_MACID2_V1_8812F) -+#define BIT_CLEAR_MACID2_V1_8812F(x) ((x) & (~BITS_MACID2_V1_8812F)) -+#define BIT_GET_MACID2_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID2_V1_8812F) & BIT_MASK_MACID2_V1_8812F) -+#define BIT_SET_MACID2_V1_8812F(x, v) \ -+ (BIT_CLEAR_MACID2_V1_8812F(x) | BIT_MACID2_V1_8812F(v)) -+ -+/* 2 REG_MACID2_H_8812F (MAC ID2 REGISTER) */ -+ -+#define BIT_SHIFT_MACID2_H_V1_8812F 0 -+#define BIT_MASK_MACID2_H_V1_8812F 0xffff -+#define BIT_MACID2_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_MACID2_H_V1_8812F) << BIT_SHIFT_MACID2_H_V1_8812F) -+#define BITS_MACID2_H_V1_8812F \ -+ (BIT_MASK_MACID2_H_V1_8812F << BIT_SHIFT_MACID2_H_V1_8812F) -+#define BIT_CLEAR_MACID2_H_V1_8812F(x) ((x) & (~BITS_MACID2_H_V1_8812F)) -+#define BIT_GET_MACID2_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID2_H_V1_8812F) & BIT_MASK_MACID2_H_V1_8812F) -+#define BIT_SET_MACID2_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_MACID2_H_V1_8812F(x) | BIT_MACID2_H_V1_8812F(v)) -+ -+/* 2 REG_BSSID2_8812F (BSSID2 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID2_V1_8812F 0 -+#define BIT_MASK_BSSID2_V1_8812F 0xffffffffL -+#define BIT_BSSID2_V1_8812F(x) \ -+ (((x) & BIT_MASK_BSSID2_V1_8812F) << BIT_SHIFT_BSSID2_V1_8812F) -+#define BITS_BSSID2_V1_8812F \ -+ (BIT_MASK_BSSID2_V1_8812F << BIT_SHIFT_BSSID2_V1_8812F) -+#define BIT_CLEAR_BSSID2_V1_8812F(x) ((x) & (~BITS_BSSID2_V1_8812F)) -+#define BIT_GET_BSSID2_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_V1_8812F) & BIT_MASK_BSSID2_V1_8812F) -+#define BIT_SET_BSSID2_V1_8812F(x, v) \ -+ (BIT_CLEAR_BSSID2_V1_8812F(x) | BIT_BSSID2_V1_8812F(v)) -+ -+/* 2 REG_BSSID2_H_8812F (BSSID2 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID2_H_V1_8812F 0 -+#define BIT_MASK_BSSID2_H_V1_8812F 0xffff -+#define BIT_BSSID2_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_BSSID2_H_V1_8812F) << BIT_SHIFT_BSSID2_H_V1_8812F) -+#define BITS_BSSID2_H_V1_8812F \ -+ (BIT_MASK_BSSID2_H_V1_8812F << BIT_SHIFT_BSSID2_H_V1_8812F) -+#define BIT_CLEAR_BSSID2_H_V1_8812F(x) ((x) & (~BITS_BSSID2_H_V1_8812F)) -+#define BIT_GET_BSSID2_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_H_V1_8812F) & BIT_MASK_BSSID2_H_V1_8812F) -+#define BIT_SET_BSSID2_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_BSSID2_H_V1_8812F(x) | BIT_BSSID2_H_V1_8812F(v)) -+ -+/* 2 REG_MACID3_8812F (MAC ID3 REGISTER) */ -+ -+#define BIT_SHIFT_MACID3_V1_8812F 0 -+#define BIT_MASK_MACID3_V1_8812F 0xffffffffL -+#define BIT_MACID3_V1_8812F(x) \ -+ (((x) & BIT_MASK_MACID3_V1_8812F) << BIT_SHIFT_MACID3_V1_8812F) -+#define BITS_MACID3_V1_8812F \ -+ (BIT_MASK_MACID3_V1_8812F << BIT_SHIFT_MACID3_V1_8812F) -+#define BIT_CLEAR_MACID3_V1_8812F(x) ((x) & (~BITS_MACID3_V1_8812F)) -+#define BIT_GET_MACID3_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID3_V1_8812F) & BIT_MASK_MACID3_V1_8812F) -+#define BIT_SET_MACID3_V1_8812F(x, v) \ -+ (BIT_CLEAR_MACID3_V1_8812F(x) | BIT_MACID3_V1_8812F(v)) -+ -+/* 2 REG_MACID3_H_8812F (MAC ID3 REGISTER) */ -+ -+#define BIT_SHIFT_MACID3_H_V1_8812F 0 -+#define BIT_MASK_MACID3_H_V1_8812F 0xffff -+#define BIT_MACID3_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_MACID3_H_V1_8812F) << BIT_SHIFT_MACID3_H_V1_8812F) -+#define BITS_MACID3_H_V1_8812F \ -+ (BIT_MASK_MACID3_H_V1_8812F << BIT_SHIFT_MACID3_H_V1_8812F) -+#define BIT_CLEAR_MACID3_H_V1_8812F(x) ((x) & (~BITS_MACID3_H_V1_8812F)) -+#define BIT_GET_MACID3_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID3_H_V1_8812F) & BIT_MASK_MACID3_H_V1_8812F) -+#define BIT_SET_MACID3_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_MACID3_H_V1_8812F(x) | BIT_MACID3_H_V1_8812F(v)) -+ -+/* 2 REG_BSSID3_8812F (BSSID3 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID3_V1_8812F 0 -+#define BIT_MASK_BSSID3_V1_8812F 0xffffffffL -+#define BIT_BSSID3_V1_8812F(x) \ -+ (((x) & BIT_MASK_BSSID3_V1_8812F) << BIT_SHIFT_BSSID3_V1_8812F) -+#define BITS_BSSID3_V1_8812F \ -+ (BIT_MASK_BSSID3_V1_8812F << BIT_SHIFT_BSSID3_V1_8812F) -+#define BIT_CLEAR_BSSID3_V1_8812F(x) ((x) & (~BITS_BSSID3_V1_8812F)) -+#define BIT_GET_BSSID3_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_V1_8812F) & BIT_MASK_BSSID3_V1_8812F) -+#define BIT_SET_BSSID3_V1_8812F(x, v) \ -+ (BIT_CLEAR_BSSID3_V1_8812F(x) | BIT_BSSID3_V1_8812F(v)) -+ -+/* 2 REG_BSSID3_H_8812F (BSSID3 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID3_H_V1_8812F 0 -+#define BIT_MASK_BSSID3_H_V1_8812F 0xffff -+#define BIT_BSSID3_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_BSSID3_H_V1_8812F) << BIT_SHIFT_BSSID3_H_V1_8812F) -+#define BITS_BSSID3_H_V1_8812F \ -+ (BIT_MASK_BSSID3_H_V1_8812F << BIT_SHIFT_BSSID3_H_V1_8812F) -+#define BIT_CLEAR_BSSID3_H_V1_8812F(x) ((x) & (~BITS_BSSID3_H_V1_8812F)) -+#define BIT_GET_BSSID3_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_H_V1_8812F) & BIT_MASK_BSSID3_H_V1_8812F) -+#define BIT_SET_BSSID3_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_BSSID3_H_V1_8812F(x) | BIT_BSSID3_H_V1_8812F(v)) -+ -+/* 2 REG_MACID4_8812F (MAC ID4 REGISTER) */ -+ -+#define BIT_SHIFT_MACID4_V1_8812F 0 -+#define BIT_MASK_MACID4_V1_8812F 0xffffffffL -+#define BIT_MACID4_V1_8812F(x) \ -+ (((x) & BIT_MASK_MACID4_V1_8812F) << BIT_SHIFT_MACID4_V1_8812F) -+#define BITS_MACID4_V1_8812F \ -+ (BIT_MASK_MACID4_V1_8812F << BIT_SHIFT_MACID4_V1_8812F) -+#define BIT_CLEAR_MACID4_V1_8812F(x) ((x) & (~BITS_MACID4_V1_8812F)) -+#define BIT_GET_MACID4_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID4_V1_8812F) & BIT_MASK_MACID4_V1_8812F) -+#define BIT_SET_MACID4_V1_8812F(x, v) \ -+ (BIT_CLEAR_MACID4_V1_8812F(x) | BIT_MACID4_V1_8812F(v)) -+ -+/* 2 REG_MACID4_H_8812F (MAC ID4 REGISTER) */ -+ -+#define BIT_SHIFT_MACID4_H_V1_8812F 0 -+#define BIT_MASK_MACID4_H_V1_8812F 0xffff -+#define BIT_MACID4_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_MACID4_H_V1_8812F) << BIT_SHIFT_MACID4_H_V1_8812F) -+#define BITS_MACID4_H_V1_8812F \ -+ (BIT_MASK_MACID4_H_V1_8812F << BIT_SHIFT_MACID4_H_V1_8812F) -+#define BIT_CLEAR_MACID4_H_V1_8812F(x) ((x) & (~BITS_MACID4_H_V1_8812F)) -+#define BIT_GET_MACID4_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID4_H_V1_8812F) & BIT_MASK_MACID4_H_V1_8812F) -+#define BIT_SET_MACID4_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_MACID4_H_V1_8812F(x) | BIT_MACID4_H_V1_8812F(v)) -+ -+/* 2 REG_BSSID4_8812F (BSSID4 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID4_V1_8812F 0 -+#define BIT_MASK_BSSID4_V1_8812F 0xffffffffL -+#define BIT_BSSID4_V1_8812F(x) \ -+ (((x) & BIT_MASK_BSSID4_V1_8812F) << BIT_SHIFT_BSSID4_V1_8812F) -+#define BITS_BSSID4_V1_8812F \ -+ (BIT_MASK_BSSID4_V1_8812F << BIT_SHIFT_BSSID4_V1_8812F) -+#define BIT_CLEAR_BSSID4_V1_8812F(x) ((x) & (~BITS_BSSID4_V1_8812F)) -+#define BIT_GET_BSSID4_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_V1_8812F) & BIT_MASK_BSSID4_V1_8812F) -+#define BIT_SET_BSSID4_V1_8812F(x, v) \ -+ (BIT_CLEAR_BSSID4_V1_8812F(x) | BIT_BSSID4_V1_8812F(v)) -+ -+/* 2 REG_BSSID4_H_8812F (BSSID4 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID4_H_V1_8812F 0 -+#define BIT_MASK_BSSID4_H_V1_8812F 0xffff -+#define BIT_BSSID4_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_BSSID4_H_V1_8812F) << BIT_SHIFT_BSSID4_H_V1_8812F) -+#define BITS_BSSID4_H_V1_8812F \ -+ (BIT_MASK_BSSID4_H_V1_8812F << BIT_SHIFT_BSSID4_H_V1_8812F) -+#define BIT_CLEAR_BSSID4_H_V1_8812F(x) ((x) & (~BITS_BSSID4_H_V1_8812F)) -+#define BIT_GET_BSSID4_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_H_V1_8812F) & BIT_MASK_BSSID4_H_V1_8812F) -+#define BIT_SET_BSSID4_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_BSSID4_H_V1_8812F(x) | BIT_BSSID4_H_V1_8812F(v)) -+ -+/* 2 REG_NOA_REPORT_8812F */ -+ -+/* 2 REG_NOA_REPORT_1_8812F */ -+ -+/* 2 REG_NOA_REPORT_2_8812F */ -+ -+/* 2 REG_NOA_REPORT_3_8812F */ -+ -+/* 2 REG_PWRBIT_SETTING_8812F */ -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWCTL_EN_8812F BIT(15) -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWDATA_EN_8812F BIT(14) -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWACT_EN_8812F BIT(13) -+#define BIT_CLI3_PWR_ST_V1_8812F BIT(12) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWCTL_EN_8812F BIT(11) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWDATA_EN_8812F BIT(10) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWACT_EN_8812F BIT(9) -+#define BIT_CLI2_PWR_ST_V1_8812F BIT(8) -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWCTL_EN_8812F BIT(7) -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWDATA_EN_8812F BIT(6) -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWACT_EN_8812F BIT(5) -+#define BIT_CLI1_PWR_ST_V1_8812F BIT(4) -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWCTL_EN_8812F BIT(3) -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWDATA_EN_8812F BIT(2) -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWACT_EN_8812F BIT(1) -+#define BIT_CLI0_PWR_ST_V1_8812F BIT(0) -+ -+/* 2 REG_GENERAL_OPTION_8812F */ -+#define BIT_WMAC_EXT_DBG_SEL_V1_8812F BIT(6) -+#define BIT_WMAC_FIX_FIRST_MPDU_WITH_PHYSTS_8812F BIT(5) -+#define BIT_RX_DMA_BYPASS_CHECK_DATABYPASS_CHECK_DATA_8812F BIT(4) -+#define BIT_RX_DMA_BYPASS_CHECK_MGTBIT_RX_DMA_BYPASS_CHECK_MGT_8812F BIT(3) -+#define BIT_TXSERV_FIELD_SEL_8812F BIT(2) -+#define BIT_RXVHT_LEN_SEL_8812F BIT(1) -+#define BIT_RXMIC_PROTECT_EN_8812F BIT(0) -+ -+/* 2 REG_RXAI_CTRL_8812F */ -+#define BIT_RXAI_INFO_RST_8812F BIT(7) -+#define BIT_RXAI_PRTCT_REL_8812F BIT(6) -+#define BIT_RXAI_PRTCT_VIO_8812F BIT(5) -+#define BIT_RXAI_PRTCT_SEL_8812F BIT(2) -+#define BIT_RXAI_AGG_CHKEN_8812F BIT(1) -+#define BIT_RXAI_ADDR_CHKEN_8812F BIT(0) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_CSI_RRSR_8812F */ -+#define BIT_CSI_LDPC_EN_8812F BIT(29) -+#define BIT_CSI_STBC_EN_8812F BIT(28) -+ -+#define BIT_SHIFT_CSI_RRSC_BITMAP_8812F 4 -+#define BIT_MASK_CSI_RRSC_BITMAP_8812F 0xffffff -+#define BIT_CSI_RRSC_BITMAP_8812F(x) \ -+ (((x) & BIT_MASK_CSI_RRSC_BITMAP_8812F) \ -+ << BIT_SHIFT_CSI_RRSC_BITMAP_8812F) -+#define BITS_CSI_RRSC_BITMAP_8812F \ -+ (BIT_MASK_CSI_RRSC_BITMAP_8812F << BIT_SHIFT_CSI_RRSC_BITMAP_8812F) -+#define BIT_CLEAR_CSI_RRSC_BITMAP_8812F(x) ((x) & (~BITS_CSI_RRSC_BITMAP_8812F)) -+#define BIT_GET_CSI_RRSC_BITMAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_CSI_RRSC_BITMAP_8812F) & \ -+ BIT_MASK_CSI_RRSC_BITMAP_8812F) -+#define BIT_SET_CSI_RRSC_BITMAP_8812F(x, v) \ -+ (BIT_CLEAR_CSI_RRSC_BITMAP_8812F(x) | BIT_CSI_RRSC_BITMAP_8812F(v)) -+ -+#define BIT_SHIFT_OFDM_LEN_TH_8812F 0 -+#define BIT_MASK_OFDM_LEN_TH_8812F 0xf -+#define BIT_OFDM_LEN_TH_8812F(x) \ -+ (((x) & BIT_MASK_OFDM_LEN_TH_8812F) << BIT_SHIFT_OFDM_LEN_TH_8812F) -+#define BITS_OFDM_LEN_TH_8812F \ -+ (BIT_MASK_OFDM_LEN_TH_8812F << BIT_SHIFT_OFDM_LEN_TH_8812F) -+#define BIT_CLEAR_OFDM_LEN_TH_8812F(x) ((x) & (~BITS_OFDM_LEN_TH_8812F)) -+#define BIT_GET_OFDM_LEN_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_OFDM_LEN_TH_8812F) & BIT_MASK_OFDM_LEN_TH_8812F) -+#define BIT_SET_OFDM_LEN_TH_8812F(x, v) \ -+ (BIT_CLEAR_OFDM_LEN_TH_8812F(x) | BIT_OFDM_LEN_TH_8812F(v)) -+ -+/* 2 REG_MU_BF_OPTION_8812F */ -+#define BIT_WMAC_RESP_NONSTA1_DIS_8812F BIT(7) -+#define BIT_WMAC_TXMU_ACKPOLICY_EN_8812F BIT(6) -+ -+#define BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8812F 4 -+#define BIT_MASK_WMAC_TXMU_ACKPOLICY_8812F 0x3 -+#define BIT_WMAC_TXMU_ACKPOLICY_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_TXMU_ACKPOLICY_8812F) \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8812F) -+#define BITS_WMAC_TXMU_ACKPOLICY_8812F \ -+ (BIT_MASK_WMAC_TXMU_ACKPOLICY_8812F \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8812F) -+#define BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8812F(x) \ -+ ((x) & (~BITS_WMAC_TXMU_ACKPOLICY_8812F)) -+#define BIT_GET_WMAC_TXMU_ACKPOLICY_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8812F) & \ -+ BIT_MASK_WMAC_TXMU_ACKPOLICY_8812F) -+#define BIT_SET_WMAC_TXMU_ACKPOLICY_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8812F(x) | \ -+ BIT_WMAC_TXMU_ACKPOLICY_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8812F 1 -+#define BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8812F 0x7 -+#define BIT_WMAC_MU_BFEE_PORT_SEL_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8812F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8812F) -+#define BITS_WMAC_MU_BFEE_PORT_SEL_8812F \ -+ (BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8812F \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8812F) -+#define BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8812F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE_PORT_SEL_8812F)) -+#define BIT_GET_WMAC_MU_BFEE_PORT_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8812F) & \ -+ BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8812F) -+#define BIT_SET_WMAC_MU_BFEE_PORT_SEL_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8812F(x) | \ -+ BIT_WMAC_MU_BFEE_PORT_SEL_8812F(v)) -+ -+#define BIT_WMAC_MU_BFEE_DIS_8812F BIT(0) -+ -+/* 2 REG_WMAC_PAUSE_BB_CLR_TH_8812F */ -+ -+#define BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8812F 0 -+#define BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8812F 0xff -+#define BIT_WMAC_PAUSE_BB_CLR_TH_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8812F) \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8812F) -+#define BITS_WMAC_PAUSE_BB_CLR_TH_8812F \ -+ (BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8812F \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8812F) -+#define BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8812F(x) \ -+ ((x) & (~BITS_WMAC_PAUSE_BB_CLR_TH_8812F)) -+#define BIT_GET_WMAC_PAUSE_BB_CLR_TH_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8812F) & \ -+ BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8812F) -+#define BIT_SET_WMAC_PAUSE_BB_CLR_TH_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8812F(x) | \ -+ BIT_WMAC_PAUSE_BB_CLR_TH_8812F(v)) -+ -+/* 2 REG__WMAC_MULBK_BUF_8812F */ -+ -+#define BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8812F 0 -+#define BIT_MASK_WMAC_MULBK_PAGE_SIZE_8812F 0xff -+#define BIT_WMAC_MULBK_PAGE_SIZE_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_MULBK_PAGE_SIZE_8812F) \ -+ << BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8812F) -+#define BITS_WMAC_MULBK_PAGE_SIZE_8812F \ -+ (BIT_MASK_WMAC_MULBK_PAGE_SIZE_8812F \ -+ << BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8812F) -+#define BIT_CLEAR_WMAC_MULBK_PAGE_SIZE_8812F(x) \ -+ ((x) & (~BITS_WMAC_MULBK_PAGE_SIZE_8812F)) -+#define BIT_GET_WMAC_MULBK_PAGE_SIZE_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8812F) & \ -+ BIT_MASK_WMAC_MULBK_PAGE_SIZE_8812F) -+#define BIT_SET_WMAC_MULBK_PAGE_SIZE_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_MULBK_PAGE_SIZE_8812F(x) | \ -+ BIT_WMAC_MULBK_PAGE_SIZE_8812F(v)) -+ -+/* 2 REG_WMAC_MU_OPTION_8812F */ -+ -+/* 2 REG_WMAC_MU_BF_CTL_8812F */ -+#define BIT_WMAC_INVLD_BFPRT_CHK_8812F BIT(15) -+#define BIT_WMAC_RETXBFRPTSEQ_UPD_8812F BIT(14) -+ -+#define BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8812F 12 -+#define BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8812F 0x3 -+#define BIT_WMAC_MU_BFRPTSEG_SEL_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8812F) \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8812F) -+#define BITS_WMAC_MU_BFRPTSEG_SEL_8812F \ -+ (BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8812F \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8812F) -+#define BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8812F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFRPTSEG_SEL_8812F)) -+#define BIT_GET_WMAC_MU_BFRPTSEG_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8812F) & \ -+ BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8812F) -+#define BIT_SET_WMAC_MU_BFRPTSEG_SEL_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8812F(x) | \ -+ BIT_WMAC_MU_BFRPTSEG_SEL_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BF_MYAID_8812F 0 -+#define BIT_MASK_WMAC_MU_BF_MYAID_8812F 0xfff -+#define BIT_WMAC_MU_BF_MYAID_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BF_MYAID_8812F) \ -+ << BIT_SHIFT_WMAC_MU_BF_MYAID_8812F) -+#define BITS_WMAC_MU_BF_MYAID_8812F \ -+ (BIT_MASK_WMAC_MU_BF_MYAID_8812F << BIT_SHIFT_WMAC_MU_BF_MYAID_8812F) -+#define BIT_CLEAR_WMAC_MU_BF_MYAID_8812F(x) \ -+ ((x) & (~BITS_WMAC_MU_BF_MYAID_8812F)) -+#define BIT_GET_WMAC_MU_BF_MYAID_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BF_MYAID_8812F) & \ -+ BIT_MASK_WMAC_MU_BF_MYAID_8812F) -+#define BIT_SET_WMAC_MU_BF_MYAID_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BF_MYAID_8812F(x) | BIT_WMAC_MU_BF_MYAID_8812F(v)) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA_8812F */ -+ -+#define BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8812F 13 -+#define BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8812F 0x7 -+#define BIT_BFRPT_PARA_USERID_SEL_V1_8812F(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8812F) \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8812F) -+#define BITS_BFRPT_PARA_USERID_SEL_V1_8812F \ -+ (BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8812F \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8812F) -+#define BIT_CLEAR_BFRPT_PARA_USERID_SEL_V1_8812F(x) \ -+ ((x) & (~BITS_BFRPT_PARA_USERID_SEL_V1_8812F)) -+#define BIT_GET_BFRPT_PARA_USERID_SEL_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8812F) & \ -+ BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8812F) -+#define BIT_SET_BFRPT_PARA_USERID_SEL_V1_8812F(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_USERID_SEL_V1_8812F(x) | \ -+ BIT_BFRPT_PARA_USERID_SEL_V1_8812F(v)) -+ -+#define BIT_SHIFT_BFRPT_PARA_V1_8812F 0 -+#define BIT_MASK_BFRPT_PARA_V1_8812F 0x1fff -+#define BIT_BFRPT_PARA_V1_8812F(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_V1_8812F) << BIT_SHIFT_BFRPT_PARA_V1_8812F) -+#define BITS_BFRPT_PARA_V1_8812F \ -+ (BIT_MASK_BFRPT_PARA_V1_8812F << BIT_SHIFT_BFRPT_PARA_V1_8812F) -+#define BIT_CLEAR_BFRPT_PARA_V1_8812F(x) ((x) & (~BITS_BFRPT_PARA_V1_8812F)) -+#define BIT_GET_BFRPT_PARA_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_V1_8812F) & BIT_MASK_BFRPT_PARA_V1_8812F) -+#define BIT_SET_BFRPT_PARA_V1_8812F(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_V1_8812F(x) | BIT_BFRPT_PARA_V1_8812F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE2_8812F */ -+#define BIT_STATUS_BFEE2_8812F BIT(10) -+#define BIT_WMAC_MU_BFEE2_EN_8812F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE2_AID_8812F 0 -+#define BIT_MASK_WMAC_MU_BFEE2_AID_8812F 0x1ff -+#define BIT_WMAC_MU_BFEE2_AID_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE2_AID_8812F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE2_AID_8812F) -+#define BITS_WMAC_MU_BFEE2_AID_8812F \ -+ (BIT_MASK_WMAC_MU_BFEE2_AID_8812F << BIT_SHIFT_WMAC_MU_BFEE2_AID_8812F) -+#define BIT_CLEAR_WMAC_MU_BFEE2_AID_8812F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE2_AID_8812F)) -+#define BIT_GET_WMAC_MU_BFEE2_AID_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE2_AID_8812F) & \ -+ BIT_MASK_WMAC_MU_BFEE2_AID_8812F) -+#define BIT_SET_WMAC_MU_BFEE2_AID_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE2_AID_8812F(x) | BIT_WMAC_MU_BFEE2_AID_8812F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE3_8812F */ -+#define BIT_STATUS_BFEE3_8812F BIT(10) -+#define BIT_WMAC_MU_BFEE3_EN_8812F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE3_AID_8812F 0 -+#define BIT_MASK_WMAC_MU_BFEE3_AID_8812F 0x1ff -+#define BIT_WMAC_MU_BFEE3_AID_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE3_AID_8812F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE3_AID_8812F) -+#define BITS_WMAC_MU_BFEE3_AID_8812F \ -+ (BIT_MASK_WMAC_MU_BFEE3_AID_8812F << BIT_SHIFT_WMAC_MU_BFEE3_AID_8812F) -+#define BIT_CLEAR_WMAC_MU_BFEE3_AID_8812F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE3_AID_8812F)) -+#define BIT_GET_WMAC_MU_BFEE3_AID_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE3_AID_8812F) & \ -+ BIT_MASK_WMAC_MU_BFEE3_AID_8812F) -+#define BIT_SET_WMAC_MU_BFEE3_AID_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE3_AID_8812F(x) | BIT_WMAC_MU_BFEE3_AID_8812F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE4_8812F */ -+#define BIT_STATUS_BFEE4_8812F BIT(10) -+#define BIT_WMAC_MU_BFEE4_EN_8812F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE4_AID_8812F 0 -+#define BIT_MASK_WMAC_MU_BFEE4_AID_8812F 0x1ff -+#define BIT_WMAC_MU_BFEE4_AID_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE4_AID_8812F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE4_AID_8812F) -+#define BITS_WMAC_MU_BFEE4_AID_8812F \ -+ (BIT_MASK_WMAC_MU_BFEE4_AID_8812F << BIT_SHIFT_WMAC_MU_BFEE4_AID_8812F) -+#define BIT_CLEAR_WMAC_MU_BFEE4_AID_8812F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE4_AID_8812F)) -+#define BIT_GET_WMAC_MU_BFEE4_AID_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE4_AID_8812F) & \ -+ BIT_MASK_WMAC_MU_BFEE4_AID_8812F) -+#define BIT_SET_WMAC_MU_BFEE4_AID_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE4_AID_8812F(x) | BIT_WMAC_MU_BFEE4_AID_8812F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE5_8812F */ -+#define BIT_BIT_STATUS_BFEE5_8812F BIT(10) -+#define BIT_WMAC_MU_BFEE5_EN_8812F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE5_AID_8812F 0 -+#define BIT_MASK_WMAC_MU_BFEE5_AID_8812F 0x1ff -+#define BIT_WMAC_MU_BFEE5_AID_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE5_AID_8812F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE5_AID_8812F) -+#define BITS_WMAC_MU_BFEE5_AID_8812F \ -+ (BIT_MASK_WMAC_MU_BFEE5_AID_8812F << BIT_SHIFT_WMAC_MU_BFEE5_AID_8812F) -+#define BIT_CLEAR_WMAC_MU_BFEE5_AID_8812F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE5_AID_8812F)) -+#define BIT_GET_WMAC_MU_BFEE5_AID_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE5_AID_8812F) & \ -+ BIT_MASK_WMAC_MU_BFEE5_AID_8812F) -+#define BIT_SET_WMAC_MU_BFEE5_AID_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE5_AID_8812F(x) | BIT_WMAC_MU_BFEE5_AID_8812F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE6_8812F */ -+#define BIT_STATUS_BFEE6_8812F BIT(10) -+#define BIT_WMAC_MU_BFEE6_EN_8812F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE6_AID_8812F 0 -+#define BIT_MASK_WMAC_MU_BFEE6_AID_8812F 0x1ff -+#define BIT_WMAC_MU_BFEE6_AID_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE6_AID_8812F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE6_AID_8812F) -+#define BITS_WMAC_MU_BFEE6_AID_8812F \ -+ (BIT_MASK_WMAC_MU_BFEE6_AID_8812F << BIT_SHIFT_WMAC_MU_BFEE6_AID_8812F) -+#define BIT_CLEAR_WMAC_MU_BFEE6_AID_8812F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE6_AID_8812F)) -+#define BIT_GET_WMAC_MU_BFEE6_AID_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE6_AID_8812F) & \ -+ BIT_MASK_WMAC_MU_BFEE6_AID_8812F) -+#define BIT_SET_WMAC_MU_BFEE6_AID_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE6_AID_8812F(x) | BIT_WMAC_MU_BFEE6_AID_8812F(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE7_8812F */ -+#define BIT_STATUS_BFEE7_8812F BIT(10) -+#define BIT_WMAC_MU_BFEE7_EN_8812F BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE7_AID_8812F 0 -+#define BIT_MASK_WMAC_MU_BFEE7_AID_8812F 0x1ff -+#define BIT_WMAC_MU_BFEE7_AID_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE7_AID_8812F) \ -+ << BIT_SHIFT_WMAC_MU_BFEE7_AID_8812F) -+#define BITS_WMAC_MU_BFEE7_AID_8812F \ -+ (BIT_MASK_WMAC_MU_BFEE7_AID_8812F << BIT_SHIFT_WMAC_MU_BFEE7_AID_8812F) -+#define BIT_CLEAR_WMAC_MU_BFEE7_AID_8812F(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE7_AID_8812F)) -+#define BIT_GET_WMAC_MU_BFEE7_AID_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE7_AID_8812F) & \ -+ BIT_MASK_WMAC_MU_BFEE7_AID_8812F) -+#define BIT_SET_WMAC_MU_BFEE7_AID_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE7_AID_8812F(x) | BIT_WMAC_MU_BFEE7_AID_8812F(v)) -+ -+/* 2 REG_WMAC_BB_STOP_RX_COUNTER_8812F */ -+#define BIT_RST_ALL_COUNTER_8812F BIT(31) -+ -+#define BIT_SHIFT_ABORT_RX_VBON_COUNTER_8812F 16 -+#define BIT_MASK_ABORT_RX_VBON_COUNTER_8812F 0xff -+#define BIT_ABORT_RX_VBON_COUNTER_8812F(x) \ -+ (((x) & BIT_MASK_ABORT_RX_VBON_COUNTER_8812F) \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8812F) -+#define BITS_ABORT_RX_VBON_COUNTER_8812F \ -+ (BIT_MASK_ABORT_RX_VBON_COUNTER_8812F \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8812F) -+#define BIT_CLEAR_ABORT_RX_VBON_COUNTER_8812F(x) \ -+ ((x) & (~BITS_ABORT_RX_VBON_COUNTER_8812F)) -+#define BIT_GET_ABORT_RX_VBON_COUNTER_8812F(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_VBON_COUNTER_8812F) & \ -+ BIT_MASK_ABORT_RX_VBON_COUNTER_8812F) -+#define BIT_SET_ABORT_RX_VBON_COUNTER_8812F(x, v) \ -+ (BIT_CLEAR_ABORT_RX_VBON_COUNTER_8812F(x) | \ -+ BIT_ABORT_RX_VBON_COUNTER_8812F(v)) -+ -+#define BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8812F 8 -+#define BIT_MASK_ABORT_RX_RDRDY_COUNTER_8812F 0xff -+#define BIT_ABORT_RX_RDRDY_COUNTER_8812F(x) \ -+ (((x) & BIT_MASK_ABORT_RX_RDRDY_COUNTER_8812F) \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8812F) -+#define BITS_ABORT_RX_RDRDY_COUNTER_8812F \ -+ (BIT_MASK_ABORT_RX_RDRDY_COUNTER_8812F \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8812F) -+#define BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8812F(x) \ -+ ((x) & (~BITS_ABORT_RX_RDRDY_COUNTER_8812F)) -+#define BIT_GET_ABORT_RX_RDRDY_COUNTER_8812F(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8812F) & \ -+ BIT_MASK_ABORT_RX_RDRDY_COUNTER_8812F) -+#define BIT_SET_ABORT_RX_RDRDY_COUNTER_8812F(x, v) \ -+ (BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8812F(x) | \ -+ BIT_ABORT_RX_RDRDY_COUNTER_8812F(v)) -+ -+#define BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8812F 0 -+#define BIT_MASK_VBON_EARLY_FALLING_COUNTER_8812F 0xff -+#define BIT_VBON_EARLY_FALLING_COUNTER_8812F(x) \ -+ (((x) & BIT_MASK_VBON_EARLY_FALLING_COUNTER_8812F) \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8812F) -+#define BITS_VBON_EARLY_FALLING_COUNTER_8812F \ -+ (BIT_MASK_VBON_EARLY_FALLING_COUNTER_8812F \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8812F) -+#define BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8812F(x) \ -+ ((x) & (~BITS_VBON_EARLY_FALLING_COUNTER_8812F)) -+#define BIT_GET_VBON_EARLY_FALLING_COUNTER_8812F(x) \ -+ (((x) >> BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8812F) & \ -+ BIT_MASK_VBON_EARLY_FALLING_COUNTER_8812F) -+#define BIT_SET_VBON_EARLY_FALLING_COUNTER_8812F(x, v) \ -+ (BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8812F(x) | \ -+ BIT_VBON_EARLY_FALLING_COUNTER_8812F(v)) -+ -+/* 2 REG_WMAC_PLCP_MONITOR_8812F */ -+#define BIT_WMAC_PLCP_TRX_SEL_8812F BIT(31) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8812F 28 -+#define BIT_MASK_WMAC_PLCP_RDSIG_SEL_8812F 0x7 -+#define BIT_WMAC_PLCP_RDSIG_SEL_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_SEL_8812F) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8812F) -+#define BITS_WMAC_PLCP_RDSIG_SEL_8812F \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_SEL_8812F \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8812F) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8812F(x) \ -+ ((x) & (~BITS_WMAC_PLCP_RDSIG_SEL_8812F)) -+#define BIT_GET_WMAC_PLCP_RDSIG_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8812F) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_SEL_8812F) -+#define BIT_SET_WMAC_PLCP_RDSIG_SEL_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8812F(x) | \ -+ BIT_WMAC_PLCP_RDSIG_SEL_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_RATE_IDX_8812F 24 -+#define BIT_MASK_WMAC_RATE_IDX_8812F 0xf -+#define BIT_WMAC_RATE_IDX_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_RATE_IDX_8812F) << BIT_SHIFT_WMAC_RATE_IDX_8812F) -+#define BITS_WMAC_RATE_IDX_8812F \ -+ (BIT_MASK_WMAC_RATE_IDX_8812F << BIT_SHIFT_WMAC_RATE_IDX_8812F) -+#define BIT_CLEAR_WMAC_RATE_IDX_8812F(x) ((x) & (~BITS_WMAC_RATE_IDX_8812F)) -+#define BIT_GET_WMAC_RATE_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RATE_IDX_8812F) & BIT_MASK_WMAC_RATE_IDX_8812F) -+#define BIT_SET_WMAC_RATE_IDX_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_RATE_IDX_8812F(x) | BIT_WMAC_RATE_IDX_8812F(v)) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_8812F 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG_8812F 0xffffff -+#define BIT_WMAC_PLCP_RDSIG_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_8812F) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_8812F) -+#define BITS_WMAC_PLCP_RDSIG_8812F \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_8812F << BIT_SHIFT_WMAC_PLCP_RDSIG_8812F) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_8812F(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_8812F)) -+#define BIT_GET_WMAC_PLCP_RDSIG_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_8812F) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_8812F) -+#define BIT_SET_WMAC_PLCP_RDSIG_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_8812F(x) | BIT_WMAC_PLCP_RDSIG_8812F(v)) -+ -+/* 2 REG_WMAC_PLCP_MONITOR_MUTX_8812F */ -+#define BIT_WMAC_MUTX_IDX_8812F BIT(24) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_8812F 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG_8812F 0xffffff -+#define BIT_WMAC_PLCP_RDSIG_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_8812F) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_8812F) -+#define BITS_WMAC_PLCP_RDSIG_8812F \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_8812F << BIT_SHIFT_WMAC_PLCP_RDSIG_8812F) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_8812F(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_8812F)) -+#define BIT_GET_WMAC_PLCP_RDSIG_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_8812F) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_8812F) -+#define BIT_SET_WMAC_PLCP_RDSIG_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_8812F(x) | BIT_WMAC_PLCP_RDSIG_8812F(v)) -+ -+/* 2 REG_WMAC_CSIDMA_CFG_8812F */ -+ -+#define BIT_SHIFT_CSI_SEG_SIZE_8812F 16 -+#define BIT_MASK_CSI_SEG_SIZE_8812F 0xfff -+#define BIT_CSI_SEG_SIZE_8812F(x) \ -+ (((x) & BIT_MASK_CSI_SEG_SIZE_8812F) << BIT_SHIFT_CSI_SEG_SIZE_8812F) -+#define BITS_CSI_SEG_SIZE_8812F \ -+ (BIT_MASK_CSI_SEG_SIZE_8812F << BIT_SHIFT_CSI_SEG_SIZE_8812F) -+#define BIT_CLEAR_CSI_SEG_SIZE_8812F(x) ((x) & (~BITS_CSI_SEG_SIZE_8812F)) -+#define BIT_GET_CSI_SEG_SIZE_8812F(x) \ -+ (((x) >> BIT_SHIFT_CSI_SEG_SIZE_8812F) & BIT_MASK_CSI_SEG_SIZE_8812F) -+#define BIT_SET_CSI_SEG_SIZE_8812F(x, v) \ -+ (BIT_CLEAR_CSI_SEG_SIZE_8812F(x) | BIT_CSI_SEG_SIZE_8812F(v)) -+ -+#define BIT_SHIFT_CSI_START_PAGE_8812F 0 -+#define BIT_MASK_CSI_START_PAGE_8812F 0xfff -+#define BIT_CSI_START_PAGE_8812F(x) \ -+ (((x) & BIT_MASK_CSI_START_PAGE_8812F) \ -+ << BIT_SHIFT_CSI_START_PAGE_8812F) -+#define BITS_CSI_START_PAGE_8812F \ -+ (BIT_MASK_CSI_START_PAGE_8812F << BIT_SHIFT_CSI_START_PAGE_8812F) -+#define BIT_CLEAR_CSI_START_PAGE_8812F(x) ((x) & (~BITS_CSI_START_PAGE_8812F)) -+#define BIT_GET_CSI_START_PAGE_8812F(x) \ -+ (((x) >> BIT_SHIFT_CSI_START_PAGE_8812F) & \ -+ BIT_MASK_CSI_START_PAGE_8812F) -+#define BIT_SET_CSI_START_PAGE_8812F(x, v) \ -+ (BIT_CLEAR_CSI_START_PAGE_8812F(x) | BIT_CSI_START_PAGE_8812F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_8812F (TA0 REGISTER) */ -+ -+#define BIT_SHIFT_TA0_V1_8812F 0 -+#define BIT_MASK_TA0_V1_8812F 0xffffffffL -+#define BIT_TA0_V1_8812F(x) \ -+ (((x) & BIT_MASK_TA0_V1_8812F) << BIT_SHIFT_TA0_V1_8812F) -+#define BITS_TA0_V1_8812F (BIT_MASK_TA0_V1_8812F << BIT_SHIFT_TA0_V1_8812F) -+#define BIT_CLEAR_TA0_V1_8812F(x) ((x) & (~BITS_TA0_V1_8812F)) -+#define BIT_GET_TA0_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TA0_V1_8812F) & BIT_MASK_TA0_V1_8812F) -+#define BIT_SET_TA0_V1_8812F(x, v) \ -+ (BIT_CLEAR_TA0_V1_8812F(x) | BIT_TA0_V1_8812F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_H_8812F (TA0 REGISTER) */ -+ -+#define BIT_SHIFT_TA0_H_V1_8812F 0 -+#define BIT_MASK_TA0_H_V1_8812F 0xffff -+#define BIT_TA0_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_TA0_H_V1_8812F) << BIT_SHIFT_TA0_H_V1_8812F) -+#define BITS_TA0_H_V1_8812F \ -+ (BIT_MASK_TA0_H_V1_8812F << BIT_SHIFT_TA0_H_V1_8812F) -+#define BIT_CLEAR_TA0_H_V1_8812F(x) ((x) & (~BITS_TA0_H_V1_8812F)) -+#define BIT_GET_TA0_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TA0_H_V1_8812F) & BIT_MASK_TA0_H_V1_8812F) -+#define BIT_SET_TA0_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_TA0_H_V1_8812F(x) | BIT_TA0_H_V1_8812F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_8812F (TA1 REGISTER) */ -+ -+#define BIT_SHIFT_TA1_V1_8812F 0 -+#define BIT_MASK_TA1_V1_8812F 0xffffffffL -+#define BIT_TA1_V1_8812F(x) \ -+ (((x) & BIT_MASK_TA1_V1_8812F) << BIT_SHIFT_TA1_V1_8812F) -+#define BITS_TA1_V1_8812F (BIT_MASK_TA1_V1_8812F << BIT_SHIFT_TA1_V1_8812F) -+#define BIT_CLEAR_TA1_V1_8812F(x) ((x) & (~BITS_TA1_V1_8812F)) -+#define BIT_GET_TA1_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TA1_V1_8812F) & BIT_MASK_TA1_V1_8812F) -+#define BIT_SET_TA1_V1_8812F(x, v) \ -+ (BIT_CLEAR_TA1_V1_8812F(x) | BIT_TA1_V1_8812F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_H_8812F (TA1 REGISTER) */ -+ -+#define BIT_SHIFT_TA1_H_V1_8812F 0 -+#define BIT_MASK_TA1_H_V1_8812F 0xffff -+#define BIT_TA1_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_TA1_H_V1_8812F) << BIT_SHIFT_TA1_H_V1_8812F) -+#define BITS_TA1_H_V1_8812F \ -+ (BIT_MASK_TA1_H_V1_8812F << BIT_SHIFT_TA1_H_V1_8812F) -+#define BIT_CLEAR_TA1_H_V1_8812F(x) ((x) & (~BITS_TA1_H_V1_8812F)) -+#define BIT_GET_TA1_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TA1_H_V1_8812F) & BIT_MASK_TA1_H_V1_8812F) -+#define BIT_SET_TA1_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_TA1_H_V1_8812F(x) | BIT_TA1_H_V1_8812F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_8812F (TA2 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_V1_8812F 0 -+#define BIT_MASK_TA2_V1_8812F 0xffffffffL -+#define BIT_TA2_V1_8812F(x) \ -+ (((x) & BIT_MASK_TA2_V1_8812F) << BIT_SHIFT_TA2_V1_8812F) -+#define BITS_TA2_V1_8812F (BIT_MASK_TA2_V1_8812F << BIT_SHIFT_TA2_V1_8812F) -+#define BIT_CLEAR_TA2_V1_8812F(x) ((x) & (~BITS_TA2_V1_8812F)) -+#define BIT_GET_TA2_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TA2_V1_8812F) & BIT_MASK_TA2_V1_8812F) -+#define BIT_SET_TA2_V1_8812F(x, v) \ -+ (BIT_CLEAR_TA2_V1_8812F(x) | BIT_TA2_V1_8812F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_H_8812F (TA2 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_H_V1_8812F 0 -+#define BIT_MASK_TA2_H_V1_8812F 0xffff -+#define BIT_TA2_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_TA2_H_V1_8812F) << BIT_SHIFT_TA2_H_V1_8812F) -+#define BITS_TA2_H_V1_8812F \ -+ (BIT_MASK_TA2_H_V1_8812F << BIT_SHIFT_TA2_H_V1_8812F) -+#define BIT_CLEAR_TA2_H_V1_8812F(x) ((x) & (~BITS_TA2_H_V1_8812F)) -+#define BIT_GET_TA2_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TA2_H_V1_8812F) & BIT_MASK_TA2_H_V1_8812F) -+#define BIT_SET_TA2_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_TA2_H_V1_8812F(x) | BIT_TA2_H_V1_8812F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_8812F (TA3 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_V1_8812F 0 -+#define BIT_MASK_TA2_V1_8812F 0xffffffffL -+#define BIT_TA2_V1_8812F(x) \ -+ (((x) & BIT_MASK_TA2_V1_8812F) << BIT_SHIFT_TA2_V1_8812F) -+#define BITS_TA2_V1_8812F (BIT_MASK_TA2_V1_8812F << BIT_SHIFT_TA2_V1_8812F) -+#define BIT_CLEAR_TA2_V1_8812F(x) ((x) & (~BITS_TA2_V1_8812F)) -+#define BIT_GET_TA2_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TA2_V1_8812F) & BIT_MASK_TA2_V1_8812F) -+#define BIT_SET_TA2_V1_8812F(x, v) \ -+ (BIT_CLEAR_TA2_V1_8812F(x) | BIT_TA2_V1_8812F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_H_8812F (TA3 REGISTER) */ -+ -+#define BIT_SHIFT_TA3_H_V1_8812F 0 -+#define BIT_MASK_TA3_H_V1_8812F 0xffff -+#define BIT_TA3_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_TA3_H_V1_8812F) << BIT_SHIFT_TA3_H_V1_8812F) -+#define BITS_TA3_H_V1_8812F \ -+ (BIT_MASK_TA3_H_V1_8812F << BIT_SHIFT_TA3_H_V1_8812F) -+#define BIT_CLEAR_TA3_H_V1_8812F(x) ((x) & (~BITS_TA3_H_V1_8812F)) -+#define BIT_GET_TA3_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TA3_H_V1_8812F) & BIT_MASK_TA3_H_V1_8812F) -+#define BIT_SET_TA3_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_TA3_H_V1_8812F(x) | BIT_TA3_H_V1_8812F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_8812F (TA4 REGISTER) */ -+ -+#define BIT_SHIFT_TA4_V1_8812F 0 -+#define BIT_MASK_TA4_V1_8812F 0xffffffffL -+#define BIT_TA4_V1_8812F(x) \ -+ (((x) & BIT_MASK_TA4_V1_8812F) << BIT_SHIFT_TA4_V1_8812F) -+#define BITS_TA4_V1_8812F (BIT_MASK_TA4_V1_8812F << BIT_SHIFT_TA4_V1_8812F) -+#define BIT_CLEAR_TA4_V1_8812F(x) ((x) & (~BITS_TA4_V1_8812F)) -+#define BIT_GET_TA4_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TA4_V1_8812F) & BIT_MASK_TA4_V1_8812F) -+#define BIT_SET_TA4_V1_8812F(x, v) \ -+ (BIT_CLEAR_TA4_V1_8812F(x) | BIT_TA4_V1_8812F(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_H_8812F (TA4 REGISTER) */ -+ -+#define BIT_SHIFT_TA4_H_V1_8812F 0 -+#define BIT_MASK_TA4_H_V1_8812F 0xffff -+#define BIT_TA4_H_V1_8812F(x) \ -+ (((x) & BIT_MASK_TA4_H_V1_8812F) << BIT_SHIFT_TA4_H_V1_8812F) -+#define BITS_TA4_H_V1_8812F \ -+ (BIT_MASK_TA4_H_V1_8812F << BIT_SHIFT_TA4_H_V1_8812F) -+#define BIT_CLEAR_TA4_H_V1_8812F(x) ((x) & (~BITS_TA4_H_V1_8812F)) -+#define BIT_GET_TA4_H_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TA4_H_V1_8812F) & BIT_MASK_TA4_H_V1_8812F) -+#define BIT_SET_TA4_H_V1_8812F(x, v) \ -+ (BIT_CLEAR_TA4_H_V1_8812F(x) | BIT_TA4_H_V1_8812F(v)) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_SND_AID12_8812F */ -+ -+#define BIT_SHIFT_USERID_SEL_8812F 12 -+#define BIT_MASK_USERID_SEL_8812F 0x7 -+#define BIT_USERID_SEL_8812F(x) \ -+ (((x) & BIT_MASK_USERID_SEL_8812F) << BIT_SHIFT_USERID_SEL_8812F) -+#define BITS_USERID_SEL_8812F \ -+ (BIT_MASK_USERID_SEL_8812F << BIT_SHIFT_USERID_SEL_8812F) -+#define BIT_CLEAR_USERID_SEL_8812F(x) ((x) & (~BITS_USERID_SEL_8812F)) -+#define BIT_GET_USERID_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_USERID_SEL_8812F) & BIT_MASK_USERID_SEL_8812F) -+#define BIT_SET_USERID_SEL_8812F(x, v) \ -+ (BIT_CLEAR_USERID_SEL_8812F(x) | BIT_USERID_SEL_8812F(v)) -+ -+#define BIT_SHIFT_USERID_AID12_8812F 0 -+#define BIT_MASK_USERID_AID12_8812F 0xfff -+#define BIT_USERID_AID12_8812F(x) \ -+ (((x) & BIT_MASK_USERID_AID12_8812F) << BIT_SHIFT_USERID_AID12_8812F) -+#define BITS_USERID_AID12_8812F \ -+ (BIT_MASK_USERID_AID12_8812F << BIT_SHIFT_USERID_AID12_8812F) -+#define BIT_CLEAR_USERID_AID12_8812F(x) ((x) & (~BITS_USERID_AID12_8812F)) -+#define BIT_GET_USERID_AID12_8812F(x) \ -+ (((x) >> BIT_SHIFT_USERID_AID12_8812F) & BIT_MASK_USERID_AID12_8812F) -+#define BIT_SET_USERID_AID12_8812F(x, v) \ -+ (BIT_CLEAR_USERID_AID12_8812F(x) | BIT_USERID_AID12_8812F(v)) -+ -+/* 2 REG_SND_PKT_INFO_8812F */ -+#define BIT_SND_FROM_DS_8812F BIT(7) -+#define BIT_SND_TO_DS_8812F BIT(6) -+ -+#define BIT_SHIFT_SND_TOKEN_8812F 0 -+#define BIT_MASK_SND_TOKEN_8812F 0x3f -+#define BIT_SND_TOKEN_8812F(x) \ -+ (((x) & BIT_MASK_SND_TOKEN_8812F) << BIT_SHIFT_SND_TOKEN_8812F) -+#define BITS_SND_TOKEN_8812F \ -+ (BIT_MASK_SND_TOKEN_8812F << BIT_SHIFT_SND_TOKEN_8812F) -+#define BIT_CLEAR_SND_TOKEN_8812F(x) ((x) & (~BITS_SND_TOKEN_8812F)) -+#define BIT_GET_SND_TOKEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_SND_TOKEN_8812F) & BIT_MASK_SND_TOKEN_8812F) -+#define BIT_SET_SND_TOKEN_8812F(x, v) \ -+ (BIT_CLEAR_SND_TOKEN_8812F(x) | BIT_SND_TOKEN_8812F(v)) -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_RSVD_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_MACID1_8812F */ -+ -+#define BIT_SHIFT_MACID1_0_8812F 0 -+#define BIT_MASK_MACID1_0_8812F 0xffffffffL -+#define BIT_MACID1_0_8812F(x) \ -+ (((x) & BIT_MASK_MACID1_0_8812F) << BIT_SHIFT_MACID1_0_8812F) -+#define BITS_MACID1_0_8812F \ -+ (BIT_MASK_MACID1_0_8812F << BIT_SHIFT_MACID1_0_8812F) -+#define BIT_CLEAR_MACID1_0_8812F(x) ((x) & (~BITS_MACID1_0_8812F)) -+#define BIT_GET_MACID1_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID1_0_8812F) & BIT_MASK_MACID1_0_8812F) -+#define BIT_SET_MACID1_0_8812F(x, v) \ -+ (BIT_CLEAR_MACID1_0_8812F(x) | BIT_MACID1_0_8812F(v)) -+ -+/* 2 REG_MACID1_1_8812F */ -+ -+#define BIT_SHIFT_MACID1_1_8812F 0 -+#define BIT_MASK_MACID1_1_8812F 0xffff -+#define BIT_MACID1_1_8812F(x) \ -+ (((x) & BIT_MASK_MACID1_1_8812F) << BIT_SHIFT_MACID1_1_8812F) -+#define BITS_MACID1_1_8812F \ -+ (BIT_MASK_MACID1_1_8812F << BIT_SHIFT_MACID1_1_8812F) -+#define BIT_CLEAR_MACID1_1_8812F(x) ((x) & (~BITS_MACID1_1_8812F)) -+#define BIT_GET_MACID1_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MACID1_1_8812F) & BIT_MASK_MACID1_1_8812F) -+#define BIT_SET_MACID1_1_8812F(x, v) \ -+ (BIT_CLEAR_MACID1_1_8812F(x) | BIT_MACID1_1_8812F(v)) -+ -+/* 2 REG_BSSID1_8812F */ -+ -+#define BIT_SHIFT_BSSID1_0_8812F 0 -+#define BIT_MASK_BSSID1_0_8812F 0xffffffffL -+#define BIT_BSSID1_0_8812F(x) \ -+ (((x) & BIT_MASK_BSSID1_0_8812F) << BIT_SHIFT_BSSID1_0_8812F) -+#define BITS_BSSID1_0_8812F \ -+ (BIT_MASK_BSSID1_0_8812F << BIT_SHIFT_BSSID1_0_8812F) -+#define BIT_CLEAR_BSSID1_0_8812F(x) ((x) & (~BITS_BSSID1_0_8812F)) -+#define BIT_GET_BSSID1_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID1_0_8812F) & BIT_MASK_BSSID1_0_8812F) -+#define BIT_SET_BSSID1_0_8812F(x, v) \ -+ (BIT_CLEAR_BSSID1_0_8812F(x) | BIT_BSSID1_0_8812F(v)) -+ -+/* 2 REG_BSSID1_1_8812F */ -+ -+#define BIT_SHIFT_BSSID1_1_8812F 0 -+#define BIT_MASK_BSSID1_1_8812F 0xffff -+#define BIT_BSSID1_1_8812F(x) \ -+ (((x) & BIT_MASK_BSSID1_1_8812F) << BIT_SHIFT_BSSID1_1_8812F) -+#define BITS_BSSID1_1_8812F \ -+ (BIT_MASK_BSSID1_1_8812F << BIT_SHIFT_BSSID1_1_8812F) -+#define BIT_CLEAR_BSSID1_1_8812F(x) ((x) & (~BITS_BSSID1_1_8812F)) -+#define BIT_GET_BSSID1_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BSSID1_1_8812F) & BIT_MASK_BSSID1_1_8812F) -+#define BIT_SET_BSSID1_1_8812F(x, v) \ -+ (BIT_CLEAR_BSSID1_1_8812F(x) | BIT_BSSID1_1_8812F(v)) -+ -+/* 2 REG_BCN_PSR_RPT1_8812F */ -+ -+#define BIT_SHIFT_DTIM_CNT1_8812F 24 -+#define BIT_MASK_DTIM_CNT1_8812F 0xff -+#define BIT_DTIM_CNT1_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_CNT1_8812F) << BIT_SHIFT_DTIM_CNT1_8812F) -+#define BITS_DTIM_CNT1_8812F \ -+ (BIT_MASK_DTIM_CNT1_8812F << BIT_SHIFT_DTIM_CNT1_8812F) -+#define BIT_CLEAR_DTIM_CNT1_8812F(x) ((x) & (~BITS_DTIM_CNT1_8812F)) -+#define BIT_GET_DTIM_CNT1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT1_8812F) & BIT_MASK_DTIM_CNT1_8812F) -+#define BIT_SET_DTIM_CNT1_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_CNT1_8812F(x) | BIT_DTIM_CNT1_8812F(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD1_8812F 16 -+#define BIT_MASK_DTIM_PERIOD1_8812F 0xff -+#define BIT_DTIM_PERIOD1_8812F(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD1_8812F) << BIT_SHIFT_DTIM_PERIOD1_8812F) -+#define BITS_DTIM_PERIOD1_8812F \ -+ (BIT_MASK_DTIM_PERIOD1_8812F << BIT_SHIFT_DTIM_PERIOD1_8812F) -+#define BIT_CLEAR_DTIM_PERIOD1_8812F(x) ((x) & (~BITS_DTIM_PERIOD1_8812F)) -+#define BIT_GET_DTIM_PERIOD1_8812F(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD1_8812F) & BIT_MASK_DTIM_PERIOD1_8812F) -+#define BIT_SET_DTIM_PERIOD1_8812F(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD1_8812F(x) | BIT_DTIM_PERIOD1_8812F(v)) -+ -+#define BIT_DTIM1_8812F BIT(15) -+#define BIT_TIM1_8812F BIT(14) -+#define BIT_BCN_VALID_V2_8812F BIT(13) -+ -+#define BIT_SHIFT_PS_AID_1_8812F 0 -+#define BIT_MASK_PS_AID_1_8812F 0x7ff -+#define BIT_PS_AID_1_8812F(x) \ -+ (((x) & BIT_MASK_PS_AID_1_8812F) << BIT_SHIFT_PS_AID_1_8812F) -+#define BITS_PS_AID_1_8812F \ -+ (BIT_MASK_PS_AID_1_8812F << BIT_SHIFT_PS_AID_1_8812F) -+#define BIT_CLEAR_PS_AID_1_8812F(x) ((x) & (~BITS_PS_AID_1_8812F)) -+#define BIT_GET_PS_AID_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_1_8812F) & BIT_MASK_PS_AID_1_8812F) -+#define BIT_SET_PS_AID_1_8812F(x, v) \ -+ (BIT_CLEAR_PS_AID_1_8812F(x) | BIT_PS_AID_1_8812F(v)) -+ -+/* 2 REG_ASSOCIATED_BFMEE_SEL_8812F */ -+#define BIT_TXUSER_ID1_8812F BIT(25) -+ -+#define BIT_SHIFT_AID1_8812F 16 -+#define BIT_MASK_AID1_8812F 0x1ff -+#define BIT_AID1_8812F(x) (((x) & BIT_MASK_AID1_8812F) << BIT_SHIFT_AID1_8812F) -+#define BITS_AID1_8812F (BIT_MASK_AID1_8812F << BIT_SHIFT_AID1_8812F) -+#define BIT_CLEAR_AID1_8812F(x) ((x) & (~BITS_AID1_8812F)) -+#define BIT_GET_AID1_8812F(x) \ -+ (((x) >> BIT_SHIFT_AID1_8812F) & BIT_MASK_AID1_8812F) -+#define BIT_SET_AID1_8812F(x, v) (BIT_CLEAR_AID1_8812F(x) | BIT_AID1_8812F(v)) -+ -+#define BIT_TXUSER_ID0_8812F BIT(9) -+ -+#define BIT_SHIFT_AID0_8812F 0 -+#define BIT_MASK_AID0_8812F 0x1ff -+#define BIT_AID0_8812F(x) (((x) & BIT_MASK_AID0_8812F) << BIT_SHIFT_AID0_8812F) -+#define BITS_AID0_8812F (BIT_MASK_AID0_8812F << BIT_SHIFT_AID0_8812F) -+#define BIT_CLEAR_AID0_8812F(x) ((x) & (~BITS_AID0_8812F)) -+#define BIT_GET_AID0_8812F(x) \ -+ (((x) >> BIT_SHIFT_AID0_8812F) & BIT_MASK_AID0_8812F) -+#define BIT_SET_AID0_8812F(x, v) (BIT_CLEAR_AID0_8812F(x) | BIT_AID0_8812F(v)) -+ -+/* 2 REG_SND_PTCL_CTRL_8812F */ -+ -+#define BIT_SHIFT_NDP_RX_STANDBY_TIMER_8812F 24 -+#define BIT_MASK_NDP_RX_STANDBY_TIMER_8812F 0xff -+#define BIT_NDP_RX_STANDBY_TIMER_8812F(x) \ -+ (((x) & BIT_MASK_NDP_RX_STANDBY_TIMER_8812F) \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8812F) -+#define BITS_NDP_RX_STANDBY_TIMER_8812F \ -+ (BIT_MASK_NDP_RX_STANDBY_TIMER_8812F \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8812F) -+#define BIT_CLEAR_NDP_RX_STANDBY_TIMER_8812F(x) \ -+ ((x) & (~BITS_NDP_RX_STANDBY_TIMER_8812F)) -+#define BIT_GET_NDP_RX_STANDBY_TIMER_8812F(x) \ -+ (((x) >> BIT_SHIFT_NDP_RX_STANDBY_TIMER_8812F) & \ -+ BIT_MASK_NDP_RX_STANDBY_TIMER_8812F) -+#define BIT_SET_NDP_RX_STANDBY_TIMER_8812F(x, v) \ -+ (BIT_CLEAR_NDP_RX_STANDBY_TIMER_8812F(x) | \ -+ BIT_NDP_RX_STANDBY_TIMER_8812F(v)) -+ -+#define BIT_R_WMAC_CHK_RPTPOLL_A2_DIS_8812F BIT(23) -+#define BIT_R_WMAC_CHK_UCNDPA_A2_DIS_8812F BIT(22) -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8812F 16 -+#define BIT_MASK_CSI_RPT_OFFSET_HT_V1_8812F 0x3f -+#define BIT_CSI_RPT_OFFSET_HT_V1_8812F(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_HT_V1_8812F) \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8812F) -+#define BITS_CSI_RPT_OFFSET_HT_V1_8812F \ -+ (BIT_MASK_CSI_RPT_OFFSET_HT_V1_8812F \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8812F) -+#define BIT_CLEAR_CSI_RPT_OFFSET_HT_V1_8812F(x) \ -+ ((x) & (~BITS_CSI_RPT_OFFSET_HT_V1_8812F)) -+#define BIT_GET_CSI_RPT_OFFSET_HT_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8812F) & \ -+ BIT_MASK_CSI_RPT_OFFSET_HT_V1_8812F) -+#define BIT_SET_CSI_RPT_OFFSET_HT_V1_8812F(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_HT_V1_8812F(x) | \ -+ BIT_CSI_RPT_OFFSET_HT_V1_8812F(v)) -+ -+#define BIT_R_WMAC_OFFSET_RPTPOLL_EN_8812F BIT(15) -+#define BIT_R_WMAC_CSI_CHKSUM_DIS_8812F BIT(14) -+ -+#define BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1_8812F 8 -+#define BIT_MASK_R_WMAC_VHT_CATEGORY_V1_8812F 0x3f -+#define BIT_R_WMAC_VHT_CATEGORY_V1_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_VHT_CATEGORY_V1_8812F) \ -+ << BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1_8812F) -+#define BITS_R_WMAC_VHT_CATEGORY_V1_8812F \ -+ (BIT_MASK_R_WMAC_VHT_CATEGORY_V1_8812F \ -+ << BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1_8812F) -+#define BIT_CLEAR_R_WMAC_VHT_CATEGORY_V1_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_VHT_CATEGORY_V1_8812F)) -+#define BIT_GET_R_WMAC_VHT_CATEGORY_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1_8812F) & \ -+ BIT_MASK_R_WMAC_VHT_CATEGORY_V1_8812F) -+#define BIT_SET_R_WMAC_VHT_CATEGORY_V1_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_VHT_CATEGORY_V1_8812F(x) | \ -+ BIT_R_WMAC_VHT_CATEGORY_V1_8812F(v)) -+ -+#define BIT_R_WMAC_USE_NSTS_8812F BIT(7) -+#define BIT_R_DISABLE_CHECK_VHTSIGB_CRC_8812F BIT(6) -+#define BIT_R_DISABLE_CHECK_VHTSIGA_CRC_8812F BIT(5) -+#define BIT_R_WMAC_BFPARAM_SEL_8812F BIT(4) -+#define BIT_R_WMAC_CSISEQ_SEL_8812F BIT(3) -+#define BIT_R_WMAC_CSI_WITHHTC_EN_8812F BIT(2) -+#define BIT_R_WMAC_HT_NDPA_EN_8812F BIT(1) -+#define BIT_R_WMAC_VHT_NDPA_EN_8812F BIT(0) -+ -+/* 2 REG_RX_CSI_RPT_INFO_8812F */ -+#define BIT_WRITE_ENABLE_8812F BIT(31) -+#define BIT_WMAC_CHECK_SOUNDING_SEQ_8812F BIT(30) -+ -+#define BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8812F 1 -+#define BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8812F 0xffffff -+#define BIT_VHTHT_MIMO_CTRL_FIELD_8812F(x) \ -+ (((x) & BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8812F) \ -+ << BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8812F) -+#define BITS_VHTHT_MIMO_CTRL_FIELD_8812F \ -+ (BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8812F \ -+ << BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8812F) -+#define BIT_CLEAR_VHTHT_MIMO_CTRL_FIELD_8812F(x) \ -+ ((x) & (~BITS_VHTHT_MIMO_CTRL_FIELD_8812F)) -+#define BIT_GET_VHTHT_MIMO_CTRL_FIELD_8812F(x) \ -+ (((x) >> BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8812F) & \ -+ BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8812F) -+#define BIT_SET_VHTHT_MIMO_CTRL_FIELD_8812F(x, v) \ -+ (BIT_CLEAR_VHTHT_MIMO_CTRL_FIELD_8812F(x) | \ -+ BIT_VHTHT_MIMO_CTRL_FIELD_8812F(v)) -+ -+#define BIT_CSI_INTERRUPT_STATUS_8812F BIT(0) -+ -+/* 2 REG_NS_ARP_CTRL_8812F */ -+#define BIT_R_WMAC_NSARP_RSPEN_8812F BIT(15) -+#define BIT_R_WMAC_NSARP_RARP_8812F BIT(9) -+#define BIT_R_WMAC_NSARP_RIPV6_8812F BIT(8) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_MODEN_8812F 6 -+#define BIT_MASK_R_WMAC_NSARP_MODEN_8812F 0x3 -+#define BIT_R_WMAC_NSARP_MODEN_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_MODEN_8812F) \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8812F) -+#define BITS_R_WMAC_NSARP_MODEN_8812F \ -+ (BIT_MASK_R_WMAC_NSARP_MODEN_8812F \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8812F) -+#define BIT_CLEAR_R_WMAC_NSARP_MODEN_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_MODEN_8812F)) -+#define BIT_GET_R_WMAC_NSARP_MODEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_MODEN_8812F) & \ -+ BIT_MASK_R_WMAC_NSARP_MODEN_8812F) -+#define BIT_SET_R_WMAC_NSARP_MODEN_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_MODEN_8812F(x) | \ -+ BIT_R_WMAC_NSARP_MODEN_8812F(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8812F 4 -+#define BIT_MASK_R_WMAC_NSARP_RSPFTP_8812F 0x3 -+#define BIT_R_WMAC_NSARP_RSPFTP_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPFTP_8812F) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8812F) -+#define BITS_R_WMAC_NSARP_RSPFTP_8812F \ -+ (BIT_MASK_R_WMAC_NSARP_RSPFTP_8812F \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8812F) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPFTP_8812F)) -+#define BIT_GET_R_WMAC_NSARP_RSPFTP_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8812F) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPFTP_8812F) -+#define BIT_SET_R_WMAC_NSARP_RSPFTP_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8812F(x) | \ -+ BIT_R_WMAC_NSARP_RSPFTP_8812F(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8812F 0 -+#define BIT_MASK_R_WMAC_NSARP_RSPSEC_8812F 0xf -+#define BIT_R_WMAC_NSARP_RSPSEC_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPSEC_8812F) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8812F) -+#define BITS_R_WMAC_NSARP_RSPSEC_8812F \ -+ (BIT_MASK_R_WMAC_NSARP_RSPSEC_8812F \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8812F) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPSEC_8812F)) -+#define BIT_GET_R_WMAC_NSARP_RSPSEC_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8812F) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPSEC_8812F) -+#define BIT_SET_R_WMAC_NSARP_RSPSEC_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8812F(x) | \ -+ BIT_R_WMAC_NSARP_RSPSEC_8812F(v)) -+ -+/* 2 REG_NS_ARP_INFO_8812F */ -+#define BIT_REQ_IS_MCNS_8812F BIT(23) -+#define BIT_REQ_IS_UCNS_8812F BIT(22) -+#define BIT_REQ_IS_USNS_8812F BIT(21) -+#define BIT_REQ_IS_ARP_8812F BIT(20) -+#define BIT_EXPRSP_MH_WITHQC_8812F BIT(19) -+ -+#define BIT_SHIFT_EXPRSP_SECTYPE_8812F 16 -+#define BIT_MASK_EXPRSP_SECTYPE_8812F 0x7 -+#define BIT_EXPRSP_SECTYPE_8812F(x) \ -+ (((x) & BIT_MASK_EXPRSP_SECTYPE_8812F) \ -+ << BIT_SHIFT_EXPRSP_SECTYPE_8812F) -+#define BITS_EXPRSP_SECTYPE_8812F \ -+ (BIT_MASK_EXPRSP_SECTYPE_8812F << BIT_SHIFT_EXPRSP_SECTYPE_8812F) -+#define BIT_CLEAR_EXPRSP_SECTYPE_8812F(x) ((x) & (~BITS_EXPRSP_SECTYPE_8812F)) -+#define BIT_GET_EXPRSP_SECTYPE_8812F(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_SECTYPE_8812F) & \ -+ BIT_MASK_EXPRSP_SECTYPE_8812F) -+#define BIT_SET_EXPRSP_SECTYPE_8812F(x, v) \ -+ (BIT_CLEAR_EXPRSP_SECTYPE_8812F(x) | BIT_EXPRSP_SECTYPE_8812F(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8812F 8 -+#define BIT_MASK_EXPRSP_CHKSM_7_TO_0_8812F 0xff -+#define BIT_EXPRSP_CHKSM_7_TO_0_8812F(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_7_TO_0_8812F) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8812F) -+#define BITS_EXPRSP_CHKSM_7_TO_0_8812F \ -+ (BIT_MASK_EXPRSP_CHKSM_7_TO_0_8812F \ -+ << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8812F) -+#define BIT_CLEAR_EXPRSP_CHKSM_7_TO_0_8812F(x) \ -+ ((x) & (~BITS_EXPRSP_CHKSM_7_TO_0_8812F)) -+#define BIT_GET_EXPRSP_CHKSM_7_TO_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8812F) & \ -+ BIT_MASK_EXPRSP_CHKSM_7_TO_0_8812F) -+#define BIT_SET_EXPRSP_CHKSM_7_TO_0_8812F(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_7_TO_0_8812F(x) | \ -+ BIT_EXPRSP_CHKSM_7_TO_0_8812F(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8812F 0 -+#define BIT_MASK_EXPRSP_CHKSM_15_TO_8_8812F 0xff -+#define BIT_EXPRSP_CHKSM_15_TO_8_8812F(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_15_TO_8_8812F) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8812F) -+#define BITS_EXPRSP_CHKSM_15_TO_8_8812F \ -+ (BIT_MASK_EXPRSP_CHKSM_15_TO_8_8812F \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8812F) -+#define BIT_CLEAR_EXPRSP_CHKSM_15_TO_8_8812F(x) \ -+ ((x) & (~BITS_EXPRSP_CHKSM_15_TO_8_8812F)) -+#define BIT_GET_EXPRSP_CHKSM_15_TO_8_8812F(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8812F) & \ -+ BIT_MASK_EXPRSP_CHKSM_15_TO_8_8812F) -+#define BIT_SET_EXPRSP_CHKSM_15_TO_8_8812F(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_15_TO_8_8812F(x) | \ -+ BIT_EXPRSP_CHKSM_15_TO_8_8812F(v)) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_V1_8812F */ -+ -+#define BIT_SHIFT_WMAC_ARPIP_8812F 0 -+#define BIT_MASK_WMAC_ARPIP_8812F 0xffffffffL -+#define BIT_WMAC_ARPIP_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_ARPIP_8812F) << BIT_SHIFT_WMAC_ARPIP_8812F) -+#define BITS_WMAC_ARPIP_8812F \ -+ (BIT_MASK_WMAC_ARPIP_8812F << BIT_SHIFT_WMAC_ARPIP_8812F) -+#define BIT_CLEAR_WMAC_ARPIP_8812F(x) ((x) & (~BITS_WMAC_ARPIP_8812F)) -+#define BIT_GET_WMAC_ARPIP_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARPIP_8812F) & BIT_MASK_WMAC_ARPIP_8812F) -+#define BIT_SET_WMAC_ARPIP_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_ARPIP_8812F(x) | BIT_WMAC_ARPIP_8812F(v)) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_8812F */ -+ -+#define BIT_SHIFT_UPD_BFMEE_USERID_8812F 13 -+#define BIT_MASK_UPD_BFMEE_USERID_8812F 0x7 -+#define BIT_UPD_BFMEE_USERID_8812F(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_USERID_8812F) \ -+ << BIT_SHIFT_UPD_BFMEE_USERID_8812F) -+#define BITS_UPD_BFMEE_USERID_8812F \ -+ (BIT_MASK_UPD_BFMEE_USERID_8812F << BIT_SHIFT_UPD_BFMEE_USERID_8812F) -+#define BIT_CLEAR_UPD_BFMEE_USERID_8812F(x) \ -+ ((x) & (~BITS_UPD_BFMEE_USERID_8812F)) -+#define BIT_GET_UPD_BFMEE_USERID_8812F(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_USERID_8812F) & \ -+ BIT_MASK_UPD_BFMEE_USERID_8812F) -+#define BIT_SET_UPD_BFMEE_USERID_8812F(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_USERID_8812F(x) | BIT_UPD_BFMEE_USERID_8812F(v)) -+ -+#define BIT_UPD_BFMEE_FBTP_8812F BIT(12) -+ -+#define BIT_SHIFT_UPD_BFMEE_BW_8812F 0 -+#define BIT_MASK_UPD_BFMEE_BW_8812F 0xfff -+#define BIT_UPD_BFMEE_BW_8812F(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_BW_8812F) << BIT_SHIFT_UPD_BFMEE_BW_8812F) -+#define BITS_UPD_BFMEE_BW_8812F \ -+ (BIT_MASK_UPD_BFMEE_BW_8812F << BIT_SHIFT_UPD_BFMEE_BW_8812F) -+#define BIT_CLEAR_UPD_BFMEE_BW_8812F(x) ((x) & (~BITS_UPD_BFMEE_BW_8812F)) -+#define BIT_GET_UPD_BFMEE_BW_8812F(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_BW_8812F) & BIT_MASK_UPD_BFMEE_BW_8812F) -+#define BIT_SET_UPD_BFMEE_BW_8812F(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_BW_8812F(x) | BIT_UPD_BFMEE_BW_8812F(v)) -+ -+#define BIT_SHIFT_UPD_BFMEE_CB_8812F 8 -+#define BIT_MASK_UPD_BFMEE_CB_8812F 0x3 -+#define BIT_UPD_BFMEE_CB_8812F(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_CB_8812F) << BIT_SHIFT_UPD_BFMEE_CB_8812F) -+#define BITS_UPD_BFMEE_CB_8812F \ -+ (BIT_MASK_UPD_BFMEE_CB_8812F << BIT_SHIFT_UPD_BFMEE_CB_8812F) -+#define BIT_CLEAR_UPD_BFMEE_CB_8812F(x) ((x) & (~BITS_UPD_BFMEE_CB_8812F)) -+#define BIT_GET_UPD_BFMEE_CB_8812F(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_CB_8812F) & BIT_MASK_UPD_BFMEE_CB_8812F) -+#define BIT_SET_UPD_BFMEE_CB_8812F(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_CB_8812F(x) | BIT_UPD_BFMEE_CB_8812F(v)) -+ -+#define BIT_SHIFT_UPD_BFMEE_NG_8812F 6 -+#define BIT_MASK_UPD_BFMEE_NG_8812F 0x3 -+#define BIT_UPD_BFMEE_NG_8812F(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_NG_8812F) << BIT_SHIFT_UPD_BFMEE_NG_8812F) -+#define BITS_UPD_BFMEE_NG_8812F \ -+ (BIT_MASK_UPD_BFMEE_NG_8812F << BIT_SHIFT_UPD_BFMEE_NG_8812F) -+#define BIT_CLEAR_UPD_BFMEE_NG_8812F(x) ((x) & (~BITS_UPD_BFMEE_NG_8812F)) -+#define BIT_GET_UPD_BFMEE_NG_8812F(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_NG_8812F) & BIT_MASK_UPD_BFMEE_NG_8812F) -+#define BIT_SET_UPD_BFMEE_NG_8812F(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_NG_8812F(x) | BIT_UPD_BFMEE_NG_8812F(v)) -+ -+#define BIT_SHIFT_UPD_BFMEE_NR_8812F 3 -+#define BIT_MASK_UPD_BFMEE_NR_8812F 0x7 -+#define BIT_UPD_BFMEE_NR_8812F(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_NR_8812F) << BIT_SHIFT_UPD_BFMEE_NR_8812F) -+#define BITS_UPD_BFMEE_NR_8812F \ -+ (BIT_MASK_UPD_BFMEE_NR_8812F << BIT_SHIFT_UPD_BFMEE_NR_8812F) -+#define BIT_CLEAR_UPD_BFMEE_NR_8812F(x) ((x) & (~BITS_UPD_BFMEE_NR_8812F)) -+#define BIT_GET_UPD_BFMEE_NR_8812F(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_NR_8812F) & BIT_MASK_UPD_BFMEE_NR_8812F) -+#define BIT_SET_UPD_BFMEE_NR_8812F(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_NR_8812F(x) | BIT_UPD_BFMEE_NR_8812F(v)) -+ -+#define BIT_SHIFT_UPD_BFMEE_NC_8812F 0 -+#define BIT_MASK_UPD_BFMEE_NC_8812F 0x7 -+#define BIT_UPD_BFMEE_NC_8812F(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_NC_8812F) << BIT_SHIFT_UPD_BFMEE_NC_8812F) -+#define BITS_UPD_BFMEE_NC_8812F \ -+ (BIT_MASK_UPD_BFMEE_NC_8812F << BIT_SHIFT_UPD_BFMEE_NC_8812F) -+#define BIT_CLEAR_UPD_BFMEE_NC_8812F(x) ((x) & (~BITS_UPD_BFMEE_NC_8812F)) -+#define BIT_GET_UPD_BFMEE_NC_8812F(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_NC_8812F) & BIT_MASK_UPD_BFMEE_NC_8812F) -+#define BIT_SET_UPD_BFMEE_NC_8812F(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_NC_8812F(x) | BIT_UPD_BFMEE_NC_8812F(v)) -+ -+/* 2 REG_IPV6_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8812F 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8812F 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_0_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8812F) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8812F) -+#define BITS_R_WMAC_IPV6_MYIPAD_0_8812F \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8812F \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8812F) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_0_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_0_8812F)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8812F) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8812F) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_0_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_0_8812F(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_0_8812F(v)) -+ -+/* 2 REG_IPV6_1_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8812F 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8812F 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_1_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8812F) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8812F) -+#define BITS_R_WMAC_IPV6_MYIPAD_1_8812F \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8812F \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8812F) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_1_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_1_8812F)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8812F) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8812F) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_1_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_1_8812F(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_1_8812F(v)) -+ -+/* 2 REG_IPV6_2_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8812F 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8812F 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_2_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8812F) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8812F) -+#define BITS_R_WMAC_IPV6_MYIPAD_2_8812F \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8812F \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8812F) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_2_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_2_8812F)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8812F) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8812F) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_2_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_2_8812F(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_2_8812F(v)) -+ -+/* 2 REG_IPV6_3_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8812F 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8812F 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_3_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8812F) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8812F) -+#define BITS_R_WMAC_IPV6_MYIPAD_3_8812F \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8812F \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8812F) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_3_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_3_8812F)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_3_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8812F) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8812F) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_3_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_3_8812F(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_3_8812F(v)) -+ -+/* 2 REG_WMAC_RTX_CTX_SUBTYPE_CFG_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8812F 4 -+#define BIT_MASK_R_WMAC_CTX_SUBTYPE_8812F 0xf -+#define BIT_R_WMAC_CTX_SUBTYPE_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_CTX_SUBTYPE_8812F) \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8812F) -+#define BITS_R_WMAC_CTX_SUBTYPE_8812F \ -+ (BIT_MASK_R_WMAC_CTX_SUBTYPE_8812F \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8812F) -+#define BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_CTX_SUBTYPE_8812F)) -+#define BIT_GET_R_WMAC_CTX_SUBTYPE_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8812F) & \ -+ BIT_MASK_R_WMAC_CTX_SUBTYPE_8812F) -+#define BIT_SET_R_WMAC_CTX_SUBTYPE_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8812F(x) | \ -+ BIT_R_WMAC_CTX_SUBTYPE_8812F(v)) -+ -+#define BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8812F 0 -+#define BIT_MASK_R_WMAC_RTX_SUBTYPE_8812F 0xf -+#define BIT_R_WMAC_RTX_SUBTYPE_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_RTX_SUBTYPE_8812F) \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8812F) -+#define BITS_R_WMAC_RTX_SUBTYPE_8812F \ -+ (BIT_MASK_R_WMAC_RTX_SUBTYPE_8812F \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8812F) -+#define BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_RTX_SUBTYPE_8812F)) -+#define BIT_GET_R_WMAC_RTX_SUBTYPE_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8812F) & \ -+ BIT_MASK_R_WMAC_RTX_SUBTYPE_8812F) -+#define BIT_SET_R_WMAC_RTX_SUBTYPE_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8812F(x) | \ -+ BIT_R_WMAC_RTX_SUBTYPE_8812F(v)) -+ -+/* 2 REG_WMAC_SWAES_DIO_B63_B32_8812F */ -+ -+#define BIT_SHIFT_WMAC_SWAES_DIO_B63_B32_8812F 0 -+#define BIT_MASK_WMAC_SWAES_DIO_B63_B32_8812F 0xffffffffL -+#define BIT_WMAC_SWAES_DIO_B63_B32_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_SWAES_DIO_B63_B32_8812F) \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B63_B32_8812F) -+#define BITS_WMAC_SWAES_DIO_B63_B32_8812F \ -+ (BIT_MASK_WMAC_SWAES_DIO_B63_B32_8812F \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B63_B32_8812F) -+#define BIT_CLEAR_WMAC_SWAES_DIO_B63_B32_8812F(x) \ -+ ((x) & (~BITS_WMAC_SWAES_DIO_B63_B32_8812F)) -+#define BIT_GET_WMAC_SWAES_DIO_B63_B32_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SWAES_DIO_B63_B32_8812F) & \ -+ BIT_MASK_WMAC_SWAES_DIO_B63_B32_8812F) -+#define BIT_SET_WMAC_SWAES_DIO_B63_B32_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_SWAES_DIO_B63_B32_8812F(x) | \ -+ BIT_WMAC_SWAES_DIO_B63_B32_8812F(v)) -+ -+/* 2 REG_WMAC_SWAES_DIO_B95_B64_8812F */ -+ -+#define BIT_SHIFT_WMAC_SWAES_DIO_B95_B64_8812F 0 -+#define BIT_MASK_WMAC_SWAES_DIO_B95_B64_8812F 0xffffffffL -+#define BIT_WMAC_SWAES_DIO_B95_B64_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_SWAES_DIO_B95_B64_8812F) \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B95_B64_8812F) -+#define BITS_WMAC_SWAES_DIO_B95_B64_8812F \ -+ (BIT_MASK_WMAC_SWAES_DIO_B95_B64_8812F \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B95_B64_8812F) -+#define BIT_CLEAR_WMAC_SWAES_DIO_B95_B64_8812F(x) \ -+ ((x) & (~BITS_WMAC_SWAES_DIO_B95_B64_8812F)) -+#define BIT_GET_WMAC_SWAES_DIO_B95_B64_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SWAES_DIO_B95_B64_8812F) & \ -+ BIT_MASK_WMAC_SWAES_DIO_B95_B64_8812F) -+#define BIT_SET_WMAC_SWAES_DIO_B95_B64_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_SWAES_DIO_B95_B64_8812F(x) | \ -+ BIT_WMAC_SWAES_DIO_B95_B64_8812F(v)) -+ -+/* 2 REG_WMAC_SWAES_DIO_B127_B96_8812F */ -+ -+#define BIT_SHIFT_WMAC_SWAES_DIO_B127_B96_8812F 0 -+#define BIT_MASK_WMAC_SWAES_DIO_B127_B96_8812F 0xffffffffL -+#define BIT_WMAC_SWAES_DIO_B127_B96_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_SWAES_DIO_B127_B96_8812F) \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B127_B96_8812F) -+#define BITS_WMAC_SWAES_DIO_B127_B96_8812F \ -+ (BIT_MASK_WMAC_SWAES_DIO_B127_B96_8812F \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B127_B96_8812F) -+#define BIT_CLEAR_WMAC_SWAES_DIO_B127_B96_8812F(x) \ -+ ((x) & (~BITS_WMAC_SWAES_DIO_B127_B96_8812F)) -+#define BIT_GET_WMAC_SWAES_DIO_B127_B96_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SWAES_DIO_B127_B96_8812F) & \ -+ BIT_MASK_WMAC_SWAES_DIO_B127_B96_8812F) -+#define BIT_SET_WMAC_SWAES_DIO_B127_B96_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_SWAES_DIO_B127_B96_8812F(x) | \ -+ BIT_WMAC_SWAES_DIO_B127_B96_8812F(v)) -+ -+/* 2 REG_WMAC_SWAES_CFG_8812F */ -+ -+/* 2 REG_BT_COEX_V2_8812F */ -+#define BIT_GNT_BT_POLARITY_8812F BIT(12) -+#define BIT_GNT_BT_BYPASS_PRIORITY_8812F BIT(8) -+ -+#define BIT_SHIFT_TIMER_8812F 0 -+#define BIT_MASK_TIMER_8812F 0xff -+#define BIT_TIMER_8812F(x) \ -+ (((x) & BIT_MASK_TIMER_8812F) << BIT_SHIFT_TIMER_8812F) -+#define BITS_TIMER_8812F (BIT_MASK_TIMER_8812F << BIT_SHIFT_TIMER_8812F) -+#define BIT_CLEAR_TIMER_8812F(x) ((x) & (~BITS_TIMER_8812F)) -+#define BIT_GET_TIMER_8812F(x) \ -+ (((x) >> BIT_SHIFT_TIMER_8812F) & BIT_MASK_TIMER_8812F) -+#define BIT_SET_TIMER_8812F(x, v) \ -+ (BIT_CLEAR_TIMER_8812F(x) | BIT_TIMER_8812F(v)) -+ -+/* 2 REG_BT_COEX_8812F */ -+#define BIT_R_GNT_BT_RFC_SW_8812F BIT(12) -+#define BIT_R_GNT_BT_RFC_SW_EN_8812F BIT(11) -+#define BIT_R_GNT_BT_BB_SW_8812F BIT(10) -+#define BIT_R_GNT_BT_BB_SW_EN_8812F BIT(9) -+#define BIT_R_BT_CNT_THREN_8812F BIT(8) -+ -+#define BIT_SHIFT_R_BT_CNT_THR_8812F 0 -+#define BIT_MASK_R_BT_CNT_THR_8812F 0xff -+#define BIT_R_BT_CNT_THR_8812F(x) \ -+ (((x) & BIT_MASK_R_BT_CNT_THR_8812F) << BIT_SHIFT_R_BT_CNT_THR_8812F) -+#define BITS_R_BT_CNT_THR_8812F \ -+ (BIT_MASK_R_BT_CNT_THR_8812F << BIT_SHIFT_R_BT_CNT_THR_8812F) -+#define BIT_CLEAR_R_BT_CNT_THR_8812F(x) ((x) & (~BITS_R_BT_CNT_THR_8812F)) -+#define BIT_GET_R_BT_CNT_THR_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CNT_THR_8812F) & BIT_MASK_R_BT_CNT_THR_8812F) -+#define BIT_SET_R_BT_CNT_THR_8812F(x, v) \ -+ (BIT_CLEAR_R_BT_CNT_THR_8812F(x) | BIT_R_BT_CNT_THR_8812F(v)) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_8812F */ -+ -+#define BIT_SHIFT_RXMYRTS_NAV_V1_8812F 8 -+#define BIT_MASK_RXMYRTS_NAV_V1_8812F 0xff -+#define BIT_RXMYRTS_NAV_V1_8812F(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_V1_8812F) \ -+ << BIT_SHIFT_RXMYRTS_NAV_V1_8812F) -+#define BITS_RXMYRTS_NAV_V1_8812F \ -+ (BIT_MASK_RXMYRTS_NAV_V1_8812F << BIT_SHIFT_RXMYRTS_NAV_V1_8812F) -+#define BIT_CLEAR_RXMYRTS_NAV_V1_8812F(x) ((x) & (~BITS_RXMYRTS_NAV_V1_8812F)) -+#define BIT_GET_RXMYRTS_NAV_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_V1_8812F) & \ -+ BIT_MASK_RXMYRTS_NAV_V1_8812F) -+#define BIT_SET_RXMYRTS_NAV_V1_8812F(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_V1_8812F(x) | BIT_RXMYRTS_NAV_V1_8812F(v)) -+ -+#define BIT_SHIFT_RTSRST_V1_8812F 0 -+#define BIT_MASK_RTSRST_V1_8812F 0xff -+#define BIT_RTSRST_V1_8812F(x) \ -+ (((x) & BIT_MASK_RTSRST_V1_8812F) << BIT_SHIFT_RTSRST_V1_8812F) -+#define BITS_RTSRST_V1_8812F \ -+ (BIT_MASK_RTSRST_V1_8812F << BIT_SHIFT_RTSRST_V1_8812F) -+#define BIT_CLEAR_RTSRST_V1_8812F(x) ((x) & (~BITS_RTSRST_V1_8812F)) -+#define BIT_GET_RTSRST_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_V1_8812F) & BIT_MASK_RTSRST_V1_8812F) -+#define BIT_SET_RTSRST_V1_8812F(x, v) \ -+ (BIT_CLEAR_RTSRST_V1_8812F(x) | BIT_RTSRST_V1_8812F(v)) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_1_8812F */ -+#define BIT_WLRX_TER_BY_CTL_1_8812F BIT(11) -+#define BIT_WLRX_TER_BY_AD_1_8812F BIT(10) -+#define BIT_ANT_DIVERSITY_SEL_1_8812F BIT(9) -+#define BIT_ANTSEL_FOR_BT_CTRL_EN_1_8812F BIT(8) -+#define BIT_WLACT_LOW_GNTWL_EN_1_8812F BIT(2) -+#define BIT_WLACT_HIGH_GNTBT_EN_1_8812F BIT(1) -+#define BIT_NAV_UPPER_1_V1_8812F BIT(0) -+ -+/* 2 REG_BT_COEX_ENHANCED_INTR_CTRL_8812F */ -+ -+#define BIT_SHIFT_BT_STAT_DELAY_8812F 12 -+#define BIT_MASK_BT_STAT_DELAY_8812F 0xf -+#define BIT_BT_STAT_DELAY_8812F(x) \ -+ (((x) & BIT_MASK_BT_STAT_DELAY_8812F) << BIT_SHIFT_BT_STAT_DELAY_8812F) -+#define BITS_BT_STAT_DELAY_8812F \ -+ (BIT_MASK_BT_STAT_DELAY_8812F << BIT_SHIFT_BT_STAT_DELAY_8812F) -+#define BIT_CLEAR_BT_STAT_DELAY_8812F(x) ((x) & (~BITS_BT_STAT_DELAY_8812F)) -+#define BIT_GET_BT_STAT_DELAY_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_STAT_DELAY_8812F) & BIT_MASK_BT_STAT_DELAY_8812F) -+#define BIT_SET_BT_STAT_DELAY_8812F(x, v) \ -+ (BIT_CLEAR_BT_STAT_DELAY_8812F(x) | BIT_BT_STAT_DELAY_8812F(v)) -+ -+#define BIT_SHIFT_BT_TRX_INIT_DETECT_8812F 8 -+#define BIT_MASK_BT_TRX_INIT_DETECT_8812F 0xf -+#define BIT_BT_TRX_INIT_DETECT_8812F(x) \ -+ (((x) & BIT_MASK_BT_TRX_INIT_DETECT_8812F) \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8812F) -+#define BITS_BT_TRX_INIT_DETECT_8812F \ -+ (BIT_MASK_BT_TRX_INIT_DETECT_8812F \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8812F) -+#define BIT_CLEAR_BT_TRX_INIT_DETECT_8812F(x) \ -+ ((x) & (~BITS_BT_TRX_INIT_DETECT_8812F)) -+#define BIT_GET_BT_TRX_INIT_DETECT_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_TRX_INIT_DETECT_8812F) & \ -+ BIT_MASK_BT_TRX_INIT_DETECT_8812F) -+#define BIT_SET_BT_TRX_INIT_DETECT_8812F(x, v) \ -+ (BIT_CLEAR_BT_TRX_INIT_DETECT_8812F(x) | \ -+ BIT_BT_TRX_INIT_DETECT_8812F(v)) -+ -+#define BIT_SHIFT_BT_PRI_DETECT_TO_8812F 4 -+#define BIT_MASK_BT_PRI_DETECT_TO_8812F 0xf -+#define BIT_BT_PRI_DETECT_TO_8812F(x) \ -+ (((x) & BIT_MASK_BT_PRI_DETECT_TO_8812F) \ -+ << BIT_SHIFT_BT_PRI_DETECT_TO_8812F) -+#define BITS_BT_PRI_DETECT_TO_8812F \ -+ (BIT_MASK_BT_PRI_DETECT_TO_8812F << BIT_SHIFT_BT_PRI_DETECT_TO_8812F) -+#define BIT_CLEAR_BT_PRI_DETECT_TO_8812F(x) \ -+ ((x) & (~BITS_BT_PRI_DETECT_TO_8812F)) -+#define BIT_GET_BT_PRI_DETECT_TO_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_PRI_DETECT_TO_8812F) & \ -+ BIT_MASK_BT_PRI_DETECT_TO_8812F) -+#define BIT_SET_BT_PRI_DETECT_TO_8812F(x, v) \ -+ (BIT_CLEAR_BT_PRI_DETECT_TO_8812F(x) | BIT_BT_PRI_DETECT_TO_8812F(v)) -+ -+#define BIT_R_GRANTALL_WLMASK_8812F BIT(3) -+#define BIT_STATIS_BT_EN_8812F BIT(2) -+#define BIT_WL_ACT_MASK_ENABLE_8812F BIT(1) -+#define BIT_ENHANCED_BT_8812F BIT(0) -+ -+/* 2 REG_BT_ACT_STATISTICS_8812F */ -+ -+#define BIT_SHIFT_STATIS_BT_HI_RX_8812F 16 -+#define BIT_MASK_STATIS_BT_HI_RX_8812F 0xffff -+#define BIT_STATIS_BT_HI_RX_8812F(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_RX_8812F) \ -+ << BIT_SHIFT_STATIS_BT_HI_RX_8812F) -+#define BITS_STATIS_BT_HI_RX_8812F \ -+ (BIT_MASK_STATIS_BT_HI_RX_8812F << BIT_SHIFT_STATIS_BT_HI_RX_8812F) -+#define BIT_CLEAR_STATIS_BT_HI_RX_8812F(x) ((x) & (~BITS_STATIS_BT_HI_RX_8812F)) -+#define BIT_GET_STATIS_BT_HI_RX_8812F(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_RX_8812F) & \ -+ BIT_MASK_STATIS_BT_HI_RX_8812F) -+#define BIT_SET_STATIS_BT_HI_RX_8812F(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_RX_8812F(x) | BIT_STATIS_BT_HI_RX_8812F(v)) -+ -+#define BIT_SHIFT_STATIS_BT_HI_TX_8812F 0 -+#define BIT_MASK_STATIS_BT_HI_TX_8812F 0xffff -+#define BIT_STATIS_BT_HI_TX_8812F(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_TX_8812F) \ -+ << BIT_SHIFT_STATIS_BT_HI_TX_8812F) -+#define BITS_STATIS_BT_HI_TX_8812F \ -+ (BIT_MASK_STATIS_BT_HI_TX_8812F << BIT_SHIFT_STATIS_BT_HI_TX_8812F) -+#define BIT_CLEAR_STATIS_BT_HI_TX_8812F(x) ((x) & (~BITS_STATIS_BT_HI_TX_8812F)) -+#define BIT_GET_STATIS_BT_HI_TX_8812F(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_TX_8812F) & \ -+ BIT_MASK_STATIS_BT_HI_TX_8812F) -+#define BIT_SET_STATIS_BT_HI_TX_8812F(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_TX_8812F(x) | BIT_STATIS_BT_HI_TX_8812F(v)) -+ -+/* 2 REG_BT_ACT_STATISTICS_1_8812F */ -+ -+#define BIT_SHIFT_STATIS_BT_LO_RX_1_8812F 16 -+#define BIT_MASK_STATIS_BT_LO_RX_1_8812F 0xffff -+#define BIT_STATIS_BT_LO_RX_1_8812F(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_RX_1_8812F) \ -+ << BIT_SHIFT_STATIS_BT_LO_RX_1_8812F) -+#define BITS_STATIS_BT_LO_RX_1_8812F \ -+ (BIT_MASK_STATIS_BT_LO_RX_1_8812F << BIT_SHIFT_STATIS_BT_LO_RX_1_8812F) -+#define BIT_CLEAR_STATIS_BT_LO_RX_1_8812F(x) \ -+ ((x) & (~BITS_STATIS_BT_LO_RX_1_8812F)) -+#define BIT_GET_STATIS_BT_LO_RX_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_RX_1_8812F) & \ -+ BIT_MASK_STATIS_BT_LO_RX_1_8812F) -+#define BIT_SET_STATIS_BT_LO_RX_1_8812F(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_RX_1_8812F(x) | BIT_STATIS_BT_LO_RX_1_8812F(v)) -+ -+#define BIT_SHIFT_STATIS_BT_LO_TX_1_8812F 0 -+#define BIT_MASK_STATIS_BT_LO_TX_1_8812F 0xffff -+#define BIT_STATIS_BT_LO_TX_1_8812F(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_TX_1_8812F) \ -+ << BIT_SHIFT_STATIS_BT_LO_TX_1_8812F) -+#define BITS_STATIS_BT_LO_TX_1_8812F \ -+ (BIT_MASK_STATIS_BT_LO_TX_1_8812F << BIT_SHIFT_STATIS_BT_LO_TX_1_8812F) -+#define BIT_CLEAR_STATIS_BT_LO_TX_1_8812F(x) \ -+ ((x) & (~BITS_STATIS_BT_LO_TX_1_8812F)) -+#define BIT_GET_STATIS_BT_LO_TX_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_TX_1_8812F) & \ -+ BIT_MASK_STATIS_BT_LO_TX_1_8812F) -+#define BIT_SET_STATIS_BT_LO_TX_1_8812F(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_TX_1_8812F(x) | BIT_STATIS_BT_LO_TX_1_8812F(v)) -+ -+/* 2 REG_BT_STATISTICS_CONTROL_REGISTER_8812F */ -+ -+#define BIT_SHIFT_R_BT_CMD_RPT_8812F 16 -+#define BIT_MASK_R_BT_CMD_RPT_8812F 0xffff -+#define BIT_R_BT_CMD_RPT_8812F(x) \ -+ (((x) & BIT_MASK_R_BT_CMD_RPT_8812F) << BIT_SHIFT_R_BT_CMD_RPT_8812F) -+#define BITS_R_BT_CMD_RPT_8812F \ -+ (BIT_MASK_R_BT_CMD_RPT_8812F << BIT_SHIFT_R_BT_CMD_RPT_8812F) -+#define BIT_CLEAR_R_BT_CMD_RPT_8812F(x) ((x) & (~BITS_R_BT_CMD_RPT_8812F)) -+#define BIT_GET_R_BT_CMD_RPT_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CMD_RPT_8812F) & BIT_MASK_R_BT_CMD_RPT_8812F) -+#define BIT_SET_R_BT_CMD_RPT_8812F(x, v) \ -+ (BIT_CLEAR_R_BT_CMD_RPT_8812F(x) | BIT_R_BT_CMD_RPT_8812F(v)) -+ -+#define BIT_SHIFT_R_RPT_FROM_BT_8812F 8 -+#define BIT_MASK_R_RPT_FROM_BT_8812F 0xff -+#define BIT_R_RPT_FROM_BT_8812F(x) \ -+ (((x) & BIT_MASK_R_RPT_FROM_BT_8812F) << BIT_SHIFT_R_RPT_FROM_BT_8812F) -+#define BITS_R_RPT_FROM_BT_8812F \ -+ (BIT_MASK_R_RPT_FROM_BT_8812F << BIT_SHIFT_R_RPT_FROM_BT_8812F) -+#define BIT_CLEAR_R_RPT_FROM_BT_8812F(x) ((x) & (~BITS_R_RPT_FROM_BT_8812F)) -+#define BIT_GET_R_RPT_FROM_BT_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_RPT_FROM_BT_8812F) & BIT_MASK_R_RPT_FROM_BT_8812F) -+#define BIT_SET_R_RPT_FROM_BT_8812F(x, v) \ -+ (BIT_CLEAR_R_RPT_FROM_BT_8812F(x) | BIT_R_RPT_FROM_BT_8812F(v)) -+ -+#define BIT_SHIFT_BT_HID_ISR_SET_8812F 6 -+#define BIT_MASK_BT_HID_ISR_SET_8812F 0x3 -+#define BIT_BT_HID_ISR_SET_8812F(x) \ -+ (((x) & BIT_MASK_BT_HID_ISR_SET_8812F) \ -+ << BIT_SHIFT_BT_HID_ISR_SET_8812F) -+#define BITS_BT_HID_ISR_SET_8812F \ -+ (BIT_MASK_BT_HID_ISR_SET_8812F << BIT_SHIFT_BT_HID_ISR_SET_8812F) -+#define BIT_CLEAR_BT_HID_ISR_SET_8812F(x) ((x) & (~BITS_BT_HID_ISR_SET_8812F)) -+#define BIT_GET_BT_HID_ISR_SET_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_HID_ISR_SET_8812F) & \ -+ BIT_MASK_BT_HID_ISR_SET_8812F) -+#define BIT_SET_BT_HID_ISR_SET_8812F(x, v) \ -+ (BIT_CLEAR_BT_HID_ISR_SET_8812F(x) | BIT_BT_HID_ISR_SET_8812F(v)) -+ -+#define BIT_TDMA_BT_START_NOTIFY_8812F BIT(5) -+#define BIT_ENABLE_TDMA_FW_MODE_8812F BIT(4) -+#define BIT_ENABLE_PTA_TDMA_MODE_8812F BIT(3) -+#define BIT_ENABLE_COEXIST_TAB_IN_TDMA_8812F BIT(2) -+#define BIT_GPIO2_GPIO3_EXANGE_OR_NO_BT_CCA_8812F BIT(1) -+#define BIT_RTK_BT_ENABLE_8812F BIT(0) -+ -+/* 2 REG_BT_STATUS_REPORT_REGISTER_8812F */ -+ -+#define BIT_SHIFT_BT_PROFILE_8812F 24 -+#define BIT_MASK_BT_PROFILE_8812F 0xff -+#define BIT_BT_PROFILE_8812F(x) \ -+ (((x) & BIT_MASK_BT_PROFILE_8812F) << BIT_SHIFT_BT_PROFILE_8812F) -+#define BITS_BT_PROFILE_8812F \ -+ (BIT_MASK_BT_PROFILE_8812F << BIT_SHIFT_BT_PROFILE_8812F) -+#define BIT_CLEAR_BT_PROFILE_8812F(x) ((x) & (~BITS_BT_PROFILE_8812F)) -+#define BIT_GET_BT_PROFILE_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_PROFILE_8812F) & BIT_MASK_BT_PROFILE_8812F) -+#define BIT_SET_BT_PROFILE_8812F(x, v) \ -+ (BIT_CLEAR_BT_PROFILE_8812F(x) | BIT_BT_PROFILE_8812F(v)) -+ -+#define BIT_SHIFT_BT_POWER_8812F 16 -+#define BIT_MASK_BT_POWER_8812F 0xff -+#define BIT_BT_POWER_8812F(x) \ -+ (((x) & BIT_MASK_BT_POWER_8812F) << BIT_SHIFT_BT_POWER_8812F) -+#define BITS_BT_POWER_8812F \ -+ (BIT_MASK_BT_POWER_8812F << BIT_SHIFT_BT_POWER_8812F) -+#define BIT_CLEAR_BT_POWER_8812F(x) ((x) & (~BITS_BT_POWER_8812F)) -+#define BIT_GET_BT_POWER_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_POWER_8812F) & BIT_MASK_BT_POWER_8812F) -+#define BIT_SET_BT_POWER_8812F(x, v) \ -+ (BIT_CLEAR_BT_POWER_8812F(x) | BIT_BT_POWER_8812F(v)) -+ -+#define BIT_SHIFT_BT_PREDECT_STATUS_8812F 8 -+#define BIT_MASK_BT_PREDECT_STATUS_8812F 0xff -+#define BIT_BT_PREDECT_STATUS_8812F(x) \ -+ (((x) & BIT_MASK_BT_PREDECT_STATUS_8812F) \ -+ << BIT_SHIFT_BT_PREDECT_STATUS_8812F) -+#define BITS_BT_PREDECT_STATUS_8812F \ -+ (BIT_MASK_BT_PREDECT_STATUS_8812F << BIT_SHIFT_BT_PREDECT_STATUS_8812F) -+#define BIT_CLEAR_BT_PREDECT_STATUS_8812F(x) \ -+ ((x) & (~BITS_BT_PREDECT_STATUS_8812F)) -+#define BIT_GET_BT_PREDECT_STATUS_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_PREDECT_STATUS_8812F) & \ -+ BIT_MASK_BT_PREDECT_STATUS_8812F) -+#define BIT_SET_BT_PREDECT_STATUS_8812F(x, v) \ -+ (BIT_CLEAR_BT_PREDECT_STATUS_8812F(x) | BIT_BT_PREDECT_STATUS_8812F(v)) -+ -+#define BIT_SHIFT_BT_CMD_INFO_8812F 0 -+#define BIT_MASK_BT_CMD_INFO_8812F 0xff -+#define BIT_BT_CMD_INFO_8812F(x) \ -+ (((x) & BIT_MASK_BT_CMD_INFO_8812F) << BIT_SHIFT_BT_CMD_INFO_8812F) -+#define BITS_BT_CMD_INFO_8812F \ -+ (BIT_MASK_BT_CMD_INFO_8812F << BIT_SHIFT_BT_CMD_INFO_8812F) -+#define BIT_CLEAR_BT_CMD_INFO_8812F(x) ((x) & (~BITS_BT_CMD_INFO_8812F)) -+#define BIT_GET_BT_CMD_INFO_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_CMD_INFO_8812F) & BIT_MASK_BT_CMD_INFO_8812F) -+#define BIT_SET_BT_CMD_INFO_8812F(x, v) \ -+ (BIT_CLEAR_BT_CMD_INFO_8812F(x) | BIT_BT_CMD_INFO_8812F(v)) -+ -+/* 2 REG_BT_INTERRUPT_CONTROL_REGISTER_8812F */ -+#define BIT_EN_MAC_NULL_PKT_NOTIFY_8812F BIT(31) -+#define BIT_EN_WLAN_RPT_AND_BT_QUERY_8812F BIT(30) -+#define BIT_EN_BT_STSTUS_RPT_8812F BIT(29) -+#define BIT_EN_BT_POWER_8812F BIT(28) -+#define BIT_EN_BT_CHANNEL_8812F BIT(27) -+#define BIT_EN_BT_SLOT_CHANGE_8812F BIT(26) -+#define BIT_EN_BT_PROFILE_OR_HID_8812F BIT(25) -+#define BIT_WLAN_RPT_NOTIFY_8812F BIT(24) -+ -+#define BIT_SHIFT_WLAN_RPT_DATA_8812F 16 -+#define BIT_MASK_WLAN_RPT_DATA_8812F 0xff -+#define BIT_WLAN_RPT_DATA_8812F(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_DATA_8812F) << BIT_SHIFT_WLAN_RPT_DATA_8812F) -+#define BITS_WLAN_RPT_DATA_8812F \ -+ (BIT_MASK_WLAN_RPT_DATA_8812F << BIT_SHIFT_WLAN_RPT_DATA_8812F) -+#define BIT_CLEAR_WLAN_RPT_DATA_8812F(x) ((x) & (~BITS_WLAN_RPT_DATA_8812F)) -+#define BIT_GET_WLAN_RPT_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_DATA_8812F) & BIT_MASK_WLAN_RPT_DATA_8812F) -+#define BIT_SET_WLAN_RPT_DATA_8812F(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_DATA_8812F(x) | BIT_WLAN_RPT_DATA_8812F(v)) -+ -+#define BIT_SHIFT_CMD_ID_8812F 8 -+#define BIT_MASK_CMD_ID_8812F 0xff -+#define BIT_CMD_ID_8812F(x) \ -+ (((x) & BIT_MASK_CMD_ID_8812F) << BIT_SHIFT_CMD_ID_8812F) -+#define BITS_CMD_ID_8812F (BIT_MASK_CMD_ID_8812F << BIT_SHIFT_CMD_ID_8812F) -+#define BIT_CLEAR_CMD_ID_8812F(x) ((x) & (~BITS_CMD_ID_8812F)) -+#define BIT_GET_CMD_ID_8812F(x) \ -+ (((x) >> BIT_SHIFT_CMD_ID_8812F) & BIT_MASK_CMD_ID_8812F) -+#define BIT_SET_CMD_ID_8812F(x, v) \ -+ (BIT_CLEAR_CMD_ID_8812F(x) | BIT_CMD_ID_8812F(v)) -+ -+#define BIT_SHIFT_BT_DATA_8812F 0 -+#define BIT_MASK_BT_DATA_8812F 0xff -+#define BIT_BT_DATA_8812F(x) \ -+ (((x) & BIT_MASK_BT_DATA_8812F) << BIT_SHIFT_BT_DATA_8812F) -+#define BITS_BT_DATA_8812F (BIT_MASK_BT_DATA_8812F << BIT_SHIFT_BT_DATA_8812F) -+#define BIT_CLEAR_BT_DATA_8812F(x) ((x) & (~BITS_BT_DATA_8812F)) -+#define BIT_GET_BT_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_DATA_8812F) & BIT_MASK_BT_DATA_8812F) -+#define BIT_SET_BT_DATA_8812F(x, v) \ -+ (BIT_CLEAR_BT_DATA_8812F(x) | BIT_BT_DATA_8812F(v)) -+ -+/* 2 REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8812F */ -+ -+#define BIT_SHIFT_WLAN_RPT_TO_8812F 0 -+#define BIT_MASK_WLAN_RPT_TO_8812F 0xff -+#define BIT_WLAN_RPT_TO_8812F(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_TO_8812F) << BIT_SHIFT_WLAN_RPT_TO_8812F) -+#define BITS_WLAN_RPT_TO_8812F \ -+ (BIT_MASK_WLAN_RPT_TO_8812F << BIT_SHIFT_WLAN_RPT_TO_8812F) -+#define BIT_CLEAR_WLAN_RPT_TO_8812F(x) ((x) & (~BITS_WLAN_RPT_TO_8812F)) -+#define BIT_GET_WLAN_RPT_TO_8812F(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_TO_8812F) & BIT_MASK_WLAN_RPT_TO_8812F) -+#define BIT_SET_WLAN_RPT_TO_8812F(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_TO_8812F(x) | BIT_WLAN_RPT_TO_8812F(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8812F */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_0_8812F 1 -+#define BIT_MASK_ISOLATION_CHK_0_8812F 0x7fffff -+#define BIT_ISOLATION_CHK_0_8812F(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_0_8812F) \ -+ << BIT_SHIFT_ISOLATION_CHK_0_8812F) -+#define BITS_ISOLATION_CHK_0_8812F \ -+ (BIT_MASK_ISOLATION_CHK_0_8812F << BIT_SHIFT_ISOLATION_CHK_0_8812F) -+#define BIT_CLEAR_ISOLATION_CHK_0_8812F(x) ((x) & (~BITS_ISOLATION_CHK_0_8812F)) -+#define BIT_GET_ISOLATION_CHK_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_0_8812F) & \ -+ BIT_MASK_ISOLATION_CHK_0_8812F) -+#define BIT_SET_ISOLATION_CHK_0_8812F(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_0_8812F(x) | BIT_ISOLATION_CHK_0_8812F(v)) -+ -+#define BIT_ISOLATION_EN_8812F BIT(0) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_1_8812F */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_1_8812F 0 -+#define BIT_MASK_ISOLATION_CHK_1_8812F 0xffffffffL -+#define BIT_ISOLATION_CHK_1_8812F(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_1_8812F) \ -+ << BIT_SHIFT_ISOLATION_CHK_1_8812F) -+#define BITS_ISOLATION_CHK_1_8812F \ -+ (BIT_MASK_ISOLATION_CHK_1_8812F << BIT_SHIFT_ISOLATION_CHK_1_8812F) -+#define BIT_CLEAR_ISOLATION_CHK_1_8812F(x) ((x) & (~BITS_ISOLATION_CHK_1_8812F)) -+#define BIT_GET_ISOLATION_CHK_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_1_8812F) & \ -+ BIT_MASK_ISOLATION_CHK_1_8812F) -+#define BIT_SET_ISOLATION_CHK_1_8812F(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_1_8812F(x) | BIT_ISOLATION_CHK_1_8812F(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_2_8812F */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_2_8812F 0 -+#define BIT_MASK_ISOLATION_CHK_2_8812F 0xffffff -+#define BIT_ISOLATION_CHK_2_8812F(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_2_8812F) \ -+ << BIT_SHIFT_ISOLATION_CHK_2_8812F) -+#define BITS_ISOLATION_CHK_2_8812F \ -+ (BIT_MASK_ISOLATION_CHK_2_8812F << BIT_SHIFT_ISOLATION_CHK_2_8812F) -+#define BIT_CLEAR_ISOLATION_CHK_2_8812F(x) ((x) & (~BITS_ISOLATION_CHK_2_8812F)) -+#define BIT_GET_ISOLATION_CHK_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_2_8812F) & \ -+ BIT_MASK_ISOLATION_CHK_2_8812F) -+#define BIT_SET_ISOLATION_CHK_2_8812F(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_2_8812F(x) | BIT_ISOLATION_CHK_2_8812F(v)) -+ -+/* 2 REG_BT_INTERRUPT_STATUS_REGISTER_8812F */ -+#define BIT_BT_HID_ISR_8812F BIT(7) -+#define BIT_BT_QUERY_ISR_8812F BIT(6) -+#define BIT_MAC_NULL_PKT_NOTIFY_ISR_8812F BIT(5) -+#define BIT_WLAN_RPT_ISR_8812F BIT(4) -+#define BIT_BT_POWER_ISR_8812F BIT(3) -+#define BIT_BT_CHANNEL_ISR_8812F BIT(2) -+#define BIT_BT_SLOT_CHANGE_ISR_8812F BIT(1) -+#define BIT_BT_PROFILE_ISR_8812F BIT(0) -+ -+/* 2 REG_BT_TDMA_TIME_REGISTER_8812F */ -+ -+#define BIT_SHIFT_BT_TIME_8812F 6 -+#define BIT_MASK_BT_TIME_8812F 0x3ffffff -+#define BIT_BT_TIME_8812F(x) \ -+ (((x) & BIT_MASK_BT_TIME_8812F) << BIT_SHIFT_BT_TIME_8812F) -+#define BITS_BT_TIME_8812F (BIT_MASK_BT_TIME_8812F << BIT_SHIFT_BT_TIME_8812F) -+#define BIT_CLEAR_BT_TIME_8812F(x) ((x) & (~BITS_BT_TIME_8812F)) -+#define BIT_GET_BT_TIME_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_TIME_8812F) & BIT_MASK_BT_TIME_8812F) -+#define BIT_SET_BT_TIME_8812F(x, v) \ -+ (BIT_CLEAR_BT_TIME_8812F(x) | BIT_BT_TIME_8812F(v)) -+ -+#define BIT_SHIFT_BT_RPT_SAMPLE_RATE_8812F 0 -+#define BIT_MASK_BT_RPT_SAMPLE_RATE_8812F 0x3f -+#define BIT_BT_RPT_SAMPLE_RATE_8812F(x) \ -+ (((x) & BIT_MASK_BT_RPT_SAMPLE_RATE_8812F) \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8812F) -+#define BITS_BT_RPT_SAMPLE_RATE_8812F \ -+ (BIT_MASK_BT_RPT_SAMPLE_RATE_8812F \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8812F) -+#define BIT_CLEAR_BT_RPT_SAMPLE_RATE_8812F(x) \ -+ ((x) & (~BITS_BT_RPT_SAMPLE_RATE_8812F)) -+#define BIT_GET_BT_RPT_SAMPLE_RATE_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_RPT_SAMPLE_RATE_8812F) & \ -+ BIT_MASK_BT_RPT_SAMPLE_RATE_8812F) -+#define BIT_SET_BT_RPT_SAMPLE_RATE_8812F(x, v) \ -+ (BIT_CLEAR_BT_RPT_SAMPLE_RATE_8812F(x) | \ -+ BIT_BT_RPT_SAMPLE_RATE_8812F(v)) -+ -+/* 2 REG_BT_ACT_REGISTER_8812F */ -+ -+#define BIT_SHIFT_BT_EISR_EN_8812F 16 -+#define BIT_MASK_BT_EISR_EN_8812F 0xff -+#define BIT_BT_EISR_EN_8812F(x) \ -+ (((x) & BIT_MASK_BT_EISR_EN_8812F) << BIT_SHIFT_BT_EISR_EN_8812F) -+#define BITS_BT_EISR_EN_8812F \ -+ (BIT_MASK_BT_EISR_EN_8812F << BIT_SHIFT_BT_EISR_EN_8812F) -+#define BIT_CLEAR_BT_EISR_EN_8812F(x) ((x) & (~BITS_BT_EISR_EN_8812F)) -+#define BIT_GET_BT_EISR_EN_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_EISR_EN_8812F) & BIT_MASK_BT_EISR_EN_8812F) -+#define BIT_SET_BT_EISR_EN_8812F(x, v) \ -+ (BIT_CLEAR_BT_EISR_EN_8812F(x) | BIT_BT_EISR_EN_8812F(v)) -+ -+#define BIT_BT_ACT_FALLING_ISR_8812F BIT(10) -+#define BIT_BT_ACT_RISING_ISR_8812F BIT(9) -+#define BIT_TDMA_TO_ISR_8812F BIT(8) -+ -+#define BIT_SHIFT_BT_CH_V1_8812F 0 -+#define BIT_MASK_BT_CH_V1_8812F 0x7f -+#define BIT_BT_CH_V1_8812F(x) \ -+ (((x) & BIT_MASK_BT_CH_V1_8812F) << BIT_SHIFT_BT_CH_V1_8812F) -+#define BITS_BT_CH_V1_8812F \ -+ (BIT_MASK_BT_CH_V1_8812F << BIT_SHIFT_BT_CH_V1_8812F) -+#define BIT_CLEAR_BT_CH_V1_8812F(x) ((x) & (~BITS_BT_CH_V1_8812F)) -+#define BIT_GET_BT_CH_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_CH_V1_8812F) & BIT_MASK_BT_CH_V1_8812F) -+#define BIT_SET_BT_CH_V1_8812F(x, v) \ -+ (BIT_CLEAR_BT_CH_V1_8812F(x) | BIT_BT_CH_V1_8812F(v)) -+ -+/* 2 REG_OBFF_CTRL_BASIC_8812F */ -+#define BIT_OBFF_EN_V1_8812F BIT(31) -+ -+#define BIT_SHIFT_OBFF_STATE_V1_8812F 28 -+#define BIT_MASK_OBFF_STATE_V1_8812F 0x3 -+#define BIT_OBFF_STATE_V1_8812F(x) \ -+ (((x) & BIT_MASK_OBFF_STATE_V1_8812F) << BIT_SHIFT_OBFF_STATE_V1_8812F) -+#define BITS_OBFF_STATE_V1_8812F \ -+ (BIT_MASK_OBFF_STATE_V1_8812F << BIT_SHIFT_OBFF_STATE_V1_8812F) -+#define BIT_CLEAR_OBFF_STATE_V1_8812F(x) ((x) & (~BITS_OBFF_STATE_V1_8812F)) -+#define BIT_GET_OBFF_STATE_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_OBFF_STATE_V1_8812F) & BIT_MASK_OBFF_STATE_V1_8812F) -+#define BIT_SET_OBFF_STATE_V1_8812F(x, v) \ -+ (BIT_CLEAR_OBFF_STATE_V1_8812F(x) | BIT_OBFF_STATE_V1_8812F(v)) -+ -+#define BIT_OBFF_ACT_RXDMA_EN_8812F BIT(27) -+#define BIT_OBFF_BLOCK_INT_EN_8812F BIT(26) -+#define BIT_OBFF_AUTOACT_EN_8812F BIT(25) -+#define BIT_OBFF_AUTOIDLE_EN_8812F BIT(24) -+ -+#define BIT_SHIFT_WAKE_MAX_PLS_8812F 20 -+#define BIT_MASK_WAKE_MAX_PLS_8812F 0x7 -+#define BIT_WAKE_MAX_PLS_8812F(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_PLS_8812F) << BIT_SHIFT_WAKE_MAX_PLS_8812F) -+#define BITS_WAKE_MAX_PLS_8812F \ -+ (BIT_MASK_WAKE_MAX_PLS_8812F << BIT_SHIFT_WAKE_MAX_PLS_8812F) -+#define BIT_CLEAR_WAKE_MAX_PLS_8812F(x) ((x) & (~BITS_WAKE_MAX_PLS_8812F)) -+#define BIT_GET_WAKE_MAX_PLS_8812F(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_PLS_8812F) & BIT_MASK_WAKE_MAX_PLS_8812F) -+#define BIT_SET_WAKE_MAX_PLS_8812F(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_PLS_8812F(x) | BIT_WAKE_MAX_PLS_8812F(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_PLS_8812F 16 -+#define BIT_MASK_WAKE_MIN_PLS_8812F 0x7 -+#define BIT_WAKE_MIN_PLS_8812F(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_PLS_8812F) << BIT_SHIFT_WAKE_MIN_PLS_8812F) -+#define BITS_WAKE_MIN_PLS_8812F \ -+ (BIT_MASK_WAKE_MIN_PLS_8812F << BIT_SHIFT_WAKE_MIN_PLS_8812F) -+#define BIT_CLEAR_WAKE_MIN_PLS_8812F(x) ((x) & (~BITS_WAKE_MIN_PLS_8812F)) -+#define BIT_GET_WAKE_MIN_PLS_8812F(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_PLS_8812F) & BIT_MASK_WAKE_MIN_PLS_8812F) -+#define BIT_SET_WAKE_MIN_PLS_8812F(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_PLS_8812F(x) | BIT_WAKE_MIN_PLS_8812F(v)) -+ -+#define BIT_SHIFT_WAKE_MAX_F2F_8812F 12 -+#define BIT_MASK_WAKE_MAX_F2F_8812F 0x7 -+#define BIT_WAKE_MAX_F2F_8812F(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_F2F_8812F) << BIT_SHIFT_WAKE_MAX_F2F_8812F) -+#define BITS_WAKE_MAX_F2F_8812F \ -+ (BIT_MASK_WAKE_MAX_F2F_8812F << BIT_SHIFT_WAKE_MAX_F2F_8812F) -+#define BIT_CLEAR_WAKE_MAX_F2F_8812F(x) ((x) & (~BITS_WAKE_MAX_F2F_8812F)) -+#define BIT_GET_WAKE_MAX_F2F_8812F(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_F2F_8812F) & BIT_MASK_WAKE_MAX_F2F_8812F) -+#define BIT_SET_WAKE_MAX_F2F_8812F(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_F2F_8812F(x) | BIT_WAKE_MAX_F2F_8812F(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_F2F_8812F 8 -+#define BIT_MASK_WAKE_MIN_F2F_8812F 0x7 -+#define BIT_WAKE_MIN_F2F_8812F(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_F2F_8812F) << BIT_SHIFT_WAKE_MIN_F2F_8812F) -+#define BITS_WAKE_MIN_F2F_8812F \ -+ (BIT_MASK_WAKE_MIN_F2F_8812F << BIT_SHIFT_WAKE_MIN_F2F_8812F) -+#define BIT_CLEAR_WAKE_MIN_F2F_8812F(x) ((x) & (~BITS_WAKE_MIN_F2F_8812F)) -+#define BIT_GET_WAKE_MIN_F2F_8812F(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_F2F_8812F) & BIT_MASK_WAKE_MIN_F2F_8812F) -+#define BIT_SET_WAKE_MIN_F2F_8812F(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_F2F_8812F(x) | BIT_WAKE_MIN_F2F_8812F(v)) -+ -+#define BIT_APP_CPU_ACT_V1_8812F BIT(3) -+#define BIT_APP_OBFF_V1_8812F BIT(2) -+#define BIT_APP_IDLE_V1_8812F BIT(1) -+#define BIT_APP_INIT_V1_8812F BIT(0) -+ -+/* 2 REG_OBFF_CTRL2_TIMER_8812F */ -+ -+#define BIT_SHIFT_RX_HIGH_TIMER_IDX_8812F 24 -+#define BIT_MASK_RX_HIGH_TIMER_IDX_8812F 0x7 -+#define BIT_RX_HIGH_TIMER_IDX_8812F(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TIMER_IDX_8812F) \ -+ << BIT_SHIFT_RX_HIGH_TIMER_IDX_8812F) -+#define BITS_RX_HIGH_TIMER_IDX_8812F \ -+ (BIT_MASK_RX_HIGH_TIMER_IDX_8812F << BIT_SHIFT_RX_HIGH_TIMER_IDX_8812F) -+#define BIT_CLEAR_RX_HIGH_TIMER_IDX_8812F(x) \ -+ ((x) & (~BITS_RX_HIGH_TIMER_IDX_8812F)) -+#define BIT_GET_RX_HIGH_TIMER_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TIMER_IDX_8812F) & \ -+ BIT_MASK_RX_HIGH_TIMER_IDX_8812F) -+#define BIT_SET_RX_HIGH_TIMER_IDX_8812F(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TIMER_IDX_8812F(x) | BIT_RX_HIGH_TIMER_IDX_8812F(v)) -+ -+#define BIT_SHIFT_RX_MED_TIMER_IDX_8812F 16 -+#define BIT_MASK_RX_MED_TIMER_IDX_8812F 0x7 -+#define BIT_RX_MED_TIMER_IDX_8812F(x) \ -+ (((x) & BIT_MASK_RX_MED_TIMER_IDX_8812F) \ -+ << BIT_SHIFT_RX_MED_TIMER_IDX_8812F) -+#define BITS_RX_MED_TIMER_IDX_8812F \ -+ (BIT_MASK_RX_MED_TIMER_IDX_8812F << BIT_SHIFT_RX_MED_TIMER_IDX_8812F) -+#define BIT_CLEAR_RX_MED_TIMER_IDX_8812F(x) \ -+ ((x) & (~BITS_RX_MED_TIMER_IDX_8812F)) -+#define BIT_GET_RX_MED_TIMER_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TIMER_IDX_8812F) & \ -+ BIT_MASK_RX_MED_TIMER_IDX_8812F) -+#define BIT_SET_RX_MED_TIMER_IDX_8812F(x, v) \ -+ (BIT_CLEAR_RX_MED_TIMER_IDX_8812F(x) | BIT_RX_MED_TIMER_IDX_8812F(v)) -+ -+#define BIT_SHIFT_RX_LOW_TIMER_IDX_8812F 8 -+#define BIT_MASK_RX_LOW_TIMER_IDX_8812F 0x7 -+#define BIT_RX_LOW_TIMER_IDX_8812F(x) \ -+ (((x) & BIT_MASK_RX_LOW_TIMER_IDX_8812F) \ -+ << BIT_SHIFT_RX_LOW_TIMER_IDX_8812F) -+#define BITS_RX_LOW_TIMER_IDX_8812F \ -+ (BIT_MASK_RX_LOW_TIMER_IDX_8812F << BIT_SHIFT_RX_LOW_TIMER_IDX_8812F) -+#define BIT_CLEAR_RX_LOW_TIMER_IDX_8812F(x) \ -+ ((x) & (~BITS_RX_LOW_TIMER_IDX_8812F)) -+#define BIT_GET_RX_LOW_TIMER_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TIMER_IDX_8812F) & \ -+ BIT_MASK_RX_LOW_TIMER_IDX_8812F) -+#define BIT_SET_RX_LOW_TIMER_IDX_8812F(x, v) \ -+ (BIT_CLEAR_RX_LOW_TIMER_IDX_8812F(x) | BIT_RX_LOW_TIMER_IDX_8812F(v)) -+ -+#define BIT_SHIFT_OBFF_INT_TIMER_IDX_8812F 0 -+#define BIT_MASK_OBFF_INT_TIMER_IDX_8812F 0x7 -+#define BIT_OBFF_INT_TIMER_IDX_8812F(x) \ -+ (((x) & BIT_MASK_OBFF_INT_TIMER_IDX_8812F) \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8812F) -+#define BITS_OBFF_INT_TIMER_IDX_8812F \ -+ (BIT_MASK_OBFF_INT_TIMER_IDX_8812F \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8812F) -+#define BIT_CLEAR_OBFF_INT_TIMER_IDX_8812F(x) \ -+ ((x) & (~BITS_OBFF_INT_TIMER_IDX_8812F)) -+#define BIT_GET_OBFF_INT_TIMER_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_OBFF_INT_TIMER_IDX_8812F) & \ -+ BIT_MASK_OBFF_INT_TIMER_IDX_8812F) -+#define BIT_SET_OBFF_INT_TIMER_IDX_8812F(x, v) \ -+ (BIT_CLEAR_OBFF_INT_TIMER_IDX_8812F(x) | \ -+ BIT_OBFF_INT_TIMER_IDX_8812F(v)) -+ -+/* 2 REG_LTR_CTRL_BASIC_8812F */ -+#define BIT_LTR_EN_V1_8812F BIT(31) -+#define BIT_LTR_HW_EN_V1_8812F BIT(30) -+#define BIT_LRT_ACT_CTS_EN_8812F BIT(29) -+#define BIT_LTR_ACT_RXPKT_EN_8812F BIT(28) -+#define BIT_LTR_ACT_RXDMA_EN_8812F BIT(27) -+#define BIT_LTR_IDLE_NO_SNOOP_8812F BIT(26) -+#define BIT_SPDUP_MGTPKT_8812F BIT(25) -+#define BIT_RX_AGG_EN_8812F BIT(24) -+#define BIT_APP_LTR_ACT_8812F BIT(23) -+#define BIT_APP_LTR_IDLE_8812F BIT(22) -+ -+#define BIT_SHIFT_HIGH_RATE_TRIG_SEL_8812F 20 -+#define BIT_MASK_HIGH_RATE_TRIG_SEL_8812F 0x3 -+#define BIT_HIGH_RATE_TRIG_SEL_8812F(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_TRIG_SEL_8812F) \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8812F) -+#define BITS_HIGH_RATE_TRIG_SEL_8812F \ -+ (BIT_MASK_HIGH_RATE_TRIG_SEL_8812F \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8812F) -+#define BIT_CLEAR_HIGH_RATE_TRIG_SEL_8812F(x) \ -+ ((x) & (~BITS_HIGH_RATE_TRIG_SEL_8812F)) -+#define BIT_GET_HIGH_RATE_TRIG_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_TRIG_SEL_8812F) & \ -+ BIT_MASK_HIGH_RATE_TRIG_SEL_8812F) -+#define BIT_SET_HIGH_RATE_TRIG_SEL_8812F(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_TRIG_SEL_8812F(x) | \ -+ BIT_HIGH_RATE_TRIG_SEL_8812F(v)) -+ -+#define BIT_SHIFT_MED_RATE_TRIG_SEL_8812F 18 -+#define BIT_MASK_MED_RATE_TRIG_SEL_8812F 0x3 -+#define BIT_MED_RATE_TRIG_SEL_8812F(x) \ -+ (((x) & BIT_MASK_MED_RATE_TRIG_SEL_8812F) \ -+ << BIT_SHIFT_MED_RATE_TRIG_SEL_8812F) -+#define BITS_MED_RATE_TRIG_SEL_8812F \ -+ (BIT_MASK_MED_RATE_TRIG_SEL_8812F << BIT_SHIFT_MED_RATE_TRIG_SEL_8812F) -+#define BIT_CLEAR_MED_RATE_TRIG_SEL_8812F(x) \ -+ ((x) & (~BITS_MED_RATE_TRIG_SEL_8812F)) -+#define BIT_GET_MED_RATE_TRIG_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_MED_RATE_TRIG_SEL_8812F) & \ -+ BIT_MASK_MED_RATE_TRIG_SEL_8812F) -+#define BIT_SET_MED_RATE_TRIG_SEL_8812F(x, v) \ -+ (BIT_CLEAR_MED_RATE_TRIG_SEL_8812F(x) | BIT_MED_RATE_TRIG_SEL_8812F(v)) -+ -+#define BIT_SHIFT_LOW_RATE_TRIG_SEL_8812F 16 -+#define BIT_MASK_LOW_RATE_TRIG_SEL_8812F 0x3 -+#define BIT_LOW_RATE_TRIG_SEL_8812F(x) \ -+ (((x) & BIT_MASK_LOW_RATE_TRIG_SEL_8812F) \ -+ << BIT_SHIFT_LOW_RATE_TRIG_SEL_8812F) -+#define BITS_LOW_RATE_TRIG_SEL_8812F \ -+ (BIT_MASK_LOW_RATE_TRIG_SEL_8812F << BIT_SHIFT_LOW_RATE_TRIG_SEL_8812F) -+#define BIT_CLEAR_LOW_RATE_TRIG_SEL_8812F(x) \ -+ ((x) & (~BITS_LOW_RATE_TRIG_SEL_8812F)) -+#define BIT_GET_LOW_RATE_TRIG_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_TRIG_SEL_8812F) & \ -+ BIT_MASK_LOW_RATE_TRIG_SEL_8812F) -+#define BIT_SET_LOW_RATE_TRIG_SEL_8812F(x, v) \ -+ (BIT_CLEAR_LOW_RATE_TRIG_SEL_8812F(x) | BIT_LOW_RATE_TRIG_SEL_8812F(v)) -+ -+#define BIT_SHIFT_HIGH_RATE_BD_IDX_8812F 8 -+#define BIT_MASK_HIGH_RATE_BD_IDX_8812F 0x7f -+#define BIT_HIGH_RATE_BD_IDX_8812F(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_BD_IDX_8812F) \ -+ << BIT_SHIFT_HIGH_RATE_BD_IDX_8812F) -+#define BITS_HIGH_RATE_BD_IDX_8812F \ -+ (BIT_MASK_HIGH_RATE_BD_IDX_8812F << BIT_SHIFT_HIGH_RATE_BD_IDX_8812F) -+#define BIT_CLEAR_HIGH_RATE_BD_IDX_8812F(x) \ -+ ((x) & (~BITS_HIGH_RATE_BD_IDX_8812F)) -+#define BIT_GET_HIGH_RATE_BD_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_BD_IDX_8812F) & \ -+ BIT_MASK_HIGH_RATE_BD_IDX_8812F) -+#define BIT_SET_HIGH_RATE_BD_IDX_8812F(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_BD_IDX_8812F(x) | BIT_HIGH_RATE_BD_IDX_8812F(v)) -+ -+#define BIT_SHIFT_LOW_RATE_BD_IDX_8812F 0 -+#define BIT_MASK_LOW_RATE_BD_IDX_8812F 0x7f -+#define BIT_LOW_RATE_BD_IDX_8812F(x) \ -+ (((x) & BIT_MASK_LOW_RATE_BD_IDX_8812F) \ -+ << BIT_SHIFT_LOW_RATE_BD_IDX_8812F) -+#define BITS_LOW_RATE_BD_IDX_8812F \ -+ (BIT_MASK_LOW_RATE_BD_IDX_8812F << BIT_SHIFT_LOW_RATE_BD_IDX_8812F) -+#define BIT_CLEAR_LOW_RATE_BD_IDX_8812F(x) ((x) & (~BITS_LOW_RATE_BD_IDX_8812F)) -+#define BIT_GET_LOW_RATE_BD_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_BD_IDX_8812F) & \ -+ BIT_MASK_LOW_RATE_BD_IDX_8812F) -+#define BIT_SET_LOW_RATE_BD_IDX_8812F(x, v) \ -+ (BIT_CLEAR_LOW_RATE_BD_IDX_8812F(x) | BIT_LOW_RATE_BD_IDX_8812F(v)) -+ -+/* 2 REG_LTR_CTRL2_TIMER_THRESHOLD_8812F */ -+ -+#define BIT_SHIFT_RX_EMPTY_TIMER_IDX_8812F 24 -+#define BIT_MASK_RX_EMPTY_TIMER_IDX_8812F 0x7 -+#define BIT_RX_EMPTY_TIMER_IDX_8812F(x) \ -+ (((x) & BIT_MASK_RX_EMPTY_TIMER_IDX_8812F) \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8812F) -+#define BITS_RX_EMPTY_TIMER_IDX_8812F \ -+ (BIT_MASK_RX_EMPTY_TIMER_IDX_8812F \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8812F) -+#define BIT_CLEAR_RX_EMPTY_TIMER_IDX_8812F(x) \ -+ ((x) & (~BITS_RX_EMPTY_TIMER_IDX_8812F)) -+#define BIT_GET_RX_EMPTY_TIMER_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_EMPTY_TIMER_IDX_8812F) & \ -+ BIT_MASK_RX_EMPTY_TIMER_IDX_8812F) -+#define BIT_SET_RX_EMPTY_TIMER_IDX_8812F(x, v) \ -+ (BIT_CLEAR_RX_EMPTY_TIMER_IDX_8812F(x) | \ -+ BIT_RX_EMPTY_TIMER_IDX_8812F(v)) -+ -+#define BIT_SHIFT_RX_AFULL_TH_IDX_8812F 20 -+#define BIT_MASK_RX_AFULL_TH_IDX_8812F 0x7 -+#define BIT_RX_AFULL_TH_IDX_8812F(x) \ -+ (((x) & BIT_MASK_RX_AFULL_TH_IDX_8812F) \ -+ << BIT_SHIFT_RX_AFULL_TH_IDX_8812F) -+#define BITS_RX_AFULL_TH_IDX_8812F \ -+ (BIT_MASK_RX_AFULL_TH_IDX_8812F << BIT_SHIFT_RX_AFULL_TH_IDX_8812F) -+#define BIT_CLEAR_RX_AFULL_TH_IDX_8812F(x) ((x) & (~BITS_RX_AFULL_TH_IDX_8812F)) -+#define BIT_GET_RX_AFULL_TH_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_AFULL_TH_IDX_8812F) & \ -+ BIT_MASK_RX_AFULL_TH_IDX_8812F) -+#define BIT_SET_RX_AFULL_TH_IDX_8812F(x, v) \ -+ (BIT_CLEAR_RX_AFULL_TH_IDX_8812F(x) | BIT_RX_AFULL_TH_IDX_8812F(v)) -+ -+#define BIT_SHIFT_RX_HIGH_TH_IDX_8812F 16 -+#define BIT_MASK_RX_HIGH_TH_IDX_8812F 0x7 -+#define BIT_RX_HIGH_TH_IDX_8812F(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TH_IDX_8812F) \ -+ << BIT_SHIFT_RX_HIGH_TH_IDX_8812F) -+#define BITS_RX_HIGH_TH_IDX_8812F \ -+ (BIT_MASK_RX_HIGH_TH_IDX_8812F << BIT_SHIFT_RX_HIGH_TH_IDX_8812F) -+#define BIT_CLEAR_RX_HIGH_TH_IDX_8812F(x) ((x) & (~BITS_RX_HIGH_TH_IDX_8812F)) -+#define BIT_GET_RX_HIGH_TH_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TH_IDX_8812F) & \ -+ BIT_MASK_RX_HIGH_TH_IDX_8812F) -+#define BIT_SET_RX_HIGH_TH_IDX_8812F(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TH_IDX_8812F(x) | BIT_RX_HIGH_TH_IDX_8812F(v)) -+ -+#define BIT_SHIFT_RX_MED_TH_IDX_8812F 12 -+#define BIT_MASK_RX_MED_TH_IDX_8812F 0x7 -+#define BIT_RX_MED_TH_IDX_8812F(x) \ -+ (((x) & BIT_MASK_RX_MED_TH_IDX_8812F) << BIT_SHIFT_RX_MED_TH_IDX_8812F) -+#define BITS_RX_MED_TH_IDX_8812F \ -+ (BIT_MASK_RX_MED_TH_IDX_8812F << BIT_SHIFT_RX_MED_TH_IDX_8812F) -+#define BIT_CLEAR_RX_MED_TH_IDX_8812F(x) ((x) & (~BITS_RX_MED_TH_IDX_8812F)) -+#define BIT_GET_RX_MED_TH_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TH_IDX_8812F) & BIT_MASK_RX_MED_TH_IDX_8812F) -+#define BIT_SET_RX_MED_TH_IDX_8812F(x, v) \ -+ (BIT_CLEAR_RX_MED_TH_IDX_8812F(x) | BIT_RX_MED_TH_IDX_8812F(v)) -+ -+#define BIT_SHIFT_RX_LOW_TH_IDX_8812F 8 -+#define BIT_MASK_RX_LOW_TH_IDX_8812F 0x7 -+#define BIT_RX_LOW_TH_IDX_8812F(x) \ -+ (((x) & BIT_MASK_RX_LOW_TH_IDX_8812F) << BIT_SHIFT_RX_LOW_TH_IDX_8812F) -+#define BITS_RX_LOW_TH_IDX_8812F \ -+ (BIT_MASK_RX_LOW_TH_IDX_8812F << BIT_SHIFT_RX_LOW_TH_IDX_8812F) -+#define BIT_CLEAR_RX_LOW_TH_IDX_8812F(x) ((x) & (~BITS_RX_LOW_TH_IDX_8812F)) -+#define BIT_GET_RX_LOW_TH_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TH_IDX_8812F) & BIT_MASK_RX_LOW_TH_IDX_8812F) -+#define BIT_SET_RX_LOW_TH_IDX_8812F(x, v) \ -+ (BIT_CLEAR_RX_LOW_TH_IDX_8812F(x) | BIT_RX_LOW_TH_IDX_8812F(v)) -+ -+#define BIT_SHIFT_LTR_SPACE_IDX_8812F 4 -+#define BIT_MASK_LTR_SPACE_IDX_8812F 0x3 -+#define BIT_LTR_SPACE_IDX_8812F(x) \ -+ (((x) & BIT_MASK_LTR_SPACE_IDX_8812F) << BIT_SHIFT_LTR_SPACE_IDX_8812F) -+#define BITS_LTR_SPACE_IDX_8812F \ -+ (BIT_MASK_LTR_SPACE_IDX_8812F << BIT_SHIFT_LTR_SPACE_IDX_8812F) -+#define BIT_CLEAR_LTR_SPACE_IDX_8812F(x) ((x) & (~BITS_LTR_SPACE_IDX_8812F)) -+#define BIT_GET_LTR_SPACE_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_LTR_SPACE_IDX_8812F) & BIT_MASK_LTR_SPACE_IDX_8812F) -+#define BIT_SET_LTR_SPACE_IDX_8812F(x, v) \ -+ (BIT_CLEAR_LTR_SPACE_IDX_8812F(x) | BIT_LTR_SPACE_IDX_8812F(v)) -+ -+#define BIT_SHIFT_LTR_IDLE_TIMER_IDX_8812F 0 -+#define BIT_MASK_LTR_IDLE_TIMER_IDX_8812F 0x7 -+#define BIT_LTR_IDLE_TIMER_IDX_8812F(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_TIMER_IDX_8812F) \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8812F) -+#define BITS_LTR_IDLE_TIMER_IDX_8812F \ -+ (BIT_MASK_LTR_IDLE_TIMER_IDX_8812F \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8812F) -+#define BIT_CLEAR_LTR_IDLE_TIMER_IDX_8812F(x) \ -+ ((x) & (~BITS_LTR_IDLE_TIMER_IDX_8812F)) -+#define BIT_GET_LTR_IDLE_TIMER_IDX_8812F(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_TIMER_IDX_8812F) & \ -+ BIT_MASK_LTR_IDLE_TIMER_IDX_8812F) -+#define BIT_SET_LTR_IDLE_TIMER_IDX_8812F(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_TIMER_IDX_8812F(x) | \ -+ BIT_LTR_IDLE_TIMER_IDX_8812F(v)) -+ -+/* 2 REG_LTR_IDLE_LATENCY_V1_8812F */ -+ -+#define BIT_SHIFT_LTR_IDLE_L_8812F 0 -+#define BIT_MASK_LTR_IDLE_L_8812F 0xffffffffL -+#define BIT_LTR_IDLE_L_8812F(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_L_8812F) << BIT_SHIFT_LTR_IDLE_L_8812F) -+#define BITS_LTR_IDLE_L_8812F \ -+ (BIT_MASK_LTR_IDLE_L_8812F << BIT_SHIFT_LTR_IDLE_L_8812F) -+#define BIT_CLEAR_LTR_IDLE_L_8812F(x) ((x) & (~BITS_LTR_IDLE_L_8812F)) -+#define BIT_GET_LTR_IDLE_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_L_8812F) & BIT_MASK_LTR_IDLE_L_8812F) -+#define BIT_SET_LTR_IDLE_L_8812F(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_L_8812F(x) | BIT_LTR_IDLE_L_8812F(v)) -+ -+/* 2 REG_LTR_ACTIVE_LATENCY_V1_8812F */ -+ -+#define BIT_SHIFT_LTR_ACT_L_8812F 0 -+#define BIT_MASK_LTR_ACT_L_8812F 0xffffffffL -+#define BIT_LTR_ACT_L_8812F(x) \ -+ (((x) & BIT_MASK_LTR_ACT_L_8812F) << BIT_SHIFT_LTR_ACT_L_8812F) -+#define BITS_LTR_ACT_L_8812F \ -+ (BIT_MASK_LTR_ACT_L_8812F << BIT_SHIFT_LTR_ACT_L_8812F) -+#define BIT_CLEAR_LTR_ACT_L_8812F(x) ((x) & (~BITS_LTR_ACT_L_8812F)) -+#define BIT_GET_LTR_ACT_L_8812F(x) \ -+ (((x) >> BIT_SHIFT_LTR_ACT_L_8812F) & BIT_MASK_LTR_ACT_L_8812F) -+#define BIT_SET_LTR_ACT_L_8812F(x, v) \ -+ (BIT_CLEAR_LTR_ACT_L_8812F(x) | BIT_LTR_ACT_L_8812F(v)) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER_8812F */ -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR_0_8812F 0 -+#define BIT_MASK_TRAIN_STA_ADDR_0_8812F 0xffffffffL -+#define BIT_TRAIN_STA_ADDR_0_8812F(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR_0_8812F) \ -+ << BIT_SHIFT_TRAIN_STA_ADDR_0_8812F) -+#define BITS_TRAIN_STA_ADDR_0_8812F \ -+ (BIT_MASK_TRAIN_STA_ADDR_0_8812F << BIT_SHIFT_TRAIN_STA_ADDR_0_8812F) -+#define BIT_CLEAR_TRAIN_STA_ADDR_0_8812F(x) \ -+ ((x) & (~BITS_TRAIN_STA_ADDR_0_8812F)) -+#define BIT_GET_TRAIN_STA_ADDR_0_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR_0_8812F) & \ -+ BIT_MASK_TRAIN_STA_ADDR_0_8812F) -+#define BIT_SET_TRAIN_STA_ADDR_0_8812F(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR_0_8812F(x) | BIT_TRAIN_STA_ADDR_0_8812F(v)) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER_1_8812F */ -+#define BIT_ANTTRN_SWITCH_8812F BIT(19) -+#define BIT_APPEND_MACID_IN_RESP_EN_1_8812F BIT(18) -+#define BIT_ADDR2_MATCH_EN_1_8812F BIT(17) -+#define BIT_ANTTRN_EN_1_8812F BIT(16) -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR_1_8812F 0 -+#define BIT_MASK_TRAIN_STA_ADDR_1_8812F 0xffff -+#define BIT_TRAIN_STA_ADDR_1_8812F(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR_1_8812F) \ -+ << BIT_SHIFT_TRAIN_STA_ADDR_1_8812F) -+#define BITS_TRAIN_STA_ADDR_1_8812F \ -+ (BIT_MASK_TRAIN_STA_ADDR_1_8812F << BIT_SHIFT_TRAIN_STA_ADDR_1_8812F) -+#define BIT_CLEAR_TRAIN_STA_ADDR_1_8812F(x) \ -+ ((x) & (~BITS_TRAIN_STA_ADDR_1_8812F)) -+#define BIT_GET_TRAIN_STA_ADDR_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR_1_8812F) & \ -+ BIT_MASK_TRAIN_STA_ADDR_1_8812F) -+#define BIT_SET_TRAIN_STA_ADDR_1_8812F(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR_1_8812F(x) | BIT_TRAIN_STA_ADDR_1_8812F(v)) -+ -+/* 2 REG_WMAC_PKTCNT_RWD_8812F */ -+ -+#define BIT_SHIFT_PKTCNT_BSSIDMAP_8812F 4 -+#define BIT_MASK_PKTCNT_BSSIDMAP_8812F 0xf -+#define BIT_PKTCNT_BSSIDMAP_8812F(x) \ -+ (((x) & BIT_MASK_PKTCNT_BSSIDMAP_8812F) \ -+ << BIT_SHIFT_PKTCNT_BSSIDMAP_8812F) -+#define BITS_PKTCNT_BSSIDMAP_8812F \ -+ (BIT_MASK_PKTCNT_BSSIDMAP_8812F << BIT_SHIFT_PKTCNT_BSSIDMAP_8812F) -+#define BIT_CLEAR_PKTCNT_BSSIDMAP_8812F(x) ((x) & (~BITS_PKTCNT_BSSIDMAP_8812F)) -+#define BIT_GET_PKTCNT_BSSIDMAP_8812F(x) \ -+ (((x) >> BIT_SHIFT_PKTCNT_BSSIDMAP_8812F) & \ -+ BIT_MASK_PKTCNT_BSSIDMAP_8812F) -+#define BIT_SET_PKTCNT_BSSIDMAP_8812F(x, v) \ -+ (BIT_CLEAR_PKTCNT_BSSIDMAP_8812F(x) | BIT_PKTCNT_BSSIDMAP_8812F(v)) -+ -+#define BIT_PKTCNT_CNTRST_8812F BIT(1) -+#define BIT_PKTCNT_CNTEN_8812F BIT(0) -+ -+/* 2 REG_WMAC_PKTCNT_CTRL_8812F */ -+#define BIT_WMAC_PKTCNT_TRST_8812F BIT(9) -+#define BIT_WMAC_PKTCNT_FEN_8812F BIT(8) -+ -+#define BIT_SHIFT_WMAC_PKTCNT_CFGAD_8812F 0 -+#define BIT_MASK_WMAC_PKTCNT_CFGAD_8812F 0xff -+#define BIT_WMAC_PKTCNT_CFGAD_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_PKTCNT_CFGAD_8812F) \ -+ << BIT_SHIFT_WMAC_PKTCNT_CFGAD_8812F) -+#define BITS_WMAC_PKTCNT_CFGAD_8812F \ -+ (BIT_MASK_WMAC_PKTCNT_CFGAD_8812F << BIT_SHIFT_WMAC_PKTCNT_CFGAD_8812F) -+#define BIT_CLEAR_WMAC_PKTCNT_CFGAD_8812F(x) \ -+ ((x) & (~BITS_WMAC_PKTCNT_CFGAD_8812F)) -+#define BIT_GET_WMAC_PKTCNT_CFGAD_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PKTCNT_CFGAD_8812F) & \ -+ BIT_MASK_WMAC_PKTCNT_CFGAD_8812F) -+#define BIT_SET_WMAC_PKTCNT_CFGAD_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_PKTCNT_CFGAD_8812F(x) | BIT_WMAC_PKTCNT_CFGAD_8812F(v)) -+ -+/* 2 REG_IQ_DUMP_8812F */ -+ -+#define BIT_SHIFT_DUMP_OK_ADDR_8812F 16 -+#define BIT_MASK_DUMP_OK_ADDR_8812F 0xffff -+#define BIT_DUMP_OK_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_DUMP_OK_ADDR_8812F) << BIT_SHIFT_DUMP_OK_ADDR_8812F) -+#define BITS_DUMP_OK_ADDR_8812F \ -+ (BIT_MASK_DUMP_OK_ADDR_8812F << BIT_SHIFT_DUMP_OK_ADDR_8812F) -+#define BIT_CLEAR_DUMP_OK_ADDR_8812F(x) ((x) & (~BITS_DUMP_OK_ADDR_8812F)) -+#define BIT_GET_DUMP_OK_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_DUMP_OK_ADDR_8812F) & BIT_MASK_DUMP_OK_ADDR_8812F) -+#define BIT_SET_DUMP_OK_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_DUMP_OK_ADDR_8812F(x) | BIT_DUMP_OK_ADDR_8812F(v)) -+ -+#define BIT_MACDBG_TRIG_IQDUMP_8812F BIT(15) -+ -+#define BIT_SHIFT_R_TRIG_TIME_SEL_8812F 8 -+#define BIT_MASK_R_TRIG_TIME_SEL_8812F 0x7f -+#define BIT_R_TRIG_TIME_SEL_8812F(x) \ -+ (((x) & BIT_MASK_R_TRIG_TIME_SEL_8812F) \ -+ << BIT_SHIFT_R_TRIG_TIME_SEL_8812F) -+#define BITS_R_TRIG_TIME_SEL_8812F \ -+ (BIT_MASK_R_TRIG_TIME_SEL_8812F << BIT_SHIFT_R_TRIG_TIME_SEL_8812F) -+#define BIT_CLEAR_R_TRIG_TIME_SEL_8812F(x) ((x) & (~BITS_R_TRIG_TIME_SEL_8812F)) -+#define BIT_GET_R_TRIG_TIME_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_TRIG_TIME_SEL_8812F) & \ -+ BIT_MASK_R_TRIG_TIME_SEL_8812F) -+#define BIT_SET_R_TRIG_TIME_SEL_8812F(x, v) \ -+ (BIT_CLEAR_R_TRIG_TIME_SEL_8812F(x) | BIT_R_TRIG_TIME_SEL_8812F(v)) -+ -+#define BIT_SHIFT_R_MAC_TRIG_SEL_8812F 6 -+#define BIT_MASK_R_MAC_TRIG_SEL_8812F 0x3 -+#define BIT_R_MAC_TRIG_SEL_8812F(x) \ -+ (((x) & BIT_MASK_R_MAC_TRIG_SEL_8812F) \ -+ << BIT_SHIFT_R_MAC_TRIG_SEL_8812F) -+#define BITS_R_MAC_TRIG_SEL_8812F \ -+ (BIT_MASK_R_MAC_TRIG_SEL_8812F << BIT_SHIFT_R_MAC_TRIG_SEL_8812F) -+#define BIT_CLEAR_R_MAC_TRIG_SEL_8812F(x) ((x) & (~BITS_R_MAC_TRIG_SEL_8812F)) -+#define BIT_GET_R_MAC_TRIG_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_TRIG_SEL_8812F) & \ -+ BIT_MASK_R_MAC_TRIG_SEL_8812F) -+#define BIT_SET_R_MAC_TRIG_SEL_8812F(x, v) \ -+ (BIT_CLEAR_R_MAC_TRIG_SEL_8812F(x) | BIT_R_MAC_TRIG_SEL_8812F(v)) -+ -+#define BIT_MAC_TRIG_REG_8812F BIT(5) -+ -+#define BIT_SHIFT_R_LEVEL_PULSE_SEL_8812F 3 -+#define BIT_MASK_R_LEVEL_PULSE_SEL_8812F 0x3 -+#define BIT_R_LEVEL_PULSE_SEL_8812F(x) \ -+ (((x) & BIT_MASK_R_LEVEL_PULSE_SEL_8812F) \ -+ << BIT_SHIFT_R_LEVEL_PULSE_SEL_8812F) -+#define BITS_R_LEVEL_PULSE_SEL_8812F \ -+ (BIT_MASK_R_LEVEL_PULSE_SEL_8812F << BIT_SHIFT_R_LEVEL_PULSE_SEL_8812F) -+#define BIT_CLEAR_R_LEVEL_PULSE_SEL_8812F(x) \ -+ ((x) & (~BITS_R_LEVEL_PULSE_SEL_8812F)) -+#define BIT_GET_R_LEVEL_PULSE_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_LEVEL_PULSE_SEL_8812F) & \ -+ BIT_MASK_R_LEVEL_PULSE_SEL_8812F) -+#define BIT_SET_R_LEVEL_PULSE_SEL_8812F(x, v) \ -+ (BIT_CLEAR_R_LEVEL_PULSE_SEL_8812F(x) | BIT_R_LEVEL_PULSE_SEL_8812F(v)) -+ -+#define BIT_EN_LA_MAC_8812F BIT(2) -+#define BIT_R_EN_IQDUMP_8812F BIT(1) -+#define BIT_R_IQDATA_DUMP_8812F BIT(0) -+ -+/* 2 REG_IQ_DUMP_1_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8812F 0 -+#define BIT_MASK_R_WMAC_MASK_LA_MAC_1_8812F 0xffffffffL -+#define BIT_R_WMAC_MASK_LA_MAC_1_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_MASK_LA_MAC_1_8812F) \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8812F) -+#define BITS_R_WMAC_MASK_LA_MAC_1_8812F \ -+ (BIT_MASK_R_WMAC_MASK_LA_MAC_1_8812F \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8812F) -+#define BIT_CLEAR_R_WMAC_MASK_LA_MAC_1_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_MASK_LA_MAC_1_8812F)) -+#define BIT_GET_R_WMAC_MASK_LA_MAC_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8812F) & \ -+ BIT_MASK_R_WMAC_MASK_LA_MAC_1_8812F) -+#define BIT_SET_R_WMAC_MASK_LA_MAC_1_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_MASK_LA_MAC_1_8812F(x) | \ -+ BIT_R_WMAC_MASK_LA_MAC_1_8812F(v)) -+ -+/* 2 REG_IQ_DUMP_2_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8812F 0 -+#define BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8812F 0xffffffffL -+#define BIT_R_WMAC_MATCH_REF_MAC_2_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8812F) \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8812F) -+#define BITS_R_WMAC_MATCH_REF_MAC_2_8812F \ -+ (BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8812F \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8812F) -+#define BIT_CLEAR_R_WMAC_MATCH_REF_MAC_2_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_MATCH_REF_MAC_2_8812F)) -+#define BIT_GET_R_WMAC_MATCH_REF_MAC_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8812F) & \ -+ BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8812F) -+#define BIT_SET_R_WMAC_MATCH_REF_MAC_2_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_MATCH_REF_MAC_2_8812F(x) | \ -+ BIT_R_WMAC_MATCH_REF_MAC_2_8812F(v)) -+ -+/* 2 REG_WMAC_FTM_CTL_8812F */ -+#define BIT_RXFTM_TXACK_SC_8812F BIT(6) -+#define BIT_RXFTM_TXACK_BW_8812F BIT(5) -+#define BIT_RXFTM_EN_8812F BIT(3) -+#define BIT_RXFTMREQ_BYDRV_8812F BIT(2) -+#define BIT_RXFTMREQ_EN_8812F BIT(1) -+#define BIT_FTM_EN_8812F BIT(0) -+ -+/* 2 REG_WMAC_IQ_MDPK_FUNC_8812F */ -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_8812F */ -+ -+#define BIT_SHIFT_R_OFDM_LEN_V1_8812F 16 -+#define BIT_MASK_R_OFDM_LEN_V1_8812F 0xffff -+#define BIT_R_OFDM_LEN_V1_8812F(x) \ -+ (((x) & BIT_MASK_R_OFDM_LEN_V1_8812F) << BIT_SHIFT_R_OFDM_LEN_V1_8812F) -+#define BITS_R_OFDM_LEN_V1_8812F \ -+ (BIT_MASK_R_OFDM_LEN_V1_8812F << BIT_SHIFT_R_OFDM_LEN_V1_8812F) -+#define BIT_CLEAR_R_OFDM_LEN_V1_8812F(x) ((x) & (~BITS_R_OFDM_LEN_V1_8812F)) -+#define BIT_GET_R_OFDM_LEN_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_OFDM_LEN_V1_8812F) & BIT_MASK_R_OFDM_LEN_V1_8812F) -+#define BIT_SET_R_OFDM_LEN_V1_8812F(x, v) \ -+ (BIT_CLEAR_R_OFDM_LEN_V1_8812F(x) | BIT_R_OFDM_LEN_V1_8812F(v)) -+ -+#define BIT_SHIFT_R_CCK_LEN_8812F 0 -+#define BIT_MASK_R_CCK_LEN_8812F 0xffff -+#define BIT_R_CCK_LEN_8812F(x) \ -+ (((x) & BIT_MASK_R_CCK_LEN_8812F) << BIT_SHIFT_R_CCK_LEN_8812F) -+#define BITS_R_CCK_LEN_8812F \ -+ (BIT_MASK_R_CCK_LEN_8812F << BIT_SHIFT_R_CCK_LEN_8812F) -+#define BIT_CLEAR_R_CCK_LEN_8812F(x) ((x) & (~BITS_R_CCK_LEN_8812F)) -+#define BIT_GET_R_CCK_LEN_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_CCK_LEN_8812F) & BIT_MASK_R_CCK_LEN_8812F) -+#define BIT_SET_R_CCK_LEN_8812F(x, v) \ -+ (BIT_CLEAR_R_CCK_LEN_8812F(x) | BIT_R_CCK_LEN_8812F(v)) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8812F 24 -+#define BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8812F 0xff -+#define BIT_R_WMAC_RXFIFO_FULL_TH_1_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8812F) \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8812F) -+#define BITS_R_WMAC_RXFIFO_FULL_TH_1_8812F \ -+ (BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8812F \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8812F) -+#define BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_1_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_RXFIFO_FULL_TH_1_8812F)) -+#define BIT_GET_R_WMAC_RXFIFO_FULL_TH_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8812F) & \ -+ BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8812F) -+#define BIT_SET_R_WMAC_RXFIFO_FULL_TH_1_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_1_8812F(x) | \ -+ BIT_R_WMAC_RXFIFO_FULL_TH_1_8812F(v)) -+ -+#define BIT_R_WMAC_RX_SYNCFIFO_SYNC_1_8812F BIT(23) -+#define BIT_R_WMAC_RXRST_DLY_1_8812F BIT(22) -+#define BIT_R_WMAC_SRCH_TXRPT_REF_DROP_1_8812F BIT(21) -+#define BIT_R_WMAC_SRCH_TXRPT_UA1_1_8812F BIT(20) -+#define BIT_R_WMAC_SRCH_TXRPT_TYPE_1_8812F BIT(19) -+#define BIT_R_WMAC_NDP_RST_1_8812F BIT(18) -+#define BIT_R_WMAC_POWINT_EN_1_8812F BIT(17) -+#define BIT_R_WMAC_SRCH_TXRPT_PERPKT_1_8812F BIT(16) -+#define BIT_R_WMAC_SRCH_TXRPT_MID_1_8812F BIT(15) -+#define BIT_R_WMAC_PFIN_TOEN_1_8812F BIT(14) -+#define BIT_R_WMAC_FIL_SECERR_1_8812F BIT(13) -+#define BIT_R_WMAC_FIL_CTLPKTLEN_1_8812F BIT(12) -+#define BIT_R_WMAC_FIL_FCTYPE_1_8812F BIT(11) -+#define BIT_R_WMAC_FIL_FCPROVER_1_8812F BIT(10) -+#define BIT_R_WMAC_PHYSTS_SNIF_1_8812F BIT(9) -+#define BIT_R_WMAC_PHYSTS_PLCP_1_8812F BIT(8) -+#define BIT_R_MAC_TCR_VBONF_RD_1_8812F BIT(7) -+#define BIT_R_WMAC_TCR_MPAR_NDP_1_8812F BIT(6) -+#define BIT_R_WMAC_NDP_FILTER_1_8812F BIT(5) -+#define BIT_R_WMAC_RXLEN_SEL_1_8812F BIT(4) -+#define BIT_R_WMAC_RXLEN_SEL1_1_8812F BIT(3) -+#define BIT_R_OFDM_FILTER_1_8812F BIT(2) -+#define BIT_R_WMAC_CHK_OFDM_LEN_1_8812F BIT(1) -+#define BIT_R_WMAC_CHK_CCK_LEN_1_8812F BIT(0) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_2_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8812F 0 -+#define BIT_MASK_R_WMAC_RX_FIL_LEN_2_8812F 0xffff -+#define BIT_R_WMAC_RX_FIL_LEN_2_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_RX_FIL_LEN_2_8812F) \ -+ << BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8812F) -+#define BITS_R_WMAC_RX_FIL_LEN_2_8812F \ -+ (BIT_MASK_R_WMAC_RX_FIL_LEN_2_8812F \ -+ << BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8812F) -+#define BIT_CLEAR_R_WMAC_RX_FIL_LEN_2_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_RX_FIL_LEN_2_8812F)) -+#define BIT_GET_R_WMAC_RX_FIL_LEN_2_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8812F) & \ -+ BIT_MASK_R_WMAC_RX_FIL_LEN_2_8812F) -+#define BIT_SET_R_WMAC_RX_FIL_LEN_2_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_RX_FIL_LEN_2_8812F(x) | \ -+ BIT_R_WMAC_RX_FIL_LEN_2_8812F(v)) -+ -+/* 2 REG_RX_FILTER_FUNCTION_8812F */ -+#define BIT_RXHANG_EN_8812F BIT(15) -+#define BIT_R_WMAC_MHRDDY_LATCH_8812F BIT(14) -+#define BIT_R_WMAC_MHRDDY_CLR_8812F BIT(13) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY1_8812F BIT(12) -+#define BIT_WMAC_DIS_VHT_PLCP_CHK_MU_8812F BIT(11) -+#define BIT_R_CHK_DELIMIT_LEN_8812F BIT(10) -+#define BIT_R_REAPTER_ADDR_MATCH_8812F BIT(9) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY_8812F BIT(8) -+#define BIT_R_LATCH_MACHRDY_8812F BIT(7) -+#define BIT_R_WMAC_RXFIL_REND_8812F BIT(6) -+#define BIT_R_WMAC_MPDURDY_CLR_8812F BIT(5) -+#define BIT_R_WMAC_CLRRXSEC_8812F BIT(4) -+#define BIT_R_WMAC_RXFIL_RDEL_8812F BIT(3) -+#define BIT_R_WMAC_RXFIL_FCSE_8812F BIT(2) -+#define BIT_R_WMAC_RXFIL_MESH_DEL_8812F BIT(1) -+#define BIT_R_WMAC_RXFIL_MASKM_8812F BIT(0) -+ -+/* 2 REG_NDP_SIG_8812F */ -+ -+#define BIT_SHIFT_R_WMAC_TXNDP_SIGB_8812F 0 -+#define BIT_MASK_R_WMAC_TXNDP_SIGB_8812F 0x1fffff -+#define BIT_R_WMAC_TXNDP_SIGB_8812F(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXNDP_SIGB_8812F) \ -+ << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8812F) -+#define BITS_R_WMAC_TXNDP_SIGB_8812F \ -+ (BIT_MASK_R_WMAC_TXNDP_SIGB_8812F << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8812F) -+#define BIT_CLEAR_R_WMAC_TXNDP_SIGB_8812F(x) \ -+ ((x) & (~BITS_R_WMAC_TXNDP_SIGB_8812F)) -+#define BIT_GET_R_WMAC_TXNDP_SIGB_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXNDP_SIGB_8812F) & \ -+ BIT_MASK_R_WMAC_TXNDP_SIGB_8812F) -+#define BIT_SET_R_WMAC_TXNDP_SIGB_8812F(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXNDP_SIGB_8812F(x) | BIT_R_WMAC_TXNDP_SIGB_8812F(v)) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_8812F */ -+ -+#define BIT_SHIFT_R_MAC_DBG_SHIFT_8812F 8 -+#define BIT_MASK_R_MAC_DBG_SHIFT_8812F 0x7 -+#define BIT_R_MAC_DBG_SHIFT_8812F(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SHIFT_8812F) \ -+ << BIT_SHIFT_R_MAC_DBG_SHIFT_8812F) -+#define BITS_R_MAC_DBG_SHIFT_8812F \ -+ (BIT_MASK_R_MAC_DBG_SHIFT_8812F << BIT_SHIFT_R_MAC_DBG_SHIFT_8812F) -+#define BIT_CLEAR_R_MAC_DBG_SHIFT_8812F(x) ((x) & (~BITS_R_MAC_DBG_SHIFT_8812F)) -+#define BIT_GET_R_MAC_DBG_SHIFT_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SHIFT_8812F) & \ -+ BIT_MASK_R_MAC_DBG_SHIFT_8812F) -+#define BIT_SET_R_MAC_DBG_SHIFT_8812F(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SHIFT_8812F(x) | BIT_R_MAC_DBG_SHIFT_8812F(v)) -+ -+#define BIT_SHIFT_R_MAC_DBG_SEL_8812F 0 -+#define BIT_MASK_R_MAC_DBG_SEL_8812F 0x3 -+#define BIT_R_MAC_DBG_SEL_8812F(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SEL_8812F) << BIT_SHIFT_R_MAC_DBG_SEL_8812F) -+#define BITS_R_MAC_DBG_SEL_8812F \ -+ (BIT_MASK_R_MAC_DBG_SEL_8812F << BIT_SHIFT_R_MAC_DBG_SEL_8812F) -+#define BIT_CLEAR_R_MAC_DBG_SEL_8812F(x) ((x) & (~BITS_R_MAC_DBG_SEL_8812F)) -+#define BIT_GET_R_MAC_DBG_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SEL_8812F) & BIT_MASK_R_MAC_DBG_SEL_8812F) -+#define BIT_SET_R_MAC_DBG_SEL_8812F(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SEL_8812F(x) | BIT_R_MAC_DBG_SEL_8812F(v)) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_1_8812F */ -+ -+#define BIT_SHIFT_R_MAC_DEBUG_1_8812F 0 -+#define BIT_MASK_R_MAC_DEBUG_1_8812F 0xffffffffL -+#define BIT_R_MAC_DEBUG_1_8812F(x) \ -+ (((x) & BIT_MASK_R_MAC_DEBUG_1_8812F) << BIT_SHIFT_R_MAC_DEBUG_1_8812F) -+#define BITS_R_MAC_DEBUG_1_8812F \ -+ (BIT_MASK_R_MAC_DEBUG_1_8812F << BIT_SHIFT_R_MAC_DEBUG_1_8812F) -+#define BIT_CLEAR_R_MAC_DEBUG_1_8812F(x) ((x) & (~BITS_R_MAC_DEBUG_1_8812F)) -+#define BIT_GET_R_MAC_DEBUG_1_8812F(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DEBUG_1_8812F) & BIT_MASK_R_MAC_DEBUG_1_8812F) -+#define BIT_SET_R_MAC_DEBUG_1_8812F(x, v) \ -+ (BIT_CLEAR_R_MAC_DEBUG_1_8812F(x) | BIT_R_MAC_DEBUG_1_8812F(v)) -+ -+/* 2 REG_WSEC_OPTION_8812F */ -+#define BIT_RXDEC_BM_MGNT_8812F BIT(22) -+#define BIT_TXENC_BM_MGNT_8812F BIT(21) -+#define BIT_RXDEC_UNI_MGNT_8812F BIT(20) -+#define BIT_TXENC_UNI_MGNT_8812F BIT(19) -+#define BIT_WMAC_SEC_MASKIV_8812F BIT(18) -+ -+#define BIT_SHIFT_WMAC_SEC_PN_SEL_8812F 16 -+#define BIT_MASK_WMAC_SEC_PN_SEL_8812F 0x3 -+#define BIT_WMAC_SEC_PN_SEL_8812F(x) \ -+ (((x) & BIT_MASK_WMAC_SEC_PN_SEL_8812F) \ -+ << BIT_SHIFT_WMAC_SEC_PN_SEL_8812F) -+#define BITS_WMAC_SEC_PN_SEL_8812F \ -+ (BIT_MASK_WMAC_SEC_PN_SEL_8812F << BIT_SHIFT_WMAC_SEC_PN_SEL_8812F) -+#define BIT_CLEAR_WMAC_SEC_PN_SEL_8812F(x) ((x) & (~BITS_WMAC_SEC_PN_SEL_8812F)) -+#define BIT_GET_WMAC_SEC_PN_SEL_8812F(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SEC_PN_SEL_8812F) & \ -+ BIT_MASK_WMAC_SEC_PN_SEL_8812F) -+#define BIT_SET_WMAC_SEC_PN_SEL_8812F(x, v) \ -+ (BIT_CLEAR_WMAC_SEC_PN_SEL_8812F(x) | BIT_WMAC_SEC_PN_SEL_8812F(v)) -+ -+#define BIT_SHIFT_BT_TIME_CNT_8812F 0 -+#define BIT_MASK_BT_TIME_CNT_8812F 0xff -+#define BIT_BT_TIME_CNT_8812F(x) \ -+ (((x) & BIT_MASK_BT_TIME_CNT_8812F) << BIT_SHIFT_BT_TIME_CNT_8812F) -+#define BITS_BT_TIME_CNT_8812F \ -+ (BIT_MASK_BT_TIME_CNT_8812F << BIT_SHIFT_BT_TIME_CNT_8812F) -+#define BIT_CLEAR_BT_TIME_CNT_8812F(x) ((x) & (~BITS_BT_TIME_CNT_8812F)) -+#define BIT_GET_BT_TIME_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_BT_TIME_CNT_8812F) & BIT_MASK_BT_TIME_CNT_8812F) -+#define BIT_SET_BT_TIME_CNT_8812F(x, v) \ -+ (BIT_CLEAR_BT_TIME_CNT_8812F(x) | BIT_BT_TIME_CNT_8812F(v)) -+ -+/* 2 REG_RTS_ADDRESS_0_8812F */ -+ -+/* 2 REG_RTS_ADDRESS_0_1_8812F */ -+ -+/* 2 REG_RTS_ADDRESS_1_8812F */ -+ -+/* 2 REG_RTS_ADDRESS_1_1_8812F */ -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8812F */ -+#define BIT_LTECOEX_ACCESS_START_V1_8812F BIT(31) -+#define BIT_LTECOEX_WRITE_MODE_V1_8812F BIT(30) -+#define BIT_LTECOEX_READY_BIT_V1_8812F BIT(29) -+ -+#define BIT_SHIFT_WRITE_BYTE_EN_V1_8812F 16 -+#define BIT_MASK_WRITE_BYTE_EN_V1_8812F 0xf -+#define BIT_WRITE_BYTE_EN_V1_8812F(x) \ -+ (((x) & BIT_MASK_WRITE_BYTE_EN_V1_8812F) \ -+ << BIT_SHIFT_WRITE_BYTE_EN_V1_8812F) -+#define BITS_WRITE_BYTE_EN_V1_8812F \ -+ (BIT_MASK_WRITE_BYTE_EN_V1_8812F << BIT_SHIFT_WRITE_BYTE_EN_V1_8812F) -+#define BIT_CLEAR_WRITE_BYTE_EN_V1_8812F(x) \ -+ ((x) & (~BITS_WRITE_BYTE_EN_V1_8812F)) -+#define BIT_GET_WRITE_BYTE_EN_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_WRITE_BYTE_EN_V1_8812F) & \ -+ BIT_MASK_WRITE_BYTE_EN_V1_8812F) -+#define BIT_SET_WRITE_BYTE_EN_V1_8812F(x, v) \ -+ (BIT_CLEAR_WRITE_BYTE_EN_V1_8812F(x) | BIT_WRITE_BYTE_EN_V1_8812F(v)) -+ -+#define BIT_SHIFT_LTECOEX_REG_ADDR_V1_8812F 0 -+#define BIT_MASK_LTECOEX_REG_ADDR_V1_8812F 0xffff -+#define BIT_LTECOEX_REG_ADDR_V1_8812F(x) \ -+ (((x) & BIT_MASK_LTECOEX_REG_ADDR_V1_8812F) \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8812F) -+#define BITS_LTECOEX_REG_ADDR_V1_8812F \ -+ (BIT_MASK_LTECOEX_REG_ADDR_V1_8812F \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8812F) -+#define BIT_CLEAR_LTECOEX_REG_ADDR_V1_8812F(x) \ -+ ((x) & (~BITS_LTECOEX_REG_ADDR_V1_8812F)) -+#define BIT_GET_LTECOEX_REG_ADDR_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_REG_ADDR_V1_8812F) & \ -+ BIT_MASK_LTECOEX_REG_ADDR_V1_8812F) -+#define BIT_SET_LTECOEX_REG_ADDR_V1_8812F(x, v) \ -+ (BIT_CLEAR_LTECOEX_REG_ADDR_V1_8812F(x) | \ -+ BIT_LTECOEX_REG_ADDR_V1_8812F(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8812F */ -+ -+#define BIT_SHIFT_LTECOEX_W_DATA_V1_8812F 0 -+#define BIT_MASK_LTECOEX_W_DATA_V1_8812F 0xffffffffL -+#define BIT_LTECOEX_W_DATA_V1_8812F(x) \ -+ (((x) & BIT_MASK_LTECOEX_W_DATA_V1_8812F) \ -+ << BIT_SHIFT_LTECOEX_W_DATA_V1_8812F) -+#define BITS_LTECOEX_W_DATA_V1_8812F \ -+ (BIT_MASK_LTECOEX_W_DATA_V1_8812F << BIT_SHIFT_LTECOEX_W_DATA_V1_8812F) -+#define BIT_CLEAR_LTECOEX_W_DATA_V1_8812F(x) \ -+ ((x) & (~BITS_LTECOEX_W_DATA_V1_8812F)) -+#define BIT_GET_LTECOEX_W_DATA_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_W_DATA_V1_8812F) & \ -+ BIT_MASK_LTECOEX_W_DATA_V1_8812F) -+#define BIT_SET_LTECOEX_W_DATA_V1_8812F(x, v) \ -+ (BIT_CLEAR_LTECOEX_W_DATA_V1_8812F(x) | BIT_LTECOEX_W_DATA_V1_8812F(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8812F */ -+ -+#define BIT_SHIFT_LTECOEX_R_DATA_V1_8812F 0 -+#define BIT_MASK_LTECOEX_R_DATA_V1_8812F 0xffffffffL -+#define BIT_LTECOEX_R_DATA_V1_8812F(x) \ -+ (((x) & BIT_MASK_LTECOEX_R_DATA_V1_8812F) \ -+ << BIT_SHIFT_LTECOEX_R_DATA_V1_8812F) -+#define BITS_LTECOEX_R_DATA_V1_8812F \ -+ (BIT_MASK_LTECOEX_R_DATA_V1_8812F << BIT_SHIFT_LTECOEX_R_DATA_V1_8812F) -+#define BIT_CLEAR_LTECOEX_R_DATA_V1_8812F(x) \ -+ ((x) & (~BITS_LTECOEX_R_DATA_V1_8812F)) -+#define BIT_GET_LTECOEX_R_DATA_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_R_DATA_V1_8812F) & \ -+ BIT_MASK_LTECOEX_R_DATA_V1_8812F) -+#define BIT_SET_LTECOEX_R_DATA_V1_8812F(x, v) \ -+ (BIT_CLEAR_LTECOEX_R_DATA_V1_8812F(x) | BIT_LTECOEX_R_DATA_V1_8812F(v)) -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_NOT_VALID_8812F */ -+ -+/* 2 REG_SDIO_TX_CTRL_8812F */ -+ -+#define BIT_SHIFT_SDIO_INT_TIMEOUT_8812F 16 -+#define BIT_MASK_SDIO_INT_TIMEOUT_8812F 0xffff -+#define BIT_SDIO_INT_TIMEOUT_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_INT_TIMEOUT_8812F) \ -+ << BIT_SHIFT_SDIO_INT_TIMEOUT_8812F) -+#define BITS_SDIO_INT_TIMEOUT_8812F \ -+ (BIT_MASK_SDIO_INT_TIMEOUT_8812F << BIT_SHIFT_SDIO_INT_TIMEOUT_8812F) -+#define BIT_CLEAR_SDIO_INT_TIMEOUT_8812F(x) \ -+ ((x) & (~BITS_SDIO_INT_TIMEOUT_8812F)) -+#define BIT_GET_SDIO_INT_TIMEOUT_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_INT_TIMEOUT_8812F) & \ -+ BIT_MASK_SDIO_INT_TIMEOUT_8812F) -+#define BIT_SET_SDIO_INT_TIMEOUT_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_INT_TIMEOUT_8812F(x) | BIT_SDIO_INT_TIMEOUT_8812F(v)) -+ -+#define BIT_IO_ERR_STATUS_8812F BIT(15) -+#define BIT_CMD53_W_MIX_8812F BIT(14) -+#define BIT_CMD53_TX_FORMAT_8812F BIT(13) -+#define BIT_CMD53_R_TIMEOUT_MASK_8812F BIT(12) -+ -+#define BIT_SHIFT_CMD53_R_TIMEOUT_UNIT_8812F 10 -+#define BIT_MASK_CMD53_R_TIMEOUT_UNIT_8812F 0x3 -+#define BIT_CMD53_R_TIMEOUT_UNIT_8812F(x) \ -+ (((x) & BIT_MASK_CMD53_R_TIMEOUT_UNIT_8812F) \ -+ << BIT_SHIFT_CMD53_R_TIMEOUT_UNIT_8812F) -+#define BITS_CMD53_R_TIMEOUT_UNIT_8812F \ -+ (BIT_MASK_CMD53_R_TIMEOUT_UNIT_8812F \ -+ << BIT_SHIFT_CMD53_R_TIMEOUT_UNIT_8812F) -+#define BIT_CLEAR_CMD53_R_TIMEOUT_UNIT_8812F(x) \ -+ ((x) & (~BITS_CMD53_R_TIMEOUT_UNIT_8812F)) -+#define BIT_GET_CMD53_R_TIMEOUT_UNIT_8812F(x) \ -+ (((x) >> BIT_SHIFT_CMD53_R_TIMEOUT_UNIT_8812F) & \ -+ BIT_MASK_CMD53_R_TIMEOUT_UNIT_8812F) -+#define BIT_SET_CMD53_R_TIMEOUT_UNIT_8812F(x, v) \ -+ (BIT_CLEAR_CMD53_R_TIMEOUT_UNIT_8812F(x) | \ -+ BIT_CMD53_R_TIMEOUT_UNIT_8812F(v)) -+ -+#define BIT_REPLY_ERRCRC_IN_DATA_8812F BIT(9) -+#define BIT_EN_CMD53_OVERLAP_8812F BIT(8) -+#define BIT_REPLY_ERR_IN_R5_8812F BIT(7) -+#define BIT_R18A_EN_8812F BIT(6) -+#define BIT_SDIO_CMD_FORCE_VLD_8812F BIT(5) -+#define BIT_INIT_CMD_EN_8812F BIT(4) -+#define BIT_RXINT_READ_MASK_DIS_8812F BIT(3) -+#define BIT_EN_RXDMA_MASK_INT_8812F BIT(2) -+#define BIT_EN_MASK_TIMER_8812F BIT(1) -+#define BIT_CMD_ERR_STOP_INT_EN_8812F BIT(0) -+ -+/* 2 REG_SDIO_CMD11_VOL_SWITCH_8812F */ -+ -+#define BIT_SHIFT_CMD11_SEQ_END_DELAY_8812F 4 -+#define BIT_MASK_CMD11_SEQ_END_DELAY_8812F 0xf -+#define BIT_CMD11_SEQ_END_DELAY_8812F(x) \ -+ (((x) & BIT_MASK_CMD11_SEQ_END_DELAY_8812F) \ -+ << BIT_SHIFT_CMD11_SEQ_END_DELAY_8812F) -+#define BITS_CMD11_SEQ_END_DELAY_8812F \ -+ (BIT_MASK_CMD11_SEQ_END_DELAY_8812F \ -+ << BIT_SHIFT_CMD11_SEQ_END_DELAY_8812F) -+#define BIT_CLEAR_CMD11_SEQ_END_DELAY_8812F(x) \ -+ ((x) & (~BITS_CMD11_SEQ_END_DELAY_8812F)) -+#define BIT_GET_CMD11_SEQ_END_DELAY_8812F(x) \ -+ (((x) >> BIT_SHIFT_CMD11_SEQ_END_DELAY_8812F) & \ -+ BIT_MASK_CMD11_SEQ_END_DELAY_8812F) -+#define BIT_SET_CMD11_SEQ_END_DELAY_8812F(x, v) \ -+ (BIT_CLEAR_CMD11_SEQ_END_DELAY_8812F(x) | \ -+ BIT_CMD11_SEQ_END_DELAY_8812F(v)) -+ -+#define BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL_8812F 1 -+#define BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL_8812F 0x7 -+#define BIT_CMD11_SEQ_SAMPLE_INTERVAL_8812F(x) \ -+ (((x) & BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL_8812F) \ -+ << BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL_8812F) -+#define BITS_CMD11_SEQ_SAMPLE_INTERVAL_8812F \ -+ (BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL_8812F \ -+ << BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL_8812F) -+#define BIT_CLEAR_CMD11_SEQ_SAMPLE_INTERVAL_8812F(x) \ -+ ((x) & (~BITS_CMD11_SEQ_SAMPLE_INTERVAL_8812F)) -+#define BIT_GET_CMD11_SEQ_SAMPLE_INTERVAL_8812F(x) \ -+ (((x) >> BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL_8812F) & \ -+ BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL_8812F) -+#define BIT_SET_CMD11_SEQ_SAMPLE_INTERVAL_8812F(x, v) \ -+ (BIT_CLEAR_CMD11_SEQ_SAMPLE_INTERVAL_8812F(x) | \ -+ BIT_CMD11_SEQ_SAMPLE_INTERVAL_8812F(v)) -+ -+#define BIT_CMD11_SEQ_EN_8812F BIT(0) -+ -+/* 2 REG_SDIO_CTRL_8812F */ -+#define BIT_SIG_OUT_PH_8812F BIT(0) -+ -+/* 2 REG_SDIO_DRIVING_8812F */ -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_D_8812F 12 -+#define BIT_MASK_SDIO_DRV_TYPE_D_8812F 0xf -+#define BIT_SDIO_DRV_TYPE_D_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_D_8812F) \ -+ << BIT_SHIFT_SDIO_DRV_TYPE_D_8812F) -+#define BITS_SDIO_DRV_TYPE_D_8812F \ -+ (BIT_MASK_SDIO_DRV_TYPE_D_8812F << BIT_SHIFT_SDIO_DRV_TYPE_D_8812F) -+#define BIT_CLEAR_SDIO_DRV_TYPE_D_8812F(x) ((x) & (~BITS_SDIO_DRV_TYPE_D_8812F)) -+#define BIT_GET_SDIO_DRV_TYPE_D_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_D_8812F) & \ -+ BIT_MASK_SDIO_DRV_TYPE_D_8812F) -+#define BIT_SET_SDIO_DRV_TYPE_D_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_D_8812F(x) | BIT_SDIO_DRV_TYPE_D_8812F(v)) -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_C_8812F 8 -+#define BIT_MASK_SDIO_DRV_TYPE_C_8812F 0xf -+#define BIT_SDIO_DRV_TYPE_C_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_C_8812F) \ -+ << BIT_SHIFT_SDIO_DRV_TYPE_C_8812F) -+#define BITS_SDIO_DRV_TYPE_C_8812F \ -+ (BIT_MASK_SDIO_DRV_TYPE_C_8812F << BIT_SHIFT_SDIO_DRV_TYPE_C_8812F) -+#define BIT_CLEAR_SDIO_DRV_TYPE_C_8812F(x) ((x) & (~BITS_SDIO_DRV_TYPE_C_8812F)) -+#define BIT_GET_SDIO_DRV_TYPE_C_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_C_8812F) & \ -+ BIT_MASK_SDIO_DRV_TYPE_C_8812F) -+#define BIT_SET_SDIO_DRV_TYPE_C_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_C_8812F(x) | BIT_SDIO_DRV_TYPE_C_8812F(v)) -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_B_8812F 4 -+#define BIT_MASK_SDIO_DRV_TYPE_B_8812F 0xf -+#define BIT_SDIO_DRV_TYPE_B_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_B_8812F) \ -+ << BIT_SHIFT_SDIO_DRV_TYPE_B_8812F) -+#define BITS_SDIO_DRV_TYPE_B_8812F \ -+ (BIT_MASK_SDIO_DRV_TYPE_B_8812F << BIT_SHIFT_SDIO_DRV_TYPE_B_8812F) -+#define BIT_CLEAR_SDIO_DRV_TYPE_B_8812F(x) ((x) & (~BITS_SDIO_DRV_TYPE_B_8812F)) -+#define BIT_GET_SDIO_DRV_TYPE_B_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_B_8812F) & \ -+ BIT_MASK_SDIO_DRV_TYPE_B_8812F) -+#define BIT_SET_SDIO_DRV_TYPE_B_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_B_8812F(x) | BIT_SDIO_DRV_TYPE_B_8812F(v)) -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_A_8812F 0 -+#define BIT_MASK_SDIO_DRV_TYPE_A_8812F 0xf -+#define BIT_SDIO_DRV_TYPE_A_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_A_8812F) \ -+ << BIT_SHIFT_SDIO_DRV_TYPE_A_8812F) -+#define BITS_SDIO_DRV_TYPE_A_8812F \ -+ (BIT_MASK_SDIO_DRV_TYPE_A_8812F << BIT_SHIFT_SDIO_DRV_TYPE_A_8812F) -+#define BIT_CLEAR_SDIO_DRV_TYPE_A_8812F(x) ((x) & (~BITS_SDIO_DRV_TYPE_A_8812F)) -+#define BIT_GET_SDIO_DRV_TYPE_A_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_A_8812F) & \ -+ BIT_MASK_SDIO_DRV_TYPE_A_8812F) -+#define BIT_SET_SDIO_DRV_TYPE_A_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_A_8812F(x) | BIT_SDIO_DRV_TYPE_A_8812F(v)) -+ -+/* 2 REG_SDIO_MONITOR_8812F */ -+ -+#define BIT_SHIFT_SDIO_INT_START_8812F 0 -+#define BIT_MASK_SDIO_INT_START_8812F 0xffffffffL -+#define BIT_SDIO_INT_START_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_INT_START_8812F) \ -+ << BIT_SHIFT_SDIO_INT_START_8812F) -+#define BITS_SDIO_INT_START_8812F \ -+ (BIT_MASK_SDIO_INT_START_8812F << BIT_SHIFT_SDIO_INT_START_8812F) -+#define BIT_CLEAR_SDIO_INT_START_8812F(x) ((x) & (~BITS_SDIO_INT_START_8812F)) -+#define BIT_GET_SDIO_INT_START_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_INT_START_8812F) & \ -+ BIT_MASK_SDIO_INT_START_8812F) -+#define BIT_SET_SDIO_INT_START_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_INT_START_8812F(x) | BIT_SDIO_INT_START_8812F(v)) -+ -+/* 2 REG_SDIO_MONITOR_2_8812F */ -+#define BIT_CMD53_WT_EN_8812F BIT(23) -+ -+#define BIT_SHIFT_SDIO_CLK_MONITOR_8812F 21 -+#define BIT_MASK_SDIO_CLK_MONITOR_8812F 0x3 -+#define BIT_SDIO_CLK_MONITOR_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_CLK_MONITOR_8812F) \ -+ << BIT_SHIFT_SDIO_CLK_MONITOR_8812F) -+#define BITS_SDIO_CLK_MONITOR_8812F \ -+ (BIT_MASK_SDIO_CLK_MONITOR_8812F << BIT_SHIFT_SDIO_CLK_MONITOR_8812F) -+#define BIT_CLEAR_SDIO_CLK_MONITOR_8812F(x) \ -+ ((x) & (~BITS_SDIO_CLK_MONITOR_8812F)) -+#define BIT_GET_SDIO_CLK_MONITOR_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CLK_MONITOR_8812F) & \ -+ BIT_MASK_SDIO_CLK_MONITOR_8812F) -+#define BIT_SET_SDIO_CLK_MONITOR_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_CLK_MONITOR_8812F(x) | BIT_SDIO_CLK_MONITOR_8812F(v)) -+ -+#define BIT_SHIFT_SDIO_CLK_CNT_8812F 0 -+#define BIT_MASK_SDIO_CLK_CNT_8812F 0x1fffff -+#define BIT_SDIO_CLK_CNT_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_CLK_CNT_8812F) << BIT_SHIFT_SDIO_CLK_CNT_8812F) -+#define BITS_SDIO_CLK_CNT_8812F \ -+ (BIT_MASK_SDIO_CLK_CNT_8812F << BIT_SHIFT_SDIO_CLK_CNT_8812F) -+#define BIT_CLEAR_SDIO_CLK_CNT_8812F(x) ((x) & (~BITS_SDIO_CLK_CNT_8812F)) -+#define BIT_GET_SDIO_CLK_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CLK_CNT_8812F) & BIT_MASK_SDIO_CLK_CNT_8812F) -+#define BIT_SET_SDIO_CLK_CNT_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_CLK_CNT_8812F(x) | BIT_SDIO_CLK_CNT_8812F(v)) -+ -+/* 2 REG_SDIO_CTRL_2_8812F */ -+#define BIT_SDIO_CLK_SMT_V1_8812F BIT(1) -+#define BIT_SDIO_DATA_SMT_8812F BIT(0) -+ -+/* 2 REG_SDIO_HIMR_8812F */ -+#define BIT_SDIO_CRCERR_MSK_8812F BIT(31) -+#define BIT_SDIO_HSISR3_IND_MSK_8812F BIT(30) -+#define BIT_SDIO_HSISR2_IND_MSK_8812F BIT(29) -+#define BIT_SDIO_HEISR_IND_MSK_8812F BIT(28) -+#define BIT_SDIO_CTWEND_MSK_8812F BIT(27) -+#define BIT_SDIO_ATIMEND_E_MSK_8812F BIT(26) -+#define BIT_SDIIO_ATIMEND_MSK_8812F BIT(25) -+#define BIT_SDIO_OCPINT_MSK_8812F BIT(24) -+#define BIT_SDIO_PSTIMEOUT_MSK_8812F BIT(23) -+#define BIT_SDIO_GTINT4_MSK_8812F BIT(22) -+#define BIT_SDIO_GTINT3_MSK_8812F BIT(21) -+#define BIT_SDIO_HSISR_IND_MSK_8812F BIT(20) -+#define BIT_SDIO_CPWM2_MSK_8812F BIT(19) -+#define BIT_SDIO_CPWM1_MSK_8812F BIT(18) -+#define BIT_SDIO_C2HCMD_INT_MSK_8812F BIT(17) -+#define BIT_SDIO_BCNERLY_INT_MSK_8812F BIT(16) -+#define BIT_SDIO_TXBCNERR_MSK_8812F BIT(7) -+#define BIT_SDIO_TXBCNOK_MSK_8812F BIT(6) -+#define BIT_SDIO_RXFOVW_MSK_8812F BIT(5) -+#define BIT_SDIO_TXFOVW_MSK_8812F BIT(4) -+#define BIT_SDIO_RXERR_MSK_8812F BIT(3) -+#define BIT_SDIO_TXERR_MSK_8812F BIT(2) -+#define BIT_SDIO_AVAL_MSK_8812F BIT(1) -+#define BIT_RX_REQUEST_MSK_8812F BIT(0) -+ -+/* 2 REG_SDIO_HISR_8812F */ -+#define BIT_SDIO_CRCERR_8812F BIT(31) -+#define BIT_SDIO_HSISR3_IND_8812F BIT(30) -+#define BIT_SDIO_HSISR2_IND_8812F BIT(29) -+#define BIT_SDIO_HEISR_IND_8812F BIT(28) -+#define BIT_SDIO_CTWEND_8812F BIT(27) -+#define BIT_SDIO_ATIMEND_E_8812F BIT(26) -+#define BIT_SDIO_ATIMEND_8812F BIT(25) -+#define BIT_SDIO_OCPINT_8812F BIT(24) -+#define BIT_SDIO_PSTIMEOUT_8812F BIT(23) -+#define BIT_SDIO_GTINT4_8812F BIT(22) -+#define BIT_SDIO_GTINT3_8812F BIT(21) -+#define BIT_SDIO_HSISR_IND_8812F BIT(20) -+#define BIT_SDIO_CPWM2_8812F BIT(19) -+#define BIT_SDIO_CPWM1_8812F BIT(18) -+#define BIT_SDIO_C2HCMD_INT_8812F BIT(17) -+#define BIT_SDIO_BCNERLY_INT_8812F BIT(16) -+#define BIT_SDIO_TXBCNERR_8812F BIT(7) -+#define BIT_SDIO_TXBCNOK_8812F BIT(6) -+#define BIT_SDIO_RXFOVW_8812F BIT(5) -+#define BIT_SDIO_TXFOVW_8812F BIT(4) -+#define BIT_SDIO_RXERR_8812F BIT(3) -+#define BIT_SDIO_TXERR_8812F BIT(2) -+#define BIT_SDIO_AVAL_8812F BIT(1) -+#define BIT_RX_REQUEST_8812F BIT(0) -+ -+/* 2 REG_SDIO_RX_REQ_LEN_8812F */ -+ -+#define BIT_SHIFT_RX_REQ_LEN_V1_8812F 0 -+#define BIT_MASK_RX_REQ_LEN_V1_8812F 0x3ffff -+#define BIT_RX_REQ_LEN_V1_8812F(x) \ -+ (((x) & BIT_MASK_RX_REQ_LEN_V1_8812F) << BIT_SHIFT_RX_REQ_LEN_V1_8812F) -+#define BITS_RX_REQ_LEN_V1_8812F \ -+ (BIT_MASK_RX_REQ_LEN_V1_8812F << BIT_SHIFT_RX_REQ_LEN_V1_8812F) -+#define BIT_CLEAR_RX_REQ_LEN_V1_8812F(x) ((x) & (~BITS_RX_REQ_LEN_V1_8812F)) -+#define BIT_GET_RX_REQ_LEN_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_RX_REQ_LEN_V1_8812F) & BIT_MASK_RX_REQ_LEN_V1_8812F) -+#define BIT_SET_RX_REQ_LEN_V1_8812F(x, v) \ -+ (BIT_CLEAR_RX_REQ_LEN_V1_8812F(x) | BIT_RX_REQ_LEN_V1_8812F(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG_SEQ_V1_8812F */ -+ -+#define BIT_SHIFT_FREE_TXPG_SEQ_8812F 0 -+#define BIT_MASK_FREE_TXPG_SEQ_8812F 0xff -+#define BIT_FREE_TXPG_SEQ_8812F(x) \ -+ (((x) & BIT_MASK_FREE_TXPG_SEQ_8812F) << BIT_SHIFT_FREE_TXPG_SEQ_8812F) -+#define BITS_FREE_TXPG_SEQ_8812F \ -+ (BIT_MASK_FREE_TXPG_SEQ_8812F << BIT_SHIFT_FREE_TXPG_SEQ_8812F) -+#define BIT_CLEAR_FREE_TXPG_SEQ_8812F(x) ((x) & (~BITS_FREE_TXPG_SEQ_8812F)) -+#define BIT_GET_FREE_TXPG_SEQ_8812F(x) \ -+ (((x) >> BIT_SHIFT_FREE_TXPG_SEQ_8812F) & BIT_MASK_FREE_TXPG_SEQ_8812F) -+#define BIT_SET_FREE_TXPG_SEQ_8812F(x, v) \ -+ (BIT_CLEAR_FREE_TXPG_SEQ_8812F(x) | BIT_FREE_TXPG_SEQ_8812F(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG_8812F */ -+ -+#define BIT_SHIFT_MID_FREEPG_V1_8812F 16 -+#define BIT_MASK_MID_FREEPG_V1_8812F 0xfff -+#define BIT_MID_FREEPG_V1_8812F(x) \ -+ (((x) & BIT_MASK_MID_FREEPG_V1_8812F) << BIT_SHIFT_MID_FREEPG_V1_8812F) -+#define BITS_MID_FREEPG_V1_8812F \ -+ (BIT_MASK_MID_FREEPG_V1_8812F << BIT_SHIFT_MID_FREEPG_V1_8812F) -+#define BIT_CLEAR_MID_FREEPG_V1_8812F(x) ((x) & (~BITS_MID_FREEPG_V1_8812F)) -+#define BIT_GET_MID_FREEPG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_MID_FREEPG_V1_8812F) & BIT_MASK_MID_FREEPG_V1_8812F) -+#define BIT_SET_MID_FREEPG_V1_8812F(x, v) \ -+ (BIT_CLEAR_MID_FREEPG_V1_8812F(x) | BIT_MID_FREEPG_V1_8812F(v)) -+ -+#define BIT_SHIFT_HIQ_FREEPG_V1_8812F 0 -+#define BIT_MASK_HIQ_FREEPG_V1_8812F 0xfff -+#define BIT_HIQ_FREEPG_V1_8812F(x) \ -+ (((x) & BIT_MASK_HIQ_FREEPG_V1_8812F) << BIT_SHIFT_HIQ_FREEPG_V1_8812F) -+#define BITS_HIQ_FREEPG_V1_8812F \ -+ (BIT_MASK_HIQ_FREEPG_V1_8812F << BIT_SHIFT_HIQ_FREEPG_V1_8812F) -+#define BIT_CLEAR_HIQ_FREEPG_V1_8812F(x) ((x) & (~BITS_HIQ_FREEPG_V1_8812F)) -+#define BIT_GET_HIQ_FREEPG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HIQ_FREEPG_V1_8812F) & BIT_MASK_HIQ_FREEPG_V1_8812F) -+#define BIT_SET_HIQ_FREEPG_V1_8812F(x, v) \ -+ (BIT_CLEAR_HIQ_FREEPG_V1_8812F(x) | BIT_HIQ_FREEPG_V1_8812F(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG2_8812F */ -+ -+#define BIT_SHIFT_PUB_FREEPG_V1_8812F 16 -+#define BIT_MASK_PUB_FREEPG_V1_8812F 0xfff -+#define BIT_PUB_FREEPG_V1_8812F(x) \ -+ (((x) & BIT_MASK_PUB_FREEPG_V1_8812F) << BIT_SHIFT_PUB_FREEPG_V1_8812F) -+#define BITS_PUB_FREEPG_V1_8812F \ -+ (BIT_MASK_PUB_FREEPG_V1_8812F << BIT_SHIFT_PUB_FREEPG_V1_8812F) -+#define BIT_CLEAR_PUB_FREEPG_V1_8812F(x) ((x) & (~BITS_PUB_FREEPG_V1_8812F)) -+#define BIT_GET_PUB_FREEPG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_PUB_FREEPG_V1_8812F) & BIT_MASK_PUB_FREEPG_V1_8812F) -+#define BIT_SET_PUB_FREEPG_V1_8812F(x, v) \ -+ (BIT_CLEAR_PUB_FREEPG_V1_8812F(x) | BIT_PUB_FREEPG_V1_8812F(v)) -+ -+#define BIT_SHIFT_LOW_FREEPG_V1_8812F 0 -+#define BIT_MASK_LOW_FREEPG_V1_8812F 0xfff -+#define BIT_LOW_FREEPG_V1_8812F(x) \ -+ (((x) & BIT_MASK_LOW_FREEPG_V1_8812F) << BIT_SHIFT_LOW_FREEPG_V1_8812F) -+#define BITS_LOW_FREEPG_V1_8812F \ -+ (BIT_MASK_LOW_FREEPG_V1_8812F << BIT_SHIFT_LOW_FREEPG_V1_8812F) -+#define BIT_CLEAR_LOW_FREEPG_V1_8812F(x) ((x) & (~BITS_LOW_FREEPG_V1_8812F)) -+#define BIT_GET_LOW_FREEPG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_LOW_FREEPG_V1_8812F) & BIT_MASK_LOW_FREEPG_V1_8812F) -+#define BIT_SET_LOW_FREEPG_V1_8812F(x, v) \ -+ (BIT_CLEAR_LOW_FREEPG_V1_8812F(x) | BIT_LOW_FREEPG_V1_8812F(v)) -+ -+/* 2 REG_SDIO_OQT_FREE_TXPG_V1_8812F */ -+ -+#define BIT_SHIFT_NOAC_OQT_FREEPG_V1_8812F 24 -+#define BIT_MASK_NOAC_OQT_FREEPG_V1_8812F 0xff -+#define BIT_NOAC_OQT_FREEPG_V1_8812F(x) \ -+ (((x) & BIT_MASK_NOAC_OQT_FREEPG_V1_8812F) \ -+ << BIT_SHIFT_NOAC_OQT_FREEPG_V1_8812F) -+#define BITS_NOAC_OQT_FREEPG_V1_8812F \ -+ (BIT_MASK_NOAC_OQT_FREEPG_V1_8812F \ -+ << BIT_SHIFT_NOAC_OQT_FREEPG_V1_8812F) -+#define BIT_CLEAR_NOAC_OQT_FREEPG_V1_8812F(x) \ -+ ((x) & (~BITS_NOAC_OQT_FREEPG_V1_8812F)) -+#define BIT_GET_NOAC_OQT_FREEPG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_NOAC_OQT_FREEPG_V1_8812F) & \ -+ BIT_MASK_NOAC_OQT_FREEPG_V1_8812F) -+#define BIT_SET_NOAC_OQT_FREEPG_V1_8812F(x, v) \ -+ (BIT_CLEAR_NOAC_OQT_FREEPG_V1_8812F(x) | \ -+ BIT_NOAC_OQT_FREEPG_V1_8812F(v)) -+ -+#define BIT_SHIFT_AC_OQT_FREEPG_V1_8812F 16 -+#define BIT_MASK_AC_OQT_FREEPG_V1_8812F 0xff -+#define BIT_AC_OQT_FREEPG_V1_8812F(x) \ -+ (((x) & BIT_MASK_AC_OQT_FREEPG_V1_8812F) \ -+ << BIT_SHIFT_AC_OQT_FREEPG_V1_8812F) -+#define BITS_AC_OQT_FREEPG_V1_8812F \ -+ (BIT_MASK_AC_OQT_FREEPG_V1_8812F << BIT_SHIFT_AC_OQT_FREEPG_V1_8812F) -+#define BIT_CLEAR_AC_OQT_FREEPG_V1_8812F(x) \ -+ ((x) & (~BITS_AC_OQT_FREEPG_V1_8812F)) -+#define BIT_GET_AC_OQT_FREEPG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_AC_OQT_FREEPG_V1_8812F) & \ -+ BIT_MASK_AC_OQT_FREEPG_V1_8812F) -+#define BIT_SET_AC_OQT_FREEPG_V1_8812F(x, v) \ -+ (BIT_CLEAR_AC_OQT_FREEPG_V1_8812F(x) | BIT_AC_OQT_FREEPG_V1_8812F(v)) -+ -+#define BIT_SHIFT_EXQ_FREEPG_V1_8812F 0 -+#define BIT_MASK_EXQ_FREEPG_V1_8812F 0xfff -+#define BIT_EXQ_FREEPG_V1_8812F(x) \ -+ (((x) & BIT_MASK_EXQ_FREEPG_V1_8812F) << BIT_SHIFT_EXQ_FREEPG_V1_8812F) -+#define BITS_EXQ_FREEPG_V1_8812F \ -+ (BIT_MASK_EXQ_FREEPG_V1_8812F << BIT_SHIFT_EXQ_FREEPG_V1_8812F) -+#define BIT_CLEAR_EXQ_FREEPG_V1_8812F(x) ((x) & (~BITS_EXQ_FREEPG_V1_8812F)) -+#define BIT_GET_EXQ_FREEPG_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_EXQ_FREEPG_V1_8812F) & BIT_MASK_EXQ_FREEPG_V1_8812F) -+#define BIT_SET_EXQ_FREEPG_V1_8812F(x, v) \ -+ (BIT_CLEAR_EXQ_FREEPG_V1_8812F(x) | BIT_EXQ_FREEPG_V1_8812F(v)) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY_8812F */ -+#define BIT_SDIO_BCNQ_EMPTY_8812F BIT(11) -+#define BIT_SDIO_HQQ_EMPTY_8812F BIT(10) -+#define BIT_SDIO_MQQ_EMPTY_8812F BIT(9) -+#define BIT_SDIO_MGQ_CPU_EMPTY_8812F BIT(8) -+#define BIT_SDIO_AC7Q_EMPTY_8812F BIT(7) -+#define BIT_SDIO_AC6Q_EMPTY_8812F BIT(6) -+#define BIT_SDIO_AC5Q_EMPTY_8812F BIT(5) -+#define BIT_SDIO_AC4Q_EMPTY_8812F BIT(4) -+#define BIT_SDIO_AC3Q_EMPTY_8812F BIT(3) -+#define BIT_SDIO_AC2Q_EMPTY_8812F BIT(2) -+#define BIT_SDIO_AC1Q_EMPTY_8812F BIT(1) -+#define BIT_SDIO_AC0Q_EMPTY_8812F BIT(0) -+ -+/* 2 REG_SDIO_HTSFR_INFO_8812F */ -+ -+#define BIT_SHIFT_HTSFR1_8812F 16 -+#define BIT_MASK_HTSFR1_8812F 0xffff -+#define BIT_HTSFR1_8812F(x) \ -+ (((x) & BIT_MASK_HTSFR1_8812F) << BIT_SHIFT_HTSFR1_8812F) -+#define BITS_HTSFR1_8812F (BIT_MASK_HTSFR1_8812F << BIT_SHIFT_HTSFR1_8812F) -+#define BIT_CLEAR_HTSFR1_8812F(x) ((x) & (~BITS_HTSFR1_8812F)) -+#define BIT_GET_HTSFR1_8812F(x) \ -+ (((x) >> BIT_SHIFT_HTSFR1_8812F) & BIT_MASK_HTSFR1_8812F) -+#define BIT_SET_HTSFR1_8812F(x, v) \ -+ (BIT_CLEAR_HTSFR1_8812F(x) | BIT_HTSFR1_8812F(v)) -+ -+#define BIT_SHIFT_HTSFR0_8812F 0 -+#define BIT_MASK_HTSFR0_8812F 0xffff -+#define BIT_HTSFR0_8812F(x) \ -+ (((x) & BIT_MASK_HTSFR0_8812F) << BIT_SHIFT_HTSFR0_8812F) -+#define BITS_HTSFR0_8812F (BIT_MASK_HTSFR0_8812F << BIT_SHIFT_HTSFR0_8812F) -+#define BIT_CLEAR_HTSFR0_8812F(x) ((x) & (~BITS_HTSFR0_8812F)) -+#define BIT_GET_HTSFR0_8812F(x) \ -+ (((x) >> BIT_SHIFT_HTSFR0_8812F) & BIT_MASK_HTSFR0_8812F) -+#define BIT_SET_HTSFR0_8812F(x, v) \ -+ (BIT_CLEAR_HTSFR0_8812F(x) | BIT_HTSFR0_8812F(v)) -+ -+/* 2 REG_SDIO_HCPWM1_V2_8812F */ -+#define BIT_TOGGLE_8812F BIT(7) -+#define BIT_CUR_PS_8812F BIT(0) -+ -+/* 2 REG_SDIO_HCPWM2_V2_8812F */ -+ -+/* 2 REG_SDIO_INDIRECT_REG_CFG_8812F */ -+#define BIT_INDIRECT_REG_RDY_8812F BIT(20) -+#define BIT_INDIRECT_REG_R_8812F BIT(19) -+#define BIT_INDIRECT_REG_W_8812F BIT(18) -+ -+#define BIT_SHIFT_INDIRECT_REG_SIZE_8812F 16 -+#define BIT_MASK_INDIRECT_REG_SIZE_8812F 0x3 -+#define BIT_INDIRECT_REG_SIZE_8812F(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_SIZE_8812F) \ -+ << BIT_SHIFT_INDIRECT_REG_SIZE_8812F) -+#define BITS_INDIRECT_REG_SIZE_8812F \ -+ (BIT_MASK_INDIRECT_REG_SIZE_8812F << BIT_SHIFT_INDIRECT_REG_SIZE_8812F) -+#define BIT_CLEAR_INDIRECT_REG_SIZE_8812F(x) \ -+ ((x) & (~BITS_INDIRECT_REG_SIZE_8812F)) -+#define BIT_GET_INDIRECT_REG_SIZE_8812F(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_SIZE_8812F) & \ -+ BIT_MASK_INDIRECT_REG_SIZE_8812F) -+#define BIT_SET_INDIRECT_REG_SIZE_8812F(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_SIZE_8812F(x) | BIT_INDIRECT_REG_SIZE_8812F(v)) -+ -+#define BIT_SHIFT_INDIRECT_REG_ADDR_8812F 0 -+#define BIT_MASK_INDIRECT_REG_ADDR_8812F 0xffff -+#define BIT_INDIRECT_REG_ADDR_8812F(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_ADDR_8812F) \ -+ << BIT_SHIFT_INDIRECT_REG_ADDR_8812F) -+#define BITS_INDIRECT_REG_ADDR_8812F \ -+ (BIT_MASK_INDIRECT_REG_ADDR_8812F << BIT_SHIFT_INDIRECT_REG_ADDR_8812F) -+#define BIT_CLEAR_INDIRECT_REG_ADDR_8812F(x) \ -+ ((x) & (~BITS_INDIRECT_REG_ADDR_8812F)) -+#define BIT_GET_INDIRECT_REG_ADDR_8812F(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_ADDR_8812F) & \ -+ BIT_MASK_INDIRECT_REG_ADDR_8812F) -+#define BIT_SET_INDIRECT_REG_ADDR_8812F(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_ADDR_8812F(x) | BIT_INDIRECT_REG_ADDR_8812F(v)) -+ -+/* 2 REG_SDIO_INDIRECT_REG_DATA_8812F */ -+ -+#define BIT_SHIFT_INDIRECT_REG_DATA_8812F 0 -+#define BIT_MASK_INDIRECT_REG_DATA_8812F 0xffffffffL -+#define BIT_INDIRECT_REG_DATA_8812F(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_DATA_8812F) \ -+ << BIT_SHIFT_INDIRECT_REG_DATA_8812F) -+#define BITS_INDIRECT_REG_DATA_8812F \ -+ (BIT_MASK_INDIRECT_REG_DATA_8812F << BIT_SHIFT_INDIRECT_REG_DATA_8812F) -+#define BIT_CLEAR_INDIRECT_REG_DATA_8812F(x) \ -+ ((x) & (~BITS_INDIRECT_REG_DATA_8812F)) -+#define BIT_GET_INDIRECT_REG_DATA_8812F(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_DATA_8812F) & \ -+ BIT_MASK_INDIRECT_REG_DATA_8812F) -+#define BIT_SET_INDIRECT_REG_DATA_8812F(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_DATA_8812F(x) | BIT_INDIRECT_REG_DATA_8812F(v)) -+ -+/* 2 REG_SDIO_H2C_8812F */ -+ -+#define BIT_SHIFT_SDIO_H2C_MSG_8812F 0 -+#define BIT_MASK_SDIO_H2C_MSG_8812F 0xffffffffL -+#define BIT_SDIO_H2C_MSG_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_H2C_MSG_8812F) << BIT_SHIFT_SDIO_H2C_MSG_8812F) -+#define BITS_SDIO_H2C_MSG_8812F \ -+ (BIT_MASK_SDIO_H2C_MSG_8812F << BIT_SHIFT_SDIO_H2C_MSG_8812F) -+#define BIT_CLEAR_SDIO_H2C_MSG_8812F(x) ((x) & (~BITS_SDIO_H2C_MSG_8812F)) -+#define BIT_GET_SDIO_H2C_MSG_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_H2C_MSG_8812F) & BIT_MASK_SDIO_H2C_MSG_8812F) -+#define BIT_SET_SDIO_H2C_MSG_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_H2C_MSG_8812F(x) | BIT_SDIO_H2C_MSG_8812F(v)) -+ -+/* 2 REG_SDIO_C2H_8812F */ -+ -+#define BIT_SHIFT_SDIO_C2H_MSG_8812F 0 -+#define BIT_MASK_SDIO_C2H_MSG_8812F 0xffffffffL -+#define BIT_SDIO_C2H_MSG_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_C2H_MSG_8812F) << BIT_SHIFT_SDIO_C2H_MSG_8812F) -+#define BITS_SDIO_C2H_MSG_8812F \ -+ (BIT_MASK_SDIO_C2H_MSG_8812F << BIT_SHIFT_SDIO_C2H_MSG_8812F) -+#define BIT_CLEAR_SDIO_C2H_MSG_8812F(x) ((x) & (~BITS_SDIO_C2H_MSG_8812F)) -+#define BIT_GET_SDIO_C2H_MSG_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_C2H_MSG_8812F) & BIT_MASK_SDIO_C2H_MSG_8812F) -+#define BIT_SET_SDIO_C2H_MSG_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_C2H_MSG_8812F(x) | BIT_SDIO_C2H_MSG_8812F(v)) -+ -+/* 2 REG_SDIO_HRPWM1_8812F */ -+#define BIT_TOGGLE_8812F BIT(7) -+#define BIT_ACK_8812F BIT(6) -+#define BIT_REQ_PS_8812F BIT(0) -+ -+/* 2 REG_SDIO_HRPWM2_8812F */ -+ -+/* 2 REG_SDIO_HPS_CLKR_8812F */ -+ -+/* 2 REG_SDIO_BUS_CTRL_8812F */ -+#define BIT_INT_MASK_DIS_8812F BIT(4) -+#define BIT_PAD_CLK_XHGE_EN_8812F BIT(3) -+#define BIT_INTER_CLK_EN_8812F BIT(2) -+#define BIT_EN_RPT_TXCRC_8812F BIT(1) -+#define BIT_DIS_RXDMA_STS_8812F BIT(0) -+ -+/* 2 REG_SDIO_HSUS_CTRL_8812F */ -+#define BIT_SPI_PHASE_8812F BIT(5) -+#define BIT_INTR_CTRL_8812F BIT(4) -+#define BIT_SDIO_VOLTAGE_8812F BIT(3) -+#define BIT_BYPASS_INIT_8812F BIT(2) -+#define BIT_HCI_RESUME_RDY_8812F BIT(1) -+#define BIT_HCI_SUS_REQ_8812F BIT(0) -+ -+/* 2 REG_SDIO_RESPONSE_TIMER_8812F */ -+ -+#define BIT_SHIFT_CMDIN_2RESP_TIMER_8812F 0 -+#define BIT_MASK_CMDIN_2RESP_TIMER_8812F 0xffff -+#define BIT_CMDIN_2RESP_TIMER_8812F(x) \ -+ (((x) & BIT_MASK_CMDIN_2RESP_TIMER_8812F) \ -+ << BIT_SHIFT_CMDIN_2RESP_TIMER_8812F) -+#define BITS_CMDIN_2RESP_TIMER_8812F \ -+ (BIT_MASK_CMDIN_2RESP_TIMER_8812F << BIT_SHIFT_CMDIN_2RESP_TIMER_8812F) -+#define BIT_CLEAR_CMDIN_2RESP_TIMER_8812F(x) \ -+ ((x) & (~BITS_CMDIN_2RESP_TIMER_8812F)) -+#define BIT_GET_CMDIN_2RESP_TIMER_8812F(x) \ -+ (((x) >> BIT_SHIFT_CMDIN_2RESP_TIMER_8812F) & \ -+ BIT_MASK_CMDIN_2RESP_TIMER_8812F) -+#define BIT_SET_CMDIN_2RESP_TIMER_8812F(x, v) \ -+ (BIT_CLEAR_CMDIN_2RESP_TIMER_8812F(x) | BIT_CMDIN_2RESP_TIMER_8812F(v)) -+ -+/* 2 REG_SDIO_CMD_CRC_8812F */ -+ -+#define BIT_SHIFT_SDIO_CMD_CRC_V1_8812F 0 -+#define BIT_MASK_SDIO_CMD_CRC_V1_8812F 0xff -+#define BIT_SDIO_CMD_CRC_V1_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_CRC_V1_8812F) \ -+ << BIT_SHIFT_SDIO_CMD_CRC_V1_8812F) -+#define BITS_SDIO_CMD_CRC_V1_8812F \ -+ (BIT_MASK_SDIO_CMD_CRC_V1_8812F << BIT_SHIFT_SDIO_CMD_CRC_V1_8812F) -+#define BIT_CLEAR_SDIO_CMD_CRC_V1_8812F(x) ((x) & (~BITS_SDIO_CMD_CRC_V1_8812F)) -+#define BIT_GET_SDIO_CMD_CRC_V1_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_CRC_V1_8812F) & \ -+ BIT_MASK_SDIO_CMD_CRC_V1_8812F) -+#define BIT_SET_SDIO_CMD_CRC_V1_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_CRC_V1_8812F(x) | BIT_SDIO_CMD_CRC_V1_8812F(v)) -+ -+/* 2 REG_SDIO_HSISR_8812F */ -+#define BIT_DRV_WLAN_INT_CLR_8812F BIT(1) -+#define BIT_DRV_WLAN_INT_8812F BIT(0) -+ -+/* 2 REG_SDIO_HSIMR_8812F */ -+#define BIT_HISR_MASK_8812F BIT(0) -+ -+/* 2 REG_SDIO_DIOERR_RPT_8812F */ -+#define BIT_SDIO_PAGE_ERR_8812F BIT(0) -+ -+/* 2 REG_SDIO_CMD_ERRCNT_8812F */ -+ -+#define BIT_SHIFT_CMD_CRC_ERR_CNT_8812F 0 -+#define BIT_MASK_CMD_CRC_ERR_CNT_8812F 0xff -+#define BIT_CMD_CRC_ERR_CNT_8812F(x) \ -+ (((x) & BIT_MASK_CMD_CRC_ERR_CNT_8812F) \ -+ << BIT_SHIFT_CMD_CRC_ERR_CNT_8812F) -+#define BITS_CMD_CRC_ERR_CNT_8812F \ -+ (BIT_MASK_CMD_CRC_ERR_CNT_8812F << BIT_SHIFT_CMD_CRC_ERR_CNT_8812F) -+#define BIT_CLEAR_CMD_CRC_ERR_CNT_8812F(x) ((x) & (~BITS_CMD_CRC_ERR_CNT_8812F)) -+#define BIT_GET_CMD_CRC_ERR_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_CMD_CRC_ERR_CNT_8812F) & \ -+ BIT_MASK_CMD_CRC_ERR_CNT_8812F) -+#define BIT_SET_CMD_CRC_ERR_CNT_8812F(x, v) \ -+ (BIT_CLEAR_CMD_CRC_ERR_CNT_8812F(x) | BIT_CMD_CRC_ERR_CNT_8812F(v)) -+ -+/* 2 REG_SDIO_DATA_ERRCNT_8812F */ -+ -+#define BIT_SHIFT_DATA_CRC_ERR_CNT_8812F 0 -+#define BIT_MASK_DATA_CRC_ERR_CNT_8812F 0xff -+#define BIT_DATA_CRC_ERR_CNT_8812F(x) \ -+ (((x) & BIT_MASK_DATA_CRC_ERR_CNT_8812F) \ -+ << BIT_SHIFT_DATA_CRC_ERR_CNT_8812F) -+#define BITS_DATA_CRC_ERR_CNT_8812F \ -+ (BIT_MASK_DATA_CRC_ERR_CNT_8812F << BIT_SHIFT_DATA_CRC_ERR_CNT_8812F) -+#define BIT_CLEAR_DATA_CRC_ERR_CNT_8812F(x) \ -+ ((x) & (~BITS_DATA_CRC_ERR_CNT_8812F)) -+#define BIT_GET_DATA_CRC_ERR_CNT_8812F(x) \ -+ (((x) >> BIT_SHIFT_DATA_CRC_ERR_CNT_8812F) & \ -+ BIT_MASK_DATA_CRC_ERR_CNT_8812F) -+#define BIT_SET_DATA_CRC_ERR_CNT_8812F(x, v) \ -+ (BIT_CLEAR_DATA_CRC_ERR_CNT_8812F(x) | BIT_DATA_CRC_ERR_CNT_8812F(v)) -+ -+/* 2 REG_SDIO_CMD_ERR_CONTENT_8812F */ -+ -+#define BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8812F 0 -+#define BIT_MASK_SDIO_CMD_ERR_CONTENT_8812F 0xffffffffffL -+#define BIT_SDIO_CMD_ERR_CONTENT_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_ERR_CONTENT_8812F) \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8812F) -+#define BITS_SDIO_CMD_ERR_CONTENT_8812F \ -+ (BIT_MASK_SDIO_CMD_ERR_CONTENT_8812F \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8812F) -+#define BIT_CLEAR_SDIO_CMD_ERR_CONTENT_8812F(x) \ -+ ((x) & (~BITS_SDIO_CMD_ERR_CONTENT_8812F)) -+#define BIT_GET_SDIO_CMD_ERR_CONTENT_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8812F) & \ -+ BIT_MASK_SDIO_CMD_ERR_CONTENT_8812F) -+#define BIT_SET_SDIO_CMD_ERR_CONTENT_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_ERR_CONTENT_8812F(x) | \ -+ BIT_SDIO_CMD_ERR_CONTENT_8812F(v)) -+ -+/* 2 REG_SDIO_CRC_ERR_IDX_8812F */ -+#define BIT_D3_CRC_ERR_8812F BIT(4) -+#define BIT_D2_CRC_ERR_8812F BIT(3) -+#define BIT_D1_CRC_ERR_8812F BIT(2) -+#define BIT_D0_CRC_ERR_8812F BIT(1) -+#define BIT_CMD_CRC_ERR_8812F BIT(0) -+ -+/* 2 REG_SDIO_DATA_CRC_8812F */ -+ -+#define BIT_SHIFT_SDIO_DATA_CRC_8812F 0 -+#define BIT_MASK_SDIO_DATA_CRC_8812F 0xffff -+#define BIT_SDIO_DATA_CRC_8812F(x) \ -+ (((x) & BIT_MASK_SDIO_DATA_CRC_8812F) << BIT_SHIFT_SDIO_DATA_CRC_8812F) -+#define BITS_SDIO_DATA_CRC_8812F \ -+ (BIT_MASK_SDIO_DATA_CRC_8812F << BIT_SHIFT_SDIO_DATA_CRC_8812F) -+#define BIT_CLEAR_SDIO_DATA_CRC_8812F(x) ((x) & (~BITS_SDIO_DATA_CRC_8812F)) -+#define BIT_GET_SDIO_DATA_CRC_8812F(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DATA_CRC_8812F) & BIT_MASK_SDIO_DATA_CRC_8812F) -+#define BIT_SET_SDIO_DATA_CRC_8812F(x, v) \ -+ (BIT_CLEAR_SDIO_DATA_CRC_8812F(x) | BIT_SDIO_DATA_CRC_8812F(v)) -+ -+/* 2 REG_SDIO_TRANS_FIFO_STATUS_8812F */ -+#define BIT_TRANS_FIFO_UNDERFLOW_8812F BIT(1) -+#define BIT_TRANS_FIFO_OVERFLOW_8812F BIT(0) -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8814b.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8814b.h -new file mode 100644 -index 000000000..e15766c30 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8814b.h -@@ -0,0 +1,26513 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_BIT_8814B_H -+#define __INC_HALMAC_BIT_8814B_H -+ -+#define CPU_OPT_WIDTH 0x1F -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_SYS_ISO_CTRL_8814B */ -+#define BIT_PWC_EV12V_8814B BIT(15) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_PA33V_EN_8814B BIT(13) -+#define BIT_PA12V_EN_8814B BIT(12) -+#define BIT_UA33V_EN_8814B BIT(11) -+#define BIT_UA12V_EN_8814B BIT(10) -+#define BIT_ISO_RFDIO_8814B BIT(9) -+#define BIT_ISO_EB2CORE_8814B BIT(8) -+#define BIT_ISO_DIOE_8814B BIT(7) -+#define BIT_ISO_WLPON2PP_8814B BIT(6) -+#define BIT_ISO_IP2MAC_WA2PP_8814B BIT(5) -+#define BIT_ISO_PD2CORE_8814B BIT(4) -+#define BIT_ISO_PA2PCIE_8814B BIT(3) -+#define BIT_ISO_UD2CORE_8814B BIT(2) -+#define BIT_ISO_UA2USB_8814B BIT(1) -+#define BIT_ISO_WD2PP_8814B BIT(0) -+ -+/* 2 REG_SYS_FUNC_EN_8814B */ -+#define BIT_FEN_MREGEN_8814B BIT(15) -+#define BIT_FEN_HWPDN_8814B BIT(14) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_FEN_ELDR_8814B BIT(12) -+#define BIT_FEN_DCORE_8814B BIT(11) -+#define BIT_FEN_CPUEN_8814B BIT(10) -+#define BIT_FEN_DIOE_8814B BIT(9) -+#define BIT_FEN_PCIED_8814B BIT(8) -+#define BIT_FEN_PPLL_8814B BIT(7) -+#define BIT_FEN_PCIEA_8814B BIT(6) -+#define BIT_FEN_DIO_PCIE_8814B BIT(5) -+#define BIT_FEN_USBD_8814B BIT(4) -+#define BIT_FEN_UPLL_8814B BIT(3) -+#define BIT_FEN_USBA_8814B BIT(2) -+#define BIT_FEN_BB_GLB_RSTN_8814B BIT(1) -+#define BIT_FEN_BBRSTB_8814B BIT(0) -+ -+/* 2 REG_SYS_PW_CTRL_8814B */ -+#define BIT_SOP_EABM_8814B BIT(31) -+#define BIT_SOP_ACKF_8814B BIT(30) -+#define BIT_SOP_ERCK_8814B BIT(29) -+#define BIT_SOP_ESWR_8814B BIT(28) -+#define BIT_SOP_PWMM_8814B BIT(27) -+#define BIT_SOP_EECK_8814B BIT(26) -+#define BIT_SOP_EXTL_8814B BIT(24) -+#define BIT_SYM_OP_RING_12M_8814B BIT(22) -+#define BIT_ROP_SWPR_8814B BIT(21) -+#define BIT_DIS_HW_LPLDM_8814B BIT(20) -+#define BIT_OPT_SWRST_WLMCU_8814B BIT(19) -+#define BIT_RDY_SYSPWR_8814B BIT(17) -+#define BIT_EN_WLON_8814B BIT(16) -+#define BIT_APDM_HPDN_8814B BIT(15) -+#define BIT_AFSM_PCIE_SUS_EN_8814B BIT(12) -+#define BIT_AFSM_WLSUS_EN_8814B BIT(11) -+#define BIT_APFM_SWLPS_8814B BIT(10) -+#define BIT_APFM_OFFMAC_8814B BIT(9) -+#define BIT_APFN_ONMAC_8814B BIT(8) -+#define BIT_CHIP_PDN_EN_8814B BIT(7) -+#define BIT_RDY_MACDIS_8814B BIT(6) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_PFM_WOWL_8814B BIT(3) -+#define BIT_PFM_LDKP_8814B BIT(2) -+#define BIT_WL_HCI_ALD_8814B BIT(1) -+#define BIT_PFM_LDALL_8814B BIT(0) -+ -+/* 2 REG_SYS_CLK_CTRL_8814B */ -+#define BIT_DATA_CPU_CLK_EN_8814B BIT(15) -+#define BIT_CPU_CLK_EN_8814B BIT(14) -+#define BIT_SYMREG_CLK_EN_8814B BIT(13) -+#define BIT_HCI_CLK_EN_8814B BIT(12) -+#define BIT_MAC_CLK_EN_8814B BIT(11) -+#define BIT_SEC_CLK_EN_8814B BIT(10) -+#define BIT_PHY_SSC_RSTB_8814B BIT(9) -+#define BIT_EXT_32K_EN_8814B BIT(8) -+#define BIT_WL_CLK_TEST_8814B BIT(7) -+#define BIT_OP_SPS_PWM_EN_8814B BIT(6) -+#define BIT_LOADER_CLK_EN_8814B BIT(5) -+#define BIT_MACSLP_8814B BIT(4) -+#define BIT_WAKEPAD_EN_8814B BIT(3) -+#define BIT_ROMD16V_EN_8814B BIT(2) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CNTD16V_EN_8814B BIT(0) -+ -+/* 2 REG_SYS_EEPROM_CTRL_8814B */ -+ -+#define BIT_SHIFT_VPDIDX_8814B 8 -+#define BIT_MASK_VPDIDX_8814B 0xff -+#define BIT_VPDIDX_8814B(x) \ -+ (((x) & BIT_MASK_VPDIDX_8814B) << BIT_SHIFT_VPDIDX_8814B) -+#define BITS_VPDIDX_8814B (BIT_MASK_VPDIDX_8814B << BIT_SHIFT_VPDIDX_8814B) -+#define BIT_CLEAR_VPDIDX_8814B(x) ((x) & (~BITS_VPDIDX_8814B)) -+#define BIT_GET_VPDIDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_VPDIDX_8814B) & BIT_MASK_VPDIDX_8814B) -+#define BIT_SET_VPDIDX_8814B(x, v) \ -+ (BIT_CLEAR_VPDIDX_8814B(x) | BIT_VPDIDX_8814B(v)) -+ -+#define BIT_SHIFT_EEM1_0_8814B 6 -+#define BIT_MASK_EEM1_0_8814B 0x3 -+#define BIT_EEM1_0_8814B(x) \ -+ (((x) & BIT_MASK_EEM1_0_8814B) << BIT_SHIFT_EEM1_0_8814B) -+#define BITS_EEM1_0_8814B (BIT_MASK_EEM1_0_8814B << BIT_SHIFT_EEM1_0_8814B) -+#define BIT_CLEAR_EEM1_0_8814B(x) ((x) & (~BITS_EEM1_0_8814B)) -+#define BIT_GET_EEM1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_EEM1_0_8814B) & BIT_MASK_EEM1_0_8814B) -+#define BIT_SET_EEM1_0_8814B(x, v) \ -+ (BIT_CLEAR_EEM1_0_8814B(x) | BIT_EEM1_0_8814B(v)) -+ -+#define BIT_AUTOLOAD_SUS_8814B BIT(5) -+#define BIT_EERPOMSEL_8814B BIT(4) -+#define BIT_EECS_V1_8814B BIT(3) -+#define BIT_EESK_V1_8814B BIT(2) -+#define BIT_EEDI_V1_8814B BIT(1) -+#define BIT_EEDO_V1_8814B BIT(0) -+ -+/* 2 REG_EE_VPD_8814B */ -+ -+#define BIT_SHIFT_VPD_DATA_8814B 0 -+#define BIT_MASK_VPD_DATA_8814B 0xffffffffL -+#define BIT_VPD_DATA_8814B(x) \ -+ (((x) & BIT_MASK_VPD_DATA_8814B) << BIT_SHIFT_VPD_DATA_8814B) -+#define BITS_VPD_DATA_8814B \ -+ (BIT_MASK_VPD_DATA_8814B << BIT_SHIFT_VPD_DATA_8814B) -+#define BIT_CLEAR_VPD_DATA_8814B(x) ((x) & (~BITS_VPD_DATA_8814B)) -+#define BIT_GET_VPD_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_VPD_DATA_8814B) & BIT_MASK_VPD_DATA_8814B) -+#define BIT_SET_VPD_DATA_8814B(x, v) \ -+ (BIT_CLEAR_VPD_DATA_8814B(x) | BIT_VPD_DATA_8814B(v)) -+ -+/* 2 REG_SYS_SWR_CTRL1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CTRL_SPS_PWM_FREQ_8814B BIT(10) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_DISABLE_OPEN_SPS_LDO_8814B BIT(8) -+#define BIT_MAC_ID_EN_8814B BIT(7) -+#define BIT_WL_CTRL_XTAL_CADJ_8814B BIT(6) -+#define BIT_AFE_BGEN_PCIE_OP_8814B BIT(2) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_SYS_SWR_CTRL2_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_SYS_SWR_CTRL3_8814B */ -+#define BIT_SPS18_OCP_DIS_8814B BIT(31) -+ -+#define BIT_SHIFT_SPS18_OCP_TH_8814B 16 -+#define BIT_MASK_SPS18_OCP_TH_8814B 0x7fff -+#define BIT_SPS18_OCP_TH_8814B(x) \ -+ (((x) & BIT_MASK_SPS18_OCP_TH_8814B) << BIT_SHIFT_SPS18_OCP_TH_8814B) -+#define BITS_SPS18_OCP_TH_8814B \ -+ (BIT_MASK_SPS18_OCP_TH_8814B << BIT_SHIFT_SPS18_OCP_TH_8814B) -+#define BIT_CLEAR_SPS18_OCP_TH_8814B(x) ((x) & (~BITS_SPS18_OCP_TH_8814B)) -+#define BIT_GET_SPS18_OCP_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_SPS18_OCP_TH_8814B) & BIT_MASK_SPS18_OCP_TH_8814B) -+#define BIT_SET_SPS18_OCP_TH_8814B(x, v) \ -+ (BIT_CLEAR_SPS18_OCP_TH_8814B(x) | BIT_SPS18_OCP_TH_8814B(v)) -+ -+#define BIT_SHIFT_OCP_WINDOW_8814B 0 -+#define BIT_MASK_OCP_WINDOW_8814B 0xffff -+#define BIT_OCP_WINDOW_8814B(x) \ -+ (((x) & BIT_MASK_OCP_WINDOW_8814B) << BIT_SHIFT_OCP_WINDOW_8814B) -+#define BITS_OCP_WINDOW_8814B \ -+ (BIT_MASK_OCP_WINDOW_8814B << BIT_SHIFT_OCP_WINDOW_8814B) -+#define BIT_CLEAR_OCP_WINDOW_8814B(x) ((x) & (~BITS_OCP_WINDOW_8814B)) -+#define BIT_GET_OCP_WINDOW_8814B(x) \ -+ (((x) >> BIT_SHIFT_OCP_WINDOW_8814B) & BIT_MASK_OCP_WINDOW_8814B) -+#define BIT_SET_OCP_WINDOW_8814B(x, v) \ -+ (BIT_CLEAR_OCP_WINDOW_8814B(x) | BIT_OCP_WINDOW_8814B(v)) -+ -+/* 2 REG_RSV_CTRL_8814B */ -+ -+#define BIT_SHIFT_HREG_DBG_V1_8814B 12 -+#define BIT_MASK_HREG_DBG_V1_8814B 0xfff -+#define BIT_HREG_DBG_V1_8814B(x) \ -+ (((x) & BIT_MASK_HREG_DBG_V1_8814B) << BIT_SHIFT_HREG_DBG_V1_8814B) -+#define BITS_HREG_DBG_V1_8814B \ -+ (BIT_MASK_HREG_DBG_V1_8814B << BIT_SHIFT_HREG_DBG_V1_8814B) -+#define BIT_CLEAR_HREG_DBG_V1_8814B(x) ((x) & (~BITS_HREG_DBG_V1_8814B)) -+#define BIT_GET_HREG_DBG_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_HREG_DBG_V1_8814B) & BIT_MASK_HREG_DBG_V1_8814B) -+#define BIT_SET_HREG_DBG_V1_8814B(x, v) \ -+ (BIT_CLEAR_HREG_DBG_V1_8814B(x) | BIT_HREG_DBG_V1_8814B(v)) -+ -+#define BIT_WLMCUIOIF_8814B BIT(8) -+#define BIT_LOCK_ALL_EN_8814B BIT(7) -+#define BIT_R_DIS_PRST_8814B BIT(6) -+#define BIT_WLOCK_1C_B6_8814B BIT(5) -+#define BIT_WLOCK_40_8814B BIT(4) -+#define BIT_WLOCK_08_8814B BIT(3) -+#define BIT_WLOCK_04_8814B BIT(2) -+#define BIT_WLOCK_00_8814B BIT(1) -+#define BIT_WLOCK_ALL_8814B BIT(0) -+ -+/* 2 REG_RF_CTRL_8814B */ -+#define BIT_RF_SDMRSTB_8814B BIT(2) -+#define BIT_RF_RSTB_8814B BIT(1) -+#define BIT_RF_EN_8814B BIT(0) -+ -+/* 2 REG_AFE_LDO_CTRL_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CPHY_LDO_CL_EN_8814B BIT(19) -+#define BIT_CPHY_LDO_OK_8814B BIT(18) -+#define BIT_PCIE_CALIB_EN_8814B BIT(17) -+#define BIT_LDH12_EN_8814B BIT(16) -+#define BIT_DATA_CPU_PWC_8814B BIT(15) -+#define BIT_WLBBOFF_BIG_PWC_EN_8814B BIT(14) -+#define BIT_WLBBOFF_SMALL_PWC_EN_8814B BIT(13) -+#define BIT_WLMACOFF_BIG_PWC_EN_8814B BIT(12) -+#define BIT_WLPON_PWC_EN_8814B BIT(11) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_LDOV12W_EN_8814B BIT(8) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_AFE_CTRL1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_MAC_CLK_SEL_8814B 20 -+#define BIT_MASK_MAC_CLK_SEL_8814B 0x3 -+#define BIT_MAC_CLK_SEL_8814B(x) \ -+ (((x) & BIT_MASK_MAC_CLK_SEL_8814B) << BIT_SHIFT_MAC_CLK_SEL_8814B) -+#define BITS_MAC_CLK_SEL_8814B \ -+ (BIT_MASK_MAC_CLK_SEL_8814B << BIT_SHIFT_MAC_CLK_SEL_8814B) -+#define BIT_CLEAR_MAC_CLK_SEL_8814B(x) ((x) & (~BITS_MAC_CLK_SEL_8814B)) -+#define BIT_GET_MAC_CLK_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAC_CLK_SEL_8814B) & BIT_MASK_MAC_CLK_SEL_8814B) -+#define BIT_SET_MAC_CLK_SEL_8814B(x, v) \ -+ (BIT_CLEAR_MAC_CLK_SEL_8814B(x) | BIT_MAC_CLK_SEL_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_ANAPARSW_POW_MAC_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_ENB_LDO_DIODE_L_8814B BIT(3) -+#define BIT_POW_LDO15_8814B BIT(2) -+#define BIT_POW_SW_8814B BIT(1) -+#define BIT_POW_LDO14_8814B BIT(0) -+ -+/* 2 REG_ANAPARLDO_POW_MAC_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_LDOE25_POW_L_8814B BIT(0) -+ -+/* 2 REG_ANAPAR_POW_MAC_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_POW_PC_LDO3_8814B BIT(5) -+#define BIT_POW_PC_LDO2_8814B BIT(4) -+#define BIT_POW_PC_LDO1_8814B BIT(3) -+#define BIT_POW_PC_LDO0_8814B BIT(2) -+#define BIT_POW_PLL_V1_8814B BIT(1) -+#define BIT_POW_POWER_CUT_8814B BIT(0) -+ -+/* 2 REG_ANAPAR_POW_XTAL_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_POW_XTAL_8814B BIT(1) -+#define BIT_POW_BG_8814B BIT(0) -+ -+/* 2 REG_ANAPARLDO_MAC_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_EFUSE_CTRL_8814B */ -+#define BIT_EF_FLAG_8814B BIT(31) -+ -+#define BIT_SHIFT_EF_PGPD_8814B 28 -+#define BIT_MASK_EF_PGPD_8814B 0x7 -+#define BIT_EF_PGPD_8814B(x) \ -+ (((x) & BIT_MASK_EF_PGPD_8814B) << BIT_SHIFT_EF_PGPD_8814B) -+#define BITS_EF_PGPD_8814B (BIT_MASK_EF_PGPD_8814B << BIT_SHIFT_EF_PGPD_8814B) -+#define BIT_CLEAR_EF_PGPD_8814B(x) ((x) & (~BITS_EF_PGPD_8814B)) -+#define BIT_GET_EF_PGPD_8814B(x) \ -+ (((x) >> BIT_SHIFT_EF_PGPD_8814B) & BIT_MASK_EF_PGPD_8814B) -+#define BIT_SET_EF_PGPD_8814B(x, v) \ -+ (BIT_CLEAR_EF_PGPD_8814B(x) | BIT_EF_PGPD_8814B(v)) -+ -+#define BIT_SHIFT_EF_RDT_8814B 24 -+#define BIT_MASK_EF_RDT_8814B 0xf -+#define BIT_EF_RDT_8814B(x) \ -+ (((x) & BIT_MASK_EF_RDT_8814B) << BIT_SHIFT_EF_RDT_8814B) -+#define BITS_EF_RDT_8814B (BIT_MASK_EF_RDT_8814B << BIT_SHIFT_EF_RDT_8814B) -+#define BIT_CLEAR_EF_RDT_8814B(x) ((x) & (~BITS_EF_RDT_8814B)) -+#define BIT_GET_EF_RDT_8814B(x) \ -+ (((x) >> BIT_SHIFT_EF_RDT_8814B) & BIT_MASK_EF_RDT_8814B) -+#define BIT_SET_EF_RDT_8814B(x, v) \ -+ (BIT_CLEAR_EF_RDT_8814B(x) | BIT_EF_RDT_8814B(v)) -+ -+#define BIT_SHIFT_EF_PGTS_8814B 20 -+#define BIT_MASK_EF_PGTS_8814B 0xf -+#define BIT_EF_PGTS_8814B(x) \ -+ (((x) & BIT_MASK_EF_PGTS_8814B) << BIT_SHIFT_EF_PGTS_8814B) -+#define BITS_EF_PGTS_8814B (BIT_MASK_EF_PGTS_8814B << BIT_SHIFT_EF_PGTS_8814B) -+#define BIT_CLEAR_EF_PGTS_8814B(x) ((x) & (~BITS_EF_PGTS_8814B)) -+#define BIT_GET_EF_PGTS_8814B(x) \ -+ (((x) >> BIT_SHIFT_EF_PGTS_8814B) & BIT_MASK_EF_PGTS_8814B) -+#define BIT_SET_EF_PGTS_8814B(x, v) \ -+ (BIT_CLEAR_EF_PGTS_8814B(x) | BIT_EF_PGTS_8814B(v)) -+ -+#define BIT_EF_PDWN_8814B BIT(19) -+#define BIT_EF_ALDEN_8814B BIT(18) -+ -+#define BIT_SHIFT_EF_ADDR_8814B 8 -+#define BIT_MASK_EF_ADDR_8814B 0x3ff -+#define BIT_EF_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_EF_ADDR_8814B) << BIT_SHIFT_EF_ADDR_8814B) -+#define BITS_EF_ADDR_8814B (BIT_MASK_EF_ADDR_8814B << BIT_SHIFT_EF_ADDR_8814B) -+#define BIT_CLEAR_EF_ADDR_8814B(x) ((x) & (~BITS_EF_ADDR_8814B)) -+#define BIT_GET_EF_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_EF_ADDR_8814B) & BIT_MASK_EF_ADDR_8814B) -+#define BIT_SET_EF_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_EF_ADDR_8814B(x) | BIT_EF_ADDR_8814B(v)) -+ -+#define BIT_SHIFT_EF_DATA_8814B 0 -+#define BIT_MASK_EF_DATA_8814B 0xff -+#define BIT_EF_DATA_8814B(x) \ -+ (((x) & BIT_MASK_EF_DATA_8814B) << BIT_SHIFT_EF_DATA_8814B) -+#define BITS_EF_DATA_8814B (BIT_MASK_EF_DATA_8814B << BIT_SHIFT_EF_DATA_8814B) -+#define BIT_CLEAR_EF_DATA_8814B(x) ((x) & (~BITS_EF_DATA_8814B)) -+#define BIT_GET_EF_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_EF_DATA_8814B) & BIT_MASK_EF_DATA_8814B) -+#define BIT_SET_EF_DATA_8814B(x, v) \ -+ (BIT_CLEAR_EF_DATA_8814B(x) | BIT_EF_DATA_8814B(v)) -+ -+/* 2 REG_LDO_EFUSE_CTRL_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_EF_CRES_SEL_8814B BIT(26) -+ -+#define BIT_SHIFT_EF_SCAN_START_V1_8814B 16 -+#define BIT_MASK_EF_SCAN_START_V1_8814B 0x3ff -+#define BIT_EF_SCAN_START_V1_8814B(x) \ -+ (((x) & BIT_MASK_EF_SCAN_START_V1_8814B) \ -+ << BIT_SHIFT_EF_SCAN_START_V1_8814B) -+#define BITS_EF_SCAN_START_V1_8814B \ -+ (BIT_MASK_EF_SCAN_START_V1_8814B << BIT_SHIFT_EF_SCAN_START_V1_8814B) -+#define BIT_CLEAR_EF_SCAN_START_V1_8814B(x) \ -+ ((x) & (~BITS_EF_SCAN_START_V1_8814B)) -+#define BIT_GET_EF_SCAN_START_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_START_V1_8814B) & \ -+ BIT_MASK_EF_SCAN_START_V1_8814B) -+#define BIT_SET_EF_SCAN_START_V1_8814B(x, v) \ -+ (BIT_CLEAR_EF_SCAN_START_V1_8814B(x) | BIT_EF_SCAN_START_V1_8814B(v)) -+ -+#define BIT_SHIFT_EF_SCAN_END_8814B 12 -+#define BIT_MASK_EF_SCAN_END_8814B 0xf -+#define BIT_EF_SCAN_END_8814B(x) \ -+ (((x) & BIT_MASK_EF_SCAN_END_8814B) << BIT_SHIFT_EF_SCAN_END_8814B) -+#define BITS_EF_SCAN_END_8814B \ -+ (BIT_MASK_EF_SCAN_END_8814B << BIT_SHIFT_EF_SCAN_END_8814B) -+#define BIT_CLEAR_EF_SCAN_END_8814B(x) ((x) & (~BITS_EF_SCAN_END_8814B)) -+#define BIT_GET_EF_SCAN_END_8814B(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_END_8814B) & BIT_MASK_EF_SCAN_END_8814B) -+#define BIT_SET_EF_SCAN_END_8814B(x, v) \ -+ (BIT_CLEAR_EF_SCAN_END_8814B(x) | BIT_EF_SCAN_END_8814B(v)) -+ -+#define BIT_EF_PD_DIS_8814B BIT(11) -+ -+#define BIT_SHIFT_EF_CELL_SEL_8814B 8 -+#define BIT_MASK_EF_CELL_SEL_8814B 0x3 -+#define BIT_EF_CELL_SEL_8814B(x) \ -+ (((x) & BIT_MASK_EF_CELL_SEL_8814B) << BIT_SHIFT_EF_CELL_SEL_8814B) -+#define BITS_EF_CELL_SEL_8814B \ -+ (BIT_MASK_EF_CELL_SEL_8814B << BIT_SHIFT_EF_CELL_SEL_8814B) -+#define BIT_CLEAR_EF_CELL_SEL_8814B(x) ((x) & (~BITS_EF_CELL_SEL_8814B)) -+#define BIT_GET_EF_CELL_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_EF_CELL_SEL_8814B) & BIT_MASK_EF_CELL_SEL_8814B) -+#define BIT_SET_EF_CELL_SEL_8814B(x, v) \ -+ (BIT_CLEAR_EF_CELL_SEL_8814B(x) | BIT_EF_CELL_SEL_8814B(v)) -+ -+#define BIT_EF_TRPT_8814B BIT(7) -+ -+#define BIT_SHIFT_EF_TTHD_8814B 0 -+#define BIT_MASK_EF_TTHD_8814B 0x7f -+#define BIT_EF_TTHD_8814B(x) \ -+ (((x) & BIT_MASK_EF_TTHD_8814B) << BIT_SHIFT_EF_TTHD_8814B) -+#define BITS_EF_TTHD_8814B (BIT_MASK_EF_TTHD_8814B << BIT_SHIFT_EF_TTHD_8814B) -+#define BIT_CLEAR_EF_TTHD_8814B(x) ((x) & (~BITS_EF_TTHD_8814B)) -+#define BIT_GET_EF_TTHD_8814B(x) \ -+ (((x) >> BIT_SHIFT_EF_TTHD_8814B) & BIT_MASK_EF_TTHD_8814B) -+#define BIT_SET_EF_TTHD_8814B(x, v) \ -+ (BIT_CLEAR_EF_TTHD_8814B(x) | BIT_EF_TTHD_8814B(v)) -+ -+/* 2 REG_PWR_OPTION_CTRL_8814B */ -+ -+#define BIT_SHIFT_DBG_SEL_V1_8814B 16 -+#define BIT_MASK_DBG_SEL_V1_8814B 0xff -+#define BIT_DBG_SEL_V1_8814B(x) \ -+ (((x) & BIT_MASK_DBG_SEL_V1_8814B) << BIT_SHIFT_DBG_SEL_V1_8814B) -+#define BITS_DBG_SEL_V1_8814B \ -+ (BIT_MASK_DBG_SEL_V1_8814B << BIT_SHIFT_DBG_SEL_V1_8814B) -+#define BIT_CLEAR_DBG_SEL_V1_8814B(x) ((x) & (~BITS_DBG_SEL_V1_8814B)) -+#define BIT_GET_DBG_SEL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_V1_8814B) & BIT_MASK_DBG_SEL_V1_8814B) -+#define BIT_SET_DBG_SEL_V1_8814B(x, v) \ -+ (BIT_CLEAR_DBG_SEL_V1_8814B(x) | BIT_DBG_SEL_V1_8814B(v)) -+ -+#define BIT_SHIFT_DBG_SEL_BYTE_8814B 14 -+#define BIT_MASK_DBG_SEL_BYTE_8814B 0x3 -+#define BIT_DBG_SEL_BYTE_8814B(x) \ -+ (((x) & BIT_MASK_DBG_SEL_BYTE_8814B) << BIT_SHIFT_DBG_SEL_BYTE_8814B) -+#define BITS_DBG_SEL_BYTE_8814B \ -+ (BIT_MASK_DBG_SEL_BYTE_8814B << BIT_SHIFT_DBG_SEL_BYTE_8814B) -+#define BIT_CLEAR_DBG_SEL_BYTE_8814B(x) ((x) & (~BITS_DBG_SEL_BYTE_8814B)) -+#define BIT_GET_DBG_SEL_BYTE_8814B(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_BYTE_8814B) & BIT_MASK_DBG_SEL_BYTE_8814B) -+#define BIT_SET_DBG_SEL_BYTE_8814B(x, v) \ -+ (BIT_CLEAR_DBG_SEL_BYTE_8814B(x) | BIT_DBG_SEL_BYTE_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_SYSON_DBG_PAD_E2_8814B BIT(11) -+#define BIT_SYSON_LED_PAD_E2_8814B BIT(10) -+#define BIT_SYSON_GPEE_PAD_E2_8814B BIT(9) -+#define BIT_SYSON_PCI_PAD_E2_8814B BIT(8) -+#define BIT_AUTO_SW_LDO_VOL_EN_8814B BIT(7) -+ -+#define BIT_SHIFT_SYSON_SPS0WWV_WT_8814B 4 -+#define BIT_MASK_SYSON_SPS0WWV_WT_8814B 0x3 -+#define BIT_SYSON_SPS0WWV_WT_8814B(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0WWV_WT_8814B) \ -+ << BIT_SHIFT_SYSON_SPS0WWV_WT_8814B) -+#define BITS_SYSON_SPS0WWV_WT_8814B \ -+ (BIT_MASK_SYSON_SPS0WWV_WT_8814B << BIT_SHIFT_SYSON_SPS0WWV_WT_8814B) -+#define BIT_CLEAR_SYSON_SPS0WWV_WT_8814B(x) \ -+ ((x) & (~BITS_SYSON_SPS0WWV_WT_8814B)) -+#define BIT_GET_SYSON_SPS0WWV_WT_8814B(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0WWV_WT_8814B) & \ -+ BIT_MASK_SYSON_SPS0WWV_WT_8814B) -+#define BIT_SET_SYSON_SPS0WWV_WT_8814B(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0WWV_WT_8814B(x) | BIT_SYSON_SPS0WWV_WT_8814B(v)) -+ -+#define BIT_SHIFT_SYSON_SPS0LDO_WT_8814B 2 -+#define BIT_MASK_SYSON_SPS0LDO_WT_8814B 0x3 -+#define BIT_SYSON_SPS0LDO_WT_8814B(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0LDO_WT_8814B) \ -+ << BIT_SHIFT_SYSON_SPS0LDO_WT_8814B) -+#define BITS_SYSON_SPS0LDO_WT_8814B \ -+ (BIT_MASK_SYSON_SPS0LDO_WT_8814B << BIT_SHIFT_SYSON_SPS0LDO_WT_8814B) -+#define BIT_CLEAR_SYSON_SPS0LDO_WT_8814B(x) \ -+ ((x) & (~BITS_SYSON_SPS0LDO_WT_8814B)) -+#define BIT_GET_SYSON_SPS0LDO_WT_8814B(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0LDO_WT_8814B) & \ -+ BIT_MASK_SYSON_SPS0LDO_WT_8814B) -+#define BIT_SET_SYSON_SPS0LDO_WT_8814B(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0LDO_WT_8814B(x) | BIT_SYSON_SPS0LDO_WT_8814B(v)) -+ -+#define BIT_SHIFT_SYSON_RCLK_SCALE_8814B 0 -+#define BIT_MASK_SYSON_RCLK_SCALE_8814B 0x3 -+#define BIT_SYSON_RCLK_SCALE_8814B(x) \ -+ (((x) & BIT_MASK_SYSON_RCLK_SCALE_8814B) \ -+ << BIT_SHIFT_SYSON_RCLK_SCALE_8814B) -+#define BITS_SYSON_RCLK_SCALE_8814B \ -+ (BIT_MASK_SYSON_RCLK_SCALE_8814B << BIT_SHIFT_SYSON_RCLK_SCALE_8814B) -+#define BIT_CLEAR_SYSON_RCLK_SCALE_8814B(x) \ -+ ((x) & (~BITS_SYSON_RCLK_SCALE_8814B)) -+#define BIT_GET_SYSON_RCLK_SCALE_8814B(x) \ -+ (((x) >> BIT_SHIFT_SYSON_RCLK_SCALE_8814B) & \ -+ BIT_MASK_SYSON_RCLK_SCALE_8814B) -+#define BIT_SET_SYSON_RCLK_SCALE_8814B(x, v) \ -+ (BIT_CLEAR_SYSON_RCLK_SCALE_8814B(x) | BIT_SYSON_RCLK_SCALE_8814B(v)) -+ -+/* 2 REG_CAL_TIMER_8814B */ -+ -+#define BIT_SHIFT_MATCH_CNT_8814B 8 -+#define BIT_MASK_MATCH_CNT_8814B 0xff -+#define BIT_MATCH_CNT_8814B(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8814B) << BIT_SHIFT_MATCH_CNT_8814B) -+#define BITS_MATCH_CNT_8814B \ -+ (BIT_MASK_MATCH_CNT_8814B << BIT_SHIFT_MATCH_CNT_8814B) -+#define BIT_CLEAR_MATCH_CNT_8814B(x) ((x) & (~BITS_MATCH_CNT_8814B)) -+#define BIT_GET_MATCH_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8814B) & BIT_MASK_MATCH_CNT_8814B) -+#define BIT_SET_MATCH_CNT_8814B(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8814B(x) | BIT_MATCH_CNT_8814B(v)) -+ -+#define BIT_SHIFT_CAL_SCAL_8814B 0 -+#define BIT_MASK_CAL_SCAL_8814B 0xff -+#define BIT_CAL_SCAL_8814B(x) \ -+ (((x) & BIT_MASK_CAL_SCAL_8814B) << BIT_SHIFT_CAL_SCAL_8814B) -+#define BITS_CAL_SCAL_8814B \ -+ (BIT_MASK_CAL_SCAL_8814B << BIT_SHIFT_CAL_SCAL_8814B) -+#define BIT_CLEAR_CAL_SCAL_8814B(x) ((x) & (~BITS_CAL_SCAL_8814B)) -+#define BIT_GET_CAL_SCAL_8814B(x) \ -+ (((x) >> BIT_SHIFT_CAL_SCAL_8814B) & BIT_MASK_CAL_SCAL_8814B) -+#define BIT_SET_CAL_SCAL_8814B(x, v) \ -+ (BIT_CLEAR_CAL_SCAL_8814B(x) | BIT_CAL_SCAL_8814B(v)) -+ -+/* 2 REG_ACLK_MON_8814B */ -+ -+#define BIT_SHIFT_RCLK_MON_8814B 5 -+#define BIT_MASK_RCLK_MON_8814B 0x7ff -+#define BIT_RCLK_MON_8814B(x) \ -+ (((x) & BIT_MASK_RCLK_MON_8814B) << BIT_SHIFT_RCLK_MON_8814B) -+#define BITS_RCLK_MON_8814B \ -+ (BIT_MASK_RCLK_MON_8814B << BIT_SHIFT_RCLK_MON_8814B) -+#define BIT_CLEAR_RCLK_MON_8814B(x) ((x) & (~BITS_RCLK_MON_8814B)) -+#define BIT_GET_RCLK_MON_8814B(x) \ -+ (((x) >> BIT_SHIFT_RCLK_MON_8814B) & BIT_MASK_RCLK_MON_8814B) -+#define BIT_SET_RCLK_MON_8814B(x, v) \ -+ (BIT_CLEAR_RCLK_MON_8814B(x) | BIT_RCLK_MON_8814B(v)) -+ -+#define BIT_CAL_EN_8814B BIT(4) -+ -+#define BIT_SHIFT_DPSTU_8814B 2 -+#define BIT_MASK_DPSTU_8814B 0x3 -+#define BIT_DPSTU_8814B(x) \ -+ (((x) & BIT_MASK_DPSTU_8814B) << BIT_SHIFT_DPSTU_8814B) -+#define BITS_DPSTU_8814B (BIT_MASK_DPSTU_8814B << BIT_SHIFT_DPSTU_8814B) -+#define BIT_CLEAR_DPSTU_8814B(x) ((x) & (~BITS_DPSTU_8814B)) -+#define BIT_GET_DPSTU_8814B(x) \ -+ (((x) >> BIT_SHIFT_DPSTU_8814B) & BIT_MASK_DPSTU_8814B) -+#define BIT_SET_DPSTU_8814B(x, v) \ -+ (BIT_CLEAR_DPSTU_8814B(x) | BIT_DPSTU_8814B(v)) -+ -+#define BIT_SUS_16X_8814B BIT(1) -+ -+/* 2 REG_GPIO_MUXCFG_8814B */ -+#define BIT_EN_DATACPU_GPIO2_8814B BIT(24) -+#define BIT_EN_DATACPU_GPIO_8814B BIT(23) -+#define BIT_EN_DATACPU_UART_8814B BIT(22) -+#define BIT_DATACPU_FSPI_EN_8814B BIT(21) -+#define BIT_EN_GPIO8_UART_OUT_8814B BIT(20) -+#define BIT_FSPI_EN_8814B BIT(19) -+#define BIT_WL_RTS_EXT_32K_SEL_8814B BIT(18) -+#define BIT_WLGP_SPI_EN_8814B BIT(16) -+#define BIT_SIC_LBK_8814B BIT(15) -+#define BIT_ENHTP_8814B BIT(14) -+#define BIT_ENSIC_8814B BIT(12) -+#define BIT_SIC_SWRST_8814B BIT(11) -+#define BIT_PO_WIFI_PTA_PINS_8814B BIT(10) -+#define BIT_PO_BT_PTA_PINS_8814B BIT(9) -+#define BIT_ENUART_8814B BIT(8) -+ -+#define BIT_SHIFT_BTMODE_8814B 6 -+#define BIT_MASK_BTMODE_8814B 0x3 -+#define BIT_BTMODE_8814B(x) \ -+ (((x) & BIT_MASK_BTMODE_8814B) << BIT_SHIFT_BTMODE_8814B) -+#define BITS_BTMODE_8814B (BIT_MASK_BTMODE_8814B << BIT_SHIFT_BTMODE_8814B) -+#define BIT_CLEAR_BTMODE_8814B(x) ((x) & (~BITS_BTMODE_8814B)) -+#define BIT_GET_BTMODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_BTMODE_8814B) & BIT_MASK_BTMODE_8814B) -+#define BIT_SET_BTMODE_8814B(x, v) \ -+ (BIT_CLEAR_BTMODE_8814B(x) | BIT_BTMODE_8814B(v)) -+ -+#define BIT_ENBT_8814B BIT(5) -+#define BIT_EROM_EN_8814B BIT(4) -+#define BIT_WLRFE_6_7_EN_8814B BIT(3) -+#define BIT_WLRFE_4_5_EN_8814B BIT(2) -+ -+#define BIT_SHIFT_GPIOSEL_8814B 0 -+#define BIT_MASK_GPIOSEL_8814B 0x3 -+#define BIT_GPIOSEL_8814B(x) \ -+ (((x) & BIT_MASK_GPIOSEL_8814B) << BIT_SHIFT_GPIOSEL_8814B) -+#define BITS_GPIOSEL_8814B (BIT_MASK_GPIOSEL_8814B << BIT_SHIFT_GPIOSEL_8814B) -+#define BIT_CLEAR_GPIOSEL_8814B(x) ((x) & (~BITS_GPIOSEL_8814B)) -+#define BIT_GET_GPIOSEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_GPIOSEL_8814B) & BIT_MASK_GPIOSEL_8814B) -+#define BIT_SET_GPIOSEL_8814B(x, v) \ -+ (BIT_CLEAR_GPIOSEL_8814B(x) | BIT_GPIOSEL_8814B(v)) -+ -+/* 2 REG_GPIO_PIN_CTRL_8814B */ -+ -+#define BIT_SHIFT_GPIO_MOD_7_TO_0_8814B 24 -+#define BIT_MASK_GPIO_MOD_7_TO_0_8814B 0xff -+#define BIT_GPIO_MOD_7_TO_0_8814B(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_7_TO_0_8814B) \ -+ << BIT_SHIFT_GPIO_MOD_7_TO_0_8814B) -+#define BITS_GPIO_MOD_7_TO_0_8814B \ -+ (BIT_MASK_GPIO_MOD_7_TO_0_8814B << BIT_SHIFT_GPIO_MOD_7_TO_0_8814B) -+#define BIT_CLEAR_GPIO_MOD_7_TO_0_8814B(x) ((x) & (~BITS_GPIO_MOD_7_TO_0_8814B)) -+#define BIT_GET_GPIO_MOD_7_TO_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_7_TO_0_8814B) & \ -+ BIT_MASK_GPIO_MOD_7_TO_0_8814B) -+#define BIT_SET_GPIO_MOD_7_TO_0_8814B(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_7_TO_0_8814B(x) | BIT_GPIO_MOD_7_TO_0_8814B(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8814B 16 -+#define BIT_MASK_GPIO_IO_SEL_7_TO_0_8814B 0xff -+#define BIT_GPIO_IO_SEL_7_TO_0_8814B(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_7_TO_0_8814B) \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8814B) -+#define BITS_GPIO_IO_SEL_7_TO_0_8814B \ -+ (BIT_MASK_GPIO_IO_SEL_7_TO_0_8814B \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8814B) -+#define BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8814B(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_7_TO_0_8814B)) -+#define BIT_GET_GPIO_IO_SEL_7_TO_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8814B) & \ -+ BIT_MASK_GPIO_IO_SEL_7_TO_0_8814B) -+#define BIT_SET_GPIO_IO_SEL_7_TO_0_8814B(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8814B(x) | \ -+ BIT_GPIO_IO_SEL_7_TO_0_8814B(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_7_TO_0_8814B 8 -+#define BIT_MASK_GPIO_OUT_7_TO_0_8814B 0xff -+#define BIT_GPIO_OUT_7_TO_0_8814B(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_7_TO_0_8814B) \ -+ << BIT_SHIFT_GPIO_OUT_7_TO_0_8814B) -+#define BITS_GPIO_OUT_7_TO_0_8814B \ -+ (BIT_MASK_GPIO_OUT_7_TO_0_8814B << BIT_SHIFT_GPIO_OUT_7_TO_0_8814B) -+#define BIT_CLEAR_GPIO_OUT_7_TO_0_8814B(x) ((x) & (~BITS_GPIO_OUT_7_TO_0_8814B)) -+#define BIT_GET_GPIO_OUT_7_TO_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_7_TO_0_8814B) & \ -+ BIT_MASK_GPIO_OUT_7_TO_0_8814B) -+#define BIT_SET_GPIO_OUT_7_TO_0_8814B(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_7_TO_0_8814B(x) | BIT_GPIO_OUT_7_TO_0_8814B(v)) -+ -+#define BIT_SHIFT_GPIO_IN_7_TO_0_8814B 0 -+#define BIT_MASK_GPIO_IN_7_TO_0_8814B 0xff -+#define BIT_GPIO_IN_7_TO_0_8814B(x) \ -+ (((x) & BIT_MASK_GPIO_IN_7_TO_0_8814B) \ -+ << BIT_SHIFT_GPIO_IN_7_TO_0_8814B) -+#define BITS_GPIO_IN_7_TO_0_8814B \ -+ (BIT_MASK_GPIO_IN_7_TO_0_8814B << BIT_SHIFT_GPIO_IN_7_TO_0_8814B) -+#define BIT_CLEAR_GPIO_IN_7_TO_0_8814B(x) ((x) & (~BITS_GPIO_IN_7_TO_0_8814B)) -+#define BIT_GET_GPIO_IN_7_TO_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_7_TO_0_8814B) & \ -+ BIT_MASK_GPIO_IN_7_TO_0_8814B) -+#define BIT_SET_GPIO_IN_7_TO_0_8814B(x, v) \ -+ (BIT_CLEAR_GPIO_IN_7_TO_0_8814B(x) | BIT_GPIO_IN_7_TO_0_8814B(v)) -+ -+/* 2 REG_GPIO_INTM_8814B */ -+ -+#define BIT_SHIFT_MUXDBG_SEL_8814B 30 -+#define BIT_MASK_MUXDBG_SEL_8814B 0x3 -+#define BIT_MUXDBG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_MUXDBG_SEL_8814B) << BIT_SHIFT_MUXDBG_SEL_8814B) -+#define BITS_MUXDBG_SEL_8814B \ -+ (BIT_MASK_MUXDBG_SEL_8814B << BIT_SHIFT_MUXDBG_SEL_8814B) -+#define BIT_CLEAR_MUXDBG_SEL_8814B(x) ((x) & (~BITS_MUXDBG_SEL_8814B)) -+#define BIT_GET_MUXDBG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_MUXDBG_SEL_8814B) & BIT_MASK_MUXDBG_SEL_8814B) -+#define BIT_SET_MUXDBG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_MUXDBG_SEL_8814B(x) | BIT_MUXDBG_SEL_8814B(v)) -+ -+#define BIT_EXTWOL_SEL_8814B BIT(17) -+#define BIT_EXTWOL_EN_8814B BIT(16) -+#define BIT_GPIOF_INT_MD_8814B BIT(15) -+#define BIT_GPIOE_INT_MD_8814B BIT(14) -+#define BIT_GPIOD_INT_MD_8814B BIT(13) -+#define BIT_GPIOF_INT_MD_8814B BIT(15) -+#define BIT_GPIOE_INT_MD_8814B BIT(14) -+#define BIT_GPIOD_INT_MD_8814B BIT(13) -+#define BIT_GPIOC_INT_MD_8814B BIT(12) -+#define BIT_GPIOB_INT_MD_8814B BIT(11) -+#define BIT_GPIOA_INT_MD_8814B BIT(10) -+#define BIT_GPIO9_INT_MD_8814B BIT(9) -+#define BIT_GPIO8_INT_MD_8814B BIT(8) -+#define BIT_GPIO7_INT_MD_8814B BIT(7) -+#define BIT_GPIO6_INT_MD_8814B BIT(6) -+#define BIT_GPIO5_INT_MD_8814B BIT(5) -+#define BIT_GPIO4_INT_MD_8814B BIT(4) -+#define BIT_GPIO3_INT_MD_8814B BIT(3) -+#define BIT_GPIO2_INT_MD_8814B BIT(2) -+#define BIT_GPIO1_INT_MD_8814B BIT(1) -+#define BIT_GPIO0_INT_MD_8814B BIT(0) -+ -+/* 2 REG_LED_CFG_8814B */ -+#define BIT_GPIO3_WL_CTRL_EN_8814B BIT(27) -+#define BIT_LNAON_SEL_EN_8814B BIT(26) -+#define BIT_PAPE_SEL_EN_8814B BIT(25) -+#define BIT_DPDT_WLBT_SEL_8814B BIT(24) -+#define BIT_DPDT_SEL_EN_8814B BIT(23) -+#define BIT_GPIO13_14_WL_CTRL_EN_8814B BIT(22) -+#define BIT_LED2DIS_8814B BIT(21) -+#define BIT_LED2PL_8814B BIT(20) -+#define BIT_LED2SV_8814B BIT(19) -+ -+#define BIT_SHIFT_LED2CM_8814B 16 -+#define BIT_MASK_LED2CM_8814B 0x7 -+#define BIT_LED2CM_8814B(x) \ -+ (((x) & BIT_MASK_LED2CM_8814B) << BIT_SHIFT_LED2CM_8814B) -+#define BITS_LED2CM_8814B (BIT_MASK_LED2CM_8814B << BIT_SHIFT_LED2CM_8814B) -+#define BIT_CLEAR_LED2CM_8814B(x) ((x) & (~BITS_LED2CM_8814B)) -+#define BIT_GET_LED2CM_8814B(x) \ -+ (((x) >> BIT_SHIFT_LED2CM_8814B) & BIT_MASK_LED2CM_8814B) -+#define BIT_SET_LED2CM_8814B(x, v) \ -+ (BIT_CLEAR_LED2CM_8814B(x) | BIT_LED2CM_8814B(v)) -+ -+#define BIT_LED1DIS_8814B BIT(15) -+#define BIT_LED1PL_8814B BIT(12) -+#define BIT_LED1SV_8814B BIT(11) -+ -+#define BIT_SHIFT_LED1CM_8814B 8 -+#define BIT_MASK_LED1CM_8814B 0x7 -+#define BIT_LED1CM_8814B(x) \ -+ (((x) & BIT_MASK_LED1CM_8814B) << BIT_SHIFT_LED1CM_8814B) -+#define BITS_LED1CM_8814B (BIT_MASK_LED1CM_8814B << BIT_SHIFT_LED1CM_8814B) -+#define BIT_CLEAR_LED1CM_8814B(x) ((x) & (~BITS_LED1CM_8814B)) -+#define BIT_GET_LED1CM_8814B(x) \ -+ (((x) >> BIT_SHIFT_LED1CM_8814B) & BIT_MASK_LED1CM_8814B) -+#define BIT_SET_LED1CM_8814B(x, v) \ -+ (BIT_CLEAR_LED1CM_8814B(x) | BIT_LED1CM_8814B(v)) -+ -+#define BIT_LED0DIS_8814B BIT(7) -+ -+#define BIT_SHIFT_AFE_LDO_SWR_CHECK_8814B 5 -+#define BIT_MASK_AFE_LDO_SWR_CHECK_8814B 0x3 -+#define BIT_AFE_LDO_SWR_CHECK_8814B(x) \ -+ (((x) & BIT_MASK_AFE_LDO_SWR_CHECK_8814B) \ -+ << BIT_SHIFT_AFE_LDO_SWR_CHECK_8814B) -+#define BITS_AFE_LDO_SWR_CHECK_8814B \ -+ (BIT_MASK_AFE_LDO_SWR_CHECK_8814B << BIT_SHIFT_AFE_LDO_SWR_CHECK_8814B) -+#define BIT_CLEAR_AFE_LDO_SWR_CHECK_8814B(x) \ -+ ((x) & (~BITS_AFE_LDO_SWR_CHECK_8814B)) -+#define BIT_GET_AFE_LDO_SWR_CHECK_8814B(x) \ -+ (((x) >> BIT_SHIFT_AFE_LDO_SWR_CHECK_8814B) & \ -+ BIT_MASK_AFE_LDO_SWR_CHECK_8814B) -+#define BIT_SET_AFE_LDO_SWR_CHECK_8814B(x, v) \ -+ (BIT_CLEAR_AFE_LDO_SWR_CHECK_8814B(x) | BIT_AFE_LDO_SWR_CHECK_8814B(v)) -+ -+#define BIT_LED0PL_8814B BIT(4) -+#define BIT_LED0SV_8814B BIT(3) -+ -+#define BIT_SHIFT_LED0CM_8814B 0 -+#define BIT_MASK_LED0CM_8814B 0x7 -+#define BIT_LED0CM_8814B(x) \ -+ (((x) & BIT_MASK_LED0CM_8814B) << BIT_SHIFT_LED0CM_8814B) -+#define BITS_LED0CM_8814B (BIT_MASK_LED0CM_8814B << BIT_SHIFT_LED0CM_8814B) -+#define BIT_CLEAR_LED0CM_8814B(x) ((x) & (~BITS_LED0CM_8814B)) -+#define BIT_GET_LED0CM_8814B(x) \ -+ (((x) >> BIT_SHIFT_LED0CM_8814B) & BIT_MASK_LED0CM_8814B) -+#define BIT_SET_LED0CM_8814B(x, v) \ -+ (BIT_CLEAR_LED0CM_8814B(x) | BIT_LED0CM_8814B(v)) -+ -+/* 2 REG_FSIMR_8814B */ -+#define BIT_FS_PDNINT_EN_8814B BIT(31) -+#define BIT_NFC_INT_PAD_EN_8814B BIT(30) -+#define BIT_FS_SPS_OCP_INT_EN_8814B BIT(29) -+#define BIT_FS_PWMERR_INT_EN_8814B BIT(28) -+#define BIT_FS_GPIOF_INT_EN_8814B BIT(27) -+#define BIT_FS_GPIOE_INT_EN_8814B BIT(26) -+#define BIT_FS_GPIOD_INT_EN_8814B BIT(25) -+#define BIT_FS_GPIOC_INT_EN_8814B BIT(24) -+#define BIT_FS_GPIOB_INT_EN_8814B BIT(23) -+#define BIT_FS_GPIOA_INT_EN_8814B BIT(22) -+#define BIT_FS_GPIO9_INT_EN_8814B BIT(21) -+#define BIT_FS_GPIO8_INT_EN_8814B BIT(20) -+#define BIT_FS_GPIO7_INT_EN_8814B BIT(19) -+#define BIT_FS_GPIO6_INT_EN_8814B BIT(18) -+#define BIT_FS_GPIO5_INT_EN_8814B BIT(17) -+#define BIT_FS_GPIO4_INT_EN_8814B BIT(16) -+#define BIT_FS_GPIO3_INT_EN_8814B BIT(15) -+#define BIT_FS_GPIO2_INT_EN_8814B BIT(14) -+#define BIT_FS_GPIO1_INT_EN_8814B BIT(13) -+#define BIT_FS_GPIO0_INT_EN_8814B BIT(12) -+#define BIT_FS_HCI_SUS_EN_8814B BIT(11) -+#define BIT_FS_HCI_RES_EN_8814B BIT(10) -+#define BIT_FS_HCI_RESET_EN_8814B BIT(9) -+#define BIT_USB_SCSI_CMD_EN_8814B BIT(8) -+#define BIT_FS_BTON_STS_UPDATE_MSK_EN_8814B BIT(7) -+#define BIT_ACT2RECOVERY_INT_EN_V1_8814B BIT(6) -+#define BIT_GEN1GEN2_SWITCH_8814B BIT(5) -+#define BIT_HCI_TXDMA_REQ_HIMR_8814B BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_MAK_8814B BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_MAK_8814B BIT(2) -+#define BIT_FS_USB_LPMRSM_MSK_8814B BIT(1) -+#define BIT_FS_USB_LPMINT_MSK_8814B BIT(0) -+ -+/* 2 REG_FSISR_8814B */ -+#define BIT_FS_PDNINT_8814B BIT(31) -+#define BIT_FS_SPS_OCP_INT_8814B BIT(29) -+#define BIT_FS_PWMERR_INT_8814B BIT(28) -+#define BIT_FS_GPIOF_INT_8814B BIT(27) -+#define BIT_FS_GPIOE_INT_8814B BIT(26) -+#define BIT_FS_GPIOD_INT_8814B BIT(25) -+#define BIT_FS_GPIOC_INT_8814B BIT(24) -+#define BIT_FS_GPIOB_INT_8814B BIT(23) -+#define BIT_FS_GPIOA_INT_8814B BIT(22) -+#define BIT_FS_GPIO9_INT_8814B BIT(21) -+#define BIT_FS_GPIO8_INT_8814B BIT(20) -+#define BIT_FS_GPIO7_INT_8814B BIT(19) -+#define BIT_FS_GPIO6_INT_8814B BIT(18) -+#define BIT_FS_GPIO5_INT_8814B BIT(17) -+#define BIT_FS_GPIO4_INT_8814B BIT(16) -+#define BIT_FS_GPIO3_INT_8814B BIT(15) -+#define BIT_FS_GPIO2_INT_8814B BIT(14) -+#define BIT_FS_GPIO1_INT_8814B BIT(13) -+#define BIT_FS_GPIO0_INT_8814B BIT(12) -+#define BIT_FS_HCI_SUS_INT_8814B BIT(11) -+#define BIT_FS_HCI_RES_INT_8814B BIT(10) -+#define BIT_FS_HCI_RESET_INT_8814B BIT(9) -+#define BIT_USB_SCSI_CMD_INT_8814B BIT(8) -+#define BIT_FS_BTON_STS_UPDATE_INT_8814B BIT(7) -+#define BIT_ACT2RECOVERY_8814B BIT(6) -+#define BIT_GEN1GEN2_SWITCH_8814B BIT(5) -+#define BIT_HCI_TXDMA_REQ_HISR_8814B BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_INT_8814B BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_INT_8814B BIT(2) -+#define BIT_FS_USB_LPMRSM_INT_8814B BIT(1) -+#define BIT_FS_USB_LPMINT_INT_8814B BIT(0) -+ -+/* 2 REG_HSIMR_8814B */ -+#define BIT_GPIOF_INT_EN_8814B BIT(31) -+#define BIT_GPIOE_INT_EN_8814B BIT(30) -+#define BIT_GPIOD_INT_EN_8814B BIT(29) -+#define BIT_GPIOC_INT_EN_8814B BIT(28) -+#define BIT_GPIOB_INT_EN_8814B BIT(27) -+#define BIT_GPIOA_INT_EN_8814B BIT(26) -+#define BIT_GPIO9_INT_EN_8814B BIT(25) -+#define BIT_GPIO8_INT_EN_8814B BIT(24) -+#define BIT_GPIO7_INT_EN_8814B BIT(23) -+#define BIT_GPIO6_INT_EN_8814B BIT(22) -+#define BIT_GPIO5_INT_EN_8814B BIT(21) -+#define BIT_GPIO4_INT_EN_8814B BIT(20) -+#define BIT_GPIO3_INT_EN_8814B BIT(19) -+#define BIT_GPIO2_INT_EN_V1_8814B BIT(18) -+#define BIT_GPIO1_INT_EN_8814B BIT(17) -+#define BIT_GPIO0_INT_EN_8814B BIT(16) -+#define BIT_PDNINT_EN_8814B BIT(7) -+#define BIT_RON_INT_EN_8814B BIT(6) -+#define BIT_SPS_OCP_INT_EN_8814B BIT(5) -+#define BIT_GPIO15_0_INT_EN_8814B BIT(0) -+ -+/* 2 REG_HSISR_8814B */ -+#define BIT_GPIOF_INT_8814B BIT(31) -+#define BIT_GPIOE_INT_8814B BIT(30) -+#define BIT_GPIOD_INT_8814B BIT(29) -+#define BIT_GPIOC_INT_8814B BIT(28) -+#define BIT_GPIOB_INT_8814B BIT(27) -+#define BIT_GPIOA_INT_8814B BIT(26) -+#define BIT_GPIO9_INT_8814B BIT(25) -+#define BIT_GPIO8_INT_8814B BIT(24) -+#define BIT_GPIO7_INT_8814B BIT(23) -+#define BIT_GPIO6_INT_8814B BIT(22) -+#define BIT_GPIO5_INT_8814B BIT(21) -+#define BIT_GPIO4_INT_8814B BIT(20) -+#define BIT_GPIO3_INT_8814B BIT(19) -+#define BIT_GPIO2_INT_V1_8814B BIT(18) -+#define BIT_GPIO1_INT_8814B BIT(17) -+#define BIT_GPIO0_INT_8814B BIT(16) -+#define BIT_PDNINT_8814B BIT(7) -+#define BIT_RON_INT_8814B BIT(6) -+#define BIT_SPS_OCP_INT_8814B BIT(5) -+#define BIT_GPIO15_0_INT_8814B BIT(0) -+ -+/* 2 REG_GPIO_EXT_CTRL_8814B */ -+ -+#define BIT_SHIFT_GPIO_MOD_15_TO_8_8814B 24 -+#define BIT_MASK_GPIO_MOD_15_TO_8_8814B 0xff -+#define BIT_GPIO_MOD_15_TO_8_8814B(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_15_TO_8_8814B) \ -+ << BIT_SHIFT_GPIO_MOD_15_TO_8_8814B) -+#define BITS_GPIO_MOD_15_TO_8_8814B \ -+ (BIT_MASK_GPIO_MOD_15_TO_8_8814B << BIT_SHIFT_GPIO_MOD_15_TO_8_8814B) -+#define BIT_CLEAR_GPIO_MOD_15_TO_8_8814B(x) \ -+ ((x) & (~BITS_GPIO_MOD_15_TO_8_8814B)) -+#define BIT_GET_GPIO_MOD_15_TO_8_8814B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_15_TO_8_8814B) & \ -+ BIT_MASK_GPIO_MOD_15_TO_8_8814B) -+#define BIT_SET_GPIO_MOD_15_TO_8_8814B(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_15_TO_8_8814B(x) | BIT_GPIO_MOD_15_TO_8_8814B(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8814B 16 -+#define BIT_MASK_GPIO_IO_SEL_15_TO_8_8814B 0xff -+#define BIT_GPIO_IO_SEL_15_TO_8_8814B(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_15_TO_8_8814B) \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8814B) -+#define BITS_GPIO_IO_SEL_15_TO_8_8814B \ -+ (BIT_MASK_GPIO_IO_SEL_15_TO_8_8814B \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8814B) -+#define BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8814B(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_15_TO_8_8814B)) -+#define BIT_GET_GPIO_IO_SEL_15_TO_8_8814B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8814B) & \ -+ BIT_MASK_GPIO_IO_SEL_15_TO_8_8814B) -+#define BIT_SET_GPIO_IO_SEL_15_TO_8_8814B(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8814B(x) | \ -+ BIT_GPIO_IO_SEL_15_TO_8_8814B(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_15_TO_8_8814B 8 -+#define BIT_MASK_GPIO_OUT_15_TO_8_8814B 0xff -+#define BIT_GPIO_OUT_15_TO_8_8814B(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_15_TO_8_8814B) \ -+ << BIT_SHIFT_GPIO_OUT_15_TO_8_8814B) -+#define BITS_GPIO_OUT_15_TO_8_8814B \ -+ (BIT_MASK_GPIO_OUT_15_TO_8_8814B << BIT_SHIFT_GPIO_OUT_15_TO_8_8814B) -+#define BIT_CLEAR_GPIO_OUT_15_TO_8_8814B(x) \ -+ ((x) & (~BITS_GPIO_OUT_15_TO_8_8814B)) -+#define BIT_GET_GPIO_OUT_15_TO_8_8814B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_15_TO_8_8814B) & \ -+ BIT_MASK_GPIO_OUT_15_TO_8_8814B) -+#define BIT_SET_GPIO_OUT_15_TO_8_8814B(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_15_TO_8_8814B(x) | BIT_GPIO_OUT_15_TO_8_8814B(v)) -+ -+#define BIT_SHIFT_GPIO_IN_15_TO_8_8814B 0 -+#define BIT_MASK_GPIO_IN_15_TO_8_8814B 0xff -+#define BIT_GPIO_IN_15_TO_8_8814B(x) \ -+ (((x) & BIT_MASK_GPIO_IN_15_TO_8_8814B) \ -+ << BIT_SHIFT_GPIO_IN_15_TO_8_8814B) -+#define BITS_GPIO_IN_15_TO_8_8814B \ -+ (BIT_MASK_GPIO_IN_15_TO_8_8814B << BIT_SHIFT_GPIO_IN_15_TO_8_8814B) -+#define BIT_CLEAR_GPIO_IN_15_TO_8_8814B(x) ((x) & (~BITS_GPIO_IN_15_TO_8_8814B)) -+#define BIT_GET_GPIO_IN_15_TO_8_8814B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_15_TO_8_8814B) & \ -+ BIT_MASK_GPIO_IN_15_TO_8_8814B) -+#define BIT_SET_GPIO_IN_15_TO_8_8814B(x, v) \ -+ (BIT_CLEAR_GPIO_IN_15_TO_8_8814B(x) | BIT_GPIO_IN_15_TO_8_8814B(v)) -+ -+/* 2 REG_PAD_CTRL1_8814B */ -+#define BIT_DATA_CPU_JTAG_8814B BIT(30) -+#define BIT_PAPE_WLBT_SEL_8814B BIT(29) -+#define BIT_LNAON_WLBT_SEL_8814B BIT(28) -+#define BIT_BTGP_GPG3_FEN_8814B BIT(26) -+#define BIT_BTGP_GPG2_FEN_8814B BIT(25) -+#define BIT_BTGP_JTAG_EN_8814B BIT(24) -+#define BIT_XTAL_CLK_EXTARNAL_EN_8814B BIT(23) -+#define BIT_BTGP_UART0_EN_8814B BIT(22) -+#define BIT_BTGP_UART1_EN_8814B BIT(21) -+#define BIT_BTGP_SPI_EN_8814B BIT(20) -+#define BIT_BTGP_GPIO_E2_8814B BIT(19) -+#define BIT_BTGP_GPIO_EN_8814B BIT(18) -+ -+#define BIT_SHIFT_BTGP_GPIO_SL_8814B 16 -+#define BIT_MASK_BTGP_GPIO_SL_8814B 0x3 -+#define BIT_BTGP_GPIO_SL_8814B(x) \ -+ (((x) & BIT_MASK_BTGP_GPIO_SL_8814B) << BIT_SHIFT_BTGP_GPIO_SL_8814B) -+#define BITS_BTGP_GPIO_SL_8814B \ -+ (BIT_MASK_BTGP_GPIO_SL_8814B << BIT_SHIFT_BTGP_GPIO_SL_8814B) -+#define BIT_CLEAR_BTGP_GPIO_SL_8814B(x) ((x) & (~BITS_BTGP_GPIO_SL_8814B)) -+#define BIT_GET_BTGP_GPIO_SL_8814B(x) \ -+ (((x) >> BIT_SHIFT_BTGP_GPIO_SL_8814B) & BIT_MASK_BTGP_GPIO_SL_8814B) -+#define BIT_SET_BTGP_GPIO_SL_8814B(x, v) \ -+ (BIT_CLEAR_BTGP_GPIO_SL_8814B(x) | BIT_BTGP_GPIO_SL_8814B(v)) -+ -+#define BIT_WL_JTAG_8814B BIT(15) -+#define BIT_PAD_SDIO_SR_8814B BIT(14) -+#define BIT_GPIO14_OUTPUT_PL_8814B BIT(13) -+#define BIT_HOST_WAKE_PAD_PULL_EN_8814B BIT(12) -+#define BIT_HOST_WAKE_PAD_SL_8814B BIT(11) -+#define BIT_SW_LNAON_G_SEL_DATA_8814B BIT(8) -+#define BIT_SW_LNAON_A_SEL_DATA_8814B BIT(7) -+#define BIT_SW_PAPE_G_SEL_DATA_8814B BIT(4) -+#define BIT_SW_PAPE_A_SEL_DATA_8814B BIT(3) -+#define BIT_SW_DPDT_SEL_DATA_8814B BIT(0) -+ -+/* 2 REG_WL_BT_PWR_CTRL_8814B */ -+#define BIT_ISO_BD2PP_8814B BIT(31) -+#define BIT_LDOV12B_EN_8814B BIT(30) -+#define BIT_CKEN_BTGPS_8814B BIT(29) -+#define BIT_FEN_BTGPS_8814B BIT(28) -+#define BIT_BTCPU_BOOTSEL_8814B BIT(27) -+#define BIT_SPI_SPEEDUP_8814B BIT(26) -+#define BIT_BT_SUS_8814B BIT(25) -+#define BIT_DEVWAKE_PAD_TYPE_SEL_8814B BIT(24) -+#define BIT_CLKREQ_PAD_TYPE_SEL_8814B BIT(23) -+#define BIT_ISO_BTPON2PP_8814B BIT(22) -+#define BIT_BTCOEX_CMD_8814B BIT(21) -+#define BIT_BT_UART_INTF_8814B BIT(20) -+#define BIT_BT_HWROF_EN_8814B BIT(19) -+#define BIT_BT_FUNC_EN_8814B BIT(18) -+#define BIT_BT_HWPDN_SL_8814B BIT(17) -+#define BIT_BT_DISN_EN_8814B BIT(16) -+#define BIT_BT_PDN_PULL_EN_8814B BIT(15) -+#define BIT_WL_PDN_PULL_EN_8814B BIT(14) -+#define BIT_EXTERNAL_REQUEST_PL_8814B BIT(13) -+#define BIT_GPIO0_2_3_PULL_LOW_EN_8814B BIT(12) -+#define BIT_ISO_BA2PP_8814B BIT(11) -+#define BIT_BT_AFE_LDO_EN_8814B BIT(10) -+#define BIT_BT_AFE_PLL_EN_8814B BIT(9) -+#define BIT_BT_DIG_CLK_EN_8814B BIT(8) -+#define BIT_UART_BRIDGE_8814B BIT(7) -+#define BIT_OSC32K_CTRL_SEL_8814B BIT(6) -+#define BIT_WL_DRV_EXIST_IDX_8814B BIT(5) -+#define BIT_DOP_EHPAD_8814B BIT(4) -+#define BIT_WL_HWROF_EN_8814B BIT(3) -+#define BIT_WL_FUNC_EN_8814B BIT(2) -+#define BIT_WL_HWPDN_SL_8814B BIT(1) -+#define BIT_WL_HWPDN_EN_8814B BIT(0) -+ -+/* 2 REG_SDM_DEBUG_8814B */ -+#define BIT_BT_WAKE_DEV_EN_V1_8814B BIT(19) -+#define BIT_BT_WAKE_HST_EN_V1_8814B BIT(18) -+#define BIT_BT_WAKE_HST_PL_V1_8814B BIT(17) -+#define BIT_BT_CLKREQ_EN_V1_8814B BIT(16) -+ -+#define BIT_SHIFT_WLCLK_PHASE_8814B 0 -+#define BIT_MASK_WLCLK_PHASE_8814B 0x1f -+#define BIT_WLCLK_PHASE_8814B(x) \ -+ (((x) & BIT_MASK_WLCLK_PHASE_8814B) << BIT_SHIFT_WLCLK_PHASE_8814B) -+#define BITS_WLCLK_PHASE_8814B \ -+ (BIT_MASK_WLCLK_PHASE_8814B << BIT_SHIFT_WLCLK_PHASE_8814B) -+#define BIT_CLEAR_WLCLK_PHASE_8814B(x) ((x) & (~BITS_WLCLK_PHASE_8814B)) -+#define BIT_GET_WLCLK_PHASE_8814B(x) \ -+ (((x) >> BIT_SHIFT_WLCLK_PHASE_8814B) & BIT_MASK_WLCLK_PHASE_8814B) -+#define BIT_SET_WLCLK_PHASE_8814B(x, v) \ -+ (BIT_CLEAR_WLCLK_PHASE_8814B(x) | BIT_WLCLK_PHASE_8814B(v)) -+ -+/* 2 REG_SYS_SDIO_CTRL_8814B */ -+#define BIT_DBG_GNT_WL_BT_8814B BIT(27) -+#define BIT_LTE_MUX_CTRL_PATH_8814B BIT(26) -+#define BIT_LTE_COEX_UART_8814B BIT(25) -+#define BIT_3W_LTE_WL_GPIO_8814B BIT(24) -+#define BIT_SDIO_INT_POLARITY_8814B BIT(19) -+#define BIT_SDIO_INT_8814B BIT(18) -+#define BIT_SDIO_OFF_EN_8814B BIT(17) -+#define BIT_SDIO_ON_EN_8814B BIT(16) -+#define BIT_PCIE_WAIT_TIMEOUT_EVENT_8814B BIT(10) -+#define BIT_PCIE_WAIT_TIME_8814B BIT(9) -+#define BIT_MPCIE_REFCLK_XTAL_SEL_8814B BIT(8) -+#define BIT_BT_CLKREQ_EN_8814B BIT(6) -+ -+#define BIT_SHIFT_USB_CKREF_CML_R_8814B 4 -+#define BIT_MASK_USB_CKREF_CML_R_8814B 0x3 -+#define BIT_USB_CKREF_CML_R_8814B(x) \ -+ (((x) & BIT_MASK_USB_CKREF_CML_R_8814B) \ -+ << BIT_SHIFT_USB_CKREF_CML_R_8814B) -+#define BITS_USB_CKREF_CML_R_8814B \ -+ (BIT_MASK_USB_CKREF_CML_R_8814B << BIT_SHIFT_USB_CKREF_CML_R_8814B) -+#define BIT_CLEAR_USB_CKREF_CML_R_8814B(x) ((x) & (~BITS_USB_CKREF_CML_R_8814B)) -+#define BIT_GET_USB_CKREF_CML_R_8814B(x) \ -+ (((x) >> BIT_SHIFT_USB_CKREF_CML_R_8814B) & \ -+ BIT_MASK_USB_CKREF_CML_R_8814B) -+#define BIT_SET_USB_CKREF_CML_R_8814B(x, v) \ -+ (BIT_CLEAR_USB_CKREF_CML_R_8814B(x) | BIT_USB_CKREF_CML_R_8814B(v)) -+ -+#define BIT_SHIFT_USB_CKREF_D2S_I_8814B 2 -+#define BIT_MASK_USB_CKREF_D2S_I_8814B 0x3 -+#define BIT_USB_CKREF_D2S_I_8814B(x) \ -+ (((x) & BIT_MASK_USB_CKREF_D2S_I_8814B) \ -+ << BIT_SHIFT_USB_CKREF_D2S_I_8814B) -+#define BITS_USB_CKREF_D2S_I_8814B \ -+ (BIT_MASK_USB_CKREF_D2S_I_8814B << BIT_SHIFT_USB_CKREF_D2S_I_8814B) -+#define BIT_CLEAR_USB_CKREF_D2S_I_8814B(x) ((x) & (~BITS_USB_CKREF_D2S_I_8814B)) -+#define BIT_GET_USB_CKREF_D2S_I_8814B(x) \ -+ (((x) >> BIT_SHIFT_USB_CKREF_D2S_I_8814B) & \ -+ BIT_MASK_USB_CKREF_D2S_I_8814B) -+#define BIT_SET_USB_CKREF_D2S_I_8814B(x, v) \ -+ (BIT_CLEAR_USB_CKREF_D2S_I_8814B(x) | BIT_USB_CKREF_D2S_I_8814B(v)) -+ -+#define BIT_RES_USB_MASS_STORAGE_DESC_8814B BIT(1) -+#define BIT_USB_WAIT_TIME_8814B BIT(0) -+ -+/* 2 REG_HCI_OPT_CTRL_8814B */ -+ -+#define BIT_SHIFT_TSFT_SEL_8814B 29 -+#define BIT_MASK_TSFT_SEL_8814B 0x7 -+#define BIT_TSFT_SEL_8814B(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_8814B) << BIT_SHIFT_TSFT_SEL_8814B) -+#define BITS_TSFT_SEL_8814B \ -+ (BIT_MASK_TSFT_SEL_8814B << BIT_SHIFT_TSFT_SEL_8814B) -+#define BIT_CLEAR_TSFT_SEL_8814B(x) ((x) & (~BITS_TSFT_SEL_8814B)) -+#define BIT_GET_TSFT_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_8814B) & BIT_MASK_TSFT_SEL_8814B) -+#define BIT_SET_TSFT_SEL_8814B(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_8814B(x) | BIT_TSFT_SEL_8814B(v)) -+ -+#define BIT_TSFT_BAND_SEL_8814B BIT(28) -+#define BIT_USB_HOST_PWR_OFF_EN_8814B BIT(12) -+#define BIT_SYM_LPS_BLOCK_EN_8814B BIT(11) -+#define BIT_USB_LPM_ACT_EN_8814B BIT(10) -+#define BIT_USB_LPM_NY_8814B BIT(9) -+#define BIT_USB_SUS_DIS_8814B BIT(8) -+ -+#define BIT_SHIFT_SDIO_PAD_E_8814B 5 -+#define BIT_MASK_SDIO_PAD_E_8814B 0x7 -+#define BIT_SDIO_PAD_E_8814B(x) \ -+ (((x) & BIT_MASK_SDIO_PAD_E_8814B) << BIT_SHIFT_SDIO_PAD_E_8814B) -+#define BITS_SDIO_PAD_E_8814B \ -+ (BIT_MASK_SDIO_PAD_E_8814B << BIT_SHIFT_SDIO_PAD_E_8814B) -+#define BIT_CLEAR_SDIO_PAD_E_8814B(x) ((x) & (~BITS_SDIO_PAD_E_8814B)) -+#define BIT_GET_SDIO_PAD_E_8814B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_PAD_E_8814B) & BIT_MASK_SDIO_PAD_E_8814B) -+#define BIT_SET_SDIO_PAD_E_8814B(x, v) \ -+ (BIT_CLEAR_SDIO_PAD_E_8814B(x) | BIT_SDIO_PAD_E_8814B(v)) -+ -+#define BIT_USB_LPPLL_EN_8814B BIT(4) -+#define BIT_ROP_SW15_8814B BIT(2) -+#define BIT_PCI_CKRDY_OPT_8814B BIT(1) -+#define BIT_PCI_VAUX_EN_8814B BIT(0) -+ -+/* 2 REG_AFE_CTRL4_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_LDO_SWR_CTRL_8814B */ -+#define BIT_ZCD_HW_AUTO_EN_8814B BIT(27) -+#define BIT_ZCD_REGSEL_8814B BIT(26) -+ -+#define BIT_SHIFT_AUTO_ZCD_IN_CODE_8814B 21 -+#define BIT_MASK_AUTO_ZCD_IN_CODE_8814B 0x1f -+#define BIT_AUTO_ZCD_IN_CODE_8814B(x) \ -+ (((x) & BIT_MASK_AUTO_ZCD_IN_CODE_8814B) \ -+ << BIT_SHIFT_AUTO_ZCD_IN_CODE_8814B) -+#define BITS_AUTO_ZCD_IN_CODE_8814B \ -+ (BIT_MASK_AUTO_ZCD_IN_CODE_8814B << BIT_SHIFT_AUTO_ZCD_IN_CODE_8814B) -+#define BIT_CLEAR_AUTO_ZCD_IN_CODE_8814B(x) \ -+ ((x) & (~BITS_AUTO_ZCD_IN_CODE_8814B)) -+#define BIT_GET_AUTO_ZCD_IN_CODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_AUTO_ZCD_IN_CODE_8814B) & \ -+ BIT_MASK_AUTO_ZCD_IN_CODE_8814B) -+#define BIT_SET_AUTO_ZCD_IN_CODE_8814B(x, v) \ -+ (BIT_CLEAR_AUTO_ZCD_IN_CODE_8814B(x) | BIT_AUTO_ZCD_IN_CODE_8814B(v)) -+ -+#define BIT_SHIFT_ZCD_CODE_IN_L_8814B 16 -+#define BIT_MASK_ZCD_CODE_IN_L_8814B 0x1f -+#define BIT_ZCD_CODE_IN_L_8814B(x) \ -+ (((x) & BIT_MASK_ZCD_CODE_IN_L_8814B) << BIT_SHIFT_ZCD_CODE_IN_L_8814B) -+#define BITS_ZCD_CODE_IN_L_8814B \ -+ (BIT_MASK_ZCD_CODE_IN_L_8814B << BIT_SHIFT_ZCD_CODE_IN_L_8814B) -+#define BIT_CLEAR_ZCD_CODE_IN_L_8814B(x) ((x) & (~BITS_ZCD_CODE_IN_L_8814B)) -+#define BIT_GET_ZCD_CODE_IN_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ZCD_CODE_IN_L_8814B) & BIT_MASK_ZCD_CODE_IN_L_8814B) -+#define BIT_SET_ZCD_CODE_IN_L_8814B(x, v) \ -+ (BIT_CLEAR_ZCD_CODE_IN_L_8814B(x) | BIT_ZCD_CODE_IN_L_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_MCUFW_CTRL_8814B */ -+ -+#define BIT_SHIFT_RPWM_8814B 24 -+#define BIT_MASK_RPWM_8814B 0xff -+#define BIT_RPWM_8814B(x) (((x) & BIT_MASK_RPWM_8814B) << BIT_SHIFT_RPWM_8814B) -+#define BITS_RPWM_8814B (BIT_MASK_RPWM_8814B << BIT_SHIFT_RPWM_8814B) -+#define BIT_CLEAR_RPWM_8814B(x) ((x) & (~BITS_RPWM_8814B)) -+#define BIT_GET_RPWM_8814B(x) \ -+ (((x) >> BIT_SHIFT_RPWM_8814B) & BIT_MASK_RPWM_8814B) -+#define BIT_SET_RPWM_8814B(x, v) (BIT_CLEAR_RPWM_8814B(x) | BIT_RPWM_8814B(v)) -+ -+#define BIT_ANA_PORT_EN_8814B BIT(22) -+#define BIT_MAC_PORT_EN_8814B BIT(21) -+#define BIT_BOOT_FSPI_EN_8814B BIT(20) -+#define BIT_ROM_DLEN_8814B BIT(19) -+ -+#define BIT_SHIFT_ROM_PGE_8814B 16 -+#define BIT_MASK_ROM_PGE_8814B 0x7 -+#define BIT_ROM_PGE_8814B(x) \ -+ (((x) & BIT_MASK_ROM_PGE_8814B) << BIT_SHIFT_ROM_PGE_8814B) -+#define BITS_ROM_PGE_8814B (BIT_MASK_ROM_PGE_8814B << BIT_SHIFT_ROM_PGE_8814B) -+#define BIT_CLEAR_ROM_PGE_8814B(x) ((x) & (~BITS_ROM_PGE_8814B)) -+#define BIT_GET_ROM_PGE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ROM_PGE_8814B) & BIT_MASK_ROM_PGE_8814B) -+#define BIT_SET_ROM_PGE_8814B(x, v) \ -+ (BIT_CLEAR_ROM_PGE_8814B(x) | BIT_ROM_PGE_8814B(v)) -+ -+#define BIT_FW_INIT_RDY_8814B BIT(15) -+#define BIT_FW_DW_RDY_8814B BIT(14) -+ -+#define BIT_SHIFT_CPU_CLK_SEL_8814B 12 -+#define BIT_MASK_CPU_CLK_SEL_8814B 0x3 -+#define BIT_CPU_CLK_SEL_8814B(x) \ -+ (((x) & BIT_MASK_CPU_CLK_SEL_8814B) << BIT_SHIFT_CPU_CLK_SEL_8814B) -+#define BITS_CPU_CLK_SEL_8814B \ -+ (BIT_MASK_CPU_CLK_SEL_8814B << BIT_SHIFT_CPU_CLK_SEL_8814B) -+#define BIT_CLEAR_CPU_CLK_SEL_8814B(x) ((x) & (~BITS_CPU_CLK_SEL_8814B)) -+#define BIT_GET_CPU_CLK_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPU_CLK_SEL_8814B) & BIT_MASK_CPU_CLK_SEL_8814B) -+#define BIT_SET_CPU_CLK_SEL_8814B(x, v) \ -+ (BIT_CLEAR_CPU_CLK_SEL_8814B(x) | BIT_CPU_CLK_SEL_8814B(v)) -+ -+#define BIT_CCLK_CHG_MASK_8814B BIT(11) -+#define BIT_EMEM__TXBUF_CHKSUM_OK_8814B BIT(10) -+#define BIT_EMEM_TXBUF_DW_RDY_8814B BIT(9) -+#define BIT_EMEM_CHKSUM_OK_8814B BIT(8) -+#define BIT_EMEM_DW_OK_8814B BIT(7) -+#define BIT_DMEM_CHKSUM_OK_8814B BIT(6) -+#define BIT_DMEM_DW_OK_8814B BIT(5) -+#define BIT_IMEM_CHKSUM_OK_8814B BIT(4) -+#define BIT_IMEM_DW_OK_8814B BIT(3) -+#define BIT_IMEM_BOOT_LOAD_CHKSUM_OK_8814B BIT(2) -+#define BIT_IMEM_BOOT_LOAD_DW_OK_8814B BIT(1) -+#define BIT_MCUFWDL_EN_8814B BIT(0) -+ -+/* 2 REG_MCU_TST_CFG_8814B */ -+ -+#define BIT_SHIFT_C2H_MSG_8814B 0 -+#define BIT_MASK_C2H_MSG_8814B 0xffff -+#define BIT_C2H_MSG_8814B(x) \ -+ (((x) & BIT_MASK_C2H_MSG_8814B) << BIT_SHIFT_C2H_MSG_8814B) -+#define BITS_C2H_MSG_8814B (BIT_MASK_C2H_MSG_8814B << BIT_SHIFT_C2H_MSG_8814B) -+#define BIT_CLEAR_C2H_MSG_8814B(x) ((x) & (~BITS_C2H_MSG_8814B)) -+#define BIT_GET_C2H_MSG_8814B(x) \ -+ (((x) >> BIT_SHIFT_C2H_MSG_8814B) & BIT_MASK_C2H_MSG_8814B) -+#define BIT_SET_C2H_MSG_8814B(x, v) \ -+ (BIT_CLEAR_C2H_MSG_8814B(x) | BIT_C2H_MSG_8814B(v)) -+ -+/* 2 REG_HMEBOX_E0_E1_8814B */ -+ -+#define BIT_SHIFT_HOST_MSG_E1_8814B 16 -+#define BIT_MASK_HOST_MSG_E1_8814B 0xffff -+#define BIT_HOST_MSG_E1_8814B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E1_8814B) << BIT_SHIFT_HOST_MSG_E1_8814B) -+#define BITS_HOST_MSG_E1_8814B \ -+ (BIT_MASK_HOST_MSG_E1_8814B << BIT_SHIFT_HOST_MSG_E1_8814B) -+#define BIT_CLEAR_HOST_MSG_E1_8814B(x) ((x) & (~BITS_HOST_MSG_E1_8814B)) -+#define BIT_GET_HOST_MSG_E1_8814B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E1_8814B) & BIT_MASK_HOST_MSG_E1_8814B) -+#define BIT_SET_HOST_MSG_E1_8814B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E1_8814B(x) | BIT_HOST_MSG_E1_8814B(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E0_8814B 0 -+#define BIT_MASK_HOST_MSG_E0_8814B 0xffff -+#define BIT_HOST_MSG_E0_8814B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E0_8814B) << BIT_SHIFT_HOST_MSG_E0_8814B) -+#define BITS_HOST_MSG_E0_8814B \ -+ (BIT_MASK_HOST_MSG_E0_8814B << BIT_SHIFT_HOST_MSG_E0_8814B) -+#define BIT_CLEAR_HOST_MSG_E0_8814B(x) ((x) & (~BITS_HOST_MSG_E0_8814B)) -+#define BIT_GET_HOST_MSG_E0_8814B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E0_8814B) & BIT_MASK_HOST_MSG_E0_8814B) -+#define BIT_SET_HOST_MSG_E0_8814B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E0_8814B(x) | BIT_HOST_MSG_E0_8814B(v)) -+ -+/* 2 REG_HMEBOX_E2_E3_8814B */ -+ -+#define BIT_SHIFT_HOST_MSG_E3_8814B 16 -+#define BIT_MASK_HOST_MSG_E3_8814B 0xffff -+#define BIT_HOST_MSG_E3_8814B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E3_8814B) << BIT_SHIFT_HOST_MSG_E3_8814B) -+#define BITS_HOST_MSG_E3_8814B \ -+ (BIT_MASK_HOST_MSG_E3_8814B << BIT_SHIFT_HOST_MSG_E3_8814B) -+#define BIT_CLEAR_HOST_MSG_E3_8814B(x) ((x) & (~BITS_HOST_MSG_E3_8814B)) -+#define BIT_GET_HOST_MSG_E3_8814B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E3_8814B) & BIT_MASK_HOST_MSG_E3_8814B) -+#define BIT_SET_HOST_MSG_E3_8814B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E3_8814B(x) | BIT_HOST_MSG_E3_8814B(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E2_8814B 0 -+#define BIT_MASK_HOST_MSG_E2_8814B 0xffff -+#define BIT_HOST_MSG_E2_8814B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E2_8814B) << BIT_SHIFT_HOST_MSG_E2_8814B) -+#define BITS_HOST_MSG_E2_8814B \ -+ (BIT_MASK_HOST_MSG_E2_8814B << BIT_SHIFT_HOST_MSG_E2_8814B) -+#define BIT_CLEAR_HOST_MSG_E2_8814B(x) ((x) & (~BITS_HOST_MSG_E2_8814B)) -+#define BIT_GET_HOST_MSG_E2_8814B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E2_8814B) & BIT_MASK_HOST_MSG_E2_8814B) -+#define BIT_SET_HOST_MSG_E2_8814B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E2_8814B(x) | BIT_HOST_MSG_E2_8814B(v)) -+ -+/* 2 REG_WLLPS_CTRL_8814B */ -+#define BIT_WLLPSOP_EABM_8814B BIT(31) -+#define BIT_WLLPSOP_ACKF_8814B BIT(30) -+#define BIT_WLLPSOP_DLDM_8814B BIT(29) -+#define BIT_WLLPSOP_ESWR_8814B BIT(28) -+#define BIT_WLLPSOP_PWMM_8814B BIT(27) -+#define BIT_WLLPSOP_EECK_8814B BIT(26) -+#define BIT_WLLPSOP_WLMACOFF_8814B BIT(25) -+#define BIT_WLLPSOP_EXTAL_8814B BIT(24) -+#define BIT_WL_SYNPON_VOLTSPDN_8814B BIT(23) -+#define BIT_WLLPSOP_WLBBOFF_8814B BIT(22) -+#define BIT_WLLPSOP_WLMEM_DS_8814B BIT(21) -+ -+#define BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8814B 12 -+#define BIT_MASK_LPLDH12_VADJ_STEP_DN_8814B 0xf -+#define BIT_LPLDH12_VADJ_STEP_DN_8814B(x) \ -+ (((x) & BIT_MASK_LPLDH12_VADJ_STEP_DN_8814B) \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8814B) -+#define BITS_LPLDH12_VADJ_STEP_DN_8814B \ -+ (BIT_MASK_LPLDH12_VADJ_STEP_DN_8814B \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8814B) -+#define BIT_CLEAR_LPLDH12_VADJ_STEP_DN_8814B(x) \ -+ ((x) & (~BITS_LPLDH12_VADJ_STEP_DN_8814B)) -+#define BIT_GET_LPLDH12_VADJ_STEP_DN_8814B(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8814B) & \ -+ BIT_MASK_LPLDH12_VADJ_STEP_DN_8814B) -+#define BIT_SET_LPLDH12_VADJ_STEP_DN_8814B(x, v) \ -+ (BIT_CLEAR_LPLDH12_VADJ_STEP_DN_8814B(x) | \ -+ BIT_LPLDH12_VADJ_STEP_DN_8814B(v)) -+ -+#define BIT_SHIFT_V15ADJ_L1_STEP_DN_8814B 8 -+#define BIT_MASK_V15ADJ_L1_STEP_DN_8814B 0x7 -+#define BIT_V15ADJ_L1_STEP_DN_8814B(x) \ -+ (((x) & BIT_MASK_V15ADJ_L1_STEP_DN_8814B) \ -+ << BIT_SHIFT_V15ADJ_L1_STEP_DN_8814B) -+#define BITS_V15ADJ_L1_STEP_DN_8814B \ -+ (BIT_MASK_V15ADJ_L1_STEP_DN_8814B << BIT_SHIFT_V15ADJ_L1_STEP_DN_8814B) -+#define BIT_CLEAR_V15ADJ_L1_STEP_DN_8814B(x) \ -+ ((x) & (~BITS_V15ADJ_L1_STEP_DN_8814B)) -+#define BIT_GET_V15ADJ_L1_STEP_DN_8814B(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L1_STEP_DN_8814B) & \ -+ BIT_MASK_V15ADJ_L1_STEP_DN_8814B) -+#define BIT_SET_V15ADJ_L1_STEP_DN_8814B(x, v) \ -+ (BIT_CLEAR_V15ADJ_L1_STEP_DN_8814B(x) | BIT_V15ADJ_L1_STEP_DN_8814B(v)) -+ -+#define BIT_REGU_32K_CLK_EN_8814B BIT(1) -+#define BIT_WL_LPS_EN_8814B BIT(0) -+ -+/* 2 REG_AFE_CTRL5_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_GPIO_DEBOUNCE_CTRL_8814B */ -+#define BIT_WLGP_DBC1EN_8814B BIT(15) -+ -+#define BIT_SHIFT_WLGP_DBC1_8814B 8 -+#define BIT_MASK_WLGP_DBC1_8814B 0xf -+#define BIT_WLGP_DBC1_8814B(x) \ -+ (((x) & BIT_MASK_WLGP_DBC1_8814B) << BIT_SHIFT_WLGP_DBC1_8814B) -+#define BITS_WLGP_DBC1_8814B \ -+ (BIT_MASK_WLGP_DBC1_8814B << BIT_SHIFT_WLGP_DBC1_8814B) -+#define BIT_CLEAR_WLGP_DBC1_8814B(x) ((x) & (~BITS_WLGP_DBC1_8814B)) -+#define BIT_GET_WLGP_DBC1_8814B(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC1_8814B) & BIT_MASK_WLGP_DBC1_8814B) -+#define BIT_SET_WLGP_DBC1_8814B(x, v) \ -+ (BIT_CLEAR_WLGP_DBC1_8814B(x) | BIT_WLGP_DBC1_8814B(v)) -+ -+#define BIT_WLGP_DBC0EN_8814B BIT(7) -+ -+#define BIT_SHIFT_WLGP_DBC0_8814B 0 -+#define BIT_MASK_WLGP_DBC0_8814B 0xf -+#define BIT_WLGP_DBC0_8814B(x) \ -+ (((x) & BIT_MASK_WLGP_DBC0_8814B) << BIT_SHIFT_WLGP_DBC0_8814B) -+#define BITS_WLGP_DBC0_8814B \ -+ (BIT_MASK_WLGP_DBC0_8814B << BIT_SHIFT_WLGP_DBC0_8814B) -+#define BIT_CLEAR_WLGP_DBC0_8814B(x) ((x) & (~BITS_WLGP_DBC0_8814B)) -+#define BIT_GET_WLGP_DBC0_8814B(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC0_8814B) & BIT_MASK_WLGP_DBC0_8814B) -+#define BIT_SET_WLGP_DBC0_8814B(x, v) \ -+ (BIT_CLEAR_WLGP_DBC0_8814B(x) | BIT_WLGP_DBC0_8814B(v)) -+ -+/* 2 REG_RPWM2_8814B */ -+ -+#define BIT_SHIFT_RPWM2_8814B 16 -+#define BIT_MASK_RPWM2_8814B 0xffff -+#define BIT_RPWM2_8814B(x) \ -+ (((x) & BIT_MASK_RPWM2_8814B) << BIT_SHIFT_RPWM2_8814B) -+#define BITS_RPWM2_8814B (BIT_MASK_RPWM2_8814B << BIT_SHIFT_RPWM2_8814B) -+#define BIT_CLEAR_RPWM2_8814B(x) ((x) & (~BITS_RPWM2_8814B)) -+#define BIT_GET_RPWM2_8814B(x) \ -+ (((x) >> BIT_SHIFT_RPWM2_8814B) & BIT_MASK_RPWM2_8814B) -+#define BIT_SET_RPWM2_8814B(x, v) \ -+ (BIT_CLEAR_RPWM2_8814B(x) | BIT_RPWM2_8814B(v)) -+ -+/* 2 REG_SYSON_FSM_MON_8814B */ -+ -+#define BIT_SHIFT_FSM_MON_SEL_8814B 24 -+#define BIT_MASK_FSM_MON_SEL_8814B 0x7 -+#define BIT_FSM_MON_SEL_8814B(x) \ -+ (((x) & BIT_MASK_FSM_MON_SEL_8814B) << BIT_SHIFT_FSM_MON_SEL_8814B) -+#define BITS_FSM_MON_SEL_8814B \ -+ (BIT_MASK_FSM_MON_SEL_8814B << BIT_SHIFT_FSM_MON_SEL_8814B) -+#define BIT_CLEAR_FSM_MON_SEL_8814B(x) ((x) & (~BITS_FSM_MON_SEL_8814B)) -+#define BIT_GET_FSM_MON_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_FSM_MON_SEL_8814B) & BIT_MASK_FSM_MON_SEL_8814B) -+#define BIT_SET_FSM_MON_SEL_8814B(x, v) \ -+ (BIT_CLEAR_FSM_MON_SEL_8814B(x) | BIT_FSM_MON_SEL_8814B(v)) -+ -+#define BIT_DOP_ELDO_8814B BIT(23) -+#define BIT_FSM_MON_UPD_8814B BIT(15) -+ -+#define BIT_SHIFT_FSM_PAR_8814B 0 -+#define BIT_MASK_FSM_PAR_8814B 0x7fff -+#define BIT_FSM_PAR_8814B(x) \ -+ (((x) & BIT_MASK_FSM_PAR_8814B) << BIT_SHIFT_FSM_PAR_8814B) -+#define BITS_FSM_PAR_8814B (BIT_MASK_FSM_PAR_8814B << BIT_SHIFT_FSM_PAR_8814B) -+#define BIT_CLEAR_FSM_PAR_8814B(x) ((x) & (~BITS_FSM_PAR_8814B)) -+#define BIT_GET_FSM_PAR_8814B(x) \ -+ (((x) >> BIT_SHIFT_FSM_PAR_8814B) & BIT_MASK_FSM_PAR_8814B) -+#define BIT_SET_FSM_PAR_8814B(x, v) \ -+ (BIT_CLEAR_FSM_PAR_8814B(x) | BIT_FSM_PAR_8814B(v)) -+ -+/* 2 REG_AFE_CTRL6_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_PMC_DBG_CTRL1_8814B */ -+#define BIT_BT_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_RD_WR_WIFI_BT_INFO_8814B 16 -+#define BIT_MASK_RD_WR_WIFI_BT_INFO_8814B 0x7fff -+#define BIT_RD_WR_WIFI_BT_INFO_8814B(x) \ -+ (((x) & BIT_MASK_RD_WR_WIFI_BT_INFO_8814B) \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8814B) -+#define BITS_RD_WR_WIFI_BT_INFO_8814B \ -+ (BIT_MASK_RD_WR_WIFI_BT_INFO_8814B \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8814B) -+#define BIT_CLEAR_RD_WR_WIFI_BT_INFO_8814B(x) \ -+ ((x) & (~BITS_RD_WR_WIFI_BT_INFO_8814B)) -+#define BIT_GET_RD_WR_WIFI_BT_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_RD_WR_WIFI_BT_INFO_8814B) & \ -+ BIT_MASK_RD_WR_WIFI_BT_INFO_8814B) -+#define BIT_SET_RD_WR_WIFI_BT_INFO_8814B(x, v) \ -+ (BIT_CLEAR_RD_WR_WIFI_BT_INFO_8814B(x) | \ -+ BIT_RD_WR_WIFI_BT_INFO_8814B(v)) -+ -+#define BIT_PMC_WR_OVF_8814B BIT(8) -+ -+#define BIT_SHIFT_WLPMC_ERRINT_8814B 0 -+#define BIT_MASK_WLPMC_ERRINT_8814B 0xff -+#define BIT_WLPMC_ERRINT_8814B(x) \ -+ (((x) & BIT_MASK_WLPMC_ERRINT_8814B) << BIT_SHIFT_WLPMC_ERRINT_8814B) -+#define BITS_WLPMC_ERRINT_8814B \ -+ (BIT_MASK_WLPMC_ERRINT_8814B << BIT_SHIFT_WLPMC_ERRINT_8814B) -+#define BIT_CLEAR_WLPMC_ERRINT_8814B(x) ((x) & (~BITS_WLPMC_ERRINT_8814B)) -+#define BIT_GET_WLPMC_ERRINT_8814B(x) \ -+ (((x) >> BIT_SHIFT_WLPMC_ERRINT_8814B) & BIT_MASK_WLPMC_ERRINT_8814B) -+#define BIT_SET_WLPMC_ERRINT_8814B(x, v) \ -+ (BIT_CLEAR_WLPMC_ERRINT_8814B(x) | BIT_WLPMC_ERRINT_8814B(v)) -+ -+/* 2 REG_AFE_CTRL7_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_HIMR0_8814B */ -+#define BIT_PSTIMER_2_MSK_8814B BIT(31) -+#define BIT_PSTIMER_1_MSK_8814B BIT(30) -+#define BIT_PSTIMER_0_MSK_8814B BIT(29) -+#define BIT_GTINT4_MSK_8814B BIT(28) -+#define BIT_GTINT3_MSK_8814B BIT(27) -+#define BIT_TXBCN0ERR_MSK_8814B BIT(26) -+#define BIT_TXBCN0OK_MSK_8814B BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_MSK_8814B BIT(24) -+#define BIT_TXDMA_START_INT_MSK_8814B BIT(23) -+#define BIT_TXDMA_STOP_INT_MSK_8814B BIT(22) -+#define BIT_HISR7_IND_MSK_8814B BIT(21) -+#define BIT_BCNDMAINT0_MSK_8814B BIT(20) -+#define BIT_HISR6_IND_MSK_8814B BIT(19) -+#define BIT_HISR5_IND_MSK_8814B BIT(18) -+#define BIT_HISR4_IND_MSK_8814B BIT(17) -+#define BIT_BCNDERR0_MSK_8814B BIT(16) -+#define BIT_HSISR_IND_ON_INT_MSK_8814B BIT(15) -+#define BIT_HISR3_IND_MSK_8814B BIT(14) -+#define BIT_HISR2_IND_MSK_8814B BIT(13) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_HISR1_IND_MSK_8814B BIT(11) -+#define BIT_C2HCMD_MSK_8814B BIT(10) -+#define BIT_CPWM2_MSK_8814B BIT(9) -+#define BIT_CPWM_MSK_8814B BIT(8) -+#define BIT_TXDMAOK_CHANNEL15_MSK_8814B BIT(7) -+#define BIT_TXDMAOK_CHANNEL14_MSK_8814B BIT(6) -+#define BIT_TXDMAOK_CHANNEL3_MSK_8814B BIT(5) -+#define BIT_TXDMAOK_CHANNEL2_MSK_8814B BIT(4) -+#define BIT_TXDMAOK_CHANNEL1_MSK_8814B BIT(3) -+#define BIT_TXDMAOK_CHANNEL0_MSK_8814B BIT(2) -+#define BIT_RDU_MSK_8814B BIT(1) -+#define BIT_RXOK_MSK_8814B BIT(0) -+ -+/* 2 REG_HISR0_8814B */ -+#define BIT_PSTIMER_2_8814B BIT(31) -+#define BIT_PSTIMER_1_8814B BIT(30) -+#define BIT_PSTIMER_0_8814B BIT(29) -+#define BIT_GTINT4_8814B BIT(28) -+#define BIT_GTINT3_8814B BIT(27) -+#define BIT_TXBCN0ERR_8814B BIT(26) -+#define BIT_TXBCN0OK_8814B BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_8814B BIT(24) -+#define BIT_TXDMA_START_INT_8814B BIT(23) -+#define BIT_TXDMA_STOP_INT_8814B BIT(22) -+#define BIT_HISR7_IND_8814B BIT(21) -+#define BIT_BCNDMAINT0_8814B BIT(20) -+#define BIT_HISR6_IND_8814B BIT(19) -+#define BIT_HISR5_IND_8814B BIT(18) -+#define BIT_HISR4_IND_8814B BIT(17) -+#define BIT_BCNDERR0_8814B BIT(16) -+#define BIT_HSISR_IND_ON_INT_8814B BIT(15) -+#define BIT_HISR3_IND_8814B BIT(14) -+#define BIT_HISR2_IND_8814B BIT(13) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_HISR1_IND_8814B BIT(11) -+#define BIT_C2HCMD_8814B BIT(10) -+#define BIT_CPWM2_8814B BIT(9) -+#define BIT_CPWM_8814B BIT(8) -+#define BIT_TXDMAOK_CHANNEL15_8814B BIT(7) -+#define BIT_TXDMAOK_CHANNEL14_8814B BIT(6) -+#define BIT_TXDMAOK_CHANNEL3_8814B BIT(5) -+#define BIT_TXDMAOK_CHANNEL2_8814B BIT(4) -+#define BIT_TXDMAOK_CHANNEL1_8814B BIT(3) -+#define BIT_TXDMAOK_CHANNEL0_8814B BIT(2) -+#define BIT_RDU_8814B BIT(1) -+#define BIT_RXOK_8814B BIT(0) -+ -+/* 2 REG_HIMR1_8814B */ -+#define BIT_PRE_TX_ERR_INT_MSK_8814B BIT(31) -+#define BIT_TXFIFO_TH_INT_8814B BIT(30) -+#define BIT_BTON_STS_UPDATE_MASK_8814B BIT(29) -+#define BIT_BCNDMAINT7__MSK_8814B BIT(27) -+#define BIT_BCNDMAINT6__MSK_8814B BIT(26) -+#define BIT_BCNDMAINT5__MSK_8814B BIT(25) -+#define BIT_BCNDMAINT4__MSK_8814B BIT(24) -+#define BIT_BCNDMAINT3_MSK_8814B BIT(23) -+#define BIT_BCNDMAINT2_MSK_8814B BIT(22) -+#define BIT_BCNDMAINT1_MSK_8814B BIT(21) -+#define BIT_BCNDERR7_MSK_8814B BIT(20) -+#define BIT_BCNDERR6_MSK_8814B BIT(19) -+#define BIT_BCNDERR5_MSK_8814B BIT(18) -+#define BIT_BCNDERR4_MSK_8814B BIT(17) -+#define BIT_BCNDERR3_MSK_8814B BIT(16) -+#define BIT_BCNDERR2_MSK_8814B BIT(15) -+#define BIT_BCNDERR1_MSK_8814B BIT(14) -+#define BIT_ATIMEND__MSK_8814B BIT(12) -+#define BIT_TXERR_MSK_8814B BIT(11) -+#define BIT_RXERR_MSK_8814B BIT(10) -+#define BIT_TXFOVW_MSK_8814B BIT(9) -+#define BIT_FOVW_MSK_8814B BIT(8) -+#define BIT_CPU_MGQ_EARLY_INT_MSK_8814B BIT(6) -+#define BIT_CPU_MGQ_TXDONE_MSK_8814B BIT(5) -+#define BIT_PSTIMER_5_MSK_8814B BIT(4) -+#define BIT_PSTIMER_4_MSK_8814B BIT(3) -+#define BIT_PSTIMER_3_MSK_8814B BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_MSK_8814B BIT(1) -+#define BIT_BB_STOPRX_INT_MSK_8814B BIT(0) -+ -+/* 2 REG_HISR1_8814B */ -+#define BIT_PRE_TX_ERR_INT_8814B BIT(31) -+#define BIT_TXFIFO_TH_INT_8814B BIT(30) -+#define BIT_BTON_STS_UPDATE_INT_8814B BIT(29) -+#define BIT_BCNDMAINT7_8814B BIT(27) -+#define BIT_BCNDMAINT6_8814B BIT(26) -+#define BIT_BCNDMAINT5_8814B BIT(25) -+#define BIT_BCNDMAINT4_8814B BIT(24) -+#define BIT_BCNDMAINT3_8814B BIT(23) -+#define BIT_BCNDMAINT2_8814B BIT(22) -+#define BIT_BCNDMAINT1_8814B BIT(21) -+#define BIT_BCNDERR7_8814B BIT(20) -+#define BIT_BCNDERR6_8814B BIT(19) -+#define BIT_BCNDERR5_8814B BIT(18) -+#define BIT_BCNDERR4_8814B BIT(17) -+#define BIT_BCNDERR3_8814B BIT(16) -+#define BIT_BCNDERR2_8814B BIT(15) -+#define BIT_BCNDERR1_8814B BIT(14) -+#define BIT_ATIMEND_8814B BIT(12) -+#define BIT_TXERR_INT_8814B BIT(11) -+#define BIT_RXERR_INT_8814B BIT(10) -+#define BIT_TXFOVW_8814B BIT(9) -+#define BIT_FOVW_8814B BIT(8) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CPU_MGQ_EARLY_INT_8814B BIT(6) -+#define BIT_CPU_MGQ_TXDONE_8814B BIT(5) -+#define BIT_PSTIMER_5_8814B BIT(4) -+#define BIT_PSTIMER_4_8814B BIT(3) -+#define BIT_PSTIMER_3_8814B BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_8814B BIT(1) -+#define BIT_BB_STOPRX_INT_8814B BIT(0) -+ -+/* 2 REG_DBG_PORT_SEL_8814B */ -+ -+#define BIT_SHIFT_DEBUG_ST_8814B 0 -+#define BIT_MASK_DEBUG_ST_8814B 0xffffffffL -+#define BIT_DEBUG_ST_8814B(x) \ -+ (((x) & BIT_MASK_DEBUG_ST_8814B) << BIT_SHIFT_DEBUG_ST_8814B) -+#define BITS_DEBUG_ST_8814B \ -+ (BIT_MASK_DEBUG_ST_8814B << BIT_SHIFT_DEBUG_ST_8814B) -+#define BIT_CLEAR_DEBUG_ST_8814B(x) ((x) & (~BITS_DEBUG_ST_8814B)) -+#define BIT_GET_DEBUG_ST_8814B(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_ST_8814B) & BIT_MASK_DEBUG_ST_8814B) -+#define BIT_SET_DEBUG_ST_8814B(x, v) \ -+ (BIT_CLEAR_DEBUG_ST_8814B(x) | BIT_DEBUG_ST_8814B(v)) -+ -+/* 2 REG_PAD_CTRL2_8814B */ -+#define BIT_USB3_USB2_TRANSITION_8814B BIT(20) -+ -+#define BIT_SHIFT_USB23_SW_MODE_V1_8814B 18 -+#define BIT_MASK_USB23_SW_MODE_V1_8814B 0x3 -+#define BIT_USB23_SW_MODE_V1_8814B(x) \ -+ (((x) & BIT_MASK_USB23_SW_MODE_V1_8814B) \ -+ << BIT_SHIFT_USB23_SW_MODE_V1_8814B) -+#define BITS_USB23_SW_MODE_V1_8814B \ -+ (BIT_MASK_USB23_SW_MODE_V1_8814B << BIT_SHIFT_USB23_SW_MODE_V1_8814B) -+#define BIT_CLEAR_USB23_SW_MODE_V1_8814B(x) \ -+ ((x) & (~BITS_USB23_SW_MODE_V1_8814B)) -+#define BIT_GET_USB23_SW_MODE_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_USB23_SW_MODE_V1_8814B) & \ -+ BIT_MASK_USB23_SW_MODE_V1_8814B) -+#define BIT_SET_USB23_SW_MODE_V1_8814B(x, v) \ -+ (BIT_CLEAR_USB23_SW_MODE_V1_8814B(x) | BIT_USB23_SW_MODE_V1_8814B(v)) -+ -+#define BIT_NO_PDN_CHIPOFF_V1_8814B BIT(17) -+#define BIT_RSM_EN_V1_8814B BIT(16) -+ -+#define BIT_SHIFT_MATCH_CNT_8814B 8 -+#define BIT_MASK_MATCH_CNT_8814B 0xff -+#define BIT_MATCH_CNT_8814B(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8814B) << BIT_SHIFT_MATCH_CNT_8814B) -+#define BITS_MATCH_CNT_8814B \ -+ (BIT_MASK_MATCH_CNT_8814B << BIT_SHIFT_MATCH_CNT_8814B) -+#define BIT_CLEAR_MATCH_CNT_8814B(x) ((x) & (~BITS_MATCH_CNT_8814B)) -+#define BIT_GET_MATCH_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8814B) & BIT_MASK_MATCH_CNT_8814B) -+#define BIT_SET_MATCH_CNT_8814B(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8814B(x) | BIT_MATCH_CNT_8814B(v)) -+ -+#define BIT_LD_B12V_EN_8814B BIT(7) -+#define BIT_EECS_IOSEL_V1_8814B BIT(6) -+#define BIT_EECS_DATA_O_V1_8814B BIT(5) -+#define BIT_EECS_DATA_I_V1_8814B BIT(4) -+#define BIT_EESK_IOSEL_V1_8814B BIT(2) -+#define BIT_EESK_DATA_O_V1_8814B BIT(1) -+#define BIT_EESK_DATA_I_V1_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_PMC_DBG_CTRL2_8814B */ -+ -+#define BIT_SHIFT_EFUSE_BURN_GNT_8814B 24 -+#define BIT_MASK_EFUSE_BURN_GNT_8814B 0xff -+#define BIT_EFUSE_BURN_GNT_8814B(x) \ -+ (((x) & BIT_MASK_EFUSE_BURN_GNT_8814B) \ -+ << BIT_SHIFT_EFUSE_BURN_GNT_8814B) -+#define BITS_EFUSE_BURN_GNT_8814B \ -+ (BIT_MASK_EFUSE_BURN_GNT_8814B << BIT_SHIFT_EFUSE_BURN_GNT_8814B) -+#define BIT_CLEAR_EFUSE_BURN_GNT_8814B(x) ((x) & (~BITS_EFUSE_BURN_GNT_8814B)) -+#define BIT_GET_EFUSE_BURN_GNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_EFUSE_BURN_GNT_8814B) & \ -+ BIT_MASK_EFUSE_BURN_GNT_8814B) -+#define BIT_SET_EFUSE_BURN_GNT_8814B(x, v) \ -+ (BIT_CLEAR_EFUSE_BURN_GNT_8814B(x) | BIT_EFUSE_BURN_GNT_8814B(v)) -+ -+#define BIT_STOP_WL_PMC_8814B BIT(9) -+#define BIT_STOP_SYM_PMC_8814B BIT(8) -+#define BIT_BT_ACCESS_WL_PAGE0_8814B BIT(6) -+#define BIT_REG_RST_WLPMC_8814B BIT(5) -+#define BIT_REG_RST_PD12N_8814B BIT(4) -+#define BIT_SYSON_DIS_WLREG_WRMSK_8814B BIT(3) -+#define BIT_SYSON_DIS_PMCREG_WRMSK_8814B BIT(2) -+ -+#define BIT_SHIFT_SYSON_REG_ARB_8814B 0 -+#define BIT_MASK_SYSON_REG_ARB_8814B 0x3 -+#define BIT_SYSON_REG_ARB_8814B(x) \ -+ (((x) & BIT_MASK_SYSON_REG_ARB_8814B) << BIT_SHIFT_SYSON_REG_ARB_8814B) -+#define BITS_SYSON_REG_ARB_8814B \ -+ (BIT_MASK_SYSON_REG_ARB_8814B << BIT_SHIFT_SYSON_REG_ARB_8814B) -+#define BIT_CLEAR_SYSON_REG_ARB_8814B(x) ((x) & (~BITS_SYSON_REG_ARB_8814B)) -+#define BIT_GET_SYSON_REG_ARB_8814B(x) \ -+ (((x) >> BIT_SHIFT_SYSON_REG_ARB_8814B) & BIT_MASK_SYSON_REG_ARB_8814B) -+#define BIT_SET_SYSON_REG_ARB_8814B(x, v) \ -+ (BIT_CLEAR_SYSON_REG_ARB_8814B(x) | BIT_SYSON_REG_ARB_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_MEM_CTRL_8814B */ -+#define BIT_UMEM_RME_8814B BIT(31) -+ -+#define BIT_SHIFT_BT_SPRAM_8814B 28 -+#define BIT_MASK_BT_SPRAM_8814B 0x3 -+#define BIT_BT_SPRAM_8814B(x) \ -+ (((x) & BIT_MASK_BT_SPRAM_8814B) << BIT_SHIFT_BT_SPRAM_8814B) -+#define BITS_BT_SPRAM_8814B \ -+ (BIT_MASK_BT_SPRAM_8814B << BIT_SHIFT_BT_SPRAM_8814B) -+#define BIT_CLEAR_BT_SPRAM_8814B(x) ((x) & (~BITS_BT_SPRAM_8814B)) -+#define BIT_GET_BT_SPRAM_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_SPRAM_8814B) & BIT_MASK_BT_SPRAM_8814B) -+#define BIT_SET_BT_SPRAM_8814B(x, v) \ -+ (BIT_CLEAR_BT_SPRAM_8814B(x) | BIT_BT_SPRAM_8814B(v)) -+ -+#define BIT_SHIFT_BT_ROM_8814B 24 -+#define BIT_MASK_BT_ROM_8814B 0xf -+#define BIT_BT_ROM_8814B(x) \ -+ (((x) & BIT_MASK_BT_ROM_8814B) << BIT_SHIFT_BT_ROM_8814B) -+#define BITS_BT_ROM_8814B (BIT_MASK_BT_ROM_8814B << BIT_SHIFT_BT_ROM_8814B) -+#define BIT_CLEAR_BT_ROM_8814B(x) ((x) & (~BITS_BT_ROM_8814B)) -+#define BIT_GET_BT_ROM_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_ROM_8814B) & BIT_MASK_BT_ROM_8814B) -+#define BIT_SET_BT_ROM_8814B(x, v) \ -+ (BIT_CLEAR_BT_ROM_8814B(x) | BIT_BT_ROM_8814B(v)) -+ -+#define BIT_SHIFT_PCI_DPRAM_8814B 10 -+#define BIT_MASK_PCI_DPRAM_8814B 0x3 -+#define BIT_PCI_DPRAM_8814B(x) \ -+ (((x) & BIT_MASK_PCI_DPRAM_8814B) << BIT_SHIFT_PCI_DPRAM_8814B) -+#define BITS_PCI_DPRAM_8814B \ -+ (BIT_MASK_PCI_DPRAM_8814B << BIT_SHIFT_PCI_DPRAM_8814B) -+#define BIT_CLEAR_PCI_DPRAM_8814B(x) ((x) & (~BITS_PCI_DPRAM_8814B)) -+#define BIT_GET_PCI_DPRAM_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCI_DPRAM_8814B) & BIT_MASK_PCI_DPRAM_8814B) -+#define BIT_SET_PCI_DPRAM_8814B(x, v) \ -+ (BIT_CLEAR_PCI_DPRAM_8814B(x) | BIT_PCI_DPRAM_8814B(v)) -+ -+#define BIT_SHIFT_PCI_SPRAM_8814B 8 -+#define BIT_MASK_PCI_SPRAM_8814B 0x3 -+#define BIT_PCI_SPRAM_8814B(x) \ -+ (((x) & BIT_MASK_PCI_SPRAM_8814B) << BIT_SHIFT_PCI_SPRAM_8814B) -+#define BITS_PCI_SPRAM_8814B \ -+ (BIT_MASK_PCI_SPRAM_8814B << BIT_SHIFT_PCI_SPRAM_8814B) -+#define BIT_CLEAR_PCI_SPRAM_8814B(x) ((x) & (~BITS_PCI_SPRAM_8814B)) -+#define BIT_GET_PCI_SPRAM_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCI_SPRAM_8814B) & BIT_MASK_PCI_SPRAM_8814B) -+#define BIT_SET_PCI_SPRAM_8814B(x, v) \ -+ (BIT_CLEAR_PCI_SPRAM_8814B(x) | BIT_PCI_SPRAM_8814B(v)) -+ -+#define BIT_SHIFT_USB_SPRAM_8814B 6 -+#define BIT_MASK_USB_SPRAM_8814B 0x3 -+#define BIT_USB_SPRAM_8814B(x) \ -+ (((x) & BIT_MASK_USB_SPRAM_8814B) << BIT_SHIFT_USB_SPRAM_8814B) -+#define BITS_USB_SPRAM_8814B \ -+ (BIT_MASK_USB_SPRAM_8814B << BIT_SHIFT_USB_SPRAM_8814B) -+#define BIT_CLEAR_USB_SPRAM_8814B(x) ((x) & (~BITS_USB_SPRAM_8814B)) -+#define BIT_GET_USB_SPRAM_8814B(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRAM_8814B) & BIT_MASK_USB_SPRAM_8814B) -+#define BIT_SET_USB_SPRAM_8814B(x, v) \ -+ (BIT_CLEAR_USB_SPRAM_8814B(x) | BIT_USB_SPRAM_8814B(v)) -+ -+#define BIT_SHIFT_USB_SPRF_8814B 4 -+#define BIT_MASK_USB_SPRF_8814B 0x3 -+#define BIT_USB_SPRF_8814B(x) \ -+ (((x) & BIT_MASK_USB_SPRF_8814B) << BIT_SHIFT_USB_SPRF_8814B) -+#define BITS_USB_SPRF_8814B \ -+ (BIT_MASK_USB_SPRF_8814B << BIT_SHIFT_USB_SPRF_8814B) -+#define BIT_CLEAR_USB_SPRF_8814B(x) ((x) & (~BITS_USB_SPRF_8814B)) -+#define BIT_GET_USB_SPRF_8814B(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRF_8814B) & BIT_MASK_USB_SPRF_8814B) -+#define BIT_SET_USB_SPRF_8814B(x, v) \ -+ (BIT_CLEAR_USB_SPRF_8814B(x) | BIT_USB_SPRF_8814B(v)) -+ -+#define BIT_SHIFT_MCU_ROM_8814B 0 -+#define BIT_MASK_MCU_ROM_8814B 0xf -+#define BIT_MCU_ROM_8814B(x) \ -+ (((x) & BIT_MASK_MCU_ROM_8814B) << BIT_SHIFT_MCU_ROM_8814B) -+#define BITS_MCU_ROM_8814B (BIT_MASK_MCU_ROM_8814B << BIT_SHIFT_MCU_ROM_8814B) -+#define BIT_CLEAR_MCU_ROM_8814B(x) ((x) & (~BITS_MCU_ROM_8814B)) -+#define BIT_GET_MCU_ROM_8814B(x) \ -+ (((x) >> BIT_SHIFT_MCU_ROM_8814B) & BIT_MASK_MCU_ROM_8814B) -+#define BIT_SET_MCU_ROM_8814B(x, v) \ -+ (BIT_CLEAR_MCU_ROM_8814B(x) | BIT_MCU_ROM_8814B(v)) -+ -+/* 2 REG_SYN_RFC_CTRL_8814B */ -+ -+#define BIT_SHIFT_SYN_RF1_CTRL_8814B 8 -+#define BIT_MASK_SYN_RF1_CTRL_8814B 0xff -+#define BIT_SYN_RF1_CTRL_8814B(x) \ -+ (((x) & BIT_MASK_SYN_RF1_CTRL_8814B) << BIT_SHIFT_SYN_RF1_CTRL_8814B) -+#define BITS_SYN_RF1_CTRL_8814B \ -+ (BIT_MASK_SYN_RF1_CTRL_8814B << BIT_SHIFT_SYN_RF1_CTRL_8814B) -+#define BIT_CLEAR_SYN_RF1_CTRL_8814B(x) ((x) & (~BITS_SYN_RF1_CTRL_8814B)) -+#define BIT_GET_SYN_RF1_CTRL_8814B(x) \ -+ (((x) >> BIT_SHIFT_SYN_RF1_CTRL_8814B) & BIT_MASK_SYN_RF1_CTRL_8814B) -+#define BIT_SET_SYN_RF1_CTRL_8814B(x, v) \ -+ (BIT_CLEAR_SYN_RF1_CTRL_8814B(x) | BIT_SYN_RF1_CTRL_8814B(v)) -+ -+#define BIT_SHIFT_SYN_RF0_CTRL_8814B 0 -+#define BIT_MASK_SYN_RF0_CTRL_8814B 0xff -+#define BIT_SYN_RF0_CTRL_8814B(x) \ -+ (((x) & BIT_MASK_SYN_RF0_CTRL_8814B) << BIT_SHIFT_SYN_RF0_CTRL_8814B) -+#define BITS_SYN_RF0_CTRL_8814B \ -+ (BIT_MASK_SYN_RF0_CTRL_8814B << BIT_SHIFT_SYN_RF0_CTRL_8814B) -+#define BIT_CLEAR_SYN_RF0_CTRL_8814B(x) ((x) & (~BITS_SYN_RF0_CTRL_8814B)) -+#define BIT_GET_SYN_RF0_CTRL_8814B(x) \ -+ (((x) >> BIT_SHIFT_SYN_RF0_CTRL_8814B) & BIT_MASK_SYN_RF0_CTRL_8814B) -+#define BIT_SET_SYN_RF0_CTRL_8814B(x, v) \ -+ (BIT_CLEAR_SYN_RF0_CTRL_8814B(x) | BIT_SYN_RF0_CTRL_8814B(v)) -+ -+/* 2 REG_USB_SIE_INTF_8814B */ -+#define BIT_RD_SEL_8814B BIT(31) -+#define BIT_USB_SIE_INTF_WE_V1_8814B BIT(30) -+#define BIT_USB_SIE_INTF_BYIOREG_V1_8814B BIT(29) -+#define BIT_USB_SIE_SELECT_8814B BIT(28) -+ -+#define BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8814B 16 -+#define BIT_MASK_USB_SIE_INTF_ADDR_V1_8814B 0x1ff -+#define BIT_USB_SIE_INTF_ADDR_V1_8814B(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_ADDR_V1_8814B) \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8814B) -+#define BITS_USB_SIE_INTF_ADDR_V1_8814B \ -+ (BIT_MASK_USB_SIE_INTF_ADDR_V1_8814B \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8814B) -+#define BIT_CLEAR_USB_SIE_INTF_ADDR_V1_8814B(x) \ -+ ((x) & (~BITS_USB_SIE_INTF_ADDR_V1_8814B)) -+#define BIT_GET_USB_SIE_INTF_ADDR_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8814B) & \ -+ BIT_MASK_USB_SIE_INTF_ADDR_V1_8814B) -+#define BIT_SET_USB_SIE_INTF_ADDR_V1_8814B(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_ADDR_V1_8814B(x) | \ -+ BIT_USB_SIE_INTF_ADDR_V1_8814B(v)) -+ -+#define BIT_SHIFT_USB_SIE_INTF_RD_8814B 8 -+#define BIT_MASK_USB_SIE_INTF_RD_8814B 0xff -+#define BIT_USB_SIE_INTF_RD_8814B(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_RD_8814B) \ -+ << BIT_SHIFT_USB_SIE_INTF_RD_8814B) -+#define BITS_USB_SIE_INTF_RD_8814B \ -+ (BIT_MASK_USB_SIE_INTF_RD_8814B << BIT_SHIFT_USB_SIE_INTF_RD_8814B) -+#define BIT_CLEAR_USB_SIE_INTF_RD_8814B(x) ((x) & (~BITS_USB_SIE_INTF_RD_8814B)) -+#define BIT_GET_USB_SIE_INTF_RD_8814B(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_RD_8814B) & \ -+ BIT_MASK_USB_SIE_INTF_RD_8814B) -+#define BIT_SET_USB_SIE_INTF_RD_8814B(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_RD_8814B(x) | BIT_USB_SIE_INTF_RD_8814B(v)) -+ -+#define BIT_SHIFT_USB_SIE_INTF_WD_8814B 0 -+#define BIT_MASK_USB_SIE_INTF_WD_8814B 0xff -+#define BIT_USB_SIE_INTF_WD_8814B(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_WD_8814B) \ -+ << BIT_SHIFT_USB_SIE_INTF_WD_8814B) -+#define BITS_USB_SIE_INTF_WD_8814B \ -+ (BIT_MASK_USB_SIE_INTF_WD_8814B << BIT_SHIFT_USB_SIE_INTF_WD_8814B) -+#define BIT_CLEAR_USB_SIE_INTF_WD_8814B(x) ((x) & (~BITS_USB_SIE_INTF_WD_8814B)) -+#define BIT_GET_USB_SIE_INTF_WD_8814B(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_WD_8814B) & \ -+ BIT_MASK_USB_SIE_INTF_WD_8814B) -+#define BIT_SET_USB_SIE_INTF_WD_8814B(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_WD_8814B(x) | BIT_USB_SIE_INTF_WD_8814B(v)) -+ -+/* 2 REG_PCIE_MIO_INTF_8814B */ -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8814B 16 -+#define BIT_MASK_PCIE_MIO_ADDR_PAGE_8814B 0x3 -+#define BIT_PCIE_MIO_ADDR_PAGE_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_PAGE_8814B) \ -+ << BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8814B) -+#define BITS_PCIE_MIO_ADDR_PAGE_8814B \ -+ (BIT_MASK_PCIE_MIO_ADDR_PAGE_8814B \ -+ << BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8814B) -+#define BIT_CLEAR_PCIE_MIO_ADDR_PAGE_8814B(x) \ -+ ((x) & (~BITS_PCIE_MIO_ADDR_PAGE_8814B)) -+#define BIT_GET_PCIE_MIO_ADDR_PAGE_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8814B) & \ -+ BIT_MASK_PCIE_MIO_ADDR_PAGE_8814B) -+#define BIT_SET_PCIE_MIO_ADDR_PAGE_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_PAGE_8814B(x) | \ -+ BIT_PCIE_MIO_ADDR_PAGE_8814B(v)) -+ -+#define BIT_PCIE_MIO_BYIOREG_8814B BIT(13) -+#define BIT_PCIE_MIO_RE_8814B BIT(12) -+ -+#define BIT_SHIFT_PCIE_MIO_WE_8814B 8 -+#define BIT_MASK_PCIE_MIO_WE_8814B 0xf -+#define BIT_PCIE_MIO_WE_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_WE_8814B) << BIT_SHIFT_PCIE_MIO_WE_8814B) -+#define BITS_PCIE_MIO_WE_8814B \ -+ (BIT_MASK_PCIE_MIO_WE_8814B << BIT_SHIFT_PCIE_MIO_WE_8814B) -+#define BIT_CLEAR_PCIE_MIO_WE_8814B(x) ((x) & (~BITS_PCIE_MIO_WE_8814B)) -+#define BIT_GET_PCIE_MIO_WE_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_WE_8814B) & BIT_MASK_PCIE_MIO_WE_8814B) -+#define BIT_SET_PCIE_MIO_WE_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_WE_8814B(x) | BIT_PCIE_MIO_WE_8814B(v)) -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_8814B 0 -+#define BIT_MASK_PCIE_MIO_ADDR_8814B 0xff -+#define BIT_PCIE_MIO_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_8814B) << BIT_SHIFT_PCIE_MIO_ADDR_8814B) -+#define BITS_PCIE_MIO_ADDR_8814B \ -+ (BIT_MASK_PCIE_MIO_ADDR_8814B << BIT_SHIFT_PCIE_MIO_ADDR_8814B) -+#define BIT_CLEAR_PCIE_MIO_ADDR_8814B(x) ((x) & (~BITS_PCIE_MIO_ADDR_8814B)) -+#define BIT_GET_PCIE_MIO_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_8814B) & BIT_MASK_PCIE_MIO_ADDR_8814B) -+#define BIT_SET_PCIE_MIO_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_8814B(x) | BIT_PCIE_MIO_ADDR_8814B(v)) -+ -+/* 2 REG_PCIE_MIO_INTD_8814B */ -+ -+#define BIT_SHIFT_PCIE_MIO_DATA_8814B 0 -+#define BIT_MASK_PCIE_MIO_DATA_8814B 0xffffffffL -+#define BIT_PCIE_MIO_DATA_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_DATA_8814B) << BIT_SHIFT_PCIE_MIO_DATA_8814B) -+#define BITS_PCIE_MIO_DATA_8814B \ -+ (BIT_MASK_PCIE_MIO_DATA_8814B << BIT_SHIFT_PCIE_MIO_DATA_8814B) -+#define BIT_CLEAR_PCIE_MIO_DATA_8814B(x) ((x) & (~BITS_PCIE_MIO_DATA_8814B)) -+#define BIT_GET_PCIE_MIO_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_DATA_8814B) & BIT_MASK_PCIE_MIO_DATA_8814B) -+#define BIT_SET_PCIE_MIO_DATA_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_DATA_8814B(x) | BIT_PCIE_MIO_DATA_8814B(v)) -+ -+/* 2 REG_WLRF1_8814B */ -+ -+#define BIT_SHIFT_WLRF1_CTRL_8814B 24 -+#define BIT_MASK_WLRF1_CTRL_8814B 0xff -+#define BIT_WLRF1_CTRL_8814B(x) \ -+ (((x) & BIT_MASK_WLRF1_CTRL_8814B) << BIT_SHIFT_WLRF1_CTRL_8814B) -+#define BITS_WLRF1_CTRL_8814B \ -+ (BIT_MASK_WLRF1_CTRL_8814B << BIT_SHIFT_WLRF1_CTRL_8814B) -+#define BIT_CLEAR_WLRF1_CTRL_8814B(x) ((x) & (~BITS_WLRF1_CTRL_8814B)) -+#define BIT_GET_WLRF1_CTRL_8814B(x) \ -+ (((x) >> BIT_SHIFT_WLRF1_CTRL_8814B) & BIT_MASK_WLRF1_CTRL_8814B) -+#define BIT_SET_WLRF1_CTRL_8814B(x, v) \ -+ (BIT_CLEAR_WLRF1_CTRL_8814B(x) | BIT_WLRF1_CTRL_8814B(v)) -+ -+#define BIT_SHIFT_WLRF2_CTRL_8814B 16 -+#define BIT_MASK_WLRF2_CTRL_8814B 0xff -+#define BIT_WLRF2_CTRL_8814B(x) \ -+ (((x) & BIT_MASK_WLRF2_CTRL_8814B) << BIT_SHIFT_WLRF2_CTRL_8814B) -+#define BITS_WLRF2_CTRL_8814B \ -+ (BIT_MASK_WLRF2_CTRL_8814B << BIT_SHIFT_WLRF2_CTRL_8814B) -+#define BIT_CLEAR_WLRF2_CTRL_8814B(x) ((x) & (~BITS_WLRF2_CTRL_8814B)) -+#define BIT_GET_WLRF2_CTRL_8814B(x) \ -+ (((x) >> BIT_SHIFT_WLRF2_CTRL_8814B) & BIT_MASK_WLRF2_CTRL_8814B) -+#define BIT_SET_WLRF2_CTRL_8814B(x, v) \ -+ (BIT_CLEAR_WLRF2_CTRL_8814B(x) | BIT_WLRF2_CTRL_8814B(v)) -+ -+#define BIT_SHIFT_WLRF3_CTRL_8814B 8 -+#define BIT_MASK_WLRF3_CTRL_8814B 0xff -+#define BIT_WLRF3_CTRL_8814B(x) \ -+ (((x) & BIT_MASK_WLRF3_CTRL_8814B) << BIT_SHIFT_WLRF3_CTRL_8814B) -+#define BITS_WLRF3_CTRL_8814B \ -+ (BIT_MASK_WLRF3_CTRL_8814B << BIT_SHIFT_WLRF3_CTRL_8814B) -+#define BIT_CLEAR_WLRF3_CTRL_8814B(x) ((x) & (~BITS_WLRF3_CTRL_8814B)) -+#define BIT_GET_WLRF3_CTRL_8814B(x) \ -+ (((x) >> BIT_SHIFT_WLRF3_CTRL_8814B) & BIT_MASK_WLRF3_CTRL_8814B) -+#define BIT_SET_WLRF3_CTRL_8814B(x, v) \ -+ (BIT_CLEAR_WLRF3_CTRL_8814B(x) | BIT_WLRF3_CTRL_8814B(v)) -+ -+/* 2 REG_SYS_CFG1_8814B */ -+ -+#define BIT_SHIFT_TRP_ICFG_8814B 28 -+#define BIT_MASK_TRP_ICFG_8814B 0xf -+#define BIT_TRP_ICFG_8814B(x) \ -+ (((x) & BIT_MASK_TRP_ICFG_8814B) << BIT_SHIFT_TRP_ICFG_8814B) -+#define BITS_TRP_ICFG_8814B \ -+ (BIT_MASK_TRP_ICFG_8814B << BIT_SHIFT_TRP_ICFG_8814B) -+#define BIT_CLEAR_TRP_ICFG_8814B(x) ((x) & (~BITS_TRP_ICFG_8814B)) -+#define BIT_GET_TRP_ICFG_8814B(x) \ -+ (((x) >> BIT_SHIFT_TRP_ICFG_8814B) & BIT_MASK_TRP_ICFG_8814B) -+#define BIT_SET_TRP_ICFG_8814B(x, v) \ -+ (BIT_CLEAR_TRP_ICFG_8814B(x) | BIT_TRP_ICFG_8814B(v)) -+ -+#define BIT_RF_TYPE_ID_8814B BIT(27) -+#define BIT_BD_HCI_SEL_8814B BIT(26) -+#define BIT_BD_PKG_SEL_8814B BIT(25) -+#define BIT_SPSLDO_SEL_8814B BIT(24) -+#define BIT_RTL_ID_8814B BIT(23) -+#define BIT_PAD_HWPD_IDN_8814B BIT(22) -+#define BIT_TESTMODE_8814B BIT(20) -+ -+#define BIT_SHIFT_VENDOR_ID_8814B 16 -+#define BIT_MASK_VENDOR_ID_8814B 0xf -+#define BIT_VENDOR_ID_8814B(x) \ -+ (((x) & BIT_MASK_VENDOR_ID_8814B) << BIT_SHIFT_VENDOR_ID_8814B) -+#define BITS_VENDOR_ID_8814B \ -+ (BIT_MASK_VENDOR_ID_8814B << BIT_SHIFT_VENDOR_ID_8814B) -+#define BIT_CLEAR_VENDOR_ID_8814B(x) ((x) & (~BITS_VENDOR_ID_8814B)) -+#define BIT_GET_VENDOR_ID_8814B(x) \ -+ (((x) >> BIT_SHIFT_VENDOR_ID_8814B) & BIT_MASK_VENDOR_ID_8814B) -+#define BIT_SET_VENDOR_ID_8814B(x, v) \ -+ (BIT_CLEAR_VENDOR_ID_8814B(x) | BIT_VENDOR_ID_8814B(v)) -+ -+#define BIT_SHIFT_CHIP_VER_8814B 12 -+#define BIT_MASK_CHIP_VER_8814B 0xf -+#define BIT_CHIP_VER_8814B(x) \ -+ (((x) & BIT_MASK_CHIP_VER_8814B) << BIT_SHIFT_CHIP_VER_8814B) -+#define BITS_CHIP_VER_8814B \ -+ (BIT_MASK_CHIP_VER_8814B << BIT_SHIFT_CHIP_VER_8814B) -+#define BIT_CLEAR_CHIP_VER_8814B(x) ((x) & (~BITS_CHIP_VER_8814B)) -+#define BIT_GET_CHIP_VER_8814B(x) \ -+ (((x) >> BIT_SHIFT_CHIP_VER_8814B) & BIT_MASK_CHIP_VER_8814B) -+#define BIT_SET_CHIP_VER_8814B(x, v) \ -+ (BIT_CLEAR_CHIP_VER_8814B(x) | BIT_CHIP_VER_8814B(v)) -+ -+#define BIT_BD_MAC3_8814B BIT(11) -+#define BIT_BD_MAC1_8814B BIT(10) -+#define BIT_BD_MAC2_8814B BIT(9) -+#define BIT_SIC_IDLE_8814B BIT(8) -+#define BIT_SW_OFFLOAD_EN_8814B BIT(7) -+#define BIT_OCP_SHUTDN_8814B BIT(6) -+#define BIT_V15_VLD_8814B BIT(5) -+#define BIT_PCIRSTB_8814B BIT(4) -+#define BIT_PCLK_VLD_8814B BIT(3) -+#define BIT_UCLK_VLD_8814B BIT(2) -+#define BIT_ACLK_VLD_8814B BIT(1) -+#define BIT_XCLK_VLD_8814B BIT(0) -+ -+/* 2 REG_SYS_STATUS1_8814B */ -+ -+#define BIT_SHIFT_RF_RL_ID_8814B 28 -+#define BIT_MASK_RF_RL_ID_8814B 0xf -+#define BIT_RF_RL_ID_8814B(x) \ -+ (((x) & BIT_MASK_RF_RL_ID_8814B) << BIT_SHIFT_RF_RL_ID_8814B) -+#define BITS_RF_RL_ID_8814B \ -+ (BIT_MASK_RF_RL_ID_8814B << BIT_SHIFT_RF_RL_ID_8814B) -+#define BIT_CLEAR_RF_RL_ID_8814B(x) ((x) & (~BITS_RF_RL_ID_8814B)) -+#define BIT_GET_RF_RL_ID_8814B(x) \ -+ (((x) >> BIT_SHIFT_RF_RL_ID_8814B) & BIT_MASK_RF_RL_ID_8814B) -+#define BIT_SET_RF_RL_ID_8814B(x, v) \ -+ (BIT_CLEAR_RF_RL_ID_8814B(x) | BIT_RF_RL_ID_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_XTAL_SEL_8814B 25 -+#define BIT_MASK_XTAL_SEL_8814B 0x3 -+#define BIT_XTAL_SEL_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_8814B) << BIT_SHIFT_XTAL_SEL_8814B) -+#define BITS_XTAL_SEL_8814B \ -+ (BIT_MASK_XTAL_SEL_8814B << BIT_SHIFT_XTAL_SEL_8814B) -+#define BIT_CLEAR_XTAL_SEL_8814B(x) ((x) & (~BITS_XTAL_SEL_8814B)) -+#define BIT_GET_XTAL_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_8814B) & BIT_MASK_XTAL_SEL_8814B) -+#define BIT_SET_XTAL_SEL_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_8814B(x) | BIT_XTAL_SEL_8814B(v)) -+ -+#define BIT_HPHY_ICFG_8814B BIT(19) -+ -+#define BIT_SHIFT_SEL_0XC0_8814B 16 -+#define BIT_MASK_SEL_0XC0_8814B 0x3 -+#define BIT_SEL_0XC0_8814B(x) \ -+ (((x) & BIT_MASK_SEL_0XC0_8814B) << BIT_SHIFT_SEL_0XC0_8814B) -+#define BITS_SEL_0XC0_8814B \ -+ (BIT_MASK_SEL_0XC0_8814B << BIT_SHIFT_SEL_0XC0_8814B) -+#define BIT_CLEAR_SEL_0XC0_8814B(x) ((x) & (~BITS_SEL_0XC0_8814B)) -+#define BIT_GET_SEL_0XC0_8814B(x) \ -+ (((x) >> BIT_SHIFT_SEL_0XC0_8814B) & BIT_MASK_SEL_0XC0_8814B) -+#define BIT_SET_SEL_0XC0_8814B(x, v) \ -+ (BIT_CLEAR_SEL_0XC0_8814B(x) | BIT_SEL_0XC0_8814B(v)) -+ -+#define BIT_SHIFT_HCI_SEL_V4_8814B 12 -+#define BIT_MASK_HCI_SEL_V4_8814B 0x3 -+#define BIT_HCI_SEL_V4_8814B(x) \ -+ (((x) & BIT_MASK_HCI_SEL_V4_8814B) << BIT_SHIFT_HCI_SEL_V4_8814B) -+#define BITS_HCI_SEL_V4_8814B \ -+ (BIT_MASK_HCI_SEL_V4_8814B << BIT_SHIFT_HCI_SEL_V4_8814B) -+#define BIT_CLEAR_HCI_SEL_V4_8814B(x) ((x) & (~BITS_HCI_SEL_V4_8814B)) -+#define BIT_GET_HCI_SEL_V4_8814B(x) \ -+ (((x) >> BIT_SHIFT_HCI_SEL_V4_8814B) & BIT_MASK_HCI_SEL_V4_8814B) -+#define BIT_SET_HCI_SEL_V4_8814B(x, v) \ -+ (BIT_CLEAR_HCI_SEL_V4_8814B(x) | BIT_HCI_SEL_V4_8814B(v)) -+ -+#define BIT_USB_OPERATION_MODE_8814B BIT(10) -+#define BIT_BT_PDN_8814B BIT(9) -+#define BIT_AUTO_WLPON_8814B BIT(8) -+#define BIT_WL_MODE_8814B BIT(7) -+#define BIT_PKG_SEL_HCI_8814B BIT(6) -+ -+#define BIT_SHIFT_PAD_HCI_SEL_V2_8814B 3 -+#define BIT_MASK_PAD_HCI_SEL_V2_8814B 0x3 -+#define BIT_PAD_HCI_SEL_V2_8814B(x) \ -+ (((x) & BIT_MASK_PAD_HCI_SEL_V2_8814B) \ -+ << BIT_SHIFT_PAD_HCI_SEL_V2_8814B) -+#define BITS_PAD_HCI_SEL_V2_8814B \ -+ (BIT_MASK_PAD_HCI_SEL_V2_8814B << BIT_SHIFT_PAD_HCI_SEL_V2_8814B) -+#define BIT_CLEAR_PAD_HCI_SEL_V2_8814B(x) ((x) & (~BITS_PAD_HCI_SEL_V2_8814B)) -+#define BIT_GET_PAD_HCI_SEL_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_PAD_HCI_SEL_V2_8814B) & \ -+ BIT_MASK_PAD_HCI_SEL_V2_8814B) -+#define BIT_SET_PAD_HCI_SEL_V2_8814B(x, v) \ -+ (BIT_CLEAR_PAD_HCI_SEL_V2_8814B(x) | BIT_PAD_HCI_SEL_V2_8814B(v)) -+ -+#define BIT_SHIFT_EFS_HCI_SEL_8814B 0 -+#define BIT_MASK_EFS_HCI_SEL_8814B 0x3 -+#define BIT_EFS_HCI_SEL_8814B(x) \ -+ (((x) & BIT_MASK_EFS_HCI_SEL_8814B) << BIT_SHIFT_EFS_HCI_SEL_8814B) -+#define BITS_EFS_HCI_SEL_8814B \ -+ (BIT_MASK_EFS_HCI_SEL_8814B << BIT_SHIFT_EFS_HCI_SEL_8814B) -+#define BIT_CLEAR_EFS_HCI_SEL_8814B(x) ((x) & (~BITS_EFS_HCI_SEL_8814B)) -+#define BIT_GET_EFS_HCI_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_EFS_HCI_SEL_8814B) & BIT_MASK_EFS_HCI_SEL_8814B) -+#define BIT_SET_EFS_HCI_SEL_8814B(x, v) \ -+ (BIT_CLEAR_EFS_HCI_SEL_8814B(x) | BIT_EFS_HCI_SEL_8814B(v)) -+ -+/* 2 REG_SYS_STATUS2_8814B */ -+#define BIT_SIO_ALDN_8814B BIT(19) -+#define BIT_USB_ALDN_8814B BIT(18) -+#define BIT_PCI_ALDN_8814B BIT(17) -+#define BIT_SYS_ALDN_8814B BIT(16) -+ -+#define BIT_SHIFT_EPVID1_8814B 8 -+#define BIT_MASK_EPVID1_8814B 0xff -+#define BIT_EPVID1_8814B(x) \ -+ (((x) & BIT_MASK_EPVID1_8814B) << BIT_SHIFT_EPVID1_8814B) -+#define BITS_EPVID1_8814B (BIT_MASK_EPVID1_8814B << BIT_SHIFT_EPVID1_8814B) -+#define BIT_CLEAR_EPVID1_8814B(x) ((x) & (~BITS_EPVID1_8814B)) -+#define BIT_GET_EPVID1_8814B(x) \ -+ (((x) >> BIT_SHIFT_EPVID1_8814B) & BIT_MASK_EPVID1_8814B) -+#define BIT_SET_EPVID1_8814B(x, v) \ -+ (BIT_CLEAR_EPVID1_8814B(x) | BIT_EPVID1_8814B(v)) -+ -+#define BIT_SHIFT_EPVID0_8814B 0 -+#define BIT_MASK_EPVID0_8814B 0xff -+#define BIT_EPVID0_8814B(x) \ -+ (((x) & BIT_MASK_EPVID0_8814B) << BIT_SHIFT_EPVID0_8814B) -+#define BITS_EPVID0_8814B (BIT_MASK_EPVID0_8814B << BIT_SHIFT_EPVID0_8814B) -+#define BIT_CLEAR_EPVID0_8814B(x) ((x) & (~BITS_EPVID0_8814B)) -+#define BIT_GET_EPVID0_8814B(x) \ -+ (((x) >> BIT_SHIFT_EPVID0_8814B) & BIT_MASK_EPVID0_8814B) -+#define BIT_SET_EPVID0_8814B(x, v) \ -+ (BIT_CLEAR_EPVID0_8814B(x) | BIT_EPVID0_8814B(v)) -+ -+/* 2 REG_SYS_CFG2_8814B */ -+#define BIT_USB2_SEL_8814B BIT(31) -+#define BIT_U3PHY_RST_V1_8814B BIT(30) -+#define BIT_U3_TERM_DETECT_8814B BIT(29) -+ -+#define BIT_SHIFT_HW_ID_8814B 0 -+#define BIT_MASK_HW_ID_8814B 0xff -+#define BIT_HW_ID_8814B(x) \ -+ (((x) & BIT_MASK_HW_ID_8814B) << BIT_SHIFT_HW_ID_8814B) -+#define BITS_HW_ID_8814B (BIT_MASK_HW_ID_8814B << BIT_SHIFT_HW_ID_8814B) -+#define BIT_CLEAR_HW_ID_8814B(x) ((x) & (~BITS_HW_ID_8814B)) -+#define BIT_GET_HW_ID_8814B(x) \ -+ (((x) >> BIT_SHIFT_HW_ID_8814B) & BIT_MASK_HW_ID_8814B) -+#define BIT_SET_HW_ID_8814B(x, v) \ -+ (BIT_CLEAR_HW_ID_8814B(x) | BIT_HW_ID_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_FEN_WLMAC_OFF_8814B BIT(31) -+#define BIT_PWC_MA33V_8814B BIT(15) -+#define BIT_PWC_MA12V_8814B BIT(14) -+#define BIT_PWC_MD12V_8814B BIT(13) -+#define BIT_PWC_PD12V_8814B BIT(12) -+#define BIT_PWC_UD12V_8814B BIT(11) -+#define BIT_ISO_BB2PP_8814B BIT(7) -+#define BIT_ISO_DENG2PP_8814B BIT(6) -+#define BIT_ISO_MA2MD_8814B BIT(1) -+#define BIT_ISO_MD2PP_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_ANAPARSW_MAC_0_8814B */ -+#define BIT_OCP_L_0_8814B BIT(31) -+#define BIT_POWOCP_L_8814B BIT(30) -+ -+#define BIT_SHIFT_CF_L_1_0_8814B 28 -+#define BIT_MASK_CF_L_1_0_8814B 0x3 -+#define BIT_CF_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_CF_L_1_0_8814B) << BIT_SHIFT_CF_L_1_0_8814B) -+#define BITS_CF_L_1_0_8814B \ -+ (BIT_MASK_CF_L_1_0_8814B << BIT_SHIFT_CF_L_1_0_8814B) -+#define BIT_CLEAR_CF_L_1_0_8814B(x) ((x) & (~BITS_CF_L_1_0_8814B)) -+#define BIT_GET_CF_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_CF_L_1_0_8814B) & BIT_MASK_CF_L_1_0_8814B) -+#define BIT_SET_CF_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_CF_L_1_0_8814B(x) | BIT_CF_L_1_0_8814B(v)) -+ -+#define BIT_SHIFT_CFC_L_1_0_8814B 26 -+#define BIT_MASK_CFC_L_1_0_8814B 0x3 -+#define BIT_CFC_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_CFC_L_1_0_8814B) << BIT_SHIFT_CFC_L_1_0_8814B) -+#define BITS_CFC_L_1_0_8814B \ -+ (BIT_MASK_CFC_L_1_0_8814B << BIT_SHIFT_CFC_L_1_0_8814B) -+#define BIT_CLEAR_CFC_L_1_0_8814B(x) ((x) & (~BITS_CFC_L_1_0_8814B)) -+#define BIT_GET_CFC_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_CFC_L_1_0_8814B) & BIT_MASK_CFC_L_1_0_8814B) -+#define BIT_SET_CFC_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_CFC_L_1_0_8814B(x) | BIT_CFC_L_1_0_8814B(v)) -+ -+#define BIT_SHIFT_R3_L_1_0_8814B 24 -+#define BIT_MASK_R3_L_1_0_8814B 0x3 -+#define BIT_R3_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_R3_L_1_0_8814B) << BIT_SHIFT_R3_L_1_0_8814B) -+#define BITS_R3_L_1_0_8814B \ -+ (BIT_MASK_R3_L_1_0_8814B << BIT_SHIFT_R3_L_1_0_8814B) -+#define BIT_CLEAR_R3_L_1_0_8814B(x) ((x) & (~BITS_R3_L_1_0_8814B)) -+#define BIT_GET_R3_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_R3_L_1_0_8814B) & BIT_MASK_R3_L_1_0_8814B) -+#define BIT_SET_R3_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_R3_L_1_0_8814B(x) | BIT_R3_L_1_0_8814B(v)) -+ -+#define BIT_SHIFT_R2_L_1_0_8814B 22 -+#define BIT_MASK_R2_L_1_0_8814B 0x3 -+#define BIT_R2_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_R2_L_1_0_8814B) << BIT_SHIFT_R2_L_1_0_8814B) -+#define BITS_R2_L_1_0_8814B \ -+ (BIT_MASK_R2_L_1_0_8814B << BIT_SHIFT_R2_L_1_0_8814B) -+#define BIT_CLEAR_R2_L_1_0_8814B(x) ((x) & (~BITS_R2_L_1_0_8814B)) -+#define BIT_GET_R2_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_R2_L_1_0_8814B) & BIT_MASK_R2_L_1_0_8814B) -+#define BIT_SET_R2_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_R2_L_1_0_8814B(x) | BIT_R2_L_1_0_8814B(v)) -+ -+#define BIT_SHIFT_R1_L_1_0_8814B 20 -+#define BIT_MASK_R1_L_1_0_8814B 0x3 -+#define BIT_R1_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_R1_L_1_0_8814B) << BIT_SHIFT_R1_L_1_0_8814B) -+#define BITS_R1_L_1_0_8814B \ -+ (BIT_MASK_R1_L_1_0_8814B << BIT_SHIFT_R1_L_1_0_8814B) -+#define BIT_CLEAR_R1_L_1_0_8814B(x) ((x) & (~BITS_R1_L_1_0_8814B)) -+#define BIT_GET_R1_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_R1_L_1_0_8814B) & BIT_MASK_R1_L_1_0_8814B) -+#define BIT_SET_R1_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_R1_L_1_0_8814B(x) | BIT_R1_L_1_0_8814B(v)) -+ -+#define BIT_SHIFT_C3_L_1_0_8814B 18 -+#define BIT_MASK_C3_L_1_0_8814B 0x3 -+#define BIT_C3_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_C3_L_1_0_8814B) << BIT_SHIFT_C3_L_1_0_8814B) -+#define BITS_C3_L_1_0_8814B \ -+ (BIT_MASK_C3_L_1_0_8814B << BIT_SHIFT_C3_L_1_0_8814B) -+#define BIT_CLEAR_C3_L_1_0_8814B(x) ((x) & (~BITS_C3_L_1_0_8814B)) -+#define BIT_GET_C3_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_C3_L_1_0_8814B) & BIT_MASK_C3_L_1_0_8814B) -+#define BIT_SET_C3_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_C3_L_1_0_8814B(x) | BIT_C3_L_1_0_8814B(v)) -+ -+#define BIT_SHIFT_C2_L_1_0_8814B 16 -+#define BIT_MASK_C2_L_1_0_8814B 0x3 -+#define BIT_C2_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_C2_L_1_0_8814B) << BIT_SHIFT_C2_L_1_0_8814B) -+#define BITS_C2_L_1_0_8814B \ -+ (BIT_MASK_C2_L_1_0_8814B << BIT_SHIFT_C2_L_1_0_8814B) -+#define BIT_CLEAR_C2_L_1_0_8814B(x) ((x) & (~BITS_C2_L_1_0_8814B)) -+#define BIT_GET_C2_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_C2_L_1_0_8814B) & BIT_MASK_C2_L_1_0_8814B) -+#define BIT_SET_C2_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_C2_L_1_0_8814B(x) | BIT_C2_L_1_0_8814B(v)) -+ -+#define BIT_SHIFT_C1_L_1_0_8814B 14 -+#define BIT_MASK_C1_L_1_0_8814B 0x3 -+#define BIT_C1_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_C1_L_1_0_8814B) << BIT_SHIFT_C1_L_1_0_8814B) -+#define BITS_C1_L_1_0_8814B \ -+ (BIT_MASK_C1_L_1_0_8814B << BIT_SHIFT_C1_L_1_0_8814B) -+#define BIT_CLEAR_C1_L_1_0_8814B(x) ((x) & (~BITS_C1_L_1_0_8814B)) -+#define BIT_GET_C1_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_C1_L_1_0_8814B) & BIT_MASK_C1_L_1_0_8814B) -+#define BIT_SET_C1_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_C1_L_1_0_8814B(x) | BIT_C1_L_1_0_8814B(v)) -+ -+#define BIT_REG_TYPE_L_V2_8814B BIT(13) -+#define BIT_REG_PWM_L_8814B BIT(12) -+ -+#define BIT_SHIFT_V15ADJ_L_2_0_8814B 9 -+#define BIT_MASK_V15ADJ_L_2_0_8814B 0x7 -+#define BIT_V15ADJ_L_2_0_8814B(x) \ -+ (((x) & BIT_MASK_V15ADJ_L_2_0_8814B) << BIT_SHIFT_V15ADJ_L_2_0_8814B) -+#define BITS_V15ADJ_L_2_0_8814B \ -+ (BIT_MASK_V15ADJ_L_2_0_8814B << BIT_SHIFT_V15ADJ_L_2_0_8814B) -+#define BIT_CLEAR_V15ADJ_L_2_0_8814B(x) ((x) & (~BITS_V15ADJ_L_2_0_8814B)) -+#define BIT_GET_V15ADJ_L_2_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L_2_0_8814B) & BIT_MASK_V15ADJ_L_2_0_8814B) -+#define BIT_SET_V15ADJ_L_2_0_8814B(x, v) \ -+ (BIT_CLEAR_V15ADJ_L_2_0_8814B(x) | BIT_V15ADJ_L_2_0_8814B(v)) -+ -+#define BIT_SHIFT_IN_L_2_0_8814B 6 -+#define BIT_MASK_IN_L_2_0_8814B 0x7 -+#define BIT_IN_L_2_0_8814B(x) \ -+ (((x) & BIT_MASK_IN_L_2_0_8814B) << BIT_SHIFT_IN_L_2_0_8814B) -+#define BITS_IN_L_2_0_8814B \ -+ (BIT_MASK_IN_L_2_0_8814B << BIT_SHIFT_IN_L_2_0_8814B) -+#define BIT_CLEAR_IN_L_2_0_8814B(x) ((x) & (~BITS_IN_L_2_0_8814B)) -+#define BIT_GET_IN_L_2_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_IN_L_2_0_8814B) & BIT_MASK_IN_L_2_0_8814B) -+#define BIT_SET_IN_L_2_0_8814B(x, v) \ -+ (BIT_CLEAR_IN_L_2_0_8814B(x) | BIT_IN_L_2_0_8814B(v)) -+ -+#define BIT_SHIFT_STD_L_1_0_8814B 4 -+#define BIT_MASK_STD_L_1_0_8814B 0x3 -+#define BIT_STD_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_STD_L_1_0_8814B) << BIT_SHIFT_STD_L_1_0_8814B) -+#define BITS_STD_L_1_0_8814B \ -+ (BIT_MASK_STD_L_1_0_8814B << BIT_SHIFT_STD_L_1_0_8814B) -+#define BIT_CLEAR_STD_L_1_0_8814B(x) ((x) & (~BITS_STD_L_1_0_8814B)) -+#define BIT_GET_STD_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_STD_L_1_0_8814B) & BIT_MASK_STD_L_1_0_8814B) -+#define BIT_SET_STD_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_STD_L_1_0_8814B(x) | BIT_STD_L_1_0_8814B(v)) -+ -+#define BIT_SHIFT_VOL_L_3_0_8814B 0 -+#define BIT_MASK_VOL_L_3_0_8814B 0xf -+#define BIT_VOL_L_3_0_8814B(x) \ -+ (((x) & BIT_MASK_VOL_L_3_0_8814B) << BIT_SHIFT_VOL_L_3_0_8814B) -+#define BITS_VOL_L_3_0_8814B \ -+ (BIT_MASK_VOL_L_3_0_8814B << BIT_SHIFT_VOL_L_3_0_8814B) -+#define BIT_CLEAR_VOL_L_3_0_8814B(x) ((x) & (~BITS_VOL_L_3_0_8814B)) -+#define BIT_GET_VOL_L_3_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_VOL_L_3_0_8814B) & BIT_MASK_VOL_L_3_0_8814B) -+#define BIT_SET_VOL_L_3_0_8814B(x, v) \ -+ (BIT_CLEAR_VOL_L_3_0_8814B(x) | BIT_VOL_L_3_0_8814B(v)) -+ -+/* 2 REG_ANAPARSW_MAC_1_8814B */ -+ -+#define BIT_SHIFT_REG_FREQ_L_V1_8814B 20 -+#define BIT_MASK_REG_FREQ_L_V1_8814B 0x7 -+#define BIT_REG_FREQ_L_V1_8814B(x) \ -+ (((x) & BIT_MASK_REG_FREQ_L_V1_8814B) << BIT_SHIFT_REG_FREQ_L_V1_8814B) -+#define BITS_REG_FREQ_L_V1_8814B \ -+ (BIT_MASK_REG_FREQ_L_V1_8814B << BIT_SHIFT_REG_FREQ_L_V1_8814B) -+#define BIT_CLEAR_REG_FREQ_L_V1_8814B(x) ((x) & (~BITS_REG_FREQ_L_V1_8814B)) -+#define BIT_GET_REG_FREQ_L_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_REG_FREQ_L_V1_8814B) & BIT_MASK_REG_FREQ_L_V1_8814B) -+#define BIT_SET_REG_FREQ_L_V1_8814B(x, v) \ -+ (BIT_CLEAR_REG_FREQ_L_V1_8814B(x) | BIT_REG_FREQ_L_V1_8814B(v)) -+ -+#define BIT_EN_DUTY_8814B BIT(19) -+ -+#define BIT_SHIFT_REG_MOS_HALF_8814B 17 -+#define BIT_MASK_REG_MOS_HALF_8814B 0x3 -+#define BIT_REG_MOS_HALF_8814B(x) \ -+ (((x) & BIT_MASK_REG_MOS_HALF_8814B) << BIT_SHIFT_REG_MOS_HALF_8814B) -+#define BITS_REG_MOS_HALF_8814B \ -+ (BIT_MASK_REG_MOS_HALF_8814B << BIT_SHIFT_REG_MOS_HALF_8814B) -+#define BIT_CLEAR_REG_MOS_HALF_8814B(x) ((x) & (~BITS_REG_MOS_HALF_8814B)) -+#define BIT_GET_REG_MOS_HALF_8814B(x) \ -+ (((x) >> BIT_SHIFT_REG_MOS_HALF_8814B) & BIT_MASK_REG_MOS_HALF_8814B) -+#define BIT_SET_REG_MOS_HALF_8814B(x, v) \ -+ (BIT_CLEAR_REG_MOS_HALF_8814B(x) | BIT_REG_MOS_HALF_8814B(v)) -+ -+#define BIT_EN_SP_8814B BIT(16) -+#define BIT_REG_AUTO_L_V1_8814B BIT(15) -+#define BIT_REG_LDOF_L_V2_8814B BIT(14) -+#define BIT_REG_OCPS_L_V2_8814B BIT(13) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_ARENB_L_V1_8814B BIT(11) -+ -+#define BIT_SHIFT_TBOX_L1_1_0_8814B 9 -+#define BIT_MASK_TBOX_L1_1_0_8814B 0x3 -+#define BIT_TBOX_L1_1_0_8814B(x) \ -+ (((x) & BIT_MASK_TBOX_L1_1_0_8814B) << BIT_SHIFT_TBOX_L1_1_0_8814B) -+#define BITS_TBOX_L1_1_0_8814B \ -+ (BIT_MASK_TBOX_L1_1_0_8814B << BIT_SHIFT_TBOX_L1_1_0_8814B) -+#define BIT_CLEAR_TBOX_L1_1_0_8814B(x) ((x) & (~BITS_TBOX_L1_1_0_8814B)) -+#define BIT_GET_TBOX_L1_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_TBOX_L1_1_0_8814B) & BIT_MASK_TBOX_L1_1_0_8814B) -+#define BIT_SET_TBOX_L1_1_0_8814B(x, v) \ -+ (BIT_CLEAR_TBOX_L1_1_0_8814B(x) | BIT_TBOX_L1_1_0_8814B(v)) -+ -+#define BIT_SHIFT_REG_DELAY_L_1_0_8814B 7 -+#define BIT_MASK_REG_DELAY_L_1_0_8814B 0x3 -+#define BIT_REG_DELAY_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_REG_DELAY_L_1_0_8814B) \ -+ << BIT_SHIFT_REG_DELAY_L_1_0_8814B) -+#define BITS_REG_DELAY_L_1_0_8814B \ -+ (BIT_MASK_REG_DELAY_L_1_0_8814B << BIT_SHIFT_REG_DELAY_L_1_0_8814B) -+#define BIT_CLEAR_REG_DELAY_L_1_0_8814B(x) ((x) & (~BITS_REG_DELAY_L_1_0_8814B)) -+#define BIT_GET_REG_DELAY_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_REG_DELAY_L_1_0_8814B) & \ -+ BIT_MASK_REG_DELAY_L_1_0_8814B) -+#define BIT_SET_REG_DELAY_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_REG_DELAY_L_1_0_8814B(x) | BIT_REG_DELAY_L_1_0_8814B(v)) -+ -+#define BIT_REG_CLAMP_D_L_8814B BIT(6) -+#define BIT_REG_BYPASS_L_V1_8814B BIT(5) -+#define BIT_REG_AUTOZCD_L_8814B BIT(4) -+#define BIT_POW_ZCD_L_V1_8814B BIT(3) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_OCP_L_2_1_8814B 0 -+#define BIT_MASK_OCP_L_2_1_8814B 0x3 -+#define BIT_OCP_L_2_1_8814B(x) \ -+ (((x) & BIT_MASK_OCP_L_2_1_8814B) << BIT_SHIFT_OCP_L_2_1_8814B) -+#define BITS_OCP_L_2_1_8814B \ -+ (BIT_MASK_OCP_L_2_1_8814B << BIT_SHIFT_OCP_L_2_1_8814B) -+#define BIT_CLEAR_OCP_L_2_1_8814B(x) ((x) & (~BITS_OCP_L_2_1_8814B)) -+#define BIT_GET_OCP_L_2_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_OCP_L_2_1_8814B) & BIT_MASK_OCP_L_2_1_8814B) -+#define BIT_SET_OCP_L_2_1_8814B(x, v) \ -+ (BIT_CLEAR_OCP_L_2_1_8814B(x) | BIT_OCP_L_2_1_8814B(v)) -+ -+/* 2 REG_ANAPAR_MAC_0_8814B */ -+ -+#define BIT_SHIFT_LPF_C2_1_0_8814B 30 -+#define BIT_MASK_LPF_C2_1_0_8814B 0x3 -+#define BIT_LPF_C2_1_0_8814B(x) \ -+ (((x) & BIT_MASK_LPF_C2_1_0_8814B) << BIT_SHIFT_LPF_C2_1_0_8814B) -+#define BITS_LPF_C2_1_0_8814B \ -+ (BIT_MASK_LPF_C2_1_0_8814B << BIT_SHIFT_LPF_C2_1_0_8814B) -+#define BIT_CLEAR_LPF_C2_1_0_8814B(x) ((x) & (~BITS_LPF_C2_1_0_8814B)) -+#define BIT_GET_LPF_C2_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LPF_C2_1_0_8814B) & BIT_MASK_LPF_C2_1_0_8814B) -+#define BIT_SET_LPF_C2_1_0_8814B(x, v) \ -+ (BIT_CLEAR_LPF_C2_1_0_8814B(x) | BIT_LPF_C2_1_0_8814B(v)) -+ -+#define BIT_SHIFT_LPF_C1_5_0_8814B 24 -+#define BIT_MASK_LPF_C1_5_0_8814B 0x3f -+#define BIT_LPF_C1_5_0_8814B(x) \ -+ (((x) & BIT_MASK_LPF_C1_5_0_8814B) << BIT_SHIFT_LPF_C1_5_0_8814B) -+#define BITS_LPF_C1_5_0_8814B \ -+ (BIT_MASK_LPF_C1_5_0_8814B << BIT_SHIFT_LPF_C1_5_0_8814B) -+#define BIT_CLEAR_LPF_C1_5_0_8814B(x) ((x) & (~BITS_LPF_C1_5_0_8814B)) -+#define BIT_GET_LPF_C1_5_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LPF_C1_5_0_8814B) & BIT_MASK_LPF_C1_5_0_8814B) -+#define BIT_SET_LPF_C1_5_0_8814B(x, v) \ -+ (BIT_CLEAR_LPF_C1_5_0_8814B(x) | BIT_LPF_C1_5_0_8814B(v)) -+ -+#define BIT_LPF_TIEL_8814B BIT(23) -+#define BIT_LPF_TIEH_8814B BIT(22) -+ -+#define BIT_SHIFT_LOCKDET_VREF_L_1_0_8814B 20 -+#define BIT_MASK_LOCKDET_VREF_L_1_0_8814B 0x3 -+#define BIT_LOCKDET_VREF_L_1_0_8814B(x) \ -+ (((x) & BIT_MASK_LOCKDET_VREF_L_1_0_8814B) \ -+ << BIT_SHIFT_LOCKDET_VREF_L_1_0_8814B) -+#define BITS_LOCKDET_VREF_L_1_0_8814B \ -+ (BIT_MASK_LOCKDET_VREF_L_1_0_8814B \ -+ << BIT_SHIFT_LOCKDET_VREF_L_1_0_8814B) -+#define BIT_CLEAR_LOCKDET_VREF_L_1_0_8814B(x) \ -+ ((x) & (~BITS_LOCKDET_VREF_L_1_0_8814B)) -+#define BIT_GET_LOCKDET_VREF_L_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LOCKDET_VREF_L_1_0_8814B) & \ -+ BIT_MASK_LOCKDET_VREF_L_1_0_8814B) -+#define BIT_SET_LOCKDET_VREF_L_1_0_8814B(x, v) \ -+ (BIT_CLEAR_LOCKDET_VREF_L_1_0_8814B(x) | \ -+ BIT_LOCKDET_VREF_L_1_0_8814B(v)) -+ -+#define BIT_SHIFT_LOCKDET_VREF_H_1_0_8814B 18 -+#define BIT_MASK_LOCKDET_VREF_H_1_0_8814B 0x3 -+#define BIT_LOCKDET_VREF_H_1_0_8814B(x) \ -+ (((x) & BIT_MASK_LOCKDET_VREF_H_1_0_8814B) \ -+ << BIT_SHIFT_LOCKDET_VREF_H_1_0_8814B) -+#define BITS_LOCKDET_VREF_H_1_0_8814B \ -+ (BIT_MASK_LOCKDET_VREF_H_1_0_8814B \ -+ << BIT_SHIFT_LOCKDET_VREF_H_1_0_8814B) -+#define BIT_CLEAR_LOCKDET_VREF_H_1_0_8814B(x) \ -+ ((x) & (~BITS_LOCKDET_VREF_H_1_0_8814B)) -+#define BIT_GET_LOCKDET_VREF_H_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LOCKDET_VREF_H_1_0_8814B) & \ -+ BIT_MASK_LOCKDET_VREF_H_1_0_8814B) -+#define BIT_SET_LOCKDET_VREF_H_1_0_8814B(x, v) \ -+ (BIT_CLEAR_LOCKDET_VREF_H_1_0_8814B(x) | \ -+ BIT_LOCKDET_VREF_H_1_0_8814B(v)) -+ -+#define BIT_SHIFT_LDO_SEL_1_0_8814B 16 -+#define BIT_MASK_LDO_SEL_1_0_8814B 0x3 -+#define BIT_LDO_SEL_1_0_8814B(x) \ -+ (((x) & BIT_MASK_LDO_SEL_1_0_8814B) << BIT_SHIFT_LDO_SEL_1_0_8814B) -+#define BITS_LDO_SEL_1_0_8814B \ -+ (BIT_MASK_LDO_SEL_1_0_8814B << BIT_SHIFT_LDO_SEL_1_0_8814B) -+#define BIT_CLEAR_LDO_SEL_1_0_8814B(x) ((x) & (~BITS_LDO_SEL_1_0_8814B)) -+#define BIT_GET_LDO_SEL_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LDO_SEL_1_0_8814B) & BIT_MASK_LDO_SEL_1_0_8814B) -+#define BIT_SET_LDO_SEL_1_0_8814B(x, v) \ -+ (BIT_CLEAR_LDO_SEL_1_0_8814B(x) | BIT_LDO_SEL_1_0_8814B(v)) -+ -+#define BIT_SHIFT_IOFFSET_5_0_8814B 10 -+#define BIT_MASK_IOFFSET_5_0_8814B 0x3f -+#define BIT_IOFFSET_5_0_8814B(x) \ -+ (((x) & BIT_MASK_IOFFSET_5_0_8814B) << BIT_SHIFT_IOFFSET_5_0_8814B) -+#define BITS_IOFFSET_5_0_8814B \ -+ (BIT_MASK_IOFFSET_5_0_8814B << BIT_SHIFT_IOFFSET_5_0_8814B) -+#define BIT_CLEAR_IOFFSET_5_0_8814B(x) ((x) & (~BITS_IOFFSET_5_0_8814B)) -+#define BIT_GET_IOFFSET_5_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_IOFFSET_5_0_8814B) & BIT_MASK_IOFFSET_5_0_8814B) -+#define BIT_SET_IOFFSET_5_0_8814B(x, v) \ -+ (BIT_CLEAR_IOFFSET_5_0_8814B(x) | BIT_IOFFSET_5_0_8814B(v)) -+ -+#define BIT_CP_ICPX2_8814B BIT(9) -+ -+#define BIT_SHIFT_CP_ICP_SEL_4_0_8814B 4 -+#define BIT_MASK_CP_ICP_SEL_4_0_8814B 0x1f -+#define BIT_CP_ICP_SEL_4_0_8814B(x) \ -+ (((x) & BIT_MASK_CP_ICP_SEL_4_0_8814B) \ -+ << BIT_SHIFT_CP_ICP_SEL_4_0_8814B) -+#define BITS_CP_ICP_SEL_4_0_8814B \ -+ (BIT_MASK_CP_ICP_SEL_4_0_8814B << BIT_SHIFT_CP_ICP_SEL_4_0_8814B) -+#define BIT_CLEAR_CP_ICP_SEL_4_0_8814B(x) ((x) & (~BITS_CP_ICP_SEL_4_0_8814B)) -+#define BIT_GET_CP_ICP_SEL_4_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_CP_ICP_SEL_4_0_8814B) & \ -+ BIT_MASK_CP_ICP_SEL_4_0_8814B) -+#define BIT_SET_CP_ICP_SEL_4_0_8814B(x, v) \ -+ (BIT_CLEAR_CP_ICP_SEL_4_0_8814B(x) | BIT_CP_ICP_SEL_4_0_8814B(v)) -+ -+#define BIT_SHIFT_IB_PI_1_0_8814B 2 -+#define BIT_MASK_IB_PI_1_0_8814B 0x3 -+#define BIT_IB_PI_1_0_8814B(x) \ -+ (((x) & BIT_MASK_IB_PI_1_0_8814B) << BIT_SHIFT_IB_PI_1_0_8814B) -+#define BITS_IB_PI_1_0_8814B \ -+ (BIT_MASK_IB_PI_1_0_8814B << BIT_SHIFT_IB_PI_1_0_8814B) -+#define BIT_CLEAR_IB_PI_1_0_8814B(x) ((x) & (~BITS_IB_PI_1_0_8814B)) -+#define BIT_GET_IB_PI_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_IB_PI_1_0_8814B) & BIT_MASK_IB_PI_1_0_8814B) -+#define BIT_SET_IB_PI_1_0_8814B(x, v) \ -+ (BIT_CLEAR_IB_PI_1_0_8814B(x) | BIT_IB_PI_1_0_8814B(v)) -+ -+#define BIT_SHIFT_LDO_VSEL_8814B 0 -+#define BIT_MASK_LDO_VSEL_8814B 0x3 -+#define BIT_LDO_VSEL_8814B(x) \ -+ (((x) & BIT_MASK_LDO_VSEL_8814B) << BIT_SHIFT_LDO_VSEL_8814B) -+#define BITS_LDO_VSEL_8814B \ -+ (BIT_MASK_LDO_VSEL_8814B << BIT_SHIFT_LDO_VSEL_8814B) -+#define BIT_CLEAR_LDO_VSEL_8814B(x) ((x) & (~BITS_LDO_VSEL_8814B)) -+#define BIT_GET_LDO_VSEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_LDO_VSEL_8814B) & BIT_MASK_LDO_VSEL_8814B) -+#define BIT_SET_LDO_VSEL_8814B(x, v) \ -+ (BIT_CLEAR_LDO_VSEL_8814B(x) | BIT_LDO_VSEL_8814B(v)) -+ -+/* 2 REG_ANAPAR_MAC_1_8814B */ -+ -+#define BIT_SHIFT_CKX_USB_IB_SEL_8814B 29 -+#define BIT_MASK_CKX_USB_IB_SEL_8814B 0x7 -+#define BIT_CKX_USB_IB_SEL_8814B(x) \ -+ (((x) & BIT_MASK_CKX_USB_IB_SEL_8814B) \ -+ << BIT_SHIFT_CKX_USB_IB_SEL_8814B) -+#define BITS_CKX_USB_IB_SEL_8814B \ -+ (BIT_MASK_CKX_USB_IB_SEL_8814B << BIT_SHIFT_CKX_USB_IB_SEL_8814B) -+#define BIT_CLEAR_CKX_USB_IB_SEL_8814B(x) ((x) & (~BITS_CKX_USB_IB_SEL_8814B)) -+#define BIT_GET_CKX_USB_IB_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_CKX_USB_IB_SEL_8814B) & \ -+ BIT_MASK_CKX_USB_IB_SEL_8814B) -+#define BIT_SET_CKX_USB_IB_SEL_8814B(x, v) \ -+ (BIT_CLEAR_CKX_USB_IB_SEL_8814B(x) | BIT_CKX_USB_IB_SEL_8814B(v)) -+ -+#define BIT_PFD_DN_GATED_8814B BIT(28) -+#define BIT_PFD_UP_GATED_8814B BIT(27) -+#define BIT_PFD_RESET_GATED_8814B BIT(26) -+ -+#define BIT_SHIFT_PFD_OUT_DRV_1_0_8814B 24 -+#define BIT_MASK_PFD_OUT_DRV_1_0_8814B 0x3 -+#define BIT_PFD_OUT_DRV_1_0_8814B(x) \ -+ (((x) & BIT_MASK_PFD_OUT_DRV_1_0_8814B) \ -+ << BIT_SHIFT_PFD_OUT_DRV_1_0_8814B) -+#define BITS_PFD_OUT_DRV_1_0_8814B \ -+ (BIT_MASK_PFD_OUT_DRV_1_0_8814B << BIT_SHIFT_PFD_OUT_DRV_1_0_8814B) -+#define BIT_CLEAR_PFD_OUT_DRV_1_0_8814B(x) ((x) & (~BITS_PFD_OUT_DRV_1_0_8814B)) -+#define BIT_GET_PFD_OUT_DRV_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_PFD_OUT_DRV_1_0_8814B) & \ -+ BIT_MASK_PFD_OUT_DRV_1_0_8814B) -+#define BIT_SET_PFD_OUT_DRV_1_0_8814B(x, v) \ -+ (BIT_CLEAR_PFD_OUT_DRV_1_0_8814B(x) | BIT_PFD_OUT_DRV_1_0_8814B(v)) -+ -+#define BIT_SHIFT_LPF_TIEMID_2_0_8814B 20 -+#define BIT_MASK_LPF_TIEMID_2_0_8814B 0x7 -+#define BIT_LPF_TIEMID_2_0_8814B(x) \ -+ (((x) & BIT_MASK_LPF_TIEMID_2_0_8814B) \ -+ << BIT_SHIFT_LPF_TIEMID_2_0_8814B) -+#define BITS_LPF_TIEMID_2_0_8814B \ -+ (BIT_MASK_LPF_TIEMID_2_0_8814B << BIT_SHIFT_LPF_TIEMID_2_0_8814B) -+#define BIT_CLEAR_LPF_TIEMID_2_0_8814B(x) ((x) & (~BITS_LPF_TIEMID_2_0_8814B)) -+#define BIT_GET_LPF_TIEMID_2_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LPF_TIEMID_2_0_8814B) & \ -+ BIT_MASK_LPF_TIEMID_2_0_8814B) -+#define BIT_SET_LPF_TIEMID_2_0_8814B(x, v) \ -+ (BIT_CLEAR_LPF_TIEMID_2_0_8814B(x) | BIT_LPF_TIEMID_2_0_8814B(v)) -+ -+#define BIT_SHIFT_LPF_R3_4_0_8814B 15 -+#define BIT_MASK_LPF_R3_4_0_8814B 0x1f -+#define BIT_LPF_R3_4_0_8814B(x) \ -+ (((x) & BIT_MASK_LPF_R3_4_0_8814B) << BIT_SHIFT_LPF_R3_4_0_8814B) -+#define BITS_LPF_R3_4_0_8814B \ -+ (BIT_MASK_LPF_R3_4_0_8814B << BIT_SHIFT_LPF_R3_4_0_8814B) -+#define BIT_CLEAR_LPF_R3_4_0_8814B(x) ((x) & (~BITS_LPF_R3_4_0_8814B)) -+#define BIT_GET_LPF_R3_4_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LPF_R3_4_0_8814B) & BIT_MASK_LPF_R3_4_0_8814B) -+#define BIT_SET_LPF_R3_4_0_8814B(x, v) \ -+ (BIT_CLEAR_LPF_R3_4_0_8814B(x) | BIT_LPF_R3_4_0_8814B(v)) -+ -+#define BIT_SHIFT_LPF_R2_4_0_8814B 10 -+#define BIT_MASK_LPF_R2_4_0_8814B 0x1f -+#define BIT_LPF_R2_4_0_8814B(x) \ -+ (((x) & BIT_MASK_LPF_R2_4_0_8814B) << BIT_SHIFT_LPF_R2_4_0_8814B) -+#define BITS_LPF_R2_4_0_8814B \ -+ (BIT_MASK_LPF_R2_4_0_8814B << BIT_SHIFT_LPF_R2_4_0_8814B) -+#define BIT_CLEAR_LPF_R2_4_0_8814B(x) ((x) & (~BITS_LPF_R2_4_0_8814B)) -+#define BIT_GET_LPF_R2_4_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LPF_R2_4_0_8814B) & BIT_MASK_LPF_R2_4_0_8814B) -+#define BIT_SET_LPF_R2_4_0_8814B(x, v) \ -+ (BIT_CLEAR_LPF_R2_4_0_8814B(x) | BIT_LPF_R2_4_0_8814B(v)) -+ -+#define BIT_SHIFT_LPF_C3_5_0_8814B 4 -+#define BIT_MASK_LPF_C3_5_0_8814B 0x3f -+#define BIT_LPF_C3_5_0_8814B(x) \ -+ (((x) & BIT_MASK_LPF_C3_5_0_8814B) << BIT_SHIFT_LPF_C3_5_0_8814B) -+#define BITS_LPF_C3_5_0_8814B \ -+ (BIT_MASK_LPF_C3_5_0_8814B << BIT_SHIFT_LPF_C3_5_0_8814B) -+#define BIT_CLEAR_LPF_C3_5_0_8814B(x) ((x) & (~BITS_LPF_C3_5_0_8814B)) -+#define BIT_GET_LPF_C3_5_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LPF_C3_5_0_8814B) & BIT_MASK_LPF_C3_5_0_8814B) -+#define BIT_SET_LPF_C3_5_0_8814B(x, v) \ -+ (BIT_CLEAR_LPF_C3_5_0_8814B(x) | BIT_LPF_C3_5_0_8814B(v)) -+ -+#define BIT_SHIFT_LPF_C2_5_2_8814B 0 -+#define BIT_MASK_LPF_C2_5_2_8814B 0xf -+#define BIT_LPF_C2_5_2_8814B(x) \ -+ (((x) & BIT_MASK_LPF_C2_5_2_8814B) << BIT_SHIFT_LPF_C2_5_2_8814B) -+#define BITS_LPF_C2_5_2_8814B \ -+ (BIT_MASK_LPF_C2_5_2_8814B << BIT_SHIFT_LPF_C2_5_2_8814B) -+#define BIT_CLEAR_LPF_C2_5_2_8814B(x) ((x) & (~BITS_LPF_C2_5_2_8814B)) -+#define BIT_GET_LPF_C2_5_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_LPF_C2_5_2_8814B) & BIT_MASK_LPF_C2_5_2_8814B) -+#define BIT_SET_LPF_C2_5_2_8814B(x, v) \ -+ (BIT_CLEAR_LPF_C2_5_2_8814B(x) | BIT_LPF_C2_5_2_8814B(v)) -+ -+/* 2 REG_ANAPAR_MAC_2_8814B */ -+#define BIT_CK_PHASE_SEL_8814B BIT(31) -+#define BIT_CK960M_EN_8814B BIT(30) -+#define BIT_CK640M_EN_8814B BIT(29) -+#define BIT_CK240M_EN_8814B BIT(28) -+ -+#define BIT_SHIFT_CK_MON_SEL_2_0_8814B 25 -+#define BIT_MASK_CK_MON_SEL_2_0_8814B 0x7 -+#define BIT_CK_MON_SEL_2_0_8814B(x) \ -+ (((x) & BIT_MASK_CK_MON_SEL_2_0_8814B) \ -+ << BIT_SHIFT_CK_MON_SEL_2_0_8814B) -+#define BITS_CK_MON_SEL_2_0_8814B \ -+ (BIT_MASK_CK_MON_SEL_2_0_8814B << BIT_SHIFT_CK_MON_SEL_2_0_8814B) -+#define BIT_CLEAR_CK_MON_SEL_2_0_8814B(x) ((x) & (~BITS_CK_MON_SEL_2_0_8814B)) -+#define BIT_GET_CK_MON_SEL_2_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_CK_MON_SEL_2_0_8814B) & \ -+ BIT_MASK_CK_MON_SEL_2_0_8814B) -+#define BIT_SET_CK_MON_SEL_2_0_8814B(x, v) \ -+ (BIT_CLEAR_CK_MON_SEL_2_0_8814B(x) | BIT_CK_MON_SEL_2_0_8814B(v)) -+ -+#define BIT_CK_MON_EN_V1_8814B BIT(24) -+#define BIT_XTAL_SOURCE_SEL_8814B BIT(23) -+#define BIT_XTAL_FREQ_SEL_8814B BIT(22) -+#define BIT_XTAL_EDGE_SEL_8814B BIT(21) -+#define BIT_XTAL_BUF_SEL_8814B BIT(20) -+ -+#define BIT_SHIFT_VCO_CV_7_0_8814B 4 -+#define BIT_MASK_VCO_CV_7_0_8814B 0xff -+#define BIT_VCO_CV_7_0_8814B(x) \ -+ (((x) & BIT_MASK_VCO_CV_7_0_8814B) << BIT_SHIFT_VCO_CV_7_0_8814B) -+#define BITS_VCO_CV_7_0_8814B \ -+ (BIT_MASK_VCO_CV_7_0_8814B << BIT_SHIFT_VCO_CV_7_0_8814B) -+#define BIT_CLEAR_VCO_CV_7_0_8814B(x) ((x) & (~BITS_VCO_CV_7_0_8814B)) -+#define BIT_GET_VCO_CV_7_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_VCO_CV_7_0_8814B) & BIT_MASK_VCO_CV_7_0_8814B) -+#define BIT_SET_VCO_CV_7_0_8814B(x, v) \ -+ (BIT_CLEAR_VCO_CV_7_0_8814B(x) | BIT_VCO_CV_7_0_8814B(v)) -+ -+#define BIT_VCO_KVCO_8814B BIT(3) -+#define BIT_SDM_EDGE_SEL_8814B BIT(2) -+#define BIT_SDM_CK_SEL_8814B BIT(1) -+#define BIT_SDM_CK_GATED_8814B BIT(0) -+ -+/* 2 REG_ANAPAR_MAC_3_8814B */ -+ -+#define BIT_SHIFT_LCK_WAIT_CYCLE_2_0_8814B 28 -+#define BIT_MASK_LCK_WAIT_CYCLE_2_0_8814B 0x7 -+#define BIT_LCK_WAIT_CYCLE_2_0_8814B(x) \ -+ (((x) & BIT_MASK_LCK_WAIT_CYCLE_2_0_8814B) \ -+ << BIT_SHIFT_LCK_WAIT_CYCLE_2_0_8814B) -+#define BITS_LCK_WAIT_CYCLE_2_0_8814B \ -+ (BIT_MASK_LCK_WAIT_CYCLE_2_0_8814B \ -+ << BIT_SHIFT_LCK_WAIT_CYCLE_2_0_8814B) -+#define BIT_CLEAR_LCK_WAIT_CYCLE_2_0_8814B(x) \ -+ ((x) & (~BITS_LCK_WAIT_CYCLE_2_0_8814B)) -+#define BIT_GET_LCK_WAIT_CYCLE_2_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LCK_WAIT_CYCLE_2_0_8814B) & \ -+ BIT_MASK_LCK_WAIT_CYCLE_2_0_8814B) -+#define BIT_SET_LCK_WAIT_CYCLE_2_0_8814B(x, v) \ -+ (BIT_CLEAR_LCK_WAIT_CYCLE_2_0_8814B(x) | \ -+ BIT_LCK_WAIT_CYCLE_2_0_8814B(v)) -+ -+#define BIT_SHIFT_LCK_VCO_DIVISOR_1_0_8814B 26 -+#define BIT_MASK_LCK_VCO_DIVISOR_1_0_8814B 0x3 -+#define BIT_LCK_VCO_DIVISOR_1_0_8814B(x) \ -+ (((x) & BIT_MASK_LCK_VCO_DIVISOR_1_0_8814B) \ -+ << BIT_SHIFT_LCK_VCO_DIVISOR_1_0_8814B) -+#define BITS_LCK_VCO_DIVISOR_1_0_8814B \ -+ (BIT_MASK_LCK_VCO_DIVISOR_1_0_8814B \ -+ << BIT_SHIFT_LCK_VCO_DIVISOR_1_0_8814B) -+#define BIT_CLEAR_LCK_VCO_DIVISOR_1_0_8814B(x) \ -+ ((x) & (~BITS_LCK_VCO_DIVISOR_1_0_8814B)) -+#define BIT_GET_LCK_VCO_DIVISOR_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LCK_VCO_DIVISOR_1_0_8814B) & \ -+ BIT_MASK_LCK_VCO_DIVISOR_1_0_8814B) -+#define BIT_SET_LCK_VCO_DIVISOR_1_0_8814B(x, v) \ -+ (BIT_CLEAR_LCK_VCO_DIVISOR_1_0_8814B(x) | \ -+ BIT_LCK_VCO_DIVISOR_1_0_8814B(v)) -+ -+#define BIT_SHIFT_LCK_SEARCH_MODE_1_0_8814B 24 -+#define BIT_MASK_LCK_SEARCH_MODE_1_0_8814B 0x3 -+#define BIT_LCK_SEARCH_MODE_1_0_8814B(x) \ -+ (((x) & BIT_MASK_LCK_SEARCH_MODE_1_0_8814B) \ -+ << BIT_SHIFT_LCK_SEARCH_MODE_1_0_8814B) -+#define BITS_LCK_SEARCH_MODE_1_0_8814B \ -+ (BIT_MASK_LCK_SEARCH_MODE_1_0_8814B \ -+ << BIT_SHIFT_LCK_SEARCH_MODE_1_0_8814B) -+#define BIT_CLEAR_LCK_SEARCH_MODE_1_0_8814B(x) \ -+ ((x) & (~BITS_LCK_SEARCH_MODE_1_0_8814B)) -+#define BIT_GET_LCK_SEARCH_MODE_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LCK_SEARCH_MODE_1_0_8814B) & \ -+ BIT_MASK_LCK_SEARCH_MODE_1_0_8814B) -+#define BIT_SET_LCK_SEARCH_MODE_1_0_8814B(x, v) \ -+ (BIT_CLEAR_LCK_SEARCH_MODE_1_0_8814B(x) | \ -+ BIT_LCK_SEARCH_MODE_1_0_8814B(v)) -+ -+#define BIT_SHIFT_LS_CV_OFFSET_3_0_8814B 12 -+#define BIT_MASK_LS_CV_OFFSET_3_0_8814B 0xf -+#define BIT_LS_CV_OFFSET_3_0_8814B(x) \ -+ (((x) & BIT_MASK_LS_CV_OFFSET_3_0_8814B) \ -+ << BIT_SHIFT_LS_CV_OFFSET_3_0_8814B) -+#define BITS_LS_CV_OFFSET_3_0_8814B \ -+ (BIT_MASK_LS_CV_OFFSET_3_0_8814B << BIT_SHIFT_LS_CV_OFFSET_3_0_8814B) -+#define BIT_CLEAR_LS_CV_OFFSET_3_0_8814B(x) \ -+ ((x) & (~BITS_LS_CV_OFFSET_3_0_8814B)) -+#define BIT_GET_LS_CV_OFFSET_3_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LS_CV_OFFSET_3_0_8814B) & \ -+ BIT_MASK_LS_CV_OFFSET_3_0_8814B) -+#define BIT_SET_LS_CV_OFFSET_3_0_8814B(x, v) \ -+ (BIT_CLEAR_LS_CV_OFFSET_3_0_8814B(x) | BIT_LS_CV_OFFSET_3_0_8814B(v)) -+ -+#define BIT_LS_EN_LC_CK40M_8814B BIT(11) -+#define BIT_LS__CV_MANUAL_8814B BIT(10) -+#define BIT_LS_PYPASS_PI_8814B BIT(9) -+#define BIT_MBIASE_8814B BIT(4) -+ -+/* 2 REG_ANAPAR_MAC_4_8814B */ -+#define BIT_LS_TIE_MID_MODE_8814B BIT(28) -+ -+#define BIT_SHIFT_LS_SYNC_CYCLE_1_0_8814B 26 -+#define BIT_MASK_LS_SYNC_CYCLE_1_0_8814B 0x3 -+#define BIT_LS_SYNC_CYCLE_1_0_8814B(x) \ -+ (((x) & BIT_MASK_LS_SYNC_CYCLE_1_0_8814B) \ -+ << BIT_SHIFT_LS_SYNC_CYCLE_1_0_8814B) -+#define BITS_LS_SYNC_CYCLE_1_0_8814B \ -+ (BIT_MASK_LS_SYNC_CYCLE_1_0_8814B << BIT_SHIFT_LS_SYNC_CYCLE_1_0_8814B) -+#define BIT_CLEAR_LS_SYNC_CYCLE_1_0_8814B(x) \ -+ ((x) & (~BITS_LS_SYNC_CYCLE_1_0_8814B)) -+#define BIT_GET_LS_SYNC_CYCLE_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LS_SYNC_CYCLE_1_0_8814B) & \ -+ BIT_MASK_LS_SYNC_CYCLE_1_0_8814B) -+#define BIT_SET_LS_SYNC_CYCLE_1_0_8814B(x, v) \ -+ (BIT_CLEAR_LS_SYNC_CYCLE_1_0_8814B(x) | BIT_LS_SYNC_CYCLE_1_0_8814B(v)) -+ -+#define BIT_LS_SDM_ORDER_8814B BIT(25) -+#define BIT_LS_RST_LC_CAL_8814B BIT(14) -+#define BIT_LS_RSTB_8814B BIT(13) -+#define BIT_LS_POW_LC_CAL_PREP_8814B BIT(11) -+ -+#define BIT_SHIFT_LCK_XTAL_DIVISOR_1_0_8814B 0 -+#define BIT_MASK_LCK_XTAL_DIVISOR_1_0_8814B 0x3 -+#define BIT_LCK_XTAL_DIVISOR_1_0_8814B(x) \ -+ (((x) & BIT_MASK_LCK_XTAL_DIVISOR_1_0_8814B) \ -+ << BIT_SHIFT_LCK_XTAL_DIVISOR_1_0_8814B) -+#define BITS_LCK_XTAL_DIVISOR_1_0_8814B \ -+ (BIT_MASK_LCK_XTAL_DIVISOR_1_0_8814B \ -+ << BIT_SHIFT_LCK_XTAL_DIVISOR_1_0_8814B) -+#define BIT_CLEAR_LCK_XTAL_DIVISOR_1_0_8814B(x) \ -+ ((x) & (~BITS_LCK_XTAL_DIVISOR_1_0_8814B)) -+#define BIT_GET_LCK_XTAL_DIVISOR_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LCK_XTAL_DIVISOR_1_0_8814B) & \ -+ BIT_MASK_LCK_XTAL_DIVISOR_1_0_8814B) -+#define BIT_SET_LCK_XTAL_DIVISOR_1_0_8814B(x, v) \ -+ (BIT_CLEAR_LCK_XTAL_DIVISOR_1_0_8814B(x) | \ -+ BIT_LCK_XTAL_DIVISOR_1_0_8814B(v)) -+ -+/* 2 REG_ANAPAR_MAC_5_8814B */ -+ -+#define BIT_SHIFT_LS_XTAL_SEL_3_0_8814B 0 -+#define BIT_MASK_LS_XTAL_SEL_3_0_8814B 0xf -+#define BIT_LS_XTAL_SEL_3_0_8814B(x) \ -+ (((x) & BIT_MASK_LS_XTAL_SEL_3_0_8814B) \ -+ << BIT_SHIFT_LS_XTAL_SEL_3_0_8814B) -+#define BITS_LS_XTAL_SEL_3_0_8814B \ -+ (BIT_MASK_LS_XTAL_SEL_3_0_8814B << BIT_SHIFT_LS_XTAL_SEL_3_0_8814B) -+#define BIT_CLEAR_LS_XTAL_SEL_3_0_8814B(x) ((x) & (~BITS_LS_XTAL_SEL_3_0_8814B)) -+#define BIT_GET_LS_XTAL_SEL_3_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_LS_XTAL_SEL_3_0_8814B) & \ -+ BIT_MASK_LS_XTAL_SEL_3_0_8814B) -+#define BIT_SET_LS_XTAL_SEL_3_0_8814B(x, v) \ -+ (BIT_CLEAR_LS_XTAL_SEL_3_0_8814B(x) | BIT_LS_XTAL_SEL_3_0_8814B(v)) -+ -+/* 2 REG_ANAPAR_MAC_6_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_ANAPAR_MAC_7_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_ANAPAR_MAC_8_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_ANAPAR_XTAL_0_8814B */ -+#define BIT_XTAL_DRV_RF1_0_8814B BIT(31) -+#define BIT_XTAL_GATED_RF1N_8814B BIT(30) -+#define BIT_XTAL_GATED_RF1P_8814B BIT(29) -+#define BIT_XTAL_GM_SEP_V2_8814B BIT(28) -+ -+#define BIT_SHIFT_XTAL_LDO_1_0_8814B 26 -+#define BIT_MASK_XTAL_LDO_1_0_8814B 0x3 -+#define BIT_XTAL_LDO_1_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_1_0_8814B) << BIT_SHIFT_XTAL_LDO_1_0_8814B) -+#define BITS_XTAL_LDO_1_0_8814B \ -+ (BIT_MASK_XTAL_LDO_1_0_8814B << BIT_SHIFT_XTAL_LDO_1_0_8814B) -+#define BIT_CLEAR_XTAL_LDO_1_0_8814B(x) ((x) & (~BITS_XTAL_LDO_1_0_8814B)) -+#define BIT_GET_XTAL_LDO_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_1_0_8814B) & BIT_MASK_XTAL_LDO_1_0_8814B) -+#define BIT_SET_XTAL_LDO_1_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_1_0_8814B(x) | BIT_XTAL_LDO_1_0_8814B(v)) -+ -+#define BIT_XQSEL_V1_8814B BIT(25) -+#define BIT_GATED_XTAL_OK0_8814B BIT(24) -+ -+#define BIT_SHIFT_XTAL_SC_XO_6_0_8814B 17 -+#define BIT_MASK_XTAL_SC_XO_6_0_8814B 0x7f -+#define BIT_XTAL_SC_XO_6_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_SC_XO_6_0_8814B) \ -+ << BIT_SHIFT_XTAL_SC_XO_6_0_8814B) -+#define BITS_XTAL_SC_XO_6_0_8814B \ -+ (BIT_MASK_XTAL_SC_XO_6_0_8814B << BIT_SHIFT_XTAL_SC_XO_6_0_8814B) -+#define BIT_CLEAR_XTAL_SC_XO_6_0_8814B(x) ((x) & (~BITS_XTAL_SC_XO_6_0_8814B)) -+#define BIT_GET_XTAL_SC_XO_6_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_XO_6_0_8814B) & \ -+ BIT_MASK_XTAL_SC_XO_6_0_8814B) -+#define BIT_SET_XTAL_SC_XO_6_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_SC_XO_6_0_8814B(x) | BIT_XTAL_SC_XO_6_0_8814B(v)) -+ -+#define BIT_SHIFT_XTAL_SC_XI_6_0_8814B 10 -+#define BIT_MASK_XTAL_SC_XI_6_0_8814B 0x7f -+#define BIT_XTAL_SC_XI_6_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_SC_XI_6_0_8814B) \ -+ << BIT_SHIFT_XTAL_SC_XI_6_0_8814B) -+#define BITS_XTAL_SC_XI_6_0_8814B \ -+ (BIT_MASK_XTAL_SC_XI_6_0_8814B << BIT_SHIFT_XTAL_SC_XI_6_0_8814B) -+#define BIT_CLEAR_XTAL_SC_XI_6_0_8814B(x) ((x) & (~BITS_XTAL_SC_XI_6_0_8814B)) -+#define BIT_GET_XTAL_SC_XI_6_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_XI_6_0_8814B) & \ -+ BIT_MASK_XTAL_SC_XI_6_0_8814B) -+#define BIT_SET_XTAL_SC_XI_6_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_SC_XI_6_0_8814B(x) | BIT_XTAL_SC_XI_6_0_8814B(v)) -+ -+#define BIT_SHIFT_XTAL_GMN_4_0_8814B 5 -+#define BIT_MASK_XTAL_GMN_4_0_8814B 0x1f -+#define BIT_XTAL_GMN_4_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_4_0_8814B) << BIT_SHIFT_XTAL_GMN_4_0_8814B) -+#define BITS_XTAL_GMN_4_0_8814B \ -+ (BIT_MASK_XTAL_GMN_4_0_8814B << BIT_SHIFT_XTAL_GMN_4_0_8814B) -+#define BIT_CLEAR_XTAL_GMN_4_0_8814B(x) ((x) & (~BITS_XTAL_GMN_4_0_8814B)) -+#define BIT_GET_XTAL_GMN_4_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_4_0_8814B) & BIT_MASK_XTAL_GMN_4_0_8814B) -+#define BIT_SET_XTAL_GMN_4_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_4_0_8814B(x) | BIT_XTAL_GMN_4_0_8814B(v)) -+ -+#define BIT_SHIFT_XTAL_GMP_4_0_8814B 0 -+#define BIT_MASK_XTAL_GMP_4_0_8814B 0x1f -+#define BIT_XTAL_GMP_4_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_4_0_8814B) << BIT_SHIFT_XTAL_GMP_4_0_8814B) -+#define BITS_XTAL_GMP_4_0_8814B \ -+ (BIT_MASK_XTAL_GMP_4_0_8814B << BIT_SHIFT_XTAL_GMP_4_0_8814B) -+#define BIT_CLEAR_XTAL_GMP_4_0_8814B(x) ((x) & (~BITS_XTAL_GMP_4_0_8814B)) -+#define BIT_GET_XTAL_GMP_4_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_4_0_8814B) & BIT_MASK_XTAL_GMP_4_0_8814B) -+#define BIT_SET_XTAL_GMP_4_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_4_0_8814B(x) | BIT_XTAL_GMP_4_0_8814B(v)) -+ -+/* 2 REG_ANAPAR_XTAL_1_8814B */ -+ -+#define BIT_SHIFT_XTAL_LDO_OK_1_0_8814B 30 -+#define BIT_MASK_XTAL_LDO_OK_1_0_8814B 0x3 -+#define BIT_XTAL_LDO_OK_1_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_OK_1_0_8814B) \ -+ << BIT_SHIFT_XTAL_LDO_OK_1_0_8814B) -+#define BITS_XTAL_LDO_OK_1_0_8814B \ -+ (BIT_MASK_XTAL_LDO_OK_1_0_8814B << BIT_SHIFT_XTAL_LDO_OK_1_0_8814B) -+#define BIT_CLEAR_XTAL_LDO_OK_1_0_8814B(x) ((x) & (~BITS_XTAL_LDO_OK_1_0_8814B)) -+#define BIT_GET_XTAL_LDO_OK_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_OK_1_0_8814B) & \ -+ BIT_MASK_XTAL_LDO_OK_1_0_8814B) -+#define BIT_SET_XTAL_LDO_OK_1_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_OK_1_0_8814B(x) | BIT_XTAL_LDO_OK_1_0_8814B(v)) -+ -+#define BIT_SHIFT_XTAL_XORES_SEL_2_0_8814B 27 -+#define BIT_MASK_XTAL_XORES_SEL_2_0_8814B 0x7 -+#define BIT_XTAL_XORES_SEL_2_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_XORES_SEL_2_0_8814B) \ -+ << BIT_SHIFT_XTAL_XORES_SEL_2_0_8814B) -+#define BITS_XTAL_XORES_SEL_2_0_8814B \ -+ (BIT_MASK_XTAL_XORES_SEL_2_0_8814B \ -+ << BIT_SHIFT_XTAL_XORES_SEL_2_0_8814B) -+#define BIT_CLEAR_XTAL_XORES_SEL_2_0_8814B(x) \ -+ ((x) & (~BITS_XTAL_XORES_SEL_2_0_8814B)) -+#define BIT_GET_XTAL_XORES_SEL_2_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_XORES_SEL_2_0_8814B) & \ -+ BIT_MASK_XTAL_XORES_SEL_2_0_8814B) -+#define BIT_SET_XTAL_XORES_SEL_2_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_XORES_SEL_2_0_8814B(x) | \ -+ BIT_XTAL_XORES_SEL_2_0_8814B(v)) -+ -+#define BIT_SHIFT_XTAL_AAC_PK_SEL_1_0_8814B 25 -+#define BIT_MASK_XTAL_AAC_PK_SEL_1_0_8814B 0x3 -+#define BIT_XTAL_AAC_PK_SEL_1_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_AAC_PK_SEL_1_0_8814B) \ -+ << BIT_SHIFT_XTAL_AAC_PK_SEL_1_0_8814B) -+#define BITS_XTAL_AAC_PK_SEL_1_0_8814B \ -+ (BIT_MASK_XTAL_AAC_PK_SEL_1_0_8814B \ -+ << BIT_SHIFT_XTAL_AAC_PK_SEL_1_0_8814B) -+#define BIT_CLEAR_XTAL_AAC_PK_SEL_1_0_8814B(x) \ -+ ((x) & (~BITS_XTAL_AAC_PK_SEL_1_0_8814B)) -+#define BIT_GET_XTAL_AAC_PK_SEL_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_AAC_PK_SEL_1_0_8814B) & \ -+ BIT_MASK_XTAL_AAC_PK_SEL_1_0_8814B) -+#define BIT_SET_XTAL_AAC_PK_SEL_1_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_AAC_PK_SEL_1_0_8814B(x) | \ -+ BIT_XTAL_AAC_PK_SEL_1_0_8814B(v)) -+ -+#define BIT_EN_XTAL_AAC_PKDET_8814B BIT(24) -+#define BIT_EN_XTAL_AAC_GM_8814B BIT(23) -+#define BIT_XTAL_LPMODE_8814B BIT(22) -+ -+#define BIT_SHIFT_XTAL_SEL_TOK_2_0_8814B 19 -+#define BIT_MASK_XTAL_SEL_TOK_2_0_8814B 0x7 -+#define BIT_XTAL_SEL_TOK_2_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_TOK_2_0_8814B) \ -+ << BIT_SHIFT_XTAL_SEL_TOK_2_0_8814B) -+#define BITS_XTAL_SEL_TOK_2_0_8814B \ -+ (BIT_MASK_XTAL_SEL_TOK_2_0_8814B << BIT_SHIFT_XTAL_SEL_TOK_2_0_8814B) -+#define BIT_CLEAR_XTAL_SEL_TOK_2_0_8814B(x) \ -+ ((x) & (~BITS_XTAL_SEL_TOK_2_0_8814B)) -+#define BIT_GET_XTAL_SEL_TOK_2_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_TOK_2_0_8814B) & \ -+ BIT_MASK_XTAL_SEL_TOK_2_0_8814B) -+#define BIT_SET_XTAL_SEL_TOK_2_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_TOK_2_0_8814B(x) | BIT_XTAL_SEL_TOK_2_0_8814B(v)) -+ -+#define BIT_XQSEL_RF_AWAKE_V2_8814B BIT(18) -+#define BIT_XQSEL_RF_INITIAL_V2_8814B BIT(17) -+#define BIT_XTAL_DELAY_USB_V1_8814B BIT(16) -+#define BIT_XTAL_DELAY_DIGI_V1_8814B BIT(15) -+#define BIT_XTAL_DELAY_AFE_V1_8814B BIT(14) -+#define BIT_XTAL_DRV_RF_LATCH_V3_8814B BIT(13) -+ -+#define BIT_SHIFT_XTAL_DRV_DIGI_1_0_8814B 11 -+#define BIT_MASK_XTAL_DRV_DIGI_1_0_8814B 0x3 -+#define BIT_XTAL_DRV_DIGI_1_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_DIGI_1_0_8814B) \ -+ << BIT_SHIFT_XTAL_DRV_DIGI_1_0_8814B) -+#define BITS_XTAL_DRV_DIGI_1_0_8814B \ -+ (BIT_MASK_XTAL_DRV_DIGI_1_0_8814B << BIT_SHIFT_XTAL_DRV_DIGI_1_0_8814B) -+#define BIT_CLEAR_XTAL_DRV_DIGI_1_0_8814B(x) \ -+ ((x) & (~BITS_XTAL_DRV_DIGI_1_0_8814B)) -+#define BIT_GET_XTAL_DRV_DIGI_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_DIGI_1_0_8814B) & \ -+ BIT_MASK_XTAL_DRV_DIGI_1_0_8814B) -+#define BIT_SET_XTAL_DRV_DIGI_1_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_DIGI_1_0_8814B(x) | BIT_XTAL_DRV_DIGI_1_0_8814B(v)) -+ -+#define BIT_XTAL_GATED_DIGIN_8814B BIT(10) -+#define BIT_XTAL_GATED_DIGIP_8814B BIT(9) -+ -+#define BIT_SHIFT_XTAL_DRV_USB_1_0_8814B 7 -+#define BIT_MASK_XTAL_DRV_USB_1_0_8814B 0x3 -+#define BIT_XTAL_DRV_USB_1_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_USB_1_0_8814B) \ -+ << BIT_SHIFT_XTAL_DRV_USB_1_0_8814B) -+#define BITS_XTAL_DRV_USB_1_0_8814B \ -+ (BIT_MASK_XTAL_DRV_USB_1_0_8814B << BIT_SHIFT_XTAL_DRV_USB_1_0_8814B) -+#define BIT_CLEAR_XTAL_DRV_USB_1_0_8814B(x) \ -+ ((x) & (~BITS_XTAL_DRV_USB_1_0_8814B)) -+#define BIT_GET_XTAL_DRV_USB_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_USB_1_0_8814B) & \ -+ BIT_MASK_XTAL_DRV_USB_1_0_8814B) -+#define BIT_SET_XTAL_DRV_USB_1_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_USB_1_0_8814B(x) | BIT_XTAL_DRV_USB_1_0_8814B(v)) -+ -+#define BIT_XTAL_GATED_USBN_8814B BIT(6) -+#define BIT_XTAL_GATED_USBP_8814B BIT(5) -+ -+#define BIT_SHIFT_XTAL_DRV_AFE_1_0_8814B 3 -+#define BIT_MASK_XTAL_DRV_AFE_1_0_8814B 0x3 -+#define BIT_XTAL_DRV_AFE_1_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_AFE_1_0_8814B) \ -+ << BIT_SHIFT_XTAL_DRV_AFE_1_0_8814B) -+#define BITS_XTAL_DRV_AFE_1_0_8814B \ -+ (BIT_MASK_XTAL_DRV_AFE_1_0_8814B << BIT_SHIFT_XTAL_DRV_AFE_1_0_8814B) -+#define BIT_CLEAR_XTAL_DRV_AFE_1_0_8814B(x) \ -+ ((x) & (~BITS_XTAL_DRV_AFE_1_0_8814B)) -+#define BIT_GET_XTAL_DRV_AFE_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_AFE_1_0_8814B) & \ -+ BIT_MASK_XTAL_DRV_AFE_1_0_8814B) -+#define BIT_SET_XTAL_DRV_AFE_1_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_AFE_1_0_8814B(x) | BIT_XTAL_DRV_AFE_1_0_8814B(v)) -+ -+#define BIT_XTAL_GATED_AFEN_8814B BIT(2) -+#define BIT_XTAL_GATED_AFEP_8814B BIT(1) -+#define BIT_XTAL_DRV_RF1_1_8814B BIT(0) -+ -+/* 2 REG_ANAPAR_XTAL_2_8814B */ -+#define BIT_XTAL_DRV_RF2_LATCH_8814B BIT(6) -+ -+#define BIT_SHIFT_XTAL_DRV_RF2_1_0_8814B 4 -+#define BIT_MASK_XTAL_DRV_RF2_1_0_8814B 0x3 -+#define BIT_XTAL_DRV_RF2_1_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF2_1_0_8814B) \ -+ << BIT_SHIFT_XTAL_DRV_RF2_1_0_8814B) -+#define BITS_XTAL_DRV_RF2_1_0_8814B \ -+ (BIT_MASK_XTAL_DRV_RF2_1_0_8814B << BIT_SHIFT_XTAL_DRV_RF2_1_0_8814B) -+#define BIT_CLEAR_XTAL_DRV_RF2_1_0_8814B(x) \ -+ ((x) & (~BITS_XTAL_DRV_RF2_1_0_8814B)) -+#define BIT_GET_XTAL_DRV_RF2_1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF2_1_0_8814B) & \ -+ BIT_MASK_XTAL_DRV_RF2_1_0_8814B) -+#define BIT_SET_XTAL_DRV_RF2_1_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF2_1_0_8814B(x) | BIT_XTAL_DRV_RF2_1_0_8814B(v)) -+ -+#define BIT_XTAL_GATED_RF2N_8814B BIT(3) -+#define BIT_XTAL_GATED_RF2P_8814B BIT(2) -+#define BIT_XTAL_LDO_DI_8814B BIT(1) -+#define BIT_XTAL_SEL_PWR_8814B BIT(0) -+ -+/* 2 REG_ANAPAR_XTAL_AAC_8814B */ -+#define BIT_EN_XTAL_AAC_TRIG_8814B BIT(28) -+#define BIT_EN_XTAL_AAC_8814B BIT(27) -+#define BIT_EN_XTAL_AAC_DIGI_8814B BIT(26) -+ -+#define BIT_SHIFT_GM_MANUAL_4_0_8814B 21 -+#define BIT_MASK_GM_MANUAL_4_0_8814B 0x1f -+#define BIT_GM_MANUAL_4_0_8814B(x) \ -+ (((x) & BIT_MASK_GM_MANUAL_4_0_8814B) << BIT_SHIFT_GM_MANUAL_4_0_8814B) -+#define BITS_GM_MANUAL_4_0_8814B \ -+ (BIT_MASK_GM_MANUAL_4_0_8814B << BIT_SHIFT_GM_MANUAL_4_0_8814B) -+#define BIT_CLEAR_GM_MANUAL_4_0_8814B(x) ((x) & (~BITS_GM_MANUAL_4_0_8814B)) -+#define BIT_GET_GM_MANUAL_4_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_GM_MANUAL_4_0_8814B) & BIT_MASK_GM_MANUAL_4_0_8814B) -+#define BIT_SET_GM_MANUAL_4_0_8814B(x, v) \ -+ (BIT_CLEAR_GM_MANUAL_4_0_8814B(x) | BIT_GM_MANUAL_4_0_8814B(v)) -+ -+#define BIT_SHIFT_GM_STUP_4_0_8814B 16 -+#define BIT_MASK_GM_STUP_4_0_8814B 0x1f -+#define BIT_GM_STUP_4_0_8814B(x) \ -+ (((x) & BIT_MASK_GM_STUP_4_0_8814B) << BIT_SHIFT_GM_STUP_4_0_8814B) -+#define BITS_GM_STUP_4_0_8814B \ -+ (BIT_MASK_GM_STUP_4_0_8814B << BIT_SHIFT_GM_STUP_4_0_8814B) -+#define BIT_CLEAR_GM_STUP_4_0_8814B(x) ((x) & (~BITS_GM_STUP_4_0_8814B)) -+#define BIT_GET_GM_STUP_4_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_GM_STUP_4_0_8814B) & BIT_MASK_GM_STUP_4_0_8814B) -+#define BIT_SET_GM_STUP_4_0_8814B(x, v) \ -+ (BIT_CLEAR_GM_STUP_4_0_8814B(x) | BIT_GM_STUP_4_0_8814B(v)) -+ -+#define BIT_SHIFT_XTAL_CK_SET_2_0_8814B 13 -+#define BIT_MASK_XTAL_CK_SET_2_0_8814B 0x7 -+#define BIT_XTAL_CK_SET_2_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_CK_SET_2_0_8814B) \ -+ << BIT_SHIFT_XTAL_CK_SET_2_0_8814B) -+#define BITS_XTAL_CK_SET_2_0_8814B \ -+ (BIT_MASK_XTAL_CK_SET_2_0_8814B << BIT_SHIFT_XTAL_CK_SET_2_0_8814B) -+#define BIT_CLEAR_XTAL_CK_SET_2_0_8814B(x) ((x) & (~BITS_XTAL_CK_SET_2_0_8814B)) -+#define BIT_GET_XTAL_CK_SET_2_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CK_SET_2_0_8814B) & \ -+ BIT_MASK_XTAL_CK_SET_2_0_8814B) -+#define BIT_SET_XTAL_CK_SET_2_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_CK_SET_2_0_8814B(x) | BIT_XTAL_CK_SET_2_0_8814B(v)) -+ -+#define BIT_SHIFT_GM_INIT_4_0_8814B 8 -+#define BIT_MASK_GM_INIT_4_0_8814B 0x1f -+#define BIT_GM_INIT_4_0_8814B(x) \ -+ (((x) & BIT_MASK_GM_INIT_4_0_8814B) << BIT_SHIFT_GM_INIT_4_0_8814B) -+#define BITS_GM_INIT_4_0_8814B \ -+ (BIT_MASK_GM_INIT_4_0_8814B << BIT_SHIFT_GM_INIT_4_0_8814B) -+#define BIT_CLEAR_GM_INIT_4_0_8814B(x) ((x) & (~BITS_GM_INIT_4_0_8814B)) -+#define BIT_GET_GM_INIT_4_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_GM_INIT_4_0_8814B) & BIT_MASK_GM_INIT_4_0_8814B) -+#define BIT_SET_GM_INIT_4_0_8814B(x, v) \ -+ (BIT_CLEAR_GM_INIT_4_0_8814B(x) | BIT_GM_INIT_4_0_8814B(v)) -+ -+#define BIT_GM_STEP_8814B BIT(7) -+ -+#define BIT_SHIFT_XAAC_GM_OFFSET_4_0_8814B 2 -+#define BIT_MASK_XAAC_GM_OFFSET_4_0_8814B 0x1f -+#define BIT_XAAC_GM_OFFSET_4_0_8814B(x) \ -+ (((x) & BIT_MASK_XAAC_GM_OFFSET_4_0_8814B) \ -+ << BIT_SHIFT_XAAC_GM_OFFSET_4_0_8814B) -+#define BITS_XAAC_GM_OFFSET_4_0_8814B \ -+ (BIT_MASK_XAAC_GM_OFFSET_4_0_8814B \ -+ << BIT_SHIFT_XAAC_GM_OFFSET_4_0_8814B) -+#define BIT_CLEAR_XAAC_GM_OFFSET_4_0_8814B(x) \ -+ ((x) & (~BITS_XAAC_GM_OFFSET_4_0_8814B)) -+#define BIT_GET_XAAC_GM_OFFSET_4_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XAAC_GM_OFFSET_4_0_8814B) & \ -+ BIT_MASK_XAAC_GM_OFFSET_4_0_8814B) -+#define BIT_SET_XAAC_GM_OFFSET_4_0_8814B(x, v) \ -+ (BIT_CLEAR_XAAC_GM_OFFSET_4_0_8814B(x) | \ -+ BIT_XAAC_GM_OFFSET_4_0_8814B(v)) -+ -+#define BIT_OFFSET_PLUS_8814B BIT(1) -+#define BIT_RESET_N_8814B BIT(0) -+ -+/* 2 REG_ANAPAR_XTAL_R_ONLY_8814B */ -+#define BIT_XTAL_PKDET_OUT_8814B BIT(6) -+ -+#define BIT_SHIFT_XTAL_GM_AAC_4_0_8814B 1 -+#define BIT_MASK_XTAL_GM_AAC_4_0_8814B 0x1f -+#define BIT_XTAL_GM_AAC_4_0_8814B(x) \ -+ (((x) & BIT_MASK_XTAL_GM_AAC_4_0_8814B) \ -+ << BIT_SHIFT_XTAL_GM_AAC_4_0_8814B) -+#define BITS_XTAL_GM_AAC_4_0_8814B \ -+ (BIT_MASK_XTAL_GM_AAC_4_0_8814B << BIT_SHIFT_XTAL_GM_AAC_4_0_8814B) -+#define BIT_CLEAR_XTAL_GM_AAC_4_0_8814B(x) ((x) & (~BITS_XTAL_GM_AAC_4_0_8814B)) -+#define BIT_GET_XTAL_GM_AAC_4_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GM_AAC_4_0_8814B) & \ -+ BIT_MASK_XTAL_GM_AAC_4_0_8814B) -+#define BIT_SET_XTAL_GM_AAC_4_0_8814B(x, v) \ -+ (BIT_CLEAR_XTAL_GM_AAC_4_0_8814B(x) | BIT_XTAL_GM_AAC_4_0_8814B(v)) -+ -+#define BIT_XAAC_READY_8814B BIT(0) -+ -+/* 2 REG_CPHY_LDO_8814B */ -+ -+#define BIT_SHIFT_CPHY_LDO_PD_8814B 12 -+#define BIT_MASK_CPHY_LDO_PD_8814B 0x3 -+#define BIT_CPHY_LDO_PD_8814B(x) \ -+ (((x) & BIT_MASK_CPHY_LDO_PD_8814B) << BIT_SHIFT_CPHY_LDO_PD_8814B) -+#define BITS_CPHY_LDO_PD_8814B \ -+ (BIT_MASK_CPHY_LDO_PD_8814B << BIT_SHIFT_CPHY_LDO_PD_8814B) -+#define BIT_CLEAR_CPHY_LDO_PD_8814B(x) ((x) & (~BITS_CPHY_LDO_PD_8814B)) -+#define BIT_GET_CPHY_LDO_PD_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPHY_LDO_PD_8814B) & BIT_MASK_CPHY_LDO_PD_8814B) -+#define BIT_SET_CPHY_LDO_PD_8814B(x, v) \ -+ (BIT_CLEAR_CPHY_LDO_PD_8814B(x) | BIT_CPHY_LDO_PD_8814B(v)) -+ -+#define BIT_SHIFT_CPHY_LDO_SR_8814B 10 -+#define BIT_MASK_CPHY_LDO_SR_8814B 0x3 -+#define BIT_CPHY_LDO_SR_8814B(x) \ -+ (((x) & BIT_MASK_CPHY_LDO_SR_8814B) << BIT_SHIFT_CPHY_LDO_SR_8814B) -+#define BITS_CPHY_LDO_SR_8814B \ -+ (BIT_MASK_CPHY_LDO_SR_8814B << BIT_SHIFT_CPHY_LDO_SR_8814B) -+#define BIT_CLEAR_CPHY_LDO_SR_8814B(x) ((x) & (~BITS_CPHY_LDO_SR_8814B)) -+#define BIT_GET_CPHY_LDO_SR_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPHY_LDO_SR_8814B) & BIT_MASK_CPHY_LDO_SR_8814B) -+#define BIT_SET_CPHY_LDO_SR_8814B(x, v) \ -+ (BIT_CLEAR_CPHY_LDO_SR_8814B(x) | BIT_CPHY_LDO_SR_8814B(v)) -+ -+#define BIT_SHIFT_CPHY_LDO_TUNEREF_8814B 8 -+#define BIT_MASK_CPHY_LDO_TUNEREF_8814B 0x3 -+#define BIT_CPHY_LDO_TUNEREF_8814B(x) \ -+ (((x) & BIT_MASK_CPHY_LDO_TUNEREF_8814B) \ -+ << BIT_SHIFT_CPHY_LDO_TUNEREF_8814B) -+#define BITS_CPHY_LDO_TUNEREF_8814B \ -+ (BIT_MASK_CPHY_LDO_TUNEREF_8814B << BIT_SHIFT_CPHY_LDO_TUNEREF_8814B) -+#define BIT_CLEAR_CPHY_LDO_TUNEREF_8814B(x) \ -+ ((x) & (~BITS_CPHY_LDO_TUNEREF_8814B)) -+#define BIT_GET_CPHY_LDO_TUNEREF_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPHY_LDO_TUNEREF_8814B) & \ -+ BIT_MASK_CPHY_LDO_TUNEREF_8814B) -+#define BIT_SET_CPHY_LDO_TUNEREF_8814B(x, v) \ -+ (BIT_CLEAR_CPHY_LDO_TUNEREF_8814B(x) | BIT_CPHY_LDO_TUNEREF_8814B(v)) -+ -+#define BIT_SHIFT_CPHY_LDO_TUNE_VO_8814B 5 -+#define BIT_MASK_CPHY_LDO_TUNE_VO_8814B 0x7 -+#define BIT_CPHY_LDO_TUNE_VO_8814B(x) \ -+ (((x) & BIT_MASK_CPHY_LDO_TUNE_VO_8814B) \ -+ << BIT_SHIFT_CPHY_LDO_TUNE_VO_8814B) -+#define BITS_CPHY_LDO_TUNE_VO_8814B \ -+ (BIT_MASK_CPHY_LDO_TUNE_VO_8814B << BIT_SHIFT_CPHY_LDO_TUNE_VO_8814B) -+#define BIT_CLEAR_CPHY_LDO_TUNE_VO_8814B(x) \ -+ ((x) & (~BITS_CPHY_LDO_TUNE_VO_8814B)) -+#define BIT_GET_CPHY_LDO_TUNE_VO_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPHY_LDO_TUNE_VO_8814B) & \ -+ BIT_MASK_CPHY_LDO_TUNE_VO_8814B) -+#define BIT_SET_CPHY_LDO_TUNE_VO_8814B(x, v) \ -+ (BIT_CLEAR_CPHY_LDO_TUNE_VO_8814B(x) | BIT_CPHY_LDO_TUNE_VO_8814B(v)) -+ -+#define BIT_SHIFT_CPHY_LDO_OCP_VTH_8814B 2 -+#define BIT_MASK_CPHY_LDO_OCP_VTH_8814B 0x7 -+#define BIT_CPHY_LDO_OCP_VTH_8814B(x) \ -+ (((x) & BIT_MASK_CPHY_LDO_OCP_VTH_8814B) \ -+ << BIT_SHIFT_CPHY_LDO_OCP_VTH_8814B) -+#define BITS_CPHY_LDO_OCP_VTH_8814B \ -+ (BIT_MASK_CPHY_LDO_OCP_VTH_8814B << BIT_SHIFT_CPHY_LDO_OCP_VTH_8814B) -+#define BIT_CLEAR_CPHY_LDO_OCP_VTH_8814B(x) \ -+ ((x) & (~BITS_CPHY_LDO_OCP_VTH_8814B)) -+#define BIT_GET_CPHY_LDO_OCP_VTH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPHY_LDO_OCP_VTH_8814B) & \ -+ BIT_MASK_CPHY_LDO_OCP_VTH_8814B) -+#define BIT_SET_CPHY_LDO_OCP_VTH_8814B(x, v) \ -+ (BIT_CLEAR_CPHY_LDO_OCP_VTH_8814B(x) | BIT_CPHY_LDO_OCP_VTH_8814B(v)) -+ -+#define BIT_SHIFT_VREF_LDO_OK_8814B 0 -+#define BIT_MASK_VREF_LDO_OK_8814B 0x3 -+#define BIT_VREF_LDO_OK_8814B(x) \ -+ (((x) & BIT_MASK_VREF_LDO_OK_8814B) << BIT_SHIFT_VREF_LDO_OK_8814B) -+#define BITS_VREF_LDO_OK_8814B \ -+ (BIT_MASK_VREF_LDO_OK_8814B << BIT_SHIFT_VREF_LDO_OK_8814B) -+#define BIT_CLEAR_VREF_LDO_OK_8814B(x) ((x) & (~BITS_VREF_LDO_OK_8814B)) -+#define BIT_GET_VREF_LDO_OK_8814B(x) \ -+ (((x) >> BIT_SHIFT_VREF_LDO_OK_8814B) & BIT_MASK_VREF_LDO_OK_8814B) -+#define BIT_SET_VREF_LDO_OK_8814B(x, v) \ -+ (BIT_CLEAR_VREF_LDO_OK_8814B(x) | BIT_VREF_LDO_OK_8814B(v)) -+ -+/* 2 REG_CPHY_BG_8814B */ -+ -+#define BIT_SHIFT_BG_8814B 0 -+#define BIT_MASK_BG_8814B 0x7 -+#define BIT_BG_8814B(x) (((x) & BIT_MASK_BG_8814B) << BIT_SHIFT_BG_8814B) -+#define BITS_BG_8814B (BIT_MASK_BG_8814B << BIT_SHIFT_BG_8814B) -+#define BIT_CLEAR_BG_8814B(x) ((x) & (~BITS_BG_8814B)) -+#define BIT_GET_BG_8814B(x) (((x) >> BIT_SHIFT_BG_8814B) & BIT_MASK_BG_8814B) -+#define BIT_SET_BG_8814B(x, v) (BIT_CLEAR_BG_8814B(x) | BIT_BG_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_HIMR_4_8814B */ -+#define BIT_TXBCN_OK_PORT4_8814B BIT(31) -+#define BIT_TXBCN_OK_PORT3_8814B BIT(30) -+#define BIT_TXBCN_OK_PORT2_8814B BIT(29) -+#define BIT_TXBCN_OK_PORT1_8814B BIT(28) -+#define BIT_TXBCN15OK_8814B BIT(23) -+#define BIT_TXBCN14OK_8814B BIT(22) -+#define BIT_TXBCN13OK_8814B BIT(21) -+#define BIT_TXBCN12OK_8814B BIT(20) -+#define BIT_TXBCN11OK_8814B BIT(19) -+#define BIT_TXBCN10OK_8814B BIT(18) -+#define BIT_TXBCN9OK_8814B BIT(17) -+#define BIT_TXBCN8OK_8814B BIT(16) -+#define BIT_BCNDERR_PORT4_8814B BIT(15) -+#define BIT_BCNDERR_PORT3_8814B BIT(14) -+#define BIT_BCNDERR_PORT2_8814B BIT(13) -+#define BIT_BCNDERR_PORT1_8814B BIT(12) -+#define BIT_TXBCN15ERR_8814B BIT(7) -+#define BIT_TXBCN14ERR_8814B BIT(6) -+#define BIT_TXBCN13ERR_8814B BIT(5) -+#define BIT_TXBCN12ERR_8814B BIT(4) -+#define BIT_TXBCN11ERR_8814B BIT(3) -+#define BIT_TXBCN10ERR_8814B BIT(2) -+#define BIT_TXBCN9ERR_8814B BIT(1) -+#define BIT_TXBCN8ERR_8814B BIT(0) -+ -+/* 2 REG_HISR_4_8814B */ -+#define BIT_TXBCN_OK_PORT4_8814B BIT(31) -+#define BIT_TXBCN_OK_PORT3_8814B BIT(30) -+#define BIT_TXBCN_OK_PORT2_8814B BIT(29) -+#define BIT_TXBCN_OK_PORT1_8814B BIT(28) -+#define BIT_TXBCN15OK_8814B BIT(23) -+#define BIT_TXBCN14OK_8814B BIT(22) -+#define BIT_TXBCN13OK_8814B BIT(21) -+#define BIT_TXBCN12OK_8814B BIT(20) -+#define BIT_TXBCN11OK_8814B BIT(19) -+#define BIT_TXBCN10OK_8814B BIT(18) -+#define BIT_TXBCN9OK_8814B BIT(17) -+#define BIT_TXBCN8OK_8814B BIT(16) -+#define BIT_BCNDERR_PORT4_8814B BIT(15) -+#define BIT_BCNDERR_PORT3_8814B BIT(14) -+#define BIT_BCNDERR_PORT2_8814B BIT(13) -+#define BIT_BCNDERR_PORT1_8814B BIT(12) -+#define BIT_TXBCN15ERR_8814B BIT(7) -+#define BIT_TXBCN14ERR_8814B BIT(6) -+#define BIT_TXBCN13ERR_8814B BIT(5) -+#define BIT_TXBCN12ERR_8814B BIT(4) -+#define BIT_TXBCN11ERR_8814B BIT(3) -+#define BIT_TXBCN10ERR_8814B BIT(2) -+#define BIT_TXBCN9ERR_8814B BIT(1) -+#define BIT_TXBCN8ERR_8814B BIT(0) -+ -+/* 2 REG_HIMR_5_8814B */ -+#define BIT_BCNDMAINT15_8814B BIT(23) -+#define BIT_BCNDMAINT14_8814B BIT(22) -+#define BIT_BCNDMAINT13_8814B BIT(21) -+#define BIT_BCNDMAINT12_8814B BIT(20) -+#define BIT_BCNDMAINT11_8814B BIT(19) -+#define BIT_BCNDMAINT10_8814B BIT(18) -+#define BIT_BCNDMAINT9_8814B BIT(17) -+#define BIT_BCNDMAINT8_8814B BIT(16) -+#define BIT_BCNDERR_PORT4_8814B BIT(15) -+#define BIT_BCNDERR_PORT3_8814B BIT(14) -+#define BIT_BCNDERR_PORT2_8814B BIT(13) -+#define BIT_BCNDERR_PORT1_8814B BIT(12) -+#define BIT_BCNDERR15_8814B BIT(7) -+#define BIT_BCNDERR14_8814B BIT(6) -+#define BIT_BCNDERR13_8814B BIT(5) -+#define BIT_BCNDERR12_8814B BIT(4) -+#define BIT_BCNDERR11_8814B BIT(3) -+#define BIT_BCNDERR10_8814B BIT(2) -+#define BIT_BCNDERR9_8814B BIT(1) -+#define BIT_BCNDERR8_8814B BIT(0) -+ -+/* 2 REG_HISR_5_8814B */ -+#define BIT_BCNDMAINT15_8814B BIT(23) -+#define BIT_BCNDMAINT14_8814B BIT(22) -+#define BIT_BCNDMAINT13_8814B BIT(21) -+#define BIT_BCNDMAINT12_8814B BIT(20) -+#define BIT_BCNDMAINT11_8814B BIT(19) -+#define BIT_BCNDMAINT10_8814B BIT(18) -+#define BIT_BCNDMAINT9_8814B BIT(17) -+#define BIT_BCNDMAINT8_8814B BIT(16) -+#define BIT_BCNDERR_PORT4_8814B BIT(15) -+#define BIT_BCNDERR_PORT3_8814B BIT(14) -+#define BIT_BCNDERR_PORT2_8814B BIT(13) -+#define BIT_BCNDERR_PORT1_8814B BIT(12) -+#define BIT_BCNDERR15_8814B BIT(7) -+#define BIT_BCNDERR14_8814B BIT(6) -+#define BIT_BCNDERR13_8814B BIT(5) -+#define BIT_BCNDERR12_8814B BIT(4) -+#define BIT_BCNDERR11_8814B BIT(3) -+#define BIT_BCNDERR10_8814B BIT(2) -+#define BIT_BCNDERR9_8814B BIT(1) -+#define BIT_BCNDERR8_8814B BIT(0) -+ -+/* 2 REG_SYS_CFG5_8814B */ -+#define BIT_LPS_STATUS_8814B BIT(3) -+#define BIT_HCI_TXDMA_BUSY_8814B BIT(2) -+#define BIT_HCI_TXDMA_ALLOW_8814B BIT(1) -+#define BIT_FW_CTRL_HCI_TXDMA_EN_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_HIMR_6_8814B */ -+#define BIT_ATIMEND_PORT4_8814B BIT(31) -+#define BIT_ATIMEND_PORT3_8814B BIT(30) -+#define BIT_ATIMEND_PORT2_8814B BIT(29) -+#define BIT_ATIMEND_PORT1_8814B BIT(28) -+#define BIT_ATIMEND15_8814B BIT(23) -+#define BIT_ATIMEND14_8814B BIT(22) -+#define BIT_ATIMEND13_8814B BIT(21) -+#define BIT_ATIMEND12_8814B BIT(20) -+#define BIT_ATIMEND11_8814B BIT(19) -+#define BIT_ATIMEND10_8814B BIT(18) -+#define BIT_ATIMEND9_8814B BIT(17) -+#define BIT_ATIMEND8_8814B BIT(16) -+#define BIT_PS_TIMER_EARLY_INT_5_8814B BIT(5) -+#define BIT_PS_TIMER_EARLY_INT_4_8814B BIT(4) -+#define BIT_PS_TIMER_EARLY_INT_3_8814B BIT(3) -+#define BIT_PS_TIMER_EARLY_INT_2_8814B BIT(2) -+#define BIT_PS_TIMER_EARLY_INT_1_8814B BIT(1) -+#define BIT_PS_TIMER_EARLY_INT_0_8814B BIT(0) -+ -+/* 2 REG_HISR_6_8814B */ -+#define BIT_ATIMEND_PORT4_8814B BIT(31) -+#define BIT_ATIMEND_PORT3_8814B BIT(30) -+#define BIT_ATIMEND_PORT2_8814B BIT(29) -+#define BIT_ATIMEND_PORT1_8814B BIT(28) -+#define BIT_ATIMEND15_8814B BIT(23) -+#define BIT_ATIMEND14_8814B BIT(22) -+#define BIT_ATIMEND13_8814B BIT(21) -+#define BIT_ATIMEND12_8814B BIT(20) -+#define BIT_ATIMEND11_8814B BIT(19) -+#define BIT_ATIMEND10_8814B BIT(18) -+#define BIT_ATIMEND9_8814B BIT(17) -+#define BIT_ATIMEND8_8814B BIT(16) -+#define BIT_PS_TIMER_EARLY_INT_5_8814B BIT(5) -+#define BIT_PS_TIMER_EARLY_INT_4_8814B BIT(4) -+#define BIT_PS_TIMER_EARLY_INT_3_8814B BIT(3) -+#define BIT_PS_TIMER_EARLY_INT_2_8814B BIT(2) -+#define BIT_PS_TIMER_EARLY_INT_1_8814B BIT(1) -+#define BIT_PS_TIMER_EARLY_INT_0_8814B BIT(0) -+ -+/* 2 REG_CPU_DMEM_CON_8814B */ -+#define BIT_WDT_AUTO_MODE_8814B BIT(22) -+#define BIT_WDT_PLATFORM_EN_8814B BIT(21) -+#define BIT_WDT_CPU_EN_8814B BIT(20) -+#define BIT_WDT_OPT_IOWRAPPER_8814B BIT(19) -+#define BIT_ANA_PORT_IDLE_8814B BIT(18) -+#define BIT_MAC_PORT_IDLE_8814B BIT(17) -+#define BIT_WL_PLATFORM_RST_8814B BIT(16) -+#define BIT_WL_SECURITY_CLK_8814B BIT(15) -+#define BIT_DDMA_EN_8814B BIT(8) -+ -+#define BIT_SHIFT_CPU_DMEM_CON_8814B 0 -+#define BIT_MASK_CPU_DMEM_CON_8814B 0xff -+#define BIT_CPU_DMEM_CON_8814B(x) \ -+ (((x) & BIT_MASK_CPU_DMEM_CON_8814B) << BIT_SHIFT_CPU_DMEM_CON_8814B) -+#define BITS_CPU_DMEM_CON_8814B \ -+ (BIT_MASK_CPU_DMEM_CON_8814B << BIT_SHIFT_CPU_DMEM_CON_8814B) -+#define BIT_CLEAR_CPU_DMEM_CON_8814B(x) ((x) & (~BITS_CPU_DMEM_CON_8814B)) -+#define BIT_GET_CPU_DMEM_CON_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPU_DMEM_CON_8814B) & BIT_MASK_CPU_DMEM_CON_8814B) -+#define BIT_SET_CPU_DMEM_CON_8814B(x, v) \ -+ (BIT_CLEAR_CPU_DMEM_CON_8814B(x) | BIT_CPU_DMEM_CON_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BOOT_REASON_8814B */ -+ -+#define BIT_SHIFT_BOOT_REASON_V1_8814B 0 -+#define BIT_MASK_BOOT_REASON_V1_8814B 0x7 -+#define BIT_BOOT_REASON_V1_8814B(x) \ -+ (((x) & BIT_MASK_BOOT_REASON_V1_8814B) \ -+ << BIT_SHIFT_BOOT_REASON_V1_8814B) -+#define BITS_BOOT_REASON_V1_8814B \ -+ (BIT_MASK_BOOT_REASON_V1_8814B << BIT_SHIFT_BOOT_REASON_V1_8814B) -+#define BIT_CLEAR_BOOT_REASON_V1_8814B(x) ((x) & (~BITS_BOOT_REASON_V1_8814B)) -+#define BIT_GET_BOOT_REASON_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BOOT_REASON_V1_8814B) & \ -+ BIT_MASK_BOOT_REASON_V1_8814B) -+#define BIT_SET_BOOT_REASON_V1_8814B(x, v) \ -+ (BIT_CLEAR_BOOT_REASON_V1_8814B(x) | BIT_BOOT_REASON_V1_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_DATA_CPU_CTL0_8814B */ -+#define BIT_DATA_FW_READY_8814B BIT(31) -+#define BIT_WDT_SYS_RST_8814B BIT(13) -+#define BIT_WDT_ENABLE_8814B BIT(12) -+ -+#define BIT_SHIFT_BOOT_SEL_8814B 6 -+#define BIT_MASK_BOOT_SEL_8814B 0x3 -+#define BIT_BOOT_SEL_8814B(x) \ -+ (((x) & BIT_MASK_BOOT_SEL_8814B) << BIT_SHIFT_BOOT_SEL_8814B) -+#define BITS_BOOT_SEL_8814B \ -+ (BIT_MASK_BOOT_SEL_8814B << BIT_SHIFT_BOOT_SEL_8814B) -+#define BIT_CLEAR_BOOT_SEL_8814B(x) ((x) & (~BITS_BOOT_SEL_8814B)) -+#define BIT_GET_BOOT_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_BOOT_SEL_8814B) & BIT_MASK_BOOT_SEL_8814B) -+#define BIT_SET_BOOT_SEL_8814B(x, v) \ -+ (BIT_CLEAR_BOOT_SEL_8814B(x) | BIT_BOOT_SEL_8814B(v)) -+ -+#define BIT_CLK_SEL_8814B BIT(4) -+#define BIT_DATA_PLATFORM_RST_8814B BIT(1) -+#define BIT_DATA_CPU_RST_8814B BIT(0) -+ -+/* 2 REG_DATA_CPU_CTL1_8814B */ -+#define BIT_HOST_INTERFACE_IO_PATH_8814B BIT(7) -+#define BIT_EN_TXDMA_OFLD_8814B BIT(6) -+#define BIT_EN_RXDMA_OFLD_8814B BIT(5) -+#define BIT_EN_HCI_DMA_TX_8814B BIT(4) -+#define BIT_EN_HCI_DMA_RX_8814B BIT(3) -+#define BIT_EN_AXI_DMA_TX_8814B BIT(2) -+#define BIT_EN_AXI_DMA_RX_8814B BIT(1) -+#define BIT_EN_PKT_ENG_8814B BIT(0) -+ -+/* 2 REG_TXDMA_STOP_HIMR_8814B */ -+ -+#define BIT_SHIFT_NTH_TXDMA_STOP_INT_MSK_8814B 0 -+#define BIT_MASK_NTH_TXDMA_STOP_INT_MSK_8814B 0x1ffff -+#define BIT_NTH_TXDMA_STOP_INT_MSK_8814B(x) \ -+ (((x) & BIT_MASK_NTH_TXDMA_STOP_INT_MSK_8814B) \ -+ << BIT_SHIFT_NTH_TXDMA_STOP_INT_MSK_8814B) -+#define BITS_NTH_TXDMA_STOP_INT_MSK_8814B \ -+ (BIT_MASK_NTH_TXDMA_STOP_INT_MSK_8814B \ -+ << BIT_SHIFT_NTH_TXDMA_STOP_INT_MSK_8814B) -+#define BIT_CLEAR_NTH_TXDMA_STOP_INT_MSK_8814B(x) \ -+ ((x) & (~BITS_NTH_TXDMA_STOP_INT_MSK_8814B)) -+#define BIT_GET_NTH_TXDMA_STOP_INT_MSK_8814B(x) \ -+ (((x) >> BIT_SHIFT_NTH_TXDMA_STOP_INT_MSK_8814B) & \ -+ BIT_MASK_NTH_TXDMA_STOP_INT_MSK_8814B) -+#define BIT_SET_NTH_TXDMA_STOP_INT_MSK_8814B(x, v) \ -+ (BIT_CLEAR_NTH_TXDMA_STOP_INT_MSK_8814B(x) | \ -+ BIT_NTH_TXDMA_STOP_INT_MSK_8814B(v)) -+ -+/* 2 REG_TXDMA_STOP_HISR_8814B */ -+ -+#define BIT_SHIFT_NTH_TXDMA_STOP_INT_8814B 0 -+#define BIT_MASK_NTH_TXDMA_STOP_INT_8814B 0x1ffff -+#define BIT_NTH_TXDMA_STOP_INT_8814B(x) \ -+ (((x) & BIT_MASK_NTH_TXDMA_STOP_INT_8814B) \ -+ << BIT_SHIFT_NTH_TXDMA_STOP_INT_8814B) -+#define BITS_NTH_TXDMA_STOP_INT_8814B \ -+ (BIT_MASK_NTH_TXDMA_STOP_INT_8814B \ -+ << BIT_SHIFT_NTH_TXDMA_STOP_INT_8814B) -+#define BIT_CLEAR_NTH_TXDMA_STOP_INT_8814B(x) \ -+ ((x) & (~BITS_NTH_TXDMA_STOP_INT_8814B)) -+#define BIT_GET_NTH_TXDMA_STOP_INT_8814B(x) \ -+ (((x) >> BIT_SHIFT_NTH_TXDMA_STOP_INT_8814B) & \ -+ BIT_MASK_NTH_TXDMA_STOP_INT_8814B) -+#define BIT_SET_NTH_TXDMA_STOP_INT_8814B(x, v) \ -+ (BIT_CLEAR_NTH_TXDMA_STOP_INT_8814B(x) | \ -+ BIT_NTH_TXDMA_STOP_INT_8814B(v)) -+ -+/* 2 REG_TXDMA_START_HIMR_8814B */ -+ -+#define BIT_SHIFT_NTH_TXDMA_START_INT_MSK_8814B 0 -+#define BIT_MASK_NTH_TXDMA_START_INT_MSK_8814B 0x1ffff -+#define BIT_NTH_TXDMA_START_INT_MSK_8814B(x) \ -+ (((x) & BIT_MASK_NTH_TXDMA_START_INT_MSK_8814B) \ -+ << BIT_SHIFT_NTH_TXDMA_START_INT_MSK_8814B) -+#define BITS_NTH_TXDMA_START_INT_MSK_8814B \ -+ (BIT_MASK_NTH_TXDMA_START_INT_MSK_8814B \ -+ << BIT_SHIFT_NTH_TXDMA_START_INT_MSK_8814B) -+#define BIT_CLEAR_NTH_TXDMA_START_INT_MSK_8814B(x) \ -+ ((x) & (~BITS_NTH_TXDMA_START_INT_MSK_8814B)) -+#define BIT_GET_NTH_TXDMA_START_INT_MSK_8814B(x) \ -+ (((x) >> BIT_SHIFT_NTH_TXDMA_START_INT_MSK_8814B) & \ -+ BIT_MASK_NTH_TXDMA_START_INT_MSK_8814B) -+#define BIT_SET_NTH_TXDMA_START_INT_MSK_8814B(x, v) \ -+ (BIT_CLEAR_NTH_TXDMA_START_INT_MSK_8814B(x) | \ -+ BIT_NTH_TXDMA_START_INT_MSK_8814B(v)) -+ -+/* 2 REG_TXDMA_START_HISR_8814B */ -+ -+#define BIT_SHIFT_NTH_TXDMA_START_INT_8814B 0 -+#define BIT_MASK_NTH_TXDMA_START_INT_8814B 0x1ffff -+#define BIT_NTH_TXDMA_START_INT_8814B(x) \ -+ (((x) & BIT_MASK_NTH_TXDMA_START_INT_8814B) \ -+ << BIT_SHIFT_NTH_TXDMA_START_INT_8814B) -+#define BITS_NTH_TXDMA_START_INT_8814B \ -+ (BIT_MASK_NTH_TXDMA_START_INT_8814B \ -+ << BIT_SHIFT_NTH_TXDMA_START_INT_8814B) -+#define BIT_CLEAR_NTH_TXDMA_START_INT_8814B(x) \ -+ ((x) & (~BITS_NTH_TXDMA_START_INT_8814B)) -+#define BIT_GET_NTH_TXDMA_START_INT_8814B(x) \ -+ (((x) >> BIT_SHIFT_NTH_TXDMA_START_INT_8814B) & \ -+ BIT_MASK_NTH_TXDMA_START_INT_8814B) -+#define BIT_SET_NTH_TXDMA_START_INT_8814B(x, v) \ -+ (BIT_CLEAR_NTH_TXDMA_START_INT_8814B(x) | \ -+ BIT_NTH_TXDMA_START_INT_8814B(v)) -+ -+/* 2 REG_NFCPAD_CTRL_8814B */ -+#define BIT_PAD_SHUTDW_8814B BIT(18) -+#define BIT_SYSON_NFC_PAD_8814B BIT(17) -+#define BIT_NFC_INT_PAD_CTRL_8814B BIT(16) -+#define BIT_NFC_RFDIS_PAD_CTRL_8814B BIT(15) -+#define BIT_NFC_CLK_PAD_CTRL_8814B BIT(14) -+#define BIT_NFC_DATA_PAD_CTRL_8814B BIT(13) -+#define BIT_NFC_PAD_PULL_CTRL_8814B BIT(12) -+ -+#define BIT_SHIFT_NFCPAD_IO_SEL_8814B 8 -+#define BIT_MASK_NFCPAD_IO_SEL_8814B 0xf -+#define BIT_NFCPAD_IO_SEL_8814B(x) \ -+ (((x) & BIT_MASK_NFCPAD_IO_SEL_8814B) << BIT_SHIFT_NFCPAD_IO_SEL_8814B) -+#define BITS_NFCPAD_IO_SEL_8814B \ -+ (BIT_MASK_NFCPAD_IO_SEL_8814B << BIT_SHIFT_NFCPAD_IO_SEL_8814B) -+#define BIT_CLEAR_NFCPAD_IO_SEL_8814B(x) ((x) & (~BITS_NFCPAD_IO_SEL_8814B)) -+#define BIT_GET_NFCPAD_IO_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_IO_SEL_8814B) & BIT_MASK_NFCPAD_IO_SEL_8814B) -+#define BIT_SET_NFCPAD_IO_SEL_8814B(x, v) \ -+ (BIT_CLEAR_NFCPAD_IO_SEL_8814B(x) | BIT_NFCPAD_IO_SEL_8814B(v)) -+ -+#define BIT_SHIFT_NFCPAD_OUT_8814B 4 -+#define BIT_MASK_NFCPAD_OUT_8814B 0xf -+#define BIT_NFCPAD_OUT_8814B(x) \ -+ (((x) & BIT_MASK_NFCPAD_OUT_8814B) << BIT_SHIFT_NFCPAD_OUT_8814B) -+#define BITS_NFCPAD_OUT_8814B \ -+ (BIT_MASK_NFCPAD_OUT_8814B << BIT_SHIFT_NFCPAD_OUT_8814B) -+#define BIT_CLEAR_NFCPAD_OUT_8814B(x) ((x) & (~BITS_NFCPAD_OUT_8814B)) -+#define BIT_GET_NFCPAD_OUT_8814B(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_OUT_8814B) & BIT_MASK_NFCPAD_OUT_8814B) -+#define BIT_SET_NFCPAD_OUT_8814B(x, v) \ -+ (BIT_CLEAR_NFCPAD_OUT_8814B(x) | BIT_NFCPAD_OUT_8814B(v)) -+ -+#define BIT_SHIFT_NFCPAD_IN_8814B 0 -+#define BIT_MASK_NFCPAD_IN_8814B 0xf -+#define BIT_NFCPAD_IN_8814B(x) \ -+ (((x) & BIT_MASK_NFCPAD_IN_8814B) << BIT_SHIFT_NFCPAD_IN_8814B) -+#define BITS_NFCPAD_IN_8814B \ -+ (BIT_MASK_NFCPAD_IN_8814B << BIT_SHIFT_NFCPAD_IN_8814B) -+#define BIT_CLEAR_NFCPAD_IN_8814B(x) ((x) & (~BITS_NFCPAD_IN_8814B)) -+#define BIT_GET_NFCPAD_IN_8814B(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_IN_8814B) & BIT_MASK_NFCPAD_IN_8814B) -+#define BIT_SET_NFCPAD_IN_8814B(x, v) \ -+ (BIT_CLEAR_NFCPAD_IN_8814B(x) | BIT_NFCPAD_IN_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_HIMR2_8814B */ -+#define BIT_BCNDMAINT_P4_MSK_8814B BIT(31) -+#define BIT_BCNDMAINT_P3_MSK_8814B BIT(30) -+#define BIT_BCNDMAINT_P2_MSK_8814B BIT(29) -+#define BIT_BCNDMAINT_P1_MSK_8814B BIT(28) -+#define BIT_SCH_PHY_TXOP_SIFS_INT_MSK_8814B BIT(23) -+#define BIT_ATIMEND7_MSK_8814B BIT(22) -+#define BIT_ATIMEND6_MSK_8814B BIT(21) -+#define BIT_ATIMEND5_MSK_8814B BIT(20) -+#define BIT_ATIMEND4_MSK_8814B BIT(19) -+#define BIT_ATIMEND3_MSK_8814B BIT(18) -+#define BIT_ATIMEND2_MSK_8814B BIT(17) -+#define BIT_ATIMEND1_MSK_8814B BIT(16) -+#define BIT_TXBCN7OK_MSK_8814B BIT(14) -+#define BIT_TXBCN6OK_MSK_8814B BIT(13) -+#define BIT_TXBCN5OK_MSK_8814B BIT(12) -+#define BIT_TXBCN4OK_MSK_8814B BIT(11) -+#define BIT_TXBCN3OK_MSK_8814B BIT(10) -+#define BIT_TXBCN2OK_MSK_8814B BIT(9) -+#define BIT_TXBCN1OK_MSK_V1_8814B BIT(8) -+#define BIT_TXBCN7ERR_MSK_8814B BIT(6) -+#define BIT_TXBCN6ERR_MSK_8814B BIT(5) -+#define BIT_TXBCN5ERR_MSK_8814B BIT(4) -+#define BIT_TXBCN4ERR_MSK_8814B BIT(3) -+#define BIT_TXBCN3ERR_MSK_8814B BIT(2) -+#define BIT_TXBCN2ERR_MSK_8814B BIT(1) -+#define BIT_TXBCN1ERR_MSK_V1_8814B BIT(0) -+ -+/* 2 REG_HISR2_8814B */ -+#define BIT_BCNDMAINT_P4_8814B BIT(31) -+#define BIT_BCNDMAINT_P3_8814B BIT(30) -+#define BIT_BCNDMAINT_P2_8814B BIT(29) -+#define BIT_BCNDMAINT_P1_8814B BIT(28) -+#define BIT_SCH_PHY_TXOP_SIFS_INT_8814B BIT(23) -+#define BIT_ATIMEND7_8814B BIT(22) -+#define BIT_ATIMEND6_8814B BIT(21) -+#define BIT_ATIMEND5_8814B BIT(20) -+#define BIT_ATIMEND4_8814B BIT(19) -+#define BIT_ATIMEND3_8814B BIT(18) -+#define BIT_ATIMEND2_8814B BIT(17) -+#define BIT_ATIMEND1_8814B BIT(16) -+#define BIT_TXBCN7OK_8814B BIT(14) -+#define BIT_TXBCN6OK_8814B BIT(13) -+#define BIT_TXBCN5OK_8814B BIT(12) -+#define BIT_TXBCN4OK_8814B BIT(11) -+#define BIT_TXBCN3OK_8814B BIT(10) -+#define BIT_TXBCN2OK_8814B BIT(9) -+#define BIT_TXBCN1OK_8814B BIT(8) -+#define BIT_TXBCN7ERR_8814B BIT(6) -+#define BIT_TXBCN6ERR_8814B BIT(5) -+#define BIT_TXBCN5ERR_8814B BIT(4) -+#define BIT_TXBCN4ERR_8814B BIT(3) -+#define BIT_TXBCN3ERR_8814B BIT(2) -+#define BIT_TXBCN2ERR_8814B BIT(1) -+#define BIT_TXBCN1ERR_8814B BIT(0) -+ -+/* 2 REG_HIMR3_8814B */ -+#define BIT_GTINT12_MSK_8814B BIT(24) -+#define BIT_GTINT11_MSK_8814B BIT(23) -+#define BIT_GTINT10_MSK_8814B BIT(22) -+#define BIT_GTINT9_MSK_8814B BIT(21) -+#define BIT_RX_DESC_BUF_FULL_MSK_8814B BIT(20) -+#define BIT_CPHY_LDO_OCP_DET_INT_MSK_8814B BIT(19) -+#define BIT_WDT_PLATFORM_INT_MSK_8814B BIT(18) -+#define BIT_WDT_CPU_INT_MSK_8814B BIT(17) -+#define BIT_SETH2CDOK_MASK_8814B BIT(16) -+#define BIT_H2C_CMD_FULL_MASK_8814B BIT(15) -+#define BIT_PKT_TRANS_ERR_MASK_8814B BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_MASK_8814B BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_MASK_8814B BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_MASK_8814B BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_MAS_8814B BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_MASK_8814B BIT(9) -+#define BIT_SEARCH_FAIL_MSK_8814B BIT(8) -+#define BIT_PWR_INT_127TO96_MASK_8814B BIT(7) -+#define BIT_PWR_INT_95TO64_MASK_8814B BIT(6) -+#define BIT_PWR_INT_63TO32_MASK_8814B BIT(5) -+#define BIT_PWR_INT_31TO0_MASK_8814B BIT(4) -+#define BIT_RX_DMA_STUCK_MSK_8814B BIT(3) -+#define BIT_TX_DMA_STUCK_MSK_8814B BIT(2) -+#define BIT_DDMA0_LP_INT_MSK_8814B BIT(1) -+#define BIT_DDMA0_HP_INT_MSK_8814B BIT(0) -+ -+/* 2 REG_HISR3_8814B */ -+#define BIT_GTINT12_8814B BIT(24) -+#define BIT_GTINT11_8814B BIT(23) -+#define BIT_GTINT10_8814B BIT(22) -+#define BIT_GTINT9_8814B BIT(21) -+#define BIT_RX_DESC_BUF_FULL_8814B BIT(20) -+#define BIT_CPHY_LDO_OCP_DET_INT_8814B BIT(19) -+#define BIT_WDT_PLATFORM_INT_8814B BIT(18) -+#define BIT_WDT_CPU_INT_8814B BIT(17) -+#define BIT_SETH2CDOK_8814B BIT(16) -+#define BIT_H2C_CMD_FULL_8814B BIT(15) -+#define BIT_PKT_TRANS_ERR_8814B BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_8814B BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_8814B BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_8814B BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_8814B BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_8814B BIT(9) -+#define BIT_SEARCH_FAIL_8814B BIT(8) -+#define BIT_PWR_INT_127TO96_8814B BIT(7) -+#define BIT_PWR_INT_95TO64_8814B BIT(6) -+#define BIT_PWR_INT_63TO32_8814B BIT(5) -+#define BIT_PWR_INT_31TO0_8814B BIT(4) -+#define BIT_RX_DMA_STUCK_8814B BIT(3) -+#define BIT_TX_DMA_STUCK_8814B BIT(2) -+#define BIT_DDMA0_LP_INT_8814B BIT(1) -+#define BIT_DDMA0_HP_INT_8814B BIT(0) -+ -+/* 2 REG_SW_MDIO_8814B */ -+#define BIT_DIS_TIMEOUT_IO_8814B BIT(24) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_HIMR_7_8814B */ -+#define BIT_DATA_CPU_WDT_INT_MSK_8814B BIT(31) -+#define BIT_OFLD_TXDMA_ERR_MSK_8814B BIT(30) -+#define BIT_OFLD_TXDMA_FULL_MSK_8814B BIT(29) -+#define BIT_OFLD_RXDMA_OVR_MSK_8814B BIT(28) -+#define BIT_OFLD_RXDMA_ERR_MSK_8814B BIT(27) -+#define BIT_OFLD_RXDMA_DES_UA_MSK_8814B BIT(26) -+#define BIT_TXDMAOK_CHANNEL_16_MSK_8814B BIT(16) -+#define BIT_TXDMAOK_CHANNEL_13_MSK_8814B BIT(13) -+#define BIT_TXDMAOK_CHANNEL_12_MSK_8814B BIT(12) -+#define BIT_TXDMAOK_CHANNEL_11_MSK_8814B BIT(11) -+#define BIT_TXDMAOK_CHANNEL_10_MSK_8814B BIT(10) -+#define BIT_TXDMAOK_CHANNEL_9_MSK_8814B BIT(9) -+#define BIT_TXDMAOK_CHANNEL_8_MSK_8814B BIT(8) -+#define BIT_TXDMAOK_CHANNEL_7_MSK_8814B BIT(7) -+#define BIT_TXDMAOK_CHANNEL_6_MSK_8814B BIT(6) -+#define BIT_TXDMAOK_CHANNEL_5_MSK_8814B BIT(5) -+#define BIT_TXDMAOK_CHANNEL_4_MSK_8814B BIT(4) -+ -+/* 2 REG_HISR_7_8814B */ -+#define BIT_DATA_CPU_WDT_INT_8814B BIT(31) -+#define BIT_OFLD_TXDMA_ERR_8814B BIT(30) -+#define BIT_OFLD_TXDMA_FULL_8814B BIT(29) -+#define BIT_OFLD_RXDMA_OVR_8814B BIT(28) -+#define BIT_OFLD_RXDMA_ERR_8814B BIT(27) -+#define BIT_OFLD_RXDMA_DES_UA_8814B BIT(26) -+#define BIT_TXDMAOK_CHANNEL_16_8814B BIT(16) -+#define BIT_TXDMAOK_CHANNEL_13_8814B BIT(13) -+#define BIT_TXDMAOK_CHANNEL_12_8814B BIT(12) -+#define BIT_TXDMAOK_CHANNEL_11_8814B BIT(11) -+#define BIT_TXDMAOK_CHANNEL_10_8814B BIT(10) -+#define BIT_TXDMAOK_CHANNEL_9_8814B BIT(9) -+#define BIT_TXDMAOK_CHANNEL_8_8814B BIT(8) -+#define BIT_TXDMAOK_CHANNEL_7_8814B BIT(7) -+#define BIT_TXDMAOK_CHANNEL_6_8814B BIT(6) -+#define BIT_TXDMAOK_CHANNEL_5_8814B BIT(5) -+#define BIT_TXDMAOK_CHANNEL_4_8814B BIT(4) -+ -+/* 2 REG_H2C_PKT_READADDR_8814B */ -+ -+#define BIT_SHIFT_H2C_PKT_READADDR_8814B 0 -+#define BIT_MASK_H2C_PKT_READADDR_8814B 0x3ffff -+#define BIT_H2C_PKT_READADDR_8814B(x) \ -+ (((x) & BIT_MASK_H2C_PKT_READADDR_8814B) \ -+ << BIT_SHIFT_H2C_PKT_READADDR_8814B) -+#define BITS_H2C_PKT_READADDR_8814B \ -+ (BIT_MASK_H2C_PKT_READADDR_8814B << BIT_SHIFT_H2C_PKT_READADDR_8814B) -+#define BIT_CLEAR_H2C_PKT_READADDR_8814B(x) \ -+ ((x) & (~BITS_H2C_PKT_READADDR_8814B)) -+#define BIT_GET_H2C_PKT_READADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_READADDR_8814B) & \ -+ BIT_MASK_H2C_PKT_READADDR_8814B) -+#define BIT_SET_H2C_PKT_READADDR_8814B(x, v) \ -+ (BIT_CLEAR_H2C_PKT_READADDR_8814B(x) | BIT_H2C_PKT_READADDR_8814B(v)) -+ -+/* 2 REG_H2C_PKT_WRITEADDR_8814B */ -+ -+#define BIT_SHIFT_H2C_PKT_WRITEADDR_8814B 0 -+#define BIT_MASK_H2C_PKT_WRITEADDR_8814B 0x3ffff -+#define BIT_H2C_PKT_WRITEADDR_8814B(x) \ -+ (((x) & BIT_MASK_H2C_PKT_WRITEADDR_8814B) \ -+ << BIT_SHIFT_H2C_PKT_WRITEADDR_8814B) -+#define BITS_H2C_PKT_WRITEADDR_8814B \ -+ (BIT_MASK_H2C_PKT_WRITEADDR_8814B << BIT_SHIFT_H2C_PKT_WRITEADDR_8814B) -+#define BIT_CLEAR_H2C_PKT_WRITEADDR_8814B(x) \ -+ ((x) & (~BITS_H2C_PKT_WRITEADDR_8814B)) -+#define BIT_GET_H2C_PKT_WRITEADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_WRITEADDR_8814B) & \ -+ BIT_MASK_H2C_PKT_WRITEADDR_8814B) -+#define BIT_SET_H2C_PKT_WRITEADDR_8814B(x, v) \ -+ (BIT_CLEAR_H2C_PKT_WRITEADDR_8814B(x) | BIT_H2C_PKT_WRITEADDR_8814B(v)) -+ -+/* 2 REG_MEM_PWR_CRTL_8814B */ -+#define BIT_MEM_BB_SD_8814B BIT(17) -+#define BIT_MEM_BB_DS_8814B BIT(16) -+#define BIT_MEM_DENG_LS_8814B BIT(13) -+#define BIT_MEM_DENG_DS_8814B BIT(12) -+#define BIT_MEM_BT_DS_8814B BIT(10) -+#define BIT_MEM_SDIO_LS_8814B BIT(9) -+#define BIT_MEM_SDIO_DS_8814B BIT(8) -+#define BIT_MEM_USB_LS_8814B BIT(7) -+#define BIT_MEM_USB_DS_8814B BIT(6) -+#define BIT_MEM_PCI_LS_8814B BIT(5) -+#define BIT_MEM_PCI_DS_8814B BIT(4) -+#define BIT_MEM_WLMAC_LS_8814B BIT(3) -+#define BIT_MEM_WLMAC_DS_8814B BIT(2) -+#define BIT_MEM_WLMCU_LS_8814B BIT(1) -+#define BIT_MEM_WLMCU_DS_8814B BIT(0) -+ -+/* 2 REG_FW_DRV_HANDSHAKE_8814B */ -+ -+#define BIT_SHIFT_FW_DRV_HANDSHAKE_8814B 0 -+#define BIT_MASK_FW_DRV_HANDSHAKE_8814B 0xffffffffL -+#define BIT_FW_DRV_HANDSHAKE_8814B(x) \ -+ (((x) & BIT_MASK_FW_DRV_HANDSHAKE_8814B) \ -+ << BIT_SHIFT_FW_DRV_HANDSHAKE_8814B) -+#define BITS_FW_DRV_HANDSHAKE_8814B \ -+ (BIT_MASK_FW_DRV_HANDSHAKE_8814B << BIT_SHIFT_FW_DRV_HANDSHAKE_8814B) -+#define BIT_CLEAR_FW_DRV_HANDSHAKE_8814B(x) \ -+ ((x) & (~BITS_FW_DRV_HANDSHAKE_8814B)) -+#define BIT_GET_FW_DRV_HANDSHAKE_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_DRV_HANDSHAKE_8814B) & \ -+ BIT_MASK_FW_DRV_HANDSHAKE_8814B) -+#define BIT_SET_FW_DRV_HANDSHAKE_8814B(x, v) \ -+ (BIT_CLEAR_FW_DRV_HANDSHAKE_8814B(x) | BIT_FW_DRV_HANDSHAKE_8814B(v)) -+ -+/* 2 REG_FW_DBG0_8814B */ -+ -+#define BIT_SHIFT_FW_DBG0_8814B 0 -+#define BIT_MASK_FW_DBG0_8814B 0xffffffffL -+#define BIT_FW_DBG0_8814B(x) \ -+ (((x) & BIT_MASK_FW_DBG0_8814B) << BIT_SHIFT_FW_DBG0_8814B) -+#define BITS_FW_DBG0_8814B (BIT_MASK_FW_DBG0_8814B << BIT_SHIFT_FW_DBG0_8814B) -+#define BIT_CLEAR_FW_DBG0_8814B(x) ((x) & (~BITS_FW_DBG0_8814B)) -+#define BIT_GET_FW_DBG0_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG0_8814B) & BIT_MASK_FW_DBG0_8814B) -+#define BIT_SET_FW_DBG0_8814B(x, v) \ -+ (BIT_CLEAR_FW_DBG0_8814B(x) | BIT_FW_DBG0_8814B(v)) -+ -+/* 2 REG_FW_DBG1_8814B */ -+ -+#define BIT_SHIFT_FW_DBG1_8814B 0 -+#define BIT_MASK_FW_DBG1_8814B 0xffffffffL -+#define BIT_FW_DBG1_8814B(x) \ -+ (((x) & BIT_MASK_FW_DBG1_8814B) << BIT_SHIFT_FW_DBG1_8814B) -+#define BITS_FW_DBG1_8814B (BIT_MASK_FW_DBG1_8814B << BIT_SHIFT_FW_DBG1_8814B) -+#define BIT_CLEAR_FW_DBG1_8814B(x) ((x) & (~BITS_FW_DBG1_8814B)) -+#define BIT_GET_FW_DBG1_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG1_8814B) & BIT_MASK_FW_DBG1_8814B) -+#define BIT_SET_FW_DBG1_8814B(x, v) \ -+ (BIT_CLEAR_FW_DBG1_8814B(x) | BIT_FW_DBG1_8814B(v)) -+ -+/* 2 REG_FW_DBG2_8814B */ -+ -+#define BIT_SHIFT_FW_DBG2_8814B 0 -+#define BIT_MASK_FW_DBG2_8814B 0xffffffffL -+#define BIT_FW_DBG2_8814B(x) \ -+ (((x) & BIT_MASK_FW_DBG2_8814B) << BIT_SHIFT_FW_DBG2_8814B) -+#define BITS_FW_DBG2_8814B (BIT_MASK_FW_DBG2_8814B << BIT_SHIFT_FW_DBG2_8814B) -+#define BIT_CLEAR_FW_DBG2_8814B(x) ((x) & (~BITS_FW_DBG2_8814B)) -+#define BIT_GET_FW_DBG2_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG2_8814B) & BIT_MASK_FW_DBG2_8814B) -+#define BIT_SET_FW_DBG2_8814B(x, v) \ -+ (BIT_CLEAR_FW_DBG2_8814B(x) | BIT_FW_DBG2_8814B(v)) -+ -+/* 2 REG_FW_DBG3_8814B */ -+ -+#define BIT_SHIFT_FW_DBG3_8814B 0 -+#define BIT_MASK_FW_DBG3_8814B 0xffffffffL -+#define BIT_FW_DBG3_8814B(x) \ -+ (((x) & BIT_MASK_FW_DBG3_8814B) << BIT_SHIFT_FW_DBG3_8814B) -+#define BITS_FW_DBG3_8814B (BIT_MASK_FW_DBG3_8814B << BIT_SHIFT_FW_DBG3_8814B) -+#define BIT_CLEAR_FW_DBG3_8814B(x) ((x) & (~BITS_FW_DBG3_8814B)) -+#define BIT_GET_FW_DBG3_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG3_8814B) & BIT_MASK_FW_DBG3_8814B) -+#define BIT_SET_FW_DBG3_8814B(x, v) \ -+ (BIT_CLEAR_FW_DBG3_8814B(x) | BIT_FW_DBG3_8814B(v)) -+ -+/* 2 REG_FW_DBG4_8814B */ -+ -+#define BIT_SHIFT_FW_DBG4_8814B 0 -+#define BIT_MASK_FW_DBG4_8814B 0xffffffffL -+#define BIT_FW_DBG4_8814B(x) \ -+ (((x) & BIT_MASK_FW_DBG4_8814B) << BIT_SHIFT_FW_DBG4_8814B) -+#define BITS_FW_DBG4_8814B (BIT_MASK_FW_DBG4_8814B << BIT_SHIFT_FW_DBG4_8814B) -+#define BIT_CLEAR_FW_DBG4_8814B(x) ((x) & (~BITS_FW_DBG4_8814B)) -+#define BIT_GET_FW_DBG4_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG4_8814B) & BIT_MASK_FW_DBG4_8814B) -+#define BIT_SET_FW_DBG4_8814B(x, v) \ -+ (BIT_CLEAR_FW_DBG4_8814B(x) | BIT_FW_DBG4_8814B(v)) -+ -+/* 2 REG_FW_DBG5_8814B */ -+ -+#define BIT_SHIFT_FW_DBG5_8814B 0 -+#define BIT_MASK_FW_DBG5_8814B 0xffffffffL -+#define BIT_FW_DBG5_8814B(x) \ -+ (((x) & BIT_MASK_FW_DBG5_8814B) << BIT_SHIFT_FW_DBG5_8814B) -+#define BITS_FW_DBG5_8814B (BIT_MASK_FW_DBG5_8814B << BIT_SHIFT_FW_DBG5_8814B) -+#define BIT_CLEAR_FW_DBG5_8814B(x) ((x) & (~BITS_FW_DBG5_8814B)) -+#define BIT_GET_FW_DBG5_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG5_8814B) & BIT_MASK_FW_DBG5_8814B) -+#define BIT_SET_FW_DBG5_8814B(x, v) \ -+ (BIT_CLEAR_FW_DBG5_8814B(x) | BIT_FW_DBG5_8814B(v)) -+ -+/* 2 REG_FW_DBG6_8814B */ -+ -+#define BIT_SHIFT_FW_DBG6_8814B 0 -+#define BIT_MASK_FW_DBG6_8814B 0xffffffffL -+#define BIT_FW_DBG6_8814B(x) \ -+ (((x) & BIT_MASK_FW_DBG6_8814B) << BIT_SHIFT_FW_DBG6_8814B) -+#define BITS_FW_DBG6_8814B (BIT_MASK_FW_DBG6_8814B << BIT_SHIFT_FW_DBG6_8814B) -+#define BIT_CLEAR_FW_DBG6_8814B(x) ((x) & (~BITS_FW_DBG6_8814B)) -+#define BIT_GET_FW_DBG6_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG6_8814B) & BIT_MASK_FW_DBG6_8814B) -+#define BIT_SET_FW_DBG6_8814B(x, v) \ -+ (BIT_CLEAR_FW_DBG6_8814B(x) | BIT_FW_DBG6_8814B(v)) -+ -+/* 2 REG_FW_DBG7_8814B */ -+ -+#define BIT_SHIFT_FW_DBG7_8814B 0 -+#define BIT_MASK_FW_DBG7_8814B 0xffffffffL -+#define BIT_FW_DBG7_8814B(x) \ -+ (((x) & BIT_MASK_FW_DBG7_8814B) << BIT_SHIFT_FW_DBG7_8814B) -+#define BITS_FW_DBG7_8814B (BIT_MASK_FW_DBG7_8814B << BIT_SHIFT_FW_DBG7_8814B) -+#define BIT_CLEAR_FW_DBG7_8814B(x) ((x) & (~BITS_FW_DBG7_8814B)) -+#define BIT_GET_FW_DBG7_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG7_8814B) & BIT_MASK_FW_DBG7_8814B) -+#define BIT_SET_FW_DBG7_8814B(x, v) \ -+ (BIT_CLEAR_FW_DBG7_8814B(x) | BIT_FW_DBG7_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_CR_8814B */ -+ -+#define BIT_SHIFT_LBMODE_8814B 24 -+#define BIT_MASK_LBMODE_8814B 0x1f -+#define BIT_LBMODE_8814B(x) \ -+ (((x) & BIT_MASK_LBMODE_8814B) << BIT_SHIFT_LBMODE_8814B) -+#define BITS_LBMODE_8814B (BIT_MASK_LBMODE_8814B << BIT_SHIFT_LBMODE_8814B) -+#define BIT_CLEAR_LBMODE_8814B(x) ((x) & (~BITS_LBMODE_8814B)) -+#define BIT_GET_LBMODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_LBMODE_8814B) & BIT_MASK_LBMODE_8814B) -+#define BIT_SET_LBMODE_8814B(x, v) \ -+ (BIT_CLEAR_LBMODE_8814B(x) | BIT_LBMODE_8814B(v)) -+ -+#define BIT_SHIFT_NETYPE1_8814B 18 -+#define BIT_MASK_NETYPE1_8814B 0x3 -+#define BIT_NETYPE1_8814B(x) \ -+ (((x) & BIT_MASK_NETYPE1_8814B) << BIT_SHIFT_NETYPE1_8814B) -+#define BITS_NETYPE1_8814B (BIT_MASK_NETYPE1_8814B << BIT_SHIFT_NETYPE1_8814B) -+#define BIT_CLEAR_NETYPE1_8814B(x) ((x) & (~BITS_NETYPE1_8814B)) -+#define BIT_GET_NETYPE1_8814B(x) \ -+ (((x) >> BIT_SHIFT_NETYPE1_8814B) & BIT_MASK_NETYPE1_8814B) -+#define BIT_SET_NETYPE1_8814B(x, v) \ -+ (BIT_CLEAR_NETYPE1_8814B(x) | BIT_NETYPE1_8814B(v)) -+ -+#define BIT_SHIFT_NETYPE0_8814B 16 -+#define BIT_MASK_NETYPE0_8814B 0x3 -+#define BIT_NETYPE0_8814B(x) \ -+ (((x) & BIT_MASK_NETYPE0_8814B) << BIT_SHIFT_NETYPE0_8814B) -+#define BITS_NETYPE0_8814B (BIT_MASK_NETYPE0_8814B << BIT_SHIFT_NETYPE0_8814B) -+#define BIT_CLEAR_NETYPE0_8814B(x) ((x) & (~BITS_NETYPE0_8814B)) -+#define BIT_GET_NETYPE0_8814B(x) \ -+ (((x) >> BIT_SHIFT_NETYPE0_8814B) & BIT_MASK_NETYPE0_8814B) -+#define BIT_SET_NETYPE0_8814B(x, v) \ -+ (BIT_CLEAR_NETYPE0_8814B(x) | BIT_NETYPE0_8814B(v)) -+ -+#define BIT_COUNTER_STS_EN_8814B BIT(13) -+#define BIT_I2C_MAILBOX_EN_8814B BIT(12) -+#define BIT_SHCUT_EN_8814B BIT(11) -+#define BIT_32K_CAL_TMR_EN_8814B BIT(10) -+#define BIT_MAC_SEC_EN_8814B BIT(9) -+#define BIT_ENSWBCN_8814B BIT(8) -+#define BIT_MACRXEN_8814B BIT(7) -+#define BIT_MACTXEN_8814B BIT(6) -+#define BIT_SCHEDULE_EN_8814B BIT(5) -+#define BIT_PROTOCOL_EN_8814B BIT(4) -+#define BIT_RXDMA_EN_8814B BIT(3) -+#define BIT_TXDMA_EN_8814B BIT(2) -+#define BIT_HCI_RXDMA_EN_8814B BIT(1) -+#define BIT_HCI_TXDMA_EN_8814B BIT(0) -+ -+/* 2 REG_PG_SIZE_8814B */ -+ -+#define BIT_SHIFT_DBG_FIFO_SEL_8814B 16 -+#define BIT_MASK_DBG_FIFO_SEL_8814B 0xff -+#define BIT_DBG_FIFO_SEL_8814B(x) \ -+ (((x) & BIT_MASK_DBG_FIFO_SEL_8814B) << BIT_SHIFT_DBG_FIFO_SEL_8814B) -+#define BITS_DBG_FIFO_SEL_8814B \ -+ (BIT_MASK_DBG_FIFO_SEL_8814B << BIT_SHIFT_DBG_FIFO_SEL_8814B) -+#define BIT_CLEAR_DBG_FIFO_SEL_8814B(x) ((x) & (~BITS_DBG_FIFO_SEL_8814B)) -+#define BIT_GET_DBG_FIFO_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_DBG_FIFO_SEL_8814B) & BIT_MASK_DBG_FIFO_SEL_8814B) -+#define BIT_SET_DBG_FIFO_SEL_8814B(x, v) \ -+ (BIT_CLEAR_DBG_FIFO_SEL_8814B(x) | BIT_DBG_FIFO_SEL_8814B(v)) -+ -+/* 2 REG_PKT_BUFF_ACCESS_CTRL_8814B */ -+ -+#define BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8814B 0 -+#define BIT_MASK_PKT_BUFF_ACCESS_CTRL_8814B 0xff -+#define BIT_PKT_BUFF_ACCESS_CTRL_8814B(x) \ -+ (((x) & BIT_MASK_PKT_BUFF_ACCESS_CTRL_8814B) \ -+ << BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8814B) -+#define BITS_PKT_BUFF_ACCESS_CTRL_8814B \ -+ (BIT_MASK_PKT_BUFF_ACCESS_CTRL_8814B \ -+ << BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8814B) -+#define BIT_CLEAR_PKT_BUFF_ACCESS_CTRL_8814B(x) \ -+ ((x) & (~BITS_PKT_BUFF_ACCESS_CTRL_8814B)) -+#define BIT_GET_PKT_BUFF_ACCESS_CTRL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8814B) & \ -+ BIT_MASK_PKT_BUFF_ACCESS_CTRL_8814B) -+#define BIT_SET_PKT_BUFF_ACCESS_CTRL_8814B(x, v) \ -+ (BIT_CLEAR_PKT_BUFF_ACCESS_CTRL_8814B(x) | \ -+ BIT_PKT_BUFF_ACCESS_CTRL_8814B(v)) -+ -+/* 2 REG_TSF_CLK_STATE_8814B */ -+#define BIT_TSF_CLK_STABLE_8814B BIT(15) -+ -+/* 2 REG_TXDMA_PQ_MAP_8814B */ -+ -+#define BIT_SHIFT_TXDMA_H2C_MAP_8814B 16 -+#define BIT_MASK_TXDMA_H2C_MAP_8814B 0x3 -+#define BIT_TXDMA_H2C_MAP_8814B(x) \ -+ (((x) & BIT_MASK_TXDMA_H2C_MAP_8814B) << BIT_SHIFT_TXDMA_H2C_MAP_8814B) -+#define BITS_TXDMA_H2C_MAP_8814B \ -+ (BIT_MASK_TXDMA_H2C_MAP_8814B << BIT_SHIFT_TXDMA_H2C_MAP_8814B) -+#define BIT_CLEAR_TXDMA_H2C_MAP_8814B(x) ((x) & (~BITS_TXDMA_H2C_MAP_8814B)) -+#define BIT_GET_TXDMA_H2C_MAP_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_H2C_MAP_8814B) & BIT_MASK_TXDMA_H2C_MAP_8814B) -+#define BIT_SET_TXDMA_H2C_MAP_8814B(x, v) \ -+ (BIT_CLEAR_TXDMA_H2C_MAP_8814B(x) | BIT_TXDMA_H2C_MAP_8814B(v)) -+ -+#define BIT_SHIFT_TXDMA_HIQ_MAP_8814B 14 -+#define BIT_MASK_TXDMA_HIQ_MAP_8814B 0x3 -+#define BIT_TXDMA_HIQ_MAP_8814B(x) \ -+ (((x) & BIT_MASK_TXDMA_HIQ_MAP_8814B) << BIT_SHIFT_TXDMA_HIQ_MAP_8814B) -+#define BITS_TXDMA_HIQ_MAP_8814B \ -+ (BIT_MASK_TXDMA_HIQ_MAP_8814B << BIT_SHIFT_TXDMA_HIQ_MAP_8814B) -+#define BIT_CLEAR_TXDMA_HIQ_MAP_8814B(x) ((x) & (~BITS_TXDMA_HIQ_MAP_8814B)) -+#define BIT_GET_TXDMA_HIQ_MAP_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_HIQ_MAP_8814B) & BIT_MASK_TXDMA_HIQ_MAP_8814B) -+#define BIT_SET_TXDMA_HIQ_MAP_8814B(x, v) \ -+ (BIT_CLEAR_TXDMA_HIQ_MAP_8814B(x) | BIT_TXDMA_HIQ_MAP_8814B(v)) -+ -+#define BIT_SHIFT_TXDMA_MGQ_MAP_8814B 12 -+#define BIT_MASK_TXDMA_MGQ_MAP_8814B 0x3 -+#define BIT_TXDMA_MGQ_MAP_8814B(x) \ -+ (((x) & BIT_MASK_TXDMA_MGQ_MAP_8814B) << BIT_SHIFT_TXDMA_MGQ_MAP_8814B) -+#define BITS_TXDMA_MGQ_MAP_8814B \ -+ (BIT_MASK_TXDMA_MGQ_MAP_8814B << BIT_SHIFT_TXDMA_MGQ_MAP_8814B) -+#define BIT_CLEAR_TXDMA_MGQ_MAP_8814B(x) ((x) & (~BITS_TXDMA_MGQ_MAP_8814B)) -+#define BIT_GET_TXDMA_MGQ_MAP_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_MGQ_MAP_8814B) & BIT_MASK_TXDMA_MGQ_MAP_8814B) -+#define BIT_SET_TXDMA_MGQ_MAP_8814B(x, v) \ -+ (BIT_CLEAR_TXDMA_MGQ_MAP_8814B(x) | BIT_TXDMA_MGQ_MAP_8814B(v)) -+ -+#define BIT_SHIFT_TXDMA_BKQ_MAP_8814B 10 -+#define BIT_MASK_TXDMA_BKQ_MAP_8814B 0x3 -+#define BIT_TXDMA_BKQ_MAP_8814B(x) \ -+ (((x) & BIT_MASK_TXDMA_BKQ_MAP_8814B) << BIT_SHIFT_TXDMA_BKQ_MAP_8814B) -+#define BITS_TXDMA_BKQ_MAP_8814B \ -+ (BIT_MASK_TXDMA_BKQ_MAP_8814B << BIT_SHIFT_TXDMA_BKQ_MAP_8814B) -+#define BIT_CLEAR_TXDMA_BKQ_MAP_8814B(x) ((x) & (~BITS_TXDMA_BKQ_MAP_8814B)) -+#define BIT_GET_TXDMA_BKQ_MAP_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BKQ_MAP_8814B) & BIT_MASK_TXDMA_BKQ_MAP_8814B) -+#define BIT_SET_TXDMA_BKQ_MAP_8814B(x, v) \ -+ (BIT_CLEAR_TXDMA_BKQ_MAP_8814B(x) | BIT_TXDMA_BKQ_MAP_8814B(v)) -+ -+#define BIT_SHIFT_TXDMA_BEQ_MAP_8814B 8 -+#define BIT_MASK_TXDMA_BEQ_MAP_8814B 0x3 -+#define BIT_TXDMA_BEQ_MAP_8814B(x) \ -+ (((x) & BIT_MASK_TXDMA_BEQ_MAP_8814B) << BIT_SHIFT_TXDMA_BEQ_MAP_8814B) -+#define BITS_TXDMA_BEQ_MAP_8814B \ -+ (BIT_MASK_TXDMA_BEQ_MAP_8814B << BIT_SHIFT_TXDMA_BEQ_MAP_8814B) -+#define BIT_CLEAR_TXDMA_BEQ_MAP_8814B(x) ((x) & (~BITS_TXDMA_BEQ_MAP_8814B)) -+#define BIT_GET_TXDMA_BEQ_MAP_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BEQ_MAP_8814B) & BIT_MASK_TXDMA_BEQ_MAP_8814B) -+#define BIT_SET_TXDMA_BEQ_MAP_8814B(x, v) \ -+ (BIT_CLEAR_TXDMA_BEQ_MAP_8814B(x) | BIT_TXDMA_BEQ_MAP_8814B(v)) -+ -+#define BIT_SHIFT_TXDMA_VIQ_MAP_8814B 6 -+#define BIT_MASK_TXDMA_VIQ_MAP_8814B 0x3 -+#define BIT_TXDMA_VIQ_MAP_8814B(x) \ -+ (((x) & BIT_MASK_TXDMA_VIQ_MAP_8814B) << BIT_SHIFT_TXDMA_VIQ_MAP_8814B) -+#define BITS_TXDMA_VIQ_MAP_8814B \ -+ (BIT_MASK_TXDMA_VIQ_MAP_8814B << BIT_SHIFT_TXDMA_VIQ_MAP_8814B) -+#define BIT_CLEAR_TXDMA_VIQ_MAP_8814B(x) ((x) & (~BITS_TXDMA_VIQ_MAP_8814B)) -+#define BIT_GET_TXDMA_VIQ_MAP_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VIQ_MAP_8814B) & BIT_MASK_TXDMA_VIQ_MAP_8814B) -+#define BIT_SET_TXDMA_VIQ_MAP_8814B(x, v) \ -+ (BIT_CLEAR_TXDMA_VIQ_MAP_8814B(x) | BIT_TXDMA_VIQ_MAP_8814B(v)) -+ -+#define BIT_SHIFT_TXDMA_VOQ_MAP_8814B 4 -+#define BIT_MASK_TXDMA_VOQ_MAP_8814B 0x3 -+#define BIT_TXDMA_VOQ_MAP_8814B(x) \ -+ (((x) & BIT_MASK_TXDMA_VOQ_MAP_8814B) << BIT_SHIFT_TXDMA_VOQ_MAP_8814B) -+#define BITS_TXDMA_VOQ_MAP_8814B \ -+ (BIT_MASK_TXDMA_VOQ_MAP_8814B << BIT_SHIFT_TXDMA_VOQ_MAP_8814B) -+#define BIT_CLEAR_TXDMA_VOQ_MAP_8814B(x) ((x) & (~BITS_TXDMA_VOQ_MAP_8814B)) -+#define BIT_GET_TXDMA_VOQ_MAP_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VOQ_MAP_8814B) & BIT_MASK_TXDMA_VOQ_MAP_8814B) -+#define BIT_SET_TXDMA_VOQ_MAP_8814B(x, v) \ -+ (BIT_CLEAR_TXDMA_VOQ_MAP_8814B(x) | BIT_TXDMA_VOQ_MAP_8814B(v)) -+ -+#define BIT_RXDMA_AGG_EN_8814B BIT(2) -+#define BIT_RXSHFT_EN_8814B BIT(1) -+#define BIT_RXDMA_ARBBW_EN_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_TRXFF_BNDY_8814B */ -+ -+#define BIT_SHIFT_FWFFOVFL_RSV_8814B 16 -+#define BIT_MASK_FWFFOVFL_RSV_8814B 0xf -+#define BIT_FWFFOVFL_RSV_8814B(x) \ -+ (((x) & BIT_MASK_FWFFOVFL_RSV_8814B) << BIT_SHIFT_FWFFOVFL_RSV_8814B) -+#define BITS_FWFFOVFL_RSV_8814B \ -+ (BIT_MASK_FWFFOVFL_RSV_8814B << BIT_SHIFT_FWFFOVFL_RSV_8814B) -+#define BIT_CLEAR_FWFFOVFL_RSV_8814B(x) ((x) & (~BITS_FWFFOVFL_RSV_8814B)) -+#define BIT_GET_FWFFOVFL_RSV_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWFFOVFL_RSV_8814B) & BIT_MASK_FWFFOVFL_RSV_8814B) -+#define BIT_SET_FWFFOVFL_RSV_8814B(x, v) \ -+ (BIT_CLEAR_FWFFOVFL_RSV_8814B(x) | BIT_FWFFOVFL_RSV_8814B(v)) -+ -+#define BIT_SHIFT_RXFFOVFL_RSV_V2_8814B 8 -+#define BIT_MASK_RXFFOVFL_RSV_V2_8814B 0xf -+#define BIT_RXFFOVFL_RSV_V2_8814B(x) \ -+ (((x) & BIT_MASK_RXFFOVFL_RSV_V2_8814B) \ -+ << BIT_SHIFT_RXFFOVFL_RSV_V2_8814B) -+#define BITS_RXFFOVFL_RSV_V2_8814B \ -+ (BIT_MASK_RXFFOVFL_RSV_V2_8814B << BIT_SHIFT_RXFFOVFL_RSV_V2_8814B) -+#define BIT_CLEAR_RXFFOVFL_RSV_V2_8814B(x) ((x) & (~BITS_RXFFOVFL_RSV_V2_8814B)) -+#define BIT_GET_RXFFOVFL_RSV_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFFOVFL_RSV_V2_8814B) & \ -+ BIT_MASK_RXFFOVFL_RSV_V2_8814B) -+#define BIT_SET_RXFFOVFL_RSV_V2_8814B(x, v) \ -+ (BIT_CLEAR_RXFFOVFL_RSV_V2_8814B(x) | BIT_RXFFOVFL_RSV_V2_8814B(v)) -+ -+/* 2 REG_PTA_I2C_MBOX_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_I2C_M_STATUS_8814B 8 -+#define BIT_MASK_I2C_M_STATUS_8814B 0xf -+#define BIT_I2C_M_STATUS_8814B(x) \ -+ (((x) & BIT_MASK_I2C_M_STATUS_8814B) << BIT_SHIFT_I2C_M_STATUS_8814B) -+#define BITS_I2C_M_STATUS_8814B \ -+ (BIT_MASK_I2C_M_STATUS_8814B << BIT_SHIFT_I2C_M_STATUS_8814B) -+#define BIT_CLEAR_I2C_M_STATUS_8814B(x) ((x) & (~BITS_I2C_M_STATUS_8814B)) -+#define BIT_GET_I2C_M_STATUS_8814B(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_STATUS_8814B) & BIT_MASK_I2C_M_STATUS_8814B) -+#define BIT_SET_I2C_M_STATUS_8814B(x, v) \ -+ (BIT_CLEAR_I2C_M_STATUS_8814B(x) | BIT_I2C_M_STATUS_8814B(v)) -+ -+#define BIT_SHIFT_I2C_M_BUS_GNT_FW_8814B 4 -+#define BIT_MASK_I2C_M_BUS_GNT_FW_8814B 0x7 -+#define BIT_I2C_M_BUS_GNT_FW_8814B(x) \ -+ (((x) & BIT_MASK_I2C_M_BUS_GNT_FW_8814B) \ -+ << BIT_SHIFT_I2C_M_BUS_GNT_FW_8814B) -+#define BITS_I2C_M_BUS_GNT_FW_8814B \ -+ (BIT_MASK_I2C_M_BUS_GNT_FW_8814B << BIT_SHIFT_I2C_M_BUS_GNT_FW_8814B) -+#define BIT_CLEAR_I2C_M_BUS_GNT_FW_8814B(x) \ -+ ((x) & (~BITS_I2C_M_BUS_GNT_FW_8814B)) -+#define BIT_GET_I2C_M_BUS_GNT_FW_8814B(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_BUS_GNT_FW_8814B) & \ -+ BIT_MASK_I2C_M_BUS_GNT_FW_8814B) -+#define BIT_SET_I2C_M_BUS_GNT_FW_8814B(x, v) \ -+ (BIT_CLEAR_I2C_M_BUS_GNT_FW_8814B(x) | BIT_I2C_M_BUS_GNT_FW_8814B(v)) -+ -+#define BIT_I2C_M_GNT_FW_8814B BIT(3) -+ -+#define BIT_SHIFT_I2C_M_SPEED_8814B 1 -+#define BIT_MASK_I2C_M_SPEED_8814B 0x3 -+#define BIT_I2C_M_SPEED_8814B(x) \ -+ (((x) & BIT_MASK_I2C_M_SPEED_8814B) << BIT_SHIFT_I2C_M_SPEED_8814B) -+#define BITS_I2C_M_SPEED_8814B \ -+ (BIT_MASK_I2C_M_SPEED_8814B << BIT_SHIFT_I2C_M_SPEED_8814B) -+#define BIT_CLEAR_I2C_M_SPEED_8814B(x) ((x) & (~BITS_I2C_M_SPEED_8814B)) -+#define BIT_GET_I2C_M_SPEED_8814B(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_SPEED_8814B) & BIT_MASK_I2C_M_SPEED_8814B) -+#define BIT_SET_I2C_M_SPEED_8814B(x, v) \ -+ (BIT_CLEAR_I2C_M_SPEED_8814B(x) | BIT_I2C_M_SPEED_8814B(v)) -+ -+#define BIT_I2C_M_UNLOCK_8814B BIT(0) -+ -+/* 2 REG_RXFF_BNDY_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_RXFF0_BNDY_V2_8814B 0 -+#define BIT_MASK_RXFF0_BNDY_V2_8814B 0x3ffff -+#define BIT_RXFF0_BNDY_V2_8814B(x) \ -+ (((x) & BIT_MASK_RXFF0_BNDY_V2_8814B) << BIT_SHIFT_RXFF0_BNDY_V2_8814B) -+#define BITS_RXFF0_BNDY_V2_8814B \ -+ (BIT_MASK_RXFF0_BNDY_V2_8814B << BIT_SHIFT_RXFF0_BNDY_V2_8814B) -+#define BIT_CLEAR_RXFF0_BNDY_V2_8814B(x) ((x) & (~BITS_RXFF0_BNDY_V2_8814B)) -+#define BIT_GET_RXFF0_BNDY_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_BNDY_V2_8814B) & BIT_MASK_RXFF0_BNDY_V2_8814B) -+#define BIT_SET_RXFF0_BNDY_V2_8814B(x, v) \ -+ (BIT_CLEAR_RXFF0_BNDY_V2_8814B(x) | BIT_RXFF0_BNDY_V2_8814B(v)) -+ -+/* 2 REG_FE1IMR_8814B */ -+#define BIT_CPUMGQ_DROP_BY_HOLD_TIME_INT_EN_8814B BIT(31) -+#define BIT_FWFF_FULL_INT_EN_8814B BIT(30) -+#define BIT_BB_STOP_RX_INT_EN_8814B BIT(29) -+#define BIT_FS_RXDMA2_DONE_INT_EN_8814B BIT(28) -+#define BIT_FS_RXDONE3_INT_EN_8814B BIT(27) -+#define BIT_FS_RXDONE2_INT_EN_8814B BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_EN_8814B BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_EN_8814B BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_EN_8814B BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_EN_8814B BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_EN_8814B BIT(21) -+#define BIT_FS_RX_UMD0_INT_EN_8814B BIT(20) -+#define BIT_FS_RX_UMD1_INT_EN_8814B BIT(19) -+#define BIT_FS_RX_BMD0_INT_EN_8814B BIT(18) -+#define BIT_FS_RX_BMD1_INT_EN_8814B BIT(17) -+#define BIT_FS_RXDONE_INT_EN_8814B BIT(16) -+#define BIT_FS_WWLAN_INT_EN_8814B BIT(15) -+#define BIT_FS_SOUND_DONE_INT_EN_8814B BIT(14) -+#define BIT_FS_TRL_MTR_INT_EN_8814B BIT(12) -+#define BIT_FS_BF1_PRETO_INT_EN_8814B BIT(11) -+#define BIT_FS_BF0_PRETO_INT_EN_8814B BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_EN_8814B BIT(9) -+#define BIT_PRETX_ERRHLD_INT_EN_8814B BIT(8) -+#define BIT_FS_GTRD_INT_EN_8814B BIT(7) -+#define BIT_FS_LTE_COEX_EN_8814B BIT(6) -+#define BIT_FS_WLACTOFF_INT_EN_8814B BIT(5) -+#define BIT_FS_WLACTON_INT_EN_8814B BIT(4) -+#define BIT_FS_BTCMD_INT_EN_8814B BIT(3) -+#define BIT_FS_REG_MAILBOX_TO_I2C_INT_EN_8814B BIT(2) -+#define BIT_FS_TRPC_TO_INT_EN_V1_8814B BIT(1) -+#define BIT_FS_RPC_O_T_INT_EN_V1_8814B BIT(0) -+ -+/* 2 REG_FE1ISR_8814B */ -+#define BIT_CPUMGQ_DROP_BY_HOLD_TIME_INT_8814B BIT(31) -+#define BIT_FWFF_FULL_INT_8814B BIT(30) -+#define BIT_BB_STOP_RX_INT_8814B BIT(29) -+#define BIT_FS_RXDMA2_DONE_INT_8814B BIT(28) -+#define BIT_FS_RXDONE3_INT_INT_8814B BIT(27) -+#define BIT_FS_RXDONE2_INT_8814B BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_8814B BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_8814B BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_8814B BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_8814B BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_8814B BIT(21) -+#define BIT_FS_RX_UMD0_INT_8814B BIT(20) -+#define BIT_FS_RX_UMD1_INT_8814B BIT(19) -+#define BIT_FS_RX_BMD0_INT_8814B BIT(18) -+#define BIT_FS_RX_BMD1_INT_8814B BIT(17) -+#define BIT_FS_RXDONE_INT_8814B BIT(16) -+#define BIT_FS_WWLAN_INT_8814B BIT(15) -+#define BIT_FS_SOUND_DONE_INT_8814B BIT(14) -+#define BIT_FS_TRL_MTR_INT_8814B BIT(12) -+#define BIT_FS_BF1_PRETO_INT_8814B BIT(11) -+#define BIT_FS_BF0_PRETO_INT_8814B BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_8814B BIT(9) -+#define BIT_PRETX_ERRHLD_INT_8814B BIT(8) -+#define BIT_SND_RDY_INT_8814B BIT(7) -+#define BIT_FS_LTE_COEX_INT_8814B BIT(6) -+#define BIT_FS_WLACTOFF_INT_8814B BIT(5) -+#define BIT_FS_WLACTON_INT_8814B BIT(4) -+#define BIT_BT_CMD_INT_8814B BIT(3) -+#define BIT_FS_MAILBOX_TO_I2C_INT_8814B BIT(2) -+#define BIT_FS_TRPC_TO_INT_8814B BIT(1) -+#define BIT_FS_RPC_O_T_INT_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_CPWM_8814B */ -+#define BIT_CPWM_TOGGLING_8814B BIT(31) -+ -+#define BIT_SHIFT_CPWM_MOD_8814B 24 -+#define BIT_MASK_CPWM_MOD_8814B 0x7f -+#define BIT_CPWM_MOD_8814B(x) \ -+ (((x) & BIT_MASK_CPWM_MOD_8814B) << BIT_SHIFT_CPWM_MOD_8814B) -+#define BITS_CPWM_MOD_8814B \ -+ (BIT_MASK_CPWM_MOD_8814B << BIT_SHIFT_CPWM_MOD_8814B) -+#define BIT_CLEAR_CPWM_MOD_8814B(x) ((x) & (~BITS_CPWM_MOD_8814B)) -+#define BIT_GET_CPWM_MOD_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPWM_MOD_8814B) & BIT_MASK_CPWM_MOD_8814B) -+#define BIT_SET_CPWM_MOD_8814B(x, v) \ -+ (BIT_CLEAR_CPWM_MOD_8814B(x) | BIT_CPWM_MOD_8814B(v)) -+ -+/* 2 REG_FWIMR_8814B */ -+#define BIT_FS_TXBCNOK_MB7_INT_EN_8814B BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_EN_8814B BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_EN_8814B BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_EN_8814B BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_EN_8814B BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_EN_8814B BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_EN_8814B BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_EN_8814B BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_EN_8814B BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_EN_8814B BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_EN_8814B BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_EN_8814B BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_EN_8814B BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_EN_8814B BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_EN_8814B BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_EN_8814B BIT(16) -+#define BIT_CPU_MGQ_TXDONE_INT_EN_8814B BIT(15) -+#define BIT_SIFS_OVERSPEC_INT_EN_8814B BIT(14) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_EN_8814B BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_EN_8814B BIT(12) -+#define BIT_FS_CPUMGQ_ERR_INT_EN_8814B BIT(11) -+#define BIT_FS_DDMA0_LP_INT_EN_8814B BIT(9) -+#define BIT_FS_DDMA0_HP_INT_EN_8814B BIT(8) -+#define BIT_FS_TRXRPT_INT_EN_8814B BIT(7) -+#define BIT_FS_C2H_W_READY_INT_EN_8814B BIT(6) -+#define BIT_FS_HRCV_INT_EN_8814B BIT(5) -+#define BIT_FS_H2CCMD_INT_EN_8814B BIT(4) -+#define BIT_FS_TXPKTIN_INT_EN_8814B BIT(3) -+#define BIT_FS_ERRORHDL_INT_EN_8814B BIT(2) -+#define BIT_FS_TXCCX_INT_EN_8814B BIT(1) -+#define BIT_FS_TXCLOSE_INT_EN_8814B BIT(0) -+ -+/* 2 REG_FWISR_8814B */ -+#define BIT_FS_TXBCNOK_MB7_INT_8814B BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_8814B BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_8814B BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_8814B BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_8814B BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_8814B BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_8814B BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_8814B BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_8814B BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_8814B BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_8814B BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_8814B BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_8814B BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_8814B BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_8814B BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_8814B BIT(16) -+#define BIT_CPU_MGQ_TXDONE_INT_8814B BIT(15) -+#define BIT_SIFS_OVERSPEC_INT_8814B BIT(14) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_8814B BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_8814B BIT(12) -+#define BIT_FS_CPUMGQ_ERR_INT_8814B BIT(11) -+#define BIT_FWCMD_PKTIN_INT_8814B BIT(10) -+#define BIT_FS_DDMA0_LP_INT_8814B BIT(9) -+#define BIT_FS_DDMA0_HP_INT_8814B BIT(8) -+#define BIT_FS_TRXRPT_INT_8814B BIT(7) -+#define BIT_FS_C2H_W_READY_INT_8814B BIT(6) -+#define BIT_FS_HRCV_INT_8814B BIT(5) -+#define BIT_FS_H2CCMD_INT_8814B BIT(4) -+#define BIT_FS_TXPKTIN_INT_8814B BIT(3) -+#define BIT_FS_ERRORHDL_INT_8814B BIT(2) -+#define BIT_FS_TXCCX_INT_8814B BIT(1) -+#define BIT_FS_TXCLOSE_INT_8814B BIT(0) -+ -+/* 2 REG_FTIMR_8814B */ -+#define BIT_PS_TIMER_C_EARLY_INT_EN_8814B BIT(23) -+#define BIT_PS_TIMER_B_EARLY_INT_EN_8814B BIT(22) -+#define BIT_PS_TIMER_A_EARLY_INT_EN_8814B BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_EN_8814B BIT(20) -+#define BIT_PS_TIMER_C_INT_EN_8814B BIT(19) -+#define BIT_PS_TIMER_B_INT_EN_8814B BIT(18) -+#define BIT_PS_TIMER_A_INT_EN_8814B BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_EN_8814B BIT(16) -+#define BIT_FS_PS_TIMEOUT2_EN_8814B BIT(15) -+#define BIT_FS_PS_TIMEOUT1_EN_8814B BIT(14) -+#define BIT_FS_PS_TIMEOUT0_EN_8814B BIT(13) -+#define BIT_FS_GTINT12_EN_8814B BIT(12) -+#define BIT_FS_GTINT11_EN_8814B BIT(11) -+#define BIT_FS_GTINT10_EN_8814B BIT(10) -+#define BIT_FS_GTINT9_EN_8814B BIT(9) -+#define BIT_FS_GTINT8_EN_8814B BIT(8) -+#define BIT_FS_GTINT7_EN_8814B BIT(7) -+#define BIT_FS_GTINT6_EN_8814B BIT(6) -+#define BIT_FS_GTINT5_EN_8814B BIT(5) -+#define BIT_FS_GTINT4_EN_8814B BIT(4) -+#define BIT_FS_GTINT3_EN_8814B BIT(3) -+#define BIT_FS_GTINT2_EN_8814B BIT(2) -+#define BIT_FS_GTINT1_EN_8814B BIT(1) -+#define BIT_FS_GTINT0_EN_8814B BIT(0) -+ -+/* 2 REG_FTISR_8814B */ -+#define BIT_PS_TIMER_5_EARLY__INT_8814B BIT(26) -+#define BIT_PS_TIMER_4_EARLY__INT_8814B BIT(25) -+#define BIT_PS_TIMER_3_EARLY__INT_8814B BIT(24) -+#define BIT_PS_TIMER_2_EARLY__INT_8814B BIT(23) -+#define BIT_PS_TIMER_1_EARLY__INT_8814B BIT(22) -+#define BIT_PS_TIMER_0_EARLY__INT_8814B BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_8814B BIT(20) -+#define BIT_PS_TIMER_5_INT_8814B BIT(19) -+#define BIT_PS_TIMER_4_INT_8814B BIT(18) -+#define BIT_PS_TIMER_3_INT_8814B BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_8814B BIT(16) -+#define BIT_PS_TIMER_2_INT_8814B BIT(15) -+#define BIT_PS_TIMER_1_INT_8814B BIT(14) -+#define BIT_PS_TIMER_0_INT_8814B BIT(13) -+#define BIT_FS_GTINT12_INT_8814B BIT(12) -+#define BIT_FS_GTINT11_INT_8814B BIT(11) -+#define BIT_FS_GTINT10_INT_8814B BIT(10) -+#define BIT_FS_GTINT9_INT_8814B BIT(9) -+#define BIT_FS_GTINT8_INT_8814B BIT(8) -+#define BIT_FS_GTINT7_INT_8814B BIT(7) -+#define BIT_FS_GTINT6_INT_8814B BIT(6) -+#define BIT_FS_GTINT5_INT_8814B BIT(5) -+#define BIT_FS_GTINT4_INT_8814B BIT(4) -+#define BIT_FS_GTINT3_INT_8814B BIT(3) -+#define BIT_FS_GTINT2_INT_8814B BIT(2) -+#define BIT_FS_GTINT1_INT_8814B BIT(1) -+#define BIT_FS_GTINT0_INT_8814B BIT(0) -+ -+/* 2 REG_PKTBUF_DBG_CTRL_8814B */ -+ -+#define BIT_SHIFT_PKTBUF_WRITE_EN_8814B 24 -+#define BIT_MASK_PKTBUF_WRITE_EN_8814B 0xff -+#define BIT_PKTBUF_WRITE_EN_8814B(x) \ -+ (((x) & BIT_MASK_PKTBUF_WRITE_EN_8814B) \ -+ << BIT_SHIFT_PKTBUF_WRITE_EN_8814B) -+#define BITS_PKTBUF_WRITE_EN_8814B \ -+ (BIT_MASK_PKTBUF_WRITE_EN_8814B << BIT_SHIFT_PKTBUF_WRITE_EN_8814B) -+#define BIT_CLEAR_PKTBUF_WRITE_EN_8814B(x) ((x) & (~BITS_PKTBUF_WRITE_EN_8814B)) -+#define BIT_GET_PKTBUF_WRITE_EN_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_WRITE_EN_8814B) & \ -+ BIT_MASK_PKTBUF_WRITE_EN_8814B) -+#define BIT_SET_PKTBUF_WRITE_EN_8814B(x, v) \ -+ (BIT_CLEAR_PKTBUF_WRITE_EN_8814B(x) | BIT_PKTBUF_WRITE_EN_8814B(v)) -+ -+#define BIT_TXRPTBUF_DBG_8814B BIT(23) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_TXPKTBUF_DBG_V2_8814B BIT(20) -+#define BIT_RXPKTBUF_DBG_8814B BIT(16) -+ -+#define BIT_SHIFT_PKTBUF_DBG_ADDR_8814B 0 -+#define BIT_MASK_PKTBUF_DBG_ADDR_8814B 0x1fff -+#define BIT_PKTBUF_DBG_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_ADDR_8814B) \ -+ << BIT_SHIFT_PKTBUF_DBG_ADDR_8814B) -+#define BITS_PKTBUF_DBG_ADDR_8814B \ -+ (BIT_MASK_PKTBUF_DBG_ADDR_8814B << BIT_SHIFT_PKTBUF_DBG_ADDR_8814B) -+#define BIT_CLEAR_PKTBUF_DBG_ADDR_8814B(x) ((x) & (~BITS_PKTBUF_DBG_ADDR_8814B)) -+#define BIT_GET_PKTBUF_DBG_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_ADDR_8814B) & \ -+ BIT_MASK_PKTBUF_DBG_ADDR_8814B) -+#define BIT_SET_PKTBUF_DBG_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_ADDR_8814B(x) | BIT_PKTBUF_DBG_ADDR_8814B(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_L_8814B */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_L_8814B 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_L_8814B 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_L_8814B(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_L_8814B) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_L_8814B) -+#define BITS_PKTBUF_DBG_DATA_L_8814B \ -+ (BIT_MASK_PKTBUF_DBG_DATA_L_8814B << BIT_SHIFT_PKTBUF_DBG_DATA_L_8814B) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_L_8814B(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_L_8814B)) -+#define BIT_GET_PKTBUF_DBG_DATA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_L_8814B) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_L_8814B) -+#define BIT_SET_PKTBUF_DBG_DATA_L_8814B(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_L_8814B(x) | BIT_PKTBUF_DBG_DATA_L_8814B(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_H_8814B */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_H_8814B 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_H_8814B 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_H_8814B(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_H_8814B) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_H_8814B) -+#define BITS_PKTBUF_DBG_DATA_H_8814B \ -+ (BIT_MASK_PKTBUF_DBG_DATA_H_8814B << BIT_SHIFT_PKTBUF_DBG_DATA_H_8814B) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_H_8814B(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_H_8814B)) -+#define BIT_GET_PKTBUF_DBG_DATA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_H_8814B) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_H_8814B) -+#define BIT_SET_PKTBUF_DBG_DATA_H_8814B(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_H_8814B(x) | BIT_PKTBUF_DBG_DATA_H_8814B(v)) -+ -+/* 2 REG_CPWM2_8814B */ -+ -+#define BIT_SHIFT_L0S_TO_RCVY_NUM_8814B 16 -+#define BIT_MASK_L0S_TO_RCVY_NUM_8814B 0xff -+#define BIT_L0S_TO_RCVY_NUM_8814B(x) \ -+ (((x) & BIT_MASK_L0S_TO_RCVY_NUM_8814B) \ -+ << BIT_SHIFT_L0S_TO_RCVY_NUM_8814B) -+#define BITS_L0S_TO_RCVY_NUM_8814B \ -+ (BIT_MASK_L0S_TO_RCVY_NUM_8814B << BIT_SHIFT_L0S_TO_RCVY_NUM_8814B) -+#define BIT_CLEAR_L0S_TO_RCVY_NUM_8814B(x) ((x) & (~BITS_L0S_TO_RCVY_NUM_8814B)) -+#define BIT_GET_L0S_TO_RCVY_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_L0S_TO_RCVY_NUM_8814B) & \ -+ BIT_MASK_L0S_TO_RCVY_NUM_8814B) -+#define BIT_SET_L0S_TO_RCVY_NUM_8814B(x, v) \ -+ (BIT_CLEAR_L0S_TO_RCVY_NUM_8814B(x) | BIT_L0S_TO_RCVY_NUM_8814B(v)) -+ -+#define BIT_CPWM2_TOGGLING_8814B BIT(15) -+ -+#define BIT_SHIFT_CPWM2_MOD_8814B 0 -+#define BIT_MASK_CPWM2_MOD_8814B 0x7fff -+#define BIT_CPWM2_MOD_8814B(x) \ -+ (((x) & BIT_MASK_CPWM2_MOD_8814B) << BIT_SHIFT_CPWM2_MOD_8814B) -+#define BITS_CPWM2_MOD_8814B \ -+ (BIT_MASK_CPWM2_MOD_8814B << BIT_SHIFT_CPWM2_MOD_8814B) -+#define BIT_CLEAR_CPWM2_MOD_8814B(x) ((x) & (~BITS_CPWM2_MOD_8814B)) -+#define BIT_GET_CPWM2_MOD_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPWM2_MOD_8814B) & BIT_MASK_CPWM2_MOD_8814B) -+#define BIT_SET_CPWM2_MOD_8814B(x, v) \ -+ (BIT_CLEAR_CPWM2_MOD_8814B(x) | BIT_CPWM2_MOD_8814B(v)) -+ -+/* 2 REG_TC0_CTRL_8814B */ -+#define BIT_TC0INT_EN_8814B BIT(26) -+#define BIT_TC0MODE_8814B BIT(25) -+#define BIT_TC0EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC0DATA_8814B 0 -+#define BIT_MASK_TC0DATA_8814B 0xffffff -+#define BIT_TC0DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC0DATA_8814B) << BIT_SHIFT_TC0DATA_8814B) -+#define BITS_TC0DATA_8814B (BIT_MASK_TC0DATA_8814B << BIT_SHIFT_TC0DATA_8814B) -+#define BIT_CLEAR_TC0DATA_8814B(x) ((x) & (~BITS_TC0DATA_8814B)) -+#define BIT_GET_TC0DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC0DATA_8814B) & BIT_MASK_TC0DATA_8814B) -+#define BIT_SET_TC0DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC0DATA_8814B(x) | BIT_TC0DATA_8814B(v)) -+ -+/* 2 REG_TC1_CTRL_8814B */ -+#define BIT_TC1INT_EN_8814B BIT(26) -+#define BIT_TC1MODE_8814B BIT(25) -+#define BIT_TC1EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC1DATA_8814B 0 -+#define BIT_MASK_TC1DATA_8814B 0xffffff -+#define BIT_TC1DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC1DATA_8814B) << BIT_SHIFT_TC1DATA_8814B) -+#define BITS_TC1DATA_8814B (BIT_MASK_TC1DATA_8814B << BIT_SHIFT_TC1DATA_8814B) -+#define BIT_CLEAR_TC1DATA_8814B(x) ((x) & (~BITS_TC1DATA_8814B)) -+#define BIT_GET_TC1DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC1DATA_8814B) & BIT_MASK_TC1DATA_8814B) -+#define BIT_SET_TC1DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC1DATA_8814B(x) | BIT_TC1DATA_8814B(v)) -+ -+/* 2 REG_TC2_CTRL_8814B */ -+#define BIT_TC2INT_EN_8814B BIT(26) -+#define BIT_TC2MODE_8814B BIT(25) -+#define BIT_TC2EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC2DATA_8814B 0 -+#define BIT_MASK_TC2DATA_8814B 0xffffff -+#define BIT_TC2DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC2DATA_8814B) << BIT_SHIFT_TC2DATA_8814B) -+#define BITS_TC2DATA_8814B (BIT_MASK_TC2DATA_8814B << BIT_SHIFT_TC2DATA_8814B) -+#define BIT_CLEAR_TC2DATA_8814B(x) ((x) & (~BITS_TC2DATA_8814B)) -+#define BIT_GET_TC2DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC2DATA_8814B) & BIT_MASK_TC2DATA_8814B) -+#define BIT_SET_TC2DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC2DATA_8814B(x) | BIT_TC2DATA_8814B(v)) -+ -+/* 2 REG_TC3_CTRL_8814B */ -+#define BIT_TC3INT_EN_8814B BIT(26) -+#define BIT_TC3MODE_8814B BIT(25) -+#define BIT_TC3EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC3DATA_8814B 0 -+#define BIT_MASK_TC3DATA_8814B 0xffffff -+#define BIT_TC3DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC3DATA_8814B) << BIT_SHIFT_TC3DATA_8814B) -+#define BITS_TC3DATA_8814B (BIT_MASK_TC3DATA_8814B << BIT_SHIFT_TC3DATA_8814B) -+#define BIT_CLEAR_TC3DATA_8814B(x) ((x) & (~BITS_TC3DATA_8814B)) -+#define BIT_GET_TC3DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC3DATA_8814B) & BIT_MASK_TC3DATA_8814B) -+#define BIT_SET_TC3DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC3DATA_8814B(x) | BIT_TC3DATA_8814B(v)) -+ -+/* 2 REG_TC4_CTRL_8814B */ -+#define BIT_TC4INT_EN_8814B BIT(26) -+#define BIT_TC4MODE_8814B BIT(25) -+#define BIT_TC4EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC4DATA_8814B 0 -+#define BIT_MASK_TC4DATA_8814B 0xffffff -+#define BIT_TC4DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC4DATA_8814B) << BIT_SHIFT_TC4DATA_8814B) -+#define BITS_TC4DATA_8814B (BIT_MASK_TC4DATA_8814B << BIT_SHIFT_TC4DATA_8814B) -+#define BIT_CLEAR_TC4DATA_8814B(x) ((x) & (~BITS_TC4DATA_8814B)) -+#define BIT_GET_TC4DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC4DATA_8814B) & BIT_MASK_TC4DATA_8814B) -+#define BIT_SET_TC4DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC4DATA_8814B(x) | BIT_TC4DATA_8814B(v)) -+ -+/* 2 REG_TCUNIT_BASE_8814B */ -+ -+#define BIT_SHIFT_TCUNIT_BASE_8814B 0 -+#define BIT_MASK_TCUNIT_BASE_8814B 0x3fff -+#define BIT_TCUNIT_BASE_8814B(x) \ -+ (((x) & BIT_MASK_TCUNIT_BASE_8814B) << BIT_SHIFT_TCUNIT_BASE_8814B) -+#define BITS_TCUNIT_BASE_8814B \ -+ (BIT_MASK_TCUNIT_BASE_8814B << BIT_SHIFT_TCUNIT_BASE_8814B) -+#define BIT_CLEAR_TCUNIT_BASE_8814B(x) ((x) & (~BITS_TCUNIT_BASE_8814B)) -+#define BIT_GET_TCUNIT_BASE_8814B(x) \ -+ (((x) >> BIT_SHIFT_TCUNIT_BASE_8814B) & BIT_MASK_TCUNIT_BASE_8814B) -+#define BIT_SET_TCUNIT_BASE_8814B(x, v) \ -+ (BIT_CLEAR_TCUNIT_BASE_8814B(x) | BIT_TCUNIT_BASE_8814B(v)) -+ -+/* 2 REG_TC5_CTRL_8814B */ -+#define BIT_TC5INT_EN_8814B BIT(26) -+#define BIT_TC5MODE_8814B BIT(25) -+#define BIT_TC5EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC5DATA_8814B 0 -+#define BIT_MASK_TC5DATA_8814B 0xffffff -+#define BIT_TC5DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC5DATA_8814B) << BIT_SHIFT_TC5DATA_8814B) -+#define BITS_TC5DATA_8814B (BIT_MASK_TC5DATA_8814B << BIT_SHIFT_TC5DATA_8814B) -+#define BIT_CLEAR_TC5DATA_8814B(x) ((x) & (~BITS_TC5DATA_8814B)) -+#define BIT_GET_TC5DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC5DATA_8814B) & BIT_MASK_TC5DATA_8814B) -+#define BIT_SET_TC5DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC5DATA_8814B(x) | BIT_TC5DATA_8814B(v)) -+ -+/* 2 REG_TC6_CTRL_8814B */ -+#define BIT_TC6INT_EN_8814B BIT(26) -+#define BIT_TC6MODE_8814B BIT(25) -+#define BIT_TC6EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC6DATA_8814B 0 -+#define BIT_MASK_TC6DATA_8814B 0xffffff -+#define BIT_TC6DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC6DATA_8814B) << BIT_SHIFT_TC6DATA_8814B) -+#define BITS_TC6DATA_8814B (BIT_MASK_TC6DATA_8814B << BIT_SHIFT_TC6DATA_8814B) -+#define BIT_CLEAR_TC6DATA_8814B(x) ((x) & (~BITS_TC6DATA_8814B)) -+#define BIT_GET_TC6DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC6DATA_8814B) & BIT_MASK_TC6DATA_8814B) -+#define BIT_SET_TC6DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC6DATA_8814B(x) | BIT_TC6DATA_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_AES_DECRPT_DATA_8814B */ -+ -+#define BIT_SHIFT_IPS_CFG_ADDR_8814B 0 -+#define BIT_MASK_IPS_CFG_ADDR_8814B 0xff -+#define BIT_IPS_CFG_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_IPS_CFG_ADDR_8814B) << BIT_SHIFT_IPS_CFG_ADDR_8814B) -+#define BITS_IPS_CFG_ADDR_8814B \ -+ (BIT_MASK_IPS_CFG_ADDR_8814B << BIT_SHIFT_IPS_CFG_ADDR_8814B) -+#define BIT_CLEAR_IPS_CFG_ADDR_8814B(x) ((x) & (~BITS_IPS_CFG_ADDR_8814B)) -+#define BIT_GET_IPS_CFG_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_ADDR_8814B) & BIT_MASK_IPS_CFG_ADDR_8814B) -+#define BIT_SET_IPS_CFG_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_IPS_CFG_ADDR_8814B(x) | BIT_IPS_CFG_ADDR_8814B(v)) -+ -+/* 2 REG_AES_DECRPT_CFG_8814B */ -+ -+#define BIT_SHIFT_IPS_CFG_DATA_8814B 0 -+#define BIT_MASK_IPS_CFG_DATA_8814B 0xffffffffL -+#define BIT_IPS_CFG_DATA_8814B(x) \ -+ (((x) & BIT_MASK_IPS_CFG_DATA_8814B) << BIT_SHIFT_IPS_CFG_DATA_8814B) -+#define BITS_IPS_CFG_DATA_8814B \ -+ (BIT_MASK_IPS_CFG_DATA_8814B << BIT_SHIFT_IPS_CFG_DATA_8814B) -+#define BIT_CLEAR_IPS_CFG_DATA_8814B(x) ((x) & (~BITS_IPS_CFG_DATA_8814B)) -+#define BIT_GET_IPS_CFG_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_DATA_8814B) & BIT_MASK_IPS_CFG_DATA_8814B) -+#define BIT_SET_IPS_CFG_DATA_8814B(x, v) \ -+ (BIT_CLEAR_IPS_CFG_DATA_8814B(x) | BIT_IPS_CFG_DATA_8814B(v)) -+ -+/* 2 REG_HIOE_CTRL_8814B */ -+#define BIT_HIOE_WRITE_REQ_8814B BIT(30) -+#define BIT_HIOE_READ_REQ_8814B BIT(29) -+#define BIT_INST_FORMAT_ERR_8814B BIT(25) -+#define BIT_OP_TIMEOUT_ERR_8814B BIT(24) -+ -+#define BIT_SHIFT_HIOE_OP_TIMEOUT_8814B 16 -+#define BIT_MASK_HIOE_OP_TIMEOUT_8814B 0xff -+#define BIT_HIOE_OP_TIMEOUT_8814B(x) \ -+ (((x) & BIT_MASK_HIOE_OP_TIMEOUT_8814B) \ -+ << BIT_SHIFT_HIOE_OP_TIMEOUT_8814B) -+#define BITS_HIOE_OP_TIMEOUT_8814B \ -+ (BIT_MASK_HIOE_OP_TIMEOUT_8814B << BIT_SHIFT_HIOE_OP_TIMEOUT_8814B) -+#define BIT_CLEAR_HIOE_OP_TIMEOUT_8814B(x) ((x) & (~BITS_HIOE_OP_TIMEOUT_8814B)) -+#define BIT_GET_HIOE_OP_TIMEOUT_8814B(x) \ -+ (((x) >> BIT_SHIFT_HIOE_OP_TIMEOUT_8814B) & \ -+ BIT_MASK_HIOE_OP_TIMEOUT_8814B) -+#define BIT_SET_HIOE_OP_TIMEOUT_8814B(x, v) \ -+ (BIT_CLEAR_HIOE_OP_TIMEOUT_8814B(x) | BIT_HIOE_OP_TIMEOUT_8814B(v)) -+ -+#define BIT_SHIFT_BITDATA_CHECKSUM_8814B 0 -+#define BIT_MASK_BITDATA_CHECKSUM_8814B 0xffff -+#define BIT_BITDATA_CHECKSUM_8814B(x) \ -+ (((x) & BIT_MASK_BITDATA_CHECKSUM_8814B) \ -+ << BIT_SHIFT_BITDATA_CHECKSUM_8814B) -+#define BITS_BITDATA_CHECKSUM_8814B \ -+ (BIT_MASK_BITDATA_CHECKSUM_8814B << BIT_SHIFT_BITDATA_CHECKSUM_8814B) -+#define BIT_CLEAR_BITDATA_CHECKSUM_8814B(x) \ -+ ((x) & (~BITS_BITDATA_CHECKSUM_8814B)) -+#define BIT_GET_BITDATA_CHECKSUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_BITDATA_CHECKSUM_8814B) & \ -+ BIT_MASK_BITDATA_CHECKSUM_8814B) -+#define BIT_SET_BITDATA_CHECKSUM_8814B(x, v) \ -+ (BIT_CLEAR_BITDATA_CHECKSUM_8814B(x) | BIT_BITDATA_CHECKSUM_8814B(v)) -+ -+/* 2 REG_HIOE_CFG_FILE_8814B */ -+ -+#define BIT_SHIFT_TXBF_END_ADDR_8814B 16 -+#define BIT_MASK_TXBF_END_ADDR_8814B 0xffff -+#define BIT_TXBF_END_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_TXBF_END_ADDR_8814B) << BIT_SHIFT_TXBF_END_ADDR_8814B) -+#define BITS_TXBF_END_ADDR_8814B \ -+ (BIT_MASK_TXBF_END_ADDR_8814B << BIT_SHIFT_TXBF_END_ADDR_8814B) -+#define BIT_CLEAR_TXBF_END_ADDR_8814B(x) ((x) & (~BITS_TXBF_END_ADDR_8814B)) -+#define BIT_GET_TXBF_END_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXBF_END_ADDR_8814B) & BIT_MASK_TXBF_END_ADDR_8814B) -+#define BIT_SET_TXBF_END_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_TXBF_END_ADDR_8814B(x) | BIT_TXBF_END_ADDR_8814B(v)) -+ -+#define BIT_SHIFT_TXBF_STR_ADDR_8814B 0 -+#define BIT_MASK_TXBF_STR_ADDR_8814B 0xffff -+#define BIT_TXBF_STR_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_TXBF_STR_ADDR_8814B) << BIT_SHIFT_TXBF_STR_ADDR_8814B) -+#define BITS_TXBF_STR_ADDR_8814B \ -+ (BIT_MASK_TXBF_STR_ADDR_8814B << BIT_SHIFT_TXBF_STR_ADDR_8814B) -+#define BIT_CLEAR_TXBF_STR_ADDR_8814B(x) ((x) & (~BITS_TXBF_STR_ADDR_8814B)) -+#define BIT_GET_TXBF_STR_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXBF_STR_ADDR_8814B) & BIT_MASK_TXBF_STR_ADDR_8814B) -+#define BIT_SET_TXBF_STR_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_TXBF_STR_ADDR_8814B(x) | BIT_TXBF_STR_ADDR_8814B(v)) -+ -+/* 2 REG_TMETER_8814B */ -+#define BIT_TEMP_VALID_8814B BIT(31) -+ -+#define BIT_SHIFT_TEMP_VALUE_8814B 24 -+#define BIT_MASK_TEMP_VALUE_8814B 0x3f -+#define BIT_TEMP_VALUE_8814B(x) \ -+ (((x) & BIT_MASK_TEMP_VALUE_8814B) << BIT_SHIFT_TEMP_VALUE_8814B) -+#define BITS_TEMP_VALUE_8814B \ -+ (BIT_MASK_TEMP_VALUE_8814B << BIT_SHIFT_TEMP_VALUE_8814B) -+#define BIT_CLEAR_TEMP_VALUE_8814B(x) ((x) & (~BITS_TEMP_VALUE_8814B)) -+#define BIT_GET_TEMP_VALUE_8814B(x) \ -+ (((x) >> BIT_SHIFT_TEMP_VALUE_8814B) & BIT_MASK_TEMP_VALUE_8814B) -+#define BIT_SET_TEMP_VALUE_8814B(x, v) \ -+ (BIT_CLEAR_TEMP_VALUE_8814B(x) | BIT_TEMP_VALUE_8814B(v)) -+ -+#define BIT_SHIFT_REG_TMETER_TIMER_8814B 8 -+#define BIT_MASK_REG_TMETER_TIMER_8814B 0xfff -+#define BIT_REG_TMETER_TIMER_8814B(x) \ -+ (((x) & BIT_MASK_REG_TMETER_TIMER_8814B) \ -+ << BIT_SHIFT_REG_TMETER_TIMER_8814B) -+#define BITS_REG_TMETER_TIMER_8814B \ -+ (BIT_MASK_REG_TMETER_TIMER_8814B << BIT_SHIFT_REG_TMETER_TIMER_8814B) -+#define BIT_CLEAR_REG_TMETER_TIMER_8814B(x) \ -+ ((x) & (~BITS_REG_TMETER_TIMER_8814B)) -+#define BIT_GET_REG_TMETER_TIMER_8814B(x) \ -+ (((x) >> BIT_SHIFT_REG_TMETER_TIMER_8814B) & \ -+ BIT_MASK_REG_TMETER_TIMER_8814B) -+#define BIT_SET_REG_TMETER_TIMER_8814B(x, v) \ -+ (BIT_CLEAR_REG_TMETER_TIMER_8814B(x) | BIT_REG_TMETER_TIMER_8814B(v)) -+ -+#define BIT_SHIFT_REG_TEMP_DELTA_8814B 2 -+#define BIT_MASK_REG_TEMP_DELTA_8814B 0x3f -+#define BIT_REG_TEMP_DELTA_8814B(x) \ -+ (((x) & BIT_MASK_REG_TEMP_DELTA_8814B) \ -+ << BIT_SHIFT_REG_TEMP_DELTA_8814B) -+#define BITS_REG_TEMP_DELTA_8814B \ -+ (BIT_MASK_REG_TEMP_DELTA_8814B << BIT_SHIFT_REG_TEMP_DELTA_8814B) -+#define BIT_CLEAR_REG_TEMP_DELTA_8814B(x) ((x) & (~BITS_REG_TEMP_DELTA_8814B)) -+#define BIT_GET_REG_TEMP_DELTA_8814B(x) \ -+ (((x) >> BIT_SHIFT_REG_TEMP_DELTA_8814B) & \ -+ BIT_MASK_REG_TEMP_DELTA_8814B) -+#define BIT_SET_REG_TEMP_DELTA_8814B(x, v) \ -+ (BIT_CLEAR_REG_TEMP_DELTA_8814B(x) | BIT_REG_TEMP_DELTA_8814B(v)) -+ -+#define BIT_REG_TMETER_EN_8814B BIT(0) -+ -+/* 2 REG_OSC_32K_CTRL_8814B */ -+ -+#define BIT_SHIFT_OSC_32K_CLKGEN_0_8814B 16 -+#define BIT_MASK_OSC_32K_CLKGEN_0_8814B 0xffff -+#define BIT_OSC_32K_CLKGEN_0_8814B(x) \ -+ (((x) & BIT_MASK_OSC_32K_CLKGEN_0_8814B) \ -+ << BIT_SHIFT_OSC_32K_CLKGEN_0_8814B) -+#define BITS_OSC_32K_CLKGEN_0_8814B \ -+ (BIT_MASK_OSC_32K_CLKGEN_0_8814B << BIT_SHIFT_OSC_32K_CLKGEN_0_8814B) -+#define BIT_CLEAR_OSC_32K_CLKGEN_0_8814B(x) \ -+ ((x) & (~BITS_OSC_32K_CLKGEN_0_8814B)) -+#define BIT_GET_OSC_32K_CLKGEN_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_CLKGEN_0_8814B) & \ -+ BIT_MASK_OSC_32K_CLKGEN_0_8814B) -+#define BIT_SET_OSC_32K_CLKGEN_0_8814B(x, v) \ -+ (BIT_CLEAR_OSC_32K_CLKGEN_0_8814B(x) | BIT_OSC_32K_CLKGEN_0_8814B(v)) -+ -+#define BIT_SHIFT_OSC_32K_RES_COMP_8814B 4 -+#define BIT_MASK_OSC_32K_RES_COMP_8814B 0x3 -+#define BIT_OSC_32K_RES_COMP_8814B(x) \ -+ (((x) & BIT_MASK_OSC_32K_RES_COMP_8814B) \ -+ << BIT_SHIFT_OSC_32K_RES_COMP_8814B) -+#define BITS_OSC_32K_RES_COMP_8814B \ -+ (BIT_MASK_OSC_32K_RES_COMP_8814B << BIT_SHIFT_OSC_32K_RES_COMP_8814B) -+#define BIT_CLEAR_OSC_32K_RES_COMP_8814B(x) \ -+ ((x) & (~BITS_OSC_32K_RES_COMP_8814B)) -+#define BIT_GET_OSC_32K_RES_COMP_8814B(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_RES_COMP_8814B) & \ -+ BIT_MASK_OSC_32K_RES_COMP_8814B) -+#define BIT_SET_OSC_32K_RES_COMP_8814B(x, v) \ -+ (BIT_CLEAR_OSC_32K_RES_COMP_8814B(x) | BIT_OSC_32K_RES_COMP_8814B(v)) -+ -+#define BIT_OSC_32K_OUT_SEL_8814B BIT(3) -+#define BIT_ISO_WL_2_OSC_32K_8814B BIT(1) -+#define BIT_POW_CKGEN_8814B BIT(0) -+ -+/* 2 REG_32K_CAL_REG1_8814B */ -+#define BIT_CAL_32K_REG_WR_8814B BIT(31) -+#define BIT_CAL_32K_DBG_SEL_8814B BIT(22) -+ -+#define BIT_SHIFT_CAL_32K_REG_ADDR_8814B 16 -+#define BIT_MASK_CAL_32K_REG_ADDR_8814B 0x3f -+#define BIT_CAL_32K_REG_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_ADDR_8814B) \ -+ << BIT_SHIFT_CAL_32K_REG_ADDR_8814B) -+#define BITS_CAL_32K_REG_ADDR_8814B \ -+ (BIT_MASK_CAL_32K_REG_ADDR_8814B << BIT_SHIFT_CAL_32K_REG_ADDR_8814B) -+#define BIT_CLEAR_CAL_32K_REG_ADDR_8814B(x) \ -+ ((x) & (~BITS_CAL_32K_REG_ADDR_8814B)) -+#define BIT_GET_CAL_32K_REG_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_ADDR_8814B) & \ -+ BIT_MASK_CAL_32K_REG_ADDR_8814B) -+#define BIT_SET_CAL_32K_REG_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_ADDR_8814B(x) | BIT_CAL_32K_REG_ADDR_8814B(v)) -+ -+#define BIT_SHIFT_CAL_32K_REG_DATA_8814B 0 -+#define BIT_MASK_CAL_32K_REG_DATA_8814B 0xffff -+#define BIT_CAL_32K_REG_DATA_8814B(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_DATA_8814B) \ -+ << BIT_SHIFT_CAL_32K_REG_DATA_8814B) -+#define BITS_CAL_32K_REG_DATA_8814B \ -+ (BIT_MASK_CAL_32K_REG_DATA_8814B << BIT_SHIFT_CAL_32K_REG_DATA_8814B) -+#define BIT_CLEAR_CAL_32K_REG_DATA_8814B(x) \ -+ ((x) & (~BITS_CAL_32K_REG_DATA_8814B)) -+#define BIT_GET_CAL_32K_REG_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_DATA_8814B) & \ -+ BIT_MASK_CAL_32K_REG_DATA_8814B) -+#define BIT_SET_CAL_32K_REG_DATA_8814B(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_DATA_8814B(x) | BIT_CAL_32K_REG_DATA_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_C2HEVT_8814B */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_V1_8814B 0 -+#define BIT_MASK_C2HEVT_MSG_V1_8814B 0xffffffffL -+#define BIT_C2HEVT_MSG_V1_8814B(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_V1_8814B) << BIT_SHIFT_C2HEVT_MSG_V1_8814B) -+#define BITS_C2HEVT_MSG_V1_8814B \ -+ (BIT_MASK_C2HEVT_MSG_V1_8814B << BIT_SHIFT_C2HEVT_MSG_V1_8814B) -+#define BIT_CLEAR_C2HEVT_MSG_V1_8814B(x) ((x) & (~BITS_C2HEVT_MSG_V1_8814B)) -+#define BIT_GET_C2HEVT_MSG_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_V1_8814B) & BIT_MASK_C2HEVT_MSG_V1_8814B) -+#define BIT_SET_C2HEVT_MSG_V1_8814B(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_V1_8814B(x) | BIT_C2HEVT_MSG_V1_8814B(v)) -+ -+/* 2 REG_C2HEVT_1_8814B */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_1_8814B 0 -+#define BIT_MASK_C2HEVT_MSG_1_8814B 0xffffffffL -+#define BIT_C2HEVT_MSG_1_8814B(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_1_8814B) << BIT_SHIFT_C2HEVT_MSG_1_8814B) -+#define BITS_C2HEVT_MSG_1_8814B \ -+ (BIT_MASK_C2HEVT_MSG_1_8814B << BIT_SHIFT_C2HEVT_MSG_1_8814B) -+#define BIT_CLEAR_C2HEVT_MSG_1_8814B(x) ((x) & (~BITS_C2HEVT_MSG_1_8814B)) -+#define BIT_GET_C2HEVT_MSG_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_1_8814B) & BIT_MASK_C2HEVT_MSG_1_8814B) -+#define BIT_SET_C2HEVT_MSG_1_8814B(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_1_8814B(x) | BIT_C2HEVT_MSG_1_8814B(v)) -+ -+/* 2 REG_C2HEVT_2_8814B */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_2_8814B 0 -+#define BIT_MASK_C2HEVT_MSG_2_8814B 0xffffffffL -+#define BIT_C2HEVT_MSG_2_8814B(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_2_8814B) << BIT_SHIFT_C2HEVT_MSG_2_8814B) -+#define BITS_C2HEVT_MSG_2_8814B \ -+ (BIT_MASK_C2HEVT_MSG_2_8814B << BIT_SHIFT_C2HEVT_MSG_2_8814B) -+#define BIT_CLEAR_C2HEVT_MSG_2_8814B(x) ((x) & (~BITS_C2HEVT_MSG_2_8814B)) -+#define BIT_GET_C2HEVT_MSG_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_2_8814B) & BIT_MASK_C2HEVT_MSG_2_8814B) -+#define BIT_SET_C2HEVT_MSG_2_8814B(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_2_8814B(x) | BIT_C2HEVT_MSG_2_8814B(v)) -+ -+/* 2 REG_C2HEVT_3_8814B */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_3_8814B 0 -+#define BIT_MASK_C2HEVT_MSG_3_8814B 0xffffffffL -+#define BIT_C2HEVT_MSG_3_8814B(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_3_8814B) << BIT_SHIFT_C2HEVT_MSG_3_8814B) -+#define BITS_C2HEVT_MSG_3_8814B \ -+ (BIT_MASK_C2HEVT_MSG_3_8814B << BIT_SHIFT_C2HEVT_MSG_3_8814B) -+#define BIT_CLEAR_C2HEVT_MSG_3_8814B(x) ((x) & (~BITS_C2HEVT_MSG_3_8814B)) -+#define BIT_GET_C2HEVT_MSG_3_8814B(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_3_8814B) & BIT_MASK_C2HEVT_MSG_3_8814B) -+#define BIT_SET_C2HEVT_MSG_3_8814B(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_3_8814B(x) | BIT_C2HEVT_MSG_3_8814B(v)) -+ -+/* 2 REG_RXDESC_BUFF_RPTR_8814B */ -+ -+#define BIT_SHIFT_RXDESC_BUFF_RPTR_8814B 0 -+#define BIT_MASK_RXDESC_BUFF_RPTR_8814B 0xffffffffL -+#define BIT_RXDESC_BUFF_RPTR_8814B(x) \ -+ (((x) & BIT_MASK_RXDESC_BUFF_RPTR_8814B) \ -+ << BIT_SHIFT_RXDESC_BUFF_RPTR_8814B) -+#define BITS_RXDESC_BUFF_RPTR_8814B \ -+ (BIT_MASK_RXDESC_BUFF_RPTR_8814B << BIT_SHIFT_RXDESC_BUFF_RPTR_8814B) -+#define BIT_CLEAR_RXDESC_BUFF_RPTR_8814B(x) \ -+ ((x) & (~BITS_RXDESC_BUFF_RPTR_8814B)) -+#define BIT_GET_RXDESC_BUFF_RPTR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXDESC_BUFF_RPTR_8814B) & \ -+ BIT_MASK_RXDESC_BUFF_RPTR_8814B) -+#define BIT_SET_RXDESC_BUFF_RPTR_8814B(x, v) \ -+ (BIT_CLEAR_RXDESC_BUFF_RPTR_8814B(x) | BIT_RXDESC_BUFF_RPTR_8814B(v)) -+ -+/* 2 REG_RXDESC_BUFF_WPTR_8814B */ -+ -+#define BIT_SHIFT_RXDESC_BUFF_WPTR_8814B 0 -+#define BIT_MASK_RXDESC_BUFF_WPTR_8814B 0xffffffffL -+#define BIT_RXDESC_BUFF_WPTR_8814B(x) \ -+ (((x) & BIT_MASK_RXDESC_BUFF_WPTR_8814B) \ -+ << BIT_SHIFT_RXDESC_BUFF_WPTR_8814B) -+#define BITS_RXDESC_BUFF_WPTR_8814B \ -+ (BIT_MASK_RXDESC_BUFF_WPTR_8814B << BIT_SHIFT_RXDESC_BUFF_WPTR_8814B) -+#define BIT_CLEAR_RXDESC_BUFF_WPTR_8814B(x) \ -+ ((x) & (~BITS_RXDESC_BUFF_WPTR_8814B)) -+#define BIT_GET_RXDESC_BUFF_WPTR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXDESC_BUFF_WPTR_8814B) & \ -+ BIT_MASK_RXDESC_BUFF_WPTR_8814B) -+#define BIT_SET_RXDESC_BUFF_WPTR_8814B(x, v) \ -+ (BIT_CLEAR_RXDESC_BUFF_WPTR_8814B(x) | BIT_RXDESC_BUFF_WPTR_8814B(v)) -+ -+/* 2 REG_SW_DEFINED_PAGE1_8814B */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE1_V1_8814B 0 -+#define BIT_MASK_SW_DEFINED_PAGE1_V1_8814B 0xffffffffL -+#define BIT_SW_DEFINED_PAGE1_V1_8814B(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE1_V1_8814B) \ -+ << BIT_SHIFT_SW_DEFINED_PAGE1_V1_8814B) -+#define BITS_SW_DEFINED_PAGE1_V1_8814B \ -+ (BIT_MASK_SW_DEFINED_PAGE1_V1_8814B \ -+ << BIT_SHIFT_SW_DEFINED_PAGE1_V1_8814B) -+#define BIT_CLEAR_SW_DEFINED_PAGE1_V1_8814B(x) \ -+ ((x) & (~BITS_SW_DEFINED_PAGE1_V1_8814B)) -+#define BIT_GET_SW_DEFINED_PAGE1_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE1_V1_8814B) & \ -+ BIT_MASK_SW_DEFINED_PAGE1_V1_8814B) -+#define BIT_SET_SW_DEFINED_PAGE1_V1_8814B(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE1_V1_8814B(x) | \ -+ BIT_SW_DEFINED_PAGE1_V1_8814B(v)) -+ -+/* 2 REG_SW_DEFINED_PAGE2_8814B */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE2_8814B 0 -+#define BIT_MASK_SW_DEFINED_PAGE2_8814B 0xffffffffL -+#define BIT_SW_DEFINED_PAGE2_8814B(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE2_8814B) \ -+ << BIT_SHIFT_SW_DEFINED_PAGE2_8814B) -+#define BITS_SW_DEFINED_PAGE2_8814B \ -+ (BIT_MASK_SW_DEFINED_PAGE2_8814B << BIT_SHIFT_SW_DEFINED_PAGE2_8814B) -+#define BIT_CLEAR_SW_DEFINED_PAGE2_8814B(x) \ -+ ((x) & (~BITS_SW_DEFINED_PAGE2_8814B)) -+#define BIT_GET_SW_DEFINED_PAGE2_8814B(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE2_8814B) & \ -+ BIT_MASK_SW_DEFINED_PAGE2_8814B) -+#define BIT_SET_SW_DEFINED_PAGE2_8814B(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE2_8814B(x) | BIT_SW_DEFINED_PAGE2_8814B(v)) -+ -+/* 2 REG_MCUTST_I_8814B */ -+ -+#define BIT_SHIFT_MCUDMSG_I_8814B 0 -+#define BIT_MASK_MCUDMSG_I_8814B 0xffffffffL -+#define BIT_MCUDMSG_I_8814B(x) \ -+ (((x) & BIT_MASK_MCUDMSG_I_8814B) << BIT_SHIFT_MCUDMSG_I_8814B) -+#define BITS_MCUDMSG_I_8814B \ -+ (BIT_MASK_MCUDMSG_I_8814B << BIT_SHIFT_MCUDMSG_I_8814B) -+#define BIT_CLEAR_MCUDMSG_I_8814B(x) ((x) & (~BITS_MCUDMSG_I_8814B)) -+#define BIT_GET_MCUDMSG_I_8814B(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_I_8814B) & BIT_MASK_MCUDMSG_I_8814B) -+#define BIT_SET_MCUDMSG_I_8814B(x, v) \ -+ (BIT_CLEAR_MCUDMSG_I_8814B(x) | BIT_MCUDMSG_I_8814B(v)) -+ -+/* 2 REG_MCUTST_II_8814B */ -+ -+#define BIT_SHIFT_MCUDMSG_II_8814B 0 -+#define BIT_MASK_MCUDMSG_II_8814B 0xffffffffL -+#define BIT_MCUDMSG_II_8814B(x) \ -+ (((x) & BIT_MASK_MCUDMSG_II_8814B) << BIT_SHIFT_MCUDMSG_II_8814B) -+#define BITS_MCUDMSG_II_8814B \ -+ (BIT_MASK_MCUDMSG_II_8814B << BIT_SHIFT_MCUDMSG_II_8814B) -+#define BIT_CLEAR_MCUDMSG_II_8814B(x) ((x) & (~BITS_MCUDMSG_II_8814B)) -+#define BIT_GET_MCUDMSG_II_8814B(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_II_8814B) & BIT_MASK_MCUDMSG_II_8814B) -+#define BIT_SET_MCUDMSG_II_8814B(x, v) \ -+ (BIT_CLEAR_MCUDMSG_II_8814B(x) | BIT_MCUDMSG_II_8814B(v)) -+ -+/* 2 REG_FMETHR_8814B */ -+#define BIT_FMSG_INT_8814B BIT(31) -+ -+#define BIT_SHIFT_FW_MSG_8814B 0 -+#define BIT_MASK_FW_MSG_8814B 0xffffffffL -+#define BIT_FW_MSG_8814B(x) \ -+ (((x) & BIT_MASK_FW_MSG_8814B) << BIT_SHIFT_FW_MSG_8814B) -+#define BITS_FW_MSG_8814B (BIT_MASK_FW_MSG_8814B << BIT_SHIFT_FW_MSG_8814B) -+#define BIT_CLEAR_FW_MSG_8814B(x) ((x) & (~BITS_FW_MSG_8814B)) -+#define BIT_GET_FW_MSG_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_8814B) & BIT_MASK_FW_MSG_8814B) -+#define BIT_SET_FW_MSG_8814B(x, v) \ -+ (BIT_CLEAR_FW_MSG_8814B(x) | BIT_FW_MSG_8814B(v)) -+ -+/* 2 REG_HMETFR_8814B */ -+ -+#define BIT_SHIFT_HRCV_MSG_8814B 24 -+#define BIT_MASK_HRCV_MSG_8814B 0xff -+#define BIT_HRCV_MSG_8814B(x) \ -+ (((x) & BIT_MASK_HRCV_MSG_8814B) << BIT_SHIFT_HRCV_MSG_8814B) -+#define BITS_HRCV_MSG_8814B \ -+ (BIT_MASK_HRCV_MSG_8814B << BIT_SHIFT_HRCV_MSG_8814B) -+#define BIT_CLEAR_HRCV_MSG_8814B(x) ((x) & (~BITS_HRCV_MSG_8814B)) -+#define BIT_GET_HRCV_MSG_8814B(x) \ -+ (((x) >> BIT_SHIFT_HRCV_MSG_8814B) & BIT_MASK_HRCV_MSG_8814B) -+#define BIT_SET_HRCV_MSG_8814B(x, v) \ -+ (BIT_CLEAR_HRCV_MSG_8814B(x) | BIT_HRCV_MSG_8814B(v)) -+ -+#define BIT_INT_BOX3_8814B BIT(3) -+#define BIT_INT_BOX2_8814B BIT(2) -+#define BIT_INT_BOX1_8814B BIT(1) -+#define BIT_INT_BOX0_8814B BIT(0) -+ -+/* 2 REG_HMEBOX0_8814B */ -+ -+#define BIT_SHIFT_HOST_MSG_0_8814B 0 -+#define BIT_MASK_HOST_MSG_0_8814B 0xffffffffL -+#define BIT_HOST_MSG_0_8814B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_0_8814B) << BIT_SHIFT_HOST_MSG_0_8814B) -+#define BITS_HOST_MSG_0_8814B \ -+ (BIT_MASK_HOST_MSG_0_8814B << BIT_SHIFT_HOST_MSG_0_8814B) -+#define BIT_CLEAR_HOST_MSG_0_8814B(x) ((x) & (~BITS_HOST_MSG_0_8814B)) -+#define BIT_GET_HOST_MSG_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_0_8814B) & BIT_MASK_HOST_MSG_0_8814B) -+#define BIT_SET_HOST_MSG_0_8814B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_0_8814B(x) | BIT_HOST_MSG_0_8814B(v)) -+ -+/* 2 REG_HMEBOX1_8814B */ -+ -+#define BIT_SHIFT_HOST_MSG_1_8814B 0 -+#define BIT_MASK_HOST_MSG_1_8814B 0xffffffffL -+#define BIT_HOST_MSG_1_8814B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_1_8814B) << BIT_SHIFT_HOST_MSG_1_8814B) -+#define BITS_HOST_MSG_1_8814B \ -+ (BIT_MASK_HOST_MSG_1_8814B << BIT_SHIFT_HOST_MSG_1_8814B) -+#define BIT_CLEAR_HOST_MSG_1_8814B(x) ((x) & (~BITS_HOST_MSG_1_8814B)) -+#define BIT_GET_HOST_MSG_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_1_8814B) & BIT_MASK_HOST_MSG_1_8814B) -+#define BIT_SET_HOST_MSG_1_8814B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_1_8814B(x) | BIT_HOST_MSG_1_8814B(v)) -+ -+/* 2 REG_HMEBOX2_8814B */ -+ -+#define BIT_SHIFT_HOST_MSG_2_8814B 0 -+#define BIT_MASK_HOST_MSG_2_8814B 0xffffffffL -+#define BIT_HOST_MSG_2_8814B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_2_8814B) << BIT_SHIFT_HOST_MSG_2_8814B) -+#define BITS_HOST_MSG_2_8814B \ -+ (BIT_MASK_HOST_MSG_2_8814B << BIT_SHIFT_HOST_MSG_2_8814B) -+#define BIT_CLEAR_HOST_MSG_2_8814B(x) ((x) & (~BITS_HOST_MSG_2_8814B)) -+#define BIT_GET_HOST_MSG_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_2_8814B) & BIT_MASK_HOST_MSG_2_8814B) -+#define BIT_SET_HOST_MSG_2_8814B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_2_8814B(x) | BIT_HOST_MSG_2_8814B(v)) -+ -+/* 2 REG_HMEBOX3_8814B */ -+ -+#define BIT_SHIFT_HOST_MSG_3_8814B 0 -+#define BIT_MASK_HOST_MSG_3_8814B 0xffffffffL -+#define BIT_HOST_MSG_3_8814B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_3_8814B) << BIT_SHIFT_HOST_MSG_3_8814B) -+#define BITS_HOST_MSG_3_8814B \ -+ (BIT_MASK_HOST_MSG_3_8814B << BIT_SHIFT_HOST_MSG_3_8814B) -+#define BIT_CLEAR_HOST_MSG_3_8814B(x) ((x) & (~BITS_HOST_MSG_3_8814B)) -+#define BIT_GET_HOST_MSG_3_8814B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_3_8814B) & BIT_MASK_HOST_MSG_3_8814B) -+#define BIT_SET_HOST_MSG_3_8814B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_3_8814B(x) | BIT_HOST_MSG_3_8814B(v)) -+ -+/* 2 REG_RXDESC_BUFF_BNDY_8814B */ -+ -+#define BIT_SHIFT_RXDESC_BUFF_BNDY_8814B 0 -+#define BIT_MASK_RXDESC_BUFF_BNDY_8814B 0xffffffffL -+#define BIT_RXDESC_BUFF_BNDY_8814B(x) \ -+ (((x) & BIT_MASK_RXDESC_BUFF_BNDY_8814B) \ -+ << BIT_SHIFT_RXDESC_BUFF_BNDY_8814B) -+#define BITS_RXDESC_BUFF_BNDY_8814B \ -+ (BIT_MASK_RXDESC_BUFF_BNDY_8814B << BIT_SHIFT_RXDESC_BUFF_BNDY_8814B) -+#define BIT_CLEAR_RXDESC_BUFF_BNDY_8814B(x) \ -+ ((x) & (~BITS_RXDESC_BUFF_BNDY_8814B)) -+#define BIT_GET_RXDESC_BUFF_BNDY_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXDESC_BUFF_BNDY_8814B) & \ -+ BIT_MASK_RXDESC_BUFF_BNDY_8814B) -+#define BIT_SET_RXDESC_BUFF_BNDY_8814B(x, v) \ -+ (BIT_CLEAR_RXDESC_BUFF_BNDY_8814B(x) | BIT_RXDESC_BUFF_BNDY_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BB_ACCESS_CTRL_8814B */ -+ -+#define BIT_SHIFT_BB_WRITE_READ_8814B 30 -+#define BIT_MASK_BB_WRITE_READ_8814B 0x3 -+#define BIT_BB_WRITE_READ_8814B(x) \ -+ (((x) & BIT_MASK_BB_WRITE_READ_8814B) << BIT_SHIFT_BB_WRITE_READ_8814B) -+#define BITS_BB_WRITE_READ_8814B \ -+ (BIT_MASK_BB_WRITE_READ_8814B << BIT_SHIFT_BB_WRITE_READ_8814B) -+#define BIT_CLEAR_BB_WRITE_READ_8814B(x) ((x) & (~BITS_BB_WRITE_READ_8814B)) -+#define BIT_GET_BB_WRITE_READ_8814B(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_READ_8814B) & BIT_MASK_BB_WRITE_READ_8814B) -+#define BIT_SET_BB_WRITE_READ_8814B(x, v) \ -+ (BIT_CLEAR_BB_WRITE_READ_8814B(x) | BIT_BB_WRITE_READ_8814B(v)) -+ -+#define BIT_SHIFT_BB_WRITE_EN_8814B 12 -+#define BIT_MASK_BB_WRITE_EN_8814B 0xf -+#define BIT_BB_WRITE_EN_8814B(x) \ -+ (((x) & BIT_MASK_BB_WRITE_EN_8814B) << BIT_SHIFT_BB_WRITE_EN_8814B) -+#define BITS_BB_WRITE_EN_8814B \ -+ (BIT_MASK_BB_WRITE_EN_8814B << BIT_SHIFT_BB_WRITE_EN_8814B) -+#define BIT_CLEAR_BB_WRITE_EN_8814B(x) ((x) & (~BITS_BB_WRITE_EN_8814B)) -+#define BIT_GET_BB_WRITE_EN_8814B(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_EN_8814B) & BIT_MASK_BB_WRITE_EN_8814B) -+#define BIT_SET_BB_WRITE_EN_8814B(x, v) \ -+ (BIT_CLEAR_BB_WRITE_EN_8814B(x) | BIT_BB_WRITE_EN_8814B(v)) -+ -+#define BIT_SHIFT_BB_ADDR_8814B 2 -+#define BIT_MASK_BB_ADDR_8814B 0x1ff -+#define BIT_BB_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_BB_ADDR_8814B) << BIT_SHIFT_BB_ADDR_8814B) -+#define BITS_BB_ADDR_8814B (BIT_MASK_BB_ADDR_8814B << BIT_SHIFT_BB_ADDR_8814B) -+#define BIT_CLEAR_BB_ADDR_8814B(x) ((x) & (~BITS_BB_ADDR_8814B)) -+#define BIT_GET_BB_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_BB_ADDR_8814B) & BIT_MASK_BB_ADDR_8814B) -+#define BIT_SET_BB_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_BB_ADDR_8814B(x) | BIT_BB_ADDR_8814B(v)) -+ -+#define BIT_BB_ERRACC_8814B BIT(0) -+ -+/* 2 REG_BB_ACCESS_DATA_8814B */ -+ -+#define BIT_SHIFT_BB_DATA_8814B 0 -+#define BIT_MASK_BB_DATA_8814B 0xffffffffL -+#define BIT_BB_DATA_8814B(x) \ -+ (((x) & BIT_MASK_BB_DATA_8814B) << BIT_SHIFT_BB_DATA_8814B) -+#define BITS_BB_DATA_8814B (BIT_MASK_BB_DATA_8814B << BIT_SHIFT_BB_DATA_8814B) -+#define BIT_CLEAR_BB_DATA_8814B(x) ((x) & (~BITS_BB_DATA_8814B)) -+#define BIT_GET_BB_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_BB_DATA_8814B) & BIT_MASK_BB_DATA_8814B) -+#define BIT_SET_BB_DATA_8814B(x, v) \ -+ (BIT_CLEAR_BB_DATA_8814B(x) | BIT_BB_DATA_8814B(v)) -+ -+/* 2 REG_HMEBOX_E0_8814B */ -+ -+#define BIT_SHIFT_HMEBOX_E0_8814B 0 -+#define BIT_MASK_HMEBOX_E0_8814B 0xffffffffL -+#define BIT_HMEBOX_E0_8814B(x) \ -+ (((x) & BIT_MASK_HMEBOX_E0_8814B) << BIT_SHIFT_HMEBOX_E0_8814B) -+#define BITS_HMEBOX_E0_8814B \ -+ (BIT_MASK_HMEBOX_E0_8814B << BIT_SHIFT_HMEBOX_E0_8814B) -+#define BIT_CLEAR_HMEBOX_E0_8814B(x) ((x) & (~BITS_HMEBOX_E0_8814B)) -+#define BIT_GET_HMEBOX_E0_8814B(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E0_8814B) & BIT_MASK_HMEBOX_E0_8814B) -+#define BIT_SET_HMEBOX_E0_8814B(x, v) \ -+ (BIT_CLEAR_HMEBOX_E0_8814B(x) | BIT_HMEBOX_E0_8814B(v)) -+ -+/* 2 REG_HMEBOX_E1_8814B */ -+ -+#define BIT_SHIFT_HMEBOX_E1_8814B 0 -+#define BIT_MASK_HMEBOX_E1_8814B 0xffffffffL -+#define BIT_HMEBOX_E1_8814B(x) \ -+ (((x) & BIT_MASK_HMEBOX_E1_8814B) << BIT_SHIFT_HMEBOX_E1_8814B) -+#define BITS_HMEBOX_E1_8814B \ -+ (BIT_MASK_HMEBOX_E1_8814B << BIT_SHIFT_HMEBOX_E1_8814B) -+#define BIT_CLEAR_HMEBOX_E1_8814B(x) ((x) & (~BITS_HMEBOX_E1_8814B)) -+#define BIT_GET_HMEBOX_E1_8814B(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E1_8814B) & BIT_MASK_HMEBOX_E1_8814B) -+#define BIT_SET_HMEBOX_E1_8814B(x, v) \ -+ (BIT_CLEAR_HMEBOX_E1_8814B(x) | BIT_HMEBOX_E1_8814B(v)) -+ -+/* 2 REG_HMEBOX_E2_8814B */ -+ -+#define BIT_SHIFT_HMEBOX_E2_8814B 0 -+#define BIT_MASK_HMEBOX_E2_8814B 0xffffffffL -+#define BIT_HMEBOX_E2_8814B(x) \ -+ (((x) & BIT_MASK_HMEBOX_E2_8814B) << BIT_SHIFT_HMEBOX_E2_8814B) -+#define BITS_HMEBOX_E2_8814B \ -+ (BIT_MASK_HMEBOX_E2_8814B << BIT_SHIFT_HMEBOX_E2_8814B) -+#define BIT_CLEAR_HMEBOX_E2_8814B(x) ((x) & (~BITS_HMEBOX_E2_8814B)) -+#define BIT_GET_HMEBOX_E2_8814B(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E2_8814B) & BIT_MASK_HMEBOX_E2_8814B) -+#define BIT_SET_HMEBOX_E2_8814B(x, v) \ -+ (BIT_CLEAR_HMEBOX_E2_8814B(x) | BIT_HMEBOX_E2_8814B(v)) -+ -+/* 2 REG_HMEBOX_E3_8814B */ -+ -+#define BIT_SHIFT_HMEBOX_E3_8814B 0 -+#define BIT_MASK_HMEBOX_E3_8814B 0xffffffffL -+#define BIT_HMEBOX_E3_8814B(x) \ -+ (((x) & BIT_MASK_HMEBOX_E3_8814B) << BIT_SHIFT_HMEBOX_E3_8814B) -+#define BITS_HMEBOX_E3_8814B \ -+ (BIT_MASK_HMEBOX_E3_8814B << BIT_SHIFT_HMEBOX_E3_8814B) -+#define BIT_CLEAR_HMEBOX_E3_8814B(x) ((x) & (~BITS_HMEBOX_E3_8814B)) -+#define BIT_GET_HMEBOX_E3_8814B(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E3_8814B) & BIT_MASK_HMEBOX_E3_8814B) -+#define BIT_SET_HMEBOX_E3_8814B(x, v) \ -+ (BIT_CLEAR_HMEBOX_E3_8814B(x) | BIT_HMEBOX_E3_8814B(v)) -+ -+/* 2 REG_CR_EXT_8814B */ -+ -+#define BIT_SHIFT_PHY_REQ_DELAY_8814B 24 -+#define BIT_MASK_PHY_REQ_DELAY_8814B 0xf -+#define BIT_PHY_REQ_DELAY_8814B(x) \ -+ (((x) & BIT_MASK_PHY_REQ_DELAY_8814B) << BIT_SHIFT_PHY_REQ_DELAY_8814B) -+#define BITS_PHY_REQ_DELAY_8814B \ -+ (BIT_MASK_PHY_REQ_DELAY_8814B << BIT_SHIFT_PHY_REQ_DELAY_8814B) -+#define BIT_CLEAR_PHY_REQ_DELAY_8814B(x) ((x) & (~BITS_PHY_REQ_DELAY_8814B)) -+#define BIT_GET_PHY_REQ_DELAY_8814B(x) \ -+ (((x) >> BIT_SHIFT_PHY_REQ_DELAY_8814B) & BIT_MASK_PHY_REQ_DELAY_8814B) -+#define BIT_SET_PHY_REQ_DELAY_8814B(x, v) \ -+ (BIT_CLEAR_PHY_REQ_DELAY_8814B(x) | BIT_PHY_REQ_DELAY_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_FW_FIFO_PTR_RST_8814B BIT(18) -+#define BIT_PHY_FIFO_PTR_RST_8814B BIT(17) -+#define BIT_SPD_DOWN_8814B BIT(16) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_NETYPE4_8814B 4 -+#define BIT_MASK_NETYPE4_8814B 0x3 -+#define BIT_NETYPE4_8814B(x) \ -+ (((x) & BIT_MASK_NETYPE4_8814B) << BIT_SHIFT_NETYPE4_8814B) -+#define BITS_NETYPE4_8814B (BIT_MASK_NETYPE4_8814B << BIT_SHIFT_NETYPE4_8814B) -+#define BIT_CLEAR_NETYPE4_8814B(x) ((x) & (~BITS_NETYPE4_8814B)) -+#define BIT_GET_NETYPE4_8814B(x) \ -+ (((x) >> BIT_SHIFT_NETYPE4_8814B) & BIT_MASK_NETYPE4_8814B) -+#define BIT_SET_NETYPE4_8814B(x, v) \ -+ (BIT_CLEAR_NETYPE4_8814B(x) | BIT_NETYPE4_8814B(v)) -+ -+#define BIT_SHIFT_NETYPE3_8814B 2 -+#define BIT_MASK_NETYPE3_8814B 0x3 -+#define BIT_NETYPE3_8814B(x) \ -+ (((x) & BIT_MASK_NETYPE3_8814B) << BIT_SHIFT_NETYPE3_8814B) -+#define BITS_NETYPE3_8814B (BIT_MASK_NETYPE3_8814B << BIT_SHIFT_NETYPE3_8814B) -+#define BIT_CLEAR_NETYPE3_8814B(x) ((x) & (~BITS_NETYPE3_8814B)) -+#define BIT_GET_NETYPE3_8814B(x) \ -+ (((x) >> BIT_SHIFT_NETYPE3_8814B) & BIT_MASK_NETYPE3_8814B) -+#define BIT_SET_NETYPE3_8814B(x, v) \ -+ (BIT_CLEAR_NETYPE3_8814B(x) | BIT_NETYPE3_8814B(v)) -+ -+#define BIT_SHIFT_NETYPE2_8814B 0 -+#define BIT_MASK_NETYPE2_8814B 0x3 -+#define BIT_NETYPE2_8814B(x) \ -+ (((x) & BIT_MASK_NETYPE2_8814B) << BIT_SHIFT_NETYPE2_8814B) -+#define BITS_NETYPE2_8814B (BIT_MASK_NETYPE2_8814B << BIT_SHIFT_NETYPE2_8814B) -+#define BIT_CLEAR_NETYPE2_8814B(x) ((x) & (~BITS_NETYPE2_8814B)) -+#define BIT_GET_NETYPE2_8814B(x) \ -+ (((x) >> BIT_SHIFT_NETYPE2_8814B) & BIT_MASK_NETYPE2_8814B) -+#define BIT_SET_NETYPE2_8814B(x, v) \ -+ (BIT_CLEAR_NETYPE2_8814B(x) | BIT_NETYPE2_8814B(v)) -+ -+/* 2 REG_TC9_CTRL_8814B */ -+#define BIT_TC9INT_EN_8814B BIT(26) -+#define BIT_TC9MODE_8814B BIT(25) -+#define BIT_TC9EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC9DATA_8814B 0 -+#define BIT_MASK_TC9DATA_8814B 0xffffff -+#define BIT_TC9DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC9DATA_8814B) << BIT_SHIFT_TC9DATA_8814B) -+#define BITS_TC9DATA_8814B (BIT_MASK_TC9DATA_8814B << BIT_SHIFT_TC9DATA_8814B) -+#define BIT_CLEAR_TC9DATA_8814B(x) ((x) & (~BITS_TC9DATA_8814B)) -+#define BIT_GET_TC9DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC9DATA_8814B) & BIT_MASK_TC9DATA_8814B) -+#define BIT_SET_TC9DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC9DATA_8814B(x) | BIT_TC9DATA_8814B(v)) -+ -+/* 2 REG_TC10_CTRL_8814B */ -+#define BIT_TC10INT_EN_8814B BIT(26) -+#define BIT_TC10MODE_8814B BIT(25) -+#define BIT_TC10EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC10DATA_8814B 0 -+#define BIT_MASK_TC10DATA_8814B 0xffffff -+#define BIT_TC10DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC10DATA_8814B) << BIT_SHIFT_TC10DATA_8814B) -+#define BITS_TC10DATA_8814B \ -+ (BIT_MASK_TC10DATA_8814B << BIT_SHIFT_TC10DATA_8814B) -+#define BIT_CLEAR_TC10DATA_8814B(x) ((x) & (~BITS_TC10DATA_8814B)) -+#define BIT_GET_TC10DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC10DATA_8814B) & BIT_MASK_TC10DATA_8814B) -+#define BIT_SET_TC10DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC10DATA_8814B(x) | BIT_TC10DATA_8814B(v)) -+ -+/* 2 REG_TC11_CTRL_8814B */ -+#define BIT_TC11INT_EN_8814B BIT(26) -+#define BIT_TC11MODE_8814B BIT(25) -+#define BIT_TC11EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC11DATA_8814B 0 -+#define BIT_MASK_TC11DATA_8814B 0xffffff -+#define BIT_TC11DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC11DATA_8814B) << BIT_SHIFT_TC11DATA_8814B) -+#define BITS_TC11DATA_8814B \ -+ (BIT_MASK_TC11DATA_8814B << BIT_SHIFT_TC11DATA_8814B) -+#define BIT_CLEAR_TC11DATA_8814B(x) ((x) & (~BITS_TC11DATA_8814B)) -+#define BIT_GET_TC11DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC11DATA_8814B) & BIT_MASK_TC11DATA_8814B) -+#define BIT_SET_TC11DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC11DATA_8814B(x) | BIT_TC11DATA_8814B(v)) -+ -+/* 2 REG_TC12_CTRL_8814B */ -+#define BIT_TC12INT_EN_8814B BIT(26) -+#define BIT_TC12MODE_8814B BIT(25) -+#define BIT_TC12EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC12DATA_8814B 0 -+#define BIT_MASK_TC12DATA_8814B 0xffffff -+#define BIT_TC12DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC12DATA_8814B) << BIT_SHIFT_TC12DATA_8814B) -+#define BITS_TC12DATA_8814B \ -+ (BIT_MASK_TC12DATA_8814B << BIT_SHIFT_TC12DATA_8814B) -+#define BIT_CLEAR_TC12DATA_8814B(x) ((x) & (~BITS_TC12DATA_8814B)) -+#define BIT_GET_TC12DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC12DATA_8814B) & BIT_MASK_TC12DATA_8814B) -+#define BIT_SET_TC12DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC12DATA_8814B(x) | BIT_TC12DATA_8814B(v)) -+ -+/* 2 REG_FWFF_8814B */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V1_8814B 24 -+#define BIT_MASK_PKTNUM_TH_V1_8814B 0xff -+#define BIT_PKTNUM_TH_V1_8814B(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V1_8814B) << BIT_SHIFT_PKTNUM_TH_V1_8814B) -+#define BITS_PKTNUM_TH_V1_8814B \ -+ (BIT_MASK_PKTNUM_TH_V1_8814B << BIT_SHIFT_PKTNUM_TH_V1_8814B) -+#define BIT_CLEAR_PKTNUM_TH_V1_8814B(x) ((x) & (~BITS_PKTNUM_TH_V1_8814B)) -+#define BIT_GET_PKTNUM_TH_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V1_8814B) & BIT_MASK_PKTNUM_TH_V1_8814B) -+#define BIT_SET_PKTNUM_TH_V1_8814B(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V1_8814B(x) | BIT_PKTNUM_TH_V1_8814B(v)) -+ -+#define BIT_SHIFT_TIMER_TH_8814B 16 -+#define BIT_MASK_TIMER_TH_8814B 0xff -+#define BIT_TIMER_TH_8814B(x) \ -+ (((x) & BIT_MASK_TIMER_TH_8814B) << BIT_SHIFT_TIMER_TH_8814B) -+#define BITS_TIMER_TH_8814B \ -+ (BIT_MASK_TIMER_TH_8814B << BIT_SHIFT_TIMER_TH_8814B) -+#define BIT_CLEAR_TIMER_TH_8814B(x) ((x) & (~BITS_TIMER_TH_8814B)) -+#define BIT_GET_TIMER_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_TIMER_TH_8814B) & BIT_MASK_TIMER_TH_8814B) -+#define BIT_SET_TIMER_TH_8814B(x, v) \ -+ (BIT_CLEAR_TIMER_TH_8814B(x) | BIT_TIMER_TH_8814B(v)) -+ -+#define BIT_SHIFT_RXPKT1ENADDR_8814B 0 -+#define BIT_MASK_RXPKT1ENADDR_8814B 0xffff -+#define BIT_RXPKT1ENADDR_8814B(x) \ -+ (((x) & BIT_MASK_RXPKT1ENADDR_8814B) << BIT_SHIFT_RXPKT1ENADDR_8814B) -+#define BITS_RXPKT1ENADDR_8814B \ -+ (BIT_MASK_RXPKT1ENADDR_8814B << BIT_SHIFT_RXPKT1ENADDR_8814B) -+#define BIT_CLEAR_RXPKT1ENADDR_8814B(x) ((x) & (~BITS_RXPKT1ENADDR_8814B)) -+#define BIT_GET_RXPKT1ENADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPKT1ENADDR_8814B) & BIT_MASK_RXPKT1ENADDR_8814B) -+#define BIT_SET_RXPKT1ENADDR_8814B(x, v) \ -+ (BIT_CLEAR_RXPKT1ENADDR_8814B(x) | BIT_RXPKT1ENADDR_8814B(v)) -+ -+/* 2 REG_RXFF_PTR_V1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_RXFF0_RDPTR_V2_8814B 0 -+#define BIT_MASK_RXFF0_RDPTR_V2_8814B 0x3ffff -+#define BIT_RXFF0_RDPTR_V2_8814B(x) \ -+ (((x) & BIT_MASK_RXFF0_RDPTR_V2_8814B) \ -+ << BIT_SHIFT_RXFF0_RDPTR_V2_8814B) -+#define BITS_RXFF0_RDPTR_V2_8814B \ -+ (BIT_MASK_RXFF0_RDPTR_V2_8814B << BIT_SHIFT_RXFF0_RDPTR_V2_8814B) -+#define BIT_CLEAR_RXFF0_RDPTR_V2_8814B(x) ((x) & (~BITS_RXFF0_RDPTR_V2_8814B)) -+#define BIT_GET_RXFF0_RDPTR_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_RDPTR_V2_8814B) & \ -+ BIT_MASK_RXFF0_RDPTR_V2_8814B) -+#define BIT_SET_RXFF0_RDPTR_V2_8814B(x, v) \ -+ (BIT_CLEAR_RXFF0_RDPTR_V2_8814B(x) | BIT_RXFF0_RDPTR_V2_8814B(v)) -+ -+/* 2 REG_RXFF_WTR_V1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_RXFF0_WTPTR_V2_8814B 0 -+#define BIT_MASK_RXFF0_WTPTR_V2_8814B 0x3ffff -+#define BIT_RXFF0_WTPTR_V2_8814B(x) \ -+ (((x) & BIT_MASK_RXFF0_WTPTR_V2_8814B) \ -+ << BIT_SHIFT_RXFF0_WTPTR_V2_8814B) -+#define BITS_RXFF0_WTPTR_V2_8814B \ -+ (BIT_MASK_RXFF0_WTPTR_V2_8814B << BIT_SHIFT_RXFF0_WTPTR_V2_8814B) -+#define BIT_CLEAR_RXFF0_WTPTR_V2_8814B(x) ((x) & (~BITS_RXFF0_WTPTR_V2_8814B)) -+#define BIT_GET_RXFF0_WTPTR_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_WTPTR_V2_8814B) & \ -+ BIT_MASK_RXFF0_WTPTR_V2_8814B) -+#define BIT_SET_RXFF0_WTPTR_V2_8814B(x, v) \ -+ (BIT_CLEAR_RXFF0_WTPTR_V2_8814B(x) | BIT_RXFF0_WTPTR_V2_8814B(v)) -+ -+/* 2 REG_FE2IMR_8814B */ -+#define BIT__FE4ISR__IND_MSK_8814B BIT(29) -+#define BIT_FS_TXSC_DESC_DONE_INT_EN_8814B BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_EN_8814B BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_EN_8814B BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_EN_8814B BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_EN_8814B BIT(24) -+#define BIT_FS_ATIM_MB7_INT_EN_8814B BIT(23) -+#define BIT_FS_ATIM_MB6_INT_EN_8814B BIT(22) -+#define BIT_FS_ATIM_MB5_INT_EN_8814B BIT(21) -+#define BIT_FS_ATIM_MB4_INT_EN_8814B BIT(20) -+#define BIT_FS_ATIM_MB3_INT_EN_8814B BIT(19) -+#define BIT_FS_ATIM_MB2_INT_EN_8814B BIT(18) -+#define BIT_FS_ATIM_MB1_INT_EN_8814B BIT(17) -+#define BIT_FS_ATIM_MB0_INT_EN_8814B BIT(16) -+#define BIT_FS_TBTT4INT_EN_8814B BIT(11) -+#define BIT_FS_TBTT3INT_EN_8814B BIT(10) -+#define BIT_FS_TBTT2INT_EN_8814B BIT(9) -+#define BIT_FS_TBTT1INT_EN_8814B BIT(8) -+#define BIT_FS_TBTT0_MB7INT_EN_8814B BIT(7) -+#define BIT_FS_TBTT0_MB6INT_EN_8814B BIT(6) -+#define BIT_FS_TBTT0_MB5INT_EN_8814B BIT(5) -+#define BIT_FS_TBTT0_MB4INT_EN_8814B BIT(4) -+#define BIT_FS_TBTT0_MB3INT_EN_8814B BIT(3) -+#define BIT_FS_TBTT0_MB2INT_EN_8814B BIT(2) -+#define BIT_FS_TBTT0_MB1INT_EN_8814B BIT(1) -+#define BIT_FS_TBTT0_INT_EN_8814B BIT(0) -+ -+/* 2 REG_FE2ISR_8814B */ -+#define BIT__FE4ISR__IND_INT_8814B BIT(29) -+#define BIT_FS_TXSC_DESC_DONE_INT_8814B BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_8814B BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_8814B BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_8814B BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_8814B BIT(24) -+#define BIT_FS_ATIM_MB7_INT_8814B BIT(23) -+#define BIT_FS_ATIM_MB6_INT_8814B BIT(22) -+#define BIT_FS_ATIM_MB5_INT_8814B BIT(21) -+#define BIT_FS_ATIM_MB4_INT_8814B BIT(20) -+#define BIT_FS_ATIM_MB3_INT_8814B BIT(19) -+#define BIT_FS_ATIM_MB2_INT_8814B BIT(18) -+#define BIT_FS_ATIM_MB1_INT_8814B BIT(17) -+#define BIT_FS_ATIM_MB0_INT_8814B BIT(16) -+#define BIT_FS_TBTT4INT_8814B BIT(11) -+#define BIT_FS_TBTT3INT_8814B BIT(10) -+#define BIT_FS_TBTT2INT_8814B BIT(9) -+#define BIT_FS_TBTT1INT_8814B BIT(8) -+#define BIT_FS_TBTT0_MB7INT_8814B BIT(7) -+#define BIT_FS_TBTT0_MB6INT_8814B BIT(6) -+#define BIT_FS_TBTT0_MB5INT_8814B BIT(5) -+#define BIT_FS_TBTT0_MB4INT_8814B BIT(4) -+#define BIT_FS_TBTT0_MB3INT_8814B BIT(3) -+#define BIT_FS_TBTT0_MB2INT_8814B BIT(2) -+#define BIT_FS_TBTT0_MB1INT_8814B BIT(1) -+#define BIT_FS_TBTT0_INT_8814B BIT(0) -+ -+/* 2 REG_FE3IMR_8814B */ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT__EN_8814B BIT(31) -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT__EN_8814B BIT(30) -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT__EN_8814B BIT(29) -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT__EN_8814B BIT(28) -+#define BIT_FS_BCNDMA4_INT_EN_8814B BIT(27) -+#define BIT_FS_BCNDMA3_INT_EN_8814B BIT(26) -+#define BIT_FS_BCNDMA2_INT_EN_8814B BIT(25) -+#define BIT_FS_BCNDMA1_INT_EN_8814B BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_EN_8814B BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_EN_8814B BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_EN_8814B BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_EN_8814B BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_EN_8814B BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_EN_8814B BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_EN_8814B BIT(17) -+#define BIT_FS_BCNDMA0_INT_EN_8814B BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT__EN_8814B BIT(15) -+#define BIT_FS_BCNERLY4_INT_EN_8814B BIT(11) -+#define BIT_FS_BCNERLY3_INT_EN_8814B BIT(10) -+#define BIT_FS_BCNERLY2_INT_EN_8814B BIT(9) -+#define BIT_FS_BCNERLY1_INT_EN_8814B BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_EN_8814B BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_EN_8814B BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_EN_8814B BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_EN_8814B BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_EN_8814B BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_EN_8814B BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_EN_8814B BIT(1) -+#define BIT_FS_BCNERLY0_INT_EN_8814B BIT(0) -+ -+/* 2 REG_FE3ISR_8814B */ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT_8814B BIT(31) -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT_8814B BIT(30) -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT_8814B BIT(29) -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT_8814B BIT(28) -+#define BIT_FS_BCNDMA4_INT_8814B BIT(27) -+#define BIT_FS_BCNDMA3_INT_8814B BIT(26) -+#define BIT_FS_BCNDMA2_INT_8814B BIT(25) -+#define BIT_FS_BCNDMA1_INT_8814B BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_8814B BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_8814B BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_8814B BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_8814B BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_8814B BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_8814B BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_8814B BIT(17) -+#define BIT_FS_BCNDMA0_INT_8814B BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT_8814B BIT(15) -+#define BIT_FS_BCNERLY4_INT_8814B BIT(11) -+#define BIT_FS_BCNERLY3_INT_8814B BIT(10) -+#define BIT_FS_BCNERLY2_INT_8814B BIT(9) -+#define BIT_FS_BCNERLY1_INT_8814B BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_8814B BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_8814B BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_8814B BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_8814B BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_8814B BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_8814B BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_8814B BIT(1) -+#define BIT_FS_BCNERLY0_INT_8814B BIT(0) -+ -+/* 2 REG_FE4IMR_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_FS_CLI3_TXPKTIN_INT_EN_8814B BIT(19) -+#define BIT_FS_CLI2_TXPKTIN_INT_EN_8814B BIT(18) -+#define BIT_FS_CLI1_TXPKTIN_INT_EN_8814B BIT(17) -+#define BIT_FS_CLI0_TXPKTIN_INT_EN_8814B BIT(16) -+#define BIT_FS_CLI3_RX_UMD0_INT_EN_8814B BIT(15) -+#define BIT_FS_CLI3_RX_UMD1_INT_EN_8814B BIT(14) -+#define BIT_FS_CLI3_RX_BMD0_INT_EN_8814B BIT(13) -+#define BIT_FS_CLI3_RX_BMD1_INT_EN_8814B BIT(12) -+#define BIT_FS_CLI2_RX_UMD0_INT_EN_8814B BIT(11) -+#define BIT_FS_CLI2_RX_UMD1_INT_EN_8814B BIT(10) -+#define BIT_FS_CLI2_RX_BMD0_INT_EN_8814B BIT(9) -+#define BIT_FS_CLI2_RX_BMD1_INT_EN_8814B BIT(8) -+#define BIT_FS_CLI1_RX_UMD0_INT_EN_8814B BIT(7) -+#define BIT_FS_CLI1_RX_UMD1_INT_EN_8814B BIT(6) -+#define BIT_FS_CLI1_RX_BMD0_INT_EN_8814B BIT(5) -+#define BIT_FS_CLI1_RX_BMD1_INT_EN_8814B BIT(4) -+#define BIT_FS_CLI0_RX_UMD0_INT_EN_8814B BIT(3) -+#define BIT_FS_CLI0_RX_UMD1_INT_EN_8814B BIT(2) -+#define BIT_FS_CLI0_RX_BMD0_INT_EN_8814B BIT(1) -+#define BIT_FS_CLI0_RX_BMD1_INT_EN_8814B BIT(0) -+ -+/* 2 REG_FE4ISR_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_P2P_PWROFF_NOA2_ERLY_INT_8814B BIT(22) -+#define BIT_P2P_PWROFF_NOA1_ERLY_INT_8814B BIT(21) -+#define BIT_P2P_PWROFF_NOA0_ERLY_INT_8814B BIT(20) -+#define BIT_FS_CLI3_TXPKTIN_INT_8814B BIT(19) -+#define BIT_FS_CLI2_TXPKTIN_INT_8814B BIT(18) -+#define BIT_FS_CLI1_TXPKTIN_INT_8814B BIT(17) -+#define BIT_FS_CLI0_TXPKTIN_INT_8814B BIT(16) -+#define BIT_FS_CLI3_RX_UMD0_INT_8814B BIT(15) -+#define BIT_FS_CLI3_RX_UMD1_INT_8814B BIT(14) -+#define BIT_FS_CLI3_RX_BMD0_INT_8814B BIT(13) -+#define BIT_FS_CLI3_RX_BMD1_INT_8814B BIT(12) -+#define BIT_FS_CLI2_RX_UMD0_INT_8814B BIT(11) -+#define BIT_FS_CLI2_RX_UMD1_INT_8814B BIT(10) -+#define BIT_FS_CLI2_RX_BMD0_INT_8814B BIT(9) -+#define BIT_FS_CLI2_RX_BMD1_INT_8814B BIT(8) -+#define BIT_FS_CLI1_RX_UMD0_INT_8814B BIT(7) -+#define BIT_FS_CLI1_RX_UMD1_INT_8814B BIT(6) -+#define BIT_FS_CLI1_RX_BMD0_INT_8814B BIT(5) -+#define BIT_FS_CLI1_RX_BMD1_INT_8814B BIT(4) -+#define BIT_FS_CLI0_RX_UMD0_INT_8814B BIT(3) -+#define BIT_FS_CLI0_RX_UMD1_INT_8814B BIT(2) -+#define BIT_FS_CLI0_RX_BMD0_INT_8814B BIT(1) -+#define BIT_FS_CLI0_RX_BMD1_INT_8814B BIT(0) -+ -+/* 2 REG_FT1IMR_8814B */ -+#define BIT__FT2ISR__IND_MSK_8814B BIT(30) -+#define BIT_FTM_PTT_INT_EN_8814B BIT(29) -+#define BIT_RXFTMREQ_INT_EN_8814B BIT(28) -+#define BIT_RXFTM_INT_EN_8814B BIT(27) -+#define BIT_TXFTM_INT_EN_8814B BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_EN_8814B BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_EN_8814B BIT(24) -+#define BIT_FS_MACID_SEARCH_FAIL_INT_EN_8814B BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_EN_8814B BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_EN_8814B BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_EN_8814B BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_EN_8814B BIT(18) -+#define BIT_FS_CTWEND2_INT_EN_8814B BIT(17) -+#define BIT_FS_CTWEND1_INT_EN_8814B BIT(16) -+#define BIT_FS_CTWEND0_INT_EN_8814B BIT(15) -+#define BIT_FS_TX_NULL1_INT_EN_8814B BIT(14) -+#define BIT_FS_TX_NULL0_INT_EN_8814B BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_EN_8814B BIT(12) -+#define BIT_FS_P2P_RFON2_INT_EN_8814B BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_EN_8814B BIT(10) -+#define BIT_FS_P2P_RFON1_INT_EN_8814B BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_EN_8814B BIT(8) -+#define BIT_FS_P2P_RFON0_INT_EN_8814B BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_EN_8814B BIT(6) -+#define BIT_FS_RX_UAPSDMD1_EN_8814B BIT(5) -+#define BIT_FS_RX_UAPSDMD0_EN_8814B BIT(4) -+#define BIT_FS_TRIGGER_PKT_EN_8814B BIT(3) -+#define BIT_FS_EOSP_INT_EN_8814B BIT(2) -+#define BIT_FS_RPWM2_INT_EN_8814B BIT(1) -+#define BIT_FS_RPWM_INT_EN_8814B BIT(0) -+ -+/* 2 REG_FT1ISR_8814B */ -+#define BIT__FT2ISR__IND_INT_8814B BIT(30) -+#define BIT_FTM_PTT_INT_8814B BIT(29) -+#define BIT_RXFTMREQ_INT_8814B BIT(28) -+#define BIT_RXFTM_INT_8814B BIT(27) -+#define BIT_TXFTM_INT_8814B BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_8814B BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_8814B BIT(24) -+#define BIT_FS_MACID_SEARCH_FAIL_INT_8814B BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_8814B BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_8814B BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_8814B BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_8814B BIT(18) -+#define BIT_FS_CTWEND2_INT_8814B BIT(17) -+#define BIT_FS_CTWEND1_INT_8814B BIT(16) -+#define BIT_FS_CTWEND0_INT_8814B BIT(15) -+#define BIT_FS_TX_NULL1_INT_8814B BIT(14) -+#define BIT_FS_TX_NULL0_INT_8814B BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_INT_8814B BIT(12) -+#define BIT_FS_P2P_RFON2_INT_8814B BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_8814B BIT(10) -+#define BIT_FS_P2P_RFON1_INT_8814B BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_8814B BIT(8) -+#define BIT_FS_P2P_RFON0_INT_8814B BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_8814B BIT(6) -+#define BIT_FS_RX_UAPSDMD1_INT_8814B BIT(5) -+#define BIT_FS_RX_UAPSDMD0_INT_8814B BIT(4) -+#define BIT_FS_TRIGGER_PKT_INT_8814B BIT(3) -+#define BIT_FS_EOSP_INT_8814B BIT(2) -+#define BIT_FS_RPWM2_INT_8814B BIT(1) -+#define BIT_FS_RPWM_INT_8814B BIT(0) -+ -+/* 2 REG_SPWR0_8814B */ -+ -+#define BIT_SHIFT_MID_31TO0_8814B 0 -+#define BIT_MASK_MID_31TO0_8814B 0xffffffffL -+#define BIT_MID_31TO0_8814B(x) \ -+ (((x) & BIT_MASK_MID_31TO0_8814B) << BIT_SHIFT_MID_31TO0_8814B) -+#define BITS_MID_31TO0_8814B \ -+ (BIT_MASK_MID_31TO0_8814B << BIT_SHIFT_MID_31TO0_8814B) -+#define BIT_CLEAR_MID_31TO0_8814B(x) ((x) & (~BITS_MID_31TO0_8814B)) -+#define BIT_GET_MID_31TO0_8814B(x) \ -+ (((x) >> BIT_SHIFT_MID_31TO0_8814B) & BIT_MASK_MID_31TO0_8814B) -+#define BIT_SET_MID_31TO0_8814B(x, v) \ -+ (BIT_CLEAR_MID_31TO0_8814B(x) | BIT_MID_31TO0_8814B(v)) -+ -+/* 2 REG_SPWR1_8814B */ -+ -+#define BIT_SHIFT_MID_63TO32_8814B 0 -+#define BIT_MASK_MID_63TO32_8814B 0xffffffffL -+#define BIT_MID_63TO32_8814B(x) \ -+ (((x) & BIT_MASK_MID_63TO32_8814B) << BIT_SHIFT_MID_63TO32_8814B) -+#define BITS_MID_63TO32_8814B \ -+ (BIT_MASK_MID_63TO32_8814B << BIT_SHIFT_MID_63TO32_8814B) -+#define BIT_CLEAR_MID_63TO32_8814B(x) ((x) & (~BITS_MID_63TO32_8814B)) -+#define BIT_GET_MID_63TO32_8814B(x) \ -+ (((x) >> BIT_SHIFT_MID_63TO32_8814B) & BIT_MASK_MID_63TO32_8814B) -+#define BIT_SET_MID_63TO32_8814B(x, v) \ -+ (BIT_CLEAR_MID_63TO32_8814B(x) | BIT_MID_63TO32_8814B(v)) -+ -+/* 2 REG_SPWR2_8814B */ -+ -+#define BIT_SHIFT_MID_95O64_8814B 0 -+#define BIT_MASK_MID_95O64_8814B 0xffffffffL -+#define BIT_MID_95O64_8814B(x) \ -+ (((x) & BIT_MASK_MID_95O64_8814B) << BIT_SHIFT_MID_95O64_8814B) -+#define BITS_MID_95O64_8814B \ -+ (BIT_MASK_MID_95O64_8814B << BIT_SHIFT_MID_95O64_8814B) -+#define BIT_CLEAR_MID_95O64_8814B(x) ((x) & (~BITS_MID_95O64_8814B)) -+#define BIT_GET_MID_95O64_8814B(x) \ -+ (((x) >> BIT_SHIFT_MID_95O64_8814B) & BIT_MASK_MID_95O64_8814B) -+#define BIT_SET_MID_95O64_8814B(x, v) \ -+ (BIT_CLEAR_MID_95O64_8814B(x) | BIT_MID_95O64_8814B(v)) -+ -+/* 2 REG_SPWR3_8814B */ -+ -+#define BIT_SHIFT_MID_127TO96_8814B 0 -+#define BIT_MASK_MID_127TO96_8814B 0xffffffffL -+#define BIT_MID_127TO96_8814B(x) \ -+ (((x) & BIT_MASK_MID_127TO96_8814B) << BIT_SHIFT_MID_127TO96_8814B) -+#define BITS_MID_127TO96_8814B \ -+ (BIT_MASK_MID_127TO96_8814B << BIT_SHIFT_MID_127TO96_8814B) -+#define BIT_CLEAR_MID_127TO96_8814B(x) ((x) & (~BITS_MID_127TO96_8814B)) -+#define BIT_GET_MID_127TO96_8814B(x) \ -+ (((x) >> BIT_SHIFT_MID_127TO96_8814B) & BIT_MASK_MID_127TO96_8814B) -+#define BIT_SET_MID_127TO96_8814B(x, v) \ -+ (BIT_CLEAR_MID_127TO96_8814B(x) | BIT_MID_127TO96_8814B(v)) -+ -+/* 2 REG_POWSEQ_8814B */ -+ -+#define BIT_SHIFT_SEQNUM_MID_8814B 16 -+#define BIT_MASK_SEQNUM_MID_8814B 0xffff -+#define BIT_SEQNUM_MID_8814B(x) \ -+ (((x) & BIT_MASK_SEQNUM_MID_8814B) << BIT_SHIFT_SEQNUM_MID_8814B) -+#define BITS_SEQNUM_MID_8814B \ -+ (BIT_MASK_SEQNUM_MID_8814B << BIT_SHIFT_SEQNUM_MID_8814B) -+#define BIT_CLEAR_SEQNUM_MID_8814B(x) ((x) & (~BITS_SEQNUM_MID_8814B)) -+#define BIT_GET_SEQNUM_MID_8814B(x) \ -+ (((x) >> BIT_SHIFT_SEQNUM_MID_8814B) & BIT_MASK_SEQNUM_MID_8814B) -+#define BIT_SET_SEQNUM_MID_8814B(x, v) \ -+ (BIT_CLEAR_SEQNUM_MID_8814B(x) | BIT_SEQNUM_MID_8814B(v)) -+ -+#define BIT_SHIFT_REF_MID_8814B 0 -+#define BIT_MASK_REF_MID_8814B 0x7f -+#define BIT_REF_MID_8814B(x) \ -+ (((x) & BIT_MASK_REF_MID_8814B) << BIT_SHIFT_REF_MID_8814B) -+#define BITS_REF_MID_8814B (BIT_MASK_REF_MID_8814B << BIT_SHIFT_REF_MID_8814B) -+#define BIT_CLEAR_REF_MID_8814B(x) ((x) & (~BITS_REF_MID_8814B)) -+#define BIT_GET_REF_MID_8814B(x) \ -+ (((x) >> BIT_SHIFT_REF_MID_8814B) & BIT_MASK_REF_MID_8814B) -+#define BIT_SET_REF_MID_8814B(x, v) \ -+ (BIT_CLEAR_REF_MID_8814B(x) | BIT_REF_MID_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_TC7_CTRL_V1_8814B */ -+#define BIT_TC7INT_EN_8814B BIT(26) -+#define BIT_TC7MODE_8814B BIT(25) -+#define BIT_TC7EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC7DATA_8814B 0 -+#define BIT_MASK_TC7DATA_8814B 0xffffff -+#define BIT_TC7DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC7DATA_8814B) << BIT_SHIFT_TC7DATA_8814B) -+#define BITS_TC7DATA_8814B (BIT_MASK_TC7DATA_8814B << BIT_SHIFT_TC7DATA_8814B) -+#define BIT_CLEAR_TC7DATA_8814B(x) ((x) & (~BITS_TC7DATA_8814B)) -+#define BIT_GET_TC7DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC7DATA_8814B) & BIT_MASK_TC7DATA_8814B) -+#define BIT_SET_TC7DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC7DATA_8814B(x) | BIT_TC7DATA_8814B(v)) -+ -+/* 2 REG_TC8_CTRL_V1_8814B */ -+#define BIT_TC8INT_EN_8814B BIT(26) -+#define BIT_TC8MODE_8814B BIT(25) -+#define BIT_TC8EN_8814B BIT(24) -+ -+#define BIT_SHIFT_TC8DATA_8814B 0 -+#define BIT_MASK_TC8DATA_8814B 0xffffff -+#define BIT_TC8DATA_8814B(x) \ -+ (((x) & BIT_MASK_TC8DATA_8814B) << BIT_SHIFT_TC8DATA_8814B) -+#define BITS_TC8DATA_8814B (BIT_MASK_TC8DATA_8814B << BIT_SHIFT_TC8DATA_8814B) -+#define BIT_CLEAR_TC8DATA_8814B(x) ((x) & (~BITS_TC8DATA_8814B)) -+#define BIT_GET_TC8DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TC8DATA_8814B) & BIT_MASK_TC8DATA_8814B) -+#define BIT_SET_TC8DATA_8814B(x, v) \ -+ (BIT_CLEAR_TC8DATA_8814B(x) | BIT_TC8DATA_8814B(v)) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL0_8814B */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8814B 24 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8814B 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT2_8814B(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8814B) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8814B) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT2_8814B \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8814B \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8814B) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT2_8814B(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT2_8814B)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT2_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8814B) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8814B) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT2_8814B(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT2_8814B(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT2_8814B(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8814B 16 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8814B 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT1_8814B(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8814B) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8814B) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT1_8814B \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8814B \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8814B) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT1_8814B(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT1_8814B)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8814B) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8814B) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT1_8814B(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT1_8814B(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT1_8814B(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8814B 8 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8814B 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT0_8814B(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8814B) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8814B) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT0_8814B \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8814B \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8814B) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT0_8814B(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT0_8814B)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT0_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8814B) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8814B) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT0_8814B(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT0_8814B(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT0_8814B(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8814B 0 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8814B 0xff -+#define BIT_RX_BCN_TBTT_ITVL_PORT0_8814B(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8814B) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8814B) -+#define BITS_RX_BCN_TBTT_ITVL_PORT0_8814B \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8814B \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8814B) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_PORT0_8814B(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_PORT0_8814B)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_PORT0_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8814B) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8814B) -+#define BIT_SET_RX_BCN_TBTT_ITVL_PORT0_8814B(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_PORT0_8814B(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_PORT0_8814B(v)) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL1_8814B */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8814B 0 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8814B 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT3_8814B(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8814B) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8814B) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT3_8814B \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8814B \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8814B) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT3_8814B(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT3_8814B)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT3_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8814B) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8814B) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT3_8814B(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT3_8814B(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT3_8814B(v)) -+ -+/* 2 REG_FWIMR1_8814B */ -+#define BIT_FS_ATIM_MB15_INT_EN_8814B BIT(31) -+#define BIT_FS_ATIM_MB14_INT_EN_8814B BIT(30) -+#define BIT_FS_ATIM_MB13_INT_EN_8814B BIT(29) -+#define BIT_FS_ATIM_MB12_INT_EN_8814B BIT(28) -+#define BIT_FS_ATIM_MB11_INT_EN_8814B BIT(27) -+#define BIT_FS_ATIM_MB10_INT_EN_8814B BIT(26) -+#define BIT_FS_ATIM_MB9_INT_EN_8814B BIT(25) -+#define BIT_FS_ATIM_MB8_INT_EN_8814B BIT(24) -+#define BIT_FS_TXBCNERR_MB15_INT_EN_8814B BIT(23) -+#define BIT_FS_TXBCNERR_MB14_INT_EN_8814B BIT(22) -+#define BIT_FS_TXBCNERR_MB13_INT_EN_8814B BIT(21) -+#define BIT_FS_TXBCNERR_MB12_INT_EN_8814B BIT(20) -+#define BIT_FS_TXBCNERR_MB11_INT_EN_8814B BIT(19) -+#define BIT_FS_TXBCNERR_MB10_INT_EN_8814B BIT(18) -+#define BIT_FS_TXBCNERR_MB9_INT_EN_8814B BIT(17) -+#define BIT_FS_TXBCNERR_MB8_INT_EN_8814B BIT(16) -+#define BIT_FS_TXBCNOK_MB15_INT_EN_8814B BIT(15) -+#define BIT_FS_TXBCNOK_MB14_INT_EN_8814B BIT(14) -+#define BIT_FS_TXBCNOK_MB13_INT_EN_8814B BIT(13) -+#define BIT_FS_TXBCNOK_MB12_INT_EN_8814B BIT(12) -+#define BIT_FS_TXBCNOK_MB11_INT_EN_8814B BIT(11) -+#define BIT_FS_TXBCNOK_MB10_INT_EN_8814B BIT(10) -+#define BIT_FS_TXBCNOK_MB9_INT_EN_8814B BIT(9) -+#define BIT_FS_TXBCNOK_MB8_INT_EN_8814B BIT(8) -+#define BIT_FS_BCNERLY0_MB15INT_EN_8814B BIT(7) -+#define BIT_FS_BCNERLY0_MB14INT_EN_8814B BIT(6) -+#define BIT_FS_BCNERLY0_MB13INT_EN_8814B BIT(5) -+#define BIT_FS_BCNERLY0_MB12INT_EN_8814B BIT(4) -+#define BIT_FS_BCNERLY0_MB11INT_EN_8814B BIT(3) -+#define BIT_FS_BCNERLY0_MB10INT_EN_8814B BIT(2) -+#define BIT_FS_BCNERLY0_MB9INT_EN_8814B BIT(1) -+#define BIT_FS_BCNERLY0_MB8INT_EN_8814B BIT(0) -+ -+/* 2 REG_FWISR1_8814B */ -+#define BIT_FS_ATIM_MB15_INT_8814B BIT(31) -+#define BIT_FS_ATIM_MB14_INT_8814B BIT(30) -+#define BIT_FS_ATIM_MB13_INT_8814B BIT(29) -+#define BIT_FS_ATIM_MB12_INT_8814B BIT(28) -+#define BIT_FS_ATIM_MB11_INT_8814B BIT(27) -+#define BIT_FS_ATIM_MB10_INT_8814B BIT(26) -+#define BIT_FS_ATIM_MB9_INT_8814B BIT(25) -+#define BIT_FS_ATIM_MB8_INT_8814B BIT(24) -+#define BIT_FS_TXBCNERR_MB15_INT_8814B BIT(23) -+#define BIT_FS_TXBCNERR_MB14_INT_8814B BIT(22) -+#define BIT_FS_TXBCNERR_MB13_INT_8814B BIT(21) -+#define BIT_FS_TXBCNERR_MB12_INT_8814B BIT(20) -+#define BIT_FS_TXBCNERR_MB11_INT_8814B BIT(19) -+#define BIT_FS_TXBCNERR_MB10_INT_8814B BIT(18) -+#define BIT_FS_TXBCNERR_MB9_INT_8814B BIT(17) -+#define BIT_FS_TXBCNERR_MB8_INT_8814B BIT(16) -+#define BIT_FS_TXBCNOK_MB15_INT_8814B BIT(15) -+#define BIT_FS_TXBCNOK_MB14_INT_8814B BIT(14) -+#define BIT_FS_TXBCNOK_MB13_INT_8814B BIT(13) -+#define BIT_FS_TXBCNOK_MB12_INT_8814B BIT(12) -+#define BIT_FS_TXBCNOK_MB11_INT_8814B BIT(11) -+#define BIT_FS_TXBCNOK_MB10_INT_8814B BIT(10) -+#define BIT_FS_TXBCNOK_MB9_INT_8814B BIT(9) -+#define BIT_FS_TXBCNOK_MB8_INT_8814B BIT(8) -+#define BIT_FS_BCNERLY0_MB15INT_8814B BIT(7) -+#define BIT_FS_BCNERLY0_MB14INT_8814B BIT(6) -+#define BIT_FS_BCNERLY0_MB13INT_8814B BIT(5) -+#define BIT_FS_BCNERLY0_MB12INT_8814B BIT(4) -+#define BIT_FS_BCNERLY0_MB11INT_8814B BIT(3) -+#define BIT_FS_BCNERLY0_MB10INT_8814B BIT(2) -+#define BIT_FS_BCNERLY0_MB9INT_8814B BIT(1) -+#define BIT_FS_BCNERLY0_MB8INT_8814B BIT(0) -+ -+/* 2 REG_FWIMR2_8814B */ -+#define BIT_FS_BCNDMA0_MB15_INT_EN_8814B BIT(15) -+#define BIT_FS_BCNDMA0_MB14_INT_EN_8814B BIT(14) -+#define BIT_FS_BCNDMA0_MB13_INT_EN_8814B BIT(13) -+#define BIT_FS_BCNDMA0_MB12_INT_EN_8814B BIT(12) -+#define BIT_FS_BCNDMA0_MB11_INT_EN_8814B BIT(11) -+#define BIT_FS_BCNDMA0_MB10_INT_EN_8814B BIT(10) -+#define BIT_FS_BCNDMA0_MB9_INT_EN_8814B BIT(9) -+#define BIT_FS_BCNDMA0_MB8_INT_EN_8814B BIT(8) -+#define BIT_FS_TBTT0_MB15INT_EN_8814B BIT(7) -+#define BIT_FS_TBTT0_MB14INT_EN_8814B BIT(6) -+#define BIT_FS_TBTT0_MB13INT_EN_8814B BIT(5) -+#define BIT_FS_TBTT0_MB12INT_EN_8814B BIT(4) -+#define BIT_FS_TBTT0_MB11INT_EN_8814B BIT(3) -+#define BIT_FS_TBTT0_MB10INT_EN_8814B BIT(2) -+#define BIT_FS_TBTT0_MB9INT_EN_8814B BIT(1) -+#define BIT_FS_TBTT0_MB8INT_EN_8814B BIT(0) -+ -+/* 2 REG_FWISR2_8814B */ -+#define BIT_FS_BCNDMA0_MB15_INT_8814B BIT(15) -+#define BIT_FS_BCNDMA0_MB14_INT_8814B BIT(14) -+#define BIT_FS_BCNDMA0_MB13_INT_8814B BIT(13) -+#define BIT_FS_BCNDMA0_MB12_INT_8814B BIT(12) -+#define BIT_FS_BCNDMA0_MB11_INT_8814B BIT(11) -+#define BIT_FS_BCNDMA0_MB10_INT_8814B BIT(10) -+#define BIT_FS_BCNDMA0_MB9_INT_8814B BIT(9) -+#define BIT_FS_BCNDMA0_MB8_INT_8814B BIT(8) -+#define BIT_FS_TBTT0_MB15INT_8814B BIT(7) -+#define BIT_FS_TBTT0_MB14INT_8814B BIT(6) -+#define BIT_FS_TBTT0_MB13INT_8814B BIT(5) -+#define BIT_FS_TBTT0_MB12INT_8814B BIT(4) -+#define BIT_FS_TBTT0_MB11INT_8814B BIT(3) -+#define BIT_FS_TBTT0_MB10INT_8814B BIT(2) -+#define BIT_FS_TBTT0_MB9INT_8814B BIT(1) -+#define BIT_FS_TBTT0_MB8INT_8814B BIT(0) -+ -+/* 2 REG_FWIMR3_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_FS_TXBCNOK_PORT4_INT_EN_8814B BIT(11) -+#define BIT_FS_TXBCNOK_PORT3_INT_EN_8814B BIT(10) -+#define BIT_FS_TXBCNOK_PORT2_INT_EN_8814B BIT(9) -+#define BIT_FS_TXBCNOK_PORT1_INT_EN_8814B BIT(8) -+#define BIT_FS_TXBCNERR_PORT4_INT_EN_8814B BIT(7) -+#define BIT_FS_TXBCNERR_PORT3_INT_EN_8814B BIT(6) -+#define BIT_FS_TXBCNERR_PORT2_INT_EN_8814B BIT(5) -+#define BIT_FS_TXBCNERR_PORT1_INT_EN_8814B BIT(4) -+#define BIT_FS_ATIM_PORT4_INT_EN_8814B BIT(3) -+#define BIT_FS_ATIM_PORT3_INT_EN_8814B BIT(2) -+#define BIT_FS_ATIM_PORT2_INT_EN_8814B BIT(1) -+#define BIT_FS_ATIM_PORT1_INT_EN_8814B BIT(0) -+ -+/* 2 REG_FWISR3_8814B */ -+#define BIT_FS_TXBCNOK_PORT4_INT_8814B BIT(11) -+#define BIT_FS_TXBCNOK_PORT3_INT_8814B BIT(10) -+#define BIT_FS_TXBCNOK_PORT2_INT_8814B BIT(9) -+#define BIT_FS_TXBCNOK_PORT1_INT_8814B BIT(8) -+#define BIT_FS_TXBCNERR_PORT4_INT_8814B BIT(7) -+#define BIT_FS_TXBCNERR_PORT3_INT_8814B BIT(6) -+#define BIT_FS_TXBCNERR_PORT2_INT_8814B BIT(5) -+#define BIT_FS_TXBCNERR_PORT1_INT_8814B BIT(4) -+#define BIT_FS_ATIM_PORT4_INT_8814B BIT(3) -+#define BIT_FS_ATIM_PORT3_INT_8814B BIT(2) -+#define BIT_FS_ATIM_PORT2_INT_8814B BIT(1) -+#define BIT_FS_ATIM_PORT1_INT_8814B BIT(0) -+ -+/* 2 REG_SPEED_SENSOR_8814B */ -+#define BIT_DSS_1_RST_N_8814B BIT(31) -+#define BIT_DSS_1_SPEED_EN_8814B BIT(30) -+#define BIT_DSS_1_WIRE_SEL_8814B BIT(29) -+#define BIT_DSS_ENCLK_8814B BIT(28) -+ -+#define BIT_SHIFT_DSS_1_RO_SEL_8814B 24 -+#define BIT_MASK_DSS_1_RO_SEL_8814B 0x7 -+#define BIT_DSS_1_RO_SEL_8814B(x) \ -+ (((x) & BIT_MASK_DSS_1_RO_SEL_8814B) << BIT_SHIFT_DSS_1_RO_SEL_8814B) -+#define BITS_DSS_1_RO_SEL_8814B \ -+ (BIT_MASK_DSS_1_RO_SEL_8814B << BIT_SHIFT_DSS_1_RO_SEL_8814B) -+#define BIT_CLEAR_DSS_1_RO_SEL_8814B(x) ((x) & (~BITS_DSS_1_RO_SEL_8814B)) -+#define BIT_GET_DSS_1_RO_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_RO_SEL_8814B) & BIT_MASK_DSS_1_RO_SEL_8814B) -+#define BIT_SET_DSS_1_RO_SEL_8814B(x, v) \ -+ (BIT_CLEAR_DSS_1_RO_SEL_8814B(x) | BIT_DSS_1_RO_SEL_8814B(v)) -+ -+#define BIT_SHIFT_DSS_1_DATA_IN_8814B 0 -+#define BIT_MASK_DSS_1_DATA_IN_8814B 0xfffff -+#define BIT_DSS_1_DATA_IN_8814B(x) \ -+ (((x) & BIT_MASK_DSS_1_DATA_IN_8814B) << BIT_SHIFT_DSS_1_DATA_IN_8814B) -+#define BITS_DSS_1_DATA_IN_8814B \ -+ (BIT_MASK_DSS_1_DATA_IN_8814B << BIT_SHIFT_DSS_1_DATA_IN_8814B) -+#define BIT_CLEAR_DSS_1_DATA_IN_8814B(x) ((x) & (~BITS_DSS_1_DATA_IN_8814B)) -+#define BIT_GET_DSS_1_DATA_IN_8814B(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_DATA_IN_8814B) & BIT_MASK_DSS_1_DATA_IN_8814B) -+#define BIT_SET_DSS_1_DATA_IN_8814B(x, v) \ -+ (BIT_CLEAR_DSS_1_DATA_IN_8814B(x) | BIT_DSS_1_DATA_IN_8814B(v)) -+ -+/* 2 REG_SPEED_SENSOR1_8814B */ -+#define BIT_DSS_1_READY_8814B BIT(31) -+#define BIT_DSS_1_WSORT_GO_8814B BIT(30) -+ -+#define BIT_SHIFT_DSS_1_COUNT_OUT_8814B 0 -+#define BIT_MASK_DSS_1_COUNT_OUT_8814B 0xfffff -+#define BIT_DSS_1_COUNT_OUT_8814B(x) \ -+ (((x) & BIT_MASK_DSS_1_COUNT_OUT_8814B) \ -+ << BIT_SHIFT_DSS_1_COUNT_OUT_8814B) -+#define BITS_DSS_1_COUNT_OUT_8814B \ -+ (BIT_MASK_DSS_1_COUNT_OUT_8814B << BIT_SHIFT_DSS_1_COUNT_OUT_8814B) -+#define BIT_CLEAR_DSS_1_COUNT_OUT_8814B(x) ((x) & (~BITS_DSS_1_COUNT_OUT_8814B)) -+#define BIT_GET_DSS_1_COUNT_OUT_8814B(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_COUNT_OUT_8814B) & \ -+ BIT_MASK_DSS_1_COUNT_OUT_8814B) -+#define BIT_SET_DSS_1_COUNT_OUT_8814B(x, v) \ -+ (BIT_CLEAR_DSS_1_COUNT_OUT_8814B(x) | BIT_DSS_1_COUNT_OUT_8814B(v)) -+ -+/* 2 REG_SPEED_SENSOR2_8814B */ -+#define BIT_DSS_2_RST_N_8814B BIT(31) -+#define BIT_DSS_2_SPEED_EN_8814B BIT(30) -+#define BIT_DSS_2_WIRE_SEL_8814B BIT(29) -+#define BIT_DSS_ENCLK_8814B BIT(28) -+ -+#define BIT_SHIFT_DSS_2_RO_SEL_8814B 24 -+#define BIT_MASK_DSS_2_RO_SEL_8814B 0x7 -+#define BIT_DSS_2_RO_SEL_8814B(x) \ -+ (((x) & BIT_MASK_DSS_2_RO_SEL_8814B) << BIT_SHIFT_DSS_2_RO_SEL_8814B) -+#define BITS_DSS_2_RO_SEL_8814B \ -+ (BIT_MASK_DSS_2_RO_SEL_8814B << BIT_SHIFT_DSS_2_RO_SEL_8814B) -+#define BIT_CLEAR_DSS_2_RO_SEL_8814B(x) ((x) & (~BITS_DSS_2_RO_SEL_8814B)) -+#define BIT_GET_DSS_2_RO_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_RO_SEL_8814B) & BIT_MASK_DSS_2_RO_SEL_8814B) -+#define BIT_SET_DSS_2_RO_SEL_8814B(x, v) \ -+ (BIT_CLEAR_DSS_2_RO_SEL_8814B(x) | BIT_DSS_2_RO_SEL_8814B(v)) -+ -+#define BIT_SHIFT_DSS_2_DATA_IN_8814B 0 -+#define BIT_MASK_DSS_2_DATA_IN_8814B 0xfffff -+#define BIT_DSS_2_DATA_IN_8814B(x) \ -+ (((x) & BIT_MASK_DSS_2_DATA_IN_8814B) << BIT_SHIFT_DSS_2_DATA_IN_8814B) -+#define BITS_DSS_2_DATA_IN_8814B \ -+ (BIT_MASK_DSS_2_DATA_IN_8814B << BIT_SHIFT_DSS_2_DATA_IN_8814B) -+#define BIT_CLEAR_DSS_2_DATA_IN_8814B(x) ((x) & (~BITS_DSS_2_DATA_IN_8814B)) -+#define BIT_GET_DSS_2_DATA_IN_8814B(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_DATA_IN_8814B) & BIT_MASK_DSS_2_DATA_IN_8814B) -+#define BIT_SET_DSS_2_DATA_IN_8814B(x, v) \ -+ (BIT_CLEAR_DSS_2_DATA_IN_8814B(x) | BIT_DSS_2_DATA_IN_8814B(v)) -+ -+/* 2 REG_SPEED_SENSOR3_8814B */ -+#define BIT_DSS_2_READY_8814B BIT(31) -+#define BIT_DSS_2_WSORT_GO_8814B BIT(30) -+ -+#define BIT_SHIFT_DSS_2_COUNT_OUT_8814B 0 -+#define BIT_MASK_DSS_2_COUNT_OUT_8814B 0xfffff -+#define BIT_DSS_2_COUNT_OUT_8814B(x) \ -+ (((x) & BIT_MASK_DSS_2_COUNT_OUT_8814B) \ -+ << BIT_SHIFT_DSS_2_COUNT_OUT_8814B) -+#define BITS_DSS_2_COUNT_OUT_8814B \ -+ (BIT_MASK_DSS_2_COUNT_OUT_8814B << BIT_SHIFT_DSS_2_COUNT_OUT_8814B) -+#define BIT_CLEAR_DSS_2_COUNT_OUT_8814B(x) ((x) & (~BITS_DSS_2_COUNT_OUT_8814B)) -+#define BIT_GET_DSS_2_COUNT_OUT_8814B(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_COUNT_OUT_8814B) & \ -+ BIT_MASK_DSS_2_COUNT_OUT_8814B) -+#define BIT_SET_DSS_2_COUNT_OUT_8814B(x, v) \ -+ (BIT_CLEAR_DSS_2_COUNT_OUT_8814B(x) | BIT_DSS_2_COUNT_OUT_8814B(v)) -+ -+/* 2 REG_SPEED_SENSOR4_8814B */ -+#define BIT_DSS_3_RST_N_8814B BIT(31) -+#define BIT_DSS_3_SPEED_EN_8814B BIT(30) -+#define BIT_DSS_3_WIRE_SEL_8814B BIT(29) -+#define BIT_DSS_ENCLK_8814B BIT(28) -+ -+#define BIT_SHIFT_DSS_3_RO_SEL_8814B 24 -+#define BIT_MASK_DSS_3_RO_SEL_8814B 0x7 -+#define BIT_DSS_3_RO_SEL_8814B(x) \ -+ (((x) & BIT_MASK_DSS_3_RO_SEL_8814B) << BIT_SHIFT_DSS_3_RO_SEL_8814B) -+#define BITS_DSS_3_RO_SEL_8814B \ -+ (BIT_MASK_DSS_3_RO_SEL_8814B << BIT_SHIFT_DSS_3_RO_SEL_8814B) -+#define BIT_CLEAR_DSS_3_RO_SEL_8814B(x) ((x) & (~BITS_DSS_3_RO_SEL_8814B)) -+#define BIT_GET_DSS_3_RO_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_RO_SEL_8814B) & BIT_MASK_DSS_3_RO_SEL_8814B) -+#define BIT_SET_DSS_3_RO_SEL_8814B(x, v) \ -+ (BIT_CLEAR_DSS_3_RO_SEL_8814B(x) | BIT_DSS_3_RO_SEL_8814B(v)) -+ -+#define BIT_SHIFT_DSS_3_DATA_IN_8814B 0 -+#define BIT_MASK_DSS_3_DATA_IN_8814B 0xfffff -+#define BIT_DSS_3_DATA_IN_8814B(x) \ -+ (((x) & BIT_MASK_DSS_3_DATA_IN_8814B) << BIT_SHIFT_DSS_3_DATA_IN_8814B) -+#define BITS_DSS_3_DATA_IN_8814B \ -+ (BIT_MASK_DSS_3_DATA_IN_8814B << BIT_SHIFT_DSS_3_DATA_IN_8814B) -+#define BIT_CLEAR_DSS_3_DATA_IN_8814B(x) ((x) & (~BITS_DSS_3_DATA_IN_8814B)) -+#define BIT_GET_DSS_3_DATA_IN_8814B(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_DATA_IN_8814B) & BIT_MASK_DSS_3_DATA_IN_8814B) -+#define BIT_SET_DSS_3_DATA_IN_8814B(x, v) \ -+ (BIT_CLEAR_DSS_3_DATA_IN_8814B(x) | BIT_DSS_3_DATA_IN_8814B(v)) -+ -+/* 2 REG_SPEED_SENSOR5_8814B */ -+#define BIT_DSS_3_READY_8814B BIT(31) -+#define BIT_DSS_3_WSORT_GO_8814B BIT(30) -+ -+#define BIT_SHIFT_DSS_3_COUNT_OUT_8814B 0 -+#define BIT_MASK_DSS_3_COUNT_OUT_8814B 0xfffff -+#define BIT_DSS_3_COUNT_OUT_8814B(x) \ -+ (((x) & BIT_MASK_DSS_3_COUNT_OUT_8814B) \ -+ << BIT_SHIFT_DSS_3_COUNT_OUT_8814B) -+#define BITS_DSS_3_COUNT_OUT_8814B \ -+ (BIT_MASK_DSS_3_COUNT_OUT_8814B << BIT_SHIFT_DSS_3_COUNT_OUT_8814B) -+#define BIT_CLEAR_DSS_3_COUNT_OUT_8814B(x) ((x) & (~BITS_DSS_3_COUNT_OUT_8814B)) -+#define BIT_GET_DSS_3_COUNT_OUT_8814B(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_COUNT_OUT_8814B) & \ -+ BIT_MASK_DSS_3_COUNT_OUT_8814B) -+#define BIT_SET_DSS_3_COUNT_OUT_8814B(x, v) \ -+ (BIT_CLEAR_DSS_3_COUNT_OUT_8814B(x) | BIT_DSS_3_COUNT_OUT_8814B(v)) -+ -+/* 2 REG_RXPKTBUF_1_MAX_ADDR_8814B */ -+ -+#define BIT_SHIFT_RXPKTBUF_SIZE_8814B 30 -+#define BIT_MASK_RXPKTBUF_SIZE_8814B 0x3 -+#define BIT_RXPKTBUF_SIZE_8814B(x) \ -+ (((x) & BIT_MASK_RXPKTBUF_SIZE_8814B) << BIT_SHIFT_RXPKTBUF_SIZE_8814B) -+#define BITS_RXPKTBUF_SIZE_8814B \ -+ (BIT_MASK_RXPKTBUF_SIZE_8814B << BIT_SHIFT_RXPKTBUF_SIZE_8814B) -+#define BIT_CLEAR_RXPKTBUF_SIZE_8814B(x) ((x) & (~BITS_RXPKTBUF_SIZE_8814B)) -+#define BIT_GET_RXPKTBUF_SIZE_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPKTBUF_SIZE_8814B) & BIT_MASK_RXPKTBUF_SIZE_8814B) -+#define BIT_SET_RXPKTBUF_SIZE_8814B(x, v) \ -+ (BIT_CLEAR_RXPKTBUF_SIZE_8814B(x) | BIT_RXPKTBUF_SIZE_8814B(v)) -+ -+#define BIT_RXPKTBUF_DBG_SEL_8814B BIT(29) -+ -+#define BIT_SHIFT_RXPKTBUF_1_MAX_ADDR_8814B 0 -+#define BIT_MASK_RXPKTBUF_1_MAX_ADDR_8814B 0x3ffff -+#define BIT_RXPKTBUF_1_MAX_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_RXPKTBUF_1_MAX_ADDR_8814B) \ -+ << BIT_SHIFT_RXPKTBUF_1_MAX_ADDR_8814B) -+#define BITS_RXPKTBUF_1_MAX_ADDR_8814B \ -+ (BIT_MASK_RXPKTBUF_1_MAX_ADDR_8814B \ -+ << BIT_SHIFT_RXPKTBUF_1_MAX_ADDR_8814B) -+#define BIT_CLEAR_RXPKTBUF_1_MAX_ADDR_8814B(x) \ -+ ((x) & (~BITS_RXPKTBUF_1_MAX_ADDR_8814B)) -+#define BIT_GET_RXPKTBUF_1_MAX_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPKTBUF_1_MAX_ADDR_8814B) & \ -+ BIT_MASK_RXPKTBUF_1_MAX_ADDR_8814B) -+#define BIT_SET_RXPKTBUF_1_MAX_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_RXPKTBUF_1_MAX_ADDR_8814B(x) | \ -+ BIT_RXPKTBUF_1_MAX_ADDR_8814B(v)) -+ -+/* 2 REG_RXFWBUF_1_MAX_ADDR_8814B */ -+ -+#define BIT_SHIFT_RXFWBUF_1_MAX_ADDR_8814B 0 -+#define BIT_MASK_RXFWBUF_1_MAX_ADDR_8814B 0xffff -+#define BIT_RXFWBUF_1_MAX_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_RXFWBUF_1_MAX_ADDR_8814B) \ -+ << BIT_SHIFT_RXFWBUF_1_MAX_ADDR_8814B) -+#define BITS_RXFWBUF_1_MAX_ADDR_8814B \ -+ (BIT_MASK_RXFWBUF_1_MAX_ADDR_8814B \ -+ << BIT_SHIFT_RXFWBUF_1_MAX_ADDR_8814B) -+#define BIT_CLEAR_RXFWBUF_1_MAX_ADDR_8814B(x) \ -+ ((x) & (~BITS_RXFWBUF_1_MAX_ADDR_8814B)) -+#define BIT_GET_RXFWBUF_1_MAX_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFWBUF_1_MAX_ADDR_8814B) & \ -+ BIT_MASK_RXFWBUF_1_MAX_ADDR_8814B) -+#define BIT_SET_RXFWBUF_1_MAX_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_RXFWBUF_1_MAX_ADDR_8814B(x) | \ -+ BIT_RXFWBUF_1_MAX_ADDR_8814B(v)) -+ -+/* 2 REG_IO_WRAP_ERR_FLAG_V1_8814B */ -+#define BIT_IO_WRAP_ERR_8814B BIT(0) -+ -+/* 2 REG_RXPKTBUF_1_READ_8814B */ -+ -+#define BIT_SHIFT_RXPKTBUF_1_READ_8814B 0 -+#define BIT_MASK_RXPKTBUF_1_READ_8814B 0x3ffff -+#define BIT_RXPKTBUF_1_READ_8814B(x) \ -+ (((x) & BIT_MASK_RXPKTBUF_1_READ_8814B) \ -+ << BIT_SHIFT_RXPKTBUF_1_READ_8814B) -+#define BITS_RXPKTBUF_1_READ_8814B \ -+ (BIT_MASK_RXPKTBUF_1_READ_8814B << BIT_SHIFT_RXPKTBUF_1_READ_8814B) -+#define BIT_CLEAR_RXPKTBUF_1_READ_8814B(x) ((x) & (~BITS_RXPKTBUF_1_READ_8814B)) -+#define BIT_GET_RXPKTBUF_1_READ_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPKTBUF_1_READ_8814B) & \ -+ BIT_MASK_RXPKTBUF_1_READ_8814B) -+#define BIT_SET_RXPKTBUF_1_READ_8814B(x, v) \ -+ (BIT_CLEAR_RXPKTBUF_1_READ_8814B(x) | BIT_RXPKTBUF_1_READ_8814B(v)) -+ -+/* 2 REG_RXPKTBUF_1_WRITE_8814B */ -+ -+#define BIT_SHIFT_RXPKTBUF_1_WRITE_8814B 0 -+#define BIT_MASK_RXPKTBUF_1_WRITE_8814B 0x3ffff -+#define BIT_RXPKTBUF_1_WRITE_8814B(x) \ -+ (((x) & BIT_MASK_RXPKTBUF_1_WRITE_8814B) \ -+ << BIT_SHIFT_RXPKTBUF_1_WRITE_8814B) -+#define BITS_RXPKTBUF_1_WRITE_8814B \ -+ (BIT_MASK_RXPKTBUF_1_WRITE_8814B << BIT_SHIFT_RXPKTBUF_1_WRITE_8814B) -+#define BIT_CLEAR_RXPKTBUF_1_WRITE_8814B(x) \ -+ ((x) & (~BITS_RXPKTBUF_1_WRITE_8814B)) -+#define BIT_GET_RXPKTBUF_1_WRITE_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPKTBUF_1_WRITE_8814B) & \ -+ BIT_MASK_RXPKTBUF_1_WRITE_8814B) -+#define BIT_SET_RXPKTBUF_1_WRITE_8814B(x, v) \ -+ (BIT_CLEAR_RXPKTBUF_1_WRITE_8814B(x) | BIT_RXPKTBUF_1_WRITE_8814B(v)) -+ -+/* 2 REG_BUFF_DBGUG_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_R_OQT_DBG_SEL_8814B 16 -+#define BIT_MASK_R_OQT_DBG_SEL_8814B 0xff -+#define BIT_R_OQT_DBG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_R_OQT_DBG_SEL_8814B) << BIT_SHIFT_R_OQT_DBG_SEL_8814B) -+#define BITS_R_OQT_DBG_SEL_8814B \ -+ (BIT_MASK_R_OQT_DBG_SEL_8814B << BIT_SHIFT_R_OQT_DBG_SEL_8814B) -+#define BIT_CLEAR_R_OQT_DBG_SEL_8814B(x) ((x) & (~BITS_R_OQT_DBG_SEL_8814B)) -+#define BIT_GET_R_OQT_DBG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_OQT_DBG_SEL_8814B) & BIT_MASK_R_OQT_DBG_SEL_8814B) -+#define BIT_SET_R_OQT_DBG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_R_OQT_DBG_SEL_8814B(x) | BIT_R_OQT_DBG_SEL_8814B(v)) -+ -+#define BIT_SHIFT_R_TXPKTBF_DBG_SEL_8814B 8 -+#define BIT_MASK_R_TXPKTBF_DBG_SEL_8814B 0x7 -+#define BIT_R_TXPKTBF_DBG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_R_TXPKTBF_DBG_SEL_8814B) \ -+ << BIT_SHIFT_R_TXPKTBF_DBG_SEL_8814B) -+#define BITS_R_TXPKTBF_DBG_SEL_8814B \ -+ (BIT_MASK_R_TXPKTBF_DBG_SEL_8814B << BIT_SHIFT_R_TXPKTBF_DBG_SEL_8814B) -+#define BIT_CLEAR_R_TXPKTBF_DBG_SEL_8814B(x) \ -+ ((x) & (~BITS_R_TXPKTBF_DBG_SEL_8814B)) -+#define BIT_GET_R_TXPKTBF_DBG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_TXPKTBF_DBG_SEL_8814B) & \ -+ BIT_MASK_R_TXPKTBF_DBG_SEL_8814B) -+#define BIT_SET_R_TXPKTBF_DBG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_R_TXPKTBF_DBG_SEL_8814B(x) | BIT_R_TXPKTBF_DBG_SEL_8814B(v)) -+ -+#define BIT_SHIFT_R_RXPKT_DBG_SEL_8814B 6 -+#define BIT_MASK_R_RXPKT_DBG_SEL_8814B 0x3 -+#define BIT_R_RXPKT_DBG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_R_RXPKT_DBG_SEL_8814B) \ -+ << BIT_SHIFT_R_RXPKT_DBG_SEL_8814B) -+#define BITS_R_RXPKT_DBG_SEL_8814B \ -+ (BIT_MASK_R_RXPKT_DBG_SEL_8814B << BIT_SHIFT_R_RXPKT_DBG_SEL_8814B) -+#define BIT_CLEAR_R_RXPKT_DBG_SEL_8814B(x) ((x) & (~BITS_R_RXPKT_DBG_SEL_8814B)) -+#define BIT_GET_R_RXPKT_DBG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_RXPKT_DBG_SEL_8814B) & \ -+ BIT_MASK_R_RXPKT_DBG_SEL_8814B) -+#define BIT_SET_R_RXPKT_DBG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_R_RXPKT_DBG_SEL_8814B(x) | BIT_R_RXPKT_DBG_SEL_8814B(v)) -+ -+#define BIT_SHIFT_R_RXPKTBF_DBG_SEL_8814B 0 -+#define BIT_MASK_R_RXPKTBF_DBG_SEL_8814B 0x3 -+#define BIT_R_RXPKTBF_DBG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_R_RXPKTBF_DBG_SEL_8814B) \ -+ << BIT_SHIFT_R_RXPKTBF_DBG_SEL_8814B) -+#define BITS_R_RXPKTBF_DBG_SEL_8814B \ -+ (BIT_MASK_R_RXPKTBF_DBG_SEL_8814B << BIT_SHIFT_R_RXPKTBF_DBG_SEL_8814B) -+#define BIT_CLEAR_R_RXPKTBF_DBG_SEL_8814B(x) \ -+ ((x) & (~BITS_R_RXPKTBF_DBG_SEL_8814B)) -+#define BIT_GET_R_RXPKTBF_DBG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_RXPKTBF_DBG_SEL_8814B) & \ -+ BIT_MASK_R_RXPKTBF_DBG_SEL_8814B) -+#define BIT_SET_R_RXPKTBF_DBG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_R_RXPKTBF_DBG_SEL_8814B(x) | BIT_R_RXPKTBF_DBG_SEL_8814B(v)) -+ -+/* 2 REG_RFE_CTRL_PAD_E2_8814B */ -+#define BIT_RFE_CTRL_ANTSW_E2_8814B BIT(16) -+#define BIT_RFE_CTRL_PIN15_E2_8814B BIT(15) -+#define BIT_RFE_CTRL_PIN14_E2_8814B BIT(14) -+#define BIT_RFE_CTRL_PIN13_E2_8814B BIT(13) -+#define BIT_RFE_CTRL_PIN12_E2_8814B BIT(12) -+#define BIT_RFE_CTRL_PIN11_E2_8814B BIT(11) -+#define BIT_RFE_CTRL_PIN10_E2_8814B BIT(10) -+#define BIT_RFE_CTRL_PIN9_E2_8814B BIT(9) -+#define BIT_RFE_CTRL_PIN8_E2_8814B BIT(8) -+#define BIT_RFE_CTRL_PIN7_E2_8814B BIT(7) -+#define BIT_RFE_CTRL_PIN6_E2_8814B BIT(6) -+#define BIT_RFE_CTRL_PIN5_E2_8814B BIT(5) -+#define BIT_RFE_CTRL_PIN4_E2_8814B BIT(4) -+#define BIT_RFE_CTRL_PIN3_E2_8814B BIT(3) -+#define BIT_RFE_CTRL_PIN2_E2_8814B BIT(2) -+#define BIT_RFE_CTRL_PIN1_E2_8814B BIT(1) -+#define BIT_RFE_CTRL_PIN0_E2_8814B BIT(0) -+ -+/* 2 REG_RFE_CTRL_PAD_SR_8814B */ -+#define BIT_RFE_CTRL_ANTSW_SR_8814B BIT(16) -+#define BIT_RFE_CTRL_PIN15_SR_8814B BIT(15) -+#define BIT_RFE_CTRL_PIN14_SR_8814B BIT(14) -+#define BIT_RFE_CTRL_PIN13_SR_8814B BIT(13) -+#define BIT_RFE_CTRL_PIN12_SR_8814B BIT(12) -+#define BIT_RFE_CTRL_PIN11_SR_8814B BIT(11) -+#define BIT_RFE_CTRL_PIN10_SR_8814B BIT(10) -+#define BIT_RFE_CTRL_PIN9_SR_8814B BIT(9) -+#define BIT_RFE_CTRL_PIN8_SR_8814B BIT(8) -+#define BIT_RFE_CTRL_PIN7_SR_8814B BIT(7) -+#define BIT_RFE_CTRL_PIN6_SR_8814B BIT(6) -+#define BIT_RFE_CTRL_PIN5_SR_8814B BIT(5) -+#define BIT_RFE_CTRL_PIN4_SR_8814B BIT(4) -+#define BIT_RFE_CTRL_PIN3_SR_8814B BIT(3) -+#define BIT_RFE_CTRL_PIN2_SR_8814B BIT(2) -+#define BIT_RFE_CTRL_PIN1_SR_8814B BIT(1) -+#define BIT_RFE_CTRL_PIN0_SR_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_H2C_PRIORITY_SEL_8814B */ -+ -+#define BIT_SHIFT_H2C_PRIORITY_SEL_8814B 0 -+#define BIT_MASK_H2C_PRIORITY_SEL_8814B 0x3 -+#define BIT_H2C_PRIORITY_SEL_8814B(x) \ -+ (((x) & BIT_MASK_H2C_PRIORITY_SEL_8814B) \ -+ << BIT_SHIFT_H2C_PRIORITY_SEL_8814B) -+#define BITS_H2C_PRIORITY_SEL_8814B \ -+ (BIT_MASK_H2C_PRIORITY_SEL_8814B << BIT_SHIFT_H2C_PRIORITY_SEL_8814B) -+#define BIT_CLEAR_H2C_PRIORITY_SEL_8814B(x) \ -+ ((x) & (~BITS_H2C_PRIORITY_SEL_8814B)) -+#define BIT_GET_H2C_PRIORITY_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2C_PRIORITY_SEL_8814B) & \ -+ BIT_MASK_H2C_PRIORITY_SEL_8814B) -+#define BIT_SET_H2C_PRIORITY_SEL_8814B(x, v) \ -+ (BIT_CLEAR_H2C_PRIORITY_SEL_8814B(x) | BIT_H2C_PRIORITY_SEL_8814B(v)) -+ -+/* 2 REG_COUNTER_CTRL_8814B */ -+ -+#define BIT_SHIFT_COUNTER_BASE_8814B 16 -+#define BIT_MASK_COUNTER_BASE_8814B 0x1fff -+#define BIT_COUNTER_BASE_8814B(x) \ -+ (((x) & BIT_MASK_COUNTER_BASE_8814B) << BIT_SHIFT_COUNTER_BASE_8814B) -+#define BITS_COUNTER_BASE_8814B \ -+ (BIT_MASK_COUNTER_BASE_8814B << BIT_SHIFT_COUNTER_BASE_8814B) -+#define BIT_CLEAR_COUNTER_BASE_8814B(x) ((x) & (~BITS_COUNTER_BASE_8814B)) -+#define BIT_GET_COUNTER_BASE_8814B(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_BASE_8814B) & BIT_MASK_COUNTER_BASE_8814B) -+#define BIT_SET_COUNTER_BASE_8814B(x, v) \ -+ (BIT_CLEAR_COUNTER_BASE_8814B(x) | BIT_COUNTER_BASE_8814B(v)) -+ -+#define BIT_EN_RTS_REQ_8814B BIT(9) -+#define BIT_EN_EDCA_REQ_8814B BIT(8) -+#define BIT_EN_PTCL_REQ_8814B BIT(7) -+#define BIT_EN_SCH_REQ_8814B BIT(6) -+#define BIT_USB_COUNT_EN_8814B BIT(5) -+#define BIT_PCIE_COUNT_EN_8814B BIT(4) -+#define BIT_RQPN_COUNT_EN_8814B BIT(3) -+#define BIT_RDE_COUNT_EN_8814B BIT(2) -+#define BIT_TDE_COUNT_EN_8814B BIT(1) -+#define BIT_DISABLE_COUNTER_8814B BIT(0) -+ -+/* 2 REG_COUNTER_THRESHOLD_8814B */ -+#define BIT_SEL_ALL_MACID_8814B BIT(31) -+ -+#define BIT_SHIFT_COUNTER_MACID_8814B 24 -+#define BIT_MASK_COUNTER_MACID_8814B 0x7f -+#define BIT_COUNTER_MACID_8814B(x) \ -+ (((x) & BIT_MASK_COUNTER_MACID_8814B) << BIT_SHIFT_COUNTER_MACID_8814B) -+#define BITS_COUNTER_MACID_8814B \ -+ (BIT_MASK_COUNTER_MACID_8814B << BIT_SHIFT_COUNTER_MACID_8814B) -+#define BIT_CLEAR_COUNTER_MACID_8814B(x) ((x) & (~BITS_COUNTER_MACID_8814B)) -+#define BIT_GET_COUNTER_MACID_8814B(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_MACID_8814B) & BIT_MASK_COUNTER_MACID_8814B) -+#define BIT_SET_COUNTER_MACID_8814B(x, v) \ -+ (BIT_CLEAR_COUNTER_MACID_8814B(x) | BIT_COUNTER_MACID_8814B(v)) -+ -+#define BIT_SHIFT_AGG_VALUE2_8814B 16 -+#define BIT_MASK_AGG_VALUE2_8814B 0x7f -+#define BIT_AGG_VALUE2_8814B(x) \ -+ (((x) & BIT_MASK_AGG_VALUE2_8814B) << BIT_SHIFT_AGG_VALUE2_8814B) -+#define BITS_AGG_VALUE2_8814B \ -+ (BIT_MASK_AGG_VALUE2_8814B << BIT_SHIFT_AGG_VALUE2_8814B) -+#define BIT_CLEAR_AGG_VALUE2_8814B(x) ((x) & (~BITS_AGG_VALUE2_8814B)) -+#define BIT_GET_AGG_VALUE2_8814B(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE2_8814B) & BIT_MASK_AGG_VALUE2_8814B) -+#define BIT_SET_AGG_VALUE2_8814B(x, v) \ -+ (BIT_CLEAR_AGG_VALUE2_8814B(x) | BIT_AGG_VALUE2_8814B(v)) -+ -+#define BIT_SHIFT_AGG_VALUE1_8814B 8 -+#define BIT_MASK_AGG_VALUE1_8814B 0x7f -+#define BIT_AGG_VALUE1_8814B(x) \ -+ (((x) & BIT_MASK_AGG_VALUE1_8814B) << BIT_SHIFT_AGG_VALUE1_8814B) -+#define BITS_AGG_VALUE1_8814B \ -+ (BIT_MASK_AGG_VALUE1_8814B << BIT_SHIFT_AGG_VALUE1_8814B) -+#define BIT_CLEAR_AGG_VALUE1_8814B(x) ((x) & (~BITS_AGG_VALUE1_8814B)) -+#define BIT_GET_AGG_VALUE1_8814B(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE1_8814B) & BIT_MASK_AGG_VALUE1_8814B) -+#define BIT_SET_AGG_VALUE1_8814B(x, v) \ -+ (BIT_CLEAR_AGG_VALUE1_8814B(x) | BIT_AGG_VALUE1_8814B(v)) -+ -+#define BIT_SHIFT_AGG_VALUE0_8814B 0 -+#define BIT_MASK_AGG_VALUE0_8814B 0x7f -+#define BIT_AGG_VALUE0_8814B(x) \ -+ (((x) & BIT_MASK_AGG_VALUE0_8814B) << BIT_SHIFT_AGG_VALUE0_8814B) -+#define BITS_AGG_VALUE0_8814B \ -+ (BIT_MASK_AGG_VALUE0_8814B << BIT_SHIFT_AGG_VALUE0_8814B) -+#define BIT_CLEAR_AGG_VALUE0_8814B(x) ((x) & (~BITS_AGG_VALUE0_8814B)) -+#define BIT_GET_AGG_VALUE0_8814B(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE0_8814B) & BIT_MASK_AGG_VALUE0_8814B) -+#define BIT_SET_AGG_VALUE0_8814B(x, v) \ -+ (BIT_CLEAR_AGG_VALUE0_8814B(x) | BIT_AGG_VALUE0_8814B(v)) -+ -+/* 2 REG_COUNTER_SET_8814B */ -+ -+#define BIT_SHIFT_REQUEST_RESET_8814B 16 -+#define BIT_MASK_REQUEST_RESET_8814B 0xffff -+#define BIT_REQUEST_RESET_8814B(x) \ -+ (((x) & BIT_MASK_REQUEST_RESET_8814B) << BIT_SHIFT_REQUEST_RESET_8814B) -+#define BITS_REQUEST_RESET_8814B \ -+ (BIT_MASK_REQUEST_RESET_8814B << BIT_SHIFT_REQUEST_RESET_8814B) -+#define BIT_CLEAR_REQUEST_RESET_8814B(x) ((x) & (~BITS_REQUEST_RESET_8814B)) -+#define BIT_GET_REQUEST_RESET_8814B(x) \ -+ (((x) >> BIT_SHIFT_REQUEST_RESET_8814B) & BIT_MASK_REQUEST_RESET_8814B) -+#define BIT_SET_REQUEST_RESET_8814B(x, v) \ -+ (BIT_CLEAR_REQUEST_RESET_8814B(x) | BIT_REQUEST_RESET_8814B(v)) -+ -+#define BIT_SHIFT_REQUEST_START_8814B 0 -+#define BIT_MASK_REQUEST_START_8814B 0xffff -+#define BIT_REQUEST_START_8814B(x) \ -+ (((x) & BIT_MASK_REQUEST_START_8814B) << BIT_SHIFT_REQUEST_START_8814B) -+#define BITS_REQUEST_START_8814B \ -+ (BIT_MASK_REQUEST_START_8814B << BIT_SHIFT_REQUEST_START_8814B) -+#define BIT_CLEAR_REQUEST_START_8814B(x) ((x) & (~BITS_REQUEST_START_8814B)) -+#define BIT_GET_REQUEST_START_8814B(x) \ -+ (((x) >> BIT_SHIFT_REQUEST_START_8814B) & BIT_MASK_REQUEST_START_8814B) -+#define BIT_SET_REQUEST_START_8814B(x, v) \ -+ (BIT_CLEAR_REQUEST_START_8814B(x) | BIT_REQUEST_START_8814B(v)) -+ -+/* 2 REG_COUNTER_OVERFLOW_8814B */ -+ -+#define BIT_SHIFT_CNT_OVF_REG_8814B 0 -+#define BIT_MASK_CNT_OVF_REG_8814B 0xffff -+#define BIT_CNT_OVF_REG_8814B(x) \ -+ (((x) & BIT_MASK_CNT_OVF_REG_8814B) << BIT_SHIFT_CNT_OVF_REG_8814B) -+#define BITS_CNT_OVF_REG_8814B \ -+ (BIT_MASK_CNT_OVF_REG_8814B << BIT_SHIFT_CNT_OVF_REG_8814B) -+#define BIT_CLEAR_CNT_OVF_REG_8814B(x) ((x) & (~BITS_CNT_OVF_REG_8814B)) -+#define BIT_GET_CNT_OVF_REG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CNT_OVF_REG_8814B) & BIT_MASK_CNT_OVF_REG_8814B) -+#define BIT_SET_CNT_OVF_REG_8814B(x, v) \ -+ (BIT_CLEAR_CNT_OVF_REG_8814B(x) | BIT_CNT_OVF_REG_8814B(v)) -+ -+/* 2 REG_TXDMA_LEN_THRESHOLD_8814B */ -+ -+#define BIT_SHIFT_TDE_LEN_TH1_8814B 16 -+#define BIT_MASK_TDE_LEN_TH1_8814B 0xffff -+#define BIT_TDE_LEN_TH1_8814B(x) \ -+ (((x) & BIT_MASK_TDE_LEN_TH1_8814B) << BIT_SHIFT_TDE_LEN_TH1_8814B) -+#define BITS_TDE_LEN_TH1_8814B \ -+ (BIT_MASK_TDE_LEN_TH1_8814B << BIT_SHIFT_TDE_LEN_TH1_8814B) -+#define BIT_CLEAR_TDE_LEN_TH1_8814B(x) ((x) & (~BITS_TDE_LEN_TH1_8814B)) -+#define BIT_GET_TDE_LEN_TH1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TDE_LEN_TH1_8814B) & BIT_MASK_TDE_LEN_TH1_8814B) -+#define BIT_SET_TDE_LEN_TH1_8814B(x, v) \ -+ (BIT_CLEAR_TDE_LEN_TH1_8814B(x) | BIT_TDE_LEN_TH1_8814B(v)) -+ -+#define BIT_SHIFT_TDE_LEN_TH0_8814B 0 -+#define BIT_MASK_TDE_LEN_TH0_8814B 0xffff -+#define BIT_TDE_LEN_TH0_8814B(x) \ -+ (((x) & BIT_MASK_TDE_LEN_TH0_8814B) << BIT_SHIFT_TDE_LEN_TH0_8814B) -+#define BITS_TDE_LEN_TH0_8814B \ -+ (BIT_MASK_TDE_LEN_TH0_8814B << BIT_SHIFT_TDE_LEN_TH0_8814B) -+#define BIT_CLEAR_TDE_LEN_TH0_8814B(x) ((x) & (~BITS_TDE_LEN_TH0_8814B)) -+#define BIT_GET_TDE_LEN_TH0_8814B(x) \ -+ (((x) >> BIT_SHIFT_TDE_LEN_TH0_8814B) & BIT_MASK_TDE_LEN_TH0_8814B) -+#define BIT_SET_TDE_LEN_TH0_8814B(x, v) \ -+ (BIT_CLEAR_TDE_LEN_TH0_8814B(x) | BIT_TDE_LEN_TH0_8814B(v)) -+ -+/* 2 REG_RXDMA_LEN_THRESHOLD_8814B */ -+ -+#define BIT_SHIFT_RDE_LEN_TH1_8814B 16 -+#define BIT_MASK_RDE_LEN_TH1_8814B 0xffff -+#define BIT_RDE_LEN_TH1_8814B(x) \ -+ (((x) & BIT_MASK_RDE_LEN_TH1_8814B) << BIT_SHIFT_RDE_LEN_TH1_8814B) -+#define BITS_RDE_LEN_TH1_8814B \ -+ (BIT_MASK_RDE_LEN_TH1_8814B << BIT_SHIFT_RDE_LEN_TH1_8814B) -+#define BIT_CLEAR_RDE_LEN_TH1_8814B(x) ((x) & (~BITS_RDE_LEN_TH1_8814B)) -+#define BIT_GET_RDE_LEN_TH1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RDE_LEN_TH1_8814B) & BIT_MASK_RDE_LEN_TH1_8814B) -+#define BIT_SET_RDE_LEN_TH1_8814B(x, v) \ -+ (BIT_CLEAR_RDE_LEN_TH1_8814B(x) | BIT_RDE_LEN_TH1_8814B(v)) -+ -+#define BIT_SHIFT_RDE_LEN_TH0_8814B 0 -+#define BIT_MASK_RDE_LEN_TH0_8814B 0xffff -+#define BIT_RDE_LEN_TH0_8814B(x) \ -+ (((x) & BIT_MASK_RDE_LEN_TH0_8814B) << BIT_SHIFT_RDE_LEN_TH0_8814B) -+#define BITS_RDE_LEN_TH0_8814B \ -+ (BIT_MASK_RDE_LEN_TH0_8814B << BIT_SHIFT_RDE_LEN_TH0_8814B) -+#define BIT_CLEAR_RDE_LEN_TH0_8814B(x) ((x) & (~BITS_RDE_LEN_TH0_8814B)) -+#define BIT_GET_RDE_LEN_TH0_8814B(x) \ -+ (((x) >> BIT_SHIFT_RDE_LEN_TH0_8814B) & BIT_MASK_RDE_LEN_TH0_8814B) -+#define BIT_SET_RDE_LEN_TH0_8814B(x, v) \ -+ (BIT_CLEAR_RDE_LEN_TH0_8814B(x) | BIT_RDE_LEN_TH0_8814B(v)) -+ -+/* 2 REG_PCIE_EXEC_TIME_THRESHOLD_8814B */ -+ -+#define BIT_SHIFT_COUNT_INT_SEL_8814B 16 -+#define BIT_MASK_COUNT_INT_SEL_8814B 0x3 -+#define BIT_COUNT_INT_SEL_8814B(x) \ -+ (((x) & BIT_MASK_COUNT_INT_SEL_8814B) << BIT_SHIFT_COUNT_INT_SEL_8814B) -+#define BITS_COUNT_INT_SEL_8814B \ -+ (BIT_MASK_COUNT_INT_SEL_8814B << BIT_SHIFT_COUNT_INT_SEL_8814B) -+#define BIT_CLEAR_COUNT_INT_SEL_8814B(x) ((x) & (~BITS_COUNT_INT_SEL_8814B)) -+#define BIT_GET_COUNT_INT_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_COUNT_INT_SEL_8814B) & BIT_MASK_COUNT_INT_SEL_8814B) -+#define BIT_SET_COUNT_INT_SEL_8814B(x, v) \ -+ (BIT_CLEAR_COUNT_INT_SEL_8814B(x) | BIT_COUNT_INT_SEL_8814B(v)) -+ -+#define BIT_SHIFT_EXEC_TIME_TH_8814B 0 -+#define BIT_MASK_EXEC_TIME_TH_8814B 0xffff -+#define BIT_EXEC_TIME_TH_8814B(x) \ -+ (((x) & BIT_MASK_EXEC_TIME_TH_8814B) << BIT_SHIFT_EXEC_TIME_TH_8814B) -+#define BITS_EXEC_TIME_TH_8814B \ -+ (BIT_MASK_EXEC_TIME_TH_8814B << BIT_SHIFT_EXEC_TIME_TH_8814B) -+#define BIT_CLEAR_EXEC_TIME_TH_8814B(x) ((x) & (~BITS_EXEC_TIME_TH_8814B)) -+#define BIT_GET_EXEC_TIME_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_EXEC_TIME_TH_8814B) & BIT_MASK_EXEC_TIME_TH_8814B) -+#define BIT_SET_EXEC_TIME_TH_8814B(x, v) \ -+ (BIT_CLEAR_EXEC_TIME_TH_8814B(x) | BIT_EXEC_TIME_TH_8814B(v)) -+ -+/* 2 REG_FT2IMR_8814B */ -+#define BIT_FS_CLI3_RX_UAPSDMD1_EN_8814B BIT(31) -+#define BIT_FS_CLI3_RX_UAPSDMD0_EN_8814B BIT(30) -+#define BIT_FS_CLI3_TRIGGER_PKT_EN_8814B BIT(29) -+#define BIT_FS_CLI3_EOSP_INT_EN_8814B BIT(28) -+#define BIT_FS_CLI2_RX_UAPSDMD1_EN_8814B BIT(27) -+#define BIT_FS_CLI2_RX_UAPSDMD0_EN_8814B BIT(26) -+#define BIT_FS_CLI2_TRIGGER_PKT_EN_8814B BIT(25) -+#define BIT_FS_CLI2_EOSP_INT_EN_8814B BIT(24) -+#define BIT_FS_CLI1_RX_UAPSDMD1_EN_8814B BIT(23) -+#define BIT_FS_CLI1_RX_UAPSDMD0_EN_8814B BIT(22) -+#define BIT_FS_CLI1_TRIGGER_PKT_EN_8814B BIT(21) -+#define BIT_FS_CLI1_EOSP_INT_EN_8814B BIT(20) -+#define BIT_FS_CLI0_RX_UAPSDMD1_EN_8814B BIT(19) -+#define BIT_FS_CLI0_RX_UAPSDMD0_EN_8814B BIT(18) -+#define BIT_FS_CLI0_TRIGGER_PKT_EN_8814B BIT(17) -+#define BIT_FS_CLI0_EOSP_INT_EN_8814B BIT(16) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_EN_8814B BIT(9) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_EN_8814B BIT(8) -+#define BIT_FS_CLI3_TX_NULL1_INT_EN_8814B BIT(7) -+#define BIT_FS_CLI3_TX_NULL0_INT_EN_8814B BIT(6) -+#define BIT_FS_CLI2_TX_NULL1_INT_EN_8814B BIT(5) -+#define BIT_FS_CLI2_TX_NULL0_INT_EN_8814B BIT(4) -+#define BIT_FS_CLI1_TX_NULL1_INT_EN_8814B BIT(3) -+#define BIT_FS_CLI1_TX_NULL0_INT_EN_8814B BIT(2) -+#define BIT_FS_CLI0_TX_NULL1_INT_EN_8814B BIT(1) -+#define BIT_FS_CLI0_TX_NULL0_INT_EN_8814B BIT(0) -+ -+/* 2 REG_FT2ISR_8814B */ -+#define BIT_FS_CLI3_RX_UAPSDMD1_INT_8814B BIT(31) -+#define BIT_FS_CLI3_RX_UAPSDMD0_INT_8814B BIT(30) -+#define BIT_FS_CLI3_TRIGGER_PKT_INT_8814B BIT(29) -+#define BIT_FS_CLI3_EOSP_INT_8814B BIT(28) -+#define BIT_FS_CLI2_RX_UAPSDMD1_INT_8814B BIT(27) -+#define BIT_FS_CLI2_RX_UAPSDMD0_INT_8814B BIT(26) -+#define BIT_FS_CLI2_TRIGGER_PKT_INT_8814B BIT(25) -+#define BIT_FS_CLI2_EOSP_INT_8814B BIT(24) -+#define BIT_FS_CLI1_RX_UAPSDMD1_INT_8814B BIT(23) -+#define BIT_FS_CLI1_RX_UAPSDMD0_INT_8814B BIT(22) -+#define BIT_FS_CLI1_TRIGGER_PKT_INT_8814B BIT(21) -+#define BIT_FS_CLI1_EOSP_INT_8814B BIT(20) -+#define BIT_FS_CLI0_RX_UAPSDMD1_INT_8814B BIT(19) -+#define BIT_FS_CLI0_RX_UAPSDMD0_INT_8814B BIT(18) -+#define BIT_FS_CLI0_TRIGGER_PKT_INT_8814B BIT(17) -+#define BIT_FS_CLI0_EOSP_INT_8814B BIT(16) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_INT_8814B BIT(9) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_INT_8814B BIT(8) -+#define BIT_FS_CLI3_TX_NULL1_INT_8814B BIT(7) -+#define BIT_FS_CLI3_TX_NULL0_INT_8814B BIT(6) -+#define BIT_FS_CLI2_TX_NULL1_INT_8814B BIT(5) -+#define BIT_FS_CLI2_TX_NULL0_INT_8814B BIT(4) -+#define BIT_FS_CLI1_TX_NULL1_INT_8814B BIT(3) -+#define BIT_FS_CLI1_TX_NULL0_INT_8814B BIT(2) -+#define BIT_FS_CLI0_TX_NULL1_INT_8814B BIT(1) -+#define BIT_FS_CLI0_TX_NULL0_INT_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_MSG2_8814B */ -+ -+#define BIT_SHIFT_FW_MSG2_8814B 0 -+#define BIT_MASK_FW_MSG2_8814B 0xffffffffL -+#define BIT_FW_MSG2_8814B(x) \ -+ (((x) & BIT_MASK_FW_MSG2_8814B) << BIT_SHIFT_FW_MSG2_8814B) -+#define BITS_FW_MSG2_8814B (BIT_MASK_FW_MSG2_8814B << BIT_SHIFT_FW_MSG2_8814B) -+#define BIT_CLEAR_FW_MSG2_8814B(x) ((x) & (~BITS_FW_MSG2_8814B)) -+#define BIT_GET_FW_MSG2_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG2_8814B) & BIT_MASK_FW_MSG2_8814B) -+#define BIT_SET_FW_MSG2_8814B(x, v) \ -+ (BIT_CLEAR_FW_MSG2_8814B(x) | BIT_FW_MSG2_8814B(v)) -+ -+/* 2 REG_MSG3_8814B */ -+ -+#define BIT_SHIFT_FW_MSG3_8814B 0 -+#define BIT_MASK_FW_MSG3_8814B 0xffffffffL -+#define BIT_FW_MSG3_8814B(x) \ -+ (((x) & BIT_MASK_FW_MSG3_8814B) << BIT_SHIFT_FW_MSG3_8814B) -+#define BITS_FW_MSG3_8814B (BIT_MASK_FW_MSG3_8814B << BIT_SHIFT_FW_MSG3_8814B) -+#define BIT_CLEAR_FW_MSG3_8814B(x) ((x) & (~BITS_FW_MSG3_8814B)) -+#define BIT_GET_FW_MSG3_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG3_8814B) & BIT_MASK_FW_MSG3_8814B) -+#define BIT_SET_FW_MSG3_8814B(x, v) \ -+ (BIT_CLEAR_FW_MSG3_8814B(x) | BIT_FW_MSG3_8814B(v)) -+ -+/* 2 REG_MSG4_8814B */ -+ -+#define BIT_SHIFT_FW_MSG4_8814B 0 -+#define BIT_MASK_FW_MSG4_8814B 0xffffffffL -+#define BIT_FW_MSG4_8814B(x) \ -+ (((x) & BIT_MASK_FW_MSG4_8814B) << BIT_SHIFT_FW_MSG4_8814B) -+#define BITS_FW_MSG4_8814B (BIT_MASK_FW_MSG4_8814B << BIT_SHIFT_FW_MSG4_8814B) -+#define BIT_CLEAR_FW_MSG4_8814B(x) ((x) & (~BITS_FW_MSG4_8814B)) -+#define BIT_GET_FW_MSG4_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG4_8814B) & BIT_MASK_FW_MSG4_8814B) -+#define BIT_SET_FW_MSG4_8814B(x, v) \ -+ (BIT_CLEAR_FW_MSG4_8814B(x) | BIT_FW_MSG4_8814B(v)) -+ -+/* 2 REG_MSG5_8814B */ -+ -+#define BIT_SHIFT_FW_MSG5_8814B 0 -+#define BIT_MASK_FW_MSG5_8814B 0xffffffffL -+#define BIT_FW_MSG5_8814B(x) \ -+ (((x) & BIT_MASK_FW_MSG5_8814B) << BIT_SHIFT_FW_MSG5_8814B) -+#define BITS_FW_MSG5_8814B (BIT_MASK_FW_MSG5_8814B << BIT_SHIFT_FW_MSG5_8814B) -+#define BIT_CLEAR_FW_MSG5_8814B(x) ((x) & (~BITS_FW_MSG5_8814B)) -+#define BIT_GET_FW_MSG5_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG5_8814B) & BIT_MASK_FW_MSG5_8814B) -+#define BIT_SET_FW_MSG5_8814B(x, v) \ -+ (BIT_CLEAR_FW_MSG5_8814B(x) | BIT_FW_MSG5_8814B(v)) -+ -+/* 2 REG_BIST_RSTN0_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BIST_RSTN2_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BIST_MODE_NRML0_8814B */ -+ -+/* 2 REG_BIST_MODE_NRML1_8814B */ -+ -+/* 2 REG_BIST_MODE_NRML2_8814B */ -+ -+/* 2 REG_BIST_MODE_NRML3_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BIST_DONE_NRML_MAC_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BIST_DONE_NRML1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BIST_DONE_DRF_MAC_8814B */ -+ -+/* 2 REG_BIST_DONE_DRF_8814B */ -+ -+/* 2 REG_BIST_DONE_DRF1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BIST_FAIL_NRML_MAC_8814B */ -+ -+/* 2 REG_BIST_FAIL_NRML_8814B */ -+ -+/* 2 REG_BIST_FAIL_NRML1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BIST_FAIL_NRML_MAC_V1_8814B */ -+ -+/* 2 REG_BIST_FAIL_NRML_V1_8814B */ -+ -+/* 2 REG_BIST_FAIL_NRML1_V1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BIST_MISR_DATAOUT_8814B */ -+ -+/* 2 REG_BIST_MISR_DATAOUT1_8814B */ -+ -+/* 2 REG_BIST_MISR_DATAOUT_CPU_8814B */ -+ -+/* 2 REG_BIST_MISR_DATAOUT_CPU1_8814B */ -+ -+/* 2 REG_BIST_MISR_DATAOUT_CPU2_8814B */ -+ -+/* 2 REG_BIST_MISR_DATOUT_CPU3_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BCN_CTRL_0_8814B */ -+#define BIT_BCN1_VALID_8814B BIT(31) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_BCN1_HEAD_8814B 16 -+#define BIT_MASK_BCN1_HEAD_8814B 0xfff -+#define BIT_BCN1_HEAD_8814B(x) \ -+ (((x) & BIT_MASK_BCN1_HEAD_8814B) << BIT_SHIFT_BCN1_HEAD_8814B) -+#define BITS_BCN1_HEAD_8814B \ -+ (BIT_MASK_BCN1_HEAD_8814B << BIT_SHIFT_BCN1_HEAD_8814B) -+#define BIT_CLEAR_BCN1_HEAD_8814B(x) ((x) & (~BITS_BCN1_HEAD_8814B)) -+#define BIT_GET_BCN1_HEAD_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN1_HEAD_8814B) & BIT_MASK_BCN1_HEAD_8814B) -+#define BIT_SET_BCN1_HEAD_8814B(x, v) \ -+ (BIT_CLEAR_BCN1_HEAD_8814B(x) | BIT_BCN1_HEAD_8814B(v)) -+ -+#define BIT_BCN0_VALID_8814B BIT(15) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_BCN0_HEAD_8814B 0 -+#define BIT_MASK_BCN0_HEAD_8814B 0xfff -+#define BIT_BCN0_HEAD_8814B(x) \ -+ (((x) & BIT_MASK_BCN0_HEAD_8814B) << BIT_SHIFT_BCN0_HEAD_8814B) -+#define BITS_BCN0_HEAD_8814B \ -+ (BIT_MASK_BCN0_HEAD_8814B << BIT_SHIFT_BCN0_HEAD_8814B) -+#define BIT_CLEAR_BCN0_HEAD_8814B(x) ((x) & (~BITS_BCN0_HEAD_8814B)) -+#define BIT_GET_BCN0_HEAD_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN0_HEAD_8814B) & BIT_MASK_BCN0_HEAD_8814B) -+#define BIT_SET_BCN0_HEAD_8814B(x, v) \ -+ (BIT_CLEAR_BCN0_HEAD_8814B(x) | BIT_BCN0_HEAD_8814B(v)) -+ -+/* 2 REG_BCN_CTRL_1_8814B */ -+#define BIT_BCN3_VALID_8814B BIT(31) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_BCN3_HEAD_8814B 16 -+#define BIT_MASK_BCN3_HEAD_8814B 0xfff -+#define BIT_BCN3_HEAD_8814B(x) \ -+ (((x) & BIT_MASK_BCN3_HEAD_8814B) << BIT_SHIFT_BCN3_HEAD_8814B) -+#define BITS_BCN3_HEAD_8814B \ -+ (BIT_MASK_BCN3_HEAD_8814B << BIT_SHIFT_BCN3_HEAD_8814B) -+#define BIT_CLEAR_BCN3_HEAD_8814B(x) ((x) & (~BITS_BCN3_HEAD_8814B)) -+#define BIT_GET_BCN3_HEAD_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN3_HEAD_8814B) & BIT_MASK_BCN3_HEAD_8814B) -+#define BIT_SET_BCN3_HEAD_8814B(x, v) \ -+ (BIT_CLEAR_BCN3_HEAD_8814B(x) | BIT_BCN3_HEAD_8814B(v)) -+ -+#define BIT_BCN2_VALID_8814B BIT(15) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_BCN2_HEAD_8814B 0 -+#define BIT_MASK_BCN2_HEAD_8814B 0xfff -+#define BIT_BCN2_HEAD_8814B(x) \ -+ (((x) & BIT_MASK_BCN2_HEAD_8814B) << BIT_SHIFT_BCN2_HEAD_8814B) -+#define BITS_BCN2_HEAD_8814B \ -+ (BIT_MASK_BCN2_HEAD_8814B << BIT_SHIFT_BCN2_HEAD_8814B) -+#define BIT_CLEAR_BCN2_HEAD_8814B(x) ((x) & (~BITS_BCN2_HEAD_8814B)) -+#define BIT_GET_BCN2_HEAD_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN2_HEAD_8814B) & BIT_MASK_BCN2_HEAD_8814B) -+#define BIT_SET_BCN2_HEAD_8814B(x, v) \ -+ (BIT_CLEAR_BCN2_HEAD_8814B(x) | BIT_BCN2_HEAD_8814B(v)) -+ -+/* 2 REG_AUTO_LLT_V1_8814B */ -+ -+#define BIT_SHIFT_MAX_TX_PKT_V1_8814B 24 -+#define BIT_MASK_MAX_TX_PKT_V1_8814B 0xff -+#define BIT_MAX_TX_PKT_V1_8814B(x) \ -+ (((x) & BIT_MASK_MAX_TX_PKT_V1_8814B) << BIT_SHIFT_MAX_TX_PKT_V1_8814B) -+#define BITS_MAX_TX_PKT_V1_8814B \ -+ (BIT_MASK_MAX_TX_PKT_V1_8814B << BIT_SHIFT_MAX_TX_PKT_V1_8814B) -+#define BIT_CLEAR_MAX_TX_PKT_V1_8814B(x) ((x) & (~BITS_MAX_TX_PKT_V1_8814B)) -+#define BIT_GET_MAX_TX_PKT_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAX_TX_PKT_V1_8814B) & BIT_MASK_MAX_TX_PKT_V1_8814B) -+#define BIT_SET_MAX_TX_PKT_V1_8814B(x, v) \ -+ (BIT_CLEAR_MAX_TX_PKT_V1_8814B(x) | BIT_MAX_TX_PKT_V1_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_R_BCN_HEAD_SEL_V1_8814B 20 -+#define BIT_MASK_R_BCN_HEAD_SEL_V1_8814B 0x7 -+#define BIT_R_BCN_HEAD_SEL_V1_8814B(x) \ -+ (((x) & BIT_MASK_R_BCN_HEAD_SEL_V1_8814B) \ -+ << BIT_SHIFT_R_BCN_HEAD_SEL_V1_8814B) -+#define BITS_R_BCN_HEAD_SEL_V1_8814B \ -+ (BIT_MASK_R_BCN_HEAD_SEL_V1_8814B << BIT_SHIFT_R_BCN_HEAD_SEL_V1_8814B) -+#define BIT_CLEAR_R_BCN_HEAD_SEL_V1_8814B(x) \ -+ ((x) & (~BITS_R_BCN_HEAD_SEL_V1_8814B)) -+#define BIT_GET_R_BCN_HEAD_SEL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_BCN_HEAD_SEL_V1_8814B) & \ -+ BIT_MASK_R_BCN_HEAD_SEL_V1_8814B) -+#define BIT_SET_R_BCN_HEAD_SEL_V1_8814B(x, v) \ -+ (BIT_CLEAR_R_BCN_HEAD_SEL_V1_8814B(x) | BIT_R_BCN_HEAD_SEL_V1_8814B(v)) -+ -+#define BIT_SHIFT_LLT_FREE_PAGE_V2_8814B 8 -+#define BIT_MASK_LLT_FREE_PAGE_V2_8814B 0xfff -+#define BIT_LLT_FREE_PAGE_V2_8814B(x) \ -+ (((x) & BIT_MASK_LLT_FREE_PAGE_V2_8814B) \ -+ << BIT_SHIFT_LLT_FREE_PAGE_V2_8814B) -+#define BITS_LLT_FREE_PAGE_V2_8814B \ -+ (BIT_MASK_LLT_FREE_PAGE_V2_8814B << BIT_SHIFT_LLT_FREE_PAGE_V2_8814B) -+#define BIT_CLEAR_LLT_FREE_PAGE_V2_8814B(x) \ -+ ((x) & (~BITS_LLT_FREE_PAGE_V2_8814B)) -+#define BIT_GET_LLT_FREE_PAGE_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_LLT_FREE_PAGE_V2_8814B) & \ -+ BIT_MASK_LLT_FREE_PAGE_V2_8814B) -+#define BIT_SET_LLT_FREE_PAGE_V2_8814B(x, v) \ -+ (BIT_CLEAR_LLT_FREE_PAGE_V2_8814B(x) | BIT_LLT_FREE_PAGE_V2_8814B(v)) -+ -+#define BIT_SHIFT_BLK_DESC_NUM_8814B 4 -+#define BIT_MASK_BLK_DESC_NUM_8814B 0xf -+#define BIT_BLK_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_BLK_DESC_NUM_8814B) << BIT_SHIFT_BLK_DESC_NUM_8814B) -+#define BITS_BLK_DESC_NUM_8814B \ -+ (BIT_MASK_BLK_DESC_NUM_8814B << BIT_SHIFT_BLK_DESC_NUM_8814B) -+#define BIT_CLEAR_BLK_DESC_NUM_8814B(x) ((x) & (~BITS_BLK_DESC_NUM_8814B)) -+#define BIT_GET_BLK_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_BLK_DESC_NUM_8814B) & BIT_MASK_BLK_DESC_NUM_8814B) -+#define BIT_SET_BLK_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_BLK_DESC_NUM_8814B(x) | BIT_BLK_DESC_NUM_8814B(v)) -+ -+#define BIT_TDE_ERROR_STOP_8814B BIT(3) -+#define BIT_R_EN_BCN_SW_HEAD_SEL_8814B BIT(2) -+#define BIT_LLT_DBG_SEL_8814B BIT(1) -+#define BIT_AUTO_INIT_LLT_V1_8814B BIT(0) -+ -+/* 2 REG_TXDMA_OFFSET_CHK_8814B */ -+#define BIT_EM_CHKSUM_FIN_8814B BIT(31) -+#define BIT_EMN_PCIE_DMA_MOD_8814B BIT(30) -+#define BIT_EN_TXQUE_CLR_8814B BIT(29) -+#define BIT_EN_PCIE_FIFO_MODE_8814B BIT(28) -+ -+#define BIT_SHIFT_PG_UNDER_TH_V1_8814B 16 -+#define BIT_MASK_PG_UNDER_TH_V1_8814B 0xfff -+#define BIT_PG_UNDER_TH_V1_8814B(x) \ -+ (((x) & BIT_MASK_PG_UNDER_TH_V1_8814B) \ -+ << BIT_SHIFT_PG_UNDER_TH_V1_8814B) -+#define BITS_PG_UNDER_TH_V1_8814B \ -+ (BIT_MASK_PG_UNDER_TH_V1_8814B << BIT_SHIFT_PG_UNDER_TH_V1_8814B) -+#define BIT_CLEAR_PG_UNDER_TH_V1_8814B(x) ((x) & (~BITS_PG_UNDER_TH_V1_8814B)) -+#define BIT_GET_PG_UNDER_TH_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_PG_UNDER_TH_V1_8814B) & \ -+ BIT_MASK_PG_UNDER_TH_V1_8814B) -+#define BIT_SET_PG_UNDER_TH_V1_8814B(x, v) \ -+ (BIT_CLEAR_PG_UNDER_TH_V1_8814B(x) | BIT_PG_UNDER_TH_V1_8814B(v)) -+ -+#define BIT_R_EN_RESET_RESTORE_H2C_8814B BIT(15) -+#define BIT_SDIO_TDE_FINISH_8814B BIT(14) -+#define BIT_SDIO_TXDESC_CHKSUM_EN_8814B BIT(13) -+#define BIT_RST_RDPTR_8814B BIT(12) -+#define BIT_RST_WRPTR_8814B BIT(11) -+#define BIT_CHK_PG_TH_EN_8814B BIT(10) -+#define BIT_DROP_DATA_EN_8814B BIT(9) -+#define BIT_CHECK_OFFSET_EN_8814B BIT(8) -+ -+#define BIT_SHIFT_CHECK_OFFSET_8814B 0 -+#define BIT_MASK_CHECK_OFFSET_8814B 0xff -+#define BIT_CHECK_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_CHECK_OFFSET_8814B) << BIT_SHIFT_CHECK_OFFSET_8814B) -+#define BITS_CHECK_OFFSET_8814B \ -+ (BIT_MASK_CHECK_OFFSET_8814B << BIT_SHIFT_CHECK_OFFSET_8814B) -+#define BIT_CLEAR_CHECK_OFFSET_8814B(x) ((x) & (~BITS_CHECK_OFFSET_8814B)) -+#define BIT_GET_CHECK_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_CHECK_OFFSET_8814B) & BIT_MASK_CHECK_OFFSET_8814B) -+#define BIT_SET_CHECK_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_CHECK_OFFSET_8814B(x) | BIT_CHECK_OFFSET_8814B(v)) -+ -+/* 2 REG_TXDMA_STATUS_8814B */ -+#define BIT_AMSDU_PKT_SIZE_ERR_8814B BIT(31) -+#define BIT_AMSDU_EN_ERR_8814B BIT(30) -+#define BIT_CHKSUM_AMSDU_EN_ERR_8814B BIT(29) -+#define BIT_TXPKTBF_REQ_ERR_8814B BIT(28) -+#define BIT_OQT_UDN_16_8814B BIT(27) -+#define BIT_OQT_OVF_16_8814B BIT(26) -+#define BIT_OQT_UDN_14_15_8814B BIT(25) -+#define BIT_OQT_OVF_14_15_8814B BIT(24) -+#define BIT_OQT_UDN_13_8814B BIT(23) -+#define BIT_OQT_OVF_13_8814B BIT(22) -+#define BIT_OQT_UDN_12_8814B BIT(21) -+#define BIT_OQT_OVF_12_8814B BIT(20) -+#define BIT_OQT_UDN_8_11_8814B BIT(19) -+#define BIT_OQT_OVF_8_11_8814B BIT(18) -+#define BIT_OQT_UDN_4_7_8814B BIT(17) -+#define BIT_OQT_OVF_4_7_8814B BIT(16) -+#define BIT_PAYLOAD_CHKSUM_ERR_8814B BIT(15) -+#define BIT_PAYLOAD_UDN_8814B BIT(14) -+#define BIT_PAYLOAD_OVF_8814B BIT(13) -+#define BIT_DSC_CHKSUM_FAIL_8814B BIT(12) -+#define BIT_EP_QSEL_DIFF_8814B BIT(10) -+#define BIT_TX_OFFS_UNMATCH_8814B BIT(9) -+#define BIT_TXOQT_UDN_0_3_8814B BIT(8) -+#define BIT_TXOQT_OVF_0_3_8814B BIT(7) -+#define BIT_TXDMA_SFF_UDN_8814B BIT(6) -+#define BIT_TXDMA_SFF_OVF_8814B BIT(5) -+#define BIT_LLT_NULL_PG_8814B BIT(4) -+#define BIT_PAGE_UDN_8814B BIT(3) -+#define BIT_PAGE_OVF_8814B BIT(2) -+#define BIT_TXFF_PG_UDN_8814B BIT(1) -+#define BIT_TXFF_PG_OVF_8814B BIT(0) -+ -+/* 2 REG_TX_DMA_DBG_8814B */ -+ -+/* 2 REG_DMA_RQPN_INFO_PUB_8814B */ -+ -+#define BIT_SHIFT_PUB_AVAL_PG_8814B 16 -+#define BIT_MASK_PUB_AVAL_PG_8814B 0xfff -+#define BIT_PUB_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_PUB_AVAL_PG_8814B) << BIT_SHIFT_PUB_AVAL_PG_8814B) -+#define BITS_PUB_AVAL_PG_8814B \ -+ (BIT_MASK_PUB_AVAL_PG_8814B << BIT_SHIFT_PUB_AVAL_PG_8814B) -+#define BIT_CLEAR_PUB_AVAL_PG_8814B(x) ((x) & (~BITS_PUB_AVAL_PG_8814B)) -+#define BIT_GET_PUB_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_PUB_AVAL_PG_8814B) & BIT_MASK_PUB_AVAL_PG_8814B) -+#define BIT_SET_PUB_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_PUB_AVAL_PG_8814B(x) | BIT_PUB_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_PUB_RSVD_PG_8814B 0 -+#define BIT_MASK_PUB_RSVD_PG_8814B 0xfff -+#define BIT_PUB_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_PUB_RSVD_PG_8814B) << BIT_SHIFT_PUB_RSVD_PG_8814B) -+#define BITS_PUB_RSVD_PG_8814B \ -+ (BIT_MASK_PUB_RSVD_PG_8814B << BIT_SHIFT_PUB_RSVD_PG_8814B) -+#define BIT_CLEAR_PUB_RSVD_PG_8814B(x) ((x) & (~BITS_PUB_RSVD_PG_8814B)) -+#define BIT_GET_PUB_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_PUB_RSVD_PG_8814B) & BIT_MASK_PUB_RSVD_PG_8814B) -+#define BIT_SET_PUB_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_PUB_RSVD_PG_8814B(x) | BIT_PUB_RSVD_PG_8814B(v)) -+ -+/* 2 REG_RQPN_CTRL_2_V1_8814B */ -+#define BIT_LD_RQPN_V1_8814B BIT(31) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CH16_PUBLIC_DIS_8814B BIT(16) -+#define BIT_CH15_PUBLIC_DIS_8814B BIT(15) -+#define BIT_CH14_PUBLIC_DIS_8814B BIT(14) -+#define BIT_CH13_PUBLIC_DIS_8814B BIT(13) -+#define BIT_CH12_PUBLIC_DIS_8814B BIT(12) -+#define BIT_CH11_PUBLIC_DIS_8814B BIT(11) -+#define BIT_CH10_PUBLIC_DIS_8814B BIT(10) -+#define BIT_CH9_PUBLIC_DIS_8814B BIT(9) -+#define BIT_CH8_PUBLIC_DIS_8814B BIT(8) -+#define BIT_CH7_PUBLIC_DIS_8814B BIT(7) -+#define BIT_CH6_PUBLIC_DIS_8814B BIT(6) -+#define BIT_CH5_PUBLIC_DIS_8814B BIT(5) -+#define BIT_CH4_PUBLIC_DIS_8814B BIT(4) -+#define BIT_CH3_PUBLIC_DIS_8814B BIT(3) -+#define BIT_CH2_PUBLIC_DIS_8814B BIT(2) -+#define BIT_CH1_PUBLIC_DIS_8814B BIT(1) -+#define BIT_CH0_PUBLIC_DIS_8814B BIT(0) -+ -+/* 2 REG_BCN_CTRL_2_8814B */ -+#define BIT_BCN0_EXT_VALID_8814B BIT(31) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_BCN0_EXT_HEAD_8814B 16 -+#define BIT_MASK_BCN0_EXT_HEAD_8814B 0xfff -+#define BIT_BCN0_EXT_HEAD_8814B(x) \ -+ (((x) & BIT_MASK_BCN0_EXT_HEAD_8814B) << BIT_SHIFT_BCN0_EXT_HEAD_8814B) -+#define BITS_BCN0_EXT_HEAD_8814B \ -+ (BIT_MASK_BCN0_EXT_HEAD_8814B << BIT_SHIFT_BCN0_EXT_HEAD_8814B) -+#define BIT_CLEAR_BCN0_EXT_HEAD_8814B(x) ((x) & (~BITS_BCN0_EXT_HEAD_8814B)) -+#define BIT_GET_BCN0_EXT_HEAD_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN0_EXT_HEAD_8814B) & BIT_MASK_BCN0_EXT_HEAD_8814B) -+#define BIT_SET_BCN0_EXT_HEAD_8814B(x, v) \ -+ (BIT_CLEAR_BCN0_EXT_HEAD_8814B(x) | BIT_BCN0_EXT_HEAD_8814B(v)) -+ -+#define BIT_BCN4_VALID_8814B BIT(15) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_BCN4_HEAD_8814B 0 -+#define BIT_MASK_BCN4_HEAD_8814B 0xfff -+#define BIT_BCN4_HEAD_8814B(x) \ -+ (((x) & BIT_MASK_BCN4_HEAD_8814B) << BIT_SHIFT_BCN4_HEAD_8814B) -+#define BITS_BCN4_HEAD_8814B \ -+ (BIT_MASK_BCN4_HEAD_8814B << BIT_SHIFT_BCN4_HEAD_8814B) -+#define BIT_CLEAR_BCN4_HEAD_8814B(x) ((x) & (~BITS_BCN4_HEAD_8814B)) -+#define BIT_GET_BCN4_HEAD_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN4_HEAD_8814B) & BIT_MASK_BCN4_HEAD_8814B) -+#define BIT_SET_BCN4_HEAD_8814B(x, v) \ -+ (BIT_CLEAR_BCN4_HEAD_8814B(x) | BIT_BCN4_HEAD_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_TXPKTNUM_0_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TXPKTNUM_CH4_7_8814B 16 -+#define BIT_MASK_TXPKTNUM_CH4_7_8814B 0xfff -+#define BIT_TXPKTNUM_CH4_7_8814B(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH4_7_8814B) \ -+ << BIT_SHIFT_TXPKTNUM_CH4_7_8814B) -+#define BITS_TXPKTNUM_CH4_7_8814B \ -+ (BIT_MASK_TXPKTNUM_CH4_7_8814B << BIT_SHIFT_TXPKTNUM_CH4_7_8814B) -+#define BIT_CLEAR_TXPKTNUM_CH4_7_8814B(x) ((x) & (~BITS_TXPKTNUM_CH4_7_8814B)) -+#define BIT_GET_TXPKTNUM_CH4_7_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH4_7_8814B) & \ -+ BIT_MASK_TXPKTNUM_CH4_7_8814B) -+#define BIT_SET_TXPKTNUM_CH4_7_8814B(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH4_7_8814B(x) | BIT_TXPKTNUM_CH4_7_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TXPKTNUM_CH0_3_8814B 0 -+#define BIT_MASK_TXPKTNUM_CH0_3_8814B 0xfff -+#define BIT_TXPKTNUM_CH0_3_8814B(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH0_3_8814B) \ -+ << BIT_SHIFT_TXPKTNUM_CH0_3_8814B) -+#define BITS_TXPKTNUM_CH0_3_8814B \ -+ (BIT_MASK_TXPKTNUM_CH0_3_8814B << BIT_SHIFT_TXPKTNUM_CH0_3_8814B) -+#define BIT_CLEAR_TXPKTNUM_CH0_3_8814B(x) ((x) & (~BITS_TXPKTNUM_CH0_3_8814B)) -+#define BIT_GET_TXPKTNUM_CH0_3_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH0_3_8814B) & \ -+ BIT_MASK_TXPKTNUM_CH0_3_8814B) -+#define BIT_SET_TXPKTNUM_CH0_3_8814B(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH0_3_8814B(x) | BIT_TXPKTNUM_CH0_3_8814B(v)) -+ -+/* 2 REG_TXPKTNUM_1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TXPKTNUM_CH12_8814B 16 -+#define BIT_MASK_TXPKTNUM_CH12_8814B 0xfff -+#define BIT_TXPKTNUM_CH12_8814B(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH12_8814B) << BIT_SHIFT_TXPKTNUM_CH12_8814B) -+#define BITS_TXPKTNUM_CH12_8814B \ -+ (BIT_MASK_TXPKTNUM_CH12_8814B << BIT_SHIFT_TXPKTNUM_CH12_8814B) -+#define BIT_CLEAR_TXPKTNUM_CH12_8814B(x) ((x) & (~BITS_TXPKTNUM_CH12_8814B)) -+#define BIT_GET_TXPKTNUM_CH12_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH12_8814B) & BIT_MASK_TXPKTNUM_CH12_8814B) -+#define BIT_SET_TXPKTNUM_CH12_8814B(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH12_8814B(x) | BIT_TXPKTNUM_CH12_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TXPKTNUM_CH8_11_8814B 0 -+#define BIT_MASK_TXPKTNUM_CH8_11_8814B 0xfff -+#define BIT_TXPKTNUM_CH8_11_8814B(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH8_11_8814B) \ -+ << BIT_SHIFT_TXPKTNUM_CH8_11_8814B) -+#define BITS_TXPKTNUM_CH8_11_8814B \ -+ (BIT_MASK_TXPKTNUM_CH8_11_8814B << BIT_SHIFT_TXPKTNUM_CH8_11_8814B) -+#define BIT_CLEAR_TXPKTNUM_CH8_11_8814B(x) ((x) & (~BITS_TXPKTNUM_CH8_11_8814B)) -+#define BIT_GET_TXPKTNUM_CH8_11_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH8_11_8814B) & \ -+ BIT_MASK_TXPKTNUM_CH8_11_8814B) -+#define BIT_SET_TXPKTNUM_CH8_11_8814B(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH8_11_8814B(x) | BIT_TXPKTNUM_CH8_11_8814B(v)) -+ -+/* 2 REG_TXPKTNUM_2_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TXPKTNUM_CH14_15_8814B 16 -+#define BIT_MASK_TXPKTNUM_CH14_15_8814B 0xfff -+#define BIT_TXPKTNUM_CH14_15_8814B(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH14_15_8814B) \ -+ << BIT_SHIFT_TXPKTNUM_CH14_15_8814B) -+#define BITS_TXPKTNUM_CH14_15_8814B \ -+ (BIT_MASK_TXPKTNUM_CH14_15_8814B << BIT_SHIFT_TXPKTNUM_CH14_15_8814B) -+#define BIT_CLEAR_TXPKTNUM_CH14_15_8814B(x) \ -+ ((x) & (~BITS_TXPKTNUM_CH14_15_8814B)) -+#define BIT_GET_TXPKTNUM_CH14_15_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH14_15_8814B) & \ -+ BIT_MASK_TXPKTNUM_CH14_15_8814B) -+#define BIT_SET_TXPKTNUM_CH14_15_8814B(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH14_15_8814B(x) | BIT_TXPKTNUM_CH14_15_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TXPKTNUM_CH13_8814B 0 -+#define BIT_MASK_TXPKTNUM_CH13_8814B 0xfff -+#define BIT_TXPKTNUM_CH13_8814B(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH13_8814B) << BIT_SHIFT_TXPKTNUM_CH13_8814B) -+#define BITS_TXPKTNUM_CH13_8814B \ -+ (BIT_MASK_TXPKTNUM_CH13_8814B << BIT_SHIFT_TXPKTNUM_CH13_8814B) -+#define BIT_CLEAR_TXPKTNUM_CH13_8814B(x) ((x) & (~BITS_TXPKTNUM_CH13_8814B)) -+#define BIT_GET_TXPKTNUM_CH13_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH13_8814B) & BIT_MASK_TXPKTNUM_CH13_8814B) -+#define BIT_SET_TXPKTNUM_CH13_8814B(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH13_8814B(x) | BIT_TXPKTNUM_CH13_8814B(v)) -+ -+/* 2 REG_TXPKTNUM_3_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TXPKTNUM_CH16_8814B 0 -+#define BIT_MASK_TXPKTNUM_CH16_8814B 0xfff -+#define BIT_TXPKTNUM_CH16_8814B(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_CH16_8814B) << BIT_SHIFT_TXPKTNUM_CH16_8814B) -+#define BITS_TXPKTNUM_CH16_8814B \ -+ (BIT_MASK_TXPKTNUM_CH16_8814B << BIT_SHIFT_TXPKTNUM_CH16_8814B) -+#define BIT_CLEAR_TXPKTNUM_CH16_8814B(x) ((x) & (~BITS_TXPKTNUM_CH16_8814B)) -+#define BIT_GET_TXPKTNUM_CH16_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_CH16_8814B) & BIT_MASK_TXPKTNUM_CH16_8814B) -+#define BIT_SET_TXPKTNUM_CH16_8814B(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_CH16_8814B(x) | BIT_TXPKTNUM_CH16_8814B(v)) -+ -+/* 2 REG_TX_AGG_ALIGN_8814B */ -+ -+#define BIT_SHIFT_HW_FLOW_CTL_EN_8814B 16 -+#define BIT_MASK_HW_FLOW_CTL_EN_8814B 0xffff -+#define BIT_HW_FLOW_CTL_EN_8814B(x) \ -+ (((x) & BIT_MASK_HW_FLOW_CTL_EN_8814B) \ -+ << BIT_SHIFT_HW_FLOW_CTL_EN_8814B) -+#define BITS_HW_FLOW_CTL_EN_8814B \ -+ (BIT_MASK_HW_FLOW_CTL_EN_8814B << BIT_SHIFT_HW_FLOW_CTL_EN_8814B) -+#define BIT_CLEAR_HW_FLOW_CTL_EN_8814B(x) ((x) & (~BITS_HW_FLOW_CTL_EN_8814B)) -+#define BIT_GET_HW_FLOW_CTL_EN_8814B(x) \ -+ (((x) >> BIT_SHIFT_HW_FLOW_CTL_EN_8814B) & \ -+ BIT_MASK_HW_FLOW_CTL_EN_8814B) -+#define BIT_SET_HW_FLOW_CTL_EN_8814B(x, v) \ -+ (BIT_CLEAR_HW_FLOW_CTL_EN_8814B(x) | BIT_HW_FLOW_CTL_EN_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_SDIO_TXAGG_ALIGN_ADJUST_EN_V1_8814B BIT(15) -+ -+#define BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_V1_8814B 0 -+#define BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_V1_8814B 0xfff -+#define BIT_SDIO_TXAGG_ALIGN_SIZE_V1_8814B(x) \ -+ (((x) & BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_V1_8814B) \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_V1_8814B) -+#define BITS_SDIO_TXAGG_ALIGN_SIZE_V1_8814B \ -+ (BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_V1_8814B \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_V1_8814B) -+#define BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE_V1_8814B(x) \ -+ ((x) & (~BITS_SDIO_TXAGG_ALIGN_SIZE_V1_8814B)) -+#define BIT_GET_SDIO_TXAGG_ALIGN_SIZE_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_V1_8814B) & \ -+ BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_V1_8814B) -+#define BIT_SET_SDIO_TXAGG_ALIGN_SIZE_V1_8814B(x, v) \ -+ (BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE_V1_8814B(x) | \ -+ BIT_SDIO_TXAGG_ALIGN_SIZE_V1_8814B(v)) -+ -+/* 2 REG_H2C_HEAD_8814B */ -+ -+#define BIT_SHIFT_H2C_HEAD_V1_8814B 0 -+#define BIT_MASK_H2C_HEAD_V1_8814B 0x7ffff -+#define BIT_H2C_HEAD_V1_8814B(x) \ -+ (((x) & BIT_MASK_H2C_HEAD_V1_8814B) << BIT_SHIFT_H2C_HEAD_V1_8814B) -+#define BITS_H2C_HEAD_V1_8814B \ -+ (BIT_MASK_H2C_HEAD_V1_8814B << BIT_SHIFT_H2C_HEAD_V1_8814B) -+#define BIT_CLEAR_H2C_HEAD_V1_8814B(x) ((x) & (~BITS_H2C_HEAD_V1_8814B)) -+#define BIT_GET_H2C_HEAD_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2C_HEAD_V1_8814B) & BIT_MASK_H2C_HEAD_V1_8814B) -+#define BIT_SET_H2C_HEAD_V1_8814B(x, v) \ -+ (BIT_CLEAR_H2C_HEAD_V1_8814B(x) | BIT_H2C_HEAD_V1_8814B(v)) -+ -+/* 2 REG_H2C_TAIL_8814B */ -+ -+#define BIT_SHIFT_H2C_TAIL_V1_8814B 0 -+#define BIT_MASK_H2C_TAIL_V1_8814B 0x7ffff -+#define BIT_H2C_TAIL_V1_8814B(x) \ -+ (((x) & BIT_MASK_H2C_TAIL_V1_8814B) << BIT_SHIFT_H2C_TAIL_V1_8814B) -+#define BITS_H2C_TAIL_V1_8814B \ -+ (BIT_MASK_H2C_TAIL_V1_8814B << BIT_SHIFT_H2C_TAIL_V1_8814B) -+#define BIT_CLEAR_H2C_TAIL_V1_8814B(x) ((x) & (~BITS_H2C_TAIL_V1_8814B)) -+#define BIT_GET_H2C_TAIL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2C_TAIL_V1_8814B) & BIT_MASK_H2C_TAIL_V1_8814B) -+#define BIT_SET_H2C_TAIL_V1_8814B(x, v) \ -+ (BIT_CLEAR_H2C_TAIL_V1_8814B(x) | BIT_H2C_TAIL_V1_8814B(v)) -+ -+/* 2 REG_H2C_READ_ADDR_8814B */ -+ -+#define BIT_SHIFT_H2C_READ_ADDR_V1_8814B 0 -+#define BIT_MASK_H2C_READ_ADDR_V1_8814B 0x7ffff -+#define BIT_H2C_READ_ADDR_V1_8814B(x) \ -+ (((x) & BIT_MASK_H2C_READ_ADDR_V1_8814B) \ -+ << BIT_SHIFT_H2C_READ_ADDR_V1_8814B) -+#define BITS_H2C_READ_ADDR_V1_8814B \ -+ (BIT_MASK_H2C_READ_ADDR_V1_8814B << BIT_SHIFT_H2C_READ_ADDR_V1_8814B) -+#define BIT_CLEAR_H2C_READ_ADDR_V1_8814B(x) \ -+ ((x) & (~BITS_H2C_READ_ADDR_V1_8814B)) -+#define BIT_GET_H2C_READ_ADDR_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2C_READ_ADDR_V1_8814B) & \ -+ BIT_MASK_H2C_READ_ADDR_V1_8814B) -+#define BIT_SET_H2C_READ_ADDR_V1_8814B(x, v) \ -+ (BIT_CLEAR_H2C_READ_ADDR_V1_8814B(x) | BIT_H2C_READ_ADDR_V1_8814B(v)) -+ -+/* 2 REG_H2C_WR_ADDR_8814B */ -+ -+#define BIT_SHIFT_H2C_WR_ADDR_V1_8814B 0 -+#define BIT_MASK_H2C_WR_ADDR_V1_8814B 0x7ffff -+#define BIT_H2C_WR_ADDR_V1_8814B(x) \ -+ (((x) & BIT_MASK_H2C_WR_ADDR_V1_8814B) \ -+ << BIT_SHIFT_H2C_WR_ADDR_V1_8814B) -+#define BITS_H2C_WR_ADDR_V1_8814B \ -+ (BIT_MASK_H2C_WR_ADDR_V1_8814B << BIT_SHIFT_H2C_WR_ADDR_V1_8814B) -+#define BIT_CLEAR_H2C_WR_ADDR_V1_8814B(x) ((x) & (~BITS_H2C_WR_ADDR_V1_8814B)) -+#define BIT_GET_H2C_WR_ADDR_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2C_WR_ADDR_V1_8814B) & \ -+ BIT_MASK_H2C_WR_ADDR_V1_8814B) -+#define BIT_SET_H2C_WR_ADDR_V1_8814B(x, v) \ -+ (BIT_CLEAR_H2C_WR_ADDR_V1_8814B(x) | BIT_H2C_WR_ADDR_V1_8814B(v)) -+ -+/* 2 REG_H2C_INFO_8814B */ -+#define BIT_H2C_SPACE_VLD_8814B BIT(3) -+#define BIT_H2C_WR_ADDR_RST_8814B BIT(2) -+ -+#define BIT_SHIFT_H2C_LEN_SEL_8814B 0 -+#define BIT_MASK_H2C_LEN_SEL_8814B 0x3 -+#define BIT_H2C_LEN_SEL_8814B(x) \ -+ (((x) & BIT_MASK_H2C_LEN_SEL_8814B) << BIT_SHIFT_H2C_LEN_SEL_8814B) -+#define BITS_H2C_LEN_SEL_8814B \ -+ (BIT_MASK_H2C_LEN_SEL_8814B << BIT_SHIFT_H2C_LEN_SEL_8814B) -+#define BIT_CLEAR_H2C_LEN_SEL_8814B(x) ((x) & (~BITS_H2C_LEN_SEL_8814B)) -+#define BIT_GET_H2C_LEN_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2C_LEN_SEL_8814B) & BIT_MASK_H2C_LEN_SEL_8814B) -+#define BIT_SET_H2C_LEN_SEL_8814B(x, v) \ -+ (BIT_CLEAR_H2C_LEN_SEL_8814B(x) | BIT_H2C_LEN_SEL_8814B(v)) -+ -+/* 2 REG_DMA_OQT_0_8814B */ -+ -+#define BIT_SHIFT_TX_OQT_12_FREE_SPACE_8814B 24 -+#define BIT_MASK_TX_OQT_12_FREE_SPACE_8814B 0xff -+#define BIT_TX_OQT_12_FREE_SPACE_8814B(x) \ -+ (((x) & BIT_MASK_TX_OQT_12_FREE_SPACE_8814B) \ -+ << BIT_SHIFT_TX_OQT_12_FREE_SPACE_8814B) -+#define BITS_TX_OQT_12_FREE_SPACE_8814B \ -+ (BIT_MASK_TX_OQT_12_FREE_SPACE_8814B \ -+ << BIT_SHIFT_TX_OQT_12_FREE_SPACE_8814B) -+#define BIT_CLEAR_TX_OQT_12_FREE_SPACE_8814B(x) \ -+ ((x) & (~BITS_TX_OQT_12_FREE_SPACE_8814B)) -+#define BIT_GET_TX_OQT_12_FREE_SPACE_8814B(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_12_FREE_SPACE_8814B) & \ -+ BIT_MASK_TX_OQT_12_FREE_SPACE_8814B) -+#define BIT_SET_TX_OQT_12_FREE_SPACE_8814B(x, v) \ -+ (BIT_CLEAR_TX_OQT_12_FREE_SPACE_8814B(x) | \ -+ BIT_TX_OQT_12_FREE_SPACE_8814B(v)) -+ -+#define BIT_SHIFT_TX_OQT_8_11_FREE_SPACE_8814B 16 -+#define BIT_MASK_TX_OQT_8_11_FREE_SPACE_8814B 0xff -+#define BIT_TX_OQT_8_11_FREE_SPACE_8814B(x) \ -+ (((x) & BIT_MASK_TX_OQT_8_11_FREE_SPACE_8814B) \ -+ << BIT_SHIFT_TX_OQT_8_11_FREE_SPACE_8814B) -+#define BITS_TX_OQT_8_11_FREE_SPACE_8814B \ -+ (BIT_MASK_TX_OQT_8_11_FREE_SPACE_8814B \ -+ << BIT_SHIFT_TX_OQT_8_11_FREE_SPACE_8814B) -+#define BIT_CLEAR_TX_OQT_8_11_FREE_SPACE_8814B(x) \ -+ ((x) & (~BITS_TX_OQT_8_11_FREE_SPACE_8814B)) -+#define BIT_GET_TX_OQT_8_11_FREE_SPACE_8814B(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_8_11_FREE_SPACE_8814B) & \ -+ BIT_MASK_TX_OQT_8_11_FREE_SPACE_8814B) -+#define BIT_SET_TX_OQT_8_11_FREE_SPACE_8814B(x, v) \ -+ (BIT_CLEAR_TX_OQT_8_11_FREE_SPACE_8814B(x) | \ -+ BIT_TX_OQT_8_11_FREE_SPACE_8814B(v)) -+ -+#define BIT_SHIFT_TX_OQT_4_7_FREE_SPACE_8814B 8 -+#define BIT_MASK_TX_OQT_4_7_FREE_SPACE_8814B 0xff -+#define BIT_TX_OQT_4_7_FREE_SPACE_8814B(x) \ -+ (((x) & BIT_MASK_TX_OQT_4_7_FREE_SPACE_8814B) \ -+ << BIT_SHIFT_TX_OQT_4_7_FREE_SPACE_8814B) -+#define BITS_TX_OQT_4_7_FREE_SPACE_8814B \ -+ (BIT_MASK_TX_OQT_4_7_FREE_SPACE_8814B \ -+ << BIT_SHIFT_TX_OQT_4_7_FREE_SPACE_8814B) -+#define BIT_CLEAR_TX_OQT_4_7_FREE_SPACE_8814B(x) \ -+ ((x) & (~BITS_TX_OQT_4_7_FREE_SPACE_8814B)) -+#define BIT_GET_TX_OQT_4_7_FREE_SPACE_8814B(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_4_7_FREE_SPACE_8814B) & \ -+ BIT_MASK_TX_OQT_4_7_FREE_SPACE_8814B) -+#define BIT_SET_TX_OQT_4_7_FREE_SPACE_8814B(x, v) \ -+ (BIT_CLEAR_TX_OQT_4_7_FREE_SPACE_8814B(x) | \ -+ BIT_TX_OQT_4_7_FREE_SPACE_8814B(v)) -+ -+#define BIT_SHIFT_TX_OQT_0_3_FREE_SPACE_8814B 0 -+#define BIT_MASK_TX_OQT_0_3_FREE_SPACE_8814B 0xff -+#define BIT_TX_OQT_0_3_FREE_SPACE_8814B(x) \ -+ (((x) & BIT_MASK_TX_OQT_0_3_FREE_SPACE_8814B) \ -+ << BIT_SHIFT_TX_OQT_0_3_FREE_SPACE_8814B) -+#define BITS_TX_OQT_0_3_FREE_SPACE_8814B \ -+ (BIT_MASK_TX_OQT_0_3_FREE_SPACE_8814B \ -+ << BIT_SHIFT_TX_OQT_0_3_FREE_SPACE_8814B) -+#define BIT_CLEAR_TX_OQT_0_3_FREE_SPACE_8814B(x) \ -+ ((x) & (~BITS_TX_OQT_0_3_FREE_SPACE_8814B)) -+#define BIT_GET_TX_OQT_0_3_FREE_SPACE_8814B(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_0_3_FREE_SPACE_8814B) & \ -+ BIT_MASK_TX_OQT_0_3_FREE_SPACE_8814B) -+#define BIT_SET_TX_OQT_0_3_FREE_SPACE_8814B(x, v) \ -+ (BIT_CLEAR_TX_OQT_0_3_FREE_SPACE_8814B(x) | \ -+ BIT_TX_OQT_0_3_FREE_SPACE_8814B(v)) -+ -+/* 2 REG_DMA_OQT_1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TX_OQT_16_FREE_SPACE_8814B 16 -+#define BIT_MASK_TX_OQT_16_FREE_SPACE_8814B 0xff -+#define BIT_TX_OQT_16_FREE_SPACE_8814B(x) \ -+ (((x) & BIT_MASK_TX_OQT_16_FREE_SPACE_8814B) \ -+ << BIT_SHIFT_TX_OQT_16_FREE_SPACE_8814B) -+#define BITS_TX_OQT_16_FREE_SPACE_8814B \ -+ (BIT_MASK_TX_OQT_16_FREE_SPACE_8814B \ -+ << BIT_SHIFT_TX_OQT_16_FREE_SPACE_8814B) -+#define BIT_CLEAR_TX_OQT_16_FREE_SPACE_8814B(x) \ -+ ((x) & (~BITS_TX_OQT_16_FREE_SPACE_8814B)) -+#define BIT_GET_TX_OQT_16_FREE_SPACE_8814B(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_16_FREE_SPACE_8814B) & \ -+ BIT_MASK_TX_OQT_16_FREE_SPACE_8814B) -+#define BIT_SET_TX_OQT_16_FREE_SPACE_8814B(x, v) \ -+ (BIT_CLEAR_TX_OQT_16_FREE_SPACE_8814B(x) | \ -+ BIT_TX_OQT_16_FREE_SPACE_8814B(v)) -+ -+#define BIT_SHIFT_TX_OQT_14_15_FREE_SPACE_8814B 8 -+#define BIT_MASK_TX_OQT_14_15_FREE_SPACE_8814B 0xff -+#define BIT_TX_OQT_14_15_FREE_SPACE_8814B(x) \ -+ (((x) & BIT_MASK_TX_OQT_14_15_FREE_SPACE_8814B) \ -+ << BIT_SHIFT_TX_OQT_14_15_FREE_SPACE_8814B) -+#define BITS_TX_OQT_14_15_FREE_SPACE_8814B \ -+ (BIT_MASK_TX_OQT_14_15_FREE_SPACE_8814B \ -+ << BIT_SHIFT_TX_OQT_14_15_FREE_SPACE_8814B) -+#define BIT_CLEAR_TX_OQT_14_15_FREE_SPACE_8814B(x) \ -+ ((x) & (~BITS_TX_OQT_14_15_FREE_SPACE_8814B)) -+#define BIT_GET_TX_OQT_14_15_FREE_SPACE_8814B(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_14_15_FREE_SPACE_8814B) & \ -+ BIT_MASK_TX_OQT_14_15_FREE_SPACE_8814B) -+#define BIT_SET_TX_OQT_14_15_FREE_SPACE_8814B(x, v) \ -+ (BIT_CLEAR_TX_OQT_14_15_FREE_SPACE_8814B(x) | \ -+ BIT_TX_OQT_14_15_FREE_SPACE_8814B(v)) -+ -+#define BIT_SHIFT_TX_OQT_13_FREE_SPACE_8814B 0 -+#define BIT_MASK_TX_OQT_13_FREE_SPACE_8814B 0xff -+#define BIT_TX_OQT_13_FREE_SPACE_8814B(x) \ -+ (((x) & BIT_MASK_TX_OQT_13_FREE_SPACE_8814B) \ -+ << BIT_SHIFT_TX_OQT_13_FREE_SPACE_8814B) -+#define BITS_TX_OQT_13_FREE_SPACE_8814B \ -+ (BIT_MASK_TX_OQT_13_FREE_SPACE_8814B \ -+ << BIT_SHIFT_TX_OQT_13_FREE_SPACE_8814B) -+#define BIT_CLEAR_TX_OQT_13_FREE_SPACE_8814B(x) \ -+ ((x) & (~BITS_TX_OQT_13_FREE_SPACE_8814B)) -+#define BIT_GET_TX_OQT_13_FREE_SPACE_8814B(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_13_FREE_SPACE_8814B) & \ -+ BIT_MASK_TX_OQT_13_FREE_SPACE_8814B) -+#define BIT_SET_TX_OQT_13_FREE_SPACE_8814B(x, v) \ -+ (BIT_CLEAR_TX_OQT_13_FREE_SPACE_8814B(x) | \ -+ BIT_TX_OQT_13_FREE_SPACE_8814B(v)) -+ -+/* 2 REG_RXDMA_AGG_PG_TH_8814B */ -+#define BIT_DMA_STORE_8814B BIT(31) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_EN_PRE_CALC_8814B BIT(29) -+#define BIT_RXAGG_SW_EN_8814B BIT(28) -+#define BIT_RXAGG_SW_TRIG_8814B BIT(27) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_DMA_AGG_TO_V1_8814B 8 -+#define BIT_MASK_DMA_AGG_TO_V1_8814B 0xff -+#define BIT_DMA_AGG_TO_V1_8814B(x) \ -+ (((x) & BIT_MASK_DMA_AGG_TO_V1_8814B) << BIT_SHIFT_DMA_AGG_TO_V1_8814B) -+#define BITS_DMA_AGG_TO_V1_8814B \ -+ (BIT_MASK_DMA_AGG_TO_V1_8814B << BIT_SHIFT_DMA_AGG_TO_V1_8814B) -+#define BIT_CLEAR_DMA_AGG_TO_V1_8814B(x) ((x) & (~BITS_DMA_AGG_TO_V1_8814B)) -+#define BIT_GET_DMA_AGG_TO_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_DMA_AGG_TO_V1_8814B) & BIT_MASK_DMA_AGG_TO_V1_8814B) -+#define BIT_SET_DMA_AGG_TO_V1_8814B(x, v) \ -+ (BIT_CLEAR_DMA_AGG_TO_V1_8814B(x) | BIT_DMA_AGG_TO_V1_8814B(v)) -+ -+#define BIT_SHIFT_RXDMA_AGG_PG_TH_8814B 0 -+#define BIT_MASK_RXDMA_AGG_PG_TH_8814B 0xff -+#define BIT_RXDMA_AGG_PG_TH_8814B(x) \ -+ (((x) & BIT_MASK_RXDMA_AGG_PG_TH_8814B) \ -+ << BIT_SHIFT_RXDMA_AGG_PG_TH_8814B) -+#define BITS_RXDMA_AGG_PG_TH_8814B \ -+ (BIT_MASK_RXDMA_AGG_PG_TH_8814B << BIT_SHIFT_RXDMA_AGG_PG_TH_8814B) -+#define BIT_CLEAR_RXDMA_AGG_PG_TH_8814B(x) ((x) & (~BITS_RXDMA_AGG_PG_TH_8814B)) -+#define BIT_GET_RXDMA_AGG_PG_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_AGG_PG_TH_8814B) & \ -+ BIT_MASK_RXDMA_AGG_PG_TH_8814B) -+#define BIT_SET_RXDMA_AGG_PG_TH_8814B(x, v) \ -+ (BIT_CLEAR_RXDMA_AGG_PG_TH_8814B(x) | BIT_RXDMA_AGG_PG_TH_8814B(v)) -+ -+/* 2 REG_RXDMA_CTRL_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8814B 20 -+#define BIT_MASK_FW_UPD_RDPTR19_TO_16_8814B 0xf -+#define BIT_FW_UPD_RDPTR19_TO_16_8814B(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR19_TO_16_8814B) \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8814B) -+#define BITS_FW_UPD_RDPTR19_TO_16_8814B \ -+ (BIT_MASK_FW_UPD_RDPTR19_TO_16_8814B \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8814B) -+#define BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8814B(x) \ -+ ((x) & (~BITS_FW_UPD_RDPTR19_TO_16_8814B)) -+#define BIT_GET_FW_UPD_RDPTR19_TO_16_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8814B) & \ -+ BIT_MASK_FW_UPD_RDPTR19_TO_16_8814B) -+#define BIT_SET_FW_UPD_RDPTR19_TO_16_8814B(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8814B(x) | \ -+ BIT_FW_UPD_RDPTR19_TO_16_8814B(v)) -+ -+#define BIT_RXDMA_REQ_8814B BIT(19) -+#define BIT_RW_RELEASE_EN_8814B BIT(18) -+#define BIT_RXDMA_IDLE_8814B BIT(17) -+#define BIT_RXPKT_RELEASE_POLL_8814B BIT(16) -+ -+#define BIT_SHIFT_FW_UPD_RDPTR_8814B 0 -+#define BIT_MASK_FW_UPD_RDPTR_8814B 0xffff -+#define BIT_FW_UPD_RDPTR_8814B(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR_8814B) << BIT_SHIFT_FW_UPD_RDPTR_8814B) -+#define BITS_FW_UPD_RDPTR_8814B \ -+ (BIT_MASK_FW_UPD_RDPTR_8814B << BIT_SHIFT_FW_UPD_RDPTR_8814B) -+#define BIT_CLEAR_FW_UPD_RDPTR_8814B(x) ((x) & (~BITS_FW_UPD_RDPTR_8814B)) -+#define BIT_GET_FW_UPD_RDPTR_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR_8814B) & BIT_MASK_FW_UPD_RDPTR_8814B) -+#define BIT_SET_FW_UPD_RDPTR_8814B(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR_8814B(x) | BIT_FW_UPD_RDPTR_8814B(v)) -+ -+/* 2 REG_RXDMA_STATUS_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_C2H_PKT_OVF_8814B BIT(7) -+#define BIT_AGG_CONFGI_ISSUE_8814B BIT(6) -+#define BIT_FW_POLL_ISSUE_8814B BIT(5) -+#define BIT_RX_DATA_UDN_8814B BIT(4) -+#define BIT_RX_SFF_UDN_8814B BIT(3) -+#define BIT_RX_SFF_OVF_8814B BIT(2) -+#define BIT_RXPKT_OVF_8814B BIT(0) -+ -+/* 2 REG_RXDMA_DPR_8814B */ -+ -+#define BIT_SHIFT_RDE_DEBUG_8814B 0 -+#define BIT_MASK_RDE_DEBUG_8814B 0xffffffffL -+#define BIT_RDE_DEBUG_8814B(x) \ -+ (((x) & BIT_MASK_RDE_DEBUG_8814B) << BIT_SHIFT_RDE_DEBUG_8814B) -+#define BITS_RDE_DEBUG_8814B \ -+ (BIT_MASK_RDE_DEBUG_8814B << BIT_SHIFT_RDE_DEBUG_8814B) -+#define BIT_CLEAR_RDE_DEBUG_8814B(x) ((x) & (~BITS_RDE_DEBUG_8814B)) -+#define BIT_GET_RDE_DEBUG_8814B(x) \ -+ (((x) >> BIT_SHIFT_RDE_DEBUG_8814B) & BIT_MASK_RDE_DEBUG_8814B) -+#define BIT_SET_RDE_DEBUG_8814B(x, v) \ -+ (BIT_CLEAR_RDE_DEBUG_8814B(x) | BIT_RDE_DEBUG_8814B(v)) -+ -+/* 2 REG_RXDMA_MODE_8814B */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V2_8814B 24 -+#define BIT_MASK_PKTNUM_TH_V2_8814B 0x1f -+#define BIT_PKTNUM_TH_V2_8814B(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V2_8814B) << BIT_SHIFT_PKTNUM_TH_V2_8814B) -+#define BITS_PKTNUM_TH_V2_8814B \ -+ (BIT_MASK_PKTNUM_TH_V2_8814B << BIT_SHIFT_PKTNUM_TH_V2_8814B) -+#define BIT_CLEAR_PKTNUM_TH_V2_8814B(x) ((x) & (~BITS_PKTNUM_TH_V2_8814B)) -+#define BIT_GET_PKTNUM_TH_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V2_8814B) & BIT_MASK_PKTNUM_TH_V2_8814B) -+#define BIT_SET_PKTNUM_TH_V2_8814B(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V2_8814B(x) | BIT_PKTNUM_TH_V2_8814B(v)) -+ -+#define BIT_TXBA_BREAK_USBAGG_8814B BIT(23) -+ -+#define BIT_SHIFT_PKTLEN_PARA_8814B 16 -+#define BIT_MASK_PKTLEN_PARA_8814B 0x7 -+#define BIT_PKTLEN_PARA_8814B(x) \ -+ (((x) & BIT_MASK_PKTLEN_PARA_8814B) << BIT_SHIFT_PKTLEN_PARA_8814B) -+#define BITS_PKTLEN_PARA_8814B \ -+ (BIT_MASK_PKTLEN_PARA_8814B << BIT_SHIFT_PKTLEN_PARA_8814B) -+#define BIT_CLEAR_PKTLEN_PARA_8814B(x) ((x) & (~BITS_PKTLEN_PARA_8814B)) -+#define BIT_GET_PKTLEN_PARA_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKTLEN_PARA_8814B) & BIT_MASK_PKTLEN_PARA_8814B) -+#define BIT_SET_PKTLEN_PARA_8814B(x, v) \ -+ (BIT_CLEAR_PKTLEN_PARA_8814B(x) | BIT_PKTLEN_PARA_8814B(v)) -+ -+#define BIT_RX_DBG_SEL_8814B BIT(7) -+#define BIT_EN_SPD_8814B BIT(6) -+ -+#define BIT_SHIFT_BURST_SIZE_8814B 4 -+#define BIT_MASK_BURST_SIZE_8814B 0x3 -+#define BIT_BURST_SIZE_8814B(x) \ -+ (((x) & BIT_MASK_BURST_SIZE_8814B) << BIT_SHIFT_BURST_SIZE_8814B) -+#define BITS_BURST_SIZE_8814B \ -+ (BIT_MASK_BURST_SIZE_8814B << BIT_SHIFT_BURST_SIZE_8814B) -+#define BIT_CLEAR_BURST_SIZE_8814B(x) ((x) & (~BITS_BURST_SIZE_8814B)) -+#define BIT_GET_BURST_SIZE_8814B(x) \ -+ (((x) >> BIT_SHIFT_BURST_SIZE_8814B) & BIT_MASK_BURST_SIZE_8814B) -+#define BIT_SET_BURST_SIZE_8814B(x, v) \ -+ (BIT_CLEAR_BURST_SIZE_8814B(x) | BIT_BURST_SIZE_8814B(v)) -+ -+#define BIT_SHIFT_BURST_CNT_8814B 2 -+#define BIT_MASK_BURST_CNT_8814B 0x3 -+#define BIT_BURST_CNT_8814B(x) \ -+ (((x) & BIT_MASK_BURST_CNT_8814B) << BIT_SHIFT_BURST_CNT_8814B) -+#define BITS_BURST_CNT_8814B \ -+ (BIT_MASK_BURST_CNT_8814B << BIT_SHIFT_BURST_CNT_8814B) -+#define BIT_CLEAR_BURST_CNT_8814B(x) ((x) & (~BITS_BURST_CNT_8814B)) -+#define BIT_GET_BURST_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_BURST_CNT_8814B) & BIT_MASK_BURST_CNT_8814B) -+#define BIT_SET_BURST_CNT_8814B(x, v) \ -+ (BIT_CLEAR_BURST_CNT_8814B(x) | BIT_BURST_CNT_8814B(v)) -+ -+#define BIT_DMA_MODE_8814B BIT(1) -+ -+/* 2 REG_C2H_PKT_8814B */ -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8814B 24 -+#define BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8814B 0xf -+#define BIT_R_C2H_STR_ADDR_16_TO_19_8814B(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8814B) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8814B) -+#define BITS_R_C2H_STR_ADDR_16_TO_19_8814B \ -+ (BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8814B \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8814B) -+#define BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8814B(x) \ -+ ((x) & (~BITS_R_C2H_STR_ADDR_16_TO_19_8814B)) -+#define BIT_GET_R_C2H_STR_ADDR_16_TO_19_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8814B) & \ -+ BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8814B) -+#define BIT_SET_R_C2H_STR_ADDR_16_TO_19_8814B(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8814B(x) | \ -+ BIT_R_C2H_STR_ADDR_16_TO_19_8814B(v)) -+ -+#define BIT_R_C2H_PKT_REQ_8814B BIT(16) -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_8814B 0 -+#define BIT_MASK_R_C2H_STR_ADDR_8814B 0xffff -+#define BIT_R_C2H_STR_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_8814B) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_8814B) -+#define BITS_R_C2H_STR_ADDR_8814B \ -+ (BIT_MASK_R_C2H_STR_ADDR_8814B << BIT_SHIFT_R_C2H_STR_ADDR_8814B) -+#define BIT_CLEAR_R_C2H_STR_ADDR_8814B(x) ((x) & (~BITS_R_C2H_STR_ADDR_8814B)) -+#define BIT_GET_R_C2H_STR_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_8814B) & \ -+ BIT_MASK_R_C2H_STR_ADDR_8814B) -+#define BIT_SET_R_C2H_STR_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_8814B(x) | BIT_R_C2H_STR_ADDR_8814B(v)) -+ -+/* 2 REG_FWFF_C2H_8814B */ -+ -+#define BIT_SHIFT_C2H_DMA_ADDR_8814B 0 -+#define BIT_MASK_C2H_DMA_ADDR_8814B 0x3ffff -+#define BIT_C2H_DMA_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_C2H_DMA_ADDR_8814B) << BIT_SHIFT_C2H_DMA_ADDR_8814B) -+#define BITS_C2H_DMA_ADDR_8814B \ -+ (BIT_MASK_C2H_DMA_ADDR_8814B << BIT_SHIFT_C2H_DMA_ADDR_8814B) -+#define BIT_CLEAR_C2H_DMA_ADDR_8814B(x) ((x) & (~BITS_C2H_DMA_ADDR_8814B)) -+#define BIT_GET_C2H_DMA_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_C2H_DMA_ADDR_8814B) & BIT_MASK_C2H_DMA_ADDR_8814B) -+#define BIT_SET_C2H_DMA_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_C2H_DMA_ADDR_8814B(x) | BIT_C2H_DMA_ADDR_8814B(v)) -+ -+/* 2 REG_FWFF_CTRL_8814B */ -+#define BIT_FWFF_DMAPKT_REQ_8814B BIT(31) -+ -+#define BIT_SHIFT_FWFF_DMA_PKT_NUM_V1_8814B 16 -+#define BIT_MASK_FWFF_DMA_PKT_NUM_V1_8814B 0x7fff -+#define BIT_FWFF_DMA_PKT_NUM_V1_8814B(x) \ -+ (((x) & BIT_MASK_FWFF_DMA_PKT_NUM_V1_8814B) \ -+ << BIT_SHIFT_FWFF_DMA_PKT_NUM_V1_8814B) -+#define BITS_FWFF_DMA_PKT_NUM_V1_8814B \ -+ (BIT_MASK_FWFF_DMA_PKT_NUM_V1_8814B \ -+ << BIT_SHIFT_FWFF_DMA_PKT_NUM_V1_8814B) -+#define BIT_CLEAR_FWFF_DMA_PKT_NUM_V1_8814B(x) \ -+ ((x) & (~BITS_FWFF_DMA_PKT_NUM_V1_8814B)) -+#define BIT_GET_FWFF_DMA_PKT_NUM_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWFF_DMA_PKT_NUM_V1_8814B) & \ -+ BIT_MASK_FWFF_DMA_PKT_NUM_V1_8814B) -+#define BIT_SET_FWFF_DMA_PKT_NUM_V1_8814B(x, v) \ -+ (BIT_CLEAR_FWFF_DMA_PKT_NUM_V1_8814B(x) | \ -+ BIT_FWFF_DMA_PKT_NUM_V1_8814B(v)) -+ -+#define BIT_SHIFT_FWFF_STR_ADDR_8814B 0 -+#define BIT_MASK_FWFF_STR_ADDR_8814B 0xffff -+#define BIT_FWFF_STR_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_FWFF_STR_ADDR_8814B) << BIT_SHIFT_FWFF_STR_ADDR_8814B) -+#define BITS_FWFF_STR_ADDR_8814B \ -+ (BIT_MASK_FWFF_STR_ADDR_8814B << BIT_SHIFT_FWFF_STR_ADDR_8814B) -+#define BIT_CLEAR_FWFF_STR_ADDR_8814B(x) ((x) & (~BITS_FWFF_STR_ADDR_8814B)) -+#define BIT_GET_FWFF_STR_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWFF_STR_ADDR_8814B) & BIT_MASK_FWFF_STR_ADDR_8814B) -+#define BIT_SET_FWFF_STR_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_FWFF_STR_ADDR_8814B(x) | BIT_FWFF_STR_ADDR_8814B(v)) -+ -+/* 2 REG_FWFF_PKT_INFO_8814B */ -+ -+#define BIT_SHIFT_FWFF_PKT_READ_ADDR_8814B 16 -+#define BIT_MASK_FWFF_PKT_READ_ADDR_8814B 0xffff -+#define BIT_FWFF_PKT_READ_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_READ_ADDR_8814B) \ -+ << BIT_SHIFT_FWFF_PKT_READ_ADDR_8814B) -+#define BITS_FWFF_PKT_READ_ADDR_8814B \ -+ (BIT_MASK_FWFF_PKT_READ_ADDR_8814B \ -+ << BIT_SHIFT_FWFF_PKT_READ_ADDR_8814B) -+#define BIT_CLEAR_FWFF_PKT_READ_ADDR_8814B(x) \ -+ ((x) & (~BITS_FWFF_PKT_READ_ADDR_8814B)) -+#define BIT_GET_FWFF_PKT_READ_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_READ_ADDR_8814B) & \ -+ BIT_MASK_FWFF_PKT_READ_ADDR_8814B) -+#define BIT_SET_FWFF_PKT_READ_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_READ_ADDR_8814B(x) | \ -+ BIT_FWFF_PKT_READ_ADDR_8814B(v)) -+ -+#define BIT_SHIFT_FWFF_PKT_WRITE_ADDR_8814B 0 -+#define BIT_MASK_FWFF_PKT_WRITE_ADDR_8814B 0xffff -+#define BIT_FWFF_PKT_WRITE_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_WRITE_ADDR_8814B) \ -+ << BIT_SHIFT_FWFF_PKT_WRITE_ADDR_8814B) -+#define BITS_FWFF_PKT_WRITE_ADDR_8814B \ -+ (BIT_MASK_FWFF_PKT_WRITE_ADDR_8814B \ -+ << BIT_SHIFT_FWFF_PKT_WRITE_ADDR_8814B) -+#define BIT_CLEAR_FWFF_PKT_WRITE_ADDR_8814B(x) \ -+ ((x) & (~BITS_FWFF_PKT_WRITE_ADDR_8814B)) -+#define BIT_GET_FWFF_PKT_WRITE_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_WRITE_ADDR_8814B) & \ -+ BIT_MASK_FWFF_PKT_WRITE_ADDR_8814B) -+#define BIT_SET_FWFF_PKT_WRITE_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_WRITE_ADDR_8814B(x) | \ -+ BIT_FWFF_PKT_WRITE_ADDR_8814B(v)) -+ -+/* 2 REG_FWFF_PKT_INFO2_8814B */ -+ -+#define BIT_SHIFT_FWFF_PKT_QUEUED_V1_8814B 0 -+#define BIT_MASK_FWFF_PKT_QUEUED_V1_8814B 0xffff -+#define BIT_FWFF_PKT_QUEUED_V1_8814B(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_QUEUED_V1_8814B) \ -+ << BIT_SHIFT_FWFF_PKT_QUEUED_V1_8814B) -+#define BITS_FWFF_PKT_QUEUED_V1_8814B \ -+ (BIT_MASK_FWFF_PKT_QUEUED_V1_8814B \ -+ << BIT_SHIFT_FWFF_PKT_QUEUED_V1_8814B) -+#define BIT_CLEAR_FWFF_PKT_QUEUED_V1_8814B(x) \ -+ ((x) & (~BITS_FWFF_PKT_QUEUED_V1_8814B)) -+#define BIT_GET_FWFF_PKT_QUEUED_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_QUEUED_V1_8814B) & \ -+ BIT_MASK_FWFF_PKT_QUEUED_V1_8814B) -+#define BIT_SET_FWFF_PKT_QUEUED_V1_8814B(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_QUEUED_V1_8814B(x) | \ -+ BIT_FWFF_PKT_QUEUED_V1_8814B(v)) -+ -+/* 2 REG_RXPKTNUM_8814B */ -+ -+#define BIT_SHIFT_PKT_NUM_WOL_V1_8814B 16 -+#define BIT_MASK_PKT_NUM_WOL_V1_8814B 0xffff -+#define BIT_PKT_NUM_WOL_V1_8814B(x) \ -+ (((x) & BIT_MASK_PKT_NUM_WOL_V1_8814B) \ -+ << BIT_SHIFT_PKT_NUM_WOL_V1_8814B) -+#define BITS_PKT_NUM_WOL_V1_8814B \ -+ (BIT_MASK_PKT_NUM_WOL_V1_8814B << BIT_SHIFT_PKT_NUM_WOL_V1_8814B) -+#define BIT_CLEAR_PKT_NUM_WOL_V1_8814B(x) ((x) & (~BITS_PKT_NUM_WOL_V1_8814B)) -+#define BIT_GET_PKT_NUM_WOL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_WOL_V1_8814B) & \ -+ BIT_MASK_PKT_NUM_WOL_V1_8814B) -+#define BIT_SET_PKT_NUM_WOL_V1_8814B(x, v) \ -+ (BIT_CLEAR_PKT_NUM_WOL_V1_8814B(x) | BIT_PKT_NUM_WOL_V1_8814B(v)) -+ -+#define BIT_SHIFT_RXPKT_NUM_V1_8814B 0 -+#define BIT_MASK_RXPKT_NUM_V1_8814B 0xffff -+#define BIT_RXPKT_NUM_V1_8814B(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_V1_8814B) << BIT_SHIFT_RXPKT_NUM_V1_8814B) -+#define BITS_RXPKT_NUM_V1_8814B \ -+ (BIT_MASK_RXPKT_NUM_V1_8814B << BIT_SHIFT_RXPKT_NUM_V1_8814B) -+#define BIT_CLEAR_RXPKT_NUM_V1_8814B(x) ((x) & (~BITS_RXPKT_NUM_V1_8814B)) -+#define BIT_GET_RXPKT_NUM_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_V1_8814B) & BIT_MASK_RXPKT_NUM_V1_8814B) -+#define BIT_SET_RXPKT_NUM_V1_8814B(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_V1_8814B(x) | BIT_RXPKT_NUM_V1_8814B(v)) -+ -+/* 2 REG_RXPKTNUM_TH_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_RXPKT_NUM_TH_8814B 0 -+#define BIT_MASK_RXPKT_NUM_TH_8814B 0xff -+#define BIT_RXPKT_NUM_TH_8814B(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_TH_8814B) << BIT_SHIFT_RXPKT_NUM_TH_8814B) -+#define BITS_RXPKT_NUM_TH_8814B \ -+ (BIT_MASK_RXPKT_NUM_TH_8814B << BIT_SHIFT_RXPKT_NUM_TH_8814B) -+#define BIT_CLEAR_RXPKT_NUM_TH_8814B(x) ((x) & (~BITS_RXPKT_NUM_TH_8814B)) -+#define BIT_GET_RXPKT_NUM_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_TH_8814B) & BIT_MASK_RXPKT_NUM_TH_8814B) -+#define BIT_SET_RXPKT_NUM_TH_8814B(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_TH_8814B(x) | BIT_RXPKT_NUM_TH_8814B(v)) -+ -+/* 2 REG_FW_UPD_RXDES_RDPTR_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_FW_UPD_RXDES_RD_PTR_8814B 0 -+#define BIT_MASK_FW_UPD_RXDES_RD_PTR_8814B 0x3ffff -+#define BIT_FW_UPD_RXDES_RD_PTR_8814B(x) \ -+ (((x) & BIT_MASK_FW_UPD_RXDES_RD_PTR_8814B) \ -+ << BIT_SHIFT_FW_UPD_RXDES_RD_PTR_8814B) -+#define BITS_FW_UPD_RXDES_RD_PTR_8814B \ -+ (BIT_MASK_FW_UPD_RXDES_RD_PTR_8814B \ -+ << BIT_SHIFT_FW_UPD_RXDES_RD_PTR_8814B) -+#define BIT_CLEAR_FW_UPD_RXDES_RD_PTR_8814B(x) \ -+ ((x) & (~BITS_FW_UPD_RXDES_RD_PTR_8814B)) -+#define BIT_GET_FW_UPD_RXDES_RD_PTR_8814B(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RXDES_RD_PTR_8814B) & \ -+ BIT_MASK_FW_UPD_RXDES_RD_PTR_8814B) -+#define BIT_SET_FW_UPD_RXDES_RD_PTR_8814B(x, v) \ -+ (BIT_CLEAR_FW_UPD_RXDES_RD_PTR_8814B(x) | \ -+ BIT_FW_UPD_RXDES_RD_PTR_8814B(v)) -+ -+/* 2 REG_DDMA_CH0SA_8814B */ -+ -+#define BIT_SHIFT_DDMACH0_SA_8814B 0 -+#define BIT_MASK_DDMACH0_SA_8814B 0xffffffffL -+#define BIT_DDMACH0_SA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH0_SA_8814B) << BIT_SHIFT_DDMACH0_SA_8814B) -+#define BITS_DDMACH0_SA_8814B \ -+ (BIT_MASK_DDMACH0_SA_8814B << BIT_SHIFT_DDMACH0_SA_8814B) -+#define BIT_CLEAR_DDMACH0_SA_8814B(x) ((x) & (~BITS_DDMACH0_SA_8814B)) -+#define BIT_GET_DDMACH0_SA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_SA_8814B) & BIT_MASK_DDMACH0_SA_8814B) -+#define BIT_SET_DDMACH0_SA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH0_SA_8814B(x) | BIT_DDMACH0_SA_8814B(v)) -+ -+/* 2 REG_DDMA_CH0DA_8814B */ -+ -+#define BIT_SHIFT_DDMACH0_DA_8814B 0 -+#define BIT_MASK_DDMACH0_DA_8814B 0xffffffffL -+#define BIT_DDMACH0_DA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH0_DA_8814B) << BIT_SHIFT_DDMACH0_DA_8814B) -+#define BITS_DDMACH0_DA_8814B \ -+ (BIT_MASK_DDMACH0_DA_8814B << BIT_SHIFT_DDMACH0_DA_8814B) -+#define BIT_CLEAR_DDMACH0_DA_8814B(x) ((x) & (~BITS_DDMACH0_DA_8814B)) -+#define BIT_GET_DDMACH0_DA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DA_8814B) & BIT_MASK_DDMACH0_DA_8814B) -+#define BIT_SET_DDMACH0_DA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH0_DA_8814B(x) | BIT_DDMACH0_DA_8814B(v)) -+ -+/* 2 REG_DDMA_CH0CTRL_8814B */ -+#define BIT_DDMACH0_OWN_8814B BIT(31) -+#define BIT_DDMACH0_IDMEM_ERR_8814B BIT(30) -+#define BIT_DDMACH0_CHKSUM_EN_8814B BIT(29) -+#define BIT_DDMACH0_DA_W_DISABLE_8814B BIT(28) -+#define BIT_DDMACH0_CHKSUM_STS_8814B BIT(27) -+#define BIT_DDMACH0_DDMA_MODE_8814B BIT(26) -+#define BIT_DDMACH0_RESET_CHKSUM_STS_8814B BIT(25) -+#define BIT_DDMACH0_CHKSUM_CONT_8814B BIT(24) -+ -+#define BIT_SHIFT_DDMACH0_DLEN_8814B 0 -+#define BIT_MASK_DDMACH0_DLEN_8814B 0x3ffff -+#define BIT_DDMACH0_DLEN_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH0_DLEN_8814B) << BIT_SHIFT_DDMACH0_DLEN_8814B) -+#define BITS_DDMACH0_DLEN_8814B \ -+ (BIT_MASK_DDMACH0_DLEN_8814B << BIT_SHIFT_DDMACH0_DLEN_8814B) -+#define BIT_CLEAR_DDMACH0_DLEN_8814B(x) ((x) & (~BITS_DDMACH0_DLEN_8814B)) -+#define BIT_GET_DDMACH0_DLEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DLEN_8814B) & BIT_MASK_DDMACH0_DLEN_8814B) -+#define BIT_SET_DDMACH0_DLEN_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH0_DLEN_8814B(x) | BIT_DDMACH0_DLEN_8814B(v)) -+ -+/* 2 REG_DDMA_CH1SA_8814B */ -+ -+#define BIT_SHIFT_DDMACH1_SA_8814B 0 -+#define BIT_MASK_DDMACH1_SA_8814B 0xffffffffL -+#define BIT_DDMACH1_SA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH1_SA_8814B) << BIT_SHIFT_DDMACH1_SA_8814B) -+#define BITS_DDMACH1_SA_8814B \ -+ (BIT_MASK_DDMACH1_SA_8814B << BIT_SHIFT_DDMACH1_SA_8814B) -+#define BIT_CLEAR_DDMACH1_SA_8814B(x) ((x) & (~BITS_DDMACH1_SA_8814B)) -+#define BIT_GET_DDMACH1_SA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_SA_8814B) & BIT_MASK_DDMACH1_SA_8814B) -+#define BIT_SET_DDMACH1_SA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH1_SA_8814B(x) | BIT_DDMACH1_SA_8814B(v)) -+ -+/* 2 REG_DDMA_CH1DA_8814B */ -+ -+#define BIT_SHIFT_DDMACH1_DA_8814B 0 -+#define BIT_MASK_DDMACH1_DA_8814B 0xffffffffL -+#define BIT_DDMACH1_DA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH1_DA_8814B) << BIT_SHIFT_DDMACH1_DA_8814B) -+#define BITS_DDMACH1_DA_8814B \ -+ (BIT_MASK_DDMACH1_DA_8814B << BIT_SHIFT_DDMACH1_DA_8814B) -+#define BIT_CLEAR_DDMACH1_DA_8814B(x) ((x) & (~BITS_DDMACH1_DA_8814B)) -+#define BIT_GET_DDMACH1_DA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DA_8814B) & BIT_MASK_DDMACH1_DA_8814B) -+#define BIT_SET_DDMACH1_DA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH1_DA_8814B(x) | BIT_DDMACH1_DA_8814B(v)) -+ -+/* 2 REG_DDMA_CH1CTRL_8814B */ -+#define BIT_DDMACH1_OWN_8814B BIT(31) -+#define BIT_DDMACH1_IDMEM_ERR_8814B BIT(30) -+#define BIT_DDMACH1_CHKSUM_EN_8814B BIT(29) -+#define BIT_DDMACH1_DA_W_DISABLE_8814B BIT(28) -+#define BIT_DDMACH1_CHKSUM_STS_8814B BIT(27) -+#define BIT_DDMACH1_DDMA_MODE_8814B BIT(26) -+#define BIT_DDMACH1_RESET_CHKSUM_STS_8814B BIT(25) -+#define BIT_DDMACH1_CHKSUM_CONT_8814B BIT(24) -+ -+#define BIT_SHIFT_DDMACH1_DLEN_8814B 0 -+#define BIT_MASK_DDMACH1_DLEN_8814B 0x3ffff -+#define BIT_DDMACH1_DLEN_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH1_DLEN_8814B) << BIT_SHIFT_DDMACH1_DLEN_8814B) -+#define BITS_DDMACH1_DLEN_8814B \ -+ (BIT_MASK_DDMACH1_DLEN_8814B << BIT_SHIFT_DDMACH1_DLEN_8814B) -+#define BIT_CLEAR_DDMACH1_DLEN_8814B(x) ((x) & (~BITS_DDMACH1_DLEN_8814B)) -+#define BIT_GET_DDMACH1_DLEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DLEN_8814B) & BIT_MASK_DDMACH1_DLEN_8814B) -+#define BIT_SET_DDMACH1_DLEN_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH1_DLEN_8814B(x) | BIT_DDMACH1_DLEN_8814B(v)) -+ -+/* 2 REG_DDMA_CH2SA_8814B */ -+ -+#define BIT_SHIFT_DDMACH2_SA_8814B 0 -+#define BIT_MASK_DDMACH2_SA_8814B 0xffffffffL -+#define BIT_DDMACH2_SA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH2_SA_8814B) << BIT_SHIFT_DDMACH2_SA_8814B) -+#define BITS_DDMACH2_SA_8814B \ -+ (BIT_MASK_DDMACH2_SA_8814B << BIT_SHIFT_DDMACH2_SA_8814B) -+#define BIT_CLEAR_DDMACH2_SA_8814B(x) ((x) & (~BITS_DDMACH2_SA_8814B)) -+#define BIT_GET_DDMACH2_SA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_SA_8814B) & BIT_MASK_DDMACH2_SA_8814B) -+#define BIT_SET_DDMACH2_SA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH2_SA_8814B(x) | BIT_DDMACH2_SA_8814B(v)) -+ -+/* 2 REG_DDMA_CH2DA_8814B */ -+ -+#define BIT_SHIFT_DDMACH2_DA_8814B 0 -+#define BIT_MASK_DDMACH2_DA_8814B 0xffffffffL -+#define BIT_DDMACH2_DA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH2_DA_8814B) << BIT_SHIFT_DDMACH2_DA_8814B) -+#define BITS_DDMACH2_DA_8814B \ -+ (BIT_MASK_DDMACH2_DA_8814B << BIT_SHIFT_DDMACH2_DA_8814B) -+#define BIT_CLEAR_DDMACH2_DA_8814B(x) ((x) & (~BITS_DDMACH2_DA_8814B)) -+#define BIT_GET_DDMACH2_DA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DA_8814B) & BIT_MASK_DDMACH2_DA_8814B) -+#define BIT_SET_DDMACH2_DA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH2_DA_8814B(x) | BIT_DDMACH2_DA_8814B(v)) -+ -+/* 2 REG_DDMA_CH2CTRL_8814B */ -+#define BIT_DDMACH2_OWN_8814B BIT(31) -+#define BIT_DDMACH2_IDMEM_ERR_8814B BIT(30) -+#define BIT_DDMACH2_CHKSUM_EN_8814B BIT(29) -+#define BIT_DDMACH2_DA_W_DISABLE_8814B BIT(28) -+#define BIT_DDMACH2_CHKSUM_STS_8814B BIT(27) -+#define BIT_DDMACH2_DDMA_MODE_8814B BIT(26) -+#define BIT_DDMACH2_RESET_CHKSUM_STS_8814B BIT(25) -+#define BIT_DDMACH2_CHKSUM_CONT_8814B BIT(24) -+ -+#define BIT_SHIFT_DDMACH2_DLEN_8814B 0 -+#define BIT_MASK_DDMACH2_DLEN_8814B 0x3ffff -+#define BIT_DDMACH2_DLEN_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH2_DLEN_8814B) << BIT_SHIFT_DDMACH2_DLEN_8814B) -+#define BITS_DDMACH2_DLEN_8814B \ -+ (BIT_MASK_DDMACH2_DLEN_8814B << BIT_SHIFT_DDMACH2_DLEN_8814B) -+#define BIT_CLEAR_DDMACH2_DLEN_8814B(x) ((x) & (~BITS_DDMACH2_DLEN_8814B)) -+#define BIT_GET_DDMACH2_DLEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DLEN_8814B) & BIT_MASK_DDMACH2_DLEN_8814B) -+#define BIT_SET_DDMACH2_DLEN_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH2_DLEN_8814B(x) | BIT_DDMACH2_DLEN_8814B(v)) -+ -+/* 2 REG_DDMA_CH3SA_8814B */ -+ -+#define BIT_SHIFT_DDMACH3_SA_8814B 0 -+#define BIT_MASK_DDMACH3_SA_8814B 0xffffffffL -+#define BIT_DDMACH3_SA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH3_SA_8814B) << BIT_SHIFT_DDMACH3_SA_8814B) -+#define BITS_DDMACH3_SA_8814B \ -+ (BIT_MASK_DDMACH3_SA_8814B << BIT_SHIFT_DDMACH3_SA_8814B) -+#define BIT_CLEAR_DDMACH3_SA_8814B(x) ((x) & (~BITS_DDMACH3_SA_8814B)) -+#define BIT_GET_DDMACH3_SA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_SA_8814B) & BIT_MASK_DDMACH3_SA_8814B) -+#define BIT_SET_DDMACH3_SA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH3_SA_8814B(x) | BIT_DDMACH3_SA_8814B(v)) -+ -+/* 2 REG_DDMA_CH3DA_8814B */ -+ -+#define BIT_SHIFT_DDMACH3_DA_8814B 0 -+#define BIT_MASK_DDMACH3_DA_8814B 0xffffffffL -+#define BIT_DDMACH3_DA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH3_DA_8814B) << BIT_SHIFT_DDMACH3_DA_8814B) -+#define BITS_DDMACH3_DA_8814B \ -+ (BIT_MASK_DDMACH3_DA_8814B << BIT_SHIFT_DDMACH3_DA_8814B) -+#define BIT_CLEAR_DDMACH3_DA_8814B(x) ((x) & (~BITS_DDMACH3_DA_8814B)) -+#define BIT_GET_DDMACH3_DA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DA_8814B) & BIT_MASK_DDMACH3_DA_8814B) -+#define BIT_SET_DDMACH3_DA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH3_DA_8814B(x) | BIT_DDMACH3_DA_8814B(v)) -+ -+/* 2 REG_DDMA_CH3CTRL_8814B */ -+#define BIT_DDMACH3_OWN_8814B BIT(31) -+#define BIT_DDMACH3_IDMEM_ERR_8814B BIT(30) -+#define BIT_DDMACH3_CHKSUM_EN_8814B BIT(29) -+#define BIT_DDMACH3_DA_W_DISABLE_8814B BIT(28) -+#define BIT_DDMACH3_CHKSUM_STS_8814B BIT(27) -+#define BIT_DDMACH3_DDMA_MODE_8814B BIT(26) -+#define BIT_DDMACH3_RESET_CHKSUM_STS_8814B BIT(25) -+#define BIT_DDMACH3_CHKSUM_CONT_8814B BIT(24) -+ -+#define BIT_SHIFT_DDMACH3_DLEN_8814B 0 -+#define BIT_MASK_DDMACH3_DLEN_8814B 0x3ffff -+#define BIT_DDMACH3_DLEN_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH3_DLEN_8814B) << BIT_SHIFT_DDMACH3_DLEN_8814B) -+#define BITS_DDMACH3_DLEN_8814B \ -+ (BIT_MASK_DDMACH3_DLEN_8814B << BIT_SHIFT_DDMACH3_DLEN_8814B) -+#define BIT_CLEAR_DDMACH3_DLEN_8814B(x) ((x) & (~BITS_DDMACH3_DLEN_8814B)) -+#define BIT_GET_DDMACH3_DLEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DLEN_8814B) & BIT_MASK_DDMACH3_DLEN_8814B) -+#define BIT_SET_DDMACH3_DLEN_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH3_DLEN_8814B(x) | BIT_DDMACH3_DLEN_8814B(v)) -+ -+/* 2 REG_DDMA_CH4SA_8814B */ -+ -+#define BIT_SHIFT_DDMACH4_SA_8814B 0 -+#define BIT_MASK_DDMACH4_SA_8814B 0xffffffffL -+#define BIT_DDMACH4_SA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH4_SA_8814B) << BIT_SHIFT_DDMACH4_SA_8814B) -+#define BITS_DDMACH4_SA_8814B \ -+ (BIT_MASK_DDMACH4_SA_8814B << BIT_SHIFT_DDMACH4_SA_8814B) -+#define BIT_CLEAR_DDMACH4_SA_8814B(x) ((x) & (~BITS_DDMACH4_SA_8814B)) -+#define BIT_GET_DDMACH4_SA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_SA_8814B) & BIT_MASK_DDMACH4_SA_8814B) -+#define BIT_SET_DDMACH4_SA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH4_SA_8814B(x) | BIT_DDMACH4_SA_8814B(v)) -+ -+/* 2 REG_DDMA_CH4DA_8814B */ -+ -+#define BIT_SHIFT_DDMACH4_DA_8814B 0 -+#define BIT_MASK_DDMACH4_DA_8814B 0xffffffffL -+#define BIT_DDMACH4_DA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH4_DA_8814B) << BIT_SHIFT_DDMACH4_DA_8814B) -+#define BITS_DDMACH4_DA_8814B \ -+ (BIT_MASK_DDMACH4_DA_8814B << BIT_SHIFT_DDMACH4_DA_8814B) -+#define BIT_CLEAR_DDMACH4_DA_8814B(x) ((x) & (~BITS_DDMACH4_DA_8814B)) -+#define BIT_GET_DDMACH4_DA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DA_8814B) & BIT_MASK_DDMACH4_DA_8814B) -+#define BIT_SET_DDMACH4_DA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH4_DA_8814B(x) | BIT_DDMACH4_DA_8814B(v)) -+ -+/* 2 REG_DDMA_CH4CTRL_8814B */ -+#define BIT_DDMACH4_OWN_8814B BIT(31) -+#define BIT_DDMACH4_IDMEM_ERR_8814B BIT(30) -+#define BIT_DDMACH4_CHKSUM_EN_8814B BIT(29) -+#define BIT_DDMACH4_DA_W_DISABLE_8814B BIT(28) -+#define BIT_DDMACH4_CHKSUM_STS_8814B BIT(27) -+#define BIT_DDMACH4_DDMA_MODE_8814B BIT(26) -+#define BIT_DDMACH4_RESET_CHKSUM_STS_8814B BIT(25) -+#define BIT_DDMACH4_CHKSUM_CONT_8814B BIT(24) -+ -+#define BIT_SHIFT_DDMACH4_DLEN_8814B 0 -+#define BIT_MASK_DDMACH4_DLEN_8814B 0x3ffff -+#define BIT_DDMACH4_DLEN_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH4_DLEN_8814B) << BIT_SHIFT_DDMACH4_DLEN_8814B) -+#define BITS_DDMACH4_DLEN_8814B \ -+ (BIT_MASK_DDMACH4_DLEN_8814B << BIT_SHIFT_DDMACH4_DLEN_8814B) -+#define BIT_CLEAR_DDMACH4_DLEN_8814B(x) ((x) & (~BITS_DDMACH4_DLEN_8814B)) -+#define BIT_GET_DDMACH4_DLEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DLEN_8814B) & BIT_MASK_DDMACH4_DLEN_8814B) -+#define BIT_SET_DDMACH4_DLEN_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH4_DLEN_8814B(x) | BIT_DDMACH4_DLEN_8814B(v)) -+ -+/* 2 REG_DDMA_CH5SA_8814B */ -+ -+#define BIT_SHIFT_DDMACH5_SA_8814B 0 -+#define BIT_MASK_DDMACH5_SA_8814B 0xffffffffL -+#define BIT_DDMACH5_SA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH5_SA_8814B) << BIT_SHIFT_DDMACH5_SA_8814B) -+#define BITS_DDMACH5_SA_8814B \ -+ (BIT_MASK_DDMACH5_SA_8814B << BIT_SHIFT_DDMACH5_SA_8814B) -+#define BIT_CLEAR_DDMACH5_SA_8814B(x) ((x) & (~BITS_DDMACH5_SA_8814B)) -+#define BIT_GET_DDMACH5_SA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_SA_8814B) & BIT_MASK_DDMACH5_SA_8814B) -+#define BIT_SET_DDMACH5_SA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH5_SA_8814B(x) | BIT_DDMACH5_SA_8814B(v)) -+ -+/* 2 REG_DDMA_CH5DA_8814B */ -+ -+#define BIT_SHIFT_DDMACH5_DA_8814B 0 -+#define BIT_MASK_DDMACH5_DA_8814B 0xffffffffL -+#define BIT_DDMACH5_DA_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH5_DA_8814B) << BIT_SHIFT_DDMACH5_DA_8814B) -+#define BITS_DDMACH5_DA_8814B \ -+ (BIT_MASK_DDMACH5_DA_8814B << BIT_SHIFT_DDMACH5_DA_8814B) -+#define BIT_CLEAR_DDMACH5_DA_8814B(x) ((x) & (~BITS_DDMACH5_DA_8814B)) -+#define BIT_GET_DDMACH5_DA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DA_8814B) & BIT_MASK_DDMACH5_DA_8814B) -+#define BIT_SET_DDMACH5_DA_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH5_DA_8814B(x) | BIT_DDMACH5_DA_8814B(v)) -+ -+/* 2 REG_DDMA_CH5CTRL_8814B */ -+#define BIT_DDMACH5_OWN_8814B BIT(31) -+#define BIT_DDMACH5_IDMEM_ERR_8814B BIT(30) -+#define BIT_DDMACH5_CHKSUM_EN_8814B BIT(29) -+#define BIT_DDMACH5_DA_W_DISABLE_8814B BIT(28) -+#define BIT_DDMACH5_CHKSUM_STS_8814B BIT(27) -+#define BIT_DDMACH5_DDMA_MODE_8814B BIT(26) -+#define BIT_DDMACH5_RESET_CHKSUM_STS_8814B BIT(25) -+#define BIT_DDMACH5_CHKSUM_CONT_8814B BIT(24) -+ -+#define BIT_SHIFT_DDMACH5_DLEN_8814B 0 -+#define BIT_MASK_DDMACH5_DLEN_8814B 0x3ffff -+#define BIT_DDMACH5_DLEN_8814B(x) \ -+ (((x) & BIT_MASK_DDMACH5_DLEN_8814B) << BIT_SHIFT_DDMACH5_DLEN_8814B) -+#define BITS_DDMACH5_DLEN_8814B \ -+ (BIT_MASK_DDMACH5_DLEN_8814B << BIT_SHIFT_DDMACH5_DLEN_8814B) -+#define BIT_CLEAR_DDMACH5_DLEN_8814B(x) ((x) & (~BITS_DDMACH5_DLEN_8814B)) -+#define BIT_GET_DDMACH5_DLEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DLEN_8814B) & BIT_MASK_DDMACH5_DLEN_8814B) -+#define BIT_SET_DDMACH5_DLEN_8814B(x, v) \ -+ (BIT_CLEAR_DDMACH5_DLEN_8814B(x) | BIT_DDMACH5_DLEN_8814B(v)) -+ -+/* 2 REG_DDMA_INT_MSK_8814B */ -+#define BIT_DDMACH5_MSK_8814B BIT(5) -+#define BIT_DDMACH4_MSK_8814B BIT(4) -+#define BIT_DDMACH3_MSK_8814B BIT(3) -+#define BIT_DDMACH2_MSK_8814B BIT(2) -+#define BIT_DDMACH1_MSK_8814B BIT(1) -+#define BIT_DDMACH0_MSK_8814B BIT(0) -+ -+/* 2 REG_DDMA_CHSTATUS_8814B */ -+#define BIT_DDMACH5_BUSY_8814B BIT(5) -+#define BIT_DDMACH4_BUSY_8814B BIT(4) -+#define BIT_DDMACH3_BUSY_8814B BIT(3) -+#define BIT_DDMACH2_BUSY_8814B BIT(2) -+#define BIT_DDMACH1_BUSY_8814B BIT(1) -+#define BIT_DDMACH0_BUSY_8814B BIT(0) -+ -+/* 2 REG_DDMA_CHKSUM_8814B */ -+ -+#define BIT_SHIFT_IDDMA0_CHKSUM_8814B 0 -+#define BIT_MASK_IDDMA0_CHKSUM_8814B 0xffff -+#define BIT_IDDMA0_CHKSUM_8814B(x) \ -+ (((x) & BIT_MASK_IDDMA0_CHKSUM_8814B) << BIT_SHIFT_IDDMA0_CHKSUM_8814B) -+#define BITS_IDDMA0_CHKSUM_8814B \ -+ (BIT_MASK_IDDMA0_CHKSUM_8814B << BIT_SHIFT_IDDMA0_CHKSUM_8814B) -+#define BIT_CLEAR_IDDMA0_CHKSUM_8814B(x) ((x) & (~BITS_IDDMA0_CHKSUM_8814B)) -+#define BIT_GET_IDDMA0_CHKSUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_IDDMA0_CHKSUM_8814B) & BIT_MASK_IDDMA0_CHKSUM_8814B) -+#define BIT_SET_IDDMA0_CHKSUM_8814B(x, v) \ -+ (BIT_CLEAR_IDDMA0_CHKSUM_8814B(x) | BIT_IDDMA0_CHKSUM_8814B(v)) -+ -+/* 2 REG_DDMA_MONITOR_8814B */ -+#define BIT_IDDMA0_PERMU_UNDERFLOW_8814B BIT(14) -+#define BIT_IDDMA0_FIFO_UNDERFLOW_8814B BIT(13) -+#define BIT_IDDMA0_FIFO_OVERFLOW_8814B BIT(12) -+#define BIT_CH5_ERR_8814B BIT(5) -+#define BIT_CH4_ERR_8814B BIT(4) -+#define BIT_CH3_ERR_8814B BIT(3) -+#define BIT_CH2_ERR_8814B BIT(2) -+#define BIT_CH1_ERR_8814B BIT(1) -+#define BIT_CH0_ERR_8814B BIT(0) -+ -+/* 2 REG_DMA_RQPN_INFO_0_8814B */ -+ -+#define BIT_SHIFT_CH0_AVAL_PG_8814B 16 -+#define BIT_MASK_CH0_AVAL_PG_8814B 0xfff -+#define BIT_CH0_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH0_AVAL_PG_8814B) << BIT_SHIFT_CH0_AVAL_PG_8814B) -+#define BITS_CH0_AVAL_PG_8814B \ -+ (BIT_MASK_CH0_AVAL_PG_8814B << BIT_SHIFT_CH0_AVAL_PG_8814B) -+#define BIT_CLEAR_CH0_AVAL_PG_8814B(x) ((x) & (~BITS_CH0_AVAL_PG_8814B)) -+#define BIT_GET_CH0_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH0_AVAL_PG_8814B) & BIT_MASK_CH0_AVAL_PG_8814B) -+#define BIT_SET_CH0_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH0_AVAL_PG_8814B(x) | BIT_CH0_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH0_RSVD_PG_8814B 0 -+#define BIT_MASK_CH0_RSVD_PG_8814B 0xfff -+#define BIT_CH0_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH0_RSVD_PG_8814B) << BIT_SHIFT_CH0_RSVD_PG_8814B) -+#define BITS_CH0_RSVD_PG_8814B \ -+ (BIT_MASK_CH0_RSVD_PG_8814B << BIT_SHIFT_CH0_RSVD_PG_8814B) -+#define BIT_CLEAR_CH0_RSVD_PG_8814B(x) ((x) & (~BITS_CH0_RSVD_PG_8814B)) -+#define BIT_GET_CH0_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH0_RSVD_PG_8814B) & BIT_MASK_CH0_RSVD_PG_8814B) -+#define BIT_SET_CH0_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH0_RSVD_PG_8814B(x) | BIT_CH0_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_1_8814B */ -+ -+#define BIT_SHIFT_CH1_AVAL_PG_8814B 16 -+#define BIT_MASK_CH1_AVAL_PG_8814B 0xfff -+#define BIT_CH1_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH1_AVAL_PG_8814B) << BIT_SHIFT_CH1_AVAL_PG_8814B) -+#define BITS_CH1_AVAL_PG_8814B \ -+ (BIT_MASK_CH1_AVAL_PG_8814B << BIT_SHIFT_CH1_AVAL_PG_8814B) -+#define BIT_CLEAR_CH1_AVAL_PG_8814B(x) ((x) & (~BITS_CH1_AVAL_PG_8814B)) -+#define BIT_GET_CH1_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH1_AVAL_PG_8814B) & BIT_MASK_CH1_AVAL_PG_8814B) -+#define BIT_SET_CH1_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH1_AVAL_PG_8814B(x) | BIT_CH1_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH1_RSVD_PG_8814B 0 -+#define BIT_MASK_CH1_RSVD_PG_8814B 0xfff -+#define BIT_CH1_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH1_RSVD_PG_8814B) << BIT_SHIFT_CH1_RSVD_PG_8814B) -+#define BITS_CH1_RSVD_PG_8814B \ -+ (BIT_MASK_CH1_RSVD_PG_8814B << BIT_SHIFT_CH1_RSVD_PG_8814B) -+#define BIT_CLEAR_CH1_RSVD_PG_8814B(x) ((x) & (~BITS_CH1_RSVD_PG_8814B)) -+#define BIT_GET_CH1_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH1_RSVD_PG_8814B) & BIT_MASK_CH1_RSVD_PG_8814B) -+#define BIT_SET_CH1_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH1_RSVD_PG_8814B(x) | BIT_CH1_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_2_8814B */ -+ -+#define BIT_SHIFT_CH2_AVAL_PG_8814B 16 -+#define BIT_MASK_CH2_AVAL_PG_8814B 0xfff -+#define BIT_CH2_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH2_AVAL_PG_8814B) << BIT_SHIFT_CH2_AVAL_PG_8814B) -+#define BITS_CH2_AVAL_PG_8814B \ -+ (BIT_MASK_CH2_AVAL_PG_8814B << BIT_SHIFT_CH2_AVAL_PG_8814B) -+#define BIT_CLEAR_CH2_AVAL_PG_8814B(x) ((x) & (~BITS_CH2_AVAL_PG_8814B)) -+#define BIT_GET_CH2_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH2_AVAL_PG_8814B) & BIT_MASK_CH2_AVAL_PG_8814B) -+#define BIT_SET_CH2_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH2_AVAL_PG_8814B(x) | BIT_CH2_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH2_RSVD_PG_8814B 0 -+#define BIT_MASK_CH2_RSVD_PG_8814B 0xfff -+#define BIT_CH2_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH2_RSVD_PG_8814B) << BIT_SHIFT_CH2_RSVD_PG_8814B) -+#define BITS_CH2_RSVD_PG_8814B \ -+ (BIT_MASK_CH2_RSVD_PG_8814B << BIT_SHIFT_CH2_RSVD_PG_8814B) -+#define BIT_CLEAR_CH2_RSVD_PG_8814B(x) ((x) & (~BITS_CH2_RSVD_PG_8814B)) -+#define BIT_GET_CH2_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH2_RSVD_PG_8814B) & BIT_MASK_CH2_RSVD_PG_8814B) -+#define BIT_SET_CH2_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH2_RSVD_PG_8814B(x) | BIT_CH2_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_3_8814B */ -+ -+#define BIT_SHIFT_CH3_AVAL_PG_8814B 16 -+#define BIT_MASK_CH3_AVAL_PG_8814B 0xfff -+#define BIT_CH3_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH3_AVAL_PG_8814B) << BIT_SHIFT_CH3_AVAL_PG_8814B) -+#define BITS_CH3_AVAL_PG_8814B \ -+ (BIT_MASK_CH3_AVAL_PG_8814B << BIT_SHIFT_CH3_AVAL_PG_8814B) -+#define BIT_CLEAR_CH3_AVAL_PG_8814B(x) ((x) & (~BITS_CH3_AVAL_PG_8814B)) -+#define BIT_GET_CH3_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH3_AVAL_PG_8814B) & BIT_MASK_CH3_AVAL_PG_8814B) -+#define BIT_SET_CH3_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH3_AVAL_PG_8814B(x) | BIT_CH3_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH3_RSVD_PG_8814B 0 -+#define BIT_MASK_CH3_RSVD_PG_8814B 0xfff -+#define BIT_CH3_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH3_RSVD_PG_8814B) << BIT_SHIFT_CH3_RSVD_PG_8814B) -+#define BITS_CH3_RSVD_PG_8814B \ -+ (BIT_MASK_CH3_RSVD_PG_8814B << BIT_SHIFT_CH3_RSVD_PG_8814B) -+#define BIT_CLEAR_CH3_RSVD_PG_8814B(x) ((x) & (~BITS_CH3_RSVD_PG_8814B)) -+#define BIT_GET_CH3_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH3_RSVD_PG_8814B) & BIT_MASK_CH3_RSVD_PG_8814B) -+#define BIT_SET_CH3_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH3_RSVD_PG_8814B(x) | BIT_CH3_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_4_8814B */ -+ -+#define BIT_SHIFT_CH4_AVAL_PG_8814B 16 -+#define BIT_MASK_CH4_AVAL_PG_8814B 0xfff -+#define BIT_CH4_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH4_AVAL_PG_8814B) << BIT_SHIFT_CH4_AVAL_PG_8814B) -+#define BITS_CH4_AVAL_PG_8814B \ -+ (BIT_MASK_CH4_AVAL_PG_8814B << BIT_SHIFT_CH4_AVAL_PG_8814B) -+#define BIT_CLEAR_CH4_AVAL_PG_8814B(x) ((x) & (~BITS_CH4_AVAL_PG_8814B)) -+#define BIT_GET_CH4_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH4_AVAL_PG_8814B) & BIT_MASK_CH4_AVAL_PG_8814B) -+#define BIT_SET_CH4_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH4_AVAL_PG_8814B(x) | BIT_CH4_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH4_RSVD_PG_8814B 0 -+#define BIT_MASK_CH4_RSVD_PG_8814B 0xfff -+#define BIT_CH4_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH4_RSVD_PG_8814B) << BIT_SHIFT_CH4_RSVD_PG_8814B) -+#define BITS_CH4_RSVD_PG_8814B \ -+ (BIT_MASK_CH4_RSVD_PG_8814B << BIT_SHIFT_CH4_RSVD_PG_8814B) -+#define BIT_CLEAR_CH4_RSVD_PG_8814B(x) ((x) & (~BITS_CH4_RSVD_PG_8814B)) -+#define BIT_GET_CH4_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH4_RSVD_PG_8814B) & BIT_MASK_CH4_RSVD_PG_8814B) -+#define BIT_SET_CH4_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH4_RSVD_PG_8814B(x) | BIT_CH4_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_5_8814B */ -+ -+#define BIT_SHIFT_CH5_AVAL_PG_8814B 16 -+#define BIT_MASK_CH5_AVAL_PG_8814B 0xfff -+#define BIT_CH5_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH5_AVAL_PG_8814B) << BIT_SHIFT_CH5_AVAL_PG_8814B) -+#define BITS_CH5_AVAL_PG_8814B \ -+ (BIT_MASK_CH5_AVAL_PG_8814B << BIT_SHIFT_CH5_AVAL_PG_8814B) -+#define BIT_CLEAR_CH5_AVAL_PG_8814B(x) ((x) & (~BITS_CH5_AVAL_PG_8814B)) -+#define BIT_GET_CH5_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH5_AVAL_PG_8814B) & BIT_MASK_CH5_AVAL_PG_8814B) -+#define BIT_SET_CH5_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH5_AVAL_PG_8814B(x) | BIT_CH5_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH5_RSVD_PG_8814B 0 -+#define BIT_MASK_CH5_RSVD_PG_8814B 0xfff -+#define BIT_CH5_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH5_RSVD_PG_8814B) << BIT_SHIFT_CH5_RSVD_PG_8814B) -+#define BITS_CH5_RSVD_PG_8814B \ -+ (BIT_MASK_CH5_RSVD_PG_8814B << BIT_SHIFT_CH5_RSVD_PG_8814B) -+#define BIT_CLEAR_CH5_RSVD_PG_8814B(x) ((x) & (~BITS_CH5_RSVD_PG_8814B)) -+#define BIT_GET_CH5_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH5_RSVD_PG_8814B) & BIT_MASK_CH5_RSVD_PG_8814B) -+#define BIT_SET_CH5_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH5_RSVD_PG_8814B(x) | BIT_CH5_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_6_8814B */ -+ -+#define BIT_SHIFT_CH6_AVAL_PG_8814B 16 -+#define BIT_MASK_CH6_AVAL_PG_8814B 0xfff -+#define BIT_CH6_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH6_AVAL_PG_8814B) << BIT_SHIFT_CH6_AVAL_PG_8814B) -+#define BITS_CH6_AVAL_PG_8814B \ -+ (BIT_MASK_CH6_AVAL_PG_8814B << BIT_SHIFT_CH6_AVAL_PG_8814B) -+#define BIT_CLEAR_CH6_AVAL_PG_8814B(x) ((x) & (~BITS_CH6_AVAL_PG_8814B)) -+#define BIT_GET_CH6_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH6_AVAL_PG_8814B) & BIT_MASK_CH6_AVAL_PG_8814B) -+#define BIT_SET_CH6_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH6_AVAL_PG_8814B(x) | BIT_CH6_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH6_RSVD_PG_8814B 0 -+#define BIT_MASK_CH6_RSVD_PG_8814B 0xfff -+#define BIT_CH6_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH6_RSVD_PG_8814B) << BIT_SHIFT_CH6_RSVD_PG_8814B) -+#define BITS_CH6_RSVD_PG_8814B \ -+ (BIT_MASK_CH6_RSVD_PG_8814B << BIT_SHIFT_CH6_RSVD_PG_8814B) -+#define BIT_CLEAR_CH6_RSVD_PG_8814B(x) ((x) & (~BITS_CH6_RSVD_PG_8814B)) -+#define BIT_GET_CH6_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH6_RSVD_PG_8814B) & BIT_MASK_CH6_RSVD_PG_8814B) -+#define BIT_SET_CH6_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH6_RSVD_PG_8814B(x) | BIT_CH6_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_7_8814B */ -+ -+#define BIT_SHIFT_CH7_AVAL_PG_8814B 16 -+#define BIT_MASK_CH7_AVAL_PG_8814B 0xfff -+#define BIT_CH7_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH7_AVAL_PG_8814B) << BIT_SHIFT_CH7_AVAL_PG_8814B) -+#define BITS_CH7_AVAL_PG_8814B \ -+ (BIT_MASK_CH7_AVAL_PG_8814B << BIT_SHIFT_CH7_AVAL_PG_8814B) -+#define BIT_CLEAR_CH7_AVAL_PG_8814B(x) ((x) & (~BITS_CH7_AVAL_PG_8814B)) -+#define BIT_GET_CH7_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH7_AVAL_PG_8814B) & BIT_MASK_CH7_AVAL_PG_8814B) -+#define BIT_SET_CH7_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH7_AVAL_PG_8814B(x) | BIT_CH7_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH7_RSVD_PG_8814B 0 -+#define BIT_MASK_CH7_RSVD_PG_8814B 0xfff -+#define BIT_CH7_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH7_RSVD_PG_8814B) << BIT_SHIFT_CH7_RSVD_PG_8814B) -+#define BITS_CH7_RSVD_PG_8814B \ -+ (BIT_MASK_CH7_RSVD_PG_8814B << BIT_SHIFT_CH7_RSVD_PG_8814B) -+#define BIT_CLEAR_CH7_RSVD_PG_8814B(x) ((x) & (~BITS_CH7_RSVD_PG_8814B)) -+#define BIT_GET_CH7_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH7_RSVD_PG_8814B) & BIT_MASK_CH7_RSVD_PG_8814B) -+#define BIT_SET_CH7_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH7_RSVD_PG_8814B(x) | BIT_CH7_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_8_8814B */ -+ -+#define BIT_SHIFT_CH8_AVAL_PG_8814B 16 -+#define BIT_MASK_CH8_AVAL_PG_8814B 0xfff -+#define BIT_CH8_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH8_AVAL_PG_8814B) << BIT_SHIFT_CH8_AVAL_PG_8814B) -+#define BITS_CH8_AVAL_PG_8814B \ -+ (BIT_MASK_CH8_AVAL_PG_8814B << BIT_SHIFT_CH8_AVAL_PG_8814B) -+#define BIT_CLEAR_CH8_AVAL_PG_8814B(x) ((x) & (~BITS_CH8_AVAL_PG_8814B)) -+#define BIT_GET_CH8_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH8_AVAL_PG_8814B) & BIT_MASK_CH8_AVAL_PG_8814B) -+#define BIT_SET_CH8_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH8_AVAL_PG_8814B(x) | BIT_CH8_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH8_RSVD_PG_8814B 0 -+#define BIT_MASK_CH8_RSVD_PG_8814B 0xfff -+#define BIT_CH8_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH8_RSVD_PG_8814B) << BIT_SHIFT_CH8_RSVD_PG_8814B) -+#define BITS_CH8_RSVD_PG_8814B \ -+ (BIT_MASK_CH8_RSVD_PG_8814B << BIT_SHIFT_CH8_RSVD_PG_8814B) -+#define BIT_CLEAR_CH8_RSVD_PG_8814B(x) ((x) & (~BITS_CH8_RSVD_PG_8814B)) -+#define BIT_GET_CH8_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH8_RSVD_PG_8814B) & BIT_MASK_CH8_RSVD_PG_8814B) -+#define BIT_SET_CH8_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH8_RSVD_PG_8814B(x) | BIT_CH8_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_9_8814B */ -+ -+#define BIT_SHIFT_CH9_AVAL_PG_8814B 16 -+#define BIT_MASK_CH9_AVAL_PG_8814B 0xfff -+#define BIT_CH9_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH9_AVAL_PG_8814B) << BIT_SHIFT_CH9_AVAL_PG_8814B) -+#define BITS_CH9_AVAL_PG_8814B \ -+ (BIT_MASK_CH9_AVAL_PG_8814B << BIT_SHIFT_CH9_AVAL_PG_8814B) -+#define BIT_CLEAR_CH9_AVAL_PG_8814B(x) ((x) & (~BITS_CH9_AVAL_PG_8814B)) -+#define BIT_GET_CH9_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH9_AVAL_PG_8814B) & BIT_MASK_CH9_AVAL_PG_8814B) -+#define BIT_SET_CH9_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH9_AVAL_PG_8814B(x) | BIT_CH9_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH9_RSVD_PG_8814B 0 -+#define BIT_MASK_CH9_RSVD_PG_8814B 0xfff -+#define BIT_CH9_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH9_RSVD_PG_8814B) << BIT_SHIFT_CH9_RSVD_PG_8814B) -+#define BITS_CH9_RSVD_PG_8814B \ -+ (BIT_MASK_CH9_RSVD_PG_8814B << BIT_SHIFT_CH9_RSVD_PG_8814B) -+#define BIT_CLEAR_CH9_RSVD_PG_8814B(x) ((x) & (~BITS_CH9_RSVD_PG_8814B)) -+#define BIT_GET_CH9_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH9_RSVD_PG_8814B) & BIT_MASK_CH9_RSVD_PG_8814B) -+#define BIT_SET_CH9_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH9_RSVD_PG_8814B(x) | BIT_CH9_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_10_8814B */ -+ -+#define BIT_SHIFT_CH10_AVAL_PG_8814B 16 -+#define BIT_MASK_CH10_AVAL_PG_8814B 0xfff -+#define BIT_CH10_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH10_AVAL_PG_8814B) << BIT_SHIFT_CH10_AVAL_PG_8814B) -+#define BITS_CH10_AVAL_PG_8814B \ -+ (BIT_MASK_CH10_AVAL_PG_8814B << BIT_SHIFT_CH10_AVAL_PG_8814B) -+#define BIT_CLEAR_CH10_AVAL_PG_8814B(x) ((x) & (~BITS_CH10_AVAL_PG_8814B)) -+#define BIT_GET_CH10_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH10_AVAL_PG_8814B) & BIT_MASK_CH10_AVAL_PG_8814B) -+#define BIT_SET_CH10_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH10_AVAL_PG_8814B(x) | BIT_CH10_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH10_RSVD_PG_8814B 0 -+#define BIT_MASK_CH10_RSVD_PG_8814B 0xfff -+#define BIT_CH10_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH10_RSVD_PG_8814B) << BIT_SHIFT_CH10_RSVD_PG_8814B) -+#define BITS_CH10_RSVD_PG_8814B \ -+ (BIT_MASK_CH10_RSVD_PG_8814B << BIT_SHIFT_CH10_RSVD_PG_8814B) -+#define BIT_CLEAR_CH10_RSVD_PG_8814B(x) ((x) & (~BITS_CH10_RSVD_PG_8814B)) -+#define BIT_GET_CH10_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH10_RSVD_PG_8814B) & BIT_MASK_CH10_RSVD_PG_8814B) -+#define BIT_SET_CH10_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH10_RSVD_PG_8814B(x) | BIT_CH10_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_11_8814B */ -+ -+#define BIT_SHIFT_CH11_AVAL_PG_8814B 16 -+#define BIT_MASK_CH11_AVAL_PG_8814B 0xfff -+#define BIT_CH11_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH11_AVAL_PG_8814B) << BIT_SHIFT_CH11_AVAL_PG_8814B) -+#define BITS_CH11_AVAL_PG_8814B \ -+ (BIT_MASK_CH11_AVAL_PG_8814B << BIT_SHIFT_CH11_AVAL_PG_8814B) -+#define BIT_CLEAR_CH11_AVAL_PG_8814B(x) ((x) & (~BITS_CH11_AVAL_PG_8814B)) -+#define BIT_GET_CH11_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH11_AVAL_PG_8814B) & BIT_MASK_CH11_AVAL_PG_8814B) -+#define BIT_SET_CH11_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH11_AVAL_PG_8814B(x) | BIT_CH11_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH11_RSVD_PG_8814B 0 -+#define BIT_MASK_CH11_RSVD_PG_8814B 0xfff -+#define BIT_CH11_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH11_RSVD_PG_8814B) << BIT_SHIFT_CH11_RSVD_PG_8814B) -+#define BITS_CH11_RSVD_PG_8814B \ -+ (BIT_MASK_CH11_RSVD_PG_8814B << BIT_SHIFT_CH11_RSVD_PG_8814B) -+#define BIT_CLEAR_CH11_RSVD_PG_8814B(x) ((x) & (~BITS_CH11_RSVD_PG_8814B)) -+#define BIT_GET_CH11_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH11_RSVD_PG_8814B) & BIT_MASK_CH11_RSVD_PG_8814B) -+#define BIT_SET_CH11_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH11_RSVD_PG_8814B(x) | BIT_CH11_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_12_8814B */ -+ -+#define BIT_SHIFT_CH12_AVAL_PG_8814B 16 -+#define BIT_MASK_CH12_AVAL_PG_8814B 0xfff -+#define BIT_CH12_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH12_AVAL_PG_8814B) << BIT_SHIFT_CH12_AVAL_PG_8814B) -+#define BITS_CH12_AVAL_PG_8814B \ -+ (BIT_MASK_CH12_AVAL_PG_8814B << BIT_SHIFT_CH12_AVAL_PG_8814B) -+#define BIT_CLEAR_CH12_AVAL_PG_8814B(x) ((x) & (~BITS_CH12_AVAL_PG_8814B)) -+#define BIT_GET_CH12_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH12_AVAL_PG_8814B) & BIT_MASK_CH12_AVAL_PG_8814B) -+#define BIT_SET_CH12_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH12_AVAL_PG_8814B(x) | BIT_CH12_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH12_RSVD_PG_8814B 0 -+#define BIT_MASK_CH12_RSVD_PG_8814B 0xfff -+#define BIT_CH12_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH12_RSVD_PG_8814B) << BIT_SHIFT_CH12_RSVD_PG_8814B) -+#define BITS_CH12_RSVD_PG_8814B \ -+ (BIT_MASK_CH12_RSVD_PG_8814B << BIT_SHIFT_CH12_RSVD_PG_8814B) -+#define BIT_CLEAR_CH12_RSVD_PG_8814B(x) ((x) & (~BITS_CH12_RSVD_PG_8814B)) -+#define BIT_GET_CH12_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH12_RSVD_PG_8814B) & BIT_MASK_CH12_RSVD_PG_8814B) -+#define BIT_SET_CH12_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH12_RSVD_PG_8814B(x) | BIT_CH12_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_13_8814B */ -+ -+#define BIT_SHIFT_CH13_AVAL_PG_8814B 16 -+#define BIT_MASK_CH13_AVAL_PG_8814B 0xfff -+#define BIT_CH13_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH13_AVAL_PG_8814B) << BIT_SHIFT_CH13_AVAL_PG_8814B) -+#define BITS_CH13_AVAL_PG_8814B \ -+ (BIT_MASK_CH13_AVAL_PG_8814B << BIT_SHIFT_CH13_AVAL_PG_8814B) -+#define BIT_CLEAR_CH13_AVAL_PG_8814B(x) ((x) & (~BITS_CH13_AVAL_PG_8814B)) -+#define BIT_GET_CH13_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH13_AVAL_PG_8814B) & BIT_MASK_CH13_AVAL_PG_8814B) -+#define BIT_SET_CH13_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH13_AVAL_PG_8814B(x) | BIT_CH13_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH13_RSVD_PG_8814B 0 -+#define BIT_MASK_CH13_RSVD_PG_8814B 0xfff -+#define BIT_CH13_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH13_RSVD_PG_8814B) << BIT_SHIFT_CH13_RSVD_PG_8814B) -+#define BITS_CH13_RSVD_PG_8814B \ -+ (BIT_MASK_CH13_RSVD_PG_8814B << BIT_SHIFT_CH13_RSVD_PG_8814B) -+#define BIT_CLEAR_CH13_RSVD_PG_8814B(x) ((x) & (~BITS_CH13_RSVD_PG_8814B)) -+#define BIT_GET_CH13_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH13_RSVD_PG_8814B) & BIT_MASK_CH13_RSVD_PG_8814B) -+#define BIT_SET_CH13_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH13_RSVD_PG_8814B(x) | BIT_CH13_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_14_8814B */ -+ -+#define BIT_SHIFT_CH14_AVAL_PG_8814B 16 -+#define BIT_MASK_CH14_AVAL_PG_8814B 0xfff -+#define BIT_CH14_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH14_AVAL_PG_8814B) << BIT_SHIFT_CH14_AVAL_PG_8814B) -+#define BITS_CH14_AVAL_PG_8814B \ -+ (BIT_MASK_CH14_AVAL_PG_8814B << BIT_SHIFT_CH14_AVAL_PG_8814B) -+#define BIT_CLEAR_CH14_AVAL_PG_8814B(x) ((x) & (~BITS_CH14_AVAL_PG_8814B)) -+#define BIT_GET_CH14_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH14_AVAL_PG_8814B) & BIT_MASK_CH14_AVAL_PG_8814B) -+#define BIT_SET_CH14_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH14_AVAL_PG_8814B(x) | BIT_CH14_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH14_RSVD_PG_8814B 0 -+#define BIT_MASK_CH14_RSVD_PG_8814B 0xfff -+#define BIT_CH14_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH14_RSVD_PG_8814B) << BIT_SHIFT_CH14_RSVD_PG_8814B) -+#define BITS_CH14_RSVD_PG_8814B \ -+ (BIT_MASK_CH14_RSVD_PG_8814B << BIT_SHIFT_CH14_RSVD_PG_8814B) -+#define BIT_CLEAR_CH14_RSVD_PG_8814B(x) ((x) & (~BITS_CH14_RSVD_PG_8814B)) -+#define BIT_GET_CH14_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH14_RSVD_PG_8814B) & BIT_MASK_CH14_RSVD_PG_8814B) -+#define BIT_SET_CH14_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH14_RSVD_PG_8814B(x) | BIT_CH14_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_15_8814B */ -+ -+#define BIT_SHIFT_CH15_AVAL_PG_8814B 16 -+#define BIT_MASK_CH15_AVAL_PG_8814B 0xfff -+#define BIT_CH15_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH15_AVAL_PG_8814B) << BIT_SHIFT_CH15_AVAL_PG_8814B) -+#define BITS_CH15_AVAL_PG_8814B \ -+ (BIT_MASK_CH15_AVAL_PG_8814B << BIT_SHIFT_CH15_AVAL_PG_8814B) -+#define BIT_CLEAR_CH15_AVAL_PG_8814B(x) ((x) & (~BITS_CH15_AVAL_PG_8814B)) -+#define BIT_GET_CH15_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH15_AVAL_PG_8814B) & BIT_MASK_CH15_AVAL_PG_8814B) -+#define BIT_SET_CH15_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH15_AVAL_PG_8814B(x) | BIT_CH15_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH15_RSVD_PG_8814B 0 -+#define BIT_MASK_CH15_RSVD_PG_8814B 0xfff -+#define BIT_CH15_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH15_RSVD_PG_8814B) << BIT_SHIFT_CH15_RSVD_PG_8814B) -+#define BITS_CH15_RSVD_PG_8814B \ -+ (BIT_MASK_CH15_RSVD_PG_8814B << BIT_SHIFT_CH15_RSVD_PG_8814B) -+#define BIT_CLEAR_CH15_RSVD_PG_8814B(x) ((x) & (~BITS_CH15_RSVD_PG_8814B)) -+#define BIT_GET_CH15_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH15_RSVD_PG_8814B) & BIT_MASK_CH15_RSVD_PG_8814B) -+#define BIT_SET_CH15_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH15_RSVD_PG_8814B(x) | BIT_CH15_RSVD_PG_8814B(v)) -+ -+/* 2 REG_DMA_RQPN_INFO_16_8814B */ -+ -+#define BIT_SHIFT_CH16_AVAL_PG_8814B 16 -+#define BIT_MASK_CH16_AVAL_PG_8814B 0xfff -+#define BIT_CH16_AVAL_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH16_AVAL_PG_8814B) << BIT_SHIFT_CH16_AVAL_PG_8814B) -+#define BITS_CH16_AVAL_PG_8814B \ -+ (BIT_MASK_CH16_AVAL_PG_8814B << BIT_SHIFT_CH16_AVAL_PG_8814B) -+#define BIT_CLEAR_CH16_AVAL_PG_8814B(x) ((x) & (~BITS_CH16_AVAL_PG_8814B)) -+#define BIT_GET_CH16_AVAL_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH16_AVAL_PG_8814B) & BIT_MASK_CH16_AVAL_PG_8814B) -+#define BIT_SET_CH16_AVAL_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH16_AVAL_PG_8814B(x) | BIT_CH16_AVAL_PG_8814B(v)) -+ -+#define BIT_SHIFT_CH16_RSVD_PG_8814B 0 -+#define BIT_MASK_CH16_RSVD_PG_8814B 0xfff -+#define BIT_CH16_RSVD_PG_8814B(x) \ -+ (((x) & BIT_MASK_CH16_RSVD_PG_8814B) << BIT_SHIFT_CH16_RSVD_PG_8814B) -+#define BITS_CH16_RSVD_PG_8814B \ -+ (BIT_MASK_CH16_RSVD_PG_8814B << BIT_SHIFT_CH16_RSVD_PG_8814B) -+#define BIT_CLEAR_CH16_RSVD_PG_8814B(x) ((x) & (~BITS_CH16_RSVD_PG_8814B)) -+#define BIT_GET_CH16_RSVD_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH16_RSVD_PG_8814B) & BIT_MASK_CH16_RSVD_PG_8814B) -+#define BIT_SET_CH16_RSVD_PG_8814B(x, v) \ -+ (BIT_CLEAR_CH16_RSVD_PG_8814B(x) | BIT_CH16_RSVD_PG_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_HWAMSDU_CTL1_8814B */ -+ -+#define BIT_SHIFT_HWAMSDU_PKTNUM_8814B 8 -+#define BIT_MASK_HWAMSDU_PKTNUM_8814B 0x3f -+#define BIT_HWAMSDU_PKTNUM_8814B(x) \ -+ (((x) & BIT_MASK_HWAMSDU_PKTNUM_8814B) \ -+ << BIT_SHIFT_HWAMSDU_PKTNUM_8814B) -+#define BITS_HWAMSDU_PKTNUM_8814B \ -+ (BIT_MASK_HWAMSDU_PKTNUM_8814B << BIT_SHIFT_HWAMSDU_PKTNUM_8814B) -+#define BIT_CLEAR_HWAMSDU_PKTNUM_8814B(x) ((x) & (~BITS_HWAMSDU_PKTNUM_8814B)) -+#define BIT_GET_HWAMSDU_PKTNUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_HWAMSDU_PKTNUM_8814B) & \ -+ BIT_MASK_HWAMSDU_PKTNUM_8814B) -+#define BIT_SET_HWAMSDU_PKTNUM_8814B(x, v) \ -+ (BIT_CLEAR_HWAMSDU_PKTNUM_8814B(x) | BIT_HWAMSDU_PKTNUM_8814B(v)) -+ -+#define BIT_HWAMSDU_BUSY_8814B BIT(7) -+#define BIT_SINGLE_AMSDU_8814B BIT(2) -+#define BIT_HWAMSDU_PADDING_MODE_8814B BIT(1) -+#define BIT_HWAMSDU_EN_8814B BIT(0) -+ -+/* 2 REG_HWAMSDU_CTL2_8814B */ -+ -+#define BIT_SHIFT_HWAMSDU_AMSDU_TIMEOUT_8814B 16 -+#define BIT_MASK_HWAMSDU_AMSDU_TIMEOUT_8814B 0xffff -+#define BIT_HWAMSDU_AMSDU_TIMEOUT_8814B(x) \ -+ (((x) & BIT_MASK_HWAMSDU_AMSDU_TIMEOUT_8814B) \ -+ << BIT_SHIFT_HWAMSDU_AMSDU_TIMEOUT_8814B) -+#define BITS_HWAMSDU_AMSDU_TIMEOUT_8814B \ -+ (BIT_MASK_HWAMSDU_AMSDU_TIMEOUT_8814B \ -+ << BIT_SHIFT_HWAMSDU_AMSDU_TIMEOUT_8814B) -+#define BIT_CLEAR_HWAMSDU_AMSDU_TIMEOUT_8814B(x) \ -+ ((x) & (~BITS_HWAMSDU_AMSDU_TIMEOUT_8814B)) -+#define BIT_GET_HWAMSDU_AMSDU_TIMEOUT_8814B(x) \ -+ (((x) >> BIT_SHIFT_HWAMSDU_AMSDU_TIMEOUT_8814B) & \ -+ BIT_MASK_HWAMSDU_AMSDU_TIMEOUT_8814B) -+#define BIT_SET_HWAMSDU_AMSDU_TIMEOUT_8814B(x, v) \ -+ (BIT_CLEAR_HWAMSDU_AMSDU_TIMEOUT_8814B(x) | \ -+ BIT_HWAMSDU_AMSDU_TIMEOUT_8814B(v)) -+ -+#define BIT_SHIFT_HWAMSDU_MSDU_TIMEOUT_8814B 0 -+#define BIT_MASK_HWAMSDU_MSDU_TIMEOUT_8814B 0xffff -+#define BIT_HWAMSDU_MSDU_TIMEOUT_8814B(x) \ -+ (((x) & BIT_MASK_HWAMSDU_MSDU_TIMEOUT_8814B) \ -+ << BIT_SHIFT_HWAMSDU_MSDU_TIMEOUT_8814B) -+#define BITS_HWAMSDU_MSDU_TIMEOUT_8814B \ -+ (BIT_MASK_HWAMSDU_MSDU_TIMEOUT_8814B \ -+ << BIT_SHIFT_HWAMSDU_MSDU_TIMEOUT_8814B) -+#define BIT_CLEAR_HWAMSDU_MSDU_TIMEOUT_8814B(x) \ -+ ((x) & (~BITS_HWAMSDU_MSDU_TIMEOUT_8814B)) -+#define BIT_GET_HWAMSDU_MSDU_TIMEOUT_8814B(x) \ -+ (((x) >> BIT_SHIFT_HWAMSDU_MSDU_TIMEOUT_8814B) & \ -+ BIT_MASK_HWAMSDU_MSDU_TIMEOUT_8814B) -+#define BIT_SET_HWAMSDU_MSDU_TIMEOUT_8814B(x, v) \ -+ (BIT_CLEAR_HWAMSDU_MSDU_TIMEOUT_8814B(x) | \ -+ BIT_HWAMSDU_MSDU_TIMEOUT_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_0_8814B */ -+#define BIT_CH0_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH0_HIGH_TH_8814B 16 -+#define BIT_MASK_CH0_HIGH_TH_8814B 0xfff -+#define BIT_CH0_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH0_HIGH_TH_8814B) << BIT_SHIFT_CH0_HIGH_TH_8814B) -+#define BITS_CH0_HIGH_TH_8814B \ -+ (BIT_MASK_CH0_HIGH_TH_8814B << BIT_SHIFT_CH0_HIGH_TH_8814B) -+#define BIT_CLEAR_CH0_HIGH_TH_8814B(x) ((x) & (~BITS_CH0_HIGH_TH_8814B)) -+#define BIT_GET_CH0_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH0_HIGH_TH_8814B) & BIT_MASK_CH0_HIGH_TH_8814B) -+#define BIT_SET_CH0_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH0_HIGH_TH_8814B(x) | BIT_CH0_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH0_LOW_TH_8814B 0 -+#define BIT_MASK_CH0_LOW_TH_8814B 0xfff -+#define BIT_CH0_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH0_LOW_TH_8814B) << BIT_SHIFT_CH0_LOW_TH_8814B) -+#define BITS_CH0_LOW_TH_8814B \ -+ (BIT_MASK_CH0_LOW_TH_8814B << BIT_SHIFT_CH0_LOW_TH_8814B) -+#define BIT_CLEAR_CH0_LOW_TH_8814B(x) ((x) & (~BITS_CH0_LOW_TH_8814B)) -+#define BIT_GET_CH0_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH0_LOW_TH_8814B) & BIT_MASK_CH0_LOW_TH_8814B) -+#define BIT_SET_CH0_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH0_LOW_TH_8814B(x) | BIT_CH0_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_1_8814B */ -+#define BIT_CH1_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH1_HIGH_TH_8814B 16 -+#define BIT_MASK_CH1_HIGH_TH_8814B 0xfff -+#define BIT_CH1_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH1_HIGH_TH_8814B) << BIT_SHIFT_CH1_HIGH_TH_8814B) -+#define BITS_CH1_HIGH_TH_8814B \ -+ (BIT_MASK_CH1_HIGH_TH_8814B << BIT_SHIFT_CH1_HIGH_TH_8814B) -+#define BIT_CLEAR_CH1_HIGH_TH_8814B(x) ((x) & (~BITS_CH1_HIGH_TH_8814B)) -+#define BIT_GET_CH1_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH1_HIGH_TH_8814B) & BIT_MASK_CH1_HIGH_TH_8814B) -+#define BIT_SET_CH1_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH1_HIGH_TH_8814B(x) | BIT_CH1_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH1_LOW_TH_8814B 0 -+#define BIT_MASK_CH1_LOW_TH_8814B 0xfff -+#define BIT_CH1_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH1_LOW_TH_8814B) << BIT_SHIFT_CH1_LOW_TH_8814B) -+#define BITS_CH1_LOW_TH_8814B \ -+ (BIT_MASK_CH1_LOW_TH_8814B << BIT_SHIFT_CH1_LOW_TH_8814B) -+#define BIT_CLEAR_CH1_LOW_TH_8814B(x) ((x) & (~BITS_CH1_LOW_TH_8814B)) -+#define BIT_GET_CH1_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH1_LOW_TH_8814B) & BIT_MASK_CH1_LOW_TH_8814B) -+#define BIT_SET_CH1_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH1_LOW_TH_8814B(x) | BIT_CH1_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_2_8814B */ -+#define BIT_CH2_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH2_HIGH_TH_8814B 16 -+#define BIT_MASK_CH2_HIGH_TH_8814B 0xfff -+#define BIT_CH2_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH2_HIGH_TH_8814B) << BIT_SHIFT_CH2_HIGH_TH_8814B) -+#define BITS_CH2_HIGH_TH_8814B \ -+ (BIT_MASK_CH2_HIGH_TH_8814B << BIT_SHIFT_CH2_HIGH_TH_8814B) -+#define BIT_CLEAR_CH2_HIGH_TH_8814B(x) ((x) & (~BITS_CH2_HIGH_TH_8814B)) -+#define BIT_GET_CH2_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH2_HIGH_TH_8814B) & BIT_MASK_CH2_HIGH_TH_8814B) -+#define BIT_SET_CH2_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH2_HIGH_TH_8814B(x) | BIT_CH2_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH2_LOW_TH_8814B 0 -+#define BIT_MASK_CH2_LOW_TH_8814B 0xfff -+#define BIT_CH2_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH2_LOW_TH_8814B) << BIT_SHIFT_CH2_LOW_TH_8814B) -+#define BITS_CH2_LOW_TH_8814B \ -+ (BIT_MASK_CH2_LOW_TH_8814B << BIT_SHIFT_CH2_LOW_TH_8814B) -+#define BIT_CLEAR_CH2_LOW_TH_8814B(x) ((x) & (~BITS_CH2_LOW_TH_8814B)) -+#define BIT_GET_CH2_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH2_LOW_TH_8814B) & BIT_MASK_CH2_LOW_TH_8814B) -+#define BIT_SET_CH2_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH2_LOW_TH_8814B(x) | BIT_CH2_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_3_8814B */ -+#define BIT_CH3_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH3_HIGH_TH_8814B 16 -+#define BIT_MASK_CH3_HIGH_TH_8814B 0xfff -+#define BIT_CH3_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH3_HIGH_TH_8814B) << BIT_SHIFT_CH3_HIGH_TH_8814B) -+#define BITS_CH3_HIGH_TH_8814B \ -+ (BIT_MASK_CH3_HIGH_TH_8814B << BIT_SHIFT_CH3_HIGH_TH_8814B) -+#define BIT_CLEAR_CH3_HIGH_TH_8814B(x) ((x) & (~BITS_CH3_HIGH_TH_8814B)) -+#define BIT_GET_CH3_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH3_HIGH_TH_8814B) & BIT_MASK_CH3_HIGH_TH_8814B) -+#define BIT_SET_CH3_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH3_HIGH_TH_8814B(x) | BIT_CH3_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH3_LOW_TH_8814B 0 -+#define BIT_MASK_CH3_LOW_TH_8814B 0xfff -+#define BIT_CH3_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH3_LOW_TH_8814B) << BIT_SHIFT_CH3_LOW_TH_8814B) -+#define BITS_CH3_LOW_TH_8814B \ -+ (BIT_MASK_CH3_LOW_TH_8814B << BIT_SHIFT_CH3_LOW_TH_8814B) -+#define BIT_CLEAR_CH3_LOW_TH_8814B(x) ((x) & (~BITS_CH3_LOW_TH_8814B)) -+#define BIT_GET_CH3_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH3_LOW_TH_8814B) & BIT_MASK_CH3_LOW_TH_8814B) -+#define BIT_SET_CH3_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH3_LOW_TH_8814B(x) | BIT_CH3_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_4_8814B */ -+#define BIT_CH4_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH4_HIGH_TH_8814B 16 -+#define BIT_MASK_CH4_HIGH_TH_8814B 0xfff -+#define BIT_CH4_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH4_HIGH_TH_8814B) << BIT_SHIFT_CH4_HIGH_TH_8814B) -+#define BITS_CH4_HIGH_TH_8814B \ -+ (BIT_MASK_CH4_HIGH_TH_8814B << BIT_SHIFT_CH4_HIGH_TH_8814B) -+#define BIT_CLEAR_CH4_HIGH_TH_8814B(x) ((x) & (~BITS_CH4_HIGH_TH_8814B)) -+#define BIT_GET_CH4_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH4_HIGH_TH_8814B) & BIT_MASK_CH4_HIGH_TH_8814B) -+#define BIT_SET_CH4_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH4_HIGH_TH_8814B(x) | BIT_CH4_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH4_LOW_TH_8814B 0 -+#define BIT_MASK_CH4_LOW_TH_8814B 0xfff -+#define BIT_CH4_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH4_LOW_TH_8814B) << BIT_SHIFT_CH4_LOW_TH_8814B) -+#define BITS_CH4_LOW_TH_8814B \ -+ (BIT_MASK_CH4_LOW_TH_8814B << BIT_SHIFT_CH4_LOW_TH_8814B) -+#define BIT_CLEAR_CH4_LOW_TH_8814B(x) ((x) & (~BITS_CH4_LOW_TH_8814B)) -+#define BIT_GET_CH4_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH4_LOW_TH_8814B) & BIT_MASK_CH4_LOW_TH_8814B) -+#define BIT_SET_CH4_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH4_LOW_TH_8814B(x) | BIT_CH4_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_5_8814B */ -+#define BIT_CH5_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH5_HIGH_TH_8814B 16 -+#define BIT_MASK_CH5_HIGH_TH_8814B 0xfff -+#define BIT_CH5_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH5_HIGH_TH_8814B) << BIT_SHIFT_CH5_HIGH_TH_8814B) -+#define BITS_CH5_HIGH_TH_8814B \ -+ (BIT_MASK_CH5_HIGH_TH_8814B << BIT_SHIFT_CH5_HIGH_TH_8814B) -+#define BIT_CLEAR_CH5_HIGH_TH_8814B(x) ((x) & (~BITS_CH5_HIGH_TH_8814B)) -+#define BIT_GET_CH5_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH5_HIGH_TH_8814B) & BIT_MASK_CH5_HIGH_TH_8814B) -+#define BIT_SET_CH5_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH5_HIGH_TH_8814B(x) | BIT_CH5_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH5_LOW_TH_8814B 0 -+#define BIT_MASK_CH5_LOW_TH_8814B 0xfff -+#define BIT_CH5_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH5_LOW_TH_8814B) << BIT_SHIFT_CH5_LOW_TH_8814B) -+#define BITS_CH5_LOW_TH_8814B \ -+ (BIT_MASK_CH5_LOW_TH_8814B << BIT_SHIFT_CH5_LOW_TH_8814B) -+#define BIT_CLEAR_CH5_LOW_TH_8814B(x) ((x) & (~BITS_CH5_LOW_TH_8814B)) -+#define BIT_GET_CH5_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH5_LOW_TH_8814B) & BIT_MASK_CH5_LOW_TH_8814B) -+#define BIT_SET_CH5_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH5_LOW_TH_8814B(x) | BIT_CH5_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_6_8814B */ -+#define BIT_CH6_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH6_HIGH_TH_8814B 16 -+#define BIT_MASK_CH6_HIGH_TH_8814B 0xfff -+#define BIT_CH6_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH6_HIGH_TH_8814B) << BIT_SHIFT_CH6_HIGH_TH_8814B) -+#define BITS_CH6_HIGH_TH_8814B \ -+ (BIT_MASK_CH6_HIGH_TH_8814B << BIT_SHIFT_CH6_HIGH_TH_8814B) -+#define BIT_CLEAR_CH6_HIGH_TH_8814B(x) ((x) & (~BITS_CH6_HIGH_TH_8814B)) -+#define BIT_GET_CH6_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH6_HIGH_TH_8814B) & BIT_MASK_CH6_HIGH_TH_8814B) -+#define BIT_SET_CH6_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH6_HIGH_TH_8814B(x) | BIT_CH6_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH6_LOW_TH_8814B 0 -+#define BIT_MASK_CH6_LOW_TH_8814B 0xfff -+#define BIT_CH6_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH6_LOW_TH_8814B) << BIT_SHIFT_CH6_LOW_TH_8814B) -+#define BITS_CH6_LOW_TH_8814B \ -+ (BIT_MASK_CH6_LOW_TH_8814B << BIT_SHIFT_CH6_LOW_TH_8814B) -+#define BIT_CLEAR_CH6_LOW_TH_8814B(x) ((x) & (~BITS_CH6_LOW_TH_8814B)) -+#define BIT_GET_CH6_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH6_LOW_TH_8814B) & BIT_MASK_CH6_LOW_TH_8814B) -+#define BIT_SET_CH6_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH6_LOW_TH_8814B(x) | BIT_CH6_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_7_8814B */ -+#define BIT_CH7_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH7_HIGH_TH_8814B 16 -+#define BIT_MASK_CH7_HIGH_TH_8814B 0xfff -+#define BIT_CH7_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH7_HIGH_TH_8814B) << BIT_SHIFT_CH7_HIGH_TH_8814B) -+#define BITS_CH7_HIGH_TH_8814B \ -+ (BIT_MASK_CH7_HIGH_TH_8814B << BIT_SHIFT_CH7_HIGH_TH_8814B) -+#define BIT_CLEAR_CH7_HIGH_TH_8814B(x) ((x) & (~BITS_CH7_HIGH_TH_8814B)) -+#define BIT_GET_CH7_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH7_HIGH_TH_8814B) & BIT_MASK_CH7_HIGH_TH_8814B) -+#define BIT_SET_CH7_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH7_HIGH_TH_8814B(x) | BIT_CH7_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH7_LOW_TH_8814B 0 -+#define BIT_MASK_CH7_LOW_TH_8814B 0xfff -+#define BIT_CH7_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH7_LOW_TH_8814B) << BIT_SHIFT_CH7_LOW_TH_8814B) -+#define BITS_CH7_LOW_TH_8814B \ -+ (BIT_MASK_CH7_LOW_TH_8814B << BIT_SHIFT_CH7_LOW_TH_8814B) -+#define BIT_CLEAR_CH7_LOW_TH_8814B(x) ((x) & (~BITS_CH7_LOW_TH_8814B)) -+#define BIT_GET_CH7_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH7_LOW_TH_8814B) & BIT_MASK_CH7_LOW_TH_8814B) -+#define BIT_SET_CH7_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH7_LOW_TH_8814B(x) | BIT_CH7_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_8_8814B */ -+#define BIT_CH8_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH8_HIGH_TH_8814B 16 -+#define BIT_MASK_CH8_HIGH_TH_8814B 0xfff -+#define BIT_CH8_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH8_HIGH_TH_8814B) << BIT_SHIFT_CH8_HIGH_TH_8814B) -+#define BITS_CH8_HIGH_TH_8814B \ -+ (BIT_MASK_CH8_HIGH_TH_8814B << BIT_SHIFT_CH8_HIGH_TH_8814B) -+#define BIT_CLEAR_CH8_HIGH_TH_8814B(x) ((x) & (~BITS_CH8_HIGH_TH_8814B)) -+#define BIT_GET_CH8_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH8_HIGH_TH_8814B) & BIT_MASK_CH8_HIGH_TH_8814B) -+#define BIT_SET_CH8_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH8_HIGH_TH_8814B(x) | BIT_CH8_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH8_LOW_TH_8814B 0 -+#define BIT_MASK_CH8_LOW_TH_8814B 0xfff -+#define BIT_CH8_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH8_LOW_TH_8814B) << BIT_SHIFT_CH8_LOW_TH_8814B) -+#define BITS_CH8_LOW_TH_8814B \ -+ (BIT_MASK_CH8_LOW_TH_8814B << BIT_SHIFT_CH8_LOW_TH_8814B) -+#define BIT_CLEAR_CH8_LOW_TH_8814B(x) ((x) & (~BITS_CH8_LOW_TH_8814B)) -+#define BIT_GET_CH8_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH8_LOW_TH_8814B) & BIT_MASK_CH8_LOW_TH_8814B) -+#define BIT_SET_CH8_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH8_LOW_TH_8814B(x) | BIT_CH8_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_9_8814B */ -+#define BIT_CH9_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH9_HIGH_TH_8814B 16 -+#define BIT_MASK_CH9_HIGH_TH_8814B 0xfff -+#define BIT_CH9_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH9_HIGH_TH_8814B) << BIT_SHIFT_CH9_HIGH_TH_8814B) -+#define BITS_CH9_HIGH_TH_8814B \ -+ (BIT_MASK_CH9_HIGH_TH_8814B << BIT_SHIFT_CH9_HIGH_TH_8814B) -+#define BIT_CLEAR_CH9_HIGH_TH_8814B(x) ((x) & (~BITS_CH9_HIGH_TH_8814B)) -+#define BIT_GET_CH9_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH9_HIGH_TH_8814B) & BIT_MASK_CH9_HIGH_TH_8814B) -+#define BIT_SET_CH9_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH9_HIGH_TH_8814B(x) | BIT_CH9_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH9_LOW_TH_8814B 0 -+#define BIT_MASK_CH9_LOW_TH_8814B 0xfff -+#define BIT_CH9_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH9_LOW_TH_8814B) << BIT_SHIFT_CH9_LOW_TH_8814B) -+#define BITS_CH9_LOW_TH_8814B \ -+ (BIT_MASK_CH9_LOW_TH_8814B << BIT_SHIFT_CH9_LOW_TH_8814B) -+#define BIT_CLEAR_CH9_LOW_TH_8814B(x) ((x) & (~BITS_CH9_LOW_TH_8814B)) -+#define BIT_GET_CH9_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH9_LOW_TH_8814B) & BIT_MASK_CH9_LOW_TH_8814B) -+#define BIT_SET_CH9_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH9_LOW_TH_8814B(x) | BIT_CH9_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_10_8814B */ -+#define BIT_CH10_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH10_HIGH_TH_8814B 16 -+#define BIT_MASK_CH10_HIGH_TH_8814B 0xfff -+#define BIT_CH10_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH10_HIGH_TH_8814B) << BIT_SHIFT_CH10_HIGH_TH_8814B) -+#define BITS_CH10_HIGH_TH_8814B \ -+ (BIT_MASK_CH10_HIGH_TH_8814B << BIT_SHIFT_CH10_HIGH_TH_8814B) -+#define BIT_CLEAR_CH10_HIGH_TH_8814B(x) ((x) & (~BITS_CH10_HIGH_TH_8814B)) -+#define BIT_GET_CH10_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH10_HIGH_TH_8814B) & BIT_MASK_CH10_HIGH_TH_8814B) -+#define BIT_SET_CH10_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH10_HIGH_TH_8814B(x) | BIT_CH10_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH10_LOW_TH_8814B 0 -+#define BIT_MASK_CH10_LOW_TH_8814B 0xfff -+#define BIT_CH10_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH10_LOW_TH_8814B) << BIT_SHIFT_CH10_LOW_TH_8814B) -+#define BITS_CH10_LOW_TH_8814B \ -+ (BIT_MASK_CH10_LOW_TH_8814B << BIT_SHIFT_CH10_LOW_TH_8814B) -+#define BIT_CLEAR_CH10_LOW_TH_8814B(x) ((x) & (~BITS_CH10_LOW_TH_8814B)) -+#define BIT_GET_CH10_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH10_LOW_TH_8814B) & BIT_MASK_CH10_LOW_TH_8814B) -+#define BIT_SET_CH10_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH10_LOW_TH_8814B(x) | BIT_CH10_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_11_8814B */ -+#define BIT_CH11_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH11_HIGH_TH_8814B 16 -+#define BIT_MASK_CH11_HIGH_TH_8814B 0xfff -+#define BIT_CH11_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH11_HIGH_TH_8814B) << BIT_SHIFT_CH11_HIGH_TH_8814B) -+#define BITS_CH11_HIGH_TH_8814B \ -+ (BIT_MASK_CH11_HIGH_TH_8814B << BIT_SHIFT_CH11_HIGH_TH_8814B) -+#define BIT_CLEAR_CH11_HIGH_TH_8814B(x) ((x) & (~BITS_CH11_HIGH_TH_8814B)) -+#define BIT_GET_CH11_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH11_HIGH_TH_8814B) & BIT_MASK_CH11_HIGH_TH_8814B) -+#define BIT_SET_CH11_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH11_HIGH_TH_8814B(x) | BIT_CH11_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH11_LOW_TH_8814B 0 -+#define BIT_MASK_CH11_LOW_TH_8814B 0xfff -+#define BIT_CH11_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH11_LOW_TH_8814B) << BIT_SHIFT_CH11_LOW_TH_8814B) -+#define BITS_CH11_LOW_TH_8814B \ -+ (BIT_MASK_CH11_LOW_TH_8814B << BIT_SHIFT_CH11_LOW_TH_8814B) -+#define BIT_CLEAR_CH11_LOW_TH_8814B(x) ((x) & (~BITS_CH11_LOW_TH_8814B)) -+#define BIT_GET_CH11_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH11_LOW_TH_8814B) & BIT_MASK_CH11_LOW_TH_8814B) -+#define BIT_SET_CH11_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH11_LOW_TH_8814B(x) | BIT_CH11_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_12_8814B */ -+#define BIT_CH12_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH12_HIGH_TH_8814B 16 -+#define BIT_MASK_CH12_HIGH_TH_8814B 0xfff -+#define BIT_CH12_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH12_HIGH_TH_8814B) << BIT_SHIFT_CH12_HIGH_TH_8814B) -+#define BITS_CH12_HIGH_TH_8814B \ -+ (BIT_MASK_CH12_HIGH_TH_8814B << BIT_SHIFT_CH12_HIGH_TH_8814B) -+#define BIT_CLEAR_CH12_HIGH_TH_8814B(x) ((x) & (~BITS_CH12_HIGH_TH_8814B)) -+#define BIT_GET_CH12_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH12_HIGH_TH_8814B) & BIT_MASK_CH12_HIGH_TH_8814B) -+#define BIT_SET_CH12_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH12_HIGH_TH_8814B(x) | BIT_CH12_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH12_LOW_TH_8814B 0 -+#define BIT_MASK_CH12_LOW_TH_8814B 0xfff -+#define BIT_CH12_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH12_LOW_TH_8814B) << BIT_SHIFT_CH12_LOW_TH_8814B) -+#define BITS_CH12_LOW_TH_8814B \ -+ (BIT_MASK_CH12_LOW_TH_8814B << BIT_SHIFT_CH12_LOW_TH_8814B) -+#define BIT_CLEAR_CH12_LOW_TH_8814B(x) ((x) & (~BITS_CH12_LOW_TH_8814B)) -+#define BIT_GET_CH12_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH12_LOW_TH_8814B) & BIT_MASK_CH12_LOW_TH_8814B) -+#define BIT_SET_CH12_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH12_LOW_TH_8814B(x) | BIT_CH12_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_13_8814B */ -+#define BIT_CH13_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH13_HIGH_TH_8814B 16 -+#define BIT_MASK_CH13_HIGH_TH_8814B 0xfff -+#define BIT_CH13_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH13_HIGH_TH_8814B) << BIT_SHIFT_CH13_HIGH_TH_8814B) -+#define BITS_CH13_HIGH_TH_8814B \ -+ (BIT_MASK_CH13_HIGH_TH_8814B << BIT_SHIFT_CH13_HIGH_TH_8814B) -+#define BIT_CLEAR_CH13_HIGH_TH_8814B(x) ((x) & (~BITS_CH13_HIGH_TH_8814B)) -+#define BIT_GET_CH13_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH13_HIGH_TH_8814B) & BIT_MASK_CH13_HIGH_TH_8814B) -+#define BIT_SET_CH13_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH13_HIGH_TH_8814B(x) | BIT_CH13_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH13_LOW_TH_8814B 0 -+#define BIT_MASK_CH13_LOW_TH_8814B 0xfff -+#define BIT_CH13_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH13_LOW_TH_8814B) << BIT_SHIFT_CH13_LOW_TH_8814B) -+#define BITS_CH13_LOW_TH_8814B \ -+ (BIT_MASK_CH13_LOW_TH_8814B << BIT_SHIFT_CH13_LOW_TH_8814B) -+#define BIT_CLEAR_CH13_LOW_TH_8814B(x) ((x) & (~BITS_CH13_LOW_TH_8814B)) -+#define BIT_GET_CH13_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH13_LOW_TH_8814B) & BIT_MASK_CH13_LOW_TH_8814B) -+#define BIT_SET_CH13_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH13_LOW_TH_8814B(x) | BIT_CH13_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_14_8814B */ -+#define BIT_CH14_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH14_HIGH_TH_8814B 16 -+#define BIT_MASK_CH14_HIGH_TH_8814B 0xfff -+#define BIT_CH14_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH14_HIGH_TH_8814B) << BIT_SHIFT_CH14_HIGH_TH_8814B) -+#define BITS_CH14_HIGH_TH_8814B \ -+ (BIT_MASK_CH14_HIGH_TH_8814B << BIT_SHIFT_CH14_HIGH_TH_8814B) -+#define BIT_CLEAR_CH14_HIGH_TH_8814B(x) ((x) & (~BITS_CH14_HIGH_TH_8814B)) -+#define BIT_GET_CH14_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH14_HIGH_TH_8814B) & BIT_MASK_CH14_HIGH_TH_8814B) -+#define BIT_SET_CH14_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH14_HIGH_TH_8814B(x) | BIT_CH14_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH14_LOW_TH_8814B 0 -+#define BIT_MASK_CH14_LOW_TH_8814B 0xfff -+#define BIT_CH14_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH14_LOW_TH_8814B) << BIT_SHIFT_CH14_LOW_TH_8814B) -+#define BITS_CH14_LOW_TH_8814B \ -+ (BIT_MASK_CH14_LOW_TH_8814B << BIT_SHIFT_CH14_LOW_TH_8814B) -+#define BIT_CLEAR_CH14_LOW_TH_8814B(x) ((x) & (~BITS_CH14_LOW_TH_8814B)) -+#define BIT_GET_CH14_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH14_LOW_TH_8814B) & BIT_MASK_CH14_LOW_TH_8814B) -+#define BIT_SET_CH14_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH14_LOW_TH_8814B(x) | BIT_CH14_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_15_8814B */ -+#define BIT_CH15_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH15_HIGH_TH_8814B 16 -+#define BIT_MASK_CH15_HIGH_TH_8814B 0xfff -+#define BIT_CH15_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH15_HIGH_TH_8814B) << BIT_SHIFT_CH15_HIGH_TH_8814B) -+#define BITS_CH15_HIGH_TH_8814B \ -+ (BIT_MASK_CH15_HIGH_TH_8814B << BIT_SHIFT_CH15_HIGH_TH_8814B) -+#define BIT_CLEAR_CH15_HIGH_TH_8814B(x) ((x) & (~BITS_CH15_HIGH_TH_8814B)) -+#define BIT_GET_CH15_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH15_HIGH_TH_8814B) & BIT_MASK_CH15_HIGH_TH_8814B) -+#define BIT_SET_CH15_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH15_HIGH_TH_8814B(x) | BIT_CH15_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH15_LOW_TH_8814B 0 -+#define BIT_MASK_CH15_LOW_TH_8814B 0xfff -+#define BIT_CH15_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH15_LOW_TH_8814B) << BIT_SHIFT_CH15_LOW_TH_8814B) -+#define BITS_CH15_LOW_TH_8814B \ -+ (BIT_MASK_CH15_LOW_TH_8814B << BIT_SHIFT_CH15_LOW_TH_8814B) -+#define BIT_CLEAR_CH15_LOW_TH_8814B(x) ((x) & (~BITS_CH15_LOW_TH_8814B)) -+#define BIT_GET_CH15_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH15_LOW_TH_8814B) & BIT_MASK_CH15_LOW_TH_8814B) -+#define BIT_SET_CH15_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH15_LOW_TH_8814B(x) | BIT_CH15_LOW_TH_8814B(v)) -+ -+/* 2 REG_TXPAGE_INT_CTRL_16_8814B */ -+#define BIT_CH16_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_CH16_HIGH_TH_8814B 16 -+#define BIT_MASK_CH16_HIGH_TH_8814B 0xfff -+#define BIT_CH16_HIGH_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH16_HIGH_TH_8814B) << BIT_SHIFT_CH16_HIGH_TH_8814B) -+#define BITS_CH16_HIGH_TH_8814B \ -+ (BIT_MASK_CH16_HIGH_TH_8814B << BIT_SHIFT_CH16_HIGH_TH_8814B) -+#define BIT_CLEAR_CH16_HIGH_TH_8814B(x) ((x) & (~BITS_CH16_HIGH_TH_8814B)) -+#define BIT_GET_CH16_HIGH_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH16_HIGH_TH_8814B) & BIT_MASK_CH16_HIGH_TH_8814B) -+#define BIT_SET_CH16_HIGH_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH16_HIGH_TH_8814B(x) | BIT_CH16_HIGH_TH_8814B(v)) -+ -+#define BIT_SHIFT_CH16_LOW_TH_8814B 0 -+#define BIT_MASK_CH16_LOW_TH_8814B 0xfff -+#define BIT_CH16_LOW_TH_8814B(x) \ -+ (((x) & BIT_MASK_CH16_LOW_TH_8814B) << BIT_SHIFT_CH16_LOW_TH_8814B) -+#define BITS_CH16_LOW_TH_8814B \ -+ (BIT_MASK_CH16_LOW_TH_8814B << BIT_SHIFT_CH16_LOW_TH_8814B) -+#define BIT_CLEAR_CH16_LOW_TH_8814B(x) ((x) & (~BITS_CH16_LOW_TH_8814B)) -+#define BIT_GET_CH16_LOW_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CH16_LOW_TH_8814B) & BIT_MASK_CH16_LOW_TH_8814B) -+#define BIT_SET_CH16_LOW_TH_8814B(x, v) \ -+ (BIT_CLEAR_CH16_LOW_TH_8814B(x) | BIT_CH16_LOW_TH_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_PCIE_CTRL_8814B */ -+#define BIT_PCIEIO_PERSTB_SEL_8814B BIT(31) -+ -+#define BIT_SHIFT_PCIE_MAX_RXDMA_8814B 28 -+#define BIT_MASK_PCIE_MAX_RXDMA_8814B 0x7 -+#define BIT_PCIE_MAX_RXDMA_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_RXDMA_8814B) \ -+ << BIT_SHIFT_PCIE_MAX_RXDMA_8814B) -+#define BITS_PCIE_MAX_RXDMA_8814B \ -+ (BIT_MASK_PCIE_MAX_RXDMA_8814B << BIT_SHIFT_PCIE_MAX_RXDMA_8814B) -+#define BIT_CLEAR_PCIE_MAX_RXDMA_8814B(x) ((x) & (~BITS_PCIE_MAX_RXDMA_8814B)) -+#define BIT_GET_PCIE_MAX_RXDMA_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_RXDMA_8814B) & \ -+ BIT_MASK_PCIE_MAX_RXDMA_8814B) -+#define BIT_SET_PCIE_MAX_RXDMA_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_RXDMA_8814B(x) | BIT_PCIE_MAX_RXDMA_8814B(v)) -+ -+#define BIT_MULRW_8814B BIT(27) -+ -+#define BIT_SHIFT_PCIE_MAX_TXDMA_8814B 24 -+#define BIT_MASK_PCIE_MAX_TXDMA_8814B 0x7 -+#define BIT_PCIE_MAX_TXDMA_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_TXDMA_8814B) \ -+ << BIT_SHIFT_PCIE_MAX_TXDMA_8814B) -+#define BITS_PCIE_MAX_TXDMA_8814B \ -+ (BIT_MASK_PCIE_MAX_TXDMA_8814B << BIT_SHIFT_PCIE_MAX_TXDMA_8814B) -+#define BIT_CLEAR_PCIE_MAX_TXDMA_8814B(x) ((x) & (~BITS_PCIE_MAX_TXDMA_8814B)) -+#define BIT_GET_PCIE_MAX_TXDMA_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_TXDMA_8814B) & \ -+ BIT_MASK_PCIE_MAX_TXDMA_8814B) -+#define BIT_SET_PCIE_MAX_TXDMA_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_TXDMA_8814B(x) | BIT_PCIE_MAX_TXDMA_8814B(v)) -+ -+#define BIT_PWR_SCALE_START_PS_8814B BIT(23) -+#define BIT_EN_CPL_TIMEOUT_PS_8814B BIT(22) -+#define BIT_REG_TXDMA_FAIL_PS_8814B BIT(21) -+#define BIT_PCIE_RST_TRXDMA_INTF_8814B BIT(20) -+#define BIT_EN_HWENTR_L1_8814B BIT(19) -+#define BIT_EN_ADV_CLKGATE_8814B BIT(18) -+#define BIT_PCIE_EN_SWENT_L23_8814B BIT(17) -+#define BIT_PCIE_EN_HWEXT_L1_8814B BIT(16) -+#define BIT_STOP_P0_MPRT_BCNQ4_8814B BIT(6) -+#define BIT_STOP_P0_MPRT_BCNQ3_8814B BIT(4) -+#define BIT_STOP_P0_MPRT_BCNQ2_8814B BIT(2) -+#define BIT_STOP_P0_MPRT_BCNQ1_8814B BIT(0) -+ -+/* 2 REG_ACH_CTRL_8814B */ -+#define BIT_STOP_P0HIQ19_8814B BIT(27) -+#define BIT_STOP_P0HIQ18_8814B BIT(26) -+#define BIT_STOP_P0HIQ17_8814B BIT(25) -+#define BIT_STOP_P0HIQ16_8814B BIT(24) -+#define BIT_RX_CLOSE_EN_V1_8814B BIT(21) -+#define BIT_STOP_FWCMDQ_8814B BIT(20) -+#define BIT_STOP_P0BCNQ_8814B BIT(18) -+#define BIT_STOP_P0MGQ_8814B BIT(16) -+#define BIT_STOP_ACH13_8814B BIT(15) -+#define BIT_STOP_ACH12_8814B BIT(14) -+#define BIT_STOP_ACH11_8814B BIT(13) -+#define BIT_STOP_ACH10_8814B BIT(12) -+#define BIT_STOP_ACH9_8814B BIT(11) -+#define BIT_STOP_ACH8_8814B BIT(10) -+#define BIT_STOP_ACH7_8814B BIT(9) -+#define BIT_STOP_ACH6_8814B BIT(8) -+#define BIT_STOP_ACH5_8814B BIT(7) -+#define BIT_STOP_ACH4_8814B BIT(6) -+#define BIT_STOP_ACH3_8814B BIT(5) -+#define BIT_STOP_ACH2_8814B BIT(4) -+#define BIT_STOP_ACH1_8814B BIT(3) -+#define BIT_STOP_ACH0_8814B BIT(2) -+#define BIT_STOP_P0RX_8814B BIT(0) -+ -+/* 2 REG_HIQ_CTRL_8814B */ -+#define BIT_STOP_P0HIQ15_8814B BIT(15) -+#define BIT_STOP_P0HIQ14_8814B BIT(14) -+#define BIT_STOP_P0HIQ13_8814B BIT(13) -+#define BIT_STOP_P0HIQ12_8814B BIT(12) -+#define BIT_STOP_P0HIQ11_8814B BIT(11) -+#define BIT_STOP_P0HIQ10_8814B BIT(10) -+#define BIT_STOP_P0HIQ9_8814B BIT(9) -+#define BIT_STOP_P0HIQ8_8814B BIT(8) -+#define BIT_STOP_P0HIQ7_8814B BIT(7) -+#define BIT_STOP_P0HIQ6_8814B BIT(6) -+#define BIT_STOP_P0HIQ5_8814B BIT(5) -+#define BIT_STOP_P0HIQ4_8814B BIT(4) -+#define BIT_STOP_P0HIQ3_8814B BIT(3) -+#define BIT_STOP_P0HIQ2_8814B BIT(2) -+#define BIT_STOP_P0HIQ1_8814B BIT(1) -+#define BIT_STOP_P0HIQ0_8814B BIT(0) -+ -+/* 2 REG_INT_MIG_V1_8814B */ -+ -+#define BIT_SHIFT_TXTTIMER_MATCH_NUM_8814B 28 -+#define BIT_MASK_TXTTIMER_MATCH_NUM_8814B 0xf -+#define BIT_TXTTIMER_MATCH_NUM_8814B(x) \ -+ (((x) & BIT_MASK_TXTTIMER_MATCH_NUM_8814B) \ -+ << BIT_SHIFT_TXTTIMER_MATCH_NUM_8814B) -+#define BITS_TXTTIMER_MATCH_NUM_8814B \ -+ (BIT_MASK_TXTTIMER_MATCH_NUM_8814B \ -+ << BIT_SHIFT_TXTTIMER_MATCH_NUM_8814B) -+#define BIT_CLEAR_TXTTIMER_MATCH_NUM_8814B(x) \ -+ ((x) & (~BITS_TXTTIMER_MATCH_NUM_8814B)) -+#define BIT_GET_TXTTIMER_MATCH_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXTTIMER_MATCH_NUM_8814B) & \ -+ BIT_MASK_TXTTIMER_MATCH_NUM_8814B) -+#define BIT_SET_TXTTIMER_MATCH_NUM_8814B(x, v) \ -+ (BIT_CLEAR_TXTTIMER_MATCH_NUM_8814B(x) | \ -+ BIT_TXTTIMER_MATCH_NUM_8814B(v)) -+ -+#define BIT_SHIFT_TXPKT_NUM_MATCH_8814B 24 -+#define BIT_MASK_TXPKT_NUM_MATCH_8814B 0xf -+#define BIT_TXPKT_NUM_MATCH_8814B(x) \ -+ (((x) & BIT_MASK_TXPKT_NUM_MATCH_8814B) \ -+ << BIT_SHIFT_TXPKT_NUM_MATCH_8814B) -+#define BITS_TXPKT_NUM_MATCH_8814B \ -+ (BIT_MASK_TXPKT_NUM_MATCH_8814B << BIT_SHIFT_TXPKT_NUM_MATCH_8814B) -+#define BIT_CLEAR_TXPKT_NUM_MATCH_8814B(x) ((x) & (~BITS_TXPKT_NUM_MATCH_8814B)) -+#define BIT_GET_TXPKT_NUM_MATCH_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXPKT_NUM_MATCH_8814B) & \ -+ BIT_MASK_TXPKT_NUM_MATCH_8814B) -+#define BIT_SET_TXPKT_NUM_MATCH_8814B(x, v) \ -+ (BIT_CLEAR_TXPKT_NUM_MATCH_8814B(x) | BIT_TXPKT_NUM_MATCH_8814B(v)) -+ -+#define BIT_SHIFT_RXTTIMER_MATCH_NUM_8814B 20 -+#define BIT_MASK_RXTTIMER_MATCH_NUM_8814B 0xf -+#define BIT_RXTTIMER_MATCH_NUM_8814B(x) \ -+ (((x) & BIT_MASK_RXTTIMER_MATCH_NUM_8814B) \ -+ << BIT_SHIFT_RXTTIMER_MATCH_NUM_8814B) -+#define BITS_RXTTIMER_MATCH_NUM_8814B \ -+ (BIT_MASK_RXTTIMER_MATCH_NUM_8814B \ -+ << BIT_SHIFT_RXTTIMER_MATCH_NUM_8814B) -+#define BIT_CLEAR_RXTTIMER_MATCH_NUM_8814B(x) \ -+ ((x) & (~BITS_RXTTIMER_MATCH_NUM_8814B)) -+#define BIT_GET_RXTTIMER_MATCH_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXTTIMER_MATCH_NUM_8814B) & \ -+ BIT_MASK_RXTTIMER_MATCH_NUM_8814B) -+#define BIT_SET_RXTTIMER_MATCH_NUM_8814B(x, v) \ -+ (BIT_CLEAR_RXTTIMER_MATCH_NUM_8814B(x) | \ -+ BIT_RXTTIMER_MATCH_NUM_8814B(v)) -+ -+#define BIT_SHIFT_RXPKT_NUM_MATCH_8814B 16 -+#define BIT_MASK_RXPKT_NUM_MATCH_8814B 0xf -+#define BIT_RXPKT_NUM_MATCH_8814B(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_MATCH_8814B) \ -+ << BIT_SHIFT_RXPKT_NUM_MATCH_8814B) -+#define BITS_RXPKT_NUM_MATCH_8814B \ -+ (BIT_MASK_RXPKT_NUM_MATCH_8814B << BIT_SHIFT_RXPKT_NUM_MATCH_8814B) -+#define BIT_CLEAR_RXPKT_NUM_MATCH_8814B(x) ((x) & (~BITS_RXPKT_NUM_MATCH_8814B)) -+#define BIT_GET_RXPKT_NUM_MATCH_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_MATCH_8814B) & \ -+ BIT_MASK_RXPKT_NUM_MATCH_8814B) -+#define BIT_SET_RXPKT_NUM_MATCH_8814B(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_MATCH_8814B(x) | BIT_RXPKT_NUM_MATCH_8814B(v)) -+ -+#define BIT_SHIFT_MIGRATE_TIMER_8814B 0 -+#define BIT_MASK_MIGRATE_TIMER_8814B 0xffff -+#define BIT_MIGRATE_TIMER_8814B(x) \ -+ (((x) & BIT_MASK_MIGRATE_TIMER_8814B) << BIT_SHIFT_MIGRATE_TIMER_8814B) -+#define BITS_MIGRATE_TIMER_8814B \ -+ (BIT_MASK_MIGRATE_TIMER_8814B << BIT_SHIFT_MIGRATE_TIMER_8814B) -+#define BIT_CLEAR_MIGRATE_TIMER_8814B(x) ((x) & (~BITS_MIGRATE_TIMER_8814B)) -+#define BIT_GET_MIGRATE_TIMER_8814B(x) \ -+ (((x) >> BIT_SHIFT_MIGRATE_TIMER_8814B) & BIT_MASK_MIGRATE_TIMER_8814B) -+#define BIT_SET_MIGRATE_TIMER_8814B(x, v) \ -+ (BIT_CLEAR_MIGRATE_TIMER_8814B(x) | BIT_MIGRATE_TIMER_8814B(v)) -+ -+/* 2 REG_P0MGQ_TXBD_DESA_L_8814B */ -+ -+/* 2 REG_P0MGQ_TXBD_DESA_H_8814B */ -+ -+/* 2 REG_ACH0_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH0_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH0_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH0_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH0_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH0_TXBD_DESA_L_8814B) -+#define BITS_ACH0_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH0_TXBD_DESA_L_8814B << BIT_SHIFT_ACH0_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH0_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH0_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH0_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH0_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH0_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH0_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH0_TXBD_DESA_L_8814B(x) | BIT_ACH0_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH0_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH0_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH0_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH0_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH0_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH0_TXBD_DESA_H_8814B) -+#define BITS_ACH0_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH0_TXBD_DESA_H_8814B << BIT_SHIFT_ACH0_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH0_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH0_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH0_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH0_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH0_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH0_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH0_TXBD_DESA_H_8814B(x) | BIT_ACH0_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH1_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH1_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH1_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH1_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH1_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH1_TXBD_DESA_L_8814B) -+#define BITS_ACH1_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH1_TXBD_DESA_L_8814B << BIT_SHIFT_ACH1_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH1_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH1_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH1_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH1_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH1_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH1_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH1_TXBD_DESA_L_8814B(x) | BIT_ACH1_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH1_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH1_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH1_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH1_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH1_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH1_TXBD_DESA_H_8814B) -+#define BITS_ACH1_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH1_TXBD_DESA_H_8814B << BIT_SHIFT_ACH1_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH1_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH1_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH1_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH1_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH1_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH1_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH1_TXBD_DESA_H_8814B(x) | BIT_ACH1_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH2_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH2_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH2_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH2_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH2_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH2_TXBD_DESA_L_8814B) -+#define BITS_ACH2_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH2_TXBD_DESA_L_8814B << BIT_SHIFT_ACH2_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH2_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH2_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH2_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH2_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH2_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH2_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH2_TXBD_DESA_L_8814B(x) | BIT_ACH2_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH2_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH2_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH2_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH2_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH2_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH2_TXBD_DESA_H_8814B) -+#define BITS_ACH2_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH2_TXBD_DESA_H_8814B << BIT_SHIFT_ACH2_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH2_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH2_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH2_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH2_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH2_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH2_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH2_TXBD_DESA_H_8814B(x) | BIT_ACH2_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH3_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH3_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH3_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH3_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH3_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH3_TXBD_DESA_L_8814B) -+#define BITS_ACH3_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH3_TXBD_DESA_L_8814B << BIT_SHIFT_ACH3_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH3_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH3_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH3_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH3_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH3_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH3_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH3_TXBD_DESA_L_8814B(x) | BIT_ACH3_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH3_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH3_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH3_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH3_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH3_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH3_TXBD_DESA_H_8814B) -+#define BITS_ACH3_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH3_TXBD_DESA_H_8814B << BIT_SHIFT_ACH3_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH3_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH3_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH3_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH3_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH3_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH3_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH3_TXBD_DESA_H_8814B(x) | BIT_ACH3_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_P0RXQ_RXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_P0RXQ_RXBD_DESA_L_8814B 0 -+#define BIT_MASK_P0RXQ_RXBD_DESA_L_8814B 0xffffffffL -+#define BIT_P0RXQ_RXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_P0RXQ_RXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_P0RXQ_RXBD_DESA_L_8814B) -+#define BITS_P0RXQ_RXBD_DESA_L_8814B \ -+ (BIT_MASK_P0RXQ_RXBD_DESA_L_8814B << BIT_SHIFT_P0RXQ_RXBD_DESA_L_8814B) -+#define BIT_CLEAR_P0RXQ_RXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_P0RXQ_RXBD_DESA_L_8814B)) -+#define BIT_GET_P0RXQ_RXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0RXQ_RXBD_DESA_L_8814B) & \ -+ BIT_MASK_P0RXQ_RXBD_DESA_L_8814B) -+#define BIT_SET_P0RXQ_RXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_P0RXQ_RXBD_DESA_L_8814B(x) | BIT_P0RXQ_RXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_P0RXQ_RXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_P0RXQ_RXBD_DESA_H_8814B 0 -+#define BIT_MASK_P0RXQ_RXBD_DESA_H_8814B 0xffffffffL -+#define BIT_P0RXQ_RXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_P0RXQ_RXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_P0RXQ_RXBD_DESA_H_8814B) -+#define BITS_P0RXQ_RXBD_DESA_H_8814B \ -+ (BIT_MASK_P0RXQ_RXBD_DESA_H_8814B << BIT_SHIFT_P0RXQ_RXBD_DESA_H_8814B) -+#define BIT_CLEAR_P0RXQ_RXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_P0RXQ_RXBD_DESA_H_8814B)) -+#define BIT_GET_P0RXQ_RXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0RXQ_RXBD_DESA_H_8814B) & \ -+ BIT_MASK_P0RXQ_RXBD_DESA_H_8814B) -+#define BIT_SET_P0RXQ_RXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_P0RXQ_RXBD_DESA_H_8814B(x) | BIT_P0RXQ_RXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_P0BCNQ_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_P0BCNQ_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_P0BCNQ_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_P0BCNQ_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_P0BCNQ_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_P0BCNQ_TXBD_DESA_L_8814B) -+#define BITS_P0BCNQ_TXBD_DESA_L_8814B \ -+ (BIT_MASK_P0BCNQ_TXBD_DESA_L_8814B \ -+ << BIT_SHIFT_P0BCNQ_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_P0BCNQ_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_P0BCNQ_TXBD_DESA_L_8814B)) -+#define BIT_GET_P0BCNQ_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0BCNQ_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_P0BCNQ_TXBD_DESA_L_8814B) -+#define BIT_SET_P0BCNQ_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_P0BCNQ_TXBD_DESA_L_8814B(x) | \ -+ BIT_P0BCNQ_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_P0BCNQ_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_P0BCNQ_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_P0BCNQ_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_P0BCNQ_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_P0BCNQ_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_P0BCNQ_TXBD_DESA_H_8814B) -+#define BITS_P0BCNQ_TXBD_DESA_H_8814B \ -+ (BIT_MASK_P0BCNQ_TXBD_DESA_H_8814B \ -+ << BIT_SHIFT_P0BCNQ_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_P0BCNQ_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_P0BCNQ_TXBD_DESA_H_8814B)) -+#define BIT_GET_P0BCNQ_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0BCNQ_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_P0BCNQ_TXBD_DESA_H_8814B) -+#define BIT_SET_P0BCNQ_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_P0BCNQ_TXBD_DESA_H_8814B(x) | \ -+ BIT_P0BCNQ_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_FWCMDQ_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_FWCMDQ_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_FWCMDQ_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_FWCMDQ_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_FWCMDQ_TXBD_DESA_L_8814B) -+#define BITS_FWCMDQ_TXBD_DESA_L_8814B \ -+ (BIT_MASK_FWCMDQ_TXBD_DESA_L_8814B \ -+ << BIT_SHIFT_FWCMDQ_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_FWCMDQ_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_FWCMDQ_TXBD_DESA_L_8814B)) -+#define BIT_GET_FWCMDQ_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_FWCMDQ_TXBD_DESA_L_8814B) -+#define BIT_SET_FWCMDQ_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_TXBD_DESA_L_8814B(x) | \ -+ BIT_FWCMDQ_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_FWCMDQ_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_FWCMDQ_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_FWCMDQ_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_FWCMDQ_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_FWCMDQ_TXBD_DESA_H_8814B) -+#define BITS_FWCMDQ_TXBD_DESA_H_8814B \ -+ (BIT_MASK_FWCMDQ_TXBD_DESA_H_8814B \ -+ << BIT_SHIFT_FWCMDQ_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_FWCMDQ_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_FWCMDQ_TXBD_DESA_H_8814B)) -+#define BIT_GET_FWCMDQ_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_FWCMDQ_TXBD_DESA_H_8814B) -+#define BIT_SET_FWCMDQ_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_TXBD_DESA_H_8814B(x) | \ -+ BIT_FWCMDQ_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_PCIE_HRPWM1_HCPWM1_DCPU_8814B */ -+ -+#define BIT_SHIFT_PCIE_HCPWM1_DCPU_8814B 16 -+#define BIT_MASK_PCIE_HCPWM1_DCPU_8814B 0xff -+#define BIT_PCIE_HCPWM1_DCPU_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM1_DCPU_8814B) \ -+ << BIT_SHIFT_PCIE_HCPWM1_DCPU_8814B) -+#define BITS_PCIE_HCPWM1_DCPU_8814B \ -+ (BIT_MASK_PCIE_HCPWM1_DCPU_8814B << BIT_SHIFT_PCIE_HCPWM1_DCPU_8814B) -+#define BIT_CLEAR_PCIE_HCPWM1_DCPU_8814B(x) \ -+ ((x) & (~BITS_PCIE_HCPWM1_DCPU_8814B)) -+#define BIT_GET_PCIE_HCPWM1_DCPU_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM1_DCPU_8814B) & \ -+ BIT_MASK_PCIE_HCPWM1_DCPU_8814B) -+#define BIT_SET_PCIE_HCPWM1_DCPU_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM1_DCPU_8814B(x) | BIT_PCIE_HCPWM1_DCPU_8814B(v)) -+ -+#define BIT_SHIFT_PCIE_HRPWM1_DCPU_8814B 8 -+#define BIT_MASK_PCIE_HRPWM1_DCPU_8814B 0xff -+#define BIT_PCIE_HRPWM1_DCPU_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM1_DCPU_8814B) \ -+ << BIT_SHIFT_PCIE_HRPWM1_DCPU_8814B) -+#define BITS_PCIE_HRPWM1_DCPU_8814B \ -+ (BIT_MASK_PCIE_HRPWM1_DCPU_8814B << BIT_SHIFT_PCIE_HRPWM1_DCPU_8814B) -+#define BIT_CLEAR_PCIE_HRPWM1_DCPU_8814B(x) \ -+ ((x) & (~BITS_PCIE_HRPWM1_DCPU_8814B)) -+#define BIT_GET_PCIE_HRPWM1_DCPU_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM1_DCPU_8814B) & \ -+ BIT_MASK_PCIE_HRPWM1_DCPU_8814B) -+#define BIT_SET_PCIE_HRPWM1_DCPU_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM1_DCPU_8814B(x) | BIT_PCIE_HRPWM1_DCPU_8814B(v)) -+ -+/* 2 REG_P0_MPRT_BCNQ_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_P0_MPRT_BCNQ_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_L_8814B) -+#define BITS_P0_MPRT_BCNQ_TXBD_DESA_L_8814B \ -+ (BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_L_8814B \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_P0_MPRT_BCNQ_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_P0_MPRT_BCNQ_TXBD_DESA_L_8814B)) -+#define BIT_GET_P0_MPRT_BCNQ_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_L_8814B) -+#define BIT_SET_P0_MPRT_BCNQ_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_P0_MPRT_BCNQ_TXBD_DESA_L_8814B(x) | \ -+ BIT_P0_MPRT_BCNQ_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_P0_MPRT_BCNQ_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_P0_MPRT_BCNQ_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_H_8814B) -+#define BITS_P0_MPRT_BCNQ_TXBD_DESA_H_8814B \ -+ (BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_H_8814B \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_P0_MPRT_BCNQ_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_P0_MPRT_BCNQ_TXBD_DESA_H_8814B)) -+#define BIT_GET_P0_MPRT_BCNQ_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0_MPRT_BCNQ_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_P0_MPRT_BCNQ_TXBD_DESA_H_8814B) -+#define BIT_SET_P0_MPRT_BCNQ_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_P0_MPRT_BCNQ_TXBD_DESA_H_8814B(x) | \ -+ BIT_P0_MPRT_BCNQ_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_P0_MPRT_BCNQ_TXRXBD_NUM_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_P0_MPRT_BCNQ_DESC_MODE_8814B 13 -+#define BIT_MASK_P0_MPRT_BCNQ_DESC_MODE_8814B 0x3 -+#define BIT_P0_MPRT_BCNQ_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0_MPRT_BCNQ_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_DESC_MODE_8814B) -+#define BITS_P0_MPRT_BCNQ_DESC_MODE_8814B \ -+ (BIT_MASK_P0_MPRT_BCNQ_DESC_MODE_8814B \ -+ << BIT_SHIFT_P0_MPRT_BCNQ_DESC_MODE_8814B) -+#define BIT_CLEAR_P0_MPRT_BCNQ_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0_MPRT_BCNQ_DESC_MODE_8814B)) -+#define BIT_GET_P0_MPRT_BCNQ_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0_MPRT_BCNQ_DESC_MODE_8814B) & \ -+ BIT_MASK_P0_MPRT_BCNQ_DESC_MODE_8814B) -+#define BIT_SET_P0_MPRT_BCNQ_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0_MPRT_BCNQ_DESC_MODE_8814B(x) | \ -+ BIT_P0_MPRT_BCNQ_DESC_MODE_8814B(v)) -+ -+#define BIT_PCIE_P0MPRT_BCNQ4_FLAG_8814B BIT(11) -+#define BIT_PCIE_P0MPRT_BCNQ3_FLAG_8814B BIT(10) -+#define BIT_PCIE_P0MPRT_BCNQ2_FLAG_8814B BIT(9) -+#define BIT_PCIE_P0MPRT_BCNQ1_FLAG_8814B BIT(8) -+#define BIT_EPHY_CAL_DONE_8814B BIT(1) -+#define BIT_RESET_APHY_8814B BIT(0) -+ -+/* 2 REG_BD_RWPTR_CLR2_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CLR_ACH7_HW_IDX_8814B BIT(21) -+#define BIT_CLR_ACH6_HW_IDX_8814B BIT(20) -+#define BIT_CLR_ACH5_HW_IDX_8814B BIT(19) -+#define BIT_CLR_ACH4_HW_IDX_8814B BIT(18) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CLR_ACH7_HOST_IDX_8814B BIT(5) -+#define BIT_CLR_ACH6_HOST_IDX_8814B BIT(4) -+#define BIT_CLR_ACH5_HOST_IDX_8814B BIT(3) -+#define BIT_CLR_ACH4_HOST_IDX_8814B BIT(2) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_BD_RWPTR_CLR3_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CLR_P0HI15Q_HW_IDX_8814B BIT(29) -+#define BIT_CLR_P0HI14Q_HW_IDX_8814B BIT(28) -+#define BIT_CLR_P0HI13Q_HW_IDX_8814B BIT(27) -+#define BIT_CLR_P0HI12Q_HW_IDX_8814B BIT(26) -+#define BIT_CLR_P0HI11Q_HW_IDX_8814B BIT(25) -+#define BIT_CLR_P0HI10Q_HW_IDX_8814B BIT(24) -+#define BIT_CLR_P0HI9Q_HW_IDX_8814B BIT(23) -+#define BIT_CLR_P0HI8Q_HW_IDX_8814B BIT(22) -+#define BIT_CLR_ACH13_HW_IDX_8814B BIT(21) -+#define BIT_CLR_ACH12_HW_IDX_8814B BIT(20) -+#define BIT_CLR_ACH11_HW_IDX_8814B BIT(19) -+#define BIT_CLR_ACH10_HW_IDX_8814B BIT(18) -+#define BIT_CLR_ACH9_HW_IDX_8814B BIT(17) -+#define BIT_CLR_ACH8_HW_IDX_8814B BIT(16) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CLR_P0HI15Q_HOST_IDX_8814B BIT(13) -+#define BIT_CLR_P0HI14Q_HOST_IDX_8814B BIT(12) -+#define BIT_CLR_P0HI13Q_HOST_IDX_8814B BIT(11) -+#define BIT_CLR_P0HI12Q_HOST_IDX_8814B BIT(10) -+#define BIT_CLR_P0HI11Q_HOST_IDX_8814B BIT(9) -+#define BIT_CLR_P0HI10Q_HOST_IDX_8814B BIT(8) -+#define BIT_CLR_P0HI9Q_HOST_IDX_8814B BIT(7) -+#define BIT_CLR_P0HI8Q_HOST_IDX_8814B BIT(6) -+#define BIT_CLR_ACH13_HOST_IDX_8814B BIT(5) -+#define BIT_CLR_ACH12_HOST_IDX_8814B BIT(4) -+#define BIT_CLR_ACH11_HOST_IDX_8814B BIT(3) -+#define BIT_CLR_ACH10_HOST_IDX_8814B BIT(2) -+#define BIT_CLR_ACH9_HOST_IDX_8814B BIT(1) -+#define BIT_CLR_ACH8_HOST_IDX_8814B BIT(0) -+ -+/* 2 REG_P0MGQ_RXQ_TXRXBD_NUM_8814B */ -+#define BIT_SYS_32_64_V1_8814B BIT(31) -+ -+#define BIT_SHIFT_P0BCNQ_DESC_MODE_8814B 29 -+#define BIT_MASK_P0BCNQ_DESC_MODE_8814B 0x3 -+#define BIT_P0BCNQ_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0BCNQ_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0BCNQ_DESC_MODE_8814B) -+#define BITS_P0BCNQ_DESC_MODE_8814B \ -+ (BIT_MASK_P0BCNQ_DESC_MODE_8814B << BIT_SHIFT_P0BCNQ_DESC_MODE_8814B) -+#define BIT_CLEAR_P0BCNQ_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0BCNQ_DESC_MODE_8814B)) -+#define BIT_GET_P0BCNQ_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0BCNQ_DESC_MODE_8814B) & \ -+ BIT_MASK_P0BCNQ_DESC_MODE_8814B) -+#define BIT_SET_P0BCNQ_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0BCNQ_DESC_MODE_8814B(x) | BIT_P0BCNQ_DESC_MODE_8814B(v)) -+ -+#define BIT_PCIE_P0BCNQ_FLAG_8814B BIT(28) -+ -+#define BIT_SHIFT_P0RXQ_DESC_NUM_8814B 16 -+#define BIT_MASK_P0RXQ_DESC_NUM_8814B 0xfff -+#define BIT_P0RXQ_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0RXQ_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0RXQ_DESC_NUM_8814B) -+#define BITS_P0RXQ_DESC_NUM_8814B \ -+ (BIT_MASK_P0RXQ_DESC_NUM_8814B << BIT_SHIFT_P0RXQ_DESC_NUM_8814B) -+#define BIT_CLEAR_P0RXQ_DESC_NUM_8814B(x) ((x) & (~BITS_P0RXQ_DESC_NUM_8814B)) -+#define BIT_GET_P0RXQ_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0RXQ_DESC_NUM_8814B) & \ -+ BIT_MASK_P0RXQ_DESC_NUM_8814B) -+#define BIT_SET_P0RXQ_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0RXQ_DESC_NUM_8814B(x) | BIT_P0RXQ_DESC_NUM_8814B(v)) -+ -+#define BIT_PCIE_P0MGQ_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0MGQ_DESC_MODE_8814B 12 -+#define BIT_MASK_P0MGQ_DESC_MODE_8814B 0x3 -+#define BIT_P0MGQ_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0MGQ_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0MGQ_DESC_MODE_8814B) -+#define BITS_P0MGQ_DESC_MODE_8814B \ -+ (BIT_MASK_P0MGQ_DESC_MODE_8814B << BIT_SHIFT_P0MGQ_DESC_MODE_8814B) -+#define BIT_CLEAR_P0MGQ_DESC_MODE_8814B(x) ((x) & (~BITS_P0MGQ_DESC_MODE_8814B)) -+#define BIT_GET_P0MGQ_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0MGQ_DESC_MODE_8814B) & \ -+ BIT_MASK_P0MGQ_DESC_MODE_8814B) -+#define BIT_SET_P0MGQ_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0MGQ_DESC_MODE_8814B(x) | BIT_P0MGQ_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0MGQ_DESC_NUM_8814B 0 -+#define BIT_MASK_P0MGQ_DESC_NUM_8814B 0xfff -+#define BIT_P0MGQ_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0MGQ_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0MGQ_DESC_NUM_8814B) -+#define BITS_P0MGQ_DESC_NUM_8814B \ -+ (BIT_MASK_P0MGQ_DESC_NUM_8814B << BIT_SHIFT_P0MGQ_DESC_NUM_8814B) -+#define BIT_CLEAR_P0MGQ_DESC_NUM_8814B(x) ((x) & (~BITS_P0MGQ_DESC_NUM_8814B)) -+#define BIT_GET_P0MGQ_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0MGQ_DESC_NUM_8814B) & \ -+ BIT_MASK_P0MGQ_DESC_NUM_8814B) -+#define BIT_SET_P0MGQ_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0MGQ_DESC_NUM_8814B(x) | BIT_P0MGQ_DESC_NUM_8814B(v)) -+ -+/* 2 REG_CHNL_DMA_CFG_8814B */ -+#define BIT_TXHCI_EN_8814B BIT(26) -+#define BIT_TXHCI_IDLE_8814B BIT(25) -+#define BIT_DMA_PRI_EN_8814B BIT(24) -+ -+/* 2 REG_FWCMDQ_TXBD_NUM_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_PCIE_FWCMDQ_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_FWCMDQ_DESC_MODE_8814B 12 -+#define BIT_MASK_FWCMDQ_DESC_MODE_8814B 0x3 -+#define BIT_FWCMDQ_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_DESC_MODE_8814B) \ -+ << BIT_SHIFT_FWCMDQ_DESC_MODE_8814B) -+#define BITS_FWCMDQ_DESC_MODE_8814B \ -+ (BIT_MASK_FWCMDQ_DESC_MODE_8814B << BIT_SHIFT_FWCMDQ_DESC_MODE_8814B) -+#define BIT_CLEAR_FWCMDQ_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_FWCMDQ_DESC_MODE_8814B)) -+#define BIT_GET_FWCMDQ_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_DESC_MODE_8814B) & \ -+ BIT_MASK_FWCMDQ_DESC_MODE_8814B) -+#define BIT_SET_FWCMDQ_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_DESC_MODE_8814B(x) | BIT_FWCMDQ_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_FWCMDQ_DESC_NUM_8814B 0 -+#define BIT_MASK_FWCMDQ_DESC_NUM_8814B 0xfff -+#define BIT_FWCMDQ_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_DESC_NUM_8814B) \ -+ << BIT_SHIFT_FWCMDQ_DESC_NUM_8814B) -+#define BITS_FWCMDQ_DESC_NUM_8814B \ -+ (BIT_MASK_FWCMDQ_DESC_NUM_8814B << BIT_SHIFT_FWCMDQ_DESC_NUM_8814B) -+#define BIT_CLEAR_FWCMDQ_DESC_NUM_8814B(x) ((x) & (~BITS_FWCMDQ_DESC_NUM_8814B)) -+#define BIT_GET_FWCMDQ_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_DESC_NUM_8814B) & \ -+ BIT_MASK_FWCMDQ_DESC_NUM_8814B) -+#define BIT_SET_FWCMDQ_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_DESC_NUM_8814B(x) | BIT_FWCMDQ_DESC_NUM_8814B(v)) -+ -+/* 2 REG_ACH0_ACH1_TXBD_NUM_8814B */ -+#define BIT_PCIE_ACH1_FLAG_V1_8814B BIT(30) -+ -+#define BIT_SHIFT_ACH1_DESC_MODE_V1_8814B 28 -+#define BIT_MASK_ACH1_DESC_MODE_V1_8814B 0x3 -+#define BIT_ACH1_DESC_MODE_V1_8814B(x) \ -+ (((x) & BIT_MASK_ACH1_DESC_MODE_V1_8814B) \ -+ << BIT_SHIFT_ACH1_DESC_MODE_V1_8814B) -+#define BITS_ACH1_DESC_MODE_V1_8814B \ -+ (BIT_MASK_ACH1_DESC_MODE_V1_8814B << BIT_SHIFT_ACH1_DESC_MODE_V1_8814B) -+#define BIT_CLEAR_ACH1_DESC_MODE_V1_8814B(x) \ -+ ((x) & (~BITS_ACH1_DESC_MODE_V1_8814B)) -+#define BIT_GET_ACH1_DESC_MODE_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH1_DESC_MODE_V1_8814B) & \ -+ BIT_MASK_ACH1_DESC_MODE_V1_8814B) -+#define BIT_SET_ACH1_DESC_MODE_V1_8814B(x, v) \ -+ (BIT_CLEAR_ACH1_DESC_MODE_V1_8814B(x) | BIT_ACH1_DESC_MODE_V1_8814B(v)) -+ -+#define BIT_SHIFT_ACH1_DESC_NUM_V1_8814B 16 -+#define BIT_MASK_ACH1_DESC_NUM_V1_8814B 0xfff -+#define BIT_ACH1_DESC_NUM_V1_8814B(x) \ -+ (((x) & BIT_MASK_ACH1_DESC_NUM_V1_8814B) \ -+ << BIT_SHIFT_ACH1_DESC_NUM_V1_8814B) -+#define BITS_ACH1_DESC_NUM_V1_8814B \ -+ (BIT_MASK_ACH1_DESC_NUM_V1_8814B << BIT_SHIFT_ACH1_DESC_NUM_V1_8814B) -+#define BIT_CLEAR_ACH1_DESC_NUM_V1_8814B(x) \ -+ ((x) & (~BITS_ACH1_DESC_NUM_V1_8814B)) -+#define BIT_GET_ACH1_DESC_NUM_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH1_DESC_NUM_V1_8814B) & \ -+ BIT_MASK_ACH1_DESC_NUM_V1_8814B) -+#define BIT_SET_ACH1_DESC_NUM_V1_8814B(x, v) \ -+ (BIT_CLEAR_ACH1_DESC_NUM_V1_8814B(x) | BIT_ACH1_DESC_NUM_V1_8814B(v)) -+ -+#define BIT_PCIE_ACH0_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_ACH0_DESC_MODE_8814B 12 -+#define BIT_MASK_ACH0_DESC_MODE_8814B 0x3 -+#define BIT_ACH0_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH0_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH0_DESC_MODE_8814B) -+#define BITS_ACH0_DESC_MODE_8814B \ -+ (BIT_MASK_ACH0_DESC_MODE_8814B << BIT_SHIFT_ACH0_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH0_DESC_MODE_8814B(x) ((x) & (~BITS_ACH0_DESC_MODE_8814B)) -+#define BIT_GET_ACH0_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH0_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH0_DESC_MODE_8814B) -+#define BIT_SET_ACH0_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH0_DESC_MODE_8814B(x) | BIT_ACH0_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH0_DESC_NUM_8814B 0 -+#define BIT_MASK_ACH0_DESC_NUM_8814B 0xfff -+#define BIT_ACH0_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH0_DESC_NUM_8814B) << BIT_SHIFT_ACH0_DESC_NUM_8814B) -+#define BITS_ACH0_DESC_NUM_8814B \ -+ (BIT_MASK_ACH0_DESC_NUM_8814B << BIT_SHIFT_ACH0_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH0_DESC_NUM_8814B(x) ((x) & (~BITS_ACH0_DESC_NUM_8814B)) -+#define BIT_GET_ACH0_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH0_DESC_NUM_8814B) & BIT_MASK_ACH0_DESC_NUM_8814B) -+#define BIT_SET_ACH0_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH0_DESC_NUM_8814B(x) | BIT_ACH0_DESC_NUM_8814B(v)) -+ -+/* 2 REG_ACH2_ACH3_TXBD_NUM_8814B */ -+#define BIT_PCIE_ACH3_FLAG_V1_8814B BIT(30) -+ -+#define BIT_SHIFT_ACH3_DESC_MODE_V1_8814B 28 -+#define BIT_MASK_ACH3_DESC_MODE_V1_8814B 0x3 -+#define BIT_ACH3_DESC_MODE_V1_8814B(x) \ -+ (((x) & BIT_MASK_ACH3_DESC_MODE_V1_8814B) \ -+ << BIT_SHIFT_ACH3_DESC_MODE_V1_8814B) -+#define BITS_ACH3_DESC_MODE_V1_8814B \ -+ (BIT_MASK_ACH3_DESC_MODE_V1_8814B << BIT_SHIFT_ACH3_DESC_MODE_V1_8814B) -+#define BIT_CLEAR_ACH3_DESC_MODE_V1_8814B(x) \ -+ ((x) & (~BITS_ACH3_DESC_MODE_V1_8814B)) -+#define BIT_GET_ACH3_DESC_MODE_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH3_DESC_MODE_V1_8814B) & \ -+ BIT_MASK_ACH3_DESC_MODE_V1_8814B) -+#define BIT_SET_ACH3_DESC_MODE_V1_8814B(x, v) \ -+ (BIT_CLEAR_ACH3_DESC_MODE_V1_8814B(x) | BIT_ACH3_DESC_MODE_V1_8814B(v)) -+ -+#define BIT_SHIFT_ACH3_DESC_NUM_V1_8814B 16 -+#define BIT_MASK_ACH3_DESC_NUM_V1_8814B 0xfff -+#define BIT_ACH3_DESC_NUM_V1_8814B(x) \ -+ (((x) & BIT_MASK_ACH3_DESC_NUM_V1_8814B) \ -+ << BIT_SHIFT_ACH3_DESC_NUM_V1_8814B) -+#define BITS_ACH3_DESC_NUM_V1_8814B \ -+ (BIT_MASK_ACH3_DESC_NUM_V1_8814B << BIT_SHIFT_ACH3_DESC_NUM_V1_8814B) -+#define BIT_CLEAR_ACH3_DESC_NUM_V1_8814B(x) \ -+ ((x) & (~BITS_ACH3_DESC_NUM_V1_8814B)) -+#define BIT_GET_ACH3_DESC_NUM_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH3_DESC_NUM_V1_8814B) & \ -+ BIT_MASK_ACH3_DESC_NUM_V1_8814B) -+#define BIT_SET_ACH3_DESC_NUM_V1_8814B(x, v) \ -+ (BIT_CLEAR_ACH3_DESC_NUM_V1_8814B(x) | BIT_ACH3_DESC_NUM_V1_8814B(v)) -+ -+#define BIT_PCIE_ACH2_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_ACH2_DESC_MODE_8814B 12 -+#define BIT_MASK_ACH2_DESC_MODE_8814B 0x3 -+#define BIT_ACH2_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH2_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH2_DESC_MODE_8814B) -+#define BITS_ACH2_DESC_MODE_8814B \ -+ (BIT_MASK_ACH2_DESC_MODE_8814B << BIT_SHIFT_ACH2_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH2_DESC_MODE_8814B(x) ((x) & (~BITS_ACH2_DESC_MODE_8814B)) -+#define BIT_GET_ACH2_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH2_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH2_DESC_MODE_8814B) -+#define BIT_SET_ACH2_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH2_DESC_MODE_8814B(x) | BIT_ACH2_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH2_DESC_NUM_8814B 0 -+#define BIT_MASK_ACH2_DESC_NUM_8814B 0xfff -+#define BIT_ACH2_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH2_DESC_NUM_8814B) << BIT_SHIFT_ACH2_DESC_NUM_8814B) -+#define BITS_ACH2_DESC_NUM_8814B \ -+ (BIT_MASK_ACH2_DESC_NUM_8814B << BIT_SHIFT_ACH2_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH2_DESC_NUM_8814B(x) ((x) & (~BITS_ACH2_DESC_NUM_8814B)) -+#define BIT_GET_ACH2_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH2_DESC_NUM_8814B) & BIT_MASK_ACH2_DESC_NUM_8814B) -+#define BIT_SET_ACH2_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH2_DESC_NUM_8814B(x) | BIT_ACH2_DESC_NUM_8814B(v)) -+ -+/* 2 REG_P0HI0Q_HI1Q_TXBD_NUM_8814B */ -+#define BIT_P0HI1Q_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_P0HI1Q_DESC_MODE_8814B 28 -+#define BIT_MASK_P0HI1Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI1Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI1Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI1Q_DESC_MODE_8814B) -+#define BITS_P0HI1Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI1Q_DESC_MODE_8814B << BIT_SHIFT_P0HI1Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI1Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI1Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI1Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI1Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI1Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI1Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI1Q_DESC_MODE_8814B(x) | BIT_P0HI1Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI1Q_DESC_NUM_8814B 16 -+#define BIT_MASK_P0HI1Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI1Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI1Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI1Q_DESC_NUM_8814B) -+#define BITS_P0HI1Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI1Q_DESC_NUM_8814B << BIT_SHIFT_P0HI1Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI1Q_DESC_NUM_8814B(x) ((x) & (~BITS_P0HI1Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI1Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI1Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI1Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI1Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI1Q_DESC_NUM_8814B(x) | BIT_P0HI1Q_DESC_NUM_8814B(v)) -+ -+#define BIT_P0HI0Q_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0HI0Q_DESC_MODE_8814B 12 -+#define BIT_MASK_P0HI0Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI0Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI0Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI0Q_DESC_MODE_8814B) -+#define BITS_P0HI0Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI0Q_DESC_MODE_8814B << BIT_SHIFT_P0HI0Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI0Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI0Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI0Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI0Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI0Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI0Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI0Q_DESC_MODE_8814B(x) | BIT_P0HI0Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI0Q_DESC_NUM_8814B 0 -+#define BIT_MASK_P0HI0Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI0Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI0Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI0Q_DESC_NUM_8814B) -+#define BITS_P0HI0Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI0Q_DESC_NUM_8814B << BIT_SHIFT_P0HI0Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI0Q_DESC_NUM_8814B(x) ((x) & (~BITS_P0HI0Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI0Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI0Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI0Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI0Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI0Q_DESC_NUM_8814B(x) | BIT_P0HI0Q_DESC_NUM_8814B(v)) -+ -+/* 2 REG_P0HI2Q_HI3Q_TXBD_NUM_8814B */ -+#define BIT_P0HI3Q_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_P0HI3Q_DESC_MODE_8814B 28 -+#define BIT_MASK_P0HI3Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI3Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI3Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI3Q_DESC_MODE_8814B) -+#define BITS_P0HI3Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI3Q_DESC_MODE_8814B << BIT_SHIFT_P0HI3Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI3Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI3Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI3Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI3Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI3Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI3Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI3Q_DESC_MODE_8814B(x) | BIT_P0HI3Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI3Q_DESC_NUM_8814B 16 -+#define BIT_MASK_P0HI3Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI3Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI3Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI3Q_DESC_NUM_8814B) -+#define BITS_P0HI3Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI3Q_DESC_NUM_8814B << BIT_SHIFT_P0HI3Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI3Q_DESC_NUM_8814B(x) ((x) & (~BITS_P0HI3Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI3Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI3Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI3Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI3Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI3Q_DESC_NUM_8814B(x) | BIT_P0HI3Q_DESC_NUM_8814B(v)) -+ -+#define BIT_P0HI2Q_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0HI2Q_DESC_MODE_8814B 12 -+#define BIT_MASK_P0HI2Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI2Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI2Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI2Q_DESC_MODE_8814B) -+#define BITS_P0HI2Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI2Q_DESC_MODE_8814B << BIT_SHIFT_P0HI2Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI2Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI2Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI2Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI2Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI2Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI2Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI2Q_DESC_MODE_8814B(x) | BIT_P0HI2Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI2Q_DESC_NUM_8814B 0 -+#define BIT_MASK_P0HI2Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI2Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI2Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI2Q_DESC_NUM_8814B) -+#define BITS_P0HI2Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI2Q_DESC_NUM_8814B << BIT_SHIFT_P0HI2Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI2Q_DESC_NUM_8814B(x) ((x) & (~BITS_P0HI2Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI2Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI2Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI2Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI2Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI2Q_DESC_NUM_8814B(x) | BIT_P0HI2Q_DESC_NUM_8814B(v)) -+ -+/* 2 REG_P0HI4Q_HI5Q_TXBD_NUM_8814B */ -+#define BIT_P0HI5Q_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_P0HI5Q_DESC_MODE_8814B 28 -+#define BIT_MASK_P0HI5Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI5Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI5Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI5Q_DESC_MODE_8814B) -+#define BITS_P0HI5Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI5Q_DESC_MODE_8814B << BIT_SHIFT_P0HI5Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI5Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI5Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI5Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI5Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI5Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI5Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI5Q_DESC_MODE_8814B(x) | BIT_P0HI5Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI5Q_DESC_NUM_8814B 16 -+#define BIT_MASK_P0HI5Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI5Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI5Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI5Q_DESC_NUM_8814B) -+#define BITS_P0HI5Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI5Q_DESC_NUM_8814B << BIT_SHIFT_P0HI5Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI5Q_DESC_NUM_8814B(x) ((x) & (~BITS_P0HI5Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI5Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI5Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI5Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI5Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI5Q_DESC_NUM_8814B(x) | BIT_P0HI5Q_DESC_NUM_8814B(v)) -+ -+#define BIT_P0HI4Q_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0HI4Q_DESC_MODE_8814B 12 -+#define BIT_MASK_P0HI4Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI4Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI4Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI4Q_DESC_MODE_8814B) -+#define BITS_P0HI4Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI4Q_DESC_MODE_8814B << BIT_SHIFT_P0HI4Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI4Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI4Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI4Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI4Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI4Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI4Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI4Q_DESC_MODE_8814B(x) | BIT_P0HI4Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI4Q_DESC_NUM_8814B 0 -+#define BIT_MASK_P0HI4Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI4Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI4Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI4Q_DESC_NUM_8814B) -+#define BITS_P0HI4Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI4Q_DESC_NUM_8814B << BIT_SHIFT_P0HI4Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI4Q_DESC_NUM_8814B(x) ((x) & (~BITS_P0HI4Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI4Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI4Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI4Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI4Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI4Q_DESC_NUM_8814B(x) | BIT_P0HI4Q_DESC_NUM_8814B(v)) -+ -+/* 2 REG_P0HI6Q_HI7Q_TXBD_NUM_8814B */ -+#define BIT_P0HI7Q_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_P0HI7Q_DESC_MODE_8814B 28 -+#define BIT_MASK_P0HI7Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI7Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI7Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI7Q_DESC_MODE_8814B) -+#define BITS_P0HI7Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI7Q_DESC_MODE_8814B << BIT_SHIFT_P0HI7Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI7Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI7Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI7Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI7Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI7Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI7Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI7Q_DESC_MODE_8814B(x) | BIT_P0HI7Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI7Q_DESC_NUM_8814B 16 -+#define BIT_MASK_P0HI7Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI7Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI7Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI7Q_DESC_NUM_8814B) -+#define BITS_P0HI7Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI7Q_DESC_NUM_8814B << BIT_SHIFT_P0HI7Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI7Q_DESC_NUM_8814B(x) ((x) & (~BITS_P0HI7Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI7Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI7Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI7Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI7Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI7Q_DESC_NUM_8814B(x) | BIT_P0HI7Q_DESC_NUM_8814B(v)) -+ -+#define BIT_P0HI6Q_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0HI6Q_DESC_MODE_8814B 12 -+#define BIT_MASK_P0HI6Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI6Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI6Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI6Q_DESC_MODE_8814B) -+#define BITS_P0HI6Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI6Q_DESC_MODE_8814B << BIT_SHIFT_P0HI6Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI6Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI6Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI6Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI6Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI6Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI6Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI6Q_DESC_MODE_8814B(x) | BIT_P0HI6Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI6Q_DESC_NUM_8814B 0 -+#define BIT_MASK_P0HI6Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI6Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI6Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI6Q_DESC_NUM_8814B) -+#define BITS_P0HI6Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI6Q_DESC_NUM_8814B << BIT_SHIFT_P0HI6Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI6Q_DESC_NUM_8814B(x) ((x) & (~BITS_P0HI6Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI6Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI6Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI6Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI6Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI6Q_DESC_NUM_8814B(x) | BIT_P0HI6Q_DESC_NUM_8814B(v)) -+ -+/* 2 REG_BD_RWPTR_CLR1_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CLR_FWCMDQ_HW_IDX_8814B BIT(30) -+#define BIT_CLR_P0HI7Q_HW_IDX_8814B BIT(29) -+#define BIT_CLR_P0HI6Q_HW_IDX_8814B BIT(28) -+#define BIT_CLR_P0HI5Q_HW_IDX_8814B BIT(27) -+#define BIT_CLR_P0HI4Q_HW_IDX_8814B BIT(26) -+#define BIT_CLR_P0HI3Q_HW_IDX_8814B BIT(25) -+#define BIT_CLR_P0HI2Q_HW_IDX_8814B BIT(24) -+#define BIT_CLR_P0HI1Q_HW_IDX_8814B BIT(23) -+#define BIT_CLR_P0HI0Q_HW_IDX_8814B BIT(22) -+#define BIT_CLR_ACH3_HW_IDX_8814B BIT(21) -+#define BIT_CLR_ACH2_HW_IDX_8814B BIT(20) -+#define BIT_CLR_ACH1_HW_IDX_8814B BIT(19) -+#define BIT_CLR_ACH0_HW_IDX_8814B BIT(18) -+#define BIT_CLR_P0MGQ_HW_IDX_8814B BIT(17) -+#define BIT_CLR_P0RXQ_HW_IDX_8814B BIT(16) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CLR_PFWCMDQ_HOST_IDX_8814B BIT(14) -+#define BIT_CLR_P0HI7Q_HOST_IDX_8814B BIT(13) -+#define BIT_CLR_P0HI6Q_HOST_IDX_8814B BIT(12) -+#define BIT_CLR_P0HI5Q_HOST_IDX_8814B BIT(11) -+#define BIT_CLR_P0HI4Q_HOST_IDX_8814B BIT(10) -+#define BIT_CLR_P0HI3Q_HOST_IDX_8814B BIT(9) -+#define BIT_CLR_P0HI2Q_HOST_IDX_8814B BIT(8) -+#define BIT_CLR_P0HI1Q_HOST_IDX_8814B BIT(7) -+#define BIT_CLR_P0HI0Q_HOST_IDX_8814B BIT(6) -+#define BIT_CLR_ACH3_HOST_IDX_8814B BIT(5) -+#define BIT_CLR_ACH2_HOST_IDX_8814B BIT(4) -+#define BIT_CLR_ACH1_HOST_IDX_8814B BIT(3) -+#define BIT_CLR_ACH0_HOST_IDX_8814B BIT(2) -+#define BIT_CLR_P0MGQ_HOST_IDX_8814B BIT(1) -+#define BIT_CLR_P0RXQ_HOST_IDX_8814B BIT(0) -+ -+/* 2 REG_TSFTIMER_HCI_8814B */ -+ -+#define BIT_SHIFT_TSFT2_HCI_8814B 16 -+#define BIT_MASK_TSFT2_HCI_8814B 0xffff -+#define BIT_TSFT2_HCI_8814B(x) \ -+ (((x) & BIT_MASK_TSFT2_HCI_8814B) << BIT_SHIFT_TSFT2_HCI_8814B) -+#define BITS_TSFT2_HCI_8814B \ -+ (BIT_MASK_TSFT2_HCI_8814B << BIT_SHIFT_TSFT2_HCI_8814B) -+#define BIT_CLEAR_TSFT2_HCI_8814B(x) ((x) & (~BITS_TSFT2_HCI_8814B)) -+#define BIT_GET_TSFT2_HCI_8814B(x) \ -+ (((x) >> BIT_SHIFT_TSFT2_HCI_8814B) & BIT_MASK_TSFT2_HCI_8814B) -+#define BIT_SET_TSFT2_HCI_8814B(x, v) \ -+ (BIT_CLEAR_TSFT2_HCI_8814B(x) | BIT_TSFT2_HCI_8814B(v)) -+ -+#define BIT_SHIFT_TSFT1_HCI_8814B 0 -+#define BIT_MASK_TSFT1_HCI_8814B 0xffff -+#define BIT_TSFT1_HCI_8814B(x) \ -+ (((x) & BIT_MASK_TSFT1_HCI_8814B) << BIT_SHIFT_TSFT1_HCI_8814B) -+#define BITS_TSFT1_HCI_8814B \ -+ (BIT_MASK_TSFT1_HCI_8814B << BIT_SHIFT_TSFT1_HCI_8814B) -+#define BIT_CLEAR_TSFT1_HCI_8814B(x) ((x) & (~BITS_TSFT1_HCI_8814B)) -+#define BIT_GET_TSFT1_HCI_8814B(x) \ -+ (((x) >> BIT_SHIFT_TSFT1_HCI_8814B) & BIT_MASK_TSFT1_HCI_8814B) -+#define BIT_SET_TSFT1_HCI_8814B(x, v) \ -+ (BIT_CLEAR_TSFT1_HCI_8814B(x) | BIT_TSFT1_HCI_8814B(v)) -+ -+/* 2 REG_ACH0_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH0_HW_IDX_8814B 16 -+#define BIT_MASK_ACH0_HW_IDX_8814B 0xfff -+#define BIT_ACH0_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH0_HW_IDX_8814B) << BIT_SHIFT_ACH0_HW_IDX_8814B) -+#define BITS_ACH0_HW_IDX_8814B \ -+ (BIT_MASK_ACH0_HW_IDX_8814B << BIT_SHIFT_ACH0_HW_IDX_8814B) -+#define BIT_CLEAR_ACH0_HW_IDX_8814B(x) ((x) & (~BITS_ACH0_HW_IDX_8814B)) -+#define BIT_GET_ACH0_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH0_HW_IDX_8814B) & BIT_MASK_ACH0_HW_IDX_8814B) -+#define BIT_SET_ACH0_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH0_HW_IDX_8814B(x) | BIT_ACH0_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH0_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH0_HOST_IDX_8814B 0xfff -+#define BIT_ACH0_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH0_HOST_IDX_8814B) << BIT_SHIFT_ACH0_HOST_IDX_8814B) -+#define BITS_ACH0_HOST_IDX_8814B \ -+ (BIT_MASK_ACH0_HOST_IDX_8814B << BIT_SHIFT_ACH0_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH0_HOST_IDX_8814B(x) ((x) & (~BITS_ACH0_HOST_IDX_8814B)) -+#define BIT_GET_ACH0_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH0_HOST_IDX_8814B) & BIT_MASK_ACH0_HOST_IDX_8814B) -+#define BIT_SET_ACH0_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH0_HOST_IDX_8814B(x) | BIT_ACH0_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH1_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH1_HW_IDX_8814B 16 -+#define BIT_MASK_ACH1_HW_IDX_8814B 0xfff -+#define BIT_ACH1_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH1_HW_IDX_8814B) << BIT_SHIFT_ACH1_HW_IDX_8814B) -+#define BITS_ACH1_HW_IDX_8814B \ -+ (BIT_MASK_ACH1_HW_IDX_8814B << BIT_SHIFT_ACH1_HW_IDX_8814B) -+#define BIT_CLEAR_ACH1_HW_IDX_8814B(x) ((x) & (~BITS_ACH1_HW_IDX_8814B)) -+#define BIT_GET_ACH1_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH1_HW_IDX_8814B) & BIT_MASK_ACH1_HW_IDX_8814B) -+#define BIT_SET_ACH1_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH1_HW_IDX_8814B(x) | BIT_ACH1_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH1_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH1_HOST_IDX_8814B 0xfff -+#define BIT_ACH1_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH1_HOST_IDX_8814B) << BIT_SHIFT_ACH1_HOST_IDX_8814B) -+#define BITS_ACH1_HOST_IDX_8814B \ -+ (BIT_MASK_ACH1_HOST_IDX_8814B << BIT_SHIFT_ACH1_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH1_HOST_IDX_8814B(x) ((x) & (~BITS_ACH1_HOST_IDX_8814B)) -+#define BIT_GET_ACH1_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH1_HOST_IDX_8814B) & BIT_MASK_ACH1_HOST_IDX_8814B) -+#define BIT_SET_ACH1_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH1_HOST_IDX_8814B(x) | BIT_ACH1_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH2_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH2_HW_IDX_8814B 16 -+#define BIT_MASK_ACH2_HW_IDX_8814B 0xfff -+#define BIT_ACH2_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH2_HW_IDX_8814B) << BIT_SHIFT_ACH2_HW_IDX_8814B) -+#define BITS_ACH2_HW_IDX_8814B \ -+ (BIT_MASK_ACH2_HW_IDX_8814B << BIT_SHIFT_ACH2_HW_IDX_8814B) -+#define BIT_CLEAR_ACH2_HW_IDX_8814B(x) ((x) & (~BITS_ACH2_HW_IDX_8814B)) -+#define BIT_GET_ACH2_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH2_HW_IDX_8814B) & BIT_MASK_ACH2_HW_IDX_8814B) -+#define BIT_SET_ACH2_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH2_HW_IDX_8814B(x) | BIT_ACH2_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH2_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH2_HOST_IDX_8814B 0xfff -+#define BIT_ACH2_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH2_HOST_IDX_8814B) << BIT_SHIFT_ACH2_HOST_IDX_8814B) -+#define BITS_ACH2_HOST_IDX_8814B \ -+ (BIT_MASK_ACH2_HOST_IDX_8814B << BIT_SHIFT_ACH2_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH2_HOST_IDX_8814B(x) ((x) & (~BITS_ACH2_HOST_IDX_8814B)) -+#define BIT_GET_ACH2_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH2_HOST_IDX_8814B) & BIT_MASK_ACH2_HOST_IDX_8814B) -+#define BIT_SET_ACH2_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH2_HOST_IDX_8814B(x) | BIT_ACH2_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH3_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH3_HW_IDX_8814B 16 -+#define BIT_MASK_ACH3_HW_IDX_8814B 0xfff -+#define BIT_ACH3_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH3_HW_IDX_8814B) << BIT_SHIFT_ACH3_HW_IDX_8814B) -+#define BITS_ACH3_HW_IDX_8814B \ -+ (BIT_MASK_ACH3_HW_IDX_8814B << BIT_SHIFT_ACH3_HW_IDX_8814B) -+#define BIT_CLEAR_ACH3_HW_IDX_8814B(x) ((x) & (~BITS_ACH3_HW_IDX_8814B)) -+#define BIT_GET_ACH3_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH3_HW_IDX_8814B) & BIT_MASK_ACH3_HW_IDX_8814B) -+#define BIT_SET_ACH3_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH3_HW_IDX_8814B(x) | BIT_ACH3_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH3_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH3_HOST_IDX_8814B 0xfff -+#define BIT_ACH3_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH3_HOST_IDX_8814B) << BIT_SHIFT_ACH3_HOST_IDX_8814B) -+#define BITS_ACH3_HOST_IDX_8814B \ -+ (BIT_MASK_ACH3_HOST_IDX_8814B << BIT_SHIFT_ACH3_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH3_HOST_IDX_8814B(x) ((x) & (~BITS_ACH3_HOST_IDX_8814B)) -+#define BIT_GET_ACH3_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH3_HOST_IDX_8814B) & BIT_MASK_ACH3_HOST_IDX_8814B) -+#define BIT_SET_ACH3_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH3_HOST_IDX_8814B(x) | BIT_ACH3_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0MGQ_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0MGQ_HW_IDX_8814B 16 -+#define BIT_MASK_P0MGQ_HW_IDX_8814B 0xfff -+#define BIT_P0MGQ_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0MGQ_HW_IDX_8814B) << BIT_SHIFT_P0MGQ_HW_IDX_8814B) -+#define BITS_P0MGQ_HW_IDX_8814B \ -+ (BIT_MASK_P0MGQ_HW_IDX_8814B << BIT_SHIFT_P0MGQ_HW_IDX_8814B) -+#define BIT_CLEAR_P0MGQ_HW_IDX_8814B(x) ((x) & (~BITS_P0MGQ_HW_IDX_8814B)) -+#define BIT_GET_P0MGQ_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0MGQ_HW_IDX_8814B) & BIT_MASK_P0MGQ_HW_IDX_8814B) -+#define BIT_SET_P0MGQ_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0MGQ_HW_IDX_8814B(x) | BIT_P0MGQ_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0MGQ_HOST_IDX_8814B 0 -+#define BIT_MASK_P0MGQ_HOST_IDX_8814B 0xfff -+#define BIT_P0MGQ_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0MGQ_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0MGQ_HOST_IDX_8814B) -+#define BITS_P0MGQ_HOST_IDX_8814B \ -+ (BIT_MASK_P0MGQ_HOST_IDX_8814B << BIT_SHIFT_P0MGQ_HOST_IDX_8814B) -+#define BIT_CLEAR_P0MGQ_HOST_IDX_8814B(x) ((x) & (~BITS_P0MGQ_HOST_IDX_8814B)) -+#define BIT_GET_P0MGQ_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0MGQ_HOST_IDX_8814B) & \ -+ BIT_MASK_P0MGQ_HOST_IDX_8814B) -+#define BIT_SET_P0MGQ_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0MGQ_HOST_IDX_8814B(x) | BIT_P0MGQ_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0RXQ_RXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0RXQ_HW_IDX_8814B 16 -+#define BIT_MASK_P0RXQ_HW_IDX_8814B 0xfff -+#define BIT_P0RXQ_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0RXQ_HW_IDX_8814B) << BIT_SHIFT_P0RXQ_HW_IDX_8814B) -+#define BITS_P0RXQ_HW_IDX_8814B \ -+ (BIT_MASK_P0RXQ_HW_IDX_8814B << BIT_SHIFT_P0RXQ_HW_IDX_8814B) -+#define BIT_CLEAR_P0RXQ_HW_IDX_8814B(x) ((x) & (~BITS_P0RXQ_HW_IDX_8814B)) -+#define BIT_GET_P0RXQ_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0RXQ_HW_IDX_8814B) & BIT_MASK_P0RXQ_HW_IDX_8814B) -+#define BIT_SET_P0RXQ_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0RXQ_HW_IDX_8814B(x) | BIT_P0RXQ_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0RXQ_HOST_IDX_8814B 0 -+#define BIT_MASK_P0RXQ_HOST_IDX_8814B 0xfff -+#define BIT_P0RXQ_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0RXQ_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0RXQ_HOST_IDX_8814B) -+#define BITS_P0RXQ_HOST_IDX_8814B \ -+ (BIT_MASK_P0RXQ_HOST_IDX_8814B << BIT_SHIFT_P0RXQ_HOST_IDX_8814B) -+#define BIT_CLEAR_P0RXQ_HOST_IDX_8814B(x) ((x) & (~BITS_P0RXQ_HOST_IDX_8814B)) -+#define BIT_GET_P0RXQ_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0RXQ_HOST_IDX_8814B) & \ -+ BIT_MASK_P0RXQ_HOST_IDX_8814B) -+#define BIT_SET_P0RXQ_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0RXQ_HOST_IDX_8814B(x) | BIT_P0RXQ_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI0Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI0Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI0Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI0Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI0Q_HW_IDX_8814B) << BIT_SHIFT_P0HI0Q_HW_IDX_8814B) -+#define BITS_P0HI0Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI0Q_HW_IDX_8814B << BIT_SHIFT_P0HI0Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI0Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI0Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI0Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI0Q_HW_IDX_8814B) & BIT_MASK_P0HI0Q_HW_IDX_8814B) -+#define BIT_SET_P0HI0Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI0Q_HW_IDX_8814B(x) | BIT_P0HI0Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI0Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI0Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI0Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI0Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI0Q_HOST_IDX_8814B) -+#define BITS_P0HI0Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI0Q_HOST_IDX_8814B << BIT_SHIFT_P0HI0Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI0Q_HOST_IDX_8814B(x) ((x) & (~BITS_P0HI0Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI0Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI0Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI0Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI0Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI0Q_HOST_IDX_8814B(x) | BIT_P0HI0Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI1Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI1Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI1Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI1Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI1Q_HW_IDX_8814B) << BIT_SHIFT_P0HI1Q_HW_IDX_8814B) -+#define BITS_P0HI1Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI1Q_HW_IDX_8814B << BIT_SHIFT_P0HI1Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI1Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI1Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI1Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI1Q_HW_IDX_8814B) & BIT_MASK_P0HI1Q_HW_IDX_8814B) -+#define BIT_SET_P0HI1Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI1Q_HW_IDX_8814B(x) | BIT_P0HI1Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI1Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI1Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI1Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI1Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI1Q_HOST_IDX_8814B) -+#define BITS_P0HI1Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI1Q_HOST_IDX_8814B << BIT_SHIFT_P0HI1Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI1Q_HOST_IDX_8814B(x) ((x) & (~BITS_P0HI1Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI1Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI1Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI1Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI1Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI1Q_HOST_IDX_8814B(x) | BIT_P0HI1Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI2Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI2Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI2Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI2Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI2Q_HW_IDX_8814B) << BIT_SHIFT_P0HI2Q_HW_IDX_8814B) -+#define BITS_P0HI2Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI2Q_HW_IDX_8814B << BIT_SHIFT_P0HI2Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI2Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI2Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI2Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI2Q_HW_IDX_8814B) & BIT_MASK_P0HI2Q_HW_IDX_8814B) -+#define BIT_SET_P0HI2Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI2Q_HW_IDX_8814B(x) | BIT_P0HI2Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI2Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI2Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI2Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI2Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI2Q_HOST_IDX_8814B) -+#define BITS_P0HI2Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI2Q_HOST_IDX_8814B << BIT_SHIFT_P0HI2Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI2Q_HOST_IDX_8814B(x) ((x) & (~BITS_P0HI2Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI2Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI2Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI2Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI2Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI2Q_HOST_IDX_8814B(x) | BIT_P0HI2Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI3Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI3Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI3Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI3Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI3Q_HW_IDX_8814B) << BIT_SHIFT_P0HI3Q_HW_IDX_8814B) -+#define BITS_P0HI3Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI3Q_HW_IDX_8814B << BIT_SHIFT_P0HI3Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI3Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI3Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI3Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI3Q_HW_IDX_8814B) & BIT_MASK_P0HI3Q_HW_IDX_8814B) -+#define BIT_SET_P0HI3Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI3Q_HW_IDX_8814B(x) | BIT_P0HI3Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI3Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI3Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI3Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI3Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI3Q_HOST_IDX_8814B) -+#define BITS_P0HI3Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI3Q_HOST_IDX_8814B << BIT_SHIFT_P0HI3Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI3Q_HOST_IDX_8814B(x) ((x) & (~BITS_P0HI3Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI3Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI3Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI3Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI3Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI3Q_HOST_IDX_8814B(x) | BIT_P0HI3Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI4Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI4Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI4Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI4Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI4Q_HW_IDX_8814B) << BIT_SHIFT_P0HI4Q_HW_IDX_8814B) -+#define BITS_P0HI4Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI4Q_HW_IDX_8814B << BIT_SHIFT_P0HI4Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI4Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI4Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI4Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI4Q_HW_IDX_8814B) & BIT_MASK_P0HI4Q_HW_IDX_8814B) -+#define BIT_SET_P0HI4Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI4Q_HW_IDX_8814B(x) | BIT_P0HI4Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI4Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI4Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI4Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI4Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI4Q_HOST_IDX_8814B) -+#define BITS_P0HI4Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI4Q_HOST_IDX_8814B << BIT_SHIFT_P0HI4Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI4Q_HOST_IDX_8814B(x) ((x) & (~BITS_P0HI4Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI4Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI4Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI4Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI4Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI4Q_HOST_IDX_8814B(x) | BIT_P0HI4Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI5Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI5Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI5Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI5Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI5Q_HW_IDX_8814B) << BIT_SHIFT_P0HI5Q_HW_IDX_8814B) -+#define BITS_P0HI5Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI5Q_HW_IDX_8814B << BIT_SHIFT_P0HI5Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI5Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI5Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI5Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI5Q_HW_IDX_8814B) & BIT_MASK_P0HI5Q_HW_IDX_8814B) -+#define BIT_SET_P0HI5Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI5Q_HW_IDX_8814B(x) | BIT_P0HI5Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI5Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI5Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI5Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI5Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI5Q_HOST_IDX_8814B) -+#define BITS_P0HI5Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI5Q_HOST_IDX_8814B << BIT_SHIFT_P0HI5Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI5Q_HOST_IDX_8814B(x) ((x) & (~BITS_P0HI5Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI5Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI5Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI5Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI5Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI5Q_HOST_IDX_8814B(x) | BIT_P0HI5Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI6Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI6Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI6Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI6Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI6Q_HW_IDX_8814B) << BIT_SHIFT_P0HI6Q_HW_IDX_8814B) -+#define BITS_P0HI6Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI6Q_HW_IDX_8814B << BIT_SHIFT_P0HI6Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI6Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI6Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI6Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI6Q_HW_IDX_8814B) & BIT_MASK_P0HI6Q_HW_IDX_8814B) -+#define BIT_SET_P0HI6Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI6Q_HW_IDX_8814B(x) | BIT_P0HI6Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI6Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI6Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI6Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI6Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI6Q_HOST_IDX_8814B) -+#define BITS_P0HI6Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI6Q_HOST_IDX_8814B << BIT_SHIFT_P0HI6Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI6Q_HOST_IDX_8814B(x) ((x) & (~BITS_P0HI6Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI6Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI6Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI6Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI6Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI6Q_HOST_IDX_8814B(x) | BIT_P0HI6Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI7Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI7Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI7Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI7Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI7Q_HW_IDX_8814B) << BIT_SHIFT_P0HI7Q_HW_IDX_8814B) -+#define BITS_P0HI7Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI7Q_HW_IDX_8814B << BIT_SHIFT_P0HI7Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI7Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI7Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI7Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI7Q_HW_IDX_8814B) & BIT_MASK_P0HI7Q_HW_IDX_8814B) -+#define BIT_SET_P0HI7Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI7Q_HW_IDX_8814B(x) | BIT_P0HI7Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI7Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI7Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI7Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI7Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI7Q_HOST_IDX_8814B) -+#define BITS_P0HI7Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI7Q_HOST_IDX_8814B << BIT_SHIFT_P0HI7Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI7Q_HOST_IDX_8814B(x) ((x) & (~BITS_P0HI7Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI7Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI7Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI7Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI7Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI7Q_HOST_IDX_8814B(x) | BIT_P0HI7Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_DBGSEL_PCIE_HRPWM1_HCPWM1_V1_8814B */ -+#define BIT_DIS_TXDMA_PRE_V1_8814B BIT(31) -+#define BIT_DIS_RXDMA_PRE_V1_8814B BIT(30) -+ -+#define BIT_SHIFT_HPS_CLKR_PCIE_V1_8814B 28 -+#define BIT_MASK_HPS_CLKR_PCIE_V1_8814B 0x3 -+#define BIT_HPS_CLKR_PCIE_V1_8814B(x) \ -+ (((x) & BIT_MASK_HPS_CLKR_PCIE_V1_8814B) \ -+ << BIT_SHIFT_HPS_CLKR_PCIE_V1_8814B) -+#define BITS_HPS_CLKR_PCIE_V1_8814B \ -+ (BIT_MASK_HPS_CLKR_PCIE_V1_8814B << BIT_SHIFT_HPS_CLKR_PCIE_V1_8814B) -+#define BIT_CLEAR_HPS_CLKR_PCIE_V1_8814B(x) \ -+ ((x) & (~BITS_HPS_CLKR_PCIE_V1_8814B)) -+#define BIT_GET_HPS_CLKR_PCIE_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_HPS_CLKR_PCIE_V1_8814B) & \ -+ BIT_MASK_HPS_CLKR_PCIE_V1_8814B) -+#define BIT_SET_HPS_CLKR_PCIE_V1_8814B(x, v) \ -+ (BIT_CLEAR_HPS_CLKR_PCIE_V1_8814B(x) | BIT_HPS_CLKR_PCIE_V1_8814B(v)) -+ -+#define BIT_PCIE_INT_V1_8814B BIT(27) -+#define BIT_TXFLAG_EXIT_L1_EN_V1_8814B BIT(26) -+#define BIT_EN_RXDMA_ALIGN_V2_8814B BIT(25) -+#define BIT_EN_TXDMA_ALIGN_V2_8814B BIT(24) -+ -+#define BIT_SHIFT_PCIE_HCPWM_V1_8814B 16 -+#define BIT_MASK_PCIE_HCPWM_V1_8814B 0xff -+#define BIT_PCIE_HCPWM_V1_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM_V1_8814B) << BIT_SHIFT_PCIE_HCPWM_V1_8814B) -+#define BITS_PCIE_HCPWM_V1_8814B \ -+ (BIT_MASK_PCIE_HCPWM_V1_8814B << BIT_SHIFT_PCIE_HCPWM_V1_8814B) -+#define BIT_CLEAR_PCIE_HCPWM_V1_8814B(x) ((x) & (~BITS_PCIE_HCPWM_V1_8814B)) -+#define BIT_GET_PCIE_HCPWM_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM_V1_8814B) & BIT_MASK_PCIE_HCPWM_V1_8814B) -+#define BIT_SET_PCIE_HCPWM_V1_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM_V1_8814B(x) | BIT_PCIE_HCPWM_V1_8814B(v)) -+ -+#define BIT_SHIFT_PCIE_HRPWM_V1_8814B 8 -+#define BIT_MASK_PCIE_HRPWM_V1_8814B 0xff -+#define BIT_PCIE_HRPWM_V1_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM_V1_8814B) << BIT_SHIFT_PCIE_HRPWM_V1_8814B) -+#define BITS_PCIE_HRPWM_V1_8814B \ -+ (BIT_MASK_PCIE_HRPWM_V1_8814B << BIT_SHIFT_PCIE_HRPWM_V1_8814B) -+#define BIT_CLEAR_PCIE_HRPWM_V1_8814B(x) ((x) & (~BITS_PCIE_HRPWM_V1_8814B)) -+#define BIT_GET_PCIE_HRPWM_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM_V1_8814B) & BIT_MASK_PCIE_HRPWM_V1_8814B) -+#define BIT_SET_PCIE_HRPWM_V1_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM_V1_8814B(x) | BIT_PCIE_HRPWM_V1_8814B(v)) -+ -+#define BIT_SHIFT_DBG_SEL_8814B 0 -+#define BIT_MASK_DBG_SEL_8814B 0xff -+#define BIT_DBG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_DBG_SEL_8814B) << BIT_SHIFT_DBG_SEL_8814B) -+#define BITS_DBG_SEL_8814B (BIT_MASK_DBG_SEL_8814B << BIT_SHIFT_DBG_SEL_8814B) -+#define BIT_CLEAR_DBG_SEL_8814B(x) ((x) & (~BITS_DBG_SEL_8814B)) -+#define BIT_GET_DBG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_8814B) & BIT_MASK_DBG_SEL_8814B) -+#define BIT_SET_DBG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_DBG_SEL_8814B(x) | BIT_DBG_SEL_8814B(v)) -+ -+/* 2 REG_PCIE_HRPWM2_HCPWM2_V1_8814B */ -+ -+#define BIT_SHIFT_PCIE_HCPWM2_V1_8814B 16 -+#define BIT_MASK_PCIE_HCPWM2_V1_8814B 0xffff -+#define BIT_PCIE_HCPWM2_V1_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM2_V1_8814B) \ -+ << BIT_SHIFT_PCIE_HCPWM2_V1_8814B) -+#define BITS_PCIE_HCPWM2_V1_8814B \ -+ (BIT_MASK_PCIE_HCPWM2_V1_8814B << BIT_SHIFT_PCIE_HCPWM2_V1_8814B) -+#define BIT_CLEAR_PCIE_HCPWM2_V1_8814B(x) ((x) & (~BITS_PCIE_HCPWM2_V1_8814B)) -+#define BIT_GET_PCIE_HCPWM2_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM2_V1_8814B) & \ -+ BIT_MASK_PCIE_HCPWM2_V1_8814B) -+#define BIT_SET_PCIE_HCPWM2_V1_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM2_V1_8814B(x) | BIT_PCIE_HCPWM2_V1_8814B(v)) -+ -+#define BIT_SHIFT_PCIE_HRPWM2_8814B 0 -+#define BIT_MASK_PCIE_HRPWM2_8814B 0xffff -+#define BIT_PCIE_HRPWM2_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM2_8814B) << BIT_SHIFT_PCIE_HRPWM2_8814B) -+#define BITS_PCIE_HRPWM2_8814B \ -+ (BIT_MASK_PCIE_HRPWM2_8814B << BIT_SHIFT_PCIE_HRPWM2_8814B) -+#define BIT_CLEAR_PCIE_HRPWM2_8814B(x) ((x) & (~BITS_PCIE_HRPWM2_8814B)) -+#define BIT_GET_PCIE_HRPWM2_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM2_8814B) & BIT_MASK_PCIE_HRPWM2_8814B) -+#define BIT_SET_PCIE_HRPWM2_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM2_8814B(x) | BIT_PCIE_HRPWM2_8814B(v)) -+ -+/* 2 REG_PCIE_H2C_MSG_V1_8814B */ -+ -+#define BIT_SHIFT_DRV2FW_INFO_8814B 0 -+#define BIT_MASK_DRV2FW_INFO_8814B 0xffffffffL -+#define BIT_DRV2FW_INFO_8814B(x) \ -+ (((x) & BIT_MASK_DRV2FW_INFO_8814B) << BIT_SHIFT_DRV2FW_INFO_8814B) -+#define BITS_DRV2FW_INFO_8814B \ -+ (BIT_MASK_DRV2FW_INFO_8814B << BIT_SHIFT_DRV2FW_INFO_8814B) -+#define BIT_CLEAR_DRV2FW_INFO_8814B(x) ((x) & (~BITS_DRV2FW_INFO_8814B)) -+#define BIT_GET_DRV2FW_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_DRV2FW_INFO_8814B) & BIT_MASK_DRV2FW_INFO_8814B) -+#define BIT_SET_DRV2FW_INFO_8814B(x, v) \ -+ (BIT_CLEAR_DRV2FW_INFO_8814B(x) | BIT_DRV2FW_INFO_8814B(v)) -+ -+/* 2 REG_PCIE_C2H_MSG_V1_8814B */ -+ -+#define BIT_SHIFT_HCI_PCIE_C2H_MSG_8814B 0 -+#define BIT_MASK_HCI_PCIE_C2H_MSG_8814B 0xffffffffL -+#define BIT_HCI_PCIE_C2H_MSG_8814B(x) \ -+ (((x) & BIT_MASK_HCI_PCIE_C2H_MSG_8814B) \ -+ << BIT_SHIFT_HCI_PCIE_C2H_MSG_8814B) -+#define BITS_HCI_PCIE_C2H_MSG_8814B \ -+ (BIT_MASK_HCI_PCIE_C2H_MSG_8814B << BIT_SHIFT_HCI_PCIE_C2H_MSG_8814B) -+#define BIT_CLEAR_HCI_PCIE_C2H_MSG_8814B(x) \ -+ ((x) & (~BITS_HCI_PCIE_C2H_MSG_8814B)) -+#define BIT_GET_HCI_PCIE_C2H_MSG_8814B(x) \ -+ (((x) >> BIT_SHIFT_HCI_PCIE_C2H_MSG_8814B) & \ -+ BIT_MASK_HCI_PCIE_C2H_MSG_8814B) -+#define BIT_SET_HCI_PCIE_C2H_MSG_8814B(x, v) \ -+ (BIT_CLEAR_HCI_PCIE_C2H_MSG_8814B(x) | BIT_HCI_PCIE_C2H_MSG_8814B(v)) -+ -+/* 2 REG_DBI_WDATA_V1_8814B */ -+ -+#define BIT_SHIFT_DBI_WDATA_8814B 0 -+#define BIT_MASK_DBI_WDATA_8814B 0xffffffffL -+#define BIT_DBI_WDATA_8814B(x) \ -+ (((x) & BIT_MASK_DBI_WDATA_8814B) << BIT_SHIFT_DBI_WDATA_8814B) -+#define BITS_DBI_WDATA_8814B \ -+ (BIT_MASK_DBI_WDATA_8814B << BIT_SHIFT_DBI_WDATA_8814B) -+#define BIT_CLEAR_DBI_WDATA_8814B(x) ((x) & (~BITS_DBI_WDATA_8814B)) -+#define BIT_GET_DBI_WDATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DBI_WDATA_8814B) & BIT_MASK_DBI_WDATA_8814B) -+#define BIT_SET_DBI_WDATA_8814B(x, v) \ -+ (BIT_CLEAR_DBI_WDATA_8814B(x) | BIT_DBI_WDATA_8814B(v)) -+ -+/* 2 REG_DBI_RDATA_V1_8814B */ -+ -+#define BIT_SHIFT_DBI_RDATA_8814B 0 -+#define BIT_MASK_DBI_RDATA_8814B 0xffffffffL -+#define BIT_DBI_RDATA_8814B(x) \ -+ (((x) & BIT_MASK_DBI_RDATA_8814B) << BIT_SHIFT_DBI_RDATA_8814B) -+#define BITS_DBI_RDATA_8814B \ -+ (BIT_MASK_DBI_RDATA_8814B << BIT_SHIFT_DBI_RDATA_8814B) -+#define BIT_CLEAR_DBI_RDATA_8814B(x) ((x) & (~BITS_DBI_RDATA_8814B)) -+#define BIT_GET_DBI_RDATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_DBI_RDATA_8814B) & BIT_MASK_DBI_RDATA_8814B) -+#define BIT_SET_DBI_RDATA_8814B(x, v) \ -+ (BIT_CLEAR_DBI_RDATA_8814B(x) | BIT_DBI_RDATA_8814B(v)) -+ -+/* 2 REG_DBI_FLAG_V1_8814B */ -+ -+#define BIT_SHIFT_LOOPBACK_DBG_SEL_8814B 28 -+#define BIT_MASK_LOOPBACK_DBG_SEL_8814B 0xf -+#define BIT_LOOPBACK_DBG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_LOOPBACK_DBG_SEL_8814B) \ -+ << BIT_SHIFT_LOOPBACK_DBG_SEL_8814B) -+#define BITS_LOOPBACK_DBG_SEL_8814B \ -+ (BIT_MASK_LOOPBACK_DBG_SEL_8814B << BIT_SHIFT_LOOPBACK_DBG_SEL_8814B) -+#define BIT_CLEAR_LOOPBACK_DBG_SEL_8814B(x) \ -+ ((x) & (~BITS_LOOPBACK_DBG_SEL_8814B)) -+#define BIT_GET_LOOPBACK_DBG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_LOOPBACK_DBG_SEL_8814B) & \ -+ BIT_MASK_LOOPBACK_DBG_SEL_8814B) -+#define BIT_SET_LOOPBACK_DBG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_LOOPBACK_DBG_SEL_8814B(x) | BIT_LOOPBACK_DBG_SEL_8814B(v)) -+ -+#define BIT_EN_STUCK_DBG_8814B BIT(26) -+#define BIT_RX_STUCK_8814B BIT(25) -+#define BIT_TX_STUCK_8814B BIT(24) -+#define BIT_DBI_RFLAG_8814B BIT(17) -+#define BIT_DBI_WFLAG_8814B BIT(16) -+ -+#define BIT_SHIFT_DBI_WREN_8814B 12 -+#define BIT_MASK_DBI_WREN_8814B 0xf -+#define BIT_DBI_WREN_8814B(x) \ -+ (((x) & BIT_MASK_DBI_WREN_8814B) << BIT_SHIFT_DBI_WREN_8814B) -+#define BITS_DBI_WREN_8814B \ -+ (BIT_MASK_DBI_WREN_8814B << BIT_SHIFT_DBI_WREN_8814B) -+#define BIT_CLEAR_DBI_WREN_8814B(x) ((x) & (~BITS_DBI_WREN_8814B)) -+#define BIT_GET_DBI_WREN_8814B(x) \ -+ (((x) >> BIT_SHIFT_DBI_WREN_8814B) & BIT_MASK_DBI_WREN_8814B) -+#define BIT_SET_DBI_WREN_8814B(x, v) \ -+ (BIT_CLEAR_DBI_WREN_8814B(x) | BIT_DBI_WREN_8814B(v)) -+ -+#define BIT_SHIFT_DBI_ADDR_8814B 0 -+#define BIT_MASK_DBI_ADDR_8814B 0xfff -+#define BIT_DBI_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_DBI_ADDR_8814B) << BIT_SHIFT_DBI_ADDR_8814B) -+#define BITS_DBI_ADDR_8814B \ -+ (BIT_MASK_DBI_ADDR_8814B << BIT_SHIFT_DBI_ADDR_8814B) -+#define BIT_CLEAR_DBI_ADDR_8814B(x) ((x) & (~BITS_DBI_ADDR_8814B)) -+#define BIT_GET_DBI_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_DBI_ADDR_8814B) & BIT_MASK_DBI_ADDR_8814B) -+#define BIT_SET_DBI_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_DBI_ADDR_8814B(x) | BIT_DBI_ADDR_8814B(v)) -+ -+/* 2 REG_MDIO_V1_8814B */ -+ -+#define BIT_SHIFT_MDIO_RDATA_8814B 16 -+#define BIT_MASK_MDIO_RDATA_8814B 0xffff -+#define BIT_MDIO_RDATA_8814B(x) \ -+ (((x) & BIT_MASK_MDIO_RDATA_8814B) << BIT_SHIFT_MDIO_RDATA_8814B) -+#define BITS_MDIO_RDATA_8814B \ -+ (BIT_MASK_MDIO_RDATA_8814B << BIT_SHIFT_MDIO_RDATA_8814B) -+#define BIT_CLEAR_MDIO_RDATA_8814B(x) ((x) & (~BITS_MDIO_RDATA_8814B)) -+#define BIT_GET_MDIO_RDATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_MDIO_RDATA_8814B) & BIT_MASK_MDIO_RDATA_8814B) -+#define BIT_SET_MDIO_RDATA_8814B(x, v) \ -+ (BIT_CLEAR_MDIO_RDATA_8814B(x) | BIT_MDIO_RDATA_8814B(v)) -+ -+#define BIT_SHIFT_MDIO_WDATA_8814B 0 -+#define BIT_MASK_MDIO_WDATA_8814B 0xffff -+#define BIT_MDIO_WDATA_8814B(x) \ -+ (((x) & BIT_MASK_MDIO_WDATA_8814B) << BIT_SHIFT_MDIO_WDATA_8814B) -+#define BITS_MDIO_WDATA_8814B \ -+ (BIT_MASK_MDIO_WDATA_8814B << BIT_SHIFT_MDIO_WDATA_8814B) -+#define BIT_CLEAR_MDIO_WDATA_8814B(x) ((x) & (~BITS_MDIO_WDATA_8814B)) -+#define BIT_GET_MDIO_WDATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_MDIO_WDATA_8814B) & BIT_MASK_MDIO_WDATA_8814B) -+#define BIT_SET_MDIO_WDATA_8814B(x, v) \ -+ (BIT_CLEAR_MDIO_WDATA_8814B(x) | BIT_MDIO_WDATA_8814B(v)) -+ -+/* 2 REG_PCIE_MIX_CFG_8814B */ -+ -+#define BIT_SHIFT_MDIO_PHY_ADDR_8814B 24 -+#define BIT_MASK_MDIO_PHY_ADDR_8814B 0x1f -+#define BIT_MDIO_PHY_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_MDIO_PHY_ADDR_8814B) << BIT_SHIFT_MDIO_PHY_ADDR_8814B) -+#define BITS_MDIO_PHY_ADDR_8814B \ -+ (BIT_MASK_MDIO_PHY_ADDR_8814B << BIT_SHIFT_MDIO_PHY_ADDR_8814B) -+#define BIT_CLEAR_MDIO_PHY_ADDR_8814B(x) ((x) & (~BITS_MDIO_PHY_ADDR_8814B)) -+#define BIT_GET_MDIO_PHY_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_MDIO_PHY_ADDR_8814B) & BIT_MASK_MDIO_PHY_ADDR_8814B) -+#define BIT_SET_MDIO_PHY_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_MDIO_PHY_ADDR_8814B(x) | BIT_MDIO_PHY_ADDR_8814B(v)) -+ -+#define BIT_SHIFT_WATCH_DOG_RECORD_V1_8814B 10 -+#define BIT_MASK_WATCH_DOG_RECORD_V1_8814B 0x3fff -+#define BIT_WATCH_DOG_RECORD_V1_8814B(x) \ -+ (((x) & BIT_MASK_WATCH_DOG_RECORD_V1_8814B) \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8814B) -+#define BITS_WATCH_DOG_RECORD_V1_8814B \ -+ (BIT_MASK_WATCH_DOG_RECORD_V1_8814B \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8814B) -+#define BIT_CLEAR_WATCH_DOG_RECORD_V1_8814B(x) \ -+ ((x) & (~BITS_WATCH_DOG_RECORD_V1_8814B)) -+#define BIT_GET_WATCH_DOG_RECORD_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_WATCH_DOG_RECORD_V1_8814B) & \ -+ BIT_MASK_WATCH_DOG_RECORD_V1_8814B) -+#define BIT_SET_WATCH_DOG_RECORD_V1_8814B(x, v) \ -+ (BIT_CLEAR_WATCH_DOG_RECORD_V1_8814B(x) | \ -+ BIT_WATCH_DOG_RECORD_V1_8814B(v)) -+ -+#define BIT_R_IO_TIMEOUT_FLAG_V1_8814B BIT(9) -+#define BIT_EN_WATCH_DOG_8814B BIT(8) -+#define BIT_ECRC_EN_8814B BIT(7) -+#define BIT_MDIO_RFLAG_8814B BIT(6) -+#define BIT_MDIO_WFLAG_8814B BIT(5) -+ -+#define BIT_SHIFT_MDIO_REG_ADDR_8814B 0 -+#define BIT_MASK_MDIO_REG_ADDR_8814B 0x1f -+#define BIT_MDIO_REG_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_MDIO_REG_ADDR_8814B) << BIT_SHIFT_MDIO_REG_ADDR_8814B) -+#define BITS_MDIO_REG_ADDR_8814B \ -+ (BIT_MASK_MDIO_REG_ADDR_8814B << BIT_SHIFT_MDIO_REG_ADDR_8814B) -+#define BIT_CLEAR_MDIO_REG_ADDR_8814B(x) ((x) & (~BITS_MDIO_REG_ADDR_8814B)) -+#define BIT_GET_MDIO_REG_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_MDIO_REG_ADDR_8814B) & BIT_MASK_MDIO_REG_ADDR_8814B) -+#define BIT_SET_MDIO_REG_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_MDIO_REG_ADDR_8814B(x) | BIT_MDIO_REG_ADDR_8814B(v)) -+ -+/* 2 REG_HCI_MIX_CFG_8814B */ -+#define BIT_EN_ALIGN_MTU_8814B BIT(23) -+ -+#define BIT_SHIFT_LATENCY_CONTROL_8814B 21 -+#define BIT_MASK_LATENCY_CONTROL_8814B 0x3 -+#define BIT_LATENCY_CONTROL_8814B(x) \ -+ (((x) & BIT_MASK_LATENCY_CONTROL_8814B) \ -+ << BIT_SHIFT_LATENCY_CONTROL_8814B) -+#define BITS_LATENCY_CONTROL_8814B \ -+ (BIT_MASK_LATENCY_CONTROL_8814B << BIT_SHIFT_LATENCY_CONTROL_8814B) -+#define BIT_CLEAR_LATENCY_CONTROL_8814B(x) ((x) & (~BITS_LATENCY_CONTROL_8814B)) -+#define BIT_GET_LATENCY_CONTROL_8814B(x) \ -+ (((x) >> BIT_SHIFT_LATENCY_CONTROL_8814B) & \ -+ BIT_MASK_LATENCY_CONTROL_8814B) -+#define BIT_SET_LATENCY_CONTROL_8814B(x, v) \ -+ (BIT_CLEAR_LATENCY_CONTROL_8814B(x) | BIT_LATENCY_CONTROL_8814B(v)) -+ -+#define BIT_HOST_GEN2_SUPPORT_8814B BIT(20) -+ -+#define BIT_SHIFT_TXDMA_ERR_FLAG_V1_8814B 15 -+#define BIT_MASK_TXDMA_ERR_FLAG_V1_8814B 0x1f -+#define BIT_TXDMA_ERR_FLAG_V1_8814B(x) \ -+ (((x) & BIT_MASK_TXDMA_ERR_FLAG_V1_8814B) \ -+ << BIT_SHIFT_TXDMA_ERR_FLAG_V1_8814B) -+#define BITS_TXDMA_ERR_FLAG_V1_8814B \ -+ (BIT_MASK_TXDMA_ERR_FLAG_V1_8814B << BIT_SHIFT_TXDMA_ERR_FLAG_V1_8814B) -+#define BIT_CLEAR_TXDMA_ERR_FLAG_V1_8814B(x) \ -+ ((x) & (~BITS_TXDMA_ERR_FLAG_V1_8814B)) -+#define BIT_GET_TXDMA_ERR_FLAG_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_ERR_FLAG_V1_8814B) & \ -+ BIT_MASK_TXDMA_ERR_FLAG_V1_8814B) -+#define BIT_SET_TXDMA_ERR_FLAG_V1_8814B(x, v) \ -+ (BIT_CLEAR_TXDMA_ERR_FLAG_V1_8814B(x) | BIT_TXDMA_ERR_FLAG_V1_8814B(v)) -+ -+#define BIT_EPHY_RX50_EN_8814B BIT(11) -+ -+#define BIT_SHIFT_MSI_TIMEOUT_ID_V1_8814B 8 -+#define BIT_MASK_MSI_TIMEOUT_ID_V1_8814B 0x7 -+#define BIT_MSI_TIMEOUT_ID_V1_8814B(x) \ -+ (((x) & BIT_MASK_MSI_TIMEOUT_ID_V1_8814B) \ -+ << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8814B) -+#define BITS_MSI_TIMEOUT_ID_V1_8814B \ -+ (BIT_MASK_MSI_TIMEOUT_ID_V1_8814B << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8814B) -+#define BIT_CLEAR_MSI_TIMEOUT_ID_V1_8814B(x) \ -+ ((x) & (~BITS_MSI_TIMEOUT_ID_V1_8814B)) -+#define BIT_GET_MSI_TIMEOUT_ID_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MSI_TIMEOUT_ID_V1_8814B) & \ -+ BIT_MASK_MSI_TIMEOUT_ID_V1_8814B) -+#define BIT_SET_MSI_TIMEOUT_ID_V1_8814B(x, v) \ -+ (BIT_CLEAR_MSI_TIMEOUT_ID_V1_8814B(x) | BIT_MSI_TIMEOUT_ID_V1_8814B(v)) -+ -+#define BIT_RADDR_RD_8814B BIT(7) -+#define BIT_L0S_LINK_OFF_8814B BIT(4) -+#define BIT_ACT_LINK_OFF_8814B BIT(3) -+#define BIT_EN_SLOW_MAC_TX_8814B BIT(2) -+#define BIT_EN_SLOW_MAC_RX_8814B BIT(1) -+#define BIT_EN_SLOW_MAC_HW_8814B BIT(0) -+ -+/* 2 REG_STC_INT_CS_8814B(PCIE STATE CHANGE INTERRUPT CONTROL AND STATUS) */ -+#define BIT_STC_INT_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_STC_INT_FLAG_8814B 16 -+#define BIT_MASK_STC_INT_FLAG_8814B 0xff -+#define BIT_STC_INT_FLAG_8814B(x) \ -+ (((x) & BIT_MASK_STC_INT_FLAG_8814B) << BIT_SHIFT_STC_INT_FLAG_8814B) -+#define BITS_STC_INT_FLAG_8814B \ -+ (BIT_MASK_STC_INT_FLAG_8814B << BIT_SHIFT_STC_INT_FLAG_8814B) -+#define BIT_CLEAR_STC_INT_FLAG_8814B(x) ((x) & (~BITS_STC_INT_FLAG_8814B)) -+#define BIT_GET_STC_INT_FLAG_8814B(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_FLAG_8814B) & BIT_MASK_STC_INT_FLAG_8814B) -+#define BIT_SET_STC_INT_FLAG_8814B(x, v) \ -+ (BIT_CLEAR_STC_INT_FLAG_8814B(x) | BIT_STC_INT_FLAG_8814B(v)) -+ -+#define BIT_SHIFT_STC_INT_IDX_8814B 8 -+#define BIT_MASK_STC_INT_IDX_8814B 0x7 -+#define BIT_STC_INT_IDX_8814B(x) \ -+ (((x) & BIT_MASK_STC_INT_IDX_8814B) << BIT_SHIFT_STC_INT_IDX_8814B) -+#define BITS_STC_INT_IDX_8814B \ -+ (BIT_MASK_STC_INT_IDX_8814B << BIT_SHIFT_STC_INT_IDX_8814B) -+#define BIT_CLEAR_STC_INT_IDX_8814B(x) ((x) & (~BITS_STC_INT_IDX_8814B)) -+#define BIT_GET_STC_INT_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_IDX_8814B) & BIT_MASK_STC_INT_IDX_8814B) -+#define BIT_SET_STC_INT_IDX_8814B(x, v) \ -+ (BIT_CLEAR_STC_INT_IDX_8814B(x) | BIT_STC_INT_IDX_8814B(v)) -+ -+#define BIT_SHIFT_STC_INT_REALTIME_CS_8814B 0 -+#define BIT_MASK_STC_INT_REALTIME_CS_8814B 0x3f -+#define BIT_STC_INT_REALTIME_CS_8814B(x) \ -+ (((x) & BIT_MASK_STC_INT_REALTIME_CS_8814B) \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8814B) -+#define BITS_STC_INT_REALTIME_CS_8814B \ -+ (BIT_MASK_STC_INT_REALTIME_CS_8814B \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8814B) -+#define BIT_CLEAR_STC_INT_REALTIME_CS_8814B(x) \ -+ ((x) & (~BITS_STC_INT_REALTIME_CS_8814B)) -+#define BIT_GET_STC_INT_REALTIME_CS_8814B(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_REALTIME_CS_8814B) & \ -+ BIT_MASK_STC_INT_REALTIME_CS_8814B) -+#define BIT_SET_STC_INT_REALTIME_CS_8814B(x, v) \ -+ (BIT_CLEAR_STC_INT_REALTIME_CS_8814B(x) | \ -+ BIT_STC_INT_REALTIME_CS_8814B(v)) -+ -+/* 2 REG_ST_INT_CFG_8814B(PCIE STATE CHANGE INTERRUPT CONFIGURATION) */ -+#define BIT_STC_INT_GRP_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_LS_8814B 8 -+#define BIT_MASK_STC_INT_EXPECT_LS_8814B 0x3f -+#define BIT_STC_INT_EXPECT_LS_8814B(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_LS_8814B) \ -+ << BIT_SHIFT_STC_INT_EXPECT_LS_8814B) -+#define BITS_STC_INT_EXPECT_LS_8814B \ -+ (BIT_MASK_STC_INT_EXPECT_LS_8814B << BIT_SHIFT_STC_INT_EXPECT_LS_8814B) -+#define BIT_CLEAR_STC_INT_EXPECT_LS_8814B(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_LS_8814B)) -+#define BIT_GET_STC_INT_EXPECT_LS_8814B(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_LS_8814B) & \ -+ BIT_MASK_STC_INT_EXPECT_LS_8814B) -+#define BIT_SET_STC_INT_EXPECT_LS_8814B(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_LS_8814B(x) | BIT_STC_INT_EXPECT_LS_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_STC_INT_EXPECT_CS_8814B 0 -+#define BIT_MASK_STC_INT_EXPECT_CS_8814B 0x3f -+#define BIT_STC_INT_EXPECT_CS_8814B(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_CS_8814B) \ -+ << BIT_SHIFT_STC_INT_EXPECT_CS_8814B) -+#define BITS_STC_INT_EXPECT_CS_8814B \ -+ (BIT_MASK_STC_INT_EXPECT_CS_8814B << BIT_SHIFT_STC_INT_EXPECT_CS_8814B) -+#define BIT_CLEAR_STC_INT_EXPECT_CS_8814B(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_CS_8814B)) -+#define BIT_GET_STC_INT_EXPECT_CS_8814B(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_CS_8814B) & \ -+ BIT_MASK_STC_INT_EXPECT_CS_8814B) -+#define BIT_SET_STC_INT_EXPECT_CS_8814B(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_CS_8814B(x) | BIT_STC_INT_EXPECT_CS_8814B(v)) -+ -+/* 2 REG_ACH4_ACH5_TXBD_NUM_8814B */ -+#define BIT_PCIE_ACH5_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_ACH5_DESC_MODE_8814B 28 -+#define BIT_MASK_ACH5_DESC_MODE_8814B 0x3 -+#define BIT_ACH5_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH5_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH5_DESC_MODE_8814B) -+#define BITS_ACH5_DESC_MODE_8814B \ -+ (BIT_MASK_ACH5_DESC_MODE_8814B << BIT_SHIFT_ACH5_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH5_DESC_MODE_8814B(x) ((x) & (~BITS_ACH5_DESC_MODE_8814B)) -+#define BIT_GET_ACH5_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH5_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH5_DESC_MODE_8814B) -+#define BIT_SET_ACH5_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH5_DESC_MODE_8814B(x) | BIT_ACH5_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH5_DESC_NUM_8814B 16 -+#define BIT_MASK_ACH5_DESC_NUM_8814B 0xfff -+#define BIT_ACH5_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH5_DESC_NUM_8814B) << BIT_SHIFT_ACH5_DESC_NUM_8814B) -+#define BITS_ACH5_DESC_NUM_8814B \ -+ (BIT_MASK_ACH5_DESC_NUM_8814B << BIT_SHIFT_ACH5_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH5_DESC_NUM_8814B(x) ((x) & (~BITS_ACH5_DESC_NUM_8814B)) -+#define BIT_GET_ACH5_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH5_DESC_NUM_8814B) & BIT_MASK_ACH5_DESC_NUM_8814B) -+#define BIT_SET_ACH5_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH5_DESC_NUM_8814B(x) | BIT_ACH5_DESC_NUM_8814B(v)) -+ -+#define BIT_PCIE_ACH4_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_ACH4_DESC_MODE_8814B 12 -+#define BIT_MASK_ACH4_DESC_MODE_8814B 0x3 -+#define BIT_ACH4_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH4_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH4_DESC_MODE_8814B) -+#define BITS_ACH4_DESC_MODE_8814B \ -+ (BIT_MASK_ACH4_DESC_MODE_8814B << BIT_SHIFT_ACH4_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH4_DESC_MODE_8814B(x) ((x) & (~BITS_ACH4_DESC_MODE_8814B)) -+#define BIT_GET_ACH4_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH4_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH4_DESC_MODE_8814B) -+#define BIT_SET_ACH4_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH4_DESC_MODE_8814B(x) | BIT_ACH4_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH4_DESC_NUM_8814B 0 -+#define BIT_MASK_ACH4_DESC_NUM_8814B 0xfff -+#define BIT_ACH4_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH4_DESC_NUM_8814B) << BIT_SHIFT_ACH4_DESC_NUM_8814B) -+#define BITS_ACH4_DESC_NUM_8814B \ -+ (BIT_MASK_ACH4_DESC_NUM_8814B << BIT_SHIFT_ACH4_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH4_DESC_NUM_8814B(x) ((x) & (~BITS_ACH4_DESC_NUM_8814B)) -+#define BIT_GET_ACH4_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH4_DESC_NUM_8814B) & BIT_MASK_ACH4_DESC_NUM_8814B) -+#define BIT_SET_ACH4_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH4_DESC_NUM_8814B(x) | BIT_ACH4_DESC_NUM_8814B(v)) -+ -+/* 2 REG_FWCMDQ_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_FWCMDQ_HW_IDX_8814B 16 -+#define BIT_MASK_FWCMDQ_HW_IDX_8814B 0xfff -+#define BIT_FWCMDQ_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_HW_IDX_8814B) << BIT_SHIFT_FWCMDQ_HW_IDX_8814B) -+#define BITS_FWCMDQ_HW_IDX_8814B \ -+ (BIT_MASK_FWCMDQ_HW_IDX_8814B << BIT_SHIFT_FWCMDQ_HW_IDX_8814B) -+#define BIT_CLEAR_FWCMDQ_HW_IDX_8814B(x) ((x) & (~BITS_FWCMDQ_HW_IDX_8814B)) -+#define BIT_GET_FWCMDQ_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_HW_IDX_8814B) & BIT_MASK_FWCMDQ_HW_IDX_8814B) -+#define BIT_SET_FWCMDQ_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_HW_IDX_8814B(x) | BIT_FWCMDQ_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_FWCMDQ_HOST_IDX_8814B 0 -+#define BIT_MASK_FWCMDQ_HOST_IDX_8814B 0xfff -+#define BIT_FWCMDQ_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_HOST_IDX_8814B) \ -+ << BIT_SHIFT_FWCMDQ_HOST_IDX_8814B) -+#define BITS_FWCMDQ_HOST_IDX_8814B \ -+ (BIT_MASK_FWCMDQ_HOST_IDX_8814B << BIT_SHIFT_FWCMDQ_HOST_IDX_8814B) -+#define BIT_CLEAR_FWCMDQ_HOST_IDX_8814B(x) ((x) & (~BITS_FWCMDQ_HOST_IDX_8814B)) -+#define BIT_GET_FWCMDQ_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_HOST_IDX_8814B) & \ -+ BIT_MASK_FWCMDQ_HOST_IDX_8814B) -+#define BIT_SET_FWCMDQ_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_HOST_IDX_8814B(x) | BIT_FWCMDQ_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI8Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI8Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI8Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI8Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI8Q_HW_IDX_8814B) << BIT_SHIFT_P0HI8Q_HW_IDX_8814B) -+#define BITS_P0HI8Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI8Q_HW_IDX_8814B << BIT_SHIFT_P0HI8Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI8Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI8Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI8Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI8Q_HW_IDX_8814B) & BIT_MASK_P0HI8Q_HW_IDX_8814B) -+#define BIT_SET_P0HI8Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI8Q_HW_IDX_8814B(x) | BIT_P0HI8Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI8Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI8Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI8Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI8Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI8Q_HOST_IDX_8814B) -+#define BITS_P0HI8Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI8Q_HOST_IDX_8814B << BIT_SHIFT_P0HI8Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI8Q_HOST_IDX_8814B(x) ((x) & (~BITS_P0HI8Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI8Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI8Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI8Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI8Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI8Q_HOST_IDX_8814B(x) | BIT_P0HI8Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_H2CQ_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_H2CQ_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_H2CQ_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_H2CQ_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_H2CQ_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_H2CQ_TXBD_DESA_L_8814B) -+#define BITS_H2CQ_TXBD_DESA_L_8814B \ -+ (BIT_MASK_H2CQ_TXBD_DESA_L_8814B << BIT_SHIFT_H2CQ_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_H2CQ_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_H2CQ_TXBD_DESA_L_8814B)) -+#define BIT_GET_H2CQ_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_H2CQ_TXBD_DESA_L_8814B) -+#define BIT_SET_H2CQ_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_H2CQ_TXBD_DESA_L_8814B(x) | BIT_H2CQ_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_H2CQ_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_H2CQ_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_H2CQ_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_H2CQ_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_H2CQ_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_H2CQ_TXBD_DESA_H_8814B) -+#define BITS_H2CQ_TXBD_DESA_H_8814B \ -+ (BIT_MASK_H2CQ_TXBD_DESA_H_8814B << BIT_SHIFT_H2CQ_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_H2CQ_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_H2CQ_TXBD_DESA_H_8814B)) -+#define BIT_GET_H2CQ_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_H2CQ_TXBD_DESA_H_8814B) -+#define BIT_SET_H2CQ_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_H2CQ_TXBD_DESA_H_8814B(x) | BIT_H2CQ_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_H2CQ_TXBD_NUM_8814B */ -+#define BIT_PCIE_H2CQ_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_H2CQ_DESC_MODE_8814B 12 -+#define BIT_MASK_H2CQ_DESC_MODE_8814B 0x3 -+#define BIT_H2CQ_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_MODE_8814B) \ -+ << BIT_SHIFT_H2CQ_DESC_MODE_8814B) -+#define BITS_H2CQ_DESC_MODE_8814B \ -+ (BIT_MASK_H2CQ_DESC_MODE_8814B << BIT_SHIFT_H2CQ_DESC_MODE_8814B) -+#define BIT_CLEAR_H2CQ_DESC_MODE_8814B(x) ((x) & (~BITS_H2CQ_DESC_MODE_8814B)) -+#define BIT_GET_H2CQ_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_MODE_8814B) & \ -+ BIT_MASK_H2CQ_DESC_MODE_8814B) -+#define BIT_SET_H2CQ_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_MODE_8814B(x) | BIT_H2CQ_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_H2CQ_DESC_NUM_8814B 0 -+#define BIT_MASK_H2CQ_DESC_NUM_8814B 0xfff -+#define BIT_H2CQ_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_NUM_8814B) << BIT_SHIFT_H2CQ_DESC_NUM_8814B) -+#define BITS_H2CQ_DESC_NUM_8814B \ -+ (BIT_MASK_H2CQ_DESC_NUM_8814B << BIT_SHIFT_H2CQ_DESC_NUM_8814B) -+#define BIT_CLEAR_H2CQ_DESC_NUM_8814B(x) ((x) & (~BITS_H2CQ_DESC_NUM_8814B)) -+#define BIT_GET_H2CQ_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_NUM_8814B) & BIT_MASK_H2CQ_DESC_NUM_8814B) -+#define BIT_SET_H2CQ_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_NUM_8814B(x) | BIT_H2CQ_DESC_NUM_8814B(v)) -+ -+/* 2 REG_H2CQ_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_H2CQ_HW_IDX_8814B 16 -+#define BIT_MASK_H2CQ_HW_IDX_8814B 0xfff -+#define BIT_H2CQ_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_H2CQ_HW_IDX_8814B) << BIT_SHIFT_H2CQ_HW_IDX_8814B) -+#define BITS_H2CQ_HW_IDX_8814B \ -+ (BIT_MASK_H2CQ_HW_IDX_8814B << BIT_SHIFT_H2CQ_HW_IDX_8814B) -+#define BIT_CLEAR_H2CQ_HW_IDX_8814B(x) ((x) & (~BITS_H2CQ_HW_IDX_8814B)) -+#define BIT_GET_H2CQ_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HW_IDX_8814B) & BIT_MASK_H2CQ_HW_IDX_8814B) -+#define BIT_SET_H2CQ_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_H2CQ_HW_IDX_8814B(x) | BIT_H2CQ_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_H2CQ_HOST_IDX_8814B 0 -+#define BIT_MASK_H2CQ_HOST_IDX_8814B 0xfff -+#define BIT_H2CQ_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_H2CQ_HOST_IDX_8814B) << BIT_SHIFT_H2CQ_HOST_IDX_8814B) -+#define BITS_H2CQ_HOST_IDX_8814B \ -+ (BIT_MASK_H2CQ_HOST_IDX_8814B << BIT_SHIFT_H2CQ_HOST_IDX_8814B) -+#define BIT_CLEAR_H2CQ_HOST_IDX_8814B(x) ((x) & (~BITS_H2CQ_HOST_IDX_8814B)) -+#define BIT_GET_H2CQ_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HOST_IDX_8814B) & BIT_MASK_H2CQ_HOST_IDX_8814B) -+#define BIT_SET_H2CQ_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_H2CQ_HOST_IDX_8814B(x) | BIT_H2CQ_HOST_IDX_8814B(v)) -+ -+/* 2 REG_H2CQ_CSR_8814B[31:0] (H2CQ CONTROL AND STATUS) */ -+#define BIT_H2CQ_FULL_8814B BIT(31) -+#define BIT_CLR_H2CQ_HOST_IDX_8814B BIT(16) -+#define BIT_CLR_H2CQ_HW_IDX_8814B BIT(8) -+#define BIT_STOP_H2CQ_8814B BIT(0) -+ -+/* 2 REG_P0HI9Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI9Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI9Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI9Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI9Q_HW_IDX_8814B) << BIT_SHIFT_P0HI9Q_HW_IDX_8814B) -+#define BITS_P0HI9Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI9Q_HW_IDX_8814B << BIT_SHIFT_P0HI9Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI9Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI9Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI9Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI9Q_HW_IDX_8814B) & BIT_MASK_P0HI9Q_HW_IDX_8814B) -+#define BIT_SET_P0HI9Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI9Q_HW_IDX_8814B(x) | BIT_P0HI9Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI9Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI9Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI9Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI9Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI9Q_HOST_IDX_8814B) -+#define BITS_P0HI9Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI9Q_HOST_IDX_8814B << BIT_SHIFT_P0HI9Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI9Q_HOST_IDX_8814B(x) ((x) & (~BITS_P0HI9Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI9Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI9Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI9Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI9Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI9Q_HOST_IDX_8814B(x) | BIT_P0HI9Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI10Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI10Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI10Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI10Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI10Q_HW_IDX_8814B) \ -+ << BIT_SHIFT_P0HI10Q_HW_IDX_8814B) -+#define BITS_P0HI10Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI10Q_HW_IDX_8814B << BIT_SHIFT_P0HI10Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI10Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI10Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI10Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI10Q_HW_IDX_8814B) & \ -+ BIT_MASK_P0HI10Q_HW_IDX_8814B) -+#define BIT_SET_P0HI10Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI10Q_HW_IDX_8814B(x) | BIT_P0HI10Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI10Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI10Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI10Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI10Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI10Q_HOST_IDX_8814B) -+#define BITS_P0HI10Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI10Q_HOST_IDX_8814B << BIT_SHIFT_P0HI10Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI10Q_HOST_IDX_8814B(x) \ -+ ((x) & (~BITS_P0HI10Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI10Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI10Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI10Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI10Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI10Q_HOST_IDX_8814B(x) | BIT_P0HI10Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI11Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI11Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI11Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI11Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI11Q_HW_IDX_8814B) \ -+ << BIT_SHIFT_P0HI11Q_HW_IDX_8814B) -+#define BITS_P0HI11Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI11Q_HW_IDX_8814B << BIT_SHIFT_P0HI11Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI11Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI11Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI11Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI11Q_HW_IDX_8814B) & \ -+ BIT_MASK_P0HI11Q_HW_IDX_8814B) -+#define BIT_SET_P0HI11Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI11Q_HW_IDX_8814B(x) | BIT_P0HI11Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI11Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI11Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI11Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI11Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI11Q_HOST_IDX_8814B) -+#define BITS_P0HI11Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI11Q_HOST_IDX_8814B << BIT_SHIFT_P0HI11Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI11Q_HOST_IDX_8814B(x) \ -+ ((x) & (~BITS_P0HI11Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI11Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI11Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI11Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI11Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI11Q_HOST_IDX_8814B(x) | BIT_P0HI11Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI12Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI12Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI12Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI12Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI12Q_HW_IDX_8814B) \ -+ << BIT_SHIFT_P0HI12Q_HW_IDX_8814B) -+#define BITS_P0HI12Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI12Q_HW_IDX_8814B << BIT_SHIFT_P0HI12Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI12Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI12Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI12Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI12Q_HW_IDX_8814B) & \ -+ BIT_MASK_P0HI12Q_HW_IDX_8814B) -+#define BIT_SET_P0HI12Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI12Q_HW_IDX_8814B(x) | BIT_P0HI12Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI12Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI12Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI12Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI12Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI12Q_HOST_IDX_8814B) -+#define BITS_P0HI12Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI12Q_HOST_IDX_8814B << BIT_SHIFT_P0HI12Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI12Q_HOST_IDX_8814B(x) \ -+ ((x) & (~BITS_P0HI12Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI12Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI12Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI12Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI12Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI12Q_HOST_IDX_8814B(x) | BIT_P0HI12Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI13Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI13Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI13Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI13Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI13Q_HW_IDX_8814B) \ -+ << BIT_SHIFT_P0HI13Q_HW_IDX_8814B) -+#define BITS_P0HI13Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI13Q_HW_IDX_8814B << BIT_SHIFT_P0HI13Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI13Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI13Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI13Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI13Q_HW_IDX_8814B) & \ -+ BIT_MASK_P0HI13Q_HW_IDX_8814B) -+#define BIT_SET_P0HI13Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI13Q_HW_IDX_8814B(x) | BIT_P0HI13Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI13Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI13Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI13Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI13Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI13Q_HOST_IDX_8814B) -+#define BITS_P0HI13Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI13Q_HOST_IDX_8814B << BIT_SHIFT_P0HI13Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI13Q_HOST_IDX_8814B(x) \ -+ ((x) & (~BITS_P0HI13Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI13Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI13Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI13Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI13Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI13Q_HOST_IDX_8814B(x) | BIT_P0HI13Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI14Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI14Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI14Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI14Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI14Q_HW_IDX_8814B) \ -+ << BIT_SHIFT_P0HI14Q_HW_IDX_8814B) -+#define BITS_P0HI14Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI14Q_HW_IDX_8814B << BIT_SHIFT_P0HI14Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI14Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI14Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI14Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI14Q_HW_IDX_8814B) & \ -+ BIT_MASK_P0HI14Q_HW_IDX_8814B) -+#define BIT_SET_P0HI14Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI14Q_HW_IDX_8814B(x) | BIT_P0HI14Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI14Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI14Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI14Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI14Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI14Q_HOST_IDX_8814B) -+#define BITS_P0HI14Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI14Q_HOST_IDX_8814B << BIT_SHIFT_P0HI14Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI14Q_HOST_IDX_8814B(x) \ -+ ((x) & (~BITS_P0HI14Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI14Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI14Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI14Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI14Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI14Q_HOST_IDX_8814B(x) | BIT_P0HI14Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI15Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI15Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI15Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI15Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI15Q_HW_IDX_8814B) \ -+ << BIT_SHIFT_P0HI15Q_HW_IDX_8814B) -+#define BITS_P0HI15Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI15Q_HW_IDX_8814B << BIT_SHIFT_P0HI15Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI15Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI15Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI15Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI15Q_HW_IDX_8814B) & \ -+ BIT_MASK_P0HI15Q_HW_IDX_8814B) -+#define BIT_SET_P0HI15Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI15Q_HW_IDX_8814B(x) | BIT_P0HI15Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI15Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI15Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI15Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI15Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI15Q_HOST_IDX_8814B) -+#define BITS_P0HI15Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI15Q_HOST_IDX_8814B << BIT_SHIFT_P0HI15Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI15Q_HOST_IDX_8814B(x) \ -+ ((x) & (~BITS_P0HI15Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI15Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI15Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI15Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI15Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI15Q_HOST_IDX_8814B(x) | BIT_P0HI15Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_CHANGE_PCIE_SPEED_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_RXDMA_ERR_CNT_8814B 8 -+#define BIT_MASK_RXDMA_ERR_CNT_8814B 0xff -+#define BIT_RXDMA_ERR_CNT_8814B(x) \ -+ (((x) & BIT_MASK_RXDMA_ERR_CNT_8814B) << BIT_SHIFT_RXDMA_ERR_CNT_8814B) -+#define BITS_RXDMA_ERR_CNT_8814B \ -+ (BIT_MASK_RXDMA_ERR_CNT_8814B << BIT_SHIFT_RXDMA_ERR_CNT_8814B) -+#define BIT_CLEAR_RXDMA_ERR_CNT_8814B(x) ((x) & (~BITS_RXDMA_ERR_CNT_8814B)) -+#define BIT_GET_RXDMA_ERR_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_ERR_CNT_8814B) & BIT_MASK_RXDMA_ERR_CNT_8814B) -+#define BIT_SET_RXDMA_ERR_CNT_8814B(x, v) \ -+ (BIT_CLEAR_RXDMA_ERR_CNT_8814B(x) | BIT_RXDMA_ERR_CNT_8814B(v)) -+ -+#define BIT_TXDMA_ERR_HANDLE_REQ_8814B BIT(7) -+#define BIT_TXDMA_ERROR_PS_8814B BIT(6) -+#define BIT_EN_TXDMA_STUCK_ERR_HANDLE_8814B BIT(5) -+#define BIT_EN_TXDMA_RTN_ERR_HANDLE_8814B BIT(4) -+#define BIT_RXDMA_ERR_HANDLE_REQ_8814B BIT(3) -+#define BIT_RXDMA_ERROR_PS_8814B BIT(2) -+#define BIT_EN_RXDMA_STUCK_ERR_HANDLE_8814B BIT(1) -+#define BIT_EN_RXDMA_RTN_ERR_HANDLE_8814B BIT(0) -+ -+/* 2 REG_DEBUG_STATE1_8814B */ -+ -+#define BIT_SHIFT_DEBUG_STATE1_8814B 0 -+#define BIT_MASK_DEBUG_STATE1_8814B 0xffffffffL -+#define BIT_DEBUG_STATE1_8814B(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE1_8814B) << BIT_SHIFT_DEBUG_STATE1_8814B) -+#define BITS_DEBUG_STATE1_8814B \ -+ (BIT_MASK_DEBUG_STATE1_8814B << BIT_SHIFT_DEBUG_STATE1_8814B) -+#define BIT_CLEAR_DEBUG_STATE1_8814B(x) ((x) & (~BITS_DEBUG_STATE1_8814B)) -+#define BIT_GET_DEBUG_STATE1_8814B(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE1_8814B) & BIT_MASK_DEBUG_STATE1_8814B) -+#define BIT_SET_DEBUG_STATE1_8814B(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE1_8814B(x) | BIT_DEBUG_STATE1_8814B(v)) -+ -+/* 2 REG_DEBUG_STATE2_8814B */ -+ -+#define BIT_SHIFT_DEBUG_STATE2_8814B 0 -+#define BIT_MASK_DEBUG_STATE2_8814B 0xffffffffL -+#define BIT_DEBUG_STATE2_8814B(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE2_8814B) << BIT_SHIFT_DEBUG_STATE2_8814B) -+#define BITS_DEBUG_STATE2_8814B \ -+ (BIT_MASK_DEBUG_STATE2_8814B << BIT_SHIFT_DEBUG_STATE2_8814B) -+#define BIT_CLEAR_DEBUG_STATE2_8814B(x) ((x) & (~BITS_DEBUG_STATE2_8814B)) -+#define BIT_GET_DEBUG_STATE2_8814B(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE2_8814B) & BIT_MASK_DEBUG_STATE2_8814B) -+#define BIT_SET_DEBUG_STATE2_8814B(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE2_8814B(x) | BIT_DEBUG_STATE2_8814B(v)) -+ -+/* 2 REG_DEBUG_STATE3_8814B */ -+ -+#define BIT_SHIFT_DEBUG_STATE3_8814B 0 -+#define BIT_MASK_DEBUG_STATE3_8814B 0xffffffffL -+#define BIT_DEBUG_STATE3_8814B(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE3_8814B) << BIT_SHIFT_DEBUG_STATE3_8814B) -+#define BITS_DEBUG_STATE3_8814B \ -+ (BIT_MASK_DEBUG_STATE3_8814B << BIT_SHIFT_DEBUG_STATE3_8814B) -+#define BIT_CLEAR_DEBUG_STATE3_8814B(x) ((x) & (~BITS_DEBUG_STATE3_8814B)) -+#define BIT_GET_DEBUG_STATE3_8814B(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE3_8814B) & BIT_MASK_DEBUG_STATE3_8814B) -+#define BIT_SET_DEBUG_STATE3_8814B(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE3_8814B(x) | BIT_DEBUG_STATE3_8814B(v)) -+ -+/* 2 REG_ACH5_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH5_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH5_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH5_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH5_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH5_TXBD_DESA_L_8814B) -+#define BITS_ACH5_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH5_TXBD_DESA_L_8814B << BIT_SHIFT_ACH5_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH5_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH5_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH5_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH5_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH5_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH5_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH5_TXBD_DESA_L_8814B(x) | BIT_ACH5_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH5_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH5_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH5_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH5_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH5_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH5_TXBD_DESA_H_8814B) -+#define BITS_ACH5_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH5_TXBD_DESA_H_8814B << BIT_SHIFT_ACH5_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH5_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH5_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH5_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH5_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH5_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH5_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH5_TXBD_DESA_H_8814B(x) | BIT_ACH5_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH6_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH6_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH6_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH6_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH6_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH6_TXBD_DESA_L_8814B) -+#define BITS_ACH6_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH6_TXBD_DESA_L_8814B << BIT_SHIFT_ACH6_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH6_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH6_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH6_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH6_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH6_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH6_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH6_TXBD_DESA_L_8814B(x) | BIT_ACH6_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH6_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH6_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH6_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH6_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH6_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH6_TXBD_DESA_H_8814B) -+#define BITS_ACH6_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH6_TXBD_DESA_H_8814B << BIT_SHIFT_ACH6_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH6_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH6_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH6_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH6_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH6_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH6_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH6_TXBD_DESA_H_8814B(x) | BIT_ACH6_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH7_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH7_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH7_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH7_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH7_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH7_TXBD_DESA_L_8814B) -+#define BITS_ACH7_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH7_TXBD_DESA_L_8814B << BIT_SHIFT_ACH7_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH7_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH7_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH7_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH7_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH7_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH7_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH7_TXBD_DESA_L_8814B(x) | BIT_ACH7_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH7_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH7_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH7_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH7_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH7_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH7_TXBD_DESA_H_8814B) -+#define BITS_ACH7_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH7_TXBD_DESA_H_8814B << BIT_SHIFT_ACH7_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH7_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH7_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH7_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH7_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH7_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH7_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH7_TXBD_DESA_H_8814B(x) | BIT_ACH7_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH8_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH8_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH8_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH8_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH8_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH8_TXBD_DESA_L_8814B) -+#define BITS_ACH8_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH8_TXBD_DESA_L_8814B << BIT_SHIFT_ACH8_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH8_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH8_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH8_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH8_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH8_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH8_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH8_TXBD_DESA_L_8814B(x) | BIT_ACH8_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH8_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH8_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH8_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH8_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH8_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH8_TXBD_DESA_H_8814B) -+#define BITS_ACH8_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH8_TXBD_DESA_H_8814B << BIT_SHIFT_ACH8_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH8_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH8_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH8_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH8_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH8_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH8_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH8_TXBD_DESA_H_8814B(x) | BIT_ACH8_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH9_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH9_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH9_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH9_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH9_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH9_TXBD_DESA_L_8814B) -+#define BITS_ACH9_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH9_TXBD_DESA_L_8814B << BIT_SHIFT_ACH9_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH9_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH9_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH9_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH9_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH9_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH9_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH9_TXBD_DESA_L_8814B(x) | BIT_ACH9_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH9_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH9_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH9_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH9_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH9_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH9_TXBD_DESA_H_8814B) -+#define BITS_ACH9_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH9_TXBD_DESA_H_8814B << BIT_SHIFT_ACH9_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH9_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH9_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH9_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH9_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH9_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH9_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH9_TXBD_DESA_H_8814B(x) | BIT_ACH9_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH10_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH10_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH10_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH10_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH10_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH10_TXBD_DESA_L_8814B) -+#define BITS_ACH10_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH10_TXBD_DESA_L_8814B << BIT_SHIFT_ACH10_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH10_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH10_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH10_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH10_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH10_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH10_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH10_TXBD_DESA_L_8814B(x) | BIT_ACH10_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH10_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH10_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH10_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH10_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH10_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH10_TXBD_DESA_H_8814B) -+#define BITS_ACH10_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH10_TXBD_DESA_H_8814B << BIT_SHIFT_ACH10_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH10_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH10_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH10_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH10_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH10_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH10_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH10_TXBD_DESA_H_8814B(x) | BIT_ACH10_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH11_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH11_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH11_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH11_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH11_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH11_TXBD_DESA_L_8814B) -+#define BITS_ACH11_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH11_TXBD_DESA_L_8814B << BIT_SHIFT_ACH11_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH11_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH11_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH11_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH11_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH11_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH11_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH11_TXBD_DESA_L_8814B(x) | BIT_ACH11_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH11_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH11_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH11_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH11_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH11_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH11_TXBD_DESA_H_8814B) -+#define BITS_ACH11_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH11_TXBD_DESA_H_8814B << BIT_SHIFT_ACH11_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH11_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH11_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH11_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH11_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH11_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH11_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH11_TXBD_DESA_H_8814B(x) | BIT_ACH11_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH12_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH12_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH12_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH12_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH12_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH12_TXBD_DESA_L_8814B) -+#define BITS_ACH12_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH12_TXBD_DESA_L_8814B << BIT_SHIFT_ACH12_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH12_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH12_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH12_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH12_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH12_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH12_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH12_TXBD_DESA_L_8814B(x) | BIT_ACH12_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH12_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH12_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH12_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH12_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH12_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH12_TXBD_DESA_H_8814B) -+#define BITS_ACH12_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH12_TXBD_DESA_H_8814B << BIT_SHIFT_ACH12_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH12_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH12_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH12_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH12_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH12_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH12_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH12_TXBD_DESA_H_8814B(x) | BIT_ACH12_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH13_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH13_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH13_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH13_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH13_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH13_TXBD_DESA_L_8814B) -+#define BITS_ACH13_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH13_TXBD_DESA_L_8814B << BIT_SHIFT_ACH13_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH13_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH13_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH13_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH13_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH13_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH13_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH13_TXBD_DESA_L_8814B(x) | BIT_ACH13_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH13_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH13_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH13_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH13_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH13_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH13_TXBD_DESA_H_8814B) -+#define BITS_ACH13_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH13_TXBD_DESA_H_8814B << BIT_SHIFT_ACH13_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH13_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH13_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH13_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH13_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH13_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH13_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH13_TXBD_DESA_H_8814B(x) | BIT_ACH13_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI0Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI0Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI0Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI0Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI0Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI0Q_TXBD_DESA_L_8814B) -+#define BITS_HI0Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI0Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI0Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI0Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI0Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI0Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI0Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI0Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI0Q_TXBD_DESA_L_8814B(x) | BIT_HI0Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI0Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI0Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI0Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI0Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI0Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI0Q_TXBD_DESA_H_8814B) -+#define BITS_HI0Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI0Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI0Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI0Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI0Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI0Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI0Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI0Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI0Q_TXBD_DESA_H_8814B(x) | BIT_HI0Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI1Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI1Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI1Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI1Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI1Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI1Q_TXBD_DESA_L_8814B) -+#define BITS_HI1Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI1Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI1Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI1Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI1Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI1Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI1Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI1Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI1Q_TXBD_DESA_L_8814B(x) | BIT_HI1Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI1Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI1Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI1Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI1Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI1Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI1Q_TXBD_DESA_H_8814B) -+#define BITS_HI1Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI1Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI1Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI1Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI1Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI1Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI1Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI1Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI1Q_TXBD_DESA_H_8814B(x) | BIT_HI1Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI2Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI2Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI2Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI2Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI2Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI2Q_TXBD_DESA_L_8814B) -+#define BITS_HI2Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI2Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI2Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI2Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI2Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI2Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI2Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI2Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI2Q_TXBD_DESA_L_8814B(x) | BIT_HI2Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI2Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI2Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI2Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI2Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI2Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI2Q_TXBD_DESA_H_8814B) -+#define BITS_HI2Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI2Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI2Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI2Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI2Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI2Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI2Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI2Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI2Q_TXBD_DESA_H_8814B(x) | BIT_HI2Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI3Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI3Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI3Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI3Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI3Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI3Q_TXBD_DESA_L_8814B) -+#define BITS_HI3Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI3Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI3Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI3Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI3Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI3Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI3Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI3Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI3Q_TXBD_DESA_L_8814B(x) | BIT_HI3Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI3Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI3Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI3Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI3Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI3Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI3Q_TXBD_DESA_H_8814B) -+#define BITS_HI3Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI3Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI3Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI3Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI3Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI3Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI3Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI3Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI3Q_TXBD_DESA_H_8814B(x) | BIT_HI3Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI4Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI4Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI4Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI4Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI4Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI4Q_TXBD_DESA_L_8814B) -+#define BITS_HI4Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI4Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI4Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI4Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI4Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI4Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI4Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI4Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI4Q_TXBD_DESA_L_8814B(x) | BIT_HI4Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI4Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI4Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI4Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI4Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI4Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI4Q_TXBD_DESA_H_8814B) -+#define BITS_HI4Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI4Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI4Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI4Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI4Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI4Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI4Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI4Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI4Q_TXBD_DESA_H_8814B(x) | BIT_HI4Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI5Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI5Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI5Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI5Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI5Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI5Q_TXBD_DESA_L_8814B) -+#define BITS_HI5Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI5Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI5Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI5Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI5Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI5Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI5Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI5Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI5Q_TXBD_DESA_L_8814B(x) | BIT_HI5Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI5Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI5Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI5Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI5Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI5Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI5Q_TXBD_DESA_H_8814B) -+#define BITS_HI5Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI5Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI5Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI5Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI5Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI5Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI5Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI5Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI5Q_TXBD_DESA_H_8814B(x) | BIT_HI5Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI6Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI6Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI6Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI6Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI6Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI6Q_TXBD_DESA_L_8814B) -+#define BITS_HI6Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI6Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI6Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI6Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI6Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI6Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI6Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI6Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI6Q_TXBD_DESA_L_8814B(x) | BIT_HI6Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI6Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI6Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI6Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI6Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI6Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI6Q_TXBD_DESA_H_8814B) -+#define BITS_HI6Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI6Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI6Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI6Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI6Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI6Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI6Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI6Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI6Q_TXBD_DESA_H_8814B(x) | BIT_HI6Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI7Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI7Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI7Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI7Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI7Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI7Q_TXBD_DESA_L_8814B) -+#define BITS_HI7Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI7Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI7Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI7Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI7Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI7Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI7Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI7Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI7Q_TXBD_DESA_L_8814B(x) | BIT_HI7Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI7Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI7Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI7Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI7Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI7Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI7Q_TXBD_DESA_H_8814B) -+#define BITS_HI7Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI7Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI7Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI7Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI7Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI7Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI7Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI7Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI7Q_TXBD_DESA_H_8814B(x) | BIT_HI7Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_ACH8_ACH9_TXBD_NUM_8814B */ -+#define BIT_PCIE_ACH9_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_ACH9_DESC_MODE_8814B 28 -+#define BIT_MASK_ACH9_DESC_MODE_8814B 0x3 -+#define BIT_ACH9_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH9_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH9_DESC_MODE_8814B) -+#define BITS_ACH9_DESC_MODE_8814B \ -+ (BIT_MASK_ACH9_DESC_MODE_8814B << BIT_SHIFT_ACH9_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH9_DESC_MODE_8814B(x) ((x) & (~BITS_ACH9_DESC_MODE_8814B)) -+#define BIT_GET_ACH9_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH9_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH9_DESC_MODE_8814B) -+#define BIT_SET_ACH9_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH9_DESC_MODE_8814B(x) | BIT_ACH9_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH9_DESC_NUM_8814B 16 -+#define BIT_MASK_ACH9_DESC_NUM_8814B 0xfff -+#define BIT_ACH9_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH9_DESC_NUM_8814B) << BIT_SHIFT_ACH9_DESC_NUM_8814B) -+#define BITS_ACH9_DESC_NUM_8814B \ -+ (BIT_MASK_ACH9_DESC_NUM_8814B << BIT_SHIFT_ACH9_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH9_DESC_NUM_8814B(x) ((x) & (~BITS_ACH9_DESC_NUM_8814B)) -+#define BIT_GET_ACH9_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH9_DESC_NUM_8814B) & BIT_MASK_ACH9_DESC_NUM_8814B) -+#define BIT_SET_ACH9_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH9_DESC_NUM_8814B(x) | BIT_ACH9_DESC_NUM_8814B(v)) -+ -+#define BIT_PCIE_ACH8_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_ACH8_DESC_MODE_8814B 12 -+#define BIT_MASK_ACH8_DESC_MODE_8814B 0x3 -+#define BIT_ACH8_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH8_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH8_DESC_MODE_8814B) -+#define BITS_ACH8_DESC_MODE_8814B \ -+ (BIT_MASK_ACH8_DESC_MODE_8814B << BIT_SHIFT_ACH8_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH8_DESC_MODE_8814B(x) ((x) & (~BITS_ACH8_DESC_MODE_8814B)) -+#define BIT_GET_ACH8_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH8_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH8_DESC_MODE_8814B) -+#define BIT_SET_ACH8_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH8_DESC_MODE_8814B(x) | BIT_ACH8_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH8_DESC_NUM_8814B 0 -+#define BIT_MASK_ACH8_DESC_NUM_8814B 0xfff -+#define BIT_ACH8_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH8_DESC_NUM_8814B) << BIT_SHIFT_ACH8_DESC_NUM_8814B) -+#define BITS_ACH8_DESC_NUM_8814B \ -+ (BIT_MASK_ACH8_DESC_NUM_8814B << BIT_SHIFT_ACH8_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH8_DESC_NUM_8814B(x) ((x) & (~BITS_ACH8_DESC_NUM_8814B)) -+#define BIT_GET_ACH8_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH8_DESC_NUM_8814B) & BIT_MASK_ACH8_DESC_NUM_8814B) -+#define BIT_SET_ACH8_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH8_DESC_NUM_8814B(x) | BIT_ACH8_DESC_NUM_8814B(v)) -+ -+/* 2 REG_ACH10_ACH11_TXBD_NUM_8814B */ -+#define BIT_PCIE_ACH11_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_ACH11_DESC_MODE_8814B 28 -+#define BIT_MASK_ACH11_DESC_MODE_8814B 0x3 -+#define BIT_ACH11_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH11_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH11_DESC_MODE_8814B) -+#define BITS_ACH11_DESC_MODE_8814B \ -+ (BIT_MASK_ACH11_DESC_MODE_8814B << BIT_SHIFT_ACH11_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH11_DESC_MODE_8814B(x) ((x) & (~BITS_ACH11_DESC_MODE_8814B)) -+#define BIT_GET_ACH11_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH11_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH11_DESC_MODE_8814B) -+#define BIT_SET_ACH11_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH11_DESC_MODE_8814B(x) | BIT_ACH11_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH11_DESC_NUM_8814B 16 -+#define BIT_MASK_ACH11_DESC_NUM_8814B 0xfff -+#define BIT_ACH11_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH11_DESC_NUM_8814B) \ -+ << BIT_SHIFT_ACH11_DESC_NUM_8814B) -+#define BITS_ACH11_DESC_NUM_8814B \ -+ (BIT_MASK_ACH11_DESC_NUM_8814B << BIT_SHIFT_ACH11_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH11_DESC_NUM_8814B(x) ((x) & (~BITS_ACH11_DESC_NUM_8814B)) -+#define BIT_GET_ACH11_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH11_DESC_NUM_8814B) & \ -+ BIT_MASK_ACH11_DESC_NUM_8814B) -+#define BIT_SET_ACH11_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH11_DESC_NUM_8814B(x) | BIT_ACH11_DESC_NUM_8814B(v)) -+ -+#define BIT_PCIE_ACH10_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_ACH10_DESC_MODE_8814B 12 -+#define BIT_MASK_ACH10_DESC_MODE_8814B 0x3 -+#define BIT_ACH10_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH10_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH10_DESC_MODE_8814B) -+#define BITS_ACH10_DESC_MODE_8814B \ -+ (BIT_MASK_ACH10_DESC_MODE_8814B << BIT_SHIFT_ACH10_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH10_DESC_MODE_8814B(x) ((x) & (~BITS_ACH10_DESC_MODE_8814B)) -+#define BIT_GET_ACH10_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH10_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH10_DESC_MODE_8814B) -+#define BIT_SET_ACH10_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH10_DESC_MODE_8814B(x) | BIT_ACH10_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH10_DESC_NUM_8814B 0 -+#define BIT_MASK_ACH10_DESC_NUM_8814B 0xfff -+#define BIT_ACH10_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH10_DESC_NUM_8814B) \ -+ << BIT_SHIFT_ACH10_DESC_NUM_8814B) -+#define BITS_ACH10_DESC_NUM_8814B \ -+ (BIT_MASK_ACH10_DESC_NUM_8814B << BIT_SHIFT_ACH10_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH10_DESC_NUM_8814B(x) ((x) & (~BITS_ACH10_DESC_NUM_8814B)) -+#define BIT_GET_ACH10_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH10_DESC_NUM_8814B) & \ -+ BIT_MASK_ACH10_DESC_NUM_8814B) -+#define BIT_SET_ACH10_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH10_DESC_NUM_8814B(x) | BIT_ACH10_DESC_NUM_8814B(v)) -+ -+/* 2 REG_ACH12_ACH13_TXBD_NUM_8814B */ -+#define BIT_PCIE_ACH13_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_ACH13_DESC_MODE_8814B 28 -+#define BIT_MASK_ACH13_DESC_MODE_8814B 0x3 -+#define BIT_ACH13_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH13_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH13_DESC_MODE_8814B) -+#define BITS_ACH13_DESC_MODE_8814B \ -+ (BIT_MASK_ACH13_DESC_MODE_8814B << BIT_SHIFT_ACH13_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH13_DESC_MODE_8814B(x) ((x) & (~BITS_ACH13_DESC_MODE_8814B)) -+#define BIT_GET_ACH13_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH13_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH13_DESC_MODE_8814B) -+#define BIT_SET_ACH13_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH13_DESC_MODE_8814B(x) | BIT_ACH13_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH13_DESC_NUM_8814B 16 -+#define BIT_MASK_ACH13_DESC_NUM_8814B 0xfff -+#define BIT_ACH13_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH13_DESC_NUM_8814B) \ -+ << BIT_SHIFT_ACH13_DESC_NUM_8814B) -+#define BITS_ACH13_DESC_NUM_8814B \ -+ (BIT_MASK_ACH13_DESC_NUM_8814B << BIT_SHIFT_ACH13_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH13_DESC_NUM_8814B(x) ((x) & (~BITS_ACH13_DESC_NUM_8814B)) -+#define BIT_GET_ACH13_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH13_DESC_NUM_8814B) & \ -+ BIT_MASK_ACH13_DESC_NUM_8814B) -+#define BIT_SET_ACH13_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH13_DESC_NUM_8814B(x) | BIT_ACH13_DESC_NUM_8814B(v)) -+ -+#define BIT_PCIE_ACH12_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_ACH12_DESC_MODE_8814B 12 -+#define BIT_MASK_ACH12_DESC_MODE_8814B 0x3 -+#define BIT_ACH12_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH12_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH12_DESC_MODE_8814B) -+#define BITS_ACH12_DESC_MODE_8814B \ -+ (BIT_MASK_ACH12_DESC_MODE_8814B << BIT_SHIFT_ACH12_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH12_DESC_MODE_8814B(x) ((x) & (~BITS_ACH12_DESC_MODE_8814B)) -+#define BIT_GET_ACH12_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH12_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH12_DESC_MODE_8814B) -+#define BIT_SET_ACH12_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH12_DESC_MODE_8814B(x) | BIT_ACH12_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH12_DESC_NUM_8814B 0 -+#define BIT_MASK_ACH12_DESC_NUM_8814B 0xfff -+#define BIT_ACH12_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH12_DESC_NUM_8814B) \ -+ << BIT_SHIFT_ACH12_DESC_NUM_8814B) -+#define BITS_ACH12_DESC_NUM_8814B \ -+ (BIT_MASK_ACH12_DESC_NUM_8814B << BIT_SHIFT_ACH12_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH12_DESC_NUM_8814B(x) ((x) & (~BITS_ACH12_DESC_NUM_8814B)) -+#define BIT_GET_ACH12_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH12_DESC_NUM_8814B) & \ -+ BIT_MASK_ACH12_DESC_NUM_8814B) -+#define BIT_SET_ACH12_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH12_DESC_NUM_8814B(x) | BIT_ACH12_DESC_NUM_8814B(v)) -+ -+/* 2 REG_OLD_DEHANG_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_OLD_DEHANG_8814B BIT(1) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_ACH4_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_ACH4_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_ACH4_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_ACH4_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_ACH4_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_ACH4_TXBD_DESA_L_8814B) -+#define BITS_ACH4_TXBD_DESA_L_8814B \ -+ (BIT_MASK_ACH4_TXBD_DESA_L_8814B << BIT_SHIFT_ACH4_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_ACH4_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_ACH4_TXBD_DESA_L_8814B)) -+#define BIT_GET_ACH4_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH4_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_ACH4_TXBD_DESA_L_8814B) -+#define BIT_SET_ACH4_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_ACH4_TXBD_DESA_L_8814B(x) | BIT_ACH4_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_ACH4_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_ACH4_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_ACH4_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_ACH4_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_ACH4_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_ACH4_TXBD_DESA_H_8814B) -+#define BITS_ACH4_TXBD_DESA_H_8814B \ -+ (BIT_MASK_ACH4_TXBD_DESA_H_8814B << BIT_SHIFT_ACH4_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_ACH4_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_ACH4_TXBD_DESA_H_8814B)) -+#define BIT_GET_ACH4_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH4_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_ACH4_TXBD_DESA_H_8814B) -+#define BIT_SET_ACH4_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_ACH4_TXBD_DESA_H_8814B(x) | BIT_ACH4_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI8Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI8Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI8Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI8Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI8Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI8Q_TXBD_DESA_L_8814B) -+#define BITS_HI8Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI8Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI8Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI8Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI8Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI8Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI8Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI8Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI8Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI8Q_TXBD_DESA_L_8814B(x) | BIT_HI8Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI8Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI8Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI8Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI8Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI8Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI8Q_TXBD_DESA_H_8814B) -+#define BITS_HI8Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI8Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI8Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI8Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI8Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI8Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI8Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI8Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI8Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI8Q_TXBD_DESA_H_8814B(x) | BIT_HI8Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI9Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI9Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI9Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI9Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI9Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI9Q_TXBD_DESA_L_8814B) -+#define BITS_HI9Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI9Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI9Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI9Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI9Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI9Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI9Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI9Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI9Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI9Q_TXBD_DESA_L_8814B(x) | BIT_HI9Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI9Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI9Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI9Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI9Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI9Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI9Q_TXBD_DESA_H_8814B) -+#define BITS_HI9Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI9Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI9Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI9Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI9Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI9Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI9Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI9Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI9Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI9Q_TXBD_DESA_H_8814B(x) | BIT_HI9Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI10Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI10Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI10Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI10Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI10Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI10Q_TXBD_DESA_L_8814B) -+#define BITS_HI10Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI10Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI10Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI10Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI10Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI10Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI10Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI10Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI10Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI10Q_TXBD_DESA_L_8814B(x) | BIT_HI10Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI10Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI10Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI10Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI10Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI10Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI10Q_TXBD_DESA_H_8814B) -+#define BITS_HI10Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI10Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI10Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI10Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI10Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI10Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI10Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI10Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI10Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI10Q_TXBD_DESA_H_8814B(x) | BIT_HI10Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI11Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI11Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI11Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI11Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI11Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI11Q_TXBD_DESA_L_8814B) -+#define BITS_HI11Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI11Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI11Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI11Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI11Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI11Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI11Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI11Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI11Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI11Q_TXBD_DESA_L_8814B(x) | BIT_HI11Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI11Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI11Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI11Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI11Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI11Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI11Q_TXBD_DESA_H_8814B) -+#define BITS_HI11Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI11Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI11Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI11Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI11Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI11Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI11Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI11Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI11Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI11Q_TXBD_DESA_H_8814B(x) | BIT_HI11Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI12Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI12Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI12Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI12Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI12Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI12Q_TXBD_DESA_L_8814B) -+#define BITS_HI12Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI12Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI12Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI12Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI12Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI12Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI12Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI12Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI12Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI12Q_TXBD_DESA_L_8814B(x) | BIT_HI12Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI12Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI12Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI12Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI12Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI12Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI12Q_TXBD_DESA_H_8814B) -+#define BITS_HI12Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI12Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI12Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI12Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI12Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI12Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI12Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI12Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI12Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI12Q_TXBD_DESA_H_8814B(x) | BIT_HI12Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI13Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI13Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI13Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI13Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI13Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI13Q_TXBD_DESA_L_8814B) -+#define BITS_HI13Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI13Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI13Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI13Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI13Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI13Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI13Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI13Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI13Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI13Q_TXBD_DESA_L_8814B(x) | BIT_HI13Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI13Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI13Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI13Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI13Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI13Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI13Q_TXBD_DESA_H_8814B) -+#define BITS_HI13Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI13Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI13Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI13Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI13Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI13Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI13Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI13Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI13Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI13Q_TXBD_DESA_H_8814B(x) | BIT_HI13Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI14Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI14Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI14Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI14Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI14Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI14Q_TXBD_DESA_L_8814B) -+#define BITS_HI14Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI14Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI14Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI14Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI14Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI14Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI14Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI14Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI14Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI14Q_TXBD_DESA_L_8814B(x) | BIT_HI14Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI14Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI14Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI14Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI14Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI14Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI14Q_TXBD_DESA_H_8814B) -+#define BITS_HI14Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI14Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI14Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI14Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI14Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI14Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI14Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI14Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI14Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI14Q_TXBD_DESA_H_8814B(x) | BIT_HI14Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI15Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI15Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI15Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI15Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI15Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI15Q_TXBD_DESA_L_8814B) -+#define BITS_HI15Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI15Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI15Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI15Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI15Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI15Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI15Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI15Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI15Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI15Q_TXBD_DESA_L_8814B(x) | BIT_HI15Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI15Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI15Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI15Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI15Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI15Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI15Q_TXBD_DESA_H_8814B) -+#define BITS_HI15Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI15Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI15Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI15Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI15Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI15Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI15Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI15Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI15Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI15Q_TXBD_DESA_H_8814B(x) | BIT_HI15Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI16Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI16Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI16Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI16Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI16Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI16Q_TXBD_DESA_L_8814B) -+#define BITS_HI16Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI16Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI16Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI16Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI16Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI16Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI16Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI16Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI16Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI16Q_TXBD_DESA_L_8814B(x) | BIT_HI16Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI16Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI16Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI16Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI16Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI16Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI16Q_TXBD_DESA_H_8814B) -+#define BITS_HI16Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI16Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI16Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI16Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI16Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI16Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI16Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI16Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI16Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI16Q_TXBD_DESA_H_8814B(x) | BIT_HI16Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI17Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI17Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI17Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI17Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI17Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI17Q_TXBD_DESA_L_8814B) -+#define BITS_HI17Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI17Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI17Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI17Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI17Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI17Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI17Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI17Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI17Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI17Q_TXBD_DESA_L_8814B(x) | BIT_HI17Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI17Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI17Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI17Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI17Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI17Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI17Q_TXBD_DESA_H_8814B) -+#define BITS_HI17Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI17Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI17Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI17Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI17Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI17Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI17Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI17Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI17Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI17Q_TXBD_DESA_H_8814B(x) | BIT_HI17Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI18Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI18Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI18Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI18Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI18Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI18Q_TXBD_DESA_L_8814B) -+#define BITS_HI18Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI18Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI18Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI18Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI18Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI18Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI18Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI18Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI18Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI18Q_TXBD_DESA_L_8814B(x) | BIT_HI18Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI18Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI18Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI18Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI18Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI18Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI18Q_TXBD_DESA_H_8814B) -+#define BITS_HI18Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI18Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI18Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI18Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI18Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI18Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI18Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI18Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI18Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI18Q_TXBD_DESA_H_8814B(x) | BIT_HI18Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_HI19Q_TXBD_DESA_L_8814B */ -+ -+#define BIT_SHIFT_HI19Q_TXBD_DESA_L_8814B 0 -+#define BIT_MASK_HI19Q_TXBD_DESA_L_8814B 0xffffffffL -+#define BIT_HI19Q_TXBD_DESA_L_8814B(x) \ -+ (((x) & BIT_MASK_HI19Q_TXBD_DESA_L_8814B) \ -+ << BIT_SHIFT_HI19Q_TXBD_DESA_L_8814B) -+#define BITS_HI19Q_TXBD_DESA_L_8814B \ -+ (BIT_MASK_HI19Q_TXBD_DESA_L_8814B << BIT_SHIFT_HI19Q_TXBD_DESA_L_8814B) -+#define BIT_CLEAR_HI19Q_TXBD_DESA_L_8814B(x) \ -+ ((x) & (~BITS_HI19Q_TXBD_DESA_L_8814B)) -+#define BIT_GET_HI19Q_TXBD_DESA_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI19Q_TXBD_DESA_L_8814B) & \ -+ BIT_MASK_HI19Q_TXBD_DESA_L_8814B) -+#define BIT_SET_HI19Q_TXBD_DESA_L_8814B(x, v) \ -+ (BIT_CLEAR_HI19Q_TXBD_DESA_L_8814B(x) | BIT_HI19Q_TXBD_DESA_L_8814B(v)) -+ -+/* 2 REG_HI19Q_TXBD_DESA_H_8814B */ -+ -+#define BIT_SHIFT_HI19Q_TXBD_DESA_H_8814B 0 -+#define BIT_MASK_HI19Q_TXBD_DESA_H_8814B 0xffffffffL -+#define BIT_HI19Q_TXBD_DESA_H_8814B(x) \ -+ (((x) & BIT_MASK_HI19Q_TXBD_DESA_H_8814B) \ -+ << BIT_SHIFT_HI19Q_TXBD_DESA_H_8814B) -+#define BITS_HI19Q_TXBD_DESA_H_8814B \ -+ (BIT_MASK_HI19Q_TXBD_DESA_H_8814B << BIT_SHIFT_HI19Q_TXBD_DESA_H_8814B) -+#define BIT_CLEAR_HI19Q_TXBD_DESA_H_8814B(x) \ -+ ((x) & (~BITS_HI19Q_TXBD_DESA_H_8814B)) -+#define BIT_GET_HI19Q_TXBD_DESA_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_HI19Q_TXBD_DESA_H_8814B) & \ -+ BIT_MASK_HI19Q_TXBD_DESA_H_8814B) -+#define BIT_SET_HI19Q_TXBD_DESA_H_8814B(x, v) \ -+ (BIT_CLEAR_HI19Q_TXBD_DESA_H_8814B(x) | BIT_HI19Q_TXBD_DESA_H_8814B(v)) -+ -+/* 2 REG_BD_RWPTR_CLR6_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CLR_P0HI19Q_HW_IDX_8814B BIT(25) -+#define BIT_CLR_P0HI18Q_HW_IDX_8814B BIT(24) -+#define BIT_CLR_P0HI17Q_HW_IDX_8814B BIT(23) -+#define BIT_CLR_P0HI16Q_HW_IDX_8814B BIT(22) -+ -+/* 2 REG_NOT_VALID_8814B */ -+#define BIT_CLR_P0HI19Q_HOST_IDX_8814B BIT(9) -+#define BIT_CLR_P0HI18Q_HOST_IDX_8814B BIT(8) -+#define BIT_CLR_P0HI17Q_HOST_IDX_8814B BIT(7) -+#define BIT_CLR_P0HI16Q_HOST_IDX_8814B BIT(6) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_P0HI16Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI16Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI16Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI16Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI16Q_HW_IDX_8814B) \ -+ << BIT_SHIFT_P0HI16Q_HW_IDX_8814B) -+#define BITS_P0HI16Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI16Q_HW_IDX_8814B << BIT_SHIFT_P0HI16Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI16Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI16Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI16Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI16Q_HW_IDX_8814B) & \ -+ BIT_MASK_P0HI16Q_HW_IDX_8814B) -+#define BIT_SET_P0HI16Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI16Q_HW_IDX_8814B(x) | BIT_P0HI16Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI16Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI16Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI16Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI16Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI16Q_HOST_IDX_8814B) -+#define BITS_P0HI16Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI16Q_HOST_IDX_8814B << BIT_SHIFT_P0HI16Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI16Q_HOST_IDX_8814B(x) \ -+ ((x) & (~BITS_P0HI16Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI16Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI16Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI16Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI16Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI16Q_HOST_IDX_8814B(x) | BIT_P0HI16Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI17Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI17Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI17Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI17Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI17Q_HW_IDX_8814B) \ -+ << BIT_SHIFT_P0HI17Q_HW_IDX_8814B) -+#define BITS_P0HI17Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI17Q_HW_IDX_8814B << BIT_SHIFT_P0HI17Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI17Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI17Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI17Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI17Q_HW_IDX_8814B) & \ -+ BIT_MASK_P0HI17Q_HW_IDX_8814B) -+#define BIT_SET_P0HI17Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI17Q_HW_IDX_8814B(x) | BIT_P0HI17Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI17Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI17Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI17Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI17Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI17Q_HOST_IDX_8814B) -+#define BITS_P0HI17Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI17Q_HOST_IDX_8814B << BIT_SHIFT_P0HI17Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI17Q_HOST_IDX_8814B(x) \ -+ ((x) & (~BITS_P0HI17Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI17Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI17Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI17Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI17Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI17Q_HOST_IDX_8814B(x) | BIT_P0HI17Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI18Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI18Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI18Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI18Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI18Q_HW_IDX_8814B) \ -+ << BIT_SHIFT_P0HI18Q_HW_IDX_8814B) -+#define BITS_P0HI18Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI18Q_HW_IDX_8814B << BIT_SHIFT_P0HI18Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI18Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI18Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI18Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI18Q_HW_IDX_8814B) & \ -+ BIT_MASK_P0HI18Q_HW_IDX_8814B) -+#define BIT_SET_P0HI18Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI18Q_HW_IDX_8814B(x) | BIT_P0HI18Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI18Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI18Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI18Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI18Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI18Q_HOST_IDX_8814B) -+#define BITS_P0HI18Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI18Q_HOST_IDX_8814B << BIT_SHIFT_P0HI18Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI18Q_HOST_IDX_8814B(x) \ -+ ((x) & (~BITS_P0HI18Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI18Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI18Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI18Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI18Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI18Q_HOST_IDX_8814B(x) | BIT_P0HI18Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI19Q_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_P0HI19Q_HW_IDX_8814B 16 -+#define BIT_MASK_P0HI19Q_HW_IDX_8814B 0xfff -+#define BIT_P0HI19Q_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI19Q_HW_IDX_8814B) \ -+ << BIT_SHIFT_P0HI19Q_HW_IDX_8814B) -+#define BITS_P0HI19Q_HW_IDX_8814B \ -+ (BIT_MASK_P0HI19Q_HW_IDX_8814B << BIT_SHIFT_P0HI19Q_HW_IDX_8814B) -+#define BIT_CLEAR_P0HI19Q_HW_IDX_8814B(x) ((x) & (~BITS_P0HI19Q_HW_IDX_8814B)) -+#define BIT_GET_P0HI19Q_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI19Q_HW_IDX_8814B) & \ -+ BIT_MASK_P0HI19Q_HW_IDX_8814B) -+#define BIT_SET_P0HI19Q_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI19Q_HW_IDX_8814B(x) | BIT_P0HI19Q_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_P0HI19Q_HOST_IDX_8814B 0 -+#define BIT_MASK_P0HI19Q_HOST_IDX_8814B 0xfff -+#define BIT_P0HI19Q_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_P0HI19Q_HOST_IDX_8814B) \ -+ << BIT_SHIFT_P0HI19Q_HOST_IDX_8814B) -+#define BITS_P0HI19Q_HOST_IDX_8814B \ -+ (BIT_MASK_P0HI19Q_HOST_IDX_8814B << BIT_SHIFT_P0HI19Q_HOST_IDX_8814B) -+#define BIT_CLEAR_P0HI19Q_HOST_IDX_8814B(x) \ -+ ((x) & (~BITS_P0HI19Q_HOST_IDX_8814B)) -+#define BIT_GET_P0HI19Q_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI19Q_HOST_IDX_8814B) & \ -+ BIT_MASK_P0HI19Q_HOST_IDX_8814B) -+#define BIT_SET_P0HI19Q_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_P0HI19Q_HOST_IDX_8814B(x) | BIT_P0HI19Q_HOST_IDX_8814B(v)) -+ -+/* 2 REG_P0HI16Q_HI17Q_TXBD_NUM_8814B */ -+#define BIT_P0HI17Q_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_P0HI17Q_DESC_MODE_8814B 28 -+#define BIT_MASK_P0HI17Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI17Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI17Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI17Q_DESC_MODE_8814B) -+#define BITS_P0HI17Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI17Q_DESC_MODE_8814B << BIT_SHIFT_P0HI17Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI17Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI17Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI17Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI17Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI17Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI17Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI17Q_DESC_MODE_8814B(x) | BIT_P0HI17Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI17Q_DESC_NUM_8814B 16 -+#define BIT_MASK_P0HI17Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI17Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI17Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI17Q_DESC_NUM_8814B) -+#define BITS_P0HI17Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI17Q_DESC_NUM_8814B << BIT_SHIFT_P0HI17Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI17Q_DESC_NUM_8814B(x) \ -+ ((x) & (~BITS_P0HI17Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI17Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI17Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI17Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI17Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI17Q_DESC_NUM_8814B(x) | BIT_P0HI17Q_DESC_NUM_8814B(v)) -+ -+#define BIT_P0HI16Q_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0HI16Q_DESC_MODE_8814B 12 -+#define BIT_MASK_P0HI16Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI16Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI16Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI16Q_DESC_MODE_8814B) -+#define BITS_P0HI16Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI16Q_DESC_MODE_8814B << BIT_SHIFT_P0HI16Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI16Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI16Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI16Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI16Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI16Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI16Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI16Q_DESC_MODE_8814B(x) | BIT_P0HI16Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI16Q_DESC_NUM_8814B 0 -+#define BIT_MASK_P0HI16Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI16Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI16Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI16Q_DESC_NUM_8814B) -+#define BITS_P0HI16Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI16Q_DESC_NUM_8814B << BIT_SHIFT_P0HI16Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI16Q_DESC_NUM_8814B(x) \ -+ ((x) & (~BITS_P0HI16Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI16Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI16Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI16Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI16Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI16Q_DESC_NUM_8814B(x) | BIT_P0HI16Q_DESC_NUM_8814B(v)) -+ -+/* 2 REG_P0HI18Q_HI19Q_TXBD_NUM_8814B */ -+#define BIT_P0HI19Q_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_P0HI19Q_DESC_MODE_8814B 28 -+#define BIT_MASK_P0HI19Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI19Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI19Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI19Q_DESC_MODE_8814B) -+#define BITS_P0HI19Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI19Q_DESC_MODE_8814B << BIT_SHIFT_P0HI19Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI19Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI19Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI19Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI19Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI19Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI19Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI19Q_DESC_MODE_8814B(x) | BIT_P0HI19Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI19Q_DESC_NUM_8814B 16 -+#define BIT_MASK_P0HI19Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI19Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI19Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI19Q_DESC_NUM_8814B) -+#define BITS_P0HI19Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI19Q_DESC_NUM_8814B << BIT_SHIFT_P0HI19Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI19Q_DESC_NUM_8814B(x) \ -+ ((x) & (~BITS_P0HI19Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI19Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI19Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI19Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI19Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI19Q_DESC_NUM_8814B(x) | BIT_P0HI19Q_DESC_NUM_8814B(v)) -+ -+#define BIT_P0HI18Q_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0HI18Q_DESC_MODE_8814B 12 -+#define BIT_MASK_P0HI18Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI18Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI18Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI18Q_DESC_MODE_8814B) -+#define BITS_P0HI18Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI18Q_DESC_MODE_8814B << BIT_SHIFT_P0HI18Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI18Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI18Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI18Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI18Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI18Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI18Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI18Q_DESC_MODE_8814B(x) | BIT_P0HI18Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI18Q_DESC_NUM_8814B 0 -+#define BIT_MASK_P0HI18Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI18Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI18Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI18Q_DESC_NUM_8814B) -+#define BITS_P0HI18Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI18Q_DESC_NUM_8814B << BIT_SHIFT_P0HI18Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI18Q_DESC_NUM_8814B(x) \ -+ ((x) & (~BITS_P0HI18Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI18Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI18Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI18Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI18Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI18Q_DESC_NUM_8814B(x) | BIT_P0HI18Q_DESC_NUM_8814B(v)) -+ -+/* 2 REG_PCIE_HISR0_8814B */ -+#define BIT_PSTIMER_2_8814B BIT(31) -+#define BIT_PSTIMER_1_8814B BIT(30) -+#define BIT_PSTIMER_0_8814B BIT(29) -+#define BIT_GTINT4_8814B BIT(28) -+#define BIT_GTINT3_8814B BIT(27) -+#define BIT_TXBCN0ERR_8814B BIT(26) -+#define BIT_TXBCN0OK_8814B BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_8814B BIT(24) -+#define BIT_TXDMA_START_INT_8814B BIT(23) -+#define BIT_TXDMA_STOP_INT_8814B BIT(22) -+#define BIT_HISR7_IND_8814B BIT(21) -+#define BIT_BCNDMAINT0_8814B BIT(20) -+#define BIT_HISR6_IND_8814B BIT(19) -+#define BIT_HISR5_IND_8814B BIT(18) -+#define BIT_HISR4_IND_8814B BIT(17) -+#define BIT_BCNDERR0_8814B BIT(16) -+#define BIT_HSISR_IND_ON_INT_8814B BIT(15) -+#define BIT_HISR3_IND_8814B BIT(14) -+#define BIT_HISR2_IND_8814B BIT(13) -+#define BIT_HISR1_IND_8814B BIT(11) -+#define BIT_C2HCMD_8814B BIT(10) -+#define BIT_CPWM2_8814B BIT(9) -+#define BIT_CPWM_8814B BIT(8) -+#define BIT_TXDMAOK_CHANNEL15_8814B BIT(7) -+#define BIT_TXDMAOK_CHANNEL14_8814B BIT(6) -+#define BIT_TXDMAOK_CHANNEL3_8814B BIT(5) -+#define BIT_TXDMAOK_CHANNEL2_8814B BIT(4) -+#define BIT_TXDMAOK_CHANNEL1_8814B BIT(3) -+#define BIT_TXDMAOK_CHANNEL0_8814B BIT(2) -+#define BIT_RDU_8814B BIT(1) -+#define BIT_RXOK_8814B BIT(0) -+ -+/* 2 REG_PCIE_HISR1_8814B */ -+#define BIT_PRE_TX_ERR_INT_8814B BIT(31) -+#define BIT_TXFIFO_TH_INT_8814B BIT(30) -+#define BIT_BTON_STS_UPDATE_INT_8814B BIT(29) -+#define BIT_BCNDMAINT7_8814B BIT(27) -+#define BIT_BCNDMAINT6_8814B BIT(26) -+#define BIT_BCNDMAINT5_8814B BIT(25) -+#define BIT_BCNDMAINT4_8814B BIT(24) -+#define BIT_BCNDMAINT3_8814B BIT(23) -+#define BIT_BCNDMAINT2_8814B BIT(22) -+#define BIT_BCNDMAINT1_8814B BIT(21) -+#define BIT_BCNDERR7_8814B BIT(20) -+#define BIT_BCNDERR6_8814B BIT(19) -+#define BIT_BCNDERR5_8814B BIT(18) -+#define BIT_BCNDERR4_8814B BIT(17) -+#define BIT_BCNDERR3_8814B BIT(16) -+#define BIT_BCNDERR2_8814B BIT(15) -+#define BIT_BCNDERR1_8814B BIT(14) -+#define BIT_ATIMEND_8814B BIT(12) -+#define BIT_TXERR_INT_8814B BIT(11) -+#define BIT_RXERR_INT_8814B BIT(10) -+#define BIT_TXFOVW_8814B BIT(9) -+#define BIT_FOVW_8814B BIT(8) -+#define BIT_CPU_MGQ_EARLY_INT_8814B BIT(6) -+#define BIT_CPU_MGQ_TXDONE_8814B BIT(5) -+#define BIT_PSTIMER_5_8814B BIT(4) -+#define BIT_PSTIMER_4_8814B BIT(3) -+#define BIT_PSTIMER_3_8814B BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_8814B BIT(1) -+#define BIT_BB_STOPRX_INT_8814B BIT(0) -+ -+/* 2 REG_P0HI8Q_HI9Q_TXBD_NUM_8814B */ -+#define BIT_P0HI9Q_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_P0HI9Q_DESC_MODE_8814B 28 -+#define BIT_MASK_P0HI9Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI9Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI9Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI9Q_DESC_MODE_8814B) -+#define BITS_P0HI9Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI9Q_DESC_MODE_8814B << BIT_SHIFT_P0HI9Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI9Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI9Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI9Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI9Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI9Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI9Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI9Q_DESC_MODE_8814B(x) | BIT_P0HI9Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI9Q_DESC_NUM_8814B 16 -+#define BIT_MASK_P0HI9Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI9Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI9Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI9Q_DESC_NUM_8814B) -+#define BITS_P0HI9Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI9Q_DESC_NUM_8814B << BIT_SHIFT_P0HI9Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI9Q_DESC_NUM_8814B(x) ((x) & (~BITS_P0HI9Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI9Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI9Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI9Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI9Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI9Q_DESC_NUM_8814B(x) | BIT_P0HI9Q_DESC_NUM_8814B(v)) -+ -+#define BIT_P0HI8Q_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0HI8Q_DESC_MODE_8814B 12 -+#define BIT_MASK_P0HI8Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI8Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI8Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI8Q_DESC_MODE_8814B) -+#define BITS_P0HI8Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI8Q_DESC_MODE_8814B << BIT_SHIFT_P0HI8Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI8Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI8Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI8Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI8Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI8Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI8Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI8Q_DESC_MODE_8814B(x) | BIT_P0HI8Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI8Q_DESC_NUM_8814B 0 -+#define BIT_MASK_P0HI8Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI8Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI8Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI8Q_DESC_NUM_8814B) -+#define BITS_P0HI8Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI8Q_DESC_NUM_8814B << BIT_SHIFT_P0HI8Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI8Q_DESC_NUM_8814B(x) ((x) & (~BITS_P0HI8Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI8Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI8Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI8Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI8Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI8Q_DESC_NUM_8814B(x) | BIT_P0HI8Q_DESC_NUM_8814B(v)) -+ -+/* 2 REG_P0HI10Q_HI11Q_TXBD_NUM_8814B */ -+#define BIT_P0HI11Q_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_P0HI11Q_DESC_MODE_8814B 28 -+#define BIT_MASK_P0HI11Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI11Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI11Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI11Q_DESC_MODE_8814B) -+#define BITS_P0HI11Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI11Q_DESC_MODE_8814B << BIT_SHIFT_P0HI11Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI11Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI11Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI11Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI11Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI11Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI11Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI11Q_DESC_MODE_8814B(x) | BIT_P0HI11Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI11Q_DESC_NUM_8814B 16 -+#define BIT_MASK_P0HI11Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI11Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI11Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI11Q_DESC_NUM_8814B) -+#define BITS_P0HI11Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI11Q_DESC_NUM_8814B << BIT_SHIFT_P0HI11Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI11Q_DESC_NUM_8814B(x) \ -+ ((x) & (~BITS_P0HI11Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI11Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI11Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI11Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI11Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI11Q_DESC_NUM_8814B(x) | BIT_P0HI11Q_DESC_NUM_8814B(v)) -+ -+#define BIT_P0HI10Q_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0HI10Q_DESC_MODE_8814B 12 -+#define BIT_MASK_P0HI10Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI10Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI10Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI10Q_DESC_MODE_8814B) -+#define BITS_P0HI10Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI10Q_DESC_MODE_8814B << BIT_SHIFT_P0HI10Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI10Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI10Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI10Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI10Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI10Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI10Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI10Q_DESC_MODE_8814B(x) | BIT_P0HI10Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI10Q_DESC_NUM_8814B 0 -+#define BIT_MASK_P0HI10Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI10Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI10Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI10Q_DESC_NUM_8814B) -+#define BITS_P0HI10Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI10Q_DESC_NUM_8814B << BIT_SHIFT_P0HI10Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI10Q_DESC_NUM_8814B(x) \ -+ ((x) & (~BITS_P0HI10Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI10Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI10Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI10Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI10Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI10Q_DESC_NUM_8814B(x) | BIT_P0HI10Q_DESC_NUM_8814B(v)) -+ -+/* 2 REG_P0HI12Q_HI13Q_TXBD_NUM_8814B */ -+#define BIT_P0HI13Q_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_P0HI13Q_DESC_MODE_8814B 28 -+#define BIT_MASK_P0HI13Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI13Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI13Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI13Q_DESC_MODE_8814B) -+#define BITS_P0HI13Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI13Q_DESC_MODE_8814B << BIT_SHIFT_P0HI13Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI13Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI13Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI13Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI13Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI13Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI13Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI13Q_DESC_MODE_8814B(x) | BIT_P0HI13Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI13Q_DESC_NUM_8814B 16 -+#define BIT_MASK_P0HI13Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI13Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI13Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI13Q_DESC_NUM_8814B) -+#define BITS_P0HI13Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI13Q_DESC_NUM_8814B << BIT_SHIFT_P0HI13Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI13Q_DESC_NUM_8814B(x) \ -+ ((x) & (~BITS_P0HI13Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI13Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI13Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI13Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI13Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI13Q_DESC_NUM_8814B(x) | BIT_P0HI13Q_DESC_NUM_8814B(v)) -+ -+#define BIT_P0HI12Q_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0HI12Q_DESC_MODE_8814B 12 -+#define BIT_MASK_P0HI12Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI12Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI12Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI12Q_DESC_MODE_8814B) -+#define BITS_P0HI12Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI12Q_DESC_MODE_8814B << BIT_SHIFT_P0HI12Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI12Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI12Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI12Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI12Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI12Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI12Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI12Q_DESC_MODE_8814B(x) | BIT_P0HI12Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI12Q_DESC_NUM_8814B 0 -+#define BIT_MASK_P0HI12Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI12Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI12Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI12Q_DESC_NUM_8814B) -+#define BITS_P0HI12Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI12Q_DESC_NUM_8814B << BIT_SHIFT_P0HI12Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI12Q_DESC_NUM_8814B(x) \ -+ ((x) & (~BITS_P0HI12Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI12Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI12Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI12Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI12Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI12Q_DESC_NUM_8814B(x) | BIT_P0HI12Q_DESC_NUM_8814B(v)) -+ -+/* 2 REG_P0HI14Q_HI15Q_TXBD_NUM_8814B */ -+#define BIT_P0HI15Q_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_P0HI15Q_DESC_MODE_8814B 28 -+#define BIT_MASK_P0HI15Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI15Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI15Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI15Q_DESC_MODE_8814B) -+#define BITS_P0HI15Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI15Q_DESC_MODE_8814B << BIT_SHIFT_P0HI15Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI15Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI15Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI15Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI15Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI15Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI15Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI15Q_DESC_MODE_8814B(x) | BIT_P0HI15Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI15Q_DESC_NUM_8814B 16 -+#define BIT_MASK_P0HI15Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI15Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI15Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI15Q_DESC_NUM_8814B) -+#define BITS_P0HI15Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI15Q_DESC_NUM_8814B << BIT_SHIFT_P0HI15Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI15Q_DESC_NUM_8814B(x) \ -+ ((x) & (~BITS_P0HI15Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI15Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI15Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI15Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI15Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI15Q_DESC_NUM_8814B(x) | BIT_P0HI15Q_DESC_NUM_8814B(v)) -+ -+#define BIT_P0HI14Q_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_P0HI14Q_DESC_MODE_8814B 12 -+#define BIT_MASK_P0HI14Q_DESC_MODE_8814B 0x3 -+#define BIT_P0HI14Q_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_P0HI14Q_DESC_MODE_8814B) \ -+ << BIT_SHIFT_P0HI14Q_DESC_MODE_8814B) -+#define BITS_P0HI14Q_DESC_MODE_8814B \ -+ (BIT_MASK_P0HI14Q_DESC_MODE_8814B << BIT_SHIFT_P0HI14Q_DESC_MODE_8814B) -+#define BIT_CLEAR_P0HI14Q_DESC_MODE_8814B(x) \ -+ ((x) & (~BITS_P0HI14Q_DESC_MODE_8814B)) -+#define BIT_GET_P0HI14Q_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI14Q_DESC_MODE_8814B) & \ -+ BIT_MASK_P0HI14Q_DESC_MODE_8814B) -+#define BIT_SET_P0HI14Q_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_P0HI14Q_DESC_MODE_8814B(x) | BIT_P0HI14Q_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_P0HI14Q_DESC_NUM_8814B 0 -+#define BIT_MASK_P0HI14Q_DESC_NUM_8814B 0xfff -+#define BIT_P0HI14Q_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_P0HI14Q_DESC_NUM_8814B) \ -+ << BIT_SHIFT_P0HI14Q_DESC_NUM_8814B) -+#define BITS_P0HI14Q_DESC_NUM_8814B \ -+ (BIT_MASK_P0HI14Q_DESC_NUM_8814B << BIT_SHIFT_P0HI14Q_DESC_NUM_8814B) -+#define BIT_CLEAR_P0HI14Q_DESC_NUM_8814B(x) \ -+ ((x) & (~BITS_P0HI14Q_DESC_NUM_8814B)) -+#define BIT_GET_P0HI14Q_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_P0HI14Q_DESC_NUM_8814B) & \ -+ BIT_MASK_P0HI14Q_DESC_NUM_8814B) -+#define BIT_SET_P0HI14Q_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_P0HI14Q_DESC_NUM_8814B(x) | BIT_P0HI14Q_DESC_NUM_8814B(v)) -+ -+/* 2 REG_ACH6_ACH7_TXBD_NUM_8814B */ -+#define BIT_PCIE_ACH7_FLAG_8814B BIT(30) -+ -+#define BIT_SHIFT_ACH7_DESC_MODE_8814B 28 -+#define BIT_MASK_ACH7_DESC_MODE_8814B 0x3 -+#define BIT_ACH7_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH7_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH7_DESC_MODE_8814B) -+#define BITS_ACH7_DESC_MODE_8814B \ -+ (BIT_MASK_ACH7_DESC_MODE_8814B << BIT_SHIFT_ACH7_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH7_DESC_MODE_8814B(x) ((x) & (~BITS_ACH7_DESC_MODE_8814B)) -+#define BIT_GET_ACH7_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH7_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH7_DESC_MODE_8814B) -+#define BIT_SET_ACH7_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH7_DESC_MODE_8814B(x) | BIT_ACH7_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH7_DESC_NUM_8814B 16 -+#define BIT_MASK_ACH7_DESC_NUM_8814B 0xfff -+#define BIT_ACH7_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH7_DESC_NUM_8814B) << BIT_SHIFT_ACH7_DESC_NUM_8814B) -+#define BITS_ACH7_DESC_NUM_8814B \ -+ (BIT_MASK_ACH7_DESC_NUM_8814B << BIT_SHIFT_ACH7_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH7_DESC_NUM_8814B(x) ((x) & (~BITS_ACH7_DESC_NUM_8814B)) -+#define BIT_GET_ACH7_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH7_DESC_NUM_8814B) & BIT_MASK_ACH7_DESC_NUM_8814B) -+#define BIT_SET_ACH7_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH7_DESC_NUM_8814B(x) | BIT_ACH7_DESC_NUM_8814B(v)) -+ -+#define BIT_PCIE_ACH6_FLAG_8814B BIT(14) -+ -+#define BIT_SHIFT_ACH6_DESC_MODE_8814B 12 -+#define BIT_MASK_ACH6_DESC_MODE_8814B 0x3 -+#define BIT_ACH6_DESC_MODE_8814B(x) \ -+ (((x) & BIT_MASK_ACH6_DESC_MODE_8814B) \ -+ << BIT_SHIFT_ACH6_DESC_MODE_8814B) -+#define BITS_ACH6_DESC_MODE_8814B \ -+ (BIT_MASK_ACH6_DESC_MODE_8814B << BIT_SHIFT_ACH6_DESC_MODE_8814B) -+#define BIT_CLEAR_ACH6_DESC_MODE_8814B(x) ((x) & (~BITS_ACH6_DESC_MODE_8814B)) -+#define BIT_GET_ACH6_DESC_MODE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH6_DESC_MODE_8814B) & \ -+ BIT_MASK_ACH6_DESC_MODE_8814B) -+#define BIT_SET_ACH6_DESC_MODE_8814B(x, v) \ -+ (BIT_CLEAR_ACH6_DESC_MODE_8814B(x) | BIT_ACH6_DESC_MODE_8814B(v)) -+ -+#define BIT_SHIFT_ACH6_DESC_NUM_8814B 0 -+#define BIT_MASK_ACH6_DESC_NUM_8814B 0xfff -+#define BIT_ACH6_DESC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ACH6_DESC_NUM_8814B) << BIT_SHIFT_ACH6_DESC_NUM_8814B) -+#define BITS_ACH6_DESC_NUM_8814B \ -+ (BIT_MASK_ACH6_DESC_NUM_8814B << BIT_SHIFT_ACH6_DESC_NUM_8814B) -+#define BIT_CLEAR_ACH6_DESC_NUM_8814B(x) ((x) & (~BITS_ACH6_DESC_NUM_8814B)) -+#define BIT_GET_ACH6_DESC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH6_DESC_NUM_8814B) & BIT_MASK_ACH6_DESC_NUM_8814B) -+#define BIT_SET_ACH6_DESC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ACH6_DESC_NUM_8814B(x) | BIT_ACH6_DESC_NUM_8814B(v)) -+ -+/* 2 REG_ACH4_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH4_HW_IDX_8814B 16 -+#define BIT_MASK_ACH4_HW_IDX_8814B 0xfff -+#define BIT_ACH4_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH4_HW_IDX_8814B) << BIT_SHIFT_ACH4_HW_IDX_8814B) -+#define BITS_ACH4_HW_IDX_8814B \ -+ (BIT_MASK_ACH4_HW_IDX_8814B << BIT_SHIFT_ACH4_HW_IDX_8814B) -+#define BIT_CLEAR_ACH4_HW_IDX_8814B(x) ((x) & (~BITS_ACH4_HW_IDX_8814B)) -+#define BIT_GET_ACH4_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH4_HW_IDX_8814B) & BIT_MASK_ACH4_HW_IDX_8814B) -+#define BIT_SET_ACH4_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH4_HW_IDX_8814B(x) | BIT_ACH4_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH4_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH4_HOST_IDX_8814B 0xfff -+#define BIT_ACH4_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH4_HOST_IDX_8814B) << BIT_SHIFT_ACH4_HOST_IDX_8814B) -+#define BITS_ACH4_HOST_IDX_8814B \ -+ (BIT_MASK_ACH4_HOST_IDX_8814B << BIT_SHIFT_ACH4_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH4_HOST_IDX_8814B(x) ((x) & (~BITS_ACH4_HOST_IDX_8814B)) -+#define BIT_GET_ACH4_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH4_HOST_IDX_8814B) & BIT_MASK_ACH4_HOST_IDX_8814B) -+#define BIT_SET_ACH4_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH4_HOST_IDX_8814B(x) | BIT_ACH4_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH5_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH5_HW_IDX_8814B 16 -+#define BIT_MASK_ACH5_HW_IDX_8814B 0xfff -+#define BIT_ACH5_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH5_HW_IDX_8814B) << BIT_SHIFT_ACH5_HW_IDX_8814B) -+#define BITS_ACH5_HW_IDX_8814B \ -+ (BIT_MASK_ACH5_HW_IDX_8814B << BIT_SHIFT_ACH5_HW_IDX_8814B) -+#define BIT_CLEAR_ACH5_HW_IDX_8814B(x) ((x) & (~BITS_ACH5_HW_IDX_8814B)) -+#define BIT_GET_ACH5_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH5_HW_IDX_8814B) & BIT_MASK_ACH5_HW_IDX_8814B) -+#define BIT_SET_ACH5_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH5_HW_IDX_8814B(x) | BIT_ACH5_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH5_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH5_HOST_IDX_8814B 0xfff -+#define BIT_ACH5_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH5_HOST_IDX_8814B) << BIT_SHIFT_ACH5_HOST_IDX_8814B) -+#define BITS_ACH5_HOST_IDX_8814B \ -+ (BIT_MASK_ACH5_HOST_IDX_8814B << BIT_SHIFT_ACH5_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH5_HOST_IDX_8814B(x) ((x) & (~BITS_ACH5_HOST_IDX_8814B)) -+#define BIT_GET_ACH5_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH5_HOST_IDX_8814B) & BIT_MASK_ACH5_HOST_IDX_8814B) -+#define BIT_SET_ACH5_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH5_HOST_IDX_8814B(x) | BIT_ACH5_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH6_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH6_HW_IDX_8814B 16 -+#define BIT_MASK_ACH6_HW_IDX_8814B 0xfff -+#define BIT_ACH6_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH6_HW_IDX_8814B) << BIT_SHIFT_ACH6_HW_IDX_8814B) -+#define BITS_ACH6_HW_IDX_8814B \ -+ (BIT_MASK_ACH6_HW_IDX_8814B << BIT_SHIFT_ACH6_HW_IDX_8814B) -+#define BIT_CLEAR_ACH6_HW_IDX_8814B(x) ((x) & (~BITS_ACH6_HW_IDX_8814B)) -+#define BIT_GET_ACH6_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH6_HW_IDX_8814B) & BIT_MASK_ACH6_HW_IDX_8814B) -+#define BIT_SET_ACH6_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH6_HW_IDX_8814B(x) | BIT_ACH6_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH6_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH6_HOST_IDX_8814B 0xfff -+#define BIT_ACH6_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH6_HOST_IDX_8814B) << BIT_SHIFT_ACH6_HOST_IDX_8814B) -+#define BITS_ACH6_HOST_IDX_8814B \ -+ (BIT_MASK_ACH6_HOST_IDX_8814B << BIT_SHIFT_ACH6_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH6_HOST_IDX_8814B(x) ((x) & (~BITS_ACH6_HOST_IDX_8814B)) -+#define BIT_GET_ACH6_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH6_HOST_IDX_8814B) & BIT_MASK_ACH6_HOST_IDX_8814B) -+#define BIT_SET_ACH6_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH6_HOST_IDX_8814B(x) | BIT_ACH6_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH7_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH7_HW_IDX_8814B 16 -+#define BIT_MASK_ACH7_HW_IDX_8814B 0xfff -+#define BIT_ACH7_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH7_HW_IDX_8814B) << BIT_SHIFT_ACH7_HW_IDX_8814B) -+#define BITS_ACH7_HW_IDX_8814B \ -+ (BIT_MASK_ACH7_HW_IDX_8814B << BIT_SHIFT_ACH7_HW_IDX_8814B) -+#define BIT_CLEAR_ACH7_HW_IDX_8814B(x) ((x) & (~BITS_ACH7_HW_IDX_8814B)) -+#define BIT_GET_ACH7_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH7_HW_IDX_8814B) & BIT_MASK_ACH7_HW_IDX_8814B) -+#define BIT_SET_ACH7_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH7_HW_IDX_8814B(x) | BIT_ACH7_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH7_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH7_HOST_IDX_8814B 0xfff -+#define BIT_ACH7_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH7_HOST_IDX_8814B) << BIT_SHIFT_ACH7_HOST_IDX_8814B) -+#define BITS_ACH7_HOST_IDX_8814B \ -+ (BIT_MASK_ACH7_HOST_IDX_8814B << BIT_SHIFT_ACH7_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH7_HOST_IDX_8814B(x) ((x) & (~BITS_ACH7_HOST_IDX_8814B)) -+#define BIT_GET_ACH7_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH7_HOST_IDX_8814B) & BIT_MASK_ACH7_HOST_IDX_8814B) -+#define BIT_SET_ACH7_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH7_HOST_IDX_8814B(x) | BIT_ACH7_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH8_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH8_HW_IDX_8814B 16 -+#define BIT_MASK_ACH8_HW_IDX_8814B 0xfff -+#define BIT_ACH8_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH8_HW_IDX_8814B) << BIT_SHIFT_ACH8_HW_IDX_8814B) -+#define BITS_ACH8_HW_IDX_8814B \ -+ (BIT_MASK_ACH8_HW_IDX_8814B << BIT_SHIFT_ACH8_HW_IDX_8814B) -+#define BIT_CLEAR_ACH8_HW_IDX_8814B(x) ((x) & (~BITS_ACH8_HW_IDX_8814B)) -+#define BIT_GET_ACH8_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH8_HW_IDX_8814B) & BIT_MASK_ACH8_HW_IDX_8814B) -+#define BIT_SET_ACH8_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH8_HW_IDX_8814B(x) | BIT_ACH8_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH8_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH8_HOST_IDX_8814B 0xfff -+#define BIT_ACH8_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH8_HOST_IDX_8814B) << BIT_SHIFT_ACH8_HOST_IDX_8814B) -+#define BITS_ACH8_HOST_IDX_8814B \ -+ (BIT_MASK_ACH8_HOST_IDX_8814B << BIT_SHIFT_ACH8_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH8_HOST_IDX_8814B(x) ((x) & (~BITS_ACH8_HOST_IDX_8814B)) -+#define BIT_GET_ACH8_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH8_HOST_IDX_8814B) & BIT_MASK_ACH8_HOST_IDX_8814B) -+#define BIT_SET_ACH8_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH8_HOST_IDX_8814B(x) | BIT_ACH8_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH9_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH9_HW_IDX_8814B 16 -+#define BIT_MASK_ACH9_HW_IDX_8814B 0xfff -+#define BIT_ACH9_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH9_HW_IDX_8814B) << BIT_SHIFT_ACH9_HW_IDX_8814B) -+#define BITS_ACH9_HW_IDX_8814B \ -+ (BIT_MASK_ACH9_HW_IDX_8814B << BIT_SHIFT_ACH9_HW_IDX_8814B) -+#define BIT_CLEAR_ACH9_HW_IDX_8814B(x) ((x) & (~BITS_ACH9_HW_IDX_8814B)) -+#define BIT_GET_ACH9_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH9_HW_IDX_8814B) & BIT_MASK_ACH9_HW_IDX_8814B) -+#define BIT_SET_ACH9_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH9_HW_IDX_8814B(x) | BIT_ACH9_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH9_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH9_HOST_IDX_8814B 0xfff -+#define BIT_ACH9_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH9_HOST_IDX_8814B) << BIT_SHIFT_ACH9_HOST_IDX_8814B) -+#define BITS_ACH9_HOST_IDX_8814B \ -+ (BIT_MASK_ACH9_HOST_IDX_8814B << BIT_SHIFT_ACH9_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH9_HOST_IDX_8814B(x) ((x) & (~BITS_ACH9_HOST_IDX_8814B)) -+#define BIT_GET_ACH9_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH9_HOST_IDX_8814B) & BIT_MASK_ACH9_HOST_IDX_8814B) -+#define BIT_SET_ACH9_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH9_HOST_IDX_8814B(x) | BIT_ACH9_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH10_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH10_HW_IDX_8814B 16 -+#define BIT_MASK_ACH10_HW_IDX_8814B 0xfff -+#define BIT_ACH10_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH10_HW_IDX_8814B) << BIT_SHIFT_ACH10_HW_IDX_8814B) -+#define BITS_ACH10_HW_IDX_8814B \ -+ (BIT_MASK_ACH10_HW_IDX_8814B << BIT_SHIFT_ACH10_HW_IDX_8814B) -+#define BIT_CLEAR_ACH10_HW_IDX_8814B(x) ((x) & (~BITS_ACH10_HW_IDX_8814B)) -+#define BIT_GET_ACH10_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH10_HW_IDX_8814B) & BIT_MASK_ACH10_HW_IDX_8814B) -+#define BIT_SET_ACH10_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH10_HW_IDX_8814B(x) | BIT_ACH10_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH10_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH10_HOST_IDX_8814B 0xfff -+#define BIT_ACH10_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH10_HOST_IDX_8814B) \ -+ << BIT_SHIFT_ACH10_HOST_IDX_8814B) -+#define BITS_ACH10_HOST_IDX_8814B \ -+ (BIT_MASK_ACH10_HOST_IDX_8814B << BIT_SHIFT_ACH10_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH10_HOST_IDX_8814B(x) ((x) & (~BITS_ACH10_HOST_IDX_8814B)) -+#define BIT_GET_ACH10_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH10_HOST_IDX_8814B) & \ -+ BIT_MASK_ACH10_HOST_IDX_8814B) -+#define BIT_SET_ACH10_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH10_HOST_IDX_8814B(x) | BIT_ACH10_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH11_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH11_HW_IDX_8814B 16 -+#define BIT_MASK_ACH11_HW_IDX_8814B 0xfff -+#define BIT_ACH11_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH11_HW_IDX_8814B) << BIT_SHIFT_ACH11_HW_IDX_8814B) -+#define BITS_ACH11_HW_IDX_8814B \ -+ (BIT_MASK_ACH11_HW_IDX_8814B << BIT_SHIFT_ACH11_HW_IDX_8814B) -+#define BIT_CLEAR_ACH11_HW_IDX_8814B(x) ((x) & (~BITS_ACH11_HW_IDX_8814B)) -+#define BIT_GET_ACH11_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH11_HW_IDX_8814B) & BIT_MASK_ACH11_HW_IDX_8814B) -+#define BIT_SET_ACH11_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH11_HW_IDX_8814B(x) | BIT_ACH11_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH11_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH11_HOST_IDX_8814B 0xfff -+#define BIT_ACH11_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH11_HOST_IDX_8814B) \ -+ << BIT_SHIFT_ACH11_HOST_IDX_8814B) -+#define BITS_ACH11_HOST_IDX_8814B \ -+ (BIT_MASK_ACH11_HOST_IDX_8814B << BIT_SHIFT_ACH11_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH11_HOST_IDX_8814B(x) ((x) & (~BITS_ACH11_HOST_IDX_8814B)) -+#define BIT_GET_ACH11_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH11_HOST_IDX_8814B) & \ -+ BIT_MASK_ACH11_HOST_IDX_8814B) -+#define BIT_SET_ACH11_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH11_HOST_IDX_8814B(x) | BIT_ACH11_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH12_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH12_HW_IDX_8814B 16 -+#define BIT_MASK_ACH12_HW_IDX_8814B 0xfff -+#define BIT_ACH12_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH12_HW_IDX_8814B) << BIT_SHIFT_ACH12_HW_IDX_8814B) -+#define BITS_ACH12_HW_IDX_8814B \ -+ (BIT_MASK_ACH12_HW_IDX_8814B << BIT_SHIFT_ACH12_HW_IDX_8814B) -+#define BIT_CLEAR_ACH12_HW_IDX_8814B(x) ((x) & (~BITS_ACH12_HW_IDX_8814B)) -+#define BIT_GET_ACH12_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH12_HW_IDX_8814B) & BIT_MASK_ACH12_HW_IDX_8814B) -+#define BIT_SET_ACH12_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH12_HW_IDX_8814B(x) | BIT_ACH12_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH12_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH12_HOST_IDX_8814B 0xfff -+#define BIT_ACH12_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH12_HOST_IDX_8814B) \ -+ << BIT_SHIFT_ACH12_HOST_IDX_8814B) -+#define BITS_ACH12_HOST_IDX_8814B \ -+ (BIT_MASK_ACH12_HOST_IDX_8814B << BIT_SHIFT_ACH12_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH12_HOST_IDX_8814B(x) ((x) & (~BITS_ACH12_HOST_IDX_8814B)) -+#define BIT_GET_ACH12_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH12_HOST_IDX_8814B) & \ -+ BIT_MASK_ACH12_HOST_IDX_8814B) -+#define BIT_SET_ACH12_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH12_HOST_IDX_8814B(x) | BIT_ACH12_HOST_IDX_8814B(v)) -+ -+/* 2 REG_ACH13_TXBD_IDX_8814B */ -+ -+#define BIT_SHIFT_ACH13_HW_IDX_8814B 16 -+#define BIT_MASK_ACH13_HW_IDX_8814B 0xfff -+#define BIT_ACH13_HW_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH13_HW_IDX_8814B) << BIT_SHIFT_ACH13_HW_IDX_8814B) -+#define BITS_ACH13_HW_IDX_8814B \ -+ (BIT_MASK_ACH13_HW_IDX_8814B << BIT_SHIFT_ACH13_HW_IDX_8814B) -+#define BIT_CLEAR_ACH13_HW_IDX_8814B(x) ((x) & (~BITS_ACH13_HW_IDX_8814B)) -+#define BIT_GET_ACH13_HW_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH13_HW_IDX_8814B) & BIT_MASK_ACH13_HW_IDX_8814B) -+#define BIT_SET_ACH13_HW_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH13_HW_IDX_8814B(x) | BIT_ACH13_HW_IDX_8814B(v)) -+ -+#define BIT_SHIFT_ACH13_HOST_IDX_8814B 0 -+#define BIT_MASK_ACH13_HOST_IDX_8814B 0xfff -+#define BIT_ACH13_HOST_IDX_8814B(x) \ -+ (((x) & BIT_MASK_ACH13_HOST_IDX_8814B) \ -+ << BIT_SHIFT_ACH13_HOST_IDX_8814B) -+#define BITS_ACH13_HOST_IDX_8814B \ -+ (BIT_MASK_ACH13_HOST_IDX_8814B << BIT_SHIFT_ACH13_HOST_IDX_8814B) -+#define BIT_CLEAR_ACH13_HOST_IDX_8814B(x) ((x) & (~BITS_ACH13_HOST_IDX_8814B)) -+#define BIT_GET_ACH13_HOST_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACH13_HOST_IDX_8814B) & \ -+ BIT_MASK_ACH13_HOST_IDX_8814B) -+#define BIT_SET_ACH13_HOST_IDX_8814B(x, v) \ -+ (BIT_CLEAR_ACH13_HOST_IDX_8814B(x) | BIT_ACH13_HOST_IDX_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL0_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL0_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL0_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL0_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL0_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL0_WEIGHT_8814B) -+#define BITS_AC_CHANNEL0_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL0_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL0_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL0_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL0_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL0_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL0_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL0_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL0_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL0_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL0_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL1_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL1_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL1_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL1_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL1_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL1_WEIGHT_8814B) -+#define BITS_AC_CHANNEL1_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL1_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL1_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL1_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL1_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL1_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL1_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL1_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL1_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL1_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL1_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL2_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL2_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL2_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL2_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL2_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL2_WEIGHT_8814B) -+#define BITS_AC_CHANNEL2_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL2_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL2_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL2_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL2_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL2_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL2_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL2_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL2_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL2_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL2_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL3_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL3_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL3_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL3_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL3_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL3_WEIGHT_8814B) -+#define BITS_AC_CHANNEL3_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL3_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL3_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL3_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL3_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL3_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL3_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL3_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL3_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL3_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL3_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL4_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL4_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL4_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL4_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL4_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL4_WEIGHT_8814B) -+#define BITS_AC_CHANNEL4_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL4_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL4_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL4_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL4_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL4_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL4_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL4_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL4_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL4_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL4_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL5_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL5_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL5_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL5_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL5_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL5_WEIGHT_8814B) -+#define BITS_AC_CHANNEL5_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL5_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL5_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL5_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL5_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL5_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL5_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL5_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL5_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL5_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL5_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL6_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL6_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL6_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL6_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL6_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL6_WEIGHT_8814B) -+#define BITS_AC_CHANNEL6_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL6_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL6_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL6_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL6_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL6_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL6_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL6_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL6_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL6_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL6_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL7_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL7_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL7_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL7_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL7_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL7_WEIGHT_8814B) -+#define BITS_AC_CHANNEL7_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL7_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL7_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL7_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL7_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL7_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL7_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL7_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL7_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL7_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL7_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL8_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL8_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL8_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL8_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL8_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL8_WEIGHT_8814B) -+#define BITS_AC_CHANNEL8_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL8_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL8_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL8_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL8_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL8_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL8_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL8_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL8_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL8_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL8_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL9_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL9_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL9_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL9_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL9_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL9_WEIGHT_8814B) -+#define BITS_AC_CHANNEL9_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL9_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL9_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL9_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL9_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL9_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL9_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL9_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL9_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL9_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL9_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL10_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL10_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL10_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL10_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL10_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL10_WEIGHT_8814B) -+#define BITS_AC_CHANNEL10_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL10_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL10_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL10_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL10_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL10_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL10_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL10_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL10_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL10_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL10_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL11_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL11_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL11_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL11_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL11_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL11_WEIGHT_8814B) -+#define BITS_AC_CHANNEL11_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL11_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL11_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL11_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL11_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL11_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL11_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL11_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL11_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL11_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL11_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL12_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL12_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL12_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL12_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL12_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL12_WEIGHT_8814B) -+#define BITS_AC_CHANNEL12_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL12_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL12_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL12_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL12_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL12_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL12_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL12_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL12_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL12_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL12_WEIGHT_8814B(v)) -+ -+/* 2 REG_AC_CHANNEL13_WEIGHT_8814B */ -+ -+#define BIT_SHIFT_AC_CHANNEL13_WEIGHT_8814B 0 -+#define BIT_MASK_AC_CHANNEL13_WEIGHT_8814B 0xff -+#define BIT_AC_CHANNEL13_WEIGHT_8814B(x) \ -+ (((x) & BIT_MASK_AC_CHANNEL13_WEIGHT_8814B) \ -+ << BIT_SHIFT_AC_CHANNEL13_WEIGHT_8814B) -+#define BITS_AC_CHANNEL13_WEIGHT_8814B \ -+ (BIT_MASK_AC_CHANNEL13_WEIGHT_8814B \ -+ << BIT_SHIFT_AC_CHANNEL13_WEIGHT_8814B) -+#define BIT_CLEAR_AC_CHANNEL13_WEIGHT_8814B(x) \ -+ ((x) & (~BITS_AC_CHANNEL13_WEIGHT_8814B)) -+#define BIT_GET_AC_CHANNEL13_WEIGHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_CHANNEL13_WEIGHT_8814B) & \ -+ BIT_MASK_AC_CHANNEL13_WEIGHT_8814B) -+#define BIT_SET_AC_CHANNEL13_WEIGHT_8814B(x, v) \ -+ (BIT_CLEAR_AC_CHANNEL13_WEIGHT_8814B(x) | \ -+ BIT_AC_CHANNEL13_WEIGHT_8814B(v)) -+ -+/* 2 REG_PCIE_HISR2_8814B */ -+#define BIT_BCNDMAINT_P4_8814B BIT(31) -+#define BIT_BCNDMAINT_P3_8814B BIT(30) -+#define BIT_BCNDMAINT_P2_8814B BIT(29) -+#define BIT_BCNDMAINT_P1_8814B BIT(28) -+#define BIT_SCH_PHY_TXOP_SIFS_INT_8814B BIT(23) -+#define BIT_ATIMEND7_8814B BIT(22) -+#define BIT_ATIMEND6_8814B BIT(21) -+#define BIT_ATIMEND5_8814B BIT(20) -+#define BIT_ATIMEND4_8814B BIT(19) -+#define BIT_ATIMEND3_8814B BIT(18) -+#define BIT_ATIMEND2_8814B BIT(17) -+#define BIT_ATIMEND1_8814B BIT(16) -+#define BIT_TXBCN7OK_8814B BIT(14) -+#define BIT_TXBCN6OK_8814B BIT(13) -+#define BIT_TXBCN5OK_8814B BIT(12) -+#define BIT_TXBCN4OK_8814B BIT(11) -+#define BIT_TXBCN3OK_8814B BIT(10) -+#define BIT_TXBCN2OK_8814B BIT(9) -+#define BIT_TXBCN1OK_8814B BIT(8) -+#define BIT_TXBCN7ERR_8814B BIT(6) -+#define BIT_TXBCN6ERR_8814B BIT(5) -+#define BIT_TXBCN5ERR_8814B BIT(4) -+#define BIT_TXBCN4ERR_8814B BIT(3) -+#define BIT_TXBCN3ERR_8814B BIT(2) -+#define BIT_TXBCN2ERR_8814B BIT(1) -+#define BIT_TXBCN1ERR_8814B BIT(0) -+ -+/* 2 REG_PCIE_HISR3_8814B */ -+#define BIT_GTINT12_8814B BIT(24) -+#define BIT_GTINT11_8814B BIT(23) -+#define BIT_GTINT10_8814B BIT(22) -+#define BIT_GTINT9_8814B BIT(21) -+#define BIT_RX_DESC_BUF_FULL_8814B BIT(20) -+#define BIT_CPHY_LDO_OCP_DET_INT_8814B BIT(19) -+#define BIT_WDT_PLATFORM_INT_8814B BIT(18) -+#define BIT_WDT_CPU_INT_8814B BIT(17) -+#define BIT_SETH2CDOK_8814B BIT(16) -+#define BIT_H2C_CMD_FULL_8814B BIT(15) -+#define BIT_PKT_TRANS_ERR_8814B BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_8814B BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_8814B BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_8814B BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_8814B BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_8814B BIT(9) -+#define BIT_SEARCH_FAIL_8814B BIT(8) -+#define BIT_PWR_INT_127TO96_8814B BIT(7) -+#define BIT_PWR_INT_95TO64_8814B BIT(6) -+#define BIT_PWR_INT_63TO32_8814B BIT(5) -+#define BIT_PWR_INT_31TO0_8814B BIT(4) -+#define BIT_RX_DMA_STUCK_8814B BIT(3) -+#define BIT_TX_DMA_STUCK_8814B BIT(2) -+#define BIT_DDMA0_LP_INT_8814B BIT(1) -+#define BIT_DDMA0_HP_INT_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_QUEUELIST_INFO0_8814B */ -+ -+#define BIT_SHIFT_QINFO0_8814B 0 -+#define BIT_MASK_QINFO0_8814B 0xffffffffL -+#define BIT_QINFO0_8814B(x) \ -+ (((x) & BIT_MASK_QINFO0_8814B) << BIT_SHIFT_QINFO0_8814B) -+#define BITS_QINFO0_8814B (BIT_MASK_QINFO0_8814B << BIT_SHIFT_QINFO0_8814B) -+#define BIT_CLEAR_QINFO0_8814B(x) ((x) & (~BITS_QINFO0_8814B)) -+#define BIT_GET_QINFO0_8814B(x) \ -+ (((x) >> BIT_SHIFT_QINFO0_8814B) & BIT_MASK_QINFO0_8814B) -+#define BIT_SET_QINFO0_8814B(x, v) \ -+ (BIT_CLEAR_QINFO0_8814B(x) | BIT_QINFO0_8814B(v)) -+ -+/* 2 REG_QUEUELIST_INFO1_8814B */ -+ -+#define BIT_SHIFT_QINFO1_8814B 0 -+#define BIT_MASK_QINFO1_8814B 0xffffffffL -+#define BIT_QINFO1_8814B(x) \ -+ (((x) & BIT_MASK_QINFO1_8814B) << BIT_SHIFT_QINFO1_8814B) -+#define BITS_QINFO1_8814B (BIT_MASK_QINFO1_8814B << BIT_SHIFT_QINFO1_8814B) -+#define BIT_CLEAR_QINFO1_8814B(x) ((x) & (~BITS_QINFO1_8814B)) -+#define BIT_GET_QINFO1_8814B(x) \ -+ (((x) >> BIT_SHIFT_QINFO1_8814B) & BIT_MASK_QINFO1_8814B) -+#define BIT_SET_QINFO1_8814B(x, v) \ -+ (BIT_CLEAR_QINFO1_8814B(x) | BIT_QINFO1_8814B(v)) -+ -+/* 2 REG_QUEUELIST_INFO2_8814B */ -+ -+#define BIT_SHIFT_QINFO2_8814B 0 -+#define BIT_MASK_QINFO2_8814B 0xffffffffL -+#define BIT_QINFO2_8814B(x) \ -+ (((x) & BIT_MASK_QINFO2_8814B) << BIT_SHIFT_QINFO2_8814B) -+#define BITS_QINFO2_8814B (BIT_MASK_QINFO2_8814B << BIT_SHIFT_QINFO2_8814B) -+#define BIT_CLEAR_QINFO2_8814B(x) ((x) & (~BITS_QINFO2_8814B)) -+#define BIT_GET_QINFO2_8814B(x) \ -+ (((x) >> BIT_SHIFT_QINFO2_8814B) & BIT_MASK_QINFO2_8814B) -+#define BIT_SET_QINFO2_8814B(x, v) \ -+ (BIT_CLEAR_QINFO2_8814B(x) | BIT_QINFO2_8814B(v)) -+ -+/* 2 REG_QUEUELIST_INFO3_8814B */ -+ -+#define BIT_SHIFT_QINFO3_8814B 0 -+#define BIT_MASK_QINFO3_8814B 0xffffffffL -+#define BIT_QINFO3_8814B(x) \ -+ (((x) & BIT_MASK_QINFO3_8814B) << BIT_SHIFT_QINFO3_8814B) -+#define BITS_QINFO3_8814B (BIT_MASK_QINFO3_8814B << BIT_SHIFT_QINFO3_8814B) -+#define BIT_CLEAR_QINFO3_8814B(x) ((x) & (~BITS_QINFO3_8814B)) -+#define BIT_GET_QINFO3_8814B(x) \ -+ (((x) >> BIT_SHIFT_QINFO3_8814B) & BIT_MASK_QINFO3_8814B) -+#define BIT_SET_QINFO3_8814B(x, v) \ -+ (BIT_CLEAR_QINFO3_8814B(x) | BIT_QINFO3_8814B(v)) -+ -+/* 2 REG_QUEUELIST_INFO_EMPTY_8814B */ -+#define BIT_FWCMDQ_EMPTY_8814B BIT(31) -+#define BIT_MGQ_CPU_EMPTY_V1_8814B BIT(30) -+#define BIT_BCNQ_EMPTY_EXTP0_8814B BIT(29) -+#define BIT_BCNQ_EMPTY_PORT4_8814B BIT(28) -+#define BIT_BCNQ_EMPTY_PORT3_8814B BIT(27) -+#define BIT_BCNQ_EMPTY_PORT2_8814B BIT(26) -+#define BIT_BCNQ_EMPTY_PORT1_8814B BIT(25) -+#define BIT_BCNQ_EMPTY_PORT0_8814B BIT(24) -+#define BIT_HQQ_EMPTY_V1_8814B BIT(23) -+#define BIT_MQQ_EMPTY_V2_8814B BIT(22) -+#define BIT_S1_EMPTY_8814B BIT(21) -+#define BIT_S0_EMPTY_8814B BIT(20) -+#define BIT_AC19Q_EMPTY_8814B BIT(19) -+#define BIT_AC18Q_EMPTY_8814B BIT(18) -+#define BIT_AC17Q_EMPTY_8814B BIT(17) -+#define BIT_AC16Q_EMPTY_8814B BIT(16) -+#define BIT_AC15Q_EMPTY_8814B BIT(15) -+#define BIT_AC14Q_EMPTY_8814B BIT(14) -+#define BIT_AC13Q_EMPTY_8814B BIT(13) -+#define BIT_AC12Q_EMPTY_8814B BIT(12) -+#define BIT_AC11Q_EMPTY_8814B BIT(11) -+#define BIT_AC10Q_EMPTY_8814B BIT(10) -+#define BIT_AC9Q_EMPTY_8814B BIT(9) -+#define BIT_AC8Q_EMPTY_8814B BIT(8) -+#define BIT_AC7Q_EMPTY_8814B BIT(7) -+#define BIT_AC6Q_EMPTY_8814B BIT(6) -+#define BIT_AC5Q_EMPTY_8814B BIT(5) -+#define BIT_AC4Q_EMPTY_8814B BIT(4) -+#define BIT_AC3Q_EMPTY_8814B BIT(3) -+#define BIT_AC2Q_EMPTY_8814B BIT(2) -+#define BIT_AC1Q_EMPTY_8814B BIT(1) -+#define BIT_AC0Q_EMPTY_8814B BIT(0) -+ -+/* 2 REG_QUEUELIST_ACQ_EN_8814B */ -+ -+#define BIT_SHIFT_QINFO_CTRL_8814B 24 -+#define BIT_MASK_QINFO_CTRL_8814B 0x3f -+#define BIT_QINFO_CTRL_8814B(x) \ -+ (((x) & BIT_MASK_QINFO_CTRL_8814B) << BIT_SHIFT_QINFO_CTRL_8814B) -+#define BITS_QINFO_CTRL_8814B \ -+ (BIT_MASK_QINFO_CTRL_8814B << BIT_SHIFT_QINFO_CTRL_8814B) -+#define BIT_CLEAR_QINFO_CTRL_8814B(x) ((x) & (~BITS_QINFO_CTRL_8814B)) -+#define BIT_GET_QINFO_CTRL_8814B(x) \ -+ (((x) >> BIT_SHIFT_QINFO_CTRL_8814B) & BIT_MASK_QINFO_CTRL_8814B) -+#define BIT_SET_QINFO_CTRL_8814B(x, v) \ -+ (BIT_CLEAR_QINFO_CTRL_8814B(x) | BIT_QINFO_CTRL_8814B(v)) -+ -+#define BIT_SHIFT_QINFO_MODE_BAND_8814B 20 -+#define BIT_MASK_QINFO_MODE_BAND_8814B 0x7 -+#define BIT_QINFO_MODE_BAND_8814B(x) \ -+ (((x) & BIT_MASK_QINFO_MODE_BAND_8814B) \ -+ << BIT_SHIFT_QINFO_MODE_BAND_8814B) -+#define BITS_QINFO_MODE_BAND_8814B \ -+ (BIT_MASK_QINFO_MODE_BAND_8814B << BIT_SHIFT_QINFO_MODE_BAND_8814B) -+#define BIT_CLEAR_QINFO_MODE_BAND_8814B(x) ((x) & (~BITS_QINFO_MODE_BAND_8814B)) -+#define BIT_GET_QINFO_MODE_BAND_8814B(x) \ -+ (((x) >> BIT_SHIFT_QINFO_MODE_BAND_8814B) & \ -+ BIT_MASK_QINFO_MODE_BAND_8814B) -+#define BIT_SET_QINFO_MODE_BAND_8814B(x, v) \ -+ (BIT_CLEAR_QINFO_MODE_BAND_8814B(x) | BIT_QINFO_MODE_BAND_8814B(v)) -+ -+#define BIT_ACQ19_ENABLE_8814B BIT(19) -+#define BIT_ACQ18_ENABLE_8814B BIT(18) -+#define BIT_ACQ17_ENABLE_8814B BIT(17) -+#define BIT_ACQ16_ENABLE_8814B BIT(16) -+#define BIT_ACQ15_ENABLE_8814B BIT(15) -+#define BIT_ACQ14_ENABLE_8814B BIT(14) -+#define BIT_ACQ13_ENABLE_8814B BIT(13) -+#define BIT_ACQ12_ENABLE_8814B BIT(12) -+#define BIT_ACQ11_ENABLE_8814B BIT(11) -+#define BIT_ACQ10_ENABLE_8814B BIT(10) -+#define BIT_ACQ9_ENABLE_8814B BIT(9) -+#define BIT_ACQ8_ENABLE_8814B BIT(8) -+#define BIT_ACQ7_ENABLE_8814B BIT(7) -+#define BIT_ACQ6_ENABLE_8814B BIT(6) -+#define BIT_ACQ5_ENABLE_8814B BIT(5) -+#define BIT_ACQ4_ENABLE_8814B BIT(4) -+#define BIT_ACQ3_ENABLE_8814B BIT(3) -+#define BIT_ACQ2_ENABLE_8814B BIT(2) -+#define BIT_ACQ1_ENABLE_8814B BIT(1) -+#define BIT_ACQ0_ENABLE_8814B BIT(0) -+ -+/* 2 REG_BCNQ_BDNY_V2_8814B */ -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_WSEL_8814B 28 -+#define BIT_MASK_BCNQ_PGBNDY_WSEL_8814B 0x7 -+#define BIT_BCNQ_PGBNDY_WSEL_8814B(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_WSEL_8814B) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_WSEL_8814B) -+#define BITS_BCNQ_PGBNDY_WSEL_8814B \ -+ (BIT_MASK_BCNQ_PGBNDY_WSEL_8814B << BIT_SHIFT_BCNQ_PGBNDY_WSEL_8814B) -+#define BIT_CLEAR_BCNQ_PGBNDY_WSEL_8814B(x) \ -+ ((x) & (~BITS_BCNQ_PGBNDY_WSEL_8814B)) -+#define BIT_GET_BCNQ_PGBNDY_WSEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_WSEL_8814B) & \ -+ BIT_MASK_BCNQ_PGBNDY_WSEL_8814B) -+#define BIT_SET_BCNQ_PGBNDY_WSEL_8814B(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_WSEL_8814B(x) | BIT_BCNQ_PGBNDY_WSEL_8814B(v)) -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_RCONTENT_8814B 12 -+#define BIT_MASK_BCNQ_PGBNDY_RCONTENT_8814B 0xfff -+#define BIT_BCNQ_PGBNDY_RCONTENT_8814B(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_RCONTENT_8814B) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_RCONTENT_8814B) -+#define BITS_BCNQ_PGBNDY_RCONTENT_8814B \ -+ (BIT_MASK_BCNQ_PGBNDY_RCONTENT_8814B \ -+ << BIT_SHIFT_BCNQ_PGBNDY_RCONTENT_8814B) -+#define BIT_CLEAR_BCNQ_PGBNDY_RCONTENT_8814B(x) \ -+ ((x) & (~BITS_BCNQ_PGBNDY_RCONTENT_8814B)) -+#define BIT_GET_BCNQ_PGBNDY_RCONTENT_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_RCONTENT_8814B) & \ -+ BIT_MASK_BCNQ_PGBNDY_RCONTENT_8814B) -+#define BIT_SET_BCNQ_PGBNDY_RCONTENT_8814B(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_RCONTENT_8814B(x) | \ -+ BIT_BCNQ_PGBNDY_RCONTENT_8814B(v)) -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_WCONTENT_8814B 0 -+#define BIT_MASK_BCNQ_PGBNDY_WCONTENT_8814B 0xfff -+#define BIT_BCNQ_PGBNDY_WCONTENT_8814B(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_WCONTENT_8814B) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_WCONTENT_8814B) -+#define BITS_BCNQ_PGBNDY_WCONTENT_8814B \ -+ (BIT_MASK_BCNQ_PGBNDY_WCONTENT_8814B \ -+ << BIT_SHIFT_BCNQ_PGBNDY_WCONTENT_8814B) -+#define BIT_CLEAR_BCNQ_PGBNDY_WCONTENT_8814B(x) \ -+ ((x) & (~BITS_BCNQ_PGBNDY_WCONTENT_8814B)) -+#define BIT_GET_BCNQ_PGBNDY_WCONTENT_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_WCONTENT_8814B) & \ -+ BIT_MASK_BCNQ_PGBNDY_WCONTENT_8814B) -+#define BIT_SET_BCNQ_PGBNDY_WCONTENT_8814B(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_WCONTENT_8814B(x) | \ -+ BIT_BCNQ_PGBNDY_WCONTENT_8814B(v)) -+ -+/* 2 REG_CPU_MGQ_INFO_8814B */ -+#define BIT_CPUMGT_CLR_V1_8814B BIT(30) -+#define BIT_CPUMGT_POLL_8814B BIT(29) -+#define BIT_BCN_EXT_POLL_8814B BIT(21) -+#define BIT_BCN4_POLL_8814B BIT(20) -+#define BIT_BCN3_POLL_8814B BIT(19) -+#define BIT_BCN2_POLL_8814B BIT(18) -+#define BIT_BCN1_POLL_V1_8814B BIT(17) -+#define BIT_BCN_POLL_V1_8814B BIT(16) -+ -+#define BIT_SHIFT_FREE_TAIL_PAGE_8814B 0 -+#define BIT_MASK_FREE_TAIL_PAGE_8814B 0xfff -+#define BIT_FREE_TAIL_PAGE_8814B(x) \ -+ (((x) & BIT_MASK_FREE_TAIL_PAGE_8814B) \ -+ << BIT_SHIFT_FREE_TAIL_PAGE_8814B) -+#define BITS_FREE_TAIL_PAGE_8814B \ -+ (BIT_MASK_FREE_TAIL_PAGE_8814B << BIT_SHIFT_FREE_TAIL_PAGE_8814B) -+#define BIT_CLEAR_FREE_TAIL_PAGE_8814B(x) ((x) & (~BITS_FREE_TAIL_PAGE_8814B)) -+#define BIT_GET_FREE_TAIL_PAGE_8814B(x) \ -+ (((x) >> BIT_SHIFT_FREE_TAIL_PAGE_8814B) & \ -+ BIT_MASK_FREE_TAIL_PAGE_8814B) -+#define BIT_SET_FREE_TAIL_PAGE_8814B(x, v) \ -+ (BIT_CLEAR_FREE_TAIL_PAGE_8814B(x) | BIT_FREE_TAIL_PAGE_8814B(v)) -+ -+/* 2 REG_FWHW_TXQ_CTRL_8814B */ -+#define BIT_RTS_LIMIT_IN_OFDM_8814B BIT(23) -+#define BIT_EN_RD_RESP_NAV_BK_8814B BIT(21) -+#define BIT_EN_WR_FREE_TAIL_8814B BIT(20) -+#define BIT_NOTXRPT_USERATE_EN_8814B BIT(19) -+#define BIT_DIS_TXFAIL_RPT_8814B BIT(18) -+#define BIT_FTM_TIMEOUT_BYPASS_8814B BIT(16) -+#define BIT_EN_BCNQ_DL5_8814B BIT(13) -+#define BIT_EN_BCNQ_DL4_8814B BIT(12) -+#define BIT_EN_BCNQ_DL3_8814B BIT(11) -+#define BIT_EN_BCNQ_DL2_8814B BIT(10) -+#define BIT_EN_BCNQ_DL1_8814B BIT(9) -+#define BIT_EN_BCNQ_DL0_8814B BIT(8) -+#define BIT_EN_RTY_BK_8814B BIT(7) -+#define BIT_EN_USE_INI_RAT_8814B BIT(6) -+#define BIT_EN_RTS_NAV_BK_8814B BIT(5) -+#define BIT_DIS_SSN_CHECK_8814B BIT(4) -+#define BIT_MACID_MATCH_RTS_8814B BIT(3) -+#define BIT_EN_BCN_TRXRPT_V1_8814B BIT(2) -+#define BIT_EN_FTMRPT_V1_8814B BIT(1) -+#define BIT_BMC_NAV_PROTECT_8814B BIT(0) -+ -+/* 2 REG_DATAFB_SEL_8814B */ -+#define BIT_BROADCAST_RTY_EN_8814B BIT(3) -+#define BIT_EN_RTY_BK_COD_8814B BIT(2) -+ -+#define BIT_SHIFT__DATA_FALLBACK_SEL_8814B 0 -+#define BIT_MASK__DATA_FALLBACK_SEL_8814B 0x3 -+#define BIT__DATA_FALLBACK_SEL_8814B(x) \ -+ (((x) & BIT_MASK__DATA_FALLBACK_SEL_8814B) \ -+ << BIT_SHIFT__DATA_FALLBACK_SEL_8814B) -+#define BITS__DATA_FALLBACK_SEL_8814B \ -+ (BIT_MASK__DATA_FALLBACK_SEL_8814B \ -+ << BIT_SHIFT__DATA_FALLBACK_SEL_8814B) -+#define BIT_CLEAR__DATA_FALLBACK_SEL_8814B(x) \ -+ ((x) & (~BITS__DATA_FALLBACK_SEL_8814B)) -+#define BIT_GET__DATA_FALLBACK_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT__DATA_FALLBACK_SEL_8814B) & \ -+ BIT_MASK__DATA_FALLBACK_SEL_8814B) -+#define BIT_SET__DATA_FALLBACK_SEL_8814B(x, v) \ -+ (BIT_CLEAR__DATA_FALLBACK_SEL_8814B(x) | \ -+ BIT__DATA_FALLBACK_SEL_8814B(v)) -+ -+/* 2 REG_TXBDNY_8814B */ -+ -+#define BIT_SHIFT_TXBNDY_8814B 0 -+#define BIT_MASK_TXBNDY_8814B 0xfff -+#define BIT_TXBNDY_8814B(x) \ -+ (((x) & BIT_MASK_TXBNDY_8814B) << BIT_SHIFT_TXBNDY_8814B) -+#define BITS_TXBNDY_8814B (BIT_MASK_TXBNDY_8814B << BIT_SHIFT_TXBNDY_8814B) -+#define BIT_CLEAR_TXBNDY_8814B(x) ((x) & (~BITS_TXBNDY_8814B)) -+#define BIT_GET_TXBNDY_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXBNDY_8814B) & BIT_MASK_TXBNDY_8814B) -+#define BIT_SET_TXBNDY_8814B(x, v) \ -+ (BIT_CLEAR_TXBNDY_8814B(x) | BIT_TXBNDY_8814B(v)) -+ -+/* 2 REG_LIFETIME_EN_8814B */ -+#define BIT_BT_INT_CPU_8814B BIT(7) -+#define BIT_BT_INT_PTA_8814B BIT(6) -+#define BIT_BA_PARSER_EN_8814B BIT(5) -+#define BIT_EN_CTRL_RTYBIT_8814B BIT(4) -+#define BIT_LIFETIME_BK_EN_8814B BIT(3) -+#define BIT_LIFETIME_BE_EN_8814B BIT(2) -+#define BIT_LIFETIME_VI_EN_8814B BIT(1) -+#define BIT_LIFETIME_VO_EN_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_SPEC_SIFS_8814B */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8814B 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_PTCL_8814B 0xff -+#define BIT_SPEC_SIFS_OFDM_PTCL_8814B(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_PTCL_8814B) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8814B) -+#define BITS_SPEC_SIFS_OFDM_PTCL_8814B \ -+ (BIT_MASK_SPEC_SIFS_OFDM_PTCL_8814B \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8814B) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8814B(x) \ -+ ((x) & (~BITS_SPEC_SIFS_OFDM_PTCL_8814B)) -+#define BIT_GET_SPEC_SIFS_OFDM_PTCL_8814B(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8814B) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_PTCL_8814B) -+#define BIT_SET_SPEC_SIFS_OFDM_PTCL_8814B(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8814B(x) | \ -+ BIT_SPEC_SIFS_OFDM_PTCL_8814B(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8814B 0 -+#define BIT_MASK_SPEC_SIFS_CCK_PTCL_8814B 0xff -+#define BIT_SPEC_SIFS_CCK_PTCL_8814B(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_PTCL_8814B) \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8814B) -+#define BITS_SPEC_SIFS_CCK_PTCL_8814B \ -+ (BIT_MASK_SPEC_SIFS_CCK_PTCL_8814B \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8814B) -+#define BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8814B(x) \ -+ ((x) & (~BITS_SPEC_SIFS_CCK_PTCL_8814B)) -+#define BIT_GET_SPEC_SIFS_CCK_PTCL_8814B(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8814B) & \ -+ BIT_MASK_SPEC_SIFS_CCK_PTCL_8814B) -+#define BIT_SET_SPEC_SIFS_CCK_PTCL_8814B(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8814B(x) | \ -+ BIT_SPEC_SIFS_CCK_PTCL_8814B(v)) -+ -+/* 2 REG_RETRY_LIMIT_8814B */ -+ -+#define BIT_SHIFT_SRL_8814B 8 -+#define BIT_MASK_SRL_8814B 0x3f -+#define BIT_SRL_8814B(x) (((x) & BIT_MASK_SRL_8814B) << BIT_SHIFT_SRL_8814B) -+#define BITS_SRL_8814B (BIT_MASK_SRL_8814B << BIT_SHIFT_SRL_8814B) -+#define BIT_CLEAR_SRL_8814B(x) ((x) & (~BITS_SRL_8814B)) -+#define BIT_GET_SRL_8814B(x) (((x) >> BIT_SHIFT_SRL_8814B) & BIT_MASK_SRL_8814B) -+#define BIT_SET_SRL_8814B(x, v) (BIT_CLEAR_SRL_8814B(x) | BIT_SRL_8814B(v)) -+ -+#define BIT_SHIFT_LRL_8814B 0 -+#define BIT_MASK_LRL_8814B 0x3f -+#define BIT_LRL_8814B(x) (((x) & BIT_MASK_LRL_8814B) << BIT_SHIFT_LRL_8814B) -+#define BITS_LRL_8814B (BIT_MASK_LRL_8814B << BIT_SHIFT_LRL_8814B) -+#define BIT_CLEAR_LRL_8814B(x) ((x) & (~BITS_LRL_8814B)) -+#define BIT_GET_LRL_8814B(x) (((x) >> BIT_SHIFT_LRL_8814B) & BIT_MASK_LRL_8814B) -+#define BIT_SET_LRL_8814B(x, v) (BIT_CLEAR_LRL_8814B(x) | BIT_LRL_8814B(v)) -+ -+/* 2 REG_TXBF_CTRL_8814B */ -+#define BIT_ENABLE_NDPA_8814B BIT(31) -+#define BIT_NDPA_PARA_8814B BIT(30) -+#define BIT_PROP_TXBF_8814B BIT(29) -+#define BIT_EN_NDPA_INT_8814B BIT(28) -+#define BIT_TXBF1_80M_160M_8814B BIT(27) -+#define BIT_TXBF1_40M_8814B BIT(26) -+#define BIT_TXBF1_20M_8814B BIT(25) -+ -+#define BIT_SHIFT_TXBF1_AID_8814B 16 -+#define BIT_MASK_TXBF1_AID_8814B 0x1ff -+#define BIT_TXBF1_AID_8814B(x) \ -+ (((x) & BIT_MASK_TXBF1_AID_8814B) << BIT_SHIFT_TXBF1_AID_8814B) -+#define BITS_TXBF1_AID_8814B \ -+ (BIT_MASK_TXBF1_AID_8814B << BIT_SHIFT_TXBF1_AID_8814B) -+#define BIT_CLEAR_TXBF1_AID_8814B(x) ((x) & (~BITS_TXBF1_AID_8814B)) -+#define BIT_GET_TXBF1_AID_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXBF1_AID_8814B) & BIT_MASK_TXBF1_AID_8814B) -+#define BIT_SET_TXBF1_AID_8814B(x, v) \ -+ (BIT_CLEAR_TXBF1_AID_8814B(x) | BIT_TXBF1_AID_8814B(v)) -+ -+#define BIT_DIS_NDP_BFEN_8814B BIT(15) -+#define BIT_TXBCN_NOBLOCK_NDP_8814B BIT(14) -+#define BIT_TXBF0_80M_160M_8814B BIT(11) -+#define BIT_TXBF0_40M_8814B BIT(10) -+#define BIT_TXBF0_20M_8814B BIT(9) -+ -+#define BIT_SHIFT_TXBF0_AID_8814B 0 -+#define BIT_MASK_TXBF0_AID_8814B 0x1ff -+#define BIT_TXBF0_AID_8814B(x) \ -+ (((x) & BIT_MASK_TXBF0_AID_8814B) << BIT_SHIFT_TXBF0_AID_8814B) -+#define BITS_TXBF0_AID_8814B \ -+ (BIT_MASK_TXBF0_AID_8814B << BIT_SHIFT_TXBF0_AID_8814B) -+#define BIT_CLEAR_TXBF0_AID_8814B(x) ((x) & (~BITS_TXBF0_AID_8814B)) -+#define BIT_GET_TXBF0_AID_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXBF0_AID_8814B) & BIT_MASK_TXBF0_AID_8814B) -+#define BIT_SET_TXBF0_AID_8814B(x, v) \ -+ (BIT_CLEAR_TXBF0_AID_8814B(x) | BIT_TXBF0_AID_8814B(v)) -+ -+/* 2 REG_DARFRC_8814B */ -+ -+#define BIT_SHIFT_DARF_RC4_V1_8814B 24 -+#define BIT_MASK_DARF_RC4_V1_8814B 0x3f -+#define BIT_DARF_RC4_V1_8814B(x) \ -+ (((x) & BIT_MASK_DARF_RC4_V1_8814B) << BIT_SHIFT_DARF_RC4_V1_8814B) -+#define BITS_DARF_RC4_V1_8814B \ -+ (BIT_MASK_DARF_RC4_V1_8814B << BIT_SHIFT_DARF_RC4_V1_8814B) -+#define BIT_CLEAR_DARF_RC4_V1_8814B(x) ((x) & (~BITS_DARF_RC4_V1_8814B)) -+#define BIT_GET_DARF_RC4_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC4_V1_8814B) & BIT_MASK_DARF_RC4_V1_8814B) -+#define BIT_SET_DARF_RC4_V1_8814B(x, v) \ -+ (BIT_CLEAR_DARF_RC4_V1_8814B(x) | BIT_DARF_RC4_V1_8814B(v)) -+ -+#define BIT_SHIFT_DARF_RC3_V1_8814B 16 -+#define BIT_MASK_DARF_RC3_V1_8814B 0x3f -+#define BIT_DARF_RC3_V1_8814B(x) \ -+ (((x) & BIT_MASK_DARF_RC3_V1_8814B) << BIT_SHIFT_DARF_RC3_V1_8814B) -+#define BITS_DARF_RC3_V1_8814B \ -+ (BIT_MASK_DARF_RC3_V1_8814B << BIT_SHIFT_DARF_RC3_V1_8814B) -+#define BIT_CLEAR_DARF_RC3_V1_8814B(x) ((x) & (~BITS_DARF_RC3_V1_8814B)) -+#define BIT_GET_DARF_RC3_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC3_V1_8814B) & BIT_MASK_DARF_RC3_V1_8814B) -+#define BIT_SET_DARF_RC3_V1_8814B(x, v) \ -+ (BIT_CLEAR_DARF_RC3_V1_8814B(x) | BIT_DARF_RC3_V1_8814B(v)) -+ -+#define BIT_SHIFT_DARF_RC2_V1_8814B 8 -+#define BIT_MASK_DARF_RC2_V1_8814B 0x3f -+#define BIT_DARF_RC2_V1_8814B(x) \ -+ (((x) & BIT_MASK_DARF_RC2_V1_8814B) << BIT_SHIFT_DARF_RC2_V1_8814B) -+#define BITS_DARF_RC2_V1_8814B \ -+ (BIT_MASK_DARF_RC2_V1_8814B << BIT_SHIFT_DARF_RC2_V1_8814B) -+#define BIT_CLEAR_DARF_RC2_V1_8814B(x) ((x) & (~BITS_DARF_RC2_V1_8814B)) -+#define BIT_GET_DARF_RC2_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC2_V1_8814B) & BIT_MASK_DARF_RC2_V1_8814B) -+#define BIT_SET_DARF_RC2_V1_8814B(x, v) \ -+ (BIT_CLEAR_DARF_RC2_V1_8814B(x) | BIT_DARF_RC2_V1_8814B(v)) -+ -+#define BIT_SHIFT_DARF_RC1_V1_8814B 0 -+#define BIT_MASK_DARF_RC1_V1_8814B 0x3f -+#define BIT_DARF_RC1_V1_8814B(x) \ -+ (((x) & BIT_MASK_DARF_RC1_V1_8814B) << BIT_SHIFT_DARF_RC1_V1_8814B) -+#define BITS_DARF_RC1_V1_8814B \ -+ (BIT_MASK_DARF_RC1_V1_8814B << BIT_SHIFT_DARF_RC1_V1_8814B) -+#define BIT_CLEAR_DARF_RC1_V1_8814B(x) ((x) & (~BITS_DARF_RC1_V1_8814B)) -+#define BIT_GET_DARF_RC1_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC1_V1_8814B) & BIT_MASK_DARF_RC1_V1_8814B) -+#define BIT_SET_DARF_RC1_V1_8814B(x, v) \ -+ (BIT_CLEAR_DARF_RC1_V1_8814B(x) | BIT_DARF_RC1_V1_8814B(v)) -+ -+/* 2 REG_DARFRCH_8814B */ -+ -+#define BIT_SHIFT_DARF_RC8_V2_8814B 24 -+#define BIT_MASK_DARF_RC8_V2_8814B 0x3f -+#define BIT_DARF_RC8_V2_8814B(x) \ -+ (((x) & BIT_MASK_DARF_RC8_V2_8814B) << BIT_SHIFT_DARF_RC8_V2_8814B) -+#define BITS_DARF_RC8_V2_8814B \ -+ (BIT_MASK_DARF_RC8_V2_8814B << BIT_SHIFT_DARF_RC8_V2_8814B) -+#define BIT_CLEAR_DARF_RC8_V2_8814B(x) ((x) & (~BITS_DARF_RC8_V2_8814B)) -+#define BIT_GET_DARF_RC8_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC8_V2_8814B) & BIT_MASK_DARF_RC8_V2_8814B) -+#define BIT_SET_DARF_RC8_V2_8814B(x, v) \ -+ (BIT_CLEAR_DARF_RC8_V2_8814B(x) | BIT_DARF_RC8_V2_8814B(v)) -+ -+#define BIT_SHIFT_DARF_RC7_V2_8814B 16 -+#define BIT_MASK_DARF_RC7_V2_8814B 0x3f -+#define BIT_DARF_RC7_V2_8814B(x) \ -+ (((x) & BIT_MASK_DARF_RC7_V2_8814B) << BIT_SHIFT_DARF_RC7_V2_8814B) -+#define BITS_DARF_RC7_V2_8814B \ -+ (BIT_MASK_DARF_RC7_V2_8814B << BIT_SHIFT_DARF_RC7_V2_8814B) -+#define BIT_CLEAR_DARF_RC7_V2_8814B(x) ((x) & (~BITS_DARF_RC7_V2_8814B)) -+#define BIT_GET_DARF_RC7_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC7_V2_8814B) & BIT_MASK_DARF_RC7_V2_8814B) -+#define BIT_SET_DARF_RC7_V2_8814B(x, v) \ -+ (BIT_CLEAR_DARF_RC7_V2_8814B(x) | BIT_DARF_RC7_V2_8814B(v)) -+ -+#define BIT_SHIFT_DARF_RC6_V2_8814B 8 -+#define BIT_MASK_DARF_RC6_V2_8814B 0x3f -+#define BIT_DARF_RC6_V2_8814B(x) \ -+ (((x) & BIT_MASK_DARF_RC6_V2_8814B) << BIT_SHIFT_DARF_RC6_V2_8814B) -+#define BITS_DARF_RC6_V2_8814B \ -+ (BIT_MASK_DARF_RC6_V2_8814B << BIT_SHIFT_DARF_RC6_V2_8814B) -+#define BIT_CLEAR_DARF_RC6_V2_8814B(x) ((x) & (~BITS_DARF_RC6_V2_8814B)) -+#define BIT_GET_DARF_RC6_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC6_V2_8814B) & BIT_MASK_DARF_RC6_V2_8814B) -+#define BIT_SET_DARF_RC6_V2_8814B(x, v) \ -+ (BIT_CLEAR_DARF_RC6_V2_8814B(x) | BIT_DARF_RC6_V2_8814B(v)) -+ -+#define BIT_SHIFT_DARF_RC5_V2_8814B 0 -+#define BIT_MASK_DARF_RC5_V2_8814B 0x3f -+#define BIT_DARF_RC5_V2_8814B(x) \ -+ (((x) & BIT_MASK_DARF_RC5_V2_8814B) << BIT_SHIFT_DARF_RC5_V2_8814B) -+#define BITS_DARF_RC5_V2_8814B \ -+ (BIT_MASK_DARF_RC5_V2_8814B << BIT_SHIFT_DARF_RC5_V2_8814B) -+#define BIT_CLEAR_DARF_RC5_V2_8814B(x) ((x) & (~BITS_DARF_RC5_V2_8814B)) -+#define BIT_GET_DARF_RC5_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC5_V2_8814B) & BIT_MASK_DARF_RC5_V2_8814B) -+#define BIT_SET_DARF_RC5_V2_8814B(x, v) \ -+ (BIT_CLEAR_DARF_RC5_V2_8814B(x) | BIT_DARF_RC5_V2_8814B(v)) -+ -+/* 2 REG_RARFRC_8814B */ -+ -+#define BIT_SHIFT_RARF_RC4_8814B 24 -+#define BIT_MASK_RARF_RC4_8814B 0x1f -+#define BIT_RARF_RC4_8814B(x) \ -+ (((x) & BIT_MASK_RARF_RC4_8814B) << BIT_SHIFT_RARF_RC4_8814B) -+#define BITS_RARF_RC4_8814B \ -+ (BIT_MASK_RARF_RC4_8814B << BIT_SHIFT_RARF_RC4_8814B) -+#define BIT_CLEAR_RARF_RC4_8814B(x) ((x) & (~BITS_RARF_RC4_8814B)) -+#define BIT_GET_RARF_RC4_8814B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC4_8814B) & BIT_MASK_RARF_RC4_8814B) -+#define BIT_SET_RARF_RC4_8814B(x, v) \ -+ (BIT_CLEAR_RARF_RC4_8814B(x) | BIT_RARF_RC4_8814B(v)) -+ -+#define BIT_SHIFT_RARF_RC3_8814B 16 -+#define BIT_MASK_RARF_RC3_8814B 0x1f -+#define BIT_RARF_RC3_8814B(x) \ -+ (((x) & BIT_MASK_RARF_RC3_8814B) << BIT_SHIFT_RARF_RC3_8814B) -+#define BITS_RARF_RC3_8814B \ -+ (BIT_MASK_RARF_RC3_8814B << BIT_SHIFT_RARF_RC3_8814B) -+#define BIT_CLEAR_RARF_RC3_8814B(x) ((x) & (~BITS_RARF_RC3_8814B)) -+#define BIT_GET_RARF_RC3_8814B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC3_8814B) & BIT_MASK_RARF_RC3_8814B) -+#define BIT_SET_RARF_RC3_8814B(x, v) \ -+ (BIT_CLEAR_RARF_RC3_8814B(x) | BIT_RARF_RC3_8814B(v)) -+ -+#define BIT_SHIFT_RARF_RC2_8814B 8 -+#define BIT_MASK_RARF_RC2_8814B 0x1f -+#define BIT_RARF_RC2_8814B(x) \ -+ (((x) & BIT_MASK_RARF_RC2_8814B) << BIT_SHIFT_RARF_RC2_8814B) -+#define BITS_RARF_RC2_8814B \ -+ (BIT_MASK_RARF_RC2_8814B << BIT_SHIFT_RARF_RC2_8814B) -+#define BIT_CLEAR_RARF_RC2_8814B(x) ((x) & (~BITS_RARF_RC2_8814B)) -+#define BIT_GET_RARF_RC2_8814B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC2_8814B) & BIT_MASK_RARF_RC2_8814B) -+#define BIT_SET_RARF_RC2_8814B(x, v) \ -+ (BIT_CLEAR_RARF_RC2_8814B(x) | BIT_RARF_RC2_8814B(v)) -+ -+#define BIT_SHIFT_RARF_RC1_8814B 0 -+#define BIT_MASK_RARF_RC1_8814B 0x1f -+#define BIT_RARF_RC1_8814B(x) \ -+ (((x) & BIT_MASK_RARF_RC1_8814B) << BIT_SHIFT_RARF_RC1_8814B) -+#define BITS_RARF_RC1_8814B \ -+ (BIT_MASK_RARF_RC1_8814B << BIT_SHIFT_RARF_RC1_8814B) -+#define BIT_CLEAR_RARF_RC1_8814B(x) ((x) & (~BITS_RARF_RC1_8814B)) -+#define BIT_GET_RARF_RC1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC1_8814B) & BIT_MASK_RARF_RC1_8814B) -+#define BIT_SET_RARF_RC1_8814B(x, v) \ -+ (BIT_CLEAR_RARF_RC1_8814B(x) | BIT_RARF_RC1_8814B(v)) -+ -+/* 2 REG_RARFRCH_8814B */ -+ -+#define BIT_SHIFT_RARF_RC8_V1_8814B 24 -+#define BIT_MASK_RARF_RC8_V1_8814B 0x1f -+#define BIT_RARF_RC8_V1_8814B(x) \ -+ (((x) & BIT_MASK_RARF_RC8_V1_8814B) << BIT_SHIFT_RARF_RC8_V1_8814B) -+#define BITS_RARF_RC8_V1_8814B \ -+ (BIT_MASK_RARF_RC8_V1_8814B << BIT_SHIFT_RARF_RC8_V1_8814B) -+#define BIT_CLEAR_RARF_RC8_V1_8814B(x) ((x) & (~BITS_RARF_RC8_V1_8814B)) -+#define BIT_GET_RARF_RC8_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC8_V1_8814B) & BIT_MASK_RARF_RC8_V1_8814B) -+#define BIT_SET_RARF_RC8_V1_8814B(x, v) \ -+ (BIT_CLEAR_RARF_RC8_V1_8814B(x) | BIT_RARF_RC8_V1_8814B(v)) -+ -+#define BIT_SHIFT_RARF_RC7_V1_8814B 16 -+#define BIT_MASK_RARF_RC7_V1_8814B 0x1f -+#define BIT_RARF_RC7_V1_8814B(x) \ -+ (((x) & BIT_MASK_RARF_RC7_V1_8814B) << BIT_SHIFT_RARF_RC7_V1_8814B) -+#define BITS_RARF_RC7_V1_8814B \ -+ (BIT_MASK_RARF_RC7_V1_8814B << BIT_SHIFT_RARF_RC7_V1_8814B) -+#define BIT_CLEAR_RARF_RC7_V1_8814B(x) ((x) & (~BITS_RARF_RC7_V1_8814B)) -+#define BIT_GET_RARF_RC7_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC7_V1_8814B) & BIT_MASK_RARF_RC7_V1_8814B) -+#define BIT_SET_RARF_RC7_V1_8814B(x, v) \ -+ (BIT_CLEAR_RARF_RC7_V1_8814B(x) | BIT_RARF_RC7_V1_8814B(v)) -+ -+#define BIT_SHIFT_RARF_RC6_V1_8814B 8 -+#define BIT_MASK_RARF_RC6_V1_8814B 0x1f -+#define BIT_RARF_RC6_V1_8814B(x) \ -+ (((x) & BIT_MASK_RARF_RC6_V1_8814B) << BIT_SHIFT_RARF_RC6_V1_8814B) -+#define BITS_RARF_RC6_V1_8814B \ -+ (BIT_MASK_RARF_RC6_V1_8814B << BIT_SHIFT_RARF_RC6_V1_8814B) -+#define BIT_CLEAR_RARF_RC6_V1_8814B(x) ((x) & (~BITS_RARF_RC6_V1_8814B)) -+#define BIT_GET_RARF_RC6_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC6_V1_8814B) & BIT_MASK_RARF_RC6_V1_8814B) -+#define BIT_SET_RARF_RC6_V1_8814B(x, v) \ -+ (BIT_CLEAR_RARF_RC6_V1_8814B(x) | BIT_RARF_RC6_V1_8814B(v)) -+ -+#define BIT_SHIFT_RARF_RC5_V1_8814B 0 -+#define BIT_MASK_RARF_RC5_V1_8814B 0x1f -+#define BIT_RARF_RC5_V1_8814B(x) \ -+ (((x) & BIT_MASK_RARF_RC5_V1_8814B) << BIT_SHIFT_RARF_RC5_V1_8814B) -+#define BITS_RARF_RC5_V1_8814B \ -+ (BIT_MASK_RARF_RC5_V1_8814B << BIT_SHIFT_RARF_RC5_V1_8814B) -+#define BIT_CLEAR_RARF_RC5_V1_8814B(x) ((x) & (~BITS_RARF_RC5_V1_8814B)) -+#define BIT_GET_RARF_RC5_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC5_V1_8814B) & BIT_MASK_RARF_RC5_V1_8814B) -+#define BIT_SET_RARF_RC5_V1_8814B(x, v) \ -+ (BIT_CLEAR_RARF_RC5_V1_8814B(x) | BIT_RARF_RC5_V1_8814B(v)) -+ -+/* 2 REG_RRSR_8814B */ -+ -+#define BIT_SHIFT_RRSR_RSC_8814B 21 -+#define BIT_MASK_RRSR_RSC_8814B 0x3 -+#define BIT_RRSR_RSC_8814B(x) \ -+ (((x) & BIT_MASK_RRSR_RSC_8814B) << BIT_SHIFT_RRSR_RSC_8814B) -+#define BITS_RRSR_RSC_8814B \ -+ (BIT_MASK_RRSR_RSC_8814B << BIT_SHIFT_RRSR_RSC_8814B) -+#define BIT_CLEAR_RRSR_RSC_8814B(x) ((x) & (~BITS_RRSR_RSC_8814B)) -+#define BIT_GET_RRSR_RSC_8814B(x) \ -+ (((x) >> BIT_SHIFT_RRSR_RSC_8814B) & BIT_MASK_RRSR_RSC_8814B) -+#define BIT_SET_RRSR_RSC_8814B(x, v) \ -+ (BIT_CLEAR_RRSR_RSC_8814B(x) | BIT_RRSR_RSC_8814B(v)) -+ -+#define BIT_SHIFT_RRSC_BITMAP_8814B 0 -+#define BIT_MASK_RRSC_BITMAP_8814B 0xfffff -+#define BIT_RRSC_BITMAP_8814B(x) \ -+ (((x) & BIT_MASK_RRSC_BITMAP_8814B) << BIT_SHIFT_RRSC_BITMAP_8814B) -+#define BITS_RRSC_BITMAP_8814B \ -+ (BIT_MASK_RRSC_BITMAP_8814B << BIT_SHIFT_RRSC_BITMAP_8814B) -+#define BIT_CLEAR_RRSC_BITMAP_8814B(x) ((x) & (~BITS_RRSC_BITMAP_8814B)) -+#define BIT_GET_RRSC_BITMAP_8814B(x) \ -+ (((x) >> BIT_SHIFT_RRSC_BITMAP_8814B) & BIT_MASK_RRSC_BITMAP_8814B) -+#define BIT_SET_RRSC_BITMAP_8814B(x, v) \ -+ (BIT_CLEAR_RRSC_BITMAP_8814B(x) | BIT_RRSC_BITMAP_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_ARFR0_8814B */ -+ -+#define BIT_SHIFT_ARFRL0_8814B 0 -+#define BIT_MASK_ARFRL0_8814B 0xffffffffL -+#define BIT_ARFRL0_8814B(x) \ -+ (((x) & BIT_MASK_ARFRL0_8814B) << BIT_SHIFT_ARFRL0_8814B) -+#define BITS_ARFRL0_8814B (BIT_MASK_ARFRL0_8814B << BIT_SHIFT_ARFRL0_8814B) -+#define BIT_CLEAR_ARFRL0_8814B(x) ((x) & (~BITS_ARFRL0_8814B)) -+#define BIT_GET_ARFRL0_8814B(x) \ -+ (((x) >> BIT_SHIFT_ARFRL0_8814B) & BIT_MASK_ARFRL0_8814B) -+#define BIT_SET_ARFRL0_8814B(x, v) \ -+ (BIT_CLEAR_ARFRL0_8814B(x) | BIT_ARFRL0_8814B(v)) -+ -+/* 2 REG_ARFRH0_8814B */ -+ -+#define BIT_SHIFT_ARFRH0_8814B 0 -+#define BIT_MASK_ARFRH0_8814B 0xffffffffL -+#define BIT_ARFRH0_8814B(x) \ -+ (((x) & BIT_MASK_ARFRH0_8814B) << BIT_SHIFT_ARFRH0_8814B) -+#define BITS_ARFRH0_8814B (BIT_MASK_ARFRH0_8814B << BIT_SHIFT_ARFRH0_8814B) -+#define BIT_CLEAR_ARFRH0_8814B(x) ((x) & (~BITS_ARFRH0_8814B)) -+#define BIT_GET_ARFRH0_8814B(x) \ -+ (((x) >> BIT_SHIFT_ARFRH0_8814B) & BIT_MASK_ARFRH0_8814B) -+#define BIT_SET_ARFRH0_8814B(x, v) \ -+ (BIT_CLEAR_ARFRH0_8814B(x) | BIT_ARFRH0_8814B(v)) -+ -+/* 2 REG_REG_ARFR_WT0_8814B */ -+ -+#define BIT_SHIFT_RATE7_WEIGHTING_8814B 28 -+#define BIT_MASK_RATE7_WEIGHTING_8814B 0xf -+#define BIT_RATE7_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE7_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE7_WEIGHTING_8814B) -+#define BITS_RATE7_WEIGHTING_8814B \ -+ (BIT_MASK_RATE7_WEIGHTING_8814B << BIT_SHIFT_RATE7_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE7_WEIGHTING_8814B(x) ((x) & (~BITS_RATE7_WEIGHTING_8814B)) -+#define BIT_GET_RATE7_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE7_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE7_WEIGHTING_8814B) -+#define BIT_SET_RATE7_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE7_WEIGHTING_8814B(x) | BIT_RATE7_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE6_WEIGHTING_8814B 24 -+#define BIT_MASK_RATE6_WEIGHTING_8814B 0xf -+#define BIT_RATE6_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE6_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE6_WEIGHTING_8814B) -+#define BITS_RATE6_WEIGHTING_8814B \ -+ (BIT_MASK_RATE6_WEIGHTING_8814B << BIT_SHIFT_RATE6_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE6_WEIGHTING_8814B(x) ((x) & (~BITS_RATE6_WEIGHTING_8814B)) -+#define BIT_GET_RATE6_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE6_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE6_WEIGHTING_8814B) -+#define BIT_SET_RATE6_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE6_WEIGHTING_8814B(x) | BIT_RATE6_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE5_WEIGHTING_8814B 20 -+#define BIT_MASK_RATE5_WEIGHTING_8814B 0xf -+#define BIT_RATE5_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE5_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE5_WEIGHTING_8814B) -+#define BITS_RATE5_WEIGHTING_8814B \ -+ (BIT_MASK_RATE5_WEIGHTING_8814B << BIT_SHIFT_RATE5_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE5_WEIGHTING_8814B(x) ((x) & (~BITS_RATE5_WEIGHTING_8814B)) -+#define BIT_GET_RATE5_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE5_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE5_WEIGHTING_8814B) -+#define BIT_SET_RATE5_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE5_WEIGHTING_8814B(x) | BIT_RATE5_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE4_WEIGHTING_8814B 16 -+#define BIT_MASK_RATE4_WEIGHTING_8814B 0xf -+#define BIT_RATE4_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE4_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE4_WEIGHTING_8814B) -+#define BITS_RATE4_WEIGHTING_8814B \ -+ (BIT_MASK_RATE4_WEIGHTING_8814B << BIT_SHIFT_RATE4_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE4_WEIGHTING_8814B(x) ((x) & (~BITS_RATE4_WEIGHTING_8814B)) -+#define BIT_GET_RATE4_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE4_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE4_WEIGHTING_8814B) -+#define BIT_SET_RATE4_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE4_WEIGHTING_8814B(x) | BIT_RATE4_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE3_WEIGHTING_8814B 12 -+#define BIT_MASK_RATE3_WEIGHTING_8814B 0xf -+#define BIT_RATE3_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE3_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE3_WEIGHTING_8814B) -+#define BITS_RATE3_WEIGHTING_8814B \ -+ (BIT_MASK_RATE3_WEIGHTING_8814B << BIT_SHIFT_RATE3_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE3_WEIGHTING_8814B(x) ((x) & (~BITS_RATE3_WEIGHTING_8814B)) -+#define BIT_GET_RATE3_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE3_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE3_WEIGHTING_8814B) -+#define BIT_SET_RATE3_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE3_WEIGHTING_8814B(x) | BIT_RATE3_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE2_WEIGHTING_8814B 8 -+#define BIT_MASK_RATE2_WEIGHTING_8814B 0xf -+#define BIT_RATE2_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE2_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE2_WEIGHTING_8814B) -+#define BITS_RATE2_WEIGHTING_8814B \ -+ (BIT_MASK_RATE2_WEIGHTING_8814B << BIT_SHIFT_RATE2_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE2_WEIGHTING_8814B(x) ((x) & (~BITS_RATE2_WEIGHTING_8814B)) -+#define BIT_GET_RATE2_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE2_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE2_WEIGHTING_8814B) -+#define BIT_SET_RATE2_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE2_WEIGHTING_8814B(x) | BIT_RATE2_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE1_WEIGHTING_8814B 4 -+#define BIT_MASK_RATE1_WEIGHTING_8814B 0xf -+#define BIT_RATE1_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE1_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE1_WEIGHTING_8814B) -+#define BITS_RATE1_WEIGHTING_8814B \ -+ (BIT_MASK_RATE1_WEIGHTING_8814B << BIT_SHIFT_RATE1_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE1_WEIGHTING_8814B(x) ((x) & (~BITS_RATE1_WEIGHTING_8814B)) -+#define BIT_GET_RATE1_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE1_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE1_WEIGHTING_8814B) -+#define BIT_SET_RATE1_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE1_WEIGHTING_8814B(x) | BIT_RATE1_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE0_WEIGHTING_8814B 0 -+#define BIT_MASK_RATE0_WEIGHTING_8814B 0xf -+#define BIT_RATE0_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE0_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE0_WEIGHTING_8814B) -+#define BITS_RATE0_WEIGHTING_8814B \ -+ (BIT_MASK_RATE0_WEIGHTING_8814B << BIT_SHIFT_RATE0_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE0_WEIGHTING_8814B(x) ((x) & (~BITS_RATE0_WEIGHTING_8814B)) -+#define BIT_GET_RATE0_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE0_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE0_WEIGHTING_8814B) -+#define BIT_SET_RATE0_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE0_WEIGHTING_8814B(x) | BIT_RATE0_WEIGHTING_8814B(v)) -+ -+/* 2 REG_REG_ARFR_WT1_8814B */ -+ -+#define BIT_SHIFT_RATE15_WEIGHTING_8814B 28 -+#define BIT_MASK_RATE15_WEIGHTING_8814B 0xf -+#define BIT_RATE15_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE15_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE15_WEIGHTING_8814B) -+#define BITS_RATE15_WEIGHTING_8814B \ -+ (BIT_MASK_RATE15_WEIGHTING_8814B << BIT_SHIFT_RATE15_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE15_WEIGHTING_8814B(x) \ -+ ((x) & (~BITS_RATE15_WEIGHTING_8814B)) -+#define BIT_GET_RATE15_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE15_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE15_WEIGHTING_8814B) -+#define BIT_SET_RATE15_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE15_WEIGHTING_8814B(x) | BIT_RATE15_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE14_WEIGHTING_8814B 24 -+#define BIT_MASK_RATE14_WEIGHTING_8814B 0xf -+#define BIT_RATE14_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE14_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE14_WEIGHTING_8814B) -+#define BITS_RATE14_WEIGHTING_8814B \ -+ (BIT_MASK_RATE14_WEIGHTING_8814B << BIT_SHIFT_RATE14_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE14_WEIGHTING_8814B(x) \ -+ ((x) & (~BITS_RATE14_WEIGHTING_8814B)) -+#define BIT_GET_RATE14_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE14_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE14_WEIGHTING_8814B) -+#define BIT_SET_RATE14_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE14_WEIGHTING_8814B(x) | BIT_RATE14_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE13_WEIGHTING_8814B 20 -+#define BIT_MASK_RATE13_WEIGHTING_8814B 0xf -+#define BIT_RATE13_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE13_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE13_WEIGHTING_8814B) -+#define BITS_RATE13_WEIGHTING_8814B \ -+ (BIT_MASK_RATE13_WEIGHTING_8814B << BIT_SHIFT_RATE13_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE13_WEIGHTING_8814B(x) \ -+ ((x) & (~BITS_RATE13_WEIGHTING_8814B)) -+#define BIT_GET_RATE13_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE13_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE13_WEIGHTING_8814B) -+#define BIT_SET_RATE13_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE13_WEIGHTING_8814B(x) | BIT_RATE13_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE12_WEIGHTING_8814B 16 -+#define BIT_MASK_RATE12_WEIGHTING_8814B 0xf -+#define BIT_RATE12_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE12_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE12_WEIGHTING_8814B) -+#define BITS_RATE12_WEIGHTING_8814B \ -+ (BIT_MASK_RATE12_WEIGHTING_8814B << BIT_SHIFT_RATE12_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE12_WEIGHTING_8814B(x) \ -+ ((x) & (~BITS_RATE12_WEIGHTING_8814B)) -+#define BIT_GET_RATE12_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE12_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE12_WEIGHTING_8814B) -+#define BIT_SET_RATE12_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE12_WEIGHTING_8814B(x) | BIT_RATE12_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE11_WEIGHTING_8814B 12 -+#define BIT_MASK_RATE11_WEIGHTING_8814B 0xf -+#define BIT_RATE11_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE11_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE11_WEIGHTING_8814B) -+#define BITS_RATE11_WEIGHTING_8814B \ -+ (BIT_MASK_RATE11_WEIGHTING_8814B << BIT_SHIFT_RATE11_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE11_WEIGHTING_8814B(x) \ -+ ((x) & (~BITS_RATE11_WEIGHTING_8814B)) -+#define BIT_GET_RATE11_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE11_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE11_WEIGHTING_8814B) -+#define BIT_SET_RATE11_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE11_WEIGHTING_8814B(x) | BIT_RATE11_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE10_WEIGHTING_8814B 8 -+#define BIT_MASK_RATE10_WEIGHTING_8814B 0xf -+#define BIT_RATE10_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE10_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE10_WEIGHTING_8814B) -+#define BITS_RATE10_WEIGHTING_8814B \ -+ (BIT_MASK_RATE10_WEIGHTING_8814B << BIT_SHIFT_RATE10_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE10_WEIGHTING_8814B(x) \ -+ ((x) & (~BITS_RATE10_WEIGHTING_8814B)) -+#define BIT_GET_RATE10_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE10_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE10_WEIGHTING_8814B) -+#define BIT_SET_RATE10_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE10_WEIGHTING_8814B(x) | BIT_RATE10_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE9_WEIGHTING_8814B 4 -+#define BIT_MASK_RATE9_WEIGHTING_8814B 0xf -+#define BIT_RATE9_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE9_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE9_WEIGHTING_8814B) -+#define BITS_RATE9_WEIGHTING_8814B \ -+ (BIT_MASK_RATE9_WEIGHTING_8814B << BIT_SHIFT_RATE9_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE9_WEIGHTING_8814B(x) ((x) & (~BITS_RATE9_WEIGHTING_8814B)) -+#define BIT_GET_RATE9_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE9_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE9_WEIGHTING_8814B) -+#define BIT_SET_RATE9_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE9_WEIGHTING_8814B(x) | BIT_RATE9_WEIGHTING_8814B(v)) -+ -+#define BIT_SHIFT_RATE8_WEIGHTING_8814B 0 -+#define BIT_MASK_RATE8_WEIGHTING_8814B 0xf -+#define BIT_RATE8_WEIGHTING_8814B(x) \ -+ (((x) & BIT_MASK_RATE8_WEIGHTING_8814B) \ -+ << BIT_SHIFT_RATE8_WEIGHTING_8814B) -+#define BITS_RATE8_WEIGHTING_8814B \ -+ (BIT_MASK_RATE8_WEIGHTING_8814B << BIT_SHIFT_RATE8_WEIGHTING_8814B) -+#define BIT_CLEAR_RATE8_WEIGHTING_8814B(x) ((x) & (~BITS_RATE8_WEIGHTING_8814B)) -+#define BIT_GET_RATE8_WEIGHTING_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE8_WEIGHTING_8814B) & \ -+ BIT_MASK_RATE8_WEIGHTING_8814B) -+#define BIT_SET_RATE8_WEIGHTING_8814B(x, v) \ -+ (BIT_CLEAR_RATE8_WEIGHTING_8814B(x) | BIT_RATE8_WEIGHTING_8814B(v)) -+ -+/* 2 REG_CCK_CHECK_8814B */ -+#define BIT_CHECK_CCK_EN_8814B BIT(7) -+#define BIT_EN_BCN_PKT_REL_P0_8814B BIT(6) -+#define BIT_BCN_PORT_SEL_8814B BIT(5) -+#define BIT_MOREDATA_BYPASS_8814B BIT(4) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_P0_8814B BIT(3) -+#define BIT_EN_SET_MOREDATA_8814B BIT(2) -+#define BIT__R_DIS_CLEAR_MACID_RELEASE_8814B BIT(1) -+#define BIT__R_MACID_RELEASE_EN_8814B BIT(0) -+ -+/* 2 REG_AMPDU_MAX_TIME_V1_8814B */ -+ -+#define BIT_SHIFT_AMPDU_MAX_TIME_8814B 0 -+#define BIT_MASK_AMPDU_MAX_TIME_8814B 0xff -+#define BIT_AMPDU_MAX_TIME_8814B(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_TIME_8814B) \ -+ << BIT_SHIFT_AMPDU_MAX_TIME_8814B) -+#define BITS_AMPDU_MAX_TIME_8814B \ -+ (BIT_MASK_AMPDU_MAX_TIME_8814B << BIT_SHIFT_AMPDU_MAX_TIME_8814B) -+#define BIT_CLEAR_AMPDU_MAX_TIME_8814B(x) ((x) & (~BITS_AMPDU_MAX_TIME_8814B)) -+#define BIT_GET_AMPDU_MAX_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_TIME_8814B) & \ -+ BIT_MASK_AMPDU_MAX_TIME_8814B) -+#define BIT_SET_AMPDU_MAX_TIME_8814B(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_TIME_8814B(x) | BIT_AMPDU_MAX_TIME_8814B(v)) -+ -+/* 2 REG_TAB_SEL_8814B */ -+ -+#define BIT_SHIFT_RATE_SEL_8814B 0 -+#define BIT_MASK_RATE_SEL_8814B 0xf -+#define BIT_RATE_SEL_8814B(x) \ -+ (((x) & BIT_MASK_RATE_SEL_8814B) << BIT_SHIFT_RATE_SEL_8814B) -+#define BITS_RATE_SEL_8814B \ -+ (BIT_MASK_RATE_SEL_8814B << BIT_SHIFT_RATE_SEL_8814B) -+#define BIT_CLEAR_RATE_SEL_8814B(x) ((x) & (~BITS_RATE_SEL_8814B)) -+#define BIT_GET_RATE_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_RATE_SEL_8814B) & BIT_MASK_RATE_SEL_8814B) -+#define BIT_SET_RATE_SEL_8814B(x, v) \ -+ (BIT_CLEAR_RATE_SEL_8814B(x) | BIT_RATE_SEL_8814B(v)) -+ -+/* 2 REG_BCN_INVALID_CTRL_8814B */ -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_P4_8814B BIT(7) -+#define BIT_EN_BCN_PKT_REL_P4_8814B BIT(6) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_P3_8814B BIT(5) -+#define BIT_EN_BCN_PKT_REL_P3_8814B BIT(4) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_P2_8814B BIT(3) -+#define BIT_EN_BCN_PKT_REL_P2_8814B BIT(2) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_P1_8814B BIT(1) -+#define BIT_EN_BCN_PKT_REL_P1_8814B BIT(0) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_HT_8814B */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8814B 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_HT_8814B 0xffff -+#define BIT_AMPDU_MAX_LENGTH_HT_8814B(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_HT_8814B) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8814B) -+#define BITS_AMPDU_MAX_LENGTH_HT_8814B \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_HT_8814B \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8814B) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_HT_8814B(x) \ -+ ((x) & (~BITS_AMPDU_MAX_LENGTH_HT_8814B)) -+#define BIT_GET_AMPDU_MAX_LENGTH_HT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8814B) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_HT_8814B) -+#define BIT_SET_AMPDU_MAX_LENGTH_HT_8814B(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_HT_8814B(x) | \ -+ BIT_AMPDU_MAX_LENGTH_HT_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NDPA_RATE_8814B */ -+ -+#define BIT_SHIFT_R_NDPA_RATE_V1_8814B 0 -+#define BIT_MASK_R_NDPA_RATE_V1_8814B 0xff -+#define BIT_R_NDPA_RATE_V1_8814B(x) \ -+ (((x) & BIT_MASK_R_NDPA_RATE_V1_8814B) \ -+ << BIT_SHIFT_R_NDPA_RATE_V1_8814B) -+#define BITS_R_NDPA_RATE_V1_8814B \ -+ (BIT_MASK_R_NDPA_RATE_V1_8814B << BIT_SHIFT_R_NDPA_RATE_V1_8814B) -+#define BIT_CLEAR_R_NDPA_RATE_V1_8814B(x) ((x) & (~BITS_R_NDPA_RATE_V1_8814B)) -+#define BIT_GET_R_NDPA_RATE_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_RATE_V1_8814B) & \ -+ BIT_MASK_R_NDPA_RATE_V1_8814B) -+#define BIT_SET_R_NDPA_RATE_V1_8814B(x, v) \ -+ (BIT_CLEAR_R_NDPA_RATE_V1_8814B(x) | BIT_R_NDPA_RATE_V1_8814B(v)) -+ -+/* 2 REG_TX_HANG_CTRL_8814B */ -+#define BIT_EN_GNT_BT_AWAKE_8814B BIT(3) -+#define BIT_EN_EOF_V1_8814B BIT(2) -+#define BIT_DIS_OQT_BLOCK_8814B BIT(1) -+#define BIT_SEARCH_QUEUE_EN_8814B BIT(0) -+ -+/* 2 REG_NDPA_OPT_CTRL_8814B */ -+#define BIT_DIS_MACID_RELEASE_RTY_8814B BIT(5) -+ -+#define BIT_SHIFT_BW_SIGTA_8814B 3 -+#define BIT_MASK_BW_SIGTA_8814B 0x3 -+#define BIT_BW_SIGTA_8814B(x) \ -+ (((x) & BIT_MASK_BW_SIGTA_8814B) << BIT_SHIFT_BW_SIGTA_8814B) -+#define BITS_BW_SIGTA_8814B \ -+ (BIT_MASK_BW_SIGTA_8814B << BIT_SHIFT_BW_SIGTA_8814B) -+#define BIT_CLEAR_BW_SIGTA_8814B(x) ((x) & (~BITS_BW_SIGTA_8814B)) -+#define BIT_GET_BW_SIGTA_8814B(x) \ -+ (((x) >> BIT_SHIFT_BW_SIGTA_8814B) & BIT_MASK_BW_SIGTA_8814B) -+#define BIT_SET_BW_SIGTA_8814B(x, v) \ -+ (BIT_CLEAR_BW_SIGTA_8814B(x) | BIT_BW_SIGTA_8814B(v)) -+ -+#define BIT_EN_BAR_SIGTA_8814B BIT(2) -+ -+#define BIT_SHIFT_NDPA_BW_8814B 0 -+#define BIT_MASK_NDPA_BW_8814B 0x3 -+#define BIT_NDPA_BW_8814B(x) \ -+ (((x) & BIT_MASK_NDPA_BW_8814B) << BIT_SHIFT_NDPA_BW_8814B) -+#define BITS_NDPA_BW_8814B (BIT_MASK_NDPA_BW_8814B << BIT_SHIFT_NDPA_BW_8814B) -+#define BIT_CLEAR_NDPA_BW_8814B(x) ((x) & (~BITS_NDPA_BW_8814B)) -+#define BIT_GET_NDPA_BW_8814B(x) \ -+ (((x) >> BIT_SHIFT_NDPA_BW_8814B) & BIT_MASK_NDPA_BW_8814B) -+#define BIT_SET_NDPA_BW_8814B(x, v) \ -+ (BIT_CLEAR_NDPA_BW_8814B(x) | BIT_NDPA_BW_8814B(v)) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_VHT_8814B */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_8814B 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_VHT_8814B 0x3ffff -+#define BIT_AMPDU_MAX_LENGTH_VHT_8814B(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_VHT_8814B) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_8814B) -+#define BITS_AMPDU_MAX_LENGTH_VHT_8814B \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_VHT_8814B \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_8814B) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_VHT_8814B(x) \ -+ ((x) & (~BITS_AMPDU_MAX_LENGTH_VHT_8814B)) -+#define BIT_GET_AMPDU_MAX_LENGTH_VHT_8814B(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_8814B) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_VHT_8814B) -+#define BIT_SET_AMPDU_MAX_LENGTH_VHT_8814B(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_VHT_8814B(x) | \ -+ BIT_AMPDU_MAX_LENGTH_VHT_8814B(v)) -+ -+/* 2 REG_RD_RESP_PKT_TH_8814B */ -+ -+#define BIT_SHIFT_RD_RESP_PKT_TH_V1_8814B 0 -+#define BIT_MASK_RD_RESP_PKT_TH_V1_8814B 0x3f -+#define BIT_RD_RESP_PKT_TH_V1_8814B(x) \ -+ (((x) & BIT_MASK_RD_RESP_PKT_TH_V1_8814B) \ -+ << BIT_SHIFT_RD_RESP_PKT_TH_V1_8814B) -+#define BITS_RD_RESP_PKT_TH_V1_8814B \ -+ (BIT_MASK_RD_RESP_PKT_TH_V1_8814B << BIT_SHIFT_RD_RESP_PKT_TH_V1_8814B) -+#define BIT_CLEAR_RD_RESP_PKT_TH_V1_8814B(x) \ -+ ((x) & (~BITS_RD_RESP_PKT_TH_V1_8814B)) -+#define BIT_GET_RD_RESP_PKT_TH_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RD_RESP_PKT_TH_V1_8814B) & \ -+ BIT_MASK_RD_RESP_PKT_TH_V1_8814B) -+#define BIT_SET_RD_RESP_PKT_TH_V1_8814B(x, v) \ -+ (BIT_CLEAR_RD_RESP_PKT_TH_V1_8814B(x) | BIT_RD_RESP_PKT_TH_V1_8814B(v)) -+ -+/* 2 REG_NEW_EDCA_CTRL_V1_8814B */ -+ -+#define BIT_SHIFT_RANDOM_VALUE_SHIFT_8814B 9 -+#define BIT_MASK_RANDOM_VALUE_SHIFT_8814B 0x7 -+#define BIT_RANDOM_VALUE_SHIFT_8814B(x) \ -+ (((x) & BIT_MASK_RANDOM_VALUE_SHIFT_8814B) \ -+ << BIT_SHIFT_RANDOM_VALUE_SHIFT_8814B) -+#define BITS_RANDOM_VALUE_SHIFT_8814B \ -+ (BIT_MASK_RANDOM_VALUE_SHIFT_8814B \ -+ << BIT_SHIFT_RANDOM_VALUE_SHIFT_8814B) -+#define BIT_CLEAR_RANDOM_VALUE_SHIFT_8814B(x) \ -+ ((x) & (~BITS_RANDOM_VALUE_SHIFT_8814B)) -+#define BIT_GET_RANDOM_VALUE_SHIFT_8814B(x) \ -+ (((x) >> BIT_SHIFT_RANDOM_VALUE_SHIFT_8814B) & \ -+ BIT_MASK_RANDOM_VALUE_SHIFT_8814B) -+#define BIT_SET_RANDOM_VALUE_SHIFT_8814B(x, v) \ -+ (BIT_CLEAR_RANDOM_VALUE_SHIFT_8814B(x) | \ -+ BIT_RANDOM_VALUE_SHIFT_8814B(v)) -+ -+#define BIT_ENABLE_NEW_EDCA_8814B BIT(8) -+ -+#define BIT_SHIFT_MEDIUM_HAS_IDKE_TRIGGER_8814B 0 -+#define BIT_MASK_MEDIUM_HAS_IDKE_TRIGGER_8814B 0xff -+#define BIT_MEDIUM_HAS_IDKE_TRIGGER_8814B(x) \ -+ (((x) & BIT_MASK_MEDIUM_HAS_IDKE_TRIGGER_8814B) \ -+ << BIT_SHIFT_MEDIUM_HAS_IDKE_TRIGGER_8814B) -+#define BITS_MEDIUM_HAS_IDKE_TRIGGER_8814B \ -+ (BIT_MASK_MEDIUM_HAS_IDKE_TRIGGER_8814B \ -+ << BIT_SHIFT_MEDIUM_HAS_IDKE_TRIGGER_8814B) -+#define BIT_CLEAR_MEDIUM_HAS_IDKE_TRIGGER_8814B(x) \ -+ ((x) & (~BITS_MEDIUM_HAS_IDKE_TRIGGER_8814B)) -+#define BIT_GET_MEDIUM_HAS_IDKE_TRIGGER_8814B(x) \ -+ (((x) >> BIT_SHIFT_MEDIUM_HAS_IDKE_TRIGGER_8814B) & \ -+ BIT_MASK_MEDIUM_HAS_IDKE_TRIGGER_8814B) -+#define BIT_SET_MEDIUM_HAS_IDKE_TRIGGER_8814B(x, v) \ -+ (BIT_CLEAR_MEDIUM_HAS_IDKE_TRIGGER_8814B(x) | \ -+ BIT_MEDIUM_HAS_IDKE_TRIGGER_8814B(v)) -+ -+/* 2 REG_ACQ_STOP_V2_8814B */ -+#define BIT_AC19Q_STOP_8814B BIT(19) -+#define BIT_AC18Q_STOP_8814B BIT(18) -+#define BIT_AC17Q_STOP_8814B BIT(17) -+#define BIT_AC16Q_STOP_8814B BIT(16) -+#define BIT_AC15Q_STOP_8814B BIT(15) -+#define BIT_AC14Q_STOP_8814B BIT(14) -+#define BIT_AC13Q_STOP_8814B BIT(13) -+#define BIT_AC12Q_STOP_8814B BIT(12) -+#define BIT_AC11Q_STOP_8814B BIT(11) -+#define BIT_AC10Q_STOP_8814B BIT(10) -+#define BIT_AC9Q_STOP_8814B BIT(9) -+#define BIT_AC8Q_STOP_8814B BIT(8) -+#define BIT_AC7Q_STOP_8814B BIT(7) -+#define BIT_AC6Q_STOP_8814B BIT(6) -+#define BIT_AC5Q_STOP_8814B BIT(5) -+#define BIT_AC4Q_STOP_8814B BIT(4) -+#define BIT_AC3Q_STOP_8814B BIT(3) -+#define BIT_AC2Q_STOP_8814B BIT(2) -+#define BIT_AC1Q_STOP_8814B BIT(1) -+#define BIT_AC0Q_STOP_8814B BIT(0) -+ -+/* 2 REG_WMAC_LBK_BUF_HD_V1_8814B */ -+ -+#define BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8814B 0 -+#define BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8814B 0xfff -+#define BIT_WMAC_LBK_BUF_HEAD_V1_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8814B) \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8814B) -+#define BITS_WMAC_LBK_BUF_HEAD_V1_8814B \ -+ (BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8814B \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8814B) -+#define BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8814B(x) \ -+ ((x) & (~BITS_WMAC_LBK_BUF_HEAD_V1_8814B)) -+#define BIT_GET_WMAC_LBK_BUF_HEAD_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8814B) & \ -+ BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8814B) -+#define BIT_SET_WMAC_LBK_BUF_HEAD_V1_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8814B(x) | \ -+ BIT_WMAC_LBK_BUF_HEAD_V1_8814B(v)) -+ -+/* 2 REG_MGQ_BDNY_V1_8814B */ -+ -+#define BIT_SHIFT_MGQ_PGBNDY_V1_8814B 0 -+#define BIT_MASK_MGQ_PGBNDY_V1_8814B 0xfff -+#define BIT_MGQ_PGBNDY_V1_8814B(x) \ -+ (((x) & BIT_MASK_MGQ_PGBNDY_V1_8814B) << BIT_SHIFT_MGQ_PGBNDY_V1_8814B) -+#define BITS_MGQ_PGBNDY_V1_8814B \ -+ (BIT_MASK_MGQ_PGBNDY_V1_8814B << BIT_SHIFT_MGQ_PGBNDY_V1_8814B) -+#define BIT_CLEAR_MGQ_PGBNDY_V1_8814B(x) ((x) & (~BITS_MGQ_PGBNDY_V1_8814B)) -+#define BIT_GET_MGQ_PGBNDY_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PGBNDY_V1_8814B) & BIT_MASK_MGQ_PGBNDY_V1_8814B) -+#define BIT_SET_MGQ_PGBNDY_V1_8814B(x, v) \ -+ (BIT_CLEAR_MGQ_PGBNDY_V1_8814B(x) | BIT_MGQ_PGBNDY_V1_8814B(v)) -+ -+/* 2 REG_TXRPT_CTRL_8814B */ -+ -+#define BIT_SHIFT_TRXRPT_TIMER_TH_8814B 24 -+#define BIT_MASK_TRXRPT_TIMER_TH_8814B 0xff -+#define BIT_TRXRPT_TIMER_TH_8814B(x) \ -+ (((x) & BIT_MASK_TRXRPT_TIMER_TH_8814B) \ -+ << BIT_SHIFT_TRXRPT_TIMER_TH_8814B) -+#define BITS_TRXRPT_TIMER_TH_8814B \ -+ (BIT_MASK_TRXRPT_TIMER_TH_8814B << BIT_SHIFT_TRXRPT_TIMER_TH_8814B) -+#define BIT_CLEAR_TRXRPT_TIMER_TH_8814B(x) ((x) & (~BITS_TRXRPT_TIMER_TH_8814B)) -+#define BIT_GET_TRXRPT_TIMER_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_TIMER_TH_8814B) & \ -+ BIT_MASK_TRXRPT_TIMER_TH_8814B) -+#define BIT_SET_TRXRPT_TIMER_TH_8814B(x, v) \ -+ (BIT_CLEAR_TRXRPT_TIMER_TH_8814B(x) | BIT_TRXRPT_TIMER_TH_8814B(v)) -+ -+#define BIT_SHIFT_TRXRPT_LEN_TH_8814B 16 -+#define BIT_MASK_TRXRPT_LEN_TH_8814B 0xff -+#define BIT_TRXRPT_LEN_TH_8814B(x) \ -+ (((x) & BIT_MASK_TRXRPT_LEN_TH_8814B) << BIT_SHIFT_TRXRPT_LEN_TH_8814B) -+#define BITS_TRXRPT_LEN_TH_8814B \ -+ (BIT_MASK_TRXRPT_LEN_TH_8814B << BIT_SHIFT_TRXRPT_LEN_TH_8814B) -+#define BIT_CLEAR_TRXRPT_LEN_TH_8814B(x) ((x) & (~BITS_TRXRPT_LEN_TH_8814B)) -+#define BIT_GET_TRXRPT_LEN_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_LEN_TH_8814B) & BIT_MASK_TRXRPT_LEN_TH_8814B) -+#define BIT_SET_TRXRPT_LEN_TH_8814B(x, v) \ -+ (BIT_CLEAR_TRXRPT_LEN_TH_8814B(x) | BIT_TRXRPT_LEN_TH_8814B(v)) -+ -+#define BIT_SHIFT_TRXRPT_READ_PTR_8814B 8 -+#define BIT_MASK_TRXRPT_READ_PTR_8814B 0xff -+#define BIT_TRXRPT_READ_PTR_8814B(x) \ -+ (((x) & BIT_MASK_TRXRPT_READ_PTR_8814B) \ -+ << BIT_SHIFT_TRXRPT_READ_PTR_8814B) -+#define BITS_TRXRPT_READ_PTR_8814B \ -+ (BIT_MASK_TRXRPT_READ_PTR_8814B << BIT_SHIFT_TRXRPT_READ_PTR_8814B) -+#define BIT_CLEAR_TRXRPT_READ_PTR_8814B(x) ((x) & (~BITS_TRXRPT_READ_PTR_8814B)) -+#define BIT_GET_TRXRPT_READ_PTR_8814B(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_READ_PTR_8814B) & \ -+ BIT_MASK_TRXRPT_READ_PTR_8814B) -+#define BIT_SET_TRXRPT_READ_PTR_8814B(x, v) \ -+ (BIT_CLEAR_TRXRPT_READ_PTR_8814B(x) | BIT_TRXRPT_READ_PTR_8814B(v)) -+ -+#define BIT_SHIFT_TRXRPT_WRITE_PTR_8814B 0 -+#define BIT_MASK_TRXRPT_WRITE_PTR_8814B 0xff -+#define BIT_TRXRPT_WRITE_PTR_8814B(x) \ -+ (((x) & BIT_MASK_TRXRPT_WRITE_PTR_8814B) \ -+ << BIT_SHIFT_TRXRPT_WRITE_PTR_8814B) -+#define BITS_TRXRPT_WRITE_PTR_8814B \ -+ (BIT_MASK_TRXRPT_WRITE_PTR_8814B << BIT_SHIFT_TRXRPT_WRITE_PTR_8814B) -+#define BIT_CLEAR_TRXRPT_WRITE_PTR_8814B(x) \ -+ ((x) & (~BITS_TRXRPT_WRITE_PTR_8814B)) -+#define BIT_GET_TRXRPT_WRITE_PTR_8814B(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_WRITE_PTR_8814B) & \ -+ BIT_MASK_TRXRPT_WRITE_PTR_8814B) -+#define BIT_SET_TRXRPT_WRITE_PTR_8814B(x, v) \ -+ (BIT_CLEAR_TRXRPT_WRITE_PTR_8814B(x) | BIT_TRXRPT_WRITE_PTR_8814B(v)) -+ -+/* 2 REG_INIRTS_RATE_SEL_8814B */ -+#define BIT_LEAG_RTS_BW_DUP_8814B BIT(5) -+ -+/* 2 REG_BASIC_CFEND_RATE_8814B */ -+ -+#define BIT_SHIFT_BASIC_CFEND_RATE_8814B 0 -+#define BIT_MASK_BASIC_CFEND_RATE_8814B 0x1f -+#define BIT_BASIC_CFEND_RATE_8814B(x) \ -+ (((x) & BIT_MASK_BASIC_CFEND_RATE_8814B) \ -+ << BIT_SHIFT_BASIC_CFEND_RATE_8814B) -+#define BITS_BASIC_CFEND_RATE_8814B \ -+ (BIT_MASK_BASIC_CFEND_RATE_8814B << BIT_SHIFT_BASIC_CFEND_RATE_8814B) -+#define BIT_CLEAR_BASIC_CFEND_RATE_8814B(x) \ -+ ((x) & (~BITS_BASIC_CFEND_RATE_8814B)) -+#define BIT_GET_BASIC_CFEND_RATE_8814B(x) \ -+ (((x) >> BIT_SHIFT_BASIC_CFEND_RATE_8814B) & \ -+ BIT_MASK_BASIC_CFEND_RATE_8814B) -+#define BIT_SET_BASIC_CFEND_RATE_8814B(x, v) \ -+ (BIT_CLEAR_BASIC_CFEND_RATE_8814B(x) | BIT_BASIC_CFEND_RATE_8814B(v)) -+ -+/* 2 REG_STBC_CFEND_RATE_8814B */ -+ -+#define BIT_SHIFT_STBC_CFEND_RATE_8814B 0 -+#define BIT_MASK_STBC_CFEND_RATE_8814B 0x1f -+#define BIT_STBC_CFEND_RATE_8814B(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_RATE_8814B) \ -+ << BIT_SHIFT_STBC_CFEND_RATE_8814B) -+#define BITS_STBC_CFEND_RATE_8814B \ -+ (BIT_MASK_STBC_CFEND_RATE_8814B << BIT_SHIFT_STBC_CFEND_RATE_8814B) -+#define BIT_CLEAR_STBC_CFEND_RATE_8814B(x) ((x) & (~BITS_STBC_CFEND_RATE_8814B)) -+#define BIT_GET_STBC_CFEND_RATE_8814B(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_RATE_8814B) & \ -+ BIT_MASK_STBC_CFEND_RATE_8814B) -+#define BIT_SET_STBC_CFEND_RATE_8814B(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_RATE_8814B(x) | BIT_STBC_CFEND_RATE_8814B(v)) -+ -+/* 2 REG_DATA_SC_8814B */ -+ -+#define BIT_SHIFT_TXSC_40M_8814B 4 -+#define BIT_MASK_TXSC_40M_8814B 0xf -+#define BIT_TXSC_40M_8814B(x) \ -+ (((x) & BIT_MASK_TXSC_40M_8814B) << BIT_SHIFT_TXSC_40M_8814B) -+#define BITS_TXSC_40M_8814B \ -+ (BIT_MASK_TXSC_40M_8814B << BIT_SHIFT_TXSC_40M_8814B) -+#define BIT_CLEAR_TXSC_40M_8814B(x) ((x) & (~BITS_TXSC_40M_8814B)) -+#define BIT_GET_TXSC_40M_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXSC_40M_8814B) & BIT_MASK_TXSC_40M_8814B) -+#define BIT_SET_TXSC_40M_8814B(x, v) \ -+ (BIT_CLEAR_TXSC_40M_8814B(x) | BIT_TXSC_40M_8814B(v)) -+ -+#define BIT_SHIFT_TXSC_20M_8814B 0 -+#define BIT_MASK_TXSC_20M_8814B 0xf -+#define BIT_TXSC_20M_8814B(x) \ -+ (((x) & BIT_MASK_TXSC_20M_8814B) << BIT_SHIFT_TXSC_20M_8814B) -+#define BITS_TXSC_20M_8814B \ -+ (BIT_MASK_TXSC_20M_8814B << BIT_SHIFT_TXSC_20M_8814B) -+#define BIT_CLEAR_TXSC_20M_8814B(x) ((x) & (~BITS_TXSC_20M_8814B)) -+#define BIT_GET_TXSC_20M_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXSC_20M_8814B) & BIT_MASK_TXSC_20M_8814B) -+#define BIT_SET_TXSC_20M_8814B(x, v) \ -+ (BIT_CLEAR_TXSC_20M_8814B(x) | BIT_TXSC_20M_8814B(v)) -+ -+/* 2 REG_MOREDATA_V1_8814B */ -+#define BIT_MOREDATA_CTRL2_EN_V1_8814B BIT(3) -+#define BIT_MOREDATA_CTRL1_EN_V1_8814B BIT(2) -+#define BIT_PKTIN_MOREDATA_REPLACE_ENABLE_V1_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_DATA_SC1_8814B */ -+ -+#define BIT_SHIFT_TXSC_160M_8814B 4 -+#define BIT_MASK_TXSC_160M_8814B 0xf -+#define BIT_TXSC_160M_8814B(x) \ -+ (((x) & BIT_MASK_TXSC_160M_8814B) << BIT_SHIFT_TXSC_160M_8814B) -+#define BITS_TXSC_160M_8814B \ -+ (BIT_MASK_TXSC_160M_8814B << BIT_SHIFT_TXSC_160M_8814B) -+#define BIT_CLEAR_TXSC_160M_8814B(x) ((x) & (~BITS_TXSC_160M_8814B)) -+#define BIT_GET_TXSC_160M_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXSC_160M_8814B) & BIT_MASK_TXSC_160M_8814B) -+#define BIT_SET_TXSC_160M_8814B(x, v) \ -+ (BIT_CLEAR_TXSC_160M_8814B(x) | BIT_TXSC_160M_8814B(v)) -+ -+#define BIT_SHIFT_TXSC_80M_8814B 0 -+#define BIT_MASK_TXSC_80M_8814B 0xf -+#define BIT_TXSC_80M_8814B(x) \ -+ (((x) & BIT_MASK_TXSC_80M_8814B) << BIT_SHIFT_TXSC_80M_8814B) -+#define BITS_TXSC_80M_8814B \ -+ (BIT_MASK_TXSC_80M_8814B << BIT_SHIFT_TXSC_80M_8814B) -+#define BIT_CLEAR_TXSC_80M_8814B(x) ((x) & (~BITS_TXSC_80M_8814B)) -+#define BIT_GET_TXSC_80M_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXSC_80M_8814B) & BIT_MASK_TXSC_80M_8814B) -+#define BIT_SET_TXSC_80M_8814B(x, v) \ -+ (BIT_CLEAR_TXSC_80M_8814B(x) | BIT_TXSC_80M_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_TXRPT_START_OFFSET_8814B */ -+#define BIT_RPTFIFO_RPTNUM_OPT_8814B BIT(31) -+ -+#define BIT_SHIFT_MISSED_RPT_NUM_8814B 28 -+#define BIT_MASK_MISSED_RPT_NUM_8814B 0x7 -+#define BIT_MISSED_RPT_NUM_8814B(x) \ -+ (((x) & BIT_MASK_MISSED_RPT_NUM_8814B) \ -+ << BIT_SHIFT_MISSED_RPT_NUM_8814B) -+#define BITS_MISSED_RPT_NUM_8814B \ -+ (BIT_MASK_MISSED_RPT_NUM_8814B << BIT_SHIFT_MISSED_RPT_NUM_8814B) -+#define BIT_CLEAR_MISSED_RPT_NUM_8814B(x) ((x) & (~BITS_MISSED_RPT_NUM_8814B)) -+#define BIT_GET_MISSED_RPT_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_MISSED_RPT_NUM_8814B) & \ -+ BIT_MASK_MISSED_RPT_NUM_8814B) -+#define BIT_SET_MISSED_RPT_NUM_8814B(x, v) \ -+ (BIT_CLEAR_MISSED_RPT_NUM_8814B(x) | BIT_MISSED_RPT_NUM_8814B(v)) -+ -+#define BIT_SHIFT_MACID_CTRL_OFFSET_V1_8814B 16 -+#define BIT_MASK_MACID_CTRL_OFFSET_V1_8814B 0x1ff -+#define BIT_MACID_CTRL_OFFSET_V1_8814B(x) \ -+ (((x) & BIT_MASK_MACID_CTRL_OFFSET_V1_8814B) \ -+ << BIT_SHIFT_MACID_CTRL_OFFSET_V1_8814B) -+#define BITS_MACID_CTRL_OFFSET_V1_8814B \ -+ (BIT_MASK_MACID_CTRL_OFFSET_V1_8814B \ -+ << BIT_SHIFT_MACID_CTRL_OFFSET_V1_8814B) -+#define BIT_CLEAR_MACID_CTRL_OFFSET_V1_8814B(x) \ -+ ((x) & (~BITS_MACID_CTRL_OFFSET_V1_8814B)) -+#define BIT_GET_MACID_CTRL_OFFSET_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_CTRL_OFFSET_V1_8814B) & \ -+ BIT_MASK_MACID_CTRL_OFFSET_V1_8814B) -+#define BIT_SET_MACID_CTRL_OFFSET_V1_8814B(x, v) \ -+ (BIT_CLEAR_MACID_CTRL_OFFSET_V1_8814B(x) | \ -+ BIT_MACID_CTRL_OFFSET_V1_8814B(v)) -+ -+#define BIT_SHIFT_AMPDU_TXRPT_OFFSET_V1_8814B 0 -+#define BIT_MASK_AMPDU_TXRPT_OFFSET_V1_8814B 0x1ff -+#define BIT_AMPDU_TXRPT_OFFSET_V1_8814B(x) \ -+ (((x) & BIT_MASK_AMPDU_TXRPT_OFFSET_V1_8814B) \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_V1_8814B) -+#define BITS_AMPDU_TXRPT_OFFSET_V1_8814B \ -+ (BIT_MASK_AMPDU_TXRPT_OFFSET_V1_8814B \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_V1_8814B) -+#define BIT_CLEAR_AMPDU_TXRPT_OFFSET_V1_8814B(x) \ -+ ((x) & (~BITS_AMPDU_TXRPT_OFFSET_V1_8814B)) -+#define BIT_GET_AMPDU_TXRPT_OFFSET_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_TXRPT_OFFSET_V1_8814B) & \ -+ BIT_MASK_AMPDU_TXRPT_OFFSET_V1_8814B) -+#define BIT_SET_AMPDU_TXRPT_OFFSET_V1_8814B(x, v) \ -+ (BIT_CLEAR_AMPDU_TXRPT_OFFSET_V1_8814B(x) | \ -+ BIT_AMPDU_TXRPT_OFFSET_V1_8814B(v)) -+ -+/* 2 REG_POWER_STAGE1_8814B */ -+#define BIT_PTA_WL_PRI_MASK_CPU_MGQ_8814B BIT(31) -+#define BIT_PTA_WL_PRI_MASK_BCNQ_8814B BIT(30) -+#define BIT_PTA_WL_PRI_MASK_HIQ_8814B BIT(29) -+#define BIT_PTA_WL_PRI_MASK_MGQ_8814B BIT(28) -+#define BIT_PTA_WL_PRI_MASK_BK_8814B BIT(27) -+#define BIT_PTA_WL_PRI_MASK_BE_8814B BIT(26) -+#define BIT_PTA_WL_PRI_MASK_VI_8814B BIT(25) -+#define BIT_PTA_WL_PRI_MASK_VO_8814B BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE1_8814B 0 -+#define BIT_MASK_POWER_STAGE1_8814B 0xffffff -+#define BIT_POWER_STAGE1_8814B(x) \ -+ (((x) & BIT_MASK_POWER_STAGE1_8814B) << BIT_SHIFT_POWER_STAGE1_8814B) -+#define BITS_POWER_STAGE1_8814B \ -+ (BIT_MASK_POWER_STAGE1_8814B << BIT_SHIFT_POWER_STAGE1_8814B) -+#define BIT_CLEAR_POWER_STAGE1_8814B(x) ((x) & (~BITS_POWER_STAGE1_8814B)) -+#define BIT_GET_POWER_STAGE1_8814B(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE1_8814B) & BIT_MASK_POWER_STAGE1_8814B) -+#define BIT_SET_POWER_STAGE1_8814B(x, v) \ -+ (BIT_CLEAR_POWER_STAGE1_8814B(x) | BIT_POWER_STAGE1_8814B(v)) -+ -+/* 2 REG_POWER_STAGE2_8814B */ -+#define BIT__CTRL_PKT_POW_ADJ_8814B BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE2_8814B 0 -+#define BIT_MASK_POWER_STAGE2_8814B 0xffffff -+#define BIT_POWER_STAGE2_8814B(x) \ -+ (((x) & BIT_MASK_POWER_STAGE2_8814B) << BIT_SHIFT_POWER_STAGE2_8814B) -+#define BITS_POWER_STAGE2_8814B \ -+ (BIT_MASK_POWER_STAGE2_8814B << BIT_SHIFT_POWER_STAGE2_8814B) -+#define BIT_CLEAR_POWER_STAGE2_8814B(x) ((x) & (~BITS_POWER_STAGE2_8814B)) -+#define BIT_GET_POWER_STAGE2_8814B(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE2_8814B) & BIT_MASK_POWER_STAGE2_8814B) -+#define BIT_SET_POWER_STAGE2_8814B(x, v) \ -+ (BIT_CLEAR_POWER_STAGE2_8814B(x) | BIT_POWER_STAGE2_8814B(v)) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL_8814B */ -+#define BIT_DMA_THIS_QUEUE_BK_8814B BIT(23) -+#define BIT_DMA_THIS_QUEUE_BE_8814B BIT(22) -+#define BIT_DMA_THIS_QUEUE_VI_8814B BIT(21) -+#define BIT_DMA_THIS_QUEUE_VO_8814B BIT(20) -+ -+#define BIT_SHIFT_TOTAL_LEN_TH_8814B 8 -+#define BIT_MASK_TOTAL_LEN_TH_8814B 0xfff -+#define BIT_TOTAL_LEN_TH_8814B(x) \ -+ (((x) & BIT_MASK_TOTAL_LEN_TH_8814B) << BIT_SHIFT_TOTAL_LEN_TH_8814B) -+#define BITS_TOTAL_LEN_TH_8814B \ -+ (BIT_MASK_TOTAL_LEN_TH_8814B << BIT_SHIFT_TOTAL_LEN_TH_8814B) -+#define BIT_CLEAR_TOTAL_LEN_TH_8814B(x) ((x) & (~BITS_TOTAL_LEN_TH_8814B)) -+#define BIT_GET_TOTAL_LEN_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_TOTAL_LEN_TH_8814B) & BIT_MASK_TOTAL_LEN_TH_8814B) -+#define BIT_SET_TOTAL_LEN_TH_8814B(x, v) \ -+ (BIT_CLEAR_TOTAL_LEN_TH_8814B(x) | BIT_TOTAL_LEN_TH_8814B(v)) -+ -+#define BIT_PRE_TX_CMD_8814B BIT(6) -+ -+#define BIT_SHIFT_NUM_SCL_EN_8814B 4 -+#define BIT_MASK_NUM_SCL_EN_8814B 0x3 -+#define BIT_NUM_SCL_EN_8814B(x) \ -+ (((x) & BIT_MASK_NUM_SCL_EN_8814B) << BIT_SHIFT_NUM_SCL_EN_8814B) -+#define BITS_NUM_SCL_EN_8814B \ -+ (BIT_MASK_NUM_SCL_EN_8814B << BIT_SHIFT_NUM_SCL_EN_8814B) -+#define BIT_CLEAR_NUM_SCL_EN_8814B(x) ((x) & (~BITS_NUM_SCL_EN_8814B)) -+#define BIT_GET_NUM_SCL_EN_8814B(x) \ -+ (((x) >> BIT_SHIFT_NUM_SCL_EN_8814B) & BIT_MASK_NUM_SCL_EN_8814B) -+#define BIT_SET_NUM_SCL_EN_8814B(x, v) \ -+ (BIT_CLEAR_NUM_SCL_EN_8814B(x) | BIT_NUM_SCL_EN_8814B(v)) -+ -+#define BIT_BK_EN_8814B BIT(3) -+#define BIT_BE_EN_8814B BIT(2) -+#define BIT_VI_EN_8814B BIT(1) -+#define BIT_VO_EN_8814B BIT(0) -+ -+/* 2 REG_PKT_LIFE_TIME_8814B */ -+ -+#define BIT_SHIFT_PKT_LIFTIME_BEBK_8814B 16 -+#define BIT_MASK_PKT_LIFTIME_BEBK_8814B 0xffff -+#define BIT_PKT_LIFTIME_BEBK_8814B(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_BEBK_8814B) \ -+ << BIT_SHIFT_PKT_LIFTIME_BEBK_8814B) -+#define BITS_PKT_LIFTIME_BEBK_8814B \ -+ (BIT_MASK_PKT_LIFTIME_BEBK_8814B << BIT_SHIFT_PKT_LIFTIME_BEBK_8814B) -+#define BIT_CLEAR_PKT_LIFTIME_BEBK_8814B(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_BEBK_8814B)) -+#define BIT_GET_PKT_LIFTIME_BEBK_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_BEBK_8814B) & \ -+ BIT_MASK_PKT_LIFTIME_BEBK_8814B) -+#define BIT_SET_PKT_LIFTIME_BEBK_8814B(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_BEBK_8814B(x) | BIT_PKT_LIFTIME_BEBK_8814B(v)) -+ -+#define BIT_SHIFT_PKT_LIFTIME_VOVI_8814B 0 -+#define BIT_MASK_PKT_LIFTIME_VOVI_8814B 0xffff -+#define BIT_PKT_LIFTIME_VOVI_8814B(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_VOVI_8814B) \ -+ << BIT_SHIFT_PKT_LIFTIME_VOVI_8814B) -+#define BITS_PKT_LIFTIME_VOVI_8814B \ -+ (BIT_MASK_PKT_LIFTIME_VOVI_8814B << BIT_SHIFT_PKT_LIFTIME_VOVI_8814B) -+#define BIT_CLEAR_PKT_LIFTIME_VOVI_8814B(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_VOVI_8814B)) -+#define BIT_GET_PKT_LIFTIME_VOVI_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_VOVI_8814B) & \ -+ BIT_MASK_PKT_LIFTIME_VOVI_8814B) -+#define BIT_SET_PKT_LIFTIME_VOVI_8814B(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_VOVI_8814B(x) | BIT_PKT_LIFTIME_VOVI_8814B(v)) -+ -+/* 2 REG_STBC_SETTING_8814B */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_L_8814B 4 -+#define BIT_MASK_CDEND_TXTIME_L_8814B 0xf -+#define BIT_CDEND_TXTIME_L_8814B(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_L_8814B) \ -+ << BIT_SHIFT_CDEND_TXTIME_L_8814B) -+#define BITS_CDEND_TXTIME_L_8814B \ -+ (BIT_MASK_CDEND_TXTIME_L_8814B << BIT_SHIFT_CDEND_TXTIME_L_8814B) -+#define BIT_CLEAR_CDEND_TXTIME_L_8814B(x) ((x) & (~BITS_CDEND_TXTIME_L_8814B)) -+#define BIT_GET_CDEND_TXTIME_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_L_8814B) & \ -+ BIT_MASK_CDEND_TXTIME_L_8814B) -+#define BIT_SET_CDEND_TXTIME_L_8814B(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_L_8814B(x) | BIT_CDEND_TXTIME_L_8814B(v)) -+ -+#define BIT_SHIFT_NESS_8814B 2 -+#define BIT_MASK_NESS_8814B 0x3 -+#define BIT_NESS_8814B(x) (((x) & BIT_MASK_NESS_8814B) << BIT_SHIFT_NESS_8814B) -+#define BITS_NESS_8814B (BIT_MASK_NESS_8814B << BIT_SHIFT_NESS_8814B) -+#define BIT_CLEAR_NESS_8814B(x) ((x) & (~BITS_NESS_8814B)) -+#define BIT_GET_NESS_8814B(x) \ -+ (((x) >> BIT_SHIFT_NESS_8814B) & BIT_MASK_NESS_8814B) -+#define BIT_SET_NESS_8814B(x, v) (BIT_CLEAR_NESS_8814B(x) | BIT_NESS_8814B(v)) -+ -+#define BIT_SHIFT_STBC_CFEND_8814B 0 -+#define BIT_MASK_STBC_CFEND_8814B 0x3 -+#define BIT_STBC_CFEND_8814B(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_8814B) << BIT_SHIFT_STBC_CFEND_8814B) -+#define BITS_STBC_CFEND_8814B \ -+ (BIT_MASK_STBC_CFEND_8814B << BIT_SHIFT_STBC_CFEND_8814B) -+#define BIT_CLEAR_STBC_CFEND_8814B(x) ((x) & (~BITS_STBC_CFEND_8814B)) -+#define BIT_GET_STBC_CFEND_8814B(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_8814B) & BIT_MASK_STBC_CFEND_8814B) -+#define BIT_SET_STBC_CFEND_8814B(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_8814B(x) | BIT_STBC_CFEND_8814B(v)) -+ -+/* 2 REG_STBC_SETTING2_8814B */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_H_8814B 0 -+#define BIT_MASK_CDEND_TXTIME_H_8814B 0x1f -+#define BIT_CDEND_TXTIME_H_8814B(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_H_8814B) \ -+ << BIT_SHIFT_CDEND_TXTIME_H_8814B) -+#define BITS_CDEND_TXTIME_H_8814B \ -+ (BIT_MASK_CDEND_TXTIME_H_8814B << BIT_SHIFT_CDEND_TXTIME_H_8814B) -+#define BIT_CLEAR_CDEND_TXTIME_H_8814B(x) ((x) & (~BITS_CDEND_TXTIME_H_8814B)) -+#define BIT_GET_CDEND_TXTIME_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_H_8814B) & \ -+ BIT_MASK_CDEND_TXTIME_H_8814B) -+#define BIT_SET_CDEND_TXTIME_H_8814B(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_H_8814B(x) | BIT_CDEND_TXTIME_H_8814B(v)) -+ -+/* 2 REG_QUEUE_CTRL_8814B */ -+#define BIT_FORCE_RND_PRI_8814B BIT(6) -+#define BIT_PTA_EDCCA_EN_8814B BIT(5) -+#define BIT_PTA_WL_TX_EN_8814B BIT(4) -+#define BIT_USE_DATA_BW_8814B BIT(3) -+#define BIT_TRI_PKT_INT_MODE1_8814B BIT(2) -+#define BIT_TRI_PKT_INT_MODE0_8814B BIT(1) -+#define BIT_ACQ_MODE_SEL_8814B BIT(0) -+ -+/* 2 REG_SINGLE_AMPDU_CTRL_8814B */ -+#define BIT_EN_SINGLE_APMDU_8814B BIT(7) -+ -+/* 2 REG_PROT_MODE_CTRL_8814B */ -+ -+#define BIT_SHIFT_RTS_MAX_AGG_NUM_8814B 24 -+#define BIT_MASK_RTS_MAX_AGG_NUM_8814B 0x3f -+#define BIT_RTS_MAX_AGG_NUM_8814B(x) \ -+ (((x) & BIT_MASK_RTS_MAX_AGG_NUM_8814B) \ -+ << BIT_SHIFT_RTS_MAX_AGG_NUM_8814B) -+#define BITS_RTS_MAX_AGG_NUM_8814B \ -+ (BIT_MASK_RTS_MAX_AGG_NUM_8814B << BIT_SHIFT_RTS_MAX_AGG_NUM_8814B) -+#define BIT_CLEAR_RTS_MAX_AGG_NUM_8814B(x) ((x) & (~BITS_RTS_MAX_AGG_NUM_8814B)) -+#define BIT_GET_RTS_MAX_AGG_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_RTS_MAX_AGG_NUM_8814B) & \ -+ BIT_MASK_RTS_MAX_AGG_NUM_8814B) -+#define BIT_SET_RTS_MAX_AGG_NUM_8814B(x, v) \ -+ (BIT_CLEAR_RTS_MAX_AGG_NUM_8814B(x) | BIT_RTS_MAX_AGG_NUM_8814B(v)) -+ -+#define BIT_SHIFT_MAX_AGG_NUM_8814B 16 -+#define BIT_MASK_MAX_AGG_NUM_8814B 0x3f -+#define BIT_MAX_AGG_NUM_8814B(x) \ -+ (((x) & BIT_MASK_MAX_AGG_NUM_8814B) << BIT_SHIFT_MAX_AGG_NUM_8814B) -+#define BITS_MAX_AGG_NUM_8814B \ -+ (BIT_MASK_MAX_AGG_NUM_8814B << BIT_SHIFT_MAX_AGG_NUM_8814B) -+#define BIT_CLEAR_MAX_AGG_NUM_8814B(x) ((x) & (~BITS_MAX_AGG_NUM_8814B)) -+#define BIT_GET_MAX_AGG_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAX_AGG_NUM_8814B) & BIT_MASK_MAX_AGG_NUM_8814B) -+#define BIT_SET_MAX_AGG_NUM_8814B(x, v) \ -+ (BIT_CLEAR_MAX_AGG_NUM_8814B(x) | BIT_MAX_AGG_NUM_8814B(v)) -+ -+#define BIT_SHIFT_RTS_TXTIME_TH_8814B 8 -+#define BIT_MASK_RTS_TXTIME_TH_8814B 0xff -+#define BIT_RTS_TXTIME_TH_8814B(x) \ -+ (((x) & BIT_MASK_RTS_TXTIME_TH_8814B) << BIT_SHIFT_RTS_TXTIME_TH_8814B) -+#define BITS_RTS_TXTIME_TH_8814B \ -+ (BIT_MASK_RTS_TXTIME_TH_8814B << BIT_SHIFT_RTS_TXTIME_TH_8814B) -+#define BIT_CLEAR_RTS_TXTIME_TH_8814B(x) ((x) & (~BITS_RTS_TXTIME_TH_8814B)) -+#define BIT_GET_RTS_TXTIME_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_RTS_TXTIME_TH_8814B) & BIT_MASK_RTS_TXTIME_TH_8814B) -+#define BIT_SET_RTS_TXTIME_TH_8814B(x, v) \ -+ (BIT_CLEAR_RTS_TXTIME_TH_8814B(x) | BIT_RTS_TXTIME_TH_8814B(v)) -+ -+#define BIT_SHIFT_RTS_LEN_TH_8814B 0 -+#define BIT_MASK_RTS_LEN_TH_8814B 0xff -+#define BIT_RTS_LEN_TH_8814B(x) \ -+ (((x) & BIT_MASK_RTS_LEN_TH_8814B) << BIT_SHIFT_RTS_LEN_TH_8814B) -+#define BITS_RTS_LEN_TH_8814B \ -+ (BIT_MASK_RTS_LEN_TH_8814B << BIT_SHIFT_RTS_LEN_TH_8814B) -+#define BIT_CLEAR_RTS_LEN_TH_8814B(x) ((x) & (~BITS_RTS_LEN_TH_8814B)) -+#define BIT_GET_RTS_LEN_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_RTS_LEN_TH_8814B) & BIT_MASK_RTS_LEN_TH_8814B) -+#define BIT_SET_RTS_LEN_TH_8814B(x, v) \ -+ (BIT_CLEAR_RTS_LEN_TH_8814B(x) | BIT_RTS_LEN_TH_8814B(v)) -+ -+/* 2 REG_BAR_MODE_CTRL_8814B */ -+ -+#define BIT_SHIFT_BAR_RTY_LMT_8814B 16 -+#define BIT_MASK_BAR_RTY_LMT_8814B 0x3 -+#define BIT_BAR_RTY_LMT_8814B(x) \ -+ (((x) & BIT_MASK_BAR_RTY_LMT_8814B) << BIT_SHIFT_BAR_RTY_LMT_8814B) -+#define BITS_BAR_RTY_LMT_8814B \ -+ (BIT_MASK_BAR_RTY_LMT_8814B << BIT_SHIFT_BAR_RTY_LMT_8814B) -+#define BIT_CLEAR_BAR_RTY_LMT_8814B(x) ((x) & (~BITS_BAR_RTY_LMT_8814B)) -+#define BIT_GET_BAR_RTY_LMT_8814B(x) \ -+ (((x) >> BIT_SHIFT_BAR_RTY_LMT_8814B) & BIT_MASK_BAR_RTY_LMT_8814B) -+#define BIT_SET_BAR_RTY_LMT_8814B(x, v) \ -+ (BIT_CLEAR_BAR_RTY_LMT_8814B(x) | BIT_BAR_RTY_LMT_8814B(v)) -+ -+#define BIT_SHIFT_BAR_PKT_TXTIME_TH_8814B 8 -+#define BIT_MASK_BAR_PKT_TXTIME_TH_8814B 0xff -+#define BIT_BAR_PKT_TXTIME_TH_8814B(x) \ -+ (((x) & BIT_MASK_BAR_PKT_TXTIME_TH_8814B) \ -+ << BIT_SHIFT_BAR_PKT_TXTIME_TH_8814B) -+#define BITS_BAR_PKT_TXTIME_TH_8814B \ -+ (BIT_MASK_BAR_PKT_TXTIME_TH_8814B << BIT_SHIFT_BAR_PKT_TXTIME_TH_8814B) -+#define BIT_CLEAR_BAR_PKT_TXTIME_TH_8814B(x) \ -+ ((x) & (~BITS_BAR_PKT_TXTIME_TH_8814B)) -+#define BIT_GET_BAR_PKT_TXTIME_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKT_TXTIME_TH_8814B) & \ -+ BIT_MASK_BAR_PKT_TXTIME_TH_8814B) -+#define BIT_SET_BAR_PKT_TXTIME_TH_8814B(x, v) \ -+ (BIT_CLEAR_BAR_PKT_TXTIME_TH_8814B(x) | BIT_BAR_PKT_TXTIME_TH_8814B(v)) -+ -+#define BIT_BAR_EN_V1_8814B BIT(6) -+ -+#define BIT_SHIFT_BAR_PKTNUM_TH_V1_8814B 0 -+#define BIT_MASK_BAR_PKTNUM_TH_V1_8814B 0x3f -+#define BIT_BAR_PKTNUM_TH_V1_8814B(x) \ -+ (((x) & BIT_MASK_BAR_PKTNUM_TH_V1_8814B) \ -+ << BIT_SHIFT_BAR_PKTNUM_TH_V1_8814B) -+#define BITS_BAR_PKTNUM_TH_V1_8814B \ -+ (BIT_MASK_BAR_PKTNUM_TH_V1_8814B << BIT_SHIFT_BAR_PKTNUM_TH_V1_8814B) -+#define BIT_CLEAR_BAR_PKTNUM_TH_V1_8814B(x) \ -+ ((x) & (~BITS_BAR_PKTNUM_TH_V1_8814B)) -+#define BIT_GET_BAR_PKTNUM_TH_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKTNUM_TH_V1_8814B) & \ -+ BIT_MASK_BAR_PKTNUM_TH_V1_8814B) -+#define BIT_SET_BAR_PKTNUM_TH_V1_8814B(x, v) \ -+ (BIT_CLEAR_BAR_PKTNUM_TH_V1_8814B(x) | BIT_BAR_PKTNUM_TH_V1_8814B(v)) -+ -+/* 2 REG_RA_TRY_RATE_AGG_LMT_8814B */ -+ -+#define BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8814B 0 -+#define BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8814B 0x3f -+#define BIT_RA_TRY_RATE_AGG_LMT_V1_8814B(x) \ -+ (((x) & BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8814B) \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8814B) -+#define BITS_RA_TRY_RATE_AGG_LMT_V1_8814B \ -+ (BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8814B \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8814B) -+#define BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8814B(x) \ -+ ((x) & (~BITS_RA_TRY_RATE_AGG_LMT_V1_8814B)) -+#define BIT_GET_RA_TRY_RATE_AGG_LMT_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8814B) & \ -+ BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8814B) -+#define BIT_SET_RA_TRY_RATE_AGG_LMT_V1_8814B(x, v) \ -+ (BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8814B(x) | \ -+ BIT_RA_TRY_RATE_AGG_LMT_V1_8814B(v)) -+ -+/* 2 REG_MACID_SLEEP_CTRL_8814B */ -+ -+#define BIT_SHIFT_DEBUG_PROTOCOL_8814B 24 -+#define BIT_MASK_DEBUG_PROTOCOL_8814B 0xff -+#define BIT_DEBUG_PROTOCOL_8814B(x) \ -+ (((x) & BIT_MASK_DEBUG_PROTOCOL_8814B) \ -+ << BIT_SHIFT_DEBUG_PROTOCOL_8814B) -+#define BITS_DEBUG_PROTOCOL_8814B \ -+ (BIT_MASK_DEBUG_PROTOCOL_8814B << BIT_SHIFT_DEBUG_PROTOCOL_8814B) -+#define BIT_CLEAR_DEBUG_PROTOCOL_8814B(x) ((x) & (~BITS_DEBUG_PROTOCOL_8814B)) -+#define BIT_GET_DEBUG_PROTOCOL_8814B(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_PROTOCOL_8814B) & \ -+ BIT_MASK_DEBUG_PROTOCOL_8814B) -+#define BIT_SET_DEBUG_PROTOCOL_8814B(x, v) \ -+ (BIT_CLEAR_DEBUG_PROTOCOL_8814B(x) | BIT_DEBUG_PROTOCOL_8814B(v)) -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_RSEL_8814B 16 -+#define BIT_MASK_BCNQ_PGBNDY_RSEL_8814B 0x7 -+#define BIT_BCNQ_PGBNDY_RSEL_8814B(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_RSEL_8814B) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_RSEL_8814B) -+#define BITS_BCNQ_PGBNDY_RSEL_8814B \ -+ (BIT_MASK_BCNQ_PGBNDY_RSEL_8814B << BIT_SHIFT_BCNQ_PGBNDY_RSEL_8814B) -+#define BIT_CLEAR_BCNQ_PGBNDY_RSEL_8814B(x) \ -+ ((x) & (~BITS_BCNQ_PGBNDY_RSEL_8814B)) -+#define BIT_GET_BCNQ_PGBNDY_RSEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_RSEL_8814B) & \ -+ BIT_MASK_BCNQ_PGBNDY_RSEL_8814B) -+#define BIT_SET_BCNQ_PGBNDY_RSEL_8814B(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_RSEL_8814B(x) | BIT_BCNQ_PGBNDY_RSEL_8814B(v)) -+ -+#define BIT_SHIFT_MACID_SLEEP_SEL_8814B 0 -+#define BIT_MASK_MACID_SLEEP_SEL_8814B 0x7 -+#define BIT_MACID_SLEEP_SEL_8814B(x) \ -+ (((x) & BIT_MASK_MACID_SLEEP_SEL_8814B) \ -+ << BIT_SHIFT_MACID_SLEEP_SEL_8814B) -+#define BITS_MACID_SLEEP_SEL_8814B \ -+ (BIT_MASK_MACID_SLEEP_SEL_8814B << BIT_SHIFT_MACID_SLEEP_SEL_8814B) -+#define BIT_CLEAR_MACID_SLEEP_SEL_8814B(x) ((x) & (~BITS_MACID_SLEEP_SEL_8814B)) -+#define BIT_GET_MACID_SLEEP_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_SLEEP_SEL_8814B) & \ -+ BIT_MASK_MACID_SLEEP_SEL_8814B) -+#define BIT_SET_MACID_SLEEP_SEL_8814B(x, v) \ -+ (BIT_CLEAR_MACID_SLEEP_SEL_8814B(x) | BIT_MACID_SLEEP_SEL_8814B(v)) -+ -+/* 2 REG_MACID_SLEEP_INFO_8814B */ -+ -+#define BIT_SHIFT_MACID_SLEEP_INFO_8814B 0 -+#define BIT_MASK_MACID_SLEEP_INFO_8814B 0xffffffffL -+#define BIT_MACID_SLEEP_INFO_8814B(x) \ -+ (((x) & BIT_MASK_MACID_SLEEP_INFO_8814B) \ -+ << BIT_SHIFT_MACID_SLEEP_INFO_8814B) -+#define BITS_MACID_SLEEP_INFO_8814B \ -+ (BIT_MASK_MACID_SLEEP_INFO_8814B << BIT_SHIFT_MACID_SLEEP_INFO_8814B) -+#define BIT_CLEAR_MACID_SLEEP_INFO_8814B(x) \ -+ ((x) & (~BITS_MACID_SLEEP_INFO_8814B)) -+#define BIT_GET_MACID_SLEEP_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_SLEEP_INFO_8814B) & \ -+ BIT_MASK_MACID_SLEEP_INFO_8814B) -+#define BIT_SET_MACID_SLEEP_INFO_8814B(x, v) \ -+ (BIT_CLEAR_MACID_SLEEP_INFO_8814B(x) | BIT_MACID_SLEEP_INFO_8814B(v)) -+ -+/* 2 REG_HW_SEQ0_8814B */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ0_8814B 0 -+#define BIT_MASK_HW_SSN_SEQ0_8814B 0xfff -+#define BIT_HW_SSN_SEQ0_8814B(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ0_8814B) << BIT_SHIFT_HW_SSN_SEQ0_8814B) -+#define BITS_HW_SSN_SEQ0_8814B \ -+ (BIT_MASK_HW_SSN_SEQ0_8814B << BIT_SHIFT_HW_SSN_SEQ0_8814B) -+#define BIT_CLEAR_HW_SSN_SEQ0_8814B(x) ((x) & (~BITS_HW_SSN_SEQ0_8814B)) -+#define BIT_GET_HW_SSN_SEQ0_8814B(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ0_8814B) & BIT_MASK_HW_SSN_SEQ0_8814B) -+#define BIT_SET_HW_SSN_SEQ0_8814B(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ0_8814B(x) | BIT_HW_SSN_SEQ0_8814B(v)) -+ -+/* 2 REG_HW_SEQ1_8814B */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ1_8814B 0 -+#define BIT_MASK_HW_SSN_SEQ1_8814B 0xfff -+#define BIT_HW_SSN_SEQ1_8814B(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ1_8814B) << BIT_SHIFT_HW_SSN_SEQ1_8814B) -+#define BITS_HW_SSN_SEQ1_8814B \ -+ (BIT_MASK_HW_SSN_SEQ1_8814B << BIT_SHIFT_HW_SSN_SEQ1_8814B) -+#define BIT_CLEAR_HW_SSN_SEQ1_8814B(x) ((x) & (~BITS_HW_SSN_SEQ1_8814B)) -+#define BIT_GET_HW_SSN_SEQ1_8814B(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ1_8814B) & BIT_MASK_HW_SSN_SEQ1_8814B) -+#define BIT_SET_HW_SSN_SEQ1_8814B(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ1_8814B(x) | BIT_HW_SSN_SEQ1_8814B(v)) -+ -+/* 2 REG_HW_SEQ2_8814B */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ2_8814B 0 -+#define BIT_MASK_HW_SSN_SEQ2_8814B 0xfff -+#define BIT_HW_SSN_SEQ2_8814B(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ2_8814B) << BIT_SHIFT_HW_SSN_SEQ2_8814B) -+#define BITS_HW_SSN_SEQ2_8814B \ -+ (BIT_MASK_HW_SSN_SEQ2_8814B << BIT_SHIFT_HW_SSN_SEQ2_8814B) -+#define BIT_CLEAR_HW_SSN_SEQ2_8814B(x) ((x) & (~BITS_HW_SSN_SEQ2_8814B)) -+#define BIT_GET_HW_SSN_SEQ2_8814B(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ2_8814B) & BIT_MASK_HW_SSN_SEQ2_8814B) -+#define BIT_SET_HW_SSN_SEQ2_8814B(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ2_8814B(x) | BIT_HW_SSN_SEQ2_8814B(v)) -+ -+/* 2 REG_HW_SEQ3_8814B */ -+ -+#define BIT_SHIFT_CSI_HWSEQ_SEL_8814B 12 -+#define BIT_MASK_CSI_HWSEQ_SEL_8814B 0x3 -+#define BIT_CSI_HWSEQ_SEL_8814B(x) \ -+ (((x) & BIT_MASK_CSI_HWSEQ_SEL_8814B) << BIT_SHIFT_CSI_HWSEQ_SEL_8814B) -+#define BITS_CSI_HWSEQ_SEL_8814B \ -+ (BIT_MASK_CSI_HWSEQ_SEL_8814B << BIT_SHIFT_CSI_HWSEQ_SEL_8814B) -+#define BIT_CLEAR_CSI_HWSEQ_SEL_8814B(x) ((x) & (~BITS_CSI_HWSEQ_SEL_8814B)) -+#define BIT_GET_CSI_HWSEQ_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_CSI_HWSEQ_SEL_8814B) & BIT_MASK_CSI_HWSEQ_SEL_8814B) -+#define BIT_SET_CSI_HWSEQ_SEL_8814B(x, v) \ -+ (BIT_CLEAR_CSI_HWSEQ_SEL_8814B(x) | BIT_CSI_HWSEQ_SEL_8814B(v)) -+ -+#define BIT_SHIFT_HW_SSN_SEQ3_8814B 0 -+#define BIT_MASK_HW_SSN_SEQ3_8814B 0xfff -+#define BIT_HW_SSN_SEQ3_8814B(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ3_8814B) << BIT_SHIFT_HW_SSN_SEQ3_8814B) -+#define BITS_HW_SSN_SEQ3_8814B \ -+ (BIT_MASK_HW_SSN_SEQ3_8814B << BIT_SHIFT_HW_SSN_SEQ3_8814B) -+#define BIT_CLEAR_HW_SSN_SEQ3_8814B(x) ((x) & (~BITS_HW_SSN_SEQ3_8814B)) -+#define BIT_GET_HW_SSN_SEQ3_8814B(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ3_8814B) & BIT_MASK_HW_SSN_SEQ3_8814B) -+#define BIT_SET_HW_SSN_SEQ3_8814B(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ3_8814B(x) | BIT_HW_SSN_SEQ3_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V3_8814B 0 -+#define BIT_MASK_PTCL_TOTAL_PG_V3_8814B 0x1fff -+#define BIT_PTCL_TOTAL_PG_V3_8814B(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V3_8814B) \ -+ << BIT_SHIFT_PTCL_TOTAL_PG_V3_8814B) -+#define BITS_PTCL_TOTAL_PG_V3_8814B \ -+ (BIT_MASK_PTCL_TOTAL_PG_V3_8814B << BIT_SHIFT_PTCL_TOTAL_PG_V3_8814B) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V3_8814B(x) \ -+ ((x) & (~BITS_PTCL_TOTAL_PG_V3_8814B)) -+#define BIT_GET_PTCL_TOTAL_PG_V3_8814B(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V3_8814B) & \ -+ BIT_MASK_PTCL_TOTAL_PG_V3_8814B) -+#define BIT_SET_PTCL_TOTAL_PG_V3_8814B(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V3_8814B(x) | BIT_PTCL_TOTAL_PG_V3_8814B(v)) -+ -+/* 2 REG_PTCL_ERR_STATUS_V1_8814B */ -+#define BIT_MUARB_SEARCH_ERR_8814B BIT(14) -+#define BIT_MU_BFEN_ERR_8814B BIT(12) -+#define BIT_NDPA_DROPNULL_ERR_8814B BIT(11) -+#define BIT_NDPA_DROPPKT_ERR_8814B BIT(10) -+#define BIT_PTCL_PKYIN_ERR_8814B BIT(9) -+#define BIT_PTCL_QSELCNL_ERR_8814B BIT(8) -+#define BIT_PTCL_RATE_TABLE_INVALID_8814B BIT(7) -+#define BIT_FTM_T2R_ERROR_8814B BIT(6) -+#define BIT_TXTIMEOUT_ERR_8814B BIT(5) -+#define BIT_NULLPAGE_ERR_8814B BIT(4) -+#define BIT_CONTENTION_ERR_8814B BIT(3) -+#define BIT_HEADNULL_ERR_8814B BIT(2) -+#define BIT_OVERFLOW_ERR_8814B BIT(1) -+#define BIT_QUEUE_INDEX_ERR_8814B BIT(0) -+ -+/* 2 REG_NULL_PKT_STATUS_V2_8814B */ -+#define BIT_HIQ_DROP_8814B BIT(7) -+#define BIT_MGQ_DROP_8814B BIT(6) -+#define BIT_TX_NULL_1_V1_8814B BIT(1) -+#define BIT_TX_NULL_0_V1_8814B BIT(0) -+ -+/* 2 REG_PRECNT_CTRL_8814B */ -+#define BIT_EN_PRECNT_8814B BIT(11) -+ -+#define BIT_SHIFT_PRECNT_TH_8814B 0 -+#define BIT_MASK_PRECNT_TH_8814B 0x7ff -+#define BIT_PRECNT_TH_8814B(x) \ -+ (((x) & BIT_MASK_PRECNT_TH_8814B) << BIT_SHIFT_PRECNT_TH_8814B) -+#define BITS_PRECNT_TH_8814B \ -+ (BIT_MASK_PRECNT_TH_8814B << BIT_SHIFT_PRECNT_TH_8814B) -+#define BIT_CLEAR_PRECNT_TH_8814B(x) ((x) & (~BITS_PRECNT_TH_8814B)) -+#define BIT_GET_PRECNT_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_PRECNT_TH_8814B) & BIT_MASK_PRECNT_TH_8814B) -+#define BIT_SET_PRECNT_TH_8814B(x, v) \ -+ (BIT_CLEAR_PRECNT_TH_8814B(x) | BIT_PRECNT_TH_8814B(v)) -+ -+/* 2 REG_NULL_PKT_STATUS_EXTEND_V1_8814B */ -+#define BIT_CLI3_TX_NULL_1_V1_8814B BIT(7) -+#define BIT_CLI3_TX_NULL_0_V1_8814B BIT(6) -+#define BIT_CLI2_TX_NULL_1_V1_8814B BIT(5) -+#define BIT_CLI2_TX_NULL_0_V1_8814B BIT(4) -+#define BIT_CLI1_TX_NULL_1_V1_8814B BIT(3) -+#define BIT_CLI1_TX_NULL_0_V1_8814B BIT(2) -+#define BIT_CLI0_TX_NULL_1_V1_8814B BIT(1) -+#define BIT_CLI0_TX_NULL_0_V1_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_PTCL_DBG_V1_8814B */ -+ -+#define BIT_SHIFT_PTCL_DBG_8814B 0 -+#define BIT_MASK_PTCL_DBG_8814B 0xffffffffL -+#define BIT_PTCL_DBG_8814B(x) \ -+ (((x) & BIT_MASK_PTCL_DBG_8814B) << BIT_SHIFT_PTCL_DBG_8814B) -+#define BITS_PTCL_DBG_8814B \ -+ (BIT_MASK_PTCL_DBG_8814B << BIT_SHIFT_PTCL_DBG_8814B) -+#define BIT_CLEAR_PTCL_DBG_8814B(x) ((x) & (~BITS_PTCL_DBG_8814B)) -+#define BIT_GET_PTCL_DBG_8814B(x) \ -+ (((x) >> BIT_SHIFT_PTCL_DBG_8814B) & BIT_MASK_PTCL_DBG_8814B) -+#define BIT_SET_PTCL_DBG_8814B(x, v) \ -+ (BIT_CLEAR_PTCL_DBG_8814B(x) | BIT_PTCL_DBG_8814B(v)) -+ -+/* 2 REG_BT_POLLUTE_PKTCNT_8814B */ -+ -+#define BIT_SHIFT_BT_POLLUTE_PKTCNT_8814B 0 -+#define BIT_MASK_BT_POLLUTE_PKTCNT_8814B 0xffff -+#define BIT_BT_POLLUTE_PKTCNT_8814B(x) \ -+ (((x) & BIT_MASK_BT_POLLUTE_PKTCNT_8814B) \ -+ << BIT_SHIFT_BT_POLLUTE_PKTCNT_8814B) -+#define BITS_BT_POLLUTE_PKTCNT_8814B \ -+ (BIT_MASK_BT_POLLUTE_PKTCNT_8814B << BIT_SHIFT_BT_POLLUTE_PKTCNT_8814B) -+#define BIT_CLEAR_BT_POLLUTE_PKTCNT_8814B(x) \ -+ ((x) & (~BITS_BT_POLLUTE_PKTCNT_8814B)) -+#define BIT_GET_BT_POLLUTE_PKTCNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_POLLUTE_PKTCNT_8814B) & \ -+ BIT_MASK_BT_POLLUTE_PKTCNT_8814B) -+#define BIT_SET_BT_POLLUTE_PKTCNT_8814B(x, v) \ -+ (BIT_CLEAR_BT_POLLUTE_PKTCNT_8814B(x) | BIT_BT_POLLUTE_PKTCNT_8814B(v)) -+ -+/* 2 REG_CPUMGQ_TIMER_CTRL2_8814B */ -+ -+#define BIT_SHIFT_TRI_HEAD_ADDR_8814B 16 -+#define BIT_MASK_TRI_HEAD_ADDR_8814B 0xfff -+#define BIT_TRI_HEAD_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_TRI_HEAD_ADDR_8814B) << BIT_SHIFT_TRI_HEAD_ADDR_8814B) -+#define BITS_TRI_HEAD_ADDR_8814B \ -+ (BIT_MASK_TRI_HEAD_ADDR_8814B << BIT_SHIFT_TRI_HEAD_ADDR_8814B) -+#define BIT_CLEAR_TRI_HEAD_ADDR_8814B(x) ((x) & (~BITS_TRI_HEAD_ADDR_8814B)) -+#define BIT_GET_TRI_HEAD_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_TRI_HEAD_ADDR_8814B) & BIT_MASK_TRI_HEAD_ADDR_8814B) -+#define BIT_SET_TRI_HEAD_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_TRI_HEAD_ADDR_8814B(x) | BIT_TRI_HEAD_ADDR_8814B(v)) -+ -+#define BIT_DROP_TH_EN_8814B BIT(8) -+ -+#define BIT_SHIFT_DROP_TH_8814B 0 -+#define BIT_MASK_DROP_TH_8814B 0xff -+#define BIT_DROP_TH_8814B(x) \ -+ (((x) & BIT_MASK_DROP_TH_8814B) << BIT_SHIFT_DROP_TH_8814B) -+#define BITS_DROP_TH_8814B (BIT_MASK_DROP_TH_8814B << BIT_SHIFT_DROP_TH_8814B) -+#define BIT_CLEAR_DROP_TH_8814B(x) ((x) & (~BITS_DROP_TH_8814B)) -+#define BIT_GET_DROP_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_DROP_TH_8814B) & BIT_MASK_DROP_TH_8814B) -+#define BIT_SET_DROP_TH_8814B(x, v) \ -+ (BIT_CLEAR_DROP_TH_8814B(x) | BIT_DROP_TH_8814B(v)) -+ -+/* 2 REG_PTCL_DBG_OUT_8814B */ -+ -+#define BIT_SHIFT_PTCL_DBG_OUT_8814B 0 -+#define BIT_MASK_PTCL_DBG_OUT_8814B 0xffffffffL -+#define BIT_PTCL_DBG_OUT_8814B(x) \ -+ (((x) & BIT_MASK_PTCL_DBG_OUT_8814B) << BIT_SHIFT_PTCL_DBG_OUT_8814B) -+#define BITS_PTCL_DBG_OUT_8814B \ -+ (BIT_MASK_PTCL_DBG_OUT_8814B << BIT_SHIFT_PTCL_DBG_OUT_8814B) -+#define BIT_CLEAR_PTCL_DBG_OUT_8814B(x) ((x) & (~BITS_PTCL_DBG_OUT_8814B)) -+#define BIT_GET_PTCL_DBG_OUT_8814B(x) \ -+ (((x) >> BIT_SHIFT_PTCL_DBG_OUT_8814B) & BIT_MASK_PTCL_DBG_OUT_8814B) -+#define BIT_SET_PTCL_DBG_OUT_8814B(x, v) \ -+ (BIT_CLEAR_PTCL_DBG_OUT_8814B(x) | BIT_PTCL_DBG_OUT_8814B(v)) -+ -+/* 2 REG_DUMMY_PAGE4_V1_8814B */ -+ -+/* 2 REG_DUMMY_PAGE4_1_8814B */ -+ -+/* 2 REG_MU_OFFSET_8814B */ -+ -+#define BIT_SHIFT_MU_RATETABLE_OFFSET_8814B 16 -+#define BIT_MASK_MU_RATETABLE_OFFSET_8814B 0x1ff -+#define BIT_MU_RATETABLE_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_MU_RATETABLE_OFFSET_8814B) \ -+ << BIT_SHIFT_MU_RATETABLE_OFFSET_8814B) -+#define BITS_MU_RATETABLE_OFFSET_8814B \ -+ (BIT_MASK_MU_RATETABLE_OFFSET_8814B \ -+ << BIT_SHIFT_MU_RATETABLE_OFFSET_8814B) -+#define BIT_CLEAR_MU_RATETABLE_OFFSET_8814B(x) \ -+ ((x) & (~BITS_MU_RATETABLE_OFFSET_8814B)) -+#define BIT_GET_MU_RATETABLE_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_RATETABLE_OFFSET_8814B) & \ -+ BIT_MASK_MU_RATETABLE_OFFSET_8814B) -+#define BIT_SET_MU_RATETABLE_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_MU_RATETABLE_OFFSET_8814B(x) | \ -+ BIT_MU_RATETABLE_OFFSET_8814B(v)) -+ -+#define BIT_SHIFT_MU_SCORETABLE_OFFSET_8814B 0 -+#define BIT_MASK_MU_SCORETABLE_OFFSET_8814B 0x1ff -+#define BIT_MU_SCORETABLE_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_MU_SCORETABLE_OFFSET_8814B) \ -+ << BIT_SHIFT_MU_SCORETABLE_OFFSET_8814B) -+#define BITS_MU_SCORETABLE_OFFSET_8814B \ -+ (BIT_MASK_MU_SCORETABLE_OFFSET_8814B \ -+ << BIT_SHIFT_MU_SCORETABLE_OFFSET_8814B) -+#define BIT_CLEAR_MU_SCORETABLE_OFFSET_8814B(x) \ -+ ((x) & (~BITS_MU_SCORETABLE_OFFSET_8814B)) -+#define BIT_GET_MU_SCORETABLE_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_SCORETABLE_OFFSET_8814B) & \ -+ BIT_MASK_MU_SCORETABLE_OFFSET_8814B) -+#define BIT_SET_MU_SCORETABLE_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_MU_SCORETABLE_OFFSET_8814B(x) | \ -+ BIT_MU_SCORETABLE_OFFSET_8814B(v)) -+ -+/* 2 REG_BF0_TIME_SETTING_8814B */ -+#define BIT_BF0_TIMER_SET_8814B BIT(31) -+#define BIT_BF0_TIMER_CLR_8814B BIT(30) -+#define BIT_BF0_UPDATE_EN_8814B BIT(29) -+#define BIT_BF0_TIMER_EN_8814B BIT(28) -+ -+#define BIT_SHIFT_BF0_PRETIME_OVER_8814B 16 -+#define BIT_MASK_BF0_PRETIME_OVER_8814B 0xfff -+#define BIT_BF0_PRETIME_OVER_8814B(x) \ -+ (((x) & BIT_MASK_BF0_PRETIME_OVER_8814B) \ -+ << BIT_SHIFT_BF0_PRETIME_OVER_8814B) -+#define BITS_BF0_PRETIME_OVER_8814B \ -+ (BIT_MASK_BF0_PRETIME_OVER_8814B << BIT_SHIFT_BF0_PRETIME_OVER_8814B) -+#define BIT_CLEAR_BF0_PRETIME_OVER_8814B(x) \ -+ ((x) & (~BITS_BF0_PRETIME_OVER_8814B)) -+#define BIT_GET_BF0_PRETIME_OVER_8814B(x) \ -+ (((x) >> BIT_SHIFT_BF0_PRETIME_OVER_8814B) & \ -+ BIT_MASK_BF0_PRETIME_OVER_8814B) -+#define BIT_SET_BF0_PRETIME_OVER_8814B(x, v) \ -+ (BIT_CLEAR_BF0_PRETIME_OVER_8814B(x) | BIT_BF0_PRETIME_OVER_8814B(v)) -+ -+#define BIT_SHIFT_BF0_LIFETIME_8814B 0 -+#define BIT_MASK_BF0_LIFETIME_8814B 0xffff -+#define BIT_BF0_LIFETIME_8814B(x) \ -+ (((x) & BIT_MASK_BF0_LIFETIME_8814B) << BIT_SHIFT_BF0_LIFETIME_8814B) -+#define BITS_BF0_LIFETIME_8814B \ -+ (BIT_MASK_BF0_LIFETIME_8814B << BIT_SHIFT_BF0_LIFETIME_8814B) -+#define BIT_CLEAR_BF0_LIFETIME_8814B(x) ((x) & (~BITS_BF0_LIFETIME_8814B)) -+#define BIT_GET_BF0_LIFETIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_BF0_LIFETIME_8814B) & BIT_MASK_BF0_LIFETIME_8814B) -+#define BIT_SET_BF0_LIFETIME_8814B(x, v) \ -+ (BIT_CLEAR_BF0_LIFETIME_8814B(x) | BIT_BF0_LIFETIME_8814B(v)) -+ -+/* 2 REG_BF1_TIME_SETTING_8814B */ -+#define BIT_BF1_TIMER_SET_8814B BIT(31) -+#define BIT_BF1_TIMER_CLR_8814B BIT(30) -+#define BIT_BF1_UPDATE_EN_8814B BIT(29) -+#define BIT_BF1_TIMER_EN_8814B BIT(28) -+ -+#define BIT_SHIFT_BF1_PRETIME_OVER_8814B 16 -+#define BIT_MASK_BF1_PRETIME_OVER_8814B 0xfff -+#define BIT_BF1_PRETIME_OVER_8814B(x) \ -+ (((x) & BIT_MASK_BF1_PRETIME_OVER_8814B) \ -+ << BIT_SHIFT_BF1_PRETIME_OVER_8814B) -+#define BITS_BF1_PRETIME_OVER_8814B \ -+ (BIT_MASK_BF1_PRETIME_OVER_8814B << BIT_SHIFT_BF1_PRETIME_OVER_8814B) -+#define BIT_CLEAR_BF1_PRETIME_OVER_8814B(x) \ -+ ((x) & (~BITS_BF1_PRETIME_OVER_8814B)) -+#define BIT_GET_BF1_PRETIME_OVER_8814B(x) \ -+ (((x) >> BIT_SHIFT_BF1_PRETIME_OVER_8814B) & \ -+ BIT_MASK_BF1_PRETIME_OVER_8814B) -+#define BIT_SET_BF1_PRETIME_OVER_8814B(x, v) \ -+ (BIT_CLEAR_BF1_PRETIME_OVER_8814B(x) | BIT_BF1_PRETIME_OVER_8814B(v)) -+ -+#define BIT_SHIFT_BF1_LIFETIME_8814B 0 -+#define BIT_MASK_BF1_LIFETIME_8814B 0xffff -+#define BIT_BF1_LIFETIME_8814B(x) \ -+ (((x) & BIT_MASK_BF1_LIFETIME_8814B) << BIT_SHIFT_BF1_LIFETIME_8814B) -+#define BITS_BF1_LIFETIME_8814B \ -+ (BIT_MASK_BF1_LIFETIME_8814B << BIT_SHIFT_BF1_LIFETIME_8814B) -+#define BIT_CLEAR_BF1_LIFETIME_8814B(x) ((x) & (~BITS_BF1_LIFETIME_8814B)) -+#define BIT_GET_BF1_LIFETIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_BF1_LIFETIME_8814B) & BIT_MASK_BF1_LIFETIME_8814B) -+#define BIT_SET_BF1_LIFETIME_8814B(x, v) \ -+ (BIT_CLEAR_BF1_LIFETIME_8814B(x) | BIT_BF1_LIFETIME_8814B(v)) -+ -+/* 2 REG_BF_TIMEOUT_EN_8814B */ -+#define BIT_EN_VHT_LDPC_8814B BIT(9) -+#define BIT_EN_HT_LDPC_8814B BIT(8) -+#define BIT_BF1_TIMEOUT_EN_8814B BIT(1) -+#define BIT_BF0_TIMEOUT_EN_8814B BIT(0) -+ -+/* 2 REG_MACID_RELEASE_INFO_8814B */ -+ -+#define BIT_SHIFT_MACID_RELEASE_INFO_8814B 0 -+#define BIT_MASK_MACID_RELEASE_INFO_8814B 0xffffffffL -+#define BIT_MACID_RELEASE_INFO_8814B(x) \ -+ (((x) & BIT_MASK_MACID_RELEASE_INFO_8814B) \ -+ << BIT_SHIFT_MACID_RELEASE_INFO_8814B) -+#define BITS_MACID_RELEASE_INFO_8814B \ -+ (BIT_MASK_MACID_RELEASE_INFO_8814B \ -+ << BIT_SHIFT_MACID_RELEASE_INFO_8814B) -+#define BIT_CLEAR_MACID_RELEASE_INFO_8814B(x) \ -+ ((x) & (~BITS_MACID_RELEASE_INFO_8814B)) -+#define BIT_GET_MACID_RELEASE_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_RELEASE_INFO_8814B) & \ -+ BIT_MASK_MACID_RELEASE_INFO_8814B) -+#define BIT_SET_MACID_RELEASE_INFO_8814B(x, v) \ -+ (BIT_CLEAR_MACID_RELEASE_INFO_8814B(x) | \ -+ BIT_MACID_RELEASE_INFO_8814B(v)) -+ -+/* 2 REG_MACID_RELEASE_SUCCESS_INFO_8814B */ -+ -+#define BIT_SHIFT_MACID_RELEASE_SUCCESS_INFO_8814B 0 -+#define BIT_MASK_MACID_RELEASE_SUCCESS_INFO_8814B 0xffffffffL -+#define BIT_MACID_RELEASE_SUCCESS_INFO_8814B(x) \ -+ (((x) & BIT_MASK_MACID_RELEASE_SUCCESS_INFO_8814B) \ -+ << BIT_SHIFT_MACID_RELEASE_SUCCESS_INFO_8814B) -+#define BITS_MACID_RELEASE_SUCCESS_INFO_8814B \ -+ (BIT_MASK_MACID_RELEASE_SUCCESS_INFO_8814B \ -+ << BIT_SHIFT_MACID_RELEASE_SUCCESS_INFO_8814B) -+#define BIT_CLEAR_MACID_RELEASE_SUCCESS_INFO_8814B(x) \ -+ ((x) & (~BITS_MACID_RELEASE_SUCCESS_INFO_8814B)) -+#define BIT_GET_MACID_RELEASE_SUCCESS_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_RELEASE_SUCCESS_INFO_8814B) & \ -+ BIT_MASK_MACID_RELEASE_SUCCESS_INFO_8814B) -+#define BIT_SET_MACID_RELEASE_SUCCESS_INFO_8814B(x, v) \ -+ (BIT_CLEAR_MACID_RELEASE_SUCCESS_INFO_8814B(x) | \ -+ BIT_MACID_RELEASE_SUCCESS_INFO_8814B(v)) -+ -+/* 2 REG_MACID_RELEASE_CTRL_8814B */ -+ -+#define BIT_SHIFT_MACID_RELEASE_SEL_8814B 24 -+#define BIT_MASK_MACID_RELEASE_SEL_8814B 0x7 -+#define BIT_MACID_RELEASE_SEL_8814B(x) \ -+ (((x) & BIT_MASK_MACID_RELEASE_SEL_8814B) \ -+ << BIT_SHIFT_MACID_RELEASE_SEL_8814B) -+#define BITS_MACID_RELEASE_SEL_8814B \ -+ (BIT_MASK_MACID_RELEASE_SEL_8814B << BIT_SHIFT_MACID_RELEASE_SEL_8814B) -+#define BIT_CLEAR_MACID_RELEASE_SEL_8814B(x) \ -+ ((x) & (~BITS_MACID_RELEASE_SEL_8814B)) -+#define BIT_GET_MACID_RELEASE_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_RELEASE_SEL_8814B) & \ -+ BIT_MASK_MACID_RELEASE_SEL_8814B) -+#define BIT_SET_MACID_RELEASE_SEL_8814B(x, v) \ -+ (BIT_CLEAR_MACID_RELEASE_SEL_8814B(x) | BIT_MACID_RELEASE_SEL_8814B(v)) -+ -+#define BIT_SHIFT_MACID_RELEASE_CLEAR_OFFSET_8814B 16 -+#define BIT_MASK_MACID_RELEASE_CLEAR_OFFSET_8814B 0xff -+#define BIT_MACID_RELEASE_CLEAR_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_MACID_RELEASE_CLEAR_OFFSET_8814B) \ -+ << BIT_SHIFT_MACID_RELEASE_CLEAR_OFFSET_8814B) -+#define BITS_MACID_RELEASE_CLEAR_OFFSET_8814B \ -+ (BIT_MASK_MACID_RELEASE_CLEAR_OFFSET_8814B \ -+ << BIT_SHIFT_MACID_RELEASE_CLEAR_OFFSET_8814B) -+#define BIT_CLEAR_MACID_RELEASE_CLEAR_OFFSET_8814B(x) \ -+ ((x) & (~BITS_MACID_RELEASE_CLEAR_OFFSET_8814B)) -+#define BIT_GET_MACID_RELEASE_CLEAR_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_RELEASE_CLEAR_OFFSET_8814B) & \ -+ BIT_MASK_MACID_RELEASE_CLEAR_OFFSET_8814B) -+#define BIT_SET_MACID_RELEASE_CLEAR_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_MACID_RELEASE_CLEAR_OFFSET_8814B(x) | \ -+ BIT_MACID_RELEASE_CLEAR_OFFSET_8814B(v)) -+ -+#define BIT_MACID_RELEASE_VALUE_8814B BIT(8) -+ -+#define BIT_SHIFT_MACID_RELEASE_OFFSET_8814B 0 -+#define BIT_MASK_MACID_RELEASE_OFFSET_8814B 0xff -+#define BIT_MACID_RELEASE_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_MACID_RELEASE_OFFSET_8814B) \ -+ << BIT_SHIFT_MACID_RELEASE_OFFSET_8814B) -+#define BITS_MACID_RELEASE_OFFSET_8814B \ -+ (BIT_MASK_MACID_RELEASE_OFFSET_8814B \ -+ << BIT_SHIFT_MACID_RELEASE_OFFSET_8814B) -+#define BIT_CLEAR_MACID_RELEASE_OFFSET_8814B(x) \ -+ ((x) & (~BITS_MACID_RELEASE_OFFSET_8814B)) -+#define BIT_GET_MACID_RELEASE_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_RELEASE_OFFSET_8814B) & \ -+ BIT_MASK_MACID_RELEASE_OFFSET_8814B) -+#define BIT_SET_MACID_RELEASE_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_MACID_RELEASE_OFFSET_8814B(x) | \ -+ BIT_MACID_RELEASE_OFFSET_8814B(v)) -+ -+/* 2 REG_FAST_EDCA_VOVI_SETTING_8814B */ -+ -+#define BIT_SHIFT_VI_FAST_EDCA_TO_8814B 24 -+#define BIT_MASK_VI_FAST_EDCA_TO_8814B 0xff -+#define BIT_VI_FAST_EDCA_TO_8814B(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_TO_8814B) \ -+ << BIT_SHIFT_VI_FAST_EDCA_TO_8814B) -+#define BITS_VI_FAST_EDCA_TO_8814B \ -+ (BIT_MASK_VI_FAST_EDCA_TO_8814B << BIT_SHIFT_VI_FAST_EDCA_TO_8814B) -+#define BIT_CLEAR_VI_FAST_EDCA_TO_8814B(x) ((x) & (~BITS_VI_FAST_EDCA_TO_8814B)) -+#define BIT_GET_VI_FAST_EDCA_TO_8814B(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_TO_8814B) & \ -+ BIT_MASK_VI_FAST_EDCA_TO_8814B) -+#define BIT_SET_VI_FAST_EDCA_TO_8814B(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_TO_8814B(x) | BIT_VI_FAST_EDCA_TO_8814B(v)) -+ -+#define BIT_VI_THRESHOLD_SEL_8814B BIT(23) -+ -+#define BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8814B 16 -+#define BIT_MASK_VI_FAST_EDCA_PKT_TH_8814B 0x7f -+#define BIT_VI_FAST_EDCA_PKT_TH_8814B(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_PKT_TH_8814B) \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8814B) -+#define BITS_VI_FAST_EDCA_PKT_TH_8814B \ -+ (BIT_MASK_VI_FAST_EDCA_PKT_TH_8814B \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8814B) -+#define BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8814B(x) \ -+ ((x) & (~BITS_VI_FAST_EDCA_PKT_TH_8814B)) -+#define BIT_GET_VI_FAST_EDCA_PKT_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8814B) & \ -+ BIT_MASK_VI_FAST_EDCA_PKT_TH_8814B) -+#define BIT_SET_VI_FAST_EDCA_PKT_TH_8814B(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8814B(x) | \ -+ BIT_VI_FAST_EDCA_PKT_TH_8814B(v)) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_TO_8814B 8 -+#define BIT_MASK_VO_FAST_EDCA_TO_8814B 0xff -+#define BIT_VO_FAST_EDCA_TO_8814B(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_TO_8814B) \ -+ << BIT_SHIFT_VO_FAST_EDCA_TO_8814B) -+#define BITS_VO_FAST_EDCA_TO_8814B \ -+ (BIT_MASK_VO_FAST_EDCA_TO_8814B << BIT_SHIFT_VO_FAST_EDCA_TO_8814B) -+#define BIT_CLEAR_VO_FAST_EDCA_TO_8814B(x) ((x) & (~BITS_VO_FAST_EDCA_TO_8814B)) -+#define BIT_GET_VO_FAST_EDCA_TO_8814B(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_TO_8814B) & \ -+ BIT_MASK_VO_FAST_EDCA_TO_8814B) -+#define BIT_SET_VO_FAST_EDCA_TO_8814B(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_TO_8814B(x) | BIT_VO_FAST_EDCA_TO_8814B(v)) -+ -+#define BIT_VO_THRESHOLD_SEL_8814B BIT(7) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8814B 0 -+#define BIT_MASK_VO_FAST_EDCA_PKT_TH_8814B 0x7f -+#define BIT_VO_FAST_EDCA_PKT_TH_8814B(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_PKT_TH_8814B) \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8814B) -+#define BITS_VO_FAST_EDCA_PKT_TH_8814B \ -+ (BIT_MASK_VO_FAST_EDCA_PKT_TH_8814B \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8814B) -+#define BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8814B(x) \ -+ ((x) & (~BITS_VO_FAST_EDCA_PKT_TH_8814B)) -+#define BIT_GET_VO_FAST_EDCA_PKT_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8814B) & \ -+ BIT_MASK_VO_FAST_EDCA_PKT_TH_8814B) -+#define BIT_SET_VO_FAST_EDCA_PKT_TH_8814B(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8814B(x) | \ -+ BIT_VO_FAST_EDCA_PKT_TH_8814B(v)) -+ -+/* 2 REG_FAST_EDCA_BEBK_SETTING_8814B */ -+ -+#define BIT_SHIFT_BK_FAST_EDCA_TO_8814B 24 -+#define BIT_MASK_BK_FAST_EDCA_TO_8814B 0xff -+#define BIT_BK_FAST_EDCA_TO_8814B(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_TO_8814B) \ -+ << BIT_SHIFT_BK_FAST_EDCA_TO_8814B) -+#define BITS_BK_FAST_EDCA_TO_8814B \ -+ (BIT_MASK_BK_FAST_EDCA_TO_8814B << BIT_SHIFT_BK_FAST_EDCA_TO_8814B) -+#define BIT_CLEAR_BK_FAST_EDCA_TO_8814B(x) ((x) & (~BITS_BK_FAST_EDCA_TO_8814B)) -+#define BIT_GET_BK_FAST_EDCA_TO_8814B(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_TO_8814B) & \ -+ BIT_MASK_BK_FAST_EDCA_TO_8814B) -+#define BIT_SET_BK_FAST_EDCA_TO_8814B(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_TO_8814B(x) | BIT_BK_FAST_EDCA_TO_8814B(v)) -+ -+#define BIT_BK_THRESHOLD_SEL_8814B BIT(23) -+ -+#define BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8814B 16 -+#define BIT_MASK_BK_FAST_EDCA_PKT_TH_8814B 0x7f -+#define BIT_BK_FAST_EDCA_PKT_TH_8814B(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_PKT_TH_8814B) \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8814B) -+#define BITS_BK_FAST_EDCA_PKT_TH_8814B \ -+ (BIT_MASK_BK_FAST_EDCA_PKT_TH_8814B \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8814B) -+#define BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8814B(x) \ -+ ((x) & (~BITS_BK_FAST_EDCA_PKT_TH_8814B)) -+#define BIT_GET_BK_FAST_EDCA_PKT_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8814B) & \ -+ BIT_MASK_BK_FAST_EDCA_PKT_TH_8814B) -+#define BIT_SET_BK_FAST_EDCA_PKT_TH_8814B(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8814B(x) | \ -+ BIT_BK_FAST_EDCA_PKT_TH_8814B(v)) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_TO_8814B 8 -+#define BIT_MASK_BE_FAST_EDCA_TO_8814B 0xff -+#define BIT_BE_FAST_EDCA_TO_8814B(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_TO_8814B) \ -+ << BIT_SHIFT_BE_FAST_EDCA_TO_8814B) -+#define BITS_BE_FAST_EDCA_TO_8814B \ -+ (BIT_MASK_BE_FAST_EDCA_TO_8814B << BIT_SHIFT_BE_FAST_EDCA_TO_8814B) -+#define BIT_CLEAR_BE_FAST_EDCA_TO_8814B(x) ((x) & (~BITS_BE_FAST_EDCA_TO_8814B)) -+#define BIT_GET_BE_FAST_EDCA_TO_8814B(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_TO_8814B) & \ -+ BIT_MASK_BE_FAST_EDCA_TO_8814B) -+#define BIT_SET_BE_FAST_EDCA_TO_8814B(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_TO_8814B(x) | BIT_BE_FAST_EDCA_TO_8814B(v)) -+ -+#define BIT_BE_THRESHOLD_SEL_8814B BIT(7) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8814B 0 -+#define BIT_MASK_BE_FAST_EDCA_PKT_TH_8814B 0x7f -+#define BIT_BE_FAST_EDCA_PKT_TH_8814B(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_PKT_TH_8814B) \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8814B) -+#define BITS_BE_FAST_EDCA_PKT_TH_8814B \ -+ (BIT_MASK_BE_FAST_EDCA_PKT_TH_8814B \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8814B) -+#define BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8814B(x) \ -+ ((x) & (~BITS_BE_FAST_EDCA_PKT_TH_8814B)) -+#define BIT_GET_BE_FAST_EDCA_PKT_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8814B) & \ -+ BIT_MASK_BE_FAST_EDCA_PKT_TH_8814B) -+#define BIT_SET_BE_FAST_EDCA_PKT_TH_8814B(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8814B(x) | \ -+ BIT_BE_FAST_EDCA_PKT_TH_8814B(v)) -+ -+/* 2 REG_MACID_DROP_INFO_8814B */ -+ -+#define BIT_SHIFT_MACID_DROP_INFO_8814B 0 -+#define BIT_MASK_MACID_DROP_INFO_8814B 0xffffffffL -+#define BIT_MACID_DROP_INFO_8814B(x) \ -+ (((x) & BIT_MASK_MACID_DROP_INFO_8814B) \ -+ << BIT_SHIFT_MACID_DROP_INFO_8814B) -+#define BITS_MACID_DROP_INFO_8814B \ -+ (BIT_MASK_MACID_DROP_INFO_8814B << BIT_SHIFT_MACID_DROP_INFO_8814B) -+#define BIT_CLEAR_MACID_DROP_INFO_8814B(x) ((x) & (~BITS_MACID_DROP_INFO_8814B)) -+#define BIT_GET_MACID_DROP_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_DROP_INFO_8814B) & \ -+ BIT_MASK_MACID_DROP_INFO_8814B) -+#define BIT_SET_MACID_DROP_INFO_8814B(x, v) \ -+ (BIT_CLEAR_MACID_DROP_INFO_8814B(x) | BIT_MACID_DROP_INFO_8814B(v)) -+ -+/* 2 REG_MACID_DROP_CTRL_8814B */ -+ -+#define BIT_SHIFT_MACID_DROP_SEL_8814B 0 -+#define BIT_MASK_MACID_DROP_SEL_8814B 0x7 -+#define BIT_MACID_DROP_SEL_8814B(x) \ -+ (((x) & BIT_MASK_MACID_DROP_SEL_8814B) \ -+ << BIT_SHIFT_MACID_DROP_SEL_8814B) -+#define BITS_MACID_DROP_SEL_8814B \ -+ (BIT_MASK_MACID_DROP_SEL_8814B << BIT_SHIFT_MACID_DROP_SEL_8814B) -+#define BIT_CLEAR_MACID_DROP_SEL_8814B(x) ((x) & (~BITS_MACID_DROP_SEL_8814B)) -+#define BIT_GET_MACID_DROP_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_DROP_SEL_8814B) & \ -+ BIT_MASK_MACID_DROP_SEL_8814B) -+#define BIT_SET_MACID_DROP_SEL_8814B(x, v) \ -+ (BIT_CLEAR_MACID_DROP_SEL_8814B(x) | BIT_MACID_DROP_SEL_8814B(v)) -+ -+/* 2 REG_MGQ_FIFO_WRITE_POINTER_8814B */ -+#define BIT_MGQ_FIFO_OV_8814B BIT(7) -+#define BIT_MGQ_FIFO_WPTR_ERROR_8814B BIT(6) -+#define BIT_EN_MGQ_FIFO_LIFETIME_8814B BIT(5) -+ -+#define BIT_SHIFT_MGQ_FIFO_WPTR_8814B 0 -+#define BIT_MASK_MGQ_FIFO_WPTR_8814B 0x1f -+#define BIT_MGQ_FIFO_WPTR_8814B(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_WPTR_8814B) << BIT_SHIFT_MGQ_FIFO_WPTR_8814B) -+#define BITS_MGQ_FIFO_WPTR_8814B \ -+ (BIT_MASK_MGQ_FIFO_WPTR_8814B << BIT_SHIFT_MGQ_FIFO_WPTR_8814B) -+#define BIT_CLEAR_MGQ_FIFO_WPTR_8814B(x) ((x) & (~BITS_MGQ_FIFO_WPTR_8814B)) -+#define BIT_GET_MGQ_FIFO_WPTR_8814B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_WPTR_8814B) & BIT_MASK_MGQ_FIFO_WPTR_8814B) -+#define BIT_SET_MGQ_FIFO_WPTR_8814B(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_WPTR_8814B(x) | BIT_MGQ_FIFO_WPTR_8814B(v)) -+ -+/* 2 REG_MGQ_FIFO_READ_POINTER_8814B */ -+ -+#define BIT_SHIFT_MGQ_FIFO_SIZE_8814B 14 -+#define BIT_MASK_MGQ_FIFO_SIZE_8814B 0x3 -+#define BIT_MGQ_FIFO_SIZE_8814B(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_SIZE_8814B) << BIT_SHIFT_MGQ_FIFO_SIZE_8814B) -+#define BITS_MGQ_FIFO_SIZE_8814B \ -+ (BIT_MASK_MGQ_FIFO_SIZE_8814B << BIT_SHIFT_MGQ_FIFO_SIZE_8814B) -+#define BIT_CLEAR_MGQ_FIFO_SIZE_8814B(x) ((x) & (~BITS_MGQ_FIFO_SIZE_8814B)) -+#define BIT_GET_MGQ_FIFO_SIZE_8814B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_SIZE_8814B) & BIT_MASK_MGQ_FIFO_SIZE_8814B) -+#define BIT_SET_MGQ_FIFO_SIZE_8814B(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_SIZE_8814B(x) | BIT_MGQ_FIFO_SIZE_8814B(v)) -+ -+#define BIT_MGQ_FIFO_PAUSE_8814B BIT(13) -+ -+#define BIT_SHIFT_MGQ_FIFO_RPTR_8814B 8 -+#define BIT_MASK_MGQ_FIFO_RPTR_8814B 0x1f -+#define BIT_MGQ_FIFO_RPTR_8814B(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_RPTR_8814B) << BIT_SHIFT_MGQ_FIFO_RPTR_8814B) -+#define BITS_MGQ_FIFO_RPTR_8814B \ -+ (BIT_MASK_MGQ_FIFO_RPTR_8814B << BIT_SHIFT_MGQ_FIFO_RPTR_8814B) -+#define BIT_CLEAR_MGQ_FIFO_RPTR_8814B(x) ((x) & (~BITS_MGQ_FIFO_RPTR_8814B)) -+#define BIT_GET_MGQ_FIFO_RPTR_8814B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_RPTR_8814B) & BIT_MASK_MGQ_FIFO_RPTR_8814B) -+#define BIT_SET_MGQ_FIFO_RPTR_8814B(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_RPTR_8814B(x) | BIT_MGQ_FIFO_RPTR_8814B(v)) -+ -+/* 2 REG_MGQ_FIFO_ENABLE_8814B */ -+#define BIT_MGQ_FIFO_EN_V1_8814B BIT(15) -+ -+#define BIT_SHIFT_MGQ_FIFO_PG_SIZE_8814B 12 -+#define BIT_MASK_MGQ_FIFO_PG_SIZE_8814B 0x7 -+#define BIT_MGQ_FIFO_PG_SIZE_8814B(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_PG_SIZE_8814B) \ -+ << BIT_SHIFT_MGQ_FIFO_PG_SIZE_8814B) -+#define BITS_MGQ_FIFO_PG_SIZE_8814B \ -+ (BIT_MASK_MGQ_FIFO_PG_SIZE_8814B << BIT_SHIFT_MGQ_FIFO_PG_SIZE_8814B) -+#define BIT_CLEAR_MGQ_FIFO_PG_SIZE_8814B(x) \ -+ ((x) & (~BITS_MGQ_FIFO_PG_SIZE_8814B)) -+#define BIT_GET_MGQ_FIFO_PG_SIZE_8814B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_PG_SIZE_8814B) & \ -+ BIT_MASK_MGQ_FIFO_PG_SIZE_8814B) -+#define BIT_SET_MGQ_FIFO_PG_SIZE_8814B(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_PG_SIZE_8814B(x) | BIT_MGQ_FIFO_PG_SIZE_8814B(v)) -+ -+#define BIT_SHIFT_MGQ_FIFO_START_PG_8814B 0 -+#define BIT_MASK_MGQ_FIFO_START_PG_8814B 0xfff -+#define BIT_MGQ_FIFO_START_PG_8814B(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_START_PG_8814B) \ -+ << BIT_SHIFT_MGQ_FIFO_START_PG_8814B) -+#define BITS_MGQ_FIFO_START_PG_8814B \ -+ (BIT_MASK_MGQ_FIFO_START_PG_8814B << BIT_SHIFT_MGQ_FIFO_START_PG_8814B) -+#define BIT_CLEAR_MGQ_FIFO_START_PG_8814B(x) \ -+ ((x) & (~BITS_MGQ_FIFO_START_PG_8814B)) -+#define BIT_GET_MGQ_FIFO_START_PG_8814B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_START_PG_8814B) & \ -+ BIT_MASK_MGQ_FIFO_START_PG_8814B) -+#define BIT_SET_MGQ_FIFO_START_PG_8814B(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_START_PG_8814B(x) | BIT_MGQ_FIFO_START_PG_8814B(v)) -+ -+/* 2 REG_MGQ_FIFO_RELEASE_INT_MASK_8814B */ -+ -+#define BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8814B 0 -+#define BIT_MASK_MGQ_FIFO_REL_INT_MASK_8814B 0xffff -+#define BIT_MGQ_FIFO_REL_INT_MASK_8814B(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_REL_INT_MASK_8814B) \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8814B) -+#define BITS_MGQ_FIFO_REL_INT_MASK_8814B \ -+ (BIT_MASK_MGQ_FIFO_REL_INT_MASK_8814B \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8814B) -+#define BIT_CLEAR_MGQ_FIFO_REL_INT_MASK_8814B(x) \ -+ ((x) & (~BITS_MGQ_FIFO_REL_INT_MASK_8814B)) -+#define BIT_GET_MGQ_FIFO_REL_INT_MASK_8814B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8814B) & \ -+ BIT_MASK_MGQ_FIFO_REL_INT_MASK_8814B) -+#define BIT_SET_MGQ_FIFO_REL_INT_MASK_8814B(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_REL_INT_MASK_8814B(x) | \ -+ BIT_MGQ_FIFO_REL_INT_MASK_8814B(v)) -+ -+/* 2 REG_MGQ_FIFO_RELEASE_INT_FLAG_8814B */ -+ -+#define BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8814B 0 -+#define BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8814B 0xffff -+#define BIT_MGQ_FIFO_REL_INT_FLAG_8814B(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8814B) \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8814B) -+#define BITS_MGQ_FIFO_REL_INT_FLAG_8814B \ -+ (BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8814B \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8814B) -+#define BIT_CLEAR_MGQ_FIFO_REL_INT_FLAG_8814B(x) \ -+ ((x) & (~BITS_MGQ_FIFO_REL_INT_FLAG_8814B)) -+#define BIT_GET_MGQ_FIFO_REL_INT_FLAG_8814B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8814B) & \ -+ BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8814B) -+#define BIT_SET_MGQ_FIFO_REL_INT_FLAG_8814B(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_REL_INT_FLAG_8814B(x) | \ -+ BIT_MGQ_FIFO_REL_INT_FLAG_8814B(v)) -+ -+/* 2 REG_MGQ_FIFO_VALID_MAP_8814B */ -+ -+#define BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8814B 0 -+#define BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8814B 0xffff -+#define BIT_MGQ_FIFO_PKT_VALID_MAP_8814B(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8814B) \ -+ << BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8814B) -+#define BITS_MGQ_FIFO_PKT_VALID_MAP_8814B \ -+ (BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8814B \ -+ << BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8814B) -+#define BIT_CLEAR_MGQ_FIFO_PKT_VALID_MAP_8814B(x) \ -+ ((x) & (~BITS_MGQ_FIFO_PKT_VALID_MAP_8814B)) -+#define BIT_GET_MGQ_FIFO_PKT_VALID_MAP_8814B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8814B) & \ -+ BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8814B) -+#define BIT_SET_MGQ_FIFO_PKT_VALID_MAP_8814B(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_PKT_VALID_MAP_8814B(x) | \ -+ BIT_MGQ_FIFO_PKT_VALID_MAP_8814B(v)) -+ -+/* 2 REG_MGQ_FIFO_LIFETIME_8814B */ -+ -+#define BIT_SHIFT_MGQ_FIFO_LIFETIME_8814B 0 -+#define BIT_MASK_MGQ_FIFO_LIFETIME_8814B 0xffff -+#define BIT_MGQ_FIFO_LIFETIME_8814B(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_LIFETIME_8814B) \ -+ << BIT_SHIFT_MGQ_FIFO_LIFETIME_8814B) -+#define BITS_MGQ_FIFO_LIFETIME_8814B \ -+ (BIT_MASK_MGQ_FIFO_LIFETIME_8814B << BIT_SHIFT_MGQ_FIFO_LIFETIME_8814B) -+#define BIT_CLEAR_MGQ_FIFO_LIFETIME_8814B(x) \ -+ ((x) & (~BITS_MGQ_FIFO_LIFETIME_8814B)) -+#define BIT_GET_MGQ_FIFO_LIFETIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_LIFETIME_8814B) & \ -+ BIT_MASK_MGQ_FIFO_LIFETIME_8814B) -+#define BIT_SET_MGQ_FIFO_LIFETIME_8814B(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_LIFETIME_8814B(x) | BIT_MGQ_FIFO_LIFETIME_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_PKT_TRANS_8814B */ -+ -+#define BIT_SHIFT_IE_DESC_OFFSET_8814B 16 -+#define BIT_MASK_IE_DESC_OFFSET_8814B 0x1ff -+#define BIT_IE_DESC_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_IE_DESC_OFFSET_8814B) \ -+ << BIT_SHIFT_IE_DESC_OFFSET_8814B) -+#define BITS_IE_DESC_OFFSET_8814B \ -+ (BIT_MASK_IE_DESC_OFFSET_8814B << BIT_SHIFT_IE_DESC_OFFSET_8814B) -+#define BIT_CLEAR_IE_DESC_OFFSET_8814B(x) ((x) & (~BITS_IE_DESC_OFFSET_8814B)) -+#define BIT_GET_IE_DESC_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_IE_DESC_OFFSET_8814B) & \ -+ BIT_MASK_IE_DESC_OFFSET_8814B) -+#define BIT_SET_IE_DESC_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_IE_DESC_OFFSET_8814B(x) | BIT_IE_DESC_OFFSET_8814B(v)) -+ -+#define BIT_DIS_FWCMD_PATH_ERRCHK_8814B BIT(13) -+#define BIT_MAC_HDR_CONVERT_EN_8814B BIT(12) -+#define BIT_TXDESC_TRANS_EN_8814B BIT(8) -+#define BIT_PKT_TRANS_ERRINT_EN_8814B BIT(7) -+ -+#define BIT_SHIFT_PKT_TRANS_ERR_MACID_SEL_8814B 4 -+#define BIT_MASK_PKT_TRANS_ERR_MACID_SEL_8814B 0x3 -+#define BIT_PKT_TRANS_ERR_MACID_SEL_8814B(x) \ -+ (((x) & BIT_MASK_PKT_TRANS_ERR_MACID_SEL_8814B) \ -+ << BIT_SHIFT_PKT_TRANS_ERR_MACID_SEL_8814B) -+#define BITS_PKT_TRANS_ERR_MACID_SEL_8814B \ -+ (BIT_MASK_PKT_TRANS_ERR_MACID_SEL_8814B \ -+ << BIT_SHIFT_PKT_TRANS_ERR_MACID_SEL_8814B) -+#define BIT_CLEAR_PKT_TRANS_ERR_MACID_SEL_8814B(x) \ -+ ((x) & (~BITS_PKT_TRANS_ERR_MACID_SEL_8814B)) -+#define BIT_GET_PKT_TRANS_ERR_MACID_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKT_TRANS_ERR_MACID_SEL_8814B) & \ -+ BIT_MASK_PKT_TRANS_ERR_MACID_SEL_8814B) -+#define BIT_SET_PKT_TRANS_ERR_MACID_SEL_8814B(x, v) \ -+ (BIT_CLEAR_PKT_TRANS_ERR_MACID_SEL_8814B(x) | \ -+ BIT_PKT_TRANS_ERR_MACID_SEL_8814B(v)) -+ -+#define BIT_PKT_TRANS_IEINIT_ERR_8814B BIT(3) -+#define BIT_PKT_TRANS_IENUM_ERR_8814B BIT(2) -+#define BIT_PKT_TRANS_IECNT_ERR1_8814B BIT(1) -+#define BIT_PKT_TRANS_IECNT_ERR0_8814B BIT(0) -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE0_8814B */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE1_8814B */ -+ -+#define BIT_SHIFT_SHCUT_MHDR_OFFSET_8814B 16 -+#define BIT_MASK_SHCUT_MHDR_OFFSET_8814B 0x1ff -+#define BIT_SHCUT_MHDR_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_SHCUT_MHDR_OFFSET_8814B) \ -+ << BIT_SHIFT_SHCUT_MHDR_OFFSET_8814B) -+#define BITS_SHCUT_MHDR_OFFSET_8814B \ -+ (BIT_MASK_SHCUT_MHDR_OFFSET_8814B << BIT_SHIFT_SHCUT_MHDR_OFFSET_8814B) -+#define BIT_CLEAR_SHCUT_MHDR_OFFSET_8814B(x) \ -+ ((x) & (~BITS_SHCUT_MHDR_OFFSET_8814B)) -+#define BIT_GET_SHCUT_MHDR_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_SHCUT_MHDR_OFFSET_8814B) & \ -+ BIT_MASK_SHCUT_MHDR_OFFSET_8814B) -+#define BIT_SET_SHCUT_MHDR_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_SHCUT_MHDR_OFFSET_8814B(x) | BIT_SHCUT_MHDR_OFFSET_8814B(v)) -+ -+/* 2 REG_SHCUT_LLC_OUI0_8814B */ -+ -+/* 2 REG_SHCUT_LLC_OUI1_8814B */ -+ -+/* 2 REG_SHCUT_LLC_OUI2_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_PKT_TRANS_ERR_MACID_8814B 0 -+#define BIT_MASK_PKT_TRANS_ERR_MACID_8814B 0xffffffffL -+#define BIT_PKT_TRANS_ERR_MACID_8814B(x) \ -+ (((x) & BIT_MASK_PKT_TRANS_ERR_MACID_8814B) \ -+ << BIT_SHIFT_PKT_TRANS_ERR_MACID_8814B) -+#define BITS_PKT_TRANS_ERR_MACID_8814B \ -+ (BIT_MASK_PKT_TRANS_ERR_MACID_8814B \ -+ << BIT_SHIFT_PKT_TRANS_ERR_MACID_8814B) -+#define BIT_CLEAR_PKT_TRANS_ERR_MACID_8814B(x) \ -+ ((x) & (~BITS_PKT_TRANS_ERR_MACID_8814B)) -+#define BIT_GET_PKT_TRANS_ERR_MACID_8814B(x) \ -+ (((x) >> BIT_SHIFT_PKT_TRANS_ERR_MACID_8814B) & \ -+ BIT_MASK_PKT_TRANS_ERR_MACID_8814B) -+#define BIT_SET_PKT_TRANS_ERR_MACID_8814B(x, v) \ -+ (BIT_CLEAR_PKT_TRANS_ERR_MACID_8814B(x) | \ -+ BIT_PKT_TRANS_ERR_MACID_8814B(v)) -+ -+/* 2 REG_FWCMDQ_CTRL_8814B */ -+#define BIT_FW_RELEASEPKT_POLLING_8814B BIT(31) -+ -+#define BIT_SHIFT_FWCMDQ_RELEASE_HEAD_8814B 16 -+#define BIT_MASK_FWCMDQ_RELEASE_HEAD_8814B 0xfff -+#define BIT_FWCMDQ_RELEASE_HEAD_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_RELEASE_HEAD_8814B) \ -+ << BIT_SHIFT_FWCMDQ_RELEASE_HEAD_8814B) -+#define BITS_FWCMDQ_RELEASE_HEAD_8814B \ -+ (BIT_MASK_FWCMDQ_RELEASE_HEAD_8814B \ -+ << BIT_SHIFT_FWCMDQ_RELEASE_HEAD_8814B) -+#define BIT_CLEAR_FWCMDQ_RELEASE_HEAD_8814B(x) \ -+ ((x) & (~BITS_FWCMDQ_RELEASE_HEAD_8814B)) -+#define BIT_GET_FWCMDQ_RELEASE_HEAD_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_RELEASE_HEAD_8814B) & \ -+ BIT_MASK_FWCMDQ_RELEASE_HEAD_8814B) -+#define BIT_SET_FWCMDQ_RELEASE_HEAD_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_RELEASE_HEAD_8814B(x) | \ -+ BIT_FWCMDQ_RELEASE_HEAD_8814B(v)) -+ -+#define BIT_FW_GETPKTT_POLLING_8814B BIT(15) -+ -+#define BIT_SHIFT_FWCMDQ_H_8814B 0 -+#define BIT_MASK_FWCMDQ_H_8814B 0xfff -+#define BIT_FWCMDQ_H_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_H_8814B) << BIT_SHIFT_FWCMDQ_H_8814B) -+#define BITS_FWCMDQ_H_8814B \ -+ (BIT_MASK_FWCMDQ_H_8814B << BIT_SHIFT_FWCMDQ_H_8814B) -+#define BIT_CLEAR_FWCMDQ_H_8814B(x) ((x) & (~BITS_FWCMDQ_H_8814B)) -+#define BIT_GET_FWCMDQ_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_H_8814B) & BIT_MASK_FWCMDQ_H_8814B) -+#define BIT_SET_FWCMDQ_H_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_H_8814B(x) | BIT_FWCMDQ_H_8814B(v)) -+ -+/* 2 REG_FWCMDQ_PAGE_8814B */ -+ -+#define BIT_SHIFT_FWCMDQ_TOTAL_PAGE_8814B 16 -+#define BIT_MASK_FWCMDQ_TOTAL_PAGE_8814B 0xfff -+#define BIT_FWCMDQ_TOTAL_PAGE_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_TOTAL_PAGE_8814B) \ -+ << BIT_SHIFT_FWCMDQ_TOTAL_PAGE_8814B) -+#define BITS_FWCMDQ_TOTAL_PAGE_8814B \ -+ (BIT_MASK_FWCMDQ_TOTAL_PAGE_8814B << BIT_SHIFT_FWCMDQ_TOTAL_PAGE_8814B) -+#define BIT_CLEAR_FWCMDQ_TOTAL_PAGE_8814B(x) \ -+ ((x) & (~BITS_FWCMDQ_TOTAL_PAGE_8814B)) -+#define BIT_GET_FWCMDQ_TOTAL_PAGE_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_TOTAL_PAGE_8814B) & \ -+ BIT_MASK_FWCMDQ_TOTAL_PAGE_8814B) -+#define BIT_SET_FWCMDQ_TOTAL_PAGE_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_TOTAL_PAGE_8814B(x) | BIT_FWCMDQ_TOTAL_PAGE_8814B(v)) -+ -+#define BIT_SHIFT_FWCMDQ_QUEUE_PAGE_8814B 0 -+#define BIT_MASK_FWCMDQ_QUEUE_PAGE_8814B 0xfff -+#define BIT_FWCMDQ_QUEUE_PAGE_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_QUEUE_PAGE_8814B) \ -+ << BIT_SHIFT_FWCMDQ_QUEUE_PAGE_8814B) -+#define BITS_FWCMDQ_QUEUE_PAGE_8814B \ -+ (BIT_MASK_FWCMDQ_QUEUE_PAGE_8814B << BIT_SHIFT_FWCMDQ_QUEUE_PAGE_8814B) -+#define BIT_CLEAR_FWCMDQ_QUEUE_PAGE_8814B(x) \ -+ ((x) & (~BITS_FWCMDQ_QUEUE_PAGE_8814B)) -+#define BIT_GET_FWCMDQ_QUEUE_PAGE_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_QUEUE_PAGE_8814B) & \ -+ BIT_MASK_FWCMDQ_QUEUE_PAGE_8814B) -+#define BIT_SET_FWCMDQ_QUEUE_PAGE_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_QUEUE_PAGE_8814B(x) | BIT_FWCMDQ_QUEUE_PAGE_8814B(v)) -+ -+/* 2 REG_FWCMDQ_INFO_8814B */ -+#define BIT_FWCMD_READY_8814B BIT(31) -+#define BIT_FWCMDQ_OVERFLOW_8814B BIT(30) -+#define BIT_FWCMDQ_UNDERFLOW_8814B BIT(29) -+#define BIT_FWCMDQ_RELEASE_MISS_8814B BIT(28) -+ -+#define BIT_SHIFT_FWCMDQ_TOTAL_PKT_8814B 16 -+#define BIT_MASK_FWCMDQ_TOTAL_PKT_8814B 0xfff -+#define BIT_FWCMDQ_TOTAL_PKT_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_TOTAL_PKT_8814B) \ -+ << BIT_SHIFT_FWCMDQ_TOTAL_PKT_8814B) -+#define BITS_FWCMDQ_TOTAL_PKT_8814B \ -+ (BIT_MASK_FWCMDQ_TOTAL_PKT_8814B << BIT_SHIFT_FWCMDQ_TOTAL_PKT_8814B) -+#define BIT_CLEAR_FWCMDQ_TOTAL_PKT_8814B(x) \ -+ ((x) & (~BITS_FWCMDQ_TOTAL_PKT_8814B)) -+#define BIT_GET_FWCMDQ_TOTAL_PKT_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_TOTAL_PKT_8814B) & \ -+ BIT_MASK_FWCMDQ_TOTAL_PKT_8814B) -+#define BIT_SET_FWCMDQ_TOTAL_PKT_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_TOTAL_PKT_8814B(x) | BIT_FWCMDQ_TOTAL_PKT_8814B(v)) -+ -+#define BIT_SHIFT_FWCMDQ_QUEUE_PKT_8814B 0 -+#define BIT_MASK_FWCMDQ_QUEUE_PKT_8814B 0xfff -+#define BIT_FWCMDQ_QUEUE_PKT_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_QUEUE_PKT_8814B) \ -+ << BIT_SHIFT_FWCMDQ_QUEUE_PKT_8814B) -+#define BITS_FWCMDQ_QUEUE_PKT_8814B \ -+ (BIT_MASK_FWCMDQ_QUEUE_PKT_8814B << BIT_SHIFT_FWCMDQ_QUEUE_PKT_8814B) -+#define BIT_CLEAR_FWCMDQ_QUEUE_PKT_8814B(x) \ -+ ((x) & (~BITS_FWCMDQ_QUEUE_PKT_8814B)) -+#define BIT_GET_FWCMDQ_QUEUE_PKT_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_QUEUE_PKT_8814B) & \ -+ BIT_MASK_FWCMDQ_QUEUE_PKT_8814B) -+#define BIT_SET_FWCMDQ_QUEUE_PKT_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_QUEUE_PKT_8814B(x) | BIT_FWCMDQ_QUEUE_PKT_8814B(v)) -+ -+/* 2 REG_FWCMDQ_HOLD_PKTNUM_8814B */ -+ -+#define BIT_SHIFT_FWCMDQ_HOLD__PKTNUM_8814B 0 -+#define BIT_MASK_FWCMDQ_HOLD__PKTNUM_8814B 0xfff -+#define BIT_FWCMDQ_HOLD__PKTNUM_8814B(x) \ -+ (((x) & BIT_MASK_FWCMDQ_HOLD__PKTNUM_8814B) \ -+ << BIT_SHIFT_FWCMDQ_HOLD__PKTNUM_8814B) -+#define BITS_FWCMDQ_HOLD__PKTNUM_8814B \ -+ (BIT_MASK_FWCMDQ_HOLD__PKTNUM_8814B \ -+ << BIT_SHIFT_FWCMDQ_HOLD__PKTNUM_8814B) -+#define BIT_CLEAR_FWCMDQ_HOLD__PKTNUM_8814B(x) \ -+ ((x) & (~BITS_FWCMDQ_HOLD__PKTNUM_8814B)) -+#define BIT_GET_FWCMDQ_HOLD__PKTNUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_FWCMDQ_HOLD__PKTNUM_8814B) & \ -+ BIT_MASK_FWCMDQ_HOLD__PKTNUM_8814B) -+#define BIT_SET_FWCMDQ_HOLD__PKTNUM_8814B(x, v) \ -+ (BIT_CLEAR_FWCMDQ_HOLD__PKTNUM_8814B(x) | \ -+ BIT_FWCMDQ_HOLD__PKTNUM_8814B(v)) -+ -+/* 2 REG_MU_TX_CTRL_8814B */ -+#define BIT_SEARCH_DONE_RDY_8814B BIT(31) -+#define BIT_MU_EN_8814B BIT(30) -+#define BIT_MU_SECONDARY_WAITMODE_EN_8814B BIT(29) -+#define BIT_MU_BB_SCORE_EN_8814B BIT(28) -+#define BIT_MU_SECONDARY_ANT_COUNT_EN_8814B BIT(27) -+#define BIT_MUARB_SEARCH_ERR_EN_8814B BIT(26) -+ -+#define BIT_SHIFT_DIS_SU_TXBF_8814B 16 -+#define BIT_MASK_DIS_SU_TXBF_8814B 0x3f -+#define BIT_DIS_SU_TXBF_8814B(x) \ -+ (((x) & BIT_MASK_DIS_SU_TXBF_8814B) << BIT_SHIFT_DIS_SU_TXBF_8814B) -+#define BITS_DIS_SU_TXBF_8814B \ -+ (BIT_MASK_DIS_SU_TXBF_8814B << BIT_SHIFT_DIS_SU_TXBF_8814B) -+#define BIT_CLEAR_DIS_SU_TXBF_8814B(x) ((x) & (~BITS_DIS_SU_TXBF_8814B)) -+#define BIT_GET_DIS_SU_TXBF_8814B(x) \ -+ (((x) >> BIT_SHIFT_DIS_SU_TXBF_8814B) & BIT_MASK_DIS_SU_TXBF_8814B) -+#define BIT_SET_DIS_SU_TXBF_8814B(x, v) \ -+ (BIT_CLEAR_DIS_SU_TXBF_8814B(x) | BIT_DIS_SU_TXBF_8814B(v)) -+ -+#define BIT_SHIFT_MU_RL_8814B 12 -+#define BIT_MASK_MU_RL_8814B 0xf -+#define BIT_MU_RL_8814B(x) \ -+ (((x) & BIT_MASK_MU_RL_8814B) << BIT_SHIFT_MU_RL_8814B) -+#define BITS_MU_RL_8814B (BIT_MASK_MU_RL_8814B << BIT_SHIFT_MU_RL_8814B) -+#define BIT_CLEAR_MU_RL_8814B(x) ((x) & (~BITS_MU_RL_8814B)) -+#define BIT_GET_MU_RL_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_RL_8814B) & BIT_MASK_MU_RL_8814B) -+#define BIT_SET_MU_RL_8814B(x, v) \ -+ (BIT_CLEAR_MU_RL_8814B(x) | BIT_MU_RL_8814B(v)) -+ -+#define BIT_SHIFT_MU_TAB_SEL_8814B 8 -+#define BIT_MASK_MU_TAB_SEL_8814B 0xf -+#define BIT_MU_TAB_SEL_8814B(x) \ -+ (((x) & BIT_MASK_MU_TAB_SEL_8814B) << BIT_SHIFT_MU_TAB_SEL_8814B) -+#define BITS_MU_TAB_SEL_8814B \ -+ (BIT_MASK_MU_TAB_SEL_8814B << BIT_SHIFT_MU_TAB_SEL_8814B) -+#define BIT_CLEAR_MU_TAB_SEL_8814B(x) ((x) & (~BITS_MU_TAB_SEL_8814B)) -+#define BIT_GET_MU_TAB_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_TAB_SEL_8814B) & BIT_MASK_MU_TAB_SEL_8814B) -+#define BIT_SET_MU_TAB_SEL_8814B(x, v) \ -+ (BIT_CLEAR_MU_TAB_SEL_8814B(x) | BIT_MU_TAB_SEL_8814B(v)) -+ -+#define BIT_SHIFT_MU_TAB_VALID_8814B 0 -+#define BIT_MASK_MU_TAB_VALID_8814B 0x3f -+#define BIT_MU_TAB_VALID_8814B(x) \ -+ (((x) & BIT_MASK_MU_TAB_VALID_8814B) << BIT_SHIFT_MU_TAB_VALID_8814B) -+#define BITS_MU_TAB_VALID_8814B \ -+ (BIT_MASK_MU_TAB_VALID_8814B << BIT_SHIFT_MU_TAB_VALID_8814B) -+#define BIT_CLEAR_MU_TAB_VALID_8814B(x) ((x) & (~BITS_MU_TAB_VALID_8814B)) -+#define BIT_GET_MU_TAB_VALID_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_TAB_VALID_8814B) & BIT_MASK_MU_TAB_VALID_8814B) -+#define BIT_SET_MU_TAB_VALID_8814B(x, v) \ -+ (BIT_CLEAR_MU_TAB_VALID_8814B(x) | BIT_MU_TAB_VALID_8814B(v)) -+ -+/* 2 REG_MU_STA_GID_VLD_8814B */ -+ -+#define BIT_SHIFT_MU_STA_GTAB_VALID_8814B 0 -+#define BIT_MASK_MU_STA_GTAB_VALID_8814B 0xffffffffL -+#define BIT_MU_STA_GTAB_VALID_8814B(x) \ -+ (((x) & BIT_MASK_MU_STA_GTAB_VALID_8814B) \ -+ << BIT_SHIFT_MU_STA_GTAB_VALID_8814B) -+#define BITS_MU_STA_GTAB_VALID_8814B \ -+ (BIT_MASK_MU_STA_GTAB_VALID_8814B << BIT_SHIFT_MU_STA_GTAB_VALID_8814B) -+#define BIT_CLEAR_MU_STA_GTAB_VALID_8814B(x) \ -+ ((x) & (~BITS_MU_STA_GTAB_VALID_8814B)) -+#define BIT_GET_MU_STA_GTAB_VALID_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_STA_GTAB_VALID_8814B) & \ -+ BIT_MASK_MU_STA_GTAB_VALID_8814B) -+#define BIT_SET_MU_STA_GTAB_VALID_8814B(x, v) \ -+ (BIT_CLEAR_MU_STA_GTAB_VALID_8814B(x) | BIT_MU_STA_GTAB_VALID_8814B(v)) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_8814B */ -+ -+#define BIT_SHIFT_MU_STA_GTAB_POSITION_L_8814B 0 -+#define BIT_MASK_MU_STA_GTAB_POSITION_L_8814B 0xffffffffL -+#define BIT_MU_STA_GTAB_POSITION_L_8814B(x) \ -+ (((x) & BIT_MASK_MU_STA_GTAB_POSITION_L_8814B) \ -+ << BIT_SHIFT_MU_STA_GTAB_POSITION_L_8814B) -+#define BITS_MU_STA_GTAB_POSITION_L_8814B \ -+ (BIT_MASK_MU_STA_GTAB_POSITION_L_8814B \ -+ << BIT_SHIFT_MU_STA_GTAB_POSITION_L_8814B) -+#define BIT_CLEAR_MU_STA_GTAB_POSITION_L_8814B(x) \ -+ ((x) & (~BITS_MU_STA_GTAB_POSITION_L_8814B)) -+#define BIT_GET_MU_STA_GTAB_POSITION_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_STA_GTAB_POSITION_L_8814B) & \ -+ BIT_MASK_MU_STA_GTAB_POSITION_L_8814B) -+#define BIT_SET_MU_STA_GTAB_POSITION_L_8814B(x, v) \ -+ (BIT_CLEAR_MU_STA_GTAB_POSITION_L_8814B(x) | \ -+ BIT_MU_STA_GTAB_POSITION_L_8814B(v)) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_H_8814B */ -+ -+#define BIT_SHIFT_MU_STA_GTAB_POSITION_H_8814B 0 -+#define BIT_MASK_MU_STA_GTAB_POSITION_H_8814B 0xffffffffL -+#define BIT_MU_STA_GTAB_POSITION_H_8814B(x) \ -+ (((x) & BIT_MASK_MU_STA_GTAB_POSITION_H_8814B) \ -+ << BIT_SHIFT_MU_STA_GTAB_POSITION_H_8814B) -+#define BITS_MU_STA_GTAB_POSITION_H_8814B \ -+ (BIT_MASK_MU_STA_GTAB_POSITION_H_8814B \ -+ << BIT_SHIFT_MU_STA_GTAB_POSITION_H_8814B) -+#define BIT_CLEAR_MU_STA_GTAB_POSITION_H_8814B(x) \ -+ ((x) & (~BITS_MU_STA_GTAB_POSITION_H_8814B)) -+#define BIT_GET_MU_STA_GTAB_POSITION_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_STA_GTAB_POSITION_H_8814B) & \ -+ BIT_MASK_MU_STA_GTAB_POSITION_H_8814B) -+#define BIT_SET_MU_STA_GTAB_POSITION_H_8814B(x, v) \ -+ (BIT_CLEAR_MU_STA_GTAB_POSITION_H_8814B(x) | \ -+ BIT_MU_STA_GTAB_POSITION_H_8814B(v)) -+ -+/* 2 REG_CHNL_INFO_CTRL_8814B */ -+#define BIT_CHNL_REF_RXNAV_8814B BIT(7) -+#define BIT_CHNL_REF_VBON_8814B BIT(6) -+#define BIT_CHNL_REF_EDCA_8814B BIT(5) -+#define BIT_CHNL_REF_CCA_8814B BIT(4) -+#define BIT_RST_CHNL_BUSY_8814B BIT(3) -+#define BIT_RST_CHNL_IDLE_8814B BIT(2) -+#define BIT_CHNL_INFO_RST_8814B BIT(1) -+#define BIT_ATM_AIRTIME_EN_8814B BIT(0) -+ -+/* 2 REG_CHNL_IDLE_TIME_8814B */ -+ -+#define BIT_SHIFT_CHNL_IDLE_TIME_8814B 0 -+#define BIT_MASK_CHNL_IDLE_TIME_8814B 0xffffffffL -+#define BIT_CHNL_IDLE_TIME_8814B(x) \ -+ (((x) & BIT_MASK_CHNL_IDLE_TIME_8814B) \ -+ << BIT_SHIFT_CHNL_IDLE_TIME_8814B) -+#define BITS_CHNL_IDLE_TIME_8814B \ -+ (BIT_MASK_CHNL_IDLE_TIME_8814B << BIT_SHIFT_CHNL_IDLE_TIME_8814B) -+#define BIT_CLEAR_CHNL_IDLE_TIME_8814B(x) ((x) & (~BITS_CHNL_IDLE_TIME_8814B)) -+#define BIT_GET_CHNL_IDLE_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_CHNL_IDLE_TIME_8814B) & \ -+ BIT_MASK_CHNL_IDLE_TIME_8814B) -+#define BIT_SET_CHNL_IDLE_TIME_8814B(x, v) \ -+ (BIT_CLEAR_CHNL_IDLE_TIME_8814B(x) | BIT_CHNL_IDLE_TIME_8814B(v)) -+ -+/* 2 REG_CHNL_BUSY_TIME_8814B */ -+ -+#define BIT_SHIFT_CHNL_BUSY_TIME_8814B 0 -+#define BIT_MASK_CHNL_BUSY_TIME_8814B 0xffffffffL -+#define BIT_CHNL_BUSY_TIME_8814B(x) \ -+ (((x) & BIT_MASK_CHNL_BUSY_TIME_8814B) \ -+ << BIT_SHIFT_CHNL_BUSY_TIME_8814B) -+#define BITS_CHNL_BUSY_TIME_8814B \ -+ (BIT_MASK_CHNL_BUSY_TIME_8814B << BIT_SHIFT_CHNL_BUSY_TIME_8814B) -+#define BIT_CLEAR_CHNL_BUSY_TIME_8814B(x) ((x) & (~BITS_CHNL_BUSY_TIME_8814B)) -+#define BIT_GET_CHNL_BUSY_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_CHNL_BUSY_TIME_8814B) & \ -+ BIT_MASK_CHNL_BUSY_TIME_8814B) -+#define BIT_SET_CHNL_BUSY_TIME_8814B(x, v) \ -+ (BIT_CLEAR_CHNL_BUSY_TIME_8814B(x) | BIT_CHNL_BUSY_TIME_8814B(v)) -+ -+/* 2 REG_MU_TRX_DBG_CNT_V1_8814B */ -+#define BIT_FORCE_SND_STS_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_SND_STS_VALUE_8814B 24 -+#define BIT_MASK_SND_STS_VALUE_8814B 0x3f -+#define BIT_SND_STS_VALUE_8814B(x) \ -+ (((x) & BIT_MASK_SND_STS_VALUE_8814B) << BIT_SHIFT_SND_STS_VALUE_8814B) -+#define BITS_SND_STS_VALUE_8814B \ -+ (BIT_MASK_SND_STS_VALUE_8814B << BIT_SHIFT_SND_STS_VALUE_8814B) -+#define BIT_CLEAR_SND_STS_VALUE_8814B(x) ((x) & (~BITS_SND_STS_VALUE_8814B)) -+#define BIT_GET_SND_STS_VALUE_8814B(x) \ -+ (((x) >> BIT_SHIFT_SND_STS_VALUE_8814B) & BIT_MASK_SND_STS_VALUE_8814B) -+#define BIT_SET_SND_STS_VALUE_8814B(x, v) \ -+ (BIT_CLEAR_SND_STS_VALUE_8814B(x) | BIT_SND_STS_VALUE_8814B(v)) -+ -+#define BIT_MU_DNGCNT_RST_8814B BIT(20) -+ -+#define BIT_SHIFT_MU_DNGCNT_SEL_8814B 16 -+#define BIT_MASK_MU_DNGCNT_SEL_8814B 0xf -+#define BIT_MU_DNGCNT_SEL_8814B(x) \ -+ (((x) & BIT_MASK_MU_DNGCNT_SEL_8814B) << BIT_SHIFT_MU_DNGCNT_SEL_8814B) -+#define BITS_MU_DNGCNT_SEL_8814B \ -+ (BIT_MASK_MU_DNGCNT_SEL_8814B << BIT_SHIFT_MU_DNGCNT_SEL_8814B) -+#define BIT_CLEAR_MU_DNGCNT_SEL_8814B(x) ((x) & (~BITS_MU_DNGCNT_SEL_8814B)) -+#define BIT_GET_MU_DNGCNT_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_DNGCNT_SEL_8814B) & BIT_MASK_MU_DNGCNT_SEL_8814B) -+#define BIT_SET_MU_DNGCNT_SEL_8814B(x, v) \ -+ (BIT_CLEAR_MU_DNGCNT_SEL_8814B(x) | BIT_MU_DNGCNT_SEL_8814B(v)) -+ -+#define BIT_SHIFT_MU_DNGCNT_8814B 0 -+#define BIT_MASK_MU_DNGCNT_8814B 0xffff -+#define BIT_MU_DNGCNT_8814B(x) \ -+ (((x) & BIT_MASK_MU_DNGCNT_8814B) << BIT_SHIFT_MU_DNGCNT_8814B) -+#define BITS_MU_DNGCNT_8814B \ -+ (BIT_MASK_MU_DNGCNT_8814B << BIT_SHIFT_MU_DNGCNT_8814B) -+#define BIT_CLEAR_MU_DNGCNT_8814B(x) ((x) & (~BITS_MU_DNGCNT_8814B)) -+#define BIT_GET_MU_DNGCNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_DNGCNT_8814B) & BIT_MASK_MU_DNGCNT_8814B) -+#define BIT_SET_MU_DNGCNT_8814B(x, v) \ -+ (BIT_CLEAR_MU_DNGCNT_8814B(x) | BIT_MU_DNGCNT_8814B(v)) -+ -+/* 2 REG_SWPS_CTRL_8814B */ -+ -+#define BIT_SHIFT_SWPS_RPT_LENGTH_8814B 8 -+#define BIT_MASK_SWPS_RPT_LENGTH_8814B 0x7f -+#define BIT_SWPS_RPT_LENGTH_8814B(x) \ -+ (((x) & BIT_MASK_SWPS_RPT_LENGTH_8814B) \ -+ << BIT_SHIFT_SWPS_RPT_LENGTH_8814B) -+#define BITS_SWPS_RPT_LENGTH_8814B \ -+ (BIT_MASK_SWPS_RPT_LENGTH_8814B << BIT_SHIFT_SWPS_RPT_LENGTH_8814B) -+#define BIT_CLEAR_SWPS_RPT_LENGTH_8814B(x) ((x) & (~BITS_SWPS_RPT_LENGTH_8814B)) -+#define BIT_GET_SWPS_RPT_LENGTH_8814B(x) \ -+ (((x) >> BIT_SHIFT_SWPS_RPT_LENGTH_8814B) & \ -+ BIT_MASK_SWPS_RPT_LENGTH_8814B) -+#define BIT_SET_SWPS_RPT_LENGTH_8814B(x, v) \ -+ (BIT_CLEAR_SWPS_RPT_LENGTH_8814B(x) | BIT_SWPS_RPT_LENGTH_8814B(v)) -+ -+#define BIT_SHIFT_MACID_SWPS_EN_SEL_8814B 2 -+#define BIT_MASK_MACID_SWPS_EN_SEL_8814B 0x3 -+#define BIT_MACID_SWPS_EN_SEL_8814B(x) \ -+ (((x) & BIT_MASK_MACID_SWPS_EN_SEL_8814B) \ -+ << BIT_SHIFT_MACID_SWPS_EN_SEL_8814B) -+#define BITS_MACID_SWPS_EN_SEL_8814B \ -+ (BIT_MASK_MACID_SWPS_EN_SEL_8814B << BIT_SHIFT_MACID_SWPS_EN_SEL_8814B) -+#define BIT_CLEAR_MACID_SWPS_EN_SEL_8814B(x) \ -+ ((x) & (~BITS_MACID_SWPS_EN_SEL_8814B)) -+#define BIT_GET_MACID_SWPS_EN_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_SWPS_EN_SEL_8814B) & \ -+ BIT_MASK_MACID_SWPS_EN_SEL_8814B) -+#define BIT_SET_MACID_SWPS_EN_SEL_8814B(x, v) \ -+ (BIT_CLEAR_MACID_SWPS_EN_SEL_8814B(x) | BIT_MACID_SWPS_EN_SEL_8814B(v)) -+ -+#define BIT_SWPS_MANUALL_POLLING_8814B BIT(1) -+#define BIT_SWPS_EN_8814B BIT(0) -+ -+/* 2 REG_SWPS_PKT_TH_8814B */ -+ -+#define BIT_SHIFT_SWPS_PKT_TH_8814B 0 -+#define BIT_MASK_SWPS_PKT_TH_8814B 0xffff -+#define BIT_SWPS_PKT_TH_8814B(x) \ -+ (((x) & BIT_MASK_SWPS_PKT_TH_8814B) << BIT_SHIFT_SWPS_PKT_TH_8814B) -+#define BITS_SWPS_PKT_TH_8814B \ -+ (BIT_MASK_SWPS_PKT_TH_8814B << BIT_SHIFT_SWPS_PKT_TH_8814B) -+#define BIT_CLEAR_SWPS_PKT_TH_8814B(x) ((x) & (~BITS_SWPS_PKT_TH_8814B)) -+#define BIT_GET_SWPS_PKT_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_SWPS_PKT_TH_8814B) & BIT_MASK_SWPS_PKT_TH_8814B) -+#define BIT_SET_SWPS_PKT_TH_8814B(x, v) \ -+ (BIT_CLEAR_SWPS_PKT_TH_8814B(x) | BIT_SWPS_PKT_TH_8814B(v)) -+ -+/* 2 REG_SWPS_TIME_TH_8814B */ -+ -+#define BIT_SHIFT_SWPS_PSTIME_TH_8814B 16 -+#define BIT_MASK_SWPS_PSTIME_TH_8814B 0xffff -+#define BIT_SWPS_PSTIME_TH_8814B(x) \ -+ (((x) & BIT_MASK_SWPS_PSTIME_TH_8814B) \ -+ << BIT_SHIFT_SWPS_PSTIME_TH_8814B) -+#define BITS_SWPS_PSTIME_TH_8814B \ -+ (BIT_MASK_SWPS_PSTIME_TH_8814B << BIT_SHIFT_SWPS_PSTIME_TH_8814B) -+#define BIT_CLEAR_SWPS_PSTIME_TH_8814B(x) ((x) & (~BITS_SWPS_PSTIME_TH_8814B)) -+#define BIT_GET_SWPS_PSTIME_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_SWPS_PSTIME_TH_8814B) & \ -+ BIT_MASK_SWPS_PSTIME_TH_8814B) -+#define BIT_SET_SWPS_PSTIME_TH_8814B(x, v) \ -+ (BIT_CLEAR_SWPS_PSTIME_TH_8814B(x) | BIT_SWPS_PSTIME_TH_8814B(v)) -+ -+#define BIT_SHIFT_SWPS_TIME_TH_8814B 0 -+#define BIT_MASK_SWPS_TIME_TH_8814B 0xffff -+#define BIT_SWPS_TIME_TH_8814B(x) \ -+ (((x) & BIT_MASK_SWPS_TIME_TH_8814B) << BIT_SHIFT_SWPS_TIME_TH_8814B) -+#define BITS_SWPS_TIME_TH_8814B \ -+ (BIT_MASK_SWPS_TIME_TH_8814B << BIT_SHIFT_SWPS_TIME_TH_8814B) -+#define BIT_CLEAR_SWPS_TIME_TH_8814B(x) ((x) & (~BITS_SWPS_TIME_TH_8814B)) -+#define BIT_GET_SWPS_TIME_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_SWPS_TIME_TH_8814B) & BIT_MASK_SWPS_TIME_TH_8814B) -+#define BIT_SET_SWPS_TIME_TH_8814B(x, v) \ -+ (BIT_CLEAR_SWPS_TIME_TH_8814B(x) | BIT_SWPS_TIME_TH_8814B(v)) -+ -+/* 2 REG_MACID_SWPS_EN_8814B */ -+ -+#define BIT_SHIFT_MACID_SWPS_EN_8814B 0 -+#define BIT_MASK_MACID_SWPS_EN_8814B 0xffffffffL -+#define BIT_MACID_SWPS_EN_8814B(x) \ -+ (((x) & BIT_MASK_MACID_SWPS_EN_8814B) << BIT_SHIFT_MACID_SWPS_EN_8814B) -+#define BITS_MACID_SWPS_EN_8814B \ -+ (BIT_MASK_MACID_SWPS_EN_8814B << BIT_SHIFT_MACID_SWPS_EN_8814B) -+#define BIT_CLEAR_MACID_SWPS_EN_8814B(x) ((x) & (~BITS_MACID_SWPS_EN_8814B)) -+#define BIT_GET_MACID_SWPS_EN_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_SWPS_EN_8814B) & BIT_MASK_MACID_SWPS_EN_8814B) -+#define BIT_SET_MACID_SWPS_EN_8814B(x, v) \ -+ (BIT_CLEAR_MACID_SWPS_EN_8814B(x) | BIT_MACID_SWPS_EN_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_EDCA_VO_PARAM_8814B */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8814B 16 -+#define BIT_MASK_TXOPLIMIT_8814B 0x7ff -+#define BIT_TXOPLIMIT_8814B(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8814B) << BIT_SHIFT_TXOPLIMIT_8814B) -+#define BITS_TXOPLIMIT_8814B \ -+ (BIT_MASK_TXOPLIMIT_8814B << BIT_SHIFT_TXOPLIMIT_8814B) -+#define BIT_CLEAR_TXOPLIMIT_8814B(x) ((x) & (~BITS_TXOPLIMIT_8814B)) -+#define BIT_GET_TXOPLIMIT_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8814B) & BIT_MASK_TXOPLIMIT_8814B) -+#define BIT_SET_TXOPLIMIT_8814B(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8814B(x) | BIT_TXOPLIMIT_8814B(v)) -+ -+#define BIT_SHIFT_CW_8814B 8 -+#define BIT_MASK_CW_8814B 0xff -+#define BIT_CW_8814B(x) (((x) & BIT_MASK_CW_8814B) << BIT_SHIFT_CW_8814B) -+#define BITS_CW_8814B (BIT_MASK_CW_8814B << BIT_SHIFT_CW_8814B) -+#define BIT_CLEAR_CW_8814B(x) ((x) & (~BITS_CW_8814B)) -+#define BIT_GET_CW_8814B(x) (((x) >> BIT_SHIFT_CW_8814B) & BIT_MASK_CW_8814B) -+#define BIT_SET_CW_8814B(x, v) (BIT_CLEAR_CW_8814B(x) | BIT_CW_8814B(v)) -+ -+#define BIT_SHIFT_AIFS_8814B 0 -+#define BIT_MASK_AIFS_8814B 0xff -+#define BIT_AIFS_8814B(x) (((x) & BIT_MASK_AIFS_8814B) << BIT_SHIFT_AIFS_8814B) -+#define BITS_AIFS_8814B (BIT_MASK_AIFS_8814B << BIT_SHIFT_AIFS_8814B) -+#define BIT_CLEAR_AIFS_8814B(x) ((x) & (~BITS_AIFS_8814B)) -+#define BIT_GET_AIFS_8814B(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8814B) & BIT_MASK_AIFS_8814B) -+#define BIT_SET_AIFS_8814B(x, v) (BIT_CLEAR_AIFS_8814B(x) | BIT_AIFS_8814B(v)) -+ -+/* 2 REG_EDCA_VI_PARAM_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8814B 16 -+#define BIT_MASK_TXOPLIMIT_8814B 0x7ff -+#define BIT_TXOPLIMIT_8814B(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8814B) << BIT_SHIFT_TXOPLIMIT_8814B) -+#define BITS_TXOPLIMIT_8814B \ -+ (BIT_MASK_TXOPLIMIT_8814B << BIT_SHIFT_TXOPLIMIT_8814B) -+#define BIT_CLEAR_TXOPLIMIT_8814B(x) ((x) & (~BITS_TXOPLIMIT_8814B)) -+#define BIT_GET_TXOPLIMIT_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8814B) & BIT_MASK_TXOPLIMIT_8814B) -+#define BIT_SET_TXOPLIMIT_8814B(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8814B(x) | BIT_TXOPLIMIT_8814B(v)) -+ -+#define BIT_SHIFT_CW_8814B 8 -+#define BIT_MASK_CW_8814B 0xff -+#define BIT_CW_8814B(x) (((x) & BIT_MASK_CW_8814B) << BIT_SHIFT_CW_8814B) -+#define BITS_CW_8814B (BIT_MASK_CW_8814B << BIT_SHIFT_CW_8814B) -+#define BIT_CLEAR_CW_8814B(x) ((x) & (~BITS_CW_8814B)) -+#define BIT_GET_CW_8814B(x) (((x) >> BIT_SHIFT_CW_8814B) & BIT_MASK_CW_8814B) -+#define BIT_SET_CW_8814B(x, v) (BIT_CLEAR_CW_8814B(x) | BIT_CW_8814B(v)) -+ -+#define BIT_SHIFT_AIFS_8814B 0 -+#define BIT_MASK_AIFS_8814B 0xff -+#define BIT_AIFS_8814B(x) (((x) & BIT_MASK_AIFS_8814B) << BIT_SHIFT_AIFS_8814B) -+#define BITS_AIFS_8814B (BIT_MASK_AIFS_8814B << BIT_SHIFT_AIFS_8814B) -+#define BIT_CLEAR_AIFS_8814B(x) ((x) & (~BITS_AIFS_8814B)) -+#define BIT_GET_AIFS_8814B(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8814B) & BIT_MASK_AIFS_8814B) -+#define BIT_SET_AIFS_8814B(x, v) (BIT_CLEAR_AIFS_8814B(x) | BIT_AIFS_8814B(v)) -+ -+/* 2 REG_EDCA_BE_PARAM_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8814B 16 -+#define BIT_MASK_TXOPLIMIT_8814B 0x7ff -+#define BIT_TXOPLIMIT_8814B(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8814B) << BIT_SHIFT_TXOPLIMIT_8814B) -+#define BITS_TXOPLIMIT_8814B \ -+ (BIT_MASK_TXOPLIMIT_8814B << BIT_SHIFT_TXOPLIMIT_8814B) -+#define BIT_CLEAR_TXOPLIMIT_8814B(x) ((x) & (~BITS_TXOPLIMIT_8814B)) -+#define BIT_GET_TXOPLIMIT_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8814B) & BIT_MASK_TXOPLIMIT_8814B) -+#define BIT_SET_TXOPLIMIT_8814B(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8814B(x) | BIT_TXOPLIMIT_8814B(v)) -+ -+#define BIT_SHIFT_CW_8814B 8 -+#define BIT_MASK_CW_8814B 0xff -+#define BIT_CW_8814B(x) (((x) & BIT_MASK_CW_8814B) << BIT_SHIFT_CW_8814B) -+#define BITS_CW_8814B (BIT_MASK_CW_8814B << BIT_SHIFT_CW_8814B) -+#define BIT_CLEAR_CW_8814B(x) ((x) & (~BITS_CW_8814B)) -+#define BIT_GET_CW_8814B(x) (((x) >> BIT_SHIFT_CW_8814B) & BIT_MASK_CW_8814B) -+#define BIT_SET_CW_8814B(x, v) (BIT_CLEAR_CW_8814B(x) | BIT_CW_8814B(v)) -+ -+#define BIT_SHIFT_AIFS_8814B 0 -+#define BIT_MASK_AIFS_8814B 0xff -+#define BIT_AIFS_8814B(x) (((x) & BIT_MASK_AIFS_8814B) << BIT_SHIFT_AIFS_8814B) -+#define BITS_AIFS_8814B (BIT_MASK_AIFS_8814B << BIT_SHIFT_AIFS_8814B) -+#define BIT_CLEAR_AIFS_8814B(x) ((x) & (~BITS_AIFS_8814B)) -+#define BIT_GET_AIFS_8814B(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8814B) & BIT_MASK_AIFS_8814B) -+#define BIT_SET_AIFS_8814B(x, v) (BIT_CLEAR_AIFS_8814B(x) | BIT_AIFS_8814B(v)) -+ -+/* 2 REG_EDCA_BK_PARAM_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8814B 16 -+#define BIT_MASK_TXOPLIMIT_8814B 0x7ff -+#define BIT_TXOPLIMIT_8814B(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8814B) << BIT_SHIFT_TXOPLIMIT_8814B) -+#define BITS_TXOPLIMIT_8814B \ -+ (BIT_MASK_TXOPLIMIT_8814B << BIT_SHIFT_TXOPLIMIT_8814B) -+#define BIT_CLEAR_TXOPLIMIT_8814B(x) ((x) & (~BITS_TXOPLIMIT_8814B)) -+#define BIT_GET_TXOPLIMIT_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8814B) & BIT_MASK_TXOPLIMIT_8814B) -+#define BIT_SET_TXOPLIMIT_8814B(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8814B(x) | BIT_TXOPLIMIT_8814B(v)) -+ -+#define BIT_SHIFT_CW_8814B 8 -+#define BIT_MASK_CW_8814B 0xff -+#define BIT_CW_8814B(x) (((x) & BIT_MASK_CW_8814B) << BIT_SHIFT_CW_8814B) -+#define BITS_CW_8814B (BIT_MASK_CW_8814B << BIT_SHIFT_CW_8814B) -+#define BIT_CLEAR_CW_8814B(x) ((x) & (~BITS_CW_8814B)) -+#define BIT_GET_CW_8814B(x) (((x) >> BIT_SHIFT_CW_8814B) & BIT_MASK_CW_8814B) -+#define BIT_SET_CW_8814B(x, v) (BIT_CLEAR_CW_8814B(x) | BIT_CW_8814B(v)) -+ -+#define BIT_SHIFT_AIFS_8814B 0 -+#define BIT_MASK_AIFS_8814B 0xff -+#define BIT_AIFS_8814B(x) (((x) & BIT_MASK_AIFS_8814B) << BIT_SHIFT_AIFS_8814B) -+#define BITS_AIFS_8814B (BIT_MASK_AIFS_8814B << BIT_SHIFT_AIFS_8814B) -+#define BIT_CLEAR_AIFS_8814B(x) ((x) & (~BITS_AIFS_8814B)) -+#define BIT_GET_AIFS_8814B(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8814B) & BIT_MASK_AIFS_8814B) -+#define BIT_SET_AIFS_8814B(x, v) (BIT_CLEAR_AIFS_8814B(x) | BIT_AIFS_8814B(v)) -+ -+/* 2 REG_BCNTCFG_8814B */ -+ -+#define BIT_SHIFT_BCNCW_MAX_8814B 12 -+#define BIT_MASK_BCNCW_MAX_8814B 0xf -+#define BIT_BCNCW_MAX_8814B(x) \ -+ (((x) & BIT_MASK_BCNCW_MAX_8814B) << BIT_SHIFT_BCNCW_MAX_8814B) -+#define BITS_BCNCW_MAX_8814B \ -+ (BIT_MASK_BCNCW_MAX_8814B << BIT_SHIFT_BCNCW_MAX_8814B) -+#define BIT_CLEAR_BCNCW_MAX_8814B(x) ((x) & (~BITS_BCNCW_MAX_8814B)) -+#define BIT_GET_BCNCW_MAX_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MAX_8814B) & BIT_MASK_BCNCW_MAX_8814B) -+#define BIT_SET_BCNCW_MAX_8814B(x, v) \ -+ (BIT_CLEAR_BCNCW_MAX_8814B(x) | BIT_BCNCW_MAX_8814B(v)) -+ -+#define BIT_SHIFT_BCNCW_MIN_8814B 8 -+#define BIT_MASK_BCNCW_MIN_8814B 0xf -+#define BIT_BCNCW_MIN_8814B(x) \ -+ (((x) & BIT_MASK_BCNCW_MIN_8814B) << BIT_SHIFT_BCNCW_MIN_8814B) -+#define BITS_BCNCW_MIN_8814B \ -+ (BIT_MASK_BCNCW_MIN_8814B << BIT_SHIFT_BCNCW_MIN_8814B) -+#define BIT_CLEAR_BCNCW_MIN_8814B(x) ((x) & (~BITS_BCNCW_MIN_8814B)) -+#define BIT_GET_BCNCW_MIN_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MIN_8814B) & BIT_MASK_BCNCW_MIN_8814B) -+#define BIT_SET_BCNCW_MIN_8814B(x, v) \ -+ (BIT_CLEAR_BCNCW_MIN_8814B(x) | BIT_BCNCW_MIN_8814B(v)) -+ -+#define BIT_SHIFT_BCNIFS_8814B 0 -+#define BIT_MASK_BCNIFS_8814B 0xff -+#define BIT_BCNIFS_8814B(x) \ -+ (((x) & BIT_MASK_BCNIFS_8814B) << BIT_SHIFT_BCNIFS_8814B) -+#define BITS_BCNIFS_8814B (BIT_MASK_BCNIFS_8814B << BIT_SHIFT_BCNIFS_8814B) -+#define BIT_CLEAR_BCNIFS_8814B(x) ((x) & (~BITS_BCNIFS_8814B)) -+#define BIT_GET_BCNIFS_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCNIFS_8814B) & BIT_MASK_BCNIFS_8814B) -+#define BIT_SET_BCNIFS_8814B(x, v) \ -+ (BIT_CLEAR_BCNIFS_8814B(x) | BIT_BCNIFS_8814B(v)) -+ -+/* 2 REG_PIFS_8814B */ -+ -+#define BIT_SHIFT_PIFS_8814B 0 -+#define BIT_MASK_PIFS_8814B 0xff -+#define BIT_PIFS_8814B(x) (((x) & BIT_MASK_PIFS_8814B) << BIT_SHIFT_PIFS_8814B) -+#define BITS_PIFS_8814B (BIT_MASK_PIFS_8814B << BIT_SHIFT_PIFS_8814B) -+#define BIT_CLEAR_PIFS_8814B(x) ((x) & (~BITS_PIFS_8814B)) -+#define BIT_GET_PIFS_8814B(x) \ -+ (((x) >> BIT_SHIFT_PIFS_8814B) & BIT_MASK_PIFS_8814B) -+#define BIT_SET_PIFS_8814B(x, v) (BIT_CLEAR_PIFS_8814B(x) | BIT_PIFS_8814B(v)) -+ -+/* 2 REG_RDG_PIFS_8814B */ -+ -+#define BIT_SHIFT_RDG_PIFS_8814B 0 -+#define BIT_MASK_RDG_PIFS_8814B 0xff -+#define BIT_RDG_PIFS_8814B(x) \ -+ (((x) & BIT_MASK_RDG_PIFS_8814B) << BIT_SHIFT_RDG_PIFS_8814B) -+#define BITS_RDG_PIFS_8814B \ -+ (BIT_MASK_RDG_PIFS_8814B << BIT_SHIFT_RDG_PIFS_8814B) -+#define BIT_CLEAR_RDG_PIFS_8814B(x) ((x) & (~BITS_RDG_PIFS_8814B)) -+#define BIT_GET_RDG_PIFS_8814B(x) \ -+ (((x) >> BIT_SHIFT_RDG_PIFS_8814B) & BIT_MASK_RDG_PIFS_8814B) -+#define BIT_SET_RDG_PIFS_8814B(x, v) \ -+ (BIT_CLEAR_RDG_PIFS_8814B(x) | BIT_RDG_PIFS_8814B(v)) -+ -+/* 2 REG_SIFS_8814B */ -+ -+#define BIT_SHIFT_SIFS_OFDM_TRX_8814B 24 -+#define BIT_MASK_SIFS_OFDM_TRX_8814B 0xff -+#define BIT_SIFS_OFDM_TRX_8814B(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_TRX_8814B) << BIT_SHIFT_SIFS_OFDM_TRX_8814B) -+#define BITS_SIFS_OFDM_TRX_8814B \ -+ (BIT_MASK_SIFS_OFDM_TRX_8814B << BIT_SHIFT_SIFS_OFDM_TRX_8814B) -+#define BIT_CLEAR_SIFS_OFDM_TRX_8814B(x) ((x) & (~BITS_SIFS_OFDM_TRX_8814B)) -+#define BIT_GET_SIFS_OFDM_TRX_8814B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_TRX_8814B) & BIT_MASK_SIFS_OFDM_TRX_8814B) -+#define BIT_SET_SIFS_OFDM_TRX_8814B(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_TRX_8814B(x) | BIT_SIFS_OFDM_TRX_8814B(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_TRX_8814B 16 -+#define BIT_MASK_SIFS_CCK_TRX_8814B 0xff -+#define BIT_SIFS_CCK_TRX_8814B(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_TRX_8814B) << BIT_SHIFT_SIFS_CCK_TRX_8814B) -+#define BITS_SIFS_CCK_TRX_8814B \ -+ (BIT_MASK_SIFS_CCK_TRX_8814B << BIT_SHIFT_SIFS_CCK_TRX_8814B) -+#define BIT_CLEAR_SIFS_CCK_TRX_8814B(x) ((x) & (~BITS_SIFS_CCK_TRX_8814B)) -+#define BIT_GET_SIFS_CCK_TRX_8814B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_TRX_8814B) & BIT_MASK_SIFS_CCK_TRX_8814B) -+#define BIT_SET_SIFS_CCK_TRX_8814B(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_TRX_8814B(x) | BIT_SIFS_CCK_TRX_8814B(v)) -+ -+#define BIT_SHIFT_SIFS_OFDM_CTX_8814B 8 -+#define BIT_MASK_SIFS_OFDM_CTX_8814B 0xff -+#define BIT_SIFS_OFDM_CTX_8814B(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_CTX_8814B) << BIT_SHIFT_SIFS_OFDM_CTX_8814B) -+#define BITS_SIFS_OFDM_CTX_8814B \ -+ (BIT_MASK_SIFS_OFDM_CTX_8814B << BIT_SHIFT_SIFS_OFDM_CTX_8814B) -+#define BIT_CLEAR_SIFS_OFDM_CTX_8814B(x) ((x) & (~BITS_SIFS_OFDM_CTX_8814B)) -+#define BIT_GET_SIFS_OFDM_CTX_8814B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_CTX_8814B) & BIT_MASK_SIFS_OFDM_CTX_8814B) -+#define BIT_SET_SIFS_OFDM_CTX_8814B(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_CTX_8814B(x) | BIT_SIFS_OFDM_CTX_8814B(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_CTX_8814B 0 -+#define BIT_MASK_SIFS_CCK_CTX_8814B 0xff -+#define BIT_SIFS_CCK_CTX_8814B(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_CTX_8814B) << BIT_SHIFT_SIFS_CCK_CTX_8814B) -+#define BITS_SIFS_CCK_CTX_8814B \ -+ (BIT_MASK_SIFS_CCK_CTX_8814B << BIT_SHIFT_SIFS_CCK_CTX_8814B) -+#define BIT_CLEAR_SIFS_CCK_CTX_8814B(x) ((x) & (~BITS_SIFS_CCK_CTX_8814B)) -+#define BIT_GET_SIFS_CCK_CTX_8814B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_CTX_8814B) & BIT_MASK_SIFS_CCK_CTX_8814B) -+#define BIT_SET_SIFS_CCK_CTX_8814B(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_CTX_8814B(x) | BIT_SIFS_CCK_CTX_8814B(v)) -+ -+/* 2 REG_FORCE_BCN_IFS_V1_8814B */ -+ -+#define BIT_SHIFT_FORCE_BCN_IFS_8814B 0 -+#define BIT_MASK_FORCE_BCN_IFS_8814B 0xff -+#define BIT_FORCE_BCN_IFS_8814B(x) \ -+ (((x) & BIT_MASK_FORCE_BCN_IFS_8814B) << BIT_SHIFT_FORCE_BCN_IFS_8814B) -+#define BITS_FORCE_BCN_IFS_8814B \ -+ (BIT_MASK_FORCE_BCN_IFS_8814B << BIT_SHIFT_FORCE_BCN_IFS_8814B) -+#define BIT_CLEAR_FORCE_BCN_IFS_8814B(x) ((x) & (~BITS_FORCE_BCN_IFS_8814B)) -+#define BIT_GET_FORCE_BCN_IFS_8814B(x) \ -+ (((x) >> BIT_SHIFT_FORCE_BCN_IFS_8814B) & BIT_MASK_FORCE_BCN_IFS_8814B) -+#define BIT_SET_FORCE_BCN_IFS_8814B(x, v) \ -+ (BIT_CLEAR_FORCE_BCN_IFS_8814B(x) | BIT_FORCE_BCN_IFS_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_AGGR_BREAK_TIME_8814B */ -+ -+#define BIT_SHIFT_AGGR_BK_TIME_8814B 0 -+#define BIT_MASK_AGGR_BK_TIME_8814B 0xff -+#define BIT_AGGR_BK_TIME_8814B(x) \ -+ (((x) & BIT_MASK_AGGR_BK_TIME_8814B) << BIT_SHIFT_AGGR_BK_TIME_8814B) -+#define BITS_AGGR_BK_TIME_8814B \ -+ (BIT_MASK_AGGR_BK_TIME_8814B << BIT_SHIFT_AGGR_BK_TIME_8814B) -+#define BIT_CLEAR_AGGR_BK_TIME_8814B(x) ((x) & (~BITS_AGGR_BK_TIME_8814B)) -+#define BIT_GET_AGGR_BK_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_AGGR_BK_TIME_8814B) & BIT_MASK_AGGR_BK_TIME_8814B) -+#define BIT_SET_AGGR_BK_TIME_8814B(x, v) \ -+ (BIT_CLEAR_AGGR_BK_TIME_8814B(x) | BIT_AGGR_BK_TIME_8814B(v)) -+ -+/* 2 REG_SLOT_8814B */ -+ -+#define BIT_SHIFT_SLOT_8814B 0 -+#define BIT_MASK_SLOT_8814B 0xff -+#define BIT_SLOT_8814B(x) (((x) & BIT_MASK_SLOT_8814B) << BIT_SHIFT_SLOT_8814B) -+#define BITS_SLOT_8814B (BIT_MASK_SLOT_8814B << BIT_SHIFT_SLOT_8814B) -+#define BIT_CLEAR_SLOT_8814B(x) ((x) & (~BITS_SLOT_8814B)) -+#define BIT_GET_SLOT_8814B(x) \ -+ (((x) >> BIT_SHIFT_SLOT_8814B) & BIT_MASK_SLOT_8814B) -+#define BIT_SET_SLOT_8814B(x, v) (BIT_CLEAR_SLOT_8814B(x) | BIT_SLOT_8814B(v)) -+ -+/* 2 REG_EDCA_CPUMGQ_PARAM_8814B */ -+ -+#define BIT_SHIFT_CW_V1_8814B 8 -+#define BIT_MASK_CW_V1_8814B 0xff -+#define BIT_CW_V1_8814B(x) \ -+ (((x) & BIT_MASK_CW_V1_8814B) << BIT_SHIFT_CW_V1_8814B) -+#define BITS_CW_V1_8814B (BIT_MASK_CW_V1_8814B << BIT_SHIFT_CW_V1_8814B) -+#define BIT_CLEAR_CW_V1_8814B(x) ((x) & (~BITS_CW_V1_8814B)) -+#define BIT_GET_CW_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_CW_V1_8814B) & BIT_MASK_CW_V1_8814B) -+#define BIT_SET_CW_V1_8814B(x, v) \ -+ (BIT_CLEAR_CW_V1_8814B(x) | BIT_CW_V1_8814B(v)) -+ -+#define BIT_SHIFT_AIFS_V1_8814B 0 -+#define BIT_MASK_AIFS_V1_8814B 0xff -+#define BIT_AIFS_V1_8814B(x) \ -+ (((x) & BIT_MASK_AIFS_V1_8814B) << BIT_SHIFT_AIFS_V1_8814B) -+#define BITS_AIFS_V1_8814B (BIT_MASK_AIFS_V1_8814B << BIT_SHIFT_AIFS_V1_8814B) -+#define BIT_CLEAR_AIFS_V1_8814B(x) ((x) & (~BITS_AIFS_V1_8814B)) -+#define BIT_GET_AIFS_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_AIFS_V1_8814B) & BIT_MASK_AIFS_V1_8814B) -+#define BIT_SET_AIFS_V1_8814B(x, v) \ -+ (BIT_CLEAR_AIFS_V1_8814B(x) | BIT_AIFS_V1_8814B(v)) -+ -+/* 2 REG_CPUMGQ_PAUSE_8814B */ -+#define BIT_MAC_STOP_CPUMGQ_V1_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_TX_PTCL_CTRL_8814B */ -+#define BIT_DIS_EDCCA_8814B BIT(15) -+#define BIT_DIS_CCA_8814B BIT(14) -+#define BIT_LSIG_TXOP_TXCMD_NAV_8814B BIT(13) -+#define BIT_SIFS_BK_EN_8814B BIT(12) -+ -+#define BIT_SHIFT_TXQ_NAV_MSK_8814B 8 -+#define BIT_MASK_TXQ_NAV_MSK_8814B 0xf -+#define BIT_TXQ_NAV_MSK_8814B(x) \ -+ (((x) & BIT_MASK_TXQ_NAV_MSK_8814B) << BIT_SHIFT_TXQ_NAV_MSK_8814B) -+#define BITS_TXQ_NAV_MSK_8814B \ -+ (BIT_MASK_TXQ_NAV_MSK_8814B << BIT_SHIFT_TXQ_NAV_MSK_8814B) -+#define BIT_CLEAR_TXQ_NAV_MSK_8814B(x) ((x) & (~BITS_TXQ_NAV_MSK_8814B)) -+#define BIT_GET_TXQ_NAV_MSK_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXQ_NAV_MSK_8814B) & BIT_MASK_TXQ_NAV_MSK_8814B) -+#define BIT_SET_TXQ_NAV_MSK_8814B(x, v) \ -+ (BIT_CLEAR_TXQ_NAV_MSK_8814B(x) | BIT_TXQ_NAV_MSK_8814B(v)) -+ -+#define BIT_DIS_CW_8814B BIT(7) -+#define BIT_NAV_END_TXOP_8814B BIT(6) -+#define BIT_RDG_END_TXOP_8814B BIT(5) -+#define BIT_AC_INBCN_HOLD_8814B BIT(4) -+#define BIT_MGTQ_TXOP_EN_8814B BIT(3) -+#define BIT_MGTQ_RTSMF_EN_8814B BIT(2) -+#define BIT_HIQ_RTSMF_EN_8814B BIT(1) -+#define BIT_BCN_RTSMF_EN_8814B BIT(0) -+ -+/* 2 REG_TXPAUSE_8814B */ -+#define BIT_STOP_BCN_HI_MGT_8814B BIT(7) -+#define BIT_MAC_STOPBCNQ_8814B BIT(6) -+#define BIT_MAC_STOPHIQ_8814B BIT(5) -+#define BIT_MAC_STOPMGQ_8814B BIT(4) -+#define BIT_MAC_STOPBK_8814B BIT(3) -+#define BIT_MAC_STOPBE_8814B BIT(2) -+#define BIT_MAC_STOPVI_8814B BIT(1) -+#define BIT_MAC_STOPVO_8814B BIT(0) -+ -+/* 2 REG_DIS_TXREQ_CLR_8814B */ -+#define BIT_DIS_BT_CCA_8814B BIT(7) -+#define BIT_DIS_TXREQ_CLR_HI_8814B BIT(5) -+#define BIT_DIS_TXREQ_CLR_MGQ_8814B BIT(4) -+#define BIT_DIS_TXREQ_CLR_VO_8814B BIT(3) -+#define BIT_DIS_TXREQ_CLR_VI_8814B BIT(2) -+#define BIT_DIS_TXREQ_CLR_BE_8814B BIT(1) -+#define BIT_DIS_TXREQ_CLR_BK_8814B BIT(0) -+ -+/* 2 REG_RD_CTRL_8814B */ -+#define BIT_EN_CLR_TXREQ_INCCA_8814B BIT(15) -+#define BIT_DIS_TX_OVER_BCNQ_8814B BIT(14) -+#define BIT_EN_BCNERR_INCCCA_8814B BIT(13) -+#define BIT_EDCCA_MSK_CNTDOWN_EN_8814B BIT(11) -+#define BIT_DIS_TXOP_CFE_8814B BIT(10) -+#define BIT_DIS_LSIG_CFE_8814B BIT(9) -+#define BIT_BKQ_RD_INIT_EN_8814B BIT(7) -+#define BIT_BEQ_RD_INIT_EN_8814B BIT(6) -+#define BIT_VIQ_RD_INIT_EN_8814B BIT(5) -+#define BIT_VOQ_RD_INIT_EN_8814B BIT(4) -+#define BIT_BKQ_RD_RESP_EN_8814B BIT(3) -+#define BIT_BEQ_RD_RESP_EN_8814B BIT(2) -+#define BIT_VIQ_RD_RESP_EN_8814B BIT(1) -+#define BIT_VOQ_RD_RESP_EN_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_PKT_LIFETIME_CTRL_8814B */ -+#define BIT_EN_P2P_CTWND1_8814B BIT(23) -+#define BIT_EN_BKF_CLR_TXREQ_8814B BIT(22) -+#define BIT_EN_BCN_TX_BTCCA_8814B BIT(20) -+#define BIT_DIS_PKT_TX_ATIM_8814B BIT(19) -+#define BIT_DIS_BCN_DIS_CTN_8814B BIT(18) -+#define BIT_EN_NAVEND_RST_TXOP_8814B BIT(17) -+#define BIT_EN_FILTER_CCA_8814B BIT(16) -+ -+#define BIT_SHIFT_CCA_FILTER_THRS_8814B 8 -+#define BIT_MASK_CCA_FILTER_THRS_8814B 0xff -+#define BIT_CCA_FILTER_THRS_8814B(x) \ -+ (((x) & BIT_MASK_CCA_FILTER_THRS_8814B) \ -+ << BIT_SHIFT_CCA_FILTER_THRS_8814B) -+#define BITS_CCA_FILTER_THRS_8814B \ -+ (BIT_MASK_CCA_FILTER_THRS_8814B << BIT_SHIFT_CCA_FILTER_THRS_8814B) -+#define BIT_CLEAR_CCA_FILTER_THRS_8814B(x) ((x) & (~BITS_CCA_FILTER_THRS_8814B)) -+#define BIT_GET_CCA_FILTER_THRS_8814B(x) \ -+ (((x) >> BIT_SHIFT_CCA_FILTER_THRS_8814B) & \ -+ BIT_MASK_CCA_FILTER_THRS_8814B) -+#define BIT_SET_CCA_FILTER_THRS_8814B(x, v) \ -+ (BIT_CLEAR_CCA_FILTER_THRS_8814B(x) | BIT_CCA_FILTER_THRS_8814B(v)) -+ -+#define BIT_SHIFT_EDCCA_THRS_8814B 0 -+#define BIT_MASK_EDCCA_THRS_8814B 0xff -+#define BIT_EDCCA_THRS_8814B(x) \ -+ (((x) & BIT_MASK_EDCCA_THRS_8814B) << BIT_SHIFT_EDCCA_THRS_8814B) -+#define BITS_EDCCA_THRS_8814B \ -+ (BIT_MASK_EDCCA_THRS_8814B << BIT_SHIFT_EDCCA_THRS_8814B) -+#define BIT_CLEAR_EDCCA_THRS_8814B(x) ((x) & (~BITS_EDCCA_THRS_8814B)) -+#define BIT_GET_EDCCA_THRS_8814B(x) \ -+ (((x) >> BIT_SHIFT_EDCCA_THRS_8814B) & BIT_MASK_EDCCA_THRS_8814B) -+#define BIT_SET_EDCCA_THRS_8814B(x, v) \ -+ (BIT_CLEAR_EDCCA_THRS_8814B(x) | BIT_EDCCA_THRS_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_TXOP_LIMIT_CTRL_8814B */ -+ -+#define BIT_SHIFT_TXOP_TBTT_CNT_8814B 24 -+#define BIT_MASK_TXOP_TBTT_CNT_8814B 0xff -+#define BIT_TXOP_TBTT_CNT_8814B(x) \ -+ (((x) & BIT_MASK_TXOP_TBTT_CNT_8814B) << BIT_SHIFT_TXOP_TBTT_CNT_8814B) -+#define BITS_TXOP_TBTT_CNT_8814B \ -+ (BIT_MASK_TXOP_TBTT_CNT_8814B << BIT_SHIFT_TXOP_TBTT_CNT_8814B) -+#define BIT_CLEAR_TXOP_TBTT_CNT_8814B(x) ((x) & (~BITS_TXOP_TBTT_CNT_8814B)) -+#define BIT_GET_TXOP_TBTT_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_TBTT_CNT_8814B) & BIT_MASK_TXOP_TBTT_CNT_8814B) -+#define BIT_SET_TXOP_TBTT_CNT_8814B(x, v) \ -+ (BIT_CLEAR_TXOP_TBTT_CNT_8814B(x) | BIT_TXOP_TBTT_CNT_8814B(v)) -+ -+#define BIT_SHIFT_TXOP_TBTT_CNT_SEL_8814B 20 -+#define BIT_MASK_TXOP_TBTT_CNT_SEL_8814B 0xf -+#define BIT_TXOP_TBTT_CNT_SEL_8814B(x) \ -+ (((x) & BIT_MASK_TXOP_TBTT_CNT_SEL_8814B) \ -+ << BIT_SHIFT_TXOP_TBTT_CNT_SEL_8814B) -+#define BITS_TXOP_TBTT_CNT_SEL_8814B \ -+ (BIT_MASK_TXOP_TBTT_CNT_SEL_8814B << BIT_SHIFT_TXOP_TBTT_CNT_SEL_8814B) -+#define BIT_CLEAR_TXOP_TBTT_CNT_SEL_8814B(x) \ -+ ((x) & (~BITS_TXOP_TBTT_CNT_SEL_8814B)) -+#define BIT_GET_TXOP_TBTT_CNT_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_TBTT_CNT_SEL_8814B) & \ -+ BIT_MASK_TXOP_TBTT_CNT_SEL_8814B) -+#define BIT_SET_TXOP_TBTT_CNT_SEL_8814B(x, v) \ -+ (BIT_CLEAR_TXOP_TBTT_CNT_SEL_8814B(x) | BIT_TXOP_TBTT_CNT_SEL_8814B(v)) -+ -+#define BIT_SHIFT_TXOP_LMT_EN_8814B 16 -+#define BIT_MASK_TXOP_LMT_EN_8814B 0xf -+#define BIT_TXOP_LMT_EN_8814B(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_EN_8814B) << BIT_SHIFT_TXOP_LMT_EN_8814B) -+#define BITS_TXOP_LMT_EN_8814B \ -+ (BIT_MASK_TXOP_LMT_EN_8814B << BIT_SHIFT_TXOP_LMT_EN_8814B) -+#define BIT_CLEAR_TXOP_LMT_EN_8814B(x) ((x) & (~BITS_TXOP_LMT_EN_8814B)) -+#define BIT_GET_TXOP_LMT_EN_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_EN_8814B) & BIT_MASK_TXOP_LMT_EN_8814B) -+#define BIT_SET_TXOP_LMT_EN_8814B(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_EN_8814B(x) | BIT_TXOP_LMT_EN_8814B(v)) -+ -+#define BIT_SHIFT_TXOP_LMT_TX_TIME_8814B 8 -+#define BIT_MASK_TXOP_LMT_TX_TIME_8814B 0xff -+#define BIT_TXOP_LMT_TX_TIME_8814B(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_TX_TIME_8814B) \ -+ << BIT_SHIFT_TXOP_LMT_TX_TIME_8814B) -+#define BITS_TXOP_LMT_TX_TIME_8814B \ -+ (BIT_MASK_TXOP_LMT_TX_TIME_8814B << BIT_SHIFT_TXOP_LMT_TX_TIME_8814B) -+#define BIT_CLEAR_TXOP_LMT_TX_TIME_8814B(x) \ -+ ((x) & (~BITS_TXOP_LMT_TX_TIME_8814B)) -+#define BIT_GET_TXOP_LMT_TX_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_TX_TIME_8814B) & \ -+ BIT_MASK_TXOP_LMT_TX_TIME_8814B) -+#define BIT_SET_TXOP_LMT_TX_TIME_8814B(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_TX_TIME_8814B(x) | BIT_TXOP_LMT_TX_TIME_8814B(v)) -+ -+#define BIT_TXOP_CNT_TRIGGER_RESET_8814B BIT(7) -+ -+#define BIT_SHIFT_TXOP_LMT_PKT_NUM_8814B 0 -+#define BIT_MASK_TXOP_LMT_PKT_NUM_8814B 0x3f -+#define BIT_TXOP_LMT_PKT_NUM_8814B(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_PKT_NUM_8814B) \ -+ << BIT_SHIFT_TXOP_LMT_PKT_NUM_8814B) -+#define BITS_TXOP_LMT_PKT_NUM_8814B \ -+ (BIT_MASK_TXOP_LMT_PKT_NUM_8814B << BIT_SHIFT_TXOP_LMT_PKT_NUM_8814B) -+#define BIT_CLEAR_TXOP_LMT_PKT_NUM_8814B(x) \ -+ ((x) & (~BITS_TXOP_LMT_PKT_NUM_8814B)) -+#define BIT_GET_TXOP_LMT_PKT_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_PKT_NUM_8814B) & \ -+ BIT_MASK_TXOP_LMT_PKT_NUM_8814B) -+#define BIT_SET_TXOP_LMT_PKT_NUM_8814B(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_PKT_NUM_8814B(x) | BIT_TXOP_LMT_PKT_NUM_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_CCA_TXEN_CNT_8814B */ -+#define BIT_CCA_TXEN_CNT_SWITCH_8814B BIT(17) -+#define BIT_CCA_TXEN_CNT_EN_8814B BIT(16) -+ -+#define BIT_SHIFT_CCA_TXEN_BIG_CNT_8814B 8 -+#define BIT_MASK_CCA_TXEN_BIG_CNT_8814B 0xff -+#define BIT_CCA_TXEN_BIG_CNT_8814B(x) \ -+ (((x) & BIT_MASK_CCA_TXEN_BIG_CNT_8814B) \ -+ << BIT_SHIFT_CCA_TXEN_BIG_CNT_8814B) -+#define BITS_CCA_TXEN_BIG_CNT_8814B \ -+ (BIT_MASK_CCA_TXEN_BIG_CNT_8814B << BIT_SHIFT_CCA_TXEN_BIG_CNT_8814B) -+#define BIT_CLEAR_CCA_TXEN_BIG_CNT_8814B(x) \ -+ ((x) & (~BITS_CCA_TXEN_BIG_CNT_8814B)) -+#define BIT_GET_CCA_TXEN_BIG_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_CCA_TXEN_BIG_CNT_8814B) & \ -+ BIT_MASK_CCA_TXEN_BIG_CNT_8814B) -+#define BIT_SET_CCA_TXEN_BIG_CNT_8814B(x, v) \ -+ (BIT_CLEAR_CCA_TXEN_BIG_CNT_8814B(x) | BIT_CCA_TXEN_BIG_CNT_8814B(v)) -+ -+#define BIT_SHIFT_CCA_TXEN_SMALL_CNT_8814B 0 -+#define BIT_MASK_CCA_TXEN_SMALL_CNT_8814B 0xff -+#define BIT_CCA_TXEN_SMALL_CNT_8814B(x) \ -+ (((x) & BIT_MASK_CCA_TXEN_SMALL_CNT_8814B) \ -+ << BIT_SHIFT_CCA_TXEN_SMALL_CNT_8814B) -+#define BITS_CCA_TXEN_SMALL_CNT_8814B \ -+ (BIT_MASK_CCA_TXEN_SMALL_CNT_8814B \ -+ << BIT_SHIFT_CCA_TXEN_SMALL_CNT_8814B) -+#define BIT_CLEAR_CCA_TXEN_SMALL_CNT_8814B(x) \ -+ ((x) & (~BITS_CCA_TXEN_SMALL_CNT_8814B)) -+#define BIT_GET_CCA_TXEN_SMALL_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_CCA_TXEN_SMALL_CNT_8814B) & \ -+ BIT_MASK_CCA_TXEN_SMALL_CNT_8814B) -+#define BIT_SET_CCA_TXEN_SMALL_CNT_8814B(x, v) \ -+ (BIT_CLEAR_CCA_TXEN_SMALL_CNT_8814B(x) | \ -+ BIT_CCA_TXEN_SMALL_CNT_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_MAX_INTER_COLLISION_8814B */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_BK_8814B 24 -+#define BIT_MASK_MAX_INTER_COLLISION_BK_8814B 0xff -+#define BIT_MAX_INTER_COLLISION_BK_8814B(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_BK_8814B) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BK_8814B) -+#define BITS_MAX_INTER_COLLISION_BK_8814B \ -+ (BIT_MASK_MAX_INTER_COLLISION_BK_8814B \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BK_8814B) -+#define BIT_CLEAR_MAX_INTER_COLLISION_BK_8814B(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_BK_8814B)) -+#define BIT_GET_MAX_INTER_COLLISION_BK_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_BK_8814B) & \ -+ BIT_MASK_MAX_INTER_COLLISION_BK_8814B) -+#define BIT_SET_MAX_INTER_COLLISION_BK_8814B(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_BK_8814B(x) | \ -+ BIT_MAX_INTER_COLLISION_BK_8814B(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_BE_8814B 16 -+#define BIT_MASK_MAX_INTER_COLLISION_BE_8814B 0xff -+#define BIT_MAX_INTER_COLLISION_BE_8814B(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_BE_8814B) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BE_8814B) -+#define BITS_MAX_INTER_COLLISION_BE_8814B \ -+ (BIT_MASK_MAX_INTER_COLLISION_BE_8814B \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BE_8814B) -+#define BIT_CLEAR_MAX_INTER_COLLISION_BE_8814B(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_BE_8814B)) -+#define BIT_GET_MAX_INTER_COLLISION_BE_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_BE_8814B) & \ -+ BIT_MASK_MAX_INTER_COLLISION_BE_8814B) -+#define BIT_SET_MAX_INTER_COLLISION_BE_8814B(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_BE_8814B(x) | \ -+ BIT_MAX_INTER_COLLISION_BE_8814B(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_VI_8814B 8 -+#define BIT_MASK_MAX_INTER_COLLISION_VI_8814B 0xff -+#define BIT_MAX_INTER_COLLISION_VI_8814B(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_VI_8814B) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VI_8814B) -+#define BITS_MAX_INTER_COLLISION_VI_8814B \ -+ (BIT_MASK_MAX_INTER_COLLISION_VI_8814B \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VI_8814B) -+#define BIT_CLEAR_MAX_INTER_COLLISION_VI_8814B(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_VI_8814B)) -+#define BIT_GET_MAX_INTER_COLLISION_VI_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_VI_8814B) & \ -+ BIT_MASK_MAX_INTER_COLLISION_VI_8814B) -+#define BIT_SET_MAX_INTER_COLLISION_VI_8814B(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_VI_8814B(x) | \ -+ BIT_MAX_INTER_COLLISION_VI_8814B(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_VO_8814B 0 -+#define BIT_MASK_MAX_INTER_COLLISION_VO_8814B 0xff -+#define BIT_MAX_INTER_COLLISION_VO_8814B(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_VO_8814B) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VO_8814B) -+#define BITS_MAX_INTER_COLLISION_VO_8814B \ -+ (BIT_MASK_MAX_INTER_COLLISION_VO_8814B \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VO_8814B) -+#define BIT_CLEAR_MAX_INTER_COLLISION_VO_8814B(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_VO_8814B)) -+#define BIT_GET_MAX_INTER_COLLISION_VO_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_VO_8814B) & \ -+ BIT_MASK_MAX_INTER_COLLISION_VO_8814B) -+#define BIT_SET_MAX_INTER_COLLISION_VO_8814B(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_VO_8814B(x) | \ -+ BIT_MAX_INTER_COLLISION_VO_8814B(v)) -+ -+/* 2 REG_MAX_INTER_COLLISION_CNT_8814B */ -+#define BIT_MAX_INTER_COLLISION_EN_8814B BIT(16) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8814B 12 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8814B 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_BK_8814B(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8814B) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8814B) -+#define BITS_MAX_INTER_COLLISION_CNT_BK_8814B \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8814B \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8814B) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_BK_8814B(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_BK_8814B)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_BK_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8814B) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8814B) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_BK_8814B(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_BK_8814B(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_BK_8814B(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8814B 8 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8814B 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_BE_8814B(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8814B) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8814B) -+#define BITS_MAX_INTER_COLLISION_CNT_BE_8814B \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8814B \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8814B) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_BE_8814B(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_BE_8814B)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_BE_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8814B) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8814B) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_BE_8814B(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_BE_8814B(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_BE_8814B(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8814B 4 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8814B 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_VI_8814B(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8814B) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8814B) -+#define BITS_MAX_INTER_COLLISION_CNT_VI_8814B \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8814B \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8814B) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_VI_8814B(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_VI_8814B)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_VI_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8814B) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8814B) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_VI_8814B(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_VI_8814B(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_VI_8814B(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8814B 0 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8814B 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_VO_8814B(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8814B) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8814B) -+#define BITS_MAX_INTER_COLLISION_CNT_VO_8814B \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8814B \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8814B) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_VO_8814B(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_VO_8814B)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_VO_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8814B) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8814B) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_VO_8814B(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_VO_8814B(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_VO_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_RD_NAV_NXT_8814B */ -+ -+#define BIT_SHIFT_RD_NAV_PROT_NXT_8814B 0 -+#define BIT_MASK_RD_NAV_PROT_NXT_8814B 0xffff -+#define BIT_RD_NAV_PROT_NXT_8814B(x) \ -+ (((x) & BIT_MASK_RD_NAV_PROT_NXT_8814B) \ -+ << BIT_SHIFT_RD_NAV_PROT_NXT_8814B) -+#define BITS_RD_NAV_PROT_NXT_8814B \ -+ (BIT_MASK_RD_NAV_PROT_NXT_8814B << BIT_SHIFT_RD_NAV_PROT_NXT_8814B) -+#define BIT_CLEAR_RD_NAV_PROT_NXT_8814B(x) ((x) & (~BITS_RD_NAV_PROT_NXT_8814B)) -+#define BIT_GET_RD_NAV_PROT_NXT_8814B(x) \ -+ (((x) >> BIT_SHIFT_RD_NAV_PROT_NXT_8814B) & \ -+ BIT_MASK_RD_NAV_PROT_NXT_8814B) -+#define BIT_SET_RD_NAV_PROT_NXT_8814B(x, v) \ -+ (BIT_CLEAR_RD_NAV_PROT_NXT_8814B(x) | BIT_RD_NAV_PROT_NXT_8814B(v)) -+ -+/* 2 REG_NAV_PROT_LEN_8814B */ -+ -+#define BIT_SHIFT_NAV_PROT_LEN_8814B 0 -+#define BIT_MASK_NAV_PROT_LEN_8814B 0xffff -+#define BIT_NAV_PROT_LEN_8814B(x) \ -+ (((x) & BIT_MASK_NAV_PROT_LEN_8814B) << BIT_SHIFT_NAV_PROT_LEN_8814B) -+#define BITS_NAV_PROT_LEN_8814B \ -+ (BIT_MASK_NAV_PROT_LEN_8814B << BIT_SHIFT_NAV_PROT_LEN_8814B) -+#define BIT_CLEAR_NAV_PROT_LEN_8814B(x) ((x) & (~BITS_NAV_PROT_LEN_8814B)) -+#define BIT_GET_NAV_PROT_LEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_NAV_PROT_LEN_8814B) & BIT_MASK_NAV_PROT_LEN_8814B) -+#define BIT_SET_NAV_PROT_LEN_8814B(x, v) \ -+ (BIT_CLEAR_NAV_PROT_LEN_8814B(x) | BIT_NAV_PROT_LEN_8814B(v)) -+ -+/* 2 REG_FTM_PTT_8814B */ -+ -+#define BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8814B 22 -+#define BIT_MASK_FTM_PTT_TSF_R2T_SEL_8814B 0x7 -+#define BIT_FTM_PTT_TSF_R2T_SEL_8814B(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_R2T_SEL_8814B) \ -+ << BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8814B) -+#define BITS_FTM_PTT_TSF_R2T_SEL_8814B \ -+ (BIT_MASK_FTM_PTT_TSF_R2T_SEL_8814B \ -+ << BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8814B) -+#define BIT_CLEAR_FTM_PTT_TSF_R2T_SEL_8814B(x) \ -+ ((x) & (~BITS_FTM_PTT_TSF_R2T_SEL_8814B)) -+#define BIT_GET_FTM_PTT_TSF_R2T_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8814B) & \ -+ BIT_MASK_FTM_PTT_TSF_R2T_SEL_8814B) -+#define BIT_SET_FTM_PTT_TSF_R2T_SEL_8814B(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_R2T_SEL_8814B(x) | \ -+ BIT_FTM_PTT_TSF_R2T_SEL_8814B(v)) -+ -+#define BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8814B 19 -+#define BIT_MASK_FTM_PTT_TSF_T2R_SEL_8814B 0x7 -+#define BIT_FTM_PTT_TSF_T2R_SEL_8814B(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_T2R_SEL_8814B) \ -+ << BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8814B) -+#define BITS_FTM_PTT_TSF_T2R_SEL_8814B \ -+ (BIT_MASK_FTM_PTT_TSF_T2R_SEL_8814B \ -+ << BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8814B) -+#define BIT_CLEAR_FTM_PTT_TSF_T2R_SEL_8814B(x) \ -+ ((x) & (~BITS_FTM_PTT_TSF_T2R_SEL_8814B)) -+#define BIT_GET_FTM_PTT_TSF_T2R_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8814B) & \ -+ BIT_MASK_FTM_PTT_TSF_T2R_SEL_8814B) -+#define BIT_SET_FTM_PTT_TSF_T2R_SEL_8814B(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_T2R_SEL_8814B(x) | \ -+ BIT_FTM_PTT_TSF_T2R_SEL_8814B(v)) -+ -+#define BIT_SHIFT_FTM_PTT_TSF_SEL_8814B 16 -+#define BIT_MASK_FTM_PTT_TSF_SEL_8814B 0x7 -+#define BIT_FTM_PTT_TSF_SEL_8814B(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_SEL_8814B) \ -+ << BIT_SHIFT_FTM_PTT_TSF_SEL_8814B) -+#define BITS_FTM_PTT_TSF_SEL_8814B \ -+ (BIT_MASK_FTM_PTT_TSF_SEL_8814B << BIT_SHIFT_FTM_PTT_TSF_SEL_8814B) -+#define BIT_CLEAR_FTM_PTT_TSF_SEL_8814B(x) ((x) & (~BITS_FTM_PTT_TSF_SEL_8814B)) -+#define BIT_GET_FTM_PTT_TSF_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_SEL_8814B) & \ -+ BIT_MASK_FTM_PTT_TSF_SEL_8814B) -+#define BIT_SET_FTM_PTT_TSF_SEL_8814B(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_SEL_8814B(x) | BIT_FTM_PTT_TSF_SEL_8814B(v)) -+ -+#define BIT_SHIFT_FTM_PTT_VALUE_8814B 0 -+#define BIT_MASK_FTM_PTT_VALUE_8814B 0xffff -+#define BIT_FTM_PTT_VALUE_8814B(x) \ -+ (((x) & BIT_MASK_FTM_PTT_VALUE_8814B) << BIT_SHIFT_FTM_PTT_VALUE_8814B) -+#define BITS_FTM_PTT_VALUE_8814B \ -+ (BIT_MASK_FTM_PTT_VALUE_8814B << BIT_SHIFT_FTM_PTT_VALUE_8814B) -+#define BIT_CLEAR_FTM_PTT_VALUE_8814B(x) ((x) & (~BITS_FTM_PTT_VALUE_8814B)) -+#define BIT_GET_FTM_PTT_VALUE_8814B(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_VALUE_8814B) & BIT_MASK_FTM_PTT_VALUE_8814B) -+#define BIT_SET_FTM_PTT_VALUE_8814B(x, v) \ -+ (BIT_CLEAR_FTM_PTT_VALUE_8814B(x) | BIT_FTM_PTT_VALUE_8814B(v)) -+ -+/* 2 REG_FTM_TSF_8814B */ -+ -+#define BIT_SHIFT_FTM_T2_TSF_8814B 16 -+#define BIT_MASK_FTM_T2_TSF_8814B 0xffff -+#define BIT_FTM_T2_TSF_8814B(x) \ -+ (((x) & BIT_MASK_FTM_T2_TSF_8814B) << BIT_SHIFT_FTM_T2_TSF_8814B) -+#define BITS_FTM_T2_TSF_8814B \ -+ (BIT_MASK_FTM_T2_TSF_8814B << BIT_SHIFT_FTM_T2_TSF_8814B) -+#define BIT_CLEAR_FTM_T2_TSF_8814B(x) ((x) & (~BITS_FTM_T2_TSF_8814B)) -+#define BIT_GET_FTM_T2_TSF_8814B(x) \ -+ (((x) >> BIT_SHIFT_FTM_T2_TSF_8814B) & BIT_MASK_FTM_T2_TSF_8814B) -+#define BIT_SET_FTM_T2_TSF_8814B(x, v) \ -+ (BIT_CLEAR_FTM_T2_TSF_8814B(x) | BIT_FTM_T2_TSF_8814B(v)) -+ -+#define BIT_SHIFT_FTM_T1_TSF_8814B 0 -+#define BIT_MASK_FTM_T1_TSF_8814B 0xffff -+#define BIT_FTM_T1_TSF_8814B(x) \ -+ (((x) & BIT_MASK_FTM_T1_TSF_8814B) << BIT_SHIFT_FTM_T1_TSF_8814B) -+#define BITS_FTM_T1_TSF_8814B \ -+ (BIT_MASK_FTM_T1_TSF_8814B << BIT_SHIFT_FTM_T1_TSF_8814B) -+#define BIT_CLEAR_FTM_T1_TSF_8814B(x) ((x) & (~BITS_FTM_T1_TSF_8814B)) -+#define BIT_GET_FTM_T1_TSF_8814B(x) \ -+ (((x) >> BIT_SHIFT_FTM_T1_TSF_8814B) & BIT_MASK_FTM_T1_TSF_8814B) -+#define BIT_SET_FTM_T1_TSF_8814B(x, v) \ -+ (BIT_CLEAR_FTM_T1_TSF_8814B(x) | BIT_FTM_T1_TSF_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_HGQ_TIMEOUT_PERIOD_8814B */ -+ -+#define BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8814B 0 -+#define BIT_MASK_HGQ_TIMEOUT_PERIOD_8814B 0xff -+#define BIT_HGQ_TIMEOUT_PERIOD_8814B(x) \ -+ (((x) & BIT_MASK_HGQ_TIMEOUT_PERIOD_8814B) \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8814B) -+#define BITS_HGQ_TIMEOUT_PERIOD_8814B \ -+ (BIT_MASK_HGQ_TIMEOUT_PERIOD_8814B \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8814B) -+#define BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8814B(x) \ -+ ((x) & (~BITS_HGQ_TIMEOUT_PERIOD_8814B)) -+#define BIT_GET_HGQ_TIMEOUT_PERIOD_8814B(x) \ -+ (((x) >> BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8814B) & \ -+ BIT_MASK_HGQ_TIMEOUT_PERIOD_8814B) -+#define BIT_SET_HGQ_TIMEOUT_PERIOD_8814B(x, v) \ -+ (BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8814B(x) | \ -+ BIT_HGQ_TIMEOUT_PERIOD_8814B(v)) -+ -+/* 2 REG_TXCMD_TIMEOUT_PERIOD_8814B */ -+ -+#define BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8814B 0 -+#define BIT_MASK_TXCMD_TIMEOUT_PERIOD_8814B 0xff -+#define BIT_TXCMD_TIMEOUT_PERIOD_8814B(x) \ -+ (((x) & BIT_MASK_TXCMD_TIMEOUT_PERIOD_8814B) \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8814B) -+#define BITS_TXCMD_TIMEOUT_PERIOD_8814B \ -+ (BIT_MASK_TXCMD_TIMEOUT_PERIOD_8814B \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8814B) -+#define BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8814B(x) \ -+ ((x) & (~BITS_TXCMD_TIMEOUT_PERIOD_8814B)) -+#define BIT_GET_TXCMD_TIMEOUT_PERIOD_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8814B) & \ -+ BIT_MASK_TXCMD_TIMEOUT_PERIOD_8814B) -+#define BIT_SET_TXCMD_TIMEOUT_PERIOD_8814B(x, v) \ -+ (BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8814B(x) | \ -+ BIT_TXCMD_TIMEOUT_PERIOD_8814B(v)) -+ -+/* 2 REG_MISC_CTRL_8814B */ -+#define BIT_DIS_SECONDARY_CCA_80M_8814B BIT(2) -+#define BIT_DIS_SECONDARY_CCA_40M_8814B BIT(1) -+#define BIT_DIS_SECONDARY_CCA_20M_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_TXOP_MIN_8814B */ -+#define BIT_HIQ_NAV_BREAK_EN_8814B BIT(15) -+#define BIT_MGQ_NAV_BREAK_EN_8814B BIT(14) -+ -+#define BIT_SHIFT_TXOP_MIN_8814B 0 -+#define BIT_MASK_TXOP_MIN_8814B 0x3fff -+#define BIT_TXOP_MIN_8814B(x) \ -+ (((x) & BIT_MASK_TXOP_MIN_8814B) << BIT_SHIFT_TXOP_MIN_8814B) -+#define BITS_TXOP_MIN_8814B \ -+ (BIT_MASK_TXOP_MIN_8814B << BIT_SHIFT_TXOP_MIN_8814B) -+#define BIT_CLEAR_TXOP_MIN_8814B(x) ((x) & (~BITS_TXOP_MIN_8814B)) -+#define BIT_GET_TXOP_MIN_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_MIN_8814B) & BIT_MASK_TXOP_MIN_8814B) -+#define BIT_SET_TXOP_MIN_8814B(x, v) \ -+ (BIT_CLEAR_TXOP_MIN_8814B(x) | BIT_TXOP_MIN_8814B(v)) -+ -+/* 2 REG_PRE_BKF_TIME_8814B */ -+ -+#define BIT_SHIFT_PRE_BKF_TIME_8814B 0 -+#define BIT_MASK_PRE_BKF_TIME_8814B 0xff -+#define BIT_PRE_BKF_TIME_8814B(x) \ -+ (((x) & BIT_MASK_PRE_BKF_TIME_8814B) << BIT_SHIFT_PRE_BKF_TIME_8814B) -+#define BITS_PRE_BKF_TIME_8814B \ -+ (BIT_MASK_PRE_BKF_TIME_8814B << BIT_SHIFT_PRE_BKF_TIME_8814B) -+#define BIT_CLEAR_PRE_BKF_TIME_8814B(x) ((x) & (~BITS_PRE_BKF_TIME_8814B)) -+#define BIT_GET_PRE_BKF_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_PRE_BKF_TIME_8814B) & BIT_MASK_PRE_BKF_TIME_8814B) -+#define BIT_SET_PRE_BKF_TIME_8814B(x, v) \ -+ (BIT_CLEAR_PRE_BKF_TIME_8814B(x) | BIT_PRE_BKF_TIME_8814B(v)) -+ -+/* 2 REG_CROSS_TXOP_CTRL_8814B */ -+#define BIT_TBTT_RETRY_8814B BIT(4) -+#define BIT_TXFAIL_BREACK_TXOP_EN_8814B BIT(3) -+#define BIT_RTS_NAV_TXOP_8814B BIT(1) -+#define BIT_NOT_CROSS_TXOP_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_ACMHWCTRL_8814B */ -+#define BIT_BEQ_ACM_STATUS_8814B BIT(7) -+#define BIT_VIQ_ACM_STATUS_8814B BIT(6) -+#define BIT_VOQ_ACM_STATUS_8814B BIT(5) -+#define BIT_BEQ_ACM_EN_8814B BIT(3) -+#define BIT_VIQ_ACM_EN_8814B BIT(2) -+#define BIT_VOQ_ACM_EN_8814B BIT(1) -+#define BIT_ACMHWEN_8814B BIT(0) -+ -+/* 2 REG_ACMRSTCTRL_8814B */ -+#define BIT_BE_ACM_RESET_USED_TIME_8814B BIT(2) -+#define BIT_VI_ACM_RESET_USED_TIME_8814B BIT(1) -+#define BIT_VO_ACM_RESET_USED_TIME_8814B BIT(0) -+ -+/* 2 REG_ACMAVG_8814B */ -+ -+#define BIT_SHIFT_AVGPERIOD_8814B 0 -+#define BIT_MASK_AVGPERIOD_8814B 0xffff -+#define BIT_AVGPERIOD_8814B(x) \ -+ (((x) & BIT_MASK_AVGPERIOD_8814B) << BIT_SHIFT_AVGPERIOD_8814B) -+#define BITS_AVGPERIOD_8814B \ -+ (BIT_MASK_AVGPERIOD_8814B << BIT_SHIFT_AVGPERIOD_8814B) -+#define BIT_CLEAR_AVGPERIOD_8814B(x) ((x) & (~BITS_AVGPERIOD_8814B)) -+#define BIT_GET_AVGPERIOD_8814B(x) \ -+ (((x) >> BIT_SHIFT_AVGPERIOD_8814B) & BIT_MASK_AVGPERIOD_8814B) -+#define BIT_SET_AVGPERIOD_8814B(x, v) \ -+ (BIT_CLEAR_AVGPERIOD_8814B(x) | BIT_AVGPERIOD_8814B(v)) -+ -+/* 2 REG_VO_ADMTIME_8814B */ -+ -+#define BIT_SHIFT_VO_ADMITTED_TIME_8814B 0 -+#define BIT_MASK_VO_ADMITTED_TIME_8814B 0xffff -+#define BIT_VO_ADMITTED_TIME_8814B(x) \ -+ (((x) & BIT_MASK_VO_ADMITTED_TIME_8814B) \ -+ << BIT_SHIFT_VO_ADMITTED_TIME_8814B) -+#define BITS_VO_ADMITTED_TIME_8814B \ -+ (BIT_MASK_VO_ADMITTED_TIME_8814B << BIT_SHIFT_VO_ADMITTED_TIME_8814B) -+#define BIT_CLEAR_VO_ADMITTED_TIME_8814B(x) \ -+ ((x) & (~BITS_VO_ADMITTED_TIME_8814B)) -+#define BIT_GET_VO_ADMITTED_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_VO_ADMITTED_TIME_8814B) & \ -+ BIT_MASK_VO_ADMITTED_TIME_8814B) -+#define BIT_SET_VO_ADMITTED_TIME_8814B(x, v) \ -+ (BIT_CLEAR_VO_ADMITTED_TIME_8814B(x) | BIT_VO_ADMITTED_TIME_8814B(v)) -+ -+/* 2 REG_VI_ADMTIME_8814B */ -+ -+#define BIT_SHIFT_VI_ADMITTED_TIME_8814B 0 -+#define BIT_MASK_VI_ADMITTED_TIME_8814B 0xffff -+#define BIT_VI_ADMITTED_TIME_8814B(x) \ -+ (((x) & BIT_MASK_VI_ADMITTED_TIME_8814B) \ -+ << BIT_SHIFT_VI_ADMITTED_TIME_8814B) -+#define BITS_VI_ADMITTED_TIME_8814B \ -+ (BIT_MASK_VI_ADMITTED_TIME_8814B << BIT_SHIFT_VI_ADMITTED_TIME_8814B) -+#define BIT_CLEAR_VI_ADMITTED_TIME_8814B(x) \ -+ ((x) & (~BITS_VI_ADMITTED_TIME_8814B)) -+#define BIT_GET_VI_ADMITTED_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_VI_ADMITTED_TIME_8814B) & \ -+ BIT_MASK_VI_ADMITTED_TIME_8814B) -+#define BIT_SET_VI_ADMITTED_TIME_8814B(x, v) \ -+ (BIT_CLEAR_VI_ADMITTED_TIME_8814B(x) | BIT_VI_ADMITTED_TIME_8814B(v)) -+ -+/* 2 REG_BE_ADMTIME_8814B */ -+ -+#define BIT_SHIFT_BE_ADMITTED_TIME_8814B 0 -+#define BIT_MASK_BE_ADMITTED_TIME_8814B 0xffff -+#define BIT_BE_ADMITTED_TIME_8814B(x) \ -+ (((x) & BIT_MASK_BE_ADMITTED_TIME_8814B) \ -+ << BIT_SHIFT_BE_ADMITTED_TIME_8814B) -+#define BITS_BE_ADMITTED_TIME_8814B \ -+ (BIT_MASK_BE_ADMITTED_TIME_8814B << BIT_SHIFT_BE_ADMITTED_TIME_8814B) -+#define BIT_CLEAR_BE_ADMITTED_TIME_8814B(x) \ -+ ((x) & (~BITS_BE_ADMITTED_TIME_8814B)) -+#define BIT_GET_BE_ADMITTED_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_BE_ADMITTED_TIME_8814B) & \ -+ BIT_MASK_BE_ADMITTED_TIME_8814B) -+#define BIT_SET_BE_ADMITTED_TIME_8814B(x, v) \ -+ (BIT_CLEAR_BE_ADMITTED_TIME_8814B(x) | BIT_BE_ADMITTED_TIME_8814B(v)) -+ -+/* 2 REG_MAC_HEADER_NAV_OFFSET_8814B */ -+ -+#define BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8814B 0 -+#define BIT_MASK_MAC_HEADER_NAV_OFFSET_8814B 0xff -+#define BIT_MAC_HEADER_NAV_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_MAC_HEADER_NAV_OFFSET_8814B) \ -+ << BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8814B) -+#define BITS_MAC_HEADER_NAV_OFFSET_8814B \ -+ (BIT_MASK_MAC_HEADER_NAV_OFFSET_8814B \ -+ << BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8814B) -+#define BIT_CLEAR_MAC_HEADER_NAV_OFFSET_8814B(x) \ -+ ((x) & (~BITS_MAC_HEADER_NAV_OFFSET_8814B)) -+#define BIT_GET_MAC_HEADER_NAV_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8814B) & \ -+ BIT_MASK_MAC_HEADER_NAV_OFFSET_8814B) -+#define BIT_SET_MAC_HEADER_NAV_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_MAC_HEADER_NAV_OFFSET_8814B(x) | \ -+ BIT_MAC_HEADER_NAV_OFFSET_8814B(v)) -+ -+/* 2 REG_DIS_NDPA_NAV_CHECK_8814B */ -+#define BIT_DIS_NDPA_NAV_CHECK_8814B BIT(0) -+ -+/* 2 REG_EDCA_RANDOM_GEN_8814B */ -+ -+#define BIT_SHIFT_RANDOM_GEN_8814B 0 -+#define BIT_MASK_RANDOM_GEN_8814B 0xffffff -+#define BIT_RANDOM_GEN_8814B(x) \ -+ (((x) & BIT_MASK_RANDOM_GEN_8814B) << BIT_SHIFT_RANDOM_GEN_8814B) -+#define BITS_RANDOM_GEN_8814B \ -+ (BIT_MASK_RANDOM_GEN_8814B << BIT_SHIFT_RANDOM_GEN_8814B) -+#define BIT_CLEAR_RANDOM_GEN_8814B(x) ((x) & (~BITS_RANDOM_GEN_8814B)) -+#define BIT_GET_RANDOM_GEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_RANDOM_GEN_8814B) & BIT_MASK_RANDOM_GEN_8814B) -+#define BIT_SET_RANDOM_GEN_8814B(x, v) \ -+ (BIT_CLEAR_RANDOM_GEN_8814B(x) | BIT_RANDOM_GEN_8814B(v)) -+ -+/* 2 REG_TXCMD_SEL_8814B */ -+ -+#define BIT_SHIFT_TXCMD_SEG_SEL_8814B 0 -+#define BIT_MASK_TXCMD_SEG_SEL_8814B 0xf -+#define BIT_TXCMD_SEG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_TXCMD_SEG_SEL_8814B) << BIT_SHIFT_TXCMD_SEG_SEL_8814B) -+#define BITS_TXCMD_SEG_SEL_8814B \ -+ (BIT_MASK_TXCMD_SEG_SEL_8814B << BIT_SHIFT_TXCMD_SEG_SEL_8814B) -+#define BIT_CLEAR_TXCMD_SEG_SEL_8814B(x) ((x) & (~BITS_TXCMD_SEG_SEL_8814B)) -+#define BIT_GET_TXCMD_SEG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_SEG_SEL_8814B) & BIT_MASK_TXCMD_SEG_SEL_8814B) -+#define BIT_SET_TXCMD_SEG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_TXCMD_SEG_SEL_8814B(x) | BIT_TXCMD_SEG_SEL_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_MU_DBG_INFO_8814B */ -+ -+#define BIT_SHIFT_MU_DBG_INFO_8814B 0 -+#define BIT_MASK_MU_DBG_INFO_8814B 0xffffffffL -+#define BIT_MU_DBG_INFO_8814B(x) \ -+ (((x) & BIT_MASK_MU_DBG_INFO_8814B) << BIT_SHIFT_MU_DBG_INFO_8814B) -+#define BITS_MU_DBG_INFO_8814B \ -+ (BIT_MASK_MU_DBG_INFO_8814B << BIT_SHIFT_MU_DBG_INFO_8814B) -+#define BIT_CLEAR_MU_DBG_INFO_8814B(x) ((x) & (~BITS_MU_DBG_INFO_8814B)) -+#define BIT_GET_MU_DBG_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_DBG_INFO_8814B) & BIT_MASK_MU_DBG_INFO_8814B) -+#define BIT_SET_MU_DBG_INFO_8814B(x, v) \ -+ (BIT_CLEAR_MU_DBG_INFO_8814B(x) | BIT_MU_DBG_INFO_8814B(v)) -+ -+/* 2 REG_MU_DBG_INFO_1_8814B */ -+ -+#define BIT_SHIFT_MU_DBG_INFO_1_8814B 0 -+#define BIT_MASK_MU_DBG_INFO_1_8814B 0xffffffffL -+#define BIT_MU_DBG_INFO_1_8814B(x) \ -+ (((x) & BIT_MASK_MU_DBG_INFO_1_8814B) << BIT_SHIFT_MU_DBG_INFO_1_8814B) -+#define BITS_MU_DBG_INFO_1_8814B \ -+ (BIT_MASK_MU_DBG_INFO_1_8814B << BIT_SHIFT_MU_DBG_INFO_1_8814B) -+#define BIT_CLEAR_MU_DBG_INFO_1_8814B(x) ((x) & (~BITS_MU_DBG_INFO_1_8814B)) -+#define BIT_GET_MU_DBG_INFO_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_DBG_INFO_1_8814B) & BIT_MASK_MU_DBG_INFO_1_8814B) -+#define BIT_SET_MU_DBG_INFO_1_8814B(x, v) \ -+ (BIT_CLEAR_MU_DBG_INFO_1_8814B(x) | BIT_MU_DBG_INFO_1_8814B(v)) -+ -+/* 2 REG_SCH_DBG_SEL_8814B */ -+ -+#define BIT_SHIFT_SCH_DBG_SEL_8814B 0 -+#define BIT_MASK_SCH_DBG_SEL_8814B 0xff -+#define BIT_SCH_DBG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_SCH_DBG_SEL_8814B) << BIT_SHIFT_SCH_DBG_SEL_8814B) -+#define BITS_SCH_DBG_SEL_8814B \ -+ (BIT_MASK_SCH_DBG_SEL_8814B << BIT_SHIFT_SCH_DBG_SEL_8814B) -+#define BIT_CLEAR_SCH_DBG_SEL_8814B(x) ((x) & (~BITS_SCH_DBG_SEL_8814B)) -+#define BIT_GET_SCH_DBG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_SCH_DBG_SEL_8814B) & BIT_MASK_SCH_DBG_SEL_8814B) -+#define BIT_SET_SCH_DBG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_SCH_DBG_SEL_8814B(x) | BIT_SCH_DBG_SEL_8814B(v)) -+ -+/* 2 REG_SCHEDULER_RST_8814B */ -+#define BIT_SCHEDULER_RST_V1_8814B BIT(0) -+ -+/* 2 REG_MU_DBG_ERR_FLAG_8814B */ -+#define BIT_BCN_PORTID_ERR_8814B BIT(2) -+ -+#define BIT_SHIFT_MU_DBG_ERR_FLAG_8814B 0 -+#define BIT_MASK_MU_DBG_ERR_FLAG_8814B 0x3 -+#define BIT_MU_DBG_ERR_FLAG_8814B(x) \ -+ (((x) & BIT_MASK_MU_DBG_ERR_FLAG_8814B) \ -+ << BIT_SHIFT_MU_DBG_ERR_FLAG_8814B) -+#define BITS_MU_DBG_ERR_FLAG_8814B \ -+ (BIT_MASK_MU_DBG_ERR_FLAG_8814B << BIT_SHIFT_MU_DBG_ERR_FLAG_8814B) -+#define BIT_CLEAR_MU_DBG_ERR_FLAG_8814B(x) ((x) & (~BITS_MU_DBG_ERR_FLAG_8814B)) -+#define BIT_GET_MU_DBG_ERR_FLAG_8814B(x) \ -+ (((x) >> BIT_SHIFT_MU_DBG_ERR_FLAG_8814B) & \ -+ BIT_MASK_MU_DBG_ERR_FLAG_8814B) -+#define BIT_SET_MU_DBG_ERR_FLAG_8814B(x, v) \ -+ (BIT_CLEAR_MU_DBG_ERR_FLAG_8814B(x) | BIT_MU_DBG_ERR_FLAG_8814B(v)) -+ -+/* 2 REG_TX_ERR_RECOVERY_RST_8814B */ -+ -+#define BIT_SHIFT_ERR_RECOVER_CNT_8814B 4 -+#define BIT_MASK_ERR_RECOVER_CNT_8814B 0xf -+#define BIT_ERR_RECOVER_CNT_8814B(x) \ -+ (((x) & BIT_MASK_ERR_RECOVER_CNT_8814B) \ -+ << BIT_SHIFT_ERR_RECOVER_CNT_8814B) -+#define BITS_ERR_RECOVER_CNT_8814B \ -+ (BIT_MASK_ERR_RECOVER_CNT_8814B << BIT_SHIFT_ERR_RECOVER_CNT_8814B) -+#define BIT_CLEAR_ERR_RECOVER_CNT_8814B(x) ((x) & (~BITS_ERR_RECOVER_CNT_8814B)) -+#define BIT_GET_ERR_RECOVER_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_ERR_RECOVER_CNT_8814B) & \ -+ BIT_MASK_ERR_RECOVER_CNT_8814B) -+#define BIT_SET_ERR_RECOVER_CNT_8814B(x, v) \ -+ (BIT_CLEAR_ERR_RECOVER_CNT_8814B(x) | BIT_ERR_RECOVER_CNT_8814B(v)) -+ -+#define BIT_RX_HANG_ERR_8814B BIT(2) -+#define BIT_TX_HANG_ERR_8814B BIT(1) -+#define BIT_TX_ERR_RECOVERY_RST_8814B BIT(0) -+ -+/* 2 REG_SCH_DBG_VALUE_8814B */ -+ -+#define BIT_SHIFT_SCH_DBG_VALUE_8814B 0 -+#define BIT_MASK_SCH_DBG_VALUE_8814B 0xffffffffL -+#define BIT_SCH_DBG_VALUE_8814B(x) \ -+ (((x) & BIT_MASK_SCH_DBG_VALUE_8814B) << BIT_SHIFT_SCH_DBG_VALUE_8814B) -+#define BITS_SCH_DBG_VALUE_8814B \ -+ (BIT_MASK_SCH_DBG_VALUE_8814B << BIT_SHIFT_SCH_DBG_VALUE_8814B) -+#define BIT_CLEAR_SCH_DBG_VALUE_8814B(x) ((x) & (~BITS_SCH_DBG_VALUE_8814B)) -+#define BIT_GET_SCH_DBG_VALUE_8814B(x) \ -+ (((x) >> BIT_SHIFT_SCH_DBG_VALUE_8814B) & BIT_MASK_SCH_DBG_VALUE_8814B) -+#define BIT_SET_SCH_DBG_VALUE_8814B(x, v) \ -+ (BIT_CLEAR_SCH_DBG_VALUE_8814B(x) | BIT_SCH_DBG_VALUE_8814B(v)) -+ -+/* 2 REG_SCH_TXCMD_8814B */ -+ -+#define BIT_SHIFT_SCH_TXCMD_8814B 0 -+#define BIT_MASK_SCH_TXCMD_8814B 0xffffffffL -+#define BIT_SCH_TXCMD_8814B(x) \ -+ (((x) & BIT_MASK_SCH_TXCMD_8814B) << BIT_SHIFT_SCH_TXCMD_8814B) -+#define BITS_SCH_TXCMD_8814B \ -+ (BIT_MASK_SCH_TXCMD_8814B << BIT_SHIFT_SCH_TXCMD_8814B) -+#define BIT_CLEAR_SCH_TXCMD_8814B(x) ((x) & (~BITS_SCH_TXCMD_8814B)) -+#define BIT_GET_SCH_TXCMD_8814B(x) \ -+ (((x) >> BIT_SHIFT_SCH_TXCMD_8814B) & BIT_MASK_SCH_TXCMD_8814B) -+#define BIT_SET_SCH_TXCMD_8814B(x, v) \ -+ (BIT_CLEAR_SCH_TXCMD_8814B(x) | BIT_SCH_TXCMD_8814B(v)) -+ -+/* 2 REG_PAGE5_DUMMY_8814B */ -+ -+/* 2 REG_PORT_CTRL_SEL_8814B */ -+ -+#define BIT_SHIFT_BCN_TIMER_SEL_FWRD_V1_8814B 4 -+#define BIT_MASK_BCN_TIMER_SEL_FWRD_V1_8814B 0x7 -+#define BIT_BCN_TIMER_SEL_FWRD_V1_8814B(x) \ -+ (((x) & BIT_MASK_BCN_TIMER_SEL_FWRD_V1_8814B) \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_V1_8814B) -+#define BITS_BCN_TIMER_SEL_FWRD_V1_8814B \ -+ (BIT_MASK_BCN_TIMER_SEL_FWRD_V1_8814B \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_V1_8814B) -+#define BIT_CLEAR_BCN_TIMER_SEL_FWRD_V1_8814B(x) \ -+ ((x) & (~BITS_BCN_TIMER_SEL_FWRD_V1_8814B)) -+#define BIT_GET_BCN_TIMER_SEL_FWRD_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN_TIMER_SEL_FWRD_V1_8814B) & \ -+ BIT_MASK_BCN_TIMER_SEL_FWRD_V1_8814B) -+#define BIT_SET_BCN_TIMER_SEL_FWRD_V1_8814B(x, v) \ -+ (BIT_CLEAR_BCN_TIMER_SEL_FWRD_V1_8814B(x) | \ -+ BIT_BCN_TIMER_SEL_FWRD_V1_8814B(v)) -+ -+#define BIT_SHIFT_PORT_CTRL_SEL_8814B 0 -+#define BIT_MASK_PORT_CTRL_SEL_8814B 0x7 -+#define BIT_PORT_CTRL_SEL_8814B(x) \ -+ (((x) & BIT_MASK_PORT_CTRL_SEL_8814B) << BIT_SHIFT_PORT_CTRL_SEL_8814B) -+#define BITS_PORT_CTRL_SEL_8814B \ -+ (BIT_MASK_PORT_CTRL_SEL_8814B << BIT_SHIFT_PORT_CTRL_SEL_8814B) -+#define BIT_CLEAR_PORT_CTRL_SEL_8814B(x) ((x) & (~BITS_PORT_CTRL_SEL_8814B)) -+#define BIT_GET_PORT_CTRL_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PORT_CTRL_SEL_8814B) & BIT_MASK_PORT_CTRL_SEL_8814B) -+#define BIT_SET_PORT_CTRL_SEL_8814B(x, v) \ -+ (BIT_CLEAR_PORT_CTRL_SEL_8814B(x) | BIT_PORT_CTRL_SEL_8814B(v)) -+ -+/* 2 REG_PORT_CTRL_CFG_8814B */ -+#define BIT_BCNERR_CNT_EN_V1_8814B BIT(11) -+#define BIT_DIS_TRX_CAL_BCN_V1_8814B BIT(10) -+#define BIT_DIS_TX_CAL_TBTT_V1_8814B BIT(9) -+#define BIT_BCN_AGGRESSION_V1_8814B BIT(8) -+#define BIT_TSFTR_RST_V1_8814B BIT(7) -+#define BIT_DIS_RX_BSSID_FIT_8814B BIT(6) -+#define BIT_EN_TXBCN_RPT_V1_8814B BIT(5) -+#define BIT_DIS_TSF_UDT_8814B BIT(4) -+#define BIT_EN_PORT_FUNCTION_8814B BIT(3) -+#define BIT_EN_RXBCN_RPT_8814B BIT(2) -+#define BIT_EN_P2P_CTWINDOW_8814B BIT(1) -+#define BIT_EN_P2P_BCNQ_AREA_8814B BIT(0) -+ -+/* 2 REG_TBTT_PROHIBIT_CFG_8814B */ -+#define BIT_MASK_PROHIBIT_8814B BIT(23) -+ -+#define BIT_SHIFT_TBTT_HOLD_TIME_8814B 8 -+#define BIT_MASK_TBTT_HOLD_TIME_8814B 0xfff -+#define BIT_TBTT_HOLD_TIME_8814B(x) \ -+ (((x) & BIT_MASK_TBTT_HOLD_TIME_8814B) \ -+ << BIT_SHIFT_TBTT_HOLD_TIME_8814B) -+#define BITS_TBTT_HOLD_TIME_8814B \ -+ (BIT_MASK_TBTT_HOLD_TIME_8814B << BIT_SHIFT_TBTT_HOLD_TIME_8814B) -+#define BIT_CLEAR_TBTT_HOLD_TIME_8814B(x) ((x) & (~BITS_TBTT_HOLD_TIME_8814B)) -+#define BIT_GET_TBTT_HOLD_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_TBTT_HOLD_TIME_8814B) & \ -+ BIT_MASK_TBTT_HOLD_TIME_8814B) -+#define BIT_SET_TBTT_HOLD_TIME_8814B(x, v) \ -+ (BIT_CLEAR_TBTT_HOLD_TIME_8814B(x) | BIT_TBTT_HOLD_TIME_8814B(v)) -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_SETUP_8814B 0 -+#define BIT_MASK_TBTT_PROHIBIT_SETUP_8814B 0xf -+#define BIT_TBTT_PROHIBIT_SETUP_8814B(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_SETUP_8814B) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8814B) -+#define BITS_TBTT_PROHIBIT_SETUP_8814B \ -+ (BIT_MASK_TBTT_PROHIBIT_SETUP_8814B \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8814B) -+#define BIT_CLEAR_TBTT_PROHIBIT_SETUP_8814B(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_SETUP_8814B)) -+#define BIT_GET_TBTT_PROHIBIT_SETUP_8814B(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_SETUP_8814B) & \ -+ BIT_MASK_TBTT_PROHIBIT_SETUP_8814B) -+#define BIT_SET_TBTT_PROHIBIT_SETUP_8814B(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_SETUP_8814B(x) | \ -+ BIT_TBTT_PROHIBIT_SETUP_8814B(v)) -+ -+/* 2 REG_DRVERLYINT_CFG_8814B */ -+ -+#define BIT_SHIFT_DRVERLYITV_8814B 0 -+#define BIT_MASK_DRVERLYITV_8814B 0xff -+#define BIT_DRVERLYITV_8814B(x) \ -+ (((x) & BIT_MASK_DRVERLYITV_8814B) << BIT_SHIFT_DRVERLYITV_8814B) -+#define BITS_DRVERLYITV_8814B \ -+ (BIT_MASK_DRVERLYITV_8814B << BIT_SHIFT_DRVERLYITV_8814B) -+#define BIT_CLEAR_DRVERLYITV_8814B(x) ((x) & (~BITS_DRVERLYITV_8814B)) -+#define BIT_GET_DRVERLYITV_8814B(x) \ -+ (((x) >> BIT_SHIFT_DRVERLYITV_8814B) & BIT_MASK_DRVERLYITV_8814B) -+#define BIT_SET_DRVERLYITV_8814B(x, v) \ -+ (BIT_CLEAR_DRVERLYITV_8814B(x) | BIT_DRVERLYITV_8814B(v)) -+ -+/* 2 REG_BCNDMATIM_CFG_8814B */ -+ -+#define BIT_SHIFT_BCNDMATIM_8814B 0 -+#define BIT_MASK_BCNDMATIM_8814B 0xff -+#define BIT_BCNDMATIM_8814B(x) \ -+ (((x) & BIT_MASK_BCNDMATIM_8814B) << BIT_SHIFT_BCNDMATIM_8814B) -+#define BITS_BCNDMATIM_8814B \ -+ (BIT_MASK_BCNDMATIM_8814B << BIT_SHIFT_BCNDMATIM_8814B) -+#define BIT_CLEAR_BCNDMATIM_8814B(x) ((x) & (~BITS_BCNDMATIM_8814B)) -+#define BIT_GET_BCNDMATIM_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCNDMATIM_8814B) & BIT_MASK_BCNDMATIM_8814B) -+#define BIT_SET_BCNDMATIM_8814B(x, v) \ -+ (BIT_CLEAR_BCNDMATIM_8814B(x) | BIT_BCNDMATIM_8814B(v)) -+ -+/* 2 REG_CTWND_CFG_8814B */ -+ -+#define BIT_SHIFT_CTWND_8814B 0 -+#define BIT_MASK_CTWND_8814B 0xff -+#define BIT_CTWND_8814B(x) \ -+ (((x) & BIT_MASK_CTWND_8814B) << BIT_SHIFT_CTWND_8814B) -+#define BITS_CTWND_8814B (BIT_MASK_CTWND_8814B << BIT_SHIFT_CTWND_8814B) -+#define BIT_CLEAR_CTWND_8814B(x) ((x) & (~BITS_CTWND_8814B)) -+#define BIT_GET_CTWND_8814B(x) \ -+ (((x) >> BIT_SHIFT_CTWND_8814B) & BIT_MASK_CTWND_8814B) -+#define BIT_SET_CTWND_8814B(x, v) \ -+ (BIT_CLEAR_CTWND_8814B(x) | BIT_CTWND_8814B(v)) -+ -+/* 2 REG_BCNIVLCUNT_CFG_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_BCNIVLCUNT_8814B 0 -+#define BIT_MASK_BCNIVLCUNT_8814B 0x7f -+#define BIT_BCNIVLCUNT_8814B(x) \ -+ (((x) & BIT_MASK_BCNIVLCUNT_8814B) << BIT_SHIFT_BCNIVLCUNT_8814B) -+#define BITS_BCNIVLCUNT_8814B \ -+ (BIT_MASK_BCNIVLCUNT_8814B << BIT_SHIFT_BCNIVLCUNT_8814B) -+#define BIT_CLEAR_BCNIVLCUNT_8814B(x) ((x) & (~BITS_BCNIVLCUNT_8814B)) -+#define BIT_GET_BCNIVLCUNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCNIVLCUNT_8814B) & BIT_MASK_BCNIVLCUNT_8814B) -+#define BIT_SET_BCNIVLCUNT_8814B(x, v) \ -+ (BIT_CLEAR_BCNIVLCUNT_8814B(x) | BIT_BCNIVLCUNT_8814B(v)) -+ -+/* 2 REG_EARLY_128US_CFG_8814B */ -+ -+#define BIT_SHIFT_EARLY_128US_8814B 0 -+#define BIT_MASK_EARLY_128US_8814B 0x7 -+#define BIT_EARLY_128US_8814B(x) \ -+ (((x) & BIT_MASK_EARLY_128US_8814B) << BIT_SHIFT_EARLY_128US_8814B) -+#define BITS_EARLY_128US_8814B \ -+ (BIT_MASK_EARLY_128US_8814B << BIT_SHIFT_EARLY_128US_8814B) -+#define BIT_CLEAR_EARLY_128US_8814B(x) ((x) & (~BITS_EARLY_128US_8814B)) -+#define BIT_GET_EARLY_128US_8814B(x) \ -+ (((x) >> BIT_SHIFT_EARLY_128US_8814B) & BIT_MASK_EARLY_128US_8814B) -+#define BIT_SET_EARLY_128US_8814B(x, v) \ -+ (BIT_CLEAR_EARLY_128US_8814B(x) | BIT_EARLY_128US_8814B(v)) -+ -+/* 2 REG_TSFTR_SYNC_OFFSET_CFG_8814B */ -+ -+#define BIT_SHIFT_TSFTR_SNC_OFFSET_V1_8814B 0 -+#define BIT_MASK_TSFTR_SNC_OFFSET_V1_8814B 0xffffff -+#define BIT_TSFTR_SNC_OFFSET_V1_8814B(x) \ -+ (((x) & BIT_MASK_TSFTR_SNC_OFFSET_V1_8814B) \ -+ << BIT_SHIFT_TSFTR_SNC_OFFSET_V1_8814B) -+#define BITS_TSFTR_SNC_OFFSET_V1_8814B \ -+ (BIT_MASK_TSFTR_SNC_OFFSET_V1_8814B \ -+ << BIT_SHIFT_TSFTR_SNC_OFFSET_V1_8814B) -+#define BIT_CLEAR_TSFTR_SNC_OFFSET_V1_8814B(x) \ -+ ((x) & (~BITS_TSFTR_SNC_OFFSET_V1_8814B)) -+#define BIT_GET_TSFTR_SNC_OFFSET_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TSFTR_SNC_OFFSET_V1_8814B) & \ -+ BIT_MASK_TSFTR_SNC_OFFSET_V1_8814B) -+#define BIT_SET_TSFTR_SNC_OFFSET_V1_8814B(x, v) \ -+ (BIT_CLEAR_TSFTR_SNC_OFFSET_V1_8814B(x) | \ -+ BIT_TSFTR_SNC_OFFSET_V1_8814B(v)) -+ -+/* 2 REG_TSFTR_SYNC_CTRL_CFG_8814B */ -+#define BIT_SYNC_TSF_NOW_V1_8814B BIT(5) -+#define BIT_SYNC_TSF_ONCE_8814B BIT(4) -+#define BIT_SYNC_TSF_AUTO_8814B BIT(3) -+ -+#define BIT_SHIFT_SYNC_PORT_SEL_8814B 0 -+#define BIT_MASK_SYNC_PORT_SEL_8814B 0x7 -+#define BIT_SYNC_PORT_SEL_8814B(x) \ -+ (((x) & BIT_MASK_SYNC_PORT_SEL_8814B) << BIT_SHIFT_SYNC_PORT_SEL_8814B) -+#define BITS_SYNC_PORT_SEL_8814B \ -+ (BIT_MASK_SYNC_PORT_SEL_8814B << BIT_SHIFT_SYNC_PORT_SEL_8814B) -+#define BIT_CLEAR_SYNC_PORT_SEL_8814B(x) ((x) & (~BITS_SYNC_PORT_SEL_8814B)) -+#define BIT_GET_SYNC_PORT_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_SYNC_PORT_SEL_8814B) & BIT_MASK_SYNC_PORT_SEL_8814B) -+#define BIT_SET_SYNC_PORT_SEL_8814B(x, v) \ -+ (BIT_CLEAR_SYNC_PORT_SEL_8814B(x) | BIT_SYNC_PORT_SEL_8814B(v)) -+ -+/* 2 REG_BCN_SPACE_CFG_8814B */ -+ -+#define BIT_SHIFT_BCN_SPACE_8814B 0 -+#define BIT_MASK_BCN_SPACE_8814B 0xffff -+#define BIT_BCN_SPACE_8814B(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_8814B) << BIT_SHIFT_BCN_SPACE_8814B) -+#define BITS_BCN_SPACE_8814B \ -+ (BIT_MASK_BCN_SPACE_8814B << BIT_SHIFT_BCN_SPACE_8814B) -+#define BIT_CLEAR_BCN_SPACE_8814B(x) ((x) & (~BITS_BCN_SPACE_8814B)) -+#define BIT_GET_BCN_SPACE_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_8814B) & BIT_MASK_BCN_SPACE_8814B) -+#define BIT_SET_BCN_SPACE_8814B(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_8814B(x) | BIT_BCN_SPACE_8814B(v)) -+ -+/* 2 REG_EARLY_INT_ADJUST_CFG_8814B */ -+ -+#define BIT_SHIFT_EARLY_INT_ADJUST_8814B 0 -+#define BIT_MASK_EARLY_INT_ADJUST_8814B 0xffff -+#define BIT_EARLY_INT_ADJUST_8814B(x) \ -+ (((x) & BIT_MASK_EARLY_INT_ADJUST_8814B) \ -+ << BIT_SHIFT_EARLY_INT_ADJUST_8814B) -+#define BITS_EARLY_INT_ADJUST_8814B \ -+ (BIT_MASK_EARLY_INT_ADJUST_8814B << BIT_SHIFT_EARLY_INT_ADJUST_8814B) -+#define BIT_CLEAR_EARLY_INT_ADJUST_8814B(x) \ -+ ((x) & (~BITS_EARLY_INT_ADJUST_8814B)) -+#define BIT_GET_EARLY_INT_ADJUST_8814B(x) \ -+ (((x) >> BIT_SHIFT_EARLY_INT_ADJUST_8814B) & \ -+ BIT_MASK_EARLY_INT_ADJUST_8814B) -+#define BIT_SET_EARLY_INT_ADJUST_8814B(x, v) \ -+ (BIT_CLEAR_EARLY_INT_ADJUST_8814B(x) | BIT_EARLY_INT_ADJUST_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_SW_TBTT_TSF_INFO_8814B */ -+ -+#define BIT_SHIFT_SW_TBTT_TSF_INFO_8814B 0 -+#define BIT_MASK_SW_TBTT_TSF_INFO_8814B 0xffffffffL -+#define BIT_SW_TBTT_TSF_INFO_8814B(x) \ -+ (((x) & BIT_MASK_SW_TBTT_TSF_INFO_8814B) \ -+ << BIT_SHIFT_SW_TBTT_TSF_INFO_8814B) -+#define BITS_SW_TBTT_TSF_INFO_8814B \ -+ (BIT_MASK_SW_TBTT_TSF_INFO_8814B << BIT_SHIFT_SW_TBTT_TSF_INFO_8814B) -+#define BIT_CLEAR_SW_TBTT_TSF_INFO_8814B(x) \ -+ ((x) & (~BITS_SW_TBTT_TSF_INFO_8814B)) -+#define BIT_GET_SW_TBTT_TSF_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_SW_TBTT_TSF_INFO_8814B) & \ -+ BIT_MASK_SW_TBTT_TSF_INFO_8814B) -+#define BIT_SET_SW_TBTT_TSF_INFO_8814B(x, v) \ -+ (BIT_CLEAR_SW_TBTT_TSF_INFO_8814B(x) | BIT_SW_TBTT_TSF_INFO_8814B(v)) -+ -+/* 2 REG_TSFTR_LOW_8814B */ -+ -+#define BIT_SHIFT_TSF_TIMER_LOW_8814B 0 -+#define BIT_MASK_TSF_TIMER_LOW_8814B 0xffffffffL -+#define BIT_TSF_TIMER_LOW_8814B(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_LOW_8814B) << BIT_SHIFT_TSF_TIMER_LOW_8814B) -+#define BITS_TSF_TIMER_LOW_8814B \ -+ (BIT_MASK_TSF_TIMER_LOW_8814B << BIT_SHIFT_TSF_TIMER_LOW_8814B) -+#define BIT_CLEAR_TSF_TIMER_LOW_8814B(x) ((x) & (~BITS_TSF_TIMER_LOW_8814B)) -+#define BIT_GET_TSF_TIMER_LOW_8814B(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_LOW_8814B) & BIT_MASK_TSF_TIMER_LOW_8814B) -+#define BIT_SET_TSF_TIMER_LOW_8814B(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_LOW_8814B(x) | BIT_TSF_TIMER_LOW_8814B(v)) -+ -+/* 2 REG_TSFTR_HIGH_8814B */ -+ -+#define BIT_SHIFT_TSF_TIMER_HIGH_8814B 0 -+#define BIT_MASK_TSF_TIMER_HIGH_8814B 0xffffffffL -+#define BIT_TSF_TIMER_HIGH_8814B(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_HIGH_8814B) \ -+ << BIT_SHIFT_TSF_TIMER_HIGH_8814B) -+#define BITS_TSF_TIMER_HIGH_8814B \ -+ (BIT_MASK_TSF_TIMER_HIGH_8814B << BIT_SHIFT_TSF_TIMER_HIGH_8814B) -+#define BIT_CLEAR_TSF_TIMER_HIGH_8814B(x) ((x) & (~BITS_TSF_TIMER_HIGH_8814B)) -+#define BIT_GET_TSF_TIMER_HIGH_8814B(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_HIGH_8814B) & \ -+ BIT_MASK_TSF_TIMER_HIGH_8814B) -+#define BIT_SET_TSF_TIMER_HIGH_8814B(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_HIGH_8814B(x) | BIT_TSF_TIMER_HIGH_8814B(v)) -+ -+/* 2 REG_BCN_ERR_CNT_MAC_8814B */ -+ -+#define BIT_SHIFT_BCN_ERR_CNT_MAC_8814B 0 -+#define BIT_MASK_BCN_ERR_CNT_MAC_8814B 0xff -+#define BIT_BCN_ERR_CNT_MAC_8814B(x) \ -+ (((x) & BIT_MASK_BCN_ERR_CNT_MAC_8814B) \ -+ << BIT_SHIFT_BCN_ERR_CNT_MAC_8814B) -+#define BITS_BCN_ERR_CNT_MAC_8814B \ -+ (BIT_MASK_BCN_ERR_CNT_MAC_8814B << BIT_SHIFT_BCN_ERR_CNT_MAC_8814B) -+#define BIT_CLEAR_BCN_ERR_CNT_MAC_8814B(x) ((x) & (~BITS_BCN_ERR_CNT_MAC_8814B)) -+#define BIT_GET_BCN_ERR_CNT_MAC_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_CNT_MAC_8814B) & \ -+ BIT_MASK_BCN_ERR_CNT_MAC_8814B) -+#define BIT_SET_BCN_ERR_CNT_MAC_8814B(x, v) \ -+ (BIT_CLEAR_BCN_ERR_CNT_MAC_8814B(x) | BIT_BCN_ERR_CNT_MAC_8814B(v)) -+ -+/* 2 REG_BCN_ERR_CNT_EDCCA_8814B */ -+ -+#define BIT_SHIFT_BCN_ERR_CNT_EDCCA_8814B 0 -+#define BIT_MASK_BCN_ERR_CNT_EDCCA_8814B 0xff -+#define BIT_BCN_ERR_CNT_EDCCA_8814B(x) \ -+ (((x) & BIT_MASK_BCN_ERR_CNT_EDCCA_8814B) \ -+ << BIT_SHIFT_BCN_ERR_CNT_EDCCA_8814B) -+#define BITS_BCN_ERR_CNT_EDCCA_8814B \ -+ (BIT_MASK_BCN_ERR_CNT_EDCCA_8814B << BIT_SHIFT_BCN_ERR_CNT_EDCCA_8814B) -+#define BIT_CLEAR_BCN_ERR_CNT_EDCCA_8814B(x) \ -+ ((x) & (~BITS_BCN_ERR_CNT_EDCCA_8814B)) -+#define BIT_GET_BCN_ERR_CNT_EDCCA_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_CNT_EDCCA_8814B) & \ -+ BIT_MASK_BCN_ERR_CNT_EDCCA_8814B) -+#define BIT_SET_BCN_ERR_CNT_EDCCA_8814B(x, v) \ -+ (BIT_CLEAR_BCN_ERR_CNT_EDCCA_8814B(x) | BIT_BCN_ERR_CNT_EDCCA_8814B(v)) -+ -+/* 2 REG_BCN_ERR_CNT_CCA_8814B */ -+ -+#define BIT_SHIFT_BCN_ERR_CNT_CCA_8814B 0 -+#define BIT_MASK_BCN_ERR_CNT_CCA_8814B 0xff -+#define BIT_BCN_ERR_CNT_CCA_8814B(x) \ -+ (((x) & BIT_MASK_BCN_ERR_CNT_CCA_8814B) \ -+ << BIT_SHIFT_BCN_ERR_CNT_CCA_8814B) -+#define BITS_BCN_ERR_CNT_CCA_8814B \ -+ (BIT_MASK_BCN_ERR_CNT_CCA_8814B << BIT_SHIFT_BCN_ERR_CNT_CCA_8814B) -+#define BIT_CLEAR_BCN_ERR_CNT_CCA_8814B(x) ((x) & (~BITS_BCN_ERR_CNT_CCA_8814B)) -+#define BIT_GET_BCN_ERR_CNT_CCA_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_CNT_CCA_8814B) & \ -+ BIT_MASK_BCN_ERR_CNT_CCA_8814B) -+#define BIT_SET_BCN_ERR_CNT_CCA_8814B(x, v) \ -+ (BIT_CLEAR_BCN_ERR_CNT_CCA_8814B(x) | BIT_BCN_ERR_CNT_CCA_8814B(v)) -+ -+/* 2 REG_BCN_ERR_CNT_INVALID_8814B */ -+ -+#define BIT_SHIFT_BCN_ERR_CNT_INVALID_8814B 0 -+#define BIT_MASK_BCN_ERR_CNT_INVALID_8814B 0xff -+#define BIT_BCN_ERR_CNT_INVALID_8814B(x) \ -+ (((x) & BIT_MASK_BCN_ERR_CNT_INVALID_8814B) \ -+ << BIT_SHIFT_BCN_ERR_CNT_INVALID_8814B) -+#define BITS_BCN_ERR_CNT_INVALID_8814B \ -+ (BIT_MASK_BCN_ERR_CNT_INVALID_8814B \ -+ << BIT_SHIFT_BCN_ERR_CNT_INVALID_8814B) -+#define BIT_CLEAR_BCN_ERR_CNT_INVALID_8814B(x) \ -+ ((x) & (~BITS_BCN_ERR_CNT_INVALID_8814B)) -+#define BIT_GET_BCN_ERR_CNT_INVALID_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_CNT_INVALID_8814B) & \ -+ BIT_MASK_BCN_ERR_CNT_INVALID_8814B) -+#define BIT_SET_BCN_ERR_CNT_INVALID_8814B(x, v) \ -+ (BIT_CLEAR_BCN_ERR_CNT_INVALID_8814B(x) | \ -+ BIT_BCN_ERR_CNT_INVALID_8814B(v)) -+ -+/* 2 REG_BCN_ERR_CNT_OTHERS_8814B */ -+ -+#define BIT_SHIFT_BCN_ERR_CNT_OTHERS_8814B 0 -+#define BIT_MASK_BCN_ERR_CNT_OTHERS_8814B 0xff -+#define BIT_BCN_ERR_CNT_OTHERS_8814B(x) \ -+ (((x) & BIT_MASK_BCN_ERR_CNT_OTHERS_8814B) \ -+ << BIT_SHIFT_BCN_ERR_CNT_OTHERS_8814B) -+#define BITS_BCN_ERR_CNT_OTHERS_8814B \ -+ (BIT_MASK_BCN_ERR_CNT_OTHERS_8814B \ -+ << BIT_SHIFT_BCN_ERR_CNT_OTHERS_8814B) -+#define BIT_CLEAR_BCN_ERR_CNT_OTHERS_8814B(x) \ -+ ((x) & (~BITS_BCN_ERR_CNT_OTHERS_8814B)) -+#define BIT_GET_BCN_ERR_CNT_OTHERS_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_CNT_OTHERS_8814B) & \ -+ BIT_MASK_BCN_ERR_CNT_OTHERS_8814B) -+#define BIT_SET_BCN_ERR_CNT_OTHERS_8814B(x, v) \ -+ (BIT_CLEAR_BCN_ERR_CNT_OTHERS_8814B(x) | \ -+ BIT_BCN_ERR_CNT_OTHERS_8814B(v)) -+ -+/* 2 REG_RX_BCN_TIMER_8814B */ -+ -+#define BIT_SHIFT_RX_BCN_TIMER_8814B 0 -+#define BIT_MASK_RX_BCN_TIMER_8814B 0xffff -+#define BIT_RX_BCN_TIMER_8814B(x) \ -+ (((x) & BIT_MASK_RX_BCN_TIMER_8814B) << BIT_SHIFT_RX_BCN_TIMER_8814B) -+#define BITS_RX_BCN_TIMER_8814B \ -+ (BIT_MASK_RX_BCN_TIMER_8814B << BIT_SHIFT_RX_BCN_TIMER_8814B) -+#define BIT_CLEAR_RX_BCN_TIMER_8814B(x) ((x) & (~BITS_RX_BCN_TIMER_8814B)) -+#define BIT_GET_RX_BCN_TIMER_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TIMER_8814B) & BIT_MASK_RX_BCN_TIMER_8814B) -+#define BIT_SET_RX_BCN_TIMER_8814B(x, v) \ -+ (BIT_CLEAR_RX_BCN_TIMER_8814B(x) | BIT_RX_BCN_TIMER_8814B(v)) -+ -+/* 2 REG_TBTT_CTN_AREA_V1_8814B */ -+ -+#define BIT_SHIFT_TBTT_CTN_AREA_8814B 0 -+#define BIT_MASK_TBTT_CTN_AREA_8814B 0xff -+#define BIT_TBTT_CTN_AREA_8814B(x) \ -+ (((x) & BIT_MASK_TBTT_CTN_AREA_8814B) << BIT_SHIFT_TBTT_CTN_AREA_8814B) -+#define BITS_TBTT_CTN_AREA_8814B \ -+ (BIT_MASK_TBTT_CTN_AREA_8814B << BIT_SHIFT_TBTT_CTN_AREA_8814B) -+#define BIT_CLEAR_TBTT_CTN_AREA_8814B(x) ((x) & (~BITS_TBTT_CTN_AREA_8814B)) -+#define BIT_GET_TBTT_CTN_AREA_8814B(x) \ -+ (((x) >> BIT_SHIFT_TBTT_CTN_AREA_8814B) & BIT_MASK_TBTT_CTN_AREA_8814B) -+#define BIT_SET_TBTT_CTN_AREA_8814B(x, v) \ -+ (BIT_CLEAR_TBTT_CTN_AREA_8814B(x) | BIT_TBTT_CTN_AREA_8814B(v)) -+ -+/* 2 REG_BCN_MAX_ERR_V1_8814B */ -+ -+#define BIT_SHIFT_BCN_MAX_ERR_8814B 0 -+#define BIT_MASK_BCN_MAX_ERR_8814B 0xff -+#define BIT_BCN_MAX_ERR_8814B(x) \ -+ (((x) & BIT_MASK_BCN_MAX_ERR_8814B) << BIT_SHIFT_BCN_MAX_ERR_8814B) -+#define BITS_BCN_MAX_ERR_8814B \ -+ (BIT_MASK_BCN_MAX_ERR_8814B << BIT_SHIFT_BCN_MAX_ERR_8814B) -+#define BIT_CLEAR_BCN_MAX_ERR_8814B(x) ((x) & (~BITS_BCN_MAX_ERR_8814B)) -+#define BIT_GET_BCN_MAX_ERR_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN_MAX_ERR_8814B) & BIT_MASK_BCN_MAX_ERR_8814B) -+#define BIT_SET_BCN_MAX_ERR_8814B(x, v) \ -+ (BIT_CLEAR_BCN_MAX_ERR_8814B(x) | BIT_BCN_MAX_ERR_8814B(v)) -+ -+/* 2 REG_RXTSF_OFFSET_CCK_V1_8814B */ -+ -+#define BIT_SHIFT_CCK_RXTSF_OFFSET_8814B 0 -+#define BIT_MASK_CCK_RXTSF_OFFSET_8814B 0xff -+#define BIT_CCK_RXTSF_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_CCK_RXTSF_OFFSET_8814B) \ -+ << BIT_SHIFT_CCK_RXTSF_OFFSET_8814B) -+#define BITS_CCK_RXTSF_OFFSET_8814B \ -+ (BIT_MASK_CCK_RXTSF_OFFSET_8814B << BIT_SHIFT_CCK_RXTSF_OFFSET_8814B) -+#define BIT_CLEAR_CCK_RXTSF_OFFSET_8814B(x) \ -+ ((x) & (~BITS_CCK_RXTSF_OFFSET_8814B)) -+#define BIT_GET_CCK_RXTSF_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_CCK_RXTSF_OFFSET_8814B) & \ -+ BIT_MASK_CCK_RXTSF_OFFSET_8814B) -+#define BIT_SET_CCK_RXTSF_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_CCK_RXTSF_OFFSET_8814B(x) | BIT_CCK_RXTSF_OFFSET_8814B(v)) -+ -+/* 2 REG_RXTSF_OFFSET_OFDM_V1_8814B */ -+ -+#define BIT_SHIFT_OFDM_RXTSF_OFFSET_8814B 0 -+#define BIT_MASK_OFDM_RXTSF_OFFSET_8814B 0xff -+#define BIT_OFDM_RXTSF_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_OFDM_RXTSF_OFFSET_8814B) \ -+ << BIT_SHIFT_OFDM_RXTSF_OFFSET_8814B) -+#define BITS_OFDM_RXTSF_OFFSET_8814B \ -+ (BIT_MASK_OFDM_RXTSF_OFFSET_8814B << BIT_SHIFT_OFDM_RXTSF_OFFSET_8814B) -+#define BIT_CLEAR_OFDM_RXTSF_OFFSET_8814B(x) \ -+ ((x) & (~BITS_OFDM_RXTSF_OFFSET_8814B)) -+#define BIT_GET_OFDM_RXTSF_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_OFDM_RXTSF_OFFSET_8814B) & \ -+ BIT_MASK_OFDM_RXTSF_OFFSET_8814B) -+#define BIT_SET_OFDM_RXTSF_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_OFDM_RXTSF_OFFSET_8814B(x) | BIT_OFDM_RXTSF_OFFSET_8814B(v)) -+ -+/* 2 REG_SUB_BCN_SPACE_8814B */ -+ -+#define BIT_SHIFT_SUB_BCN_SPACE_V2_8814B 0 -+#define BIT_MASK_SUB_BCN_SPACE_V2_8814B 0xff -+#define BIT_SUB_BCN_SPACE_V2_8814B(x) \ -+ (((x) & BIT_MASK_SUB_BCN_SPACE_V2_8814B) \ -+ << BIT_SHIFT_SUB_BCN_SPACE_V2_8814B) -+#define BITS_SUB_BCN_SPACE_V2_8814B \ -+ (BIT_MASK_SUB_BCN_SPACE_V2_8814B << BIT_SHIFT_SUB_BCN_SPACE_V2_8814B) -+#define BIT_CLEAR_SUB_BCN_SPACE_V2_8814B(x) \ -+ ((x) & (~BITS_SUB_BCN_SPACE_V2_8814B)) -+#define BIT_GET_SUB_BCN_SPACE_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_SUB_BCN_SPACE_V2_8814B) & \ -+ BIT_MASK_SUB_BCN_SPACE_V2_8814B) -+#define BIT_SET_SUB_BCN_SPACE_V2_8814B(x, v) \ -+ (BIT_CLEAR_SUB_BCN_SPACE_V2_8814B(x) | BIT_SUB_BCN_SPACE_V2_8814B(v)) -+ -+/* 2 REG_MBID_NUM_V1_8814B */ -+ -+#define BIT_SHIFT_BCN_ERR_PORT_SEL_8814B 4 -+#define BIT_MASK_BCN_ERR_PORT_SEL_8814B 0xf -+#define BIT_BCN_ERR_PORT_SEL_8814B(x) \ -+ (((x) & BIT_MASK_BCN_ERR_PORT_SEL_8814B) \ -+ << BIT_SHIFT_BCN_ERR_PORT_SEL_8814B) -+#define BITS_BCN_ERR_PORT_SEL_8814B \ -+ (BIT_MASK_BCN_ERR_PORT_SEL_8814B << BIT_SHIFT_BCN_ERR_PORT_SEL_8814B) -+#define BIT_CLEAR_BCN_ERR_PORT_SEL_8814B(x) \ -+ ((x) & (~BITS_BCN_ERR_PORT_SEL_8814B)) -+#define BIT_GET_BCN_ERR_PORT_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_BCN_ERR_PORT_SEL_8814B) & \ -+ BIT_MASK_BCN_ERR_PORT_SEL_8814B) -+#define BIT_SET_BCN_ERR_PORT_SEL_8814B(x, v) \ -+ (BIT_CLEAR_BCN_ERR_PORT_SEL_8814B(x) | BIT_BCN_ERR_PORT_SEL_8814B(v)) -+ -+#define BIT_SHIFT_MBID_BCN_NUM_V1_8814B 0 -+#define BIT_MASK_MBID_BCN_NUM_V1_8814B 0xf -+#define BIT_MBID_BCN_NUM_V1_8814B(x) \ -+ (((x) & BIT_MASK_MBID_BCN_NUM_V1_8814B) \ -+ << BIT_SHIFT_MBID_BCN_NUM_V1_8814B) -+#define BITS_MBID_BCN_NUM_V1_8814B \ -+ (BIT_MASK_MBID_BCN_NUM_V1_8814B << BIT_SHIFT_MBID_BCN_NUM_V1_8814B) -+#define BIT_CLEAR_MBID_BCN_NUM_V1_8814B(x) ((x) & (~BITS_MBID_BCN_NUM_V1_8814B)) -+#define BIT_GET_MBID_BCN_NUM_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCN_NUM_V1_8814B) & \ -+ BIT_MASK_MBID_BCN_NUM_V1_8814B) -+#define BIT_SET_MBID_BCN_NUM_V1_8814B(x, v) \ -+ (BIT_CLEAR_MBID_BCN_NUM_V1_8814B(x) | BIT_MBID_BCN_NUM_V1_8814B(v)) -+ -+/* 2 REG_MBSSID_CTRL_V1_8814B */ -+#define BIT_MBID_BCNQ15_EN_8814B BIT(15) -+#define BIT_MBID_BCNQ14_EN_8814B BIT(14) -+#define BIT_MBID_BCNQ13_EN_8814B BIT(13) -+#define BIT_MBID_BCNQ12_EN_8814B BIT(12) -+#define BIT_MBID_BCNQ11_EN_8814B BIT(11) -+#define BIT_MBID_BCNQ10_EN_8814B BIT(10) -+#define BIT_MBID_BCNQ9_EN_8814B BIT(9) -+#define BIT_MBID_BCNQ8_EN_8814B BIT(8) -+#define BIT_MBID_BCNQ7_EN_8814B BIT(7) -+#define BIT_MBID_BCNQ6_EN_8814B BIT(6) -+#define BIT_MBID_BCNQ5_EN_8814B BIT(5) -+#define BIT_MBID_BCNQ4_EN_8814B BIT(4) -+#define BIT_MBID_BCNQ3_EN_8814B BIT(3) -+#define BIT_MBID_BCNQ2_EN_8814B BIT(2) -+#define BIT_MBID_BCNQ1_EN_8814B BIT(1) -+#define BIT_MBID_BCNQ0_EN_8814B BIT(0) -+ -+/* 2 REG_USTIME_TSF_V1_8814B */ -+ -+#define BIT_SHIFT_USTIME_TSF_V1_8814B 0 -+#define BIT_MASK_USTIME_TSF_V1_8814B 0xff -+#define BIT_USTIME_TSF_V1_8814B(x) \ -+ (((x) & BIT_MASK_USTIME_TSF_V1_8814B) << BIT_SHIFT_USTIME_TSF_V1_8814B) -+#define BITS_USTIME_TSF_V1_8814B \ -+ (BIT_MASK_USTIME_TSF_V1_8814B << BIT_SHIFT_USTIME_TSF_V1_8814B) -+#define BIT_CLEAR_USTIME_TSF_V1_8814B(x) ((x) & (~BITS_USTIME_TSF_V1_8814B)) -+#define BIT_GET_USTIME_TSF_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_USTIME_TSF_V1_8814B) & BIT_MASK_USTIME_TSF_V1_8814B) -+#define BIT_SET_USTIME_TSF_V1_8814B(x, v) \ -+ (BIT_CLEAR_USTIME_TSF_V1_8814B(x) | BIT_USTIME_TSF_V1_8814B(v)) -+ -+/* 2 REG_BW_CFG_8814B */ -+#define BIT_SLEEP_32K_EN_8814B BIT(3) -+#define BIT_DIS_MARK_TSF_US_V1_8814B BIT(2) -+ -+#define BIT_SHIFT_BW_CFG_8814B 0 -+#define BIT_MASK_BW_CFG_8814B 0x3 -+#define BIT_BW_CFG_8814B(x) \ -+ (((x) & BIT_MASK_BW_CFG_8814B) << BIT_SHIFT_BW_CFG_8814B) -+#define BITS_BW_CFG_8814B (BIT_MASK_BW_CFG_8814B << BIT_SHIFT_BW_CFG_8814B) -+#define BIT_CLEAR_BW_CFG_8814B(x) ((x) & (~BITS_BW_CFG_8814B)) -+#define BIT_GET_BW_CFG_8814B(x) \ -+ (((x) >> BIT_SHIFT_BW_CFG_8814B) & BIT_MASK_BW_CFG_8814B) -+#define BIT_SET_BW_CFG_8814B(x, v) \ -+ (BIT_CLEAR_BW_CFG_8814B(x) | BIT_BW_CFG_8814B(v)) -+ -+/* 2 REG_ATIMWND_CFG_8814B */ -+ -+#define BIT_SHIFT_ATIMWND_V1_8814B 0 -+#define BIT_MASK_ATIMWND_V1_8814B 0xff -+#define BIT_ATIMWND_V1_8814B(x) \ -+ (((x) & BIT_MASK_ATIMWND_V1_8814B) << BIT_SHIFT_ATIMWND_V1_8814B) -+#define BITS_ATIMWND_V1_8814B \ -+ (BIT_MASK_ATIMWND_V1_8814B << BIT_SHIFT_ATIMWND_V1_8814B) -+#define BIT_CLEAR_ATIMWND_V1_8814B(x) ((x) & (~BITS_ATIMWND_V1_8814B)) -+#define BIT_GET_ATIMWND_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND_V1_8814B) & BIT_MASK_ATIMWND_V1_8814B) -+#define BIT_SET_ATIMWND_V1_8814B(x, v) \ -+ (BIT_CLEAR_ATIMWND_V1_8814B(x) | BIT_ATIMWND_V1_8814B(v)) -+ -+/* 2 REG_DTIM_COUNTER_CFG_8814B */ -+ -+#define BIT_SHIFT_DTIM_COUNT_8814B 0 -+#define BIT_MASK_DTIM_COUNT_8814B 0xff -+#define BIT_DTIM_COUNT_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_8814B) << BIT_SHIFT_DTIM_COUNT_8814B) -+#define BITS_DTIM_COUNT_8814B \ -+ (BIT_MASK_DTIM_COUNT_8814B << BIT_SHIFT_DTIM_COUNT_8814B) -+#define BIT_CLEAR_DTIM_COUNT_8814B(x) ((x) & (~BITS_DTIM_COUNT_8814B)) -+#define BIT_GET_DTIM_COUNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_8814B) & BIT_MASK_DTIM_COUNT_8814B) -+#define BIT_SET_DTIM_COUNT_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_8814B(x) | BIT_DTIM_COUNT_8814B(v)) -+ -+/* 2 REG_ATIM_DTIM_CTRL_SEL_8814B */ -+#define BIT_DTIM_BYPASS_V1_8814B BIT(7) -+ -+#define BIT_SHIFT_ATIM_DTIM_SEL_8814B 0 -+#define BIT_MASK_ATIM_DTIM_SEL_8814B 0x1f -+#define BIT_ATIM_DTIM_SEL_8814B(x) \ -+ (((x) & BIT_MASK_ATIM_DTIM_SEL_8814B) << BIT_SHIFT_ATIM_DTIM_SEL_8814B) -+#define BITS_ATIM_DTIM_SEL_8814B \ -+ (BIT_MASK_ATIM_DTIM_SEL_8814B << BIT_SHIFT_ATIM_DTIM_SEL_8814B) -+#define BIT_CLEAR_ATIM_DTIM_SEL_8814B(x) ((x) & (~BITS_ATIM_DTIM_SEL_8814B)) -+#define BIT_GET_ATIM_DTIM_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_ATIM_DTIM_SEL_8814B) & BIT_MASK_ATIM_DTIM_SEL_8814B) -+#define BIT_SET_ATIM_DTIM_SEL_8814B(x, v) \ -+ (BIT_CLEAR_ATIM_DTIM_SEL_8814B(x) | BIT_ATIM_DTIM_SEL_8814B(v)) -+ -+/* 2 REG_ATIMUGT_V1_8814B */ -+ -+#define BIT_SHIFT_ATIM_URGENT_8814B 0 -+#define BIT_MASK_ATIM_URGENT_8814B 0xff -+#define BIT_ATIM_URGENT_8814B(x) \ -+ (((x) & BIT_MASK_ATIM_URGENT_8814B) << BIT_SHIFT_ATIM_URGENT_8814B) -+#define BITS_ATIM_URGENT_8814B \ -+ (BIT_MASK_ATIM_URGENT_8814B << BIT_SHIFT_ATIM_URGENT_8814B) -+#define BIT_CLEAR_ATIM_URGENT_8814B(x) ((x) & (~BITS_ATIM_URGENT_8814B)) -+#define BIT_GET_ATIM_URGENT_8814B(x) \ -+ (((x) >> BIT_SHIFT_ATIM_URGENT_8814B) & BIT_MASK_ATIM_URGENT_8814B) -+#define BIT_SET_ATIM_URGENT_8814B(x, v) \ -+ (BIT_CLEAR_ATIM_URGENT_8814B(x) | BIT_ATIM_URGENT_8814B(v)) -+ -+/* 2 REG_BCNDROPCTRL_V1_8814B */ -+#define BIT_BEACON_DROP_EN_8814B BIT(7) -+ -+#define BIT_SHIFT_BEACON_DROP_IVL_8814B 0 -+#define BIT_MASK_BEACON_DROP_IVL_8814B 0x7f -+#define BIT_BEACON_DROP_IVL_8814B(x) \ -+ (((x) & BIT_MASK_BEACON_DROP_IVL_8814B) \ -+ << BIT_SHIFT_BEACON_DROP_IVL_8814B) -+#define BITS_BEACON_DROP_IVL_8814B \ -+ (BIT_MASK_BEACON_DROP_IVL_8814B << BIT_SHIFT_BEACON_DROP_IVL_8814B) -+#define BIT_CLEAR_BEACON_DROP_IVL_8814B(x) ((x) & (~BITS_BEACON_DROP_IVL_8814B)) -+#define BIT_GET_BEACON_DROP_IVL_8814B(x) \ -+ (((x) >> BIT_SHIFT_BEACON_DROP_IVL_8814B) & \ -+ BIT_MASK_BEACON_DROP_IVL_8814B) -+#define BIT_SET_BEACON_DROP_IVL_8814B(x, v) \ -+ (BIT_CLEAR_BEACON_DROP_IVL_8814B(x) | BIT_BEACON_DROP_IVL_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_DIS_ATIM_V1_8814B */ -+#define BIT_DIS_ATIM_P4_8814B BIT(19) -+#define BIT_DIS_ATIM_P3_8814B BIT(18) -+#define BIT_DIS_ATIM_P2_8814B BIT(17) -+#define BIT_DIS_ATIM_P1_8814B BIT(16) -+#define BIT_DIS_ATIM_VAP15_8814B BIT(15) -+#define BIT_DIS_ATIM_VAP14_8814B BIT(14) -+#define BIT_DIS_ATIM_VAP13_8814B BIT(13) -+#define BIT_DIS_ATIM_VAP12_8814B BIT(12) -+#define BIT_DIS_ATIM_VAP11_8814B BIT(11) -+#define BIT_DIS_ATIM_VAP10_8814B BIT(10) -+#define BIT_DIS_ATIM_VAP9_8814B BIT(9) -+#define BIT_DIS_ATIM_VAP8_8814B BIT(8) -+#define BIT_DIS_ATIM_VAP7_8814B BIT(7) -+#define BIT_DIS_ATIM_VAP6_8814B BIT(6) -+#define BIT_DIS_ATIM_VAP5_8814B BIT(5) -+#define BIT_DIS_ATIM_VAP4_8814B BIT(4) -+#define BIT_DIS_ATIM_VAP3_8814B BIT(3) -+#define BIT_DIS_ATIM_VAP2_8814B BIT(2) -+#define BIT_DIS_ATIM_VAP1_8814B BIT(1) -+#define BIT_DIS_ATIM_ROOT_P0_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_HIQ_NO_LMT_EN_V1_8814B */ -+#define BIT_HIQ_NO_LMT_EN_P4_8814B BIT(19) -+#define BIT_HIQ_NO_LMT_EN_P3_8814B BIT(18) -+#define BIT_HIQ_NO_LMT_EN_P2_8814B BIT(17) -+#define BIT_HIQ_NO_LMT_EN_P1_8814B BIT(16) -+#define BIT_HIQ_NO_LMT_EN_VAP15_8814B BIT(15) -+#define BIT_HIQ_NO_LMT_EN_VAP14_8814B BIT(14) -+#define BIT_HIQ_NO_LMT_EN_VAP13_8814B BIT(13) -+#define BIT_HIQ_NO_LMT_EN_VAP12_8814B BIT(12) -+#define BIT_HIQ_NO_LMT_EN_VAP11_8814B BIT(11) -+#define BIT_HIQ_NO_LMT_EN_VAP10_8814B BIT(10) -+#define BIT_HIQ_NO_LMT_EN_VAP9_8814B BIT(9) -+#define BIT_HIQ_NO_LMT_EN_VAP8_8814B BIT(8) -+#define BIT_HIQ_NO_LMT_EN_VAP7_8814B BIT(7) -+#define BIT_HIQ_NO_LMT_EN_VAP6_8814B BIT(6) -+#define BIT_HIQ_NO_LMT_EN_VAP5_8814B BIT(5) -+#define BIT_HIQ_NO_LMT_EN_VAP4_8814B BIT(4) -+#define BIT_HIQ_NO_LMT_EN_VAP3_8814B BIT(3) -+#define BIT_HIQ_NO_LMT_EN_VAP2_8814B BIT(2) -+#define BIT_HIQ_NO_LMT_EN_VAP1_8814B BIT(1) -+#define BIT_HIQ_NO_LMT_EN_ROOT_P0_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_P2PPS_CTRL_V1_8814B */ -+#define BIT_P2P_PWR_RST1_V2_8814B BIT(15) -+#define BIT_P2P_PWR_RST0_V2_8814B BIT(14) -+#define BIT_EN_TSFBIT32_RST_P2P_V1_8814B BIT(13) -+ -+#define BIT_SHIFT_NOA_UNIT0_SEL_V1_8814B 8 -+#define BIT_MASK_NOA_UNIT0_SEL_V1_8814B 0x7 -+#define BIT_NOA_UNIT0_SEL_V1_8814B(x) \ -+ (((x) & BIT_MASK_NOA_UNIT0_SEL_V1_8814B) \ -+ << BIT_SHIFT_NOA_UNIT0_SEL_V1_8814B) -+#define BITS_NOA_UNIT0_SEL_V1_8814B \ -+ (BIT_MASK_NOA_UNIT0_SEL_V1_8814B << BIT_SHIFT_NOA_UNIT0_SEL_V1_8814B) -+#define BIT_CLEAR_NOA_UNIT0_SEL_V1_8814B(x) \ -+ ((x) & (~BITS_NOA_UNIT0_SEL_V1_8814B)) -+#define BIT_GET_NOA_UNIT0_SEL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT0_SEL_V1_8814B) & \ -+ BIT_MASK_NOA_UNIT0_SEL_V1_8814B) -+#define BIT_SET_NOA_UNIT0_SEL_V1_8814B(x, v) \ -+ (BIT_CLEAR_NOA_UNIT0_SEL_V1_8814B(x) | BIT_NOA_UNIT0_SEL_V1_8814B(v)) -+ -+#define BIT_P2P_CTW_ALLSTASLEEP_V1_8814B BIT(7) -+#define BIT_P2P_OFF_DISTX_EN_V1_8814B BIT(6) -+#define BIT_PWR_MGT_EN_V1_8814B BIT(5) -+#define BIT_P2P_NOA1_EN_V1_8814B BIT(2) -+#define BIT_P2P_NOA0_EN_V1_8814B BIT(1) -+ -+/* 2 REG_P2PPS_SPEC_STATE_V1_8814B */ -+#define BIT_SPEC_POWER_STATE_8814B BIT(7) -+#define BIT_SPEC_CTWINDOW_ON_8814B BIT(6) -+#define BIT_SPEC_BEACON_AREA_ON_8814B BIT(5) -+#define BIT_SPEC_CTWIN_EARLY_DISTX_8814B BIT(4) -+#define BIT_SPEC_NOA1_OFF_PERIOD_8814B BIT(3) -+#define BIT_SPEC_FORCE_DOZE1_8814B BIT(2) -+#define BIT_SPEC_NOA0_OFF_PERIOD_8814B BIT(1) -+#define BIT_SPEC_FORCE_DOZE0_8814B BIT(0) -+ -+/* 2 REG_P2PPS_STATE_V1_8814B */ -+#define BIT_POWER_STATE_8814B BIT(7) -+#define BIT_CTWINDOW_ON_8814B BIT(6) -+#define BIT_BEACON_AREA_ON_8814B BIT(5) -+#define BIT_CTWIN_EARLY_DISTX_8814B BIT(4) -+#define BIT_NOA1_OFF_PERIOD_8814B BIT(3) -+#define BIT_FORCE_DOZE1_8814B BIT(2) -+#define BIT_NOA0_OFF_PERIOD_8814B BIT(1) -+#define BIT_FORCE_DOZE0_8814B BIT(0) -+ -+/* 2 REG_P2PPS1_CTRL_V1_8814B */ -+#define BIT_P2P1_PWR_RST1_V2_8814B BIT(15) -+#define BIT_P2P1_PWR_RST0_V2_8814B BIT(14) -+#define BIT_EN_TSFBIT32_RST_P2P1_V1_8814B BIT(13) -+ -+#define BIT_SHIFT_NOA_UNIT1_SEL_V1_8814B 8 -+#define BIT_MASK_NOA_UNIT1_SEL_V1_8814B 0x7 -+#define BIT_NOA_UNIT1_SEL_V1_8814B(x) \ -+ (((x) & BIT_MASK_NOA_UNIT1_SEL_V1_8814B) \ -+ << BIT_SHIFT_NOA_UNIT1_SEL_V1_8814B) -+#define BITS_NOA_UNIT1_SEL_V1_8814B \ -+ (BIT_MASK_NOA_UNIT1_SEL_V1_8814B << BIT_SHIFT_NOA_UNIT1_SEL_V1_8814B) -+#define BIT_CLEAR_NOA_UNIT1_SEL_V1_8814B(x) \ -+ ((x) & (~BITS_NOA_UNIT1_SEL_V1_8814B)) -+#define BIT_GET_NOA_UNIT1_SEL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT1_SEL_V1_8814B) & \ -+ BIT_MASK_NOA_UNIT1_SEL_V1_8814B) -+#define BIT_SET_NOA_UNIT1_SEL_V1_8814B(x, v) \ -+ (BIT_CLEAR_NOA_UNIT1_SEL_V1_8814B(x) | BIT_NOA_UNIT1_SEL_V1_8814B(v)) -+ -+#define BIT_P2P1_CTW_ALLSTASLEEP_V1_8814B BIT(7) -+#define BIT_P2P1_OFF_DISTX_EN_8814B BIT(6) -+#define BIT_P2P1_PWR_MGT_EN_V1_8814B BIT(5) -+#define BIT_P2P1_NOA1_EN_V1_8814B BIT(2) -+#define BIT_P2P1_NOA0_EN_V1_8814B BIT(1) -+ -+/* 2 REG_P2PPS1_SPEC_STATE_V1_8814B */ -+#define BIT_P2P1_SPEC_POWER_STATEP_8814B BIT(7) -+#define BIT_P2P1_SPEC_CTWINDOW_ON_8814B BIT(6) -+#define BIT_P2P1_SPEC_BEACON_AREA_ON_8814B BIT(5) -+#define BIT_P2P1_SPEC_CTWIN_EARLY_DISTX_8814B BIT(4) -+#define BIT_P2P1_SPEC_NOA1_OFF_PERIOD_8814B BIT(3) -+#define BIT_P2P1_SPEC_FORCE_DOZE1_8814B BIT(2) -+#define BIT_P2P1_SPEC_NOA0_OFF_PERIOD_8814B BIT(1) -+#define BIT_P2P1_SPEC_FORCE_DOZE0_8814B BIT(0) -+ -+/* 2 REG_P2PPS1_STATE_V1_8814B */ -+#define BIT_P2P1_POWER_STATE_8814B BIT(7) -+#define BIT_P2P1_CTWINDOW_ON_8814B BIT(6) -+#define BIT_P2P1_BEACON_AREA_ON_8814B BIT(5) -+#define BIT_P2P1_CTWIN_EARLY_DISTX_8814B BIT(4) -+#define BIT_P2P1_NOA1_OFF_PERIOD_8814B BIT(3) -+#define BIT_P2P1_FORCE_DOZE1_8814B BIT(2) -+#define BIT_P2P1_NOA0_OFF_PERIOD_8814B BIT(1) -+#define BIT_P2P1_FORCE_DOZE0_8814B BIT(0) -+ -+/* 2 REG_P2PPS2_CTRL_V1_8814B */ -+#define BIT_P2P2_PWR_RST1_V2_8814B BIT(15) -+#define BIT_P2P2_PWR_RST0_V2_8814B BIT(14) -+#define BIT_EN_TSFBIT32_RST_P2P2_V1_8814B BIT(13) -+ -+#define BIT_SHIFT_NOA_UNIT2_SEL_V1_8814B 8 -+#define BIT_MASK_NOA_UNIT2_SEL_V1_8814B 0x7 -+#define BIT_NOA_UNIT2_SEL_V1_8814B(x) \ -+ (((x) & BIT_MASK_NOA_UNIT2_SEL_V1_8814B) \ -+ << BIT_SHIFT_NOA_UNIT2_SEL_V1_8814B) -+#define BITS_NOA_UNIT2_SEL_V1_8814B \ -+ (BIT_MASK_NOA_UNIT2_SEL_V1_8814B << BIT_SHIFT_NOA_UNIT2_SEL_V1_8814B) -+#define BIT_CLEAR_NOA_UNIT2_SEL_V1_8814B(x) \ -+ ((x) & (~BITS_NOA_UNIT2_SEL_V1_8814B)) -+#define BIT_GET_NOA_UNIT2_SEL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT2_SEL_V1_8814B) & \ -+ BIT_MASK_NOA_UNIT2_SEL_V1_8814B) -+#define BIT_SET_NOA_UNIT2_SEL_V1_8814B(x, v) \ -+ (BIT_CLEAR_NOA_UNIT2_SEL_V1_8814B(x) | BIT_NOA_UNIT2_SEL_V1_8814B(v)) -+ -+#define BIT_P2P2_CTW_ALLSTASLEEP_V1_8814B BIT(7) -+#define BIT_P2P2_OFF_DISTX_EN_V1_8814B BIT(6) -+#define BIT_P2P2_PWR_MGT_EN_V1_8814B BIT(5) -+#define BIT_P2P2_NOA1_EN_V1_8814B BIT(2) -+#define BIT_P2P2_NOA0_EN_V1_8814B BIT(1) -+ -+/* 2 REG_P2PPS2_SPEC_STATE_V1_8814B */ -+#define BIT_P2P2_SPEC_POWER_STATEP_8814B BIT(7) -+#define BIT_P2P2_SPEC_CTWINDOW_ON_8814B BIT(6) -+#define BIT_P2P2_SPEC_BEACON_AREA_ON_8814B BIT(5) -+#define BIT_P2P2_SPEC_CTWIN_EARLY_DISTX_8814B BIT(4) -+#define BIT_P2P2_SPEC_NOA1_OFF_PERIOD_8814B BIT(3) -+#define BIT_P2P2_SPEC_FORCE_DOZE1_8814B BIT(2) -+#define BIT_P2P2_SPEC_NOA0_OFF_PERIOD_8814B BIT(1) -+#define BIT_P2P2_SPEC_FORCE_DOZE0_8814B BIT(0) -+ -+/* 2 REG_P2PPS2_STATE_V1_8814B */ -+#define BIT_P2P2_POWER_STATE_8814B BIT(7) -+#define BIT_P2P2_CTWINDOW_ON_8814B BIT(6) -+#define BIT_P2P2_BEACON_AREA_ON_8814B BIT(5) -+#define BIT_P2P2_CTWIN_EARLY_DISTX_8814B BIT(4) -+#define BIT_P2P2_NOA1_OFF_PERIOD_8814B BIT(3) -+#define BIT_P2P2_FORCE_DOZE1_8814B BIT(2) -+#define BIT_P2P2_NOA0_OFF_PERIOD_8814B BIT(1) -+#define BIT_P2P2_FORCE_DOZE0_8814B BIT(0) -+ -+/* 2 REG_P2PON_DIS_TXTIME_V1_8814B */ -+ -+#define BIT_SHIFT_P2PON_DIS_TXTIME_8814B 0 -+#define BIT_MASK_P2PON_DIS_TXTIME_8814B 0xff -+#define BIT_P2PON_DIS_TXTIME_8814B(x) \ -+ (((x) & BIT_MASK_P2PON_DIS_TXTIME_8814B) \ -+ << BIT_SHIFT_P2PON_DIS_TXTIME_8814B) -+#define BITS_P2PON_DIS_TXTIME_8814B \ -+ (BIT_MASK_P2PON_DIS_TXTIME_8814B << BIT_SHIFT_P2PON_DIS_TXTIME_8814B) -+#define BIT_CLEAR_P2PON_DIS_TXTIME_8814B(x) \ -+ ((x) & (~BITS_P2PON_DIS_TXTIME_8814B)) -+#define BIT_GET_P2PON_DIS_TXTIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_P2PON_DIS_TXTIME_8814B) & \ -+ BIT_MASK_P2PON_DIS_TXTIME_8814B) -+#define BIT_SET_P2PON_DIS_TXTIME_8814B(x, v) \ -+ (BIT_CLEAR_P2PON_DIS_TXTIME_8814B(x) | BIT_P2PON_DIS_TXTIME_8814B(v)) -+ -+/* 2 REG_P2POFF_DIS_TXTIME_V1_8814B */ -+ -+#define BIT_SHIFT_P2POFF_DIS_TXTIME_8814B 0 -+#define BIT_MASK_P2POFF_DIS_TXTIME_8814B 0xff -+#define BIT_P2POFF_DIS_TXTIME_8814B(x) \ -+ (((x) & BIT_MASK_P2POFF_DIS_TXTIME_8814B) \ -+ << BIT_SHIFT_P2POFF_DIS_TXTIME_8814B) -+#define BITS_P2POFF_DIS_TXTIME_8814B \ -+ (BIT_MASK_P2POFF_DIS_TXTIME_8814B << BIT_SHIFT_P2POFF_DIS_TXTIME_8814B) -+#define BIT_CLEAR_P2POFF_DIS_TXTIME_8814B(x) \ -+ ((x) & (~BITS_P2POFF_DIS_TXTIME_8814B)) -+#define BIT_GET_P2POFF_DIS_TXTIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_P2POFF_DIS_TXTIME_8814B) & \ -+ BIT_MASK_P2POFF_DIS_TXTIME_8814B) -+#define BIT_SET_P2POFF_DIS_TXTIME_8814B(x, v) \ -+ (BIT_CLEAR_P2POFF_DIS_TXTIME_8814B(x) | BIT_P2POFF_DIS_TXTIME_8814B(v)) -+ -+/* 2 REG_CHG_POWER_BCN_AREA_8814B */ -+#define BIT_CHG_POWER_BCN_AREA_8814B BIT(0) -+ -+/* 2 REG_NOA_SEL_8814B */ -+ -+#define BIT_SHIFT_NOA_SEL_V1_8814B 0 -+#define BIT_MASK_NOA_SEL_V1_8814B 0x7 -+#define BIT_NOA_SEL_V1_8814B(x) \ -+ (((x) & BIT_MASK_NOA_SEL_V1_8814B) << BIT_SHIFT_NOA_SEL_V1_8814B) -+#define BITS_NOA_SEL_V1_8814B \ -+ (BIT_MASK_NOA_SEL_V1_8814B << BIT_SHIFT_NOA_SEL_V1_8814B) -+#define BIT_CLEAR_NOA_SEL_V1_8814B(x) ((x) & (~BITS_NOA_SEL_V1_8814B)) -+#define BIT_GET_NOA_SEL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_SEL_V1_8814B) & BIT_MASK_NOA_SEL_V1_8814B) -+#define BIT_SET_NOA_SEL_V1_8814B(x, v) \ -+ (BIT_CLEAR_NOA_SEL_V1_8814B(x) | BIT_NOA_SEL_V1_8814B(v)) -+ -+/* 2 REG_NOA_PARAM_V1_8814B */ -+ -+#define BIT_SHIFT_NOA_DURATION_8814B 0 -+#define BIT_MASK_NOA_DURATION_8814B 0xffffffffL -+#define BIT_NOA_DURATION_8814B(x) \ -+ (((x) & BIT_MASK_NOA_DURATION_8814B) << BIT_SHIFT_NOA_DURATION_8814B) -+#define BITS_NOA_DURATION_8814B \ -+ (BIT_MASK_NOA_DURATION_8814B << BIT_SHIFT_NOA_DURATION_8814B) -+#define BIT_CLEAR_NOA_DURATION_8814B(x) ((x) & (~BITS_NOA_DURATION_8814B)) -+#define BIT_GET_NOA_DURATION_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_DURATION_8814B) & BIT_MASK_NOA_DURATION_8814B) -+#define BIT_SET_NOA_DURATION_8814B(x, v) \ -+ (BIT_CLEAR_NOA_DURATION_8814B(x) | BIT_NOA_DURATION_8814B(v)) -+ -+/* 2 REG_NOA_PARAM_1_V1_8814B */ -+ -+#define BIT_SHIFT_NOA_INTERVAL_8814B 0 -+#define BIT_MASK_NOA_INTERVAL_8814B 0xffffffffL -+#define BIT_NOA_INTERVAL_8814B(x) \ -+ (((x) & BIT_MASK_NOA_INTERVAL_8814B) << BIT_SHIFT_NOA_INTERVAL_8814B) -+#define BITS_NOA_INTERVAL_8814B \ -+ (BIT_MASK_NOA_INTERVAL_8814B << BIT_SHIFT_NOA_INTERVAL_8814B) -+#define BIT_CLEAR_NOA_INTERVAL_8814B(x) ((x) & (~BITS_NOA_INTERVAL_8814B)) -+#define BIT_GET_NOA_INTERVAL_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_INTERVAL_8814B) & BIT_MASK_NOA_INTERVAL_8814B) -+#define BIT_SET_NOA_INTERVAL_8814B(x, v) \ -+ (BIT_CLEAR_NOA_INTERVAL_8814B(x) | BIT_NOA_INTERVAL_8814B(v)) -+ -+/* 2 REG_NOA_PARAM_2_V1_8814B */ -+ -+#define BIT_SHIFT_NOA_START_TIME_8814B 0 -+#define BIT_MASK_NOA_START_TIME_8814B 0xffffffffL -+#define BIT_NOA_START_TIME_8814B(x) \ -+ (((x) & BIT_MASK_NOA_START_TIME_8814B) \ -+ << BIT_SHIFT_NOA_START_TIME_8814B) -+#define BITS_NOA_START_TIME_8814B \ -+ (BIT_MASK_NOA_START_TIME_8814B << BIT_SHIFT_NOA_START_TIME_8814B) -+#define BIT_CLEAR_NOA_START_TIME_8814B(x) ((x) & (~BITS_NOA_START_TIME_8814B)) -+#define BIT_GET_NOA_START_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_START_TIME_8814B) & \ -+ BIT_MASK_NOA_START_TIME_8814B) -+#define BIT_SET_NOA_START_TIME_8814B(x, v) \ -+ (BIT_CLEAR_NOA_START_TIME_8814B(x) | BIT_NOA_START_TIME_8814B(v)) -+ -+/* 2 REG_NOA_PARAM_3_V1_8814B */ -+ -+#define BIT_SHIFT_NOA_COUNT_V2_8814B 0 -+#define BIT_MASK_NOA_COUNT_V2_8814B 0xffffffffL -+#define BIT_NOA_COUNT_V2_8814B(x) \ -+ (((x) & BIT_MASK_NOA_COUNT_V2_8814B) << BIT_SHIFT_NOA_COUNT_V2_8814B) -+#define BITS_NOA_COUNT_V2_8814B \ -+ (BIT_MASK_NOA_COUNT_V2_8814B << BIT_SHIFT_NOA_COUNT_V2_8814B) -+#define BIT_CLEAR_NOA_COUNT_V2_8814B(x) ((x) & (~BITS_NOA_COUNT_V2_8814B)) -+#define BIT_GET_NOA_COUNT_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_COUNT_V2_8814B) & BIT_MASK_NOA_COUNT_V2_8814B) -+#define BIT_SET_NOA_COUNT_V2_8814B(x, v) \ -+ (BIT_CLEAR_NOA_COUNT_V2_8814B(x) | BIT_NOA_COUNT_V2_8814B(v)) -+ -+/* 2 REG_NOA_ON_ERLY_TIME_V1_8814B */ -+ -+#define BIT_SHIFT__NOA_ON_ERLY_TIME_8814B 0 -+#define BIT_MASK__NOA_ON_ERLY_TIME_8814B 0xff -+#define BIT__NOA_ON_ERLY_TIME_8814B(x) \ -+ (((x) & BIT_MASK__NOA_ON_ERLY_TIME_8814B) \ -+ << BIT_SHIFT__NOA_ON_ERLY_TIME_8814B) -+#define BITS__NOA_ON_ERLY_TIME_8814B \ -+ (BIT_MASK__NOA_ON_ERLY_TIME_8814B << BIT_SHIFT__NOA_ON_ERLY_TIME_8814B) -+#define BIT_CLEAR__NOA_ON_ERLY_TIME_8814B(x) \ -+ ((x) & (~BITS__NOA_ON_ERLY_TIME_8814B)) -+#define BIT_GET__NOA_ON_ERLY_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT__NOA_ON_ERLY_TIME_8814B) & \ -+ BIT_MASK__NOA_ON_ERLY_TIME_8814B) -+#define BIT_SET__NOA_ON_ERLY_TIME_8814B(x, v) \ -+ (BIT_CLEAR__NOA_ON_ERLY_TIME_8814B(x) | BIT__NOA_ON_ERLY_TIME_8814B(v)) -+ -+/* 2 REG_NOA_OFF_ERLY_TIME_V1_8814B */ -+ -+#define BIT_SHIFT__NOA_OFF_ERLY_TIME_8814B 0 -+#define BIT_MASK__NOA_OFF_ERLY_TIME_8814B 0xff -+#define BIT__NOA_OFF_ERLY_TIME_8814B(x) \ -+ (((x) & BIT_MASK__NOA_OFF_ERLY_TIME_8814B) \ -+ << BIT_SHIFT__NOA_OFF_ERLY_TIME_8814B) -+#define BITS__NOA_OFF_ERLY_TIME_8814B \ -+ (BIT_MASK__NOA_OFF_ERLY_TIME_8814B \ -+ << BIT_SHIFT__NOA_OFF_ERLY_TIME_8814B) -+#define BIT_CLEAR__NOA_OFF_ERLY_TIME_8814B(x) \ -+ ((x) & (~BITS__NOA_OFF_ERLY_TIME_8814B)) -+#define BIT_GET__NOA_OFF_ERLY_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT__NOA_OFF_ERLY_TIME_8814B) & \ -+ BIT_MASK__NOA_OFF_ERLY_TIME_8814B) -+#define BIT_SET__NOA_OFF_ERLY_TIME_8814B(x, v) \ -+ (BIT_CLEAR__NOA_OFF_ERLY_TIME_8814B(x) | \ -+ BIT__NOA_OFF_ERLY_TIME_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_P2PPS_HW_AUTO_PAUSE_CTRL_8814B */ -+#define BIT_P2PPS_NOA_STOP_TX_HANG_8814B BIT(31) -+#define BIT_P2PPS_MACID_PAUSE_EN_8814B BIT(11) -+#define BIT_P2PPS__MGQ_PAUSE_8814B BIT(10) -+#define BIT_P2PPS__HIQ_PAUSE_8814B BIT(9) -+#define BIT_P2PPS__BCNQ_PAUSE_8814B BIT(8) -+ -+#define BIT_SHIFT_P2PPS_MACID_PAUSE_8814B 0 -+#define BIT_MASK_P2PPS_MACID_PAUSE_8814B 0xff -+#define BIT_P2PPS_MACID_PAUSE_8814B(x) \ -+ (((x) & BIT_MASK_P2PPS_MACID_PAUSE_8814B) \ -+ << BIT_SHIFT_P2PPS_MACID_PAUSE_8814B) -+#define BITS_P2PPS_MACID_PAUSE_8814B \ -+ (BIT_MASK_P2PPS_MACID_PAUSE_8814B << BIT_SHIFT_P2PPS_MACID_PAUSE_8814B) -+#define BIT_CLEAR_P2PPS_MACID_PAUSE_8814B(x) \ -+ ((x) & (~BITS_P2PPS_MACID_PAUSE_8814B)) -+#define BIT_GET_P2PPS_MACID_PAUSE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P2PPS_MACID_PAUSE_8814B) & \ -+ BIT_MASK_P2PPS_MACID_PAUSE_8814B) -+#define BIT_SET_P2PPS_MACID_PAUSE_8814B(x, v) \ -+ (BIT_CLEAR_P2PPS_MACID_PAUSE_8814B(x) | BIT_P2PPS_MACID_PAUSE_8814B(v)) -+ -+/* 2 REG_P2PPS1_HW_AUTO_PAUSE_CTRL_8814B */ -+#define BIT_P2PPS1_NOA_STOP_TX_HANG_8814B BIT(31) -+#define BIT_P2PPS1_MACID_PAUSE_EN_8814B BIT(11) -+#define BIT_P2PPS1__MGQ_PAUSE_8814B BIT(10) -+#define BIT_P2PPS1__HIQ_PAUSE_8814B BIT(9) -+#define BIT_P2PPS1__BCNQ_PAUSE_8814B BIT(8) -+ -+#define BIT_SHIFT_P2PPS1_MACID_PAUSE_8814B 0 -+#define BIT_MASK_P2PPS1_MACID_PAUSE_8814B 0xff -+#define BIT_P2PPS1_MACID_PAUSE_8814B(x) \ -+ (((x) & BIT_MASK_P2PPS1_MACID_PAUSE_8814B) \ -+ << BIT_SHIFT_P2PPS1_MACID_PAUSE_8814B) -+#define BITS_P2PPS1_MACID_PAUSE_8814B \ -+ (BIT_MASK_P2PPS1_MACID_PAUSE_8814B \ -+ << BIT_SHIFT_P2PPS1_MACID_PAUSE_8814B) -+#define BIT_CLEAR_P2PPS1_MACID_PAUSE_8814B(x) \ -+ ((x) & (~BITS_P2PPS1_MACID_PAUSE_8814B)) -+#define BIT_GET_P2PPS1_MACID_PAUSE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P2PPS1_MACID_PAUSE_8814B) & \ -+ BIT_MASK_P2PPS1_MACID_PAUSE_8814B) -+#define BIT_SET_P2PPS1_MACID_PAUSE_8814B(x, v) \ -+ (BIT_CLEAR_P2PPS1_MACID_PAUSE_8814B(x) | \ -+ BIT_P2PPS1_MACID_PAUSE_8814B(v)) -+ -+/* 2 REG_P2PPS2_HW_AUTO_PAUSE_CTRL_8814B */ -+#define BIT_P2PPS2_NOA_STOP_TX_HANG_8814B BIT(31) -+#define BIT_P2PPS2_MACID_PAUSE_EN_8814B BIT(11) -+#define BIT_P2PPS2__MGQ_PAUSE_8814B BIT(10) -+#define BIT_P2PPS2__HIQ_PAUSE_8814B BIT(9) -+#define BIT_P2PPS2__BCNQ_PAUSE_8814B BIT(8) -+ -+#define BIT_SHIFT_P2PPS2_MACID_PAUSE_8814B 0 -+#define BIT_MASK_P2PPS2_MACID_PAUSE_8814B 0xff -+#define BIT_P2PPS2_MACID_PAUSE_8814B(x) \ -+ (((x) & BIT_MASK_P2PPS2_MACID_PAUSE_8814B) \ -+ << BIT_SHIFT_P2PPS2_MACID_PAUSE_8814B) -+#define BITS_P2PPS2_MACID_PAUSE_8814B \ -+ (BIT_MASK_P2PPS2_MACID_PAUSE_8814B \ -+ << BIT_SHIFT_P2PPS2_MACID_PAUSE_8814B) -+#define BIT_CLEAR_P2PPS2_MACID_PAUSE_8814B(x) \ -+ ((x) & (~BITS_P2PPS2_MACID_PAUSE_8814B)) -+#define BIT_GET_P2PPS2_MACID_PAUSE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P2PPS2_MACID_PAUSE_8814B) & \ -+ BIT_MASK_P2PPS2_MACID_PAUSE_8814B) -+#define BIT_SET_P2PPS2_MACID_PAUSE_8814B(x, v) \ -+ (BIT_CLEAR_P2PPS2_MACID_PAUSE_8814B(x) | \ -+ BIT_P2PPS2_MACID_PAUSE_8814B(v)) -+ -+/* 2 REG_RX_TBTT_SHIFT_8814B */ -+ -+#define BIT_SHIFT_RX_TBTT_SHIFT_SEL_8814B 24 -+#define BIT_MASK_RX_TBTT_SHIFT_SEL_8814B 0x7 -+#define BIT_RX_TBTT_SHIFT_SEL_8814B(x) \ -+ (((x) & BIT_MASK_RX_TBTT_SHIFT_SEL_8814B) \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_SEL_8814B) -+#define BITS_RX_TBTT_SHIFT_SEL_8814B \ -+ (BIT_MASK_RX_TBTT_SHIFT_SEL_8814B << BIT_SHIFT_RX_TBTT_SHIFT_SEL_8814B) -+#define BIT_CLEAR_RX_TBTT_SHIFT_SEL_8814B(x) \ -+ ((x) & (~BITS_RX_TBTT_SHIFT_SEL_8814B)) -+#define BIT_GET_RX_TBTT_SHIFT_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_TBTT_SHIFT_SEL_8814B) & \ -+ BIT_MASK_RX_TBTT_SHIFT_SEL_8814B) -+#define BIT_SET_RX_TBTT_SHIFT_SEL_8814B(x, v) \ -+ (BIT_CLEAR_RX_TBTT_SHIFT_SEL_8814B(x) | BIT_RX_TBTT_SHIFT_SEL_8814B(v)) -+ -+#define BIT_RX_TBTT_SHIFT_RW_FLAG_8814B BIT(15) -+ -+#define BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_8814B 0 -+#define BIT_MASK_RX_TBTT_SHIFT_OFFSET_8814B 0xfff -+#define BIT_RX_TBTT_SHIFT_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_RX_TBTT_SHIFT_OFFSET_8814B) \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_8814B) -+#define BITS_RX_TBTT_SHIFT_OFFSET_8814B \ -+ (BIT_MASK_RX_TBTT_SHIFT_OFFSET_8814B \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_8814B) -+#define BIT_CLEAR_RX_TBTT_SHIFT_OFFSET_8814B(x) \ -+ ((x) & (~BITS_RX_TBTT_SHIFT_OFFSET_8814B)) -+#define BIT_GET_RX_TBTT_SHIFT_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_8814B) & \ -+ BIT_MASK_RX_TBTT_SHIFT_OFFSET_8814B) -+#define BIT_SET_RX_TBTT_SHIFT_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_RX_TBTT_SHIFT_OFFSET_8814B(x) | \ -+ BIT_RX_TBTT_SHIFT_OFFSET_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_FREERUN_CNT_LOW_8814B */ -+ -+#define BIT_SHIFT_FREERUN_CNT_LOW_8814B 0 -+#define BIT_MASK_FREERUN_CNT_LOW_8814B 0xffffffffL -+#define BIT_FREERUN_CNT_LOW_8814B(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_LOW_8814B) \ -+ << BIT_SHIFT_FREERUN_CNT_LOW_8814B) -+#define BITS_FREERUN_CNT_LOW_8814B \ -+ (BIT_MASK_FREERUN_CNT_LOW_8814B << BIT_SHIFT_FREERUN_CNT_LOW_8814B) -+#define BIT_CLEAR_FREERUN_CNT_LOW_8814B(x) ((x) & (~BITS_FREERUN_CNT_LOW_8814B)) -+#define BIT_GET_FREERUN_CNT_LOW_8814B(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_LOW_8814B) & \ -+ BIT_MASK_FREERUN_CNT_LOW_8814B) -+#define BIT_SET_FREERUN_CNT_LOW_8814B(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_LOW_8814B(x) | BIT_FREERUN_CNT_LOW_8814B(v)) -+ -+/* 2 REG_FREERUN_CNT_HIGH_8814B */ -+ -+#define BIT_SHIFT_FREERUN_CNT_HIGH_8814B 0 -+#define BIT_MASK_FREERUN_CNT_HIGH_8814B 0xffffffffL -+#define BIT_FREERUN_CNT_HIGH_8814B(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_HIGH_8814B) \ -+ << BIT_SHIFT_FREERUN_CNT_HIGH_8814B) -+#define BITS_FREERUN_CNT_HIGH_8814B \ -+ (BIT_MASK_FREERUN_CNT_HIGH_8814B << BIT_SHIFT_FREERUN_CNT_HIGH_8814B) -+#define BIT_CLEAR_FREERUN_CNT_HIGH_8814B(x) \ -+ ((x) & (~BITS_FREERUN_CNT_HIGH_8814B)) -+#define BIT_GET_FREERUN_CNT_HIGH_8814B(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_HIGH_8814B) & \ -+ BIT_MASK_FREERUN_CNT_HIGH_8814B) -+#define BIT_SET_FREERUN_CNT_HIGH_8814B(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_HIGH_8814B(x) | BIT_FREERUN_CNT_HIGH_8814B(v)) -+ -+/* 2 REG_CPUMGQ_TX_TIMER_V1_8814B */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8814B 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_V1_8814B 0xffffffffL -+#define BIT_CPUMGQ_TX_TIMER_V1_8814B(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_V1_8814B) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8814B) -+#define BITS_CPUMGQ_TX_TIMER_V1_8814B \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_V1_8814B \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8814B) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8814B(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_V1_8814B)) -+#define BIT_GET_CPUMGQ_TX_TIMER_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8814B) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_V1_8814B) -+#define BIT_SET_CPUMGQ_TX_TIMER_V1_8814B(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8814B(x) | \ -+ BIT_CPUMGQ_TX_TIMER_V1_8814B(v)) -+ -+/* 2 REG_PS_TIMER_0_8814B */ -+ -+#define BIT_SHIFT_PS_TIMER_0_8814B 0 -+#define BIT_MASK_PS_TIMER_0_8814B 0xffffffffL -+#define BIT_PS_TIMER_0_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_0_8814B) << BIT_SHIFT_PS_TIMER_0_8814B) -+#define BITS_PS_TIMER_0_8814B \ -+ (BIT_MASK_PS_TIMER_0_8814B << BIT_SHIFT_PS_TIMER_0_8814B) -+#define BIT_CLEAR_PS_TIMER_0_8814B(x) ((x) & (~BITS_PS_TIMER_0_8814B)) -+#define BIT_GET_PS_TIMER_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_0_8814B) & BIT_MASK_PS_TIMER_0_8814B) -+#define BIT_SET_PS_TIMER_0_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_0_8814B(x) | BIT_PS_TIMER_0_8814B(v)) -+ -+/* 2 REG_PS_TIMER_1_8814B */ -+ -+#define BIT_SHIFT_PS_TIMER_1_8814B 0 -+#define BIT_MASK_PS_TIMER_1_8814B 0xffffffffL -+#define BIT_PS_TIMER_1_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_1_8814B) << BIT_SHIFT_PS_TIMER_1_8814B) -+#define BITS_PS_TIMER_1_8814B \ -+ (BIT_MASK_PS_TIMER_1_8814B << BIT_SHIFT_PS_TIMER_1_8814B) -+#define BIT_CLEAR_PS_TIMER_1_8814B(x) ((x) & (~BITS_PS_TIMER_1_8814B)) -+#define BIT_GET_PS_TIMER_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_1_8814B) & BIT_MASK_PS_TIMER_1_8814B) -+#define BIT_SET_PS_TIMER_1_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_1_8814B(x) | BIT_PS_TIMER_1_8814B(v)) -+ -+/* 2 REG_PS_TIMER_2_8814B */ -+ -+#define BIT_SHIFT_PS_TIMER_2_8814B 0 -+#define BIT_MASK_PS_TIMER_2_8814B 0xffffffffL -+#define BIT_PS_TIMER_2_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_2_8814B) << BIT_SHIFT_PS_TIMER_2_8814B) -+#define BITS_PS_TIMER_2_8814B \ -+ (BIT_MASK_PS_TIMER_2_8814B << BIT_SHIFT_PS_TIMER_2_8814B) -+#define BIT_CLEAR_PS_TIMER_2_8814B(x) ((x) & (~BITS_PS_TIMER_2_8814B)) -+#define BIT_GET_PS_TIMER_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_2_8814B) & BIT_MASK_PS_TIMER_2_8814B) -+#define BIT_SET_PS_TIMER_2_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_2_8814B(x) | BIT_PS_TIMER_2_8814B(v)) -+ -+/* 2 REG_PS_TIMER_3_8814B */ -+ -+#define BIT_SHIFT_PS_TIMER_3_8814B 0 -+#define BIT_MASK_PS_TIMER_3_8814B 0xffffffffL -+#define BIT_PS_TIMER_3_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_3_8814B) << BIT_SHIFT_PS_TIMER_3_8814B) -+#define BITS_PS_TIMER_3_8814B \ -+ (BIT_MASK_PS_TIMER_3_8814B << BIT_SHIFT_PS_TIMER_3_8814B) -+#define BIT_CLEAR_PS_TIMER_3_8814B(x) ((x) & (~BITS_PS_TIMER_3_8814B)) -+#define BIT_GET_PS_TIMER_3_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_3_8814B) & BIT_MASK_PS_TIMER_3_8814B) -+#define BIT_SET_PS_TIMER_3_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_3_8814B(x) | BIT_PS_TIMER_3_8814B(v)) -+ -+/* 2 REG_PS_TIMER_4_8814B */ -+ -+#define BIT_SHIFT_PS_TIMER_4_8814B 0 -+#define BIT_MASK_PS_TIMER_4_8814B 0xffffffffL -+#define BIT_PS_TIMER_4_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_4_8814B) << BIT_SHIFT_PS_TIMER_4_8814B) -+#define BITS_PS_TIMER_4_8814B \ -+ (BIT_MASK_PS_TIMER_4_8814B << BIT_SHIFT_PS_TIMER_4_8814B) -+#define BIT_CLEAR_PS_TIMER_4_8814B(x) ((x) & (~BITS_PS_TIMER_4_8814B)) -+#define BIT_GET_PS_TIMER_4_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_4_8814B) & BIT_MASK_PS_TIMER_4_8814B) -+#define BIT_SET_PS_TIMER_4_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_4_8814B(x) | BIT_PS_TIMER_4_8814B(v)) -+ -+/* 2 REG_PS_TIMER_5_8814B */ -+ -+#define BIT_SHIFT_PS_TIMER_5_8814B 0 -+#define BIT_MASK_PS_TIMER_5_8814B 0xffffffffL -+#define BIT_PS_TIMER_5_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_5_8814B) << BIT_SHIFT_PS_TIMER_5_8814B) -+#define BITS_PS_TIMER_5_8814B \ -+ (BIT_MASK_PS_TIMER_5_8814B << BIT_SHIFT_PS_TIMER_5_8814B) -+#define BIT_CLEAR_PS_TIMER_5_8814B(x) ((x) & (~BITS_PS_TIMER_5_8814B)) -+#define BIT_GET_PS_TIMER_5_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_5_8814B) & BIT_MASK_PS_TIMER_5_8814B) -+#define BIT_SET_PS_TIMER_5_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_5_8814B(x) | BIT_PS_TIMER_5_8814B(v)) -+ -+/* 2 REG_PS_TIMER_01_CTRL_8814B */ -+ -+#define BIT_SHIFT_PS_TIMER_1_EARLY_TIME_8814B 24 -+#define BIT_MASK_PS_TIMER_1_EARLY_TIME_8814B 0xff -+#define BIT_PS_TIMER_1_EARLY_TIME_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_1_EARLY_TIME_8814B) \ -+ << BIT_SHIFT_PS_TIMER_1_EARLY_TIME_8814B) -+#define BITS_PS_TIMER_1_EARLY_TIME_8814B \ -+ (BIT_MASK_PS_TIMER_1_EARLY_TIME_8814B \ -+ << BIT_SHIFT_PS_TIMER_1_EARLY_TIME_8814B) -+#define BIT_CLEAR_PS_TIMER_1_EARLY_TIME_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_1_EARLY_TIME_8814B)) -+#define BIT_GET_PS_TIMER_1_EARLY_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_1_EARLY_TIME_8814B) & \ -+ BIT_MASK_PS_TIMER_1_EARLY_TIME_8814B) -+#define BIT_SET_PS_TIMER_1_EARLY_TIME_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_1_EARLY_TIME_8814B(x) | \ -+ BIT_PS_TIMER_1_EARLY_TIME_8814B(v)) -+ -+#define BIT_PS_TIMER_1_EN_8814B BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_1_TSF_SEL_8814B 16 -+#define BIT_MASK_PS_TIMER_1_TSF_SEL_8814B 0x7 -+#define BIT_PS_TIMER_1_TSF_SEL_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_1_TSF_SEL_8814B) \ -+ << BIT_SHIFT_PS_TIMER_1_TSF_SEL_8814B) -+#define BITS_PS_TIMER_1_TSF_SEL_8814B \ -+ (BIT_MASK_PS_TIMER_1_TSF_SEL_8814B \ -+ << BIT_SHIFT_PS_TIMER_1_TSF_SEL_8814B) -+#define BIT_CLEAR_PS_TIMER_1_TSF_SEL_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_1_TSF_SEL_8814B)) -+#define BIT_GET_PS_TIMER_1_TSF_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_1_TSF_SEL_8814B) & \ -+ BIT_MASK_PS_TIMER_1_TSF_SEL_8814B) -+#define BIT_SET_PS_TIMER_1_TSF_SEL_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_1_TSF_SEL_8814B(x) | \ -+ BIT_PS_TIMER_1_TSF_SEL_8814B(v)) -+ -+#define BIT_SHIFT_PS_TIMER_0_EARLY_TIME_8814B 8 -+#define BIT_MASK_PS_TIMER_0_EARLY_TIME_8814B 0xff -+#define BIT_PS_TIMER_0_EARLY_TIME_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_0_EARLY_TIME_8814B) \ -+ << BIT_SHIFT_PS_TIMER_0_EARLY_TIME_8814B) -+#define BITS_PS_TIMER_0_EARLY_TIME_8814B \ -+ (BIT_MASK_PS_TIMER_0_EARLY_TIME_8814B \ -+ << BIT_SHIFT_PS_TIMER_0_EARLY_TIME_8814B) -+#define BIT_CLEAR_PS_TIMER_0_EARLY_TIME_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_0_EARLY_TIME_8814B)) -+#define BIT_GET_PS_TIMER_0_EARLY_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_0_EARLY_TIME_8814B) & \ -+ BIT_MASK_PS_TIMER_0_EARLY_TIME_8814B) -+#define BIT_SET_PS_TIMER_0_EARLY_TIME_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_0_EARLY_TIME_8814B(x) | \ -+ BIT_PS_TIMER_0_EARLY_TIME_8814B(v)) -+ -+#define BIT_PS_TIMER_0_EN_8814B BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_0_TSF_SEL_8814B 0 -+#define BIT_MASK_PS_TIMER_0_TSF_SEL_8814B 0x7 -+#define BIT_PS_TIMER_0_TSF_SEL_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_0_TSF_SEL_8814B) \ -+ << BIT_SHIFT_PS_TIMER_0_TSF_SEL_8814B) -+#define BITS_PS_TIMER_0_TSF_SEL_8814B \ -+ (BIT_MASK_PS_TIMER_0_TSF_SEL_8814B \ -+ << BIT_SHIFT_PS_TIMER_0_TSF_SEL_8814B) -+#define BIT_CLEAR_PS_TIMER_0_TSF_SEL_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_0_TSF_SEL_8814B)) -+#define BIT_GET_PS_TIMER_0_TSF_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_0_TSF_SEL_8814B) & \ -+ BIT_MASK_PS_TIMER_0_TSF_SEL_8814B) -+#define BIT_SET_PS_TIMER_0_TSF_SEL_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_0_TSF_SEL_8814B(x) | \ -+ BIT_PS_TIMER_0_TSF_SEL_8814B(v)) -+ -+/* 2 REG_PS_TIMER_23_CTRL_8814B */ -+ -+#define BIT_SHIFT_PS_TIMER_3_EARLY_TIME_8814B 24 -+#define BIT_MASK_PS_TIMER_3_EARLY_TIME_8814B 0xff -+#define BIT_PS_TIMER_3_EARLY_TIME_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_3_EARLY_TIME_8814B) \ -+ << BIT_SHIFT_PS_TIMER_3_EARLY_TIME_8814B) -+#define BITS_PS_TIMER_3_EARLY_TIME_8814B \ -+ (BIT_MASK_PS_TIMER_3_EARLY_TIME_8814B \ -+ << BIT_SHIFT_PS_TIMER_3_EARLY_TIME_8814B) -+#define BIT_CLEAR_PS_TIMER_3_EARLY_TIME_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_3_EARLY_TIME_8814B)) -+#define BIT_GET_PS_TIMER_3_EARLY_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_3_EARLY_TIME_8814B) & \ -+ BIT_MASK_PS_TIMER_3_EARLY_TIME_8814B) -+#define BIT_SET_PS_TIMER_3_EARLY_TIME_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_3_EARLY_TIME_8814B(x) | \ -+ BIT_PS_TIMER_3_EARLY_TIME_8814B(v)) -+ -+#define BIT_PS_TIMER_3_EN_8814B BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_3_TSF_SEL_8814B 16 -+#define BIT_MASK_PS_TIMER_3_TSF_SEL_8814B 0x7 -+#define BIT_PS_TIMER_3_TSF_SEL_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_3_TSF_SEL_8814B) \ -+ << BIT_SHIFT_PS_TIMER_3_TSF_SEL_8814B) -+#define BITS_PS_TIMER_3_TSF_SEL_8814B \ -+ (BIT_MASK_PS_TIMER_3_TSF_SEL_8814B \ -+ << BIT_SHIFT_PS_TIMER_3_TSF_SEL_8814B) -+#define BIT_CLEAR_PS_TIMER_3_TSF_SEL_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_3_TSF_SEL_8814B)) -+#define BIT_GET_PS_TIMER_3_TSF_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_3_TSF_SEL_8814B) & \ -+ BIT_MASK_PS_TIMER_3_TSF_SEL_8814B) -+#define BIT_SET_PS_TIMER_3_TSF_SEL_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_3_TSF_SEL_8814B(x) | \ -+ BIT_PS_TIMER_3_TSF_SEL_8814B(v)) -+ -+#define BIT_SHIFT_PS_TIMER_2_EARLY_TIME_8814B 8 -+#define BIT_MASK_PS_TIMER_2_EARLY_TIME_8814B 0xff -+#define BIT_PS_TIMER_2_EARLY_TIME_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_2_EARLY_TIME_8814B) \ -+ << BIT_SHIFT_PS_TIMER_2_EARLY_TIME_8814B) -+#define BITS_PS_TIMER_2_EARLY_TIME_8814B \ -+ (BIT_MASK_PS_TIMER_2_EARLY_TIME_8814B \ -+ << BIT_SHIFT_PS_TIMER_2_EARLY_TIME_8814B) -+#define BIT_CLEAR_PS_TIMER_2_EARLY_TIME_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_2_EARLY_TIME_8814B)) -+#define BIT_GET_PS_TIMER_2_EARLY_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_2_EARLY_TIME_8814B) & \ -+ BIT_MASK_PS_TIMER_2_EARLY_TIME_8814B) -+#define BIT_SET_PS_TIMER_2_EARLY_TIME_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_2_EARLY_TIME_8814B(x) | \ -+ BIT_PS_TIMER_2_EARLY_TIME_8814B(v)) -+ -+#define BIT_PS_TIMER_2_EN_8814B BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_2_TSF_SEL_8814B 0 -+#define BIT_MASK_PS_TIMER_2_TSF_SEL_8814B 0x7 -+#define BIT_PS_TIMER_2_TSF_SEL_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_2_TSF_SEL_8814B) \ -+ << BIT_SHIFT_PS_TIMER_2_TSF_SEL_8814B) -+#define BITS_PS_TIMER_2_TSF_SEL_8814B \ -+ (BIT_MASK_PS_TIMER_2_TSF_SEL_8814B \ -+ << BIT_SHIFT_PS_TIMER_2_TSF_SEL_8814B) -+#define BIT_CLEAR_PS_TIMER_2_TSF_SEL_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_2_TSF_SEL_8814B)) -+#define BIT_GET_PS_TIMER_2_TSF_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_2_TSF_SEL_8814B) & \ -+ BIT_MASK_PS_TIMER_2_TSF_SEL_8814B) -+#define BIT_SET_PS_TIMER_2_TSF_SEL_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_2_TSF_SEL_8814B(x) | \ -+ BIT_PS_TIMER_2_TSF_SEL_8814B(v)) -+ -+/* 2 REG_PS_TIMER_45_CTRL_8814B */ -+ -+#define BIT_SHIFT_PS_TIMER_5_EARLY_TIME_8814B 24 -+#define BIT_MASK_PS_TIMER_5_EARLY_TIME_8814B 0xff -+#define BIT_PS_TIMER_5_EARLY_TIME_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_5_EARLY_TIME_8814B) \ -+ << BIT_SHIFT_PS_TIMER_5_EARLY_TIME_8814B) -+#define BITS_PS_TIMER_5_EARLY_TIME_8814B \ -+ (BIT_MASK_PS_TIMER_5_EARLY_TIME_8814B \ -+ << BIT_SHIFT_PS_TIMER_5_EARLY_TIME_8814B) -+#define BIT_CLEAR_PS_TIMER_5_EARLY_TIME_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_5_EARLY_TIME_8814B)) -+#define BIT_GET_PS_TIMER_5_EARLY_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_5_EARLY_TIME_8814B) & \ -+ BIT_MASK_PS_TIMER_5_EARLY_TIME_8814B) -+#define BIT_SET_PS_TIMER_5_EARLY_TIME_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_5_EARLY_TIME_8814B(x) | \ -+ BIT_PS_TIMER_5_EARLY_TIME_8814B(v)) -+ -+#define BIT_PS_TIMER_5_EN_8814B BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_5_TSF_SEL_8814B 16 -+#define BIT_MASK_PS_TIMER_5_TSF_SEL_8814B 0x7 -+#define BIT_PS_TIMER_5_TSF_SEL_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_5_TSF_SEL_8814B) \ -+ << BIT_SHIFT_PS_TIMER_5_TSF_SEL_8814B) -+#define BITS_PS_TIMER_5_TSF_SEL_8814B \ -+ (BIT_MASK_PS_TIMER_5_TSF_SEL_8814B \ -+ << BIT_SHIFT_PS_TIMER_5_TSF_SEL_8814B) -+#define BIT_CLEAR_PS_TIMER_5_TSF_SEL_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_5_TSF_SEL_8814B)) -+#define BIT_GET_PS_TIMER_5_TSF_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_5_TSF_SEL_8814B) & \ -+ BIT_MASK_PS_TIMER_5_TSF_SEL_8814B) -+#define BIT_SET_PS_TIMER_5_TSF_SEL_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_5_TSF_SEL_8814B(x) | \ -+ BIT_PS_TIMER_5_TSF_SEL_8814B(v)) -+ -+#define BIT_SHIFT_PS_TIMER_4_EARLY_TIME_8814B 8 -+#define BIT_MASK_PS_TIMER_4_EARLY_TIME_8814B 0xff -+#define BIT_PS_TIMER_4_EARLY_TIME_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_4_EARLY_TIME_8814B) \ -+ << BIT_SHIFT_PS_TIMER_4_EARLY_TIME_8814B) -+#define BITS_PS_TIMER_4_EARLY_TIME_8814B \ -+ (BIT_MASK_PS_TIMER_4_EARLY_TIME_8814B \ -+ << BIT_SHIFT_PS_TIMER_4_EARLY_TIME_8814B) -+#define BIT_CLEAR_PS_TIMER_4_EARLY_TIME_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_4_EARLY_TIME_8814B)) -+#define BIT_GET_PS_TIMER_4_EARLY_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_4_EARLY_TIME_8814B) & \ -+ BIT_MASK_PS_TIMER_4_EARLY_TIME_8814B) -+#define BIT_SET_PS_TIMER_4_EARLY_TIME_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_4_EARLY_TIME_8814B(x) | \ -+ BIT_PS_TIMER_4_EARLY_TIME_8814B(v)) -+ -+#define BIT_PS_TIMER_4_EN_8814B BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_4_TSF_SEL_8814B 0 -+#define BIT_MASK_PS_TIMER_4_TSF_SEL_8814B 0x7 -+#define BIT_PS_TIMER_4_TSF_SEL_8814B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_4_TSF_SEL_8814B) \ -+ << BIT_SHIFT_PS_TIMER_4_TSF_SEL_8814B) -+#define BITS_PS_TIMER_4_TSF_SEL_8814B \ -+ (BIT_MASK_PS_TIMER_4_TSF_SEL_8814B \ -+ << BIT_SHIFT_PS_TIMER_4_TSF_SEL_8814B) -+#define BIT_CLEAR_PS_TIMER_4_TSF_SEL_8814B(x) \ -+ ((x) & (~BITS_PS_TIMER_4_TSF_SEL_8814B)) -+#define BIT_GET_PS_TIMER_4_TSF_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_4_TSF_SEL_8814B) & \ -+ BIT_MASK_PS_TIMER_4_TSF_SEL_8814B) -+#define BIT_SET_PS_TIMER_4_TSF_SEL_8814B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_4_TSF_SEL_8814B(x) | \ -+ BIT_PS_TIMER_4_TSF_SEL_8814B(v)) -+ -+/* 2 REG_CPUMGQ_FREERUN_TIMER_CTRL_8814B */ -+#define BIT_FREECNT_RST_V1_8814B BIT(23) -+#define BIT_EN_FREECNT_V1_8814B BIT(16) -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_V1_8814B 8 -+#define BIT_MASK_CPUMGQ_TX_TIMER_EARLY_V1_8814B 0xff -+#define BIT_CPUMGQ_TX_TIMER_EARLY_V1_8814B(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_EARLY_V1_8814B) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_V1_8814B) -+#define BITS_CPUMGQ_TX_TIMER_EARLY_V1_8814B \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_EARLY_V1_8814B \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_V1_8814B) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_V1_8814B(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_EARLY_V1_8814B)) -+#define BIT_GET_CPUMGQ_TX_TIMER_EARLY_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_V1_8814B) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_EARLY_V1_8814B) -+#define BIT_SET_CPUMGQ_TX_TIMER_EARLY_V1_8814B(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_V1_8814B(x) | \ -+ BIT_CPUMGQ_TX_TIMER_EARLY_V1_8814B(v)) -+ -+#define BIT_CPUMGQ_TIMER_EN_V1_8814B BIT(7) -+#define BIT_CPUMGQ_DROP_BY_HOLDTIME_8814B BIT(5) -+#define BIT_CPUMGQ_TX_EN_V1_8814B BIT(4) -+ -+#define BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_V1_8814B 0 -+#define BIT_MASK_CPUMGQ_TIMER_TSF_SEL_V1_8814B 0x7 -+#define BIT_CPUMGQ_TIMER_TSF_SEL_V1_8814B(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TIMER_TSF_SEL_V1_8814B) \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_V1_8814B) -+#define BITS_CPUMGQ_TIMER_TSF_SEL_V1_8814B \ -+ (BIT_MASK_CPUMGQ_TIMER_TSF_SEL_V1_8814B \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_V1_8814B) -+#define BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_V1_8814B(x) \ -+ ((x) & (~BITS_CPUMGQ_TIMER_TSF_SEL_V1_8814B)) -+#define BIT_GET_CPUMGQ_TIMER_TSF_SEL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_V1_8814B) & \ -+ BIT_MASK_CPUMGQ_TIMER_TSF_SEL_V1_8814B) -+#define BIT_SET_CPUMGQ_TIMER_TSF_SEL_V1_8814B(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_V1_8814B(x) | \ -+ BIT_CPUMGQ_TIMER_TSF_SEL_V1_8814B(v)) -+ -+/* 2 REG_CPUMGQ_PROHIBIT_8814B */ -+ -+#define BIT_SHIFT_CPUMGQ_HOLD_TIME_8814B 8 -+#define BIT_MASK_CPUMGQ_HOLD_TIME_8814B 0xfff -+#define BIT_CPUMGQ_HOLD_TIME_8814B(x) \ -+ (((x) & BIT_MASK_CPUMGQ_HOLD_TIME_8814B) \ -+ << BIT_SHIFT_CPUMGQ_HOLD_TIME_8814B) -+#define BITS_CPUMGQ_HOLD_TIME_8814B \ -+ (BIT_MASK_CPUMGQ_HOLD_TIME_8814B << BIT_SHIFT_CPUMGQ_HOLD_TIME_8814B) -+#define BIT_CLEAR_CPUMGQ_HOLD_TIME_8814B(x) \ -+ ((x) & (~BITS_CPUMGQ_HOLD_TIME_8814B)) -+#define BIT_GET_CPUMGQ_HOLD_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_HOLD_TIME_8814B) & \ -+ BIT_MASK_CPUMGQ_HOLD_TIME_8814B) -+#define BIT_SET_CPUMGQ_HOLD_TIME_8814B(x, v) \ -+ (BIT_CLEAR_CPUMGQ_HOLD_TIME_8814B(x) | BIT_CPUMGQ_HOLD_TIME_8814B(v)) -+ -+#define BIT_SHIFT_CPUMGQ_PROHIBIT_SETUP_8814B 0 -+#define BIT_MASK_CPUMGQ_PROHIBIT_SETUP_8814B 0xf -+#define BIT_CPUMGQ_PROHIBIT_SETUP_8814B(x) \ -+ (((x) & BIT_MASK_CPUMGQ_PROHIBIT_SETUP_8814B) \ -+ << BIT_SHIFT_CPUMGQ_PROHIBIT_SETUP_8814B) -+#define BITS_CPUMGQ_PROHIBIT_SETUP_8814B \ -+ (BIT_MASK_CPUMGQ_PROHIBIT_SETUP_8814B \ -+ << BIT_SHIFT_CPUMGQ_PROHIBIT_SETUP_8814B) -+#define BIT_CLEAR_CPUMGQ_PROHIBIT_SETUP_8814B(x) \ -+ ((x) & (~BITS_CPUMGQ_PROHIBIT_SETUP_8814B)) -+#define BIT_GET_CPUMGQ_PROHIBIT_SETUP_8814B(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_PROHIBIT_SETUP_8814B) & \ -+ BIT_MASK_CPUMGQ_PROHIBIT_SETUP_8814B) -+#define BIT_SET_CPUMGQ_PROHIBIT_SETUP_8814B(x, v) \ -+ (BIT_CLEAR_CPUMGQ_PROHIBIT_SETUP_8814B(x) | \ -+ BIT_CPUMGQ_PROHIBIT_SETUP_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_TIMER_COMPARE_8814B */ -+#define BIT_COMP_TRIGGER_8814B BIT(7) -+ -+#define BIT_SHIFT_Y_COMP_8814B 4 -+#define BIT_MASK_Y_COMP_8814B 0x7 -+#define BIT_Y_COMP_8814B(x) \ -+ (((x) & BIT_MASK_Y_COMP_8814B) << BIT_SHIFT_Y_COMP_8814B) -+#define BITS_Y_COMP_8814B (BIT_MASK_Y_COMP_8814B << BIT_SHIFT_Y_COMP_8814B) -+#define BIT_CLEAR_Y_COMP_8814B(x) ((x) & (~BITS_Y_COMP_8814B)) -+#define BIT_GET_Y_COMP_8814B(x) \ -+ (((x) >> BIT_SHIFT_Y_COMP_8814B) & BIT_MASK_Y_COMP_8814B) -+#define BIT_SET_Y_COMP_8814B(x, v) \ -+ (BIT_CLEAR_Y_COMP_8814B(x) | BIT_Y_COMP_8814B(v)) -+ -+#define BIT_X_COMP_Y_OVERFLOW_8814B BIT(3) -+ -+#define BIT_SHIFT_X_COMP_8814B 0 -+#define BIT_MASK_X_COMP_8814B 0x7 -+#define BIT_X_COMP_8814B(x) \ -+ (((x) & BIT_MASK_X_COMP_8814B) << BIT_SHIFT_X_COMP_8814B) -+#define BITS_X_COMP_8814B (BIT_MASK_X_COMP_8814B << BIT_SHIFT_X_COMP_8814B) -+#define BIT_CLEAR_X_COMP_8814B(x) ((x) & (~BITS_X_COMP_8814B)) -+#define BIT_GET_X_COMP_8814B(x) \ -+ (((x) >> BIT_SHIFT_X_COMP_8814B) & BIT_MASK_X_COMP_8814B) -+#define BIT_SET_X_COMP_8814B(x, v) \ -+ (BIT_CLEAR_X_COMP_8814B(x) | BIT_X_COMP_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_TIMER_COMPARE_VALUE_LOW_8814B */ -+ -+#define BIT_SHIFT_COMP_VALUE_LOW_8814B 0 -+#define BIT_MASK_COMP_VALUE_LOW_8814B 0xffffffffL -+#define BIT_COMP_VALUE_LOW_8814B(x) \ -+ (((x) & BIT_MASK_COMP_VALUE_LOW_8814B) \ -+ << BIT_SHIFT_COMP_VALUE_LOW_8814B) -+#define BITS_COMP_VALUE_LOW_8814B \ -+ (BIT_MASK_COMP_VALUE_LOW_8814B << BIT_SHIFT_COMP_VALUE_LOW_8814B) -+#define BIT_CLEAR_COMP_VALUE_LOW_8814B(x) ((x) & (~BITS_COMP_VALUE_LOW_8814B)) -+#define BIT_GET_COMP_VALUE_LOW_8814B(x) \ -+ (((x) >> BIT_SHIFT_COMP_VALUE_LOW_8814B) & \ -+ BIT_MASK_COMP_VALUE_LOW_8814B) -+#define BIT_SET_COMP_VALUE_LOW_8814B(x, v) \ -+ (BIT_CLEAR_COMP_VALUE_LOW_8814B(x) | BIT_COMP_VALUE_LOW_8814B(v)) -+ -+/* 2 REG_TIMER_COMPARE_VALUE_HIGH_8814B */ -+ -+#define BIT_SHIFT_COMP_VALUE_HIGH_8814B 0 -+#define BIT_MASK_COMP_VALUE_HIGH_8814B 0xffffffffL -+#define BIT_COMP_VALUE_HIGH_8814B(x) \ -+ (((x) & BIT_MASK_COMP_VALUE_HIGH_8814B) \ -+ << BIT_SHIFT_COMP_VALUE_HIGH_8814B) -+#define BITS_COMP_VALUE_HIGH_8814B \ -+ (BIT_MASK_COMP_VALUE_HIGH_8814B << BIT_SHIFT_COMP_VALUE_HIGH_8814B) -+#define BIT_CLEAR_COMP_VALUE_HIGH_8814B(x) ((x) & (~BITS_COMP_VALUE_HIGH_8814B)) -+#define BIT_GET_COMP_VALUE_HIGH_8814B(x) \ -+ (((x) >> BIT_SHIFT_COMP_VALUE_HIGH_8814B) & \ -+ BIT_MASK_COMP_VALUE_HIGH_8814B) -+#define BIT_SET_COMP_VALUE_HIGH_8814B(x, v) \ -+ (BIT_CLEAR_COMP_VALUE_HIGH_8814B(x) | BIT_COMP_VALUE_HIGH_8814B(v)) -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_SCHEDULER_COUNTER_8814B */ -+ -+#define BIT_SHIFT__SCHEDULER_COUNTER_8814B 16 -+#define BIT_MASK__SCHEDULER_COUNTER_8814B 0xffff -+#define BIT__SCHEDULER_COUNTER_8814B(x) \ -+ (((x) & BIT_MASK__SCHEDULER_COUNTER_8814B) \ -+ << BIT_SHIFT__SCHEDULER_COUNTER_8814B) -+#define BITS__SCHEDULER_COUNTER_8814B \ -+ (BIT_MASK__SCHEDULER_COUNTER_8814B \ -+ << BIT_SHIFT__SCHEDULER_COUNTER_8814B) -+#define BIT_CLEAR__SCHEDULER_COUNTER_8814B(x) \ -+ ((x) & (~BITS__SCHEDULER_COUNTER_8814B)) -+#define BIT_GET__SCHEDULER_COUNTER_8814B(x) \ -+ (((x) >> BIT_SHIFT__SCHEDULER_COUNTER_8814B) & \ -+ BIT_MASK__SCHEDULER_COUNTER_8814B) -+#define BIT_SET__SCHEDULER_COUNTER_8814B(x, v) \ -+ (BIT_CLEAR__SCHEDULER_COUNTER_8814B(x) | \ -+ BIT__SCHEDULER_COUNTER_8814B(v)) -+ -+#define BIT__SCHEDULER_COUNTER_RST_8814B BIT(8) -+ -+#define BIT_SHIFT_SCHEDULER_COUNTER_SEL_8814B 0 -+#define BIT_MASK_SCHEDULER_COUNTER_SEL_8814B 0xff -+#define BIT_SCHEDULER_COUNTER_SEL_8814B(x) \ -+ (((x) & BIT_MASK_SCHEDULER_COUNTER_SEL_8814B) \ -+ << BIT_SHIFT_SCHEDULER_COUNTER_SEL_8814B) -+#define BITS_SCHEDULER_COUNTER_SEL_8814B \ -+ (BIT_MASK_SCHEDULER_COUNTER_SEL_8814B \ -+ << BIT_SHIFT_SCHEDULER_COUNTER_SEL_8814B) -+#define BIT_CLEAR_SCHEDULER_COUNTER_SEL_8814B(x) \ -+ ((x) & (~BITS_SCHEDULER_COUNTER_SEL_8814B)) -+#define BIT_GET_SCHEDULER_COUNTER_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_SCHEDULER_COUNTER_SEL_8814B) & \ -+ BIT_MASK_SCHEDULER_COUNTER_SEL_8814B) -+#define BIT_SET_SCHEDULER_COUNTER_SEL_8814B(x, v) \ -+ (BIT_CLEAR_SCHEDULER_COUNTER_SEL_8814B(x) | \ -+ BIT_SCHEDULER_COUNTER_SEL_8814B(v)) -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_WMAC_CR_8814B (WMAC CR AND APSD CONTROL REGISTER) */ -+#define BIT_IC_MACPHY_M_8814B BIT(0) -+ -+/* 2 REG_WMAC_FWPKT_CR_8814B */ -+#define BIT_FWEN_8814B BIT(7) -+#define BIT_PHYSTS_PKT_CTRL_8814B BIT(6) -+#define BIT_FWFULL_TO_RXFF_EN_8814B BIT(5) -+#define BIT_APPHDR_MIDSRCH_FAIL_8814B BIT(4) -+#define BIT_FWPARSING_EN_8814B BIT(3) -+ -+#define BIT_SHIFT_APPEND_MHDR_LEN_8814B 0 -+#define BIT_MASK_APPEND_MHDR_LEN_8814B 0x7 -+#define BIT_APPEND_MHDR_LEN_8814B(x) \ -+ (((x) & BIT_MASK_APPEND_MHDR_LEN_8814B) \ -+ << BIT_SHIFT_APPEND_MHDR_LEN_8814B) -+#define BITS_APPEND_MHDR_LEN_8814B \ -+ (BIT_MASK_APPEND_MHDR_LEN_8814B << BIT_SHIFT_APPEND_MHDR_LEN_8814B) -+#define BIT_CLEAR_APPEND_MHDR_LEN_8814B(x) ((x) & (~BITS_APPEND_MHDR_LEN_8814B)) -+#define BIT_GET_APPEND_MHDR_LEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_APPEND_MHDR_LEN_8814B) & \ -+ BIT_MASK_APPEND_MHDR_LEN_8814B) -+#define BIT_SET_APPEND_MHDR_LEN_8814B(x, v) \ -+ (BIT_CLEAR_APPEND_MHDR_LEN_8814B(x) | BIT_APPEND_MHDR_LEN_8814B(v)) -+ -+/* 2 REG_FW_STS_FILTER_8814B */ -+#define BIT_DATA_FW_STS_FILTER_8814B BIT(2) -+#define BIT_CTRL_FW_STS_FILTER_8814B BIT(1) -+#define BIT_MGNT_FW_STS_FILTER_8814B BIT(0) -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_TCR_8814B (TRANSMISSION CONFIGURATION REGISTER) */ -+#define BIT_WMAC_EN_RTS_ADDR_8814B BIT(31) -+#define BIT_WMAC_DISABLE_CCK_8814B BIT(30) -+#define BIT_WMAC_RAW_LEN_8814B BIT(29) -+#define BIT_WMAC_NOTX_IN_RXNDP_8814B BIT(28) -+#define BIT_WMAC_EN_EOF_8814B BIT(27) -+#define BIT_WMAC_BF_SEL_8814B BIT(26) -+#define BIT_WMAC_TCRPWRMGT_HWCTL_EN_8814B BIT(24) -+#define BIT_WMAC_SMOOTH_VAL_8814B BIT(23) -+#define BIT_WMAC_EN_SCRAM_INC_8814B BIT(22) -+#define BIT_UNDERFLOWEN_CMPLEN_SEL_8814B BIT(21) -+#define BIT_FETCH_MPDU_AFTER_WSEC_RDY_8814B BIT(20) -+#define BIT_WMAC_TCR_EN_20MST_8814B BIT(19) -+#define BIT_WMAC_DIS_SIGTA_8814B BIT(18) -+#define BIT_WMAC_DIS_A2B0_8814B BIT(17) -+#define BIT_WMAC_MSK_SIGBCRC_8814B BIT(16) -+#define BIT_WMAC_TCR_ERRSTEN_3_8814B BIT(15) -+#define BIT_WMAC_TCR_ERRSTEN_2_8814B BIT(14) -+#define BIT_WMAC_TCR_ERRSTEN_1_8814B BIT(13) -+#define BIT_WMAC_TCR_ERRSTEN_0_8814B BIT(12) -+#define BIT_WMAC_TCR_TXSK_PERPKT_8814B BIT(11) -+#define BIT_ICV_8814B BIT(10) -+#define BIT_CRC_8814B BIT(8) -+#define BIT_WMAC_TCRPWRMGT_HWDATA_EN_8814B BIT(7) -+#define BIT_PWR_ST_8814B BIT(6) -+#define BIT_WMAC_TCR_UPD_TIMIE_8814B BIT(5) -+#define BIT_WMAC_TCR_UPD_HGQMD_8814B BIT(4) -+#define BIT_VHTSIGA1_TXPS_8814B BIT(3) -+#define BIT_PAD_SEL_8814B BIT(2) -+#define BIT_DIS_GCLK_8814B BIT(1) -+#define BIT_WMAC_TCRPWRMGT_HWACT_EN_8814B BIT(0) -+ -+/* 2 REG_RCR_8814B (RECEIVE CONFIGURATION REGISTER) */ -+#define BIT_APP_FCS_8814B BIT(31) -+#define BIT_APP_MIC_8814B BIT(30) -+#define BIT_APP_ICV_8814B BIT(29) -+#define BIT_APP_PHYSTS_8814B BIT(28) -+#define BIT_APP_BASSN_8814B BIT(27) -+#define BIT_VHT_DACK_8814B BIT(26) -+#define BIT_TCPOFLD_EN_8814B BIT(25) -+#define BIT_ENADDRCAM_8814B BIT(24) -+#define BIT_LSIGEN_8814B BIT(23) -+#define BIT_MFBEN_8814B BIT(22) -+#define BIT_DISCHKPPDLLEN_8814B BIT(21) -+#define BIT_PKTCTL_DLEN_8814B BIT(20) -+#define BIT_DISGCLK_8814B BIT(19) -+#define BIT_TIM_PARSER_EN_8814B BIT(18) -+#define BIT_BC_MD_EN_8814B BIT(17) -+#define BIT_UC_MD_EN_8814B BIT(16) -+#define BIT_RXSK_PERPKT_8814B BIT(15) -+#define BIT_HTC_LOC_CTRL_8814B BIT(14) -+#define BIT_ACK_WITH_CBSSID_DATA_OPTION_8814B BIT(13) -+#define BIT_RPFM_CAM_ENABLE_8814B BIT(12) -+#define BIT_TA_BCN_8814B BIT(11) -+#define BIT_DISDECMYPKT_8814B BIT(10) -+#define BIT_AICV_8814B BIT(9) -+#define BIT_ACRC32_8814B BIT(8) -+#define BIT_CBSSID_BCN_8814B BIT(7) -+#define BIT_CBSSID_DATA_8814B BIT(6) -+#define BIT_APWRMGT_8814B BIT(5) -+#define BIT_ADD3_8814B BIT(4) -+#define BIT_AB_8814B BIT(3) -+#define BIT_AM_8814B BIT(2) -+#define BIT_APM_8814B BIT(1) -+#define BIT_AAP_8814B BIT(0) -+ -+/* 2 REG_RX_PKT_LIMIT_8814B (RX PACKET LENGTH LIMIT REGISTER) */ -+ -+#define BIT_SHIFT_RXPKTLMT_8814B 0 -+#define BIT_MASK_RXPKTLMT_8814B 0x3f -+#define BIT_RXPKTLMT_8814B(x) \ -+ (((x) & BIT_MASK_RXPKTLMT_8814B) << BIT_SHIFT_RXPKTLMT_8814B) -+#define BITS_RXPKTLMT_8814B \ -+ (BIT_MASK_RXPKTLMT_8814B << BIT_SHIFT_RXPKTLMT_8814B) -+#define BIT_CLEAR_RXPKTLMT_8814B(x) ((x) & (~BITS_RXPKTLMT_8814B)) -+#define BIT_GET_RXPKTLMT_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPKTLMT_8814B) & BIT_MASK_RXPKTLMT_8814B) -+#define BIT_SET_RXPKTLMT_8814B(x, v) \ -+ (BIT_CLEAR_RXPKTLMT_8814B(x) | BIT_RXPKTLMT_8814B(v)) -+ -+/* 2 REG_RX_DLK_TIME_8814B (RX DEADLOCK TIME REGISTER) */ -+ -+#define BIT_SHIFT_RX_DLK_TIME_8814B 0 -+#define BIT_MASK_RX_DLK_TIME_8814B 0xff -+#define BIT_RX_DLK_TIME_8814B(x) \ -+ (((x) & BIT_MASK_RX_DLK_TIME_8814B) << BIT_SHIFT_RX_DLK_TIME_8814B) -+#define BITS_RX_DLK_TIME_8814B \ -+ (BIT_MASK_RX_DLK_TIME_8814B << BIT_SHIFT_RX_DLK_TIME_8814B) -+#define BIT_CLEAR_RX_DLK_TIME_8814B(x) ((x) & (~BITS_RX_DLK_TIME_8814B)) -+#define BIT_GET_RX_DLK_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_DLK_TIME_8814B) & BIT_MASK_RX_DLK_TIME_8814B) -+#define BIT_SET_RX_DLK_TIME_8814B(x, v) \ -+ (BIT_CLEAR_RX_DLK_TIME_8814B(x) | BIT_RX_DLK_TIME_8814B(v)) -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RX_DRVINFO_SZ_8814B (RX DRIVER INFO SIZE REGISTER) */ -+#define BIT_PHYSTS_PER_PKT_MODE_8814B BIT(7) -+ -+#define BIT_SHIFT_DRVINFO_SZ_V1_8814B 0 -+#define BIT_MASK_DRVINFO_SZ_V1_8814B 0xf -+#define BIT_DRVINFO_SZ_V1_8814B(x) \ -+ (((x) & BIT_MASK_DRVINFO_SZ_V1_8814B) << BIT_SHIFT_DRVINFO_SZ_V1_8814B) -+#define BITS_DRVINFO_SZ_V1_8814B \ -+ (BIT_MASK_DRVINFO_SZ_V1_8814B << BIT_SHIFT_DRVINFO_SZ_V1_8814B) -+#define BIT_CLEAR_DRVINFO_SZ_V1_8814B(x) ((x) & (~BITS_DRVINFO_SZ_V1_8814B)) -+#define BIT_GET_DRVINFO_SZ_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_DRVINFO_SZ_V1_8814B) & BIT_MASK_DRVINFO_SZ_V1_8814B) -+#define BIT_SET_DRVINFO_SZ_V1_8814B(x, v) \ -+ (BIT_CLEAR_DRVINFO_SZ_V1_8814B(x) | BIT_DRVINFO_SZ_V1_8814B(v)) -+ -+/* 2 REG_MACID_8814B (MAC ID REGISTER) */ -+ -+#define BIT_SHIFT_MACID_V1_8814B 0 -+#define BIT_MASK_MACID_V1_8814B 0xffffffffL -+#define BIT_MACID_V1_8814B(x) \ -+ (((x) & BIT_MASK_MACID_V1_8814B) << BIT_SHIFT_MACID_V1_8814B) -+#define BITS_MACID_V1_8814B \ -+ (BIT_MASK_MACID_V1_8814B << BIT_SHIFT_MACID_V1_8814B) -+#define BIT_CLEAR_MACID_V1_8814B(x) ((x) & (~BITS_MACID_V1_8814B)) -+#define BIT_GET_MACID_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_V1_8814B) & BIT_MASK_MACID_V1_8814B) -+#define BIT_SET_MACID_V1_8814B(x, v) \ -+ (BIT_CLEAR_MACID_V1_8814B(x) | BIT_MACID_V1_8814B(v)) -+ -+/* 2 REG_MACID_H_8814B (MAC ID REGISTER) */ -+ -+#define BIT_SHIFT_MACID_H_V1_8814B 0 -+#define BIT_MASK_MACID_H_V1_8814B 0xffff -+#define BIT_MACID_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_MACID_H_V1_8814B) << BIT_SHIFT_MACID_H_V1_8814B) -+#define BITS_MACID_H_V1_8814B \ -+ (BIT_MASK_MACID_H_V1_8814B << BIT_SHIFT_MACID_H_V1_8814B) -+#define BIT_CLEAR_MACID_H_V1_8814B(x) ((x) & (~BITS_MACID_H_V1_8814B)) -+#define BIT_GET_MACID_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID_H_V1_8814B) & BIT_MASK_MACID_H_V1_8814B) -+#define BIT_SET_MACID_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_MACID_H_V1_8814B(x) | BIT_MACID_H_V1_8814B(v)) -+ -+/* 2 REG_BSSID_8814B (BSSID REGISTER) */ -+ -+#define BIT_SHIFT_BSSID_V1_8814B 0 -+#define BIT_MASK_BSSID_V1_8814B 0xffffffffL -+#define BIT_BSSID_V1_8814B(x) \ -+ (((x) & BIT_MASK_BSSID_V1_8814B) << BIT_SHIFT_BSSID_V1_8814B) -+#define BITS_BSSID_V1_8814B \ -+ (BIT_MASK_BSSID_V1_8814B << BIT_SHIFT_BSSID_V1_8814B) -+#define BIT_CLEAR_BSSID_V1_8814B(x) ((x) & (~BITS_BSSID_V1_8814B)) -+#define BIT_GET_BSSID_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID_V1_8814B) & BIT_MASK_BSSID_V1_8814B) -+#define BIT_SET_BSSID_V1_8814B(x, v) \ -+ (BIT_CLEAR_BSSID_V1_8814B(x) | BIT_BSSID_V1_8814B(v)) -+ -+/* 2 REG_BSSID_H_8814B (BSSID REGISTER) */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+#define BIT_SHIFT_BSSID_H_V1_8814B 0 -+#define BIT_MASK_BSSID_H_V1_8814B 0xffff -+#define BIT_BSSID_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_BSSID_H_V1_8814B) << BIT_SHIFT_BSSID_H_V1_8814B) -+#define BITS_BSSID_H_V1_8814B \ -+ (BIT_MASK_BSSID_H_V1_8814B << BIT_SHIFT_BSSID_H_V1_8814B) -+#define BIT_CLEAR_BSSID_H_V1_8814B(x) ((x) & (~BITS_BSSID_H_V1_8814B)) -+#define BIT_GET_BSSID_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID_H_V1_8814B) & BIT_MASK_BSSID_H_V1_8814B) -+#define BIT_SET_BSSID_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_BSSID_H_V1_8814B(x) | BIT_BSSID_H_V1_8814B(v)) -+ -+/* 2 REG_MAR_8814B (MULTICAST ADDRESS REGISTER) */ -+ -+#define BIT_SHIFT_MAR_V1_8814B 0 -+#define BIT_MASK_MAR_V1_8814B 0xffffffffL -+#define BIT_MAR_V1_8814B(x) \ -+ (((x) & BIT_MASK_MAR_V1_8814B) << BIT_SHIFT_MAR_V1_8814B) -+#define BITS_MAR_V1_8814B (BIT_MASK_MAR_V1_8814B << BIT_SHIFT_MAR_V1_8814B) -+#define BIT_CLEAR_MAR_V1_8814B(x) ((x) & (~BITS_MAR_V1_8814B)) -+#define BIT_GET_MAR_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAR_V1_8814B) & BIT_MASK_MAR_V1_8814B) -+#define BIT_SET_MAR_V1_8814B(x, v) \ -+ (BIT_CLEAR_MAR_V1_8814B(x) | BIT_MAR_V1_8814B(v)) -+ -+/* 2 REG_MAR_H_8814B (MULTICAST ADDRESS REGISTER) */ -+ -+#define BIT_SHIFT_MAR_H_V1_8814B 0 -+#define BIT_MASK_MAR_H_V1_8814B 0xffffffffL -+#define BIT_MAR_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_MAR_H_V1_8814B) << BIT_SHIFT_MAR_H_V1_8814B) -+#define BITS_MAR_H_V1_8814B \ -+ (BIT_MASK_MAR_H_V1_8814B << BIT_SHIFT_MAR_H_V1_8814B) -+#define BIT_CLEAR_MAR_H_V1_8814B(x) ((x) & (~BITS_MAR_H_V1_8814B)) -+#define BIT_GET_MAR_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MAR_H_V1_8814B) & BIT_MASK_MAR_H_V1_8814B) -+#define BIT_SET_MAR_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_MAR_H_V1_8814B(x) | BIT_MAR_H_V1_8814B(v)) -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_WMAC_DEBUG_SEL_8814B */ -+ -+#define BIT_SHIFT_WMAC_ARB_DBG_SEL_8814B 3 -+#define BIT_MASK_WMAC_ARB_DBG_SEL_8814B 0x3 -+#define BIT_WMAC_ARB_DBG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_ARB_DBG_SEL_8814B) \ -+ << BIT_SHIFT_WMAC_ARB_DBG_SEL_8814B) -+#define BITS_WMAC_ARB_DBG_SEL_8814B \ -+ (BIT_MASK_WMAC_ARB_DBG_SEL_8814B << BIT_SHIFT_WMAC_ARB_DBG_SEL_8814B) -+#define BIT_CLEAR_WMAC_ARB_DBG_SEL_8814B(x) \ -+ ((x) & (~BITS_WMAC_ARB_DBG_SEL_8814B)) -+#define BIT_GET_WMAC_ARB_DBG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARB_DBG_SEL_8814B) & \ -+ BIT_MASK_WMAC_ARB_DBG_SEL_8814B) -+#define BIT_SET_WMAC_ARB_DBG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_ARB_DBG_SEL_8814B(x) | BIT_WMAC_ARB_DBG_SEL_8814B(v)) -+ -+#define BIT_WMAC_EXT_DBG_SEL_8814B BIT(2) -+ -+#define BIT_SHIFT_WMAC_MU_DBGSEL_V1_8814B 0 -+#define BIT_MASK_WMAC_MU_DBGSEL_V1_8814B 0x3 -+#define BIT_WMAC_MU_DBGSEL_V1_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_DBGSEL_V1_8814B) \ -+ << BIT_SHIFT_WMAC_MU_DBGSEL_V1_8814B) -+#define BITS_WMAC_MU_DBGSEL_V1_8814B \ -+ (BIT_MASK_WMAC_MU_DBGSEL_V1_8814B << BIT_SHIFT_WMAC_MU_DBGSEL_V1_8814B) -+#define BIT_CLEAR_WMAC_MU_DBGSEL_V1_8814B(x) \ -+ ((x) & (~BITS_WMAC_MU_DBGSEL_V1_8814B)) -+#define BIT_GET_WMAC_MU_DBGSEL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_DBGSEL_V1_8814B) & \ -+ BIT_MASK_WMAC_MU_DBGSEL_V1_8814B) -+#define BIT_SET_WMAC_MU_DBGSEL_V1_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_DBGSEL_V1_8814B(x) | BIT_WMAC_MU_DBGSEL_V1_8814B(v)) -+ -+/* 2 REG_WMAC_TCR_TSFT_OFS_8814B */ -+ -+#define BIT_SHIFT_WMAC_TCR_TSFT_OFS_8814B 0 -+#define BIT_MASK_WMAC_TCR_TSFT_OFS_8814B 0xffff -+#define BIT_WMAC_TCR_TSFT_OFS_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_TCR_TSFT_OFS_8814B) \ -+ << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8814B) -+#define BITS_WMAC_TCR_TSFT_OFS_8814B \ -+ (BIT_MASK_WMAC_TCR_TSFT_OFS_8814B << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8814B) -+#define BIT_CLEAR_WMAC_TCR_TSFT_OFS_8814B(x) \ -+ ((x) & (~BITS_WMAC_TCR_TSFT_OFS_8814B)) -+#define BIT_GET_WMAC_TCR_TSFT_OFS_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TCR_TSFT_OFS_8814B) & \ -+ BIT_MASK_WMAC_TCR_TSFT_OFS_8814B) -+#define BIT_SET_WMAC_TCR_TSFT_OFS_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_TCR_TSFT_OFS_8814B(x) | BIT_WMAC_TCR_TSFT_OFS_8814B(v)) -+ -+/* 2 REG_UDF_THSD_8814B */ -+#define BIT_UDF_THSD_V1_8814B BIT(7) -+ -+#define BIT_SHIFT_UDF_THSD_VALUE_8814B 0 -+#define BIT_MASK_UDF_THSD_VALUE_8814B 0x7f -+#define BIT_UDF_THSD_VALUE_8814B(x) \ -+ (((x) & BIT_MASK_UDF_THSD_VALUE_8814B) \ -+ << BIT_SHIFT_UDF_THSD_VALUE_8814B) -+#define BITS_UDF_THSD_VALUE_8814B \ -+ (BIT_MASK_UDF_THSD_VALUE_8814B << BIT_SHIFT_UDF_THSD_VALUE_8814B) -+#define BIT_CLEAR_UDF_THSD_VALUE_8814B(x) ((x) & (~BITS_UDF_THSD_VALUE_8814B)) -+#define BIT_GET_UDF_THSD_VALUE_8814B(x) \ -+ (((x) >> BIT_SHIFT_UDF_THSD_VALUE_8814B) & \ -+ BIT_MASK_UDF_THSD_VALUE_8814B) -+#define BIT_SET_UDF_THSD_VALUE_8814B(x, v) \ -+ (BIT_CLEAR_UDF_THSD_VALUE_8814B(x) | BIT_UDF_THSD_VALUE_8814B(v)) -+ -+/* 2 REG_ZLD_NUM_8814B */ -+ -+#define BIT_SHIFT_ZLD_NUM_8814B 0 -+#define BIT_MASK_ZLD_NUM_8814B 0xff -+#define BIT_ZLD_NUM_8814B(x) \ -+ (((x) & BIT_MASK_ZLD_NUM_8814B) << BIT_SHIFT_ZLD_NUM_8814B) -+#define BITS_ZLD_NUM_8814B (BIT_MASK_ZLD_NUM_8814B << BIT_SHIFT_ZLD_NUM_8814B) -+#define BIT_CLEAR_ZLD_NUM_8814B(x) ((x) & (~BITS_ZLD_NUM_8814B)) -+#define BIT_GET_ZLD_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_ZLD_NUM_8814B) & BIT_MASK_ZLD_NUM_8814B) -+#define BIT_SET_ZLD_NUM_8814B(x, v) \ -+ (BIT_CLEAR_ZLD_NUM_8814B(x) | BIT_ZLD_NUM_8814B(v)) -+ -+/* 2 REG_STMP_THSD_8814B */ -+ -+#define BIT_SHIFT_STMP_THSD_8814B 0 -+#define BIT_MASK_STMP_THSD_8814B 0xff -+#define BIT_STMP_THSD_8814B(x) \ -+ (((x) & BIT_MASK_STMP_THSD_8814B) << BIT_SHIFT_STMP_THSD_8814B) -+#define BITS_STMP_THSD_8814B \ -+ (BIT_MASK_STMP_THSD_8814B << BIT_SHIFT_STMP_THSD_8814B) -+#define BIT_CLEAR_STMP_THSD_8814B(x) ((x) & (~BITS_STMP_THSD_8814B)) -+#define BIT_GET_STMP_THSD_8814B(x) \ -+ (((x) >> BIT_SHIFT_STMP_THSD_8814B) & BIT_MASK_STMP_THSD_8814B) -+#define BIT_SET_STMP_THSD_8814B(x, v) \ -+ (BIT_CLEAR_STMP_THSD_8814B(x) | BIT_STMP_THSD_8814B(v)) -+ -+/* 2 REG_WMAC_TXTIMEOUT_8814B */ -+ -+#define BIT_SHIFT_WMAC_TXTIMEOUT_8814B 0 -+#define BIT_MASK_WMAC_TXTIMEOUT_8814B 0xff -+#define BIT_WMAC_TXTIMEOUT_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_TXTIMEOUT_8814B) \ -+ << BIT_SHIFT_WMAC_TXTIMEOUT_8814B) -+#define BITS_WMAC_TXTIMEOUT_8814B \ -+ (BIT_MASK_WMAC_TXTIMEOUT_8814B << BIT_SHIFT_WMAC_TXTIMEOUT_8814B) -+#define BIT_CLEAR_WMAC_TXTIMEOUT_8814B(x) ((x) & (~BITS_WMAC_TXTIMEOUT_8814B)) -+#define BIT_GET_WMAC_TXTIMEOUT_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXTIMEOUT_8814B) & \ -+ BIT_MASK_WMAC_TXTIMEOUT_8814B) -+#define BIT_SET_WMAC_TXTIMEOUT_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_TXTIMEOUT_8814B(x) | BIT_WMAC_TXTIMEOUT_8814B(v)) -+ -+/* 2 REG_MCU_TEST_2_V1_8814B */ -+ -+#define BIT_SHIFT_MCU_RSVD_2_V1_8814B 0 -+#define BIT_MASK_MCU_RSVD_2_V1_8814B 0xffff -+#define BIT_MCU_RSVD_2_V1_8814B(x) \ -+ (((x) & BIT_MASK_MCU_RSVD_2_V1_8814B) << BIT_SHIFT_MCU_RSVD_2_V1_8814B) -+#define BITS_MCU_RSVD_2_V1_8814B \ -+ (BIT_MASK_MCU_RSVD_2_V1_8814B << BIT_SHIFT_MCU_RSVD_2_V1_8814B) -+#define BIT_CLEAR_MCU_RSVD_2_V1_8814B(x) ((x) & (~BITS_MCU_RSVD_2_V1_8814B)) -+#define BIT_GET_MCU_RSVD_2_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MCU_RSVD_2_V1_8814B) & BIT_MASK_MCU_RSVD_2_V1_8814B) -+#define BIT_SET_MCU_RSVD_2_V1_8814B(x, v) \ -+ (BIT_CLEAR_MCU_RSVD_2_V1_8814B(x) | BIT_MCU_RSVD_2_V1_8814B(v)) -+ -+/* 2 REG_USTIME_EDCA_8814B (US TIME TUNING FOR EDCA REGISTER) */ -+ -+#define BIT_SHIFT_USTIME_EDCA_8814B 0 -+#define BIT_MASK_USTIME_EDCA_8814B 0xff -+#define BIT_USTIME_EDCA_8814B(x) \ -+ (((x) & BIT_MASK_USTIME_EDCA_8814B) << BIT_SHIFT_USTIME_EDCA_8814B) -+#define BITS_USTIME_EDCA_8814B \ -+ (BIT_MASK_USTIME_EDCA_8814B << BIT_SHIFT_USTIME_EDCA_8814B) -+#define BIT_CLEAR_USTIME_EDCA_8814B(x) ((x) & (~BITS_USTIME_EDCA_8814B)) -+#define BIT_GET_USTIME_EDCA_8814B(x) \ -+ (((x) >> BIT_SHIFT_USTIME_EDCA_8814B) & BIT_MASK_USTIME_EDCA_8814B) -+#define BIT_SET_USTIME_EDCA_8814B(x, v) \ -+ (BIT_CLEAR_USTIME_EDCA_8814B(x) | BIT_USTIME_EDCA_8814B(v)) -+ -+/* 2 REG_ACKTO_CCK_8814B (ACK TIMEOUT REGISTER FOR CCK RATE) */ -+ -+#define BIT_SHIFT_ACKTO_CCK_8814B 0 -+#define BIT_MASK_ACKTO_CCK_8814B 0xff -+#define BIT_ACKTO_CCK_8814B(x) \ -+ (((x) & BIT_MASK_ACKTO_CCK_8814B) << BIT_SHIFT_ACKTO_CCK_8814B) -+#define BITS_ACKTO_CCK_8814B \ -+ (BIT_MASK_ACKTO_CCK_8814B << BIT_SHIFT_ACKTO_CCK_8814B) -+#define BIT_CLEAR_ACKTO_CCK_8814B(x) ((x) & (~BITS_ACKTO_CCK_8814B)) -+#define BIT_GET_ACKTO_CCK_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACKTO_CCK_8814B) & BIT_MASK_ACKTO_CCK_8814B) -+#define BIT_SET_ACKTO_CCK_8814B(x, v) \ -+ (BIT_CLEAR_ACKTO_CCK_8814B(x) | BIT_ACKTO_CCK_8814B(v)) -+ -+/* 2 REG_MAC_SPEC_SIFS_8814B (SPECIFICATION SIFS REGISTER) */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_8814B 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_8814B 0xff -+#define BIT_SPEC_SIFS_OFDM_8814B(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_8814B) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_8814B) -+#define BITS_SPEC_SIFS_OFDM_8814B \ -+ (BIT_MASK_SPEC_SIFS_OFDM_8814B << BIT_SHIFT_SPEC_SIFS_OFDM_8814B) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_8814B(x) ((x) & (~BITS_SPEC_SIFS_OFDM_8814B)) -+#define BIT_GET_SPEC_SIFS_OFDM_8814B(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_8814B) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_8814B) -+#define BIT_SET_SPEC_SIFS_OFDM_8814B(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_8814B(x) | BIT_SPEC_SIFS_OFDM_8814B(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_8814B 0 -+#define BIT_MASK_SPEC_SIFS_CCK_8814B 0xff -+#define BIT_SPEC_SIFS_CCK_8814B(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_8814B) << BIT_SHIFT_SPEC_SIFS_CCK_8814B) -+#define BITS_SPEC_SIFS_CCK_8814B \ -+ (BIT_MASK_SPEC_SIFS_CCK_8814B << BIT_SHIFT_SPEC_SIFS_CCK_8814B) -+#define BIT_CLEAR_SPEC_SIFS_CCK_8814B(x) ((x) & (~BITS_SPEC_SIFS_CCK_8814B)) -+#define BIT_GET_SPEC_SIFS_CCK_8814B(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_8814B) & BIT_MASK_SPEC_SIFS_CCK_8814B) -+#define BIT_SET_SPEC_SIFS_CCK_8814B(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_8814B(x) | BIT_SPEC_SIFS_CCK_8814B(v)) -+ -+/* 2 REG_RESP_SIFS_CCK_8814B (RESPONSE SIFS FOR CCK REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_CCK_8814B 8 -+#define BIT_MASK_SIFS_R2T_CCK_8814B 0xff -+#define BIT_SIFS_R2T_CCK_8814B(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_CCK_8814B) << BIT_SHIFT_SIFS_R2T_CCK_8814B) -+#define BITS_SIFS_R2T_CCK_8814B \ -+ (BIT_MASK_SIFS_R2T_CCK_8814B << BIT_SHIFT_SIFS_R2T_CCK_8814B) -+#define BIT_CLEAR_SIFS_R2T_CCK_8814B(x) ((x) & (~BITS_SIFS_R2T_CCK_8814B)) -+#define BIT_GET_SIFS_R2T_CCK_8814B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_CCK_8814B) & BIT_MASK_SIFS_R2T_CCK_8814B) -+#define BIT_SET_SIFS_R2T_CCK_8814B(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_CCK_8814B(x) | BIT_SIFS_R2T_CCK_8814B(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_CCK_8814B 0 -+#define BIT_MASK_SIFS_T2T_CCK_8814B 0xff -+#define BIT_SIFS_T2T_CCK_8814B(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_CCK_8814B) << BIT_SHIFT_SIFS_T2T_CCK_8814B) -+#define BITS_SIFS_T2T_CCK_8814B \ -+ (BIT_MASK_SIFS_T2T_CCK_8814B << BIT_SHIFT_SIFS_T2T_CCK_8814B) -+#define BIT_CLEAR_SIFS_T2T_CCK_8814B(x) ((x) & (~BITS_SIFS_T2T_CCK_8814B)) -+#define BIT_GET_SIFS_T2T_CCK_8814B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_CCK_8814B) & BIT_MASK_SIFS_T2T_CCK_8814B) -+#define BIT_SET_SIFS_T2T_CCK_8814B(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_CCK_8814B(x) | BIT_SIFS_T2T_CCK_8814B(v)) -+ -+/* 2 REG_RESP_SIFS_OFDM_8814B (RESPONSE SIFS FOR OFDM REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_OFDM_8814B 8 -+#define BIT_MASK_SIFS_R2T_OFDM_8814B 0xff -+#define BIT_SIFS_R2T_OFDM_8814B(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_OFDM_8814B) << BIT_SHIFT_SIFS_R2T_OFDM_8814B) -+#define BITS_SIFS_R2T_OFDM_8814B \ -+ (BIT_MASK_SIFS_R2T_OFDM_8814B << BIT_SHIFT_SIFS_R2T_OFDM_8814B) -+#define BIT_CLEAR_SIFS_R2T_OFDM_8814B(x) ((x) & (~BITS_SIFS_R2T_OFDM_8814B)) -+#define BIT_GET_SIFS_R2T_OFDM_8814B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_OFDM_8814B) & BIT_MASK_SIFS_R2T_OFDM_8814B) -+#define BIT_SET_SIFS_R2T_OFDM_8814B(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_OFDM_8814B(x) | BIT_SIFS_R2T_OFDM_8814B(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_OFDM_8814B 0 -+#define BIT_MASK_SIFS_T2T_OFDM_8814B 0xff -+#define BIT_SIFS_T2T_OFDM_8814B(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_OFDM_8814B) << BIT_SHIFT_SIFS_T2T_OFDM_8814B) -+#define BITS_SIFS_T2T_OFDM_8814B \ -+ (BIT_MASK_SIFS_T2T_OFDM_8814B << BIT_SHIFT_SIFS_T2T_OFDM_8814B) -+#define BIT_CLEAR_SIFS_T2T_OFDM_8814B(x) ((x) & (~BITS_SIFS_T2T_OFDM_8814B)) -+#define BIT_GET_SIFS_T2T_OFDM_8814B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_OFDM_8814B) & BIT_MASK_SIFS_T2T_OFDM_8814B) -+#define BIT_SET_SIFS_T2T_OFDM_8814B(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_OFDM_8814B(x) | BIT_SIFS_T2T_OFDM_8814B(v)) -+ -+/* 2 REG_ACKTO_8814B (ACK TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_ACKTO_8814B 0 -+#define BIT_MASK_ACKTO_8814B 0xff -+#define BIT_ACKTO_8814B(x) \ -+ (((x) & BIT_MASK_ACKTO_8814B) << BIT_SHIFT_ACKTO_8814B) -+#define BITS_ACKTO_8814B (BIT_MASK_ACKTO_8814B << BIT_SHIFT_ACKTO_8814B) -+#define BIT_CLEAR_ACKTO_8814B(x) ((x) & (~BITS_ACKTO_8814B)) -+#define BIT_GET_ACKTO_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACKTO_8814B) & BIT_MASK_ACKTO_8814B) -+#define BIT_SET_ACKTO_8814B(x, v) \ -+ (BIT_CLEAR_ACKTO_8814B(x) | BIT_ACKTO_8814B(v)) -+ -+/* 2 REG_CTS2TO_8814B (CTS2 TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_CTS2TO_8814B 0 -+#define BIT_MASK_CTS2TO_8814B 0xff -+#define BIT_CTS2TO_8814B(x) \ -+ (((x) & BIT_MASK_CTS2TO_8814B) << BIT_SHIFT_CTS2TO_8814B) -+#define BITS_CTS2TO_8814B (BIT_MASK_CTS2TO_8814B << BIT_SHIFT_CTS2TO_8814B) -+#define BIT_CLEAR_CTS2TO_8814B(x) ((x) & (~BITS_CTS2TO_8814B)) -+#define BIT_GET_CTS2TO_8814B(x) \ -+ (((x) >> BIT_SHIFT_CTS2TO_8814B) & BIT_MASK_CTS2TO_8814B) -+#define BIT_SET_CTS2TO_8814B(x, v) \ -+ (BIT_CLEAR_CTS2TO_8814B(x) | BIT_CTS2TO_8814B(v)) -+ -+/* 2 REG_EIFS_8814B (EIFS REGISTER) */ -+ -+#define BIT_SHIFT_EIFS_8814B 0 -+#define BIT_MASK_EIFS_8814B 0xffff -+#define BIT_EIFS_8814B(x) (((x) & BIT_MASK_EIFS_8814B) << BIT_SHIFT_EIFS_8814B) -+#define BITS_EIFS_8814B (BIT_MASK_EIFS_8814B << BIT_SHIFT_EIFS_8814B) -+#define BIT_CLEAR_EIFS_8814B(x) ((x) & (~BITS_EIFS_8814B)) -+#define BIT_GET_EIFS_8814B(x) \ -+ (((x) >> BIT_SHIFT_EIFS_8814B) & BIT_MASK_EIFS_8814B) -+#define BIT_SET_EIFS_8814B(x, v) (BIT_CLEAR_EIFS_8814B(x) | BIT_EIFS_8814B(v)) -+ -+/* 2 REG_RPFM_MAP0_8814B */ -+#define BIT_MGT_RPFM15EN_8814B BIT(15) -+#define BIT_MGT_RPFM14EN_8814B BIT(14) -+#define BIT_MGT_RPFM13EN_8814B BIT(13) -+#define BIT_MGT_RPFM12EN_8814B BIT(12) -+#define BIT_MGT_RPFM11EN_8814B BIT(11) -+#define BIT_MGT_RPFM10EN_8814B BIT(10) -+#define BIT_MGT_RPFM9EN_8814B BIT(9) -+#define BIT_MGT_RPFM8EN_8814B BIT(8) -+#define BIT_MGT_RPFM7EN_8814B BIT(7) -+#define BIT_MGT_RPFM6EN_8814B BIT(6) -+#define BIT_MGT_RPFM5EN_8814B BIT(5) -+#define BIT_MGT_RPFM4EN_8814B BIT(4) -+#define BIT_MGT_RPFM3EN_8814B BIT(3) -+#define BIT_MGT_RPFM2EN_8814B BIT(2) -+#define BIT_MGT_RPFM1EN_8814B BIT(1) -+#define BIT_MGT_RPFM0EN_8814B BIT(0) -+ -+/* 2 REG_RPFM_MAP1_V1_8814B */ -+#define BIT_DATA_RPFM15EN_8814B BIT(15) -+#define BIT_DATA_RPFM14EN_8814B BIT(14) -+#define BIT_DATA_RPFM13EN_8814B BIT(13) -+#define BIT_DATA_RPFM12EN_8814B BIT(12) -+#define BIT_DATA_RPFM11EN_8814B BIT(11) -+#define BIT_DATA_RPFM10EN_8814B BIT(10) -+#define BIT_DATA_RPFM9EN_8814B BIT(9) -+#define BIT_DATA_RPFM8EN_8814B BIT(8) -+#define BIT_DATA_RPFM7EN_8814B BIT(7) -+#define BIT_DATA_RPFM6EN_8814B BIT(6) -+#define BIT_DATA_RPFM5EN_8814B BIT(5) -+#define BIT_DATA_RPFM4EN_8814B BIT(4) -+#define BIT_DATA_RPFM3EN_8814B BIT(3) -+#define BIT_DATA_RPFM2EN_8814B BIT(2) -+#define BIT_DATA_RPFM1EN_8814B BIT(1) -+#define BIT_DATA_RPFM0EN_8814B BIT(0) -+ -+/* 2 REG_RPFM_CAM_CMD_8814B (RX PAYLOAD FRAME MASK CAM COMMAND REGISTER) */ -+#define BIT_RPFM_CAM_POLLING_8814B BIT(31) -+#define BIT_RPFM_CAM_CLR_8814B BIT(30) -+#define BIT_RPFM_CAM_WE_8814B BIT(16) -+ -+#define BIT_SHIFT_RPFM_CAM_ADDR_8814B 0 -+#define BIT_MASK_RPFM_CAM_ADDR_8814B 0x7f -+#define BIT_RPFM_CAM_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_RPFM_CAM_ADDR_8814B) << BIT_SHIFT_RPFM_CAM_ADDR_8814B) -+#define BITS_RPFM_CAM_ADDR_8814B \ -+ (BIT_MASK_RPFM_CAM_ADDR_8814B << BIT_SHIFT_RPFM_CAM_ADDR_8814B) -+#define BIT_CLEAR_RPFM_CAM_ADDR_8814B(x) ((x) & (~BITS_RPFM_CAM_ADDR_8814B)) -+#define BIT_GET_RPFM_CAM_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RPFM_CAM_ADDR_8814B) & BIT_MASK_RPFM_CAM_ADDR_8814B) -+#define BIT_SET_RPFM_CAM_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_RPFM_CAM_ADDR_8814B(x) | BIT_RPFM_CAM_ADDR_8814B(v)) -+ -+/* 2 REG_RPFM_CAM_RWD_8814B (ACK TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_RPFM_CAM_RWD_8814B 0 -+#define BIT_MASK_RPFM_CAM_RWD_8814B 0xffffffffL -+#define BIT_RPFM_CAM_RWD_8814B(x) \ -+ (((x) & BIT_MASK_RPFM_CAM_RWD_8814B) << BIT_SHIFT_RPFM_CAM_RWD_8814B) -+#define BITS_RPFM_CAM_RWD_8814B \ -+ (BIT_MASK_RPFM_CAM_RWD_8814B << BIT_SHIFT_RPFM_CAM_RWD_8814B) -+#define BIT_CLEAR_RPFM_CAM_RWD_8814B(x) ((x) & (~BITS_RPFM_CAM_RWD_8814B)) -+#define BIT_GET_RPFM_CAM_RWD_8814B(x) \ -+ (((x) >> BIT_SHIFT_RPFM_CAM_RWD_8814B) & BIT_MASK_RPFM_CAM_RWD_8814B) -+#define BIT_SET_RPFM_CAM_RWD_8814B(x, v) \ -+ (BIT_CLEAR_RPFM_CAM_RWD_8814B(x) | BIT_RPFM_CAM_RWD_8814B(v)) -+ -+/* 2 REG_NAV_CTRL_8814B (NAV CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_NAV_UPPER_8814B 16 -+#define BIT_MASK_NAV_UPPER_8814B 0xff -+#define BIT_NAV_UPPER_8814B(x) \ -+ (((x) & BIT_MASK_NAV_UPPER_8814B) << BIT_SHIFT_NAV_UPPER_8814B) -+#define BITS_NAV_UPPER_8814B \ -+ (BIT_MASK_NAV_UPPER_8814B << BIT_SHIFT_NAV_UPPER_8814B) -+#define BIT_CLEAR_NAV_UPPER_8814B(x) ((x) & (~BITS_NAV_UPPER_8814B)) -+#define BIT_GET_NAV_UPPER_8814B(x) \ -+ (((x) >> BIT_SHIFT_NAV_UPPER_8814B) & BIT_MASK_NAV_UPPER_8814B) -+#define BIT_SET_NAV_UPPER_8814B(x, v) \ -+ (BIT_CLEAR_NAV_UPPER_8814B(x) | BIT_NAV_UPPER_8814B(v)) -+ -+#define BIT_SHIFT_RXMYRTS_NAV_8814B 8 -+#define BIT_MASK_RXMYRTS_NAV_8814B 0xf -+#define BIT_RXMYRTS_NAV_8814B(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_8814B) << BIT_SHIFT_RXMYRTS_NAV_8814B) -+#define BITS_RXMYRTS_NAV_8814B \ -+ (BIT_MASK_RXMYRTS_NAV_8814B << BIT_SHIFT_RXMYRTS_NAV_8814B) -+#define BIT_CLEAR_RXMYRTS_NAV_8814B(x) ((x) & (~BITS_RXMYRTS_NAV_8814B)) -+#define BIT_GET_RXMYRTS_NAV_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_8814B) & BIT_MASK_RXMYRTS_NAV_8814B) -+#define BIT_SET_RXMYRTS_NAV_8814B(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_8814B(x) | BIT_RXMYRTS_NAV_8814B(v)) -+ -+#define BIT_SHIFT_RTSRST_8814B 0 -+#define BIT_MASK_RTSRST_8814B 0xff -+#define BIT_RTSRST_8814B(x) \ -+ (((x) & BIT_MASK_RTSRST_8814B) << BIT_SHIFT_RTSRST_8814B) -+#define BITS_RTSRST_8814B (BIT_MASK_RTSRST_8814B << BIT_SHIFT_RTSRST_8814B) -+#define BIT_CLEAR_RTSRST_8814B(x) ((x) & (~BITS_RTSRST_8814B)) -+#define BIT_GET_RTSRST_8814B(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_8814B) & BIT_MASK_RTSRST_8814B) -+#define BIT_SET_RTSRST_8814B(x, v) \ -+ (BIT_CLEAR_RTSRST_8814B(x) | BIT_RTSRST_8814B(v)) -+ -+/* 2 REG_BACAMCMD_8814B (BLOCK ACK CAM COMMAND REGISTER) */ -+#define BIT_BACAM_POLL_8814B BIT(31) -+#define BIT_BACAM_RST_8814B BIT(17) -+#define BIT_BACAM_RW_8814B BIT(16) -+ -+#define BIT_SHIFT_TXSBM_8814B 14 -+#define BIT_MASK_TXSBM_8814B 0x3 -+#define BIT_TXSBM_8814B(x) \ -+ (((x) & BIT_MASK_TXSBM_8814B) << BIT_SHIFT_TXSBM_8814B) -+#define BITS_TXSBM_8814B (BIT_MASK_TXSBM_8814B << BIT_SHIFT_TXSBM_8814B) -+#define BIT_CLEAR_TXSBM_8814B(x) ((x) & (~BITS_TXSBM_8814B)) -+#define BIT_GET_TXSBM_8814B(x) \ -+ (((x) >> BIT_SHIFT_TXSBM_8814B) & BIT_MASK_TXSBM_8814B) -+#define BIT_SET_TXSBM_8814B(x, v) \ -+ (BIT_CLEAR_TXSBM_8814B(x) | BIT_TXSBM_8814B(v)) -+ -+#define BIT_SHIFT_BACAM_ADDR_8814B 0 -+#define BIT_MASK_BACAM_ADDR_8814B 0x3f -+#define BIT_BACAM_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_BACAM_ADDR_8814B) << BIT_SHIFT_BACAM_ADDR_8814B) -+#define BITS_BACAM_ADDR_8814B \ -+ (BIT_MASK_BACAM_ADDR_8814B << BIT_SHIFT_BACAM_ADDR_8814B) -+#define BIT_CLEAR_BACAM_ADDR_8814B(x) ((x) & (~BITS_BACAM_ADDR_8814B)) -+#define BIT_GET_BACAM_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_BACAM_ADDR_8814B) & BIT_MASK_BACAM_ADDR_8814B) -+#define BIT_SET_BACAM_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_BACAM_ADDR_8814B(x) | BIT_BACAM_ADDR_8814B(v)) -+ -+/* 2 REG_BACAMCONTENT_8814B (BLOCK ACK CAM CONTENT REGISTER) */ -+ -+#define BIT_SHIFT_BA_CONTENT_L_8814B 0 -+#define BIT_MASK_BA_CONTENT_L_8814B 0xffffffffL -+#define BIT_BA_CONTENT_L_8814B(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_L_8814B) << BIT_SHIFT_BA_CONTENT_L_8814B) -+#define BITS_BA_CONTENT_L_8814B \ -+ (BIT_MASK_BA_CONTENT_L_8814B << BIT_SHIFT_BA_CONTENT_L_8814B) -+#define BIT_CLEAR_BA_CONTENT_L_8814B(x) ((x) & (~BITS_BA_CONTENT_L_8814B)) -+#define BIT_GET_BA_CONTENT_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_L_8814B) & BIT_MASK_BA_CONTENT_L_8814B) -+#define BIT_SET_BA_CONTENT_L_8814B(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_L_8814B(x) | BIT_BA_CONTENT_L_8814B(v)) -+ -+/* 2 REG_BACAMCONTENT_H_8814B (BLOCK ACK CAM CONTENT REGISTER) */ -+ -+#define BIT_SHIFT_BA_CONTENT_H_8814B 0 -+#define BIT_MASK_BA_CONTENT_H_8814B 0xffffffffL -+#define BIT_BA_CONTENT_H_8814B(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_H_8814B) << BIT_SHIFT_BA_CONTENT_H_8814B) -+#define BITS_BA_CONTENT_H_8814B \ -+ (BIT_MASK_BA_CONTENT_H_8814B << BIT_SHIFT_BA_CONTENT_H_8814B) -+#define BIT_CLEAR_BA_CONTENT_H_8814B(x) ((x) & (~BITS_BA_CONTENT_H_8814B)) -+#define BIT_GET_BA_CONTENT_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_H_8814B) & BIT_MASK_BA_CONTENT_H_8814B) -+#define BIT_SET_BA_CONTENT_H_8814B(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_H_8814B(x) | BIT_BA_CONTENT_H_8814B(v)) -+ -+/* 2 REG_LBDLY_8814B (LOOPBACK DELAY REGISTER) */ -+ -+#define BIT_SHIFT_LBDLY_8814B 0 -+#define BIT_MASK_LBDLY_8814B 0x1f -+#define BIT_LBDLY_8814B(x) \ -+ (((x) & BIT_MASK_LBDLY_8814B) << BIT_SHIFT_LBDLY_8814B) -+#define BITS_LBDLY_8814B (BIT_MASK_LBDLY_8814B << BIT_SHIFT_LBDLY_8814B) -+#define BIT_CLEAR_LBDLY_8814B(x) ((x) & (~BITS_LBDLY_8814B)) -+#define BIT_GET_LBDLY_8814B(x) \ -+ (((x) >> BIT_SHIFT_LBDLY_8814B) & BIT_MASK_LBDLY_8814B) -+#define BIT_SET_LBDLY_8814B(x, v) \ -+ (BIT_CLEAR_LBDLY_8814B(x) | BIT_LBDLY_8814B(v)) -+ -+/* 2 REG_WMAC_BACAM_RPMEN_8814B */ -+ -+#define BIT_SHIFT_BITMAP_SSNBK_COUNTER_8814B 2 -+#define BIT_MASK_BITMAP_SSNBK_COUNTER_8814B 0x3f -+#define BIT_BITMAP_SSNBK_COUNTER_8814B(x) \ -+ (((x) & BIT_MASK_BITMAP_SSNBK_COUNTER_8814B) \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8814B) -+#define BITS_BITMAP_SSNBK_COUNTER_8814B \ -+ (BIT_MASK_BITMAP_SSNBK_COUNTER_8814B \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8814B) -+#define BIT_CLEAR_BITMAP_SSNBK_COUNTER_8814B(x) \ -+ ((x) & (~BITS_BITMAP_SSNBK_COUNTER_8814B)) -+#define BIT_GET_BITMAP_SSNBK_COUNTER_8814B(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_SSNBK_COUNTER_8814B) & \ -+ BIT_MASK_BITMAP_SSNBK_COUNTER_8814B) -+#define BIT_SET_BITMAP_SSNBK_COUNTER_8814B(x, v) \ -+ (BIT_CLEAR_BITMAP_SSNBK_COUNTER_8814B(x) | \ -+ BIT_BITMAP_SSNBK_COUNTER_8814B(v)) -+ -+#define BIT_BITMAP_EN_8814B BIT(1) -+#define BIT_WMAC_BACAM_RPMEN_8814B BIT(0) -+ -+/* 2 REG_TX_RX_8814B STATUS */ -+ -+#define BIT_SHIFT_RXPKT_TYPE_8814B 2 -+#define BIT_MASK_RXPKT_TYPE_8814B 0x3f -+#define BIT_RXPKT_TYPE_8814B(x) \ -+ (((x) & BIT_MASK_RXPKT_TYPE_8814B) << BIT_SHIFT_RXPKT_TYPE_8814B) -+#define BITS_RXPKT_TYPE_8814B \ -+ (BIT_MASK_RXPKT_TYPE_8814B << BIT_SHIFT_RXPKT_TYPE_8814B) -+#define BIT_CLEAR_RXPKT_TYPE_8814B(x) ((x) & (~BITS_RXPKT_TYPE_8814B)) -+#define BIT_GET_RXPKT_TYPE_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_TYPE_8814B) & BIT_MASK_RXPKT_TYPE_8814B) -+#define BIT_SET_RXPKT_TYPE_8814B(x, v) \ -+ (BIT_CLEAR_RXPKT_TYPE_8814B(x) | BIT_RXPKT_TYPE_8814B(v)) -+ -+#define BIT_TXACT_IND_8814B BIT(1) -+#define BIT_RXACT_IND_8814B BIT(0) -+ -+/* 2 REG_WMAC_BITMAP_CTL_8814B */ -+#define BIT_BITMAP_VO_8814B BIT(7) -+#define BIT_BITMAP_VI_8814B BIT(6) -+#define BIT_BITMAP_BE_8814B BIT(5) -+#define BIT_BITMAP_BK_8814B BIT(4) -+ -+#define BIT_SHIFT_BITMAP_CONDITION_8814B 2 -+#define BIT_MASK_BITMAP_CONDITION_8814B 0x3 -+#define BIT_BITMAP_CONDITION_8814B(x) \ -+ (((x) & BIT_MASK_BITMAP_CONDITION_8814B) \ -+ << BIT_SHIFT_BITMAP_CONDITION_8814B) -+#define BITS_BITMAP_CONDITION_8814B \ -+ (BIT_MASK_BITMAP_CONDITION_8814B << BIT_SHIFT_BITMAP_CONDITION_8814B) -+#define BIT_CLEAR_BITMAP_CONDITION_8814B(x) \ -+ ((x) & (~BITS_BITMAP_CONDITION_8814B)) -+#define BIT_GET_BITMAP_CONDITION_8814B(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_CONDITION_8814B) & \ -+ BIT_MASK_BITMAP_CONDITION_8814B) -+#define BIT_SET_BITMAP_CONDITION_8814B(x, v) \ -+ (BIT_CLEAR_BITMAP_CONDITION_8814B(x) | BIT_BITMAP_CONDITION_8814B(v)) -+ -+#define BIT_BITMAP_SSNBK_COUNTER_CLR_8814B BIT(1) -+#define BIT_BITMAP_FORCE_8814B BIT(0) -+ -+/* 2 REG_RXERR_RPT_8814B (RX ERROR REPORT REGISTER) */ -+ -+#define BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8814B 28 -+#define BIT_MASK_RXERR_RPT_SEL_V1_3_0_8814B 0xf -+#define BIT_RXERR_RPT_SEL_V1_3_0_8814B(x) \ -+ (((x) & BIT_MASK_RXERR_RPT_SEL_V1_3_0_8814B) \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8814B) -+#define BITS_RXERR_RPT_SEL_V1_3_0_8814B \ -+ (BIT_MASK_RXERR_RPT_SEL_V1_3_0_8814B \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8814B) -+#define BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8814B(x) \ -+ ((x) & (~BITS_RXERR_RPT_SEL_V1_3_0_8814B)) -+#define BIT_GET_RXERR_RPT_SEL_V1_3_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8814B) & \ -+ BIT_MASK_RXERR_RPT_SEL_V1_3_0_8814B) -+#define BIT_SET_RXERR_RPT_SEL_V1_3_0_8814B(x, v) \ -+ (BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8814B(x) | \ -+ BIT_RXERR_RPT_SEL_V1_3_0_8814B(v)) -+ -+#define BIT_RXERR_RPT_RST_8814B BIT(27) -+#define BIT_RXERR_RPT_SEL_V1_4_8814B BIT(26) -+#define BIT_W1S_8814B BIT(23) -+#define BIT_UD_SELECT_BSSID_8814B BIT(22) -+ -+#define BIT_SHIFT_UD_SUB_TYPE_8814B 18 -+#define BIT_MASK_UD_SUB_TYPE_8814B 0xf -+#define BIT_UD_SUB_TYPE_8814B(x) \ -+ (((x) & BIT_MASK_UD_SUB_TYPE_8814B) << BIT_SHIFT_UD_SUB_TYPE_8814B) -+#define BITS_UD_SUB_TYPE_8814B \ -+ (BIT_MASK_UD_SUB_TYPE_8814B << BIT_SHIFT_UD_SUB_TYPE_8814B) -+#define BIT_CLEAR_UD_SUB_TYPE_8814B(x) ((x) & (~BITS_UD_SUB_TYPE_8814B)) -+#define BIT_GET_UD_SUB_TYPE_8814B(x) \ -+ (((x) >> BIT_SHIFT_UD_SUB_TYPE_8814B) & BIT_MASK_UD_SUB_TYPE_8814B) -+#define BIT_SET_UD_SUB_TYPE_8814B(x, v) \ -+ (BIT_CLEAR_UD_SUB_TYPE_8814B(x) | BIT_UD_SUB_TYPE_8814B(v)) -+ -+#define BIT_SHIFT_UD_TYPE_8814B 16 -+#define BIT_MASK_UD_TYPE_8814B 0x3 -+#define BIT_UD_TYPE_8814B(x) \ -+ (((x) & BIT_MASK_UD_TYPE_8814B) << BIT_SHIFT_UD_TYPE_8814B) -+#define BITS_UD_TYPE_8814B (BIT_MASK_UD_TYPE_8814B << BIT_SHIFT_UD_TYPE_8814B) -+#define BIT_CLEAR_UD_TYPE_8814B(x) ((x) & (~BITS_UD_TYPE_8814B)) -+#define BIT_GET_UD_TYPE_8814B(x) \ -+ (((x) >> BIT_SHIFT_UD_TYPE_8814B) & BIT_MASK_UD_TYPE_8814B) -+#define BIT_SET_UD_TYPE_8814B(x, v) \ -+ (BIT_CLEAR_UD_TYPE_8814B(x) | BIT_UD_TYPE_8814B(v)) -+ -+#define BIT_SHIFT_RPT_COUNTER_8814B 0 -+#define BIT_MASK_RPT_COUNTER_8814B 0xffff -+#define BIT_RPT_COUNTER_8814B(x) \ -+ (((x) & BIT_MASK_RPT_COUNTER_8814B) << BIT_SHIFT_RPT_COUNTER_8814B) -+#define BITS_RPT_COUNTER_8814B \ -+ (BIT_MASK_RPT_COUNTER_8814B << BIT_SHIFT_RPT_COUNTER_8814B) -+#define BIT_CLEAR_RPT_COUNTER_8814B(x) ((x) & (~BITS_RPT_COUNTER_8814B)) -+#define BIT_GET_RPT_COUNTER_8814B(x) \ -+ (((x) >> BIT_SHIFT_RPT_COUNTER_8814B) & BIT_MASK_RPT_COUNTER_8814B) -+#define BIT_SET_RPT_COUNTER_8814B(x, v) \ -+ (BIT_CLEAR_RPT_COUNTER_8814B(x) | BIT_RPT_COUNTER_8814B(v)) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_8814B (WMAC TX/RX PROTOCOL CONTROL REGISTER) */ -+#define BIT_EN_TXCTS_INTXOP_8814B BIT(32) -+#define BIT_BLK_EDCA_BBSLP_8814B BIT(31) -+#define BIT_BLK_EDCA_BBSBY_8814B BIT(30) -+#define BIT_ACKTO_BLOCK_SCH_EN_8814B BIT(27) -+#define BIT_EIFS_BLOCK_SCH_EN_8814B BIT(26) -+#define BIT_PLCPCHK_RST_EIFS_8814B BIT(25) -+#define BIT_CCA_RST_EIFS_8814B BIT(24) -+#define BIT_DIS_UPD_MYRXPKTNAV_8814B BIT(23) -+#define BIT_EARLY_TXBA_8814B BIT(22) -+ -+#define BIT_SHIFT_RESP_CHNBUSY_8814B 20 -+#define BIT_MASK_RESP_CHNBUSY_8814B 0x3 -+#define BIT_RESP_CHNBUSY_8814B(x) \ -+ (((x) & BIT_MASK_RESP_CHNBUSY_8814B) << BIT_SHIFT_RESP_CHNBUSY_8814B) -+#define BITS_RESP_CHNBUSY_8814B \ -+ (BIT_MASK_RESP_CHNBUSY_8814B << BIT_SHIFT_RESP_CHNBUSY_8814B) -+#define BIT_CLEAR_RESP_CHNBUSY_8814B(x) ((x) & (~BITS_RESP_CHNBUSY_8814B)) -+#define BIT_GET_RESP_CHNBUSY_8814B(x) \ -+ (((x) >> BIT_SHIFT_RESP_CHNBUSY_8814B) & BIT_MASK_RESP_CHNBUSY_8814B) -+#define BIT_SET_RESP_CHNBUSY_8814B(x, v) \ -+ (BIT_CLEAR_RESP_CHNBUSY_8814B(x) | BIT_RESP_CHNBUSY_8814B(v)) -+ -+#define BIT_RESP_DCTS_EN_8814B BIT(19) -+#define BIT_RESP_DCFE_EN_8814B BIT(18) -+#define BIT_RESP_SPLCPEN_8814B BIT(17) -+#define BIT_RESP_SGIEN_8814B BIT(16) -+#define BIT_RESP_LDPC_EN_8814B BIT(15) -+#define BIT_DIS_RESP_ACKINCCA_8814B BIT(14) -+#define BIT_DIS_RESP_CTSINCCA_8814B BIT(13) -+ -+#define BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8814B 10 -+#define BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8814B 0x7 -+#define BIT_R_WMAC_SECOND_CCA_TIMER_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8814B) \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8814B) -+#define BITS_R_WMAC_SECOND_CCA_TIMER_8814B \ -+ (BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8814B \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8814B) -+#define BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_SECOND_CCA_TIMER_8814B)) -+#define BIT_GET_R_WMAC_SECOND_CCA_TIMER_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8814B) & \ -+ BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8814B) -+#define BIT_SET_R_WMAC_SECOND_CCA_TIMER_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8814B(x) | \ -+ BIT_R_WMAC_SECOND_CCA_TIMER_8814B(v)) -+ -+#define BIT_SHIFT_RFMOD_8814B 7 -+#define BIT_MASK_RFMOD_8814B 0x3 -+#define BIT_RFMOD_8814B(x) \ -+ (((x) & BIT_MASK_RFMOD_8814B) << BIT_SHIFT_RFMOD_8814B) -+#define BITS_RFMOD_8814B (BIT_MASK_RFMOD_8814B << BIT_SHIFT_RFMOD_8814B) -+#define BIT_CLEAR_RFMOD_8814B(x) ((x) & (~BITS_RFMOD_8814B)) -+#define BIT_GET_RFMOD_8814B(x) \ -+ (((x) >> BIT_SHIFT_RFMOD_8814B) & BIT_MASK_RFMOD_8814B) -+#define BIT_SET_RFMOD_8814B(x, v) \ -+ (BIT_CLEAR_RFMOD_8814B(x) | BIT_RFMOD_8814B(v)) -+ -+#define BIT_SHIFT_RESP_CTS_DYNBW_SEL_8814B 5 -+#define BIT_MASK_RESP_CTS_DYNBW_SEL_8814B 0x3 -+#define BIT_RESP_CTS_DYNBW_SEL_8814B(x) \ -+ (((x) & BIT_MASK_RESP_CTS_DYNBW_SEL_8814B) \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8814B) -+#define BITS_RESP_CTS_DYNBW_SEL_8814B \ -+ (BIT_MASK_RESP_CTS_DYNBW_SEL_8814B \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8814B) -+#define BIT_CLEAR_RESP_CTS_DYNBW_SEL_8814B(x) \ -+ ((x) & (~BITS_RESP_CTS_DYNBW_SEL_8814B)) -+#define BIT_GET_RESP_CTS_DYNBW_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_RESP_CTS_DYNBW_SEL_8814B) & \ -+ BIT_MASK_RESP_CTS_DYNBW_SEL_8814B) -+#define BIT_SET_RESP_CTS_DYNBW_SEL_8814B(x, v) \ -+ (BIT_CLEAR_RESP_CTS_DYNBW_SEL_8814B(x) | \ -+ BIT_RESP_CTS_DYNBW_SEL_8814B(v)) -+ -+#define BIT_DLY_TX_WAIT_RXANTSEL_8814B BIT(4) -+#define BIT_TXRESP_BY_RXANTSEL_8814B BIT(3) -+ -+#define BIT_SHIFT_ORIG_DCTS_CHK_8814B 0 -+#define BIT_MASK_ORIG_DCTS_CHK_8814B 0x3 -+#define BIT_ORIG_DCTS_CHK_8814B(x) \ -+ (((x) & BIT_MASK_ORIG_DCTS_CHK_8814B) << BIT_SHIFT_ORIG_DCTS_CHK_8814B) -+#define BITS_ORIG_DCTS_CHK_8814B \ -+ (BIT_MASK_ORIG_DCTS_CHK_8814B << BIT_SHIFT_ORIG_DCTS_CHK_8814B) -+#define BIT_CLEAR_ORIG_DCTS_CHK_8814B(x) ((x) & (~BITS_ORIG_DCTS_CHK_8814B)) -+#define BIT_GET_ORIG_DCTS_CHK_8814B(x) \ -+ (((x) >> BIT_SHIFT_ORIG_DCTS_CHK_8814B) & BIT_MASK_ORIG_DCTS_CHK_8814B) -+#define BIT_SET_ORIG_DCTS_CHK_8814B(x, v) \ -+ (BIT_CLEAR_ORIG_DCTS_CHK_8814B(x) | BIT_ORIG_DCTS_CHK_8814B(v)) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_H_8814B */ -+ -+#define BIT_SHIFT_ACKBA_TYPSEL_8814B 28 -+#define BIT_MASK_ACKBA_TYPSEL_8814B 0xf -+#define BIT_ACKBA_TYPSEL_8814B(x) \ -+ (((x) & BIT_MASK_ACKBA_TYPSEL_8814B) << BIT_SHIFT_ACKBA_TYPSEL_8814B) -+#define BITS_ACKBA_TYPSEL_8814B \ -+ (BIT_MASK_ACKBA_TYPSEL_8814B << BIT_SHIFT_ACKBA_TYPSEL_8814B) -+#define BIT_CLEAR_ACKBA_TYPSEL_8814B(x) ((x) & (~BITS_ACKBA_TYPSEL_8814B)) -+#define BIT_GET_ACKBA_TYPSEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_TYPSEL_8814B) & BIT_MASK_ACKBA_TYPSEL_8814B) -+#define BIT_SET_ACKBA_TYPSEL_8814B(x, v) \ -+ (BIT_CLEAR_ACKBA_TYPSEL_8814B(x) | BIT_ACKBA_TYPSEL_8814B(v)) -+ -+#define BIT_SHIFT_ACKBA_ACKPCHK_8814B 24 -+#define BIT_MASK_ACKBA_ACKPCHK_8814B 0xf -+#define BIT_ACKBA_ACKPCHK_8814B(x) \ -+ (((x) & BIT_MASK_ACKBA_ACKPCHK_8814B) << BIT_SHIFT_ACKBA_ACKPCHK_8814B) -+#define BITS_ACKBA_ACKPCHK_8814B \ -+ (BIT_MASK_ACKBA_ACKPCHK_8814B << BIT_SHIFT_ACKBA_ACKPCHK_8814B) -+#define BIT_CLEAR_ACKBA_ACKPCHK_8814B(x) ((x) & (~BITS_ACKBA_ACKPCHK_8814B)) -+#define BIT_GET_ACKBA_ACKPCHK_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_ACKPCHK_8814B) & BIT_MASK_ACKBA_ACKPCHK_8814B) -+#define BIT_SET_ACKBA_ACKPCHK_8814B(x, v) \ -+ (BIT_CLEAR_ACKBA_ACKPCHK_8814B(x) | BIT_ACKBA_ACKPCHK_8814B(v)) -+ -+#define BIT_SHIFT_ACKBAR_TYPESEL_8814B 16 -+#define BIT_MASK_ACKBAR_TYPESEL_8814B 0xff -+#define BIT_ACKBAR_TYPESEL_8814B(x) \ -+ (((x) & BIT_MASK_ACKBAR_TYPESEL_8814B) \ -+ << BIT_SHIFT_ACKBAR_TYPESEL_8814B) -+#define BITS_ACKBAR_TYPESEL_8814B \ -+ (BIT_MASK_ACKBAR_TYPESEL_8814B << BIT_SHIFT_ACKBAR_TYPESEL_8814B) -+#define BIT_CLEAR_ACKBAR_TYPESEL_8814B(x) ((x) & (~BITS_ACKBAR_TYPESEL_8814B)) -+#define BIT_GET_ACKBAR_TYPESEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_TYPESEL_8814B) & \ -+ BIT_MASK_ACKBAR_TYPESEL_8814B) -+#define BIT_SET_ACKBAR_TYPESEL_8814B(x, v) \ -+ (BIT_CLEAR_ACKBAR_TYPESEL_8814B(x) | BIT_ACKBAR_TYPESEL_8814B(v)) -+ -+#define BIT_SHIFT_ACKBAR_ACKPCHK_8814B 12 -+#define BIT_MASK_ACKBAR_ACKPCHK_8814B 0xf -+#define BIT_ACKBAR_ACKPCHK_8814B(x) \ -+ (((x) & BIT_MASK_ACKBAR_ACKPCHK_8814B) \ -+ << BIT_SHIFT_ACKBAR_ACKPCHK_8814B) -+#define BITS_ACKBAR_ACKPCHK_8814B \ -+ (BIT_MASK_ACKBAR_ACKPCHK_8814B << BIT_SHIFT_ACKBAR_ACKPCHK_8814B) -+#define BIT_CLEAR_ACKBAR_ACKPCHK_8814B(x) ((x) & (~BITS_ACKBAR_ACKPCHK_8814B)) -+#define BIT_GET_ACKBAR_ACKPCHK_8814B(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_ACKPCHK_8814B) & \ -+ BIT_MASK_ACKBAR_ACKPCHK_8814B) -+#define BIT_SET_ACKBAR_ACKPCHK_8814B(x, v) \ -+ (BIT_CLEAR_ACKBAR_ACKPCHK_8814B(x) | BIT_ACKBAR_ACKPCHK_8814B(v)) -+ -+#define BIT_RXBA_IGNOREA2_V1_8814B BIT(10) -+#define BIT_EN_SAVE_ALL_TXOPADDR_V1_8814B BIT(9) -+#define BIT_EN_TXCTS_TO_TXOPOWNER_INRXNAV_V1_8814B BIT(8) -+#define BIT_DIS_TXBA_AMPDUFCSERR_V1_8814B BIT(7) -+#define BIT_DIS_TXBA_RXBARINFULL_V1_8814B BIT(6) -+#define BIT_DIS_TXCFE_INFULL_V1_8814B BIT(5) -+#define BIT_DIS_TXCTS_INFULL_V1_8814B BIT(4) -+#define BIT_EN_TXACKBA_IN_TX_RDG_V1_8814B BIT(3) -+#define BIT_EN_TXACKBA_IN_TXOP_V1_8814B BIT(2) -+#define BIT_EN_TXCTS_IN_RXNAV_V1_8814B BIT(1) -+#define BIT_EN_TXCTS_INTXOP_V1_8814B BIT(0) -+ -+/* 2 REG_CAMCMD_8814B (CAM COMMAND REGISTER) */ -+#define BIT_SECCAM_POLLING_8814B BIT(31) -+#define BIT_SECCAM_CLR_8814B BIT(30) -+#define BIT_SECCAM_WE_8814B BIT(16) -+ -+#define BIT_SHIFT_SECCAM_ADDR_V2_8814B 0 -+#define BIT_MASK_SECCAM_ADDR_V2_8814B 0x3ff -+#define BIT_SECCAM_ADDR_V2_8814B(x) \ -+ (((x) & BIT_MASK_SECCAM_ADDR_V2_8814B) \ -+ << BIT_SHIFT_SECCAM_ADDR_V2_8814B) -+#define BITS_SECCAM_ADDR_V2_8814B \ -+ (BIT_MASK_SECCAM_ADDR_V2_8814B << BIT_SHIFT_SECCAM_ADDR_V2_8814B) -+#define BIT_CLEAR_SECCAM_ADDR_V2_8814B(x) ((x) & (~BITS_SECCAM_ADDR_V2_8814B)) -+#define BIT_GET_SECCAM_ADDR_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_SECCAM_ADDR_V2_8814B) & \ -+ BIT_MASK_SECCAM_ADDR_V2_8814B) -+#define BIT_SET_SECCAM_ADDR_V2_8814B(x, v) \ -+ (BIT_CLEAR_SECCAM_ADDR_V2_8814B(x) | BIT_SECCAM_ADDR_V2_8814B(v)) -+ -+/* 2 REG_CAMWRITE_8814B (CAM WRITE REGISTER) */ -+ -+#define BIT_SHIFT_CAMW_DATA_8814B 0 -+#define BIT_MASK_CAMW_DATA_8814B 0xffffffffL -+#define BIT_CAMW_DATA_8814B(x) \ -+ (((x) & BIT_MASK_CAMW_DATA_8814B) << BIT_SHIFT_CAMW_DATA_8814B) -+#define BITS_CAMW_DATA_8814B \ -+ (BIT_MASK_CAMW_DATA_8814B << BIT_SHIFT_CAMW_DATA_8814B) -+#define BIT_CLEAR_CAMW_DATA_8814B(x) ((x) & (~BITS_CAMW_DATA_8814B)) -+#define BIT_GET_CAMW_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_CAMW_DATA_8814B) & BIT_MASK_CAMW_DATA_8814B) -+#define BIT_SET_CAMW_DATA_8814B(x, v) \ -+ (BIT_CLEAR_CAMW_DATA_8814B(x) | BIT_CAMW_DATA_8814B(v)) -+ -+/* 2 REG_CAMREAD_8814B (CAM READ REGISTER) */ -+ -+#define BIT_SHIFT_CAMR_DATA_8814B 0 -+#define BIT_MASK_CAMR_DATA_8814B 0xffffffffL -+#define BIT_CAMR_DATA_8814B(x) \ -+ (((x) & BIT_MASK_CAMR_DATA_8814B) << BIT_SHIFT_CAMR_DATA_8814B) -+#define BITS_CAMR_DATA_8814B \ -+ (BIT_MASK_CAMR_DATA_8814B << BIT_SHIFT_CAMR_DATA_8814B) -+#define BIT_CLEAR_CAMR_DATA_8814B(x) ((x) & (~BITS_CAMR_DATA_8814B)) -+#define BIT_GET_CAMR_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_CAMR_DATA_8814B) & BIT_MASK_CAMR_DATA_8814B) -+#define BIT_SET_CAMR_DATA_8814B(x, v) \ -+ (BIT_CLEAR_CAMR_DATA_8814B(x) | BIT_CAMR_DATA_8814B(v)) -+ -+/* 2 REG_CAMDBG_8814B (CAM DEBUG REGISTER) */ -+#define BIT_SECCAM_INFO_8814B BIT(31) -+#define BIT_SEC_KEYFOUND_8814B BIT(15) -+ -+#define BIT_SHIFT_CAMDBG_SEC_TYPE_8814B 12 -+#define BIT_MASK_CAMDBG_SEC_TYPE_8814B 0x7 -+#define BIT_CAMDBG_SEC_TYPE_8814B(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_TYPE_8814B) \ -+ << BIT_SHIFT_CAMDBG_SEC_TYPE_8814B) -+#define BITS_CAMDBG_SEC_TYPE_8814B \ -+ (BIT_MASK_CAMDBG_SEC_TYPE_8814B << BIT_SHIFT_CAMDBG_SEC_TYPE_8814B) -+#define BIT_CLEAR_CAMDBG_SEC_TYPE_8814B(x) ((x) & (~BITS_CAMDBG_SEC_TYPE_8814B)) -+#define BIT_GET_CAMDBG_SEC_TYPE_8814B(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_TYPE_8814B) & \ -+ BIT_MASK_CAMDBG_SEC_TYPE_8814B) -+#define BIT_SET_CAMDBG_SEC_TYPE_8814B(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_TYPE_8814B(x) | BIT_CAMDBG_SEC_TYPE_8814B(v)) -+ -+#define BIT_CAMDBG_EXT_SECTYPE_8814B BIT(11) -+ -+#define BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8814B 5 -+#define BIT_MASK_CAMDBG_MIC_KEY_IDX_8814B 0x1f -+#define BIT_CAMDBG_MIC_KEY_IDX_8814B(x) \ -+ (((x) & BIT_MASK_CAMDBG_MIC_KEY_IDX_8814B) \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8814B) -+#define BITS_CAMDBG_MIC_KEY_IDX_8814B \ -+ (BIT_MASK_CAMDBG_MIC_KEY_IDX_8814B \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8814B) -+#define BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8814B(x) \ -+ ((x) & (~BITS_CAMDBG_MIC_KEY_IDX_8814B)) -+#define BIT_GET_CAMDBG_MIC_KEY_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8814B) & \ -+ BIT_MASK_CAMDBG_MIC_KEY_IDX_8814B) -+#define BIT_SET_CAMDBG_MIC_KEY_IDX_8814B(x, v) \ -+ (BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8814B(x) | \ -+ BIT_CAMDBG_MIC_KEY_IDX_8814B(v)) -+ -+#define BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8814B 0 -+#define BIT_MASK_CAMDBG_SEC_KEY_IDX_8814B 0x1f -+#define BIT_CAMDBG_SEC_KEY_IDX_8814B(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_KEY_IDX_8814B) \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8814B) -+#define BITS_CAMDBG_SEC_KEY_IDX_8814B \ -+ (BIT_MASK_CAMDBG_SEC_KEY_IDX_8814B \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8814B) -+#define BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8814B(x) \ -+ ((x) & (~BITS_CAMDBG_SEC_KEY_IDX_8814B)) -+#define BIT_GET_CAMDBG_SEC_KEY_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8814B) & \ -+ BIT_MASK_CAMDBG_SEC_KEY_IDX_8814B) -+#define BIT_SET_CAMDBG_SEC_KEY_IDX_8814B(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8814B(x) | \ -+ BIT_CAMDBG_SEC_KEY_IDX_8814B(v)) -+ -+/* 2 REG_SECCFG_8814B (SECURITY CONFIGURATION REGISTER) */ -+#define BIT_DIS_GCLK_WAPI_8814B BIT(15) -+#define BIT_DIS_GCLK_AES_8814B BIT(14) -+#define BIT_DIS_GCLK_TKIP_8814B BIT(13) -+#define BIT_AES_SEL_QC_1_8814B BIT(12) -+#define BIT_AES_SEL_QC_0_8814B BIT(11) -+#define BIT_CHK_BMC_8814B BIT(9) -+#define BIT_CHK_KEYID_8814B BIT(8) -+#define BIT_RXBCUSEDK_8814B BIT(7) -+#define BIT_TXBCUSEDK_8814B BIT(6) -+#define BIT_NOSKMC_8814B BIT(5) -+#define BIT_SKBYA2_8814B BIT(4) -+#define BIT_RXDEC_8814B BIT(3) -+#define BIT_TXENC_8814B BIT(2) -+#define BIT_RXUHUSEDK_8814B BIT(1) -+#define BIT_TXUHUSEDK_8814B BIT(0) -+ -+/* 2 REG_RXFILTER_CATEGORY_1_8814B */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_1_8814B 0 -+#define BIT_MASK_RXFILTER_CATEGORY_1_8814B 0xff -+#define BIT_RXFILTER_CATEGORY_1_8814B(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_1_8814B) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8814B) -+#define BITS_RXFILTER_CATEGORY_1_8814B \ -+ (BIT_MASK_RXFILTER_CATEGORY_1_8814B \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8814B) -+#define BIT_CLEAR_RXFILTER_CATEGORY_1_8814B(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_1_8814B)) -+#define BIT_GET_RXFILTER_CATEGORY_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_1_8814B) & \ -+ BIT_MASK_RXFILTER_CATEGORY_1_8814B) -+#define BIT_SET_RXFILTER_CATEGORY_1_8814B(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_1_8814B(x) | \ -+ BIT_RXFILTER_CATEGORY_1_8814B(v)) -+ -+/* 2 REG_RXFILTER_ACTION_1_8814B */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_1_8814B 0 -+#define BIT_MASK_RXFILTER_ACTION_1_8814B 0xff -+#define BIT_RXFILTER_ACTION_1_8814B(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_1_8814B) \ -+ << BIT_SHIFT_RXFILTER_ACTION_1_8814B) -+#define BITS_RXFILTER_ACTION_1_8814B \ -+ (BIT_MASK_RXFILTER_ACTION_1_8814B << BIT_SHIFT_RXFILTER_ACTION_1_8814B) -+#define BIT_CLEAR_RXFILTER_ACTION_1_8814B(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_1_8814B)) -+#define BIT_GET_RXFILTER_ACTION_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_1_8814B) & \ -+ BIT_MASK_RXFILTER_ACTION_1_8814B) -+#define BIT_SET_RXFILTER_ACTION_1_8814B(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_1_8814B(x) | BIT_RXFILTER_ACTION_1_8814B(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_2_8814B */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_2_8814B 0 -+#define BIT_MASK_RXFILTER_CATEGORY_2_8814B 0xff -+#define BIT_RXFILTER_CATEGORY_2_8814B(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_2_8814B) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8814B) -+#define BITS_RXFILTER_CATEGORY_2_8814B \ -+ (BIT_MASK_RXFILTER_CATEGORY_2_8814B \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8814B) -+#define BIT_CLEAR_RXFILTER_CATEGORY_2_8814B(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_2_8814B)) -+#define BIT_GET_RXFILTER_CATEGORY_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_2_8814B) & \ -+ BIT_MASK_RXFILTER_CATEGORY_2_8814B) -+#define BIT_SET_RXFILTER_CATEGORY_2_8814B(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_2_8814B(x) | \ -+ BIT_RXFILTER_CATEGORY_2_8814B(v)) -+ -+/* 2 REG_RXFILTER_ACTION_2_8814B */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_2_8814B 0 -+#define BIT_MASK_RXFILTER_ACTION_2_8814B 0xff -+#define BIT_RXFILTER_ACTION_2_8814B(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_2_8814B) \ -+ << BIT_SHIFT_RXFILTER_ACTION_2_8814B) -+#define BITS_RXFILTER_ACTION_2_8814B \ -+ (BIT_MASK_RXFILTER_ACTION_2_8814B << BIT_SHIFT_RXFILTER_ACTION_2_8814B) -+#define BIT_CLEAR_RXFILTER_ACTION_2_8814B(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_2_8814B)) -+#define BIT_GET_RXFILTER_ACTION_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_2_8814B) & \ -+ BIT_MASK_RXFILTER_ACTION_2_8814B) -+#define BIT_SET_RXFILTER_ACTION_2_8814B(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_2_8814B(x) | BIT_RXFILTER_ACTION_2_8814B(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_3_8814B */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_3_8814B 0 -+#define BIT_MASK_RXFILTER_CATEGORY_3_8814B 0xff -+#define BIT_RXFILTER_CATEGORY_3_8814B(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_3_8814B) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8814B) -+#define BITS_RXFILTER_CATEGORY_3_8814B \ -+ (BIT_MASK_RXFILTER_CATEGORY_3_8814B \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8814B) -+#define BIT_CLEAR_RXFILTER_CATEGORY_3_8814B(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_3_8814B)) -+#define BIT_GET_RXFILTER_CATEGORY_3_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_3_8814B) & \ -+ BIT_MASK_RXFILTER_CATEGORY_3_8814B) -+#define BIT_SET_RXFILTER_CATEGORY_3_8814B(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_3_8814B(x) | \ -+ BIT_RXFILTER_CATEGORY_3_8814B(v)) -+ -+/* 2 REG_RXFILTER_ACTION_3_8814B */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_3_8814B 0 -+#define BIT_MASK_RXFILTER_ACTION_3_8814B 0xff -+#define BIT_RXFILTER_ACTION_3_8814B(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_3_8814B) \ -+ << BIT_SHIFT_RXFILTER_ACTION_3_8814B) -+#define BITS_RXFILTER_ACTION_3_8814B \ -+ (BIT_MASK_RXFILTER_ACTION_3_8814B << BIT_SHIFT_RXFILTER_ACTION_3_8814B) -+#define BIT_CLEAR_RXFILTER_ACTION_3_8814B(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_3_8814B)) -+#define BIT_GET_RXFILTER_ACTION_3_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_3_8814B) & \ -+ BIT_MASK_RXFILTER_ACTION_3_8814B) -+#define BIT_SET_RXFILTER_ACTION_3_8814B(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_3_8814B(x) | BIT_RXFILTER_ACTION_3_8814B(v)) -+ -+/* 2 REG_RXFLTMAP3_8814B (RX FILTER MAP GROUP 3) */ -+#define BIT_MGTFLT15EN_FW_8814B BIT(15) -+#define BIT_MGTFLT14EN_FW_8814B BIT(14) -+#define BIT_MGTFLT13EN_FW_8814B BIT(13) -+#define BIT_MGTFLT12EN_FW_8814B BIT(12) -+#define BIT_MGTFLT11EN_FW_8814B BIT(11) -+#define BIT_MGTFLT10EN_FW_8814B BIT(10) -+#define BIT_MGTFLT9EN_FW_8814B BIT(9) -+#define BIT_MGTFLT8EN_FW_8814B BIT(8) -+#define BIT_MGTFLT7EN_FW_8814B BIT(7) -+#define BIT_MGTFLT6EN_FW_8814B BIT(6) -+#define BIT_MGTFLT5EN_FW_8814B BIT(5) -+#define BIT_MGTFLT4EN_FW_8814B BIT(4) -+#define BIT_MGTFLT3EN_FW_8814B BIT(3) -+#define BIT_MGTFLT2EN_FW_8814B BIT(2) -+#define BIT_MGTFLT1EN_FW_8814B BIT(1) -+#define BIT_MGTFLT0EN_FW_8814B BIT(0) -+ -+/* 2 REG_RXFLTMAP4_8814B (RX FILTER MAP GROUP 4) */ -+#define BIT_CTRLFLT15EN_FW_8814B BIT(15) -+#define BIT_CTRLFLT14EN_FW_8814B BIT(14) -+#define BIT_CTRLFLT13EN_FW_8814B BIT(13) -+#define BIT_CTRLFLT12EN_FW_8814B BIT(12) -+#define BIT_CTRLFLT11EN_FW_8814B BIT(11) -+#define BIT_CTRLFLT10EN_FW_8814B BIT(10) -+#define BIT_CTRLFLT9EN_FW_8814B BIT(9) -+#define BIT_CTRLFLT8EN_FW_8814B BIT(8) -+#define BIT_CTRLFLT7EN_FW_8814B BIT(7) -+#define BIT_CTRLFLT6EN_FW_8814B BIT(6) -+#define BIT_CTRLFLT5EN_FW_8814B BIT(5) -+#define BIT_CTRLFLT4EN_FW_8814B BIT(4) -+#define BIT_CTRLFLT3EN_FW_8814B BIT(3) -+#define BIT_CTRLFLT2EN_FW_8814B BIT(2) -+#define BIT_CTRLFLT1EN_FW_8814B BIT(1) -+#define BIT_CTRLFLT0EN_FW_8814B BIT(0) -+ -+/* 2 REG_RXFLTMAP5_8814B (RX FILTER MAP GROUP 5) */ -+#define BIT_DATAFLT15EN_FW_8814B BIT(15) -+#define BIT_DATAFLT14EN_FW_8814B BIT(14) -+#define BIT_DATAFLT13EN_FW_8814B BIT(13) -+#define BIT_DATAFLT12EN_FW_8814B BIT(12) -+#define BIT_DATAFLT11EN_FW_8814B BIT(11) -+#define BIT_DATAFLT10EN_FW_8814B BIT(10) -+#define BIT_DATAFLT9EN_FW_8814B BIT(9) -+#define BIT_DATAFLT8EN_FW_8814B BIT(8) -+#define BIT_DATAFLT7EN_FW_8814B BIT(7) -+#define BIT_DATAFLT6EN_FW_8814B BIT(6) -+#define BIT_DATAFLT5EN_FW_8814B BIT(5) -+#define BIT_DATAFLT4EN_FW_8814B BIT(4) -+#define BIT_DATAFLT3EN_FW_8814B BIT(3) -+#define BIT_DATAFLT2EN_FW_8814B BIT(2) -+#define BIT_DATAFLT1EN_FW_8814B BIT(1) -+#define BIT_DATAFLT0EN_FW_8814B BIT(0) -+ -+/* 2 REG_RXFLTMAP6_8814B (RX FILTER MAP GROUP 6) */ -+#define BIT_ACTIONFLT15EN_FW_8814B BIT(15) -+#define BIT_ACTIONFLT14EN_FW_8814B BIT(14) -+#define BIT_ACTIONFLT13EN_FW_8814B BIT(13) -+#define BIT_ACTIONFLT12EN_FW_8814B BIT(12) -+#define BIT_ACTIONFLT11EN_FW_8814B BIT(11) -+#define BIT_ACTIONFLT10EN_FW_8814B BIT(10) -+#define BIT_ACTIONFLT9EN_FW_8814B BIT(9) -+#define BIT_ACTIONFLT8EN_FW_8814B BIT(8) -+#define BIT_ACTIONFLT7EN_FW_8814B BIT(7) -+#define BIT_ACTIONFLT6EN_FW_8814B BIT(6) -+#define BIT_ACTIONFLT5EN_FW_8814B BIT(5) -+#define BIT_ACTIONFLT4EN_FW_8814B BIT(4) -+#define BIT_ACTIONFLT3EN_FW_8814B BIT(3) -+#define BIT_ACTIONFLT2EN_FW_8814B BIT(2) -+#define BIT_ACTIONFLT1EN_FW_8814B BIT(1) -+#define BIT_ACTIONFLT0EN_FW_8814B BIT(0) -+ -+/* 2 REG_WOW_CTRL_8814B (WAKE ON WLAN CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_PSF_BSSIDSEL_B2B1_8814B 6 -+#define BIT_MASK_PSF_BSSIDSEL_B2B1_8814B 0x3 -+#define BIT_PSF_BSSIDSEL_B2B1_8814B(x) \ -+ (((x) & BIT_MASK_PSF_BSSIDSEL_B2B1_8814B) \ -+ << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8814B) -+#define BITS_PSF_BSSIDSEL_B2B1_8814B \ -+ (BIT_MASK_PSF_BSSIDSEL_B2B1_8814B << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8814B) -+#define BIT_CLEAR_PSF_BSSIDSEL_B2B1_8814B(x) \ -+ ((x) & (~BITS_PSF_BSSIDSEL_B2B1_8814B)) -+#define BIT_GET_PSF_BSSIDSEL_B2B1_8814B(x) \ -+ (((x) >> BIT_SHIFT_PSF_BSSIDSEL_B2B1_8814B) & \ -+ BIT_MASK_PSF_BSSIDSEL_B2B1_8814B) -+#define BIT_SET_PSF_BSSIDSEL_B2B1_8814B(x, v) \ -+ (BIT_CLEAR_PSF_BSSIDSEL_B2B1_8814B(x) | BIT_PSF_BSSIDSEL_B2B1_8814B(v)) -+ -+#define BIT_WOWHCI_8814B BIT(5) -+#define BIT_PSF_BSSIDSEL_B0_8814B BIT(4) -+#define BIT_UWF_8814B BIT(3) -+#define BIT_MAGIC_8814B BIT(2) -+#define BIT_WOWEN_8814B BIT(1) -+#define BIT_FORCE_WAKEUP_8814B BIT(0) -+ -+/* 2 REG_NAN_RX_TSF_FILTER_8814B(NAN_RX_TSF_ADDRESS_FILTER) */ -+#define BIT_CHK_TSF_TA_8814B BIT(2) -+#define BIT_CHK_TSF_CBSSID_8814B BIT(1) -+#define BIT_CHK_TSF_EN_8814B BIT(0) -+ -+/* 2 REG_PS_RX_INFO_8814B (POWER SAVE RX INFORMATION REGISTER) */ -+ -+#define BIT_SHIFT_PORTSEL__PS_RX_INFO_8814B 5 -+#define BIT_MASK_PORTSEL__PS_RX_INFO_8814B 0x7 -+#define BIT_PORTSEL__PS_RX_INFO_8814B(x) \ -+ (((x) & BIT_MASK_PORTSEL__PS_RX_INFO_8814B) \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8814B) -+#define BITS_PORTSEL__PS_RX_INFO_8814B \ -+ (BIT_MASK_PORTSEL__PS_RX_INFO_8814B \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8814B) -+#define BIT_CLEAR_PORTSEL__PS_RX_INFO_8814B(x) \ -+ ((x) & (~BITS_PORTSEL__PS_RX_INFO_8814B)) -+#define BIT_GET_PORTSEL__PS_RX_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_PORTSEL__PS_RX_INFO_8814B) & \ -+ BIT_MASK_PORTSEL__PS_RX_INFO_8814B) -+#define BIT_SET_PORTSEL__PS_RX_INFO_8814B(x, v) \ -+ (BIT_CLEAR_PORTSEL__PS_RX_INFO_8814B(x) | \ -+ BIT_PORTSEL__PS_RX_INFO_8814B(v)) -+ -+#define BIT_RXCTRLIN0_8814B BIT(4) -+#define BIT_RXMGTIN0_8814B BIT(3) -+#define BIT_RXDATAIN2_8814B BIT(2) -+#define BIT_RXDATAIN1_8814B BIT(1) -+#define BIT_RXDATAIN0_8814B BIT(0) -+ -+/* 2 REG_WMMPS_UAPSD_TID_8814B (WMM POWER SAVE UAPSD TID REGISTER) */ -+#define BIT_WMMPS_UAPSD_TID7_8814B BIT(7) -+#define BIT_WMMPS_UAPSD_TID6_8814B BIT(6) -+#define BIT_WMMPS_UAPSD_TID5_8814B BIT(5) -+#define BIT_WMMPS_UAPSD_TID4_8814B BIT(4) -+#define BIT_WMMPS_UAPSD_TID3_8814B BIT(3) -+#define BIT_WMMPS_UAPSD_TID2_8814B BIT(2) -+#define BIT_WMMPS_UAPSD_TID1_8814B BIT(1) -+#define BIT_WMMPS_UAPSD_TID0_8814B BIT(0) -+ -+/* 2 REG_LPNAV_CTRL_8814B (LOW POWER NAV CONTROL REGISTER) */ -+ -+/* 2 REG_WKFMCAM_CMD_8814B (WAKEUP FRAME CAM COMMAND REGISTER) */ -+#define BIT_WKFCAM_POLLING_V1_8814B BIT(31) -+#define BIT_WKFCAM_CLR_V1_8814B BIT(30) -+#define BIT_WKFCAM_WE_8814B BIT(16) -+ -+#define BIT_SHIFT_WKFCAM_ADDR_V2_8814B 8 -+#define BIT_MASK_WKFCAM_ADDR_V2_8814B 0xff -+#define BIT_WKFCAM_ADDR_V2_8814B(x) \ -+ (((x) & BIT_MASK_WKFCAM_ADDR_V2_8814B) \ -+ << BIT_SHIFT_WKFCAM_ADDR_V2_8814B) -+#define BITS_WKFCAM_ADDR_V2_8814B \ -+ (BIT_MASK_WKFCAM_ADDR_V2_8814B << BIT_SHIFT_WKFCAM_ADDR_V2_8814B) -+#define BIT_CLEAR_WKFCAM_ADDR_V2_8814B(x) ((x) & (~BITS_WKFCAM_ADDR_V2_8814B)) -+#define BIT_GET_WKFCAM_ADDR_V2_8814B(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_ADDR_V2_8814B) & \ -+ BIT_MASK_WKFCAM_ADDR_V2_8814B) -+#define BIT_SET_WKFCAM_ADDR_V2_8814B(x, v) \ -+ (BIT_CLEAR_WKFCAM_ADDR_V2_8814B(x) | BIT_WKFCAM_ADDR_V2_8814B(v)) -+ -+#define BIT_SHIFT_WKFCAM_CAM_NUM_V1_8814B 0 -+#define BIT_MASK_WKFCAM_CAM_NUM_V1_8814B 0xff -+#define BIT_WKFCAM_CAM_NUM_V1_8814B(x) \ -+ (((x) & BIT_MASK_WKFCAM_CAM_NUM_V1_8814B) \ -+ << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8814B) -+#define BITS_WKFCAM_CAM_NUM_V1_8814B \ -+ (BIT_MASK_WKFCAM_CAM_NUM_V1_8814B << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8814B) -+#define BIT_CLEAR_WKFCAM_CAM_NUM_V1_8814B(x) \ -+ ((x) & (~BITS_WKFCAM_CAM_NUM_V1_8814B)) -+#define BIT_GET_WKFCAM_CAM_NUM_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_CAM_NUM_V1_8814B) & \ -+ BIT_MASK_WKFCAM_CAM_NUM_V1_8814B) -+#define BIT_SET_WKFCAM_CAM_NUM_V1_8814B(x, v) \ -+ (BIT_CLEAR_WKFCAM_CAM_NUM_V1_8814B(x) | BIT_WKFCAM_CAM_NUM_V1_8814B(v)) -+ -+/* 2 REG_WKFMCAM_RWD_8814B (WAKEUP FRAME READ/WRITE DATA) */ -+ -+#define BIT_SHIFT_WKFMCAM_RWD_8814B 0 -+#define BIT_MASK_WKFMCAM_RWD_8814B 0xffffffffL -+#define BIT_WKFMCAM_RWD_8814B(x) \ -+ (((x) & BIT_MASK_WKFMCAM_RWD_8814B) << BIT_SHIFT_WKFMCAM_RWD_8814B) -+#define BITS_WKFMCAM_RWD_8814B \ -+ (BIT_MASK_WKFMCAM_RWD_8814B << BIT_SHIFT_WKFMCAM_RWD_8814B) -+#define BIT_CLEAR_WKFMCAM_RWD_8814B(x) ((x) & (~BITS_WKFMCAM_RWD_8814B)) -+#define BIT_GET_WKFMCAM_RWD_8814B(x) \ -+ (((x) >> BIT_SHIFT_WKFMCAM_RWD_8814B) & BIT_MASK_WKFMCAM_RWD_8814B) -+#define BIT_SET_WKFMCAM_RWD_8814B(x, v) \ -+ (BIT_CLEAR_WKFMCAM_RWD_8814B(x) | BIT_WKFMCAM_RWD_8814B(v)) -+ -+/* 2 REG_RXFLTMAP0_8814B (RX FILTER MAP GROUP 0) */ -+#define BIT_MGTFLT15EN_8814B BIT(15) -+#define BIT_MGTFLT14EN_8814B BIT(14) -+#define BIT_MGTFLT13EN_8814B BIT(13) -+#define BIT_MGTFLT12EN_8814B BIT(12) -+#define BIT_MGTFLT11EN_8814B BIT(11) -+#define BIT_MGTFLT10EN_8814B BIT(10) -+#define BIT_MGTFLT9EN_8814B BIT(9) -+#define BIT_MGTFLT8EN_8814B BIT(8) -+#define BIT_MGTFLT7EN_8814B BIT(7) -+#define BIT_MGTFLT6EN_8814B BIT(6) -+#define BIT_MGTFLT5EN_8814B BIT(5) -+#define BIT_MGTFLT4EN_8814B BIT(4) -+#define BIT_MGTFLT3EN_8814B BIT(3) -+#define BIT_MGTFLT2EN_8814B BIT(2) -+#define BIT_MGTFLT1EN_8814B BIT(1) -+#define BIT_MGTFLT0EN_8814B BIT(0) -+ -+/* 2 REG_RXFLTMAP1_8814B (RX FILTER MAP GROUP 1) */ -+#define BIT_CTRLFLT15EN_8814B BIT(15) -+#define BIT_CTRLFLT14EN_8814B BIT(14) -+#define BIT_CTRLFLT13EN_8814B BIT(13) -+#define BIT_CTRLFLT12EN_8814B BIT(12) -+#define BIT_CTRLFLT11EN_8814B BIT(11) -+#define BIT_CTRLFLT10EN_8814B BIT(10) -+#define BIT_CTRLFLT9EN_8814B BIT(9) -+#define BIT_CTRLFLT8EN_8814B BIT(8) -+#define BIT_CTRLFLT7EN_8814B BIT(7) -+#define BIT_CTRLFLT6EN_8814B BIT(6) -+#define BIT_CTRLFLT5EN_8814B BIT(5) -+#define BIT_CTRLFLT4EN_8814B BIT(4) -+#define BIT_CTRLFLT3EN_8814B BIT(3) -+#define BIT_CTRLFLT2EN_8814B BIT(2) -+#define BIT_CTRLFLT1EN_8814B BIT(1) -+#define BIT_CTRLFLT0EN_8814B BIT(0) -+ -+/* 2 REG_RXFLTMAP2_8814B (RX FILTER MAP GROUP 2) */ -+#define BIT_DATAFLT15EN_8814B BIT(15) -+#define BIT_DATAFLT14EN_8814B BIT(14) -+#define BIT_DATAFLT13EN_8814B BIT(13) -+#define BIT_DATAFLT12EN_8814B BIT(12) -+#define BIT_DATAFLT11EN_8814B BIT(11) -+#define BIT_DATAFLT10EN_8814B BIT(10) -+#define BIT_DATAFLT9EN_8814B BIT(9) -+#define BIT_DATAFLT8EN_8814B BIT(8) -+#define BIT_DATAFLT7EN_8814B BIT(7) -+#define BIT_DATAFLT6EN_8814B BIT(6) -+#define BIT_DATAFLT5EN_8814B BIT(5) -+#define BIT_DATAFLT4EN_8814B BIT(4) -+#define BIT_DATAFLT3EN_8814B BIT(3) -+#define BIT_DATAFLT2EN_8814B BIT(2) -+#define BIT_DATAFLT1EN_8814B BIT(1) -+#define BIT_DATAFLT0EN_8814B BIT(0) -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_BCN_PSR_RPT_8814B (BEACON PARSER REPORT REGISTER) */ -+ -+#define BIT_SHIFT_DTIM_CNT_8814B 24 -+#define BIT_MASK_DTIM_CNT_8814B 0xff -+#define BIT_DTIM_CNT_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_CNT_8814B) << BIT_SHIFT_DTIM_CNT_8814B) -+#define BITS_DTIM_CNT_8814B \ -+ (BIT_MASK_DTIM_CNT_8814B << BIT_SHIFT_DTIM_CNT_8814B) -+#define BIT_CLEAR_DTIM_CNT_8814B(x) ((x) & (~BITS_DTIM_CNT_8814B)) -+#define BIT_GET_DTIM_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT_8814B) & BIT_MASK_DTIM_CNT_8814B) -+#define BIT_SET_DTIM_CNT_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_CNT_8814B(x) | BIT_DTIM_CNT_8814B(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD_8814B 16 -+#define BIT_MASK_DTIM_PERIOD_8814B 0xff -+#define BIT_DTIM_PERIOD_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD_8814B) << BIT_SHIFT_DTIM_PERIOD_8814B) -+#define BITS_DTIM_PERIOD_8814B \ -+ (BIT_MASK_DTIM_PERIOD_8814B << BIT_SHIFT_DTIM_PERIOD_8814B) -+#define BIT_CLEAR_DTIM_PERIOD_8814B(x) ((x) & (~BITS_DTIM_PERIOD_8814B)) -+#define BIT_GET_DTIM_PERIOD_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD_8814B) & BIT_MASK_DTIM_PERIOD_8814B) -+#define BIT_SET_DTIM_PERIOD_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD_8814B(x) | BIT_DTIM_PERIOD_8814B(v)) -+ -+#define BIT_DTIM_8814B BIT(15) -+#define BIT_TIM_8814B BIT(14) -+#define BIT_RPT_VALID_8814B BIT(13) -+ -+#define BIT_SHIFT_PS_AID_0_8814B 0 -+#define BIT_MASK_PS_AID_0_8814B 0x7ff -+#define BIT_PS_AID_0_8814B(x) \ -+ (((x) & BIT_MASK_PS_AID_0_8814B) << BIT_SHIFT_PS_AID_0_8814B) -+#define BITS_PS_AID_0_8814B \ -+ (BIT_MASK_PS_AID_0_8814B << BIT_SHIFT_PS_AID_0_8814B) -+#define BIT_CLEAR_PS_AID_0_8814B(x) ((x) & (~BITS_PS_AID_0_8814B)) -+#define BIT_GET_PS_AID_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_0_8814B) & BIT_MASK_PS_AID_0_8814B) -+#define BIT_SET_PS_AID_0_8814B(x, v) \ -+ (BIT_CLEAR_PS_AID_0_8814B(x) | BIT_PS_AID_0_8814B(v)) -+ -+/* 2 REG_FLC_RPC_8814B (FW LPS CONDITION -- RX PKT COUNTER) */ -+ -+#define BIT_SHIFT_FLC_RPC_8814B 0 -+#define BIT_MASK_FLC_RPC_8814B 0xff -+#define BIT_FLC_RPC_8814B(x) \ -+ (((x) & BIT_MASK_FLC_RPC_8814B) << BIT_SHIFT_FLC_RPC_8814B) -+#define BITS_FLC_RPC_8814B (BIT_MASK_FLC_RPC_8814B << BIT_SHIFT_FLC_RPC_8814B) -+#define BIT_CLEAR_FLC_RPC_8814B(x) ((x) & (~BITS_FLC_RPC_8814B)) -+#define BIT_GET_FLC_RPC_8814B(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPC_8814B) & BIT_MASK_FLC_RPC_8814B) -+#define BIT_SET_FLC_RPC_8814B(x, v) \ -+ (BIT_CLEAR_FLC_RPC_8814B(x) | BIT_FLC_RPC_8814B(v)) -+ -+/* 2 REG_FLC_RPCT_8814B (FLC_RPC THRESHOLD) */ -+ -+#define BIT_SHIFT_FLC_RPCT_8814B 0 -+#define BIT_MASK_FLC_RPCT_8814B 0xff -+#define BIT_FLC_RPCT_8814B(x) \ -+ (((x) & BIT_MASK_FLC_RPCT_8814B) << BIT_SHIFT_FLC_RPCT_8814B) -+#define BITS_FLC_RPCT_8814B \ -+ (BIT_MASK_FLC_RPCT_8814B << BIT_SHIFT_FLC_RPCT_8814B) -+#define BIT_CLEAR_FLC_RPCT_8814B(x) ((x) & (~BITS_FLC_RPCT_8814B)) -+#define BIT_GET_FLC_RPCT_8814B(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPCT_8814B) & BIT_MASK_FLC_RPCT_8814B) -+#define BIT_SET_FLC_RPCT_8814B(x, v) \ -+ (BIT_CLEAR_FLC_RPCT_8814B(x) | BIT_FLC_RPCT_8814B(v)) -+ -+/* 2 REG_FLC_PTS_8814B (PKT TYPE SELECTION OF FLC_RPC T) */ -+#define BIT_CMF_8814B BIT(2) -+#define BIT_CCF_8814B BIT(1) -+#define BIT_CDF_8814B BIT(0) -+ -+/* 2 REG_FLC_TRPC_8814B (TIMER OF FLC_RPC) */ -+#define BIT_FLC_RPCT_V1_8814B BIT(7) -+#define BIT_MODE_8814B BIT(6) -+ -+#define BIT_SHIFT_TRPCD_8814B 0 -+#define BIT_MASK_TRPCD_8814B 0x3f -+#define BIT_TRPCD_8814B(x) \ -+ (((x) & BIT_MASK_TRPCD_8814B) << BIT_SHIFT_TRPCD_8814B) -+#define BITS_TRPCD_8814B (BIT_MASK_TRPCD_8814B << BIT_SHIFT_TRPCD_8814B) -+#define BIT_CLEAR_TRPCD_8814B(x) ((x) & (~BITS_TRPCD_8814B)) -+#define BIT_GET_TRPCD_8814B(x) \ -+ (((x) >> BIT_SHIFT_TRPCD_8814B) & BIT_MASK_TRPCD_8814B) -+#define BIT_SET_TRPCD_8814B(x, v) \ -+ (BIT_CLEAR_TRPCD_8814B(x) | BIT_TRPCD_8814B(v)) -+ -+/* 2 REG_RXPKTMON_CTRL_8814B */ -+ -+#define BIT_SHIFT_RXBKQPKT_SEQ_8814B 20 -+#define BIT_MASK_RXBKQPKT_SEQ_8814B 0xf -+#define BIT_RXBKQPKT_SEQ_8814B(x) \ -+ (((x) & BIT_MASK_RXBKQPKT_SEQ_8814B) << BIT_SHIFT_RXBKQPKT_SEQ_8814B) -+#define BITS_RXBKQPKT_SEQ_8814B \ -+ (BIT_MASK_RXBKQPKT_SEQ_8814B << BIT_SHIFT_RXBKQPKT_SEQ_8814B) -+#define BIT_CLEAR_RXBKQPKT_SEQ_8814B(x) ((x) & (~BITS_RXBKQPKT_SEQ_8814B)) -+#define BIT_GET_RXBKQPKT_SEQ_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXBKQPKT_SEQ_8814B) & BIT_MASK_RXBKQPKT_SEQ_8814B) -+#define BIT_SET_RXBKQPKT_SEQ_8814B(x, v) \ -+ (BIT_CLEAR_RXBKQPKT_SEQ_8814B(x) | BIT_RXBKQPKT_SEQ_8814B(v)) -+ -+#define BIT_SHIFT_RXBEQPKT_SEQ_8814B 16 -+#define BIT_MASK_RXBEQPKT_SEQ_8814B 0xf -+#define BIT_RXBEQPKT_SEQ_8814B(x) \ -+ (((x) & BIT_MASK_RXBEQPKT_SEQ_8814B) << BIT_SHIFT_RXBEQPKT_SEQ_8814B) -+#define BITS_RXBEQPKT_SEQ_8814B \ -+ (BIT_MASK_RXBEQPKT_SEQ_8814B << BIT_SHIFT_RXBEQPKT_SEQ_8814B) -+#define BIT_CLEAR_RXBEQPKT_SEQ_8814B(x) ((x) & (~BITS_RXBEQPKT_SEQ_8814B)) -+#define BIT_GET_RXBEQPKT_SEQ_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXBEQPKT_SEQ_8814B) & BIT_MASK_RXBEQPKT_SEQ_8814B) -+#define BIT_SET_RXBEQPKT_SEQ_8814B(x, v) \ -+ (BIT_CLEAR_RXBEQPKT_SEQ_8814B(x) | BIT_RXBEQPKT_SEQ_8814B(v)) -+ -+#define BIT_SHIFT_RXVIQPKT_SEQ_8814B 12 -+#define BIT_MASK_RXVIQPKT_SEQ_8814B 0xf -+#define BIT_RXVIQPKT_SEQ_8814B(x) \ -+ (((x) & BIT_MASK_RXVIQPKT_SEQ_8814B) << BIT_SHIFT_RXVIQPKT_SEQ_8814B) -+#define BITS_RXVIQPKT_SEQ_8814B \ -+ (BIT_MASK_RXVIQPKT_SEQ_8814B << BIT_SHIFT_RXVIQPKT_SEQ_8814B) -+#define BIT_CLEAR_RXVIQPKT_SEQ_8814B(x) ((x) & (~BITS_RXVIQPKT_SEQ_8814B)) -+#define BIT_GET_RXVIQPKT_SEQ_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXVIQPKT_SEQ_8814B) & BIT_MASK_RXVIQPKT_SEQ_8814B) -+#define BIT_SET_RXVIQPKT_SEQ_8814B(x, v) \ -+ (BIT_CLEAR_RXVIQPKT_SEQ_8814B(x) | BIT_RXVIQPKT_SEQ_8814B(v)) -+ -+#define BIT_SHIFT_RXVOQPKT_SEQ_8814B 8 -+#define BIT_MASK_RXVOQPKT_SEQ_8814B 0xf -+#define BIT_RXVOQPKT_SEQ_8814B(x) \ -+ (((x) & BIT_MASK_RXVOQPKT_SEQ_8814B) << BIT_SHIFT_RXVOQPKT_SEQ_8814B) -+#define BITS_RXVOQPKT_SEQ_8814B \ -+ (BIT_MASK_RXVOQPKT_SEQ_8814B << BIT_SHIFT_RXVOQPKT_SEQ_8814B) -+#define BIT_CLEAR_RXVOQPKT_SEQ_8814B(x) ((x) & (~BITS_RXVOQPKT_SEQ_8814B)) -+#define BIT_GET_RXVOQPKT_SEQ_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXVOQPKT_SEQ_8814B) & BIT_MASK_RXVOQPKT_SEQ_8814B) -+#define BIT_SET_RXVOQPKT_SEQ_8814B(x, v) \ -+ (BIT_CLEAR_RXVOQPKT_SEQ_8814B(x) | BIT_RXVOQPKT_SEQ_8814B(v)) -+ -+#define BIT_RXBKQPKT_ERR_8814B BIT(7) -+#define BIT_RXBEQPKT_ERR_8814B BIT(6) -+#define BIT_RXVIQPKT_ERR_8814B BIT(5) -+#define BIT_RXVOQPKT_ERR_8814B BIT(4) -+#define BIT_RXDMA_MON_EN_8814B BIT(2) -+#define BIT_RXPKT_MON_RST_8814B BIT(1) -+#define BIT_RXPKT_MON_EN_8814B BIT(0) -+ -+/* 2 REG_STATE_MON_8814B */ -+ -+#define BIT_SHIFT_STATE_SEL_8814B 24 -+#define BIT_MASK_STATE_SEL_8814B 0x1f -+#define BIT_STATE_SEL_8814B(x) \ -+ (((x) & BIT_MASK_STATE_SEL_8814B) << BIT_SHIFT_STATE_SEL_8814B) -+#define BITS_STATE_SEL_8814B \ -+ (BIT_MASK_STATE_SEL_8814B << BIT_SHIFT_STATE_SEL_8814B) -+#define BIT_CLEAR_STATE_SEL_8814B(x) ((x) & (~BITS_STATE_SEL_8814B)) -+#define BIT_GET_STATE_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_STATE_SEL_8814B) & BIT_MASK_STATE_SEL_8814B) -+#define BIT_SET_STATE_SEL_8814B(x, v) \ -+ (BIT_CLEAR_STATE_SEL_8814B(x) | BIT_STATE_SEL_8814B(v)) -+ -+#define BIT_SHIFT_STATE_INFO_8814B 8 -+#define BIT_MASK_STATE_INFO_8814B 0xff -+#define BIT_STATE_INFO_8814B(x) \ -+ (((x) & BIT_MASK_STATE_INFO_8814B) << BIT_SHIFT_STATE_INFO_8814B) -+#define BITS_STATE_INFO_8814B \ -+ (BIT_MASK_STATE_INFO_8814B << BIT_SHIFT_STATE_INFO_8814B) -+#define BIT_CLEAR_STATE_INFO_8814B(x) ((x) & (~BITS_STATE_INFO_8814B)) -+#define BIT_GET_STATE_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_STATE_INFO_8814B) & BIT_MASK_STATE_INFO_8814B) -+#define BIT_SET_STATE_INFO_8814B(x, v) \ -+ (BIT_CLEAR_STATE_INFO_8814B(x) | BIT_STATE_INFO_8814B(v)) -+ -+#define BIT_UPD_NXT_STATE_8814B BIT(7) -+ -+#define BIT_SHIFT_CUR_STATE_8814B 0 -+#define BIT_MASK_CUR_STATE_8814B 0x7f -+#define BIT_CUR_STATE_8814B(x) \ -+ (((x) & BIT_MASK_CUR_STATE_8814B) << BIT_SHIFT_CUR_STATE_8814B) -+#define BITS_CUR_STATE_8814B \ -+ (BIT_MASK_CUR_STATE_8814B << BIT_SHIFT_CUR_STATE_8814B) -+#define BIT_CLEAR_CUR_STATE_8814B(x) ((x) & (~BITS_CUR_STATE_8814B)) -+#define BIT_GET_CUR_STATE_8814B(x) \ -+ (((x) >> BIT_SHIFT_CUR_STATE_8814B) & BIT_MASK_CUR_STATE_8814B) -+#define BIT_SET_CUR_STATE_8814B(x, v) \ -+ (BIT_CLEAR_CUR_STATE_8814B(x) | BIT_CUR_STATE_8814B(v)) -+ -+/* 2 REG_ERROR_MON_8814B */ -+#define BIT_CSIRPT_LEN_BB_MORE_THAN_MAC_8814B BIT(23) -+#define BIT_CSI_CHKSUM_ERROR_8814B BIT(22) -+#define BIT_MACRX_ERR_5_8814B BIT(21) -+#define BIT_MACRX_ERR_4_8814B BIT(20) -+#define BIT_MACRX_ERR_3_8814B BIT(19) -+#define BIT_MACRX_ERR_2_8814B BIT(18) -+#define BIT_MACRX_ERR_1_8814B BIT(17) -+#define BIT_MACRX_ERR_0_8814B BIT(16) -+#define BIT_WMAC_PRETX_ERRHDL_EN_8814B BIT(15) -+#define BIT_MACTX_ERR_5_8814B BIT(5) -+#define BIT_MACTX_ERR_4_8814B BIT(4) -+#define BIT_MACTX_ERR_3_8814B BIT(3) -+#define BIT_MACTX_ERR_2_8814B BIT(2) -+#define BIT_MACTX_ERR_1_8814B BIT(1) -+#define BIT_MACTX_ERR_0_8814B BIT(0) -+ -+/* 2 REG_SEARCH_MACID_8814B */ -+#define BIT_EN_TXRPTBUF_CLK_8814B BIT(31) -+#define BIT_WMAC_SRCH_FIFOFULL_8814B BIT(15) -+#define BIT_DIS_INFOSRCH_8814B BIT(14) -+#define BIT_DISABLE_B0_8814B BIT(13) -+ -+#define BIT_SHIFT_INFO_ADDR_OFFSET_8814B 0 -+#define BIT_MASK_INFO_ADDR_OFFSET_8814B 0x1fff -+#define BIT_INFO_ADDR_OFFSET_8814B(x) \ -+ (((x) & BIT_MASK_INFO_ADDR_OFFSET_8814B) \ -+ << BIT_SHIFT_INFO_ADDR_OFFSET_8814B) -+#define BITS_INFO_ADDR_OFFSET_8814B \ -+ (BIT_MASK_INFO_ADDR_OFFSET_8814B << BIT_SHIFT_INFO_ADDR_OFFSET_8814B) -+#define BIT_CLEAR_INFO_ADDR_OFFSET_8814B(x) \ -+ ((x) & (~BITS_INFO_ADDR_OFFSET_8814B)) -+#define BIT_GET_INFO_ADDR_OFFSET_8814B(x) \ -+ (((x) >> BIT_SHIFT_INFO_ADDR_OFFSET_8814B) & \ -+ BIT_MASK_INFO_ADDR_OFFSET_8814B) -+#define BIT_SET_INFO_ADDR_OFFSET_8814B(x, v) \ -+ (BIT_CLEAR_INFO_ADDR_OFFSET_8814B(x) | BIT_INFO_ADDR_OFFSET_8814B(v)) -+ -+/* 2 REG_BT_COEX_TABLE_8814B (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_COEX_TABLE_1_8814B 0 -+#define BIT_MASK_COEX_TABLE_1_8814B 0xffffffffL -+#define BIT_COEX_TABLE_1_8814B(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_1_8814B) << BIT_SHIFT_COEX_TABLE_1_8814B) -+#define BITS_COEX_TABLE_1_8814B \ -+ (BIT_MASK_COEX_TABLE_1_8814B << BIT_SHIFT_COEX_TABLE_1_8814B) -+#define BIT_CLEAR_COEX_TABLE_1_8814B(x) ((x) & (~BITS_COEX_TABLE_1_8814B)) -+#define BIT_GET_COEX_TABLE_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_1_8814B) & BIT_MASK_COEX_TABLE_1_8814B) -+#define BIT_SET_COEX_TABLE_1_8814B(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_1_8814B(x) | BIT_COEX_TABLE_1_8814B(v)) -+ -+/* 2 REG_BT_COEX_TABLE2_8814B (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_COEX_TABLE_2_8814B 0 -+#define BIT_MASK_COEX_TABLE_2_8814B 0xffffffffL -+#define BIT_COEX_TABLE_2_8814B(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_2_8814B) << BIT_SHIFT_COEX_TABLE_2_8814B) -+#define BITS_COEX_TABLE_2_8814B \ -+ (BIT_MASK_COEX_TABLE_2_8814B << BIT_SHIFT_COEX_TABLE_2_8814B) -+#define BIT_CLEAR_COEX_TABLE_2_8814B(x) ((x) & (~BITS_COEX_TABLE_2_8814B)) -+#define BIT_GET_COEX_TABLE_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_2_8814B) & BIT_MASK_COEX_TABLE_2_8814B) -+#define BIT_SET_COEX_TABLE_2_8814B(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_2_8814B(x) | BIT_COEX_TABLE_2_8814B(v)) -+ -+/* 2 REG_BT_COEX_BREAK_TABLE_8814B (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_BREAK_TABLE_2_8814B 16 -+#define BIT_MASK_BREAK_TABLE_2_8814B 0xffff -+#define BIT_BREAK_TABLE_2_8814B(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_2_8814B) << BIT_SHIFT_BREAK_TABLE_2_8814B) -+#define BITS_BREAK_TABLE_2_8814B \ -+ (BIT_MASK_BREAK_TABLE_2_8814B << BIT_SHIFT_BREAK_TABLE_2_8814B) -+#define BIT_CLEAR_BREAK_TABLE_2_8814B(x) ((x) & (~BITS_BREAK_TABLE_2_8814B)) -+#define BIT_GET_BREAK_TABLE_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_2_8814B) & BIT_MASK_BREAK_TABLE_2_8814B) -+#define BIT_SET_BREAK_TABLE_2_8814B(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_2_8814B(x) | BIT_BREAK_TABLE_2_8814B(v)) -+ -+#define BIT_SHIFT_BREAK_TABLE_1_8814B 0 -+#define BIT_MASK_BREAK_TABLE_1_8814B 0xffff -+#define BIT_BREAK_TABLE_1_8814B(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_1_8814B) << BIT_SHIFT_BREAK_TABLE_1_8814B) -+#define BITS_BREAK_TABLE_1_8814B \ -+ (BIT_MASK_BREAK_TABLE_1_8814B << BIT_SHIFT_BREAK_TABLE_1_8814B) -+#define BIT_CLEAR_BREAK_TABLE_1_8814B(x) ((x) & (~BITS_BREAK_TABLE_1_8814B)) -+#define BIT_GET_BREAK_TABLE_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_1_8814B) & BIT_MASK_BREAK_TABLE_1_8814B) -+#define BIT_SET_BREAK_TABLE_1_8814B(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_1_8814B(x) | BIT_BREAK_TABLE_1_8814B(v)) -+ -+/* 2 REG_BT_COEX_TABLE_H_8814B (BT-COEXISTENCE CONTROL REGISTER) */ -+#define BIT_PRI_MASK_RX_RESP_V1_8814B BIT(30) -+#define BIT_PRI_MASK_RXOFDM_V1_8814B BIT(29) -+#define BIT_PRI_MASK_RXCCK_V1_8814B BIT(28) -+ -+#define BIT_SHIFT_PRI_MASK_TXAC_8814B 21 -+#define BIT_MASK_PRI_MASK_TXAC_8814B 0x7f -+#define BIT_PRI_MASK_TXAC_8814B(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TXAC_8814B) << BIT_SHIFT_PRI_MASK_TXAC_8814B) -+#define BITS_PRI_MASK_TXAC_8814B \ -+ (BIT_MASK_PRI_MASK_TXAC_8814B << BIT_SHIFT_PRI_MASK_TXAC_8814B) -+#define BIT_CLEAR_PRI_MASK_TXAC_8814B(x) ((x) & (~BITS_PRI_MASK_TXAC_8814B)) -+#define BIT_GET_PRI_MASK_TXAC_8814B(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TXAC_8814B) & BIT_MASK_PRI_MASK_TXAC_8814B) -+#define BIT_SET_PRI_MASK_TXAC_8814B(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TXAC_8814B(x) | BIT_PRI_MASK_TXAC_8814B(v)) -+ -+#define BIT_SHIFT_PRI_MASK_NAV_8814B 13 -+#define BIT_MASK_PRI_MASK_NAV_8814B 0xff -+#define BIT_PRI_MASK_NAV_8814B(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NAV_8814B) << BIT_SHIFT_PRI_MASK_NAV_8814B) -+#define BITS_PRI_MASK_NAV_8814B \ -+ (BIT_MASK_PRI_MASK_NAV_8814B << BIT_SHIFT_PRI_MASK_NAV_8814B) -+#define BIT_CLEAR_PRI_MASK_NAV_8814B(x) ((x) & (~BITS_PRI_MASK_NAV_8814B)) -+#define BIT_GET_PRI_MASK_NAV_8814B(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NAV_8814B) & BIT_MASK_PRI_MASK_NAV_8814B) -+#define BIT_SET_PRI_MASK_NAV_8814B(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NAV_8814B(x) | BIT_PRI_MASK_NAV_8814B(v)) -+ -+#define BIT_PRI_MASK_CCK_V1_8814B BIT(12) -+#define BIT_PRI_MASK_OFDM_V1_8814B BIT(11) -+#define BIT_PRI_MASK_RTY_V1_8814B BIT(10) -+ -+#define BIT_SHIFT_PRI_MASK_NUM_8814B 6 -+#define BIT_MASK_PRI_MASK_NUM_8814B 0xf -+#define BIT_PRI_MASK_NUM_8814B(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NUM_8814B) << BIT_SHIFT_PRI_MASK_NUM_8814B) -+#define BITS_PRI_MASK_NUM_8814B \ -+ (BIT_MASK_PRI_MASK_NUM_8814B << BIT_SHIFT_PRI_MASK_NUM_8814B) -+#define BIT_CLEAR_PRI_MASK_NUM_8814B(x) ((x) & (~BITS_PRI_MASK_NUM_8814B)) -+#define BIT_GET_PRI_MASK_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NUM_8814B) & BIT_MASK_PRI_MASK_NUM_8814B) -+#define BIT_SET_PRI_MASK_NUM_8814B(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NUM_8814B(x) | BIT_PRI_MASK_NUM_8814B(v)) -+ -+#define BIT_SHIFT_PRI_MASK_TYPE_8814B 2 -+#define BIT_MASK_PRI_MASK_TYPE_8814B 0xf -+#define BIT_PRI_MASK_TYPE_8814B(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TYPE_8814B) << BIT_SHIFT_PRI_MASK_TYPE_8814B) -+#define BITS_PRI_MASK_TYPE_8814B \ -+ (BIT_MASK_PRI_MASK_TYPE_8814B << BIT_SHIFT_PRI_MASK_TYPE_8814B) -+#define BIT_CLEAR_PRI_MASK_TYPE_8814B(x) ((x) & (~BITS_PRI_MASK_TYPE_8814B)) -+#define BIT_GET_PRI_MASK_TYPE_8814B(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TYPE_8814B) & BIT_MASK_PRI_MASK_TYPE_8814B) -+#define BIT_SET_PRI_MASK_TYPE_8814B(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TYPE_8814B(x) | BIT_PRI_MASK_TYPE_8814B(v)) -+ -+#define BIT_OOB_V1_8814B BIT(1) -+#define BIT_ANT_SEL_V1_8814B BIT(0) -+ -+/* 2 REG_RXCMD_0_8814B */ -+#define BIT_RXCMD_EN_8814B BIT(31) -+ -+#define BIT_SHIFT_RXCMD_INFO_8814B 0 -+#define BIT_MASK_RXCMD_INFO_8814B 0x7fffffffL -+#define BIT_RXCMD_INFO_8814B(x) \ -+ (((x) & BIT_MASK_RXCMD_INFO_8814B) << BIT_SHIFT_RXCMD_INFO_8814B) -+#define BITS_RXCMD_INFO_8814B \ -+ (BIT_MASK_RXCMD_INFO_8814B << BIT_SHIFT_RXCMD_INFO_8814B) -+#define BIT_CLEAR_RXCMD_INFO_8814B(x) ((x) & (~BITS_RXCMD_INFO_8814B)) -+#define BIT_GET_RXCMD_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_INFO_8814B) & BIT_MASK_RXCMD_INFO_8814B) -+#define BIT_SET_RXCMD_INFO_8814B(x, v) \ -+ (BIT_CLEAR_RXCMD_INFO_8814B(x) | BIT_RXCMD_INFO_8814B(v)) -+ -+/* 2 REG_RXCMD_1_8814B */ -+ -+#define BIT_SHIFT_CSI_RADDR_LATCH_8814B 24 -+#define BIT_MASK_CSI_RADDR_LATCH_8814B 0xff -+#define BIT_CSI_RADDR_LATCH_8814B(x) \ -+ (((x) & BIT_MASK_CSI_RADDR_LATCH_8814B) \ -+ << BIT_SHIFT_CSI_RADDR_LATCH_8814B) -+#define BITS_CSI_RADDR_LATCH_8814B \ -+ (BIT_MASK_CSI_RADDR_LATCH_8814B << BIT_SHIFT_CSI_RADDR_LATCH_8814B) -+#define BIT_CLEAR_CSI_RADDR_LATCH_8814B(x) ((x) & (~BITS_CSI_RADDR_LATCH_8814B)) -+#define BIT_GET_CSI_RADDR_LATCH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CSI_RADDR_LATCH_8814B) & \ -+ BIT_MASK_CSI_RADDR_LATCH_8814B) -+#define BIT_SET_CSI_RADDR_LATCH_8814B(x, v) \ -+ (BIT_CLEAR_CSI_RADDR_LATCH_8814B(x) | BIT_CSI_RADDR_LATCH_8814B(v)) -+ -+#define BIT_SHIFT_CSI_WADDR_LATCH_8814B 16 -+#define BIT_MASK_CSI_WADDR_LATCH_8814B 0xff -+#define BIT_CSI_WADDR_LATCH_8814B(x) \ -+ (((x) & BIT_MASK_CSI_WADDR_LATCH_8814B) \ -+ << BIT_SHIFT_CSI_WADDR_LATCH_8814B) -+#define BITS_CSI_WADDR_LATCH_8814B \ -+ (BIT_MASK_CSI_WADDR_LATCH_8814B << BIT_SHIFT_CSI_WADDR_LATCH_8814B) -+#define BIT_CLEAR_CSI_WADDR_LATCH_8814B(x) ((x) & (~BITS_CSI_WADDR_LATCH_8814B)) -+#define BIT_GET_CSI_WADDR_LATCH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CSI_WADDR_LATCH_8814B) & \ -+ BIT_MASK_CSI_WADDR_LATCH_8814B) -+#define BIT_SET_CSI_WADDR_LATCH_8814B(x, v) \ -+ (BIT_CLEAR_CSI_WADDR_LATCH_8814B(x) | BIT_CSI_WADDR_LATCH_8814B(v)) -+ -+#define BIT_SHIFT_RXCMD_PRD_8814B 0 -+#define BIT_MASK_RXCMD_PRD_8814B 0xffff -+#define BIT_RXCMD_PRD_8814B(x) \ -+ (((x) & BIT_MASK_RXCMD_PRD_8814B) << BIT_SHIFT_RXCMD_PRD_8814B) -+#define BITS_RXCMD_PRD_8814B \ -+ (BIT_MASK_RXCMD_PRD_8814B << BIT_SHIFT_RXCMD_PRD_8814B) -+#define BIT_CLEAR_RXCMD_PRD_8814B(x) ((x) & (~BITS_RXCMD_PRD_8814B)) -+#define BIT_GET_RXCMD_PRD_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_PRD_8814B) & BIT_MASK_RXCMD_PRD_8814B) -+#define BIT_SET_RXCMD_PRD_8814B(x, v) \ -+ (BIT_CLEAR_RXCMD_PRD_8814B(x) | BIT_RXCMD_PRD_8814B(v)) -+ -+/* 2 REG_WMAC_RESP_TXINFO_8814B (RESPONSE TXINFO REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_MFB_8814B 25 -+#define BIT_MASK_WMAC_RESP_MFB_8814B 0x7f -+#define BIT_WMAC_RESP_MFB_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_MFB_8814B) << BIT_SHIFT_WMAC_RESP_MFB_8814B) -+#define BITS_WMAC_RESP_MFB_8814B \ -+ (BIT_MASK_WMAC_RESP_MFB_8814B << BIT_SHIFT_WMAC_RESP_MFB_8814B) -+#define BIT_CLEAR_WMAC_RESP_MFB_8814B(x) ((x) & (~BITS_WMAC_RESP_MFB_8814B)) -+#define BIT_GET_WMAC_RESP_MFB_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_MFB_8814B) & BIT_MASK_WMAC_RESP_MFB_8814B) -+#define BIT_SET_WMAC_RESP_MFB_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_MFB_8814B(x) | BIT_WMAC_RESP_MFB_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_ANTINF_SEL_8814B 23 -+#define BIT_MASK_WMAC_ANTINF_SEL_8814B 0x3 -+#define BIT_WMAC_ANTINF_SEL_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_ANTINF_SEL_8814B) \ -+ << BIT_SHIFT_WMAC_ANTINF_SEL_8814B) -+#define BITS_WMAC_ANTINF_SEL_8814B \ -+ (BIT_MASK_WMAC_ANTINF_SEL_8814B << BIT_SHIFT_WMAC_ANTINF_SEL_8814B) -+#define BIT_CLEAR_WMAC_ANTINF_SEL_8814B(x) ((x) & (~BITS_WMAC_ANTINF_SEL_8814B)) -+#define BIT_GET_WMAC_ANTINF_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTINF_SEL_8814B) & \ -+ BIT_MASK_WMAC_ANTINF_SEL_8814B) -+#define BIT_SET_WMAC_ANTINF_SEL_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_ANTINF_SEL_8814B(x) | BIT_WMAC_ANTINF_SEL_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_ANTSEL_SEL_8814B 21 -+#define BIT_MASK_WMAC_ANTSEL_SEL_8814B 0x3 -+#define BIT_WMAC_ANTSEL_SEL_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_ANTSEL_SEL_8814B) \ -+ << BIT_SHIFT_WMAC_ANTSEL_SEL_8814B) -+#define BITS_WMAC_ANTSEL_SEL_8814B \ -+ (BIT_MASK_WMAC_ANTSEL_SEL_8814B << BIT_SHIFT_WMAC_ANTSEL_SEL_8814B) -+#define BIT_CLEAR_WMAC_ANTSEL_SEL_8814B(x) ((x) & (~BITS_WMAC_ANTSEL_SEL_8814B)) -+#define BIT_GET_WMAC_ANTSEL_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTSEL_SEL_8814B) & \ -+ BIT_MASK_WMAC_ANTSEL_SEL_8814B) -+#define BIT_SET_WMAC_ANTSEL_SEL_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_ANTSEL_SEL_8814B(x) | BIT_WMAC_ANTSEL_SEL_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B 18 -+#define BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B 0x3 -+#define BIT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B) \ -+ << BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B) -+#define BITS_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B \ -+ (BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B \ -+ << BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B) -+#define BIT_CLEAR_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B)) -+#define BIT_GET_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B) & \ -+ BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B) -+#define BIT_SET_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B(x) | \ -+ BIT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXANT_V1_8814B 6 -+#define BIT_MASK_WMAC_RESP_TXANT_V1_8814B 0xfff -+#define BIT_WMAC_RESP_TXANT_V1_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXANT_V1_8814B) \ -+ << BIT_SHIFT_WMAC_RESP_TXANT_V1_8814B) -+#define BITS_WMAC_RESP_TXANT_V1_8814B \ -+ (BIT_MASK_WMAC_RESP_TXANT_V1_8814B \ -+ << BIT_SHIFT_WMAC_RESP_TXANT_V1_8814B) -+#define BIT_CLEAR_WMAC_RESP_TXANT_V1_8814B(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXANT_V1_8814B)) -+#define BIT_GET_WMAC_RESP_TXANT_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXANT_V1_8814B) & \ -+ BIT_MASK_WMAC_RESP_TXANT_V1_8814B) -+#define BIT_SET_WMAC_RESP_TXANT_V1_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXANT_V1_8814B(x) | \ -+ BIT_WMAC_RESP_TXANT_V1_8814B(v)) -+ -+/* 2 REG_BBPSF_CTRL_8814B */ -+#define BIT_CTL_IDLE_CLR_CSI_RPT_8814B BIT(31) -+#define BIT_WMAC_USE_NDPARATE_8814B BIT(30) -+ -+#define BIT_SHIFT_WMAC_CSI_RATE_8814B 24 -+#define BIT_MASK_WMAC_CSI_RATE_8814B 0x3f -+#define BIT_WMAC_CSI_RATE_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_CSI_RATE_8814B) << BIT_SHIFT_WMAC_CSI_RATE_8814B) -+#define BITS_WMAC_CSI_RATE_8814B \ -+ (BIT_MASK_WMAC_CSI_RATE_8814B << BIT_SHIFT_WMAC_CSI_RATE_8814B) -+#define BIT_CLEAR_WMAC_CSI_RATE_8814B(x) ((x) & (~BITS_WMAC_CSI_RATE_8814B)) -+#define BIT_GET_WMAC_CSI_RATE_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_CSI_RATE_8814B) & BIT_MASK_WMAC_CSI_RATE_8814B) -+#define BIT_SET_WMAC_CSI_RATE_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_CSI_RATE_8814B(x) | BIT_WMAC_CSI_RATE_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXRATE_8814B 16 -+#define BIT_MASK_WMAC_RESP_TXRATE_8814B 0xff -+#define BIT_WMAC_RESP_TXRATE_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXRATE_8814B) \ -+ << BIT_SHIFT_WMAC_RESP_TXRATE_8814B) -+#define BITS_WMAC_RESP_TXRATE_8814B \ -+ (BIT_MASK_WMAC_RESP_TXRATE_8814B << BIT_SHIFT_WMAC_RESP_TXRATE_8814B) -+#define BIT_CLEAR_WMAC_RESP_TXRATE_8814B(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXRATE_8814B)) -+#define BIT_GET_WMAC_RESP_TXRATE_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXRATE_8814B) & \ -+ BIT_MASK_WMAC_RESP_TXRATE_8814B) -+#define BIT_SET_WMAC_RESP_TXRATE_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXRATE_8814B(x) | BIT_WMAC_RESP_TXRATE_8814B(v)) -+ -+#define BIT_CSI_FORCE_RATE_EN_8814B BIT(15) -+ -+#define BIT_SHIFT_CSI_RSC_8814B 13 -+#define BIT_MASK_CSI_RSC_8814B 0x3 -+#define BIT_CSI_RSC_8814B(x) \ -+ (((x) & BIT_MASK_CSI_RSC_8814B) << BIT_SHIFT_CSI_RSC_8814B) -+#define BITS_CSI_RSC_8814B (BIT_MASK_CSI_RSC_8814B << BIT_SHIFT_CSI_RSC_8814B) -+#define BIT_CLEAR_CSI_RSC_8814B(x) ((x) & (~BITS_CSI_RSC_8814B)) -+#define BIT_GET_CSI_RSC_8814B(x) \ -+ (((x) >> BIT_SHIFT_CSI_RSC_8814B) & BIT_MASK_CSI_RSC_8814B) -+#define BIT_SET_CSI_RSC_8814B(x, v) \ -+ (BIT_CLEAR_CSI_RSC_8814B(x) | BIT_CSI_RSC_8814B(v)) -+ -+#define BIT_CSI_GID_SEL_8814B BIT(12) -+#define BIT_RDCSIMD_FLAG_TRIG_SEL_8814B BIT(11) -+#define BIT_NDPVLD_POS_RST_FFPTR_DIS_V1_8814B BIT(10) -+#define BIT_NDPVLD_PROTECT_RDRDY_DIS_8814B BIT(9) -+#define BIT_RDCSI_EMPTY_APPZERO_8814B BIT(8) -+#define BIT_CSI_RATE_FB_EN_8814B BIT(7) -+#define BIT_RXFIFO_WRPTR_WO_CHKSUM_8814B BIT(6) -+ -+/* 2 REG_P2P_RX_BCN_NOA_8814B (P2P RX BEACON NOA REGISTER) */ -+#define BIT_NOA_PARSER_EN_8814B BIT(15) -+ -+#define BIT_SHIFT_BSSID_SEL_V1_8814B 12 -+#define BIT_MASK_BSSID_SEL_V1_8814B 0x7 -+#define BIT_BSSID_SEL_V1_8814B(x) \ -+ (((x) & BIT_MASK_BSSID_SEL_V1_8814B) << BIT_SHIFT_BSSID_SEL_V1_8814B) -+#define BITS_BSSID_SEL_V1_8814B \ -+ (BIT_MASK_BSSID_SEL_V1_8814B << BIT_SHIFT_BSSID_SEL_V1_8814B) -+#define BIT_CLEAR_BSSID_SEL_V1_8814B(x) ((x) & (~BITS_BSSID_SEL_V1_8814B)) -+#define BIT_GET_BSSID_SEL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID_SEL_V1_8814B) & BIT_MASK_BSSID_SEL_V1_8814B) -+#define BIT_SET_BSSID_SEL_V1_8814B(x, v) \ -+ (BIT_CLEAR_BSSID_SEL_V1_8814B(x) | BIT_BSSID_SEL_V1_8814B(v)) -+ -+#define BIT_SHIFT_P2P_OUI_TYPE_8814B 0 -+#define BIT_MASK_P2P_OUI_TYPE_8814B 0xff -+#define BIT_P2P_OUI_TYPE_8814B(x) \ -+ (((x) & BIT_MASK_P2P_OUI_TYPE_8814B) << BIT_SHIFT_P2P_OUI_TYPE_8814B) -+#define BITS_P2P_OUI_TYPE_8814B \ -+ (BIT_MASK_P2P_OUI_TYPE_8814B << BIT_SHIFT_P2P_OUI_TYPE_8814B) -+#define BIT_CLEAR_P2P_OUI_TYPE_8814B(x) ((x) & (~BITS_P2P_OUI_TYPE_8814B)) -+#define BIT_GET_P2P_OUI_TYPE_8814B(x) \ -+ (((x) >> BIT_SHIFT_P2P_OUI_TYPE_8814B) & BIT_MASK_P2P_OUI_TYPE_8814B) -+#define BIT_SET_P2P_OUI_TYPE_8814B(x, v) \ -+ (BIT_CLEAR_P2P_OUI_TYPE_8814B(x) | BIT_P2P_OUI_TYPE_8814B(v)) -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_8814B (ASSOCIATED BEAMFORMER0 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8814B 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8814B 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_V1_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8814B) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8814B) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_V1_8814B \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8814B \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8814B) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_V1_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_V1_8814B)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8814B) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8814B) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_V1_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_V1_8814B(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_V1_8814B(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_H_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID0_8814B 16 -+#define BIT_MASK_R_WMAC_TXCSI_AID0_8814B 0x1ff -+#define BIT_R_WMAC_TXCSI_AID0_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID0_8814B) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID0_8814B) -+#define BITS_R_WMAC_TXCSI_AID0_8814B \ -+ (BIT_MASK_R_WMAC_TXCSI_AID0_8814B << BIT_SHIFT_R_WMAC_TXCSI_AID0_8814B) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID0_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID0_8814B)) -+#define BIT_GET_R_WMAC_TXCSI_AID0_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID0_8814B) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID0_8814B) -+#define BIT_SET_R_WMAC_TXCSI_AID0_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID0_8814B(x) | BIT_R_WMAC_TXCSI_AID0_8814B(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8814B(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_8814B (ASSOCIATED BEAMFORMER1 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8814B 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8814B 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_V1_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8814B) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8814B) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_V1_8814B \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8814B \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8814B) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V1_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_V1_8814B)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8814B) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8814B) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_V1_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V1_8814B(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_V1_8814B(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_H_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID1_8814B 16 -+#define BIT_MASK_R_WMAC_TXCSI_AID1_8814B 0x1ff -+#define BIT_R_WMAC_TXCSI_AID1_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID1_8814B) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID1_8814B) -+#define BITS_R_WMAC_TXCSI_AID1_8814B \ -+ (BIT_MASK_R_WMAC_TXCSI_AID1_8814B << BIT_SHIFT_R_WMAC_TXCSI_AID1_8814B) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID1_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID1_8814B)) -+#define BIT_GET_R_WMAC_TXCSI_AID1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID1_8814B) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID1_8814B) -+#define BIT_SET_R_WMAC_TXCSI_AID1_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID1_8814B(x) | BIT_R_WMAC_TXCSI_AID1_8814B(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8814B(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW20_8814B (TX CSI REPORT PARAMETER REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_1_8814B 16 -+#define BIT_MASK_R_WMAC_BFINFO_20M_1_8814B 0xfff -+#define BIT_R_WMAC_BFINFO_20M_1_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_1_8814B) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8814B) -+#define BITS_R_WMAC_BFINFO_20M_1_8814B \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_1_8814B \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8814B) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_1_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_1_8814B)) -+#define BIT_GET_R_WMAC_BFINFO_20M_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_1_8814B) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_1_8814B) -+#define BIT_SET_R_WMAC_BFINFO_20M_1_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_1_8814B(x) | \ -+ BIT_R_WMAC_BFINFO_20M_1_8814B(v)) -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_0_8814B 0 -+#define BIT_MASK_R_WMAC_BFINFO_20M_0_8814B 0xfff -+#define BIT_R_WMAC_BFINFO_20M_0_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_0_8814B) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8814B) -+#define BITS_R_WMAC_BFINFO_20M_0_8814B \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_0_8814B \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8814B) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_0_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_0_8814B)) -+#define BIT_GET_R_WMAC_BFINFO_20M_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_0_8814B) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_0_8814B) -+#define BIT_SET_R_WMAC_BFINFO_20M_0_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_0_8814B(x) | \ -+ BIT_R_WMAC_BFINFO_20M_0_8814B(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW40_8814B (TX CSI REPORT PARAMETER_BW40 REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_ANTD_8814B 12 -+#define BIT_MASK_WMAC_RESP_ANTD_8814B 0xf -+#define BIT_WMAC_RESP_ANTD_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTD_8814B) \ -+ << BIT_SHIFT_WMAC_RESP_ANTD_8814B) -+#define BITS_WMAC_RESP_ANTD_8814B \ -+ (BIT_MASK_WMAC_RESP_ANTD_8814B << BIT_SHIFT_WMAC_RESP_ANTD_8814B) -+#define BIT_CLEAR_WMAC_RESP_ANTD_8814B(x) ((x) & (~BITS_WMAC_RESP_ANTD_8814B)) -+#define BIT_GET_WMAC_RESP_ANTD_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTD_8814B) & \ -+ BIT_MASK_WMAC_RESP_ANTD_8814B) -+#define BIT_SET_WMAC_RESP_ANTD_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTD_8814B(x) | BIT_WMAC_RESP_ANTD_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTC_8814B 8 -+#define BIT_MASK_WMAC_RESP_ANTC_8814B 0xf -+#define BIT_WMAC_RESP_ANTC_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTC_8814B) \ -+ << BIT_SHIFT_WMAC_RESP_ANTC_8814B) -+#define BITS_WMAC_RESP_ANTC_8814B \ -+ (BIT_MASK_WMAC_RESP_ANTC_8814B << BIT_SHIFT_WMAC_RESP_ANTC_8814B) -+#define BIT_CLEAR_WMAC_RESP_ANTC_8814B(x) ((x) & (~BITS_WMAC_RESP_ANTC_8814B)) -+#define BIT_GET_WMAC_RESP_ANTC_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTC_8814B) & \ -+ BIT_MASK_WMAC_RESP_ANTC_8814B) -+#define BIT_SET_WMAC_RESP_ANTC_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTC_8814B(x) | BIT_WMAC_RESP_ANTC_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTB_8814B 4 -+#define BIT_MASK_WMAC_RESP_ANTB_8814B 0xf -+#define BIT_WMAC_RESP_ANTB_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTB_8814B) \ -+ << BIT_SHIFT_WMAC_RESP_ANTB_8814B) -+#define BITS_WMAC_RESP_ANTB_8814B \ -+ (BIT_MASK_WMAC_RESP_ANTB_8814B << BIT_SHIFT_WMAC_RESP_ANTB_8814B) -+#define BIT_CLEAR_WMAC_RESP_ANTB_8814B(x) ((x) & (~BITS_WMAC_RESP_ANTB_8814B)) -+#define BIT_GET_WMAC_RESP_ANTB_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTB_8814B) & \ -+ BIT_MASK_WMAC_RESP_ANTB_8814B) -+#define BIT_SET_WMAC_RESP_ANTB_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTB_8814B(x) | BIT_WMAC_RESP_ANTB_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTA_8814B 0 -+#define BIT_MASK_WMAC_RESP_ANTA_8814B 0xf -+#define BIT_WMAC_RESP_ANTA_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTA_8814B) \ -+ << BIT_SHIFT_WMAC_RESP_ANTA_8814B) -+#define BITS_WMAC_RESP_ANTA_8814B \ -+ (BIT_MASK_WMAC_RESP_ANTA_8814B << BIT_SHIFT_WMAC_RESP_ANTA_8814B) -+#define BIT_CLEAR_WMAC_RESP_ANTA_8814B(x) ((x) & (~BITS_WMAC_RESP_ANTA_8814B)) -+#define BIT_GET_WMAC_RESP_ANTA_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTA_8814B) & \ -+ BIT_MASK_WMAC_RESP_ANTA_8814B) -+#define BIT_SET_WMAC_RESP_ANTA_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTA_8814B(x) | BIT_WMAC_RESP_ANTA_8814B(v)) -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_BCN_PSR_RPT2_8814B (BEACON PARSER REPORT REGISTER2) */ -+ -+#define BIT_SHIFT_DTIM_CNT2_8814B 24 -+#define BIT_MASK_DTIM_CNT2_8814B 0xff -+#define BIT_DTIM_CNT2_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_CNT2_8814B) << BIT_SHIFT_DTIM_CNT2_8814B) -+#define BITS_DTIM_CNT2_8814B \ -+ (BIT_MASK_DTIM_CNT2_8814B << BIT_SHIFT_DTIM_CNT2_8814B) -+#define BIT_CLEAR_DTIM_CNT2_8814B(x) ((x) & (~BITS_DTIM_CNT2_8814B)) -+#define BIT_GET_DTIM_CNT2_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT2_8814B) & BIT_MASK_DTIM_CNT2_8814B) -+#define BIT_SET_DTIM_CNT2_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_CNT2_8814B(x) | BIT_DTIM_CNT2_8814B(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD2_8814B 16 -+#define BIT_MASK_DTIM_PERIOD2_8814B 0xff -+#define BIT_DTIM_PERIOD2_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD2_8814B) << BIT_SHIFT_DTIM_PERIOD2_8814B) -+#define BITS_DTIM_PERIOD2_8814B \ -+ (BIT_MASK_DTIM_PERIOD2_8814B << BIT_SHIFT_DTIM_PERIOD2_8814B) -+#define BIT_CLEAR_DTIM_PERIOD2_8814B(x) ((x) & (~BITS_DTIM_PERIOD2_8814B)) -+#define BIT_GET_DTIM_PERIOD2_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD2_8814B) & BIT_MASK_DTIM_PERIOD2_8814B) -+#define BIT_SET_DTIM_PERIOD2_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD2_8814B(x) | BIT_DTIM_PERIOD2_8814B(v)) -+ -+#define BIT_DTIM2_8814B BIT(15) -+#define BIT_TIM2_8814B BIT(14) -+#define BIT_RPT_VALID_8814B BIT(13) -+ -+#define BIT_SHIFT_PS_AID_2_8814B 0 -+#define BIT_MASK_PS_AID_2_8814B 0x7ff -+#define BIT_PS_AID_2_8814B(x) \ -+ (((x) & BIT_MASK_PS_AID_2_8814B) << BIT_SHIFT_PS_AID_2_8814B) -+#define BITS_PS_AID_2_8814B \ -+ (BIT_MASK_PS_AID_2_8814B << BIT_SHIFT_PS_AID_2_8814B) -+#define BIT_CLEAR_PS_AID_2_8814B(x) ((x) & (~BITS_PS_AID_2_8814B)) -+#define BIT_GET_PS_AID_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_2_8814B) & BIT_MASK_PS_AID_2_8814B) -+#define BIT_SET_PS_AID_2_8814B(x, v) \ -+ (BIT_CLEAR_PS_AID_2_8814B(x) | BIT_PS_AID_2_8814B(v)) -+ -+/* 2 REG_BCN_PSR_RPT3_8814B (BEACON PARSER REPORT REGISTER3) */ -+ -+#define BIT_SHIFT_DTIM_CNT3_8814B 24 -+#define BIT_MASK_DTIM_CNT3_8814B 0xff -+#define BIT_DTIM_CNT3_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_CNT3_8814B) << BIT_SHIFT_DTIM_CNT3_8814B) -+#define BITS_DTIM_CNT3_8814B \ -+ (BIT_MASK_DTIM_CNT3_8814B << BIT_SHIFT_DTIM_CNT3_8814B) -+#define BIT_CLEAR_DTIM_CNT3_8814B(x) ((x) & (~BITS_DTIM_CNT3_8814B)) -+#define BIT_GET_DTIM_CNT3_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT3_8814B) & BIT_MASK_DTIM_CNT3_8814B) -+#define BIT_SET_DTIM_CNT3_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_CNT3_8814B(x) | BIT_DTIM_CNT3_8814B(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD3_8814B 16 -+#define BIT_MASK_DTIM_PERIOD3_8814B 0xff -+#define BIT_DTIM_PERIOD3_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD3_8814B) << BIT_SHIFT_DTIM_PERIOD3_8814B) -+#define BITS_DTIM_PERIOD3_8814B \ -+ (BIT_MASK_DTIM_PERIOD3_8814B << BIT_SHIFT_DTIM_PERIOD3_8814B) -+#define BIT_CLEAR_DTIM_PERIOD3_8814B(x) ((x) & (~BITS_DTIM_PERIOD3_8814B)) -+#define BIT_GET_DTIM_PERIOD3_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD3_8814B) & BIT_MASK_DTIM_PERIOD3_8814B) -+#define BIT_SET_DTIM_PERIOD3_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD3_8814B(x) | BIT_DTIM_PERIOD3_8814B(v)) -+ -+#define BIT_DTIM3_8814B BIT(15) -+#define BIT_TIM3_8814B BIT(14) -+#define BIT_RPT_VALID_8814B BIT(13) -+ -+#define BIT_SHIFT_PS_AID_3_8814B 0 -+#define BIT_MASK_PS_AID_3_8814B 0x7ff -+#define BIT_PS_AID_3_8814B(x) \ -+ (((x) & BIT_MASK_PS_AID_3_8814B) << BIT_SHIFT_PS_AID_3_8814B) -+#define BITS_PS_AID_3_8814B \ -+ (BIT_MASK_PS_AID_3_8814B << BIT_SHIFT_PS_AID_3_8814B) -+#define BIT_CLEAR_PS_AID_3_8814B(x) ((x) & (~BITS_PS_AID_3_8814B)) -+#define BIT_GET_PS_AID_3_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_3_8814B) & BIT_MASK_PS_AID_3_8814B) -+#define BIT_SET_PS_AID_3_8814B(x, v) \ -+ (BIT_CLEAR_PS_AID_3_8814B(x) | BIT_PS_AID_3_8814B(v)) -+ -+/* 2 REG_BCN_PSR_RPT4_8814B (BEACON PARSER REPORT REGISTER4) */ -+ -+#define BIT_SHIFT_DTIM_CNT4_8814B 24 -+#define BIT_MASK_DTIM_CNT4_8814B 0xff -+#define BIT_DTIM_CNT4_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_CNT4_8814B) << BIT_SHIFT_DTIM_CNT4_8814B) -+#define BITS_DTIM_CNT4_8814B \ -+ (BIT_MASK_DTIM_CNT4_8814B << BIT_SHIFT_DTIM_CNT4_8814B) -+#define BIT_CLEAR_DTIM_CNT4_8814B(x) ((x) & (~BITS_DTIM_CNT4_8814B)) -+#define BIT_GET_DTIM_CNT4_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT4_8814B) & BIT_MASK_DTIM_CNT4_8814B) -+#define BIT_SET_DTIM_CNT4_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_CNT4_8814B(x) | BIT_DTIM_CNT4_8814B(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD4_8814B 16 -+#define BIT_MASK_DTIM_PERIOD4_8814B 0xff -+#define BIT_DTIM_PERIOD4_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD4_8814B) << BIT_SHIFT_DTIM_PERIOD4_8814B) -+#define BITS_DTIM_PERIOD4_8814B \ -+ (BIT_MASK_DTIM_PERIOD4_8814B << BIT_SHIFT_DTIM_PERIOD4_8814B) -+#define BIT_CLEAR_DTIM_PERIOD4_8814B(x) ((x) & (~BITS_DTIM_PERIOD4_8814B)) -+#define BIT_GET_DTIM_PERIOD4_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD4_8814B) & BIT_MASK_DTIM_PERIOD4_8814B) -+#define BIT_SET_DTIM_PERIOD4_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD4_8814B(x) | BIT_DTIM_PERIOD4_8814B(v)) -+ -+#define BIT_DTIM4_8814B BIT(15) -+#define BIT_TIM4_8814B BIT(14) -+#define BIT_RPT_VALID_8814B BIT(13) -+ -+#define BIT_SHIFT_PS_AID_4_8814B 0 -+#define BIT_MASK_PS_AID_4_8814B 0x7ff -+#define BIT_PS_AID_4_8814B(x) \ -+ (((x) & BIT_MASK_PS_AID_4_8814B) << BIT_SHIFT_PS_AID_4_8814B) -+#define BITS_PS_AID_4_8814B \ -+ (BIT_MASK_PS_AID_4_8814B << BIT_SHIFT_PS_AID_4_8814B) -+#define BIT_CLEAR_PS_AID_4_8814B(x) ((x) & (~BITS_PS_AID_4_8814B)) -+#define BIT_GET_PS_AID_4_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_4_8814B) & BIT_MASK_PS_AID_4_8814B) -+#define BIT_SET_PS_AID_4_8814B(x, v) \ -+ (BIT_CLEAR_PS_AID_4_8814B(x) | BIT_PS_AID_4_8814B(v)) -+ -+/* 2 REG_A1_ADDR_MASK_8814B (A1 ADDR MASK REGISTER) */ -+ -+#define BIT_SHIFT_A1_ADDR_MASK_8814B 0 -+#define BIT_MASK_A1_ADDR_MASK_8814B 0xffffffffL -+#define BIT_A1_ADDR_MASK_8814B(x) \ -+ (((x) & BIT_MASK_A1_ADDR_MASK_8814B) << BIT_SHIFT_A1_ADDR_MASK_8814B) -+#define BITS_A1_ADDR_MASK_8814B \ -+ (BIT_MASK_A1_ADDR_MASK_8814B << BIT_SHIFT_A1_ADDR_MASK_8814B) -+#define BIT_CLEAR_A1_ADDR_MASK_8814B(x) ((x) & (~BITS_A1_ADDR_MASK_8814B)) -+#define BIT_GET_A1_ADDR_MASK_8814B(x) \ -+ (((x) >> BIT_SHIFT_A1_ADDR_MASK_8814B) & BIT_MASK_A1_ADDR_MASK_8814B) -+#define BIT_SET_A1_ADDR_MASK_8814B(x, v) \ -+ (BIT_CLEAR_A1_ADDR_MASK_8814B(x) | BIT_A1_ADDR_MASK_8814B(v)) -+ -+/* 2 REG_RXPSF_CTRL_8814B */ -+#define BIT_RXGCK_FIFOTHR_EN_8814B BIT(28) -+ -+#define BIT_SHIFT_RXGCK_VHT_FIFOTHR_8814B 26 -+#define BIT_MASK_RXGCK_VHT_FIFOTHR_8814B 0x3 -+#define BIT_RXGCK_VHT_FIFOTHR_8814B(x) \ -+ (((x) & BIT_MASK_RXGCK_VHT_FIFOTHR_8814B) \ -+ << BIT_SHIFT_RXGCK_VHT_FIFOTHR_8814B) -+#define BITS_RXGCK_VHT_FIFOTHR_8814B \ -+ (BIT_MASK_RXGCK_VHT_FIFOTHR_8814B << BIT_SHIFT_RXGCK_VHT_FIFOTHR_8814B) -+#define BIT_CLEAR_RXGCK_VHT_FIFOTHR_8814B(x) \ -+ ((x) & (~BITS_RXGCK_VHT_FIFOTHR_8814B)) -+#define BIT_GET_RXGCK_VHT_FIFOTHR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_VHT_FIFOTHR_8814B) & \ -+ BIT_MASK_RXGCK_VHT_FIFOTHR_8814B) -+#define BIT_SET_RXGCK_VHT_FIFOTHR_8814B(x, v) \ -+ (BIT_CLEAR_RXGCK_VHT_FIFOTHR_8814B(x) | BIT_RXGCK_VHT_FIFOTHR_8814B(v)) -+ -+#define BIT_SHIFT_RXGCK_HT_FIFOTHR_8814B 24 -+#define BIT_MASK_RXGCK_HT_FIFOTHR_8814B 0x3 -+#define BIT_RXGCK_HT_FIFOTHR_8814B(x) \ -+ (((x) & BIT_MASK_RXGCK_HT_FIFOTHR_8814B) \ -+ << BIT_SHIFT_RXGCK_HT_FIFOTHR_8814B) -+#define BITS_RXGCK_HT_FIFOTHR_8814B \ -+ (BIT_MASK_RXGCK_HT_FIFOTHR_8814B << BIT_SHIFT_RXGCK_HT_FIFOTHR_8814B) -+#define BIT_CLEAR_RXGCK_HT_FIFOTHR_8814B(x) \ -+ ((x) & (~BITS_RXGCK_HT_FIFOTHR_8814B)) -+#define BIT_GET_RXGCK_HT_FIFOTHR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_HT_FIFOTHR_8814B) & \ -+ BIT_MASK_RXGCK_HT_FIFOTHR_8814B) -+#define BIT_SET_RXGCK_HT_FIFOTHR_8814B(x, v) \ -+ (BIT_CLEAR_RXGCK_HT_FIFOTHR_8814B(x) | BIT_RXGCK_HT_FIFOTHR_8814B(v)) -+ -+#define BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8814B 22 -+#define BIT_MASK_RXGCK_OFDM_FIFOTHR_8814B 0x3 -+#define BIT_RXGCK_OFDM_FIFOTHR_8814B(x) \ -+ (((x) & BIT_MASK_RXGCK_OFDM_FIFOTHR_8814B) \ -+ << BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8814B) -+#define BITS_RXGCK_OFDM_FIFOTHR_8814B \ -+ (BIT_MASK_RXGCK_OFDM_FIFOTHR_8814B \ -+ << BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8814B) -+#define BIT_CLEAR_RXGCK_OFDM_FIFOTHR_8814B(x) \ -+ ((x) & (~BITS_RXGCK_OFDM_FIFOTHR_8814B)) -+#define BIT_GET_RXGCK_OFDM_FIFOTHR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8814B) & \ -+ BIT_MASK_RXGCK_OFDM_FIFOTHR_8814B) -+#define BIT_SET_RXGCK_OFDM_FIFOTHR_8814B(x, v) \ -+ (BIT_CLEAR_RXGCK_OFDM_FIFOTHR_8814B(x) | \ -+ BIT_RXGCK_OFDM_FIFOTHR_8814B(v)) -+ -+#define BIT_SHIFT_RXGCK_CCK_FIFOTHR_8814B 20 -+#define BIT_MASK_RXGCK_CCK_FIFOTHR_8814B 0x3 -+#define BIT_RXGCK_CCK_FIFOTHR_8814B(x) \ -+ (((x) & BIT_MASK_RXGCK_CCK_FIFOTHR_8814B) \ -+ << BIT_SHIFT_RXGCK_CCK_FIFOTHR_8814B) -+#define BITS_RXGCK_CCK_FIFOTHR_8814B \ -+ (BIT_MASK_RXGCK_CCK_FIFOTHR_8814B << BIT_SHIFT_RXGCK_CCK_FIFOTHR_8814B) -+#define BIT_CLEAR_RXGCK_CCK_FIFOTHR_8814B(x) \ -+ ((x) & (~BITS_RXGCK_CCK_FIFOTHR_8814B)) -+#define BIT_GET_RXGCK_CCK_FIFOTHR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_CCK_FIFOTHR_8814B) & \ -+ BIT_MASK_RXGCK_CCK_FIFOTHR_8814B) -+#define BIT_SET_RXGCK_CCK_FIFOTHR_8814B(x, v) \ -+ (BIT_CLEAR_RXGCK_CCK_FIFOTHR_8814B(x) | BIT_RXGCK_CCK_FIFOTHR_8814B(v)) -+ -+#define BIT_SHIFT_RXGCK_ENTRY_DELAY_8814B 17 -+#define BIT_MASK_RXGCK_ENTRY_DELAY_8814B 0x7 -+#define BIT_RXGCK_ENTRY_DELAY_8814B(x) \ -+ (((x) & BIT_MASK_RXGCK_ENTRY_DELAY_8814B) \ -+ << BIT_SHIFT_RXGCK_ENTRY_DELAY_8814B) -+#define BITS_RXGCK_ENTRY_DELAY_8814B \ -+ (BIT_MASK_RXGCK_ENTRY_DELAY_8814B << BIT_SHIFT_RXGCK_ENTRY_DELAY_8814B) -+#define BIT_CLEAR_RXGCK_ENTRY_DELAY_8814B(x) \ -+ ((x) & (~BITS_RXGCK_ENTRY_DELAY_8814B)) -+#define BIT_GET_RXGCK_ENTRY_DELAY_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_ENTRY_DELAY_8814B) & \ -+ BIT_MASK_RXGCK_ENTRY_DELAY_8814B) -+#define BIT_SET_RXGCK_ENTRY_DELAY_8814B(x, v) \ -+ (BIT_CLEAR_RXGCK_ENTRY_DELAY_8814B(x) | BIT_RXGCK_ENTRY_DELAY_8814B(v)) -+ -+#define BIT_RXGCK_OFDMCCA_EN_8814B BIT(16) -+ -+#define BIT_SHIFT_RXPSF_PKTLENTHR_8814B 13 -+#define BIT_MASK_RXPSF_PKTLENTHR_8814B 0x7 -+#define BIT_RXPSF_PKTLENTHR_8814B(x) \ -+ (((x) & BIT_MASK_RXPSF_PKTLENTHR_8814B) \ -+ << BIT_SHIFT_RXPSF_PKTLENTHR_8814B) -+#define BITS_RXPSF_PKTLENTHR_8814B \ -+ (BIT_MASK_RXPSF_PKTLENTHR_8814B << BIT_SHIFT_RXPSF_PKTLENTHR_8814B) -+#define BIT_CLEAR_RXPSF_PKTLENTHR_8814B(x) ((x) & (~BITS_RXPSF_PKTLENTHR_8814B)) -+#define BIT_GET_RXPSF_PKTLENTHR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPSF_PKTLENTHR_8814B) & \ -+ BIT_MASK_RXPSF_PKTLENTHR_8814B) -+#define BIT_SET_RXPSF_PKTLENTHR_8814B(x, v) \ -+ (BIT_CLEAR_RXPSF_PKTLENTHR_8814B(x) | BIT_RXPSF_PKTLENTHR_8814B(v)) -+ -+#define BIT_RXPSF_CTRLEN_8814B BIT(12) -+#define BIT_RXPSF_VHTCHKEN_8814B BIT(11) -+#define BIT_RXPSF_HTCHKEN_8814B BIT(10) -+#define BIT_RXPSF_OFDMCHKEN_8814B BIT(9) -+#define BIT_RXPSF_CCKCHKEN_8814B BIT(8) -+#define BIT_RXPSF_OFDMRST_8814B BIT(7) -+#define BIT_RXPSF_CCKRST_8814B BIT(6) -+#define BIT_RXPSF_MHCHKEN_8814B BIT(5) -+#define BIT_RXPSF_CONT_ERRCHKEN_8814B BIT(4) -+#define BIT_RXPSF_ALL_ERRCHKEN_8814B BIT(3) -+ -+#define BIT_SHIFT_RXPSF_ERRTHR_8814B 0 -+#define BIT_MASK_RXPSF_ERRTHR_8814B 0x7 -+#define BIT_RXPSF_ERRTHR_8814B(x) \ -+ (((x) & BIT_MASK_RXPSF_ERRTHR_8814B) << BIT_SHIFT_RXPSF_ERRTHR_8814B) -+#define BITS_RXPSF_ERRTHR_8814B \ -+ (BIT_MASK_RXPSF_ERRTHR_8814B << BIT_SHIFT_RXPSF_ERRTHR_8814B) -+#define BIT_CLEAR_RXPSF_ERRTHR_8814B(x) ((x) & (~BITS_RXPSF_ERRTHR_8814B)) -+#define BIT_GET_RXPSF_ERRTHR_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXPSF_ERRTHR_8814B) & BIT_MASK_RXPSF_ERRTHR_8814B) -+#define BIT_SET_RXPSF_ERRTHR_8814B(x, v) \ -+ (BIT_CLEAR_RXPSF_ERRTHR_8814B(x) | BIT_RXPSF_ERRTHR_8814B(v)) -+ -+/* 2 REG_RXPSF_TYPE_CTRL_8814B */ -+#define BIT_RXPSF_DATA15EN_8814B BIT(31) -+#define BIT_RXPSF_DATA14EN_8814B BIT(30) -+#define BIT_RXPSF_DATA13EN_8814B BIT(29) -+#define BIT_RXPSF_DATA12EN_8814B BIT(28) -+#define BIT_RXPSF_DATA11EN_8814B BIT(27) -+#define BIT_RXPSF_DATA10EN_8814B BIT(26) -+#define BIT_RXPSF_DATA9EN_8814B BIT(25) -+#define BIT_RXPSF_DATA8EN_8814B BIT(24) -+#define BIT_RXPSF_DATA7EN_8814B BIT(23) -+#define BIT_RXPSF_DATA6EN_8814B BIT(22) -+#define BIT_RXPSF_DATA5EN_8814B BIT(21) -+#define BIT_RXPSF_DATA4EN_8814B BIT(20) -+#define BIT_RXPSF_DATA3EN_8814B BIT(19) -+#define BIT_RXPSF_DATA2EN_8814B BIT(18) -+#define BIT_RXPSF_DATA1EN_8814B BIT(17) -+#define BIT_RXPSF_DATA0EN_8814B BIT(16) -+#define BIT_RXPSF_MGT15EN_8814B BIT(15) -+#define BIT_RXPSF_MGT14EN_8814B BIT(14) -+#define BIT_RXPSF_MGT13EN_8814B BIT(13) -+#define BIT_RXPSF_MGT12EN_8814B BIT(12) -+#define BIT_RXPSF_MGT11EN_8814B BIT(11) -+#define BIT_RXPSF_MGT10EN_8814B BIT(10) -+#define BIT_RXPSF_MGT9EN_8814B BIT(9) -+#define BIT_RXPSF_MGT8EN_8814B BIT(8) -+#define BIT_RXPSF_MGT7EN_8814B BIT(7) -+#define BIT_RXPSF_MGT6EN_8814B BIT(6) -+#define BIT_RXPSF_MGT5EN_8814B BIT(5) -+#define BIT_RXPSF_MGT4EN_8814B BIT(4) -+#define BIT_RXPSF_MGT3EN_8814B BIT(3) -+#define BIT_RXPSF_MGT2EN_8814B BIT(2) -+#define BIT_RXPSF_MGT1EN_8814B BIT(1) -+#define BIT_RXPSF_MGT0EN_8814B BIT(0) -+ -+/* 2 REG_CAM_ACCESS_CTRL_8814B */ -+#define BIT_INDIRECT_ERR_8814B BIT(6) -+#define BIT_DIRECT_ERR_8814B BIT(5) -+#define BIT_DIR_ACCESS_EN_RX_BA_8814B BIT(4) -+#define BIT_DIR_ACCESS_EN_ADDRCAM_8814B BIT(3) -+#define BIT_DIR_ACCESS_EN_KEY_8814B BIT(2) -+#define BIT_DIR_ACCESS_EN_WOWLAN_8814B BIT(1) -+#define BIT_DIR_ACCESS_EN_FW_FILTER_8814B BIT(0) -+ -+/* 2 REG_CUT_AMSDU_CTRL_8814B */ -+#define BIT__CUT_AMSDU_CHKLEN_EN_8814B BIT(31) -+#define BIT_EN_CUT_AMSDU_8814B BIT(30) -+ -+#define BIT_SHIFT_CUT_AMSDU_CHKLEN_L_TH_8814B 16 -+#define BIT_MASK_CUT_AMSDU_CHKLEN_L_TH_8814B 0xff -+#define BIT_CUT_AMSDU_CHKLEN_L_TH_8814B(x) \ -+ (((x) & BIT_MASK_CUT_AMSDU_CHKLEN_L_TH_8814B) \ -+ << BIT_SHIFT_CUT_AMSDU_CHKLEN_L_TH_8814B) -+#define BITS_CUT_AMSDU_CHKLEN_L_TH_8814B \ -+ (BIT_MASK_CUT_AMSDU_CHKLEN_L_TH_8814B \ -+ << BIT_SHIFT_CUT_AMSDU_CHKLEN_L_TH_8814B) -+#define BIT_CLEAR_CUT_AMSDU_CHKLEN_L_TH_8814B(x) \ -+ ((x) & (~BITS_CUT_AMSDU_CHKLEN_L_TH_8814B)) -+#define BIT_GET_CUT_AMSDU_CHKLEN_L_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CUT_AMSDU_CHKLEN_L_TH_8814B) & \ -+ BIT_MASK_CUT_AMSDU_CHKLEN_L_TH_8814B) -+#define BIT_SET_CUT_AMSDU_CHKLEN_L_TH_8814B(x, v) \ -+ (BIT_CLEAR_CUT_AMSDU_CHKLEN_L_TH_8814B(x) | \ -+ BIT_CUT_AMSDU_CHKLEN_L_TH_8814B(v)) -+ -+#define BIT_SHIFT_CUT_AMSDU_CHKLEN_H_TH_8814B 0 -+#define BIT_MASK_CUT_AMSDU_CHKLEN_H_TH_8814B 0xffff -+#define BIT_CUT_AMSDU_CHKLEN_H_TH_8814B(x) \ -+ (((x) & BIT_MASK_CUT_AMSDU_CHKLEN_H_TH_8814B) \ -+ << BIT_SHIFT_CUT_AMSDU_CHKLEN_H_TH_8814B) -+#define BITS_CUT_AMSDU_CHKLEN_H_TH_8814B \ -+ (BIT_MASK_CUT_AMSDU_CHKLEN_H_TH_8814B \ -+ << BIT_SHIFT_CUT_AMSDU_CHKLEN_H_TH_8814B) -+#define BIT_CLEAR_CUT_AMSDU_CHKLEN_H_TH_8814B(x) \ -+ ((x) & (~BITS_CUT_AMSDU_CHKLEN_H_TH_8814B)) -+#define BIT_GET_CUT_AMSDU_CHKLEN_H_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_CUT_AMSDU_CHKLEN_H_TH_8814B) & \ -+ BIT_MASK_CUT_AMSDU_CHKLEN_H_TH_8814B) -+#define BIT_SET_CUT_AMSDU_CHKLEN_H_TH_8814B(x, v) \ -+ (BIT_CLEAR_CUT_AMSDU_CHKLEN_H_TH_8814B(x) | \ -+ BIT_CUT_AMSDU_CHKLEN_H_TH_8814B(v)) -+ -+/* 2 REG_MACID2_8814B (MAC ID2 REGISTER) */ -+ -+#define BIT_SHIFT_MACID2_V1_8814B 0 -+#define BIT_MASK_MACID2_V1_8814B 0xffffffffL -+#define BIT_MACID2_V1_8814B(x) \ -+ (((x) & BIT_MASK_MACID2_V1_8814B) << BIT_SHIFT_MACID2_V1_8814B) -+#define BITS_MACID2_V1_8814B \ -+ (BIT_MASK_MACID2_V1_8814B << BIT_SHIFT_MACID2_V1_8814B) -+#define BIT_CLEAR_MACID2_V1_8814B(x) ((x) & (~BITS_MACID2_V1_8814B)) -+#define BIT_GET_MACID2_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID2_V1_8814B) & BIT_MASK_MACID2_V1_8814B) -+#define BIT_SET_MACID2_V1_8814B(x, v) \ -+ (BIT_CLEAR_MACID2_V1_8814B(x) | BIT_MACID2_V1_8814B(v)) -+ -+/* 2 REG_MACID2_H_8814B (MAC ID2 REGISTER) */ -+ -+#define BIT_SHIFT_MACID2_H_V1_8814B 0 -+#define BIT_MASK_MACID2_H_V1_8814B 0xffff -+#define BIT_MACID2_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_MACID2_H_V1_8814B) << BIT_SHIFT_MACID2_H_V1_8814B) -+#define BITS_MACID2_H_V1_8814B \ -+ (BIT_MASK_MACID2_H_V1_8814B << BIT_SHIFT_MACID2_H_V1_8814B) -+#define BIT_CLEAR_MACID2_H_V1_8814B(x) ((x) & (~BITS_MACID2_H_V1_8814B)) -+#define BIT_GET_MACID2_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID2_H_V1_8814B) & BIT_MASK_MACID2_H_V1_8814B) -+#define BIT_SET_MACID2_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_MACID2_H_V1_8814B(x) | BIT_MACID2_H_V1_8814B(v)) -+ -+/* 2 REG_BSSID2_8814B (BSSID2 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID2_V1_8814B 0 -+#define BIT_MASK_BSSID2_V1_8814B 0xffffffffL -+#define BIT_BSSID2_V1_8814B(x) \ -+ (((x) & BIT_MASK_BSSID2_V1_8814B) << BIT_SHIFT_BSSID2_V1_8814B) -+#define BITS_BSSID2_V1_8814B \ -+ (BIT_MASK_BSSID2_V1_8814B << BIT_SHIFT_BSSID2_V1_8814B) -+#define BIT_CLEAR_BSSID2_V1_8814B(x) ((x) & (~BITS_BSSID2_V1_8814B)) -+#define BIT_GET_BSSID2_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_V1_8814B) & BIT_MASK_BSSID2_V1_8814B) -+#define BIT_SET_BSSID2_V1_8814B(x, v) \ -+ (BIT_CLEAR_BSSID2_V1_8814B(x) | BIT_BSSID2_V1_8814B(v)) -+ -+/* 2 REG_BSSID2_H_8814B (BSSID2 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID2_H_V1_8814B 0 -+#define BIT_MASK_BSSID2_H_V1_8814B 0xffff -+#define BIT_BSSID2_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_BSSID2_H_V1_8814B) << BIT_SHIFT_BSSID2_H_V1_8814B) -+#define BITS_BSSID2_H_V1_8814B \ -+ (BIT_MASK_BSSID2_H_V1_8814B << BIT_SHIFT_BSSID2_H_V1_8814B) -+#define BIT_CLEAR_BSSID2_H_V1_8814B(x) ((x) & (~BITS_BSSID2_H_V1_8814B)) -+#define BIT_GET_BSSID2_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_H_V1_8814B) & BIT_MASK_BSSID2_H_V1_8814B) -+#define BIT_SET_BSSID2_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_BSSID2_H_V1_8814B(x) | BIT_BSSID2_H_V1_8814B(v)) -+ -+/* 2 REG_MACID3_8814B (MAC ID3 REGISTER) */ -+ -+#define BIT_SHIFT_MACID3_V1_8814B 0 -+#define BIT_MASK_MACID3_V1_8814B 0xffffffffL -+#define BIT_MACID3_V1_8814B(x) \ -+ (((x) & BIT_MASK_MACID3_V1_8814B) << BIT_SHIFT_MACID3_V1_8814B) -+#define BITS_MACID3_V1_8814B \ -+ (BIT_MASK_MACID3_V1_8814B << BIT_SHIFT_MACID3_V1_8814B) -+#define BIT_CLEAR_MACID3_V1_8814B(x) ((x) & (~BITS_MACID3_V1_8814B)) -+#define BIT_GET_MACID3_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID3_V1_8814B) & BIT_MASK_MACID3_V1_8814B) -+#define BIT_SET_MACID3_V1_8814B(x, v) \ -+ (BIT_CLEAR_MACID3_V1_8814B(x) | BIT_MACID3_V1_8814B(v)) -+ -+/* 2 REG_MACID3_H_8814B (MAC ID3 REGISTER) */ -+ -+#define BIT_SHIFT_MACID3_H_V1_8814B 0 -+#define BIT_MASK_MACID3_H_V1_8814B 0xffff -+#define BIT_MACID3_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_MACID3_H_V1_8814B) << BIT_SHIFT_MACID3_H_V1_8814B) -+#define BITS_MACID3_H_V1_8814B \ -+ (BIT_MASK_MACID3_H_V1_8814B << BIT_SHIFT_MACID3_H_V1_8814B) -+#define BIT_CLEAR_MACID3_H_V1_8814B(x) ((x) & (~BITS_MACID3_H_V1_8814B)) -+#define BIT_GET_MACID3_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID3_H_V1_8814B) & BIT_MASK_MACID3_H_V1_8814B) -+#define BIT_SET_MACID3_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_MACID3_H_V1_8814B(x) | BIT_MACID3_H_V1_8814B(v)) -+ -+/* 2 REG_BSSID3_8814B (BSSID3 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID3_V1_8814B 0 -+#define BIT_MASK_BSSID3_V1_8814B 0xffffffffL -+#define BIT_BSSID3_V1_8814B(x) \ -+ (((x) & BIT_MASK_BSSID3_V1_8814B) << BIT_SHIFT_BSSID3_V1_8814B) -+#define BITS_BSSID3_V1_8814B \ -+ (BIT_MASK_BSSID3_V1_8814B << BIT_SHIFT_BSSID3_V1_8814B) -+#define BIT_CLEAR_BSSID3_V1_8814B(x) ((x) & (~BITS_BSSID3_V1_8814B)) -+#define BIT_GET_BSSID3_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_V1_8814B) & BIT_MASK_BSSID3_V1_8814B) -+#define BIT_SET_BSSID3_V1_8814B(x, v) \ -+ (BIT_CLEAR_BSSID3_V1_8814B(x) | BIT_BSSID3_V1_8814B(v)) -+ -+/* 2 REG_BSSID3_H_8814B (BSSID3 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID3_H_V1_8814B 0 -+#define BIT_MASK_BSSID3_H_V1_8814B 0xffff -+#define BIT_BSSID3_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_BSSID3_H_V1_8814B) << BIT_SHIFT_BSSID3_H_V1_8814B) -+#define BITS_BSSID3_H_V1_8814B \ -+ (BIT_MASK_BSSID3_H_V1_8814B << BIT_SHIFT_BSSID3_H_V1_8814B) -+#define BIT_CLEAR_BSSID3_H_V1_8814B(x) ((x) & (~BITS_BSSID3_H_V1_8814B)) -+#define BIT_GET_BSSID3_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_H_V1_8814B) & BIT_MASK_BSSID3_H_V1_8814B) -+#define BIT_SET_BSSID3_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_BSSID3_H_V1_8814B(x) | BIT_BSSID3_H_V1_8814B(v)) -+ -+/* 2 REG_MACID4_8814B (MAC ID4 REGISTER) */ -+ -+#define BIT_SHIFT_MACID4_V1_8814B 0 -+#define BIT_MASK_MACID4_V1_8814B 0xffffffffL -+#define BIT_MACID4_V1_8814B(x) \ -+ (((x) & BIT_MASK_MACID4_V1_8814B) << BIT_SHIFT_MACID4_V1_8814B) -+#define BITS_MACID4_V1_8814B \ -+ (BIT_MASK_MACID4_V1_8814B << BIT_SHIFT_MACID4_V1_8814B) -+#define BIT_CLEAR_MACID4_V1_8814B(x) ((x) & (~BITS_MACID4_V1_8814B)) -+#define BIT_GET_MACID4_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID4_V1_8814B) & BIT_MASK_MACID4_V1_8814B) -+#define BIT_SET_MACID4_V1_8814B(x, v) \ -+ (BIT_CLEAR_MACID4_V1_8814B(x) | BIT_MACID4_V1_8814B(v)) -+ -+/* 2 REG_MACID4_H_8814B (MAC ID4 REGISTER) */ -+ -+#define BIT_SHIFT_MACID4_H_V1_8814B 0 -+#define BIT_MASK_MACID4_H_V1_8814B 0xffff -+#define BIT_MACID4_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_MACID4_H_V1_8814B) << BIT_SHIFT_MACID4_H_V1_8814B) -+#define BITS_MACID4_H_V1_8814B \ -+ (BIT_MASK_MACID4_H_V1_8814B << BIT_SHIFT_MACID4_H_V1_8814B) -+#define BIT_CLEAR_MACID4_H_V1_8814B(x) ((x) & (~BITS_MACID4_H_V1_8814B)) -+#define BIT_GET_MACID4_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID4_H_V1_8814B) & BIT_MASK_MACID4_H_V1_8814B) -+#define BIT_SET_MACID4_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_MACID4_H_V1_8814B(x) | BIT_MACID4_H_V1_8814B(v)) -+ -+/* 2 REG_BSSID4_8814B (BSSID4 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID4_V1_8814B 0 -+#define BIT_MASK_BSSID4_V1_8814B 0xffffffffL -+#define BIT_BSSID4_V1_8814B(x) \ -+ (((x) & BIT_MASK_BSSID4_V1_8814B) << BIT_SHIFT_BSSID4_V1_8814B) -+#define BITS_BSSID4_V1_8814B \ -+ (BIT_MASK_BSSID4_V1_8814B << BIT_SHIFT_BSSID4_V1_8814B) -+#define BIT_CLEAR_BSSID4_V1_8814B(x) ((x) & (~BITS_BSSID4_V1_8814B)) -+#define BIT_GET_BSSID4_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_V1_8814B) & BIT_MASK_BSSID4_V1_8814B) -+#define BIT_SET_BSSID4_V1_8814B(x, v) \ -+ (BIT_CLEAR_BSSID4_V1_8814B(x) | BIT_BSSID4_V1_8814B(v)) -+ -+/* 2 REG_BSSID4_H_8814B (BSSID4 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID4_H_V1_8814B 0 -+#define BIT_MASK_BSSID4_H_V1_8814B 0xffff -+#define BIT_BSSID4_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_BSSID4_H_V1_8814B) << BIT_SHIFT_BSSID4_H_V1_8814B) -+#define BITS_BSSID4_H_V1_8814B \ -+ (BIT_MASK_BSSID4_H_V1_8814B << BIT_SHIFT_BSSID4_H_V1_8814B) -+#define BIT_CLEAR_BSSID4_H_V1_8814B(x) ((x) & (~BITS_BSSID4_H_V1_8814B)) -+#define BIT_GET_BSSID4_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_H_V1_8814B) & BIT_MASK_BSSID4_H_V1_8814B) -+#define BIT_SET_BSSID4_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_BSSID4_H_V1_8814B(x) | BIT_BSSID4_H_V1_8814B(v)) -+ -+/* 2 REG_NOA_REPORT_8814B */ -+ -+#define BIT_SHIFT_NOA_RPT_8814B 0 -+#define BIT_MASK_NOA_RPT_8814B 0xffffffffL -+#define BIT_NOA_RPT_8814B(x) \ -+ (((x) & BIT_MASK_NOA_RPT_8814B) << BIT_SHIFT_NOA_RPT_8814B) -+#define BITS_NOA_RPT_8814B (BIT_MASK_NOA_RPT_8814B << BIT_SHIFT_NOA_RPT_8814B) -+#define BIT_CLEAR_NOA_RPT_8814B(x) ((x) & (~BITS_NOA_RPT_8814B)) -+#define BIT_GET_NOA_RPT_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_RPT_8814B) & BIT_MASK_NOA_RPT_8814B) -+#define BIT_SET_NOA_RPT_8814B(x, v) \ -+ (BIT_CLEAR_NOA_RPT_8814B(x) | BIT_NOA_RPT_8814B(v)) -+ -+/* 2 REG_NOA_REPORT_1_8814B */ -+ -+#define BIT_SHIFT_NOA_RPT_1_8814B 0 -+#define BIT_MASK_NOA_RPT_1_8814B 0xffffffffL -+#define BIT_NOA_RPT_1_8814B(x) \ -+ (((x) & BIT_MASK_NOA_RPT_1_8814B) << BIT_SHIFT_NOA_RPT_1_8814B) -+#define BITS_NOA_RPT_1_8814B \ -+ (BIT_MASK_NOA_RPT_1_8814B << BIT_SHIFT_NOA_RPT_1_8814B) -+#define BIT_CLEAR_NOA_RPT_1_8814B(x) ((x) & (~BITS_NOA_RPT_1_8814B)) -+#define BIT_GET_NOA_RPT_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_RPT_1_8814B) & BIT_MASK_NOA_RPT_1_8814B) -+#define BIT_SET_NOA_RPT_1_8814B(x, v) \ -+ (BIT_CLEAR_NOA_RPT_1_8814B(x) | BIT_NOA_RPT_1_8814B(v)) -+ -+/* 2 REG_NOA_REPORT_2_8814B */ -+ -+#define BIT_SHIFT_NOA_RPT_2_8814B 0 -+#define BIT_MASK_NOA_RPT_2_8814B 0xffffffffL -+#define BIT_NOA_RPT_2_8814B(x) \ -+ (((x) & BIT_MASK_NOA_RPT_2_8814B) << BIT_SHIFT_NOA_RPT_2_8814B) -+#define BITS_NOA_RPT_2_8814B \ -+ (BIT_MASK_NOA_RPT_2_8814B << BIT_SHIFT_NOA_RPT_2_8814B) -+#define BIT_CLEAR_NOA_RPT_2_8814B(x) ((x) & (~BITS_NOA_RPT_2_8814B)) -+#define BIT_GET_NOA_RPT_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_RPT_2_8814B) & BIT_MASK_NOA_RPT_2_8814B) -+#define BIT_SET_NOA_RPT_2_8814B(x, v) \ -+ (BIT_CLEAR_NOA_RPT_2_8814B(x) | BIT_NOA_RPT_2_8814B(v)) -+ -+/* 2 REG_NOA_REPORT_3_8814B */ -+ -+#define BIT_SHIFT_NOA_RPT_3_8814B 0 -+#define BIT_MASK_NOA_RPT_3_8814B 0xff -+#define BIT_NOA_RPT_3_8814B(x) \ -+ (((x) & BIT_MASK_NOA_RPT_3_8814B) << BIT_SHIFT_NOA_RPT_3_8814B) -+#define BITS_NOA_RPT_3_8814B \ -+ (BIT_MASK_NOA_RPT_3_8814B << BIT_SHIFT_NOA_RPT_3_8814B) -+#define BIT_CLEAR_NOA_RPT_3_8814B(x) ((x) & (~BITS_NOA_RPT_3_8814B)) -+#define BIT_GET_NOA_RPT_3_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOA_RPT_3_8814B) & BIT_MASK_NOA_RPT_3_8814B) -+#define BIT_SET_NOA_RPT_3_8814B(x, v) \ -+ (BIT_CLEAR_NOA_RPT_3_8814B(x) | BIT_NOA_RPT_3_8814B(v)) -+ -+/* 2 REG_PWRBIT_SETTING_8814B */ -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWCTL_EN_8814B BIT(15) -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWDATA_EN_8814B BIT(14) -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWACT_EN_8814B BIT(13) -+#define BIT_CLI3_PWR_ST_V1_8814B BIT(12) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWCTL_EN_8814B BIT(11) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWDATA_EN_8814B BIT(10) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWACT_EN_8814B BIT(9) -+#define BIT_CLI2_PWR_ST_V1_8814B BIT(8) -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWCTL_EN_8814B BIT(7) -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWDATA_EN_8814B BIT(6) -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWACT_EN_8814B BIT(5) -+#define BIT_CLI1_PWR_ST_V1_8814B BIT(4) -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWCTL_EN_8814B BIT(3) -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWDATA_EN_8814B BIT(2) -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWACT_EN_8814B BIT(1) -+#define BIT_CLI0_PWR_ST_V1_8814B BIT(0) -+ -+/* 2 REG_GENERAL_OPTION_8814B */ -+#define BIT_FIX_MSDU_TAIL_WR_8814B BIT(12) -+#define BIT_FIX_MSDU_SHIFT_8814B BIT(11) -+#define BIT_RXFIFO_GNT_CUT_8814B BIT(8) -+#define BIT_WMAC_FIX_FIRST_MPDU_WITH_PHYSTS_8814B BIT(5) -+#define BIT_DUMMY_RXD_FCS_ERROR_MASK_EN_8814B BIT(4) -+#define BIT_PATTERN_MATCH_FIX_EN_8814B BIT(3) -+#define BIT_TXSERV_FIELD_SEL_8814B BIT(2) -+#define BIT_RXVHT_LEN_SEL_8814B BIT(1) -+#define BIT_RXMIC_PROTECT_EN_8814B BIT(0) -+ -+/* 2 REG_FWPHYFF_RCR_8814B */ -+#define BIT_RCR2_AAMSDU_8814B BIT(25) -+#define BIT_RCR2_CBSSID_BCN_8814B BIT(24) -+#define BIT_RCR2_ACRC32_8814B BIT(23) -+#define BIT_RCR2_TA_BCN_8814B BIT(22) -+#define BIT_RCR2_CBSSID_DATA_8814B BIT(21) -+#define BIT_RCR2_ADD3_8814B BIT(20) -+#define BIT_RCR2_AB_8814B BIT(19) -+#define BIT_RCR2_AM_8814B BIT(18) -+#define BIT_RCR2_APM_8814B BIT(17) -+#define BIT_RCR2_AAP_8814B BIT(16) -+#define BIT_RCR1_AAMSDU_8814B BIT(9) -+#define BIT_RCR1_CBSSID_BCN_8814B BIT(8) -+#define BIT_RCR1_ACRC32_8814B BIT(7) -+#define BIT_RCR1_TA_BCN_8814B BIT(6) -+#define BIT_RCR1_CBSSID_DATA_8814B BIT(5) -+#define BIT_RCR1_ADD3_8814B BIT(4) -+#define BIT_RCR1_AB_8814B BIT(3) -+#define BIT_RCR1_AM_8814B BIT(2) -+#define BIT_RCR1_APM_8814B BIT(1) -+#define BIT_RCR1_AAP_8814B BIT(0) -+ -+/* 2 REG_ADDRCAM_WRITE_CONTENT_8814B */ -+ -+#define BIT_SHIFT_ADDRCAM_WDATA_8814B 0 -+#define BIT_MASK_ADDRCAM_WDATA_8814B 0xffffffffL -+#define BIT_ADDRCAM_WDATA_8814B(x) \ -+ (((x) & BIT_MASK_ADDRCAM_WDATA_8814B) << BIT_SHIFT_ADDRCAM_WDATA_8814B) -+#define BITS_ADDRCAM_WDATA_8814B \ -+ (BIT_MASK_ADDRCAM_WDATA_8814B << BIT_SHIFT_ADDRCAM_WDATA_8814B) -+#define BIT_CLEAR_ADDRCAM_WDATA_8814B(x) ((x) & (~BITS_ADDRCAM_WDATA_8814B)) -+#define BIT_GET_ADDRCAM_WDATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_ADDRCAM_WDATA_8814B) & BIT_MASK_ADDRCAM_WDATA_8814B) -+#define BIT_SET_ADDRCAM_WDATA_8814B(x, v) \ -+ (BIT_CLEAR_ADDRCAM_WDATA_8814B(x) | BIT_ADDRCAM_WDATA_8814B(v)) -+ -+/* 2 REG_ADDRCAM_READ_CONTENT_8814B */ -+ -+#define BIT_SHIFT_ADDRCAM_RDATA_8814B 0 -+#define BIT_MASK_ADDRCAM_RDATA_8814B 0xffffffffL -+#define BIT_ADDRCAM_RDATA_8814B(x) \ -+ (((x) & BIT_MASK_ADDRCAM_RDATA_8814B) << BIT_SHIFT_ADDRCAM_RDATA_8814B) -+#define BITS_ADDRCAM_RDATA_8814B \ -+ (BIT_MASK_ADDRCAM_RDATA_8814B << BIT_SHIFT_ADDRCAM_RDATA_8814B) -+#define BIT_CLEAR_ADDRCAM_RDATA_8814B(x) ((x) & (~BITS_ADDRCAM_RDATA_8814B)) -+#define BIT_GET_ADDRCAM_RDATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_ADDRCAM_RDATA_8814B) & BIT_MASK_ADDRCAM_RDATA_8814B) -+#define BIT_SET_ADDRCAM_RDATA_8814B(x, v) \ -+ (BIT_CLEAR_ADDRCAM_RDATA_8814B(x) | BIT_ADDRCAM_RDATA_8814B(v)) -+ -+/* 2 REG_ADDRCAM_CFG_8814B */ -+#define BIT_ADDRCAM_POLL_8814B BIT(31) -+#define BIT__ADDRCAM_WT_EN_8814B BIT(30) -+#define BIT_CLRADDRCAM_8814B BIT(29) -+ -+#define BIT_SHIFT__ADDRCAM_ADDR_8814B 8 -+#define BIT_MASK__ADDRCAM_ADDR_8814B 0x3ff -+#define BIT__ADDRCAM_ADDR_8814B(x) \ -+ (((x) & BIT_MASK__ADDRCAM_ADDR_8814B) << BIT_SHIFT__ADDRCAM_ADDR_8814B) -+#define BITS__ADDRCAM_ADDR_8814B \ -+ (BIT_MASK__ADDRCAM_ADDR_8814B << BIT_SHIFT__ADDRCAM_ADDR_8814B) -+#define BIT_CLEAR__ADDRCAM_ADDR_8814B(x) ((x) & (~BITS__ADDRCAM_ADDR_8814B)) -+#define BIT_GET__ADDRCAM_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT__ADDRCAM_ADDR_8814B) & BIT_MASK__ADDRCAM_ADDR_8814B) -+#define BIT_SET__ADDRCAM_ADDR_8814B(x, v) \ -+ (BIT_CLEAR__ADDRCAM_ADDR_8814B(x) | BIT__ADDRCAM_ADDR_8814B(v)) -+ -+#define BIT_SHIFT_ADDRCAM_RANGE_8814B 0 -+#define BIT_MASK_ADDRCAM_RANGE_8814B 0x7f -+#define BIT_ADDRCAM_RANGE_8814B(x) \ -+ (((x) & BIT_MASK_ADDRCAM_RANGE_8814B) << BIT_SHIFT_ADDRCAM_RANGE_8814B) -+#define BITS_ADDRCAM_RANGE_8814B \ -+ (BIT_MASK_ADDRCAM_RANGE_8814B << BIT_SHIFT_ADDRCAM_RANGE_8814B) -+#define BIT_CLEAR_ADDRCAM_RANGE_8814B(x) ((x) & (~BITS_ADDRCAM_RANGE_8814B)) -+#define BIT_GET_ADDRCAM_RANGE_8814B(x) \ -+ (((x) >> BIT_SHIFT_ADDRCAM_RANGE_8814B) & BIT_MASK_ADDRCAM_RANGE_8814B) -+#define BIT_SET_ADDRCAM_RANGE_8814B(x, v) \ -+ (BIT_CLEAR_ADDRCAM_RANGE_8814B(x) | BIT_ADDRCAM_RANGE_8814B(v)) -+ -+/* 2 REG_CSI_RRSR_8814B */ -+#define BIT_CSI_LDPC_EN_8814B BIT(29) -+#define BIT_CSI_STBC_EN_8814B BIT(28) -+ -+#define BIT_SHIFT_CSI_RRSC_BITMAP_8814B 4 -+#define BIT_MASK_CSI_RRSC_BITMAP_8814B 0xffffff -+#define BIT_CSI_RRSC_BITMAP_8814B(x) \ -+ (((x) & BIT_MASK_CSI_RRSC_BITMAP_8814B) \ -+ << BIT_SHIFT_CSI_RRSC_BITMAP_8814B) -+#define BITS_CSI_RRSC_BITMAP_8814B \ -+ (BIT_MASK_CSI_RRSC_BITMAP_8814B << BIT_SHIFT_CSI_RRSC_BITMAP_8814B) -+#define BIT_CLEAR_CSI_RRSC_BITMAP_8814B(x) ((x) & (~BITS_CSI_RRSC_BITMAP_8814B)) -+#define BIT_GET_CSI_RRSC_BITMAP_8814B(x) \ -+ (((x) >> BIT_SHIFT_CSI_RRSC_BITMAP_8814B) & \ -+ BIT_MASK_CSI_RRSC_BITMAP_8814B) -+#define BIT_SET_CSI_RRSC_BITMAP_8814B(x, v) \ -+ (BIT_CLEAR_CSI_RRSC_BITMAP_8814B(x) | BIT_CSI_RRSC_BITMAP_8814B(v)) -+ -+#define BIT_SHIFT_OFDM_LEN_TH_8814B 0 -+#define BIT_MASK_OFDM_LEN_TH_8814B 0xf -+#define BIT_OFDM_LEN_TH_8814B(x) \ -+ (((x) & BIT_MASK_OFDM_LEN_TH_8814B) << BIT_SHIFT_OFDM_LEN_TH_8814B) -+#define BITS_OFDM_LEN_TH_8814B \ -+ (BIT_MASK_OFDM_LEN_TH_8814B << BIT_SHIFT_OFDM_LEN_TH_8814B) -+#define BIT_CLEAR_OFDM_LEN_TH_8814B(x) ((x) & (~BITS_OFDM_LEN_TH_8814B)) -+#define BIT_GET_OFDM_LEN_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_OFDM_LEN_TH_8814B) & BIT_MASK_OFDM_LEN_TH_8814B) -+#define BIT_SET_OFDM_LEN_TH_8814B(x, v) \ -+ (BIT_CLEAR_OFDM_LEN_TH_8814B(x) | BIT_OFDM_LEN_TH_8814B(v)) -+ -+/* 2 REG_MU_BF_OPTION_8814B */ -+#define BIT_WMAC_RESP_NONSTA1_DIS_8814B BIT(7) -+#define BIT_WMAC_TXMU_ACKPOLICY_EN_8814B BIT(6) -+ -+#define BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8814B 4 -+#define BIT_MASK_WMAC_TXMU_ACKPOLICY_8814B 0x3 -+#define BIT_WMAC_TXMU_ACKPOLICY_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_TXMU_ACKPOLICY_8814B) \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8814B) -+#define BITS_WMAC_TXMU_ACKPOLICY_8814B \ -+ (BIT_MASK_WMAC_TXMU_ACKPOLICY_8814B \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8814B) -+#define BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8814B(x) \ -+ ((x) & (~BITS_WMAC_TXMU_ACKPOLICY_8814B)) -+#define BIT_GET_WMAC_TXMU_ACKPOLICY_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8814B) & \ -+ BIT_MASK_WMAC_TXMU_ACKPOLICY_8814B) -+#define BIT_SET_WMAC_TXMU_ACKPOLICY_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8814B(x) | \ -+ BIT_WMAC_TXMU_ACKPOLICY_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8814B 1 -+#define BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8814B 0x7 -+#define BIT_WMAC_MU_BFEE_PORT_SEL_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8814B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8814B) -+#define BITS_WMAC_MU_BFEE_PORT_SEL_8814B \ -+ (BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8814B \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8814B) -+#define BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8814B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE_PORT_SEL_8814B)) -+#define BIT_GET_WMAC_MU_BFEE_PORT_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8814B) & \ -+ BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8814B) -+#define BIT_SET_WMAC_MU_BFEE_PORT_SEL_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8814B(x) | \ -+ BIT_WMAC_MU_BFEE_PORT_SEL_8814B(v)) -+ -+#define BIT_WMAC_MU_BFEE_DIS_8814B BIT(0) -+ -+/* 2 REG_WMAC_PAUSE_BB_CLR_TH_8814B */ -+ -+#define BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8814B 0 -+#define BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8814B 0xff -+#define BIT_WMAC_PAUSE_BB_CLR_TH_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8814B) \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8814B) -+#define BITS_WMAC_PAUSE_BB_CLR_TH_8814B \ -+ (BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8814B \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8814B) -+#define BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8814B(x) \ -+ ((x) & (~BITS_WMAC_PAUSE_BB_CLR_TH_8814B)) -+#define BIT_GET_WMAC_PAUSE_BB_CLR_TH_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8814B) & \ -+ BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8814B) -+#define BIT_SET_WMAC_PAUSE_BB_CLR_TH_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8814B(x) | \ -+ BIT_WMAC_PAUSE_BB_CLR_TH_8814B(v)) -+ -+/* 2 REG_WMAC_MULBK_BUF_8814B */ -+ -+#define BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8814B 0 -+#define BIT_MASK_WMAC_MULBK_PAGE_SIZE_8814B 0xff -+#define BIT_WMAC_MULBK_PAGE_SIZE_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MULBK_PAGE_SIZE_8814B) \ -+ << BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8814B) -+#define BITS_WMAC_MULBK_PAGE_SIZE_8814B \ -+ (BIT_MASK_WMAC_MULBK_PAGE_SIZE_8814B \ -+ << BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8814B) -+#define BIT_CLEAR_WMAC_MULBK_PAGE_SIZE_8814B(x) \ -+ ((x) & (~BITS_WMAC_MULBK_PAGE_SIZE_8814B)) -+#define BIT_GET_WMAC_MULBK_PAGE_SIZE_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8814B) & \ -+ BIT_MASK_WMAC_MULBK_PAGE_SIZE_8814B) -+#define BIT_SET_WMAC_MULBK_PAGE_SIZE_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MULBK_PAGE_SIZE_8814B(x) | \ -+ BIT_WMAC_MULBK_PAGE_SIZE_8814B(v)) -+ -+/* 2 REG_WMAC_MU_OPTION_8814B */ -+#define BIT_NOCHK_BFPOLL_BMP_8814B BIT(7) -+ -+/* 2 REG_WMAC_MU_BF_CTL_8814B */ -+#define BIT_WMAC_INVLD_BFPRT_CHK_8814B BIT(15) -+#define BIT_WMAC_RETXBFRPTSEQ_UPD_8814B BIT(14) -+ -+#define BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8814B 12 -+#define BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8814B 0x3 -+#define BIT_WMAC_MU_BFRPTSEG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8814B) \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8814B) -+#define BITS_WMAC_MU_BFRPTSEG_SEL_8814B \ -+ (BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8814B \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8814B) -+#define BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8814B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFRPTSEG_SEL_8814B)) -+#define BIT_GET_WMAC_MU_BFRPTSEG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8814B) & \ -+ BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8814B) -+#define BIT_SET_WMAC_MU_BFRPTSEG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8814B(x) | \ -+ BIT_WMAC_MU_BFRPTSEG_SEL_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BF_MYAID_8814B 0 -+#define BIT_MASK_WMAC_MU_BF_MYAID_8814B 0xfff -+#define BIT_WMAC_MU_BF_MYAID_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BF_MYAID_8814B) \ -+ << BIT_SHIFT_WMAC_MU_BF_MYAID_8814B) -+#define BITS_WMAC_MU_BF_MYAID_8814B \ -+ (BIT_MASK_WMAC_MU_BF_MYAID_8814B << BIT_SHIFT_WMAC_MU_BF_MYAID_8814B) -+#define BIT_CLEAR_WMAC_MU_BF_MYAID_8814B(x) \ -+ ((x) & (~BITS_WMAC_MU_BF_MYAID_8814B)) -+#define BIT_GET_WMAC_MU_BF_MYAID_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BF_MYAID_8814B) & \ -+ BIT_MASK_WMAC_MU_BF_MYAID_8814B) -+#define BIT_SET_WMAC_MU_BF_MYAID_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BF_MYAID_8814B(x) | BIT_WMAC_MU_BF_MYAID_8814B(v)) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA_8814B */ -+ -+#define BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8814B 13 -+#define BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8814B 0x7 -+#define BIT_BFRPT_PARA_USERID_SEL_V1_8814B(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8814B) \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8814B) -+#define BITS_BFRPT_PARA_USERID_SEL_V1_8814B \ -+ (BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8814B \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8814B) -+#define BIT_CLEAR_BFRPT_PARA_USERID_SEL_V1_8814B(x) \ -+ ((x) & (~BITS_BFRPT_PARA_USERID_SEL_V1_8814B)) -+#define BIT_GET_BFRPT_PARA_USERID_SEL_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8814B) & \ -+ BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8814B) -+#define BIT_SET_BFRPT_PARA_USERID_SEL_V1_8814B(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_USERID_SEL_V1_8814B(x) | \ -+ BIT_BFRPT_PARA_USERID_SEL_V1_8814B(v)) -+ -+#define BIT_SHIFT_BFRPT_PARA_V1_8814B 0 -+#define BIT_MASK_BFRPT_PARA_V1_8814B 0x1fff -+#define BIT_BFRPT_PARA_V1_8814B(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_V1_8814B) << BIT_SHIFT_BFRPT_PARA_V1_8814B) -+#define BITS_BFRPT_PARA_V1_8814B \ -+ (BIT_MASK_BFRPT_PARA_V1_8814B << BIT_SHIFT_BFRPT_PARA_V1_8814B) -+#define BIT_CLEAR_BFRPT_PARA_V1_8814B(x) ((x) & (~BITS_BFRPT_PARA_V1_8814B)) -+#define BIT_GET_BFRPT_PARA_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_V1_8814B) & BIT_MASK_BFRPT_PARA_V1_8814B) -+#define BIT_SET_BFRPT_PARA_V1_8814B(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_V1_8814B(x) | BIT_BFRPT_PARA_V1_8814B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE2_8814B */ -+#define BIT_STATUS_BFEE2_8814B BIT(10) -+#define BIT_WMAC_MU_BFEE2_EN_8814B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE2_AID_8814B 0 -+#define BIT_MASK_WMAC_MU_BFEE2_AID_8814B 0x1ff -+#define BIT_WMAC_MU_BFEE2_AID_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE2_AID_8814B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE2_AID_8814B) -+#define BITS_WMAC_MU_BFEE2_AID_8814B \ -+ (BIT_MASK_WMAC_MU_BFEE2_AID_8814B << BIT_SHIFT_WMAC_MU_BFEE2_AID_8814B) -+#define BIT_CLEAR_WMAC_MU_BFEE2_AID_8814B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE2_AID_8814B)) -+#define BIT_GET_WMAC_MU_BFEE2_AID_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE2_AID_8814B) & \ -+ BIT_MASK_WMAC_MU_BFEE2_AID_8814B) -+#define BIT_SET_WMAC_MU_BFEE2_AID_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE2_AID_8814B(x) | BIT_WMAC_MU_BFEE2_AID_8814B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE3_8814B */ -+#define BIT_STATUS_BFEE3_8814B BIT(10) -+#define BIT_WMAC_MU_BFEE3_EN_8814B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE3_AID_8814B 0 -+#define BIT_MASK_WMAC_MU_BFEE3_AID_8814B 0x1ff -+#define BIT_WMAC_MU_BFEE3_AID_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE3_AID_8814B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE3_AID_8814B) -+#define BITS_WMAC_MU_BFEE3_AID_8814B \ -+ (BIT_MASK_WMAC_MU_BFEE3_AID_8814B << BIT_SHIFT_WMAC_MU_BFEE3_AID_8814B) -+#define BIT_CLEAR_WMAC_MU_BFEE3_AID_8814B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE3_AID_8814B)) -+#define BIT_GET_WMAC_MU_BFEE3_AID_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE3_AID_8814B) & \ -+ BIT_MASK_WMAC_MU_BFEE3_AID_8814B) -+#define BIT_SET_WMAC_MU_BFEE3_AID_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE3_AID_8814B(x) | BIT_WMAC_MU_BFEE3_AID_8814B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE4_8814B */ -+#define BIT_STATUS_BFEE4_8814B BIT(10) -+#define BIT_WMAC_MU_BFEE4_EN_8814B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE4_AID_8814B 0 -+#define BIT_MASK_WMAC_MU_BFEE4_AID_8814B 0x1ff -+#define BIT_WMAC_MU_BFEE4_AID_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE4_AID_8814B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE4_AID_8814B) -+#define BITS_WMAC_MU_BFEE4_AID_8814B \ -+ (BIT_MASK_WMAC_MU_BFEE4_AID_8814B << BIT_SHIFT_WMAC_MU_BFEE4_AID_8814B) -+#define BIT_CLEAR_WMAC_MU_BFEE4_AID_8814B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE4_AID_8814B)) -+#define BIT_GET_WMAC_MU_BFEE4_AID_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE4_AID_8814B) & \ -+ BIT_MASK_WMAC_MU_BFEE4_AID_8814B) -+#define BIT_SET_WMAC_MU_BFEE4_AID_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE4_AID_8814B(x) | BIT_WMAC_MU_BFEE4_AID_8814B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE5_8814B */ -+#define BIT_BIT_STATUS_BFEE5_8814B BIT(10) -+#define BIT_WMAC_MU_BFEE5_EN_8814B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE5_AID_8814B 0 -+#define BIT_MASK_WMAC_MU_BFEE5_AID_8814B 0x1ff -+#define BIT_WMAC_MU_BFEE5_AID_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE5_AID_8814B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE5_AID_8814B) -+#define BITS_WMAC_MU_BFEE5_AID_8814B \ -+ (BIT_MASK_WMAC_MU_BFEE5_AID_8814B << BIT_SHIFT_WMAC_MU_BFEE5_AID_8814B) -+#define BIT_CLEAR_WMAC_MU_BFEE5_AID_8814B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE5_AID_8814B)) -+#define BIT_GET_WMAC_MU_BFEE5_AID_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE5_AID_8814B) & \ -+ BIT_MASK_WMAC_MU_BFEE5_AID_8814B) -+#define BIT_SET_WMAC_MU_BFEE5_AID_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE5_AID_8814B(x) | BIT_WMAC_MU_BFEE5_AID_8814B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE6_8814B */ -+#define BIT_STATUS_BFEE6_8814B BIT(10) -+#define BIT_WMAC_MU_BFEE6_EN_8814B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE6_AID_8814B 0 -+#define BIT_MASK_WMAC_MU_BFEE6_AID_8814B 0x1ff -+#define BIT_WMAC_MU_BFEE6_AID_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE6_AID_8814B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE6_AID_8814B) -+#define BITS_WMAC_MU_BFEE6_AID_8814B \ -+ (BIT_MASK_WMAC_MU_BFEE6_AID_8814B << BIT_SHIFT_WMAC_MU_BFEE6_AID_8814B) -+#define BIT_CLEAR_WMAC_MU_BFEE6_AID_8814B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE6_AID_8814B)) -+#define BIT_GET_WMAC_MU_BFEE6_AID_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE6_AID_8814B) & \ -+ BIT_MASK_WMAC_MU_BFEE6_AID_8814B) -+#define BIT_SET_WMAC_MU_BFEE6_AID_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE6_AID_8814B(x) | BIT_WMAC_MU_BFEE6_AID_8814B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE7_8814B */ -+#define BIT_STATUS_BFEE7_8814B BIT(10) -+#define BIT_WMAC_MU_BFEE7_EN_8814B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE7_AID_8814B 0 -+#define BIT_MASK_WMAC_MU_BFEE7_AID_8814B 0x1ff -+#define BIT_WMAC_MU_BFEE7_AID_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE7_AID_8814B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE7_AID_8814B) -+#define BITS_WMAC_MU_BFEE7_AID_8814B \ -+ (BIT_MASK_WMAC_MU_BFEE7_AID_8814B << BIT_SHIFT_WMAC_MU_BFEE7_AID_8814B) -+#define BIT_CLEAR_WMAC_MU_BFEE7_AID_8814B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE7_AID_8814B)) -+#define BIT_GET_WMAC_MU_BFEE7_AID_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE7_AID_8814B) & \ -+ BIT_MASK_WMAC_MU_BFEE7_AID_8814B) -+#define BIT_SET_WMAC_MU_BFEE7_AID_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE7_AID_8814B(x) | BIT_WMAC_MU_BFEE7_AID_8814B(v)) -+ -+/* 2 REG_WMAC_BB_STOP_RX_COUNTER_8814B */ -+#define BIT_RST_ALL_COUNTER_8814B BIT(31) -+ -+#define BIT_SHIFT_ABORT_RX_VBON_COUNTER_8814B 16 -+#define BIT_MASK_ABORT_RX_VBON_COUNTER_8814B 0xff -+#define BIT_ABORT_RX_VBON_COUNTER_8814B(x) \ -+ (((x) & BIT_MASK_ABORT_RX_VBON_COUNTER_8814B) \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8814B) -+#define BITS_ABORT_RX_VBON_COUNTER_8814B \ -+ (BIT_MASK_ABORT_RX_VBON_COUNTER_8814B \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8814B) -+#define BIT_CLEAR_ABORT_RX_VBON_COUNTER_8814B(x) \ -+ ((x) & (~BITS_ABORT_RX_VBON_COUNTER_8814B)) -+#define BIT_GET_ABORT_RX_VBON_COUNTER_8814B(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_VBON_COUNTER_8814B) & \ -+ BIT_MASK_ABORT_RX_VBON_COUNTER_8814B) -+#define BIT_SET_ABORT_RX_VBON_COUNTER_8814B(x, v) \ -+ (BIT_CLEAR_ABORT_RX_VBON_COUNTER_8814B(x) | \ -+ BIT_ABORT_RX_VBON_COUNTER_8814B(v)) -+ -+#define BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8814B 8 -+#define BIT_MASK_ABORT_RX_RDRDY_COUNTER_8814B 0xff -+#define BIT_ABORT_RX_RDRDY_COUNTER_8814B(x) \ -+ (((x) & BIT_MASK_ABORT_RX_RDRDY_COUNTER_8814B) \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8814B) -+#define BITS_ABORT_RX_RDRDY_COUNTER_8814B \ -+ (BIT_MASK_ABORT_RX_RDRDY_COUNTER_8814B \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8814B) -+#define BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8814B(x) \ -+ ((x) & (~BITS_ABORT_RX_RDRDY_COUNTER_8814B)) -+#define BIT_GET_ABORT_RX_RDRDY_COUNTER_8814B(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8814B) & \ -+ BIT_MASK_ABORT_RX_RDRDY_COUNTER_8814B) -+#define BIT_SET_ABORT_RX_RDRDY_COUNTER_8814B(x, v) \ -+ (BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8814B(x) | \ -+ BIT_ABORT_RX_RDRDY_COUNTER_8814B(v)) -+ -+#define BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8814B 0 -+#define BIT_MASK_VBON_EARLY_FALLING_COUNTER_8814B 0xff -+#define BIT_VBON_EARLY_FALLING_COUNTER_8814B(x) \ -+ (((x) & BIT_MASK_VBON_EARLY_FALLING_COUNTER_8814B) \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8814B) -+#define BITS_VBON_EARLY_FALLING_COUNTER_8814B \ -+ (BIT_MASK_VBON_EARLY_FALLING_COUNTER_8814B \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8814B) -+#define BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8814B(x) \ -+ ((x) & (~BITS_VBON_EARLY_FALLING_COUNTER_8814B)) -+#define BIT_GET_VBON_EARLY_FALLING_COUNTER_8814B(x) \ -+ (((x) >> BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8814B) & \ -+ BIT_MASK_VBON_EARLY_FALLING_COUNTER_8814B) -+#define BIT_SET_VBON_EARLY_FALLING_COUNTER_8814B(x, v) \ -+ (BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8814B(x) | \ -+ BIT_VBON_EARLY_FALLING_COUNTER_8814B(v)) -+ -+/* 2 REG_WMAC_PLCP_MONITOR_8814B */ -+#define BIT_WMAC_PLCP_TRX_SEL_8814B BIT(31) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8814B 28 -+#define BIT_MASK_WMAC_PLCP_RDSIG_SEL_8814B 0x7 -+#define BIT_WMAC_PLCP_RDSIG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_SEL_8814B) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8814B) -+#define BITS_WMAC_PLCP_RDSIG_SEL_8814B \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_SEL_8814B \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8814B) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8814B(x) \ -+ ((x) & (~BITS_WMAC_PLCP_RDSIG_SEL_8814B)) -+#define BIT_GET_WMAC_PLCP_RDSIG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8814B) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_SEL_8814B) -+#define BIT_SET_WMAC_PLCP_RDSIG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8814B(x) | \ -+ BIT_WMAC_PLCP_RDSIG_SEL_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_RATE_IDX_8814B 24 -+#define BIT_MASK_WMAC_RATE_IDX_8814B 0xf -+#define BIT_WMAC_RATE_IDX_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_RATE_IDX_8814B) << BIT_SHIFT_WMAC_RATE_IDX_8814B) -+#define BITS_WMAC_RATE_IDX_8814B \ -+ (BIT_MASK_WMAC_RATE_IDX_8814B << BIT_SHIFT_WMAC_RATE_IDX_8814B) -+#define BIT_CLEAR_WMAC_RATE_IDX_8814B(x) ((x) & (~BITS_WMAC_RATE_IDX_8814B)) -+#define BIT_GET_WMAC_RATE_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RATE_IDX_8814B) & BIT_MASK_WMAC_RATE_IDX_8814B) -+#define BIT_SET_WMAC_RATE_IDX_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_RATE_IDX_8814B(x) | BIT_WMAC_RATE_IDX_8814B(v)) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_8814B 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG_8814B 0xffffff -+#define BIT_WMAC_PLCP_RDSIG_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_8814B) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_8814B) -+#define BITS_WMAC_PLCP_RDSIG_8814B \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_8814B << BIT_SHIFT_WMAC_PLCP_RDSIG_8814B) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_8814B(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_8814B)) -+#define BIT_GET_WMAC_PLCP_RDSIG_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_8814B) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_8814B) -+#define BIT_SET_WMAC_PLCP_RDSIG_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_8814B(x) | BIT_WMAC_PLCP_RDSIG_8814B(v)) -+ -+/* 2 REG_WMAC_DEBUG_PORT_8814B */ -+ -+#define BIT_SHIFT_WMAC_DEBUG_PORT_8814B 0 -+#define BIT_MASK_WMAC_DEBUG_PORT_8814B 0xffffffffL -+#define BIT_WMAC_DEBUG_PORT_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_DEBUG_PORT_8814B) \ -+ << BIT_SHIFT_WMAC_DEBUG_PORT_8814B) -+#define BITS_WMAC_DEBUG_PORT_8814B \ -+ (BIT_MASK_WMAC_DEBUG_PORT_8814B << BIT_SHIFT_WMAC_DEBUG_PORT_8814B) -+#define BIT_CLEAR_WMAC_DEBUG_PORT_8814B(x) ((x) & (~BITS_WMAC_DEBUG_PORT_8814B)) -+#define BIT_GET_WMAC_DEBUG_PORT_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_DEBUG_PORT_8814B) & \ -+ BIT_MASK_WMAC_DEBUG_PORT_8814B) -+#define BIT_SET_WMAC_DEBUG_PORT_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_DEBUG_PORT_8814B(x) | BIT_WMAC_DEBUG_PORT_8814B(v)) -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_8814B (TA0 REGISTER) */ -+ -+#define BIT_SHIFT_TA0_V1_8814B 0 -+#define BIT_MASK_TA0_V1_8814B 0xffffffffL -+#define BIT_TA0_V1_8814B(x) \ -+ (((x) & BIT_MASK_TA0_V1_8814B) << BIT_SHIFT_TA0_V1_8814B) -+#define BITS_TA0_V1_8814B (BIT_MASK_TA0_V1_8814B << BIT_SHIFT_TA0_V1_8814B) -+#define BIT_CLEAR_TA0_V1_8814B(x) ((x) & (~BITS_TA0_V1_8814B)) -+#define BIT_GET_TA0_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TA0_V1_8814B) & BIT_MASK_TA0_V1_8814B) -+#define BIT_SET_TA0_V1_8814B(x, v) \ -+ (BIT_CLEAR_TA0_V1_8814B(x) | BIT_TA0_V1_8814B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_H_8814B (TA0 REGISTER) */ -+ -+#define BIT_SHIFT_TA0_H_V1_8814B 0 -+#define BIT_MASK_TA0_H_V1_8814B 0xffff -+#define BIT_TA0_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_TA0_H_V1_8814B) << BIT_SHIFT_TA0_H_V1_8814B) -+#define BITS_TA0_H_V1_8814B \ -+ (BIT_MASK_TA0_H_V1_8814B << BIT_SHIFT_TA0_H_V1_8814B) -+#define BIT_CLEAR_TA0_H_V1_8814B(x) ((x) & (~BITS_TA0_H_V1_8814B)) -+#define BIT_GET_TA0_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TA0_H_V1_8814B) & BIT_MASK_TA0_H_V1_8814B) -+#define BIT_SET_TA0_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_TA0_H_V1_8814B(x) | BIT_TA0_H_V1_8814B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_8814B (TA1 REGISTER) */ -+ -+#define BIT_SHIFT_TA1_V1_8814B 0 -+#define BIT_MASK_TA1_V1_8814B 0xffffffffL -+#define BIT_TA1_V1_8814B(x) \ -+ (((x) & BIT_MASK_TA1_V1_8814B) << BIT_SHIFT_TA1_V1_8814B) -+#define BITS_TA1_V1_8814B (BIT_MASK_TA1_V1_8814B << BIT_SHIFT_TA1_V1_8814B) -+#define BIT_CLEAR_TA1_V1_8814B(x) ((x) & (~BITS_TA1_V1_8814B)) -+#define BIT_GET_TA1_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TA1_V1_8814B) & BIT_MASK_TA1_V1_8814B) -+#define BIT_SET_TA1_V1_8814B(x, v) \ -+ (BIT_CLEAR_TA1_V1_8814B(x) | BIT_TA1_V1_8814B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_H_8814B (TA1 REGISTER) */ -+ -+#define BIT_SHIFT_TA1_H_V1_8814B 0 -+#define BIT_MASK_TA1_H_V1_8814B 0xffff -+#define BIT_TA1_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_TA1_H_V1_8814B) << BIT_SHIFT_TA1_H_V1_8814B) -+#define BITS_TA1_H_V1_8814B \ -+ (BIT_MASK_TA1_H_V1_8814B << BIT_SHIFT_TA1_H_V1_8814B) -+#define BIT_CLEAR_TA1_H_V1_8814B(x) ((x) & (~BITS_TA1_H_V1_8814B)) -+#define BIT_GET_TA1_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TA1_H_V1_8814B) & BIT_MASK_TA1_H_V1_8814B) -+#define BIT_SET_TA1_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_TA1_H_V1_8814B(x) | BIT_TA1_H_V1_8814B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_8814B (TA2 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_V1_8814B 0 -+#define BIT_MASK_TA2_V1_8814B 0xffffffffL -+#define BIT_TA2_V1_8814B(x) \ -+ (((x) & BIT_MASK_TA2_V1_8814B) << BIT_SHIFT_TA2_V1_8814B) -+#define BITS_TA2_V1_8814B (BIT_MASK_TA2_V1_8814B << BIT_SHIFT_TA2_V1_8814B) -+#define BIT_CLEAR_TA2_V1_8814B(x) ((x) & (~BITS_TA2_V1_8814B)) -+#define BIT_GET_TA2_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TA2_V1_8814B) & BIT_MASK_TA2_V1_8814B) -+#define BIT_SET_TA2_V1_8814B(x, v) \ -+ (BIT_CLEAR_TA2_V1_8814B(x) | BIT_TA2_V1_8814B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_H_8814B (TA2 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_H_V1_8814B 0 -+#define BIT_MASK_TA2_H_V1_8814B 0xffff -+#define BIT_TA2_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_TA2_H_V1_8814B) << BIT_SHIFT_TA2_H_V1_8814B) -+#define BITS_TA2_H_V1_8814B \ -+ (BIT_MASK_TA2_H_V1_8814B << BIT_SHIFT_TA2_H_V1_8814B) -+#define BIT_CLEAR_TA2_H_V1_8814B(x) ((x) & (~BITS_TA2_H_V1_8814B)) -+#define BIT_GET_TA2_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TA2_H_V1_8814B) & BIT_MASK_TA2_H_V1_8814B) -+#define BIT_SET_TA2_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_TA2_H_V1_8814B(x) | BIT_TA2_H_V1_8814B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_8814B (TA3 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_V1_8814B 0 -+#define BIT_MASK_TA2_V1_8814B 0xffffffffL -+#define BIT_TA2_V1_8814B(x) \ -+ (((x) & BIT_MASK_TA2_V1_8814B) << BIT_SHIFT_TA2_V1_8814B) -+#define BITS_TA2_V1_8814B (BIT_MASK_TA2_V1_8814B << BIT_SHIFT_TA2_V1_8814B) -+#define BIT_CLEAR_TA2_V1_8814B(x) ((x) & (~BITS_TA2_V1_8814B)) -+#define BIT_GET_TA2_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TA2_V1_8814B) & BIT_MASK_TA2_V1_8814B) -+#define BIT_SET_TA2_V1_8814B(x, v) \ -+ (BIT_CLEAR_TA2_V1_8814B(x) | BIT_TA2_V1_8814B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_H_8814B (TA3 REGISTER) */ -+ -+#define BIT_SHIFT_TA3_H_V1_8814B 0 -+#define BIT_MASK_TA3_H_V1_8814B 0xffff -+#define BIT_TA3_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_TA3_H_V1_8814B) << BIT_SHIFT_TA3_H_V1_8814B) -+#define BITS_TA3_H_V1_8814B \ -+ (BIT_MASK_TA3_H_V1_8814B << BIT_SHIFT_TA3_H_V1_8814B) -+#define BIT_CLEAR_TA3_H_V1_8814B(x) ((x) & (~BITS_TA3_H_V1_8814B)) -+#define BIT_GET_TA3_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TA3_H_V1_8814B) & BIT_MASK_TA3_H_V1_8814B) -+#define BIT_SET_TA3_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_TA3_H_V1_8814B(x) | BIT_TA3_H_V1_8814B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_8814B (TA4 REGISTER) */ -+ -+#define BIT_SHIFT_TA4_V1_8814B 0 -+#define BIT_MASK_TA4_V1_8814B 0xffffffffL -+#define BIT_TA4_V1_8814B(x) \ -+ (((x) & BIT_MASK_TA4_V1_8814B) << BIT_SHIFT_TA4_V1_8814B) -+#define BITS_TA4_V1_8814B (BIT_MASK_TA4_V1_8814B << BIT_SHIFT_TA4_V1_8814B) -+#define BIT_CLEAR_TA4_V1_8814B(x) ((x) & (~BITS_TA4_V1_8814B)) -+#define BIT_GET_TA4_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TA4_V1_8814B) & BIT_MASK_TA4_V1_8814B) -+#define BIT_SET_TA4_V1_8814B(x, v) \ -+ (BIT_CLEAR_TA4_V1_8814B(x) | BIT_TA4_V1_8814B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_H_8814B (TA4 REGISTER) */ -+ -+#define BIT_SHIFT_TA4_H_V1_8814B 0 -+#define BIT_MASK_TA4_H_V1_8814B 0xffff -+#define BIT_TA4_H_V1_8814B(x) \ -+ (((x) & BIT_MASK_TA4_H_V1_8814B) << BIT_SHIFT_TA4_H_V1_8814B) -+#define BITS_TA4_H_V1_8814B \ -+ (BIT_MASK_TA4_H_V1_8814B << BIT_SHIFT_TA4_H_V1_8814B) -+#define BIT_CLEAR_TA4_H_V1_8814B(x) ((x) & (~BITS_TA4_H_V1_8814B)) -+#define BIT_GET_TA4_H_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_TA4_H_V1_8814B) & BIT_MASK_TA4_H_V1_8814B) -+#define BIT_SET_TA4_H_V1_8814B(x, v) \ -+ (BIT_CLEAR_TA4_H_V1_8814B(x) | BIT_TA4_H_V1_8814B(v)) -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_RSVD_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_MACID1_8814B */ -+ -+#define BIT_SHIFT_MACID1_0_8814B 0 -+#define BIT_MASK_MACID1_0_8814B 0xffffffffL -+#define BIT_MACID1_0_8814B(x) \ -+ (((x) & BIT_MASK_MACID1_0_8814B) << BIT_SHIFT_MACID1_0_8814B) -+#define BITS_MACID1_0_8814B \ -+ (BIT_MASK_MACID1_0_8814B << BIT_SHIFT_MACID1_0_8814B) -+#define BIT_CLEAR_MACID1_0_8814B(x) ((x) & (~BITS_MACID1_0_8814B)) -+#define BIT_GET_MACID1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID1_0_8814B) & BIT_MASK_MACID1_0_8814B) -+#define BIT_SET_MACID1_0_8814B(x, v) \ -+ (BIT_CLEAR_MACID1_0_8814B(x) | BIT_MACID1_0_8814B(v)) -+ -+/* 2 REG_MACID1_1_8814B */ -+ -+#define BIT_SHIFT_MACID1_1_8814B 0 -+#define BIT_MASK_MACID1_1_8814B 0xffff -+#define BIT_MACID1_1_8814B(x) \ -+ (((x) & BIT_MASK_MACID1_1_8814B) << BIT_SHIFT_MACID1_1_8814B) -+#define BITS_MACID1_1_8814B \ -+ (BIT_MASK_MACID1_1_8814B << BIT_SHIFT_MACID1_1_8814B) -+#define BIT_CLEAR_MACID1_1_8814B(x) ((x) & (~BITS_MACID1_1_8814B)) -+#define BIT_GET_MACID1_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MACID1_1_8814B) & BIT_MASK_MACID1_1_8814B) -+#define BIT_SET_MACID1_1_8814B(x, v) \ -+ (BIT_CLEAR_MACID1_1_8814B(x) | BIT_MACID1_1_8814B(v)) -+ -+/* 2 REG_BSSID1_8814B */ -+ -+#define BIT_SHIFT_BSSID1_0_8814B 0 -+#define BIT_MASK_BSSID1_0_8814B 0xffffffffL -+#define BIT_BSSID1_0_8814B(x) \ -+ (((x) & BIT_MASK_BSSID1_0_8814B) << BIT_SHIFT_BSSID1_0_8814B) -+#define BITS_BSSID1_0_8814B \ -+ (BIT_MASK_BSSID1_0_8814B << BIT_SHIFT_BSSID1_0_8814B) -+#define BIT_CLEAR_BSSID1_0_8814B(x) ((x) & (~BITS_BSSID1_0_8814B)) -+#define BIT_GET_BSSID1_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID1_0_8814B) & BIT_MASK_BSSID1_0_8814B) -+#define BIT_SET_BSSID1_0_8814B(x, v) \ -+ (BIT_CLEAR_BSSID1_0_8814B(x) | BIT_BSSID1_0_8814B(v)) -+ -+/* 2 REG_BSSID1_1_8814B */ -+ -+#define BIT_SHIFT_BSSID1_1_8814B 0 -+#define BIT_MASK_BSSID1_1_8814B 0xffff -+#define BIT_BSSID1_1_8814B(x) \ -+ (((x) & BIT_MASK_BSSID1_1_8814B) << BIT_SHIFT_BSSID1_1_8814B) -+#define BITS_BSSID1_1_8814B \ -+ (BIT_MASK_BSSID1_1_8814B << BIT_SHIFT_BSSID1_1_8814B) -+#define BIT_CLEAR_BSSID1_1_8814B(x) ((x) & (~BITS_BSSID1_1_8814B)) -+#define BIT_GET_BSSID1_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_BSSID1_1_8814B) & BIT_MASK_BSSID1_1_8814B) -+#define BIT_SET_BSSID1_1_8814B(x, v) \ -+ (BIT_CLEAR_BSSID1_1_8814B(x) | BIT_BSSID1_1_8814B(v)) -+ -+/* 2 REG_BCN_PSR_RPT1_8814B */ -+ -+#define BIT_SHIFT_DTIM_CNT1_8814B 24 -+#define BIT_MASK_DTIM_CNT1_8814B 0xff -+#define BIT_DTIM_CNT1_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_CNT1_8814B) << BIT_SHIFT_DTIM_CNT1_8814B) -+#define BITS_DTIM_CNT1_8814B \ -+ (BIT_MASK_DTIM_CNT1_8814B << BIT_SHIFT_DTIM_CNT1_8814B) -+#define BIT_CLEAR_DTIM_CNT1_8814B(x) ((x) & (~BITS_DTIM_CNT1_8814B)) -+#define BIT_GET_DTIM_CNT1_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT1_8814B) & BIT_MASK_DTIM_CNT1_8814B) -+#define BIT_SET_DTIM_CNT1_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_CNT1_8814B(x) | BIT_DTIM_CNT1_8814B(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD1_8814B 16 -+#define BIT_MASK_DTIM_PERIOD1_8814B 0xff -+#define BIT_DTIM_PERIOD1_8814B(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD1_8814B) << BIT_SHIFT_DTIM_PERIOD1_8814B) -+#define BITS_DTIM_PERIOD1_8814B \ -+ (BIT_MASK_DTIM_PERIOD1_8814B << BIT_SHIFT_DTIM_PERIOD1_8814B) -+#define BIT_CLEAR_DTIM_PERIOD1_8814B(x) ((x) & (~BITS_DTIM_PERIOD1_8814B)) -+#define BIT_GET_DTIM_PERIOD1_8814B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD1_8814B) & BIT_MASK_DTIM_PERIOD1_8814B) -+#define BIT_SET_DTIM_PERIOD1_8814B(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD1_8814B(x) | BIT_DTIM_PERIOD1_8814B(v)) -+ -+#define BIT_DTIM1_8814B BIT(15) -+#define BIT_TIM1_8814B BIT(14) -+ -+#define BIT_SHIFT_PS_AID_1_8814B 0 -+#define BIT_MASK_PS_AID_1_8814B 0x7ff -+#define BIT_PS_AID_1_8814B(x) \ -+ (((x) & BIT_MASK_PS_AID_1_8814B) << BIT_SHIFT_PS_AID_1_8814B) -+#define BITS_PS_AID_1_8814B \ -+ (BIT_MASK_PS_AID_1_8814B << BIT_SHIFT_PS_AID_1_8814B) -+#define BIT_CLEAR_PS_AID_1_8814B(x) ((x) & (~BITS_PS_AID_1_8814B)) -+#define BIT_GET_PS_AID_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_1_8814B) & BIT_MASK_PS_AID_1_8814B) -+#define BIT_SET_PS_AID_1_8814B(x, v) \ -+ (BIT_CLEAR_PS_AID_1_8814B(x) | BIT_PS_AID_1_8814B(v)) -+ -+/* 2 REG_ASSOCIATED_BFMEE_SEL_8814B */ -+#define BIT_TXUSER_ID1_8814B BIT(25) -+ -+#define BIT_SHIFT_AID1_8814B 16 -+#define BIT_MASK_AID1_8814B 0x1ff -+#define BIT_AID1_8814B(x) (((x) & BIT_MASK_AID1_8814B) << BIT_SHIFT_AID1_8814B) -+#define BITS_AID1_8814B (BIT_MASK_AID1_8814B << BIT_SHIFT_AID1_8814B) -+#define BIT_CLEAR_AID1_8814B(x) ((x) & (~BITS_AID1_8814B)) -+#define BIT_GET_AID1_8814B(x) \ -+ (((x) >> BIT_SHIFT_AID1_8814B) & BIT_MASK_AID1_8814B) -+#define BIT_SET_AID1_8814B(x, v) (BIT_CLEAR_AID1_8814B(x) | BIT_AID1_8814B(v)) -+ -+#define BIT_TXUSER_ID0_8814B BIT(9) -+ -+#define BIT_SHIFT_AID0_8814B 0 -+#define BIT_MASK_AID0_8814B 0x1ff -+#define BIT_AID0_8814B(x) (((x) & BIT_MASK_AID0_8814B) << BIT_SHIFT_AID0_8814B) -+#define BITS_AID0_8814B (BIT_MASK_AID0_8814B << BIT_SHIFT_AID0_8814B) -+#define BIT_CLEAR_AID0_8814B(x) ((x) & (~BITS_AID0_8814B)) -+#define BIT_GET_AID0_8814B(x) \ -+ (((x) >> BIT_SHIFT_AID0_8814B) & BIT_MASK_AID0_8814B) -+#define BIT_SET_AID0_8814B(x, v) (BIT_CLEAR_AID0_8814B(x) | BIT_AID0_8814B(v)) -+ -+/* 2 REG_SND_PTCL_CTRL_8814B */ -+ -+#define BIT_SHIFT_NDP_RX_STANDBY_TIMER_8814B 24 -+#define BIT_MASK_NDP_RX_STANDBY_TIMER_8814B 0xff -+#define BIT_NDP_RX_STANDBY_TIMER_8814B(x) \ -+ (((x) & BIT_MASK_NDP_RX_STANDBY_TIMER_8814B) \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8814B) -+#define BITS_NDP_RX_STANDBY_TIMER_8814B \ -+ (BIT_MASK_NDP_RX_STANDBY_TIMER_8814B \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8814B) -+#define BIT_CLEAR_NDP_RX_STANDBY_TIMER_8814B(x) \ -+ ((x) & (~BITS_NDP_RX_STANDBY_TIMER_8814B)) -+#define BIT_GET_NDP_RX_STANDBY_TIMER_8814B(x) \ -+ (((x) >> BIT_SHIFT_NDP_RX_STANDBY_TIMER_8814B) & \ -+ BIT_MASK_NDP_RX_STANDBY_TIMER_8814B) -+#define BIT_SET_NDP_RX_STANDBY_TIMER_8814B(x, v) \ -+ (BIT_CLEAR_NDP_RX_STANDBY_TIMER_8814B(x) | \ -+ BIT_NDP_RX_STANDBY_TIMER_8814B(v)) -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_HT_8814B 16 -+#define BIT_MASK_CSI_RPT_OFFSET_HT_8814B 0xff -+#define BIT_CSI_RPT_OFFSET_HT_8814B(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_HT_8814B) \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_HT_8814B) -+#define BITS_CSI_RPT_OFFSET_HT_8814B \ -+ (BIT_MASK_CSI_RPT_OFFSET_HT_8814B << BIT_SHIFT_CSI_RPT_OFFSET_HT_8814B) -+#define BIT_CLEAR_CSI_RPT_OFFSET_HT_8814B(x) \ -+ ((x) & (~BITS_CSI_RPT_OFFSET_HT_8814B)) -+#define BIT_GET_CSI_RPT_OFFSET_HT_8814B(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_HT_8814B) & \ -+ BIT_MASK_CSI_RPT_OFFSET_HT_8814B) -+#define BIT_SET_CSI_RPT_OFFSET_HT_8814B(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_HT_8814B(x) | BIT_CSI_RPT_OFFSET_HT_8814B(v)) -+ -+#define BIT_VHTNDP_RPTPOLL_CSI_STR_OFFSET_SEL_8814B BIT(15) -+#define BIT_R_WMAC_CSI_CHKSUM_DIS_8814B BIT(14) -+ -+#define BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1_8814B 8 -+#define BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1_8814B 0x3f -+#define BIT_R_CSI_RPT_OFFSET_VHT_V1_8814B(x) \ -+ (((x) & BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1_8814B) \ -+ << BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1_8814B) -+#define BITS_R_CSI_RPT_OFFSET_VHT_V1_8814B \ -+ (BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1_8814B \ -+ << BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1_8814B) -+#define BIT_CLEAR_R_CSI_RPT_OFFSET_VHT_V1_8814B(x) \ -+ ((x) & (~BITS_R_CSI_RPT_OFFSET_VHT_V1_8814B)) -+#define BIT_GET_R_CSI_RPT_OFFSET_VHT_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1_8814B) & \ -+ BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1_8814B) -+#define BIT_SET_R_CSI_RPT_OFFSET_VHT_V1_8814B(x, v) \ -+ (BIT_CLEAR_R_CSI_RPT_OFFSET_VHT_V1_8814B(x) | \ -+ BIT_R_CSI_RPT_OFFSET_VHT_V1_8814B(v)) -+ -+#define BIT_R_WMAC_USE_NSTS_8814B BIT(7) -+#define BIT_R_DISABLE_CHECK_VHTSIGB_CRC_8814B BIT(6) -+#define BIT_R_DISABLE_CHECK_VHTSIGA_CRC_8814B BIT(5) -+#define BIT_R_WMAC_BFPARAM_SEL_8814B BIT(4) -+#define BIT_R_WMAC_CSISEQ_SEL_8814B BIT(3) -+#define BIT_R_WMAC_CSI_WITHHTC_EN_8814B BIT(2) -+#define BIT_R_WMAC_HT_NDPA_EN_8814B BIT(1) -+#define BIT_R_WMAC_VHT_NDPA_EN_8814B BIT(0) -+ -+/* 2 REG_RX_CSI_RPT_INFO_8814B */ -+#define BIT_WRITE_ENABLE_8814B BIT(31) -+#define BIT_WMAC_CHECK_SOUNDING_SEQ_8814B BIT(30) -+ -+#define BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8814B 1 -+#define BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8814B 0xffffff -+#define BIT_VHTHT_MIMO_CTRL_FIELD_8814B(x) \ -+ (((x) & BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8814B) \ -+ << BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8814B) -+#define BITS_VHTHT_MIMO_CTRL_FIELD_8814B \ -+ (BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8814B \ -+ << BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8814B) -+#define BIT_CLEAR_VHTHT_MIMO_CTRL_FIELD_8814B(x) \ -+ ((x) & (~BITS_VHTHT_MIMO_CTRL_FIELD_8814B)) -+#define BIT_GET_VHTHT_MIMO_CTRL_FIELD_8814B(x) \ -+ (((x) >> BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8814B) & \ -+ BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8814B) -+#define BIT_SET_VHTHT_MIMO_CTRL_FIELD_8814B(x, v) \ -+ (BIT_CLEAR_VHTHT_MIMO_CTRL_FIELD_8814B(x) | \ -+ BIT_VHTHT_MIMO_CTRL_FIELD_8814B(v)) -+ -+#define BIT_CSI_INTERRUPT_STATUS_8814B BIT(0) -+ -+/* 2 REG_NS_ARP_CTRL_8814B */ -+#define BIT_R_WMAC_NSARP_RSPEN_8814B BIT(15) -+#define BIT_R_WMAC_NSARP_RARP_8814B BIT(9) -+#define BIT_R_WMAC_NSARP_RIPV6_8814B BIT(8) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_MODEN_8814B 6 -+#define BIT_MASK_R_WMAC_NSARP_MODEN_8814B 0x3 -+#define BIT_R_WMAC_NSARP_MODEN_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_MODEN_8814B) \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8814B) -+#define BITS_R_WMAC_NSARP_MODEN_8814B \ -+ (BIT_MASK_R_WMAC_NSARP_MODEN_8814B \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8814B) -+#define BIT_CLEAR_R_WMAC_NSARP_MODEN_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_MODEN_8814B)) -+#define BIT_GET_R_WMAC_NSARP_MODEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_MODEN_8814B) & \ -+ BIT_MASK_R_WMAC_NSARP_MODEN_8814B) -+#define BIT_SET_R_WMAC_NSARP_MODEN_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_MODEN_8814B(x) | \ -+ BIT_R_WMAC_NSARP_MODEN_8814B(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8814B 4 -+#define BIT_MASK_R_WMAC_NSARP_RSPFTP_8814B 0x3 -+#define BIT_R_WMAC_NSARP_RSPFTP_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPFTP_8814B) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8814B) -+#define BITS_R_WMAC_NSARP_RSPFTP_8814B \ -+ (BIT_MASK_R_WMAC_NSARP_RSPFTP_8814B \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8814B) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPFTP_8814B)) -+#define BIT_GET_R_WMAC_NSARP_RSPFTP_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8814B) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPFTP_8814B) -+#define BIT_SET_R_WMAC_NSARP_RSPFTP_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8814B(x) | \ -+ BIT_R_WMAC_NSARP_RSPFTP_8814B(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8814B 0 -+#define BIT_MASK_R_WMAC_NSARP_RSPSEC_8814B 0xf -+#define BIT_R_WMAC_NSARP_RSPSEC_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPSEC_8814B) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8814B) -+#define BITS_R_WMAC_NSARP_RSPSEC_8814B \ -+ (BIT_MASK_R_WMAC_NSARP_RSPSEC_8814B \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8814B) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPSEC_8814B)) -+#define BIT_GET_R_WMAC_NSARP_RSPSEC_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8814B) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPSEC_8814B) -+#define BIT_SET_R_WMAC_NSARP_RSPSEC_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8814B(x) | \ -+ BIT_R_WMAC_NSARP_RSPSEC_8814B(v)) -+ -+/* 2 REG_NS_ARP_INFO_8814B */ -+#define BIT_REQ_IS_MCNS_8814B BIT(23) -+#define BIT_REQ_IS_UCNS_8814B BIT(22) -+#define BIT_REQ_IS_USNS_8814B BIT(21) -+#define BIT_REQ_IS_ARP_8814B BIT(20) -+#define BIT_EXPRSP_MH_WITHQC_8814B BIT(19) -+ -+#define BIT_SHIFT_EXPRSP_SECTYPE_8814B 16 -+#define BIT_MASK_EXPRSP_SECTYPE_8814B 0x7 -+#define BIT_EXPRSP_SECTYPE_8814B(x) \ -+ (((x) & BIT_MASK_EXPRSP_SECTYPE_8814B) \ -+ << BIT_SHIFT_EXPRSP_SECTYPE_8814B) -+#define BITS_EXPRSP_SECTYPE_8814B \ -+ (BIT_MASK_EXPRSP_SECTYPE_8814B << BIT_SHIFT_EXPRSP_SECTYPE_8814B) -+#define BIT_CLEAR_EXPRSP_SECTYPE_8814B(x) ((x) & (~BITS_EXPRSP_SECTYPE_8814B)) -+#define BIT_GET_EXPRSP_SECTYPE_8814B(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_SECTYPE_8814B) & \ -+ BIT_MASK_EXPRSP_SECTYPE_8814B) -+#define BIT_SET_EXPRSP_SECTYPE_8814B(x, v) \ -+ (BIT_CLEAR_EXPRSP_SECTYPE_8814B(x) | BIT_EXPRSP_SECTYPE_8814B(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8814B 8 -+#define BIT_MASK_EXPRSP_CHKSM_7_TO_0_8814B 0xff -+#define BIT_EXPRSP_CHKSM_7_TO_0_8814B(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_7_TO_0_8814B) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8814B) -+#define BITS_EXPRSP_CHKSM_7_TO_0_8814B \ -+ (BIT_MASK_EXPRSP_CHKSM_7_TO_0_8814B \ -+ << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8814B) -+#define BIT_CLEAR_EXPRSP_CHKSM_7_TO_0_8814B(x) \ -+ ((x) & (~BITS_EXPRSP_CHKSM_7_TO_0_8814B)) -+#define BIT_GET_EXPRSP_CHKSM_7_TO_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8814B) & \ -+ BIT_MASK_EXPRSP_CHKSM_7_TO_0_8814B) -+#define BIT_SET_EXPRSP_CHKSM_7_TO_0_8814B(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_7_TO_0_8814B(x) | \ -+ BIT_EXPRSP_CHKSM_7_TO_0_8814B(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8814B 0 -+#define BIT_MASK_EXPRSP_CHKSM_15_TO_8_8814B 0xff -+#define BIT_EXPRSP_CHKSM_15_TO_8_8814B(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_15_TO_8_8814B) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8814B) -+#define BITS_EXPRSP_CHKSM_15_TO_8_8814B \ -+ (BIT_MASK_EXPRSP_CHKSM_15_TO_8_8814B \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8814B) -+#define BIT_CLEAR_EXPRSP_CHKSM_15_TO_8_8814B(x) \ -+ ((x) & (~BITS_EXPRSP_CHKSM_15_TO_8_8814B)) -+#define BIT_GET_EXPRSP_CHKSM_15_TO_8_8814B(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8814B) & \ -+ BIT_MASK_EXPRSP_CHKSM_15_TO_8_8814B) -+#define BIT_SET_EXPRSP_CHKSM_15_TO_8_8814B(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_15_TO_8_8814B(x) | \ -+ BIT_EXPRSP_CHKSM_15_TO_8_8814B(v)) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_V1_8814B */ -+ -+#define BIT_SHIFT_WMAC_ARPIP_8814B 0 -+#define BIT_MASK_WMAC_ARPIP_8814B 0xffffffffL -+#define BIT_WMAC_ARPIP_8814B(x) \ -+ (((x) & BIT_MASK_WMAC_ARPIP_8814B) << BIT_SHIFT_WMAC_ARPIP_8814B) -+#define BITS_WMAC_ARPIP_8814B \ -+ (BIT_MASK_WMAC_ARPIP_8814B << BIT_SHIFT_WMAC_ARPIP_8814B) -+#define BIT_CLEAR_WMAC_ARPIP_8814B(x) ((x) & (~BITS_WMAC_ARPIP_8814B)) -+#define BIT_GET_WMAC_ARPIP_8814B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARPIP_8814B) & BIT_MASK_WMAC_ARPIP_8814B) -+#define BIT_SET_WMAC_ARPIP_8814B(x, v) \ -+ (BIT_CLEAR_WMAC_ARPIP_8814B(x) | BIT_WMAC_ARPIP_8814B(v)) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_8814B */ -+ -+#define BIT_SHIFT_BEAMFORMING_INFO_8814B 0 -+#define BIT_MASK_BEAMFORMING_INFO_8814B 0xffffffffL -+#define BIT_BEAMFORMING_INFO_8814B(x) \ -+ (((x) & BIT_MASK_BEAMFORMING_INFO_8814B) \ -+ << BIT_SHIFT_BEAMFORMING_INFO_8814B) -+#define BITS_BEAMFORMING_INFO_8814B \ -+ (BIT_MASK_BEAMFORMING_INFO_8814B << BIT_SHIFT_BEAMFORMING_INFO_8814B) -+#define BIT_CLEAR_BEAMFORMING_INFO_8814B(x) \ -+ ((x) & (~BITS_BEAMFORMING_INFO_8814B)) -+#define BIT_GET_BEAMFORMING_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_BEAMFORMING_INFO_8814B) & \ -+ BIT_MASK_BEAMFORMING_INFO_8814B) -+#define BIT_SET_BEAMFORMING_INFO_8814B(x, v) \ -+ (BIT_CLEAR_BEAMFORMING_INFO_8814B(x) | BIT_BEAMFORMING_INFO_8814B(v)) -+ -+/* 2 REG_IPV6_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8814B 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8814B 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_0_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8814B) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8814B) -+#define BITS_R_WMAC_IPV6_MYIPAD_0_8814B \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8814B \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8814B) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_0_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_0_8814B)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8814B) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8814B) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_0_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_0_8814B(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_0_8814B(v)) -+ -+/* 2 REG_IPV6_1_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8814B 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8814B 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_1_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8814B) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8814B) -+#define BITS_R_WMAC_IPV6_MYIPAD_1_8814B \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8814B \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8814B) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_1_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_1_8814B)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8814B) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8814B) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_1_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_1_8814B(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_1_8814B(v)) -+ -+/* 2 REG_IPV6_2_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8814B 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8814B 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_2_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8814B) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8814B) -+#define BITS_R_WMAC_IPV6_MYIPAD_2_8814B \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8814B \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8814B) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_2_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_2_8814B)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8814B) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8814B) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_2_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_2_8814B(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_2_8814B(v)) -+ -+/* 2 REG_IPV6_3_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8814B 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8814B 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_3_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8814B) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8814B) -+#define BITS_R_WMAC_IPV6_MYIPAD_3_8814B \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8814B \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8814B) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_3_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_3_8814B)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_3_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8814B) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8814B) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_3_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_3_8814B(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_3_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_WMAC_RTX_CTX_SUBTYPE_CFG_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8814B 4 -+#define BIT_MASK_R_WMAC_CTX_SUBTYPE_8814B 0xf -+#define BIT_R_WMAC_CTX_SUBTYPE_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_CTX_SUBTYPE_8814B) \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8814B) -+#define BITS_R_WMAC_CTX_SUBTYPE_8814B \ -+ (BIT_MASK_R_WMAC_CTX_SUBTYPE_8814B \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8814B) -+#define BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_CTX_SUBTYPE_8814B)) -+#define BIT_GET_R_WMAC_CTX_SUBTYPE_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8814B) & \ -+ BIT_MASK_R_WMAC_CTX_SUBTYPE_8814B) -+#define BIT_SET_R_WMAC_CTX_SUBTYPE_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8814B(x) | \ -+ BIT_R_WMAC_CTX_SUBTYPE_8814B(v)) -+ -+#define BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8814B 0 -+#define BIT_MASK_R_WMAC_RTX_SUBTYPE_8814B 0xf -+#define BIT_R_WMAC_RTX_SUBTYPE_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_RTX_SUBTYPE_8814B) \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8814B) -+#define BITS_R_WMAC_RTX_SUBTYPE_8814B \ -+ (BIT_MASK_R_WMAC_RTX_SUBTYPE_8814B \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8814B) -+#define BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_RTX_SUBTYPE_8814B)) -+#define BIT_GET_R_WMAC_RTX_SUBTYPE_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8814B) & \ -+ BIT_MASK_R_WMAC_RTX_SUBTYPE_8814B) -+#define BIT_SET_R_WMAC_RTX_SUBTYPE_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8814B(x) | \ -+ BIT_R_WMAC_RTX_SUBTYPE_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_WMAC_SWAES_CFG_8814B */ -+ -+/* 2 REG_BT_COEX_V2_8814B */ -+#define BIT_GNT_BT_POLARITY_8814B BIT(12) -+#define BIT_GNT_BT_BYPASS_PRIORITY_8814B BIT(8) -+ -+#define BIT_SHIFT_TIMER_8814B 0 -+#define BIT_MASK_TIMER_8814B 0xff -+#define BIT_TIMER_8814B(x) \ -+ (((x) & BIT_MASK_TIMER_8814B) << BIT_SHIFT_TIMER_8814B) -+#define BITS_TIMER_8814B (BIT_MASK_TIMER_8814B << BIT_SHIFT_TIMER_8814B) -+#define BIT_CLEAR_TIMER_8814B(x) ((x) & (~BITS_TIMER_8814B)) -+#define BIT_GET_TIMER_8814B(x) \ -+ (((x) >> BIT_SHIFT_TIMER_8814B) & BIT_MASK_TIMER_8814B) -+#define BIT_SET_TIMER_8814B(x, v) \ -+ (BIT_CLEAR_TIMER_8814B(x) | BIT_TIMER_8814B(v)) -+ -+/* 2 REG_BT_COEX_8814B */ -+#define BIT_R_GNT_BT_RFC_SW_8814B BIT(12) -+#define BIT_R_GNT_BT_RFC_SW_EN_8814B BIT(11) -+#define BIT_R_GNT_BT_BB_SW_8814B BIT(10) -+#define BIT_R_GNT_BT_BB_SW_EN_8814B BIT(9) -+#define BIT_R_BT_CNT_THREN_8814B BIT(8) -+ -+#define BIT_SHIFT_R_BT_CNT_THR_8814B 0 -+#define BIT_MASK_R_BT_CNT_THR_8814B 0xff -+#define BIT_R_BT_CNT_THR_8814B(x) \ -+ (((x) & BIT_MASK_R_BT_CNT_THR_8814B) << BIT_SHIFT_R_BT_CNT_THR_8814B) -+#define BITS_R_BT_CNT_THR_8814B \ -+ (BIT_MASK_R_BT_CNT_THR_8814B << BIT_SHIFT_R_BT_CNT_THR_8814B) -+#define BIT_CLEAR_R_BT_CNT_THR_8814B(x) ((x) & (~BITS_R_BT_CNT_THR_8814B)) -+#define BIT_GET_R_BT_CNT_THR_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CNT_THR_8814B) & BIT_MASK_R_BT_CNT_THR_8814B) -+#define BIT_SET_R_BT_CNT_THR_8814B(x, v) \ -+ (BIT_CLEAR_R_BT_CNT_THR_8814B(x) | BIT_R_BT_CNT_THR_8814B(v)) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_8814B */ -+ -+#define BIT_SHIFT_RXMYRTS_NAV_V1_8814B 8 -+#define BIT_MASK_RXMYRTS_NAV_V1_8814B 0xff -+#define BIT_RXMYRTS_NAV_V1_8814B(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_V1_8814B) \ -+ << BIT_SHIFT_RXMYRTS_NAV_V1_8814B) -+#define BITS_RXMYRTS_NAV_V1_8814B \ -+ (BIT_MASK_RXMYRTS_NAV_V1_8814B << BIT_SHIFT_RXMYRTS_NAV_V1_8814B) -+#define BIT_CLEAR_RXMYRTS_NAV_V1_8814B(x) ((x) & (~BITS_RXMYRTS_NAV_V1_8814B)) -+#define BIT_GET_RXMYRTS_NAV_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_V1_8814B) & \ -+ BIT_MASK_RXMYRTS_NAV_V1_8814B) -+#define BIT_SET_RXMYRTS_NAV_V1_8814B(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_V1_8814B(x) | BIT_RXMYRTS_NAV_V1_8814B(v)) -+ -+#define BIT_SHIFT_RTSRST_V1_8814B 0 -+#define BIT_MASK_RTSRST_V1_8814B 0xff -+#define BIT_RTSRST_V1_8814B(x) \ -+ (((x) & BIT_MASK_RTSRST_V1_8814B) << BIT_SHIFT_RTSRST_V1_8814B) -+#define BITS_RTSRST_V1_8814B \ -+ (BIT_MASK_RTSRST_V1_8814B << BIT_SHIFT_RTSRST_V1_8814B) -+#define BIT_CLEAR_RTSRST_V1_8814B(x) ((x) & (~BITS_RTSRST_V1_8814B)) -+#define BIT_GET_RTSRST_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_V1_8814B) & BIT_MASK_RTSRST_V1_8814B) -+#define BIT_SET_RTSRST_V1_8814B(x, v) \ -+ (BIT_CLEAR_RTSRST_V1_8814B(x) | BIT_RTSRST_V1_8814B(v)) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_1_8814B */ -+#define BIT_WLRX_TER_BY_CTL_1_8814B BIT(11) -+#define BIT_WLRX_TER_BY_AD_1_8814B BIT(10) -+#define BIT_ANT_DIVERSITY_SEL_1_8814B BIT(9) -+#define BIT_ANTSEL_FOR_BT_CTRL_EN_1_8814B BIT(8) -+#define BIT_WLACT_LOW_GNTWL_EN_1_8814B BIT(2) -+#define BIT_WLACT_HIGH_GNTBT_EN_1_8814B BIT(1) -+#define BIT_NAV_UPPER_1_V1_8814B BIT(0) -+ -+/* 2 REG_BT_COEX_ENHANCED_INTR_CTRL_8814B */ -+ -+#define BIT_SHIFT_BT_STAT_DELAY_8814B 12 -+#define BIT_MASK_BT_STAT_DELAY_8814B 0xf -+#define BIT_BT_STAT_DELAY_8814B(x) \ -+ (((x) & BIT_MASK_BT_STAT_DELAY_8814B) << BIT_SHIFT_BT_STAT_DELAY_8814B) -+#define BITS_BT_STAT_DELAY_8814B \ -+ (BIT_MASK_BT_STAT_DELAY_8814B << BIT_SHIFT_BT_STAT_DELAY_8814B) -+#define BIT_CLEAR_BT_STAT_DELAY_8814B(x) ((x) & (~BITS_BT_STAT_DELAY_8814B)) -+#define BIT_GET_BT_STAT_DELAY_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_STAT_DELAY_8814B) & BIT_MASK_BT_STAT_DELAY_8814B) -+#define BIT_SET_BT_STAT_DELAY_8814B(x, v) \ -+ (BIT_CLEAR_BT_STAT_DELAY_8814B(x) | BIT_BT_STAT_DELAY_8814B(v)) -+ -+#define BIT_SHIFT_BT_TRX_INIT_DETECT_8814B 8 -+#define BIT_MASK_BT_TRX_INIT_DETECT_8814B 0xf -+#define BIT_BT_TRX_INIT_DETECT_8814B(x) \ -+ (((x) & BIT_MASK_BT_TRX_INIT_DETECT_8814B) \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8814B) -+#define BITS_BT_TRX_INIT_DETECT_8814B \ -+ (BIT_MASK_BT_TRX_INIT_DETECT_8814B \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8814B) -+#define BIT_CLEAR_BT_TRX_INIT_DETECT_8814B(x) \ -+ ((x) & (~BITS_BT_TRX_INIT_DETECT_8814B)) -+#define BIT_GET_BT_TRX_INIT_DETECT_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_TRX_INIT_DETECT_8814B) & \ -+ BIT_MASK_BT_TRX_INIT_DETECT_8814B) -+#define BIT_SET_BT_TRX_INIT_DETECT_8814B(x, v) \ -+ (BIT_CLEAR_BT_TRX_INIT_DETECT_8814B(x) | \ -+ BIT_BT_TRX_INIT_DETECT_8814B(v)) -+ -+#define BIT_SHIFT_BT_PRI_DETECT_TO_8814B 4 -+#define BIT_MASK_BT_PRI_DETECT_TO_8814B 0xf -+#define BIT_BT_PRI_DETECT_TO_8814B(x) \ -+ (((x) & BIT_MASK_BT_PRI_DETECT_TO_8814B) \ -+ << BIT_SHIFT_BT_PRI_DETECT_TO_8814B) -+#define BITS_BT_PRI_DETECT_TO_8814B \ -+ (BIT_MASK_BT_PRI_DETECT_TO_8814B << BIT_SHIFT_BT_PRI_DETECT_TO_8814B) -+#define BIT_CLEAR_BT_PRI_DETECT_TO_8814B(x) \ -+ ((x) & (~BITS_BT_PRI_DETECT_TO_8814B)) -+#define BIT_GET_BT_PRI_DETECT_TO_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_PRI_DETECT_TO_8814B) & \ -+ BIT_MASK_BT_PRI_DETECT_TO_8814B) -+#define BIT_SET_BT_PRI_DETECT_TO_8814B(x, v) \ -+ (BIT_CLEAR_BT_PRI_DETECT_TO_8814B(x) | BIT_BT_PRI_DETECT_TO_8814B(v)) -+ -+#define BIT_R_GRANTALL_WLMASK_8814B BIT(3) -+#define BIT_STATIS_BT_EN_8814B BIT(2) -+#define BIT_WL_ACT_MASK_ENABLE_8814B BIT(1) -+#define BIT_ENHANCED_BT_8814B BIT(0) -+ -+/* 2 REG_BT_ACT_STATISTICS_8814B */ -+ -+#define BIT_SHIFT_STATIS_BT_HI_RX_8814B 16 -+#define BIT_MASK_STATIS_BT_HI_RX_8814B 0xffff -+#define BIT_STATIS_BT_HI_RX_8814B(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_RX_8814B) \ -+ << BIT_SHIFT_STATIS_BT_HI_RX_8814B) -+#define BITS_STATIS_BT_HI_RX_8814B \ -+ (BIT_MASK_STATIS_BT_HI_RX_8814B << BIT_SHIFT_STATIS_BT_HI_RX_8814B) -+#define BIT_CLEAR_STATIS_BT_HI_RX_8814B(x) ((x) & (~BITS_STATIS_BT_HI_RX_8814B)) -+#define BIT_GET_STATIS_BT_HI_RX_8814B(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_RX_8814B) & \ -+ BIT_MASK_STATIS_BT_HI_RX_8814B) -+#define BIT_SET_STATIS_BT_HI_RX_8814B(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_RX_8814B(x) | BIT_STATIS_BT_HI_RX_8814B(v)) -+ -+#define BIT_SHIFT_STATIS_BT_HI_TX_8814B 0 -+#define BIT_MASK_STATIS_BT_HI_TX_8814B 0xffff -+#define BIT_STATIS_BT_HI_TX_8814B(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_TX_8814B) \ -+ << BIT_SHIFT_STATIS_BT_HI_TX_8814B) -+#define BITS_STATIS_BT_HI_TX_8814B \ -+ (BIT_MASK_STATIS_BT_HI_TX_8814B << BIT_SHIFT_STATIS_BT_HI_TX_8814B) -+#define BIT_CLEAR_STATIS_BT_HI_TX_8814B(x) ((x) & (~BITS_STATIS_BT_HI_TX_8814B)) -+#define BIT_GET_STATIS_BT_HI_TX_8814B(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_TX_8814B) & \ -+ BIT_MASK_STATIS_BT_HI_TX_8814B) -+#define BIT_SET_STATIS_BT_HI_TX_8814B(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_TX_8814B(x) | BIT_STATIS_BT_HI_TX_8814B(v)) -+ -+/* 2 REG_BT_ACT_STATISTICS_1_8814B */ -+ -+#define BIT_SHIFT_STATIS_BT_LO_RX_1_8814B 16 -+#define BIT_MASK_STATIS_BT_LO_RX_1_8814B 0xffff -+#define BIT_STATIS_BT_LO_RX_1_8814B(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_RX_1_8814B) \ -+ << BIT_SHIFT_STATIS_BT_LO_RX_1_8814B) -+#define BITS_STATIS_BT_LO_RX_1_8814B \ -+ (BIT_MASK_STATIS_BT_LO_RX_1_8814B << BIT_SHIFT_STATIS_BT_LO_RX_1_8814B) -+#define BIT_CLEAR_STATIS_BT_LO_RX_1_8814B(x) \ -+ ((x) & (~BITS_STATIS_BT_LO_RX_1_8814B)) -+#define BIT_GET_STATIS_BT_LO_RX_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_RX_1_8814B) & \ -+ BIT_MASK_STATIS_BT_LO_RX_1_8814B) -+#define BIT_SET_STATIS_BT_LO_RX_1_8814B(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_RX_1_8814B(x) | BIT_STATIS_BT_LO_RX_1_8814B(v)) -+ -+#define BIT_SHIFT_STATIS_BT_LO_TX_1_8814B 0 -+#define BIT_MASK_STATIS_BT_LO_TX_1_8814B 0xffff -+#define BIT_STATIS_BT_LO_TX_1_8814B(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_TX_1_8814B) \ -+ << BIT_SHIFT_STATIS_BT_LO_TX_1_8814B) -+#define BITS_STATIS_BT_LO_TX_1_8814B \ -+ (BIT_MASK_STATIS_BT_LO_TX_1_8814B << BIT_SHIFT_STATIS_BT_LO_TX_1_8814B) -+#define BIT_CLEAR_STATIS_BT_LO_TX_1_8814B(x) \ -+ ((x) & (~BITS_STATIS_BT_LO_TX_1_8814B)) -+#define BIT_GET_STATIS_BT_LO_TX_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_TX_1_8814B) & \ -+ BIT_MASK_STATIS_BT_LO_TX_1_8814B) -+#define BIT_SET_STATIS_BT_LO_TX_1_8814B(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_TX_1_8814B(x) | BIT_STATIS_BT_LO_TX_1_8814B(v)) -+ -+/* 2 REG_BT_STATISTICS_CONTROL_REGISTER_8814B */ -+ -+#define BIT_SHIFT_R_BT_CMD_RPT_8814B 16 -+#define BIT_MASK_R_BT_CMD_RPT_8814B 0xffff -+#define BIT_R_BT_CMD_RPT_8814B(x) \ -+ (((x) & BIT_MASK_R_BT_CMD_RPT_8814B) << BIT_SHIFT_R_BT_CMD_RPT_8814B) -+#define BITS_R_BT_CMD_RPT_8814B \ -+ (BIT_MASK_R_BT_CMD_RPT_8814B << BIT_SHIFT_R_BT_CMD_RPT_8814B) -+#define BIT_CLEAR_R_BT_CMD_RPT_8814B(x) ((x) & (~BITS_R_BT_CMD_RPT_8814B)) -+#define BIT_GET_R_BT_CMD_RPT_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CMD_RPT_8814B) & BIT_MASK_R_BT_CMD_RPT_8814B) -+#define BIT_SET_R_BT_CMD_RPT_8814B(x, v) \ -+ (BIT_CLEAR_R_BT_CMD_RPT_8814B(x) | BIT_R_BT_CMD_RPT_8814B(v)) -+ -+#define BIT_SHIFT_R_RPT_FROM_BT_8814B 8 -+#define BIT_MASK_R_RPT_FROM_BT_8814B 0xff -+#define BIT_R_RPT_FROM_BT_8814B(x) \ -+ (((x) & BIT_MASK_R_RPT_FROM_BT_8814B) << BIT_SHIFT_R_RPT_FROM_BT_8814B) -+#define BITS_R_RPT_FROM_BT_8814B \ -+ (BIT_MASK_R_RPT_FROM_BT_8814B << BIT_SHIFT_R_RPT_FROM_BT_8814B) -+#define BIT_CLEAR_R_RPT_FROM_BT_8814B(x) ((x) & (~BITS_R_RPT_FROM_BT_8814B)) -+#define BIT_GET_R_RPT_FROM_BT_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_RPT_FROM_BT_8814B) & BIT_MASK_R_RPT_FROM_BT_8814B) -+#define BIT_SET_R_RPT_FROM_BT_8814B(x, v) \ -+ (BIT_CLEAR_R_RPT_FROM_BT_8814B(x) | BIT_R_RPT_FROM_BT_8814B(v)) -+ -+#define BIT_SHIFT_BT_HID_ISR_SET_8814B 6 -+#define BIT_MASK_BT_HID_ISR_SET_8814B 0x3 -+#define BIT_BT_HID_ISR_SET_8814B(x) \ -+ (((x) & BIT_MASK_BT_HID_ISR_SET_8814B) \ -+ << BIT_SHIFT_BT_HID_ISR_SET_8814B) -+#define BITS_BT_HID_ISR_SET_8814B \ -+ (BIT_MASK_BT_HID_ISR_SET_8814B << BIT_SHIFT_BT_HID_ISR_SET_8814B) -+#define BIT_CLEAR_BT_HID_ISR_SET_8814B(x) ((x) & (~BITS_BT_HID_ISR_SET_8814B)) -+#define BIT_GET_BT_HID_ISR_SET_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_HID_ISR_SET_8814B) & \ -+ BIT_MASK_BT_HID_ISR_SET_8814B) -+#define BIT_SET_BT_HID_ISR_SET_8814B(x, v) \ -+ (BIT_CLEAR_BT_HID_ISR_SET_8814B(x) | BIT_BT_HID_ISR_SET_8814B(v)) -+ -+#define BIT_TDMA_BT_START_NOTIFY_8814B BIT(5) -+#define BIT_ENABLE_TDMA_FW_MODE_8814B BIT(4) -+#define BIT_ENABLE_PTA_TDMA_MODE_8814B BIT(3) -+#define BIT_ENABLE_COEXIST_TAB_IN_TDMA_8814B BIT(2) -+#define BIT_GPIO2_GPIO3_EXANGE_OR_NO_BT_CCA_8814B BIT(1) -+#define BIT_RTK_BT_ENABLE_8814B BIT(0) -+ -+/* 2 REG_BT_STATUS_REPORT_REGISTER_8814B */ -+ -+#define BIT_SHIFT_BT_PROFILE_8814B 24 -+#define BIT_MASK_BT_PROFILE_8814B 0xff -+#define BIT_BT_PROFILE_8814B(x) \ -+ (((x) & BIT_MASK_BT_PROFILE_8814B) << BIT_SHIFT_BT_PROFILE_8814B) -+#define BITS_BT_PROFILE_8814B \ -+ (BIT_MASK_BT_PROFILE_8814B << BIT_SHIFT_BT_PROFILE_8814B) -+#define BIT_CLEAR_BT_PROFILE_8814B(x) ((x) & (~BITS_BT_PROFILE_8814B)) -+#define BIT_GET_BT_PROFILE_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_PROFILE_8814B) & BIT_MASK_BT_PROFILE_8814B) -+#define BIT_SET_BT_PROFILE_8814B(x, v) \ -+ (BIT_CLEAR_BT_PROFILE_8814B(x) | BIT_BT_PROFILE_8814B(v)) -+ -+#define BIT_SHIFT_BT_POWER_8814B 16 -+#define BIT_MASK_BT_POWER_8814B 0xff -+#define BIT_BT_POWER_8814B(x) \ -+ (((x) & BIT_MASK_BT_POWER_8814B) << BIT_SHIFT_BT_POWER_8814B) -+#define BITS_BT_POWER_8814B \ -+ (BIT_MASK_BT_POWER_8814B << BIT_SHIFT_BT_POWER_8814B) -+#define BIT_CLEAR_BT_POWER_8814B(x) ((x) & (~BITS_BT_POWER_8814B)) -+#define BIT_GET_BT_POWER_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_POWER_8814B) & BIT_MASK_BT_POWER_8814B) -+#define BIT_SET_BT_POWER_8814B(x, v) \ -+ (BIT_CLEAR_BT_POWER_8814B(x) | BIT_BT_POWER_8814B(v)) -+ -+#define BIT_SHIFT_BT_PREDECT_STATUS_8814B 8 -+#define BIT_MASK_BT_PREDECT_STATUS_8814B 0xff -+#define BIT_BT_PREDECT_STATUS_8814B(x) \ -+ (((x) & BIT_MASK_BT_PREDECT_STATUS_8814B) \ -+ << BIT_SHIFT_BT_PREDECT_STATUS_8814B) -+#define BITS_BT_PREDECT_STATUS_8814B \ -+ (BIT_MASK_BT_PREDECT_STATUS_8814B << BIT_SHIFT_BT_PREDECT_STATUS_8814B) -+#define BIT_CLEAR_BT_PREDECT_STATUS_8814B(x) \ -+ ((x) & (~BITS_BT_PREDECT_STATUS_8814B)) -+#define BIT_GET_BT_PREDECT_STATUS_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_PREDECT_STATUS_8814B) & \ -+ BIT_MASK_BT_PREDECT_STATUS_8814B) -+#define BIT_SET_BT_PREDECT_STATUS_8814B(x, v) \ -+ (BIT_CLEAR_BT_PREDECT_STATUS_8814B(x) | BIT_BT_PREDECT_STATUS_8814B(v)) -+ -+#define BIT_SHIFT_BT_CMD_INFO_8814B 0 -+#define BIT_MASK_BT_CMD_INFO_8814B 0xff -+#define BIT_BT_CMD_INFO_8814B(x) \ -+ (((x) & BIT_MASK_BT_CMD_INFO_8814B) << BIT_SHIFT_BT_CMD_INFO_8814B) -+#define BITS_BT_CMD_INFO_8814B \ -+ (BIT_MASK_BT_CMD_INFO_8814B << BIT_SHIFT_BT_CMD_INFO_8814B) -+#define BIT_CLEAR_BT_CMD_INFO_8814B(x) ((x) & (~BITS_BT_CMD_INFO_8814B)) -+#define BIT_GET_BT_CMD_INFO_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_CMD_INFO_8814B) & BIT_MASK_BT_CMD_INFO_8814B) -+#define BIT_SET_BT_CMD_INFO_8814B(x, v) \ -+ (BIT_CLEAR_BT_CMD_INFO_8814B(x) | BIT_BT_CMD_INFO_8814B(v)) -+ -+/* 2 REG_BT_INTERRUPT_CONTROL_REGISTER_8814B */ -+#define BIT_EN_MAC_NULL_PKT_NOTIFY_8814B BIT(31) -+#define BIT_EN_WLAN_RPT_AND_BT_QUERY_8814B BIT(30) -+#define BIT_EN_BT_STSTUS_RPT_8814B BIT(29) -+#define BIT_EN_BT_POWER_8814B BIT(28) -+#define BIT_EN_BT_CHANNEL_8814B BIT(27) -+#define BIT_EN_BT_SLOT_CHANGE_8814B BIT(26) -+#define BIT_EN_BT_PROFILE_OR_HID_8814B BIT(25) -+#define BIT_WLAN_RPT_NOTIFY_8814B BIT(24) -+ -+#define BIT_SHIFT_WLAN_RPT_DATA_8814B 16 -+#define BIT_MASK_WLAN_RPT_DATA_8814B 0xff -+#define BIT_WLAN_RPT_DATA_8814B(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_DATA_8814B) << BIT_SHIFT_WLAN_RPT_DATA_8814B) -+#define BITS_WLAN_RPT_DATA_8814B \ -+ (BIT_MASK_WLAN_RPT_DATA_8814B << BIT_SHIFT_WLAN_RPT_DATA_8814B) -+#define BIT_CLEAR_WLAN_RPT_DATA_8814B(x) ((x) & (~BITS_WLAN_RPT_DATA_8814B)) -+#define BIT_GET_WLAN_RPT_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_DATA_8814B) & BIT_MASK_WLAN_RPT_DATA_8814B) -+#define BIT_SET_WLAN_RPT_DATA_8814B(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_DATA_8814B(x) | BIT_WLAN_RPT_DATA_8814B(v)) -+ -+#define BIT_SHIFT_CMD_ID_8814B 8 -+#define BIT_MASK_CMD_ID_8814B 0xff -+#define BIT_CMD_ID_8814B(x) \ -+ (((x) & BIT_MASK_CMD_ID_8814B) << BIT_SHIFT_CMD_ID_8814B) -+#define BITS_CMD_ID_8814B (BIT_MASK_CMD_ID_8814B << BIT_SHIFT_CMD_ID_8814B) -+#define BIT_CLEAR_CMD_ID_8814B(x) ((x) & (~BITS_CMD_ID_8814B)) -+#define BIT_GET_CMD_ID_8814B(x) \ -+ (((x) >> BIT_SHIFT_CMD_ID_8814B) & BIT_MASK_CMD_ID_8814B) -+#define BIT_SET_CMD_ID_8814B(x, v) \ -+ (BIT_CLEAR_CMD_ID_8814B(x) | BIT_CMD_ID_8814B(v)) -+ -+#define BIT_SHIFT_BT_DATA_8814B 0 -+#define BIT_MASK_BT_DATA_8814B 0xff -+#define BIT_BT_DATA_8814B(x) \ -+ (((x) & BIT_MASK_BT_DATA_8814B) << BIT_SHIFT_BT_DATA_8814B) -+#define BITS_BT_DATA_8814B (BIT_MASK_BT_DATA_8814B << BIT_SHIFT_BT_DATA_8814B) -+#define BIT_CLEAR_BT_DATA_8814B(x) ((x) & (~BITS_BT_DATA_8814B)) -+#define BIT_GET_BT_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_DATA_8814B) & BIT_MASK_BT_DATA_8814B) -+#define BIT_SET_BT_DATA_8814B(x, v) \ -+ (BIT_CLEAR_BT_DATA_8814B(x) | BIT_BT_DATA_8814B(v)) -+ -+/* 2 REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8814B */ -+ -+#define BIT_SHIFT_WLAN_RPT_TO_8814B 0 -+#define BIT_MASK_WLAN_RPT_TO_8814B 0xff -+#define BIT_WLAN_RPT_TO_8814B(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_TO_8814B) << BIT_SHIFT_WLAN_RPT_TO_8814B) -+#define BITS_WLAN_RPT_TO_8814B \ -+ (BIT_MASK_WLAN_RPT_TO_8814B << BIT_SHIFT_WLAN_RPT_TO_8814B) -+#define BIT_CLEAR_WLAN_RPT_TO_8814B(x) ((x) & (~BITS_WLAN_RPT_TO_8814B)) -+#define BIT_GET_WLAN_RPT_TO_8814B(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_TO_8814B) & BIT_MASK_WLAN_RPT_TO_8814B) -+#define BIT_SET_WLAN_RPT_TO_8814B(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_TO_8814B(x) | BIT_WLAN_RPT_TO_8814B(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8814B */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_0_8814B 1 -+#define BIT_MASK_ISOLATION_CHK_0_8814B 0x7fffff -+#define BIT_ISOLATION_CHK_0_8814B(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_0_8814B) \ -+ << BIT_SHIFT_ISOLATION_CHK_0_8814B) -+#define BITS_ISOLATION_CHK_0_8814B \ -+ (BIT_MASK_ISOLATION_CHK_0_8814B << BIT_SHIFT_ISOLATION_CHK_0_8814B) -+#define BIT_CLEAR_ISOLATION_CHK_0_8814B(x) ((x) & (~BITS_ISOLATION_CHK_0_8814B)) -+#define BIT_GET_ISOLATION_CHK_0_8814B(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_0_8814B) & \ -+ BIT_MASK_ISOLATION_CHK_0_8814B) -+#define BIT_SET_ISOLATION_CHK_0_8814B(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_0_8814B(x) | BIT_ISOLATION_CHK_0_8814B(v)) -+ -+#define BIT_ISOLATION_EN_8814B BIT(0) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_1_8814B */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_1_8814B 0 -+#define BIT_MASK_ISOLATION_CHK_1_8814B 0xffffffffL -+#define BIT_ISOLATION_CHK_1_8814B(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_1_8814B) \ -+ << BIT_SHIFT_ISOLATION_CHK_1_8814B) -+#define BITS_ISOLATION_CHK_1_8814B \ -+ (BIT_MASK_ISOLATION_CHK_1_8814B << BIT_SHIFT_ISOLATION_CHK_1_8814B) -+#define BIT_CLEAR_ISOLATION_CHK_1_8814B(x) ((x) & (~BITS_ISOLATION_CHK_1_8814B)) -+#define BIT_GET_ISOLATION_CHK_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_1_8814B) & \ -+ BIT_MASK_ISOLATION_CHK_1_8814B) -+#define BIT_SET_ISOLATION_CHK_1_8814B(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_1_8814B(x) | BIT_ISOLATION_CHK_1_8814B(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_2_8814B */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_2_8814B 0 -+#define BIT_MASK_ISOLATION_CHK_2_8814B 0xffffff -+#define BIT_ISOLATION_CHK_2_8814B(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_2_8814B) \ -+ << BIT_SHIFT_ISOLATION_CHK_2_8814B) -+#define BITS_ISOLATION_CHK_2_8814B \ -+ (BIT_MASK_ISOLATION_CHK_2_8814B << BIT_SHIFT_ISOLATION_CHK_2_8814B) -+#define BIT_CLEAR_ISOLATION_CHK_2_8814B(x) ((x) & (~BITS_ISOLATION_CHK_2_8814B)) -+#define BIT_GET_ISOLATION_CHK_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_2_8814B) & \ -+ BIT_MASK_ISOLATION_CHK_2_8814B) -+#define BIT_SET_ISOLATION_CHK_2_8814B(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_2_8814B(x) | BIT_ISOLATION_CHK_2_8814B(v)) -+ -+/* 2 REG_BT_INTERRUPT_STATUS_REGISTER_8814B */ -+#define BIT_BT_HID_ISR_8814B BIT(7) -+#define BIT_BT_QUERY_ISR_8814B BIT(6) -+#define BIT_MAC_NULL_PKT_NOTIFY_ISR_8814B BIT(5) -+#define BIT_WLAN_RPT_ISR_8814B BIT(4) -+#define BIT_BT_POWER_ISR_8814B BIT(3) -+#define BIT_BT_CHANNEL_ISR_8814B BIT(2) -+#define BIT_BT_SLOT_CHANGE_ISR_8814B BIT(1) -+#define BIT_BT_PROFILE_ISR_8814B BIT(0) -+ -+/* 2 REG_BT_TDMA_TIME_REGISTER_8814B */ -+ -+#define BIT_SHIFT_BT_TIME_8814B 6 -+#define BIT_MASK_BT_TIME_8814B 0x3ffffff -+#define BIT_BT_TIME_8814B(x) \ -+ (((x) & BIT_MASK_BT_TIME_8814B) << BIT_SHIFT_BT_TIME_8814B) -+#define BITS_BT_TIME_8814B (BIT_MASK_BT_TIME_8814B << BIT_SHIFT_BT_TIME_8814B) -+#define BIT_CLEAR_BT_TIME_8814B(x) ((x) & (~BITS_BT_TIME_8814B)) -+#define BIT_GET_BT_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_TIME_8814B) & BIT_MASK_BT_TIME_8814B) -+#define BIT_SET_BT_TIME_8814B(x, v) \ -+ (BIT_CLEAR_BT_TIME_8814B(x) | BIT_BT_TIME_8814B(v)) -+ -+#define BIT_SHIFT_BT_RPT_SAMPLE_RATE_8814B 0 -+#define BIT_MASK_BT_RPT_SAMPLE_RATE_8814B 0x3f -+#define BIT_BT_RPT_SAMPLE_RATE_8814B(x) \ -+ (((x) & BIT_MASK_BT_RPT_SAMPLE_RATE_8814B) \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8814B) -+#define BITS_BT_RPT_SAMPLE_RATE_8814B \ -+ (BIT_MASK_BT_RPT_SAMPLE_RATE_8814B \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8814B) -+#define BIT_CLEAR_BT_RPT_SAMPLE_RATE_8814B(x) \ -+ ((x) & (~BITS_BT_RPT_SAMPLE_RATE_8814B)) -+#define BIT_GET_BT_RPT_SAMPLE_RATE_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_RPT_SAMPLE_RATE_8814B) & \ -+ BIT_MASK_BT_RPT_SAMPLE_RATE_8814B) -+#define BIT_SET_BT_RPT_SAMPLE_RATE_8814B(x, v) \ -+ (BIT_CLEAR_BT_RPT_SAMPLE_RATE_8814B(x) | \ -+ BIT_BT_RPT_SAMPLE_RATE_8814B(v)) -+ -+/* 2 REG_BT_ACT_REGISTER_8814B */ -+ -+#define BIT_SHIFT_BT_EISR_EN_8814B 16 -+#define BIT_MASK_BT_EISR_EN_8814B 0xff -+#define BIT_BT_EISR_EN_8814B(x) \ -+ (((x) & BIT_MASK_BT_EISR_EN_8814B) << BIT_SHIFT_BT_EISR_EN_8814B) -+#define BITS_BT_EISR_EN_8814B \ -+ (BIT_MASK_BT_EISR_EN_8814B << BIT_SHIFT_BT_EISR_EN_8814B) -+#define BIT_CLEAR_BT_EISR_EN_8814B(x) ((x) & (~BITS_BT_EISR_EN_8814B)) -+#define BIT_GET_BT_EISR_EN_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_EISR_EN_8814B) & BIT_MASK_BT_EISR_EN_8814B) -+#define BIT_SET_BT_EISR_EN_8814B(x, v) \ -+ (BIT_CLEAR_BT_EISR_EN_8814B(x) | BIT_BT_EISR_EN_8814B(v)) -+ -+#define BIT_BT_ACT_FALLING_ISR_8814B BIT(10) -+#define BIT_BT_ACT_RISING_ISR_8814B BIT(9) -+#define BIT_TDMA_TO_ISR_8814B BIT(8) -+ -+#define BIT_SHIFT_BT_CH_8814B 0 -+#define BIT_MASK_BT_CH_8814B 0xff -+#define BIT_BT_CH_8814B(x) \ -+ (((x) & BIT_MASK_BT_CH_8814B) << BIT_SHIFT_BT_CH_8814B) -+#define BITS_BT_CH_8814B (BIT_MASK_BT_CH_8814B << BIT_SHIFT_BT_CH_8814B) -+#define BIT_CLEAR_BT_CH_8814B(x) ((x) & (~BITS_BT_CH_8814B)) -+#define BIT_GET_BT_CH_8814B(x) \ -+ (((x) >> BIT_SHIFT_BT_CH_8814B) & BIT_MASK_BT_CH_8814B) -+#define BIT_SET_BT_CH_8814B(x, v) \ -+ (BIT_CLEAR_BT_CH_8814B(x) | BIT_BT_CH_8814B(v)) -+ -+/* 2 REG_OBFF_CTRL_BASIC_8814B */ -+#define BIT_OBFF_EN_V1_8814B BIT(31) -+ -+#define BIT_SHIFT_OBFF_STATE_V1_8814B 28 -+#define BIT_MASK_OBFF_STATE_V1_8814B 0x3 -+#define BIT_OBFF_STATE_V1_8814B(x) \ -+ (((x) & BIT_MASK_OBFF_STATE_V1_8814B) << BIT_SHIFT_OBFF_STATE_V1_8814B) -+#define BITS_OBFF_STATE_V1_8814B \ -+ (BIT_MASK_OBFF_STATE_V1_8814B << BIT_SHIFT_OBFF_STATE_V1_8814B) -+#define BIT_CLEAR_OBFF_STATE_V1_8814B(x) ((x) & (~BITS_OBFF_STATE_V1_8814B)) -+#define BIT_GET_OBFF_STATE_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_OBFF_STATE_V1_8814B) & BIT_MASK_OBFF_STATE_V1_8814B) -+#define BIT_SET_OBFF_STATE_V1_8814B(x, v) \ -+ (BIT_CLEAR_OBFF_STATE_V1_8814B(x) | BIT_OBFF_STATE_V1_8814B(v)) -+ -+#define BIT_OBFF_ACT_RXDMA_EN_8814B BIT(27) -+#define BIT_OBFF_BLOCK_INT_EN_8814B BIT(26) -+#define BIT_OBFF_AUTOACT_EN_8814B BIT(25) -+#define BIT_OBFF_AUTOIDLE_EN_8814B BIT(24) -+ -+#define BIT_SHIFT_WAKE_MAX_PLS_8814B 20 -+#define BIT_MASK_WAKE_MAX_PLS_8814B 0x7 -+#define BIT_WAKE_MAX_PLS_8814B(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_PLS_8814B) << BIT_SHIFT_WAKE_MAX_PLS_8814B) -+#define BITS_WAKE_MAX_PLS_8814B \ -+ (BIT_MASK_WAKE_MAX_PLS_8814B << BIT_SHIFT_WAKE_MAX_PLS_8814B) -+#define BIT_CLEAR_WAKE_MAX_PLS_8814B(x) ((x) & (~BITS_WAKE_MAX_PLS_8814B)) -+#define BIT_GET_WAKE_MAX_PLS_8814B(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_PLS_8814B) & BIT_MASK_WAKE_MAX_PLS_8814B) -+#define BIT_SET_WAKE_MAX_PLS_8814B(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_PLS_8814B(x) | BIT_WAKE_MAX_PLS_8814B(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_PLS_8814B 16 -+#define BIT_MASK_WAKE_MIN_PLS_8814B 0x7 -+#define BIT_WAKE_MIN_PLS_8814B(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_PLS_8814B) << BIT_SHIFT_WAKE_MIN_PLS_8814B) -+#define BITS_WAKE_MIN_PLS_8814B \ -+ (BIT_MASK_WAKE_MIN_PLS_8814B << BIT_SHIFT_WAKE_MIN_PLS_8814B) -+#define BIT_CLEAR_WAKE_MIN_PLS_8814B(x) ((x) & (~BITS_WAKE_MIN_PLS_8814B)) -+#define BIT_GET_WAKE_MIN_PLS_8814B(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_PLS_8814B) & BIT_MASK_WAKE_MIN_PLS_8814B) -+#define BIT_SET_WAKE_MIN_PLS_8814B(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_PLS_8814B(x) | BIT_WAKE_MIN_PLS_8814B(v)) -+ -+#define BIT_SHIFT_WAKE_MAX_F2F_8814B 12 -+#define BIT_MASK_WAKE_MAX_F2F_8814B 0x7 -+#define BIT_WAKE_MAX_F2F_8814B(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_F2F_8814B) << BIT_SHIFT_WAKE_MAX_F2F_8814B) -+#define BITS_WAKE_MAX_F2F_8814B \ -+ (BIT_MASK_WAKE_MAX_F2F_8814B << BIT_SHIFT_WAKE_MAX_F2F_8814B) -+#define BIT_CLEAR_WAKE_MAX_F2F_8814B(x) ((x) & (~BITS_WAKE_MAX_F2F_8814B)) -+#define BIT_GET_WAKE_MAX_F2F_8814B(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_F2F_8814B) & BIT_MASK_WAKE_MAX_F2F_8814B) -+#define BIT_SET_WAKE_MAX_F2F_8814B(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_F2F_8814B(x) | BIT_WAKE_MAX_F2F_8814B(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_F2F_8814B 8 -+#define BIT_MASK_WAKE_MIN_F2F_8814B 0x7 -+#define BIT_WAKE_MIN_F2F_8814B(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_F2F_8814B) << BIT_SHIFT_WAKE_MIN_F2F_8814B) -+#define BITS_WAKE_MIN_F2F_8814B \ -+ (BIT_MASK_WAKE_MIN_F2F_8814B << BIT_SHIFT_WAKE_MIN_F2F_8814B) -+#define BIT_CLEAR_WAKE_MIN_F2F_8814B(x) ((x) & (~BITS_WAKE_MIN_F2F_8814B)) -+#define BIT_GET_WAKE_MIN_F2F_8814B(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_F2F_8814B) & BIT_MASK_WAKE_MIN_F2F_8814B) -+#define BIT_SET_WAKE_MIN_F2F_8814B(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_F2F_8814B(x) | BIT_WAKE_MIN_F2F_8814B(v)) -+ -+#define BIT_APP_CPU_ACT_V1_8814B BIT(3) -+#define BIT_APP_OBFF_V1_8814B BIT(2) -+#define BIT_APP_IDLE_V1_8814B BIT(1) -+#define BIT_APP_INIT_V1_8814B BIT(0) -+ -+/* 2 REG_OBFF_CTRL2_TIMER_8814B */ -+ -+#define BIT_SHIFT_RX_HIGH_TIMER_IDX_8814B 24 -+#define BIT_MASK_RX_HIGH_TIMER_IDX_8814B 0x7 -+#define BIT_RX_HIGH_TIMER_IDX_8814B(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TIMER_IDX_8814B) \ -+ << BIT_SHIFT_RX_HIGH_TIMER_IDX_8814B) -+#define BITS_RX_HIGH_TIMER_IDX_8814B \ -+ (BIT_MASK_RX_HIGH_TIMER_IDX_8814B << BIT_SHIFT_RX_HIGH_TIMER_IDX_8814B) -+#define BIT_CLEAR_RX_HIGH_TIMER_IDX_8814B(x) \ -+ ((x) & (~BITS_RX_HIGH_TIMER_IDX_8814B)) -+#define BIT_GET_RX_HIGH_TIMER_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TIMER_IDX_8814B) & \ -+ BIT_MASK_RX_HIGH_TIMER_IDX_8814B) -+#define BIT_SET_RX_HIGH_TIMER_IDX_8814B(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TIMER_IDX_8814B(x) | BIT_RX_HIGH_TIMER_IDX_8814B(v)) -+ -+#define BIT_SHIFT_RX_MED_TIMER_IDX_8814B 16 -+#define BIT_MASK_RX_MED_TIMER_IDX_8814B 0x7 -+#define BIT_RX_MED_TIMER_IDX_8814B(x) \ -+ (((x) & BIT_MASK_RX_MED_TIMER_IDX_8814B) \ -+ << BIT_SHIFT_RX_MED_TIMER_IDX_8814B) -+#define BITS_RX_MED_TIMER_IDX_8814B \ -+ (BIT_MASK_RX_MED_TIMER_IDX_8814B << BIT_SHIFT_RX_MED_TIMER_IDX_8814B) -+#define BIT_CLEAR_RX_MED_TIMER_IDX_8814B(x) \ -+ ((x) & (~BITS_RX_MED_TIMER_IDX_8814B)) -+#define BIT_GET_RX_MED_TIMER_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TIMER_IDX_8814B) & \ -+ BIT_MASK_RX_MED_TIMER_IDX_8814B) -+#define BIT_SET_RX_MED_TIMER_IDX_8814B(x, v) \ -+ (BIT_CLEAR_RX_MED_TIMER_IDX_8814B(x) | BIT_RX_MED_TIMER_IDX_8814B(v)) -+ -+#define BIT_SHIFT_RX_LOW_TIMER_IDX_8814B 8 -+#define BIT_MASK_RX_LOW_TIMER_IDX_8814B 0x7 -+#define BIT_RX_LOW_TIMER_IDX_8814B(x) \ -+ (((x) & BIT_MASK_RX_LOW_TIMER_IDX_8814B) \ -+ << BIT_SHIFT_RX_LOW_TIMER_IDX_8814B) -+#define BITS_RX_LOW_TIMER_IDX_8814B \ -+ (BIT_MASK_RX_LOW_TIMER_IDX_8814B << BIT_SHIFT_RX_LOW_TIMER_IDX_8814B) -+#define BIT_CLEAR_RX_LOW_TIMER_IDX_8814B(x) \ -+ ((x) & (~BITS_RX_LOW_TIMER_IDX_8814B)) -+#define BIT_GET_RX_LOW_TIMER_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TIMER_IDX_8814B) & \ -+ BIT_MASK_RX_LOW_TIMER_IDX_8814B) -+#define BIT_SET_RX_LOW_TIMER_IDX_8814B(x, v) \ -+ (BIT_CLEAR_RX_LOW_TIMER_IDX_8814B(x) | BIT_RX_LOW_TIMER_IDX_8814B(v)) -+ -+#define BIT_SHIFT_OBFF_INT_TIMER_IDX_8814B 0 -+#define BIT_MASK_OBFF_INT_TIMER_IDX_8814B 0x7 -+#define BIT_OBFF_INT_TIMER_IDX_8814B(x) \ -+ (((x) & BIT_MASK_OBFF_INT_TIMER_IDX_8814B) \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8814B) -+#define BITS_OBFF_INT_TIMER_IDX_8814B \ -+ (BIT_MASK_OBFF_INT_TIMER_IDX_8814B \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8814B) -+#define BIT_CLEAR_OBFF_INT_TIMER_IDX_8814B(x) \ -+ ((x) & (~BITS_OBFF_INT_TIMER_IDX_8814B)) -+#define BIT_GET_OBFF_INT_TIMER_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_OBFF_INT_TIMER_IDX_8814B) & \ -+ BIT_MASK_OBFF_INT_TIMER_IDX_8814B) -+#define BIT_SET_OBFF_INT_TIMER_IDX_8814B(x, v) \ -+ (BIT_CLEAR_OBFF_INT_TIMER_IDX_8814B(x) | \ -+ BIT_OBFF_INT_TIMER_IDX_8814B(v)) -+ -+/* 2 REG_LTR_CTRL_BASIC_8814B */ -+#define BIT_LTR_EN_V1_8814B BIT(31) -+#define BIT_LTR_HW_EN_V1_8814B BIT(30) -+#define BIT_LRT_ACT_CTS_EN_8814B BIT(29) -+#define BIT_LTR_ACT_RXPKT_EN_8814B BIT(28) -+#define BIT_LTR_ACT_RXDMA_EN_8814B BIT(27) -+#define BIT_LTR_IDLE_NO_SNOOP_8814B BIT(26) -+#define BIT_SPDUP_MGTPKT_8814B BIT(25) -+#define BIT_RX_AGG_EN_8814B BIT(24) -+#define BIT_APP_LTR_ACT_8814B BIT(23) -+#define BIT_APP_LTR_IDLE_8814B BIT(22) -+ -+#define BIT_SHIFT_HIGH_RATE_TRIG_SEL_8814B 20 -+#define BIT_MASK_HIGH_RATE_TRIG_SEL_8814B 0x3 -+#define BIT_HIGH_RATE_TRIG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_TRIG_SEL_8814B) \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8814B) -+#define BITS_HIGH_RATE_TRIG_SEL_8814B \ -+ (BIT_MASK_HIGH_RATE_TRIG_SEL_8814B \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8814B) -+#define BIT_CLEAR_HIGH_RATE_TRIG_SEL_8814B(x) \ -+ ((x) & (~BITS_HIGH_RATE_TRIG_SEL_8814B)) -+#define BIT_GET_HIGH_RATE_TRIG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_TRIG_SEL_8814B) & \ -+ BIT_MASK_HIGH_RATE_TRIG_SEL_8814B) -+#define BIT_SET_HIGH_RATE_TRIG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_TRIG_SEL_8814B(x) | \ -+ BIT_HIGH_RATE_TRIG_SEL_8814B(v)) -+ -+#define BIT_SHIFT_MED_RATE_TRIG_SEL_8814B 18 -+#define BIT_MASK_MED_RATE_TRIG_SEL_8814B 0x3 -+#define BIT_MED_RATE_TRIG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_MED_RATE_TRIG_SEL_8814B) \ -+ << BIT_SHIFT_MED_RATE_TRIG_SEL_8814B) -+#define BITS_MED_RATE_TRIG_SEL_8814B \ -+ (BIT_MASK_MED_RATE_TRIG_SEL_8814B << BIT_SHIFT_MED_RATE_TRIG_SEL_8814B) -+#define BIT_CLEAR_MED_RATE_TRIG_SEL_8814B(x) \ -+ ((x) & (~BITS_MED_RATE_TRIG_SEL_8814B)) -+#define BIT_GET_MED_RATE_TRIG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_MED_RATE_TRIG_SEL_8814B) & \ -+ BIT_MASK_MED_RATE_TRIG_SEL_8814B) -+#define BIT_SET_MED_RATE_TRIG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_MED_RATE_TRIG_SEL_8814B(x) | BIT_MED_RATE_TRIG_SEL_8814B(v)) -+ -+#define BIT_SHIFT_LOW_RATE_TRIG_SEL_8814B 16 -+#define BIT_MASK_LOW_RATE_TRIG_SEL_8814B 0x3 -+#define BIT_LOW_RATE_TRIG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_LOW_RATE_TRIG_SEL_8814B) \ -+ << BIT_SHIFT_LOW_RATE_TRIG_SEL_8814B) -+#define BITS_LOW_RATE_TRIG_SEL_8814B \ -+ (BIT_MASK_LOW_RATE_TRIG_SEL_8814B << BIT_SHIFT_LOW_RATE_TRIG_SEL_8814B) -+#define BIT_CLEAR_LOW_RATE_TRIG_SEL_8814B(x) \ -+ ((x) & (~BITS_LOW_RATE_TRIG_SEL_8814B)) -+#define BIT_GET_LOW_RATE_TRIG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_TRIG_SEL_8814B) & \ -+ BIT_MASK_LOW_RATE_TRIG_SEL_8814B) -+#define BIT_SET_LOW_RATE_TRIG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_LOW_RATE_TRIG_SEL_8814B(x) | BIT_LOW_RATE_TRIG_SEL_8814B(v)) -+ -+#define BIT_SHIFT_HIGH_RATE_BD_IDX_8814B 8 -+#define BIT_MASK_HIGH_RATE_BD_IDX_8814B 0x7f -+#define BIT_HIGH_RATE_BD_IDX_8814B(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_BD_IDX_8814B) \ -+ << BIT_SHIFT_HIGH_RATE_BD_IDX_8814B) -+#define BITS_HIGH_RATE_BD_IDX_8814B \ -+ (BIT_MASK_HIGH_RATE_BD_IDX_8814B << BIT_SHIFT_HIGH_RATE_BD_IDX_8814B) -+#define BIT_CLEAR_HIGH_RATE_BD_IDX_8814B(x) \ -+ ((x) & (~BITS_HIGH_RATE_BD_IDX_8814B)) -+#define BIT_GET_HIGH_RATE_BD_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_BD_IDX_8814B) & \ -+ BIT_MASK_HIGH_RATE_BD_IDX_8814B) -+#define BIT_SET_HIGH_RATE_BD_IDX_8814B(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_BD_IDX_8814B(x) | BIT_HIGH_RATE_BD_IDX_8814B(v)) -+ -+#define BIT_SHIFT_LOW_RATE_BD_IDX_8814B 0 -+#define BIT_MASK_LOW_RATE_BD_IDX_8814B 0x7f -+#define BIT_LOW_RATE_BD_IDX_8814B(x) \ -+ (((x) & BIT_MASK_LOW_RATE_BD_IDX_8814B) \ -+ << BIT_SHIFT_LOW_RATE_BD_IDX_8814B) -+#define BITS_LOW_RATE_BD_IDX_8814B \ -+ (BIT_MASK_LOW_RATE_BD_IDX_8814B << BIT_SHIFT_LOW_RATE_BD_IDX_8814B) -+#define BIT_CLEAR_LOW_RATE_BD_IDX_8814B(x) ((x) & (~BITS_LOW_RATE_BD_IDX_8814B)) -+#define BIT_GET_LOW_RATE_BD_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_BD_IDX_8814B) & \ -+ BIT_MASK_LOW_RATE_BD_IDX_8814B) -+#define BIT_SET_LOW_RATE_BD_IDX_8814B(x, v) \ -+ (BIT_CLEAR_LOW_RATE_BD_IDX_8814B(x) | BIT_LOW_RATE_BD_IDX_8814B(v)) -+ -+/* 2 REG_LTR_CTRL2_TIMER_THRESHOLD_8814B */ -+ -+#define BIT_SHIFT_RX_EMPTY_TIMER_IDX_8814B 24 -+#define BIT_MASK_RX_EMPTY_TIMER_IDX_8814B 0x7 -+#define BIT_RX_EMPTY_TIMER_IDX_8814B(x) \ -+ (((x) & BIT_MASK_RX_EMPTY_TIMER_IDX_8814B) \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8814B) -+#define BITS_RX_EMPTY_TIMER_IDX_8814B \ -+ (BIT_MASK_RX_EMPTY_TIMER_IDX_8814B \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8814B) -+#define BIT_CLEAR_RX_EMPTY_TIMER_IDX_8814B(x) \ -+ ((x) & (~BITS_RX_EMPTY_TIMER_IDX_8814B)) -+#define BIT_GET_RX_EMPTY_TIMER_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_EMPTY_TIMER_IDX_8814B) & \ -+ BIT_MASK_RX_EMPTY_TIMER_IDX_8814B) -+#define BIT_SET_RX_EMPTY_TIMER_IDX_8814B(x, v) \ -+ (BIT_CLEAR_RX_EMPTY_TIMER_IDX_8814B(x) | \ -+ BIT_RX_EMPTY_TIMER_IDX_8814B(v)) -+ -+#define BIT_SHIFT_RX_AFULL_TH_IDX_8814B 20 -+#define BIT_MASK_RX_AFULL_TH_IDX_8814B 0x7 -+#define BIT_RX_AFULL_TH_IDX_8814B(x) \ -+ (((x) & BIT_MASK_RX_AFULL_TH_IDX_8814B) \ -+ << BIT_SHIFT_RX_AFULL_TH_IDX_8814B) -+#define BITS_RX_AFULL_TH_IDX_8814B \ -+ (BIT_MASK_RX_AFULL_TH_IDX_8814B << BIT_SHIFT_RX_AFULL_TH_IDX_8814B) -+#define BIT_CLEAR_RX_AFULL_TH_IDX_8814B(x) ((x) & (~BITS_RX_AFULL_TH_IDX_8814B)) -+#define BIT_GET_RX_AFULL_TH_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_AFULL_TH_IDX_8814B) & \ -+ BIT_MASK_RX_AFULL_TH_IDX_8814B) -+#define BIT_SET_RX_AFULL_TH_IDX_8814B(x, v) \ -+ (BIT_CLEAR_RX_AFULL_TH_IDX_8814B(x) | BIT_RX_AFULL_TH_IDX_8814B(v)) -+ -+#define BIT_SHIFT_RX_HIGH_TH_IDX_8814B 16 -+#define BIT_MASK_RX_HIGH_TH_IDX_8814B 0x7 -+#define BIT_RX_HIGH_TH_IDX_8814B(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TH_IDX_8814B) \ -+ << BIT_SHIFT_RX_HIGH_TH_IDX_8814B) -+#define BITS_RX_HIGH_TH_IDX_8814B \ -+ (BIT_MASK_RX_HIGH_TH_IDX_8814B << BIT_SHIFT_RX_HIGH_TH_IDX_8814B) -+#define BIT_CLEAR_RX_HIGH_TH_IDX_8814B(x) ((x) & (~BITS_RX_HIGH_TH_IDX_8814B)) -+#define BIT_GET_RX_HIGH_TH_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TH_IDX_8814B) & \ -+ BIT_MASK_RX_HIGH_TH_IDX_8814B) -+#define BIT_SET_RX_HIGH_TH_IDX_8814B(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TH_IDX_8814B(x) | BIT_RX_HIGH_TH_IDX_8814B(v)) -+ -+#define BIT_SHIFT_RX_MED_TH_IDX_8814B 12 -+#define BIT_MASK_RX_MED_TH_IDX_8814B 0x7 -+#define BIT_RX_MED_TH_IDX_8814B(x) \ -+ (((x) & BIT_MASK_RX_MED_TH_IDX_8814B) << BIT_SHIFT_RX_MED_TH_IDX_8814B) -+#define BITS_RX_MED_TH_IDX_8814B \ -+ (BIT_MASK_RX_MED_TH_IDX_8814B << BIT_SHIFT_RX_MED_TH_IDX_8814B) -+#define BIT_CLEAR_RX_MED_TH_IDX_8814B(x) ((x) & (~BITS_RX_MED_TH_IDX_8814B)) -+#define BIT_GET_RX_MED_TH_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TH_IDX_8814B) & BIT_MASK_RX_MED_TH_IDX_8814B) -+#define BIT_SET_RX_MED_TH_IDX_8814B(x, v) \ -+ (BIT_CLEAR_RX_MED_TH_IDX_8814B(x) | BIT_RX_MED_TH_IDX_8814B(v)) -+ -+#define BIT_SHIFT_RX_LOW_TH_IDX_8814B 8 -+#define BIT_MASK_RX_LOW_TH_IDX_8814B 0x7 -+#define BIT_RX_LOW_TH_IDX_8814B(x) \ -+ (((x) & BIT_MASK_RX_LOW_TH_IDX_8814B) << BIT_SHIFT_RX_LOW_TH_IDX_8814B) -+#define BITS_RX_LOW_TH_IDX_8814B \ -+ (BIT_MASK_RX_LOW_TH_IDX_8814B << BIT_SHIFT_RX_LOW_TH_IDX_8814B) -+#define BIT_CLEAR_RX_LOW_TH_IDX_8814B(x) ((x) & (~BITS_RX_LOW_TH_IDX_8814B)) -+#define BIT_GET_RX_LOW_TH_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TH_IDX_8814B) & BIT_MASK_RX_LOW_TH_IDX_8814B) -+#define BIT_SET_RX_LOW_TH_IDX_8814B(x, v) \ -+ (BIT_CLEAR_RX_LOW_TH_IDX_8814B(x) | BIT_RX_LOW_TH_IDX_8814B(v)) -+ -+#define BIT_SHIFT_LTR_SPACE_IDX_8814B 4 -+#define BIT_MASK_LTR_SPACE_IDX_8814B 0x3 -+#define BIT_LTR_SPACE_IDX_8814B(x) \ -+ (((x) & BIT_MASK_LTR_SPACE_IDX_8814B) << BIT_SHIFT_LTR_SPACE_IDX_8814B) -+#define BITS_LTR_SPACE_IDX_8814B \ -+ (BIT_MASK_LTR_SPACE_IDX_8814B << BIT_SHIFT_LTR_SPACE_IDX_8814B) -+#define BIT_CLEAR_LTR_SPACE_IDX_8814B(x) ((x) & (~BITS_LTR_SPACE_IDX_8814B)) -+#define BIT_GET_LTR_SPACE_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_LTR_SPACE_IDX_8814B) & BIT_MASK_LTR_SPACE_IDX_8814B) -+#define BIT_SET_LTR_SPACE_IDX_8814B(x, v) \ -+ (BIT_CLEAR_LTR_SPACE_IDX_8814B(x) | BIT_LTR_SPACE_IDX_8814B(v)) -+ -+#define BIT_SHIFT_LTR_IDLE_TIMER_IDX_8814B 0 -+#define BIT_MASK_LTR_IDLE_TIMER_IDX_8814B 0x7 -+#define BIT_LTR_IDLE_TIMER_IDX_8814B(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_TIMER_IDX_8814B) \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8814B) -+#define BITS_LTR_IDLE_TIMER_IDX_8814B \ -+ (BIT_MASK_LTR_IDLE_TIMER_IDX_8814B \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8814B) -+#define BIT_CLEAR_LTR_IDLE_TIMER_IDX_8814B(x) \ -+ ((x) & (~BITS_LTR_IDLE_TIMER_IDX_8814B)) -+#define BIT_GET_LTR_IDLE_TIMER_IDX_8814B(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_TIMER_IDX_8814B) & \ -+ BIT_MASK_LTR_IDLE_TIMER_IDX_8814B) -+#define BIT_SET_LTR_IDLE_TIMER_IDX_8814B(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_TIMER_IDX_8814B(x) | \ -+ BIT_LTR_IDLE_TIMER_IDX_8814B(v)) -+ -+/* 2 REG_LTR_IDLE_LATENCY_V1_8814B */ -+ -+#define BIT_SHIFT_LTR_IDLE_L_8814B 0 -+#define BIT_MASK_LTR_IDLE_L_8814B 0xffffffffL -+#define BIT_LTR_IDLE_L_8814B(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_L_8814B) << BIT_SHIFT_LTR_IDLE_L_8814B) -+#define BITS_LTR_IDLE_L_8814B \ -+ (BIT_MASK_LTR_IDLE_L_8814B << BIT_SHIFT_LTR_IDLE_L_8814B) -+#define BIT_CLEAR_LTR_IDLE_L_8814B(x) ((x) & (~BITS_LTR_IDLE_L_8814B)) -+#define BIT_GET_LTR_IDLE_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_L_8814B) & BIT_MASK_LTR_IDLE_L_8814B) -+#define BIT_SET_LTR_IDLE_L_8814B(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_L_8814B(x) | BIT_LTR_IDLE_L_8814B(v)) -+ -+/* 2 REG_LTR_ACTIVE_LATENCY_V1_8814B */ -+ -+#define BIT_SHIFT_LTR_ACT_L_8814B 0 -+#define BIT_MASK_LTR_ACT_L_8814B 0xffffffffL -+#define BIT_LTR_ACT_L_8814B(x) \ -+ (((x) & BIT_MASK_LTR_ACT_L_8814B) << BIT_SHIFT_LTR_ACT_L_8814B) -+#define BITS_LTR_ACT_L_8814B \ -+ (BIT_MASK_LTR_ACT_L_8814B << BIT_SHIFT_LTR_ACT_L_8814B) -+#define BIT_CLEAR_LTR_ACT_L_8814B(x) ((x) & (~BITS_LTR_ACT_L_8814B)) -+#define BIT_GET_LTR_ACT_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_LTR_ACT_L_8814B) & BIT_MASK_LTR_ACT_L_8814B) -+#define BIT_SET_LTR_ACT_L_8814B(x, v) \ -+ (BIT_CLEAR_LTR_ACT_L_8814B(x) | BIT_LTR_ACT_L_8814B(v)) -+ -+#define BIT_SHIFT_ANT_ADDR2_1_8814B 0 -+#define BIT_MASK_ANT_ADDR2_1_8814B 0xffffffffL -+#define BIT_ANT_ADDR2_1_8814B(x) \ -+ (((x) & BIT_MASK_ANT_ADDR2_1_8814B) << BIT_SHIFT_ANT_ADDR2_1_8814B) -+#define BITS_ANT_ADDR2_1_8814B \ -+ (BIT_MASK_ANT_ADDR2_1_8814B << BIT_SHIFT_ANT_ADDR2_1_8814B) -+#define BIT_CLEAR_ANT_ADDR2_1_8814B(x) ((x) & (~BITS_ANT_ADDR2_1_8814B)) -+#define BIT_GET_ANT_ADDR2_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_ANT_ADDR2_1_8814B) & BIT_MASK_ANT_ADDR2_1_8814B) -+#define BIT_SET_ANT_ADDR2_1_8814B(x, v) \ -+ (BIT_CLEAR_ANT_ADDR2_1_8814B(x) | BIT_ANT_ADDR2_1_8814B(v)) -+ -+/* 2 REG_SMART_ANT_CTRL_8814B */ -+#define BIT_ANTTRN_SWITCH_8814B BIT(19) -+#define BIT_APPEND_MACID_IN_RESP_EN_1_8814B BIT(18) -+#define BIT_ADDR2_MATCH_EN_1_8814B BIT(17) -+#define BIT_ANTTRN_EN_1_8814B BIT(16) -+ -+#define BIT_SHIFT_ANT_ADDR2_2_8814B 0 -+#define BIT_MASK_ANT_ADDR2_2_8814B 0xffff -+#define BIT_ANT_ADDR2_2_8814B(x) \ -+ (((x) & BIT_MASK_ANT_ADDR2_2_8814B) << BIT_SHIFT_ANT_ADDR2_2_8814B) -+#define BITS_ANT_ADDR2_2_8814B \ -+ (BIT_MASK_ANT_ADDR2_2_8814B << BIT_SHIFT_ANT_ADDR2_2_8814B) -+#define BIT_CLEAR_ANT_ADDR2_2_8814B(x) ((x) & (~BITS_ANT_ADDR2_2_8814B)) -+#define BIT_GET_ANT_ADDR2_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_ANT_ADDR2_2_8814B) & BIT_MASK_ANT_ADDR2_2_8814B) -+#define BIT_SET_ANT_ADDR2_2_8814B(x, v) \ -+ (BIT_CLEAR_ANT_ADDR2_2_8814B(x) | BIT_ANT_ADDR2_2_8814B(v)) -+ -+/* 2 REG_CONTROL_FRAME_REPORT_8814B */ -+ -+#define BIT_SHIFT_CONTROL_FRAME_REPORT_8814B 0 -+#define BIT_MASK_CONTROL_FRAME_REPORT_8814B 0xffffffffL -+#define BIT_CONTROL_FRAME_REPORT_8814B(x) \ -+ (((x) & BIT_MASK_CONTROL_FRAME_REPORT_8814B) \ -+ << BIT_SHIFT_CONTROL_FRAME_REPORT_8814B) -+#define BITS_CONTROL_FRAME_REPORT_8814B \ -+ (BIT_MASK_CONTROL_FRAME_REPORT_8814B \ -+ << BIT_SHIFT_CONTROL_FRAME_REPORT_8814B) -+#define BIT_CLEAR_CONTROL_FRAME_REPORT_8814B(x) \ -+ ((x) & (~BITS_CONTROL_FRAME_REPORT_8814B)) -+#define BIT_GET_CONTROL_FRAME_REPORT_8814B(x) \ -+ (((x) >> BIT_SHIFT_CONTROL_FRAME_REPORT_8814B) & \ -+ BIT_MASK_CONTROL_FRAME_REPORT_8814B) -+#define BIT_SET_CONTROL_FRAME_REPORT_8814B(x, v) \ -+ (BIT_CLEAR_CONTROL_FRAME_REPORT_8814B(x) | \ -+ BIT_CONTROL_FRAME_REPORT_8814B(v)) -+ -+/* 2 REG_CONTROL_FRAME_CNT_CTRL_8814B */ -+#define BIT_ALLCNTRST_8814B BIT(9) -+#define BIT__ALLCNTEN_8814B BIT(8) -+ -+#define BIT_SHIFT_ADDR_8814B 4 -+#define BIT_MASK_ADDR_8814B 0xf -+#define BIT_ADDR_8814B(x) (((x) & BIT_MASK_ADDR_8814B) << BIT_SHIFT_ADDR_8814B) -+#define BITS_ADDR_8814B (BIT_MASK_ADDR_8814B << BIT_SHIFT_ADDR_8814B) -+#define BIT_CLEAR_ADDR_8814B(x) ((x) & (~BITS_ADDR_8814B)) -+#define BIT_GET_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_ADDR_8814B) & BIT_MASK_ADDR_8814B) -+#define BIT_SET_ADDR_8814B(x, v) (BIT_CLEAR_ADDR_8814B(x) | BIT_ADDR_8814B(v)) -+ -+#define BIT_SHIFT_CTRL_SEL_8814B 0 -+#define BIT_MASK_CTRL_SEL_8814B 0xf -+#define BIT_CTRL_SEL_8814B(x) \ -+ (((x) & BIT_MASK_CTRL_SEL_8814B) << BIT_SHIFT_CTRL_SEL_8814B) -+#define BITS_CTRL_SEL_8814B \ -+ (BIT_MASK_CTRL_SEL_8814B << BIT_SHIFT_CTRL_SEL_8814B) -+#define BIT_CLEAR_CTRL_SEL_8814B(x) ((x) & (~BITS_CTRL_SEL_8814B)) -+#define BIT_GET_CTRL_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_CTRL_SEL_8814B) & BIT_MASK_CTRL_SEL_8814B) -+#define BIT_SET_CTRL_SEL_8814B(x, v) \ -+ (BIT_CLEAR_CTRL_SEL_8814B(x) | BIT_CTRL_SEL_8814B(v)) -+ -+/* 2 REG_IQ_DUMP_8814B */ -+ -+#define BIT_SHIFT_DUMP_OK_ADDR_8814B 16 -+#define BIT_MASK_DUMP_OK_ADDR_8814B 0xffff -+#define BIT_DUMP_OK_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_DUMP_OK_ADDR_8814B) << BIT_SHIFT_DUMP_OK_ADDR_8814B) -+#define BITS_DUMP_OK_ADDR_8814B \ -+ (BIT_MASK_DUMP_OK_ADDR_8814B << BIT_SHIFT_DUMP_OK_ADDR_8814B) -+#define BIT_CLEAR_DUMP_OK_ADDR_8814B(x) ((x) & (~BITS_DUMP_OK_ADDR_8814B)) -+#define BIT_GET_DUMP_OK_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_DUMP_OK_ADDR_8814B) & BIT_MASK_DUMP_OK_ADDR_8814B) -+#define BIT_SET_DUMP_OK_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_DUMP_OK_ADDR_8814B(x) | BIT_DUMP_OK_ADDR_8814B(v)) -+ -+#define BIT_SHIFT_R_TRIG_TIME_SEL_8814B 8 -+#define BIT_MASK_R_TRIG_TIME_SEL_8814B 0x7f -+#define BIT_R_TRIG_TIME_SEL_8814B(x) \ -+ (((x) & BIT_MASK_R_TRIG_TIME_SEL_8814B) \ -+ << BIT_SHIFT_R_TRIG_TIME_SEL_8814B) -+#define BITS_R_TRIG_TIME_SEL_8814B \ -+ (BIT_MASK_R_TRIG_TIME_SEL_8814B << BIT_SHIFT_R_TRIG_TIME_SEL_8814B) -+#define BIT_CLEAR_R_TRIG_TIME_SEL_8814B(x) ((x) & (~BITS_R_TRIG_TIME_SEL_8814B)) -+#define BIT_GET_R_TRIG_TIME_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_TRIG_TIME_SEL_8814B) & \ -+ BIT_MASK_R_TRIG_TIME_SEL_8814B) -+#define BIT_SET_R_TRIG_TIME_SEL_8814B(x, v) \ -+ (BIT_CLEAR_R_TRIG_TIME_SEL_8814B(x) | BIT_R_TRIG_TIME_SEL_8814B(v)) -+ -+#define BIT_SHIFT_R_MAC_TRIG_SEL_8814B 6 -+#define BIT_MASK_R_MAC_TRIG_SEL_8814B 0x3 -+#define BIT_R_MAC_TRIG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_R_MAC_TRIG_SEL_8814B) \ -+ << BIT_SHIFT_R_MAC_TRIG_SEL_8814B) -+#define BITS_R_MAC_TRIG_SEL_8814B \ -+ (BIT_MASK_R_MAC_TRIG_SEL_8814B << BIT_SHIFT_R_MAC_TRIG_SEL_8814B) -+#define BIT_CLEAR_R_MAC_TRIG_SEL_8814B(x) ((x) & (~BITS_R_MAC_TRIG_SEL_8814B)) -+#define BIT_GET_R_MAC_TRIG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_TRIG_SEL_8814B) & \ -+ BIT_MASK_R_MAC_TRIG_SEL_8814B) -+#define BIT_SET_R_MAC_TRIG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_R_MAC_TRIG_SEL_8814B(x) | BIT_R_MAC_TRIG_SEL_8814B(v)) -+ -+#define BIT_MAC_TRIG_REG_8814B BIT(5) -+ -+#define BIT_SHIFT_R_LEVEL_PULSE_SEL_8814B 3 -+#define BIT_MASK_R_LEVEL_PULSE_SEL_8814B 0x3 -+#define BIT_R_LEVEL_PULSE_SEL_8814B(x) \ -+ (((x) & BIT_MASK_R_LEVEL_PULSE_SEL_8814B) \ -+ << BIT_SHIFT_R_LEVEL_PULSE_SEL_8814B) -+#define BITS_R_LEVEL_PULSE_SEL_8814B \ -+ (BIT_MASK_R_LEVEL_PULSE_SEL_8814B << BIT_SHIFT_R_LEVEL_PULSE_SEL_8814B) -+#define BIT_CLEAR_R_LEVEL_PULSE_SEL_8814B(x) \ -+ ((x) & (~BITS_R_LEVEL_PULSE_SEL_8814B)) -+#define BIT_GET_R_LEVEL_PULSE_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_LEVEL_PULSE_SEL_8814B) & \ -+ BIT_MASK_R_LEVEL_PULSE_SEL_8814B) -+#define BIT_SET_R_LEVEL_PULSE_SEL_8814B(x, v) \ -+ (BIT_CLEAR_R_LEVEL_PULSE_SEL_8814B(x) | BIT_R_LEVEL_PULSE_SEL_8814B(v)) -+ -+#define BIT_EN_LA_MAC_8814B BIT(2) -+#define BIT_R_EN_IQDUMP_8814B BIT(1) -+#define BIT_R_IQDATA_DUMP_8814B BIT(0) -+ -+/* 2 REG_IQ_DUMP_1_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8814B 0 -+#define BIT_MASK_R_WMAC_MASK_LA_MAC_1_8814B 0xffffffffL -+#define BIT_R_WMAC_MASK_LA_MAC_1_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_MASK_LA_MAC_1_8814B) \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8814B) -+#define BITS_R_WMAC_MASK_LA_MAC_1_8814B \ -+ (BIT_MASK_R_WMAC_MASK_LA_MAC_1_8814B \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8814B) -+#define BIT_CLEAR_R_WMAC_MASK_LA_MAC_1_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_MASK_LA_MAC_1_8814B)) -+#define BIT_GET_R_WMAC_MASK_LA_MAC_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8814B) & \ -+ BIT_MASK_R_WMAC_MASK_LA_MAC_1_8814B) -+#define BIT_SET_R_WMAC_MASK_LA_MAC_1_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_MASK_LA_MAC_1_8814B(x) | \ -+ BIT_R_WMAC_MASK_LA_MAC_1_8814B(v)) -+ -+/* 2 REG_IQ_DUMP_2_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8814B 0 -+#define BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8814B 0xffffffffL -+#define BIT_R_WMAC_MATCH_REF_MAC_2_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8814B) \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8814B) -+#define BITS_R_WMAC_MATCH_REF_MAC_2_8814B \ -+ (BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8814B \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8814B) -+#define BIT_CLEAR_R_WMAC_MATCH_REF_MAC_2_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_MATCH_REF_MAC_2_8814B)) -+#define BIT_GET_R_WMAC_MATCH_REF_MAC_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8814B) & \ -+ BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8814B) -+#define BIT_SET_R_WMAC_MATCH_REF_MAC_2_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_MATCH_REF_MAC_2_8814B(x) | \ -+ BIT_R_WMAC_MATCH_REF_MAC_2_8814B(v)) -+ -+/* 2 REG_WMAC_FTM_CTL_8814B */ -+#define BIT_RXFTM_TXACK_SC_8814B BIT(6) -+#define BIT_RXFTM_TXACK_BW_8814B BIT(5) -+#define BIT_RXFTM_EN_8814B BIT(3) -+#define BIT_RXFTMREQ_BYDRV_8814B BIT(2) -+#define BIT_RXFTMREQ_EN_8814B BIT(1) -+#define BIT_FTM_EN_8814B BIT(0) -+ -+/* 2 REG_WMAC_IQ_MDPK_FUNC_8814B */ -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_8814B */ -+ -+#define BIT_SHIFT_R_OFDM_LEN_8814B 26 -+#define BIT_MASK_R_OFDM_LEN_8814B 0x3f -+#define BIT_R_OFDM_LEN_8814B(x) \ -+ (((x) & BIT_MASK_R_OFDM_LEN_8814B) << BIT_SHIFT_R_OFDM_LEN_8814B) -+#define BITS_R_OFDM_LEN_8814B \ -+ (BIT_MASK_R_OFDM_LEN_8814B << BIT_SHIFT_R_OFDM_LEN_8814B) -+#define BIT_CLEAR_R_OFDM_LEN_8814B(x) ((x) & (~BITS_R_OFDM_LEN_8814B)) -+#define BIT_GET_R_OFDM_LEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_OFDM_LEN_8814B) & BIT_MASK_R_OFDM_LEN_8814B) -+#define BIT_SET_R_OFDM_LEN_8814B(x, v) \ -+ (BIT_CLEAR_R_OFDM_LEN_8814B(x) | BIT_R_OFDM_LEN_8814B(v)) -+ -+#define BIT_SHIFT_R_CCK_LEN_8814B 0 -+#define BIT_MASK_R_CCK_LEN_8814B 0xffff -+#define BIT_R_CCK_LEN_8814B(x) \ -+ (((x) & BIT_MASK_R_CCK_LEN_8814B) << BIT_SHIFT_R_CCK_LEN_8814B) -+#define BITS_R_CCK_LEN_8814B \ -+ (BIT_MASK_R_CCK_LEN_8814B << BIT_SHIFT_R_CCK_LEN_8814B) -+#define BIT_CLEAR_R_CCK_LEN_8814B(x) ((x) & (~BITS_R_CCK_LEN_8814B)) -+#define BIT_GET_R_CCK_LEN_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_CCK_LEN_8814B) & BIT_MASK_R_CCK_LEN_8814B) -+#define BIT_SET_R_CCK_LEN_8814B(x, v) \ -+ (BIT_CLEAR_R_CCK_LEN_8814B(x) | BIT_R_CCK_LEN_8814B(v)) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8814B 24 -+#define BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8814B 0xff -+#define BIT_R_WMAC_RXFIFO_FULL_TH_1_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8814B) \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8814B) -+#define BITS_R_WMAC_RXFIFO_FULL_TH_1_8814B \ -+ (BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8814B \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8814B) -+#define BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_1_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_RXFIFO_FULL_TH_1_8814B)) -+#define BIT_GET_R_WMAC_RXFIFO_FULL_TH_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8814B) & \ -+ BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8814B) -+#define BIT_SET_R_WMAC_RXFIFO_FULL_TH_1_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_1_8814B(x) | \ -+ BIT_R_WMAC_RXFIFO_FULL_TH_1_8814B(v)) -+ -+#define BIT_R_WMAC_RX_SYNCFIFO_SYNC_1_8814B BIT(23) -+#define BIT_R_WMAC_RXRST_DLY_1_8814B BIT(22) -+#define BIT_R_WMAC_SRCH_TXRPT_REF_DROP_1_8814B BIT(21) -+#define BIT_R_WMAC_SRCH_TXRPT_UA1_1_8814B BIT(20) -+#define BIT_R_WMAC_SRCH_TXRPT_TYPE_1_8814B BIT(19) -+#define BIT_R_WMAC_NDP_RST_1_8814B BIT(18) -+#define BIT_R_WMAC_POWINT_EN_1_8814B BIT(17) -+#define BIT_R_WMAC_SRCH_TXRPT_PERPKT_1_8814B BIT(16) -+#define BIT_R_WMAC_SRCH_TXRPT_MID_1_8814B BIT(15) -+#define BIT_R_WMAC_PFIN_TOEN_1_8814B BIT(14) -+#define BIT_R_WMAC_FIL_SECERR_1_8814B BIT(13) -+#define BIT_R_WMAC_FIL_CTLPKTLEN_1_8814B BIT(12) -+#define BIT_R_WMAC_FIL_FCTYPE_1_8814B BIT(11) -+#define BIT_R_WMAC_FIL_FCPROVER_1_8814B BIT(10) -+#define BIT_R_WMAC_PHYSTS_SNIF_1_8814B BIT(9) -+#define BIT_R_WMAC_PHYSTS_PLCP_1_8814B BIT(8) -+#define BIT_R_MAC_TCR_VBONF_RD_1_8814B BIT(7) -+#define BIT_R_WMAC_TCR_MPAR_NDP_1_8814B BIT(6) -+#define BIT_R_WMAC_NDP_FILTER_1_8814B BIT(5) -+#define BIT_R_WMAC_RXLEN_SEL_1_8814B BIT(4) -+#define BIT_R_WMAC_RXLEN_SEL1_1_8814B BIT(3) -+#define BIT_R_OFDM_FILTER_1_8814B BIT(2) -+#define BIT_R_WMAC_CHK_OFDM_LEN_1_8814B BIT(1) -+#define BIT_R_WMAC_CHK_CCK_LEN_1_8814B BIT(0) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_2_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8814B 0 -+#define BIT_MASK_R_WMAC_RX_FIL_LEN_2_8814B 0xffff -+#define BIT_R_WMAC_RX_FIL_LEN_2_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_RX_FIL_LEN_2_8814B) \ -+ << BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8814B) -+#define BITS_R_WMAC_RX_FIL_LEN_2_8814B \ -+ (BIT_MASK_R_WMAC_RX_FIL_LEN_2_8814B \ -+ << BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8814B) -+#define BIT_CLEAR_R_WMAC_RX_FIL_LEN_2_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_RX_FIL_LEN_2_8814B)) -+#define BIT_GET_R_WMAC_RX_FIL_LEN_2_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8814B) & \ -+ BIT_MASK_R_WMAC_RX_FIL_LEN_2_8814B) -+#define BIT_SET_R_WMAC_RX_FIL_LEN_2_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_RX_FIL_LEN_2_8814B(x) | \ -+ BIT_R_WMAC_RX_FIL_LEN_2_8814B(v)) -+ -+/* 2 REG_RX_FILTER_FUNCTION_8814B */ -+#define BIT_RXHANG_EN_8814B BIT(15) -+#define BIT_R_WMAC_MHRDDY_LATCH_8814B BIT(14) -+#define BIT_R_WMAC_MHRDDY_CLR_8814B BIT(13) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY1_8814B BIT(12) -+#define BIT_WMAC_DIS_VHT_PLCP_CHK_MU_8814B BIT(11) -+#define BIT_R_CHK_DELIMIT_LEN_8814B BIT(10) -+#define BIT_R_REAPTER_ADDR_MATCH_8814B BIT(9) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY_8814B BIT(8) -+#define BIT_R_LATCH_MACHRDY_8814B BIT(7) -+#define BIT_R_WMAC_RXFIL_REND_8814B BIT(6) -+#define BIT_R_WMAC_MPDURDY_CLR_8814B BIT(5) -+#define BIT_R_WMAC_CLRRXSEC_8814B BIT(4) -+#define BIT_R_WMAC_RXFIL_RDEL_8814B BIT(3) -+#define BIT_R_WMAC_RXFIL_FCSE_8814B BIT(2) -+#define BIT_R_WMAC_RXFIL_MESH_DEL_8814B BIT(1) -+#define BIT_R_WMAC_RXFIL_MASKM_8814B BIT(0) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NDP_SIG_8814B */ -+ -+#define BIT_SHIFT_R_WMAC_TXNDP_SIGB_8814B 0 -+#define BIT_MASK_R_WMAC_TXNDP_SIGB_8814B 0x1fffff -+#define BIT_R_WMAC_TXNDP_SIGB_8814B(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXNDP_SIGB_8814B) \ -+ << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8814B) -+#define BITS_R_WMAC_TXNDP_SIGB_8814B \ -+ (BIT_MASK_R_WMAC_TXNDP_SIGB_8814B << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8814B) -+#define BIT_CLEAR_R_WMAC_TXNDP_SIGB_8814B(x) \ -+ ((x) & (~BITS_R_WMAC_TXNDP_SIGB_8814B)) -+#define BIT_GET_R_WMAC_TXNDP_SIGB_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXNDP_SIGB_8814B) & \ -+ BIT_MASK_R_WMAC_TXNDP_SIGB_8814B) -+#define BIT_SET_R_WMAC_TXNDP_SIGB_8814B(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXNDP_SIGB_8814B(x) | BIT_R_WMAC_TXNDP_SIGB_8814B(v)) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_8814B */ -+ -+#define BIT_SHIFT_R_MAC_DBG_SHIFT_8814B 8 -+#define BIT_MASK_R_MAC_DBG_SHIFT_8814B 0x7 -+#define BIT_R_MAC_DBG_SHIFT_8814B(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SHIFT_8814B) \ -+ << BIT_SHIFT_R_MAC_DBG_SHIFT_8814B) -+#define BITS_R_MAC_DBG_SHIFT_8814B \ -+ (BIT_MASK_R_MAC_DBG_SHIFT_8814B << BIT_SHIFT_R_MAC_DBG_SHIFT_8814B) -+#define BIT_CLEAR_R_MAC_DBG_SHIFT_8814B(x) ((x) & (~BITS_R_MAC_DBG_SHIFT_8814B)) -+#define BIT_GET_R_MAC_DBG_SHIFT_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SHIFT_8814B) & \ -+ BIT_MASK_R_MAC_DBG_SHIFT_8814B) -+#define BIT_SET_R_MAC_DBG_SHIFT_8814B(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SHIFT_8814B(x) | BIT_R_MAC_DBG_SHIFT_8814B(v)) -+ -+#define BIT_SHIFT_R_MAC_DBG_SEL_8814B 0 -+#define BIT_MASK_R_MAC_DBG_SEL_8814B 0x3 -+#define BIT_R_MAC_DBG_SEL_8814B(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SEL_8814B) << BIT_SHIFT_R_MAC_DBG_SEL_8814B) -+#define BITS_R_MAC_DBG_SEL_8814B \ -+ (BIT_MASK_R_MAC_DBG_SEL_8814B << BIT_SHIFT_R_MAC_DBG_SEL_8814B) -+#define BIT_CLEAR_R_MAC_DBG_SEL_8814B(x) ((x) & (~BITS_R_MAC_DBG_SEL_8814B)) -+#define BIT_GET_R_MAC_DBG_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SEL_8814B) & BIT_MASK_R_MAC_DBG_SEL_8814B) -+#define BIT_SET_R_MAC_DBG_SEL_8814B(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SEL_8814B(x) | BIT_R_MAC_DBG_SEL_8814B(v)) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_1_8814B */ -+ -+#define BIT_SHIFT_R_MAC_DEBUG_1_8814B 0 -+#define BIT_MASK_R_MAC_DEBUG_1_8814B 0xffffffffL -+#define BIT_R_MAC_DEBUG_1_8814B(x) \ -+ (((x) & BIT_MASK_R_MAC_DEBUG_1_8814B) << BIT_SHIFT_R_MAC_DEBUG_1_8814B) -+#define BITS_R_MAC_DEBUG_1_8814B \ -+ (BIT_MASK_R_MAC_DEBUG_1_8814B << BIT_SHIFT_R_MAC_DEBUG_1_8814B) -+#define BIT_CLEAR_R_MAC_DEBUG_1_8814B(x) ((x) & (~BITS_R_MAC_DEBUG_1_8814B)) -+#define BIT_GET_R_MAC_DEBUG_1_8814B(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DEBUG_1_8814B) & BIT_MASK_R_MAC_DEBUG_1_8814B) -+#define BIT_SET_R_MAC_DEBUG_1_8814B(x, v) \ -+ (BIT_CLEAR_R_MAC_DEBUG_1_8814B(x) | BIT_R_MAC_DEBUG_1_8814B(v)) -+ -+/* 2 REG_WSEC_OPTION_8814B */ -+#define BIT_RXDEC_BM_MGNT_8814B BIT(22) -+#define BIT_TXENC_BM_MGNT_8814B BIT(21) -+#define BIT_RXDEC_UNI_MGNT_8814B BIT(20) -+#define BIT_TXENC_UNI_MGNT_8814B BIT(19) -+ -+/* 2 REG_RTS_ADDRESS_0_8814B */ -+ -+/* 2 REG_RTS_ADDRESS_0_1_8814B */ -+ -+/* 2 REG_RTS_ADDRESS_1_8814B */ -+ -+/* 2 REG_RTS_ADDRESS_1_1_8814B */ -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8814B */ -+#define BIT_LTECOEX_ACCESS_START_V1_8814B BIT(31) -+#define BIT_LTECOEX_WRITE_MODE_V1_8814B BIT(30) -+#define BIT_LTECOEX_READY_BIT_V1_8814B BIT(29) -+ -+#define BIT_SHIFT_WRITE_BYTE_EN_V1_8814B 16 -+#define BIT_MASK_WRITE_BYTE_EN_V1_8814B 0xf -+#define BIT_WRITE_BYTE_EN_V1_8814B(x) \ -+ (((x) & BIT_MASK_WRITE_BYTE_EN_V1_8814B) \ -+ << BIT_SHIFT_WRITE_BYTE_EN_V1_8814B) -+#define BITS_WRITE_BYTE_EN_V1_8814B \ -+ (BIT_MASK_WRITE_BYTE_EN_V1_8814B << BIT_SHIFT_WRITE_BYTE_EN_V1_8814B) -+#define BIT_CLEAR_WRITE_BYTE_EN_V1_8814B(x) \ -+ ((x) & (~BITS_WRITE_BYTE_EN_V1_8814B)) -+#define BIT_GET_WRITE_BYTE_EN_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_WRITE_BYTE_EN_V1_8814B) & \ -+ BIT_MASK_WRITE_BYTE_EN_V1_8814B) -+#define BIT_SET_WRITE_BYTE_EN_V1_8814B(x, v) \ -+ (BIT_CLEAR_WRITE_BYTE_EN_V1_8814B(x) | BIT_WRITE_BYTE_EN_V1_8814B(v)) -+ -+#define BIT_SHIFT_LTECOEX_REG_ADDR_V1_8814B 0 -+#define BIT_MASK_LTECOEX_REG_ADDR_V1_8814B 0xffff -+#define BIT_LTECOEX_REG_ADDR_V1_8814B(x) \ -+ (((x) & BIT_MASK_LTECOEX_REG_ADDR_V1_8814B) \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8814B) -+#define BITS_LTECOEX_REG_ADDR_V1_8814B \ -+ (BIT_MASK_LTECOEX_REG_ADDR_V1_8814B \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8814B) -+#define BIT_CLEAR_LTECOEX_REG_ADDR_V1_8814B(x) \ -+ ((x) & (~BITS_LTECOEX_REG_ADDR_V1_8814B)) -+#define BIT_GET_LTECOEX_REG_ADDR_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_REG_ADDR_V1_8814B) & \ -+ BIT_MASK_LTECOEX_REG_ADDR_V1_8814B) -+#define BIT_SET_LTECOEX_REG_ADDR_V1_8814B(x, v) \ -+ (BIT_CLEAR_LTECOEX_REG_ADDR_V1_8814B(x) | \ -+ BIT_LTECOEX_REG_ADDR_V1_8814B(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8814B */ -+ -+#define BIT_SHIFT_LTECOEX_W_DATA_V1_8814B 0 -+#define BIT_MASK_LTECOEX_W_DATA_V1_8814B 0xffffffffL -+#define BIT_LTECOEX_W_DATA_V1_8814B(x) \ -+ (((x) & BIT_MASK_LTECOEX_W_DATA_V1_8814B) \ -+ << BIT_SHIFT_LTECOEX_W_DATA_V1_8814B) -+#define BITS_LTECOEX_W_DATA_V1_8814B \ -+ (BIT_MASK_LTECOEX_W_DATA_V1_8814B << BIT_SHIFT_LTECOEX_W_DATA_V1_8814B) -+#define BIT_CLEAR_LTECOEX_W_DATA_V1_8814B(x) \ -+ ((x) & (~BITS_LTECOEX_W_DATA_V1_8814B)) -+#define BIT_GET_LTECOEX_W_DATA_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_W_DATA_V1_8814B) & \ -+ BIT_MASK_LTECOEX_W_DATA_V1_8814B) -+#define BIT_SET_LTECOEX_W_DATA_V1_8814B(x, v) \ -+ (BIT_CLEAR_LTECOEX_W_DATA_V1_8814B(x) | BIT_LTECOEX_W_DATA_V1_8814B(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8814B */ -+ -+#define BIT_SHIFT_LTECOEX_R_DATA_V1_8814B 0 -+#define BIT_MASK_LTECOEX_R_DATA_V1_8814B 0xffffffffL -+#define BIT_LTECOEX_R_DATA_V1_8814B(x) \ -+ (((x) & BIT_MASK_LTECOEX_R_DATA_V1_8814B) \ -+ << BIT_SHIFT_LTECOEX_R_DATA_V1_8814B) -+#define BITS_LTECOEX_R_DATA_V1_8814B \ -+ (BIT_MASK_LTECOEX_R_DATA_V1_8814B << BIT_SHIFT_LTECOEX_R_DATA_V1_8814B) -+#define BIT_CLEAR_LTECOEX_R_DATA_V1_8814B(x) \ -+ ((x) & (~BITS_LTECOEX_R_DATA_V1_8814B)) -+#define BIT_GET_LTECOEX_R_DATA_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_R_DATA_V1_8814B) & \ -+ BIT_MASK_LTECOEX_R_DATA_V1_8814B) -+#define BIT_SET_LTECOEX_R_DATA_V1_8814B(x, v) \ -+ (BIT_CLEAR_LTECOEX_R_DATA_V1_8814B(x) | BIT_LTECOEX_R_DATA_V1_8814B(v)) -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_NOT_VALID_8814B */ -+ -+/* 2 REG_PCIE_CFG_FORCE_LINK_L_8814B */ -+#define BIT_PCIE_CFG_FORCE_EN_8814B BIT(7) -+ -+/* 2 REG_PCIE_CFG_FORCE_LINK_H_8814B */ -+#define BIT_PCIE_CFG_TRXACT_DIS_IDLE_TIMER_8814B BIT(6) -+ -+#define BIT_SHIFT_PCIE_CFG_LINK_STATE_8814B 0 -+#define BIT_MASK_PCIE_CFG_LINK_STATE_8814B 0x3f -+#define BIT_PCIE_CFG_LINK_STATE_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_LINK_STATE_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_LINK_STATE_8814B) -+#define BITS_PCIE_CFG_LINK_STATE_8814B \ -+ (BIT_MASK_PCIE_CFG_LINK_STATE_8814B \ -+ << BIT_SHIFT_PCIE_CFG_LINK_STATE_8814B) -+#define BIT_CLEAR_PCIE_CFG_LINK_STATE_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_LINK_STATE_8814B)) -+#define BIT_GET_PCIE_CFG_LINK_STATE_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_LINK_STATE_8814B) & \ -+ BIT_MASK_PCIE_CFG_LINK_STATE_8814B) -+#define BIT_SET_PCIE_CFG_LINK_STATE_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_LINK_STATE_8814B(x) | \ -+ BIT_PCIE_CFG_LINK_STATE_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B */ -+ -+#define BIT_SHIFT_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B 0 -+#define BIT_MASK_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B 0xff -+#define BIT_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B) -+#define BITS_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B \ -+ (BIT_MASK_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B) -+#define BIT_CLEAR_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B)) -+#define BIT_GET_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B) & \ -+ BIT_MASK_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B) -+#define BIT_SET_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B(x) | \ -+ BIT_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_CX_NFTS_8814B */ -+ -+#define BIT_SHIFT_PCIE_CFG_CX_NFTS_8814B 0 -+#define BIT_MASK_PCIE_CFG_CX_NFTS_8814B 0xff -+#define BIT_PCIE_CFG_CX_NFTS_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_CX_NFTS_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_CX_NFTS_8814B) -+#define BITS_PCIE_CFG_CX_NFTS_8814B \ -+ (BIT_MASK_PCIE_CFG_CX_NFTS_8814B << BIT_SHIFT_PCIE_CFG_CX_NFTS_8814B) -+#define BIT_CLEAR_PCIE_CFG_CX_NFTS_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_CX_NFTS_8814B)) -+#define BIT_GET_PCIE_CFG_CX_NFTS_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_CX_NFTS_8814B) & \ -+ BIT_MASK_PCIE_CFG_CX_NFTS_8814B) -+#define BIT_SET_PCIE_CFG_CX_NFTS_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_CX_NFTS_8814B(x) | BIT_PCIE_CFG_CX_NFTS_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_DEFAULT_ENTR_LATENCY_8814B */ -+#define BIT_PCIE_CFG_REAL_EN_L0S_8814B BIT(7) -+#define BIT_PCIE_CFG_ENTER_ASPM_8814B BIT(6) -+ -+#define BIT_SHIFT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B 3 -+#define BIT_MASK_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B 0x7 -+#define BIT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B) -+#define BITS_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B \ -+ (BIT_MASK_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B) -+#define BIT_CLEAR_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B)) -+#define BIT_GET_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B) & \ -+ BIT_MASK_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B) -+#define BIT_SET_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B(x) | \ -+ BIT_PCIE_CFG_DEFAULT_L1_ENTR_LATENCY_8814B(v)) -+ -+#define BIT_SHIFT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B 0 -+#define BIT_MASK_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B 0x7 -+#define BIT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B) -+#define BITS_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B \ -+ (BIT_MASK_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B) -+#define BIT_CLEAR_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B)) -+#define BIT_GET_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B) & \ -+ BIT_MASK_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B) -+#define BIT_SET_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B(x) | \ -+ BIT_PCIE_CFG_DEFAULT_L0S_ENTR_LATENCY_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_L1_MISC_SEL_8814B */ -+#define BIT_PCIE_CFG_L1_RIDLE_SEL_8814B BIT(6) -+#define BIT_PCIE_CFG_L1_TIMEOUT_SEL_8814B BIT(5) -+#define BIT_PCIE_CFG_L1_EIDLE_SEL_8814B BIT(4) -+ -+#define BIT_SHIFT_PCIE_CFG_DEFAULT_LINK_RATE_8814B 0 -+#define BIT_MASK_PCIE_CFG_DEFAULT_LINK_RATE_8814B 0xf -+#define BIT_PCIE_CFG_DEFAULT_LINK_RATE_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_DEFAULT_LINK_RATE_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_LINK_RATE_8814B) -+#define BITS_PCIE_CFG_DEFAULT_LINK_RATE_8814B \ -+ (BIT_MASK_PCIE_CFG_DEFAULT_LINK_RATE_8814B \ -+ << BIT_SHIFT_PCIE_CFG_DEFAULT_LINK_RATE_8814B) -+#define BIT_CLEAR_PCIE_CFG_DEFAULT_LINK_RATE_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_DEFAULT_LINK_RATE_8814B)) -+#define BIT_GET_PCIE_CFG_DEFAULT_LINK_RATE_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_DEFAULT_LINK_RATE_8814B) & \ -+ BIT_MASK_PCIE_CFG_DEFAULT_LINK_RATE_8814B) -+#define BIT_SET_PCIE_CFG_DEFAULT_LINK_RATE_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_DEFAULT_LINK_RATE_8814B(x) | \ -+ BIT_PCIE_CFG_DEFAULT_LINK_RATE_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF_8814B */ -+#define BIT_PCIE_CFG_REAL_PTM_ENABLE_8814B BIT(6) -+#define BIT_PCIE_CFG_REAL_EN_L1SUB_8814B BIT(5) -+ -+#define BIT_SHIFT_PCIE_CFG_MAX_FUNC_NUM_8814B 0 -+#define BIT_MASK_PCIE_CFG_MAX_FUNC_NUM_8814B 0x7 -+#define BIT_PCIE_CFG_MAX_FUNC_NUM_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_MAX_FUNC_NUM_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_MAX_FUNC_NUM_8814B) -+#define BITS_PCIE_CFG_MAX_FUNC_NUM_8814B \ -+ (BIT_MASK_PCIE_CFG_MAX_FUNC_NUM_8814B \ -+ << BIT_SHIFT_PCIE_CFG_MAX_FUNC_NUM_8814B) -+#define BIT_CLEAR_PCIE_CFG_MAX_FUNC_NUM_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_MAX_FUNC_NUM_8814B)) -+#define BIT_GET_PCIE_CFG_MAX_FUNC_NUM_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_MAX_FUNC_NUM_8814B) & \ -+ BIT_MASK_PCIE_CFG_MAX_FUNC_NUM_8814B) -+#define BIT_SET_PCIE_CFG_MAX_FUNC_NUM_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_MAX_FUNC_NUM_8814B(x) | \ -+ BIT_PCIE_CFG_MAX_FUNC_NUM_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_FORCE_CLKREQ_N_PAD_8814B */ -+#define BIT_PCIE_CFG_REAL_EN_64BITS_8814B BIT(5) -+#define BIT_PCIE_CFG_REAL_EN_CLKREQ_8814B BIT(4) -+#define BIT_PCIE_CFG_REAL_EN_L1_8814B BIT(3) -+#define BIT_PCIE_CFG_WAKE_N_EN_8814B BIT(2) -+#define BIT_PCIE_CFG_BYPASS_LTR_OPTION_8814B BIT(1) -+#define BIT_PCIE_CFG_FORCE_CLKREQ_N_PAD_8814B BIT(0) -+ -+/* 2 REG_PCIE_CFG_TIMER_MODIFIER_FOR_ACK_NAK_LATENCY_8814B */ -+ -+#define BIT_SHIFT_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B 0 -+#define BIT_MASK_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B 0xff -+#define BIT_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B) -+#define BITS_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B \ -+ (BIT_MASK_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B \ -+ << BIT_SHIFT_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B) -+#define BIT_CLEAR_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B)) -+#define BIT_GET_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B) & \ -+ BIT_MASK_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B) -+#define BIT_SET_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B(x) | \ -+ BIT_PCIE_CFG_TIMER_MOD_ACK_NAK_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_TIMER_MODIFIER_FOR_FLOW_CONTROL_WATCHDOG_8814B */ -+#define BIT_PCIE_CFG_BYPASS_L1_SUBSTATE_OPTION_8814B BIT(7) -+ -+#define BIT_SHIFT_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B 5 -+#define BIT_MASK_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B 0x3 -+#define BIT_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B) -+#define BITS_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B \ -+ (BIT_MASK_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B \ -+ << BIT_SHIFT_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B) -+#define BIT_CLEAR_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B)) -+#define BIT_GET_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B) & \ -+ BIT_MASK_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B) -+#define BIT_SET_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B(x) | \ -+ BIT_PCIE_CFG_FAST_LINK_SCALING_FACTOR_8814B(v)) -+ -+#define BIT_SHIFT_PCIE_CFG_UPDATE_FREQ_TIMER_8814B 0 -+#define BIT_MASK_PCIE_CFG_UPDATE_FREQ_TIMER_8814B 0x1f -+#define BIT_PCIE_CFG_UPDATE_FREQ_TIMER_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_UPDATE_FREQ_TIMER_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_UPDATE_FREQ_TIMER_8814B) -+#define BITS_PCIE_CFG_UPDATE_FREQ_TIMER_8814B \ -+ (BIT_MASK_PCIE_CFG_UPDATE_FREQ_TIMER_8814B \ -+ << BIT_SHIFT_PCIE_CFG_UPDATE_FREQ_TIMER_8814B) -+#define BIT_CLEAR_PCIE_CFG_UPDATE_FREQ_TIMER_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_UPDATE_FREQ_TIMER_8814B)) -+#define BIT_GET_PCIE_CFG_UPDATE_FREQ_TIMER_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_UPDATE_FREQ_TIMER_8814B) & \ -+ BIT_MASK_PCIE_CFG_UPDATE_FREQ_TIMER_8814B) -+#define BIT_SET_PCIE_CFG_UPDATE_FREQ_TIMER_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_UPDATE_FREQ_TIMER_8814B(x) | \ -+ BIT_PCIE_CFG_UPDATE_FREQ_TIMER_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B */ -+ -+#define BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B 0 -+#define BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B 0xff -+#define BIT_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B) -+#define BITS_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B \ -+ (BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B \ -+ << BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B) -+#define BIT_CLEAR_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B)) -+#define BIT_GET_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B) & \ -+ BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B) -+#define BIT_SET_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B(x) | \ -+ BIT_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B */ -+#define BIT_PCIE_CFG_DISABLE_FC_WATCHDOG_TIMER_8814B BIT(7) -+ -+#define BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B 0 -+#define BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B 0x7 -+#define BIT_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B) -+#define BITS_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B \ -+ (BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B \ -+ << BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B) -+#define BIT_CLEAR_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B)) -+#define BIT_GET_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B) & \ -+ BIT_MASK_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B) -+#define BIT_SET_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B(x) | \ -+ BIT_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_L1_UNIT_SEL_8814B */ -+ -+#define BIT_SHIFT_PCIE_CFG_L1_UNIT_SEL_8814B 0 -+#define BIT_MASK_PCIE_CFG_L1_UNIT_SEL_8814B 0xff -+#define BIT_PCIE_CFG_L1_UNIT_SEL_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_L1_UNIT_SEL_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_L1_UNIT_SEL_8814B) -+#define BITS_PCIE_CFG_L1_UNIT_SEL_8814B \ -+ (BIT_MASK_PCIE_CFG_L1_UNIT_SEL_8814B \ -+ << BIT_SHIFT_PCIE_CFG_L1_UNIT_SEL_8814B) -+#define BIT_CLEAR_PCIE_CFG_L1_UNIT_SEL_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_L1_UNIT_SEL_8814B)) -+#define BIT_GET_PCIE_CFG_L1_UNIT_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_L1_UNIT_SEL_8814B) & \ -+ BIT_MASK_PCIE_CFG_L1_UNIT_SEL_8814B) -+#define BIT_SET_PCIE_CFG_L1_UNIT_SEL_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_L1_UNIT_SEL_8814B(x) | \ -+ BIT_PCIE_CFG_L1_UNIT_SEL_8814B(v)) -+ -+/* 2 REG_PCIE_CFG_MIN_CLKREQ_SEL_8814B */ -+ -+#define BIT_SHIFT_PCIE_CFG_MIN_CLKREQ_SEL_8814B 0 -+#define BIT_MASK_PCIE_CFG_MIN_CLKREQ_SEL_8814B 0xf -+#define BIT_PCIE_CFG_MIN_CLKREQ_SEL_8814B(x) \ -+ (((x) & BIT_MASK_PCIE_CFG_MIN_CLKREQ_SEL_8814B) \ -+ << BIT_SHIFT_PCIE_CFG_MIN_CLKREQ_SEL_8814B) -+#define BITS_PCIE_CFG_MIN_CLKREQ_SEL_8814B \ -+ (BIT_MASK_PCIE_CFG_MIN_CLKREQ_SEL_8814B \ -+ << BIT_SHIFT_PCIE_CFG_MIN_CLKREQ_SEL_8814B) -+#define BIT_CLEAR_PCIE_CFG_MIN_CLKREQ_SEL_8814B(x) \ -+ ((x) & (~BITS_PCIE_CFG_MIN_CLKREQ_SEL_8814B)) -+#define BIT_GET_PCIE_CFG_MIN_CLKREQ_SEL_8814B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_CFG_MIN_CLKREQ_SEL_8814B) & \ -+ BIT_MASK_PCIE_CFG_MIN_CLKREQ_SEL_8814B) -+#define BIT_SET_PCIE_CFG_MIN_CLKREQ_SEL_8814B(x, v) \ -+ (BIT_CLEAR_PCIE_CFG_MIN_CLKREQ_SEL_8814B(x) | \ -+ BIT_PCIE_CFG_MIN_CLKREQ_SEL_8814B(v)) -+ -+/* 2 REG_SDIO_TX_CTRL_8814B */ -+ -+#define BIT_SHIFT_SDIO_INT_TIMEOUT_8814B 16 -+#define BIT_MASK_SDIO_INT_TIMEOUT_8814B 0xffff -+#define BIT_SDIO_INT_TIMEOUT_8814B(x) \ -+ (((x) & BIT_MASK_SDIO_INT_TIMEOUT_8814B) \ -+ << BIT_SHIFT_SDIO_INT_TIMEOUT_8814B) -+#define BITS_SDIO_INT_TIMEOUT_8814B \ -+ (BIT_MASK_SDIO_INT_TIMEOUT_8814B << BIT_SHIFT_SDIO_INT_TIMEOUT_8814B) -+#define BIT_CLEAR_SDIO_INT_TIMEOUT_8814B(x) \ -+ ((x) & (~BITS_SDIO_INT_TIMEOUT_8814B)) -+#define BIT_GET_SDIO_INT_TIMEOUT_8814B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_INT_TIMEOUT_8814B) & \ -+ BIT_MASK_SDIO_INT_TIMEOUT_8814B) -+#define BIT_SET_SDIO_INT_TIMEOUT_8814B(x, v) \ -+ (BIT_CLEAR_SDIO_INT_TIMEOUT_8814B(x) | BIT_SDIO_INT_TIMEOUT_8814B(v)) -+ -+#define BIT_IO_ERR_STATUS_8814B BIT(15) -+#define BIT_REPLY_ERRCRC_IN_DATA_8814B BIT(9) -+#define BIT_EN_CMD53_OVERLAP_8814B BIT(8) -+#define BIT_REPLY_ERR_IN_R5_8814B BIT(7) -+#define BIT_R18A_EN_8814B BIT(6) -+#define BIT_SDIO_CMD_FORCE_VLD_8814B BIT(5) -+#define BIT_INIT_CMD_EN_8814B BIT(4) -+#define BIT_EN_RXDMA_MASK_INT_8814B BIT(2) -+#define BIT_EN_MASK_TIMER_8814B BIT(1) -+#define BIT_CMD_ERR_STOP_INT_EN_8814B BIT(0) -+ -+/* 2 REG_SDIO_HIMR_8814B */ -+#define BIT_SDIO_CRCERR_MSK_8814B BIT(31) -+#define BIT_SDIO_HSISR3_IND_MSK_8814B BIT(30) -+#define BIT_SDIO_HSISR2_IND_MSK_8814B BIT(29) -+#define BIT_SDIO_HEISR_IND_MSK_8814B BIT(28) -+#define BIT_SDIO_CTWEND_MSK_8814B BIT(27) -+#define BIT_SDIO_ATIMEND_E_MSK_8814B BIT(26) -+#define BIT_SDIIO_ATIMEND_MSK_8814B BIT(25) -+#define BIT_SDIO_OCPINT_MSK_8814B BIT(24) -+#define BIT_SDIO_PSTIMEOUT_MSK_8814B BIT(23) -+#define BIT_SDIO_GTINT4_MSK_8814B BIT(22) -+#define BIT_SDIO_GTINT3_MSK_8814B BIT(21) -+#define BIT_SDIO_HSISR_IND_MSK_8814B BIT(20) -+#define BIT_SDIO_CPWM2_MSK_8814B BIT(19) -+#define BIT_SDIO_CPWM1_MSK_8814B BIT(18) -+#define BIT_SDIO_C2HCMD_INT_MSK_8814B BIT(17) -+#define BIT_SDIO_BCNERLY_INT_MSK_8814B BIT(16) -+#define BIT_SDIO_TXBCNERR_MSK_8814B BIT(7) -+#define BIT_SDIO_TXBCNOK_MSK_8814B BIT(6) -+#define BIT_SDIO_RXFOVW_MSK_8814B BIT(5) -+#define BIT_SDIO_TXFOVW_MSK_8814B BIT(4) -+#define BIT_SDIO_RXERR_MSK_8814B BIT(3) -+#define BIT_SDIO_TXERR_MSK_8814B BIT(2) -+#define BIT_SDIO_AVAL_MSK_8814B BIT(1) -+#define BIT_RX_REQUEST_MSK_8814B BIT(0) -+ -+/* 2 REG_SDIO_HISR_8814B */ -+#define BIT_SDIO_CRCERR_8814B BIT(31) -+#define BIT_SDIO_HSISR3_IND_8814B BIT(30) -+#define BIT_SDIO_HSISR2_IND_8814B BIT(29) -+#define BIT_SDIO_HEISR_IND_8814B BIT(28) -+#define BIT_SDIO_CTWEND_8814B BIT(27) -+#define BIT_SDIO_ATIMEND_E_8814B BIT(26) -+#define BIT_SDIO_ATIMEND_8814B BIT(25) -+#define BIT_SDIO_OCPINT_8814B BIT(24) -+#define BIT_SDIO_PSTIMEOUT_8814B BIT(23) -+#define BIT_SDIO_GTINT4_8814B BIT(22) -+#define BIT_SDIO_GTINT3_8814B BIT(21) -+#define BIT_SDIO_HSISR_IND_8814B BIT(20) -+#define BIT_SDIO_CPWM2_8814B BIT(19) -+#define BIT_SDIO_CPWM1_8814B BIT(18) -+#define BIT_SDIO_C2HCMD_INT_8814B BIT(17) -+#define BIT_SDIO_BCNERLY_INT_8814B BIT(16) -+#define BIT_SDIO_TXBCNERR_8814B BIT(7) -+#define BIT_SDIO_TXBCNOK_8814B BIT(6) -+#define BIT_SDIO_RXFOVW_8814B BIT(5) -+#define BIT_SDIO_TXFOVW_8814B BIT(4) -+#define BIT_SDIO_RXERR_8814B BIT(3) -+#define BIT_SDIO_TXERR_8814B BIT(2) -+#define BIT_SDIO_AVAL_8814B BIT(1) -+#define BIT_RX_REQUEST_8814B BIT(0) -+ -+/* 2 REG_SDIO_RX_REQ_LEN_8814B */ -+ -+#define BIT_SHIFT_RX_REQ_LEN_V1_8814B 0 -+#define BIT_MASK_RX_REQ_LEN_V1_8814B 0x3ffff -+#define BIT_RX_REQ_LEN_V1_8814B(x) \ -+ (((x) & BIT_MASK_RX_REQ_LEN_V1_8814B) << BIT_SHIFT_RX_REQ_LEN_V1_8814B) -+#define BITS_RX_REQ_LEN_V1_8814B \ -+ (BIT_MASK_RX_REQ_LEN_V1_8814B << BIT_SHIFT_RX_REQ_LEN_V1_8814B) -+#define BIT_CLEAR_RX_REQ_LEN_V1_8814B(x) ((x) & (~BITS_RX_REQ_LEN_V1_8814B)) -+#define BIT_GET_RX_REQ_LEN_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_RX_REQ_LEN_V1_8814B) & BIT_MASK_RX_REQ_LEN_V1_8814B) -+#define BIT_SET_RX_REQ_LEN_V1_8814B(x, v) \ -+ (BIT_CLEAR_RX_REQ_LEN_V1_8814B(x) | BIT_RX_REQ_LEN_V1_8814B(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG_SEQ_V1_8814B */ -+ -+#define BIT_SHIFT_FREE_TXPG_SEQ_8814B 0 -+#define BIT_MASK_FREE_TXPG_SEQ_8814B 0xff -+#define BIT_FREE_TXPG_SEQ_8814B(x) \ -+ (((x) & BIT_MASK_FREE_TXPG_SEQ_8814B) << BIT_SHIFT_FREE_TXPG_SEQ_8814B) -+#define BITS_FREE_TXPG_SEQ_8814B \ -+ (BIT_MASK_FREE_TXPG_SEQ_8814B << BIT_SHIFT_FREE_TXPG_SEQ_8814B) -+#define BIT_CLEAR_FREE_TXPG_SEQ_8814B(x) ((x) & (~BITS_FREE_TXPG_SEQ_8814B)) -+#define BIT_GET_FREE_TXPG_SEQ_8814B(x) \ -+ (((x) >> BIT_SHIFT_FREE_TXPG_SEQ_8814B) & BIT_MASK_FREE_TXPG_SEQ_8814B) -+#define BIT_SET_FREE_TXPG_SEQ_8814B(x, v) \ -+ (BIT_CLEAR_FREE_TXPG_SEQ_8814B(x) | BIT_FREE_TXPG_SEQ_8814B(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG_8814B */ -+ -+#define BIT_SHIFT_MID_FREEPG_V1_8814B 16 -+#define BIT_MASK_MID_FREEPG_V1_8814B 0xfff -+#define BIT_MID_FREEPG_V1_8814B(x) \ -+ (((x) & BIT_MASK_MID_FREEPG_V1_8814B) << BIT_SHIFT_MID_FREEPG_V1_8814B) -+#define BITS_MID_FREEPG_V1_8814B \ -+ (BIT_MASK_MID_FREEPG_V1_8814B << BIT_SHIFT_MID_FREEPG_V1_8814B) -+#define BIT_CLEAR_MID_FREEPG_V1_8814B(x) ((x) & (~BITS_MID_FREEPG_V1_8814B)) -+#define BIT_GET_MID_FREEPG_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_MID_FREEPG_V1_8814B) & BIT_MASK_MID_FREEPG_V1_8814B) -+#define BIT_SET_MID_FREEPG_V1_8814B(x, v) \ -+ (BIT_CLEAR_MID_FREEPG_V1_8814B(x) | BIT_MID_FREEPG_V1_8814B(v)) -+ -+#define BIT_SHIFT_HIQ_FREEPG_V1_8814B 0 -+#define BIT_MASK_HIQ_FREEPG_V1_8814B 0xfff -+#define BIT_HIQ_FREEPG_V1_8814B(x) \ -+ (((x) & BIT_MASK_HIQ_FREEPG_V1_8814B) << BIT_SHIFT_HIQ_FREEPG_V1_8814B) -+#define BITS_HIQ_FREEPG_V1_8814B \ -+ (BIT_MASK_HIQ_FREEPG_V1_8814B << BIT_SHIFT_HIQ_FREEPG_V1_8814B) -+#define BIT_CLEAR_HIQ_FREEPG_V1_8814B(x) ((x) & (~BITS_HIQ_FREEPG_V1_8814B)) -+#define BIT_GET_HIQ_FREEPG_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_HIQ_FREEPG_V1_8814B) & BIT_MASK_HIQ_FREEPG_V1_8814B) -+#define BIT_SET_HIQ_FREEPG_V1_8814B(x, v) \ -+ (BIT_CLEAR_HIQ_FREEPG_V1_8814B(x) | BIT_HIQ_FREEPG_V1_8814B(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG2_8814B */ -+ -+#define BIT_SHIFT_PUB_FREEPG_V1_8814B 16 -+#define BIT_MASK_PUB_FREEPG_V1_8814B 0xfff -+#define BIT_PUB_FREEPG_V1_8814B(x) \ -+ (((x) & BIT_MASK_PUB_FREEPG_V1_8814B) << BIT_SHIFT_PUB_FREEPG_V1_8814B) -+#define BITS_PUB_FREEPG_V1_8814B \ -+ (BIT_MASK_PUB_FREEPG_V1_8814B << BIT_SHIFT_PUB_FREEPG_V1_8814B) -+#define BIT_CLEAR_PUB_FREEPG_V1_8814B(x) ((x) & (~BITS_PUB_FREEPG_V1_8814B)) -+#define BIT_GET_PUB_FREEPG_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_PUB_FREEPG_V1_8814B) & BIT_MASK_PUB_FREEPG_V1_8814B) -+#define BIT_SET_PUB_FREEPG_V1_8814B(x, v) \ -+ (BIT_CLEAR_PUB_FREEPG_V1_8814B(x) | BIT_PUB_FREEPG_V1_8814B(v)) -+ -+#define BIT_SHIFT_LOW_FREEPG_V1_8814B 0 -+#define BIT_MASK_LOW_FREEPG_V1_8814B 0xfff -+#define BIT_LOW_FREEPG_V1_8814B(x) \ -+ (((x) & BIT_MASK_LOW_FREEPG_V1_8814B) << BIT_SHIFT_LOW_FREEPG_V1_8814B) -+#define BITS_LOW_FREEPG_V1_8814B \ -+ (BIT_MASK_LOW_FREEPG_V1_8814B << BIT_SHIFT_LOW_FREEPG_V1_8814B) -+#define BIT_CLEAR_LOW_FREEPG_V1_8814B(x) ((x) & (~BITS_LOW_FREEPG_V1_8814B)) -+#define BIT_GET_LOW_FREEPG_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_LOW_FREEPG_V1_8814B) & BIT_MASK_LOW_FREEPG_V1_8814B) -+#define BIT_SET_LOW_FREEPG_V1_8814B(x, v) \ -+ (BIT_CLEAR_LOW_FREEPG_V1_8814B(x) | BIT_LOW_FREEPG_V1_8814B(v)) -+ -+/* 2 REG_SDIO_OQT_FREE_TXPG_V1_8814B */ -+ -+#define BIT_SHIFT_NOAC_OQT_FREEPG_V1_8814B 24 -+#define BIT_MASK_NOAC_OQT_FREEPG_V1_8814B 0xff -+#define BIT_NOAC_OQT_FREEPG_V1_8814B(x) \ -+ (((x) & BIT_MASK_NOAC_OQT_FREEPG_V1_8814B) \ -+ << BIT_SHIFT_NOAC_OQT_FREEPG_V1_8814B) -+#define BITS_NOAC_OQT_FREEPG_V1_8814B \ -+ (BIT_MASK_NOAC_OQT_FREEPG_V1_8814B \ -+ << BIT_SHIFT_NOAC_OQT_FREEPG_V1_8814B) -+#define BIT_CLEAR_NOAC_OQT_FREEPG_V1_8814B(x) \ -+ ((x) & (~BITS_NOAC_OQT_FREEPG_V1_8814B)) -+#define BIT_GET_NOAC_OQT_FREEPG_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_NOAC_OQT_FREEPG_V1_8814B) & \ -+ BIT_MASK_NOAC_OQT_FREEPG_V1_8814B) -+#define BIT_SET_NOAC_OQT_FREEPG_V1_8814B(x, v) \ -+ (BIT_CLEAR_NOAC_OQT_FREEPG_V1_8814B(x) | \ -+ BIT_NOAC_OQT_FREEPG_V1_8814B(v)) -+ -+#define BIT_SHIFT_AC_OQT_FREEPG_V1_8814B 16 -+#define BIT_MASK_AC_OQT_FREEPG_V1_8814B 0xff -+#define BIT_AC_OQT_FREEPG_V1_8814B(x) \ -+ (((x) & BIT_MASK_AC_OQT_FREEPG_V1_8814B) \ -+ << BIT_SHIFT_AC_OQT_FREEPG_V1_8814B) -+#define BITS_AC_OQT_FREEPG_V1_8814B \ -+ (BIT_MASK_AC_OQT_FREEPG_V1_8814B << BIT_SHIFT_AC_OQT_FREEPG_V1_8814B) -+#define BIT_CLEAR_AC_OQT_FREEPG_V1_8814B(x) \ -+ ((x) & (~BITS_AC_OQT_FREEPG_V1_8814B)) -+#define BIT_GET_AC_OQT_FREEPG_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_AC_OQT_FREEPG_V1_8814B) & \ -+ BIT_MASK_AC_OQT_FREEPG_V1_8814B) -+#define BIT_SET_AC_OQT_FREEPG_V1_8814B(x, v) \ -+ (BIT_CLEAR_AC_OQT_FREEPG_V1_8814B(x) | BIT_AC_OQT_FREEPG_V1_8814B(v)) -+ -+#define BIT_SHIFT_EXQ_FREEPG_V1_8814B 0 -+#define BIT_MASK_EXQ_FREEPG_V1_8814B 0xfff -+#define BIT_EXQ_FREEPG_V1_8814B(x) \ -+ (((x) & BIT_MASK_EXQ_FREEPG_V1_8814B) << BIT_SHIFT_EXQ_FREEPG_V1_8814B) -+#define BITS_EXQ_FREEPG_V1_8814B \ -+ (BIT_MASK_EXQ_FREEPG_V1_8814B << BIT_SHIFT_EXQ_FREEPG_V1_8814B) -+#define BIT_CLEAR_EXQ_FREEPG_V1_8814B(x) ((x) & (~BITS_EXQ_FREEPG_V1_8814B)) -+#define BIT_GET_EXQ_FREEPG_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_EXQ_FREEPG_V1_8814B) & BIT_MASK_EXQ_FREEPG_V1_8814B) -+#define BIT_SET_EXQ_FREEPG_V1_8814B(x, v) \ -+ (BIT_CLEAR_EXQ_FREEPG_V1_8814B(x) | BIT_EXQ_FREEPG_V1_8814B(v)) -+ -+/* 2 REG_SDIO_HTSFR_INFO_8814B */ -+ -+#define BIT_SHIFT_HTSFR1_8814B 16 -+#define BIT_MASK_HTSFR1_8814B 0xffff -+#define BIT_HTSFR1_8814B(x) \ -+ (((x) & BIT_MASK_HTSFR1_8814B) << BIT_SHIFT_HTSFR1_8814B) -+#define BITS_HTSFR1_8814B (BIT_MASK_HTSFR1_8814B << BIT_SHIFT_HTSFR1_8814B) -+#define BIT_CLEAR_HTSFR1_8814B(x) ((x) & (~BITS_HTSFR1_8814B)) -+#define BIT_GET_HTSFR1_8814B(x) \ -+ (((x) >> BIT_SHIFT_HTSFR1_8814B) & BIT_MASK_HTSFR1_8814B) -+#define BIT_SET_HTSFR1_8814B(x, v) \ -+ (BIT_CLEAR_HTSFR1_8814B(x) | BIT_HTSFR1_8814B(v)) -+ -+#define BIT_SHIFT_HTSFR0_8814B 0 -+#define BIT_MASK_HTSFR0_8814B 0xffff -+#define BIT_HTSFR0_8814B(x) \ -+ (((x) & BIT_MASK_HTSFR0_8814B) << BIT_SHIFT_HTSFR0_8814B) -+#define BITS_HTSFR0_8814B (BIT_MASK_HTSFR0_8814B << BIT_SHIFT_HTSFR0_8814B) -+#define BIT_CLEAR_HTSFR0_8814B(x) ((x) & (~BITS_HTSFR0_8814B)) -+#define BIT_GET_HTSFR0_8814B(x) \ -+ (((x) >> BIT_SHIFT_HTSFR0_8814B) & BIT_MASK_HTSFR0_8814B) -+#define BIT_SET_HTSFR0_8814B(x, v) \ -+ (BIT_CLEAR_HTSFR0_8814B(x) | BIT_HTSFR0_8814B(v)) -+ -+/* 2 REG_SDIO_HCPWM1_V2_8814B */ -+#define BIT_TOGGLE_8814B BIT(7) -+#define BIT_CUR_PS_8814B BIT(0) -+ -+/* 2 REG_SDIO_HCPWM2_V2_8814B */ -+ -+/* 2 REG_SDIO_INDIRECT_REG_CFG_8814B */ -+#define BIT_INDIRECT_REG_RDY_8814B BIT(20) -+#define BIT_INDIRECT_REG_R_8814B BIT(19) -+#define BIT_INDIRECT_REG_W_8814B BIT(18) -+ -+#define BIT_SHIFT_INDIRECT_REG_SIZE_8814B 16 -+#define BIT_MASK_INDIRECT_REG_SIZE_8814B 0x3 -+#define BIT_INDIRECT_REG_SIZE_8814B(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_SIZE_8814B) \ -+ << BIT_SHIFT_INDIRECT_REG_SIZE_8814B) -+#define BITS_INDIRECT_REG_SIZE_8814B \ -+ (BIT_MASK_INDIRECT_REG_SIZE_8814B << BIT_SHIFT_INDIRECT_REG_SIZE_8814B) -+#define BIT_CLEAR_INDIRECT_REG_SIZE_8814B(x) \ -+ ((x) & (~BITS_INDIRECT_REG_SIZE_8814B)) -+#define BIT_GET_INDIRECT_REG_SIZE_8814B(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_SIZE_8814B) & \ -+ BIT_MASK_INDIRECT_REG_SIZE_8814B) -+#define BIT_SET_INDIRECT_REG_SIZE_8814B(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_SIZE_8814B(x) | BIT_INDIRECT_REG_SIZE_8814B(v)) -+ -+#define BIT_SHIFT_INDIRECT_REG_ADDR_8814B 0 -+#define BIT_MASK_INDIRECT_REG_ADDR_8814B 0xffff -+#define BIT_INDIRECT_REG_ADDR_8814B(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_ADDR_8814B) \ -+ << BIT_SHIFT_INDIRECT_REG_ADDR_8814B) -+#define BITS_INDIRECT_REG_ADDR_8814B \ -+ (BIT_MASK_INDIRECT_REG_ADDR_8814B << BIT_SHIFT_INDIRECT_REG_ADDR_8814B) -+#define BIT_CLEAR_INDIRECT_REG_ADDR_8814B(x) \ -+ ((x) & (~BITS_INDIRECT_REG_ADDR_8814B)) -+#define BIT_GET_INDIRECT_REG_ADDR_8814B(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_ADDR_8814B) & \ -+ BIT_MASK_INDIRECT_REG_ADDR_8814B) -+#define BIT_SET_INDIRECT_REG_ADDR_8814B(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_ADDR_8814B(x) | BIT_INDIRECT_REG_ADDR_8814B(v)) -+ -+/* 2 REG_SDIO_INDIRECT_REG_DATA_8814B */ -+ -+#define BIT_SHIFT_INDIRECT_REG_DATA_8814B 0 -+#define BIT_MASK_INDIRECT_REG_DATA_8814B 0xffffffffL -+#define BIT_INDIRECT_REG_DATA_8814B(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_DATA_8814B) \ -+ << BIT_SHIFT_INDIRECT_REG_DATA_8814B) -+#define BITS_INDIRECT_REG_DATA_8814B \ -+ (BIT_MASK_INDIRECT_REG_DATA_8814B << BIT_SHIFT_INDIRECT_REG_DATA_8814B) -+#define BIT_CLEAR_INDIRECT_REG_DATA_8814B(x) \ -+ ((x) & (~BITS_INDIRECT_REG_DATA_8814B)) -+#define BIT_GET_INDIRECT_REG_DATA_8814B(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_DATA_8814B) & \ -+ BIT_MASK_INDIRECT_REG_DATA_8814B) -+#define BIT_SET_INDIRECT_REG_DATA_8814B(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_DATA_8814B(x) | BIT_INDIRECT_REG_DATA_8814B(v)) -+ -+/* 2 REG_SDIO_H2C_8814B */ -+ -+#define BIT_SHIFT_SDIO_H2C_MSG_8814B 0 -+#define BIT_MASK_SDIO_H2C_MSG_8814B 0xffffffffL -+#define BIT_SDIO_H2C_MSG_8814B(x) \ -+ (((x) & BIT_MASK_SDIO_H2C_MSG_8814B) << BIT_SHIFT_SDIO_H2C_MSG_8814B) -+#define BITS_SDIO_H2C_MSG_8814B \ -+ (BIT_MASK_SDIO_H2C_MSG_8814B << BIT_SHIFT_SDIO_H2C_MSG_8814B) -+#define BIT_CLEAR_SDIO_H2C_MSG_8814B(x) ((x) & (~BITS_SDIO_H2C_MSG_8814B)) -+#define BIT_GET_SDIO_H2C_MSG_8814B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_H2C_MSG_8814B) & BIT_MASK_SDIO_H2C_MSG_8814B) -+#define BIT_SET_SDIO_H2C_MSG_8814B(x, v) \ -+ (BIT_CLEAR_SDIO_H2C_MSG_8814B(x) | BIT_SDIO_H2C_MSG_8814B(v)) -+ -+/* 2 REG_SDIO_C2H_8814B */ -+ -+#define BIT_SHIFT_SDIO_C2H_MSG_8814B 0 -+#define BIT_MASK_SDIO_C2H_MSG_8814B 0xffffffffL -+#define BIT_SDIO_C2H_MSG_8814B(x) \ -+ (((x) & BIT_MASK_SDIO_C2H_MSG_8814B) << BIT_SHIFT_SDIO_C2H_MSG_8814B) -+#define BITS_SDIO_C2H_MSG_8814B \ -+ (BIT_MASK_SDIO_C2H_MSG_8814B << BIT_SHIFT_SDIO_C2H_MSG_8814B) -+#define BIT_CLEAR_SDIO_C2H_MSG_8814B(x) ((x) & (~BITS_SDIO_C2H_MSG_8814B)) -+#define BIT_GET_SDIO_C2H_MSG_8814B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_C2H_MSG_8814B) & BIT_MASK_SDIO_C2H_MSG_8814B) -+#define BIT_SET_SDIO_C2H_MSG_8814B(x, v) \ -+ (BIT_CLEAR_SDIO_C2H_MSG_8814B(x) | BIT_SDIO_C2H_MSG_8814B(v)) -+ -+/* 2 REG_SDIO_HRPWM1_8814B */ -+#define BIT_TOGGLE_8814B BIT(7) -+#define BIT_ACK_8814B BIT(6) -+#define BIT_REQ_PS_8814B BIT(0) -+ -+/* 2 REG_SDIO_HRPWM2_8814B */ -+ -+/* 2 REG_SDIO_HPS_CLKR_8814B */ -+ -+/* 2 REG_SDIO_BUS_CTRL_8814B */ -+#define BIT_PAD_CLK_XHGE_EN_8814B BIT(3) -+#define BIT_INTER_CLK_EN_8814B BIT(2) -+#define BIT_EN_RPT_TXCRC_8814B BIT(1) -+#define BIT_DIS_RXDMA_STS_8814B BIT(0) -+ -+/* 2 REG_SDIO_HSUS_CTRL_8814B */ -+#define BIT_INTR_CTRL_8814B BIT(4) -+#define BIT_SDIO_VOLTAGE_8814B BIT(3) -+#define BIT_BYPASS_INIT_8814B BIT(2) -+#define BIT_HCI_RESUME_RDY_8814B BIT(1) -+#define BIT_HCI_SUS_REQ_8814B BIT(0) -+ -+/* 2 REG_SDIO_RESPONSE_TIMER_8814B */ -+ -+#define BIT_SHIFT_CMDIN_2RESP_TIMER_8814B 0 -+#define BIT_MASK_CMDIN_2RESP_TIMER_8814B 0xffff -+#define BIT_CMDIN_2RESP_TIMER_8814B(x) \ -+ (((x) & BIT_MASK_CMDIN_2RESP_TIMER_8814B) \ -+ << BIT_SHIFT_CMDIN_2RESP_TIMER_8814B) -+#define BITS_CMDIN_2RESP_TIMER_8814B \ -+ (BIT_MASK_CMDIN_2RESP_TIMER_8814B << BIT_SHIFT_CMDIN_2RESP_TIMER_8814B) -+#define BIT_CLEAR_CMDIN_2RESP_TIMER_8814B(x) \ -+ ((x) & (~BITS_CMDIN_2RESP_TIMER_8814B)) -+#define BIT_GET_CMDIN_2RESP_TIMER_8814B(x) \ -+ (((x) >> BIT_SHIFT_CMDIN_2RESP_TIMER_8814B) & \ -+ BIT_MASK_CMDIN_2RESP_TIMER_8814B) -+#define BIT_SET_CMDIN_2RESP_TIMER_8814B(x, v) \ -+ (BIT_CLEAR_CMDIN_2RESP_TIMER_8814B(x) | BIT_CMDIN_2RESP_TIMER_8814B(v)) -+ -+/* 2 REG_SDIO_CMD_CRC_8814B */ -+ -+#define BIT_SHIFT_SDIO_CMD_CRC_V1_8814B 0 -+#define BIT_MASK_SDIO_CMD_CRC_V1_8814B 0xff -+#define BIT_SDIO_CMD_CRC_V1_8814B(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_CRC_V1_8814B) \ -+ << BIT_SHIFT_SDIO_CMD_CRC_V1_8814B) -+#define BITS_SDIO_CMD_CRC_V1_8814B \ -+ (BIT_MASK_SDIO_CMD_CRC_V1_8814B << BIT_SHIFT_SDIO_CMD_CRC_V1_8814B) -+#define BIT_CLEAR_SDIO_CMD_CRC_V1_8814B(x) ((x) & (~BITS_SDIO_CMD_CRC_V1_8814B)) -+#define BIT_GET_SDIO_CMD_CRC_V1_8814B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_CRC_V1_8814B) & \ -+ BIT_MASK_SDIO_CMD_CRC_V1_8814B) -+#define BIT_SET_SDIO_CMD_CRC_V1_8814B(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_CRC_V1_8814B(x) | BIT_SDIO_CMD_CRC_V1_8814B(v)) -+ -+/* 2 REG_SDIO_HSISR_8814B */ -+#define BIT_DRV_WLAN_INT_CLR_8814B BIT(1) -+#define BIT_DRV_WLAN_INT_8814B BIT(0) -+ -+/* 2 REG_SDIO_ERR_RPT_8814B */ -+#define BIT_HR_FF_OVF_8814B BIT(6) -+#define BIT_HR_FF_UDN_8814B BIT(5) -+#define BIT_TXDMA_BUSY_ERR_8814B BIT(4) -+#define BIT_TXDMA_VLD_ERR_8814B BIT(3) -+#define BIT_QSEL_UNKNOWN_ERR_8814B BIT(2) -+#define BIT_QSEL_MIS_ERR_8814B BIT(1) -+#define BIT_SDIO_OVERRD_ERR_8814B BIT(0) -+ -+/* 2 REG_SDIO_CMD_ERRCNT_8814B */ -+ -+#define BIT_SHIFT_CMD_CRC_ERR_CNT_8814B 0 -+#define BIT_MASK_CMD_CRC_ERR_CNT_8814B 0xff -+#define BIT_CMD_CRC_ERR_CNT_8814B(x) \ -+ (((x) & BIT_MASK_CMD_CRC_ERR_CNT_8814B) \ -+ << BIT_SHIFT_CMD_CRC_ERR_CNT_8814B) -+#define BITS_CMD_CRC_ERR_CNT_8814B \ -+ (BIT_MASK_CMD_CRC_ERR_CNT_8814B << BIT_SHIFT_CMD_CRC_ERR_CNT_8814B) -+#define BIT_CLEAR_CMD_CRC_ERR_CNT_8814B(x) ((x) & (~BITS_CMD_CRC_ERR_CNT_8814B)) -+#define BIT_GET_CMD_CRC_ERR_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_CMD_CRC_ERR_CNT_8814B) & \ -+ BIT_MASK_CMD_CRC_ERR_CNT_8814B) -+#define BIT_SET_CMD_CRC_ERR_CNT_8814B(x, v) \ -+ (BIT_CLEAR_CMD_CRC_ERR_CNT_8814B(x) | BIT_CMD_CRC_ERR_CNT_8814B(v)) -+ -+/* 2 REG_SDIO_DATA_ERRCNT_8814B */ -+ -+#define BIT_SHIFT_DATA_CRC_ERR_CNT_8814B 0 -+#define BIT_MASK_DATA_CRC_ERR_CNT_8814B 0xff -+#define BIT_DATA_CRC_ERR_CNT_8814B(x) \ -+ (((x) & BIT_MASK_DATA_CRC_ERR_CNT_8814B) \ -+ << BIT_SHIFT_DATA_CRC_ERR_CNT_8814B) -+#define BITS_DATA_CRC_ERR_CNT_8814B \ -+ (BIT_MASK_DATA_CRC_ERR_CNT_8814B << BIT_SHIFT_DATA_CRC_ERR_CNT_8814B) -+#define BIT_CLEAR_DATA_CRC_ERR_CNT_8814B(x) \ -+ ((x) & (~BITS_DATA_CRC_ERR_CNT_8814B)) -+#define BIT_GET_DATA_CRC_ERR_CNT_8814B(x) \ -+ (((x) >> BIT_SHIFT_DATA_CRC_ERR_CNT_8814B) & \ -+ BIT_MASK_DATA_CRC_ERR_CNT_8814B) -+#define BIT_SET_DATA_CRC_ERR_CNT_8814B(x, v) \ -+ (BIT_CLEAR_DATA_CRC_ERR_CNT_8814B(x) | BIT_DATA_CRC_ERR_CNT_8814B(v)) -+ -+/* 2 REG_SDIO_CMD_ERR_CONTENT_8814B */ -+ -+#define BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8814B 0 -+#define BIT_MASK_SDIO_CMD_ERR_CONTENT_8814B 0xffffffffffL -+#define BIT_SDIO_CMD_ERR_CONTENT_8814B(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_ERR_CONTENT_8814B) \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8814B) -+#define BITS_SDIO_CMD_ERR_CONTENT_8814B \ -+ (BIT_MASK_SDIO_CMD_ERR_CONTENT_8814B \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8814B) -+#define BIT_CLEAR_SDIO_CMD_ERR_CONTENT_8814B(x) \ -+ ((x) & (~BITS_SDIO_CMD_ERR_CONTENT_8814B)) -+#define BIT_GET_SDIO_CMD_ERR_CONTENT_8814B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8814B) & \ -+ BIT_MASK_SDIO_CMD_ERR_CONTENT_8814B) -+#define BIT_SET_SDIO_CMD_ERR_CONTENT_8814B(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_ERR_CONTENT_8814B(x) | \ -+ BIT_SDIO_CMD_ERR_CONTENT_8814B(v)) -+ -+/* 2 REG_SDIO_CRC_ERR_IDX_8814B */ -+#define BIT_D3_CRC_ERR_8814B BIT(4) -+#define BIT_D2_CRC_ERR_8814B BIT(3) -+#define BIT_D1_CRC_ERR_8814B BIT(2) -+#define BIT_D0_CRC_ERR_8814B BIT(1) -+#define BIT_CMD_CRC_ERR_8814B BIT(0) -+ -+/* 2 REG_SDIO_DATA_CRC_8814B */ -+ -+#define BIT_SHIFT_SDIO_DATA_CRC_8814B 0 -+#define BIT_MASK_SDIO_DATA_CRC_8814B 0xffff -+#define BIT_SDIO_DATA_CRC_8814B(x) \ -+ (((x) & BIT_MASK_SDIO_DATA_CRC_8814B) << BIT_SHIFT_SDIO_DATA_CRC_8814B) -+#define BITS_SDIO_DATA_CRC_8814B \ -+ (BIT_MASK_SDIO_DATA_CRC_8814B << BIT_SHIFT_SDIO_DATA_CRC_8814B) -+#define BIT_CLEAR_SDIO_DATA_CRC_8814B(x) ((x) & (~BITS_SDIO_DATA_CRC_8814B)) -+#define BIT_GET_SDIO_DATA_CRC_8814B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DATA_CRC_8814B) & BIT_MASK_SDIO_DATA_CRC_8814B) -+#define BIT_SET_SDIO_DATA_CRC_8814B(x, v) \ -+ (BIT_CLEAR_SDIO_DATA_CRC_8814B(x) | BIT_SDIO_DATA_CRC_8814B(v)) -+ -+/* 2 REG_SDIO_DATA_REPLY_TIME_8814B */ -+ -+#define BIT_SHIFT_SDIO_DATA_REPLY_TIME_8814B 0 -+#define BIT_MASK_SDIO_DATA_REPLY_TIME_8814B 0x7 -+#define BIT_SDIO_DATA_REPLY_TIME_8814B(x) \ -+ (((x) & BIT_MASK_SDIO_DATA_REPLY_TIME_8814B) \ -+ << BIT_SHIFT_SDIO_DATA_REPLY_TIME_8814B) -+#define BITS_SDIO_DATA_REPLY_TIME_8814B \ -+ (BIT_MASK_SDIO_DATA_REPLY_TIME_8814B \ -+ << BIT_SHIFT_SDIO_DATA_REPLY_TIME_8814B) -+#define BIT_CLEAR_SDIO_DATA_REPLY_TIME_8814B(x) \ -+ ((x) & (~BITS_SDIO_DATA_REPLY_TIME_8814B)) -+#define BIT_GET_SDIO_DATA_REPLY_TIME_8814B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DATA_REPLY_TIME_8814B) & \ -+ BIT_MASK_SDIO_DATA_REPLY_TIME_8814B) -+#define BIT_SET_SDIO_DATA_REPLY_TIME_8814B(x, v) \ -+ (BIT_CLEAR_SDIO_DATA_REPLY_TIME_8814B(x) | \ -+ BIT_SDIO_DATA_REPLY_TIME_8814B(v)) -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8821c.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8821c.h -new file mode 100644 -index 000000000..d9550a236 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8821c.h -@@ -0,0 +1,19483 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_BIT_8821C_H -+#define __INC_HALMAC_BIT_8821C_H -+ -+#define CPU_OPT_WIDTH 0x1F -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_SYS_ISO_CTRL_8821C */ -+#define BIT_PWC_EV12V_8821C BIT(15) -+#define BIT_PWC_EV25V_8821C BIT(14) -+#define BIT_PA33V_EN_8821C BIT(13) -+#define BIT_PA12V_EN_8821C BIT(12) -+#define BIT_UA33V_EN_8821C BIT(11) -+#define BIT_UA12V_EN_8821C BIT(10) -+#define BIT_ISO_RFDIO_8821C BIT(9) -+#define BIT_ISO_EB2CORE_8821C BIT(8) -+#define BIT_ISO_DIOE_8821C BIT(7) -+#define BIT_ISO_WLPON2PP_8821C BIT(6) -+#define BIT_ISO_IP2MAC_WA2PP_8821C BIT(5) -+#define BIT_ISO_PD2CORE_8821C BIT(4) -+#define BIT_ISO_PA2PCIE_8821C BIT(3) -+#define BIT_ISO_UD2CORE_8821C BIT(2) -+#define BIT_ISO_UA2USB_8821C BIT(1) -+#define BIT_ISO_WD2PP_8821C BIT(0) -+ -+/* 2 REG_SYS_FUNC_EN_8821C */ -+#define BIT_FEN_MREGEN_8821C BIT(15) -+#define BIT_FEN_HWPDN_8821C BIT(14) -+#define BIT_EN_25_1_8821C BIT(13) -+#define BIT_FEN_ELDR_8821C BIT(12) -+#define BIT_FEN_DCORE_8821C BIT(11) -+#define BIT_FEN_CPUEN_8821C BIT(10) -+#define BIT_FEN_DIOE_8821C BIT(9) -+#define BIT_FEN_PCIED_8821C BIT(8) -+#define BIT_FEN_PPLL_8821C BIT(7) -+#define BIT_FEN_PCIEA_8821C BIT(6) -+#define BIT_FEN_DIO_PCIE_8821C BIT(5) -+#define BIT_FEN_USBD_8821C BIT(4) -+#define BIT_FEN_UPLL_8821C BIT(3) -+#define BIT_FEN_USBA_8821C BIT(2) -+#define BIT_FEN_BB_GLB_RSTN_8821C BIT(1) -+#define BIT_FEN_BBRSTB_8821C BIT(0) -+ -+/* 2 REG_SYS_PW_CTRL_8821C */ -+#define BIT_SOP_EABM_8821C BIT(31) -+#define BIT_SOP_ACKF_8821C BIT(30) -+#define BIT_SOP_ERCK_8821C BIT(29) -+#define BIT_SOP_ESWR_8821C BIT(28) -+#define BIT_SOP_PWMM_8821C BIT(27) -+#define BIT_SOP_EECK_8821C BIT(26) -+#define BIT_SOP_EXTL_8821C BIT(24) -+#define BIT_SYM_OP_RING_12M_8821C BIT(22) -+#define BIT_ROP_SWPR_8821C BIT(21) -+#define BIT_DIS_HW_LPLDM_8821C BIT(20) -+#define BIT_OPT_SWRST_WLMCU_8821C BIT(19) -+#define BIT_RDY_SYSPWR_8821C BIT(17) -+#define BIT_EN_WLON_8821C BIT(16) -+#define BIT_APDM_HPDN_8821C BIT(15) -+#define BIT_AFSM_PCIE_SUS_EN_8821C BIT(12) -+#define BIT_AFSM_WLSUS_EN_8821C BIT(11) -+#define BIT_APFM_SWLPS_8821C BIT(10) -+#define BIT_APFM_OFFMAC_8821C BIT(9) -+#define BIT_APFN_ONMAC_8821C BIT(8) -+#define BIT_CHIP_PDN_EN_8821C BIT(7) -+#define BIT_RDY_MACDIS_8821C BIT(6) -+#define BIT_RING_CLK_12M_EN_8821C BIT(4) -+#define BIT_PFM_WOWL_8821C BIT(3) -+#define BIT_PFM_LDKP_8821C BIT(2) -+#define BIT_WL_HCI_ALD_8821C BIT(1) -+#define BIT_PFM_LDALL_8821C BIT(0) -+ -+/* 2 REG_SYS_CLK_CTRL_8821C */ -+#define BIT_LDO_DUMMY_8821C BIT(15) -+#define BIT_CPU_CLK_EN_8821C BIT(14) -+#define BIT_SYMREG_CLK_EN_8821C BIT(13) -+#define BIT_HCI_CLK_EN_8821C BIT(12) -+#define BIT_MAC_CLK_EN_8821C BIT(11) -+#define BIT_SEC_CLK_EN_8821C BIT(10) -+#define BIT_PHY_SSC_RSTB_8821C BIT(9) -+#define BIT_EXT_32K_EN_8821C BIT(8) -+#define BIT_WL_CLK_TEST_8821C BIT(7) -+#define BIT_OP_SPS_PWM_EN_8821C BIT(6) -+#define BIT_LOADER_CLK_EN_8821C BIT(5) -+#define BIT_MACSLP_8821C BIT(4) -+#define BIT_WAKEPAD_EN_8821C BIT(3) -+#define BIT_ROMD16V_EN_8821C BIT(2) -+#define BIT_CKANA12M_EN_8821C BIT(1) -+#define BIT_CNTD16V_EN_8821C BIT(0) -+ -+/* 2 REG_SYS_EEPROM_CTRL_8821C */ -+ -+#define BIT_SHIFT_VPDIDX_8821C 8 -+#define BIT_MASK_VPDIDX_8821C 0xff -+#define BIT_VPDIDX_8821C(x) \ -+ (((x) & BIT_MASK_VPDIDX_8821C) << BIT_SHIFT_VPDIDX_8821C) -+#define BITS_VPDIDX_8821C (BIT_MASK_VPDIDX_8821C << BIT_SHIFT_VPDIDX_8821C) -+#define BIT_CLEAR_VPDIDX_8821C(x) ((x) & (~BITS_VPDIDX_8821C)) -+#define BIT_GET_VPDIDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_VPDIDX_8821C) & BIT_MASK_VPDIDX_8821C) -+#define BIT_SET_VPDIDX_8821C(x, v) \ -+ (BIT_CLEAR_VPDIDX_8821C(x) | BIT_VPDIDX_8821C(v)) -+ -+#define BIT_SHIFT_EEM1_0_8821C 6 -+#define BIT_MASK_EEM1_0_8821C 0x3 -+#define BIT_EEM1_0_8821C(x) \ -+ (((x) & BIT_MASK_EEM1_0_8821C) << BIT_SHIFT_EEM1_0_8821C) -+#define BITS_EEM1_0_8821C (BIT_MASK_EEM1_0_8821C << BIT_SHIFT_EEM1_0_8821C) -+#define BIT_CLEAR_EEM1_0_8821C(x) ((x) & (~BITS_EEM1_0_8821C)) -+#define BIT_GET_EEM1_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_EEM1_0_8821C) & BIT_MASK_EEM1_0_8821C) -+#define BIT_SET_EEM1_0_8821C(x, v) \ -+ (BIT_CLEAR_EEM1_0_8821C(x) | BIT_EEM1_0_8821C(v)) -+ -+#define BIT_AUTOLOAD_SUS_8821C BIT(5) -+#define BIT_EERPOMSEL_8821C BIT(4) -+#define BIT_EECS_V1_8821C BIT(3) -+#define BIT_EESK_V1_8821C BIT(2) -+#define BIT_EEDI_V1_8821C BIT(1) -+#define BIT_EEDO_V1_8821C BIT(0) -+ -+/* 2 REG_EE_VPD_8821C */ -+ -+#define BIT_SHIFT_VPD_DATA_8821C 0 -+#define BIT_MASK_VPD_DATA_8821C 0xffffffffL -+#define BIT_VPD_DATA_8821C(x) \ -+ (((x) & BIT_MASK_VPD_DATA_8821C) << BIT_SHIFT_VPD_DATA_8821C) -+#define BITS_VPD_DATA_8821C \ -+ (BIT_MASK_VPD_DATA_8821C << BIT_SHIFT_VPD_DATA_8821C) -+#define BIT_CLEAR_VPD_DATA_8821C(x) ((x) & (~BITS_VPD_DATA_8821C)) -+#define BIT_GET_VPD_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_VPD_DATA_8821C) & BIT_MASK_VPD_DATA_8821C) -+#define BIT_SET_VPD_DATA_8821C(x, v) \ -+ (BIT_CLEAR_VPD_DATA_8821C(x) | BIT_VPD_DATA_8821C(v)) -+ -+/* 2 REG_SYS_SWR_CTRL1_8821C */ -+#define BIT_C2_L_BIT0_8821C BIT(31) -+ -+#define BIT_SHIFT_C1_L_8821C 29 -+#define BIT_MASK_C1_L_8821C 0x3 -+#define BIT_C1_L_8821C(x) (((x) & BIT_MASK_C1_L_8821C) << BIT_SHIFT_C1_L_8821C) -+#define BITS_C1_L_8821C (BIT_MASK_C1_L_8821C << BIT_SHIFT_C1_L_8821C) -+#define BIT_CLEAR_C1_L_8821C(x) ((x) & (~BITS_C1_L_8821C)) -+#define BIT_GET_C1_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_C1_L_8821C) & BIT_MASK_C1_L_8821C) -+#define BIT_SET_C1_L_8821C(x, v) (BIT_CLEAR_C1_L_8821C(x) | BIT_C1_L_8821C(v)) -+ -+#define BIT_SHIFT_REG_FREQ_L_8821C 25 -+#define BIT_MASK_REG_FREQ_L_8821C 0x7 -+#define BIT_REG_FREQ_L_8821C(x) \ -+ (((x) & BIT_MASK_REG_FREQ_L_8821C) << BIT_SHIFT_REG_FREQ_L_8821C) -+#define BITS_REG_FREQ_L_8821C \ -+ (BIT_MASK_REG_FREQ_L_8821C << BIT_SHIFT_REG_FREQ_L_8821C) -+#define BIT_CLEAR_REG_FREQ_L_8821C(x) ((x) & (~BITS_REG_FREQ_L_8821C)) -+#define BIT_GET_REG_FREQ_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_FREQ_L_8821C) & BIT_MASK_REG_FREQ_L_8821C) -+#define BIT_SET_REG_FREQ_L_8821C(x, v) \ -+ (BIT_CLEAR_REG_FREQ_L_8821C(x) | BIT_REG_FREQ_L_8821C(v)) -+ -+#define BIT_REG_EN_DUTY_8821C BIT(24) -+ -+#define BIT_SHIFT_REG_MODE_8821C 22 -+#define BIT_MASK_REG_MODE_8821C 0x3 -+#define BIT_REG_MODE_8821C(x) \ -+ (((x) & BIT_MASK_REG_MODE_8821C) << BIT_SHIFT_REG_MODE_8821C) -+#define BITS_REG_MODE_8821C \ -+ (BIT_MASK_REG_MODE_8821C << BIT_SHIFT_REG_MODE_8821C) -+#define BIT_CLEAR_REG_MODE_8821C(x) ((x) & (~BITS_REG_MODE_8821C)) -+#define BIT_GET_REG_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_MODE_8821C) & BIT_MASK_REG_MODE_8821C) -+#define BIT_SET_REG_MODE_8821C(x, v) \ -+ (BIT_CLEAR_REG_MODE_8821C(x) | BIT_REG_MODE_8821C(v)) -+ -+#define BIT_REG_EN_SP_8821C BIT(21) -+#define BIT_REG_AUTO_L_8821C BIT(20) -+#define BIT_SW18_SELD_BIT0_8821C BIT(19) -+#define BIT_SW18_POWOCP_8821C BIT(18) -+ -+#define BIT_SHIFT_OCP_L1_8821C 15 -+#define BIT_MASK_OCP_L1_8821C 0x7 -+#define BIT_OCP_L1_8821C(x) \ -+ (((x) & BIT_MASK_OCP_L1_8821C) << BIT_SHIFT_OCP_L1_8821C) -+#define BITS_OCP_L1_8821C (BIT_MASK_OCP_L1_8821C << BIT_SHIFT_OCP_L1_8821C) -+#define BIT_CLEAR_OCP_L1_8821C(x) ((x) & (~BITS_OCP_L1_8821C)) -+#define BIT_GET_OCP_L1_8821C(x) \ -+ (((x) >> BIT_SHIFT_OCP_L1_8821C) & BIT_MASK_OCP_L1_8821C) -+#define BIT_SET_OCP_L1_8821C(x, v) \ -+ (BIT_CLEAR_OCP_L1_8821C(x) | BIT_OCP_L1_8821C(v)) -+ -+#define BIT_SHIFT_CF_L_8821C 13 -+#define BIT_MASK_CF_L_8821C 0x3 -+#define BIT_CF_L_8821C(x) (((x) & BIT_MASK_CF_L_8821C) << BIT_SHIFT_CF_L_8821C) -+#define BITS_CF_L_8821C (BIT_MASK_CF_L_8821C << BIT_SHIFT_CF_L_8821C) -+#define BIT_CLEAR_CF_L_8821C(x) ((x) & (~BITS_CF_L_8821C)) -+#define BIT_GET_CF_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_CF_L_8821C) & BIT_MASK_CF_L_8821C) -+#define BIT_SET_CF_L_8821C(x, v) (BIT_CLEAR_CF_L_8821C(x) | BIT_CF_L_8821C(v)) -+ -+#define BIT_SW18_FPWM_8821C BIT(11) -+#define BIT_SW18_SWEN_8821C BIT(9) -+#define BIT_SW18_LDEN_8821C BIT(8) -+#define BIT_MAC_ID_EN_8821C BIT(7) -+#define BIT_AFE_BGEN_8821C BIT(0) -+ -+/* 2 REG_SYS_SWR_CTRL2_8821C */ -+#define BIT_POW_ZCD_L_8821C BIT(31) -+#define BIT_AUTOZCD_L_8821C BIT(30) -+ -+#define BIT_SHIFT_REG_DELAY_8821C 28 -+#define BIT_MASK_REG_DELAY_8821C 0x3 -+#define BIT_REG_DELAY_8821C(x) \ -+ (((x) & BIT_MASK_REG_DELAY_8821C) << BIT_SHIFT_REG_DELAY_8821C) -+#define BITS_REG_DELAY_8821C \ -+ (BIT_MASK_REG_DELAY_8821C << BIT_SHIFT_REG_DELAY_8821C) -+#define BIT_CLEAR_REG_DELAY_8821C(x) ((x) & (~BITS_REG_DELAY_8821C)) -+#define BIT_GET_REG_DELAY_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_DELAY_8821C) & BIT_MASK_REG_DELAY_8821C) -+#define BIT_SET_REG_DELAY_8821C(x, v) \ -+ (BIT_CLEAR_REG_DELAY_8821C(x) | BIT_REG_DELAY_8821C(v)) -+ -+#define BIT_SHIFT_V15ADJ_L1_V1_8821C 24 -+#define BIT_MASK_V15ADJ_L1_V1_8821C 0x7 -+#define BIT_V15ADJ_L1_V1_8821C(x) \ -+ (((x) & BIT_MASK_V15ADJ_L1_V1_8821C) << BIT_SHIFT_V15ADJ_L1_V1_8821C) -+#define BITS_V15ADJ_L1_V1_8821C \ -+ (BIT_MASK_V15ADJ_L1_V1_8821C << BIT_SHIFT_V15ADJ_L1_V1_8821C) -+#define BIT_CLEAR_V15ADJ_L1_V1_8821C(x) ((x) & (~BITS_V15ADJ_L1_V1_8821C)) -+#define BIT_GET_V15ADJ_L1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L1_V1_8821C) & BIT_MASK_V15ADJ_L1_V1_8821C) -+#define BIT_SET_V15ADJ_L1_V1_8821C(x, v) \ -+ (BIT_CLEAR_V15ADJ_L1_V1_8821C(x) | BIT_V15ADJ_L1_V1_8821C(v)) -+ -+#define BIT_SHIFT_VOL_L1_V1_8821C 20 -+#define BIT_MASK_VOL_L1_V1_8821C 0xf -+#define BIT_VOL_L1_V1_8821C(x) \ -+ (((x) & BIT_MASK_VOL_L1_V1_8821C) << BIT_SHIFT_VOL_L1_V1_8821C) -+#define BITS_VOL_L1_V1_8821C \ -+ (BIT_MASK_VOL_L1_V1_8821C << BIT_SHIFT_VOL_L1_V1_8821C) -+#define BIT_CLEAR_VOL_L1_V1_8821C(x) ((x) & (~BITS_VOL_L1_V1_8821C)) -+#define BIT_GET_VOL_L1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_VOL_L1_V1_8821C) & BIT_MASK_VOL_L1_V1_8821C) -+#define BIT_SET_VOL_L1_V1_8821C(x, v) \ -+ (BIT_CLEAR_VOL_L1_V1_8821C(x) | BIT_VOL_L1_V1_8821C(v)) -+ -+#define BIT_SHIFT_IN_L1_V1_8821C 17 -+#define BIT_MASK_IN_L1_V1_8821C 0x7 -+#define BIT_IN_L1_V1_8821C(x) \ -+ (((x) & BIT_MASK_IN_L1_V1_8821C) << BIT_SHIFT_IN_L1_V1_8821C) -+#define BITS_IN_L1_V1_8821C \ -+ (BIT_MASK_IN_L1_V1_8821C << BIT_SHIFT_IN_L1_V1_8821C) -+#define BIT_CLEAR_IN_L1_V1_8821C(x) ((x) & (~BITS_IN_L1_V1_8821C)) -+#define BIT_GET_IN_L1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_IN_L1_V1_8821C) & BIT_MASK_IN_L1_V1_8821C) -+#define BIT_SET_IN_L1_V1_8821C(x, v) \ -+ (BIT_CLEAR_IN_L1_V1_8821C(x) | BIT_IN_L1_V1_8821C(v)) -+ -+#define BIT_SHIFT_TBOX_L1_8821C 15 -+#define BIT_MASK_TBOX_L1_8821C 0x3 -+#define BIT_TBOX_L1_8821C(x) \ -+ (((x) & BIT_MASK_TBOX_L1_8821C) << BIT_SHIFT_TBOX_L1_8821C) -+#define BITS_TBOX_L1_8821C (BIT_MASK_TBOX_L1_8821C << BIT_SHIFT_TBOX_L1_8821C) -+#define BIT_CLEAR_TBOX_L1_8821C(x) ((x) & (~BITS_TBOX_L1_8821C)) -+#define BIT_GET_TBOX_L1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TBOX_L1_8821C) & BIT_MASK_TBOX_L1_8821C) -+#define BIT_SET_TBOX_L1_8821C(x, v) \ -+ (BIT_CLEAR_TBOX_L1_8821C(x) | BIT_TBOX_L1_8821C(v)) -+ -+#define BIT_SW18_SEL_8821C BIT(13) -+ -+/* 2 REG_NOT_VALID_8821C */ -+#define BIT_SW18_SD_8821C BIT(10) -+ -+#define BIT_SHIFT_R3_L_8821C 7 -+#define BIT_MASK_R3_L_8821C 0x3 -+#define BIT_R3_L_8821C(x) (((x) & BIT_MASK_R3_L_8821C) << BIT_SHIFT_R3_L_8821C) -+#define BITS_R3_L_8821C (BIT_MASK_R3_L_8821C << BIT_SHIFT_R3_L_8821C) -+#define BIT_CLEAR_R3_L_8821C(x) ((x) & (~BITS_R3_L_8821C)) -+#define BIT_GET_R3_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_R3_L_8821C) & BIT_MASK_R3_L_8821C) -+#define BIT_SET_R3_L_8821C(x, v) (BIT_CLEAR_R3_L_8821C(x) | BIT_R3_L_8821C(v)) -+ -+#define BIT_SHIFT_SW18_R2_8821C 5 -+#define BIT_MASK_SW18_R2_8821C 0x3 -+#define BIT_SW18_R2_8821C(x) \ -+ (((x) & BIT_MASK_SW18_R2_8821C) << BIT_SHIFT_SW18_R2_8821C) -+#define BITS_SW18_R2_8821C (BIT_MASK_SW18_R2_8821C << BIT_SHIFT_SW18_R2_8821C) -+#define BIT_CLEAR_SW18_R2_8821C(x) ((x) & (~BITS_SW18_R2_8821C)) -+#define BIT_GET_SW18_R2_8821C(x) \ -+ (((x) >> BIT_SHIFT_SW18_R2_8821C) & BIT_MASK_SW18_R2_8821C) -+#define BIT_SET_SW18_R2_8821C(x, v) \ -+ (BIT_CLEAR_SW18_R2_8821C(x) | BIT_SW18_R2_8821C(v)) -+ -+#define BIT_SHIFT_SW18_R1_8821C 3 -+#define BIT_MASK_SW18_R1_8821C 0x3 -+#define BIT_SW18_R1_8821C(x) \ -+ (((x) & BIT_MASK_SW18_R1_8821C) << BIT_SHIFT_SW18_R1_8821C) -+#define BITS_SW18_R1_8821C (BIT_MASK_SW18_R1_8821C << BIT_SHIFT_SW18_R1_8821C) -+#define BIT_CLEAR_SW18_R1_8821C(x) ((x) & (~BITS_SW18_R1_8821C)) -+#define BIT_GET_SW18_R1_8821C(x) \ -+ (((x) >> BIT_SHIFT_SW18_R1_8821C) & BIT_MASK_SW18_R1_8821C) -+#define BIT_SET_SW18_R1_8821C(x, v) \ -+ (BIT_CLEAR_SW18_R1_8821C(x) | BIT_SW18_R1_8821C(v)) -+ -+#define BIT_SHIFT_C3_L_C3_8821C 1 -+#define BIT_MASK_C3_L_C3_8821C 0x3 -+#define BIT_C3_L_C3_8821C(x) \ -+ (((x) & BIT_MASK_C3_L_C3_8821C) << BIT_SHIFT_C3_L_C3_8821C) -+#define BITS_C3_L_C3_8821C (BIT_MASK_C3_L_C3_8821C << BIT_SHIFT_C3_L_C3_8821C) -+#define BIT_CLEAR_C3_L_C3_8821C(x) ((x) & (~BITS_C3_L_C3_8821C)) -+#define BIT_GET_C3_L_C3_8821C(x) \ -+ (((x) >> BIT_SHIFT_C3_L_C3_8821C) & BIT_MASK_C3_L_C3_8821C) -+#define BIT_SET_C3_L_C3_8821C(x, v) \ -+ (BIT_CLEAR_C3_L_C3_8821C(x) | BIT_C3_L_C3_8821C(v)) -+ -+#define BIT_C2_L_BIT1_8821C BIT(0) -+ -+/* 2 REG_SYS_SWR_CTRL3_8821C */ -+#define BIT_SPS18_OCP_DIS_8821C BIT(31) -+ -+#define BIT_SHIFT_SPS18_OCP_TH_8821C 16 -+#define BIT_MASK_SPS18_OCP_TH_8821C 0x7fff -+#define BIT_SPS18_OCP_TH_8821C(x) \ -+ (((x) & BIT_MASK_SPS18_OCP_TH_8821C) << BIT_SHIFT_SPS18_OCP_TH_8821C) -+#define BITS_SPS18_OCP_TH_8821C \ -+ (BIT_MASK_SPS18_OCP_TH_8821C << BIT_SHIFT_SPS18_OCP_TH_8821C) -+#define BIT_CLEAR_SPS18_OCP_TH_8821C(x) ((x) & (~BITS_SPS18_OCP_TH_8821C)) -+#define BIT_GET_SPS18_OCP_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_SPS18_OCP_TH_8821C) & BIT_MASK_SPS18_OCP_TH_8821C) -+#define BIT_SET_SPS18_OCP_TH_8821C(x, v) \ -+ (BIT_CLEAR_SPS18_OCP_TH_8821C(x) | BIT_SPS18_OCP_TH_8821C(v)) -+ -+#define BIT_SHIFT_OCP_WINDOW_8821C 0 -+#define BIT_MASK_OCP_WINDOW_8821C 0xffff -+#define BIT_OCP_WINDOW_8821C(x) \ -+ (((x) & BIT_MASK_OCP_WINDOW_8821C) << BIT_SHIFT_OCP_WINDOW_8821C) -+#define BITS_OCP_WINDOW_8821C \ -+ (BIT_MASK_OCP_WINDOW_8821C << BIT_SHIFT_OCP_WINDOW_8821C) -+#define BIT_CLEAR_OCP_WINDOW_8821C(x) ((x) & (~BITS_OCP_WINDOW_8821C)) -+#define BIT_GET_OCP_WINDOW_8821C(x) \ -+ (((x) >> BIT_SHIFT_OCP_WINDOW_8821C) & BIT_MASK_OCP_WINDOW_8821C) -+#define BIT_SET_OCP_WINDOW_8821C(x, v) \ -+ (BIT_CLEAR_OCP_WINDOW_8821C(x) | BIT_OCP_WINDOW_8821C(v)) -+ -+/* 2 REG_RSV_CTRL_8821C */ -+#define BIT_HREG_DBG_8821C BIT(23) -+#define BIT_WLMCUIOIF_8821C BIT(8) -+#define BIT_LOCK_ALL_EN_8821C BIT(7) -+#define BIT_R_DIS_PRST_8821C BIT(6) -+#define BIT_WLOCK_1C_B6_8821C BIT(5) -+#define BIT_WLOCK_40_8821C BIT(4) -+#define BIT_WLOCK_08_8821C BIT(3) -+#define BIT_WLOCK_04_8821C BIT(2) -+#define BIT_WLOCK_00_8821C BIT(1) -+#define BIT_WLOCK_ALL_8821C BIT(0) -+ -+/* 2 REG_RF_CTRL_8821C */ -+#define BIT_RF_SDMRSTB_8821C BIT(2) -+#define BIT_RF_RSTB_8821C BIT(1) -+#define BIT_RF_EN_8821C BIT(0) -+ -+/* 2 REG_AFE_LDO_CTRL_8821C */ -+ -+#define BIT_SHIFT_LPLDH12_RSV_8821C 29 -+#define BIT_MASK_LPLDH12_RSV_8821C 0x7 -+#define BIT_LPLDH12_RSV_8821C(x) \ -+ (((x) & BIT_MASK_LPLDH12_RSV_8821C) << BIT_SHIFT_LPLDH12_RSV_8821C) -+#define BITS_LPLDH12_RSV_8821C \ -+ (BIT_MASK_LPLDH12_RSV_8821C << BIT_SHIFT_LPLDH12_RSV_8821C) -+#define BIT_CLEAR_LPLDH12_RSV_8821C(x) ((x) & (~BITS_LPLDH12_RSV_8821C)) -+#define BIT_GET_LPLDH12_RSV_8821C(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_RSV_8821C) & BIT_MASK_LPLDH12_RSV_8821C) -+#define BIT_SET_LPLDH12_RSV_8821C(x, v) \ -+ (BIT_CLEAR_LPLDH12_RSV_8821C(x) | BIT_LPLDH12_RSV_8821C(v)) -+ -+#define BIT_LPLDH12_SLP_8821C BIT(28) -+ -+#define BIT_SHIFT_LPLDH12_VADJ_8821C 24 -+#define BIT_MASK_LPLDH12_VADJ_8821C 0xf -+#define BIT_LPLDH12_VADJ_8821C(x) \ -+ (((x) & BIT_MASK_LPLDH12_VADJ_8821C) << BIT_SHIFT_LPLDH12_VADJ_8821C) -+#define BITS_LPLDH12_VADJ_8821C \ -+ (BIT_MASK_LPLDH12_VADJ_8821C << BIT_SHIFT_LPLDH12_VADJ_8821C) -+#define BIT_CLEAR_LPLDH12_VADJ_8821C(x) ((x) & (~BITS_LPLDH12_VADJ_8821C)) -+#define BIT_GET_LPLDH12_VADJ_8821C(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_VADJ_8821C) & BIT_MASK_LPLDH12_VADJ_8821C) -+#define BIT_SET_LPLDH12_VADJ_8821C(x, v) \ -+ (BIT_CLEAR_LPLDH12_VADJ_8821C(x) | BIT_LPLDH12_VADJ_8821C(v)) -+ -+#define BIT_PCIE_CALIB_EN_8821C BIT(17) -+#define BIT_LDH12_EN_8821C BIT(16) -+#define BIT_WLBBOFF_BIG_PWC_EN_8821C BIT(14) -+#define BIT_WLBBOFF_SMALL_PWC_EN_8821C BIT(13) -+#define BIT_WLMACOFF_BIG_PWC_EN_8821C BIT(12) -+#define BIT_WLPON_PWC_EN_8821C BIT(11) -+#define BIT_POW_REGU_P1_8821C BIT(10) -+#define BIT_LDOV12W_EN_8821C BIT(8) -+#define BIT_EX_XTAL_DRV_DIGI_8821C BIT(7) -+#define BIT_EX_XTAL_DRV_USB_8821C BIT(6) -+#define BIT_EX_XTAL_DRV_AFE_8821C BIT(5) -+#define BIT_EX_XTAL_DRV_RF2_8821C BIT(4) -+#define BIT_EX_XTAL_DRV_RF1_8821C BIT(3) -+#define BIT_POW_REGU_P0_8821C BIT(2) -+ -+/* 2 REG_NOT_VALID_8821C */ -+#define BIT_POW_PLL_LDO_8821C BIT(0) -+ -+/* 2 REG_AFE_CTRL1_8821C */ -+#define BIT_AGPIO_GPE_8821C BIT(31) -+ -+#define BIT_SHIFT_XTAL_CAP_XI_8821C 25 -+#define BIT_MASK_XTAL_CAP_XI_8821C 0x3f -+#define BIT_XTAL_CAP_XI_8821C(x) \ -+ (((x) & BIT_MASK_XTAL_CAP_XI_8821C) << BIT_SHIFT_XTAL_CAP_XI_8821C) -+#define BITS_XTAL_CAP_XI_8821C \ -+ (BIT_MASK_XTAL_CAP_XI_8821C << BIT_SHIFT_XTAL_CAP_XI_8821C) -+#define BIT_CLEAR_XTAL_CAP_XI_8821C(x) ((x) & (~BITS_XTAL_CAP_XI_8821C)) -+#define BIT_GET_XTAL_CAP_XI_8821C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CAP_XI_8821C) & BIT_MASK_XTAL_CAP_XI_8821C) -+#define BIT_SET_XTAL_CAP_XI_8821C(x, v) \ -+ (BIT_CLEAR_XTAL_CAP_XI_8821C(x) | BIT_XTAL_CAP_XI_8821C(v)) -+ -+#define BIT_SHIFT_XTAL_DRV_DIGI_8821C 23 -+#define BIT_MASK_XTAL_DRV_DIGI_8821C 0x3 -+#define BIT_XTAL_DRV_DIGI_8821C(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_DIGI_8821C) << BIT_SHIFT_XTAL_DRV_DIGI_8821C) -+#define BITS_XTAL_DRV_DIGI_8821C \ -+ (BIT_MASK_XTAL_DRV_DIGI_8821C << BIT_SHIFT_XTAL_DRV_DIGI_8821C) -+#define BIT_CLEAR_XTAL_DRV_DIGI_8821C(x) ((x) & (~BITS_XTAL_DRV_DIGI_8821C)) -+#define BIT_GET_XTAL_DRV_DIGI_8821C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_DIGI_8821C) & BIT_MASK_XTAL_DRV_DIGI_8821C) -+#define BIT_SET_XTAL_DRV_DIGI_8821C(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_DIGI_8821C(x) | BIT_XTAL_DRV_DIGI_8821C(v)) -+ -+#define BIT_XTAL_DRV_USB_BIT1_8821C BIT(22) -+ -+#define BIT_SHIFT_MAC_CLK_SEL_8821C 20 -+#define BIT_MASK_MAC_CLK_SEL_8821C 0x3 -+#define BIT_MAC_CLK_SEL_8821C(x) \ -+ (((x) & BIT_MASK_MAC_CLK_SEL_8821C) << BIT_SHIFT_MAC_CLK_SEL_8821C) -+#define BITS_MAC_CLK_SEL_8821C \ -+ (BIT_MASK_MAC_CLK_SEL_8821C << BIT_SHIFT_MAC_CLK_SEL_8821C) -+#define BIT_CLEAR_MAC_CLK_SEL_8821C(x) ((x) & (~BITS_MAC_CLK_SEL_8821C)) -+#define BIT_GET_MAC_CLK_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_MAC_CLK_SEL_8821C) & BIT_MASK_MAC_CLK_SEL_8821C) -+#define BIT_SET_MAC_CLK_SEL_8821C(x, v) \ -+ (BIT_CLEAR_MAC_CLK_SEL_8821C(x) | BIT_MAC_CLK_SEL_8821C(v)) -+ -+#define BIT_XTAL_DRV_USB_BIT0_8821C BIT(19) -+ -+#define BIT_SHIFT_XTAL_DRV_AFE_8821C 17 -+#define BIT_MASK_XTAL_DRV_AFE_8821C 0x3 -+#define BIT_XTAL_DRV_AFE_8821C(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_AFE_8821C) << BIT_SHIFT_XTAL_DRV_AFE_8821C) -+#define BITS_XTAL_DRV_AFE_8821C \ -+ (BIT_MASK_XTAL_DRV_AFE_8821C << BIT_SHIFT_XTAL_DRV_AFE_8821C) -+#define BIT_CLEAR_XTAL_DRV_AFE_8821C(x) ((x) & (~BITS_XTAL_DRV_AFE_8821C)) -+#define BIT_GET_XTAL_DRV_AFE_8821C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_AFE_8821C) & BIT_MASK_XTAL_DRV_AFE_8821C) -+#define BIT_SET_XTAL_DRV_AFE_8821C(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_AFE_8821C(x) | BIT_XTAL_DRV_AFE_8821C(v)) -+ -+#define BIT_SHIFT_XTAL_DRV_RF2_8821C 15 -+#define BIT_MASK_XTAL_DRV_RF2_8821C 0x3 -+#define BIT_XTAL_DRV_RF2_8821C(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF2_8821C) << BIT_SHIFT_XTAL_DRV_RF2_8821C) -+#define BITS_XTAL_DRV_RF2_8821C \ -+ (BIT_MASK_XTAL_DRV_RF2_8821C << BIT_SHIFT_XTAL_DRV_RF2_8821C) -+#define BIT_CLEAR_XTAL_DRV_RF2_8821C(x) ((x) & (~BITS_XTAL_DRV_RF2_8821C)) -+#define BIT_GET_XTAL_DRV_RF2_8821C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF2_8821C) & BIT_MASK_XTAL_DRV_RF2_8821C) -+#define BIT_SET_XTAL_DRV_RF2_8821C(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF2_8821C(x) | BIT_XTAL_DRV_RF2_8821C(v)) -+ -+#define BIT_SHIFT_XTAL_DRV_RF1_8821C 13 -+#define BIT_MASK_XTAL_DRV_RF1_8821C 0x3 -+#define BIT_XTAL_DRV_RF1_8821C(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF1_8821C) << BIT_SHIFT_XTAL_DRV_RF1_8821C) -+#define BITS_XTAL_DRV_RF1_8821C \ -+ (BIT_MASK_XTAL_DRV_RF1_8821C << BIT_SHIFT_XTAL_DRV_RF1_8821C) -+#define BIT_CLEAR_XTAL_DRV_RF1_8821C(x) ((x) & (~BITS_XTAL_DRV_RF1_8821C)) -+#define BIT_GET_XTAL_DRV_RF1_8821C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF1_8821C) & BIT_MASK_XTAL_DRV_RF1_8821C) -+#define BIT_SET_XTAL_DRV_RF1_8821C(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF1_8821C(x) | BIT_XTAL_DRV_RF1_8821C(v)) -+ -+#define BIT_XTAL_DELAY_DIGI_8821C BIT(12) -+#define BIT_XTAL_DELAY_USB_8821C BIT(11) -+#define BIT_XTAL_DELAY_AFE_8821C BIT(10) -+ -+#define BIT_SHIFT_XTAL_LDO_VREF_8821C 7 -+#define BIT_MASK_XTAL_LDO_VREF_8821C 0x7 -+#define BIT_XTAL_LDO_VREF_8821C(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_VREF_8821C) << BIT_SHIFT_XTAL_LDO_VREF_8821C) -+#define BITS_XTAL_LDO_VREF_8821C \ -+ (BIT_MASK_XTAL_LDO_VREF_8821C << BIT_SHIFT_XTAL_LDO_VREF_8821C) -+#define BIT_CLEAR_XTAL_LDO_VREF_8821C(x) ((x) & (~BITS_XTAL_LDO_VREF_8821C)) -+#define BIT_GET_XTAL_LDO_VREF_8821C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_VREF_8821C) & BIT_MASK_XTAL_LDO_VREF_8821C) -+#define BIT_SET_XTAL_LDO_VREF_8821C(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_VREF_8821C(x) | BIT_XTAL_LDO_VREF_8821C(v)) -+ -+#define BIT_XTAL_XQSEL_RF_8821C BIT(6) -+#define BIT_XTAL_XQSEL_8821C BIT(5) -+ -+#define BIT_SHIFT_XTAL_GMN_V2_8821C 3 -+#define BIT_MASK_XTAL_GMN_V2_8821C 0x3 -+#define BIT_XTAL_GMN_V2_8821C(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_V2_8821C) << BIT_SHIFT_XTAL_GMN_V2_8821C) -+#define BITS_XTAL_GMN_V2_8821C \ -+ (BIT_MASK_XTAL_GMN_V2_8821C << BIT_SHIFT_XTAL_GMN_V2_8821C) -+#define BIT_CLEAR_XTAL_GMN_V2_8821C(x) ((x) & (~BITS_XTAL_GMN_V2_8821C)) -+#define BIT_GET_XTAL_GMN_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_V2_8821C) & BIT_MASK_XTAL_GMN_V2_8821C) -+#define BIT_SET_XTAL_GMN_V2_8821C(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_V2_8821C(x) | BIT_XTAL_GMN_V2_8821C(v)) -+ -+#define BIT_SHIFT_XTAL_GMP_V2_8821C 1 -+#define BIT_MASK_XTAL_GMP_V2_8821C 0x3 -+#define BIT_XTAL_GMP_V2_8821C(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_V2_8821C) << BIT_SHIFT_XTAL_GMP_V2_8821C) -+#define BITS_XTAL_GMP_V2_8821C \ -+ (BIT_MASK_XTAL_GMP_V2_8821C << BIT_SHIFT_XTAL_GMP_V2_8821C) -+#define BIT_CLEAR_XTAL_GMP_V2_8821C(x) ((x) & (~BITS_XTAL_GMP_V2_8821C)) -+#define BIT_GET_XTAL_GMP_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_V2_8821C) & BIT_MASK_XTAL_GMP_V2_8821C) -+#define BIT_SET_XTAL_GMP_V2_8821C(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_V2_8821C(x) | BIT_XTAL_GMP_V2_8821C(v)) -+ -+#define BIT_XTAL_EN_8821C BIT(0) -+ -+/* 2 REG_AFE_CTRL2_8821C */ -+ -+#define BIT_SHIFT_REG_C3_V4_8821C 30 -+#define BIT_MASK_REG_C3_V4_8821C 0x3 -+#define BIT_REG_C3_V4_8821C(x) \ -+ (((x) & BIT_MASK_REG_C3_V4_8821C) << BIT_SHIFT_REG_C3_V4_8821C) -+#define BITS_REG_C3_V4_8821C \ -+ (BIT_MASK_REG_C3_V4_8821C << BIT_SHIFT_REG_C3_V4_8821C) -+#define BIT_CLEAR_REG_C3_V4_8821C(x) ((x) & (~BITS_REG_C3_V4_8821C)) -+#define BIT_GET_REG_C3_V4_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_C3_V4_8821C) & BIT_MASK_REG_C3_V4_8821C) -+#define BIT_SET_REG_C3_V4_8821C(x, v) \ -+ (BIT_CLEAR_REG_C3_V4_8821C(x) | BIT_REG_C3_V4_8821C(v)) -+ -+#define BIT_REG_CP_BIT1_8821C BIT(29) -+ -+#define BIT_SHIFT_REG_RS_V4_8821C 26 -+#define BIT_MASK_REG_RS_V4_8821C 0x7 -+#define BIT_REG_RS_V4_8821C(x) \ -+ (((x) & BIT_MASK_REG_RS_V4_8821C) << BIT_SHIFT_REG_RS_V4_8821C) -+#define BITS_REG_RS_V4_8821C \ -+ (BIT_MASK_REG_RS_V4_8821C << BIT_SHIFT_REG_RS_V4_8821C) -+#define BIT_CLEAR_REG_RS_V4_8821C(x) ((x) & (~BITS_REG_RS_V4_8821C)) -+#define BIT_GET_REG_RS_V4_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_RS_V4_8821C) & BIT_MASK_REG_RS_V4_8821C) -+#define BIT_SET_REG_RS_V4_8821C(x, v) \ -+ (BIT_CLEAR_REG_RS_V4_8821C(x) | BIT_REG_RS_V4_8821C(v)) -+ -+#define BIT_SHIFT_REG__CS_8821C 24 -+#define BIT_MASK_REG__CS_8821C 0x3 -+#define BIT_REG__CS_8821C(x) \ -+ (((x) & BIT_MASK_REG__CS_8821C) << BIT_SHIFT_REG__CS_8821C) -+#define BITS_REG__CS_8821C (BIT_MASK_REG__CS_8821C << BIT_SHIFT_REG__CS_8821C) -+#define BIT_CLEAR_REG__CS_8821C(x) ((x) & (~BITS_REG__CS_8821C)) -+#define BIT_GET_REG__CS_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG__CS_8821C) & BIT_MASK_REG__CS_8821C) -+#define BIT_SET_REG__CS_8821C(x, v) \ -+ (BIT_CLEAR_REG__CS_8821C(x) | BIT_REG__CS_8821C(v)) -+ -+#define BIT_SHIFT_REG_CP_OFFSET_8821C 21 -+#define BIT_MASK_REG_CP_OFFSET_8821C 0x7 -+#define BIT_REG_CP_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_REG_CP_OFFSET_8821C) << BIT_SHIFT_REG_CP_OFFSET_8821C) -+#define BITS_REG_CP_OFFSET_8821C \ -+ (BIT_MASK_REG_CP_OFFSET_8821C << BIT_SHIFT_REG_CP_OFFSET_8821C) -+#define BIT_CLEAR_REG_CP_OFFSET_8821C(x) ((x) & (~BITS_REG_CP_OFFSET_8821C)) -+#define BIT_GET_REG_CP_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_OFFSET_8821C) & BIT_MASK_REG_CP_OFFSET_8821C) -+#define BIT_SET_REG_CP_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_REG_CP_OFFSET_8821C(x) | BIT_REG_CP_OFFSET_8821C(v)) -+ -+#define BIT_SHIFT_CP_BIAS_8821C 18 -+#define BIT_MASK_CP_BIAS_8821C 0x7 -+#define BIT_CP_BIAS_8821C(x) \ -+ (((x) & BIT_MASK_CP_BIAS_8821C) << BIT_SHIFT_CP_BIAS_8821C) -+#define BITS_CP_BIAS_8821C (BIT_MASK_CP_BIAS_8821C << BIT_SHIFT_CP_BIAS_8821C) -+#define BIT_CLEAR_CP_BIAS_8821C(x) ((x) & (~BITS_CP_BIAS_8821C)) -+#define BIT_GET_CP_BIAS_8821C(x) \ -+ (((x) >> BIT_SHIFT_CP_BIAS_8821C) & BIT_MASK_CP_BIAS_8821C) -+#define BIT_SET_CP_BIAS_8821C(x, v) \ -+ (BIT_CLEAR_CP_BIAS_8821C(x) | BIT_CP_BIAS_8821C(v)) -+ -+#define BIT_REG_IDOUBLE_V2_8821C BIT(17) -+#define BIT_EN_SYN_8821C BIT(16) -+ -+#define BIT_SHIFT_MCCO_8821C 14 -+#define BIT_MASK_MCCO_8821C 0x3 -+#define BIT_MCCO_8821C(x) (((x) & BIT_MASK_MCCO_8821C) << BIT_SHIFT_MCCO_8821C) -+#define BITS_MCCO_8821C (BIT_MASK_MCCO_8821C << BIT_SHIFT_MCCO_8821C) -+#define BIT_CLEAR_MCCO_8821C(x) ((x) & (~BITS_MCCO_8821C)) -+#define BIT_GET_MCCO_8821C(x) \ -+ (((x) >> BIT_SHIFT_MCCO_8821C) & BIT_MASK_MCCO_8821C) -+#define BIT_SET_MCCO_8821C(x, v) (BIT_CLEAR_MCCO_8821C(x) | BIT_MCCO_8821C(v)) -+ -+#define BIT_SHIFT_REG_LDO_SEL_8821C 12 -+#define BIT_MASK_REG_LDO_SEL_8821C 0x3 -+#define BIT_REG_LDO_SEL_8821C(x) \ -+ (((x) & BIT_MASK_REG_LDO_SEL_8821C) << BIT_SHIFT_REG_LDO_SEL_8821C) -+#define BITS_REG_LDO_SEL_8821C \ -+ (BIT_MASK_REG_LDO_SEL_8821C << BIT_SHIFT_REG_LDO_SEL_8821C) -+#define BIT_CLEAR_REG_LDO_SEL_8821C(x) ((x) & (~BITS_REG_LDO_SEL_8821C)) -+#define BIT_GET_REG_LDO_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_LDO_SEL_8821C) & BIT_MASK_REG_LDO_SEL_8821C) -+#define BIT_SET_REG_LDO_SEL_8821C(x, v) \ -+ (BIT_CLEAR_REG_LDO_SEL_8821C(x) | BIT_REG_LDO_SEL_8821C(v)) -+ -+#define BIT_REG_KVCO_V2_8821C BIT(10) -+#define BIT_AGPIO_GPO_8821C BIT(9) -+ -+#define BIT_SHIFT_AGPIO_DRV_8821C 7 -+#define BIT_MASK_AGPIO_DRV_8821C 0x3 -+#define BIT_AGPIO_DRV_8821C(x) \ -+ (((x) & BIT_MASK_AGPIO_DRV_8821C) << BIT_SHIFT_AGPIO_DRV_8821C) -+#define BITS_AGPIO_DRV_8821C \ -+ (BIT_MASK_AGPIO_DRV_8821C << BIT_SHIFT_AGPIO_DRV_8821C) -+#define BIT_CLEAR_AGPIO_DRV_8821C(x) ((x) & (~BITS_AGPIO_DRV_8821C)) -+#define BIT_GET_AGPIO_DRV_8821C(x) \ -+ (((x) >> BIT_SHIFT_AGPIO_DRV_8821C) & BIT_MASK_AGPIO_DRV_8821C) -+#define BIT_SET_AGPIO_DRV_8821C(x, v) \ -+ (BIT_CLEAR_AGPIO_DRV_8821C(x) | BIT_AGPIO_DRV_8821C(v)) -+ -+#define BIT_SHIFT_XTAL_CAP_XO_8821C 1 -+#define BIT_MASK_XTAL_CAP_XO_8821C 0x3f -+#define BIT_XTAL_CAP_XO_8821C(x) \ -+ (((x) & BIT_MASK_XTAL_CAP_XO_8821C) << BIT_SHIFT_XTAL_CAP_XO_8821C) -+#define BITS_XTAL_CAP_XO_8821C \ -+ (BIT_MASK_XTAL_CAP_XO_8821C << BIT_SHIFT_XTAL_CAP_XO_8821C) -+#define BIT_CLEAR_XTAL_CAP_XO_8821C(x) ((x) & (~BITS_XTAL_CAP_XO_8821C)) -+#define BIT_GET_XTAL_CAP_XO_8821C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CAP_XO_8821C) & BIT_MASK_XTAL_CAP_XO_8821C) -+#define BIT_SET_XTAL_CAP_XO_8821C(x, v) \ -+ (BIT_CLEAR_XTAL_CAP_XO_8821C(x) | BIT_XTAL_CAP_XO_8821C(v)) -+ -+#define BIT_POW_PLL_8821C BIT(0) -+ -+/* 2 REG_AFE_CTRL3_8821C */ -+ -+#define BIT_SHIFT_PS_8821C 7 -+#define BIT_MASK_PS_8821C 0x7 -+#define BIT_PS_8821C(x) (((x) & BIT_MASK_PS_8821C) << BIT_SHIFT_PS_8821C) -+#define BITS_PS_8821C (BIT_MASK_PS_8821C << BIT_SHIFT_PS_8821C) -+#define BIT_CLEAR_PS_8821C(x) ((x) & (~BITS_PS_8821C)) -+#define BIT_GET_PS_8821C(x) (((x) >> BIT_SHIFT_PS_8821C) & BIT_MASK_PS_8821C) -+#define BIT_SET_PS_8821C(x, v) (BIT_CLEAR_PS_8821C(x) | BIT_PS_8821C(v)) -+ -+#define BIT_PSEN_8821C BIT(6) -+#define BIT_DOGENB_8821C BIT(5) -+#define BIT_REG_MBIAS_8821C BIT(4) -+ -+#define BIT_SHIFT_REG_R3_V4_8821C 1 -+#define BIT_MASK_REG_R3_V4_8821C 0x7 -+#define BIT_REG_R3_V4_8821C(x) \ -+ (((x) & BIT_MASK_REG_R3_V4_8821C) << BIT_SHIFT_REG_R3_V4_8821C) -+#define BITS_REG_R3_V4_8821C \ -+ (BIT_MASK_REG_R3_V4_8821C << BIT_SHIFT_REG_R3_V4_8821C) -+#define BIT_CLEAR_REG_R3_V4_8821C(x) ((x) & (~BITS_REG_R3_V4_8821C)) -+#define BIT_GET_REG_R3_V4_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_R3_V4_8821C) & BIT_MASK_REG_R3_V4_8821C) -+#define BIT_SET_REG_R3_V4_8821C(x, v) \ -+ (BIT_CLEAR_REG_R3_V4_8821C(x) | BIT_REG_R3_V4_8821C(v)) -+ -+#define BIT_REG_CP_BIT0_8821C BIT(0) -+ -+/* 2 REG_EFUSE_CTRL_8821C */ -+#define BIT_EF_FLAG_8821C BIT(31) -+ -+#define BIT_SHIFT_EF_PGPD_8821C 28 -+#define BIT_MASK_EF_PGPD_8821C 0x7 -+#define BIT_EF_PGPD_8821C(x) \ -+ (((x) & BIT_MASK_EF_PGPD_8821C) << BIT_SHIFT_EF_PGPD_8821C) -+#define BITS_EF_PGPD_8821C (BIT_MASK_EF_PGPD_8821C << BIT_SHIFT_EF_PGPD_8821C) -+#define BIT_CLEAR_EF_PGPD_8821C(x) ((x) & (~BITS_EF_PGPD_8821C)) -+#define BIT_GET_EF_PGPD_8821C(x) \ -+ (((x) >> BIT_SHIFT_EF_PGPD_8821C) & BIT_MASK_EF_PGPD_8821C) -+#define BIT_SET_EF_PGPD_8821C(x, v) \ -+ (BIT_CLEAR_EF_PGPD_8821C(x) | BIT_EF_PGPD_8821C(v)) -+ -+#define BIT_SHIFT_EF_RDT_8821C 24 -+#define BIT_MASK_EF_RDT_8821C 0xf -+#define BIT_EF_RDT_8821C(x) \ -+ (((x) & BIT_MASK_EF_RDT_8821C) << BIT_SHIFT_EF_RDT_8821C) -+#define BITS_EF_RDT_8821C (BIT_MASK_EF_RDT_8821C << BIT_SHIFT_EF_RDT_8821C) -+#define BIT_CLEAR_EF_RDT_8821C(x) ((x) & (~BITS_EF_RDT_8821C)) -+#define BIT_GET_EF_RDT_8821C(x) \ -+ (((x) >> BIT_SHIFT_EF_RDT_8821C) & BIT_MASK_EF_RDT_8821C) -+#define BIT_SET_EF_RDT_8821C(x, v) \ -+ (BIT_CLEAR_EF_RDT_8821C(x) | BIT_EF_RDT_8821C(v)) -+ -+#define BIT_SHIFT_EF_PGTS_8821C 20 -+#define BIT_MASK_EF_PGTS_8821C 0xf -+#define BIT_EF_PGTS_8821C(x) \ -+ (((x) & BIT_MASK_EF_PGTS_8821C) << BIT_SHIFT_EF_PGTS_8821C) -+#define BITS_EF_PGTS_8821C (BIT_MASK_EF_PGTS_8821C << BIT_SHIFT_EF_PGTS_8821C) -+#define BIT_CLEAR_EF_PGTS_8821C(x) ((x) & (~BITS_EF_PGTS_8821C)) -+#define BIT_GET_EF_PGTS_8821C(x) \ -+ (((x) >> BIT_SHIFT_EF_PGTS_8821C) & BIT_MASK_EF_PGTS_8821C) -+#define BIT_SET_EF_PGTS_8821C(x, v) \ -+ (BIT_CLEAR_EF_PGTS_8821C(x) | BIT_EF_PGTS_8821C(v)) -+ -+#define BIT_EF_PDWN_8821C BIT(19) -+#define BIT_EF_ALDEN_8821C BIT(18) -+ -+#define BIT_SHIFT_EF_ADDR_8821C 8 -+#define BIT_MASK_EF_ADDR_8821C 0x3ff -+#define BIT_EF_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_EF_ADDR_8821C) << BIT_SHIFT_EF_ADDR_8821C) -+#define BITS_EF_ADDR_8821C (BIT_MASK_EF_ADDR_8821C << BIT_SHIFT_EF_ADDR_8821C) -+#define BIT_CLEAR_EF_ADDR_8821C(x) ((x) & (~BITS_EF_ADDR_8821C)) -+#define BIT_GET_EF_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_EF_ADDR_8821C) & BIT_MASK_EF_ADDR_8821C) -+#define BIT_SET_EF_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_EF_ADDR_8821C(x) | BIT_EF_ADDR_8821C(v)) -+ -+#define BIT_SHIFT_EF_DATA_8821C 0 -+#define BIT_MASK_EF_DATA_8821C 0xff -+#define BIT_EF_DATA_8821C(x) \ -+ (((x) & BIT_MASK_EF_DATA_8821C) << BIT_SHIFT_EF_DATA_8821C) -+#define BITS_EF_DATA_8821C (BIT_MASK_EF_DATA_8821C << BIT_SHIFT_EF_DATA_8821C) -+#define BIT_CLEAR_EF_DATA_8821C(x) ((x) & (~BITS_EF_DATA_8821C)) -+#define BIT_GET_EF_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_EF_DATA_8821C) & BIT_MASK_EF_DATA_8821C) -+#define BIT_SET_EF_DATA_8821C(x, v) \ -+ (BIT_CLEAR_EF_DATA_8821C(x) | BIT_EF_DATA_8821C(v)) -+ -+/* 2 REG_LDO_EFUSE_CTRL_8821C */ -+#define BIT_LDOE25_EN_8821C BIT(31) -+ -+#define BIT_SHIFT_LDOE25_V12ADJ_L_8821C 27 -+#define BIT_MASK_LDOE25_V12ADJ_L_8821C 0xf -+#define BIT_LDOE25_V12ADJ_L_8821C(x) \ -+ (((x) & BIT_MASK_LDOE25_V12ADJ_L_8821C) \ -+ << BIT_SHIFT_LDOE25_V12ADJ_L_8821C) -+#define BITS_LDOE25_V12ADJ_L_8821C \ -+ (BIT_MASK_LDOE25_V12ADJ_L_8821C << BIT_SHIFT_LDOE25_V12ADJ_L_8821C) -+#define BIT_CLEAR_LDOE25_V12ADJ_L_8821C(x) ((x) & (~BITS_LDOE25_V12ADJ_L_8821C)) -+#define BIT_GET_LDOE25_V12ADJ_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_LDOE25_V12ADJ_L_8821C) & \ -+ BIT_MASK_LDOE25_V12ADJ_L_8821C) -+#define BIT_SET_LDOE25_V12ADJ_L_8821C(x, v) \ -+ (BIT_CLEAR_LDOE25_V12ADJ_L_8821C(x) | BIT_LDOE25_V12ADJ_L_8821C(v)) -+ -+#define BIT_EF_CRES_SEL_8821C BIT(26) -+ -+#define BIT_SHIFT_EF_SCAN_START_V1_8821C 16 -+#define BIT_MASK_EF_SCAN_START_V1_8821C 0x3ff -+#define BIT_EF_SCAN_START_V1_8821C(x) \ -+ (((x) & BIT_MASK_EF_SCAN_START_V1_8821C) \ -+ << BIT_SHIFT_EF_SCAN_START_V1_8821C) -+#define BITS_EF_SCAN_START_V1_8821C \ -+ (BIT_MASK_EF_SCAN_START_V1_8821C << BIT_SHIFT_EF_SCAN_START_V1_8821C) -+#define BIT_CLEAR_EF_SCAN_START_V1_8821C(x) \ -+ ((x) & (~BITS_EF_SCAN_START_V1_8821C)) -+#define BIT_GET_EF_SCAN_START_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_START_V1_8821C) & \ -+ BIT_MASK_EF_SCAN_START_V1_8821C) -+#define BIT_SET_EF_SCAN_START_V1_8821C(x, v) \ -+ (BIT_CLEAR_EF_SCAN_START_V1_8821C(x) | BIT_EF_SCAN_START_V1_8821C(v)) -+ -+#define BIT_SHIFT_EF_SCAN_END_8821C 12 -+#define BIT_MASK_EF_SCAN_END_8821C 0xf -+#define BIT_EF_SCAN_END_8821C(x) \ -+ (((x) & BIT_MASK_EF_SCAN_END_8821C) << BIT_SHIFT_EF_SCAN_END_8821C) -+#define BITS_EF_SCAN_END_8821C \ -+ (BIT_MASK_EF_SCAN_END_8821C << BIT_SHIFT_EF_SCAN_END_8821C) -+#define BIT_CLEAR_EF_SCAN_END_8821C(x) ((x) & (~BITS_EF_SCAN_END_8821C)) -+#define BIT_GET_EF_SCAN_END_8821C(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_END_8821C) & BIT_MASK_EF_SCAN_END_8821C) -+#define BIT_SET_EF_SCAN_END_8821C(x, v) \ -+ (BIT_CLEAR_EF_SCAN_END_8821C(x) | BIT_EF_SCAN_END_8821C(v)) -+ -+#define BIT_EF_PD_DIS_8821C BIT(11) -+ -+#define BIT_SHIFT_EF_CELL_SEL_8821C 8 -+#define BIT_MASK_EF_CELL_SEL_8821C 0x3 -+#define BIT_EF_CELL_SEL_8821C(x) \ -+ (((x) & BIT_MASK_EF_CELL_SEL_8821C) << BIT_SHIFT_EF_CELL_SEL_8821C) -+#define BITS_EF_CELL_SEL_8821C \ -+ (BIT_MASK_EF_CELL_SEL_8821C << BIT_SHIFT_EF_CELL_SEL_8821C) -+#define BIT_CLEAR_EF_CELL_SEL_8821C(x) ((x) & (~BITS_EF_CELL_SEL_8821C)) -+#define BIT_GET_EF_CELL_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_EF_CELL_SEL_8821C) & BIT_MASK_EF_CELL_SEL_8821C) -+#define BIT_SET_EF_CELL_SEL_8821C(x, v) \ -+ (BIT_CLEAR_EF_CELL_SEL_8821C(x) | BIT_EF_CELL_SEL_8821C(v)) -+ -+#define BIT_EF_TRPT_8821C BIT(7) -+ -+#define BIT_SHIFT_EF_TTHD_8821C 0 -+#define BIT_MASK_EF_TTHD_8821C 0x7f -+#define BIT_EF_TTHD_8821C(x) \ -+ (((x) & BIT_MASK_EF_TTHD_8821C) << BIT_SHIFT_EF_TTHD_8821C) -+#define BITS_EF_TTHD_8821C (BIT_MASK_EF_TTHD_8821C << BIT_SHIFT_EF_TTHD_8821C) -+#define BIT_CLEAR_EF_TTHD_8821C(x) ((x) & (~BITS_EF_TTHD_8821C)) -+#define BIT_GET_EF_TTHD_8821C(x) \ -+ (((x) >> BIT_SHIFT_EF_TTHD_8821C) & BIT_MASK_EF_TTHD_8821C) -+#define BIT_SET_EF_TTHD_8821C(x, v) \ -+ (BIT_CLEAR_EF_TTHD_8821C(x) | BIT_EF_TTHD_8821C(v)) -+ -+/* 2 REG_PWR_OPTION_CTRL_8821C */ -+ -+#define BIT_SHIFT_DBG_SEL_V1_8821C 16 -+#define BIT_MASK_DBG_SEL_V1_8821C 0xff -+#define BIT_DBG_SEL_V1_8821C(x) \ -+ (((x) & BIT_MASK_DBG_SEL_V1_8821C) << BIT_SHIFT_DBG_SEL_V1_8821C) -+#define BITS_DBG_SEL_V1_8821C \ -+ (BIT_MASK_DBG_SEL_V1_8821C << BIT_SHIFT_DBG_SEL_V1_8821C) -+#define BIT_CLEAR_DBG_SEL_V1_8821C(x) ((x) & (~BITS_DBG_SEL_V1_8821C)) -+#define BIT_GET_DBG_SEL_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_V1_8821C) & BIT_MASK_DBG_SEL_V1_8821C) -+#define BIT_SET_DBG_SEL_V1_8821C(x, v) \ -+ (BIT_CLEAR_DBG_SEL_V1_8821C(x) | BIT_DBG_SEL_V1_8821C(v)) -+ -+#define BIT_SHIFT_DBG_SEL_BYTE_8821C 14 -+#define BIT_MASK_DBG_SEL_BYTE_8821C 0x3 -+#define BIT_DBG_SEL_BYTE_8821C(x) \ -+ (((x) & BIT_MASK_DBG_SEL_BYTE_8821C) << BIT_SHIFT_DBG_SEL_BYTE_8821C) -+#define BITS_DBG_SEL_BYTE_8821C \ -+ (BIT_MASK_DBG_SEL_BYTE_8821C << BIT_SHIFT_DBG_SEL_BYTE_8821C) -+#define BIT_CLEAR_DBG_SEL_BYTE_8821C(x) ((x) & (~BITS_DBG_SEL_BYTE_8821C)) -+#define BIT_GET_DBG_SEL_BYTE_8821C(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_BYTE_8821C) & BIT_MASK_DBG_SEL_BYTE_8821C) -+#define BIT_SET_DBG_SEL_BYTE_8821C(x, v) \ -+ (BIT_CLEAR_DBG_SEL_BYTE_8821C(x) | BIT_DBG_SEL_BYTE_8821C(v)) -+ -+#define BIT_SHIFT_STD_L1_V1_8821C 12 -+#define BIT_MASK_STD_L1_V1_8821C 0x3 -+#define BIT_STD_L1_V1_8821C(x) \ -+ (((x) & BIT_MASK_STD_L1_V1_8821C) << BIT_SHIFT_STD_L1_V1_8821C) -+#define BITS_STD_L1_V1_8821C \ -+ (BIT_MASK_STD_L1_V1_8821C << BIT_SHIFT_STD_L1_V1_8821C) -+#define BIT_CLEAR_STD_L1_V1_8821C(x) ((x) & (~BITS_STD_L1_V1_8821C)) -+#define BIT_GET_STD_L1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_STD_L1_V1_8821C) & BIT_MASK_STD_L1_V1_8821C) -+#define BIT_SET_STD_L1_V1_8821C(x, v) \ -+ (BIT_CLEAR_STD_L1_V1_8821C(x) | BIT_STD_L1_V1_8821C(v)) -+ -+#define BIT_SYSON_DBG_PAD_E2_8821C BIT(11) -+#define BIT_SYSON_LED_PAD_E2_8821C BIT(10) -+#define BIT_SYSON_GPEE_PAD_E2_8821C BIT(9) -+#define BIT_SYSON_PCI_PAD_E2_8821C BIT(8) -+#define BIT_AUTO_SW_LDO_VOL_EN_8821C BIT(7) -+ -+#define BIT_SHIFT_SYSON_SPS0WWV_WT_8821C 4 -+#define BIT_MASK_SYSON_SPS0WWV_WT_8821C 0x3 -+#define BIT_SYSON_SPS0WWV_WT_8821C(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0WWV_WT_8821C) \ -+ << BIT_SHIFT_SYSON_SPS0WWV_WT_8821C) -+#define BITS_SYSON_SPS0WWV_WT_8821C \ -+ (BIT_MASK_SYSON_SPS0WWV_WT_8821C << BIT_SHIFT_SYSON_SPS0WWV_WT_8821C) -+#define BIT_CLEAR_SYSON_SPS0WWV_WT_8821C(x) \ -+ ((x) & (~BITS_SYSON_SPS0WWV_WT_8821C)) -+#define BIT_GET_SYSON_SPS0WWV_WT_8821C(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0WWV_WT_8821C) & \ -+ BIT_MASK_SYSON_SPS0WWV_WT_8821C) -+#define BIT_SET_SYSON_SPS0WWV_WT_8821C(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0WWV_WT_8821C(x) | BIT_SYSON_SPS0WWV_WT_8821C(v)) -+ -+#define BIT_SHIFT_SYSON_SPS0LDO_WT_8821C 2 -+#define BIT_MASK_SYSON_SPS0LDO_WT_8821C 0x3 -+#define BIT_SYSON_SPS0LDO_WT_8821C(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0LDO_WT_8821C) \ -+ << BIT_SHIFT_SYSON_SPS0LDO_WT_8821C) -+#define BITS_SYSON_SPS0LDO_WT_8821C \ -+ (BIT_MASK_SYSON_SPS0LDO_WT_8821C << BIT_SHIFT_SYSON_SPS0LDO_WT_8821C) -+#define BIT_CLEAR_SYSON_SPS0LDO_WT_8821C(x) \ -+ ((x) & (~BITS_SYSON_SPS0LDO_WT_8821C)) -+#define BIT_GET_SYSON_SPS0LDO_WT_8821C(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0LDO_WT_8821C) & \ -+ BIT_MASK_SYSON_SPS0LDO_WT_8821C) -+#define BIT_SET_SYSON_SPS0LDO_WT_8821C(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0LDO_WT_8821C(x) | BIT_SYSON_SPS0LDO_WT_8821C(v)) -+ -+#define BIT_SHIFT_SYSON_RCLK_SCALE_8821C 0 -+#define BIT_MASK_SYSON_RCLK_SCALE_8821C 0x3 -+#define BIT_SYSON_RCLK_SCALE_8821C(x) \ -+ (((x) & BIT_MASK_SYSON_RCLK_SCALE_8821C) \ -+ << BIT_SHIFT_SYSON_RCLK_SCALE_8821C) -+#define BITS_SYSON_RCLK_SCALE_8821C \ -+ (BIT_MASK_SYSON_RCLK_SCALE_8821C << BIT_SHIFT_SYSON_RCLK_SCALE_8821C) -+#define BIT_CLEAR_SYSON_RCLK_SCALE_8821C(x) \ -+ ((x) & (~BITS_SYSON_RCLK_SCALE_8821C)) -+#define BIT_GET_SYSON_RCLK_SCALE_8821C(x) \ -+ (((x) >> BIT_SHIFT_SYSON_RCLK_SCALE_8821C) & \ -+ BIT_MASK_SYSON_RCLK_SCALE_8821C) -+#define BIT_SET_SYSON_RCLK_SCALE_8821C(x, v) \ -+ (BIT_CLEAR_SYSON_RCLK_SCALE_8821C(x) | BIT_SYSON_RCLK_SCALE_8821C(v)) -+ -+/* 2 REG_CAL_TIMER_8821C */ -+ -+#define BIT_SHIFT_MATCH_CNT_8821C 8 -+#define BIT_MASK_MATCH_CNT_8821C 0xff -+#define BIT_MATCH_CNT_8821C(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8821C) << BIT_SHIFT_MATCH_CNT_8821C) -+#define BITS_MATCH_CNT_8821C \ -+ (BIT_MASK_MATCH_CNT_8821C << BIT_SHIFT_MATCH_CNT_8821C) -+#define BIT_CLEAR_MATCH_CNT_8821C(x) ((x) & (~BITS_MATCH_CNT_8821C)) -+#define BIT_GET_MATCH_CNT_8821C(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8821C) & BIT_MASK_MATCH_CNT_8821C) -+#define BIT_SET_MATCH_CNT_8821C(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8821C(x) | BIT_MATCH_CNT_8821C(v)) -+ -+#define BIT_SHIFT_CAL_SCAL_8821C 0 -+#define BIT_MASK_CAL_SCAL_8821C 0xff -+#define BIT_CAL_SCAL_8821C(x) \ -+ (((x) & BIT_MASK_CAL_SCAL_8821C) << BIT_SHIFT_CAL_SCAL_8821C) -+#define BITS_CAL_SCAL_8821C \ -+ (BIT_MASK_CAL_SCAL_8821C << BIT_SHIFT_CAL_SCAL_8821C) -+#define BIT_CLEAR_CAL_SCAL_8821C(x) ((x) & (~BITS_CAL_SCAL_8821C)) -+#define BIT_GET_CAL_SCAL_8821C(x) \ -+ (((x) >> BIT_SHIFT_CAL_SCAL_8821C) & BIT_MASK_CAL_SCAL_8821C) -+#define BIT_SET_CAL_SCAL_8821C(x, v) \ -+ (BIT_CLEAR_CAL_SCAL_8821C(x) | BIT_CAL_SCAL_8821C(v)) -+ -+/* 2 REG_ACLK_MON_8821C */ -+ -+#define BIT_SHIFT_RCLK_MON_8821C 5 -+#define BIT_MASK_RCLK_MON_8821C 0x7ff -+#define BIT_RCLK_MON_8821C(x) \ -+ (((x) & BIT_MASK_RCLK_MON_8821C) << BIT_SHIFT_RCLK_MON_8821C) -+#define BITS_RCLK_MON_8821C \ -+ (BIT_MASK_RCLK_MON_8821C << BIT_SHIFT_RCLK_MON_8821C) -+#define BIT_CLEAR_RCLK_MON_8821C(x) ((x) & (~BITS_RCLK_MON_8821C)) -+#define BIT_GET_RCLK_MON_8821C(x) \ -+ (((x) >> BIT_SHIFT_RCLK_MON_8821C) & BIT_MASK_RCLK_MON_8821C) -+#define BIT_SET_RCLK_MON_8821C(x, v) \ -+ (BIT_CLEAR_RCLK_MON_8821C(x) | BIT_RCLK_MON_8821C(v)) -+ -+#define BIT_CAL_EN_8821C BIT(4) -+ -+#define BIT_SHIFT_DPSTU_8821C 2 -+#define BIT_MASK_DPSTU_8821C 0x3 -+#define BIT_DPSTU_8821C(x) \ -+ (((x) & BIT_MASK_DPSTU_8821C) << BIT_SHIFT_DPSTU_8821C) -+#define BITS_DPSTU_8821C (BIT_MASK_DPSTU_8821C << BIT_SHIFT_DPSTU_8821C) -+#define BIT_CLEAR_DPSTU_8821C(x) ((x) & (~BITS_DPSTU_8821C)) -+#define BIT_GET_DPSTU_8821C(x) \ -+ (((x) >> BIT_SHIFT_DPSTU_8821C) & BIT_MASK_DPSTU_8821C) -+#define BIT_SET_DPSTU_8821C(x, v) \ -+ (BIT_CLEAR_DPSTU_8821C(x) | BIT_DPSTU_8821C(v)) -+ -+#define BIT_SUS_16X_8821C BIT(1) -+ -+/* 2 REG_GPIO_MUXCFG_8821C */ -+#define BIT_FSPI_EN_8821C BIT(19) -+#define BIT_WL_RTS_EXT_32K_SEL_8821C BIT(18) -+#define BIT_WLGP_SPI_EN_8821C BIT(16) -+#define BIT_SIC_LBK_8821C BIT(15) -+#define BIT_ENHTP_8821C BIT(14) -+#define BIT_ENSIC_8821C BIT(12) -+#define BIT_SIC_SWRST_8821C BIT(11) -+#define BIT_PO_WIFI_PTA_PINS_8821C BIT(10) -+#define BIT_PO_BT_PTA_PINS_8821C BIT(9) -+#define BIT_ENUART_8821C BIT(8) -+ -+#define BIT_SHIFT_BTMODE_8821C 6 -+#define BIT_MASK_BTMODE_8821C 0x3 -+#define BIT_BTMODE_8821C(x) \ -+ (((x) & BIT_MASK_BTMODE_8821C) << BIT_SHIFT_BTMODE_8821C) -+#define BITS_BTMODE_8821C (BIT_MASK_BTMODE_8821C << BIT_SHIFT_BTMODE_8821C) -+#define BIT_CLEAR_BTMODE_8821C(x) ((x) & (~BITS_BTMODE_8821C)) -+#define BIT_GET_BTMODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_BTMODE_8821C) & BIT_MASK_BTMODE_8821C) -+#define BIT_SET_BTMODE_8821C(x, v) \ -+ (BIT_CLEAR_BTMODE_8821C(x) | BIT_BTMODE_8821C(v)) -+ -+#define BIT_ENBT_8821C BIT(5) -+#define BIT_EROM_EN_8821C BIT(4) -+#define BIT_WLRFE_6_7_EN_8821C BIT(3) -+#define BIT_WLRFE_4_5_EN_8821C BIT(2) -+ -+#define BIT_SHIFT_GPIOSEL_8821C 0 -+#define BIT_MASK_GPIOSEL_8821C 0x3 -+#define BIT_GPIOSEL_8821C(x) \ -+ (((x) & BIT_MASK_GPIOSEL_8821C) << BIT_SHIFT_GPIOSEL_8821C) -+#define BITS_GPIOSEL_8821C (BIT_MASK_GPIOSEL_8821C << BIT_SHIFT_GPIOSEL_8821C) -+#define BIT_CLEAR_GPIOSEL_8821C(x) ((x) & (~BITS_GPIOSEL_8821C)) -+#define BIT_GET_GPIOSEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_GPIOSEL_8821C) & BIT_MASK_GPIOSEL_8821C) -+#define BIT_SET_GPIOSEL_8821C(x, v) \ -+ (BIT_CLEAR_GPIOSEL_8821C(x) | BIT_GPIOSEL_8821C(v)) -+ -+/* 2 REG_GPIO_PIN_CTRL_8821C */ -+ -+#define BIT_SHIFT_GPIO_MOD_7_TO_0_8821C 24 -+#define BIT_MASK_GPIO_MOD_7_TO_0_8821C 0xff -+#define BIT_GPIO_MOD_7_TO_0_8821C(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_7_TO_0_8821C) \ -+ << BIT_SHIFT_GPIO_MOD_7_TO_0_8821C) -+#define BITS_GPIO_MOD_7_TO_0_8821C \ -+ (BIT_MASK_GPIO_MOD_7_TO_0_8821C << BIT_SHIFT_GPIO_MOD_7_TO_0_8821C) -+#define BIT_CLEAR_GPIO_MOD_7_TO_0_8821C(x) ((x) & (~BITS_GPIO_MOD_7_TO_0_8821C)) -+#define BIT_GET_GPIO_MOD_7_TO_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_7_TO_0_8821C) & \ -+ BIT_MASK_GPIO_MOD_7_TO_0_8821C) -+#define BIT_SET_GPIO_MOD_7_TO_0_8821C(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_7_TO_0_8821C(x) | BIT_GPIO_MOD_7_TO_0_8821C(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8821C 16 -+#define BIT_MASK_GPIO_IO_SEL_7_TO_0_8821C 0xff -+#define BIT_GPIO_IO_SEL_7_TO_0_8821C(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_7_TO_0_8821C) \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8821C) -+#define BITS_GPIO_IO_SEL_7_TO_0_8821C \ -+ (BIT_MASK_GPIO_IO_SEL_7_TO_0_8821C \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8821C) -+#define BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8821C(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_7_TO_0_8821C)) -+#define BIT_GET_GPIO_IO_SEL_7_TO_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8821C) & \ -+ BIT_MASK_GPIO_IO_SEL_7_TO_0_8821C) -+#define BIT_SET_GPIO_IO_SEL_7_TO_0_8821C(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8821C(x) | \ -+ BIT_GPIO_IO_SEL_7_TO_0_8821C(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_7_TO_0_8821C 8 -+#define BIT_MASK_GPIO_OUT_7_TO_0_8821C 0xff -+#define BIT_GPIO_OUT_7_TO_0_8821C(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_7_TO_0_8821C) \ -+ << BIT_SHIFT_GPIO_OUT_7_TO_0_8821C) -+#define BITS_GPIO_OUT_7_TO_0_8821C \ -+ (BIT_MASK_GPIO_OUT_7_TO_0_8821C << BIT_SHIFT_GPIO_OUT_7_TO_0_8821C) -+#define BIT_CLEAR_GPIO_OUT_7_TO_0_8821C(x) ((x) & (~BITS_GPIO_OUT_7_TO_0_8821C)) -+#define BIT_GET_GPIO_OUT_7_TO_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_7_TO_0_8821C) & \ -+ BIT_MASK_GPIO_OUT_7_TO_0_8821C) -+#define BIT_SET_GPIO_OUT_7_TO_0_8821C(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_7_TO_0_8821C(x) | BIT_GPIO_OUT_7_TO_0_8821C(v)) -+ -+#define BIT_SHIFT_GPIO_IN_7_TO_0_8821C 0 -+#define BIT_MASK_GPIO_IN_7_TO_0_8821C 0xff -+#define BIT_GPIO_IN_7_TO_0_8821C(x) \ -+ (((x) & BIT_MASK_GPIO_IN_7_TO_0_8821C) \ -+ << BIT_SHIFT_GPIO_IN_7_TO_0_8821C) -+#define BITS_GPIO_IN_7_TO_0_8821C \ -+ (BIT_MASK_GPIO_IN_7_TO_0_8821C << BIT_SHIFT_GPIO_IN_7_TO_0_8821C) -+#define BIT_CLEAR_GPIO_IN_7_TO_0_8821C(x) ((x) & (~BITS_GPIO_IN_7_TO_0_8821C)) -+#define BIT_GET_GPIO_IN_7_TO_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_7_TO_0_8821C) & \ -+ BIT_MASK_GPIO_IN_7_TO_0_8821C) -+#define BIT_SET_GPIO_IN_7_TO_0_8821C(x, v) \ -+ (BIT_CLEAR_GPIO_IN_7_TO_0_8821C(x) | BIT_GPIO_IN_7_TO_0_8821C(v)) -+ -+/* 2 REG_GPIO_INTM_8821C */ -+ -+#define BIT_SHIFT_MUXDBG_SEL_8821C 30 -+#define BIT_MASK_MUXDBG_SEL_8821C 0x3 -+#define BIT_MUXDBG_SEL_8821C(x) \ -+ (((x) & BIT_MASK_MUXDBG_SEL_8821C) << BIT_SHIFT_MUXDBG_SEL_8821C) -+#define BITS_MUXDBG_SEL_8821C \ -+ (BIT_MASK_MUXDBG_SEL_8821C << BIT_SHIFT_MUXDBG_SEL_8821C) -+#define BIT_CLEAR_MUXDBG_SEL_8821C(x) ((x) & (~BITS_MUXDBG_SEL_8821C)) -+#define BIT_GET_MUXDBG_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_MUXDBG_SEL_8821C) & BIT_MASK_MUXDBG_SEL_8821C) -+#define BIT_SET_MUXDBG_SEL_8821C(x, v) \ -+ (BIT_CLEAR_MUXDBG_SEL_8821C(x) | BIT_MUXDBG_SEL_8821C(v)) -+ -+#define BIT_EXTWOL_SEL_8821C BIT(17) -+#define BIT_EXTWOL_EN_8821C BIT(16) -+#define BIT_GPIOF_INT_MD_8821C BIT(15) -+#define BIT_GPIOE_INT_MD_8821C BIT(14) -+#define BIT_GPIOD_INT_MD_8821C BIT(13) -+#define BIT_GPIOF_INT_MD_8821C BIT(15) -+#define BIT_GPIOE_INT_MD_8821C BIT(14) -+#define BIT_GPIOD_INT_MD_8821C BIT(13) -+#define BIT_GPIOC_INT_MD_8821C BIT(12) -+#define BIT_GPIOB_INT_MD_8821C BIT(11) -+#define BIT_GPIOA_INT_MD_8821C BIT(10) -+#define BIT_GPIO9_INT_MD_8821C BIT(9) -+#define BIT_GPIO8_INT_MD_8821C BIT(8) -+#define BIT_GPIO7_INT_MD_8821C BIT(7) -+#define BIT_GPIO6_INT_MD_8821C BIT(6) -+#define BIT_GPIO5_INT_MD_8821C BIT(5) -+#define BIT_GPIO4_INT_MD_8821C BIT(4) -+#define BIT_GPIO3_INT_MD_8821C BIT(3) -+#define BIT_GPIO2_INT_MD_8821C BIT(2) -+#define BIT_GPIO1_INT_MD_8821C BIT(1) -+#define BIT_GPIO0_INT_MD_8821C BIT(0) -+ -+/* 2 REG_LED_CFG_8821C */ -+#define BIT_GPIO3_WL_CTRL_EN_8821C BIT(27) -+#define BIT_LNAON_SEL_EN_8821C BIT(26) -+#define BIT_PAPE_SEL_EN_8821C BIT(25) -+#define BIT_DPDT_WLBT_SEL_8821C BIT(24) -+#define BIT_DPDT_SEL_EN_8821C BIT(23) -+#define BIT_GPIO13_14_WL_CTRL_EN_8821C BIT(22) -+#define BIT_LED2DIS_8821C BIT(21) -+#define BIT_LED2PL_8821C BIT(20) -+#define BIT_LED2SV_8821C BIT(19) -+ -+#define BIT_SHIFT_LED2CM_8821C 16 -+#define BIT_MASK_LED2CM_8821C 0x7 -+#define BIT_LED2CM_8821C(x) \ -+ (((x) & BIT_MASK_LED2CM_8821C) << BIT_SHIFT_LED2CM_8821C) -+#define BITS_LED2CM_8821C (BIT_MASK_LED2CM_8821C << BIT_SHIFT_LED2CM_8821C) -+#define BIT_CLEAR_LED2CM_8821C(x) ((x) & (~BITS_LED2CM_8821C)) -+#define BIT_GET_LED2CM_8821C(x) \ -+ (((x) >> BIT_SHIFT_LED2CM_8821C) & BIT_MASK_LED2CM_8821C) -+#define BIT_SET_LED2CM_8821C(x, v) \ -+ (BIT_CLEAR_LED2CM_8821C(x) | BIT_LED2CM_8821C(v)) -+ -+#define BIT_LED1DIS_8821C BIT(15) -+#define BIT_LED1PL_8821C BIT(12) -+#define BIT_LED1SV_8821C BIT(11) -+ -+#define BIT_SHIFT_LED1CM_8821C 8 -+#define BIT_MASK_LED1CM_8821C 0x7 -+#define BIT_LED1CM_8821C(x) \ -+ (((x) & BIT_MASK_LED1CM_8821C) << BIT_SHIFT_LED1CM_8821C) -+#define BITS_LED1CM_8821C (BIT_MASK_LED1CM_8821C << BIT_SHIFT_LED1CM_8821C) -+#define BIT_CLEAR_LED1CM_8821C(x) ((x) & (~BITS_LED1CM_8821C)) -+#define BIT_GET_LED1CM_8821C(x) \ -+ (((x) >> BIT_SHIFT_LED1CM_8821C) & BIT_MASK_LED1CM_8821C) -+#define BIT_SET_LED1CM_8821C(x, v) \ -+ (BIT_CLEAR_LED1CM_8821C(x) | BIT_LED1CM_8821C(v)) -+ -+#define BIT_LED0DIS_8821C BIT(7) -+ -+#define BIT_SHIFT_AFE_LDO_SWR_CHECK_8821C 5 -+#define BIT_MASK_AFE_LDO_SWR_CHECK_8821C 0x3 -+#define BIT_AFE_LDO_SWR_CHECK_8821C(x) \ -+ (((x) & BIT_MASK_AFE_LDO_SWR_CHECK_8821C) \ -+ << BIT_SHIFT_AFE_LDO_SWR_CHECK_8821C) -+#define BITS_AFE_LDO_SWR_CHECK_8821C \ -+ (BIT_MASK_AFE_LDO_SWR_CHECK_8821C << BIT_SHIFT_AFE_LDO_SWR_CHECK_8821C) -+#define BIT_CLEAR_AFE_LDO_SWR_CHECK_8821C(x) \ -+ ((x) & (~BITS_AFE_LDO_SWR_CHECK_8821C)) -+#define BIT_GET_AFE_LDO_SWR_CHECK_8821C(x) \ -+ (((x) >> BIT_SHIFT_AFE_LDO_SWR_CHECK_8821C) & \ -+ BIT_MASK_AFE_LDO_SWR_CHECK_8821C) -+#define BIT_SET_AFE_LDO_SWR_CHECK_8821C(x, v) \ -+ (BIT_CLEAR_AFE_LDO_SWR_CHECK_8821C(x) | BIT_AFE_LDO_SWR_CHECK_8821C(v)) -+ -+#define BIT_LED0PL_8821C BIT(4) -+#define BIT_LED0SV_8821C BIT(3) -+ -+#define BIT_SHIFT_LED0CM_8821C 0 -+#define BIT_MASK_LED0CM_8821C 0x7 -+#define BIT_LED0CM_8821C(x) \ -+ (((x) & BIT_MASK_LED0CM_8821C) << BIT_SHIFT_LED0CM_8821C) -+#define BITS_LED0CM_8821C (BIT_MASK_LED0CM_8821C << BIT_SHIFT_LED0CM_8821C) -+#define BIT_CLEAR_LED0CM_8821C(x) ((x) & (~BITS_LED0CM_8821C)) -+#define BIT_GET_LED0CM_8821C(x) \ -+ (((x) >> BIT_SHIFT_LED0CM_8821C) & BIT_MASK_LED0CM_8821C) -+#define BIT_SET_LED0CM_8821C(x, v) \ -+ (BIT_CLEAR_LED0CM_8821C(x) | BIT_LED0CM_8821C(v)) -+ -+/* 2 REG_FSIMR_8821C */ -+#define BIT_FS_PDNINT_EN_8821C BIT(31) -+#define BIT_NFC_INT_PAD_EN_8821C BIT(30) -+#define BIT_FS_SPS_OCP_INT_EN_8821C BIT(29) -+#define BIT_FS_PWMERR_INT_EN_8821C BIT(28) -+#define BIT_FS_GPIOF_INT_EN_8821C BIT(27) -+#define BIT_FS_GPIOE_INT_EN_8821C BIT(26) -+#define BIT_FS_GPIOD_INT_EN_8821C BIT(25) -+#define BIT_FS_GPIOC_INT_EN_8821C BIT(24) -+#define BIT_FS_GPIOB_INT_EN_8821C BIT(23) -+#define BIT_FS_GPIOA_INT_EN_8821C BIT(22) -+#define BIT_FS_GPIO9_INT_EN_8821C BIT(21) -+#define BIT_FS_GPIO8_INT_EN_8821C BIT(20) -+#define BIT_FS_GPIO7_INT_EN_8821C BIT(19) -+#define BIT_FS_GPIO6_INT_EN_8821C BIT(18) -+#define BIT_FS_GPIO5_INT_EN_8821C BIT(17) -+#define BIT_FS_GPIO4_INT_EN_8821C BIT(16) -+#define BIT_FS_GPIO3_INT_EN_8821C BIT(15) -+#define BIT_FS_GPIO2_INT_EN_8821C BIT(14) -+#define BIT_FS_GPIO1_INT_EN_8821C BIT(13) -+#define BIT_FS_GPIO0_INT_EN_8821C BIT(12) -+#define BIT_FS_HCI_SUS_EN_8821C BIT(11) -+#define BIT_FS_HCI_RES_EN_8821C BIT(10) -+#define BIT_FS_HCI_RESET_EN_8821C BIT(9) -+#define BIT_USB_SCSI_CMD_EN_8821C BIT(8) -+#define BIT_FS_BTON_STS_UPDATE_MSK_EN_8821C BIT(7) -+#define BIT_ACT2RECOVERY_INT_EN_V1_8821C BIT(6) -+#define BIT_GEN1GEN2_SWITCH_8821C BIT(5) -+#define BIT_HCI_TXDMA_REQ_HIMR_8821C BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_MAK_8821C BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_MAK_8821C BIT(2) -+#define BIT_FS_USB_LPMRSM_MSK_8821C BIT(1) -+#define BIT_FS_USB_LPMINT_MSK_8821C BIT(0) -+ -+/* 2 REG_FSISR_8821C */ -+#define BIT_FS_PDNINT_8821C BIT(31) -+#define BIT_FS_SPS_OCP_INT_8821C BIT(29) -+#define BIT_FS_PWMERR_INT_8821C BIT(28) -+#define BIT_FS_GPIOF_INT_8821C BIT(27) -+#define BIT_FS_GPIOE_INT_8821C BIT(26) -+#define BIT_FS_GPIOD_INT_8821C BIT(25) -+#define BIT_FS_GPIOC_INT_8821C BIT(24) -+#define BIT_FS_GPIOB_INT_8821C BIT(23) -+#define BIT_FS_GPIOA_INT_8821C BIT(22) -+#define BIT_FS_GPIO9_INT_8821C BIT(21) -+#define BIT_FS_GPIO8_INT_8821C BIT(20) -+#define BIT_FS_GPIO7_INT_8821C BIT(19) -+#define BIT_FS_GPIO6_INT_8821C BIT(18) -+#define BIT_FS_GPIO5_INT_8821C BIT(17) -+#define BIT_FS_GPIO4_INT_8821C BIT(16) -+#define BIT_FS_GPIO3_INT_8821C BIT(15) -+#define BIT_FS_GPIO2_INT_8821C BIT(14) -+#define BIT_FS_GPIO1_INT_8821C BIT(13) -+#define BIT_FS_GPIO0_INT_8821C BIT(12) -+#define BIT_FS_HCI_SUS_INT_8821C BIT(11) -+#define BIT_FS_HCI_RES_INT_8821C BIT(10) -+#define BIT_FS_HCI_RESET_INT_8821C BIT(9) -+#define BIT_USB_SCSI_CMD_INT_8821C BIT(8) -+#define BIT_ACT2RECOVERY_8821C BIT(6) -+#define BIT_GEN1GEN2_SWITCH_8821C BIT(5) -+#define BIT_HCI_TXDMA_REQ_HISR_8821C BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_INT_8821C BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_INT_8821C BIT(2) -+#define BIT_FS_USB_LPMRSM_INT_8821C BIT(1) -+#define BIT_FS_USB_LPMINT_INT_8821C BIT(0) -+ -+/* 2 REG_HSIMR_8821C */ -+#define BIT_GPIOF_INT_EN_8821C BIT(31) -+#define BIT_GPIOE_INT_EN_8821C BIT(30) -+#define BIT_GPIOD_INT_EN_8821C BIT(29) -+#define BIT_GPIOC_INT_EN_8821C BIT(28) -+#define BIT_GPIOB_INT_EN_8821C BIT(27) -+#define BIT_GPIOA_INT_EN_8821C BIT(26) -+#define BIT_GPIO9_INT_EN_8821C BIT(25) -+#define BIT_GPIO8_INT_EN_8821C BIT(24) -+#define BIT_GPIO7_INT_EN_8821C BIT(23) -+#define BIT_GPIO6_INT_EN_8821C BIT(22) -+#define BIT_GPIO5_INT_EN_8821C BIT(21) -+#define BIT_GPIO4_INT_EN_8821C BIT(20) -+#define BIT_GPIO3_INT_EN_8821C BIT(19) -+#define BIT_GPIO2_INT_EN_V1_8821C BIT(18) -+#define BIT_GPIO1_INT_EN_8821C BIT(17) -+#define BIT_GPIO0_INT_EN_8821C BIT(16) -+#define BIT_PDNINT_EN_8821C BIT(7) -+#define BIT_RON_INT_EN_8821C BIT(6) -+#define BIT_SPS_OCP_INT_EN_8821C BIT(5) -+#define BIT_GPIO15_0_INT_EN_8821C BIT(0) -+ -+/* 2 REG_HSISR_8821C */ -+#define BIT_GPIOF_INT_8821C BIT(31) -+#define BIT_GPIOE_INT_8821C BIT(30) -+#define BIT_GPIOD_INT_8821C BIT(29) -+#define BIT_GPIOC_INT_8821C BIT(28) -+#define BIT_GPIOB_INT_8821C BIT(27) -+#define BIT_GPIOA_INT_8821C BIT(26) -+#define BIT_GPIO9_INT_8821C BIT(25) -+#define BIT_GPIO8_INT_8821C BIT(24) -+#define BIT_GPIO7_INT_8821C BIT(23) -+#define BIT_GPIO6_INT_8821C BIT(22) -+#define BIT_GPIO5_INT_8821C BIT(21) -+#define BIT_GPIO4_INT_8821C BIT(20) -+#define BIT_GPIO3_INT_8821C BIT(19) -+#define BIT_GPIO2_INT_V1_8821C BIT(18) -+#define BIT_GPIO1_INT_8821C BIT(17) -+#define BIT_GPIO0_INT_8821C BIT(16) -+#define BIT_PDNINT_8821C BIT(7) -+#define BIT_RON_INT_8821C BIT(6) -+#define BIT_SPS_OCP_INT_8821C BIT(5) -+#define BIT_GPIO15_0_INT_8821C BIT(0) -+ -+/* 2 REG_GPIO_EXT_CTRL_8821C */ -+ -+#define BIT_SHIFT_GPIO_MOD_15_TO_8_8821C 24 -+#define BIT_MASK_GPIO_MOD_15_TO_8_8821C 0xff -+#define BIT_GPIO_MOD_15_TO_8_8821C(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_15_TO_8_8821C) \ -+ << BIT_SHIFT_GPIO_MOD_15_TO_8_8821C) -+#define BITS_GPIO_MOD_15_TO_8_8821C \ -+ (BIT_MASK_GPIO_MOD_15_TO_8_8821C << BIT_SHIFT_GPIO_MOD_15_TO_8_8821C) -+#define BIT_CLEAR_GPIO_MOD_15_TO_8_8821C(x) \ -+ ((x) & (~BITS_GPIO_MOD_15_TO_8_8821C)) -+#define BIT_GET_GPIO_MOD_15_TO_8_8821C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_15_TO_8_8821C) & \ -+ BIT_MASK_GPIO_MOD_15_TO_8_8821C) -+#define BIT_SET_GPIO_MOD_15_TO_8_8821C(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_15_TO_8_8821C(x) | BIT_GPIO_MOD_15_TO_8_8821C(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8821C 16 -+#define BIT_MASK_GPIO_IO_SEL_15_TO_8_8821C 0xff -+#define BIT_GPIO_IO_SEL_15_TO_8_8821C(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_15_TO_8_8821C) \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8821C) -+#define BITS_GPIO_IO_SEL_15_TO_8_8821C \ -+ (BIT_MASK_GPIO_IO_SEL_15_TO_8_8821C \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8821C) -+#define BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8821C(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_15_TO_8_8821C)) -+#define BIT_GET_GPIO_IO_SEL_15_TO_8_8821C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8821C) & \ -+ BIT_MASK_GPIO_IO_SEL_15_TO_8_8821C) -+#define BIT_SET_GPIO_IO_SEL_15_TO_8_8821C(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8821C(x) | \ -+ BIT_GPIO_IO_SEL_15_TO_8_8821C(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_15_TO_8_8821C 8 -+#define BIT_MASK_GPIO_OUT_15_TO_8_8821C 0xff -+#define BIT_GPIO_OUT_15_TO_8_8821C(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_15_TO_8_8821C) \ -+ << BIT_SHIFT_GPIO_OUT_15_TO_8_8821C) -+#define BITS_GPIO_OUT_15_TO_8_8821C \ -+ (BIT_MASK_GPIO_OUT_15_TO_8_8821C << BIT_SHIFT_GPIO_OUT_15_TO_8_8821C) -+#define BIT_CLEAR_GPIO_OUT_15_TO_8_8821C(x) \ -+ ((x) & (~BITS_GPIO_OUT_15_TO_8_8821C)) -+#define BIT_GET_GPIO_OUT_15_TO_8_8821C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_15_TO_8_8821C) & \ -+ BIT_MASK_GPIO_OUT_15_TO_8_8821C) -+#define BIT_SET_GPIO_OUT_15_TO_8_8821C(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_15_TO_8_8821C(x) | BIT_GPIO_OUT_15_TO_8_8821C(v)) -+ -+#define BIT_SHIFT_GPIO_IN_15_TO_8_8821C 0 -+#define BIT_MASK_GPIO_IN_15_TO_8_8821C 0xff -+#define BIT_GPIO_IN_15_TO_8_8821C(x) \ -+ (((x) & BIT_MASK_GPIO_IN_15_TO_8_8821C) \ -+ << BIT_SHIFT_GPIO_IN_15_TO_8_8821C) -+#define BITS_GPIO_IN_15_TO_8_8821C \ -+ (BIT_MASK_GPIO_IN_15_TO_8_8821C << BIT_SHIFT_GPIO_IN_15_TO_8_8821C) -+#define BIT_CLEAR_GPIO_IN_15_TO_8_8821C(x) ((x) & (~BITS_GPIO_IN_15_TO_8_8821C)) -+#define BIT_GET_GPIO_IN_15_TO_8_8821C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_15_TO_8_8821C) & \ -+ BIT_MASK_GPIO_IN_15_TO_8_8821C) -+#define BIT_SET_GPIO_IN_15_TO_8_8821C(x, v) \ -+ (BIT_CLEAR_GPIO_IN_15_TO_8_8821C(x) | BIT_GPIO_IN_15_TO_8_8821C(v)) -+ -+/* 2 REG_PAD_CTRL1_8821C */ -+#define BIT_PAPE_WLBT_SEL_8821C BIT(29) -+#define BIT_LNAON_WLBT_SEL_8821C BIT(28) -+#define BIT_BTGP_GPG3_FEN_8821C BIT(26) -+#define BIT_BTGP_GPG2_FEN_8821C BIT(25) -+#define BIT_BTGP_JTAG_EN_8821C BIT(24) -+#define BIT_XTAL_CLK_EXTARNAL_EN_8821C BIT(23) -+#define BIT_BTGP_UART0_EN_8821C BIT(22) -+#define BIT_BTGP_UART1_EN_8821C BIT(21) -+#define BIT_BTGP_SPI_EN_8821C BIT(20) -+#define BIT_BTGP_GPIO_E2_8821C BIT(19) -+#define BIT_BTGP_GPIO_EN_8821C BIT(18) -+ -+#define BIT_SHIFT_BTGP_GPIO_SL_8821C 16 -+#define BIT_MASK_BTGP_GPIO_SL_8821C 0x3 -+#define BIT_BTGP_GPIO_SL_8821C(x) \ -+ (((x) & BIT_MASK_BTGP_GPIO_SL_8821C) << BIT_SHIFT_BTGP_GPIO_SL_8821C) -+#define BITS_BTGP_GPIO_SL_8821C \ -+ (BIT_MASK_BTGP_GPIO_SL_8821C << BIT_SHIFT_BTGP_GPIO_SL_8821C) -+#define BIT_CLEAR_BTGP_GPIO_SL_8821C(x) ((x) & (~BITS_BTGP_GPIO_SL_8821C)) -+#define BIT_GET_BTGP_GPIO_SL_8821C(x) \ -+ (((x) >> BIT_SHIFT_BTGP_GPIO_SL_8821C) & BIT_MASK_BTGP_GPIO_SL_8821C) -+#define BIT_SET_BTGP_GPIO_SL_8821C(x, v) \ -+ (BIT_CLEAR_BTGP_GPIO_SL_8821C(x) | BIT_BTGP_GPIO_SL_8821C(v)) -+ -+#define BIT_PAD_SDIO_SR_8821C BIT(14) -+#define BIT_GPIO14_OUTPUT_PL_8821C BIT(13) -+#define BIT_HOST_WAKE_PAD_PULL_EN_8821C BIT(12) -+#define BIT_HOST_WAKE_PAD_SL_8821C BIT(11) -+#define BIT_PAD_LNAON_SR_8821C BIT(10) -+#define BIT_PAD_LNAON_E2_8821C BIT(9) -+#define BIT_SW_LNAON_G_SEL_DATA_8821C BIT(8) -+#define BIT_SW_LNAON_A_SEL_DATA_8821C BIT(7) -+#define BIT_PAD_PAPE_SR_8821C BIT(6) -+#define BIT_PAD_PAPE_E2_8821C BIT(5) -+#define BIT_SW_PAPE_G_SEL_DATA_8821C BIT(4) -+#define BIT_SW_PAPE_A_SEL_DATA_8821C BIT(3) -+#define BIT_PAD_DPDT_SR_8821C BIT(2) -+#define BIT_PAD_DPDT_PAD_E2_8821C BIT(1) -+#define BIT_SW_DPDT_SEL_DATA_8821C BIT(0) -+ -+/* 2 REG_WL_BT_PWR_CTRL_8821C */ -+#define BIT_ISO_BD2PP_8821C BIT(31) -+#define BIT_LDOV12B_EN_8821C BIT(30) -+#define BIT_CKEN_BTGPS_8821C BIT(29) -+#define BIT_FEN_BTGPS_8821C BIT(28) -+#define BIT_BTCPU_BOOTSEL_8821C BIT(27) -+#define BIT_SPI_SPEEDUP_8821C BIT(26) -+#define BIT_DEVWAKE_PAD_TYPE_SEL_8821C BIT(24) -+#define BIT_CLKREQ_PAD_TYPE_SEL_8821C BIT(23) -+#define BIT_ISO_BTPON2PP_8821C BIT(22) -+#define BIT_BT_HWROF_EN_8821C BIT(19) -+#define BIT_BT_FUNC_EN_8821C BIT(18) -+#define BIT_BT_HWPDN_SL_8821C BIT(17) -+#define BIT_BT_DISN_EN_8821C BIT(16) -+#define BIT_BT_PDN_PULL_EN_8821C BIT(15) -+#define BIT_WL_PDN_PULL_EN_8821C BIT(14) -+#define BIT_EXTERNAL_REQUEST_PL_8821C BIT(13) -+#define BIT_GPIO0_2_3_PULL_LOW_EN_8821C BIT(12) -+#define BIT_ISO_BA2PP_8821C BIT(11) -+#define BIT_BT_AFE_LDO_EN_8821C BIT(10) -+#define BIT_BT_AFE_PLL_EN_8821C BIT(9) -+#define BIT_BT_DIG_CLK_EN_8821C BIT(8) -+#define BIT_WL_DRV_EXIST_IDX_8821C BIT(5) -+#define BIT_DOP_EHPAD_8821C BIT(4) -+#define BIT_WL_HWROF_EN_8821C BIT(3) -+#define BIT_WL_FUNC_EN_8821C BIT(2) -+#define BIT_WL_HWPDN_SL_8821C BIT(1) -+#define BIT_WL_HWPDN_EN_8821C BIT(0) -+ -+/* 2 REG_SDM_DEBUG_8821C */ -+ -+#define BIT_SHIFT_WLCLK_PHASE_8821C 0 -+#define BIT_MASK_WLCLK_PHASE_8821C 0x1f -+#define BIT_WLCLK_PHASE_8821C(x) \ -+ (((x) & BIT_MASK_WLCLK_PHASE_8821C) << BIT_SHIFT_WLCLK_PHASE_8821C) -+#define BITS_WLCLK_PHASE_8821C \ -+ (BIT_MASK_WLCLK_PHASE_8821C << BIT_SHIFT_WLCLK_PHASE_8821C) -+#define BIT_CLEAR_WLCLK_PHASE_8821C(x) ((x) & (~BITS_WLCLK_PHASE_8821C)) -+#define BIT_GET_WLCLK_PHASE_8821C(x) \ -+ (((x) >> BIT_SHIFT_WLCLK_PHASE_8821C) & BIT_MASK_WLCLK_PHASE_8821C) -+#define BIT_SET_WLCLK_PHASE_8821C(x, v) \ -+ (BIT_CLEAR_WLCLK_PHASE_8821C(x) | BIT_WLCLK_PHASE_8821C(v)) -+ -+/* 2 REG_SYS_SDIO_CTRL_8821C */ -+#define BIT_DBG_GNT_WL_BT_8821C BIT(27) -+#define BIT_LTE_MUX_CTRL_PATH_8821C BIT(26) -+#define BIT_LTE_COEX_UART_8821C BIT(25) -+#define BIT_3W_LTE_WL_GPIO_8821C BIT(24) -+#define BIT_SDIO_INT_POLARITY_8821C BIT(19) -+#define BIT_SDIO_INT_8821C BIT(18) -+#define BIT_SDIO_OFF_EN_8821C BIT(17) -+#define BIT_SDIO_ON_EN_8821C BIT(16) -+#define BIT_PCIE_WAIT_TIMEOUT_EVENT_8821C BIT(10) -+#define BIT_PCIE_WAIT_TIME_8821C BIT(9) -+#define BIT_MPCIE_REFCLK_XTAL_SEL_8821C BIT(8) -+#define BIT_RES_USB_MASS_STORAGE_DESC_8821C BIT(1) -+#define BIT_USB_WAIT_TIME_8821C BIT(0) -+ -+/* 2 REG_HCI_OPT_CTRL_8821C */ -+ -+#define BIT_SHIFT_TSFT_SEL_8821C 29 -+#define BIT_MASK_TSFT_SEL_8821C 0x7 -+#define BIT_TSFT_SEL_8821C(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_8821C) << BIT_SHIFT_TSFT_SEL_8821C) -+#define BITS_TSFT_SEL_8821C \ -+ (BIT_MASK_TSFT_SEL_8821C << BIT_SHIFT_TSFT_SEL_8821C) -+#define BIT_CLEAR_TSFT_SEL_8821C(x) ((x) & (~BITS_TSFT_SEL_8821C)) -+#define BIT_GET_TSFT_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_8821C) & BIT_MASK_TSFT_SEL_8821C) -+#define BIT_SET_TSFT_SEL_8821C(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_8821C(x) | BIT_TSFT_SEL_8821C(v)) -+ -+#define BIT_SDIO_PAD_E5_8821C BIT(18) -+#define BIT_USB_HOST_PWR_OFF_EN_8821C BIT(12) -+#define BIT_SYM_LPS_BLOCK_EN_8821C BIT(11) -+#define BIT_USB_LPM_ACT_EN_8821C BIT(10) -+#define BIT_USB_LPM_NY_8821C BIT(9) -+#define BIT_USB_SUS_DIS_8821C BIT(8) -+ -+#define BIT_SHIFT_SDIO_PAD_E_8821C 5 -+#define BIT_MASK_SDIO_PAD_E_8821C 0x7 -+#define BIT_SDIO_PAD_E_8821C(x) \ -+ (((x) & BIT_MASK_SDIO_PAD_E_8821C) << BIT_SHIFT_SDIO_PAD_E_8821C) -+#define BITS_SDIO_PAD_E_8821C \ -+ (BIT_MASK_SDIO_PAD_E_8821C << BIT_SHIFT_SDIO_PAD_E_8821C) -+#define BIT_CLEAR_SDIO_PAD_E_8821C(x) ((x) & (~BITS_SDIO_PAD_E_8821C)) -+#define BIT_GET_SDIO_PAD_E_8821C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_PAD_E_8821C) & BIT_MASK_SDIO_PAD_E_8821C) -+#define BIT_SET_SDIO_PAD_E_8821C(x, v) \ -+ (BIT_CLEAR_SDIO_PAD_E_8821C(x) | BIT_SDIO_PAD_E_8821C(v)) -+ -+#define BIT_USB_LPPLL_EN_8821C BIT(4) -+#define BIT_ROP_SW15_8821C BIT(2) -+#define BIT_PCI_CKRDY_OPT_8821C BIT(1) -+#define BIT_PCI_VAUX_EN_8821C BIT(0) -+ -+/* 2 REG_AFE_CTRL4_8821C */ -+ -+/* 2 REG_LDO_SWR_CTRL_8821C */ -+#define BIT_ZCD_HW_AUTO_EN_8821C BIT(27) -+#define BIT_ZCD_REGSEL_8821C BIT(26) -+ -+#define BIT_SHIFT_AUTO_ZCD_IN_CODE_8821C 21 -+#define BIT_MASK_AUTO_ZCD_IN_CODE_8821C 0x1f -+#define BIT_AUTO_ZCD_IN_CODE_8821C(x) \ -+ (((x) & BIT_MASK_AUTO_ZCD_IN_CODE_8821C) \ -+ << BIT_SHIFT_AUTO_ZCD_IN_CODE_8821C) -+#define BITS_AUTO_ZCD_IN_CODE_8821C \ -+ (BIT_MASK_AUTO_ZCD_IN_CODE_8821C << BIT_SHIFT_AUTO_ZCD_IN_CODE_8821C) -+#define BIT_CLEAR_AUTO_ZCD_IN_CODE_8821C(x) \ -+ ((x) & (~BITS_AUTO_ZCD_IN_CODE_8821C)) -+#define BIT_GET_AUTO_ZCD_IN_CODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_AUTO_ZCD_IN_CODE_8821C) & \ -+ BIT_MASK_AUTO_ZCD_IN_CODE_8821C) -+#define BIT_SET_AUTO_ZCD_IN_CODE_8821C(x, v) \ -+ (BIT_CLEAR_AUTO_ZCD_IN_CODE_8821C(x) | BIT_AUTO_ZCD_IN_CODE_8821C(v)) -+ -+#define BIT_SHIFT_ZCD_CODE_IN_L_8821C 16 -+#define BIT_MASK_ZCD_CODE_IN_L_8821C 0x1f -+#define BIT_ZCD_CODE_IN_L_8821C(x) \ -+ (((x) & BIT_MASK_ZCD_CODE_IN_L_8821C) << BIT_SHIFT_ZCD_CODE_IN_L_8821C) -+#define BITS_ZCD_CODE_IN_L_8821C \ -+ (BIT_MASK_ZCD_CODE_IN_L_8821C << BIT_SHIFT_ZCD_CODE_IN_L_8821C) -+#define BIT_CLEAR_ZCD_CODE_IN_L_8821C(x) ((x) & (~BITS_ZCD_CODE_IN_L_8821C)) -+#define BIT_GET_ZCD_CODE_IN_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_ZCD_CODE_IN_L_8821C) & BIT_MASK_ZCD_CODE_IN_L_8821C) -+#define BIT_SET_ZCD_CODE_IN_L_8821C(x, v) \ -+ (BIT_CLEAR_ZCD_CODE_IN_L_8821C(x) | BIT_ZCD_CODE_IN_L_8821C(v)) -+ -+#define BIT_SHIFT_LDO_HV5_DUMMY_8821C 14 -+#define BIT_MASK_LDO_HV5_DUMMY_8821C 0x3 -+#define BIT_LDO_HV5_DUMMY_8821C(x) \ -+ (((x) & BIT_MASK_LDO_HV5_DUMMY_8821C) << BIT_SHIFT_LDO_HV5_DUMMY_8821C) -+#define BITS_LDO_HV5_DUMMY_8821C \ -+ (BIT_MASK_LDO_HV5_DUMMY_8821C << BIT_SHIFT_LDO_HV5_DUMMY_8821C) -+#define BIT_CLEAR_LDO_HV5_DUMMY_8821C(x) ((x) & (~BITS_LDO_HV5_DUMMY_8821C)) -+#define BIT_GET_LDO_HV5_DUMMY_8821C(x) \ -+ (((x) >> BIT_SHIFT_LDO_HV5_DUMMY_8821C) & BIT_MASK_LDO_HV5_DUMMY_8821C) -+#define BIT_SET_LDO_HV5_DUMMY_8821C(x, v) \ -+ (BIT_CLEAR_LDO_HV5_DUMMY_8821C(x) | BIT_LDO_HV5_DUMMY_8821C(v)) -+ -+#define BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1_8821C 12 -+#define BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1_8821C 0x3 -+#define BIT_REG_VTUNE33_BIT0_TO_BIT1_8821C(x) \ -+ (((x) & BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1_8821C) \ -+ << BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1_8821C) -+#define BITS_REG_VTUNE33_BIT0_TO_BIT1_8821C \ -+ (BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1_8821C \ -+ << BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1_8821C) -+#define BIT_CLEAR_REG_VTUNE33_BIT0_TO_BIT1_8821C(x) \ -+ ((x) & (~BITS_REG_VTUNE33_BIT0_TO_BIT1_8821C)) -+#define BIT_GET_REG_VTUNE33_BIT0_TO_BIT1_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1_8821C) & \ -+ BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1_8821C) -+#define BIT_SET_REG_VTUNE33_BIT0_TO_BIT1_8821C(x, v) \ -+ (BIT_CLEAR_REG_VTUNE33_BIT0_TO_BIT1_8821C(x) | \ -+ BIT_REG_VTUNE33_BIT0_TO_BIT1_8821C(v)) -+ -+#define BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1_8821C 10 -+#define BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1_8821C 0x3 -+#define BIT_REG_STANDBY33_BIT0_TO_BIT1_8821C(x) \ -+ (((x) & BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1_8821C) \ -+ << BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1_8821C) -+#define BITS_REG_STANDBY33_BIT0_TO_BIT1_8821C \ -+ (BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1_8821C \ -+ << BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1_8821C) -+#define BIT_CLEAR_REG_STANDBY33_BIT0_TO_BIT1_8821C(x) \ -+ ((x) & (~BITS_REG_STANDBY33_BIT0_TO_BIT1_8821C)) -+#define BIT_GET_REG_STANDBY33_BIT0_TO_BIT1_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1_8821C) & \ -+ BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1_8821C) -+#define BIT_SET_REG_STANDBY33_BIT0_TO_BIT1_8821C(x, v) \ -+ (BIT_CLEAR_REG_STANDBY33_BIT0_TO_BIT1_8821C(x) | \ -+ BIT_REG_STANDBY33_BIT0_TO_BIT1_8821C(v)) -+ -+#define BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1_8821C 8 -+#define BIT_MASK_REG_LOAD33_BIT0_TO_BIT1_8821C 0x3 -+#define BIT_REG_LOAD33_BIT0_TO_BIT1_8821C(x) \ -+ (((x) & BIT_MASK_REG_LOAD33_BIT0_TO_BIT1_8821C) \ -+ << BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1_8821C) -+#define BITS_REG_LOAD33_BIT0_TO_BIT1_8821C \ -+ (BIT_MASK_REG_LOAD33_BIT0_TO_BIT1_8821C \ -+ << BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1_8821C) -+#define BIT_CLEAR_REG_LOAD33_BIT0_TO_BIT1_8821C(x) \ -+ ((x) & (~BITS_REG_LOAD33_BIT0_TO_BIT1_8821C)) -+#define BIT_GET_REG_LOAD33_BIT0_TO_BIT1_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1_8821C) & \ -+ BIT_MASK_REG_LOAD33_BIT0_TO_BIT1_8821C) -+#define BIT_SET_REG_LOAD33_BIT0_TO_BIT1_8821C(x, v) \ -+ (BIT_CLEAR_REG_LOAD33_BIT0_TO_BIT1_8821C(x) | \ -+ BIT_REG_LOAD33_BIT0_TO_BIT1_8821C(v)) -+ -+#define BIT_REG_BYPASS_L_8821C BIT(7) -+#define BIT_REG_LDOF_L_8821C BIT(6) -+#define BIT_REG_OCPS_L_8821C BIT(5) -+#define BIT_ARENB_L_8821C BIT(3) -+ -+#define BIT_SHIFT_CFC_L_8821C 1 -+#define BIT_MASK_CFC_L_8821C 0x3 -+#define BIT_CFC_L_8821C(x) \ -+ (((x) & BIT_MASK_CFC_L_8821C) << BIT_SHIFT_CFC_L_8821C) -+#define BITS_CFC_L_8821C (BIT_MASK_CFC_L_8821C << BIT_SHIFT_CFC_L_8821C) -+#define BIT_CLEAR_CFC_L_8821C(x) ((x) & (~BITS_CFC_L_8821C)) -+#define BIT_GET_CFC_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_CFC_L_8821C) & BIT_MASK_CFC_L_8821C) -+#define BIT_SET_CFC_L_8821C(x, v) \ -+ (BIT_CLEAR_CFC_L_8821C(x) | BIT_CFC_L_8821C(v)) -+ -+#define BIT_REG_TYPE_L_8821C BIT(0) -+ -+/* 2 REG_MCUFW_CTRL_8821C */ -+ -+#define BIT_SHIFT_RPWM_8821C 24 -+#define BIT_MASK_RPWM_8821C 0xff -+#define BIT_RPWM_8821C(x) (((x) & BIT_MASK_RPWM_8821C) << BIT_SHIFT_RPWM_8821C) -+#define BITS_RPWM_8821C (BIT_MASK_RPWM_8821C << BIT_SHIFT_RPWM_8821C) -+#define BIT_CLEAR_RPWM_8821C(x) ((x) & (~BITS_RPWM_8821C)) -+#define BIT_GET_RPWM_8821C(x) \ -+ (((x) >> BIT_SHIFT_RPWM_8821C) & BIT_MASK_RPWM_8821C) -+#define BIT_SET_RPWM_8821C(x, v) (BIT_CLEAR_RPWM_8821C(x) | BIT_RPWM_8821C(v)) -+ -+#define BIT_ANA_PORT_EN_8821C BIT(22) -+#define BIT_MAC_PORT_EN_8821C BIT(21) -+#define BIT_BOOT_FSPI_EN_8821C BIT(20) -+#define BIT_ROM_DLEN_8821C BIT(19) -+ -+#define BIT_SHIFT_ROM_PGE_8821C 16 -+#define BIT_MASK_ROM_PGE_8821C 0x7 -+#define BIT_ROM_PGE_8821C(x) \ -+ (((x) & BIT_MASK_ROM_PGE_8821C) << BIT_SHIFT_ROM_PGE_8821C) -+#define BITS_ROM_PGE_8821C (BIT_MASK_ROM_PGE_8821C << BIT_SHIFT_ROM_PGE_8821C) -+#define BIT_CLEAR_ROM_PGE_8821C(x) ((x) & (~BITS_ROM_PGE_8821C)) -+#define BIT_GET_ROM_PGE_8821C(x) \ -+ (((x) >> BIT_SHIFT_ROM_PGE_8821C) & BIT_MASK_ROM_PGE_8821C) -+#define BIT_SET_ROM_PGE_8821C(x, v) \ -+ (BIT_CLEAR_ROM_PGE_8821C(x) | BIT_ROM_PGE_8821C(v)) -+ -+#define BIT_FW_INIT_RDY_8821C BIT(15) -+#define BIT_FW_DW_RDY_8821C BIT(14) -+ -+#define BIT_SHIFT_CPU_CLK_SEL_8821C 12 -+#define BIT_MASK_CPU_CLK_SEL_8821C 0x3 -+#define BIT_CPU_CLK_SEL_8821C(x) \ -+ (((x) & BIT_MASK_CPU_CLK_SEL_8821C) << BIT_SHIFT_CPU_CLK_SEL_8821C) -+#define BITS_CPU_CLK_SEL_8821C \ -+ (BIT_MASK_CPU_CLK_SEL_8821C << BIT_SHIFT_CPU_CLK_SEL_8821C) -+#define BIT_CLEAR_CPU_CLK_SEL_8821C(x) ((x) & (~BITS_CPU_CLK_SEL_8821C)) -+#define BIT_GET_CPU_CLK_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_CPU_CLK_SEL_8821C) & BIT_MASK_CPU_CLK_SEL_8821C) -+#define BIT_SET_CPU_CLK_SEL_8821C(x, v) \ -+ (BIT_CLEAR_CPU_CLK_SEL_8821C(x) | BIT_CPU_CLK_SEL_8821C(v)) -+ -+#define BIT_CCLK_CHG_MASK_8821C BIT(11) -+#define BIT_EMEM__TXBUF_CHKSUM_OK_8821C BIT(10) -+#define BIT_EMEM_TXBUF_DW_RDY_8821C BIT(9) -+#define BIT_EMEM_CHKSUM_OK_8821C BIT(8) -+#define BIT_EMEM_DW_OK_8821C BIT(7) -+#define BIT_DMEM_CHKSUM_OK_8821C BIT(6) -+#define BIT_DMEM_DW_OK_8821C BIT(5) -+#define BIT_IMEM_CHKSUM_OK_8821C BIT(4) -+#define BIT_IMEM_DW_OK_8821C BIT(3) -+#define BIT_IMEM_BOOT_LOAD_CHKSUM_OK_8821C BIT(2) -+#define BIT_IMEM_BOOT_LOAD_DW_OK_8821C BIT(1) -+#define BIT_MCUFWDL_EN_8821C BIT(0) -+ -+/* 2 REG_MCU_TST_CFG_8821C */ -+ -+#define BIT_SHIFT_C2H_MSG_8821C 0 -+#define BIT_MASK_C2H_MSG_8821C 0xffff -+#define BIT_C2H_MSG_8821C(x) \ -+ (((x) & BIT_MASK_C2H_MSG_8821C) << BIT_SHIFT_C2H_MSG_8821C) -+#define BITS_C2H_MSG_8821C (BIT_MASK_C2H_MSG_8821C << BIT_SHIFT_C2H_MSG_8821C) -+#define BIT_CLEAR_C2H_MSG_8821C(x) ((x) & (~BITS_C2H_MSG_8821C)) -+#define BIT_GET_C2H_MSG_8821C(x) \ -+ (((x) >> BIT_SHIFT_C2H_MSG_8821C) & BIT_MASK_C2H_MSG_8821C) -+#define BIT_SET_C2H_MSG_8821C(x, v) \ -+ (BIT_CLEAR_C2H_MSG_8821C(x) | BIT_C2H_MSG_8821C(v)) -+ -+/* 2 REG_HMEBOX_E0_E1_8821C */ -+ -+#define BIT_SHIFT_HOST_MSG_E1_8821C 16 -+#define BIT_MASK_HOST_MSG_E1_8821C 0xffff -+#define BIT_HOST_MSG_E1_8821C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E1_8821C) << BIT_SHIFT_HOST_MSG_E1_8821C) -+#define BITS_HOST_MSG_E1_8821C \ -+ (BIT_MASK_HOST_MSG_E1_8821C << BIT_SHIFT_HOST_MSG_E1_8821C) -+#define BIT_CLEAR_HOST_MSG_E1_8821C(x) ((x) & (~BITS_HOST_MSG_E1_8821C)) -+#define BIT_GET_HOST_MSG_E1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E1_8821C) & BIT_MASK_HOST_MSG_E1_8821C) -+#define BIT_SET_HOST_MSG_E1_8821C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E1_8821C(x) | BIT_HOST_MSG_E1_8821C(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E0_8821C 0 -+#define BIT_MASK_HOST_MSG_E0_8821C 0xffff -+#define BIT_HOST_MSG_E0_8821C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E0_8821C) << BIT_SHIFT_HOST_MSG_E0_8821C) -+#define BITS_HOST_MSG_E0_8821C \ -+ (BIT_MASK_HOST_MSG_E0_8821C << BIT_SHIFT_HOST_MSG_E0_8821C) -+#define BIT_CLEAR_HOST_MSG_E0_8821C(x) ((x) & (~BITS_HOST_MSG_E0_8821C)) -+#define BIT_GET_HOST_MSG_E0_8821C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E0_8821C) & BIT_MASK_HOST_MSG_E0_8821C) -+#define BIT_SET_HOST_MSG_E0_8821C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E0_8821C(x) | BIT_HOST_MSG_E0_8821C(v)) -+ -+/* 2 REG_HMEBOX_E2_E3_8821C */ -+ -+#define BIT_SHIFT_HOST_MSG_E3_8821C 16 -+#define BIT_MASK_HOST_MSG_E3_8821C 0xffff -+#define BIT_HOST_MSG_E3_8821C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E3_8821C) << BIT_SHIFT_HOST_MSG_E3_8821C) -+#define BITS_HOST_MSG_E3_8821C \ -+ (BIT_MASK_HOST_MSG_E3_8821C << BIT_SHIFT_HOST_MSG_E3_8821C) -+#define BIT_CLEAR_HOST_MSG_E3_8821C(x) ((x) & (~BITS_HOST_MSG_E3_8821C)) -+#define BIT_GET_HOST_MSG_E3_8821C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E3_8821C) & BIT_MASK_HOST_MSG_E3_8821C) -+#define BIT_SET_HOST_MSG_E3_8821C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E3_8821C(x) | BIT_HOST_MSG_E3_8821C(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E2_8821C 0 -+#define BIT_MASK_HOST_MSG_E2_8821C 0xffff -+#define BIT_HOST_MSG_E2_8821C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E2_8821C) << BIT_SHIFT_HOST_MSG_E2_8821C) -+#define BITS_HOST_MSG_E2_8821C \ -+ (BIT_MASK_HOST_MSG_E2_8821C << BIT_SHIFT_HOST_MSG_E2_8821C) -+#define BIT_CLEAR_HOST_MSG_E2_8821C(x) ((x) & (~BITS_HOST_MSG_E2_8821C)) -+#define BIT_GET_HOST_MSG_E2_8821C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E2_8821C) & BIT_MASK_HOST_MSG_E2_8821C) -+#define BIT_SET_HOST_MSG_E2_8821C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E2_8821C(x) | BIT_HOST_MSG_E2_8821C(v)) -+ -+/* 2 REG_WLLPS_CTRL_8821C */ -+#define BIT_WLLPSOP_EABM_8821C BIT(31) -+#define BIT_WLLPSOP_ACKF_8821C BIT(30) -+#define BIT_WLLPSOP_DLDM_8821C BIT(29) -+#define BIT_WLLPSOP_ESWR_8821C BIT(28) -+#define BIT_WLLPSOP_PWMM_8821C BIT(27) -+#define BIT_WLLPSOP_EECK_8821C BIT(26) -+#define BIT_WLLPSOP_WLMACOFF_8821C BIT(25) -+#define BIT_WLLPSOP_EXTAL_8821C BIT(24) -+#define BIT_WL_SYNPON_VOLTSPDN_8821C BIT(23) -+#define BIT_WLLPSOP_WLBBOFF_8821C BIT(22) -+#define BIT_WLLPSOP_WLMEM_DS_8821C BIT(21) -+ -+#define BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8821C 12 -+#define BIT_MASK_LPLDH12_VADJ_STEP_DN_8821C 0xf -+#define BIT_LPLDH12_VADJ_STEP_DN_8821C(x) \ -+ (((x) & BIT_MASK_LPLDH12_VADJ_STEP_DN_8821C) \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8821C) -+#define BITS_LPLDH12_VADJ_STEP_DN_8821C \ -+ (BIT_MASK_LPLDH12_VADJ_STEP_DN_8821C \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8821C) -+#define BIT_CLEAR_LPLDH12_VADJ_STEP_DN_8821C(x) \ -+ ((x) & (~BITS_LPLDH12_VADJ_STEP_DN_8821C)) -+#define BIT_GET_LPLDH12_VADJ_STEP_DN_8821C(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8821C) & \ -+ BIT_MASK_LPLDH12_VADJ_STEP_DN_8821C) -+#define BIT_SET_LPLDH12_VADJ_STEP_DN_8821C(x, v) \ -+ (BIT_CLEAR_LPLDH12_VADJ_STEP_DN_8821C(x) | \ -+ BIT_LPLDH12_VADJ_STEP_DN_8821C(v)) -+ -+#define BIT_SHIFT_V15ADJ_L1_STEP_DN_8821C 8 -+#define BIT_MASK_V15ADJ_L1_STEP_DN_8821C 0x7 -+#define BIT_V15ADJ_L1_STEP_DN_8821C(x) \ -+ (((x) & BIT_MASK_V15ADJ_L1_STEP_DN_8821C) \ -+ << BIT_SHIFT_V15ADJ_L1_STEP_DN_8821C) -+#define BITS_V15ADJ_L1_STEP_DN_8821C \ -+ (BIT_MASK_V15ADJ_L1_STEP_DN_8821C << BIT_SHIFT_V15ADJ_L1_STEP_DN_8821C) -+#define BIT_CLEAR_V15ADJ_L1_STEP_DN_8821C(x) \ -+ ((x) & (~BITS_V15ADJ_L1_STEP_DN_8821C)) -+#define BIT_GET_V15ADJ_L1_STEP_DN_8821C(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L1_STEP_DN_8821C) & \ -+ BIT_MASK_V15ADJ_L1_STEP_DN_8821C) -+#define BIT_SET_V15ADJ_L1_STEP_DN_8821C(x, v) \ -+ (BIT_CLEAR_V15ADJ_L1_STEP_DN_8821C(x) | BIT_V15ADJ_L1_STEP_DN_8821C(v)) -+ -+#define BIT_REGU_32K_CLK_EN_8821C BIT(1) -+#define BIT_WL_LPS_EN_8821C BIT(0) -+ -+/* 2 REG_AFE_CTRL5_8821C */ -+#define BIT_BB_DBG_SEL_AFE_SDM_BIT0_8821C BIT(31) -+#define BIT_ORDER_SDM_8821C BIT(30) -+#define BIT_RFE_SEL_SDM_8821C BIT(29) -+ -+#define BIT_SHIFT_REF_SEL_8821C 25 -+#define BIT_MASK_REF_SEL_8821C 0xf -+#define BIT_REF_SEL_8821C(x) \ -+ (((x) & BIT_MASK_REF_SEL_8821C) << BIT_SHIFT_REF_SEL_8821C) -+#define BITS_REF_SEL_8821C (BIT_MASK_REF_SEL_8821C << BIT_SHIFT_REF_SEL_8821C) -+#define BIT_CLEAR_REF_SEL_8821C(x) ((x) & (~BITS_REF_SEL_8821C)) -+#define BIT_GET_REF_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_REF_SEL_8821C) & BIT_MASK_REF_SEL_8821C) -+#define BIT_SET_REF_SEL_8821C(x, v) \ -+ (BIT_CLEAR_REF_SEL_8821C(x) | BIT_REF_SEL_8821C(v)) -+ -+#define BIT_SHIFT_F0F_SDM_8821C 12 -+#define BIT_MASK_F0F_SDM_8821C 0x1fff -+#define BIT_F0F_SDM_8821C(x) \ -+ (((x) & BIT_MASK_F0F_SDM_8821C) << BIT_SHIFT_F0F_SDM_8821C) -+#define BITS_F0F_SDM_8821C (BIT_MASK_F0F_SDM_8821C << BIT_SHIFT_F0F_SDM_8821C) -+#define BIT_CLEAR_F0F_SDM_8821C(x) ((x) & (~BITS_F0F_SDM_8821C)) -+#define BIT_GET_F0F_SDM_8821C(x) \ -+ (((x) >> BIT_SHIFT_F0F_SDM_8821C) & BIT_MASK_F0F_SDM_8821C) -+#define BIT_SET_F0F_SDM_8821C(x, v) \ -+ (BIT_CLEAR_F0F_SDM_8821C(x) | BIT_F0F_SDM_8821C(v)) -+ -+#define BIT_SHIFT_F0N_SDM_8821C 9 -+#define BIT_MASK_F0N_SDM_8821C 0x7 -+#define BIT_F0N_SDM_8821C(x) \ -+ (((x) & BIT_MASK_F0N_SDM_8821C) << BIT_SHIFT_F0N_SDM_8821C) -+#define BITS_F0N_SDM_8821C (BIT_MASK_F0N_SDM_8821C << BIT_SHIFT_F0N_SDM_8821C) -+#define BIT_CLEAR_F0N_SDM_8821C(x) ((x) & (~BITS_F0N_SDM_8821C)) -+#define BIT_GET_F0N_SDM_8821C(x) \ -+ (((x) >> BIT_SHIFT_F0N_SDM_8821C) & BIT_MASK_F0N_SDM_8821C) -+#define BIT_SET_F0N_SDM_8821C(x, v) \ -+ (BIT_CLEAR_F0N_SDM_8821C(x) | BIT_F0N_SDM_8821C(v)) -+ -+#define BIT_SHIFT_DIVN_SDM_8821C 3 -+#define BIT_MASK_DIVN_SDM_8821C 0x3f -+#define BIT_DIVN_SDM_8821C(x) \ -+ (((x) & BIT_MASK_DIVN_SDM_8821C) << BIT_SHIFT_DIVN_SDM_8821C) -+#define BITS_DIVN_SDM_8821C \ -+ (BIT_MASK_DIVN_SDM_8821C << BIT_SHIFT_DIVN_SDM_8821C) -+#define BIT_CLEAR_DIVN_SDM_8821C(x) ((x) & (~BITS_DIVN_SDM_8821C)) -+#define BIT_GET_DIVN_SDM_8821C(x) \ -+ (((x) >> BIT_SHIFT_DIVN_SDM_8821C) & BIT_MASK_DIVN_SDM_8821C) -+#define BIT_SET_DIVN_SDM_8821C(x, v) \ -+ (BIT_CLEAR_DIVN_SDM_8821C(x) | BIT_DIVN_SDM_8821C(v)) -+ -+/* 2 REG_GPIO_DEBOUNCE_CTRL_8821C */ -+#define BIT_WLGP_DBC1EN_8821C BIT(15) -+ -+#define BIT_SHIFT_WLGP_DBC1_8821C 8 -+#define BIT_MASK_WLGP_DBC1_8821C 0xf -+#define BIT_WLGP_DBC1_8821C(x) \ -+ (((x) & BIT_MASK_WLGP_DBC1_8821C) << BIT_SHIFT_WLGP_DBC1_8821C) -+#define BITS_WLGP_DBC1_8821C \ -+ (BIT_MASK_WLGP_DBC1_8821C << BIT_SHIFT_WLGP_DBC1_8821C) -+#define BIT_CLEAR_WLGP_DBC1_8821C(x) ((x) & (~BITS_WLGP_DBC1_8821C)) -+#define BIT_GET_WLGP_DBC1_8821C(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC1_8821C) & BIT_MASK_WLGP_DBC1_8821C) -+#define BIT_SET_WLGP_DBC1_8821C(x, v) \ -+ (BIT_CLEAR_WLGP_DBC1_8821C(x) | BIT_WLGP_DBC1_8821C(v)) -+ -+#define BIT_WLGP_DBC0EN_8821C BIT(7) -+ -+#define BIT_SHIFT_WLGP_DBC0_8821C 0 -+#define BIT_MASK_WLGP_DBC0_8821C 0xf -+#define BIT_WLGP_DBC0_8821C(x) \ -+ (((x) & BIT_MASK_WLGP_DBC0_8821C) << BIT_SHIFT_WLGP_DBC0_8821C) -+#define BITS_WLGP_DBC0_8821C \ -+ (BIT_MASK_WLGP_DBC0_8821C << BIT_SHIFT_WLGP_DBC0_8821C) -+#define BIT_CLEAR_WLGP_DBC0_8821C(x) ((x) & (~BITS_WLGP_DBC0_8821C)) -+#define BIT_GET_WLGP_DBC0_8821C(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC0_8821C) & BIT_MASK_WLGP_DBC0_8821C) -+#define BIT_SET_WLGP_DBC0_8821C(x, v) \ -+ (BIT_CLEAR_WLGP_DBC0_8821C(x) | BIT_WLGP_DBC0_8821C(v)) -+ -+/* 2 REG_RPWM2_8821C */ -+ -+#define BIT_SHIFT_RPWM2_8821C 16 -+#define BIT_MASK_RPWM2_8821C 0xffff -+#define BIT_RPWM2_8821C(x) \ -+ (((x) & BIT_MASK_RPWM2_8821C) << BIT_SHIFT_RPWM2_8821C) -+#define BITS_RPWM2_8821C (BIT_MASK_RPWM2_8821C << BIT_SHIFT_RPWM2_8821C) -+#define BIT_CLEAR_RPWM2_8821C(x) ((x) & (~BITS_RPWM2_8821C)) -+#define BIT_GET_RPWM2_8821C(x) \ -+ (((x) >> BIT_SHIFT_RPWM2_8821C) & BIT_MASK_RPWM2_8821C) -+#define BIT_SET_RPWM2_8821C(x, v) \ -+ (BIT_CLEAR_RPWM2_8821C(x) | BIT_RPWM2_8821C(v)) -+ -+/* 2 REG_SYSON_FSM_MON_8821C */ -+ -+#define BIT_SHIFT_FSM_MON_SEL_8821C 24 -+#define BIT_MASK_FSM_MON_SEL_8821C 0x7 -+#define BIT_FSM_MON_SEL_8821C(x) \ -+ (((x) & BIT_MASK_FSM_MON_SEL_8821C) << BIT_SHIFT_FSM_MON_SEL_8821C) -+#define BITS_FSM_MON_SEL_8821C \ -+ (BIT_MASK_FSM_MON_SEL_8821C << BIT_SHIFT_FSM_MON_SEL_8821C) -+#define BIT_CLEAR_FSM_MON_SEL_8821C(x) ((x) & (~BITS_FSM_MON_SEL_8821C)) -+#define BIT_GET_FSM_MON_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_FSM_MON_SEL_8821C) & BIT_MASK_FSM_MON_SEL_8821C) -+#define BIT_SET_FSM_MON_SEL_8821C(x, v) \ -+ (BIT_CLEAR_FSM_MON_SEL_8821C(x) | BIT_FSM_MON_SEL_8821C(v)) -+ -+#define BIT_DOP_ELDO_8821C BIT(23) -+#define BIT_FSM_MON_UPD_8821C BIT(15) -+ -+#define BIT_SHIFT_FSM_PAR_8821C 0 -+#define BIT_MASK_FSM_PAR_8821C 0x7fff -+#define BIT_FSM_PAR_8821C(x) \ -+ (((x) & BIT_MASK_FSM_PAR_8821C) << BIT_SHIFT_FSM_PAR_8821C) -+#define BITS_FSM_PAR_8821C (BIT_MASK_FSM_PAR_8821C << BIT_SHIFT_FSM_PAR_8821C) -+#define BIT_CLEAR_FSM_PAR_8821C(x) ((x) & (~BITS_FSM_PAR_8821C)) -+#define BIT_GET_FSM_PAR_8821C(x) \ -+ (((x) >> BIT_SHIFT_FSM_PAR_8821C) & BIT_MASK_FSM_PAR_8821C) -+#define BIT_SET_FSM_PAR_8821C(x, v) \ -+ (BIT_CLEAR_FSM_PAR_8821C(x) | BIT_FSM_PAR_8821C(v)) -+ -+/* 2 REG_AFE_CTRL6_8821C */ -+ -+#define BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C 0 -+#define BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C 0x7 -+#define BIT_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C(x) \ -+ (((x) & BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C) \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C) -+#define BITS_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C \ -+ (BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C) -+#define BIT_CLEAR_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C(x) \ -+ ((x) & (~BITS_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C)) -+#define BIT_GET_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C) & \ -+ BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C) -+#define BIT_SET_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C(x, v) \ -+ (BIT_CLEAR_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C(x) | \ -+ BIT_BB_DBG_SEL_AFE_SDM_BIT3_1_8821C(v)) -+ -+/* 2 REG_PMC_DBG_CTRL1_8821C */ -+#define BIT_BT_INT_EN_8821C BIT(31) -+ -+#define BIT_SHIFT_RD_WR_WIFI_BT_INFO_8821C 16 -+#define BIT_MASK_RD_WR_WIFI_BT_INFO_8821C 0x7fff -+#define BIT_RD_WR_WIFI_BT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_RD_WR_WIFI_BT_INFO_8821C) \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8821C) -+#define BITS_RD_WR_WIFI_BT_INFO_8821C \ -+ (BIT_MASK_RD_WR_WIFI_BT_INFO_8821C \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8821C) -+#define BIT_CLEAR_RD_WR_WIFI_BT_INFO_8821C(x) \ -+ ((x) & (~BITS_RD_WR_WIFI_BT_INFO_8821C)) -+#define BIT_GET_RD_WR_WIFI_BT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_RD_WR_WIFI_BT_INFO_8821C) & \ -+ BIT_MASK_RD_WR_WIFI_BT_INFO_8821C) -+#define BIT_SET_RD_WR_WIFI_BT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_RD_WR_WIFI_BT_INFO_8821C(x) | \ -+ BIT_RD_WR_WIFI_BT_INFO_8821C(v)) -+ -+#define BIT_PMC_WR_OVF_8821C BIT(8) -+ -+#define BIT_SHIFT_WLPMC_ERRINT_8821C 0 -+#define BIT_MASK_WLPMC_ERRINT_8821C 0xff -+#define BIT_WLPMC_ERRINT_8821C(x) \ -+ (((x) & BIT_MASK_WLPMC_ERRINT_8821C) << BIT_SHIFT_WLPMC_ERRINT_8821C) -+#define BITS_WLPMC_ERRINT_8821C \ -+ (BIT_MASK_WLPMC_ERRINT_8821C << BIT_SHIFT_WLPMC_ERRINT_8821C) -+#define BIT_CLEAR_WLPMC_ERRINT_8821C(x) ((x) & (~BITS_WLPMC_ERRINT_8821C)) -+#define BIT_GET_WLPMC_ERRINT_8821C(x) \ -+ (((x) >> BIT_SHIFT_WLPMC_ERRINT_8821C) & BIT_MASK_WLPMC_ERRINT_8821C) -+#define BIT_SET_WLPMC_ERRINT_8821C(x, v) \ -+ (BIT_CLEAR_WLPMC_ERRINT_8821C(x) | BIT_WLPMC_ERRINT_8821C(v)) -+ -+/* 2 REG_AFE_CTRL7_8821C */ -+ -+#define BIT_SHIFT_SEL_V_8821C 30 -+#define BIT_MASK_SEL_V_8821C 0x3 -+#define BIT_SEL_V_8821C(x) \ -+ (((x) & BIT_MASK_SEL_V_8821C) << BIT_SHIFT_SEL_V_8821C) -+#define BITS_SEL_V_8821C (BIT_MASK_SEL_V_8821C << BIT_SHIFT_SEL_V_8821C) -+#define BIT_CLEAR_SEL_V_8821C(x) ((x) & (~BITS_SEL_V_8821C)) -+#define BIT_GET_SEL_V_8821C(x) \ -+ (((x) >> BIT_SHIFT_SEL_V_8821C) & BIT_MASK_SEL_V_8821C) -+#define BIT_SET_SEL_V_8821C(x, v) \ -+ (BIT_CLEAR_SEL_V_8821C(x) | BIT_SEL_V_8821C(v)) -+ -+#define BIT_SEL_LDO_PC_8821C BIT(29) -+ -+#define BIT_SHIFT_CK_MON_SEL_8821C 26 -+#define BIT_MASK_CK_MON_SEL_8821C 0x7 -+#define BIT_CK_MON_SEL_8821C(x) \ -+ (((x) & BIT_MASK_CK_MON_SEL_8821C) << BIT_SHIFT_CK_MON_SEL_8821C) -+#define BITS_CK_MON_SEL_8821C \ -+ (BIT_MASK_CK_MON_SEL_8821C << BIT_SHIFT_CK_MON_SEL_8821C) -+#define BIT_CLEAR_CK_MON_SEL_8821C(x) ((x) & (~BITS_CK_MON_SEL_8821C)) -+#define BIT_GET_CK_MON_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_CK_MON_SEL_8821C) & BIT_MASK_CK_MON_SEL_8821C) -+#define BIT_SET_CK_MON_SEL_8821C(x, v) \ -+ (BIT_CLEAR_CK_MON_SEL_8821C(x) | BIT_CK_MON_SEL_8821C(v)) -+ -+#define BIT_CK_MON_EN_8821C BIT(25) -+#define BIT_FREF_EDGE_8821C BIT(24) -+#define BIT_CK320M_EN_8821C BIT(23) -+#define BIT_CK_5M_EN_8821C BIT(22) -+#define BIT_TESTEN_8821C BIT(21) -+ -+/* 2 REG_HIMR0_8821C */ -+#define BIT_TIMEOUT_INTERRUPT2_MASK_8821C BIT(31) -+#define BIT_TIMEOUT_INTERRUTP1_MASK_8821C BIT(30) -+#define BIT_PSTIMEOUT_MSK_8821C BIT(29) -+#define BIT_GTINT4_MSK_8821C BIT(28) -+#define BIT_GTINT3_MSK_8821C BIT(27) -+#define BIT_TXBCN0ERR_MSK_8821C BIT(26) -+#define BIT_TXBCN0OK_MSK_8821C BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_MSK_8821C BIT(24) -+#define BIT_BCNDMAINT0_MSK_8821C BIT(20) -+#define BIT_BCNDERR0_MSK_8821C BIT(16) -+#define BIT_HSISR_IND_ON_INT_MSK_8821C BIT(15) -+#define BIT_BCNDMAINT_E_MSK_8821C BIT(14) -+#define BIT_CTWEND_MSK_8821C BIT(12) -+#define BIT_HISR1_IND_MSK_8821C BIT(11) -+#define BIT_C2HCMD_MSK_8821C BIT(10) -+#define BIT_CPWM2_MSK_8821C BIT(9) -+#define BIT_CPWM_MSK_8821C BIT(8) -+#define BIT_HIGHDOK_MSK_8821C BIT(7) -+#define BIT_MGTDOK_MSK_8821C BIT(6) -+#define BIT_BKDOK_MSK_8821C BIT(5) -+#define BIT_BEDOK_MSK_8821C BIT(4) -+#define BIT_VIDOK_MSK_8821C BIT(3) -+#define BIT_VODOK_MSK_8821C BIT(2) -+#define BIT_RDU_MSK_8821C BIT(1) -+#define BIT_RXOK_MSK_8821C BIT(0) -+ -+/* 2 REG_HISR0_8821C */ -+#define BIT_PSTIMEOUT2_8821C BIT(31) -+#define BIT_PSTIMEOUT1_8821C BIT(30) -+#define BIT_PSTIMEOUT_8821C BIT(29) -+#define BIT_GTINT4_8821C BIT(28) -+#define BIT_GTINT3_8821C BIT(27) -+#define BIT_TXBCN0ERR_8821C BIT(26) -+#define BIT_TXBCN0OK_8821C BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_8821C BIT(24) -+#define BIT_BCNDMAINT0_8821C BIT(20) -+#define BIT_BCNDERR0_8821C BIT(16) -+#define BIT_HSISR_IND_ON_INT_8821C BIT(15) -+#define BIT_BCNDMAINT_E_8821C BIT(14) -+#define BIT_CTWEND_8821C BIT(12) -+#define BIT_HISR1_IND_INT_8821C BIT(11) -+#define BIT_C2HCMD_8821C BIT(10) -+#define BIT_CPWM2_8821C BIT(9) -+#define BIT_CPWM_8821C BIT(8) -+#define BIT_HIGHDOK_8821C BIT(7) -+#define BIT_MGTDOK_8821C BIT(6) -+#define BIT_BKDOK_8821C BIT(5) -+#define BIT_BEDOK_8821C BIT(4) -+#define BIT_VIDOK_8821C BIT(3) -+#define BIT_VODOK_8821C BIT(2) -+#define BIT_RDU_8821C BIT(1) -+#define BIT_RXOK_8821C BIT(0) -+ -+/* 2 REG_HIMR1_8821C */ -+#define BIT_TXFIFO_TH_INT_8821C BIT(30) -+#define BIT_BTON_STS_UPDATE_MASK_8821C BIT(29) -+#define BIT_MCU_ERR_MASK_8821C BIT(28) -+#define BIT_BCNDMAINT7__MSK_8821C BIT(27) -+#define BIT_BCNDMAINT6__MSK_8821C BIT(26) -+#define BIT_BCNDMAINT5__MSK_8821C BIT(25) -+#define BIT_BCNDMAINT4__MSK_8821C BIT(24) -+#define BIT_BCNDMAINT3_MSK_8821C BIT(23) -+#define BIT_BCNDMAINT2_MSK_8821C BIT(22) -+#define BIT_BCNDMAINT1_MSK_8821C BIT(21) -+#define BIT_BCNDERR7_MSK_8821C BIT(20) -+#define BIT_BCNDERR6_MSK_8821C BIT(19) -+#define BIT_BCNDERR5_MSK_8821C BIT(18) -+#define BIT_BCNDERR4_MSK_8821C BIT(17) -+#define BIT_BCNDERR3_MSK_8821C BIT(16) -+#define BIT_BCNDERR2_MSK_8821C BIT(15) -+#define BIT_BCNDERR1_MSK_8821C BIT(14) -+#define BIT_ATIMEND_E_MSK_8821C BIT(13) -+#define BIT_ATIMEND__MSK_8821C BIT(12) -+#define BIT_TXERR_MSK_8821C BIT(11) -+#define BIT_RXERR_MSK_8821C BIT(10) -+#define BIT_TXFOVW_MSK_8821C BIT(9) -+#define BIT_FOVW_MSK_8821C BIT(8) -+#define BIT_CPU_MGQ_TXDONE_MSK_8821C BIT(5) -+#define BIT_PS_TIMER_C_MSK_8821C BIT(4) -+#define BIT_PS_TIMER_B_MSK_8821C BIT(3) -+#define BIT_PS_TIMER_A_MSK_8821C BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_MSK_8821C BIT(1) -+ -+/* 2 REG_HISR1_8821C */ -+#define BIT_TXFIFO_TH_INT_8821C BIT(30) -+#define BIT_BTON_STS_UPDATE_INT_8821C BIT(29) -+#define BIT_MCU_ERR_8821C BIT(28) -+#define BIT_BCNDMAINT7_8821C BIT(27) -+#define BIT_BCNDMAINT6_8821C BIT(26) -+#define BIT_BCNDMAINT5_8821C BIT(25) -+#define BIT_BCNDMAINT4_8821C BIT(24) -+#define BIT_BCNDMAINT3_8821C BIT(23) -+#define BIT_BCNDMAINT2_8821C BIT(22) -+#define BIT_BCNDMAINT1_8821C BIT(21) -+#define BIT_BCNDERR7_8821C BIT(20) -+#define BIT_BCNDERR6_8821C BIT(19) -+#define BIT_BCNDERR5_8821C BIT(18) -+#define BIT_BCNDERR4_8821C BIT(17) -+#define BIT_BCNDERR3_8821C BIT(16) -+#define BIT_BCNDERR2_8821C BIT(15) -+#define BIT_BCNDERR1_8821C BIT(14) -+#define BIT_ATIMEND_E_8821C BIT(13) -+#define BIT_ATIMEND_8821C BIT(12) -+#define BIT_TXERR_INT_8821C BIT(11) -+#define BIT_RXERR_INT_8821C BIT(10) -+#define BIT_TXFOVW_8821C BIT(9) -+#define BIT_FOVW_8821C BIT(8) -+ -+/* 2 REG_NOT_VALID_8821C */ -+#define BIT_CPU_MGQ_TXDONE_8821C BIT(5) -+#define BIT_PS_TIMER_C_8821C BIT(4) -+#define BIT_PS_TIMER_B_8821C BIT(3) -+#define BIT_PS_TIMER_A_8821C BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_8821C BIT(1) -+ -+/* 2 REG_DBG_PORT_SEL_8821C */ -+ -+#define BIT_SHIFT_DEBUG_ST_8821C 0 -+#define BIT_MASK_DEBUG_ST_8821C 0xffffffffL -+#define BIT_DEBUG_ST_8821C(x) \ -+ (((x) & BIT_MASK_DEBUG_ST_8821C) << BIT_SHIFT_DEBUG_ST_8821C) -+#define BITS_DEBUG_ST_8821C \ -+ (BIT_MASK_DEBUG_ST_8821C << BIT_SHIFT_DEBUG_ST_8821C) -+#define BIT_CLEAR_DEBUG_ST_8821C(x) ((x) & (~BITS_DEBUG_ST_8821C)) -+#define BIT_GET_DEBUG_ST_8821C(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_ST_8821C) & BIT_MASK_DEBUG_ST_8821C) -+#define BIT_SET_DEBUG_ST_8821C(x, v) \ -+ (BIT_CLEAR_DEBUG_ST_8821C(x) | BIT_DEBUG_ST_8821C(v)) -+ -+/* 2 REG_PAD_CTRL2_8821C */ -+#define BIT_USB3_USB2_TRANSITION_8821C BIT(20) -+ -+#define BIT_SHIFT_USB23_SW_MODE_V1_8821C 18 -+#define BIT_MASK_USB23_SW_MODE_V1_8821C 0x3 -+#define BIT_USB23_SW_MODE_V1_8821C(x) \ -+ (((x) & BIT_MASK_USB23_SW_MODE_V1_8821C) \ -+ << BIT_SHIFT_USB23_SW_MODE_V1_8821C) -+#define BITS_USB23_SW_MODE_V1_8821C \ -+ (BIT_MASK_USB23_SW_MODE_V1_8821C << BIT_SHIFT_USB23_SW_MODE_V1_8821C) -+#define BIT_CLEAR_USB23_SW_MODE_V1_8821C(x) \ -+ ((x) & (~BITS_USB23_SW_MODE_V1_8821C)) -+#define BIT_GET_USB23_SW_MODE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_USB23_SW_MODE_V1_8821C) & \ -+ BIT_MASK_USB23_SW_MODE_V1_8821C) -+#define BIT_SET_USB23_SW_MODE_V1_8821C(x, v) \ -+ (BIT_CLEAR_USB23_SW_MODE_V1_8821C(x) | BIT_USB23_SW_MODE_V1_8821C(v)) -+ -+#define BIT_NO_PDN_CHIPOFF_V1_8821C BIT(17) -+#define BIT_RSM_EN_V1_8821C BIT(16) -+ -+#define BIT_SHIFT_MATCH_CNT_8821C 8 -+#define BIT_MASK_MATCH_CNT_8821C 0xff -+#define BIT_MATCH_CNT_8821C(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8821C) << BIT_SHIFT_MATCH_CNT_8821C) -+#define BITS_MATCH_CNT_8821C \ -+ (BIT_MASK_MATCH_CNT_8821C << BIT_SHIFT_MATCH_CNT_8821C) -+#define BIT_CLEAR_MATCH_CNT_8821C(x) ((x) & (~BITS_MATCH_CNT_8821C)) -+#define BIT_GET_MATCH_CNT_8821C(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8821C) & BIT_MASK_MATCH_CNT_8821C) -+#define BIT_SET_MATCH_CNT_8821C(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8821C(x) | BIT_MATCH_CNT_8821C(v)) -+ -+#define BIT_LD_B12V_EN_8821C BIT(7) -+#define BIT_EECS_IOSEL_V1_8821C BIT(6) -+#define BIT_EECS_DATA_O_V1_8821C BIT(5) -+#define BIT_EECS_DATA_I_V1_8821C BIT(4) -+#define BIT_EESK_IOSEL_V1_8821C BIT(2) -+#define BIT_EESK_DATA_O_V1_8821C BIT(1) -+#define BIT_EESK_DATA_I_V1_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_PMC_DBG_CTRL2_8821C */ -+ -+#define BIT_SHIFT_EFUSE_BURN_GNT_8821C 24 -+#define BIT_MASK_EFUSE_BURN_GNT_8821C 0xff -+#define BIT_EFUSE_BURN_GNT_8821C(x) \ -+ (((x) & BIT_MASK_EFUSE_BURN_GNT_8821C) \ -+ << BIT_SHIFT_EFUSE_BURN_GNT_8821C) -+#define BITS_EFUSE_BURN_GNT_8821C \ -+ (BIT_MASK_EFUSE_BURN_GNT_8821C << BIT_SHIFT_EFUSE_BURN_GNT_8821C) -+#define BIT_CLEAR_EFUSE_BURN_GNT_8821C(x) ((x) & (~BITS_EFUSE_BURN_GNT_8821C)) -+#define BIT_GET_EFUSE_BURN_GNT_8821C(x) \ -+ (((x) >> BIT_SHIFT_EFUSE_BURN_GNT_8821C) & \ -+ BIT_MASK_EFUSE_BURN_GNT_8821C) -+#define BIT_SET_EFUSE_BURN_GNT_8821C(x, v) \ -+ (BIT_CLEAR_EFUSE_BURN_GNT_8821C(x) | BIT_EFUSE_BURN_GNT_8821C(v)) -+ -+#define BIT_STOP_WL_PMC_8821C BIT(9) -+#define BIT_STOP_SYM_PMC_8821C BIT(8) -+#define BIT_BT_ACCESS_WL_PAGE0_8821C BIT(6) -+#define BIT_REG_RST_WLPMC_8821C BIT(5) -+#define BIT_REG_RST_PD12N_8821C BIT(4) -+#define BIT_SYSON_DIS_WLREG_WRMSK_8821C BIT(3) -+#define BIT_SYSON_DIS_PMCREG_WRMSK_8821C BIT(2) -+ -+#define BIT_SHIFT_SYSON_REG_ARB_8821C 0 -+#define BIT_MASK_SYSON_REG_ARB_8821C 0x3 -+#define BIT_SYSON_REG_ARB_8821C(x) \ -+ (((x) & BIT_MASK_SYSON_REG_ARB_8821C) << BIT_SHIFT_SYSON_REG_ARB_8821C) -+#define BITS_SYSON_REG_ARB_8821C \ -+ (BIT_MASK_SYSON_REG_ARB_8821C << BIT_SHIFT_SYSON_REG_ARB_8821C) -+#define BIT_CLEAR_SYSON_REG_ARB_8821C(x) ((x) & (~BITS_SYSON_REG_ARB_8821C)) -+#define BIT_GET_SYSON_REG_ARB_8821C(x) \ -+ (((x) >> BIT_SHIFT_SYSON_REG_ARB_8821C) & BIT_MASK_SYSON_REG_ARB_8821C) -+#define BIT_SET_SYSON_REG_ARB_8821C(x, v) \ -+ (BIT_CLEAR_SYSON_REG_ARB_8821C(x) | BIT_SYSON_REG_ARB_8821C(v)) -+ -+/* 2 REG_BIST_CTRL_8821C */ -+#define BIT_BIST_USB_DIS_8821C BIT(27) -+#define BIT_BIST_PCI_DIS_8821C BIT(26) -+#define BIT_BIST_BT_DIS_8821C BIT(25) -+#define BIT_BIST_WL_DIS_8821C BIT(24) -+ -+#define BIT_SHIFT_BIST_RPT_SEL_8821C 16 -+#define BIT_MASK_BIST_RPT_SEL_8821C 0xf -+#define BIT_BIST_RPT_SEL_8821C(x) \ -+ (((x) & BIT_MASK_BIST_RPT_SEL_8821C) << BIT_SHIFT_BIST_RPT_SEL_8821C) -+#define BITS_BIST_RPT_SEL_8821C \ -+ (BIT_MASK_BIST_RPT_SEL_8821C << BIT_SHIFT_BIST_RPT_SEL_8821C) -+#define BIT_CLEAR_BIST_RPT_SEL_8821C(x) ((x) & (~BITS_BIST_RPT_SEL_8821C)) -+#define BIT_GET_BIST_RPT_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_BIST_RPT_SEL_8821C) & BIT_MASK_BIST_RPT_SEL_8821C) -+#define BIT_SET_BIST_RPT_SEL_8821C(x, v) \ -+ (BIT_CLEAR_BIST_RPT_SEL_8821C(x) | BIT_BIST_RPT_SEL_8821C(v)) -+ -+#define BIT_BIST_RESUME_PS_8821C BIT(4) -+#define BIT_BIST_RESUME_8821C BIT(3) -+#define BIT_BIST_NORMAL_8821C BIT(2) -+#define BIT_BIST_RSTN_8821C BIT(1) -+#define BIT_BIST_CLK_EN_8821C BIT(0) -+ -+/* 2 REG_BIST_RPT_8821C */ -+ -+#define BIT_SHIFT_MBIST_REPORT_8821C 0 -+#define BIT_MASK_MBIST_REPORT_8821C 0xffffffffL -+#define BIT_MBIST_REPORT_8821C(x) \ -+ (((x) & BIT_MASK_MBIST_REPORT_8821C) << BIT_SHIFT_MBIST_REPORT_8821C) -+#define BITS_MBIST_REPORT_8821C \ -+ (BIT_MASK_MBIST_REPORT_8821C << BIT_SHIFT_MBIST_REPORT_8821C) -+#define BIT_CLEAR_MBIST_REPORT_8821C(x) ((x) & (~BITS_MBIST_REPORT_8821C)) -+#define BIT_GET_MBIST_REPORT_8821C(x) \ -+ (((x) >> BIT_SHIFT_MBIST_REPORT_8821C) & BIT_MASK_MBIST_REPORT_8821C) -+#define BIT_SET_MBIST_REPORT_8821C(x, v) \ -+ (BIT_CLEAR_MBIST_REPORT_8821C(x) | BIT_MBIST_REPORT_8821C(v)) -+ -+/* 2 REG_MEM_CTRL_8821C */ -+#define BIT_UMEM_RME_8821C BIT(31) -+ -+#define BIT_SHIFT_BT_SPRAM_8821C 28 -+#define BIT_MASK_BT_SPRAM_8821C 0x3 -+#define BIT_BT_SPRAM_8821C(x) \ -+ (((x) & BIT_MASK_BT_SPRAM_8821C) << BIT_SHIFT_BT_SPRAM_8821C) -+#define BITS_BT_SPRAM_8821C \ -+ (BIT_MASK_BT_SPRAM_8821C << BIT_SHIFT_BT_SPRAM_8821C) -+#define BIT_CLEAR_BT_SPRAM_8821C(x) ((x) & (~BITS_BT_SPRAM_8821C)) -+#define BIT_GET_BT_SPRAM_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_SPRAM_8821C) & BIT_MASK_BT_SPRAM_8821C) -+#define BIT_SET_BT_SPRAM_8821C(x, v) \ -+ (BIT_CLEAR_BT_SPRAM_8821C(x) | BIT_BT_SPRAM_8821C(v)) -+ -+#define BIT_SHIFT_BT_ROM_8821C 24 -+#define BIT_MASK_BT_ROM_8821C 0xf -+#define BIT_BT_ROM_8821C(x) \ -+ (((x) & BIT_MASK_BT_ROM_8821C) << BIT_SHIFT_BT_ROM_8821C) -+#define BITS_BT_ROM_8821C (BIT_MASK_BT_ROM_8821C << BIT_SHIFT_BT_ROM_8821C) -+#define BIT_CLEAR_BT_ROM_8821C(x) ((x) & (~BITS_BT_ROM_8821C)) -+#define BIT_GET_BT_ROM_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_ROM_8821C) & BIT_MASK_BT_ROM_8821C) -+#define BIT_SET_BT_ROM_8821C(x, v) \ -+ (BIT_CLEAR_BT_ROM_8821C(x) | BIT_BT_ROM_8821C(v)) -+ -+#define BIT_SHIFT_PCI_DPRAM_8821C 10 -+#define BIT_MASK_PCI_DPRAM_8821C 0x3 -+#define BIT_PCI_DPRAM_8821C(x) \ -+ (((x) & BIT_MASK_PCI_DPRAM_8821C) << BIT_SHIFT_PCI_DPRAM_8821C) -+#define BITS_PCI_DPRAM_8821C \ -+ (BIT_MASK_PCI_DPRAM_8821C << BIT_SHIFT_PCI_DPRAM_8821C) -+#define BIT_CLEAR_PCI_DPRAM_8821C(x) ((x) & (~BITS_PCI_DPRAM_8821C)) -+#define BIT_GET_PCI_DPRAM_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCI_DPRAM_8821C) & BIT_MASK_PCI_DPRAM_8821C) -+#define BIT_SET_PCI_DPRAM_8821C(x, v) \ -+ (BIT_CLEAR_PCI_DPRAM_8821C(x) | BIT_PCI_DPRAM_8821C(v)) -+ -+#define BIT_SHIFT_PCI_SPRAM_8821C 8 -+#define BIT_MASK_PCI_SPRAM_8821C 0x3 -+#define BIT_PCI_SPRAM_8821C(x) \ -+ (((x) & BIT_MASK_PCI_SPRAM_8821C) << BIT_SHIFT_PCI_SPRAM_8821C) -+#define BITS_PCI_SPRAM_8821C \ -+ (BIT_MASK_PCI_SPRAM_8821C << BIT_SHIFT_PCI_SPRAM_8821C) -+#define BIT_CLEAR_PCI_SPRAM_8821C(x) ((x) & (~BITS_PCI_SPRAM_8821C)) -+#define BIT_GET_PCI_SPRAM_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCI_SPRAM_8821C) & BIT_MASK_PCI_SPRAM_8821C) -+#define BIT_SET_PCI_SPRAM_8821C(x, v) \ -+ (BIT_CLEAR_PCI_SPRAM_8821C(x) | BIT_PCI_SPRAM_8821C(v)) -+ -+#define BIT_SHIFT_USB_SPRAM_8821C 6 -+#define BIT_MASK_USB_SPRAM_8821C 0x3 -+#define BIT_USB_SPRAM_8821C(x) \ -+ (((x) & BIT_MASK_USB_SPRAM_8821C) << BIT_SHIFT_USB_SPRAM_8821C) -+#define BITS_USB_SPRAM_8821C \ -+ (BIT_MASK_USB_SPRAM_8821C << BIT_SHIFT_USB_SPRAM_8821C) -+#define BIT_CLEAR_USB_SPRAM_8821C(x) ((x) & (~BITS_USB_SPRAM_8821C)) -+#define BIT_GET_USB_SPRAM_8821C(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRAM_8821C) & BIT_MASK_USB_SPRAM_8821C) -+#define BIT_SET_USB_SPRAM_8821C(x, v) \ -+ (BIT_CLEAR_USB_SPRAM_8821C(x) | BIT_USB_SPRAM_8821C(v)) -+ -+#define BIT_SHIFT_USB_SPRF_8821C 4 -+#define BIT_MASK_USB_SPRF_8821C 0x3 -+#define BIT_USB_SPRF_8821C(x) \ -+ (((x) & BIT_MASK_USB_SPRF_8821C) << BIT_SHIFT_USB_SPRF_8821C) -+#define BITS_USB_SPRF_8821C \ -+ (BIT_MASK_USB_SPRF_8821C << BIT_SHIFT_USB_SPRF_8821C) -+#define BIT_CLEAR_USB_SPRF_8821C(x) ((x) & (~BITS_USB_SPRF_8821C)) -+#define BIT_GET_USB_SPRF_8821C(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRF_8821C) & BIT_MASK_USB_SPRF_8821C) -+#define BIT_SET_USB_SPRF_8821C(x, v) \ -+ (BIT_CLEAR_USB_SPRF_8821C(x) | BIT_USB_SPRF_8821C(v)) -+ -+#define BIT_SHIFT_MCU_ROM_8821C 0 -+#define BIT_MASK_MCU_ROM_8821C 0xf -+#define BIT_MCU_ROM_8821C(x) \ -+ (((x) & BIT_MASK_MCU_ROM_8821C) << BIT_SHIFT_MCU_ROM_8821C) -+#define BITS_MCU_ROM_8821C (BIT_MASK_MCU_ROM_8821C << BIT_SHIFT_MCU_ROM_8821C) -+#define BIT_CLEAR_MCU_ROM_8821C(x) ((x) & (~BITS_MCU_ROM_8821C)) -+#define BIT_GET_MCU_ROM_8821C(x) \ -+ (((x) >> BIT_SHIFT_MCU_ROM_8821C) & BIT_MASK_MCU_ROM_8821C) -+#define BIT_SET_MCU_ROM_8821C(x, v) \ -+ (BIT_CLEAR_MCU_ROM_8821C(x) | BIT_MCU_ROM_8821C(v)) -+ -+/* 2 REG_AFE_CTRL8_8821C */ -+#define BIT_SYN_AGPIO_8821C BIT(20) -+#define BIT_XTAL_LP_8821C BIT(4) -+#define BIT_XTAL_GM_SEP_8821C BIT(3) -+ -+#define BIT_SHIFT_XTAL_SEL_TOK_8821C 0 -+#define BIT_MASK_XTAL_SEL_TOK_8821C 0x7 -+#define BIT_XTAL_SEL_TOK_8821C(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_TOK_8821C) << BIT_SHIFT_XTAL_SEL_TOK_8821C) -+#define BITS_XTAL_SEL_TOK_8821C \ -+ (BIT_MASK_XTAL_SEL_TOK_8821C << BIT_SHIFT_XTAL_SEL_TOK_8821C) -+#define BIT_CLEAR_XTAL_SEL_TOK_8821C(x) ((x) & (~BITS_XTAL_SEL_TOK_8821C)) -+#define BIT_GET_XTAL_SEL_TOK_8821C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_TOK_8821C) & BIT_MASK_XTAL_SEL_TOK_8821C) -+#define BIT_SET_XTAL_SEL_TOK_8821C(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_TOK_8821C(x) | BIT_XTAL_SEL_TOK_8821C(v)) -+ -+/* 2 REG_USB_SIE_INTF_8821C */ -+#define BIT_RD_SEL_8821C BIT(31) -+#define BIT_USB_SIE_INTF_WE_V1_8821C BIT(30) -+#define BIT_USB_SIE_INTF_BYIOREG_V1_8821C BIT(29) -+#define BIT_USB_SIE_SELECT_8821C BIT(28) -+ -+#define BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8821C 16 -+#define BIT_MASK_USB_SIE_INTF_ADDR_V1_8821C 0x1ff -+#define BIT_USB_SIE_INTF_ADDR_V1_8821C(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_ADDR_V1_8821C) \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8821C) -+#define BITS_USB_SIE_INTF_ADDR_V1_8821C \ -+ (BIT_MASK_USB_SIE_INTF_ADDR_V1_8821C \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8821C) -+#define BIT_CLEAR_USB_SIE_INTF_ADDR_V1_8821C(x) \ -+ ((x) & (~BITS_USB_SIE_INTF_ADDR_V1_8821C)) -+#define BIT_GET_USB_SIE_INTF_ADDR_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8821C) & \ -+ BIT_MASK_USB_SIE_INTF_ADDR_V1_8821C) -+#define BIT_SET_USB_SIE_INTF_ADDR_V1_8821C(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_ADDR_V1_8821C(x) | \ -+ BIT_USB_SIE_INTF_ADDR_V1_8821C(v)) -+ -+#define BIT_SHIFT_USB_SIE_INTF_RD_8821C 8 -+#define BIT_MASK_USB_SIE_INTF_RD_8821C 0xff -+#define BIT_USB_SIE_INTF_RD_8821C(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_RD_8821C) \ -+ << BIT_SHIFT_USB_SIE_INTF_RD_8821C) -+#define BITS_USB_SIE_INTF_RD_8821C \ -+ (BIT_MASK_USB_SIE_INTF_RD_8821C << BIT_SHIFT_USB_SIE_INTF_RD_8821C) -+#define BIT_CLEAR_USB_SIE_INTF_RD_8821C(x) ((x) & (~BITS_USB_SIE_INTF_RD_8821C)) -+#define BIT_GET_USB_SIE_INTF_RD_8821C(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_RD_8821C) & \ -+ BIT_MASK_USB_SIE_INTF_RD_8821C) -+#define BIT_SET_USB_SIE_INTF_RD_8821C(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_RD_8821C(x) | BIT_USB_SIE_INTF_RD_8821C(v)) -+ -+#define BIT_SHIFT_USB_SIE_INTF_WD_8821C 0 -+#define BIT_MASK_USB_SIE_INTF_WD_8821C 0xff -+#define BIT_USB_SIE_INTF_WD_8821C(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_WD_8821C) \ -+ << BIT_SHIFT_USB_SIE_INTF_WD_8821C) -+#define BITS_USB_SIE_INTF_WD_8821C \ -+ (BIT_MASK_USB_SIE_INTF_WD_8821C << BIT_SHIFT_USB_SIE_INTF_WD_8821C) -+#define BIT_CLEAR_USB_SIE_INTF_WD_8821C(x) ((x) & (~BITS_USB_SIE_INTF_WD_8821C)) -+#define BIT_GET_USB_SIE_INTF_WD_8821C(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_WD_8821C) & \ -+ BIT_MASK_USB_SIE_INTF_WD_8821C) -+#define BIT_SET_USB_SIE_INTF_WD_8821C(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_WD_8821C(x) | BIT_USB_SIE_INTF_WD_8821C(v)) -+ -+/* 2 REG_PCIE_MIO_INTF_8821C */ -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8821C 16 -+#define BIT_MASK_PCIE_MIO_ADDR_PAGE_8821C 0x3 -+#define BIT_PCIE_MIO_ADDR_PAGE_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_PAGE_8821C) \ -+ << BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8821C) -+#define BITS_PCIE_MIO_ADDR_PAGE_8821C \ -+ (BIT_MASK_PCIE_MIO_ADDR_PAGE_8821C \ -+ << BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8821C) -+#define BIT_CLEAR_PCIE_MIO_ADDR_PAGE_8821C(x) \ -+ ((x) & (~BITS_PCIE_MIO_ADDR_PAGE_8821C)) -+#define BIT_GET_PCIE_MIO_ADDR_PAGE_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8821C) & \ -+ BIT_MASK_PCIE_MIO_ADDR_PAGE_8821C) -+#define BIT_SET_PCIE_MIO_ADDR_PAGE_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_PAGE_8821C(x) | \ -+ BIT_PCIE_MIO_ADDR_PAGE_8821C(v)) -+ -+#define BIT_PCIE_MIO_BYIOREG_8821C BIT(13) -+#define BIT_PCIE_MIO_RE_8821C BIT(12) -+ -+#define BIT_SHIFT_PCIE_MIO_WE_8821C 8 -+#define BIT_MASK_PCIE_MIO_WE_8821C 0xf -+#define BIT_PCIE_MIO_WE_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_WE_8821C) << BIT_SHIFT_PCIE_MIO_WE_8821C) -+#define BITS_PCIE_MIO_WE_8821C \ -+ (BIT_MASK_PCIE_MIO_WE_8821C << BIT_SHIFT_PCIE_MIO_WE_8821C) -+#define BIT_CLEAR_PCIE_MIO_WE_8821C(x) ((x) & (~BITS_PCIE_MIO_WE_8821C)) -+#define BIT_GET_PCIE_MIO_WE_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_WE_8821C) & BIT_MASK_PCIE_MIO_WE_8821C) -+#define BIT_SET_PCIE_MIO_WE_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_WE_8821C(x) | BIT_PCIE_MIO_WE_8821C(v)) -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_8821C 0 -+#define BIT_MASK_PCIE_MIO_ADDR_8821C 0xff -+#define BIT_PCIE_MIO_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_8821C) << BIT_SHIFT_PCIE_MIO_ADDR_8821C) -+#define BITS_PCIE_MIO_ADDR_8821C \ -+ (BIT_MASK_PCIE_MIO_ADDR_8821C << BIT_SHIFT_PCIE_MIO_ADDR_8821C) -+#define BIT_CLEAR_PCIE_MIO_ADDR_8821C(x) ((x) & (~BITS_PCIE_MIO_ADDR_8821C)) -+#define BIT_GET_PCIE_MIO_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_8821C) & BIT_MASK_PCIE_MIO_ADDR_8821C) -+#define BIT_SET_PCIE_MIO_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_8821C(x) | BIT_PCIE_MIO_ADDR_8821C(v)) -+ -+/* 2 REG_PCIE_MIO_INTD_8821C */ -+ -+#define BIT_SHIFT_PCIE_MIO_DATA_8821C 0 -+#define BIT_MASK_PCIE_MIO_DATA_8821C 0xffffffffL -+#define BIT_PCIE_MIO_DATA_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_DATA_8821C) << BIT_SHIFT_PCIE_MIO_DATA_8821C) -+#define BITS_PCIE_MIO_DATA_8821C \ -+ (BIT_MASK_PCIE_MIO_DATA_8821C << BIT_SHIFT_PCIE_MIO_DATA_8821C) -+#define BIT_CLEAR_PCIE_MIO_DATA_8821C(x) ((x) & (~BITS_PCIE_MIO_DATA_8821C)) -+#define BIT_GET_PCIE_MIO_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_DATA_8821C) & BIT_MASK_PCIE_MIO_DATA_8821C) -+#define BIT_SET_PCIE_MIO_DATA_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_DATA_8821C(x) | BIT_PCIE_MIO_DATA_8821C(v)) -+ -+/* 2 REG_WLRF1_8821C */ -+ -+#define BIT_SHIFT_WLRF1_CTRL_8821C 24 -+#define BIT_MASK_WLRF1_CTRL_8821C 0xff -+#define BIT_WLRF1_CTRL_8821C(x) \ -+ (((x) & BIT_MASK_WLRF1_CTRL_8821C) << BIT_SHIFT_WLRF1_CTRL_8821C) -+#define BITS_WLRF1_CTRL_8821C \ -+ (BIT_MASK_WLRF1_CTRL_8821C << BIT_SHIFT_WLRF1_CTRL_8821C) -+#define BIT_CLEAR_WLRF1_CTRL_8821C(x) ((x) & (~BITS_WLRF1_CTRL_8821C)) -+#define BIT_GET_WLRF1_CTRL_8821C(x) \ -+ (((x) >> BIT_SHIFT_WLRF1_CTRL_8821C) & BIT_MASK_WLRF1_CTRL_8821C) -+#define BIT_SET_WLRF1_CTRL_8821C(x, v) \ -+ (BIT_CLEAR_WLRF1_CTRL_8821C(x) | BIT_WLRF1_CTRL_8821C(v)) -+ -+/* 2 REG_SYS_CFG1_8821C */ -+ -+#define BIT_SHIFT_TRP_ICFG_8821C 28 -+#define BIT_MASK_TRP_ICFG_8821C 0xf -+#define BIT_TRP_ICFG_8821C(x) \ -+ (((x) & BIT_MASK_TRP_ICFG_8821C) << BIT_SHIFT_TRP_ICFG_8821C) -+#define BITS_TRP_ICFG_8821C \ -+ (BIT_MASK_TRP_ICFG_8821C << BIT_SHIFT_TRP_ICFG_8821C) -+#define BIT_CLEAR_TRP_ICFG_8821C(x) ((x) & (~BITS_TRP_ICFG_8821C)) -+#define BIT_GET_TRP_ICFG_8821C(x) \ -+ (((x) >> BIT_SHIFT_TRP_ICFG_8821C) & BIT_MASK_TRP_ICFG_8821C) -+#define BIT_SET_TRP_ICFG_8821C(x, v) \ -+ (BIT_CLEAR_TRP_ICFG_8821C(x) | BIT_TRP_ICFG_8821C(v)) -+ -+#define BIT_RF_TYPE_ID_8821C BIT(27) -+#define BIT_BD_HCI_SEL_8821C BIT(26) -+#define BIT_BD_PKG_SEL_8821C BIT(25) -+#define BIT_SPSLDO_SEL_8821C BIT(24) -+#define BIT_RTL_ID_8821C BIT(23) -+#define BIT_PAD_HWPD_IDN_8821C BIT(22) -+#define BIT_TESTMODE_8821C BIT(20) -+ -+#define BIT_SHIFT_VENDOR_ID_8821C 16 -+#define BIT_MASK_VENDOR_ID_8821C 0xf -+#define BIT_VENDOR_ID_8821C(x) \ -+ (((x) & BIT_MASK_VENDOR_ID_8821C) << BIT_SHIFT_VENDOR_ID_8821C) -+#define BITS_VENDOR_ID_8821C \ -+ (BIT_MASK_VENDOR_ID_8821C << BIT_SHIFT_VENDOR_ID_8821C) -+#define BIT_CLEAR_VENDOR_ID_8821C(x) ((x) & (~BITS_VENDOR_ID_8821C)) -+#define BIT_GET_VENDOR_ID_8821C(x) \ -+ (((x) >> BIT_SHIFT_VENDOR_ID_8821C) & BIT_MASK_VENDOR_ID_8821C) -+#define BIT_SET_VENDOR_ID_8821C(x, v) \ -+ (BIT_CLEAR_VENDOR_ID_8821C(x) | BIT_VENDOR_ID_8821C(v)) -+ -+#define BIT_SHIFT_CHIP_VER_8821C 12 -+#define BIT_MASK_CHIP_VER_8821C 0xf -+#define BIT_CHIP_VER_8821C(x) \ -+ (((x) & BIT_MASK_CHIP_VER_8821C) << BIT_SHIFT_CHIP_VER_8821C) -+#define BITS_CHIP_VER_8821C \ -+ (BIT_MASK_CHIP_VER_8821C << BIT_SHIFT_CHIP_VER_8821C) -+#define BIT_CLEAR_CHIP_VER_8821C(x) ((x) & (~BITS_CHIP_VER_8821C)) -+#define BIT_GET_CHIP_VER_8821C(x) \ -+ (((x) >> BIT_SHIFT_CHIP_VER_8821C) & BIT_MASK_CHIP_VER_8821C) -+#define BIT_SET_CHIP_VER_8821C(x, v) \ -+ (BIT_CLEAR_CHIP_VER_8821C(x) | BIT_CHIP_VER_8821C(v)) -+ -+#define BIT_BD_MAC3_8821C BIT(11) -+#define BIT_BD_MAC1_8821C BIT(10) -+#define BIT_BD_MAC2_8821C BIT(9) -+#define BIT_SIC_IDLE_8821C BIT(8) -+#define BIT_SW_OFFLOAD_EN_8821C BIT(7) -+#define BIT_OCP_SHUTDN_8821C BIT(6) -+#define BIT_V15_VLD_8821C BIT(5) -+#define BIT_PCIRSTB_8821C BIT(4) -+#define BIT_PCLK_VLD_8821C BIT(3) -+#define BIT_UCLK_VLD_8821C BIT(2) -+#define BIT_ACLK_VLD_8821C BIT(1) -+#define BIT_XCLK_VLD_8821C BIT(0) -+ -+/* 2 REG_SYS_STATUS1_8821C */ -+ -+#define BIT_SHIFT_RF_RL_ID_8821C 28 -+#define BIT_MASK_RF_RL_ID_8821C 0xf -+#define BIT_RF_RL_ID_8821C(x) \ -+ (((x) & BIT_MASK_RF_RL_ID_8821C) << BIT_SHIFT_RF_RL_ID_8821C) -+#define BITS_RF_RL_ID_8821C \ -+ (BIT_MASK_RF_RL_ID_8821C << BIT_SHIFT_RF_RL_ID_8821C) -+#define BIT_CLEAR_RF_RL_ID_8821C(x) ((x) & (~BITS_RF_RL_ID_8821C)) -+#define BIT_GET_RF_RL_ID_8821C(x) \ -+ (((x) >> BIT_SHIFT_RF_RL_ID_8821C) & BIT_MASK_RF_RL_ID_8821C) -+#define BIT_SET_RF_RL_ID_8821C(x, v) \ -+ (BIT_CLEAR_RF_RL_ID_8821C(x) | BIT_RF_RL_ID_8821C(v)) -+ -+#define BIT_HPHY_ICFG_8821C BIT(19) -+ -+#define BIT_SHIFT_SEL_0XC0_8821C 16 -+#define BIT_MASK_SEL_0XC0_8821C 0x3 -+#define BIT_SEL_0XC0_8821C(x) \ -+ (((x) & BIT_MASK_SEL_0XC0_8821C) << BIT_SHIFT_SEL_0XC0_8821C) -+#define BITS_SEL_0XC0_8821C \ -+ (BIT_MASK_SEL_0XC0_8821C << BIT_SHIFT_SEL_0XC0_8821C) -+#define BIT_CLEAR_SEL_0XC0_8821C(x) ((x) & (~BITS_SEL_0XC0_8821C)) -+#define BIT_GET_SEL_0XC0_8821C(x) \ -+ (((x) >> BIT_SHIFT_SEL_0XC0_8821C) & BIT_MASK_SEL_0XC0_8821C) -+#define BIT_SET_SEL_0XC0_8821C(x, v) \ -+ (BIT_CLEAR_SEL_0XC0_8821C(x) | BIT_SEL_0XC0_8821C(v)) -+ -+#define BIT_SHIFT_HCI_SEL_V4_8821C 12 -+#define BIT_MASK_HCI_SEL_V4_8821C 0x3 -+#define BIT_HCI_SEL_V4_8821C(x) \ -+ (((x) & BIT_MASK_HCI_SEL_V4_8821C) << BIT_SHIFT_HCI_SEL_V4_8821C) -+#define BITS_HCI_SEL_V4_8821C \ -+ (BIT_MASK_HCI_SEL_V4_8821C << BIT_SHIFT_HCI_SEL_V4_8821C) -+#define BIT_CLEAR_HCI_SEL_V4_8821C(x) ((x) & (~BITS_HCI_SEL_V4_8821C)) -+#define BIT_GET_HCI_SEL_V4_8821C(x) \ -+ (((x) >> BIT_SHIFT_HCI_SEL_V4_8821C) & BIT_MASK_HCI_SEL_V4_8821C) -+#define BIT_SET_HCI_SEL_V4_8821C(x, v) \ -+ (BIT_CLEAR_HCI_SEL_V4_8821C(x) | BIT_HCI_SEL_V4_8821C(v)) -+ -+#define BIT_USB_OPERATION_MODE_8821C BIT(10) -+#define BIT_BT_PDN_8821C BIT(9) -+#define BIT_AUTO_WLPON_8821C BIT(8) -+#define BIT_WL_MODE_8821C BIT(7) -+#define BIT_PKG_SEL_HCI_8821C BIT(6) -+ -+#define BIT_SHIFT_PAD_HCI_SEL_V2_8821C 3 -+#define BIT_MASK_PAD_HCI_SEL_V2_8821C 0x3 -+#define BIT_PAD_HCI_SEL_V2_8821C(x) \ -+ (((x) & BIT_MASK_PAD_HCI_SEL_V2_8821C) \ -+ << BIT_SHIFT_PAD_HCI_SEL_V2_8821C) -+#define BITS_PAD_HCI_SEL_V2_8821C \ -+ (BIT_MASK_PAD_HCI_SEL_V2_8821C << BIT_SHIFT_PAD_HCI_SEL_V2_8821C) -+#define BIT_CLEAR_PAD_HCI_SEL_V2_8821C(x) ((x) & (~BITS_PAD_HCI_SEL_V2_8821C)) -+#define BIT_GET_PAD_HCI_SEL_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_PAD_HCI_SEL_V2_8821C) & \ -+ BIT_MASK_PAD_HCI_SEL_V2_8821C) -+#define BIT_SET_PAD_HCI_SEL_V2_8821C(x, v) \ -+ (BIT_CLEAR_PAD_HCI_SEL_V2_8821C(x) | BIT_PAD_HCI_SEL_V2_8821C(v)) -+ -+#define BIT_SHIFT_EFS_HCI_SEL_8821C 0 -+#define BIT_MASK_EFS_HCI_SEL_8821C 0x3 -+#define BIT_EFS_HCI_SEL_8821C(x) \ -+ (((x) & BIT_MASK_EFS_HCI_SEL_8821C) << BIT_SHIFT_EFS_HCI_SEL_8821C) -+#define BITS_EFS_HCI_SEL_8821C \ -+ (BIT_MASK_EFS_HCI_SEL_8821C << BIT_SHIFT_EFS_HCI_SEL_8821C) -+#define BIT_CLEAR_EFS_HCI_SEL_8821C(x) ((x) & (~BITS_EFS_HCI_SEL_8821C)) -+#define BIT_GET_EFS_HCI_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_EFS_HCI_SEL_8821C) & BIT_MASK_EFS_HCI_SEL_8821C) -+#define BIT_SET_EFS_HCI_SEL_8821C(x, v) \ -+ (BIT_CLEAR_EFS_HCI_SEL_8821C(x) | BIT_EFS_HCI_SEL_8821C(v)) -+ -+/* 2 REG_SYS_STATUS2_8821C */ -+#define BIT_SIO_ALDN_8821C BIT(19) -+#define BIT_USB_ALDN_8821C BIT(18) -+#define BIT_PCI_ALDN_8821C BIT(17) -+#define BIT_SYS_ALDN_8821C BIT(16) -+ -+#define BIT_SHIFT_EPVID1_8821C 8 -+#define BIT_MASK_EPVID1_8821C 0xff -+#define BIT_EPVID1_8821C(x) \ -+ (((x) & BIT_MASK_EPVID1_8821C) << BIT_SHIFT_EPVID1_8821C) -+#define BITS_EPVID1_8821C (BIT_MASK_EPVID1_8821C << BIT_SHIFT_EPVID1_8821C) -+#define BIT_CLEAR_EPVID1_8821C(x) ((x) & (~BITS_EPVID1_8821C)) -+#define BIT_GET_EPVID1_8821C(x) \ -+ (((x) >> BIT_SHIFT_EPVID1_8821C) & BIT_MASK_EPVID1_8821C) -+#define BIT_SET_EPVID1_8821C(x, v) \ -+ (BIT_CLEAR_EPVID1_8821C(x) | BIT_EPVID1_8821C(v)) -+ -+#define BIT_SHIFT_EPVID0_8821C 0 -+#define BIT_MASK_EPVID0_8821C 0xff -+#define BIT_EPVID0_8821C(x) \ -+ (((x) & BIT_MASK_EPVID0_8821C) << BIT_SHIFT_EPVID0_8821C) -+#define BITS_EPVID0_8821C (BIT_MASK_EPVID0_8821C << BIT_SHIFT_EPVID0_8821C) -+#define BIT_CLEAR_EPVID0_8821C(x) ((x) & (~BITS_EPVID0_8821C)) -+#define BIT_GET_EPVID0_8821C(x) \ -+ (((x) >> BIT_SHIFT_EPVID0_8821C) & BIT_MASK_EPVID0_8821C) -+#define BIT_SET_EPVID0_8821C(x, v) \ -+ (BIT_CLEAR_EPVID0_8821C(x) | BIT_EPVID0_8821C(v)) -+ -+/* 2 REG_SYS_CFG2_8821C */ -+#define BIT_HCI_SEL_EMBEDDED_8821C BIT(8) -+ -+#define BIT_SHIFT_HW_ID_8821C 0 -+#define BIT_MASK_HW_ID_8821C 0xff -+#define BIT_HW_ID_8821C(x) \ -+ (((x) & BIT_MASK_HW_ID_8821C) << BIT_SHIFT_HW_ID_8821C) -+#define BITS_HW_ID_8821C (BIT_MASK_HW_ID_8821C << BIT_SHIFT_HW_ID_8821C) -+#define BIT_CLEAR_HW_ID_8821C(x) ((x) & (~BITS_HW_ID_8821C)) -+#define BIT_GET_HW_ID_8821C(x) \ -+ (((x) >> BIT_SHIFT_HW_ID_8821C) & BIT_MASK_HW_ID_8821C) -+#define BIT_SET_HW_ID_8821C(x, v) \ -+ (BIT_CLEAR_HW_ID_8821C(x) | BIT_HW_ID_8821C(v)) -+ -+/* 2 REG_SYS_CFG3_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_SYS_CFG5_8821C */ -+#define BIT_LPS_STATUS_8821C BIT(3) -+#define BIT_HCI_TXDMA_BUSY_8821C BIT(2) -+#define BIT_HCI_TXDMA_ALLOW_8821C BIT(1) -+#define BIT_FW_CTRL_HCI_TXDMA_EN_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_CPU_DMEM_CON_8821C */ -+#define BIT_WDT_AUTO_MODE_8821C BIT(22) -+#define BIT_WDT_PLATFORM_EN_8821C BIT(21) -+#define BIT_WDT_CPU_EN_8821C BIT(20) -+#define BIT_WDT_OPT_IOWRAPPER_8821C BIT(19) -+#define BIT_ANA_PORT_IDLE_8821C BIT(18) -+#define BIT_MAC_PORT_IDLE_8821C BIT(17) -+#define BIT_WL_PLATFORM_RST_8821C BIT(16) -+#define BIT_WL_SECURITY_CLK_8821C BIT(15) -+ -+#define BIT_SHIFT_CPU_DMEM_CON_8821C 0 -+#define BIT_MASK_CPU_DMEM_CON_8821C 0xff -+#define BIT_CPU_DMEM_CON_8821C(x) \ -+ (((x) & BIT_MASK_CPU_DMEM_CON_8821C) << BIT_SHIFT_CPU_DMEM_CON_8821C) -+#define BITS_CPU_DMEM_CON_8821C \ -+ (BIT_MASK_CPU_DMEM_CON_8821C << BIT_SHIFT_CPU_DMEM_CON_8821C) -+#define BIT_CLEAR_CPU_DMEM_CON_8821C(x) ((x) & (~BITS_CPU_DMEM_CON_8821C)) -+#define BIT_GET_CPU_DMEM_CON_8821C(x) \ -+ (((x) >> BIT_SHIFT_CPU_DMEM_CON_8821C) & BIT_MASK_CPU_DMEM_CON_8821C) -+#define BIT_SET_CPU_DMEM_CON_8821C(x, v) \ -+ (BIT_CLEAR_CPU_DMEM_CON_8821C(x) | BIT_CPU_DMEM_CON_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_BOOT_REASON_8821C */ -+ -+#define BIT_SHIFT_BOOT_REASON_V1_8821C 0 -+#define BIT_MASK_BOOT_REASON_V1_8821C 0x7 -+#define BIT_BOOT_REASON_V1_8821C(x) \ -+ (((x) & BIT_MASK_BOOT_REASON_V1_8821C) \ -+ << BIT_SHIFT_BOOT_REASON_V1_8821C) -+#define BITS_BOOT_REASON_V1_8821C \ -+ (BIT_MASK_BOOT_REASON_V1_8821C << BIT_SHIFT_BOOT_REASON_V1_8821C) -+#define BIT_CLEAR_BOOT_REASON_V1_8821C(x) ((x) & (~BITS_BOOT_REASON_V1_8821C)) -+#define BIT_GET_BOOT_REASON_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BOOT_REASON_V1_8821C) & \ -+ BIT_MASK_BOOT_REASON_V1_8821C) -+#define BIT_SET_BOOT_REASON_V1_8821C(x, v) \ -+ (BIT_CLEAR_BOOT_REASON_V1_8821C(x) | BIT_BOOT_REASON_V1_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NFCPAD_CTRL_8821C */ -+#define BIT_PAD_SHUTDW_8821C BIT(18) -+#define BIT_SYSON_NFC_PAD_8821C BIT(17) -+#define BIT_NFC_INT_PAD_CTRL_8821C BIT(16) -+#define BIT_NFC_RFDIS_PAD_CTRL_8821C BIT(15) -+#define BIT_NFC_CLK_PAD_CTRL_8821C BIT(14) -+#define BIT_NFC_DATA_PAD_CTRL_8821C BIT(13) -+#define BIT_NFC_PAD_PULL_CTRL_8821C BIT(12) -+ -+#define BIT_SHIFT_NFCPAD_IO_SEL_8821C 8 -+#define BIT_MASK_NFCPAD_IO_SEL_8821C 0xf -+#define BIT_NFCPAD_IO_SEL_8821C(x) \ -+ (((x) & BIT_MASK_NFCPAD_IO_SEL_8821C) << BIT_SHIFT_NFCPAD_IO_SEL_8821C) -+#define BITS_NFCPAD_IO_SEL_8821C \ -+ (BIT_MASK_NFCPAD_IO_SEL_8821C << BIT_SHIFT_NFCPAD_IO_SEL_8821C) -+#define BIT_CLEAR_NFCPAD_IO_SEL_8821C(x) ((x) & (~BITS_NFCPAD_IO_SEL_8821C)) -+#define BIT_GET_NFCPAD_IO_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_IO_SEL_8821C) & BIT_MASK_NFCPAD_IO_SEL_8821C) -+#define BIT_SET_NFCPAD_IO_SEL_8821C(x, v) \ -+ (BIT_CLEAR_NFCPAD_IO_SEL_8821C(x) | BIT_NFCPAD_IO_SEL_8821C(v)) -+ -+#define BIT_SHIFT_NFCPAD_OUT_8821C 4 -+#define BIT_MASK_NFCPAD_OUT_8821C 0xf -+#define BIT_NFCPAD_OUT_8821C(x) \ -+ (((x) & BIT_MASK_NFCPAD_OUT_8821C) << BIT_SHIFT_NFCPAD_OUT_8821C) -+#define BITS_NFCPAD_OUT_8821C \ -+ (BIT_MASK_NFCPAD_OUT_8821C << BIT_SHIFT_NFCPAD_OUT_8821C) -+#define BIT_CLEAR_NFCPAD_OUT_8821C(x) ((x) & (~BITS_NFCPAD_OUT_8821C)) -+#define BIT_GET_NFCPAD_OUT_8821C(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_OUT_8821C) & BIT_MASK_NFCPAD_OUT_8821C) -+#define BIT_SET_NFCPAD_OUT_8821C(x, v) \ -+ (BIT_CLEAR_NFCPAD_OUT_8821C(x) | BIT_NFCPAD_OUT_8821C(v)) -+ -+#define BIT_SHIFT_NFCPAD_IN_8821C 0 -+#define BIT_MASK_NFCPAD_IN_8821C 0xf -+#define BIT_NFCPAD_IN_8821C(x) \ -+ (((x) & BIT_MASK_NFCPAD_IN_8821C) << BIT_SHIFT_NFCPAD_IN_8821C) -+#define BITS_NFCPAD_IN_8821C \ -+ (BIT_MASK_NFCPAD_IN_8821C << BIT_SHIFT_NFCPAD_IN_8821C) -+#define BIT_CLEAR_NFCPAD_IN_8821C(x) ((x) & (~BITS_NFCPAD_IN_8821C)) -+#define BIT_GET_NFCPAD_IN_8821C(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_IN_8821C) & BIT_MASK_NFCPAD_IN_8821C) -+#define BIT_SET_NFCPAD_IN_8821C(x, v) \ -+ (BIT_CLEAR_NFCPAD_IN_8821C(x) | BIT_NFCPAD_IN_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_HIMR2_8821C */ -+#define BIT_BCNDMAINT_P4_MSK_8821C BIT(31) -+#define BIT_BCNDMAINT_P3_MSK_8821C BIT(30) -+#define BIT_BCNDMAINT_P2_MSK_8821C BIT(29) -+#define BIT_BCNDMAINT_P1_MSK_8821C BIT(28) -+#define BIT_ATIMEND7_MSK_8821C BIT(22) -+#define BIT_ATIMEND6_MSK_8821C BIT(21) -+#define BIT_ATIMEND5_MSK_8821C BIT(20) -+#define BIT_ATIMEND4_MSK_8821C BIT(19) -+#define BIT_ATIMEND3_MSK_8821C BIT(18) -+#define BIT_ATIMEND2_MSK_8821C BIT(17) -+#define BIT_ATIMEND1_MSK_8821C BIT(16) -+#define BIT_TXBCN7OK_MSK_8821C BIT(14) -+#define BIT_TXBCN6OK_MSK_8821C BIT(13) -+#define BIT_TXBCN5OK_MSK_8821C BIT(12) -+#define BIT_TXBCN4OK_MSK_8821C BIT(11) -+#define BIT_TXBCN3OK_MSK_8821C BIT(10) -+#define BIT_TXBCN2OK_MSK_8821C BIT(9) -+#define BIT_TXBCN1OK_MSK_V1_8821C BIT(8) -+#define BIT_TXBCN7ERR_MSK_8821C BIT(6) -+#define BIT_TXBCN6ERR_MSK_8821C BIT(5) -+#define BIT_TXBCN5ERR_MSK_8821C BIT(4) -+#define BIT_TXBCN4ERR_MSK_8821C BIT(3) -+#define BIT_TXBCN3ERR_MSK_8821C BIT(2) -+#define BIT_TXBCN2ERR_MSK_8821C BIT(1) -+#define BIT_TXBCN1ERR_MSK_V1_8821C BIT(0) -+ -+/* 2 REG_HISR2_8821C */ -+#define BIT_BCNDMAINT_P4_8821C BIT(31) -+#define BIT_BCNDMAINT_P3_8821C BIT(30) -+#define BIT_BCNDMAINT_P2_8821C BIT(29) -+#define BIT_BCNDMAINT_P1_8821C BIT(28) -+#define BIT_ATIMEND7_8821C BIT(22) -+#define BIT_ATIMEND6_8821C BIT(21) -+#define BIT_ATIMEND5_8821C BIT(20) -+#define BIT_ATIMEND4_8821C BIT(19) -+#define BIT_ATIMEND3_8821C BIT(18) -+#define BIT_ATIMEND2_8821C BIT(17) -+#define BIT_ATIMEND1_8821C BIT(16) -+#define BIT_TXBCN7OK_8821C BIT(14) -+#define BIT_TXBCN6OK_8821C BIT(13) -+#define BIT_TXBCN5OK_8821C BIT(12) -+#define BIT_TXBCN4OK_8821C BIT(11) -+#define BIT_TXBCN3OK_8821C BIT(10) -+#define BIT_TXBCN2OK_8821C BIT(9) -+#define BIT_TXBCN1OK_8821C BIT(8) -+#define BIT_TXBCN7ERR_8821C BIT(6) -+#define BIT_TXBCN6ERR_8821C BIT(5) -+#define BIT_TXBCN5ERR_8821C BIT(4) -+#define BIT_TXBCN4ERR_8821C BIT(3) -+#define BIT_TXBCN3ERR_8821C BIT(2) -+#define BIT_TXBCN2ERR_8821C BIT(1) -+#define BIT_TXBCN1ERR_8821C BIT(0) -+ -+/* 2 REG_HIMR3_8821C */ -+#define BIT_WDT_PLATFORM_INT_MSK_8821C BIT(18) -+#define BIT_WDT_CPU_INT_MSK_8821C BIT(17) -+#define BIT_SETH2CDOK_MASK_8821C BIT(16) -+#define BIT_H2C_CMD_FULL_MASK_8821C BIT(15) -+#define BIT_PWR_INT_127_MASK_8821C BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_MASK_8821C BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_MASK_8821C BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_MASK_8821C BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_MAS_8821C BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_MASK_8821C BIT(9) -+#define BIT_PWR_INT_127_MASK_V1_8821C BIT(8) -+#define BIT_PWR_INT_126TO96_MASK_8821C BIT(7) -+#define BIT_PWR_INT_95TO64_MASK_8821C BIT(6) -+#define BIT_PWR_INT_63TO32_MASK_8821C BIT(5) -+#define BIT_PWR_INT_31TO0_MASK_8821C BIT(4) -+#define BIT_DDMA0_LP_INT_MSK_8821C BIT(1) -+#define BIT_DDMA0_HP_INT_MSK_8821C BIT(0) -+ -+/* 2 REG_HISR3_8821C */ -+#define BIT_WDT_PLATFORM_INT_8821C BIT(18) -+#define BIT_WDT_CPU_INT_8821C BIT(17) -+#define BIT_SETH2CDOK_8821C BIT(16) -+#define BIT_H2C_CMD_FULL_8821C BIT(15) -+#define BIT_PWR_INT_127_8821C BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_8821C BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_8821C BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_8821C BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_8821C BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_8821C BIT(9) -+#define BIT_PWR_INT_127_V1_8821C BIT(8) -+#define BIT_PWR_INT_126TO96_8821C BIT(7) -+#define BIT_PWR_INT_95TO64_8821C BIT(6) -+#define BIT_PWR_INT_63TO32_8821C BIT(5) -+#define BIT_PWR_INT_31TO0_8821C BIT(4) -+#define BIT_DDMA0_LP_INT_8821C BIT(1) -+#define BIT_DDMA0_HP_INT_8821C BIT(0) -+ -+/* 2 REG_SW_MDIO_8821C */ -+#define BIT_DIS_TIMEOUT_IO_8821C BIT(24) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_H2C_PKT_READADDR_8821C */ -+ -+#define BIT_SHIFT_H2C_PKT_READADDR_8821C 0 -+#define BIT_MASK_H2C_PKT_READADDR_8821C 0x3ffff -+#define BIT_H2C_PKT_READADDR_8821C(x) \ -+ (((x) & BIT_MASK_H2C_PKT_READADDR_8821C) \ -+ << BIT_SHIFT_H2C_PKT_READADDR_8821C) -+#define BITS_H2C_PKT_READADDR_8821C \ -+ (BIT_MASK_H2C_PKT_READADDR_8821C << BIT_SHIFT_H2C_PKT_READADDR_8821C) -+#define BIT_CLEAR_H2C_PKT_READADDR_8821C(x) \ -+ ((x) & (~BITS_H2C_PKT_READADDR_8821C)) -+#define BIT_GET_H2C_PKT_READADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_READADDR_8821C) & \ -+ BIT_MASK_H2C_PKT_READADDR_8821C) -+#define BIT_SET_H2C_PKT_READADDR_8821C(x, v) \ -+ (BIT_CLEAR_H2C_PKT_READADDR_8821C(x) | BIT_H2C_PKT_READADDR_8821C(v)) -+ -+/* 2 REG_H2C_PKT_WRITEADDR_8821C */ -+ -+#define BIT_SHIFT_H2C_PKT_WRITEADDR_8821C 0 -+#define BIT_MASK_H2C_PKT_WRITEADDR_8821C 0x3ffff -+#define BIT_H2C_PKT_WRITEADDR_8821C(x) \ -+ (((x) & BIT_MASK_H2C_PKT_WRITEADDR_8821C) \ -+ << BIT_SHIFT_H2C_PKT_WRITEADDR_8821C) -+#define BITS_H2C_PKT_WRITEADDR_8821C \ -+ (BIT_MASK_H2C_PKT_WRITEADDR_8821C << BIT_SHIFT_H2C_PKT_WRITEADDR_8821C) -+#define BIT_CLEAR_H2C_PKT_WRITEADDR_8821C(x) \ -+ ((x) & (~BITS_H2C_PKT_WRITEADDR_8821C)) -+#define BIT_GET_H2C_PKT_WRITEADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_WRITEADDR_8821C) & \ -+ BIT_MASK_H2C_PKT_WRITEADDR_8821C) -+#define BIT_SET_H2C_PKT_WRITEADDR_8821C(x, v) \ -+ (BIT_CLEAR_H2C_PKT_WRITEADDR_8821C(x) | BIT_H2C_PKT_WRITEADDR_8821C(v)) -+ -+/* 2 REG_MEM_PWR_CRTL_8821C */ -+#define BIT_MEM_BB_SD_8821C BIT(17) -+#define BIT_MEM_BB_DS_8821C BIT(16) -+#define BIT_MEM_BT_DS_8821C BIT(10) -+#define BIT_MEM_SDIO_LS_8821C BIT(9) -+#define BIT_MEM_SDIO_DS_8821C BIT(8) -+#define BIT_MEM_USB_LS_8821C BIT(7) -+#define BIT_MEM_USB_DS_8821C BIT(6) -+#define BIT_MEM_PCI_LS_8821C BIT(5) -+#define BIT_MEM_PCI_DS_8821C BIT(4) -+#define BIT_MEM_WLMAC_LS_8821C BIT(3) -+#define BIT_MEM_WLMAC_DS_8821C BIT(2) -+#define BIT_MEM_WLMCU_LS_8821C BIT(1) -+#define BIT_MEM_WLMCU_DS_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_FW_DBG6_8821C */ -+ -+#define BIT_SHIFT_FW_DBG6_8821C 0 -+#define BIT_MASK_FW_DBG6_8821C 0xffffffffL -+#define BIT_FW_DBG6_8821C(x) \ -+ (((x) & BIT_MASK_FW_DBG6_8821C) << BIT_SHIFT_FW_DBG6_8821C) -+#define BITS_FW_DBG6_8821C (BIT_MASK_FW_DBG6_8821C << BIT_SHIFT_FW_DBG6_8821C) -+#define BIT_CLEAR_FW_DBG6_8821C(x) ((x) & (~BITS_FW_DBG6_8821C)) -+#define BIT_GET_FW_DBG6_8821C(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG6_8821C) & BIT_MASK_FW_DBG6_8821C) -+#define BIT_SET_FW_DBG6_8821C(x, v) \ -+ (BIT_CLEAR_FW_DBG6_8821C(x) | BIT_FW_DBG6_8821C(v)) -+ -+/* 2 REG_FW_DBG7_8821C */ -+ -+#define BIT_SHIFT_FW_DBG7_8821C 0 -+#define BIT_MASK_FW_DBG7_8821C 0xffffffffL -+#define BIT_FW_DBG7_8821C(x) \ -+ (((x) & BIT_MASK_FW_DBG7_8821C) << BIT_SHIFT_FW_DBG7_8821C) -+#define BITS_FW_DBG7_8821C (BIT_MASK_FW_DBG7_8821C << BIT_SHIFT_FW_DBG7_8821C) -+#define BIT_CLEAR_FW_DBG7_8821C(x) ((x) & (~BITS_FW_DBG7_8821C)) -+#define BIT_GET_FW_DBG7_8821C(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG7_8821C) & BIT_MASK_FW_DBG7_8821C) -+#define BIT_SET_FW_DBG7_8821C(x, v) \ -+ (BIT_CLEAR_FW_DBG7_8821C(x) | BIT_FW_DBG7_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_CR_8821C */ -+ -+#define BIT_SHIFT_LBMODE_8821C 24 -+#define BIT_MASK_LBMODE_8821C 0x1f -+#define BIT_LBMODE_8821C(x) \ -+ (((x) & BIT_MASK_LBMODE_8821C) << BIT_SHIFT_LBMODE_8821C) -+#define BITS_LBMODE_8821C (BIT_MASK_LBMODE_8821C << BIT_SHIFT_LBMODE_8821C) -+#define BIT_CLEAR_LBMODE_8821C(x) ((x) & (~BITS_LBMODE_8821C)) -+#define BIT_GET_LBMODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_LBMODE_8821C) & BIT_MASK_LBMODE_8821C) -+#define BIT_SET_LBMODE_8821C(x, v) \ -+ (BIT_CLEAR_LBMODE_8821C(x) | BIT_LBMODE_8821C(v)) -+ -+#define BIT_SHIFT_NETYPE1_8821C 18 -+#define BIT_MASK_NETYPE1_8821C 0x3 -+#define BIT_NETYPE1_8821C(x) \ -+ (((x) & BIT_MASK_NETYPE1_8821C) << BIT_SHIFT_NETYPE1_8821C) -+#define BITS_NETYPE1_8821C (BIT_MASK_NETYPE1_8821C << BIT_SHIFT_NETYPE1_8821C) -+#define BIT_CLEAR_NETYPE1_8821C(x) ((x) & (~BITS_NETYPE1_8821C)) -+#define BIT_GET_NETYPE1_8821C(x) \ -+ (((x) >> BIT_SHIFT_NETYPE1_8821C) & BIT_MASK_NETYPE1_8821C) -+#define BIT_SET_NETYPE1_8821C(x, v) \ -+ (BIT_CLEAR_NETYPE1_8821C(x) | BIT_NETYPE1_8821C(v)) -+ -+#define BIT_SHIFT_NETYPE0_8821C 16 -+#define BIT_MASK_NETYPE0_8821C 0x3 -+#define BIT_NETYPE0_8821C(x) \ -+ (((x) & BIT_MASK_NETYPE0_8821C) << BIT_SHIFT_NETYPE0_8821C) -+#define BITS_NETYPE0_8821C (BIT_MASK_NETYPE0_8821C << BIT_SHIFT_NETYPE0_8821C) -+#define BIT_CLEAR_NETYPE0_8821C(x) ((x) & (~BITS_NETYPE0_8821C)) -+#define BIT_GET_NETYPE0_8821C(x) \ -+ (((x) >> BIT_SHIFT_NETYPE0_8821C) & BIT_MASK_NETYPE0_8821C) -+#define BIT_SET_NETYPE0_8821C(x, v) \ -+ (BIT_CLEAR_NETYPE0_8821C(x) | BIT_NETYPE0_8821C(v)) -+ -+#define BIT_COUNTER_STS_EN_8821C BIT(13) -+#define BIT_I2C_MAILBOX_EN_8821C BIT(12) -+#define BIT_SHCUT_EN_8821C BIT(11) -+#define BIT_32K_CAL_TMR_EN_8821C BIT(10) -+#define BIT_MAC_SEC_EN_8821C BIT(9) -+#define BIT_ENSWBCN_8821C BIT(8) -+#define BIT_MACRXEN_8821C BIT(7) -+#define BIT_MACTXEN_8821C BIT(6) -+#define BIT_SCHEDULE_EN_8821C BIT(5) -+#define BIT_PROTOCOL_EN_8821C BIT(4) -+#define BIT_RXDMA_EN_8821C BIT(3) -+#define BIT_TXDMA_EN_8821C BIT(2) -+#define BIT_HCI_RXDMA_EN_8821C BIT(1) -+#define BIT_HCI_TXDMA_EN_8821C BIT(0) -+ -+/* 2 REG_PG_SIZE_8821C */ -+ -+#define BIT_SHIFT_DBG_FIFO_SEL_8821C 16 -+#define BIT_MASK_DBG_FIFO_SEL_8821C 0xff -+#define BIT_DBG_FIFO_SEL_8821C(x) \ -+ (((x) & BIT_MASK_DBG_FIFO_SEL_8821C) << BIT_SHIFT_DBG_FIFO_SEL_8821C) -+#define BITS_DBG_FIFO_SEL_8821C \ -+ (BIT_MASK_DBG_FIFO_SEL_8821C << BIT_SHIFT_DBG_FIFO_SEL_8821C) -+#define BIT_CLEAR_DBG_FIFO_SEL_8821C(x) ((x) & (~BITS_DBG_FIFO_SEL_8821C)) -+#define BIT_GET_DBG_FIFO_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_DBG_FIFO_SEL_8821C) & BIT_MASK_DBG_FIFO_SEL_8821C) -+#define BIT_SET_DBG_FIFO_SEL_8821C(x, v) \ -+ (BIT_CLEAR_DBG_FIFO_SEL_8821C(x) | BIT_DBG_FIFO_SEL_8821C(v)) -+ -+/* 2 REG_PKT_BUFF_ACCESS_CTRL_8821C */ -+ -+#define BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8821C 0 -+#define BIT_MASK_PKT_BUFF_ACCESS_CTRL_8821C 0xff -+#define BIT_PKT_BUFF_ACCESS_CTRL_8821C(x) \ -+ (((x) & BIT_MASK_PKT_BUFF_ACCESS_CTRL_8821C) \ -+ << BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8821C) -+#define BITS_PKT_BUFF_ACCESS_CTRL_8821C \ -+ (BIT_MASK_PKT_BUFF_ACCESS_CTRL_8821C \ -+ << BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8821C) -+#define BIT_CLEAR_PKT_BUFF_ACCESS_CTRL_8821C(x) \ -+ ((x) & (~BITS_PKT_BUFF_ACCESS_CTRL_8821C)) -+#define BIT_GET_PKT_BUFF_ACCESS_CTRL_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8821C) & \ -+ BIT_MASK_PKT_BUFF_ACCESS_CTRL_8821C) -+#define BIT_SET_PKT_BUFF_ACCESS_CTRL_8821C(x, v) \ -+ (BIT_CLEAR_PKT_BUFF_ACCESS_CTRL_8821C(x) | \ -+ BIT_PKT_BUFF_ACCESS_CTRL_8821C(v)) -+ -+/* 2 REG_TSF_CLK_STATE_8821C */ -+#define BIT_TSF_CLK_STABLE_8821C BIT(15) -+ -+/* 2 REG_TXDMA_PQ_MAP_8821C */ -+ -+#define BIT_SHIFT_TXDMA_H2C_MAP_8821C 16 -+#define BIT_MASK_TXDMA_H2C_MAP_8821C 0x3 -+#define BIT_TXDMA_H2C_MAP_8821C(x) \ -+ (((x) & BIT_MASK_TXDMA_H2C_MAP_8821C) << BIT_SHIFT_TXDMA_H2C_MAP_8821C) -+#define BITS_TXDMA_H2C_MAP_8821C \ -+ (BIT_MASK_TXDMA_H2C_MAP_8821C << BIT_SHIFT_TXDMA_H2C_MAP_8821C) -+#define BIT_CLEAR_TXDMA_H2C_MAP_8821C(x) ((x) & (~BITS_TXDMA_H2C_MAP_8821C)) -+#define BIT_GET_TXDMA_H2C_MAP_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_H2C_MAP_8821C) & BIT_MASK_TXDMA_H2C_MAP_8821C) -+#define BIT_SET_TXDMA_H2C_MAP_8821C(x, v) \ -+ (BIT_CLEAR_TXDMA_H2C_MAP_8821C(x) | BIT_TXDMA_H2C_MAP_8821C(v)) -+ -+#define BIT_SHIFT_TXDMA_HIQ_MAP_8821C 14 -+#define BIT_MASK_TXDMA_HIQ_MAP_8821C 0x3 -+#define BIT_TXDMA_HIQ_MAP_8821C(x) \ -+ (((x) & BIT_MASK_TXDMA_HIQ_MAP_8821C) << BIT_SHIFT_TXDMA_HIQ_MAP_8821C) -+#define BITS_TXDMA_HIQ_MAP_8821C \ -+ (BIT_MASK_TXDMA_HIQ_MAP_8821C << BIT_SHIFT_TXDMA_HIQ_MAP_8821C) -+#define BIT_CLEAR_TXDMA_HIQ_MAP_8821C(x) ((x) & (~BITS_TXDMA_HIQ_MAP_8821C)) -+#define BIT_GET_TXDMA_HIQ_MAP_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_HIQ_MAP_8821C) & BIT_MASK_TXDMA_HIQ_MAP_8821C) -+#define BIT_SET_TXDMA_HIQ_MAP_8821C(x, v) \ -+ (BIT_CLEAR_TXDMA_HIQ_MAP_8821C(x) | BIT_TXDMA_HIQ_MAP_8821C(v)) -+ -+#define BIT_SHIFT_TXDMA_MGQ_MAP_8821C 12 -+#define BIT_MASK_TXDMA_MGQ_MAP_8821C 0x3 -+#define BIT_TXDMA_MGQ_MAP_8821C(x) \ -+ (((x) & BIT_MASK_TXDMA_MGQ_MAP_8821C) << BIT_SHIFT_TXDMA_MGQ_MAP_8821C) -+#define BITS_TXDMA_MGQ_MAP_8821C \ -+ (BIT_MASK_TXDMA_MGQ_MAP_8821C << BIT_SHIFT_TXDMA_MGQ_MAP_8821C) -+#define BIT_CLEAR_TXDMA_MGQ_MAP_8821C(x) ((x) & (~BITS_TXDMA_MGQ_MAP_8821C)) -+#define BIT_GET_TXDMA_MGQ_MAP_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_MGQ_MAP_8821C) & BIT_MASK_TXDMA_MGQ_MAP_8821C) -+#define BIT_SET_TXDMA_MGQ_MAP_8821C(x, v) \ -+ (BIT_CLEAR_TXDMA_MGQ_MAP_8821C(x) | BIT_TXDMA_MGQ_MAP_8821C(v)) -+ -+#define BIT_SHIFT_TXDMA_BKQ_MAP_8821C 10 -+#define BIT_MASK_TXDMA_BKQ_MAP_8821C 0x3 -+#define BIT_TXDMA_BKQ_MAP_8821C(x) \ -+ (((x) & BIT_MASK_TXDMA_BKQ_MAP_8821C) << BIT_SHIFT_TXDMA_BKQ_MAP_8821C) -+#define BITS_TXDMA_BKQ_MAP_8821C \ -+ (BIT_MASK_TXDMA_BKQ_MAP_8821C << BIT_SHIFT_TXDMA_BKQ_MAP_8821C) -+#define BIT_CLEAR_TXDMA_BKQ_MAP_8821C(x) ((x) & (~BITS_TXDMA_BKQ_MAP_8821C)) -+#define BIT_GET_TXDMA_BKQ_MAP_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BKQ_MAP_8821C) & BIT_MASK_TXDMA_BKQ_MAP_8821C) -+#define BIT_SET_TXDMA_BKQ_MAP_8821C(x, v) \ -+ (BIT_CLEAR_TXDMA_BKQ_MAP_8821C(x) | BIT_TXDMA_BKQ_MAP_8821C(v)) -+ -+#define BIT_SHIFT_TXDMA_BEQ_MAP_8821C 8 -+#define BIT_MASK_TXDMA_BEQ_MAP_8821C 0x3 -+#define BIT_TXDMA_BEQ_MAP_8821C(x) \ -+ (((x) & BIT_MASK_TXDMA_BEQ_MAP_8821C) << BIT_SHIFT_TXDMA_BEQ_MAP_8821C) -+#define BITS_TXDMA_BEQ_MAP_8821C \ -+ (BIT_MASK_TXDMA_BEQ_MAP_8821C << BIT_SHIFT_TXDMA_BEQ_MAP_8821C) -+#define BIT_CLEAR_TXDMA_BEQ_MAP_8821C(x) ((x) & (~BITS_TXDMA_BEQ_MAP_8821C)) -+#define BIT_GET_TXDMA_BEQ_MAP_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BEQ_MAP_8821C) & BIT_MASK_TXDMA_BEQ_MAP_8821C) -+#define BIT_SET_TXDMA_BEQ_MAP_8821C(x, v) \ -+ (BIT_CLEAR_TXDMA_BEQ_MAP_8821C(x) | BIT_TXDMA_BEQ_MAP_8821C(v)) -+ -+#define BIT_SHIFT_TXDMA_VIQ_MAP_8821C 6 -+#define BIT_MASK_TXDMA_VIQ_MAP_8821C 0x3 -+#define BIT_TXDMA_VIQ_MAP_8821C(x) \ -+ (((x) & BIT_MASK_TXDMA_VIQ_MAP_8821C) << BIT_SHIFT_TXDMA_VIQ_MAP_8821C) -+#define BITS_TXDMA_VIQ_MAP_8821C \ -+ (BIT_MASK_TXDMA_VIQ_MAP_8821C << BIT_SHIFT_TXDMA_VIQ_MAP_8821C) -+#define BIT_CLEAR_TXDMA_VIQ_MAP_8821C(x) ((x) & (~BITS_TXDMA_VIQ_MAP_8821C)) -+#define BIT_GET_TXDMA_VIQ_MAP_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VIQ_MAP_8821C) & BIT_MASK_TXDMA_VIQ_MAP_8821C) -+#define BIT_SET_TXDMA_VIQ_MAP_8821C(x, v) \ -+ (BIT_CLEAR_TXDMA_VIQ_MAP_8821C(x) | BIT_TXDMA_VIQ_MAP_8821C(v)) -+ -+#define BIT_SHIFT_TXDMA_VOQ_MAP_8821C 4 -+#define BIT_MASK_TXDMA_VOQ_MAP_8821C 0x3 -+#define BIT_TXDMA_VOQ_MAP_8821C(x) \ -+ (((x) & BIT_MASK_TXDMA_VOQ_MAP_8821C) << BIT_SHIFT_TXDMA_VOQ_MAP_8821C) -+#define BITS_TXDMA_VOQ_MAP_8821C \ -+ (BIT_MASK_TXDMA_VOQ_MAP_8821C << BIT_SHIFT_TXDMA_VOQ_MAP_8821C) -+#define BIT_CLEAR_TXDMA_VOQ_MAP_8821C(x) ((x) & (~BITS_TXDMA_VOQ_MAP_8821C)) -+#define BIT_GET_TXDMA_VOQ_MAP_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VOQ_MAP_8821C) & BIT_MASK_TXDMA_VOQ_MAP_8821C) -+#define BIT_SET_TXDMA_VOQ_MAP_8821C(x, v) \ -+ (BIT_CLEAR_TXDMA_VOQ_MAP_8821C(x) | BIT_TXDMA_VOQ_MAP_8821C(v)) -+ -+#define BIT_RXDMA_AGG_EN_8821C BIT(2) -+#define BIT_RXSHFT_EN_8821C BIT(1) -+#define BIT_RXDMA_ARBBW_EN_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_TRXFF_BNDY_8821C */ -+ -+#define BIT_SHIFT_RXFFOVFL_RSV_V2_8821C 8 -+#define BIT_MASK_RXFFOVFL_RSV_V2_8821C 0xf -+#define BIT_RXFFOVFL_RSV_V2_8821C(x) \ -+ (((x) & BIT_MASK_RXFFOVFL_RSV_V2_8821C) \ -+ << BIT_SHIFT_RXFFOVFL_RSV_V2_8821C) -+#define BITS_RXFFOVFL_RSV_V2_8821C \ -+ (BIT_MASK_RXFFOVFL_RSV_V2_8821C << BIT_SHIFT_RXFFOVFL_RSV_V2_8821C) -+#define BIT_CLEAR_RXFFOVFL_RSV_V2_8821C(x) ((x) & (~BITS_RXFFOVFL_RSV_V2_8821C)) -+#define BIT_GET_RXFFOVFL_RSV_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXFFOVFL_RSV_V2_8821C) & \ -+ BIT_MASK_RXFFOVFL_RSV_V2_8821C) -+#define BIT_SET_RXFFOVFL_RSV_V2_8821C(x, v) \ -+ (BIT_CLEAR_RXFFOVFL_RSV_V2_8821C(x) | BIT_RXFFOVFL_RSV_V2_8821C(v)) -+ -+/* 2 REG_PTA_I2C_MBOX_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_I2C_M_STATUS_8821C 8 -+#define BIT_MASK_I2C_M_STATUS_8821C 0xf -+#define BIT_I2C_M_STATUS_8821C(x) \ -+ (((x) & BIT_MASK_I2C_M_STATUS_8821C) << BIT_SHIFT_I2C_M_STATUS_8821C) -+#define BITS_I2C_M_STATUS_8821C \ -+ (BIT_MASK_I2C_M_STATUS_8821C << BIT_SHIFT_I2C_M_STATUS_8821C) -+#define BIT_CLEAR_I2C_M_STATUS_8821C(x) ((x) & (~BITS_I2C_M_STATUS_8821C)) -+#define BIT_GET_I2C_M_STATUS_8821C(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_STATUS_8821C) & BIT_MASK_I2C_M_STATUS_8821C) -+#define BIT_SET_I2C_M_STATUS_8821C(x, v) \ -+ (BIT_CLEAR_I2C_M_STATUS_8821C(x) | BIT_I2C_M_STATUS_8821C(v)) -+ -+#define BIT_SHIFT_I2C_M_BUS_GNT_FW_8821C 4 -+#define BIT_MASK_I2C_M_BUS_GNT_FW_8821C 0x7 -+#define BIT_I2C_M_BUS_GNT_FW_8821C(x) \ -+ (((x) & BIT_MASK_I2C_M_BUS_GNT_FW_8821C) \ -+ << BIT_SHIFT_I2C_M_BUS_GNT_FW_8821C) -+#define BITS_I2C_M_BUS_GNT_FW_8821C \ -+ (BIT_MASK_I2C_M_BUS_GNT_FW_8821C << BIT_SHIFT_I2C_M_BUS_GNT_FW_8821C) -+#define BIT_CLEAR_I2C_M_BUS_GNT_FW_8821C(x) \ -+ ((x) & (~BITS_I2C_M_BUS_GNT_FW_8821C)) -+#define BIT_GET_I2C_M_BUS_GNT_FW_8821C(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_BUS_GNT_FW_8821C) & \ -+ BIT_MASK_I2C_M_BUS_GNT_FW_8821C) -+#define BIT_SET_I2C_M_BUS_GNT_FW_8821C(x, v) \ -+ (BIT_CLEAR_I2C_M_BUS_GNT_FW_8821C(x) | BIT_I2C_M_BUS_GNT_FW_8821C(v)) -+ -+#define BIT_I2C_M_GNT_FW_8821C BIT(3) -+ -+#define BIT_SHIFT_I2C_M_SPEED_8821C 1 -+#define BIT_MASK_I2C_M_SPEED_8821C 0x3 -+#define BIT_I2C_M_SPEED_8821C(x) \ -+ (((x) & BIT_MASK_I2C_M_SPEED_8821C) << BIT_SHIFT_I2C_M_SPEED_8821C) -+#define BITS_I2C_M_SPEED_8821C \ -+ (BIT_MASK_I2C_M_SPEED_8821C << BIT_SHIFT_I2C_M_SPEED_8821C) -+#define BIT_CLEAR_I2C_M_SPEED_8821C(x) ((x) & (~BITS_I2C_M_SPEED_8821C)) -+#define BIT_GET_I2C_M_SPEED_8821C(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_SPEED_8821C) & BIT_MASK_I2C_M_SPEED_8821C) -+#define BIT_SET_I2C_M_SPEED_8821C(x, v) \ -+ (BIT_CLEAR_I2C_M_SPEED_8821C(x) | BIT_I2C_M_SPEED_8821C(v)) -+ -+#define BIT_I2C_M_UNLOCK_8821C BIT(0) -+ -+/* 2 REG_RXFF_BNDY_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_RXFF0_BNDY_V2_8821C 0 -+#define BIT_MASK_RXFF0_BNDY_V2_8821C 0x3ffff -+#define BIT_RXFF0_BNDY_V2_8821C(x) \ -+ (((x) & BIT_MASK_RXFF0_BNDY_V2_8821C) << BIT_SHIFT_RXFF0_BNDY_V2_8821C) -+#define BITS_RXFF0_BNDY_V2_8821C \ -+ (BIT_MASK_RXFF0_BNDY_V2_8821C << BIT_SHIFT_RXFF0_BNDY_V2_8821C) -+#define BIT_CLEAR_RXFF0_BNDY_V2_8821C(x) ((x) & (~BITS_RXFF0_BNDY_V2_8821C)) -+#define BIT_GET_RXFF0_BNDY_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_BNDY_V2_8821C) & BIT_MASK_RXFF0_BNDY_V2_8821C) -+#define BIT_SET_RXFF0_BNDY_V2_8821C(x, v) \ -+ (BIT_CLEAR_RXFF0_BNDY_V2_8821C(x) | BIT_RXFF0_BNDY_V2_8821C(v)) -+ -+/* 2 REG_FE1IMR_8821C */ -+#define BIT_FS_RXDMA2_DONE_INT_EN_8821C BIT(28) -+#define BIT_FS_RXDONE3_INT_EN_8821C BIT(27) -+#define BIT_FS_RXDONE2_INT_EN_8821C BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_EN_8821C BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_EN_8821C BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_EN_8821C BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_EN_8821C BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_EN_8821C BIT(21) -+#define BIT_FS_RX_UMD0_INT_EN_8821C BIT(20) -+#define BIT_FS_RX_UMD1_INT_EN_8821C BIT(19) -+#define BIT_FS_RX_BMD0_INT_EN_8821C BIT(18) -+#define BIT_FS_RX_BMD1_INT_EN_8821C BIT(17) -+#define BIT_FS_RXDONE_INT_EN_8821C BIT(16) -+#define BIT_FS_WWLAN_INT_EN_8821C BIT(15) -+#define BIT_FS_SOUND_DONE_INT_EN_8821C BIT(14) -+#define BIT_FS_LP_STBY_INT_EN_8821C BIT(13) -+#define BIT_FS_TRL_MTR_INT_EN_8821C BIT(12) -+#define BIT_FS_BF1_PRETO_INT_EN_8821C BIT(11) -+#define BIT_FS_BF0_PRETO_INT_EN_8821C BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_EN_8821C BIT(9) -+#define BIT_FS_LTE_COEX_EN_8821C BIT(6) -+#define BIT_FS_WLACTOFF_INT_EN_8821C BIT(5) -+#define BIT_FS_WLACTON_INT_EN_8821C BIT(4) -+#define BIT_FS_BTCMD_INT_EN_8821C BIT(3) -+#define BIT_FS_REG_MAILBOX_TO_I2C_INT_EN_8821C BIT(2) -+#define BIT_FS_TRPC_TO_INT_EN_V1_8821C BIT(1) -+#define BIT_FS_RPC_O_T_INT_EN_V1_8821C BIT(0) -+ -+/* 2 REG_FE1ISR_8821C */ -+#define BIT_FS_RXDMA2_DONE_INT_8821C BIT(28) -+#define BIT_FS_RXDONE3_INT_8821C BIT(27) -+#define BIT_FS_RXDONE2_INT_8821C BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_8821C BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_8821C BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_8821C BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_8821C BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_8821C BIT(21) -+#define BIT_FS_RX_UMD0_INT_8821C BIT(20) -+#define BIT_FS_RX_UMD1_INT_8821C BIT(19) -+#define BIT_FS_RX_BMD0_INT_8821C BIT(18) -+#define BIT_FS_RX_BMD1_INT_8821C BIT(17) -+#define BIT_FS_RXDONE_INT_8821C BIT(16) -+#define BIT_FS_WWLAN_INT_8821C BIT(15) -+#define BIT_FS_SOUND_DONE_INT_8821C BIT(14) -+#define BIT_FS_LP_STBY_INT_8821C BIT(13) -+#define BIT_FS_TRL_MTR_INT_8821C BIT(12) -+#define BIT_FS_BF1_PRETO_INT_8821C BIT(11) -+#define BIT_FS_BF0_PRETO_INT_8821C BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_8821C BIT(9) -+#define BIT_FS_LTE_COEX_INT_8821C BIT(6) -+#define BIT_FS_WLACTOFF_INT_8821C BIT(5) -+#define BIT_FS_WLACTON_INT_8821C BIT(4) -+#define BIT_FS_BCN_RX_INT_INT_8821C BIT(3) -+#define BIT_FS_MAILBOX_TO_I2C_INT_8821C BIT(2) -+#define BIT_FS_TRPC_TO_INT_8821C BIT(1) -+#define BIT_FS_RPC_O_T_INT_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_CPWM_8821C */ -+#define BIT_CPWM_TOGGLING_8821C BIT(31) -+ -+#define BIT_SHIFT_CPWM_MOD_8821C 24 -+#define BIT_MASK_CPWM_MOD_8821C 0x7f -+#define BIT_CPWM_MOD_8821C(x) \ -+ (((x) & BIT_MASK_CPWM_MOD_8821C) << BIT_SHIFT_CPWM_MOD_8821C) -+#define BITS_CPWM_MOD_8821C \ -+ (BIT_MASK_CPWM_MOD_8821C << BIT_SHIFT_CPWM_MOD_8821C) -+#define BIT_CLEAR_CPWM_MOD_8821C(x) ((x) & (~BITS_CPWM_MOD_8821C)) -+#define BIT_GET_CPWM_MOD_8821C(x) \ -+ (((x) >> BIT_SHIFT_CPWM_MOD_8821C) & BIT_MASK_CPWM_MOD_8821C) -+#define BIT_SET_CPWM_MOD_8821C(x, v) \ -+ (BIT_CLEAR_CPWM_MOD_8821C(x) | BIT_CPWM_MOD_8821C(v)) -+ -+/* 2 REG_FWIMR_8821C */ -+#define BIT_FS_TXBCNOK_MB7_INT_EN_8821C BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_EN_8821C BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_EN_8821C BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_EN_8821C BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_EN_8821C BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_EN_8821C BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_EN_8821C BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_EN_8821C BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_EN_8821C BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_EN_8821C BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_EN_8821C BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_EN_8821C BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_EN_8821C BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_EN_8821C BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_EN_8821C BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_EN_8821C BIT(16) -+#define BIT_CPU_MGQ_TXDONE_INT_EN_8821C BIT(15) -+#define BIT_SIFS_OVERSPEC_INT_EN_8821C BIT(14) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_EN_8821C BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_EN_8821C BIT(12) -+#define BIT_FS_DDMA1_LP_INT_EN_8821C BIT(11) -+#define BIT_FS_DDMA1_HP_INT_EN_8821C BIT(10) -+#define BIT_FS_DDMA0_LP_INT_EN_8821C BIT(9) -+#define BIT_FS_DDMA0_HP_INT_EN_8821C BIT(8) -+#define BIT_FS_TRXRPT_INT_EN_8821C BIT(7) -+#define BIT_FS_C2H_W_READY_INT_EN_8821C BIT(6) -+#define BIT_FS_HRCV_INT_EN_8821C BIT(5) -+#define BIT_FS_H2CCMD_INT_EN_8821C BIT(4) -+#define BIT_FS_TXPKTIN_INT_EN_8821C BIT(3) -+#define BIT_FS_ERRORHDL_INT_EN_8821C BIT(2) -+#define BIT_FS_TXCCX_INT_EN_8821C BIT(1) -+#define BIT_FS_TXCLOSE_INT_EN_8821C BIT(0) -+ -+/* 2 REG_FWISR_8821C */ -+#define BIT_FS_TXBCNOK_MB7_INT_8821C BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_8821C BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_8821C BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_8821C BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_8821C BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_8821C BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_8821C BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_8821C BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_8821C BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_8821C BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_8821C BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_8821C BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_8821C BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_8821C BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_8821C BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_8821C BIT(16) -+#define BIT_CPU_MGQ_TXDONE_INT_8821C BIT(15) -+#define BIT_SIFS_OVERSPEC_INT_8821C BIT(14) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_8821C BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_8821C BIT(12) -+#define BIT_FS_DDMA1_LP_INT_8821C BIT(11) -+#define BIT_FS_DDMA1_HP_INT_8821C BIT(10) -+#define BIT_FS_DDMA0_LP_INT_8821C BIT(9) -+#define BIT_FS_DDMA0_HP_INT_8821C BIT(8) -+#define BIT_FS_TRXRPT_INT_8821C BIT(7) -+#define BIT_FS_C2H_W_READY_INT_8821C BIT(6) -+#define BIT_FS_HRCV_INT_8821C BIT(5) -+#define BIT_FS_H2CCMD_INT_8821C BIT(4) -+#define BIT_FS_TXPKTIN_INT_8821C BIT(3) -+#define BIT_FS_ERRORHDL_INT_8821C BIT(2) -+#define BIT_FS_TXCCX_INT_8821C BIT(1) -+#define BIT_FS_TXCLOSE_INT_8821C BIT(0) -+ -+/* 2 REG_FTIMR_8821C */ -+#define BIT_PS_TIMER_C_EARLY_INT_EN_8821C BIT(23) -+#define BIT_PS_TIMER_B_EARLY_INT_EN_8821C BIT(22) -+#define BIT_PS_TIMER_A_EARLY_INT_EN_8821C BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_EN_8821C BIT(20) -+#define BIT_PS_TIMER_C_INT_EN_8821C BIT(19) -+#define BIT_PS_TIMER_B_INT_EN_8821C BIT(18) -+#define BIT_PS_TIMER_A_INT_EN_8821C BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_EN_8821C BIT(16) -+#define BIT_FS_PS_TIMEOUT2_EN_8821C BIT(15) -+#define BIT_FS_PS_TIMEOUT1_EN_8821C BIT(14) -+#define BIT_FS_PS_TIMEOUT0_EN_8821C BIT(13) -+#define BIT_FS_GTINT8_EN_8821C BIT(8) -+#define BIT_FS_GTINT7_EN_8821C BIT(7) -+#define BIT_FS_GTINT6_EN_8821C BIT(6) -+#define BIT_FS_GTINT5_EN_8821C BIT(5) -+#define BIT_FS_GTINT4_EN_8821C BIT(4) -+#define BIT_FS_GTINT3_EN_8821C BIT(3) -+#define BIT_FS_GTINT2_EN_8821C BIT(2) -+#define BIT_FS_GTINT1_EN_8821C BIT(1) -+#define BIT_FS_GTINT0_EN_8821C BIT(0) -+ -+/* 2 REG_FTISR_8821C */ -+#define BIT_PS_TIMER_C_EARLY__INT_8821C BIT(23) -+#define BIT_PS_TIMER_B_EARLY__INT_8821C BIT(22) -+#define BIT_PS_TIMER_A_EARLY__INT_8821C BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_8821C BIT(20) -+#define BIT_PS_TIMER_C_INT_8821C BIT(19) -+#define BIT_PS_TIMER_B_INT_8821C BIT(18) -+#define BIT_PS_TIMER_A_INT_8821C BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_8821C BIT(16) -+#define BIT_FS_PS_TIMEOUT2_INT_8821C BIT(15) -+#define BIT_FS_PS_TIMEOUT1_INT_8821C BIT(14) -+#define BIT_FS_PS_TIMEOUT0_INT_8821C BIT(13) -+#define BIT_FS_GTINT8_INT_8821C BIT(8) -+#define BIT_FS_GTINT7_INT_8821C BIT(7) -+#define BIT_FS_GTINT6_INT_8821C BIT(6) -+#define BIT_FS_GTINT5_INT_8821C BIT(5) -+#define BIT_FS_GTINT4_INT_8821C BIT(4) -+#define BIT_FS_GTINT3_INT_8821C BIT(3) -+#define BIT_FS_GTINT2_INT_8821C BIT(2) -+#define BIT_FS_GTINT1_INT_8821C BIT(1) -+#define BIT_FS_GTINT0_INT_8821C BIT(0) -+ -+/* 2 REG_PKTBUF_DBG_CTRL_8821C */ -+ -+#define BIT_SHIFT_PKTBUF_WRITE_EN_8821C 24 -+#define BIT_MASK_PKTBUF_WRITE_EN_8821C 0xff -+#define BIT_PKTBUF_WRITE_EN_8821C(x) \ -+ (((x) & BIT_MASK_PKTBUF_WRITE_EN_8821C) \ -+ << BIT_SHIFT_PKTBUF_WRITE_EN_8821C) -+#define BITS_PKTBUF_WRITE_EN_8821C \ -+ (BIT_MASK_PKTBUF_WRITE_EN_8821C << BIT_SHIFT_PKTBUF_WRITE_EN_8821C) -+#define BIT_CLEAR_PKTBUF_WRITE_EN_8821C(x) ((x) & (~BITS_PKTBUF_WRITE_EN_8821C)) -+#define BIT_GET_PKTBUF_WRITE_EN_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_WRITE_EN_8821C) & \ -+ BIT_MASK_PKTBUF_WRITE_EN_8821C) -+#define BIT_SET_PKTBUF_WRITE_EN_8821C(x, v) \ -+ (BIT_CLEAR_PKTBUF_WRITE_EN_8821C(x) | BIT_PKTBUF_WRITE_EN_8821C(v)) -+ -+#define BIT_TXRPTBUF_DBG_8821C BIT(23) -+ -+/* 2 REG_NOT_VALID_8821C */ -+#define BIT_TXPKTBUF_DBG_V2_8821C BIT(20) -+#define BIT_RXPKTBUF_DBG_8821C BIT(16) -+ -+#define BIT_SHIFT_PKTBUF_DBG_ADDR_8821C 0 -+#define BIT_MASK_PKTBUF_DBG_ADDR_8821C 0x1fff -+#define BIT_PKTBUF_DBG_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_ADDR_8821C) \ -+ << BIT_SHIFT_PKTBUF_DBG_ADDR_8821C) -+#define BITS_PKTBUF_DBG_ADDR_8821C \ -+ (BIT_MASK_PKTBUF_DBG_ADDR_8821C << BIT_SHIFT_PKTBUF_DBG_ADDR_8821C) -+#define BIT_CLEAR_PKTBUF_DBG_ADDR_8821C(x) ((x) & (~BITS_PKTBUF_DBG_ADDR_8821C)) -+#define BIT_GET_PKTBUF_DBG_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_ADDR_8821C) & \ -+ BIT_MASK_PKTBUF_DBG_ADDR_8821C) -+#define BIT_SET_PKTBUF_DBG_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_ADDR_8821C(x) | BIT_PKTBUF_DBG_ADDR_8821C(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_L_8821C */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_L_8821C 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_L_8821C 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_L_8821C(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_L_8821C) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_L_8821C) -+#define BITS_PKTBUF_DBG_DATA_L_8821C \ -+ (BIT_MASK_PKTBUF_DBG_DATA_L_8821C << BIT_SHIFT_PKTBUF_DBG_DATA_L_8821C) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_L_8821C(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_L_8821C)) -+#define BIT_GET_PKTBUF_DBG_DATA_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_L_8821C) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_L_8821C) -+#define BIT_SET_PKTBUF_DBG_DATA_L_8821C(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_L_8821C(x) | BIT_PKTBUF_DBG_DATA_L_8821C(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_H_8821C */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_H_8821C 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_H_8821C 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_H_8821C(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_H_8821C) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_H_8821C) -+#define BITS_PKTBUF_DBG_DATA_H_8821C \ -+ (BIT_MASK_PKTBUF_DBG_DATA_H_8821C << BIT_SHIFT_PKTBUF_DBG_DATA_H_8821C) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_H_8821C(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_H_8821C)) -+#define BIT_GET_PKTBUF_DBG_DATA_H_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_H_8821C) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_H_8821C) -+#define BIT_SET_PKTBUF_DBG_DATA_H_8821C(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_H_8821C(x) | BIT_PKTBUF_DBG_DATA_H_8821C(v)) -+ -+/* 2 REG_CPWM2_8821C */ -+ -+#define BIT_SHIFT_L0S_TO_RCVY_NUM_8821C 16 -+#define BIT_MASK_L0S_TO_RCVY_NUM_8821C 0xff -+#define BIT_L0S_TO_RCVY_NUM_8821C(x) \ -+ (((x) & BIT_MASK_L0S_TO_RCVY_NUM_8821C) \ -+ << BIT_SHIFT_L0S_TO_RCVY_NUM_8821C) -+#define BITS_L0S_TO_RCVY_NUM_8821C \ -+ (BIT_MASK_L0S_TO_RCVY_NUM_8821C << BIT_SHIFT_L0S_TO_RCVY_NUM_8821C) -+#define BIT_CLEAR_L0S_TO_RCVY_NUM_8821C(x) ((x) & (~BITS_L0S_TO_RCVY_NUM_8821C)) -+#define BIT_GET_L0S_TO_RCVY_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_L0S_TO_RCVY_NUM_8821C) & \ -+ BIT_MASK_L0S_TO_RCVY_NUM_8821C) -+#define BIT_SET_L0S_TO_RCVY_NUM_8821C(x, v) \ -+ (BIT_CLEAR_L0S_TO_RCVY_NUM_8821C(x) | BIT_L0S_TO_RCVY_NUM_8821C(v)) -+ -+#define BIT_CPWM2_TOGGLING_8821C BIT(15) -+ -+#define BIT_SHIFT_CPWM2_MOD_8821C 0 -+#define BIT_MASK_CPWM2_MOD_8821C 0x7fff -+#define BIT_CPWM2_MOD_8821C(x) \ -+ (((x) & BIT_MASK_CPWM2_MOD_8821C) << BIT_SHIFT_CPWM2_MOD_8821C) -+#define BITS_CPWM2_MOD_8821C \ -+ (BIT_MASK_CPWM2_MOD_8821C << BIT_SHIFT_CPWM2_MOD_8821C) -+#define BIT_CLEAR_CPWM2_MOD_8821C(x) ((x) & (~BITS_CPWM2_MOD_8821C)) -+#define BIT_GET_CPWM2_MOD_8821C(x) \ -+ (((x) >> BIT_SHIFT_CPWM2_MOD_8821C) & BIT_MASK_CPWM2_MOD_8821C) -+#define BIT_SET_CPWM2_MOD_8821C(x, v) \ -+ (BIT_CLEAR_CPWM2_MOD_8821C(x) | BIT_CPWM2_MOD_8821C(v)) -+ -+/* 2 REG_TC0_CTRL_8821C */ -+#define BIT_TC0INT_EN_8821C BIT(26) -+#define BIT_TC0MODE_8821C BIT(25) -+#define BIT_TC0EN_8821C BIT(24) -+ -+#define BIT_SHIFT_TC0DATA_8821C 0 -+#define BIT_MASK_TC0DATA_8821C 0xffffff -+#define BIT_TC0DATA_8821C(x) \ -+ (((x) & BIT_MASK_TC0DATA_8821C) << BIT_SHIFT_TC0DATA_8821C) -+#define BITS_TC0DATA_8821C (BIT_MASK_TC0DATA_8821C << BIT_SHIFT_TC0DATA_8821C) -+#define BIT_CLEAR_TC0DATA_8821C(x) ((x) & (~BITS_TC0DATA_8821C)) -+#define BIT_GET_TC0DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TC0DATA_8821C) & BIT_MASK_TC0DATA_8821C) -+#define BIT_SET_TC0DATA_8821C(x, v) \ -+ (BIT_CLEAR_TC0DATA_8821C(x) | BIT_TC0DATA_8821C(v)) -+ -+/* 2 REG_TC1_CTRL_8821C */ -+#define BIT_TC1INT_EN_8821C BIT(26) -+#define BIT_TC1MODE_8821C BIT(25) -+#define BIT_TC1EN_8821C BIT(24) -+ -+#define BIT_SHIFT_TC1DATA_8821C 0 -+#define BIT_MASK_TC1DATA_8821C 0xffffff -+#define BIT_TC1DATA_8821C(x) \ -+ (((x) & BIT_MASK_TC1DATA_8821C) << BIT_SHIFT_TC1DATA_8821C) -+#define BITS_TC1DATA_8821C (BIT_MASK_TC1DATA_8821C << BIT_SHIFT_TC1DATA_8821C) -+#define BIT_CLEAR_TC1DATA_8821C(x) ((x) & (~BITS_TC1DATA_8821C)) -+#define BIT_GET_TC1DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TC1DATA_8821C) & BIT_MASK_TC1DATA_8821C) -+#define BIT_SET_TC1DATA_8821C(x, v) \ -+ (BIT_CLEAR_TC1DATA_8821C(x) | BIT_TC1DATA_8821C(v)) -+ -+/* 2 REG_TC2_CTRL_8821C */ -+#define BIT_TC2INT_EN_8821C BIT(26) -+#define BIT_TC2MODE_8821C BIT(25) -+#define BIT_TC2EN_8821C BIT(24) -+ -+#define BIT_SHIFT_TC2DATA_8821C 0 -+#define BIT_MASK_TC2DATA_8821C 0xffffff -+#define BIT_TC2DATA_8821C(x) \ -+ (((x) & BIT_MASK_TC2DATA_8821C) << BIT_SHIFT_TC2DATA_8821C) -+#define BITS_TC2DATA_8821C (BIT_MASK_TC2DATA_8821C << BIT_SHIFT_TC2DATA_8821C) -+#define BIT_CLEAR_TC2DATA_8821C(x) ((x) & (~BITS_TC2DATA_8821C)) -+#define BIT_GET_TC2DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TC2DATA_8821C) & BIT_MASK_TC2DATA_8821C) -+#define BIT_SET_TC2DATA_8821C(x, v) \ -+ (BIT_CLEAR_TC2DATA_8821C(x) | BIT_TC2DATA_8821C(v)) -+ -+/* 2 REG_TC3_CTRL_8821C */ -+#define BIT_TC3INT_EN_8821C BIT(26) -+#define BIT_TC3MODE_8821C BIT(25) -+#define BIT_TC3EN_8821C BIT(24) -+ -+#define BIT_SHIFT_TC3DATA_8821C 0 -+#define BIT_MASK_TC3DATA_8821C 0xffffff -+#define BIT_TC3DATA_8821C(x) \ -+ (((x) & BIT_MASK_TC3DATA_8821C) << BIT_SHIFT_TC3DATA_8821C) -+#define BITS_TC3DATA_8821C (BIT_MASK_TC3DATA_8821C << BIT_SHIFT_TC3DATA_8821C) -+#define BIT_CLEAR_TC3DATA_8821C(x) ((x) & (~BITS_TC3DATA_8821C)) -+#define BIT_GET_TC3DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TC3DATA_8821C) & BIT_MASK_TC3DATA_8821C) -+#define BIT_SET_TC3DATA_8821C(x, v) \ -+ (BIT_CLEAR_TC3DATA_8821C(x) | BIT_TC3DATA_8821C(v)) -+ -+/* 2 REG_TC4_CTRL_8821C */ -+#define BIT_TC4INT_EN_8821C BIT(26) -+#define BIT_TC4MODE_8821C BIT(25) -+#define BIT_TC4EN_8821C BIT(24) -+ -+#define BIT_SHIFT_TC4DATA_8821C 0 -+#define BIT_MASK_TC4DATA_8821C 0xffffff -+#define BIT_TC4DATA_8821C(x) \ -+ (((x) & BIT_MASK_TC4DATA_8821C) << BIT_SHIFT_TC4DATA_8821C) -+#define BITS_TC4DATA_8821C (BIT_MASK_TC4DATA_8821C << BIT_SHIFT_TC4DATA_8821C) -+#define BIT_CLEAR_TC4DATA_8821C(x) ((x) & (~BITS_TC4DATA_8821C)) -+#define BIT_GET_TC4DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TC4DATA_8821C) & BIT_MASK_TC4DATA_8821C) -+#define BIT_SET_TC4DATA_8821C(x, v) \ -+ (BIT_CLEAR_TC4DATA_8821C(x) | BIT_TC4DATA_8821C(v)) -+ -+/* 2 REG_TCUNIT_BASE_8821C */ -+ -+#define BIT_SHIFT_TCUNIT_BASE_8821C 0 -+#define BIT_MASK_TCUNIT_BASE_8821C 0x3fff -+#define BIT_TCUNIT_BASE_8821C(x) \ -+ (((x) & BIT_MASK_TCUNIT_BASE_8821C) << BIT_SHIFT_TCUNIT_BASE_8821C) -+#define BITS_TCUNIT_BASE_8821C \ -+ (BIT_MASK_TCUNIT_BASE_8821C << BIT_SHIFT_TCUNIT_BASE_8821C) -+#define BIT_CLEAR_TCUNIT_BASE_8821C(x) ((x) & (~BITS_TCUNIT_BASE_8821C)) -+#define BIT_GET_TCUNIT_BASE_8821C(x) \ -+ (((x) >> BIT_SHIFT_TCUNIT_BASE_8821C) & BIT_MASK_TCUNIT_BASE_8821C) -+#define BIT_SET_TCUNIT_BASE_8821C(x, v) \ -+ (BIT_CLEAR_TCUNIT_BASE_8821C(x) | BIT_TCUNIT_BASE_8821C(v)) -+ -+/* 2 REG_TC5_CTRL_8821C */ -+#define BIT_TC5INT_EN_8821C BIT(26) -+#define BIT_TC5MODE_8821C BIT(25) -+#define BIT_TC5EN_8821C BIT(24) -+ -+#define BIT_SHIFT_TC5DATA_8821C 0 -+#define BIT_MASK_TC5DATA_8821C 0xffffff -+#define BIT_TC5DATA_8821C(x) \ -+ (((x) & BIT_MASK_TC5DATA_8821C) << BIT_SHIFT_TC5DATA_8821C) -+#define BITS_TC5DATA_8821C (BIT_MASK_TC5DATA_8821C << BIT_SHIFT_TC5DATA_8821C) -+#define BIT_CLEAR_TC5DATA_8821C(x) ((x) & (~BITS_TC5DATA_8821C)) -+#define BIT_GET_TC5DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TC5DATA_8821C) & BIT_MASK_TC5DATA_8821C) -+#define BIT_SET_TC5DATA_8821C(x, v) \ -+ (BIT_CLEAR_TC5DATA_8821C(x) | BIT_TC5DATA_8821C(v)) -+ -+/* 2 REG_TC6_CTRL_8821C */ -+#define BIT_TC6INT_EN_8821C BIT(26) -+#define BIT_TC6MODE_8821C BIT(25) -+#define BIT_TC6EN_8821C BIT(24) -+ -+#define BIT_SHIFT_TC6DATA_8821C 0 -+#define BIT_MASK_TC6DATA_8821C 0xffffff -+#define BIT_TC6DATA_8821C(x) \ -+ (((x) & BIT_MASK_TC6DATA_8821C) << BIT_SHIFT_TC6DATA_8821C) -+#define BITS_TC6DATA_8821C (BIT_MASK_TC6DATA_8821C << BIT_SHIFT_TC6DATA_8821C) -+#define BIT_CLEAR_TC6DATA_8821C(x) ((x) & (~BITS_TC6DATA_8821C)) -+#define BIT_GET_TC6DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TC6DATA_8821C) & BIT_MASK_TC6DATA_8821C) -+#define BIT_SET_TC6DATA_8821C(x, v) \ -+ (BIT_CLEAR_TC6DATA_8821C(x) | BIT_TC6DATA_8821C(v)) -+ -+/* 2 REG_MBIST_DRF_FAIL_8821C */ -+ -+#define BIT_SHIFT_8051_MBIST_DRF_FAIL_8821C 26 -+#define BIT_MASK_8051_MBIST_DRF_FAIL_8821C 0x3f -+#define BIT_8051_MBIST_DRF_FAIL_8821C(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DRF_FAIL_8821C) \ -+ << BIT_SHIFT_8051_MBIST_DRF_FAIL_8821C) -+#define BITS_8051_MBIST_DRF_FAIL_8821C \ -+ (BIT_MASK_8051_MBIST_DRF_FAIL_8821C \ -+ << BIT_SHIFT_8051_MBIST_DRF_FAIL_8821C) -+#define BIT_CLEAR_8051_MBIST_DRF_FAIL_8821C(x) \ -+ ((x) & (~BITS_8051_MBIST_DRF_FAIL_8821C)) -+#define BIT_GET_8051_MBIST_DRF_FAIL_8821C(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DRF_FAIL_8821C) & \ -+ BIT_MASK_8051_MBIST_DRF_FAIL_8821C) -+#define BIT_SET_8051_MBIST_DRF_FAIL_8821C(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DRF_FAIL_8821C(x) | \ -+ BIT_8051_MBIST_DRF_FAIL_8821C(v)) -+ -+#define BIT_SHIFT_USB_MBIST_DRF_FAIL_8821C 24 -+#define BIT_MASK_USB_MBIST_DRF_FAIL_8821C 0x3 -+#define BIT_USB_MBIST_DRF_FAIL_8821C(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DRF_FAIL_8821C) \ -+ << BIT_SHIFT_USB_MBIST_DRF_FAIL_8821C) -+#define BITS_USB_MBIST_DRF_FAIL_8821C \ -+ (BIT_MASK_USB_MBIST_DRF_FAIL_8821C \ -+ << BIT_SHIFT_USB_MBIST_DRF_FAIL_8821C) -+#define BIT_CLEAR_USB_MBIST_DRF_FAIL_8821C(x) \ -+ ((x) & (~BITS_USB_MBIST_DRF_FAIL_8821C)) -+#define BIT_GET_USB_MBIST_DRF_FAIL_8821C(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DRF_FAIL_8821C) & \ -+ BIT_MASK_USB_MBIST_DRF_FAIL_8821C) -+#define BIT_SET_USB_MBIST_DRF_FAIL_8821C(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DRF_FAIL_8821C(x) | \ -+ BIT_USB_MBIST_DRF_FAIL_8821C(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8821C 18 -+#define BIT_MASK_PCIE_MBIST_DRF_FAIL_8821C 0x3f -+#define BIT_PCIE_MBIST_DRF_FAIL_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DRF_FAIL_8821C) \ -+ << BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8821C) -+#define BITS_PCIE_MBIST_DRF_FAIL_8821C \ -+ (BIT_MASK_PCIE_MBIST_DRF_FAIL_8821C \ -+ << BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8821C) -+#define BIT_CLEAR_PCIE_MBIST_DRF_FAIL_8821C(x) \ -+ ((x) & (~BITS_PCIE_MBIST_DRF_FAIL_8821C)) -+#define BIT_GET_PCIE_MBIST_DRF_FAIL_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8821C) & \ -+ BIT_MASK_PCIE_MBIST_DRF_FAIL_8821C) -+#define BIT_SET_PCIE_MBIST_DRF_FAIL_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DRF_FAIL_8821C(x) | \ -+ BIT_PCIE_MBIST_DRF_FAIL_8821C(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_DRF_FAIL_8821C 0 -+#define BIT_MASK_MAC_MBIST_DRF_FAIL_8821C 0x3ffff -+#define BIT_MAC_MBIST_DRF_FAIL_8821C(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DRF_FAIL_8821C) \ -+ << BIT_SHIFT_MAC_MBIST_DRF_FAIL_8821C) -+#define BITS_MAC_MBIST_DRF_FAIL_8821C \ -+ (BIT_MASK_MAC_MBIST_DRF_FAIL_8821C \ -+ << BIT_SHIFT_MAC_MBIST_DRF_FAIL_8821C) -+#define BIT_CLEAR_MAC_MBIST_DRF_FAIL_8821C(x) \ -+ ((x) & (~BITS_MAC_MBIST_DRF_FAIL_8821C)) -+#define BIT_GET_MAC_MBIST_DRF_FAIL_8821C(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DRF_FAIL_8821C) & \ -+ BIT_MASK_MAC_MBIST_DRF_FAIL_8821C) -+#define BIT_SET_MAC_MBIST_DRF_FAIL_8821C(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DRF_FAIL_8821C(x) | \ -+ BIT_MAC_MBIST_DRF_FAIL_8821C(v)) -+ -+/* 2 REG_MBIST_START_PAUSE_8821C */ -+ -+#define BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8821C 26 -+#define BIT_MASK_8051_MBIST_START_PAUSE_V1_8821C 0x3f -+#define BIT_8051_MBIST_START_PAUSE_V1_8821C(x) \ -+ (((x) & BIT_MASK_8051_MBIST_START_PAUSE_V1_8821C) \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8821C) -+#define BITS_8051_MBIST_START_PAUSE_V1_8821C \ -+ (BIT_MASK_8051_MBIST_START_PAUSE_V1_8821C \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8821C) -+#define BIT_CLEAR_8051_MBIST_START_PAUSE_V1_8821C(x) \ -+ ((x) & (~BITS_8051_MBIST_START_PAUSE_V1_8821C)) -+#define BIT_GET_8051_MBIST_START_PAUSE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8821C) & \ -+ BIT_MASK_8051_MBIST_START_PAUSE_V1_8821C) -+#define BIT_SET_8051_MBIST_START_PAUSE_V1_8821C(x, v) \ -+ (BIT_CLEAR_8051_MBIST_START_PAUSE_V1_8821C(x) | \ -+ BIT_8051_MBIST_START_PAUSE_V1_8821C(v)) -+ -+#define BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8821C 24 -+#define BIT_MASK_USB_MBIST_START_PAUSE_V1_8821C 0x3 -+#define BIT_USB_MBIST_START_PAUSE_V1_8821C(x) \ -+ (((x) & BIT_MASK_USB_MBIST_START_PAUSE_V1_8821C) \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8821C) -+#define BITS_USB_MBIST_START_PAUSE_V1_8821C \ -+ (BIT_MASK_USB_MBIST_START_PAUSE_V1_8821C \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8821C) -+#define BIT_CLEAR_USB_MBIST_START_PAUSE_V1_8821C(x) \ -+ ((x) & (~BITS_USB_MBIST_START_PAUSE_V1_8821C)) -+#define BIT_GET_USB_MBIST_START_PAUSE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8821C) & \ -+ BIT_MASK_USB_MBIST_START_PAUSE_V1_8821C) -+#define BIT_SET_USB_MBIST_START_PAUSE_V1_8821C(x, v) \ -+ (BIT_CLEAR_USB_MBIST_START_PAUSE_V1_8821C(x) | \ -+ BIT_USB_MBIST_START_PAUSE_V1_8821C(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8821C 18 -+#define BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8821C 0x3f -+#define BIT_PCIE_MBIST_START_PAUSE_V1_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8821C) \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8821C) -+#define BITS_PCIE_MBIST_START_PAUSE_V1_8821C \ -+ (BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8821C \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8821C) -+#define BIT_CLEAR_PCIE_MBIST_START_PAUSE_V1_8821C(x) \ -+ ((x) & (~BITS_PCIE_MBIST_START_PAUSE_V1_8821C)) -+#define BIT_GET_PCIE_MBIST_START_PAUSE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8821C) & \ -+ BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8821C) -+#define BIT_SET_PCIE_MBIST_START_PAUSE_V1_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_START_PAUSE_V1_8821C(x) | \ -+ BIT_PCIE_MBIST_START_PAUSE_V1_8821C(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8821C 0 -+#define BIT_MASK_MAC_MBIST_START_PAUSE_V1_8821C 0x3ffff -+#define BIT_MAC_MBIST_START_PAUSE_V1_8821C(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_START_PAUSE_V1_8821C) \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8821C) -+#define BITS_MAC_MBIST_START_PAUSE_V1_8821C \ -+ (BIT_MASK_MAC_MBIST_START_PAUSE_V1_8821C \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8821C) -+#define BIT_CLEAR_MAC_MBIST_START_PAUSE_V1_8821C(x) \ -+ ((x) & (~BITS_MAC_MBIST_START_PAUSE_V1_8821C)) -+#define BIT_GET_MAC_MBIST_START_PAUSE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8821C) & \ -+ BIT_MASK_MAC_MBIST_START_PAUSE_V1_8821C) -+#define BIT_SET_MAC_MBIST_START_PAUSE_V1_8821C(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_START_PAUSE_V1_8821C(x) | \ -+ BIT_MAC_MBIST_START_PAUSE_V1_8821C(v)) -+ -+/* 2 REG_MBIST_DONE_8821C */ -+ -+#define BIT_SHIFT_8051_MBIST_DONE_V1_8821C 26 -+#define BIT_MASK_8051_MBIST_DONE_V1_8821C 0x3f -+#define BIT_8051_MBIST_DONE_V1_8821C(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DONE_V1_8821C) \ -+ << BIT_SHIFT_8051_MBIST_DONE_V1_8821C) -+#define BITS_8051_MBIST_DONE_V1_8821C \ -+ (BIT_MASK_8051_MBIST_DONE_V1_8821C \ -+ << BIT_SHIFT_8051_MBIST_DONE_V1_8821C) -+#define BIT_CLEAR_8051_MBIST_DONE_V1_8821C(x) \ -+ ((x) & (~BITS_8051_MBIST_DONE_V1_8821C)) -+#define BIT_GET_8051_MBIST_DONE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DONE_V1_8821C) & \ -+ BIT_MASK_8051_MBIST_DONE_V1_8821C) -+#define BIT_SET_8051_MBIST_DONE_V1_8821C(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DONE_V1_8821C(x) | \ -+ BIT_8051_MBIST_DONE_V1_8821C(v)) -+ -+#define BIT_SHIFT_USB_MBIST_DONE_V1_8821C 24 -+#define BIT_MASK_USB_MBIST_DONE_V1_8821C 0x3 -+#define BIT_USB_MBIST_DONE_V1_8821C(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DONE_V1_8821C) \ -+ << BIT_SHIFT_USB_MBIST_DONE_V1_8821C) -+#define BITS_USB_MBIST_DONE_V1_8821C \ -+ (BIT_MASK_USB_MBIST_DONE_V1_8821C << BIT_SHIFT_USB_MBIST_DONE_V1_8821C) -+#define BIT_CLEAR_USB_MBIST_DONE_V1_8821C(x) \ -+ ((x) & (~BITS_USB_MBIST_DONE_V1_8821C)) -+#define BIT_GET_USB_MBIST_DONE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DONE_V1_8821C) & \ -+ BIT_MASK_USB_MBIST_DONE_V1_8821C) -+#define BIT_SET_USB_MBIST_DONE_V1_8821C(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DONE_V1_8821C(x) | BIT_USB_MBIST_DONE_V1_8821C(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DONE_V1_8821C 18 -+#define BIT_MASK_PCIE_MBIST_DONE_V1_8821C 0x3f -+#define BIT_PCIE_MBIST_DONE_V1_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DONE_V1_8821C) \ -+ << BIT_SHIFT_PCIE_MBIST_DONE_V1_8821C) -+#define BITS_PCIE_MBIST_DONE_V1_8821C \ -+ (BIT_MASK_PCIE_MBIST_DONE_V1_8821C \ -+ << BIT_SHIFT_PCIE_MBIST_DONE_V1_8821C) -+#define BIT_CLEAR_PCIE_MBIST_DONE_V1_8821C(x) \ -+ ((x) & (~BITS_PCIE_MBIST_DONE_V1_8821C)) -+#define BIT_GET_PCIE_MBIST_DONE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DONE_V1_8821C) & \ -+ BIT_MASK_PCIE_MBIST_DONE_V1_8821C) -+#define BIT_SET_PCIE_MBIST_DONE_V1_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DONE_V1_8821C(x) | \ -+ BIT_PCIE_MBIST_DONE_V1_8821C(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_DONE_V1_8821C 0 -+#define BIT_MASK_MAC_MBIST_DONE_V1_8821C 0x3ffff -+#define BIT_MAC_MBIST_DONE_V1_8821C(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DONE_V1_8821C) \ -+ << BIT_SHIFT_MAC_MBIST_DONE_V1_8821C) -+#define BITS_MAC_MBIST_DONE_V1_8821C \ -+ (BIT_MASK_MAC_MBIST_DONE_V1_8821C << BIT_SHIFT_MAC_MBIST_DONE_V1_8821C) -+#define BIT_CLEAR_MAC_MBIST_DONE_V1_8821C(x) \ -+ ((x) & (~BITS_MAC_MBIST_DONE_V1_8821C)) -+#define BIT_GET_MAC_MBIST_DONE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DONE_V1_8821C) & \ -+ BIT_MASK_MAC_MBIST_DONE_V1_8821C) -+#define BIT_SET_MAC_MBIST_DONE_V1_8821C(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DONE_V1_8821C(x) | BIT_MAC_MBIST_DONE_V1_8821C(v)) -+ -+/* 2 REG_MBIST_READ_BIST_RPT_8821C */ -+ -+#define BIT_SHIFT_MBIST_READ_BIST_RPT_8821C 0 -+#define BIT_MASK_MBIST_READ_BIST_RPT_8821C 0xffffffffL -+#define BIT_MBIST_READ_BIST_RPT_8821C(x) \ -+ (((x) & BIT_MASK_MBIST_READ_BIST_RPT_8821C) \ -+ << BIT_SHIFT_MBIST_READ_BIST_RPT_8821C) -+#define BITS_MBIST_READ_BIST_RPT_8821C \ -+ (BIT_MASK_MBIST_READ_BIST_RPT_8821C \ -+ << BIT_SHIFT_MBIST_READ_BIST_RPT_8821C) -+#define BIT_CLEAR_MBIST_READ_BIST_RPT_8821C(x) \ -+ ((x) & (~BITS_MBIST_READ_BIST_RPT_8821C)) -+#define BIT_GET_MBIST_READ_BIST_RPT_8821C(x) \ -+ (((x) >> BIT_SHIFT_MBIST_READ_BIST_RPT_8821C) & \ -+ BIT_MASK_MBIST_READ_BIST_RPT_8821C) -+#define BIT_SET_MBIST_READ_BIST_RPT_8821C(x, v) \ -+ (BIT_CLEAR_MBIST_READ_BIST_RPT_8821C(x) | \ -+ BIT_MBIST_READ_BIST_RPT_8821C(v)) -+ -+/* 2 REG_AES_DECRPT_DATA_8821C */ -+ -+#define BIT_SHIFT_IPS_CFG_ADDR_8821C 0 -+#define BIT_MASK_IPS_CFG_ADDR_8821C 0xff -+#define BIT_IPS_CFG_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_IPS_CFG_ADDR_8821C) << BIT_SHIFT_IPS_CFG_ADDR_8821C) -+#define BITS_IPS_CFG_ADDR_8821C \ -+ (BIT_MASK_IPS_CFG_ADDR_8821C << BIT_SHIFT_IPS_CFG_ADDR_8821C) -+#define BIT_CLEAR_IPS_CFG_ADDR_8821C(x) ((x) & (~BITS_IPS_CFG_ADDR_8821C)) -+#define BIT_GET_IPS_CFG_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_ADDR_8821C) & BIT_MASK_IPS_CFG_ADDR_8821C) -+#define BIT_SET_IPS_CFG_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_IPS_CFG_ADDR_8821C(x) | BIT_IPS_CFG_ADDR_8821C(v)) -+ -+/* 2 REG_AES_DECRPT_CFG_8821C */ -+ -+#define BIT_SHIFT_IPS_CFG_DATA_8821C 0 -+#define BIT_MASK_IPS_CFG_DATA_8821C 0xffffffffL -+#define BIT_IPS_CFG_DATA_8821C(x) \ -+ (((x) & BIT_MASK_IPS_CFG_DATA_8821C) << BIT_SHIFT_IPS_CFG_DATA_8821C) -+#define BITS_IPS_CFG_DATA_8821C \ -+ (BIT_MASK_IPS_CFG_DATA_8821C << BIT_SHIFT_IPS_CFG_DATA_8821C) -+#define BIT_CLEAR_IPS_CFG_DATA_8821C(x) ((x) & (~BITS_IPS_CFG_DATA_8821C)) -+#define BIT_GET_IPS_CFG_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_DATA_8821C) & BIT_MASK_IPS_CFG_DATA_8821C) -+#define BIT_SET_IPS_CFG_DATA_8821C(x, v) \ -+ (BIT_CLEAR_IPS_CFG_DATA_8821C(x) | BIT_IPS_CFG_DATA_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_TMETER_8821C */ -+#define BIT_TEMP_VALID_8821C BIT(31) -+ -+#define BIT_SHIFT_TEMP_VALUE_8821C 24 -+#define BIT_MASK_TEMP_VALUE_8821C 0x3f -+#define BIT_TEMP_VALUE_8821C(x) \ -+ (((x) & BIT_MASK_TEMP_VALUE_8821C) << BIT_SHIFT_TEMP_VALUE_8821C) -+#define BITS_TEMP_VALUE_8821C \ -+ (BIT_MASK_TEMP_VALUE_8821C << BIT_SHIFT_TEMP_VALUE_8821C) -+#define BIT_CLEAR_TEMP_VALUE_8821C(x) ((x) & (~BITS_TEMP_VALUE_8821C)) -+#define BIT_GET_TEMP_VALUE_8821C(x) \ -+ (((x) >> BIT_SHIFT_TEMP_VALUE_8821C) & BIT_MASK_TEMP_VALUE_8821C) -+#define BIT_SET_TEMP_VALUE_8821C(x, v) \ -+ (BIT_CLEAR_TEMP_VALUE_8821C(x) | BIT_TEMP_VALUE_8821C(v)) -+ -+#define BIT_SHIFT_REG_TMETER_TIMER_8821C 8 -+#define BIT_MASK_REG_TMETER_TIMER_8821C 0xfff -+#define BIT_REG_TMETER_TIMER_8821C(x) \ -+ (((x) & BIT_MASK_REG_TMETER_TIMER_8821C) \ -+ << BIT_SHIFT_REG_TMETER_TIMER_8821C) -+#define BITS_REG_TMETER_TIMER_8821C \ -+ (BIT_MASK_REG_TMETER_TIMER_8821C << BIT_SHIFT_REG_TMETER_TIMER_8821C) -+#define BIT_CLEAR_REG_TMETER_TIMER_8821C(x) \ -+ ((x) & (~BITS_REG_TMETER_TIMER_8821C)) -+#define BIT_GET_REG_TMETER_TIMER_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_TMETER_TIMER_8821C) & \ -+ BIT_MASK_REG_TMETER_TIMER_8821C) -+#define BIT_SET_REG_TMETER_TIMER_8821C(x, v) \ -+ (BIT_CLEAR_REG_TMETER_TIMER_8821C(x) | BIT_REG_TMETER_TIMER_8821C(v)) -+ -+#define BIT_SHIFT_REG_TEMP_DELTA_8821C 2 -+#define BIT_MASK_REG_TEMP_DELTA_8821C 0x3f -+#define BIT_REG_TEMP_DELTA_8821C(x) \ -+ (((x) & BIT_MASK_REG_TEMP_DELTA_8821C) \ -+ << BIT_SHIFT_REG_TEMP_DELTA_8821C) -+#define BITS_REG_TEMP_DELTA_8821C \ -+ (BIT_MASK_REG_TEMP_DELTA_8821C << BIT_SHIFT_REG_TEMP_DELTA_8821C) -+#define BIT_CLEAR_REG_TEMP_DELTA_8821C(x) ((x) & (~BITS_REG_TEMP_DELTA_8821C)) -+#define BIT_GET_REG_TEMP_DELTA_8821C(x) \ -+ (((x) >> BIT_SHIFT_REG_TEMP_DELTA_8821C) & \ -+ BIT_MASK_REG_TEMP_DELTA_8821C) -+#define BIT_SET_REG_TEMP_DELTA_8821C(x, v) \ -+ (BIT_CLEAR_REG_TEMP_DELTA_8821C(x) | BIT_REG_TEMP_DELTA_8821C(v)) -+ -+#define BIT_REG_TMETER_EN_8821C BIT(0) -+ -+/* 2 REG_OSC_32K_CTRL_8821C */ -+ -+#define BIT_SHIFT_OSC_32K_CLKGEN_0_8821C 16 -+#define BIT_MASK_OSC_32K_CLKGEN_0_8821C 0xffff -+#define BIT_OSC_32K_CLKGEN_0_8821C(x) \ -+ (((x) & BIT_MASK_OSC_32K_CLKGEN_0_8821C) \ -+ << BIT_SHIFT_OSC_32K_CLKGEN_0_8821C) -+#define BITS_OSC_32K_CLKGEN_0_8821C \ -+ (BIT_MASK_OSC_32K_CLKGEN_0_8821C << BIT_SHIFT_OSC_32K_CLKGEN_0_8821C) -+#define BIT_CLEAR_OSC_32K_CLKGEN_0_8821C(x) \ -+ ((x) & (~BITS_OSC_32K_CLKGEN_0_8821C)) -+#define BIT_GET_OSC_32K_CLKGEN_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_CLKGEN_0_8821C) & \ -+ BIT_MASK_OSC_32K_CLKGEN_0_8821C) -+#define BIT_SET_OSC_32K_CLKGEN_0_8821C(x, v) \ -+ (BIT_CLEAR_OSC_32K_CLKGEN_0_8821C(x) | BIT_OSC_32K_CLKGEN_0_8821C(v)) -+ -+#define BIT_SHIFT_OSC_32K_RES_COMP_8821C 4 -+#define BIT_MASK_OSC_32K_RES_COMP_8821C 0x3 -+#define BIT_OSC_32K_RES_COMP_8821C(x) \ -+ (((x) & BIT_MASK_OSC_32K_RES_COMP_8821C) \ -+ << BIT_SHIFT_OSC_32K_RES_COMP_8821C) -+#define BITS_OSC_32K_RES_COMP_8821C \ -+ (BIT_MASK_OSC_32K_RES_COMP_8821C << BIT_SHIFT_OSC_32K_RES_COMP_8821C) -+#define BIT_CLEAR_OSC_32K_RES_COMP_8821C(x) \ -+ ((x) & (~BITS_OSC_32K_RES_COMP_8821C)) -+#define BIT_GET_OSC_32K_RES_COMP_8821C(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_RES_COMP_8821C) & \ -+ BIT_MASK_OSC_32K_RES_COMP_8821C) -+#define BIT_SET_OSC_32K_RES_COMP_8821C(x, v) \ -+ (BIT_CLEAR_OSC_32K_RES_COMP_8821C(x) | BIT_OSC_32K_RES_COMP_8821C(v)) -+ -+#define BIT_OSC_32K_OUT_SEL_8821C BIT(3) -+#define BIT_ISO_WL_2_OSC_32K_8821C BIT(1) -+#define BIT_POW_CKGEN_8821C BIT(0) -+ -+/* 2 REG_32K_CAL_REG1_8821C */ -+#define BIT_CAL_32K_REG_WR_8821C BIT(31) -+#define BIT_CAL_32K_DBG_SEL_8821C BIT(22) -+ -+#define BIT_SHIFT_CAL_32K_REG_ADDR_8821C 16 -+#define BIT_MASK_CAL_32K_REG_ADDR_8821C 0x3f -+#define BIT_CAL_32K_REG_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_ADDR_8821C) \ -+ << BIT_SHIFT_CAL_32K_REG_ADDR_8821C) -+#define BITS_CAL_32K_REG_ADDR_8821C \ -+ (BIT_MASK_CAL_32K_REG_ADDR_8821C << BIT_SHIFT_CAL_32K_REG_ADDR_8821C) -+#define BIT_CLEAR_CAL_32K_REG_ADDR_8821C(x) \ -+ ((x) & (~BITS_CAL_32K_REG_ADDR_8821C)) -+#define BIT_GET_CAL_32K_REG_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_ADDR_8821C) & \ -+ BIT_MASK_CAL_32K_REG_ADDR_8821C) -+#define BIT_SET_CAL_32K_REG_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_ADDR_8821C(x) | BIT_CAL_32K_REG_ADDR_8821C(v)) -+ -+#define BIT_SHIFT_CAL_32K_REG_DATA_8821C 0 -+#define BIT_MASK_CAL_32K_REG_DATA_8821C 0xffff -+#define BIT_CAL_32K_REG_DATA_8821C(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_DATA_8821C) \ -+ << BIT_SHIFT_CAL_32K_REG_DATA_8821C) -+#define BITS_CAL_32K_REG_DATA_8821C \ -+ (BIT_MASK_CAL_32K_REG_DATA_8821C << BIT_SHIFT_CAL_32K_REG_DATA_8821C) -+#define BIT_CLEAR_CAL_32K_REG_DATA_8821C(x) \ -+ ((x) & (~BITS_CAL_32K_REG_DATA_8821C)) -+#define BIT_GET_CAL_32K_REG_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_DATA_8821C) & \ -+ BIT_MASK_CAL_32K_REG_DATA_8821C) -+#define BIT_SET_CAL_32K_REG_DATA_8821C(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_DATA_8821C(x) | BIT_CAL_32K_REG_DATA_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_C2HEVT_8821C */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_V1_8821C 0 -+#define BIT_MASK_C2HEVT_MSG_V1_8821C 0xffffffffL -+#define BIT_C2HEVT_MSG_V1_8821C(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_V1_8821C) << BIT_SHIFT_C2HEVT_MSG_V1_8821C) -+#define BITS_C2HEVT_MSG_V1_8821C \ -+ (BIT_MASK_C2HEVT_MSG_V1_8821C << BIT_SHIFT_C2HEVT_MSG_V1_8821C) -+#define BIT_CLEAR_C2HEVT_MSG_V1_8821C(x) ((x) & (~BITS_C2HEVT_MSG_V1_8821C)) -+#define BIT_GET_C2HEVT_MSG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_V1_8821C) & BIT_MASK_C2HEVT_MSG_V1_8821C) -+#define BIT_SET_C2HEVT_MSG_V1_8821C(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_V1_8821C(x) | BIT_C2HEVT_MSG_V1_8821C(v)) -+ -+/* 2 REG_C2HEVT_1_8821C */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_1_8821C 0 -+#define BIT_MASK_C2HEVT_MSG_1_8821C 0xffffffffL -+#define BIT_C2HEVT_MSG_1_8821C(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_1_8821C) << BIT_SHIFT_C2HEVT_MSG_1_8821C) -+#define BITS_C2HEVT_MSG_1_8821C \ -+ (BIT_MASK_C2HEVT_MSG_1_8821C << BIT_SHIFT_C2HEVT_MSG_1_8821C) -+#define BIT_CLEAR_C2HEVT_MSG_1_8821C(x) ((x) & (~BITS_C2HEVT_MSG_1_8821C)) -+#define BIT_GET_C2HEVT_MSG_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_1_8821C) & BIT_MASK_C2HEVT_MSG_1_8821C) -+#define BIT_SET_C2HEVT_MSG_1_8821C(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_1_8821C(x) | BIT_C2HEVT_MSG_1_8821C(v)) -+ -+/* 2 REG_C2HEVT_2_8821C */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_2_8821C 0 -+#define BIT_MASK_C2HEVT_MSG_2_8821C 0xffffffffL -+#define BIT_C2HEVT_MSG_2_8821C(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_2_8821C) << BIT_SHIFT_C2HEVT_MSG_2_8821C) -+#define BITS_C2HEVT_MSG_2_8821C \ -+ (BIT_MASK_C2HEVT_MSG_2_8821C << BIT_SHIFT_C2HEVT_MSG_2_8821C) -+#define BIT_CLEAR_C2HEVT_MSG_2_8821C(x) ((x) & (~BITS_C2HEVT_MSG_2_8821C)) -+#define BIT_GET_C2HEVT_MSG_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_2_8821C) & BIT_MASK_C2HEVT_MSG_2_8821C) -+#define BIT_SET_C2HEVT_MSG_2_8821C(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_2_8821C(x) | BIT_C2HEVT_MSG_2_8821C(v)) -+ -+/* 2 REG_C2HEVT_3_8821C */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_3_8821C 0 -+#define BIT_MASK_C2HEVT_MSG_3_8821C 0xffffffffL -+#define BIT_C2HEVT_MSG_3_8821C(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_3_8821C) << BIT_SHIFT_C2HEVT_MSG_3_8821C) -+#define BITS_C2HEVT_MSG_3_8821C \ -+ (BIT_MASK_C2HEVT_MSG_3_8821C << BIT_SHIFT_C2HEVT_MSG_3_8821C) -+#define BIT_CLEAR_C2HEVT_MSG_3_8821C(x) ((x) & (~BITS_C2HEVT_MSG_3_8821C)) -+#define BIT_GET_C2HEVT_MSG_3_8821C(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_3_8821C) & BIT_MASK_C2HEVT_MSG_3_8821C) -+#define BIT_SET_C2HEVT_MSG_3_8821C(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_3_8821C(x) | BIT_C2HEVT_MSG_3_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_SW_DEFINED_PAGE1_8821C */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE1_V1_8821C 0 -+#define BIT_MASK_SW_DEFINED_PAGE1_V1_8821C 0xffffffffL -+#define BIT_SW_DEFINED_PAGE1_V1_8821C(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE1_V1_8821C) \ -+ << BIT_SHIFT_SW_DEFINED_PAGE1_V1_8821C) -+#define BITS_SW_DEFINED_PAGE1_V1_8821C \ -+ (BIT_MASK_SW_DEFINED_PAGE1_V1_8821C \ -+ << BIT_SHIFT_SW_DEFINED_PAGE1_V1_8821C) -+#define BIT_CLEAR_SW_DEFINED_PAGE1_V1_8821C(x) \ -+ ((x) & (~BITS_SW_DEFINED_PAGE1_V1_8821C)) -+#define BIT_GET_SW_DEFINED_PAGE1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE1_V1_8821C) & \ -+ BIT_MASK_SW_DEFINED_PAGE1_V1_8821C) -+#define BIT_SET_SW_DEFINED_PAGE1_V1_8821C(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE1_V1_8821C(x) | \ -+ BIT_SW_DEFINED_PAGE1_V1_8821C(v)) -+ -+/* 2 REG_SW_DEFINED_PAGE2_8821C */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE2_8821C 0 -+#define BIT_MASK_SW_DEFINED_PAGE2_8821C 0xffffffffL -+#define BIT_SW_DEFINED_PAGE2_8821C(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE2_8821C) \ -+ << BIT_SHIFT_SW_DEFINED_PAGE2_8821C) -+#define BITS_SW_DEFINED_PAGE2_8821C \ -+ (BIT_MASK_SW_DEFINED_PAGE2_8821C << BIT_SHIFT_SW_DEFINED_PAGE2_8821C) -+#define BIT_CLEAR_SW_DEFINED_PAGE2_8821C(x) \ -+ ((x) & (~BITS_SW_DEFINED_PAGE2_8821C)) -+#define BIT_GET_SW_DEFINED_PAGE2_8821C(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE2_8821C) & \ -+ BIT_MASK_SW_DEFINED_PAGE2_8821C) -+#define BIT_SET_SW_DEFINED_PAGE2_8821C(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE2_8821C(x) | BIT_SW_DEFINED_PAGE2_8821C(v)) -+ -+/* 2 REG_MCUTST_I_8821C */ -+ -+#define BIT_SHIFT_MCUDMSG_I_8821C 0 -+#define BIT_MASK_MCUDMSG_I_8821C 0xffffffffL -+#define BIT_MCUDMSG_I_8821C(x) \ -+ (((x) & BIT_MASK_MCUDMSG_I_8821C) << BIT_SHIFT_MCUDMSG_I_8821C) -+#define BITS_MCUDMSG_I_8821C \ -+ (BIT_MASK_MCUDMSG_I_8821C << BIT_SHIFT_MCUDMSG_I_8821C) -+#define BIT_CLEAR_MCUDMSG_I_8821C(x) ((x) & (~BITS_MCUDMSG_I_8821C)) -+#define BIT_GET_MCUDMSG_I_8821C(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_I_8821C) & BIT_MASK_MCUDMSG_I_8821C) -+#define BIT_SET_MCUDMSG_I_8821C(x, v) \ -+ (BIT_CLEAR_MCUDMSG_I_8821C(x) | BIT_MCUDMSG_I_8821C(v)) -+ -+/* 2 REG_MCUTST_II_8821C */ -+ -+#define BIT_SHIFT_MCUDMSG_II_8821C 0 -+#define BIT_MASK_MCUDMSG_II_8821C 0xffffffffL -+#define BIT_MCUDMSG_II_8821C(x) \ -+ (((x) & BIT_MASK_MCUDMSG_II_8821C) << BIT_SHIFT_MCUDMSG_II_8821C) -+#define BITS_MCUDMSG_II_8821C \ -+ (BIT_MASK_MCUDMSG_II_8821C << BIT_SHIFT_MCUDMSG_II_8821C) -+#define BIT_CLEAR_MCUDMSG_II_8821C(x) ((x) & (~BITS_MCUDMSG_II_8821C)) -+#define BIT_GET_MCUDMSG_II_8821C(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_II_8821C) & BIT_MASK_MCUDMSG_II_8821C) -+#define BIT_SET_MCUDMSG_II_8821C(x, v) \ -+ (BIT_CLEAR_MCUDMSG_II_8821C(x) | BIT_MCUDMSG_II_8821C(v)) -+ -+/* 2 REG_FMETHR_8821C */ -+#define BIT_FMSG_INT_8821C BIT(31) -+ -+#define BIT_SHIFT_FW_MSG_8821C 0 -+#define BIT_MASK_FW_MSG_8821C 0xffffffffL -+#define BIT_FW_MSG_8821C(x) \ -+ (((x) & BIT_MASK_FW_MSG_8821C) << BIT_SHIFT_FW_MSG_8821C) -+#define BITS_FW_MSG_8821C (BIT_MASK_FW_MSG_8821C << BIT_SHIFT_FW_MSG_8821C) -+#define BIT_CLEAR_FW_MSG_8821C(x) ((x) & (~BITS_FW_MSG_8821C)) -+#define BIT_GET_FW_MSG_8821C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_8821C) & BIT_MASK_FW_MSG_8821C) -+#define BIT_SET_FW_MSG_8821C(x, v) \ -+ (BIT_CLEAR_FW_MSG_8821C(x) | BIT_FW_MSG_8821C(v)) -+ -+/* 2 REG_HMETFR_8821C */ -+ -+#define BIT_SHIFT_HRCV_MSG_8821C 24 -+#define BIT_MASK_HRCV_MSG_8821C 0xff -+#define BIT_HRCV_MSG_8821C(x) \ -+ (((x) & BIT_MASK_HRCV_MSG_8821C) << BIT_SHIFT_HRCV_MSG_8821C) -+#define BITS_HRCV_MSG_8821C \ -+ (BIT_MASK_HRCV_MSG_8821C << BIT_SHIFT_HRCV_MSG_8821C) -+#define BIT_CLEAR_HRCV_MSG_8821C(x) ((x) & (~BITS_HRCV_MSG_8821C)) -+#define BIT_GET_HRCV_MSG_8821C(x) \ -+ (((x) >> BIT_SHIFT_HRCV_MSG_8821C) & BIT_MASK_HRCV_MSG_8821C) -+#define BIT_SET_HRCV_MSG_8821C(x, v) \ -+ (BIT_CLEAR_HRCV_MSG_8821C(x) | BIT_HRCV_MSG_8821C(v)) -+ -+#define BIT_INT_BOX3_8821C BIT(3) -+#define BIT_INT_BOX2_8821C BIT(2) -+#define BIT_INT_BOX1_8821C BIT(1) -+#define BIT_INT_BOX0_8821C BIT(0) -+ -+/* 2 REG_HMEBOX0_8821C */ -+ -+#define BIT_SHIFT_HOST_MSG_0_8821C 0 -+#define BIT_MASK_HOST_MSG_0_8821C 0xffffffffL -+#define BIT_HOST_MSG_0_8821C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_0_8821C) << BIT_SHIFT_HOST_MSG_0_8821C) -+#define BITS_HOST_MSG_0_8821C \ -+ (BIT_MASK_HOST_MSG_0_8821C << BIT_SHIFT_HOST_MSG_0_8821C) -+#define BIT_CLEAR_HOST_MSG_0_8821C(x) ((x) & (~BITS_HOST_MSG_0_8821C)) -+#define BIT_GET_HOST_MSG_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_0_8821C) & BIT_MASK_HOST_MSG_0_8821C) -+#define BIT_SET_HOST_MSG_0_8821C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_0_8821C(x) | BIT_HOST_MSG_0_8821C(v)) -+ -+/* 2 REG_HMEBOX1_8821C */ -+ -+#define BIT_SHIFT_HOST_MSG_1_8821C 0 -+#define BIT_MASK_HOST_MSG_1_8821C 0xffffffffL -+#define BIT_HOST_MSG_1_8821C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_1_8821C) << BIT_SHIFT_HOST_MSG_1_8821C) -+#define BITS_HOST_MSG_1_8821C \ -+ (BIT_MASK_HOST_MSG_1_8821C << BIT_SHIFT_HOST_MSG_1_8821C) -+#define BIT_CLEAR_HOST_MSG_1_8821C(x) ((x) & (~BITS_HOST_MSG_1_8821C)) -+#define BIT_GET_HOST_MSG_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_1_8821C) & BIT_MASK_HOST_MSG_1_8821C) -+#define BIT_SET_HOST_MSG_1_8821C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_1_8821C(x) | BIT_HOST_MSG_1_8821C(v)) -+ -+/* 2 REG_HMEBOX2_8821C */ -+ -+#define BIT_SHIFT_HOST_MSG_2_8821C 0 -+#define BIT_MASK_HOST_MSG_2_8821C 0xffffffffL -+#define BIT_HOST_MSG_2_8821C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_2_8821C) << BIT_SHIFT_HOST_MSG_2_8821C) -+#define BITS_HOST_MSG_2_8821C \ -+ (BIT_MASK_HOST_MSG_2_8821C << BIT_SHIFT_HOST_MSG_2_8821C) -+#define BIT_CLEAR_HOST_MSG_2_8821C(x) ((x) & (~BITS_HOST_MSG_2_8821C)) -+#define BIT_GET_HOST_MSG_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_2_8821C) & BIT_MASK_HOST_MSG_2_8821C) -+#define BIT_SET_HOST_MSG_2_8821C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_2_8821C(x) | BIT_HOST_MSG_2_8821C(v)) -+ -+/* 2 REG_HMEBOX3_8821C */ -+ -+#define BIT_SHIFT_HOST_MSG_3_8821C 0 -+#define BIT_MASK_HOST_MSG_3_8821C 0xffffffffL -+#define BIT_HOST_MSG_3_8821C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_3_8821C) << BIT_SHIFT_HOST_MSG_3_8821C) -+#define BITS_HOST_MSG_3_8821C \ -+ (BIT_MASK_HOST_MSG_3_8821C << BIT_SHIFT_HOST_MSG_3_8821C) -+#define BIT_CLEAR_HOST_MSG_3_8821C(x) ((x) & (~BITS_HOST_MSG_3_8821C)) -+#define BIT_GET_HOST_MSG_3_8821C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_3_8821C) & BIT_MASK_HOST_MSG_3_8821C) -+#define BIT_SET_HOST_MSG_3_8821C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_3_8821C(x) | BIT_HOST_MSG_3_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_BB_ACCESS_CTRL_8821C */ -+ -+#define BIT_SHIFT_BB_WRITE_READ_8821C 30 -+#define BIT_MASK_BB_WRITE_READ_8821C 0x3 -+#define BIT_BB_WRITE_READ_8821C(x) \ -+ (((x) & BIT_MASK_BB_WRITE_READ_8821C) << BIT_SHIFT_BB_WRITE_READ_8821C) -+#define BITS_BB_WRITE_READ_8821C \ -+ (BIT_MASK_BB_WRITE_READ_8821C << BIT_SHIFT_BB_WRITE_READ_8821C) -+#define BIT_CLEAR_BB_WRITE_READ_8821C(x) ((x) & (~BITS_BB_WRITE_READ_8821C)) -+#define BIT_GET_BB_WRITE_READ_8821C(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_READ_8821C) & BIT_MASK_BB_WRITE_READ_8821C) -+#define BIT_SET_BB_WRITE_READ_8821C(x, v) \ -+ (BIT_CLEAR_BB_WRITE_READ_8821C(x) | BIT_BB_WRITE_READ_8821C(v)) -+ -+#define BIT_SHIFT_BB_WRITE_EN_8821C 12 -+#define BIT_MASK_BB_WRITE_EN_8821C 0xf -+#define BIT_BB_WRITE_EN_8821C(x) \ -+ (((x) & BIT_MASK_BB_WRITE_EN_8821C) << BIT_SHIFT_BB_WRITE_EN_8821C) -+#define BITS_BB_WRITE_EN_8821C \ -+ (BIT_MASK_BB_WRITE_EN_8821C << BIT_SHIFT_BB_WRITE_EN_8821C) -+#define BIT_CLEAR_BB_WRITE_EN_8821C(x) ((x) & (~BITS_BB_WRITE_EN_8821C)) -+#define BIT_GET_BB_WRITE_EN_8821C(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_EN_8821C) & BIT_MASK_BB_WRITE_EN_8821C) -+#define BIT_SET_BB_WRITE_EN_8821C(x, v) \ -+ (BIT_CLEAR_BB_WRITE_EN_8821C(x) | BIT_BB_WRITE_EN_8821C(v)) -+ -+#define BIT_SHIFT_BB_ADDR_8821C 2 -+#define BIT_MASK_BB_ADDR_8821C 0x1ff -+#define BIT_BB_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_BB_ADDR_8821C) << BIT_SHIFT_BB_ADDR_8821C) -+#define BITS_BB_ADDR_8821C (BIT_MASK_BB_ADDR_8821C << BIT_SHIFT_BB_ADDR_8821C) -+#define BIT_CLEAR_BB_ADDR_8821C(x) ((x) & (~BITS_BB_ADDR_8821C)) -+#define BIT_GET_BB_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_BB_ADDR_8821C) & BIT_MASK_BB_ADDR_8821C) -+#define BIT_SET_BB_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_BB_ADDR_8821C(x) | BIT_BB_ADDR_8821C(v)) -+ -+#define BIT_BB_ERRACC_8821C BIT(0) -+ -+/* 2 REG_BB_ACCESS_DATA_8821C */ -+ -+#define BIT_SHIFT_BB_DATA_8821C 0 -+#define BIT_MASK_BB_DATA_8821C 0xffffffffL -+#define BIT_BB_DATA_8821C(x) \ -+ (((x) & BIT_MASK_BB_DATA_8821C) << BIT_SHIFT_BB_DATA_8821C) -+#define BITS_BB_DATA_8821C (BIT_MASK_BB_DATA_8821C << BIT_SHIFT_BB_DATA_8821C) -+#define BIT_CLEAR_BB_DATA_8821C(x) ((x) & (~BITS_BB_DATA_8821C)) -+#define BIT_GET_BB_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_BB_DATA_8821C) & BIT_MASK_BB_DATA_8821C) -+#define BIT_SET_BB_DATA_8821C(x, v) \ -+ (BIT_CLEAR_BB_DATA_8821C(x) | BIT_BB_DATA_8821C(v)) -+ -+/* 2 REG_HMEBOX_E0_8821C */ -+ -+#define BIT_SHIFT_HMEBOX_E0_8821C 0 -+#define BIT_MASK_HMEBOX_E0_8821C 0xffffffffL -+#define BIT_HMEBOX_E0_8821C(x) \ -+ (((x) & BIT_MASK_HMEBOX_E0_8821C) << BIT_SHIFT_HMEBOX_E0_8821C) -+#define BITS_HMEBOX_E0_8821C \ -+ (BIT_MASK_HMEBOX_E0_8821C << BIT_SHIFT_HMEBOX_E0_8821C) -+#define BIT_CLEAR_HMEBOX_E0_8821C(x) ((x) & (~BITS_HMEBOX_E0_8821C)) -+#define BIT_GET_HMEBOX_E0_8821C(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E0_8821C) & BIT_MASK_HMEBOX_E0_8821C) -+#define BIT_SET_HMEBOX_E0_8821C(x, v) \ -+ (BIT_CLEAR_HMEBOX_E0_8821C(x) | BIT_HMEBOX_E0_8821C(v)) -+ -+/* 2 REG_HMEBOX_E1_8821C */ -+ -+#define BIT_SHIFT_HMEBOX_E1_8821C 0 -+#define BIT_MASK_HMEBOX_E1_8821C 0xffffffffL -+#define BIT_HMEBOX_E1_8821C(x) \ -+ (((x) & BIT_MASK_HMEBOX_E1_8821C) << BIT_SHIFT_HMEBOX_E1_8821C) -+#define BITS_HMEBOX_E1_8821C \ -+ (BIT_MASK_HMEBOX_E1_8821C << BIT_SHIFT_HMEBOX_E1_8821C) -+#define BIT_CLEAR_HMEBOX_E1_8821C(x) ((x) & (~BITS_HMEBOX_E1_8821C)) -+#define BIT_GET_HMEBOX_E1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E1_8821C) & BIT_MASK_HMEBOX_E1_8821C) -+#define BIT_SET_HMEBOX_E1_8821C(x, v) \ -+ (BIT_CLEAR_HMEBOX_E1_8821C(x) | BIT_HMEBOX_E1_8821C(v)) -+ -+/* 2 REG_HMEBOX_E2_8821C */ -+ -+#define BIT_SHIFT_HMEBOX_E2_8821C 0 -+#define BIT_MASK_HMEBOX_E2_8821C 0xffffffffL -+#define BIT_HMEBOX_E2_8821C(x) \ -+ (((x) & BIT_MASK_HMEBOX_E2_8821C) << BIT_SHIFT_HMEBOX_E2_8821C) -+#define BITS_HMEBOX_E2_8821C \ -+ (BIT_MASK_HMEBOX_E2_8821C << BIT_SHIFT_HMEBOX_E2_8821C) -+#define BIT_CLEAR_HMEBOX_E2_8821C(x) ((x) & (~BITS_HMEBOX_E2_8821C)) -+#define BIT_GET_HMEBOX_E2_8821C(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E2_8821C) & BIT_MASK_HMEBOX_E2_8821C) -+#define BIT_SET_HMEBOX_E2_8821C(x, v) \ -+ (BIT_CLEAR_HMEBOX_E2_8821C(x) | BIT_HMEBOX_E2_8821C(v)) -+ -+/* 2 REG_HMEBOX_E3_8821C */ -+ -+#define BIT_SHIFT_HMEBOX_E3_8821C 0 -+#define BIT_MASK_HMEBOX_E3_8821C 0xffffffffL -+#define BIT_HMEBOX_E3_8821C(x) \ -+ (((x) & BIT_MASK_HMEBOX_E3_8821C) << BIT_SHIFT_HMEBOX_E3_8821C) -+#define BITS_HMEBOX_E3_8821C \ -+ (BIT_MASK_HMEBOX_E3_8821C << BIT_SHIFT_HMEBOX_E3_8821C) -+#define BIT_CLEAR_HMEBOX_E3_8821C(x) ((x) & (~BITS_HMEBOX_E3_8821C)) -+#define BIT_GET_HMEBOX_E3_8821C(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E3_8821C) & BIT_MASK_HMEBOX_E3_8821C) -+#define BIT_SET_HMEBOX_E3_8821C(x, v) \ -+ (BIT_CLEAR_HMEBOX_E3_8821C(x) | BIT_HMEBOX_E3_8821C(v)) -+ -+/* 2 REG_CR_EXT_8821C */ -+ -+#define BIT_SHIFT_PHY_REQ_DELAY_8821C 24 -+#define BIT_MASK_PHY_REQ_DELAY_8821C 0xf -+#define BIT_PHY_REQ_DELAY_8821C(x) \ -+ (((x) & BIT_MASK_PHY_REQ_DELAY_8821C) << BIT_SHIFT_PHY_REQ_DELAY_8821C) -+#define BITS_PHY_REQ_DELAY_8821C \ -+ (BIT_MASK_PHY_REQ_DELAY_8821C << BIT_SHIFT_PHY_REQ_DELAY_8821C) -+#define BIT_CLEAR_PHY_REQ_DELAY_8821C(x) ((x) & (~BITS_PHY_REQ_DELAY_8821C)) -+#define BIT_GET_PHY_REQ_DELAY_8821C(x) \ -+ (((x) >> BIT_SHIFT_PHY_REQ_DELAY_8821C) & BIT_MASK_PHY_REQ_DELAY_8821C) -+#define BIT_SET_PHY_REQ_DELAY_8821C(x, v) \ -+ (BIT_CLEAR_PHY_REQ_DELAY_8821C(x) | BIT_PHY_REQ_DELAY_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+#define BIT_SPD_DOWN_8821C BIT(16) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_NETYPE4_8821C 4 -+#define BIT_MASK_NETYPE4_8821C 0x3 -+#define BIT_NETYPE4_8821C(x) \ -+ (((x) & BIT_MASK_NETYPE4_8821C) << BIT_SHIFT_NETYPE4_8821C) -+#define BITS_NETYPE4_8821C (BIT_MASK_NETYPE4_8821C << BIT_SHIFT_NETYPE4_8821C) -+#define BIT_CLEAR_NETYPE4_8821C(x) ((x) & (~BITS_NETYPE4_8821C)) -+#define BIT_GET_NETYPE4_8821C(x) \ -+ (((x) >> BIT_SHIFT_NETYPE4_8821C) & BIT_MASK_NETYPE4_8821C) -+#define BIT_SET_NETYPE4_8821C(x, v) \ -+ (BIT_CLEAR_NETYPE4_8821C(x) | BIT_NETYPE4_8821C(v)) -+ -+#define BIT_SHIFT_NETYPE3_8821C 2 -+#define BIT_MASK_NETYPE3_8821C 0x3 -+#define BIT_NETYPE3_8821C(x) \ -+ (((x) & BIT_MASK_NETYPE3_8821C) << BIT_SHIFT_NETYPE3_8821C) -+#define BITS_NETYPE3_8821C (BIT_MASK_NETYPE3_8821C << BIT_SHIFT_NETYPE3_8821C) -+#define BIT_CLEAR_NETYPE3_8821C(x) ((x) & (~BITS_NETYPE3_8821C)) -+#define BIT_GET_NETYPE3_8821C(x) \ -+ (((x) >> BIT_SHIFT_NETYPE3_8821C) & BIT_MASK_NETYPE3_8821C) -+#define BIT_SET_NETYPE3_8821C(x, v) \ -+ (BIT_CLEAR_NETYPE3_8821C(x) | BIT_NETYPE3_8821C(v)) -+ -+#define BIT_SHIFT_NETYPE2_8821C 0 -+#define BIT_MASK_NETYPE2_8821C 0x3 -+#define BIT_NETYPE2_8821C(x) \ -+ (((x) & BIT_MASK_NETYPE2_8821C) << BIT_SHIFT_NETYPE2_8821C) -+#define BITS_NETYPE2_8821C (BIT_MASK_NETYPE2_8821C << BIT_SHIFT_NETYPE2_8821C) -+#define BIT_CLEAR_NETYPE2_8821C(x) ((x) & (~BITS_NETYPE2_8821C)) -+#define BIT_GET_NETYPE2_8821C(x) \ -+ (((x) >> BIT_SHIFT_NETYPE2_8821C) & BIT_MASK_NETYPE2_8821C) -+#define BIT_SET_NETYPE2_8821C(x, v) \ -+ (BIT_CLEAR_NETYPE2_8821C(x) | BIT_NETYPE2_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_FWFF_8821C */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V1_8821C 24 -+#define BIT_MASK_PKTNUM_TH_V1_8821C 0xff -+#define BIT_PKTNUM_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V1_8821C) << BIT_SHIFT_PKTNUM_TH_V1_8821C) -+#define BITS_PKTNUM_TH_V1_8821C \ -+ (BIT_MASK_PKTNUM_TH_V1_8821C << BIT_SHIFT_PKTNUM_TH_V1_8821C) -+#define BIT_CLEAR_PKTNUM_TH_V1_8821C(x) ((x) & (~BITS_PKTNUM_TH_V1_8821C)) -+#define BIT_GET_PKTNUM_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V1_8821C) & BIT_MASK_PKTNUM_TH_V1_8821C) -+#define BIT_SET_PKTNUM_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V1_8821C(x) | BIT_PKTNUM_TH_V1_8821C(v)) -+ -+#define BIT_SHIFT_TIMER_TH_8821C 16 -+#define BIT_MASK_TIMER_TH_8821C 0xff -+#define BIT_TIMER_TH_8821C(x) \ -+ (((x) & BIT_MASK_TIMER_TH_8821C) << BIT_SHIFT_TIMER_TH_8821C) -+#define BITS_TIMER_TH_8821C \ -+ (BIT_MASK_TIMER_TH_8821C << BIT_SHIFT_TIMER_TH_8821C) -+#define BIT_CLEAR_TIMER_TH_8821C(x) ((x) & (~BITS_TIMER_TH_8821C)) -+#define BIT_GET_TIMER_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_TIMER_TH_8821C) & BIT_MASK_TIMER_TH_8821C) -+#define BIT_SET_TIMER_TH_8821C(x, v) \ -+ (BIT_CLEAR_TIMER_TH_8821C(x) | BIT_TIMER_TH_8821C(v)) -+ -+#define BIT_SHIFT_RXPKT1ENADDR_8821C 0 -+#define BIT_MASK_RXPKT1ENADDR_8821C 0xffff -+#define BIT_RXPKT1ENADDR_8821C(x) \ -+ (((x) & BIT_MASK_RXPKT1ENADDR_8821C) << BIT_SHIFT_RXPKT1ENADDR_8821C) -+#define BITS_RXPKT1ENADDR_8821C \ -+ (BIT_MASK_RXPKT1ENADDR_8821C << BIT_SHIFT_RXPKT1ENADDR_8821C) -+#define BIT_CLEAR_RXPKT1ENADDR_8821C(x) ((x) & (~BITS_RXPKT1ENADDR_8821C)) -+#define BIT_GET_RXPKT1ENADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXPKT1ENADDR_8821C) & BIT_MASK_RXPKT1ENADDR_8821C) -+#define BIT_SET_RXPKT1ENADDR_8821C(x, v) \ -+ (BIT_CLEAR_RXPKT1ENADDR_8821C(x) | BIT_RXPKT1ENADDR_8821C(v)) -+ -+/* 2 REG_RXFF_PTR_V1_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_RXFF0_RDPTR_V2_8821C 0 -+#define BIT_MASK_RXFF0_RDPTR_V2_8821C 0x3ffff -+#define BIT_RXFF0_RDPTR_V2_8821C(x) \ -+ (((x) & BIT_MASK_RXFF0_RDPTR_V2_8821C) \ -+ << BIT_SHIFT_RXFF0_RDPTR_V2_8821C) -+#define BITS_RXFF0_RDPTR_V2_8821C \ -+ (BIT_MASK_RXFF0_RDPTR_V2_8821C << BIT_SHIFT_RXFF0_RDPTR_V2_8821C) -+#define BIT_CLEAR_RXFF0_RDPTR_V2_8821C(x) ((x) & (~BITS_RXFF0_RDPTR_V2_8821C)) -+#define BIT_GET_RXFF0_RDPTR_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_RDPTR_V2_8821C) & \ -+ BIT_MASK_RXFF0_RDPTR_V2_8821C) -+#define BIT_SET_RXFF0_RDPTR_V2_8821C(x, v) \ -+ (BIT_CLEAR_RXFF0_RDPTR_V2_8821C(x) | BIT_RXFF0_RDPTR_V2_8821C(v)) -+ -+/* 2 REG_RXFF_WTR_V1_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_RXFF0_WTPTR_V2_8821C 0 -+#define BIT_MASK_RXFF0_WTPTR_V2_8821C 0x3ffff -+#define BIT_RXFF0_WTPTR_V2_8821C(x) \ -+ (((x) & BIT_MASK_RXFF0_WTPTR_V2_8821C) \ -+ << BIT_SHIFT_RXFF0_WTPTR_V2_8821C) -+#define BITS_RXFF0_WTPTR_V2_8821C \ -+ (BIT_MASK_RXFF0_WTPTR_V2_8821C << BIT_SHIFT_RXFF0_WTPTR_V2_8821C) -+#define BIT_CLEAR_RXFF0_WTPTR_V2_8821C(x) ((x) & (~BITS_RXFF0_WTPTR_V2_8821C)) -+#define BIT_GET_RXFF0_WTPTR_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_WTPTR_V2_8821C) & \ -+ BIT_MASK_RXFF0_WTPTR_V2_8821C) -+#define BIT_SET_RXFF0_WTPTR_V2_8821C(x, v) \ -+ (BIT_CLEAR_RXFF0_WTPTR_V2_8821C(x) | BIT_RXFF0_WTPTR_V2_8821C(v)) -+ -+/* 2 REG_FE2IMR_8821C */ -+#define BIT__FE4ISR__IND_MSK_8821C BIT(29) -+#define BIT_FS_TXSC_DESC_DONE_INT_EN_8821C BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_EN_8821C BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_EN_8821C BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_EN_8821C BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_EN_8821C BIT(24) -+#define BIT_FS_ATIM_MB7_INT_EN_8821C BIT(23) -+#define BIT_FS_ATIM_MB6_INT_EN_8821C BIT(22) -+#define BIT_FS_ATIM_MB5_INT_EN_8821C BIT(21) -+#define BIT_FS_ATIM_MB4_INT_EN_8821C BIT(20) -+#define BIT_FS_ATIM_MB3_INT_EN_8821C BIT(19) -+#define BIT_FS_ATIM_MB2_INT_EN_8821C BIT(18) -+#define BIT_FS_ATIM_MB1_INT_EN_8821C BIT(17) -+#define BIT_FS_ATIM_MB0_INT_EN_8821C BIT(16) -+#define BIT_FS_TBTT4INT_EN_8821C BIT(11) -+#define BIT_FS_TBTT3INT_EN_8821C BIT(10) -+#define BIT_FS_TBTT2INT_EN_8821C BIT(9) -+#define BIT_FS_TBTT1INT_EN_8821C BIT(8) -+#define BIT_FS_TBTT0_MB7INT_EN_8821C BIT(7) -+#define BIT_FS_TBTT0_MB6INT_EN_8821C BIT(6) -+#define BIT_FS_TBTT0_MB5INT_EN_8821C BIT(5) -+#define BIT_FS_TBTT0_MB4INT_EN_8821C BIT(4) -+#define BIT_FS_TBTT0_MB3INT_EN_8821C BIT(3) -+#define BIT_FS_TBTT0_MB2INT_EN_8821C BIT(2) -+#define BIT_FS_TBTT0_MB1INT_EN_8821C BIT(1) -+#define BIT_FS_TBTT0_INT_EN_8821C BIT(0) -+ -+/* 2 REG_FE2ISR_8821C */ -+#define BIT__FE4ISR__IND_INT_8821C BIT(29) -+#define BIT_FS_TXSC_DESC_DONE_INT_8821C BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_8821C BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_8821C BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_8821C BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_8821C BIT(24) -+#define BIT_FS_ATIM_MB7_INT_8821C BIT(23) -+#define BIT_FS_ATIM_MB6_INT_8821C BIT(22) -+#define BIT_FS_ATIM_MB5_INT_8821C BIT(21) -+#define BIT_FS_ATIM_MB4_INT_8821C BIT(20) -+#define BIT_FS_ATIM_MB3_INT_8821C BIT(19) -+#define BIT_FS_ATIM_MB2_INT_8821C BIT(18) -+#define BIT_FS_ATIM_MB1_INT_8821C BIT(17) -+#define BIT_FS_ATIM_MB0_INT_8821C BIT(16) -+#define BIT_FS_TBTT4INT_8821C BIT(11) -+#define BIT_FS_TBTT3INT_8821C BIT(10) -+#define BIT_FS_TBTT2INT_8821C BIT(9) -+#define BIT_FS_TBTT1INT_8821C BIT(8) -+#define BIT_FS_TBTT0_MB7INT_8821C BIT(7) -+#define BIT_FS_TBTT0_MB6INT_8821C BIT(6) -+#define BIT_FS_TBTT0_MB5INT_8821C BIT(5) -+#define BIT_FS_TBTT0_MB4INT_8821C BIT(4) -+#define BIT_FS_TBTT0_MB3INT_8821C BIT(3) -+#define BIT_FS_TBTT0_MB2INT_8821C BIT(2) -+#define BIT_FS_TBTT0_MB1INT_8821C BIT(1) -+#define BIT_FS_TBTT0_INT_8821C BIT(0) -+ -+/* 2 REG_FE3IMR_8821C */ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT__EN_8821C BIT(31) -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT__EN_8821C BIT(30) -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT__EN_8821C BIT(29) -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT__EN_8821C BIT(28) -+#define BIT_FS_BCNDMA4_INT_EN_8821C BIT(27) -+#define BIT_FS_BCNDMA3_INT_EN_8821C BIT(26) -+#define BIT_FS_BCNDMA2_INT_EN_8821C BIT(25) -+#define BIT_FS_BCNDMA1_INT_EN_8821C BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_EN_8821C BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_EN_8821C BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_EN_8821C BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_EN_8821C BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_EN_8821C BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_EN_8821C BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_EN_8821C BIT(17) -+#define BIT_FS_BCNDMA0_INT_EN_8821C BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT__EN_8821C BIT(15) -+#define BIT_FS_BCNERLY4_INT_EN_8821C BIT(11) -+#define BIT_FS_BCNERLY3_INT_EN_8821C BIT(10) -+#define BIT_FS_BCNERLY2_INT_EN_8821C BIT(9) -+#define BIT_FS_BCNERLY1_INT_EN_8821C BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_EN_8821C BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_EN_8821C BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_EN_8821C BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_EN_8821C BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_EN_8821C BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_EN_8821C BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_EN_8821C BIT(1) -+#define BIT_FS_BCNERLY0_INT_EN_8821C BIT(0) -+ -+/* 2 REG_FE3ISR_8821C */ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT_8821C BIT(31) -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT_8821C BIT(30) -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT_8821C BIT(29) -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT_8821C BIT(28) -+#define BIT_FS_BCNDMA4_INT_8821C BIT(27) -+#define BIT_FS_BCNDMA3_INT_8821C BIT(26) -+#define BIT_FS_BCNDMA2_INT_8821C BIT(25) -+#define BIT_FS_BCNDMA1_INT_8821C BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_8821C BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_8821C BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_8821C BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_8821C BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_8821C BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_8821C BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_8821C BIT(17) -+#define BIT_FS_BCNDMA0_INT_8821C BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT_8821C BIT(15) -+#define BIT_FS_BCNERLY4_INT_8821C BIT(11) -+#define BIT_FS_BCNERLY3_INT_8821C BIT(10) -+#define BIT_FS_BCNERLY2_INT_8821C BIT(9) -+#define BIT_FS_BCNERLY1_INT_8821C BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_8821C BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_8821C BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_8821C BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_8821C BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_8821C BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_8821C BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_8821C BIT(1) -+#define BIT_FS_BCNERLY0_INT_8821C BIT(0) -+ -+/* 2 REG_FE4IMR_8821C */ -+#define BIT_FS_CLI3_TXPKTIN_INT_EN_8821C BIT(19) -+#define BIT_FS_CLI2_TXPKTIN_INT_EN_8821C BIT(18) -+#define BIT_FS_CLI1_TXPKTIN_INT_EN_8821C BIT(17) -+#define BIT_FS_CLI0_TXPKTIN_INT_EN_8821C BIT(16) -+#define BIT_FS_CLI3_RX_UMD0_INT_EN_8821C BIT(15) -+#define BIT_FS_CLI3_RX_UMD1_INT_EN_8821C BIT(14) -+#define BIT_FS_CLI3_RX_BMD0_INT_EN_8821C BIT(13) -+#define BIT_FS_CLI3_RX_BMD1_INT_EN_8821C BIT(12) -+#define BIT_FS_CLI2_RX_UMD0_INT_EN_8821C BIT(11) -+#define BIT_FS_CLI2_RX_UMD1_INT_EN_8821C BIT(10) -+#define BIT_FS_CLI2_RX_BMD0_INT_EN_8821C BIT(9) -+#define BIT_FS_CLI2_RX_BMD1_INT_EN_8821C BIT(8) -+#define BIT_FS_CLI1_RX_UMD0_INT_EN_8821C BIT(7) -+#define BIT_FS_CLI1_RX_UMD1_INT_EN_8821C BIT(6) -+#define BIT_FS_CLI1_RX_BMD0_INT_EN_8821C BIT(5) -+#define BIT_FS_CLI1_RX_BMD1_INT_EN_8821C BIT(4) -+#define BIT_FS_CLI0_RX_UMD0_INT_EN_8821C BIT(3) -+#define BIT_FS_CLI0_RX_UMD1_INT_EN_8821C BIT(2) -+#define BIT_FS_CLI0_RX_BMD0_INT_EN_8821C BIT(1) -+#define BIT_FS_CLI0_RX_BMD1_INT_EN_8821C BIT(0) -+ -+/* 2 REG_FE4ISR_8821C */ -+#define BIT_FS_CLI3_TXPKTIN_INT_8821C BIT(19) -+#define BIT_FS_CLI2_TXPKTIN_INT_8821C BIT(18) -+#define BIT_FS_CLI1_TXPKTIN_INT_8821C BIT(17) -+#define BIT_FS_CLI0_TXPKTIN_INT_8821C BIT(16) -+#define BIT_FS_CLI3_RX_UMD0_INT_8821C BIT(15) -+#define BIT_FS_CLI3_RX_UMD1_INT_8821C BIT(14) -+#define BIT_FS_CLI3_RX_BMD0_INT_8821C BIT(13) -+#define BIT_FS_CLI3_RX_BMD1_INT_8821C BIT(12) -+#define BIT_FS_CLI2_RX_UMD0_INT_8821C BIT(11) -+#define BIT_FS_CLI2_RX_UMD1_INT_8821C BIT(10) -+#define BIT_FS_CLI2_RX_BMD0_INT_8821C BIT(9) -+#define BIT_FS_CLI2_RX_BMD1_INT_8821C BIT(8) -+#define BIT_FS_CLI1_RX_UMD0_INT_8821C BIT(7) -+#define BIT_FS_CLI1_RX_UMD1_INT_8821C BIT(6) -+#define BIT_FS_CLI1_RX_BMD0_INT_8821C BIT(5) -+#define BIT_FS_CLI1_RX_BMD1_INT_8821C BIT(4) -+#define BIT_FS_CLI0_RX_UMD0_INT_8821C BIT(3) -+#define BIT_FS_CLI0_RX_UMD1_INT_8821C BIT(2) -+#define BIT_FS_CLI0_RX_BMD0_INT_8821C BIT(1) -+#define BIT_FS_CLI0_RX_BMD1_INT_8821C BIT(0) -+ -+/* 2 REG_FT1IMR_8821C */ -+#define BIT__FT2ISR__IND_MSK_8821C BIT(30) -+#define BIT_FTM_PTT_INT_EN_8821C BIT(29) -+#define BIT_RXFTMREQ_INT_EN_8821C BIT(28) -+#define BIT_RXFTM_INT_EN_8821C BIT(27) -+#define BIT_TXFTM_INT_EN_8821C BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_EN_8821C BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_EN_8821C BIT(24) -+#define BIT_FS_MACID_PWRCHANGE5_INT_EN_8821C BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_EN_8821C BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_EN_8821C BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_EN_8821C BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_EN_8821C BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_EN_8821C BIT(18) -+#define BIT_FS_CTWEND2_INT_EN_8821C BIT(17) -+#define BIT_FS_CTWEND1_INT_EN_8821C BIT(16) -+#define BIT_FS_CTWEND0_INT_EN_8821C BIT(15) -+#define BIT_FS_TX_NULL1_INT_EN_8821C BIT(14) -+#define BIT_FS_TX_NULL0_INT_EN_8821C BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_EN_8821C BIT(12) -+#define BIT_FS_P2P_RFON2_INT_EN_8821C BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_EN_8821C BIT(10) -+#define BIT_FS_P2P_RFON1_INT_EN_8821C BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_EN_8821C BIT(8) -+#define BIT_FS_P2P_RFON0_INT_EN_8821C BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_EN_8821C BIT(6) -+#define BIT_FS_RX_UAPSDMD1_EN_8821C BIT(5) -+#define BIT_FS_RX_UAPSDMD0_EN_8821C BIT(4) -+#define BIT_FS_TRIGGER_PKT_EN_8821C BIT(3) -+#define BIT_FS_EOSP_INT_EN_8821C BIT(2) -+#define BIT_FS_RPWM2_INT_EN_8821C BIT(1) -+#define BIT_FS_RPWM_INT_EN_8821C BIT(0) -+ -+/* 2 REG_FT1ISR_8821C */ -+#define BIT__FT2ISR__IND_INT_8821C BIT(30) -+#define BIT_FTM_PTT_INT_8821C BIT(29) -+#define BIT_RXFTMREQ_INT_8821C BIT(28) -+#define BIT_RXFTM_INT_8821C BIT(27) -+#define BIT_TXFTM_INT_8821C BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_8821C BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_8821C BIT(24) -+#define BIT_FS_MACID_PWRCHANGE5_INT_8821C BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_8821C BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_8821C BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_8821C BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_8821C BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_8821C BIT(18) -+#define BIT_FS_CTWEND2_INT_8821C BIT(17) -+#define BIT_FS_CTWEND1_INT_8821C BIT(16) -+#define BIT_FS_CTWEND0_INT_8821C BIT(15) -+#define BIT_FS_TX_NULL1_INT_8821C BIT(14) -+#define BIT_FS_TX_NULL0_INT_8821C BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_INT_8821C BIT(12) -+#define BIT_FS_P2P_RFON2_INT_8821C BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_8821C BIT(10) -+#define BIT_FS_P2P_RFON1_INT_8821C BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_8821C BIT(8) -+#define BIT_FS_P2P_RFON0_INT_8821C BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_8821C BIT(6) -+#define BIT_FS_RX_UAPSDMD1_INT_8821C BIT(5) -+#define BIT_FS_RX_UAPSDMD0_INT_8821C BIT(4) -+#define BIT_FS_TRIGGER_PKT_INT_8821C BIT(3) -+#define BIT_FS_EOSP_INT_8821C BIT(2) -+#define BIT_FS_RPWM2_INT_8821C BIT(1) -+#define BIT_FS_RPWM_INT_8821C BIT(0) -+ -+/* 2 REG_SPWR0_8821C */ -+ -+#define BIT_SHIFT_MID_31TO0_8821C 0 -+#define BIT_MASK_MID_31TO0_8821C 0xffffffffL -+#define BIT_MID_31TO0_8821C(x) \ -+ (((x) & BIT_MASK_MID_31TO0_8821C) << BIT_SHIFT_MID_31TO0_8821C) -+#define BITS_MID_31TO0_8821C \ -+ (BIT_MASK_MID_31TO0_8821C << BIT_SHIFT_MID_31TO0_8821C) -+#define BIT_CLEAR_MID_31TO0_8821C(x) ((x) & (~BITS_MID_31TO0_8821C)) -+#define BIT_GET_MID_31TO0_8821C(x) \ -+ (((x) >> BIT_SHIFT_MID_31TO0_8821C) & BIT_MASK_MID_31TO0_8821C) -+#define BIT_SET_MID_31TO0_8821C(x, v) \ -+ (BIT_CLEAR_MID_31TO0_8821C(x) | BIT_MID_31TO0_8821C(v)) -+ -+/* 2 REG_SPWR1_8821C */ -+ -+#define BIT_SHIFT_MID_63TO32_8821C 0 -+#define BIT_MASK_MID_63TO32_8821C 0xffffffffL -+#define BIT_MID_63TO32_8821C(x) \ -+ (((x) & BIT_MASK_MID_63TO32_8821C) << BIT_SHIFT_MID_63TO32_8821C) -+#define BITS_MID_63TO32_8821C \ -+ (BIT_MASK_MID_63TO32_8821C << BIT_SHIFT_MID_63TO32_8821C) -+#define BIT_CLEAR_MID_63TO32_8821C(x) ((x) & (~BITS_MID_63TO32_8821C)) -+#define BIT_GET_MID_63TO32_8821C(x) \ -+ (((x) >> BIT_SHIFT_MID_63TO32_8821C) & BIT_MASK_MID_63TO32_8821C) -+#define BIT_SET_MID_63TO32_8821C(x, v) \ -+ (BIT_CLEAR_MID_63TO32_8821C(x) | BIT_MID_63TO32_8821C(v)) -+ -+/* 2 REG_SPWR2_8821C */ -+ -+#define BIT_SHIFT_MID_95O64_8821C 0 -+#define BIT_MASK_MID_95O64_8821C 0xffffffffL -+#define BIT_MID_95O64_8821C(x) \ -+ (((x) & BIT_MASK_MID_95O64_8821C) << BIT_SHIFT_MID_95O64_8821C) -+#define BITS_MID_95O64_8821C \ -+ (BIT_MASK_MID_95O64_8821C << BIT_SHIFT_MID_95O64_8821C) -+#define BIT_CLEAR_MID_95O64_8821C(x) ((x) & (~BITS_MID_95O64_8821C)) -+#define BIT_GET_MID_95O64_8821C(x) \ -+ (((x) >> BIT_SHIFT_MID_95O64_8821C) & BIT_MASK_MID_95O64_8821C) -+#define BIT_SET_MID_95O64_8821C(x, v) \ -+ (BIT_CLEAR_MID_95O64_8821C(x) | BIT_MID_95O64_8821C(v)) -+ -+/* 2 REG_SPWR3_8821C */ -+ -+#define BIT_SHIFT_MID_127TO96_8821C 0 -+#define BIT_MASK_MID_127TO96_8821C 0xffffffffL -+#define BIT_MID_127TO96_8821C(x) \ -+ (((x) & BIT_MASK_MID_127TO96_8821C) << BIT_SHIFT_MID_127TO96_8821C) -+#define BITS_MID_127TO96_8821C \ -+ (BIT_MASK_MID_127TO96_8821C << BIT_SHIFT_MID_127TO96_8821C) -+#define BIT_CLEAR_MID_127TO96_8821C(x) ((x) & (~BITS_MID_127TO96_8821C)) -+#define BIT_GET_MID_127TO96_8821C(x) \ -+ (((x) >> BIT_SHIFT_MID_127TO96_8821C) & BIT_MASK_MID_127TO96_8821C) -+#define BIT_SET_MID_127TO96_8821C(x, v) \ -+ (BIT_CLEAR_MID_127TO96_8821C(x) | BIT_MID_127TO96_8821C(v)) -+ -+/* 2 REG_POWSEQ_8821C */ -+ -+#define BIT_SHIFT_SEQNUM_MID_8821C 16 -+#define BIT_MASK_SEQNUM_MID_8821C 0xffff -+#define BIT_SEQNUM_MID_8821C(x) \ -+ (((x) & BIT_MASK_SEQNUM_MID_8821C) << BIT_SHIFT_SEQNUM_MID_8821C) -+#define BITS_SEQNUM_MID_8821C \ -+ (BIT_MASK_SEQNUM_MID_8821C << BIT_SHIFT_SEQNUM_MID_8821C) -+#define BIT_CLEAR_SEQNUM_MID_8821C(x) ((x) & (~BITS_SEQNUM_MID_8821C)) -+#define BIT_GET_SEQNUM_MID_8821C(x) \ -+ (((x) >> BIT_SHIFT_SEQNUM_MID_8821C) & BIT_MASK_SEQNUM_MID_8821C) -+#define BIT_SET_SEQNUM_MID_8821C(x, v) \ -+ (BIT_CLEAR_SEQNUM_MID_8821C(x) | BIT_SEQNUM_MID_8821C(v)) -+ -+#define BIT_SHIFT_REF_MID_8821C 0 -+#define BIT_MASK_REF_MID_8821C 0x7f -+#define BIT_REF_MID_8821C(x) \ -+ (((x) & BIT_MASK_REF_MID_8821C) << BIT_SHIFT_REF_MID_8821C) -+#define BITS_REF_MID_8821C (BIT_MASK_REF_MID_8821C << BIT_SHIFT_REF_MID_8821C) -+#define BIT_CLEAR_REF_MID_8821C(x) ((x) & (~BITS_REF_MID_8821C)) -+#define BIT_GET_REF_MID_8821C(x) \ -+ (((x) >> BIT_SHIFT_REF_MID_8821C) & BIT_MASK_REF_MID_8821C) -+#define BIT_SET_REF_MID_8821C(x, v) \ -+ (BIT_CLEAR_REF_MID_8821C(x) | BIT_REF_MID_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_TC7_CTRL_V1_8821C */ -+#define BIT_TC7INT_EN_8821C BIT(26) -+#define BIT_TC7MODE_8821C BIT(25) -+#define BIT_TC7EN_8821C BIT(24) -+ -+#define BIT_SHIFT_TC7DATA_8821C 0 -+#define BIT_MASK_TC7DATA_8821C 0xffffff -+#define BIT_TC7DATA_8821C(x) \ -+ (((x) & BIT_MASK_TC7DATA_8821C) << BIT_SHIFT_TC7DATA_8821C) -+#define BITS_TC7DATA_8821C (BIT_MASK_TC7DATA_8821C << BIT_SHIFT_TC7DATA_8821C) -+#define BIT_CLEAR_TC7DATA_8821C(x) ((x) & (~BITS_TC7DATA_8821C)) -+#define BIT_GET_TC7DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TC7DATA_8821C) & BIT_MASK_TC7DATA_8821C) -+#define BIT_SET_TC7DATA_8821C(x, v) \ -+ (BIT_CLEAR_TC7DATA_8821C(x) | BIT_TC7DATA_8821C(v)) -+ -+/* 2 REG_TC8_CTRL_V1_8821C */ -+#define BIT_TC8INT_EN_8821C BIT(26) -+#define BIT_TC8MODE_8821C BIT(25) -+#define BIT_TC8EN_8821C BIT(24) -+ -+#define BIT_SHIFT_TC8DATA_8821C 0 -+#define BIT_MASK_TC8DATA_8821C 0xffffff -+#define BIT_TC8DATA_8821C(x) \ -+ (((x) & BIT_MASK_TC8DATA_8821C) << BIT_SHIFT_TC8DATA_8821C) -+#define BITS_TC8DATA_8821C (BIT_MASK_TC8DATA_8821C << BIT_SHIFT_TC8DATA_8821C) -+#define BIT_CLEAR_TC8DATA_8821C(x) ((x) & (~BITS_TC8DATA_8821C)) -+#define BIT_GET_TC8DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TC8DATA_8821C) & BIT_MASK_TC8DATA_8821C) -+#define BIT_SET_TC8DATA_8821C(x, v) \ -+ (BIT_CLEAR_TC8DATA_8821C(x) | BIT_TC8DATA_8821C(v)) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL0_8821C */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8821C 24 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8821C 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT2_8821C(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8821C) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8821C) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT2_8821C \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8821C \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8821C) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT2_8821C(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT2_8821C)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT2_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8821C) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8821C) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT2_8821C(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT2_8821C(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT2_8821C(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8821C 16 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8821C 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT1_8821C(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8821C) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8821C) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT1_8821C \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8821C \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8821C) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT1_8821C(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT1_8821C)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8821C) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8821C) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT1_8821C(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT1_8821C(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT1_8821C(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8821C 8 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8821C 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT0_8821C(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8821C) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8821C) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT0_8821C \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8821C \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8821C) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT0_8821C(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT0_8821C)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT0_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8821C) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8821C) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT0_8821C(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT0_8821C(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT0_8821C(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8821C 0 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8821C 0xff -+#define BIT_RX_BCN_TBTT_ITVL_PORT0_8821C(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8821C) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8821C) -+#define BITS_RX_BCN_TBTT_ITVL_PORT0_8821C \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8821C \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8821C) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_PORT0_8821C(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_PORT0_8821C)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_PORT0_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8821C) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8821C) -+#define BIT_SET_RX_BCN_TBTT_ITVL_PORT0_8821C(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_PORT0_8821C(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_PORT0_8821C(v)) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL1_8821C */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8821C 0 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8821C 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT3_8821C(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8821C) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8821C) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT3_8821C \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8821C \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8821C) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT3_8821C(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT3_8821C)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT3_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8821C) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8821C) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT3_8821C(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT3_8821C(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT3_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_IO_WRAP_ERR_FLAG_8821C */ -+#define BIT_IO_WRAP_ERR_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_SPEED_SENSOR_8821C */ -+#define BIT_DSS_1_RST_N_8821C BIT(31) -+#define BIT_DSS_1_SPEED_EN_8821C BIT(30) -+#define BIT_DSS_1_WIRE_SEL_8821C BIT(29) -+#define BIT_DSS_ENCLK_8821C BIT(28) -+ -+#define BIT_SHIFT_DSS_1_RO_SEL_8821C 24 -+#define BIT_MASK_DSS_1_RO_SEL_8821C 0x7 -+#define BIT_DSS_1_RO_SEL_8821C(x) \ -+ (((x) & BIT_MASK_DSS_1_RO_SEL_8821C) << BIT_SHIFT_DSS_1_RO_SEL_8821C) -+#define BITS_DSS_1_RO_SEL_8821C \ -+ (BIT_MASK_DSS_1_RO_SEL_8821C << BIT_SHIFT_DSS_1_RO_SEL_8821C) -+#define BIT_CLEAR_DSS_1_RO_SEL_8821C(x) ((x) & (~BITS_DSS_1_RO_SEL_8821C)) -+#define BIT_GET_DSS_1_RO_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_RO_SEL_8821C) & BIT_MASK_DSS_1_RO_SEL_8821C) -+#define BIT_SET_DSS_1_RO_SEL_8821C(x, v) \ -+ (BIT_CLEAR_DSS_1_RO_SEL_8821C(x) | BIT_DSS_1_RO_SEL_8821C(v)) -+ -+#define BIT_SHIFT_DSS_1_DATA_IN_8821C 0 -+#define BIT_MASK_DSS_1_DATA_IN_8821C 0xfffff -+#define BIT_DSS_1_DATA_IN_8821C(x) \ -+ (((x) & BIT_MASK_DSS_1_DATA_IN_8821C) << BIT_SHIFT_DSS_1_DATA_IN_8821C) -+#define BITS_DSS_1_DATA_IN_8821C \ -+ (BIT_MASK_DSS_1_DATA_IN_8821C << BIT_SHIFT_DSS_1_DATA_IN_8821C) -+#define BIT_CLEAR_DSS_1_DATA_IN_8821C(x) ((x) & (~BITS_DSS_1_DATA_IN_8821C)) -+#define BIT_GET_DSS_1_DATA_IN_8821C(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_DATA_IN_8821C) & BIT_MASK_DSS_1_DATA_IN_8821C) -+#define BIT_SET_DSS_1_DATA_IN_8821C(x, v) \ -+ (BIT_CLEAR_DSS_1_DATA_IN_8821C(x) | BIT_DSS_1_DATA_IN_8821C(v)) -+ -+/* 2 REG_SPEED_SENSOR1_8821C */ -+#define BIT_DSS_1_READY_8821C BIT(31) -+#define BIT_DSS_1_WSORT_GO_8821C BIT(30) -+ -+#define BIT_SHIFT_DSS_1_COUNT_OUT_8821C 0 -+#define BIT_MASK_DSS_1_COUNT_OUT_8821C 0xfffff -+#define BIT_DSS_1_COUNT_OUT_8821C(x) \ -+ (((x) & BIT_MASK_DSS_1_COUNT_OUT_8821C) \ -+ << BIT_SHIFT_DSS_1_COUNT_OUT_8821C) -+#define BITS_DSS_1_COUNT_OUT_8821C \ -+ (BIT_MASK_DSS_1_COUNT_OUT_8821C << BIT_SHIFT_DSS_1_COUNT_OUT_8821C) -+#define BIT_CLEAR_DSS_1_COUNT_OUT_8821C(x) ((x) & (~BITS_DSS_1_COUNT_OUT_8821C)) -+#define BIT_GET_DSS_1_COUNT_OUT_8821C(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_COUNT_OUT_8821C) & \ -+ BIT_MASK_DSS_1_COUNT_OUT_8821C) -+#define BIT_SET_DSS_1_COUNT_OUT_8821C(x, v) \ -+ (BIT_CLEAR_DSS_1_COUNT_OUT_8821C(x) | BIT_DSS_1_COUNT_OUT_8821C(v)) -+ -+/* 2 REG_SPEED_SENSOR2_8821C */ -+#define BIT_DSS_2_RST_N_8821C BIT(31) -+#define BIT_DSS_2_SPEED_EN_8821C BIT(30) -+#define BIT_DSS_2_WIRE_SEL_8821C BIT(29) -+#define BIT_DSS_ENCLK_8821C BIT(28) -+ -+#define BIT_SHIFT_DSS_2_RO_SEL_8821C 24 -+#define BIT_MASK_DSS_2_RO_SEL_8821C 0x7 -+#define BIT_DSS_2_RO_SEL_8821C(x) \ -+ (((x) & BIT_MASK_DSS_2_RO_SEL_8821C) << BIT_SHIFT_DSS_2_RO_SEL_8821C) -+#define BITS_DSS_2_RO_SEL_8821C \ -+ (BIT_MASK_DSS_2_RO_SEL_8821C << BIT_SHIFT_DSS_2_RO_SEL_8821C) -+#define BIT_CLEAR_DSS_2_RO_SEL_8821C(x) ((x) & (~BITS_DSS_2_RO_SEL_8821C)) -+#define BIT_GET_DSS_2_RO_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_RO_SEL_8821C) & BIT_MASK_DSS_2_RO_SEL_8821C) -+#define BIT_SET_DSS_2_RO_SEL_8821C(x, v) \ -+ (BIT_CLEAR_DSS_2_RO_SEL_8821C(x) | BIT_DSS_2_RO_SEL_8821C(v)) -+ -+#define BIT_SHIFT_DSS_2_DATA_IN_8821C 0 -+#define BIT_MASK_DSS_2_DATA_IN_8821C 0xfffff -+#define BIT_DSS_2_DATA_IN_8821C(x) \ -+ (((x) & BIT_MASK_DSS_2_DATA_IN_8821C) << BIT_SHIFT_DSS_2_DATA_IN_8821C) -+#define BITS_DSS_2_DATA_IN_8821C \ -+ (BIT_MASK_DSS_2_DATA_IN_8821C << BIT_SHIFT_DSS_2_DATA_IN_8821C) -+#define BIT_CLEAR_DSS_2_DATA_IN_8821C(x) ((x) & (~BITS_DSS_2_DATA_IN_8821C)) -+#define BIT_GET_DSS_2_DATA_IN_8821C(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_DATA_IN_8821C) & BIT_MASK_DSS_2_DATA_IN_8821C) -+#define BIT_SET_DSS_2_DATA_IN_8821C(x, v) \ -+ (BIT_CLEAR_DSS_2_DATA_IN_8821C(x) | BIT_DSS_2_DATA_IN_8821C(v)) -+ -+/* 2 REG_SPEED_SENSOR3_8821C */ -+#define BIT_DSS_2_READY_8821C BIT(31) -+#define BIT_DSS_2_WSORT_GO_8821C BIT(30) -+ -+#define BIT_SHIFT_DSS_2_COUNT_OUT_8821C 0 -+#define BIT_MASK_DSS_2_COUNT_OUT_8821C 0xfffff -+#define BIT_DSS_2_COUNT_OUT_8821C(x) \ -+ (((x) & BIT_MASK_DSS_2_COUNT_OUT_8821C) \ -+ << BIT_SHIFT_DSS_2_COUNT_OUT_8821C) -+#define BITS_DSS_2_COUNT_OUT_8821C \ -+ (BIT_MASK_DSS_2_COUNT_OUT_8821C << BIT_SHIFT_DSS_2_COUNT_OUT_8821C) -+#define BIT_CLEAR_DSS_2_COUNT_OUT_8821C(x) ((x) & (~BITS_DSS_2_COUNT_OUT_8821C)) -+#define BIT_GET_DSS_2_COUNT_OUT_8821C(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_COUNT_OUT_8821C) & \ -+ BIT_MASK_DSS_2_COUNT_OUT_8821C) -+#define BIT_SET_DSS_2_COUNT_OUT_8821C(x, v) \ -+ (BIT_CLEAR_DSS_2_COUNT_OUT_8821C(x) | BIT_DSS_2_COUNT_OUT_8821C(v)) -+ -+/* 2 REG_SPEED_SENSOR4_8821C */ -+#define BIT_DSS_3_RST_N_8821C BIT(31) -+#define BIT_DSS_3_SPEED_EN_8821C BIT(30) -+#define BIT_DSS_3_WIRE_SEL_8821C BIT(29) -+#define BIT_DSS_ENCLK_8821C BIT(28) -+ -+#define BIT_SHIFT_DSS_3_RO_SEL_8821C 24 -+#define BIT_MASK_DSS_3_RO_SEL_8821C 0x7 -+#define BIT_DSS_3_RO_SEL_8821C(x) \ -+ (((x) & BIT_MASK_DSS_3_RO_SEL_8821C) << BIT_SHIFT_DSS_3_RO_SEL_8821C) -+#define BITS_DSS_3_RO_SEL_8821C \ -+ (BIT_MASK_DSS_3_RO_SEL_8821C << BIT_SHIFT_DSS_3_RO_SEL_8821C) -+#define BIT_CLEAR_DSS_3_RO_SEL_8821C(x) ((x) & (~BITS_DSS_3_RO_SEL_8821C)) -+#define BIT_GET_DSS_3_RO_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_RO_SEL_8821C) & BIT_MASK_DSS_3_RO_SEL_8821C) -+#define BIT_SET_DSS_3_RO_SEL_8821C(x, v) \ -+ (BIT_CLEAR_DSS_3_RO_SEL_8821C(x) | BIT_DSS_3_RO_SEL_8821C(v)) -+ -+#define BIT_SHIFT_DSS_3_DATA_IN_8821C 0 -+#define BIT_MASK_DSS_3_DATA_IN_8821C 0xfffff -+#define BIT_DSS_3_DATA_IN_8821C(x) \ -+ (((x) & BIT_MASK_DSS_3_DATA_IN_8821C) << BIT_SHIFT_DSS_3_DATA_IN_8821C) -+#define BITS_DSS_3_DATA_IN_8821C \ -+ (BIT_MASK_DSS_3_DATA_IN_8821C << BIT_SHIFT_DSS_3_DATA_IN_8821C) -+#define BIT_CLEAR_DSS_3_DATA_IN_8821C(x) ((x) & (~BITS_DSS_3_DATA_IN_8821C)) -+#define BIT_GET_DSS_3_DATA_IN_8821C(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_DATA_IN_8821C) & BIT_MASK_DSS_3_DATA_IN_8821C) -+#define BIT_SET_DSS_3_DATA_IN_8821C(x, v) \ -+ (BIT_CLEAR_DSS_3_DATA_IN_8821C(x) | BIT_DSS_3_DATA_IN_8821C(v)) -+ -+/* 2 REG_SPEED_SENSOR5_8821C */ -+#define BIT_DSS_3_READY_8821C BIT(31) -+#define BIT_DSS_3_WSORT_GO_8821C BIT(30) -+ -+#define BIT_SHIFT_DSS_3_COUNT_OUT_8821C 0 -+#define BIT_MASK_DSS_3_COUNT_OUT_8821C 0xfffff -+#define BIT_DSS_3_COUNT_OUT_8821C(x) \ -+ (((x) & BIT_MASK_DSS_3_COUNT_OUT_8821C) \ -+ << BIT_SHIFT_DSS_3_COUNT_OUT_8821C) -+#define BITS_DSS_3_COUNT_OUT_8821C \ -+ (BIT_MASK_DSS_3_COUNT_OUT_8821C << BIT_SHIFT_DSS_3_COUNT_OUT_8821C) -+#define BIT_CLEAR_DSS_3_COUNT_OUT_8821C(x) ((x) & (~BITS_DSS_3_COUNT_OUT_8821C)) -+#define BIT_GET_DSS_3_COUNT_OUT_8821C(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_COUNT_OUT_8821C) & \ -+ BIT_MASK_DSS_3_COUNT_OUT_8821C) -+#define BIT_SET_DSS_3_COUNT_OUT_8821C(x, v) \ -+ (BIT_CLEAR_DSS_3_COUNT_OUT_8821C(x) | BIT_DSS_3_COUNT_OUT_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_COUNTER_CTRL_8821C */ -+ -+#define BIT_SHIFT_COUNTER_BASE_8821C 16 -+#define BIT_MASK_COUNTER_BASE_8821C 0x1fff -+#define BIT_COUNTER_BASE_8821C(x) \ -+ (((x) & BIT_MASK_COUNTER_BASE_8821C) << BIT_SHIFT_COUNTER_BASE_8821C) -+#define BITS_COUNTER_BASE_8821C \ -+ (BIT_MASK_COUNTER_BASE_8821C << BIT_SHIFT_COUNTER_BASE_8821C) -+#define BIT_CLEAR_COUNTER_BASE_8821C(x) ((x) & (~BITS_COUNTER_BASE_8821C)) -+#define BIT_GET_COUNTER_BASE_8821C(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_BASE_8821C) & BIT_MASK_COUNTER_BASE_8821C) -+#define BIT_SET_COUNTER_BASE_8821C(x, v) \ -+ (BIT_CLEAR_COUNTER_BASE_8821C(x) | BIT_COUNTER_BASE_8821C(v)) -+ -+#define BIT_EN_RTS_REQ_8821C BIT(9) -+#define BIT_EN_EDCA_REQ_8821C BIT(8) -+#define BIT_EN_PTCL_REQ_8821C BIT(7) -+#define BIT_EN_SCH_REQ_8821C BIT(6) -+#define BIT_USB_COUNT_EN_8821C BIT(5) -+#define BIT_PCIE_COUNT_EN_8821C BIT(4) -+#define BIT_RQPN_COUNT_EN_8821C BIT(3) -+#define BIT_RDE_COUNT_EN_8821C BIT(2) -+#define BIT_TDE_COUNT_EN_8821C BIT(1) -+#define BIT_DISABLE_COUNTER_8821C BIT(0) -+ -+/* 2 REG_COUNTER_THRESHOLD_8821C */ -+#define BIT_SEL_ALL_MACID_8821C BIT(31) -+ -+#define BIT_SHIFT_COUNTER_MACID_8821C 24 -+#define BIT_MASK_COUNTER_MACID_8821C 0x7f -+#define BIT_COUNTER_MACID_8821C(x) \ -+ (((x) & BIT_MASK_COUNTER_MACID_8821C) << BIT_SHIFT_COUNTER_MACID_8821C) -+#define BITS_COUNTER_MACID_8821C \ -+ (BIT_MASK_COUNTER_MACID_8821C << BIT_SHIFT_COUNTER_MACID_8821C) -+#define BIT_CLEAR_COUNTER_MACID_8821C(x) ((x) & (~BITS_COUNTER_MACID_8821C)) -+#define BIT_GET_COUNTER_MACID_8821C(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_MACID_8821C) & BIT_MASK_COUNTER_MACID_8821C) -+#define BIT_SET_COUNTER_MACID_8821C(x, v) \ -+ (BIT_CLEAR_COUNTER_MACID_8821C(x) | BIT_COUNTER_MACID_8821C(v)) -+ -+#define BIT_SHIFT_AGG_VALUE2_8821C 16 -+#define BIT_MASK_AGG_VALUE2_8821C 0x7f -+#define BIT_AGG_VALUE2_8821C(x) \ -+ (((x) & BIT_MASK_AGG_VALUE2_8821C) << BIT_SHIFT_AGG_VALUE2_8821C) -+#define BITS_AGG_VALUE2_8821C \ -+ (BIT_MASK_AGG_VALUE2_8821C << BIT_SHIFT_AGG_VALUE2_8821C) -+#define BIT_CLEAR_AGG_VALUE2_8821C(x) ((x) & (~BITS_AGG_VALUE2_8821C)) -+#define BIT_GET_AGG_VALUE2_8821C(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE2_8821C) & BIT_MASK_AGG_VALUE2_8821C) -+#define BIT_SET_AGG_VALUE2_8821C(x, v) \ -+ (BIT_CLEAR_AGG_VALUE2_8821C(x) | BIT_AGG_VALUE2_8821C(v)) -+ -+#define BIT_SHIFT_AGG_VALUE1_8821C 8 -+#define BIT_MASK_AGG_VALUE1_8821C 0x7f -+#define BIT_AGG_VALUE1_8821C(x) \ -+ (((x) & BIT_MASK_AGG_VALUE1_8821C) << BIT_SHIFT_AGG_VALUE1_8821C) -+#define BITS_AGG_VALUE1_8821C \ -+ (BIT_MASK_AGG_VALUE1_8821C << BIT_SHIFT_AGG_VALUE1_8821C) -+#define BIT_CLEAR_AGG_VALUE1_8821C(x) ((x) & (~BITS_AGG_VALUE1_8821C)) -+#define BIT_GET_AGG_VALUE1_8821C(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE1_8821C) & BIT_MASK_AGG_VALUE1_8821C) -+#define BIT_SET_AGG_VALUE1_8821C(x, v) \ -+ (BIT_CLEAR_AGG_VALUE1_8821C(x) | BIT_AGG_VALUE1_8821C(v)) -+ -+#define BIT_SHIFT_AGG_VALUE0_8821C 0 -+#define BIT_MASK_AGG_VALUE0_8821C 0x7f -+#define BIT_AGG_VALUE0_8821C(x) \ -+ (((x) & BIT_MASK_AGG_VALUE0_8821C) << BIT_SHIFT_AGG_VALUE0_8821C) -+#define BITS_AGG_VALUE0_8821C \ -+ (BIT_MASK_AGG_VALUE0_8821C << BIT_SHIFT_AGG_VALUE0_8821C) -+#define BIT_CLEAR_AGG_VALUE0_8821C(x) ((x) & (~BITS_AGG_VALUE0_8821C)) -+#define BIT_GET_AGG_VALUE0_8821C(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE0_8821C) & BIT_MASK_AGG_VALUE0_8821C) -+#define BIT_SET_AGG_VALUE0_8821C(x, v) \ -+ (BIT_CLEAR_AGG_VALUE0_8821C(x) | BIT_AGG_VALUE0_8821C(v)) -+ -+/* 2 REG_COUNTER_SET_8821C */ -+ -+#define BIT_SHIFT_REQUEST_RESET_8821C 16 -+#define BIT_MASK_REQUEST_RESET_8821C 0xffff -+#define BIT_REQUEST_RESET_8821C(x) \ -+ (((x) & BIT_MASK_REQUEST_RESET_8821C) << BIT_SHIFT_REQUEST_RESET_8821C) -+#define BITS_REQUEST_RESET_8821C \ -+ (BIT_MASK_REQUEST_RESET_8821C << BIT_SHIFT_REQUEST_RESET_8821C) -+#define BIT_CLEAR_REQUEST_RESET_8821C(x) ((x) & (~BITS_REQUEST_RESET_8821C)) -+#define BIT_GET_REQUEST_RESET_8821C(x) \ -+ (((x) >> BIT_SHIFT_REQUEST_RESET_8821C) & BIT_MASK_REQUEST_RESET_8821C) -+#define BIT_SET_REQUEST_RESET_8821C(x, v) \ -+ (BIT_CLEAR_REQUEST_RESET_8821C(x) | BIT_REQUEST_RESET_8821C(v)) -+ -+#define BIT_SHIFT_REQUEST_START_8821C 0 -+#define BIT_MASK_REQUEST_START_8821C 0xffff -+#define BIT_REQUEST_START_8821C(x) \ -+ (((x) & BIT_MASK_REQUEST_START_8821C) << BIT_SHIFT_REQUEST_START_8821C) -+#define BITS_REQUEST_START_8821C \ -+ (BIT_MASK_REQUEST_START_8821C << BIT_SHIFT_REQUEST_START_8821C) -+#define BIT_CLEAR_REQUEST_START_8821C(x) ((x) & (~BITS_REQUEST_START_8821C)) -+#define BIT_GET_REQUEST_START_8821C(x) \ -+ (((x) >> BIT_SHIFT_REQUEST_START_8821C) & BIT_MASK_REQUEST_START_8821C) -+#define BIT_SET_REQUEST_START_8821C(x, v) \ -+ (BIT_CLEAR_REQUEST_START_8821C(x) | BIT_REQUEST_START_8821C(v)) -+ -+/* 2 REG_COUNTER_OVERFLOW_8821C */ -+ -+#define BIT_SHIFT_CNT_OVF_REG_8821C 0 -+#define BIT_MASK_CNT_OVF_REG_8821C 0xffff -+#define BIT_CNT_OVF_REG_8821C(x) \ -+ (((x) & BIT_MASK_CNT_OVF_REG_8821C) << BIT_SHIFT_CNT_OVF_REG_8821C) -+#define BITS_CNT_OVF_REG_8821C \ -+ (BIT_MASK_CNT_OVF_REG_8821C << BIT_SHIFT_CNT_OVF_REG_8821C) -+#define BIT_CLEAR_CNT_OVF_REG_8821C(x) ((x) & (~BITS_CNT_OVF_REG_8821C)) -+#define BIT_GET_CNT_OVF_REG_8821C(x) \ -+ (((x) >> BIT_SHIFT_CNT_OVF_REG_8821C) & BIT_MASK_CNT_OVF_REG_8821C) -+#define BIT_SET_CNT_OVF_REG_8821C(x, v) \ -+ (BIT_CLEAR_CNT_OVF_REG_8821C(x) | BIT_CNT_OVF_REG_8821C(v)) -+ -+/* 2 REG_TXDMA_LEN_THRESHOLD_8821C */ -+ -+#define BIT_SHIFT_TDE_LEN_TH1_8821C 16 -+#define BIT_MASK_TDE_LEN_TH1_8821C 0xffff -+#define BIT_TDE_LEN_TH1_8821C(x) \ -+ (((x) & BIT_MASK_TDE_LEN_TH1_8821C) << BIT_SHIFT_TDE_LEN_TH1_8821C) -+#define BITS_TDE_LEN_TH1_8821C \ -+ (BIT_MASK_TDE_LEN_TH1_8821C << BIT_SHIFT_TDE_LEN_TH1_8821C) -+#define BIT_CLEAR_TDE_LEN_TH1_8821C(x) ((x) & (~BITS_TDE_LEN_TH1_8821C)) -+#define BIT_GET_TDE_LEN_TH1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TDE_LEN_TH1_8821C) & BIT_MASK_TDE_LEN_TH1_8821C) -+#define BIT_SET_TDE_LEN_TH1_8821C(x, v) \ -+ (BIT_CLEAR_TDE_LEN_TH1_8821C(x) | BIT_TDE_LEN_TH1_8821C(v)) -+ -+#define BIT_SHIFT_TDE_LEN_TH0_8821C 0 -+#define BIT_MASK_TDE_LEN_TH0_8821C 0xffff -+#define BIT_TDE_LEN_TH0_8821C(x) \ -+ (((x) & BIT_MASK_TDE_LEN_TH0_8821C) << BIT_SHIFT_TDE_LEN_TH0_8821C) -+#define BITS_TDE_LEN_TH0_8821C \ -+ (BIT_MASK_TDE_LEN_TH0_8821C << BIT_SHIFT_TDE_LEN_TH0_8821C) -+#define BIT_CLEAR_TDE_LEN_TH0_8821C(x) ((x) & (~BITS_TDE_LEN_TH0_8821C)) -+#define BIT_GET_TDE_LEN_TH0_8821C(x) \ -+ (((x) >> BIT_SHIFT_TDE_LEN_TH0_8821C) & BIT_MASK_TDE_LEN_TH0_8821C) -+#define BIT_SET_TDE_LEN_TH0_8821C(x, v) \ -+ (BIT_CLEAR_TDE_LEN_TH0_8821C(x) | BIT_TDE_LEN_TH0_8821C(v)) -+ -+/* 2 REG_RXDMA_LEN_THRESHOLD_8821C */ -+ -+#define BIT_SHIFT_RDE_LEN_TH1_8821C 16 -+#define BIT_MASK_RDE_LEN_TH1_8821C 0xffff -+#define BIT_RDE_LEN_TH1_8821C(x) \ -+ (((x) & BIT_MASK_RDE_LEN_TH1_8821C) << BIT_SHIFT_RDE_LEN_TH1_8821C) -+#define BITS_RDE_LEN_TH1_8821C \ -+ (BIT_MASK_RDE_LEN_TH1_8821C << BIT_SHIFT_RDE_LEN_TH1_8821C) -+#define BIT_CLEAR_RDE_LEN_TH1_8821C(x) ((x) & (~BITS_RDE_LEN_TH1_8821C)) -+#define BIT_GET_RDE_LEN_TH1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RDE_LEN_TH1_8821C) & BIT_MASK_RDE_LEN_TH1_8821C) -+#define BIT_SET_RDE_LEN_TH1_8821C(x, v) \ -+ (BIT_CLEAR_RDE_LEN_TH1_8821C(x) | BIT_RDE_LEN_TH1_8821C(v)) -+ -+#define BIT_SHIFT_RDE_LEN_TH0_8821C 0 -+#define BIT_MASK_RDE_LEN_TH0_8821C 0xffff -+#define BIT_RDE_LEN_TH0_8821C(x) \ -+ (((x) & BIT_MASK_RDE_LEN_TH0_8821C) << BIT_SHIFT_RDE_LEN_TH0_8821C) -+#define BITS_RDE_LEN_TH0_8821C \ -+ (BIT_MASK_RDE_LEN_TH0_8821C << BIT_SHIFT_RDE_LEN_TH0_8821C) -+#define BIT_CLEAR_RDE_LEN_TH0_8821C(x) ((x) & (~BITS_RDE_LEN_TH0_8821C)) -+#define BIT_GET_RDE_LEN_TH0_8821C(x) \ -+ (((x) >> BIT_SHIFT_RDE_LEN_TH0_8821C) & BIT_MASK_RDE_LEN_TH0_8821C) -+#define BIT_SET_RDE_LEN_TH0_8821C(x, v) \ -+ (BIT_CLEAR_RDE_LEN_TH0_8821C(x) | BIT_RDE_LEN_TH0_8821C(v)) -+ -+/* 2 REG_PCIE_EXEC_TIME_THRESHOLD_8821C */ -+ -+#define BIT_SHIFT_COUNT_INT_SEL_8821C 16 -+#define BIT_MASK_COUNT_INT_SEL_8821C 0x3 -+#define BIT_COUNT_INT_SEL_8821C(x) \ -+ (((x) & BIT_MASK_COUNT_INT_SEL_8821C) << BIT_SHIFT_COUNT_INT_SEL_8821C) -+#define BITS_COUNT_INT_SEL_8821C \ -+ (BIT_MASK_COUNT_INT_SEL_8821C << BIT_SHIFT_COUNT_INT_SEL_8821C) -+#define BIT_CLEAR_COUNT_INT_SEL_8821C(x) ((x) & (~BITS_COUNT_INT_SEL_8821C)) -+#define BIT_GET_COUNT_INT_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_COUNT_INT_SEL_8821C) & BIT_MASK_COUNT_INT_SEL_8821C) -+#define BIT_SET_COUNT_INT_SEL_8821C(x, v) \ -+ (BIT_CLEAR_COUNT_INT_SEL_8821C(x) | BIT_COUNT_INT_SEL_8821C(v)) -+ -+#define BIT_SHIFT_EXEC_TIME_TH_8821C 0 -+#define BIT_MASK_EXEC_TIME_TH_8821C 0xffff -+#define BIT_EXEC_TIME_TH_8821C(x) \ -+ (((x) & BIT_MASK_EXEC_TIME_TH_8821C) << BIT_SHIFT_EXEC_TIME_TH_8821C) -+#define BITS_EXEC_TIME_TH_8821C \ -+ (BIT_MASK_EXEC_TIME_TH_8821C << BIT_SHIFT_EXEC_TIME_TH_8821C) -+#define BIT_CLEAR_EXEC_TIME_TH_8821C(x) ((x) & (~BITS_EXEC_TIME_TH_8821C)) -+#define BIT_GET_EXEC_TIME_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_EXEC_TIME_TH_8821C) & BIT_MASK_EXEC_TIME_TH_8821C) -+#define BIT_SET_EXEC_TIME_TH_8821C(x, v) \ -+ (BIT_CLEAR_EXEC_TIME_TH_8821C(x) | BIT_EXEC_TIME_TH_8821C(v)) -+ -+/* 2 REG_FT2IMR_8821C */ -+#define BIT_FS_CLI3_RX_UAPSDMD1_EN_8821C BIT(31) -+#define BIT_FS_CLI3_RX_UAPSDMD0_EN_8821C BIT(30) -+#define BIT_FS_CLI3_TRIGGER_PKT_EN_8821C BIT(29) -+#define BIT_FS_CLI3_EOSP_INT_EN_8821C BIT(28) -+#define BIT_FS_CLI2_RX_UAPSDMD1_EN_8821C BIT(27) -+#define BIT_FS_CLI2_RX_UAPSDMD0_EN_8821C BIT(26) -+#define BIT_FS_CLI2_TRIGGER_PKT_EN_8821C BIT(25) -+#define BIT_FS_CLI2_EOSP_INT_EN_8821C BIT(24) -+#define BIT_FS_CLI1_RX_UAPSDMD1_EN_8821C BIT(23) -+#define BIT_FS_CLI1_RX_UAPSDMD0_EN_8821C BIT(22) -+#define BIT_FS_CLI1_TRIGGER_PKT_EN_8821C BIT(21) -+#define BIT_FS_CLI1_EOSP_INT_EN_8821C BIT(20) -+#define BIT_FS_CLI0_RX_UAPSDMD1_EN_8821C BIT(19) -+#define BIT_FS_CLI0_RX_UAPSDMD0_EN_8821C BIT(18) -+#define BIT_FS_CLI0_TRIGGER_PKT_EN_8821C BIT(17) -+#define BIT_FS_CLI0_EOSP_INT_EN_8821C BIT(16) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_EN_8821C BIT(9) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_EN_8821C BIT(8) -+#define BIT_FS_CLI3_TX_NULL1_INT_EN_8821C BIT(7) -+#define BIT_FS_CLI3_TX_NULL0_INT_EN_8821C BIT(6) -+#define BIT_FS_CLI2_TX_NULL1_INT_EN_8821C BIT(5) -+#define BIT_FS_CLI2_TX_NULL0_INT_EN_8821C BIT(4) -+#define BIT_FS_CLI1_TX_NULL1_INT_EN_8821C BIT(3) -+#define BIT_FS_CLI1_TX_NULL0_INT_EN_8821C BIT(2) -+#define BIT_FS_CLI0_TX_NULL1_INT_EN_8821C BIT(1) -+#define BIT_FS_CLI0_TX_NULL0_INT_EN_8821C BIT(0) -+ -+/* 2 REG_FT2ISR_8821C */ -+#define BIT_FS_CLI3_RX_UAPSDMD1_INT_8821C BIT(31) -+#define BIT_FS_CLI3_RX_UAPSDMD0_INT_8821C BIT(30) -+#define BIT_FS_CLI3_TRIGGER_PKT_INT_8821C BIT(29) -+#define BIT_FS_CLI3_EOSP_INT_8821C BIT(28) -+#define BIT_FS_CLI2_RX_UAPSDMD1_INT_8821C BIT(27) -+#define BIT_FS_CLI2_RX_UAPSDMD0_INT_8821C BIT(26) -+#define BIT_FS_CLI2_TRIGGER_PKT_INT_8821C BIT(25) -+#define BIT_FS_CLI2_EOSP_INT_8821C BIT(24) -+#define BIT_FS_CLI1_RX_UAPSDMD1_INT_8821C BIT(23) -+#define BIT_FS_CLI1_RX_UAPSDMD0_INT_8821C BIT(22) -+#define BIT_FS_CLI1_TRIGGER_PKT_INT_8821C BIT(21) -+#define BIT_FS_CLI1_EOSP_INT_8821C BIT(20) -+#define BIT_FS_CLI0_RX_UAPSDMD1_INT_8821C BIT(19) -+#define BIT_FS_CLI0_RX_UAPSDMD0_INT_8821C BIT(18) -+#define BIT_FS_CLI0_TRIGGER_PKT_INT_8821C BIT(17) -+#define BIT_FS_CLI0_EOSP_INT_8821C BIT(16) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_INT_8821C BIT(9) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_INT_8821C BIT(8) -+#define BIT_FS_CLI3_TX_NULL1_INT_8821C BIT(7) -+#define BIT_FS_CLI3_TX_NULL0_INT_8821C BIT(6) -+#define BIT_FS_CLI2_TX_NULL1_INT_8821C BIT(5) -+#define BIT_FS_CLI2_TX_NULL0_INT_8821C BIT(4) -+#define BIT_FS_CLI1_TX_NULL1_INT_8821C BIT(3) -+#define BIT_FS_CLI1_TX_NULL0_INT_8821C BIT(2) -+#define BIT_FS_CLI0_TX_NULL1_INT_8821C BIT(1) -+#define BIT_FS_CLI0_TX_NULL0_INT_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_MSG2_8821C */ -+ -+#define BIT_SHIFT_FW_MSG2_8821C 0 -+#define BIT_MASK_FW_MSG2_8821C 0xffffffffL -+#define BIT_FW_MSG2_8821C(x) \ -+ (((x) & BIT_MASK_FW_MSG2_8821C) << BIT_SHIFT_FW_MSG2_8821C) -+#define BITS_FW_MSG2_8821C (BIT_MASK_FW_MSG2_8821C << BIT_SHIFT_FW_MSG2_8821C) -+#define BIT_CLEAR_FW_MSG2_8821C(x) ((x) & (~BITS_FW_MSG2_8821C)) -+#define BIT_GET_FW_MSG2_8821C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG2_8821C) & BIT_MASK_FW_MSG2_8821C) -+#define BIT_SET_FW_MSG2_8821C(x, v) \ -+ (BIT_CLEAR_FW_MSG2_8821C(x) | BIT_FW_MSG2_8821C(v)) -+ -+/* 2 REG_MSG3_8821C */ -+ -+#define BIT_SHIFT_FW_MSG3_8821C 0 -+#define BIT_MASK_FW_MSG3_8821C 0xffffffffL -+#define BIT_FW_MSG3_8821C(x) \ -+ (((x) & BIT_MASK_FW_MSG3_8821C) << BIT_SHIFT_FW_MSG3_8821C) -+#define BITS_FW_MSG3_8821C (BIT_MASK_FW_MSG3_8821C << BIT_SHIFT_FW_MSG3_8821C) -+#define BIT_CLEAR_FW_MSG3_8821C(x) ((x) & (~BITS_FW_MSG3_8821C)) -+#define BIT_GET_FW_MSG3_8821C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG3_8821C) & BIT_MASK_FW_MSG3_8821C) -+#define BIT_SET_FW_MSG3_8821C(x, v) \ -+ (BIT_CLEAR_FW_MSG3_8821C(x) | BIT_FW_MSG3_8821C(v)) -+ -+/* 2 REG_MSG4_8821C */ -+ -+#define BIT_SHIFT_FW_MSG4_8821C 0 -+#define BIT_MASK_FW_MSG4_8821C 0xffffffffL -+#define BIT_FW_MSG4_8821C(x) \ -+ (((x) & BIT_MASK_FW_MSG4_8821C) << BIT_SHIFT_FW_MSG4_8821C) -+#define BITS_FW_MSG4_8821C (BIT_MASK_FW_MSG4_8821C << BIT_SHIFT_FW_MSG4_8821C) -+#define BIT_CLEAR_FW_MSG4_8821C(x) ((x) & (~BITS_FW_MSG4_8821C)) -+#define BIT_GET_FW_MSG4_8821C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG4_8821C) & BIT_MASK_FW_MSG4_8821C) -+#define BIT_SET_FW_MSG4_8821C(x, v) \ -+ (BIT_CLEAR_FW_MSG4_8821C(x) | BIT_FW_MSG4_8821C(v)) -+ -+/* 2 REG_MSG5_8821C */ -+ -+#define BIT_SHIFT_FW_MSG5_8821C 0 -+#define BIT_MASK_FW_MSG5_8821C 0xffffffffL -+#define BIT_FW_MSG5_8821C(x) \ -+ (((x) & BIT_MASK_FW_MSG5_8821C) << BIT_SHIFT_FW_MSG5_8821C) -+#define BITS_FW_MSG5_8821C (BIT_MASK_FW_MSG5_8821C << BIT_SHIFT_FW_MSG5_8821C) -+#define BIT_CLEAR_FW_MSG5_8821C(x) ((x) & (~BITS_FW_MSG5_8821C)) -+#define BIT_GET_FW_MSG5_8821C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG5_8821C) & BIT_MASK_FW_MSG5_8821C) -+#define BIT_SET_FW_MSG5_8821C(x, v) \ -+ (BIT_CLEAR_FW_MSG5_8821C(x) | BIT_FW_MSG5_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_FIFOPAGE_CTRL_1_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8821C 16 -+#define BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8821C 0xff -+#define BIT_TX_OQT_HE_FREE_SPACE_V1_8821C(x) \ -+ (((x) & BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8821C) \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8821C) -+#define BITS_TX_OQT_HE_FREE_SPACE_V1_8821C \ -+ (BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8821C \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8821C) -+#define BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1_8821C(x) \ -+ ((x) & (~BITS_TX_OQT_HE_FREE_SPACE_V1_8821C)) -+#define BIT_GET_TX_OQT_HE_FREE_SPACE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8821C) & \ -+ BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8821C) -+#define BIT_SET_TX_OQT_HE_FREE_SPACE_V1_8821C(x, v) \ -+ (BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1_8821C(x) | \ -+ BIT_TX_OQT_HE_FREE_SPACE_V1_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8821C 0 -+#define BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8821C 0xff -+#define BIT_TX_OQT_NL_FREE_SPACE_V1_8821C(x) \ -+ (((x) & BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8821C) \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8821C) -+#define BITS_TX_OQT_NL_FREE_SPACE_V1_8821C \ -+ (BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8821C \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8821C) -+#define BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1_8821C(x) \ -+ ((x) & (~BITS_TX_OQT_NL_FREE_SPACE_V1_8821C)) -+#define BIT_GET_TX_OQT_NL_FREE_SPACE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8821C) & \ -+ BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8821C) -+#define BIT_SET_TX_OQT_NL_FREE_SPACE_V1_8821C(x, v) \ -+ (BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1_8821C(x) | \ -+ BIT_TX_OQT_NL_FREE_SPACE_V1_8821C(v)) -+ -+/* 2 REG_FIFOPAGE_CTRL_2_8821C */ -+#define BIT_BCN_VALID_1_V1_8821C BIT(31) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_BCN_HEAD_1_V1_8821C 16 -+#define BIT_MASK_BCN_HEAD_1_V1_8821C 0xfff -+#define BIT_BCN_HEAD_1_V1_8821C(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_1_V1_8821C) << BIT_SHIFT_BCN_HEAD_1_V1_8821C) -+#define BITS_BCN_HEAD_1_V1_8821C \ -+ (BIT_MASK_BCN_HEAD_1_V1_8821C << BIT_SHIFT_BCN_HEAD_1_V1_8821C) -+#define BIT_CLEAR_BCN_HEAD_1_V1_8821C(x) ((x) & (~BITS_BCN_HEAD_1_V1_8821C)) -+#define BIT_GET_BCN_HEAD_1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_1_V1_8821C) & BIT_MASK_BCN_HEAD_1_V1_8821C) -+#define BIT_SET_BCN_HEAD_1_V1_8821C(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_1_V1_8821C(x) | BIT_BCN_HEAD_1_V1_8821C(v)) -+ -+#define BIT_BCN_VALID_V1_8821C BIT(15) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_BCN_HEAD_V1_8821C 0 -+#define BIT_MASK_BCN_HEAD_V1_8821C 0xfff -+#define BIT_BCN_HEAD_V1_8821C(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_V1_8821C) << BIT_SHIFT_BCN_HEAD_V1_8821C) -+#define BITS_BCN_HEAD_V1_8821C \ -+ (BIT_MASK_BCN_HEAD_V1_8821C << BIT_SHIFT_BCN_HEAD_V1_8821C) -+#define BIT_CLEAR_BCN_HEAD_V1_8821C(x) ((x) & (~BITS_BCN_HEAD_V1_8821C)) -+#define BIT_GET_BCN_HEAD_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_V1_8821C) & BIT_MASK_BCN_HEAD_V1_8821C) -+#define BIT_SET_BCN_HEAD_V1_8821C(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_V1_8821C(x) | BIT_BCN_HEAD_V1_8821C(v)) -+ -+/* 2 REG_AUTO_LLT_V1_8821C */ -+ -+#define BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C 24 -+#define BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C 0xff -+#define BIT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C(x) \ -+ (((x) & BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C) \ -+ << BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C) -+#define BITS_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C \ -+ (BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C \ -+ << BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C) -+#define BIT_CLEAR_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C(x) \ -+ ((x) & (~BITS_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C)) -+#define BIT_GET_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C) & \ -+ BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C) -+#define BIT_SET_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C(x, v) \ -+ (BIT_CLEAR_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C(x) | \ -+ BIT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8821C(v)) -+ -+#define BIT_SHIFT_LLT_FREE_PAGE_V1_8821C 8 -+#define BIT_MASK_LLT_FREE_PAGE_V1_8821C 0xffff -+#define BIT_LLT_FREE_PAGE_V1_8821C(x) \ -+ (((x) & BIT_MASK_LLT_FREE_PAGE_V1_8821C) \ -+ << BIT_SHIFT_LLT_FREE_PAGE_V1_8821C) -+#define BITS_LLT_FREE_PAGE_V1_8821C \ -+ (BIT_MASK_LLT_FREE_PAGE_V1_8821C << BIT_SHIFT_LLT_FREE_PAGE_V1_8821C) -+#define BIT_CLEAR_LLT_FREE_PAGE_V1_8821C(x) \ -+ ((x) & (~BITS_LLT_FREE_PAGE_V1_8821C)) -+#define BIT_GET_LLT_FREE_PAGE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_LLT_FREE_PAGE_V1_8821C) & \ -+ BIT_MASK_LLT_FREE_PAGE_V1_8821C) -+#define BIT_SET_LLT_FREE_PAGE_V1_8821C(x, v) \ -+ (BIT_CLEAR_LLT_FREE_PAGE_V1_8821C(x) | BIT_LLT_FREE_PAGE_V1_8821C(v)) -+ -+#define BIT_SHIFT_BLK_DESC_NUM_8821C 4 -+#define BIT_MASK_BLK_DESC_NUM_8821C 0xf -+#define BIT_BLK_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_BLK_DESC_NUM_8821C) << BIT_SHIFT_BLK_DESC_NUM_8821C) -+#define BITS_BLK_DESC_NUM_8821C \ -+ (BIT_MASK_BLK_DESC_NUM_8821C << BIT_SHIFT_BLK_DESC_NUM_8821C) -+#define BIT_CLEAR_BLK_DESC_NUM_8821C(x) ((x) & (~BITS_BLK_DESC_NUM_8821C)) -+#define BIT_GET_BLK_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_BLK_DESC_NUM_8821C) & BIT_MASK_BLK_DESC_NUM_8821C) -+#define BIT_SET_BLK_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_BLK_DESC_NUM_8821C(x) | BIT_BLK_DESC_NUM_8821C(v)) -+ -+#define BIT_R_BCN_HEAD_SEL_8821C BIT(3) -+#define BIT_R_EN_BCN_SW_HEAD_SEL_8821C BIT(2) -+#define BIT_LLT_DBG_SEL_8821C BIT(1) -+#define BIT_AUTO_INIT_LLT_V1_8821C BIT(0) -+ -+/* 2 REG_TXDMA_OFFSET_CHK_8821C */ -+#define BIT_EM_CHKSUM_FIN_8821C BIT(31) -+#define BIT_EMN_PCIE_DMA_MOD_8821C BIT(30) -+#define BIT_EN_TXQUE_CLR_8821C BIT(29) -+#define BIT_EN_PCIE_FIFO_MODE_8821C BIT(28) -+ -+#define BIT_SHIFT_PG_UNDER_TH_V1_8821C 16 -+#define BIT_MASK_PG_UNDER_TH_V1_8821C 0xfff -+#define BIT_PG_UNDER_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_PG_UNDER_TH_V1_8821C) \ -+ << BIT_SHIFT_PG_UNDER_TH_V1_8821C) -+#define BITS_PG_UNDER_TH_V1_8821C \ -+ (BIT_MASK_PG_UNDER_TH_V1_8821C << BIT_SHIFT_PG_UNDER_TH_V1_8821C) -+#define BIT_CLEAR_PG_UNDER_TH_V1_8821C(x) ((x) & (~BITS_PG_UNDER_TH_V1_8821C)) -+#define BIT_GET_PG_UNDER_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PG_UNDER_TH_V1_8821C) & \ -+ BIT_MASK_PG_UNDER_TH_V1_8821C) -+#define BIT_SET_PG_UNDER_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_PG_UNDER_TH_V1_8821C(x) | BIT_PG_UNDER_TH_V1_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+#define BIT_SDIO_TXDESC_CHKSUM_EN_8821C BIT(13) -+#define BIT_RST_RDPTR_8821C BIT(12) -+#define BIT_RST_WRPTR_8821C BIT(11) -+#define BIT_CHK_PG_TH_EN_8821C BIT(10) -+#define BIT_DROP_DATA_EN_8821C BIT(9) -+#define BIT_CHECK_OFFSET_EN_8821C BIT(8) -+ -+#define BIT_SHIFT_CHECK_OFFSET_8821C 0 -+#define BIT_MASK_CHECK_OFFSET_8821C 0xff -+#define BIT_CHECK_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_CHECK_OFFSET_8821C) << BIT_SHIFT_CHECK_OFFSET_8821C) -+#define BITS_CHECK_OFFSET_8821C \ -+ (BIT_MASK_CHECK_OFFSET_8821C << BIT_SHIFT_CHECK_OFFSET_8821C) -+#define BIT_CLEAR_CHECK_OFFSET_8821C(x) ((x) & (~BITS_CHECK_OFFSET_8821C)) -+#define BIT_GET_CHECK_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_CHECK_OFFSET_8821C) & BIT_MASK_CHECK_OFFSET_8821C) -+#define BIT_SET_CHECK_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_CHECK_OFFSET_8821C(x) | BIT_CHECK_OFFSET_8821C(v)) -+ -+/* 2 REG_TXDMA_STATUS_8821C */ -+#define BIT_TXPKTBUF_REQ_ERR_8821C BIT(18) -+#define BIT_HI_OQT_UDN_8821C BIT(17) -+#define BIT_HI_OQT_OVF_8821C BIT(16) -+#define BIT_PAYLOAD_CHKSUM_ERR_8821C BIT(15) -+#define BIT_PAYLOAD_UDN_8821C BIT(14) -+#define BIT_PAYLOAD_OVF_8821C BIT(13) -+#define BIT_DSC_CHKSUM_FAIL_8821C BIT(12) -+#define BIT_UNKNOWN_QSEL_8821C BIT(11) -+#define BIT_EP_QSEL_DIFF_8821C BIT(10) -+#define BIT_TX_OFFS_UNMATCH_8821C BIT(9) -+#define BIT_TXOQT_UDN_8821C BIT(8) -+#define BIT_TXOQT_OVF_8821C BIT(7) -+#define BIT_TXDMA_SFF_UDN_8821C BIT(6) -+#define BIT_TXDMA_SFF_OVF_8821C BIT(5) -+#define BIT_LLT_NULL_PG_8821C BIT(4) -+#define BIT_PAGE_UDN_8821C BIT(3) -+#define BIT_PAGE_OVF_8821C BIT(2) -+#define BIT_TXFF_PG_UDN_8821C BIT(1) -+#define BIT_TXFF_PG_OVF_8821C BIT(0) -+ -+/* 2 REG_TX_DMA_DBG_8821C */ -+ -+/* 2 REG_TQPNT1_8821C */ -+#define BIT_HPQ_INT_EN_8821C BIT(31) -+ -+#define BIT_SHIFT_HPQ_HIGH_TH_V1_8821C 16 -+#define BIT_MASK_HPQ_HIGH_TH_V1_8821C 0xfff -+#define BIT_HPQ_HIGH_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_HPQ_HIGH_TH_V1_8821C) \ -+ << BIT_SHIFT_HPQ_HIGH_TH_V1_8821C) -+#define BITS_HPQ_HIGH_TH_V1_8821C \ -+ (BIT_MASK_HPQ_HIGH_TH_V1_8821C << BIT_SHIFT_HPQ_HIGH_TH_V1_8821C) -+#define BIT_CLEAR_HPQ_HIGH_TH_V1_8821C(x) ((x) & (~BITS_HPQ_HIGH_TH_V1_8821C)) -+#define BIT_GET_HPQ_HIGH_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HPQ_HIGH_TH_V1_8821C) & \ -+ BIT_MASK_HPQ_HIGH_TH_V1_8821C) -+#define BIT_SET_HPQ_HIGH_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_HPQ_HIGH_TH_V1_8821C(x) | BIT_HPQ_HIGH_TH_V1_8821C(v)) -+ -+#define BIT_SHIFT_HPQ_LOW_TH_V1_8821C 0 -+#define BIT_MASK_HPQ_LOW_TH_V1_8821C 0xfff -+#define BIT_HPQ_LOW_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_HPQ_LOW_TH_V1_8821C) << BIT_SHIFT_HPQ_LOW_TH_V1_8821C) -+#define BITS_HPQ_LOW_TH_V1_8821C \ -+ (BIT_MASK_HPQ_LOW_TH_V1_8821C << BIT_SHIFT_HPQ_LOW_TH_V1_8821C) -+#define BIT_CLEAR_HPQ_LOW_TH_V1_8821C(x) ((x) & (~BITS_HPQ_LOW_TH_V1_8821C)) -+#define BIT_GET_HPQ_LOW_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HPQ_LOW_TH_V1_8821C) & BIT_MASK_HPQ_LOW_TH_V1_8821C) -+#define BIT_SET_HPQ_LOW_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_HPQ_LOW_TH_V1_8821C(x) | BIT_HPQ_LOW_TH_V1_8821C(v)) -+ -+/* 2 REG_TQPNT2_8821C */ -+#define BIT_NPQ_INT_EN_8821C BIT(31) -+ -+#define BIT_SHIFT_NPQ_HIGH_TH_V1_8821C 16 -+#define BIT_MASK_NPQ_HIGH_TH_V1_8821C 0xfff -+#define BIT_NPQ_HIGH_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_NPQ_HIGH_TH_V1_8821C) \ -+ << BIT_SHIFT_NPQ_HIGH_TH_V1_8821C) -+#define BITS_NPQ_HIGH_TH_V1_8821C \ -+ (BIT_MASK_NPQ_HIGH_TH_V1_8821C << BIT_SHIFT_NPQ_HIGH_TH_V1_8821C) -+#define BIT_CLEAR_NPQ_HIGH_TH_V1_8821C(x) ((x) & (~BITS_NPQ_HIGH_TH_V1_8821C)) -+#define BIT_GET_NPQ_HIGH_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_NPQ_HIGH_TH_V1_8821C) & \ -+ BIT_MASK_NPQ_HIGH_TH_V1_8821C) -+#define BIT_SET_NPQ_HIGH_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_NPQ_HIGH_TH_V1_8821C(x) | BIT_NPQ_HIGH_TH_V1_8821C(v)) -+ -+#define BIT_SHIFT_NPQ_LOW_TH_V1_8821C 0 -+#define BIT_MASK_NPQ_LOW_TH_V1_8821C 0xfff -+#define BIT_NPQ_LOW_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_NPQ_LOW_TH_V1_8821C) << BIT_SHIFT_NPQ_LOW_TH_V1_8821C) -+#define BITS_NPQ_LOW_TH_V1_8821C \ -+ (BIT_MASK_NPQ_LOW_TH_V1_8821C << BIT_SHIFT_NPQ_LOW_TH_V1_8821C) -+#define BIT_CLEAR_NPQ_LOW_TH_V1_8821C(x) ((x) & (~BITS_NPQ_LOW_TH_V1_8821C)) -+#define BIT_GET_NPQ_LOW_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_NPQ_LOW_TH_V1_8821C) & BIT_MASK_NPQ_LOW_TH_V1_8821C) -+#define BIT_SET_NPQ_LOW_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_NPQ_LOW_TH_V1_8821C(x) | BIT_NPQ_LOW_TH_V1_8821C(v)) -+ -+/* 2 REG_TQPNT3_8821C */ -+#define BIT_LPQ_INT_EN_8821C BIT(31) -+ -+#define BIT_SHIFT_LPQ_HIGH_TH_V1_8821C 16 -+#define BIT_MASK_LPQ_HIGH_TH_V1_8821C 0xfff -+#define BIT_LPQ_HIGH_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_LPQ_HIGH_TH_V1_8821C) \ -+ << BIT_SHIFT_LPQ_HIGH_TH_V1_8821C) -+#define BITS_LPQ_HIGH_TH_V1_8821C \ -+ (BIT_MASK_LPQ_HIGH_TH_V1_8821C << BIT_SHIFT_LPQ_HIGH_TH_V1_8821C) -+#define BIT_CLEAR_LPQ_HIGH_TH_V1_8821C(x) ((x) & (~BITS_LPQ_HIGH_TH_V1_8821C)) -+#define BIT_GET_LPQ_HIGH_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_LPQ_HIGH_TH_V1_8821C) & \ -+ BIT_MASK_LPQ_HIGH_TH_V1_8821C) -+#define BIT_SET_LPQ_HIGH_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_LPQ_HIGH_TH_V1_8821C(x) | BIT_LPQ_HIGH_TH_V1_8821C(v)) -+ -+#define BIT_SHIFT_LPQ_LOW_TH_V1_8821C 0 -+#define BIT_MASK_LPQ_LOW_TH_V1_8821C 0xfff -+#define BIT_LPQ_LOW_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_LPQ_LOW_TH_V1_8821C) << BIT_SHIFT_LPQ_LOW_TH_V1_8821C) -+#define BITS_LPQ_LOW_TH_V1_8821C \ -+ (BIT_MASK_LPQ_LOW_TH_V1_8821C << BIT_SHIFT_LPQ_LOW_TH_V1_8821C) -+#define BIT_CLEAR_LPQ_LOW_TH_V1_8821C(x) ((x) & (~BITS_LPQ_LOW_TH_V1_8821C)) -+#define BIT_GET_LPQ_LOW_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_LPQ_LOW_TH_V1_8821C) & BIT_MASK_LPQ_LOW_TH_V1_8821C) -+#define BIT_SET_LPQ_LOW_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_LPQ_LOW_TH_V1_8821C(x) | BIT_LPQ_LOW_TH_V1_8821C(v)) -+ -+/* 2 REG_TQPNT4_8821C */ -+#define BIT_EXQ_INT_EN_8821C BIT(31) -+ -+#define BIT_SHIFT_EXQ_HIGH_TH_V1_8821C 16 -+#define BIT_MASK_EXQ_HIGH_TH_V1_8821C 0xfff -+#define BIT_EXQ_HIGH_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_EXQ_HIGH_TH_V1_8821C) \ -+ << BIT_SHIFT_EXQ_HIGH_TH_V1_8821C) -+#define BITS_EXQ_HIGH_TH_V1_8821C \ -+ (BIT_MASK_EXQ_HIGH_TH_V1_8821C << BIT_SHIFT_EXQ_HIGH_TH_V1_8821C) -+#define BIT_CLEAR_EXQ_HIGH_TH_V1_8821C(x) ((x) & (~BITS_EXQ_HIGH_TH_V1_8821C)) -+#define BIT_GET_EXQ_HIGH_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_EXQ_HIGH_TH_V1_8821C) & \ -+ BIT_MASK_EXQ_HIGH_TH_V1_8821C) -+#define BIT_SET_EXQ_HIGH_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_EXQ_HIGH_TH_V1_8821C(x) | BIT_EXQ_HIGH_TH_V1_8821C(v)) -+ -+#define BIT_SHIFT_EXQ_LOW_TH_V1_8821C 0 -+#define BIT_MASK_EXQ_LOW_TH_V1_8821C 0xfff -+#define BIT_EXQ_LOW_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_EXQ_LOW_TH_V1_8821C) << BIT_SHIFT_EXQ_LOW_TH_V1_8821C) -+#define BITS_EXQ_LOW_TH_V1_8821C \ -+ (BIT_MASK_EXQ_LOW_TH_V1_8821C << BIT_SHIFT_EXQ_LOW_TH_V1_8821C) -+#define BIT_CLEAR_EXQ_LOW_TH_V1_8821C(x) ((x) & (~BITS_EXQ_LOW_TH_V1_8821C)) -+#define BIT_GET_EXQ_LOW_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_EXQ_LOW_TH_V1_8821C) & BIT_MASK_EXQ_LOW_TH_V1_8821C) -+#define BIT_SET_EXQ_LOW_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_EXQ_LOW_TH_V1_8821C(x) | BIT_EXQ_LOW_TH_V1_8821C(v)) -+ -+/* 2 REG_RQPN_CTRL_1_8821C */ -+ -+#define BIT_SHIFT_TXPKTNUM_H_8821C 16 -+#define BIT_MASK_TXPKTNUM_H_8821C 0xffff -+#define BIT_TXPKTNUM_H_8821C(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_H_8821C) << BIT_SHIFT_TXPKTNUM_H_8821C) -+#define BITS_TXPKTNUM_H_8821C \ -+ (BIT_MASK_TXPKTNUM_H_8821C << BIT_SHIFT_TXPKTNUM_H_8821C) -+#define BIT_CLEAR_TXPKTNUM_H_8821C(x) ((x) & (~BITS_TXPKTNUM_H_8821C)) -+#define BIT_GET_TXPKTNUM_H_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_H_8821C) & BIT_MASK_TXPKTNUM_H_8821C) -+#define BIT_SET_TXPKTNUM_H_8821C(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_H_8821C(x) | BIT_TXPKTNUM_H_8821C(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_V2_8821C 0 -+#define BIT_MASK_TXPKTNUM_V2_8821C 0xffff -+#define BIT_TXPKTNUM_V2_8821C(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_V2_8821C) << BIT_SHIFT_TXPKTNUM_V2_8821C) -+#define BITS_TXPKTNUM_V2_8821C \ -+ (BIT_MASK_TXPKTNUM_V2_8821C << BIT_SHIFT_TXPKTNUM_V2_8821C) -+#define BIT_CLEAR_TXPKTNUM_V2_8821C(x) ((x) & (~BITS_TXPKTNUM_V2_8821C)) -+#define BIT_GET_TXPKTNUM_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_V2_8821C) & BIT_MASK_TXPKTNUM_V2_8821C) -+#define BIT_SET_TXPKTNUM_V2_8821C(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_V2_8821C(x) | BIT_TXPKTNUM_V2_8821C(v)) -+ -+/* 2 REG_RQPN_CTRL_2_8821C */ -+#define BIT_LD_RQPN_8821C BIT(31) -+#define BIT_EXQ_PUBLIC_DIS_V1_8821C BIT(19) -+#define BIT_NPQ_PUBLIC_DIS_V1_8821C BIT(18) -+#define BIT_LPQ_PUBLIC_DIS_V1_8821C BIT(17) -+#define BIT_HPQ_PUBLIC_DIS_V1_8821C BIT(16) -+#define BIT_SDIO_TXAGG_ALIGN_ADJUST_EN_8821C BIT(15) -+ -+#define BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8821C 0 -+#define BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8821C 0xfff -+#define BIT_SDIO_TXAGG_ALIGN_SIZE_8821C(x) \ -+ (((x) & BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8821C) \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8821C) -+#define BITS_SDIO_TXAGG_ALIGN_SIZE_8821C \ -+ (BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8821C \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8821C) -+#define BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE_8821C(x) \ -+ ((x) & (~BITS_SDIO_TXAGG_ALIGN_SIZE_8821C)) -+#define BIT_GET_SDIO_TXAGG_ALIGN_SIZE_8821C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8821C) & \ -+ BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8821C) -+#define BIT_SET_SDIO_TXAGG_ALIGN_SIZE_8821C(x, v) \ -+ (BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE_8821C(x) | \ -+ BIT_SDIO_TXAGG_ALIGN_SIZE_8821C(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_1_8821C */ -+ -+#define BIT_SHIFT_HPQ_AVAL_PG_V1_8821C 16 -+#define BIT_MASK_HPQ_AVAL_PG_V1_8821C 0xfff -+#define BIT_HPQ_AVAL_PG_V1_8821C(x) \ -+ (((x) & BIT_MASK_HPQ_AVAL_PG_V1_8821C) \ -+ << BIT_SHIFT_HPQ_AVAL_PG_V1_8821C) -+#define BITS_HPQ_AVAL_PG_V1_8821C \ -+ (BIT_MASK_HPQ_AVAL_PG_V1_8821C << BIT_SHIFT_HPQ_AVAL_PG_V1_8821C) -+#define BIT_CLEAR_HPQ_AVAL_PG_V1_8821C(x) ((x) & (~BITS_HPQ_AVAL_PG_V1_8821C)) -+#define BIT_GET_HPQ_AVAL_PG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HPQ_AVAL_PG_V1_8821C) & \ -+ BIT_MASK_HPQ_AVAL_PG_V1_8821C) -+#define BIT_SET_HPQ_AVAL_PG_V1_8821C(x, v) \ -+ (BIT_CLEAR_HPQ_AVAL_PG_V1_8821C(x) | BIT_HPQ_AVAL_PG_V1_8821C(v)) -+ -+#define BIT_SHIFT_HPQ_V1_8821C 0 -+#define BIT_MASK_HPQ_V1_8821C 0xfff -+#define BIT_HPQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_HPQ_V1_8821C) << BIT_SHIFT_HPQ_V1_8821C) -+#define BITS_HPQ_V1_8821C (BIT_MASK_HPQ_V1_8821C << BIT_SHIFT_HPQ_V1_8821C) -+#define BIT_CLEAR_HPQ_V1_8821C(x) ((x) & (~BITS_HPQ_V1_8821C)) -+#define BIT_GET_HPQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HPQ_V1_8821C) & BIT_MASK_HPQ_V1_8821C) -+#define BIT_SET_HPQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_HPQ_V1_8821C(x) | BIT_HPQ_V1_8821C(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_2_8821C */ -+ -+#define BIT_SHIFT_LPQ_AVAL_PG_V1_8821C 16 -+#define BIT_MASK_LPQ_AVAL_PG_V1_8821C 0xfff -+#define BIT_LPQ_AVAL_PG_V1_8821C(x) \ -+ (((x) & BIT_MASK_LPQ_AVAL_PG_V1_8821C) \ -+ << BIT_SHIFT_LPQ_AVAL_PG_V1_8821C) -+#define BITS_LPQ_AVAL_PG_V1_8821C \ -+ (BIT_MASK_LPQ_AVAL_PG_V1_8821C << BIT_SHIFT_LPQ_AVAL_PG_V1_8821C) -+#define BIT_CLEAR_LPQ_AVAL_PG_V1_8821C(x) ((x) & (~BITS_LPQ_AVAL_PG_V1_8821C)) -+#define BIT_GET_LPQ_AVAL_PG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_LPQ_AVAL_PG_V1_8821C) & \ -+ BIT_MASK_LPQ_AVAL_PG_V1_8821C) -+#define BIT_SET_LPQ_AVAL_PG_V1_8821C(x, v) \ -+ (BIT_CLEAR_LPQ_AVAL_PG_V1_8821C(x) | BIT_LPQ_AVAL_PG_V1_8821C(v)) -+ -+#define BIT_SHIFT_LPQ_V1_8821C 0 -+#define BIT_MASK_LPQ_V1_8821C 0xfff -+#define BIT_LPQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_LPQ_V1_8821C) << BIT_SHIFT_LPQ_V1_8821C) -+#define BITS_LPQ_V1_8821C (BIT_MASK_LPQ_V1_8821C << BIT_SHIFT_LPQ_V1_8821C) -+#define BIT_CLEAR_LPQ_V1_8821C(x) ((x) & (~BITS_LPQ_V1_8821C)) -+#define BIT_GET_LPQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_LPQ_V1_8821C) & BIT_MASK_LPQ_V1_8821C) -+#define BIT_SET_LPQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_LPQ_V1_8821C(x) | BIT_LPQ_V1_8821C(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_3_8821C */ -+ -+#define BIT_SHIFT_NPQ_AVAL_PG_V1_8821C 16 -+#define BIT_MASK_NPQ_AVAL_PG_V1_8821C 0xfff -+#define BIT_NPQ_AVAL_PG_V1_8821C(x) \ -+ (((x) & BIT_MASK_NPQ_AVAL_PG_V1_8821C) \ -+ << BIT_SHIFT_NPQ_AVAL_PG_V1_8821C) -+#define BITS_NPQ_AVAL_PG_V1_8821C \ -+ (BIT_MASK_NPQ_AVAL_PG_V1_8821C << BIT_SHIFT_NPQ_AVAL_PG_V1_8821C) -+#define BIT_CLEAR_NPQ_AVAL_PG_V1_8821C(x) ((x) & (~BITS_NPQ_AVAL_PG_V1_8821C)) -+#define BIT_GET_NPQ_AVAL_PG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_NPQ_AVAL_PG_V1_8821C) & \ -+ BIT_MASK_NPQ_AVAL_PG_V1_8821C) -+#define BIT_SET_NPQ_AVAL_PG_V1_8821C(x, v) \ -+ (BIT_CLEAR_NPQ_AVAL_PG_V1_8821C(x) | BIT_NPQ_AVAL_PG_V1_8821C(v)) -+ -+#define BIT_SHIFT_NPQ_V1_8821C 0 -+#define BIT_MASK_NPQ_V1_8821C 0xfff -+#define BIT_NPQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_NPQ_V1_8821C) << BIT_SHIFT_NPQ_V1_8821C) -+#define BITS_NPQ_V1_8821C (BIT_MASK_NPQ_V1_8821C << BIT_SHIFT_NPQ_V1_8821C) -+#define BIT_CLEAR_NPQ_V1_8821C(x) ((x) & (~BITS_NPQ_V1_8821C)) -+#define BIT_GET_NPQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_NPQ_V1_8821C) & BIT_MASK_NPQ_V1_8821C) -+#define BIT_SET_NPQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_NPQ_V1_8821C(x) | BIT_NPQ_V1_8821C(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_4_8821C */ -+ -+#define BIT_SHIFT_EXQ_AVAL_PG_V1_8821C 16 -+#define BIT_MASK_EXQ_AVAL_PG_V1_8821C 0xfff -+#define BIT_EXQ_AVAL_PG_V1_8821C(x) \ -+ (((x) & BIT_MASK_EXQ_AVAL_PG_V1_8821C) \ -+ << BIT_SHIFT_EXQ_AVAL_PG_V1_8821C) -+#define BITS_EXQ_AVAL_PG_V1_8821C \ -+ (BIT_MASK_EXQ_AVAL_PG_V1_8821C << BIT_SHIFT_EXQ_AVAL_PG_V1_8821C) -+#define BIT_CLEAR_EXQ_AVAL_PG_V1_8821C(x) ((x) & (~BITS_EXQ_AVAL_PG_V1_8821C)) -+#define BIT_GET_EXQ_AVAL_PG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_EXQ_AVAL_PG_V1_8821C) & \ -+ BIT_MASK_EXQ_AVAL_PG_V1_8821C) -+#define BIT_SET_EXQ_AVAL_PG_V1_8821C(x, v) \ -+ (BIT_CLEAR_EXQ_AVAL_PG_V1_8821C(x) | BIT_EXQ_AVAL_PG_V1_8821C(v)) -+ -+#define BIT_SHIFT_EXQ_V1_8821C 0 -+#define BIT_MASK_EXQ_V1_8821C 0xfff -+#define BIT_EXQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_EXQ_V1_8821C) << BIT_SHIFT_EXQ_V1_8821C) -+#define BITS_EXQ_V1_8821C (BIT_MASK_EXQ_V1_8821C << BIT_SHIFT_EXQ_V1_8821C) -+#define BIT_CLEAR_EXQ_V1_8821C(x) ((x) & (~BITS_EXQ_V1_8821C)) -+#define BIT_GET_EXQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_EXQ_V1_8821C) & BIT_MASK_EXQ_V1_8821C) -+#define BIT_SET_EXQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_EXQ_V1_8821C(x) | BIT_EXQ_V1_8821C(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_5_8821C */ -+ -+#define BIT_SHIFT_PUBQ_AVAL_PG_V1_8821C 16 -+#define BIT_MASK_PUBQ_AVAL_PG_V1_8821C 0xfff -+#define BIT_PUBQ_AVAL_PG_V1_8821C(x) \ -+ (((x) & BIT_MASK_PUBQ_AVAL_PG_V1_8821C) \ -+ << BIT_SHIFT_PUBQ_AVAL_PG_V1_8821C) -+#define BITS_PUBQ_AVAL_PG_V1_8821C \ -+ (BIT_MASK_PUBQ_AVAL_PG_V1_8821C << BIT_SHIFT_PUBQ_AVAL_PG_V1_8821C) -+#define BIT_CLEAR_PUBQ_AVAL_PG_V1_8821C(x) ((x) & (~BITS_PUBQ_AVAL_PG_V1_8821C)) -+#define BIT_GET_PUBQ_AVAL_PG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_AVAL_PG_V1_8821C) & \ -+ BIT_MASK_PUBQ_AVAL_PG_V1_8821C) -+#define BIT_SET_PUBQ_AVAL_PG_V1_8821C(x, v) \ -+ (BIT_CLEAR_PUBQ_AVAL_PG_V1_8821C(x) | BIT_PUBQ_AVAL_PG_V1_8821C(v)) -+ -+#define BIT_SHIFT_PUBQ_V1_8821C 0 -+#define BIT_MASK_PUBQ_V1_8821C 0xfff -+#define BIT_PUBQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_PUBQ_V1_8821C) << BIT_SHIFT_PUBQ_V1_8821C) -+#define BITS_PUBQ_V1_8821C (BIT_MASK_PUBQ_V1_8821C << BIT_SHIFT_PUBQ_V1_8821C) -+#define BIT_CLEAR_PUBQ_V1_8821C(x) ((x) & (~BITS_PUBQ_V1_8821C)) -+#define BIT_GET_PUBQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_V1_8821C) & BIT_MASK_PUBQ_V1_8821C) -+#define BIT_SET_PUBQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_PUBQ_V1_8821C(x) | BIT_PUBQ_V1_8821C(v)) -+ -+/* 2 REG_H2C_HEAD_8821C */ -+ -+#define BIT_SHIFT_H2C_HEAD_8821C 0 -+#define BIT_MASK_H2C_HEAD_8821C 0x3ffff -+#define BIT_H2C_HEAD_8821C(x) \ -+ (((x) & BIT_MASK_H2C_HEAD_8821C) << BIT_SHIFT_H2C_HEAD_8821C) -+#define BITS_H2C_HEAD_8821C \ -+ (BIT_MASK_H2C_HEAD_8821C << BIT_SHIFT_H2C_HEAD_8821C) -+#define BIT_CLEAR_H2C_HEAD_8821C(x) ((x) & (~BITS_H2C_HEAD_8821C)) -+#define BIT_GET_H2C_HEAD_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2C_HEAD_8821C) & BIT_MASK_H2C_HEAD_8821C) -+#define BIT_SET_H2C_HEAD_8821C(x, v) \ -+ (BIT_CLEAR_H2C_HEAD_8821C(x) | BIT_H2C_HEAD_8821C(v)) -+ -+/* 2 REG_H2C_TAIL_8821C */ -+ -+#define BIT_SHIFT_H2C_TAIL_8821C 0 -+#define BIT_MASK_H2C_TAIL_8821C 0x3ffff -+#define BIT_H2C_TAIL_8821C(x) \ -+ (((x) & BIT_MASK_H2C_TAIL_8821C) << BIT_SHIFT_H2C_TAIL_8821C) -+#define BITS_H2C_TAIL_8821C \ -+ (BIT_MASK_H2C_TAIL_8821C << BIT_SHIFT_H2C_TAIL_8821C) -+#define BIT_CLEAR_H2C_TAIL_8821C(x) ((x) & (~BITS_H2C_TAIL_8821C)) -+#define BIT_GET_H2C_TAIL_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2C_TAIL_8821C) & BIT_MASK_H2C_TAIL_8821C) -+#define BIT_SET_H2C_TAIL_8821C(x, v) \ -+ (BIT_CLEAR_H2C_TAIL_8821C(x) | BIT_H2C_TAIL_8821C(v)) -+ -+/* 2 REG_H2C_READ_ADDR_8821C */ -+ -+#define BIT_SHIFT_H2C_READ_ADDR_8821C 0 -+#define BIT_MASK_H2C_READ_ADDR_8821C 0x3ffff -+#define BIT_H2C_READ_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_H2C_READ_ADDR_8821C) << BIT_SHIFT_H2C_READ_ADDR_8821C) -+#define BITS_H2C_READ_ADDR_8821C \ -+ (BIT_MASK_H2C_READ_ADDR_8821C << BIT_SHIFT_H2C_READ_ADDR_8821C) -+#define BIT_CLEAR_H2C_READ_ADDR_8821C(x) ((x) & (~BITS_H2C_READ_ADDR_8821C)) -+#define BIT_GET_H2C_READ_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2C_READ_ADDR_8821C) & BIT_MASK_H2C_READ_ADDR_8821C) -+#define BIT_SET_H2C_READ_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_H2C_READ_ADDR_8821C(x) | BIT_H2C_READ_ADDR_8821C(v)) -+ -+/* 2 REG_H2C_WR_ADDR_8821C */ -+ -+#define BIT_SHIFT_H2C_WR_ADDR_8821C 0 -+#define BIT_MASK_H2C_WR_ADDR_8821C 0x3ffff -+#define BIT_H2C_WR_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_H2C_WR_ADDR_8821C) << BIT_SHIFT_H2C_WR_ADDR_8821C) -+#define BITS_H2C_WR_ADDR_8821C \ -+ (BIT_MASK_H2C_WR_ADDR_8821C << BIT_SHIFT_H2C_WR_ADDR_8821C) -+#define BIT_CLEAR_H2C_WR_ADDR_8821C(x) ((x) & (~BITS_H2C_WR_ADDR_8821C)) -+#define BIT_GET_H2C_WR_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2C_WR_ADDR_8821C) & BIT_MASK_H2C_WR_ADDR_8821C) -+#define BIT_SET_H2C_WR_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_H2C_WR_ADDR_8821C(x) | BIT_H2C_WR_ADDR_8821C(v)) -+ -+/* 2 REG_H2C_INFO_8821C */ -+#define BIT_H2C_SPACE_VLD_8821C BIT(3) -+#define BIT_H2C_WR_ADDR_RST_8821C BIT(2) -+ -+#define BIT_SHIFT_H2C_LEN_SEL_8821C 0 -+#define BIT_MASK_H2C_LEN_SEL_8821C 0x3 -+#define BIT_H2C_LEN_SEL_8821C(x) \ -+ (((x) & BIT_MASK_H2C_LEN_SEL_8821C) << BIT_SHIFT_H2C_LEN_SEL_8821C) -+#define BITS_H2C_LEN_SEL_8821C \ -+ (BIT_MASK_H2C_LEN_SEL_8821C << BIT_SHIFT_H2C_LEN_SEL_8821C) -+#define BIT_CLEAR_H2C_LEN_SEL_8821C(x) ((x) & (~BITS_H2C_LEN_SEL_8821C)) -+#define BIT_GET_H2C_LEN_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2C_LEN_SEL_8821C) & BIT_MASK_H2C_LEN_SEL_8821C) -+#define BIT_SET_H2C_LEN_SEL_8821C(x, v) \ -+ (BIT_CLEAR_H2C_LEN_SEL_8821C(x) | BIT_H2C_LEN_SEL_8821C(v)) -+ -+/* 2 REG_RXDMA_AGG_PG_TH_8821C */ -+#define BIT_USB_RXDMA_AGG_EN_8821C BIT(31) -+#define BIT_EN_PRE_CALC_8821C BIT(29) -+#define BIT_RXAGG_SW_EN_8821C BIT(28) -+#define BIT_RXAGG_SW_TRIG_8821C BIT(27) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_PKT_NUM_WOL_8821C 16 -+#define BIT_MASK_PKT_NUM_WOL_8821C 0xff -+#define BIT_PKT_NUM_WOL_8821C(x) \ -+ (((x) & BIT_MASK_PKT_NUM_WOL_8821C) << BIT_SHIFT_PKT_NUM_WOL_8821C) -+#define BITS_PKT_NUM_WOL_8821C \ -+ (BIT_MASK_PKT_NUM_WOL_8821C << BIT_SHIFT_PKT_NUM_WOL_8821C) -+#define BIT_CLEAR_PKT_NUM_WOL_8821C(x) ((x) & (~BITS_PKT_NUM_WOL_8821C)) -+#define BIT_GET_PKT_NUM_WOL_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_WOL_8821C) & BIT_MASK_PKT_NUM_WOL_8821C) -+#define BIT_SET_PKT_NUM_WOL_8821C(x, v) \ -+ (BIT_CLEAR_PKT_NUM_WOL_8821C(x) | BIT_PKT_NUM_WOL_8821C(v)) -+ -+#define BIT_SHIFT_DMA_AGG_TO_V1_8821C 8 -+#define BIT_MASK_DMA_AGG_TO_V1_8821C 0xff -+#define BIT_DMA_AGG_TO_V1_8821C(x) \ -+ (((x) & BIT_MASK_DMA_AGG_TO_V1_8821C) << BIT_SHIFT_DMA_AGG_TO_V1_8821C) -+#define BITS_DMA_AGG_TO_V1_8821C \ -+ (BIT_MASK_DMA_AGG_TO_V1_8821C << BIT_SHIFT_DMA_AGG_TO_V1_8821C) -+#define BIT_CLEAR_DMA_AGG_TO_V1_8821C(x) ((x) & (~BITS_DMA_AGG_TO_V1_8821C)) -+#define BIT_GET_DMA_AGG_TO_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DMA_AGG_TO_V1_8821C) & BIT_MASK_DMA_AGG_TO_V1_8821C) -+#define BIT_SET_DMA_AGG_TO_V1_8821C(x, v) \ -+ (BIT_CLEAR_DMA_AGG_TO_V1_8821C(x) | BIT_DMA_AGG_TO_V1_8821C(v)) -+ -+#define BIT_SHIFT_RXDMA_AGG_PG_TH_8821C 0 -+#define BIT_MASK_RXDMA_AGG_PG_TH_8821C 0xff -+#define BIT_RXDMA_AGG_PG_TH_8821C(x) \ -+ (((x) & BIT_MASK_RXDMA_AGG_PG_TH_8821C) \ -+ << BIT_SHIFT_RXDMA_AGG_PG_TH_8821C) -+#define BITS_RXDMA_AGG_PG_TH_8821C \ -+ (BIT_MASK_RXDMA_AGG_PG_TH_8821C << BIT_SHIFT_RXDMA_AGG_PG_TH_8821C) -+#define BIT_CLEAR_RXDMA_AGG_PG_TH_8821C(x) ((x) & (~BITS_RXDMA_AGG_PG_TH_8821C)) -+#define BIT_GET_RXDMA_AGG_PG_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_AGG_PG_TH_8821C) & \ -+ BIT_MASK_RXDMA_AGG_PG_TH_8821C) -+#define BIT_SET_RXDMA_AGG_PG_TH_8821C(x, v) \ -+ (BIT_CLEAR_RXDMA_AGG_PG_TH_8821C(x) | BIT_RXDMA_AGG_PG_TH_8821C(v)) -+ -+/* 2 REG_RXPKT_NUM_8821C */ -+ -+#define BIT_SHIFT_RXPKT_NUM_8821C 24 -+#define BIT_MASK_RXPKT_NUM_8821C 0xff -+#define BIT_RXPKT_NUM_8821C(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_8821C) << BIT_SHIFT_RXPKT_NUM_8821C) -+#define BITS_RXPKT_NUM_8821C \ -+ (BIT_MASK_RXPKT_NUM_8821C << BIT_SHIFT_RXPKT_NUM_8821C) -+#define BIT_CLEAR_RXPKT_NUM_8821C(x) ((x) & (~BITS_RXPKT_NUM_8821C)) -+#define BIT_GET_RXPKT_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_8821C) & BIT_MASK_RXPKT_NUM_8821C) -+#define BIT_SET_RXPKT_NUM_8821C(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_8821C(x) | BIT_RXPKT_NUM_8821C(v)) -+ -+#define BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8821C 20 -+#define BIT_MASK_FW_UPD_RDPTR19_TO_16_8821C 0xf -+#define BIT_FW_UPD_RDPTR19_TO_16_8821C(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR19_TO_16_8821C) \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8821C) -+#define BITS_FW_UPD_RDPTR19_TO_16_8821C \ -+ (BIT_MASK_FW_UPD_RDPTR19_TO_16_8821C \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8821C) -+#define BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8821C(x) \ -+ ((x) & (~BITS_FW_UPD_RDPTR19_TO_16_8821C)) -+#define BIT_GET_FW_UPD_RDPTR19_TO_16_8821C(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8821C) & \ -+ BIT_MASK_FW_UPD_RDPTR19_TO_16_8821C) -+#define BIT_SET_FW_UPD_RDPTR19_TO_16_8821C(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8821C(x) | \ -+ BIT_FW_UPD_RDPTR19_TO_16_8821C(v)) -+ -+#define BIT_RXDMA_REQ_8821C BIT(19) -+#define BIT_RW_RELEASE_EN_8821C BIT(18) -+#define BIT_RXDMA_IDLE_8821C BIT(17) -+#define BIT_RXPKT_RELEASE_POLL_8821C BIT(16) -+ -+#define BIT_SHIFT_FW_UPD_RDPTR_8821C 0 -+#define BIT_MASK_FW_UPD_RDPTR_8821C 0xffff -+#define BIT_FW_UPD_RDPTR_8821C(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR_8821C) << BIT_SHIFT_FW_UPD_RDPTR_8821C) -+#define BITS_FW_UPD_RDPTR_8821C \ -+ (BIT_MASK_FW_UPD_RDPTR_8821C << BIT_SHIFT_FW_UPD_RDPTR_8821C) -+#define BIT_CLEAR_FW_UPD_RDPTR_8821C(x) ((x) & (~BITS_FW_UPD_RDPTR_8821C)) -+#define BIT_GET_FW_UPD_RDPTR_8821C(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR_8821C) & BIT_MASK_FW_UPD_RDPTR_8821C) -+#define BIT_SET_FW_UPD_RDPTR_8821C(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR_8821C(x) | BIT_FW_UPD_RDPTR_8821C(v)) -+ -+/* 2 REG_RXDMA_STATUS_8821C */ -+#define BIT_C2H_PKT_OVF_8821C BIT(7) -+#define BIT_AGG_CONFGI_ISSUE_8821C BIT(6) -+#define BIT_FW_POLL_ISSUE_8821C BIT(5) -+#define BIT_RX_DATA_UDN_8821C BIT(4) -+#define BIT_RX_SFF_UDN_8821C BIT(3) -+#define BIT_RX_SFF_OVF_8821C BIT(2) -+#define BIT_RXPKT_OVF_8821C BIT(0) -+ -+/* 2 REG_RXDMA_DPR_8821C */ -+ -+#define BIT_SHIFT_RDE_DEBUG_8821C 0 -+#define BIT_MASK_RDE_DEBUG_8821C 0xffffffffL -+#define BIT_RDE_DEBUG_8821C(x) \ -+ (((x) & BIT_MASK_RDE_DEBUG_8821C) << BIT_SHIFT_RDE_DEBUG_8821C) -+#define BITS_RDE_DEBUG_8821C \ -+ (BIT_MASK_RDE_DEBUG_8821C << BIT_SHIFT_RDE_DEBUG_8821C) -+#define BIT_CLEAR_RDE_DEBUG_8821C(x) ((x) & (~BITS_RDE_DEBUG_8821C)) -+#define BIT_GET_RDE_DEBUG_8821C(x) \ -+ (((x) >> BIT_SHIFT_RDE_DEBUG_8821C) & BIT_MASK_RDE_DEBUG_8821C) -+#define BIT_SET_RDE_DEBUG_8821C(x, v) \ -+ (BIT_CLEAR_RDE_DEBUG_8821C(x) | BIT_RDE_DEBUG_8821C(v)) -+ -+/* 2 REG_RXDMA_MODE_8821C */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V2_8821C 24 -+#define BIT_MASK_PKTNUM_TH_V2_8821C 0x1f -+#define BIT_PKTNUM_TH_V2_8821C(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V2_8821C) << BIT_SHIFT_PKTNUM_TH_V2_8821C) -+#define BITS_PKTNUM_TH_V2_8821C \ -+ (BIT_MASK_PKTNUM_TH_V2_8821C << BIT_SHIFT_PKTNUM_TH_V2_8821C) -+#define BIT_CLEAR_PKTNUM_TH_V2_8821C(x) ((x) & (~BITS_PKTNUM_TH_V2_8821C)) -+#define BIT_GET_PKTNUM_TH_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V2_8821C) & BIT_MASK_PKTNUM_TH_V2_8821C) -+#define BIT_SET_PKTNUM_TH_V2_8821C(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V2_8821C(x) | BIT_PKTNUM_TH_V2_8821C(v)) -+ -+#define BIT_TXBA_BREAK_USBAGG_8821C BIT(23) -+ -+#define BIT_SHIFT_PKTLEN_PARA_8821C 16 -+#define BIT_MASK_PKTLEN_PARA_8821C 0x7 -+#define BIT_PKTLEN_PARA_8821C(x) \ -+ (((x) & BIT_MASK_PKTLEN_PARA_8821C) << BIT_SHIFT_PKTLEN_PARA_8821C) -+#define BITS_PKTLEN_PARA_8821C \ -+ (BIT_MASK_PKTLEN_PARA_8821C << BIT_SHIFT_PKTLEN_PARA_8821C) -+#define BIT_CLEAR_PKTLEN_PARA_8821C(x) ((x) & (~BITS_PKTLEN_PARA_8821C)) -+#define BIT_GET_PKTLEN_PARA_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKTLEN_PARA_8821C) & BIT_MASK_PKTLEN_PARA_8821C) -+#define BIT_SET_PKTLEN_PARA_8821C(x, v) \ -+ (BIT_CLEAR_PKTLEN_PARA_8821C(x) | BIT_PKTLEN_PARA_8821C(v)) -+ -+#define BIT_SHIFT_BURST_SIZE_8821C 4 -+#define BIT_MASK_BURST_SIZE_8821C 0x3 -+#define BIT_BURST_SIZE_8821C(x) \ -+ (((x) & BIT_MASK_BURST_SIZE_8821C) << BIT_SHIFT_BURST_SIZE_8821C) -+#define BITS_BURST_SIZE_8821C \ -+ (BIT_MASK_BURST_SIZE_8821C << BIT_SHIFT_BURST_SIZE_8821C) -+#define BIT_CLEAR_BURST_SIZE_8821C(x) ((x) & (~BITS_BURST_SIZE_8821C)) -+#define BIT_GET_BURST_SIZE_8821C(x) \ -+ (((x) >> BIT_SHIFT_BURST_SIZE_8821C) & BIT_MASK_BURST_SIZE_8821C) -+#define BIT_SET_BURST_SIZE_8821C(x, v) \ -+ (BIT_CLEAR_BURST_SIZE_8821C(x) | BIT_BURST_SIZE_8821C(v)) -+ -+#define BIT_SHIFT_BURST_CNT_8821C 2 -+#define BIT_MASK_BURST_CNT_8821C 0x3 -+#define BIT_BURST_CNT_8821C(x) \ -+ (((x) & BIT_MASK_BURST_CNT_8821C) << BIT_SHIFT_BURST_CNT_8821C) -+#define BITS_BURST_CNT_8821C \ -+ (BIT_MASK_BURST_CNT_8821C << BIT_SHIFT_BURST_CNT_8821C) -+#define BIT_CLEAR_BURST_CNT_8821C(x) ((x) & (~BITS_BURST_CNT_8821C)) -+#define BIT_GET_BURST_CNT_8821C(x) \ -+ (((x) >> BIT_SHIFT_BURST_CNT_8821C) & BIT_MASK_BURST_CNT_8821C) -+#define BIT_SET_BURST_CNT_8821C(x, v) \ -+ (BIT_CLEAR_BURST_CNT_8821C(x) | BIT_BURST_CNT_8821C(v)) -+ -+#define BIT_DMA_MODE_8821C BIT(1) -+ -+/* 2 REG_C2H_PKT_8821C */ -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8821C 24 -+#define BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8821C 0xf -+#define BIT_R_C2H_STR_ADDR_16_TO_19_8821C(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8821C) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8821C) -+#define BITS_R_C2H_STR_ADDR_16_TO_19_8821C \ -+ (BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8821C \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8821C) -+#define BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8821C(x) \ -+ ((x) & (~BITS_R_C2H_STR_ADDR_16_TO_19_8821C)) -+#define BIT_GET_R_C2H_STR_ADDR_16_TO_19_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8821C) & \ -+ BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8821C) -+#define BIT_SET_R_C2H_STR_ADDR_16_TO_19_8821C(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8821C(x) | \ -+ BIT_R_C2H_STR_ADDR_16_TO_19_8821C(v)) -+ -+#define BIT_R_C2H_PKT_REQ_8821C BIT(16) -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_8821C 0 -+#define BIT_MASK_R_C2H_STR_ADDR_8821C 0xffff -+#define BIT_R_C2H_STR_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_8821C) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_8821C) -+#define BITS_R_C2H_STR_ADDR_8821C \ -+ (BIT_MASK_R_C2H_STR_ADDR_8821C << BIT_SHIFT_R_C2H_STR_ADDR_8821C) -+#define BIT_CLEAR_R_C2H_STR_ADDR_8821C(x) ((x) & (~BITS_R_C2H_STR_ADDR_8821C)) -+#define BIT_GET_R_C2H_STR_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_8821C) & \ -+ BIT_MASK_R_C2H_STR_ADDR_8821C) -+#define BIT_SET_R_C2H_STR_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_8821C(x) | BIT_R_C2H_STR_ADDR_8821C(v)) -+ -+/* 2 REG_FWFF_C2H_8821C */ -+ -+#define BIT_SHIFT_C2H_DMA_ADDR_8821C 0 -+#define BIT_MASK_C2H_DMA_ADDR_8821C 0x3ffff -+#define BIT_C2H_DMA_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_C2H_DMA_ADDR_8821C) << BIT_SHIFT_C2H_DMA_ADDR_8821C) -+#define BITS_C2H_DMA_ADDR_8821C \ -+ (BIT_MASK_C2H_DMA_ADDR_8821C << BIT_SHIFT_C2H_DMA_ADDR_8821C) -+#define BIT_CLEAR_C2H_DMA_ADDR_8821C(x) ((x) & (~BITS_C2H_DMA_ADDR_8821C)) -+#define BIT_GET_C2H_DMA_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_C2H_DMA_ADDR_8821C) & BIT_MASK_C2H_DMA_ADDR_8821C) -+#define BIT_SET_C2H_DMA_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_C2H_DMA_ADDR_8821C(x) | BIT_C2H_DMA_ADDR_8821C(v)) -+ -+/* 2 REG_FWFF_CTRL_8821C */ -+#define BIT_FWFF_DMAPKT_REQ_8821C BIT(31) -+ -+#define BIT_SHIFT_FWFF_DMA_PKT_NUM_8821C 16 -+#define BIT_MASK_FWFF_DMA_PKT_NUM_8821C 0xff -+#define BIT_FWFF_DMA_PKT_NUM_8821C(x) \ -+ (((x) & BIT_MASK_FWFF_DMA_PKT_NUM_8821C) \ -+ << BIT_SHIFT_FWFF_DMA_PKT_NUM_8821C) -+#define BITS_FWFF_DMA_PKT_NUM_8821C \ -+ (BIT_MASK_FWFF_DMA_PKT_NUM_8821C << BIT_SHIFT_FWFF_DMA_PKT_NUM_8821C) -+#define BIT_CLEAR_FWFF_DMA_PKT_NUM_8821C(x) \ -+ ((x) & (~BITS_FWFF_DMA_PKT_NUM_8821C)) -+#define BIT_GET_FWFF_DMA_PKT_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_FWFF_DMA_PKT_NUM_8821C) & \ -+ BIT_MASK_FWFF_DMA_PKT_NUM_8821C) -+#define BIT_SET_FWFF_DMA_PKT_NUM_8821C(x, v) \ -+ (BIT_CLEAR_FWFF_DMA_PKT_NUM_8821C(x) | BIT_FWFF_DMA_PKT_NUM_8821C(v)) -+ -+#define BIT_SHIFT_FWFF_STR_ADDR_8821C 0 -+#define BIT_MASK_FWFF_STR_ADDR_8821C 0xffff -+#define BIT_FWFF_STR_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_FWFF_STR_ADDR_8821C) << BIT_SHIFT_FWFF_STR_ADDR_8821C) -+#define BITS_FWFF_STR_ADDR_8821C \ -+ (BIT_MASK_FWFF_STR_ADDR_8821C << BIT_SHIFT_FWFF_STR_ADDR_8821C) -+#define BIT_CLEAR_FWFF_STR_ADDR_8821C(x) ((x) & (~BITS_FWFF_STR_ADDR_8821C)) -+#define BIT_GET_FWFF_STR_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_FWFF_STR_ADDR_8821C) & BIT_MASK_FWFF_STR_ADDR_8821C) -+#define BIT_SET_FWFF_STR_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_FWFF_STR_ADDR_8821C(x) | BIT_FWFF_STR_ADDR_8821C(v)) -+ -+/* 2 REG_FWFF_PKT_INFO_8821C */ -+ -+#define BIT_SHIFT_FWFF_PKT_QUEUED_8821C 16 -+#define BIT_MASK_FWFF_PKT_QUEUED_8821C 0xff -+#define BIT_FWFF_PKT_QUEUED_8821C(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_QUEUED_8821C) \ -+ << BIT_SHIFT_FWFF_PKT_QUEUED_8821C) -+#define BITS_FWFF_PKT_QUEUED_8821C \ -+ (BIT_MASK_FWFF_PKT_QUEUED_8821C << BIT_SHIFT_FWFF_PKT_QUEUED_8821C) -+#define BIT_CLEAR_FWFF_PKT_QUEUED_8821C(x) ((x) & (~BITS_FWFF_PKT_QUEUED_8821C)) -+#define BIT_GET_FWFF_PKT_QUEUED_8821C(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_QUEUED_8821C) & \ -+ BIT_MASK_FWFF_PKT_QUEUED_8821C) -+#define BIT_SET_FWFF_PKT_QUEUED_8821C(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_QUEUED_8821C(x) | BIT_FWFF_PKT_QUEUED_8821C(v)) -+ -+#define BIT_SHIFT_FWFF_PKT_STR_ADDR_8821C 0 -+#define BIT_MASK_FWFF_PKT_STR_ADDR_8821C 0xffff -+#define BIT_FWFF_PKT_STR_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_STR_ADDR_8821C) \ -+ << BIT_SHIFT_FWFF_PKT_STR_ADDR_8821C) -+#define BITS_FWFF_PKT_STR_ADDR_8821C \ -+ (BIT_MASK_FWFF_PKT_STR_ADDR_8821C << BIT_SHIFT_FWFF_PKT_STR_ADDR_8821C) -+#define BIT_CLEAR_FWFF_PKT_STR_ADDR_8821C(x) \ -+ ((x) & (~BITS_FWFF_PKT_STR_ADDR_8821C)) -+#define BIT_GET_FWFF_PKT_STR_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_STR_ADDR_8821C) & \ -+ BIT_MASK_FWFF_PKT_STR_ADDR_8821C) -+#define BIT_SET_FWFF_PKT_STR_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_STR_ADDR_8821C(x) | BIT_FWFF_PKT_STR_ADDR_8821C(v)) -+ -+/* 2 REG_DDMA_CH0SA_8821C */ -+ -+#define BIT_SHIFT_DDMACH0_SA_8821C 0 -+#define BIT_MASK_DDMACH0_SA_8821C 0xffffffffL -+#define BIT_DDMACH0_SA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH0_SA_8821C) << BIT_SHIFT_DDMACH0_SA_8821C) -+#define BITS_DDMACH0_SA_8821C \ -+ (BIT_MASK_DDMACH0_SA_8821C << BIT_SHIFT_DDMACH0_SA_8821C) -+#define BIT_CLEAR_DDMACH0_SA_8821C(x) ((x) & (~BITS_DDMACH0_SA_8821C)) -+#define BIT_GET_DDMACH0_SA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_SA_8821C) & BIT_MASK_DDMACH0_SA_8821C) -+#define BIT_SET_DDMACH0_SA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH0_SA_8821C(x) | BIT_DDMACH0_SA_8821C(v)) -+ -+/* 2 REG_DDMA_CH0DA_8821C */ -+ -+#define BIT_SHIFT_DDMACH0_DA_8821C 0 -+#define BIT_MASK_DDMACH0_DA_8821C 0xffffffffL -+#define BIT_DDMACH0_DA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH0_DA_8821C) << BIT_SHIFT_DDMACH0_DA_8821C) -+#define BITS_DDMACH0_DA_8821C \ -+ (BIT_MASK_DDMACH0_DA_8821C << BIT_SHIFT_DDMACH0_DA_8821C) -+#define BIT_CLEAR_DDMACH0_DA_8821C(x) ((x) & (~BITS_DDMACH0_DA_8821C)) -+#define BIT_GET_DDMACH0_DA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DA_8821C) & BIT_MASK_DDMACH0_DA_8821C) -+#define BIT_SET_DDMACH0_DA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH0_DA_8821C(x) | BIT_DDMACH0_DA_8821C(v)) -+ -+/* 2 REG_DDMA_CH0CTRL_8821C */ -+#define BIT_DDMACH0_OWN_8821C BIT(31) -+#define BIT_DDMACH0_IDMEM_ERR_8821C BIT(30) -+#define BIT_DDMACH0_CHKSUM_EN_8821C BIT(29) -+#define BIT_DDMACH0_DA_W_DISABLE_8821C BIT(28) -+#define BIT_DDMACH0_CHKSUM_STS_8821C BIT(27) -+#define BIT_DDMACH0_DDMA_MODE_8821C BIT(26) -+#define BIT_DDMACH0_RESET_CHKSUM_STS_8821C BIT(25) -+#define BIT_DDMACH0_CHKSUM_CONT_8821C BIT(24) -+ -+#define BIT_SHIFT_DDMACH0_DLEN_8821C 0 -+#define BIT_MASK_DDMACH0_DLEN_8821C 0x3ffff -+#define BIT_DDMACH0_DLEN_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH0_DLEN_8821C) << BIT_SHIFT_DDMACH0_DLEN_8821C) -+#define BITS_DDMACH0_DLEN_8821C \ -+ (BIT_MASK_DDMACH0_DLEN_8821C << BIT_SHIFT_DDMACH0_DLEN_8821C) -+#define BIT_CLEAR_DDMACH0_DLEN_8821C(x) ((x) & (~BITS_DDMACH0_DLEN_8821C)) -+#define BIT_GET_DDMACH0_DLEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DLEN_8821C) & BIT_MASK_DDMACH0_DLEN_8821C) -+#define BIT_SET_DDMACH0_DLEN_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH0_DLEN_8821C(x) | BIT_DDMACH0_DLEN_8821C(v)) -+ -+/* 2 REG_DDMA_CH1SA_8821C */ -+ -+#define BIT_SHIFT_DDMACH1_SA_8821C 0 -+#define BIT_MASK_DDMACH1_SA_8821C 0xffffffffL -+#define BIT_DDMACH1_SA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH1_SA_8821C) << BIT_SHIFT_DDMACH1_SA_8821C) -+#define BITS_DDMACH1_SA_8821C \ -+ (BIT_MASK_DDMACH1_SA_8821C << BIT_SHIFT_DDMACH1_SA_8821C) -+#define BIT_CLEAR_DDMACH1_SA_8821C(x) ((x) & (~BITS_DDMACH1_SA_8821C)) -+#define BIT_GET_DDMACH1_SA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_SA_8821C) & BIT_MASK_DDMACH1_SA_8821C) -+#define BIT_SET_DDMACH1_SA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH1_SA_8821C(x) | BIT_DDMACH1_SA_8821C(v)) -+ -+/* 2 REG_DDMA_CH1DA_8821C */ -+ -+#define BIT_SHIFT_DDMACH1_DA_8821C 0 -+#define BIT_MASK_DDMACH1_DA_8821C 0xffffffffL -+#define BIT_DDMACH1_DA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH1_DA_8821C) << BIT_SHIFT_DDMACH1_DA_8821C) -+#define BITS_DDMACH1_DA_8821C \ -+ (BIT_MASK_DDMACH1_DA_8821C << BIT_SHIFT_DDMACH1_DA_8821C) -+#define BIT_CLEAR_DDMACH1_DA_8821C(x) ((x) & (~BITS_DDMACH1_DA_8821C)) -+#define BIT_GET_DDMACH1_DA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DA_8821C) & BIT_MASK_DDMACH1_DA_8821C) -+#define BIT_SET_DDMACH1_DA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH1_DA_8821C(x) | BIT_DDMACH1_DA_8821C(v)) -+ -+/* 2 REG_DDMA_CH1CTRL_8821C */ -+#define BIT_DDMACH1_OWN_8821C BIT(31) -+#define BIT_DDMACH1_IDMEM_ERR_8821C BIT(30) -+#define BIT_DDMACH1_CHKSUM_EN_8821C BIT(29) -+#define BIT_DDMACH1_DA_W_DISABLE_8821C BIT(28) -+#define BIT_DDMACH1_CHKSUM_STS_8821C BIT(27) -+#define BIT_DDMACH1_DDMA_MODE_8821C BIT(26) -+#define BIT_DDMACH1_RESET_CHKSUM_STS_8821C BIT(25) -+#define BIT_DDMACH1_CHKSUM_CONT_8821C BIT(24) -+ -+#define BIT_SHIFT_DDMACH1_DLEN_8821C 0 -+#define BIT_MASK_DDMACH1_DLEN_8821C 0x3ffff -+#define BIT_DDMACH1_DLEN_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH1_DLEN_8821C) << BIT_SHIFT_DDMACH1_DLEN_8821C) -+#define BITS_DDMACH1_DLEN_8821C \ -+ (BIT_MASK_DDMACH1_DLEN_8821C << BIT_SHIFT_DDMACH1_DLEN_8821C) -+#define BIT_CLEAR_DDMACH1_DLEN_8821C(x) ((x) & (~BITS_DDMACH1_DLEN_8821C)) -+#define BIT_GET_DDMACH1_DLEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DLEN_8821C) & BIT_MASK_DDMACH1_DLEN_8821C) -+#define BIT_SET_DDMACH1_DLEN_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH1_DLEN_8821C(x) | BIT_DDMACH1_DLEN_8821C(v)) -+ -+/* 2 REG_DDMA_CH2SA_8821C */ -+ -+#define BIT_SHIFT_DDMACH2_SA_8821C 0 -+#define BIT_MASK_DDMACH2_SA_8821C 0xffffffffL -+#define BIT_DDMACH2_SA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH2_SA_8821C) << BIT_SHIFT_DDMACH2_SA_8821C) -+#define BITS_DDMACH2_SA_8821C \ -+ (BIT_MASK_DDMACH2_SA_8821C << BIT_SHIFT_DDMACH2_SA_8821C) -+#define BIT_CLEAR_DDMACH2_SA_8821C(x) ((x) & (~BITS_DDMACH2_SA_8821C)) -+#define BIT_GET_DDMACH2_SA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_SA_8821C) & BIT_MASK_DDMACH2_SA_8821C) -+#define BIT_SET_DDMACH2_SA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH2_SA_8821C(x) | BIT_DDMACH2_SA_8821C(v)) -+ -+/* 2 REG_DDMA_CH2DA_8821C */ -+ -+#define BIT_SHIFT_DDMACH2_DA_8821C 0 -+#define BIT_MASK_DDMACH2_DA_8821C 0xffffffffL -+#define BIT_DDMACH2_DA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH2_DA_8821C) << BIT_SHIFT_DDMACH2_DA_8821C) -+#define BITS_DDMACH2_DA_8821C \ -+ (BIT_MASK_DDMACH2_DA_8821C << BIT_SHIFT_DDMACH2_DA_8821C) -+#define BIT_CLEAR_DDMACH2_DA_8821C(x) ((x) & (~BITS_DDMACH2_DA_8821C)) -+#define BIT_GET_DDMACH2_DA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DA_8821C) & BIT_MASK_DDMACH2_DA_8821C) -+#define BIT_SET_DDMACH2_DA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH2_DA_8821C(x) | BIT_DDMACH2_DA_8821C(v)) -+ -+/* 2 REG_DDMA_CH2CTRL_8821C */ -+#define BIT_DDMACH2_OWN_8821C BIT(31) -+#define BIT_DDMACH2_IDMEM_ERR_8821C BIT(30) -+#define BIT_DDMACH2_CHKSUM_EN_8821C BIT(29) -+#define BIT_DDMACH2_DA_W_DISABLE_8821C BIT(28) -+#define BIT_DDMACH2_CHKSUM_STS_8821C BIT(27) -+#define BIT_DDMACH2_DDMA_MODE_8821C BIT(26) -+#define BIT_DDMACH2_RESET_CHKSUM_STS_8821C BIT(25) -+#define BIT_DDMACH2_CHKSUM_CONT_8821C BIT(24) -+ -+#define BIT_SHIFT_DDMACH2_DLEN_8821C 0 -+#define BIT_MASK_DDMACH2_DLEN_8821C 0x3ffff -+#define BIT_DDMACH2_DLEN_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH2_DLEN_8821C) << BIT_SHIFT_DDMACH2_DLEN_8821C) -+#define BITS_DDMACH2_DLEN_8821C \ -+ (BIT_MASK_DDMACH2_DLEN_8821C << BIT_SHIFT_DDMACH2_DLEN_8821C) -+#define BIT_CLEAR_DDMACH2_DLEN_8821C(x) ((x) & (~BITS_DDMACH2_DLEN_8821C)) -+#define BIT_GET_DDMACH2_DLEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DLEN_8821C) & BIT_MASK_DDMACH2_DLEN_8821C) -+#define BIT_SET_DDMACH2_DLEN_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH2_DLEN_8821C(x) | BIT_DDMACH2_DLEN_8821C(v)) -+ -+/* 2 REG_DDMA_CH3SA_8821C */ -+ -+#define BIT_SHIFT_DDMACH3_SA_8821C 0 -+#define BIT_MASK_DDMACH3_SA_8821C 0xffffffffL -+#define BIT_DDMACH3_SA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH3_SA_8821C) << BIT_SHIFT_DDMACH3_SA_8821C) -+#define BITS_DDMACH3_SA_8821C \ -+ (BIT_MASK_DDMACH3_SA_8821C << BIT_SHIFT_DDMACH3_SA_8821C) -+#define BIT_CLEAR_DDMACH3_SA_8821C(x) ((x) & (~BITS_DDMACH3_SA_8821C)) -+#define BIT_GET_DDMACH3_SA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_SA_8821C) & BIT_MASK_DDMACH3_SA_8821C) -+#define BIT_SET_DDMACH3_SA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH3_SA_8821C(x) | BIT_DDMACH3_SA_8821C(v)) -+ -+/* 2 REG_DDMA_CH3DA_8821C */ -+ -+#define BIT_SHIFT_DDMACH3_DA_8821C 0 -+#define BIT_MASK_DDMACH3_DA_8821C 0xffffffffL -+#define BIT_DDMACH3_DA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH3_DA_8821C) << BIT_SHIFT_DDMACH3_DA_8821C) -+#define BITS_DDMACH3_DA_8821C \ -+ (BIT_MASK_DDMACH3_DA_8821C << BIT_SHIFT_DDMACH3_DA_8821C) -+#define BIT_CLEAR_DDMACH3_DA_8821C(x) ((x) & (~BITS_DDMACH3_DA_8821C)) -+#define BIT_GET_DDMACH3_DA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DA_8821C) & BIT_MASK_DDMACH3_DA_8821C) -+#define BIT_SET_DDMACH3_DA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH3_DA_8821C(x) | BIT_DDMACH3_DA_8821C(v)) -+ -+/* 2 REG_DDMA_CH3CTRL_8821C */ -+#define BIT_DDMACH3_OWN_8821C BIT(31) -+#define BIT_DDMACH3_IDMEM_ERR_8821C BIT(30) -+#define BIT_DDMACH3_CHKSUM_EN_8821C BIT(29) -+#define BIT_DDMACH3_DA_W_DISABLE_8821C BIT(28) -+#define BIT_DDMACH3_CHKSUM_STS_8821C BIT(27) -+#define BIT_DDMACH3_DDMA_MODE_8821C BIT(26) -+#define BIT_DDMACH3_RESET_CHKSUM_STS_8821C BIT(25) -+#define BIT_DDMACH3_CHKSUM_CONT_8821C BIT(24) -+ -+#define BIT_SHIFT_DDMACH3_DLEN_8821C 0 -+#define BIT_MASK_DDMACH3_DLEN_8821C 0x3ffff -+#define BIT_DDMACH3_DLEN_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH3_DLEN_8821C) << BIT_SHIFT_DDMACH3_DLEN_8821C) -+#define BITS_DDMACH3_DLEN_8821C \ -+ (BIT_MASK_DDMACH3_DLEN_8821C << BIT_SHIFT_DDMACH3_DLEN_8821C) -+#define BIT_CLEAR_DDMACH3_DLEN_8821C(x) ((x) & (~BITS_DDMACH3_DLEN_8821C)) -+#define BIT_GET_DDMACH3_DLEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DLEN_8821C) & BIT_MASK_DDMACH3_DLEN_8821C) -+#define BIT_SET_DDMACH3_DLEN_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH3_DLEN_8821C(x) | BIT_DDMACH3_DLEN_8821C(v)) -+ -+/* 2 REG_DDMA_CH4SA_8821C */ -+ -+#define BIT_SHIFT_DDMACH4_SA_8821C 0 -+#define BIT_MASK_DDMACH4_SA_8821C 0xffffffffL -+#define BIT_DDMACH4_SA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH4_SA_8821C) << BIT_SHIFT_DDMACH4_SA_8821C) -+#define BITS_DDMACH4_SA_8821C \ -+ (BIT_MASK_DDMACH4_SA_8821C << BIT_SHIFT_DDMACH4_SA_8821C) -+#define BIT_CLEAR_DDMACH4_SA_8821C(x) ((x) & (~BITS_DDMACH4_SA_8821C)) -+#define BIT_GET_DDMACH4_SA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_SA_8821C) & BIT_MASK_DDMACH4_SA_8821C) -+#define BIT_SET_DDMACH4_SA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH4_SA_8821C(x) | BIT_DDMACH4_SA_8821C(v)) -+ -+/* 2 REG_DDMA_CH4DA_8821C */ -+ -+#define BIT_SHIFT_DDMACH4_DA_8821C 0 -+#define BIT_MASK_DDMACH4_DA_8821C 0xffffffffL -+#define BIT_DDMACH4_DA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH4_DA_8821C) << BIT_SHIFT_DDMACH4_DA_8821C) -+#define BITS_DDMACH4_DA_8821C \ -+ (BIT_MASK_DDMACH4_DA_8821C << BIT_SHIFT_DDMACH4_DA_8821C) -+#define BIT_CLEAR_DDMACH4_DA_8821C(x) ((x) & (~BITS_DDMACH4_DA_8821C)) -+#define BIT_GET_DDMACH4_DA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DA_8821C) & BIT_MASK_DDMACH4_DA_8821C) -+#define BIT_SET_DDMACH4_DA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH4_DA_8821C(x) | BIT_DDMACH4_DA_8821C(v)) -+ -+/* 2 REG_DDMA_CH4CTRL_8821C */ -+#define BIT_DDMACH4_OWN_8821C BIT(31) -+#define BIT_DDMACH4_IDMEM_ERR_8821C BIT(30) -+#define BIT_DDMACH4_CHKSUM_EN_8821C BIT(29) -+#define BIT_DDMACH4_DA_W_DISABLE_8821C BIT(28) -+#define BIT_DDMACH4_CHKSUM_STS_8821C BIT(27) -+#define BIT_DDMACH4_DDMA_MODE_8821C BIT(26) -+#define BIT_DDMACH4_RESET_CHKSUM_STS_8821C BIT(25) -+#define BIT_DDMACH4_CHKSUM_CONT_8821C BIT(24) -+ -+#define BIT_SHIFT_DDMACH4_DLEN_8821C 0 -+#define BIT_MASK_DDMACH4_DLEN_8821C 0x3ffff -+#define BIT_DDMACH4_DLEN_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH4_DLEN_8821C) << BIT_SHIFT_DDMACH4_DLEN_8821C) -+#define BITS_DDMACH4_DLEN_8821C \ -+ (BIT_MASK_DDMACH4_DLEN_8821C << BIT_SHIFT_DDMACH4_DLEN_8821C) -+#define BIT_CLEAR_DDMACH4_DLEN_8821C(x) ((x) & (~BITS_DDMACH4_DLEN_8821C)) -+#define BIT_GET_DDMACH4_DLEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DLEN_8821C) & BIT_MASK_DDMACH4_DLEN_8821C) -+#define BIT_SET_DDMACH4_DLEN_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH4_DLEN_8821C(x) | BIT_DDMACH4_DLEN_8821C(v)) -+ -+/* 2 REG_DDMA_CH5SA_8821C */ -+ -+#define BIT_SHIFT_DDMACH5_SA_8821C 0 -+#define BIT_MASK_DDMACH5_SA_8821C 0xffffffffL -+#define BIT_DDMACH5_SA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH5_SA_8821C) << BIT_SHIFT_DDMACH5_SA_8821C) -+#define BITS_DDMACH5_SA_8821C \ -+ (BIT_MASK_DDMACH5_SA_8821C << BIT_SHIFT_DDMACH5_SA_8821C) -+#define BIT_CLEAR_DDMACH5_SA_8821C(x) ((x) & (~BITS_DDMACH5_SA_8821C)) -+#define BIT_GET_DDMACH5_SA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_SA_8821C) & BIT_MASK_DDMACH5_SA_8821C) -+#define BIT_SET_DDMACH5_SA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH5_SA_8821C(x) | BIT_DDMACH5_SA_8821C(v)) -+ -+/* 2 REG_DDMA_CH5DA_8821C */ -+ -+#define BIT_SHIFT_DDMACH5_DA_8821C 0 -+#define BIT_MASK_DDMACH5_DA_8821C 0xffffffffL -+#define BIT_DDMACH5_DA_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH5_DA_8821C) << BIT_SHIFT_DDMACH5_DA_8821C) -+#define BITS_DDMACH5_DA_8821C \ -+ (BIT_MASK_DDMACH5_DA_8821C << BIT_SHIFT_DDMACH5_DA_8821C) -+#define BIT_CLEAR_DDMACH5_DA_8821C(x) ((x) & (~BITS_DDMACH5_DA_8821C)) -+#define BIT_GET_DDMACH5_DA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DA_8821C) & BIT_MASK_DDMACH5_DA_8821C) -+#define BIT_SET_DDMACH5_DA_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH5_DA_8821C(x) | BIT_DDMACH5_DA_8821C(v)) -+ -+/* 2 REG_DDMA_CH5CTRL_8821C */ -+#define BIT_DDMACH5_OWN_8821C BIT(31) -+#define BIT_DDMACH5_IDMEM_ERR_8821C BIT(30) -+#define BIT_DDMACH5_CHKSUM_EN_8821C BIT(29) -+#define BIT_DDMACH5_DA_W_DISABLE_8821C BIT(28) -+#define BIT_DDMACH5_CHKSUM_STS_8821C BIT(27) -+#define BIT_DDMACH5_DDMA_MODE_8821C BIT(26) -+#define BIT_DDMACH5_RESET_CHKSUM_STS_8821C BIT(25) -+#define BIT_DDMACH5_CHKSUM_CONT_8821C BIT(24) -+ -+#define BIT_SHIFT_DDMACH5_DLEN_8821C 0 -+#define BIT_MASK_DDMACH5_DLEN_8821C 0x3ffff -+#define BIT_DDMACH5_DLEN_8821C(x) \ -+ (((x) & BIT_MASK_DDMACH5_DLEN_8821C) << BIT_SHIFT_DDMACH5_DLEN_8821C) -+#define BITS_DDMACH5_DLEN_8821C \ -+ (BIT_MASK_DDMACH5_DLEN_8821C << BIT_SHIFT_DDMACH5_DLEN_8821C) -+#define BIT_CLEAR_DDMACH5_DLEN_8821C(x) ((x) & (~BITS_DDMACH5_DLEN_8821C)) -+#define BIT_GET_DDMACH5_DLEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DLEN_8821C) & BIT_MASK_DDMACH5_DLEN_8821C) -+#define BIT_SET_DDMACH5_DLEN_8821C(x, v) \ -+ (BIT_CLEAR_DDMACH5_DLEN_8821C(x) | BIT_DDMACH5_DLEN_8821C(v)) -+ -+/* 2 REG_DDMA_INT_MSK_8821C */ -+#define BIT_DDMACH5_MSK_8821C BIT(5) -+#define BIT_DDMACH4_MSK_8821C BIT(4) -+#define BIT_DDMACH3_MSK_8821C BIT(3) -+#define BIT_DDMACH2_MSK_8821C BIT(2) -+#define BIT_DDMACH1_MSK_8821C BIT(1) -+#define BIT_DDMACH0_MSK_8821C BIT(0) -+ -+/* 2 REG_DDMA_CHSTATUS_8821C */ -+#define BIT_DDMACH5_BUSY_8821C BIT(5) -+#define BIT_DDMACH4_BUSY_8821C BIT(4) -+#define BIT_DDMACH3_BUSY_8821C BIT(3) -+#define BIT_DDMACH2_BUSY_8821C BIT(2) -+#define BIT_DDMACH1_BUSY_8821C BIT(1) -+#define BIT_DDMACH0_BUSY_8821C BIT(0) -+ -+/* 2 REG_DDMA_CHKSUM_8821C */ -+ -+#define BIT_SHIFT_IDDMA0_CHKSUM_8821C 0 -+#define BIT_MASK_IDDMA0_CHKSUM_8821C 0xffff -+#define BIT_IDDMA0_CHKSUM_8821C(x) \ -+ (((x) & BIT_MASK_IDDMA0_CHKSUM_8821C) << BIT_SHIFT_IDDMA0_CHKSUM_8821C) -+#define BITS_IDDMA0_CHKSUM_8821C \ -+ (BIT_MASK_IDDMA0_CHKSUM_8821C << BIT_SHIFT_IDDMA0_CHKSUM_8821C) -+#define BIT_CLEAR_IDDMA0_CHKSUM_8821C(x) ((x) & (~BITS_IDDMA0_CHKSUM_8821C)) -+#define BIT_GET_IDDMA0_CHKSUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_IDDMA0_CHKSUM_8821C) & BIT_MASK_IDDMA0_CHKSUM_8821C) -+#define BIT_SET_IDDMA0_CHKSUM_8821C(x, v) \ -+ (BIT_CLEAR_IDDMA0_CHKSUM_8821C(x) | BIT_IDDMA0_CHKSUM_8821C(v)) -+ -+/* 2 REG_DDMA_MONITOR_8821C */ -+#define BIT_IDDMA0_PERMU_UNDERFLOW_8821C BIT(14) -+#define BIT_IDDMA0_FIFO_UNDERFLOW_8821C BIT(13) -+#define BIT_IDDMA0_FIFO_OVERFLOW_8821C BIT(12) -+#define BIT_CH5_ERR_8821C BIT(5) -+#define BIT_CH4_ERR_8821C BIT(4) -+#define BIT_CH3_ERR_8821C BIT(3) -+#define BIT_CH2_ERR_8821C BIT(2) -+#define BIT_CH1_ERR_8821C BIT(1) -+#define BIT_CH0_ERR_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_PCIE_CTRL_8821C */ -+#define BIT_PCIEIO_PERSTB_SEL_8821C BIT(31) -+ -+#define BIT_SHIFT_PCIE_MAX_RXDMA_8821C 28 -+#define BIT_MASK_PCIE_MAX_RXDMA_8821C 0x7 -+#define BIT_PCIE_MAX_RXDMA_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_RXDMA_8821C) \ -+ << BIT_SHIFT_PCIE_MAX_RXDMA_8821C) -+#define BITS_PCIE_MAX_RXDMA_8821C \ -+ (BIT_MASK_PCIE_MAX_RXDMA_8821C << BIT_SHIFT_PCIE_MAX_RXDMA_8821C) -+#define BIT_CLEAR_PCIE_MAX_RXDMA_8821C(x) ((x) & (~BITS_PCIE_MAX_RXDMA_8821C)) -+#define BIT_GET_PCIE_MAX_RXDMA_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_RXDMA_8821C) & \ -+ BIT_MASK_PCIE_MAX_RXDMA_8821C) -+#define BIT_SET_PCIE_MAX_RXDMA_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_RXDMA_8821C(x) | BIT_PCIE_MAX_RXDMA_8821C(v)) -+ -+#define BIT_MULRW_8821C BIT(27) -+ -+#define BIT_SHIFT_PCIE_MAX_TXDMA_8821C 24 -+#define BIT_MASK_PCIE_MAX_TXDMA_8821C 0x7 -+#define BIT_PCIE_MAX_TXDMA_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_TXDMA_8821C) \ -+ << BIT_SHIFT_PCIE_MAX_TXDMA_8821C) -+#define BITS_PCIE_MAX_TXDMA_8821C \ -+ (BIT_MASK_PCIE_MAX_TXDMA_8821C << BIT_SHIFT_PCIE_MAX_TXDMA_8821C) -+#define BIT_CLEAR_PCIE_MAX_TXDMA_8821C(x) ((x) & (~BITS_PCIE_MAX_TXDMA_8821C)) -+#define BIT_GET_PCIE_MAX_TXDMA_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_TXDMA_8821C) & \ -+ BIT_MASK_PCIE_MAX_TXDMA_8821C) -+#define BIT_SET_PCIE_MAX_TXDMA_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_TXDMA_8821C(x) | BIT_PCIE_MAX_TXDMA_8821C(v)) -+ -+#define BIT_EN_CPL_TIMEOUT_PS_8821C BIT(22) -+#define BIT_REG_TXDMA_FAIL_PS_8821C BIT(21) -+#define BIT_PCIE_RST_TRXDMA_INTF_8821C BIT(20) -+#define BIT_EN_HWENTR_L1_8821C BIT(19) -+#define BIT_EN_ADV_CLKGATE_8821C BIT(18) -+#define BIT_PCIE_EN_SWENT_L23_8821C BIT(17) -+#define BIT_PCIE_EN_HWEXT_L1_8821C BIT(16) -+#define BIT_RX_CLOSE_EN_8821C BIT(15) -+#define BIT_STOP_BCNQ_8821C BIT(14) -+#define BIT_STOP_MGQ_8821C BIT(13) -+#define BIT_STOP_VOQ_8821C BIT(12) -+#define BIT_STOP_VIQ_8821C BIT(11) -+#define BIT_STOP_BEQ_8821C BIT(10) -+#define BIT_STOP_BKQ_8821C BIT(9) -+#define BIT_STOP_RXQ_8821C BIT(8) -+#define BIT_STOP_HI7Q_8821C BIT(7) -+#define BIT_STOP_HI6Q_8821C BIT(6) -+#define BIT_STOP_HI5Q_8821C BIT(5) -+#define BIT_STOP_HI4Q_8821C BIT(4) -+#define BIT_STOP_HI3Q_8821C BIT(3) -+#define BIT_STOP_HI2Q_8821C BIT(2) -+#define BIT_STOP_HI1Q_8821C BIT(1) -+#define BIT_STOP_HI0Q_8821C BIT(0) -+ -+/* 2 REG_INT_MIG_8821C */ -+ -+#define BIT_SHIFT_TXTTIMER_MATCH_NUM_8821C 28 -+#define BIT_MASK_TXTTIMER_MATCH_NUM_8821C 0xf -+#define BIT_TXTTIMER_MATCH_NUM_8821C(x) \ -+ (((x) & BIT_MASK_TXTTIMER_MATCH_NUM_8821C) \ -+ << BIT_SHIFT_TXTTIMER_MATCH_NUM_8821C) -+#define BITS_TXTTIMER_MATCH_NUM_8821C \ -+ (BIT_MASK_TXTTIMER_MATCH_NUM_8821C \ -+ << BIT_SHIFT_TXTTIMER_MATCH_NUM_8821C) -+#define BIT_CLEAR_TXTTIMER_MATCH_NUM_8821C(x) \ -+ ((x) & (~BITS_TXTTIMER_MATCH_NUM_8821C)) -+#define BIT_GET_TXTTIMER_MATCH_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXTTIMER_MATCH_NUM_8821C) & \ -+ BIT_MASK_TXTTIMER_MATCH_NUM_8821C) -+#define BIT_SET_TXTTIMER_MATCH_NUM_8821C(x, v) \ -+ (BIT_CLEAR_TXTTIMER_MATCH_NUM_8821C(x) | \ -+ BIT_TXTTIMER_MATCH_NUM_8821C(v)) -+ -+#define BIT_SHIFT_TXPKT_NUM_MATCH_8821C 24 -+#define BIT_MASK_TXPKT_NUM_MATCH_8821C 0xf -+#define BIT_TXPKT_NUM_MATCH_8821C(x) \ -+ (((x) & BIT_MASK_TXPKT_NUM_MATCH_8821C) \ -+ << BIT_SHIFT_TXPKT_NUM_MATCH_8821C) -+#define BITS_TXPKT_NUM_MATCH_8821C \ -+ (BIT_MASK_TXPKT_NUM_MATCH_8821C << BIT_SHIFT_TXPKT_NUM_MATCH_8821C) -+#define BIT_CLEAR_TXPKT_NUM_MATCH_8821C(x) ((x) & (~BITS_TXPKT_NUM_MATCH_8821C)) -+#define BIT_GET_TXPKT_NUM_MATCH_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXPKT_NUM_MATCH_8821C) & \ -+ BIT_MASK_TXPKT_NUM_MATCH_8821C) -+#define BIT_SET_TXPKT_NUM_MATCH_8821C(x, v) \ -+ (BIT_CLEAR_TXPKT_NUM_MATCH_8821C(x) | BIT_TXPKT_NUM_MATCH_8821C(v)) -+ -+#define BIT_SHIFT_RXTTIMER_MATCH_NUM_8821C 20 -+#define BIT_MASK_RXTTIMER_MATCH_NUM_8821C 0xf -+#define BIT_RXTTIMER_MATCH_NUM_8821C(x) \ -+ (((x) & BIT_MASK_RXTTIMER_MATCH_NUM_8821C) \ -+ << BIT_SHIFT_RXTTIMER_MATCH_NUM_8821C) -+#define BITS_RXTTIMER_MATCH_NUM_8821C \ -+ (BIT_MASK_RXTTIMER_MATCH_NUM_8821C \ -+ << BIT_SHIFT_RXTTIMER_MATCH_NUM_8821C) -+#define BIT_CLEAR_RXTTIMER_MATCH_NUM_8821C(x) \ -+ ((x) & (~BITS_RXTTIMER_MATCH_NUM_8821C)) -+#define BIT_GET_RXTTIMER_MATCH_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXTTIMER_MATCH_NUM_8821C) & \ -+ BIT_MASK_RXTTIMER_MATCH_NUM_8821C) -+#define BIT_SET_RXTTIMER_MATCH_NUM_8821C(x, v) \ -+ (BIT_CLEAR_RXTTIMER_MATCH_NUM_8821C(x) | \ -+ BIT_RXTTIMER_MATCH_NUM_8821C(v)) -+ -+#define BIT_SHIFT_RXPKT_NUM_MATCH_8821C 16 -+#define BIT_MASK_RXPKT_NUM_MATCH_8821C 0xf -+#define BIT_RXPKT_NUM_MATCH_8821C(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_MATCH_8821C) \ -+ << BIT_SHIFT_RXPKT_NUM_MATCH_8821C) -+#define BITS_RXPKT_NUM_MATCH_8821C \ -+ (BIT_MASK_RXPKT_NUM_MATCH_8821C << BIT_SHIFT_RXPKT_NUM_MATCH_8821C) -+#define BIT_CLEAR_RXPKT_NUM_MATCH_8821C(x) ((x) & (~BITS_RXPKT_NUM_MATCH_8821C)) -+#define BIT_GET_RXPKT_NUM_MATCH_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_MATCH_8821C) & \ -+ BIT_MASK_RXPKT_NUM_MATCH_8821C) -+#define BIT_SET_RXPKT_NUM_MATCH_8821C(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_MATCH_8821C(x) | BIT_RXPKT_NUM_MATCH_8821C(v)) -+ -+#define BIT_SHIFT_MIGRATE_TIMER_8821C 0 -+#define BIT_MASK_MIGRATE_TIMER_8821C 0xffff -+#define BIT_MIGRATE_TIMER_8821C(x) \ -+ (((x) & BIT_MASK_MIGRATE_TIMER_8821C) << BIT_SHIFT_MIGRATE_TIMER_8821C) -+#define BITS_MIGRATE_TIMER_8821C \ -+ (BIT_MASK_MIGRATE_TIMER_8821C << BIT_SHIFT_MIGRATE_TIMER_8821C) -+#define BIT_CLEAR_MIGRATE_TIMER_8821C(x) ((x) & (~BITS_MIGRATE_TIMER_8821C)) -+#define BIT_GET_MIGRATE_TIMER_8821C(x) \ -+ (((x) >> BIT_SHIFT_MIGRATE_TIMER_8821C) & BIT_MASK_MIGRATE_TIMER_8821C) -+#define BIT_SET_MIGRATE_TIMER_8821C(x, v) \ -+ (BIT_CLEAR_MIGRATE_TIMER_8821C(x) | BIT_MIGRATE_TIMER_8821C(v)) -+ -+/* 2 REG_BCNQ_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_BCNQ_TXBD_DESA_8821C 0 -+#define BIT_MASK_BCNQ_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_BCNQ_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_BCNQ_TXBD_DESA_8821C) \ -+ << BIT_SHIFT_BCNQ_TXBD_DESA_8821C) -+#define BITS_BCNQ_TXBD_DESA_8821C \ -+ (BIT_MASK_BCNQ_TXBD_DESA_8821C << BIT_SHIFT_BCNQ_TXBD_DESA_8821C) -+#define BIT_CLEAR_BCNQ_TXBD_DESA_8821C(x) ((x) & (~BITS_BCNQ_TXBD_DESA_8821C)) -+#define BIT_GET_BCNQ_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_TXBD_DESA_8821C) & \ -+ BIT_MASK_BCNQ_TXBD_DESA_8821C) -+#define BIT_SET_BCNQ_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_BCNQ_TXBD_DESA_8821C(x) | BIT_BCNQ_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_MGQ_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_MGQ_TXBD_DESA_8821C 0 -+#define BIT_MASK_MGQ_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_MGQ_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_TXBD_DESA_8821C) << BIT_SHIFT_MGQ_TXBD_DESA_8821C) -+#define BITS_MGQ_TXBD_DESA_8821C \ -+ (BIT_MASK_MGQ_TXBD_DESA_8821C << BIT_SHIFT_MGQ_TXBD_DESA_8821C) -+#define BIT_CLEAR_MGQ_TXBD_DESA_8821C(x) ((x) & (~BITS_MGQ_TXBD_DESA_8821C)) -+#define BIT_GET_MGQ_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_TXBD_DESA_8821C) & BIT_MASK_MGQ_TXBD_DESA_8821C) -+#define BIT_SET_MGQ_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_TXBD_DESA_8821C(x) | BIT_MGQ_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_VOQ_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_VOQ_TXBD_DESA_8821C 0 -+#define BIT_MASK_VOQ_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_VOQ_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_VOQ_TXBD_DESA_8821C) << BIT_SHIFT_VOQ_TXBD_DESA_8821C) -+#define BITS_VOQ_TXBD_DESA_8821C \ -+ (BIT_MASK_VOQ_TXBD_DESA_8821C << BIT_SHIFT_VOQ_TXBD_DESA_8821C) -+#define BIT_CLEAR_VOQ_TXBD_DESA_8821C(x) ((x) & (~BITS_VOQ_TXBD_DESA_8821C)) -+#define BIT_GET_VOQ_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_VOQ_TXBD_DESA_8821C) & BIT_MASK_VOQ_TXBD_DESA_8821C) -+#define BIT_SET_VOQ_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_VOQ_TXBD_DESA_8821C(x) | BIT_VOQ_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_VIQ_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_VIQ_TXBD_DESA_8821C 0 -+#define BIT_MASK_VIQ_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_VIQ_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_VIQ_TXBD_DESA_8821C) << BIT_SHIFT_VIQ_TXBD_DESA_8821C) -+#define BITS_VIQ_TXBD_DESA_8821C \ -+ (BIT_MASK_VIQ_TXBD_DESA_8821C << BIT_SHIFT_VIQ_TXBD_DESA_8821C) -+#define BIT_CLEAR_VIQ_TXBD_DESA_8821C(x) ((x) & (~BITS_VIQ_TXBD_DESA_8821C)) -+#define BIT_GET_VIQ_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_VIQ_TXBD_DESA_8821C) & BIT_MASK_VIQ_TXBD_DESA_8821C) -+#define BIT_SET_VIQ_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_VIQ_TXBD_DESA_8821C(x) | BIT_VIQ_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_BEQ_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_BEQ_TXBD_DESA_8821C 0 -+#define BIT_MASK_BEQ_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_BEQ_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_BEQ_TXBD_DESA_8821C) << BIT_SHIFT_BEQ_TXBD_DESA_8821C) -+#define BITS_BEQ_TXBD_DESA_8821C \ -+ (BIT_MASK_BEQ_TXBD_DESA_8821C << BIT_SHIFT_BEQ_TXBD_DESA_8821C) -+#define BIT_CLEAR_BEQ_TXBD_DESA_8821C(x) ((x) & (~BITS_BEQ_TXBD_DESA_8821C)) -+#define BIT_GET_BEQ_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_BEQ_TXBD_DESA_8821C) & BIT_MASK_BEQ_TXBD_DESA_8821C) -+#define BIT_SET_BEQ_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_BEQ_TXBD_DESA_8821C(x) | BIT_BEQ_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_BKQ_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_BKQ_TXBD_DESA_8821C 0 -+#define BIT_MASK_BKQ_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_BKQ_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_BKQ_TXBD_DESA_8821C) << BIT_SHIFT_BKQ_TXBD_DESA_8821C) -+#define BITS_BKQ_TXBD_DESA_8821C \ -+ (BIT_MASK_BKQ_TXBD_DESA_8821C << BIT_SHIFT_BKQ_TXBD_DESA_8821C) -+#define BIT_CLEAR_BKQ_TXBD_DESA_8821C(x) ((x) & (~BITS_BKQ_TXBD_DESA_8821C)) -+#define BIT_GET_BKQ_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_BKQ_TXBD_DESA_8821C) & BIT_MASK_BKQ_TXBD_DESA_8821C) -+#define BIT_SET_BKQ_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_BKQ_TXBD_DESA_8821C(x) | BIT_BKQ_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_RXQ_RXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_RXQ_RXBD_DESA_8821C 0 -+#define BIT_MASK_RXQ_RXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_RXQ_RXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_RXQ_RXBD_DESA_8821C) << BIT_SHIFT_RXQ_RXBD_DESA_8821C) -+#define BITS_RXQ_RXBD_DESA_8821C \ -+ (BIT_MASK_RXQ_RXBD_DESA_8821C << BIT_SHIFT_RXQ_RXBD_DESA_8821C) -+#define BIT_CLEAR_RXQ_RXBD_DESA_8821C(x) ((x) & (~BITS_RXQ_RXBD_DESA_8821C)) -+#define BIT_GET_RXQ_RXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXQ_RXBD_DESA_8821C) & BIT_MASK_RXQ_RXBD_DESA_8821C) -+#define BIT_SET_RXQ_RXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_RXQ_RXBD_DESA_8821C(x) | BIT_RXQ_RXBD_DESA_8821C(v)) -+ -+/* 2 REG_HI0Q_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_HI0Q_TXBD_DESA_8821C 0 -+#define BIT_MASK_HI0Q_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_HI0Q_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_HI0Q_TXBD_DESA_8821C) \ -+ << BIT_SHIFT_HI0Q_TXBD_DESA_8821C) -+#define BITS_HI0Q_TXBD_DESA_8821C \ -+ (BIT_MASK_HI0Q_TXBD_DESA_8821C << BIT_SHIFT_HI0Q_TXBD_DESA_8821C) -+#define BIT_CLEAR_HI0Q_TXBD_DESA_8821C(x) ((x) & (~BITS_HI0Q_TXBD_DESA_8821C)) -+#define BIT_GET_HI0Q_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_TXBD_DESA_8821C) & \ -+ BIT_MASK_HI0Q_TXBD_DESA_8821C) -+#define BIT_SET_HI0Q_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_HI0Q_TXBD_DESA_8821C(x) | BIT_HI0Q_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_HI1Q_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_HI1Q_TXBD_DESA_8821C 0 -+#define BIT_MASK_HI1Q_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_HI1Q_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_HI1Q_TXBD_DESA_8821C) \ -+ << BIT_SHIFT_HI1Q_TXBD_DESA_8821C) -+#define BITS_HI1Q_TXBD_DESA_8821C \ -+ (BIT_MASK_HI1Q_TXBD_DESA_8821C << BIT_SHIFT_HI1Q_TXBD_DESA_8821C) -+#define BIT_CLEAR_HI1Q_TXBD_DESA_8821C(x) ((x) & (~BITS_HI1Q_TXBD_DESA_8821C)) -+#define BIT_GET_HI1Q_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_TXBD_DESA_8821C) & \ -+ BIT_MASK_HI1Q_TXBD_DESA_8821C) -+#define BIT_SET_HI1Q_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_HI1Q_TXBD_DESA_8821C(x) | BIT_HI1Q_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_HI2Q_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_HI2Q_TXBD_DESA_8821C 0 -+#define BIT_MASK_HI2Q_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_HI2Q_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_HI2Q_TXBD_DESA_8821C) \ -+ << BIT_SHIFT_HI2Q_TXBD_DESA_8821C) -+#define BITS_HI2Q_TXBD_DESA_8821C \ -+ (BIT_MASK_HI2Q_TXBD_DESA_8821C << BIT_SHIFT_HI2Q_TXBD_DESA_8821C) -+#define BIT_CLEAR_HI2Q_TXBD_DESA_8821C(x) ((x) & (~BITS_HI2Q_TXBD_DESA_8821C)) -+#define BIT_GET_HI2Q_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_TXBD_DESA_8821C) & \ -+ BIT_MASK_HI2Q_TXBD_DESA_8821C) -+#define BIT_SET_HI2Q_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_HI2Q_TXBD_DESA_8821C(x) | BIT_HI2Q_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_HI3Q_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_HI3Q_TXBD_DESA_8821C 0 -+#define BIT_MASK_HI3Q_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_HI3Q_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_HI3Q_TXBD_DESA_8821C) \ -+ << BIT_SHIFT_HI3Q_TXBD_DESA_8821C) -+#define BITS_HI3Q_TXBD_DESA_8821C \ -+ (BIT_MASK_HI3Q_TXBD_DESA_8821C << BIT_SHIFT_HI3Q_TXBD_DESA_8821C) -+#define BIT_CLEAR_HI3Q_TXBD_DESA_8821C(x) ((x) & (~BITS_HI3Q_TXBD_DESA_8821C)) -+#define BIT_GET_HI3Q_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_TXBD_DESA_8821C) & \ -+ BIT_MASK_HI3Q_TXBD_DESA_8821C) -+#define BIT_SET_HI3Q_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_HI3Q_TXBD_DESA_8821C(x) | BIT_HI3Q_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_HI4Q_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_HI4Q_TXBD_DESA_8821C 0 -+#define BIT_MASK_HI4Q_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_HI4Q_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_HI4Q_TXBD_DESA_8821C) \ -+ << BIT_SHIFT_HI4Q_TXBD_DESA_8821C) -+#define BITS_HI4Q_TXBD_DESA_8821C \ -+ (BIT_MASK_HI4Q_TXBD_DESA_8821C << BIT_SHIFT_HI4Q_TXBD_DESA_8821C) -+#define BIT_CLEAR_HI4Q_TXBD_DESA_8821C(x) ((x) & (~BITS_HI4Q_TXBD_DESA_8821C)) -+#define BIT_GET_HI4Q_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_TXBD_DESA_8821C) & \ -+ BIT_MASK_HI4Q_TXBD_DESA_8821C) -+#define BIT_SET_HI4Q_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_HI4Q_TXBD_DESA_8821C(x) | BIT_HI4Q_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_HI5Q_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_HI5Q_TXBD_DESA_8821C 0 -+#define BIT_MASK_HI5Q_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_HI5Q_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_HI5Q_TXBD_DESA_8821C) \ -+ << BIT_SHIFT_HI5Q_TXBD_DESA_8821C) -+#define BITS_HI5Q_TXBD_DESA_8821C \ -+ (BIT_MASK_HI5Q_TXBD_DESA_8821C << BIT_SHIFT_HI5Q_TXBD_DESA_8821C) -+#define BIT_CLEAR_HI5Q_TXBD_DESA_8821C(x) ((x) & (~BITS_HI5Q_TXBD_DESA_8821C)) -+#define BIT_GET_HI5Q_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_TXBD_DESA_8821C) & \ -+ BIT_MASK_HI5Q_TXBD_DESA_8821C) -+#define BIT_SET_HI5Q_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_HI5Q_TXBD_DESA_8821C(x) | BIT_HI5Q_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_HI6Q_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_HI6Q_TXBD_DESA_8821C 0 -+#define BIT_MASK_HI6Q_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_HI6Q_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_HI6Q_TXBD_DESA_8821C) \ -+ << BIT_SHIFT_HI6Q_TXBD_DESA_8821C) -+#define BITS_HI6Q_TXBD_DESA_8821C \ -+ (BIT_MASK_HI6Q_TXBD_DESA_8821C << BIT_SHIFT_HI6Q_TXBD_DESA_8821C) -+#define BIT_CLEAR_HI6Q_TXBD_DESA_8821C(x) ((x) & (~BITS_HI6Q_TXBD_DESA_8821C)) -+#define BIT_GET_HI6Q_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_TXBD_DESA_8821C) & \ -+ BIT_MASK_HI6Q_TXBD_DESA_8821C) -+#define BIT_SET_HI6Q_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_HI6Q_TXBD_DESA_8821C(x) | BIT_HI6Q_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_HI7Q_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_HI7Q_TXBD_DESA_8821C 0 -+#define BIT_MASK_HI7Q_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_HI7Q_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_HI7Q_TXBD_DESA_8821C) \ -+ << BIT_SHIFT_HI7Q_TXBD_DESA_8821C) -+#define BITS_HI7Q_TXBD_DESA_8821C \ -+ (BIT_MASK_HI7Q_TXBD_DESA_8821C << BIT_SHIFT_HI7Q_TXBD_DESA_8821C) -+#define BIT_CLEAR_HI7Q_TXBD_DESA_8821C(x) ((x) & (~BITS_HI7Q_TXBD_DESA_8821C)) -+#define BIT_GET_HI7Q_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_TXBD_DESA_8821C) & \ -+ BIT_MASK_HI7Q_TXBD_DESA_8821C) -+#define BIT_SET_HI7Q_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_HI7Q_TXBD_DESA_8821C(x) | BIT_HI7Q_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_MGQ_TXBD_NUM_8821C */ -+#define BIT_PCIE_MGQ_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_MGQ_DESC_MODE_8821C 12 -+#define BIT_MASK_MGQ_DESC_MODE_8821C 0x3 -+#define BIT_MGQ_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_MODE_8821C) << BIT_SHIFT_MGQ_DESC_MODE_8821C) -+#define BITS_MGQ_DESC_MODE_8821C \ -+ (BIT_MASK_MGQ_DESC_MODE_8821C << BIT_SHIFT_MGQ_DESC_MODE_8821C) -+#define BIT_CLEAR_MGQ_DESC_MODE_8821C(x) ((x) & (~BITS_MGQ_DESC_MODE_8821C)) -+#define BIT_GET_MGQ_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_MODE_8821C) & BIT_MASK_MGQ_DESC_MODE_8821C) -+#define BIT_SET_MGQ_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_MODE_8821C(x) | BIT_MGQ_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_MGQ_DESC_NUM_8821C 0 -+#define BIT_MASK_MGQ_DESC_NUM_8821C 0xfff -+#define BIT_MGQ_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_NUM_8821C) << BIT_SHIFT_MGQ_DESC_NUM_8821C) -+#define BITS_MGQ_DESC_NUM_8821C \ -+ (BIT_MASK_MGQ_DESC_NUM_8821C << BIT_SHIFT_MGQ_DESC_NUM_8821C) -+#define BIT_CLEAR_MGQ_DESC_NUM_8821C(x) ((x) & (~BITS_MGQ_DESC_NUM_8821C)) -+#define BIT_GET_MGQ_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_NUM_8821C) & BIT_MASK_MGQ_DESC_NUM_8821C) -+#define BIT_SET_MGQ_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_NUM_8821C(x) | BIT_MGQ_DESC_NUM_8821C(v)) -+ -+/* 2 REG_RX_RXBD_NUM_8821C */ -+#define BIT_SYS_32_64_8821C BIT(15) -+ -+#define BIT_SHIFT_BCNQ_DESC_MODE_8821C 13 -+#define BIT_MASK_BCNQ_DESC_MODE_8821C 0x3 -+#define BIT_BCNQ_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_BCNQ_DESC_MODE_8821C) \ -+ << BIT_SHIFT_BCNQ_DESC_MODE_8821C) -+#define BITS_BCNQ_DESC_MODE_8821C \ -+ (BIT_MASK_BCNQ_DESC_MODE_8821C << BIT_SHIFT_BCNQ_DESC_MODE_8821C) -+#define BIT_CLEAR_BCNQ_DESC_MODE_8821C(x) ((x) & (~BITS_BCNQ_DESC_MODE_8821C)) -+#define BIT_GET_BCNQ_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_DESC_MODE_8821C) & \ -+ BIT_MASK_BCNQ_DESC_MODE_8821C) -+#define BIT_SET_BCNQ_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_BCNQ_DESC_MODE_8821C(x) | BIT_BCNQ_DESC_MODE_8821C(v)) -+ -+#define BIT_PCIE_BCNQ_FLAG_8821C BIT(12) -+ -+#define BIT_SHIFT_RXQ_DESC_NUM_8821C 0 -+#define BIT_MASK_RXQ_DESC_NUM_8821C 0xfff -+#define BIT_RXQ_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_RXQ_DESC_NUM_8821C) << BIT_SHIFT_RXQ_DESC_NUM_8821C) -+#define BITS_RXQ_DESC_NUM_8821C \ -+ (BIT_MASK_RXQ_DESC_NUM_8821C << BIT_SHIFT_RXQ_DESC_NUM_8821C) -+#define BIT_CLEAR_RXQ_DESC_NUM_8821C(x) ((x) & (~BITS_RXQ_DESC_NUM_8821C)) -+#define BIT_GET_RXQ_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXQ_DESC_NUM_8821C) & BIT_MASK_RXQ_DESC_NUM_8821C) -+#define BIT_SET_RXQ_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_RXQ_DESC_NUM_8821C(x) | BIT_RXQ_DESC_NUM_8821C(v)) -+ -+/* 2 REG_VOQ_TXBD_NUM_8821C */ -+#define BIT_PCIE_VOQ_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_VOQ_DESC_MODE_8821C 12 -+#define BIT_MASK_VOQ_DESC_MODE_8821C 0x3 -+#define BIT_VOQ_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_MODE_8821C) << BIT_SHIFT_VOQ_DESC_MODE_8821C) -+#define BITS_VOQ_DESC_MODE_8821C \ -+ (BIT_MASK_VOQ_DESC_MODE_8821C << BIT_SHIFT_VOQ_DESC_MODE_8821C) -+#define BIT_CLEAR_VOQ_DESC_MODE_8821C(x) ((x) & (~BITS_VOQ_DESC_MODE_8821C)) -+#define BIT_GET_VOQ_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_MODE_8821C) & BIT_MASK_VOQ_DESC_MODE_8821C) -+#define BIT_SET_VOQ_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_MODE_8821C(x) | BIT_VOQ_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_VOQ_DESC_NUM_8821C 0 -+#define BIT_MASK_VOQ_DESC_NUM_8821C 0xfff -+#define BIT_VOQ_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_NUM_8821C) << BIT_SHIFT_VOQ_DESC_NUM_8821C) -+#define BITS_VOQ_DESC_NUM_8821C \ -+ (BIT_MASK_VOQ_DESC_NUM_8821C << BIT_SHIFT_VOQ_DESC_NUM_8821C) -+#define BIT_CLEAR_VOQ_DESC_NUM_8821C(x) ((x) & (~BITS_VOQ_DESC_NUM_8821C)) -+#define BIT_GET_VOQ_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_NUM_8821C) & BIT_MASK_VOQ_DESC_NUM_8821C) -+#define BIT_SET_VOQ_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_NUM_8821C(x) | BIT_VOQ_DESC_NUM_8821C(v)) -+ -+/* 2 REG_VIQ_TXBD_NUM_8821C */ -+#define BIT_PCIE_VIQ_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_VIQ_DESC_MODE_8821C 12 -+#define BIT_MASK_VIQ_DESC_MODE_8821C 0x3 -+#define BIT_VIQ_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_MODE_8821C) << BIT_SHIFT_VIQ_DESC_MODE_8821C) -+#define BITS_VIQ_DESC_MODE_8821C \ -+ (BIT_MASK_VIQ_DESC_MODE_8821C << BIT_SHIFT_VIQ_DESC_MODE_8821C) -+#define BIT_CLEAR_VIQ_DESC_MODE_8821C(x) ((x) & (~BITS_VIQ_DESC_MODE_8821C)) -+#define BIT_GET_VIQ_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_MODE_8821C) & BIT_MASK_VIQ_DESC_MODE_8821C) -+#define BIT_SET_VIQ_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_MODE_8821C(x) | BIT_VIQ_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_VIQ_DESC_NUM_8821C 0 -+#define BIT_MASK_VIQ_DESC_NUM_8821C 0xfff -+#define BIT_VIQ_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_NUM_8821C) << BIT_SHIFT_VIQ_DESC_NUM_8821C) -+#define BITS_VIQ_DESC_NUM_8821C \ -+ (BIT_MASK_VIQ_DESC_NUM_8821C << BIT_SHIFT_VIQ_DESC_NUM_8821C) -+#define BIT_CLEAR_VIQ_DESC_NUM_8821C(x) ((x) & (~BITS_VIQ_DESC_NUM_8821C)) -+#define BIT_GET_VIQ_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_NUM_8821C) & BIT_MASK_VIQ_DESC_NUM_8821C) -+#define BIT_SET_VIQ_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_NUM_8821C(x) | BIT_VIQ_DESC_NUM_8821C(v)) -+ -+/* 2 REG_BEQ_TXBD_NUM_8821C */ -+#define BIT_PCIE_BEQ_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_BEQ_DESC_MODE_8821C 12 -+#define BIT_MASK_BEQ_DESC_MODE_8821C 0x3 -+#define BIT_BEQ_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_MODE_8821C) << BIT_SHIFT_BEQ_DESC_MODE_8821C) -+#define BITS_BEQ_DESC_MODE_8821C \ -+ (BIT_MASK_BEQ_DESC_MODE_8821C << BIT_SHIFT_BEQ_DESC_MODE_8821C) -+#define BIT_CLEAR_BEQ_DESC_MODE_8821C(x) ((x) & (~BITS_BEQ_DESC_MODE_8821C)) -+#define BIT_GET_BEQ_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_MODE_8821C) & BIT_MASK_BEQ_DESC_MODE_8821C) -+#define BIT_SET_BEQ_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_MODE_8821C(x) | BIT_BEQ_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_BEQ_DESC_NUM_8821C 0 -+#define BIT_MASK_BEQ_DESC_NUM_8821C 0xfff -+#define BIT_BEQ_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_NUM_8821C) << BIT_SHIFT_BEQ_DESC_NUM_8821C) -+#define BITS_BEQ_DESC_NUM_8821C \ -+ (BIT_MASK_BEQ_DESC_NUM_8821C << BIT_SHIFT_BEQ_DESC_NUM_8821C) -+#define BIT_CLEAR_BEQ_DESC_NUM_8821C(x) ((x) & (~BITS_BEQ_DESC_NUM_8821C)) -+#define BIT_GET_BEQ_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_NUM_8821C) & BIT_MASK_BEQ_DESC_NUM_8821C) -+#define BIT_SET_BEQ_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_NUM_8821C(x) | BIT_BEQ_DESC_NUM_8821C(v)) -+ -+/* 2 REG_BKQ_TXBD_NUM_8821C */ -+#define BIT_PCIE_BKQ_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_BKQ_DESC_MODE_8821C 12 -+#define BIT_MASK_BKQ_DESC_MODE_8821C 0x3 -+#define BIT_BKQ_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_MODE_8821C) << BIT_SHIFT_BKQ_DESC_MODE_8821C) -+#define BITS_BKQ_DESC_MODE_8821C \ -+ (BIT_MASK_BKQ_DESC_MODE_8821C << BIT_SHIFT_BKQ_DESC_MODE_8821C) -+#define BIT_CLEAR_BKQ_DESC_MODE_8821C(x) ((x) & (~BITS_BKQ_DESC_MODE_8821C)) -+#define BIT_GET_BKQ_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_MODE_8821C) & BIT_MASK_BKQ_DESC_MODE_8821C) -+#define BIT_SET_BKQ_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_MODE_8821C(x) | BIT_BKQ_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_BKQ_DESC_NUM_8821C 0 -+#define BIT_MASK_BKQ_DESC_NUM_8821C 0xfff -+#define BIT_BKQ_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_NUM_8821C) << BIT_SHIFT_BKQ_DESC_NUM_8821C) -+#define BITS_BKQ_DESC_NUM_8821C \ -+ (BIT_MASK_BKQ_DESC_NUM_8821C << BIT_SHIFT_BKQ_DESC_NUM_8821C) -+#define BIT_CLEAR_BKQ_DESC_NUM_8821C(x) ((x) & (~BITS_BKQ_DESC_NUM_8821C)) -+#define BIT_GET_BKQ_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_NUM_8821C) & BIT_MASK_BKQ_DESC_NUM_8821C) -+#define BIT_SET_BKQ_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_NUM_8821C(x) | BIT_BKQ_DESC_NUM_8821C(v)) -+ -+/* 2 REG_HI0Q_TXBD_NUM_8821C */ -+#define BIT_HI0Q_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_HI0Q_DESC_MODE_8821C 12 -+#define BIT_MASK_HI0Q_DESC_MODE_8821C 0x3 -+#define BIT_HI0Q_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_MODE_8821C) \ -+ << BIT_SHIFT_HI0Q_DESC_MODE_8821C) -+#define BITS_HI0Q_DESC_MODE_8821C \ -+ (BIT_MASK_HI0Q_DESC_MODE_8821C << BIT_SHIFT_HI0Q_DESC_MODE_8821C) -+#define BIT_CLEAR_HI0Q_DESC_MODE_8821C(x) ((x) & (~BITS_HI0Q_DESC_MODE_8821C)) -+#define BIT_GET_HI0Q_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_MODE_8821C) & \ -+ BIT_MASK_HI0Q_DESC_MODE_8821C) -+#define BIT_SET_HI0Q_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_MODE_8821C(x) | BIT_HI0Q_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_HI0Q_DESC_NUM_8821C 0 -+#define BIT_MASK_HI0Q_DESC_NUM_8821C 0xfff -+#define BIT_HI0Q_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_NUM_8821C) << BIT_SHIFT_HI0Q_DESC_NUM_8821C) -+#define BITS_HI0Q_DESC_NUM_8821C \ -+ (BIT_MASK_HI0Q_DESC_NUM_8821C << BIT_SHIFT_HI0Q_DESC_NUM_8821C) -+#define BIT_CLEAR_HI0Q_DESC_NUM_8821C(x) ((x) & (~BITS_HI0Q_DESC_NUM_8821C)) -+#define BIT_GET_HI0Q_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_NUM_8821C) & BIT_MASK_HI0Q_DESC_NUM_8821C) -+#define BIT_SET_HI0Q_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_NUM_8821C(x) | BIT_HI0Q_DESC_NUM_8821C(v)) -+ -+/* 2 REG_HI1Q_TXBD_NUM_8821C */ -+#define BIT_HI1Q_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_HI1Q_DESC_MODE_8821C 12 -+#define BIT_MASK_HI1Q_DESC_MODE_8821C 0x3 -+#define BIT_HI1Q_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_MODE_8821C) \ -+ << BIT_SHIFT_HI1Q_DESC_MODE_8821C) -+#define BITS_HI1Q_DESC_MODE_8821C \ -+ (BIT_MASK_HI1Q_DESC_MODE_8821C << BIT_SHIFT_HI1Q_DESC_MODE_8821C) -+#define BIT_CLEAR_HI1Q_DESC_MODE_8821C(x) ((x) & (~BITS_HI1Q_DESC_MODE_8821C)) -+#define BIT_GET_HI1Q_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_MODE_8821C) & \ -+ BIT_MASK_HI1Q_DESC_MODE_8821C) -+#define BIT_SET_HI1Q_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_MODE_8821C(x) | BIT_HI1Q_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_HI1Q_DESC_NUM_8821C 0 -+#define BIT_MASK_HI1Q_DESC_NUM_8821C 0xfff -+#define BIT_HI1Q_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_NUM_8821C) << BIT_SHIFT_HI1Q_DESC_NUM_8821C) -+#define BITS_HI1Q_DESC_NUM_8821C \ -+ (BIT_MASK_HI1Q_DESC_NUM_8821C << BIT_SHIFT_HI1Q_DESC_NUM_8821C) -+#define BIT_CLEAR_HI1Q_DESC_NUM_8821C(x) ((x) & (~BITS_HI1Q_DESC_NUM_8821C)) -+#define BIT_GET_HI1Q_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_NUM_8821C) & BIT_MASK_HI1Q_DESC_NUM_8821C) -+#define BIT_SET_HI1Q_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_NUM_8821C(x) | BIT_HI1Q_DESC_NUM_8821C(v)) -+ -+/* 2 REG_HI2Q_TXBD_NUM_8821C */ -+#define BIT_HI2Q_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_HI2Q_DESC_MODE_8821C 12 -+#define BIT_MASK_HI2Q_DESC_MODE_8821C 0x3 -+#define BIT_HI2Q_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_MODE_8821C) \ -+ << BIT_SHIFT_HI2Q_DESC_MODE_8821C) -+#define BITS_HI2Q_DESC_MODE_8821C \ -+ (BIT_MASK_HI2Q_DESC_MODE_8821C << BIT_SHIFT_HI2Q_DESC_MODE_8821C) -+#define BIT_CLEAR_HI2Q_DESC_MODE_8821C(x) ((x) & (~BITS_HI2Q_DESC_MODE_8821C)) -+#define BIT_GET_HI2Q_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_MODE_8821C) & \ -+ BIT_MASK_HI2Q_DESC_MODE_8821C) -+#define BIT_SET_HI2Q_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_MODE_8821C(x) | BIT_HI2Q_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_HI2Q_DESC_NUM_8821C 0 -+#define BIT_MASK_HI2Q_DESC_NUM_8821C 0xfff -+#define BIT_HI2Q_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_NUM_8821C) << BIT_SHIFT_HI2Q_DESC_NUM_8821C) -+#define BITS_HI2Q_DESC_NUM_8821C \ -+ (BIT_MASK_HI2Q_DESC_NUM_8821C << BIT_SHIFT_HI2Q_DESC_NUM_8821C) -+#define BIT_CLEAR_HI2Q_DESC_NUM_8821C(x) ((x) & (~BITS_HI2Q_DESC_NUM_8821C)) -+#define BIT_GET_HI2Q_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_NUM_8821C) & BIT_MASK_HI2Q_DESC_NUM_8821C) -+#define BIT_SET_HI2Q_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_NUM_8821C(x) | BIT_HI2Q_DESC_NUM_8821C(v)) -+ -+/* 2 REG_HI3Q_TXBD_NUM_8821C */ -+#define BIT_HI3Q_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_HI3Q_DESC_MODE_8821C 12 -+#define BIT_MASK_HI3Q_DESC_MODE_8821C 0x3 -+#define BIT_HI3Q_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_MODE_8821C) \ -+ << BIT_SHIFT_HI3Q_DESC_MODE_8821C) -+#define BITS_HI3Q_DESC_MODE_8821C \ -+ (BIT_MASK_HI3Q_DESC_MODE_8821C << BIT_SHIFT_HI3Q_DESC_MODE_8821C) -+#define BIT_CLEAR_HI3Q_DESC_MODE_8821C(x) ((x) & (~BITS_HI3Q_DESC_MODE_8821C)) -+#define BIT_GET_HI3Q_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_MODE_8821C) & \ -+ BIT_MASK_HI3Q_DESC_MODE_8821C) -+#define BIT_SET_HI3Q_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_MODE_8821C(x) | BIT_HI3Q_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_HI3Q_DESC_NUM_8821C 0 -+#define BIT_MASK_HI3Q_DESC_NUM_8821C 0xfff -+#define BIT_HI3Q_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_NUM_8821C) << BIT_SHIFT_HI3Q_DESC_NUM_8821C) -+#define BITS_HI3Q_DESC_NUM_8821C \ -+ (BIT_MASK_HI3Q_DESC_NUM_8821C << BIT_SHIFT_HI3Q_DESC_NUM_8821C) -+#define BIT_CLEAR_HI3Q_DESC_NUM_8821C(x) ((x) & (~BITS_HI3Q_DESC_NUM_8821C)) -+#define BIT_GET_HI3Q_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_NUM_8821C) & BIT_MASK_HI3Q_DESC_NUM_8821C) -+#define BIT_SET_HI3Q_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_NUM_8821C(x) | BIT_HI3Q_DESC_NUM_8821C(v)) -+ -+/* 2 REG_HI4Q_TXBD_NUM_8821C */ -+#define BIT_HI4Q_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_HI4Q_DESC_MODE_8821C 12 -+#define BIT_MASK_HI4Q_DESC_MODE_8821C 0x3 -+#define BIT_HI4Q_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_MODE_8821C) \ -+ << BIT_SHIFT_HI4Q_DESC_MODE_8821C) -+#define BITS_HI4Q_DESC_MODE_8821C \ -+ (BIT_MASK_HI4Q_DESC_MODE_8821C << BIT_SHIFT_HI4Q_DESC_MODE_8821C) -+#define BIT_CLEAR_HI4Q_DESC_MODE_8821C(x) ((x) & (~BITS_HI4Q_DESC_MODE_8821C)) -+#define BIT_GET_HI4Q_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_MODE_8821C) & \ -+ BIT_MASK_HI4Q_DESC_MODE_8821C) -+#define BIT_SET_HI4Q_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_MODE_8821C(x) | BIT_HI4Q_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_HI4Q_DESC_NUM_8821C 0 -+#define BIT_MASK_HI4Q_DESC_NUM_8821C 0xfff -+#define BIT_HI4Q_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_NUM_8821C) << BIT_SHIFT_HI4Q_DESC_NUM_8821C) -+#define BITS_HI4Q_DESC_NUM_8821C \ -+ (BIT_MASK_HI4Q_DESC_NUM_8821C << BIT_SHIFT_HI4Q_DESC_NUM_8821C) -+#define BIT_CLEAR_HI4Q_DESC_NUM_8821C(x) ((x) & (~BITS_HI4Q_DESC_NUM_8821C)) -+#define BIT_GET_HI4Q_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_NUM_8821C) & BIT_MASK_HI4Q_DESC_NUM_8821C) -+#define BIT_SET_HI4Q_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_NUM_8821C(x) | BIT_HI4Q_DESC_NUM_8821C(v)) -+ -+/* 2 REG_HI5Q_TXBD_NUM_8821C */ -+#define BIT_HI5Q_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_HI5Q_DESC_MODE_8821C 12 -+#define BIT_MASK_HI5Q_DESC_MODE_8821C 0x3 -+#define BIT_HI5Q_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_MODE_8821C) \ -+ << BIT_SHIFT_HI5Q_DESC_MODE_8821C) -+#define BITS_HI5Q_DESC_MODE_8821C \ -+ (BIT_MASK_HI5Q_DESC_MODE_8821C << BIT_SHIFT_HI5Q_DESC_MODE_8821C) -+#define BIT_CLEAR_HI5Q_DESC_MODE_8821C(x) ((x) & (~BITS_HI5Q_DESC_MODE_8821C)) -+#define BIT_GET_HI5Q_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_MODE_8821C) & \ -+ BIT_MASK_HI5Q_DESC_MODE_8821C) -+#define BIT_SET_HI5Q_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_MODE_8821C(x) | BIT_HI5Q_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_HI5Q_DESC_NUM_8821C 0 -+#define BIT_MASK_HI5Q_DESC_NUM_8821C 0xfff -+#define BIT_HI5Q_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_NUM_8821C) << BIT_SHIFT_HI5Q_DESC_NUM_8821C) -+#define BITS_HI5Q_DESC_NUM_8821C \ -+ (BIT_MASK_HI5Q_DESC_NUM_8821C << BIT_SHIFT_HI5Q_DESC_NUM_8821C) -+#define BIT_CLEAR_HI5Q_DESC_NUM_8821C(x) ((x) & (~BITS_HI5Q_DESC_NUM_8821C)) -+#define BIT_GET_HI5Q_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_NUM_8821C) & BIT_MASK_HI5Q_DESC_NUM_8821C) -+#define BIT_SET_HI5Q_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_NUM_8821C(x) | BIT_HI5Q_DESC_NUM_8821C(v)) -+ -+/* 2 REG_HI6Q_TXBD_NUM_8821C */ -+#define BIT_HI6Q_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_HI6Q_DESC_MODE_8821C 12 -+#define BIT_MASK_HI6Q_DESC_MODE_8821C 0x3 -+#define BIT_HI6Q_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_MODE_8821C) \ -+ << BIT_SHIFT_HI6Q_DESC_MODE_8821C) -+#define BITS_HI6Q_DESC_MODE_8821C \ -+ (BIT_MASK_HI6Q_DESC_MODE_8821C << BIT_SHIFT_HI6Q_DESC_MODE_8821C) -+#define BIT_CLEAR_HI6Q_DESC_MODE_8821C(x) ((x) & (~BITS_HI6Q_DESC_MODE_8821C)) -+#define BIT_GET_HI6Q_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_MODE_8821C) & \ -+ BIT_MASK_HI6Q_DESC_MODE_8821C) -+#define BIT_SET_HI6Q_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_MODE_8821C(x) | BIT_HI6Q_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_HI6Q_DESC_NUM_8821C 0 -+#define BIT_MASK_HI6Q_DESC_NUM_8821C 0xfff -+#define BIT_HI6Q_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_NUM_8821C) << BIT_SHIFT_HI6Q_DESC_NUM_8821C) -+#define BITS_HI6Q_DESC_NUM_8821C \ -+ (BIT_MASK_HI6Q_DESC_NUM_8821C << BIT_SHIFT_HI6Q_DESC_NUM_8821C) -+#define BIT_CLEAR_HI6Q_DESC_NUM_8821C(x) ((x) & (~BITS_HI6Q_DESC_NUM_8821C)) -+#define BIT_GET_HI6Q_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_NUM_8821C) & BIT_MASK_HI6Q_DESC_NUM_8821C) -+#define BIT_SET_HI6Q_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_NUM_8821C(x) | BIT_HI6Q_DESC_NUM_8821C(v)) -+ -+/* 2 REG_HI7Q_TXBD_NUM_8821C */ -+#define BIT_HI7Q_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_HI7Q_DESC_MODE_8821C 12 -+#define BIT_MASK_HI7Q_DESC_MODE_8821C 0x3 -+#define BIT_HI7Q_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_MODE_8821C) \ -+ << BIT_SHIFT_HI7Q_DESC_MODE_8821C) -+#define BITS_HI7Q_DESC_MODE_8821C \ -+ (BIT_MASK_HI7Q_DESC_MODE_8821C << BIT_SHIFT_HI7Q_DESC_MODE_8821C) -+#define BIT_CLEAR_HI7Q_DESC_MODE_8821C(x) ((x) & (~BITS_HI7Q_DESC_MODE_8821C)) -+#define BIT_GET_HI7Q_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_MODE_8821C) & \ -+ BIT_MASK_HI7Q_DESC_MODE_8821C) -+#define BIT_SET_HI7Q_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_MODE_8821C(x) | BIT_HI7Q_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_HI7Q_DESC_NUM_8821C 0 -+#define BIT_MASK_HI7Q_DESC_NUM_8821C 0xfff -+#define BIT_HI7Q_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_NUM_8821C) << BIT_SHIFT_HI7Q_DESC_NUM_8821C) -+#define BITS_HI7Q_DESC_NUM_8821C \ -+ (BIT_MASK_HI7Q_DESC_NUM_8821C << BIT_SHIFT_HI7Q_DESC_NUM_8821C) -+#define BIT_CLEAR_HI7Q_DESC_NUM_8821C(x) ((x) & (~BITS_HI7Q_DESC_NUM_8821C)) -+#define BIT_GET_HI7Q_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_NUM_8821C) & BIT_MASK_HI7Q_DESC_NUM_8821C) -+#define BIT_SET_HI7Q_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_NUM_8821C(x) | BIT_HI7Q_DESC_NUM_8821C(v)) -+ -+/* 2 REG_TSFTIMER_HCI_8821C */ -+ -+#define BIT_SHIFT_TSFT2_HCI_8821C 16 -+#define BIT_MASK_TSFT2_HCI_8821C 0xffff -+#define BIT_TSFT2_HCI_8821C(x) \ -+ (((x) & BIT_MASK_TSFT2_HCI_8821C) << BIT_SHIFT_TSFT2_HCI_8821C) -+#define BITS_TSFT2_HCI_8821C \ -+ (BIT_MASK_TSFT2_HCI_8821C << BIT_SHIFT_TSFT2_HCI_8821C) -+#define BIT_CLEAR_TSFT2_HCI_8821C(x) ((x) & (~BITS_TSFT2_HCI_8821C)) -+#define BIT_GET_TSFT2_HCI_8821C(x) \ -+ (((x) >> BIT_SHIFT_TSFT2_HCI_8821C) & BIT_MASK_TSFT2_HCI_8821C) -+#define BIT_SET_TSFT2_HCI_8821C(x, v) \ -+ (BIT_CLEAR_TSFT2_HCI_8821C(x) | BIT_TSFT2_HCI_8821C(v)) -+ -+#define BIT_SHIFT_TSFT1_HCI_8821C 0 -+#define BIT_MASK_TSFT1_HCI_8821C 0xffff -+#define BIT_TSFT1_HCI_8821C(x) \ -+ (((x) & BIT_MASK_TSFT1_HCI_8821C) << BIT_SHIFT_TSFT1_HCI_8821C) -+#define BITS_TSFT1_HCI_8821C \ -+ (BIT_MASK_TSFT1_HCI_8821C << BIT_SHIFT_TSFT1_HCI_8821C) -+#define BIT_CLEAR_TSFT1_HCI_8821C(x) ((x) & (~BITS_TSFT1_HCI_8821C)) -+#define BIT_GET_TSFT1_HCI_8821C(x) \ -+ (((x) >> BIT_SHIFT_TSFT1_HCI_8821C) & BIT_MASK_TSFT1_HCI_8821C) -+#define BIT_SET_TSFT1_HCI_8821C(x, v) \ -+ (BIT_CLEAR_TSFT1_HCI_8821C(x) | BIT_TSFT1_HCI_8821C(v)) -+ -+/* 2 REG_BD_RWPTR_CLR_8821C */ -+#define BIT_CLR_HI7Q_HW_IDX_8821C BIT(29) -+#define BIT_CLR_HI6Q_HW_IDX_8821C BIT(28) -+#define BIT_CLR_HI5Q_HW_IDX_8821C BIT(27) -+#define BIT_CLR_HI4Q_HW_IDX_8821C BIT(26) -+#define BIT_CLR_HI3Q_HW_IDX_8821C BIT(25) -+#define BIT_CLR_HI2Q_HW_IDX_8821C BIT(24) -+#define BIT_CLR_HI1Q_HW_IDX_8821C BIT(23) -+#define BIT_CLR_HI0Q_HW_IDX_8821C BIT(22) -+#define BIT_CLR_BKQ_HW_IDX_8821C BIT(21) -+#define BIT_CLR_BEQ_HW_IDX_8821C BIT(20) -+#define BIT_CLR_VIQ_HW_IDX_8821C BIT(19) -+#define BIT_CLR_VOQ_HW_IDX_8821C BIT(18) -+#define BIT_CLR_MGQ_HW_IDX_8821C BIT(17) -+#define BIT_CLR_RXQ_HW_IDX_8821C BIT(16) -+#define BIT_CLR_HI7Q_HOST_IDX_8821C BIT(13) -+#define BIT_CLR_HI6Q_HOST_IDX_8821C BIT(12) -+#define BIT_CLR_HI5Q_HOST_IDX_8821C BIT(11) -+#define BIT_CLR_HI4Q_HOST_IDX_8821C BIT(10) -+#define BIT_CLR_HI3Q_HOST_IDX_8821C BIT(9) -+#define BIT_CLR_HI2Q_HOST_IDX_8821C BIT(8) -+#define BIT_CLR_HI1Q_HOST_IDX_8821C BIT(7) -+#define BIT_CLR_HI0Q_HOST_IDX_8821C BIT(6) -+#define BIT_CLR_BKQ_HOST_IDX_8821C BIT(5) -+#define BIT_CLR_BEQ_HOST_IDX_8821C BIT(4) -+#define BIT_CLR_VIQ_HOST_IDX_8821C BIT(3) -+#define BIT_CLR_VOQ_HOST_IDX_8821C BIT(2) -+#define BIT_CLR_MGQ_HOST_IDX_8821C BIT(1) -+#define BIT_CLR_RXQ_HOST_IDX_8821C BIT(0) -+ -+/* 2 REG_VOQ_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_VOQ_HW_IDX_8821C 16 -+#define BIT_MASK_VOQ_HW_IDX_8821C 0xfff -+#define BIT_VOQ_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_VOQ_HW_IDX_8821C) << BIT_SHIFT_VOQ_HW_IDX_8821C) -+#define BITS_VOQ_HW_IDX_8821C \ -+ (BIT_MASK_VOQ_HW_IDX_8821C << BIT_SHIFT_VOQ_HW_IDX_8821C) -+#define BIT_CLEAR_VOQ_HW_IDX_8821C(x) ((x) & (~BITS_VOQ_HW_IDX_8821C)) -+#define BIT_GET_VOQ_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HW_IDX_8821C) & BIT_MASK_VOQ_HW_IDX_8821C) -+#define BIT_SET_VOQ_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_VOQ_HW_IDX_8821C(x) | BIT_VOQ_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_VOQ_HOST_IDX_8821C 0 -+#define BIT_MASK_VOQ_HOST_IDX_8821C 0xfff -+#define BIT_VOQ_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_VOQ_HOST_IDX_8821C) << BIT_SHIFT_VOQ_HOST_IDX_8821C) -+#define BITS_VOQ_HOST_IDX_8821C \ -+ (BIT_MASK_VOQ_HOST_IDX_8821C << BIT_SHIFT_VOQ_HOST_IDX_8821C) -+#define BIT_CLEAR_VOQ_HOST_IDX_8821C(x) ((x) & (~BITS_VOQ_HOST_IDX_8821C)) -+#define BIT_GET_VOQ_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HOST_IDX_8821C) & BIT_MASK_VOQ_HOST_IDX_8821C) -+#define BIT_SET_VOQ_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_VOQ_HOST_IDX_8821C(x) | BIT_VOQ_HOST_IDX_8821C(v)) -+ -+/* 2 REG_VIQ_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_VIQ_HW_IDX_8821C 16 -+#define BIT_MASK_VIQ_HW_IDX_8821C 0xfff -+#define BIT_VIQ_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_VIQ_HW_IDX_8821C) << BIT_SHIFT_VIQ_HW_IDX_8821C) -+#define BITS_VIQ_HW_IDX_8821C \ -+ (BIT_MASK_VIQ_HW_IDX_8821C << BIT_SHIFT_VIQ_HW_IDX_8821C) -+#define BIT_CLEAR_VIQ_HW_IDX_8821C(x) ((x) & (~BITS_VIQ_HW_IDX_8821C)) -+#define BIT_GET_VIQ_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HW_IDX_8821C) & BIT_MASK_VIQ_HW_IDX_8821C) -+#define BIT_SET_VIQ_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_VIQ_HW_IDX_8821C(x) | BIT_VIQ_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_VIQ_HOST_IDX_8821C 0 -+#define BIT_MASK_VIQ_HOST_IDX_8821C 0xfff -+#define BIT_VIQ_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_VIQ_HOST_IDX_8821C) << BIT_SHIFT_VIQ_HOST_IDX_8821C) -+#define BITS_VIQ_HOST_IDX_8821C \ -+ (BIT_MASK_VIQ_HOST_IDX_8821C << BIT_SHIFT_VIQ_HOST_IDX_8821C) -+#define BIT_CLEAR_VIQ_HOST_IDX_8821C(x) ((x) & (~BITS_VIQ_HOST_IDX_8821C)) -+#define BIT_GET_VIQ_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HOST_IDX_8821C) & BIT_MASK_VIQ_HOST_IDX_8821C) -+#define BIT_SET_VIQ_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_VIQ_HOST_IDX_8821C(x) | BIT_VIQ_HOST_IDX_8821C(v)) -+ -+/* 2 REG_BEQ_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_BEQ_HW_IDX_8821C 16 -+#define BIT_MASK_BEQ_HW_IDX_8821C 0xfff -+#define BIT_BEQ_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_BEQ_HW_IDX_8821C) << BIT_SHIFT_BEQ_HW_IDX_8821C) -+#define BITS_BEQ_HW_IDX_8821C \ -+ (BIT_MASK_BEQ_HW_IDX_8821C << BIT_SHIFT_BEQ_HW_IDX_8821C) -+#define BIT_CLEAR_BEQ_HW_IDX_8821C(x) ((x) & (~BITS_BEQ_HW_IDX_8821C)) -+#define BIT_GET_BEQ_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HW_IDX_8821C) & BIT_MASK_BEQ_HW_IDX_8821C) -+#define BIT_SET_BEQ_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_BEQ_HW_IDX_8821C(x) | BIT_BEQ_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_BEQ_HOST_IDX_8821C 0 -+#define BIT_MASK_BEQ_HOST_IDX_8821C 0xfff -+#define BIT_BEQ_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_BEQ_HOST_IDX_8821C) << BIT_SHIFT_BEQ_HOST_IDX_8821C) -+#define BITS_BEQ_HOST_IDX_8821C \ -+ (BIT_MASK_BEQ_HOST_IDX_8821C << BIT_SHIFT_BEQ_HOST_IDX_8821C) -+#define BIT_CLEAR_BEQ_HOST_IDX_8821C(x) ((x) & (~BITS_BEQ_HOST_IDX_8821C)) -+#define BIT_GET_BEQ_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HOST_IDX_8821C) & BIT_MASK_BEQ_HOST_IDX_8821C) -+#define BIT_SET_BEQ_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_BEQ_HOST_IDX_8821C(x) | BIT_BEQ_HOST_IDX_8821C(v)) -+ -+/* 2 REG_BKQ_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_BKQ_HW_IDX_8821C 16 -+#define BIT_MASK_BKQ_HW_IDX_8821C 0xfff -+#define BIT_BKQ_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_BKQ_HW_IDX_8821C) << BIT_SHIFT_BKQ_HW_IDX_8821C) -+#define BITS_BKQ_HW_IDX_8821C \ -+ (BIT_MASK_BKQ_HW_IDX_8821C << BIT_SHIFT_BKQ_HW_IDX_8821C) -+#define BIT_CLEAR_BKQ_HW_IDX_8821C(x) ((x) & (~BITS_BKQ_HW_IDX_8821C)) -+#define BIT_GET_BKQ_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HW_IDX_8821C) & BIT_MASK_BKQ_HW_IDX_8821C) -+#define BIT_SET_BKQ_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_BKQ_HW_IDX_8821C(x) | BIT_BKQ_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_BKQ_HOST_IDX_8821C 0 -+#define BIT_MASK_BKQ_HOST_IDX_8821C 0xfff -+#define BIT_BKQ_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_BKQ_HOST_IDX_8821C) << BIT_SHIFT_BKQ_HOST_IDX_8821C) -+#define BITS_BKQ_HOST_IDX_8821C \ -+ (BIT_MASK_BKQ_HOST_IDX_8821C << BIT_SHIFT_BKQ_HOST_IDX_8821C) -+#define BIT_CLEAR_BKQ_HOST_IDX_8821C(x) ((x) & (~BITS_BKQ_HOST_IDX_8821C)) -+#define BIT_GET_BKQ_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HOST_IDX_8821C) & BIT_MASK_BKQ_HOST_IDX_8821C) -+#define BIT_SET_BKQ_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_BKQ_HOST_IDX_8821C(x) | BIT_BKQ_HOST_IDX_8821C(v)) -+ -+/* 2 REG_MGQ_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_MGQ_HW_IDX_8821C 16 -+#define BIT_MASK_MGQ_HW_IDX_8821C 0xfff -+#define BIT_MGQ_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_HW_IDX_8821C) << BIT_SHIFT_MGQ_HW_IDX_8821C) -+#define BITS_MGQ_HW_IDX_8821C \ -+ (BIT_MASK_MGQ_HW_IDX_8821C << BIT_SHIFT_MGQ_HW_IDX_8821C) -+#define BIT_CLEAR_MGQ_HW_IDX_8821C(x) ((x) & (~BITS_MGQ_HW_IDX_8821C)) -+#define BIT_GET_MGQ_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HW_IDX_8821C) & BIT_MASK_MGQ_HW_IDX_8821C) -+#define BIT_SET_MGQ_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_HW_IDX_8821C(x) | BIT_MGQ_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_MGQ_HOST_IDX_8821C 0 -+#define BIT_MASK_MGQ_HOST_IDX_8821C 0xfff -+#define BIT_MGQ_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_HOST_IDX_8821C) << BIT_SHIFT_MGQ_HOST_IDX_8821C) -+#define BITS_MGQ_HOST_IDX_8821C \ -+ (BIT_MASK_MGQ_HOST_IDX_8821C << BIT_SHIFT_MGQ_HOST_IDX_8821C) -+#define BIT_CLEAR_MGQ_HOST_IDX_8821C(x) ((x) & (~BITS_MGQ_HOST_IDX_8821C)) -+#define BIT_GET_MGQ_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HOST_IDX_8821C) & BIT_MASK_MGQ_HOST_IDX_8821C) -+#define BIT_SET_MGQ_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_HOST_IDX_8821C(x) | BIT_MGQ_HOST_IDX_8821C(v)) -+ -+/* 2 REG_RXQ_RXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_RXQ_HW_IDX_8821C 16 -+#define BIT_MASK_RXQ_HW_IDX_8821C 0xfff -+#define BIT_RXQ_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_RXQ_HW_IDX_8821C) << BIT_SHIFT_RXQ_HW_IDX_8821C) -+#define BITS_RXQ_HW_IDX_8821C \ -+ (BIT_MASK_RXQ_HW_IDX_8821C << BIT_SHIFT_RXQ_HW_IDX_8821C) -+#define BIT_CLEAR_RXQ_HW_IDX_8821C(x) ((x) & (~BITS_RXQ_HW_IDX_8821C)) -+#define BIT_GET_RXQ_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HW_IDX_8821C) & BIT_MASK_RXQ_HW_IDX_8821C) -+#define BIT_SET_RXQ_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_RXQ_HW_IDX_8821C(x) | BIT_RXQ_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_RXQ_HOST_IDX_8821C 0 -+#define BIT_MASK_RXQ_HOST_IDX_8821C 0xfff -+#define BIT_RXQ_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_RXQ_HOST_IDX_8821C) << BIT_SHIFT_RXQ_HOST_IDX_8821C) -+#define BITS_RXQ_HOST_IDX_8821C \ -+ (BIT_MASK_RXQ_HOST_IDX_8821C << BIT_SHIFT_RXQ_HOST_IDX_8821C) -+#define BIT_CLEAR_RXQ_HOST_IDX_8821C(x) ((x) & (~BITS_RXQ_HOST_IDX_8821C)) -+#define BIT_GET_RXQ_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HOST_IDX_8821C) & BIT_MASK_RXQ_HOST_IDX_8821C) -+#define BIT_SET_RXQ_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_RXQ_HOST_IDX_8821C(x) | BIT_RXQ_HOST_IDX_8821C(v)) -+ -+/* 2 REG_HI0Q_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_HI0Q_HW_IDX_8821C 16 -+#define BIT_MASK_HI0Q_HW_IDX_8821C 0xfff -+#define BIT_HI0Q_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI0Q_HW_IDX_8821C) << BIT_SHIFT_HI0Q_HW_IDX_8821C) -+#define BITS_HI0Q_HW_IDX_8821C \ -+ (BIT_MASK_HI0Q_HW_IDX_8821C << BIT_SHIFT_HI0Q_HW_IDX_8821C) -+#define BIT_CLEAR_HI0Q_HW_IDX_8821C(x) ((x) & (~BITS_HI0Q_HW_IDX_8821C)) -+#define BIT_GET_HI0Q_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HW_IDX_8821C) & BIT_MASK_HI0Q_HW_IDX_8821C) -+#define BIT_SET_HI0Q_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI0Q_HW_IDX_8821C(x) | BIT_HI0Q_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_HI0Q_HOST_IDX_8821C 0 -+#define BIT_MASK_HI0Q_HOST_IDX_8821C 0xfff -+#define BIT_HI0Q_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI0Q_HOST_IDX_8821C) << BIT_SHIFT_HI0Q_HOST_IDX_8821C) -+#define BITS_HI0Q_HOST_IDX_8821C \ -+ (BIT_MASK_HI0Q_HOST_IDX_8821C << BIT_SHIFT_HI0Q_HOST_IDX_8821C) -+#define BIT_CLEAR_HI0Q_HOST_IDX_8821C(x) ((x) & (~BITS_HI0Q_HOST_IDX_8821C)) -+#define BIT_GET_HI0Q_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HOST_IDX_8821C) & BIT_MASK_HI0Q_HOST_IDX_8821C) -+#define BIT_SET_HI0Q_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI0Q_HOST_IDX_8821C(x) | BIT_HI0Q_HOST_IDX_8821C(v)) -+ -+/* 2 REG_HI1Q_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_HI1Q_HW_IDX_8821C 16 -+#define BIT_MASK_HI1Q_HW_IDX_8821C 0xfff -+#define BIT_HI1Q_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI1Q_HW_IDX_8821C) << BIT_SHIFT_HI1Q_HW_IDX_8821C) -+#define BITS_HI1Q_HW_IDX_8821C \ -+ (BIT_MASK_HI1Q_HW_IDX_8821C << BIT_SHIFT_HI1Q_HW_IDX_8821C) -+#define BIT_CLEAR_HI1Q_HW_IDX_8821C(x) ((x) & (~BITS_HI1Q_HW_IDX_8821C)) -+#define BIT_GET_HI1Q_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HW_IDX_8821C) & BIT_MASK_HI1Q_HW_IDX_8821C) -+#define BIT_SET_HI1Q_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI1Q_HW_IDX_8821C(x) | BIT_HI1Q_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_HI1Q_HOST_IDX_8821C 0 -+#define BIT_MASK_HI1Q_HOST_IDX_8821C 0xfff -+#define BIT_HI1Q_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI1Q_HOST_IDX_8821C) << BIT_SHIFT_HI1Q_HOST_IDX_8821C) -+#define BITS_HI1Q_HOST_IDX_8821C \ -+ (BIT_MASK_HI1Q_HOST_IDX_8821C << BIT_SHIFT_HI1Q_HOST_IDX_8821C) -+#define BIT_CLEAR_HI1Q_HOST_IDX_8821C(x) ((x) & (~BITS_HI1Q_HOST_IDX_8821C)) -+#define BIT_GET_HI1Q_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HOST_IDX_8821C) & BIT_MASK_HI1Q_HOST_IDX_8821C) -+#define BIT_SET_HI1Q_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI1Q_HOST_IDX_8821C(x) | BIT_HI1Q_HOST_IDX_8821C(v)) -+ -+/* 2 REG_HI2Q_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_HI2Q_HW_IDX_8821C 16 -+#define BIT_MASK_HI2Q_HW_IDX_8821C 0xfff -+#define BIT_HI2Q_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI2Q_HW_IDX_8821C) << BIT_SHIFT_HI2Q_HW_IDX_8821C) -+#define BITS_HI2Q_HW_IDX_8821C \ -+ (BIT_MASK_HI2Q_HW_IDX_8821C << BIT_SHIFT_HI2Q_HW_IDX_8821C) -+#define BIT_CLEAR_HI2Q_HW_IDX_8821C(x) ((x) & (~BITS_HI2Q_HW_IDX_8821C)) -+#define BIT_GET_HI2Q_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HW_IDX_8821C) & BIT_MASK_HI2Q_HW_IDX_8821C) -+#define BIT_SET_HI2Q_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI2Q_HW_IDX_8821C(x) | BIT_HI2Q_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_HI2Q_HOST_IDX_8821C 0 -+#define BIT_MASK_HI2Q_HOST_IDX_8821C 0xfff -+#define BIT_HI2Q_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI2Q_HOST_IDX_8821C) << BIT_SHIFT_HI2Q_HOST_IDX_8821C) -+#define BITS_HI2Q_HOST_IDX_8821C \ -+ (BIT_MASK_HI2Q_HOST_IDX_8821C << BIT_SHIFT_HI2Q_HOST_IDX_8821C) -+#define BIT_CLEAR_HI2Q_HOST_IDX_8821C(x) ((x) & (~BITS_HI2Q_HOST_IDX_8821C)) -+#define BIT_GET_HI2Q_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HOST_IDX_8821C) & BIT_MASK_HI2Q_HOST_IDX_8821C) -+#define BIT_SET_HI2Q_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI2Q_HOST_IDX_8821C(x) | BIT_HI2Q_HOST_IDX_8821C(v)) -+ -+/* 2 REG_HI3Q_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_HI3Q_HW_IDX_8821C 16 -+#define BIT_MASK_HI3Q_HW_IDX_8821C 0xfff -+#define BIT_HI3Q_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI3Q_HW_IDX_8821C) << BIT_SHIFT_HI3Q_HW_IDX_8821C) -+#define BITS_HI3Q_HW_IDX_8821C \ -+ (BIT_MASK_HI3Q_HW_IDX_8821C << BIT_SHIFT_HI3Q_HW_IDX_8821C) -+#define BIT_CLEAR_HI3Q_HW_IDX_8821C(x) ((x) & (~BITS_HI3Q_HW_IDX_8821C)) -+#define BIT_GET_HI3Q_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HW_IDX_8821C) & BIT_MASK_HI3Q_HW_IDX_8821C) -+#define BIT_SET_HI3Q_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI3Q_HW_IDX_8821C(x) | BIT_HI3Q_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_HI3Q_HOST_IDX_8821C 0 -+#define BIT_MASK_HI3Q_HOST_IDX_8821C 0xfff -+#define BIT_HI3Q_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI3Q_HOST_IDX_8821C) << BIT_SHIFT_HI3Q_HOST_IDX_8821C) -+#define BITS_HI3Q_HOST_IDX_8821C \ -+ (BIT_MASK_HI3Q_HOST_IDX_8821C << BIT_SHIFT_HI3Q_HOST_IDX_8821C) -+#define BIT_CLEAR_HI3Q_HOST_IDX_8821C(x) ((x) & (~BITS_HI3Q_HOST_IDX_8821C)) -+#define BIT_GET_HI3Q_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HOST_IDX_8821C) & BIT_MASK_HI3Q_HOST_IDX_8821C) -+#define BIT_SET_HI3Q_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI3Q_HOST_IDX_8821C(x) | BIT_HI3Q_HOST_IDX_8821C(v)) -+ -+/* 2 REG_HI4Q_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_HI4Q_HW_IDX_8821C 16 -+#define BIT_MASK_HI4Q_HW_IDX_8821C 0xfff -+#define BIT_HI4Q_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI4Q_HW_IDX_8821C) << BIT_SHIFT_HI4Q_HW_IDX_8821C) -+#define BITS_HI4Q_HW_IDX_8821C \ -+ (BIT_MASK_HI4Q_HW_IDX_8821C << BIT_SHIFT_HI4Q_HW_IDX_8821C) -+#define BIT_CLEAR_HI4Q_HW_IDX_8821C(x) ((x) & (~BITS_HI4Q_HW_IDX_8821C)) -+#define BIT_GET_HI4Q_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HW_IDX_8821C) & BIT_MASK_HI4Q_HW_IDX_8821C) -+#define BIT_SET_HI4Q_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI4Q_HW_IDX_8821C(x) | BIT_HI4Q_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_HI4Q_HOST_IDX_8821C 0 -+#define BIT_MASK_HI4Q_HOST_IDX_8821C 0xfff -+#define BIT_HI4Q_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI4Q_HOST_IDX_8821C) << BIT_SHIFT_HI4Q_HOST_IDX_8821C) -+#define BITS_HI4Q_HOST_IDX_8821C \ -+ (BIT_MASK_HI4Q_HOST_IDX_8821C << BIT_SHIFT_HI4Q_HOST_IDX_8821C) -+#define BIT_CLEAR_HI4Q_HOST_IDX_8821C(x) ((x) & (~BITS_HI4Q_HOST_IDX_8821C)) -+#define BIT_GET_HI4Q_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HOST_IDX_8821C) & BIT_MASK_HI4Q_HOST_IDX_8821C) -+#define BIT_SET_HI4Q_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI4Q_HOST_IDX_8821C(x) | BIT_HI4Q_HOST_IDX_8821C(v)) -+ -+/* 2 REG_HI5Q_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_HI5Q_HW_IDX_8821C 16 -+#define BIT_MASK_HI5Q_HW_IDX_8821C 0xfff -+#define BIT_HI5Q_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI5Q_HW_IDX_8821C) << BIT_SHIFT_HI5Q_HW_IDX_8821C) -+#define BITS_HI5Q_HW_IDX_8821C \ -+ (BIT_MASK_HI5Q_HW_IDX_8821C << BIT_SHIFT_HI5Q_HW_IDX_8821C) -+#define BIT_CLEAR_HI5Q_HW_IDX_8821C(x) ((x) & (~BITS_HI5Q_HW_IDX_8821C)) -+#define BIT_GET_HI5Q_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HW_IDX_8821C) & BIT_MASK_HI5Q_HW_IDX_8821C) -+#define BIT_SET_HI5Q_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI5Q_HW_IDX_8821C(x) | BIT_HI5Q_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_HI5Q_HOST_IDX_8821C 0 -+#define BIT_MASK_HI5Q_HOST_IDX_8821C 0xfff -+#define BIT_HI5Q_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI5Q_HOST_IDX_8821C) << BIT_SHIFT_HI5Q_HOST_IDX_8821C) -+#define BITS_HI5Q_HOST_IDX_8821C \ -+ (BIT_MASK_HI5Q_HOST_IDX_8821C << BIT_SHIFT_HI5Q_HOST_IDX_8821C) -+#define BIT_CLEAR_HI5Q_HOST_IDX_8821C(x) ((x) & (~BITS_HI5Q_HOST_IDX_8821C)) -+#define BIT_GET_HI5Q_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HOST_IDX_8821C) & BIT_MASK_HI5Q_HOST_IDX_8821C) -+#define BIT_SET_HI5Q_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI5Q_HOST_IDX_8821C(x) | BIT_HI5Q_HOST_IDX_8821C(v)) -+ -+/* 2 REG_HI6Q_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_HI6Q_HW_IDX_8821C 16 -+#define BIT_MASK_HI6Q_HW_IDX_8821C 0xfff -+#define BIT_HI6Q_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI6Q_HW_IDX_8821C) << BIT_SHIFT_HI6Q_HW_IDX_8821C) -+#define BITS_HI6Q_HW_IDX_8821C \ -+ (BIT_MASK_HI6Q_HW_IDX_8821C << BIT_SHIFT_HI6Q_HW_IDX_8821C) -+#define BIT_CLEAR_HI6Q_HW_IDX_8821C(x) ((x) & (~BITS_HI6Q_HW_IDX_8821C)) -+#define BIT_GET_HI6Q_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HW_IDX_8821C) & BIT_MASK_HI6Q_HW_IDX_8821C) -+#define BIT_SET_HI6Q_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI6Q_HW_IDX_8821C(x) | BIT_HI6Q_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_HI6Q_HOST_IDX_8821C 0 -+#define BIT_MASK_HI6Q_HOST_IDX_8821C 0xfff -+#define BIT_HI6Q_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI6Q_HOST_IDX_8821C) << BIT_SHIFT_HI6Q_HOST_IDX_8821C) -+#define BITS_HI6Q_HOST_IDX_8821C \ -+ (BIT_MASK_HI6Q_HOST_IDX_8821C << BIT_SHIFT_HI6Q_HOST_IDX_8821C) -+#define BIT_CLEAR_HI6Q_HOST_IDX_8821C(x) ((x) & (~BITS_HI6Q_HOST_IDX_8821C)) -+#define BIT_GET_HI6Q_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HOST_IDX_8821C) & BIT_MASK_HI6Q_HOST_IDX_8821C) -+#define BIT_SET_HI6Q_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI6Q_HOST_IDX_8821C(x) | BIT_HI6Q_HOST_IDX_8821C(v)) -+ -+/* 2 REG_HI7Q_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_HI7Q_HW_IDX_8821C 16 -+#define BIT_MASK_HI7Q_HW_IDX_8821C 0xfff -+#define BIT_HI7Q_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI7Q_HW_IDX_8821C) << BIT_SHIFT_HI7Q_HW_IDX_8821C) -+#define BITS_HI7Q_HW_IDX_8821C \ -+ (BIT_MASK_HI7Q_HW_IDX_8821C << BIT_SHIFT_HI7Q_HW_IDX_8821C) -+#define BIT_CLEAR_HI7Q_HW_IDX_8821C(x) ((x) & (~BITS_HI7Q_HW_IDX_8821C)) -+#define BIT_GET_HI7Q_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HW_IDX_8821C) & BIT_MASK_HI7Q_HW_IDX_8821C) -+#define BIT_SET_HI7Q_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI7Q_HW_IDX_8821C(x) | BIT_HI7Q_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_HI7Q_HOST_IDX_8821C 0 -+#define BIT_MASK_HI7Q_HOST_IDX_8821C 0xfff -+#define BIT_HI7Q_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HI7Q_HOST_IDX_8821C) << BIT_SHIFT_HI7Q_HOST_IDX_8821C) -+#define BITS_HI7Q_HOST_IDX_8821C \ -+ (BIT_MASK_HI7Q_HOST_IDX_8821C << BIT_SHIFT_HI7Q_HOST_IDX_8821C) -+#define BIT_CLEAR_HI7Q_HOST_IDX_8821C(x) ((x) & (~BITS_HI7Q_HOST_IDX_8821C)) -+#define BIT_GET_HI7Q_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HOST_IDX_8821C) & BIT_MASK_HI7Q_HOST_IDX_8821C) -+#define BIT_SET_HI7Q_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HI7Q_HOST_IDX_8821C(x) | BIT_HI7Q_HOST_IDX_8821C(v)) -+ -+/* 2 REG_DBG_SEL_V1_8821C */ -+ -+#define BIT_SHIFT_DBG_SEL_8821C 0 -+#define BIT_MASK_DBG_SEL_8821C 0xff -+#define BIT_DBG_SEL_8821C(x) \ -+ (((x) & BIT_MASK_DBG_SEL_8821C) << BIT_SHIFT_DBG_SEL_8821C) -+#define BITS_DBG_SEL_8821C (BIT_MASK_DBG_SEL_8821C << BIT_SHIFT_DBG_SEL_8821C) -+#define BIT_CLEAR_DBG_SEL_8821C(x) ((x) & (~BITS_DBG_SEL_8821C)) -+#define BIT_GET_DBG_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_8821C) & BIT_MASK_DBG_SEL_8821C) -+#define BIT_SET_DBG_SEL_8821C(x, v) \ -+ (BIT_CLEAR_DBG_SEL_8821C(x) | BIT_DBG_SEL_8821C(v)) -+ -+/* 2 REG_PCIE_HRPWM1_V1_8821C */ -+ -+#define BIT_SHIFT_PCIE_HRPWM_8821C 0 -+#define BIT_MASK_PCIE_HRPWM_8821C 0xff -+#define BIT_PCIE_HRPWM_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM_8821C) << BIT_SHIFT_PCIE_HRPWM_8821C) -+#define BITS_PCIE_HRPWM_8821C \ -+ (BIT_MASK_PCIE_HRPWM_8821C << BIT_SHIFT_PCIE_HRPWM_8821C) -+#define BIT_CLEAR_PCIE_HRPWM_8821C(x) ((x) & (~BITS_PCIE_HRPWM_8821C)) -+#define BIT_GET_PCIE_HRPWM_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM_8821C) & BIT_MASK_PCIE_HRPWM_8821C) -+#define BIT_SET_PCIE_HRPWM_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM_8821C(x) | BIT_PCIE_HRPWM_8821C(v)) -+ -+/* 2 REG_PCIE_HCPWM1_V1_8821C */ -+ -+#define BIT_SHIFT_PCIE_HCPWM_8821C 0 -+#define BIT_MASK_PCIE_HCPWM_8821C 0xff -+#define BIT_PCIE_HCPWM_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM_8821C) << BIT_SHIFT_PCIE_HCPWM_8821C) -+#define BITS_PCIE_HCPWM_8821C \ -+ (BIT_MASK_PCIE_HCPWM_8821C << BIT_SHIFT_PCIE_HCPWM_8821C) -+#define BIT_CLEAR_PCIE_HCPWM_8821C(x) ((x) & (~BITS_PCIE_HCPWM_8821C)) -+#define BIT_GET_PCIE_HCPWM_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM_8821C) & BIT_MASK_PCIE_HCPWM_8821C) -+#define BIT_SET_PCIE_HCPWM_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM_8821C(x) | BIT_PCIE_HCPWM_8821C(v)) -+ -+/* 2 REG_PCIE_CTRL2_8821C */ -+#define BIT_DIS_TXDMA_PRE_8821C BIT(7) -+#define BIT_DIS_RXDMA_PRE_8821C BIT(6) -+ -+#define BIT_SHIFT_HPS_CLKR_PCIE_8821C 4 -+#define BIT_MASK_HPS_CLKR_PCIE_8821C 0x3 -+#define BIT_HPS_CLKR_PCIE_8821C(x) \ -+ (((x) & BIT_MASK_HPS_CLKR_PCIE_8821C) << BIT_SHIFT_HPS_CLKR_PCIE_8821C) -+#define BITS_HPS_CLKR_PCIE_8821C \ -+ (BIT_MASK_HPS_CLKR_PCIE_8821C << BIT_SHIFT_HPS_CLKR_PCIE_8821C) -+#define BIT_CLEAR_HPS_CLKR_PCIE_8821C(x) ((x) & (~BITS_HPS_CLKR_PCIE_8821C)) -+#define BIT_GET_HPS_CLKR_PCIE_8821C(x) \ -+ (((x) >> BIT_SHIFT_HPS_CLKR_PCIE_8821C) & BIT_MASK_HPS_CLKR_PCIE_8821C) -+#define BIT_SET_HPS_CLKR_PCIE_8821C(x, v) \ -+ (BIT_CLEAR_HPS_CLKR_PCIE_8821C(x) | BIT_HPS_CLKR_PCIE_8821C(v)) -+ -+#define BIT_PCIE_INT_8821C BIT(3) -+#define BIT_TXFLAG_EXIT_L1_EN_8821C BIT(2) -+#define BIT_EN_RXDMA_ALIGN_8821C BIT(1) -+#define BIT_EN_TXDMA_ALIGN_8821C BIT(0) -+ -+/* 2 REG_PCIE_HRPWM2_V1_8821C */ -+ -+#define BIT_SHIFT_PCIE_HRPWM2_8821C 0 -+#define BIT_MASK_PCIE_HRPWM2_8821C 0xffff -+#define BIT_PCIE_HRPWM2_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM2_8821C) << BIT_SHIFT_PCIE_HRPWM2_8821C) -+#define BITS_PCIE_HRPWM2_8821C \ -+ (BIT_MASK_PCIE_HRPWM2_8821C << BIT_SHIFT_PCIE_HRPWM2_8821C) -+#define BIT_CLEAR_PCIE_HRPWM2_8821C(x) ((x) & (~BITS_PCIE_HRPWM2_8821C)) -+#define BIT_GET_PCIE_HRPWM2_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM2_8821C) & BIT_MASK_PCIE_HRPWM2_8821C) -+#define BIT_SET_PCIE_HRPWM2_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM2_8821C(x) | BIT_PCIE_HRPWM2_8821C(v)) -+ -+/* 2 REG_PCIE_HCPWM2_V1_8821C */ -+ -+#define BIT_SHIFT_PCIE_HCPWM2_8821C 0 -+#define BIT_MASK_PCIE_HCPWM2_8821C 0xffff -+#define BIT_PCIE_HCPWM2_8821C(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM2_8821C) << BIT_SHIFT_PCIE_HCPWM2_8821C) -+#define BITS_PCIE_HCPWM2_8821C \ -+ (BIT_MASK_PCIE_HCPWM2_8821C << BIT_SHIFT_PCIE_HCPWM2_8821C) -+#define BIT_CLEAR_PCIE_HCPWM2_8821C(x) ((x) & (~BITS_PCIE_HCPWM2_8821C)) -+#define BIT_GET_PCIE_HCPWM2_8821C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM2_8821C) & BIT_MASK_PCIE_HCPWM2_8821C) -+#define BIT_SET_PCIE_HCPWM2_8821C(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM2_8821C(x) | BIT_PCIE_HCPWM2_8821C(v)) -+ -+/* 2 REG_PCIE_H2C_MSG_V1_8821C */ -+ -+#define BIT_SHIFT_DRV2FW_INFO_8821C 0 -+#define BIT_MASK_DRV2FW_INFO_8821C 0xffffffffL -+#define BIT_DRV2FW_INFO_8821C(x) \ -+ (((x) & BIT_MASK_DRV2FW_INFO_8821C) << BIT_SHIFT_DRV2FW_INFO_8821C) -+#define BITS_DRV2FW_INFO_8821C \ -+ (BIT_MASK_DRV2FW_INFO_8821C << BIT_SHIFT_DRV2FW_INFO_8821C) -+#define BIT_CLEAR_DRV2FW_INFO_8821C(x) ((x) & (~BITS_DRV2FW_INFO_8821C)) -+#define BIT_GET_DRV2FW_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_DRV2FW_INFO_8821C) & BIT_MASK_DRV2FW_INFO_8821C) -+#define BIT_SET_DRV2FW_INFO_8821C(x, v) \ -+ (BIT_CLEAR_DRV2FW_INFO_8821C(x) | BIT_DRV2FW_INFO_8821C(v)) -+ -+/* 2 REG_PCIE_C2H_MSG_V1_8821C */ -+ -+#define BIT_SHIFT_HCI_PCIE_C2H_MSG_8821C 0 -+#define BIT_MASK_HCI_PCIE_C2H_MSG_8821C 0xffffffffL -+#define BIT_HCI_PCIE_C2H_MSG_8821C(x) \ -+ (((x) & BIT_MASK_HCI_PCIE_C2H_MSG_8821C) \ -+ << BIT_SHIFT_HCI_PCIE_C2H_MSG_8821C) -+#define BITS_HCI_PCIE_C2H_MSG_8821C \ -+ (BIT_MASK_HCI_PCIE_C2H_MSG_8821C << BIT_SHIFT_HCI_PCIE_C2H_MSG_8821C) -+#define BIT_CLEAR_HCI_PCIE_C2H_MSG_8821C(x) \ -+ ((x) & (~BITS_HCI_PCIE_C2H_MSG_8821C)) -+#define BIT_GET_HCI_PCIE_C2H_MSG_8821C(x) \ -+ (((x) >> BIT_SHIFT_HCI_PCIE_C2H_MSG_8821C) & \ -+ BIT_MASK_HCI_PCIE_C2H_MSG_8821C) -+#define BIT_SET_HCI_PCIE_C2H_MSG_8821C(x, v) \ -+ (BIT_CLEAR_HCI_PCIE_C2H_MSG_8821C(x) | BIT_HCI_PCIE_C2H_MSG_8821C(v)) -+ -+/* 2 REG_DBI_WDATA_V1_8821C */ -+ -+#define BIT_SHIFT_DBI_WDATA_8821C 0 -+#define BIT_MASK_DBI_WDATA_8821C 0xffffffffL -+#define BIT_DBI_WDATA_8821C(x) \ -+ (((x) & BIT_MASK_DBI_WDATA_8821C) << BIT_SHIFT_DBI_WDATA_8821C) -+#define BITS_DBI_WDATA_8821C \ -+ (BIT_MASK_DBI_WDATA_8821C << BIT_SHIFT_DBI_WDATA_8821C) -+#define BIT_CLEAR_DBI_WDATA_8821C(x) ((x) & (~BITS_DBI_WDATA_8821C)) -+#define BIT_GET_DBI_WDATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DBI_WDATA_8821C) & BIT_MASK_DBI_WDATA_8821C) -+#define BIT_SET_DBI_WDATA_8821C(x, v) \ -+ (BIT_CLEAR_DBI_WDATA_8821C(x) | BIT_DBI_WDATA_8821C(v)) -+ -+/* 2 REG_DBI_RDATA_V1_8821C */ -+ -+#define BIT_SHIFT_DBI_RDATA_8821C 0 -+#define BIT_MASK_DBI_RDATA_8821C 0xffffffffL -+#define BIT_DBI_RDATA_8821C(x) \ -+ (((x) & BIT_MASK_DBI_RDATA_8821C) << BIT_SHIFT_DBI_RDATA_8821C) -+#define BITS_DBI_RDATA_8821C \ -+ (BIT_MASK_DBI_RDATA_8821C << BIT_SHIFT_DBI_RDATA_8821C) -+#define BIT_CLEAR_DBI_RDATA_8821C(x) ((x) & (~BITS_DBI_RDATA_8821C)) -+#define BIT_GET_DBI_RDATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DBI_RDATA_8821C) & BIT_MASK_DBI_RDATA_8821C) -+#define BIT_SET_DBI_RDATA_8821C(x, v) \ -+ (BIT_CLEAR_DBI_RDATA_8821C(x) | BIT_DBI_RDATA_8821C(v)) -+ -+/* 2 REG_DBI_FLAG_V1_8821C */ -+#define BIT_EN_STUCK_DBG_8821C BIT(26) -+#define BIT_RX_STUCK_8821C BIT(25) -+#define BIT_TX_STUCK_8821C BIT(24) -+#define BIT_DBI_RFLAG_8821C BIT(17) -+#define BIT_DBI_WFLAG_8821C BIT(16) -+ -+#define BIT_SHIFT_DBI_WREN_8821C 12 -+#define BIT_MASK_DBI_WREN_8821C 0xf -+#define BIT_DBI_WREN_8821C(x) \ -+ (((x) & BIT_MASK_DBI_WREN_8821C) << BIT_SHIFT_DBI_WREN_8821C) -+#define BITS_DBI_WREN_8821C \ -+ (BIT_MASK_DBI_WREN_8821C << BIT_SHIFT_DBI_WREN_8821C) -+#define BIT_CLEAR_DBI_WREN_8821C(x) ((x) & (~BITS_DBI_WREN_8821C)) -+#define BIT_GET_DBI_WREN_8821C(x) \ -+ (((x) >> BIT_SHIFT_DBI_WREN_8821C) & BIT_MASK_DBI_WREN_8821C) -+#define BIT_SET_DBI_WREN_8821C(x, v) \ -+ (BIT_CLEAR_DBI_WREN_8821C(x) | BIT_DBI_WREN_8821C(v)) -+ -+#define BIT_SHIFT_DBI_ADDR_8821C 0 -+#define BIT_MASK_DBI_ADDR_8821C 0xfff -+#define BIT_DBI_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_DBI_ADDR_8821C) << BIT_SHIFT_DBI_ADDR_8821C) -+#define BITS_DBI_ADDR_8821C \ -+ (BIT_MASK_DBI_ADDR_8821C << BIT_SHIFT_DBI_ADDR_8821C) -+#define BIT_CLEAR_DBI_ADDR_8821C(x) ((x) & (~BITS_DBI_ADDR_8821C)) -+#define BIT_GET_DBI_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_DBI_ADDR_8821C) & BIT_MASK_DBI_ADDR_8821C) -+#define BIT_SET_DBI_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_DBI_ADDR_8821C(x) | BIT_DBI_ADDR_8821C(v)) -+ -+/* 2 REG_MDIO_V1_8821C */ -+ -+#define BIT_SHIFT_MDIO_RDATA_8821C 16 -+#define BIT_MASK_MDIO_RDATA_8821C 0xffff -+#define BIT_MDIO_RDATA_8821C(x) \ -+ (((x) & BIT_MASK_MDIO_RDATA_8821C) << BIT_SHIFT_MDIO_RDATA_8821C) -+#define BITS_MDIO_RDATA_8821C \ -+ (BIT_MASK_MDIO_RDATA_8821C << BIT_SHIFT_MDIO_RDATA_8821C) -+#define BIT_CLEAR_MDIO_RDATA_8821C(x) ((x) & (~BITS_MDIO_RDATA_8821C)) -+#define BIT_GET_MDIO_RDATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_MDIO_RDATA_8821C) & BIT_MASK_MDIO_RDATA_8821C) -+#define BIT_SET_MDIO_RDATA_8821C(x, v) \ -+ (BIT_CLEAR_MDIO_RDATA_8821C(x) | BIT_MDIO_RDATA_8821C(v)) -+ -+#define BIT_SHIFT_MDIO_WDATA_8821C 0 -+#define BIT_MASK_MDIO_WDATA_8821C 0xffff -+#define BIT_MDIO_WDATA_8821C(x) \ -+ (((x) & BIT_MASK_MDIO_WDATA_8821C) << BIT_SHIFT_MDIO_WDATA_8821C) -+#define BITS_MDIO_WDATA_8821C \ -+ (BIT_MASK_MDIO_WDATA_8821C << BIT_SHIFT_MDIO_WDATA_8821C) -+#define BIT_CLEAR_MDIO_WDATA_8821C(x) ((x) & (~BITS_MDIO_WDATA_8821C)) -+#define BIT_GET_MDIO_WDATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_MDIO_WDATA_8821C) & BIT_MASK_MDIO_WDATA_8821C) -+#define BIT_SET_MDIO_WDATA_8821C(x, v) \ -+ (BIT_CLEAR_MDIO_WDATA_8821C(x) | BIT_MDIO_WDATA_8821C(v)) -+ -+/* 2 REG_PCIE_MIX_CFG_8821C */ -+ -+#define BIT_SHIFT_MDIO_PHY_ADDR_8821C 24 -+#define BIT_MASK_MDIO_PHY_ADDR_8821C 0x1f -+#define BIT_MDIO_PHY_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_MDIO_PHY_ADDR_8821C) << BIT_SHIFT_MDIO_PHY_ADDR_8821C) -+#define BITS_MDIO_PHY_ADDR_8821C \ -+ (BIT_MASK_MDIO_PHY_ADDR_8821C << BIT_SHIFT_MDIO_PHY_ADDR_8821C) -+#define BIT_CLEAR_MDIO_PHY_ADDR_8821C(x) ((x) & (~BITS_MDIO_PHY_ADDR_8821C)) -+#define BIT_GET_MDIO_PHY_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_MDIO_PHY_ADDR_8821C) & BIT_MASK_MDIO_PHY_ADDR_8821C) -+#define BIT_SET_MDIO_PHY_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_MDIO_PHY_ADDR_8821C(x) | BIT_MDIO_PHY_ADDR_8821C(v)) -+ -+#define BIT_SHIFT_WATCH_DOG_RECORD_V1_8821C 10 -+#define BIT_MASK_WATCH_DOG_RECORD_V1_8821C 0x3fff -+#define BIT_WATCH_DOG_RECORD_V1_8821C(x) \ -+ (((x) & BIT_MASK_WATCH_DOG_RECORD_V1_8821C) \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8821C) -+#define BITS_WATCH_DOG_RECORD_V1_8821C \ -+ (BIT_MASK_WATCH_DOG_RECORD_V1_8821C \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8821C) -+#define BIT_CLEAR_WATCH_DOG_RECORD_V1_8821C(x) \ -+ ((x) & (~BITS_WATCH_DOG_RECORD_V1_8821C)) -+#define BIT_GET_WATCH_DOG_RECORD_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_WATCH_DOG_RECORD_V1_8821C) & \ -+ BIT_MASK_WATCH_DOG_RECORD_V1_8821C) -+#define BIT_SET_WATCH_DOG_RECORD_V1_8821C(x, v) \ -+ (BIT_CLEAR_WATCH_DOG_RECORD_V1_8821C(x) | \ -+ BIT_WATCH_DOG_RECORD_V1_8821C(v)) -+ -+#define BIT_R_IO_TIMEOUT_FLAG_V1_8821C BIT(9) -+#define BIT_EN_WATCH_DOG_8821C BIT(8) -+#define BIT_ECRC_EN_V1_8821C BIT(7) -+#define BIT_MDIO_RFLAG_V1_8821C BIT(6) -+#define BIT_MDIO_WFLAG_V1_8821C BIT(5) -+ -+#define BIT_SHIFT_MDIO_REG_ADDR_V1_8821C 0 -+#define BIT_MASK_MDIO_REG_ADDR_V1_8821C 0x1f -+#define BIT_MDIO_REG_ADDR_V1_8821C(x) \ -+ (((x) & BIT_MASK_MDIO_REG_ADDR_V1_8821C) \ -+ << BIT_SHIFT_MDIO_REG_ADDR_V1_8821C) -+#define BITS_MDIO_REG_ADDR_V1_8821C \ -+ (BIT_MASK_MDIO_REG_ADDR_V1_8821C << BIT_SHIFT_MDIO_REG_ADDR_V1_8821C) -+#define BIT_CLEAR_MDIO_REG_ADDR_V1_8821C(x) \ -+ ((x) & (~BITS_MDIO_REG_ADDR_V1_8821C)) -+#define BIT_GET_MDIO_REG_ADDR_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MDIO_REG_ADDR_V1_8821C) & \ -+ BIT_MASK_MDIO_REG_ADDR_V1_8821C) -+#define BIT_SET_MDIO_REG_ADDR_V1_8821C(x, v) \ -+ (BIT_CLEAR_MDIO_REG_ADDR_V1_8821C(x) | BIT_MDIO_REG_ADDR_V1_8821C(v)) -+ -+/* 2 REG_HCI_MIX_CFG_8821C */ -+#define BIT_HOST_GEN2_SUPPORT_8821C BIT(20) -+ -+#define BIT_SHIFT_TXDMA_ERR_FLAG_8821C 16 -+#define BIT_MASK_TXDMA_ERR_FLAG_8821C 0xf -+#define BIT_TXDMA_ERR_FLAG_8821C(x) \ -+ (((x) & BIT_MASK_TXDMA_ERR_FLAG_8821C) \ -+ << BIT_SHIFT_TXDMA_ERR_FLAG_8821C) -+#define BITS_TXDMA_ERR_FLAG_8821C \ -+ (BIT_MASK_TXDMA_ERR_FLAG_8821C << BIT_SHIFT_TXDMA_ERR_FLAG_8821C) -+#define BIT_CLEAR_TXDMA_ERR_FLAG_8821C(x) ((x) & (~BITS_TXDMA_ERR_FLAG_8821C)) -+#define BIT_GET_TXDMA_ERR_FLAG_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_ERR_FLAG_8821C) & \ -+ BIT_MASK_TXDMA_ERR_FLAG_8821C) -+#define BIT_SET_TXDMA_ERR_FLAG_8821C(x, v) \ -+ (BIT_CLEAR_TXDMA_ERR_FLAG_8821C(x) | BIT_TXDMA_ERR_FLAG_8821C(v)) -+ -+#define BIT_SHIFT_EARLY_MODE_SEL_8821C 12 -+#define BIT_MASK_EARLY_MODE_SEL_8821C 0xf -+#define BIT_EARLY_MODE_SEL_8821C(x) \ -+ (((x) & BIT_MASK_EARLY_MODE_SEL_8821C) \ -+ << BIT_SHIFT_EARLY_MODE_SEL_8821C) -+#define BITS_EARLY_MODE_SEL_8821C \ -+ (BIT_MASK_EARLY_MODE_SEL_8821C << BIT_SHIFT_EARLY_MODE_SEL_8821C) -+#define BIT_CLEAR_EARLY_MODE_SEL_8821C(x) ((x) & (~BITS_EARLY_MODE_SEL_8821C)) -+#define BIT_GET_EARLY_MODE_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_EARLY_MODE_SEL_8821C) & \ -+ BIT_MASK_EARLY_MODE_SEL_8821C) -+#define BIT_SET_EARLY_MODE_SEL_8821C(x, v) \ -+ (BIT_CLEAR_EARLY_MODE_SEL_8821C(x) | BIT_EARLY_MODE_SEL_8821C(v)) -+ -+#define BIT_EPHY_RX50_EN_8821C BIT(11) -+ -+#define BIT_SHIFT_MSI_TIMEOUT_ID_V1_8821C 8 -+#define BIT_MASK_MSI_TIMEOUT_ID_V1_8821C 0x7 -+#define BIT_MSI_TIMEOUT_ID_V1_8821C(x) \ -+ (((x) & BIT_MASK_MSI_TIMEOUT_ID_V1_8821C) \ -+ << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8821C) -+#define BITS_MSI_TIMEOUT_ID_V1_8821C \ -+ (BIT_MASK_MSI_TIMEOUT_ID_V1_8821C << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8821C) -+#define BIT_CLEAR_MSI_TIMEOUT_ID_V1_8821C(x) \ -+ ((x) & (~BITS_MSI_TIMEOUT_ID_V1_8821C)) -+#define BIT_GET_MSI_TIMEOUT_ID_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MSI_TIMEOUT_ID_V1_8821C) & \ -+ BIT_MASK_MSI_TIMEOUT_ID_V1_8821C) -+#define BIT_SET_MSI_TIMEOUT_ID_V1_8821C(x, v) \ -+ (BIT_CLEAR_MSI_TIMEOUT_ID_V1_8821C(x) | BIT_MSI_TIMEOUT_ID_V1_8821C(v)) -+ -+#define BIT_RADDR_RD_8821C BIT(7) -+#define BIT_EN_MUL_TAG_8821C BIT(6) -+#define BIT_EN_EARLY_MODE_8821C BIT(5) -+#define BIT_L0S_LINK_OFF_8821C BIT(4) -+#define BIT_ACT_LINK_OFF_8821C BIT(3) -+#define BIT_EN_SLOW_MAC_TX_8821C BIT(2) -+#define BIT_EN_SLOW_MAC_RX_8821C BIT(1) -+ -+/* 2 REG_STC_INT_CS_8821C(PCIE STATE CHANGE INTERRUPT CONTROL AND STATUS) */ -+#define BIT_STC_INT_EN_8821C BIT(31) -+ -+#define BIT_SHIFT_STC_INT_FLAG_8821C 16 -+#define BIT_MASK_STC_INT_FLAG_8821C 0xff -+#define BIT_STC_INT_FLAG_8821C(x) \ -+ (((x) & BIT_MASK_STC_INT_FLAG_8821C) << BIT_SHIFT_STC_INT_FLAG_8821C) -+#define BITS_STC_INT_FLAG_8821C \ -+ (BIT_MASK_STC_INT_FLAG_8821C << BIT_SHIFT_STC_INT_FLAG_8821C) -+#define BIT_CLEAR_STC_INT_FLAG_8821C(x) ((x) & (~BITS_STC_INT_FLAG_8821C)) -+#define BIT_GET_STC_INT_FLAG_8821C(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_FLAG_8821C) & BIT_MASK_STC_INT_FLAG_8821C) -+#define BIT_SET_STC_INT_FLAG_8821C(x, v) \ -+ (BIT_CLEAR_STC_INT_FLAG_8821C(x) | BIT_STC_INT_FLAG_8821C(v)) -+ -+#define BIT_SHIFT_STC_INT_IDX_8821C 8 -+#define BIT_MASK_STC_INT_IDX_8821C 0x7 -+#define BIT_STC_INT_IDX_8821C(x) \ -+ (((x) & BIT_MASK_STC_INT_IDX_8821C) << BIT_SHIFT_STC_INT_IDX_8821C) -+#define BITS_STC_INT_IDX_8821C \ -+ (BIT_MASK_STC_INT_IDX_8821C << BIT_SHIFT_STC_INT_IDX_8821C) -+#define BIT_CLEAR_STC_INT_IDX_8821C(x) ((x) & (~BITS_STC_INT_IDX_8821C)) -+#define BIT_GET_STC_INT_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_IDX_8821C) & BIT_MASK_STC_INT_IDX_8821C) -+#define BIT_SET_STC_INT_IDX_8821C(x, v) \ -+ (BIT_CLEAR_STC_INT_IDX_8821C(x) | BIT_STC_INT_IDX_8821C(v)) -+ -+#define BIT_SHIFT_STC_INT_REALTIME_CS_8821C 0 -+#define BIT_MASK_STC_INT_REALTIME_CS_8821C 0x3f -+#define BIT_STC_INT_REALTIME_CS_8821C(x) \ -+ (((x) & BIT_MASK_STC_INT_REALTIME_CS_8821C) \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8821C) -+#define BITS_STC_INT_REALTIME_CS_8821C \ -+ (BIT_MASK_STC_INT_REALTIME_CS_8821C \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8821C) -+#define BIT_CLEAR_STC_INT_REALTIME_CS_8821C(x) \ -+ ((x) & (~BITS_STC_INT_REALTIME_CS_8821C)) -+#define BIT_GET_STC_INT_REALTIME_CS_8821C(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_REALTIME_CS_8821C) & \ -+ BIT_MASK_STC_INT_REALTIME_CS_8821C) -+#define BIT_SET_STC_INT_REALTIME_CS_8821C(x, v) \ -+ (BIT_CLEAR_STC_INT_REALTIME_CS_8821C(x) | \ -+ BIT_STC_INT_REALTIME_CS_8821C(v)) -+ -+/* 2 REG_ST_INT_CFG_8821C(PCIE STATE CHANGE INTERRUPT CONFIGURATION) */ -+#define BIT_STC_INT_GRP_EN_8821C BIT(31) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_LS_8821C 8 -+#define BIT_MASK_STC_INT_EXPECT_LS_8821C 0x3f -+#define BIT_STC_INT_EXPECT_LS_8821C(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_LS_8821C) \ -+ << BIT_SHIFT_STC_INT_EXPECT_LS_8821C) -+#define BITS_STC_INT_EXPECT_LS_8821C \ -+ (BIT_MASK_STC_INT_EXPECT_LS_8821C << BIT_SHIFT_STC_INT_EXPECT_LS_8821C) -+#define BIT_CLEAR_STC_INT_EXPECT_LS_8821C(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_LS_8821C)) -+#define BIT_GET_STC_INT_EXPECT_LS_8821C(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_LS_8821C) & \ -+ BIT_MASK_STC_INT_EXPECT_LS_8821C) -+#define BIT_SET_STC_INT_EXPECT_LS_8821C(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_LS_8821C(x) | BIT_STC_INT_EXPECT_LS_8821C(v)) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_CS_8821C 0 -+#define BIT_MASK_STC_INT_EXPECT_CS_8821C 0x3f -+#define BIT_STC_INT_EXPECT_CS_8821C(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_CS_8821C) \ -+ << BIT_SHIFT_STC_INT_EXPECT_CS_8821C) -+#define BITS_STC_INT_EXPECT_CS_8821C \ -+ (BIT_MASK_STC_INT_EXPECT_CS_8821C << BIT_SHIFT_STC_INT_EXPECT_CS_8821C) -+#define BIT_CLEAR_STC_INT_EXPECT_CS_8821C(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_CS_8821C)) -+#define BIT_GET_STC_INT_EXPECT_CS_8821C(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_CS_8821C) & \ -+ BIT_MASK_STC_INT_EXPECT_CS_8821C) -+#define BIT_SET_STC_INT_EXPECT_CS_8821C(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_CS_8821C(x) | BIT_STC_INT_EXPECT_CS_8821C(v)) -+ -+/* 2 REG_CMU_DLY_CTRL_8821C(PCIE PHY CLOCK MGT UNIT DELAY CONTROL ) */ -+#define BIT_CMU_DLY_EN_8821C BIT(31) -+#define BIT_CMU_DLY_MODE_8821C BIT(30) -+ -+#define BIT_SHIFT_CMU_DLY_PRE_DIV_8821C 0 -+#define BIT_MASK_CMU_DLY_PRE_DIV_8821C 0xff -+#define BIT_CMU_DLY_PRE_DIV_8821C(x) \ -+ (((x) & BIT_MASK_CMU_DLY_PRE_DIV_8821C) \ -+ << BIT_SHIFT_CMU_DLY_PRE_DIV_8821C) -+#define BITS_CMU_DLY_PRE_DIV_8821C \ -+ (BIT_MASK_CMU_DLY_PRE_DIV_8821C << BIT_SHIFT_CMU_DLY_PRE_DIV_8821C) -+#define BIT_CLEAR_CMU_DLY_PRE_DIV_8821C(x) ((x) & (~BITS_CMU_DLY_PRE_DIV_8821C)) -+#define BIT_GET_CMU_DLY_PRE_DIV_8821C(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_PRE_DIV_8821C) & \ -+ BIT_MASK_CMU_DLY_PRE_DIV_8821C) -+#define BIT_SET_CMU_DLY_PRE_DIV_8821C(x, v) \ -+ (BIT_CLEAR_CMU_DLY_PRE_DIV_8821C(x) | BIT_CMU_DLY_PRE_DIV_8821C(v)) -+ -+/* 2 REG_CMU_DLY_CFG_8821C(PCIE PHY CLOCK MGT UNIT DELAY CONFIGURATION ) */ -+ -+#define BIT_SHIFT_CMU_DLY_LTR_A2I_8821C 24 -+#define BIT_MASK_CMU_DLY_LTR_A2I_8821C 0xff -+#define BIT_CMU_DLY_LTR_A2I_8821C(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_A2I_8821C) \ -+ << BIT_SHIFT_CMU_DLY_LTR_A2I_8821C) -+#define BITS_CMU_DLY_LTR_A2I_8821C \ -+ (BIT_MASK_CMU_DLY_LTR_A2I_8821C << BIT_SHIFT_CMU_DLY_LTR_A2I_8821C) -+#define BIT_CLEAR_CMU_DLY_LTR_A2I_8821C(x) ((x) & (~BITS_CMU_DLY_LTR_A2I_8821C)) -+#define BIT_GET_CMU_DLY_LTR_A2I_8821C(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_A2I_8821C) & \ -+ BIT_MASK_CMU_DLY_LTR_A2I_8821C) -+#define BIT_SET_CMU_DLY_LTR_A2I_8821C(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_A2I_8821C(x) | BIT_CMU_DLY_LTR_A2I_8821C(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_I2A_8821C 16 -+#define BIT_MASK_CMU_DLY_LTR_I2A_8821C 0xff -+#define BIT_CMU_DLY_LTR_I2A_8821C(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_I2A_8821C) \ -+ << BIT_SHIFT_CMU_DLY_LTR_I2A_8821C) -+#define BITS_CMU_DLY_LTR_I2A_8821C \ -+ (BIT_MASK_CMU_DLY_LTR_I2A_8821C << BIT_SHIFT_CMU_DLY_LTR_I2A_8821C) -+#define BIT_CLEAR_CMU_DLY_LTR_I2A_8821C(x) ((x) & (~BITS_CMU_DLY_LTR_I2A_8821C)) -+#define BIT_GET_CMU_DLY_LTR_I2A_8821C(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_I2A_8821C) & \ -+ BIT_MASK_CMU_DLY_LTR_I2A_8821C) -+#define BIT_SET_CMU_DLY_LTR_I2A_8821C(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_I2A_8821C(x) | BIT_CMU_DLY_LTR_I2A_8821C(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_IDLE_8821C 8 -+#define BIT_MASK_CMU_DLY_LTR_IDLE_8821C 0xff -+#define BIT_CMU_DLY_LTR_IDLE_8821C(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_IDLE_8821C) \ -+ << BIT_SHIFT_CMU_DLY_LTR_IDLE_8821C) -+#define BITS_CMU_DLY_LTR_IDLE_8821C \ -+ (BIT_MASK_CMU_DLY_LTR_IDLE_8821C << BIT_SHIFT_CMU_DLY_LTR_IDLE_8821C) -+#define BIT_CLEAR_CMU_DLY_LTR_IDLE_8821C(x) \ -+ ((x) & (~BITS_CMU_DLY_LTR_IDLE_8821C)) -+#define BIT_GET_CMU_DLY_LTR_IDLE_8821C(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_IDLE_8821C) & \ -+ BIT_MASK_CMU_DLY_LTR_IDLE_8821C) -+#define BIT_SET_CMU_DLY_LTR_IDLE_8821C(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_IDLE_8821C(x) | BIT_CMU_DLY_LTR_IDLE_8821C(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_ACT_8821C 0 -+#define BIT_MASK_CMU_DLY_LTR_ACT_8821C 0xff -+#define BIT_CMU_DLY_LTR_ACT_8821C(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_ACT_8821C) \ -+ << BIT_SHIFT_CMU_DLY_LTR_ACT_8821C) -+#define BITS_CMU_DLY_LTR_ACT_8821C \ -+ (BIT_MASK_CMU_DLY_LTR_ACT_8821C << BIT_SHIFT_CMU_DLY_LTR_ACT_8821C) -+#define BIT_CLEAR_CMU_DLY_LTR_ACT_8821C(x) ((x) & (~BITS_CMU_DLY_LTR_ACT_8821C)) -+#define BIT_GET_CMU_DLY_LTR_ACT_8821C(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_ACT_8821C) & \ -+ BIT_MASK_CMU_DLY_LTR_ACT_8821C) -+#define BIT_SET_CMU_DLY_LTR_ACT_8821C(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_ACT_8821C(x) | BIT_CMU_DLY_LTR_ACT_8821C(v)) -+ -+/* 2 REG_H2CQ_TXBD_DESA_8821C */ -+ -+#define BIT_SHIFT_H2CQ_TXBD_DESA_8821C 0 -+#define BIT_MASK_H2CQ_TXBD_DESA_8821C 0xffffffffffffffffL -+#define BIT_H2CQ_TXBD_DESA_8821C(x) \ -+ (((x) & BIT_MASK_H2CQ_TXBD_DESA_8821C) \ -+ << BIT_SHIFT_H2CQ_TXBD_DESA_8821C) -+#define BITS_H2CQ_TXBD_DESA_8821C \ -+ (BIT_MASK_H2CQ_TXBD_DESA_8821C << BIT_SHIFT_H2CQ_TXBD_DESA_8821C) -+#define BIT_CLEAR_H2CQ_TXBD_DESA_8821C(x) ((x) & (~BITS_H2CQ_TXBD_DESA_8821C)) -+#define BIT_GET_H2CQ_TXBD_DESA_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_TXBD_DESA_8821C) & \ -+ BIT_MASK_H2CQ_TXBD_DESA_8821C) -+#define BIT_SET_H2CQ_TXBD_DESA_8821C(x, v) \ -+ (BIT_CLEAR_H2CQ_TXBD_DESA_8821C(x) | BIT_H2CQ_TXBD_DESA_8821C(v)) -+ -+/* 2 REG_H2CQ_TXBD_NUM_8821C */ -+#define BIT_PCIE_H2CQ_FLAG_8821C BIT(14) -+ -+#define BIT_SHIFT_H2CQ_DESC_MODE_8821C 12 -+#define BIT_MASK_H2CQ_DESC_MODE_8821C 0x3 -+#define BIT_H2CQ_DESC_MODE_8821C(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_MODE_8821C) \ -+ << BIT_SHIFT_H2CQ_DESC_MODE_8821C) -+#define BITS_H2CQ_DESC_MODE_8821C \ -+ (BIT_MASK_H2CQ_DESC_MODE_8821C << BIT_SHIFT_H2CQ_DESC_MODE_8821C) -+#define BIT_CLEAR_H2CQ_DESC_MODE_8821C(x) ((x) & (~BITS_H2CQ_DESC_MODE_8821C)) -+#define BIT_GET_H2CQ_DESC_MODE_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_MODE_8821C) & \ -+ BIT_MASK_H2CQ_DESC_MODE_8821C) -+#define BIT_SET_H2CQ_DESC_MODE_8821C(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_MODE_8821C(x) | BIT_H2CQ_DESC_MODE_8821C(v)) -+ -+#define BIT_SHIFT_H2CQ_DESC_NUM_8821C 0 -+#define BIT_MASK_H2CQ_DESC_NUM_8821C 0xfff -+#define BIT_H2CQ_DESC_NUM_8821C(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_NUM_8821C) << BIT_SHIFT_H2CQ_DESC_NUM_8821C) -+#define BITS_H2CQ_DESC_NUM_8821C \ -+ (BIT_MASK_H2CQ_DESC_NUM_8821C << BIT_SHIFT_H2CQ_DESC_NUM_8821C) -+#define BIT_CLEAR_H2CQ_DESC_NUM_8821C(x) ((x) & (~BITS_H2CQ_DESC_NUM_8821C)) -+#define BIT_GET_H2CQ_DESC_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_NUM_8821C) & BIT_MASK_H2CQ_DESC_NUM_8821C) -+#define BIT_SET_H2CQ_DESC_NUM_8821C(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_NUM_8821C(x) | BIT_H2CQ_DESC_NUM_8821C(v)) -+ -+/* 2 REG_H2CQ_TXBD_IDX_8821C */ -+ -+#define BIT_SHIFT_H2CQ_HW_IDX_8821C 16 -+#define BIT_MASK_H2CQ_HW_IDX_8821C 0xfff -+#define BIT_H2CQ_HW_IDX_8821C(x) \ -+ (((x) & BIT_MASK_H2CQ_HW_IDX_8821C) << BIT_SHIFT_H2CQ_HW_IDX_8821C) -+#define BITS_H2CQ_HW_IDX_8821C \ -+ (BIT_MASK_H2CQ_HW_IDX_8821C << BIT_SHIFT_H2CQ_HW_IDX_8821C) -+#define BIT_CLEAR_H2CQ_HW_IDX_8821C(x) ((x) & (~BITS_H2CQ_HW_IDX_8821C)) -+#define BIT_GET_H2CQ_HW_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HW_IDX_8821C) & BIT_MASK_H2CQ_HW_IDX_8821C) -+#define BIT_SET_H2CQ_HW_IDX_8821C(x, v) \ -+ (BIT_CLEAR_H2CQ_HW_IDX_8821C(x) | BIT_H2CQ_HW_IDX_8821C(v)) -+ -+#define BIT_SHIFT_H2CQ_HOST_IDX_8821C 0 -+#define BIT_MASK_H2CQ_HOST_IDX_8821C 0xfff -+#define BIT_H2CQ_HOST_IDX_8821C(x) \ -+ (((x) & BIT_MASK_H2CQ_HOST_IDX_8821C) << BIT_SHIFT_H2CQ_HOST_IDX_8821C) -+#define BITS_H2CQ_HOST_IDX_8821C \ -+ (BIT_MASK_H2CQ_HOST_IDX_8821C << BIT_SHIFT_H2CQ_HOST_IDX_8821C) -+#define BIT_CLEAR_H2CQ_HOST_IDX_8821C(x) ((x) & (~BITS_H2CQ_HOST_IDX_8821C)) -+#define BIT_GET_H2CQ_HOST_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HOST_IDX_8821C) & BIT_MASK_H2CQ_HOST_IDX_8821C) -+#define BIT_SET_H2CQ_HOST_IDX_8821C(x, v) \ -+ (BIT_CLEAR_H2CQ_HOST_IDX_8821C(x) | BIT_H2CQ_HOST_IDX_8821C(v)) -+ -+/* 2 REG_H2CQ_CSR_8821C[31:0] (H2CQ CONTROL AND STATUS) */ -+#define BIT_H2CQ_FULL_8821C BIT(31) -+#define BIT_CLR_H2CQ_HOST_IDX_8821C BIT(16) -+#define BIT_CLR_H2CQ_HW_IDX_8821C BIT(8) -+#define BIT_STOP_H2CQ_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_Q0_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q0_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_Q0_V1_8821C 0x7f -+#define BIT_QUEUEMACID_Q0_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q0_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_Q0_V1_8821C) -+#define BITS_QUEUEMACID_Q0_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_Q0_V1_8821C << BIT_SHIFT_QUEUEMACID_Q0_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_Q0_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q0_V1_8821C)) -+#define BIT_GET_QUEUEMACID_Q0_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q0_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_Q0_V1_8821C) -+#define BIT_SET_QUEUEMACID_Q0_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q0_V1_8821C(x) | BIT_QUEUEMACID_Q0_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q0_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_Q0_V1_8821C 0x3 -+#define BIT_QUEUEAC_Q0_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q0_V1_8821C) << BIT_SHIFT_QUEUEAC_Q0_V1_8821C) -+#define BITS_QUEUEAC_Q0_V1_8821C \ -+ (BIT_MASK_QUEUEAC_Q0_V1_8821C << BIT_SHIFT_QUEUEAC_Q0_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_Q0_V1_8821C(x) ((x) & (~BITS_QUEUEAC_Q0_V1_8821C)) -+#define BIT_GET_QUEUEAC_Q0_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q0_V1_8821C) & BIT_MASK_QUEUEAC_Q0_V1_8821C) -+#define BIT_SET_QUEUEAC_Q0_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q0_V1_8821C(x) | BIT_QUEUEAC_Q0_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_Q0_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q0_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_Q0_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_Q0_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q0_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_Q0_V2_8821C) -+#define BITS_TAIL_PKT_Q0_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_Q0_V2_8821C << BIT_SHIFT_TAIL_PKT_Q0_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_Q0_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_Q0_V2_8821C)) -+#define BIT_GET_TAIL_PKT_Q0_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q0_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_Q0_V2_8821C) -+#define BIT_SET_TAIL_PKT_Q0_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q0_V2_8821C(x) | BIT_TAIL_PKT_Q0_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q0_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_Q0_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_Q0_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q0_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_Q0_V1_8821C) -+#define BITS_HEAD_PKT_Q0_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_Q0_V1_8821C << BIT_SHIFT_HEAD_PKT_Q0_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_Q0_V1_8821C(x) ((x) & (~BITS_HEAD_PKT_Q0_V1_8821C)) -+#define BIT_GET_HEAD_PKT_Q0_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q0_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_Q0_V1_8821C) -+#define BIT_SET_HEAD_PKT_Q0_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q0_V1_8821C(x) | BIT_HEAD_PKT_Q0_V1_8821C(v)) -+ -+/* 2 REG_Q1_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q1_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_Q1_V1_8821C 0x7f -+#define BIT_QUEUEMACID_Q1_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q1_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_Q1_V1_8821C) -+#define BITS_QUEUEMACID_Q1_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_Q1_V1_8821C << BIT_SHIFT_QUEUEMACID_Q1_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_Q1_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q1_V1_8821C)) -+#define BIT_GET_QUEUEMACID_Q1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q1_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_Q1_V1_8821C) -+#define BIT_SET_QUEUEMACID_Q1_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q1_V1_8821C(x) | BIT_QUEUEMACID_Q1_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q1_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_Q1_V1_8821C 0x3 -+#define BIT_QUEUEAC_Q1_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q1_V1_8821C) << BIT_SHIFT_QUEUEAC_Q1_V1_8821C) -+#define BITS_QUEUEAC_Q1_V1_8821C \ -+ (BIT_MASK_QUEUEAC_Q1_V1_8821C << BIT_SHIFT_QUEUEAC_Q1_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_Q1_V1_8821C(x) ((x) & (~BITS_QUEUEAC_Q1_V1_8821C)) -+#define BIT_GET_QUEUEAC_Q1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q1_V1_8821C) & BIT_MASK_QUEUEAC_Q1_V1_8821C) -+#define BIT_SET_QUEUEAC_Q1_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q1_V1_8821C(x) | BIT_QUEUEAC_Q1_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_Q1_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q1_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_Q1_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_Q1_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q1_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_Q1_V2_8821C) -+#define BITS_TAIL_PKT_Q1_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_Q1_V2_8821C << BIT_SHIFT_TAIL_PKT_Q1_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_Q1_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_Q1_V2_8821C)) -+#define BIT_GET_TAIL_PKT_Q1_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q1_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_Q1_V2_8821C) -+#define BIT_SET_TAIL_PKT_Q1_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q1_V2_8821C(x) | BIT_TAIL_PKT_Q1_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q1_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_Q1_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_Q1_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q1_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_Q1_V1_8821C) -+#define BITS_HEAD_PKT_Q1_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_Q1_V1_8821C << BIT_SHIFT_HEAD_PKT_Q1_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_Q1_V1_8821C(x) ((x) & (~BITS_HEAD_PKT_Q1_V1_8821C)) -+#define BIT_GET_HEAD_PKT_Q1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q1_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_Q1_V1_8821C) -+#define BIT_SET_HEAD_PKT_Q1_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q1_V1_8821C(x) | BIT_HEAD_PKT_Q1_V1_8821C(v)) -+ -+/* 2 REG_Q2_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q2_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_Q2_V1_8821C 0x7f -+#define BIT_QUEUEMACID_Q2_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q2_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_Q2_V1_8821C) -+#define BITS_QUEUEMACID_Q2_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_Q2_V1_8821C << BIT_SHIFT_QUEUEMACID_Q2_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_Q2_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q2_V1_8821C)) -+#define BIT_GET_QUEUEMACID_Q2_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q2_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_Q2_V1_8821C) -+#define BIT_SET_QUEUEMACID_Q2_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q2_V1_8821C(x) | BIT_QUEUEMACID_Q2_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q2_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_Q2_V1_8821C 0x3 -+#define BIT_QUEUEAC_Q2_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q2_V1_8821C) << BIT_SHIFT_QUEUEAC_Q2_V1_8821C) -+#define BITS_QUEUEAC_Q2_V1_8821C \ -+ (BIT_MASK_QUEUEAC_Q2_V1_8821C << BIT_SHIFT_QUEUEAC_Q2_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_Q2_V1_8821C(x) ((x) & (~BITS_QUEUEAC_Q2_V1_8821C)) -+#define BIT_GET_QUEUEAC_Q2_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q2_V1_8821C) & BIT_MASK_QUEUEAC_Q2_V1_8821C) -+#define BIT_SET_QUEUEAC_Q2_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q2_V1_8821C(x) | BIT_QUEUEAC_Q2_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_Q2_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q2_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_Q2_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_Q2_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q2_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_Q2_V2_8821C) -+#define BITS_TAIL_PKT_Q2_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_Q2_V2_8821C << BIT_SHIFT_TAIL_PKT_Q2_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_Q2_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_Q2_V2_8821C)) -+#define BIT_GET_TAIL_PKT_Q2_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q2_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_Q2_V2_8821C) -+#define BIT_SET_TAIL_PKT_Q2_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q2_V2_8821C(x) | BIT_TAIL_PKT_Q2_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q2_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_Q2_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_Q2_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q2_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_Q2_V1_8821C) -+#define BITS_HEAD_PKT_Q2_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_Q2_V1_8821C << BIT_SHIFT_HEAD_PKT_Q2_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_Q2_V1_8821C(x) ((x) & (~BITS_HEAD_PKT_Q2_V1_8821C)) -+#define BIT_GET_HEAD_PKT_Q2_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q2_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_Q2_V1_8821C) -+#define BIT_SET_HEAD_PKT_Q2_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q2_V1_8821C(x) | BIT_HEAD_PKT_Q2_V1_8821C(v)) -+ -+/* 2 REG_Q3_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q3_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_Q3_V1_8821C 0x7f -+#define BIT_QUEUEMACID_Q3_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q3_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_Q3_V1_8821C) -+#define BITS_QUEUEMACID_Q3_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_Q3_V1_8821C << BIT_SHIFT_QUEUEMACID_Q3_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_Q3_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q3_V1_8821C)) -+#define BIT_GET_QUEUEMACID_Q3_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q3_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_Q3_V1_8821C) -+#define BIT_SET_QUEUEMACID_Q3_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q3_V1_8821C(x) | BIT_QUEUEMACID_Q3_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q3_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_Q3_V1_8821C 0x3 -+#define BIT_QUEUEAC_Q3_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q3_V1_8821C) << BIT_SHIFT_QUEUEAC_Q3_V1_8821C) -+#define BITS_QUEUEAC_Q3_V1_8821C \ -+ (BIT_MASK_QUEUEAC_Q3_V1_8821C << BIT_SHIFT_QUEUEAC_Q3_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_Q3_V1_8821C(x) ((x) & (~BITS_QUEUEAC_Q3_V1_8821C)) -+#define BIT_GET_QUEUEAC_Q3_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q3_V1_8821C) & BIT_MASK_QUEUEAC_Q3_V1_8821C) -+#define BIT_SET_QUEUEAC_Q3_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q3_V1_8821C(x) | BIT_QUEUEAC_Q3_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_Q3_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q3_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_Q3_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_Q3_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q3_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_Q3_V2_8821C) -+#define BITS_TAIL_PKT_Q3_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_Q3_V2_8821C << BIT_SHIFT_TAIL_PKT_Q3_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_Q3_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_Q3_V2_8821C)) -+#define BIT_GET_TAIL_PKT_Q3_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q3_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_Q3_V2_8821C) -+#define BIT_SET_TAIL_PKT_Q3_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q3_V2_8821C(x) | BIT_TAIL_PKT_Q3_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q3_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_Q3_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_Q3_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q3_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_Q3_V1_8821C) -+#define BITS_HEAD_PKT_Q3_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_Q3_V1_8821C << BIT_SHIFT_HEAD_PKT_Q3_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_Q3_V1_8821C(x) ((x) & (~BITS_HEAD_PKT_Q3_V1_8821C)) -+#define BIT_GET_HEAD_PKT_Q3_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q3_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_Q3_V1_8821C) -+#define BIT_SET_HEAD_PKT_Q3_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q3_V1_8821C(x) | BIT_HEAD_PKT_Q3_V1_8821C(v)) -+ -+/* 2 REG_MGQ_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_MGQ_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_MGQ_V1_8821C 0x7f -+#define BIT_QUEUEMACID_MGQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_MGQ_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_MGQ_V1_8821C) -+#define BITS_QUEUEMACID_MGQ_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_MGQ_V1_8821C << BIT_SHIFT_QUEUEMACID_MGQ_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_MGQ_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_MGQ_V1_8821C)) -+#define BIT_GET_QUEUEMACID_MGQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_MGQ_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_MGQ_V1_8821C) -+#define BIT_SET_QUEUEMACID_MGQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_MGQ_V1_8821C(x) | BIT_QUEUEMACID_MGQ_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_MGQ_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_MGQ_V1_8821C 0x3 -+#define BIT_QUEUEAC_MGQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_MGQ_V1_8821C) \ -+ << BIT_SHIFT_QUEUEAC_MGQ_V1_8821C) -+#define BITS_QUEUEAC_MGQ_V1_8821C \ -+ (BIT_MASK_QUEUEAC_MGQ_V1_8821C << BIT_SHIFT_QUEUEAC_MGQ_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_MGQ_V1_8821C(x) ((x) & (~BITS_QUEUEAC_MGQ_V1_8821C)) -+#define BIT_GET_QUEUEAC_MGQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_MGQ_V1_8821C) & \ -+ BIT_MASK_QUEUEAC_MGQ_V1_8821C) -+#define BIT_SET_QUEUEAC_MGQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_MGQ_V1_8821C(x) | BIT_QUEUEAC_MGQ_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_MGQ_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_MGQ_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_MGQ_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_MGQ_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_MGQ_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_MGQ_V2_8821C) -+#define BITS_TAIL_PKT_MGQ_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_MGQ_V2_8821C << BIT_SHIFT_TAIL_PKT_MGQ_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_MGQ_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_MGQ_V2_8821C)) -+#define BIT_GET_TAIL_PKT_MGQ_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_MGQ_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_MGQ_V2_8821C) -+#define BIT_SET_TAIL_PKT_MGQ_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_MGQ_V2_8821C(x) | BIT_TAIL_PKT_MGQ_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_MGQ_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_MGQ_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_MGQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_MGQ_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_MGQ_V1_8821C) -+#define BITS_HEAD_PKT_MGQ_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_MGQ_V1_8821C << BIT_SHIFT_HEAD_PKT_MGQ_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_MGQ_V1_8821C(x) ((x) & (~BITS_HEAD_PKT_MGQ_V1_8821C)) -+#define BIT_GET_HEAD_PKT_MGQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_MGQ_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_MGQ_V1_8821C) -+#define BIT_SET_HEAD_PKT_MGQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_MGQ_V1_8821C(x) | BIT_HEAD_PKT_MGQ_V1_8821C(v)) -+ -+/* 2 REG_HIQ_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_HIQ_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_HIQ_V1_8821C 0x7f -+#define BIT_QUEUEMACID_HIQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_HIQ_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_HIQ_V1_8821C) -+#define BITS_QUEUEMACID_HIQ_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_HIQ_V1_8821C << BIT_SHIFT_QUEUEMACID_HIQ_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_HIQ_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_HIQ_V1_8821C)) -+#define BIT_GET_QUEUEMACID_HIQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_HIQ_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_HIQ_V1_8821C) -+#define BIT_SET_QUEUEMACID_HIQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_HIQ_V1_8821C(x) | BIT_QUEUEMACID_HIQ_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_HIQ_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_HIQ_V1_8821C 0x3 -+#define BIT_QUEUEAC_HIQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_HIQ_V1_8821C) \ -+ << BIT_SHIFT_QUEUEAC_HIQ_V1_8821C) -+#define BITS_QUEUEAC_HIQ_V1_8821C \ -+ (BIT_MASK_QUEUEAC_HIQ_V1_8821C << BIT_SHIFT_QUEUEAC_HIQ_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_HIQ_V1_8821C(x) ((x) & (~BITS_QUEUEAC_HIQ_V1_8821C)) -+#define BIT_GET_QUEUEAC_HIQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_HIQ_V1_8821C) & \ -+ BIT_MASK_QUEUEAC_HIQ_V1_8821C) -+#define BIT_SET_QUEUEAC_HIQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_HIQ_V1_8821C(x) | BIT_QUEUEAC_HIQ_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_HIQ_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_HIQ_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_HIQ_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_HIQ_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_HIQ_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_HIQ_V2_8821C) -+#define BITS_TAIL_PKT_HIQ_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_HIQ_V2_8821C << BIT_SHIFT_TAIL_PKT_HIQ_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_HIQ_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_HIQ_V2_8821C)) -+#define BIT_GET_TAIL_PKT_HIQ_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_HIQ_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_HIQ_V2_8821C) -+#define BIT_SET_TAIL_PKT_HIQ_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_HIQ_V2_8821C(x) | BIT_TAIL_PKT_HIQ_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_HIQ_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_HIQ_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_HIQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_HIQ_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_HIQ_V1_8821C) -+#define BITS_HEAD_PKT_HIQ_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_HIQ_V1_8821C << BIT_SHIFT_HEAD_PKT_HIQ_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_HIQ_V1_8821C(x) ((x) & (~BITS_HEAD_PKT_HIQ_V1_8821C)) -+#define BIT_GET_HEAD_PKT_HIQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_HIQ_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_HIQ_V1_8821C) -+#define BIT_SET_HEAD_PKT_HIQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_HIQ_V1_8821C(x) | BIT_HEAD_PKT_HIQ_V1_8821C(v)) -+ -+/* 2 REG_BCNQ_INFO_8821C */ -+ -+#define BIT_SHIFT_BCNQ_HEAD_PG_V1_8821C 0 -+#define BIT_MASK_BCNQ_HEAD_PG_V1_8821C 0xfff -+#define BIT_BCNQ_HEAD_PG_V1_8821C(x) \ -+ (((x) & BIT_MASK_BCNQ_HEAD_PG_V1_8821C) \ -+ << BIT_SHIFT_BCNQ_HEAD_PG_V1_8821C) -+#define BITS_BCNQ_HEAD_PG_V1_8821C \ -+ (BIT_MASK_BCNQ_HEAD_PG_V1_8821C << BIT_SHIFT_BCNQ_HEAD_PG_V1_8821C) -+#define BIT_CLEAR_BCNQ_HEAD_PG_V1_8821C(x) ((x) & (~BITS_BCNQ_HEAD_PG_V1_8821C)) -+#define BIT_GET_BCNQ_HEAD_PG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_HEAD_PG_V1_8821C) & \ -+ BIT_MASK_BCNQ_HEAD_PG_V1_8821C) -+#define BIT_SET_BCNQ_HEAD_PG_V1_8821C(x, v) \ -+ (BIT_CLEAR_BCNQ_HEAD_PG_V1_8821C(x) | BIT_BCNQ_HEAD_PG_V1_8821C(v)) -+ -+/* 2 REG_TXPKT_EMPTY_8821C */ -+#define BIT_BCNQ_EMPTY_8821C BIT(11) -+#define BIT_HQQ_EMPTY_8821C BIT(10) -+#define BIT_MQQ_EMPTY_8821C BIT(9) -+#define BIT_MGQ_CPU_EMPTY_8821C BIT(8) -+#define BIT_AC7Q_EMPTY_8821C BIT(7) -+#define BIT_AC6Q_EMPTY_8821C BIT(6) -+#define BIT_AC5Q_EMPTY_8821C BIT(5) -+#define BIT_AC4Q_EMPTY_8821C BIT(4) -+#define BIT_AC3Q_EMPTY_8821C BIT(3) -+#define BIT_AC2Q_EMPTY_8821C BIT(2) -+#define BIT_AC1Q_EMPTY_8821C BIT(1) -+#define BIT_AC0Q_EMPTY_8821C BIT(0) -+ -+/* 2 REG_CPU_MGQ_INFO_8821C */ -+#define BIT_BCN1_POLL_8821C BIT(30) -+#define BIT_CPUMGT_POLL_8821C BIT(29) -+#define BIT_BCN_POLL_8821C BIT(28) -+#define BIT_CPUMGQ_FW_NUM_V1_8821C BIT(12) -+ -+#define BIT_SHIFT_FW_FREE_TAIL_V1_8821C 0 -+#define BIT_MASK_FW_FREE_TAIL_V1_8821C 0xfff -+#define BIT_FW_FREE_TAIL_V1_8821C(x) \ -+ (((x) & BIT_MASK_FW_FREE_TAIL_V1_8821C) \ -+ << BIT_SHIFT_FW_FREE_TAIL_V1_8821C) -+#define BITS_FW_FREE_TAIL_V1_8821C \ -+ (BIT_MASK_FW_FREE_TAIL_V1_8821C << BIT_SHIFT_FW_FREE_TAIL_V1_8821C) -+#define BIT_CLEAR_FW_FREE_TAIL_V1_8821C(x) ((x) & (~BITS_FW_FREE_TAIL_V1_8821C)) -+#define BIT_GET_FW_FREE_TAIL_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_FW_FREE_TAIL_V1_8821C) & \ -+ BIT_MASK_FW_FREE_TAIL_V1_8821C) -+#define BIT_SET_FW_FREE_TAIL_V1_8821C(x, v) \ -+ (BIT_CLEAR_FW_FREE_TAIL_V1_8821C(x) | BIT_FW_FREE_TAIL_V1_8821C(v)) -+ -+/* 2 REG_FWHW_TXQ_CTRL_8821C */ -+#define BIT_RTS_LIMIT_IN_OFDM_8821C BIT(23) -+#define BIT_EN_BCNQ_DL_8821C BIT(22) -+#define BIT_EN_RD_RESP_NAV_BK_8821C BIT(21) -+#define BIT_EN_WR_FREE_TAIL_8821C BIT(20) -+ -+#define BIT_SHIFT_EN_QUEUE_RPT_8821C 8 -+#define BIT_MASK_EN_QUEUE_RPT_8821C 0xff -+#define BIT_EN_QUEUE_RPT_8821C(x) \ -+ (((x) & BIT_MASK_EN_QUEUE_RPT_8821C) << BIT_SHIFT_EN_QUEUE_RPT_8821C) -+#define BITS_EN_QUEUE_RPT_8821C \ -+ (BIT_MASK_EN_QUEUE_RPT_8821C << BIT_SHIFT_EN_QUEUE_RPT_8821C) -+#define BIT_CLEAR_EN_QUEUE_RPT_8821C(x) ((x) & (~BITS_EN_QUEUE_RPT_8821C)) -+#define BIT_GET_EN_QUEUE_RPT_8821C(x) \ -+ (((x) >> BIT_SHIFT_EN_QUEUE_RPT_8821C) & BIT_MASK_EN_QUEUE_RPT_8821C) -+#define BIT_SET_EN_QUEUE_RPT_8821C(x, v) \ -+ (BIT_CLEAR_EN_QUEUE_RPT_8821C(x) | BIT_EN_QUEUE_RPT_8821C(v)) -+ -+#define BIT_EN_RTY_BK_8821C BIT(7) -+#define BIT_EN_USE_INI_RAT_8821C BIT(6) -+#define BIT_EN_RTS_NAV_BK_8821C BIT(5) -+#define BIT_DIS_SSN_CHECK_8821C BIT(4) -+#define BIT_MACID_MATCH_RTS_8821C BIT(3) -+#define BIT_EN_BCN_TRXRPT_V1_8821C BIT(2) -+#define BIT_R_EN_FTMRPT_V1_8821C BIT(1) -+#define BIT_R_BMC_NAV_PROTECT_8821C BIT(0) -+ -+/* 2 REG_DATAFB_SEL_8821C */ -+#define BIT_BROADCAST_RTY_EN_8821C BIT(3) -+#define BIT_EN_RTY_BK_COD_8821C BIT(2) -+ -+#define BIT_SHIFT__R_DATA_FALLBACK_SEL_8821C 0 -+#define BIT_MASK__R_DATA_FALLBACK_SEL_8821C 0x3 -+#define BIT__R_DATA_FALLBACK_SEL_8821C(x) \ -+ (((x) & BIT_MASK__R_DATA_FALLBACK_SEL_8821C) \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL_8821C) -+#define BITS__R_DATA_FALLBACK_SEL_8821C \ -+ (BIT_MASK__R_DATA_FALLBACK_SEL_8821C \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL_8821C) -+#define BIT_CLEAR__R_DATA_FALLBACK_SEL_8821C(x) \ -+ ((x) & (~BITS__R_DATA_FALLBACK_SEL_8821C)) -+#define BIT_GET__R_DATA_FALLBACK_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT__R_DATA_FALLBACK_SEL_8821C) & \ -+ BIT_MASK__R_DATA_FALLBACK_SEL_8821C) -+#define BIT_SET__R_DATA_FALLBACK_SEL_8821C(x, v) \ -+ (BIT_CLEAR__R_DATA_FALLBACK_SEL_8821C(x) | \ -+ BIT__R_DATA_FALLBACK_SEL_8821C(v)) -+ -+/* 2 REG_BCNQ_BDNY_V1_8821C */ -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_V1_8821C 0 -+#define BIT_MASK_BCNQ_PGBNDY_V1_8821C 0xfff -+#define BIT_BCNQ_PGBNDY_V1_8821C(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_V1_8821C) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_V1_8821C) -+#define BITS_BCNQ_PGBNDY_V1_8821C \ -+ (BIT_MASK_BCNQ_PGBNDY_V1_8821C << BIT_SHIFT_BCNQ_PGBNDY_V1_8821C) -+#define BIT_CLEAR_BCNQ_PGBNDY_V1_8821C(x) ((x) & (~BITS_BCNQ_PGBNDY_V1_8821C)) -+#define BIT_GET_BCNQ_PGBNDY_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_V1_8821C) & \ -+ BIT_MASK_BCNQ_PGBNDY_V1_8821C) -+#define BIT_SET_BCNQ_PGBNDY_V1_8821C(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_V1_8821C(x) | BIT_BCNQ_PGBNDY_V1_8821C(v)) -+ -+/* 2 REG_LIFETIME_EN_8821C */ -+#define BIT_BT_INT_CPU_8821C BIT(7) -+#define BIT_BT_INT_PTA_8821C BIT(6) -+#define BIT_EN_CTRL_RTYBIT_8821C BIT(4) -+#define BIT_LIFETIME_BK_EN_8821C BIT(3) -+#define BIT_LIFETIME_BE_EN_8821C BIT(2) -+#define BIT_LIFETIME_VI_EN_8821C BIT(1) -+#define BIT_LIFETIME_VO_EN_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_SPEC_SIFS_8821C */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8821C 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_PTCL_8821C 0xff -+#define BIT_SPEC_SIFS_OFDM_PTCL_8821C(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_PTCL_8821C) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8821C) -+#define BITS_SPEC_SIFS_OFDM_PTCL_8821C \ -+ (BIT_MASK_SPEC_SIFS_OFDM_PTCL_8821C \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8821C) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8821C(x) \ -+ ((x) & (~BITS_SPEC_SIFS_OFDM_PTCL_8821C)) -+#define BIT_GET_SPEC_SIFS_OFDM_PTCL_8821C(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8821C) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_PTCL_8821C) -+#define BIT_SET_SPEC_SIFS_OFDM_PTCL_8821C(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8821C(x) | \ -+ BIT_SPEC_SIFS_OFDM_PTCL_8821C(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8821C 0 -+#define BIT_MASK_SPEC_SIFS_CCK_PTCL_8821C 0xff -+#define BIT_SPEC_SIFS_CCK_PTCL_8821C(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_PTCL_8821C) \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8821C) -+#define BITS_SPEC_SIFS_CCK_PTCL_8821C \ -+ (BIT_MASK_SPEC_SIFS_CCK_PTCL_8821C \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8821C) -+#define BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8821C(x) \ -+ ((x) & (~BITS_SPEC_SIFS_CCK_PTCL_8821C)) -+#define BIT_GET_SPEC_SIFS_CCK_PTCL_8821C(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8821C) & \ -+ BIT_MASK_SPEC_SIFS_CCK_PTCL_8821C) -+#define BIT_SET_SPEC_SIFS_CCK_PTCL_8821C(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8821C(x) | \ -+ BIT_SPEC_SIFS_CCK_PTCL_8821C(v)) -+ -+/* 2 REG_RETRY_LIMIT_8821C */ -+ -+#define BIT_SHIFT_SRL_8821C 8 -+#define BIT_MASK_SRL_8821C 0x3f -+#define BIT_SRL_8821C(x) (((x) & BIT_MASK_SRL_8821C) << BIT_SHIFT_SRL_8821C) -+#define BITS_SRL_8821C (BIT_MASK_SRL_8821C << BIT_SHIFT_SRL_8821C) -+#define BIT_CLEAR_SRL_8821C(x) ((x) & (~BITS_SRL_8821C)) -+#define BIT_GET_SRL_8821C(x) (((x) >> BIT_SHIFT_SRL_8821C) & BIT_MASK_SRL_8821C) -+#define BIT_SET_SRL_8821C(x, v) (BIT_CLEAR_SRL_8821C(x) | BIT_SRL_8821C(v)) -+ -+#define BIT_SHIFT_LRL_8821C 0 -+#define BIT_MASK_LRL_8821C 0x3f -+#define BIT_LRL_8821C(x) (((x) & BIT_MASK_LRL_8821C) << BIT_SHIFT_LRL_8821C) -+#define BITS_LRL_8821C (BIT_MASK_LRL_8821C << BIT_SHIFT_LRL_8821C) -+#define BIT_CLEAR_LRL_8821C(x) ((x) & (~BITS_LRL_8821C)) -+#define BIT_GET_LRL_8821C(x) (((x) >> BIT_SHIFT_LRL_8821C) & BIT_MASK_LRL_8821C) -+#define BIT_SET_LRL_8821C(x, v) (BIT_CLEAR_LRL_8821C(x) | BIT_LRL_8821C(v)) -+ -+/* 2 REG_TXBF_CTRL_8821C */ -+#define BIT_R_ENABLE_NDPA_8821C BIT(31) -+#define BIT_USE_NDPA_PARAMETER_8821C BIT(30) -+#define BIT_R_PROP_TXBF_8821C BIT(29) -+#define BIT_R_EN_NDPA_INT_8821C BIT(28) -+#define BIT_R_TXBF1_80M_8821C BIT(27) -+#define BIT_R_TXBF1_40M_8821C BIT(26) -+#define BIT_R_TXBF1_20M_8821C BIT(25) -+ -+#define BIT_SHIFT_R_TXBF1_AID_8821C 16 -+#define BIT_MASK_R_TXBF1_AID_8821C 0x1ff -+#define BIT_R_TXBF1_AID_8821C(x) \ -+ (((x) & BIT_MASK_R_TXBF1_AID_8821C) << BIT_SHIFT_R_TXBF1_AID_8821C) -+#define BITS_R_TXBF1_AID_8821C \ -+ (BIT_MASK_R_TXBF1_AID_8821C << BIT_SHIFT_R_TXBF1_AID_8821C) -+#define BIT_CLEAR_R_TXBF1_AID_8821C(x) ((x) & (~BITS_R_TXBF1_AID_8821C)) -+#define BIT_GET_R_TXBF1_AID_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF1_AID_8821C) & BIT_MASK_R_TXBF1_AID_8821C) -+#define BIT_SET_R_TXBF1_AID_8821C(x, v) \ -+ (BIT_CLEAR_R_TXBF1_AID_8821C(x) | BIT_R_TXBF1_AID_8821C(v)) -+ -+#define BIT_DIS_NDP_BFEN_8821C BIT(15) -+#define BIT_R_TXBCN_NOBLOCK_NDP_8821C BIT(14) -+#define BIT_R_TXBF0_80M_8821C BIT(11) -+#define BIT_R_TXBF0_40M_8821C BIT(10) -+#define BIT_R_TXBF0_20M_8821C BIT(9) -+ -+#define BIT_SHIFT_R_TXBF0_AID_8821C 0 -+#define BIT_MASK_R_TXBF0_AID_8821C 0x1ff -+#define BIT_R_TXBF0_AID_8821C(x) \ -+ (((x) & BIT_MASK_R_TXBF0_AID_8821C) << BIT_SHIFT_R_TXBF0_AID_8821C) -+#define BITS_R_TXBF0_AID_8821C \ -+ (BIT_MASK_R_TXBF0_AID_8821C << BIT_SHIFT_R_TXBF0_AID_8821C) -+#define BIT_CLEAR_R_TXBF0_AID_8821C(x) ((x) & (~BITS_R_TXBF0_AID_8821C)) -+#define BIT_GET_R_TXBF0_AID_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF0_AID_8821C) & BIT_MASK_R_TXBF0_AID_8821C) -+#define BIT_SET_R_TXBF0_AID_8821C(x, v) \ -+ (BIT_CLEAR_R_TXBF0_AID_8821C(x) | BIT_R_TXBF0_AID_8821C(v)) -+ -+/* 2 REG_DARFRC_8821C */ -+ -+#define BIT_SHIFT_DARF_RC4_8821C 24 -+#define BIT_MASK_DARF_RC4_8821C 0x1f -+#define BIT_DARF_RC4_8821C(x) \ -+ (((x) & BIT_MASK_DARF_RC4_8821C) << BIT_SHIFT_DARF_RC4_8821C) -+#define BITS_DARF_RC4_8821C \ -+ (BIT_MASK_DARF_RC4_8821C << BIT_SHIFT_DARF_RC4_8821C) -+#define BIT_CLEAR_DARF_RC4_8821C(x) ((x) & (~BITS_DARF_RC4_8821C)) -+#define BIT_GET_DARF_RC4_8821C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC4_8821C) & BIT_MASK_DARF_RC4_8821C) -+#define BIT_SET_DARF_RC4_8821C(x, v) \ -+ (BIT_CLEAR_DARF_RC4_8821C(x) | BIT_DARF_RC4_8821C(v)) -+ -+#define BIT_SHIFT_DARF_RC3_8821C 16 -+#define BIT_MASK_DARF_RC3_8821C 0x1f -+#define BIT_DARF_RC3_8821C(x) \ -+ (((x) & BIT_MASK_DARF_RC3_8821C) << BIT_SHIFT_DARF_RC3_8821C) -+#define BITS_DARF_RC3_8821C \ -+ (BIT_MASK_DARF_RC3_8821C << BIT_SHIFT_DARF_RC3_8821C) -+#define BIT_CLEAR_DARF_RC3_8821C(x) ((x) & (~BITS_DARF_RC3_8821C)) -+#define BIT_GET_DARF_RC3_8821C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC3_8821C) & BIT_MASK_DARF_RC3_8821C) -+#define BIT_SET_DARF_RC3_8821C(x, v) \ -+ (BIT_CLEAR_DARF_RC3_8821C(x) | BIT_DARF_RC3_8821C(v)) -+ -+#define BIT_SHIFT_DARF_RC2_8821C 8 -+#define BIT_MASK_DARF_RC2_8821C 0x1f -+#define BIT_DARF_RC2_8821C(x) \ -+ (((x) & BIT_MASK_DARF_RC2_8821C) << BIT_SHIFT_DARF_RC2_8821C) -+#define BITS_DARF_RC2_8821C \ -+ (BIT_MASK_DARF_RC2_8821C << BIT_SHIFT_DARF_RC2_8821C) -+#define BIT_CLEAR_DARF_RC2_8821C(x) ((x) & (~BITS_DARF_RC2_8821C)) -+#define BIT_GET_DARF_RC2_8821C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC2_8821C) & BIT_MASK_DARF_RC2_8821C) -+#define BIT_SET_DARF_RC2_8821C(x, v) \ -+ (BIT_CLEAR_DARF_RC2_8821C(x) | BIT_DARF_RC2_8821C(v)) -+ -+#define BIT_SHIFT_DARF_RC1_8821C 0 -+#define BIT_MASK_DARF_RC1_8821C 0x1f -+#define BIT_DARF_RC1_8821C(x) \ -+ (((x) & BIT_MASK_DARF_RC1_8821C) << BIT_SHIFT_DARF_RC1_8821C) -+#define BITS_DARF_RC1_8821C \ -+ (BIT_MASK_DARF_RC1_8821C << BIT_SHIFT_DARF_RC1_8821C) -+#define BIT_CLEAR_DARF_RC1_8821C(x) ((x) & (~BITS_DARF_RC1_8821C)) -+#define BIT_GET_DARF_RC1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC1_8821C) & BIT_MASK_DARF_RC1_8821C) -+#define BIT_SET_DARF_RC1_8821C(x, v) \ -+ (BIT_CLEAR_DARF_RC1_8821C(x) | BIT_DARF_RC1_8821C(v)) -+ -+/* 2 REG_DARFRCH_8821C */ -+ -+#define BIT_SHIFT_DARF_RC8_V1_8821C 24 -+#define BIT_MASK_DARF_RC8_V1_8821C 0x1f -+#define BIT_DARF_RC8_V1_8821C(x) \ -+ (((x) & BIT_MASK_DARF_RC8_V1_8821C) << BIT_SHIFT_DARF_RC8_V1_8821C) -+#define BITS_DARF_RC8_V1_8821C \ -+ (BIT_MASK_DARF_RC8_V1_8821C << BIT_SHIFT_DARF_RC8_V1_8821C) -+#define BIT_CLEAR_DARF_RC8_V1_8821C(x) ((x) & (~BITS_DARF_RC8_V1_8821C)) -+#define BIT_GET_DARF_RC8_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC8_V1_8821C) & BIT_MASK_DARF_RC8_V1_8821C) -+#define BIT_SET_DARF_RC8_V1_8821C(x, v) \ -+ (BIT_CLEAR_DARF_RC8_V1_8821C(x) | BIT_DARF_RC8_V1_8821C(v)) -+ -+#define BIT_SHIFT_DARF_RC7_V1_8821C 16 -+#define BIT_MASK_DARF_RC7_V1_8821C 0x1f -+#define BIT_DARF_RC7_V1_8821C(x) \ -+ (((x) & BIT_MASK_DARF_RC7_V1_8821C) << BIT_SHIFT_DARF_RC7_V1_8821C) -+#define BITS_DARF_RC7_V1_8821C \ -+ (BIT_MASK_DARF_RC7_V1_8821C << BIT_SHIFT_DARF_RC7_V1_8821C) -+#define BIT_CLEAR_DARF_RC7_V1_8821C(x) ((x) & (~BITS_DARF_RC7_V1_8821C)) -+#define BIT_GET_DARF_RC7_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC7_V1_8821C) & BIT_MASK_DARF_RC7_V1_8821C) -+#define BIT_SET_DARF_RC7_V1_8821C(x, v) \ -+ (BIT_CLEAR_DARF_RC7_V1_8821C(x) | BIT_DARF_RC7_V1_8821C(v)) -+ -+#define BIT_SHIFT_DARF_RC6_V1_8821C 8 -+#define BIT_MASK_DARF_RC6_V1_8821C 0x1f -+#define BIT_DARF_RC6_V1_8821C(x) \ -+ (((x) & BIT_MASK_DARF_RC6_V1_8821C) << BIT_SHIFT_DARF_RC6_V1_8821C) -+#define BITS_DARF_RC6_V1_8821C \ -+ (BIT_MASK_DARF_RC6_V1_8821C << BIT_SHIFT_DARF_RC6_V1_8821C) -+#define BIT_CLEAR_DARF_RC6_V1_8821C(x) ((x) & (~BITS_DARF_RC6_V1_8821C)) -+#define BIT_GET_DARF_RC6_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC6_V1_8821C) & BIT_MASK_DARF_RC6_V1_8821C) -+#define BIT_SET_DARF_RC6_V1_8821C(x, v) \ -+ (BIT_CLEAR_DARF_RC6_V1_8821C(x) | BIT_DARF_RC6_V1_8821C(v)) -+ -+#define BIT_SHIFT_DARF_RC5_V1_8821C 0 -+#define BIT_MASK_DARF_RC5_V1_8821C 0x1f -+#define BIT_DARF_RC5_V1_8821C(x) \ -+ (((x) & BIT_MASK_DARF_RC5_V1_8821C) << BIT_SHIFT_DARF_RC5_V1_8821C) -+#define BITS_DARF_RC5_V1_8821C \ -+ (BIT_MASK_DARF_RC5_V1_8821C << BIT_SHIFT_DARF_RC5_V1_8821C) -+#define BIT_CLEAR_DARF_RC5_V1_8821C(x) ((x) & (~BITS_DARF_RC5_V1_8821C)) -+#define BIT_GET_DARF_RC5_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC5_V1_8821C) & BIT_MASK_DARF_RC5_V1_8821C) -+#define BIT_SET_DARF_RC5_V1_8821C(x, v) \ -+ (BIT_CLEAR_DARF_RC5_V1_8821C(x) | BIT_DARF_RC5_V1_8821C(v)) -+ -+/* 2 REG_RARFRC_8821C */ -+ -+#define BIT_SHIFT_RARF_RC4_8821C 24 -+#define BIT_MASK_RARF_RC4_8821C 0x1f -+#define BIT_RARF_RC4_8821C(x) \ -+ (((x) & BIT_MASK_RARF_RC4_8821C) << BIT_SHIFT_RARF_RC4_8821C) -+#define BITS_RARF_RC4_8821C \ -+ (BIT_MASK_RARF_RC4_8821C << BIT_SHIFT_RARF_RC4_8821C) -+#define BIT_CLEAR_RARF_RC4_8821C(x) ((x) & (~BITS_RARF_RC4_8821C)) -+#define BIT_GET_RARF_RC4_8821C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC4_8821C) & BIT_MASK_RARF_RC4_8821C) -+#define BIT_SET_RARF_RC4_8821C(x, v) \ -+ (BIT_CLEAR_RARF_RC4_8821C(x) | BIT_RARF_RC4_8821C(v)) -+ -+#define BIT_SHIFT_RARF_RC3_8821C 16 -+#define BIT_MASK_RARF_RC3_8821C 0x1f -+#define BIT_RARF_RC3_8821C(x) \ -+ (((x) & BIT_MASK_RARF_RC3_8821C) << BIT_SHIFT_RARF_RC3_8821C) -+#define BITS_RARF_RC3_8821C \ -+ (BIT_MASK_RARF_RC3_8821C << BIT_SHIFT_RARF_RC3_8821C) -+#define BIT_CLEAR_RARF_RC3_8821C(x) ((x) & (~BITS_RARF_RC3_8821C)) -+#define BIT_GET_RARF_RC3_8821C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC3_8821C) & BIT_MASK_RARF_RC3_8821C) -+#define BIT_SET_RARF_RC3_8821C(x, v) \ -+ (BIT_CLEAR_RARF_RC3_8821C(x) | BIT_RARF_RC3_8821C(v)) -+ -+#define BIT_SHIFT_RARF_RC2_8821C 8 -+#define BIT_MASK_RARF_RC2_8821C 0x1f -+#define BIT_RARF_RC2_8821C(x) \ -+ (((x) & BIT_MASK_RARF_RC2_8821C) << BIT_SHIFT_RARF_RC2_8821C) -+#define BITS_RARF_RC2_8821C \ -+ (BIT_MASK_RARF_RC2_8821C << BIT_SHIFT_RARF_RC2_8821C) -+#define BIT_CLEAR_RARF_RC2_8821C(x) ((x) & (~BITS_RARF_RC2_8821C)) -+#define BIT_GET_RARF_RC2_8821C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC2_8821C) & BIT_MASK_RARF_RC2_8821C) -+#define BIT_SET_RARF_RC2_8821C(x, v) \ -+ (BIT_CLEAR_RARF_RC2_8821C(x) | BIT_RARF_RC2_8821C(v)) -+ -+#define BIT_SHIFT_RARF_RC1_8821C 0 -+#define BIT_MASK_RARF_RC1_8821C 0x1f -+#define BIT_RARF_RC1_8821C(x) \ -+ (((x) & BIT_MASK_RARF_RC1_8821C) << BIT_SHIFT_RARF_RC1_8821C) -+#define BITS_RARF_RC1_8821C \ -+ (BIT_MASK_RARF_RC1_8821C << BIT_SHIFT_RARF_RC1_8821C) -+#define BIT_CLEAR_RARF_RC1_8821C(x) ((x) & (~BITS_RARF_RC1_8821C)) -+#define BIT_GET_RARF_RC1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC1_8821C) & BIT_MASK_RARF_RC1_8821C) -+#define BIT_SET_RARF_RC1_8821C(x, v) \ -+ (BIT_CLEAR_RARF_RC1_8821C(x) | BIT_RARF_RC1_8821C(v)) -+ -+/* 2 REG_RARFRCH_8821C */ -+ -+#define BIT_SHIFT_RARF_RC8_V1_8821C 24 -+#define BIT_MASK_RARF_RC8_V1_8821C 0x1f -+#define BIT_RARF_RC8_V1_8821C(x) \ -+ (((x) & BIT_MASK_RARF_RC8_V1_8821C) << BIT_SHIFT_RARF_RC8_V1_8821C) -+#define BITS_RARF_RC8_V1_8821C \ -+ (BIT_MASK_RARF_RC8_V1_8821C << BIT_SHIFT_RARF_RC8_V1_8821C) -+#define BIT_CLEAR_RARF_RC8_V1_8821C(x) ((x) & (~BITS_RARF_RC8_V1_8821C)) -+#define BIT_GET_RARF_RC8_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC8_V1_8821C) & BIT_MASK_RARF_RC8_V1_8821C) -+#define BIT_SET_RARF_RC8_V1_8821C(x, v) \ -+ (BIT_CLEAR_RARF_RC8_V1_8821C(x) | BIT_RARF_RC8_V1_8821C(v)) -+ -+#define BIT_SHIFT_RARF_RC7_V1_8821C 16 -+#define BIT_MASK_RARF_RC7_V1_8821C 0x1f -+#define BIT_RARF_RC7_V1_8821C(x) \ -+ (((x) & BIT_MASK_RARF_RC7_V1_8821C) << BIT_SHIFT_RARF_RC7_V1_8821C) -+#define BITS_RARF_RC7_V1_8821C \ -+ (BIT_MASK_RARF_RC7_V1_8821C << BIT_SHIFT_RARF_RC7_V1_8821C) -+#define BIT_CLEAR_RARF_RC7_V1_8821C(x) ((x) & (~BITS_RARF_RC7_V1_8821C)) -+#define BIT_GET_RARF_RC7_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC7_V1_8821C) & BIT_MASK_RARF_RC7_V1_8821C) -+#define BIT_SET_RARF_RC7_V1_8821C(x, v) \ -+ (BIT_CLEAR_RARF_RC7_V1_8821C(x) | BIT_RARF_RC7_V1_8821C(v)) -+ -+#define BIT_SHIFT_RARF_RC6_V1_8821C 8 -+#define BIT_MASK_RARF_RC6_V1_8821C 0x1f -+#define BIT_RARF_RC6_V1_8821C(x) \ -+ (((x) & BIT_MASK_RARF_RC6_V1_8821C) << BIT_SHIFT_RARF_RC6_V1_8821C) -+#define BITS_RARF_RC6_V1_8821C \ -+ (BIT_MASK_RARF_RC6_V1_8821C << BIT_SHIFT_RARF_RC6_V1_8821C) -+#define BIT_CLEAR_RARF_RC6_V1_8821C(x) ((x) & (~BITS_RARF_RC6_V1_8821C)) -+#define BIT_GET_RARF_RC6_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC6_V1_8821C) & BIT_MASK_RARF_RC6_V1_8821C) -+#define BIT_SET_RARF_RC6_V1_8821C(x, v) \ -+ (BIT_CLEAR_RARF_RC6_V1_8821C(x) | BIT_RARF_RC6_V1_8821C(v)) -+ -+#define BIT_SHIFT_RARF_RC5_V1_8821C 0 -+#define BIT_MASK_RARF_RC5_V1_8821C 0x1f -+#define BIT_RARF_RC5_V1_8821C(x) \ -+ (((x) & BIT_MASK_RARF_RC5_V1_8821C) << BIT_SHIFT_RARF_RC5_V1_8821C) -+#define BITS_RARF_RC5_V1_8821C \ -+ (BIT_MASK_RARF_RC5_V1_8821C << BIT_SHIFT_RARF_RC5_V1_8821C) -+#define BIT_CLEAR_RARF_RC5_V1_8821C(x) ((x) & (~BITS_RARF_RC5_V1_8821C)) -+#define BIT_GET_RARF_RC5_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC5_V1_8821C) & BIT_MASK_RARF_RC5_V1_8821C) -+#define BIT_SET_RARF_RC5_V1_8821C(x, v) \ -+ (BIT_CLEAR_RARF_RC5_V1_8821C(x) | BIT_RARF_RC5_V1_8821C(v)) -+ -+/* 2 REG_RRSR_8821C */ -+ -+#define BIT_SHIFT_RRSR_RSC_8821C 21 -+#define BIT_MASK_RRSR_RSC_8821C 0x3 -+#define BIT_RRSR_RSC_8821C(x) \ -+ (((x) & BIT_MASK_RRSR_RSC_8821C) << BIT_SHIFT_RRSR_RSC_8821C) -+#define BITS_RRSR_RSC_8821C \ -+ (BIT_MASK_RRSR_RSC_8821C << BIT_SHIFT_RRSR_RSC_8821C) -+#define BIT_CLEAR_RRSR_RSC_8821C(x) ((x) & (~BITS_RRSR_RSC_8821C)) -+#define BIT_GET_RRSR_RSC_8821C(x) \ -+ (((x) >> BIT_SHIFT_RRSR_RSC_8821C) & BIT_MASK_RRSR_RSC_8821C) -+#define BIT_SET_RRSR_RSC_8821C(x, v) \ -+ (BIT_CLEAR_RRSR_RSC_8821C(x) | BIT_RRSR_RSC_8821C(v)) -+ -+#define BIT_SHIFT_RRSC_BITMAP_8821C 0 -+#define BIT_MASK_RRSC_BITMAP_8821C 0xfffff -+#define BIT_RRSC_BITMAP_8821C(x) \ -+ (((x) & BIT_MASK_RRSC_BITMAP_8821C) << BIT_SHIFT_RRSC_BITMAP_8821C) -+#define BITS_RRSC_BITMAP_8821C \ -+ (BIT_MASK_RRSC_BITMAP_8821C << BIT_SHIFT_RRSC_BITMAP_8821C) -+#define BIT_CLEAR_RRSC_BITMAP_8821C(x) ((x) & (~BITS_RRSC_BITMAP_8821C)) -+#define BIT_GET_RRSC_BITMAP_8821C(x) \ -+ (((x) >> BIT_SHIFT_RRSC_BITMAP_8821C) & BIT_MASK_RRSC_BITMAP_8821C) -+#define BIT_SET_RRSC_BITMAP_8821C(x, v) \ -+ (BIT_CLEAR_RRSC_BITMAP_8821C(x) | BIT_RRSC_BITMAP_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_ARFR0_8821C */ -+ -+#define BIT_SHIFT_ARFRL0_8821C 0 -+#define BIT_MASK_ARFRL0_8821C 0xffffffffL -+#define BIT_ARFRL0_8821C(x) \ -+ (((x) & BIT_MASK_ARFRL0_8821C) << BIT_SHIFT_ARFRL0_8821C) -+#define BITS_ARFRL0_8821C (BIT_MASK_ARFRL0_8821C << BIT_SHIFT_ARFRL0_8821C) -+#define BIT_CLEAR_ARFRL0_8821C(x) ((x) & (~BITS_ARFRL0_8821C)) -+#define BIT_GET_ARFRL0_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL0_8821C) & BIT_MASK_ARFRL0_8821C) -+#define BIT_SET_ARFRL0_8821C(x, v) \ -+ (BIT_CLEAR_ARFRL0_8821C(x) | BIT_ARFRL0_8821C(v)) -+ -+/* 2 REG_ARFRH0_8821C */ -+ -+#define BIT_SHIFT_ARFRH0_8821C 0 -+#define BIT_MASK_ARFRH0_8821C 0xffffffffL -+#define BIT_ARFRH0_8821C(x) \ -+ (((x) & BIT_MASK_ARFRH0_8821C) << BIT_SHIFT_ARFRH0_8821C) -+#define BITS_ARFRH0_8821C (BIT_MASK_ARFRH0_8821C << BIT_SHIFT_ARFRH0_8821C) -+#define BIT_CLEAR_ARFRH0_8821C(x) ((x) & (~BITS_ARFRH0_8821C)) -+#define BIT_GET_ARFRH0_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH0_8821C) & BIT_MASK_ARFRH0_8821C) -+#define BIT_SET_ARFRH0_8821C(x, v) \ -+ (BIT_CLEAR_ARFRH0_8821C(x) | BIT_ARFRH0_8821C(v)) -+ -+/* 2 REG_ARFR1_V1_8821C */ -+ -+#define BIT_SHIFT_ARFRL1_8821C 0 -+#define BIT_MASK_ARFRL1_8821C 0xffffffffL -+#define BIT_ARFRL1_8821C(x) \ -+ (((x) & BIT_MASK_ARFRL1_8821C) << BIT_SHIFT_ARFRL1_8821C) -+#define BITS_ARFRL1_8821C (BIT_MASK_ARFRL1_8821C << BIT_SHIFT_ARFRL1_8821C) -+#define BIT_CLEAR_ARFRL1_8821C(x) ((x) & (~BITS_ARFRL1_8821C)) -+#define BIT_GET_ARFRL1_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL1_8821C) & BIT_MASK_ARFRL1_8821C) -+#define BIT_SET_ARFRL1_8821C(x, v) \ -+ (BIT_CLEAR_ARFRL1_8821C(x) | BIT_ARFRL1_8821C(v)) -+ -+/* 2 REG_ARFRH1_V1_8821C */ -+ -+#define BIT_SHIFT_ARFRH1_8821C 0 -+#define BIT_MASK_ARFRH1_8821C 0xffffffffL -+#define BIT_ARFRH1_8821C(x) \ -+ (((x) & BIT_MASK_ARFRH1_8821C) << BIT_SHIFT_ARFRH1_8821C) -+#define BITS_ARFRH1_8821C (BIT_MASK_ARFRH1_8821C << BIT_SHIFT_ARFRH1_8821C) -+#define BIT_CLEAR_ARFRH1_8821C(x) ((x) & (~BITS_ARFRH1_8821C)) -+#define BIT_GET_ARFRH1_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH1_8821C) & BIT_MASK_ARFRH1_8821C) -+#define BIT_SET_ARFRH1_8821C(x, v) \ -+ (BIT_CLEAR_ARFRH1_8821C(x) | BIT_ARFRH1_8821C(v)) -+ -+/* 2 REG_CCK_CHECK_8821C */ -+#define BIT_CHECK_CCK_EN_8821C BIT(7) -+#define BIT_EN_BCN_PKT_REL_8821C BIT(6) -+#define BIT_BCN_PORT_SEL_8821C BIT(5) -+#define BIT_MOREDATA_BYPASS_8821C BIT(4) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_8821C BIT(3) -+#define BIT_R_EN_SET_MOREDATA_8821C BIT(2) -+#define BIT__R_DIS_CLEAR_MACID_RELEASE_8821C BIT(1) -+#define BIT__R_MACID_RELEASE_EN_8821C BIT(0) -+ -+/* 2 REG_AMPDU_MAX_TIME_V1_8821C */ -+ -+#define BIT_SHIFT_AMPDU_MAX_TIME_8821C 0 -+#define BIT_MASK_AMPDU_MAX_TIME_8821C 0xff -+#define BIT_AMPDU_MAX_TIME_8821C(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_TIME_8821C) \ -+ << BIT_SHIFT_AMPDU_MAX_TIME_8821C) -+#define BITS_AMPDU_MAX_TIME_8821C \ -+ (BIT_MASK_AMPDU_MAX_TIME_8821C << BIT_SHIFT_AMPDU_MAX_TIME_8821C) -+#define BIT_CLEAR_AMPDU_MAX_TIME_8821C(x) ((x) & (~BITS_AMPDU_MAX_TIME_8821C)) -+#define BIT_GET_AMPDU_MAX_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_TIME_8821C) & \ -+ BIT_MASK_AMPDU_MAX_TIME_8821C) -+#define BIT_SET_AMPDU_MAX_TIME_8821C(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_TIME_8821C(x) | BIT_AMPDU_MAX_TIME_8821C(v)) -+ -+/* 2 REG_BCNQ1_BDNY_V1_8821C */ -+ -+#define BIT_SHIFT_BCNQ1_PGBNDY_V1_8821C 0 -+#define BIT_MASK_BCNQ1_PGBNDY_V1_8821C 0xfff -+#define BIT_BCNQ1_PGBNDY_V1_8821C(x) \ -+ (((x) & BIT_MASK_BCNQ1_PGBNDY_V1_8821C) \ -+ << BIT_SHIFT_BCNQ1_PGBNDY_V1_8821C) -+#define BITS_BCNQ1_PGBNDY_V1_8821C \ -+ (BIT_MASK_BCNQ1_PGBNDY_V1_8821C << BIT_SHIFT_BCNQ1_PGBNDY_V1_8821C) -+#define BIT_CLEAR_BCNQ1_PGBNDY_V1_8821C(x) ((x) & (~BITS_BCNQ1_PGBNDY_V1_8821C)) -+#define BIT_GET_BCNQ1_PGBNDY_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ1_PGBNDY_V1_8821C) & \ -+ BIT_MASK_BCNQ1_PGBNDY_V1_8821C) -+#define BIT_SET_BCNQ1_PGBNDY_V1_8821C(x, v) \ -+ (BIT_CLEAR_BCNQ1_PGBNDY_V1_8821C(x) | BIT_BCNQ1_PGBNDY_V1_8821C(v)) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_8821C */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_8821C 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_8821C 0xffffffffL -+#define BIT_AMPDU_MAX_LENGTH_8821C(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_8821C) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_8821C) -+#define BITS_AMPDU_MAX_LENGTH_8821C \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_8821C << BIT_SHIFT_AMPDU_MAX_LENGTH_8821C) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_8821C(x) \ -+ ((x) & (~BITS_AMPDU_MAX_LENGTH_8821C)) -+#define BIT_GET_AMPDU_MAX_LENGTH_8821C(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_8821C) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_8821C) -+#define BIT_SET_AMPDU_MAX_LENGTH_8821C(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_8821C(x) | BIT_AMPDU_MAX_LENGTH_8821C(v)) -+ -+/* 2 REG_ACQ_STOP_8821C */ -+#define BIT_AC7Q_STOP_8821C BIT(7) -+#define BIT_AC6Q_STOP_8821C BIT(6) -+#define BIT_AC5Q_STOP_8821C BIT(5) -+#define BIT_AC4Q_STOP_8821C BIT(4) -+#define BIT_AC3Q_STOP_8821C BIT(3) -+#define BIT_AC2Q_STOP_8821C BIT(2) -+#define BIT_AC1Q_STOP_8821C BIT(1) -+#define BIT_AC0Q_STOP_8821C BIT(0) -+ -+/* 2 REG_NDPA_RATE_8821C */ -+ -+#define BIT_SHIFT_R_NDPA_RATE_V1_8821C 0 -+#define BIT_MASK_R_NDPA_RATE_V1_8821C 0xff -+#define BIT_R_NDPA_RATE_V1_8821C(x) \ -+ (((x) & BIT_MASK_R_NDPA_RATE_V1_8821C) \ -+ << BIT_SHIFT_R_NDPA_RATE_V1_8821C) -+#define BITS_R_NDPA_RATE_V1_8821C \ -+ (BIT_MASK_R_NDPA_RATE_V1_8821C << BIT_SHIFT_R_NDPA_RATE_V1_8821C) -+#define BIT_CLEAR_R_NDPA_RATE_V1_8821C(x) ((x) & (~BITS_R_NDPA_RATE_V1_8821C)) -+#define BIT_GET_R_NDPA_RATE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_RATE_V1_8821C) & \ -+ BIT_MASK_R_NDPA_RATE_V1_8821C) -+#define BIT_SET_R_NDPA_RATE_V1_8821C(x, v) \ -+ (BIT_CLEAR_R_NDPA_RATE_V1_8821C(x) | BIT_R_NDPA_RATE_V1_8821C(v)) -+ -+/* 2 REG_TX_HANG_CTRL_8821C */ -+#define BIT_R_EN_GNT_BT_AWAKE_8821C BIT(3) -+#define BIT_EN_EOF_V1_8821C BIT(2) -+#define BIT_DIS_OQT_BLOCK_8821C BIT(1) -+#define BIT_SEARCH_QUEUE_EN_8821C BIT(0) -+ -+/* 2 REG_NDPA_OPT_CTRL_8821C */ -+#define BIT_R_DIS_MACID_RELEASE_RTY_8821C BIT(5) -+ -+#define BIT_SHIFT_BW_SIGTA_8821C 3 -+#define BIT_MASK_BW_SIGTA_8821C 0x3 -+#define BIT_BW_SIGTA_8821C(x) \ -+ (((x) & BIT_MASK_BW_SIGTA_8821C) << BIT_SHIFT_BW_SIGTA_8821C) -+#define BITS_BW_SIGTA_8821C \ -+ (BIT_MASK_BW_SIGTA_8821C << BIT_SHIFT_BW_SIGTA_8821C) -+#define BIT_CLEAR_BW_SIGTA_8821C(x) ((x) & (~BITS_BW_SIGTA_8821C)) -+#define BIT_GET_BW_SIGTA_8821C(x) \ -+ (((x) >> BIT_SHIFT_BW_SIGTA_8821C) & BIT_MASK_BW_SIGTA_8821C) -+#define BIT_SET_BW_SIGTA_8821C(x, v) \ -+ (BIT_CLEAR_BW_SIGTA_8821C(x) | BIT_BW_SIGTA_8821C(v)) -+ -+#define BIT_EN_BAR_SIGTA_8821C BIT(2) -+ -+#define BIT_SHIFT_R_NDPA_BW_8821C 0 -+#define BIT_MASK_R_NDPA_BW_8821C 0x3 -+#define BIT_R_NDPA_BW_8821C(x) \ -+ (((x) & BIT_MASK_R_NDPA_BW_8821C) << BIT_SHIFT_R_NDPA_BW_8821C) -+#define BITS_R_NDPA_BW_8821C \ -+ (BIT_MASK_R_NDPA_BW_8821C << BIT_SHIFT_R_NDPA_BW_8821C) -+#define BIT_CLEAR_R_NDPA_BW_8821C(x) ((x) & (~BITS_R_NDPA_BW_8821C)) -+#define BIT_GET_R_NDPA_BW_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_BW_8821C) & BIT_MASK_R_NDPA_BW_8821C) -+#define BIT_SET_R_NDPA_BW_8821C(x, v) \ -+ (BIT_CLEAR_R_NDPA_BW_8821C(x) | BIT_R_NDPA_BW_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_RD_RESP_PKT_TH_8821C */ -+ -+#define BIT_SHIFT_RD_RESP_PKT_TH_V1_8821C 0 -+#define BIT_MASK_RD_RESP_PKT_TH_V1_8821C 0x3f -+#define BIT_RD_RESP_PKT_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_RD_RESP_PKT_TH_V1_8821C) \ -+ << BIT_SHIFT_RD_RESP_PKT_TH_V1_8821C) -+#define BITS_RD_RESP_PKT_TH_V1_8821C \ -+ (BIT_MASK_RD_RESP_PKT_TH_V1_8821C << BIT_SHIFT_RD_RESP_PKT_TH_V1_8821C) -+#define BIT_CLEAR_RD_RESP_PKT_TH_V1_8821C(x) \ -+ ((x) & (~BITS_RD_RESP_PKT_TH_V1_8821C)) -+#define BIT_GET_RD_RESP_PKT_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RD_RESP_PKT_TH_V1_8821C) & \ -+ BIT_MASK_RD_RESP_PKT_TH_V1_8821C) -+#define BIT_SET_RD_RESP_PKT_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_RD_RESP_PKT_TH_V1_8821C(x) | BIT_RD_RESP_PKT_TH_V1_8821C(v)) -+ -+/* 2 REG_CMDQ_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_CMDQ_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_CMDQ_V1_8821C 0x7f -+#define BIT_QUEUEMACID_CMDQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_CMDQ_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_CMDQ_V1_8821C) -+#define BITS_QUEUEMACID_CMDQ_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_CMDQ_V1_8821C \ -+ << BIT_SHIFT_QUEUEMACID_CMDQ_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_CMDQ_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_CMDQ_V1_8821C)) -+#define BIT_GET_QUEUEMACID_CMDQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_CMDQ_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_CMDQ_V1_8821C) -+#define BIT_SET_QUEUEMACID_CMDQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_CMDQ_V1_8821C(x) | \ -+ BIT_QUEUEMACID_CMDQ_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_CMDQ_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_CMDQ_V1_8821C 0x3 -+#define BIT_QUEUEAC_CMDQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_CMDQ_V1_8821C) \ -+ << BIT_SHIFT_QUEUEAC_CMDQ_V1_8821C) -+#define BITS_QUEUEAC_CMDQ_V1_8821C \ -+ (BIT_MASK_QUEUEAC_CMDQ_V1_8821C << BIT_SHIFT_QUEUEAC_CMDQ_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_CMDQ_V1_8821C(x) ((x) & (~BITS_QUEUEAC_CMDQ_V1_8821C)) -+#define BIT_GET_QUEUEAC_CMDQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_CMDQ_V1_8821C) & \ -+ BIT_MASK_QUEUEAC_CMDQ_V1_8821C) -+#define BIT_SET_QUEUEAC_CMDQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_CMDQ_V1_8821C(x) | BIT_QUEUEAC_CMDQ_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_CMDQ_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q4_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_Q4_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_Q4_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q4_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_Q4_V2_8821C) -+#define BITS_TAIL_PKT_Q4_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_Q4_V2_8821C << BIT_SHIFT_TAIL_PKT_Q4_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_Q4_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_Q4_V2_8821C)) -+#define BIT_GET_TAIL_PKT_Q4_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q4_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_Q4_V2_8821C) -+#define BIT_SET_TAIL_PKT_Q4_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q4_V2_8821C(x) | BIT_TAIL_PKT_Q4_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_CMDQ_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_CMDQ_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_CMDQ_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_CMDQ_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_CMDQ_V1_8821C) -+#define BITS_HEAD_PKT_CMDQ_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_CMDQ_V1_8821C << BIT_SHIFT_HEAD_PKT_CMDQ_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_CMDQ_V1_8821C(x) \ -+ ((x) & (~BITS_HEAD_PKT_CMDQ_V1_8821C)) -+#define BIT_GET_HEAD_PKT_CMDQ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_CMDQ_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_CMDQ_V1_8821C) -+#define BIT_SET_HEAD_PKT_CMDQ_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_CMDQ_V1_8821C(x) | BIT_HEAD_PKT_CMDQ_V1_8821C(v)) -+ -+/* 2 REG_Q4_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q4_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_Q4_V1_8821C 0x7f -+#define BIT_QUEUEMACID_Q4_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q4_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_Q4_V1_8821C) -+#define BITS_QUEUEMACID_Q4_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_Q4_V1_8821C << BIT_SHIFT_QUEUEMACID_Q4_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_Q4_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q4_V1_8821C)) -+#define BIT_GET_QUEUEMACID_Q4_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q4_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_Q4_V1_8821C) -+#define BIT_SET_QUEUEMACID_Q4_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q4_V1_8821C(x) | BIT_QUEUEMACID_Q4_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q4_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_Q4_V1_8821C 0x3 -+#define BIT_QUEUEAC_Q4_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q4_V1_8821C) << BIT_SHIFT_QUEUEAC_Q4_V1_8821C) -+#define BITS_QUEUEAC_Q4_V1_8821C \ -+ (BIT_MASK_QUEUEAC_Q4_V1_8821C << BIT_SHIFT_QUEUEAC_Q4_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_Q4_V1_8821C(x) ((x) & (~BITS_QUEUEAC_Q4_V1_8821C)) -+#define BIT_GET_QUEUEAC_Q4_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q4_V1_8821C) & BIT_MASK_QUEUEAC_Q4_V1_8821C) -+#define BIT_SET_QUEUEAC_Q4_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q4_V1_8821C(x) | BIT_QUEUEAC_Q4_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_Q4_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q4_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_Q4_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_Q4_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q4_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_Q4_V2_8821C) -+#define BITS_TAIL_PKT_Q4_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_Q4_V2_8821C << BIT_SHIFT_TAIL_PKT_Q4_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_Q4_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_Q4_V2_8821C)) -+#define BIT_GET_TAIL_PKT_Q4_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q4_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_Q4_V2_8821C) -+#define BIT_SET_TAIL_PKT_Q4_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q4_V2_8821C(x) | BIT_TAIL_PKT_Q4_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q4_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_Q4_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_Q4_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q4_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_Q4_V1_8821C) -+#define BITS_HEAD_PKT_Q4_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_Q4_V1_8821C << BIT_SHIFT_HEAD_PKT_Q4_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_Q4_V1_8821C(x) ((x) & (~BITS_HEAD_PKT_Q4_V1_8821C)) -+#define BIT_GET_HEAD_PKT_Q4_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q4_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_Q4_V1_8821C) -+#define BIT_SET_HEAD_PKT_Q4_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q4_V1_8821C(x) | BIT_HEAD_PKT_Q4_V1_8821C(v)) -+ -+/* 2 REG_Q5_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q5_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_Q5_V1_8821C 0x7f -+#define BIT_QUEUEMACID_Q5_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q5_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_Q5_V1_8821C) -+#define BITS_QUEUEMACID_Q5_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_Q5_V1_8821C << BIT_SHIFT_QUEUEMACID_Q5_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_Q5_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q5_V1_8821C)) -+#define BIT_GET_QUEUEMACID_Q5_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q5_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_Q5_V1_8821C) -+#define BIT_SET_QUEUEMACID_Q5_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q5_V1_8821C(x) | BIT_QUEUEMACID_Q5_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q5_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_Q5_V1_8821C 0x3 -+#define BIT_QUEUEAC_Q5_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q5_V1_8821C) << BIT_SHIFT_QUEUEAC_Q5_V1_8821C) -+#define BITS_QUEUEAC_Q5_V1_8821C \ -+ (BIT_MASK_QUEUEAC_Q5_V1_8821C << BIT_SHIFT_QUEUEAC_Q5_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_Q5_V1_8821C(x) ((x) & (~BITS_QUEUEAC_Q5_V1_8821C)) -+#define BIT_GET_QUEUEAC_Q5_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q5_V1_8821C) & BIT_MASK_QUEUEAC_Q5_V1_8821C) -+#define BIT_SET_QUEUEAC_Q5_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q5_V1_8821C(x) | BIT_QUEUEAC_Q5_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_Q5_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q5_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_Q5_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_Q5_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q5_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_Q5_V2_8821C) -+#define BITS_TAIL_PKT_Q5_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_Q5_V2_8821C << BIT_SHIFT_TAIL_PKT_Q5_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_Q5_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_Q5_V2_8821C)) -+#define BIT_GET_TAIL_PKT_Q5_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q5_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_Q5_V2_8821C) -+#define BIT_SET_TAIL_PKT_Q5_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q5_V2_8821C(x) | BIT_TAIL_PKT_Q5_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q5_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_Q5_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_Q5_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q5_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_Q5_V1_8821C) -+#define BITS_HEAD_PKT_Q5_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_Q5_V1_8821C << BIT_SHIFT_HEAD_PKT_Q5_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_Q5_V1_8821C(x) ((x) & (~BITS_HEAD_PKT_Q5_V1_8821C)) -+#define BIT_GET_HEAD_PKT_Q5_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q5_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_Q5_V1_8821C) -+#define BIT_SET_HEAD_PKT_Q5_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q5_V1_8821C(x) | BIT_HEAD_PKT_Q5_V1_8821C(v)) -+ -+/* 2 REG_Q6_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q6_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_Q6_V1_8821C 0x7f -+#define BIT_QUEUEMACID_Q6_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q6_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_Q6_V1_8821C) -+#define BITS_QUEUEMACID_Q6_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_Q6_V1_8821C << BIT_SHIFT_QUEUEMACID_Q6_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_Q6_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q6_V1_8821C)) -+#define BIT_GET_QUEUEMACID_Q6_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q6_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_Q6_V1_8821C) -+#define BIT_SET_QUEUEMACID_Q6_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q6_V1_8821C(x) | BIT_QUEUEMACID_Q6_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q6_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_Q6_V1_8821C 0x3 -+#define BIT_QUEUEAC_Q6_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q6_V1_8821C) << BIT_SHIFT_QUEUEAC_Q6_V1_8821C) -+#define BITS_QUEUEAC_Q6_V1_8821C \ -+ (BIT_MASK_QUEUEAC_Q6_V1_8821C << BIT_SHIFT_QUEUEAC_Q6_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_Q6_V1_8821C(x) ((x) & (~BITS_QUEUEAC_Q6_V1_8821C)) -+#define BIT_GET_QUEUEAC_Q6_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q6_V1_8821C) & BIT_MASK_QUEUEAC_Q6_V1_8821C) -+#define BIT_SET_QUEUEAC_Q6_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q6_V1_8821C(x) | BIT_QUEUEAC_Q6_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_Q6_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q6_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_Q6_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_Q6_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q6_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_Q6_V2_8821C) -+#define BITS_TAIL_PKT_Q6_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_Q6_V2_8821C << BIT_SHIFT_TAIL_PKT_Q6_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_Q6_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_Q6_V2_8821C)) -+#define BIT_GET_TAIL_PKT_Q6_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q6_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_Q6_V2_8821C) -+#define BIT_SET_TAIL_PKT_Q6_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q6_V2_8821C(x) | BIT_TAIL_PKT_Q6_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q6_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_Q6_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_Q6_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q6_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_Q6_V1_8821C) -+#define BITS_HEAD_PKT_Q6_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_Q6_V1_8821C << BIT_SHIFT_HEAD_PKT_Q6_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_Q6_V1_8821C(x) ((x) & (~BITS_HEAD_PKT_Q6_V1_8821C)) -+#define BIT_GET_HEAD_PKT_Q6_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q6_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_Q6_V1_8821C) -+#define BIT_SET_HEAD_PKT_Q6_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q6_V1_8821C(x) | BIT_HEAD_PKT_Q6_V1_8821C(v)) -+ -+/* 2 REG_Q7_INFO_8821C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q7_V1_8821C 25 -+#define BIT_MASK_QUEUEMACID_Q7_V1_8821C 0x7f -+#define BIT_QUEUEMACID_Q7_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q7_V1_8821C) \ -+ << BIT_SHIFT_QUEUEMACID_Q7_V1_8821C) -+#define BITS_QUEUEMACID_Q7_V1_8821C \ -+ (BIT_MASK_QUEUEMACID_Q7_V1_8821C << BIT_SHIFT_QUEUEMACID_Q7_V1_8821C) -+#define BIT_CLEAR_QUEUEMACID_Q7_V1_8821C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q7_V1_8821C)) -+#define BIT_GET_QUEUEMACID_Q7_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q7_V1_8821C) & \ -+ BIT_MASK_QUEUEMACID_Q7_V1_8821C) -+#define BIT_SET_QUEUEMACID_Q7_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q7_V1_8821C(x) | BIT_QUEUEMACID_Q7_V1_8821C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q7_V1_8821C 23 -+#define BIT_MASK_QUEUEAC_Q7_V1_8821C 0x3 -+#define BIT_QUEUEAC_Q7_V1_8821C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q7_V1_8821C) << BIT_SHIFT_QUEUEAC_Q7_V1_8821C) -+#define BITS_QUEUEAC_Q7_V1_8821C \ -+ (BIT_MASK_QUEUEAC_Q7_V1_8821C << BIT_SHIFT_QUEUEAC_Q7_V1_8821C) -+#define BIT_CLEAR_QUEUEAC_Q7_V1_8821C(x) ((x) & (~BITS_QUEUEAC_Q7_V1_8821C)) -+#define BIT_GET_QUEUEAC_Q7_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q7_V1_8821C) & BIT_MASK_QUEUEAC_Q7_V1_8821C) -+#define BIT_SET_QUEUEAC_Q7_V1_8821C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q7_V1_8821C(x) | BIT_QUEUEAC_Q7_V1_8821C(v)) -+ -+#define BIT_TIDEMPTY_Q7_V1_8821C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q7_V2_8821C 11 -+#define BIT_MASK_TAIL_PKT_Q7_V2_8821C 0x7ff -+#define BIT_TAIL_PKT_Q7_V2_8821C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q7_V2_8821C) \ -+ << BIT_SHIFT_TAIL_PKT_Q7_V2_8821C) -+#define BITS_TAIL_PKT_Q7_V2_8821C \ -+ (BIT_MASK_TAIL_PKT_Q7_V2_8821C << BIT_SHIFT_TAIL_PKT_Q7_V2_8821C) -+#define BIT_CLEAR_TAIL_PKT_Q7_V2_8821C(x) ((x) & (~BITS_TAIL_PKT_Q7_V2_8821C)) -+#define BIT_GET_TAIL_PKT_Q7_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q7_V2_8821C) & \ -+ BIT_MASK_TAIL_PKT_Q7_V2_8821C) -+#define BIT_SET_TAIL_PKT_Q7_V2_8821C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q7_V2_8821C(x) | BIT_TAIL_PKT_Q7_V2_8821C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q7_V1_8821C 0 -+#define BIT_MASK_HEAD_PKT_Q7_V1_8821C 0x7ff -+#define BIT_HEAD_PKT_Q7_V1_8821C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q7_V1_8821C) \ -+ << BIT_SHIFT_HEAD_PKT_Q7_V1_8821C) -+#define BITS_HEAD_PKT_Q7_V1_8821C \ -+ (BIT_MASK_HEAD_PKT_Q7_V1_8821C << BIT_SHIFT_HEAD_PKT_Q7_V1_8821C) -+#define BIT_CLEAR_HEAD_PKT_Q7_V1_8821C(x) ((x) & (~BITS_HEAD_PKT_Q7_V1_8821C)) -+#define BIT_GET_HEAD_PKT_Q7_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q7_V1_8821C) & \ -+ BIT_MASK_HEAD_PKT_Q7_V1_8821C) -+#define BIT_SET_HEAD_PKT_Q7_V1_8821C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q7_V1_8821C(x) | BIT_HEAD_PKT_Q7_V1_8821C(v)) -+ -+/* 2 REG_WMAC_LBK_BUF_HD_V1_8821C */ -+ -+#define BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8821C 0 -+#define BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8821C 0xfff -+#define BIT_WMAC_LBK_BUF_HEAD_V1_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8821C) \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8821C) -+#define BITS_WMAC_LBK_BUF_HEAD_V1_8821C \ -+ (BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8821C \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8821C) -+#define BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8821C(x) \ -+ ((x) & (~BITS_WMAC_LBK_BUF_HEAD_V1_8821C)) -+#define BIT_GET_WMAC_LBK_BUF_HEAD_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8821C) & \ -+ BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8821C) -+#define BIT_SET_WMAC_LBK_BUF_HEAD_V1_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8821C(x) | \ -+ BIT_WMAC_LBK_BUF_HEAD_V1_8821C(v)) -+ -+/* 2 REG_MGQ_BDNY_V1_8821C */ -+ -+#define BIT_SHIFT_MGQ_PGBNDY_V1_8821C 0 -+#define BIT_MASK_MGQ_PGBNDY_V1_8821C 0xfff -+#define BIT_MGQ_PGBNDY_V1_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_PGBNDY_V1_8821C) << BIT_SHIFT_MGQ_PGBNDY_V1_8821C) -+#define BITS_MGQ_PGBNDY_V1_8821C \ -+ (BIT_MASK_MGQ_PGBNDY_V1_8821C << BIT_SHIFT_MGQ_PGBNDY_V1_8821C) -+#define BIT_CLEAR_MGQ_PGBNDY_V1_8821C(x) ((x) & (~BITS_MGQ_PGBNDY_V1_8821C)) -+#define BIT_GET_MGQ_PGBNDY_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PGBNDY_V1_8821C) & BIT_MASK_MGQ_PGBNDY_V1_8821C) -+#define BIT_SET_MGQ_PGBNDY_V1_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_PGBNDY_V1_8821C(x) | BIT_MGQ_PGBNDY_V1_8821C(v)) -+ -+/* 2 REG_TXRPT_CTRL_8821C */ -+ -+#define BIT_SHIFT_TRXRPT_TIMER_TH_8821C 24 -+#define BIT_MASK_TRXRPT_TIMER_TH_8821C 0xff -+#define BIT_TRXRPT_TIMER_TH_8821C(x) \ -+ (((x) & BIT_MASK_TRXRPT_TIMER_TH_8821C) \ -+ << BIT_SHIFT_TRXRPT_TIMER_TH_8821C) -+#define BITS_TRXRPT_TIMER_TH_8821C \ -+ (BIT_MASK_TRXRPT_TIMER_TH_8821C << BIT_SHIFT_TRXRPT_TIMER_TH_8821C) -+#define BIT_CLEAR_TRXRPT_TIMER_TH_8821C(x) ((x) & (~BITS_TRXRPT_TIMER_TH_8821C)) -+#define BIT_GET_TRXRPT_TIMER_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_TIMER_TH_8821C) & \ -+ BIT_MASK_TRXRPT_TIMER_TH_8821C) -+#define BIT_SET_TRXRPT_TIMER_TH_8821C(x, v) \ -+ (BIT_CLEAR_TRXRPT_TIMER_TH_8821C(x) | BIT_TRXRPT_TIMER_TH_8821C(v)) -+ -+#define BIT_SHIFT_TRXRPT_LEN_TH_8821C 16 -+#define BIT_MASK_TRXRPT_LEN_TH_8821C 0xff -+#define BIT_TRXRPT_LEN_TH_8821C(x) \ -+ (((x) & BIT_MASK_TRXRPT_LEN_TH_8821C) << BIT_SHIFT_TRXRPT_LEN_TH_8821C) -+#define BITS_TRXRPT_LEN_TH_8821C \ -+ (BIT_MASK_TRXRPT_LEN_TH_8821C << BIT_SHIFT_TRXRPT_LEN_TH_8821C) -+#define BIT_CLEAR_TRXRPT_LEN_TH_8821C(x) ((x) & (~BITS_TRXRPT_LEN_TH_8821C)) -+#define BIT_GET_TRXRPT_LEN_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_LEN_TH_8821C) & BIT_MASK_TRXRPT_LEN_TH_8821C) -+#define BIT_SET_TRXRPT_LEN_TH_8821C(x, v) \ -+ (BIT_CLEAR_TRXRPT_LEN_TH_8821C(x) | BIT_TRXRPT_LEN_TH_8821C(v)) -+ -+#define BIT_SHIFT_TRXRPT_READ_PTR_8821C 8 -+#define BIT_MASK_TRXRPT_READ_PTR_8821C 0xff -+#define BIT_TRXRPT_READ_PTR_8821C(x) \ -+ (((x) & BIT_MASK_TRXRPT_READ_PTR_8821C) \ -+ << BIT_SHIFT_TRXRPT_READ_PTR_8821C) -+#define BITS_TRXRPT_READ_PTR_8821C \ -+ (BIT_MASK_TRXRPT_READ_PTR_8821C << BIT_SHIFT_TRXRPT_READ_PTR_8821C) -+#define BIT_CLEAR_TRXRPT_READ_PTR_8821C(x) ((x) & (~BITS_TRXRPT_READ_PTR_8821C)) -+#define BIT_GET_TRXRPT_READ_PTR_8821C(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_READ_PTR_8821C) & \ -+ BIT_MASK_TRXRPT_READ_PTR_8821C) -+#define BIT_SET_TRXRPT_READ_PTR_8821C(x, v) \ -+ (BIT_CLEAR_TRXRPT_READ_PTR_8821C(x) | BIT_TRXRPT_READ_PTR_8821C(v)) -+ -+#define BIT_SHIFT_TRXRPT_WRITE_PTR_8821C 0 -+#define BIT_MASK_TRXRPT_WRITE_PTR_8821C 0xff -+#define BIT_TRXRPT_WRITE_PTR_8821C(x) \ -+ (((x) & BIT_MASK_TRXRPT_WRITE_PTR_8821C) \ -+ << BIT_SHIFT_TRXRPT_WRITE_PTR_8821C) -+#define BITS_TRXRPT_WRITE_PTR_8821C \ -+ (BIT_MASK_TRXRPT_WRITE_PTR_8821C << BIT_SHIFT_TRXRPT_WRITE_PTR_8821C) -+#define BIT_CLEAR_TRXRPT_WRITE_PTR_8821C(x) \ -+ ((x) & (~BITS_TRXRPT_WRITE_PTR_8821C)) -+#define BIT_GET_TRXRPT_WRITE_PTR_8821C(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_WRITE_PTR_8821C) & \ -+ BIT_MASK_TRXRPT_WRITE_PTR_8821C) -+#define BIT_SET_TRXRPT_WRITE_PTR_8821C(x, v) \ -+ (BIT_CLEAR_TRXRPT_WRITE_PTR_8821C(x) | BIT_TRXRPT_WRITE_PTR_8821C(v)) -+ -+/* 2 REG_INIRTS_RATE_SEL_8821C */ -+#define BIT_LEAG_RTS_BW_DUP_8821C BIT(5) -+ -+/* 2 REG_BASIC_CFEND_RATE_8821C */ -+ -+#define BIT_SHIFT_BASIC_CFEND_RATE_8821C 0 -+#define BIT_MASK_BASIC_CFEND_RATE_8821C 0x1f -+#define BIT_BASIC_CFEND_RATE_8821C(x) \ -+ (((x) & BIT_MASK_BASIC_CFEND_RATE_8821C) \ -+ << BIT_SHIFT_BASIC_CFEND_RATE_8821C) -+#define BITS_BASIC_CFEND_RATE_8821C \ -+ (BIT_MASK_BASIC_CFEND_RATE_8821C << BIT_SHIFT_BASIC_CFEND_RATE_8821C) -+#define BIT_CLEAR_BASIC_CFEND_RATE_8821C(x) \ -+ ((x) & (~BITS_BASIC_CFEND_RATE_8821C)) -+#define BIT_GET_BASIC_CFEND_RATE_8821C(x) \ -+ (((x) >> BIT_SHIFT_BASIC_CFEND_RATE_8821C) & \ -+ BIT_MASK_BASIC_CFEND_RATE_8821C) -+#define BIT_SET_BASIC_CFEND_RATE_8821C(x, v) \ -+ (BIT_CLEAR_BASIC_CFEND_RATE_8821C(x) | BIT_BASIC_CFEND_RATE_8821C(v)) -+ -+/* 2 REG_STBC_CFEND_RATE_8821C */ -+ -+#define BIT_SHIFT_STBC_CFEND_RATE_8821C 0 -+#define BIT_MASK_STBC_CFEND_RATE_8821C 0x1f -+#define BIT_STBC_CFEND_RATE_8821C(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_RATE_8821C) \ -+ << BIT_SHIFT_STBC_CFEND_RATE_8821C) -+#define BITS_STBC_CFEND_RATE_8821C \ -+ (BIT_MASK_STBC_CFEND_RATE_8821C << BIT_SHIFT_STBC_CFEND_RATE_8821C) -+#define BIT_CLEAR_STBC_CFEND_RATE_8821C(x) ((x) & (~BITS_STBC_CFEND_RATE_8821C)) -+#define BIT_GET_STBC_CFEND_RATE_8821C(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_RATE_8821C) & \ -+ BIT_MASK_STBC_CFEND_RATE_8821C) -+#define BIT_SET_STBC_CFEND_RATE_8821C(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_RATE_8821C(x) | BIT_STBC_CFEND_RATE_8821C(v)) -+ -+/* 2 REG_DATA_SC_8821C */ -+ -+#define BIT_SHIFT_TXSC_40M_8821C 4 -+#define BIT_MASK_TXSC_40M_8821C 0xf -+#define BIT_TXSC_40M_8821C(x) \ -+ (((x) & BIT_MASK_TXSC_40M_8821C) << BIT_SHIFT_TXSC_40M_8821C) -+#define BITS_TXSC_40M_8821C \ -+ (BIT_MASK_TXSC_40M_8821C << BIT_SHIFT_TXSC_40M_8821C) -+#define BIT_CLEAR_TXSC_40M_8821C(x) ((x) & (~BITS_TXSC_40M_8821C)) -+#define BIT_GET_TXSC_40M_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXSC_40M_8821C) & BIT_MASK_TXSC_40M_8821C) -+#define BIT_SET_TXSC_40M_8821C(x, v) \ -+ (BIT_CLEAR_TXSC_40M_8821C(x) | BIT_TXSC_40M_8821C(v)) -+ -+#define BIT_SHIFT_TXSC_20M_8821C 0 -+#define BIT_MASK_TXSC_20M_8821C 0xf -+#define BIT_TXSC_20M_8821C(x) \ -+ (((x) & BIT_MASK_TXSC_20M_8821C) << BIT_SHIFT_TXSC_20M_8821C) -+#define BITS_TXSC_20M_8821C \ -+ (BIT_MASK_TXSC_20M_8821C << BIT_SHIFT_TXSC_20M_8821C) -+#define BIT_CLEAR_TXSC_20M_8821C(x) ((x) & (~BITS_TXSC_20M_8821C)) -+#define BIT_GET_TXSC_20M_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXSC_20M_8821C) & BIT_MASK_TXSC_20M_8821C) -+#define BIT_SET_TXSC_20M_8821C(x, v) \ -+ (BIT_CLEAR_TXSC_20M_8821C(x) | BIT_TXSC_20M_8821C(v)) -+ -+/* 2 REG_MACID_SLEEP3_8821C */ -+ -+#define BIT_SHIFT_MACID127_96_PKTSLEEP_8821C 0 -+#define BIT_MASK_MACID127_96_PKTSLEEP_8821C 0xffffffffL -+#define BIT_MACID127_96_PKTSLEEP_8821C(x) \ -+ (((x) & BIT_MASK_MACID127_96_PKTSLEEP_8821C) \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP_8821C) -+#define BITS_MACID127_96_PKTSLEEP_8821C \ -+ (BIT_MASK_MACID127_96_PKTSLEEP_8821C \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP_8821C) -+#define BIT_CLEAR_MACID127_96_PKTSLEEP_8821C(x) \ -+ ((x) & (~BITS_MACID127_96_PKTSLEEP_8821C)) -+#define BIT_GET_MACID127_96_PKTSLEEP_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_PKTSLEEP_8821C) & \ -+ BIT_MASK_MACID127_96_PKTSLEEP_8821C) -+#define BIT_SET_MACID127_96_PKTSLEEP_8821C(x, v) \ -+ (BIT_CLEAR_MACID127_96_PKTSLEEP_8821C(x) | \ -+ BIT_MACID127_96_PKTSLEEP_8821C(v)) -+ -+/* 2 REG_MACID_SLEEP1_8821C */ -+ -+#define BIT_SHIFT_MACID63_32_PKTSLEEP_8821C 0 -+#define BIT_MASK_MACID63_32_PKTSLEEP_8821C 0xffffffffL -+#define BIT_MACID63_32_PKTSLEEP_8821C(x) \ -+ (((x) & BIT_MASK_MACID63_32_PKTSLEEP_8821C) \ -+ << BIT_SHIFT_MACID63_32_PKTSLEEP_8821C) -+#define BITS_MACID63_32_PKTSLEEP_8821C \ -+ (BIT_MASK_MACID63_32_PKTSLEEP_8821C \ -+ << BIT_SHIFT_MACID63_32_PKTSLEEP_8821C) -+#define BIT_CLEAR_MACID63_32_PKTSLEEP_8821C(x) \ -+ ((x) & (~BITS_MACID63_32_PKTSLEEP_8821C)) -+#define BIT_GET_MACID63_32_PKTSLEEP_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_PKTSLEEP_8821C) & \ -+ BIT_MASK_MACID63_32_PKTSLEEP_8821C) -+#define BIT_SET_MACID63_32_PKTSLEEP_8821C(x, v) \ -+ (BIT_CLEAR_MACID63_32_PKTSLEEP_8821C(x) | \ -+ BIT_MACID63_32_PKTSLEEP_8821C(v)) -+ -+/* 2 REG_ARFR2_V1_8821C */ -+ -+#define BIT_SHIFT_ARFRL2_8821C 0 -+#define BIT_MASK_ARFRL2_8821C 0xffffffffL -+#define BIT_ARFRL2_8821C(x) \ -+ (((x) & BIT_MASK_ARFRL2_8821C) << BIT_SHIFT_ARFRL2_8821C) -+#define BITS_ARFRL2_8821C (BIT_MASK_ARFRL2_8821C << BIT_SHIFT_ARFRL2_8821C) -+#define BIT_CLEAR_ARFRL2_8821C(x) ((x) & (~BITS_ARFRL2_8821C)) -+#define BIT_GET_ARFRL2_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL2_8821C) & BIT_MASK_ARFRL2_8821C) -+#define BIT_SET_ARFRL2_8821C(x, v) \ -+ (BIT_CLEAR_ARFRL2_8821C(x) | BIT_ARFRL2_8821C(v)) -+ -+/* 2 REG_ARFRH2_V1_8821C */ -+ -+#define BIT_SHIFT_ARFRH2_8821C 0 -+#define BIT_MASK_ARFRH2_8821C 0xffffffffL -+#define BIT_ARFRH2_8821C(x) \ -+ (((x) & BIT_MASK_ARFRH2_8821C) << BIT_SHIFT_ARFRH2_8821C) -+#define BITS_ARFRH2_8821C (BIT_MASK_ARFRH2_8821C << BIT_SHIFT_ARFRH2_8821C) -+#define BIT_CLEAR_ARFRH2_8821C(x) ((x) & (~BITS_ARFRH2_8821C)) -+#define BIT_GET_ARFRH2_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH2_8821C) & BIT_MASK_ARFRH2_8821C) -+#define BIT_SET_ARFRH2_8821C(x, v) \ -+ (BIT_CLEAR_ARFRH2_8821C(x) | BIT_ARFRH2_8821C(v)) -+ -+/* 2 REG_ARFR3_V1_8821C */ -+ -+#define BIT_SHIFT_ARFRL3_8821C 0 -+#define BIT_MASK_ARFRL3_8821C 0xffffffffL -+#define BIT_ARFRL3_8821C(x) \ -+ (((x) & BIT_MASK_ARFRL3_8821C) << BIT_SHIFT_ARFRL3_8821C) -+#define BITS_ARFRL3_8821C (BIT_MASK_ARFRL3_8821C << BIT_SHIFT_ARFRL3_8821C) -+#define BIT_CLEAR_ARFRL3_8821C(x) ((x) & (~BITS_ARFRL3_8821C)) -+#define BIT_GET_ARFRL3_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL3_8821C) & BIT_MASK_ARFRL3_8821C) -+#define BIT_SET_ARFRL3_8821C(x, v) \ -+ (BIT_CLEAR_ARFRL3_8821C(x) | BIT_ARFRL3_8821C(v)) -+ -+/* 2 REG_ARFRH3_V1_8821C */ -+ -+#define BIT_SHIFT_ARFRH3_8821C 0 -+#define BIT_MASK_ARFRH3_8821C 0xffffffffL -+#define BIT_ARFRH3_8821C(x) \ -+ (((x) & BIT_MASK_ARFRH3_8821C) << BIT_SHIFT_ARFRH3_8821C) -+#define BITS_ARFRH3_8821C (BIT_MASK_ARFRH3_8821C << BIT_SHIFT_ARFRH3_8821C) -+#define BIT_CLEAR_ARFRH3_8821C(x) ((x) & (~BITS_ARFRH3_8821C)) -+#define BIT_GET_ARFRH3_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH3_8821C) & BIT_MASK_ARFRH3_8821C) -+#define BIT_SET_ARFRH3_8821C(x, v) \ -+ (BIT_CLEAR_ARFRH3_8821C(x) | BIT_ARFRH3_8821C(v)) -+ -+/* 2 REG_ARFR4_8821C */ -+ -+#define BIT_SHIFT_ARFRL4_8821C 0 -+#define BIT_MASK_ARFRL4_8821C 0xffffffffL -+#define BIT_ARFRL4_8821C(x) \ -+ (((x) & BIT_MASK_ARFRL4_8821C) << BIT_SHIFT_ARFRL4_8821C) -+#define BITS_ARFRL4_8821C (BIT_MASK_ARFRL4_8821C << BIT_SHIFT_ARFRL4_8821C) -+#define BIT_CLEAR_ARFRL4_8821C(x) ((x) & (~BITS_ARFRL4_8821C)) -+#define BIT_GET_ARFRL4_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL4_8821C) & BIT_MASK_ARFRL4_8821C) -+#define BIT_SET_ARFRL4_8821C(x, v) \ -+ (BIT_CLEAR_ARFRL4_8821C(x) | BIT_ARFRL4_8821C(v)) -+ -+/* 2 REG_ARFRH4_8821C */ -+ -+#define BIT_SHIFT_ARFRH4_8821C 0 -+#define BIT_MASK_ARFRH4_8821C 0xffffffffL -+#define BIT_ARFRH4_8821C(x) \ -+ (((x) & BIT_MASK_ARFRH4_8821C) << BIT_SHIFT_ARFRH4_8821C) -+#define BITS_ARFRH4_8821C (BIT_MASK_ARFRH4_8821C << BIT_SHIFT_ARFRH4_8821C) -+#define BIT_CLEAR_ARFRH4_8821C(x) ((x) & (~BITS_ARFRH4_8821C)) -+#define BIT_GET_ARFRH4_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH4_8821C) & BIT_MASK_ARFRH4_8821C) -+#define BIT_SET_ARFRH4_8821C(x, v) \ -+ (BIT_CLEAR_ARFRH4_8821C(x) | BIT_ARFRH4_8821C(v)) -+ -+/* 2 REG_ARFR5_8821C */ -+ -+#define BIT_SHIFT_ARFRL5_8821C 0 -+#define BIT_MASK_ARFRL5_8821C 0xffffffffL -+#define BIT_ARFRL5_8821C(x) \ -+ (((x) & BIT_MASK_ARFRL5_8821C) << BIT_SHIFT_ARFRL5_8821C) -+#define BITS_ARFRL5_8821C (BIT_MASK_ARFRL5_8821C << BIT_SHIFT_ARFRL5_8821C) -+#define BIT_CLEAR_ARFRL5_8821C(x) ((x) & (~BITS_ARFRL5_8821C)) -+#define BIT_GET_ARFRL5_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL5_8821C) & BIT_MASK_ARFRL5_8821C) -+#define BIT_SET_ARFRL5_8821C(x, v) \ -+ (BIT_CLEAR_ARFRL5_8821C(x) | BIT_ARFRL5_8821C(v)) -+ -+/* 2 REG_ARFRH5_8821C */ -+ -+#define BIT_SHIFT_ARFRH5_8821C 0 -+#define BIT_MASK_ARFRH5_8821C 0xffffffffL -+#define BIT_ARFRH5_8821C(x) \ -+ (((x) & BIT_MASK_ARFRH5_8821C) << BIT_SHIFT_ARFRH5_8821C) -+#define BITS_ARFRH5_8821C (BIT_MASK_ARFRH5_8821C << BIT_SHIFT_ARFRH5_8821C) -+#define BIT_CLEAR_ARFRH5_8821C(x) ((x) & (~BITS_ARFRH5_8821C)) -+#define BIT_GET_ARFRH5_8821C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH5_8821C) & BIT_MASK_ARFRH5_8821C) -+#define BIT_SET_ARFRH5_8821C(x, v) \ -+ (BIT_CLEAR_ARFRH5_8821C(x) | BIT_ARFRH5_8821C(v)) -+ -+/* 2 REG_TXRPT_START_OFFSET_8821C */ -+ -+#define BIT_SHIFT_R_MUTAB_TXRPT_OFFSET_8821C 24 -+#define BIT_MASK_R_MUTAB_TXRPT_OFFSET_8821C 0xff -+#define BIT_R_MUTAB_TXRPT_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_R_MUTAB_TXRPT_OFFSET_8821C) \ -+ << BIT_SHIFT_R_MUTAB_TXRPT_OFFSET_8821C) -+#define BITS_R_MUTAB_TXRPT_OFFSET_8821C \ -+ (BIT_MASK_R_MUTAB_TXRPT_OFFSET_8821C \ -+ << BIT_SHIFT_R_MUTAB_TXRPT_OFFSET_8821C) -+#define BIT_CLEAR_R_MUTAB_TXRPT_OFFSET_8821C(x) \ -+ ((x) & (~BITS_R_MUTAB_TXRPT_OFFSET_8821C)) -+#define BIT_GET_R_MUTAB_TXRPT_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MUTAB_TXRPT_OFFSET_8821C) & \ -+ BIT_MASK_R_MUTAB_TXRPT_OFFSET_8821C) -+#define BIT_SET_R_MUTAB_TXRPT_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_R_MUTAB_TXRPT_OFFSET_8821C(x) | \ -+ BIT_R_MUTAB_TXRPT_OFFSET_8821C(v)) -+ -+#define BIT__R_RPTFIFO_1K_8821C BIT(16) -+ -+#define BIT_SHIFT_MACID_CTRL_OFFSET_8821C 8 -+#define BIT_MASK_MACID_CTRL_OFFSET_8821C 0xff -+#define BIT_MACID_CTRL_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_MACID_CTRL_OFFSET_8821C) \ -+ << BIT_SHIFT_MACID_CTRL_OFFSET_8821C) -+#define BITS_MACID_CTRL_OFFSET_8821C \ -+ (BIT_MASK_MACID_CTRL_OFFSET_8821C << BIT_SHIFT_MACID_CTRL_OFFSET_8821C) -+#define BIT_CLEAR_MACID_CTRL_OFFSET_8821C(x) \ -+ ((x) & (~BITS_MACID_CTRL_OFFSET_8821C)) -+#define BIT_GET_MACID_CTRL_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID_CTRL_OFFSET_8821C) & \ -+ BIT_MASK_MACID_CTRL_OFFSET_8821C) -+#define BIT_SET_MACID_CTRL_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_MACID_CTRL_OFFSET_8821C(x) | BIT_MACID_CTRL_OFFSET_8821C(v)) -+ -+#define BIT_SHIFT_AMPDU_TXRPT_OFFSET_8821C 0 -+#define BIT_MASK_AMPDU_TXRPT_OFFSET_8821C 0xff -+#define BIT_AMPDU_TXRPT_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_AMPDU_TXRPT_OFFSET_8821C) \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_8821C) -+#define BITS_AMPDU_TXRPT_OFFSET_8821C \ -+ (BIT_MASK_AMPDU_TXRPT_OFFSET_8821C \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_8821C) -+#define BIT_CLEAR_AMPDU_TXRPT_OFFSET_8821C(x) \ -+ ((x) & (~BITS_AMPDU_TXRPT_OFFSET_8821C)) -+#define BIT_GET_AMPDU_TXRPT_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_TXRPT_OFFSET_8821C) & \ -+ BIT_MASK_AMPDU_TXRPT_OFFSET_8821C) -+#define BIT_SET_AMPDU_TXRPT_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_AMPDU_TXRPT_OFFSET_8821C(x) | \ -+ BIT_AMPDU_TXRPT_OFFSET_8821C(v)) -+ -+/* 2 REG_POWER_STAGE1_8821C */ -+#define BIT_PTA_WL_PRI_MASK_CPU_MGQ_8821C BIT(31) -+#define BIT_PTA_WL_PRI_MASK_BCNQ_8821C BIT(30) -+#define BIT_PTA_WL_PRI_MASK_HIQ_8821C BIT(29) -+#define BIT_PTA_WL_PRI_MASK_MGQ_8821C BIT(28) -+#define BIT_PTA_WL_PRI_MASK_BK_8821C BIT(27) -+#define BIT_PTA_WL_PRI_MASK_BE_8821C BIT(26) -+#define BIT_PTA_WL_PRI_MASK_VI_8821C BIT(25) -+#define BIT_PTA_WL_PRI_MASK_VO_8821C BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE1_8821C 0 -+#define BIT_MASK_POWER_STAGE1_8821C 0xffffff -+#define BIT_POWER_STAGE1_8821C(x) \ -+ (((x) & BIT_MASK_POWER_STAGE1_8821C) << BIT_SHIFT_POWER_STAGE1_8821C) -+#define BITS_POWER_STAGE1_8821C \ -+ (BIT_MASK_POWER_STAGE1_8821C << BIT_SHIFT_POWER_STAGE1_8821C) -+#define BIT_CLEAR_POWER_STAGE1_8821C(x) ((x) & (~BITS_POWER_STAGE1_8821C)) -+#define BIT_GET_POWER_STAGE1_8821C(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE1_8821C) & BIT_MASK_POWER_STAGE1_8821C) -+#define BIT_SET_POWER_STAGE1_8821C(x, v) \ -+ (BIT_CLEAR_POWER_STAGE1_8821C(x) | BIT_POWER_STAGE1_8821C(v)) -+ -+/* 2 REG_POWER_STAGE2_8821C */ -+#define BIT__R_CTRL_PKT_POW_ADJ_8821C BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE2_8821C 0 -+#define BIT_MASK_POWER_STAGE2_8821C 0xffffff -+#define BIT_POWER_STAGE2_8821C(x) \ -+ (((x) & BIT_MASK_POWER_STAGE2_8821C) << BIT_SHIFT_POWER_STAGE2_8821C) -+#define BITS_POWER_STAGE2_8821C \ -+ (BIT_MASK_POWER_STAGE2_8821C << BIT_SHIFT_POWER_STAGE2_8821C) -+#define BIT_CLEAR_POWER_STAGE2_8821C(x) ((x) & (~BITS_POWER_STAGE2_8821C)) -+#define BIT_GET_POWER_STAGE2_8821C(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE2_8821C) & BIT_MASK_POWER_STAGE2_8821C) -+#define BIT_SET_POWER_STAGE2_8821C(x, v) \ -+ (BIT_CLEAR_POWER_STAGE2_8821C(x) | BIT_POWER_STAGE2_8821C(v)) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL_8821C */ -+ -+#define BIT_SHIFT_PAD_NUM_THRES_8821C 24 -+#define BIT_MASK_PAD_NUM_THRES_8821C 0x3f -+#define BIT_PAD_NUM_THRES_8821C(x) \ -+ (((x) & BIT_MASK_PAD_NUM_THRES_8821C) << BIT_SHIFT_PAD_NUM_THRES_8821C) -+#define BITS_PAD_NUM_THRES_8821C \ -+ (BIT_MASK_PAD_NUM_THRES_8821C << BIT_SHIFT_PAD_NUM_THRES_8821C) -+#define BIT_CLEAR_PAD_NUM_THRES_8821C(x) ((x) & (~BITS_PAD_NUM_THRES_8821C)) -+#define BIT_GET_PAD_NUM_THRES_8821C(x) \ -+ (((x) >> BIT_SHIFT_PAD_NUM_THRES_8821C) & BIT_MASK_PAD_NUM_THRES_8821C) -+#define BIT_SET_PAD_NUM_THRES_8821C(x, v) \ -+ (BIT_CLEAR_PAD_NUM_THRES_8821C(x) | BIT_PAD_NUM_THRES_8821C(v)) -+ -+#define BIT_R_DMA_THIS_QUEUE_BK_8821C BIT(23) -+#define BIT_R_DMA_THIS_QUEUE_BE_8821C BIT(22) -+#define BIT_R_DMA_THIS_QUEUE_VI_8821C BIT(21) -+#define BIT_R_DMA_THIS_QUEUE_VO_8821C BIT(20) -+ -+#define BIT_SHIFT_R_TOTAL_LEN_TH_8821C 8 -+#define BIT_MASK_R_TOTAL_LEN_TH_8821C 0xfff -+#define BIT_R_TOTAL_LEN_TH_8821C(x) \ -+ (((x) & BIT_MASK_R_TOTAL_LEN_TH_8821C) \ -+ << BIT_SHIFT_R_TOTAL_LEN_TH_8821C) -+#define BITS_R_TOTAL_LEN_TH_8821C \ -+ (BIT_MASK_R_TOTAL_LEN_TH_8821C << BIT_SHIFT_R_TOTAL_LEN_TH_8821C) -+#define BIT_CLEAR_R_TOTAL_LEN_TH_8821C(x) ((x) & (~BITS_R_TOTAL_LEN_TH_8821C)) -+#define BIT_GET_R_TOTAL_LEN_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_TOTAL_LEN_TH_8821C) & \ -+ BIT_MASK_R_TOTAL_LEN_TH_8821C) -+#define BIT_SET_R_TOTAL_LEN_TH_8821C(x, v) \ -+ (BIT_CLEAR_R_TOTAL_LEN_TH_8821C(x) | BIT_R_TOTAL_LEN_TH_8821C(v)) -+ -+#define BIT_EN_NEW_EARLY_8821C BIT(7) -+#define BIT_PRE_TX_CMD_8821C BIT(6) -+ -+#define BIT_SHIFT_NUM_SCL_EN_8821C 4 -+#define BIT_MASK_NUM_SCL_EN_8821C 0x3 -+#define BIT_NUM_SCL_EN_8821C(x) \ -+ (((x) & BIT_MASK_NUM_SCL_EN_8821C) << BIT_SHIFT_NUM_SCL_EN_8821C) -+#define BITS_NUM_SCL_EN_8821C \ -+ (BIT_MASK_NUM_SCL_EN_8821C << BIT_SHIFT_NUM_SCL_EN_8821C) -+#define BIT_CLEAR_NUM_SCL_EN_8821C(x) ((x) & (~BITS_NUM_SCL_EN_8821C)) -+#define BIT_GET_NUM_SCL_EN_8821C(x) \ -+ (((x) >> BIT_SHIFT_NUM_SCL_EN_8821C) & BIT_MASK_NUM_SCL_EN_8821C) -+#define BIT_SET_NUM_SCL_EN_8821C(x, v) \ -+ (BIT_CLEAR_NUM_SCL_EN_8821C(x) | BIT_NUM_SCL_EN_8821C(v)) -+ -+#define BIT_BK_EN_8821C BIT(3) -+#define BIT_BE_EN_8821C BIT(2) -+#define BIT_VI_EN_8821C BIT(1) -+#define BIT_VO_EN_8821C BIT(0) -+ -+/* 2 REG_PKT_LIFE_TIME_8821C */ -+ -+#define BIT_SHIFT_PKT_LIFTIME_BEBK_8821C 16 -+#define BIT_MASK_PKT_LIFTIME_BEBK_8821C 0xffff -+#define BIT_PKT_LIFTIME_BEBK_8821C(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_BEBK_8821C) \ -+ << BIT_SHIFT_PKT_LIFTIME_BEBK_8821C) -+#define BITS_PKT_LIFTIME_BEBK_8821C \ -+ (BIT_MASK_PKT_LIFTIME_BEBK_8821C << BIT_SHIFT_PKT_LIFTIME_BEBK_8821C) -+#define BIT_CLEAR_PKT_LIFTIME_BEBK_8821C(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_BEBK_8821C)) -+#define BIT_GET_PKT_LIFTIME_BEBK_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_BEBK_8821C) & \ -+ BIT_MASK_PKT_LIFTIME_BEBK_8821C) -+#define BIT_SET_PKT_LIFTIME_BEBK_8821C(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_BEBK_8821C(x) | BIT_PKT_LIFTIME_BEBK_8821C(v)) -+ -+#define BIT_SHIFT_PKT_LIFTIME_VOVI_8821C 0 -+#define BIT_MASK_PKT_LIFTIME_VOVI_8821C 0xffff -+#define BIT_PKT_LIFTIME_VOVI_8821C(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_VOVI_8821C) \ -+ << BIT_SHIFT_PKT_LIFTIME_VOVI_8821C) -+#define BITS_PKT_LIFTIME_VOVI_8821C \ -+ (BIT_MASK_PKT_LIFTIME_VOVI_8821C << BIT_SHIFT_PKT_LIFTIME_VOVI_8821C) -+#define BIT_CLEAR_PKT_LIFTIME_VOVI_8821C(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_VOVI_8821C)) -+#define BIT_GET_PKT_LIFTIME_VOVI_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_VOVI_8821C) & \ -+ BIT_MASK_PKT_LIFTIME_VOVI_8821C) -+#define BIT_SET_PKT_LIFTIME_VOVI_8821C(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_VOVI_8821C(x) | BIT_PKT_LIFTIME_VOVI_8821C(v)) -+ -+/* 2 REG_STBC_SETTING_8821C */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_L_8821C 4 -+#define BIT_MASK_CDEND_TXTIME_L_8821C 0xf -+#define BIT_CDEND_TXTIME_L_8821C(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_L_8821C) \ -+ << BIT_SHIFT_CDEND_TXTIME_L_8821C) -+#define BITS_CDEND_TXTIME_L_8821C \ -+ (BIT_MASK_CDEND_TXTIME_L_8821C << BIT_SHIFT_CDEND_TXTIME_L_8821C) -+#define BIT_CLEAR_CDEND_TXTIME_L_8821C(x) ((x) & (~BITS_CDEND_TXTIME_L_8821C)) -+#define BIT_GET_CDEND_TXTIME_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_L_8821C) & \ -+ BIT_MASK_CDEND_TXTIME_L_8821C) -+#define BIT_SET_CDEND_TXTIME_L_8821C(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_L_8821C(x) | BIT_CDEND_TXTIME_L_8821C(v)) -+ -+#define BIT_SHIFT_NESS_8821C 2 -+#define BIT_MASK_NESS_8821C 0x3 -+#define BIT_NESS_8821C(x) (((x) & BIT_MASK_NESS_8821C) << BIT_SHIFT_NESS_8821C) -+#define BITS_NESS_8821C (BIT_MASK_NESS_8821C << BIT_SHIFT_NESS_8821C) -+#define BIT_CLEAR_NESS_8821C(x) ((x) & (~BITS_NESS_8821C)) -+#define BIT_GET_NESS_8821C(x) \ -+ (((x) >> BIT_SHIFT_NESS_8821C) & BIT_MASK_NESS_8821C) -+#define BIT_SET_NESS_8821C(x, v) (BIT_CLEAR_NESS_8821C(x) | BIT_NESS_8821C(v)) -+ -+#define BIT_SHIFT_STBC_CFEND_8821C 0 -+#define BIT_MASK_STBC_CFEND_8821C 0x3 -+#define BIT_STBC_CFEND_8821C(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_8821C) << BIT_SHIFT_STBC_CFEND_8821C) -+#define BITS_STBC_CFEND_8821C \ -+ (BIT_MASK_STBC_CFEND_8821C << BIT_SHIFT_STBC_CFEND_8821C) -+#define BIT_CLEAR_STBC_CFEND_8821C(x) ((x) & (~BITS_STBC_CFEND_8821C)) -+#define BIT_GET_STBC_CFEND_8821C(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_8821C) & BIT_MASK_STBC_CFEND_8821C) -+#define BIT_SET_STBC_CFEND_8821C(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_8821C(x) | BIT_STBC_CFEND_8821C(v)) -+ -+/* 2 REG_STBC_SETTING2_8821C */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_H_8821C 0 -+#define BIT_MASK_CDEND_TXTIME_H_8821C 0x1f -+#define BIT_CDEND_TXTIME_H_8821C(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_H_8821C) \ -+ << BIT_SHIFT_CDEND_TXTIME_H_8821C) -+#define BITS_CDEND_TXTIME_H_8821C \ -+ (BIT_MASK_CDEND_TXTIME_H_8821C << BIT_SHIFT_CDEND_TXTIME_H_8821C) -+#define BIT_CLEAR_CDEND_TXTIME_H_8821C(x) ((x) & (~BITS_CDEND_TXTIME_H_8821C)) -+#define BIT_GET_CDEND_TXTIME_H_8821C(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_H_8821C) & \ -+ BIT_MASK_CDEND_TXTIME_H_8821C) -+#define BIT_SET_CDEND_TXTIME_H_8821C(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_H_8821C(x) | BIT_CDEND_TXTIME_H_8821C(v)) -+ -+/* 2 REG_QUEUE_CTRL_8821C */ -+#define BIT_PTA_EDCCA_EN_8821C BIT(5) -+#define BIT_PTA_WL_TX_EN_8821C BIT(4) -+#define BIT_R_USE_DATA_BW_8821C BIT(3) -+#define BIT_TRI_PKT_INT_MODE1_8821C BIT(2) -+#define BIT_TRI_PKT_INT_MODE0_8821C BIT(1) -+#define BIT_ACQ_MODE_SEL_8821C BIT(0) -+ -+/* 2 REG_SINGLE_AMPDU_CTRL_8821C */ -+#define BIT_EN_SINGLE_APMDU_8821C BIT(7) -+ -+/* 2 REG_PROT_MODE_CTRL_8821C */ -+ -+#define BIT_SHIFT_RTS_MAX_AGG_NUM_8821C 24 -+#define BIT_MASK_RTS_MAX_AGG_NUM_8821C 0x3f -+#define BIT_RTS_MAX_AGG_NUM_8821C(x) \ -+ (((x) & BIT_MASK_RTS_MAX_AGG_NUM_8821C) \ -+ << BIT_SHIFT_RTS_MAX_AGG_NUM_8821C) -+#define BITS_RTS_MAX_AGG_NUM_8821C \ -+ (BIT_MASK_RTS_MAX_AGG_NUM_8821C << BIT_SHIFT_RTS_MAX_AGG_NUM_8821C) -+#define BIT_CLEAR_RTS_MAX_AGG_NUM_8821C(x) ((x) & (~BITS_RTS_MAX_AGG_NUM_8821C)) -+#define BIT_GET_RTS_MAX_AGG_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_RTS_MAX_AGG_NUM_8821C) & \ -+ BIT_MASK_RTS_MAX_AGG_NUM_8821C) -+#define BIT_SET_RTS_MAX_AGG_NUM_8821C(x, v) \ -+ (BIT_CLEAR_RTS_MAX_AGG_NUM_8821C(x) | BIT_RTS_MAX_AGG_NUM_8821C(v)) -+ -+#define BIT_SHIFT_MAX_AGG_NUM_8821C 16 -+#define BIT_MASK_MAX_AGG_NUM_8821C 0x3f -+#define BIT_MAX_AGG_NUM_8821C(x) \ -+ (((x) & BIT_MASK_MAX_AGG_NUM_8821C) << BIT_SHIFT_MAX_AGG_NUM_8821C) -+#define BITS_MAX_AGG_NUM_8821C \ -+ (BIT_MASK_MAX_AGG_NUM_8821C << BIT_SHIFT_MAX_AGG_NUM_8821C) -+#define BIT_CLEAR_MAX_AGG_NUM_8821C(x) ((x) & (~BITS_MAX_AGG_NUM_8821C)) -+#define BIT_GET_MAX_AGG_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_MAX_AGG_NUM_8821C) & BIT_MASK_MAX_AGG_NUM_8821C) -+#define BIT_SET_MAX_AGG_NUM_8821C(x, v) \ -+ (BIT_CLEAR_MAX_AGG_NUM_8821C(x) | BIT_MAX_AGG_NUM_8821C(v)) -+ -+#define BIT_SHIFT_RTS_TXTIME_TH_8821C 8 -+#define BIT_MASK_RTS_TXTIME_TH_8821C 0xff -+#define BIT_RTS_TXTIME_TH_8821C(x) \ -+ (((x) & BIT_MASK_RTS_TXTIME_TH_8821C) << BIT_SHIFT_RTS_TXTIME_TH_8821C) -+#define BITS_RTS_TXTIME_TH_8821C \ -+ (BIT_MASK_RTS_TXTIME_TH_8821C << BIT_SHIFT_RTS_TXTIME_TH_8821C) -+#define BIT_CLEAR_RTS_TXTIME_TH_8821C(x) ((x) & (~BITS_RTS_TXTIME_TH_8821C)) -+#define BIT_GET_RTS_TXTIME_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_RTS_TXTIME_TH_8821C) & BIT_MASK_RTS_TXTIME_TH_8821C) -+#define BIT_SET_RTS_TXTIME_TH_8821C(x, v) \ -+ (BIT_CLEAR_RTS_TXTIME_TH_8821C(x) | BIT_RTS_TXTIME_TH_8821C(v)) -+ -+#define BIT_SHIFT_RTS_LEN_TH_8821C 0 -+#define BIT_MASK_RTS_LEN_TH_8821C 0xff -+#define BIT_RTS_LEN_TH_8821C(x) \ -+ (((x) & BIT_MASK_RTS_LEN_TH_8821C) << BIT_SHIFT_RTS_LEN_TH_8821C) -+#define BITS_RTS_LEN_TH_8821C \ -+ (BIT_MASK_RTS_LEN_TH_8821C << BIT_SHIFT_RTS_LEN_TH_8821C) -+#define BIT_CLEAR_RTS_LEN_TH_8821C(x) ((x) & (~BITS_RTS_LEN_TH_8821C)) -+#define BIT_GET_RTS_LEN_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_RTS_LEN_TH_8821C) & BIT_MASK_RTS_LEN_TH_8821C) -+#define BIT_SET_RTS_LEN_TH_8821C(x, v) \ -+ (BIT_CLEAR_RTS_LEN_TH_8821C(x) | BIT_RTS_LEN_TH_8821C(v)) -+ -+/* 2 REG_BAR_MODE_CTRL_8821C */ -+ -+#define BIT_SHIFT_BAR_RTY_LMT_8821C 16 -+#define BIT_MASK_BAR_RTY_LMT_8821C 0x3 -+#define BIT_BAR_RTY_LMT_8821C(x) \ -+ (((x) & BIT_MASK_BAR_RTY_LMT_8821C) << BIT_SHIFT_BAR_RTY_LMT_8821C) -+#define BITS_BAR_RTY_LMT_8821C \ -+ (BIT_MASK_BAR_RTY_LMT_8821C << BIT_SHIFT_BAR_RTY_LMT_8821C) -+#define BIT_CLEAR_BAR_RTY_LMT_8821C(x) ((x) & (~BITS_BAR_RTY_LMT_8821C)) -+#define BIT_GET_BAR_RTY_LMT_8821C(x) \ -+ (((x) >> BIT_SHIFT_BAR_RTY_LMT_8821C) & BIT_MASK_BAR_RTY_LMT_8821C) -+#define BIT_SET_BAR_RTY_LMT_8821C(x, v) \ -+ (BIT_CLEAR_BAR_RTY_LMT_8821C(x) | BIT_BAR_RTY_LMT_8821C(v)) -+ -+#define BIT_SHIFT_BAR_PKT_TXTIME_TH_8821C 8 -+#define BIT_MASK_BAR_PKT_TXTIME_TH_8821C 0xff -+#define BIT_BAR_PKT_TXTIME_TH_8821C(x) \ -+ (((x) & BIT_MASK_BAR_PKT_TXTIME_TH_8821C) \ -+ << BIT_SHIFT_BAR_PKT_TXTIME_TH_8821C) -+#define BITS_BAR_PKT_TXTIME_TH_8821C \ -+ (BIT_MASK_BAR_PKT_TXTIME_TH_8821C << BIT_SHIFT_BAR_PKT_TXTIME_TH_8821C) -+#define BIT_CLEAR_BAR_PKT_TXTIME_TH_8821C(x) \ -+ ((x) & (~BITS_BAR_PKT_TXTIME_TH_8821C)) -+#define BIT_GET_BAR_PKT_TXTIME_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKT_TXTIME_TH_8821C) & \ -+ BIT_MASK_BAR_PKT_TXTIME_TH_8821C) -+#define BIT_SET_BAR_PKT_TXTIME_TH_8821C(x, v) \ -+ (BIT_CLEAR_BAR_PKT_TXTIME_TH_8821C(x) | BIT_BAR_PKT_TXTIME_TH_8821C(v)) -+ -+#define BIT_BAR_EN_V1_8821C BIT(6) -+ -+#define BIT_SHIFT_BAR_PKTNUM_TH_V1_8821C 0 -+#define BIT_MASK_BAR_PKTNUM_TH_V1_8821C 0x3f -+#define BIT_BAR_PKTNUM_TH_V1_8821C(x) \ -+ (((x) & BIT_MASK_BAR_PKTNUM_TH_V1_8821C) \ -+ << BIT_SHIFT_BAR_PKTNUM_TH_V1_8821C) -+#define BITS_BAR_PKTNUM_TH_V1_8821C \ -+ (BIT_MASK_BAR_PKTNUM_TH_V1_8821C << BIT_SHIFT_BAR_PKTNUM_TH_V1_8821C) -+#define BIT_CLEAR_BAR_PKTNUM_TH_V1_8821C(x) \ -+ ((x) & (~BITS_BAR_PKTNUM_TH_V1_8821C)) -+#define BIT_GET_BAR_PKTNUM_TH_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKTNUM_TH_V1_8821C) & \ -+ BIT_MASK_BAR_PKTNUM_TH_V1_8821C) -+#define BIT_SET_BAR_PKTNUM_TH_V1_8821C(x, v) \ -+ (BIT_CLEAR_BAR_PKTNUM_TH_V1_8821C(x) | BIT_BAR_PKTNUM_TH_V1_8821C(v)) -+ -+/* 2 REG_RA_TRY_RATE_AGG_LMT_8821C */ -+ -+#define BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8821C 0 -+#define BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8821C 0x3f -+#define BIT_RA_TRY_RATE_AGG_LMT_V1_8821C(x) \ -+ (((x) & BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8821C) \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8821C) -+#define BITS_RA_TRY_RATE_AGG_LMT_V1_8821C \ -+ (BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8821C \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8821C) -+#define BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8821C(x) \ -+ ((x) & (~BITS_RA_TRY_RATE_AGG_LMT_V1_8821C)) -+#define BIT_GET_RA_TRY_RATE_AGG_LMT_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8821C) & \ -+ BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8821C) -+#define BIT_SET_RA_TRY_RATE_AGG_LMT_V1_8821C(x, v) \ -+ (BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8821C(x) | \ -+ BIT_RA_TRY_RATE_AGG_LMT_V1_8821C(v)) -+ -+/* 2 REG_MACID_SLEEP2_8821C */ -+ -+#define BIT_SHIFT_MACID95_64PKTSLEEP_8821C 0 -+#define BIT_MASK_MACID95_64PKTSLEEP_8821C 0xffffffffL -+#define BIT_MACID95_64PKTSLEEP_8821C(x) \ -+ (((x) & BIT_MASK_MACID95_64PKTSLEEP_8821C) \ -+ << BIT_SHIFT_MACID95_64PKTSLEEP_8821C) -+#define BITS_MACID95_64PKTSLEEP_8821C \ -+ (BIT_MASK_MACID95_64PKTSLEEP_8821C \ -+ << BIT_SHIFT_MACID95_64PKTSLEEP_8821C) -+#define BIT_CLEAR_MACID95_64PKTSLEEP_8821C(x) \ -+ ((x) & (~BITS_MACID95_64PKTSLEEP_8821C)) -+#define BIT_GET_MACID95_64PKTSLEEP_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64PKTSLEEP_8821C) & \ -+ BIT_MASK_MACID95_64PKTSLEEP_8821C) -+#define BIT_SET_MACID95_64PKTSLEEP_8821C(x, v) \ -+ (BIT_CLEAR_MACID95_64PKTSLEEP_8821C(x) | \ -+ BIT_MACID95_64PKTSLEEP_8821C(v)) -+ -+/* 2 REG_MACID_SLEEP_8821C */ -+ -+#define BIT_SHIFT_MACID31_0_PKTSLEEP_8821C 0 -+#define BIT_MASK_MACID31_0_PKTSLEEP_8821C 0xffffffffL -+#define BIT_MACID31_0_PKTSLEEP_8821C(x) \ -+ (((x) & BIT_MASK_MACID31_0_PKTSLEEP_8821C) \ -+ << BIT_SHIFT_MACID31_0_PKTSLEEP_8821C) -+#define BITS_MACID31_0_PKTSLEEP_8821C \ -+ (BIT_MASK_MACID31_0_PKTSLEEP_8821C \ -+ << BIT_SHIFT_MACID31_0_PKTSLEEP_8821C) -+#define BIT_CLEAR_MACID31_0_PKTSLEEP_8821C(x) \ -+ ((x) & (~BITS_MACID31_0_PKTSLEEP_8821C)) -+#define BIT_GET_MACID31_0_PKTSLEEP_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_PKTSLEEP_8821C) & \ -+ BIT_MASK_MACID31_0_PKTSLEEP_8821C) -+#define BIT_SET_MACID31_0_PKTSLEEP_8821C(x, v) \ -+ (BIT_CLEAR_MACID31_0_PKTSLEEP_8821C(x) | \ -+ BIT_MACID31_0_PKTSLEEP_8821C(v)) -+ -+/* 2 REG_HW_SEQ0_8821C */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ0_8821C 0 -+#define BIT_MASK_HW_SSN_SEQ0_8821C 0xfff -+#define BIT_HW_SSN_SEQ0_8821C(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ0_8821C) << BIT_SHIFT_HW_SSN_SEQ0_8821C) -+#define BITS_HW_SSN_SEQ0_8821C \ -+ (BIT_MASK_HW_SSN_SEQ0_8821C << BIT_SHIFT_HW_SSN_SEQ0_8821C) -+#define BIT_CLEAR_HW_SSN_SEQ0_8821C(x) ((x) & (~BITS_HW_SSN_SEQ0_8821C)) -+#define BIT_GET_HW_SSN_SEQ0_8821C(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ0_8821C) & BIT_MASK_HW_SSN_SEQ0_8821C) -+#define BIT_SET_HW_SSN_SEQ0_8821C(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ0_8821C(x) | BIT_HW_SSN_SEQ0_8821C(v)) -+ -+/* 2 REG_HW_SEQ1_8821C */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ1_8821C 0 -+#define BIT_MASK_HW_SSN_SEQ1_8821C 0xfff -+#define BIT_HW_SSN_SEQ1_8821C(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ1_8821C) << BIT_SHIFT_HW_SSN_SEQ1_8821C) -+#define BITS_HW_SSN_SEQ1_8821C \ -+ (BIT_MASK_HW_SSN_SEQ1_8821C << BIT_SHIFT_HW_SSN_SEQ1_8821C) -+#define BIT_CLEAR_HW_SSN_SEQ1_8821C(x) ((x) & (~BITS_HW_SSN_SEQ1_8821C)) -+#define BIT_GET_HW_SSN_SEQ1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ1_8821C) & BIT_MASK_HW_SSN_SEQ1_8821C) -+#define BIT_SET_HW_SSN_SEQ1_8821C(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ1_8821C(x) | BIT_HW_SSN_SEQ1_8821C(v)) -+ -+/* 2 REG_HW_SEQ2_8821C */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ2_8821C 0 -+#define BIT_MASK_HW_SSN_SEQ2_8821C 0xfff -+#define BIT_HW_SSN_SEQ2_8821C(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ2_8821C) << BIT_SHIFT_HW_SSN_SEQ2_8821C) -+#define BITS_HW_SSN_SEQ2_8821C \ -+ (BIT_MASK_HW_SSN_SEQ2_8821C << BIT_SHIFT_HW_SSN_SEQ2_8821C) -+#define BIT_CLEAR_HW_SSN_SEQ2_8821C(x) ((x) & (~BITS_HW_SSN_SEQ2_8821C)) -+#define BIT_GET_HW_SSN_SEQ2_8821C(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ2_8821C) & BIT_MASK_HW_SSN_SEQ2_8821C) -+#define BIT_SET_HW_SSN_SEQ2_8821C(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ2_8821C(x) | BIT_HW_SSN_SEQ2_8821C(v)) -+ -+/* 2 REG_HW_SEQ3_8821C */ -+ -+#define BIT_SHIFT_CSI_HWSEQ_SEL_8821C 12 -+#define BIT_MASK_CSI_HWSEQ_SEL_8821C 0x3 -+#define BIT_CSI_HWSEQ_SEL_8821C(x) \ -+ (((x) & BIT_MASK_CSI_HWSEQ_SEL_8821C) << BIT_SHIFT_CSI_HWSEQ_SEL_8821C) -+#define BITS_CSI_HWSEQ_SEL_8821C \ -+ (BIT_MASK_CSI_HWSEQ_SEL_8821C << BIT_SHIFT_CSI_HWSEQ_SEL_8821C) -+#define BIT_CLEAR_CSI_HWSEQ_SEL_8821C(x) ((x) & (~BITS_CSI_HWSEQ_SEL_8821C)) -+#define BIT_GET_CSI_HWSEQ_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_CSI_HWSEQ_SEL_8821C) & BIT_MASK_CSI_HWSEQ_SEL_8821C) -+#define BIT_SET_CSI_HWSEQ_SEL_8821C(x, v) \ -+ (BIT_CLEAR_CSI_HWSEQ_SEL_8821C(x) | BIT_CSI_HWSEQ_SEL_8821C(v)) -+ -+#define BIT_SHIFT_HW_SSN_SEQ3_8821C 0 -+#define BIT_MASK_HW_SSN_SEQ3_8821C 0xfff -+#define BIT_HW_SSN_SEQ3_8821C(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ3_8821C) << BIT_SHIFT_HW_SSN_SEQ3_8821C) -+#define BITS_HW_SSN_SEQ3_8821C \ -+ (BIT_MASK_HW_SSN_SEQ3_8821C << BIT_SHIFT_HW_SSN_SEQ3_8821C) -+#define BIT_CLEAR_HW_SSN_SEQ3_8821C(x) ((x) & (~BITS_HW_SSN_SEQ3_8821C)) -+#define BIT_GET_HW_SSN_SEQ3_8821C(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ3_8821C) & BIT_MASK_HW_SSN_SEQ3_8821C) -+#define BIT_SET_HW_SSN_SEQ3_8821C(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ3_8821C(x) | BIT_HW_SSN_SEQ3_8821C(v)) -+ -+/* 2 REG_NULL_PKT_STATUS_V1_8821C */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V2_8821C 2 -+#define BIT_MASK_PTCL_TOTAL_PG_V2_8821C 0x3fff -+#define BIT_PTCL_TOTAL_PG_V2_8821C(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V2_8821C) \ -+ << BIT_SHIFT_PTCL_TOTAL_PG_V2_8821C) -+#define BITS_PTCL_TOTAL_PG_V2_8821C \ -+ (BIT_MASK_PTCL_TOTAL_PG_V2_8821C << BIT_SHIFT_PTCL_TOTAL_PG_V2_8821C) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V2_8821C(x) \ -+ ((x) & (~BITS_PTCL_TOTAL_PG_V2_8821C)) -+#define BIT_GET_PTCL_TOTAL_PG_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V2_8821C) & \ -+ BIT_MASK_PTCL_TOTAL_PG_V2_8821C) -+#define BIT_SET_PTCL_TOTAL_PG_V2_8821C(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V2_8821C(x) | BIT_PTCL_TOTAL_PG_V2_8821C(v)) -+ -+#define BIT_TX_NULL_1_8821C BIT(1) -+#define BIT_TX_NULL_0_8821C BIT(0) -+ -+/* 2 REG_PTCL_ERR_STATUS_8821C */ -+#define BIT_PTCL_RATE_TABLE_INVALID_8821C BIT(7) -+#define BIT_FTM_T2R_ERROR_8821C BIT(6) -+#define BIT_PTCL_ERR0_8821C BIT(5) -+#define BIT_PTCL_ERR1_8821C BIT(4) -+#define BIT_PTCL_ERR2_8821C BIT(3) -+#define BIT_PTCL_ERR3_8821C BIT(2) -+#define BIT_PTCL_ERR4_8821C BIT(1) -+#define BIT_PTCL_ERR5_8821C BIT(0) -+ -+/* 2 REG_NULL_PKT_STATUS_EXTEND_8821C */ -+#define BIT_CLI3_TX_NULL_1_8821C BIT(7) -+#define BIT_CLI3_TX_NULL_0_8821C BIT(6) -+#define BIT_CLI2_TX_NULL_1_8821C BIT(5) -+#define BIT_CLI2_TX_NULL_0_8821C BIT(4) -+#define BIT_CLI1_TX_NULL_1_8821C BIT(3) -+#define BIT_CLI1_TX_NULL_0_8821C BIT(2) -+#define BIT_CLI0_TX_NULL_1_8821C BIT(1) -+#define BIT_CLI0_TX_NULL_0_8821C BIT(0) -+ -+/* 2 REG_VIDEO_ENHANCEMENT_FUN_8821C */ -+#define BIT_HIQ_DROP_8821C BIT(7) -+#define BIT_MGQ_DROP_8821C BIT(6) -+#define BIT_VIDEO_JUST_DROP_8821C BIT(1) -+#define BIT_VIDEO_ENHANCEMENT_FUN_EN_8821C BIT(0) -+ -+/* 2 REG_PRECNT_CTRL_8821C */ -+#define BIT_EN_PRECNT_8821C BIT(11) -+ -+#define BIT_SHIFT_PRECNT_TH_8821C 0 -+#define BIT_MASK_PRECNT_TH_8821C 0x7ff -+#define BIT_PRECNT_TH_8821C(x) \ -+ (((x) & BIT_MASK_PRECNT_TH_8821C) << BIT_SHIFT_PRECNT_TH_8821C) -+#define BITS_PRECNT_TH_8821C \ -+ (BIT_MASK_PRECNT_TH_8821C << BIT_SHIFT_PRECNT_TH_8821C) -+#define BIT_CLEAR_PRECNT_TH_8821C(x) ((x) & (~BITS_PRECNT_TH_8821C)) -+#define BIT_GET_PRECNT_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_PRECNT_TH_8821C) & BIT_MASK_PRECNT_TH_8821C) -+#define BIT_SET_PRECNT_TH_8821C(x, v) \ -+ (BIT_CLEAR_PRECNT_TH_8821C(x) | BIT_PRECNT_TH_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_BT_POLLUTE_PKT_CNT_8821C */ -+ -+#define BIT_SHIFT_BT_POLLUTE_PKT_CNT_8821C 0 -+#define BIT_MASK_BT_POLLUTE_PKT_CNT_8821C 0xffff -+#define BIT_BT_POLLUTE_PKT_CNT_8821C(x) \ -+ (((x) & BIT_MASK_BT_POLLUTE_PKT_CNT_8821C) \ -+ << BIT_SHIFT_BT_POLLUTE_PKT_CNT_8821C) -+#define BITS_BT_POLLUTE_PKT_CNT_8821C \ -+ (BIT_MASK_BT_POLLUTE_PKT_CNT_8821C \ -+ << BIT_SHIFT_BT_POLLUTE_PKT_CNT_8821C) -+#define BIT_CLEAR_BT_POLLUTE_PKT_CNT_8821C(x) \ -+ ((x) & (~BITS_BT_POLLUTE_PKT_CNT_8821C)) -+#define BIT_GET_BT_POLLUTE_PKT_CNT_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_POLLUTE_PKT_CNT_8821C) & \ -+ BIT_MASK_BT_POLLUTE_PKT_CNT_8821C) -+#define BIT_SET_BT_POLLUTE_PKT_CNT_8821C(x, v) \ -+ (BIT_CLEAR_BT_POLLUTE_PKT_CNT_8821C(x) | \ -+ BIT_BT_POLLUTE_PKT_CNT_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_PTCL_DBG_8821C */ -+ -+#define BIT_SHIFT_PTCL_DBG_8821C 0 -+#define BIT_MASK_PTCL_DBG_8821C 0xffffffffL -+#define BIT_PTCL_DBG_8821C(x) \ -+ (((x) & BIT_MASK_PTCL_DBG_8821C) << BIT_SHIFT_PTCL_DBG_8821C) -+#define BITS_PTCL_DBG_8821C \ -+ (BIT_MASK_PTCL_DBG_8821C << BIT_SHIFT_PTCL_DBG_8821C) -+#define BIT_CLEAR_PTCL_DBG_8821C(x) ((x) & (~BITS_PTCL_DBG_8821C)) -+#define BIT_GET_PTCL_DBG_8821C(x) \ -+ (((x) >> BIT_SHIFT_PTCL_DBG_8821C) & BIT_MASK_PTCL_DBG_8821C) -+#define BIT_SET_PTCL_DBG_8821C(x, v) \ -+ (BIT_CLEAR_PTCL_DBG_8821C(x) | BIT_PTCL_DBG_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_CPUMGQ_TIMER_CTRL2_8821C */ -+ -+#define BIT_SHIFT_TRI_HEAD_ADDR_8821C 16 -+#define BIT_MASK_TRI_HEAD_ADDR_8821C 0xfff -+#define BIT_TRI_HEAD_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_TRI_HEAD_ADDR_8821C) << BIT_SHIFT_TRI_HEAD_ADDR_8821C) -+#define BITS_TRI_HEAD_ADDR_8821C \ -+ (BIT_MASK_TRI_HEAD_ADDR_8821C << BIT_SHIFT_TRI_HEAD_ADDR_8821C) -+#define BIT_CLEAR_TRI_HEAD_ADDR_8821C(x) ((x) & (~BITS_TRI_HEAD_ADDR_8821C)) -+#define BIT_GET_TRI_HEAD_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_TRI_HEAD_ADDR_8821C) & BIT_MASK_TRI_HEAD_ADDR_8821C) -+#define BIT_SET_TRI_HEAD_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_TRI_HEAD_ADDR_8821C(x) | BIT_TRI_HEAD_ADDR_8821C(v)) -+ -+#define BIT_DROP_TH_EN_8821C BIT(8) -+ -+#define BIT_SHIFT_DROP_TH_8821C 0 -+#define BIT_MASK_DROP_TH_8821C 0xff -+#define BIT_DROP_TH_8821C(x) \ -+ (((x) & BIT_MASK_DROP_TH_8821C) << BIT_SHIFT_DROP_TH_8821C) -+#define BITS_DROP_TH_8821C (BIT_MASK_DROP_TH_8821C << BIT_SHIFT_DROP_TH_8821C) -+#define BIT_CLEAR_DROP_TH_8821C(x) ((x) & (~BITS_DROP_TH_8821C)) -+#define BIT_GET_DROP_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_DROP_TH_8821C) & BIT_MASK_DROP_TH_8821C) -+#define BIT_SET_DROP_TH_8821C(x, v) \ -+ (BIT_CLEAR_DROP_TH_8821C(x) | BIT_DROP_TH_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_DUMMY_PAGE4_V1_8821C */ -+ -+/* 2 REG_MOREDATA_8821C */ -+#define BIT_MOREDATA_CTRL2_EN_V1_8821C BIT(3) -+#define BIT_MOREDATA_CTRL1_EN_V1_8821C BIT(2) -+#define BIT_PKTIN_MOREDATA_REPLACE_ENABLE_V1_8821C BIT(0) -+ -+/* 2 REG_Q0_Q1_INFO_8821C */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8821C BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8821C 28 -+#define BIT_MASK_GTAB_ID_8821C 0x7 -+#define BIT_GTAB_ID_8821C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8821C) << BIT_SHIFT_GTAB_ID_8821C) -+#define BITS_GTAB_ID_8821C (BIT_MASK_GTAB_ID_8821C << BIT_SHIFT_GTAB_ID_8821C) -+#define BIT_CLEAR_GTAB_ID_8821C(x) ((x) & (~BITS_GTAB_ID_8821C)) -+#define BIT_GET_GTAB_ID_8821C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8821C) & BIT_MASK_GTAB_ID_8821C) -+#define BIT_SET_GTAB_ID_8821C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8821C(x) | BIT_GTAB_ID_8821C(v)) -+ -+#define BIT_SHIFT_AC1_PKT_INFO_8821C 16 -+#define BIT_MASK_AC1_PKT_INFO_8821C 0xfff -+#define BIT_AC1_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_AC1_PKT_INFO_8821C) << BIT_SHIFT_AC1_PKT_INFO_8821C) -+#define BITS_AC1_PKT_INFO_8821C \ -+ (BIT_MASK_AC1_PKT_INFO_8821C << BIT_SHIFT_AC1_PKT_INFO_8821C) -+#define BIT_CLEAR_AC1_PKT_INFO_8821C(x) ((x) & (~BITS_AC1_PKT_INFO_8821C)) -+#define BIT_GET_AC1_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_AC1_PKT_INFO_8821C) & BIT_MASK_AC1_PKT_INFO_8821C) -+#define BIT_SET_AC1_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_AC1_PKT_INFO_8821C(x) | BIT_AC1_PKT_INFO_8821C(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8821C BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8821C 12 -+#define BIT_MASK_GTAB_ID_V1_8821C 0x7 -+#define BIT_GTAB_ID_V1_8821C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8821C) << BIT_SHIFT_GTAB_ID_V1_8821C) -+#define BITS_GTAB_ID_V1_8821C \ -+ (BIT_MASK_GTAB_ID_V1_8821C << BIT_SHIFT_GTAB_ID_V1_8821C) -+#define BIT_CLEAR_GTAB_ID_V1_8821C(x) ((x) & (~BITS_GTAB_ID_V1_8821C)) -+#define BIT_GET_GTAB_ID_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8821C) & BIT_MASK_GTAB_ID_V1_8821C) -+#define BIT_SET_GTAB_ID_V1_8821C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8821C(x) | BIT_GTAB_ID_V1_8821C(v)) -+ -+#define BIT_SHIFT_AC0_PKT_INFO_8821C 0 -+#define BIT_MASK_AC0_PKT_INFO_8821C 0xfff -+#define BIT_AC0_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_AC0_PKT_INFO_8821C) << BIT_SHIFT_AC0_PKT_INFO_8821C) -+#define BITS_AC0_PKT_INFO_8821C \ -+ (BIT_MASK_AC0_PKT_INFO_8821C << BIT_SHIFT_AC0_PKT_INFO_8821C) -+#define BIT_CLEAR_AC0_PKT_INFO_8821C(x) ((x) & (~BITS_AC0_PKT_INFO_8821C)) -+#define BIT_GET_AC0_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_AC0_PKT_INFO_8821C) & BIT_MASK_AC0_PKT_INFO_8821C) -+#define BIT_SET_AC0_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_AC0_PKT_INFO_8821C(x) | BIT_AC0_PKT_INFO_8821C(v)) -+ -+/* 2 REG_Q2_Q3_INFO_8821C */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8821C BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8821C 28 -+#define BIT_MASK_GTAB_ID_8821C 0x7 -+#define BIT_GTAB_ID_8821C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8821C) << BIT_SHIFT_GTAB_ID_8821C) -+#define BITS_GTAB_ID_8821C (BIT_MASK_GTAB_ID_8821C << BIT_SHIFT_GTAB_ID_8821C) -+#define BIT_CLEAR_GTAB_ID_8821C(x) ((x) & (~BITS_GTAB_ID_8821C)) -+#define BIT_GET_GTAB_ID_8821C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8821C) & BIT_MASK_GTAB_ID_8821C) -+#define BIT_SET_GTAB_ID_8821C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8821C(x) | BIT_GTAB_ID_8821C(v)) -+ -+#define BIT_SHIFT_AC3_PKT_INFO_8821C 16 -+#define BIT_MASK_AC3_PKT_INFO_8821C 0xfff -+#define BIT_AC3_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_AC3_PKT_INFO_8821C) << BIT_SHIFT_AC3_PKT_INFO_8821C) -+#define BITS_AC3_PKT_INFO_8821C \ -+ (BIT_MASK_AC3_PKT_INFO_8821C << BIT_SHIFT_AC3_PKT_INFO_8821C) -+#define BIT_CLEAR_AC3_PKT_INFO_8821C(x) ((x) & (~BITS_AC3_PKT_INFO_8821C)) -+#define BIT_GET_AC3_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_AC3_PKT_INFO_8821C) & BIT_MASK_AC3_PKT_INFO_8821C) -+#define BIT_SET_AC3_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_AC3_PKT_INFO_8821C(x) | BIT_AC3_PKT_INFO_8821C(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8821C BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8821C 12 -+#define BIT_MASK_GTAB_ID_V1_8821C 0x7 -+#define BIT_GTAB_ID_V1_8821C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8821C) << BIT_SHIFT_GTAB_ID_V1_8821C) -+#define BITS_GTAB_ID_V1_8821C \ -+ (BIT_MASK_GTAB_ID_V1_8821C << BIT_SHIFT_GTAB_ID_V1_8821C) -+#define BIT_CLEAR_GTAB_ID_V1_8821C(x) ((x) & (~BITS_GTAB_ID_V1_8821C)) -+#define BIT_GET_GTAB_ID_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8821C) & BIT_MASK_GTAB_ID_V1_8821C) -+#define BIT_SET_GTAB_ID_V1_8821C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8821C(x) | BIT_GTAB_ID_V1_8821C(v)) -+ -+#define BIT_SHIFT_AC2_PKT_INFO_8821C 0 -+#define BIT_MASK_AC2_PKT_INFO_8821C 0xfff -+#define BIT_AC2_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_AC2_PKT_INFO_8821C) << BIT_SHIFT_AC2_PKT_INFO_8821C) -+#define BITS_AC2_PKT_INFO_8821C \ -+ (BIT_MASK_AC2_PKT_INFO_8821C << BIT_SHIFT_AC2_PKT_INFO_8821C) -+#define BIT_CLEAR_AC2_PKT_INFO_8821C(x) ((x) & (~BITS_AC2_PKT_INFO_8821C)) -+#define BIT_GET_AC2_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_AC2_PKT_INFO_8821C) & BIT_MASK_AC2_PKT_INFO_8821C) -+#define BIT_SET_AC2_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_AC2_PKT_INFO_8821C(x) | BIT_AC2_PKT_INFO_8821C(v)) -+ -+/* 2 REG_Q4_Q5_INFO_8821C */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8821C BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8821C 28 -+#define BIT_MASK_GTAB_ID_8821C 0x7 -+#define BIT_GTAB_ID_8821C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8821C) << BIT_SHIFT_GTAB_ID_8821C) -+#define BITS_GTAB_ID_8821C (BIT_MASK_GTAB_ID_8821C << BIT_SHIFT_GTAB_ID_8821C) -+#define BIT_CLEAR_GTAB_ID_8821C(x) ((x) & (~BITS_GTAB_ID_8821C)) -+#define BIT_GET_GTAB_ID_8821C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8821C) & BIT_MASK_GTAB_ID_8821C) -+#define BIT_SET_GTAB_ID_8821C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8821C(x) | BIT_GTAB_ID_8821C(v)) -+ -+#define BIT_SHIFT_AC5_PKT_INFO_8821C 16 -+#define BIT_MASK_AC5_PKT_INFO_8821C 0xfff -+#define BIT_AC5_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_AC5_PKT_INFO_8821C) << BIT_SHIFT_AC5_PKT_INFO_8821C) -+#define BITS_AC5_PKT_INFO_8821C \ -+ (BIT_MASK_AC5_PKT_INFO_8821C << BIT_SHIFT_AC5_PKT_INFO_8821C) -+#define BIT_CLEAR_AC5_PKT_INFO_8821C(x) ((x) & (~BITS_AC5_PKT_INFO_8821C)) -+#define BIT_GET_AC5_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_AC5_PKT_INFO_8821C) & BIT_MASK_AC5_PKT_INFO_8821C) -+#define BIT_SET_AC5_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_AC5_PKT_INFO_8821C(x) | BIT_AC5_PKT_INFO_8821C(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8821C BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8821C 12 -+#define BIT_MASK_GTAB_ID_V1_8821C 0x7 -+#define BIT_GTAB_ID_V1_8821C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8821C) << BIT_SHIFT_GTAB_ID_V1_8821C) -+#define BITS_GTAB_ID_V1_8821C \ -+ (BIT_MASK_GTAB_ID_V1_8821C << BIT_SHIFT_GTAB_ID_V1_8821C) -+#define BIT_CLEAR_GTAB_ID_V1_8821C(x) ((x) & (~BITS_GTAB_ID_V1_8821C)) -+#define BIT_GET_GTAB_ID_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8821C) & BIT_MASK_GTAB_ID_V1_8821C) -+#define BIT_SET_GTAB_ID_V1_8821C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8821C(x) | BIT_GTAB_ID_V1_8821C(v)) -+ -+#define BIT_SHIFT_AC4_PKT_INFO_8821C 0 -+#define BIT_MASK_AC4_PKT_INFO_8821C 0xfff -+#define BIT_AC4_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_AC4_PKT_INFO_8821C) << BIT_SHIFT_AC4_PKT_INFO_8821C) -+#define BITS_AC4_PKT_INFO_8821C \ -+ (BIT_MASK_AC4_PKT_INFO_8821C << BIT_SHIFT_AC4_PKT_INFO_8821C) -+#define BIT_CLEAR_AC4_PKT_INFO_8821C(x) ((x) & (~BITS_AC4_PKT_INFO_8821C)) -+#define BIT_GET_AC4_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_AC4_PKT_INFO_8821C) & BIT_MASK_AC4_PKT_INFO_8821C) -+#define BIT_SET_AC4_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_AC4_PKT_INFO_8821C(x) | BIT_AC4_PKT_INFO_8821C(v)) -+ -+/* 2 REG_Q6_Q7_INFO_8821C */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8821C BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8821C 28 -+#define BIT_MASK_GTAB_ID_8821C 0x7 -+#define BIT_GTAB_ID_8821C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8821C) << BIT_SHIFT_GTAB_ID_8821C) -+#define BITS_GTAB_ID_8821C (BIT_MASK_GTAB_ID_8821C << BIT_SHIFT_GTAB_ID_8821C) -+#define BIT_CLEAR_GTAB_ID_8821C(x) ((x) & (~BITS_GTAB_ID_8821C)) -+#define BIT_GET_GTAB_ID_8821C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8821C) & BIT_MASK_GTAB_ID_8821C) -+#define BIT_SET_GTAB_ID_8821C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8821C(x) | BIT_GTAB_ID_8821C(v)) -+ -+#define BIT_SHIFT_AC7_PKT_INFO_8821C 16 -+#define BIT_MASK_AC7_PKT_INFO_8821C 0xfff -+#define BIT_AC7_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_AC7_PKT_INFO_8821C) << BIT_SHIFT_AC7_PKT_INFO_8821C) -+#define BITS_AC7_PKT_INFO_8821C \ -+ (BIT_MASK_AC7_PKT_INFO_8821C << BIT_SHIFT_AC7_PKT_INFO_8821C) -+#define BIT_CLEAR_AC7_PKT_INFO_8821C(x) ((x) & (~BITS_AC7_PKT_INFO_8821C)) -+#define BIT_GET_AC7_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_AC7_PKT_INFO_8821C) & BIT_MASK_AC7_PKT_INFO_8821C) -+#define BIT_SET_AC7_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_AC7_PKT_INFO_8821C(x) | BIT_AC7_PKT_INFO_8821C(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8821C BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8821C 12 -+#define BIT_MASK_GTAB_ID_V1_8821C 0x7 -+#define BIT_GTAB_ID_V1_8821C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8821C) << BIT_SHIFT_GTAB_ID_V1_8821C) -+#define BITS_GTAB_ID_V1_8821C \ -+ (BIT_MASK_GTAB_ID_V1_8821C << BIT_SHIFT_GTAB_ID_V1_8821C) -+#define BIT_CLEAR_GTAB_ID_V1_8821C(x) ((x) & (~BITS_GTAB_ID_V1_8821C)) -+#define BIT_GET_GTAB_ID_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8821C) & BIT_MASK_GTAB_ID_V1_8821C) -+#define BIT_SET_GTAB_ID_V1_8821C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8821C(x) | BIT_GTAB_ID_V1_8821C(v)) -+ -+#define BIT_SHIFT_AC6_PKT_INFO_8821C 0 -+#define BIT_MASK_AC6_PKT_INFO_8821C 0xfff -+#define BIT_AC6_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_AC6_PKT_INFO_8821C) << BIT_SHIFT_AC6_PKT_INFO_8821C) -+#define BITS_AC6_PKT_INFO_8821C \ -+ (BIT_MASK_AC6_PKT_INFO_8821C << BIT_SHIFT_AC6_PKT_INFO_8821C) -+#define BIT_CLEAR_AC6_PKT_INFO_8821C(x) ((x) & (~BITS_AC6_PKT_INFO_8821C)) -+#define BIT_GET_AC6_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_AC6_PKT_INFO_8821C) & BIT_MASK_AC6_PKT_INFO_8821C) -+#define BIT_SET_AC6_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_AC6_PKT_INFO_8821C(x) | BIT_AC6_PKT_INFO_8821C(v)) -+ -+/* 2 REG_MGQ_HIQ_INFO_8821C */ -+ -+#define BIT_SHIFT_HIQ_PKT_INFO_8821C 16 -+#define BIT_MASK_HIQ_PKT_INFO_8821C 0xfff -+#define BIT_HIQ_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_HIQ_PKT_INFO_8821C) << BIT_SHIFT_HIQ_PKT_INFO_8821C) -+#define BITS_HIQ_PKT_INFO_8821C \ -+ (BIT_MASK_HIQ_PKT_INFO_8821C << BIT_SHIFT_HIQ_PKT_INFO_8821C) -+#define BIT_CLEAR_HIQ_PKT_INFO_8821C(x) ((x) & (~BITS_HIQ_PKT_INFO_8821C)) -+#define BIT_GET_HIQ_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_HIQ_PKT_INFO_8821C) & BIT_MASK_HIQ_PKT_INFO_8821C) -+#define BIT_SET_HIQ_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_HIQ_PKT_INFO_8821C(x) | BIT_HIQ_PKT_INFO_8821C(v)) -+ -+#define BIT_SHIFT_MGQ_PKT_INFO_8821C 0 -+#define BIT_MASK_MGQ_PKT_INFO_8821C 0xfff -+#define BIT_MGQ_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_PKT_INFO_8821C) << BIT_SHIFT_MGQ_PKT_INFO_8821C) -+#define BITS_MGQ_PKT_INFO_8821C \ -+ (BIT_MASK_MGQ_PKT_INFO_8821C << BIT_SHIFT_MGQ_PKT_INFO_8821C) -+#define BIT_CLEAR_MGQ_PKT_INFO_8821C(x) ((x) & (~BITS_MGQ_PKT_INFO_8821C)) -+#define BIT_GET_MGQ_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PKT_INFO_8821C) & BIT_MASK_MGQ_PKT_INFO_8821C) -+#define BIT_SET_MGQ_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_PKT_INFO_8821C(x) | BIT_MGQ_PKT_INFO_8821C(v)) -+ -+/* 2 REG_CMDQ_BCNQ_INFO_8821C */ -+ -+#define BIT_SHIFT_CMDQ_PKT_INFO_8821C 16 -+#define BIT_MASK_CMDQ_PKT_INFO_8821C 0xfff -+#define BIT_CMDQ_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_CMDQ_PKT_INFO_8821C) << BIT_SHIFT_CMDQ_PKT_INFO_8821C) -+#define BITS_CMDQ_PKT_INFO_8821C \ -+ (BIT_MASK_CMDQ_PKT_INFO_8821C << BIT_SHIFT_CMDQ_PKT_INFO_8821C) -+#define BIT_CLEAR_CMDQ_PKT_INFO_8821C(x) ((x) & (~BITS_CMDQ_PKT_INFO_8821C)) -+#define BIT_GET_CMDQ_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_CMDQ_PKT_INFO_8821C) & BIT_MASK_CMDQ_PKT_INFO_8821C) -+#define BIT_SET_CMDQ_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_CMDQ_PKT_INFO_8821C(x) | BIT_CMDQ_PKT_INFO_8821C(v)) -+ -+#define BIT_SHIFT_BCNQ_PKT_INFO_8821C 0 -+#define BIT_MASK_BCNQ_PKT_INFO_8821C 0xfff -+#define BIT_BCNQ_PKT_INFO_8821C(x) \ -+ (((x) & BIT_MASK_BCNQ_PKT_INFO_8821C) << BIT_SHIFT_BCNQ_PKT_INFO_8821C) -+#define BITS_BCNQ_PKT_INFO_8821C \ -+ (BIT_MASK_BCNQ_PKT_INFO_8821C << BIT_SHIFT_BCNQ_PKT_INFO_8821C) -+#define BIT_CLEAR_BCNQ_PKT_INFO_8821C(x) ((x) & (~BITS_BCNQ_PKT_INFO_8821C)) -+#define BIT_GET_BCNQ_PKT_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PKT_INFO_8821C) & BIT_MASK_BCNQ_PKT_INFO_8821C) -+#define BIT_SET_BCNQ_PKT_INFO_8821C(x, v) \ -+ (BIT_CLEAR_BCNQ_PKT_INFO_8821C(x) | BIT_BCNQ_PKT_INFO_8821C(v)) -+ -+/* 2 REG_USEREG_SETTING_8821C */ -+#define BIT_NDPA_USEREG_8821C BIT(21) -+ -+#define BIT_SHIFT_RETRY_USEREG_8821C 19 -+#define BIT_MASK_RETRY_USEREG_8821C 0x3 -+#define BIT_RETRY_USEREG_8821C(x) \ -+ (((x) & BIT_MASK_RETRY_USEREG_8821C) << BIT_SHIFT_RETRY_USEREG_8821C) -+#define BITS_RETRY_USEREG_8821C \ -+ (BIT_MASK_RETRY_USEREG_8821C << BIT_SHIFT_RETRY_USEREG_8821C) -+#define BIT_CLEAR_RETRY_USEREG_8821C(x) ((x) & (~BITS_RETRY_USEREG_8821C)) -+#define BIT_GET_RETRY_USEREG_8821C(x) \ -+ (((x) >> BIT_SHIFT_RETRY_USEREG_8821C) & BIT_MASK_RETRY_USEREG_8821C) -+#define BIT_SET_RETRY_USEREG_8821C(x, v) \ -+ (BIT_CLEAR_RETRY_USEREG_8821C(x) | BIT_RETRY_USEREG_8821C(v)) -+ -+#define BIT_SHIFT_TRYPKT_USEREG_8821C 17 -+#define BIT_MASK_TRYPKT_USEREG_8821C 0x3 -+#define BIT_TRYPKT_USEREG_8821C(x) \ -+ (((x) & BIT_MASK_TRYPKT_USEREG_8821C) << BIT_SHIFT_TRYPKT_USEREG_8821C) -+#define BITS_TRYPKT_USEREG_8821C \ -+ (BIT_MASK_TRYPKT_USEREG_8821C << BIT_SHIFT_TRYPKT_USEREG_8821C) -+#define BIT_CLEAR_TRYPKT_USEREG_8821C(x) ((x) & (~BITS_TRYPKT_USEREG_8821C)) -+#define BIT_GET_TRYPKT_USEREG_8821C(x) \ -+ (((x) >> BIT_SHIFT_TRYPKT_USEREG_8821C) & BIT_MASK_TRYPKT_USEREG_8821C) -+#define BIT_SET_TRYPKT_USEREG_8821C(x, v) \ -+ (BIT_CLEAR_TRYPKT_USEREG_8821C(x) | BIT_TRYPKT_USEREG_8821C(v)) -+ -+#define BIT_CTLPKT_USEREG_8821C BIT(16) -+ -+/* 2 REG_AESIV_SETTING_8821C */ -+ -+#define BIT_SHIFT_AESIV_OFFSET_8821C 0 -+#define BIT_MASK_AESIV_OFFSET_8821C 0xfff -+#define BIT_AESIV_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_AESIV_OFFSET_8821C) << BIT_SHIFT_AESIV_OFFSET_8821C) -+#define BITS_AESIV_OFFSET_8821C \ -+ (BIT_MASK_AESIV_OFFSET_8821C << BIT_SHIFT_AESIV_OFFSET_8821C) -+#define BIT_CLEAR_AESIV_OFFSET_8821C(x) ((x) & (~BITS_AESIV_OFFSET_8821C)) -+#define BIT_GET_AESIV_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_AESIV_OFFSET_8821C) & BIT_MASK_AESIV_OFFSET_8821C) -+#define BIT_SET_AESIV_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_AESIV_OFFSET_8821C(x) | BIT_AESIV_OFFSET_8821C(v)) -+ -+/* 2 REG_BF0_TIME_SETTING_8821C */ -+#define BIT_BF0_TIMER_SET_8821C BIT(31) -+#define BIT_BF0_TIMER_CLR_8821C BIT(30) -+#define BIT_BF0_UPDATE_EN_8821C BIT(29) -+#define BIT_BF0_TIMER_EN_8821C BIT(28) -+ -+#define BIT_SHIFT_BF0_PRETIME_OVER_8821C 16 -+#define BIT_MASK_BF0_PRETIME_OVER_8821C 0xfff -+#define BIT_BF0_PRETIME_OVER_8821C(x) \ -+ (((x) & BIT_MASK_BF0_PRETIME_OVER_8821C) \ -+ << BIT_SHIFT_BF0_PRETIME_OVER_8821C) -+#define BITS_BF0_PRETIME_OVER_8821C \ -+ (BIT_MASK_BF0_PRETIME_OVER_8821C << BIT_SHIFT_BF0_PRETIME_OVER_8821C) -+#define BIT_CLEAR_BF0_PRETIME_OVER_8821C(x) \ -+ ((x) & (~BITS_BF0_PRETIME_OVER_8821C)) -+#define BIT_GET_BF0_PRETIME_OVER_8821C(x) \ -+ (((x) >> BIT_SHIFT_BF0_PRETIME_OVER_8821C) & \ -+ BIT_MASK_BF0_PRETIME_OVER_8821C) -+#define BIT_SET_BF0_PRETIME_OVER_8821C(x, v) \ -+ (BIT_CLEAR_BF0_PRETIME_OVER_8821C(x) | BIT_BF0_PRETIME_OVER_8821C(v)) -+ -+#define BIT_SHIFT_BF0_LIFETIME_8821C 0 -+#define BIT_MASK_BF0_LIFETIME_8821C 0xffff -+#define BIT_BF0_LIFETIME_8821C(x) \ -+ (((x) & BIT_MASK_BF0_LIFETIME_8821C) << BIT_SHIFT_BF0_LIFETIME_8821C) -+#define BITS_BF0_LIFETIME_8821C \ -+ (BIT_MASK_BF0_LIFETIME_8821C << BIT_SHIFT_BF0_LIFETIME_8821C) -+#define BIT_CLEAR_BF0_LIFETIME_8821C(x) ((x) & (~BITS_BF0_LIFETIME_8821C)) -+#define BIT_GET_BF0_LIFETIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_BF0_LIFETIME_8821C) & BIT_MASK_BF0_LIFETIME_8821C) -+#define BIT_SET_BF0_LIFETIME_8821C(x, v) \ -+ (BIT_CLEAR_BF0_LIFETIME_8821C(x) | BIT_BF0_LIFETIME_8821C(v)) -+ -+/* 2 REG_BF1_TIME_SETTING_8821C */ -+#define BIT_BF1_TIMER_SET_8821C BIT(31) -+#define BIT_BF1_TIMER_CLR_8821C BIT(30) -+#define BIT_BF1_UPDATE_EN_8821C BIT(29) -+#define BIT_BF1_TIMER_EN_8821C BIT(28) -+ -+#define BIT_SHIFT_BF1_PRETIME_OVER_8821C 16 -+#define BIT_MASK_BF1_PRETIME_OVER_8821C 0xfff -+#define BIT_BF1_PRETIME_OVER_8821C(x) \ -+ (((x) & BIT_MASK_BF1_PRETIME_OVER_8821C) \ -+ << BIT_SHIFT_BF1_PRETIME_OVER_8821C) -+#define BITS_BF1_PRETIME_OVER_8821C \ -+ (BIT_MASK_BF1_PRETIME_OVER_8821C << BIT_SHIFT_BF1_PRETIME_OVER_8821C) -+#define BIT_CLEAR_BF1_PRETIME_OVER_8821C(x) \ -+ ((x) & (~BITS_BF1_PRETIME_OVER_8821C)) -+#define BIT_GET_BF1_PRETIME_OVER_8821C(x) \ -+ (((x) >> BIT_SHIFT_BF1_PRETIME_OVER_8821C) & \ -+ BIT_MASK_BF1_PRETIME_OVER_8821C) -+#define BIT_SET_BF1_PRETIME_OVER_8821C(x, v) \ -+ (BIT_CLEAR_BF1_PRETIME_OVER_8821C(x) | BIT_BF1_PRETIME_OVER_8821C(v)) -+ -+#define BIT_SHIFT_BF1_LIFETIME_8821C 0 -+#define BIT_MASK_BF1_LIFETIME_8821C 0xffff -+#define BIT_BF1_LIFETIME_8821C(x) \ -+ (((x) & BIT_MASK_BF1_LIFETIME_8821C) << BIT_SHIFT_BF1_LIFETIME_8821C) -+#define BITS_BF1_LIFETIME_8821C \ -+ (BIT_MASK_BF1_LIFETIME_8821C << BIT_SHIFT_BF1_LIFETIME_8821C) -+#define BIT_CLEAR_BF1_LIFETIME_8821C(x) ((x) & (~BITS_BF1_LIFETIME_8821C)) -+#define BIT_GET_BF1_LIFETIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_BF1_LIFETIME_8821C) & BIT_MASK_BF1_LIFETIME_8821C) -+#define BIT_SET_BF1_LIFETIME_8821C(x, v) \ -+ (BIT_CLEAR_BF1_LIFETIME_8821C(x) | BIT_BF1_LIFETIME_8821C(v)) -+ -+/* 2 REG_BF_TIMEOUT_EN_8821C */ -+#define BIT_EN_VHT_LDPC_8821C BIT(9) -+#define BIT_EN_HT_LDPC_8821C BIT(8) -+#define BIT_BF1_TIMEOUT_EN_8821C BIT(1) -+#define BIT_BF0_TIMEOUT_EN_8821C BIT(0) -+ -+/* 2 REG_MACID_RELEASE0_8821C */ -+ -+#define BIT_SHIFT_MACID31_0_RELEASE_8821C 0 -+#define BIT_MASK_MACID31_0_RELEASE_8821C 0xffffffffL -+#define BIT_MACID31_0_RELEASE_8821C(x) \ -+ (((x) & BIT_MASK_MACID31_0_RELEASE_8821C) \ -+ << BIT_SHIFT_MACID31_0_RELEASE_8821C) -+#define BITS_MACID31_0_RELEASE_8821C \ -+ (BIT_MASK_MACID31_0_RELEASE_8821C << BIT_SHIFT_MACID31_0_RELEASE_8821C) -+#define BIT_CLEAR_MACID31_0_RELEASE_8821C(x) \ -+ ((x) & (~BITS_MACID31_0_RELEASE_8821C)) -+#define BIT_GET_MACID31_0_RELEASE_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_RELEASE_8821C) & \ -+ BIT_MASK_MACID31_0_RELEASE_8821C) -+#define BIT_SET_MACID31_0_RELEASE_8821C(x, v) \ -+ (BIT_CLEAR_MACID31_0_RELEASE_8821C(x) | BIT_MACID31_0_RELEASE_8821C(v)) -+ -+/* 2 REG_MACID_RELEASE1_8821C */ -+ -+#define BIT_SHIFT_MACID63_32_RELEASE_8821C 0 -+#define BIT_MASK_MACID63_32_RELEASE_8821C 0xffffffffL -+#define BIT_MACID63_32_RELEASE_8821C(x) \ -+ (((x) & BIT_MASK_MACID63_32_RELEASE_8821C) \ -+ << BIT_SHIFT_MACID63_32_RELEASE_8821C) -+#define BITS_MACID63_32_RELEASE_8821C \ -+ (BIT_MASK_MACID63_32_RELEASE_8821C \ -+ << BIT_SHIFT_MACID63_32_RELEASE_8821C) -+#define BIT_CLEAR_MACID63_32_RELEASE_8821C(x) \ -+ ((x) & (~BITS_MACID63_32_RELEASE_8821C)) -+#define BIT_GET_MACID63_32_RELEASE_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_RELEASE_8821C) & \ -+ BIT_MASK_MACID63_32_RELEASE_8821C) -+#define BIT_SET_MACID63_32_RELEASE_8821C(x, v) \ -+ (BIT_CLEAR_MACID63_32_RELEASE_8821C(x) | \ -+ BIT_MACID63_32_RELEASE_8821C(v)) -+ -+/* 2 REG_MACID_RELEASE2_8821C */ -+ -+#define BIT_SHIFT_MACID95_64_RELEASE_8821C 0 -+#define BIT_MASK_MACID95_64_RELEASE_8821C 0xffffffffL -+#define BIT_MACID95_64_RELEASE_8821C(x) \ -+ (((x) & BIT_MASK_MACID95_64_RELEASE_8821C) \ -+ << BIT_SHIFT_MACID95_64_RELEASE_8821C) -+#define BITS_MACID95_64_RELEASE_8821C \ -+ (BIT_MASK_MACID95_64_RELEASE_8821C \ -+ << BIT_SHIFT_MACID95_64_RELEASE_8821C) -+#define BIT_CLEAR_MACID95_64_RELEASE_8821C(x) \ -+ ((x) & (~BITS_MACID95_64_RELEASE_8821C)) -+#define BIT_GET_MACID95_64_RELEASE_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_RELEASE_8821C) & \ -+ BIT_MASK_MACID95_64_RELEASE_8821C) -+#define BIT_SET_MACID95_64_RELEASE_8821C(x, v) \ -+ (BIT_CLEAR_MACID95_64_RELEASE_8821C(x) | \ -+ BIT_MACID95_64_RELEASE_8821C(v)) -+ -+/* 2 REG_MACID_RELEASE3_8821C */ -+ -+#define BIT_SHIFT_MACID127_96_RELEASE_8821C 0 -+#define BIT_MASK_MACID127_96_RELEASE_8821C 0xffffffffL -+#define BIT_MACID127_96_RELEASE_8821C(x) \ -+ (((x) & BIT_MASK_MACID127_96_RELEASE_8821C) \ -+ << BIT_SHIFT_MACID127_96_RELEASE_8821C) -+#define BITS_MACID127_96_RELEASE_8821C \ -+ (BIT_MASK_MACID127_96_RELEASE_8821C \ -+ << BIT_SHIFT_MACID127_96_RELEASE_8821C) -+#define BIT_CLEAR_MACID127_96_RELEASE_8821C(x) \ -+ ((x) & (~BITS_MACID127_96_RELEASE_8821C)) -+#define BIT_GET_MACID127_96_RELEASE_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_RELEASE_8821C) & \ -+ BIT_MASK_MACID127_96_RELEASE_8821C) -+#define BIT_SET_MACID127_96_RELEASE_8821C(x, v) \ -+ (BIT_CLEAR_MACID127_96_RELEASE_8821C(x) | \ -+ BIT_MACID127_96_RELEASE_8821C(v)) -+ -+/* 2 REG_MACID_RELEASE_SETTING_8821C */ -+#define BIT_MACID_VALUE_8821C BIT(7) -+ -+#define BIT_SHIFT_MACID_OFFSET_8821C 0 -+#define BIT_MASK_MACID_OFFSET_8821C 0x7f -+#define BIT_MACID_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_MACID_OFFSET_8821C) << BIT_SHIFT_MACID_OFFSET_8821C) -+#define BITS_MACID_OFFSET_8821C \ -+ (BIT_MASK_MACID_OFFSET_8821C << BIT_SHIFT_MACID_OFFSET_8821C) -+#define BIT_CLEAR_MACID_OFFSET_8821C(x) ((x) & (~BITS_MACID_OFFSET_8821C)) -+#define BIT_GET_MACID_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID_OFFSET_8821C) & BIT_MASK_MACID_OFFSET_8821C) -+#define BIT_SET_MACID_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_MACID_OFFSET_8821C(x) | BIT_MACID_OFFSET_8821C(v)) -+ -+/* 2 REG_FAST_EDCA_VOVI_SETTING_8821C */ -+ -+#define BIT_SHIFT_VI_FAST_EDCA_TO_8821C 24 -+#define BIT_MASK_VI_FAST_EDCA_TO_8821C 0xff -+#define BIT_VI_FAST_EDCA_TO_8821C(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_TO_8821C) \ -+ << BIT_SHIFT_VI_FAST_EDCA_TO_8821C) -+#define BITS_VI_FAST_EDCA_TO_8821C \ -+ (BIT_MASK_VI_FAST_EDCA_TO_8821C << BIT_SHIFT_VI_FAST_EDCA_TO_8821C) -+#define BIT_CLEAR_VI_FAST_EDCA_TO_8821C(x) ((x) & (~BITS_VI_FAST_EDCA_TO_8821C)) -+#define BIT_GET_VI_FAST_EDCA_TO_8821C(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_TO_8821C) & \ -+ BIT_MASK_VI_FAST_EDCA_TO_8821C) -+#define BIT_SET_VI_FAST_EDCA_TO_8821C(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_TO_8821C(x) | BIT_VI_FAST_EDCA_TO_8821C(v)) -+ -+#define BIT_VI_THRESHOLD_SEL_8821C BIT(23) -+ -+#define BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8821C 16 -+#define BIT_MASK_VI_FAST_EDCA_PKT_TH_8821C 0x7f -+#define BIT_VI_FAST_EDCA_PKT_TH_8821C(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_PKT_TH_8821C) \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8821C) -+#define BITS_VI_FAST_EDCA_PKT_TH_8821C \ -+ (BIT_MASK_VI_FAST_EDCA_PKT_TH_8821C \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8821C) -+#define BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8821C(x) \ -+ ((x) & (~BITS_VI_FAST_EDCA_PKT_TH_8821C)) -+#define BIT_GET_VI_FAST_EDCA_PKT_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8821C) & \ -+ BIT_MASK_VI_FAST_EDCA_PKT_TH_8821C) -+#define BIT_SET_VI_FAST_EDCA_PKT_TH_8821C(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8821C(x) | \ -+ BIT_VI_FAST_EDCA_PKT_TH_8821C(v)) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_TO_8821C 8 -+#define BIT_MASK_VO_FAST_EDCA_TO_8821C 0xff -+#define BIT_VO_FAST_EDCA_TO_8821C(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_TO_8821C) \ -+ << BIT_SHIFT_VO_FAST_EDCA_TO_8821C) -+#define BITS_VO_FAST_EDCA_TO_8821C \ -+ (BIT_MASK_VO_FAST_EDCA_TO_8821C << BIT_SHIFT_VO_FAST_EDCA_TO_8821C) -+#define BIT_CLEAR_VO_FAST_EDCA_TO_8821C(x) ((x) & (~BITS_VO_FAST_EDCA_TO_8821C)) -+#define BIT_GET_VO_FAST_EDCA_TO_8821C(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_TO_8821C) & \ -+ BIT_MASK_VO_FAST_EDCA_TO_8821C) -+#define BIT_SET_VO_FAST_EDCA_TO_8821C(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_TO_8821C(x) | BIT_VO_FAST_EDCA_TO_8821C(v)) -+ -+#define BIT_VO_THRESHOLD_SEL_8821C BIT(7) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8821C 0 -+#define BIT_MASK_VO_FAST_EDCA_PKT_TH_8821C 0x7f -+#define BIT_VO_FAST_EDCA_PKT_TH_8821C(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_PKT_TH_8821C) \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8821C) -+#define BITS_VO_FAST_EDCA_PKT_TH_8821C \ -+ (BIT_MASK_VO_FAST_EDCA_PKT_TH_8821C \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8821C) -+#define BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8821C(x) \ -+ ((x) & (~BITS_VO_FAST_EDCA_PKT_TH_8821C)) -+#define BIT_GET_VO_FAST_EDCA_PKT_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8821C) & \ -+ BIT_MASK_VO_FAST_EDCA_PKT_TH_8821C) -+#define BIT_SET_VO_FAST_EDCA_PKT_TH_8821C(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8821C(x) | \ -+ BIT_VO_FAST_EDCA_PKT_TH_8821C(v)) -+ -+/* 2 REG_FAST_EDCA_BEBK_SETTING_8821C */ -+ -+#define BIT_SHIFT_BK_FAST_EDCA_TO_8821C 24 -+#define BIT_MASK_BK_FAST_EDCA_TO_8821C 0xff -+#define BIT_BK_FAST_EDCA_TO_8821C(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_TO_8821C) \ -+ << BIT_SHIFT_BK_FAST_EDCA_TO_8821C) -+#define BITS_BK_FAST_EDCA_TO_8821C \ -+ (BIT_MASK_BK_FAST_EDCA_TO_8821C << BIT_SHIFT_BK_FAST_EDCA_TO_8821C) -+#define BIT_CLEAR_BK_FAST_EDCA_TO_8821C(x) ((x) & (~BITS_BK_FAST_EDCA_TO_8821C)) -+#define BIT_GET_BK_FAST_EDCA_TO_8821C(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_TO_8821C) & \ -+ BIT_MASK_BK_FAST_EDCA_TO_8821C) -+#define BIT_SET_BK_FAST_EDCA_TO_8821C(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_TO_8821C(x) | BIT_BK_FAST_EDCA_TO_8821C(v)) -+ -+#define BIT_BK_THRESHOLD_SEL_8821C BIT(23) -+ -+#define BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8821C 16 -+#define BIT_MASK_BK_FAST_EDCA_PKT_TH_8821C 0x7f -+#define BIT_BK_FAST_EDCA_PKT_TH_8821C(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_PKT_TH_8821C) \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8821C) -+#define BITS_BK_FAST_EDCA_PKT_TH_8821C \ -+ (BIT_MASK_BK_FAST_EDCA_PKT_TH_8821C \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8821C) -+#define BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8821C(x) \ -+ ((x) & (~BITS_BK_FAST_EDCA_PKT_TH_8821C)) -+#define BIT_GET_BK_FAST_EDCA_PKT_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8821C) & \ -+ BIT_MASK_BK_FAST_EDCA_PKT_TH_8821C) -+#define BIT_SET_BK_FAST_EDCA_PKT_TH_8821C(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8821C(x) | \ -+ BIT_BK_FAST_EDCA_PKT_TH_8821C(v)) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_TO_8821C 8 -+#define BIT_MASK_BE_FAST_EDCA_TO_8821C 0xff -+#define BIT_BE_FAST_EDCA_TO_8821C(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_TO_8821C) \ -+ << BIT_SHIFT_BE_FAST_EDCA_TO_8821C) -+#define BITS_BE_FAST_EDCA_TO_8821C \ -+ (BIT_MASK_BE_FAST_EDCA_TO_8821C << BIT_SHIFT_BE_FAST_EDCA_TO_8821C) -+#define BIT_CLEAR_BE_FAST_EDCA_TO_8821C(x) ((x) & (~BITS_BE_FAST_EDCA_TO_8821C)) -+#define BIT_GET_BE_FAST_EDCA_TO_8821C(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_TO_8821C) & \ -+ BIT_MASK_BE_FAST_EDCA_TO_8821C) -+#define BIT_SET_BE_FAST_EDCA_TO_8821C(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_TO_8821C(x) | BIT_BE_FAST_EDCA_TO_8821C(v)) -+ -+#define BIT_BE_THRESHOLD_SEL_8821C BIT(7) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8821C 0 -+#define BIT_MASK_BE_FAST_EDCA_PKT_TH_8821C 0x7f -+#define BIT_BE_FAST_EDCA_PKT_TH_8821C(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_PKT_TH_8821C) \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8821C) -+#define BITS_BE_FAST_EDCA_PKT_TH_8821C \ -+ (BIT_MASK_BE_FAST_EDCA_PKT_TH_8821C \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8821C) -+#define BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8821C(x) \ -+ ((x) & (~BITS_BE_FAST_EDCA_PKT_TH_8821C)) -+#define BIT_GET_BE_FAST_EDCA_PKT_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8821C) & \ -+ BIT_MASK_BE_FAST_EDCA_PKT_TH_8821C) -+#define BIT_SET_BE_FAST_EDCA_PKT_TH_8821C(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8821C(x) | \ -+ BIT_BE_FAST_EDCA_PKT_TH_8821C(v)) -+ -+/* 2 REG_MACID_DROP0_8821C */ -+ -+#define BIT_SHIFT_MACID31_0_DROP_8821C 0 -+#define BIT_MASK_MACID31_0_DROP_8821C 0xffffffffL -+#define BIT_MACID31_0_DROP_8821C(x) \ -+ (((x) & BIT_MASK_MACID31_0_DROP_8821C) \ -+ << BIT_SHIFT_MACID31_0_DROP_8821C) -+#define BITS_MACID31_0_DROP_8821C \ -+ (BIT_MASK_MACID31_0_DROP_8821C << BIT_SHIFT_MACID31_0_DROP_8821C) -+#define BIT_CLEAR_MACID31_0_DROP_8821C(x) ((x) & (~BITS_MACID31_0_DROP_8821C)) -+#define BIT_GET_MACID31_0_DROP_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_DROP_8821C) & \ -+ BIT_MASK_MACID31_0_DROP_8821C) -+#define BIT_SET_MACID31_0_DROP_8821C(x, v) \ -+ (BIT_CLEAR_MACID31_0_DROP_8821C(x) | BIT_MACID31_0_DROP_8821C(v)) -+ -+/* 2 REG_MACID_DROP1_8821C */ -+ -+#define BIT_SHIFT_MACID63_32_DROP_8821C 0 -+#define BIT_MASK_MACID63_32_DROP_8821C 0xffffffffL -+#define BIT_MACID63_32_DROP_8821C(x) \ -+ (((x) & BIT_MASK_MACID63_32_DROP_8821C) \ -+ << BIT_SHIFT_MACID63_32_DROP_8821C) -+#define BITS_MACID63_32_DROP_8821C \ -+ (BIT_MASK_MACID63_32_DROP_8821C << BIT_SHIFT_MACID63_32_DROP_8821C) -+#define BIT_CLEAR_MACID63_32_DROP_8821C(x) ((x) & (~BITS_MACID63_32_DROP_8821C)) -+#define BIT_GET_MACID63_32_DROP_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_DROP_8821C) & \ -+ BIT_MASK_MACID63_32_DROP_8821C) -+#define BIT_SET_MACID63_32_DROP_8821C(x, v) \ -+ (BIT_CLEAR_MACID63_32_DROP_8821C(x) | BIT_MACID63_32_DROP_8821C(v)) -+ -+/* 2 REG_MACID_DROP2_8821C */ -+ -+#define BIT_SHIFT_MACID95_64_DROP_8821C 0 -+#define BIT_MASK_MACID95_64_DROP_8821C 0xffffffffL -+#define BIT_MACID95_64_DROP_8821C(x) \ -+ (((x) & BIT_MASK_MACID95_64_DROP_8821C) \ -+ << BIT_SHIFT_MACID95_64_DROP_8821C) -+#define BITS_MACID95_64_DROP_8821C \ -+ (BIT_MASK_MACID95_64_DROP_8821C << BIT_SHIFT_MACID95_64_DROP_8821C) -+#define BIT_CLEAR_MACID95_64_DROP_8821C(x) ((x) & (~BITS_MACID95_64_DROP_8821C)) -+#define BIT_GET_MACID95_64_DROP_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_DROP_8821C) & \ -+ BIT_MASK_MACID95_64_DROP_8821C) -+#define BIT_SET_MACID95_64_DROP_8821C(x, v) \ -+ (BIT_CLEAR_MACID95_64_DROP_8821C(x) | BIT_MACID95_64_DROP_8821C(v)) -+ -+/* 2 REG_MACID_DROP3_8821C */ -+ -+#define BIT_SHIFT_MACID127_96_DROP_8821C 0 -+#define BIT_MASK_MACID127_96_DROP_8821C 0xffffffffL -+#define BIT_MACID127_96_DROP_8821C(x) \ -+ (((x) & BIT_MASK_MACID127_96_DROP_8821C) \ -+ << BIT_SHIFT_MACID127_96_DROP_8821C) -+#define BITS_MACID127_96_DROP_8821C \ -+ (BIT_MASK_MACID127_96_DROP_8821C << BIT_SHIFT_MACID127_96_DROP_8821C) -+#define BIT_CLEAR_MACID127_96_DROP_8821C(x) \ -+ ((x) & (~BITS_MACID127_96_DROP_8821C)) -+#define BIT_GET_MACID127_96_DROP_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_DROP_8821C) & \ -+ BIT_MASK_MACID127_96_DROP_8821C) -+#define BIT_SET_MACID127_96_DROP_8821C(x, v) \ -+ (BIT_CLEAR_MACID127_96_DROP_8821C(x) | BIT_MACID127_96_DROP_8821C(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_0_8821C */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8821C 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8821C 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_0_8821C(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8821C) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8821C) -+#define BITS_R_MACID_RELEASE_SUCCESS_0_8821C \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8821C \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8821C) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0_8821C(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_0_8821C)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8821C) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8821C) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_0_8821C(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0_8821C(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_0_8821C(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_1_8821C */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8821C 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8821C 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_1_8821C(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8821C) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8821C) -+#define BITS_R_MACID_RELEASE_SUCCESS_1_8821C \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8821C \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8821C) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1_8821C(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_1_8821C)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8821C) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8821C) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_1_8821C(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1_8821C(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_1_8821C(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_2_8821C */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8821C 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8821C 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_2_8821C(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8821C) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8821C) -+#define BITS_R_MACID_RELEASE_SUCCESS_2_8821C \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8821C \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8821C) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2_8821C(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_2_8821C)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8821C) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8821C) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_2_8821C(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2_8821C(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_2_8821C(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_3_8821C */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8821C 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8821C 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_3_8821C(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8821C) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8821C) -+#define BITS_R_MACID_RELEASE_SUCCESS_3_8821C \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8821C \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8821C) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3_8821C(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_3_8821C)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_3_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8821C) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8821C) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_3_8821C(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3_8821C(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_3_8821C(v)) -+ -+/* 2 REG_MGQ_FIFO_WRITE_POINTER_8821C */ -+#define BIT_MGQ_FIFO_OV_8821C BIT(7) -+#define BIT_MGQ_FIFO_WPTR_ERROR_8821C BIT(6) -+#define BIT_EN_MGQ_FIFO_LIFETIME_8821C BIT(5) -+ -+#define BIT_SHIFT_MGQ_FIFO_WPTR_8821C 0 -+#define BIT_MASK_MGQ_FIFO_WPTR_8821C 0x1f -+#define BIT_MGQ_FIFO_WPTR_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_WPTR_8821C) << BIT_SHIFT_MGQ_FIFO_WPTR_8821C) -+#define BITS_MGQ_FIFO_WPTR_8821C \ -+ (BIT_MASK_MGQ_FIFO_WPTR_8821C << BIT_SHIFT_MGQ_FIFO_WPTR_8821C) -+#define BIT_CLEAR_MGQ_FIFO_WPTR_8821C(x) ((x) & (~BITS_MGQ_FIFO_WPTR_8821C)) -+#define BIT_GET_MGQ_FIFO_WPTR_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_WPTR_8821C) & BIT_MASK_MGQ_FIFO_WPTR_8821C) -+#define BIT_SET_MGQ_FIFO_WPTR_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_WPTR_8821C(x) | BIT_MGQ_FIFO_WPTR_8821C(v)) -+ -+/* 2 REG_MGQ_FIFO_READ_POINTER_8821C */ -+ -+#define BIT_SHIFT_MGQ_FIFO_SIZE_8821C 14 -+#define BIT_MASK_MGQ_FIFO_SIZE_8821C 0x3 -+#define BIT_MGQ_FIFO_SIZE_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_SIZE_8821C) << BIT_SHIFT_MGQ_FIFO_SIZE_8821C) -+#define BITS_MGQ_FIFO_SIZE_8821C \ -+ (BIT_MASK_MGQ_FIFO_SIZE_8821C << BIT_SHIFT_MGQ_FIFO_SIZE_8821C) -+#define BIT_CLEAR_MGQ_FIFO_SIZE_8821C(x) ((x) & (~BITS_MGQ_FIFO_SIZE_8821C)) -+#define BIT_GET_MGQ_FIFO_SIZE_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_SIZE_8821C) & BIT_MASK_MGQ_FIFO_SIZE_8821C) -+#define BIT_SET_MGQ_FIFO_SIZE_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_SIZE_8821C(x) | BIT_MGQ_FIFO_SIZE_8821C(v)) -+ -+#define BIT_MGQ_FIFO_PAUSE_8821C BIT(13) -+ -+#define BIT_SHIFT_MGQ_FIFO_RPTR_8821C 8 -+#define BIT_MASK_MGQ_FIFO_RPTR_8821C 0x1f -+#define BIT_MGQ_FIFO_RPTR_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_RPTR_8821C) << BIT_SHIFT_MGQ_FIFO_RPTR_8821C) -+#define BITS_MGQ_FIFO_RPTR_8821C \ -+ (BIT_MASK_MGQ_FIFO_RPTR_8821C << BIT_SHIFT_MGQ_FIFO_RPTR_8821C) -+#define BIT_CLEAR_MGQ_FIFO_RPTR_8821C(x) ((x) & (~BITS_MGQ_FIFO_RPTR_8821C)) -+#define BIT_GET_MGQ_FIFO_RPTR_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_RPTR_8821C) & BIT_MASK_MGQ_FIFO_RPTR_8821C) -+#define BIT_SET_MGQ_FIFO_RPTR_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_RPTR_8821C(x) | BIT_MGQ_FIFO_RPTR_8821C(v)) -+ -+/* 2 REG_MGQ_FIFO_ENABLE_8821C */ -+#define BIT_MGQ_FIFO_EN_8821C BIT(15) -+ -+#define BIT_SHIFT_MGQ_FIFO_PG_SIZE_8821C 12 -+#define BIT_MASK_MGQ_FIFO_PG_SIZE_8821C 0x7 -+#define BIT_MGQ_FIFO_PG_SIZE_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_PG_SIZE_8821C) \ -+ << BIT_SHIFT_MGQ_FIFO_PG_SIZE_8821C) -+#define BITS_MGQ_FIFO_PG_SIZE_8821C \ -+ (BIT_MASK_MGQ_FIFO_PG_SIZE_8821C << BIT_SHIFT_MGQ_FIFO_PG_SIZE_8821C) -+#define BIT_CLEAR_MGQ_FIFO_PG_SIZE_8821C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_PG_SIZE_8821C)) -+#define BIT_GET_MGQ_FIFO_PG_SIZE_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_PG_SIZE_8821C) & \ -+ BIT_MASK_MGQ_FIFO_PG_SIZE_8821C) -+#define BIT_SET_MGQ_FIFO_PG_SIZE_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_PG_SIZE_8821C(x) | BIT_MGQ_FIFO_PG_SIZE_8821C(v)) -+ -+#define BIT_SHIFT_MGQ_FIFO_START_PG_8821C 0 -+#define BIT_MASK_MGQ_FIFO_START_PG_8821C 0xfff -+#define BIT_MGQ_FIFO_START_PG_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_START_PG_8821C) \ -+ << BIT_SHIFT_MGQ_FIFO_START_PG_8821C) -+#define BITS_MGQ_FIFO_START_PG_8821C \ -+ (BIT_MASK_MGQ_FIFO_START_PG_8821C << BIT_SHIFT_MGQ_FIFO_START_PG_8821C) -+#define BIT_CLEAR_MGQ_FIFO_START_PG_8821C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_START_PG_8821C)) -+#define BIT_GET_MGQ_FIFO_START_PG_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_START_PG_8821C) & \ -+ BIT_MASK_MGQ_FIFO_START_PG_8821C) -+#define BIT_SET_MGQ_FIFO_START_PG_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_START_PG_8821C(x) | BIT_MGQ_FIFO_START_PG_8821C(v)) -+ -+/* 2 REG_MGQ_FIFO_RELEASE_INT_MASK_8821C */ -+ -+#define BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8821C 0 -+#define BIT_MASK_MGQ_FIFO_REL_INT_MASK_8821C 0xffff -+#define BIT_MGQ_FIFO_REL_INT_MASK_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_REL_INT_MASK_8821C) \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8821C) -+#define BITS_MGQ_FIFO_REL_INT_MASK_8821C \ -+ (BIT_MASK_MGQ_FIFO_REL_INT_MASK_8821C \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8821C) -+#define BIT_CLEAR_MGQ_FIFO_REL_INT_MASK_8821C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_REL_INT_MASK_8821C)) -+#define BIT_GET_MGQ_FIFO_REL_INT_MASK_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8821C) & \ -+ BIT_MASK_MGQ_FIFO_REL_INT_MASK_8821C) -+#define BIT_SET_MGQ_FIFO_REL_INT_MASK_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_REL_INT_MASK_8821C(x) | \ -+ BIT_MGQ_FIFO_REL_INT_MASK_8821C(v)) -+ -+/* 2 REG_MGQ_FIFO_RELEASE_INT_FLAG_8821C */ -+ -+#define BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8821C 0 -+#define BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8821C 0xffff -+#define BIT_MGQ_FIFO_REL_INT_FLAG_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8821C) \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8821C) -+#define BITS_MGQ_FIFO_REL_INT_FLAG_8821C \ -+ (BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8821C \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8821C) -+#define BIT_CLEAR_MGQ_FIFO_REL_INT_FLAG_8821C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_REL_INT_FLAG_8821C)) -+#define BIT_GET_MGQ_FIFO_REL_INT_FLAG_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8821C) & \ -+ BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8821C) -+#define BIT_SET_MGQ_FIFO_REL_INT_FLAG_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_REL_INT_FLAG_8821C(x) | \ -+ BIT_MGQ_FIFO_REL_INT_FLAG_8821C(v)) -+ -+/* 2 REG_MGQ_FIFO_VALID_MAP_8821C */ -+ -+#define BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8821C 0 -+#define BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8821C 0xffff -+#define BIT_MGQ_FIFO_PKT_VALID_MAP_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8821C) \ -+ << BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8821C) -+#define BITS_MGQ_FIFO_PKT_VALID_MAP_8821C \ -+ (BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8821C \ -+ << BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8821C) -+#define BIT_CLEAR_MGQ_FIFO_PKT_VALID_MAP_8821C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_PKT_VALID_MAP_8821C)) -+#define BIT_GET_MGQ_FIFO_PKT_VALID_MAP_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8821C) & \ -+ BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8821C) -+#define BIT_SET_MGQ_FIFO_PKT_VALID_MAP_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_PKT_VALID_MAP_8821C(x) | \ -+ BIT_MGQ_FIFO_PKT_VALID_MAP_8821C(v)) -+ -+/* 2 REG_MGQ_FIFO_LIFETIME_8821C */ -+ -+#define BIT_SHIFT_MGQ_FIFO_LIFETIME_8821C 0 -+#define BIT_MASK_MGQ_FIFO_LIFETIME_8821C 0xffff -+#define BIT_MGQ_FIFO_LIFETIME_8821C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_LIFETIME_8821C) \ -+ << BIT_SHIFT_MGQ_FIFO_LIFETIME_8821C) -+#define BITS_MGQ_FIFO_LIFETIME_8821C \ -+ (BIT_MASK_MGQ_FIFO_LIFETIME_8821C << BIT_SHIFT_MGQ_FIFO_LIFETIME_8821C) -+#define BIT_CLEAR_MGQ_FIFO_LIFETIME_8821C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_LIFETIME_8821C)) -+#define BIT_GET_MGQ_FIFO_LIFETIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_LIFETIME_8821C) & \ -+ BIT_MASK_MGQ_FIFO_LIFETIME_8821C) -+#define BIT_SET_MGQ_FIFO_LIFETIME_8821C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_LIFETIME_8821C(x) | BIT_MGQ_FIFO_LIFETIME_8821C(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C 0x7f -+#define BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C) -+#define BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C(v)) -+ -+/* 2 REG_SHCUT_SETTING_8821C */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE0_8821C */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE1_8821C */ -+ -+/* 2 REG_SHCUT_LLC_OUI0_8821C */ -+ -+/* 2 REG_SHCUT_LLC_OUI1_8821C */ -+ -+/* 2 REG_SHCUT_LLC_OUI2_8821C */ -+ -+/* 2 REG_MU_TX_CTL_8821C */ -+#define BIT_R_MU_P1_WAIT_STATE_EN_8821C BIT(16) -+ -+#define BIT_SHIFT_R_MU_RL_8821C 12 -+#define BIT_MASK_R_MU_RL_8821C 0xf -+#define BIT_R_MU_RL_8821C(x) \ -+ (((x) & BIT_MASK_R_MU_RL_8821C) << BIT_SHIFT_R_MU_RL_8821C) -+#define BITS_R_MU_RL_8821C (BIT_MASK_R_MU_RL_8821C << BIT_SHIFT_R_MU_RL_8821C) -+#define BIT_CLEAR_R_MU_RL_8821C(x) ((x) & (~BITS_R_MU_RL_8821C)) -+#define BIT_GET_R_MU_RL_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_RL_8821C) & BIT_MASK_R_MU_RL_8821C) -+#define BIT_SET_R_MU_RL_8821C(x, v) \ -+ (BIT_CLEAR_R_MU_RL_8821C(x) | BIT_R_MU_RL_8821C(v)) -+ -+#define BIT_R_FORCE_P1_RATEDOWN_8821C BIT(11) -+ -+#define BIT_SHIFT_R_MU_TAB_SEL_8821C 8 -+#define BIT_MASK_R_MU_TAB_SEL_8821C 0x7 -+#define BIT_R_MU_TAB_SEL_8821C(x) \ -+ (((x) & BIT_MASK_R_MU_TAB_SEL_8821C) << BIT_SHIFT_R_MU_TAB_SEL_8821C) -+#define BITS_R_MU_TAB_SEL_8821C \ -+ (BIT_MASK_R_MU_TAB_SEL_8821C << BIT_SHIFT_R_MU_TAB_SEL_8821C) -+#define BIT_CLEAR_R_MU_TAB_SEL_8821C(x) ((x) & (~BITS_R_MU_TAB_SEL_8821C)) -+#define BIT_GET_R_MU_TAB_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_TAB_SEL_8821C) & BIT_MASK_R_MU_TAB_SEL_8821C) -+#define BIT_SET_R_MU_TAB_SEL_8821C(x, v) \ -+ (BIT_CLEAR_R_MU_TAB_SEL_8821C(x) | BIT_R_MU_TAB_SEL_8821C(v)) -+ -+#define BIT_R_EN_MU_MIMO_8821C BIT(7) -+#define BIT_R_EN_REVERS_GTAB_8821C BIT(6) -+ -+#define BIT_SHIFT_R_MU_TABLE_VALID_8821C 0 -+#define BIT_MASK_R_MU_TABLE_VALID_8821C 0x3f -+#define BIT_R_MU_TABLE_VALID_8821C(x) \ -+ (((x) & BIT_MASK_R_MU_TABLE_VALID_8821C) \ -+ << BIT_SHIFT_R_MU_TABLE_VALID_8821C) -+#define BITS_R_MU_TABLE_VALID_8821C \ -+ (BIT_MASK_R_MU_TABLE_VALID_8821C << BIT_SHIFT_R_MU_TABLE_VALID_8821C) -+#define BIT_CLEAR_R_MU_TABLE_VALID_8821C(x) \ -+ ((x) & (~BITS_R_MU_TABLE_VALID_8821C)) -+#define BIT_GET_R_MU_TABLE_VALID_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_TABLE_VALID_8821C) & \ -+ BIT_MASK_R_MU_TABLE_VALID_8821C) -+#define BIT_SET_R_MU_TABLE_VALID_8821C(x, v) \ -+ (BIT_CLEAR_R_MU_TABLE_VALID_8821C(x) | BIT_R_MU_TABLE_VALID_8821C(v)) -+ -+/* 2 REG_MU_STA_GID_VLD_8821C */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_VALID_8821C 0 -+#define BIT_MASK_R_MU_STA_GTAB_VALID_8821C 0xffffffffL -+#define BIT_R_MU_STA_GTAB_VALID_8821C(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_VALID_8821C) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8821C) -+#define BITS_R_MU_STA_GTAB_VALID_8821C \ -+ (BIT_MASK_R_MU_STA_GTAB_VALID_8821C \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8821C) -+#define BIT_CLEAR_R_MU_STA_GTAB_VALID_8821C(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_VALID_8821C)) -+#define BIT_GET_R_MU_STA_GTAB_VALID_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_VALID_8821C) & \ -+ BIT_MASK_R_MU_STA_GTAB_VALID_8821C) -+#define BIT_SET_R_MU_STA_GTAB_VALID_8821C(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_VALID_8821C(x) | \ -+ BIT_R_MU_STA_GTAB_VALID_8821C(v)) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_8821C */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8821C 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_L_8821C 0xffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_L_8821C(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_L_8821C) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8821C) -+#define BITS_R_MU_STA_GTAB_POSITION_L_8821C \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_L_8821C \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8821C) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_L_8821C(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_L_8821C)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8821C) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_L_8821C) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_L_8821C(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_L_8821C(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_L_8821C(v)) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_H_8821C */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8821C 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_H_8821C 0xffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_H_8821C(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_H_8821C) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8821C) -+#define BITS_R_MU_STA_GTAB_POSITION_H_8821C \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_H_8821C \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8821C) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_H_8821C(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_H_8821C)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_H_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8821C) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_H_8821C) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_H_8821C(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_H_8821C(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_H_8821C(v)) -+ -+/* 2 REG_MU_TRX_DBG_CNT_8821C */ -+#define BIT_MU_DNGCNT_RST_8821C BIT(20) -+ -+#define BIT_SHIFT_MU_DBGCNT_SEL_8821C 16 -+#define BIT_MASK_MU_DBGCNT_SEL_8821C 0xf -+#define BIT_MU_DBGCNT_SEL_8821C(x) \ -+ (((x) & BIT_MASK_MU_DBGCNT_SEL_8821C) << BIT_SHIFT_MU_DBGCNT_SEL_8821C) -+#define BITS_MU_DBGCNT_SEL_8821C \ -+ (BIT_MASK_MU_DBGCNT_SEL_8821C << BIT_SHIFT_MU_DBGCNT_SEL_8821C) -+#define BIT_CLEAR_MU_DBGCNT_SEL_8821C(x) ((x) & (~BITS_MU_DBGCNT_SEL_8821C)) -+#define BIT_GET_MU_DBGCNT_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_MU_DBGCNT_SEL_8821C) & BIT_MASK_MU_DBGCNT_SEL_8821C) -+#define BIT_SET_MU_DBGCNT_SEL_8821C(x, v) \ -+ (BIT_CLEAR_MU_DBGCNT_SEL_8821C(x) | BIT_MU_DBGCNT_SEL_8821C(v)) -+ -+#define BIT_SHIFT_MU_DNGCNT_8821C 0 -+#define BIT_MASK_MU_DNGCNT_8821C 0xffff -+#define BIT_MU_DNGCNT_8821C(x) \ -+ (((x) & BIT_MASK_MU_DNGCNT_8821C) << BIT_SHIFT_MU_DNGCNT_8821C) -+#define BITS_MU_DNGCNT_8821C \ -+ (BIT_MASK_MU_DNGCNT_8821C << BIT_SHIFT_MU_DNGCNT_8821C) -+#define BIT_CLEAR_MU_DNGCNT_8821C(x) ((x) & (~BITS_MU_DNGCNT_8821C)) -+#define BIT_GET_MU_DNGCNT_8821C(x) \ -+ (((x) >> BIT_SHIFT_MU_DNGCNT_8821C) & BIT_MASK_MU_DNGCNT_8821C) -+#define BIT_SET_MU_DNGCNT_8821C(x, v) \ -+ (BIT_CLEAR_MU_DNGCNT_8821C(x) | BIT_MU_DNGCNT_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_EDCA_VO_PARAM_8821C */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8821C 16 -+#define BIT_MASK_TXOPLIMIT_8821C 0x7ff -+#define BIT_TXOPLIMIT_8821C(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8821C) << BIT_SHIFT_TXOPLIMIT_8821C) -+#define BITS_TXOPLIMIT_8821C \ -+ (BIT_MASK_TXOPLIMIT_8821C << BIT_SHIFT_TXOPLIMIT_8821C) -+#define BIT_CLEAR_TXOPLIMIT_8821C(x) ((x) & (~BITS_TXOPLIMIT_8821C)) -+#define BIT_GET_TXOPLIMIT_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8821C) & BIT_MASK_TXOPLIMIT_8821C) -+#define BIT_SET_TXOPLIMIT_8821C(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8821C(x) | BIT_TXOPLIMIT_8821C(v)) -+ -+#define BIT_SHIFT_CW_8821C 8 -+#define BIT_MASK_CW_8821C 0xff -+#define BIT_CW_8821C(x) (((x) & BIT_MASK_CW_8821C) << BIT_SHIFT_CW_8821C) -+#define BITS_CW_8821C (BIT_MASK_CW_8821C << BIT_SHIFT_CW_8821C) -+#define BIT_CLEAR_CW_8821C(x) ((x) & (~BITS_CW_8821C)) -+#define BIT_GET_CW_8821C(x) (((x) >> BIT_SHIFT_CW_8821C) & BIT_MASK_CW_8821C) -+#define BIT_SET_CW_8821C(x, v) (BIT_CLEAR_CW_8821C(x) | BIT_CW_8821C(v)) -+ -+#define BIT_SHIFT_AIFS_8821C 0 -+#define BIT_MASK_AIFS_8821C 0xff -+#define BIT_AIFS_8821C(x) (((x) & BIT_MASK_AIFS_8821C) << BIT_SHIFT_AIFS_8821C) -+#define BITS_AIFS_8821C (BIT_MASK_AIFS_8821C << BIT_SHIFT_AIFS_8821C) -+#define BIT_CLEAR_AIFS_8821C(x) ((x) & (~BITS_AIFS_8821C)) -+#define BIT_GET_AIFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8821C) & BIT_MASK_AIFS_8821C) -+#define BIT_SET_AIFS_8821C(x, v) (BIT_CLEAR_AIFS_8821C(x) | BIT_AIFS_8821C(v)) -+ -+/* 2 REG_EDCA_VI_PARAM_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8821C 16 -+#define BIT_MASK_TXOPLIMIT_8821C 0x7ff -+#define BIT_TXOPLIMIT_8821C(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8821C) << BIT_SHIFT_TXOPLIMIT_8821C) -+#define BITS_TXOPLIMIT_8821C \ -+ (BIT_MASK_TXOPLIMIT_8821C << BIT_SHIFT_TXOPLIMIT_8821C) -+#define BIT_CLEAR_TXOPLIMIT_8821C(x) ((x) & (~BITS_TXOPLIMIT_8821C)) -+#define BIT_GET_TXOPLIMIT_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8821C) & BIT_MASK_TXOPLIMIT_8821C) -+#define BIT_SET_TXOPLIMIT_8821C(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8821C(x) | BIT_TXOPLIMIT_8821C(v)) -+ -+#define BIT_SHIFT_CW_8821C 8 -+#define BIT_MASK_CW_8821C 0xff -+#define BIT_CW_8821C(x) (((x) & BIT_MASK_CW_8821C) << BIT_SHIFT_CW_8821C) -+#define BITS_CW_8821C (BIT_MASK_CW_8821C << BIT_SHIFT_CW_8821C) -+#define BIT_CLEAR_CW_8821C(x) ((x) & (~BITS_CW_8821C)) -+#define BIT_GET_CW_8821C(x) (((x) >> BIT_SHIFT_CW_8821C) & BIT_MASK_CW_8821C) -+#define BIT_SET_CW_8821C(x, v) (BIT_CLEAR_CW_8821C(x) | BIT_CW_8821C(v)) -+ -+#define BIT_SHIFT_AIFS_8821C 0 -+#define BIT_MASK_AIFS_8821C 0xff -+#define BIT_AIFS_8821C(x) (((x) & BIT_MASK_AIFS_8821C) << BIT_SHIFT_AIFS_8821C) -+#define BITS_AIFS_8821C (BIT_MASK_AIFS_8821C << BIT_SHIFT_AIFS_8821C) -+#define BIT_CLEAR_AIFS_8821C(x) ((x) & (~BITS_AIFS_8821C)) -+#define BIT_GET_AIFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8821C) & BIT_MASK_AIFS_8821C) -+#define BIT_SET_AIFS_8821C(x, v) (BIT_CLEAR_AIFS_8821C(x) | BIT_AIFS_8821C(v)) -+ -+/* 2 REG_EDCA_BE_PARAM_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8821C 16 -+#define BIT_MASK_TXOPLIMIT_8821C 0x7ff -+#define BIT_TXOPLIMIT_8821C(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8821C) << BIT_SHIFT_TXOPLIMIT_8821C) -+#define BITS_TXOPLIMIT_8821C \ -+ (BIT_MASK_TXOPLIMIT_8821C << BIT_SHIFT_TXOPLIMIT_8821C) -+#define BIT_CLEAR_TXOPLIMIT_8821C(x) ((x) & (~BITS_TXOPLIMIT_8821C)) -+#define BIT_GET_TXOPLIMIT_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8821C) & BIT_MASK_TXOPLIMIT_8821C) -+#define BIT_SET_TXOPLIMIT_8821C(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8821C(x) | BIT_TXOPLIMIT_8821C(v)) -+ -+#define BIT_SHIFT_CW_8821C 8 -+#define BIT_MASK_CW_8821C 0xff -+#define BIT_CW_8821C(x) (((x) & BIT_MASK_CW_8821C) << BIT_SHIFT_CW_8821C) -+#define BITS_CW_8821C (BIT_MASK_CW_8821C << BIT_SHIFT_CW_8821C) -+#define BIT_CLEAR_CW_8821C(x) ((x) & (~BITS_CW_8821C)) -+#define BIT_GET_CW_8821C(x) (((x) >> BIT_SHIFT_CW_8821C) & BIT_MASK_CW_8821C) -+#define BIT_SET_CW_8821C(x, v) (BIT_CLEAR_CW_8821C(x) | BIT_CW_8821C(v)) -+ -+#define BIT_SHIFT_AIFS_8821C 0 -+#define BIT_MASK_AIFS_8821C 0xff -+#define BIT_AIFS_8821C(x) (((x) & BIT_MASK_AIFS_8821C) << BIT_SHIFT_AIFS_8821C) -+#define BITS_AIFS_8821C (BIT_MASK_AIFS_8821C << BIT_SHIFT_AIFS_8821C) -+#define BIT_CLEAR_AIFS_8821C(x) ((x) & (~BITS_AIFS_8821C)) -+#define BIT_GET_AIFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8821C) & BIT_MASK_AIFS_8821C) -+#define BIT_SET_AIFS_8821C(x, v) (BIT_CLEAR_AIFS_8821C(x) | BIT_AIFS_8821C(v)) -+ -+/* 2 REG_EDCA_BK_PARAM_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8821C 16 -+#define BIT_MASK_TXOPLIMIT_8821C 0x7ff -+#define BIT_TXOPLIMIT_8821C(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8821C) << BIT_SHIFT_TXOPLIMIT_8821C) -+#define BITS_TXOPLIMIT_8821C \ -+ (BIT_MASK_TXOPLIMIT_8821C << BIT_SHIFT_TXOPLIMIT_8821C) -+#define BIT_CLEAR_TXOPLIMIT_8821C(x) ((x) & (~BITS_TXOPLIMIT_8821C)) -+#define BIT_GET_TXOPLIMIT_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8821C) & BIT_MASK_TXOPLIMIT_8821C) -+#define BIT_SET_TXOPLIMIT_8821C(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8821C(x) | BIT_TXOPLIMIT_8821C(v)) -+ -+#define BIT_SHIFT_CW_8821C 8 -+#define BIT_MASK_CW_8821C 0xff -+#define BIT_CW_8821C(x) (((x) & BIT_MASK_CW_8821C) << BIT_SHIFT_CW_8821C) -+#define BITS_CW_8821C (BIT_MASK_CW_8821C << BIT_SHIFT_CW_8821C) -+#define BIT_CLEAR_CW_8821C(x) ((x) & (~BITS_CW_8821C)) -+#define BIT_GET_CW_8821C(x) (((x) >> BIT_SHIFT_CW_8821C) & BIT_MASK_CW_8821C) -+#define BIT_SET_CW_8821C(x, v) (BIT_CLEAR_CW_8821C(x) | BIT_CW_8821C(v)) -+ -+#define BIT_SHIFT_AIFS_8821C 0 -+#define BIT_MASK_AIFS_8821C 0xff -+#define BIT_AIFS_8821C(x) (((x) & BIT_MASK_AIFS_8821C) << BIT_SHIFT_AIFS_8821C) -+#define BITS_AIFS_8821C (BIT_MASK_AIFS_8821C << BIT_SHIFT_AIFS_8821C) -+#define BIT_CLEAR_AIFS_8821C(x) ((x) & (~BITS_AIFS_8821C)) -+#define BIT_GET_AIFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8821C) & BIT_MASK_AIFS_8821C) -+#define BIT_SET_AIFS_8821C(x, v) (BIT_CLEAR_AIFS_8821C(x) | BIT_AIFS_8821C(v)) -+ -+/* 2 REG_BCNTCFG_8821C */ -+ -+#define BIT_SHIFT_BCNCW_MAX_8821C 12 -+#define BIT_MASK_BCNCW_MAX_8821C 0xf -+#define BIT_BCNCW_MAX_8821C(x) \ -+ (((x) & BIT_MASK_BCNCW_MAX_8821C) << BIT_SHIFT_BCNCW_MAX_8821C) -+#define BITS_BCNCW_MAX_8821C \ -+ (BIT_MASK_BCNCW_MAX_8821C << BIT_SHIFT_BCNCW_MAX_8821C) -+#define BIT_CLEAR_BCNCW_MAX_8821C(x) ((x) & (~BITS_BCNCW_MAX_8821C)) -+#define BIT_GET_BCNCW_MAX_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MAX_8821C) & BIT_MASK_BCNCW_MAX_8821C) -+#define BIT_SET_BCNCW_MAX_8821C(x, v) \ -+ (BIT_CLEAR_BCNCW_MAX_8821C(x) | BIT_BCNCW_MAX_8821C(v)) -+ -+#define BIT_SHIFT_BCNCW_MIN_8821C 8 -+#define BIT_MASK_BCNCW_MIN_8821C 0xf -+#define BIT_BCNCW_MIN_8821C(x) \ -+ (((x) & BIT_MASK_BCNCW_MIN_8821C) << BIT_SHIFT_BCNCW_MIN_8821C) -+#define BITS_BCNCW_MIN_8821C \ -+ (BIT_MASK_BCNCW_MIN_8821C << BIT_SHIFT_BCNCW_MIN_8821C) -+#define BIT_CLEAR_BCNCW_MIN_8821C(x) ((x) & (~BITS_BCNCW_MIN_8821C)) -+#define BIT_GET_BCNCW_MIN_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MIN_8821C) & BIT_MASK_BCNCW_MIN_8821C) -+#define BIT_SET_BCNCW_MIN_8821C(x, v) \ -+ (BIT_CLEAR_BCNCW_MIN_8821C(x) | BIT_BCNCW_MIN_8821C(v)) -+ -+#define BIT_SHIFT_BCNIFS_8821C 0 -+#define BIT_MASK_BCNIFS_8821C 0xff -+#define BIT_BCNIFS_8821C(x) \ -+ (((x) & BIT_MASK_BCNIFS_8821C) << BIT_SHIFT_BCNIFS_8821C) -+#define BITS_BCNIFS_8821C (BIT_MASK_BCNIFS_8821C << BIT_SHIFT_BCNIFS_8821C) -+#define BIT_CLEAR_BCNIFS_8821C(x) ((x) & (~BITS_BCNIFS_8821C)) -+#define BIT_GET_BCNIFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNIFS_8821C) & BIT_MASK_BCNIFS_8821C) -+#define BIT_SET_BCNIFS_8821C(x, v) \ -+ (BIT_CLEAR_BCNIFS_8821C(x) | BIT_BCNIFS_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_PIFS_8821C */ -+ -+#define BIT_SHIFT_PIFS_8821C 0 -+#define BIT_MASK_PIFS_8821C 0xff -+#define BIT_PIFS_8821C(x) (((x) & BIT_MASK_PIFS_8821C) << BIT_SHIFT_PIFS_8821C) -+#define BITS_PIFS_8821C (BIT_MASK_PIFS_8821C << BIT_SHIFT_PIFS_8821C) -+#define BIT_CLEAR_PIFS_8821C(x) ((x) & (~BITS_PIFS_8821C)) -+#define BIT_GET_PIFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_PIFS_8821C) & BIT_MASK_PIFS_8821C) -+#define BIT_SET_PIFS_8821C(x, v) (BIT_CLEAR_PIFS_8821C(x) | BIT_PIFS_8821C(v)) -+ -+/* 2 REG_RDG_PIFS_8821C */ -+ -+#define BIT_SHIFT_RDG_PIFS_8821C 0 -+#define BIT_MASK_RDG_PIFS_8821C 0xff -+#define BIT_RDG_PIFS_8821C(x) \ -+ (((x) & BIT_MASK_RDG_PIFS_8821C) << BIT_SHIFT_RDG_PIFS_8821C) -+#define BITS_RDG_PIFS_8821C \ -+ (BIT_MASK_RDG_PIFS_8821C << BIT_SHIFT_RDG_PIFS_8821C) -+#define BIT_CLEAR_RDG_PIFS_8821C(x) ((x) & (~BITS_RDG_PIFS_8821C)) -+#define BIT_GET_RDG_PIFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_RDG_PIFS_8821C) & BIT_MASK_RDG_PIFS_8821C) -+#define BIT_SET_RDG_PIFS_8821C(x, v) \ -+ (BIT_CLEAR_RDG_PIFS_8821C(x) | BIT_RDG_PIFS_8821C(v)) -+ -+/* 2 REG_SIFS_8821C */ -+ -+#define BIT_SHIFT_SIFS_OFDM_TRX_8821C 24 -+#define BIT_MASK_SIFS_OFDM_TRX_8821C 0xff -+#define BIT_SIFS_OFDM_TRX_8821C(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_TRX_8821C) << BIT_SHIFT_SIFS_OFDM_TRX_8821C) -+#define BITS_SIFS_OFDM_TRX_8821C \ -+ (BIT_MASK_SIFS_OFDM_TRX_8821C << BIT_SHIFT_SIFS_OFDM_TRX_8821C) -+#define BIT_CLEAR_SIFS_OFDM_TRX_8821C(x) ((x) & (~BITS_SIFS_OFDM_TRX_8821C)) -+#define BIT_GET_SIFS_OFDM_TRX_8821C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_TRX_8821C) & BIT_MASK_SIFS_OFDM_TRX_8821C) -+#define BIT_SET_SIFS_OFDM_TRX_8821C(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_TRX_8821C(x) | BIT_SIFS_OFDM_TRX_8821C(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_TRX_8821C 16 -+#define BIT_MASK_SIFS_CCK_TRX_8821C 0xff -+#define BIT_SIFS_CCK_TRX_8821C(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_TRX_8821C) << BIT_SHIFT_SIFS_CCK_TRX_8821C) -+#define BITS_SIFS_CCK_TRX_8821C \ -+ (BIT_MASK_SIFS_CCK_TRX_8821C << BIT_SHIFT_SIFS_CCK_TRX_8821C) -+#define BIT_CLEAR_SIFS_CCK_TRX_8821C(x) ((x) & (~BITS_SIFS_CCK_TRX_8821C)) -+#define BIT_GET_SIFS_CCK_TRX_8821C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_TRX_8821C) & BIT_MASK_SIFS_CCK_TRX_8821C) -+#define BIT_SET_SIFS_CCK_TRX_8821C(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_TRX_8821C(x) | BIT_SIFS_CCK_TRX_8821C(v)) -+ -+#define BIT_SHIFT_SIFS_OFDM_CTX_8821C 8 -+#define BIT_MASK_SIFS_OFDM_CTX_8821C 0xff -+#define BIT_SIFS_OFDM_CTX_8821C(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_CTX_8821C) << BIT_SHIFT_SIFS_OFDM_CTX_8821C) -+#define BITS_SIFS_OFDM_CTX_8821C \ -+ (BIT_MASK_SIFS_OFDM_CTX_8821C << BIT_SHIFT_SIFS_OFDM_CTX_8821C) -+#define BIT_CLEAR_SIFS_OFDM_CTX_8821C(x) ((x) & (~BITS_SIFS_OFDM_CTX_8821C)) -+#define BIT_GET_SIFS_OFDM_CTX_8821C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_CTX_8821C) & BIT_MASK_SIFS_OFDM_CTX_8821C) -+#define BIT_SET_SIFS_OFDM_CTX_8821C(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_CTX_8821C(x) | BIT_SIFS_OFDM_CTX_8821C(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_CTX_8821C 0 -+#define BIT_MASK_SIFS_CCK_CTX_8821C 0xff -+#define BIT_SIFS_CCK_CTX_8821C(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_CTX_8821C) << BIT_SHIFT_SIFS_CCK_CTX_8821C) -+#define BITS_SIFS_CCK_CTX_8821C \ -+ (BIT_MASK_SIFS_CCK_CTX_8821C << BIT_SHIFT_SIFS_CCK_CTX_8821C) -+#define BIT_CLEAR_SIFS_CCK_CTX_8821C(x) ((x) & (~BITS_SIFS_CCK_CTX_8821C)) -+#define BIT_GET_SIFS_CCK_CTX_8821C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_CTX_8821C) & BIT_MASK_SIFS_CCK_CTX_8821C) -+#define BIT_SET_SIFS_CCK_CTX_8821C(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_CTX_8821C(x) | BIT_SIFS_CCK_CTX_8821C(v)) -+ -+/* 2 REG_TSFTR_SYN_OFFSET_8821C */ -+ -+#define BIT_SHIFT_TSFTR_SNC_OFFSET_8821C 0 -+#define BIT_MASK_TSFTR_SNC_OFFSET_8821C 0xffff -+#define BIT_TSFTR_SNC_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_TSFTR_SNC_OFFSET_8821C) \ -+ << BIT_SHIFT_TSFTR_SNC_OFFSET_8821C) -+#define BITS_TSFTR_SNC_OFFSET_8821C \ -+ (BIT_MASK_TSFTR_SNC_OFFSET_8821C << BIT_SHIFT_TSFTR_SNC_OFFSET_8821C) -+#define BIT_CLEAR_TSFTR_SNC_OFFSET_8821C(x) \ -+ ((x) & (~BITS_TSFTR_SNC_OFFSET_8821C)) -+#define BIT_GET_TSFTR_SNC_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_TSFTR_SNC_OFFSET_8821C) & \ -+ BIT_MASK_TSFTR_SNC_OFFSET_8821C) -+#define BIT_SET_TSFTR_SNC_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_TSFTR_SNC_OFFSET_8821C(x) | BIT_TSFTR_SNC_OFFSET_8821C(v)) -+ -+/* 2 REG_AGGR_BREAK_TIME_8821C */ -+ -+#define BIT_SHIFT_AGGR_BK_TIME_8821C 0 -+#define BIT_MASK_AGGR_BK_TIME_8821C 0xff -+#define BIT_AGGR_BK_TIME_8821C(x) \ -+ (((x) & BIT_MASK_AGGR_BK_TIME_8821C) << BIT_SHIFT_AGGR_BK_TIME_8821C) -+#define BITS_AGGR_BK_TIME_8821C \ -+ (BIT_MASK_AGGR_BK_TIME_8821C << BIT_SHIFT_AGGR_BK_TIME_8821C) -+#define BIT_CLEAR_AGGR_BK_TIME_8821C(x) ((x) & (~BITS_AGGR_BK_TIME_8821C)) -+#define BIT_GET_AGGR_BK_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_AGGR_BK_TIME_8821C) & BIT_MASK_AGGR_BK_TIME_8821C) -+#define BIT_SET_AGGR_BK_TIME_8821C(x, v) \ -+ (BIT_CLEAR_AGGR_BK_TIME_8821C(x) | BIT_AGGR_BK_TIME_8821C(v)) -+ -+/* 2 REG_SLOT_8821C */ -+ -+#define BIT_SHIFT_SLOT_8821C 0 -+#define BIT_MASK_SLOT_8821C 0xff -+#define BIT_SLOT_8821C(x) (((x) & BIT_MASK_SLOT_8821C) << BIT_SHIFT_SLOT_8821C) -+#define BITS_SLOT_8821C (BIT_MASK_SLOT_8821C << BIT_SHIFT_SLOT_8821C) -+#define BIT_CLEAR_SLOT_8821C(x) ((x) & (~BITS_SLOT_8821C)) -+#define BIT_GET_SLOT_8821C(x) \ -+ (((x) >> BIT_SHIFT_SLOT_8821C) & BIT_MASK_SLOT_8821C) -+#define BIT_SET_SLOT_8821C(x, v) (BIT_CLEAR_SLOT_8821C(x) | BIT_SLOT_8821C(v)) -+ -+/* 2 REG_NOA_ON_ERLY_TIME_8821C */ -+ -+#define BIT_SHIFT__NOA_ON_ERLY_TIME_8821C 0 -+#define BIT_MASK__NOA_ON_ERLY_TIME_8821C 0xff -+#define BIT__NOA_ON_ERLY_TIME_8821C(x) \ -+ (((x) & BIT_MASK__NOA_ON_ERLY_TIME_8821C) \ -+ << BIT_SHIFT__NOA_ON_ERLY_TIME_8821C) -+#define BITS__NOA_ON_ERLY_TIME_8821C \ -+ (BIT_MASK__NOA_ON_ERLY_TIME_8821C << BIT_SHIFT__NOA_ON_ERLY_TIME_8821C) -+#define BIT_CLEAR__NOA_ON_ERLY_TIME_8821C(x) \ -+ ((x) & (~BITS__NOA_ON_ERLY_TIME_8821C)) -+#define BIT_GET__NOA_ON_ERLY_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT__NOA_ON_ERLY_TIME_8821C) & \ -+ BIT_MASK__NOA_ON_ERLY_TIME_8821C) -+#define BIT_SET__NOA_ON_ERLY_TIME_8821C(x, v) \ -+ (BIT_CLEAR__NOA_ON_ERLY_TIME_8821C(x) | BIT__NOA_ON_ERLY_TIME_8821C(v)) -+ -+/* 2 REG_NOA_OFF_ERLY_TIME_8821C */ -+ -+#define BIT_SHIFT__NOA_OFF_ERLY_TIME_8821C 0 -+#define BIT_MASK__NOA_OFF_ERLY_TIME_8821C 0xff -+#define BIT__NOA_OFF_ERLY_TIME_8821C(x) \ -+ (((x) & BIT_MASK__NOA_OFF_ERLY_TIME_8821C) \ -+ << BIT_SHIFT__NOA_OFF_ERLY_TIME_8821C) -+#define BITS__NOA_OFF_ERLY_TIME_8821C \ -+ (BIT_MASK__NOA_OFF_ERLY_TIME_8821C \ -+ << BIT_SHIFT__NOA_OFF_ERLY_TIME_8821C) -+#define BIT_CLEAR__NOA_OFF_ERLY_TIME_8821C(x) \ -+ ((x) & (~BITS__NOA_OFF_ERLY_TIME_8821C)) -+#define BIT_GET__NOA_OFF_ERLY_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT__NOA_OFF_ERLY_TIME_8821C) & \ -+ BIT_MASK__NOA_OFF_ERLY_TIME_8821C) -+#define BIT_SET__NOA_OFF_ERLY_TIME_8821C(x, v) \ -+ (BIT_CLEAR__NOA_OFF_ERLY_TIME_8821C(x) | \ -+ BIT__NOA_OFF_ERLY_TIME_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_TX_PTCL_CTRL_8821C */ -+#define BIT_DIS_EDCCA_8821C BIT(15) -+#define BIT_DIS_CCA_8821C BIT(14) -+#define BIT_LSIG_TXOP_TXCMD_NAV_8821C BIT(13) -+#define BIT_SIFS_BK_EN_8821C BIT(12) -+ -+#define BIT_SHIFT_TXQ_NAV_MSK_8821C 8 -+#define BIT_MASK_TXQ_NAV_MSK_8821C 0xf -+#define BIT_TXQ_NAV_MSK_8821C(x) \ -+ (((x) & BIT_MASK_TXQ_NAV_MSK_8821C) << BIT_SHIFT_TXQ_NAV_MSK_8821C) -+#define BITS_TXQ_NAV_MSK_8821C \ -+ (BIT_MASK_TXQ_NAV_MSK_8821C << BIT_SHIFT_TXQ_NAV_MSK_8821C) -+#define BIT_CLEAR_TXQ_NAV_MSK_8821C(x) ((x) & (~BITS_TXQ_NAV_MSK_8821C)) -+#define BIT_GET_TXQ_NAV_MSK_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXQ_NAV_MSK_8821C) & BIT_MASK_TXQ_NAV_MSK_8821C) -+#define BIT_SET_TXQ_NAV_MSK_8821C(x, v) \ -+ (BIT_CLEAR_TXQ_NAV_MSK_8821C(x) | BIT_TXQ_NAV_MSK_8821C(v)) -+ -+#define BIT_DIS_CW_8821C BIT(7) -+#define BIT_NAV_END_TXOP_8821C BIT(6) -+#define BIT_RDG_END_TXOP_8821C BIT(5) -+#define BIT_AC_INBCN_HOLD_8821C BIT(4) -+#define BIT_MGTQ_TXOP_EN_8821C BIT(3) -+#define BIT_MGTQ_RTSMF_EN_8821C BIT(2) -+#define BIT_HIQ_RTSMF_EN_8821C BIT(1) -+#define BIT_BCN_RTSMF_EN_8821C BIT(0) -+ -+/* 2 REG_TXPAUSE_8821C */ -+#define BIT_STOP_BCN_HI_MGT_8821C BIT(7) -+#define BIT_MAC_STOPBCNQ_8821C BIT(6) -+#define BIT_MAC_STOPHIQ_8821C BIT(5) -+#define BIT_MAC_STOPMGQ_8821C BIT(4) -+#define BIT_MAC_STOPBK_8821C BIT(3) -+#define BIT_MAC_STOPBE_8821C BIT(2) -+#define BIT_MAC_STOPVI_8821C BIT(1) -+#define BIT_MAC_STOPVO_8821C BIT(0) -+ -+/* 2 REG_DIS_TXREQ_CLR_8821C */ -+#define BIT_DIS_BT_CCA_8821C BIT(7) -+#define BIT_DIS_TXREQ_CLR_HI_8821C BIT(5) -+#define BIT_DIS_TXREQ_CLR_MGQ_8821C BIT(4) -+#define BIT_DIS_TXREQ_CLR_VO_8821C BIT(3) -+#define BIT_DIS_TXREQ_CLR_VI_8821C BIT(2) -+#define BIT_DIS_TXREQ_CLR_BE_8821C BIT(1) -+#define BIT_DIS_TXREQ_CLR_BK_8821C BIT(0) -+ -+/* 2 REG_RD_CTRL_8821C */ -+#define BIT_EN_CLR_TXREQ_INCCA_8821C BIT(15) -+#define BIT_DIS_TX_OVER_BCNQ_8821C BIT(14) -+#define BIT_EN_BCNERR_INCCCA_8821C BIT(13) -+#define BIT_EDCCA_MSK_CNTDOWN_EN_8821C BIT(11) -+#define BIT_DIS_TXOP_CFE_8821C BIT(10) -+#define BIT_DIS_LSIG_CFE_8821C BIT(9) -+#define BIT_DIS_STBC_CFE_8821C BIT(8) -+#define BIT_BKQ_RD_INIT_EN_8821C BIT(7) -+#define BIT_BEQ_RD_INIT_EN_8821C BIT(6) -+#define BIT_VIQ_RD_INIT_EN_8821C BIT(5) -+#define BIT_VOQ_RD_INIT_EN_8821C BIT(4) -+#define BIT_BKQ_RD_RESP_EN_8821C BIT(3) -+#define BIT_BEQ_RD_RESP_EN_8821C BIT(2) -+#define BIT_VIQ_RD_RESP_EN_8821C BIT(1) -+#define BIT_VOQ_RD_RESP_EN_8821C BIT(0) -+ -+/* 2 REG_MBSSID_CTRL_8821C */ -+#define BIT_MBID_BCNQ7_EN_8821C BIT(7) -+#define BIT_MBID_BCNQ6_EN_8821C BIT(6) -+#define BIT_MBID_BCNQ5_EN_8821C BIT(5) -+#define BIT_MBID_BCNQ4_EN_8821C BIT(4) -+#define BIT_MBID_BCNQ3_EN_8821C BIT(3) -+#define BIT_MBID_BCNQ2_EN_8821C BIT(2) -+#define BIT_MBID_BCNQ1_EN_8821C BIT(1) -+#define BIT_MBID_BCNQ0_EN_8821C BIT(0) -+ -+/* 2 REG_P2PPS_CTRL_8821C */ -+#define BIT_P2P_CTW_ALLSTASLEEP_8821C BIT(7) -+#define BIT_P2P_OFF_DISTX_EN_8821C BIT(6) -+#define BIT_PWR_MGT_EN_8821C BIT(5) -+#define BIT_P2P_NOA1_EN_8821C BIT(2) -+#define BIT_P2P_NOA0_EN_8821C BIT(1) -+ -+/* 2 REG_PKT_LIFETIME_CTRL_8821C */ -+#define BIT_EN_P2P_CTWND1_8821C BIT(23) -+#define BIT_EN_BKF_CLR_TXREQ_8821C BIT(22) -+#define BIT_EN_TSFBIT32_RST_P2P_8821C BIT(21) -+#define BIT_EN_BCN_TX_BTCCA_8821C BIT(20) -+#define BIT_DIS_PKT_TX_ATIM_8821C BIT(19) -+#define BIT_DIS_BCN_DIS_CTN_8821C BIT(18) -+#define BIT_EN_NAVEND_RST_TXOP_8821C BIT(17) -+#define BIT_EN_FILTER_CCA_8821C BIT(16) -+ -+#define BIT_SHIFT_CCA_FILTER_THRS_8821C 8 -+#define BIT_MASK_CCA_FILTER_THRS_8821C 0xff -+#define BIT_CCA_FILTER_THRS_8821C(x) \ -+ (((x) & BIT_MASK_CCA_FILTER_THRS_8821C) \ -+ << BIT_SHIFT_CCA_FILTER_THRS_8821C) -+#define BITS_CCA_FILTER_THRS_8821C \ -+ (BIT_MASK_CCA_FILTER_THRS_8821C << BIT_SHIFT_CCA_FILTER_THRS_8821C) -+#define BIT_CLEAR_CCA_FILTER_THRS_8821C(x) ((x) & (~BITS_CCA_FILTER_THRS_8821C)) -+#define BIT_GET_CCA_FILTER_THRS_8821C(x) \ -+ (((x) >> BIT_SHIFT_CCA_FILTER_THRS_8821C) & \ -+ BIT_MASK_CCA_FILTER_THRS_8821C) -+#define BIT_SET_CCA_FILTER_THRS_8821C(x, v) \ -+ (BIT_CLEAR_CCA_FILTER_THRS_8821C(x) | BIT_CCA_FILTER_THRS_8821C(v)) -+ -+#define BIT_SHIFT_EDCCA_THRS_8821C 0 -+#define BIT_MASK_EDCCA_THRS_8821C 0xff -+#define BIT_EDCCA_THRS_8821C(x) \ -+ (((x) & BIT_MASK_EDCCA_THRS_8821C) << BIT_SHIFT_EDCCA_THRS_8821C) -+#define BITS_EDCCA_THRS_8821C \ -+ (BIT_MASK_EDCCA_THRS_8821C << BIT_SHIFT_EDCCA_THRS_8821C) -+#define BIT_CLEAR_EDCCA_THRS_8821C(x) ((x) & (~BITS_EDCCA_THRS_8821C)) -+#define BIT_GET_EDCCA_THRS_8821C(x) \ -+ (((x) >> BIT_SHIFT_EDCCA_THRS_8821C) & BIT_MASK_EDCCA_THRS_8821C) -+#define BIT_SET_EDCCA_THRS_8821C(x, v) \ -+ (BIT_CLEAR_EDCCA_THRS_8821C(x) | BIT_EDCCA_THRS_8821C(v)) -+ -+/* 2 REG_P2PPS_SPEC_STATE_8821C */ -+#define BIT_SPEC_POWER_STATE_8821C BIT(7) -+#define BIT_SPEC_CTWINDOW_ON_8821C BIT(6) -+#define BIT_SPEC_BEACON_AREA_ON_8821C BIT(5) -+#define BIT_SPEC_CTWIN_EARLY_DISTX_8821C BIT(4) -+#define BIT_SPEC_NOA1_OFF_PERIOD_8821C BIT(3) -+#define BIT_SPEC_FORCE_DOZE1_8821C BIT(2) -+#define BIT_SPEC_NOA0_OFF_PERIOD_8821C BIT(1) -+#define BIT_SPEC_FORCE_DOZE0_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_BAR_TX_CTRL_8821C */ -+ -+/* 2 REG_P2PON_DIS_TXTIME_8821C */ -+ -+#define BIT_SHIFT_P2PON_DIS_TXTIME_8821C 0 -+#define BIT_MASK_P2PON_DIS_TXTIME_8821C 0xff -+#define BIT_P2PON_DIS_TXTIME_8821C(x) \ -+ (((x) & BIT_MASK_P2PON_DIS_TXTIME_8821C) \ -+ << BIT_SHIFT_P2PON_DIS_TXTIME_8821C) -+#define BITS_P2PON_DIS_TXTIME_8821C \ -+ (BIT_MASK_P2PON_DIS_TXTIME_8821C << BIT_SHIFT_P2PON_DIS_TXTIME_8821C) -+#define BIT_CLEAR_P2PON_DIS_TXTIME_8821C(x) \ -+ ((x) & (~BITS_P2PON_DIS_TXTIME_8821C)) -+#define BIT_GET_P2PON_DIS_TXTIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_P2PON_DIS_TXTIME_8821C) & \ -+ BIT_MASK_P2PON_DIS_TXTIME_8821C) -+#define BIT_SET_P2PON_DIS_TXTIME_8821C(x, v) \ -+ (BIT_CLEAR_P2PON_DIS_TXTIME_8821C(x) | BIT_P2PON_DIS_TXTIME_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_TBTT_PROHIBIT_8821C */ -+ -+#define BIT_SHIFT_TBTT_HOLD_TIME_AP_8821C 8 -+#define BIT_MASK_TBTT_HOLD_TIME_AP_8821C 0xfff -+#define BIT_TBTT_HOLD_TIME_AP_8821C(x) \ -+ (((x) & BIT_MASK_TBTT_HOLD_TIME_AP_8821C) \ -+ << BIT_SHIFT_TBTT_HOLD_TIME_AP_8821C) -+#define BITS_TBTT_HOLD_TIME_AP_8821C \ -+ (BIT_MASK_TBTT_HOLD_TIME_AP_8821C << BIT_SHIFT_TBTT_HOLD_TIME_AP_8821C) -+#define BIT_CLEAR_TBTT_HOLD_TIME_AP_8821C(x) \ -+ ((x) & (~BITS_TBTT_HOLD_TIME_AP_8821C)) -+#define BIT_GET_TBTT_HOLD_TIME_AP_8821C(x) \ -+ (((x) >> BIT_SHIFT_TBTT_HOLD_TIME_AP_8821C) & \ -+ BIT_MASK_TBTT_HOLD_TIME_AP_8821C) -+#define BIT_SET_TBTT_HOLD_TIME_AP_8821C(x, v) \ -+ (BIT_CLEAR_TBTT_HOLD_TIME_AP_8821C(x) | BIT_TBTT_HOLD_TIME_AP_8821C(v)) -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_SETUP_8821C 0 -+#define BIT_MASK_TBTT_PROHIBIT_SETUP_8821C 0xf -+#define BIT_TBTT_PROHIBIT_SETUP_8821C(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_SETUP_8821C) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8821C) -+#define BITS_TBTT_PROHIBIT_SETUP_8821C \ -+ (BIT_MASK_TBTT_PROHIBIT_SETUP_8821C \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8821C) -+#define BIT_CLEAR_TBTT_PROHIBIT_SETUP_8821C(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_SETUP_8821C)) -+#define BIT_GET_TBTT_PROHIBIT_SETUP_8821C(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_SETUP_8821C) & \ -+ BIT_MASK_TBTT_PROHIBIT_SETUP_8821C) -+#define BIT_SET_TBTT_PROHIBIT_SETUP_8821C(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_SETUP_8821C(x) | \ -+ BIT_TBTT_PROHIBIT_SETUP_8821C(v)) -+ -+/* 2 REG_P2PPS_STATE_8821C */ -+#define BIT_POWER_STATE_8821C BIT(7) -+#define BIT_CTWINDOW_ON_8821C BIT(6) -+#define BIT_BEACON_AREA_ON_8821C BIT(5) -+#define BIT_CTWIN_EARLY_DISTX_8821C BIT(4) -+#define BIT_NOA1_OFF_PERIOD_8821C BIT(3) -+#define BIT_FORCE_DOZE1_8821C BIT(2) -+#define BIT_NOA0_OFF_PERIOD_8821C BIT(1) -+#define BIT_FORCE_DOZE0_8821C BIT(0) -+ -+/* 2 REG_RD_NAV_NXT_8821C */ -+ -+#define BIT_SHIFT_RD_NAV_PROT_NXT_8821C 0 -+#define BIT_MASK_RD_NAV_PROT_NXT_8821C 0xffff -+#define BIT_RD_NAV_PROT_NXT_8821C(x) \ -+ (((x) & BIT_MASK_RD_NAV_PROT_NXT_8821C) \ -+ << BIT_SHIFT_RD_NAV_PROT_NXT_8821C) -+#define BITS_RD_NAV_PROT_NXT_8821C \ -+ (BIT_MASK_RD_NAV_PROT_NXT_8821C << BIT_SHIFT_RD_NAV_PROT_NXT_8821C) -+#define BIT_CLEAR_RD_NAV_PROT_NXT_8821C(x) ((x) & (~BITS_RD_NAV_PROT_NXT_8821C)) -+#define BIT_GET_RD_NAV_PROT_NXT_8821C(x) \ -+ (((x) >> BIT_SHIFT_RD_NAV_PROT_NXT_8821C) & \ -+ BIT_MASK_RD_NAV_PROT_NXT_8821C) -+#define BIT_SET_RD_NAV_PROT_NXT_8821C(x, v) \ -+ (BIT_CLEAR_RD_NAV_PROT_NXT_8821C(x) | BIT_RD_NAV_PROT_NXT_8821C(v)) -+ -+/* 2 REG_NAV_PROT_LEN_8821C */ -+ -+#define BIT_SHIFT_NAV_PROT_LEN_8821C 0 -+#define BIT_MASK_NAV_PROT_LEN_8821C 0xffff -+#define BIT_NAV_PROT_LEN_8821C(x) \ -+ (((x) & BIT_MASK_NAV_PROT_LEN_8821C) << BIT_SHIFT_NAV_PROT_LEN_8821C) -+#define BITS_NAV_PROT_LEN_8821C \ -+ (BIT_MASK_NAV_PROT_LEN_8821C << BIT_SHIFT_NAV_PROT_LEN_8821C) -+#define BIT_CLEAR_NAV_PROT_LEN_8821C(x) ((x) & (~BITS_NAV_PROT_LEN_8821C)) -+#define BIT_GET_NAV_PROT_LEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_NAV_PROT_LEN_8821C) & BIT_MASK_NAV_PROT_LEN_8821C) -+#define BIT_SET_NAV_PROT_LEN_8821C(x, v) \ -+ (BIT_CLEAR_NAV_PROT_LEN_8821C(x) | BIT_NAV_PROT_LEN_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_BCN_CTRL_8821C */ -+#define BIT_DIS_RX_BSSID_FIT_8821C BIT(6) -+#define BIT_P0_EN_TXBCN_RPT_8821C BIT(5) -+#define BIT_DIS_TSF_UDT_8821C BIT(4) -+#define BIT_EN_BCN_FUNCTION_8821C BIT(3) -+#define BIT_P0_EN_RXBCN_RPT_8821C BIT(2) -+#define BIT_EN_P2P_CTWINDOW_8821C BIT(1) -+#define BIT_EN_P2P_BCNQ_AREA_8821C BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT0_8821C */ -+#define BIT_CLI0_DIS_RX_BSSID_FIT_8821C BIT(6) -+#define BIT_CLI0_DIS_TSF_UDT_8821C BIT(4) -+#define BIT_CLI0_EN_BCN_FUNCTION_8821C BIT(3) -+#define BIT_CLI0_EN_RXBCN_RPT_8821C BIT(2) -+#define BIT_CLI0_ENP2P_CTWINDOW_8821C BIT(1) -+#define BIT_CLI0_ENP2P_BCNQ_AREA_8821C BIT(0) -+ -+/* 2 REG_MBID_NUM_8821C */ -+#define BIT_EN_PRE_DL_BEACON_8821C BIT(3) -+ -+#define BIT_SHIFT_MBID_BCN_NUM_8821C 0 -+#define BIT_MASK_MBID_BCN_NUM_8821C 0x7 -+#define BIT_MBID_BCN_NUM_8821C(x) \ -+ (((x) & BIT_MASK_MBID_BCN_NUM_8821C) << BIT_SHIFT_MBID_BCN_NUM_8821C) -+#define BITS_MBID_BCN_NUM_8821C \ -+ (BIT_MASK_MBID_BCN_NUM_8821C << BIT_SHIFT_MBID_BCN_NUM_8821C) -+#define BIT_CLEAR_MBID_BCN_NUM_8821C(x) ((x) & (~BITS_MBID_BCN_NUM_8821C)) -+#define BIT_GET_MBID_BCN_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCN_NUM_8821C) & BIT_MASK_MBID_BCN_NUM_8821C) -+#define BIT_SET_MBID_BCN_NUM_8821C(x, v) \ -+ (BIT_CLEAR_MBID_BCN_NUM_8821C(x) | BIT_MBID_BCN_NUM_8821C(v)) -+ -+/* 2 REG_DUAL_TSF_RST_8821C */ -+#define BIT_FREECNT_RST_8821C BIT(5) -+#define BIT_TSFTR_CLI3_RST_8821C BIT(4) -+#define BIT_TSFTR_CLI2_RST_8821C BIT(3) -+#define BIT_TSFTR_CLI1_RST_8821C BIT(2) -+#define BIT_TSFTR_CLI0_RST_8821C BIT(1) -+#define BIT_TSFTR_RST_8821C BIT(0) -+ -+/* 2 REG_MBSSID_BCN_SPACE_8821C */ -+ -+#define BIT_SHIFT_BCN_TIMER_SEL_FWRD_8821C 28 -+#define BIT_MASK_BCN_TIMER_SEL_FWRD_8821C 0x7 -+#define BIT_BCN_TIMER_SEL_FWRD_8821C(x) \ -+ (((x) & BIT_MASK_BCN_TIMER_SEL_FWRD_8821C) \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_8821C) -+#define BITS_BCN_TIMER_SEL_FWRD_8821C \ -+ (BIT_MASK_BCN_TIMER_SEL_FWRD_8821C \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_8821C) -+#define BIT_CLEAR_BCN_TIMER_SEL_FWRD_8821C(x) \ -+ ((x) & (~BITS_BCN_TIMER_SEL_FWRD_8821C)) -+#define BIT_GET_BCN_TIMER_SEL_FWRD_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCN_TIMER_SEL_FWRD_8821C) & \ -+ BIT_MASK_BCN_TIMER_SEL_FWRD_8821C) -+#define BIT_SET_BCN_TIMER_SEL_FWRD_8821C(x, v) \ -+ (BIT_CLEAR_BCN_TIMER_SEL_FWRD_8821C(x) | \ -+ BIT_BCN_TIMER_SEL_FWRD_8821C(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT0_8821C 16 -+#define BIT_MASK_BCN_SPACE_CLINT0_8821C 0xfff -+#define BIT_BCN_SPACE_CLINT0_8821C(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT0_8821C) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT0_8821C) -+#define BITS_BCN_SPACE_CLINT0_8821C \ -+ (BIT_MASK_BCN_SPACE_CLINT0_8821C << BIT_SHIFT_BCN_SPACE_CLINT0_8821C) -+#define BIT_CLEAR_BCN_SPACE_CLINT0_8821C(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT0_8821C)) -+#define BIT_GET_BCN_SPACE_CLINT0_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT0_8821C) & \ -+ BIT_MASK_BCN_SPACE_CLINT0_8821C) -+#define BIT_SET_BCN_SPACE_CLINT0_8821C(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT0_8821C(x) | BIT_BCN_SPACE_CLINT0_8821C(v)) -+ -+#define BIT_SHIFT_BCN_SPACE0_8821C 0 -+#define BIT_MASK_BCN_SPACE0_8821C 0xffff -+#define BIT_BCN_SPACE0_8821C(x) \ -+ (((x) & BIT_MASK_BCN_SPACE0_8821C) << BIT_SHIFT_BCN_SPACE0_8821C) -+#define BITS_BCN_SPACE0_8821C \ -+ (BIT_MASK_BCN_SPACE0_8821C << BIT_SHIFT_BCN_SPACE0_8821C) -+#define BIT_CLEAR_BCN_SPACE0_8821C(x) ((x) & (~BITS_BCN_SPACE0_8821C)) -+#define BIT_GET_BCN_SPACE0_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE0_8821C) & BIT_MASK_BCN_SPACE0_8821C) -+#define BIT_SET_BCN_SPACE0_8821C(x, v) \ -+ (BIT_CLEAR_BCN_SPACE0_8821C(x) | BIT_BCN_SPACE0_8821C(v)) -+ -+/* 2 REG_DRVERLYINT_8821C */ -+ -+#define BIT_SHIFT_DRVERLYITV_8821C 0 -+#define BIT_MASK_DRVERLYITV_8821C 0xff -+#define BIT_DRVERLYITV_8821C(x) \ -+ (((x) & BIT_MASK_DRVERLYITV_8821C) << BIT_SHIFT_DRVERLYITV_8821C) -+#define BITS_DRVERLYITV_8821C \ -+ (BIT_MASK_DRVERLYITV_8821C << BIT_SHIFT_DRVERLYITV_8821C) -+#define BIT_CLEAR_DRVERLYITV_8821C(x) ((x) & (~BITS_DRVERLYITV_8821C)) -+#define BIT_GET_DRVERLYITV_8821C(x) \ -+ (((x) >> BIT_SHIFT_DRVERLYITV_8821C) & BIT_MASK_DRVERLYITV_8821C) -+#define BIT_SET_DRVERLYITV_8821C(x, v) \ -+ (BIT_CLEAR_DRVERLYITV_8821C(x) | BIT_DRVERLYITV_8821C(v)) -+ -+/* 2 REG_BCNDMATIM_8821C */ -+ -+#define BIT_SHIFT_BCNDMATIM_8821C 0 -+#define BIT_MASK_BCNDMATIM_8821C 0xff -+#define BIT_BCNDMATIM_8821C(x) \ -+ (((x) & BIT_MASK_BCNDMATIM_8821C) << BIT_SHIFT_BCNDMATIM_8821C) -+#define BITS_BCNDMATIM_8821C \ -+ (BIT_MASK_BCNDMATIM_8821C << BIT_SHIFT_BCNDMATIM_8821C) -+#define BIT_CLEAR_BCNDMATIM_8821C(x) ((x) & (~BITS_BCNDMATIM_8821C)) -+#define BIT_GET_BCNDMATIM_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNDMATIM_8821C) & BIT_MASK_BCNDMATIM_8821C) -+#define BIT_SET_BCNDMATIM_8821C(x, v) \ -+ (BIT_CLEAR_BCNDMATIM_8821C(x) | BIT_BCNDMATIM_8821C(v)) -+ -+/* 2 REG_ATIMWND_8821C */ -+ -+#define BIT_SHIFT_ATIMWND0_8821C 0 -+#define BIT_MASK_ATIMWND0_8821C 0xffff -+#define BIT_ATIMWND0_8821C(x) \ -+ (((x) & BIT_MASK_ATIMWND0_8821C) << BIT_SHIFT_ATIMWND0_8821C) -+#define BITS_ATIMWND0_8821C \ -+ (BIT_MASK_ATIMWND0_8821C << BIT_SHIFT_ATIMWND0_8821C) -+#define BIT_CLEAR_ATIMWND0_8821C(x) ((x) & (~BITS_ATIMWND0_8821C)) -+#define BIT_GET_ATIMWND0_8821C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND0_8821C) & BIT_MASK_ATIMWND0_8821C) -+#define BIT_SET_ATIMWND0_8821C(x, v) \ -+ (BIT_CLEAR_ATIMWND0_8821C(x) | BIT_ATIMWND0_8821C(v)) -+ -+/* 2 REG_USTIME_TSF_8821C */ -+ -+#define BIT_SHIFT_USTIME_TSF_V1_8821C 0 -+#define BIT_MASK_USTIME_TSF_V1_8821C 0xff -+#define BIT_USTIME_TSF_V1_8821C(x) \ -+ (((x) & BIT_MASK_USTIME_TSF_V1_8821C) << BIT_SHIFT_USTIME_TSF_V1_8821C) -+#define BITS_USTIME_TSF_V1_8821C \ -+ (BIT_MASK_USTIME_TSF_V1_8821C << BIT_SHIFT_USTIME_TSF_V1_8821C) -+#define BIT_CLEAR_USTIME_TSF_V1_8821C(x) ((x) & (~BITS_USTIME_TSF_V1_8821C)) -+#define BIT_GET_USTIME_TSF_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_USTIME_TSF_V1_8821C) & BIT_MASK_USTIME_TSF_V1_8821C) -+#define BIT_SET_USTIME_TSF_V1_8821C(x, v) \ -+ (BIT_CLEAR_USTIME_TSF_V1_8821C(x) | BIT_USTIME_TSF_V1_8821C(v)) -+ -+/* 2 REG_BCN_MAX_ERR_8821C */ -+ -+#define BIT_SHIFT_BCN_MAX_ERR_8821C 0 -+#define BIT_MASK_BCN_MAX_ERR_8821C 0xff -+#define BIT_BCN_MAX_ERR_8821C(x) \ -+ (((x) & BIT_MASK_BCN_MAX_ERR_8821C) << BIT_SHIFT_BCN_MAX_ERR_8821C) -+#define BITS_BCN_MAX_ERR_8821C \ -+ (BIT_MASK_BCN_MAX_ERR_8821C << BIT_SHIFT_BCN_MAX_ERR_8821C) -+#define BIT_CLEAR_BCN_MAX_ERR_8821C(x) ((x) & (~BITS_BCN_MAX_ERR_8821C)) -+#define BIT_GET_BCN_MAX_ERR_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCN_MAX_ERR_8821C) & BIT_MASK_BCN_MAX_ERR_8821C) -+#define BIT_SET_BCN_MAX_ERR_8821C(x, v) \ -+ (BIT_CLEAR_BCN_MAX_ERR_8821C(x) | BIT_BCN_MAX_ERR_8821C(v)) -+ -+/* 2 REG_RXTSF_OFFSET_CCK_8821C */ -+ -+#define BIT_SHIFT_CCK_RXTSF_OFFSET_8821C 0 -+#define BIT_MASK_CCK_RXTSF_OFFSET_8821C 0xff -+#define BIT_CCK_RXTSF_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_CCK_RXTSF_OFFSET_8821C) \ -+ << BIT_SHIFT_CCK_RXTSF_OFFSET_8821C) -+#define BITS_CCK_RXTSF_OFFSET_8821C \ -+ (BIT_MASK_CCK_RXTSF_OFFSET_8821C << BIT_SHIFT_CCK_RXTSF_OFFSET_8821C) -+#define BIT_CLEAR_CCK_RXTSF_OFFSET_8821C(x) \ -+ ((x) & (~BITS_CCK_RXTSF_OFFSET_8821C)) -+#define BIT_GET_CCK_RXTSF_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_CCK_RXTSF_OFFSET_8821C) & \ -+ BIT_MASK_CCK_RXTSF_OFFSET_8821C) -+#define BIT_SET_CCK_RXTSF_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_CCK_RXTSF_OFFSET_8821C(x) | BIT_CCK_RXTSF_OFFSET_8821C(v)) -+ -+/* 2 REG_RXTSF_OFFSET_OFDM_8821C */ -+ -+#define BIT_SHIFT_OFDM_RXTSF_OFFSET_8821C 0 -+#define BIT_MASK_OFDM_RXTSF_OFFSET_8821C 0xff -+#define BIT_OFDM_RXTSF_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_OFDM_RXTSF_OFFSET_8821C) \ -+ << BIT_SHIFT_OFDM_RXTSF_OFFSET_8821C) -+#define BITS_OFDM_RXTSF_OFFSET_8821C \ -+ (BIT_MASK_OFDM_RXTSF_OFFSET_8821C << BIT_SHIFT_OFDM_RXTSF_OFFSET_8821C) -+#define BIT_CLEAR_OFDM_RXTSF_OFFSET_8821C(x) \ -+ ((x) & (~BITS_OFDM_RXTSF_OFFSET_8821C)) -+#define BIT_GET_OFDM_RXTSF_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_OFDM_RXTSF_OFFSET_8821C) & \ -+ BIT_MASK_OFDM_RXTSF_OFFSET_8821C) -+#define BIT_SET_OFDM_RXTSF_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_OFDM_RXTSF_OFFSET_8821C(x) | BIT_OFDM_RXTSF_OFFSET_8821C(v)) -+ -+/* 2 REG_TSFTR_8821C */ -+ -+#define BIT_SHIFT_TSF_TIMER_V1_8821C 0 -+#define BIT_MASK_TSF_TIMER_V1_8821C 0xffffffffL -+#define BIT_TSF_TIMER_V1_8821C(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_V1_8821C) << BIT_SHIFT_TSF_TIMER_V1_8821C) -+#define BITS_TSF_TIMER_V1_8821C \ -+ (BIT_MASK_TSF_TIMER_V1_8821C << BIT_SHIFT_TSF_TIMER_V1_8821C) -+#define BIT_CLEAR_TSF_TIMER_V1_8821C(x) ((x) & (~BITS_TSF_TIMER_V1_8821C)) -+#define BIT_GET_TSF_TIMER_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_V1_8821C) & BIT_MASK_TSF_TIMER_V1_8821C) -+#define BIT_SET_TSF_TIMER_V1_8821C(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_V1_8821C(x) | BIT_TSF_TIMER_V1_8821C(v)) -+ -+/* 2 REG_TSFTR_1_8821C */ -+ -+#define BIT_SHIFT_TSF_TIMER_V2_8821C 0 -+#define BIT_MASK_TSF_TIMER_V2_8821C 0xffffffffL -+#define BIT_TSF_TIMER_V2_8821C(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_V2_8821C) << BIT_SHIFT_TSF_TIMER_V2_8821C) -+#define BITS_TSF_TIMER_V2_8821C \ -+ (BIT_MASK_TSF_TIMER_V2_8821C << BIT_SHIFT_TSF_TIMER_V2_8821C) -+#define BIT_CLEAR_TSF_TIMER_V2_8821C(x) ((x) & (~BITS_TSF_TIMER_V2_8821C)) -+#define BIT_GET_TSF_TIMER_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_V2_8821C) & BIT_MASK_TSF_TIMER_V2_8821C) -+#define BIT_SET_TSF_TIMER_V2_8821C(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_V2_8821C(x) | BIT_TSF_TIMER_V2_8821C(v)) -+ -+/* 2 REG_FREERUN_CNT_8821C */ -+ -+#define BIT_SHIFT_FREERUN_CNT_V1_8821C 0 -+#define BIT_MASK_FREERUN_CNT_V1_8821C 0xffffffffL -+#define BIT_FREERUN_CNT_V1_8821C(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_V1_8821C) \ -+ << BIT_SHIFT_FREERUN_CNT_V1_8821C) -+#define BITS_FREERUN_CNT_V1_8821C \ -+ (BIT_MASK_FREERUN_CNT_V1_8821C << BIT_SHIFT_FREERUN_CNT_V1_8821C) -+#define BIT_CLEAR_FREERUN_CNT_V1_8821C(x) ((x) & (~BITS_FREERUN_CNT_V1_8821C)) -+#define BIT_GET_FREERUN_CNT_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_V1_8821C) & \ -+ BIT_MASK_FREERUN_CNT_V1_8821C) -+#define BIT_SET_FREERUN_CNT_V1_8821C(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_V1_8821C(x) | BIT_FREERUN_CNT_V1_8821C(v)) -+ -+/* 2 REG_FREERUN_CNT_1_8821C */ -+ -+#define BIT_SHIFT_FREERUN_CNT_V2_8821C 0 -+#define BIT_MASK_FREERUN_CNT_V2_8821C 0xffffffffL -+#define BIT_FREERUN_CNT_V2_8821C(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_V2_8821C) \ -+ << BIT_SHIFT_FREERUN_CNT_V2_8821C) -+#define BITS_FREERUN_CNT_V2_8821C \ -+ (BIT_MASK_FREERUN_CNT_V2_8821C << BIT_SHIFT_FREERUN_CNT_V2_8821C) -+#define BIT_CLEAR_FREERUN_CNT_V2_8821C(x) ((x) & (~BITS_FREERUN_CNT_V2_8821C)) -+#define BIT_GET_FREERUN_CNT_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_V2_8821C) & \ -+ BIT_MASK_FREERUN_CNT_V2_8821C) -+#define BIT_SET_FREERUN_CNT_V2_8821C(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_V2_8821C(x) | BIT_FREERUN_CNT_V2_8821C(v)) -+ -+/* 2 REG_ATIMWND1_V1_8821C */ -+ -+#define BIT_SHIFT_ATIMWND1_V1_8821C 0 -+#define BIT_MASK_ATIMWND1_V1_8821C 0xff -+#define BIT_ATIMWND1_V1_8821C(x) \ -+ (((x) & BIT_MASK_ATIMWND1_V1_8821C) << BIT_SHIFT_ATIMWND1_V1_8821C) -+#define BITS_ATIMWND1_V1_8821C \ -+ (BIT_MASK_ATIMWND1_V1_8821C << BIT_SHIFT_ATIMWND1_V1_8821C) -+#define BIT_CLEAR_ATIMWND1_V1_8821C(x) ((x) & (~BITS_ATIMWND1_V1_8821C)) -+#define BIT_GET_ATIMWND1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND1_V1_8821C) & BIT_MASK_ATIMWND1_V1_8821C) -+#define BIT_SET_ATIMWND1_V1_8821C(x, v) \ -+ (BIT_CLEAR_ATIMWND1_V1_8821C(x) | BIT_ATIMWND1_V1_8821C(v)) -+ -+/* 2 REG_TBTT_PROHIBIT_INFRA_8821C */ -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_INFRA_8821C 0 -+#define BIT_MASK_TBTT_PROHIBIT_INFRA_8821C 0xff -+#define BIT_TBTT_PROHIBIT_INFRA_8821C(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_INFRA_8821C) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_INFRA_8821C) -+#define BITS_TBTT_PROHIBIT_INFRA_8821C \ -+ (BIT_MASK_TBTT_PROHIBIT_INFRA_8821C \ -+ << BIT_SHIFT_TBTT_PROHIBIT_INFRA_8821C) -+#define BIT_CLEAR_TBTT_PROHIBIT_INFRA_8821C(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_INFRA_8821C)) -+#define BIT_GET_TBTT_PROHIBIT_INFRA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_INFRA_8821C) & \ -+ BIT_MASK_TBTT_PROHIBIT_INFRA_8821C) -+#define BIT_SET_TBTT_PROHIBIT_INFRA_8821C(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_INFRA_8821C(x) | \ -+ BIT_TBTT_PROHIBIT_INFRA_8821C(v)) -+ -+/* 2 REG_CTWND_8821C */ -+ -+#define BIT_SHIFT_CTWND_8821C 0 -+#define BIT_MASK_CTWND_8821C 0xff -+#define BIT_CTWND_8821C(x) \ -+ (((x) & BIT_MASK_CTWND_8821C) << BIT_SHIFT_CTWND_8821C) -+#define BITS_CTWND_8821C (BIT_MASK_CTWND_8821C << BIT_SHIFT_CTWND_8821C) -+#define BIT_CLEAR_CTWND_8821C(x) ((x) & (~BITS_CTWND_8821C)) -+#define BIT_GET_CTWND_8821C(x) \ -+ (((x) >> BIT_SHIFT_CTWND_8821C) & BIT_MASK_CTWND_8821C) -+#define BIT_SET_CTWND_8821C(x, v) \ -+ (BIT_CLEAR_CTWND_8821C(x) | BIT_CTWND_8821C(v)) -+ -+/* 2 REG_BCNIVLCUNT_8821C */ -+ -+#define BIT_SHIFT_BCNIVLCUNT_8821C 0 -+#define BIT_MASK_BCNIVLCUNT_8821C 0x7f -+#define BIT_BCNIVLCUNT_8821C(x) \ -+ (((x) & BIT_MASK_BCNIVLCUNT_8821C) << BIT_SHIFT_BCNIVLCUNT_8821C) -+#define BITS_BCNIVLCUNT_8821C \ -+ (BIT_MASK_BCNIVLCUNT_8821C << BIT_SHIFT_BCNIVLCUNT_8821C) -+#define BIT_CLEAR_BCNIVLCUNT_8821C(x) ((x) & (~BITS_BCNIVLCUNT_8821C)) -+#define BIT_GET_BCNIVLCUNT_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCNIVLCUNT_8821C) & BIT_MASK_BCNIVLCUNT_8821C) -+#define BIT_SET_BCNIVLCUNT_8821C(x, v) \ -+ (BIT_CLEAR_BCNIVLCUNT_8821C(x) | BIT_BCNIVLCUNT_8821C(v)) -+ -+/* 2 REG_BCNDROPCTRL_8821C */ -+#define BIT_BEACON_DROP_EN_8821C BIT(7) -+ -+#define BIT_SHIFT_BEACON_DROP_IVL_8821C 0 -+#define BIT_MASK_BEACON_DROP_IVL_8821C 0x7f -+#define BIT_BEACON_DROP_IVL_8821C(x) \ -+ (((x) & BIT_MASK_BEACON_DROP_IVL_8821C) \ -+ << BIT_SHIFT_BEACON_DROP_IVL_8821C) -+#define BITS_BEACON_DROP_IVL_8821C \ -+ (BIT_MASK_BEACON_DROP_IVL_8821C << BIT_SHIFT_BEACON_DROP_IVL_8821C) -+#define BIT_CLEAR_BEACON_DROP_IVL_8821C(x) ((x) & (~BITS_BEACON_DROP_IVL_8821C)) -+#define BIT_GET_BEACON_DROP_IVL_8821C(x) \ -+ (((x) >> BIT_SHIFT_BEACON_DROP_IVL_8821C) & \ -+ BIT_MASK_BEACON_DROP_IVL_8821C) -+#define BIT_SET_BEACON_DROP_IVL_8821C(x, v) \ -+ (BIT_CLEAR_BEACON_DROP_IVL_8821C(x) | BIT_BEACON_DROP_IVL_8821C(v)) -+ -+/* 2 REG_HGQ_TIMEOUT_PERIOD_8821C */ -+ -+#define BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8821C 0 -+#define BIT_MASK_HGQ_TIMEOUT_PERIOD_8821C 0xff -+#define BIT_HGQ_TIMEOUT_PERIOD_8821C(x) \ -+ (((x) & BIT_MASK_HGQ_TIMEOUT_PERIOD_8821C) \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8821C) -+#define BITS_HGQ_TIMEOUT_PERIOD_8821C \ -+ (BIT_MASK_HGQ_TIMEOUT_PERIOD_8821C \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8821C) -+#define BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8821C(x) \ -+ ((x) & (~BITS_HGQ_TIMEOUT_PERIOD_8821C)) -+#define BIT_GET_HGQ_TIMEOUT_PERIOD_8821C(x) \ -+ (((x) >> BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8821C) & \ -+ BIT_MASK_HGQ_TIMEOUT_PERIOD_8821C) -+#define BIT_SET_HGQ_TIMEOUT_PERIOD_8821C(x, v) \ -+ (BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8821C(x) | \ -+ BIT_HGQ_TIMEOUT_PERIOD_8821C(v)) -+ -+/* 2 REG_TXCMD_TIMEOUT_PERIOD_8821C */ -+ -+#define BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8821C 0 -+#define BIT_MASK_TXCMD_TIMEOUT_PERIOD_8821C 0xff -+#define BIT_TXCMD_TIMEOUT_PERIOD_8821C(x) \ -+ (((x) & BIT_MASK_TXCMD_TIMEOUT_PERIOD_8821C) \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8821C) -+#define BITS_TXCMD_TIMEOUT_PERIOD_8821C \ -+ (BIT_MASK_TXCMD_TIMEOUT_PERIOD_8821C \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8821C) -+#define BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8821C(x) \ -+ ((x) & (~BITS_TXCMD_TIMEOUT_PERIOD_8821C)) -+#define BIT_GET_TXCMD_TIMEOUT_PERIOD_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8821C) & \ -+ BIT_MASK_TXCMD_TIMEOUT_PERIOD_8821C) -+#define BIT_SET_TXCMD_TIMEOUT_PERIOD_8821C(x, v) \ -+ (BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8821C(x) | \ -+ BIT_TXCMD_TIMEOUT_PERIOD_8821C(v)) -+ -+/* 2 REG_MISC_CTRL_8821C */ -+#define BIT_AUTO_SYNC_BY_TBTT_8821C BIT(6) -+#define BIT_DIS_TRX_CAL_BCN_8821C BIT(5) -+#define BIT_DIS_TX_CAL_TBTT_8821C BIT(4) -+#define BIT_EN_FREECNT_8821C BIT(3) -+#define BIT_BCN_AGGRESSION_8821C BIT(2) -+ -+#define BIT_SHIFT_DIS_SECONDARY_CCA_8821C 0 -+#define BIT_MASK_DIS_SECONDARY_CCA_8821C 0x3 -+#define BIT_DIS_SECONDARY_CCA_8821C(x) \ -+ (((x) & BIT_MASK_DIS_SECONDARY_CCA_8821C) \ -+ << BIT_SHIFT_DIS_SECONDARY_CCA_8821C) -+#define BITS_DIS_SECONDARY_CCA_8821C \ -+ (BIT_MASK_DIS_SECONDARY_CCA_8821C << BIT_SHIFT_DIS_SECONDARY_CCA_8821C) -+#define BIT_CLEAR_DIS_SECONDARY_CCA_8821C(x) \ -+ ((x) & (~BITS_DIS_SECONDARY_CCA_8821C)) -+#define BIT_GET_DIS_SECONDARY_CCA_8821C(x) \ -+ (((x) >> BIT_SHIFT_DIS_SECONDARY_CCA_8821C) & \ -+ BIT_MASK_DIS_SECONDARY_CCA_8821C) -+#define BIT_SET_DIS_SECONDARY_CCA_8821C(x, v) \ -+ (BIT_CLEAR_DIS_SECONDARY_CCA_8821C(x) | BIT_DIS_SECONDARY_CCA_8821C(v)) -+ -+/* 2 REG_BCN_CTRL_CLINT1_8821C */ -+#define BIT_CLI1_DIS_RX_BSSID_FIT_8821C BIT(6) -+#define BIT_CLI1_DIS_TSF_UDT_8821C BIT(4) -+#define BIT_CLI1_EN_BCN_FUNCTION_8821C BIT(3) -+#define BIT_CLI1_EN_RXBCN_RPT_8821C BIT(2) -+#define BIT_CLI1_ENP2P_CTWINDOW_8821C BIT(1) -+#define BIT_CLI1_ENP2P_BCNQ_AREA_8821C BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT2_8821C */ -+#define BIT_CLI2_DIS_RX_BSSID_FIT_8821C BIT(6) -+#define BIT_CLI2_DIS_TSF_UDT_8821C BIT(4) -+#define BIT_CLI2_EN_BCN_FUNCTION_8821C BIT(3) -+#define BIT_CLI2_EN_RXBCN_RPT_8821C BIT(2) -+#define BIT_CLI2_ENP2P_CTWINDOW_8821C BIT(1) -+#define BIT_CLI2_ENP2P_BCNQ_AREA_8821C BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT3_8821C */ -+#define BIT_CLI3_DIS_RX_BSSID_FIT_8821C BIT(6) -+#define BIT_CLI3_DIS_TSF_UDT_8821C BIT(4) -+#define BIT_CLI3_EN_BCN_FUNCTION_8821C BIT(3) -+#define BIT_CLI3_EN_RXBCN_RPT_8821C BIT(2) -+#define BIT_CLI3_ENP2P_CTWINDOW_8821C BIT(1) -+#define BIT_CLI3_ENP2P_BCNQ_AREA_8821C BIT(0) -+ -+/* 2 REG_EXTEND_CTRL_8821C */ -+#define BIT_EN_TSFBIT32_RST_P2P2_8821C BIT(5) -+#define BIT_EN_TSFBIT32_RST_P2P1_8821C BIT(4) -+ -+#define BIT_SHIFT_PORT_SEL_8821C 0 -+#define BIT_MASK_PORT_SEL_8821C 0x7 -+#define BIT_PORT_SEL_8821C(x) \ -+ (((x) & BIT_MASK_PORT_SEL_8821C) << BIT_SHIFT_PORT_SEL_8821C) -+#define BITS_PORT_SEL_8821C \ -+ (BIT_MASK_PORT_SEL_8821C << BIT_SHIFT_PORT_SEL_8821C) -+#define BIT_CLEAR_PORT_SEL_8821C(x) ((x) & (~BITS_PORT_SEL_8821C)) -+#define BIT_GET_PORT_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_PORT_SEL_8821C) & BIT_MASK_PORT_SEL_8821C) -+#define BIT_SET_PORT_SEL_8821C(x, v) \ -+ (BIT_CLEAR_PORT_SEL_8821C(x) | BIT_PORT_SEL_8821C(v)) -+ -+/* 2 REG_P2PPS1_SPEC_STATE_8821C */ -+#define BIT_P2P1_SPEC_POWER_STATE_8821C BIT(7) -+#define BIT_P2P1_SPEC_CTWINDOW_ON_8821C BIT(6) -+#define BIT_P2P1_SPEC_BCN_AREA_ON_8821C BIT(5) -+#define BIT_P2P1_SPEC_CTWIN_EARLY_DISTX_8821C BIT(4) -+#define BIT_P2P1_SPEC_NOA1_OFF_PERIOD_8821C BIT(3) -+#define BIT_P2P1_SPEC_FORCE_DOZE1_8821C BIT(2) -+#define BIT_P2P1_SPEC_NOA0_OFF_PERIOD_8821C BIT(1) -+#define BIT_P2P1_SPEC_FORCE_DOZE0_8821C BIT(0) -+ -+/* 2 REG_P2PPS1_STATE_8821C */ -+#define BIT_P2P1_POWER_STATE_8821C BIT(7) -+#define BIT_P2P1_CTWINDOW_ON_8821C BIT(6) -+#define BIT_P2P1_BEACON_AREA_ON_8821C BIT(5) -+#define BIT_P2P1_CTWIN_EARLY_DISTX_8821C BIT(4) -+#define BIT_P2P1_NOA1_OFF_PERIOD_8821C BIT(3) -+#define BIT_P2P1_FORCE_DOZE1_8821C BIT(2) -+#define BIT_P2P1_NOA0_OFF_PERIOD_8821C BIT(1) -+#define BIT_P2P1_FORCE_DOZE0_8821C BIT(0) -+ -+/* 2 REG_P2PPS2_SPEC_STATE_8821C */ -+#define BIT_P2P2_SPEC_POWER_STATE_8821C BIT(7) -+#define BIT_P2P2_SPEC_CTWINDOW_ON_8821C BIT(6) -+#define BIT_P2P2_SPEC_BCN_AREA_ON_8821C BIT(5) -+#define BIT_P2P2_SPEC_CTWIN_EARLY_DISTX_8821C BIT(4) -+#define BIT_P2P2_SPEC_NOA1_OFF_PERIOD_8821C BIT(3) -+#define BIT_P2P2_SPEC_FORCE_DOZE1_8821C BIT(2) -+#define BIT_P2P2_SPEC_NOA0_OFF_PERIOD_8821C BIT(1) -+#define BIT_P2P2_SPEC_FORCE_DOZE0_8821C BIT(0) -+ -+/* 2 REG_P2PPS2_STATE_8821C */ -+#define BIT_P2P2_POWER_STATE_8821C BIT(7) -+#define BIT_P2P2_CTWINDOW_ON_8821C BIT(6) -+#define BIT_P2P2_BEACON_AREA_ON_8821C BIT(5) -+#define BIT_P2P2_CTWIN_EARLY_DISTX_8821C BIT(4) -+#define BIT_P2P2_NOA1_OFF_PERIOD_8821C BIT(3) -+#define BIT_P2P2_FORCE_DOZE1_8821C BIT(2) -+#define BIT_P2P2_NOA0_OFF_PERIOD_8821C BIT(1) -+#define BIT_P2P2_FORCE_DOZE0_8821C BIT(0) -+ -+/* 2 REG_PS_TIMER0_8821C */ -+ -+#define BIT_SHIFT_PSTIMER0_INT_8821C 5 -+#define BIT_MASK_PSTIMER0_INT_8821C 0x7ffffff -+#define BIT_PSTIMER0_INT_8821C(x) \ -+ (((x) & BIT_MASK_PSTIMER0_INT_8821C) << BIT_SHIFT_PSTIMER0_INT_8821C) -+#define BITS_PSTIMER0_INT_8821C \ -+ (BIT_MASK_PSTIMER0_INT_8821C << BIT_SHIFT_PSTIMER0_INT_8821C) -+#define BIT_CLEAR_PSTIMER0_INT_8821C(x) ((x) & (~BITS_PSTIMER0_INT_8821C)) -+#define BIT_GET_PSTIMER0_INT_8821C(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER0_INT_8821C) & BIT_MASK_PSTIMER0_INT_8821C) -+#define BIT_SET_PSTIMER0_INT_8821C(x, v) \ -+ (BIT_CLEAR_PSTIMER0_INT_8821C(x) | BIT_PSTIMER0_INT_8821C(v)) -+ -+/* 2 REG_PS_TIMER1_8821C */ -+ -+#define BIT_SHIFT_PSTIMER1_INT_8821C 5 -+#define BIT_MASK_PSTIMER1_INT_8821C 0x7ffffff -+#define BIT_PSTIMER1_INT_8821C(x) \ -+ (((x) & BIT_MASK_PSTIMER1_INT_8821C) << BIT_SHIFT_PSTIMER1_INT_8821C) -+#define BITS_PSTIMER1_INT_8821C \ -+ (BIT_MASK_PSTIMER1_INT_8821C << BIT_SHIFT_PSTIMER1_INT_8821C) -+#define BIT_CLEAR_PSTIMER1_INT_8821C(x) ((x) & (~BITS_PSTIMER1_INT_8821C)) -+#define BIT_GET_PSTIMER1_INT_8821C(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER1_INT_8821C) & BIT_MASK_PSTIMER1_INT_8821C) -+#define BIT_SET_PSTIMER1_INT_8821C(x, v) \ -+ (BIT_CLEAR_PSTIMER1_INT_8821C(x) | BIT_PSTIMER1_INT_8821C(v)) -+ -+/* 2 REG_PS_TIMER2_8821C */ -+ -+#define BIT_SHIFT_PSTIMER2_INT_8821C 5 -+#define BIT_MASK_PSTIMER2_INT_8821C 0x7ffffff -+#define BIT_PSTIMER2_INT_8821C(x) \ -+ (((x) & BIT_MASK_PSTIMER2_INT_8821C) << BIT_SHIFT_PSTIMER2_INT_8821C) -+#define BITS_PSTIMER2_INT_8821C \ -+ (BIT_MASK_PSTIMER2_INT_8821C << BIT_SHIFT_PSTIMER2_INT_8821C) -+#define BIT_CLEAR_PSTIMER2_INT_8821C(x) ((x) & (~BITS_PSTIMER2_INT_8821C)) -+#define BIT_GET_PSTIMER2_INT_8821C(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER2_INT_8821C) & BIT_MASK_PSTIMER2_INT_8821C) -+#define BIT_SET_PSTIMER2_INT_8821C(x, v) \ -+ (BIT_CLEAR_PSTIMER2_INT_8821C(x) | BIT_PSTIMER2_INT_8821C(v)) -+ -+/* 2 REG_TBTT_CTN_AREA_8821C */ -+ -+#define BIT_SHIFT_TBTT_CTN_AREA_8821C 0 -+#define BIT_MASK_TBTT_CTN_AREA_8821C 0xff -+#define BIT_TBTT_CTN_AREA_8821C(x) \ -+ (((x) & BIT_MASK_TBTT_CTN_AREA_8821C) << BIT_SHIFT_TBTT_CTN_AREA_8821C) -+#define BITS_TBTT_CTN_AREA_8821C \ -+ (BIT_MASK_TBTT_CTN_AREA_8821C << BIT_SHIFT_TBTT_CTN_AREA_8821C) -+#define BIT_CLEAR_TBTT_CTN_AREA_8821C(x) ((x) & (~BITS_TBTT_CTN_AREA_8821C)) -+#define BIT_GET_TBTT_CTN_AREA_8821C(x) \ -+ (((x) >> BIT_SHIFT_TBTT_CTN_AREA_8821C) & BIT_MASK_TBTT_CTN_AREA_8821C) -+#define BIT_SET_TBTT_CTN_AREA_8821C(x, v) \ -+ (BIT_CLEAR_TBTT_CTN_AREA_8821C(x) | BIT_TBTT_CTN_AREA_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_FORCE_BCN_IFS_8821C */ -+ -+#define BIT_SHIFT_FORCE_BCN_IFS_8821C 0 -+#define BIT_MASK_FORCE_BCN_IFS_8821C 0xff -+#define BIT_FORCE_BCN_IFS_8821C(x) \ -+ (((x) & BIT_MASK_FORCE_BCN_IFS_8821C) << BIT_SHIFT_FORCE_BCN_IFS_8821C) -+#define BITS_FORCE_BCN_IFS_8821C \ -+ (BIT_MASK_FORCE_BCN_IFS_8821C << BIT_SHIFT_FORCE_BCN_IFS_8821C) -+#define BIT_CLEAR_FORCE_BCN_IFS_8821C(x) ((x) & (~BITS_FORCE_BCN_IFS_8821C)) -+#define BIT_GET_FORCE_BCN_IFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_FORCE_BCN_IFS_8821C) & BIT_MASK_FORCE_BCN_IFS_8821C) -+#define BIT_SET_FORCE_BCN_IFS_8821C(x, v) \ -+ (BIT_CLEAR_FORCE_BCN_IFS_8821C(x) | BIT_FORCE_BCN_IFS_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_TXOP_MIN_8821C */ -+ -+#define BIT_SHIFT_TXOP_MIN_8821C 0 -+#define BIT_MASK_TXOP_MIN_8821C 0x3fff -+#define BIT_TXOP_MIN_8821C(x) \ -+ (((x) & BIT_MASK_TXOP_MIN_8821C) << BIT_SHIFT_TXOP_MIN_8821C) -+#define BITS_TXOP_MIN_8821C \ -+ (BIT_MASK_TXOP_MIN_8821C << BIT_SHIFT_TXOP_MIN_8821C) -+#define BIT_CLEAR_TXOP_MIN_8821C(x) ((x) & (~BITS_TXOP_MIN_8821C)) -+#define BIT_GET_TXOP_MIN_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXOP_MIN_8821C) & BIT_MASK_TXOP_MIN_8821C) -+#define BIT_SET_TXOP_MIN_8821C(x, v) \ -+ (BIT_CLEAR_TXOP_MIN_8821C(x) | BIT_TXOP_MIN_8821C(v)) -+ -+/* 2 REG_PRE_BKF_TIME_8821C */ -+ -+#define BIT_SHIFT_PRE_BKF_TIME_8821C 0 -+#define BIT_MASK_PRE_BKF_TIME_8821C 0xff -+#define BIT_PRE_BKF_TIME_8821C(x) \ -+ (((x) & BIT_MASK_PRE_BKF_TIME_8821C) << BIT_SHIFT_PRE_BKF_TIME_8821C) -+#define BITS_PRE_BKF_TIME_8821C \ -+ (BIT_MASK_PRE_BKF_TIME_8821C << BIT_SHIFT_PRE_BKF_TIME_8821C) -+#define BIT_CLEAR_PRE_BKF_TIME_8821C(x) ((x) & (~BITS_PRE_BKF_TIME_8821C)) -+#define BIT_GET_PRE_BKF_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_PRE_BKF_TIME_8821C) & BIT_MASK_PRE_BKF_TIME_8821C) -+#define BIT_SET_PRE_BKF_TIME_8821C(x, v) \ -+ (BIT_CLEAR_PRE_BKF_TIME_8821C(x) | BIT_PRE_BKF_TIME_8821C(v)) -+ -+/* 2 REG_CROSS_TXOP_CTRL_8821C */ -+#define BIT_TXFAIL_BREACK_TXOP_EN_8821C BIT(3) -+#define BIT_DTIM_BYPASS_8821C BIT(2) -+#define BIT_RTS_NAV_TXOP_8821C BIT(1) -+#define BIT_NOT_CROSS_TXOP_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_ATIMWND2_8821C */ -+ -+#define BIT_SHIFT_ATIMWND2_8821C 0 -+#define BIT_MASK_ATIMWND2_8821C 0xff -+#define BIT_ATIMWND2_8821C(x) \ -+ (((x) & BIT_MASK_ATIMWND2_8821C) << BIT_SHIFT_ATIMWND2_8821C) -+#define BITS_ATIMWND2_8821C \ -+ (BIT_MASK_ATIMWND2_8821C << BIT_SHIFT_ATIMWND2_8821C) -+#define BIT_CLEAR_ATIMWND2_8821C(x) ((x) & (~BITS_ATIMWND2_8821C)) -+#define BIT_GET_ATIMWND2_8821C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND2_8821C) & BIT_MASK_ATIMWND2_8821C) -+#define BIT_SET_ATIMWND2_8821C(x, v) \ -+ (BIT_CLEAR_ATIMWND2_8821C(x) | BIT_ATIMWND2_8821C(v)) -+ -+/* 2 REG_ATIMWND3_8821C */ -+ -+#define BIT_SHIFT_ATIMWND3_8821C 0 -+#define BIT_MASK_ATIMWND3_8821C 0xff -+#define BIT_ATIMWND3_8821C(x) \ -+ (((x) & BIT_MASK_ATIMWND3_8821C) << BIT_SHIFT_ATIMWND3_8821C) -+#define BITS_ATIMWND3_8821C \ -+ (BIT_MASK_ATIMWND3_8821C << BIT_SHIFT_ATIMWND3_8821C) -+#define BIT_CLEAR_ATIMWND3_8821C(x) ((x) & (~BITS_ATIMWND3_8821C)) -+#define BIT_GET_ATIMWND3_8821C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND3_8821C) & BIT_MASK_ATIMWND3_8821C) -+#define BIT_SET_ATIMWND3_8821C(x, v) \ -+ (BIT_CLEAR_ATIMWND3_8821C(x) | BIT_ATIMWND3_8821C(v)) -+ -+/* 2 REG_ATIMWND4_8821C */ -+ -+#define BIT_SHIFT_ATIMWND4_8821C 0 -+#define BIT_MASK_ATIMWND4_8821C 0xff -+#define BIT_ATIMWND4_8821C(x) \ -+ (((x) & BIT_MASK_ATIMWND4_8821C) << BIT_SHIFT_ATIMWND4_8821C) -+#define BITS_ATIMWND4_8821C \ -+ (BIT_MASK_ATIMWND4_8821C << BIT_SHIFT_ATIMWND4_8821C) -+#define BIT_CLEAR_ATIMWND4_8821C(x) ((x) & (~BITS_ATIMWND4_8821C)) -+#define BIT_GET_ATIMWND4_8821C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND4_8821C) & BIT_MASK_ATIMWND4_8821C) -+#define BIT_SET_ATIMWND4_8821C(x, v) \ -+ (BIT_CLEAR_ATIMWND4_8821C(x) | BIT_ATIMWND4_8821C(v)) -+ -+/* 2 REG_ATIMWND5_8821C */ -+ -+#define BIT_SHIFT_ATIMWND5_8821C 0 -+#define BIT_MASK_ATIMWND5_8821C 0xff -+#define BIT_ATIMWND5_8821C(x) \ -+ (((x) & BIT_MASK_ATIMWND5_8821C) << BIT_SHIFT_ATIMWND5_8821C) -+#define BITS_ATIMWND5_8821C \ -+ (BIT_MASK_ATIMWND5_8821C << BIT_SHIFT_ATIMWND5_8821C) -+#define BIT_CLEAR_ATIMWND5_8821C(x) ((x) & (~BITS_ATIMWND5_8821C)) -+#define BIT_GET_ATIMWND5_8821C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND5_8821C) & BIT_MASK_ATIMWND5_8821C) -+#define BIT_SET_ATIMWND5_8821C(x, v) \ -+ (BIT_CLEAR_ATIMWND5_8821C(x) | BIT_ATIMWND5_8821C(v)) -+ -+/* 2 REG_ATIMWND6_8821C */ -+ -+#define BIT_SHIFT_ATIMWND6_8821C 0 -+#define BIT_MASK_ATIMWND6_8821C 0xff -+#define BIT_ATIMWND6_8821C(x) \ -+ (((x) & BIT_MASK_ATIMWND6_8821C) << BIT_SHIFT_ATIMWND6_8821C) -+#define BITS_ATIMWND6_8821C \ -+ (BIT_MASK_ATIMWND6_8821C << BIT_SHIFT_ATIMWND6_8821C) -+#define BIT_CLEAR_ATIMWND6_8821C(x) ((x) & (~BITS_ATIMWND6_8821C)) -+#define BIT_GET_ATIMWND6_8821C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND6_8821C) & BIT_MASK_ATIMWND6_8821C) -+#define BIT_SET_ATIMWND6_8821C(x, v) \ -+ (BIT_CLEAR_ATIMWND6_8821C(x) | BIT_ATIMWND6_8821C(v)) -+ -+/* 2 REG_ATIMWND7_8821C */ -+ -+#define BIT_SHIFT_ATIMWND7_8821C 0 -+#define BIT_MASK_ATIMWND7_8821C 0xff -+#define BIT_ATIMWND7_8821C(x) \ -+ (((x) & BIT_MASK_ATIMWND7_8821C) << BIT_SHIFT_ATIMWND7_8821C) -+#define BITS_ATIMWND7_8821C \ -+ (BIT_MASK_ATIMWND7_8821C << BIT_SHIFT_ATIMWND7_8821C) -+#define BIT_CLEAR_ATIMWND7_8821C(x) ((x) & (~BITS_ATIMWND7_8821C)) -+#define BIT_GET_ATIMWND7_8821C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND7_8821C) & BIT_MASK_ATIMWND7_8821C) -+#define BIT_SET_ATIMWND7_8821C(x, v) \ -+ (BIT_CLEAR_ATIMWND7_8821C(x) | BIT_ATIMWND7_8821C(v)) -+ -+/* 2 REG_ATIMUGT_8821C */ -+ -+#define BIT_SHIFT_ATIM_URGENT_8821C 0 -+#define BIT_MASK_ATIM_URGENT_8821C 0xff -+#define BIT_ATIM_URGENT_8821C(x) \ -+ (((x) & BIT_MASK_ATIM_URGENT_8821C) << BIT_SHIFT_ATIM_URGENT_8821C) -+#define BITS_ATIM_URGENT_8821C \ -+ (BIT_MASK_ATIM_URGENT_8821C << BIT_SHIFT_ATIM_URGENT_8821C) -+#define BIT_CLEAR_ATIM_URGENT_8821C(x) ((x) & (~BITS_ATIM_URGENT_8821C)) -+#define BIT_GET_ATIM_URGENT_8821C(x) \ -+ (((x) >> BIT_SHIFT_ATIM_URGENT_8821C) & BIT_MASK_ATIM_URGENT_8821C) -+#define BIT_SET_ATIM_URGENT_8821C(x, v) \ -+ (BIT_CLEAR_ATIM_URGENT_8821C(x) | BIT_ATIM_URGENT_8821C(v)) -+ -+/* 2 REG_HIQ_NO_LMT_EN_8821C */ -+#define BIT_HIQ_NO_LMT_EN_VAP7_8821C BIT(7) -+#define BIT_HIQ_NO_LMT_EN_VAP6_8821C BIT(6) -+#define BIT_HIQ_NO_LMT_EN_VAP5_8821C BIT(5) -+#define BIT_HIQ_NO_LMT_EN_VAP4_8821C BIT(4) -+#define BIT_HIQ_NO_LMT_EN_VAP3_8821C BIT(3) -+#define BIT_HIQ_NO_LMT_EN_VAP2_8821C BIT(2) -+#define BIT_HIQ_NO_LMT_EN_VAP1_8821C BIT(1) -+#define BIT_HIQ_NO_LMT_EN_ROOT_8821C BIT(0) -+ -+/* 2 REG_DTIM_COUNTER_ROOT_8821C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_ROOT_8821C 0 -+#define BIT_MASK_DTIM_COUNT_ROOT_8821C 0xff -+#define BIT_DTIM_COUNT_ROOT_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_ROOT_8821C) \ -+ << BIT_SHIFT_DTIM_COUNT_ROOT_8821C) -+#define BITS_DTIM_COUNT_ROOT_8821C \ -+ (BIT_MASK_DTIM_COUNT_ROOT_8821C << BIT_SHIFT_DTIM_COUNT_ROOT_8821C) -+#define BIT_CLEAR_DTIM_COUNT_ROOT_8821C(x) ((x) & (~BITS_DTIM_COUNT_ROOT_8821C)) -+#define BIT_GET_DTIM_COUNT_ROOT_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_ROOT_8821C) & \ -+ BIT_MASK_DTIM_COUNT_ROOT_8821C) -+#define BIT_SET_DTIM_COUNT_ROOT_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_ROOT_8821C(x) | BIT_DTIM_COUNT_ROOT_8821C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP1_8821C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP1_8821C 0 -+#define BIT_MASK_DTIM_COUNT_VAP1_8821C 0xff -+#define BIT_DTIM_COUNT_VAP1_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP1_8821C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP1_8821C) -+#define BITS_DTIM_COUNT_VAP1_8821C \ -+ (BIT_MASK_DTIM_COUNT_VAP1_8821C << BIT_SHIFT_DTIM_COUNT_VAP1_8821C) -+#define BIT_CLEAR_DTIM_COUNT_VAP1_8821C(x) ((x) & (~BITS_DTIM_COUNT_VAP1_8821C)) -+#define BIT_GET_DTIM_COUNT_VAP1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP1_8821C) & \ -+ BIT_MASK_DTIM_COUNT_VAP1_8821C) -+#define BIT_SET_DTIM_COUNT_VAP1_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP1_8821C(x) | BIT_DTIM_COUNT_VAP1_8821C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP2_8821C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP2_8821C 0 -+#define BIT_MASK_DTIM_COUNT_VAP2_8821C 0xff -+#define BIT_DTIM_COUNT_VAP2_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP2_8821C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP2_8821C) -+#define BITS_DTIM_COUNT_VAP2_8821C \ -+ (BIT_MASK_DTIM_COUNT_VAP2_8821C << BIT_SHIFT_DTIM_COUNT_VAP2_8821C) -+#define BIT_CLEAR_DTIM_COUNT_VAP2_8821C(x) ((x) & (~BITS_DTIM_COUNT_VAP2_8821C)) -+#define BIT_GET_DTIM_COUNT_VAP2_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP2_8821C) & \ -+ BIT_MASK_DTIM_COUNT_VAP2_8821C) -+#define BIT_SET_DTIM_COUNT_VAP2_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP2_8821C(x) | BIT_DTIM_COUNT_VAP2_8821C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP3_8821C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP3_8821C 0 -+#define BIT_MASK_DTIM_COUNT_VAP3_8821C 0xff -+#define BIT_DTIM_COUNT_VAP3_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP3_8821C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP3_8821C) -+#define BITS_DTIM_COUNT_VAP3_8821C \ -+ (BIT_MASK_DTIM_COUNT_VAP3_8821C << BIT_SHIFT_DTIM_COUNT_VAP3_8821C) -+#define BIT_CLEAR_DTIM_COUNT_VAP3_8821C(x) ((x) & (~BITS_DTIM_COUNT_VAP3_8821C)) -+#define BIT_GET_DTIM_COUNT_VAP3_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP3_8821C) & \ -+ BIT_MASK_DTIM_COUNT_VAP3_8821C) -+#define BIT_SET_DTIM_COUNT_VAP3_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP3_8821C(x) | BIT_DTIM_COUNT_VAP3_8821C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP4_8821C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP4_8821C 0 -+#define BIT_MASK_DTIM_COUNT_VAP4_8821C 0xff -+#define BIT_DTIM_COUNT_VAP4_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP4_8821C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP4_8821C) -+#define BITS_DTIM_COUNT_VAP4_8821C \ -+ (BIT_MASK_DTIM_COUNT_VAP4_8821C << BIT_SHIFT_DTIM_COUNT_VAP4_8821C) -+#define BIT_CLEAR_DTIM_COUNT_VAP4_8821C(x) ((x) & (~BITS_DTIM_COUNT_VAP4_8821C)) -+#define BIT_GET_DTIM_COUNT_VAP4_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP4_8821C) & \ -+ BIT_MASK_DTIM_COUNT_VAP4_8821C) -+#define BIT_SET_DTIM_COUNT_VAP4_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP4_8821C(x) | BIT_DTIM_COUNT_VAP4_8821C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP5_8821C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP5_8821C 0 -+#define BIT_MASK_DTIM_COUNT_VAP5_8821C 0xff -+#define BIT_DTIM_COUNT_VAP5_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP5_8821C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP5_8821C) -+#define BITS_DTIM_COUNT_VAP5_8821C \ -+ (BIT_MASK_DTIM_COUNT_VAP5_8821C << BIT_SHIFT_DTIM_COUNT_VAP5_8821C) -+#define BIT_CLEAR_DTIM_COUNT_VAP5_8821C(x) ((x) & (~BITS_DTIM_COUNT_VAP5_8821C)) -+#define BIT_GET_DTIM_COUNT_VAP5_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP5_8821C) & \ -+ BIT_MASK_DTIM_COUNT_VAP5_8821C) -+#define BIT_SET_DTIM_COUNT_VAP5_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP5_8821C(x) | BIT_DTIM_COUNT_VAP5_8821C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP6_8821C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP6_8821C 0 -+#define BIT_MASK_DTIM_COUNT_VAP6_8821C 0xff -+#define BIT_DTIM_COUNT_VAP6_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP6_8821C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP6_8821C) -+#define BITS_DTIM_COUNT_VAP6_8821C \ -+ (BIT_MASK_DTIM_COUNT_VAP6_8821C << BIT_SHIFT_DTIM_COUNT_VAP6_8821C) -+#define BIT_CLEAR_DTIM_COUNT_VAP6_8821C(x) ((x) & (~BITS_DTIM_COUNT_VAP6_8821C)) -+#define BIT_GET_DTIM_COUNT_VAP6_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP6_8821C) & \ -+ BIT_MASK_DTIM_COUNT_VAP6_8821C) -+#define BIT_SET_DTIM_COUNT_VAP6_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP6_8821C(x) | BIT_DTIM_COUNT_VAP6_8821C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP7_8821C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP7_8821C 0 -+#define BIT_MASK_DTIM_COUNT_VAP7_8821C 0xff -+#define BIT_DTIM_COUNT_VAP7_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP7_8821C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP7_8821C) -+#define BITS_DTIM_COUNT_VAP7_8821C \ -+ (BIT_MASK_DTIM_COUNT_VAP7_8821C << BIT_SHIFT_DTIM_COUNT_VAP7_8821C) -+#define BIT_CLEAR_DTIM_COUNT_VAP7_8821C(x) ((x) & (~BITS_DTIM_COUNT_VAP7_8821C)) -+#define BIT_GET_DTIM_COUNT_VAP7_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP7_8821C) & \ -+ BIT_MASK_DTIM_COUNT_VAP7_8821C) -+#define BIT_SET_DTIM_COUNT_VAP7_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP7_8821C(x) | BIT_DTIM_COUNT_VAP7_8821C(v)) -+ -+/* 2 REG_DIS_ATIM_8821C */ -+#define BIT_DIS_ATIM_VAP7_8821C BIT(7) -+#define BIT_DIS_ATIM_VAP6_8821C BIT(6) -+#define BIT_DIS_ATIM_VAP5_8821C BIT(5) -+#define BIT_DIS_ATIM_VAP4_8821C BIT(4) -+#define BIT_DIS_ATIM_VAP3_8821C BIT(3) -+#define BIT_DIS_ATIM_VAP2_8821C BIT(2) -+#define BIT_DIS_ATIM_VAP1_8821C BIT(1) -+#define BIT_DIS_ATIM_ROOT_8821C BIT(0) -+ -+/* 2 REG_EARLY_128US_8821C */ -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER1_8821C 3 -+#define BIT_MASK_TSFT_SEL_TIMER1_8821C 0x7 -+#define BIT_TSFT_SEL_TIMER1_8821C(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER1_8821C) \ -+ << BIT_SHIFT_TSFT_SEL_TIMER1_8821C) -+#define BITS_TSFT_SEL_TIMER1_8821C \ -+ (BIT_MASK_TSFT_SEL_TIMER1_8821C << BIT_SHIFT_TSFT_SEL_TIMER1_8821C) -+#define BIT_CLEAR_TSFT_SEL_TIMER1_8821C(x) ((x) & (~BITS_TSFT_SEL_TIMER1_8821C)) -+#define BIT_GET_TSFT_SEL_TIMER1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER1_8821C) & \ -+ BIT_MASK_TSFT_SEL_TIMER1_8821C) -+#define BIT_SET_TSFT_SEL_TIMER1_8821C(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER1_8821C(x) | BIT_TSFT_SEL_TIMER1_8821C(v)) -+ -+#define BIT_SHIFT_EARLY_128US_8821C 0 -+#define BIT_MASK_EARLY_128US_8821C 0x7 -+#define BIT_EARLY_128US_8821C(x) \ -+ (((x) & BIT_MASK_EARLY_128US_8821C) << BIT_SHIFT_EARLY_128US_8821C) -+#define BITS_EARLY_128US_8821C \ -+ (BIT_MASK_EARLY_128US_8821C << BIT_SHIFT_EARLY_128US_8821C) -+#define BIT_CLEAR_EARLY_128US_8821C(x) ((x) & (~BITS_EARLY_128US_8821C)) -+#define BIT_GET_EARLY_128US_8821C(x) \ -+ (((x) >> BIT_SHIFT_EARLY_128US_8821C) & BIT_MASK_EARLY_128US_8821C) -+#define BIT_SET_EARLY_128US_8821C(x, v) \ -+ (BIT_CLEAR_EARLY_128US_8821C(x) | BIT_EARLY_128US_8821C(v)) -+ -+/* 2 REG_P2PPS1_CTRL_8821C */ -+#define BIT_P2P1_CTW_ALLSTASLEEP_8821C BIT(7) -+#define BIT_P2P1_OFF_DISTX_EN_8821C BIT(6) -+#define BIT_P2P1_PWR_MGT_EN_8821C BIT(5) -+#define BIT_P2P1_NOA1_EN_8821C BIT(2) -+#define BIT_P2P1_NOA0_EN_8821C BIT(1) -+ -+/* 2 REG_P2PPS2_CTRL_8821C */ -+#define BIT_P2P2_CTW_ALLSTASLEEP_8821C BIT(7) -+#define BIT_P2P2_OFF_DISTX_EN_8821C BIT(6) -+#define BIT_P2P2_PWR_MGT_EN_8821C BIT(5) -+#define BIT_P2P2_NOA1_EN_8821C BIT(2) -+#define BIT_P2P2_NOA0_EN_8821C BIT(1) -+ -+/* 2 REG_TIMER0_SRC_SEL_8821C */ -+ -+#define BIT_SHIFT_SYNC_CLI_SEL_8821C 4 -+#define BIT_MASK_SYNC_CLI_SEL_8821C 0x7 -+#define BIT_SYNC_CLI_SEL_8821C(x) \ -+ (((x) & BIT_MASK_SYNC_CLI_SEL_8821C) << BIT_SHIFT_SYNC_CLI_SEL_8821C) -+#define BITS_SYNC_CLI_SEL_8821C \ -+ (BIT_MASK_SYNC_CLI_SEL_8821C << BIT_SHIFT_SYNC_CLI_SEL_8821C) -+#define BIT_CLEAR_SYNC_CLI_SEL_8821C(x) ((x) & (~BITS_SYNC_CLI_SEL_8821C)) -+#define BIT_GET_SYNC_CLI_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_SYNC_CLI_SEL_8821C) & BIT_MASK_SYNC_CLI_SEL_8821C) -+#define BIT_SET_SYNC_CLI_SEL_8821C(x, v) \ -+ (BIT_CLEAR_SYNC_CLI_SEL_8821C(x) | BIT_SYNC_CLI_SEL_8821C(v)) -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER0_8821C 0 -+#define BIT_MASK_TSFT_SEL_TIMER0_8821C 0x7 -+#define BIT_TSFT_SEL_TIMER0_8821C(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER0_8821C) \ -+ << BIT_SHIFT_TSFT_SEL_TIMER0_8821C) -+#define BITS_TSFT_SEL_TIMER0_8821C \ -+ (BIT_MASK_TSFT_SEL_TIMER0_8821C << BIT_SHIFT_TSFT_SEL_TIMER0_8821C) -+#define BIT_CLEAR_TSFT_SEL_TIMER0_8821C(x) ((x) & (~BITS_TSFT_SEL_TIMER0_8821C)) -+#define BIT_GET_TSFT_SEL_TIMER0_8821C(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER0_8821C) & \ -+ BIT_MASK_TSFT_SEL_TIMER0_8821C) -+#define BIT_SET_TSFT_SEL_TIMER0_8821C(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER0_8821C(x) | BIT_TSFT_SEL_TIMER0_8821C(v)) -+ -+/* 2 REG_NOA_UNIT_SEL_8821C */ -+ -+#define BIT_SHIFT_NOA_UNIT2_SEL_8821C 8 -+#define BIT_MASK_NOA_UNIT2_SEL_8821C 0x7 -+#define BIT_NOA_UNIT2_SEL_8821C(x) \ -+ (((x) & BIT_MASK_NOA_UNIT2_SEL_8821C) << BIT_SHIFT_NOA_UNIT2_SEL_8821C) -+#define BITS_NOA_UNIT2_SEL_8821C \ -+ (BIT_MASK_NOA_UNIT2_SEL_8821C << BIT_SHIFT_NOA_UNIT2_SEL_8821C) -+#define BIT_CLEAR_NOA_UNIT2_SEL_8821C(x) ((x) & (~BITS_NOA_UNIT2_SEL_8821C)) -+#define BIT_GET_NOA_UNIT2_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT2_SEL_8821C) & BIT_MASK_NOA_UNIT2_SEL_8821C) -+#define BIT_SET_NOA_UNIT2_SEL_8821C(x, v) \ -+ (BIT_CLEAR_NOA_UNIT2_SEL_8821C(x) | BIT_NOA_UNIT2_SEL_8821C(v)) -+ -+#define BIT_SHIFT_NOA_UNIT1_SEL_8821C 4 -+#define BIT_MASK_NOA_UNIT1_SEL_8821C 0x7 -+#define BIT_NOA_UNIT1_SEL_8821C(x) \ -+ (((x) & BIT_MASK_NOA_UNIT1_SEL_8821C) << BIT_SHIFT_NOA_UNIT1_SEL_8821C) -+#define BITS_NOA_UNIT1_SEL_8821C \ -+ (BIT_MASK_NOA_UNIT1_SEL_8821C << BIT_SHIFT_NOA_UNIT1_SEL_8821C) -+#define BIT_CLEAR_NOA_UNIT1_SEL_8821C(x) ((x) & (~BITS_NOA_UNIT1_SEL_8821C)) -+#define BIT_GET_NOA_UNIT1_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT1_SEL_8821C) & BIT_MASK_NOA_UNIT1_SEL_8821C) -+#define BIT_SET_NOA_UNIT1_SEL_8821C(x, v) \ -+ (BIT_CLEAR_NOA_UNIT1_SEL_8821C(x) | BIT_NOA_UNIT1_SEL_8821C(v)) -+ -+#define BIT_SHIFT_NOA_UNIT0_SEL_8821C 0 -+#define BIT_MASK_NOA_UNIT0_SEL_8821C 0x7 -+#define BIT_NOA_UNIT0_SEL_8821C(x) \ -+ (((x) & BIT_MASK_NOA_UNIT0_SEL_8821C) << BIT_SHIFT_NOA_UNIT0_SEL_8821C) -+#define BITS_NOA_UNIT0_SEL_8821C \ -+ (BIT_MASK_NOA_UNIT0_SEL_8821C << BIT_SHIFT_NOA_UNIT0_SEL_8821C) -+#define BIT_CLEAR_NOA_UNIT0_SEL_8821C(x) ((x) & (~BITS_NOA_UNIT0_SEL_8821C)) -+#define BIT_GET_NOA_UNIT0_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT0_SEL_8821C) & BIT_MASK_NOA_UNIT0_SEL_8821C) -+#define BIT_SET_NOA_UNIT0_SEL_8821C(x, v) \ -+ (BIT_CLEAR_NOA_UNIT0_SEL_8821C(x) | BIT_NOA_UNIT0_SEL_8821C(v)) -+ -+/* 2 REG_P2POFF_DIS_TXTIME_8821C */ -+ -+#define BIT_SHIFT_P2POFF_DIS_TXTIME_8821C 0 -+#define BIT_MASK_P2POFF_DIS_TXTIME_8821C 0xff -+#define BIT_P2POFF_DIS_TXTIME_8821C(x) \ -+ (((x) & BIT_MASK_P2POFF_DIS_TXTIME_8821C) \ -+ << BIT_SHIFT_P2POFF_DIS_TXTIME_8821C) -+#define BITS_P2POFF_DIS_TXTIME_8821C \ -+ (BIT_MASK_P2POFF_DIS_TXTIME_8821C << BIT_SHIFT_P2POFF_DIS_TXTIME_8821C) -+#define BIT_CLEAR_P2POFF_DIS_TXTIME_8821C(x) \ -+ ((x) & (~BITS_P2POFF_DIS_TXTIME_8821C)) -+#define BIT_GET_P2POFF_DIS_TXTIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_P2POFF_DIS_TXTIME_8821C) & \ -+ BIT_MASK_P2POFF_DIS_TXTIME_8821C) -+#define BIT_SET_P2POFF_DIS_TXTIME_8821C(x, v) \ -+ (BIT_CLEAR_P2POFF_DIS_TXTIME_8821C(x) | BIT_P2POFF_DIS_TXTIME_8821C(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE2_8821C */ -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT2_8821C 16 -+#define BIT_MASK_BCN_SPACE_CLINT2_8821C 0xfff -+#define BIT_BCN_SPACE_CLINT2_8821C(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT2_8821C) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT2_8821C) -+#define BITS_BCN_SPACE_CLINT2_8821C \ -+ (BIT_MASK_BCN_SPACE_CLINT2_8821C << BIT_SHIFT_BCN_SPACE_CLINT2_8821C) -+#define BIT_CLEAR_BCN_SPACE_CLINT2_8821C(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT2_8821C)) -+#define BIT_GET_BCN_SPACE_CLINT2_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT2_8821C) & \ -+ BIT_MASK_BCN_SPACE_CLINT2_8821C) -+#define BIT_SET_BCN_SPACE_CLINT2_8821C(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT2_8821C(x) | BIT_BCN_SPACE_CLINT2_8821C(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT1_8821C 0 -+#define BIT_MASK_BCN_SPACE_CLINT1_8821C 0xfff -+#define BIT_BCN_SPACE_CLINT1_8821C(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT1_8821C) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT1_8821C) -+#define BITS_BCN_SPACE_CLINT1_8821C \ -+ (BIT_MASK_BCN_SPACE_CLINT1_8821C << BIT_SHIFT_BCN_SPACE_CLINT1_8821C) -+#define BIT_CLEAR_BCN_SPACE_CLINT1_8821C(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT1_8821C)) -+#define BIT_GET_BCN_SPACE_CLINT1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT1_8821C) & \ -+ BIT_MASK_BCN_SPACE_CLINT1_8821C) -+#define BIT_SET_BCN_SPACE_CLINT1_8821C(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT1_8821C(x) | BIT_BCN_SPACE_CLINT1_8821C(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE3_8821C */ -+ -+#define BIT_SHIFT_SUB_BCN_SPACE_8821C 16 -+#define BIT_MASK_SUB_BCN_SPACE_8821C 0xff -+#define BIT_SUB_BCN_SPACE_8821C(x) \ -+ (((x) & BIT_MASK_SUB_BCN_SPACE_8821C) << BIT_SHIFT_SUB_BCN_SPACE_8821C) -+#define BITS_SUB_BCN_SPACE_8821C \ -+ (BIT_MASK_SUB_BCN_SPACE_8821C << BIT_SHIFT_SUB_BCN_SPACE_8821C) -+#define BIT_CLEAR_SUB_BCN_SPACE_8821C(x) ((x) & (~BITS_SUB_BCN_SPACE_8821C)) -+#define BIT_GET_SUB_BCN_SPACE_8821C(x) \ -+ (((x) >> BIT_SHIFT_SUB_BCN_SPACE_8821C) & BIT_MASK_SUB_BCN_SPACE_8821C) -+#define BIT_SET_SUB_BCN_SPACE_8821C(x, v) \ -+ (BIT_CLEAR_SUB_BCN_SPACE_8821C(x) | BIT_SUB_BCN_SPACE_8821C(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT3_8821C 0 -+#define BIT_MASK_BCN_SPACE_CLINT3_8821C 0xfff -+#define BIT_BCN_SPACE_CLINT3_8821C(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT3_8821C) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT3_8821C) -+#define BITS_BCN_SPACE_CLINT3_8821C \ -+ (BIT_MASK_BCN_SPACE_CLINT3_8821C << BIT_SHIFT_BCN_SPACE_CLINT3_8821C) -+#define BIT_CLEAR_BCN_SPACE_CLINT3_8821C(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT3_8821C)) -+#define BIT_GET_BCN_SPACE_CLINT3_8821C(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT3_8821C) & \ -+ BIT_MASK_BCN_SPACE_CLINT3_8821C) -+#define BIT_SET_BCN_SPACE_CLINT3_8821C(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT3_8821C(x) | BIT_BCN_SPACE_CLINT3_8821C(v)) -+ -+/* 2 REG_ACMHWCTRL_8821C */ -+#define BIT_BEQ_ACM_STATUS_8821C BIT(7) -+#define BIT_VIQ_ACM_STATUS_8821C BIT(6) -+#define BIT_VOQ_ACM_STATUS_8821C BIT(5) -+#define BIT_BEQ_ACM_EN_8821C BIT(3) -+#define BIT_VIQ_ACM_EN_8821C BIT(2) -+#define BIT_VOQ_ACM_EN_8821C BIT(1) -+#define BIT_ACMHWEN_8821C BIT(0) -+ -+/* 2 REG_ACMRSTCTRL_8821C */ -+#define BIT_BE_ACM_RESET_USED_TIME_8821C BIT(2) -+#define BIT_VI_ACM_RESET_USED_TIME_8821C BIT(1) -+#define BIT_VO_ACM_RESET_USED_TIME_8821C BIT(0) -+ -+/* 2 REG_ACMAVG_8821C */ -+ -+#define BIT_SHIFT_AVGPERIOD_8821C 0 -+#define BIT_MASK_AVGPERIOD_8821C 0xffff -+#define BIT_AVGPERIOD_8821C(x) \ -+ (((x) & BIT_MASK_AVGPERIOD_8821C) << BIT_SHIFT_AVGPERIOD_8821C) -+#define BITS_AVGPERIOD_8821C \ -+ (BIT_MASK_AVGPERIOD_8821C << BIT_SHIFT_AVGPERIOD_8821C) -+#define BIT_CLEAR_AVGPERIOD_8821C(x) ((x) & (~BITS_AVGPERIOD_8821C)) -+#define BIT_GET_AVGPERIOD_8821C(x) \ -+ (((x) >> BIT_SHIFT_AVGPERIOD_8821C) & BIT_MASK_AVGPERIOD_8821C) -+#define BIT_SET_AVGPERIOD_8821C(x, v) \ -+ (BIT_CLEAR_AVGPERIOD_8821C(x) | BIT_AVGPERIOD_8821C(v)) -+ -+/* 2 REG_VO_ADMTIME_8821C */ -+ -+#define BIT_SHIFT_VO_ADMITTED_TIME_8821C 0 -+#define BIT_MASK_VO_ADMITTED_TIME_8821C 0xffff -+#define BIT_VO_ADMITTED_TIME_8821C(x) \ -+ (((x) & BIT_MASK_VO_ADMITTED_TIME_8821C) \ -+ << BIT_SHIFT_VO_ADMITTED_TIME_8821C) -+#define BITS_VO_ADMITTED_TIME_8821C \ -+ (BIT_MASK_VO_ADMITTED_TIME_8821C << BIT_SHIFT_VO_ADMITTED_TIME_8821C) -+#define BIT_CLEAR_VO_ADMITTED_TIME_8821C(x) \ -+ ((x) & (~BITS_VO_ADMITTED_TIME_8821C)) -+#define BIT_GET_VO_ADMITTED_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_VO_ADMITTED_TIME_8821C) & \ -+ BIT_MASK_VO_ADMITTED_TIME_8821C) -+#define BIT_SET_VO_ADMITTED_TIME_8821C(x, v) \ -+ (BIT_CLEAR_VO_ADMITTED_TIME_8821C(x) | BIT_VO_ADMITTED_TIME_8821C(v)) -+ -+/* 2 REG_VI_ADMTIME_8821C */ -+ -+#define BIT_SHIFT_VI_ADMITTED_TIME_8821C 0 -+#define BIT_MASK_VI_ADMITTED_TIME_8821C 0xffff -+#define BIT_VI_ADMITTED_TIME_8821C(x) \ -+ (((x) & BIT_MASK_VI_ADMITTED_TIME_8821C) \ -+ << BIT_SHIFT_VI_ADMITTED_TIME_8821C) -+#define BITS_VI_ADMITTED_TIME_8821C \ -+ (BIT_MASK_VI_ADMITTED_TIME_8821C << BIT_SHIFT_VI_ADMITTED_TIME_8821C) -+#define BIT_CLEAR_VI_ADMITTED_TIME_8821C(x) \ -+ ((x) & (~BITS_VI_ADMITTED_TIME_8821C)) -+#define BIT_GET_VI_ADMITTED_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_VI_ADMITTED_TIME_8821C) & \ -+ BIT_MASK_VI_ADMITTED_TIME_8821C) -+#define BIT_SET_VI_ADMITTED_TIME_8821C(x, v) \ -+ (BIT_CLEAR_VI_ADMITTED_TIME_8821C(x) | BIT_VI_ADMITTED_TIME_8821C(v)) -+ -+/* 2 REG_BE_ADMTIME_8821C */ -+ -+#define BIT_SHIFT_BE_ADMITTED_TIME_8821C 0 -+#define BIT_MASK_BE_ADMITTED_TIME_8821C 0xffff -+#define BIT_BE_ADMITTED_TIME_8821C(x) \ -+ (((x) & BIT_MASK_BE_ADMITTED_TIME_8821C) \ -+ << BIT_SHIFT_BE_ADMITTED_TIME_8821C) -+#define BITS_BE_ADMITTED_TIME_8821C \ -+ (BIT_MASK_BE_ADMITTED_TIME_8821C << BIT_SHIFT_BE_ADMITTED_TIME_8821C) -+#define BIT_CLEAR_BE_ADMITTED_TIME_8821C(x) \ -+ ((x) & (~BITS_BE_ADMITTED_TIME_8821C)) -+#define BIT_GET_BE_ADMITTED_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_BE_ADMITTED_TIME_8821C) & \ -+ BIT_MASK_BE_ADMITTED_TIME_8821C) -+#define BIT_SET_BE_ADMITTED_TIME_8821C(x, v) \ -+ (BIT_CLEAR_BE_ADMITTED_TIME_8821C(x) | BIT_BE_ADMITTED_TIME_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_EDCA_RANDOM_GEN_8821C */ -+ -+#define BIT_SHIFT_RANDOM_GEN_8821C 0 -+#define BIT_MASK_RANDOM_GEN_8821C 0xffffff -+#define BIT_RANDOM_GEN_8821C(x) \ -+ (((x) & BIT_MASK_RANDOM_GEN_8821C) << BIT_SHIFT_RANDOM_GEN_8821C) -+#define BITS_RANDOM_GEN_8821C \ -+ (BIT_MASK_RANDOM_GEN_8821C << BIT_SHIFT_RANDOM_GEN_8821C) -+#define BIT_CLEAR_RANDOM_GEN_8821C(x) ((x) & (~BITS_RANDOM_GEN_8821C)) -+#define BIT_GET_RANDOM_GEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_RANDOM_GEN_8821C) & BIT_MASK_RANDOM_GEN_8821C) -+#define BIT_SET_RANDOM_GEN_8821C(x, v) \ -+ (BIT_CLEAR_RANDOM_GEN_8821C(x) | BIT_RANDOM_GEN_8821C(v)) -+ -+/* 2 REG_TXCMD_NOA_SEL_8821C */ -+ -+#define BIT_SHIFT_NOA_SEL_V2_8821C 4 -+#define BIT_MASK_NOA_SEL_V2_8821C 0x7 -+#define BIT_NOA_SEL_V2_8821C(x) \ -+ (((x) & BIT_MASK_NOA_SEL_V2_8821C) << BIT_SHIFT_NOA_SEL_V2_8821C) -+#define BITS_NOA_SEL_V2_8821C \ -+ (BIT_MASK_NOA_SEL_V2_8821C << BIT_SHIFT_NOA_SEL_V2_8821C) -+#define BIT_CLEAR_NOA_SEL_V2_8821C(x) ((x) & (~BITS_NOA_SEL_V2_8821C)) -+#define BIT_GET_NOA_SEL_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_NOA_SEL_V2_8821C) & BIT_MASK_NOA_SEL_V2_8821C) -+#define BIT_SET_NOA_SEL_V2_8821C(x, v) \ -+ (BIT_CLEAR_NOA_SEL_V2_8821C(x) | BIT_NOA_SEL_V2_8821C(v)) -+ -+#define BIT_SHIFT_TXCMD_SEG_SEL_8821C 0 -+#define BIT_MASK_TXCMD_SEG_SEL_8821C 0xf -+#define BIT_TXCMD_SEG_SEL_8821C(x) \ -+ (((x) & BIT_MASK_TXCMD_SEG_SEL_8821C) << BIT_SHIFT_TXCMD_SEG_SEL_8821C) -+#define BITS_TXCMD_SEG_SEL_8821C \ -+ (BIT_MASK_TXCMD_SEG_SEL_8821C << BIT_SHIFT_TXCMD_SEG_SEL_8821C) -+#define BIT_CLEAR_TXCMD_SEG_SEL_8821C(x) ((x) & (~BITS_TXCMD_SEG_SEL_8821C)) -+#define BIT_GET_TXCMD_SEG_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_SEG_SEL_8821C) & BIT_MASK_TXCMD_SEG_SEL_8821C) -+#define BIT_SET_TXCMD_SEG_SEL_8821C(x, v) \ -+ (BIT_CLEAR_TXCMD_SEG_SEL_8821C(x) | BIT_TXCMD_SEG_SEL_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOA_PARAM_8821C */ -+ -+#define BIT_SHIFT_NOA_DURATION_V1_8821C 0 -+#define BIT_MASK_NOA_DURATION_V1_8821C 0xffffffffL -+#define BIT_NOA_DURATION_V1_8821C(x) \ -+ (((x) & BIT_MASK_NOA_DURATION_V1_8821C) \ -+ << BIT_SHIFT_NOA_DURATION_V1_8821C) -+#define BITS_NOA_DURATION_V1_8821C \ -+ (BIT_MASK_NOA_DURATION_V1_8821C << BIT_SHIFT_NOA_DURATION_V1_8821C) -+#define BIT_CLEAR_NOA_DURATION_V1_8821C(x) ((x) & (~BITS_NOA_DURATION_V1_8821C)) -+#define BIT_GET_NOA_DURATION_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_NOA_DURATION_V1_8821C) & \ -+ BIT_MASK_NOA_DURATION_V1_8821C) -+#define BIT_SET_NOA_DURATION_V1_8821C(x, v) \ -+ (BIT_CLEAR_NOA_DURATION_V1_8821C(x) | BIT_NOA_DURATION_V1_8821C(v)) -+ -+/* 2 REG_NOA_PARAM_1_8821C */ -+ -+#define BIT_SHIFT_NOA_INTERVAL_V1_8821C 0 -+#define BIT_MASK_NOA_INTERVAL_V1_8821C 0xffffffffL -+#define BIT_NOA_INTERVAL_V1_8821C(x) \ -+ (((x) & BIT_MASK_NOA_INTERVAL_V1_8821C) \ -+ << BIT_SHIFT_NOA_INTERVAL_V1_8821C) -+#define BITS_NOA_INTERVAL_V1_8821C \ -+ (BIT_MASK_NOA_INTERVAL_V1_8821C << BIT_SHIFT_NOA_INTERVAL_V1_8821C) -+#define BIT_CLEAR_NOA_INTERVAL_V1_8821C(x) ((x) & (~BITS_NOA_INTERVAL_V1_8821C)) -+#define BIT_GET_NOA_INTERVAL_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_NOA_INTERVAL_V1_8821C) & \ -+ BIT_MASK_NOA_INTERVAL_V1_8821C) -+#define BIT_SET_NOA_INTERVAL_V1_8821C(x, v) \ -+ (BIT_CLEAR_NOA_INTERVAL_V1_8821C(x) | BIT_NOA_INTERVAL_V1_8821C(v)) -+ -+/* 2 REG_NOA_PARAM_2_8821C */ -+ -+#define BIT_SHIFT_NOA_START_TIME_V1_8821C 0 -+#define BIT_MASK_NOA_START_TIME_V1_8821C 0xffffffffL -+#define BIT_NOA_START_TIME_V1_8821C(x) \ -+ (((x) & BIT_MASK_NOA_START_TIME_V1_8821C) \ -+ << BIT_SHIFT_NOA_START_TIME_V1_8821C) -+#define BITS_NOA_START_TIME_V1_8821C \ -+ (BIT_MASK_NOA_START_TIME_V1_8821C << BIT_SHIFT_NOA_START_TIME_V1_8821C) -+#define BIT_CLEAR_NOA_START_TIME_V1_8821C(x) \ -+ ((x) & (~BITS_NOA_START_TIME_V1_8821C)) -+#define BIT_GET_NOA_START_TIME_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_NOA_START_TIME_V1_8821C) & \ -+ BIT_MASK_NOA_START_TIME_V1_8821C) -+#define BIT_SET_NOA_START_TIME_V1_8821C(x, v) \ -+ (BIT_CLEAR_NOA_START_TIME_V1_8821C(x) | BIT_NOA_START_TIME_V1_8821C(v)) -+ -+/* 2 REG_NOA_PARAM_3_8821C */ -+ -+#define BIT_SHIFT_NOA_COUNT_V1_8821C 0 -+#define BIT_MASK_NOA_COUNT_V1_8821C 0xffffffffL -+#define BIT_NOA_COUNT_V1_8821C(x) \ -+ (((x) & BIT_MASK_NOA_COUNT_V1_8821C) << BIT_SHIFT_NOA_COUNT_V1_8821C) -+#define BITS_NOA_COUNT_V1_8821C \ -+ (BIT_MASK_NOA_COUNT_V1_8821C << BIT_SHIFT_NOA_COUNT_V1_8821C) -+#define BIT_CLEAR_NOA_COUNT_V1_8821C(x) ((x) & (~BITS_NOA_COUNT_V1_8821C)) -+#define BIT_GET_NOA_COUNT_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_NOA_COUNT_V1_8821C) & BIT_MASK_NOA_COUNT_V1_8821C) -+#define BIT_SET_NOA_COUNT_V1_8821C(x, v) \ -+ (BIT_CLEAR_NOA_COUNT_V1_8821C(x) | BIT_NOA_COUNT_V1_8821C(v)) -+ -+/* 2 REG_P2P_RST_8821C */ -+#define BIT_P2P2_PWR_RST1_8821C BIT(5) -+#define BIT_P2P2_PWR_RST0_8821C BIT(4) -+#define BIT_P2P1_PWR_RST1_8821C BIT(3) -+#define BIT_P2P1_PWR_RST0_8821C BIT(2) -+#define BIT_P2P_PWR_RST1_V1_8821C BIT(1) -+#define BIT_P2P_PWR_RST0_V1_8821C BIT(0) -+ -+/* 2 REG_SCHEDULER_RST_8821C */ -+#define BIT_SYNC_CLI_ONCE_RIGHT_NOW_8821C BIT(2) -+#define BIT_SYNC_CLI_ONCE_BY_TBTT_8821C BIT(1) -+#define BIT_SCHEDULER_RST_V1_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_SCH_TXCMD_8821C */ -+ -+#define BIT_SHIFT_SCH_TXCMD_8821C 0 -+#define BIT_MASK_SCH_TXCMD_8821C 0xffffffffL -+#define BIT_SCH_TXCMD_8821C(x) \ -+ (((x) & BIT_MASK_SCH_TXCMD_8821C) << BIT_SHIFT_SCH_TXCMD_8821C) -+#define BITS_SCH_TXCMD_8821C \ -+ (BIT_MASK_SCH_TXCMD_8821C << BIT_SHIFT_SCH_TXCMD_8821C) -+#define BIT_CLEAR_SCH_TXCMD_8821C(x) ((x) & (~BITS_SCH_TXCMD_8821C)) -+#define BIT_GET_SCH_TXCMD_8821C(x) \ -+ (((x) >> BIT_SHIFT_SCH_TXCMD_8821C) & BIT_MASK_SCH_TXCMD_8821C) -+#define BIT_SET_SCH_TXCMD_8821C(x, v) \ -+ (BIT_CLEAR_SCH_TXCMD_8821C(x) | BIT_SCH_TXCMD_8821C(v)) -+ -+/* 2 REG_PAGE5_DUMMY_8821C */ -+#define BIT_ECO_TXOP_BREAK_FORCE_CFEND_8821C BIT(0) -+ -+/* 2 REG_CPUMGQ_TX_TIMER_8821C */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8821C 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_V1_8821C 0xffffffffL -+#define BIT_CPUMGQ_TX_TIMER_V1_8821C(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_V1_8821C) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8821C) -+#define BITS_CPUMGQ_TX_TIMER_V1_8821C \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_V1_8821C \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8821C) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8821C(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_V1_8821C)) -+#define BIT_GET_CPUMGQ_TX_TIMER_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8821C) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_V1_8821C) -+#define BIT_SET_CPUMGQ_TX_TIMER_V1_8821C(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8821C(x) | \ -+ BIT_CPUMGQ_TX_TIMER_V1_8821C(v)) -+ -+/* 2 REG_PS_TIMER_A_8821C */ -+ -+#define BIT_SHIFT_PS_TIMER_A_V1_8821C 0 -+#define BIT_MASK_PS_TIMER_A_V1_8821C 0xffffffffL -+#define BIT_PS_TIMER_A_V1_8821C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_V1_8821C) << BIT_SHIFT_PS_TIMER_A_V1_8821C) -+#define BITS_PS_TIMER_A_V1_8821C \ -+ (BIT_MASK_PS_TIMER_A_V1_8821C << BIT_SHIFT_PS_TIMER_A_V1_8821C) -+#define BIT_CLEAR_PS_TIMER_A_V1_8821C(x) ((x) & (~BITS_PS_TIMER_A_V1_8821C)) -+#define BIT_GET_PS_TIMER_A_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_V1_8821C) & BIT_MASK_PS_TIMER_A_V1_8821C) -+#define BIT_SET_PS_TIMER_A_V1_8821C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_V1_8821C(x) | BIT_PS_TIMER_A_V1_8821C(v)) -+ -+/* 2 REG_PS_TIMER_B_8821C */ -+ -+#define BIT_SHIFT_PS_TIMER_B_V1_8821C 0 -+#define BIT_MASK_PS_TIMER_B_V1_8821C 0xffffffffL -+#define BIT_PS_TIMER_B_V1_8821C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_V1_8821C) << BIT_SHIFT_PS_TIMER_B_V1_8821C) -+#define BITS_PS_TIMER_B_V1_8821C \ -+ (BIT_MASK_PS_TIMER_B_V1_8821C << BIT_SHIFT_PS_TIMER_B_V1_8821C) -+#define BIT_CLEAR_PS_TIMER_B_V1_8821C(x) ((x) & (~BITS_PS_TIMER_B_V1_8821C)) -+#define BIT_GET_PS_TIMER_B_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_V1_8821C) & BIT_MASK_PS_TIMER_B_V1_8821C) -+#define BIT_SET_PS_TIMER_B_V1_8821C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_V1_8821C(x) | BIT_PS_TIMER_B_V1_8821C(v)) -+ -+/* 2 REG_PS_TIMER_C_8821C */ -+ -+#define BIT_SHIFT_PS_TIMER_C_V1_8821C 0 -+#define BIT_MASK_PS_TIMER_C_V1_8821C 0xffffffffL -+#define BIT_PS_TIMER_C_V1_8821C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_V1_8821C) << BIT_SHIFT_PS_TIMER_C_V1_8821C) -+#define BITS_PS_TIMER_C_V1_8821C \ -+ (BIT_MASK_PS_TIMER_C_V1_8821C << BIT_SHIFT_PS_TIMER_C_V1_8821C) -+#define BIT_CLEAR_PS_TIMER_C_V1_8821C(x) ((x) & (~BITS_PS_TIMER_C_V1_8821C)) -+#define BIT_GET_PS_TIMER_C_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_V1_8821C) & BIT_MASK_PS_TIMER_C_V1_8821C) -+#define BIT_SET_PS_TIMER_C_V1_8821C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_V1_8821C(x) | BIT_PS_TIMER_C_V1_8821C(v)) -+ -+/* 2 REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL_8821C */ -+#define BIT_CPUMGQ_TIMER_EN_8821C BIT(31) -+#define BIT_CPUMGQ_TX_EN_8821C BIT(28) -+ -+#define BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8821C 24 -+#define BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8821C 0x7 -+#define BIT_CPUMGQ_TIMER_TSF_SEL_8821C(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8821C) \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8821C) -+#define BITS_CPUMGQ_TIMER_TSF_SEL_8821C \ -+ (BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8821C \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8821C) -+#define BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_8821C(x) \ -+ ((x) & (~BITS_CPUMGQ_TIMER_TSF_SEL_8821C)) -+#define BIT_GET_CPUMGQ_TIMER_TSF_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8821C) & \ -+ BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8821C) -+#define BIT_SET_CPUMGQ_TIMER_TSF_SEL_8821C(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_8821C(x) | \ -+ BIT_CPUMGQ_TIMER_TSF_SEL_8821C(v)) -+ -+#define BIT_PS_TIMER_C_EN_8821C BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_C_TSF_SEL_8821C 16 -+#define BIT_MASK_PS_TIMER_C_TSF_SEL_8821C 0x7 -+#define BIT_PS_TIMER_C_TSF_SEL_8821C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_TSF_SEL_8821C) \ -+ << BIT_SHIFT_PS_TIMER_C_TSF_SEL_8821C) -+#define BITS_PS_TIMER_C_TSF_SEL_8821C \ -+ (BIT_MASK_PS_TIMER_C_TSF_SEL_8821C \ -+ << BIT_SHIFT_PS_TIMER_C_TSF_SEL_8821C) -+#define BIT_CLEAR_PS_TIMER_C_TSF_SEL_8821C(x) \ -+ ((x) & (~BITS_PS_TIMER_C_TSF_SEL_8821C)) -+#define BIT_GET_PS_TIMER_C_TSF_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_TSF_SEL_8821C) & \ -+ BIT_MASK_PS_TIMER_C_TSF_SEL_8821C) -+#define BIT_SET_PS_TIMER_C_TSF_SEL_8821C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_TSF_SEL_8821C(x) | \ -+ BIT_PS_TIMER_C_TSF_SEL_8821C(v)) -+ -+#define BIT_PS_TIMER_B_EN_8821C BIT(15) -+ -+#define BIT_SHIFT_PS_TIMER_B_TSF_SEL_8821C 8 -+#define BIT_MASK_PS_TIMER_B_TSF_SEL_8821C 0x7 -+#define BIT_PS_TIMER_B_TSF_SEL_8821C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_TSF_SEL_8821C) \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_8821C) -+#define BITS_PS_TIMER_B_TSF_SEL_8821C \ -+ (BIT_MASK_PS_TIMER_B_TSF_SEL_8821C \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_8821C) -+#define BIT_CLEAR_PS_TIMER_B_TSF_SEL_8821C(x) \ -+ ((x) & (~BITS_PS_TIMER_B_TSF_SEL_8821C)) -+#define BIT_GET_PS_TIMER_B_TSF_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_TSF_SEL_8821C) & \ -+ BIT_MASK_PS_TIMER_B_TSF_SEL_8821C) -+#define BIT_SET_PS_TIMER_B_TSF_SEL_8821C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_TSF_SEL_8821C(x) | \ -+ BIT_PS_TIMER_B_TSF_SEL_8821C(v)) -+ -+#define BIT_PS_TIMER_A_EN_8821C BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_A_TSF_SEL_8821C 0 -+#define BIT_MASK_PS_TIMER_A_TSF_SEL_8821C 0x7 -+#define BIT_PS_TIMER_A_TSF_SEL_8821C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_TSF_SEL_8821C) \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_8821C) -+#define BITS_PS_TIMER_A_TSF_SEL_8821C \ -+ (BIT_MASK_PS_TIMER_A_TSF_SEL_8821C \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_8821C) -+#define BIT_CLEAR_PS_TIMER_A_TSF_SEL_8821C(x) \ -+ ((x) & (~BITS_PS_TIMER_A_TSF_SEL_8821C)) -+#define BIT_GET_PS_TIMER_A_TSF_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_TSF_SEL_8821C) & \ -+ BIT_MASK_PS_TIMER_A_TSF_SEL_8821C) -+#define BIT_SET_PS_TIMER_A_TSF_SEL_8821C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_TSF_SEL_8821C(x) | \ -+ BIT_PS_TIMER_A_TSF_SEL_8821C(v)) -+ -+/* 2 REG_CPUMGQ_TX_TIMER_EARLY_8821C */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8821C 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8821C 0xff -+#define BIT_CPUMGQ_TX_TIMER_EARLY_8821C(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8821C) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8821C) -+#define BITS_CPUMGQ_TX_TIMER_EARLY_8821C \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8821C \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8821C) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_8821C(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_EARLY_8821C)) -+#define BIT_GET_CPUMGQ_TX_TIMER_EARLY_8821C(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8821C) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8821C) -+#define BIT_SET_CPUMGQ_TX_TIMER_EARLY_8821C(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_8821C(x) | \ -+ BIT_CPUMGQ_TX_TIMER_EARLY_8821C(v)) -+ -+/* 2 REG_PS_TIMER_A_EARLY_8821C */ -+ -+#define BIT_SHIFT_PS_TIMER_A_EARLY_8821C 0 -+#define BIT_MASK_PS_TIMER_A_EARLY_8821C 0xff -+#define BIT_PS_TIMER_A_EARLY_8821C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_EARLY_8821C) \ -+ << BIT_SHIFT_PS_TIMER_A_EARLY_8821C) -+#define BITS_PS_TIMER_A_EARLY_8821C \ -+ (BIT_MASK_PS_TIMER_A_EARLY_8821C << BIT_SHIFT_PS_TIMER_A_EARLY_8821C) -+#define BIT_CLEAR_PS_TIMER_A_EARLY_8821C(x) \ -+ ((x) & (~BITS_PS_TIMER_A_EARLY_8821C)) -+#define BIT_GET_PS_TIMER_A_EARLY_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_EARLY_8821C) & \ -+ BIT_MASK_PS_TIMER_A_EARLY_8821C) -+#define BIT_SET_PS_TIMER_A_EARLY_8821C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_EARLY_8821C(x) | BIT_PS_TIMER_A_EARLY_8821C(v)) -+ -+/* 2 REG_PS_TIMER_B_EARLY_8821C */ -+ -+#define BIT_SHIFT_PS_TIMER_B_EARLY_8821C 0 -+#define BIT_MASK_PS_TIMER_B_EARLY_8821C 0xff -+#define BIT_PS_TIMER_B_EARLY_8821C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_EARLY_8821C) \ -+ << BIT_SHIFT_PS_TIMER_B_EARLY_8821C) -+#define BITS_PS_TIMER_B_EARLY_8821C \ -+ (BIT_MASK_PS_TIMER_B_EARLY_8821C << BIT_SHIFT_PS_TIMER_B_EARLY_8821C) -+#define BIT_CLEAR_PS_TIMER_B_EARLY_8821C(x) \ -+ ((x) & (~BITS_PS_TIMER_B_EARLY_8821C)) -+#define BIT_GET_PS_TIMER_B_EARLY_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_EARLY_8821C) & \ -+ BIT_MASK_PS_TIMER_B_EARLY_8821C) -+#define BIT_SET_PS_TIMER_B_EARLY_8821C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_EARLY_8821C(x) | BIT_PS_TIMER_B_EARLY_8821C(v)) -+ -+/* 2 REG_PS_TIMER_C_EARLY_8821C */ -+ -+#define BIT_SHIFT_PS_TIMER_C_EARLY_8821C 0 -+#define BIT_MASK_PS_TIMER_C_EARLY_8821C 0xff -+#define BIT_PS_TIMER_C_EARLY_8821C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_EARLY_8821C) \ -+ << BIT_SHIFT_PS_TIMER_C_EARLY_8821C) -+#define BITS_PS_TIMER_C_EARLY_8821C \ -+ (BIT_MASK_PS_TIMER_C_EARLY_8821C << BIT_SHIFT_PS_TIMER_C_EARLY_8821C) -+#define BIT_CLEAR_PS_TIMER_C_EARLY_8821C(x) \ -+ ((x) & (~BITS_PS_TIMER_C_EARLY_8821C)) -+#define BIT_GET_PS_TIMER_C_EARLY_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_EARLY_8821C) & \ -+ BIT_MASK_PS_TIMER_C_EARLY_8821C) -+#define BIT_SET_PS_TIMER_C_EARLY_8821C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_EARLY_8821C(x) | BIT_PS_TIMER_C_EARLY_8821C(v)) -+ -+/* 2 REG_CPUMGQ_PARAMETER_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+#define BIT_MAC_STOP_CPUMGQ_8821C BIT(16) -+ -+#define BIT_SHIFT_CW_8821C 8 -+#define BIT_MASK_CW_8821C 0xff -+#define BIT_CW_8821C(x) (((x) & BIT_MASK_CW_8821C) << BIT_SHIFT_CW_8821C) -+#define BITS_CW_8821C (BIT_MASK_CW_8821C << BIT_SHIFT_CW_8821C) -+#define BIT_CLEAR_CW_8821C(x) ((x) & (~BITS_CW_8821C)) -+#define BIT_GET_CW_8821C(x) (((x) >> BIT_SHIFT_CW_8821C) & BIT_MASK_CW_8821C) -+#define BIT_SET_CW_8821C(x, v) (BIT_CLEAR_CW_8821C(x) | BIT_CW_8821C(v)) -+ -+#define BIT_SHIFT_AIFS_8821C 0 -+#define BIT_MASK_AIFS_8821C 0xff -+#define BIT_AIFS_8821C(x) (((x) & BIT_MASK_AIFS_8821C) << BIT_SHIFT_AIFS_8821C) -+#define BITS_AIFS_8821C (BIT_MASK_AIFS_8821C << BIT_SHIFT_AIFS_8821C) -+#define BIT_CLEAR_AIFS_8821C(x) ((x) & (~BITS_AIFS_8821C)) -+#define BIT_GET_AIFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8821C) & BIT_MASK_AIFS_8821C) -+#define BIT_SET_AIFS_8821C(x, v) (BIT_CLEAR_AIFS_8821C(x) | BIT_AIFS_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_WMAC_CR_8821C (WMAC CR AND APSD CONTROL REGISTER) */ -+#define BIT_IC_MACPHY_M_8821C BIT(0) -+ -+/* 2 REG_WMAC_FWPKT_CR_8821C */ -+#define BIT_FWEN_8821C BIT(7) -+#define BIT_PHYSTS_PKT_CTRL_8821C BIT(6) -+#define BIT_FWFULL_TO_RXFF_EN_8821C BIT(5) -+#define BIT_APPHDR_MIDSRCH_FAIL_8821C BIT(4) -+#define BIT_FWPARSING_EN_8821C BIT(3) -+ -+#define BIT_SHIFT_APPEND_MHDR_LEN_8821C 0 -+#define BIT_MASK_APPEND_MHDR_LEN_8821C 0x7 -+#define BIT_APPEND_MHDR_LEN_8821C(x) \ -+ (((x) & BIT_MASK_APPEND_MHDR_LEN_8821C) \ -+ << BIT_SHIFT_APPEND_MHDR_LEN_8821C) -+#define BITS_APPEND_MHDR_LEN_8821C \ -+ (BIT_MASK_APPEND_MHDR_LEN_8821C << BIT_SHIFT_APPEND_MHDR_LEN_8821C) -+#define BIT_CLEAR_APPEND_MHDR_LEN_8821C(x) ((x) & (~BITS_APPEND_MHDR_LEN_8821C)) -+#define BIT_GET_APPEND_MHDR_LEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_APPEND_MHDR_LEN_8821C) & \ -+ BIT_MASK_APPEND_MHDR_LEN_8821C) -+#define BIT_SET_APPEND_MHDR_LEN_8821C(x, v) \ -+ (BIT_CLEAR_APPEND_MHDR_LEN_8821C(x) | BIT_APPEND_MHDR_LEN_8821C(v)) -+ -+/* 2 REG_FW_STS_FILTER_8821C */ -+#define BIT_DATA_FW_STS_FILTER_8821C BIT(2) -+#define BIT_CTRL_FW_STS_FILTER_8821C BIT(1) -+#define BIT_MGNT_FW_STS_FILTER_8821C BIT(0) -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_TCR_8821C (TRANSMISSION CONFIGURATION REGISTER) */ -+#define BIT_WMAC_EN_RTS_ADDR_8821C BIT(31) -+#define BIT_WMAC_DISABLE_CCK_8821C BIT(30) -+#define BIT_WMAC_RAW_LEN_8821C BIT(29) -+#define BIT_WMAC_NOTX_IN_RXNDP_8821C BIT(28) -+#define BIT_WMAC_EN_EOF_8821C BIT(27) -+#define BIT_WMAC_BF_SEL_8821C BIT(26) -+#define BIT_WMAC_ANTMODE_SEL_8821C BIT(25) -+#define BIT_WMAC_TCRPWRMGT_HWCTL_8821C BIT(24) -+#define BIT_WMAC_SMOOTH_VAL_8821C BIT(23) -+#define BIT_FETCH_MPDU_AFTER_WSEC_RDY_8821C BIT(20) -+#define BIT_WMAC_TCR_EN_20MST_8821C BIT(19) -+#define BIT_WMAC_DIS_SIGTA_8821C BIT(18) -+#define BIT_WMAC_DIS_A2B0_8821C BIT(17) -+#define BIT_WMAC_MSK_SIGBCRC_8821C BIT(16) -+#define BIT_WMAC_TCR_ERRSTEN_3_8821C BIT(15) -+#define BIT_WMAC_TCR_ERRSTEN_2_8821C BIT(14) -+#define BIT_WMAC_TCR_ERRSTEN_1_8821C BIT(13) -+#define BIT_WMAC_TCR_ERRSTEN_0_8821C BIT(12) -+#define BIT_WMAC_TCR_TXSK_PERPKT_8821C BIT(11) -+#define BIT_ICV_8821C BIT(10) -+#define BIT_CFEND_FORMAT_8821C BIT(9) -+#define BIT_CRC_8821C BIT(8) -+#define BIT_PWRBIT_OW_EN_8821C BIT(7) -+#define BIT_PWR_ST_8821C BIT(6) -+#define BIT_WMAC_TCR_UPD_TIMIE_8821C BIT(5) -+#define BIT_WMAC_TCR_UPD_HGQMD_8821C BIT(4) -+#define BIT_VHTSIGA1_TXPS_8821C BIT(3) -+#define BIT_PAD_SEL_8821C BIT(2) -+#define BIT_DIS_GCLK_8821C BIT(1) -+ -+/* 2 REG_RCR_8821C (RECEIVE CONFIGURATION REGISTER) */ -+#define BIT_APP_FCS_8821C BIT(31) -+#define BIT_APP_MIC_8821C BIT(30) -+#define BIT_APP_ICV_8821C BIT(29) -+#define BIT_APP_PHYSTS_8821C BIT(28) -+#define BIT_APP_BASSN_8821C BIT(27) -+#define BIT_VHT_DACK_8821C BIT(26) -+#define BIT_TCPOFLD_EN_8821C BIT(25) -+#define BIT_ENMBID_8821C BIT(24) -+#define BIT_LSIGEN_8821C BIT(23) -+#define BIT_MFBEN_8821C BIT(22) -+#define BIT_DISCHKPPDLLEN_8821C BIT(21) -+#define BIT_PKTCTL_DLEN_8821C BIT(20) -+#define BIT_TIM_PARSER_EN_8821C BIT(18) -+#define BIT_BC_MD_EN_8821C BIT(17) -+#define BIT_UC_MD_EN_8821C BIT(16) -+#define BIT_RXSK_PERPKT_8821C BIT(15) -+#define BIT_HTC_LOC_CTRL_8821C BIT(14) -+#define BIT_RPFM_CAM_ENABLE_8821C BIT(12) -+#define BIT_TA_BCN_8821C BIT(11) -+#define BIT_DISDECMYPKT_8821C BIT(10) -+#define BIT_AICV_8821C BIT(9) -+#define BIT_ACRC32_8821C BIT(8) -+#define BIT_CBSSID_BCN_8821C BIT(7) -+#define BIT_CBSSID_DATA_8821C BIT(6) -+#define BIT_APWRMGT_8821C BIT(5) -+#define BIT_ADD3_8821C BIT(4) -+#define BIT_AB_8821C BIT(3) -+#define BIT_AM_8821C BIT(2) -+#define BIT_APM_8821C BIT(1) -+#define BIT_AAP_8821C BIT(0) -+ -+/* 2 REG_RX_PKT_LIMIT_8821C (RX PACKET LENGTH LIMIT REGISTER) */ -+ -+#define BIT_SHIFT_RXPKTLMT_8821C 0 -+#define BIT_MASK_RXPKTLMT_8821C 0x3f -+#define BIT_RXPKTLMT_8821C(x) \ -+ (((x) & BIT_MASK_RXPKTLMT_8821C) << BIT_SHIFT_RXPKTLMT_8821C) -+#define BITS_RXPKTLMT_8821C \ -+ (BIT_MASK_RXPKTLMT_8821C << BIT_SHIFT_RXPKTLMT_8821C) -+#define BIT_CLEAR_RXPKTLMT_8821C(x) ((x) & (~BITS_RXPKTLMT_8821C)) -+#define BIT_GET_RXPKTLMT_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXPKTLMT_8821C) & BIT_MASK_RXPKTLMT_8821C) -+#define BIT_SET_RXPKTLMT_8821C(x, v) \ -+ (BIT_CLEAR_RXPKTLMT_8821C(x) | BIT_RXPKTLMT_8821C(v)) -+ -+/* 2 REG_RX_DLK_TIME_8821C (RX DEADLOCK TIME REGISTER) */ -+ -+#define BIT_SHIFT_RX_DLK_TIME_8821C 0 -+#define BIT_MASK_RX_DLK_TIME_8821C 0xff -+#define BIT_RX_DLK_TIME_8821C(x) \ -+ (((x) & BIT_MASK_RX_DLK_TIME_8821C) << BIT_SHIFT_RX_DLK_TIME_8821C) -+#define BITS_RX_DLK_TIME_8821C \ -+ (BIT_MASK_RX_DLK_TIME_8821C << BIT_SHIFT_RX_DLK_TIME_8821C) -+#define BIT_CLEAR_RX_DLK_TIME_8821C(x) ((x) & (~BITS_RX_DLK_TIME_8821C)) -+#define BIT_GET_RX_DLK_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_DLK_TIME_8821C) & BIT_MASK_RX_DLK_TIME_8821C) -+#define BIT_SET_RX_DLK_TIME_8821C(x, v) \ -+ (BIT_CLEAR_RX_DLK_TIME_8821C(x) | BIT_RX_DLK_TIME_8821C(v)) -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RX_DRVINFO_SZ_8821C (RX DRIVER INFO SIZE REGISTER) */ -+#define BIT_PHYSTS_PER_PKT_MODE_8821C BIT(7) -+ -+#define BIT_SHIFT_DRVINFO_SZ_V1_8821C 0 -+#define BIT_MASK_DRVINFO_SZ_V1_8821C 0xf -+#define BIT_DRVINFO_SZ_V1_8821C(x) \ -+ (((x) & BIT_MASK_DRVINFO_SZ_V1_8821C) << BIT_SHIFT_DRVINFO_SZ_V1_8821C) -+#define BITS_DRVINFO_SZ_V1_8821C \ -+ (BIT_MASK_DRVINFO_SZ_V1_8821C << BIT_SHIFT_DRVINFO_SZ_V1_8821C) -+#define BIT_CLEAR_DRVINFO_SZ_V1_8821C(x) ((x) & (~BITS_DRVINFO_SZ_V1_8821C)) -+#define BIT_GET_DRVINFO_SZ_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DRVINFO_SZ_V1_8821C) & BIT_MASK_DRVINFO_SZ_V1_8821C) -+#define BIT_SET_DRVINFO_SZ_V1_8821C(x, v) \ -+ (BIT_CLEAR_DRVINFO_SZ_V1_8821C(x) | BIT_DRVINFO_SZ_V1_8821C(v)) -+ -+/* 2 REG_MACID_8821C (MAC ID REGISTER) */ -+ -+#define BIT_SHIFT_MACID_V1_8821C 0 -+#define BIT_MASK_MACID_V1_8821C 0xffffffffL -+#define BIT_MACID_V1_8821C(x) \ -+ (((x) & BIT_MASK_MACID_V1_8821C) << BIT_SHIFT_MACID_V1_8821C) -+#define BITS_MACID_V1_8821C \ -+ (BIT_MASK_MACID_V1_8821C << BIT_SHIFT_MACID_V1_8821C) -+#define BIT_CLEAR_MACID_V1_8821C(x) ((x) & (~BITS_MACID_V1_8821C)) -+#define BIT_GET_MACID_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID_V1_8821C) & BIT_MASK_MACID_V1_8821C) -+#define BIT_SET_MACID_V1_8821C(x, v) \ -+ (BIT_CLEAR_MACID_V1_8821C(x) | BIT_MACID_V1_8821C(v)) -+ -+/* 2 REG_MACID_H_8821C (MAC ID REGISTER) */ -+ -+#define BIT_SHIFT_MACID_H_V1_8821C 0 -+#define BIT_MASK_MACID_H_V1_8821C 0xffff -+#define BIT_MACID_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_MACID_H_V1_8821C) << BIT_SHIFT_MACID_H_V1_8821C) -+#define BITS_MACID_H_V1_8821C \ -+ (BIT_MASK_MACID_H_V1_8821C << BIT_SHIFT_MACID_H_V1_8821C) -+#define BIT_CLEAR_MACID_H_V1_8821C(x) ((x) & (~BITS_MACID_H_V1_8821C)) -+#define BIT_GET_MACID_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID_H_V1_8821C) & BIT_MASK_MACID_H_V1_8821C) -+#define BIT_SET_MACID_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_MACID_H_V1_8821C(x) | BIT_MACID_H_V1_8821C(v)) -+ -+/* 2 REG_BSSID_8821C (BSSID REGISTER) */ -+ -+#define BIT_SHIFT_BSSID_V1_8821C 0 -+#define BIT_MASK_BSSID_V1_8821C 0xffffffffL -+#define BIT_BSSID_V1_8821C(x) \ -+ (((x) & BIT_MASK_BSSID_V1_8821C) << BIT_SHIFT_BSSID_V1_8821C) -+#define BITS_BSSID_V1_8821C \ -+ (BIT_MASK_BSSID_V1_8821C << BIT_SHIFT_BSSID_V1_8821C) -+#define BIT_CLEAR_BSSID_V1_8821C(x) ((x) & (~BITS_BSSID_V1_8821C)) -+#define BIT_GET_BSSID_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BSSID_V1_8821C) & BIT_MASK_BSSID_V1_8821C) -+#define BIT_SET_BSSID_V1_8821C(x, v) \ -+ (BIT_CLEAR_BSSID_V1_8821C(x) | BIT_BSSID_V1_8821C(v)) -+ -+/* 2 REG_BSSID_H_8821C (BSSID REGISTER) */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+#define BIT_SHIFT_BSSID_H_V1_8821C 0 -+#define BIT_MASK_BSSID_H_V1_8821C 0xffff -+#define BIT_BSSID_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_BSSID_H_V1_8821C) << BIT_SHIFT_BSSID_H_V1_8821C) -+#define BITS_BSSID_H_V1_8821C \ -+ (BIT_MASK_BSSID_H_V1_8821C << BIT_SHIFT_BSSID_H_V1_8821C) -+#define BIT_CLEAR_BSSID_H_V1_8821C(x) ((x) & (~BITS_BSSID_H_V1_8821C)) -+#define BIT_GET_BSSID_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BSSID_H_V1_8821C) & BIT_MASK_BSSID_H_V1_8821C) -+#define BIT_SET_BSSID_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_BSSID_H_V1_8821C(x) | BIT_BSSID_H_V1_8821C(v)) -+ -+/* 2 REG_MAR_8821C (MULTICAST ADDRESS REGISTER) */ -+ -+#define BIT_SHIFT_MAR_V1_8821C 0 -+#define BIT_MASK_MAR_V1_8821C 0xffffffffL -+#define BIT_MAR_V1_8821C(x) \ -+ (((x) & BIT_MASK_MAR_V1_8821C) << BIT_SHIFT_MAR_V1_8821C) -+#define BITS_MAR_V1_8821C (BIT_MASK_MAR_V1_8821C << BIT_SHIFT_MAR_V1_8821C) -+#define BIT_CLEAR_MAR_V1_8821C(x) ((x) & (~BITS_MAR_V1_8821C)) -+#define BIT_GET_MAR_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MAR_V1_8821C) & BIT_MASK_MAR_V1_8821C) -+#define BIT_SET_MAR_V1_8821C(x, v) \ -+ (BIT_CLEAR_MAR_V1_8821C(x) | BIT_MAR_V1_8821C(v)) -+ -+/* 2 REG_MAR_H_8821C (MULTICAST ADDRESS REGISTER) */ -+ -+#define BIT_SHIFT_MAR_H_V1_8821C 0 -+#define BIT_MASK_MAR_H_V1_8821C 0xffffffffL -+#define BIT_MAR_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_MAR_H_V1_8821C) << BIT_SHIFT_MAR_H_V1_8821C) -+#define BITS_MAR_H_V1_8821C \ -+ (BIT_MASK_MAR_H_V1_8821C << BIT_SHIFT_MAR_H_V1_8821C) -+#define BIT_CLEAR_MAR_H_V1_8821C(x) ((x) & (~BITS_MAR_H_V1_8821C)) -+#define BIT_GET_MAR_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MAR_H_V1_8821C) & BIT_MASK_MAR_H_V1_8821C) -+#define BIT_SET_MAR_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_MAR_H_V1_8821C(x) | BIT_MAR_H_V1_8821C(v)) -+ -+/* 2 REG_MBIDCAMCFG_1_8821C (MBSSID CAM CONFIGURATION REGISTER) */ -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_L_8821C 0 -+#define BIT_MASK_MBIDCAM_RWDATA_L_8821C 0xffffffffL -+#define BIT_MBIDCAM_RWDATA_L_8821C(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_L_8821C) \ -+ << BIT_SHIFT_MBIDCAM_RWDATA_L_8821C) -+#define BITS_MBIDCAM_RWDATA_L_8821C \ -+ (BIT_MASK_MBIDCAM_RWDATA_L_8821C << BIT_SHIFT_MBIDCAM_RWDATA_L_8821C) -+#define BIT_CLEAR_MBIDCAM_RWDATA_L_8821C(x) \ -+ ((x) & (~BITS_MBIDCAM_RWDATA_L_8821C)) -+#define BIT_GET_MBIDCAM_RWDATA_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_L_8821C) & \ -+ BIT_MASK_MBIDCAM_RWDATA_L_8821C) -+#define BIT_SET_MBIDCAM_RWDATA_L_8821C(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_L_8821C(x) | BIT_MBIDCAM_RWDATA_L_8821C(v)) -+ -+/* 2 REG_MBIDCAMCFG_2_8821C (MBSSID CAM CONFIGURATION REGISTER) */ -+#define BIT_MBIDCAM_POLL_8821C BIT(31) -+#define BIT_MBIDCAM_WT_EN_8821C BIT(30) -+ -+#define BIT_SHIFT_MBIDCAM_ADDR_8821C 24 -+#define BIT_MASK_MBIDCAM_ADDR_8821C 0x1f -+#define BIT_MBIDCAM_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_MBIDCAM_ADDR_8821C) << BIT_SHIFT_MBIDCAM_ADDR_8821C) -+#define BITS_MBIDCAM_ADDR_8821C \ -+ (BIT_MASK_MBIDCAM_ADDR_8821C << BIT_SHIFT_MBIDCAM_ADDR_8821C) -+#define BIT_CLEAR_MBIDCAM_ADDR_8821C(x) ((x) & (~BITS_MBIDCAM_ADDR_8821C)) -+#define BIT_GET_MBIDCAM_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_ADDR_8821C) & BIT_MASK_MBIDCAM_ADDR_8821C) -+#define BIT_SET_MBIDCAM_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_MBIDCAM_ADDR_8821C(x) | BIT_MBIDCAM_ADDR_8821C(v)) -+ -+#define BIT_MBIDCAM_VALID_8821C BIT(23) -+#define BIT_LSIC_TXOP_EN_8821C BIT(17) -+#define BIT_CTS_EN_8821C BIT(16) -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_H_8821C 0 -+#define BIT_MASK_MBIDCAM_RWDATA_H_8821C 0xffff -+#define BIT_MBIDCAM_RWDATA_H_8821C(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_H_8821C) \ -+ << BIT_SHIFT_MBIDCAM_RWDATA_H_8821C) -+#define BITS_MBIDCAM_RWDATA_H_8821C \ -+ (BIT_MASK_MBIDCAM_RWDATA_H_8821C << BIT_SHIFT_MBIDCAM_RWDATA_H_8821C) -+#define BIT_CLEAR_MBIDCAM_RWDATA_H_8821C(x) \ -+ ((x) & (~BITS_MBIDCAM_RWDATA_H_8821C)) -+#define BIT_GET_MBIDCAM_RWDATA_H_8821C(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_H_8821C) & \ -+ BIT_MASK_MBIDCAM_RWDATA_H_8821C) -+#define BIT_SET_MBIDCAM_RWDATA_H_8821C(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_H_8821C(x) | BIT_MBIDCAM_RWDATA_H_8821C(v)) -+ -+/* 2 REG_WMAC_TCR_TSFT_OFS_8821C */ -+ -+#define BIT_SHIFT_WMAC_TCR_TSFT_OFS_8821C 0 -+#define BIT_MASK_WMAC_TCR_TSFT_OFS_8821C 0xffff -+#define BIT_WMAC_TCR_TSFT_OFS_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_TCR_TSFT_OFS_8821C) \ -+ << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8821C) -+#define BITS_WMAC_TCR_TSFT_OFS_8821C \ -+ (BIT_MASK_WMAC_TCR_TSFT_OFS_8821C << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8821C) -+#define BIT_CLEAR_WMAC_TCR_TSFT_OFS_8821C(x) \ -+ ((x) & (~BITS_WMAC_TCR_TSFT_OFS_8821C)) -+#define BIT_GET_WMAC_TCR_TSFT_OFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TCR_TSFT_OFS_8821C) & \ -+ BIT_MASK_WMAC_TCR_TSFT_OFS_8821C) -+#define BIT_SET_WMAC_TCR_TSFT_OFS_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_TCR_TSFT_OFS_8821C(x) | BIT_WMAC_TCR_TSFT_OFS_8821C(v)) -+ -+/* 2 REG_UDF_THSD_8821C */ -+ -+#define BIT_SHIFT_UDF_THSD_8821C 0 -+#define BIT_MASK_UDF_THSD_8821C 0xff -+#define BIT_UDF_THSD_8821C(x) \ -+ (((x) & BIT_MASK_UDF_THSD_8821C) << BIT_SHIFT_UDF_THSD_8821C) -+#define BITS_UDF_THSD_8821C \ -+ (BIT_MASK_UDF_THSD_8821C << BIT_SHIFT_UDF_THSD_8821C) -+#define BIT_CLEAR_UDF_THSD_8821C(x) ((x) & (~BITS_UDF_THSD_8821C)) -+#define BIT_GET_UDF_THSD_8821C(x) \ -+ (((x) >> BIT_SHIFT_UDF_THSD_8821C) & BIT_MASK_UDF_THSD_8821C) -+#define BIT_SET_UDF_THSD_8821C(x, v) \ -+ (BIT_CLEAR_UDF_THSD_8821C(x) | BIT_UDF_THSD_8821C(v)) -+ -+/* 2 REG_ZLD_NUM_8821C */ -+ -+#define BIT_SHIFT_ZLD_NUM_8821C 0 -+#define BIT_MASK_ZLD_NUM_8821C 0xff -+#define BIT_ZLD_NUM_8821C(x) \ -+ (((x) & BIT_MASK_ZLD_NUM_8821C) << BIT_SHIFT_ZLD_NUM_8821C) -+#define BITS_ZLD_NUM_8821C (BIT_MASK_ZLD_NUM_8821C << BIT_SHIFT_ZLD_NUM_8821C) -+#define BIT_CLEAR_ZLD_NUM_8821C(x) ((x) & (~BITS_ZLD_NUM_8821C)) -+#define BIT_GET_ZLD_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_ZLD_NUM_8821C) & BIT_MASK_ZLD_NUM_8821C) -+#define BIT_SET_ZLD_NUM_8821C(x, v) \ -+ (BIT_CLEAR_ZLD_NUM_8821C(x) | BIT_ZLD_NUM_8821C(v)) -+ -+/* 2 REG_STMP_THSD_8821C */ -+ -+#define BIT_SHIFT_STMP_THSD_8821C 0 -+#define BIT_MASK_STMP_THSD_8821C 0xff -+#define BIT_STMP_THSD_8821C(x) \ -+ (((x) & BIT_MASK_STMP_THSD_8821C) << BIT_SHIFT_STMP_THSD_8821C) -+#define BITS_STMP_THSD_8821C \ -+ (BIT_MASK_STMP_THSD_8821C << BIT_SHIFT_STMP_THSD_8821C) -+#define BIT_CLEAR_STMP_THSD_8821C(x) ((x) & (~BITS_STMP_THSD_8821C)) -+#define BIT_GET_STMP_THSD_8821C(x) \ -+ (((x) >> BIT_SHIFT_STMP_THSD_8821C) & BIT_MASK_STMP_THSD_8821C) -+#define BIT_SET_STMP_THSD_8821C(x, v) \ -+ (BIT_CLEAR_STMP_THSD_8821C(x) | BIT_STMP_THSD_8821C(v)) -+ -+/* 2 REG_WMAC_TXTIMEOUT_8821C */ -+ -+#define BIT_SHIFT_WMAC_TXTIMEOUT_8821C 0 -+#define BIT_MASK_WMAC_TXTIMEOUT_8821C 0xff -+#define BIT_WMAC_TXTIMEOUT_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_TXTIMEOUT_8821C) \ -+ << BIT_SHIFT_WMAC_TXTIMEOUT_8821C) -+#define BITS_WMAC_TXTIMEOUT_8821C \ -+ (BIT_MASK_WMAC_TXTIMEOUT_8821C << BIT_SHIFT_WMAC_TXTIMEOUT_8821C) -+#define BIT_CLEAR_WMAC_TXTIMEOUT_8821C(x) ((x) & (~BITS_WMAC_TXTIMEOUT_8821C)) -+#define BIT_GET_WMAC_TXTIMEOUT_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXTIMEOUT_8821C) & \ -+ BIT_MASK_WMAC_TXTIMEOUT_8821C) -+#define BIT_SET_WMAC_TXTIMEOUT_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_TXTIMEOUT_8821C(x) | BIT_WMAC_TXTIMEOUT_8821C(v)) -+ -+/* 2 REG_MCU_TEST_2_V1_8821C */ -+ -+#define BIT_SHIFT_MCU_RSVD_2_V1_8821C 0 -+#define BIT_MASK_MCU_RSVD_2_V1_8821C 0xffff -+#define BIT_MCU_RSVD_2_V1_8821C(x) \ -+ (((x) & BIT_MASK_MCU_RSVD_2_V1_8821C) << BIT_SHIFT_MCU_RSVD_2_V1_8821C) -+#define BITS_MCU_RSVD_2_V1_8821C \ -+ (BIT_MASK_MCU_RSVD_2_V1_8821C << BIT_SHIFT_MCU_RSVD_2_V1_8821C) -+#define BIT_CLEAR_MCU_RSVD_2_V1_8821C(x) ((x) & (~BITS_MCU_RSVD_2_V1_8821C)) -+#define BIT_GET_MCU_RSVD_2_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MCU_RSVD_2_V1_8821C) & BIT_MASK_MCU_RSVD_2_V1_8821C) -+#define BIT_SET_MCU_RSVD_2_V1_8821C(x, v) \ -+ (BIT_CLEAR_MCU_RSVD_2_V1_8821C(x) | BIT_MCU_RSVD_2_V1_8821C(v)) -+ -+/* 2 REG_USTIME_EDCA_8821C (US TIME TUNING FOR EDCA REGISTER) */ -+ -+#define BIT_SHIFT_USTIME_EDCA_8821C 0 -+#define BIT_MASK_USTIME_EDCA_8821C 0xff -+#define BIT_USTIME_EDCA_8821C(x) \ -+ (((x) & BIT_MASK_USTIME_EDCA_8821C) << BIT_SHIFT_USTIME_EDCA_8821C) -+#define BITS_USTIME_EDCA_8821C \ -+ (BIT_MASK_USTIME_EDCA_8821C << BIT_SHIFT_USTIME_EDCA_8821C) -+#define BIT_CLEAR_USTIME_EDCA_8821C(x) ((x) & (~BITS_USTIME_EDCA_8821C)) -+#define BIT_GET_USTIME_EDCA_8821C(x) \ -+ (((x) >> BIT_SHIFT_USTIME_EDCA_8821C) & BIT_MASK_USTIME_EDCA_8821C) -+#define BIT_SET_USTIME_EDCA_8821C(x, v) \ -+ (BIT_CLEAR_USTIME_EDCA_8821C(x) | BIT_USTIME_EDCA_8821C(v)) -+ -+/* 2 REG_ACKTO_CCK_8821C (ACK TIMEOUT REGISTER FOR CCK RATE) */ -+ -+#define BIT_SHIFT_ACKTO_CCK_8821C 0 -+#define BIT_MASK_ACKTO_CCK_8821C 0xff -+#define BIT_ACKTO_CCK_8821C(x) \ -+ (((x) & BIT_MASK_ACKTO_CCK_8821C) << BIT_SHIFT_ACKTO_CCK_8821C) -+#define BITS_ACKTO_CCK_8821C \ -+ (BIT_MASK_ACKTO_CCK_8821C << BIT_SHIFT_ACKTO_CCK_8821C) -+#define BIT_CLEAR_ACKTO_CCK_8821C(x) ((x) & (~BITS_ACKTO_CCK_8821C)) -+#define BIT_GET_ACKTO_CCK_8821C(x) \ -+ (((x) >> BIT_SHIFT_ACKTO_CCK_8821C) & BIT_MASK_ACKTO_CCK_8821C) -+#define BIT_SET_ACKTO_CCK_8821C(x, v) \ -+ (BIT_CLEAR_ACKTO_CCK_8821C(x) | BIT_ACKTO_CCK_8821C(v)) -+ -+/* 2 REG_MAC_SPEC_SIFS_8821C (SPECIFICATION SIFS REGISTER) */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_8821C 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_8821C 0xff -+#define BIT_SPEC_SIFS_OFDM_8821C(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_8821C) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_8821C) -+#define BITS_SPEC_SIFS_OFDM_8821C \ -+ (BIT_MASK_SPEC_SIFS_OFDM_8821C << BIT_SHIFT_SPEC_SIFS_OFDM_8821C) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_8821C(x) ((x) & (~BITS_SPEC_SIFS_OFDM_8821C)) -+#define BIT_GET_SPEC_SIFS_OFDM_8821C(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_8821C) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_8821C) -+#define BIT_SET_SPEC_SIFS_OFDM_8821C(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_8821C(x) | BIT_SPEC_SIFS_OFDM_8821C(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_8821C 0 -+#define BIT_MASK_SPEC_SIFS_CCK_8821C 0xff -+#define BIT_SPEC_SIFS_CCK_8821C(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_8821C) << BIT_SHIFT_SPEC_SIFS_CCK_8821C) -+#define BITS_SPEC_SIFS_CCK_8821C \ -+ (BIT_MASK_SPEC_SIFS_CCK_8821C << BIT_SHIFT_SPEC_SIFS_CCK_8821C) -+#define BIT_CLEAR_SPEC_SIFS_CCK_8821C(x) ((x) & (~BITS_SPEC_SIFS_CCK_8821C)) -+#define BIT_GET_SPEC_SIFS_CCK_8821C(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_8821C) & BIT_MASK_SPEC_SIFS_CCK_8821C) -+#define BIT_SET_SPEC_SIFS_CCK_8821C(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_8821C(x) | BIT_SPEC_SIFS_CCK_8821C(v)) -+ -+/* 2 REG_RESP_SIFS_CCK_8821C (RESPONSE SIFS FOR CCK REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_CCK_8821C 8 -+#define BIT_MASK_SIFS_R2T_CCK_8821C 0xff -+#define BIT_SIFS_R2T_CCK_8821C(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_CCK_8821C) << BIT_SHIFT_SIFS_R2T_CCK_8821C) -+#define BITS_SIFS_R2T_CCK_8821C \ -+ (BIT_MASK_SIFS_R2T_CCK_8821C << BIT_SHIFT_SIFS_R2T_CCK_8821C) -+#define BIT_CLEAR_SIFS_R2T_CCK_8821C(x) ((x) & (~BITS_SIFS_R2T_CCK_8821C)) -+#define BIT_GET_SIFS_R2T_CCK_8821C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_CCK_8821C) & BIT_MASK_SIFS_R2T_CCK_8821C) -+#define BIT_SET_SIFS_R2T_CCK_8821C(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_CCK_8821C(x) | BIT_SIFS_R2T_CCK_8821C(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_CCK_8821C 0 -+#define BIT_MASK_SIFS_T2T_CCK_8821C 0xff -+#define BIT_SIFS_T2T_CCK_8821C(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_CCK_8821C) << BIT_SHIFT_SIFS_T2T_CCK_8821C) -+#define BITS_SIFS_T2T_CCK_8821C \ -+ (BIT_MASK_SIFS_T2T_CCK_8821C << BIT_SHIFT_SIFS_T2T_CCK_8821C) -+#define BIT_CLEAR_SIFS_T2T_CCK_8821C(x) ((x) & (~BITS_SIFS_T2T_CCK_8821C)) -+#define BIT_GET_SIFS_T2T_CCK_8821C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_CCK_8821C) & BIT_MASK_SIFS_T2T_CCK_8821C) -+#define BIT_SET_SIFS_T2T_CCK_8821C(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_CCK_8821C(x) | BIT_SIFS_T2T_CCK_8821C(v)) -+ -+/* 2 REG_RESP_SIFS_OFDM_8821C (RESPONSE SIFS FOR OFDM REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_OFDM_8821C 8 -+#define BIT_MASK_SIFS_R2T_OFDM_8821C 0xff -+#define BIT_SIFS_R2T_OFDM_8821C(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_OFDM_8821C) << BIT_SHIFT_SIFS_R2T_OFDM_8821C) -+#define BITS_SIFS_R2T_OFDM_8821C \ -+ (BIT_MASK_SIFS_R2T_OFDM_8821C << BIT_SHIFT_SIFS_R2T_OFDM_8821C) -+#define BIT_CLEAR_SIFS_R2T_OFDM_8821C(x) ((x) & (~BITS_SIFS_R2T_OFDM_8821C)) -+#define BIT_GET_SIFS_R2T_OFDM_8821C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_OFDM_8821C) & BIT_MASK_SIFS_R2T_OFDM_8821C) -+#define BIT_SET_SIFS_R2T_OFDM_8821C(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_OFDM_8821C(x) | BIT_SIFS_R2T_OFDM_8821C(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_OFDM_8821C 0 -+#define BIT_MASK_SIFS_T2T_OFDM_8821C 0xff -+#define BIT_SIFS_T2T_OFDM_8821C(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_OFDM_8821C) << BIT_SHIFT_SIFS_T2T_OFDM_8821C) -+#define BITS_SIFS_T2T_OFDM_8821C \ -+ (BIT_MASK_SIFS_T2T_OFDM_8821C << BIT_SHIFT_SIFS_T2T_OFDM_8821C) -+#define BIT_CLEAR_SIFS_T2T_OFDM_8821C(x) ((x) & (~BITS_SIFS_T2T_OFDM_8821C)) -+#define BIT_GET_SIFS_T2T_OFDM_8821C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_OFDM_8821C) & BIT_MASK_SIFS_T2T_OFDM_8821C) -+#define BIT_SET_SIFS_T2T_OFDM_8821C(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_OFDM_8821C(x) | BIT_SIFS_T2T_OFDM_8821C(v)) -+ -+/* 2 REG_ACKTO_8821C (ACK TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_ACKTO_8821C 0 -+#define BIT_MASK_ACKTO_8821C 0xff -+#define BIT_ACKTO_8821C(x) \ -+ (((x) & BIT_MASK_ACKTO_8821C) << BIT_SHIFT_ACKTO_8821C) -+#define BITS_ACKTO_8821C (BIT_MASK_ACKTO_8821C << BIT_SHIFT_ACKTO_8821C) -+#define BIT_CLEAR_ACKTO_8821C(x) ((x) & (~BITS_ACKTO_8821C)) -+#define BIT_GET_ACKTO_8821C(x) \ -+ (((x) >> BIT_SHIFT_ACKTO_8821C) & BIT_MASK_ACKTO_8821C) -+#define BIT_SET_ACKTO_8821C(x, v) \ -+ (BIT_CLEAR_ACKTO_8821C(x) | BIT_ACKTO_8821C(v)) -+ -+/* 2 REG_CTS2TO_8821C (CTS2 TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_CTS2TO_8821C 0 -+#define BIT_MASK_CTS2TO_8821C 0xff -+#define BIT_CTS2TO_8821C(x) \ -+ (((x) & BIT_MASK_CTS2TO_8821C) << BIT_SHIFT_CTS2TO_8821C) -+#define BITS_CTS2TO_8821C (BIT_MASK_CTS2TO_8821C << BIT_SHIFT_CTS2TO_8821C) -+#define BIT_CLEAR_CTS2TO_8821C(x) ((x) & (~BITS_CTS2TO_8821C)) -+#define BIT_GET_CTS2TO_8821C(x) \ -+ (((x) >> BIT_SHIFT_CTS2TO_8821C) & BIT_MASK_CTS2TO_8821C) -+#define BIT_SET_CTS2TO_8821C(x, v) \ -+ (BIT_CLEAR_CTS2TO_8821C(x) | BIT_CTS2TO_8821C(v)) -+ -+/* 2 REG_EIFS_8821C (EIFS REGISTER) */ -+ -+#define BIT_SHIFT_EIFS_8821C 0 -+#define BIT_MASK_EIFS_8821C 0xffff -+#define BIT_EIFS_8821C(x) (((x) & BIT_MASK_EIFS_8821C) << BIT_SHIFT_EIFS_8821C) -+#define BITS_EIFS_8821C (BIT_MASK_EIFS_8821C << BIT_SHIFT_EIFS_8821C) -+#define BIT_CLEAR_EIFS_8821C(x) ((x) & (~BITS_EIFS_8821C)) -+#define BIT_GET_EIFS_8821C(x) \ -+ (((x) >> BIT_SHIFT_EIFS_8821C) & BIT_MASK_EIFS_8821C) -+#define BIT_SET_EIFS_8821C(x, v) (BIT_CLEAR_EIFS_8821C(x) | BIT_EIFS_8821C(v)) -+ -+/* 2 REG_RPFM_MAP0_8821C */ -+#define BIT_MGT_RPFM15EN_8821C BIT(15) -+#define BIT_MGT_RPFM14EN_8821C BIT(14) -+#define BIT_MGT_RPFM13EN_8821C BIT(13) -+#define BIT_MGT_RPFM12EN_8821C BIT(12) -+#define BIT_MGT_RPFM11EN_8821C BIT(11) -+#define BIT_MGT_RPFM10EN_8821C BIT(10) -+#define BIT_MGT_RPFM9EN_8821C BIT(9) -+#define BIT_MGT_RPFM8EN_8821C BIT(8) -+#define BIT_MGT_RPFM7EN_8821C BIT(7) -+#define BIT_MGT_RPFM6EN_8821C BIT(6) -+#define BIT_MGT_RPFM5EN_8821C BIT(5) -+#define BIT_MGT_RPFM4EN_8821C BIT(4) -+#define BIT_MGT_RPFM3EN_8821C BIT(3) -+#define BIT_MGT_RPFM2EN_8821C BIT(2) -+#define BIT_MGT_RPFM1EN_8821C BIT(1) -+#define BIT_MGT_RPFM0EN_8821C BIT(0) -+ -+/* 2 REG_RPFM_MAP1_V1_8821C */ -+#define BIT_DATA_RPFM15EN_8821C BIT(15) -+#define BIT_DATA_RPFM14EN_8821C BIT(14) -+#define BIT_DATA_RPFM13EN_8821C BIT(13) -+#define BIT_DATA_RPFM12EN_8821C BIT(12) -+#define BIT_DATA_RPFM11EN_8821C BIT(11) -+#define BIT_DATA_RPFM10EN_8821C BIT(10) -+#define BIT_DATA_RPFM9EN_8821C BIT(9) -+#define BIT_DATA_RPFM8EN_8821C BIT(8) -+#define BIT_DATA_RPFM7EN_8821C BIT(7) -+#define BIT_DATA_RPFM6EN_8821C BIT(6) -+#define BIT_DATA_RPFM5EN_8821C BIT(5) -+#define BIT_DATA_RPFM4EN_8821C BIT(4) -+#define BIT_DATA_RPFM3EN_8821C BIT(3) -+#define BIT_DATA_RPFM2EN_8821C BIT(2) -+#define BIT_DATA_RPFM1EN_8821C BIT(1) -+#define BIT_DATA_RPFM0EN_8821C BIT(0) -+ -+/* 2 REG_RPFM_CAM_CMD_8821C (RX PAYLOAD FRAME MASK CAM COMMAND REGISTER) */ -+#define BIT_RPFM_CAM_POLLING_8821C BIT(31) -+#define BIT_RPFM_CAM_CLR_8821C BIT(30) -+#define BIT_RPFM_CAM_WE_8821C BIT(16) -+ -+#define BIT_SHIFT_RPFM_CAM_ADDR_8821C 0 -+#define BIT_MASK_RPFM_CAM_ADDR_8821C 0x7f -+#define BIT_RPFM_CAM_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_RPFM_CAM_ADDR_8821C) << BIT_SHIFT_RPFM_CAM_ADDR_8821C) -+#define BITS_RPFM_CAM_ADDR_8821C \ -+ (BIT_MASK_RPFM_CAM_ADDR_8821C << BIT_SHIFT_RPFM_CAM_ADDR_8821C) -+#define BIT_CLEAR_RPFM_CAM_ADDR_8821C(x) ((x) & (~BITS_RPFM_CAM_ADDR_8821C)) -+#define BIT_GET_RPFM_CAM_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_RPFM_CAM_ADDR_8821C) & BIT_MASK_RPFM_CAM_ADDR_8821C) -+#define BIT_SET_RPFM_CAM_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_RPFM_CAM_ADDR_8821C(x) | BIT_RPFM_CAM_ADDR_8821C(v)) -+ -+/* 2 REG_RPFM_CAM_RWD_8821C (ACK TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_RPFM_CAM_RWD_8821C 0 -+#define BIT_MASK_RPFM_CAM_RWD_8821C 0xffffffffL -+#define BIT_RPFM_CAM_RWD_8821C(x) \ -+ (((x) & BIT_MASK_RPFM_CAM_RWD_8821C) << BIT_SHIFT_RPFM_CAM_RWD_8821C) -+#define BITS_RPFM_CAM_RWD_8821C \ -+ (BIT_MASK_RPFM_CAM_RWD_8821C << BIT_SHIFT_RPFM_CAM_RWD_8821C) -+#define BIT_CLEAR_RPFM_CAM_RWD_8821C(x) ((x) & (~BITS_RPFM_CAM_RWD_8821C)) -+#define BIT_GET_RPFM_CAM_RWD_8821C(x) \ -+ (((x) >> BIT_SHIFT_RPFM_CAM_RWD_8821C) & BIT_MASK_RPFM_CAM_RWD_8821C) -+#define BIT_SET_RPFM_CAM_RWD_8821C(x, v) \ -+ (BIT_CLEAR_RPFM_CAM_RWD_8821C(x) | BIT_RPFM_CAM_RWD_8821C(v)) -+ -+/* 2 REG_NAV_CTRL_8821C (NAV CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_NAV_UPPER_8821C 16 -+#define BIT_MASK_NAV_UPPER_8821C 0xff -+#define BIT_NAV_UPPER_8821C(x) \ -+ (((x) & BIT_MASK_NAV_UPPER_8821C) << BIT_SHIFT_NAV_UPPER_8821C) -+#define BITS_NAV_UPPER_8821C \ -+ (BIT_MASK_NAV_UPPER_8821C << BIT_SHIFT_NAV_UPPER_8821C) -+#define BIT_CLEAR_NAV_UPPER_8821C(x) ((x) & (~BITS_NAV_UPPER_8821C)) -+#define BIT_GET_NAV_UPPER_8821C(x) \ -+ (((x) >> BIT_SHIFT_NAV_UPPER_8821C) & BIT_MASK_NAV_UPPER_8821C) -+#define BIT_SET_NAV_UPPER_8821C(x, v) \ -+ (BIT_CLEAR_NAV_UPPER_8821C(x) | BIT_NAV_UPPER_8821C(v)) -+ -+#define BIT_SHIFT_RXMYRTS_NAV_8821C 8 -+#define BIT_MASK_RXMYRTS_NAV_8821C 0xf -+#define BIT_RXMYRTS_NAV_8821C(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_8821C) << BIT_SHIFT_RXMYRTS_NAV_8821C) -+#define BITS_RXMYRTS_NAV_8821C \ -+ (BIT_MASK_RXMYRTS_NAV_8821C << BIT_SHIFT_RXMYRTS_NAV_8821C) -+#define BIT_CLEAR_RXMYRTS_NAV_8821C(x) ((x) & (~BITS_RXMYRTS_NAV_8821C)) -+#define BIT_GET_RXMYRTS_NAV_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_8821C) & BIT_MASK_RXMYRTS_NAV_8821C) -+#define BIT_SET_RXMYRTS_NAV_8821C(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_8821C(x) | BIT_RXMYRTS_NAV_8821C(v)) -+ -+#define BIT_SHIFT_RTSRST_8821C 0 -+#define BIT_MASK_RTSRST_8821C 0xff -+#define BIT_RTSRST_8821C(x) \ -+ (((x) & BIT_MASK_RTSRST_8821C) << BIT_SHIFT_RTSRST_8821C) -+#define BITS_RTSRST_8821C (BIT_MASK_RTSRST_8821C << BIT_SHIFT_RTSRST_8821C) -+#define BIT_CLEAR_RTSRST_8821C(x) ((x) & (~BITS_RTSRST_8821C)) -+#define BIT_GET_RTSRST_8821C(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_8821C) & BIT_MASK_RTSRST_8821C) -+#define BIT_SET_RTSRST_8821C(x, v) \ -+ (BIT_CLEAR_RTSRST_8821C(x) | BIT_RTSRST_8821C(v)) -+ -+/* 2 REG_BACAMCMD_8821C (BLOCK ACK CAM COMMAND REGISTER) */ -+#define BIT_BACAM_POLL_8821C BIT(31) -+#define BIT_BACAM_RST_8821C BIT(17) -+#define BIT_BACAM_RW_8821C BIT(16) -+ -+#define BIT_SHIFT_TXSBM_8821C 14 -+#define BIT_MASK_TXSBM_8821C 0x3 -+#define BIT_TXSBM_8821C(x) \ -+ (((x) & BIT_MASK_TXSBM_8821C) << BIT_SHIFT_TXSBM_8821C) -+#define BITS_TXSBM_8821C (BIT_MASK_TXSBM_8821C << BIT_SHIFT_TXSBM_8821C) -+#define BIT_CLEAR_TXSBM_8821C(x) ((x) & (~BITS_TXSBM_8821C)) -+#define BIT_GET_TXSBM_8821C(x) \ -+ (((x) >> BIT_SHIFT_TXSBM_8821C) & BIT_MASK_TXSBM_8821C) -+#define BIT_SET_TXSBM_8821C(x, v) \ -+ (BIT_CLEAR_TXSBM_8821C(x) | BIT_TXSBM_8821C(v)) -+ -+#define BIT_SHIFT_BACAM_ADDR_8821C 0 -+#define BIT_MASK_BACAM_ADDR_8821C 0x3f -+#define BIT_BACAM_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_BACAM_ADDR_8821C) << BIT_SHIFT_BACAM_ADDR_8821C) -+#define BITS_BACAM_ADDR_8821C \ -+ (BIT_MASK_BACAM_ADDR_8821C << BIT_SHIFT_BACAM_ADDR_8821C) -+#define BIT_CLEAR_BACAM_ADDR_8821C(x) ((x) & (~BITS_BACAM_ADDR_8821C)) -+#define BIT_GET_BACAM_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_BACAM_ADDR_8821C) & BIT_MASK_BACAM_ADDR_8821C) -+#define BIT_SET_BACAM_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_BACAM_ADDR_8821C(x) | BIT_BACAM_ADDR_8821C(v)) -+ -+/* 2 REG_BACAMCONTENT_8821C (BLOCK ACK CAM CONTENT REGISTER) */ -+ -+#define BIT_SHIFT_BA_CONTENT_L_8821C 0 -+#define BIT_MASK_BA_CONTENT_L_8821C 0xffffffffL -+#define BIT_BA_CONTENT_L_8821C(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_L_8821C) << BIT_SHIFT_BA_CONTENT_L_8821C) -+#define BITS_BA_CONTENT_L_8821C \ -+ (BIT_MASK_BA_CONTENT_L_8821C << BIT_SHIFT_BA_CONTENT_L_8821C) -+#define BIT_CLEAR_BA_CONTENT_L_8821C(x) ((x) & (~BITS_BA_CONTENT_L_8821C)) -+#define BIT_GET_BA_CONTENT_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_L_8821C) & BIT_MASK_BA_CONTENT_L_8821C) -+#define BIT_SET_BA_CONTENT_L_8821C(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_L_8821C(x) | BIT_BA_CONTENT_L_8821C(v)) -+ -+/* 2 REG_BACAMCONTENT_H_8821C (BLOCK ACK CAM CONTENT REGISTER) */ -+ -+#define BIT_SHIFT_BA_CONTENT_H_8821C 0 -+#define BIT_MASK_BA_CONTENT_H_8821C 0xffffffffL -+#define BIT_BA_CONTENT_H_8821C(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_H_8821C) << BIT_SHIFT_BA_CONTENT_H_8821C) -+#define BITS_BA_CONTENT_H_8821C \ -+ (BIT_MASK_BA_CONTENT_H_8821C << BIT_SHIFT_BA_CONTENT_H_8821C) -+#define BIT_CLEAR_BA_CONTENT_H_8821C(x) ((x) & (~BITS_BA_CONTENT_H_8821C)) -+#define BIT_GET_BA_CONTENT_H_8821C(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_H_8821C) & BIT_MASK_BA_CONTENT_H_8821C) -+#define BIT_SET_BA_CONTENT_H_8821C(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_H_8821C(x) | BIT_BA_CONTENT_H_8821C(v)) -+ -+/* 2 REG_LBDLY_8821C (LOOPBACK DELAY REGISTER) */ -+ -+#define BIT_SHIFT_LBDLY_8821C 0 -+#define BIT_MASK_LBDLY_8821C 0x1f -+#define BIT_LBDLY_8821C(x) \ -+ (((x) & BIT_MASK_LBDLY_8821C) << BIT_SHIFT_LBDLY_8821C) -+#define BITS_LBDLY_8821C (BIT_MASK_LBDLY_8821C << BIT_SHIFT_LBDLY_8821C) -+#define BIT_CLEAR_LBDLY_8821C(x) ((x) & (~BITS_LBDLY_8821C)) -+#define BIT_GET_LBDLY_8821C(x) \ -+ (((x) >> BIT_SHIFT_LBDLY_8821C) & BIT_MASK_LBDLY_8821C) -+#define BIT_SET_LBDLY_8821C(x, v) \ -+ (BIT_CLEAR_LBDLY_8821C(x) | BIT_LBDLY_8821C(v)) -+ -+/* 2 REG_WMAC_BACAM_RPMEN_8821C */ -+ -+#define BIT_SHIFT_BITMAP_SSNBK_COUNTER_8821C 2 -+#define BIT_MASK_BITMAP_SSNBK_COUNTER_8821C 0x3f -+#define BIT_BITMAP_SSNBK_COUNTER_8821C(x) \ -+ (((x) & BIT_MASK_BITMAP_SSNBK_COUNTER_8821C) \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8821C) -+#define BITS_BITMAP_SSNBK_COUNTER_8821C \ -+ (BIT_MASK_BITMAP_SSNBK_COUNTER_8821C \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8821C) -+#define BIT_CLEAR_BITMAP_SSNBK_COUNTER_8821C(x) \ -+ ((x) & (~BITS_BITMAP_SSNBK_COUNTER_8821C)) -+#define BIT_GET_BITMAP_SSNBK_COUNTER_8821C(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_SSNBK_COUNTER_8821C) & \ -+ BIT_MASK_BITMAP_SSNBK_COUNTER_8821C) -+#define BIT_SET_BITMAP_SSNBK_COUNTER_8821C(x, v) \ -+ (BIT_CLEAR_BITMAP_SSNBK_COUNTER_8821C(x) | \ -+ BIT_BITMAP_SSNBK_COUNTER_8821C(v)) -+ -+#define BIT_BITMAP_EN_8821C BIT(1) -+#define BIT_WMAC_BACAM_RPMEN_8821C BIT(0) -+ -+/* 2 REG_TX_RX_8821C STATUS */ -+ -+#define BIT_SHIFT_RXPKT_TYPE_8821C 2 -+#define BIT_MASK_RXPKT_TYPE_8821C 0x3f -+#define BIT_RXPKT_TYPE_8821C(x) \ -+ (((x) & BIT_MASK_RXPKT_TYPE_8821C) << BIT_SHIFT_RXPKT_TYPE_8821C) -+#define BITS_RXPKT_TYPE_8821C \ -+ (BIT_MASK_RXPKT_TYPE_8821C << BIT_SHIFT_RXPKT_TYPE_8821C) -+#define BIT_CLEAR_RXPKT_TYPE_8821C(x) ((x) & (~BITS_RXPKT_TYPE_8821C)) -+#define BIT_GET_RXPKT_TYPE_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_TYPE_8821C) & BIT_MASK_RXPKT_TYPE_8821C) -+#define BIT_SET_RXPKT_TYPE_8821C(x, v) \ -+ (BIT_CLEAR_RXPKT_TYPE_8821C(x) | BIT_RXPKT_TYPE_8821C(v)) -+ -+#define BIT_TXACT_IND_8821C BIT(1) -+#define BIT_RXACT_IND_8821C BIT(0) -+ -+/* 2 REG_WMAC_BITMAP_CTL_8821C */ -+#define BIT_BITMAP_VO_8821C BIT(7) -+#define BIT_BITMAP_VI_8821C BIT(6) -+#define BIT_BITMAP_BE_8821C BIT(5) -+#define BIT_BITMAP_BK_8821C BIT(4) -+ -+#define BIT_SHIFT_BITMAP_CONDITION_8821C 2 -+#define BIT_MASK_BITMAP_CONDITION_8821C 0x3 -+#define BIT_BITMAP_CONDITION_8821C(x) \ -+ (((x) & BIT_MASK_BITMAP_CONDITION_8821C) \ -+ << BIT_SHIFT_BITMAP_CONDITION_8821C) -+#define BITS_BITMAP_CONDITION_8821C \ -+ (BIT_MASK_BITMAP_CONDITION_8821C << BIT_SHIFT_BITMAP_CONDITION_8821C) -+#define BIT_CLEAR_BITMAP_CONDITION_8821C(x) \ -+ ((x) & (~BITS_BITMAP_CONDITION_8821C)) -+#define BIT_GET_BITMAP_CONDITION_8821C(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_CONDITION_8821C) & \ -+ BIT_MASK_BITMAP_CONDITION_8821C) -+#define BIT_SET_BITMAP_CONDITION_8821C(x, v) \ -+ (BIT_CLEAR_BITMAP_CONDITION_8821C(x) | BIT_BITMAP_CONDITION_8821C(v)) -+ -+#define BIT_BITMAP_SSNBK_COUNTER_CLR_8821C BIT(1) -+#define BIT_BITMAP_FORCE_8821C BIT(0) -+ -+/* 2 REG_RXERR_RPT_8821C (RX ERROR REPORT REGISTER) */ -+ -+#define BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8821C 28 -+#define BIT_MASK_RXERR_RPT_SEL_V1_3_0_8821C 0xf -+#define BIT_RXERR_RPT_SEL_V1_3_0_8821C(x) \ -+ (((x) & BIT_MASK_RXERR_RPT_SEL_V1_3_0_8821C) \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8821C) -+#define BITS_RXERR_RPT_SEL_V1_3_0_8821C \ -+ (BIT_MASK_RXERR_RPT_SEL_V1_3_0_8821C \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8821C) -+#define BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8821C(x) \ -+ ((x) & (~BITS_RXERR_RPT_SEL_V1_3_0_8821C)) -+#define BIT_GET_RXERR_RPT_SEL_V1_3_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8821C) & \ -+ BIT_MASK_RXERR_RPT_SEL_V1_3_0_8821C) -+#define BIT_SET_RXERR_RPT_SEL_V1_3_0_8821C(x, v) \ -+ (BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8821C(x) | \ -+ BIT_RXERR_RPT_SEL_V1_3_0_8821C(v)) -+ -+#define BIT_RXERR_RPT_RST_8821C BIT(27) -+#define BIT_RXERR_RPT_SEL_V1_4_8821C BIT(26) -+#define BIT_W1S_8821C BIT(23) -+#define BIT_UD_SELECT_BSSID_8821C BIT(22) -+ -+#define BIT_SHIFT_UD_SUB_TYPE_8821C 18 -+#define BIT_MASK_UD_SUB_TYPE_8821C 0xf -+#define BIT_UD_SUB_TYPE_8821C(x) \ -+ (((x) & BIT_MASK_UD_SUB_TYPE_8821C) << BIT_SHIFT_UD_SUB_TYPE_8821C) -+#define BITS_UD_SUB_TYPE_8821C \ -+ (BIT_MASK_UD_SUB_TYPE_8821C << BIT_SHIFT_UD_SUB_TYPE_8821C) -+#define BIT_CLEAR_UD_SUB_TYPE_8821C(x) ((x) & (~BITS_UD_SUB_TYPE_8821C)) -+#define BIT_GET_UD_SUB_TYPE_8821C(x) \ -+ (((x) >> BIT_SHIFT_UD_SUB_TYPE_8821C) & BIT_MASK_UD_SUB_TYPE_8821C) -+#define BIT_SET_UD_SUB_TYPE_8821C(x, v) \ -+ (BIT_CLEAR_UD_SUB_TYPE_8821C(x) | BIT_UD_SUB_TYPE_8821C(v)) -+ -+#define BIT_SHIFT_UD_TYPE_8821C 16 -+#define BIT_MASK_UD_TYPE_8821C 0x3 -+#define BIT_UD_TYPE_8821C(x) \ -+ (((x) & BIT_MASK_UD_TYPE_8821C) << BIT_SHIFT_UD_TYPE_8821C) -+#define BITS_UD_TYPE_8821C (BIT_MASK_UD_TYPE_8821C << BIT_SHIFT_UD_TYPE_8821C) -+#define BIT_CLEAR_UD_TYPE_8821C(x) ((x) & (~BITS_UD_TYPE_8821C)) -+#define BIT_GET_UD_TYPE_8821C(x) \ -+ (((x) >> BIT_SHIFT_UD_TYPE_8821C) & BIT_MASK_UD_TYPE_8821C) -+#define BIT_SET_UD_TYPE_8821C(x, v) \ -+ (BIT_CLEAR_UD_TYPE_8821C(x) | BIT_UD_TYPE_8821C(v)) -+ -+#define BIT_SHIFT_RPT_COUNTER_8821C 0 -+#define BIT_MASK_RPT_COUNTER_8821C 0xffff -+#define BIT_RPT_COUNTER_8821C(x) \ -+ (((x) & BIT_MASK_RPT_COUNTER_8821C) << BIT_SHIFT_RPT_COUNTER_8821C) -+#define BITS_RPT_COUNTER_8821C \ -+ (BIT_MASK_RPT_COUNTER_8821C << BIT_SHIFT_RPT_COUNTER_8821C) -+#define BIT_CLEAR_RPT_COUNTER_8821C(x) ((x) & (~BITS_RPT_COUNTER_8821C)) -+#define BIT_GET_RPT_COUNTER_8821C(x) \ -+ (((x) >> BIT_SHIFT_RPT_COUNTER_8821C) & BIT_MASK_RPT_COUNTER_8821C) -+#define BIT_SET_RPT_COUNTER_8821C(x, v) \ -+ (BIT_CLEAR_RPT_COUNTER_8821C(x) | BIT_RPT_COUNTER_8821C(v)) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_8821C (WMAC TX/RX PROTOCOL CONTROL REGISTER) */ -+#define BIT_EN_TXCTS_INTXOP_8821C BIT(32) -+#define BIT_BLK_EDCA_BBSLP_8821C BIT(31) -+#define BIT_BLK_EDCA_BBSBY_8821C BIT(30) -+#define BIT_ACKTO_BLOCK_SCH_EN_8821C BIT(27) -+#define BIT_EIFS_BLOCK_SCH_EN_8821C BIT(26) -+#define BIT_PLCPCHK_RST_EIFS_8821C BIT(25) -+#define BIT_CCA_RST_EIFS_8821C BIT(24) -+#define BIT_DIS_UPD_MYRXPKTNAV_8821C BIT(23) -+#define BIT_EARLY_TXBA_8821C BIT(22) -+ -+#define BIT_SHIFT_RESP_CHNBUSY_8821C 20 -+#define BIT_MASK_RESP_CHNBUSY_8821C 0x3 -+#define BIT_RESP_CHNBUSY_8821C(x) \ -+ (((x) & BIT_MASK_RESP_CHNBUSY_8821C) << BIT_SHIFT_RESP_CHNBUSY_8821C) -+#define BITS_RESP_CHNBUSY_8821C \ -+ (BIT_MASK_RESP_CHNBUSY_8821C << BIT_SHIFT_RESP_CHNBUSY_8821C) -+#define BIT_CLEAR_RESP_CHNBUSY_8821C(x) ((x) & (~BITS_RESP_CHNBUSY_8821C)) -+#define BIT_GET_RESP_CHNBUSY_8821C(x) \ -+ (((x) >> BIT_SHIFT_RESP_CHNBUSY_8821C) & BIT_MASK_RESP_CHNBUSY_8821C) -+#define BIT_SET_RESP_CHNBUSY_8821C(x, v) \ -+ (BIT_CLEAR_RESP_CHNBUSY_8821C(x) | BIT_RESP_CHNBUSY_8821C(v)) -+ -+#define BIT_RESP_DCTS_EN_8821C BIT(19) -+#define BIT_RESP_DCFE_EN_8821C BIT(18) -+#define BIT_RESP_SPLCPEN_8821C BIT(17) -+#define BIT_RESP_SGIEN_8821C BIT(16) -+#define BIT_RESP_LDPC_EN_8821C BIT(15) -+#define BIT_DIS_RESP_ACKINCCA_8821C BIT(14) -+#define BIT_DIS_RESP_CTSINCCA_8821C BIT(13) -+ -+#define BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8821C 10 -+#define BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8821C 0x7 -+#define BIT_R_WMAC_SECOND_CCA_TIMER_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8821C) \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8821C) -+#define BITS_R_WMAC_SECOND_CCA_TIMER_8821C \ -+ (BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8821C \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8821C) -+#define BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_SECOND_CCA_TIMER_8821C)) -+#define BIT_GET_R_WMAC_SECOND_CCA_TIMER_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8821C) & \ -+ BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8821C) -+#define BIT_SET_R_WMAC_SECOND_CCA_TIMER_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8821C(x) | \ -+ BIT_R_WMAC_SECOND_CCA_TIMER_8821C(v)) -+ -+#define BIT_SHIFT_RFMOD_8821C 7 -+#define BIT_MASK_RFMOD_8821C 0x3 -+#define BIT_RFMOD_8821C(x) \ -+ (((x) & BIT_MASK_RFMOD_8821C) << BIT_SHIFT_RFMOD_8821C) -+#define BITS_RFMOD_8821C (BIT_MASK_RFMOD_8821C << BIT_SHIFT_RFMOD_8821C) -+#define BIT_CLEAR_RFMOD_8821C(x) ((x) & (~BITS_RFMOD_8821C)) -+#define BIT_GET_RFMOD_8821C(x) \ -+ (((x) >> BIT_SHIFT_RFMOD_8821C) & BIT_MASK_RFMOD_8821C) -+#define BIT_SET_RFMOD_8821C(x, v) \ -+ (BIT_CLEAR_RFMOD_8821C(x) | BIT_RFMOD_8821C(v)) -+ -+#define BIT_SHIFT_RESP_CTS_DYNBW_SEL_8821C 5 -+#define BIT_MASK_RESP_CTS_DYNBW_SEL_8821C 0x3 -+#define BIT_RESP_CTS_DYNBW_SEL_8821C(x) \ -+ (((x) & BIT_MASK_RESP_CTS_DYNBW_SEL_8821C) \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8821C) -+#define BITS_RESP_CTS_DYNBW_SEL_8821C \ -+ (BIT_MASK_RESP_CTS_DYNBW_SEL_8821C \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8821C) -+#define BIT_CLEAR_RESP_CTS_DYNBW_SEL_8821C(x) \ -+ ((x) & (~BITS_RESP_CTS_DYNBW_SEL_8821C)) -+#define BIT_GET_RESP_CTS_DYNBW_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_RESP_CTS_DYNBW_SEL_8821C) & \ -+ BIT_MASK_RESP_CTS_DYNBW_SEL_8821C) -+#define BIT_SET_RESP_CTS_DYNBW_SEL_8821C(x, v) \ -+ (BIT_CLEAR_RESP_CTS_DYNBW_SEL_8821C(x) | \ -+ BIT_RESP_CTS_DYNBW_SEL_8821C(v)) -+ -+#define BIT_DLY_TX_WAIT_RXANTSEL_8821C BIT(4) -+#define BIT_TXRESP_BY_RXANTSEL_8821C BIT(3) -+ -+#define BIT_SHIFT_ORIG_DCTS_CHK_8821C 0 -+#define BIT_MASK_ORIG_DCTS_CHK_8821C 0x3 -+#define BIT_ORIG_DCTS_CHK_8821C(x) \ -+ (((x) & BIT_MASK_ORIG_DCTS_CHK_8821C) << BIT_SHIFT_ORIG_DCTS_CHK_8821C) -+#define BITS_ORIG_DCTS_CHK_8821C \ -+ (BIT_MASK_ORIG_DCTS_CHK_8821C << BIT_SHIFT_ORIG_DCTS_CHK_8821C) -+#define BIT_CLEAR_ORIG_DCTS_CHK_8821C(x) ((x) & (~BITS_ORIG_DCTS_CHK_8821C)) -+#define BIT_GET_ORIG_DCTS_CHK_8821C(x) \ -+ (((x) >> BIT_SHIFT_ORIG_DCTS_CHK_8821C) & BIT_MASK_ORIG_DCTS_CHK_8821C) -+#define BIT_SET_ORIG_DCTS_CHK_8821C(x, v) \ -+ (BIT_CLEAR_ORIG_DCTS_CHK_8821C(x) | BIT_ORIG_DCTS_CHK_8821C(v)) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_H_8821C */ -+ -+#define BIT_SHIFT_ACKBA_TYPSEL_8821C 28 -+#define BIT_MASK_ACKBA_TYPSEL_8821C 0xf -+#define BIT_ACKBA_TYPSEL_8821C(x) \ -+ (((x) & BIT_MASK_ACKBA_TYPSEL_8821C) << BIT_SHIFT_ACKBA_TYPSEL_8821C) -+#define BITS_ACKBA_TYPSEL_8821C \ -+ (BIT_MASK_ACKBA_TYPSEL_8821C << BIT_SHIFT_ACKBA_TYPSEL_8821C) -+#define BIT_CLEAR_ACKBA_TYPSEL_8821C(x) ((x) & (~BITS_ACKBA_TYPSEL_8821C)) -+#define BIT_GET_ACKBA_TYPSEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_TYPSEL_8821C) & BIT_MASK_ACKBA_TYPSEL_8821C) -+#define BIT_SET_ACKBA_TYPSEL_8821C(x, v) \ -+ (BIT_CLEAR_ACKBA_TYPSEL_8821C(x) | BIT_ACKBA_TYPSEL_8821C(v)) -+ -+#define BIT_SHIFT_ACKBA_ACKPCHK_8821C 24 -+#define BIT_MASK_ACKBA_ACKPCHK_8821C 0xf -+#define BIT_ACKBA_ACKPCHK_8821C(x) \ -+ (((x) & BIT_MASK_ACKBA_ACKPCHK_8821C) << BIT_SHIFT_ACKBA_ACKPCHK_8821C) -+#define BITS_ACKBA_ACKPCHK_8821C \ -+ (BIT_MASK_ACKBA_ACKPCHK_8821C << BIT_SHIFT_ACKBA_ACKPCHK_8821C) -+#define BIT_CLEAR_ACKBA_ACKPCHK_8821C(x) ((x) & (~BITS_ACKBA_ACKPCHK_8821C)) -+#define BIT_GET_ACKBA_ACKPCHK_8821C(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_ACKPCHK_8821C) & BIT_MASK_ACKBA_ACKPCHK_8821C) -+#define BIT_SET_ACKBA_ACKPCHK_8821C(x, v) \ -+ (BIT_CLEAR_ACKBA_ACKPCHK_8821C(x) | BIT_ACKBA_ACKPCHK_8821C(v)) -+ -+#define BIT_SHIFT_ACKBAR_TYPESEL_8821C 16 -+#define BIT_MASK_ACKBAR_TYPESEL_8821C 0xff -+#define BIT_ACKBAR_TYPESEL_8821C(x) \ -+ (((x) & BIT_MASK_ACKBAR_TYPESEL_8821C) \ -+ << BIT_SHIFT_ACKBAR_TYPESEL_8821C) -+#define BITS_ACKBAR_TYPESEL_8821C \ -+ (BIT_MASK_ACKBAR_TYPESEL_8821C << BIT_SHIFT_ACKBAR_TYPESEL_8821C) -+#define BIT_CLEAR_ACKBAR_TYPESEL_8821C(x) ((x) & (~BITS_ACKBAR_TYPESEL_8821C)) -+#define BIT_GET_ACKBAR_TYPESEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_TYPESEL_8821C) & \ -+ BIT_MASK_ACKBAR_TYPESEL_8821C) -+#define BIT_SET_ACKBAR_TYPESEL_8821C(x, v) \ -+ (BIT_CLEAR_ACKBAR_TYPESEL_8821C(x) | BIT_ACKBAR_TYPESEL_8821C(v)) -+ -+#define BIT_SHIFT_ACKBAR_ACKPCHK_8821C 12 -+#define BIT_MASK_ACKBAR_ACKPCHK_8821C 0xf -+#define BIT_ACKBAR_ACKPCHK_8821C(x) \ -+ (((x) & BIT_MASK_ACKBAR_ACKPCHK_8821C) \ -+ << BIT_SHIFT_ACKBAR_ACKPCHK_8821C) -+#define BITS_ACKBAR_ACKPCHK_8821C \ -+ (BIT_MASK_ACKBAR_ACKPCHK_8821C << BIT_SHIFT_ACKBAR_ACKPCHK_8821C) -+#define BIT_CLEAR_ACKBAR_ACKPCHK_8821C(x) ((x) & (~BITS_ACKBAR_ACKPCHK_8821C)) -+#define BIT_GET_ACKBAR_ACKPCHK_8821C(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_ACKPCHK_8821C) & \ -+ BIT_MASK_ACKBAR_ACKPCHK_8821C) -+#define BIT_SET_ACKBAR_ACKPCHK_8821C(x, v) \ -+ (BIT_CLEAR_ACKBAR_ACKPCHK_8821C(x) | BIT_ACKBAR_ACKPCHK_8821C(v)) -+ -+#define BIT_RXBA_IGNOREA2_V1_8821C BIT(10) -+#define BIT_EN_SAVE_ALL_TXOPADDR_V1_8821C BIT(9) -+#define BIT_EN_TXCTS_TO_TXOPOWNER_INRXNAV_V1_8821C BIT(8) -+#define BIT_DIS_TXBA_AMPDUFCSERR_V1_8821C BIT(7) -+#define BIT_DIS_TXBA_RXBARINFULL_V1_8821C BIT(6) -+#define BIT_DIS_TXCFE_INFULL_V1_8821C BIT(5) -+#define BIT_DIS_TXCTS_INFULL_V1_8821C BIT(4) -+#define BIT_EN_TXACKBA_IN_TX_RDG_V1_8821C BIT(3) -+#define BIT_EN_TXACKBA_IN_TXOP_V1_8821C BIT(2) -+#define BIT_EN_TXCTS_IN_RXNAV_V1_8821C BIT(1) -+#define BIT_EN_TXCTS_INTXOP_V1_8821C BIT(0) -+ -+/* 2 REG_CAMCMD_8821C (CAM COMMAND REGISTER) */ -+#define BIT_SECCAM_POLLING_8821C BIT(31) -+#define BIT_SECCAM_CLR_8821C BIT(30) -+#define BIT_MFBCAM_CLR_8821C BIT(29) -+#define BIT_SECCAM_WE_8821C BIT(16) -+ -+#define BIT_SHIFT_SECCAM_ADDR_V2_8821C 0 -+#define BIT_MASK_SECCAM_ADDR_V2_8821C 0x3ff -+#define BIT_SECCAM_ADDR_V2_8821C(x) \ -+ (((x) & BIT_MASK_SECCAM_ADDR_V2_8821C) \ -+ << BIT_SHIFT_SECCAM_ADDR_V2_8821C) -+#define BITS_SECCAM_ADDR_V2_8821C \ -+ (BIT_MASK_SECCAM_ADDR_V2_8821C << BIT_SHIFT_SECCAM_ADDR_V2_8821C) -+#define BIT_CLEAR_SECCAM_ADDR_V2_8821C(x) ((x) & (~BITS_SECCAM_ADDR_V2_8821C)) -+#define BIT_GET_SECCAM_ADDR_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_SECCAM_ADDR_V2_8821C) & \ -+ BIT_MASK_SECCAM_ADDR_V2_8821C) -+#define BIT_SET_SECCAM_ADDR_V2_8821C(x, v) \ -+ (BIT_CLEAR_SECCAM_ADDR_V2_8821C(x) | BIT_SECCAM_ADDR_V2_8821C(v)) -+ -+/* 2 REG_CAMWRITE_8821C (CAM WRITE REGISTER) */ -+ -+#define BIT_SHIFT_CAMW_DATA_8821C 0 -+#define BIT_MASK_CAMW_DATA_8821C 0xffffffffL -+#define BIT_CAMW_DATA_8821C(x) \ -+ (((x) & BIT_MASK_CAMW_DATA_8821C) << BIT_SHIFT_CAMW_DATA_8821C) -+#define BITS_CAMW_DATA_8821C \ -+ (BIT_MASK_CAMW_DATA_8821C << BIT_SHIFT_CAMW_DATA_8821C) -+#define BIT_CLEAR_CAMW_DATA_8821C(x) ((x) & (~BITS_CAMW_DATA_8821C)) -+#define BIT_GET_CAMW_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_CAMW_DATA_8821C) & BIT_MASK_CAMW_DATA_8821C) -+#define BIT_SET_CAMW_DATA_8821C(x, v) \ -+ (BIT_CLEAR_CAMW_DATA_8821C(x) | BIT_CAMW_DATA_8821C(v)) -+ -+/* 2 REG_CAMREAD_8821C (CAM READ REGISTER) */ -+ -+#define BIT_SHIFT_CAMR_DATA_8821C 0 -+#define BIT_MASK_CAMR_DATA_8821C 0xffffffffL -+#define BIT_CAMR_DATA_8821C(x) \ -+ (((x) & BIT_MASK_CAMR_DATA_8821C) << BIT_SHIFT_CAMR_DATA_8821C) -+#define BITS_CAMR_DATA_8821C \ -+ (BIT_MASK_CAMR_DATA_8821C << BIT_SHIFT_CAMR_DATA_8821C) -+#define BIT_CLEAR_CAMR_DATA_8821C(x) ((x) & (~BITS_CAMR_DATA_8821C)) -+#define BIT_GET_CAMR_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_CAMR_DATA_8821C) & BIT_MASK_CAMR_DATA_8821C) -+#define BIT_SET_CAMR_DATA_8821C(x, v) \ -+ (BIT_CLEAR_CAMR_DATA_8821C(x) | BIT_CAMR_DATA_8821C(v)) -+ -+/* 2 REG_CAMDBG_8821C (CAM DEBUG REGISTER) */ -+#define BIT_SECCAM_INFO_8821C BIT(31) -+#define BIT_SEC_KEYFOUND_8821C BIT(15) -+ -+#define BIT_SHIFT_CAMDBG_SEC_TYPE_8821C 12 -+#define BIT_MASK_CAMDBG_SEC_TYPE_8821C 0x7 -+#define BIT_CAMDBG_SEC_TYPE_8821C(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_TYPE_8821C) \ -+ << BIT_SHIFT_CAMDBG_SEC_TYPE_8821C) -+#define BITS_CAMDBG_SEC_TYPE_8821C \ -+ (BIT_MASK_CAMDBG_SEC_TYPE_8821C << BIT_SHIFT_CAMDBG_SEC_TYPE_8821C) -+#define BIT_CLEAR_CAMDBG_SEC_TYPE_8821C(x) ((x) & (~BITS_CAMDBG_SEC_TYPE_8821C)) -+#define BIT_GET_CAMDBG_SEC_TYPE_8821C(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_TYPE_8821C) & \ -+ BIT_MASK_CAMDBG_SEC_TYPE_8821C) -+#define BIT_SET_CAMDBG_SEC_TYPE_8821C(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_TYPE_8821C(x) | BIT_CAMDBG_SEC_TYPE_8821C(v)) -+ -+#define BIT_CAMDBG_EXT_SECTYPE_8821C BIT(11) -+ -+#define BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8821C 5 -+#define BIT_MASK_CAMDBG_MIC_KEY_IDX_8821C 0x1f -+#define BIT_CAMDBG_MIC_KEY_IDX_8821C(x) \ -+ (((x) & BIT_MASK_CAMDBG_MIC_KEY_IDX_8821C) \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8821C) -+#define BITS_CAMDBG_MIC_KEY_IDX_8821C \ -+ (BIT_MASK_CAMDBG_MIC_KEY_IDX_8821C \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8821C) -+#define BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8821C(x) \ -+ ((x) & (~BITS_CAMDBG_MIC_KEY_IDX_8821C)) -+#define BIT_GET_CAMDBG_MIC_KEY_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8821C) & \ -+ BIT_MASK_CAMDBG_MIC_KEY_IDX_8821C) -+#define BIT_SET_CAMDBG_MIC_KEY_IDX_8821C(x, v) \ -+ (BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8821C(x) | \ -+ BIT_CAMDBG_MIC_KEY_IDX_8821C(v)) -+ -+#define BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8821C 0 -+#define BIT_MASK_CAMDBG_SEC_KEY_IDX_8821C 0x1f -+#define BIT_CAMDBG_SEC_KEY_IDX_8821C(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_KEY_IDX_8821C) \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8821C) -+#define BITS_CAMDBG_SEC_KEY_IDX_8821C \ -+ (BIT_MASK_CAMDBG_SEC_KEY_IDX_8821C \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8821C) -+#define BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8821C(x) \ -+ ((x) & (~BITS_CAMDBG_SEC_KEY_IDX_8821C)) -+#define BIT_GET_CAMDBG_SEC_KEY_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8821C) & \ -+ BIT_MASK_CAMDBG_SEC_KEY_IDX_8821C) -+#define BIT_SET_CAMDBG_SEC_KEY_IDX_8821C(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8821C(x) | \ -+ BIT_CAMDBG_SEC_KEY_IDX_8821C(v)) -+ -+/* 2 REG_SECCFG_8821C (SECURITY CONFIGURATION REGISTER) */ -+#define BIT_DIS_GCLK_WAPI_8821C BIT(15) -+#define BIT_DIS_GCLK_AES_8821C BIT(14) -+#define BIT_DIS_GCLK_TKIP_8821C BIT(13) -+#define BIT_AES_SEL_QC_1_8821C BIT(12) -+#define BIT_AES_SEL_QC_0_8821C BIT(11) -+#define BIT_CHK_BMC_8821C BIT(9) -+#define BIT_CHK_KEYID_8821C BIT(8) -+#define BIT_RXBCUSEDK_8821C BIT(7) -+#define BIT_TXBCUSEDK_8821C BIT(6) -+#define BIT_NOSKMC_8821C BIT(5) -+#define BIT_SKBYA2_8821C BIT(4) -+#define BIT_RXDEC_8821C BIT(3) -+#define BIT_TXENC_8821C BIT(2) -+#define BIT_RXUHUSEDK_8821C BIT(1) -+#define BIT_TXUHUSEDK_8821C BIT(0) -+ -+/* 2 REG_RXFILTER_CATEGORY_1_8821C */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_1_8821C 0 -+#define BIT_MASK_RXFILTER_CATEGORY_1_8821C 0xff -+#define BIT_RXFILTER_CATEGORY_1_8821C(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_1_8821C) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8821C) -+#define BITS_RXFILTER_CATEGORY_1_8821C \ -+ (BIT_MASK_RXFILTER_CATEGORY_1_8821C \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8821C) -+#define BIT_CLEAR_RXFILTER_CATEGORY_1_8821C(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_1_8821C)) -+#define BIT_GET_RXFILTER_CATEGORY_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_1_8821C) & \ -+ BIT_MASK_RXFILTER_CATEGORY_1_8821C) -+#define BIT_SET_RXFILTER_CATEGORY_1_8821C(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_1_8821C(x) | \ -+ BIT_RXFILTER_CATEGORY_1_8821C(v)) -+ -+/* 2 REG_RXFILTER_ACTION_1_8821C */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_1_8821C 0 -+#define BIT_MASK_RXFILTER_ACTION_1_8821C 0xff -+#define BIT_RXFILTER_ACTION_1_8821C(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_1_8821C) \ -+ << BIT_SHIFT_RXFILTER_ACTION_1_8821C) -+#define BITS_RXFILTER_ACTION_1_8821C \ -+ (BIT_MASK_RXFILTER_ACTION_1_8821C << BIT_SHIFT_RXFILTER_ACTION_1_8821C) -+#define BIT_CLEAR_RXFILTER_ACTION_1_8821C(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_1_8821C)) -+#define BIT_GET_RXFILTER_ACTION_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_1_8821C) & \ -+ BIT_MASK_RXFILTER_ACTION_1_8821C) -+#define BIT_SET_RXFILTER_ACTION_1_8821C(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_1_8821C(x) | BIT_RXFILTER_ACTION_1_8821C(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_2_8821C */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_2_8821C 0 -+#define BIT_MASK_RXFILTER_CATEGORY_2_8821C 0xff -+#define BIT_RXFILTER_CATEGORY_2_8821C(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_2_8821C) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8821C) -+#define BITS_RXFILTER_CATEGORY_2_8821C \ -+ (BIT_MASK_RXFILTER_CATEGORY_2_8821C \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8821C) -+#define BIT_CLEAR_RXFILTER_CATEGORY_2_8821C(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_2_8821C)) -+#define BIT_GET_RXFILTER_CATEGORY_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_2_8821C) & \ -+ BIT_MASK_RXFILTER_CATEGORY_2_8821C) -+#define BIT_SET_RXFILTER_CATEGORY_2_8821C(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_2_8821C(x) | \ -+ BIT_RXFILTER_CATEGORY_2_8821C(v)) -+ -+/* 2 REG_RXFILTER_ACTION_2_8821C */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_2_8821C 0 -+#define BIT_MASK_RXFILTER_ACTION_2_8821C 0xff -+#define BIT_RXFILTER_ACTION_2_8821C(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_2_8821C) \ -+ << BIT_SHIFT_RXFILTER_ACTION_2_8821C) -+#define BITS_RXFILTER_ACTION_2_8821C \ -+ (BIT_MASK_RXFILTER_ACTION_2_8821C << BIT_SHIFT_RXFILTER_ACTION_2_8821C) -+#define BIT_CLEAR_RXFILTER_ACTION_2_8821C(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_2_8821C)) -+#define BIT_GET_RXFILTER_ACTION_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_2_8821C) & \ -+ BIT_MASK_RXFILTER_ACTION_2_8821C) -+#define BIT_SET_RXFILTER_ACTION_2_8821C(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_2_8821C(x) | BIT_RXFILTER_ACTION_2_8821C(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_3_8821C */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_3_8821C 0 -+#define BIT_MASK_RXFILTER_CATEGORY_3_8821C 0xff -+#define BIT_RXFILTER_CATEGORY_3_8821C(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_3_8821C) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8821C) -+#define BITS_RXFILTER_CATEGORY_3_8821C \ -+ (BIT_MASK_RXFILTER_CATEGORY_3_8821C \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8821C) -+#define BIT_CLEAR_RXFILTER_CATEGORY_3_8821C(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_3_8821C)) -+#define BIT_GET_RXFILTER_CATEGORY_3_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_3_8821C) & \ -+ BIT_MASK_RXFILTER_CATEGORY_3_8821C) -+#define BIT_SET_RXFILTER_CATEGORY_3_8821C(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_3_8821C(x) | \ -+ BIT_RXFILTER_CATEGORY_3_8821C(v)) -+ -+/* 2 REG_RXFILTER_ACTION_3_8821C */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_3_8821C 0 -+#define BIT_MASK_RXFILTER_ACTION_3_8821C 0xff -+#define BIT_RXFILTER_ACTION_3_8821C(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_3_8821C) \ -+ << BIT_SHIFT_RXFILTER_ACTION_3_8821C) -+#define BITS_RXFILTER_ACTION_3_8821C \ -+ (BIT_MASK_RXFILTER_ACTION_3_8821C << BIT_SHIFT_RXFILTER_ACTION_3_8821C) -+#define BIT_CLEAR_RXFILTER_ACTION_3_8821C(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_3_8821C)) -+#define BIT_GET_RXFILTER_ACTION_3_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_3_8821C) & \ -+ BIT_MASK_RXFILTER_ACTION_3_8821C) -+#define BIT_SET_RXFILTER_ACTION_3_8821C(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_3_8821C(x) | BIT_RXFILTER_ACTION_3_8821C(v)) -+ -+/* 2 REG_RXFLTMAP3_8821C (RX FILTER MAP GROUP 3) */ -+#define BIT_MGTFLT15EN_FW_8821C BIT(15) -+#define BIT_MGTFLT14EN_FW_8821C BIT(14) -+#define BIT_MGTFLT13EN_FW_8821C BIT(13) -+#define BIT_MGTFLT12EN_FW_8821C BIT(12) -+#define BIT_MGTFLT11EN_FW_8821C BIT(11) -+#define BIT_MGTFLT10EN_FW_8821C BIT(10) -+#define BIT_MGTFLT9EN_FW_8821C BIT(9) -+#define BIT_MGTFLT8EN_FW_8821C BIT(8) -+#define BIT_MGTFLT7EN_FW_8821C BIT(7) -+#define BIT_MGTFLT6EN_FW_8821C BIT(6) -+#define BIT_MGTFLT5EN_FW_8821C BIT(5) -+#define BIT_MGTFLT4EN_FW_8821C BIT(4) -+#define BIT_MGTFLT3EN_FW_8821C BIT(3) -+#define BIT_MGTFLT2EN_FW_8821C BIT(2) -+#define BIT_MGTFLT1EN_FW_8821C BIT(1) -+#define BIT_MGTFLT0EN_FW_8821C BIT(0) -+ -+/* 2 REG_RXFLTMAP4_8821C (RX FILTER MAP GROUP 4) */ -+#define BIT_CTRLFLT15EN_FW_8821C BIT(15) -+#define BIT_CTRLFLT14EN_FW_8821C BIT(14) -+#define BIT_CTRLFLT13EN_FW_8821C BIT(13) -+#define BIT_CTRLFLT12EN_FW_8821C BIT(12) -+#define BIT_CTRLFLT11EN_FW_8821C BIT(11) -+#define BIT_CTRLFLT10EN_FW_8821C BIT(10) -+#define BIT_CTRLFLT9EN_FW_8821C BIT(9) -+#define BIT_CTRLFLT8EN_FW_8821C BIT(8) -+#define BIT_CTRLFLT7EN_FW_8821C BIT(7) -+#define BIT_CTRLFLT6EN_FW_8821C BIT(6) -+#define BIT_CTRLFLT5EN_FW_8821C BIT(5) -+#define BIT_CTRLFLT4EN_FW_8821C BIT(4) -+#define BIT_CTRLFLT3EN_FW_8821C BIT(3) -+#define BIT_CTRLFLT2EN_FW_8821C BIT(2) -+#define BIT_CTRLFLT1EN_FW_8821C BIT(1) -+#define BIT_CTRLFLT0EN_FW_8821C BIT(0) -+ -+/* 2 REG_RXFLTMAP5_8821C (RX FILTER MAP GROUP 5) */ -+#define BIT_DATAFLT15EN_FW_8821C BIT(15) -+#define BIT_DATAFLT14EN_FW_8821C BIT(14) -+#define BIT_DATAFLT13EN_FW_8821C BIT(13) -+#define BIT_DATAFLT12EN_FW_8821C BIT(12) -+#define BIT_DATAFLT11EN_FW_8821C BIT(11) -+#define BIT_DATAFLT10EN_FW_8821C BIT(10) -+#define BIT_DATAFLT9EN_FW_8821C BIT(9) -+#define BIT_DATAFLT8EN_FW_8821C BIT(8) -+#define BIT_DATAFLT7EN_FW_8821C BIT(7) -+#define BIT_DATAFLT6EN_FW_8821C BIT(6) -+#define BIT_DATAFLT5EN_FW_8821C BIT(5) -+#define BIT_DATAFLT4EN_FW_8821C BIT(4) -+#define BIT_DATAFLT3EN_FW_8821C BIT(3) -+#define BIT_DATAFLT2EN_FW_8821C BIT(2) -+#define BIT_DATAFLT1EN_FW_8821C BIT(1) -+#define BIT_DATAFLT0EN_FW_8821C BIT(0) -+ -+/* 2 REG_RXFLTMAP6_8821C (RX FILTER MAP GROUP 6) */ -+#define BIT_ACTIONFLT15EN_FW_8821C BIT(15) -+#define BIT_ACTIONFLT14EN_FW_8821C BIT(14) -+#define BIT_ACTIONFLT13EN_FW_8821C BIT(13) -+#define BIT_ACTIONFLT12EN_FW_8821C BIT(12) -+#define BIT_ACTIONFLT11EN_FW_8821C BIT(11) -+#define BIT_ACTIONFLT10EN_FW_8821C BIT(10) -+#define BIT_ACTIONFLT9EN_FW_8821C BIT(9) -+#define BIT_ACTIONFLT8EN_FW_8821C BIT(8) -+#define BIT_ACTIONFLT7EN_FW_8821C BIT(7) -+#define BIT_ACTIONFLT6EN_FW_8821C BIT(6) -+#define BIT_ACTIONFLT5EN_FW_8821C BIT(5) -+#define BIT_ACTIONFLT4EN_FW_8821C BIT(4) -+#define BIT_ACTIONFLT3EN_FW_8821C BIT(3) -+#define BIT_ACTIONFLT2EN_FW_8821C BIT(2) -+#define BIT_ACTIONFLT1EN_FW_8821C BIT(1) -+#define BIT_ACTIONFLT0EN_FW_8821C BIT(0) -+ -+/* 2 REG_WOW_CTRL_8821C (WAKE ON WLAN CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_PSF_BSSIDSEL_B2B1_8821C 6 -+#define BIT_MASK_PSF_BSSIDSEL_B2B1_8821C 0x3 -+#define BIT_PSF_BSSIDSEL_B2B1_8821C(x) \ -+ (((x) & BIT_MASK_PSF_BSSIDSEL_B2B1_8821C) \ -+ << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8821C) -+#define BITS_PSF_BSSIDSEL_B2B1_8821C \ -+ (BIT_MASK_PSF_BSSIDSEL_B2B1_8821C << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8821C) -+#define BIT_CLEAR_PSF_BSSIDSEL_B2B1_8821C(x) \ -+ ((x) & (~BITS_PSF_BSSIDSEL_B2B1_8821C)) -+#define BIT_GET_PSF_BSSIDSEL_B2B1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PSF_BSSIDSEL_B2B1_8821C) & \ -+ BIT_MASK_PSF_BSSIDSEL_B2B1_8821C) -+#define BIT_SET_PSF_BSSIDSEL_B2B1_8821C(x, v) \ -+ (BIT_CLEAR_PSF_BSSIDSEL_B2B1_8821C(x) | BIT_PSF_BSSIDSEL_B2B1_8821C(v)) -+ -+#define BIT_WOWHCI_8821C BIT(5) -+#define BIT_PSF_BSSIDSEL_B0_8821C BIT(4) -+#define BIT_UWF_8821C BIT(3) -+#define BIT_MAGIC_8821C BIT(2) -+#define BIT_WOWEN_8821C BIT(1) -+#define BIT_FORCE_WAKEUP_8821C BIT(0) -+ -+/* 2 REG_NAN_RX_TSF_FILTER_8821C(NAN_RX_TSF_ADDRESS_FILTER) */ -+#define BIT_CHK_TSF_TA_8821C BIT(2) -+#define BIT_CHK_TSF_CBSSID_8821C BIT(1) -+#define BIT_CHK_TSF_EN_8821C BIT(0) -+ -+/* 2 REG_PS_RX_INFO_8821C (POWER SAVE RX INFORMATION REGISTER) */ -+ -+#define BIT_SHIFT_PORTSEL__PS_RX_INFO_8821C 5 -+#define BIT_MASK_PORTSEL__PS_RX_INFO_8821C 0x7 -+#define BIT_PORTSEL__PS_RX_INFO_8821C(x) \ -+ (((x) & BIT_MASK_PORTSEL__PS_RX_INFO_8821C) \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8821C) -+#define BITS_PORTSEL__PS_RX_INFO_8821C \ -+ (BIT_MASK_PORTSEL__PS_RX_INFO_8821C \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8821C) -+#define BIT_CLEAR_PORTSEL__PS_RX_INFO_8821C(x) \ -+ ((x) & (~BITS_PORTSEL__PS_RX_INFO_8821C)) -+#define BIT_GET_PORTSEL__PS_RX_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_PORTSEL__PS_RX_INFO_8821C) & \ -+ BIT_MASK_PORTSEL__PS_RX_INFO_8821C) -+#define BIT_SET_PORTSEL__PS_RX_INFO_8821C(x, v) \ -+ (BIT_CLEAR_PORTSEL__PS_RX_INFO_8821C(x) | \ -+ BIT_PORTSEL__PS_RX_INFO_8821C(v)) -+ -+#define BIT_RXCTRLIN0_8821C BIT(4) -+#define BIT_RXMGTIN0_8821C BIT(3) -+#define BIT_RXDATAIN2_8821C BIT(2) -+#define BIT_RXDATAIN1_8821C BIT(1) -+#define BIT_RXDATAIN0_8821C BIT(0) -+ -+/* 2 REG_WMMPS_UAPSD_TID_8821C (WMM POWER SAVE UAPSD TID REGISTER) */ -+#define BIT_WMMPS_UAPSD_TID7_8821C BIT(7) -+#define BIT_WMMPS_UAPSD_TID6_8821C BIT(6) -+#define BIT_WMMPS_UAPSD_TID5_8821C BIT(5) -+#define BIT_WMMPS_UAPSD_TID4_8821C BIT(4) -+#define BIT_WMMPS_UAPSD_TID3_8821C BIT(3) -+#define BIT_WMMPS_UAPSD_TID2_8821C BIT(2) -+#define BIT_WMMPS_UAPSD_TID1_8821C BIT(1) -+#define BIT_WMMPS_UAPSD_TID0_8821C BIT(0) -+ -+/* 2 REG_LPNAV_CTRL_8821C (LOW POWER NAV CONTROL REGISTER) */ -+#define BIT_LPNAV_EN_8821C BIT(31) -+ -+#define BIT_SHIFT_LPNAV_EARLY_8821C 16 -+#define BIT_MASK_LPNAV_EARLY_8821C 0x7fff -+#define BIT_LPNAV_EARLY_8821C(x) \ -+ (((x) & BIT_MASK_LPNAV_EARLY_8821C) << BIT_SHIFT_LPNAV_EARLY_8821C) -+#define BITS_LPNAV_EARLY_8821C \ -+ (BIT_MASK_LPNAV_EARLY_8821C << BIT_SHIFT_LPNAV_EARLY_8821C) -+#define BIT_CLEAR_LPNAV_EARLY_8821C(x) ((x) & (~BITS_LPNAV_EARLY_8821C)) -+#define BIT_GET_LPNAV_EARLY_8821C(x) \ -+ (((x) >> BIT_SHIFT_LPNAV_EARLY_8821C) & BIT_MASK_LPNAV_EARLY_8821C) -+#define BIT_SET_LPNAV_EARLY_8821C(x, v) \ -+ (BIT_CLEAR_LPNAV_EARLY_8821C(x) | BIT_LPNAV_EARLY_8821C(v)) -+ -+#define BIT_SHIFT_LPNAV_TH_8821C 0 -+#define BIT_MASK_LPNAV_TH_8821C 0xffff -+#define BIT_LPNAV_TH_8821C(x) \ -+ (((x) & BIT_MASK_LPNAV_TH_8821C) << BIT_SHIFT_LPNAV_TH_8821C) -+#define BITS_LPNAV_TH_8821C \ -+ (BIT_MASK_LPNAV_TH_8821C << BIT_SHIFT_LPNAV_TH_8821C) -+#define BIT_CLEAR_LPNAV_TH_8821C(x) ((x) & (~BITS_LPNAV_TH_8821C)) -+#define BIT_GET_LPNAV_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_LPNAV_TH_8821C) & BIT_MASK_LPNAV_TH_8821C) -+#define BIT_SET_LPNAV_TH_8821C(x, v) \ -+ (BIT_CLEAR_LPNAV_TH_8821C(x) | BIT_LPNAV_TH_8821C(v)) -+ -+/* 2 REG_WKFMCAM_CMD_8821C (WAKEUP FRAME CAM COMMAND REGISTER) */ -+#define BIT_WKFCAM_POLLING_V1_8821C BIT(31) -+#define BIT_WKFCAM_CLR_V1_8821C BIT(30) -+#define BIT_WKFCAM_WE_8821C BIT(16) -+ -+#define BIT_SHIFT_WKFCAM_ADDR_V2_8821C 8 -+#define BIT_MASK_WKFCAM_ADDR_V2_8821C 0xff -+#define BIT_WKFCAM_ADDR_V2_8821C(x) \ -+ (((x) & BIT_MASK_WKFCAM_ADDR_V2_8821C) \ -+ << BIT_SHIFT_WKFCAM_ADDR_V2_8821C) -+#define BITS_WKFCAM_ADDR_V2_8821C \ -+ (BIT_MASK_WKFCAM_ADDR_V2_8821C << BIT_SHIFT_WKFCAM_ADDR_V2_8821C) -+#define BIT_CLEAR_WKFCAM_ADDR_V2_8821C(x) ((x) & (~BITS_WKFCAM_ADDR_V2_8821C)) -+#define BIT_GET_WKFCAM_ADDR_V2_8821C(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_ADDR_V2_8821C) & \ -+ BIT_MASK_WKFCAM_ADDR_V2_8821C) -+#define BIT_SET_WKFCAM_ADDR_V2_8821C(x, v) \ -+ (BIT_CLEAR_WKFCAM_ADDR_V2_8821C(x) | BIT_WKFCAM_ADDR_V2_8821C(v)) -+ -+#define BIT_SHIFT_WKFCAM_CAM_NUM_V1_8821C 0 -+#define BIT_MASK_WKFCAM_CAM_NUM_V1_8821C 0xff -+#define BIT_WKFCAM_CAM_NUM_V1_8821C(x) \ -+ (((x) & BIT_MASK_WKFCAM_CAM_NUM_V1_8821C) \ -+ << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8821C) -+#define BITS_WKFCAM_CAM_NUM_V1_8821C \ -+ (BIT_MASK_WKFCAM_CAM_NUM_V1_8821C << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8821C) -+#define BIT_CLEAR_WKFCAM_CAM_NUM_V1_8821C(x) \ -+ ((x) & (~BITS_WKFCAM_CAM_NUM_V1_8821C)) -+#define BIT_GET_WKFCAM_CAM_NUM_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_CAM_NUM_V1_8821C) & \ -+ BIT_MASK_WKFCAM_CAM_NUM_V1_8821C) -+#define BIT_SET_WKFCAM_CAM_NUM_V1_8821C(x, v) \ -+ (BIT_CLEAR_WKFCAM_CAM_NUM_V1_8821C(x) | BIT_WKFCAM_CAM_NUM_V1_8821C(v)) -+ -+/* 2 REG_WKFMCAM_RWD_8821C (WAKEUP FRAME READ/WRITE DATA) */ -+ -+#define BIT_SHIFT_WKFMCAM_RWD_8821C 0 -+#define BIT_MASK_WKFMCAM_RWD_8821C 0xffffffffL -+#define BIT_WKFMCAM_RWD_8821C(x) \ -+ (((x) & BIT_MASK_WKFMCAM_RWD_8821C) << BIT_SHIFT_WKFMCAM_RWD_8821C) -+#define BITS_WKFMCAM_RWD_8821C \ -+ (BIT_MASK_WKFMCAM_RWD_8821C << BIT_SHIFT_WKFMCAM_RWD_8821C) -+#define BIT_CLEAR_WKFMCAM_RWD_8821C(x) ((x) & (~BITS_WKFMCAM_RWD_8821C)) -+#define BIT_GET_WKFMCAM_RWD_8821C(x) \ -+ (((x) >> BIT_SHIFT_WKFMCAM_RWD_8821C) & BIT_MASK_WKFMCAM_RWD_8821C) -+#define BIT_SET_WKFMCAM_RWD_8821C(x, v) \ -+ (BIT_CLEAR_WKFMCAM_RWD_8821C(x) | BIT_WKFMCAM_RWD_8821C(v)) -+ -+/* 2 REG_RXFLTMAP0_8821C (RX FILTER MAP GROUP 0) */ -+#define BIT_MGTFLT15EN_8821C BIT(15) -+#define BIT_MGTFLT14EN_8821C BIT(14) -+#define BIT_MGTFLT13EN_8821C BIT(13) -+#define BIT_MGTFLT12EN_8821C BIT(12) -+#define BIT_MGTFLT11EN_8821C BIT(11) -+#define BIT_MGTFLT10EN_8821C BIT(10) -+#define BIT_MGTFLT9EN_8821C BIT(9) -+#define BIT_MGTFLT8EN_8821C BIT(8) -+#define BIT_MGTFLT7EN_8821C BIT(7) -+#define BIT_MGTFLT6EN_8821C BIT(6) -+#define BIT_MGTFLT5EN_8821C BIT(5) -+#define BIT_MGTFLT4EN_8821C BIT(4) -+#define BIT_MGTFLT3EN_8821C BIT(3) -+#define BIT_MGTFLT2EN_8821C BIT(2) -+#define BIT_MGTFLT1EN_8821C BIT(1) -+#define BIT_MGTFLT0EN_8821C BIT(0) -+ -+/* 2 REG_RXFLTMAP1_8821C (RX FILTER MAP GROUP 1) */ -+#define BIT_CTRLFLT15EN_8821C BIT(15) -+#define BIT_CTRLFLT14EN_8821C BIT(14) -+#define BIT_CTRLFLT13EN_8821C BIT(13) -+#define BIT_CTRLFLT12EN_8821C BIT(12) -+#define BIT_CTRLFLT11EN_8821C BIT(11) -+#define BIT_CTRLFLT10EN_8821C BIT(10) -+#define BIT_CTRLFLT9EN_8821C BIT(9) -+#define BIT_CTRLFLT8EN_8821C BIT(8) -+#define BIT_CTRLFLT7EN_8821C BIT(7) -+#define BIT_CTRLFLT6EN_8821C BIT(6) -+#define BIT_CTRLFLT5EN_8821C BIT(5) -+#define BIT_CTRLFLT4EN_8821C BIT(4) -+#define BIT_CTRLFLT3EN_8821C BIT(3) -+#define BIT_CTRLFLT2EN_8821C BIT(2) -+#define BIT_CTRLFLT1EN_8821C BIT(1) -+#define BIT_CTRLFLT0EN_8821C BIT(0) -+ -+/* 2 REG_RXFLTMAP2_8821C (RX FILTER MAP GROUP 2) */ -+#define BIT_DATAFLT15EN_8821C BIT(15) -+#define BIT_DATAFLT14EN_8821C BIT(14) -+#define BIT_DATAFLT13EN_8821C BIT(13) -+#define BIT_DATAFLT12EN_8821C BIT(12) -+#define BIT_DATAFLT11EN_8821C BIT(11) -+#define BIT_DATAFLT10EN_8821C BIT(10) -+#define BIT_DATAFLT9EN_8821C BIT(9) -+#define BIT_DATAFLT8EN_8821C BIT(8) -+#define BIT_DATAFLT7EN_8821C BIT(7) -+#define BIT_DATAFLT6EN_8821C BIT(6) -+#define BIT_DATAFLT5EN_8821C BIT(5) -+#define BIT_DATAFLT4EN_8821C BIT(4) -+#define BIT_DATAFLT3EN_8821C BIT(3) -+#define BIT_DATAFLT2EN_8821C BIT(2) -+#define BIT_DATAFLT1EN_8821C BIT(1) -+#define BIT_DATAFLT0EN_8821C BIT(0) -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_BCN_PSR_RPT_8821C (BEACON PARSER REPORT REGISTER) */ -+ -+#define BIT_SHIFT_DTIM_CNT_8821C 24 -+#define BIT_MASK_DTIM_CNT_8821C 0xff -+#define BIT_DTIM_CNT_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_CNT_8821C) << BIT_SHIFT_DTIM_CNT_8821C) -+#define BITS_DTIM_CNT_8821C \ -+ (BIT_MASK_DTIM_CNT_8821C << BIT_SHIFT_DTIM_CNT_8821C) -+#define BIT_CLEAR_DTIM_CNT_8821C(x) ((x) & (~BITS_DTIM_CNT_8821C)) -+#define BIT_GET_DTIM_CNT_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT_8821C) & BIT_MASK_DTIM_CNT_8821C) -+#define BIT_SET_DTIM_CNT_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_CNT_8821C(x) | BIT_DTIM_CNT_8821C(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD_8821C 16 -+#define BIT_MASK_DTIM_PERIOD_8821C 0xff -+#define BIT_DTIM_PERIOD_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD_8821C) << BIT_SHIFT_DTIM_PERIOD_8821C) -+#define BITS_DTIM_PERIOD_8821C \ -+ (BIT_MASK_DTIM_PERIOD_8821C << BIT_SHIFT_DTIM_PERIOD_8821C) -+#define BIT_CLEAR_DTIM_PERIOD_8821C(x) ((x) & (~BITS_DTIM_PERIOD_8821C)) -+#define BIT_GET_DTIM_PERIOD_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD_8821C) & BIT_MASK_DTIM_PERIOD_8821C) -+#define BIT_SET_DTIM_PERIOD_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD_8821C(x) | BIT_DTIM_PERIOD_8821C(v)) -+ -+#define BIT_DTIM_8821C BIT(15) -+#define BIT_TIM_8821C BIT(14) -+#define BIT_RPT_VALID_8821C BIT(13) -+ -+#define BIT_SHIFT_PS_AID_0_8821C 0 -+#define BIT_MASK_PS_AID_0_8821C 0x7ff -+#define BIT_PS_AID_0_8821C(x) \ -+ (((x) & BIT_MASK_PS_AID_0_8821C) << BIT_SHIFT_PS_AID_0_8821C) -+#define BITS_PS_AID_0_8821C \ -+ (BIT_MASK_PS_AID_0_8821C << BIT_SHIFT_PS_AID_0_8821C) -+#define BIT_CLEAR_PS_AID_0_8821C(x) ((x) & (~BITS_PS_AID_0_8821C)) -+#define BIT_GET_PS_AID_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_0_8821C) & BIT_MASK_PS_AID_0_8821C) -+#define BIT_SET_PS_AID_0_8821C(x, v) \ -+ (BIT_CLEAR_PS_AID_0_8821C(x) | BIT_PS_AID_0_8821C(v)) -+ -+/* 2 REG_FLC_RPC_8821C (FW LPS CONDITION -- RX PKT COUNTER) */ -+ -+#define BIT_SHIFT_FLC_RPC_8821C 0 -+#define BIT_MASK_FLC_RPC_8821C 0xff -+#define BIT_FLC_RPC_8821C(x) \ -+ (((x) & BIT_MASK_FLC_RPC_8821C) << BIT_SHIFT_FLC_RPC_8821C) -+#define BITS_FLC_RPC_8821C (BIT_MASK_FLC_RPC_8821C << BIT_SHIFT_FLC_RPC_8821C) -+#define BIT_CLEAR_FLC_RPC_8821C(x) ((x) & (~BITS_FLC_RPC_8821C)) -+#define BIT_GET_FLC_RPC_8821C(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPC_8821C) & BIT_MASK_FLC_RPC_8821C) -+#define BIT_SET_FLC_RPC_8821C(x, v) \ -+ (BIT_CLEAR_FLC_RPC_8821C(x) | BIT_FLC_RPC_8821C(v)) -+ -+/* 2 REG_FLC_RPCT_8821C (FLC_RPC THRESHOLD) */ -+ -+#define BIT_SHIFT_FLC_RPCT_8821C 0 -+#define BIT_MASK_FLC_RPCT_8821C 0xff -+#define BIT_FLC_RPCT_8821C(x) \ -+ (((x) & BIT_MASK_FLC_RPCT_8821C) << BIT_SHIFT_FLC_RPCT_8821C) -+#define BITS_FLC_RPCT_8821C \ -+ (BIT_MASK_FLC_RPCT_8821C << BIT_SHIFT_FLC_RPCT_8821C) -+#define BIT_CLEAR_FLC_RPCT_8821C(x) ((x) & (~BITS_FLC_RPCT_8821C)) -+#define BIT_GET_FLC_RPCT_8821C(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPCT_8821C) & BIT_MASK_FLC_RPCT_8821C) -+#define BIT_SET_FLC_RPCT_8821C(x, v) \ -+ (BIT_CLEAR_FLC_RPCT_8821C(x) | BIT_FLC_RPCT_8821C(v)) -+ -+/* 2 REG_FLC_PTS_8821C (PKT TYPE SELECTION OF FLC_RPC T) */ -+#define BIT_CMF_8821C BIT(2) -+#define BIT_CCF_8821C BIT(1) -+#define BIT_CDF_8821C BIT(0) -+ -+/* 2 REG_FLC_TRPC_8821C (TIMER OF FLC_RPC) */ -+#define BIT_FLC_RPCT_V1_8821C BIT(7) -+#define BIT_MODE_8821C BIT(6) -+ -+#define BIT_SHIFT_TRPCD_8821C 0 -+#define BIT_MASK_TRPCD_8821C 0x3f -+#define BIT_TRPCD_8821C(x) \ -+ (((x) & BIT_MASK_TRPCD_8821C) << BIT_SHIFT_TRPCD_8821C) -+#define BITS_TRPCD_8821C (BIT_MASK_TRPCD_8821C << BIT_SHIFT_TRPCD_8821C) -+#define BIT_CLEAR_TRPCD_8821C(x) ((x) & (~BITS_TRPCD_8821C)) -+#define BIT_GET_TRPCD_8821C(x) \ -+ (((x) >> BIT_SHIFT_TRPCD_8821C) & BIT_MASK_TRPCD_8821C) -+#define BIT_SET_TRPCD_8821C(x, v) \ -+ (BIT_CLEAR_TRPCD_8821C(x) | BIT_TRPCD_8821C(v)) -+ -+/* 2 REG_RXPKTMON_CTRL_8821C */ -+ -+#define BIT_SHIFT_RXBKQPKT_SEQ_8821C 20 -+#define BIT_MASK_RXBKQPKT_SEQ_8821C 0xf -+#define BIT_RXBKQPKT_SEQ_8821C(x) \ -+ (((x) & BIT_MASK_RXBKQPKT_SEQ_8821C) << BIT_SHIFT_RXBKQPKT_SEQ_8821C) -+#define BITS_RXBKQPKT_SEQ_8821C \ -+ (BIT_MASK_RXBKQPKT_SEQ_8821C << BIT_SHIFT_RXBKQPKT_SEQ_8821C) -+#define BIT_CLEAR_RXBKQPKT_SEQ_8821C(x) ((x) & (~BITS_RXBKQPKT_SEQ_8821C)) -+#define BIT_GET_RXBKQPKT_SEQ_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXBKQPKT_SEQ_8821C) & BIT_MASK_RXBKQPKT_SEQ_8821C) -+#define BIT_SET_RXBKQPKT_SEQ_8821C(x, v) \ -+ (BIT_CLEAR_RXBKQPKT_SEQ_8821C(x) | BIT_RXBKQPKT_SEQ_8821C(v)) -+ -+#define BIT_SHIFT_RXBEQPKT_SEQ_8821C 16 -+#define BIT_MASK_RXBEQPKT_SEQ_8821C 0xf -+#define BIT_RXBEQPKT_SEQ_8821C(x) \ -+ (((x) & BIT_MASK_RXBEQPKT_SEQ_8821C) << BIT_SHIFT_RXBEQPKT_SEQ_8821C) -+#define BITS_RXBEQPKT_SEQ_8821C \ -+ (BIT_MASK_RXBEQPKT_SEQ_8821C << BIT_SHIFT_RXBEQPKT_SEQ_8821C) -+#define BIT_CLEAR_RXBEQPKT_SEQ_8821C(x) ((x) & (~BITS_RXBEQPKT_SEQ_8821C)) -+#define BIT_GET_RXBEQPKT_SEQ_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXBEQPKT_SEQ_8821C) & BIT_MASK_RXBEQPKT_SEQ_8821C) -+#define BIT_SET_RXBEQPKT_SEQ_8821C(x, v) \ -+ (BIT_CLEAR_RXBEQPKT_SEQ_8821C(x) | BIT_RXBEQPKT_SEQ_8821C(v)) -+ -+#define BIT_SHIFT_RXVIQPKT_SEQ_8821C 12 -+#define BIT_MASK_RXVIQPKT_SEQ_8821C 0xf -+#define BIT_RXVIQPKT_SEQ_8821C(x) \ -+ (((x) & BIT_MASK_RXVIQPKT_SEQ_8821C) << BIT_SHIFT_RXVIQPKT_SEQ_8821C) -+#define BITS_RXVIQPKT_SEQ_8821C \ -+ (BIT_MASK_RXVIQPKT_SEQ_8821C << BIT_SHIFT_RXVIQPKT_SEQ_8821C) -+#define BIT_CLEAR_RXVIQPKT_SEQ_8821C(x) ((x) & (~BITS_RXVIQPKT_SEQ_8821C)) -+#define BIT_GET_RXVIQPKT_SEQ_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXVIQPKT_SEQ_8821C) & BIT_MASK_RXVIQPKT_SEQ_8821C) -+#define BIT_SET_RXVIQPKT_SEQ_8821C(x, v) \ -+ (BIT_CLEAR_RXVIQPKT_SEQ_8821C(x) | BIT_RXVIQPKT_SEQ_8821C(v)) -+ -+#define BIT_SHIFT_RXVOQPKT_SEQ_8821C 8 -+#define BIT_MASK_RXVOQPKT_SEQ_8821C 0xf -+#define BIT_RXVOQPKT_SEQ_8821C(x) \ -+ (((x) & BIT_MASK_RXVOQPKT_SEQ_8821C) << BIT_SHIFT_RXVOQPKT_SEQ_8821C) -+#define BITS_RXVOQPKT_SEQ_8821C \ -+ (BIT_MASK_RXVOQPKT_SEQ_8821C << BIT_SHIFT_RXVOQPKT_SEQ_8821C) -+#define BIT_CLEAR_RXVOQPKT_SEQ_8821C(x) ((x) & (~BITS_RXVOQPKT_SEQ_8821C)) -+#define BIT_GET_RXVOQPKT_SEQ_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXVOQPKT_SEQ_8821C) & BIT_MASK_RXVOQPKT_SEQ_8821C) -+#define BIT_SET_RXVOQPKT_SEQ_8821C(x, v) \ -+ (BIT_CLEAR_RXVOQPKT_SEQ_8821C(x) | BIT_RXVOQPKT_SEQ_8821C(v)) -+ -+#define BIT_RXBKQPKT_ERR_8821C BIT(7) -+#define BIT_RXBEQPKT_ERR_8821C BIT(6) -+#define BIT_RXVIQPKT_ERR_8821C BIT(5) -+#define BIT_RXVOQPKT_ERR_8821C BIT(4) -+#define BIT_RXDMA_MON_EN_8821C BIT(2) -+#define BIT_RXPKT_MON_RST_8821C BIT(1) -+#define BIT_RXPKT_MON_EN_8821C BIT(0) -+ -+/* 2 REG_STATE_MON_8821C */ -+ -+#define BIT_SHIFT_STATE_SEL_8821C 24 -+#define BIT_MASK_STATE_SEL_8821C 0x1f -+#define BIT_STATE_SEL_8821C(x) \ -+ (((x) & BIT_MASK_STATE_SEL_8821C) << BIT_SHIFT_STATE_SEL_8821C) -+#define BITS_STATE_SEL_8821C \ -+ (BIT_MASK_STATE_SEL_8821C << BIT_SHIFT_STATE_SEL_8821C) -+#define BIT_CLEAR_STATE_SEL_8821C(x) ((x) & (~BITS_STATE_SEL_8821C)) -+#define BIT_GET_STATE_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_STATE_SEL_8821C) & BIT_MASK_STATE_SEL_8821C) -+#define BIT_SET_STATE_SEL_8821C(x, v) \ -+ (BIT_CLEAR_STATE_SEL_8821C(x) | BIT_STATE_SEL_8821C(v)) -+ -+#define BIT_SHIFT_STATE_INFO_8821C 8 -+#define BIT_MASK_STATE_INFO_8821C 0xff -+#define BIT_STATE_INFO_8821C(x) \ -+ (((x) & BIT_MASK_STATE_INFO_8821C) << BIT_SHIFT_STATE_INFO_8821C) -+#define BITS_STATE_INFO_8821C \ -+ (BIT_MASK_STATE_INFO_8821C << BIT_SHIFT_STATE_INFO_8821C) -+#define BIT_CLEAR_STATE_INFO_8821C(x) ((x) & (~BITS_STATE_INFO_8821C)) -+#define BIT_GET_STATE_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_STATE_INFO_8821C) & BIT_MASK_STATE_INFO_8821C) -+#define BIT_SET_STATE_INFO_8821C(x, v) \ -+ (BIT_CLEAR_STATE_INFO_8821C(x) | BIT_STATE_INFO_8821C(v)) -+ -+#define BIT_UPD_NXT_STATE_8821C BIT(7) -+ -+#define BIT_SHIFT_CUR_STATE_8821C 0 -+#define BIT_MASK_CUR_STATE_8821C 0x7f -+#define BIT_CUR_STATE_8821C(x) \ -+ (((x) & BIT_MASK_CUR_STATE_8821C) << BIT_SHIFT_CUR_STATE_8821C) -+#define BITS_CUR_STATE_8821C \ -+ (BIT_MASK_CUR_STATE_8821C << BIT_SHIFT_CUR_STATE_8821C) -+#define BIT_CLEAR_CUR_STATE_8821C(x) ((x) & (~BITS_CUR_STATE_8821C)) -+#define BIT_GET_CUR_STATE_8821C(x) \ -+ (((x) >> BIT_SHIFT_CUR_STATE_8821C) & BIT_MASK_CUR_STATE_8821C) -+#define BIT_SET_CUR_STATE_8821C(x, v) \ -+ (BIT_CLEAR_CUR_STATE_8821C(x) | BIT_CUR_STATE_8821C(v)) -+ -+/* 2 REG_ERROR_MON_8821C */ -+#define BIT_MACRX_ERR_1_8821C BIT(17) -+#define BIT_MACRX_ERR_0_8821C BIT(16) -+#define BIT_MACTX_ERR_3_8821C BIT(3) -+#define BIT_MACTX_ERR_2_8821C BIT(2) -+#define BIT_MACTX_ERR_1_8821C BIT(1) -+#define BIT_MACTX_ERR_0_8821C BIT(0) -+ -+/* 2 REG_SEARCH_MACID_8821C */ -+#define BIT_EN_TXRPTBUF_CLK_8821C BIT(31) -+ -+#define BIT_SHIFT_INFO_INDEX_OFFSET_8821C 16 -+#define BIT_MASK_INFO_INDEX_OFFSET_8821C 0x1fff -+#define BIT_INFO_INDEX_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_INFO_INDEX_OFFSET_8821C) \ -+ << BIT_SHIFT_INFO_INDEX_OFFSET_8821C) -+#define BITS_INFO_INDEX_OFFSET_8821C \ -+ (BIT_MASK_INFO_INDEX_OFFSET_8821C << BIT_SHIFT_INFO_INDEX_OFFSET_8821C) -+#define BIT_CLEAR_INFO_INDEX_OFFSET_8821C(x) \ -+ ((x) & (~BITS_INFO_INDEX_OFFSET_8821C)) -+#define BIT_GET_INFO_INDEX_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_INFO_INDEX_OFFSET_8821C) & \ -+ BIT_MASK_INFO_INDEX_OFFSET_8821C) -+#define BIT_SET_INFO_INDEX_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_INFO_INDEX_OFFSET_8821C(x) | BIT_INFO_INDEX_OFFSET_8821C(v)) -+ -+#define BIT_WMAC_SRCH_FIFOFULL_8821C BIT(15) -+#define BIT_DIS_INFOSRCH_8821C BIT(14) -+#define BIT_DISABLE_B0_8821C BIT(13) -+ -+#define BIT_SHIFT_INFO_ADDR_OFFSET_8821C 0 -+#define BIT_MASK_INFO_ADDR_OFFSET_8821C 0x1fff -+#define BIT_INFO_ADDR_OFFSET_8821C(x) \ -+ (((x) & BIT_MASK_INFO_ADDR_OFFSET_8821C) \ -+ << BIT_SHIFT_INFO_ADDR_OFFSET_8821C) -+#define BITS_INFO_ADDR_OFFSET_8821C \ -+ (BIT_MASK_INFO_ADDR_OFFSET_8821C << BIT_SHIFT_INFO_ADDR_OFFSET_8821C) -+#define BIT_CLEAR_INFO_ADDR_OFFSET_8821C(x) \ -+ ((x) & (~BITS_INFO_ADDR_OFFSET_8821C)) -+#define BIT_GET_INFO_ADDR_OFFSET_8821C(x) \ -+ (((x) >> BIT_SHIFT_INFO_ADDR_OFFSET_8821C) & \ -+ BIT_MASK_INFO_ADDR_OFFSET_8821C) -+#define BIT_SET_INFO_ADDR_OFFSET_8821C(x, v) \ -+ (BIT_CLEAR_INFO_ADDR_OFFSET_8821C(x) | BIT_INFO_ADDR_OFFSET_8821C(v)) -+ -+/* 2 REG_BT_COEX_TABLE_8821C (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_COEX_TABLE_1_8821C 0 -+#define BIT_MASK_COEX_TABLE_1_8821C 0xffffffffL -+#define BIT_COEX_TABLE_1_8821C(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_1_8821C) << BIT_SHIFT_COEX_TABLE_1_8821C) -+#define BITS_COEX_TABLE_1_8821C \ -+ (BIT_MASK_COEX_TABLE_1_8821C << BIT_SHIFT_COEX_TABLE_1_8821C) -+#define BIT_CLEAR_COEX_TABLE_1_8821C(x) ((x) & (~BITS_COEX_TABLE_1_8821C)) -+#define BIT_GET_COEX_TABLE_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_1_8821C) & BIT_MASK_COEX_TABLE_1_8821C) -+#define BIT_SET_COEX_TABLE_1_8821C(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_1_8821C(x) | BIT_COEX_TABLE_1_8821C(v)) -+ -+/* 2 REG_BT_COEX_TABLE2_8821C (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_COEX_TABLE_2_8821C 0 -+#define BIT_MASK_COEX_TABLE_2_8821C 0xffffffffL -+#define BIT_COEX_TABLE_2_8821C(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_2_8821C) << BIT_SHIFT_COEX_TABLE_2_8821C) -+#define BITS_COEX_TABLE_2_8821C \ -+ (BIT_MASK_COEX_TABLE_2_8821C << BIT_SHIFT_COEX_TABLE_2_8821C) -+#define BIT_CLEAR_COEX_TABLE_2_8821C(x) ((x) & (~BITS_COEX_TABLE_2_8821C)) -+#define BIT_GET_COEX_TABLE_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_2_8821C) & BIT_MASK_COEX_TABLE_2_8821C) -+#define BIT_SET_COEX_TABLE_2_8821C(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_2_8821C(x) | BIT_COEX_TABLE_2_8821C(v)) -+ -+/* 2 REG_BT_COEX_BREAK_TABLE_8821C (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_BREAK_TABLE_2_8821C 16 -+#define BIT_MASK_BREAK_TABLE_2_8821C 0xffff -+#define BIT_BREAK_TABLE_2_8821C(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_2_8821C) << BIT_SHIFT_BREAK_TABLE_2_8821C) -+#define BITS_BREAK_TABLE_2_8821C \ -+ (BIT_MASK_BREAK_TABLE_2_8821C << BIT_SHIFT_BREAK_TABLE_2_8821C) -+#define BIT_CLEAR_BREAK_TABLE_2_8821C(x) ((x) & (~BITS_BREAK_TABLE_2_8821C)) -+#define BIT_GET_BREAK_TABLE_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_2_8821C) & BIT_MASK_BREAK_TABLE_2_8821C) -+#define BIT_SET_BREAK_TABLE_2_8821C(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_2_8821C(x) | BIT_BREAK_TABLE_2_8821C(v)) -+ -+#define BIT_SHIFT_BREAK_TABLE_1_8821C 0 -+#define BIT_MASK_BREAK_TABLE_1_8821C 0xffff -+#define BIT_BREAK_TABLE_1_8821C(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_1_8821C) << BIT_SHIFT_BREAK_TABLE_1_8821C) -+#define BITS_BREAK_TABLE_1_8821C \ -+ (BIT_MASK_BREAK_TABLE_1_8821C << BIT_SHIFT_BREAK_TABLE_1_8821C) -+#define BIT_CLEAR_BREAK_TABLE_1_8821C(x) ((x) & (~BITS_BREAK_TABLE_1_8821C)) -+#define BIT_GET_BREAK_TABLE_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_1_8821C) & BIT_MASK_BREAK_TABLE_1_8821C) -+#define BIT_SET_BREAK_TABLE_1_8821C(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_1_8821C(x) | BIT_BREAK_TABLE_1_8821C(v)) -+ -+/* 2 REG_BT_COEX_TABLE_H_8821C (BT-COEXISTENCE CONTROL REGISTER) */ -+#define BIT_PRI_MASK_RX_RESP_V1_8821C BIT(30) -+#define BIT_PRI_MASK_RXOFDM_V1_8821C BIT(29) -+#define BIT_PRI_MASK_RXCCK_V1_8821C BIT(28) -+ -+#define BIT_SHIFT_PRI_MASK_TXAC_8821C 21 -+#define BIT_MASK_PRI_MASK_TXAC_8821C 0x7f -+#define BIT_PRI_MASK_TXAC_8821C(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TXAC_8821C) << BIT_SHIFT_PRI_MASK_TXAC_8821C) -+#define BITS_PRI_MASK_TXAC_8821C \ -+ (BIT_MASK_PRI_MASK_TXAC_8821C << BIT_SHIFT_PRI_MASK_TXAC_8821C) -+#define BIT_CLEAR_PRI_MASK_TXAC_8821C(x) ((x) & (~BITS_PRI_MASK_TXAC_8821C)) -+#define BIT_GET_PRI_MASK_TXAC_8821C(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TXAC_8821C) & BIT_MASK_PRI_MASK_TXAC_8821C) -+#define BIT_SET_PRI_MASK_TXAC_8821C(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TXAC_8821C(x) | BIT_PRI_MASK_TXAC_8821C(v)) -+ -+#define BIT_SHIFT_PRI_MASK_NAV_8821C 13 -+#define BIT_MASK_PRI_MASK_NAV_8821C 0xff -+#define BIT_PRI_MASK_NAV_8821C(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NAV_8821C) << BIT_SHIFT_PRI_MASK_NAV_8821C) -+#define BITS_PRI_MASK_NAV_8821C \ -+ (BIT_MASK_PRI_MASK_NAV_8821C << BIT_SHIFT_PRI_MASK_NAV_8821C) -+#define BIT_CLEAR_PRI_MASK_NAV_8821C(x) ((x) & (~BITS_PRI_MASK_NAV_8821C)) -+#define BIT_GET_PRI_MASK_NAV_8821C(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NAV_8821C) & BIT_MASK_PRI_MASK_NAV_8821C) -+#define BIT_SET_PRI_MASK_NAV_8821C(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NAV_8821C(x) | BIT_PRI_MASK_NAV_8821C(v)) -+ -+#define BIT_PRI_MASK_CCK_V1_8821C BIT(12) -+#define BIT_PRI_MASK_OFDM_V1_8821C BIT(11) -+#define BIT_PRI_MASK_RTY_V1_8821C BIT(10) -+ -+#define BIT_SHIFT_PRI_MASK_NUM_8821C 6 -+#define BIT_MASK_PRI_MASK_NUM_8821C 0xf -+#define BIT_PRI_MASK_NUM_8821C(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NUM_8821C) << BIT_SHIFT_PRI_MASK_NUM_8821C) -+#define BITS_PRI_MASK_NUM_8821C \ -+ (BIT_MASK_PRI_MASK_NUM_8821C << BIT_SHIFT_PRI_MASK_NUM_8821C) -+#define BIT_CLEAR_PRI_MASK_NUM_8821C(x) ((x) & (~BITS_PRI_MASK_NUM_8821C)) -+#define BIT_GET_PRI_MASK_NUM_8821C(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NUM_8821C) & BIT_MASK_PRI_MASK_NUM_8821C) -+#define BIT_SET_PRI_MASK_NUM_8821C(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NUM_8821C(x) | BIT_PRI_MASK_NUM_8821C(v)) -+ -+#define BIT_SHIFT_PRI_MASK_TYPE_8821C 2 -+#define BIT_MASK_PRI_MASK_TYPE_8821C 0xf -+#define BIT_PRI_MASK_TYPE_8821C(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TYPE_8821C) << BIT_SHIFT_PRI_MASK_TYPE_8821C) -+#define BITS_PRI_MASK_TYPE_8821C \ -+ (BIT_MASK_PRI_MASK_TYPE_8821C << BIT_SHIFT_PRI_MASK_TYPE_8821C) -+#define BIT_CLEAR_PRI_MASK_TYPE_8821C(x) ((x) & (~BITS_PRI_MASK_TYPE_8821C)) -+#define BIT_GET_PRI_MASK_TYPE_8821C(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TYPE_8821C) & BIT_MASK_PRI_MASK_TYPE_8821C) -+#define BIT_SET_PRI_MASK_TYPE_8821C(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TYPE_8821C(x) | BIT_PRI_MASK_TYPE_8821C(v)) -+ -+#define BIT_OOB_V1_8821C BIT(1) -+#define BIT_ANT_SEL_V1_8821C BIT(0) -+ -+/* 2 REG_RXCMD_0_8821C */ -+#define BIT_RXCMD_EN_8821C BIT(31) -+ -+#define BIT_SHIFT_RXCMD_INFO_8821C 0 -+#define BIT_MASK_RXCMD_INFO_8821C 0x7fffffffL -+#define BIT_RXCMD_INFO_8821C(x) \ -+ (((x) & BIT_MASK_RXCMD_INFO_8821C) << BIT_SHIFT_RXCMD_INFO_8821C) -+#define BITS_RXCMD_INFO_8821C \ -+ (BIT_MASK_RXCMD_INFO_8821C << BIT_SHIFT_RXCMD_INFO_8821C) -+#define BIT_CLEAR_RXCMD_INFO_8821C(x) ((x) & (~BITS_RXCMD_INFO_8821C)) -+#define BIT_GET_RXCMD_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_INFO_8821C) & BIT_MASK_RXCMD_INFO_8821C) -+#define BIT_SET_RXCMD_INFO_8821C(x, v) \ -+ (BIT_CLEAR_RXCMD_INFO_8821C(x) | BIT_RXCMD_INFO_8821C(v)) -+ -+/* 2 REG_RXCMD_1_8821C */ -+ -+#define BIT_SHIFT_CSI_RADDR_LATCH_8821C 24 -+#define BIT_MASK_CSI_RADDR_LATCH_8821C 0xff -+#define BIT_CSI_RADDR_LATCH_8821C(x) \ -+ (((x) & BIT_MASK_CSI_RADDR_LATCH_8821C) \ -+ << BIT_SHIFT_CSI_RADDR_LATCH_8821C) -+#define BITS_CSI_RADDR_LATCH_8821C \ -+ (BIT_MASK_CSI_RADDR_LATCH_8821C << BIT_SHIFT_CSI_RADDR_LATCH_8821C) -+#define BIT_CLEAR_CSI_RADDR_LATCH_8821C(x) ((x) & (~BITS_CSI_RADDR_LATCH_8821C)) -+#define BIT_GET_CSI_RADDR_LATCH_8821C(x) \ -+ (((x) >> BIT_SHIFT_CSI_RADDR_LATCH_8821C) & \ -+ BIT_MASK_CSI_RADDR_LATCH_8821C) -+#define BIT_SET_CSI_RADDR_LATCH_8821C(x, v) \ -+ (BIT_CLEAR_CSI_RADDR_LATCH_8821C(x) | BIT_CSI_RADDR_LATCH_8821C(v)) -+ -+#define BIT_SHIFT_CSI_WADDR_LATCH_8821C 16 -+#define BIT_MASK_CSI_WADDR_LATCH_8821C 0xff -+#define BIT_CSI_WADDR_LATCH_8821C(x) \ -+ (((x) & BIT_MASK_CSI_WADDR_LATCH_8821C) \ -+ << BIT_SHIFT_CSI_WADDR_LATCH_8821C) -+#define BITS_CSI_WADDR_LATCH_8821C \ -+ (BIT_MASK_CSI_WADDR_LATCH_8821C << BIT_SHIFT_CSI_WADDR_LATCH_8821C) -+#define BIT_CLEAR_CSI_WADDR_LATCH_8821C(x) ((x) & (~BITS_CSI_WADDR_LATCH_8821C)) -+#define BIT_GET_CSI_WADDR_LATCH_8821C(x) \ -+ (((x) >> BIT_SHIFT_CSI_WADDR_LATCH_8821C) & \ -+ BIT_MASK_CSI_WADDR_LATCH_8821C) -+#define BIT_SET_CSI_WADDR_LATCH_8821C(x, v) \ -+ (BIT_CLEAR_CSI_WADDR_LATCH_8821C(x) | BIT_CSI_WADDR_LATCH_8821C(v)) -+ -+#define BIT_SHIFT_RXCMD_PRD_8821C 0 -+#define BIT_MASK_RXCMD_PRD_8821C 0xffff -+#define BIT_RXCMD_PRD_8821C(x) \ -+ (((x) & BIT_MASK_RXCMD_PRD_8821C) << BIT_SHIFT_RXCMD_PRD_8821C) -+#define BITS_RXCMD_PRD_8821C \ -+ (BIT_MASK_RXCMD_PRD_8821C << BIT_SHIFT_RXCMD_PRD_8821C) -+#define BIT_CLEAR_RXCMD_PRD_8821C(x) ((x) & (~BITS_RXCMD_PRD_8821C)) -+#define BIT_GET_RXCMD_PRD_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_PRD_8821C) & BIT_MASK_RXCMD_PRD_8821C) -+#define BIT_SET_RXCMD_PRD_8821C(x, v) \ -+ (BIT_CLEAR_RXCMD_PRD_8821C(x) | BIT_RXCMD_PRD_8821C(v)) -+ -+/* 2 REG_WMAC_RESP_TXINFO_8821C (RESPONSE TXINFO REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_MFB_8821C 25 -+#define BIT_MASK_WMAC_RESP_MFB_8821C 0x7f -+#define BIT_WMAC_RESP_MFB_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_MFB_8821C) << BIT_SHIFT_WMAC_RESP_MFB_8821C) -+#define BITS_WMAC_RESP_MFB_8821C \ -+ (BIT_MASK_WMAC_RESP_MFB_8821C << BIT_SHIFT_WMAC_RESP_MFB_8821C) -+#define BIT_CLEAR_WMAC_RESP_MFB_8821C(x) ((x) & (~BITS_WMAC_RESP_MFB_8821C)) -+#define BIT_GET_WMAC_RESP_MFB_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_MFB_8821C) & BIT_MASK_WMAC_RESP_MFB_8821C) -+#define BIT_SET_WMAC_RESP_MFB_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_MFB_8821C(x) | BIT_WMAC_RESP_MFB_8821C(v)) -+ -+#define BIT_SHIFT_WMAC_ANTINF_SEL_8821C 23 -+#define BIT_MASK_WMAC_ANTINF_SEL_8821C 0x3 -+#define BIT_WMAC_ANTINF_SEL_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_ANTINF_SEL_8821C) \ -+ << BIT_SHIFT_WMAC_ANTINF_SEL_8821C) -+#define BITS_WMAC_ANTINF_SEL_8821C \ -+ (BIT_MASK_WMAC_ANTINF_SEL_8821C << BIT_SHIFT_WMAC_ANTINF_SEL_8821C) -+#define BIT_CLEAR_WMAC_ANTINF_SEL_8821C(x) ((x) & (~BITS_WMAC_ANTINF_SEL_8821C)) -+#define BIT_GET_WMAC_ANTINF_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTINF_SEL_8821C) & \ -+ BIT_MASK_WMAC_ANTINF_SEL_8821C) -+#define BIT_SET_WMAC_ANTINF_SEL_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_ANTINF_SEL_8821C(x) | BIT_WMAC_ANTINF_SEL_8821C(v)) -+ -+#define BIT_SHIFT_WMAC_ANTSEL_SEL_8821C 21 -+#define BIT_MASK_WMAC_ANTSEL_SEL_8821C 0x3 -+#define BIT_WMAC_ANTSEL_SEL_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_ANTSEL_SEL_8821C) \ -+ << BIT_SHIFT_WMAC_ANTSEL_SEL_8821C) -+#define BITS_WMAC_ANTSEL_SEL_8821C \ -+ (BIT_MASK_WMAC_ANTSEL_SEL_8821C << BIT_SHIFT_WMAC_ANTSEL_SEL_8821C) -+#define BIT_CLEAR_WMAC_ANTSEL_SEL_8821C(x) ((x) & (~BITS_WMAC_ANTSEL_SEL_8821C)) -+#define BIT_GET_WMAC_ANTSEL_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTSEL_SEL_8821C) & \ -+ BIT_MASK_WMAC_ANTSEL_SEL_8821C) -+#define BIT_SET_WMAC_ANTSEL_SEL_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_ANTSEL_SEL_8821C(x) | BIT_WMAC_ANTSEL_SEL_8821C(v)) -+ -+#define BIT_SHIFT_R_WMAC_RESP_TXPOWER_8821C 18 -+#define BIT_MASK_R_WMAC_RESP_TXPOWER_8821C 0x7 -+#define BIT_R_WMAC_RESP_TXPOWER_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_RESP_TXPOWER_8821C) \ -+ << BIT_SHIFT_R_WMAC_RESP_TXPOWER_8821C) -+#define BITS_R_WMAC_RESP_TXPOWER_8821C \ -+ (BIT_MASK_R_WMAC_RESP_TXPOWER_8821C \ -+ << BIT_SHIFT_R_WMAC_RESP_TXPOWER_8821C) -+#define BIT_CLEAR_R_WMAC_RESP_TXPOWER_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_RESP_TXPOWER_8821C)) -+#define BIT_GET_R_WMAC_RESP_TXPOWER_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RESP_TXPOWER_8821C) & \ -+ BIT_MASK_R_WMAC_RESP_TXPOWER_8821C) -+#define BIT_SET_R_WMAC_RESP_TXPOWER_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_RESP_TXPOWER_8821C(x) | \ -+ BIT_R_WMAC_RESP_TXPOWER_8821C(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXANT_8821C 0 -+#define BIT_MASK_WMAC_RESP_TXANT_8821C 0x3ffff -+#define BIT_WMAC_RESP_TXANT_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXANT_8821C) \ -+ << BIT_SHIFT_WMAC_RESP_TXANT_8821C) -+#define BITS_WMAC_RESP_TXANT_8821C \ -+ (BIT_MASK_WMAC_RESP_TXANT_8821C << BIT_SHIFT_WMAC_RESP_TXANT_8821C) -+#define BIT_CLEAR_WMAC_RESP_TXANT_8821C(x) ((x) & (~BITS_WMAC_RESP_TXANT_8821C)) -+#define BIT_GET_WMAC_RESP_TXANT_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXANT_8821C) & \ -+ BIT_MASK_WMAC_RESP_TXANT_8821C) -+#define BIT_SET_WMAC_RESP_TXANT_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXANT_8821C(x) | BIT_WMAC_RESP_TXANT_8821C(v)) -+ -+/* 2 REG_BBPSF_CTRL_8821C */ -+#define BIT_CTL_IDLE_CLR_CSI_RPT_8821C BIT(31) -+#define BIT_WMAC_USE_NDPARATE_8821C BIT(30) -+ -+#define BIT_SHIFT_WMAC_CSI_RATE_8821C 24 -+#define BIT_MASK_WMAC_CSI_RATE_8821C 0x3f -+#define BIT_WMAC_CSI_RATE_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_CSI_RATE_8821C) << BIT_SHIFT_WMAC_CSI_RATE_8821C) -+#define BITS_WMAC_CSI_RATE_8821C \ -+ (BIT_MASK_WMAC_CSI_RATE_8821C << BIT_SHIFT_WMAC_CSI_RATE_8821C) -+#define BIT_CLEAR_WMAC_CSI_RATE_8821C(x) ((x) & (~BITS_WMAC_CSI_RATE_8821C)) -+#define BIT_GET_WMAC_CSI_RATE_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_CSI_RATE_8821C) & BIT_MASK_WMAC_CSI_RATE_8821C) -+#define BIT_SET_WMAC_CSI_RATE_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_CSI_RATE_8821C(x) | BIT_WMAC_CSI_RATE_8821C(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXRATE_8821C 16 -+#define BIT_MASK_WMAC_RESP_TXRATE_8821C 0xff -+#define BIT_WMAC_RESP_TXRATE_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXRATE_8821C) \ -+ << BIT_SHIFT_WMAC_RESP_TXRATE_8821C) -+#define BITS_WMAC_RESP_TXRATE_8821C \ -+ (BIT_MASK_WMAC_RESP_TXRATE_8821C << BIT_SHIFT_WMAC_RESP_TXRATE_8821C) -+#define BIT_CLEAR_WMAC_RESP_TXRATE_8821C(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXRATE_8821C)) -+#define BIT_GET_WMAC_RESP_TXRATE_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXRATE_8821C) & \ -+ BIT_MASK_WMAC_RESP_TXRATE_8821C) -+#define BIT_SET_WMAC_RESP_TXRATE_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXRATE_8821C(x) | BIT_WMAC_RESP_TXRATE_8821C(v)) -+ -+#define BIT_CSI_FORCE_RATE_EN_8821C BIT(15) -+ -+#define BIT_SHIFT_CSI_RSC_8821C 13 -+#define BIT_MASK_CSI_RSC_8821C 0x3 -+#define BIT_CSI_RSC_8821C(x) \ -+ (((x) & BIT_MASK_CSI_RSC_8821C) << BIT_SHIFT_CSI_RSC_8821C) -+#define BITS_CSI_RSC_8821C (BIT_MASK_CSI_RSC_8821C << BIT_SHIFT_CSI_RSC_8821C) -+#define BIT_CLEAR_CSI_RSC_8821C(x) ((x) & (~BITS_CSI_RSC_8821C)) -+#define BIT_GET_CSI_RSC_8821C(x) \ -+ (((x) >> BIT_SHIFT_CSI_RSC_8821C) & BIT_MASK_CSI_RSC_8821C) -+#define BIT_SET_CSI_RSC_8821C(x, v) \ -+ (BIT_CLEAR_CSI_RSC_8821C(x) | BIT_CSI_RSC_8821C(v)) -+ -+#define BIT_CSI_GID_SEL_8821C BIT(12) -+#define BIT_RDCSIMD_FLAG_TRIG_SEL_8821C BIT(11) -+#define BIT_NDPVLD_POS_RST_FFPTR_DIS_V1_8821C BIT(10) -+#define BIT_NDPVLD_PROTECT_RDRDY_DIS_8821C BIT(9) -+#define BIT_RDCSI_EMPTY_APPZERO_8821C BIT(8) -+#define BIT_BBPSF_MPDUCHKEN_8821C BIT(5) -+#define BIT_BBPSF_MHCHKEN_8821C BIT(4) -+#define BIT_BBPSF_ERRCHKEN_8821C BIT(3) -+ -+#define BIT_SHIFT_BBPSF_ERRTHR_8821C 0 -+#define BIT_MASK_BBPSF_ERRTHR_8821C 0x7 -+#define BIT_BBPSF_ERRTHR_8821C(x) \ -+ (((x) & BIT_MASK_BBPSF_ERRTHR_8821C) << BIT_SHIFT_BBPSF_ERRTHR_8821C) -+#define BITS_BBPSF_ERRTHR_8821C \ -+ (BIT_MASK_BBPSF_ERRTHR_8821C << BIT_SHIFT_BBPSF_ERRTHR_8821C) -+#define BIT_CLEAR_BBPSF_ERRTHR_8821C(x) ((x) & (~BITS_BBPSF_ERRTHR_8821C)) -+#define BIT_GET_BBPSF_ERRTHR_8821C(x) \ -+ (((x) >> BIT_SHIFT_BBPSF_ERRTHR_8821C) & BIT_MASK_BBPSF_ERRTHR_8821C) -+#define BIT_SET_BBPSF_ERRTHR_8821C(x, v) \ -+ (BIT_CLEAR_BBPSF_ERRTHR_8821C(x) | BIT_BBPSF_ERRTHR_8821C(v)) -+ -+/* 2 REG_P2P_RX_BCN_NOA_8821C (P2P RX BEACON NOA REGISTER) */ -+#define BIT_NOA_PARSER_EN_8821C BIT(15) -+#define BIT_BSSID_SEL_8821C BIT(14) -+ -+#define BIT_SHIFT_P2P_OUI_TYPE_8821C 0 -+#define BIT_MASK_P2P_OUI_TYPE_8821C 0xff -+#define BIT_P2P_OUI_TYPE_8821C(x) \ -+ (((x) & BIT_MASK_P2P_OUI_TYPE_8821C) << BIT_SHIFT_P2P_OUI_TYPE_8821C) -+#define BITS_P2P_OUI_TYPE_8821C \ -+ (BIT_MASK_P2P_OUI_TYPE_8821C << BIT_SHIFT_P2P_OUI_TYPE_8821C) -+#define BIT_CLEAR_P2P_OUI_TYPE_8821C(x) ((x) & (~BITS_P2P_OUI_TYPE_8821C)) -+#define BIT_GET_P2P_OUI_TYPE_8821C(x) \ -+ (((x) >> BIT_SHIFT_P2P_OUI_TYPE_8821C) & BIT_MASK_P2P_OUI_TYPE_8821C) -+#define BIT_SET_P2P_OUI_TYPE_8821C(x, v) \ -+ (BIT_CLEAR_P2P_OUI_TYPE_8821C(x) | BIT_P2P_OUI_TYPE_8821C(v)) -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_8821C (ASSOCIATED BEAMFORMER0 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8821C 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8821C 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_V1_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8821C) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8821C) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_V1_8821C \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8821C \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8821C) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_V1_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_V1_8821C)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8821C) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8821C) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_V1_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_V1_8821C(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_V1_8821C(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_H_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID0_8821C 16 -+#define BIT_MASK_R_WMAC_TXCSI_AID0_8821C 0x1ff -+#define BIT_R_WMAC_TXCSI_AID0_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID0_8821C) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID0_8821C) -+#define BITS_R_WMAC_TXCSI_AID0_8821C \ -+ (BIT_MASK_R_WMAC_TXCSI_AID0_8821C << BIT_SHIFT_R_WMAC_TXCSI_AID0_8821C) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID0_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID0_8821C)) -+#define BIT_GET_R_WMAC_TXCSI_AID0_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID0_8821C) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID0_8821C) -+#define BIT_SET_R_WMAC_TXCSI_AID0_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID0_8821C(x) | BIT_R_WMAC_TXCSI_AID0_8821C(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8821C(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_8821C (ASSOCIATED BEAMFORMER1 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8821C 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8821C 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_V1_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8821C) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8821C) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_V1_8821C \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8821C \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8821C) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V1_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_V1_8821C)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8821C) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8821C) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_V1_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V1_8821C(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_V1_8821C(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_H_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID1_8821C 16 -+#define BIT_MASK_R_WMAC_TXCSI_AID1_8821C 0x1ff -+#define BIT_R_WMAC_TXCSI_AID1_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID1_8821C) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID1_8821C) -+#define BITS_R_WMAC_TXCSI_AID1_8821C \ -+ (BIT_MASK_R_WMAC_TXCSI_AID1_8821C << BIT_SHIFT_R_WMAC_TXCSI_AID1_8821C) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID1_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID1_8821C)) -+#define BIT_GET_R_WMAC_TXCSI_AID1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID1_8821C) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID1_8821C) -+#define BIT_SET_R_WMAC_TXCSI_AID1_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID1_8821C(x) | BIT_R_WMAC_TXCSI_AID1_8821C(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8821C(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW20_8821C (TX CSI REPORT PARAMETER REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_1_8821C 16 -+#define BIT_MASK_R_WMAC_BFINFO_20M_1_8821C 0xfff -+#define BIT_R_WMAC_BFINFO_20M_1_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_1_8821C) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8821C) -+#define BITS_R_WMAC_BFINFO_20M_1_8821C \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_1_8821C \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8821C) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_1_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_1_8821C)) -+#define BIT_GET_R_WMAC_BFINFO_20M_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_1_8821C) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_1_8821C) -+#define BIT_SET_R_WMAC_BFINFO_20M_1_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_1_8821C(x) | \ -+ BIT_R_WMAC_BFINFO_20M_1_8821C(v)) -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_0_8821C 0 -+#define BIT_MASK_R_WMAC_BFINFO_20M_0_8821C 0xfff -+#define BIT_R_WMAC_BFINFO_20M_0_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_0_8821C) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8821C) -+#define BITS_R_WMAC_BFINFO_20M_0_8821C \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_0_8821C \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8821C) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_0_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_0_8821C)) -+#define BIT_GET_R_WMAC_BFINFO_20M_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_0_8821C) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_0_8821C) -+#define BIT_SET_R_WMAC_BFINFO_20M_0_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_0_8821C(x) | \ -+ BIT_R_WMAC_BFINFO_20M_0_8821C(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW40_8821C (TX CSI REPORT PARAMETER_BW40 REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_ANTCD_8821C 0 -+#define BIT_MASK_WMAC_RESP_ANTCD_8821C 0xf -+#define BIT_WMAC_RESP_ANTCD_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTCD_8821C) \ -+ << BIT_SHIFT_WMAC_RESP_ANTCD_8821C) -+#define BITS_WMAC_RESP_ANTCD_8821C \ -+ (BIT_MASK_WMAC_RESP_ANTCD_8821C << BIT_SHIFT_WMAC_RESP_ANTCD_8821C) -+#define BIT_CLEAR_WMAC_RESP_ANTCD_8821C(x) ((x) & (~BITS_WMAC_RESP_ANTCD_8821C)) -+#define BIT_GET_WMAC_RESP_ANTCD_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTCD_8821C) & \ -+ BIT_MASK_WMAC_RESP_ANTCD_8821C) -+#define BIT_SET_WMAC_RESP_ANTCD_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTCD_8821C(x) | BIT_WMAC_RESP_ANTCD_8821C(v)) -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_BCN_PSR_RPT2_8821C (BEACON PARSER REPORT REGISTER2) */ -+ -+#define BIT_SHIFT_DTIM_CNT2_8821C 24 -+#define BIT_MASK_DTIM_CNT2_8821C 0xff -+#define BIT_DTIM_CNT2_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_CNT2_8821C) << BIT_SHIFT_DTIM_CNT2_8821C) -+#define BITS_DTIM_CNT2_8821C \ -+ (BIT_MASK_DTIM_CNT2_8821C << BIT_SHIFT_DTIM_CNT2_8821C) -+#define BIT_CLEAR_DTIM_CNT2_8821C(x) ((x) & (~BITS_DTIM_CNT2_8821C)) -+#define BIT_GET_DTIM_CNT2_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT2_8821C) & BIT_MASK_DTIM_CNT2_8821C) -+#define BIT_SET_DTIM_CNT2_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_CNT2_8821C(x) | BIT_DTIM_CNT2_8821C(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD2_8821C 16 -+#define BIT_MASK_DTIM_PERIOD2_8821C 0xff -+#define BIT_DTIM_PERIOD2_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD2_8821C) << BIT_SHIFT_DTIM_PERIOD2_8821C) -+#define BITS_DTIM_PERIOD2_8821C \ -+ (BIT_MASK_DTIM_PERIOD2_8821C << BIT_SHIFT_DTIM_PERIOD2_8821C) -+#define BIT_CLEAR_DTIM_PERIOD2_8821C(x) ((x) & (~BITS_DTIM_PERIOD2_8821C)) -+#define BIT_GET_DTIM_PERIOD2_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD2_8821C) & BIT_MASK_DTIM_PERIOD2_8821C) -+#define BIT_SET_DTIM_PERIOD2_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD2_8821C(x) | BIT_DTIM_PERIOD2_8821C(v)) -+ -+#define BIT_DTIM2_8821C BIT(15) -+#define BIT_TIM2_8821C BIT(14) -+ -+#define BIT_SHIFT_PS_AID_2_8821C 0 -+#define BIT_MASK_PS_AID_2_8821C 0x7ff -+#define BIT_PS_AID_2_8821C(x) \ -+ (((x) & BIT_MASK_PS_AID_2_8821C) << BIT_SHIFT_PS_AID_2_8821C) -+#define BITS_PS_AID_2_8821C \ -+ (BIT_MASK_PS_AID_2_8821C << BIT_SHIFT_PS_AID_2_8821C) -+#define BIT_CLEAR_PS_AID_2_8821C(x) ((x) & (~BITS_PS_AID_2_8821C)) -+#define BIT_GET_PS_AID_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_2_8821C) & BIT_MASK_PS_AID_2_8821C) -+#define BIT_SET_PS_AID_2_8821C(x, v) \ -+ (BIT_CLEAR_PS_AID_2_8821C(x) | BIT_PS_AID_2_8821C(v)) -+ -+/* 2 REG_BCN_PSR_RPT3_8821C (BEACON PARSER REPORT REGISTER3) */ -+ -+#define BIT_SHIFT_DTIM_CNT3_8821C 24 -+#define BIT_MASK_DTIM_CNT3_8821C 0xff -+#define BIT_DTIM_CNT3_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_CNT3_8821C) << BIT_SHIFT_DTIM_CNT3_8821C) -+#define BITS_DTIM_CNT3_8821C \ -+ (BIT_MASK_DTIM_CNT3_8821C << BIT_SHIFT_DTIM_CNT3_8821C) -+#define BIT_CLEAR_DTIM_CNT3_8821C(x) ((x) & (~BITS_DTIM_CNT3_8821C)) -+#define BIT_GET_DTIM_CNT3_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT3_8821C) & BIT_MASK_DTIM_CNT3_8821C) -+#define BIT_SET_DTIM_CNT3_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_CNT3_8821C(x) | BIT_DTIM_CNT3_8821C(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD3_8821C 16 -+#define BIT_MASK_DTIM_PERIOD3_8821C 0xff -+#define BIT_DTIM_PERIOD3_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD3_8821C) << BIT_SHIFT_DTIM_PERIOD3_8821C) -+#define BITS_DTIM_PERIOD3_8821C \ -+ (BIT_MASK_DTIM_PERIOD3_8821C << BIT_SHIFT_DTIM_PERIOD3_8821C) -+#define BIT_CLEAR_DTIM_PERIOD3_8821C(x) ((x) & (~BITS_DTIM_PERIOD3_8821C)) -+#define BIT_GET_DTIM_PERIOD3_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD3_8821C) & BIT_MASK_DTIM_PERIOD3_8821C) -+#define BIT_SET_DTIM_PERIOD3_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD3_8821C(x) | BIT_DTIM_PERIOD3_8821C(v)) -+ -+#define BIT_DTIM3_8821C BIT(15) -+#define BIT_TIM3_8821C BIT(14) -+ -+#define BIT_SHIFT_PS_AID_3_8821C 0 -+#define BIT_MASK_PS_AID_3_8821C 0x7ff -+#define BIT_PS_AID_3_8821C(x) \ -+ (((x) & BIT_MASK_PS_AID_3_8821C) << BIT_SHIFT_PS_AID_3_8821C) -+#define BITS_PS_AID_3_8821C \ -+ (BIT_MASK_PS_AID_3_8821C << BIT_SHIFT_PS_AID_3_8821C) -+#define BIT_CLEAR_PS_AID_3_8821C(x) ((x) & (~BITS_PS_AID_3_8821C)) -+#define BIT_GET_PS_AID_3_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_3_8821C) & BIT_MASK_PS_AID_3_8821C) -+#define BIT_SET_PS_AID_3_8821C(x, v) \ -+ (BIT_CLEAR_PS_AID_3_8821C(x) | BIT_PS_AID_3_8821C(v)) -+ -+/* 2 REG_BCN_PSR_RPT4_8821C (BEACON PARSER REPORT REGISTER4) */ -+ -+#define BIT_SHIFT_DTIM_CNT4_8821C 24 -+#define BIT_MASK_DTIM_CNT4_8821C 0xff -+#define BIT_DTIM_CNT4_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_CNT4_8821C) << BIT_SHIFT_DTIM_CNT4_8821C) -+#define BITS_DTIM_CNT4_8821C \ -+ (BIT_MASK_DTIM_CNT4_8821C << BIT_SHIFT_DTIM_CNT4_8821C) -+#define BIT_CLEAR_DTIM_CNT4_8821C(x) ((x) & (~BITS_DTIM_CNT4_8821C)) -+#define BIT_GET_DTIM_CNT4_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT4_8821C) & BIT_MASK_DTIM_CNT4_8821C) -+#define BIT_SET_DTIM_CNT4_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_CNT4_8821C(x) | BIT_DTIM_CNT4_8821C(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD4_8821C 16 -+#define BIT_MASK_DTIM_PERIOD4_8821C 0xff -+#define BIT_DTIM_PERIOD4_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD4_8821C) << BIT_SHIFT_DTIM_PERIOD4_8821C) -+#define BITS_DTIM_PERIOD4_8821C \ -+ (BIT_MASK_DTIM_PERIOD4_8821C << BIT_SHIFT_DTIM_PERIOD4_8821C) -+#define BIT_CLEAR_DTIM_PERIOD4_8821C(x) ((x) & (~BITS_DTIM_PERIOD4_8821C)) -+#define BIT_GET_DTIM_PERIOD4_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD4_8821C) & BIT_MASK_DTIM_PERIOD4_8821C) -+#define BIT_SET_DTIM_PERIOD4_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD4_8821C(x) | BIT_DTIM_PERIOD4_8821C(v)) -+ -+#define BIT_DTIM4_8821C BIT(15) -+#define BIT_TIM4_8821C BIT(14) -+ -+#define BIT_SHIFT_PS_AID_4_8821C 0 -+#define BIT_MASK_PS_AID_4_8821C 0x7ff -+#define BIT_PS_AID_4_8821C(x) \ -+ (((x) & BIT_MASK_PS_AID_4_8821C) << BIT_SHIFT_PS_AID_4_8821C) -+#define BITS_PS_AID_4_8821C \ -+ (BIT_MASK_PS_AID_4_8821C << BIT_SHIFT_PS_AID_4_8821C) -+#define BIT_CLEAR_PS_AID_4_8821C(x) ((x) & (~BITS_PS_AID_4_8821C)) -+#define BIT_GET_PS_AID_4_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_4_8821C) & BIT_MASK_PS_AID_4_8821C) -+#define BIT_SET_PS_AID_4_8821C(x, v) \ -+ (BIT_CLEAR_PS_AID_4_8821C(x) | BIT_PS_AID_4_8821C(v)) -+ -+/* 2 REG_A1_ADDR_MASK_8821C (A1 ADDR MASK REGISTER) */ -+ -+#define BIT_SHIFT_A1_ADDR_MASK_8821C 0 -+#define BIT_MASK_A1_ADDR_MASK_8821C 0xffffffffL -+#define BIT_A1_ADDR_MASK_8821C(x) \ -+ (((x) & BIT_MASK_A1_ADDR_MASK_8821C) << BIT_SHIFT_A1_ADDR_MASK_8821C) -+#define BITS_A1_ADDR_MASK_8821C \ -+ (BIT_MASK_A1_ADDR_MASK_8821C << BIT_SHIFT_A1_ADDR_MASK_8821C) -+#define BIT_CLEAR_A1_ADDR_MASK_8821C(x) ((x) & (~BITS_A1_ADDR_MASK_8821C)) -+#define BIT_GET_A1_ADDR_MASK_8821C(x) \ -+ (((x) >> BIT_SHIFT_A1_ADDR_MASK_8821C) & BIT_MASK_A1_ADDR_MASK_8821C) -+#define BIT_SET_A1_ADDR_MASK_8821C(x, v) \ -+ (BIT_CLEAR_A1_ADDR_MASK_8821C(x) | BIT_A1_ADDR_MASK_8821C(v)) -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_MACID2_8821C (MAC ID2 REGISTER) */ -+ -+#define BIT_SHIFT_MACID2_V1_8821C 0 -+#define BIT_MASK_MACID2_V1_8821C 0xffffffffL -+#define BIT_MACID2_V1_8821C(x) \ -+ (((x) & BIT_MASK_MACID2_V1_8821C) << BIT_SHIFT_MACID2_V1_8821C) -+#define BITS_MACID2_V1_8821C \ -+ (BIT_MASK_MACID2_V1_8821C << BIT_SHIFT_MACID2_V1_8821C) -+#define BIT_CLEAR_MACID2_V1_8821C(x) ((x) & (~BITS_MACID2_V1_8821C)) -+#define BIT_GET_MACID2_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID2_V1_8821C) & BIT_MASK_MACID2_V1_8821C) -+#define BIT_SET_MACID2_V1_8821C(x, v) \ -+ (BIT_CLEAR_MACID2_V1_8821C(x) | BIT_MACID2_V1_8821C(v)) -+ -+/* 2 REG_MACID2_H_8821C (MAC ID2 REGISTER) */ -+ -+#define BIT_SHIFT_MACID2_H_V1_8821C 0 -+#define BIT_MASK_MACID2_H_V1_8821C 0xffff -+#define BIT_MACID2_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_MACID2_H_V1_8821C) << BIT_SHIFT_MACID2_H_V1_8821C) -+#define BITS_MACID2_H_V1_8821C \ -+ (BIT_MASK_MACID2_H_V1_8821C << BIT_SHIFT_MACID2_H_V1_8821C) -+#define BIT_CLEAR_MACID2_H_V1_8821C(x) ((x) & (~BITS_MACID2_H_V1_8821C)) -+#define BIT_GET_MACID2_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID2_H_V1_8821C) & BIT_MASK_MACID2_H_V1_8821C) -+#define BIT_SET_MACID2_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_MACID2_H_V1_8821C(x) | BIT_MACID2_H_V1_8821C(v)) -+ -+/* 2 REG_BSSID2_8821C (BSSID2 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID2_V1_8821C 0 -+#define BIT_MASK_BSSID2_V1_8821C 0xffffffffL -+#define BIT_BSSID2_V1_8821C(x) \ -+ (((x) & BIT_MASK_BSSID2_V1_8821C) << BIT_SHIFT_BSSID2_V1_8821C) -+#define BITS_BSSID2_V1_8821C \ -+ (BIT_MASK_BSSID2_V1_8821C << BIT_SHIFT_BSSID2_V1_8821C) -+#define BIT_CLEAR_BSSID2_V1_8821C(x) ((x) & (~BITS_BSSID2_V1_8821C)) -+#define BIT_GET_BSSID2_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_V1_8821C) & BIT_MASK_BSSID2_V1_8821C) -+#define BIT_SET_BSSID2_V1_8821C(x, v) \ -+ (BIT_CLEAR_BSSID2_V1_8821C(x) | BIT_BSSID2_V1_8821C(v)) -+ -+/* 2 REG_BSSID2_H_8821C (BSSID2 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID2_H_V1_8821C 0 -+#define BIT_MASK_BSSID2_H_V1_8821C 0xffff -+#define BIT_BSSID2_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_BSSID2_H_V1_8821C) << BIT_SHIFT_BSSID2_H_V1_8821C) -+#define BITS_BSSID2_H_V1_8821C \ -+ (BIT_MASK_BSSID2_H_V1_8821C << BIT_SHIFT_BSSID2_H_V1_8821C) -+#define BIT_CLEAR_BSSID2_H_V1_8821C(x) ((x) & (~BITS_BSSID2_H_V1_8821C)) -+#define BIT_GET_BSSID2_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_H_V1_8821C) & BIT_MASK_BSSID2_H_V1_8821C) -+#define BIT_SET_BSSID2_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_BSSID2_H_V1_8821C(x) | BIT_BSSID2_H_V1_8821C(v)) -+ -+/* 2 REG_MACID3_8821C (MAC ID3 REGISTER) */ -+ -+#define BIT_SHIFT_MACID3_V1_8821C 0 -+#define BIT_MASK_MACID3_V1_8821C 0xffffffffL -+#define BIT_MACID3_V1_8821C(x) \ -+ (((x) & BIT_MASK_MACID3_V1_8821C) << BIT_SHIFT_MACID3_V1_8821C) -+#define BITS_MACID3_V1_8821C \ -+ (BIT_MASK_MACID3_V1_8821C << BIT_SHIFT_MACID3_V1_8821C) -+#define BIT_CLEAR_MACID3_V1_8821C(x) ((x) & (~BITS_MACID3_V1_8821C)) -+#define BIT_GET_MACID3_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID3_V1_8821C) & BIT_MASK_MACID3_V1_8821C) -+#define BIT_SET_MACID3_V1_8821C(x, v) \ -+ (BIT_CLEAR_MACID3_V1_8821C(x) | BIT_MACID3_V1_8821C(v)) -+ -+/* 2 REG_MACID3_H_8821C (MAC ID3 REGISTER) */ -+ -+#define BIT_SHIFT_MACID3_H_V1_8821C 0 -+#define BIT_MASK_MACID3_H_V1_8821C 0xffff -+#define BIT_MACID3_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_MACID3_H_V1_8821C) << BIT_SHIFT_MACID3_H_V1_8821C) -+#define BITS_MACID3_H_V1_8821C \ -+ (BIT_MASK_MACID3_H_V1_8821C << BIT_SHIFT_MACID3_H_V1_8821C) -+#define BIT_CLEAR_MACID3_H_V1_8821C(x) ((x) & (~BITS_MACID3_H_V1_8821C)) -+#define BIT_GET_MACID3_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID3_H_V1_8821C) & BIT_MASK_MACID3_H_V1_8821C) -+#define BIT_SET_MACID3_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_MACID3_H_V1_8821C(x) | BIT_MACID3_H_V1_8821C(v)) -+ -+/* 2 REG_BSSID3_8821C (BSSID3 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID3_V1_8821C 0 -+#define BIT_MASK_BSSID3_V1_8821C 0xffffffffL -+#define BIT_BSSID3_V1_8821C(x) \ -+ (((x) & BIT_MASK_BSSID3_V1_8821C) << BIT_SHIFT_BSSID3_V1_8821C) -+#define BITS_BSSID3_V1_8821C \ -+ (BIT_MASK_BSSID3_V1_8821C << BIT_SHIFT_BSSID3_V1_8821C) -+#define BIT_CLEAR_BSSID3_V1_8821C(x) ((x) & (~BITS_BSSID3_V1_8821C)) -+#define BIT_GET_BSSID3_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_V1_8821C) & BIT_MASK_BSSID3_V1_8821C) -+#define BIT_SET_BSSID3_V1_8821C(x, v) \ -+ (BIT_CLEAR_BSSID3_V1_8821C(x) | BIT_BSSID3_V1_8821C(v)) -+ -+/* 2 REG_BSSID3_H_8821C (BSSID3 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID3_H_V1_8821C 0 -+#define BIT_MASK_BSSID3_H_V1_8821C 0xffff -+#define BIT_BSSID3_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_BSSID3_H_V1_8821C) << BIT_SHIFT_BSSID3_H_V1_8821C) -+#define BITS_BSSID3_H_V1_8821C \ -+ (BIT_MASK_BSSID3_H_V1_8821C << BIT_SHIFT_BSSID3_H_V1_8821C) -+#define BIT_CLEAR_BSSID3_H_V1_8821C(x) ((x) & (~BITS_BSSID3_H_V1_8821C)) -+#define BIT_GET_BSSID3_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_H_V1_8821C) & BIT_MASK_BSSID3_H_V1_8821C) -+#define BIT_SET_BSSID3_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_BSSID3_H_V1_8821C(x) | BIT_BSSID3_H_V1_8821C(v)) -+ -+/* 2 REG_MACID4_8821C (MAC ID4 REGISTER) */ -+ -+#define BIT_SHIFT_MACID4_V1_8821C 0 -+#define BIT_MASK_MACID4_V1_8821C 0xffffffffL -+#define BIT_MACID4_V1_8821C(x) \ -+ (((x) & BIT_MASK_MACID4_V1_8821C) << BIT_SHIFT_MACID4_V1_8821C) -+#define BITS_MACID4_V1_8821C \ -+ (BIT_MASK_MACID4_V1_8821C << BIT_SHIFT_MACID4_V1_8821C) -+#define BIT_CLEAR_MACID4_V1_8821C(x) ((x) & (~BITS_MACID4_V1_8821C)) -+#define BIT_GET_MACID4_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID4_V1_8821C) & BIT_MASK_MACID4_V1_8821C) -+#define BIT_SET_MACID4_V1_8821C(x, v) \ -+ (BIT_CLEAR_MACID4_V1_8821C(x) | BIT_MACID4_V1_8821C(v)) -+ -+/* 2 REG_MACID4_H_8821C (MAC ID4 REGISTER) */ -+ -+#define BIT_SHIFT_MACID4_H_V1_8821C 0 -+#define BIT_MASK_MACID4_H_V1_8821C 0xffff -+#define BIT_MACID4_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_MACID4_H_V1_8821C) << BIT_SHIFT_MACID4_H_V1_8821C) -+#define BITS_MACID4_H_V1_8821C \ -+ (BIT_MASK_MACID4_H_V1_8821C << BIT_SHIFT_MACID4_H_V1_8821C) -+#define BIT_CLEAR_MACID4_H_V1_8821C(x) ((x) & (~BITS_MACID4_H_V1_8821C)) -+#define BIT_GET_MACID4_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID4_H_V1_8821C) & BIT_MASK_MACID4_H_V1_8821C) -+#define BIT_SET_MACID4_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_MACID4_H_V1_8821C(x) | BIT_MACID4_H_V1_8821C(v)) -+ -+/* 2 REG_BSSID4_8821C (BSSID4 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID4_V1_8821C 0 -+#define BIT_MASK_BSSID4_V1_8821C 0xffffffffL -+#define BIT_BSSID4_V1_8821C(x) \ -+ (((x) & BIT_MASK_BSSID4_V1_8821C) << BIT_SHIFT_BSSID4_V1_8821C) -+#define BITS_BSSID4_V1_8821C \ -+ (BIT_MASK_BSSID4_V1_8821C << BIT_SHIFT_BSSID4_V1_8821C) -+#define BIT_CLEAR_BSSID4_V1_8821C(x) ((x) & (~BITS_BSSID4_V1_8821C)) -+#define BIT_GET_BSSID4_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_V1_8821C) & BIT_MASK_BSSID4_V1_8821C) -+#define BIT_SET_BSSID4_V1_8821C(x, v) \ -+ (BIT_CLEAR_BSSID4_V1_8821C(x) | BIT_BSSID4_V1_8821C(v)) -+ -+/* 2 REG_BSSID4_H_8821C (BSSID4 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID4_H_V1_8821C 0 -+#define BIT_MASK_BSSID4_H_V1_8821C 0xffff -+#define BIT_BSSID4_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_BSSID4_H_V1_8821C) << BIT_SHIFT_BSSID4_H_V1_8821C) -+#define BITS_BSSID4_H_V1_8821C \ -+ (BIT_MASK_BSSID4_H_V1_8821C << BIT_SHIFT_BSSID4_H_V1_8821C) -+#define BIT_CLEAR_BSSID4_H_V1_8821C(x) ((x) & (~BITS_BSSID4_H_V1_8821C)) -+#define BIT_GET_BSSID4_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_H_V1_8821C) & BIT_MASK_BSSID4_H_V1_8821C) -+#define BIT_SET_BSSID4_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_BSSID4_H_V1_8821C(x) | BIT_BSSID4_H_V1_8821C(v)) -+ -+/* 2 REG_NOA_REPORT_8821C */ -+ -+/* 2 REG_NOA_REPORT_1_8821C */ -+ -+/* 2 REG_NOA_REPORT_2_8821C */ -+ -+/* 2 REG_NOA_REPORT_3_8821C */ -+ -+/* 2 REG_PWRBIT_SETTING_8821C */ -+#define BIT_CLI3_PWRBIT_OW_EN_8821C BIT(7) -+#define BIT_CLI3_PWR_ST_8821C BIT(6) -+#define BIT_CLI2_PWRBIT_OW_EN_8821C BIT(5) -+#define BIT_CLI2_PWR_ST_8821C BIT(4) -+#define BIT_CLI1_PWRBIT_OW_EN_8821C BIT(3) -+#define BIT_CLI1_PWR_ST_8821C BIT(2) -+#define BIT_CLI0_PWRBIT_OW_EN_8821C BIT(1) -+#define BIT_CLI0_PWR_ST_8821C BIT(0) -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_MU_BF_OPTION_8821C */ -+#define BIT_WMAC_RESP_NONSTA1_DIS_8821C BIT(7) -+#define BIT_WMAC_TXMU_ACKPOLICY_EN_8821C BIT(6) -+ -+#define BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8821C 4 -+#define BIT_MASK_WMAC_TXMU_ACKPOLICY_8821C 0x3 -+#define BIT_WMAC_TXMU_ACKPOLICY_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_TXMU_ACKPOLICY_8821C) \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8821C) -+#define BITS_WMAC_TXMU_ACKPOLICY_8821C \ -+ (BIT_MASK_WMAC_TXMU_ACKPOLICY_8821C \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8821C) -+#define BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8821C(x) \ -+ ((x) & (~BITS_WMAC_TXMU_ACKPOLICY_8821C)) -+#define BIT_GET_WMAC_TXMU_ACKPOLICY_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8821C) & \ -+ BIT_MASK_WMAC_TXMU_ACKPOLICY_8821C) -+#define BIT_SET_WMAC_TXMU_ACKPOLICY_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8821C(x) | \ -+ BIT_WMAC_TXMU_ACKPOLICY_8821C(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8821C 1 -+#define BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8821C 0x7 -+#define BIT_WMAC_MU_BFEE_PORT_SEL_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8821C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8821C) -+#define BITS_WMAC_MU_BFEE_PORT_SEL_8821C \ -+ (BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8821C \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8821C) -+#define BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8821C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE_PORT_SEL_8821C)) -+#define BIT_GET_WMAC_MU_BFEE_PORT_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8821C) & \ -+ BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8821C) -+#define BIT_SET_WMAC_MU_BFEE_PORT_SEL_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8821C(x) | \ -+ BIT_WMAC_MU_BFEE_PORT_SEL_8821C(v)) -+ -+#define BIT_WMAC_MU_BFEE_DIS_8821C BIT(0) -+ -+/* 2 REG_WMAC_PAUSE_BB_CLR_TH_8821C */ -+ -+#define BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8821C 0 -+#define BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8821C 0xff -+#define BIT_WMAC_PAUSE_BB_CLR_TH_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8821C) \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8821C) -+#define BITS_WMAC_PAUSE_BB_CLR_TH_8821C \ -+ (BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8821C \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8821C) -+#define BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8821C(x) \ -+ ((x) & (~BITS_WMAC_PAUSE_BB_CLR_TH_8821C)) -+#define BIT_GET_WMAC_PAUSE_BB_CLR_TH_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8821C) & \ -+ BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8821C) -+#define BIT_SET_WMAC_PAUSE_BB_CLR_TH_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8821C(x) | \ -+ BIT_WMAC_PAUSE_BB_CLR_TH_8821C(v)) -+ -+/* 2 REG_WMAC_MU_ARB_8821C */ -+#define BIT_WMAC_ARB_HW_ADAPT_EN_8821C BIT(7) -+#define BIT_WMAC_ARB_SW_EN_8821C BIT(6) -+ -+#define BIT_SHIFT_WMAC_ARB_SW_STATE_8821C 0 -+#define BIT_MASK_WMAC_ARB_SW_STATE_8821C 0x3f -+#define BIT_WMAC_ARB_SW_STATE_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_ARB_SW_STATE_8821C) \ -+ << BIT_SHIFT_WMAC_ARB_SW_STATE_8821C) -+#define BITS_WMAC_ARB_SW_STATE_8821C \ -+ (BIT_MASK_WMAC_ARB_SW_STATE_8821C << BIT_SHIFT_WMAC_ARB_SW_STATE_8821C) -+#define BIT_CLEAR_WMAC_ARB_SW_STATE_8821C(x) \ -+ ((x) & (~BITS_WMAC_ARB_SW_STATE_8821C)) -+#define BIT_GET_WMAC_ARB_SW_STATE_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARB_SW_STATE_8821C) & \ -+ BIT_MASK_WMAC_ARB_SW_STATE_8821C) -+#define BIT_SET_WMAC_ARB_SW_STATE_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_ARB_SW_STATE_8821C(x) | BIT_WMAC_ARB_SW_STATE_8821C(v)) -+ -+/* 2 REG_WMAC_MU_OPTION_8821C */ -+ -+#define BIT_SHIFT_WMAC_MU_DBGSEL_8821C 5 -+#define BIT_MASK_WMAC_MU_DBGSEL_8821C 0x3 -+#define BIT_WMAC_MU_DBGSEL_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_DBGSEL_8821C) \ -+ << BIT_SHIFT_WMAC_MU_DBGSEL_8821C) -+#define BITS_WMAC_MU_DBGSEL_8821C \ -+ (BIT_MASK_WMAC_MU_DBGSEL_8821C << BIT_SHIFT_WMAC_MU_DBGSEL_8821C) -+#define BIT_CLEAR_WMAC_MU_DBGSEL_8821C(x) ((x) & (~BITS_WMAC_MU_DBGSEL_8821C)) -+#define BIT_GET_WMAC_MU_DBGSEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_DBGSEL_8821C) & \ -+ BIT_MASK_WMAC_MU_DBGSEL_8821C) -+#define BIT_SET_WMAC_MU_DBGSEL_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_DBGSEL_8821C(x) | BIT_WMAC_MU_DBGSEL_8821C(v)) -+ -+#define BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8821C 0 -+#define BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8821C 0x1f -+#define BIT_WMAC_MU_CPRD_TIMEOUT_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8821C) \ -+ << BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8821C) -+#define BITS_WMAC_MU_CPRD_TIMEOUT_8821C \ -+ (BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8821C \ -+ << BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8821C) -+#define BIT_CLEAR_WMAC_MU_CPRD_TIMEOUT_8821C(x) \ -+ ((x) & (~BITS_WMAC_MU_CPRD_TIMEOUT_8821C)) -+#define BIT_GET_WMAC_MU_CPRD_TIMEOUT_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8821C) & \ -+ BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8821C) -+#define BIT_SET_WMAC_MU_CPRD_TIMEOUT_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_CPRD_TIMEOUT_8821C(x) | \ -+ BIT_WMAC_MU_CPRD_TIMEOUT_8821C(v)) -+ -+/* 2 REG_WMAC_MU_BF_CTL_8821C */ -+#define BIT_WMAC_INVLD_BFPRT_CHK_8821C BIT(15) -+#define BIT_WMAC_RETXBFRPTSEQ_UPD_8821C BIT(14) -+ -+#define BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8821C 12 -+#define BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8821C 0x3 -+#define BIT_WMAC_MU_BFRPTSEG_SEL_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8821C) \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8821C) -+#define BITS_WMAC_MU_BFRPTSEG_SEL_8821C \ -+ (BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8821C \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8821C) -+#define BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8821C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFRPTSEG_SEL_8821C)) -+#define BIT_GET_WMAC_MU_BFRPTSEG_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8821C) & \ -+ BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8821C) -+#define BIT_SET_WMAC_MU_BFRPTSEG_SEL_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8821C(x) | \ -+ BIT_WMAC_MU_BFRPTSEG_SEL_8821C(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BF_MYAID_8821C 0 -+#define BIT_MASK_WMAC_MU_BF_MYAID_8821C 0xfff -+#define BIT_WMAC_MU_BF_MYAID_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BF_MYAID_8821C) \ -+ << BIT_SHIFT_WMAC_MU_BF_MYAID_8821C) -+#define BITS_WMAC_MU_BF_MYAID_8821C \ -+ (BIT_MASK_WMAC_MU_BF_MYAID_8821C << BIT_SHIFT_WMAC_MU_BF_MYAID_8821C) -+#define BIT_CLEAR_WMAC_MU_BF_MYAID_8821C(x) \ -+ ((x) & (~BITS_WMAC_MU_BF_MYAID_8821C)) -+#define BIT_GET_WMAC_MU_BF_MYAID_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BF_MYAID_8821C) & \ -+ BIT_MASK_WMAC_MU_BF_MYAID_8821C) -+#define BIT_SET_WMAC_MU_BF_MYAID_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BF_MYAID_8821C(x) | BIT_WMAC_MU_BF_MYAID_8821C(v)) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA_8821C */ -+ -+#define BIT_SHIFT_BFRPT_PARA_USERID_SEL_8821C 12 -+#define BIT_MASK_BFRPT_PARA_USERID_SEL_8821C 0x7 -+#define BIT_BFRPT_PARA_USERID_SEL_8821C(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_USERID_SEL_8821C) \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_8821C) -+#define BITS_BFRPT_PARA_USERID_SEL_8821C \ -+ (BIT_MASK_BFRPT_PARA_USERID_SEL_8821C \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_8821C) -+#define BIT_CLEAR_BFRPT_PARA_USERID_SEL_8821C(x) \ -+ ((x) & (~BITS_BFRPT_PARA_USERID_SEL_8821C)) -+#define BIT_GET_BFRPT_PARA_USERID_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_USERID_SEL_8821C) & \ -+ BIT_MASK_BFRPT_PARA_USERID_SEL_8821C) -+#define BIT_SET_BFRPT_PARA_USERID_SEL_8821C(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_USERID_SEL_8821C(x) | \ -+ BIT_BFRPT_PARA_USERID_SEL_8821C(v)) -+ -+#define BIT_SHIFT_BFRPT_PARA_8821C 0 -+#define BIT_MASK_BFRPT_PARA_8821C 0xfff -+#define BIT_BFRPT_PARA_8821C(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_8821C) << BIT_SHIFT_BFRPT_PARA_8821C) -+#define BITS_BFRPT_PARA_8821C \ -+ (BIT_MASK_BFRPT_PARA_8821C << BIT_SHIFT_BFRPT_PARA_8821C) -+#define BIT_CLEAR_BFRPT_PARA_8821C(x) ((x) & (~BITS_BFRPT_PARA_8821C)) -+#define BIT_GET_BFRPT_PARA_8821C(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_8821C) & BIT_MASK_BFRPT_PARA_8821C) -+#define BIT_SET_BFRPT_PARA_8821C(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_8821C(x) | BIT_BFRPT_PARA_8821C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE2_8821C */ -+#define BIT_STATUS_BFEE2_8821C BIT(10) -+#define BIT_WMAC_MU_BFEE2_EN_8821C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE2_AID_8821C 0 -+#define BIT_MASK_WMAC_MU_BFEE2_AID_8821C 0x1ff -+#define BIT_WMAC_MU_BFEE2_AID_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE2_AID_8821C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE2_AID_8821C) -+#define BITS_WMAC_MU_BFEE2_AID_8821C \ -+ (BIT_MASK_WMAC_MU_BFEE2_AID_8821C << BIT_SHIFT_WMAC_MU_BFEE2_AID_8821C) -+#define BIT_CLEAR_WMAC_MU_BFEE2_AID_8821C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE2_AID_8821C)) -+#define BIT_GET_WMAC_MU_BFEE2_AID_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE2_AID_8821C) & \ -+ BIT_MASK_WMAC_MU_BFEE2_AID_8821C) -+#define BIT_SET_WMAC_MU_BFEE2_AID_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE2_AID_8821C(x) | BIT_WMAC_MU_BFEE2_AID_8821C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE3_8821C */ -+#define BIT_STATUS_BFEE3_8821C BIT(10) -+#define BIT_WMAC_MU_BFEE3_EN_8821C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE3_AID_8821C 0 -+#define BIT_MASK_WMAC_MU_BFEE3_AID_8821C 0x1ff -+#define BIT_WMAC_MU_BFEE3_AID_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE3_AID_8821C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE3_AID_8821C) -+#define BITS_WMAC_MU_BFEE3_AID_8821C \ -+ (BIT_MASK_WMAC_MU_BFEE3_AID_8821C << BIT_SHIFT_WMAC_MU_BFEE3_AID_8821C) -+#define BIT_CLEAR_WMAC_MU_BFEE3_AID_8821C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE3_AID_8821C)) -+#define BIT_GET_WMAC_MU_BFEE3_AID_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE3_AID_8821C) & \ -+ BIT_MASK_WMAC_MU_BFEE3_AID_8821C) -+#define BIT_SET_WMAC_MU_BFEE3_AID_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE3_AID_8821C(x) | BIT_WMAC_MU_BFEE3_AID_8821C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE4_8821C */ -+#define BIT_STATUS_BFEE4_8821C BIT(10) -+#define BIT_WMAC_MU_BFEE4_EN_8821C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE4_AID_8821C 0 -+#define BIT_MASK_WMAC_MU_BFEE4_AID_8821C 0x1ff -+#define BIT_WMAC_MU_BFEE4_AID_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE4_AID_8821C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE4_AID_8821C) -+#define BITS_WMAC_MU_BFEE4_AID_8821C \ -+ (BIT_MASK_WMAC_MU_BFEE4_AID_8821C << BIT_SHIFT_WMAC_MU_BFEE4_AID_8821C) -+#define BIT_CLEAR_WMAC_MU_BFEE4_AID_8821C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE4_AID_8821C)) -+#define BIT_GET_WMAC_MU_BFEE4_AID_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE4_AID_8821C) & \ -+ BIT_MASK_WMAC_MU_BFEE4_AID_8821C) -+#define BIT_SET_WMAC_MU_BFEE4_AID_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE4_AID_8821C(x) | BIT_WMAC_MU_BFEE4_AID_8821C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE5_8821C */ -+#define BIT_BIT_STATUS_BFEE5_8821C BIT(10) -+#define BIT_WMAC_MU_BFEE5_EN_8821C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE5_AID_8821C 0 -+#define BIT_MASK_WMAC_MU_BFEE5_AID_8821C 0x1ff -+#define BIT_WMAC_MU_BFEE5_AID_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE5_AID_8821C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE5_AID_8821C) -+#define BITS_WMAC_MU_BFEE5_AID_8821C \ -+ (BIT_MASK_WMAC_MU_BFEE5_AID_8821C << BIT_SHIFT_WMAC_MU_BFEE5_AID_8821C) -+#define BIT_CLEAR_WMAC_MU_BFEE5_AID_8821C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE5_AID_8821C)) -+#define BIT_GET_WMAC_MU_BFEE5_AID_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE5_AID_8821C) & \ -+ BIT_MASK_WMAC_MU_BFEE5_AID_8821C) -+#define BIT_SET_WMAC_MU_BFEE5_AID_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE5_AID_8821C(x) | BIT_WMAC_MU_BFEE5_AID_8821C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE6_8821C */ -+#define BIT_STATUS_BFEE6_8821C BIT(10) -+#define BIT_WMAC_MU_BFEE6_EN_8821C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE6_AID_8821C 0 -+#define BIT_MASK_WMAC_MU_BFEE6_AID_8821C 0x1ff -+#define BIT_WMAC_MU_BFEE6_AID_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE6_AID_8821C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE6_AID_8821C) -+#define BITS_WMAC_MU_BFEE6_AID_8821C \ -+ (BIT_MASK_WMAC_MU_BFEE6_AID_8821C << BIT_SHIFT_WMAC_MU_BFEE6_AID_8821C) -+#define BIT_CLEAR_WMAC_MU_BFEE6_AID_8821C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE6_AID_8821C)) -+#define BIT_GET_WMAC_MU_BFEE6_AID_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE6_AID_8821C) & \ -+ BIT_MASK_WMAC_MU_BFEE6_AID_8821C) -+#define BIT_SET_WMAC_MU_BFEE6_AID_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE6_AID_8821C(x) | BIT_WMAC_MU_BFEE6_AID_8821C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE7_8821C */ -+#define BIT_STATUS_BFEE7_8821C BIT(10) -+#define BIT_WMAC_MU_BFEE7_EN_8821C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE7_AID_8821C 0 -+#define BIT_MASK_WMAC_MU_BFEE7_AID_8821C 0x1ff -+#define BIT_WMAC_MU_BFEE7_AID_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE7_AID_8821C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE7_AID_8821C) -+#define BITS_WMAC_MU_BFEE7_AID_8821C \ -+ (BIT_MASK_WMAC_MU_BFEE7_AID_8821C << BIT_SHIFT_WMAC_MU_BFEE7_AID_8821C) -+#define BIT_CLEAR_WMAC_MU_BFEE7_AID_8821C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE7_AID_8821C)) -+#define BIT_GET_WMAC_MU_BFEE7_AID_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE7_AID_8821C) & \ -+ BIT_MASK_WMAC_MU_BFEE7_AID_8821C) -+#define BIT_SET_WMAC_MU_BFEE7_AID_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE7_AID_8821C(x) | BIT_WMAC_MU_BFEE7_AID_8821C(v)) -+ -+/* 2 REG_WMAC_BB_STOP_RX_COUNTER_8821C */ -+#define BIT_RST_ALL_COUNTER_8821C BIT(31) -+ -+#define BIT_SHIFT_ABORT_RX_VBON_COUNTER_8821C 16 -+#define BIT_MASK_ABORT_RX_VBON_COUNTER_8821C 0xff -+#define BIT_ABORT_RX_VBON_COUNTER_8821C(x) \ -+ (((x) & BIT_MASK_ABORT_RX_VBON_COUNTER_8821C) \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8821C) -+#define BITS_ABORT_RX_VBON_COUNTER_8821C \ -+ (BIT_MASK_ABORT_RX_VBON_COUNTER_8821C \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8821C) -+#define BIT_CLEAR_ABORT_RX_VBON_COUNTER_8821C(x) \ -+ ((x) & (~BITS_ABORT_RX_VBON_COUNTER_8821C)) -+#define BIT_GET_ABORT_RX_VBON_COUNTER_8821C(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_VBON_COUNTER_8821C) & \ -+ BIT_MASK_ABORT_RX_VBON_COUNTER_8821C) -+#define BIT_SET_ABORT_RX_VBON_COUNTER_8821C(x, v) \ -+ (BIT_CLEAR_ABORT_RX_VBON_COUNTER_8821C(x) | \ -+ BIT_ABORT_RX_VBON_COUNTER_8821C(v)) -+ -+#define BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8821C 8 -+#define BIT_MASK_ABORT_RX_RDRDY_COUNTER_8821C 0xff -+#define BIT_ABORT_RX_RDRDY_COUNTER_8821C(x) \ -+ (((x) & BIT_MASK_ABORT_RX_RDRDY_COUNTER_8821C) \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8821C) -+#define BITS_ABORT_RX_RDRDY_COUNTER_8821C \ -+ (BIT_MASK_ABORT_RX_RDRDY_COUNTER_8821C \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8821C) -+#define BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8821C(x) \ -+ ((x) & (~BITS_ABORT_RX_RDRDY_COUNTER_8821C)) -+#define BIT_GET_ABORT_RX_RDRDY_COUNTER_8821C(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8821C) & \ -+ BIT_MASK_ABORT_RX_RDRDY_COUNTER_8821C) -+#define BIT_SET_ABORT_RX_RDRDY_COUNTER_8821C(x, v) \ -+ (BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8821C(x) | \ -+ BIT_ABORT_RX_RDRDY_COUNTER_8821C(v)) -+ -+#define BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8821C 0 -+#define BIT_MASK_VBON_EARLY_FALLING_COUNTER_8821C 0xff -+#define BIT_VBON_EARLY_FALLING_COUNTER_8821C(x) \ -+ (((x) & BIT_MASK_VBON_EARLY_FALLING_COUNTER_8821C) \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8821C) -+#define BITS_VBON_EARLY_FALLING_COUNTER_8821C \ -+ (BIT_MASK_VBON_EARLY_FALLING_COUNTER_8821C \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8821C) -+#define BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8821C(x) \ -+ ((x) & (~BITS_VBON_EARLY_FALLING_COUNTER_8821C)) -+#define BIT_GET_VBON_EARLY_FALLING_COUNTER_8821C(x) \ -+ (((x) >> BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8821C) & \ -+ BIT_MASK_VBON_EARLY_FALLING_COUNTER_8821C) -+#define BIT_SET_VBON_EARLY_FALLING_COUNTER_8821C(x, v) \ -+ (BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8821C(x) | \ -+ BIT_VBON_EARLY_FALLING_COUNTER_8821C(v)) -+ -+/* 2 REG_WMAC_PLCP_MONITOR_8821C */ -+#define BIT_WMAC_PLCP_TRX_SEL_8821C BIT(31) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8821C 28 -+#define BIT_MASK_WMAC_PLCP_RDSIG_SEL_8821C 0x7 -+#define BIT_WMAC_PLCP_RDSIG_SEL_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_SEL_8821C) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8821C) -+#define BITS_WMAC_PLCP_RDSIG_SEL_8821C \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_SEL_8821C \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8821C) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8821C(x) \ -+ ((x) & (~BITS_WMAC_PLCP_RDSIG_SEL_8821C)) -+#define BIT_GET_WMAC_PLCP_RDSIG_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8821C) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_SEL_8821C) -+#define BIT_SET_WMAC_PLCP_RDSIG_SEL_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8821C(x) | \ -+ BIT_WMAC_PLCP_RDSIG_SEL_8821C(v)) -+ -+#define BIT_SHIFT_WMAC_RATE_IDX_8821C 24 -+#define BIT_MASK_WMAC_RATE_IDX_8821C 0xf -+#define BIT_WMAC_RATE_IDX_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_RATE_IDX_8821C) << BIT_SHIFT_WMAC_RATE_IDX_8821C) -+#define BITS_WMAC_RATE_IDX_8821C \ -+ (BIT_MASK_WMAC_RATE_IDX_8821C << BIT_SHIFT_WMAC_RATE_IDX_8821C) -+#define BIT_CLEAR_WMAC_RATE_IDX_8821C(x) ((x) & (~BITS_WMAC_RATE_IDX_8821C)) -+#define BIT_GET_WMAC_RATE_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RATE_IDX_8821C) & BIT_MASK_WMAC_RATE_IDX_8821C) -+#define BIT_SET_WMAC_RATE_IDX_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_RATE_IDX_8821C(x) | BIT_WMAC_RATE_IDX_8821C(v)) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_8821C 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG_8821C 0xffffff -+#define BIT_WMAC_PLCP_RDSIG_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_8821C) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_8821C) -+#define BITS_WMAC_PLCP_RDSIG_8821C \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_8821C << BIT_SHIFT_WMAC_PLCP_RDSIG_8821C) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_8821C(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_8821C)) -+#define BIT_GET_WMAC_PLCP_RDSIG_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_8821C) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_8821C) -+#define BIT_SET_WMAC_PLCP_RDSIG_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_8821C(x) | BIT_WMAC_PLCP_RDSIG_8821C(v)) -+ -+/* 2 REG_WMAC_PLCP_MONITOR_MUTX_8821C */ -+#define BIT_WMAC_MUTX_IDX_8821C BIT(24) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_8821C 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG_8821C 0xffffff -+#define BIT_WMAC_PLCP_RDSIG_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_8821C) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_8821C) -+#define BITS_WMAC_PLCP_RDSIG_8821C \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_8821C << BIT_SHIFT_WMAC_PLCP_RDSIG_8821C) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_8821C(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_8821C)) -+#define BIT_GET_WMAC_PLCP_RDSIG_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_8821C) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_8821C) -+#define BIT_SET_WMAC_PLCP_RDSIG_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_8821C(x) | BIT_WMAC_PLCP_RDSIG_8821C(v)) -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_8821C (TA0 REGISTER) */ -+ -+#define BIT_SHIFT_TA0_V1_8821C 0 -+#define BIT_MASK_TA0_V1_8821C 0xffffffffL -+#define BIT_TA0_V1_8821C(x) \ -+ (((x) & BIT_MASK_TA0_V1_8821C) << BIT_SHIFT_TA0_V1_8821C) -+#define BITS_TA0_V1_8821C (BIT_MASK_TA0_V1_8821C << BIT_SHIFT_TA0_V1_8821C) -+#define BIT_CLEAR_TA0_V1_8821C(x) ((x) & (~BITS_TA0_V1_8821C)) -+#define BIT_GET_TA0_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TA0_V1_8821C) & BIT_MASK_TA0_V1_8821C) -+#define BIT_SET_TA0_V1_8821C(x, v) \ -+ (BIT_CLEAR_TA0_V1_8821C(x) | BIT_TA0_V1_8821C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_H_8821C (TA0 REGISTER) */ -+ -+#define BIT_SHIFT_TA0_H_V1_8821C 0 -+#define BIT_MASK_TA0_H_V1_8821C 0xffff -+#define BIT_TA0_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_TA0_H_V1_8821C) << BIT_SHIFT_TA0_H_V1_8821C) -+#define BITS_TA0_H_V1_8821C \ -+ (BIT_MASK_TA0_H_V1_8821C << BIT_SHIFT_TA0_H_V1_8821C) -+#define BIT_CLEAR_TA0_H_V1_8821C(x) ((x) & (~BITS_TA0_H_V1_8821C)) -+#define BIT_GET_TA0_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TA0_H_V1_8821C) & BIT_MASK_TA0_H_V1_8821C) -+#define BIT_SET_TA0_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_TA0_H_V1_8821C(x) | BIT_TA0_H_V1_8821C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_8821C (TA1 REGISTER) */ -+ -+#define BIT_SHIFT_TA1_V1_8821C 0 -+#define BIT_MASK_TA1_V1_8821C 0xffffffffL -+#define BIT_TA1_V1_8821C(x) \ -+ (((x) & BIT_MASK_TA1_V1_8821C) << BIT_SHIFT_TA1_V1_8821C) -+#define BITS_TA1_V1_8821C (BIT_MASK_TA1_V1_8821C << BIT_SHIFT_TA1_V1_8821C) -+#define BIT_CLEAR_TA1_V1_8821C(x) ((x) & (~BITS_TA1_V1_8821C)) -+#define BIT_GET_TA1_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TA1_V1_8821C) & BIT_MASK_TA1_V1_8821C) -+#define BIT_SET_TA1_V1_8821C(x, v) \ -+ (BIT_CLEAR_TA1_V1_8821C(x) | BIT_TA1_V1_8821C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_H_8821C (TA1 REGISTER) */ -+ -+#define BIT_SHIFT_TA1_H_V1_8821C 0 -+#define BIT_MASK_TA1_H_V1_8821C 0xffff -+#define BIT_TA1_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_TA1_H_V1_8821C) << BIT_SHIFT_TA1_H_V1_8821C) -+#define BITS_TA1_H_V1_8821C \ -+ (BIT_MASK_TA1_H_V1_8821C << BIT_SHIFT_TA1_H_V1_8821C) -+#define BIT_CLEAR_TA1_H_V1_8821C(x) ((x) & (~BITS_TA1_H_V1_8821C)) -+#define BIT_GET_TA1_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TA1_H_V1_8821C) & BIT_MASK_TA1_H_V1_8821C) -+#define BIT_SET_TA1_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_TA1_H_V1_8821C(x) | BIT_TA1_H_V1_8821C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_8821C (TA2 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_V1_8821C 0 -+#define BIT_MASK_TA2_V1_8821C 0xffffffffL -+#define BIT_TA2_V1_8821C(x) \ -+ (((x) & BIT_MASK_TA2_V1_8821C) << BIT_SHIFT_TA2_V1_8821C) -+#define BITS_TA2_V1_8821C (BIT_MASK_TA2_V1_8821C << BIT_SHIFT_TA2_V1_8821C) -+#define BIT_CLEAR_TA2_V1_8821C(x) ((x) & (~BITS_TA2_V1_8821C)) -+#define BIT_GET_TA2_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TA2_V1_8821C) & BIT_MASK_TA2_V1_8821C) -+#define BIT_SET_TA2_V1_8821C(x, v) \ -+ (BIT_CLEAR_TA2_V1_8821C(x) | BIT_TA2_V1_8821C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_H_8821C (TA2 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_H_V1_8821C 0 -+#define BIT_MASK_TA2_H_V1_8821C 0xffff -+#define BIT_TA2_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_TA2_H_V1_8821C) << BIT_SHIFT_TA2_H_V1_8821C) -+#define BITS_TA2_H_V1_8821C \ -+ (BIT_MASK_TA2_H_V1_8821C << BIT_SHIFT_TA2_H_V1_8821C) -+#define BIT_CLEAR_TA2_H_V1_8821C(x) ((x) & (~BITS_TA2_H_V1_8821C)) -+#define BIT_GET_TA2_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TA2_H_V1_8821C) & BIT_MASK_TA2_H_V1_8821C) -+#define BIT_SET_TA2_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_TA2_H_V1_8821C(x) | BIT_TA2_H_V1_8821C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_8821C (TA3 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_V1_8821C 0 -+#define BIT_MASK_TA2_V1_8821C 0xffffffffL -+#define BIT_TA2_V1_8821C(x) \ -+ (((x) & BIT_MASK_TA2_V1_8821C) << BIT_SHIFT_TA2_V1_8821C) -+#define BITS_TA2_V1_8821C (BIT_MASK_TA2_V1_8821C << BIT_SHIFT_TA2_V1_8821C) -+#define BIT_CLEAR_TA2_V1_8821C(x) ((x) & (~BITS_TA2_V1_8821C)) -+#define BIT_GET_TA2_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TA2_V1_8821C) & BIT_MASK_TA2_V1_8821C) -+#define BIT_SET_TA2_V1_8821C(x, v) \ -+ (BIT_CLEAR_TA2_V1_8821C(x) | BIT_TA2_V1_8821C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_H_8821C (TA3 REGISTER) */ -+ -+#define BIT_SHIFT_TA3_H_V1_8821C 0 -+#define BIT_MASK_TA3_H_V1_8821C 0xffff -+#define BIT_TA3_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_TA3_H_V1_8821C) << BIT_SHIFT_TA3_H_V1_8821C) -+#define BITS_TA3_H_V1_8821C \ -+ (BIT_MASK_TA3_H_V1_8821C << BIT_SHIFT_TA3_H_V1_8821C) -+#define BIT_CLEAR_TA3_H_V1_8821C(x) ((x) & (~BITS_TA3_H_V1_8821C)) -+#define BIT_GET_TA3_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TA3_H_V1_8821C) & BIT_MASK_TA3_H_V1_8821C) -+#define BIT_SET_TA3_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_TA3_H_V1_8821C(x) | BIT_TA3_H_V1_8821C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_8821C (TA4 REGISTER) */ -+ -+#define BIT_SHIFT_TA4_V1_8821C 0 -+#define BIT_MASK_TA4_V1_8821C 0xffffffffL -+#define BIT_TA4_V1_8821C(x) \ -+ (((x) & BIT_MASK_TA4_V1_8821C) << BIT_SHIFT_TA4_V1_8821C) -+#define BITS_TA4_V1_8821C (BIT_MASK_TA4_V1_8821C << BIT_SHIFT_TA4_V1_8821C) -+#define BIT_CLEAR_TA4_V1_8821C(x) ((x) & (~BITS_TA4_V1_8821C)) -+#define BIT_GET_TA4_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TA4_V1_8821C) & BIT_MASK_TA4_V1_8821C) -+#define BIT_SET_TA4_V1_8821C(x, v) \ -+ (BIT_CLEAR_TA4_V1_8821C(x) | BIT_TA4_V1_8821C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_H_8821C (TA4 REGISTER) */ -+ -+#define BIT_SHIFT_TA4_H_V1_8821C 0 -+#define BIT_MASK_TA4_H_V1_8821C 0xffff -+#define BIT_TA4_H_V1_8821C(x) \ -+ (((x) & BIT_MASK_TA4_H_V1_8821C) << BIT_SHIFT_TA4_H_V1_8821C) -+#define BITS_TA4_H_V1_8821C \ -+ (BIT_MASK_TA4_H_V1_8821C << BIT_SHIFT_TA4_H_V1_8821C) -+#define BIT_CLEAR_TA4_H_V1_8821C(x) ((x) & (~BITS_TA4_H_V1_8821C)) -+#define BIT_GET_TA4_H_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TA4_H_V1_8821C) & BIT_MASK_TA4_H_V1_8821C) -+#define BIT_SET_TA4_H_V1_8821C(x, v) \ -+ (BIT_CLEAR_TA4_H_V1_8821C(x) | BIT_TA4_H_V1_8821C(v)) -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_RSVD_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_MACID1_8821C */ -+ -+#define BIT_SHIFT_MACID1_0_8821C 0 -+#define BIT_MASK_MACID1_0_8821C 0xffffffffL -+#define BIT_MACID1_0_8821C(x) \ -+ (((x) & BIT_MASK_MACID1_0_8821C) << BIT_SHIFT_MACID1_0_8821C) -+#define BITS_MACID1_0_8821C \ -+ (BIT_MASK_MACID1_0_8821C << BIT_SHIFT_MACID1_0_8821C) -+#define BIT_CLEAR_MACID1_0_8821C(x) ((x) & (~BITS_MACID1_0_8821C)) -+#define BIT_GET_MACID1_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID1_0_8821C) & BIT_MASK_MACID1_0_8821C) -+#define BIT_SET_MACID1_0_8821C(x, v) \ -+ (BIT_CLEAR_MACID1_0_8821C(x) | BIT_MACID1_0_8821C(v)) -+ -+/* 2 REG_MACID1_1_8821C */ -+ -+#define BIT_SHIFT_MACID1_1_8821C 0 -+#define BIT_MASK_MACID1_1_8821C 0xffff -+#define BIT_MACID1_1_8821C(x) \ -+ (((x) & BIT_MASK_MACID1_1_8821C) << BIT_SHIFT_MACID1_1_8821C) -+#define BITS_MACID1_1_8821C \ -+ (BIT_MASK_MACID1_1_8821C << BIT_SHIFT_MACID1_1_8821C) -+#define BIT_CLEAR_MACID1_1_8821C(x) ((x) & (~BITS_MACID1_1_8821C)) -+#define BIT_GET_MACID1_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MACID1_1_8821C) & BIT_MASK_MACID1_1_8821C) -+#define BIT_SET_MACID1_1_8821C(x, v) \ -+ (BIT_CLEAR_MACID1_1_8821C(x) | BIT_MACID1_1_8821C(v)) -+ -+/* 2 REG_BSSID1_8821C */ -+ -+#define BIT_SHIFT_BSSID1_0_8821C 0 -+#define BIT_MASK_BSSID1_0_8821C 0xffffffffL -+#define BIT_BSSID1_0_8821C(x) \ -+ (((x) & BIT_MASK_BSSID1_0_8821C) << BIT_SHIFT_BSSID1_0_8821C) -+#define BITS_BSSID1_0_8821C \ -+ (BIT_MASK_BSSID1_0_8821C << BIT_SHIFT_BSSID1_0_8821C) -+#define BIT_CLEAR_BSSID1_0_8821C(x) ((x) & (~BITS_BSSID1_0_8821C)) -+#define BIT_GET_BSSID1_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_BSSID1_0_8821C) & BIT_MASK_BSSID1_0_8821C) -+#define BIT_SET_BSSID1_0_8821C(x, v) \ -+ (BIT_CLEAR_BSSID1_0_8821C(x) | BIT_BSSID1_0_8821C(v)) -+ -+/* 2 REG_BSSID1_1_8821C */ -+ -+#define BIT_SHIFT_BSSID1_1_8821C 0 -+#define BIT_MASK_BSSID1_1_8821C 0xffff -+#define BIT_BSSID1_1_8821C(x) \ -+ (((x) & BIT_MASK_BSSID1_1_8821C) << BIT_SHIFT_BSSID1_1_8821C) -+#define BITS_BSSID1_1_8821C \ -+ (BIT_MASK_BSSID1_1_8821C << BIT_SHIFT_BSSID1_1_8821C) -+#define BIT_CLEAR_BSSID1_1_8821C(x) ((x) & (~BITS_BSSID1_1_8821C)) -+#define BIT_GET_BSSID1_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_BSSID1_1_8821C) & BIT_MASK_BSSID1_1_8821C) -+#define BIT_SET_BSSID1_1_8821C(x, v) \ -+ (BIT_CLEAR_BSSID1_1_8821C(x) | BIT_BSSID1_1_8821C(v)) -+ -+/* 2 REG_BCN_PSR_RPT1_8821C */ -+ -+#define BIT_SHIFT_DTIM_CNT1_8821C 24 -+#define BIT_MASK_DTIM_CNT1_8821C 0xff -+#define BIT_DTIM_CNT1_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_CNT1_8821C) << BIT_SHIFT_DTIM_CNT1_8821C) -+#define BITS_DTIM_CNT1_8821C \ -+ (BIT_MASK_DTIM_CNT1_8821C << BIT_SHIFT_DTIM_CNT1_8821C) -+#define BIT_CLEAR_DTIM_CNT1_8821C(x) ((x) & (~BITS_DTIM_CNT1_8821C)) -+#define BIT_GET_DTIM_CNT1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT1_8821C) & BIT_MASK_DTIM_CNT1_8821C) -+#define BIT_SET_DTIM_CNT1_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_CNT1_8821C(x) | BIT_DTIM_CNT1_8821C(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD1_8821C 16 -+#define BIT_MASK_DTIM_PERIOD1_8821C 0xff -+#define BIT_DTIM_PERIOD1_8821C(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD1_8821C) << BIT_SHIFT_DTIM_PERIOD1_8821C) -+#define BITS_DTIM_PERIOD1_8821C \ -+ (BIT_MASK_DTIM_PERIOD1_8821C << BIT_SHIFT_DTIM_PERIOD1_8821C) -+#define BIT_CLEAR_DTIM_PERIOD1_8821C(x) ((x) & (~BITS_DTIM_PERIOD1_8821C)) -+#define BIT_GET_DTIM_PERIOD1_8821C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD1_8821C) & BIT_MASK_DTIM_PERIOD1_8821C) -+#define BIT_SET_DTIM_PERIOD1_8821C(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD1_8821C(x) | BIT_DTIM_PERIOD1_8821C(v)) -+ -+#define BIT_DTIM1_8821C BIT(15) -+#define BIT_TIM1_8821C BIT(14) -+ -+#define BIT_SHIFT_PS_AID_1_8821C 0 -+#define BIT_MASK_PS_AID_1_8821C 0x7ff -+#define BIT_PS_AID_1_8821C(x) \ -+ (((x) & BIT_MASK_PS_AID_1_8821C) << BIT_SHIFT_PS_AID_1_8821C) -+#define BITS_PS_AID_1_8821C \ -+ (BIT_MASK_PS_AID_1_8821C << BIT_SHIFT_PS_AID_1_8821C) -+#define BIT_CLEAR_PS_AID_1_8821C(x) ((x) & (~BITS_PS_AID_1_8821C)) -+#define BIT_GET_PS_AID_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_1_8821C) & BIT_MASK_PS_AID_1_8821C) -+#define BIT_SET_PS_AID_1_8821C(x, v) \ -+ (BIT_CLEAR_PS_AID_1_8821C(x) | BIT_PS_AID_1_8821C(v)) -+ -+/* 2 REG_ASSOCIATED_BFMEE_SEL_8821C */ -+#define BIT_TXUSER_ID1_8821C BIT(25) -+ -+#define BIT_SHIFT_AID1_8821C 16 -+#define BIT_MASK_AID1_8821C 0x1ff -+#define BIT_AID1_8821C(x) (((x) & BIT_MASK_AID1_8821C) << BIT_SHIFT_AID1_8821C) -+#define BITS_AID1_8821C (BIT_MASK_AID1_8821C << BIT_SHIFT_AID1_8821C) -+#define BIT_CLEAR_AID1_8821C(x) ((x) & (~BITS_AID1_8821C)) -+#define BIT_GET_AID1_8821C(x) \ -+ (((x) >> BIT_SHIFT_AID1_8821C) & BIT_MASK_AID1_8821C) -+#define BIT_SET_AID1_8821C(x, v) (BIT_CLEAR_AID1_8821C(x) | BIT_AID1_8821C(v)) -+ -+#define BIT_TXUSER_ID0_8821C BIT(9) -+ -+#define BIT_SHIFT_AID0_8821C 0 -+#define BIT_MASK_AID0_8821C 0x1ff -+#define BIT_AID0_8821C(x) (((x) & BIT_MASK_AID0_8821C) << BIT_SHIFT_AID0_8821C) -+#define BITS_AID0_8821C (BIT_MASK_AID0_8821C << BIT_SHIFT_AID0_8821C) -+#define BIT_CLEAR_AID0_8821C(x) ((x) & (~BITS_AID0_8821C)) -+#define BIT_GET_AID0_8821C(x) \ -+ (((x) >> BIT_SHIFT_AID0_8821C) & BIT_MASK_AID0_8821C) -+#define BIT_SET_AID0_8821C(x, v) (BIT_CLEAR_AID0_8821C(x) | BIT_AID0_8821C(v)) -+ -+/* 2 REG_SND_PTCL_CTRL_8821C */ -+ -+#define BIT_SHIFT_NDP_RX_STANDBY_TIMER_8821C 24 -+#define BIT_MASK_NDP_RX_STANDBY_TIMER_8821C 0xff -+#define BIT_NDP_RX_STANDBY_TIMER_8821C(x) \ -+ (((x) & BIT_MASK_NDP_RX_STANDBY_TIMER_8821C) \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8821C) -+#define BITS_NDP_RX_STANDBY_TIMER_8821C \ -+ (BIT_MASK_NDP_RX_STANDBY_TIMER_8821C \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8821C) -+#define BIT_CLEAR_NDP_RX_STANDBY_TIMER_8821C(x) \ -+ ((x) & (~BITS_NDP_RX_STANDBY_TIMER_8821C)) -+#define BIT_GET_NDP_RX_STANDBY_TIMER_8821C(x) \ -+ (((x) >> BIT_SHIFT_NDP_RX_STANDBY_TIMER_8821C) & \ -+ BIT_MASK_NDP_RX_STANDBY_TIMER_8821C) -+#define BIT_SET_NDP_RX_STANDBY_TIMER_8821C(x, v) \ -+ (BIT_CLEAR_NDP_RX_STANDBY_TIMER_8821C(x) | \ -+ BIT_NDP_RX_STANDBY_TIMER_8821C(v)) -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_HT_8821C 16 -+#define BIT_MASK_CSI_RPT_OFFSET_HT_8821C 0xff -+#define BIT_CSI_RPT_OFFSET_HT_8821C(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_HT_8821C) \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_HT_8821C) -+#define BITS_CSI_RPT_OFFSET_HT_8821C \ -+ (BIT_MASK_CSI_RPT_OFFSET_HT_8821C << BIT_SHIFT_CSI_RPT_OFFSET_HT_8821C) -+#define BIT_CLEAR_CSI_RPT_OFFSET_HT_8821C(x) \ -+ ((x) & (~BITS_CSI_RPT_OFFSET_HT_8821C)) -+#define BIT_GET_CSI_RPT_OFFSET_HT_8821C(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_HT_8821C) & \ -+ BIT_MASK_CSI_RPT_OFFSET_HT_8821C) -+#define BIT_SET_CSI_RPT_OFFSET_HT_8821C(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_HT_8821C(x) | BIT_CSI_RPT_OFFSET_HT_8821C(v)) -+ -+#define BIT_SHIFT_R_WMAC_VHT_CATEGORY_8821C 8 -+#define BIT_MASK_R_WMAC_VHT_CATEGORY_8821C 0xff -+#define BIT_R_WMAC_VHT_CATEGORY_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_VHT_CATEGORY_8821C) \ -+ << BIT_SHIFT_R_WMAC_VHT_CATEGORY_8821C) -+#define BITS_R_WMAC_VHT_CATEGORY_8821C \ -+ (BIT_MASK_R_WMAC_VHT_CATEGORY_8821C \ -+ << BIT_SHIFT_R_WMAC_VHT_CATEGORY_8821C) -+#define BIT_CLEAR_R_WMAC_VHT_CATEGORY_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_VHT_CATEGORY_8821C)) -+#define BIT_GET_R_WMAC_VHT_CATEGORY_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_VHT_CATEGORY_8821C) & \ -+ BIT_MASK_R_WMAC_VHT_CATEGORY_8821C) -+#define BIT_SET_R_WMAC_VHT_CATEGORY_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_VHT_CATEGORY_8821C(x) | \ -+ BIT_R_WMAC_VHT_CATEGORY_8821C(v)) -+ -+#define BIT_R_WMAC_USE_NSTS_8821C BIT(7) -+#define BIT_R_DISABLE_CHECK_VHTSIGB_CRC_8821C BIT(6) -+#define BIT_R_DISABLE_CHECK_VHTSIGA_CRC_8821C BIT(5) -+#define BIT_R_WMAC_BFPARAM_SEL_8821C BIT(4) -+#define BIT_R_WMAC_CSISEQ_SEL_8821C BIT(3) -+#define BIT_R_WMAC_CSI_WITHHTC_EN_8821C BIT(2) -+#define BIT_R_WMAC_HT_NDPA_EN_8821C BIT(1) -+#define BIT_R_WMAC_VHT_NDPA_EN_8821C BIT(0) -+ -+/* 2 REG_RX_CSI_RPT_INFO_8821C */ -+ -+/* 2 REG_NS_ARP_CTRL_8821C */ -+#define BIT_R_WMAC_NSARP_RSPEN_8821C BIT(15) -+#define BIT_R_WMAC_NSARP_RARP_8821C BIT(9) -+#define BIT_R_WMAC_NSARP_RIPV6_8821C BIT(8) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_MODEN_8821C 6 -+#define BIT_MASK_R_WMAC_NSARP_MODEN_8821C 0x3 -+#define BIT_R_WMAC_NSARP_MODEN_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_MODEN_8821C) \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8821C) -+#define BITS_R_WMAC_NSARP_MODEN_8821C \ -+ (BIT_MASK_R_WMAC_NSARP_MODEN_8821C \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8821C) -+#define BIT_CLEAR_R_WMAC_NSARP_MODEN_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_MODEN_8821C)) -+#define BIT_GET_R_WMAC_NSARP_MODEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_MODEN_8821C) & \ -+ BIT_MASK_R_WMAC_NSARP_MODEN_8821C) -+#define BIT_SET_R_WMAC_NSARP_MODEN_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_MODEN_8821C(x) | \ -+ BIT_R_WMAC_NSARP_MODEN_8821C(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8821C 4 -+#define BIT_MASK_R_WMAC_NSARP_RSPFTP_8821C 0x3 -+#define BIT_R_WMAC_NSARP_RSPFTP_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPFTP_8821C) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8821C) -+#define BITS_R_WMAC_NSARP_RSPFTP_8821C \ -+ (BIT_MASK_R_WMAC_NSARP_RSPFTP_8821C \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8821C) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPFTP_8821C)) -+#define BIT_GET_R_WMAC_NSARP_RSPFTP_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8821C) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPFTP_8821C) -+#define BIT_SET_R_WMAC_NSARP_RSPFTP_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8821C(x) | \ -+ BIT_R_WMAC_NSARP_RSPFTP_8821C(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8821C 0 -+#define BIT_MASK_R_WMAC_NSARP_RSPSEC_8821C 0xf -+#define BIT_R_WMAC_NSARP_RSPSEC_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPSEC_8821C) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8821C) -+#define BITS_R_WMAC_NSARP_RSPSEC_8821C \ -+ (BIT_MASK_R_WMAC_NSARP_RSPSEC_8821C \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8821C) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPSEC_8821C)) -+#define BIT_GET_R_WMAC_NSARP_RSPSEC_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8821C) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPSEC_8821C) -+#define BIT_SET_R_WMAC_NSARP_RSPSEC_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8821C(x) | \ -+ BIT_R_WMAC_NSARP_RSPSEC_8821C(v)) -+ -+/* 2 REG_NS_ARP_INFO_8821C */ -+#define BIT_REQ_IS_MCNS_8821C BIT(23) -+#define BIT_REQ_IS_UCNS_8821C BIT(22) -+#define BIT_REQ_IS_USNS_8821C BIT(21) -+#define BIT_REQ_IS_ARP_8821C BIT(20) -+#define BIT_EXPRSP_MH_WITHQC_8821C BIT(19) -+ -+#define BIT_SHIFT_EXPRSP_SECTYPE_8821C 16 -+#define BIT_MASK_EXPRSP_SECTYPE_8821C 0x7 -+#define BIT_EXPRSP_SECTYPE_8821C(x) \ -+ (((x) & BIT_MASK_EXPRSP_SECTYPE_8821C) \ -+ << BIT_SHIFT_EXPRSP_SECTYPE_8821C) -+#define BITS_EXPRSP_SECTYPE_8821C \ -+ (BIT_MASK_EXPRSP_SECTYPE_8821C << BIT_SHIFT_EXPRSP_SECTYPE_8821C) -+#define BIT_CLEAR_EXPRSP_SECTYPE_8821C(x) ((x) & (~BITS_EXPRSP_SECTYPE_8821C)) -+#define BIT_GET_EXPRSP_SECTYPE_8821C(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_SECTYPE_8821C) & \ -+ BIT_MASK_EXPRSP_SECTYPE_8821C) -+#define BIT_SET_EXPRSP_SECTYPE_8821C(x, v) \ -+ (BIT_CLEAR_EXPRSP_SECTYPE_8821C(x) | BIT_EXPRSP_SECTYPE_8821C(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8821C 8 -+#define BIT_MASK_EXPRSP_CHKSM_7_TO_0_8821C 0xff -+#define BIT_EXPRSP_CHKSM_7_TO_0_8821C(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_7_TO_0_8821C) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8821C) -+#define BITS_EXPRSP_CHKSM_7_TO_0_8821C \ -+ (BIT_MASK_EXPRSP_CHKSM_7_TO_0_8821C \ -+ << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8821C) -+#define BIT_CLEAR_EXPRSP_CHKSM_7_TO_0_8821C(x) \ -+ ((x) & (~BITS_EXPRSP_CHKSM_7_TO_0_8821C)) -+#define BIT_GET_EXPRSP_CHKSM_7_TO_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8821C) & \ -+ BIT_MASK_EXPRSP_CHKSM_7_TO_0_8821C) -+#define BIT_SET_EXPRSP_CHKSM_7_TO_0_8821C(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_7_TO_0_8821C(x) | \ -+ BIT_EXPRSP_CHKSM_7_TO_0_8821C(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8821C 0 -+#define BIT_MASK_EXPRSP_CHKSM_15_TO_8_8821C 0xff -+#define BIT_EXPRSP_CHKSM_15_TO_8_8821C(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_15_TO_8_8821C) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8821C) -+#define BITS_EXPRSP_CHKSM_15_TO_8_8821C \ -+ (BIT_MASK_EXPRSP_CHKSM_15_TO_8_8821C \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8821C) -+#define BIT_CLEAR_EXPRSP_CHKSM_15_TO_8_8821C(x) \ -+ ((x) & (~BITS_EXPRSP_CHKSM_15_TO_8_8821C)) -+#define BIT_GET_EXPRSP_CHKSM_15_TO_8_8821C(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8821C) & \ -+ BIT_MASK_EXPRSP_CHKSM_15_TO_8_8821C) -+#define BIT_SET_EXPRSP_CHKSM_15_TO_8_8821C(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_15_TO_8_8821C(x) | \ -+ BIT_EXPRSP_CHKSM_15_TO_8_8821C(v)) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_V1_8821C */ -+ -+#define BIT_SHIFT_WMAC_ARPIP_8821C 0 -+#define BIT_MASK_WMAC_ARPIP_8821C 0xffffffffL -+#define BIT_WMAC_ARPIP_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_ARPIP_8821C) << BIT_SHIFT_WMAC_ARPIP_8821C) -+#define BITS_WMAC_ARPIP_8821C \ -+ (BIT_MASK_WMAC_ARPIP_8821C << BIT_SHIFT_WMAC_ARPIP_8821C) -+#define BIT_CLEAR_WMAC_ARPIP_8821C(x) ((x) & (~BITS_WMAC_ARPIP_8821C)) -+#define BIT_GET_WMAC_ARPIP_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARPIP_8821C) & BIT_MASK_WMAC_ARPIP_8821C) -+#define BIT_SET_WMAC_ARPIP_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_ARPIP_8821C(x) | BIT_WMAC_ARPIP_8821C(v)) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_8821C */ -+ -+#define BIT_SHIFT_BEAMFORMING_INFO_8821C 0 -+#define BIT_MASK_BEAMFORMING_INFO_8821C 0xffffffffL -+#define BIT_BEAMFORMING_INFO_8821C(x) \ -+ (((x) & BIT_MASK_BEAMFORMING_INFO_8821C) \ -+ << BIT_SHIFT_BEAMFORMING_INFO_8821C) -+#define BITS_BEAMFORMING_INFO_8821C \ -+ (BIT_MASK_BEAMFORMING_INFO_8821C << BIT_SHIFT_BEAMFORMING_INFO_8821C) -+#define BIT_CLEAR_BEAMFORMING_INFO_8821C(x) \ -+ ((x) & (~BITS_BEAMFORMING_INFO_8821C)) -+#define BIT_GET_BEAMFORMING_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_BEAMFORMING_INFO_8821C) & \ -+ BIT_MASK_BEAMFORMING_INFO_8821C) -+#define BIT_SET_BEAMFORMING_INFO_8821C(x, v) \ -+ (BIT_CLEAR_BEAMFORMING_INFO_8821C(x) | BIT_BEAMFORMING_INFO_8821C(v)) -+ -+/* 2 REG_IPV6_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8821C 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8821C 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_0_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8821C) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8821C) -+#define BITS_R_WMAC_IPV6_MYIPAD_0_8821C \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8821C \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8821C) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_0_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_0_8821C)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8821C) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8821C) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_0_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_0_8821C(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_0_8821C(v)) -+ -+/* 2 REG_IPV6_1_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8821C 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8821C 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_1_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8821C) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8821C) -+#define BITS_R_WMAC_IPV6_MYIPAD_1_8821C \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8821C \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8821C) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_1_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_1_8821C)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8821C) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8821C) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_1_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_1_8821C(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_1_8821C(v)) -+ -+/* 2 REG_IPV6_2_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8821C 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8821C 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_2_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8821C) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8821C) -+#define BITS_R_WMAC_IPV6_MYIPAD_2_8821C \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8821C \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8821C) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_2_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_2_8821C)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8821C) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8821C) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_2_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_2_8821C(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_2_8821C(v)) -+ -+/* 2 REG_IPV6_3_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8821C 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8821C 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_3_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8821C) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8821C) -+#define BITS_R_WMAC_IPV6_MYIPAD_3_8821C \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8821C \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8821C) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_3_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_3_8821C)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_3_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8821C) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8821C) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_3_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_3_8821C(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_3_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_WMAC_RTX_CTX_SUBTYPE_CFG_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8821C 4 -+#define BIT_MASK_R_WMAC_CTX_SUBTYPE_8821C 0xf -+#define BIT_R_WMAC_CTX_SUBTYPE_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_CTX_SUBTYPE_8821C) \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8821C) -+#define BITS_R_WMAC_CTX_SUBTYPE_8821C \ -+ (BIT_MASK_R_WMAC_CTX_SUBTYPE_8821C \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8821C) -+#define BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_CTX_SUBTYPE_8821C)) -+#define BIT_GET_R_WMAC_CTX_SUBTYPE_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8821C) & \ -+ BIT_MASK_R_WMAC_CTX_SUBTYPE_8821C) -+#define BIT_SET_R_WMAC_CTX_SUBTYPE_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8821C(x) | \ -+ BIT_R_WMAC_CTX_SUBTYPE_8821C(v)) -+ -+#define BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8821C 0 -+#define BIT_MASK_R_WMAC_RTX_SUBTYPE_8821C 0xf -+#define BIT_R_WMAC_RTX_SUBTYPE_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_RTX_SUBTYPE_8821C) \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8821C) -+#define BITS_R_WMAC_RTX_SUBTYPE_8821C \ -+ (BIT_MASK_R_WMAC_RTX_SUBTYPE_8821C \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8821C) -+#define BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_RTX_SUBTYPE_8821C)) -+#define BIT_GET_R_WMAC_RTX_SUBTYPE_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8821C) & \ -+ BIT_MASK_R_WMAC_RTX_SUBTYPE_8821C) -+#define BIT_SET_R_WMAC_RTX_SUBTYPE_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8821C(x) | \ -+ BIT_R_WMAC_RTX_SUBTYPE_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_WMAC_SWAES_CFG_8821C */ -+ -+/* 2 REG_BT_COEX_V2_8821C */ -+#define BIT_GNT_BT_POLARITY_8821C BIT(12) -+#define BIT_GNT_BT_BYPASS_PRIORITY_8821C BIT(8) -+ -+#define BIT_SHIFT_TIMER_8821C 0 -+#define BIT_MASK_TIMER_8821C 0xff -+#define BIT_TIMER_8821C(x) \ -+ (((x) & BIT_MASK_TIMER_8821C) << BIT_SHIFT_TIMER_8821C) -+#define BITS_TIMER_8821C (BIT_MASK_TIMER_8821C << BIT_SHIFT_TIMER_8821C) -+#define BIT_CLEAR_TIMER_8821C(x) ((x) & (~BITS_TIMER_8821C)) -+#define BIT_GET_TIMER_8821C(x) \ -+ (((x) >> BIT_SHIFT_TIMER_8821C) & BIT_MASK_TIMER_8821C) -+#define BIT_SET_TIMER_8821C(x, v) \ -+ (BIT_CLEAR_TIMER_8821C(x) | BIT_TIMER_8821C(v)) -+ -+/* 2 REG_BT_COEX_8821C */ -+#define BIT_R_GNT_BT_RFC_SW_8821C BIT(12) -+#define BIT_R_GNT_BT_RFC_SW_EN_8821C BIT(11) -+#define BIT_R_GNT_BT_BB_SW_8821C BIT(10) -+#define BIT_R_GNT_BT_BB_SW_EN_8821C BIT(9) -+#define BIT_R_BT_CNT_THREN_8821C BIT(8) -+ -+#define BIT_SHIFT_R_BT_CNT_THR_8821C 0 -+#define BIT_MASK_R_BT_CNT_THR_8821C 0xff -+#define BIT_R_BT_CNT_THR_8821C(x) \ -+ (((x) & BIT_MASK_R_BT_CNT_THR_8821C) << BIT_SHIFT_R_BT_CNT_THR_8821C) -+#define BITS_R_BT_CNT_THR_8821C \ -+ (BIT_MASK_R_BT_CNT_THR_8821C << BIT_SHIFT_R_BT_CNT_THR_8821C) -+#define BIT_CLEAR_R_BT_CNT_THR_8821C(x) ((x) & (~BITS_R_BT_CNT_THR_8821C)) -+#define BIT_GET_R_BT_CNT_THR_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CNT_THR_8821C) & BIT_MASK_R_BT_CNT_THR_8821C) -+#define BIT_SET_R_BT_CNT_THR_8821C(x, v) \ -+ (BIT_CLEAR_R_BT_CNT_THR_8821C(x) | BIT_R_BT_CNT_THR_8821C(v)) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_8821C */ -+ -+#define BIT_SHIFT_RXMYRTS_NAV_V1_8821C 8 -+#define BIT_MASK_RXMYRTS_NAV_V1_8821C 0xff -+#define BIT_RXMYRTS_NAV_V1_8821C(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_V1_8821C) \ -+ << BIT_SHIFT_RXMYRTS_NAV_V1_8821C) -+#define BITS_RXMYRTS_NAV_V1_8821C \ -+ (BIT_MASK_RXMYRTS_NAV_V1_8821C << BIT_SHIFT_RXMYRTS_NAV_V1_8821C) -+#define BIT_CLEAR_RXMYRTS_NAV_V1_8821C(x) ((x) & (~BITS_RXMYRTS_NAV_V1_8821C)) -+#define BIT_GET_RXMYRTS_NAV_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_V1_8821C) & \ -+ BIT_MASK_RXMYRTS_NAV_V1_8821C) -+#define BIT_SET_RXMYRTS_NAV_V1_8821C(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_V1_8821C(x) | BIT_RXMYRTS_NAV_V1_8821C(v)) -+ -+#define BIT_SHIFT_RTSRST_V1_8821C 0 -+#define BIT_MASK_RTSRST_V1_8821C 0xff -+#define BIT_RTSRST_V1_8821C(x) \ -+ (((x) & BIT_MASK_RTSRST_V1_8821C) << BIT_SHIFT_RTSRST_V1_8821C) -+#define BITS_RTSRST_V1_8821C \ -+ (BIT_MASK_RTSRST_V1_8821C << BIT_SHIFT_RTSRST_V1_8821C) -+#define BIT_CLEAR_RTSRST_V1_8821C(x) ((x) & (~BITS_RTSRST_V1_8821C)) -+#define BIT_GET_RTSRST_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_V1_8821C) & BIT_MASK_RTSRST_V1_8821C) -+#define BIT_SET_RTSRST_V1_8821C(x, v) \ -+ (BIT_CLEAR_RTSRST_V1_8821C(x) | BIT_RTSRST_V1_8821C(v)) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_1_8821C */ -+#define BIT_WLRX_TER_BY_CTL_1_8821C BIT(11) -+#define BIT_WLRX_TER_BY_AD_1_8821C BIT(10) -+#define BIT_ANT_DIVERSITY_SEL_1_8821C BIT(9) -+#define BIT_ANTSEL_FOR_BT_CTRL_EN_1_8821C BIT(8) -+#define BIT_WLACT_LOW_GNTWL_EN_1_8821C BIT(2) -+#define BIT_WLACT_HIGH_GNTBT_EN_1_8821C BIT(1) -+#define BIT_NAV_UPPER_1_V1_8821C BIT(0) -+ -+/* 2 REG_BT_COEX_ENHANCED_INTR_CTRL_8821C */ -+ -+#define BIT_SHIFT_BT_STAT_DELAY_8821C 12 -+#define BIT_MASK_BT_STAT_DELAY_8821C 0xf -+#define BIT_BT_STAT_DELAY_8821C(x) \ -+ (((x) & BIT_MASK_BT_STAT_DELAY_8821C) << BIT_SHIFT_BT_STAT_DELAY_8821C) -+#define BITS_BT_STAT_DELAY_8821C \ -+ (BIT_MASK_BT_STAT_DELAY_8821C << BIT_SHIFT_BT_STAT_DELAY_8821C) -+#define BIT_CLEAR_BT_STAT_DELAY_8821C(x) ((x) & (~BITS_BT_STAT_DELAY_8821C)) -+#define BIT_GET_BT_STAT_DELAY_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_STAT_DELAY_8821C) & BIT_MASK_BT_STAT_DELAY_8821C) -+#define BIT_SET_BT_STAT_DELAY_8821C(x, v) \ -+ (BIT_CLEAR_BT_STAT_DELAY_8821C(x) | BIT_BT_STAT_DELAY_8821C(v)) -+ -+#define BIT_SHIFT_BT_TRX_INIT_DETECT_8821C 8 -+#define BIT_MASK_BT_TRX_INIT_DETECT_8821C 0xf -+#define BIT_BT_TRX_INIT_DETECT_8821C(x) \ -+ (((x) & BIT_MASK_BT_TRX_INIT_DETECT_8821C) \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8821C) -+#define BITS_BT_TRX_INIT_DETECT_8821C \ -+ (BIT_MASK_BT_TRX_INIT_DETECT_8821C \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8821C) -+#define BIT_CLEAR_BT_TRX_INIT_DETECT_8821C(x) \ -+ ((x) & (~BITS_BT_TRX_INIT_DETECT_8821C)) -+#define BIT_GET_BT_TRX_INIT_DETECT_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_TRX_INIT_DETECT_8821C) & \ -+ BIT_MASK_BT_TRX_INIT_DETECT_8821C) -+#define BIT_SET_BT_TRX_INIT_DETECT_8821C(x, v) \ -+ (BIT_CLEAR_BT_TRX_INIT_DETECT_8821C(x) | \ -+ BIT_BT_TRX_INIT_DETECT_8821C(v)) -+ -+#define BIT_SHIFT_BT_PRI_DETECT_TO_8821C 4 -+#define BIT_MASK_BT_PRI_DETECT_TO_8821C 0xf -+#define BIT_BT_PRI_DETECT_TO_8821C(x) \ -+ (((x) & BIT_MASK_BT_PRI_DETECT_TO_8821C) \ -+ << BIT_SHIFT_BT_PRI_DETECT_TO_8821C) -+#define BITS_BT_PRI_DETECT_TO_8821C \ -+ (BIT_MASK_BT_PRI_DETECT_TO_8821C << BIT_SHIFT_BT_PRI_DETECT_TO_8821C) -+#define BIT_CLEAR_BT_PRI_DETECT_TO_8821C(x) \ -+ ((x) & (~BITS_BT_PRI_DETECT_TO_8821C)) -+#define BIT_GET_BT_PRI_DETECT_TO_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_PRI_DETECT_TO_8821C) & \ -+ BIT_MASK_BT_PRI_DETECT_TO_8821C) -+#define BIT_SET_BT_PRI_DETECT_TO_8821C(x, v) \ -+ (BIT_CLEAR_BT_PRI_DETECT_TO_8821C(x) | BIT_BT_PRI_DETECT_TO_8821C(v)) -+ -+#define BIT_R_GRANTALL_WLMASK_8821C BIT(3) -+#define BIT_STATIS_BT_EN_8821C BIT(2) -+#define BIT_WL_ACT_MASK_ENABLE_8821C BIT(1) -+#define BIT_ENHANCED_BT_8821C BIT(0) -+ -+/* 2 REG_BT_ACT_STATISTICS_8821C */ -+ -+#define BIT_SHIFT_STATIS_BT_HI_RX_8821C 16 -+#define BIT_MASK_STATIS_BT_HI_RX_8821C 0xffff -+#define BIT_STATIS_BT_HI_RX_8821C(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_RX_8821C) \ -+ << BIT_SHIFT_STATIS_BT_HI_RX_8821C) -+#define BITS_STATIS_BT_HI_RX_8821C \ -+ (BIT_MASK_STATIS_BT_HI_RX_8821C << BIT_SHIFT_STATIS_BT_HI_RX_8821C) -+#define BIT_CLEAR_STATIS_BT_HI_RX_8821C(x) ((x) & (~BITS_STATIS_BT_HI_RX_8821C)) -+#define BIT_GET_STATIS_BT_HI_RX_8821C(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_RX_8821C) & \ -+ BIT_MASK_STATIS_BT_HI_RX_8821C) -+#define BIT_SET_STATIS_BT_HI_RX_8821C(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_RX_8821C(x) | BIT_STATIS_BT_HI_RX_8821C(v)) -+ -+#define BIT_SHIFT_STATIS_BT_HI_TX_8821C 0 -+#define BIT_MASK_STATIS_BT_HI_TX_8821C 0xffff -+#define BIT_STATIS_BT_HI_TX_8821C(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_TX_8821C) \ -+ << BIT_SHIFT_STATIS_BT_HI_TX_8821C) -+#define BITS_STATIS_BT_HI_TX_8821C \ -+ (BIT_MASK_STATIS_BT_HI_TX_8821C << BIT_SHIFT_STATIS_BT_HI_TX_8821C) -+#define BIT_CLEAR_STATIS_BT_HI_TX_8821C(x) ((x) & (~BITS_STATIS_BT_HI_TX_8821C)) -+#define BIT_GET_STATIS_BT_HI_TX_8821C(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_TX_8821C) & \ -+ BIT_MASK_STATIS_BT_HI_TX_8821C) -+#define BIT_SET_STATIS_BT_HI_TX_8821C(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_TX_8821C(x) | BIT_STATIS_BT_HI_TX_8821C(v)) -+ -+/* 2 REG_BT_ACT_STATISTICS_1_8821C */ -+ -+#define BIT_SHIFT_STATIS_BT_LO_RX_1_8821C 16 -+#define BIT_MASK_STATIS_BT_LO_RX_1_8821C 0xffff -+#define BIT_STATIS_BT_LO_RX_1_8821C(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_RX_1_8821C) \ -+ << BIT_SHIFT_STATIS_BT_LO_RX_1_8821C) -+#define BITS_STATIS_BT_LO_RX_1_8821C \ -+ (BIT_MASK_STATIS_BT_LO_RX_1_8821C << BIT_SHIFT_STATIS_BT_LO_RX_1_8821C) -+#define BIT_CLEAR_STATIS_BT_LO_RX_1_8821C(x) \ -+ ((x) & (~BITS_STATIS_BT_LO_RX_1_8821C)) -+#define BIT_GET_STATIS_BT_LO_RX_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_RX_1_8821C) & \ -+ BIT_MASK_STATIS_BT_LO_RX_1_8821C) -+#define BIT_SET_STATIS_BT_LO_RX_1_8821C(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_RX_1_8821C(x) | BIT_STATIS_BT_LO_RX_1_8821C(v)) -+ -+#define BIT_SHIFT_STATIS_BT_LO_TX_1_8821C 0 -+#define BIT_MASK_STATIS_BT_LO_TX_1_8821C 0xffff -+#define BIT_STATIS_BT_LO_TX_1_8821C(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_TX_1_8821C) \ -+ << BIT_SHIFT_STATIS_BT_LO_TX_1_8821C) -+#define BITS_STATIS_BT_LO_TX_1_8821C \ -+ (BIT_MASK_STATIS_BT_LO_TX_1_8821C << BIT_SHIFT_STATIS_BT_LO_TX_1_8821C) -+#define BIT_CLEAR_STATIS_BT_LO_TX_1_8821C(x) \ -+ ((x) & (~BITS_STATIS_BT_LO_TX_1_8821C)) -+#define BIT_GET_STATIS_BT_LO_TX_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_TX_1_8821C) & \ -+ BIT_MASK_STATIS_BT_LO_TX_1_8821C) -+#define BIT_SET_STATIS_BT_LO_TX_1_8821C(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_TX_1_8821C(x) | BIT_STATIS_BT_LO_TX_1_8821C(v)) -+ -+/* 2 REG_BT_STATISTICS_CONTROL_REGISTER_8821C */ -+ -+#define BIT_SHIFT_R_BT_CMD_RPT_8821C 16 -+#define BIT_MASK_R_BT_CMD_RPT_8821C 0xffff -+#define BIT_R_BT_CMD_RPT_8821C(x) \ -+ (((x) & BIT_MASK_R_BT_CMD_RPT_8821C) << BIT_SHIFT_R_BT_CMD_RPT_8821C) -+#define BITS_R_BT_CMD_RPT_8821C \ -+ (BIT_MASK_R_BT_CMD_RPT_8821C << BIT_SHIFT_R_BT_CMD_RPT_8821C) -+#define BIT_CLEAR_R_BT_CMD_RPT_8821C(x) ((x) & (~BITS_R_BT_CMD_RPT_8821C)) -+#define BIT_GET_R_BT_CMD_RPT_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CMD_RPT_8821C) & BIT_MASK_R_BT_CMD_RPT_8821C) -+#define BIT_SET_R_BT_CMD_RPT_8821C(x, v) \ -+ (BIT_CLEAR_R_BT_CMD_RPT_8821C(x) | BIT_R_BT_CMD_RPT_8821C(v)) -+ -+#define BIT_SHIFT_R_RPT_FROM_BT_8821C 8 -+#define BIT_MASK_R_RPT_FROM_BT_8821C 0xff -+#define BIT_R_RPT_FROM_BT_8821C(x) \ -+ (((x) & BIT_MASK_R_RPT_FROM_BT_8821C) << BIT_SHIFT_R_RPT_FROM_BT_8821C) -+#define BITS_R_RPT_FROM_BT_8821C \ -+ (BIT_MASK_R_RPT_FROM_BT_8821C << BIT_SHIFT_R_RPT_FROM_BT_8821C) -+#define BIT_CLEAR_R_RPT_FROM_BT_8821C(x) ((x) & (~BITS_R_RPT_FROM_BT_8821C)) -+#define BIT_GET_R_RPT_FROM_BT_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_RPT_FROM_BT_8821C) & BIT_MASK_R_RPT_FROM_BT_8821C) -+#define BIT_SET_R_RPT_FROM_BT_8821C(x, v) \ -+ (BIT_CLEAR_R_RPT_FROM_BT_8821C(x) | BIT_R_RPT_FROM_BT_8821C(v)) -+ -+#define BIT_SHIFT_BT_HID_ISR_SET_8821C 6 -+#define BIT_MASK_BT_HID_ISR_SET_8821C 0x3 -+#define BIT_BT_HID_ISR_SET_8821C(x) \ -+ (((x) & BIT_MASK_BT_HID_ISR_SET_8821C) \ -+ << BIT_SHIFT_BT_HID_ISR_SET_8821C) -+#define BITS_BT_HID_ISR_SET_8821C \ -+ (BIT_MASK_BT_HID_ISR_SET_8821C << BIT_SHIFT_BT_HID_ISR_SET_8821C) -+#define BIT_CLEAR_BT_HID_ISR_SET_8821C(x) ((x) & (~BITS_BT_HID_ISR_SET_8821C)) -+#define BIT_GET_BT_HID_ISR_SET_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_HID_ISR_SET_8821C) & \ -+ BIT_MASK_BT_HID_ISR_SET_8821C) -+#define BIT_SET_BT_HID_ISR_SET_8821C(x, v) \ -+ (BIT_CLEAR_BT_HID_ISR_SET_8821C(x) | BIT_BT_HID_ISR_SET_8821C(v)) -+ -+#define BIT_TDMA_BT_START_NOTIFY_8821C BIT(5) -+#define BIT_ENABLE_TDMA_FW_MODE_8821C BIT(4) -+#define BIT_ENABLE_PTA_TDMA_MODE_8821C BIT(3) -+#define BIT_ENABLE_COEXIST_TAB_IN_TDMA_8821C BIT(2) -+#define BIT_GPIO2_GPIO3_EXANGE_OR_NO_BT_CCA_8821C BIT(1) -+#define BIT_RTK_BT_ENABLE_8821C BIT(0) -+ -+/* 2 REG_BT_STATUS_REPORT_REGISTER_8821C */ -+ -+#define BIT_SHIFT_BT_PROFILE_8821C 24 -+#define BIT_MASK_BT_PROFILE_8821C 0xff -+#define BIT_BT_PROFILE_8821C(x) \ -+ (((x) & BIT_MASK_BT_PROFILE_8821C) << BIT_SHIFT_BT_PROFILE_8821C) -+#define BITS_BT_PROFILE_8821C \ -+ (BIT_MASK_BT_PROFILE_8821C << BIT_SHIFT_BT_PROFILE_8821C) -+#define BIT_CLEAR_BT_PROFILE_8821C(x) ((x) & (~BITS_BT_PROFILE_8821C)) -+#define BIT_GET_BT_PROFILE_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_PROFILE_8821C) & BIT_MASK_BT_PROFILE_8821C) -+#define BIT_SET_BT_PROFILE_8821C(x, v) \ -+ (BIT_CLEAR_BT_PROFILE_8821C(x) | BIT_BT_PROFILE_8821C(v)) -+ -+#define BIT_SHIFT_BT_POWER_8821C 16 -+#define BIT_MASK_BT_POWER_8821C 0xff -+#define BIT_BT_POWER_8821C(x) \ -+ (((x) & BIT_MASK_BT_POWER_8821C) << BIT_SHIFT_BT_POWER_8821C) -+#define BITS_BT_POWER_8821C \ -+ (BIT_MASK_BT_POWER_8821C << BIT_SHIFT_BT_POWER_8821C) -+#define BIT_CLEAR_BT_POWER_8821C(x) ((x) & (~BITS_BT_POWER_8821C)) -+#define BIT_GET_BT_POWER_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_POWER_8821C) & BIT_MASK_BT_POWER_8821C) -+#define BIT_SET_BT_POWER_8821C(x, v) \ -+ (BIT_CLEAR_BT_POWER_8821C(x) | BIT_BT_POWER_8821C(v)) -+ -+#define BIT_SHIFT_BT_PREDECT_STATUS_8821C 8 -+#define BIT_MASK_BT_PREDECT_STATUS_8821C 0xff -+#define BIT_BT_PREDECT_STATUS_8821C(x) \ -+ (((x) & BIT_MASK_BT_PREDECT_STATUS_8821C) \ -+ << BIT_SHIFT_BT_PREDECT_STATUS_8821C) -+#define BITS_BT_PREDECT_STATUS_8821C \ -+ (BIT_MASK_BT_PREDECT_STATUS_8821C << BIT_SHIFT_BT_PREDECT_STATUS_8821C) -+#define BIT_CLEAR_BT_PREDECT_STATUS_8821C(x) \ -+ ((x) & (~BITS_BT_PREDECT_STATUS_8821C)) -+#define BIT_GET_BT_PREDECT_STATUS_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_PREDECT_STATUS_8821C) & \ -+ BIT_MASK_BT_PREDECT_STATUS_8821C) -+#define BIT_SET_BT_PREDECT_STATUS_8821C(x, v) \ -+ (BIT_CLEAR_BT_PREDECT_STATUS_8821C(x) | BIT_BT_PREDECT_STATUS_8821C(v)) -+ -+#define BIT_SHIFT_BT_CMD_INFO_8821C 0 -+#define BIT_MASK_BT_CMD_INFO_8821C 0xff -+#define BIT_BT_CMD_INFO_8821C(x) \ -+ (((x) & BIT_MASK_BT_CMD_INFO_8821C) << BIT_SHIFT_BT_CMD_INFO_8821C) -+#define BITS_BT_CMD_INFO_8821C \ -+ (BIT_MASK_BT_CMD_INFO_8821C << BIT_SHIFT_BT_CMD_INFO_8821C) -+#define BIT_CLEAR_BT_CMD_INFO_8821C(x) ((x) & (~BITS_BT_CMD_INFO_8821C)) -+#define BIT_GET_BT_CMD_INFO_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_CMD_INFO_8821C) & BIT_MASK_BT_CMD_INFO_8821C) -+#define BIT_SET_BT_CMD_INFO_8821C(x, v) \ -+ (BIT_CLEAR_BT_CMD_INFO_8821C(x) | BIT_BT_CMD_INFO_8821C(v)) -+ -+/* 2 REG_BT_INTERRUPT_CONTROL_REGISTER_8821C */ -+#define BIT_EN_MAC_NULL_PKT_NOTIFY_8821C BIT(31) -+#define BIT_EN_WLAN_RPT_AND_BT_QUERY_8821C BIT(30) -+#define BIT_EN_BT_STSTUS_RPT_8821C BIT(29) -+#define BIT_EN_BT_POWER_8821C BIT(28) -+#define BIT_EN_BT_CHANNEL_8821C BIT(27) -+#define BIT_EN_BT_SLOT_CHANGE_8821C BIT(26) -+#define BIT_EN_BT_PROFILE_OR_HID_8821C BIT(25) -+#define BIT_WLAN_RPT_NOTIFY_8821C BIT(24) -+ -+#define BIT_SHIFT_WLAN_RPT_DATA_8821C 16 -+#define BIT_MASK_WLAN_RPT_DATA_8821C 0xff -+#define BIT_WLAN_RPT_DATA_8821C(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_DATA_8821C) << BIT_SHIFT_WLAN_RPT_DATA_8821C) -+#define BITS_WLAN_RPT_DATA_8821C \ -+ (BIT_MASK_WLAN_RPT_DATA_8821C << BIT_SHIFT_WLAN_RPT_DATA_8821C) -+#define BIT_CLEAR_WLAN_RPT_DATA_8821C(x) ((x) & (~BITS_WLAN_RPT_DATA_8821C)) -+#define BIT_GET_WLAN_RPT_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_DATA_8821C) & BIT_MASK_WLAN_RPT_DATA_8821C) -+#define BIT_SET_WLAN_RPT_DATA_8821C(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_DATA_8821C(x) | BIT_WLAN_RPT_DATA_8821C(v)) -+ -+#define BIT_SHIFT_CMD_ID_8821C 8 -+#define BIT_MASK_CMD_ID_8821C 0xff -+#define BIT_CMD_ID_8821C(x) \ -+ (((x) & BIT_MASK_CMD_ID_8821C) << BIT_SHIFT_CMD_ID_8821C) -+#define BITS_CMD_ID_8821C (BIT_MASK_CMD_ID_8821C << BIT_SHIFT_CMD_ID_8821C) -+#define BIT_CLEAR_CMD_ID_8821C(x) ((x) & (~BITS_CMD_ID_8821C)) -+#define BIT_GET_CMD_ID_8821C(x) \ -+ (((x) >> BIT_SHIFT_CMD_ID_8821C) & BIT_MASK_CMD_ID_8821C) -+#define BIT_SET_CMD_ID_8821C(x, v) \ -+ (BIT_CLEAR_CMD_ID_8821C(x) | BIT_CMD_ID_8821C(v)) -+ -+#define BIT_SHIFT_BT_DATA_8821C 0 -+#define BIT_MASK_BT_DATA_8821C 0xff -+#define BIT_BT_DATA_8821C(x) \ -+ (((x) & BIT_MASK_BT_DATA_8821C) << BIT_SHIFT_BT_DATA_8821C) -+#define BITS_BT_DATA_8821C (BIT_MASK_BT_DATA_8821C << BIT_SHIFT_BT_DATA_8821C) -+#define BIT_CLEAR_BT_DATA_8821C(x) ((x) & (~BITS_BT_DATA_8821C)) -+#define BIT_GET_BT_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_DATA_8821C) & BIT_MASK_BT_DATA_8821C) -+#define BIT_SET_BT_DATA_8821C(x, v) \ -+ (BIT_CLEAR_BT_DATA_8821C(x) | BIT_BT_DATA_8821C(v)) -+ -+/* 2 REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8821C */ -+ -+#define BIT_SHIFT_WLAN_RPT_TO_8821C 0 -+#define BIT_MASK_WLAN_RPT_TO_8821C 0xff -+#define BIT_WLAN_RPT_TO_8821C(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_TO_8821C) << BIT_SHIFT_WLAN_RPT_TO_8821C) -+#define BITS_WLAN_RPT_TO_8821C \ -+ (BIT_MASK_WLAN_RPT_TO_8821C << BIT_SHIFT_WLAN_RPT_TO_8821C) -+#define BIT_CLEAR_WLAN_RPT_TO_8821C(x) ((x) & (~BITS_WLAN_RPT_TO_8821C)) -+#define BIT_GET_WLAN_RPT_TO_8821C(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_TO_8821C) & BIT_MASK_WLAN_RPT_TO_8821C) -+#define BIT_SET_WLAN_RPT_TO_8821C(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_TO_8821C(x) | BIT_WLAN_RPT_TO_8821C(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8821C */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_0_8821C 1 -+#define BIT_MASK_ISOLATION_CHK_0_8821C 0x7fffff -+#define BIT_ISOLATION_CHK_0_8821C(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_0_8821C) \ -+ << BIT_SHIFT_ISOLATION_CHK_0_8821C) -+#define BITS_ISOLATION_CHK_0_8821C \ -+ (BIT_MASK_ISOLATION_CHK_0_8821C << BIT_SHIFT_ISOLATION_CHK_0_8821C) -+#define BIT_CLEAR_ISOLATION_CHK_0_8821C(x) ((x) & (~BITS_ISOLATION_CHK_0_8821C)) -+#define BIT_GET_ISOLATION_CHK_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_0_8821C) & \ -+ BIT_MASK_ISOLATION_CHK_0_8821C) -+#define BIT_SET_ISOLATION_CHK_0_8821C(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_0_8821C(x) | BIT_ISOLATION_CHK_0_8821C(v)) -+ -+#define BIT_ISOLATION_EN_8821C BIT(0) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_1_8821C */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_1_8821C 0 -+#define BIT_MASK_ISOLATION_CHK_1_8821C 0xffffffffL -+#define BIT_ISOLATION_CHK_1_8821C(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_1_8821C) \ -+ << BIT_SHIFT_ISOLATION_CHK_1_8821C) -+#define BITS_ISOLATION_CHK_1_8821C \ -+ (BIT_MASK_ISOLATION_CHK_1_8821C << BIT_SHIFT_ISOLATION_CHK_1_8821C) -+#define BIT_CLEAR_ISOLATION_CHK_1_8821C(x) ((x) & (~BITS_ISOLATION_CHK_1_8821C)) -+#define BIT_GET_ISOLATION_CHK_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_1_8821C) & \ -+ BIT_MASK_ISOLATION_CHK_1_8821C) -+#define BIT_SET_ISOLATION_CHK_1_8821C(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_1_8821C(x) | BIT_ISOLATION_CHK_1_8821C(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_2_8821C */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_2_8821C 0 -+#define BIT_MASK_ISOLATION_CHK_2_8821C 0xffffff -+#define BIT_ISOLATION_CHK_2_8821C(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_2_8821C) \ -+ << BIT_SHIFT_ISOLATION_CHK_2_8821C) -+#define BITS_ISOLATION_CHK_2_8821C \ -+ (BIT_MASK_ISOLATION_CHK_2_8821C << BIT_SHIFT_ISOLATION_CHK_2_8821C) -+#define BIT_CLEAR_ISOLATION_CHK_2_8821C(x) ((x) & (~BITS_ISOLATION_CHK_2_8821C)) -+#define BIT_GET_ISOLATION_CHK_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_2_8821C) & \ -+ BIT_MASK_ISOLATION_CHK_2_8821C) -+#define BIT_SET_ISOLATION_CHK_2_8821C(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_2_8821C(x) | BIT_ISOLATION_CHK_2_8821C(v)) -+ -+/* 2 REG_BT_INTERRUPT_STATUS_REGISTER_8821C */ -+#define BIT_BT_HID_ISR_8821C BIT(7) -+#define BIT_BT_QUERY_ISR_8821C BIT(6) -+#define BIT_MAC_NULL_PKT_NOTIFY_ISR_8821C BIT(5) -+#define BIT_WLAN_RPT_ISR_8821C BIT(4) -+#define BIT_BT_POWER_ISR_8821C BIT(3) -+#define BIT_BT_CHANNEL_ISR_8821C BIT(2) -+#define BIT_BT_SLOT_CHANGE_ISR_8821C BIT(1) -+#define BIT_BT_PROFILE_ISR_8821C BIT(0) -+ -+/* 2 REG_BT_TDMA_TIME_REGISTER_8821C */ -+ -+#define BIT_SHIFT_BT_TIME_8821C 6 -+#define BIT_MASK_BT_TIME_8821C 0x3ffffff -+#define BIT_BT_TIME_8821C(x) \ -+ (((x) & BIT_MASK_BT_TIME_8821C) << BIT_SHIFT_BT_TIME_8821C) -+#define BITS_BT_TIME_8821C (BIT_MASK_BT_TIME_8821C << BIT_SHIFT_BT_TIME_8821C) -+#define BIT_CLEAR_BT_TIME_8821C(x) ((x) & (~BITS_BT_TIME_8821C)) -+#define BIT_GET_BT_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_TIME_8821C) & BIT_MASK_BT_TIME_8821C) -+#define BIT_SET_BT_TIME_8821C(x, v) \ -+ (BIT_CLEAR_BT_TIME_8821C(x) | BIT_BT_TIME_8821C(v)) -+ -+#define BIT_SHIFT_BT_RPT_SAMPLE_RATE_8821C 0 -+#define BIT_MASK_BT_RPT_SAMPLE_RATE_8821C 0x3f -+#define BIT_BT_RPT_SAMPLE_RATE_8821C(x) \ -+ (((x) & BIT_MASK_BT_RPT_SAMPLE_RATE_8821C) \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8821C) -+#define BITS_BT_RPT_SAMPLE_RATE_8821C \ -+ (BIT_MASK_BT_RPT_SAMPLE_RATE_8821C \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8821C) -+#define BIT_CLEAR_BT_RPT_SAMPLE_RATE_8821C(x) \ -+ ((x) & (~BITS_BT_RPT_SAMPLE_RATE_8821C)) -+#define BIT_GET_BT_RPT_SAMPLE_RATE_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_RPT_SAMPLE_RATE_8821C) & \ -+ BIT_MASK_BT_RPT_SAMPLE_RATE_8821C) -+#define BIT_SET_BT_RPT_SAMPLE_RATE_8821C(x, v) \ -+ (BIT_CLEAR_BT_RPT_SAMPLE_RATE_8821C(x) | \ -+ BIT_BT_RPT_SAMPLE_RATE_8821C(v)) -+ -+/* 2 REG_BT_ACT_REGISTER_8821C */ -+ -+#define BIT_SHIFT_BT_EISR_EN_8821C 16 -+#define BIT_MASK_BT_EISR_EN_8821C 0xff -+#define BIT_BT_EISR_EN_8821C(x) \ -+ (((x) & BIT_MASK_BT_EISR_EN_8821C) << BIT_SHIFT_BT_EISR_EN_8821C) -+#define BITS_BT_EISR_EN_8821C \ -+ (BIT_MASK_BT_EISR_EN_8821C << BIT_SHIFT_BT_EISR_EN_8821C) -+#define BIT_CLEAR_BT_EISR_EN_8821C(x) ((x) & (~BITS_BT_EISR_EN_8821C)) -+#define BIT_GET_BT_EISR_EN_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_EISR_EN_8821C) & BIT_MASK_BT_EISR_EN_8821C) -+#define BIT_SET_BT_EISR_EN_8821C(x, v) \ -+ (BIT_CLEAR_BT_EISR_EN_8821C(x) | BIT_BT_EISR_EN_8821C(v)) -+ -+#define BIT_BT_ACT_FALLING_ISR_8821C BIT(10) -+#define BIT_BT_ACT_RISING_ISR_8821C BIT(9) -+#define BIT_TDMA_TO_ISR_8821C BIT(8) -+ -+#define BIT_SHIFT_BT_CH_8821C 0 -+#define BIT_MASK_BT_CH_8821C 0xff -+#define BIT_BT_CH_8821C(x) \ -+ (((x) & BIT_MASK_BT_CH_8821C) << BIT_SHIFT_BT_CH_8821C) -+#define BITS_BT_CH_8821C (BIT_MASK_BT_CH_8821C << BIT_SHIFT_BT_CH_8821C) -+#define BIT_CLEAR_BT_CH_8821C(x) ((x) & (~BITS_BT_CH_8821C)) -+#define BIT_GET_BT_CH_8821C(x) \ -+ (((x) >> BIT_SHIFT_BT_CH_8821C) & BIT_MASK_BT_CH_8821C) -+#define BIT_SET_BT_CH_8821C(x, v) \ -+ (BIT_CLEAR_BT_CH_8821C(x) | BIT_BT_CH_8821C(v)) -+ -+/* 2 REG_OBFF_CTRL_BASIC_8821C */ -+#define BIT_OBFF_EN_V1_8821C BIT(31) -+ -+#define BIT_SHIFT_OBFF_STATE_V1_8821C 28 -+#define BIT_MASK_OBFF_STATE_V1_8821C 0x3 -+#define BIT_OBFF_STATE_V1_8821C(x) \ -+ (((x) & BIT_MASK_OBFF_STATE_V1_8821C) << BIT_SHIFT_OBFF_STATE_V1_8821C) -+#define BITS_OBFF_STATE_V1_8821C \ -+ (BIT_MASK_OBFF_STATE_V1_8821C << BIT_SHIFT_OBFF_STATE_V1_8821C) -+#define BIT_CLEAR_OBFF_STATE_V1_8821C(x) ((x) & (~BITS_OBFF_STATE_V1_8821C)) -+#define BIT_GET_OBFF_STATE_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_OBFF_STATE_V1_8821C) & BIT_MASK_OBFF_STATE_V1_8821C) -+#define BIT_SET_OBFF_STATE_V1_8821C(x, v) \ -+ (BIT_CLEAR_OBFF_STATE_V1_8821C(x) | BIT_OBFF_STATE_V1_8821C(v)) -+ -+#define BIT_OBFF_ACT_RXDMA_EN_8821C BIT(27) -+#define BIT_OBFF_BLOCK_INT_EN_8821C BIT(26) -+#define BIT_OBFF_AUTOACT_EN_8821C BIT(25) -+#define BIT_OBFF_AUTOIDLE_EN_8821C BIT(24) -+ -+#define BIT_SHIFT_WAKE_MAX_PLS_8821C 20 -+#define BIT_MASK_WAKE_MAX_PLS_8821C 0x7 -+#define BIT_WAKE_MAX_PLS_8821C(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_PLS_8821C) << BIT_SHIFT_WAKE_MAX_PLS_8821C) -+#define BITS_WAKE_MAX_PLS_8821C \ -+ (BIT_MASK_WAKE_MAX_PLS_8821C << BIT_SHIFT_WAKE_MAX_PLS_8821C) -+#define BIT_CLEAR_WAKE_MAX_PLS_8821C(x) ((x) & (~BITS_WAKE_MAX_PLS_8821C)) -+#define BIT_GET_WAKE_MAX_PLS_8821C(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_PLS_8821C) & BIT_MASK_WAKE_MAX_PLS_8821C) -+#define BIT_SET_WAKE_MAX_PLS_8821C(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_PLS_8821C(x) | BIT_WAKE_MAX_PLS_8821C(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_PLS_8821C 16 -+#define BIT_MASK_WAKE_MIN_PLS_8821C 0x7 -+#define BIT_WAKE_MIN_PLS_8821C(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_PLS_8821C) << BIT_SHIFT_WAKE_MIN_PLS_8821C) -+#define BITS_WAKE_MIN_PLS_8821C \ -+ (BIT_MASK_WAKE_MIN_PLS_8821C << BIT_SHIFT_WAKE_MIN_PLS_8821C) -+#define BIT_CLEAR_WAKE_MIN_PLS_8821C(x) ((x) & (~BITS_WAKE_MIN_PLS_8821C)) -+#define BIT_GET_WAKE_MIN_PLS_8821C(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_PLS_8821C) & BIT_MASK_WAKE_MIN_PLS_8821C) -+#define BIT_SET_WAKE_MIN_PLS_8821C(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_PLS_8821C(x) | BIT_WAKE_MIN_PLS_8821C(v)) -+ -+#define BIT_SHIFT_WAKE_MAX_F2F_8821C 12 -+#define BIT_MASK_WAKE_MAX_F2F_8821C 0x7 -+#define BIT_WAKE_MAX_F2F_8821C(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_F2F_8821C) << BIT_SHIFT_WAKE_MAX_F2F_8821C) -+#define BITS_WAKE_MAX_F2F_8821C \ -+ (BIT_MASK_WAKE_MAX_F2F_8821C << BIT_SHIFT_WAKE_MAX_F2F_8821C) -+#define BIT_CLEAR_WAKE_MAX_F2F_8821C(x) ((x) & (~BITS_WAKE_MAX_F2F_8821C)) -+#define BIT_GET_WAKE_MAX_F2F_8821C(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_F2F_8821C) & BIT_MASK_WAKE_MAX_F2F_8821C) -+#define BIT_SET_WAKE_MAX_F2F_8821C(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_F2F_8821C(x) | BIT_WAKE_MAX_F2F_8821C(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_F2F_8821C 8 -+#define BIT_MASK_WAKE_MIN_F2F_8821C 0x7 -+#define BIT_WAKE_MIN_F2F_8821C(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_F2F_8821C) << BIT_SHIFT_WAKE_MIN_F2F_8821C) -+#define BITS_WAKE_MIN_F2F_8821C \ -+ (BIT_MASK_WAKE_MIN_F2F_8821C << BIT_SHIFT_WAKE_MIN_F2F_8821C) -+#define BIT_CLEAR_WAKE_MIN_F2F_8821C(x) ((x) & (~BITS_WAKE_MIN_F2F_8821C)) -+#define BIT_GET_WAKE_MIN_F2F_8821C(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_F2F_8821C) & BIT_MASK_WAKE_MIN_F2F_8821C) -+#define BIT_SET_WAKE_MIN_F2F_8821C(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_F2F_8821C(x) | BIT_WAKE_MIN_F2F_8821C(v)) -+ -+#define BIT_APP_CPU_ACT_V1_8821C BIT(3) -+#define BIT_APP_OBFF_V1_8821C BIT(2) -+#define BIT_APP_IDLE_V1_8821C BIT(1) -+#define BIT_APP_INIT_V1_8821C BIT(0) -+ -+/* 2 REG_OBFF_CTRL2_TIMER_8821C */ -+ -+#define BIT_SHIFT_RX_HIGH_TIMER_IDX_8821C 24 -+#define BIT_MASK_RX_HIGH_TIMER_IDX_8821C 0x7 -+#define BIT_RX_HIGH_TIMER_IDX_8821C(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TIMER_IDX_8821C) \ -+ << BIT_SHIFT_RX_HIGH_TIMER_IDX_8821C) -+#define BITS_RX_HIGH_TIMER_IDX_8821C \ -+ (BIT_MASK_RX_HIGH_TIMER_IDX_8821C << BIT_SHIFT_RX_HIGH_TIMER_IDX_8821C) -+#define BIT_CLEAR_RX_HIGH_TIMER_IDX_8821C(x) \ -+ ((x) & (~BITS_RX_HIGH_TIMER_IDX_8821C)) -+#define BIT_GET_RX_HIGH_TIMER_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TIMER_IDX_8821C) & \ -+ BIT_MASK_RX_HIGH_TIMER_IDX_8821C) -+#define BIT_SET_RX_HIGH_TIMER_IDX_8821C(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TIMER_IDX_8821C(x) | BIT_RX_HIGH_TIMER_IDX_8821C(v)) -+ -+#define BIT_SHIFT_RX_MED_TIMER_IDX_8821C 16 -+#define BIT_MASK_RX_MED_TIMER_IDX_8821C 0x7 -+#define BIT_RX_MED_TIMER_IDX_8821C(x) \ -+ (((x) & BIT_MASK_RX_MED_TIMER_IDX_8821C) \ -+ << BIT_SHIFT_RX_MED_TIMER_IDX_8821C) -+#define BITS_RX_MED_TIMER_IDX_8821C \ -+ (BIT_MASK_RX_MED_TIMER_IDX_8821C << BIT_SHIFT_RX_MED_TIMER_IDX_8821C) -+#define BIT_CLEAR_RX_MED_TIMER_IDX_8821C(x) \ -+ ((x) & (~BITS_RX_MED_TIMER_IDX_8821C)) -+#define BIT_GET_RX_MED_TIMER_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TIMER_IDX_8821C) & \ -+ BIT_MASK_RX_MED_TIMER_IDX_8821C) -+#define BIT_SET_RX_MED_TIMER_IDX_8821C(x, v) \ -+ (BIT_CLEAR_RX_MED_TIMER_IDX_8821C(x) | BIT_RX_MED_TIMER_IDX_8821C(v)) -+ -+#define BIT_SHIFT_RX_LOW_TIMER_IDX_8821C 8 -+#define BIT_MASK_RX_LOW_TIMER_IDX_8821C 0x7 -+#define BIT_RX_LOW_TIMER_IDX_8821C(x) \ -+ (((x) & BIT_MASK_RX_LOW_TIMER_IDX_8821C) \ -+ << BIT_SHIFT_RX_LOW_TIMER_IDX_8821C) -+#define BITS_RX_LOW_TIMER_IDX_8821C \ -+ (BIT_MASK_RX_LOW_TIMER_IDX_8821C << BIT_SHIFT_RX_LOW_TIMER_IDX_8821C) -+#define BIT_CLEAR_RX_LOW_TIMER_IDX_8821C(x) \ -+ ((x) & (~BITS_RX_LOW_TIMER_IDX_8821C)) -+#define BIT_GET_RX_LOW_TIMER_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TIMER_IDX_8821C) & \ -+ BIT_MASK_RX_LOW_TIMER_IDX_8821C) -+#define BIT_SET_RX_LOW_TIMER_IDX_8821C(x, v) \ -+ (BIT_CLEAR_RX_LOW_TIMER_IDX_8821C(x) | BIT_RX_LOW_TIMER_IDX_8821C(v)) -+ -+#define BIT_SHIFT_OBFF_INT_TIMER_IDX_8821C 0 -+#define BIT_MASK_OBFF_INT_TIMER_IDX_8821C 0x7 -+#define BIT_OBFF_INT_TIMER_IDX_8821C(x) \ -+ (((x) & BIT_MASK_OBFF_INT_TIMER_IDX_8821C) \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8821C) -+#define BITS_OBFF_INT_TIMER_IDX_8821C \ -+ (BIT_MASK_OBFF_INT_TIMER_IDX_8821C \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8821C) -+#define BIT_CLEAR_OBFF_INT_TIMER_IDX_8821C(x) \ -+ ((x) & (~BITS_OBFF_INT_TIMER_IDX_8821C)) -+#define BIT_GET_OBFF_INT_TIMER_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_OBFF_INT_TIMER_IDX_8821C) & \ -+ BIT_MASK_OBFF_INT_TIMER_IDX_8821C) -+#define BIT_SET_OBFF_INT_TIMER_IDX_8821C(x, v) \ -+ (BIT_CLEAR_OBFF_INT_TIMER_IDX_8821C(x) | \ -+ BIT_OBFF_INT_TIMER_IDX_8821C(v)) -+ -+/* 2 REG_LTR_CTRL_BASIC_8821C */ -+#define BIT_LTR_EN_V1_8821C BIT(31) -+#define BIT_LTR_HW_EN_V1_8821C BIT(30) -+#define BIT_LRT_ACT_CTS_EN_8821C BIT(29) -+#define BIT_LTR_ACT_RXPKT_EN_8821C BIT(28) -+#define BIT_LTR_ACT_RXDMA_EN_8821C BIT(27) -+#define BIT_LTR_IDLE_NO_SNOOP_8821C BIT(26) -+#define BIT_SPDUP_MGTPKT_8821C BIT(25) -+#define BIT_RX_AGG_EN_8821C BIT(24) -+#define BIT_APP_LTR_ACT_8821C BIT(23) -+#define BIT_APP_LTR_IDLE_8821C BIT(22) -+ -+#define BIT_SHIFT_HIGH_RATE_TRIG_SEL_8821C 20 -+#define BIT_MASK_HIGH_RATE_TRIG_SEL_8821C 0x3 -+#define BIT_HIGH_RATE_TRIG_SEL_8821C(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_TRIG_SEL_8821C) \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8821C) -+#define BITS_HIGH_RATE_TRIG_SEL_8821C \ -+ (BIT_MASK_HIGH_RATE_TRIG_SEL_8821C \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8821C) -+#define BIT_CLEAR_HIGH_RATE_TRIG_SEL_8821C(x) \ -+ ((x) & (~BITS_HIGH_RATE_TRIG_SEL_8821C)) -+#define BIT_GET_HIGH_RATE_TRIG_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_TRIG_SEL_8821C) & \ -+ BIT_MASK_HIGH_RATE_TRIG_SEL_8821C) -+#define BIT_SET_HIGH_RATE_TRIG_SEL_8821C(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_TRIG_SEL_8821C(x) | \ -+ BIT_HIGH_RATE_TRIG_SEL_8821C(v)) -+ -+#define BIT_SHIFT_MED_RATE_TRIG_SEL_8821C 18 -+#define BIT_MASK_MED_RATE_TRIG_SEL_8821C 0x3 -+#define BIT_MED_RATE_TRIG_SEL_8821C(x) \ -+ (((x) & BIT_MASK_MED_RATE_TRIG_SEL_8821C) \ -+ << BIT_SHIFT_MED_RATE_TRIG_SEL_8821C) -+#define BITS_MED_RATE_TRIG_SEL_8821C \ -+ (BIT_MASK_MED_RATE_TRIG_SEL_8821C << BIT_SHIFT_MED_RATE_TRIG_SEL_8821C) -+#define BIT_CLEAR_MED_RATE_TRIG_SEL_8821C(x) \ -+ ((x) & (~BITS_MED_RATE_TRIG_SEL_8821C)) -+#define BIT_GET_MED_RATE_TRIG_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_MED_RATE_TRIG_SEL_8821C) & \ -+ BIT_MASK_MED_RATE_TRIG_SEL_8821C) -+#define BIT_SET_MED_RATE_TRIG_SEL_8821C(x, v) \ -+ (BIT_CLEAR_MED_RATE_TRIG_SEL_8821C(x) | BIT_MED_RATE_TRIG_SEL_8821C(v)) -+ -+#define BIT_SHIFT_LOW_RATE_TRIG_SEL_8821C 16 -+#define BIT_MASK_LOW_RATE_TRIG_SEL_8821C 0x3 -+#define BIT_LOW_RATE_TRIG_SEL_8821C(x) \ -+ (((x) & BIT_MASK_LOW_RATE_TRIG_SEL_8821C) \ -+ << BIT_SHIFT_LOW_RATE_TRIG_SEL_8821C) -+#define BITS_LOW_RATE_TRIG_SEL_8821C \ -+ (BIT_MASK_LOW_RATE_TRIG_SEL_8821C << BIT_SHIFT_LOW_RATE_TRIG_SEL_8821C) -+#define BIT_CLEAR_LOW_RATE_TRIG_SEL_8821C(x) \ -+ ((x) & (~BITS_LOW_RATE_TRIG_SEL_8821C)) -+#define BIT_GET_LOW_RATE_TRIG_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_TRIG_SEL_8821C) & \ -+ BIT_MASK_LOW_RATE_TRIG_SEL_8821C) -+#define BIT_SET_LOW_RATE_TRIG_SEL_8821C(x, v) \ -+ (BIT_CLEAR_LOW_RATE_TRIG_SEL_8821C(x) | BIT_LOW_RATE_TRIG_SEL_8821C(v)) -+ -+#define BIT_SHIFT_HIGH_RATE_BD_IDX_8821C 8 -+#define BIT_MASK_HIGH_RATE_BD_IDX_8821C 0x7f -+#define BIT_HIGH_RATE_BD_IDX_8821C(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_BD_IDX_8821C) \ -+ << BIT_SHIFT_HIGH_RATE_BD_IDX_8821C) -+#define BITS_HIGH_RATE_BD_IDX_8821C \ -+ (BIT_MASK_HIGH_RATE_BD_IDX_8821C << BIT_SHIFT_HIGH_RATE_BD_IDX_8821C) -+#define BIT_CLEAR_HIGH_RATE_BD_IDX_8821C(x) \ -+ ((x) & (~BITS_HIGH_RATE_BD_IDX_8821C)) -+#define BIT_GET_HIGH_RATE_BD_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_BD_IDX_8821C) & \ -+ BIT_MASK_HIGH_RATE_BD_IDX_8821C) -+#define BIT_SET_HIGH_RATE_BD_IDX_8821C(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_BD_IDX_8821C(x) | BIT_HIGH_RATE_BD_IDX_8821C(v)) -+ -+#define BIT_SHIFT_LOW_RATE_BD_IDX_8821C 0 -+#define BIT_MASK_LOW_RATE_BD_IDX_8821C 0x7f -+#define BIT_LOW_RATE_BD_IDX_8821C(x) \ -+ (((x) & BIT_MASK_LOW_RATE_BD_IDX_8821C) \ -+ << BIT_SHIFT_LOW_RATE_BD_IDX_8821C) -+#define BITS_LOW_RATE_BD_IDX_8821C \ -+ (BIT_MASK_LOW_RATE_BD_IDX_8821C << BIT_SHIFT_LOW_RATE_BD_IDX_8821C) -+#define BIT_CLEAR_LOW_RATE_BD_IDX_8821C(x) ((x) & (~BITS_LOW_RATE_BD_IDX_8821C)) -+#define BIT_GET_LOW_RATE_BD_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_BD_IDX_8821C) & \ -+ BIT_MASK_LOW_RATE_BD_IDX_8821C) -+#define BIT_SET_LOW_RATE_BD_IDX_8821C(x, v) \ -+ (BIT_CLEAR_LOW_RATE_BD_IDX_8821C(x) | BIT_LOW_RATE_BD_IDX_8821C(v)) -+ -+/* 2 REG_LTR_CTRL2_TIMER_THRESHOLD_8821C */ -+ -+#define BIT_SHIFT_RX_EMPTY_TIMER_IDX_8821C 24 -+#define BIT_MASK_RX_EMPTY_TIMER_IDX_8821C 0x7 -+#define BIT_RX_EMPTY_TIMER_IDX_8821C(x) \ -+ (((x) & BIT_MASK_RX_EMPTY_TIMER_IDX_8821C) \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8821C) -+#define BITS_RX_EMPTY_TIMER_IDX_8821C \ -+ (BIT_MASK_RX_EMPTY_TIMER_IDX_8821C \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8821C) -+#define BIT_CLEAR_RX_EMPTY_TIMER_IDX_8821C(x) \ -+ ((x) & (~BITS_RX_EMPTY_TIMER_IDX_8821C)) -+#define BIT_GET_RX_EMPTY_TIMER_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_EMPTY_TIMER_IDX_8821C) & \ -+ BIT_MASK_RX_EMPTY_TIMER_IDX_8821C) -+#define BIT_SET_RX_EMPTY_TIMER_IDX_8821C(x, v) \ -+ (BIT_CLEAR_RX_EMPTY_TIMER_IDX_8821C(x) | \ -+ BIT_RX_EMPTY_TIMER_IDX_8821C(v)) -+ -+#define BIT_SHIFT_RX_AFULL_TH_IDX_8821C 20 -+#define BIT_MASK_RX_AFULL_TH_IDX_8821C 0x7 -+#define BIT_RX_AFULL_TH_IDX_8821C(x) \ -+ (((x) & BIT_MASK_RX_AFULL_TH_IDX_8821C) \ -+ << BIT_SHIFT_RX_AFULL_TH_IDX_8821C) -+#define BITS_RX_AFULL_TH_IDX_8821C \ -+ (BIT_MASK_RX_AFULL_TH_IDX_8821C << BIT_SHIFT_RX_AFULL_TH_IDX_8821C) -+#define BIT_CLEAR_RX_AFULL_TH_IDX_8821C(x) ((x) & (~BITS_RX_AFULL_TH_IDX_8821C)) -+#define BIT_GET_RX_AFULL_TH_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_AFULL_TH_IDX_8821C) & \ -+ BIT_MASK_RX_AFULL_TH_IDX_8821C) -+#define BIT_SET_RX_AFULL_TH_IDX_8821C(x, v) \ -+ (BIT_CLEAR_RX_AFULL_TH_IDX_8821C(x) | BIT_RX_AFULL_TH_IDX_8821C(v)) -+ -+#define BIT_SHIFT_RX_HIGH_TH_IDX_8821C 16 -+#define BIT_MASK_RX_HIGH_TH_IDX_8821C 0x7 -+#define BIT_RX_HIGH_TH_IDX_8821C(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TH_IDX_8821C) \ -+ << BIT_SHIFT_RX_HIGH_TH_IDX_8821C) -+#define BITS_RX_HIGH_TH_IDX_8821C \ -+ (BIT_MASK_RX_HIGH_TH_IDX_8821C << BIT_SHIFT_RX_HIGH_TH_IDX_8821C) -+#define BIT_CLEAR_RX_HIGH_TH_IDX_8821C(x) ((x) & (~BITS_RX_HIGH_TH_IDX_8821C)) -+#define BIT_GET_RX_HIGH_TH_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TH_IDX_8821C) & \ -+ BIT_MASK_RX_HIGH_TH_IDX_8821C) -+#define BIT_SET_RX_HIGH_TH_IDX_8821C(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TH_IDX_8821C(x) | BIT_RX_HIGH_TH_IDX_8821C(v)) -+ -+#define BIT_SHIFT_RX_MED_TH_IDX_8821C 12 -+#define BIT_MASK_RX_MED_TH_IDX_8821C 0x7 -+#define BIT_RX_MED_TH_IDX_8821C(x) \ -+ (((x) & BIT_MASK_RX_MED_TH_IDX_8821C) << BIT_SHIFT_RX_MED_TH_IDX_8821C) -+#define BITS_RX_MED_TH_IDX_8821C \ -+ (BIT_MASK_RX_MED_TH_IDX_8821C << BIT_SHIFT_RX_MED_TH_IDX_8821C) -+#define BIT_CLEAR_RX_MED_TH_IDX_8821C(x) ((x) & (~BITS_RX_MED_TH_IDX_8821C)) -+#define BIT_GET_RX_MED_TH_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TH_IDX_8821C) & BIT_MASK_RX_MED_TH_IDX_8821C) -+#define BIT_SET_RX_MED_TH_IDX_8821C(x, v) \ -+ (BIT_CLEAR_RX_MED_TH_IDX_8821C(x) | BIT_RX_MED_TH_IDX_8821C(v)) -+ -+#define BIT_SHIFT_RX_LOW_TH_IDX_8821C 8 -+#define BIT_MASK_RX_LOW_TH_IDX_8821C 0x7 -+#define BIT_RX_LOW_TH_IDX_8821C(x) \ -+ (((x) & BIT_MASK_RX_LOW_TH_IDX_8821C) << BIT_SHIFT_RX_LOW_TH_IDX_8821C) -+#define BITS_RX_LOW_TH_IDX_8821C \ -+ (BIT_MASK_RX_LOW_TH_IDX_8821C << BIT_SHIFT_RX_LOW_TH_IDX_8821C) -+#define BIT_CLEAR_RX_LOW_TH_IDX_8821C(x) ((x) & (~BITS_RX_LOW_TH_IDX_8821C)) -+#define BIT_GET_RX_LOW_TH_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TH_IDX_8821C) & BIT_MASK_RX_LOW_TH_IDX_8821C) -+#define BIT_SET_RX_LOW_TH_IDX_8821C(x, v) \ -+ (BIT_CLEAR_RX_LOW_TH_IDX_8821C(x) | BIT_RX_LOW_TH_IDX_8821C(v)) -+ -+#define BIT_SHIFT_LTR_SPACE_IDX_8821C 4 -+#define BIT_MASK_LTR_SPACE_IDX_8821C 0x3 -+#define BIT_LTR_SPACE_IDX_8821C(x) \ -+ (((x) & BIT_MASK_LTR_SPACE_IDX_8821C) << BIT_SHIFT_LTR_SPACE_IDX_8821C) -+#define BITS_LTR_SPACE_IDX_8821C \ -+ (BIT_MASK_LTR_SPACE_IDX_8821C << BIT_SHIFT_LTR_SPACE_IDX_8821C) -+#define BIT_CLEAR_LTR_SPACE_IDX_8821C(x) ((x) & (~BITS_LTR_SPACE_IDX_8821C)) -+#define BIT_GET_LTR_SPACE_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_LTR_SPACE_IDX_8821C) & BIT_MASK_LTR_SPACE_IDX_8821C) -+#define BIT_SET_LTR_SPACE_IDX_8821C(x, v) \ -+ (BIT_CLEAR_LTR_SPACE_IDX_8821C(x) | BIT_LTR_SPACE_IDX_8821C(v)) -+ -+#define BIT_SHIFT_LTR_IDLE_TIMER_IDX_8821C 0 -+#define BIT_MASK_LTR_IDLE_TIMER_IDX_8821C 0x7 -+#define BIT_LTR_IDLE_TIMER_IDX_8821C(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_TIMER_IDX_8821C) \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8821C) -+#define BITS_LTR_IDLE_TIMER_IDX_8821C \ -+ (BIT_MASK_LTR_IDLE_TIMER_IDX_8821C \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8821C) -+#define BIT_CLEAR_LTR_IDLE_TIMER_IDX_8821C(x) \ -+ ((x) & (~BITS_LTR_IDLE_TIMER_IDX_8821C)) -+#define BIT_GET_LTR_IDLE_TIMER_IDX_8821C(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_TIMER_IDX_8821C) & \ -+ BIT_MASK_LTR_IDLE_TIMER_IDX_8821C) -+#define BIT_SET_LTR_IDLE_TIMER_IDX_8821C(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_TIMER_IDX_8821C(x) | \ -+ BIT_LTR_IDLE_TIMER_IDX_8821C(v)) -+ -+/* 2 REG_LTR_IDLE_LATENCY_V1_8821C */ -+ -+#define BIT_SHIFT_LTR_IDLE_L_8821C 0 -+#define BIT_MASK_LTR_IDLE_L_8821C 0xffffffffL -+#define BIT_LTR_IDLE_L_8821C(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_L_8821C) << BIT_SHIFT_LTR_IDLE_L_8821C) -+#define BITS_LTR_IDLE_L_8821C \ -+ (BIT_MASK_LTR_IDLE_L_8821C << BIT_SHIFT_LTR_IDLE_L_8821C) -+#define BIT_CLEAR_LTR_IDLE_L_8821C(x) ((x) & (~BITS_LTR_IDLE_L_8821C)) -+#define BIT_GET_LTR_IDLE_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_L_8821C) & BIT_MASK_LTR_IDLE_L_8821C) -+#define BIT_SET_LTR_IDLE_L_8821C(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_L_8821C(x) | BIT_LTR_IDLE_L_8821C(v)) -+ -+/* 2 REG_LTR_ACTIVE_LATENCY_V1_8821C */ -+ -+#define BIT_SHIFT_LTR_ACT_L_8821C 0 -+#define BIT_MASK_LTR_ACT_L_8821C 0xffffffffL -+#define BIT_LTR_ACT_L_8821C(x) \ -+ (((x) & BIT_MASK_LTR_ACT_L_8821C) << BIT_SHIFT_LTR_ACT_L_8821C) -+#define BITS_LTR_ACT_L_8821C \ -+ (BIT_MASK_LTR_ACT_L_8821C << BIT_SHIFT_LTR_ACT_L_8821C) -+#define BIT_CLEAR_LTR_ACT_L_8821C(x) ((x) & (~BITS_LTR_ACT_L_8821C)) -+#define BIT_GET_LTR_ACT_L_8821C(x) \ -+ (((x) >> BIT_SHIFT_LTR_ACT_L_8821C) & BIT_MASK_LTR_ACT_L_8821C) -+#define BIT_SET_LTR_ACT_L_8821C(x, v) \ -+ (BIT_CLEAR_LTR_ACT_L_8821C(x) | BIT_LTR_ACT_L_8821C(v)) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER_8821C */ -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR_0_8821C 0 -+#define BIT_MASK_TRAIN_STA_ADDR_0_8821C 0xffffffffL -+#define BIT_TRAIN_STA_ADDR_0_8821C(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR_0_8821C) \ -+ << BIT_SHIFT_TRAIN_STA_ADDR_0_8821C) -+#define BITS_TRAIN_STA_ADDR_0_8821C \ -+ (BIT_MASK_TRAIN_STA_ADDR_0_8821C << BIT_SHIFT_TRAIN_STA_ADDR_0_8821C) -+#define BIT_CLEAR_TRAIN_STA_ADDR_0_8821C(x) \ -+ ((x) & (~BITS_TRAIN_STA_ADDR_0_8821C)) -+#define BIT_GET_TRAIN_STA_ADDR_0_8821C(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR_0_8821C) & \ -+ BIT_MASK_TRAIN_STA_ADDR_0_8821C) -+#define BIT_SET_TRAIN_STA_ADDR_0_8821C(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR_0_8821C(x) | BIT_TRAIN_STA_ADDR_0_8821C(v)) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER_1_8821C */ -+#define BIT_APPEND_MACID_IN_RESP_EN_1_8821C BIT(18) -+#define BIT_ADDR2_MATCH_EN_1_8821C BIT(17) -+#define BIT_ANTTRN_EN_1_8821C BIT(16) -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR_1_8821C 0 -+#define BIT_MASK_TRAIN_STA_ADDR_1_8821C 0xffff -+#define BIT_TRAIN_STA_ADDR_1_8821C(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR_1_8821C) \ -+ << BIT_SHIFT_TRAIN_STA_ADDR_1_8821C) -+#define BITS_TRAIN_STA_ADDR_1_8821C \ -+ (BIT_MASK_TRAIN_STA_ADDR_1_8821C << BIT_SHIFT_TRAIN_STA_ADDR_1_8821C) -+#define BIT_CLEAR_TRAIN_STA_ADDR_1_8821C(x) \ -+ ((x) & (~BITS_TRAIN_STA_ADDR_1_8821C)) -+#define BIT_GET_TRAIN_STA_ADDR_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR_1_8821C) & \ -+ BIT_MASK_TRAIN_STA_ADDR_1_8821C) -+#define BIT_SET_TRAIN_STA_ADDR_1_8821C(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR_1_8821C(x) | BIT_TRAIN_STA_ADDR_1_8821C(v)) -+ -+/* 2 REG_WMAC_PKTCNT_RWD_8821C */ -+ -+#define BIT_SHIFT_PKTCNT_BSSIDMAP_8821C 4 -+#define BIT_MASK_PKTCNT_BSSIDMAP_8821C 0xf -+#define BIT_PKTCNT_BSSIDMAP_8821C(x) \ -+ (((x) & BIT_MASK_PKTCNT_BSSIDMAP_8821C) \ -+ << BIT_SHIFT_PKTCNT_BSSIDMAP_8821C) -+#define BITS_PKTCNT_BSSIDMAP_8821C \ -+ (BIT_MASK_PKTCNT_BSSIDMAP_8821C << BIT_SHIFT_PKTCNT_BSSIDMAP_8821C) -+#define BIT_CLEAR_PKTCNT_BSSIDMAP_8821C(x) ((x) & (~BITS_PKTCNT_BSSIDMAP_8821C)) -+#define BIT_GET_PKTCNT_BSSIDMAP_8821C(x) \ -+ (((x) >> BIT_SHIFT_PKTCNT_BSSIDMAP_8821C) & \ -+ BIT_MASK_PKTCNT_BSSIDMAP_8821C) -+#define BIT_SET_PKTCNT_BSSIDMAP_8821C(x, v) \ -+ (BIT_CLEAR_PKTCNT_BSSIDMAP_8821C(x) | BIT_PKTCNT_BSSIDMAP_8821C(v)) -+ -+#define BIT_PKTCNT_CNTRST_8821C BIT(1) -+#define BIT_PKTCNT_CNTEN_8821C BIT(0) -+ -+/* 2 REG_WMAC_PKTCNT_CTRL_8821C */ -+#define BIT_WMAC_PKTCNT_TRST_8821C BIT(9) -+#define BIT_WMAC_PKTCNT_FEN_8821C BIT(8) -+ -+#define BIT_SHIFT_WMAC_PKTCNT_CFGAD_8821C 0 -+#define BIT_MASK_WMAC_PKTCNT_CFGAD_8821C 0xff -+#define BIT_WMAC_PKTCNT_CFGAD_8821C(x) \ -+ (((x) & BIT_MASK_WMAC_PKTCNT_CFGAD_8821C) \ -+ << BIT_SHIFT_WMAC_PKTCNT_CFGAD_8821C) -+#define BITS_WMAC_PKTCNT_CFGAD_8821C \ -+ (BIT_MASK_WMAC_PKTCNT_CFGAD_8821C << BIT_SHIFT_WMAC_PKTCNT_CFGAD_8821C) -+#define BIT_CLEAR_WMAC_PKTCNT_CFGAD_8821C(x) \ -+ ((x) & (~BITS_WMAC_PKTCNT_CFGAD_8821C)) -+#define BIT_GET_WMAC_PKTCNT_CFGAD_8821C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PKTCNT_CFGAD_8821C) & \ -+ BIT_MASK_WMAC_PKTCNT_CFGAD_8821C) -+#define BIT_SET_WMAC_PKTCNT_CFGAD_8821C(x, v) \ -+ (BIT_CLEAR_WMAC_PKTCNT_CFGAD_8821C(x) | BIT_WMAC_PKTCNT_CFGAD_8821C(v)) -+ -+/* 2 REG_IQ_DUMP_8821C */ -+ -+#define BIT_SHIFT_DUMP_OK_ADDR_8821C 16 -+#define BIT_MASK_DUMP_OK_ADDR_8821C 0xffff -+#define BIT_DUMP_OK_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_DUMP_OK_ADDR_8821C) << BIT_SHIFT_DUMP_OK_ADDR_8821C) -+#define BITS_DUMP_OK_ADDR_8821C \ -+ (BIT_MASK_DUMP_OK_ADDR_8821C << BIT_SHIFT_DUMP_OK_ADDR_8821C) -+#define BIT_CLEAR_DUMP_OK_ADDR_8821C(x) ((x) & (~BITS_DUMP_OK_ADDR_8821C)) -+#define BIT_GET_DUMP_OK_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_DUMP_OK_ADDR_8821C) & BIT_MASK_DUMP_OK_ADDR_8821C) -+#define BIT_SET_DUMP_OK_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_DUMP_OK_ADDR_8821C(x) | BIT_DUMP_OK_ADDR_8821C(v)) -+ -+#define BIT_SHIFT_R_TRIG_TIME_SEL_8821C 8 -+#define BIT_MASK_R_TRIG_TIME_SEL_8821C 0x7f -+#define BIT_R_TRIG_TIME_SEL_8821C(x) \ -+ (((x) & BIT_MASK_R_TRIG_TIME_SEL_8821C) \ -+ << BIT_SHIFT_R_TRIG_TIME_SEL_8821C) -+#define BITS_R_TRIG_TIME_SEL_8821C \ -+ (BIT_MASK_R_TRIG_TIME_SEL_8821C << BIT_SHIFT_R_TRIG_TIME_SEL_8821C) -+#define BIT_CLEAR_R_TRIG_TIME_SEL_8821C(x) ((x) & (~BITS_R_TRIG_TIME_SEL_8821C)) -+#define BIT_GET_R_TRIG_TIME_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_TRIG_TIME_SEL_8821C) & \ -+ BIT_MASK_R_TRIG_TIME_SEL_8821C) -+#define BIT_SET_R_TRIG_TIME_SEL_8821C(x, v) \ -+ (BIT_CLEAR_R_TRIG_TIME_SEL_8821C(x) | BIT_R_TRIG_TIME_SEL_8821C(v)) -+ -+#define BIT_SHIFT_R_MAC_TRIG_SEL_8821C 6 -+#define BIT_MASK_R_MAC_TRIG_SEL_8821C 0x3 -+#define BIT_R_MAC_TRIG_SEL_8821C(x) \ -+ (((x) & BIT_MASK_R_MAC_TRIG_SEL_8821C) \ -+ << BIT_SHIFT_R_MAC_TRIG_SEL_8821C) -+#define BITS_R_MAC_TRIG_SEL_8821C \ -+ (BIT_MASK_R_MAC_TRIG_SEL_8821C << BIT_SHIFT_R_MAC_TRIG_SEL_8821C) -+#define BIT_CLEAR_R_MAC_TRIG_SEL_8821C(x) ((x) & (~BITS_R_MAC_TRIG_SEL_8821C)) -+#define BIT_GET_R_MAC_TRIG_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_TRIG_SEL_8821C) & \ -+ BIT_MASK_R_MAC_TRIG_SEL_8821C) -+#define BIT_SET_R_MAC_TRIG_SEL_8821C(x, v) \ -+ (BIT_CLEAR_R_MAC_TRIG_SEL_8821C(x) | BIT_R_MAC_TRIG_SEL_8821C(v)) -+ -+#define BIT_MAC_TRIG_REG_8821C BIT(5) -+ -+#define BIT_SHIFT_R_LEVEL_PULSE_SEL_8821C 3 -+#define BIT_MASK_R_LEVEL_PULSE_SEL_8821C 0x3 -+#define BIT_R_LEVEL_PULSE_SEL_8821C(x) \ -+ (((x) & BIT_MASK_R_LEVEL_PULSE_SEL_8821C) \ -+ << BIT_SHIFT_R_LEVEL_PULSE_SEL_8821C) -+#define BITS_R_LEVEL_PULSE_SEL_8821C \ -+ (BIT_MASK_R_LEVEL_PULSE_SEL_8821C << BIT_SHIFT_R_LEVEL_PULSE_SEL_8821C) -+#define BIT_CLEAR_R_LEVEL_PULSE_SEL_8821C(x) \ -+ ((x) & (~BITS_R_LEVEL_PULSE_SEL_8821C)) -+#define BIT_GET_R_LEVEL_PULSE_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_LEVEL_PULSE_SEL_8821C) & \ -+ BIT_MASK_R_LEVEL_PULSE_SEL_8821C) -+#define BIT_SET_R_LEVEL_PULSE_SEL_8821C(x, v) \ -+ (BIT_CLEAR_R_LEVEL_PULSE_SEL_8821C(x) | BIT_R_LEVEL_PULSE_SEL_8821C(v)) -+ -+#define BIT_EN_LA_MAC_8821C BIT(2) -+#define BIT_R_EN_IQDUMP_8821C BIT(1) -+#define BIT_R_IQDATA_DUMP_8821C BIT(0) -+ -+/* 2 REG_IQ_DUMP_1_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8821C 0 -+#define BIT_MASK_R_WMAC_MASK_LA_MAC_1_8821C 0xffffffffL -+#define BIT_R_WMAC_MASK_LA_MAC_1_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_MASK_LA_MAC_1_8821C) \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8821C) -+#define BITS_R_WMAC_MASK_LA_MAC_1_8821C \ -+ (BIT_MASK_R_WMAC_MASK_LA_MAC_1_8821C \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8821C) -+#define BIT_CLEAR_R_WMAC_MASK_LA_MAC_1_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_MASK_LA_MAC_1_8821C)) -+#define BIT_GET_R_WMAC_MASK_LA_MAC_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8821C) & \ -+ BIT_MASK_R_WMAC_MASK_LA_MAC_1_8821C) -+#define BIT_SET_R_WMAC_MASK_LA_MAC_1_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_MASK_LA_MAC_1_8821C(x) | \ -+ BIT_R_WMAC_MASK_LA_MAC_1_8821C(v)) -+ -+/* 2 REG_IQ_DUMP_2_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8821C 0 -+#define BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8821C 0xffffffffL -+#define BIT_R_WMAC_MATCH_REF_MAC_2_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8821C) \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8821C) -+#define BITS_R_WMAC_MATCH_REF_MAC_2_8821C \ -+ (BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8821C \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8821C) -+#define BIT_CLEAR_R_WMAC_MATCH_REF_MAC_2_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_MATCH_REF_MAC_2_8821C)) -+#define BIT_GET_R_WMAC_MATCH_REF_MAC_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8821C) & \ -+ BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8821C) -+#define BIT_SET_R_WMAC_MATCH_REF_MAC_2_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_MATCH_REF_MAC_2_8821C(x) | \ -+ BIT_R_WMAC_MATCH_REF_MAC_2_8821C(v)) -+ -+/* 2 REG_WMAC_FTM_CTL_8821C */ -+#define BIT_RXFTM_TXACK_SC_8821C BIT(6) -+#define BIT_RXFTM_TXACK_BW_8821C BIT(5) -+#define BIT_RXFTM_EN_8821C BIT(3) -+#define BIT_RXFTMREQ_BYDRV_8821C BIT(2) -+#define BIT_RXFTMREQ_EN_8821C BIT(1) -+#define BIT_FTM_EN_8821C BIT(0) -+ -+/* 2 REG_WMAC_IQ_MDPK_FUNC_8821C */ -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_8821C */ -+ -+#define BIT_SHIFT_R_OFDM_LEN_8821C 26 -+#define BIT_MASK_R_OFDM_LEN_8821C 0x3f -+#define BIT_R_OFDM_LEN_8821C(x) \ -+ (((x) & BIT_MASK_R_OFDM_LEN_8821C) << BIT_SHIFT_R_OFDM_LEN_8821C) -+#define BITS_R_OFDM_LEN_8821C \ -+ (BIT_MASK_R_OFDM_LEN_8821C << BIT_SHIFT_R_OFDM_LEN_8821C) -+#define BIT_CLEAR_R_OFDM_LEN_8821C(x) ((x) & (~BITS_R_OFDM_LEN_8821C)) -+#define BIT_GET_R_OFDM_LEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_OFDM_LEN_8821C) & BIT_MASK_R_OFDM_LEN_8821C) -+#define BIT_SET_R_OFDM_LEN_8821C(x, v) \ -+ (BIT_CLEAR_R_OFDM_LEN_8821C(x) | BIT_R_OFDM_LEN_8821C(v)) -+ -+#define BIT_SHIFT_R_CCK_LEN_8821C 0 -+#define BIT_MASK_R_CCK_LEN_8821C 0xffff -+#define BIT_R_CCK_LEN_8821C(x) \ -+ (((x) & BIT_MASK_R_CCK_LEN_8821C) << BIT_SHIFT_R_CCK_LEN_8821C) -+#define BITS_R_CCK_LEN_8821C \ -+ (BIT_MASK_R_CCK_LEN_8821C << BIT_SHIFT_R_CCK_LEN_8821C) -+#define BIT_CLEAR_R_CCK_LEN_8821C(x) ((x) & (~BITS_R_CCK_LEN_8821C)) -+#define BIT_GET_R_CCK_LEN_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_CCK_LEN_8821C) & BIT_MASK_R_CCK_LEN_8821C) -+#define BIT_SET_R_CCK_LEN_8821C(x, v) \ -+ (BIT_CLEAR_R_CCK_LEN_8821C(x) | BIT_R_CCK_LEN_8821C(v)) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8821C 24 -+#define BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8821C 0xff -+#define BIT_R_WMAC_RXFIFO_FULL_TH_1_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8821C) \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8821C) -+#define BITS_R_WMAC_RXFIFO_FULL_TH_1_8821C \ -+ (BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8821C \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8821C) -+#define BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_1_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_RXFIFO_FULL_TH_1_8821C)) -+#define BIT_GET_R_WMAC_RXFIFO_FULL_TH_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8821C) & \ -+ BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8821C) -+#define BIT_SET_R_WMAC_RXFIFO_FULL_TH_1_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_1_8821C(x) | \ -+ BIT_R_WMAC_RXFIFO_FULL_TH_1_8821C(v)) -+ -+#define BIT_R_WMAC_RX_SYNCFIFO_SYNC_1_8821C BIT(23) -+#define BIT_R_WMAC_RXRST_DLY_1_8821C BIT(22) -+#define BIT_R_WMAC_SRCH_TXRPT_REF_DROP_1_8821C BIT(21) -+#define BIT_R_WMAC_SRCH_TXRPT_UA1_1_8821C BIT(20) -+#define BIT_R_WMAC_SRCH_TXRPT_TYPE_1_8821C BIT(19) -+#define BIT_R_WMAC_NDP_RST_1_8821C BIT(18) -+#define BIT_R_WMAC_POWINT_EN_1_8821C BIT(17) -+#define BIT_R_WMAC_SRCH_TXRPT_PERPKT_1_8821C BIT(16) -+#define BIT_R_WMAC_SRCH_TXRPT_MID_1_8821C BIT(15) -+#define BIT_R_WMAC_PFIN_TOEN_1_8821C BIT(14) -+#define BIT_R_WMAC_FIL_SECERR_1_8821C BIT(13) -+#define BIT_R_WMAC_FIL_CTLPKTLEN_1_8821C BIT(12) -+#define BIT_R_WMAC_FIL_FCTYPE_1_8821C BIT(11) -+#define BIT_R_WMAC_FIL_FCPROVER_1_8821C BIT(10) -+#define BIT_R_WMAC_PHYSTS_SNIF_1_8821C BIT(9) -+#define BIT_R_WMAC_PHYSTS_PLCP_1_8821C BIT(8) -+#define BIT_R_MAC_TCR_VBONF_RD_1_8821C BIT(7) -+#define BIT_R_WMAC_TCR_MPAR_NDP_1_8821C BIT(6) -+#define BIT_R_WMAC_NDP_FILTER_1_8821C BIT(5) -+#define BIT_R_WMAC_RXLEN_SEL_1_8821C BIT(4) -+#define BIT_R_WMAC_RXLEN_SEL1_1_8821C BIT(3) -+#define BIT_R_OFDM_FILTER_1_8821C BIT(2) -+#define BIT_R_WMAC_CHK_OFDM_LEN_1_8821C BIT(1) -+#define BIT_R_WMAC_CHK_CCK_LEN_1_8821C BIT(0) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_2_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8821C 0 -+#define BIT_MASK_R_WMAC_RX_FIL_LEN_2_8821C 0xffff -+#define BIT_R_WMAC_RX_FIL_LEN_2_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_RX_FIL_LEN_2_8821C) \ -+ << BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8821C) -+#define BITS_R_WMAC_RX_FIL_LEN_2_8821C \ -+ (BIT_MASK_R_WMAC_RX_FIL_LEN_2_8821C \ -+ << BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8821C) -+#define BIT_CLEAR_R_WMAC_RX_FIL_LEN_2_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_RX_FIL_LEN_2_8821C)) -+#define BIT_GET_R_WMAC_RX_FIL_LEN_2_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8821C) & \ -+ BIT_MASK_R_WMAC_RX_FIL_LEN_2_8821C) -+#define BIT_SET_R_WMAC_RX_FIL_LEN_2_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_RX_FIL_LEN_2_8821C(x) | \ -+ BIT_R_WMAC_RX_FIL_LEN_2_8821C(v)) -+ -+/* 2 REG_RX_FILTER_FUNCTION_8821C */ -+#define BIT_R_WMAC_MHRDDY_LATCH_8821C BIT(14) -+#define BIT_R_WMAC_MHRDDY_CLR_8821C BIT(13) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY1_8821C BIT(12) -+#define BIT_WMAC_DIS_VHT_PLCP_CHK_MU_8821C BIT(11) -+#define BIT_R_CHK_DELIMIT_LEN_8821C BIT(10) -+#define BIT_R_REAPTER_ADDR_MATCH_8821C BIT(9) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY_8821C BIT(8) -+#define BIT_R_LATCH_MACHRDY_8821C BIT(7) -+#define BIT_R_WMAC_RXFIL_REND_8821C BIT(6) -+#define BIT_R_WMAC_MPDURDY_CLR_8821C BIT(5) -+#define BIT_R_WMAC_CLRRXSEC_8821C BIT(4) -+#define BIT_R_WMAC_RXFIL_RDEL_8821C BIT(3) -+#define BIT_R_WMAC_RXFIL_FCSE_8821C BIT(2) -+#define BIT_R_WMAC_RXFIL_MESH_DEL_8821C BIT(1) -+#define BIT_R_WMAC_RXFIL_MASKM_8821C BIT(0) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NDP_SIG_8821C */ -+ -+#define BIT_SHIFT_R_WMAC_TXNDP_SIGB_8821C 0 -+#define BIT_MASK_R_WMAC_TXNDP_SIGB_8821C 0x1fffff -+#define BIT_R_WMAC_TXNDP_SIGB_8821C(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXNDP_SIGB_8821C) \ -+ << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8821C) -+#define BITS_R_WMAC_TXNDP_SIGB_8821C \ -+ (BIT_MASK_R_WMAC_TXNDP_SIGB_8821C << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8821C) -+#define BIT_CLEAR_R_WMAC_TXNDP_SIGB_8821C(x) \ -+ ((x) & (~BITS_R_WMAC_TXNDP_SIGB_8821C)) -+#define BIT_GET_R_WMAC_TXNDP_SIGB_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXNDP_SIGB_8821C) & \ -+ BIT_MASK_R_WMAC_TXNDP_SIGB_8821C) -+#define BIT_SET_R_WMAC_TXNDP_SIGB_8821C(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXNDP_SIGB_8821C(x) | BIT_R_WMAC_TXNDP_SIGB_8821C(v)) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_8821C */ -+ -+#define BIT_SHIFT_R_MAC_DBG_SHIFT_8821C 8 -+#define BIT_MASK_R_MAC_DBG_SHIFT_8821C 0x7 -+#define BIT_R_MAC_DBG_SHIFT_8821C(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SHIFT_8821C) \ -+ << BIT_SHIFT_R_MAC_DBG_SHIFT_8821C) -+#define BITS_R_MAC_DBG_SHIFT_8821C \ -+ (BIT_MASK_R_MAC_DBG_SHIFT_8821C << BIT_SHIFT_R_MAC_DBG_SHIFT_8821C) -+#define BIT_CLEAR_R_MAC_DBG_SHIFT_8821C(x) ((x) & (~BITS_R_MAC_DBG_SHIFT_8821C)) -+#define BIT_GET_R_MAC_DBG_SHIFT_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SHIFT_8821C) & \ -+ BIT_MASK_R_MAC_DBG_SHIFT_8821C) -+#define BIT_SET_R_MAC_DBG_SHIFT_8821C(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SHIFT_8821C(x) | BIT_R_MAC_DBG_SHIFT_8821C(v)) -+ -+#define BIT_SHIFT_R_MAC_DBG_SEL_8821C 0 -+#define BIT_MASK_R_MAC_DBG_SEL_8821C 0x3 -+#define BIT_R_MAC_DBG_SEL_8821C(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SEL_8821C) << BIT_SHIFT_R_MAC_DBG_SEL_8821C) -+#define BITS_R_MAC_DBG_SEL_8821C \ -+ (BIT_MASK_R_MAC_DBG_SEL_8821C << BIT_SHIFT_R_MAC_DBG_SEL_8821C) -+#define BIT_CLEAR_R_MAC_DBG_SEL_8821C(x) ((x) & (~BITS_R_MAC_DBG_SEL_8821C)) -+#define BIT_GET_R_MAC_DBG_SEL_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SEL_8821C) & BIT_MASK_R_MAC_DBG_SEL_8821C) -+#define BIT_SET_R_MAC_DBG_SEL_8821C(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SEL_8821C(x) | BIT_R_MAC_DBG_SEL_8821C(v)) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_1_8821C */ -+ -+#define BIT_SHIFT_R_MAC_DEBUG_1_8821C 0 -+#define BIT_MASK_R_MAC_DEBUG_1_8821C 0xffffffffL -+#define BIT_R_MAC_DEBUG_1_8821C(x) \ -+ (((x) & BIT_MASK_R_MAC_DEBUG_1_8821C) << BIT_SHIFT_R_MAC_DEBUG_1_8821C) -+#define BITS_R_MAC_DEBUG_1_8821C \ -+ (BIT_MASK_R_MAC_DEBUG_1_8821C << BIT_SHIFT_R_MAC_DEBUG_1_8821C) -+#define BIT_CLEAR_R_MAC_DEBUG_1_8821C(x) ((x) & (~BITS_R_MAC_DEBUG_1_8821C)) -+#define BIT_GET_R_MAC_DEBUG_1_8821C(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DEBUG_1_8821C) & BIT_MASK_R_MAC_DEBUG_1_8821C) -+#define BIT_SET_R_MAC_DEBUG_1_8821C(x, v) \ -+ (BIT_CLEAR_R_MAC_DEBUG_1_8821C(x) | BIT_R_MAC_DEBUG_1_8821C(v)) -+ -+/* 2 REG_WSEC_OPTION_8821C */ -+#define BIT_RXDEC_BM_MGNT_8821C BIT(22) -+#define BIT_TXENC_BM_MGNT_8821C BIT(21) -+#define BIT_RXDEC_UNI_MGNT_8821C BIT(20) -+#define BIT_TXENC_UNI_MGNT_8821C BIT(19) -+ -+/* 2 REG_RTS_ADDRESS_0_8821C */ -+ -+/* 2 REG_RTS_ADDRESS_0_1_8821C */ -+ -+/* 2 REG_RTS_ADDRESS_1_8821C */ -+ -+/* 2 REG_RTS_ADDRESS_1_1_8821C */ -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8821C */ -+#define BIT_LTECOEX_ACCESS_START_V1_8821C BIT(31) -+#define BIT_LTECOEX_WRITE_MODE_V1_8821C BIT(30) -+#define BIT_LTECOEX_READY_BIT_V1_8821C BIT(29) -+ -+#define BIT_SHIFT_WRITE_BYTE_EN_V1_8821C 16 -+#define BIT_MASK_WRITE_BYTE_EN_V1_8821C 0xf -+#define BIT_WRITE_BYTE_EN_V1_8821C(x) \ -+ (((x) & BIT_MASK_WRITE_BYTE_EN_V1_8821C) \ -+ << BIT_SHIFT_WRITE_BYTE_EN_V1_8821C) -+#define BITS_WRITE_BYTE_EN_V1_8821C \ -+ (BIT_MASK_WRITE_BYTE_EN_V1_8821C << BIT_SHIFT_WRITE_BYTE_EN_V1_8821C) -+#define BIT_CLEAR_WRITE_BYTE_EN_V1_8821C(x) \ -+ ((x) & (~BITS_WRITE_BYTE_EN_V1_8821C)) -+#define BIT_GET_WRITE_BYTE_EN_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_WRITE_BYTE_EN_V1_8821C) & \ -+ BIT_MASK_WRITE_BYTE_EN_V1_8821C) -+#define BIT_SET_WRITE_BYTE_EN_V1_8821C(x, v) \ -+ (BIT_CLEAR_WRITE_BYTE_EN_V1_8821C(x) | BIT_WRITE_BYTE_EN_V1_8821C(v)) -+ -+#define BIT_SHIFT_LTECOEX_REG_ADDR_V1_8821C 0 -+#define BIT_MASK_LTECOEX_REG_ADDR_V1_8821C 0xffff -+#define BIT_LTECOEX_REG_ADDR_V1_8821C(x) \ -+ (((x) & BIT_MASK_LTECOEX_REG_ADDR_V1_8821C) \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8821C) -+#define BITS_LTECOEX_REG_ADDR_V1_8821C \ -+ (BIT_MASK_LTECOEX_REG_ADDR_V1_8821C \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8821C) -+#define BIT_CLEAR_LTECOEX_REG_ADDR_V1_8821C(x) \ -+ ((x) & (~BITS_LTECOEX_REG_ADDR_V1_8821C)) -+#define BIT_GET_LTECOEX_REG_ADDR_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_REG_ADDR_V1_8821C) & \ -+ BIT_MASK_LTECOEX_REG_ADDR_V1_8821C) -+#define BIT_SET_LTECOEX_REG_ADDR_V1_8821C(x, v) \ -+ (BIT_CLEAR_LTECOEX_REG_ADDR_V1_8821C(x) | \ -+ BIT_LTECOEX_REG_ADDR_V1_8821C(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8821C */ -+ -+#define BIT_SHIFT_LTECOEX_W_DATA_V1_8821C 0 -+#define BIT_MASK_LTECOEX_W_DATA_V1_8821C 0xffffffffL -+#define BIT_LTECOEX_W_DATA_V1_8821C(x) \ -+ (((x) & BIT_MASK_LTECOEX_W_DATA_V1_8821C) \ -+ << BIT_SHIFT_LTECOEX_W_DATA_V1_8821C) -+#define BITS_LTECOEX_W_DATA_V1_8821C \ -+ (BIT_MASK_LTECOEX_W_DATA_V1_8821C << BIT_SHIFT_LTECOEX_W_DATA_V1_8821C) -+#define BIT_CLEAR_LTECOEX_W_DATA_V1_8821C(x) \ -+ ((x) & (~BITS_LTECOEX_W_DATA_V1_8821C)) -+#define BIT_GET_LTECOEX_W_DATA_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_W_DATA_V1_8821C) & \ -+ BIT_MASK_LTECOEX_W_DATA_V1_8821C) -+#define BIT_SET_LTECOEX_W_DATA_V1_8821C(x, v) \ -+ (BIT_CLEAR_LTECOEX_W_DATA_V1_8821C(x) | BIT_LTECOEX_W_DATA_V1_8821C(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8821C */ -+ -+#define BIT_SHIFT_LTECOEX_R_DATA_V1_8821C 0 -+#define BIT_MASK_LTECOEX_R_DATA_V1_8821C 0xffffffffL -+#define BIT_LTECOEX_R_DATA_V1_8821C(x) \ -+ (((x) & BIT_MASK_LTECOEX_R_DATA_V1_8821C) \ -+ << BIT_SHIFT_LTECOEX_R_DATA_V1_8821C) -+#define BITS_LTECOEX_R_DATA_V1_8821C \ -+ (BIT_MASK_LTECOEX_R_DATA_V1_8821C << BIT_SHIFT_LTECOEX_R_DATA_V1_8821C) -+#define BIT_CLEAR_LTECOEX_R_DATA_V1_8821C(x) \ -+ ((x) & (~BITS_LTECOEX_R_DATA_V1_8821C)) -+#define BIT_GET_LTECOEX_R_DATA_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_R_DATA_V1_8821C) & \ -+ BIT_MASK_LTECOEX_R_DATA_V1_8821C) -+#define BIT_SET_LTECOEX_R_DATA_V1_8821C(x, v) \ -+ (BIT_CLEAR_LTECOEX_R_DATA_V1_8821C(x) | BIT_LTECOEX_R_DATA_V1_8821C(v)) -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_NOT_VALID_8821C */ -+ -+/* 2 REG_SDIO_TX_CTRL_8821C */ -+ -+#define BIT_SHIFT_SDIO_INT_TIMEOUT_8821C 16 -+#define BIT_MASK_SDIO_INT_TIMEOUT_8821C 0xffff -+#define BIT_SDIO_INT_TIMEOUT_8821C(x) \ -+ (((x) & BIT_MASK_SDIO_INT_TIMEOUT_8821C) \ -+ << BIT_SHIFT_SDIO_INT_TIMEOUT_8821C) -+#define BITS_SDIO_INT_TIMEOUT_8821C \ -+ (BIT_MASK_SDIO_INT_TIMEOUT_8821C << BIT_SHIFT_SDIO_INT_TIMEOUT_8821C) -+#define BIT_CLEAR_SDIO_INT_TIMEOUT_8821C(x) \ -+ ((x) & (~BITS_SDIO_INT_TIMEOUT_8821C)) -+#define BIT_GET_SDIO_INT_TIMEOUT_8821C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_INT_TIMEOUT_8821C) & \ -+ BIT_MASK_SDIO_INT_TIMEOUT_8821C) -+#define BIT_SET_SDIO_INT_TIMEOUT_8821C(x, v) \ -+ (BIT_CLEAR_SDIO_INT_TIMEOUT_8821C(x) | BIT_SDIO_INT_TIMEOUT_8821C(v)) -+ -+#define BIT_IO_ERR_STATUS_8821C BIT(15) -+#define BIT_REPLY_ERRCRC_IN_DATA_8821C BIT(9) -+#define BIT_EN_CMD53_OVERLAP_8821C BIT(8) -+#define BIT_REPLY_ERR_IN_R5_8821C BIT(7) -+#define BIT_R18A_EN_8821C BIT(6) -+#define BIT_SDIO_CMD_FORCE_VLD_8821C BIT(5) -+#define BIT_INIT_CMD_EN_8821C BIT(4) -+#define BIT_EN_RXDMA_MASK_INT_8821C BIT(2) -+#define BIT_EN_MASK_TIMER_8821C BIT(1) -+#define BIT_CMD_ERR_STOP_INT_EN_8821C BIT(0) -+ -+/* 2 REG_SDIO_HIMR_8821C */ -+#define BIT_SDIO_CRCERR_MSK_8821C BIT(31) -+#define BIT_SDIO_HSISR3_IND_MSK_8821C BIT(30) -+#define BIT_SDIO_HSISR2_IND_MSK_8821C BIT(29) -+#define BIT_SDIO_HEISR_IND_MSK_8821C BIT(28) -+#define BIT_SDIO_CTWEND_MSK_8821C BIT(27) -+#define BIT_SDIO_ATIMEND_E_MSK_8821C BIT(26) -+#define BIT_SDIIO_ATIMEND_MSK_8821C BIT(25) -+#define BIT_SDIO_OCPINT_MSK_8821C BIT(24) -+#define BIT_SDIO_PSTIMEOUT_MSK_8821C BIT(23) -+#define BIT_SDIO_GTINT4_MSK_8821C BIT(22) -+#define BIT_SDIO_GTINT3_MSK_8821C BIT(21) -+#define BIT_SDIO_HSISR_IND_MSK_8821C BIT(20) -+#define BIT_SDIO_CPWM2_MSK_8821C BIT(19) -+#define BIT_SDIO_CPWM1_MSK_8821C BIT(18) -+#define BIT_SDIO_C2HCMD_INT_MSK_8821C BIT(17) -+#define BIT_SDIO_BCNERLY_INT_MSK_8821C BIT(16) -+#define BIT_SDIO_TXBCNERR_MSK_8821C BIT(7) -+#define BIT_SDIO_TXBCNOK_MSK_8821C BIT(6) -+#define BIT_SDIO_RXFOVW_MSK_8821C BIT(5) -+#define BIT_SDIO_TXFOVW_MSK_8821C BIT(4) -+#define BIT_SDIO_RXERR_MSK_8821C BIT(3) -+#define BIT_SDIO_TXERR_MSK_8821C BIT(2) -+#define BIT_SDIO_AVAL_MSK_8821C BIT(1) -+#define BIT_RX_REQUEST_MSK_8821C BIT(0) -+ -+/* 2 REG_SDIO_HISR_8821C */ -+#define BIT_SDIO_CRCERR_8821C BIT(31) -+#define BIT_SDIO_HSISR3_IND_8821C BIT(30) -+#define BIT_SDIO_HSISR2_IND_8821C BIT(29) -+#define BIT_SDIO_HEISR_IND_8821C BIT(28) -+#define BIT_SDIO_CTWEND_8821C BIT(27) -+#define BIT_SDIO_ATIMEND_E_8821C BIT(26) -+#define BIT_SDIO_ATIMEND_8821C BIT(25) -+#define BIT_SDIO_OCPINT_8821C BIT(24) -+#define BIT_SDIO_PSTIMEOUT_8821C BIT(23) -+#define BIT_SDIO_GTINT4_8821C BIT(22) -+#define BIT_SDIO_GTINT3_8821C BIT(21) -+#define BIT_SDIO_HSISR_IND_8821C BIT(20) -+#define BIT_SDIO_CPWM2_8821C BIT(19) -+#define BIT_SDIO_CPWM1_8821C BIT(18) -+#define BIT_SDIO_C2HCMD_INT_8821C BIT(17) -+#define BIT_SDIO_BCNERLY_INT_8821C BIT(16) -+#define BIT_SDIO_TXBCNERR_8821C BIT(7) -+#define BIT_SDIO_TXBCNOK_8821C BIT(6) -+#define BIT_SDIO_RXFOVW_8821C BIT(5) -+#define BIT_SDIO_TXFOVW_8821C BIT(4) -+#define BIT_SDIO_RXERR_8821C BIT(3) -+#define BIT_SDIO_TXERR_8821C BIT(2) -+#define BIT_SDIO_AVAL_8821C BIT(1) -+#define BIT_RX_REQUEST_8821C BIT(0) -+ -+/* 2 REG_SDIO_RX_REQ_LEN_8821C */ -+ -+#define BIT_SHIFT_RX_REQ_LEN_V1_8821C 0 -+#define BIT_MASK_RX_REQ_LEN_V1_8821C 0x3ffff -+#define BIT_RX_REQ_LEN_V1_8821C(x) \ -+ (((x) & BIT_MASK_RX_REQ_LEN_V1_8821C) << BIT_SHIFT_RX_REQ_LEN_V1_8821C) -+#define BITS_RX_REQ_LEN_V1_8821C \ -+ (BIT_MASK_RX_REQ_LEN_V1_8821C << BIT_SHIFT_RX_REQ_LEN_V1_8821C) -+#define BIT_CLEAR_RX_REQ_LEN_V1_8821C(x) ((x) & (~BITS_RX_REQ_LEN_V1_8821C)) -+#define BIT_GET_RX_REQ_LEN_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_RX_REQ_LEN_V1_8821C) & BIT_MASK_RX_REQ_LEN_V1_8821C) -+#define BIT_SET_RX_REQ_LEN_V1_8821C(x, v) \ -+ (BIT_CLEAR_RX_REQ_LEN_V1_8821C(x) | BIT_RX_REQ_LEN_V1_8821C(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG_SEQ_V1_8821C */ -+ -+#define BIT_SHIFT_FREE_TXPG_SEQ_8821C 0 -+#define BIT_MASK_FREE_TXPG_SEQ_8821C 0xff -+#define BIT_FREE_TXPG_SEQ_8821C(x) \ -+ (((x) & BIT_MASK_FREE_TXPG_SEQ_8821C) << BIT_SHIFT_FREE_TXPG_SEQ_8821C) -+#define BITS_FREE_TXPG_SEQ_8821C \ -+ (BIT_MASK_FREE_TXPG_SEQ_8821C << BIT_SHIFT_FREE_TXPG_SEQ_8821C) -+#define BIT_CLEAR_FREE_TXPG_SEQ_8821C(x) ((x) & (~BITS_FREE_TXPG_SEQ_8821C)) -+#define BIT_GET_FREE_TXPG_SEQ_8821C(x) \ -+ (((x) >> BIT_SHIFT_FREE_TXPG_SEQ_8821C) & BIT_MASK_FREE_TXPG_SEQ_8821C) -+#define BIT_SET_FREE_TXPG_SEQ_8821C(x, v) \ -+ (BIT_CLEAR_FREE_TXPG_SEQ_8821C(x) | BIT_FREE_TXPG_SEQ_8821C(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG_8821C */ -+ -+#define BIT_SHIFT_MID_FREEPG_V1_8821C 16 -+#define BIT_MASK_MID_FREEPG_V1_8821C 0xfff -+#define BIT_MID_FREEPG_V1_8821C(x) \ -+ (((x) & BIT_MASK_MID_FREEPG_V1_8821C) << BIT_SHIFT_MID_FREEPG_V1_8821C) -+#define BITS_MID_FREEPG_V1_8821C \ -+ (BIT_MASK_MID_FREEPG_V1_8821C << BIT_SHIFT_MID_FREEPG_V1_8821C) -+#define BIT_CLEAR_MID_FREEPG_V1_8821C(x) ((x) & (~BITS_MID_FREEPG_V1_8821C)) -+#define BIT_GET_MID_FREEPG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_MID_FREEPG_V1_8821C) & BIT_MASK_MID_FREEPG_V1_8821C) -+#define BIT_SET_MID_FREEPG_V1_8821C(x, v) \ -+ (BIT_CLEAR_MID_FREEPG_V1_8821C(x) | BIT_MID_FREEPG_V1_8821C(v)) -+ -+#define BIT_SHIFT_HIQ_FREEPG_V1_8821C 0 -+#define BIT_MASK_HIQ_FREEPG_V1_8821C 0xfff -+#define BIT_HIQ_FREEPG_V1_8821C(x) \ -+ (((x) & BIT_MASK_HIQ_FREEPG_V1_8821C) << BIT_SHIFT_HIQ_FREEPG_V1_8821C) -+#define BITS_HIQ_FREEPG_V1_8821C \ -+ (BIT_MASK_HIQ_FREEPG_V1_8821C << BIT_SHIFT_HIQ_FREEPG_V1_8821C) -+#define BIT_CLEAR_HIQ_FREEPG_V1_8821C(x) ((x) & (~BITS_HIQ_FREEPG_V1_8821C)) -+#define BIT_GET_HIQ_FREEPG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HIQ_FREEPG_V1_8821C) & BIT_MASK_HIQ_FREEPG_V1_8821C) -+#define BIT_SET_HIQ_FREEPG_V1_8821C(x, v) \ -+ (BIT_CLEAR_HIQ_FREEPG_V1_8821C(x) | BIT_HIQ_FREEPG_V1_8821C(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG2_8821C */ -+ -+#define BIT_SHIFT_PUB_FREEPG_V1_8821C 16 -+#define BIT_MASK_PUB_FREEPG_V1_8821C 0xfff -+#define BIT_PUB_FREEPG_V1_8821C(x) \ -+ (((x) & BIT_MASK_PUB_FREEPG_V1_8821C) << BIT_SHIFT_PUB_FREEPG_V1_8821C) -+#define BITS_PUB_FREEPG_V1_8821C \ -+ (BIT_MASK_PUB_FREEPG_V1_8821C << BIT_SHIFT_PUB_FREEPG_V1_8821C) -+#define BIT_CLEAR_PUB_FREEPG_V1_8821C(x) ((x) & (~BITS_PUB_FREEPG_V1_8821C)) -+#define BIT_GET_PUB_FREEPG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_PUB_FREEPG_V1_8821C) & BIT_MASK_PUB_FREEPG_V1_8821C) -+#define BIT_SET_PUB_FREEPG_V1_8821C(x, v) \ -+ (BIT_CLEAR_PUB_FREEPG_V1_8821C(x) | BIT_PUB_FREEPG_V1_8821C(v)) -+ -+#define BIT_SHIFT_LOW_FREEPG_V1_8821C 0 -+#define BIT_MASK_LOW_FREEPG_V1_8821C 0xfff -+#define BIT_LOW_FREEPG_V1_8821C(x) \ -+ (((x) & BIT_MASK_LOW_FREEPG_V1_8821C) << BIT_SHIFT_LOW_FREEPG_V1_8821C) -+#define BITS_LOW_FREEPG_V1_8821C \ -+ (BIT_MASK_LOW_FREEPG_V1_8821C << BIT_SHIFT_LOW_FREEPG_V1_8821C) -+#define BIT_CLEAR_LOW_FREEPG_V1_8821C(x) ((x) & (~BITS_LOW_FREEPG_V1_8821C)) -+#define BIT_GET_LOW_FREEPG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_LOW_FREEPG_V1_8821C) & BIT_MASK_LOW_FREEPG_V1_8821C) -+#define BIT_SET_LOW_FREEPG_V1_8821C(x, v) \ -+ (BIT_CLEAR_LOW_FREEPG_V1_8821C(x) | BIT_LOW_FREEPG_V1_8821C(v)) -+ -+/* 2 REG_SDIO_OQT_FREE_TXPG_V1_8821C */ -+ -+#define BIT_SHIFT_NOAC_OQT_FREEPG_V1_8821C 24 -+#define BIT_MASK_NOAC_OQT_FREEPG_V1_8821C 0xff -+#define BIT_NOAC_OQT_FREEPG_V1_8821C(x) \ -+ (((x) & BIT_MASK_NOAC_OQT_FREEPG_V1_8821C) \ -+ << BIT_SHIFT_NOAC_OQT_FREEPG_V1_8821C) -+#define BITS_NOAC_OQT_FREEPG_V1_8821C \ -+ (BIT_MASK_NOAC_OQT_FREEPG_V1_8821C \ -+ << BIT_SHIFT_NOAC_OQT_FREEPG_V1_8821C) -+#define BIT_CLEAR_NOAC_OQT_FREEPG_V1_8821C(x) \ -+ ((x) & (~BITS_NOAC_OQT_FREEPG_V1_8821C)) -+#define BIT_GET_NOAC_OQT_FREEPG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_NOAC_OQT_FREEPG_V1_8821C) & \ -+ BIT_MASK_NOAC_OQT_FREEPG_V1_8821C) -+#define BIT_SET_NOAC_OQT_FREEPG_V1_8821C(x, v) \ -+ (BIT_CLEAR_NOAC_OQT_FREEPG_V1_8821C(x) | \ -+ BIT_NOAC_OQT_FREEPG_V1_8821C(v)) -+ -+#define BIT_SHIFT_AC_OQT_FREEPG_V1_8821C 16 -+#define BIT_MASK_AC_OQT_FREEPG_V1_8821C 0xff -+#define BIT_AC_OQT_FREEPG_V1_8821C(x) \ -+ (((x) & BIT_MASK_AC_OQT_FREEPG_V1_8821C) \ -+ << BIT_SHIFT_AC_OQT_FREEPG_V1_8821C) -+#define BITS_AC_OQT_FREEPG_V1_8821C \ -+ (BIT_MASK_AC_OQT_FREEPG_V1_8821C << BIT_SHIFT_AC_OQT_FREEPG_V1_8821C) -+#define BIT_CLEAR_AC_OQT_FREEPG_V1_8821C(x) \ -+ ((x) & (~BITS_AC_OQT_FREEPG_V1_8821C)) -+#define BIT_GET_AC_OQT_FREEPG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_AC_OQT_FREEPG_V1_8821C) & \ -+ BIT_MASK_AC_OQT_FREEPG_V1_8821C) -+#define BIT_SET_AC_OQT_FREEPG_V1_8821C(x, v) \ -+ (BIT_CLEAR_AC_OQT_FREEPG_V1_8821C(x) | BIT_AC_OQT_FREEPG_V1_8821C(v)) -+ -+#define BIT_SHIFT_EXQ_FREEPG_V1_8821C 0 -+#define BIT_MASK_EXQ_FREEPG_V1_8821C 0xfff -+#define BIT_EXQ_FREEPG_V1_8821C(x) \ -+ (((x) & BIT_MASK_EXQ_FREEPG_V1_8821C) << BIT_SHIFT_EXQ_FREEPG_V1_8821C) -+#define BITS_EXQ_FREEPG_V1_8821C \ -+ (BIT_MASK_EXQ_FREEPG_V1_8821C << BIT_SHIFT_EXQ_FREEPG_V1_8821C) -+#define BIT_CLEAR_EXQ_FREEPG_V1_8821C(x) ((x) & (~BITS_EXQ_FREEPG_V1_8821C)) -+#define BIT_GET_EXQ_FREEPG_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_EXQ_FREEPG_V1_8821C) & BIT_MASK_EXQ_FREEPG_V1_8821C) -+#define BIT_SET_EXQ_FREEPG_V1_8821C(x, v) \ -+ (BIT_CLEAR_EXQ_FREEPG_V1_8821C(x) | BIT_EXQ_FREEPG_V1_8821C(v)) -+ -+/* 2 REG_SDIO_HTSFR_INFO_8821C */ -+ -+#define BIT_SHIFT_HTSFR1_8821C 16 -+#define BIT_MASK_HTSFR1_8821C 0xffff -+#define BIT_HTSFR1_8821C(x) \ -+ (((x) & BIT_MASK_HTSFR1_8821C) << BIT_SHIFT_HTSFR1_8821C) -+#define BITS_HTSFR1_8821C (BIT_MASK_HTSFR1_8821C << BIT_SHIFT_HTSFR1_8821C) -+#define BIT_CLEAR_HTSFR1_8821C(x) ((x) & (~BITS_HTSFR1_8821C)) -+#define BIT_GET_HTSFR1_8821C(x) \ -+ (((x) >> BIT_SHIFT_HTSFR1_8821C) & BIT_MASK_HTSFR1_8821C) -+#define BIT_SET_HTSFR1_8821C(x, v) \ -+ (BIT_CLEAR_HTSFR1_8821C(x) | BIT_HTSFR1_8821C(v)) -+ -+#define BIT_SHIFT_HTSFR0_8821C 0 -+#define BIT_MASK_HTSFR0_8821C 0xffff -+#define BIT_HTSFR0_8821C(x) \ -+ (((x) & BIT_MASK_HTSFR0_8821C) << BIT_SHIFT_HTSFR0_8821C) -+#define BITS_HTSFR0_8821C (BIT_MASK_HTSFR0_8821C << BIT_SHIFT_HTSFR0_8821C) -+#define BIT_CLEAR_HTSFR0_8821C(x) ((x) & (~BITS_HTSFR0_8821C)) -+#define BIT_GET_HTSFR0_8821C(x) \ -+ (((x) >> BIT_SHIFT_HTSFR0_8821C) & BIT_MASK_HTSFR0_8821C) -+#define BIT_SET_HTSFR0_8821C(x, v) \ -+ (BIT_CLEAR_HTSFR0_8821C(x) | BIT_HTSFR0_8821C(v)) -+ -+/* 2 REG_SDIO_HCPWM1_V2_8821C */ -+#define BIT_TOGGLE_8821C BIT(7) -+#define BIT_CUR_PS_8821C BIT(0) -+ -+/* 2 REG_SDIO_HCPWM2_V2_8821C */ -+ -+/* 2 REG_SDIO_INDIRECT_REG_CFG_8821C */ -+#define BIT_INDIRECT_REG_RDY_8821C BIT(20) -+#define BIT_INDIRECT_REG_R_8821C BIT(19) -+#define BIT_INDIRECT_REG_W_8821C BIT(18) -+ -+#define BIT_SHIFT_INDIRECT_REG_SIZE_8821C 16 -+#define BIT_MASK_INDIRECT_REG_SIZE_8821C 0x3 -+#define BIT_INDIRECT_REG_SIZE_8821C(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_SIZE_8821C) \ -+ << BIT_SHIFT_INDIRECT_REG_SIZE_8821C) -+#define BITS_INDIRECT_REG_SIZE_8821C \ -+ (BIT_MASK_INDIRECT_REG_SIZE_8821C << BIT_SHIFT_INDIRECT_REG_SIZE_8821C) -+#define BIT_CLEAR_INDIRECT_REG_SIZE_8821C(x) \ -+ ((x) & (~BITS_INDIRECT_REG_SIZE_8821C)) -+#define BIT_GET_INDIRECT_REG_SIZE_8821C(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_SIZE_8821C) & \ -+ BIT_MASK_INDIRECT_REG_SIZE_8821C) -+#define BIT_SET_INDIRECT_REG_SIZE_8821C(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_SIZE_8821C(x) | BIT_INDIRECT_REG_SIZE_8821C(v)) -+ -+#define BIT_SHIFT_INDIRECT_REG_ADDR_8821C 0 -+#define BIT_MASK_INDIRECT_REG_ADDR_8821C 0xffff -+#define BIT_INDIRECT_REG_ADDR_8821C(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_ADDR_8821C) \ -+ << BIT_SHIFT_INDIRECT_REG_ADDR_8821C) -+#define BITS_INDIRECT_REG_ADDR_8821C \ -+ (BIT_MASK_INDIRECT_REG_ADDR_8821C << BIT_SHIFT_INDIRECT_REG_ADDR_8821C) -+#define BIT_CLEAR_INDIRECT_REG_ADDR_8821C(x) \ -+ ((x) & (~BITS_INDIRECT_REG_ADDR_8821C)) -+#define BIT_GET_INDIRECT_REG_ADDR_8821C(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_ADDR_8821C) & \ -+ BIT_MASK_INDIRECT_REG_ADDR_8821C) -+#define BIT_SET_INDIRECT_REG_ADDR_8821C(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_ADDR_8821C(x) | BIT_INDIRECT_REG_ADDR_8821C(v)) -+ -+/* 2 REG_SDIO_INDIRECT_REG_DATA_8821C */ -+ -+#define BIT_SHIFT_INDIRECT_REG_DATA_8821C 0 -+#define BIT_MASK_INDIRECT_REG_DATA_8821C 0xffffffffL -+#define BIT_INDIRECT_REG_DATA_8821C(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_DATA_8821C) \ -+ << BIT_SHIFT_INDIRECT_REG_DATA_8821C) -+#define BITS_INDIRECT_REG_DATA_8821C \ -+ (BIT_MASK_INDIRECT_REG_DATA_8821C << BIT_SHIFT_INDIRECT_REG_DATA_8821C) -+#define BIT_CLEAR_INDIRECT_REG_DATA_8821C(x) \ -+ ((x) & (~BITS_INDIRECT_REG_DATA_8821C)) -+#define BIT_GET_INDIRECT_REG_DATA_8821C(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_DATA_8821C) & \ -+ BIT_MASK_INDIRECT_REG_DATA_8821C) -+#define BIT_SET_INDIRECT_REG_DATA_8821C(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_DATA_8821C(x) | BIT_INDIRECT_REG_DATA_8821C(v)) -+ -+/* 2 REG_SDIO_H2C_8821C */ -+ -+#define BIT_SHIFT_SDIO_H2C_MSG_8821C 0 -+#define BIT_MASK_SDIO_H2C_MSG_8821C 0xffffffffL -+#define BIT_SDIO_H2C_MSG_8821C(x) \ -+ (((x) & BIT_MASK_SDIO_H2C_MSG_8821C) << BIT_SHIFT_SDIO_H2C_MSG_8821C) -+#define BITS_SDIO_H2C_MSG_8821C \ -+ (BIT_MASK_SDIO_H2C_MSG_8821C << BIT_SHIFT_SDIO_H2C_MSG_8821C) -+#define BIT_CLEAR_SDIO_H2C_MSG_8821C(x) ((x) & (~BITS_SDIO_H2C_MSG_8821C)) -+#define BIT_GET_SDIO_H2C_MSG_8821C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_H2C_MSG_8821C) & BIT_MASK_SDIO_H2C_MSG_8821C) -+#define BIT_SET_SDIO_H2C_MSG_8821C(x, v) \ -+ (BIT_CLEAR_SDIO_H2C_MSG_8821C(x) | BIT_SDIO_H2C_MSG_8821C(v)) -+ -+/* 2 REG_SDIO_C2H_8821C */ -+ -+#define BIT_SHIFT_SDIO_C2H_MSG_8821C 0 -+#define BIT_MASK_SDIO_C2H_MSG_8821C 0xffffffffL -+#define BIT_SDIO_C2H_MSG_8821C(x) \ -+ (((x) & BIT_MASK_SDIO_C2H_MSG_8821C) << BIT_SHIFT_SDIO_C2H_MSG_8821C) -+#define BITS_SDIO_C2H_MSG_8821C \ -+ (BIT_MASK_SDIO_C2H_MSG_8821C << BIT_SHIFT_SDIO_C2H_MSG_8821C) -+#define BIT_CLEAR_SDIO_C2H_MSG_8821C(x) ((x) & (~BITS_SDIO_C2H_MSG_8821C)) -+#define BIT_GET_SDIO_C2H_MSG_8821C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_C2H_MSG_8821C) & BIT_MASK_SDIO_C2H_MSG_8821C) -+#define BIT_SET_SDIO_C2H_MSG_8821C(x, v) \ -+ (BIT_CLEAR_SDIO_C2H_MSG_8821C(x) | BIT_SDIO_C2H_MSG_8821C(v)) -+ -+/* 2 REG_SDIO_HRPWM1_8821C */ -+#define BIT_TOGGLE_8821C BIT(7) -+#define BIT_ACK_8821C BIT(6) -+#define BIT_REQ_PS_8821C BIT(0) -+ -+/* 2 REG_SDIO_HRPWM2_8821C */ -+ -+/* 2 REG_SDIO_HPS_CLKR_8821C */ -+ -+/* 2 REG_SDIO_BUS_CTRL_8821C */ -+#define BIT_PAD_CLK_XHGE_EN_8821C BIT(3) -+#define BIT_INTER_CLK_EN_8821C BIT(2) -+#define BIT_EN_RPT_TXCRC_8821C BIT(1) -+#define BIT_DIS_RXDMA_STS_8821C BIT(0) -+ -+/* 2 REG_SDIO_HSUS_CTRL_8821C */ -+#define BIT_INTR_CTRL_8821C BIT(4) -+#define BIT_SDIO_VOLTAGE_8821C BIT(3) -+#define BIT_BYPASS_INIT_8821C BIT(2) -+#define BIT_HCI_RESUME_RDY_8821C BIT(1) -+#define BIT_HCI_SUS_REQ_8821C BIT(0) -+ -+/* 2 REG_SDIO_RESPONSE_TIMER_8821C */ -+ -+#define BIT_SHIFT_CMDIN_2RESP_TIMER_8821C 0 -+#define BIT_MASK_CMDIN_2RESP_TIMER_8821C 0xffff -+#define BIT_CMDIN_2RESP_TIMER_8821C(x) \ -+ (((x) & BIT_MASK_CMDIN_2RESP_TIMER_8821C) \ -+ << BIT_SHIFT_CMDIN_2RESP_TIMER_8821C) -+#define BITS_CMDIN_2RESP_TIMER_8821C \ -+ (BIT_MASK_CMDIN_2RESP_TIMER_8821C << BIT_SHIFT_CMDIN_2RESP_TIMER_8821C) -+#define BIT_CLEAR_CMDIN_2RESP_TIMER_8821C(x) \ -+ ((x) & (~BITS_CMDIN_2RESP_TIMER_8821C)) -+#define BIT_GET_CMDIN_2RESP_TIMER_8821C(x) \ -+ (((x) >> BIT_SHIFT_CMDIN_2RESP_TIMER_8821C) & \ -+ BIT_MASK_CMDIN_2RESP_TIMER_8821C) -+#define BIT_SET_CMDIN_2RESP_TIMER_8821C(x, v) \ -+ (BIT_CLEAR_CMDIN_2RESP_TIMER_8821C(x) | BIT_CMDIN_2RESP_TIMER_8821C(v)) -+ -+/* 2 REG_SDIO_CMD_CRC_8821C */ -+ -+#define BIT_SHIFT_SDIO_CMD_CRC_V1_8821C 0 -+#define BIT_MASK_SDIO_CMD_CRC_V1_8821C 0xff -+#define BIT_SDIO_CMD_CRC_V1_8821C(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_CRC_V1_8821C) \ -+ << BIT_SHIFT_SDIO_CMD_CRC_V1_8821C) -+#define BITS_SDIO_CMD_CRC_V1_8821C \ -+ (BIT_MASK_SDIO_CMD_CRC_V1_8821C << BIT_SHIFT_SDIO_CMD_CRC_V1_8821C) -+#define BIT_CLEAR_SDIO_CMD_CRC_V1_8821C(x) ((x) & (~BITS_SDIO_CMD_CRC_V1_8821C)) -+#define BIT_GET_SDIO_CMD_CRC_V1_8821C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_CRC_V1_8821C) & \ -+ BIT_MASK_SDIO_CMD_CRC_V1_8821C) -+#define BIT_SET_SDIO_CMD_CRC_V1_8821C(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_CRC_V1_8821C(x) | BIT_SDIO_CMD_CRC_V1_8821C(v)) -+ -+/* 2 REG_SDIO_HSISR_8821C */ -+#define BIT_DRV_WLAN_INT_CLR_8821C BIT(1) -+#define BIT_DRV_WLAN_INT_8821C BIT(0) -+ -+/* 2 REG_SDIO_ERR_RPT_8821C */ -+#define BIT_HR_FF_OVF_8821C BIT(6) -+#define BIT_HR_FF_UDN_8821C BIT(5) -+#define BIT_TXDMA_BUSY_ERR_8821C BIT(4) -+#define BIT_TXDMA_VLD_ERR_8821C BIT(3) -+#define BIT_QSEL_UNKNOWN_ERR_8821C BIT(2) -+#define BIT_QSEL_MIS_ERR_8821C BIT(1) -+#define BIT_SDIO_OVERRD_ERR_8821C BIT(0) -+ -+/* 2 REG_SDIO_CMD_ERRCNT_8821C */ -+ -+#define BIT_SHIFT_CMD_CRC_ERR_CNT_8821C 0 -+#define BIT_MASK_CMD_CRC_ERR_CNT_8821C 0xff -+#define BIT_CMD_CRC_ERR_CNT_8821C(x) \ -+ (((x) & BIT_MASK_CMD_CRC_ERR_CNT_8821C) \ -+ << BIT_SHIFT_CMD_CRC_ERR_CNT_8821C) -+#define BITS_CMD_CRC_ERR_CNT_8821C \ -+ (BIT_MASK_CMD_CRC_ERR_CNT_8821C << BIT_SHIFT_CMD_CRC_ERR_CNT_8821C) -+#define BIT_CLEAR_CMD_CRC_ERR_CNT_8821C(x) ((x) & (~BITS_CMD_CRC_ERR_CNT_8821C)) -+#define BIT_GET_CMD_CRC_ERR_CNT_8821C(x) \ -+ (((x) >> BIT_SHIFT_CMD_CRC_ERR_CNT_8821C) & \ -+ BIT_MASK_CMD_CRC_ERR_CNT_8821C) -+#define BIT_SET_CMD_CRC_ERR_CNT_8821C(x, v) \ -+ (BIT_CLEAR_CMD_CRC_ERR_CNT_8821C(x) | BIT_CMD_CRC_ERR_CNT_8821C(v)) -+ -+/* 2 REG_SDIO_DATA_ERRCNT_8821C */ -+ -+#define BIT_SHIFT_DATA_CRC_ERR_CNT_8821C 0 -+#define BIT_MASK_DATA_CRC_ERR_CNT_8821C 0xff -+#define BIT_DATA_CRC_ERR_CNT_8821C(x) \ -+ (((x) & BIT_MASK_DATA_CRC_ERR_CNT_8821C) \ -+ << BIT_SHIFT_DATA_CRC_ERR_CNT_8821C) -+#define BITS_DATA_CRC_ERR_CNT_8821C \ -+ (BIT_MASK_DATA_CRC_ERR_CNT_8821C << BIT_SHIFT_DATA_CRC_ERR_CNT_8821C) -+#define BIT_CLEAR_DATA_CRC_ERR_CNT_8821C(x) \ -+ ((x) & (~BITS_DATA_CRC_ERR_CNT_8821C)) -+#define BIT_GET_DATA_CRC_ERR_CNT_8821C(x) \ -+ (((x) >> BIT_SHIFT_DATA_CRC_ERR_CNT_8821C) & \ -+ BIT_MASK_DATA_CRC_ERR_CNT_8821C) -+#define BIT_SET_DATA_CRC_ERR_CNT_8821C(x, v) \ -+ (BIT_CLEAR_DATA_CRC_ERR_CNT_8821C(x) | BIT_DATA_CRC_ERR_CNT_8821C(v)) -+ -+/* 2 REG_SDIO_CMD_ERR_CONTENT_8821C */ -+ -+#define BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8821C 0 -+#define BIT_MASK_SDIO_CMD_ERR_CONTENT_8821C 0xffffffffffL -+#define BIT_SDIO_CMD_ERR_CONTENT_8821C(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_ERR_CONTENT_8821C) \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8821C) -+#define BITS_SDIO_CMD_ERR_CONTENT_8821C \ -+ (BIT_MASK_SDIO_CMD_ERR_CONTENT_8821C \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8821C) -+#define BIT_CLEAR_SDIO_CMD_ERR_CONTENT_8821C(x) \ -+ ((x) & (~BITS_SDIO_CMD_ERR_CONTENT_8821C)) -+#define BIT_GET_SDIO_CMD_ERR_CONTENT_8821C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8821C) & \ -+ BIT_MASK_SDIO_CMD_ERR_CONTENT_8821C) -+#define BIT_SET_SDIO_CMD_ERR_CONTENT_8821C(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_ERR_CONTENT_8821C(x) | \ -+ BIT_SDIO_CMD_ERR_CONTENT_8821C(v)) -+ -+/* 2 REG_SDIO_CRC_ERR_IDX_8821C */ -+#define BIT_D3_CRC_ERR_8821C BIT(4) -+#define BIT_D2_CRC_ERR_8821C BIT(3) -+#define BIT_D1_CRC_ERR_8821C BIT(2) -+#define BIT_D0_CRC_ERR_8821C BIT(1) -+#define BIT_CMD_CRC_ERR_8821C BIT(0) -+ -+/* 2 REG_SDIO_DATA_CRC_8821C */ -+ -+#define BIT_SHIFT_SDIO_DATA_CRC_8821C 0 -+#define BIT_MASK_SDIO_DATA_CRC_8821C 0xffff -+#define BIT_SDIO_DATA_CRC_8821C(x) \ -+ (((x) & BIT_MASK_SDIO_DATA_CRC_8821C) << BIT_SHIFT_SDIO_DATA_CRC_8821C) -+#define BITS_SDIO_DATA_CRC_8821C \ -+ (BIT_MASK_SDIO_DATA_CRC_8821C << BIT_SHIFT_SDIO_DATA_CRC_8821C) -+#define BIT_CLEAR_SDIO_DATA_CRC_8821C(x) ((x) & (~BITS_SDIO_DATA_CRC_8821C)) -+#define BIT_GET_SDIO_DATA_CRC_8821C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DATA_CRC_8821C) & BIT_MASK_SDIO_DATA_CRC_8821C) -+#define BIT_SET_SDIO_DATA_CRC_8821C(x, v) \ -+ (BIT_CLEAR_SDIO_DATA_CRC_8821C(x) | BIT_SDIO_DATA_CRC_8821C(v)) -+ -+/* 2 REG_SDIO_DATA_REPLY_TIME_8821C */ -+ -+#define BIT_SHIFT_SDIO_DATA_REPLY_TIME_8821C 0 -+#define BIT_MASK_SDIO_DATA_REPLY_TIME_8821C 0x7 -+#define BIT_SDIO_DATA_REPLY_TIME_8821C(x) \ -+ (((x) & BIT_MASK_SDIO_DATA_REPLY_TIME_8821C) \ -+ << BIT_SHIFT_SDIO_DATA_REPLY_TIME_8821C) -+#define BITS_SDIO_DATA_REPLY_TIME_8821C \ -+ (BIT_MASK_SDIO_DATA_REPLY_TIME_8821C \ -+ << BIT_SHIFT_SDIO_DATA_REPLY_TIME_8821C) -+#define BIT_CLEAR_SDIO_DATA_REPLY_TIME_8821C(x) \ -+ ((x) & (~BITS_SDIO_DATA_REPLY_TIME_8821C)) -+#define BIT_GET_SDIO_DATA_REPLY_TIME_8821C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DATA_REPLY_TIME_8821C) & \ -+ BIT_MASK_SDIO_DATA_REPLY_TIME_8821C) -+#define BIT_SET_SDIO_DATA_REPLY_TIME_8821C(x, v) \ -+ (BIT_CLEAR_SDIO_DATA_REPLY_TIME_8821C(x) | \ -+ BIT_SDIO_DATA_REPLY_TIME_8821C(v)) -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8822b.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8822b.h -new file mode 100644 -index 000000000..9600e9a8e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8822b.h -@@ -0,0 +1,17886 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_BIT_8822B_H -+#define __INC_HALMAC_BIT_8822B_H -+ -+#define CPU_OPT_WIDTH 0x1F -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_SYS_ISO_CTRL_8822B */ -+#define BIT_PWC_EV12V_8822B BIT(15) -+#define BIT_PWC_EV25V_8822B BIT(14) -+#define BIT_PA33V_EN_8822B BIT(13) -+#define BIT_PA12V_EN_8822B BIT(12) -+#define BIT_UA33V_EN_8822B BIT(11) -+#define BIT_UA12V_EN_8822B BIT(10) -+#define BIT_ISO_RFDIO_8822B BIT(9) -+#define BIT_ISO_EB2CORE_8822B BIT(8) -+#define BIT_ISO_DIOE_8822B BIT(7) -+#define BIT_ISO_WLPON2PP_8822B BIT(6) -+#define BIT_ISO_IP2MAC_WA2PP_8822B BIT(5) -+#define BIT_ISO_PD2CORE_8822B BIT(4) -+#define BIT_ISO_PA2PCIE_8822B BIT(3) -+#define BIT_ISO_UD2CORE_8822B BIT(2) -+#define BIT_ISO_UA2USB_8822B BIT(1) -+#define BIT_ISO_WD2PP_8822B BIT(0) -+ -+/* 2 REG_SYS_FUNC_EN_8822B */ -+#define BIT_FEN_MREGEN_8822B BIT(15) -+#define BIT_FEN_HWPDN_8822B BIT(14) -+#define BIT_EN_25_1_8822B BIT(13) -+#define BIT_FEN_ELDR_8822B BIT(12) -+#define BIT_FEN_DCORE_8822B BIT(11) -+#define BIT_FEN_CPUEN_8822B BIT(10) -+#define BIT_FEN_DIOE_8822B BIT(9) -+#define BIT_FEN_PCIED_8822B BIT(8) -+#define BIT_FEN_PPLL_8822B BIT(7) -+#define BIT_FEN_PCIEA_8822B BIT(6) -+#define BIT_FEN_DIO_PCIE_8822B BIT(5) -+#define BIT_FEN_USBD_8822B BIT(4) -+#define BIT_FEN_UPLL_8822B BIT(3) -+#define BIT_FEN_USBA_8822B BIT(2) -+#define BIT_FEN_BB_GLB_RSTN_8822B BIT(1) -+#define BIT_FEN_BBRSTB_8822B BIT(0) -+ -+/* 2 REG_SYS_PW_CTRL_8822B */ -+#define BIT_SOP_EABM_8822B BIT(31) -+#define BIT_SOP_ACKF_8822B BIT(30) -+#define BIT_SOP_ERCK_8822B BIT(29) -+#define BIT_SOP_ESWR_8822B BIT(28) -+#define BIT_SOP_PWMM_8822B BIT(27) -+#define BIT_SOP_EECK_8822B BIT(26) -+#define BIT_SOP_EXTL_8822B BIT(24) -+#define BIT_SYM_OP_RING_12M_8822B BIT(22) -+#define BIT_ROP_SWPR_8822B BIT(21) -+#define BIT_DIS_HW_LPLDM_8822B BIT(20) -+#define BIT_OPT_SWRST_WLMCU_8822B BIT(19) -+#define BIT_RDY_SYSPWR_8822B BIT(17) -+#define BIT_EN_WLON_8822B BIT(16) -+#define BIT_APDM_HPDN_8822B BIT(15) -+#define BIT_AFSM_PCIE_SUS_EN_8822B BIT(12) -+#define BIT_AFSM_WLSUS_EN_8822B BIT(11) -+#define BIT_APFM_SWLPS_8822B BIT(10) -+#define BIT_APFM_OFFMAC_8822B BIT(9) -+#define BIT_APFN_ONMAC_8822B BIT(8) -+#define BIT_CHIP_PDN_EN_8822B BIT(7) -+#define BIT_RDY_MACDIS_8822B BIT(6) -+#define BIT_RING_CLK_12M_EN_8822B BIT(4) -+#define BIT_PFM_WOWL_8822B BIT(3) -+#define BIT_PFM_LDKP_8822B BIT(2) -+#define BIT_WL_HCI_ALD_8822B BIT(1) -+#define BIT_PFM_LDALL_8822B BIT(0) -+ -+/* 2 REG_SYS_CLK_CTRL_8822B */ -+#define BIT_LDO_DUMMY_8822B BIT(15) -+#define BIT_CPU_CLK_EN_8822B BIT(14) -+#define BIT_SYMREG_CLK_EN_8822B BIT(13) -+#define BIT_HCI_CLK_EN_8822B BIT(12) -+#define BIT_MAC_CLK_EN_8822B BIT(11) -+#define BIT_SEC_CLK_EN_8822B BIT(10) -+#define BIT_PHY_SSC_RSTB_8822B BIT(9) -+#define BIT_EXT_32K_EN_8822B BIT(8) -+#define BIT_WL_CLK_TEST_8822B BIT(7) -+#define BIT_OP_SPS_PWM_EN_8822B BIT(6) -+#define BIT_LOADER_CLK_EN_8822B BIT(5) -+#define BIT_MACSLP_8822B BIT(4) -+#define BIT_WAKEPAD_EN_8822B BIT(3) -+#define BIT_ROMD16V_EN_8822B BIT(2) -+#define BIT_CKANA12M_EN_8822B BIT(1) -+#define BIT_CNTD16V_EN_8822B BIT(0) -+ -+/* 2 REG_SYS_EEPROM_CTRL_8822B */ -+ -+#define BIT_SHIFT_VPDIDX_8822B 8 -+#define BIT_MASK_VPDIDX_8822B 0xff -+#define BIT_VPDIDX_8822B(x) \ -+ (((x) & BIT_MASK_VPDIDX_8822B) << BIT_SHIFT_VPDIDX_8822B) -+#define BITS_VPDIDX_8822B (BIT_MASK_VPDIDX_8822B << BIT_SHIFT_VPDIDX_8822B) -+#define BIT_CLEAR_VPDIDX_8822B(x) ((x) & (~BITS_VPDIDX_8822B)) -+#define BIT_GET_VPDIDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_VPDIDX_8822B) & BIT_MASK_VPDIDX_8822B) -+#define BIT_SET_VPDIDX_8822B(x, v) \ -+ (BIT_CLEAR_VPDIDX_8822B(x) | BIT_VPDIDX_8822B(v)) -+ -+#define BIT_SHIFT_EEM1_0_8822B 6 -+#define BIT_MASK_EEM1_0_8822B 0x3 -+#define BIT_EEM1_0_8822B(x) \ -+ (((x) & BIT_MASK_EEM1_0_8822B) << BIT_SHIFT_EEM1_0_8822B) -+#define BITS_EEM1_0_8822B (BIT_MASK_EEM1_0_8822B << BIT_SHIFT_EEM1_0_8822B) -+#define BIT_CLEAR_EEM1_0_8822B(x) ((x) & (~BITS_EEM1_0_8822B)) -+#define BIT_GET_EEM1_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_EEM1_0_8822B) & BIT_MASK_EEM1_0_8822B) -+#define BIT_SET_EEM1_0_8822B(x, v) \ -+ (BIT_CLEAR_EEM1_0_8822B(x) | BIT_EEM1_0_8822B(v)) -+ -+#define BIT_AUTOLOAD_SUS_8822B BIT(5) -+#define BIT_EERPOMSEL_8822B BIT(4) -+#define BIT_EECS_V1_8822B BIT(3) -+#define BIT_EESK_V1_8822B BIT(2) -+#define BIT_EEDI_V1_8822B BIT(1) -+#define BIT_EEDO_V1_8822B BIT(0) -+ -+/* 2 REG_EE_VPD_8822B */ -+ -+#define BIT_SHIFT_VPD_DATA_8822B 0 -+#define BIT_MASK_VPD_DATA_8822B 0xffffffffL -+#define BIT_VPD_DATA_8822B(x) \ -+ (((x) & BIT_MASK_VPD_DATA_8822B) << BIT_SHIFT_VPD_DATA_8822B) -+#define BITS_VPD_DATA_8822B \ -+ (BIT_MASK_VPD_DATA_8822B << BIT_SHIFT_VPD_DATA_8822B) -+#define BIT_CLEAR_VPD_DATA_8822B(x) ((x) & (~BITS_VPD_DATA_8822B)) -+#define BIT_GET_VPD_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_VPD_DATA_8822B) & BIT_MASK_VPD_DATA_8822B) -+#define BIT_SET_VPD_DATA_8822B(x, v) \ -+ (BIT_CLEAR_VPD_DATA_8822B(x) | BIT_VPD_DATA_8822B(v)) -+ -+/* 2 REG_SYS_SWR_CTRL1_8822B */ -+#define BIT_C2_L_BIT0_8822B BIT(31) -+ -+#define BIT_SHIFT_C1_L_8822B 29 -+#define BIT_MASK_C1_L_8822B 0x3 -+#define BIT_C1_L_8822B(x) (((x) & BIT_MASK_C1_L_8822B) << BIT_SHIFT_C1_L_8822B) -+#define BITS_C1_L_8822B (BIT_MASK_C1_L_8822B << BIT_SHIFT_C1_L_8822B) -+#define BIT_CLEAR_C1_L_8822B(x) ((x) & (~BITS_C1_L_8822B)) -+#define BIT_GET_C1_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_C1_L_8822B) & BIT_MASK_C1_L_8822B) -+#define BIT_SET_C1_L_8822B(x, v) (BIT_CLEAR_C1_L_8822B(x) | BIT_C1_L_8822B(v)) -+ -+#define BIT_SHIFT_REG_FREQ_L_8822B 25 -+#define BIT_MASK_REG_FREQ_L_8822B 0x7 -+#define BIT_REG_FREQ_L_8822B(x) \ -+ (((x) & BIT_MASK_REG_FREQ_L_8822B) << BIT_SHIFT_REG_FREQ_L_8822B) -+#define BITS_REG_FREQ_L_8822B \ -+ (BIT_MASK_REG_FREQ_L_8822B << BIT_SHIFT_REG_FREQ_L_8822B) -+#define BIT_CLEAR_REG_FREQ_L_8822B(x) ((x) & (~BITS_REG_FREQ_L_8822B)) -+#define BIT_GET_REG_FREQ_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_FREQ_L_8822B) & BIT_MASK_REG_FREQ_L_8822B) -+#define BIT_SET_REG_FREQ_L_8822B(x, v) \ -+ (BIT_CLEAR_REG_FREQ_L_8822B(x) | BIT_REG_FREQ_L_8822B(v)) -+ -+#define BIT_REG_EN_DUTY_8822B BIT(24) -+ -+#define BIT_SHIFT_REG_MODE_8822B 22 -+#define BIT_MASK_REG_MODE_8822B 0x3 -+#define BIT_REG_MODE_8822B(x) \ -+ (((x) & BIT_MASK_REG_MODE_8822B) << BIT_SHIFT_REG_MODE_8822B) -+#define BITS_REG_MODE_8822B \ -+ (BIT_MASK_REG_MODE_8822B << BIT_SHIFT_REG_MODE_8822B) -+#define BIT_CLEAR_REG_MODE_8822B(x) ((x) & (~BITS_REG_MODE_8822B)) -+#define BIT_GET_REG_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_MODE_8822B) & BIT_MASK_REG_MODE_8822B) -+#define BIT_SET_REG_MODE_8822B(x, v) \ -+ (BIT_CLEAR_REG_MODE_8822B(x) | BIT_REG_MODE_8822B(v)) -+ -+#define BIT_REG_EN_SP_8822B BIT(21) -+#define BIT_REG_AUTO_L_8822B BIT(20) -+#define BIT_SW18_SELD_BIT0_8822B BIT(19) -+#define BIT_SW18_POWOCP_8822B BIT(18) -+ -+#define BIT_SHIFT_OCP_L1_8822B 15 -+#define BIT_MASK_OCP_L1_8822B 0x7 -+#define BIT_OCP_L1_8822B(x) \ -+ (((x) & BIT_MASK_OCP_L1_8822B) << BIT_SHIFT_OCP_L1_8822B) -+#define BITS_OCP_L1_8822B (BIT_MASK_OCP_L1_8822B << BIT_SHIFT_OCP_L1_8822B) -+#define BIT_CLEAR_OCP_L1_8822B(x) ((x) & (~BITS_OCP_L1_8822B)) -+#define BIT_GET_OCP_L1_8822B(x) \ -+ (((x) >> BIT_SHIFT_OCP_L1_8822B) & BIT_MASK_OCP_L1_8822B) -+#define BIT_SET_OCP_L1_8822B(x, v) \ -+ (BIT_CLEAR_OCP_L1_8822B(x) | BIT_OCP_L1_8822B(v)) -+ -+#define BIT_SHIFT_CF_L_8822B 13 -+#define BIT_MASK_CF_L_8822B 0x3 -+#define BIT_CF_L_8822B(x) (((x) & BIT_MASK_CF_L_8822B) << BIT_SHIFT_CF_L_8822B) -+#define BITS_CF_L_8822B (BIT_MASK_CF_L_8822B << BIT_SHIFT_CF_L_8822B) -+#define BIT_CLEAR_CF_L_8822B(x) ((x) & (~BITS_CF_L_8822B)) -+#define BIT_GET_CF_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_CF_L_8822B) & BIT_MASK_CF_L_8822B) -+#define BIT_SET_CF_L_8822B(x, v) (BIT_CLEAR_CF_L_8822B(x) | BIT_CF_L_8822B(v)) -+ -+#define BIT_SW18_FPWM_8822B BIT(11) -+#define BIT_SW18_SWEN_8822B BIT(9) -+#define BIT_SW18_LDEN_8822B BIT(8) -+#define BIT_MAC_ID_EN_8822B BIT(7) -+#define BIT_AFE_BGEN_8822B BIT(0) -+ -+/* 2 REG_SYS_SWR_CTRL2_8822B */ -+#define BIT_POW_ZCD_L_8822B BIT(31) -+#define BIT_AUTOZCD_L_8822B BIT(30) -+ -+#define BIT_SHIFT_REG_DELAY_8822B 28 -+#define BIT_MASK_REG_DELAY_8822B 0x3 -+#define BIT_REG_DELAY_8822B(x) \ -+ (((x) & BIT_MASK_REG_DELAY_8822B) << BIT_SHIFT_REG_DELAY_8822B) -+#define BITS_REG_DELAY_8822B \ -+ (BIT_MASK_REG_DELAY_8822B << BIT_SHIFT_REG_DELAY_8822B) -+#define BIT_CLEAR_REG_DELAY_8822B(x) ((x) & (~BITS_REG_DELAY_8822B)) -+#define BIT_GET_REG_DELAY_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_DELAY_8822B) & BIT_MASK_REG_DELAY_8822B) -+#define BIT_SET_REG_DELAY_8822B(x, v) \ -+ (BIT_CLEAR_REG_DELAY_8822B(x) | BIT_REG_DELAY_8822B(v)) -+ -+#define BIT_SHIFT_V15ADJ_L1_V1_8822B 24 -+#define BIT_MASK_V15ADJ_L1_V1_8822B 0x7 -+#define BIT_V15ADJ_L1_V1_8822B(x) \ -+ (((x) & BIT_MASK_V15ADJ_L1_V1_8822B) << BIT_SHIFT_V15ADJ_L1_V1_8822B) -+#define BITS_V15ADJ_L1_V1_8822B \ -+ (BIT_MASK_V15ADJ_L1_V1_8822B << BIT_SHIFT_V15ADJ_L1_V1_8822B) -+#define BIT_CLEAR_V15ADJ_L1_V1_8822B(x) ((x) & (~BITS_V15ADJ_L1_V1_8822B)) -+#define BIT_GET_V15ADJ_L1_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L1_V1_8822B) & BIT_MASK_V15ADJ_L1_V1_8822B) -+#define BIT_SET_V15ADJ_L1_V1_8822B(x, v) \ -+ (BIT_CLEAR_V15ADJ_L1_V1_8822B(x) | BIT_V15ADJ_L1_V1_8822B(v)) -+ -+#define BIT_SHIFT_VOL_L1_V1_8822B 20 -+#define BIT_MASK_VOL_L1_V1_8822B 0xf -+#define BIT_VOL_L1_V1_8822B(x) \ -+ (((x) & BIT_MASK_VOL_L1_V1_8822B) << BIT_SHIFT_VOL_L1_V1_8822B) -+#define BITS_VOL_L1_V1_8822B \ -+ (BIT_MASK_VOL_L1_V1_8822B << BIT_SHIFT_VOL_L1_V1_8822B) -+#define BIT_CLEAR_VOL_L1_V1_8822B(x) ((x) & (~BITS_VOL_L1_V1_8822B)) -+#define BIT_GET_VOL_L1_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_VOL_L1_V1_8822B) & BIT_MASK_VOL_L1_V1_8822B) -+#define BIT_SET_VOL_L1_V1_8822B(x, v) \ -+ (BIT_CLEAR_VOL_L1_V1_8822B(x) | BIT_VOL_L1_V1_8822B(v)) -+ -+#define BIT_SHIFT_IN_L1_V1_8822B 17 -+#define BIT_MASK_IN_L1_V1_8822B 0x7 -+#define BIT_IN_L1_V1_8822B(x) \ -+ (((x) & BIT_MASK_IN_L1_V1_8822B) << BIT_SHIFT_IN_L1_V1_8822B) -+#define BITS_IN_L1_V1_8822B \ -+ (BIT_MASK_IN_L1_V1_8822B << BIT_SHIFT_IN_L1_V1_8822B) -+#define BIT_CLEAR_IN_L1_V1_8822B(x) ((x) & (~BITS_IN_L1_V1_8822B)) -+#define BIT_GET_IN_L1_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_IN_L1_V1_8822B) & BIT_MASK_IN_L1_V1_8822B) -+#define BIT_SET_IN_L1_V1_8822B(x, v) \ -+ (BIT_CLEAR_IN_L1_V1_8822B(x) | BIT_IN_L1_V1_8822B(v)) -+ -+#define BIT_SHIFT_TBOX_L1_8822B 15 -+#define BIT_MASK_TBOX_L1_8822B 0x3 -+#define BIT_TBOX_L1_8822B(x) \ -+ (((x) & BIT_MASK_TBOX_L1_8822B) << BIT_SHIFT_TBOX_L1_8822B) -+#define BITS_TBOX_L1_8822B (BIT_MASK_TBOX_L1_8822B << BIT_SHIFT_TBOX_L1_8822B) -+#define BIT_CLEAR_TBOX_L1_8822B(x) ((x) & (~BITS_TBOX_L1_8822B)) -+#define BIT_GET_TBOX_L1_8822B(x) \ -+ (((x) >> BIT_SHIFT_TBOX_L1_8822B) & BIT_MASK_TBOX_L1_8822B) -+#define BIT_SET_TBOX_L1_8822B(x, v) \ -+ (BIT_CLEAR_TBOX_L1_8822B(x) | BIT_TBOX_L1_8822B(v)) -+ -+#define BIT_SW18_SEL_8822B BIT(13) -+ -+/* 2 REG_NOT_VALID_8822B */ -+#define BIT_SW18_SD_8822B BIT(10) -+ -+#define BIT_SHIFT_R3_L_8822B 7 -+#define BIT_MASK_R3_L_8822B 0x3 -+#define BIT_R3_L_8822B(x) (((x) & BIT_MASK_R3_L_8822B) << BIT_SHIFT_R3_L_8822B) -+#define BITS_R3_L_8822B (BIT_MASK_R3_L_8822B << BIT_SHIFT_R3_L_8822B) -+#define BIT_CLEAR_R3_L_8822B(x) ((x) & (~BITS_R3_L_8822B)) -+#define BIT_GET_R3_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_R3_L_8822B) & BIT_MASK_R3_L_8822B) -+#define BIT_SET_R3_L_8822B(x, v) (BIT_CLEAR_R3_L_8822B(x) | BIT_R3_L_8822B(v)) -+ -+#define BIT_SHIFT_SW18_R2_8822B 5 -+#define BIT_MASK_SW18_R2_8822B 0x3 -+#define BIT_SW18_R2_8822B(x) \ -+ (((x) & BIT_MASK_SW18_R2_8822B) << BIT_SHIFT_SW18_R2_8822B) -+#define BITS_SW18_R2_8822B (BIT_MASK_SW18_R2_8822B << BIT_SHIFT_SW18_R2_8822B) -+#define BIT_CLEAR_SW18_R2_8822B(x) ((x) & (~BITS_SW18_R2_8822B)) -+#define BIT_GET_SW18_R2_8822B(x) \ -+ (((x) >> BIT_SHIFT_SW18_R2_8822B) & BIT_MASK_SW18_R2_8822B) -+#define BIT_SET_SW18_R2_8822B(x, v) \ -+ (BIT_CLEAR_SW18_R2_8822B(x) | BIT_SW18_R2_8822B(v)) -+ -+#define BIT_SHIFT_SW18_R1_8822B 3 -+#define BIT_MASK_SW18_R1_8822B 0x3 -+#define BIT_SW18_R1_8822B(x) \ -+ (((x) & BIT_MASK_SW18_R1_8822B) << BIT_SHIFT_SW18_R1_8822B) -+#define BITS_SW18_R1_8822B (BIT_MASK_SW18_R1_8822B << BIT_SHIFT_SW18_R1_8822B) -+#define BIT_CLEAR_SW18_R1_8822B(x) ((x) & (~BITS_SW18_R1_8822B)) -+#define BIT_GET_SW18_R1_8822B(x) \ -+ (((x) >> BIT_SHIFT_SW18_R1_8822B) & BIT_MASK_SW18_R1_8822B) -+#define BIT_SET_SW18_R1_8822B(x, v) \ -+ (BIT_CLEAR_SW18_R1_8822B(x) | BIT_SW18_R1_8822B(v)) -+ -+#define BIT_SHIFT_C3_L_C3_8822B 1 -+#define BIT_MASK_C3_L_C3_8822B 0x3 -+#define BIT_C3_L_C3_8822B(x) \ -+ (((x) & BIT_MASK_C3_L_C3_8822B) << BIT_SHIFT_C3_L_C3_8822B) -+#define BITS_C3_L_C3_8822B (BIT_MASK_C3_L_C3_8822B << BIT_SHIFT_C3_L_C3_8822B) -+#define BIT_CLEAR_C3_L_C3_8822B(x) ((x) & (~BITS_C3_L_C3_8822B)) -+#define BIT_GET_C3_L_C3_8822B(x) \ -+ (((x) >> BIT_SHIFT_C3_L_C3_8822B) & BIT_MASK_C3_L_C3_8822B) -+#define BIT_SET_C3_L_C3_8822B(x, v) \ -+ (BIT_CLEAR_C3_L_C3_8822B(x) | BIT_C3_L_C3_8822B(v)) -+ -+#define BIT_C2_L_BIT1_8822B BIT(0) -+ -+/* 2 REG_SYS_SWR_CTRL3_8822B */ -+#define BIT_SPS18_OCP_DIS_8822B BIT(31) -+ -+#define BIT_SHIFT_SPS18_OCP_TH_8822B 16 -+#define BIT_MASK_SPS18_OCP_TH_8822B 0x7fff -+#define BIT_SPS18_OCP_TH_8822B(x) \ -+ (((x) & BIT_MASK_SPS18_OCP_TH_8822B) << BIT_SHIFT_SPS18_OCP_TH_8822B) -+#define BITS_SPS18_OCP_TH_8822B \ -+ (BIT_MASK_SPS18_OCP_TH_8822B << BIT_SHIFT_SPS18_OCP_TH_8822B) -+#define BIT_CLEAR_SPS18_OCP_TH_8822B(x) ((x) & (~BITS_SPS18_OCP_TH_8822B)) -+#define BIT_GET_SPS18_OCP_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_SPS18_OCP_TH_8822B) & BIT_MASK_SPS18_OCP_TH_8822B) -+#define BIT_SET_SPS18_OCP_TH_8822B(x, v) \ -+ (BIT_CLEAR_SPS18_OCP_TH_8822B(x) | BIT_SPS18_OCP_TH_8822B(v)) -+ -+#define BIT_SHIFT_OCP_WINDOW_8822B 0 -+#define BIT_MASK_OCP_WINDOW_8822B 0xffff -+#define BIT_OCP_WINDOW_8822B(x) \ -+ (((x) & BIT_MASK_OCP_WINDOW_8822B) << BIT_SHIFT_OCP_WINDOW_8822B) -+#define BITS_OCP_WINDOW_8822B \ -+ (BIT_MASK_OCP_WINDOW_8822B << BIT_SHIFT_OCP_WINDOW_8822B) -+#define BIT_CLEAR_OCP_WINDOW_8822B(x) ((x) & (~BITS_OCP_WINDOW_8822B)) -+#define BIT_GET_OCP_WINDOW_8822B(x) \ -+ (((x) >> BIT_SHIFT_OCP_WINDOW_8822B) & BIT_MASK_OCP_WINDOW_8822B) -+#define BIT_SET_OCP_WINDOW_8822B(x, v) \ -+ (BIT_CLEAR_OCP_WINDOW_8822B(x) | BIT_OCP_WINDOW_8822B(v)) -+ -+/* 2 REG_RSV_CTRL_8822B */ -+#define BIT_HREG_DBG_8822B BIT(23) -+#define BIT_WLMCUIOIF_8822B BIT(8) -+#define BIT_LOCK_ALL_EN_8822B BIT(7) -+#define BIT_R_DIS_PRST_8822B BIT(6) -+#define BIT_WLOCK_1C_B6_8822B BIT(5) -+#define BIT_WLOCK_40_8822B BIT(4) -+#define BIT_WLOCK_08_8822B BIT(3) -+#define BIT_WLOCK_04_8822B BIT(2) -+#define BIT_WLOCK_00_8822B BIT(1) -+#define BIT_WLOCK_ALL_8822B BIT(0) -+ -+/* 2 REG_RF_CTRL_8822B */ -+#define BIT_RF_SDMRSTB_8822B BIT(2) -+#define BIT_RF_RSTB_8822B BIT(1) -+#define BIT_RF_EN_8822B BIT(0) -+ -+/* 2 REG_AFE_LDO_CTRL_8822B */ -+ -+#define BIT_SHIFT_LPLDH12_RSV_8822B 29 -+#define BIT_MASK_LPLDH12_RSV_8822B 0x7 -+#define BIT_LPLDH12_RSV_8822B(x) \ -+ (((x) & BIT_MASK_LPLDH12_RSV_8822B) << BIT_SHIFT_LPLDH12_RSV_8822B) -+#define BITS_LPLDH12_RSV_8822B \ -+ (BIT_MASK_LPLDH12_RSV_8822B << BIT_SHIFT_LPLDH12_RSV_8822B) -+#define BIT_CLEAR_LPLDH12_RSV_8822B(x) ((x) & (~BITS_LPLDH12_RSV_8822B)) -+#define BIT_GET_LPLDH12_RSV_8822B(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_RSV_8822B) & BIT_MASK_LPLDH12_RSV_8822B) -+#define BIT_SET_LPLDH12_RSV_8822B(x, v) \ -+ (BIT_CLEAR_LPLDH12_RSV_8822B(x) | BIT_LPLDH12_RSV_8822B(v)) -+ -+#define BIT_LPLDH12_SLP_8822B BIT(28) -+ -+#define BIT_SHIFT_LPLDH12_VADJ_8822B 24 -+#define BIT_MASK_LPLDH12_VADJ_8822B 0xf -+#define BIT_LPLDH12_VADJ_8822B(x) \ -+ (((x) & BIT_MASK_LPLDH12_VADJ_8822B) << BIT_SHIFT_LPLDH12_VADJ_8822B) -+#define BITS_LPLDH12_VADJ_8822B \ -+ (BIT_MASK_LPLDH12_VADJ_8822B << BIT_SHIFT_LPLDH12_VADJ_8822B) -+#define BIT_CLEAR_LPLDH12_VADJ_8822B(x) ((x) & (~BITS_LPLDH12_VADJ_8822B)) -+#define BIT_GET_LPLDH12_VADJ_8822B(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_VADJ_8822B) & BIT_MASK_LPLDH12_VADJ_8822B) -+#define BIT_SET_LPLDH12_VADJ_8822B(x, v) \ -+ (BIT_CLEAR_LPLDH12_VADJ_8822B(x) | BIT_LPLDH12_VADJ_8822B(v)) -+ -+#define BIT_LDH12_EN_8822B BIT(16) -+#define BIT_WLBBOFF_BIG_PWC_EN_8822B BIT(14) -+#define BIT_WLBBOFF_SMALL_PWC_EN_8822B BIT(13) -+#define BIT_WLMACOFF_BIG_PWC_EN_8822B BIT(12) -+#define BIT_WLPON_PWC_EN_8822B BIT(11) -+#define BIT_POW_REGU_P1_8822B BIT(10) -+#define BIT_LDOV12W_EN_8822B BIT(8) -+#define BIT_EX_XTAL_DRV_DIGI_8822B BIT(7) -+#define BIT_EX_XTAL_DRV_USB_8822B BIT(6) -+#define BIT_EX_XTAL_DRV_AFE_8822B BIT(5) -+#define BIT_EX_XTAL_DRV_RF2_8822B BIT(4) -+#define BIT_EX_XTAL_DRV_RF1_8822B BIT(3) -+#define BIT_POW_REGU_P0_8822B BIT(2) -+ -+/* 2 REG_NOT_VALID_8822B */ -+#define BIT_POW_PLL_LDO_8822B BIT(0) -+ -+/* 2 REG_AFE_CTRL1_8822B */ -+#define BIT_AGPIO_GPE_8822B BIT(31) -+ -+#define BIT_SHIFT_XTAL_CAP_XI_8822B 25 -+#define BIT_MASK_XTAL_CAP_XI_8822B 0x3f -+#define BIT_XTAL_CAP_XI_8822B(x) \ -+ (((x) & BIT_MASK_XTAL_CAP_XI_8822B) << BIT_SHIFT_XTAL_CAP_XI_8822B) -+#define BITS_XTAL_CAP_XI_8822B \ -+ (BIT_MASK_XTAL_CAP_XI_8822B << BIT_SHIFT_XTAL_CAP_XI_8822B) -+#define BIT_CLEAR_XTAL_CAP_XI_8822B(x) ((x) & (~BITS_XTAL_CAP_XI_8822B)) -+#define BIT_GET_XTAL_CAP_XI_8822B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CAP_XI_8822B) & BIT_MASK_XTAL_CAP_XI_8822B) -+#define BIT_SET_XTAL_CAP_XI_8822B(x, v) \ -+ (BIT_CLEAR_XTAL_CAP_XI_8822B(x) | BIT_XTAL_CAP_XI_8822B(v)) -+ -+#define BIT_SHIFT_XTAL_DRV_DIGI_8822B 23 -+#define BIT_MASK_XTAL_DRV_DIGI_8822B 0x3 -+#define BIT_XTAL_DRV_DIGI_8822B(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_DIGI_8822B) << BIT_SHIFT_XTAL_DRV_DIGI_8822B) -+#define BITS_XTAL_DRV_DIGI_8822B \ -+ (BIT_MASK_XTAL_DRV_DIGI_8822B << BIT_SHIFT_XTAL_DRV_DIGI_8822B) -+#define BIT_CLEAR_XTAL_DRV_DIGI_8822B(x) ((x) & (~BITS_XTAL_DRV_DIGI_8822B)) -+#define BIT_GET_XTAL_DRV_DIGI_8822B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_DIGI_8822B) & BIT_MASK_XTAL_DRV_DIGI_8822B) -+#define BIT_SET_XTAL_DRV_DIGI_8822B(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_DIGI_8822B(x) | BIT_XTAL_DRV_DIGI_8822B(v)) -+ -+#define BIT_XTAL_DRV_USB_BIT1_8822B BIT(22) -+ -+#define BIT_SHIFT_MAC_CLK_SEL_8822B 20 -+#define BIT_MASK_MAC_CLK_SEL_8822B 0x3 -+#define BIT_MAC_CLK_SEL_8822B(x) \ -+ (((x) & BIT_MASK_MAC_CLK_SEL_8822B) << BIT_SHIFT_MAC_CLK_SEL_8822B) -+#define BITS_MAC_CLK_SEL_8822B \ -+ (BIT_MASK_MAC_CLK_SEL_8822B << BIT_SHIFT_MAC_CLK_SEL_8822B) -+#define BIT_CLEAR_MAC_CLK_SEL_8822B(x) ((x) & (~BITS_MAC_CLK_SEL_8822B)) -+#define BIT_GET_MAC_CLK_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_MAC_CLK_SEL_8822B) & BIT_MASK_MAC_CLK_SEL_8822B) -+#define BIT_SET_MAC_CLK_SEL_8822B(x, v) \ -+ (BIT_CLEAR_MAC_CLK_SEL_8822B(x) | BIT_MAC_CLK_SEL_8822B(v)) -+ -+#define BIT_XTAL_DRV_USB_BIT0_8822B BIT(19) -+ -+#define BIT_SHIFT_XTAL_DRV_AFE_8822B 17 -+#define BIT_MASK_XTAL_DRV_AFE_8822B 0x3 -+#define BIT_XTAL_DRV_AFE_8822B(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_AFE_8822B) << BIT_SHIFT_XTAL_DRV_AFE_8822B) -+#define BITS_XTAL_DRV_AFE_8822B \ -+ (BIT_MASK_XTAL_DRV_AFE_8822B << BIT_SHIFT_XTAL_DRV_AFE_8822B) -+#define BIT_CLEAR_XTAL_DRV_AFE_8822B(x) ((x) & (~BITS_XTAL_DRV_AFE_8822B)) -+#define BIT_GET_XTAL_DRV_AFE_8822B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_AFE_8822B) & BIT_MASK_XTAL_DRV_AFE_8822B) -+#define BIT_SET_XTAL_DRV_AFE_8822B(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_AFE_8822B(x) | BIT_XTAL_DRV_AFE_8822B(v)) -+ -+#define BIT_SHIFT_XTAL_DRV_RF2_8822B 15 -+#define BIT_MASK_XTAL_DRV_RF2_8822B 0x3 -+#define BIT_XTAL_DRV_RF2_8822B(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF2_8822B) << BIT_SHIFT_XTAL_DRV_RF2_8822B) -+#define BITS_XTAL_DRV_RF2_8822B \ -+ (BIT_MASK_XTAL_DRV_RF2_8822B << BIT_SHIFT_XTAL_DRV_RF2_8822B) -+#define BIT_CLEAR_XTAL_DRV_RF2_8822B(x) ((x) & (~BITS_XTAL_DRV_RF2_8822B)) -+#define BIT_GET_XTAL_DRV_RF2_8822B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF2_8822B) & BIT_MASK_XTAL_DRV_RF2_8822B) -+#define BIT_SET_XTAL_DRV_RF2_8822B(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF2_8822B(x) | BIT_XTAL_DRV_RF2_8822B(v)) -+ -+#define BIT_SHIFT_XTAL_DRV_RF1_8822B 13 -+#define BIT_MASK_XTAL_DRV_RF1_8822B 0x3 -+#define BIT_XTAL_DRV_RF1_8822B(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF1_8822B) << BIT_SHIFT_XTAL_DRV_RF1_8822B) -+#define BITS_XTAL_DRV_RF1_8822B \ -+ (BIT_MASK_XTAL_DRV_RF1_8822B << BIT_SHIFT_XTAL_DRV_RF1_8822B) -+#define BIT_CLEAR_XTAL_DRV_RF1_8822B(x) ((x) & (~BITS_XTAL_DRV_RF1_8822B)) -+#define BIT_GET_XTAL_DRV_RF1_8822B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF1_8822B) & BIT_MASK_XTAL_DRV_RF1_8822B) -+#define BIT_SET_XTAL_DRV_RF1_8822B(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF1_8822B(x) | BIT_XTAL_DRV_RF1_8822B(v)) -+ -+#define BIT_XTAL_DELAY_DIGI_8822B BIT(12) -+#define BIT_XTAL_DELAY_USB_8822B BIT(11) -+#define BIT_XTAL_DELAY_AFE_8822B BIT(10) -+ -+#define BIT_SHIFT_XTAL_LDO_VREF_8822B 7 -+#define BIT_MASK_XTAL_LDO_VREF_8822B 0x7 -+#define BIT_XTAL_LDO_VREF_8822B(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_VREF_8822B) << BIT_SHIFT_XTAL_LDO_VREF_8822B) -+#define BITS_XTAL_LDO_VREF_8822B \ -+ (BIT_MASK_XTAL_LDO_VREF_8822B << BIT_SHIFT_XTAL_LDO_VREF_8822B) -+#define BIT_CLEAR_XTAL_LDO_VREF_8822B(x) ((x) & (~BITS_XTAL_LDO_VREF_8822B)) -+#define BIT_GET_XTAL_LDO_VREF_8822B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_VREF_8822B) & BIT_MASK_XTAL_LDO_VREF_8822B) -+#define BIT_SET_XTAL_LDO_VREF_8822B(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_VREF_8822B(x) | BIT_XTAL_LDO_VREF_8822B(v)) -+ -+#define BIT_XTAL_XQSEL_RF_8822B BIT(6) -+#define BIT_XTAL_XQSEL_8822B BIT(5) -+ -+#define BIT_SHIFT_XTAL_GMN_V2_8822B 3 -+#define BIT_MASK_XTAL_GMN_V2_8822B 0x3 -+#define BIT_XTAL_GMN_V2_8822B(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_V2_8822B) << BIT_SHIFT_XTAL_GMN_V2_8822B) -+#define BITS_XTAL_GMN_V2_8822B \ -+ (BIT_MASK_XTAL_GMN_V2_8822B << BIT_SHIFT_XTAL_GMN_V2_8822B) -+#define BIT_CLEAR_XTAL_GMN_V2_8822B(x) ((x) & (~BITS_XTAL_GMN_V2_8822B)) -+#define BIT_GET_XTAL_GMN_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_V2_8822B) & BIT_MASK_XTAL_GMN_V2_8822B) -+#define BIT_SET_XTAL_GMN_V2_8822B(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_V2_8822B(x) | BIT_XTAL_GMN_V2_8822B(v)) -+ -+#define BIT_SHIFT_XTAL_GMP_V2_8822B 1 -+#define BIT_MASK_XTAL_GMP_V2_8822B 0x3 -+#define BIT_XTAL_GMP_V2_8822B(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_V2_8822B) << BIT_SHIFT_XTAL_GMP_V2_8822B) -+#define BITS_XTAL_GMP_V2_8822B \ -+ (BIT_MASK_XTAL_GMP_V2_8822B << BIT_SHIFT_XTAL_GMP_V2_8822B) -+#define BIT_CLEAR_XTAL_GMP_V2_8822B(x) ((x) & (~BITS_XTAL_GMP_V2_8822B)) -+#define BIT_GET_XTAL_GMP_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_V2_8822B) & BIT_MASK_XTAL_GMP_V2_8822B) -+#define BIT_SET_XTAL_GMP_V2_8822B(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_V2_8822B(x) | BIT_XTAL_GMP_V2_8822B(v)) -+ -+#define BIT_XTAL_EN_8822B BIT(0) -+ -+/* 2 REG_AFE_CTRL2_8822B */ -+ -+#define BIT_SHIFT_REG_C3_V4_8822B 30 -+#define BIT_MASK_REG_C3_V4_8822B 0x3 -+#define BIT_REG_C3_V4_8822B(x) \ -+ (((x) & BIT_MASK_REG_C3_V4_8822B) << BIT_SHIFT_REG_C3_V4_8822B) -+#define BITS_REG_C3_V4_8822B \ -+ (BIT_MASK_REG_C3_V4_8822B << BIT_SHIFT_REG_C3_V4_8822B) -+#define BIT_CLEAR_REG_C3_V4_8822B(x) ((x) & (~BITS_REG_C3_V4_8822B)) -+#define BIT_GET_REG_C3_V4_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_C3_V4_8822B) & BIT_MASK_REG_C3_V4_8822B) -+#define BIT_SET_REG_C3_V4_8822B(x, v) \ -+ (BIT_CLEAR_REG_C3_V4_8822B(x) | BIT_REG_C3_V4_8822B(v)) -+ -+#define BIT_REG_CP_BIT1_8822B BIT(29) -+ -+#define BIT_SHIFT_REG_RS_V4_8822B 26 -+#define BIT_MASK_REG_RS_V4_8822B 0x7 -+#define BIT_REG_RS_V4_8822B(x) \ -+ (((x) & BIT_MASK_REG_RS_V4_8822B) << BIT_SHIFT_REG_RS_V4_8822B) -+#define BITS_REG_RS_V4_8822B \ -+ (BIT_MASK_REG_RS_V4_8822B << BIT_SHIFT_REG_RS_V4_8822B) -+#define BIT_CLEAR_REG_RS_V4_8822B(x) ((x) & (~BITS_REG_RS_V4_8822B)) -+#define BIT_GET_REG_RS_V4_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_RS_V4_8822B) & BIT_MASK_REG_RS_V4_8822B) -+#define BIT_SET_REG_RS_V4_8822B(x, v) \ -+ (BIT_CLEAR_REG_RS_V4_8822B(x) | BIT_REG_RS_V4_8822B(v)) -+ -+#define BIT_SHIFT_REG__CS_8822B 24 -+#define BIT_MASK_REG__CS_8822B 0x3 -+#define BIT_REG__CS_8822B(x) \ -+ (((x) & BIT_MASK_REG__CS_8822B) << BIT_SHIFT_REG__CS_8822B) -+#define BITS_REG__CS_8822B (BIT_MASK_REG__CS_8822B << BIT_SHIFT_REG__CS_8822B) -+#define BIT_CLEAR_REG__CS_8822B(x) ((x) & (~BITS_REG__CS_8822B)) -+#define BIT_GET_REG__CS_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG__CS_8822B) & BIT_MASK_REG__CS_8822B) -+#define BIT_SET_REG__CS_8822B(x, v) \ -+ (BIT_CLEAR_REG__CS_8822B(x) | BIT_REG__CS_8822B(v)) -+ -+#define BIT_SHIFT_REG_CP_OFFSET_8822B 21 -+#define BIT_MASK_REG_CP_OFFSET_8822B 0x7 -+#define BIT_REG_CP_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_REG_CP_OFFSET_8822B) << BIT_SHIFT_REG_CP_OFFSET_8822B) -+#define BITS_REG_CP_OFFSET_8822B \ -+ (BIT_MASK_REG_CP_OFFSET_8822B << BIT_SHIFT_REG_CP_OFFSET_8822B) -+#define BIT_CLEAR_REG_CP_OFFSET_8822B(x) ((x) & (~BITS_REG_CP_OFFSET_8822B)) -+#define BIT_GET_REG_CP_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_OFFSET_8822B) & BIT_MASK_REG_CP_OFFSET_8822B) -+#define BIT_SET_REG_CP_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_REG_CP_OFFSET_8822B(x) | BIT_REG_CP_OFFSET_8822B(v)) -+ -+#define BIT_SHIFT_CP_BIAS_8822B 18 -+#define BIT_MASK_CP_BIAS_8822B 0x7 -+#define BIT_CP_BIAS_8822B(x) \ -+ (((x) & BIT_MASK_CP_BIAS_8822B) << BIT_SHIFT_CP_BIAS_8822B) -+#define BITS_CP_BIAS_8822B (BIT_MASK_CP_BIAS_8822B << BIT_SHIFT_CP_BIAS_8822B) -+#define BIT_CLEAR_CP_BIAS_8822B(x) ((x) & (~BITS_CP_BIAS_8822B)) -+#define BIT_GET_CP_BIAS_8822B(x) \ -+ (((x) >> BIT_SHIFT_CP_BIAS_8822B) & BIT_MASK_CP_BIAS_8822B) -+#define BIT_SET_CP_BIAS_8822B(x, v) \ -+ (BIT_CLEAR_CP_BIAS_8822B(x) | BIT_CP_BIAS_8822B(v)) -+ -+#define BIT_REG_IDOUBLE_V2_8822B BIT(17) -+#define BIT_EN_SYN_8822B BIT(16) -+ -+#define BIT_SHIFT_MCCO_8822B 14 -+#define BIT_MASK_MCCO_8822B 0x3 -+#define BIT_MCCO_8822B(x) (((x) & BIT_MASK_MCCO_8822B) << BIT_SHIFT_MCCO_8822B) -+#define BITS_MCCO_8822B (BIT_MASK_MCCO_8822B << BIT_SHIFT_MCCO_8822B) -+#define BIT_CLEAR_MCCO_8822B(x) ((x) & (~BITS_MCCO_8822B)) -+#define BIT_GET_MCCO_8822B(x) \ -+ (((x) >> BIT_SHIFT_MCCO_8822B) & BIT_MASK_MCCO_8822B) -+#define BIT_SET_MCCO_8822B(x, v) (BIT_CLEAR_MCCO_8822B(x) | BIT_MCCO_8822B(v)) -+ -+#define BIT_SHIFT_REG_LDO_SEL_8822B 12 -+#define BIT_MASK_REG_LDO_SEL_8822B 0x3 -+#define BIT_REG_LDO_SEL_8822B(x) \ -+ (((x) & BIT_MASK_REG_LDO_SEL_8822B) << BIT_SHIFT_REG_LDO_SEL_8822B) -+#define BITS_REG_LDO_SEL_8822B \ -+ (BIT_MASK_REG_LDO_SEL_8822B << BIT_SHIFT_REG_LDO_SEL_8822B) -+#define BIT_CLEAR_REG_LDO_SEL_8822B(x) ((x) & (~BITS_REG_LDO_SEL_8822B)) -+#define BIT_GET_REG_LDO_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_LDO_SEL_8822B) & BIT_MASK_REG_LDO_SEL_8822B) -+#define BIT_SET_REG_LDO_SEL_8822B(x, v) \ -+ (BIT_CLEAR_REG_LDO_SEL_8822B(x) | BIT_REG_LDO_SEL_8822B(v)) -+ -+#define BIT_REG_KVCO_V2_8822B BIT(10) -+#define BIT_AGPIO_GPO_8822B BIT(9) -+ -+#define BIT_SHIFT_AGPIO_DRV_8822B 7 -+#define BIT_MASK_AGPIO_DRV_8822B 0x3 -+#define BIT_AGPIO_DRV_8822B(x) \ -+ (((x) & BIT_MASK_AGPIO_DRV_8822B) << BIT_SHIFT_AGPIO_DRV_8822B) -+#define BITS_AGPIO_DRV_8822B \ -+ (BIT_MASK_AGPIO_DRV_8822B << BIT_SHIFT_AGPIO_DRV_8822B) -+#define BIT_CLEAR_AGPIO_DRV_8822B(x) ((x) & (~BITS_AGPIO_DRV_8822B)) -+#define BIT_GET_AGPIO_DRV_8822B(x) \ -+ (((x) >> BIT_SHIFT_AGPIO_DRV_8822B) & BIT_MASK_AGPIO_DRV_8822B) -+#define BIT_SET_AGPIO_DRV_8822B(x, v) \ -+ (BIT_CLEAR_AGPIO_DRV_8822B(x) | BIT_AGPIO_DRV_8822B(v)) -+ -+#define BIT_SHIFT_XTAL_CAP_XO_8822B 1 -+#define BIT_MASK_XTAL_CAP_XO_8822B 0x3f -+#define BIT_XTAL_CAP_XO_8822B(x) \ -+ (((x) & BIT_MASK_XTAL_CAP_XO_8822B) << BIT_SHIFT_XTAL_CAP_XO_8822B) -+#define BITS_XTAL_CAP_XO_8822B \ -+ (BIT_MASK_XTAL_CAP_XO_8822B << BIT_SHIFT_XTAL_CAP_XO_8822B) -+#define BIT_CLEAR_XTAL_CAP_XO_8822B(x) ((x) & (~BITS_XTAL_CAP_XO_8822B)) -+#define BIT_GET_XTAL_CAP_XO_8822B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CAP_XO_8822B) & BIT_MASK_XTAL_CAP_XO_8822B) -+#define BIT_SET_XTAL_CAP_XO_8822B(x, v) \ -+ (BIT_CLEAR_XTAL_CAP_XO_8822B(x) | BIT_XTAL_CAP_XO_8822B(v)) -+ -+#define BIT_POW_PLL_8822B BIT(0) -+ -+/* 2 REG_AFE_CTRL3_8822B */ -+ -+#define BIT_SHIFT_PS_8822B 7 -+#define BIT_MASK_PS_8822B 0x7 -+#define BIT_PS_8822B(x) (((x) & BIT_MASK_PS_8822B) << BIT_SHIFT_PS_8822B) -+#define BITS_PS_8822B (BIT_MASK_PS_8822B << BIT_SHIFT_PS_8822B) -+#define BIT_CLEAR_PS_8822B(x) ((x) & (~BITS_PS_8822B)) -+#define BIT_GET_PS_8822B(x) (((x) >> BIT_SHIFT_PS_8822B) & BIT_MASK_PS_8822B) -+#define BIT_SET_PS_8822B(x, v) (BIT_CLEAR_PS_8822B(x) | BIT_PS_8822B(v)) -+ -+#define BIT_PSEN_8822B BIT(6) -+#define BIT_DOGENB_8822B BIT(5) -+#define BIT_REG_MBIAS_8822B BIT(4) -+ -+#define BIT_SHIFT_REG_R3_V4_8822B 1 -+#define BIT_MASK_REG_R3_V4_8822B 0x7 -+#define BIT_REG_R3_V4_8822B(x) \ -+ (((x) & BIT_MASK_REG_R3_V4_8822B) << BIT_SHIFT_REG_R3_V4_8822B) -+#define BITS_REG_R3_V4_8822B \ -+ (BIT_MASK_REG_R3_V4_8822B << BIT_SHIFT_REG_R3_V4_8822B) -+#define BIT_CLEAR_REG_R3_V4_8822B(x) ((x) & (~BITS_REG_R3_V4_8822B)) -+#define BIT_GET_REG_R3_V4_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_R3_V4_8822B) & BIT_MASK_REG_R3_V4_8822B) -+#define BIT_SET_REG_R3_V4_8822B(x, v) \ -+ (BIT_CLEAR_REG_R3_V4_8822B(x) | BIT_REG_R3_V4_8822B(v)) -+ -+#define BIT_REG_CP_BIT0_8822B BIT(0) -+ -+/* 2 REG_EFUSE_CTRL_8822B */ -+#define BIT_EF_FLAG_8822B BIT(31) -+ -+#define BIT_SHIFT_EF_PGPD_8822B 28 -+#define BIT_MASK_EF_PGPD_8822B 0x7 -+#define BIT_EF_PGPD_8822B(x) \ -+ (((x) & BIT_MASK_EF_PGPD_8822B) << BIT_SHIFT_EF_PGPD_8822B) -+#define BITS_EF_PGPD_8822B (BIT_MASK_EF_PGPD_8822B << BIT_SHIFT_EF_PGPD_8822B) -+#define BIT_CLEAR_EF_PGPD_8822B(x) ((x) & (~BITS_EF_PGPD_8822B)) -+#define BIT_GET_EF_PGPD_8822B(x) \ -+ (((x) >> BIT_SHIFT_EF_PGPD_8822B) & BIT_MASK_EF_PGPD_8822B) -+#define BIT_SET_EF_PGPD_8822B(x, v) \ -+ (BIT_CLEAR_EF_PGPD_8822B(x) | BIT_EF_PGPD_8822B(v)) -+ -+#define BIT_SHIFT_EF_RDT_8822B 24 -+#define BIT_MASK_EF_RDT_8822B 0xf -+#define BIT_EF_RDT_8822B(x) \ -+ (((x) & BIT_MASK_EF_RDT_8822B) << BIT_SHIFT_EF_RDT_8822B) -+#define BITS_EF_RDT_8822B (BIT_MASK_EF_RDT_8822B << BIT_SHIFT_EF_RDT_8822B) -+#define BIT_CLEAR_EF_RDT_8822B(x) ((x) & (~BITS_EF_RDT_8822B)) -+#define BIT_GET_EF_RDT_8822B(x) \ -+ (((x) >> BIT_SHIFT_EF_RDT_8822B) & BIT_MASK_EF_RDT_8822B) -+#define BIT_SET_EF_RDT_8822B(x, v) \ -+ (BIT_CLEAR_EF_RDT_8822B(x) | BIT_EF_RDT_8822B(v)) -+ -+#define BIT_SHIFT_EF_PGTS_8822B 20 -+#define BIT_MASK_EF_PGTS_8822B 0xf -+#define BIT_EF_PGTS_8822B(x) \ -+ (((x) & BIT_MASK_EF_PGTS_8822B) << BIT_SHIFT_EF_PGTS_8822B) -+#define BITS_EF_PGTS_8822B (BIT_MASK_EF_PGTS_8822B << BIT_SHIFT_EF_PGTS_8822B) -+#define BIT_CLEAR_EF_PGTS_8822B(x) ((x) & (~BITS_EF_PGTS_8822B)) -+#define BIT_GET_EF_PGTS_8822B(x) \ -+ (((x) >> BIT_SHIFT_EF_PGTS_8822B) & BIT_MASK_EF_PGTS_8822B) -+#define BIT_SET_EF_PGTS_8822B(x, v) \ -+ (BIT_CLEAR_EF_PGTS_8822B(x) | BIT_EF_PGTS_8822B(v)) -+ -+#define BIT_EF_PDWN_8822B BIT(19) -+#define BIT_EF_ALDEN_8822B BIT(18) -+ -+#define BIT_SHIFT_EF_ADDR_8822B 8 -+#define BIT_MASK_EF_ADDR_8822B 0x3ff -+#define BIT_EF_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_EF_ADDR_8822B) << BIT_SHIFT_EF_ADDR_8822B) -+#define BITS_EF_ADDR_8822B (BIT_MASK_EF_ADDR_8822B << BIT_SHIFT_EF_ADDR_8822B) -+#define BIT_CLEAR_EF_ADDR_8822B(x) ((x) & (~BITS_EF_ADDR_8822B)) -+#define BIT_GET_EF_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_EF_ADDR_8822B) & BIT_MASK_EF_ADDR_8822B) -+#define BIT_SET_EF_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_EF_ADDR_8822B(x) | BIT_EF_ADDR_8822B(v)) -+ -+#define BIT_SHIFT_EF_DATA_8822B 0 -+#define BIT_MASK_EF_DATA_8822B 0xff -+#define BIT_EF_DATA_8822B(x) \ -+ (((x) & BIT_MASK_EF_DATA_8822B) << BIT_SHIFT_EF_DATA_8822B) -+#define BITS_EF_DATA_8822B (BIT_MASK_EF_DATA_8822B << BIT_SHIFT_EF_DATA_8822B) -+#define BIT_CLEAR_EF_DATA_8822B(x) ((x) & (~BITS_EF_DATA_8822B)) -+#define BIT_GET_EF_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_EF_DATA_8822B) & BIT_MASK_EF_DATA_8822B) -+#define BIT_SET_EF_DATA_8822B(x, v) \ -+ (BIT_CLEAR_EF_DATA_8822B(x) | BIT_EF_DATA_8822B(v)) -+ -+/* 2 REG_LDO_EFUSE_CTRL_8822B */ -+#define BIT_LDOE25_EN_8822B BIT(31) -+ -+#define BIT_SHIFT_LDOE25_V12ADJ_L_8822B 27 -+#define BIT_MASK_LDOE25_V12ADJ_L_8822B 0xf -+#define BIT_LDOE25_V12ADJ_L_8822B(x) \ -+ (((x) & BIT_MASK_LDOE25_V12ADJ_L_8822B) \ -+ << BIT_SHIFT_LDOE25_V12ADJ_L_8822B) -+#define BITS_LDOE25_V12ADJ_L_8822B \ -+ (BIT_MASK_LDOE25_V12ADJ_L_8822B << BIT_SHIFT_LDOE25_V12ADJ_L_8822B) -+#define BIT_CLEAR_LDOE25_V12ADJ_L_8822B(x) ((x) & (~BITS_LDOE25_V12ADJ_L_8822B)) -+#define BIT_GET_LDOE25_V12ADJ_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_LDOE25_V12ADJ_L_8822B) & \ -+ BIT_MASK_LDOE25_V12ADJ_L_8822B) -+#define BIT_SET_LDOE25_V12ADJ_L_8822B(x, v) \ -+ (BIT_CLEAR_LDOE25_V12ADJ_L_8822B(x) | BIT_LDOE25_V12ADJ_L_8822B(v)) -+ -+#define BIT_EF_CRES_SEL_8822B BIT(26) -+ -+#define BIT_SHIFT_EF_SCAN_START_V1_8822B 16 -+#define BIT_MASK_EF_SCAN_START_V1_8822B 0x3ff -+#define BIT_EF_SCAN_START_V1_8822B(x) \ -+ (((x) & BIT_MASK_EF_SCAN_START_V1_8822B) \ -+ << BIT_SHIFT_EF_SCAN_START_V1_8822B) -+#define BITS_EF_SCAN_START_V1_8822B \ -+ (BIT_MASK_EF_SCAN_START_V1_8822B << BIT_SHIFT_EF_SCAN_START_V1_8822B) -+#define BIT_CLEAR_EF_SCAN_START_V1_8822B(x) \ -+ ((x) & (~BITS_EF_SCAN_START_V1_8822B)) -+#define BIT_GET_EF_SCAN_START_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_START_V1_8822B) & \ -+ BIT_MASK_EF_SCAN_START_V1_8822B) -+#define BIT_SET_EF_SCAN_START_V1_8822B(x, v) \ -+ (BIT_CLEAR_EF_SCAN_START_V1_8822B(x) | BIT_EF_SCAN_START_V1_8822B(v)) -+ -+#define BIT_SHIFT_EF_SCAN_END_8822B 12 -+#define BIT_MASK_EF_SCAN_END_8822B 0xf -+#define BIT_EF_SCAN_END_8822B(x) \ -+ (((x) & BIT_MASK_EF_SCAN_END_8822B) << BIT_SHIFT_EF_SCAN_END_8822B) -+#define BITS_EF_SCAN_END_8822B \ -+ (BIT_MASK_EF_SCAN_END_8822B << BIT_SHIFT_EF_SCAN_END_8822B) -+#define BIT_CLEAR_EF_SCAN_END_8822B(x) ((x) & (~BITS_EF_SCAN_END_8822B)) -+#define BIT_GET_EF_SCAN_END_8822B(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_END_8822B) & BIT_MASK_EF_SCAN_END_8822B) -+#define BIT_SET_EF_SCAN_END_8822B(x, v) \ -+ (BIT_CLEAR_EF_SCAN_END_8822B(x) | BIT_EF_SCAN_END_8822B(v)) -+ -+#define BIT_EF_PD_DIS_8822B BIT(11) -+ -+#define BIT_SHIFT_EF_CELL_SEL_8822B 8 -+#define BIT_MASK_EF_CELL_SEL_8822B 0x3 -+#define BIT_EF_CELL_SEL_8822B(x) \ -+ (((x) & BIT_MASK_EF_CELL_SEL_8822B) << BIT_SHIFT_EF_CELL_SEL_8822B) -+#define BITS_EF_CELL_SEL_8822B \ -+ (BIT_MASK_EF_CELL_SEL_8822B << BIT_SHIFT_EF_CELL_SEL_8822B) -+#define BIT_CLEAR_EF_CELL_SEL_8822B(x) ((x) & (~BITS_EF_CELL_SEL_8822B)) -+#define BIT_GET_EF_CELL_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_EF_CELL_SEL_8822B) & BIT_MASK_EF_CELL_SEL_8822B) -+#define BIT_SET_EF_CELL_SEL_8822B(x, v) \ -+ (BIT_CLEAR_EF_CELL_SEL_8822B(x) | BIT_EF_CELL_SEL_8822B(v)) -+ -+#define BIT_EF_TRPT_8822B BIT(7) -+ -+#define BIT_SHIFT_EF_TTHD_8822B 0 -+#define BIT_MASK_EF_TTHD_8822B 0x7f -+#define BIT_EF_TTHD_8822B(x) \ -+ (((x) & BIT_MASK_EF_TTHD_8822B) << BIT_SHIFT_EF_TTHD_8822B) -+#define BITS_EF_TTHD_8822B (BIT_MASK_EF_TTHD_8822B << BIT_SHIFT_EF_TTHD_8822B) -+#define BIT_CLEAR_EF_TTHD_8822B(x) ((x) & (~BITS_EF_TTHD_8822B)) -+#define BIT_GET_EF_TTHD_8822B(x) \ -+ (((x) >> BIT_SHIFT_EF_TTHD_8822B) & BIT_MASK_EF_TTHD_8822B) -+#define BIT_SET_EF_TTHD_8822B(x, v) \ -+ (BIT_CLEAR_EF_TTHD_8822B(x) | BIT_EF_TTHD_8822B(v)) -+ -+/* 2 REG_PWR_OPTION_CTRL_8822B */ -+ -+#define BIT_SHIFT_DBG_SEL_V1_8822B 16 -+#define BIT_MASK_DBG_SEL_V1_8822B 0xff -+#define BIT_DBG_SEL_V1_8822B(x) \ -+ (((x) & BIT_MASK_DBG_SEL_V1_8822B) << BIT_SHIFT_DBG_SEL_V1_8822B) -+#define BITS_DBG_SEL_V1_8822B \ -+ (BIT_MASK_DBG_SEL_V1_8822B << BIT_SHIFT_DBG_SEL_V1_8822B) -+#define BIT_CLEAR_DBG_SEL_V1_8822B(x) ((x) & (~BITS_DBG_SEL_V1_8822B)) -+#define BIT_GET_DBG_SEL_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_V1_8822B) & BIT_MASK_DBG_SEL_V1_8822B) -+#define BIT_SET_DBG_SEL_V1_8822B(x, v) \ -+ (BIT_CLEAR_DBG_SEL_V1_8822B(x) | BIT_DBG_SEL_V1_8822B(v)) -+ -+#define BIT_SHIFT_DBG_SEL_BYTE_8822B 14 -+#define BIT_MASK_DBG_SEL_BYTE_8822B 0x3 -+#define BIT_DBG_SEL_BYTE_8822B(x) \ -+ (((x) & BIT_MASK_DBG_SEL_BYTE_8822B) << BIT_SHIFT_DBG_SEL_BYTE_8822B) -+#define BITS_DBG_SEL_BYTE_8822B \ -+ (BIT_MASK_DBG_SEL_BYTE_8822B << BIT_SHIFT_DBG_SEL_BYTE_8822B) -+#define BIT_CLEAR_DBG_SEL_BYTE_8822B(x) ((x) & (~BITS_DBG_SEL_BYTE_8822B)) -+#define BIT_GET_DBG_SEL_BYTE_8822B(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_BYTE_8822B) & BIT_MASK_DBG_SEL_BYTE_8822B) -+#define BIT_SET_DBG_SEL_BYTE_8822B(x, v) \ -+ (BIT_CLEAR_DBG_SEL_BYTE_8822B(x) | BIT_DBG_SEL_BYTE_8822B(v)) -+ -+#define BIT_SHIFT_STD_L1_V1_8822B 12 -+#define BIT_MASK_STD_L1_V1_8822B 0x3 -+#define BIT_STD_L1_V1_8822B(x) \ -+ (((x) & BIT_MASK_STD_L1_V1_8822B) << BIT_SHIFT_STD_L1_V1_8822B) -+#define BITS_STD_L1_V1_8822B \ -+ (BIT_MASK_STD_L1_V1_8822B << BIT_SHIFT_STD_L1_V1_8822B) -+#define BIT_CLEAR_STD_L1_V1_8822B(x) ((x) & (~BITS_STD_L1_V1_8822B)) -+#define BIT_GET_STD_L1_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_STD_L1_V1_8822B) & BIT_MASK_STD_L1_V1_8822B) -+#define BIT_SET_STD_L1_V1_8822B(x, v) \ -+ (BIT_CLEAR_STD_L1_V1_8822B(x) | BIT_STD_L1_V1_8822B(v)) -+ -+#define BIT_SYSON_DBG_PAD_E2_8822B BIT(11) -+#define BIT_SYSON_LED_PAD_E2_8822B BIT(10) -+#define BIT_SYSON_GPEE_PAD_E2_8822B BIT(9) -+#define BIT_SYSON_PCI_PAD_E2_8822B BIT(8) -+#define BIT_AUTO_SW_LDO_VOL_EN_8822B BIT(7) -+ -+#define BIT_SHIFT_SYSON_SPS0WWV_WT_8822B 4 -+#define BIT_MASK_SYSON_SPS0WWV_WT_8822B 0x3 -+#define BIT_SYSON_SPS0WWV_WT_8822B(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0WWV_WT_8822B) \ -+ << BIT_SHIFT_SYSON_SPS0WWV_WT_8822B) -+#define BITS_SYSON_SPS0WWV_WT_8822B \ -+ (BIT_MASK_SYSON_SPS0WWV_WT_8822B << BIT_SHIFT_SYSON_SPS0WWV_WT_8822B) -+#define BIT_CLEAR_SYSON_SPS0WWV_WT_8822B(x) \ -+ ((x) & (~BITS_SYSON_SPS0WWV_WT_8822B)) -+#define BIT_GET_SYSON_SPS0WWV_WT_8822B(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0WWV_WT_8822B) & \ -+ BIT_MASK_SYSON_SPS0WWV_WT_8822B) -+#define BIT_SET_SYSON_SPS0WWV_WT_8822B(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0WWV_WT_8822B(x) | BIT_SYSON_SPS0WWV_WT_8822B(v)) -+ -+#define BIT_SHIFT_SYSON_SPS0LDO_WT_8822B 2 -+#define BIT_MASK_SYSON_SPS0LDO_WT_8822B 0x3 -+#define BIT_SYSON_SPS0LDO_WT_8822B(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0LDO_WT_8822B) \ -+ << BIT_SHIFT_SYSON_SPS0LDO_WT_8822B) -+#define BITS_SYSON_SPS0LDO_WT_8822B \ -+ (BIT_MASK_SYSON_SPS0LDO_WT_8822B << BIT_SHIFT_SYSON_SPS0LDO_WT_8822B) -+#define BIT_CLEAR_SYSON_SPS0LDO_WT_8822B(x) \ -+ ((x) & (~BITS_SYSON_SPS0LDO_WT_8822B)) -+#define BIT_GET_SYSON_SPS0LDO_WT_8822B(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0LDO_WT_8822B) & \ -+ BIT_MASK_SYSON_SPS0LDO_WT_8822B) -+#define BIT_SET_SYSON_SPS0LDO_WT_8822B(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0LDO_WT_8822B(x) | BIT_SYSON_SPS0LDO_WT_8822B(v)) -+ -+#define BIT_SHIFT_SYSON_RCLK_SCALE_8822B 0 -+#define BIT_MASK_SYSON_RCLK_SCALE_8822B 0x3 -+#define BIT_SYSON_RCLK_SCALE_8822B(x) \ -+ (((x) & BIT_MASK_SYSON_RCLK_SCALE_8822B) \ -+ << BIT_SHIFT_SYSON_RCLK_SCALE_8822B) -+#define BITS_SYSON_RCLK_SCALE_8822B \ -+ (BIT_MASK_SYSON_RCLK_SCALE_8822B << BIT_SHIFT_SYSON_RCLK_SCALE_8822B) -+#define BIT_CLEAR_SYSON_RCLK_SCALE_8822B(x) \ -+ ((x) & (~BITS_SYSON_RCLK_SCALE_8822B)) -+#define BIT_GET_SYSON_RCLK_SCALE_8822B(x) \ -+ (((x) >> BIT_SHIFT_SYSON_RCLK_SCALE_8822B) & \ -+ BIT_MASK_SYSON_RCLK_SCALE_8822B) -+#define BIT_SET_SYSON_RCLK_SCALE_8822B(x, v) \ -+ (BIT_CLEAR_SYSON_RCLK_SCALE_8822B(x) | BIT_SYSON_RCLK_SCALE_8822B(v)) -+ -+/* 2 REG_CAL_TIMER_8822B */ -+ -+#define BIT_SHIFT_MATCH_CNT_8822B 8 -+#define BIT_MASK_MATCH_CNT_8822B 0xff -+#define BIT_MATCH_CNT_8822B(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8822B) << BIT_SHIFT_MATCH_CNT_8822B) -+#define BITS_MATCH_CNT_8822B \ -+ (BIT_MASK_MATCH_CNT_8822B << BIT_SHIFT_MATCH_CNT_8822B) -+#define BIT_CLEAR_MATCH_CNT_8822B(x) ((x) & (~BITS_MATCH_CNT_8822B)) -+#define BIT_GET_MATCH_CNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8822B) & BIT_MASK_MATCH_CNT_8822B) -+#define BIT_SET_MATCH_CNT_8822B(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8822B(x) | BIT_MATCH_CNT_8822B(v)) -+ -+#define BIT_SHIFT_CAL_SCAL_8822B 0 -+#define BIT_MASK_CAL_SCAL_8822B 0xff -+#define BIT_CAL_SCAL_8822B(x) \ -+ (((x) & BIT_MASK_CAL_SCAL_8822B) << BIT_SHIFT_CAL_SCAL_8822B) -+#define BITS_CAL_SCAL_8822B \ -+ (BIT_MASK_CAL_SCAL_8822B << BIT_SHIFT_CAL_SCAL_8822B) -+#define BIT_CLEAR_CAL_SCAL_8822B(x) ((x) & (~BITS_CAL_SCAL_8822B)) -+#define BIT_GET_CAL_SCAL_8822B(x) \ -+ (((x) >> BIT_SHIFT_CAL_SCAL_8822B) & BIT_MASK_CAL_SCAL_8822B) -+#define BIT_SET_CAL_SCAL_8822B(x, v) \ -+ (BIT_CLEAR_CAL_SCAL_8822B(x) | BIT_CAL_SCAL_8822B(v)) -+ -+/* 2 REG_ACLK_MON_8822B */ -+ -+#define BIT_SHIFT_RCLK_MON_8822B 5 -+#define BIT_MASK_RCLK_MON_8822B 0x7ff -+#define BIT_RCLK_MON_8822B(x) \ -+ (((x) & BIT_MASK_RCLK_MON_8822B) << BIT_SHIFT_RCLK_MON_8822B) -+#define BITS_RCLK_MON_8822B \ -+ (BIT_MASK_RCLK_MON_8822B << BIT_SHIFT_RCLK_MON_8822B) -+#define BIT_CLEAR_RCLK_MON_8822B(x) ((x) & (~BITS_RCLK_MON_8822B)) -+#define BIT_GET_RCLK_MON_8822B(x) \ -+ (((x) >> BIT_SHIFT_RCLK_MON_8822B) & BIT_MASK_RCLK_MON_8822B) -+#define BIT_SET_RCLK_MON_8822B(x, v) \ -+ (BIT_CLEAR_RCLK_MON_8822B(x) | BIT_RCLK_MON_8822B(v)) -+ -+#define BIT_CAL_EN_8822B BIT(4) -+ -+#define BIT_SHIFT_DPSTU_8822B 2 -+#define BIT_MASK_DPSTU_8822B 0x3 -+#define BIT_DPSTU_8822B(x) \ -+ (((x) & BIT_MASK_DPSTU_8822B) << BIT_SHIFT_DPSTU_8822B) -+#define BITS_DPSTU_8822B (BIT_MASK_DPSTU_8822B << BIT_SHIFT_DPSTU_8822B) -+#define BIT_CLEAR_DPSTU_8822B(x) ((x) & (~BITS_DPSTU_8822B)) -+#define BIT_GET_DPSTU_8822B(x) \ -+ (((x) >> BIT_SHIFT_DPSTU_8822B) & BIT_MASK_DPSTU_8822B) -+#define BIT_SET_DPSTU_8822B(x, v) \ -+ (BIT_CLEAR_DPSTU_8822B(x) | BIT_DPSTU_8822B(v)) -+ -+#define BIT_SUS_16X_8822B BIT(1) -+ -+/* 2 REG_GPIO_MUXCFG_8822B */ -+#define BIT_FSPI_EN_8822B BIT(19) -+#define BIT_WL_RTS_EXT_32K_SEL_8822B BIT(18) -+#define BIT_WLGP_SPI_EN_8822B BIT(16) -+#define BIT_SIC_LBK_8822B BIT(15) -+#define BIT_ENHTP_8822B BIT(14) -+#define BIT_ENSIC_8822B BIT(12) -+#define BIT_SIC_SWRST_8822B BIT(11) -+#define BIT_PO_WIFI_PTA_PINS_8822B BIT(10) -+#define BIT_PO_BT_PTA_PINS_8822B BIT(9) -+#define BIT_ENUART_8822B BIT(8) -+ -+#define BIT_SHIFT_BTMODE_8822B 6 -+#define BIT_MASK_BTMODE_8822B 0x3 -+#define BIT_BTMODE_8822B(x) \ -+ (((x) & BIT_MASK_BTMODE_8822B) << BIT_SHIFT_BTMODE_8822B) -+#define BITS_BTMODE_8822B (BIT_MASK_BTMODE_8822B << BIT_SHIFT_BTMODE_8822B) -+#define BIT_CLEAR_BTMODE_8822B(x) ((x) & (~BITS_BTMODE_8822B)) -+#define BIT_GET_BTMODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_BTMODE_8822B) & BIT_MASK_BTMODE_8822B) -+#define BIT_SET_BTMODE_8822B(x, v) \ -+ (BIT_CLEAR_BTMODE_8822B(x) | BIT_BTMODE_8822B(v)) -+ -+#define BIT_ENBT_8822B BIT(5) -+#define BIT_EROM_EN_8822B BIT(4) -+#define BIT_WLRFE_6_7_EN_8822B BIT(3) -+#define BIT_WLRFE_4_5_EN_8822B BIT(2) -+ -+#define BIT_SHIFT_GPIOSEL_8822B 0 -+#define BIT_MASK_GPIOSEL_8822B 0x3 -+#define BIT_GPIOSEL_8822B(x) \ -+ (((x) & BIT_MASK_GPIOSEL_8822B) << BIT_SHIFT_GPIOSEL_8822B) -+#define BITS_GPIOSEL_8822B (BIT_MASK_GPIOSEL_8822B << BIT_SHIFT_GPIOSEL_8822B) -+#define BIT_CLEAR_GPIOSEL_8822B(x) ((x) & (~BITS_GPIOSEL_8822B)) -+#define BIT_GET_GPIOSEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_GPIOSEL_8822B) & BIT_MASK_GPIOSEL_8822B) -+#define BIT_SET_GPIOSEL_8822B(x, v) \ -+ (BIT_CLEAR_GPIOSEL_8822B(x) | BIT_GPIOSEL_8822B(v)) -+ -+/* 2 REG_GPIO_PIN_CTRL_8822B */ -+ -+#define BIT_SHIFT_GPIO_MOD_7_TO_0_8822B 24 -+#define BIT_MASK_GPIO_MOD_7_TO_0_8822B 0xff -+#define BIT_GPIO_MOD_7_TO_0_8822B(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_7_TO_0_8822B) \ -+ << BIT_SHIFT_GPIO_MOD_7_TO_0_8822B) -+#define BITS_GPIO_MOD_7_TO_0_8822B \ -+ (BIT_MASK_GPIO_MOD_7_TO_0_8822B << BIT_SHIFT_GPIO_MOD_7_TO_0_8822B) -+#define BIT_CLEAR_GPIO_MOD_7_TO_0_8822B(x) ((x) & (~BITS_GPIO_MOD_7_TO_0_8822B)) -+#define BIT_GET_GPIO_MOD_7_TO_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_7_TO_0_8822B) & \ -+ BIT_MASK_GPIO_MOD_7_TO_0_8822B) -+#define BIT_SET_GPIO_MOD_7_TO_0_8822B(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_7_TO_0_8822B(x) | BIT_GPIO_MOD_7_TO_0_8822B(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8822B 16 -+#define BIT_MASK_GPIO_IO_SEL_7_TO_0_8822B 0xff -+#define BIT_GPIO_IO_SEL_7_TO_0_8822B(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_7_TO_0_8822B) \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8822B) -+#define BITS_GPIO_IO_SEL_7_TO_0_8822B \ -+ (BIT_MASK_GPIO_IO_SEL_7_TO_0_8822B \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8822B) -+#define BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8822B(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_7_TO_0_8822B)) -+#define BIT_GET_GPIO_IO_SEL_7_TO_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8822B) & \ -+ BIT_MASK_GPIO_IO_SEL_7_TO_0_8822B) -+#define BIT_SET_GPIO_IO_SEL_7_TO_0_8822B(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8822B(x) | \ -+ BIT_GPIO_IO_SEL_7_TO_0_8822B(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_7_TO_0_8822B 8 -+#define BIT_MASK_GPIO_OUT_7_TO_0_8822B 0xff -+#define BIT_GPIO_OUT_7_TO_0_8822B(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_7_TO_0_8822B) \ -+ << BIT_SHIFT_GPIO_OUT_7_TO_0_8822B) -+#define BITS_GPIO_OUT_7_TO_0_8822B \ -+ (BIT_MASK_GPIO_OUT_7_TO_0_8822B << BIT_SHIFT_GPIO_OUT_7_TO_0_8822B) -+#define BIT_CLEAR_GPIO_OUT_7_TO_0_8822B(x) ((x) & (~BITS_GPIO_OUT_7_TO_0_8822B)) -+#define BIT_GET_GPIO_OUT_7_TO_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_7_TO_0_8822B) & \ -+ BIT_MASK_GPIO_OUT_7_TO_0_8822B) -+#define BIT_SET_GPIO_OUT_7_TO_0_8822B(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_7_TO_0_8822B(x) | BIT_GPIO_OUT_7_TO_0_8822B(v)) -+ -+#define BIT_SHIFT_GPIO_IN_7_TO_0_8822B 0 -+#define BIT_MASK_GPIO_IN_7_TO_0_8822B 0xff -+#define BIT_GPIO_IN_7_TO_0_8822B(x) \ -+ (((x) & BIT_MASK_GPIO_IN_7_TO_0_8822B) \ -+ << BIT_SHIFT_GPIO_IN_7_TO_0_8822B) -+#define BITS_GPIO_IN_7_TO_0_8822B \ -+ (BIT_MASK_GPIO_IN_7_TO_0_8822B << BIT_SHIFT_GPIO_IN_7_TO_0_8822B) -+#define BIT_CLEAR_GPIO_IN_7_TO_0_8822B(x) ((x) & (~BITS_GPIO_IN_7_TO_0_8822B)) -+#define BIT_GET_GPIO_IN_7_TO_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_7_TO_0_8822B) & \ -+ BIT_MASK_GPIO_IN_7_TO_0_8822B) -+#define BIT_SET_GPIO_IN_7_TO_0_8822B(x, v) \ -+ (BIT_CLEAR_GPIO_IN_7_TO_0_8822B(x) | BIT_GPIO_IN_7_TO_0_8822B(v)) -+ -+/* 2 REG_GPIO_INTM_8822B */ -+ -+#define BIT_SHIFT_MUXDBG_SEL_8822B 30 -+#define BIT_MASK_MUXDBG_SEL_8822B 0x3 -+#define BIT_MUXDBG_SEL_8822B(x) \ -+ (((x) & BIT_MASK_MUXDBG_SEL_8822B) << BIT_SHIFT_MUXDBG_SEL_8822B) -+#define BITS_MUXDBG_SEL_8822B \ -+ (BIT_MASK_MUXDBG_SEL_8822B << BIT_SHIFT_MUXDBG_SEL_8822B) -+#define BIT_CLEAR_MUXDBG_SEL_8822B(x) ((x) & (~BITS_MUXDBG_SEL_8822B)) -+#define BIT_GET_MUXDBG_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_MUXDBG_SEL_8822B) & BIT_MASK_MUXDBG_SEL_8822B) -+#define BIT_SET_MUXDBG_SEL_8822B(x, v) \ -+ (BIT_CLEAR_MUXDBG_SEL_8822B(x) | BIT_MUXDBG_SEL_8822B(v)) -+ -+#define BIT_EXTWOL_SEL_8822B BIT(17) -+#define BIT_EXTWOL_EN_8822B BIT(16) -+#define BIT_GPIOF_INT_MD_8822B BIT(15) -+#define BIT_GPIOE_INT_MD_8822B BIT(14) -+#define BIT_GPIOD_INT_MD_8822B BIT(13) -+#define BIT_GPIOF_INT_MD_8822B BIT(15) -+#define BIT_GPIOE_INT_MD_8822B BIT(14) -+#define BIT_GPIOD_INT_MD_8822B BIT(13) -+#define BIT_GPIOC_INT_MD_8822B BIT(12) -+#define BIT_GPIOB_INT_MD_8822B BIT(11) -+#define BIT_GPIOA_INT_MD_8822B BIT(10) -+#define BIT_GPIO9_INT_MD_8822B BIT(9) -+#define BIT_GPIO8_INT_MD_8822B BIT(8) -+#define BIT_GPIO7_INT_MD_8822B BIT(7) -+#define BIT_GPIO6_INT_MD_8822B BIT(6) -+#define BIT_GPIO5_INT_MD_8822B BIT(5) -+#define BIT_GPIO4_INT_MD_8822B BIT(4) -+#define BIT_GPIO3_INT_MD_8822B BIT(3) -+#define BIT_GPIO2_INT_MD_8822B BIT(2) -+#define BIT_GPIO1_INT_MD_8822B BIT(1) -+#define BIT_GPIO0_INT_MD_8822B BIT(0) -+ -+/* 2 REG_LED_CFG_8822B */ -+#define BIT_GPIO3_WL_CTRL_EN_8822B BIT(27) -+#define BIT_LNAON_SEL_EN_8822B BIT(26) -+#define BIT_PAPE_SEL_EN_8822B BIT(25) -+#define BIT_DPDT_WLBT_SEL_8822B BIT(24) -+#define BIT_DPDT_SEL_EN_8822B BIT(23) -+#define BIT_GPIO13_14_WL_CTRL_EN_8822B BIT(22) -+#define BIT_GPIO13_14_WL_CTRL_EN_8822B BIT(22) -+#define BIT_LED2DIS_8822B BIT(21) -+#define BIT_LED2PL_8822B BIT(20) -+#define BIT_LED2SV_8822B BIT(19) -+ -+#define BIT_SHIFT_LED2CM_8822B 16 -+#define BIT_MASK_LED2CM_8822B 0x7 -+#define BIT_LED2CM_8822B(x) \ -+ (((x) & BIT_MASK_LED2CM_8822B) << BIT_SHIFT_LED2CM_8822B) -+#define BITS_LED2CM_8822B (BIT_MASK_LED2CM_8822B << BIT_SHIFT_LED2CM_8822B) -+#define BIT_CLEAR_LED2CM_8822B(x) ((x) & (~BITS_LED2CM_8822B)) -+#define BIT_GET_LED2CM_8822B(x) \ -+ (((x) >> BIT_SHIFT_LED2CM_8822B) & BIT_MASK_LED2CM_8822B) -+#define BIT_SET_LED2CM_8822B(x, v) \ -+ (BIT_CLEAR_LED2CM_8822B(x) | BIT_LED2CM_8822B(v)) -+ -+#define BIT_LED1DIS_8822B BIT(15) -+#define BIT_LED1PL_8822B BIT(12) -+#define BIT_LED1SV_8822B BIT(11) -+ -+#define BIT_SHIFT_LED1CM_8822B 8 -+#define BIT_MASK_LED1CM_8822B 0x7 -+#define BIT_LED1CM_8822B(x) \ -+ (((x) & BIT_MASK_LED1CM_8822B) << BIT_SHIFT_LED1CM_8822B) -+#define BITS_LED1CM_8822B (BIT_MASK_LED1CM_8822B << BIT_SHIFT_LED1CM_8822B) -+#define BIT_CLEAR_LED1CM_8822B(x) ((x) & (~BITS_LED1CM_8822B)) -+#define BIT_GET_LED1CM_8822B(x) \ -+ (((x) >> BIT_SHIFT_LED1CM_8822B) & BIT_MASK_LED1CM_8822B) -+#define BIT_SET_LED1CM_8822B(x, v) \ -+ (BIT_CLEAR_LED1CM_8822B(x) | BIT_LED1CM_8822B(v)) -+ -+#define BIT_LED0DIS_8822B BIT(7) -+ -+#define BIT_SHIFT_AFE_LDO_SWR_CHECK_8822B 5 -+#define BIT_MASK_AFE_LDO_SWR_CHECK_8822B 0x3 -+#define BIT_AFE_LDO_SWR_CHECK_8822B(x) \ -+ (((x) & BIT_MASK_AFE_LDO_SWR_CHECK_8822B) \ -+ << BIT_SHIFT_AFE_LDO_SWR_CHECK_8822B) -+#define BITS_AFE_LDO_SWR_CHECK_8822B \ -+ (BIT_MASK_AFE_LDO_SWR_CHECK_8822B << BIT_SHIFT_AFE_LDO_SWR_CHECK_8822B) -+#define BIT_CLEAR_AFE_LDO_SWR_CHECK_8822B(x) \ -+ ((x) & (~BITS_AFE_LDO_SWR_CHECK_8822B)) -+#define BIT_GET_AFE_LDO_SWR_CHECK_8822B(x) \ -+ (((x) >> BIT_SHIFT_AFE_LDO_SWR_CHECK_8822B) & \ -+ BIT_MASK_AFE_LDO_SWR_CHECK_8822B) -+#define BIT_SET_AFE_LDO_SWR_CHECK_8822B(x, v) \ -+ (BIT_CLEAR_AFE_LDO_SWR_CHECK_8822B(x) | BIT_AFE_LDO_SWR_CHECK_8822B(v)) -+ -+#define BIT_LED0PL_8822B BIT(4) -+#define BIT_LED0SV_8822B BIT(3) -+ -+#define BIT_SHIFT_LED0CM_8822B 0 -+#define BIT_MASK_LED0CM_8822B 0x7 -+#define BIT_LED0CM_8822B(x) \ -+ (((x) & BIT_MASK_LED0CM_8822B) << BIT_SHIFT_LED0CM_8822B) -+#define BITS_LED0CM_8822B (BIT_MASK_LED0CM_8822B << BIT_SHIFT_LED0CM_8822B) -+#define BIT_CLEAR_LED0CM_8822B(x) ((x) & (~BITS_LED0CM_8822B)) -+#define BIT_GET_LED0CM_8822B(x) \ -+ (((x) >> BIT_SHIFT_LED0CM_8822B) & BIT_MASK_LED0CM_8822B) -+#define BIT_SET_LED0CM_8822B(x, v) \ -+ (BIT_CLEAR_LED0CM_8822B(x) | BIT_LED0CM_8822B(v)) -+ -+/* 2 REG_FSIMR_8822B */ -+#define BIT_FS_PDNINT_EN_8822B BIT(31) -+#define BIT_NFC_INT_PAD_EN_8822B BIT(30) -+#define BIT_FS_SPS_OCP_INT_EN_8822B BIT(29) -+#define BIT_FS_PWMERR_INT_EN_8822B BIT(28) -+#define BIT_FS_GPIOF_INT_EN_8822B BIT(27) -+#define BIT_FS_GPIOE_INT_EN_8822B BIT(26) -+#define BIT_FS_GPIOD_INT_EN_8822B BIT(25) -+#define BIT_FS_GPIOC_INT_EN_8822B BIT(24) -+#define BIT_FS_GPIOB_INT_EN_8822B BIT(23) -+#define BIT_FS_GPIOA_INT_EN_8822B BIT(22) -+#define BIT_FS_GPIO9_INT_EN_8822B BIT(21) -+#define BIT_FS_GPIO8_INT_EN_8822B BIT(20) -+#define BIT_FS_GPIO7_INT_EN_8822B BIT(19) -+#define BIT_FS_GPIO6_INT_EN_8822B BIT(18) -+#define BIT_FS_GPIO5_INT_EN_8822B BIT(17) -+#define BIT_FS_GPIO4_INT_EN_8822B BIT(16) -+#define BIT_FS_GPIO3_INT_EN_8822B BIT(15) -+#define BIT_FS_GPIO2_INT_EN_8822B BIT(14) -+#define BIT_FS_GPIO1_INT_EN_8822B BIT(13) -+#define BIT_FS_GPIO0_INT_EN_8822B BIT(12) -+#define BIT_FS_HCI_SUS_EN_8822B BIT(11) -+#define BIT_FS_HCI_RES_EN_8822B BIT(10) -+#define BIT_FS_HCI_RESET_EN_8822B BIT(9) -+#define BIT_FS_BTON_STS_UPDATE_MSK_EN_8822B BIT(7) -+#define BIT_ACT2RECOVERY_INT_EN_V1_8822B BIT(6) -+#define BIT_GEN1GEN2_SWITCH_8822B BIT(5) -+#define BIT_HCI_TXDMA_REQ_HIMR_8822B BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_MAK_8822B BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_MAK_8822B BIT(2) -+#define BIT_FS_USB_LPMRSM_MSK_8822B BIT(1) -+#define BIT_FS_USB_LPMINT_MSK_8822B BIT(0) -+ -+/* 2 REG_FSISR_8822B */ -+#define BIT_FS_PDNINT_8822B BIT(31) -+#define BIT_FS_SPS_OCP_INT_8822B BIT(29) -+#define BIT_FS_PWMERR_INT_8822B BIT(28) -+#define BIT_FS_GPIOF_INT_8822B BIT(27) -+#define BIT_FS_GPIOE_INT_8822B BIT(26) -+#define BIT_FS_GPIOD_INT_8822B BIT(25) -+#define BIT_FS_GPIOC_INT_8822B BIT(24) -+#define BIT_FS_GPIOB_INT_8822B BIT(23) -+#define BIT_FS_GPIOA_INT_8822B BIT(22) -+#define BIT_FS_GPIO9_INT_8822B BIT(21) -+#define BIT_FS_GPIO8_INT_8822B BIT(20) -+#define BIT_FS_GPIO7_INT_8822B BIT(19) -+#define BIT_FS_GPIO6_INT_8822B BIT(18) -+#define BIT_FS_GPIO5_INT_8822B BIT(17) -+#define BIT_FS_GPIO4_INT_8822B BIT(16) -+#define BIT_FS_GPIO3_INT_8822B BIT(15) -+#define BIT_FS_GPIO2_INT_8822B BIT(14) -+#define BIT_FS_GPIO1_INT_8822B BIT(13) -+#define BIT_FS_GPIO0_INT_8822B BIT(12) -+#define BIT_FS_HCI_SUS_INT_8822B BIT(11) -+#define BIT_FS_HCI_RES_INT_8822B BIT(10) -+#define BIT_FS_HCI_RESET_INT_8822B BIT(9) -+#define BIT_ACT2RECOVERY_8822B BIT(6) -+#define BIT_GEN1GEN2_SWITCH_8822B BIT(5) -+#define BIT_HCI_TXDMA_REQ_HISR_8822B BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_INT_8822B BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_INT_8822B BIT(2) -+#define BIT_FS_USB_LPMRSM_INT_8822B BIT(1) -+#define BIT_FS_USB_LPMINT_INT_8822B BIT(0) -+ -+/* 2 REG_HSIMR_8822B */ -+#define BIT_GPIOF_INT_EN_8822B BIT(31) -+#define BIT_GPIOE_INT_EN_8822B BIT(30) -+#define BIT_GPIOD_INT_EN_8822B BIT(29) -+#define BIT_GPIOC_INT_EN_8822B BIT(28) -+#define BIT_GPIOB_INT_EN_8822B BIT(27) -+#define BIT_GPIOA_INT_EN_8822B BIT(26) -+#define BIT_GPIO9_INT_EN_8822B BIT(25) -+#define BIT_GPIO8_INT_EN_8822B BIT(24) -+#define BIT_GPIO7_INT_EN_8822B BIT(23) -+#define BIT_GPIO6_INT_EN_8822B BIT(22) -+#define BIT_GPIO5_INT_EN_8822B BIT(21) -+#define BIT_GPIO4_INT_EN_8822B BIT(20) -+#define BIT_GPIO3_INT_EN_8822B BIT(19) -+#define BIT_GPIO2_INT_EN_V1_8822B BIT(18) -+#define BIT_GPIO1_INT_EN_8822B BIT(17) -+#define BIT_GPIO0_INT_EN_8822B BIT(16) -+#define BIT_PDNINT_EN_8822B BIT(7) -+#define BIT_RON_INT_EN_8822B BIT(6) -+#define BIT_SPS_OCP_INT_EN_8822B BIT(5) -+#define BIT_GPIO15_0_INT_EN_8822B BIT(0) -+ -+/* 2 REG_HSISR_8822B */ -+#define BIT_GPIOF_INT_8822B BIT(31) -+#define BIT_GPIOE_INT_8822B BIT(30) -+#define BIT_GPIOD_INT_8822B BIT(29) -+#define BIT_GPIOC_INT_8822B BIT(28) -+#define BIT_GPIOB_INT_8822B BIT(27) -+#define BIT_GPIOA_INT_8822B BIT(26) -+#define BIT_GPIO9_INT_8822B BIT(25) -+#define BIT_GPIO8_INT_8822B BIT(24) -+#define BIT_GPIO7_INT_8822B BIT(23) -+#define BIT_GPIO6_INT_8822B BIT(22) -+#define BIT_GPIO5_INT_8822B BIT(21) -+#define BIT_GPIO4_INT_8822B BIT(20) -+#define BIT_GPIO3_INT_8822B BIT(19) -+#define BIT_GPIO2_INT_V1_8822B BIT(18) -+#define BIT_GPIO1_INT_8822B BIT(17) -+#define BIT_GPIO0_INT_8822B BIT(16) -+#define BIT_PDNINT_8822B BIT(7) -+#define BIT_RON_INT_8822B BIT(6) -+#define BIT_SPS_OCP_INT_8822B BIT(5) -+#define BIT_GPIO15_0_INT_8822B BIT(0) -+ -+/* 2 REG_GPIO_EXT_CTRL_8822B */ -+ -+#define BIT_SHIFT_GPIO_MOD_15_TO_8_8822B 24 -+#define BIT_MASK_GPIO_MOD_15_TO_8_8822B 0xff -+#define BIT_GPIO_MOD_15_TO_8_8822B(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_15_TO_8_8822B) \ -+ << BIT_SHIFT_GPIO_MOD_15_TO_8_8822B) -+#define BITS_GPIO_MOD_15_TO_8_8822B \ -+ (BIT_MASK_GPIO_MOD_15_TO_8_8822B << BIT_SHIFT_GPIO_MOD_15_TO_8_8822B) -+#define BIT_CLEAR_GPIO_MOD_15_TO_8_8822B(x) \ -+ ((x) & (~BITS_GPIO_MOD_15_TO_8_8822B)) -+#define BIT_GET_GPIO_MOD_15_TO_8_8822B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_15_TO_8_8822B) & \ -+ BIT_MASK_GPIO_MOD_15_TO_8_8822B) -+#define BIT_SET_GPIO_MOD_15_TO_8_8822B(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_15_TO_8_8822B(x) | BIT_GPIO_MOD_15_TO_8_8822B(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8822B 16 -+#define BIT_MASK_GPIO_IO_SEL_15_TO_8_8822B 0xff -+#define BIT_GPIO_IO_SEL_15_TO_8_8822B(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_15_TO_8_8822B) \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8822B) -+#define BITS_GPIO_IO_SEL_15_TO_8_8822B \ -+ (BIT_MASK_GPIO_IO_SEL_15_TO_8_8822B \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8822B) -+#define BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8822B(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_15_TO_8_8822B)) -+#define BIT_GET_GPIO_IO_SEL_15_TO_8_8822B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8822B) & \ -+ BIT_MASK_GPIO_IO_SEL_15_TO_8_8822B) -+#define BIT_SET_GPIO_IO_SEL_15_TO_8_8822B(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8822B(x) | \ -+ BIT_GPIO_IO_SEL_15_TO_8_8822B(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_15_TO_8_8822B 8 -+#define BIT_MASK_GPIO_OUT_15_TO_8_8822B 0xff -+#define BIT_GPIO_OUT_15_TO_8_8822B(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_15_TO_8_8822B) \ -+ << BIT_SHIFT_GPIO_OUT_15_TO_8_8822B) -+#define BITS_GPIO_OUT_15_TO_8_8822B \ -+ (BIT_MASK_GPIO_OUT_15_TO_8_8822B << BIT_SHIFT_GPIO_OUT_15_TO_8_8822B) -+#define BIT_CLEAR_GPIO_OUT_15_TO_8_8822B(x) \ -+ ((x) & (~BITS_GPIO_OUT_15_TO_8_8822B)) -+#define BIT_GET_GPIO_OUT_15_TO_8_8822B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_15_TO_8_8822B) & \ -+ BIT_MASK_GPIO_OUT_15_TO_8_8822B) -+#define BIT_SET_GPIO_OUT_15_TO_8_8822B(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_15_TO_8_8822B(x) | BIT_GPIO_OUT_15_TO_8_8822B(v)) -+ -+#define BIT_SHIFT_GPIO_IN_15_TO_8_8822B 0 -+#define BIT_MASK_GPIO_IN_15_TO_8_8822B 0xff -+#define BIT_GPIO_IN_15_TO_8_8822B(x) \ -+ (((x) & BIT_MASK_GPIO_IN_15_TO_8_8822B) \ -+ << BIT_SHIFT_GPIO_IN_15_TO_8_8822B) -+#define BITS_GPIO_IN_15_TO_8_8822B \ -+ (BIT_MASK_GPIO_IN_15_TO_8_8822B << BIT_SHIFT_GPIO_IN_15_TO_8_8822B) -+#define BIT_CLEAR_GPIO_IN_15_TO_8_8822B(x) ((x) & (~BITS_GPIO_IN_15_TO_8_8822B)) -+#define BIT_GET_GPIO_IN_15_TO_8_8822B(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_15_TO_8_8822B) & \ -+ BIT_MASK_GPIO_IN_15_TO_8_8822B) -+#define BIT_SET_GPIO_IN_15_TO_8_8822B(x, v) \ -+ (BIT_CLEAR_GPIO_IN_15_TO_8_8822B(x) | BIT_GPIO_IN_15_TO_8_8822B(v)) -+ -+/* 2 REG_PAD_CTRL1_8822B */ -+#define BIT_PAPE_WLBT_SEL_8822B BIT(29) -+#define BIT_LNAON_WLBT_SEL_8822B BIT(28) -+#define BIT_BTGP_GPG3_FEN_8822B BIT(26) -+#define BIT_BTGP_GPG2_FEN_8822B BIT(25) -+#define BIT_BTGP_JTAG_EN_8822B BIT(24) -+#define BIT_XTAL_CLK_EXTARNAL_EN_8822B BIT(23) -+#define BIT_BTGP_UART0_EN_8822B BIT(22) -+#define BIT_BTGP_UART1_EN_8822B BIT(21) -+#define BIT_BTGP_SPI_EN_8822B BIT(20) -+#define BIT_BTGP_GPIO_E2_8822B BIT(19) -+#define BIT_BTGP_GPIO_EN_8822B BIT(18) -+ -+#define BIT_SHIFT_BTGP_GPIO_SL_8822B 16 -+#define BIT_MASK_BTGP_GPIO_SL_8822B 0x3 -+#define BIT_BTGP_GPIO_SL_8822B(x) \ -+ (((x) & BIT_MASK_BTGP_GPIO_SL_8822B) << BIT_SHIFT_BTGP_GPIO_SL_8822B) -+#define BITS_BTGP_GPIO_SL_8822B \ -+ (BIT_MASK_BTGP_GPIO_SL_8822B << BIT_SHIFT_BTGP_GPIO_SL_8822B) -+#define BIT_CLEAR_BTGP_GPIO_SL_8822B(x) ((x) & (~BITS_BTGP_GPIO_SL_8822B)) -+#define BIT_GET_BTGP_GPIO_SL_8822B(x) \ -+ (((x) >> BIT_SHIFT_BTGP_GPIO_SL_8822B) & BIT_MASK_BTGP_GPIO_SL_8822B) -+#define BIT_SET_BTGP_GPIO_SL_8822B(x, v) \ -+ (BIT_CLEAR_BTGP_GPIO_SL_8822B(x) | BIT_BTGP_GPIO_SL_8822B(v)) -+ -+#define BIT_PAD_SDIO_SR_8822B BIT(14) -+#define BIT_GPIO14_OUTPUT_PL_8822B BIT(13) -+#define BIT_HOST_WAKE_PAD_PULL_EN_8822B BIT(12) -+#define BIT_HOST_WAKE_PAD_SL_8822B BIT(11) -+#define BIT_PAD_LNAON_SR_8822B BIT(10) -+#define BIT_PAD_LNAON_E2_8822B BIT(9) -+#define BIT_SW_LNAON_G_SEL_DATA_8822B BIT(8) -+#define BIT_SW_LNAON_A_SEL_DATA_8822B BIT(7) -+#define BIT_PAD_PAPE_SR_8822B BIT(6) -+#define BIT_PAD_PAPE_E2_8822B BIT(5) -+#define BIT_SW_PAPE_G_SEL_DATA_8822B BIT(4) -+#define BIT_SW_PAPE_A_SEL_DATA_8822B BIT(3) -+#define BIT_PAD_DPDT_SR_8822B BIT(2) -+#define BIT_PAD_DPDT_PAD_E2_8822B BIT(1) -+#define BIT_SW_DPDT_SEL_DATA_8822B BIT(0) -+ -+/* 2 REG_WL_BT_PWR_CTRL_8822B */ -+#define BIT_ISO_BD2PP_8822B BIT(31) -+#define BIT_LDOV12B_EN_8822B BIT(30) -+#define BIT_CKEN_BTGPS_8822B BIT(29) -+#define BIT_FEN_BTGPS_8822B BIT(28) -+#define BIT_BTCPU_BOOTSEL_8822B BIT(27) -+#define BIT_SPI_SPEEDUP_8822B BIT(26) -+#define BIT_DEVWAKE_PAD_TYPE_SEL_8822B BIT(24) -+#define BIT_CLKREQ_PAD_TYPE_SEL_8822B BIT(23) -+#define BIT_ISO_BTPON2PP_8822B BIT(22) -+#define BIT_BT_HWROF_EN_8822B BIT(19) -+#define BIT_BT_FUNC_EN_8822B BIT(18) -+#define BIT_BT_HWPDN_SL_8822B BIT(17) -+#define BIT_BT_DISN_EN_8822B BIT(16) -+#define BIT_BT_PDN_PULL_EN_8822B BIT(15) -+#define BIT_WL_PDN_PULL_EN_8822B BIT(14) -+#define BIT_EXTERNAL_REQUEST_PL_8822B BIT(13) -+#define BIT_GPIO0_2_3_PULL_LOW_EN_8822B BIT(12) -+#define BIT_ISO_BA2PP_8822B BIT(11) -+#define BIT_BT_AFE_LDO_EN_8822B BIT(10) -+#define BIT_BT_AFE_PLL_EN_8822B BIT(9) -+#define BIT_BT_DIG_CLK_EN_8822B BIT(8) -+#define BIT_WL_DRV_EXIST_IDX_8822B BIT(5) -+#define BIT_DOP_EHPAD_8822B BIT(4) -+#define BIT_WL_HWROF_EN_8822B BIT(3) -+#define BIT_WL_FUNC_EN_8822B BIT(2) -+#define BIT_WL_HWPDN_SL_8822B BIT(1) -+#define BIT_WL_HWPDN_EN_8822B BIT(0) -+ -+/* 2 REG_SDM_DEBUG_8822B */ -+ -+#define BIT_SHIFT_WLCLK_PHASE_8822B 0 -+#define BIT_MASK_WLCLK_PHASE_8822B 0x1f -+#define BIT_WLCLK_PHASE_8822B(x) \ -+ (((x) & BIT_MASK_WLCLK_PHASE_8822B) << BIT_SHIFT_WLCLK_PHASE_8822B) -+#define BITS_WLCLK_PHASE_8822B \ -+ (BIT_MASK_WLCLK_PHASE_8822B << BIT_SHIFT_WLCLK_PHASE_8822B) -+#define BIT_CLEAR_WLCLK_PHASE_8822B(x) ((x) & (~BITS_WLCLK_PHASE_8822B)) -+#define BIT_GET_WLCLK_PHASE_8822B(x) \ -+ (((x) >> BIT_SHIFT_WLCLK_PHASE_8822B) & BIT_MASK_WLCLK_PHASE_8822B) -+#define BIT_SET_WLCLK_PHASE_8822B(x, v) \ -+ (BIT_CLEAR_WLCLK_PHASE_8822B(x) | BIT_WLCLK_PHASE_8822B(v)) -+ -+/* 2 REG_SYS_SDIO_CTRL_8822B */ -+#define BIT_DBG_GNT_WL_BT_8822B BIT(27) -+#define BIT_LTE_MUX_CTRL_PATH_8822B BIT(26) -+#define BIT_LTE_COEX_UART_8822B BIT(25) -+#define BIT_3W_LTE_WL_GPIO_8822B BIT(24) -+#define BIT_SDIO_INT_POLARITY_8822B BIT(19) -+#define BIT_SDIO_INT_8822B BIT(18) -+#define BIT_SDIO_OFF_EN_8822B BIT(17) -+#define BIT_SDIO_ON_EN_8822B BIT(16) -+#define BIT_PCIE_WAIT_TIMEOUT_EVENT_8822B BIT(10) -+#define BIT_PCIE_WAIT_TIME_8822B BIT(9) -+#define BIT_MPCIE_REFCLK_XTAL_SEL_8822B BIT(8) -+ -+#define BIT_SHIFT_SI_AUTHORIZATION_8822B 0 -+#define BIT_MASK_SI_AUTHORIZATION_8822B 0xff -+#define BIT_SI_AUTHORIZATION_8822B(x) \ -+ (((x) & BIT_MASK_SI_AUTHORIZATION_8822B) \ -+ << BIT_SHIFT_SI_AUTHORIZATION_8822B) -+#define BITS_SI_AUTHORIZATION_8822B \ -+ (BIT_MASK_SI_AUTHORIZATION_8822B << BIT_SHIFT_SI_AUTHORIZATION_8822B) -+#define BIT_CLEAR_SI_AUTHORIZATION_8822B(x) \ -+ ((x) & (~BITS_SI_AUTHORIZATION_8822B)) -+#define BIT_GET_SI_AUTHORIZATION_8822B(x) \ -+ (((x) >> BIT_SHIFT_SI_AUTHORIZATION_8822B) & \ -+ BIT_MASK_SI_AUTHORIZATION_8822B) -+#define BIT_SET_SI_AUTHORIZATION_8822B(x, v) \ -+ (BIT_CLEAR_SI_AUTHORIZATION_8822B(x) | BIT_SI_AUTHORIZATION_8822B(v)) -+ -+/* 2 REG_HCI_OPT_CTRL_8822B */ -+ -+#define BIT_SHIFT_TSFT_SEL_8822B 29 -+#define BIT_MASK_TSFT_SEL_8822B 0x7 -+#define BIT_TSFT_SEL_8822B(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_8822B) << BIT_SHIFT_TSFT_SEL_8822B) -+#define BITS_TSFT_SEL_8822B \ -+ (BIT_MASK_TSFT_SEL_8822B << BIT_SHIFT_TSFT_SEL_8822B) -+#define BIT_CLEAR_TSFT_SEL_8822B(x) ((x) & (~BITS_TSFT_SEL_8822B)) -+#define BIT_GET_TSFT_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_8822B) & BIT_MASK_TSFT_SEL_8822B) -+#define BIT_SET_TSFT_SEL_8822B(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_8822B(x) | BIT_TSFT_SEL_8822B(v)) -+ -+#define BIT_USB_HOST_PWR_OFF_EN_8822B BIT(12) -+#define BIT_SYM_LPS_BLOCK_EN_8822B BIT(11) -+#define BIT_USB_LPM_ACT_EN_8822B BIT(10) -+#define BIT_USB_LPM_NY_8822B BIT(9) -+#define BIT_USB_SUS_DIS_8822B BIT(8) -+ -+#define BIT_SHIFT_SDIO_PAD_E_8822B 5 -+#define BIT_MASK_SDIO_PAD_E_8822B 0x7 -+#define BIT_SDIO_PAD_E_8822B(x) \ -+ (((x) & BIT_MASK_SDIO_PAD_E_8822B) << BIT_SHIFT_SDIO_PAD_E_8822B) -+#define BITS_SDIO_PAD_E_8822B \ -+ (BIT_MASK_SDIO_PAD_E_8822B << BIT_SHIFT_SDIO_PAD_E_8822B) -+#define BIT_CLEAR_SDIO_PAD_E_8822B(x) ((x) & (~BITS_SDIO_PAD_E_8822B)) -+#define BIT_GET_SDIO_PAD_E_8822B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_PAD_E_8822B) & BIT_MASK_SDIO_PAD_E_8822B) -+#define BIT_SET_SDIO_PAD_E_8822B(x, v) \ -+ (BIT_CLEAR_SDIO_PAD_E_8822B(x) | BIT_SDIO_PAD_E_8822B(v)) -+ -+#define BIT_USB_LPPLL_EN_8822B BIT(4) -+#define BIT_ROP_SW15_8822B BIT(2) -+#define BIT_PCI_CKRDY_OPT_8822B BIT(1) -+#define BIT_PCI_VAUX_EN_8822B BIT(0) -+ -+/* 2 REG_AFE_CTRL4_8822B */ -+ -+/* 2 REG_LDO_SWR_CTRL_8822B */ -+#define BIT_ZCD_HW_AUTO_EN_8822B BIT(27) -+#define BIT_ZCD_REGSEL_8822B BIT(26) -+ -+#define BIT_SHIFT_AUTO_ZCD_IN_CODE_8822B 21 -+#define BIT_MASK_AUTO_ZCD_IN_CODE_8822B 0x1f -+#define BIT_AUTO_ZCD_IN_CODE_8822B(x) \ -+ (((x) & BIT_MASK_AUTO_ZCD_IN_CODE_8822B) \ -+ << BIT_SHIFT_AUTO_ZCD_IN_CODE_8822B) -+#define BITS_AUTO_ZCD_IN_CODE_8822B \ -+ (BIT_MASK_AUTO_ZCD_IN_CODE_8822B << BIT_SHIFT_AUTO_ZCD_IN_CODE_8822B) -+#define BIT_CLEAR_AUTO_ZCD_IN_CODE_8822B(x) \ -+ ((x) & (~BITS_AUTO_ZCD_IN_CODE_8822B)) -+#define BIT_GET_AUTO_ZCD_IN_CODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_AUTO_ZCD_IN_CODE_8822B) & \ -+ BIT_MASK_AUTO_ZCD_IN_CODE_8822B) -+#define BIT_SET_AUTO_ZCD_IN_CODE_8822B(x, v) \ -+ (BIT_CLEAR_AUTO_ZCD_IN_CODE_8822B(x) | BIT_AUTO_ZCD_IN_CODE_8822B(v)) -+ -+#define BIT_SHIFT_ZCD_CODE_IN_L_8822B 16 -+#define BIT_MASK_ZCD_CODE_IN_L_8822B 0x1f -+#define BIT_ZCD_CODE_IN_L_8822B(x) \ -+ (((x) & BIT_MASK_ZCD_CODE_IN_L_8822B) << BIT_SHIFT_ZCD_CODE_IN_L_8822B) -+#define BITS_ZCD_CODE_IN_L_8822B \ -+ (BIT_MASK_ZCD_CODE_IN_L_8822B << BIT_SHIFT_ZCD_CODE_IN_L_8822B) -+#define BIT_CLEAR_ZCD_CODE_IN_L_8822B(x) ((x) & (~BITS_ZCD_CODE_IN_L_8822B)) -+#define BIT_GET_ZCD_CODE_IN_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_ZCD_CODE_IN_L_8822B) & BIT_MASK_ZCD_CODE_IN_L_8822B) -+#define BIT_SET_ZCD_CODE_IN_L_8822B(x, v) \ -+ (BIT_CLEAR_ZCD_CODE_IN_L_8822B(x) | BIT_ZCD_CODE_IN_L_8822B(v)) -+ -+#define BIT_SHIFT_LDO_HV5_DUMMY_8822B 14 -+#define BIT_MASK_LDO_HV5_DUMMY_8822B 0x3 -+#define BIT_LDO_HV5_DUMMY_8822B(x) \ -+ (((x) & BIT_MASK_LDO_HV5_DUMMY_8822B) << BIT_SHIFT_LDO_HV5_DUMMY_8822B) -+#define BITS_LDO_HV5_DUMMY_8822B \ -+ (BIT_MASK_LDO_HV5_DUMMY_8822B << BIT_SHIFT_LDO_HV5_DUMMY_8822B) -+#define BIT_CLEAR_LDO_HV5_DUMMY_8822B(x) ((x) & (~BITS_LDO_HV5_DUMMY_8822B)) -+#define BIT_GET_LDO_HV5_DUMMY_8822B(x) \ -+ (((x) >> BIT_SHIFT_LDO_HV5_DUMMY_8822B) & BIT_MASK_LDO_HV5_DUMMY_8822B) -+#define BIT_SET_LDO_HV5_DUMMY_8822B(x, v) \ -+ (BIT_CLEAR_LDO_HV5_DUMMY_8822B(x) | BIT_LDO_HV5_DUMMY_8822B(v)) -+ -+#define BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1_8822B 12 -+#define BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1_8822B 0x3 -+#define BIT_REG_VTUNE33_BIT0_TO_BIT1_8822B(x) \ -+ (((x) & BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1_8822B) \ -+ << BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1_8822B) -+#define BITS_REG_VTUNE33_BIT0_TO_BIT1_8822B \ -+ (BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1_8822B \ -+ << BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1_8822B) -+#define BIT_CLEAR_REG_VTUNE33_BIT0_TO_BIT1_8822B(x) \ -+ ((x) & (~BITS_REG_VTUNE33_BIT0_TO_BIT1_8822B)) -+#define BIT_GET_REG_VTUNE33_BIT0_TO_BIT1_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_VTUNE33_BIT0_TO_BIT1_8822B) & \ -+ BIT_MASK_REG_VTUNE33_BIT0_TO_BIT1_8822B) -+#define BIT_SET_REG_VTUNE33_BIT0_TO_BIT1_8822B(x, v) \ -+ (BIT_CLEAR_REG_VTUNE33_BIT0_TO_BIT1_8822B(x) | \ -+ BIT_REG_VTUNE33_BIT0_TO_BIT1_8822B(v)) -+ -+#define BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1_8822B 10 -+#define BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1_8822B 0x3 -+#define BIT_REG_STANDBY33_BIT0_TO_BIT1_8822B(x) \ -+ (((x) & BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1_8822B) \ -+ << BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1_8822B) -+#define BITS_REG_STANDBY33_BIT0_TO_BIT1_8822B \ -+ (BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1_8822B \ -+ << BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1_8822B) -+#define BIT_CLEAR_REG_STANDBY33_BIT0_TO_BIT1_8822B(x) \ -+ ((x) & (~BITS_REG_STANDBY33_BIT0_TO_BIT1_8822B)) -+#define BIT_GET_REG_STANDBY33_BIT0_TO_BIT1_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_STANDBY33_BIT0_TO_BIT1_8822B) & \ -+ BIT_MASK_REG_STANDBY33_BIT0_TO_BIT1_8822B) -+#define BIT_SET_REG_STANDBY33_BIT0_TO_BIT1_8822B(x, v) \ -+ (BIT_CLEAR_REG_STANDBY33_BIT0_TO_BIT1_8822B(x) | \ -+ BIT_REG_STANDBY33_BIT0_TO_BIT1_8822B(v)) -+ -+#define BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1_8822B 8 -+#define BIT_MASK_REG_LOAD33_BIT0_TO_BIT1_8822B 0x3 -+#define BIT_REG_LOAD33_BIT0_TO_BIT1_8822B(x) \ -+ (((x) & BIT_MASK_REG_LOAD33_BIT0_TO_BIT1_8822B) \ -+ << BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1_8822B) -+#define BITS_REG_LOAD33_BIT0_TO_BIT1_8822B \ -+ (BIT_MASK_REG_LOAD33_BIT0_TO_BIT1_8822B \ -+ << BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1_8822B) -+#define BIT_CLEAR_REG_LOAD33_BIT0_TO_BIT1_8822B(x) \ -+ ((x) & (~BITS_REG_LOAD33_BIT0_TO_BIT1_8822B)) -+#define BIT_GET_REG_LOAD33_BIT0_TO_BIT1_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_LOAD33_BIT0_TO_BIT1_8822B) & \ -+ BIT_MASK_REG_LOAD33_BIT0_TO_BIT1_8822B) -+#define BIT_SET_REG_LOAD33_BIT0_TO_BIT1_8822B(x, v) \ -+ (BIT_CLEAR_REG_LOAD33_BIT0_TO_BIT1_8822B(x) | \ -+ BIT_REG_LOAD33_BIT0_TO_BIT1_8822B(v)) -+ -+#define BIT_REG_BYPASS_L_8822B BIT(7) -+#define BIT_REG_LDOF_L_8822B BIT(6) -+#define BIT_REG_TYPE_L_V1_8822B BIT(5) -+#define BIT_ARENB_L_8822B BIT(3) -+ -+#define BIT_SHIFT_CFC_L_8822B 1 -+#define BIT_MASK_CFC_L_8822B 0x3 -+#define BIT_CFC_L_8822B(x) \ -+ (((x) & BIT_MASK_CFC_L_8822B) << BIT_SHIFT_CFC_L_8822B) -+#define BITS_CFC_L_8822B (BIT_MASK_CFC_L_8822B << BIT_SHIFT_CFC_L_8822B) -+#define BIT_CLEAR_CFC_L_8822B(x) ((x) & (~BITS_CFC_L_8822B)) -+#define BIT_GET_CFC_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_CFC_L_8822B) & BIT_MASK_CFC_L_8822B) -+#define BIT_SET_CFC_L_8822B(x, v) \ -+ (BIT_CLEAR_CFC_L_8822B(x) | BIT_CFC_L_8822B(v)) -+ -+#define BIT_REG_OCPS_L_V1_8822B BIT(0) -+ -+/* 2 REG_MCUFW_CTRL_8822B */ -+ -+#define BIT_SHIFT_RPWM_8822B 24 -+#define BIT_MASK_RPWM_8822B 0xff -+#define BIT_RPWM_8822B(x) (((x) & BIT_MASK_RPWM_8822B) << BIT_SHIFT_RPWM_8822B) -+#define BITS_RPWM_8822B (BIT_MASK_RPWM_8822B << BIT_SHIFT_RPWM_8822B) -+#define BIT_CLEAR_RPWM_8822B(x) ((x) & (~BITS_RPWM_8822B)) -+#define BIT_GET_RPWM_8822B(x) \ -+ (((x) >> BIT_SHIFT_RPWM_8822B) & BIT_MASK_RPWM_8822B) -+#define BIT_SET_RPWM_8822B(x, v) (BIT_CLEAR_RPWM_8822B(x) | BIT_RPWM_8822B(v)) -+ -+#define BIT_ANA_PORT_EN_8822B BIT(22) -+#define BIT_MAC_PORT_EN_8822B BIT(21) -+#define BIT_BOOT_FSPI_EN_8822B BIT(20) -+#define BIT_ROM_DLEN_8822B BIT(19) -+ -+#define BIT_SHIFT_ROM_PGE_8822B 16 -+#define BIT_MASK_ROM_PGE_8822B 0x7 -+#define BIT_ROM_PGE_8822B(x) \ -+ (((x) & BIT_MASK_ROM_PGE_8822B) << BIT_SHIFT_ROM_PGE_8822B) -+#define BITS_ROM_PGE_8822B (BIT_MASK_ROM_PGE_8822B << BIT_SHIFT_ROM_PGE_8822B) -+#define BIT_CLEAR_ROM_PGE_8822B(x) ((x) & (~BITS_ROM_PGE_8822B)) -+#define BIT_GET_ROM_PGE_8822B(x) \ -+ (((x) >> BIT_SHIFT_ROM_PGE_8822B) & BIT_MASK_ROM_PGE_8822B) -+#define BIT_SET_ROM_PGE_8822B(x, v) \ -+ (BIT_CLEAR_ROM_PGE_8822B(x) | BIT_ROM_PGE_8822B(v)) -+ -+#define BIT_FW_INIT_RDY_8822B BIT(15) -+#define BIT_FW_DW_RDY_8822B BIT(14) -+ -+#define BIT_SHIFT_CPU_CLK_SEL_8822B 12 -+#define BIT_MASK_CPU_CLK_SEL_8822B 0x3 -+#define BIT_CPU_CLK_SEL_8822B(x) \ -+ (((x) & BIT_MASK_CPU_CLK_SEL_8822B) << BIT_SHIFT_CPU_CLK_SEL_8822B) -+#define BITS_CPU_CLK_SEL_8822B \ -+ (BIT_MASK_CPU_CLK_SEL_8822B << BIT_SHIFT_CPU_CLK_SEL_8822B) -+#define BIT_CLEAR_CPU_CLK_SEL_8822B(x) ((x) & (~BITS_CPU_CLK_SEL_8822B)) -+#define BIT_GET_CPU_CLK_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_CPU_CLK_SEL_8822B) & BIT_MASK_CPU_CLK_SEL_8822B) -+#define BIT_SET_CPU_CLK_SEL_8822B(x, v) \ -+ (BIT_CLEAR_CPU_CLK_SEL_8822B(x) | BIT_CPU_CLK_SEL_8822B(v)) -+ -+#define BIT_CCLK_CHG_MASK_8822B BIT(11) -+#define BIT_EMEM__TXBUF_CHKSUM_OK_8822B BIT(10) -+#define BIT_EMEM_TXBUF_DW_RDY_8822B BIT(9) -+#define BIT_EMEM_CHKSUM_OK_8822B BIT(8) -+#define BIT_EMEM_DW_OK_8822B BIT(7) -+#define BIT_DMEM_CHKSUM_OK_8822B BIT(6) -+#define BIT_DMEM_DW_OK_8822B BIT(5) -+#define BIT_IMEM_CHKSUM_OK_8822B BIT(4) -+#define BIT_IMEM_DW_OK_8822B BIT(3) -+#define BIT_IMEM_BOOT_LOAD_CHKSUM_OK_8822B BIT(2) -+#define BIT_IMEM_BOOT_LOAD_DW_OK_8822B BIT(1) -+#define BIT_MCUFWDL_EN_8822B BIT(0) -+ -+/* 2 REG_MCU_TST_CFG_8822B */ -+ -+#define BIT_SHIFT_C2H_MSG_8822B 0 -+#define BIT_MASK_C2H_MSG_8822B 0xffff -+#define BIT_C2H_MSG_8822B(x) \ -+ (((x) & BIT_MASK_C2H_MSG_8822B) << BIT_SHIFT_C2H_MSG_8822B) -+#define BITS_C2H_MSG_8822B (BIT_MASK_C2H_MSG_8822B << BIT_SHIFT_C2H_MSG_8822B) -+#define BIT_CLEAR_C2H_MSG_8822B(x) ((x) & (~BITS_C2H_MSG_8822B)) -+#define BIT_GET_C2H_MSG_8822B(x) \ -+ (((x) >> BIT_SHIFT_C2H_MSG_8822B) & BIT_MASK_C2H_MSG_8822B) -+#define BIT_SET_C2H_MSG_8822B(x, v) \ -+ (BIT_CLEAR_C2H_MSG_8822B(x) | BIT_C2H_MSG_8822B(v)) -+ -+/* 2 REG_HMEBOX_E0_E1_8822B */ -+ -+#define BIT_SHIFT_HOST_MSG_E1_8822B 16 -+#define BIT_MASK_HOST_MSG_E1_8822B 0xffff -+#define BIT_HOST_MSG_E1_8822B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E1_8822B) << BIT_SHIFT_HOST_MSG_E1_8822B) -+#define BITS_HOST_MSG_E1_8822B \ -+ (BIT_MASK_HOST_MSG_E1_8822B << BIT_SHIFT_HOST_MSG_E1_8822B) -+#define BIT_CLEAR_HOST_MSG_E1_8822B(x) ((x) & (~BITS_HOST_MSG_E1_8822B)) -+#define BIT_GET_HOST_MSG_E1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E1_8822B) & BIT_MASK_HOST_MSG_E1_8822B) -+#define BIT_SET_HOST_MSG_E1_8822B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E1_8822B(x) | BIT_HOST_MSG_E1_8822B(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E0_8822B 0 -+#define BIT_MASK_HOST_MSG_E0_8822B 0xffff -+#define BIT_HOST_MSG_E0_8822B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E0_8822B) << BIT_SHIFT_HOST_MSG_E0_8822B) -+#define BITS_HOST_MSG_E0_8822B \ -+ (BIT_MASK_HOST_MSG_E0_8822B << BIT_SHIFT_HOST_MSG_E0_8822B) -+#define BIT_CLEAR_HOST_MSG_E0_8822B(x) ((x) & (~BITS_HOST_MSG_E0_8822B)) -+#define BIT_GET_HOST_MSG_E0_8822B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E0_8822B) & BIT_MASK_HOST_MSG_E0_8822B) -+#define BIT_SET_HOST_MSG_E0_8822B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E0_8822B(x) | BIT_HOST_MSG_E0_8822B(v)) -+ -+/* 2 REG_HMEBOX_E2_E3_8822B */ -+ -+#define BIT_SHIFT_HOST_MSG_E3_8822B 16 -+#define BIT_MASK_HOST_MSG_E3_8822B 0xffff -+#define BIT_HOST_MSG_E3_8822B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E3_8822B) << BIT_SHIFT_HOST_MSG_E3_8822B) -+#define BITS_HOST_MSG_E3_8822B \ -+ (BIT_MASK_HOST_MSG_E3_8822B << BIT_SHIFT_HOST_MSG_E3_8822B) -+#define BIT_CLEAR_HOST_MSG_E3_8822B(x) ((x) & (~BITS_HOST_MSG_E3_8822B)) -+#define BIT_GET_HOST_MSG_E3_8822B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E3_8822B) & BIT_MASK_HOST_MSG_E3_8822B) -+#define BIT_SET_HOST_MSG_E3_8822B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E3_8822B(x) | BIT_HOST_MSG_E3_8822B(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E2_8822B 0 -+#define BIT_MASK_HOST_MSG_E2_8822B 0xffff -+#define BIT_HOST_MSG_E2_8822B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E2_8822B) << BIT_SHIFT_HOST_MSG_E2_8822B) -+#define BITS_HOST_MSG_E2_8822B \ -+ (BIT_MASK_HOST_MSG_E2_8822B << BIT_SHIFT_HOST_MSG_E2_8822B) -+#define BIT_CLEAR_HOST_MSG_E2_8822B(x) ((x) & (~BITS_HOST_MSG_E2_8822B)) -+#define BIT_GET_HOST_MSG_E2_8822B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E2_8822B) & BIT_MASK_HOST_MSG_E2_8822B) -+#define BIT_SET_HOST_MSG_E2_8822B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E2_8822B(x) | BIT_HOST_MSG_E2_8822B(v)) -+ -+/* 2 REG_WLLPS_CTRL_8822B */ -+#define BIT_WLLPSOP_EABM_8822B BIT(31) -+#define BIT_WLLPSOP_ACKF_8822B BIT(30) -+#define BIT_WLLPSOP_DLDM_8822B BIT(29) -+#define BIT_WLLPSOP_ESWR_8822B BIT(28) -+#define BIT_WLLPSOP_PWMM_8822B BIT(27) -+#define BIT_WLLPSOP_EECK_8822B BIT(26) -+#define BIT_WLLPSOP_WLMACOFF_8822B BIT(25) -+#define BIT_WLLPSOP_EXTAL_8822B BIT(24) -+#define BIT_WL_SYNPON_VOLTSPDN_8822B BIT(23) -+#define BIT_WLLPSOP_WLBBOFF_8822B BIT(22) -+#define BIT_WLLPSOP_WLMEM_DS_8822B BIT(21) -+ -+#define BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8822B 12 -+#define BIT_MASK_LPLDH12_VADJ_STEP_DN_8822B 0xf -+#define BIT_LPLDH12_VADJ_STEP_DN_8822B(x) \ -+ (((x) & BIT_MASK_LPLDH12_VADJ_STEP_DN_8822B) \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8822B) -+#define BITS_LPLDH12_VADJ_STEP_DN_8822B \ -+ (BIT_MASK_LPLDH12_VADJ_STEP_DN_8822B \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8822B) -+#define BIT_CLEAR_LPLDH12_VADJ_STEP_DN_8822B(x) \ -+ ((x) & (~BITS_LPLDH12_VADJ_STEP_DN_8822B)) -+#define BIT_GET_LPLDH12_VADJ_STEP_DN_8822B(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8822B) & \ -+ BIT_MASK_LPLDH12_VADJ_STEP_DN_8822B) -+#define BIT_SET_LPLDH12_VADJ_STEP_DN_8822B(x, v) \ -+ (BIT_CLEAR_LPLDH12_VADJ_STEP_DN_8822B(x) | \ -+ BIT_LPLDH12_VADJ_STEP_DN_8822B(v)) -+ -+#define BIT_SHIFT_V15ADJ_L1_STEP_DN_8822B 8 -+#define BIT_MASK_V15ADJ_L1_STEP_DN_8822B 0x7 -+#define BIT_V15ADJ_L1_STEP_DN_8822B(x) \ -+ (((x) & BIT_MASK_V15ADJ_L1_STEP_DN_8822B) \ -+ << BIT_SHIFT_V15ADJ_L1_STEP_DN_8822B) -+#define BITS_V15ADJ_L1_STEP_DN_8822B \ -+ (BIT_MASK_V15ADJ_L1_STEP_DN_8822B << BIT_SHIFT_V15ADJ_L1_STEP_DN_8822B) -+#define BIT_CLEAR_V15ADJ_L1_STEP_DN_8822B(x) \ -+ ((x) & (~BITS_V15ADJ_L1_STEP_DN_8822B)) -+#define BIT_GET_V15ADJ_L1_STEP_DN_8822B(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L1_STEP_DN_8822B) & \ -+ BIT_MASK_V15ADJ_L1_STEP_DN_8822B) -+#define BIT_SET_V15ADJ_L1_STEP_DN_8822B(x, v) \ -+ (BIT_CLEAR_V15ADJ_L1_STEP_DN_8822B(x) | BIT_V15ADJ_L1_STEP_DN_8822B(v)) -+ -+#define BIT_REGU_32K_CLK_EN_8822B BIT(1) -+#define BIT_WL_LPS_EN_8822B BIT(0) -+ -+/* 2 REG_AFE_CTRL5_8822B */ -+#define BIT_BB_DBG_SEL_AFE_SDM_BIT0_8822B BIT(31) -+#define BIT_ORDER_SDM_8822B BIT(30) -+#define BIT_RFE_SEL_SDM_8822B BIT(29) -+ -+#define BIT_SHIFT_REF_SEL_8822B 25 -+#define BIT_MASK_REF_SEL_8822B 0xf -+#define BIT_REF_SEL_8822B(x) \ -+ (((x) & BIT_MASK_REF_SEL_8822B) << BIT_SHIFT_REF_SEL_8822B) -+#define BITS_REF_SEL_8822B (BIT_MASK_REF_SEL_8822B << BIT_SHIFT_REF_SEL_8822B) -+#define BIT_CLEAR_REF_SEL_8822B(x) ((x) & (~BITS_REF_SEL_8822B)) -+#define BIT_GET_REF_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_REF_SEL_8822B) & BIT_MASK_REF_SEL_8822B) -+#define BIT_SET_REF_SEL_8822B(x, v) \ -+ (BIT_CLEAR_REF_SEL_8822B(x) | BIT_REF_SEL_8822B(v)) -+ -+#define BIT_SHIFT_F0F_SDM_8822B 12 -+#define BIT_MASK_F0F_SDM_8822B 0x1fff -+#define BIT_F0F_SDM_8822B(x) \ -+ (((x) & BIT_MASK_F0F_SDM_8822B) << BIT_SHIFT_F0F_SDM_8822B) -+#define BITS_F0F_SDM_8822B (BIT_MASK_F0F_SDM_8822B << BIT_SHIFT_F0F_SDM_8822B) -+#define BIT_CLEAR_F0F_SDM_8822B(x) ((x) & (~BITS_F0F_SDM_8822B)) -+#define BIT_GET_F0F_SDM_8822B(x) \ -+ (((x) >> BIT_SHIFT_F0F_SDM_8822B) & BIT_MASK_F0F_SDM_8822B) -+#define BIT_SET_F0F_SDM_8822B(x, v) \ -+ (BIT_CLEAR_F0F_SDM_8822B(x) | BIT_F0F_SDM_8822B(v)) -+ -+#define BIT_SHIFT_F0N_SDM_8822B 9 -+#define BIT_MASK_F0N_SDM_8822B 0x7 -+#define BIT_F0N_SDM_8822B(x) \ -+ (((x) & BIT_MASK_F0N_SDM_8822B) << BIT_SHIFT_F0N_SDM_8822B) -+#define BITS_F0N_SDM_8822B (BIT_MASK_F0N_SDM_8822B << BIT_SHIFT_F0N_SDM_8822B) -+#define BIT_CLEAR_F0N_SDM_8822B(x) ((x) & (~BITS_F0N_SDM_8822B)) -+#define BIT_GET_F0N_SDM_8822B(x) \ -+ (((x) >> BIT_SHIFT_F0N_SDM_8822B) & BIT_MASK_F0N_SDM_8822B) -+#define BIT_SET_F0N_SDM_8822B(x, v) \ -+ (BIT_CLEAR_F0N_SDM_8822B(x) | BIT_F0N_SDM_8822B(v)) -+ -+#define BIT_SHIFT_DIVN_SDM_8822B 3 -+#define BIT_MASK_DIVN_SDM_8822B 0x3f -+#define BIT_DIVN_SDM_8822B(x) \ -+ (((x) & BIT_MASK_DIVN_SDM_8822B) << BIT_SHIFT_DIVN_SDM_8822B) -+#define BITS_DIVN_SDM_8822B \ -+ (BIT_MASK_DIVN_SDM_8822B << BIT_SHIFT_DIVN_SDM_8822B) -+#define BIT_CLEAR_DIVN_SDM_8822B(x) ((x) & (~BITS_DIVN_SDM_8822B)) -+#define BIT_GET_DIVN_SDM_8822B(x) \ -+ (((x) >> BIT_SHIFT_DIVN_SDM_8822B) & BIT_MASK_DIVN_SDM_8822B) -+#define BIT_SET_DIVN_SDM_8822B(x, v) \ -+ (BIT_CLEAR_DIVN_SDM_8822B(x) | BIT_DIVN_SDM_8822B(v)) -+ -+/* 2 REG_GPIO_DEBOUNCE_CTRL_8822B */ -+#define BIT_WLGP_DBC1EN_8822B BIT(15) -+ -+#define BIT_SHIFT_WLGP_DBC1_8822B 8 -+#define BIT_MASK_WLGP_DBC1_8822B 0xf -+#define BIT_WLGP_DBC1_8822B(x) \ -+ (((x) & BIT_MASK_WLGP_DBC1_8822B) << BIT_SHIFT_WLGP_DBC1_8822B) -+#define BITS_WLGP_DBC1_8822B \ -+ (BIT_MASK_WLGP_DBC1_8822B << BIT_SHIFT_WLGP_DBC1_8822B) -+#define BIT_CLEAR_WLGP_DBC1_8822B(x) ((x) & (~BITS_WLGP_DBC1_8822B)) -+#define BIT_GET_WLGP_DBC1_8822B(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC1_8822B) & BIT_MASK_WLGP_DBC1_8822B) -+#define BIT_SET_WLGP_DBC1_8822B(x, v) \ -+ (BIT_CLEAR_WLGP_DBC1_8822B(x) | BIT_WLGP_DBC1_8822B(v)) -+ -+#define BIT_WLGP_DBC0EN_8822B BIT(7) -+ -+#define BIT_SHIFT_WLGP_DBC0_8822B 0 -+#define BIT_MASK_WLGP_DBC0_8822B 0xf -+#define BIT_WLGP_DBC0_8822B(x) \ -+ (((x) & BIT_MASK_WLGP_DBC0_8822B) << BIT_SHIFT_WLGP_DBC0_8822B) -+#define BITS_WLGP_DBC0_8822B \ -+ (BIT_MASK_WLGP_DBC0_8822B << BIT_SHIFT_WLGP_DBC0_8822B) -+#define BIT_CLEAR_WLGP_DBC0_8822B(x) ((x) & (~BITS_WLGP_DBC0_8822B)) -+#define BIT_GET_WLGP_DBC0_8822B(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC0_8822B) & BIT_MASK_WLGP_DBC0_8822B) -+#define BIT_SET_WLGP_DBC0_8822B(x, v) \ -+ (BIT_CLEAR_WLGP_DBC0_8822B(x) | BIT_WLGP_DBC0_8822B(v)) -+ -+/* 2 REG_RPWM2_8822B */ -+ -+#define BIT_SHIFT_RPWM2_8822B 16 -+#define BIT_MASK_RPWM2_8822B 0xffff -+#define BIT_RPWM2_8822B(x) \ -+ (((x) & BIT_MASK_RPWM2_8822B) << BIT_SHIFT_RPWM2_8822B) -+#define BITS_RPWM2_8822B (BIT_MASK_RPWM2_8822B << BIT_SHIFT_RPWM2_8822B) -+#define BIT_CLEAR_RPWM2_8822B(x) ((x) & (~BITS_RPWM2_8822B)) -+#define BIT_GET_RPWM2_8822B(x) \ -+ (((x) >> BIT_SHIFT_RPWM2_8822B) & BIT_MASK_RPWM2_8822B) -+#define BIT_SET_RPWM2_8822B(x, v) \ -+ (BIT_CLEAR_RPWM2_8822B(x) | BIT_RPWM2_8822B(v)) -+ -+/* 2 REG_SYSON_FSM_MON_8822B */ -+ -+#define BIT_SHIFT_FSM_MON_SEL_8822B 24 -+#define BIT_MASK_FSM_MON_SEL_8822B 0x7 -+#define BIT_FSM_MON_SEL_8822B(x) \ -+ (((x) & BIT_MASK_FSM_MON_SEL_8822B) << BIT_SHIFT_FSM_MON_SEL_8822B) -+#define BITS_FSM_MON_SEL_8822B \ -+ (BIT_MASK_FSM_MON_SEL_8822B << BIT_SHIFT_FSM_MON_SEL_8822B) -+#define BIT_CLEAR_FSM_MON_SEL_8822B(x) ((x) & (~BITS_FSM_MON_SEL_8822B)) -+#define BIT_GET_FSM_MON_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_FSM_MON_SEL_8822B) & BIT_MASK_FSM_MON_SEL_8822B) -+#define BIT_SET_FSM_MON_SEL_8822B(x, v) \ -+ (BIT_CLEAR_FSM_MON_SEL_8822B(x) | BIT_FSM_MON_SEL_8822B(v)) -+ -+#define BIT_DOP_ELDO_8822B BIT(23) -+#define BIT_FSM_MON_UPD_8822B BIT(15) -+ -+#define BIT_SHIFT_FSM_PAR_8822B 0 -+#define BIT_MASK_FSM_PAR_8822B 0x7fff -+#define BIT_FSM_PAR_8822B(x) \ -+ (((x) & BIT_MASK_FSM_PAR_8822B) << BIT_SHIFT_FSM_PAR_8822B) -+#define BITS_FSM_PAR_8822B (BIT_MASK_FSM_PAR_8822B << BIT_SHIFT_FSM_PAR_8822B) -+#define BIT_CLEAR_FSM_PAR_8822B(x) ((x) & (~BITS_FSM_PAR_8822B)) -+#define BIT_GET_FSM_PAR_8822B(x) \ -+ (((x) >> BIT_SHIFT_FSM_PAR_8822B) & BIT_MASK_FSM_PAR_8822B) -+#define BIT_SET_FSM_PAR_8822B(x, v) \ -+ (BIT_CLEAR_FSM_PAR_8822B(x) | BIT_FSM_PAR_8822B(v)) -+ -+/* 2 REG_AFE_CTRL6_8822B */ -+ -+#define BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B 0 -+#define BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B 0x7 -+#define BIT_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B(x) \ -+ (((x) & BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B) \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B) -+#define BITS_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B \ -+ (BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B \ -+ << BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B) -+#define BIT_CLEAR_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B(x) \ -+ ((x) & (~BITS_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B)) -+#define BIT_GET_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B) & \ -+ BIT_MASK_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B) -+#define BIT_SET_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B(x, v) \ -+ (BIT_CLEAR_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B(x) | \ -+ BIT_BB_DBG_SEL_AFE_SDM_BIT3_1_8822B(v)) -+ -+/* 2 REG_PMC_DBG_CTRL1_8822B */ -+#define BIT_BT_INT_EN_8822B BIT(31) -+ -+#define BIT_SHIFT_RD_WR_WIFI_BT_INFO_8822B 16 -+#define BIT_MASK_RD_WR_WIFI_BT_INFO_8822B 0x7fff -+#define BIT_RD_WR_WIFI_BT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_RD_WR_WIFI_BT_INFO_8822B) \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8822B) -+#define BITS_RD_WR_WIFI_BT_INFO_8822B \ -+ (BIT_MASK_RD_WR_WIFI_BT_INFO_8822B \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8822B) -+#define BIT_CLEAR_RD_WR_WIFI_BT_INFO_8822B(x) \ -+ ((x) & (~BITS_RD_WR_WIFI_BT_INFO_8822B)) -+#define BIT_GET_RD_WR_WIFI_BT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_RD_WR_WIFI_BT_INFO_8822B) & \ -+ BIT_MASK_RD_WR_WIFI_BT_INFO_8822B) -+#define BIT_SET_RD_WR_WIFI_BT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_RD_WR_WIFI_BT_INFO_8822B(x) | \ -+ BIT_RD_WR_WIFI_BT_INFO_8822B(v)) -+ -+#define BIT_PMC_WR_OVF_8822B BIT(8) -+ -+#define BIT_SHIFT_WLPMC_ERRINT_8822B 0 -+#define BIT_MASK_WLPMC_ERRINT_8822B 0xff -+#define BIT_WLPMC_ERRINT_8822B(x) \ -+ (((x) & BIT_MASK_WLPMC_ERRINT_8822B) << BIT_SHIFT_WLPMC_ERRINT_8822B) -+#define BITS_WLPMC_ERRINT_8822B \ -+ (BIT_MASK_WLPMC_ERRINT_8822B << BIT_SHIFT_WLPMC_ERRINT_8822B) -+#define BIT_CLEAR_WLPMC_ERRINT_8822B(x) ((x) & (~BITS_WLPMC_ERRINT_8822B)) -+#define BIT_GET_WLPMC_ERRINT_8822B(x) \ -+ (((x) >> BIT_SHIFT_WLPMC_ERRINT_8822B) & BIT_MASK_WLPMC_ERRINT_8822B) -+#define BIT_SET_WLPMC_ERRINT_8822B(x, v) \ -+ (BIT_CLEAR_WLPMC_ERRINT_8822B(x) | BIT_WLPMC_ERRINT_8822B(v)) -+ -+/* 2 REG_AFE_CTRL7_8822B */ -+ -+#define BIT_SHIFT_SEL_V_8822B 30 -+#define BIT_MASK_SEL_V_8822B 0x3 -+#define BIT_SEL_V_8822B(x) \ -+ (((x) & BIT_MASK_SEL_V_8822B) << BIT_SHIFT_SEL_V_8822B) -+#define BITS_SEL_V_8822B (BIT_MASK_SEL_V_8822B << BIT_SHIFT_SEL_V_8822B) -+#define BIT_CLEAR_SEL_V_8822B(x) ((x) & (~BITS_SEL_V_8822B)) -+#define BIT_GET_SEL_V_8822B(x) \ -+ (((x) >> BIT_SHIFT_SEL_V_8822B) & BIT_MASK_SEL_V_8822B) -+#define BIT_SET_SEL_V_8822B(x, v) \ -+ (BIT_CLEAR_SEL_V_8822B(x) | BIT_SEL_V_8822B(v)) -+ -+#define BIT_SEL_LDO_PC_8822B BIT(29) -+ -+#define BIT_SHIFT_CK_MON_SEL_8822B 26 -+#define BIT_MASK_CK_MON_SEL_8822B 0x7 -+#define BIT_CK_MON_SEL_8822B(x) \ -+ (((x) & BIT_MASK_CK_MON_SEL_8822B) << BIT_SHIFT_CK_MON_SEL_8822B) -+#define BITS_CK_MON_SEL_8822B \ -+ (BIT_MASK_CK_MON_SEL_8822B << BIT_SHIFT_CK_MON_SEL_8822B) -+#define BIT_CLEAR_CK_MON_SEL_8822B(x) ((x) & (~BITS_CK_MON_SEL_8822B)) -+#define BIT_GET_CK_MON_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_CK_MON_SEL_8822B) & BIT_MASK_CK_MON_SEL_8822B) -+#define BIT_SET_CK_MON_SEL_8822B(x, v) \ -+ (BIT_CLEAR_CK_MON_SEL_8822B(x) | BIT_CK_MON_SEL_8822B(v)) -+ -+#define BIT_CK_MON_EN_8822B BIT(25) -+#define BIT_FREF_EDGE_8822B BIT(24) -+#define BIT_CK320M_EN_8822B BIT(23) -+#define BIT_CK_5M_EN_8822B BIT(22) -+#define BIT_TESTEN_8822B BIT(21) -+ -+/* 2 REG_HIMR0_8822B */ -+#define BIT_TIMEOUT_INTERRUPT2_MASK_8822B BIT(31) -+#define BIT_TIMEOUT_INTERRUTP1_MASK_8822B BIT(30) -+#define BIT_PSTIMEOUT_MSK_8822B BIT(29) -+#define BIT_GTINT4_MSK_8822B BIT(28) -+#define BIT_GTINT3_MSK_8822B BIT(27) -+#define BIT_TXBCN0ERR_MSK_8822B BIT(26) -+#define BIT_TXBCN0OK_MSK_8822B BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_MSK_8822B BIT(24) -+#define BIT_BCNDMAINT0_MSK_8822B BIT(20) -+#define BIT_BCNDERR0_MSK_8822B BIT(16) -+#define BIT_HSISR_IND_ON_INT_MSK_8822B BIT(15) -+#define BIT_HISR3_IND_INT_MSK_8822B BIT(14) -+#define BIT_HISR2_IND_INT_MSK_8822B BIT(13) -+#define BIT_HISR1_IND_MSK_8822B BIT(11) -+#define BIT_C2HCMD_MSK_8822B BIT(10) -+#define BIT_CPWM2_MSK_8822B BIT(9) -+#define BIT_CPWM_MSK_8822B BIT(8) -+#define BIT_HIGHDOK_MSK_8822B BIT(7) -+#define BIT_MGTDOK_MSK_8822B BIT(6) -+#define BIT_BKDOK_MSK_8822B BIT(5) -+#define BIT_BEDOK_MSK_8822B BIT(4) -+#define BIT_VIDOK_MSK_8822B BIT(3) -+#define BIT_VODOK_MSK_8822B BIT(2) -+#define BIT_RDU_MSK_8822B BIT(1) -+#define BIT_RXOK_MSK_8822B BIT(0) -+ -+/* 2 REG_HISR0_8822B */ -+#define BIT_PSTIMEOUT2_8822B BIT(31) -+#define BIT_PSTIMEOUT1_8822B BIT(30) -+#define BIT_PSTIMEOUT_8822B BIT(29) -+#define BIT_GTINT4_8822B BIT(28) -+#define BIT_GTINT3_8822B BIT(27) -+#define BIT_TXBCN0ERR_8822B BIT(26) -+#define BIT_TXBCN0OK_8822B BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_8822B BIT(24) -+#define BIT_BCNDMAINT0_8822B BIT(20) -+#define BIT_BCNDERR0_8822B BIT(16) -+#define BIT_HSISR_IND_ON_INT_8822B BIT(15) -+#define BIT_HISR3_IND_INT_8822B BIT(14) -+#define BIT_HISR2_IND_INT_8822B BIT(13) -+#define BIT_HISR1_IND_INT_8822B BIT(11) -+#define BIT_C2HCMD_8822B BIT(10) -+#define BIT_CPWM2_8822B BIT(9) -+#define BIT_CPWM_8822B BIT(8) -+#define BIT_HIGHDOK_8822B BIT(7) -+#define BIT_MGTDOK_8822B BIT(6) -+#define BIT_BKDOK_8822B BIT(5) -+#define BIT_BEDOK_8822B BIT(4) -+#define BIT_VIDOK_8822B BIT(3) -+#define BIT_VODOK_8822B BIT(2) -+#define BIT_RDU_8822B BIT(1) -+#define BIT_RXOK_8822B BIT(0) -+ -+/* 2 REG_HIMR1_8822B */ -+#define BIT_TXFIFO_TH_INT_8822B BIT(30) -+#define BIT_BTON_STS_UPDATE_MASK_8822B BIT(29) -+#define BIT_BCNDMAINT7__MSK_8822B BIT(27) -+#define BIT_BCNDMAINT6__MSK_8822B BIT(26) -+#define BIT_BCNDMAINT5__MSK_8822B BIT(25) -+#define BIT_BCNDMAINT4__MSK_8822B BIT(24) -+#define BIT_BCNDMAINT3_MSK_8822B BIT(23) -+#define BIT_BCNDMAINT2_MSK_8822B BIT(22) -+#define BIT_BCNDMAINT1_MSK_8822B BIT(21) -+#define BIT_BCNDERR7_MSK_8822B BIT(20) -+#define BIT_BCNDERR6_MSK_8822B BIT(19) -+#define BIT_BCNDERR5_MSK_8822B BIT(18) -+#define BIT_BCNDERR4_MSK_8822B BIT(17) -+#define BIT_BCNDERR3_MSK_8822B BIT(16) -+#define BIT_BCNDERR2_MSK_8822B BIT(15) -+#define BIT_BCNDERR1_MSK_8822B BIT(14) -+#define BIT_ATIMEND_E_V1_MSK_8822B BIT(12) -+#define BIT_TXERR_MSK_8822B BIT(11) -+#define BIT_RXERR_MSK_8822B BIT(10) -+#define BIT_TXFOVW_MSK_8822B BIT(9) -+#define BIT_FOVW_MSK_8822B BIT(8) -+#define BIT_CPU_MGQ_TXDONE_MSK_8822B BIT(5) -+#define BIT_PS_TIMER_C_MSK_8822B BIT(4) -+#define BIT_PS_TIMER_B_MSK_8822B BIT(3) -+#define BIT_PS_TIMER_A_MSK_8822B BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_MSK_8822B BIT(1) -+ -+/* 2 REG_HISR1_8822B */ -+#define BIT_TXFIFO_TH_INT_8822B BIT(30) -+#define BIT_BTON_STS_UPDATE_INT_8822B BIT(29) -+#define BIT_BCNDMAINT7_8822B BIT(27) -+#define BIT_BCNDMAINT6_8822B BIT(26) -+#define BIT_BCNDMAINT5_8822B BIT(25) -+#define BIT_BCNDMAINT4_8822B BIT(24) -+#define BIT_BCNDMAINT3_8822B BIT(23) -+#define BIT_BCNDMAINT2_8822B BIT(22) -+#define BIT_BCNDMAINT1_8822B BIT(21) -+#define BIT_BCNDERR7_8822B BIT(20) -+#define BIT_BCNDERR6_8822B BIT(19) -+#define BIT_BCNDERR5_8822B BIT(18) -+#define BIT_BCNDERR4_8822B BIT(17) -+#define BIT_BCNDERR3_8822B BIT(16) -+#define BIT_BCNDERR2_8822B BIT(15) -+#define BIT_BCNDERR1_8822B BIT(14) -+#define BIT_ATIMEND_E_V1_INT_8822B BIT(12) -+#define BIT_TXERR_INT_8822B BIT(11) -+#define BIT_RXERR_INT_8822B BIT(10) -+#define BIT_TXFOVW_8822B BIT(9) -+#define BIT_FOVW_8822B BIT(8) -+#define BIT_CPU_MGQ_TXDONE_8822B BIT(5) -+#define BIT_PS_TIMER_C_8822B BIT(4) -+#define BIT_PS_TIMER_B_8822B BIT(3) -+#define BIT_PS_TIMER_A_8822B BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_8822B BIT(1) -+ -+/* 2 REG_DBG_PORT_SEL_8822B */ -+ -+#define BIT_SHIFT_DEBUG_ST_8822B 0 -+#define BIT_MASK_DEBUG_ST_8822B 0xffffffffL -+#define BIT_DEBUG_ST_8822B(x) \ -+ (((x) & BIT_MASK_DEBUG_ST_8822B) << BIT_SHIFT_DEBUG_ST_8822B) -+#define BITS_DEBUG_ST_8822B \ -+ (BIT_MASK_DEBUG_ST_8822B << BIT_SHIFT_DEBUG_ST_8822B) -+#define BIT_CLEAR_DEBUG_ST_8822B(x) ((x) & (~BITS_DEBUG_ST_8822B)) -+#define BIT_GET_DEBUG_ST_8822B(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_ST_8822B) & BIT_MASK_DEBUG_ST_8822B) -+#define BIT_SET_DEBUG_ST_8822B(x, v) \ -+ (BIT_CLEAR_DEBUG_ST_8822B(x) | BIT_DEBUG_ST_8822B(v)) -+ -+/* 2 REG_PAD_CTRL2_8822B */ -+#define BIT_USB3_USB2_TRANSITION_8822B BIT(20) -+ -+#define BIT_SHIFT_USB23_SW_MODE_V1_8822B 18 -+#define BIT_MASK_USB23_SW_MODE_V1_8822B 0x3 -+#define BIT_USB23_SW_MODE_V1_8822B(x) \ -+ (((x) & BIT_MASK_USB23_SW_MODE_V1_8822B) \ -+ << BIT_SHIFT_USB23_SW_MODE_V1_8822B) -+#define BITS_USB23_SW_MODE_V1_8822B \ -+ (BIT_MASK_USB23_SW_MODE_V1_8822B << BIT_SHIFT_USB23_SW_MODE_V1_8822B) -+#define BIT_CLEAR_USB23_SW_MODE_V1_8822B(x) \ -+ ((x) & (~BITS_USB23_SW_MODE_V1_8822B)) -+#define BIT_GET_USB23_SW_MODE_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_USB23_SW_MODE_V1_8822B) & \ -+ BIT_MASK_USB23_SW_MODE_V1_8822B) -+#define BIT_SET_USB23_SW_MODE_V1_8822B(x, v) \ -+ (BIT_CLEAR_USB23_SW_MODE_V1_8822B(x) | BIT_USB23_SW_MODE_V1_8822B(v)) -+ -+#define BIT_NO_PDN_CHIPOFF_V1_8822B BIT(17) -+#define BIT_RSM_EN_V1_8822B BIT(16) -+ -+#define BIT_SHIFT_MATCH_CNT_8822B 8 -+#define BIT_MASK_MATCH_CNT_8822B 0xff -+#define BIT_MATCH_CNT_8822B(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8822B) << BIT_SHIFT_MATCH_CNT_8822B) -+#define BITS_MATCH_CNT_8822B \ -+ (BIT_MASK_MATCH_CNT_8822B << BIT_SHIFT_MATCH_CNT_8822B) -+#define BIT_CLEAR_MATCH_CNT_8822B(x) ((x) & (~BITS_MATCH_CNT_8822B)) -+#define BIT_GET_MATCH_CNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8822B) & BIT_MASK_MATCH_CNT_8822B) -+#define BIT_SET_MATCH_CNT_8822B(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8822B(x) | BIT_MATCH_CNT_8822B(v)) -+ -+#define BIT_LD_B12V_EN_8822B BIT(7) -+#define BIT_EECS_IOSEL_V1_8822B BIT(6) -+#define BIT_EECS_DATA_O_V1_8822B BIT(5) -+#define BIT_EECS_DATA_I_V1_8822B BIT(4) -+#define BIT_EESK_IOSEL_V1_8822B BIT(2) -+#define BIT_EESK_DATA_O_V1_8822B BIT(1) -+#define BIT_EESK_DATA_I_V1_8822B BIT(0) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_PMC_DBG_CTRL2_8822B */ -+ -+#define BIT_SHIFT_EFUSE_BURN_GNT_8822B 24 -+#define BIT_MASK_EFUSE_BURN_GNT_8822B 0xff -+#define BIT_EFUSE_BURN_GNT_8822B(x) \ -+ (((x) & BIT_MASK_EFUSE_BURN_GNT_8822B) \ -+ << BIT_SHIFT_EFUSE_BURN_GNT_8822B) -+#define BITS_EFUSE_BURN_GNT_8822B \ -+ (BIT_MASK_EFUSE_BURN_GNT_8822B << BIT_SHIFT_EFUSE_BURN_GNT_8822B) -+#define BIT_CLEAR_EFUSE_BURN_GNT_8822B(x) ((x) & (~BITS_EFUSE_BURN_GNT_8822B)) -+#define BIT_GET_EFUSE_BURN_GNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_EFUSE_BURN_GNT_8822B) & \ -+ BIT_MASK_EFUSE_BURN_GNT_8822B) -+#define BIT_SET_EFUSE_BURN_GNT_8822B(x, v) \ -+ (BIT_CLEAR_EFUSE_BURN_GNT_8822B(x) | BIT_EFUSE_BURN_GNT_8822B(v)) -+ -+#define BIT_STOP_WL_PMC_8822B BIT(9) -+#define BIT_STOP_SYM_PMC_8822B BIT(8) -+#define BIT_REG_RST_WLPMC_8822B BIT(5) -+#define BIT_REG_RST_PD12N_8822B BIT(4) -+#define BIT_SYSON_DIS_WLREG_WRMSK_8822B BIT(3) -+#define BIT_SYSON_DIS_PMCREG_WRMSK_8822B BIT(2) -+ -+#define BIT_SHIFT_SYSON_REG_ARB_8822B 0 -+#define BIT_MASK_SYSON_REG_ARB_8822B 0x3 -+#define BIT_SYSON_REG_ARB_8822B(x) \ -+ (((x) & BIT_MASK_SYSON_REG_ARB_8822B) << BIT_SHIFT_SYSON_REG_ARB_8822B) -+#define BITS_SYSON_REG_ARB_8822B \ -+ (BIT_MASK_SYSON_REG_ARB_8822B << BIT_SHIFT_SYSON_REG_ARB_8822B) -+#define BIT_CLEAR_SYSON_REG_ARB_8822B(x) ((x) & (~BITS_SYSON_REG_ARB_8822B)) -+#define BIT_GET_SYSON_REG_ARB_8822B(x) \ -+ (((x) >> BIT_SHIFT_SYSON_REG_ARB_8822B) & BIT_MASK_SYSON_REG_ARB_8822B) -+#define BIT_SET_SYSON_REG_ARB_8822B(x, v) \ -+ (BIT_CLEAR_SYSON_REG_ARB_8822B(x) | BIT_SYSON_REG_ARB_8822B(v)) -+ -+/* 2 REG_BIST_CTRL_8822B */ -+#define BIT_BIST_USB_DIS_8822B BIT(27) -+#define BIT_BIST_PCI_DIS_8822B BIT(26) -+#define BIT_BIST_BT_DIS_8822B BIT(25) -+#define BIT_BIST_WL_DIS_8822B BIT(24) -+ -+#define BIT_SHIFT_BIST_RPT_SEL_8822B 16 -+#define BIT_MASK_BIST_RPT_SEL_8822B 0xf -+#define BIT_BIST_RPT_SEL_8822B(x) \ -+ (((x) & BIT_MASK_BIST_RPT_SEL_8822B) << BIT_SHIFT_BIST_RPT_SEL_8822B) -+#define BITS_BIST_RPT_SEL_8822B \ -+ (BIT_MASK_BIST_RPT_SEL_8822B << BIT_SHIFT_BIST_RPT_SEL_8822B) -+#define BIT_CLEAR_BIST_RPT_SEL_8822B(x) ((x) & (~BITS_BIST_RPT_SEL_8822B)) -+#define BIT_GET_BIST_RPT_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_BIST_RPT_SEL_8822B) & BIT_MASK_BIST_RPT_SEL_8822B) -+#define BIT_SET_BIST_RPT_SEL_8822B(x, v) \ -+ (BIT_CLEAR_BIST_RPT_SEL_8822B(x) | BIT_BIST_RPT_SEL_8822B(v)) -+ -+#define BIT_BIST_RESUME_PS_8822B BIT(4) -+#define BIT_BIST_RESUME_8822B BIT(3) -+#define BIT_BIST_NORMAL_8822B BIT(2) -+#define BIT_BIST_RSTN_8822B BIT(1) -+#define BIT_BIST_CLK_EN_8822B BIT(0) -+ -+/* 2 REG_BIST_RPT_8822B */ -+ -+#define BIT_SHIFT_MBIST_REPORT_8822B 0 -+#define BIT_MASK_MBIST_REPORT_8822B 0xffffffffL -+#define BIT_MBIST_REPORT_8822B(x) \ -+ (((x) & BIT_MASK_MBIST_REPORT_8822B) << BIT_SHIFT_MBIST_REPORT_8822B) -+#define BITS_MBIST_REPORT_8822B \ -+ (BIT_MASK_MBIST_REPORT_8822B << BIT_SHIFT_MBIST_REPORT_8822B) -+#define BIT_CLEAR_MBIST_REPORT_8822B(x) ((x) & (~BITS_MBIST_REPORT_8822B)) -+#define BIT_GET_MBIST_REPORT_8822B(x) \ -+ (((x) >> BIT_SHIFT_MBIST_REPORT_8822B) & BIT_MASK_MBIST_REPORT_8822B) -+#define BIT_SET_MBIST_REPORT_8822B(x, v) \ -+ (BIT_CLEAR_MBIST_REPORT_8822B(x) | BIT_MBIST_REPORT_8822B(v)) -+ -+/* 2 REG_MEM_CTRL_8822B */ -+#define BIT_UMEM_RME_8822B BIT(31) -+ -+#define BIT_SHIFT_BT_SPRAM_8822B 28 -+#define BIT_MASK_BT_SPRAM_8822B 0x3 -+#define BIT_BT_SPRAM_8822B(x) \ -+ (((x) & BIT_MASK_BT_SPRAM_8822B) << BIT_SHIFT_BT_SPRAM_8822B) -+#define BITS_BT_SPRAM_8822B \ -+ (BIT_MASK_BT_SPRAM_8822B << BIT_SHIFT_BT_SPRAM_8822B) -+#define BIT_CLEAR_BT_SPRAM_8822B(x) ((x) & (~BITS_BT_SPRAM_8822B)) -+#define BIT_GET_BT_SPRAM_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_SPRAM_8822B) & BIT_MASK_BT_SPRAM_8822B) -+#define BIT_SET_BT_SPRAM_8822B(x, v) \ -+ (BIT_CLEAR_BT_SPRAM_8822B(x) | BIT_BT_SPRAM_8822B(v)) -+ -+#define BIT_SHIFT_BT_ROM_8822B 24 -+#define BIT_MASK_BT_ROM_8822B 0xf -+#define BIT_BT_ROM_8822B(x) \ -+ (((x) & BIT_MASK_BT_ROM_8822B) << BIT_SHIFT_BT_ROM_8822B) -+#define BITS_BT_ROM_8822B (BIT_MASK_BT_ROM_8822B << BIT_SHIFT_BT_ROM_8822B) -+#define BIT_CLEAR_BT_ROM_8822B(x) ((x) & (~BITS_BT_ROM_8822B)) -+#define BIT_GET_BT_ROM_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_ROM_8822B) & BIT_MASK_BT_ROM_8822B) -+#define BIT_SET_BT_ROM_8822B(x, v) \ -+ (BIT_CLEAR_BT_ROM_8822B(x) | BIT_BT_ROM_8822B(v)) -+ -+#define BIT_SHIFT_PCI_DPRAM_8822B 10 -+#define BIT_MASK_PCI_DPRAM_8822B 0x3 -+#define BIT_PCI_DPRAM_8822B(x) \ -+ (((x) & BIT_MASK_PCI_DPRAM_8822B) << BIT_SHIFT_PCI_DPRAM_8822B) -+#define BITS_PCI_DPRAM_8822B \ -+ (BIT_MASK_PCI_DPRAM_8822B << BIT_SHIFT_PCI_DPRAM_8822B) -+#define BIT_CLEAR_PCI_DPRAM_8822B(x) ((x) & (~BITS_PCI_DPRAM_8822B)) -+#define BIT_GET_PCI_DPRAM_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCI_DPRAM_8822B) & BIT_MASK_PCI_DPRAM_8822B) -+#define BIT_SET_PCI_DPRAM_8822B(x, v) \ -+ (BIT_CLEAR_PCI_DPRAM_8822B(x) | BIT_PCI_DPRAM_8822B(v)) -+ -+#define BIT_SHIFT_PCI_SPRAM_8822B 8 -+#define BIT_MASK_PCI_SPRAM_8822B 0x3 -+#define BIT_PCI_SPRAM_8822B(x) \ -+ (((x) & BIT_MASK_PCI_SPRAM_8822B) << BIT_SHIFT_PCI_SPRAM_8822B) -+#define BITS_PCI_SPRAM_8822B \ -+ (BIT_MASK_PCI_SPRAM_8822B << BIT_SHIFT_PCI_SPRAM_8822B) -+#define BIT_CLEAR_PCI_SPRAM_8822B(x) ((x) & (~BITS_PCI_SPRAM_8822B)) -+#define BIT_GET_PCI_SPRAM_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCI_SPRAM_8822B) & BIT_MASK_PCI_SPRAM_8822B) -+#define BIT_SET_PCI_SPRAM_8822B(x, v) \ -+ (BIT_CLEAR_PCI_SPRAM_8822B(x) | BIT_PCI_SPRAM_8822B(v)) -+ -+#define BIT_SHIFT_USB_SPRAM_8822B 6 -+#define BIT_MASK_USB_SPRAM_8822B 0x3 -+#define BIT_USB_SPRAM_8822B(x) \ -+ (((x) & BIT_MASK_USB_SPRAM_8822B) << BIT_SHIFT_USB_SPRAM_8822B) -+#define BITS_USB_SPRAM_8822B \ -+ (BIT_MASK_USB_SPRAM_8822B << BIT_SHIFT_USB_SPRAM_8822B) -+#define BIT_CLEAR_USB_SPRAM_8822B(x) ((x) & (~BITS_USB_SPRAM_8822B)) -+#define BIT_GET_USB_SPRAM_8822B(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRAM_8822B) & BIT_MASK_USB_SPRAM_8822B) -+#define BIT_SET_USB_SPRAM_8822B(x, v) \ -+ (BIT_CLEAR_USB_SPRAM_8822B(x) | BIT_USB_SPRAM_8822B(v)) -+ -+#define BIT_SHIFT_USB_SPRF_8822B 4 -+#define BIT_MASK_USB_SPRF_8822B 0x3 -+#define BIT_USB_SPRF_8822B(x) \ -+ (((x) & BIT_MASK_USB_SPRF_8822B) << BIT_SHIFT_USB_SPRF_8822B) -+#define BITS_USB_SPRF_8822B \ -+ (BIT_MASK_USB_SPRF_8822B << BIT_SHIFT_USB_SPRF_8822B) -+#define BIT_CLEAR_USB_SPRF_8822B(x) ((x) & (~BITS_USB_SPRF_8822B)) -+#define BIT_GET_USB_SPRF_8822B(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRF_8822B) & BIT_MASK_USB_SPRF_8822B) -+#define BIT_SET_USB_SPRF_8822B(x, v) \ -+ (BIT_CLEAR_USB_SPRF_8822B(x) | BIT_USB_SPRF_8822B(v)) -+ -+#define BIT_SHIFT_MCU_ROM_8822B 0 -+#define BIT_MASK_MCU_ROM_8822B 0xf -+#define BIT_MCU_ROM_8822B(x) \ -+ (((x) & BIT_MASK_MCU_ROM_8822B) << BIT_SHIFT_MCU_ROM_8822B) -+#define BITS_MCU_ROM_8822B (BIT_MASK_MCU_ROM_8822B << BIT_SHIFT_MCU_ROM_8822B) -+#define BIT_CLEAR_MCU_ROM_8822B(x) ((x) & (~BITS_MCU_ROM_8822B)) -+#define BIT_GET_MCU_ROM_8822B(x) \ -+ (((x) >> BIT_SHIFT_MCU_ROM_8822B) & BIT_MASK_MCU_ROM_8822B) -+#define BIT_SET_MCU_ROM_8822B(x, v) \ -+ (BIT_CLEAR_MCU_ROM_8822B(x) | BIT_MCU_ROM_8822B(v)) -+ -+/* 2 REG_AFE_CTRL8_8822B */ -+#define BIT_SYN_AGPIO_8822B BIT(20) -+#define BIT_XTAL_LP_8822B BIT(4) -+#define BIT_XTAL_GM_SEP_8822B BIT(3) -+ -+#define BIT_SHIFT_XTAL_SEL_TOK_8822B 0 -+#define BIT_MASK_XTAL_SEL_TOK_8822B 0x7 -+#define BIT_XTAL_SEL_TOK_8822B(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_TOK_8822B) << BIT_SHIFT_XTAL_SEL_TOK_8822B) -+#define BITS_XTAL_SEL_TOK_8822B \ -+ (BIT_MASK_XTAL_SEL_TOK_8822B << BIT_SHIFT_XTAL_SEL_TOK_8822B) -+#define BIT_CLEAR_XTAL_SEL_TOK_8822B(x) ((x) & (~BITS_XTAL_SEL_TOK_8822B)) -+#define BIT_GET_XTAL_SEL_TOK_8822B(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_TOK_8822B) & BIT_MASK_XTAL_SEL_TOK_8822B) -+#define BIT_SET_XTAL_SEL_TOK_8822B(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_TOK_8822B(x) | BIT_XTAL_SEL_TOK_8822B(v)) -+ -+/* 2 REG_USB_SIE_INTF_8822B */ -+#define BIT_RD_SEL_8822B BIT(31) -+#define BIT_USB_SIE_INTF_WE_V1_8822B BIT(30) -+#define BIT_USB_SIE_INTF_BYIOREG_V1_8822B BIT(29) -+#define BIT_USB_SIE_SELECT_8822B BIT(28) -+ -+#define BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8822B 16 -+#define BIT_MASK_USB_SIE_INTF_ADDR_V1_8822B 0x1ff -+#define BIT_USB_SIE_INTF_ADDR_V1_8822B(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_ADDR_V1_8822B) \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8822B) -+#define BITS_USB_SIE_INTF_ADDR_V1_8822B \ -+ (BIT_MASK_USB_SIE_INTF_ADDR_V1_8822B \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8822B) -+#define BIT_CLEAR_USB_SIE_INTF_ADDR_V1_8822B(x) \ -+ ((x) & (~BITS_USB_SIE_INTF_ADDR_V1_8822B)) -+#define BIT_GET_USB_SIE_INTF_ADDR_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8822B) & \ -+ BIT_MASK_USB_SIE_INTF_ADDR_V1_8822B) -+#define BIT_SET_USB_SIE_INTF_ADDR_V1_8822B(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_ADDR_V1_8822B(x) | \ -+ BIT_USB_SIE_INTF_ADDR_V1_8822B(v)) -+ -+#define BIT_SHIFT_USB_SIE_INTF_RD_8822B 8 -+#define BIT_MASK_USB_SIE_INTF_RD_8822B 0xff -+#define BIT_USB_SIE_INTF_RD_8822B(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_RD_8822B) \ -+ << BIT_SHIFT_USB_SIE_INTF_RD_8822B) -+#define BITS_USB_SIE_INTF_RD_8822B \ -+ (BIT_MASK_USB_SIE_INTF_RD_8822B << BIT_SHIFT_USB_SIE_INTF_RD_8822B) -+#define BIT_CLEAR_USB_SIE_INTF_RD_8822B(x) ((x) & (~BITS_USB_SIE_INTF_RD_8822B)) -+#define BIT_GET_USB_SIE_INTF_RD_8822B(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_RD_8822B) & \ -+ BIT_MASK_USB_SIE_INTF_RD_8822B) -+#define BIT_SET_USB_SIE_INTF_RD_8822B(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_RD_8822B(x) | BIT_USB_SIE_INTF_RD_8822B(v)) -+ -+#define BIT_SHIFT_USB_SIE_INTF_WD_8822B 0 -+#define BIT_MASK_USB_SIE_INTF_WD_8822B 0xff -+#define BIT_USB_SIE_INTF_WD_8822B(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_WD_8822B) \ -+ << BIT_SHIFT_USB_SIE_INTF_WD_8822B) -+#define BITS_USB_SIE_INTF_WD_8822B \ -+ (BIT_MASK_USB_SIE_INTF_WD_8822B << BIT_SHIFT_USB_SIE_INTF_WD_8822B) -+#define BIT_CLEAR_USB_SIE_INTF_WD_8822B(x) ((x) & (~BITS_USB_SIE_INTF_WD_8822B)) -+#define BIT_GET_USB_SIE_INTF_WD_8822B(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_WD_8822B) & \ -+ BIT_MASK_USB_SIE_INTF_WD_8822B) -+#define BIT_SET_USB_SIE_INTF_WD_8822B(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_WD_8822B(x) | BIT_USB_SIE_INTF_WD_8822B(v)) -+ -+/* 2 REG_PCIE_MIO_INTF_8822B */ -+#define BIT_PCIE_MIO_BYIOREG_8822B BIT(13) -+#define BIT_PCIE_MIO_RE_8822B BIT(12) -+ -+#define BIT_SHIFT_PCIE_MIO_WE_8822B 8 -+#define BIT_MASK_PCIE_MIO_WE_8822B 0xf -+#define BIT_PCIE_MIO_WE_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_WE_8822B) << BIT_SHIFT_PCIE_MIO_WE_8822B) -+#define BITS_PCIE_MIO_WE_8822B \ -+ (BIT_MASK_PCIE_MIO_WE_8822B << BIT_SHIFT_PCIE_MIO_WE_8822B) -+#define BIT_CLEAR_PCIE_MIO_WE_8822B(x) ((x) & (~BITS_PCIE_MIO_WE_8822B)) -+#define BIT_GET_PCIE_MIO_WE_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_WE_8822B) & BIT_MASK_PCIE_MIO_WE_8822B) -+#define BIT_SET_PCIE_MIO_WE_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_WE_8822B(x) | BIT_PCIE_MIO_WE_8822B(v)) -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_8822B 0 -+#define BIT_MASK_PCIE_MIO_ADDR_8822B 0xff -+#define BIT_PCIE_MIO_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_8822B) << BIT_SHIFT_PCIE_MIO_ADDR_8822B) -+#define BITS_PCIE_MIO_ADDR_8822B \ -+ (BIT_MASK_PCIE_MIO_ADDR_8822B << BIT_SHIFT_PCIE_MIO_ADDR_8822B) -+#define BIT_CLEAR_PCIE_MIO_ADDR_8822B(x) ((x) & (~BITS_PCIE_MIO_ADDR_8822B)) -+#define BIT_GET_PCIE_MIO_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_8822B) & BIT_MASK_PCIE_MIO_ADDR_8822B) -+#define BIT_SET_PCIE_MIO_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_8822B(x) | BIT_PCIE_MIO_ADDR_8822B(v)) -+ -+/* 2 REG_PCIE_MIO_INTD_8822B */ -+ -+#define BIT_SHIFT_PCIE_MIO_DATA_8822B 0 -+#define BIT_MASK_PCIE_MIO_DATA_8822B 0xffffffffL -+#define BIT_PCIE_MIO_DATA_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_DATA_8822B) << BIT_SHIFT_PCIE_MIO_DATA_8822B) -+#define BITS_PCIE_MIO_DATA_8822B \ -+ (BIT_MASK_PCIE_MIO_DATA_8822B << BIT_SHIFT_PCIE_MIO_DATA_8822B) -+#define BIT_CLEAR_PCIE_MIO_DATA_8822B(x) ((x) & (~BITS_PCIE_MIO_DATA_8822B)) -+#define BIT_GET_PCIE_MIO_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_DATA_8822B) & BIT_MASK_PCIE_MIO_DATA_8822B) -+#define BIT_SET_PCIE_MIO_DATA_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_DATA_8822B(x) | BIT_PCIE_MIO_DATA_8822B(v)) -+ -+/* 2 REG_WLRF1_8822B */ -+ -+#define BIT_SHIFT_WLRF1_CTRL_8822B 24 -+#define BIT_MASK_WLRF1_CTRL_8822B 0xff -+#define BIT_WLRF1_CTRL_8822B(x) \ -+ (((x) & BIT_MASK_WLRF1_CTRL_8822B) << BIT_SHIFT_WLRF1_CTRL_8822B) -+#define BITS_WLRF1_CTRL_8822B \ -+ (BIT_MASK_WLRF1_CTRL_8822B << BIT_SHIFT_WLRF1_CTRL_8822B) -+#define BIT_CLEAR_WLRF1_CTRL_8822B(x) ((x) & (~BITS_WLRF1_CTRL_8822B)) -+#define BIT_GET_WLRF1_CTRL_8822B(x) \ -+ (((x) >> BIT_SHIFT_WLRF1_CTRL_8822B) & BIT_MASK_WLRF1_CTRL_8822B) -+#define BIT_SET_WLRF1_CTRL_8822B(x, v) \ -+ (BIT_CLEAR_WLRF1_CTRL_8822B(x) | BIT_WLRF1_CTRL_8822B(v)) -+ -+/* 2 REG_SYS_CFG1_8822B */ -+ -+#define BIT_SHIFT_TRP_ICFG_8822B 28 -+#define BIT_MASK_TRP_ICFG_8822B 0xf -+#define BIT_TRP_ICFG_8822B(x) \ -+ (((x) & BIT_MASK_TRP_ICFG_8822B) << BIT_SHIFT_TRP_ICFG_8822B) -+#define BITS_TRP_ICFG_8822B \ -+ (BIT_MASK_TRP_ICFG_8822B << BIT_SHIFT_TRP_ICFG_8822B) -+#define BIT_CLEAR_TRP_ICFG_8822B(x) ((x) & (~BITS_TRP_ICFG_8822B)) -+#define BIT_GET_TRP_ICFG_8822B(x) \ -+ (((x) >> BIT_SHIFT_TRP_ICFG_8822B) & BIT_MASK_TRP_ICFG_8822B) -+#define BIT_SET_TRP_ICFG_8822B(x, v) \ -+ (BIT_CLEAR_TRP_ICFG_8822B(x) | BIT_TRP_ICFG_8822B(v)) -+ -+#define BIT_RF_TYPE_ID_8822B BIT(27) -+#define BIT_BD_HCI_SEL_8822B BIT(26) -+#define BIT_BD_PKG_SEL_8822B BIT(25) -+#define BIT_SPSLDO_SEL_8822B BIT(24) -+#define BIT_RTL_ID_8822B BIT(23) -+#define BIT_PAD_HWPD_IDN_8822B BIT(22) -+#define BIT_TESTMODE_8822B BIT(20) -+ -+#define BIT_SHIFT_VENDOR_ID_8822B 16 -+#define BIT_MASK_VENDOR_ID_8822B 0xf -+#define BIT_VENDOR_ID_8822B(x) \ -+ (((x) & BIT_MASK_VENDOR_ID_8822B) << BIT_SHIFT_VENDOR_ID_8822B) -+#define BITS_VENDOR_ID_8822B \ -+ (BIT_MASK_VENDOR_ID_8822B << BIT_SHIFT_VENDOR_ID_8822B) -+#define BIT_CLEAR_VENDOR_ID_8822B(x) ((x) & (~BITS_VENDOR_ID_8822B)) -+#define BIT_GET_VENDOR_ID_8822B(x) \ -+ (((x) >> BIT_SHIFT_VENDOR_ID_8822B) & BIT_MASK_VENDOR_ID_8822B) -+#define BIT_SET_VENDOR_ID_8822B(x, v) \ -+ (BIT_CLEAR_VENDOR_ID_8822B(x) | BIT_VENDOR_ID_8822B(v)) -+ -+#define BIT_SHIFT_CHIP_VER_8822B 12 -+#define BIT_MASK_CHIP_VER_8822B 0xf -+#define BIT_CHIP_VER_8822B(x) \ -+ (((x) & BIT_MASK_CHIP_VER_8822B) << BIT_SHIFT_CHIP_VER_8822B) -+#define BITS_CHIP_VER_8822B \ -+ (BIT_MASK_CHIP_VER_8822B << BIT_SHIFT_CHIP_VER_8822B) -+#define BIT_CLEAR_CHIP_VER_8822B(x) ((x) & (~BITS_CHIP_VER_8822B)) -+#define BIT_GET_CHIP_VER_8822B(x) \ -+ (((x) >> BIT_SHIFT_CHIP_VER_8822B) & BIT_MASK_CHIP_VER_8822B) -+#define BIT_SET_CHIP_VER_8822B(x, v) \ -+ (BIT_CLEAR_CHIP_VER_8822B(x) | BIT_CHIP_VER_8822B(v)) -+ -+#define BIT_BD_MAC3_8822B BIT(11) -+#define BIT_BD_MAC1_8822B BIT(10) -+#define BIT_BD_MAC2_8822B BIT(9) -+#define BIT_SIC_IDLE_8822B BIT(8) -+#define BIT_SW_OFFLOAD_EN_8822B BIT(7) -+#define BIT_OCP_SHUTDN_8822B BIT(6) -+#define BIT_V15_VLD_8822B BIT(5) -+#define BIT_PCIRSTB_8822B BIT(4) -+#define BIT_PCLK_VLD_8822B BIT(3) -+#define BIT_UCLK_VLD_8822B BIT(2) -+#define BIT_ACLK_VLD_8822B BIT(1) -+#define BIT_XCLK_VLD_8822B BIT(0) -+ -+/* 2 REG_SYS_STATUS1_8822B */ -+ -+#define BIT_SHIFT_RF_RL_ID_8822B 28 -+#define BIT_MASK_RF_RL_ID_8822B 0xf -+#define BIT_RF_RL_ID_8822B(x) \ -+ (((x) & BIT_MASK_RF_RL_ID_8822B) << BIT_SHIFT_RF_RL_ID_8822B) -+#define BITS_RF_RL_ID_8822B \ -+ (BIT_MASK_RF_RL_ID_8822B << BIT_SHIFT_RF_RL_ID_8822B) -+#define BIT_CLEAR_RF_RL_ID_8822B(x) ((x) & (~BITS_RF_RL_ID_8822B)) -+#define BIT_GET_RF_RL_ID_8822B(x) \ -+ (((x) >> BIT_SHIFT_RF_RL_ID_8822B) & BIT_MASK_RF_RL_ID_8822B) -+#define BIT_SET_RF_RL_ID_8822B(x, v) \ -+ (BIT_CLEAR_RF_RL_ID_8822B(x) | BIT_RF_RL_ID_8822B(v)) -+ -+#define BIT_HPHY_ICFG_8822B BIT(19) -+ -+#define BIT_SHIFT_SEL_0XC0_8822B 16 -+#define BIT_MASK_SEL_0XC0_8822B 0x3 -+#define BIT_SEL_0XC0_8822B(x) \ -+ (((x) & BIT_MASK_SEL_0XC0_8822B) << BIT_SHIFT_SEL_0XC0_8822B) -+#define BITS_SEL_0XC0_8822B \ -+ (BIT_MASK_SEL_0XC0_8822B << BIT_SHIFT_SEL_0XC0_8822B) -+#define BIT_CLEAR_SEL_0XC0_8822B(x) ((x) & (~BITS_SEL_0XC0_8822B)) -+#define BIT_GET_SEL_0XC0_8822B(x) \ -+ (((x) >> BIT_SHIFT_SEL_0XC0_8822B) & BIT_MASK_SEL_0XC0_8822B) -+#define BIT_SET_SEL_0XC0_8822B(x, v) \ -+ (BIT_CLEAR_SEL_0XC0_8822B(x) | BIT_SEL_0XC0_8822B(v)) -+ -+#define BIT_SHIFT_HCI_SEL_V3_8822B 12 -+#define BIT_MASK_HCI_SEL_V3_8822B 0x7 -+#define BIT_HCI_SEL_V3_8822B(x) \ -+ (((x) & BIT_MASK_HCI_SEL_V3_8822B) << BIT_SHIFT_HCI_SEL_V3_8822B) -+#define BITS_HCI_SEL_V3_8822B \ -+ (BIT_MASK_HCI_SEL_V3_8822B << BIT_SHIFT_HCI_SEL_V3_8822B) -+#define BIT_CLEAR_HCI_SEL_V3_8822B(x) ((x) & (~BITS_HCI_SEL_V3_8822B)) -+#define BIT_GET_HCI_SEL_V3_8822B(x) \ -+ (((x) >> BIT_SHIFT_HCI_SEL_V3_8822B) & BIT_MASK_HCI_SEL_V3_8822B) -+#define BIT_SET_HCI_SEL_V3_8822B(x, v) \ -+ (BIT_CLEAR_HCI_SEL_V3_8822B(x) | BIT_HCI_SEL_V3_8822B(v)) -+ -+#define BIT_USB_OPERATION_MODE_8822B BIT(10) -+#define BIT_BT_PDN_8822B BIT(9) -+#define BIT_AUTO_WLPON_8822B BIT(8) -+#define BIT_WL_MODE_8822B BIT(7) -+#define BIT_PKG_SEL_HCI_8822B BIT(6) -+ -+#define BIT_SHIFT_PAD_HCI_SEL_V1_8822B 3 -+#define BIT_MASK_PAD_HCI_SEL_V1_8822B 0x7 -+#define BIT_PAD_HCI_SEL_V1_8822B(x) \ -+ (((x) & BIT_MASK_PAD_HCI_SEL_V1_8822B) \ -+ << BIT_SHIFT_PAD_HCI_SEL_V1_8822B) -+#define BITS_PAD_HCI_SEL_V1_8822B \ -+ (BIT_MASK_PAD_HCI_SEL_V1_8822B << BIT_SHIFT_PAD_HCI_SEL_V1_8822B) -+#define BIT_CLEAR_PAD_HCI_SEL_V1_8822B(x) ((x) & (~BITS_PAD_HCI_SEL_V1_8822B)) -+#define BIT_GET_PAD_HCI_SEL_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PAD_HCI_SEL_V1_8822B) & \ -+ BIT_MASK_PAD_HCI_SEL_V1_8822B) -+#define BIT_SET_PAD_HCI_SEL_V1_8822B(x, v) \ -+ (BIT_CLEAR_PAD_HCI_SEL_V1_8822B(x) | BIT_PAD_HCI_SEL_V1_8822B(v)) -+ -+#define BIT_SHIFT_EFS_HCI_SEL_V1_8822B 0 -+#define BIT_MASK_EFS_HCI_SEL_V1_8822B 0x7 -+#define BIT_EFS_HCI_SEL_V1_8822B(x) \ -+ (((x) & BIT_MASK_EFS_HCI_SEL_V1_8822B) \ -+ << BIT_SHIFT_EFS_HCI_SEL_V1_8822B) -+#define BITS_EFS_HCI_SEL_V1_8822B \ -+ (BIT_MASK_EFS_HCI_SEL_V1_8822B << BIT_SHIFT_EFS_HCI_SEL_V1_8822B) -+#define BIT_CLEAR_EFS_HCI_SEL_V1_8822B(x) ((x) & (~BITS_EFS_HCI_SEL_V1_8822B)) -+#define BIT_GET_EFS_HCI_SEL_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_EFS_HCI_SEL_V1_8822B) & \ -+ BIT_MASK_EFS_HCI_SEL_V1_8822B) -+#define BIT_SET_EFS_HCI_SEL_V1_8822B(x, v) \ -+ (BIT_CLEAR_EFS_HCI_SEL_V1_8822B(x) | BIT_EFS_HCI_SEL_V1_8822B(v)) -+ -+/* 2 REG_SYS_STATUS2_8822B */ -+#define BIT_SIO_ALDN_8822B BIT(19) -+#define BIT_USB_ALDN_8822B BIT(18) -+#define BIT_PCI_ALDN_8822B BIT(17) -+#define BIT_SYS_ALDN_8822B BIT(16) -+ -+#define BIT_SHIFT_EPVID1_8822B 8 -+#define BIT_MASK_EPVID1_8822B 0xff -+#define BIT_EPVID1_8822B(x) \ -+ (((x) & BIT_MASK_EPVID1_8822B) << BIT_SHIFT_EPVID1_8822B) -+#define BITS_EPVID1_8822B (BIT_MASK_EPVID1_8822B << BIT_SHIFT_EPVID1_8822B) -+#define BIT_CLEAR_EPVID1_8822B(x) ((x) & (~BITS_EPVID1_8822B)) -+#define BIT_GET_EPVID1_8822B(x) \ -+ (((x) >> BIT_SHIFT_EPVID1_8822B) & BIT_MASK_EPVID1_8822B) -+#define BIT_SET_EPVID1_8822B(x, v) \ -+ (BIT_CLEAR_EPVID1_8822B(x) | BIT_EPVID1_8822B(v)) -+ -+#define BIT_SHIFT_EPVID0_8822B 0 -+#define BIT_MASK_EPVID0_8822B 0xff -+#define BIT_EPVID0_8822B(x) \ -+ (((x) & BIT_MASK_EPVID0_8822B) << BIT_SHIFT_EPVID0_8822B) -+#define BITS_EPVID0_8822B (BIT_MASK_EPVID0_8822B << BIT_SHIFT_EPVID0_8822B) -+#define BIT_CLEAR_EPVID0_8822B(x) ((x) & (~BITS_EPVID0_8822B)) -+#define BIT_GET_EPVID0_8822B(x) \ -+ (((x) >> BIT_SHIFT_EPVID0_8822B) & BIT_MASK_EPVID0_8822B) -+#define BIT_SET_EPVID0_8822B(x, v) \ -+ (BIT_CLEAR_EPVID0_8822B(x) | BIT_EPVID0_8822B(v)) -+ -+/* 2 REG_SYS_CFG2_8822B */ -+#define BIT_HCI_SEL_EMBEDDED_8822B BIT(8) -+ -+#define BIT_SHIFT_HW_ID_8822B 0 -+#define BIT_MASK_HW_ID_8822B 0xff -+#define BIT_HW_ID_8822B(x) \ -+ (((x) & BIT_MASK_HW_ID_8822B) << BIT_SHIFT_HW_ID_8822B) -+#define BITS_HW_ID_8822B (BIT_MASK_HW_ID_8822B << BIT_SHIFT_HW_ID_8822B) -+#define BIT_CLEAR_HW_ID_8822B(x) ((x) & (~BITS_HW_ID_8822B)) -+#define BIT_GET_HW_ID_8822B(x) \ -+ (((x) >> BIT_SHIFT_HW_ID_8822B) & BIT_MASK_HW_ID_8822B) -+#define BIT_SET_HW_ID_8822B(x, v) \ -+ (BIT_CLEAR_HW_ID_8822B(x) | BIT_HW_ID_8822B(v)) -+ -+/* 2 REG_SYS_CFG3_8822B */ -+#define BIT_PWC_MA33V_8822B BIT(15) -+#define BIT_PWC_MA12V_8822B BIT(14) -+#define BIT_PWC_MD12V_8822B BIT(13) -+#define BIT_PWC_PD12V_8822B BIT(12) -+#define BIT_PWC_UD12V_8822B BIT(11) -+#define BIT_ISO_MA2MD_8822B BIT(1) -+#define BIT_ISO_MD2PP_8822B BIT(0) -+ -+/* 2 REG_SYS_CFG4_8822B */ -+ -+/* 2 REG_SYS_CFG5_8822B */ -+#define BIT_LPS_STATUS_8822B BIT(3) -+#define BIT_HCI_TXDMA_BUSY_8822B BIT(2) -+#define BIT_HCI_TXDMA_ALLOW_8822B BIT(1) -+#define BIT_FW_CTRL_HCI_TXDMA_EN_8822B BIT(0) -+ -+/* 2 REG_CPU_DMEM_CON_8822B */ -+#define BIT_WDT_OPT_IOWRAPPER_8822B BIT(19) -+#define BIT_ANA_PORT_IDLE_8822B BIT(18) -+#define BIT_MAC_PORT_IDLE_8822B BIT(17) -+#define BIT_WL_PLATFORM_RST_8822B BIT(16) -+#define BIT_WL_SECURITY_CLK_8822B BIT(15) -+ -+#define BIT_SHIFT_CPU_DMEM_CON_8822B 0 -+#define BIT_MASK_CPU_DMEM_CON_8822B 0xff -+#define BIT_CPU_DMEM_CON_8822B(x) \ -+ (((x) & BIT_MASK_CPU_DMEM_CON_8822B) << BIT_SHIFT_CPU_DMEM_CON_8822B) -+#define BITS_CPU_DMEM_CON_8822B \ -+ (BIT_MASK_CPU_DMEM_CON_8822B << BIT_SHIFT_CPU_DMEM_CON_8822B) -+#define BIT_CLEAR_CPU_DMEM_CON_8822B(x) ((x) & (~BITS_CPU_DMEM_CON_8822B)) -+#define BIT_GET_CPU_DMEM_CON_8822B(x) \ -+ (((x) >> BIT_SHIFT_CPU_DMEM_CON_8822B) & BIT_MASK_CPU_DMEM_CON_8822B) -+#define BIT_SET_CPU_DMEM_CON_8822B(x, v) \ -+ (BIT_CLEAR_CPU_DMEM_CON_8822B(x) | BIT_CPU_DMEM_CON_8822B(v)) -+ -+/* 2 REG_BOOT_REASON_8822B */ -+ -+#define BIT_SHIFT_BOOT_REASON_V1_8822B 0 -+#define BIT_MASK_BOOT_REASON_V1_8822B 0x7 -+#define BIT_BOOT_REASON_V1_8822B(x) \ -+ (((x) & BIT_MASK_BOOT_REASON_V1_8822B) \ -+ << BIT_SHIFT_BOOT_REASON_V1_8822B) -+#define BITS_BOOT_REASON_V1_8822B \ -+ (BIT_MASK_BOOT_REASON_V1_8822B << BIT_SHIFT_BOOT_REASON_V1_8822B) -+#define BIT_CLEAR_BOOT_REASON_V1_8822B(x) ((x) & (~BITS_BOOT_REASON_V1_8822B)) -+#define BIT_GET_BOOT_REASON_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BOOT_REASON_V1_8822B) & \ -+ BIT_MASK_BOOT_REASON_V1_8822B) -+#define BIT_SET_BOOT_REASON_V1_8822B(x, v) \ -+ (BIT_CLEAR_BOOT_REASON_V1_8822B(x) | BIT_BOOT_REASON_V1_8822B(v)) -+ -+/* 2 REG_NFCPAD_CTRL_8822B */ -+#define BIT_PAD_SHUTDW_8822B BIT(18) -+#define BIT_SYSON_NFC_PAD_8822B BIT(17) -+#define BIT_NFC_INT_PAD_CTRL_8822B BIT(16) -+#define BIT_NFC_RFDIS_PAD_CTRL_8822B BIT(15) -+#define BIT_NFC_CLK_PAD_CTRL_8822B BIT(14) -+#define BIT_NFC_DATA_PAD_CTRL_8822B BIT(13) -+#define BIT_NFC_PAD_PULL_CTRL_8822B BIT(12) -+ -+#define BIT_SHIFT_NFCPAD_IO_SEL_8822B 8 -+#define BIT_MASK_NFCPAD_IO_SEL_8822B 0xf -+#define BIT_NFCPAD_IO_SEL_8822B(x) \ -+ (((x) & BIT_MASK_NFCPAD_IO_SEL_8822B) << BIT_SHIFT_NFCPAD_IO_SEL_8822B) -+#define BITS_NFCPAD_IO_SEL_8822B \ -+ (BIT_MASK_NFCPAD_IO_SEL_8822B << BIT_SHIFT_NFCPAD_IO_SEL_8822B) -+#define BIT_CLEAR_NFCPAD_IO_SEL_8822B(x) ((x) & (~BITS_NFCPAD_IO_SEL_8822B)) -+#define BIT_GET_NFCPAD_IO_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_IO_SEL_8822B) & BIT_MASK_NFCPAD_IO_SEL_8822B) -+#define BIT_SET_NFCPAD_IO_SEL_8822B(x, v) \ -+ (BIT_CLEAR_NFCPAD_IO_SEL_8822B(x) | BIT_NFCPAD_IO_SEL_8822B(v)) -+ -+#define BIT_SHIFT_NFCPAD_OUT_8822B 4 -+#define BIT_MASK_NFCPAD_OUT_8822B 0xf -+#define BIT_NFCPAD_OUT_8822B(x) \ -+ (((x) & BIT_MASK_NFCPAD_OUT_8822B) << BIT_SHIFT_NFCPAD_OUT_8822B) -+#define BITS_NFCPAD_OUT_8822B \ -+ (BIT_MASK_NFCPAD_OUT_8822B << BIT_SHIFT_NFCPAD_OUT_8822B) -+#define BIT_CLEAR_NFCPAD_OUT_8822B(x) ((x) & (~BITS_NFCPAD_OUT_8822B)) -+#define BIT_GET_NFCPAD_OUT_8822B(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_OUT_8822B) & BIT_MASK_NFCPAD_OUT_8822B) -+#define BIT_SET_NFCPAD_OUT_8822B(x, v) \ -+ (BIT_CLEAR_NFCPAD_OUT_8822B(x) | BIT_NFCPAD_OUT_8822B(v)) -+ -+#define BIT_SHIFT_NFCPAD_IN_8822B 0 -+#define BIT_MASK_NFCPAD_IN_8822B 0xf -+#define BIT_NFCPAD_IN_8822B(x) \ -+ (((x) & BIT_MASK_NFCPAD_IN_8822B) << BIT_SHIFT_NFCPAD_IN_8822B) -+#define BITS_NFCPAD_IN_8822B \ -+ (BIT_MASK_NFCPAD_IN_8822B << BIT_SHIFT_NFCPAD_IN_8822B) -+#define BIT_CLEAR_NFCPAD_IN_8822B(x) ((x) & (~BITS_NFCPAD_IN_8822B)) -+#define BIT_GET_NFCPAD_IN_8822B(x) \ -+ (((x) >> BIT_SHIFT_NFCPAD_IN_8822B) & BIT_MASK_NFCPAD_IN_8822B) -+#define BIT_SET_NFCPAD_IN_8822B(x, v) \ -+ (BIT_CLEAR_NFCPAD_IN_8822B(x) | BIT_NFCPAD_IN_8822B(v)) -+ -+/* 2 REG_HIMR2_8822B */ -+#define BIT_BCNDMAINT_P4_MSK_8822B BIT(31) -+#define BIT_BCNDMAINT_P3_MSK_8822B BIT(30) -+#define BIT_BCNDMAINT_P2_MSK_8822B BIT(29) -+#define BIT_BCNDMAINT_P1_MSK_8822B BIT(28) -+#define BIT_ATIMEND7_MSK_8822B BIT(22) -+#define BIT_ATIMEND6_MSK_8822B BIT(21) -+#define BIT_ATIMEND5_MSK_8822B BIT(20) -+#define BIT_ATIMEND4_MSK_8822B BIT(19) -+#define BIT_ATIMEND3_MSK_8822B BIT(18) -+#define BIT_ATIMEND2_MSK_8822B BIT(17) -+#define BIT_ATIMEND1_MSK_8822B BIT(16) -+#define BIT_TXBCN7OK_MSK_8822B BIT(14) -+#define BIT_TXBCN6OK_MSK_8822B BIT(13) -+#define BIT_TXBCN5OK_MSK_8822B BIT(12) -+#define BIT_TXBCN4OK_MSK_8822B BIT(11) -+#define BIT_TXBCN3OK_MSK_8822B BIT(10) -+#define BIT_TXBCN2OK_MSK_8822B BIT(9) -+#define BIT_TXBCN1OK_MSK_V1_8822B BIT(8) -+#define BIT_TXBCN7ERR_MSK_8822B BIT(6) -+#define BIT_TXBCN6ERR_MSK_8822B BIT(5) -+#define BIT_TXBCN5ERR_MSK_8822B BIT(4) -+#define BIT_TXBCN4ERR_MSK_8822B BIT(3) -+#define BIT_TXBCN3ERR_MSK_8822B BIT(2) -+#define BIT_TXBCN2ERR_MSK_8822B BIT(1) -+#define BIT_TXBCN1ERR_MSK_V1_8822B BIT(0) -+ -+/* 2 REG_HISR2_8822B */ -+#define BIT_BCNDMAINT_P4_8822B BIT(31) -+#define BIT_BCNDMAINT_P3_8822B BIT(30) -+#define BIT_BCNDMAINT_P2_8822B BIT(29) -+#define BIT_BCNDMAINT_P1_8822B BIT(28) -+#define BIT_ATIMEND7_8822B BIT(22) -+#define BIT_ATIMEND6_8822B BIT(21) -+#define BIT_ATIMEND5_8822B BIT(20) -+#define BIT_ATIMEND4_8822B BIT(19) -+#define BIT_ATIMEND3_8822B BIT(18) -+#define BIT_ATIMEND2_8822B BIT(17) -+#define BIT_ATIMEND1_8822B BIT(16) -+#define BIT_TXBCN7OK_8822B BIT(14) -+#define BIT_TXBCN6OK_8822B BIT(13) -+#define BIT_TXBCN5OK_8822B BIT(12) -+#define BIT_TXBCN4OK_8822B BIT(11) -+#define BIT_TXBCN3OK_8822B BIT(10) -+#define BIT_TXBCN2OK_8822B BIT(9) -+#define BIT_TXBCN1OK_8822B BIT(8) -+#define BIT_TXBCN7ERR_8822B BIT(6) -+#define BIT_TXBCN6ERR_8822B BIT(5) -+#define BIT_TXBCN5ERR_8822B BIT(4) -+#define BIT_TXBCN4ERR_8822B BIT(3) -+#define BIT_TXBCN3ERR_8822B BIT(2) -+#define BIT_TXBCN2ERR_8822B BIT(1) -+#define BIT_TXBCN1ERR_8822B BIT(0) -+ -+/* 2 REG_HIMR3_8822B */ -+#define BIT_WDT_PLATFORM_INT_MSK_8822B BIT(18) -+#define BIT_WDT_CPU_INT_MSK_8822B BIT(17) -+#define BIT_SETH2CDOK_MASK_8822B BIT(16) -+#define BIT_H2C_CMD_FULL_MASK_8822B BIT(15) -+#define BIT_PWR_INT_127_MASK_8822B BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_MASK_8822B BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_MASK_8822B BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_MASK_8822B BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_MAS_8822B BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_MASK_8822B BIT(9) -+#define BIT_PWR_INT_127_MASK_V1_8822B BIT(8) -+#define BIT_PWR_INT_126TO96_MASK_8822B BIT(7) -+#define BIT_PWR_INT_95TO64_MASK_8822B BIT(6) -+#define BIT_PWR_INT_63TO32_MASK_8822B BIT(5) -+#define BIT_PWR_INT_31TO0_MASK_8822B BIT(4) -+#define BIT_DDMA0_LP_INT_MSK_8822B BIT(1) -+#define BIT_DDMA0_HP_INT_MSK_8822B BIT(0) -+ -+/* 2 REG_HISR3_8822B */ -+#define BIT_WDT_PLATFORM_INT_8822B BIT(18) -+#define BIT_WDT_CPU_INT_8822B BIT(17) -+#define BIT_SETH2CDOK_8822B BIT(16) -+#define BIT_H2C_CMD_FULL_8822B BIT(15) -+#define BIT_PWR_INT_127_8822B BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_8822B BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_8822B BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_8822B BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_8822B BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_8822B BIT(9) -+#define BIT_PWR_INT_127_V1_8822B BIT(8) -+#define BIT_PWR_INT_126TO96_8822B BIT(7) -+#define BIT_PWR_INT_95TO64_8822B BIT(6) -+#define BIT_PWR_INT_63TO32_8822B BIT(5) -+#define BIT_PWR_INT_31TO0_8822B BIT(4) -+#define BIT_DDMA0_LP_INT_8822B BIT(1) -+#define BIT_DDMA0_HP_INT_8822B BIT(0) -+ -+/* 2 REG_SW_MDIO_8822B */ -+#define BIT_DIS_TIMEOUT_IO_8822B BIT(24) -+ -+/* 2 REG_SW_FLUSH_8822B */ -+#define BIT_FLUSH_HOLDN_EN_8822B BIT(25) -+#define BIT_FLUSH_WR_EN_8822B BIT(24) -+#define BIT_SW_FLASH_CONTROL_8822B BIT(23) -+#define BIT_SW_FLASH_WEN_E_8822B BIT(19) -+#define BIT_SW_FLASH_HOLDN_E_8822B BIT(18) -+#define BIT_SW_FLASH_SO_E_8822B BIT(17) -+#define BIT_SW_FLASH_SI_E_8822B BIT(16) -+#define BIT_SW_FLASH_SK_O_8822B BIT(13) -+#define BIT_SW_FLASH_CEN_O_8822B BIT(12) -+#define BIT_SW_FLASH_WEN_O_8822B BIT(11) -+#define BIT_SW_FLASH_HOLDN_O_8822B BIT(10) -+#define BIT_SW_FLASH_SO_O_8822B BIT(9) -+#define BIT_SW_FLASH_SI_O_8822B BIT(8) -+#define BIT_SW_FLASH_WEN_I_8822B BIT(3) -+#define BIT_SW_FLASH_HOLDN_I_8822B BIT(2) -+#define BIT_SW_FLASH_SO_I_8822B BIT(1) -+#define BIT_SW_FLASH_SI_I_8822B BIT(0) -+ -+/* 2 REG_H2C_PKT_READADDR_8822B */ -+ -+#define BIT_SHIFT_H2C_PKT_READADDR_8822B 0 -+#define BIT_MASK_H2C_PKT_READADDR_8822B 0x3ffff -+#define BIT_H2C_PKT_READADDR_8822B(x) \ -+ (((x) & BIT_MASK_H2C_PKT_READADDR_8822B) \ -+ << BIT_SHIFT_H2C_PKT_READADDR_8822B) -+#define BITS_H2C_PKT_READADDR_8822B \ -+ (BIT_MASK_H2C_PKT_READADDR_8822B << BIT_SHIFT_H2C_PKT_READADDR_8822B) -+#define BIT_CLEAR_H2C_PKT_READADDR_8822B(x) \ -+ ((x) & (~BITS_H2C_PKT_READADDR_8822B)) -+#define BIT_GET_H2C_PKT_READADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_READADDR_8822B) & \ -+ BIT_MASK_H2C_PKT_READADDR_8822B) -+#define BIT_SET_H2C_PKT_READADDR_8822B(x, v) \ -+ (BIT_CLEAR_H2C_PKT_READADDR_8822B(x) | BIT_H2C_PKT_READADDR_8822B(v)) -+ -+/* 2 REG_H2C_PKT_WRITEADDR_8822B */ -+ -+#define BIT_SHIFT_H2C_PKT_WRITEADDR_8822B 0 -+#define BIT_MASK_H2C_PKT_WRITEADDR_8822B 0x3ffff -+#define BIT_H2C_PKT_WRITEADDR_8822B(x) \ -+ (((x) & BIT_MASK_H2C_PKT_WRITEADDR_8822B) \ -+ << BIT_SHIFT_H2C_PKT_WRITEADDR_8822B) -+#define BITS_H2C_PKT_WRITEADDR_8822B \ -+ (BIT_MASK_H2C_PKT_WRITEADDR_8822B << BIT_SHIFT_H2C_PKT_WRITEADDR_8822B) -+#define BIT_CLEAR_H2C_PKT_WRITEADDR_8822B(x) \ -+ ((x) & (~BITS_H2C_PKT_WRITEADDR_8822B)) -+#define BIT_GET_H2C_PKT_WRITEADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_WRITEADDR_8822B) & \ -+ BIT_MASK_H2C_PKT_WRITEADDR_8822B) -+#define BIT_SET_H2C_PKT_WRITEADDR_8822B(x, v) \ -+ (BIT_CLEAR_H2C_PKT_WRITEADDR_8822B(x) | BIT_H2C_PKT_WRITEADDR_8822B(v)) -+ -+/* 2 REG_MEM_PWR_CRTL_8822B */ -+#define BIT_MEM_BB_SD_8822B BIT(17) -+#define BIT_MEM_BB_DS_8822B BIT(16) -+#define BIT_MEM_BT_DS_8822B BIT(10) -+#define BIT_MEM_SDIO_LS_8822B BIT(9) -+#define BIT_MEM_SDIO_DS_8822B BIT(8) -+#define BIT_MEM_USB_LS_8822B BIT(7) -+#define BIT_MEM_USB_DS_8822B BIT(6) -+#define BIT_MEM_PCI_LS_8822B BIT(5) -+#define BIT_MEM_PCI_DS_8822B BIT(4) -+#define BIT_MEM_WLMAC_LS_8822B BIT(3) -+#define BIT_MEM_WLMAC_DS_8822B BIT(2) -+#define BIT_MEM_WLMCU_LS_8822B BIT(1) -+#define BIT_MEM_WLMCU_DS_8822B BIT(0) -+ -+/* 2 REG_FW_DBG0_8822B */ -+ -+#define BIT_SHIFT_FW_DBG0_8822B 0 -+#define BIT_MASK_FW_DBG0_8822B 0xffffffffL -+#define BIT_FW_DBG0_8822B(x) \ -+ (((x) & BIT_MASK_FW_DBG0_8822B) << BIT_SHIFT_FW_DBG0_8822B) -+#define BITS_FW_DBG0_8822B (BIT_MASK_FW_DBG0_8822B << BIT_SHIFT_FW_DBG0_8822B) -+#define BIT_CLEAR_FW_DBG0_8822B(x) ((x) & (~BITS_FW_DBG0_8822B)) -+#define BIT_GET_FW_DBG0_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG0_8822B) & BIT_MASK_FW_DBG0_8822B) -+#define BIT_SET_FW_DBG0_8822B(x, v) \ -+ (BIT_CLEAR_FW_DBG0_8822B(x) | BIT_FW_DBG0_8822B(v)) -+ -+/* 2 REG_FW_DBG1_8822B */ -+ -+#define BIT_SHIFT_FW_DBG1_8822B 0 -+#define BIT_MASK_FW_DBG1_8822B 0xffffffffL -+#define BIT_FW_DBG1_8822B(x) \ -+ (((x) & BIT_MASK_FW_DBG1_8822B) << BIT_SHIFT_FW_DBG1_8822B) -+#define BITS_FW_DBG1_8822B (BIT_MASK_FW_DBG1_8822B << BIT_SHIFT_FW_DBG1_8822B) -+#define BIT_CLEAR_FW_DBG1_8822B(x) ((x) & (~BITS_FW_DBG1_8822B)) -+#define BIT_GET_FW_DBG1_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG1_8822B) & BIT_MASK_FW_DBG1_8822B) -+#define BIT_SET_FW_DBG1_8822B(x, v) \ -+ (BIT_CLEAR_FW_DBG1_8822B(x) | BIT_FW_DBG1_8822B(v)) -+ -+/* 2 REG_FW_DBG2_8822B */ -+ -+#define BIT_SHIFT_FW_DBG2_8822B 0 -+#define BIT_MASK_FW_DBG2_8822B 0xffffffffL -+#define BIT_FW_DBG2_8822B(x) \ -+ (((x) & BIT_MASK_FW_DBG2_8822B) << BIT_SHIFT_FW_DBG2_8822B) -+#define BITS_FW_DBG2_8822B (BIT_MASK_FW_DBG2_8822B << BIT_SHIFT_FW_DBG2_8822B) -+#define BIT_CLEAR_FW_DBG2_8822B(x) ((x) & (~BITS_FW_DBG2_8822B)) -+#define BIT_GET_FW_DBG2_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG2_8822B) & BIT_MASK_FW_DBG2_8822B) -+#define BIT_SET_FW_DBG2_8822B(x, v) \ -+ (BIT_CLEAR_FW_DBG2_8822B(x) | BIT_FW_DBG2_8822B(v)) -+ -+/* 2 REG_FW_DBG3_8822B */ -+ -+#define BIT_SHIFT_FW_DBG3_8822B 0 -+#define BIT_MASK_FW_DBG3_8822B 0xffffffffL -+#define BIT_FW_DBG3_8822B(x) \ -+ (((x) & BIT_MASK_FW_DBG3_8822B) << BIT_SHIFT_FW_DBG3_8822B) -+#define BITS_FW_DBG3_8822B (BIT_MASK_FW_DBG3_8822B << BIT_SHIFT_FW_DBG3_8822B) -+#define BIT_CLEAR_FW_DBG3_8822B(x) ((x) & (~BITS_FW_DBG3_8822B)) -+#define BIT_GET_FW_DBG3_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG3_8822B) & BIT_MASK_FW_DBG3_8822B) -+#define BIT_SET_FW_DBG3_8822B(x, v) \ -+ (BIT_CLEAR_FW_DBG3_8822B(x) | BIT_FW_DBG3_8822B(v)) -+ -+/* 2 REG_FW_DBG4_8822B */ -+ -+#define BIT_SHIFT_FW_DBG4_8822B 0 -+#define BIT_MASK_FW_DBG4_8822B 0xffffffffL -+#define BIT_FW_DBG4_8822B(x) \ -+ (((x) & BIT_MASK_FW_DBG4_8822B) << BIT_SHIFT_FW_DBG4_8822B) -+#define BITS_FW_DBG4_8822B (BIT_MASK_FW_DBG4_8822B << BIT_SHIFT_FW_DBG4_8822B) -+#define BIT_CLEAR_FW_DBG4_8822B(x) ((x) & (~BITS_FW_DBG4_8822B)) -+#define BIT_GET_FW_DBG4_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG4_8822B) & BIT_MASK_FW_DBG4_8822B) -+#define BIT_SET_FW_DBG4_8822B(x, v) \ -+ (BIT_CLEAR_FW_DBG4_8822B(x) | BIT_FW_DBG4_8822B(v)) -+ -+/* 2 REG_FW_DBG5_8822B */ -+ -+#define BIT_SHIFT_FW_DBG5_8822B 0 -+#define BIT_MASK_FW_DBG5_8822B 0xffffffffL -+#define BIT_FW_DBG5_8822B(x) \ -+ (((x) & BIT_MASK_FW_DBG5_8822B) << BIT_SHIFT_FW_DBG5_8822B) -+#define BITS_FW_DBG5_8822B (BIT_MASK_FW_DBG5_8822B << BIT_SHIFT_FW_DBG5_8822B) -+#define BIT_CLEAR_FW_DBG5_8822B(x) ((x) & (~BITS_FW_DBG5_8822B)) -+#define BIT_GET_FW_DBG5_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG5_8822B) & BIT_MASK_FW_DBG5_8822B) -+#define BIT_SET_FW_DBG5_8822B(x, v) \ -+ (BIT_CLEAR_FW_DBG5_8822B(x) | BIT_FW_DBG5_8822B(v)) -+ -+/* 2 REG_FW_DBG6_8822B */ -+ -+#define BIT_SHIFT_FW_DBG6_8822B 0 -+#define BIT_MASK_FW_DBG6_8822B 0xffffffffL -+#define BIT_FW_DBG6_8822B(x) \ -+ (((x) & BIT_MASK_FW_DBG6_8822B) << BIT_SHIFT_FW_DBG6_8822B) -+#define BITS_FW_DBG6_8822B (BIT_MASK_FW_DBG6_8822B << BIT_SHIFT_FW_DBG6_8822B) -+#define BIT_CLEAR_FW_DBG6_8822B(x) ((x) & (~BITS_FW_DBG6_8822B)) -+#define BIT_GET_FW_DBG6_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG6_8822B) & BIT_MASK_FW_DBG6_8822B) -+#define BIT_SET_FW_DBG6_8822B(x, v) \ -+ (BIT_CLEAR_FW_DBG6_8822B(x) | BIT_FW_DBG6_8822B(v)) -+ -+/* 2 REG_FW_DBG7_8822B */ -+ -+#define BIT_SHIFT_FW_DBG7_8822B 0 -+#define BIT_MASK_FW_DBG7_8822B 0xffffffffL -+#define BIT_FW_DBG7_8822B(x) \ -+ (((x) & BIT_MASK_FW_DBG7_8822B) << BIT_SHIFT_FW_DBG7_8822B) -+#define BITS_FW_DBG7_8822B (BIT_MASK_FW_DBG7_8822B << BIT_SHIFT_FW_DBG7_8822B) -+#define BIT_CLEAR_FW_DBG7_8822B(x) ((x) & (~BITS_FW_DBG7_8822B)) -+#define BIT_GET_FW_DBG7_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG7_8822B) & BIT_MASK_FW_DBG7_8822B) -+#define BIT_SET_FW_DBG7_8822B(x, v) \ -+ (BIT_CLEAR_FW_DBG7_8822B(x) | BIT_FW_DBG7_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_CR_8822B */ -+ -+#define BIT_SHIFT_LBMODE_8822B 24 -+#define BIT_MASK_LBMODE_8822B 0x1f -+#define BIT_LBMODE_8822B(x) \ -+ (((x) & BIT_MASK_LBMODE_8822B) << BIT_SHIFT_LBMODE_8822B) -+#define BITS_LBMODE_8822B (BIT_MASK_LBMODE_8822B << BIT_SHIFT_LBMODE_8822B) -+#define BIT_CLEAR_LBMODE_8822B(x) ((x) & (~BITS_LBMODE_8822B)) -+#define BIT_GET_LBMODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_LBMODE_8822B) & BIT_MASK_LBMODE_8822B) -+#define BIT_SET_LBMODE_8822B(x, v) \ -+ (BIT_CLEAR_LBMODE_8822B(x) | BIT_LBMODE_8822B(v)) -+ -+#define BIT_SHIFT_NETYPE1_8822B 18 -+#define BIT_MASK_NETYPE1_8822B 0x3 -+#define BIT_NETYPE1_8822B(x) \ -+ (((x) & BIT_MASK_NETYPE1_8822B) << BIT_SHIFT_NETYPE1_8822B) -+#define BITS_NETYPE1_8822B (BIT_MASK_NETYPE1_8822B << BIT_SHIFT_NETYPE1_8822B) -+#define BIT_CLEAR_NETYPE1_8822B(x) ((x) & (~BITS_NETYPE1_8822B)) -+#define BIT_GET_NETYPE1_8822B(x) \ -+ (((x) >> BIT_SHIFT_NETYPE1_8822B) & BIT_MASK_NETYPE1_8822B) -+#define BIT_SET_NETYPE1_8822B(x, v) \ -+ (BIT_CLEAR_NETYPE1_8822B(x) | BIT_NETYPE1_8822B(v)) -+ -+#define BIT_SHIFT_NETYPE0_8822B 16 -+#define BIT_MASK_NETYPE0_8822B 0x3 -+#define BIT_NETYPE0_8822B(x) \ -+ (((x) & BIT_MASK_NETYPE0_8822B) << BIT_SHIFT_NETYPE0_8822B) -+#define BITS_NETYPE0_8822B (BIT_MASK_NETYPE0_8822B << BIT_SHIFT_NETYPE0_8822B) -+#define BIT_CLEAR_NETYPE0_8822B(x) ((x) & (~BITS_NETYPE0_8822B)) -+#define BIT_GET_NETYPE0_8822B(x) \ -+ (((x) >> BIT_SHIFT_NETYPE0_8822B) & BIT_MASK_NETYPE0_8822B) -+#define BIT_SET_NETYPE0_8822B(x, v) \ -+ (BIT_CLEAR_NETYPE0_8822B(x) | BIT_NETYPE0_8822B(v)) -+ -+#define BIT_I2C_MAILBOX_EN_8822B BIT(12) -+#define BIT_SHCUT_EN_8822B BIT(11) -+#define BIT_32K_CAL_TMR_EN_8822B BIT(10) -+#define BIT_MAC_SEC_EN_8822B BIT(9) -+#define BIT_ENSWBCN_8822B BIT(8) -+#define BIT_MACRXEN_8822B BIT(7) -+#define BIT_MACTXEN_8822B BIT(6) -+#define BIT_SCHEDULE_EN_8822B BIT(5) -+#define BIT_PROTOCOL_EN_8822B BIT(4) -+#define BIT_RXDMA_EN_8822B BIT(3) -+#define BIT_TXDMA_EN_8822B BIT(2) -+#define BIT_HCI_RXDMA_EN_8822B BIT(1) -+#define BIT_HCI_TXDMA_EN_8822B BIT(0) -+ -+/* 2 REG_TSF_CLK_STATE_8822B */ -+#define BIT_TSF_CLK_STABLE_8822B BIT(15) -+ -+/* 2 REG_TXDMA_PQ_MAP_8822B */ -+ -+#define BIT_SHIFT_TXDMA_HIQ_MAP_8822B 14 -+#define BIT_MASK_TXDMA_HIQ_MAP_8822B 0x3 -+#define BIT_TXDMA_HIQ_MAP_8822B(x) \ -+ (((x) & BIT_MASK_TXDMA_HIQ_MAP_8822B) << BIT_SHIFT_TXDMA_HIQ_MAP_8822B) -+#define BITS_TXDMA_HIQ_MAP_8822B \ -+ (BIT_MASK_TXDMA_HIQ_MAP_8822B << BIT_SHIFT_TXDMA_HIQ_MAP_8822B) -+#define BIT_CLEAR_TXDMA_HIQ_MAP_8822B(x) ((x) & (~BITS_TXDMA_HIQ_MAP_8822B)) -+#define BIT_GET_TXDMA_HIQ_MAP_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_HIQ_MAP_8822B) & BIT_MASK_TXDMA_HIQ_MAP_8822B) -+#define BIT_SET_TXDMA_HIQ_MAP_8822B(x, v) \ -+ (BIT_CLEAR_TXDMA_HIQ_MAP_8822B(x) | BIT_TXDMA_HIQ_MAP_8822B(v)) -+ -+#define BIT_SHIFT_TXDMA_MGQ_MAP_8822B 12 -+#define BIT_MASK_TXDMA_MGQ_MAP_8822B 0x3 -+#define BIT_TXDMA_MGQ_MAP_8822B(x) \ -+ (((x) & BIT_MASK_TXDMA_MGQ_MAP_8822B) << BIT_SHIFT_TXDMA_MGQ_MAP_8822B) -+#define BITS_TXDMA_MGQ_MAP_8822B \ -+ (BIT_MASK_TXDMA_MGQ_MAP_8822B << BIT_SHIFT_TXDMA_MGQ_MAP_8822B) -+#define BIT_CLEAR_TXDMA_MGQ_MAP_8822B(x) ((x) & (~BITS_TXDMA_MGQ_MAP_8822B)) -+#define BIT_GET_TXDMA_MGQ_MAP_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_MGQ_MAP_8822B) & BIT_MASK_TXDMA_MGQ_MAP_8822B) -+#define BIT_SET_TXDMA_MGQ_MAP_8822B(x, v) \ -+ (BIT_CLEAR_TXDMA_MGQ_MAP_8822B(x) | BIT_TXDMA_MGQ_MAP_8822B(v)) -+ -+#define BIT_SHIFT_TXDMA_BKQ_MAP_8822B 10 -+#define BIT_MASK_TXDMA_BKQ_MAP_8822B 0x3 -+#define BIT_TXDMA_BKQ_MAP_8822B(x) \ -+ (((x) & BIT_MASK_TXDMA_BKQ_MAP_8822B) << BIT_SHIFT_TXDMA_BKQ_MAP_8822B) -+#define BITS_TXDMA_BKQ_MAP_8822B \ -+ (BIT_MASK_TXDMA_BKQ_MAP_8822B << BIT_SHIFT_TXDMA_BKQ_MAP_8822B) -+#define BIT_CLEAR_TXDMA_BKQ_MAP_8822B(x) ((x) & (~BITS_TXDMA_BKQ_MAP_8822B)) -+#define BIT_GET_TXDMA_BKQ_MAP_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BKQ_MAP_8822B) & BIT_MASK_TXDMA_BKQ_MAP_8822B) -+#define BIT_SET_TXDMA_BKQ_MAP_8822B(x, v) \ -+ (BIT_CLEAR_TXDMA_BKQ_MAP_8822B(x) | BIT_TXDMA_BKQ_MAP_8822B(v)) -+ -+#define BIT_SHIFT_TXDMA_BEQ_MAP_8822B 8 -+#define BIT_MASK_TXDMA_BEQ_MAP_8822B 0x3 -+#define BIT_TXDMA_BEQ_MAP_8822B(x) \ -+ (((x) & BIT_MASK_TXDMA_BEQ_MAP_8822B) << BIT_SHIFT_TXDMA_BEQ_MAP_8822B) -+#define BITS_TXDMA_BEQ_MAP_8822B \ -+ (BIT_MASK_TXDMA_BEQ_MAP_8822B << BIT_SHIFT_TXDMA_BEQ_MAP_8822B) -+#define BIT_CLEAR_TXDMA_BEQ_MAP_8822B(x) ((x) & (~BITS_TXDMA_BEQ_MAP_8822B)) -+#define BIT_GET_TXDMA_BEQ_MAP_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BEQ_MAP_8822B) & BIT_MASK_TXDMA_BEQ_MAP_8822B) -+#define BIT_SET_TXDMA_BEQ_MAP_8822B(x, v) \ -+ (BIT_CLEAR_TXDMA_BEQ_MAP_8822B(x) | BIT_TXDMA_BEQ_MAP_8822B(v)) -+ -+#define BIT_SHIFT_TXDMA_VIQ_MAP_8822B 6 -+#define BIT_MASK_TXDMA_VIQ_MAP_8822B 0x3 -+#define BIT_TXDMA_VIQ_MAP_8822B(x) \ -+ (((x) & BIT_MASK_TXDMA_VIQ_MAP_8822B) << BIT_SHIFT_TXDMA_VIQ_MAP_8822B) -+#define BITS_TXDMA_VIQ_MAP_8822B \ -+ (BIT_MASK_TXDMA_VIQ_MAP_8822B << BIT_SHIFT_TXDMA_VIQ_MAP_8822B) -+#define BIT_CLEAR_TXDMA_VIQ_MAP_8822B(x) ((x) & (~BITS_TXDMA_VIQ_MAP_8822B)) -+#define BIT_GET_TXDMA_VIQ_MAP_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VIQ_MAP_8822B) & BIT_MASK_TXDMA_VIQ_MAP_8822B) -+#define BIT_SET_TXDMA_VIQ_MAP_8822B(x, v) \ -+ (BIT_CLEAR_TXDMA_VIQ_MAP_8822B(x) | BIT_TXDMA_VIQ_MAP_8822B(v)) -+ -+#define BIT_SHIFT_TXDMA_VOQ_MAP_8822B 4 -+#define BIT_MASK_TXDMA_VOQ_MAP_8822B 0x3 -+#define BIT_TXDMA_VOQ_MAP_8822B(x) \ -+ (((x) & BIT_MASK_TXDMA_VOQ_MAP_8822B) << BIT_SHIFT_TXDMA_VOQ_MAP_8822B) -+#define BITS_TXDMA_VOQ_MAP_8822B \ -+ (BIT_MASK_TXDMA_VOQ_MAP_8822B << BIT_SHIFT_TXDMA_VOQ_MAP_8822B) -+#define BIT_CLEAR_TXDMA_VOQ_MAP_8822B(x) ((x) & (~BITS_TXDMA_VOQ_MAP_8822B)) -+#define BIT_GET_TXDMA_VOQ_MAP_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VOQ_MAP_8822B) & BIT_MASK_TXDMA_VOQ_MAP_8822B) -+#define BIT_SET_TXDMA_VOQ_MAP_8822B(x, v) \ -+ (BIT_CLEAR_TXDMA_VOQ_MAP_8822B(x) | BIT_TXDMA_VOQ_MAP_8822B(v)) -+ -+#define BIT_RXDMA_AGG_EN_8822B BIT(2) -+#define BIT_RXSHFT_EN_8822B BIT(1) -+#define BIT_RXDMA_ARBBW_EN_8822B BIT(0) -+ -+/* 2 REG_TRXFF_BNDY_8822B */ -+ -+#define BIT_SHIFT_RXFFOVFL_RSV_V2_8822B 8 -+#define BIT_MASK_RXFFOVFL_RSV_V2_8822B 0xf -+#define BIT_RXFFOVFL_RSV_V2_8822B(x) \ -+ (((x) & BIT_MASK_RXFFOVFL_RSV_V2_8822B) \ -+ << BIT_SHIFT_RXFFOVFL_RSV_V2_8822B) -+#define BITS_RXFFOVFL_RSV_V2_8822B \ -+ (BIT_MASK_RXFFOVFL_RSV_V2_8822B << BIT_SHIFT_RXFFOVFL_RSV_V2_8822B) -+#define BIT_CLEAR_RXFFOVFL_RSV_V2_8822B(x) ((x) & (~BITS_RXFFOVFL_RSV_V2_8822B)) -+#define BIT_GET_RXFFOVFL_RSV_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXFFOVFL_RSV_V2_8822B) & \ -+ BIT_MASK_RXFFOVFL_RSV_V2_8822B) -+#define BIT_SET_RXFFOVFL_RSV_V2_8822B(x, v) \ -+ (BIT_CLEAR_RXFFOVFL_RSV_V2_8822B(x) | BIT_RXFFOVFL_RSV_V2_8822B(v)) -+ -+#define BIT_SHIFT_TXPKTBUF_PGBNDY_8822B 0 -+#define BIT_MASK_TXPKTBUF_PGBNDY_8822B 0xff -+#define BIT_TXPKTBUF_PGBNDY_8822B(x) \ -+ (((x) & BIT_MASK_TXPKTBUF_PGBNDY_8822B) \ -+ << BIT_SHIFT_TXPKTBUF_PGBNDY_8822B) -+#define BITS_TXPKTBUF_PGBNDY_8822B \ -+ (BIT_MASK_TXPKTBUF_PGBNDY_8822B << BIT_SHIFT_TXPKTBUF_PGBNDY_8822B) -+#define BIT_CLEAR_TXPKTBUF_PGBNDY_8822B(x) ((x) & (~BITS_TXPKTBUF_PGBNDY_8822B)) -+#define BIT_GET_TXPKTBUF_PGBNDY_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXPKTBUF_PGBNDY_8822B) & \ -+ BIT_MASK_TXPKTBUF_PGBNDY_8822B) -+#define BIT_SET_TXPKTBUF_PGBNDY_8822B(x, v) \ -+ (BIT_CLEAR_TXPKTBUF_PGBNDY_8822B(x) | BIT_TXPKTBUF_PGBNDY_8822B(v)) -+ -+/* 2 REG_PTA_I2C_MBOX_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_I2C_M_STATUS_8822B 8 -+#define BIT_MASK_I2C_M_STATUS_8822B 0xf -+#define BIT_I2C_M_STATUS_8822B(x) \ -+ (((x) & BIT_MASK_I2C_M_STATUS_8822B) << BIT_SHIFT_I2C_M_STATUS_8822B) -+#define BITS_I2C_M_STATUS_8822B \ -+ (BIT_MASK_I2C_M_STATUS_8822B << BIT_SHIFT_I2C_M_STATUS_8822B) -+#define BIT_CLEAR_I2C_M_STATUS_8822B(x) ((x) & (~BITS_I2C_M_STATUS_8822B)) -+#define BIT_GET_I2C_M_STATUS_8822B(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_STATUS_8822B) & BIT_MASK_I2C_M_STATUS_8822B) -+#define BIT_SET_I2C_M_STATUS_8822B(x, v) \ -+ (BIT_CLEAR_I2C_M_STATUS_8822B(x) | BIT_I2C_M_STATUS_8822B(v)) -+ -+#define BIT_SHIFT_I2C_M_BUS_GNT_FW_8822B 4 -+#define BIT_MASK_I2C_M_BUS_GNT_FW_8822B 0x7 -+#define BIT_I2C_M_BUS_GNT_FW_8822B(x) \ -+ (((x) & BIT_MASK_I2C_M_BUS_GNT_FW_8822B) \ -+ << BIT_SHIFT_I2C_M_BUS_GNT_FW_8822B) -+#define BITS_I2C_M_BUS_GNT_FW_8822B \ -+ (BIT_MASK_I2C_M_BUS_GNT_FW_8822B << BIT_SHIFT_I2C_M_BUS_GNT_FW_8822B) -+#define BIT_CLEAR_I2C_M_BUS_GNT_FW_8822B(x) \ -+ ((x) & (~BITS_I2C_M_BUS_GNT_FW_8822B)) -+#define BIT_GET_I2C_M_BUS_GNT_FW_8822B(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_BUS_GNT_FW_8822B) & \ -+ BIT_MASK_I2C_M_BUS_GNT_FW_8822B) -+#define BIT_SET_I2C_M_BUS_GNT_FW_8822B(x, v) \ -+ (BIT_CLEAR_I2C_M_BUS_GNT_FW_8822B(x) | BIT_I2C_M_BUS_GNT_FW_8822B(v)) -+ -+#define BIT_I2C_M_GNT_FW_8822B BIT(3) -+ -+#define BIT_SHIFT_I2C_M_SPEED_8822B 1 -+#define BIT_MASK_I2C_M_SPEED_8822B 0x3 -+#define BIT_I2C_M_SPEED_8822B(x) \ -+ (((x) & BIT_MASK_I2C_M_SPEED_8822B) << BIT_SHIFT_I2C_M_SPEED_8822B) -+#define BITS_I2C_M_SPEED_8822B \ -+ (BIT_MASK_I2C_M_SPEED_8822B << BIT_SHIFT_I2C_M_SPEED_8822B) -+#define BIT_CLEAR_I2C_M_SPEED_8822B(x) ((x) & (~BITS_I2C_M_SPEED_8822B)) -+#define BIT_GET_I2C_M_SPEED_8822B(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_SPEED_8822B) & BIT_MASK_I2C_M_SPEED_8822B) -+#define BIT_SET_I2C_M_SPEED_8822B(x, v) \ -+ (BIT_CLEAR_I2C_M_SPEED_8822B(x) | BIT_I2C_M_SPEED_8822B(v)) -+ -+#define BIT_I2C_M_UNLOCK_8822B BIT(0) -+ -+/* 2 REG_RXFF_BNDY_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_RXFF0_BNDY_V2_8822B 0 -+#define BIT_MASK_RXFF0_BNDY_V2_8822B 0x3ffff -+#define BIT_RXFF0_BNDY_V2_8822B(x) \ -+ (((x) & BIT_MASK_RXFF0_BNDY_V2_8822B) << BIT_SHIFT_RXFF0_BNDY_V2_8822B) -+#define BITS_RXFF0_BNDY_V2_8822B \ -+ (BIT_MASK_RXFF0_BNDY_V2_8822B << BIT_SHIFT_RXFF0_BNDY_V2_8822B) -+#define BIT_CLEAR_RXFF0_BNDY_V2_8822B(x) ((x) & (~BITS_RXFF0_BNDY_V2_8822B)) -+#define BIT_GET_RXFF0_BNDY_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_BNDY_V2_8822B) & BIT_MASK_RXFF0_BNDY_V2_8822B) -+#define BIT_SET_RXFF0_BNDY_V2_8822B(x, v) \ -+ (BIT_CLEAR_RXFF0_BNDY_V2_8822B(x) | BIT_RXFF0_BNDY_V2_8822B(v)) -+ -+/* 2 REG_FE1IMR_8822B */ -+#define BIT_FS_RXDMA2_DONE_INT_EN_8822B BIT(28) -+#define BIT_FS_RXDONE3_INT_EN_8822B BIT(27) -+#define BIT_FS_RXDONE2_INT_EN_8822B BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_EN_8822B BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_EN_8822B BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_EN_8822B BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_EN_8822B BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_EN_8822B BIT(21) -+#define BIT_FS_RX_UMD0_INT_EN_8822B BIT(20) -+#define BIT_FS_RX_UMD1_INT_EN_8822B BIT(19) -+#define BIT_FS_RX_BMD0_INT_EN_8822B BIT(18) -+#define BIT_FS_RX_BMD1_INT_EN_8822B BIT(17) -+#define BIT_FS_RXDONE_INT_EN_8822B BIT(16) -+#define BIT_FS_WWLAN_INT_EN_8822B BIT(15) -+#define BIT_FS_SOUND_DONE_INT_EN_8822B BIT(14) -+#define BIT_FS_LP_STBY_INT_EN_8822B BIT(13) -+#define BIT_FS_TRL_MTR_INT_EN_8822B BIT(12) -+#define BIT_FS_BF1_PRETO_INT_EN_8822B BIT(11) -+#define BIT_FS_BF0_PRETO_INT_EN_8822B BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_EN_8822B BIT(9) -+#define BIT_FS_LTE_COEX_EN_8822B BIT(6) -+#define BIT_FS_WLACTOFF_INT_EN_8822B BIT(5) -+#define BIT_FS_WLACTON_INT_EN_8822B BIT(4) -+#define BIT_FS_BTCMD_INT_EN_8822B BIT(3) -+#define BIT_FS_REG_MAILBOX_TO_I2C_INT_EN_8822B BIT(2) -+#define BIT_FS_TRPC_TO_INT_EN_V1_8822B BIT(1) -+#define BIT_FS_RPC_O_T_INT_EN_V1_8822B BIT(0) -+ -+/* 2 REG_FE1ISR_8822B */ -+#define BIT_FS_RXDMA2_DONE_INT_8822B BIT(28) -+#define BIT_FS_RXDONE3_INT_8822B BIT(27) -+#define BIT_FS_RXDONE2_INT_8822B BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_8822B BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_8822B BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_8822B BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_8822B BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_8822B BIT(21) -+#define BIT_FS_RX_UMD0_INT_8822B BIT(20) -+#define BIT_FS_RX_UMD1_INT_8822B BIT(19) -+#define BIT_FS_RX_BMD0_INT_8822B BIT(18) -+#define BIT_FS_RX_BMD1_INT_8822B BIT(17) -+#define BIT_FS_RXDONE_INT_8822B BIT(16) -+#define BIT_FS_WWLAN_INT_8822B BIT(15) -+#define BIT_FS_SOUND_DONE_INT_8822B BIT(14) -+#define BIT_FS_LP_STBY_INT_8822B BIT(13) -+#define BIT_FS_TRL_MTR_INT_8822B BIT(12) -+#define BIT_FS_BF1_PRETO_INT_8822B BIT(11) -+#define BIT_FS_BF0_PRETO_INT_8822B BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_8822B BIT(9) -+#define BIT_FS_LTE_COEX_INT_8822B BIT(6) -+#define BIT_FS_WLACTOFF_INT_8822B BIT(5) -+#define BIT_FS_WLACTON_INT_8822B BIT(4) -+#define BIT_FS_BCN_RX_INT_INT_8822B BIT(3) -+#define BIT_FS_MAILBOX_TO_I2C_INT_8822B BIT(2) -+#define BIT_FS_TRPC_TO_INT_8822B BIT(1) -+#define BIT_FS_RPC_O_T_INT_8822B BIT(0) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_CPWM_8822B */ -+#define BIT_CPWM_TOGGLING_8822B BIT(31) -+ -+#define BIT_SHIFT_CPWM_MOD_8822B 24 -+#define BIT_MASK_CPWM_MOD_8822B 0x7f -+#define BIT_CPWM_MOD_8822B(x) \ -+ (((x) & BIT_MASK_CPWM_MOD_8822B) << BIT_SHIFT_CPWM_MOD_8822B) -+#define BITS_CPWM_MOD_8822B \ -+ (BIT_MASK_CPWM_MOD_8822B << BIT_SHIFT_CPWM_MOD_8822B) -+#define BIT_CLEAR_CPWM_MOD_8822B(x) ((x) & (~BITS_CPWM_MOD_8822B)) -+#define BIT_GET_CPWM_MOD_8822B(x) \ -+ (((x) >> BIT_SHIFT_CPWM_MOD_8822B) & BIT_MASK_CPWM_MOD_8822B) -+#define BIT_SET_CPWM_MOD_8822B(x, v) \ -+ (BIT_CLEAR_CPWM_MOD_8822B(x) | BIT_CPWM_MOD_8822B(v)) -+ -+/* 2 REG_FWIMR_8822B */ -+#define BIT_FS_TXBCNOK_MB7_INT_EN_8822B BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_EN_8822B BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_EN_8822B BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_EN_8822B BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_EN_8822B BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_EN_8822B BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_EN_8822B BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_EN_8822B BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_EN_8822B BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_EN_8822B BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_EN_8822B BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_EN_8822B BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_EN_8822B BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_EN_8822B BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_EN_8822B BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_EN_8822B BIT(16) -+#define BIT_CPU_MGQ_TXDONE_INT_EN_8822B BIT(15) -+#define BIT_SIFS_OVERSPEC_INT_EN_8822B BIT(14) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_EN_8822B BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_EN_8822B BIT(12) -+#define BIT_FS_CPUMGQ_ERR_INT_EN_8822B BIT(11) -+#define BIT_FS_DDMA0_LP_INT_EN_8822B BIT(9) -+#define BIT_FS_DDMA0_HP_INT_EN_8822B BIT(8) -+#define BIT_FS_TRXRPT_INT_EN_8822B BIT(7) -+#define BIT_FS_C2H_W_READY_INT_EN_8822B BIT(6) -+#define BIT_FS_HRCV_INT_EN_8822B BIT(5) -+#define BIT_FS_H2CCMD_INT_EN_8822B BIT(4) -+#define BIT_FS_TXPKTIN_INT_EN_8822B BIT(3) -+#define BIT_FS_ERRORHDL_INT_EN_8822B BIT(2) -+#define BIT_FS_TXCCX_INT_EN_8822B BIT(1) -+#define BIT_FS_TXCLOSE_INT_EN_8822B BIT(0) -+ -+/* 2 REG_FWISR_8822B */ -+#define BIT_FS_TXBCNOK_MB7_INT_8822B BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_8822B BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_8822B BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_8822B BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_8822B BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_8822B BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_8822B BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_8822B BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_8822B BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_8822B BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_8822B BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_8822B BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_8822B BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_8822B BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_8822B BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_8822B BIT(16) -+#define BIT_CPU_MGQ_TXDONE_INT_8822B BIT(15) -+#define BIT_SIFS_OVERSPEC_INT_8822B BIT(14) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_8822B BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_8822B BIT(12) -+#define BIT_FS_CPUMGQ_ERR_INT_8822B BIT(11) -+#define BIT_FS_DDMA0_LP_INT_8822B BIT(9) -+#define BIT_FS_DDMA0_HP_INT_8822B BIT(8) -+#define BIT_FS_TRXRPT_INT_8822B BIT(7) -+#define BIT_FS_C2H_W_READY_INT_8822B BIT(6) -+#define BIT_FS_HRCV_INT_8822B BIT(5) -+#define BIT_FS_H2CCMD_INT_8822B BIT(4) -+#define BIT_FS_TXPKTIN_INT_8822B BIT(3) -+#define BIT_FS_ERRORHDL_INT_8822B BIT(2) -+#define BIT_FS_TXCCX_INT_8822B BIT(1) -+#define BIT_FS_TXCLOSE_INT_8822B BIT(0) -+ -+/* 2 REG_FTIMR_8822B */ -+#define BIT_PS_TIMER_C_EARLY_INT_EN_8822B BIT(23) -+#define BIT_PS_TIMER_B_EARLY_INT_EN_8822B BIT(22) -+#define BIT_PS_TIMER_A_EARLY_INT_EN_8822B BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_EN_8822B BIT(20) -+#define BIT_PS_TIMER_C_INT_EN_8822B BIT(19) -+#define BIT_PS_TIMER_B_INT_EN_8822B BIT(18) -+#define BIT_PS_TIMER_A_INT_EN_8822B BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_EN_8822B BIT(16) -+#define BIT_FS_PS_TIMEOUT2_EN_8822B BIT(15) -+#define BIT_FS_PS_TIMEOUT1_EN_8822B BIT(14) -+#define BIT_FS_PS_TIMEOUT0_EN_8822B BIT(13) -+#define BIT_FS_GTINT8_EN_8822B BIT(8) -+#define BIT_FS_GTINT7_EN_8822B BIT(7) -+#define BIT_FS_GTINT6_EN_8822B BIT(6) -+#define BIT_FS_GTINT5_EN_8822B BIT(5) -+#define BIT_FS_GTINT4_EN_8822B BIT(4) -+#define BIT_FS_GTINT3_EN_8822B BIT(3) -+#define BIT_FS_GTINT2_EN_8822B BIT(2) -+#define BIT_FS_GTINT1_EN_8822B BIT(1) -+#define BIT_FS_GTINT0_EN_8822B BIT(0) -+ -+/* 2 REG_FTISR_8822B */ -+#define BIT_PS_TIMER_C_EARLY__INT_8822B BIT(23) -+#define BIT_PS_TIMER_B_EARLY__INT_8822B BIT(22) -+#define BIT_PS_TIMER_A_EARLY__INT_8822B BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_8822B BIT(20) -+#define BIT_PS_TIMER_C_INT_8822B BIT(19) -+#define BIT_PS_TIMER_B_INT_8822B BIT(18) -+#define BIT_PS_TIMER_A_INT_8822B BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_8822B BIT(16) -+#define BIT_FS_PS_TIMEOUT2_INT_8822B BIT(15) -+#define BIT_FS_PS_TIMEOUT1_INT_8822B BIT(14) -+#define BIT_FS_PS_TIMEOUT0_INT_8822B BIT(13) -+#define BIT_FS_GTINT8_INT_8822B BIT(8) -+#define BIT_FS_GTINT7_INT_8822B BIT(7) -+#define BIT_FS_GTINT6_INT_8822B BIT(6) -+#define BIT_FS_GTINT5_INT_8822B BIT(5) -+#define BIT_FS_GTINT4_INT_8822B BIT(4) -+#define BIT_FS_GTINT3_INT_8822B BIT(3) -+#define BIT_FS_GTINT2_INT_8822B BIT(2) -+#define BIT_FS_GTINT1_INT_8822B BIT(1) -+#define BIT_FS_GTINT0_INT_8822B BIT(0) -+ -+/* 2 REG_PKTBUF_DBG_CTRL_8822B */ -+ -+#define BIT_SHIFT_PKTBUF_WRITE_EN_8822B 24 -+#define BIT_MASK_PKTBUF_WRITE_EN_8822B 0xff -+#define BIT_PKTBUF_WRITE_EN_8822B(x) \ -+ (((x) & BIT_MASK_PKTBUF_WRITE_EN_8822B) \ -+ << BIT_SHIFT_PKTBUF_WRITE_EN_8822B) -+#define BITS_PKTBUF_WRITE_EN_8822B \ -+ (BIT_MASK_PKTBUF_WRITE_EN_8822B << BIT_SHIFT_PKTBUF_WRITE_EN_8822B) -+#define BIT_CLEAR_PKTBUF_WRITE_EN_8822B(x) ((x) & (~BITS_PKTBUF_WRITE_EN_8822B)) -+#define BIT_GET_PKTBUF_WRITE_EN_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_WRITE_EN_8822B) & \ -+ BIT_MASK_PKTBUF_WRITE_EN_8822B) -+#define BIT_SET_PKTBUF_WRITE_EN_8822B(x, v) \ -+ (BIT_CLEAR_PKTBUF_WRITE_EN_8822B(x) | BIT_PKTBUF_WRITE_EN_8822B(v)) -+ -+#define BIT_TXRPTBUF_DBG_8822B BIT(23) -+ -+/* 2 REG_NOT_VALID_8822B */ -+#define BIT_TXPKTBUF_DBG_V2_8822B BIT(20) -+#define BIT_RXPKTBUF_DBG_8822B BIT(16) -+ -+#define BIT_SHIFT_PKTBUF_DBG_ADDR_8822B 0 -+#define BIT_MASK_PKTBUF_DBG_ADDR_8822B 0x1fff -+#define BIT_PKTBUF_DBG_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_ADDR_8822B) \ -+ << BIT_SHIFT_PKTBUF_DBG_ADDR_8822B) -+#define BITS_PKTBUF_DBG_ADDR_8822B \ -+ (BIT_MASK_PKTBUF_DBG_ADDR_8822B << BIT_SHIFT_PKTBUF_DBG_ADDR_8822B) -+#define BIT_CLEAR_PKTBUF_DBG_ADDR_8822B(x) ((x) & (~BITS_PKTBUF_DBG_ADDR_8822B)) -+#define BIT_GET_PKTBUF_DBG_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_ADDR_8822B) & \ -+ BIT_MASK_PKTBUF_DBG_ADDR_8822B) -+#define BIT_SET_PKTBUF_DBG_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_ADDR_8822B(x) | BIT_PKTBUF_DBG_ADDR_8822B(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_L_8822B */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_L_8822B 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_L_8822B 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_L_8822B(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_L_8822B) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_L_8822B) -+#define BITS_PKTBUF_DBG_DATA_L_8822B \ -+ (BIT_MASK_PKTBUF_DBG_DATA_L_8822B << BIT_SHIFT_PKTBUF_DBG_DATA_L_8822B) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_L_8822B(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_L_8822B)) -+#define BIT_GET_PKTBUF_DBG_DATA_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_L_8822B) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_L_8822B) -+#define BIT_SET_PKTBUF_DBG_DATA_L_8822B(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_L_8822B(x) | BIT_PKTBUF_DBG_DATA_L_8822B(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_H_8822B */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_H_8822B 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_H_8822B 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_H_8822B(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_H_8822B) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_H_8822B) -+#define BITS_PKTBUF_DBG_DATA_H_8822B \ -+ (BIT_MASK_PKTBUF_DBG_DATA_H_8822B << BIT_SHIFT_PKTBUF_DBG_DATA_H_8822B) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_H_8822B(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_H_8822B)) -+#define BIT_GET_PKTBUF_DBG_DATA_H_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_H_8822B) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_H_8822B) -+#define BIT_SET_PKTBUF_DBG_DATA_H_8822B(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_H_8822B(x) | BIT_PKTBUF_DBG_DATA_H_8822B(v)) -+ -+/* 2 REG_CPWM2_8822B */ -+ -+#define BIT_SHIFT_L0S_TO_RCVY_NUM_8822B 16 -+#define BIT_MASK_L0S_TO_RCVY_NUM_8822B 0xff -+#define BIT_L0S_TO_RCVY_NUM_8822B(x) \ -+ (((x) & BIT_MASK_L0S_TO_RCVY_NUM_8822B) \ -+ << BIT_SHIFT_L0S_TO_RCVY_NUM_8822B) -+#define BITS_L0S_TO_RCVY_NUM_8822B \ -+ (BIT_MASK_L0S_TO_RCVY_NUM_8822B << BIT_SHIFT_L0S_TO_RCVY_NUM_8822B) -+#define BIT_CLEAR_L0S_TO_RCVY_NUM_8822B(x) ((x) & (~BITS_L0S_TO_RCVY_NUM_8822B)) -+#define BIT_GET_L0S_TO_RCVY_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_L0S_TO_RCVY_NUM_8822B) & \ -+ BIT_MASK_L0S_TO_RCVY_NUM_8822B) -+#define BIT_SET_L0S_TO_RCVY_NUM_8822B(x, v) \ -+ (BIT_CLEAR_L0S_TO_RCVY_NUM_8822B(x) | BIT_L0S_TO_RCVY_NUM_8822B(v)) -+ -+#define BIT_CPWM2_TOGGLING_8822B BIT(15) -+ -+#define BIT_SHIFT_CPWM2_MOD_8822B 0 -+#define BIT_MASK_CPWM2_MOD_8822B 0x7fff -+#define BIT_CPWM2_MOD_8822B(x) \ -+ (((x) & BIT_MASK_CPWM2_MOD_8822B) << BIT_SHIFT_CPWM2_MOD_8822B) -+#define BITS_CPWM2_MOD_8822B \ -+ (BIT_MASK_CPWM2_MOD_8822B << BIT_SHIFT_CPWM2_MOD_8822B) -+#define BIT_CLEAR_CPWM2_MOD_8822B(x) ((x) & (~BITS_CPWM2_MOD_8822B)) -+#define BIT_GET_CPWM2_MOD_8822B(x) \ -+ (((x) >> BIT_SHIFT_CPWM2_MOD_8822B) & BIT_MASK_CPWM2_MOD_8822B) -+#define BIT_SET_CPWM2_MOD_8822B(x, v) \ -+ (BIT_CLEAR_CPWM2_MOD_8822B(x) | BIT_CPWM2_MOD_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_TC0_CTRL_8822B */ -+#define BIT_TC0INT_EN_8822B BIT(26) -+#define BIT_TC0MODE_8822B BIT(25) -+#define BIT_TC0EN_8822B BIT(24) -+ -+#define BIT_SHIFT_TC0DATA_8822B 0 -+#define BIT_MASK_TC0DATA_8822B 0xffffff -+#define BIT_TC0DATA_8822B(x) \ -+ (((x) & BIT_MASK_TC0DATA_8822B) << BIT_SHIFT_TC0DATA_8822B) -+#define BITS_TC0DATA_8822B (BIT_MASK_TC0DATA_8822B << BIT_SHIFT_TC0DATA_8822B) -+#define BIT_CLEAR_TC0DATA_8822B(x) ((x) & (~BITS_TC0DATA_8822B)) -+#define BIT_GET_TC0DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TC0DATA_8822B) & BIT_MASK_TC0DATA_8822B) -+#define BIT_SET_TC0DATA_8822B(x, v) \ -+ (BIT_CLEAR_TC0DATA_8822B(x) | BIT_TC0DATA_8822B(v)) -+ -+/* 2 REG_TC1_CTRL_8822B */ -+#define BIT_TC1INT_EN_8822B BIT(26) -+#define BIT_TC1MODE_8822B BIT(25) -+#define BIT_TC1EN_8822B BIT(24) -+ -+#define BIT_SHIFT_TC1DATA_8822B 0 -+#define BIT_MASK_TC1DATA_8822B 0xffffff -+#define BIT_TC1DATA_8822B(x) \ -+ (((x) & BIT_MASK_TC1DATA_8822B) << BIT_SHIFT_TC1DATA_8822B) -+#define BITS_TC1DATA_8822B (BIT_MASK_TC1DATA_8822B << BIT_SHIFT_TC1DATA_8822B) -+#define BIT_CLEAR_TC1DATA_8822B(x) ((x) & (~BITS_TC1DATA_8822B)) -+#define BIT_GET_TC1DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TC1DATA_8822B) & BIT_MASK_TC1DATA_8822B) -+#define BIT_SET_TC1DATA_8822B(x, v) \ -+ (BIT_CLEAR_TC1DATA_8822B(x) | BIT_TC1DATA_8822B(v)) -+ -+/* 2 REG_TC2_CTRL_8822B */ -+#define BIT_TC2INT_EN_8822B BIT(26) -+#define BIT_TC2MODE_8822B BIT(25) -+#define BIT_TC2EN_8822B BIT(24) -+ -+#define BIT_SHIFT_TC2DATA_8822B 0 -+#define BIT_MASK_TC2DATA_8822B 0xffffff -+#define BIT_TC2DATA_8822B(x) \ -+ (((x) & BIT_MASK_TC2DATA_8822B) << BIT_SHIFT_TC2DATA_8822B) -+#define BITS_TC2DATA_8822B (BIT_MASK_TC2DATA_8822B << BIT_SHIFT_TC2DATA_8822B) -+#define BIT_CLEAR_TC2DATA_8822B(x) ((x) & (~BITS_TC2DATA_8822B)) -+#define BIT_GET_TC2DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TC2DATA_8822B) & BIT_MASK_TC2DATA_8822B) -+#define BIT_SET_TC2DATA_8822B(x, v) \ -+ (BIT_CLEAR_TC2DATA_8822B(x) | BIT_TC2DATA_8822B(v)) -+ -+/* 2 REG_TC3_CTRL_8822B */ -+#define BIT_TC3INT_EN_8822B BIT(26) -+#define BIT_TC3MODE_8822B BIT(25) -+#define BIT_TC3EN_8822B BIT(24) -+ -+#define BIT_SHIFT_TC3DATA_8822B 0 -+#define BIT_MASK_TC3DATA_8822B 0xffffff -+#define BIT_TC3DATA_8822B(x) \ -+ (((x) & BIT_MASK_TC3DATA_8822B) << BIT_SHIFT_TC3DATA_8822B) -+#define BITS_TC3DATA_8822B (BIT_MASK_TC3DATA_8822B << BIT_SHIFT_TC3DATA_8822B) -+#define BIT_CLEAR_TC3DATA_8822B(x) ((x) & (~BITS_TC3DATA_8822B)) -+#define BIT_GET_TC3DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TC3DATA_8822B) & BIT_MASK_TC3DATA_8822B) -+#define BIT_SET_TC3DATA_8822B(x, v) \ -+ (BIT_CLEAR_TC3DATA_8822B(x) | BIT_TC3DATA_8822B(v)) -+ -+/* 2 REG_TC4_CTRL_8822B */ -+#define BIT_TC4INT_EN_8822B BIT(26) -+#define BIT_TC4MODE_8822B BIT(25) -+#define BIT_TC4EN_8822B BIT(24) -+ -+#define BIT_SHIFT_TC4DATA_8822B 0 -+#define BIT_MASK_TC4DATA_8822B 0xffffff -+#define BIT_TC4DATA_8822B(x) \ -+ (((x) & BIT_MASK_TC4DATA_8822B) << BIT_SHIFT_TC4DATA_8822B) -+#define BITS_TC4DATA_8822B (BIT_MASK_TC4DATA_8822B << BIT_SHIFT_TC4DATA_8822B) -+#define BIT_CLEAR_TC4DATA_8822B(x) ((x) & (~BITS_TC4DATA_8822B)) -+#define BIT_GET_TC4DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TC4DATA_8822B) & BIT_MASK_TC4DATA_8822B) -+#define BIT_SET_TC4DATA_8822B(x, v) \ -+ (BIT_CLEAR_TC4DATA_8822B(x) | BIT_TC4DATA_8822B(v)) -+ -+/* 2 REG_TCUNIT_BASE_8822B */ -+ -+#define BIT_SHIFT_TCUNIT_BASE_8822B 0 -+#define BIT_MASK_TCUNIT_BASE_8822B 0x3fff -+#define BIT_TCUNIT_BASE_8822B(x) \ -+ (((x) & BIT_MASK_TCUNIT_BASE_8822B) << BIT_SHIFT_TCUNIT_BASE_8822B) -+#define BITS_TCUNIT_BASE_8822B \ -+ (BIT_MASK_TCUNIT_BASE_8822B << BIT_SHIFT_TCUNIT_BASE_8822B) -+#define BIT_CLEAR_TCUNIT_BASE_8822B(x) ((x) & (~BITS_TCUNIT_BASE_8822B)) -+#define BIT_GET_TCUNIT_BASE_8822B(x) \ -+ (((x) >> BIT_SHIFT_TCUNIT_BASE_8822B) & BIT_MASK_TCUNIT_BASE_8822B) -+#define BIT_SET_TCUNIT_BASE_8822B(x, v) \ -+ (BIT_CLEAR_TCUNIT_BASE_8822B(x) | BIT_TCUNIT_BASE_8822B(v)) -+ -+/* 2 REG_TC5_CTRL_8822B */ -+#define BIT_TC5INT_EN_8822B BIT(26) -+#define BIT_TC5MODE_8822B BIT(25) -+#define BIT_TC5EN_8822B BIT(24) -+ -+#define BIT_SHIFT_TC5DATA_8822B 0 -+#define BIT_MASK_TC5DATA_8822B 0xffffff -+#define BIT_TC5DATA_8822B(x) \ -+ (((x) & BIT_MASK_TC5DATA_8822B) << BIT_SHIFT_TC5DATA_8822B) -+#define BITS_TC5DATA_8822B (BIT_MASK_TC5DATA_8822B << BIT_SHIFT_TC5DATA_8822B) -+#define BIT_CLEAR_TC5DATA_8822B(x) ((x) & (~BITS_TC5DATA_8822B)) -+#define BIT_GET_TC5DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TC5DATA_8822B) & BIT_MASK_TC5DATA_8822B) -+#define BIT_SET_TC5DATA_8822B(x, v) \ -+ (BIT_CLEAR_TC5DATA_8822B(x) | BIT_TC5DATA_8822B(v)) -+ -+/* 2 REG_TC6_CTRL_8822B */ -+#define BIT_TC6INT_EN_8822B BIT(26) -+#define BIT_TC6MODE_8822B BIT(25) -+#define BIT_TC6EN_8822B BIT(24) -+ -+#define BIT_SHIFT_TC6DATA_8822B 0 -+#define BIT_MASK_TC6DATA_8822B 0xffffff -+#define BIT_TC6DATA_8822B(x) \ -+ (((x) & BIT_MASK_TC6DATA_8822B) << BIT_SHIFT_TC6DATA_8822B) -+#define BITS_TC6DATA_8822B (BIT_MASK_TC6DATA_8822B << BIT_SHIFT_TC6DATA_8822B) -+#define BIT_CLEAR_TC6DATA_8822B(x) ((x) & (~BITS_TC6DATA_8822B)) -+#define BIT_GET_TC6DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TC6DATA_8822B) & BIT_MASK_TC6DATA_8822B) -+#define BIT_SET_TC6DATA_8822B(x, v) \ -+ (BIT_CLEAR_TC6DATA_8822B(x) | BIT_TC6DATA_8822B(v)) -+ -+/* 2 REG_MBIST_FAIL_8822B */ -+ -+#define BIT_SHIFT_8051_MBIST_FAIL_8822B 26 -+#define BIT_MASK_8051_MBIST_FAIL_8822B 0x7 -+#define BIT_8051_MBIST_FAIL_8822B(x) \ -+ (((x) & BIT_MASK_8051_MBIST_FAIL_8822B) \ -+ << BIT_SHIFT_8051_MBIST_FAIL_8822B) -+#define BITS_8051_MBIST_FAIL_8822B \ -+ (BIT_MASK_8051_MBIST_FAIL_8822B << BIT_SHIFT_8051_MBIST_FAIL_8822B) -+#define BIT_CLEAR_8051_MBIST_FAIL_8822B(x) ((x) & (~BITS_8051_MBIST_FAIL_8822B)) -+#define BIT_GET_8051_MBIST_FAIL_8822B(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_FAIL_8822B) & \ -+ BIT_MASK_8051_MBIST_FAIL_8822B) -+#define BIT_SET_8051_MBIST_FAIL_8822B(x, v) \ -+ (BIT_CLEAR_8051_MBIST_FAIL_8822B(x) | BIT_8051_MBIST_FAIL_8822B(v)) -+ -+#define BIT_SHIFT_USB_MBIST_FAIL_8822B 24 -+#define BIT_MASK_USB_MBIST_FAIL_8822B 0x3 -+#define BIT_USB_MBIST_FAIL_8822B(x) \ -+ (((x) & BIT_MASK_USB_MBIST_FAIL_8822B) \ -+ << BIT_SHIFT_USB_MBIST_FAIL_8822B) -+#define BITS_USB_MBIST_FAIL_8822B \ -+ (BIT_MASK_USB_MBIST_FAIL_8822B << BIT_SHIFT_USB_MBIST_FAIL_8822B) -+#define BIT_CLEAR_USB_MBIST_FAIL_8822B(x) ((x) & (~BITS_USB_MBIST_FAIL_8822B)) -+#define BIT_GET_USB_MBIST_FAIL_8822B(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_FAIL_8822B) & \ -+ BIT_MASK_USB_MBIST_FAIL_8822B) -+#define BIT_SET_USB_MBIST_FAIL_8822B(x, v) \ -+ (BIT_CLEAR_USB_MBIST_FAIL_8822B(x) | BIT_USB_MBIST_FAIL_8822B(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_FAIL_8822B 16 -+#define BIT_MASK_PCIE_MBIST_FAIL_8822B 0x3f -+#define BIT_PCIE_MBIST_FAIL_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_FAIL_8822B) \ -+ << BIT_SHIFT_PCIE_MBIST_FAIL_8822B) -+#define BITS_PCIE_MBIST_FAIL_8822B \ -+ (BIT_MASK_PCIE_MBIST_FAIL_8822B << BIT_SHIFT_PCIE_MBIST_FAIL_8822B) -+#define BIT_CLEAR_PCIE_MBIST_FAIL_8822B(x) ((x) & (~BITS_PCIE_MBIST_FAIL_8822B)) -+#define BIT_GET_PCIE_MBIST_FAIL_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_FAIL_8822B) & \ -+ BIT_MASK_PCIE_MBIST_FAIL_8822B) -+#define BIT_SET_PCIE_MBIST_FAIL_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_FAIL_8822B(x) | BIT_PCIE_MBIST_FAIL_8822B(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_FAIL_8822B 0 -+#define BIT_MASK_MAC_MBIST_FAIL_8822B 0xfff -+#define BIT_MAC_MBIST_FAIL_8822B(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_FAIL_8822B) \ -+ << BIT_SHIFT_MAC_MBIST_FAIL_8822B) -+#define BITS_MAC_MBIST_FAIL_8822B \ -+ (BIT_MASK_MAC_MBIST_FAIL_8822B << BIT_SHIFT_MAC_MBIST_FAIL_8822B) -+#define BIT_CLEAR_MAC_MBIST_FAIL_8822B(x) ((x) & (~BITS_MAC_MBIST_FAIL_8822B)) -+#define BIT_GET_MAC_MBIST_FAIL_8822B(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_FAIL_8822B) & \ -+ BIT_MASK_MAC_MBIST_FAIL_8822B) -+#define BIT_SET_MAC_MBIST_FAIL_8822B(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_FAIL_8822B(x) | BIT_MAC_MBIST_FAIL_8822B(v)) -+ -+/* 2 REG_MBIST_START_PAUSE_8822B */ -+ -+#define BIT_SHIFT_8051_MBIST_START_PAUSE_8822B 26 -+#define BIT_MASK_8051_MBIST_START_PAUSE_8822B 0x7 -+#define BIT_8051_MBIST_START_PAUSE_8822B(x) \ -+ (((x) & BIT_MASK_8051_MBIST_START_PAUSE_8822B) \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_8822B) -+#define BITS_8051_MBIST_START_PAUSE_8822B \ -+ (BIT_MASK_8051_MBIST_START_PAUSE_8822B \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_8822B) -+#define BIT_CLEAR_8051_MBIST_START_PAUSE_8822B(x) \ -+ ((x) & (~BITS_8051_MBIST_START_PAUSE_8822B)) -+#define BIT_GET_8051_MBIST_START_PAUSE_8822B(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_START_PAUSE_8822B) & \ -+ BIT_MASK_8051_MBIST_START_PAUSE_8822B) -+#define BIT_SET_8051_MBIST_START_PAUSE_8822B(x, v) \ -+ (BIT_CLEAR_8051_MBIST_START_PAUSE_8822B(x) | \ -+ BIT_8051_MBIST_START_PAUSE_8822B(v)) -+ -+#define BIT_SHIFT_USB_MBIST_START_PAUSE_8822B 24 -+#define BIT_MASK_USB_MBIST_START_PAUSE_8822B 0x3 -+#define BIT_USB_MBIST_START_PAUSE_8822B(x) \ -+ (((x) & BIT_MASK_USB_MBIST_START_PAUSE_8822B) \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_8822B) -+#define BITS_USB_MBIST_START_PAUSE_8822B \ -+ (BIT_MASK_USB_MBIST_START_PAUSE_8822B \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_8822B) -+#define BIT_CLEAR_USB_MBIST_START_PAUSE_8822B(x) \ -+ ((x) & (~BITS_USB_MBIST_START_PAUSE_8822B)) -+#define BIT_GET_USB_MBIST_START_PAUSE_8822B(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_START_PAUSE_8822B) & \ -+ BIT_MASK_USB_MBIST_START_PAUSE_8822B) -+#define BIT_SET_USB_MBIST_START_PAUSE_8822B(x, v) \ -+ (BIT_CLEAR_USB_MBIST_START_PAUSE_8822B(x) | \ -+ BIT_USB_MBIST_START_PAUSE_8822B(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_START_PAUSE_8822B 16 -+#define BIT_MASK_PCIE_MBIST_START_PAUSE_8822B 0x3f -+#define BIT_PCIE_MBIST_START_PAUSE_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_START_PAUSE_8822B) \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_8822B) -+#define BITS_PCIE_MBIST_START_PAUSE_8822B \ -+ (BIT_MASK_PCIE_MBIST_START_PAUSE_8822B \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_8822B) -+#define BIT_CLEAR_PCIE_MBIST_START_PAUSE_8822B(x) \ -+ ((x) & (~BITS_PCIE_MBIST_START_PAUSE_8822B)) -+#define BIT_GET_PCIE_MBIST_START_PAUSE_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_START_PAUSE_8822B) & \ -+ BIT_MASK_PCIE_MBIST_START_PAUSE_8822B) -+#define BIT_SET_PCIE_MBIST_START_PAUSE_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_START_PAUSE_8822B(x) | \ -+ BIT_PCIE_MBIST_START_PAUSE_8822B(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_START_PAUSE_8822B 0 -+#define BIT_MASK_MAC_MBIST_START_PAUSE_8822B 0xfff -+#define BIT_MAC_MBIST_START_PAUSE_8822B(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_START_PAUSE_8822B) \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_8822B) -+#define BITS_MAC_MBIST_START_PAUSE_8822B \ -+ (BIT_MASK_MAC_MBIST_START_PAUSE_8822B \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_8822B) -+#define BIT_CLEAR_MAC_MBIST_START_PAUSE_8822B(x) \ -+ ((x) & (~BITS_MAC_MBIST_START_PAUSE_8822B)) -+#define BIT_GET_MAC_MBIST_START_PAUSE_8822B(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_START_PAUSE_8822B) & \ -+ BIT_MASK_MAC_MBIST_START_PAUSE_8822B) -+#define BIT_SET_MAC_MBIST_START_PAUSE_8822B(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_START_PAUSE_8822B(x) | \ -+ BIT_MAC_MBIST_START_PAUSE_8822B(v)) -+ -+/* 2 REG_MBIST_DONE_8822B */ -+ -+#define BIT_SHIFT_8051_MBIST_DONE_8822B 26 -+#define BIT_MASK_8051_MBIST_DONE_8822B 0x7 -+#define BIT_8051_MBIST_DONE_8822B(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DONE_8822B) \ -+ << BIT_SHIFT_8051_MBIST_DONE_8822B) -+#define BITS_8051_MBIST_DONE_8822B \ -+ (BIT_MASK_8051_MBIST_DONE_8822B << BIT_SHIFT_8051_MBIST_DONE_8822B) -+#define BIT_CLEAR_8051_MBIST_DONE_8822B(x) ((x) & (~BITS_8051_MBIST_DONE_8822B)) -+#define BIT_GET_8051_MBIST_DONE_8822B(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DONE_8822B) & \ -+ BIT_MASK_8051_MBIST_DONE_8822B) -+#define BIT_SET_8051_MBIST_DONE_8822B(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DONE_8822B(x) | BIT_8051_MBIST_DONE_8822B(v)) -+ -+#define BIT_SHIFT_USB_MBIST_DONE_8822B 24 -+#define BIT_MASK_USB_MBIST_DONE_8822B 0x3 -+#define BIT_USB_MBIST_DONE_8822B(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DONE_8822B) \ -+ << BIT_SHIFT_USB_MBIST_DONE_8822B) -+#define BITS_USB_MBIST_DONE_8822B \ -+ (BIT_MASK_USB_MBIST_DONE_8822B << BIT_SHIFT_USB_MBIST_DONE_8822B) -+#define BIT_CLEAR_USB_MBIST_DONE_8822B(x) ((x) & (~BITS_USB_MBIST_DONE_8822B)) -+#define BIT_GET_USB_MBIST_DONE_8822B(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DONE_8822B) & \ -+ BIT_MASK_USB_MBIST_DONE_8822B) -+#define BIT_SET_USB_MBIST_DONE_8822B(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DONE_8822B(x) | BIT_USB_MBIST_DONE_8822B(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DONE_8822B 16 -+#define BIT_MASK_PCIE_MBIST_DONE_8822B 0x3f -+#define BIT_PCIE_MBIST_DONE_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DONE_8822B) \ -+ << BIT_SHIFT_PCIE_MBIST_DONE_8822B) -+#define BITS_PCIE_MBIST_DONE_8822B \ -+ (BIT_MASK_PCIE_MBIST_DONE_8822B << BIT_SHIFT_PCIE_MBIST_DONE_8822B) -+#define BIT_CLEAR_PCIE_MBIST_DONE_8822B(x) ((x) & (~BITS_PCIE_MBIST_DONE_8822B)) -+#define BIT_GET_PCIE_MBIST_DONE_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DONE_8822B) & \ -+ BIT_MASK_PCIE_MBIST_DONE_8822B) -+#define BIT_SET_PCIE_MBIST_DONE_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DONE_8822B(x) | BIT_PCIE_MBIST_DONE_8822B(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_DONE_8822B 0 -+#define BIT_MASK_MAC_MBIST_DONE_8822B 0xfff -+#define BIT_MAC_MBIST_DONE_8822B(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DONE_8822B) \ -+ << BIT_SHIFT_MAC_MBIST_DONE_8822B) -+#define BITS_MAC_MBIST_DONE_8822B \ -+ (BIT_MASK_MAC_MBIST_DONE_8822B << BIT_SHIFT_MAC_MBIST_DONE_8822B) -+#define BIT_CLEAR_MAC_MBIST_DONE_8822B(x) ((x) & (~BITS_MAC_MBIST_DONE_8822B)) -+#define BIT_GET_MAC_MBIST_DONE_8822B(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DONE_8822B) & \ -+ BIT_MASK_MAC_MBIST_DONE_8822B) -+#define BIT_SET_MAC_MBIST_DONE_8822B(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DONE_8822B(x) | BIT_MAC_MBIST_DONE_8822B(v)) -+ -+/* 2 REG_MBIST_FAIL_NRML_8822B */ -+ -+#define BIT_SHIFT_MBIST_FAIL_NRML_8822B 0 -+#define BIT_MASK_MBIST_FAIL_NRML_8822B 0xffffffffL -+#define BIT_MBIST_FAIL_NRML_8822B(x) \ -+ (((x) & BIT_MASK_MBIST_FAIL_NRML_8822B) \ -+ << BIT_SHIFT_MBIST_FAIL_NRML_8822B) -+#define BITS_MBIST_FAIL_NRML_8822B \ -+ (BIT_MASK_MBIST_FAIL_NRML_8822B << BIT_SHIFT_MBIST_FAIL_NRML_8822B) -+#define BIT_CLEAR_MBIST_FAIL_NRML_8822B(x) ((x) & (~BITS_MBIST_FAIL_NRML_8822B)) -+#define BIT_GET_MBIST_FAIL_NRML_8822B(x) \ -+ (((x) >> BIT_SHIFT_MBIST_FAIL_NRML_8822B) & \ -+ BIT_MASK_MBIST_FAIL_NRML_8822B) -+#define BIT_SET_MBIST_FAIL_NRML_8822B(x, v) \ -+ (BIT_CLEAR_MBIST_FAIL_NRML_8822B(x) | BIT_MBIST_FAIL_NRML_8822B(v)) -+ -+/* 2 REG_AES_DECRPT_DATA_8822B */ -+ -+#define BIT_SHIFT_IPS_CFG_ADDR_8822B 0 -+#define BIT_MASK_IPS_CFG_ADDR_8822B 0xff -+#define BIT_IPS_CFG_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_IPS_CFG_ADDR_8822B) << BIT_SHIFT_IPS_CFG_ADDR_8822B) -+#define BITS_IPS_CFG_ADDR_8822B \ -+ (BIT_MASK_IPS_CFG_ADDR_8822B << BIT_SHIFT_IPS_CFG_ADDR_8822B) -+#define BIT_CLEAR_IPS_CFG_ADDR_8822B(x) ((x) & (~BITS_IPS_CFG_ADDR_8822B)) -+#define BIT_GET_IPS_CFG_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_ADDR_8822B) & BIT_MASK_IPS_CFG_ADDR_8822B) -+#define BIT_SET_IPS_CFG_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_IPS_CFG_ADDR_8822B(x) | BIT_IPS_CFG_ADDR_8822B(v)) -+ -+/* 2 REG_AES_DECRPT_CFG_8822B */ -+ -+#define BIT_SHIFT_IPS_CFG_DATA_8822B 0 -+#define BIT_MASK_IPS_CFG_DATA_8822B 0xffffffffL -+#define BIT_IPS_CFG_DATA_8822B(x) \ -+ (((x) & BIT_MASK_IPS_CFG_DATA_8822B) << BIT_SHIFT_IPS_CFG_DATA_8822B) -+#define BITS_IPS_CFG_DATA_8822B \ -+ (BIT_MASK_IPS_CFG_DATA_8822B << BIT_SHIFT_IPS_CFG_DATA_8822B) -+#define BIT_CLEAR_IPS_CFG_DATA_8822B(x) ((x) & (~BITS_IPS_CFG_DATA_8822B)) -+#define BIT_GET_IPS_CFG_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_DATA_8822B) & BIT_MASK_IPS_CFG_DATA_8822B) -+#define BIT_SET_IPS_CFG_DATA_8822B(x, v) \ -+ (BIT_CLEAR_IPS_CFG_DATA_8822B(x) | BIT_IPS_CFG_DATA_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_TMETER_8822B */ -+#define BIT_TEMP_VALID_8822B BIT(31) -+ -+#define BIT_SHIFT_TEMP_VALUE_8822B 24 -+#define BIT_MASK_TEMP_VALUE_8822B 0x3f -+#define BIT_TEMP_VALUE_8822B(x) \ -+ (((x) & BIT_MASK_TEMP_VALUE_8822B) << BIT_SHIFT_TEMP_VALUE_8822B) -+#define BITS_TEMP_VALUE_8822B \ -+ (BIT_MASK_TEMP_VALUE_8822B << BIT_SHIFT_TEMP_VALUE_8822B) -+#define BIT_CLEAR_TEMP_VALUE_8822B(x) ((x) & (~BITS_TEMP_VALUE_8822B)) -+#define BIT_GET_TEMP_VALUE_8822B(x) \ -+ (((x) >> BIT_SHIFT_TEMP_VALUE_8822B) & BIT_MASK_TEMP_VALUE_8822B) -+#define BIT_SET_TEMP_VALUE_8822B(x, v) \ -+ (BIT_CLEAR_TEMP_VALUE_8822B(x) | BIT_TEMP_VALUE_8822B(v)) -+ -+#define BIT_SHIFT_REG_TMETER_TIMER_8822B 8 -+#define BIT_MASK_REG_TMETER_TIMER_8822B 0xfff -+#define BIT_REG_TMETER_TIMER_8822B(x) \ -+ (((x) & BIT_MASK_REG_TMETER_TIMER_8822B) \ -+ << BIT_SHIFT_REG_TMETER_TIMER_8822B) -+#define BITS_REG_TMETER_TIMER_8822B \ -+ (BIT_MASK_REG_TMETER_TIMER_8822B << BIT_SHIFT_REG_TMETER_TIMER_8822B) -+#define BIT_CLEAR_REG_TMETER_TIMER_8822B(x) \ -+ ((x) & (~BITS_REG_TMETER_TIMER_8822B)) -+#define BIT_GET_REG_TMETER_TIMER_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_TMETER_TIMER_8822B) & \ -+ BIT_MASK_REG_TMETER_TIMER_8822B) -+#define BIT_SET_REG_TMETER_TIMER_8822B(x, v) \ -+ (BIT_CLEAR_REG_TMETER_TIMER_8822B(x) | BIT_REG_TMETER_TIMER_8822B(v)) -+ -+#define BIT_SHIFT_REG_TEMP_DELTA_8822B 2 -+#define BIT_MASK_REG_TEMP_DELTA_8822B 0x3f -+#define BIT_REG_TEMP_DELTA_8822B(x) \ -+ (((x) & BIT_MASK_REG_TEMP_DELTA_8822B) \ -+ << BIT_SHIFT_REG_TEMP_DELTA_8822B) -+#define BITS_REG_TEMP_DELTA_8822B \ -+ (BIT_MASK_REG_TEMP_DELTA_8822B << BIT_SHIFT_REG_TEMP_DELTA_8822B) -+#define BIT_CLEAR_REG_TEMP_DELTA_8822B(x) ((x) & (~BITS_REG_TEMP_DELTA_8822B)) -+#define BIT_GET_REG_TEMP_DELTA_8822B(x) \ -+ (((x) >> BIT_SHIFT_REG_TEMP_DELTA_8822B) & \ -+ BIT_MASK_REG_TEMP_DELTA_8822B) -+#define BIT_SET_REG_TEMP_DELTA_8822B(x, v) \ -+ (BIT_CLEAR_REG_TEMP_DELTA_8822B(x) | BIT_REG_TEMP_DELTA_8822B(v)) -+ -+#define BIT_REG_TMETER_EN_8822B BIT(0) -+ -+/* 2 REG_OSC_32K_CTRL_8822B */ -+ -+#define BIT_SHIFT_OSC_32K_CLKGEN_0_8822B 16 -+#define BIT_MASK_OSC_32K_CLKGEN_0_8822B 0xffff -+#define BIT_OSC_32K_CLKGEN_0_8822B(x) \ -+ (((x) & BIT_MASK_OSC_32K_CLKGEN_0_8822B) \ -+ << BIT_SHIFT_OSC_32K_CLKGEN_0_8822B) -+#define BITS_OSC_32K_CLKGEN_0_8822B \ -+ (BIT_MASK_OSC_32K_CLKGEN_0_8822B << BIT_SHIFT_OSC_32K_CLKGEN_0_8822B) -+#define BIT_CLEAR_OSC_32K_CLKGEN_0_8822B(x) \ -+ ((x) & (~BITS_OSC_32K_CLKGEN_0_8822B)) -+#define BIT_GET_OSC_32K_CLKGEN_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_CLKGEN_0_8822B) & \ -+ BIT_MASK_OSC_32K_CLKGEN_0_8822B) -+#define BIT_SET_OSC_32K_CLKGEN_0_8822B(x, v) \ -+ (BIT_CLEAR_OSC_32K_CLKGEN_0_8822B(x) | BIT_OSC_32K_CLKGEN_0_8822B(v)) -+ -+#define BIT_SHIFT_OSC_32K_RES_COMP_8822B 4 -+#define BIT_MASK_OSC_32K_RES_COMP_8822B 0x3 -+#define BIT_OSC_32K_RES_COMP_8822B(x) \ -+ (((x) & BIT_MASK_OSC_32K_RES_COMP_8822B) \ -+ << BIT_SHIFT_OSC_32K_RES_COMP_8822B) -+#define BITS_OSC_32K_RES_COMP_8822B \ -+ (BIT_MASK_OSC_32K_RES_COMP_8822B << BIT_SHIFT_OSC_32K_RES_COMP_8822B) -+#define BIT_CLEAR_OSC_32K_RES_COMP_8822B(x) \ -+ ((x) & (~BITS_OSC_32K_RES_COMP_8822B)) -+#define BIT_GET_OSC_32K_RES_COMP_8822B(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_RES_COMP_8822B) & \ -+ BIT_MASK_OSC_32K_RES_COMP_8822B) -+#define BIT_SET_OSC_32K_RES_COMP_8822B(x, v) \ -+ (BIT_CLEAR_OSC_32K_RES_COMP_8822B(x) | BIT_OSC_32K_RES_COMP_8822B(v)) -+ -+#define BIT_OSC_32K_OUT_SEL_8822B BIT(3) -+#define BIT_ISO_WL_2_OSC_32K_8822B BIT(1) -+#define BIT_POW_CKGEN_8822B BIT(0) -+ -+/* 2 REG_32K_CAL_REG1_8822B */ -+#define BIT_CAL_32K_REG_WR_8822B BIT(31) -+#define BIT_CAL_32K_DBG_SEL_8822B BIT(22) -+ -+#define BIT_SHIFT_CAL_32K_REG_ADDR_8822B 16 -+#define BIT_MASK_CAL_32K_REG_ADDR_8822B 0x3f -+#define BIT_CAL_32K_REG_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_ADDR_8822B) \ -+ << BIT_SHIFT_CAL_32K_REG_ADDR_8822B) -+#define BITS_CAL_32K_REG_ADDR_8822B \ -+ (BIT_MASK_CAL_32K_REG_ADDR_8822B << BIT_SHIFT_CAL_32K_REG_ADDR_8822B) -+#define BIT_CLEAR_CAL_32K_REG_ADDR_8822B(x) \ -+ ((x) & (~BITS_CAL_32K_REG_ADDR_8822B)) -+#define BIT_GET_CAL_32K_REG_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_ADDR_8822B) & \ -+ BIT_MASK_CAL_32K_REG_ADDR_8822B) -+#define BIT_SET_CAL_32K_REG_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_ADDR_8822B(x) | BIT_CAL_32K_REG_ADDR_8822B(v)) -+ -+#define BIT_SHIFT_CAL_32K_REG_DATA_8822B 0 -+#define BIT_MASK_CAL_32K_REG_DATA_8822B 0xffff -+#define BIT_CAL_32K_REG_DATA_8822B(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_DATA_8822B) \ -+ << BIT_SHIFT_CAL_32K_REG_DATA_8822B) -+#define BITS_CAL_32K_REG_DATA_8822B \ -+ (BIT_MASK_CAL_32K_REG_DATA_8822B << BIT_SHIFT_CAL_32K_REG_DATA_8822B) -+#define BIT_CLEAR_CAL_32K_REG_DATA_8822B(x) \ -+ ((x) & (~BITS_CAL_32K_REG_DATA_8822B)) -+#define BIT_GET_CAL_32K_REG_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_DATA_8822B) & \ -+ BIT_MASK_CAL_32K_REG_DATA_8822B) -+#define BIT_SET_CAL_32K_REG_DATA_8822B(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_DATA_8822B(x) | BIT_CAL_32K_REG_DATA_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_C2HEVT_8822B */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_V1_8822B 0 -+#define BIT_MASK_C2HEVT_MSG_V1_8822B 0xffffffffL -+#define BIT_C2HEVT_MSG_V1_8822B(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_V1_8822B) << BIT_SHIFT_C2HEVT_MSG_V1_8822B) -+#define BITS_C2HEVT_MSG_V1_8822B \ -+ (BIT_MASK_C2HEVT_MSG_V1_8822B << BIT_SHIFT_C2HEVT_MSG_V1_8822B) -+#define BIT_CLEAR_C2HEVT_MSG_V1_8822B(x) ((x) & (~BITS_C2HEVT_MSG_V1_8822B)) -+#define BIT_GET_C2HEVT_MSG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_V1_8822B) & BIT_MASK_C2HEVT_MSG_V1_8822B) -+#define BIT_SET_C2HEVT_MSG_V1_8822B(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_V1_8822B(x) | BIT_C2HEVT_MSG_V1_8822B(v)) -+ -+/* 2 REG_C2HEVT_1_8822B */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_1_8822B 0 -+#define BIT_MASK_C2HEVT_MSG_1_8822B 0xffffffffL -+#define BIT_C2HEVT_MSG_1_8822B(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_1_8822B) << BIT_SHIFT_C2HEVT_MSG_1_8822B) -+#define BITS_C2HEVT_MSG_1_8822B \ -+ (BIT_MASK_C2HEVT_MSG_1_8822B << BIT_SHIFT_C2HEVT_MSG_1_8822B) -+#define BIT_CLEAR_C2HEVT_MSG_1_8822B(x) ((x) & (~BITS_C2HEVT_MSG_1_8822B)) -+#define BIT_GET_C2HEVT_MSG_1_8822B(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_1_8822B) & BIT_MASK_C2HEVT_MSG_1_8822B) -+#define BIT_SET_C2HEVT_MSG_1_8822B(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_1_8822B(x) | BIT_C2HEVT_MSG_1_8822B(v)) -+ -+/* 2 REG_C2HEVT_2_8822B */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_2_8822B 0 -+#define BIT_MASK_C2HEVT_MSG_2_8822B 0xffffffffL -+#define BIT_C2HEVT_MSG_2_8822B(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_2_8822B) << BIT_SHIFT_C2HEVT_MSG_2_8822B) -+#define BITS_C2HEVT_MSG_2_8822B \ -+ (BIT_MASK_C2HEVT_MSG_2_8822B << BIT_SHIFT_C2HEVT_MSG_2_8822B) -+#define BIT_CLEAR_C2HEVT_MSG_2_8822B(x) ((x) & (~BITS_C2HEVT_MSG_2_8822B)) -+#define BIT_GET_C2HEVT_MSG_2_8822B(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_2_8822B) & BIT_MASK_C2HEVT_MSG_2_8822B) -+#define BIT_SET_C2HEVT_MSG_2_8822B(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_2_8822B(x) | BIT_C2HEVT_MSG_2_8822B(v)) -+ -+/* 2 REG_C2HEVT_3_8822B */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_3_8822B 0 -+#define BIT_MASK_C2HEVT_MSG_3_8822B 0xffffffffL -+#define BIT_C2HEVT_MSG_3_8822B(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_3_8822B) << BIT_SHIFT_C2HEVT_MSG_3_8822B) -+#define BITS_C2HEVT_MSG_3_8822B \ -+ (BIT_MASK_C2HEVT_MSG_3_8822B << BIT_SHIFT_C2HEVT_MSG_3_8822B) -+#define BIT_CLEAR_C2HEVT_MSG_3_8822B(x) ((x) & (~BITS_C2HEVT_MSG_3_8822B)) -+#define BIT_GET_C2HEVT_MSG_3_8822B(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_3_8822B) & BIT_MASK_C2HEVT_MSG_3_8822B) -+#define BIT_SET_C2HEVT_MSG_3_8822B(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_3_8822B(x) | BIT_C2HEVT_MSG_3_8822B(v)) -+ -+/* 2 REG_SW_DEFINED_PAGE1_8822B */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE1_8822B 0 -+#define BIT_MASK_SW_DEFINED_PAGE1_8822B 0xffffffffffffffffL -+#define BIT_SW_DEFINED_PAGE1_8822B(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE1_8822B) \ -+ << BIT_SHIFT_SW_DEFINED_PAGE1_8822B) -+#define BITS_SW_DEFINED_PAGE1_8822B \ -+ (BIT_MASK_SW_DEFINED_PAGE1_8822B << BIT_SHIFT_SW_DEFINED_PAGE1_8822B) -+#define BIT_CLEAR_SW_DEFINED_PAGE1_8822B(x) \ -+ ((x) & (~BITS_SW_DEFINED_PAGE1_8822B)) -+#define BIT_GET_SW_DEFINED_PAGE1_8822B(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE1_8822B) & \ -+ BIT_MASK_SW_DEFINED_PAGE1_8822B) -+#define BIT_SET_SW_DEFINED_PAGE1_8822B(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE1_8822B(x) | BIT_SW_DEFINED_PAGE1_8822B(v)) -+ -+/* 2 REG_MCUTST_I_8822B */ -+ -+#define BIT_SHIFT_MCUDMSG_I_8822B 0 -+#define BIT_MASK_MCUDMSG_I_8822B 0xffffffffL -+#define BIT_MCUDMSG_I_8822B(x) \ -+ (((x) & BIT_MASK_MCUDMSG_I_8822B) << BIT_SHIFT_MCUDMSG_I_8822B) -+#define BITS_MCUDMSG_I_8822B \ -+ (BIT_MASK_MCUDMSG_I_8822B << BIT_SHIFT_MCUDMSG_I_8822B) -+#define BIT_CLEAR_MCUDMSG_I_8822B(x) ((x) & (~BITS_MCUDMSG_I_8822B)) -+#define BIT_GET_MCUDMSG_I_8822B(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_I_8822B) & BIT_MASK_MCUDMSG_I_8822B) -+#define BIT_SET_MCUDMSG_I_8822B(x, v) \ -+ (BIT_CLEAR_MCUDMSG_I_8822B(x) | BIT_MCUDMSG_I_8822B(v)) -+ -+/* 2 REG_MCUTST_II_8822B */ -+ -+#define BIT_SHIFT_MCUDMSG_II_8822B 0 -+#define BIT_MASK_MCUDMSG_II_8822B 0xffffffffL -+#define BIT_MCUDMSG_II_8822B(x) \ -+ (((x) & BIT_MASK_MCUDMSG_II_8822B) << BIT_SHIFT_MCUDMSG_II_8822B) -+#define BITS_MCUDMSG_II_8822B \ -+ (BIT_MASK_MCUDMSG_II_8822B << BIT_SHIFT_MCUDMSG_II_8822B) -+#define BIT_CLEAR_MCUDMSG_II_8822B(x) ((x) & (~BITS_MCUDMSG_II_8822B)) -+#define BIT_GET_MCUDMSG_II_8822B(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_II_8822B) & BIT_MASK_MCUDMSG_II_8822B) -+#define BIT_SET_MCUDMSG_II_8822B(x, v) \ -+ (BIT_CLEAR_MCUDMSG_II_8822B(x) | BIT_MCUDMSG_II_8822B(v)) -+ -+/* 2 REG_FMETHR_8822B */ -+#define BIT_FMSG_INT_8822B BIT(31) -+ -+#define BIT_SHIFT_FW_MSG_8822B 0 -+#define BIT_MASK_FW_MSG_8822B 0xffffffffL -+#define BIT_FW_MSG_8822B(x) \ -+ (((x) & BIT_MASK_FW_MSG_8822B) << BIT_SHIFT_FW_MSG_8822B) -+#define BITS_FW_MSG_8822B (BIT_MASK_FW_MSG_8822B << BIT_SHIFT_FW_MSG_8822B) -+#define BIT_CLEAR_FW_MSG_8822B(x) ((x) & (~BITS_FW_MSG_8822B)) -+#define BIT_GET_FW_MSG_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_8822B) & BIT_MASK_FW_MSG_8822B) -+#define BIT_SET_FW_MSG_8822B(x, v) \ -+ (BIT_CLEAR_FW_MSG_8822B(x) | BIT_FW_MSG_8822B(v)) -+ -+/* 2 REG_HMETFR_8822B */ -+ -+#define BIT_SHIFT_HRCV_MSG_8822B 24 -+#define BIT_MASK_HRCV_MSG_8822B 0xff -+#define BIT_HRCV_MSG_8822B(x) \ -+ (((x) & BIT_MASK_HRCV_MSG_8822B) << BIT_SHIFT_HRCV_MSG_8822B) -+#define BITS_HRCV_MSG_8822B \ -+ (BIT_MASK_HRCV_MSG_8822B << BIT_SHIFT_HRCV_MSG_8822B) -+#define BIT_CLEAR_HRCV_MSG_8822B(x) ((x) & (~BITS_HRCV_MSG_8822B)) -+#define BIT_GET_HRCV_MSG_8822B(x) \ -+ (((x) >> BIT_SHIFT_HRCV_MSG_8822B) & BIT_MASK_HRCV_MSG_8822B) -+#define BIT_SET_HRCV_MSG_8822B(x, v) \ -+ (BIT_CLEAR_HRCV_MSG_8822B(x) | BIT_HRCV_MSG_8822B(v)) -+ -+#define BIT_INT_BOX3_8822B BIT(3) -+#define BIT_INT_BOX2_8822B BIT(2) -+#define BIT_INT_BOX1_8822B BIT(1) -+#define BIT_INT_BOX0_8822B BIT(0) -+ -+/* 2 REG_HMEBOX0_8822B */ -+ -+#define BIT_SHIFT_HOST_MSG_0_8822B 0 -+#define BIT_MASK_HOST_MSG_0_8822B 0xffffffffL -+#define BIT_HOST_MSG_0_8822B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_0_8822B) << BIT_SHIFT_HOST_MSG_0_8822B) -+#define BITS_HOST_MSG_0_8822B \ -+ (BIT_MASK_HOST_MSG_0_8822B << BIT_SHIFT_HOST_MSG_0_8822B) -+#define BIT_CLEAR_HOST_MSG_0_8822B(x) ((x) & (~BITS_HOST_MSG_0_8822B)) -+#define BIT_GET_HOST_MSG_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_0_8822B) & BIT_MASK_HOST_MSG_0_8822B) -+#define BIT_SET_HOST_MSG_0_8822B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_0_8822B(x) | BIT_HOST_MSG_0_8822B(v)) -+ -+/* 2 REG_HMEBOX1_8822B */ -+ -+#define BIT_SHIFT_HOST_MSG_1_8822B 0 -+#define BIT_MASK_HOST_MSG_1_8822B 0xffffffffL -+#define BIT_HOST_MSG_1_8822B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_1_8822B) << BIT_SHIFT_HOST_MSG_1_8822B) -+#define BITS_HOST_MSG_1_8822B \ -+ (BIT_MASK_HOST_MSG_1_8822B << BIT_SHIFT_HOST_MSG_1_8822B) -+#define BIT_CLEAR_HOST_MSG_1_8822B(x) ((x) & (~BITS_HOST_MSG_1_8822B)) -+#define BIT_GET_HOST_MSG_1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_1_8822B) & BIT_MASK_HOST_MSG_1_8822B) -+#define BIT_SET_HOST_MSG_1_8822B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_1_8822B(x) | BIT_HOST_MSG_1_8822B(v)) -+ -+/* 2 REG_HMEBOX2_8822B */ -+ -+#define BIT_SHIFT_HOST_MSG_2_8822B 0 -+#define BIT_MASK_HOST_MSG_2_8822B 0xffffffffL -+#define BIT_HOST_MSG_2_8822B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_2_8822B) << BIT_SHIFT_HOST_MSG_2_8822B) -+#define BITS_HOST_MSG_2_8822B \ -+ (BIT_MASK_HOST_MSG_2_8822B << BIT_SHIFT_HOST_MSG_2_8822B) -+#define BIT_CLEAR_HOST_MSG_2_8822B(x) ((x) & (~BITS_HOST_MSG_2_8822B)) -+#define BIT_GET_HOST_MSG_2_8822B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_2_8822B) & BIT_MASK_HOST_MSG_2_8822B) -+#define BIT_SET_HOST_MSG_2_8822B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_2_8822B(x) | BIT_HOST_MSG_2_8822B(v)) -+ -+/* 2 REG_HMEBOX3_8822B */ -+ -+#define BIT_SHIFT_HOST_MSG_3_8822B 0 -+#define BIT_MASK_HOST_MSG_3_8822B 0xffffffffL -+#define BIT_HOST_MSG_3_8822B(x) \ -+ (((x) & BIT_MASK_HOST_MSG_3_8822B) << BIT_SHIFT_HOST_MSG_3_8822B) -+#define BITS_HOST_MSG_3_8822B \ -+ (BIT_MASK_HOST_MSG_3_8822B << BIT_SHIFT_HOST_MSG_3_8822B) -+#define BIT_CLEAR_HOST_MSG_3_8822B(x) ((x) & (~BITS_HOST_MSG_3_8822B)) -+#define BIT_GET_HOST_MSG_3_8822B(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_3_8822B) & BIT_MASK_HOST_MSG_3_8822B) -+#define BIT_SET_HOST_MSG_3_8822B(x, v) \ -+ (BIT_CLEAR_HOST_MSG_3_8822B(x) | BIT_HOST_MSG_3_8822B(v)) -+ -+/* 2 REG_LLT_INIT_8822B */ -+ -+#define BIT_SHIFT_LLTE_RWM_8822B 30 -+#define BIT_MASK_LLTE_RWM_8822B 0x3 -+#define BIT_LLTE_RWM_8822B(x) \ -+ (((x) & BIT_MASK_LLTE_RWM_8822B) << BIT_SHIFT_LLTE_RWM_8822B) -+#define BITS_LLTE_RWM_8822B \ -+ (BIT_MASK_LLTE_RWM_8822B << BIT_SHIFT_LLTE_RWM_8822B) -+#define BIT_CLEAR_LLTE_RWM_8822B(x) ((x) & (~BITS_LLTE_RWM_8822B)) -+#define BIT_GET_LLTE_RWM_8822B(x) \ -+ (((x) >> BIT_SHIFT_LLTE_RWM_8822B) & BIT_MASK_LLTE_RWM_8822B) -+#define BIT_SET_LLTE_RWM_8822B(x, v) \ -+ (BIT_CLEAR_LLTE_RWM_8822B(x) | BIT_LLTE_RWM_8822B(v)) -+ -+#define BIT_SHIFT_LLTINI_PDATA_V1_8822B 16 -+#define BIT_MASK_LLTINI_PDATA_V1_8822B 0xfff -+#define BIT_LLTINI_PDATA_V1_8822B(x) \ -+ (((x) & BIT_MASK_LLTINI_PDATA_V1_8822B) \ -+ << BIT_SHIFT_LLTINI_PDATA_V1_8822B) -+#define BITS_LLTINI_PDATA_V1_8822B \ -+ (BIT_MASK_LLTINI_PDATA_V1_8822B << BIT_SHIFT_LLTINI_PDATA_V1_8822B) -+#define BIT_CLEAR_LLTINI_PDATA_V1_8822B(x) ((x) & (~BITS_LLTINI_PDATA_V1_8822B)) -+#define BIT_GET_LLTINI_PDATA_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_PDATA_V1_8822B) & \ -+ BIT_MASK_LLTINI_PDATA_V1_8822B) -+#define BIT_SET_LLTINI_PDATA_V1_8822B(x, v) \ -+ (BIT_CLEAR_LLTINI_PDATA_V1_8822B(x) | BIT_LLTINI_PDATA_V1_8822B(v)) -+ -+#define BIT_SHIFT_LLTINI_HDATA_V1_8822B 0 -+#define BIT_MASK_LLTINI_HDATA_V1_8822B 0xfff -+#define BIT_LLTINI_HDATA_V1_8822B(x) \ -+ (((x) & BIT_MASK_LLTINI_HDATA_V1_8822B) \ -+ << BIT_SHIFT_LLTINI_HDATA_V1_8822B) -+#define BITS_LLTINI_HDATA_V1_8822B \ -+ (BIT_MASK_LLTINI_HDATA_V1_8822B << BIT_SHIFT_LLTINI_HDATA_V1_8822B) -+#define BIT_CLEAR_LLTINI_HDATA_V1_8822B(x) ((x) & (~BITS_LLTINI_HDATA_V1_8822B)) -+#define BIT_GET_LLTINI_HDATA_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_HDATA_V1_8822B) & \ -+ BIT_MASK_LLTINI_HDATA_V1_8822B) -+#define BIT_SET_LLTINI_HDATA_V1_8822B(x, v) \ -+ (BIT_CLEAR_LLTINI_HDATA_V1_8822B(x) | BIT_LLTINI_HDATA_V1_8822B(v)) -+ -+/* 2 REG_LLT_INIT_ADDR_8822B */ -+ -+#define BIT_SHIFT_LLTINI_ADDR_V1_8822B 0 -+#define BIT_MASK_LLTINI_ADDR_V1_8822B 0xfff -+#define BIT_LLTINI_ADDR_V1_8822B(x) \ -+ (((x) & BIT_MASK_LLTINI_ADDR_V1_8822B) \ -+ << BIT_SHIFT_LLTINI_ADDR_V1_8822B) -+#define BITS_LLTINI_ADDR_V1_8822B \ -+ (BIT_MASK_LLTINI_ADDR_V1_8822B << BIT_SHIFT_LLTINI_ADDR_V1_8822B) -+#define BIT_CLEAR_LLTINI_ADDR_V1_8822B(x) ((x) & (~BITS_LLTINI_ADDR_V1_8822B)) -+#define BIT_GET_LLTINI_ADDR_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LLTINI_ADDR_V1_8822B) & \ -+ BIT_MASK_LLTINI_ADDR_V1_8822B) -+#define BIT_SET_LLTINI_ADDR_V1_8822B(x, v) \ -+ (BIT_CLEAR_LLTINI_ADDR_V1_8822B(x) | BIT_LLTINI_ADDR_V1_8822B(v)) -+ -+/* 2 REG_BB_ACCESS_CTRL_8822B */ -+ -+#define BIT_SHIFT_BB_WRITE_READ_8822B 30 -+#define BIT_MASK_BB_WRITE_READ_8822B 0x3 -+#define BIT_BB_WRITE_READ_8822B(x) \ -+ (((x) & BIT_MASK_BB_WRITE_READ_8822B) << BIT_SHIFT_BB_WRITE_READ_8822B) -+#define BITS_BB_WRITE_READ_8822B \ -+ (BIT_MASK_BB_WRITE_READ_8822B << BIT_SHIFT_BB_WRITE_READ_8822B) -+#define BIT_CLEAR_BB_WRITE_READ_8822B(x) ((x) & (~BITS_BB_WRITE_READ_8822B)) -+#define BIT_GET_BB_WRITE_READ_8822B(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_READ_8822B) & BIT_MASK_BB_WRITE_READ_8822B) -+#define BIT_SET_BB_WRITE_READ_8822B(x, v) \ -+ (BIT_CLEAR_BB_WRITE_READ_8822B(x) | BIT_BB_WRITE_READ_8822B(v)) -+ -+#define BIT_SHIFT_BB_WRITE_EN_8822B 12 -+#define BIT_MASK_BB_WRITE_EN_8822B 0xf -+#define BIT_BB_WRITE_EN_8822B(x) \ -+ (((x) & BIT_MASK_BB_WRITE_EN_8822B) << BIT_SHIFT_BB_WRITE_EN_8822B) -+#define BITS_BB_WRITE_EN_8822B \ -+ (BIT_MASK_BB_WRITE_EN_8822B << BIT_SHIFT_BB_WRITE_EN_8822B) -+#define BIT_CLEAR_BB_WRITE_EN_8822B(x) ((x) & (~BITS_BB_WRITE_EN_8822B)) -+#define BIT_GET_BB_WRITE_EN_8822B(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_EN_8822B) & BIT_MASK_BB_WRITE_EN_8822B) -+#define BIT_SET_BB_WRITE_EN_8822B(x, v) \ -+ (BIT_CLEAR_BB_WRITE_EN_8822B(x) | BIT_BB_WRITE_EN_8822B(v)) -+ -+#define BIT_SHIFT_BB_ADDR_8822B 2 -+#define BIT_MASK_BB_ADDR_8822B 0x1ff -+#define BIT_BB_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_BB_ADDR_8822B) << BIT_SHIFT_BB_ADDR_8822B) -+#define BITS_BB_ADDR_8822B (BIT_MASK_BB_ADDR_8822B << BIT_SHIFT_BB_ADDR_8822B) -+#define BIT_CLEAR_BB_ADDR_8822B(x) ((x) & (~BITS_BB_ADDR_8822B)) -+#define BIT_GET_BB_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_BB_ADDR_8822B) & BIT_MASK_BB_ADDR_8822B) -+#define BIT_SET_BB_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_BB_ADDR_8822B(x) | BIT_BB_ADDR_8822B(v)) -+ -+#define BIT_BB_ERRACC_8822B BIT(0) -+ -+/* 2 REG_BB_ACCESS_DATA_8822B */ -+ -+#define BIT_SHIFT_BB_DATA_8822B 0 -+#define BIT_MASK_BB_DATA_8822B 0xffffffffL -+#define BIT_BB_DATA_8822B(x) \ -+ (((x) & BIT_MASK_BB_DATA_8822B) << BIT_SHIFT_BB_DATA_8822B) -+#define BITS_BB_DATA_8822B (BIT_MASK_BB_DATA_8822B << BIT_SHIFT_BB_DATA_8822B) -+#define BIT_CLEAR_BB_DATA_8822B(x) ((x) & (~BITS_BB_DATA_8822B)) -+#define BIT_GET_BB_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_BB_DATA_8822B) & BIT_MASK_BB_DATA_8822B) -+#define BIT_SET_BB_DATA_8822B(x, v) \ -+ (BIT_CLEAR_BB_DATA_8822B(x) | BIT_BB_DATA_8822B(v)) -+ -+/* 2 REG_HMEBOX_E0_8822B */ -+ -+#define BIT_SHIFT_HMEBOX_E0_8822B 0 -+#define BIT_MASK_HMEBOX_E0_8822B 0xffffffffL -+#define BIT_HMEBOX_E0_8822B(x) \ -+ (((x) & BIT_MASK_HMEBOX_E0_8822B) << BIT_SHIFT_HMEBOX_E0_8822B) -+#define BITS_HMEBOX_E0_8822B \ -+ (BIT_MASK_HMEBOX_E0_8822B << BIT_SHIFT_HMEBOX_E0_8822B) -+#define BIT_CLEAR_HMEBOX_E0_8822B(x) ((x) & (~BITS_HMEBOX_E0_8822B)) -+#define BIT_GET_HMEBOX_E0_8822B(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E0_8822B) & BIT_MASK_HMEBOX_E0_8822B) -+#define BIT_SET_HMEBOX_E0_8822B(x, v) \ -+ (BIT_CLEAR_HMEBOX_E0_8822B(x) | BIT_HMEBOX_E0_8822B(v)) -+ -+/* 2 REG_HMEBOX_E1_8822B */ -+ -+#define BIT_SHIFT_HMEBOX_E1_8822B 0 -+#define BIT_MASK_HMEBOX_E1_8822B 0xffffffffL -+#define BIT_HMEBOX_E1_8822B(x) \ -+ (((x) & BIT_MASK_HMEBOX_E1_8822B) << BIT_SHIFT_HMEBOX_E1_8822B) -+#define BITS_HMEBOX_E1_8822B \ -+ (BIT_MASK_HMEBOX_E1_8822B << BIT_SHIFT_HMEBOX_E1_8822B) -+#define BIT_CLEAR_HMEBOX_E1_8822B(x) ((x) & (~BITS_HMEBOX_E1_8822B)) -+#define BIT_GET_HMEBOX_E1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E1_8822B) & BIT_MASK_HMEBOX_E1_8822B) -+#define BIT_SET_HMEBOX_E1_8822B(x, v) \ -+ (BIT_CLEAR_HMEBOX_E1_8822B(x) | BIT_HMEBOX_E1_8822B(v)) -+ -+/* 2 REG_HMEBOX_E2_8822B */ -+ -+#define BIT_SHIFT_HMEBOX_E2_8822B 0 -+#define BIT_MASK_HMEBOX_E2_8822B 0xffffffffL -+#define BIT_HMEBOX_E2_8822B(x) \ -+ (((x) & BIT_MASK_HMEBOX_E2_8822B) << BIT_SHIFT_HMEBOX_E2_8822B) -+#define BITS_HMEBOX_E2_8822B \ -+ (BIT_MASK_HMEBOX_E2_8822B << BIT_SHIFT_HMEBOX_E2_8822B) -+#define BIT_CLEAR_HMEBOX_E2_8822B(x) ((x) & (~BITS_HMEBOX_E2_8822B)) -+#define BIT_GET_HMEBOX_E2_8822B(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E2_8822B) & BIT_MASK_HMEBOX_E2_8822B) -+#define BIT_SET_HMEBOX_E2_8822B(x, v) \ -+ (BIT_CLEAR_HMEBOX_E2_8822B(x) | BIT_HMEBOX_E2_8822B(v)) -+ -+/* 2 REG_HMEBOX_E3_8822B */ -+ -+#define BIT_SHIFT_HMEBOX_E3_8822B 0 -+#define BIT_MASK_HMEBOX_E3_8822B 0xffffffffL -+#define BIT_HMEBOX_E3_8822B(x) \ -+ (((x) & BIT_MASK_HMEBOX_E3_8822B) << BIT_SHIFT_HMEBOX_E3_8822B) -+#define BITS_HMEBOX_E3_8822B \ -+ (BIT_MASK_HMEBOX_E3_8822B << BIT_SHIFT_HMEBOX_E3_8822B) -+#define BIT_CLEAR_HMEBOX_E3_8822B(x) ((x) & (~BITS_HMEBOX_E3_8822B)) -+#define BIT_GET_HMEBOX_E3_8822B(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E3_8822B) & BIT_MASK_HMEBOX_E3_8822B) -+#define BIT_SET_HMEBOX_E3_8822B(x, v) \ -+ (BIT_CLEAR_HMEBOX_E3_8822B(x) | BIT_HMEBOX_E3_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_CR_EXT_8822B */ -+ -+#define BIT_SHIFT_PHY_REQ_DELAY_8822B 24 -+#define BIT_MASK_PHY_REQ_DELAY_8822B 0xf -+#define BIT_PHY_REQ_DELAY_8822B(x) \ -+ (((x) & BIT_MASK_PHY_REQ_DELAY_8822B) << BIT_SHIFT_PHY_REQ_DELAY_8822B) -+#define BITS_PHY_REQ_DELAY_8822B \ -+ (BIT_MASK_PHY_REQ_DELAY_8822B << BIT_SHIFT_PHY_REQ_DELAY_8822B) -+#define BIT_CLEAR_PHY_REQ_DELAY_8822B(x) ((x) & (~BITS_PHY_REQ_DELAY_8822B)) -+#define BIT_GET_PHY_REQ_DELAY_8822B(x) \ -+ (((x) >> BIT_SHIFT_PHY_REQ_DELAY_8822B) & BIT_MASK_PHY_REQ_DELAY_8822B) -+#define BIT_SET_PHY_REQ_DELAY_8822B(x, v) \ -+ (BIT_CLEAR_PHY_REQ_DELAY_8822B(x) | BIT_PHY_REQ_DELAY_8822B(v)) -+ -+#define BIT_SPD_DOWN_8822B BIT(16) -+ -+#define BIT_SHIFT_NETYPE4_8822B 4 -+#define BIT_MASK_NETYPE4_8822B 0x3 -+#define BIT_NETYPE4_8822B(x) \ -+ (((x) & BIT_MASK_NETYPE4_8822B) << BIT_SHIFT_NETYPE4_8822B) -+#define BITS_NETYPE4_8822B (BIT_MASK_NETYPE4_8822B << BIT_SHIFT_NETYPE4_8822B) -+#define BIT_CLEAR_NETYPE4_8822B(x) ((x) & (~BITS_NETYPE4_8822B)) -+#define BIT_GET_NETYPE4_8822B(x) \ -+ (((x) >> BIT_SHIFT_NETYPE4_8822B) & BIT_MASK_NETYPE4_8822B) -+#define BIT_SET_NETYPE4_8822B(x, v) \ -+ (BIT_CLEAR_NETYPE4_8822B(x) | BIT_NETYPE4_8822B(v)) -+ -+#define BIT_SHIFT_NETYPE3_8822B 2 -+#define BIT_MASK_NETYPE3_8822B 0x3 -+#define BIT_NETYPE3_8822B(x) \ -+ (((x) & BIT_MASK_NETYPE3_8822B) << BIT_SHIFT_NETYPE3_8822B) -+#define BITS_NETYPE3_8822B (BIT_MASK_NETYPE3_8822B << BIT_SHIFT_NETYPE3_8822B) -+#define BIT_CLEAR_NETYPE3_8822B(x) ((x) & (~BITS_NETYPE3_8822B)) -+#define BIT_GET_NETYPE3_8822B(x) \ -+ (((x) >> BIT_SHIFT_NETYPE3_8822B) & BIT_MASK_NETYPE3_8822B) -+#define BIT_SET_NETYPE3_8822B(x, v) \ -+ (BIT_CLEAR_NETYPE3_8822B(x) | BIT_NETYPE3_8822B(v)) -+ -+#define BIT_SHIFT_NETYPE2_8822B 0 -+#define BIT_MASK_NETYPE2_8822B 0x3 -+#define BIT_NETYPE2_8822B(x) \ -+ (((x) & BIT_MASK_NETYPE2_8822B) << BIT_SHIFT_NETYPE2_8822B) -+#define BITS_NETYPE2_8822B (BIT_MASK_NETYPE2_8822B << BIT_SHIFT_NETYPE2_8822B) -+#define BIT_CLEAR_NETYPE2_8822B(x) ((x) & (~BITS_NETYPE2_8822B)) -+#define BIT_GET_NETYPE2_8822B(x) \ -+ (((x) >> BIT_SHIFT_NETYPE2_8822B) & BIT_MASK_NETYPE2_8822B) -+#define BIT_SET_NETYPE2_8822B(x, v) \ -+ (BIT_CLEAR_NETYPE2_8822B(x) | BIT_NETYPE2_8822B(v)) -+ -+/* 2 REG_FWFF_8822B */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V1_8822B 24 -+#define BIT_MASK_PKTNUM_TH_V1_8822B 0xff -+#define BIT_PKTNUM_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V1_8822B) << BIT_SHIFT_PKTNUM_TH_V1_8822B) -+#define BITS_PKTNUM_TH_V1_8822B \ -+ (BIT_MASK_PKTNUM_TH_V1_8822B << BIT_SHIFT_PKTNUM_TH_V1_8822B) -+#define BIT_CLEAR_PKTNUM_TH_V1_8822B(x) ((x) & (~BITS_PKTNUM_TH_V1_8822B)) -+#define BIT_GET_PKTNUM_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V1_8822B) & BIT_MASK_PKTNUM_TH_V1_8822B) -+#define BIT_SET_PKTNUM_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V1_8822B(x) | BIT_PKTNUM_TH_V1_8822B(v)) -+ -+#define BIT_SHIFT_TIMER_TH_8822B 16 -+#define BIT_MASK_TIMER_TH_8822B 0xff -+#define BIT_TIMER_TH_8822B(x) \ -+ (((x) & BIT_MASK_TIMER_TH_8822B) << BIT_SHIFT_TIMER_TH_8822B) -+#define BITS_TIMER_TH_8822B \ -+ (BIT_MASK_TIMER_TH_8822B << BIT_SHIFT_TIMER_TH_8822B) -+#define BIT_CLEAR_TIMER_TH_8822B(x) ((x) & (~BITS_TIMER_TH_8822B)) -+#define BIT_GET_TIMER_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_TIMER_TH_8822B) & BIT_MASK_TIMER_TH_8822B) -+#define BIT_SET_TIMER_TH_8822B(x, v) \ -+ (BIT_CLEAR_TIMER_TH_8822B(x) | BIT_TIMER_TH_8822B(v)) -+ -+#define BIT_SHIFT_RXPKT1ENADDR_8822B 0 -+#define BIT_MASK_RXPKT1ENADDR_8822B 0xffff -+#define BIT_RXPKT1ENADDR_8822B(x) \ -+ (((x) & BIT_MASK_RXPKT1ENADDR_8822B) << BIT_SHIFT_RXPKT1ENADDR_8822B) -+#define BITS_RXPKT1ENADDR_8822B \ -+ (BIT_MASK_RXPKT1ENADDR_8822B << BIT_SHIFT_RXPKT1ENADDR_8822B) -+#define BIT_CLEAR_RXPKT1ENADDR_8822B(x) ((x) & (~BITS_RXPKT1ENADDR_8822B)) -+#define BIT_GET_RXPKT1ENADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXPKT1ENADDR_8822B) & BIT_MASK_RXPKT1ENADDR_8822B) -+#define BIT_SET_RXPKT1ENADDR_8822B(x, v) \ -+ (BIT_CLEAR_RXPKT1ENADDR_8822B(x) | BIT_RXPKT1ENADDR_8822B(v)) -+ -+/* 2 REG_RXFF_PTR_V1_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_RXFF0_RDPTR_V2_8822B 0 -+#define BIT_MASK_RXFF0_RDPTR_V2_8822B 0x3ffff -+#define BIT_RXFF0_RDPTR_V2_8822B(x) \ -+ (((x) & BIT_MASK_RXFF0_RDPTR_V2_8822B) \ -+ << BIT_SHIFT_RXFF0_RDPTR_V2_8822B) -+#define BITS_RXFF0_RDPTR_V2_8822B \ -+ (BIT_MASK_RXFF0_RDPTR_V2_8822B << BIT_SHIFT_RXFF0_RDPTR_V2_8822B) -+#define BIT_CLEAR_RXFF0_RDPTR_V2_8822B(x) ((x) & (~BITS_RXFF0_RDPTR_V2_8822B)) -+#define BIT_GET_RXFF0_RDPTR_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_RDPTR_V2_8822B) & \ -+ BIT_MASK_RXFF0_RDPTR_V2_8822B) -+#define BIT_SET_RXFF0_RDPTR_V2_8822B(x, v) \ -+ (BIT_CLEAR_RXFF0_RDPTR_V2_8822B(x) | BIT_RXFF0_RDPTR_V2_8822B(v)) -+ -+/* 2 REG_RXFF_WTR_V1_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_RXFF0_WTPTR_V2_8822B 0 -+#define BIT_MASK_RXFF0_WTPTR_V2_8822B 0x3ffff -+#define BIT_RXFF0_WTPTR_V2_8822B(x) \ -+ (((x) & BIT_MASK_RXFF0_WTPTR_V2_8822B) \ -+ << BIT_SHIFT_RXFF0_WTPTR_V2_8822B) -+#define BITS_RXFF0_WTPTR_V2_8822B \ -+ (BIT_MASK_RXFF0_WTPTR_V2_8822B << BIT_SHIFT_RXFF0_WTPTR_V2_8822B) -+#define BIT_CLEAR_RXFF0_WTPTR_V2_8822B(x) ((x) & (~BITS_RXFF0_WTPTR_V2_8822B)) -+#define BIT_GET_RXFF0_WTPTR_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_WTPTR_V2_8822B) & \ -+ BIT_MASK_RXFF0_WTPTR_V2_8822B) -+#define BIT_SET_RXFF0_WTPTR_V2_8822B(x, v) \ -+ (BIT_CLEAR_RXFF0_WTPTR_V2_8822B(x) | BIT_RXFF0_WTPTR_V2_8822B(v)) -+ -+/* 2 REG_FE2IMR_8822B */ -+#define BIT__FE4ISR__IND_MSK_8822B BIT(29) -+#define BIT_FS_TXSC_DESC_DONE_INT_EN_8822B BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_EN_8822B BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_EN_8822B BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_EN_8822B BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_EN_8822B BIT(24) -+#define BIT_FS_ATIM_MB7_INT_EN_8822B BIT(23) -+#define BIT_FS_ATIM_MB6_INT_EN_8822B BIT(22) -+#define BIT_FS_ATIM_MB5_INT_EN_8822B BIT(21) -+#define BIT_FS_ATIM_MB4_INT_EN_8822B BIT(20) -+#define BIT_FS_ATIM_MB3_INT_EN_8822B BIT(19) -+#define BIT_FS_ATIM_MB2_INT_EN_8822B BIT(18) -+#define BIT_FS_ATIM_MB1_INT_EN_8822B BIT(17) -+#define BIT_FS_ATIM_MB0_INT_EN_8822B BIT(16) -+#define BIT_FS_TBTT4INT_EN_8822B BIT(11) -+#define BIT_FS_TBTT3INT_EN_8822B BIT(10) -+#define BIT_FS_TBTT2INT_EN_8822B BIT(9) -+#define BIT_FS_TBTT1INT_EN_8822B BIT(8) -+#define BIT_FS_TBTT0_MB7INT_EN_8822B BIT(7) -+#define BIT_FS_TBTT0_MB6INT_EN_8822B BIT(6) -+#define BIT_FS_TBTT0_MB5INT_EN_8822B BIT(5) -+#define BIT_FS_TBTT0_MB4INT_EN_8822B BIT(4) -+#define BIT_FS_TBTT0_MB3INT_EN_8822B BIT(3) -+#define BIT_FS_TBTT0_MB2INT_EN_8822B BIT(2) -+#define BIT_FS_TBTT0_MB1INT_EN_8822B BIT(1) -+#define BIT_FS_TBTT0_INT_EN_8822B BIT(0) -+ -+/* 2 REG_FE2ISR_8822B */ -+#define BIT__FE4ISR__IND_INT_8822B BIT(29) -+#define BIT_FS_TXSC_DESC_DONE_INT_8822B BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_8822B BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_8822B BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_8822B BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_8822B BIT(24) -+#define BIT_FS_ATIM_MB7_INT_8822B BIT(23) -+#define BIT_FS_ATIM_MB6_INT_8822B BIT(22) -+#define BIT_FS_ATIM_MB5_INT_8822B BIT(21) -+#define BIT_FS_ATIM_MB4_INT_8822B BIT(20) -+#define BIT_FS_ATIM_MB3_INT_8822B BIT(19) -+#define BIT_FS_ATIM_MB2_INT_8822B BIT(18) -+#define BIT_FS_ATIM_MB1_INT_8822B BIT(17) -+#define BIT_FS_ATIM_MB0_INT_8822B BIT(16) -+#define BIT_FS_TBTT4INT_8822B BIT(11) -+#define BIT_FS_TBTT3INT_8822B BIT(10) -+#define BIT_FS_TBTT2INT_8822B BIT(9) -+#define BIT_FS_TBTT1INT_8822B BIT(8) -+#define BIT_FS_TBTT0_MB7INT_8822B BIT(7) -+#define BIT_FS_TBTT0_MB6INT_8822B BIT(6) -+#define BIT_FS_TBTT0_MB5INT_8822B BIT(5) -+#define BIT_FS_TBTT0_MB4INT_8822B BIT(4) -+#define BIT_FS_TBTT0_MB3INT_8822B BIT(3) -+#define BIT_FS_TBTT0_MB2INT_8822B BIT(2) -+#define BIT_FS_TBTT0_MB1INT_8822B BIT(1) -+#define BIT_FS_TBTT0_INT_8822B BIT(0) -+ -+/* 2 REG_FE3IMR_8822B */ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT__EN_8822B BIT(31) -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT__EN_8822B BIT(30) -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT__EN_8822B BIT(29) -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT__EN_8822B BIT(28) -+#define BIT_FS_BCNDMA4_INT_EN_8822B BIT(27) -+#define BIT_FS_BCNDMA3_INT_EN_8822B BIT(26) -+#define BIT_FS_BCNDMA2_INT_EN_8822B BIT(25) -+#define BIT_FS_BCNDMA1_INT_EN_8822B BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_EN_8822B BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_EN_8822B BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_EN_8822B BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_EN_8822B BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_EN_8822B BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_EN_8822B BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_EN_8822B BIT(17) -+#define BIT_FS_BCNDMA0_INT_EN_8822B BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT__EN_8822B BIT(15) -+#define BIT_FS_BCNERLY4_INT_EN_8822B BIT(11) -+#define BIT_FS_BCNERLY3_INT_EN_8822B BIT(10) -+#define BIT_FS_BCNERLY2_INT_EN_8822B BIT(9) -+#define BIT_FS_BCNERLY1_INT_EN_8822B BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_EN_8822B BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_EN_8822B BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_EN_8822B BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_EN_8822B BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_EN_8822B BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_EN_8822B BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_EN_8822B BIT(1) -+#define BIT_FS_BCNERLY0_INT_EN_8822B BIT(0) -+ -+/* 2 REG_FE3ISR_8822B */ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT_8822B BIT(31) -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT_8822B BIT(30) -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT_8822B BIT(29) -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT_8822B BIT(28) -+#define BIT_FS_BCNDMA4_INT_8822B BIT(27) -+#define BIT_FS_BCNDMA3_INT_8822B BIT(26) -+#define BIT_FS_BCNDMA2_INT_8822B BIT(25) -+#define BIT_FS_BCNDMA1_INT_8822B BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_8822B BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_8822B BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_8822B BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_8822B BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_8822B BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_8822B BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_8822B BIT(17) -+#define BIT_FS_BCNDMA0_INT_8822B BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT_8822B BIT(15) -+#define BIT_FS_BCNERLY4_INT_8822B BIT(11) -+#define BIT_FS_BCNERLY3_INT_8822B BIT(10) -+#define BIT_FS_BCNERLY2_INT_8822B BIT(9) -+#define BIT_FS_BCNERLY1_INT_8822B BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_8822B BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_8822B BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_8822B BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_8822B BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_8822B BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_8822B BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_8822B BIT(1) -+#define BIT_FS_BCNERLY0_INT_8822B BIT(0) -+ -+/* 2 REG_FE4IMR_8822B */ -+#define BIT_FS_CLI3_TXPKTIN_INT_EN_8822B BIT(19) -+#define BIT_FS_CLI2_TXPKTIN_INT_EN_8822B BIT(18) -+#define BIT_FS_CLI1_TXPKTIN_INT_EN_8822B BIT(17) -+#define BIT_FS_CLI0_TXPKTIN_INT_EN_8822B BIT(16) -+#define BIT_FS_CLI3_RX_UMD0_INT_EN_8822B BIT(15) -+#define BIT_FS_CLI3_RX_UMD1_INT_EN_8822B BIT(14) -+#define BIT_FS_CLI3_RX_BMD0_INT_EN_8822B BIT(13) -+#define BIT_FS_CLI3_RX_BMD1_INT_EN_8822B BIT(12) -+#define BIT_FS_CLI2_RX_UMD0_INT_EN_8822B BIT(11) -+#define BIT_FS_CLI2_RX_UMD1_INT_EN_8822B BIT(10) -+#define BIT_FS_CLI2_RX_BMD0_INT_EN_8822B BIT(9) -+#define BIT_FS_CLI2_RX_BMD1_INT_EN_8822B BIT(8) -+#define BIT_FS_CLI1_RX_UMD0_INT_EN_8822B BIT(7) -+#define BIT_FS_CLI1_RX_UMD1_INT_EN_8822B BIT(6) -+#define BIT_FS_CLI1_RX_BMD0_INT_EN_8822B BIT(5) -+#define BIT_FS_CLI1_RX_BMD1_INT_EN_8822B BIT(4) -+#define BIT_FS_CLI0_RX_UMD0_INT_EN_8822B BIT(3) -+#define BIT_FS_CLI0_RX_UMD1_INT_EN_8822B BIT(2) -+#define BIT_FS_CLI0_RX_BMD0_INT_EN_8822B BIT(1) -+#define BIT_FS_CLI0_RX_BMD1_INT_EN_8822B BIT(0) -+ -+/* 2 REG_FE4ISR_8822B */ -+#define BIT_FS_CLI3_TXPKTIN_INT_8822B BIT(19) -+#define BIT_FS_CLI2_TXPKTIN_INT_8822B BIT(18) -+#define BIT_FS_CLI1_TXPKTIN_INT_8822B BIT(17) -+#define BIT_FS_CLI0_TXPKTIN_INT_8822B BIT(16) -+#define BIT_FS_CLI3_RX_UMD0_INT_8822B BIT(15) -+#define BIT_FS_CLI3_RX_UMD1_INT_8822B BIT(14) -+#define BIT_FS_CLI3_RX_BMD0_INT_8822B BIT(13) -+#define BIT_FS_CLI3_RX_BMD1_INT_8822B BIT(12) -+#define BIT_FS_CLI2_RX_UMD0_INT_8822B BIT(11) -+#define BIT_FS_CLI2_RX_UMD1_INT_8822B BIT(10) -+#define BIT_FS_CLI2_RX_BMD0_INT_8822B BIT(9) -+#define BIT_FS_CLI2_RX_BMD1_INT_8822B BIT(8) -+#define BIT_FS_CLI1_RX_UMD0_INT_8822B BIT(7) -+#define BIT_FS_CLI1_RX_UMD1_INT_8822B BIT(6) -+#define BIT_FS_CLI1_RX_BMD0_INT_8822B BIT(5) -+#define BIT_FS_CLI1_RX_BMD1_INT_8822B BIT(4) -+#define BIT_FS_CLI0_RX_UMD0_INT_8822B BIT(3) -+#define BIT_FS_CLI0_RX_UMD1_INT_8822B BIT(2) -+#define BIT_FS_CLI0_RX_BMD0_INT_8822B BIT(1) -+#define BIT_FS_CLI0_RX_BMD1_INT_8822B BIT(0) -+ -+/* 2 REG_FT1IMR_8822B */ -+#define BIT__FT2ISR__IND_MSK_8822B BIT(30) -+#define BIT_FTM_PTT_INT_EN_8822B BIT(29) -+#define BIT_RXFTMREQ_INT_EN_8822B BIT(28) -+#define BIT_RXFTM_INT_EN_8822B BIT(27) -+#define BIT_TXFTM_INT_EN_8822B BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_EN_8822B BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_EN_8822B BIT(24) -+#define BIT_FS_MACID_PWRCHANGE5_INT_EN_8822B BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_EN_8822B BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_EN_8822B BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_EN_8822B BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_EN_8822B BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_EN_8822B BIT(18) -+#define BIT_FS_CTWEND2_INT_EN_8822B BIT(17) -+#define BIT_FS_CTWEND1_INT_EN_8822B BIT(16) -+#define BIT_FS_CTWEND0_INT_EN_8822B BIT(15) -+#define BIT_FS_TX_NULL1_INT_EN_8822B BIT(14) -+#define BIT_FS_TX_NULL0_INT_EN_8822B BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_EN_8822B BIT(12) -+#define BIT_FS_P2P_RFON2_INT_EN_8822B BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_EN_8822B BIT(10) -+#define BIT_FS_P2P_RFON1_INT_EN_8822B BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_EN_8822B BIT(8) -+#define BIT_FS_P2P_RFON0_INT_EN_8822B BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_EN_8822B BIT(6) -+#define BIT_FS_RX_UAPSDMD1_EN_8822B BIT(5) -+#define BIT_FS_RX_UAPSDMD0_EN_8822B BIT(4) -+#define BIT_FS_TRIGGER_PKT_EN_8822B BIT(3) -+#define BIT_FS_EOSP_INT_EN_8822B BIT(2) -+#define BIT_FS_RPWM2_INT_EN_8822B BIT(1) -+#define BIT_FS_RPWM_INT_EN_8822B BIT(0) -+ -+/* 2 REG_FT1ISR_8822B */ -+#define BIT__FT2ISR__IND_INT_8822B BIT(30) -+#define BIT_FTM_PTT_INT_8822B BIT(29) -+#define BIT_RXFTMREQ_INT_8822B BIT(28) -+#define BIT_RXFTM_INT_8822B BIT(27) -+#define BIT_TXFTM_INT_8822B BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_8822B BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_8822B BIT(24) -+#define BIT_FS_MACID_PWRCHANGE5_INT_8822B BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_8822B BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_8822B BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_8822B BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_8822B BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_8822B BIT(18) -+#define BIT_FS_CTWEND2_INT_8822B BIT(17) -+#define BIT_FS_CTWEND1_INT_8822B BIT(16) -+#define BIT_FS_CTWEND0_INT_8822B BIT(15) -+#define BIT_FS_TX_NULL1_INT_8822B BIT(14) -+#define BIT_FS_TX_NULL0_INT_8822B BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_INT_8822B BIT(12) -+#define BIT_FS_P2P_RFON2_INT_8822B BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_8822B BIT(10) -+#define BIT_FS_P2P_RFON1_INT_8822B BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_8822B BIT(8) -+#define BIT_FS_P2P_RFON0_INT_8822B BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_8822B BIT(6) -+#define BIT_FS_RX_UAPSDMD1_INT_8822B BIT(5) -+#define BIT_FS_RX_UAPSDMD0_INT_8822B BIT(4) -+#define BIT_FS_TRIGGER_PKT_INT_8822B BIT(3) -+#define BIT_FS_EOSP_INT_8822B BIT(2) -+#define BIT_FS_RPWM2_INT_8822B BIT(1) -+#define BIT_FS_RPWM_INT_8822B BIT(0) -+ -+/* 2 REG_SPWR0_8822B */ -+ -+#define BIT_SHIFT_MID_31TO0_8822B 0 -+#define BIT_MASK_MID_31TO0_8822B 0xffffffffL -+#define BIT_MID_31TO0_8822B(x) \ -+ (((x) & BIT_MASK_MID_31TO0_8822B) << BIT_SHIFT_MID_31TO0_8822B) -+#define BITS_MID_31TO0_8822B \ -+ (BIT_MASK_MID_31TO0_8822B << BIT_SHIFT_MID_31TO0_8822B) -+#define BIT_CLEAR_MID_31TO0_8822B(x) ((x) & (~BITS_MID_31TO0_8822B)) -+#define BIT_GET_MID_31TO0_8822B(x) \ -+ (((x) >> BIT_SHIFT_MID_31TO0_8822B) & BIT_MASK_MID_31TO0_8822B) -+#define BIT_SET_MID_31TO0_8822B(x, v) \ -+ (BIT_CLEAR_MID_31TO0_8822B(x) | BIT_MID_31TO0_8822B(v)) -+ -+/* 2 REG_SPWR1_8822B */ -+ -+#define BIT_SHIFT_MID_63TO32_8822B 0 -+#define BIT_MASK_MID_63TO32_8822B 0xffffffffL -+#define BIT_MID_63TO32_8822B(x) \ -+ (((x) & BIT_MASK_MID_63TO32_8822B) << BIT_SHIFT_MID_63TO32_8822B) -+#define BITS_MID_63TO32_8822B \ -+ (BIT_MASK_MID_63TO32_8822B << BIT_SHIFT_MID_63TO32_8822B) -+#define BIT_CLEAR_MID_63TO32_8822B(x) ((x) & (~BITS_MID_63TO32_8822B)) -+#define BIT_GET_MID_63TO32_8822B(x) \ -+ (((x) >> BIT_SHIFT_MID_63TO32_8822B) & BIT_MASK_MID_63TO32_8822B) -+#define BIT_SET_MID_63TO32_8822B(x, v) \ -+ (BIT_CLEAR_MID_63TO32_8822B(x) | BIT_MID_63TO32_8822B(v)) -+ -+/* 2 REG_SPWR2_8822B */ -+ -+#define BIT_SHIFT_MID_95O64_8822B 0 -+#define BIT_MASK_MID_95O64_8822B 0xffffffffL -+#define BIT_MID_95O64_8822B(x) \ -+ (((x) & BIT_MASK_MID_95O64_8822B) << BIT_SHIFT_MID_95O64_8822B) -+#define BITS_MID_95O64_8822B \ -+ (BIT_MASK_MID_95O64_8822B << BIT_SHIFT_MID_95O64_8822B) -+#define BIT_CLEAR_MID_95O64_8822B(x) ((x) & (~BITS_MID_95O64_8822B)) -+#define BIT_GET_MID_95O64_8822B(x) \ -+ (((x) >> BIT_SHIFT_MID_95O64_8822B) & BIT_MASK_MID_95O64_8822B) -+#define BIT_SET_MID_95O64_8822B(x, v) \ -+ (BIT_CLEAR_MID_95O64_8822B(x) | BIT_MID_95O64_8822B(v)) -+ -+/* 2 REG_SPWR3_8822B */ -+ -+#define BIT_SHIFT_MID_127TO96_8822B 0 -+#define BIT_MASK_MID_127TO96_8822B 0xffffffffL -+#define BIT_MID_127TO96_8822B(x) \ -+ (((x) & BIT_MASK_MID_127TO96_8822B) << BIT_SHIFT_MID_127TO96_8822B) -+#define BITS_MID_127TO96_8822B \ -+ (BIT_MASK_MID_127TO96_8822B << BIT_SHIFT_MID_127TO96_8822B) -+#define BIT_CLEAR_MID_127TO96_8822B(x) ((x) & (~BITS_MID_127TO96_8822B)) -+#define BIT_GET_MID_127TO96_8822B(x) \ -+ (((x) >> BIT_SHIFT_MID_127TO96_8822B) & BIT_MASK_MID_127TO96_8822B) -+#define BIT_SET_MID_127TO96_8822B(x, v) \ -+ (BIT_CLEAR_MID_127TO96_8822B(x) | BIT_MID_127TO96_8822B(v)) -+ -+/* 2 REG_POWSEQ_8822B */ -+ -+#define BIT_SHIFT_SEQNUM_MID_8822B 16 -+#define BIT_MASK_SEQNUM_MID_8822B 0xffff -+#define BIT_SEQNUM_MID_8822B(x) \ -+ (((x) & BIT_MASK_SEQNUM_MID_8822B) << BIT_SHIFT_SEQNUM_MID_8822B) -+#define BITS_SEQNUM_MID_8822B \ -+ (BIT_MASK_SEQNUM_MID_8822B << BIT_SHIFT_SEQNUM_MID_8822B) -+#define BIT_CLEAR_SEQNUM_MID_8822B(x) ((x) & (~BITS_SEQNUM_MID_8822B)) -+#define BIT_GET_SEQNUM_MID_8822B(x) \ -+ (((x) >> BIT_SHIFT_SEQNUM_MID_8822B) & BIT_MASK_SEQNUM_MID_8822B) -+#define BIT_SET_SEQNUM_MID_8822B(x, v) \ -+ (BIT_CLEAR_SEQNUM_MID_8822B(x) | BIT_SEQNUM_MID_8822B(v)) -+ -+#define BIT_SHIFT_REF_MID_8822B 0 -+#define BIT_MASK_REF_MID_8822B 0x7f -+#define BIT_REF_MID_8822B(x) \ -+ (((x) & BIT_MASK_REF_MID_8822B) << BIT_SHIFT_REF_MID_8822B) -+#define BITS_REF_MID_8822B (BIT_MASK_REF_MID_8822B << BIT_SHIFT_REF_MID_8822B) -+#define BIT_CLEAR_REF_MID_8822B(x) ((x) & (~BITS_REF_MID_8822B)) -+#define BIT_GET_REF_MID_8822B(x) \ -+ (((x) >> BIT_SHIFT_REF_MID_8822B) & BIT_MASK_REF_MID_8822B) -+#define BIT_SET_REF_MID_8822B(x, v) \ -+ (BIT_CLEAR_REF_MID_8822B(x) | BIT_REF_MID_8822B(v)) -+ -+/* 2 REG_TC7_CTRL_V1_8822B */ -+#define BIT_TC7INT_EN_8822B BIT(26) -+#define BIT_TC7MODE_8822B BIT(25) -+#define BIT_TC7EN_8822B BIT(24) -+ -+#define BIT_SHIFT_TC7DATA_8822B 0 -+#define BIT_MASK_TC7DATA_8822B 0xffffff -+#define BIT_TC7DATA_8822B(x) \ -+ (((x) & BIT_MASK_TC7DATA_8822B) << BIT_SHIFT_TC7DATA_8822B) -+#define BITS_TC7DATA_8822B (BIT_MASK_TC7DATA_8822B << BIT_SHIFT_TC7DATA_8822B) -+#define BIT_CLEAR_TC7DATA_8822B(x) ((x) & (~BITS_TC7DATA_8822B)) -+#define BIT_GET_TC7DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TC7DATA_8822B) & BIT_MASK_TC7DATA_8822B) -+#define BIT_SET_TC7DATA_8822B(x, v) \ -+ (BIT_CLEAR_TC7DATA_8822B(x) | BIT_TC7DATA_8822B(v)) -+ -+/* 2 REG_TC8_CTRL_V1_8822B */ -+#define BIT_TC8INT_EN_8822B BIT(26) -+#define BIT_TC8MODE_8822B BIT(25) -+#define BIT_TC8EN_8822B BIT(24) -+ -+#define BIT_SHIFT_TC8DATA_8822B 0 -+#define BIT_MASK_TC8DATA_8822B 0xffffff -+#define BIT_TC8DATA_8822B(x) \ -+ (((x) & BIT_MASK_TC8DATA_8822B) << BIT_SHIFT_TC8DATA_8822B) -+#define BITS_TC8DATA_8822B (BIT_MASK_TC8DATA_8822B << BIT_SHIFT_TC8DATA_8822B) -+#define BIT_CLEAR_TC8DATA_8822B(x) ((x) & (~BITS_TC8DATA_8822B)) -+#define BIT_GET_TC8DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TC8DATA_8822B) & BIT_MASK_TC8DATA_8822B) -+#define BIT_SET_TC8DATA_8822B(x, v) \ -+ (BIT_CLEAR_TC8DATA_8822B(x) | BIT_TC8DATA_8822B(v)) -+ -+/* 2 REG_FT2IMR_8822B */ -+#define BIT_FS_CLI3_RX_UAPSDMD1_EN_8822B BIT(31) -+#define BIT_FS_CLI3_RX_UAPSDMD0_EN_8822B BIT(30) -+#define BIT_FS_CLI3_TRIGGER_PKT_EN_8822B BIT(29) -+#define BIT_FS_CLI3_EOSP_INT_EN_8822B BIT(28) -+#define BIT_FS_CLI2_RX_UAPSDMD1_EN_8822B BIT(27) -+#define BIT_FS_CLI2_RX_UAPSDMD0_EN_8822B BIT(26) -+#define BIT_FS_CLI2_TRIGGER_PKT_EN_8822B BIT(25) -+#define BIT_FS_CLI2_EOSP_INT_EN_8822B BIT(24) -+#define BIT_FS_CLI1_RX_UAPSDMD1_EN_8822B BIT(23) -+#define BIT_FS_CLI1_RX_UAPSDMD0_EN_8822B BIT(22) -+#define BIT_FS_CLI1_TRIGGER_PKT_EN_8822B BIT(21) -+#define BIT_FS_CLI1_EOSP_INT_EN_8822B BIT(20) -+#define BIT_FS_CLI0_RX_UAPSDMD1_EN_8822B BIT(19) -+#define BIT_FS_CLI0_RX_UAPSDMD0_EN_8822B BIT(18) -+#define BIT_FS_CLI0_TRIGGER_PKT_EN_8822B BIT(17) -+#define BIT_FS_CLI0_EOSP_INT_EN_8822B BIT(16) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_EN_8822B BIT(9) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_EN_8822B BIT(8) -+#define BIT_FS_CLI3_TX_NULL1_INT_EN_8822B BIT(7) -+#define BIT_FS_CLI3_TX_NULL0_INT_EN_8822B BIT(6) -+#define BIT_FS_CLI2_TX_NULL1_INT_EN_8822B BIT(5) -+#define BIT_FS_CLI2_TX_NULL0_INT_EN_8822B BIT(4) -+#define BIT_FS_CLI1_TX_NULL1_INT_EN_8822B BIT(3) -+#define BIT_FS_CLI1_TX_NULL0_INT_EN_8822B BIT(2) -+#define BIT_FS_CLI0_TX_NULL1_INT_EN_8822B BIT(1) -+#define BIT_FS_CLI0_TX_NULL0_INT_EN_8822B BIT(0) -+ -+/* 2 REG_FT2ISR_8822B */ -+#define BIT_FS_CLI3_RX_UAPSDMD1_INT_8822B BIT(31) -+#define BIT_FS_CLI3_RX_UAPSDMD0_INT_8822B BIT(30) -+#define BIT_FS_CLI3_TRIGGER_PKT_INT_8822B BIT(29) -+#define BIT_FS_CLI3_EOSP_INT_8822B BIT(28) -+#define BIT_FS_CLI2_RX_UAPSDMD1_INT_8822B BIT(27) -+#define BIT_FS_CLI2_RX_UAPSDMD0_INT_8822B BIT(26) -+#define BIT_FS_CLI2_TRIGGER_PKT_INT_8822B BIT(25) -+#define BIT_FS_CLI2_EOSP_INT_8822B BIT(24) -+#define BIT_FS_CLI1_RX_UAPSDMD1_INT_8822B BIT(23) -+#define BIT_FS_CLI1_RX_UAPSDMD0_INT_8822B BIT(22) -+#define BIT_FS_CLI1_TRIGGER_PKT_INT_8822B BIT(21) -+#define BIT_FS_CLI1_EOSP_INT_8822B BIT(20) -+#define BIT_FS_CLI0_RX_UAPSDMD1_INT_8822B BIT(19) -+#define BIT_FS_CLI0_RX_UAPSDMD0_INT_8822B BIT(18) -+#define BIT_FS_CLI0_TRIGGER_PKT_INT_8822B BIT(17) -+#define BIT_FS_CLI0_EOSP_INT_8822B BIT(16) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_INT_8822B BIT(9) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_INT_8822B BIT(8) -+#define BIT_FS_CLI3_TX_NULL1_INT_8822B BIT(7) -+#define BIT_FS_CLI3_TX_NULL0_INT_8822B BIT(6) -+#define BIT_FS_CLI2_TX_NULL1_INT_8822B BIT(5) -+#define BIT_FS_CLI2_TX_NULL0_INT_8822B BIT(4) -+#define BIT_FS_CLI1_TX_NULL1_INT_8822B BIT(3) -+#define BIT_FS_CLI1_TX_NULL0_INT_8822B BIT(2) -+#define BIT_FS_CLI0_TX_NULL1_INT_8822B BIT(1) -+#define BIT_FS_CLI0_TX_NULL0_INT_8822B BIT(0) -+ -+/* 2 REG_MSG2_8822B */ -+ -+#define BIT_SHIFT_FW_MSG2_8822B 0 -+#define BIT_MASK_FW_MSG2_8822B 0xffffffffL -+#define BIT_FW_MSG2_8822B(x) \ -+ (((x) & BIT_MASK_FW_MSG2_8822B) << BIT_SHIFT_FW_MSG2_8822B) -+#define BITS_FW_MSG2_8822B (BIT_MASK_FW_MSG2_8822B << BIT_SHIFT_FW_MSG2_8822B) -+#define BIT_CLEAR_FW_MSG2_8822B(x) ((x) & (~BITS_FW_MSG2_8822B)) -+#define BIT_GET_FW_MSG2_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG2_8822B) & BIT_MASK_FW_MSG2_8822B) -+#define BIT_SET_FW_MSG2_8822B(x, v) \ -+ (BIT_CLEAR_FW_MSG2_8822B(x) | BIT_FW_MSG2_8822B(v)) -+ -+/* 2 REG_MSG3_8822B */ -+ -+#define BIT_SHIFT_FW_MSG3_8822B 0 -+#define BIT_MASK_FW_MSG3_8822B 0xffffffffL -+#define BIT_FW_MSG3_8822B(x) \ -+ (((x) & BIT_MASK_FW_MSG3_8822B) << BIT_SHIFT_FW_MSG3_8822B) -+#define BITS_FW_MSG3_8822B (BIT_MASK_FW_MSG3_8822B << BIT_SHIFT_FW_MSG3_8822B) -+#define BIT_CLEAR_FW_MSG3_8822B(x) ((x) & (~BITS_FW_MSG3_8822B)) -+#define BIT_GET_FW_MSG3_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG3_8822B) & BIT_MASK_FW_MSG3_8822B) -+#define BIT_SET_FW_MSG3_8822B(x, v) \ -+ (BIT_CLEAR_FW_MSG3_8822B(x) | BIT_FW_MSG3_8822B(v)) -+ -+/* 2 REG_MSG4_8822B */ -+ -+#define BIT_SHIFT_FW_MSG4_8822B 0 -+#define BIT_MASK_FW_MSG4_8822B 0xffffffffL -+#define BIT_FW_MSG4_8822B(x) \ -+ (((x) & BIT_MASK_FW_MSG4_8822B) << BIT_SHIFT_FW_MSG4_8822B) -+#define BITS_FW_MSG4_8822B (BIT_MASK_FW_MSG4_8822B << BIT_SHIFT_FW_MSG4_8822B) -+#define BIT_CLEAR_FW_MSG4_8822B(x) ((x) & (~BITS_FW_MSG4_8822B)) -+#define BIT_GET_FW_MSG4_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG4_8822B) & BIT_MASK_FW_MSG4_8822B) -+#define BIT_SET_FW_MSG4_8822B(x, v) \ -+ (BIT_CLEAR_FW_MSG4_8822B(x) | BIT_FW_MSG4_8822B(v)) -+ -+/* 2 REG_MSG5_8822B */ -+ -+#define BIT_SHIFT_FW_MSG5_8822B 0 -+#define BIT_MASK_FW_MSG5_8822B 0xffffffffL -+#define BIT_FW_MSG5_8822B(x) \ -+ (((x) & BIT_MASK_FW_MSG5_8822B) << BIT_SHIFT_FW_MSG5_8822B) -+#define BITS_FW_MSG5_8822B (BIT_MASK_FW_MSG5_8822B << BIT_SHIFT_FW_MSG5_8822B) -+#define BIT_CLEAR_FW_MSG5_8822B(x) ((x) & (~BITS_FW_MSG5_8822B)) -+#define BIT_GET_FW_MSG5_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG5_8822B) & BIT_MASK_FW_MSG5_8822B) -+#define BIT_SET_FW_MSG5_8822B(x, v) \ -+ (BIT_CLEAR_FW_MSG5_8822B(x) | BIT_FW_MSG5_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_FIFOPAGE_CTRL_1_8822B */ -+ -+#define BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8822B 16 -+#define BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8822B 0xff -+#define BIT_TX_OQT_HE_FREE_SPACE_V1_8822B(x) \ -+ (((x) & BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8822B) \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8822B) -+#define BITS_TX_OQT_HE_FREE_SPACE_V1_8822B \ -+ (BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8822B \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8822B) -+#define BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1_8822B(x) \ -+ ((x) & (~BITS_TX_OQT_HE_FREE_SPACE_V1_8822B)) -+#define BIT_GET_TX_OQT_HE_FREE_SPACE_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8822B) & \ -+ BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8822B) -+#define BIT_SET_TX_OQT_HE_FREE_SPACE_V1_8822B(x, v) \ -+ (BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1_8822B(x) | \ -+ BIT_TX_OQT_HE_FREE_SPACE_V1_8822B(v)) -+ -+#define BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8822B 0 -+#define BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8822B 0xff -+#define BIT_TX_OQT_NL_FREE_SPACE_V1_8822B(x) \ -+ (((x) & BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8822B) \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8822B) -+#define BITS_TX_OQT_NL_FREE_SPACE_V1_8822B \ -+ (BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8822B \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8822B) -+#define BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1_8822B(x) \ -+ ((x) & (~BITS_TX_OQT_NL_FREE_SPACE_V1_8822B)) -+#define BIT_GET_TX_OQT_NL_FREE_SPACE_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8822B) & \ -+ BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8822B) -+#define BIT_SET_TX_OQT_NL_FREE_SPACE_V1_8822B(x, v) \ -+ (BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1_8822B(x) | \ -+ BIT_TX_OQT_NL_FREE_SPACE_V1_8822B(v)) -+ -+/* 2 REG_FIFOPAGE_CTRL_2_8822B */ -+#define BIT_BCN_VALID_1_V1_8822B BIT(31) -+ -+#define BIT_SHIFT_BCN_HEAD_1_V1_8822B 16 -+#define BIT_MASK_BCN_HEAD_1_V1_8822B 0xfff -+#define BIT_BCN_HEAD_1_V1_8822B(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_1_V1_8822B) << BIT_SHIFT_BCN_HEAD_1_V1_8822B) -+#define BITS_BCN_HEAD_1_V1_8822B \ -+ (BIT_MASK_BCN_HEAD_1_V1_8822B << BIT_SHIFT_BCN_HEAD_1_V1_8822B) -+#define BIT_CLEAR_BCN_HEAD_1_V1_8822B(x) ((x) & (~BITS_BCN_HEAD_1_V1_8822B)) -+#define BIT_GET_BCN_HEAD_1_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_1_V1_8822B) & BIT_MASK_BCN_HEAD_1_V1_8822B) -+#define BIT_SET_BCN_HEAD_1_V1_8822B(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_1_V1_8822B(x) | BIT_BCN_HEAD_1_V1_8822B(v)) -+ -+#define BIT_BCN_VALID_V1_8822B BIT(15) -+ -+#define BIT_SHIFT_BCN_HEAD_V1_8822B 0 -+#define BIT_MASK_BCN_HEAD_V1_8822B 0xfff -+#define BIT_BCN_HEAD_V1_8822B(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_V1_8822B) << BIT_SHIFT_BCN_HEAD_V1_8822B) -+#define BITS_BCN_HEAD_V1_8822B \ -+ (BIT_MASK_BCN_HEAD_V1_8822B << BIT_SHIFT_BCN_HEAD_V1_8822B) -+#define BIT_CLEAR_BCN_HEAD_V1_8822B(x) ((x) & (~BITS_BCN_HEAD_V1_8822B)) -+#define BIT_GET_BCN_HEAD_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_V1_8822B) & BIT_MASK_BCN_HEAD_V1_8822B) -+#define BIT_SET_BCN_HEAD_V1_8822B(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_V1_8822B(x) | BIT_BCN_HEAD_V1_8822B(v)) -+ -+/* 2 REG_AUTO_LLT_V1_8822B */ -+ -+#define BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B 24 -+#define BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B 0xff -+#define BIT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B(x) \ -+ (((x) & BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B) \ -+ << BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B) -+#define BITS_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B \ -+ (BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B \ -+ << BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B) -+#define BIT_CLEAR_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B(x) \ -+ ((x) & (~BITS_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B)) -+#define BIT_GET_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B) & \ -+ BIT_MASK_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B) -+#define BIT_SET_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B(x, v) \ -+ (BIT_CLEAR_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B(x) | \ -+ BIT_MAX_TX_PKT_FOR_USB_AND_SDIO_V1_8822B(v)) -+ -+#define BIT_SHIFT_LLT_FREE_PAGE_V1_8822B 8 -+#define BIT_MASK_LLT_FREE_PAGE_V1_8822B 0xffff -+#define BIT_LLT_FREE_PAGE_V1_8822B(x) \ -+ (((x) & BIT_MASK_LLT_FREE_PAGE_V1_8822B) \ -+ << BIT_SHIFT_LLT_FREE_PAGE_V1_8822B) -+#define BITS_LLT_FREE_PAGE_V1_8822B \ -+ (BIT_MASK_LLT_FREE_PAGE_V1_8822B << BIT_SHIFT_LLT_FREE_PAGE_V1_8822B) -+#define BIT_CLEAR_LLT_FREE_PAGE_V1_8822B(x) \ -+ ((x) & (~BITS_LLT_FREE_PAGE_V1_8822B)) -+#define BIT_GET_LLT_FREE_PAGE_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LLT_FREE_PAGE_V1_8822B) & \ -+ BIT_MASK_LLT_FREE_PAGE_V1_8822B) -+#define BIT_SET_LLT_FREE_PAGE_V1_8822B(x, v) \ -+ (BIT_CLEAR_LLT_FREE_PAGE_V1_8822B(x) | BIT_LLT_FREE_PAGE_V1_8822B(v)) -+ -+#define BIT_SHIFT_BLK_DESC_NUM_8822B 4 -+#define BIT_MASK_BLK_DESC_NUM_8822B 0xf -+#define BIT_BLK_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_BLK_DESC_NUM_8822B) << BIT_SHIFT_BLK_DESC_NUM_8822B) -+#define BITS_BLK_DESC_NUM_8822B \ -+ (BIT_MASK_BLK_DESC_NUM_8822B << BIT_SHIFT_BLK_DESC_NUM_8822B) -+#define BIT_CLEAR_BLK_DESC_NUM_8822B(x) ((x) & (~BITS_BLK_DESC_NUM_8822B)) -+#define BIT_GET_BLK_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_BLK_DESC_NUM_8822B) & BIT_MASK_BLK_DESC_NUM_8822B) -+#define BIT_SET_BLK_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_BLK_DESC_NUM_8822B(x) | BIT_BLK_DESC_NUM_8822B(v)) -+ -+#define BIT_R_BCN_HEAD_SEL_8822B BIT(3) -+#define BIT_R_EN_BCN_SW_HEAD_SEL_8822B BIT(2) -+#define BIT_LLT_DBG_SEL_8822B BIT(1) -+#define BIT_AUTO_INIT_LLT_V1_8822B BIT(0) -+ -+/* 2 REG_TXDMA_OFFSET_CHK_8822B */ -+#define BIT_EM_CHKSUM_FIN_8822B BIT(31) -+#define BIT_EMN_PCIE_DMA_MOD_8822B BIT(30) -+#define BIT_EN_TXQUE_CLR_8822B BIT(29) -+#define BIT_EN_PCIE_FIFO_MODE_8822B BIT(28) -+ -+#define BIT_SHIFT_PG_UNDER_TH_V1_8822B 16 -+#define BIT_MASK_PG_UNDER_TH_V1_8822B 0xfff -+#define BIT_PG_UNDER_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_PG_UNDER_TH_V1_8822B) \ -+ << BIT_SHIFT_PG_UNDER_TH_V1_8822B) -+#define BITS_PG_UNDER_TH_V1_8822B \ -+ (BIT_MASK_PG_UNDER_TH_V1_8822B << BIT_SHIFT_PG_UNDER_TH_V1_8822B) -+#define BIT_CLEAR_PG_UNDER_TH_V1_8822B(x) ((x) & (~BITS_PG_UNDER_TH_V1_8822B)) -+#define BIT_GET_PG_UNDER_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PG_UNDER_TH_V1_8822B) & \ -+ BIT_MASK_PG_UNDER_TH_V1_8822B) -+#define BIT_SET_PG_UNDER_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_PG_UNDER_TH_V1_8822B(x) | BIT_PG_UNDER_TH_V1_8822B(v)) -+ -+#define BIT_RESTORE_H2C_ADDRESS_8822B BIT(15) -+#define BIT_SDIO_TXDESC_CHKSUM_EN_8822B BIT(13) -+#define BIT_RST_RDPTR_8822B BIT(12) -+#define BIT_RST_WRPTR_8822B BIT(11) -+#define BIT_CHK_PG_TH_EN_8822B BIT(10) -+#define BIT_DROP_DATA_EN_8822B BIT(9) -+#define BIT_CHECK_OFFSET_EN_8822B BIT(8) -+ -+#define BIT_SHIFT_CHECK_OFFSET_8822B 0 -+#define BIT_MASK_CHECK_OFFSET_8822B 0xff -+#define BIT_CHECK_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_CHECK_OFFSET_8822B) << BIT_SHIFT_CHECK_OFFSET_8822B) -+#define BITS_CHECK_OFFSET_8822B \ -+ (BIT_MASK_CHECK_OFFSET_8822B << BIT_SHIFT_CHECK_OFFSET_8822B) -+#define BIT_CLEAR_CHECK_OFFSET_8822B(x) ((x) & (~BITS_CHECK_OFFSET_8822B)) -+#define BIT_GET_CHECK_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_CHECK_OFFSET_8822B) & BIT_MASK_CHECK_OFFSET_8822B) -+#define BIT_SET_CHECK_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_CHECK_OFFSET_8822B(x) | BIT_CHECK_OFFSET_8822B(v)) -+ -+/* 2 REG_TXDMA_STATUS_8822B */ -+#define BIT_HI_OQT_UDN_8822B BIT(17) -+#define BIT_HI_OQT_OVF_8822B BIT(16) -+#define BIT_PAYLOAD_CHKSUM_ERR_8822B BIT(15) -+#define BIT_PAYLOAD_UDN_8822B BIT(14) -+#define BIT_PAYLOAD_OVF_8822B BIT(13) -+#define BIT_DSC_CHKSUM_FAIL_8822B BIT(12) -+#define BIT_UNKNOWN_QSEL_8822B BIT(11) -+#define BIT_EP_QSEL_DIFF_8822B BIT(10) -+#define BIT_TX_OFFS_UNMATCH_8822B BIT(9) -+#define BIT_TXOQT_UDN_8822B BIT(8) -+#define BIT_TXOQT_OVF_8822B BIT(7) -+#define BIT_TXDMA_SFF_UDN_8822B BIT(6) -+#define BIT_TXDMA_SFF_OVF_8822B BIT(5) -+#define BIT_LLT_NULL_PG_8822B BIT(4) -+#define BIT_PAGE_UDN_8822B BIT(3) -+#define BIT_PAGE_OVF_8822B BIT(2) -+#define BIT_TXFF_PG_UDN_8822B BIT(1) -+#define BIT_TXFF_PG_OVF_8822B BIT(0) -+ -+/* 2 REG_TX_DMA_DBG_8822B */ -+ -+/* 2 REG_TQPNT1_8822B */ -+ -+#define BIT_SHIFT_HPQ_HIGH_TH_V1_8822B 16 -+#define BIT_MASK_HPQ_HIGH_TH_V1_8822B 0xfff -+#define BIT_HPQ_HIGH_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_HPQ_HIGH_TH_V1_8822B) \ -+ << BIT_SHIFT_HPQ_HIGH_TH_V1_8822B) -+#define BITS_HPQ_HIGH_TH_V1_8822B \ -+ (BIT_MASK_HPQ_HIGH_TH_V1_8822B << BIT_SHIFT_HPQ_HIGH_TH_V1_8822B) -+#define BIT_CLEAR_HPQ_HIGH_TH_V1_8822B(x) ((x) & (~BITS_HPQ_HIGH_TH_V1_8822B)) -+#define BIT_GET_HPQ_HIGH_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HPQ_HIGH_TH_V1_8822B) & \ -+ BIT_MASK_HPQ_HIGH_TH_V1_8822B) -+#define BIT_SET_HPQ_HIGH_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_HPQ_HIGH_TH_V1_8822B(x) | BIT_HPQ_HIGH_TH_V1_8822B(v)) -+ -+#define BIT_SHIFT_HPQ_LOW_TH_V1_8822B 0 -+#define BIT_MASK_HPQ_LOW_TH_V1_8822B 0xfff -+#define BIT_HPQ_LOW_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_HPQ_LOW_TH_V1_8822B) << BIT_SHIFT_HPQ_LOW_TH_V1_8822B) -+#define BITS_HPQ_LOW_TH_V1_8822B \ -+ (BIT_MASK_HPQ_LOW_TH_V1_8822B << BIT_SHIFT_HPQ_LOW_TH_V1_8822B) -+#define BIT_CLEAR_HPQ_LOW_TH_V1_8822B(x) ((x) & (~BITS_HPQ_LOW_TH_V1_8822B)) -+#define BIT_GET_HPQ_LOW_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HPQ_LOW_TH_V1_8822B) & BIT_MASK_HPQ_LOW_TH_V1_8822B) -+#define BIT_SET_HPQ_LOW_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_HPQ_LOW_TH_V1_8822B(x) | BIT_HPQ_LOW_TH_V1_8822B(v)) -+ -+/* 2 REG_TQPNT2_8822B */ -+ -+#define BIT_SHIFT_NPQ_HIGH_TH_V1_8822B 16 -+#define BIT_MASK_NPQ_HIGH_TH_V1_8822B 0xfff -+#define BIT_NPQ_HIGH_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_NPQ_HIGH_TH_V1_8822B) \ -+ << BIT_SHIFT_NPQ_HIGH_TH_V1_8822B) -+#define BITS_NPQ_HIGH_TH_V1_8822B \ -+ (BIT_MASK_NPQ_HIGH_TH_V1_8822B << BIT_SHIFT_NPQ_HIGH_TH_V1_8822B) -+#define BIT_CLEAR_NPQ_HIGH_TH_V1_8822B(x) ((x) & (~BITS_NPQ_HIGH_TH_V1_8822B)) -+#define BIT_GET_NPQ_HIGH_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_NPQ_HIGH_TH_V1_8822B) & \ -+ BIT_MASK_NPQ_HIGH_TH_V1_8822B) -+#define BIT_SET_NPQ_HIGH_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_NPQ_HIGH_TH_V1_8822B(x) | BIT_NPQ_HIGH_TH_V1_8822B(v)) -+ -+#define BIT_SHIFT_NPQ_LOW_TH_V1_8822B 0 -+#define BIT_MASK_NPQ_LOW_TH_V1_8822B 0xfff -+#define BIT_NPQ_LOW_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_NPQ_LOW_TH_V1_8822B) << BIT_SHIFT_NPQ_LOW_TH_V1_8822B) -+#define BITS_NPQ_LOW_TH_V1_8822B \ -+ (BIT_MASK_NPQ_LOW_TH_V1_8822B << BIT_SHIFT_NPQ_LOW_TH_V1_8822B) -+#define BIT_CLEAR_NPQ_LOW_TH_V1_8822B(x) ((x) & (~BITS_NPQ_LOW_TH_V1_8822B)) -+#define BIT_GET_NPQ_LOW_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_NPQ_LOW_TH_V1_8822B) & BIT_MASK_NPQ_LOW_TH_V1_8822B) -+#define BIT_SET_NPQ_LOW_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_NPQ_LOW_TH_V1_8822B(x) | BIT_NPQ_LOW_TH_V1_8822B(v)) -+ -+/* 2 REG_TQPNT3_8822B */ -+ -+#define BIT_SHIFT_LPQ_HIGH_TH_V1_8822B 16 -+#define BIT_MASK_LPQ_HIGH_TH_V1_8822B 0xfff -+#define BIT_LPQ_HIGH_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_LPQ_HIGH_TH_V1_8822B) \ -+ << BIT_SHIFT_LPQ_HIGH_TH_V1_8822B) -+#define BITS_LPQ_HIGH_TH_V1_8822B \ -+ (BIT_MASK_LPQ_HIGH_TH_V1_8822B << BIT_SHIFT_LPQ_HIGH_TH_V1_8822B) -+#define BIT_CLEAR_LPQ_HIGH_TH_V1_8822B(x) ((x) & (~BITS_LPQ_HIGH_TH_V1_8822B)) -+#define BIT_GET_LPQ_HIGH_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LPQ_HIGH_TH_V1_8822B) & \ -+ BIT_MASK_LPQ_HIGH_TH_V1_8822B) -+#define BIT_SET_LPQ_HIGH_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_LPQ_HIGH_TH_V1_8822B(x) | BIT_LPQ_HIGH_TH_V1_8822B(v)) -+ -+#define BIT_SHIFT_LPQ_LOW_TH_V1_8822B 0 -+#define BIT_MASK_LPQ_LOW_TH_V1_8822B 0xfff -+#define BIT_LPQ_LOW_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_LPQ_LOW_TH_V1_8822B) << BIT_SHIFT_LPQ_LOW_TH_V1_8822B) -+#define BITS_LPQ_LOW_TH_V1_8822B \ -+ (BIT_MASK_LPQ_LOW_TH_V1_8822B << BIT_SHIFT_LPQ_LOW_TH_V1_8822B) -+#define BIT_CLEAR_LPQ_LOW_TH_V1_8822B(x) ((x) & (~BITS_LPQ_LOW_TH_V1_8822B)) -+#define BIT_GET_LPQ_LOW_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LPQ_LOW_TH_V1_8822B) & BIT_MASK_LPQ_LOW_TH_V1_8822B) -+#define BIT_SET_LPQ_LOW_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_LPQ_LOW_TH_V1_8822B(x) | BIT_LPQ_LOW_TH_V1_8822B(v)) -+ -+/* 2 REG_TQPNT4_8822B */ -+ -+#define BIT_SHIFT_EXQ_HIGH_TH_V1_8822B 16 -+#define BIT_MASK_EXQ_HIGH_TH_V1_8822B 0xfff -+#define BIT_EXQ_HIGH_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_EXQ_HIGH_TH_V1_8822B) \ -+ << BIT_SHIFT_EXQ_HIGH_TH_V1_8822B) -+#define BITS_EXQ_HIGH_TH_V1_8822B \ -+ (BIT_MASK_EXQ_HIGH_TH_V1_8822B << BIT_SHIFT_EXQ_HIGH_TH_V1_8822B) -+#define BIT_CLEAR_EXQ_HIGH_TH_V1_8822B(x) ((x) & (~BITS_EXQ_HIGH_TH_V1_8822B)) -+#define BIT_GET_EXQ_HIGH_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_EXQ_HIGH_TH_V1_8822B) & \ -+ BIT_MASK_EXQ_HIGH_TH_V1_8822B) -+#define BIT_SET_EXQ_HIGH_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_EXQ_HIGH_TH_V1_8822B(x) | BIT_EXQ_HIGH_TH_V1_8822B(v)) -+ -+#define BIT_SHIFT_EXQ_LOW_TH_V1_8822B 0 -+#define BIT_MASK_EXQ_LOW_TH_V1_8822B 0xfff -+#define BIT_EXQ_LOW_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_EXQ_LOW_TH_V1_8822B) << BIT_SHIFT_EXQ_LOW_TH_V1_8822B) -+#define BITS_EXQ_LOW_TH_V1_8822B \ -+ (BIT_MASK_EXQ_LOW_TH_V1_8822B << BIT_SHIFT_EXQ_LOW_TH_V1_8822B) -+#define BIT_CLEAR_EXQ_LOW_TH_V1_8822B(x) ((x) & (~BITS_EXQ_LOW_TH_V1_8822B)) -+#define BIT_GET_EXQ_LOW_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_EXQ_LOW_TH_V1_8822B) & BIT_MASK_EXQ_LOW_TH_V1_8822B) -+#define BIT_SET_EXQ_LOW_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_EXQ_LOW_TH_V1_8822B(x) | BIT_EXQ_LOW_TH_V1_8822B(v)) -+ -+/* 2 REG_RQPN_CTRL_1_8822B */ -+ -+#define BIT_SHIFT_TXPKTNUM_H_8822B 16 -+#define BIT_MASK_TXPKTNUM_H_8822B 0xffff -+#define BIT_TXPKTNUM_H_8822B(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_H_8822B) << BIT_SHIFT_TXPKTNUM_H_8822B) -+#define BITS_TXPKTNUM_H_8822B \ -+ (BIT_MASK_TXPKTNUM_H_8822B << BIT_SHIFT_TXPKTNUM_H_8822B) -+#define BIT_CLEAR_TXPKTNUM_H_8822B(x) ((x) & (~BITS_TXPKTNUM_H_8822B)) -+#define BIT_GET_TXPKTNUM_H_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_H_8822B) & BIT_MASK_TXPKTNUM_H_8822B) -+#define BIT_SET_TXPKTNUM_H_8822B(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_H_8822B(x) | BIT_TXPKTNUM_H_8822B(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_V2_8822B 0 -+#define BIT_MASK_TXPKTNUM_V2_8822B 0xffff -+#define BIT_TXPKTNUM_V2_8822B(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_V2_8822B) << BIT_SHIFT_TXPKTNUM_V2_8822B) -+#define BITS_TXPKTNUM_V2_8822B \ -+ (BIT_MASK_TXPKTNUM_V2_8822B << BIT_SHIFT_TXPKTNUM_V2_8822B) -+#define BIT_CLEAR_TXPKTNUM_V2_8822B(x) ((x) & (~BITS_TXPKTNUM_V2_8822B)) -+#define BIT_GET_TXPKTNUM_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_V2_8822B) & BIT_MASK_TXPKTNUM_V2_8822B) -+#define BIT_SET_TXPKTNUM_V2_8822B(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_V2_8822B(x) | BIT_TXPKTNUM_V2_8822B(v)) -+ -+/* 2 REG_RQPN_CTRL_2_8822B */ -+#define BIT_LD_RQPN_8822B BIT(31) -+#define BIT_EXQ_PUBLIC_DIS_V1_8822B BIT(19) -+#define BIT_NPQ_PUBLIC_DIS_V1_8822B BIT(18) -+#define BIT_LPQ_PUBLIC_DIS_V1_8822B BIT(17) -+#define BIT_HPQ_PUBLIC_DIS_V1_8822B BIT(16) -+ -+/* 2 REG_FIFOPAGE_INFO_1_8822B */ -+ -+#define BIT_SHIFT_HPQ_AVAL_PG_V1_8822B 16 -+#define BIT_MASK_HPQ_AVAL_PG_V1_8822B 0xfff -+#define BIT_HPQ_AVAL_PG_V1_8822B(x) \ -+ (((x) & BIT_MASK_HPQ_AVAL_PG_V1_8822B) \ -+ << BIT_SHIFT_HPQ_AVAL_PG_V1_8822B) -+#define BITS_HPQ_AVAL_PG_V1_8822B \ -+ (BIT_MASK_HPQ_AVAL_PG_V1_8822B << BIT_SHIFT_HPQ_AVAL_PG_V1_8822B) -+#define BIT_CLEAR_HPQ_AVAL_PG_V1_8822B(x) ((x) & (~BITS_HPQ_AVAL_PG_V1_8822B)) -+#define BIT_GET_HPQ_AVAL_PG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HPQ_AVAL_PG_V1_8822B) & \ -+ BIT_MASK_HPQ_AVAL_PG_V1_8822B) -+#define BIT_SET_HPQ_AVAL_PG_V1_8822B(x, v) \ -+ (BIT_CLEAR_HPQ_AVAL_PG_V1_8822B(x) | BIT_HPQ_AVAL_PG_V1_8822B(v)) -+ -+#define BIT_SHIFT_HPQ_V1_8822B 0 -+#define BIT_MASK_HPQ_V1_8822B 0xfff -+#define BIT_HPQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_HPQ_V1_8822B) << BIT_SHIFT_HPQ_V1_8822B) -+#define BITS_HPQ_V1_8822B (BIT_MASK_HPQ_V1_8822B << BIT_SHIFT_HPQ_V1_8822B) -+#define BIT_CLEAR_HPQ_V1_8822B(x) ((x) & (~BITS_HPQ_V1_8822B)) -+#define BIT_GET_HPQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HPQ_V1_8822B) & BIT_MASK_HPQ_V1_8822B) -+#define BIT_SET_HPQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_HPQ_V1_8822B(x) | BIT_HPQ_V1_8822B(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_2_8822B */ -+ -+#define BIT_SHIFT_LPQ_AVAL_PG_V1_8822B 16 -+#define BIT_MASK_LPQ_AVAL_PG_V1_8822B 0xfff -+#define BIT_LPQ_AVAL_PG_V1_8822B(x) \ -+ (((x) & BIT_MASK_LPQ_AVAL_PG_V1_8822B) \ -+ << BIT_SHIFT_LPQ_AVAL_PG_V1_8822B) -+#define BITS_LPQ_AVAL_PG_V1_8822B \ -+ (BIT_MASK_LPQ_AVAL_PG_V1_8822B << BIT_SHIFT_LPQ_AVAL_PG_V1_8822B) -+#define BIT_CLEAR_LPQ_AVAL_PG_V1_8822B(x) ((x) & (~BITS_LPQ_AVAL_PG_V1_8822B)) -+#define BIT_GET_LPQ_AVAL_PG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LPQ_AVAL_PG_V1_8822B) & \ -+ BIT_MASK_LPQ_AVAL_PG_V1_8822B) -+#define BIT_SET_LPQ_AVAL_PG_V1_8822B(x, v) \ -+ (BIT_CLEAR_LPQ_AVAL_PG_V1_8822B(x) | BIT_LPQ_AVAL_PG_V1_8822B(v)) -+ -+#define BIT_SHIFT_LPQ_V1_8822B 0 -+#define BIT_MASK_LPQ_V1_8822B 0xfff -+#define BIT_LPQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_LPQ_V1_8822B) << BIT_SHIFT_LPQ_V1_8822B) -+#define BITS_LPQ_V1_8822B (BIT_MASK_LPQ_V1_8822B << BIT_SHIFT_LPQ_V1_8822B) -+#define BIT_CLEAR_LPQ_V1_8822B(x) ((x) & (~BITS_LPQ_V1_8822B)) -+#define BIT_GET_LPQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LPQ_V1_8822B) & BIT_MASK_LPQ_V1_8822B) -+#define BIT_SET_LPQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_LPQ_V1_8822B(x) | BIT_LPQ_V1_8822B(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_3_8822B */ -+ -+#define BIT_SHIFT_NPQ_AVAL_PG_V1_8822B 16 -+#define BIT_MASK_NPQ_AVAL_PG_V1_8822B 0xfff -+#define BIT_NPQ_AVAL_PG_V1_8822B(x) \ -+ (((x) & BIT_MASK_NPQ_AVAL_PG_V1_8822B) \ -+ << BIT_SHIFT_NPQ_AVAL_PG_V1_8822B) -+#define BITS_NPQ_AVAL_PG_V1_8822B \ -+ (BIT_MASK_NPQ_AVAL_PG_V1_8822B << BIT_SHIFT_NPQ_AVAL_PG_V1_8822B) -+#define BIT_CLEAR_NPQ_AVAL_PG_V1_8822B(x) ((x) & (~BITS_NPQ_AVAL_PG_V1_8822B)) -+#define BIT_GET_NPQ_AVAL_PG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_NPQ_AVAL_PG_V1_8822B) & \ -+ BIT_MASK_NPQ_AVAL_PG_V1_8822B) -+#define BIT_SET_NPQ_AVAL_PG_V1_8822B(x, v) \ -+ (BIT_CLEAR_NPQ_AVAL_PG_V1_8822B(x) | BIT_NPQ_AVAL_PG_V1_8822B(v)) -+ -+#define BIT_SHIFT_NPQ_V1_8822B 0 -+#define BIT_MASK_NPQ_V1_8822B 0xfff -+#define BIT_NPQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_NPQ_V1_8822B) << BIT_SHIFT_NPQ_V1_8822B) -+#define BITS_NPQ_V1_8822B (BIT_MASK_NPQ_V1_8822B << BIT_SHIFT_NPQ_V1_8822B) -+#define BIT_CLEAR_NPQ_V1_8822B(x) ((x) & (~BITS_NPQ_V1_8822B)) -+#define BIT_GET_NPQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_NPQ_V1_8822B) & BIT_MASK_NPQ_V1_8822B) -+#define BIT_SET_NPQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_NPQ_V1_8822B(x) | BIT_NPQ_V1_8822B(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_4_8822B */ -+ -+#define BIT_SHIFT_EXQ_AVAL_PG_V1_8822B 16 -+#define BIT_MASK_EXQ_AVAL_PG_V1_8822B 0xfff -+#define BIT_EXQ_AVAL_PG_V1_8822B(x) \ -+ (((x) & BIT_MASK_EXQ_AVAL_PG_V1_8822B) \ -+ << BIT_SHIFT_EXQ_AVAL_PG_V1_8822B) -+#define BITS_EXQ_AVAL_PG_V1_8822B \ -+ (BIT_MASK_EXQ_AVAL_PG_V1_8822B << BIT_SHIFT_EXQ_AVAL_PG_V1_8822B) -+#define BIT_CLEAR_EXQ_AVAL_PG_V1_8822B(x) ((x) & (~BITS_EXQ_AVAL_PG_V1_8822B)) -+#define BIT_GET_EXQ_AVAL_PG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_EXQ_AVAL_PG_V1_8822B) & \ -+ BIT_MASK_EXQ_AVAL_PG_V1_8822B) -+#define BIT_SET_EXQ_AVAL_PG_V1_8822B(x, v) \ -+ (BIT_CLEAR_EXQ_AVAL_PG_V1_8822B(x) | BIT_EXQ_AVAL_PG_V1_8822B(v)) -+ -+#define BIT_SHIFT_EXQ_V1_8822B 0 -+#define BIT_MASK_EXQ_V1_8822B 0xfff -+#define BIT_EXQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_EXQ_V1_8822B) << BIT_SHIFT_EXQ_V1_8822B) -+#define BITS_EXQ_V1_8822B (BIT_MASK_EXQ_V1_8822B << BIT_SHIFT_EXQ_V1_8822B) -+#define BIT_CLEAR_EXQ_V1_8822B(x) ((x) & (~BITS_EXQ_V1_8822B)) -+#define BIT_GET_EXQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_EXQ_V1_8822B) & BIT_MASK_EXQ_V1_8822B) -+#define BIT_SET_EXQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_EXQ_V1_8822B(x) | BIT_EXQ_V1_8822B(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_5_8822B */ -+ -+#define BIT_SHIFT_PUBQ_AVAL_PG_V1_8822B 16 -+#define BIT_MASK_PUBQ_AVAL_PG_V1_8822B 0xfff -+#define BIT_PUBQ_AVAL_PG_V1_8822B(x) \ -+ (((x) & BIT_MASK_PUBQ_AVAL_PG_V1_8822B) \ -+ << BIT_SHIFT_PUBQ_AVAL_PG_V1_8822B) -+#define BITS_PUBQ_AVAL_PG_V1_8822B \ -+ (BIT_MASK_PUBQ_AVAL_PG_V1_8822B << BIT_SHIFT_PUBQ_AVAL_PG_V1_8822B) -+#define BIT_CLEAR_PUBQ_AVAL_PG_V1_8822B(x) ((x) & (~BITS_PUBQ_AVAL_PG_V1_8822B)) -+#define BIT_GET_PUBQ_AVAL_PG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_AVAL_PG_V1_8822B) & \ -+ BIT_MASK_PUBQ_AVAL_PG_V1_8822B) -+#define BIT_SET_PUBQ_AVAL_PG_V1_8822B(x, v) \ -+ (BIT_CLEAR_PUBQ_AVAL_PG_V1_8822B(x) | BIT_PUBQ_AVAL_PG_V1_8822B(v)) -+ -+#define BIT_SHIFT_PUBQ_V1_8822B 0 -+#define BIT_MASK_PUBQ_V1_8822B 0xfff -+#define BIT_PUBQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_PUBQ_V1_8822B) << BIT_SHIFT_PUBQ_V1_8822B) -+#define BITS_PUBQ_V1_8822B (BIT_MASK_PUBQ_V1_8822B << BIT_SHIFT_PUBQ_V1_8822B) -+#define BIT_CLEAR_PUBQ_V1_8822B(x) ((x) & (~BITS_PUBQ_V1_8822B)) -+#define BIT_GET_PUBQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_V1_8822B) & BIT_MASK_PUBQ_V1_8822B) -+#define BIT_SET_PUBQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_PUBQ_V1_8822B(x) | BIT_PUBQ_V1_8822B(v)) -+ -+/* 2 REG_H2C_HEAD_8822B */ -+ -+#define BIT_SHIFT_H2C_HEAD_8822B 0 -+#define BIT_MASK_H2C_HEAD_8822B 0x3ffff -+#define BIT_H2C_HEAD_8822B(x) \ -+ (((x) & BIT_MASK_H2C_HEAD_8822B) << BIT_SHIFT_H2C_HEAD_8822B) -+#define BITS_H2C_HEAD_8822B \ -+ (BIT_MASK_H2C_HEAD_8822B << BIT_SHIFT_H2C_HEAD_8822B) -+#define BIT_CLEAR_H2C_HEAD_8822B(x) ((x) & (~BITS_H2C_HEAD_8822B)) -+#define BIT_GET_H2C_HEAD_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2C_HEAD_8822B) & BIT_MASK_H2C_HEAD_8822B) -+#define BIT_SET_H2C_HEAD_8822B(x, v) \ -+ (BIT_CLEAR_H2C_HEAD_8822B(x) | BIT_H2C_HEAD_8822B(v)) -+ -+/* 2 REG_H2C_TAIL_8822B */ -+ -+#define BIT_SHIFT_H2C_TAIL_8822B 0 -+#define BIT_MASK_H2C_TAIL_8822B 0x3ffff -+#define BIT_H2C_TAIL_8822B(x) \ -+ (((x) & BIT_MASK_H2C_TAIL_8822B) << BIT_SHIFT_H2C_TAIL_8822B) -+#define BITS_H2C_TAIL_8822B \ -+ (BIT_MASK_H2C_TAIL_8822B << BIT_SHIFT_H2C_TAIL_8822B) -+#define BIT_CLEAR_H2C_TAIL_8822B(x) ((x) & (~BITS_H2C_TAIL_8822B)) -+#define BIT_GET_H2C_TAIL_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2C_TAIL_8822B) & BIT_MASK_H2C_TAIL_8822B) -+#define BIT_SET_H2C_TAIL_8822B(x, v) \ -+ (BIT_CLEAR_H2C_TAIL_8822B(x) | BIT_H2C_TAIL_8822B(v)) -+ -+/* 2 REG_H2C_READ_ADDR_8822B */ -+ -+#define BIT_SHIFT_H2C_READ_ADDR_8822B 0 -+#define BIT_MASK_H2C_READ_ADDR_8822B 0x3ffff -+#define BIT_H2C_READ_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_H2C_READ_ADDR_8822B) << BIT_SHIFT_H2C_READ_ADDR_8822B) -+#define BITS_H2C_READ_ADDR_8822B \ -+ (BIT_MASK_H2C_READ_ADDR_8822B << BIT_SHIFT_H2C_READ_ADDR_8822B) -+#define BIT_CLEAR_H2C_READ_ADDR_8822B(x) ((x) & (~BITS_H2C_READ_ADDR_8822B)) -+#define BIT_GET_H2C_READ_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2C_READ_ADDR_8822B) & BIT_MASK_H2C_READ_ADDR_8822B) -+#define BIT_SET_H2C_READ_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_H2C_READ_ADDR_8822B(x) | BIT_H2C_READ_ADDR_8822B(v)) -+ -+/* 2 REG_H2C_WR_ADDR_8822B */ -+ -+#define BIT_SHIFT_H2C_WR_ADDR_8822B 0 -+#define BIT_MASK_H2C_WR_ADDR_8822B 0x3ffff -+#define BIT_H2C_WR_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_H2C_WR_ADDR_8822B) << BIT_SHIFT_H2C_WR_ADDR_8822B) -+#define BITS_H2C_WR_ADDR_8822B \ -+ (BIT_MASK_H2C_WR_ADDR_8822B << BIT_SHIFT_H2C_WR_ADDR_8822B) -+#define BIT_CLEAR_H2C_WR_ADDR_8822B(x) ((x) & (~BITS_H2C_WR_ADDR_8822B)) -+#define BIT_GET_H2C_WR_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2C_WR_ADDR_8822B) & BIT_MASK_H2C_WR_ADDR_8822B) -+#define BIT_SET_H2C_WR_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_H2C_WR_ADDR_8822B(x) | BIT_H2C_WR_ADDR_8822B(v)) -+ -+/* 2 REG_H2C_INFO_8822B */ -+#define BIT_H2C_SPACE_VLD_8822B BIT(3) -+#define BIT_H2C_WR_ADDR_RST_8822B BIT(2) -+ -+#define BIT_SHIFT_H2C_LEN_SEL_8822B 0 -+#define BIT_MASK_H2C_LEN_SEL_8822B 0x3 -+#define BIT_H2C_LEN_SEL_8822B(x) \ -+ (((x) & BIT_MASK_H2C_LEN_SEL_8822B) << BIT_SHIFT_H2C_LEN_SEL_8822B) -+#define BITS_H2C_LEN_SEL_8822B \ -+ (BIT_MASK_H2C_LEN_SEL_8822B << BIT_SHIFT_H2C_LEN_SEL_8822B) -+#define BIT_CLEAR_H2C_LEN_SEL_8822B(x) ((x) & (~BITS_H2C_LEN_SEL_8822B)) -+#define BIT_GET_H2C_LEN_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2C_LEN_SEL_8822B) & BIT_MASK_H2C_LEN_SEL_8822B) -+#define BIT_SET_H2C_LEN_SEL_8822B(x, v) \ -+ (BIT_CLEAR_H2C_LEN_SEL_8822B(x) | BIT_H2C_LEN_SEL_8822B(v)) -+ -+/* 2 REG_RXDMA_AGG_PG_TH_8822B */ -+#define BIT_USB_RXDMA_AGG_EN_8822B BIT(31) -+#define BIT_EN_PRE_CALC_8822B BIT(29) -+#define BIT_RXAGG_SW_EN_8822B BIT(28) -+#define BIT_RXAGG_SW_TRIG_8822B BIT(27) -+ -+#define BIT_SHIFT_PKT_NUM_WOL_8822B 16 -+#define BIT_MASK_PKT_NUM_WOL_8822B 0xff -+#define BIT_PKT_NUM_WOL_8822B(x) \ -+ (((x) & BIT_MASK_PKT_NUM_WOL_8822B) << BIT_SHIFT_PKT_NUM_WOL_8822B) -+#define BITS_PKT_NUM_WOL_8822B \ -+ (BIT_MASK_PKT_NUM_WOL_8822B << BIT_SHIFT_PKT_NUM_WOL_8822B) -+#define BIT_CLEAR_PKT_NUM_WOL_8822B(x) ((x) & (~BITS_PKT_NUM_WOL_8822B)) -+#define BIT_GET_PKT_NUM_WOL_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_WOL_8822B) & BIT_MASK_PKT_NUM_WOL_8822B) -+#define BIT_SET_PKT_NUM_WOL_8822B(x, v) \ -+ (BIT_CLEAR_PKT_NUM_WOL_8822B(x) | BIT_PKT_NUM_WOL_8822B(v)) -+ -+#define BIT_SHIFT_DMA_AGG_TO_V1_8822B 8 -+#define BIT_MASK_DMA_AGG_TO_V1_8822B 0xff -+#define BIT_DMA_AGG_TO_V1_8822B(x) \ -+ (((x) & BIT_MASK_DMA_AGG_TO_V1_8822B) << BIT_SHIFT_DMA_AGG_TO_V1_8822B) -+#define BITS_DMA_AGG_TO_V1_8822B \ -+ (BIT_MASK_DMA_AGG_TO_V1_8822B << BIT_SHIFT_DMA_AGG_TO_V1_8822B) -+#define BIT_CLEAR_DMA_AGG_TO_V1_8822B(x) ((x) & (~BITS_DMA_AGG_TO_V1_8822B)) -+#define BIT_GET_DMA_AGG_TO_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_DMA_AGG_TO_V1_8822B) & BIT_MASK_DMA_AGG_TO_V1_8822B) -+#define BIT_SET_DMA_AGG_TO_V1_8822B(x, v) \ -+ (BIT_CLEAR_DMA_AGG_TO_V1_8822B(x) | BIT_DMA_AGG_TO_V1_8822B(v)) -+ -+#define BIT_SHIFT_RXDMA_AGG_PG_TH_8822B 0 -+#define BIT_MASK_RXDMA_AGG_PG_TH_8822B 0xff -+#define BIT_RXDMA_AGG_PG_TH_8822B(x) \ -+ (((x) & BIT_MASK_RXDMA_AGG_PG_TH_8822B) \ -+ << BIT_SHIFT_RXDMA_AGG_PG_TH_8822B) -+#define BITS_RXDMA_AGG_PG_TH_8822B \ -+ (BIT_MASK_RXDMA_AGG_PG_TH_8822B << BIT_SHIFT_RXDMA_AGG_PG_TH_8822B) -+#define BIT_CLEAR_RXDMA_AGG_PG_TH_8822B(x) ((x) & (~BITS_RXDMA_AGG_PG_TH_8822B)) -+#define BIT_GET_RXDMA_AGG_PG_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_AGG_PG_TH_8822B) & \ -+ BIT_MASK_RXDMA_AGG_PG_TH_8822B) -+#define BIT_SET_RXDMA_AGG_PG_TH_8822B(x, v) \ -+ (BIT_CLEAR_RXDMA_AGG_PG_TH_8822B(x) | BIT_RXDMA_AGG_PG_TH_8822B(v)) -+ -+/* 2 REG_RXPKT_NUM_8822B */ -+ -+#define BIT_SHIFT_RXPKT_NUM_8822B 24 -+#define BIT_MASK_RXPKT_NUM_8822B 0xff -+#define BIT_RXPKT_NUM_8822B(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_8822B) << BIT_SHIFT_RXPKT_NUM_8822B) -+#define BITS_RXPKT_NUM_8822B \ -+ (BIT_MASK_RXPKT_NUM_8822B << BIT_SHIFT_RXPKT_NUM_8822B) -+#define BIT_CLEAR_RXPKT_NUM_8822B(x) ((x) & (~BITS_RXPKT_NUM_8822B)) -+#define BIT_GET_RXPKT_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_8822B) & BIT_MASK_RXPKT_NUM_8822B) -+#define BIT_SET_RXPKT_NUM_8822B(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_8822B(x) | BIT_RXPKT_NUM_8822B(v)) -+ -+#define BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8822B 20 -+#define BIT_MASK_FW_UPD_RDPTR19_TO_16_8822B 0xf -+#define BIT_FW_UPD_RDPTR19_TO_16_8822B(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR19_TO_16_8822B) \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8822B) -+#define BITS_FW_UPD_RDPTR19_TO_16_8822B \ -+ (BIT_MASK_FW_UPD_RDPTR19_TO_16_8822B \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8822B) -+#define BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8822B(x) \ -+ ((x) & (~BITS_FW_UPD_RDPTR19_TO_16_8822B)) -+#define BIT_GET_FW_UPD_RDPTR19_TO_16_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8822B) & \ -+ BIT_MASK_FW_UPD_RDPTR19_TO_16_8822B) -+#define BIT_SET_FW_UPD_RDPTR19_TO_16_8822B(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8822B(x) | \ -+ BIT_FW_UPD_RDPTR19_TO_16_8822B(v)) -+ -+#define BIT_RXDMA_REQ_8822B BIT(19) -+#define BIT_RW_RELEASE_EN_8822B BIT(18) -+#define BIT_RXDMA_IDLE_8822B BIT(17) -+#define BIT_RXPKT_RELEASE_POLL_8822B BIT(16) -+ -+#define BIT_SHIFT_FW_UPD_RDPTR_8822B 0 -+#define BIT_MASK_FW_UPD_RDPTR_8822B 0xffff -+#define BIT_FW_UPD_RDPTR_8822B(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR_8822B) << BIT_SHIFT_FW_UPD_RDPTR_8822B) -+#define BITS_FW_UPD_RDPTR_8822B \ -+ (BIT_MASK_FW_UPD_RDPTR_8822B << BIT_SHIFT_FW_UPD_RDPTR_8822B) -+#define BIT_CLEAR_FW_UPD_RDPTR_8822B(x) ((x) & (~BITS_FW_UPD_RDPTR_8822B)) -+#define BIT_GET_FW_UPD_RDPTR_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR_8822B) & BIT_MASK_FW_UPD_RDPTR_8822B) -+#define BIT_SET_FW_UPD_RDPTR_8822B(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR_8822B(x) | BIT_FW_UPD_RDPTR_8822B(v)) -+ -+/* 2 REG_RXDMA_STATUS_8822B */ -+#define BIT_C2H_PKT_OVF_8822B BIT(7) -+#define BIT_AGG_CONFGI_ISSUE_8822B BIT(6) -+#define BIT_FW_POLL_ISSUE_8822B BIT(5) -+#define BIT_RX_DATA_UDN_8822B BIT(4) -+#define BIT_RX_SFF_UDN_8822B BIT(3) -+#define BIT_RX_SFF_OVF_8822B BIT(2) -+#define BIT_RXPKT_OVF_8822B BIT(0) -+ -+/* 2 REG_RXDMA_DPR_8822B */ -+ -+#define BIT_SHIFT_RDE_DEBUG_8822B 0 -+#define BIT_MASK_RDE_DEBUG_8822B 0xffffffffL -+#define BIT_RDE_DEBUG_8822B(x) \ -+ (((x) & BIT_MASK_RDE_DEBUG_8822B) << BIT_SHIFT_RDE_DEBUG_8822B) -+#define BITS_RDE_DEBUG_8822B \ -+ (BIT_MASK_RDE_DEBUG_8822B << BIT_SHIFT_RDE_DEBUG_8822B) -+#define BIT_CLEAR_RDE_DEBUG_8822B(x) ((x) & (~BITS_RDE_DEBUG_8822B)) -+#define BIT_GET_RDE_DEBUG_8822B(x) \ -+ (((x) >> BIT_SHIFT_RDE_DEBUG_8822B) & BIT_MASK_RDE_DEBUG_8822B) -+#define BIT_SET_RDE_DEBUG_8822B(x, v) \ -+ (BIT_CLEAR_RDE_DEBUG_8822B(x) | BIT_RDE_DEBUG_8822B(v)) -+ -+/* 2 REG_RXDMA_MODE_8822B */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V2_8822B 24 -+#define BIT_MASK_PKTNUM_TH_V2_8822B 0x1f -+#define BIT_PKTNUM_TH_V2_8822B(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V2_8822B) << BIT_SHIFT_PKTNUM_TH_V2_8822B) -+#define BITS_PKTNUM_TH_V2_8822B \ -+ (BIT_MASK_PKTNUM_TH_V2_8822B << BIT_SHIFT_PKTNUM_TH_V2_8822B) -+#define BIT_CLEAR_PKTNUM_TH_V2_8822B(x) ((x) & (~BITS_PKTNUM_TH_V2_8822B)) -+#define BIT_GET_PKTNUM_TH_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V2_8822B) & BIT_MASK_PKTNUM_TH_V2_8822B) -+#define BIT_SET_PKTNUM_TH_V2_8822B(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V2_8822B(x) | BIT_PKTNUM_TH_V2_8822B(v)) -+ -+#define BIT_TXBA_BREAK_USBAGG_8822B BIT(23) -+ -+#define BIT_SHIFT_PKTLEN_PARA_8822B 16 -+#define BIT_MASK_PKTLEN_PARA_8822B 0x7 -+#define BIT_PKTLEN_PARA_8822B(x) \ -+ (((x) & BIT_MASK_PKTLEN_PARA_8822B) << BIT_SHIFT_PKTLEN_PARA_8822B) -+#define BITS_PKTLEN_PARA_8822B \ -+ (BIT_MASK_PKTLEN_PARA_8822B << BIT_SHIFT_PKTLEN_PARA_8822B) -+#define BIT_CLEAR_PKTLEN_PARA_8822B(x) ((x) & (~BITS_PKTLEN_PARA_8822B)) -+#define BIT_GET_PKTLEN_PARA_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKTLEN_PARA_8822B) & BIT_MASK_PKTLEN_PARA_8822B) -+#define BIT_SET_PKTLEN_PARA_8822B(x, v) \ -+ (BIT_CLEAR_PKTLEN_PARA_8822B(x) | BIT_PKTLEN_PARA_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_BURST_SIZE_8822B 4 -+#define BIT_MASK_BURST_SIZE_8822B 0x3 -+#define BIT_BURST_SIZE_8822B(x) \ -+ (((x) & BIT_MASK_BURST_SIZE_8822B) << BIT_SHIFT_BURST_SIZE_8822B) -+#define BITS_BURST_SIZE_8822B \ -+ (BIT_MASK_BURST_SIZE_8822B << BIT_SHIFT_BURST_SIZE_8822B) -+#define BIT_CLEAR_BURST_SIZE_8822B(x) ((x) & (~BITS_BURST_SIZE_8822B)) -+#define BIT_GET_BURST_SIZE_8822B(x) \ -+ (((x) >> BIT_SHIFT_BURST_SIZE_8822B) & BIT_MASK_BURST_SIZE_8822B) -+#define BIT_SET_BURST_SIZE_8822B(x, v) \ -+ (BIT_CLEAR_BURST_SIZE_8822B(x) | BIT_BURST_SIZE_8822B(v)) -+ -+#define BIT_SHIFT_BURST_CNT_8822B 2 -+#define BIT_MASK_BURST_CNT_8822B 0x3 -+#define BIT_BURST_CNT_8822B(x) \ -+ (((x) & BIT_MASK_BURST_CNT_8822B) << BIT_SHIFT_BURST_CNT_8822B) -+#define BITS_BURST_CNT_8822B \ -+ (BIT_MASK_BURST_CNT_8822B << BIT_SHIFT_BURST_CNT_8822B) -+#define BIT_CLEAR_BURST_CNT_8822B(x) ((x) & (~BITS_BURST_CNT_8822B)) -+#define BIT_GET_BURST_CNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_BURST_CNT_8822B) & BIT_MASK_BURST_CNT_8822B) -+#define BIT_SET_BURST_CNT_8822B(x, v) \ -+ (BIT_CLEAR_BURST_CNT_8822B(x) | BIT_BURST_CNT_8822B(v)) -+ -+#define BIT_DMA_MODE_8822B BIT(1) -+ -+/* 2 REG_C2H_PKT_8822B */ -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8822B 24 -+#define BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8822B 0xf -+#define BIT_R_C2H_STR_ADDR_16_TO_19_8822B(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8822B) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8822B) -+#define BITS_R_C2H_STR_ADDR_16_TO_19_8822B \ -+ (BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8822B \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8822B) -+#define BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8822B(x) \ -+ ((x) & (~BITS_R_C2H_STR_ADDR_16_TO_19_8822B)) -+#define BIT_GET_R_C2H_STR_ADDR_16_TO_19_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8822B) & \ -+ BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8822B) -+#define BIT_SET_R_C2H_STR_ADDR_16_TO_19_8822B(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8822B(x) | \ -+ BIT_R_C2H_STR_ADDR_16_TO_19_8822B(v)) -+ -+#define BIT_R_C2H_PKT_REQ_8822B BIT(16) -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_8822B 0 -+#define BIT_MASK_R_C2H_STR_ADDR_8822B 0xffff -+#define BIT_R_C2H_STR_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_8822B) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_8822B) -+#define BITS_R_C2H_STR_ADDR_8822B \ -+ (BIT_MASK_R_C2H_STR_ADDR_8822B << BIT_SHIFT_R_C2H_STR_ADDR_8822B) -+#define BIT_CLEAR_R_C2H_STR_ADDR_8822B(x) ((x) & (~BITS_R_C2H_STR_ADDR_8822B)) -+#define BIT_GET_R_C2H_STR_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_8822B) & \ -+ BIT_MASK_R_C2H_STR_ADDR_8822B) -+#define BIT_SET_R_C2H_STR_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_8822B(x) | BIT_R_C2H_STR_ADDR_8822B(v)) -+ -+/* 2 REG_FWFF_C2H_8822B */ -+ -+#define BIT_SHIFT_C2H_DMA_ADDR_8822B 0 -+#define BIT_MASK_C2H_DMA_ADDR_8822B 0x3ffff -+#define BIT_C2H_DMA_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_C2H_DMA_ADDR_8822B) << BIT_SHIFT_C2H_DMA_ADDR_8822B) -+#define BITS_C2H_DMA_ADDR_8822B \ -+ (BIT_MASK_C2H_DMA_ADDR_8822B << BIT_SHIFT_C2H_DMA_ADDR_8822B) -+#define BIT_CLEAR_C2H_DMA_ADDR_8822B(x) ((x) & (~BITS_C2H_DMA_ADDR_8822B)) -+#define BIT_GET_C2H_DMA_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_C2H_DMA_ADDR_8822B) & BIT_MASK_C2H_DMA_ADDR_8822B) -+#define BIT_SET_C2H_DMA_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_C2H_DMA_ADDR_8822B(x) | BIT_C2H_DMA_ADDR_8822B(v)) -+ -+/* 2 REG_FWFF_CTRL_8822B */ -+#define BIT_FWFF_DMAPKT_REQ_8822B BIT(31) -+ -+#define BIT_SHIFT_FWFF_DMA_PKT_NUM_8822B 16 -+#define BIT_MASK_FWFF_DMA_PKT_NUM_8822B 0xff -+#define BIT_FWFF_DMA_PKT_NUM_8822B(x) \ -+ (((x) & BIT_MASK_FWFF_DMA_PKT_NUM_8822B) \ -+ << BIT_SHIFT_FWFF_DMA_PKT_NUM_8822B) -+#define BITS_FWFF_DMA_PKT_NUM_8822B \ -+ (BIT_MASK_FWFF_DMA_PKT_NUM_8822B << BIT_SHIFT_FWFF_DMA_PKT_NUM_8822B) -+#define BIT_CLEAR_FWFF_DMA_PKT_NUM_8822B(x) \ -+ ((x) & (~BITS_FWFF_DMA_PKT_NUM_8822B)) -+#define BIT_GET_FWFF_DMA_PKT_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_FWFF_DMA_PKT_NUM_8822B) & \ -+ BIT_MASK_FWFF_DMA_PKT_NUM_8822B) -+#define BIT_SET_FWFF_DMA_PKT_NUM_8822B(x, v) \ -+ (BIT_CLEAR_FWFF_DMA_PKT_NUM_8822B(x) | BIT_FWFF_DMA_PKT_NUM_8822B(v)) -+ -+#define BIT_SHIFT_FWFF_STR_ADDR_8822B 0 -+#define BIT_MASK_FWFF_STR_ADDR_8822B 0xffff -+#define BIT_FWFF_STR_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_FWFF_STR_ADDR_8822B) << BIT_SHIFT_FWFF_STR_ADDR_8822B) -+#define BITS_FWFF_STR_ADDR_8822B \ -+ (BIT_MASK_FWFF_STR_ADDR_8822B << BIT_SHIFT_FWFF_STR_ADDR_8822B) -+#define BIT_CLEAR_FWFF_STR_ADDR_8822B(x) ((x) & (~BITS_FWFF_STR_ADDR_8822B)) -+#define BIT_GET_FWFF_STR_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_FWFF_STR_ADDR_8822B) & BIT_MASK_FWFF_STR_ADDR_8822B) -+#define BIT_SET_FWFF_STR_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_FWFF_STR_ADDR_8822B(x) | BIT_FWFF_STR_ADDR_8822B(v)) -+ -+/* 2 REG_FWFF_PKT_INFO_8822B */ -+ -+#define BIT_SHIFT_FWFF_PKT_QUEUED_8822B 16 -+#define BIT_MASK_FWFF_PKT_QUEUED_8822B 0xff -+#define BIT_FWFF_PKT_QUEUED_8822B(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_QUEUED_8822B) \ -+ << BIT_SHIFT_FWFF_PKT_QUEUED_8822B) -+#define BITS_FWFF_PKT_QUEUED_8822B \ -+ (BIT_MASK_FWFF_PKT_QUEUED_8822B << BIT_SHIFT_FWFF_PKT_QUEUED_8822B) -+#define BIT_CLEAR_FWFF_PKT_QUEUED_8822B(x) ((x) & (~BITS_FWFF_PKT_QUEUED_8822B)) -+#define BIT_GET_FWFF_PKT_QUEUED_8822B(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_QUEUED_8822B) & \ -+ BIT_MASK_FWFF_PKT_QUEUED_8822B) -+#define BIT_SET_FWFF_PKT_QUEUED_8822B(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_QUEUED_8822B(x) | BIT_FWFF_PKT_QUEUED_8822B(v)) -+ -+#define BIT_SHIFT_FWFF_PKT_STR_ADDR_8822B 0 -+#define BIT_MASK_FWFF_PKT_STR_ADDR_8822B 0xffff -+#define BIT_FWFF_PKT_STR_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_STR_ADDR_8822B) \ -+ << BIT_SHIFT_FWFF_PKT_STR_ADDR_8822B) -+#define BITS_FWFF_PKT_STR_ADDR_8822B \ -+ (BIT_MASK_FWFF_PKT_STR_ADDR_8822B << BIT_SHIFT_FWFF_PKT_STR_ADDR_8822B) -+#define BIT_CLEAR_FWFF_PKT_STR_ADDR_8822B(x) \ -+ ((x) & (~BITS_FWFF_PKT_STR_ADDR_8822B)) -+#define BIT_GET_FWFF_PKT_STR_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_STR_ADDR_8822B) & \ -+ BIT_MASK_FWFF_PKT_STR_ADDR_8822B) -+#define BIT_SET_FWFF_PKT_STR_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_STR_ADDR_8822B(x) | BIT_FWFF_PKT_STR_ADDR_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_DDMA_CH0SA_8822B */ -+ -+#define BIT_SHIFT_DDMACH0_SA_8822B 0 -+#define BIT_MASK_DDMACH0_SA_8822B 0xffffffffL -+#define BIT_DDMACH0_SA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH0_SA_8822B) << BIT_SHIFT_DDMACH0_SA_8822B) -+#define BITS_DDMACH0_SA_8822B \ -+ (BIT_MASK_DDMACH0_SA_8822B << BIT_SHIFT_DDMACH0_SA_8822B) -+#define BIT_CLEAR_DDMACH0_SA_8822B(x) ((x) & (~BITS_DDMACH0_SA_8822B)) -+#define BIT_GET_DDMACH0_SA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_SA_8822B) & BIT_MASK_DDMACH0_SA_8822B) -+#define BIT_SET_DDMACH0_SA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH0_SA_8822B(x) | BIT_DDMACH0_SA_8822B(v)) -+ -+/* 2 REG_DDMA_CH0DA_8822B */ -+ -+#define BIT_SHIFT_DDMACH0_DA_8822B 0 -+#define BIT_MASK_DDMACH0_DA_8822B 0xffffffffL -+#define BIT_DDMACH0_DA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH0_DA_8822B) << BIT_SHIFT_DDMACH0_DA_8822B) -+#define BITS_DDMACH0_DA_8822B \ -+ (BIT_MASK_DDMACH0_DA_8822B << BIT_SHIFT_DDMACH0_DA_8822B) -+#define BIT_CLEAR_DDMACH0_DA_8822B(x) ((x) & (~BITS_DDMACH0_DA_8822B)) -+#define BIT_GET_DDMACH0_DA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DA_8822B) & BIT_MASK_DDMACH0_DA_8822B) -+#define BIT_SET_DDMACH0_DA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH0_DA_8822B(x) | BIT_DDMACH0_DA_8822B(v)) -+ -+/* 2 REG_DDMA_CH0CTRL_8822B */ -+#define BIT_DDMACH0_OWN_8822B BIT(31) -+#define BIT_DDMACH0_IDMEM_ERR_8822B BIT(30) -+#define BIT_DDMACH0_CHKSUM_EN_8822B BIT(29) -+#define BIT_DDMACH0_DA_W_DISABLE_8822B BIT(28) -+#define BIT_DDMACH0_CHKSUM_STS_8822B BIT(27) -+#define BIT_DDMACH0_DDMA_MODE_8822B BIT(26) -+#define BIT_DDMACH0_RESET_CHKSUM_STS_8822B BIT(25) -+#define BIT_DDMACH0_CHKSUM_CONT_8822B BIT(24) -+ -+#define BIT_SHIFT_DDMACH0_DLEN_8822B 0 -+#define BIT_MASK_DDMACH0_DLEN_8822B 0x3ffff -+#define BIT_DDMACH0_DLEN_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH0_DLEN_8822B) << BIT_SHIFT_DDMACH0_DLEN_8822B) -+#define BITS_DDMACH0_DLEN_8822B \ -+ (BIT_MASK_DDMACH0_DLEN_8822B << BIT_SHIFT_DDMACH0_DLEN_8822B) -+#define BIT_CLEAR_DDMACH0_DLEN_8822B(x) ((x) & (~BITS_DDMACH0_DLEN_8822B)) -+#define BIT_GET_DDMACH0_DLEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DLEN_8822B) & BIT_MASK_DDMACH0_DLEN_8822B) -+#define BIT_SET_DDMACH0_DLEN_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH0_DLEN_8822B(x) | BIT_DDMACH0_DLEN_8822B(v)) -+ -+/* 2 REG_DDMA_CH1SA_8822B */ -+ -+#define BIT_SHIFT_DDMACH1_SA_8822B 0 -+#define BIT_MASK_DDMACH1_SA_8822B 0xffffffffL -+#define BIT_DDMACH1_SA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH1_SA_8822B) << BIT_SHIFT_DDMACH1_SA_8822B) -+#define BITS_DDMACH1_SA_8822B \ -+ (BIT_MASK_DDMACH1_SA_8822B << BIT_SHIFT_DDMACH1_SA_8822B) -+#define BIT_CLEAR_DDMACH1_SA_8822B(x) ((x) & (~BITS_DDMACH1_SA_8822B)) -+#define BIT_GET_DDMACH1_SA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_SA_8822B) & BIT_MASK_DDMACH1_SA_8822B) -+#define BIT_SET_DDMACH1_SA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH1_SA_8822B(x) | BIT_DDMACH1_SA_8822B(v)) -+ -+/* 2 REG_DDMA_CH1DA_8822B */ -+ -+#define BIT_SHIFT_DDMACH1_DA_8822B 0 -+#define BIT_MASK_DDMACH1_DA_8822B 0xffffffffL -+#define BIT_DDMACH1_DA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH1_DA_8822B) << BIT_SHIFT_DDMACH1_DA_8822B) -+#define BITS_DDMACH1_DA_8822B \ -+ (BIT_MASK_DDMACH1_DA_8822B << BIT_SHIFT_DDMACH1_DA_8822B) -+#define BIT_CLEAR_DDMACH1_DA_8822B(x) ((x) & (~BITS_DDMACH1_DA_8822B)) -+#define BIT_GET_DDMACH1_DA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DA_8822B) & BIT_MASK_DDMACH1_DA_8822B) -+#define BIT_SET_DDMACH1_DA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH1_DA_8822B(x) | BIT_DDMACH1_DA_8822B(v)) -+ -+/* 2 REG_DDMA_CH1CTRL_8822B */ -+#define BIT_DDMACH1_OWN_8822B BIT(31) -+#define BIT_DDMACH1_IDMEM_ERR_8822B BIT(30) -+#define BIT_DDMACH1_CHKSUM_EN_8822B BIT(29) -+#define BIT_DDMACH1_DA_W_DISABLE_8822B BIT(28) -+#define BIT_DDMACH1_CHKSUM_STS_8822B BIT(27) -+#define BIT_DDMACH1_DDMA_MODE_8822B BIT(26) -+#define BIT_DDMACH1_RESET_CHKSUM_STS_8822B BIT(25) -+#define BIT_DDMACH1_CHKSUM_CONT_8822B BIT(24) -+ -+#define BIT_SHIFT_DDMACH1_DLEN_8822B 0 -+#define BIT_MASK_DDMACH1_DLEN_8822B 0x3ffff -+#define BIT_DDMACH1_DLEN_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH1_DLEN_8822B) << BIT_SHIFT_DDMACH1_DLEN_8822B) -+#define BITS_DDMACH1_DLEN_8822B \ -+ (BIT_MASK_DDMACH1_DLEN_8822B << BIT_SHIFT_DDMACH1_DLEN_8822B) -+#define BIT_CLEAR_DDMACH1_DLEN_8822B(x) ((x) & (~BITS_DDMACH1_DLEN_8822B)) -+#define BIT_GET_DDMACH1_DLEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DLEN_8822B) & BIT_MASK_DDMACH1_DLEN_8822B) -+#define BIT_SET_DDMACH1_DLEN_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH1_DLEN_8822B(x) | BIT_DDMACH1_DLEN_8822B(v)) -+ -+/* 2 REG_DDMA_CH2SA_8822B */ -+ -+#define BIT_SHIFT_DDMACH2_SA_8822B 0 -+#define BIT_MASK_DDMACH2_SA_8822B 0xffffffffL -+#define BIT_DDMACH2_SA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH2_SA_8822B) << BIT_SHIFT_DDMACH2_SA_8822B) -+#define BITS_DDMACH2_SA_8822B \ -+ (BIT_MASK_DDMACH2_SA_8822B << BIT_SHIFT_DDMACH2_SA_8822B) -+#define BIT_CLEAR_DDMACH2_SA_8822B(x) ((x) & (~BITS_DDMACH2_SA_8822B)) -+#define BIT_GET_DDMACH2_SA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_SA_8822B) & BIT_MASK_DDMACH2_SA_8822B) -+#define BIT_SET_DDMACH2_SA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH2_SA_8822B(x) | BIT_DDMACH2_SA_8822B(v)) -+ -+/* 2 REG_DDMA_CH2DA_8822B */ -+ -+#define BIT_SHIFT_DDMACH2_DA_8822B 0 -+#define BIT_MASK_DDMACH2_DA_8822B 0xffffffffL -+#define BIT_DDMACH2_DA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH2_DA_8822B) << BIT_SHIFT_DDMACH2_DA_8822B) -+#define BITS_DDMACH2_DA_8822B \ -+ (BIT_MASK_DDMACH2_DA_8822B << BIT_SHIFT_DDMACH2_DA_8822B) -+#define BIT_CLEAR_DDMACH2_DA_8822B(x) ((x) & (~BITS_DDMACH2_DA_8822B)) -+#define BIT_GET_DDMACH2_DA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DA_8822B) & BIT_MASK_DDMACH2_DA_8822B) -+#define BIT_SET_DDMACH2_DA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH2_DA_8822B(x) | BIT_DDMACH2_DA_8822B(v)) -+ -+/* 2 REG_DDMA_CH2CTRL_8822B */ -+#define BIT_DDMACH2_OWN_8822B BIT(31) -+#define BIT_DDMACH2_IDMEM_ERR_8822B BIT(30) -+#define BIT_DDMACH2_CHKSUM_EN_8822B BIT(29) -+#define BIT_DDMACH2_DA_W_DISABLE_8822B BIT(28) -+#define BIT_DDMACH2_CHKSUM_STS_8822B BIT(27) -+#define BIT_DDMACH2_DDMA_MODE_8822B BIT(26) -+#define BIT_DDMACH2_RESET_CHKSUM_STS_8822B BIT(25) -+#define BIT_DDMACH2_CHKSUM_CONT_8822B BIT(24) -+ -+#define BIT_SHIFT_DDMACH2_DLEN_8822B 0 -+#define BIT_MASK_DDMACH2_DLEN_8822B 0x3ffff -+#define BIT_DDMACH2_DLEN_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH2_DLEN_8822B) << BIT_SHIFT_DDMACH2_DLEN_8822B) -+#define BITS_DDMACH2_DLEN_8822B \ -+ (BIT_MASK_DDMACH2_DLEN_8822B << BIT_SHIFT_DDMACH2_DLEN_8822B) -+#define BIT_CLEAR_DDMACH2_DLEN_8822B(x) ((x) & (~BITS_DDMACH2_DLEN_8822B)) -+#define BIT_GET_DDMACH2_DLEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DLEN_8822B) & BIT_MASK_DDMACH2_DLEN_8822B) -+#define BIT_SET_DDMACH2_DLEN_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH2_DLEN_8822B(x) | BIT_DDMACH2_DLEN_8822B(v)) -+ -+/* 2 REG_DDMA_CH3SA_8822B */ -+ -+#define BIT_SHIFT_DDMACH3_SA_8822B 0 -+#define BIT_MASK_DDMACH3_SA_8822B 0xffffffffL -+#define BIT_DDMACH3_SA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH3_SA_8822B) << BIT_SHIFT_DDMACH3_SA_8822B) -+#define BITS_DDMACH3_SA_8822B \ -+ (BIT_MASK_DDMACH3_SA_8822B << BIT_SHIFT_DDMACH3_SA_8822B) -+#define BIT_CLEAR_DDMACH3_SA_8822B(x) ((x) & (~BITS_DDMACH3_SA_8822B)) -+#define BIT_GET_DDMACH3_SA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_SA_8822B) & BIT_MASK_DDMACH3_SA_8822B) -+#define BIT_SET_DDMACH3_SA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH3_SA_8822B(x) | BIT_DDMACH3_SA_8822B(v)) -+ -+/* 2 REG_DDMA_CH3DA_8822B */ -+ -+#define BIT_SHIFT_DDMACH3_DA_8822B 0 -+#define BIT_MASK_DDMACH3_DA_8822B 0xffffffffL -+#define BIT_DDMACH3_DA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH3_DA_8822B) << BIT_SHIFT_DDMACH3_DA_8822B) -+#define BITS_DDMACH3_DA_8822B \ -+ (BIT_MASK_DDMACH3_DA_8822B << BIT_SHIFT_DDMACH3_DA_8822B) -+#define BIT_CLEAR_DDMACH3_DA_8822B(x) ((x) & (~BITS_DDMACH3_DA_8822B)) -+#define BIT_GET_DDMACH3_DA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DA_8822B) & BIT_MASK_DDMACH3_DA_8822B) -+#define BIT_SET_DDMACH3_DA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH3_DA_8822B(x) | BIT_DDMACH3_DA_8822B(v)) -+ -+/* 2 REG_DDMA_CH3CTRL_8822B */ -+#define BIT_DDMACH3_OWN_8822B BIT(31) -+#define BIT_DDMACH3_IDMEM_ERR_8822B BIT(30) -+#define BIT_DDMACH3_CHKSUM_EN_8822B BIT(29) -+#define BIT_DDMACH3_DA_W_DISABLE_8822B BIT(28) -+#define BIT_DDMACH3_CHKSUM_STS_8822B BIT(27) -+#define BIT_DDMACH3_DDMA_MODE_8822B BIT(26) -+#define BIT_DDMACH3_RESET_CHKSUM_STS_8822B BIT(25) -+#define BIT_DDMACH3_CHKSUM_CONT_8822B BIT(24) -+ -+#define BIT_SHIFT_DDMACH3_DLEN_8822B 0 -+#define BIT_MASK_DDMACH3_DLEN_8822B 0x3ffff -+#define BIT_DDMACH3_DLEN_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH3_DLEN_8822B) << BIT_SHIFT_DDMACH3_DLEN_8822B) -+#define BITS_DDMACH3_DLEN_8822B \ -+ (BIT_MASK_DDMACH3_DLEN_8822B << BIT_SHIFT_DDMACH3_DLEN_8822B) -+#define BIT_CLEAR_DDMACH3_DLEN_8822B(x) ((x) & (~BITS_DDMACH3_DLEN_8822B)) -+#define BIT_GET_DDMACH3_DLEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DLEN_8822B) & BIT_MASK_DDMACH3_DLEN_8822B) -+#define BIT_SET_DDMACH3_DLEN_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH3_DLEN_8822B(x) | BIT_DDMACH3_DLEN_8822B(v)) -+ -+/* 2 REG_DDMA_CH4SA_8822B */ -+ -+#define BIT_SHIFT_DDMACH4_SA_8822B 0 -+#define BIT_MASK_DDMACH4_SA_8822B 0xffffffffL -+#define BIT_DDMACH4_SA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH4_SA_8822B) << BIT_SHIFT_DDMACH4_SA_8822B) -+#define BITS_DDMACH4_SA_8822B \ -+ (BIT_MASK_DDMACH4_SA_8822B << BIT_SHIFT_DDMACH4_SA_8822B) -+#define BIT_CLEAR_DDMACH4_SA_8822B(x) ((x) & (~BITS_DDMACH4_SA_8822B)) -+#define BIT_GET_DDMACH4_SA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_SA_8822B) & BIT_MASK_DDMACH4_SA_8822B) -+#define BIT_SET_DDMACH4_SA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH4_SA_8822B(x) | BIT_DDMACH4_SA_8822B(v)) -+ -+/* 2 REG_DDMA_CH4DA_8822B */ -+ -+#define BIT_SHIFT_DDMACH4_DA_8822B 0 -+#define BIT_MASK_DDMACH4_DA_8822B 0xffffffffL -+#define BIT_DDMACH4_DA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH4_DA_8822B) << BIT_SHIFT_DDMACH4_DA_8822B) -+#define BITS_DDMACH4_DA_8822B \ -+ (BIT_MASK_DDMACH4_DA_8822B << BIT_SHIFT_DDMACH4_DA_8822B) -+#define BIT_CLEAR_DDMACH4_DA_8822B(x) ((x) & (~BITS_DDMACH4_DA_8822B)) -+#define BIT_GET_DDMACH4_DA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DA_8822B) & BIT_MASK_DDMACH4_DA_8822B) -+#define BIT_SET_DDMACH4_DA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH4_DA_8822B(x) | BIT_DDMACH4_DA_8822B(v)) -+ -+/* 2 REG_DDMA_CH4CTRL_8822B */ -+#define BIT_DDMACH4_OWN_8822B BIT(31) -+#define BIT_DDMACH4_IDMEM_ERR_8822B BIT(30) -+#define BIT_DDMACH4_CHKSUM_EN_8822B BIT(29) -+#define BIT_DDMACH4_DA_W_DISABLE_8822B BIT(28) -+#define BIT_DDMACH4_CHKSUM_STS_8822B BIT(27) -+#define BIT_DDMACH4_DDMA_MODE_8822B BIT(26) -+#define BIT_DDMACH4_RESET_CHKSUM_STS_8822B BIT(25) -+#define BIT_DDMACH4_CHKSUM_CONT_8822B BIT(24) -+ -+#define BIT_SHIFT_DDMACH4_DLEN_8822B 0 -+#define BIT_MASK_DDMACH4_DLEN_8822B 0x3ffff -+#define BIT_DDMACH4_DLEN_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH4_DLEN_8822B) << BIT_SHIFT_DDMACH4_DLEN_8822B) -+#define BITS_DDMACH4_DLEN_8822B \ -+ (BIT_MASK_DDMACH4_DLEN_8822B << BIT_SHIFT_DDMACH4_DLEN_8822B) -+#define BIT_CLEAR_DDMACH4_DLEN_8822B(x) ((x) & (~BITS_DDMACH4_DLEN_8822B)) -+#define BIT_GET_DDMACH4_DLEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DLEN_8822B) & BIT_MASK_DDMACH4_DLEN_8822B) -+#define BIT_SET_DDMACH4_DLEN_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH4_DLEN_8822B(x) | BIT_DDMACH4_DLEN_8822B(v)) -+ -+/* 2 REG_DDMA_CH5SA_8822B */ -+ -+#define BIT_SHIFT_DDMACH5_SA_8822B 0 -+#define BIT_MASK_DDMACH5_SA_8822B 0xffffffffL -+#define BIT_DDMACH5_SA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH5_SA_8822B) << BIT_SHIFT_DDMACH5_SA_8822B) -+#define BITS_DDMACH5_SA_8822B \ -+ (BIT_MASK_DDMACH5_SA_8822B << BIT_SHIFT_DDMACH5_SA_8822B) -+#define BIT_CLEAR_DDMACH5_SA_8822B(x) ((x) & (~BITS_DDMACH5_SA_8822B)) -+#define BIT_GET_DDMACH5_SA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_SA_8822B) & BIT_MASK_DDMACH5_SA_8822B) -+#define BIT_SET_DDMACH5_SA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH5_SA_8822B(x) | BIT_DDMACH5_SA_8822B(v)) -+ -+/* 2 REG_DDMA_CH5DA_8822B */ -+ -+#define BIT_SHIFT_DDMACH5_DA_8822B 0 -+#define BIT_MASK_DDMACH5_DA_8822B 0xffffffffL -+#define BIT_DDMACH5_DA_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH5_DA_8822B) << BIT_SHIFT_DDMACH5_DA_8822B) -+#define BITS_DDMACH5_DA_8822B \ -+ (BIT_MASK_DDMACH5_DA_8822B << BIT_SHIFT_DDMACH5_DA_8822B) -+#define BIT_CLEAR_DDMACH5_DA_8822B(x) ((x) & (~BITS_DDMACH5_DA_8822B)) -+#define BIT_GET_DDMACH5_DA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DA_8822B) & BIT_MASK_DDMACH5_DA_8822B) -+#define BIT_SET_DDMACH5_DA_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH5_DA_8822B(x) | BIT_DDMACH5_DA_8822B(v)) -+ -+/* 2 REG_REG_DDMA_CH5CTRL_8822B */ -+#define BIT_DDMACH5_OWN_8822B BIT(31) -+#define BIT_DDMACH5_IDMEM_ERR_8822B BIT(30) -+#define BIT_DDMACH5_CHKSUM_EN_8822B BIT(29) -+#define BIT_DDMACH5_DA_W_DISABLE_8822B BIT(28) -+#define BIT_DDMACH5_CHKSUM_STS_8822B BIT(27) -+#define BIT_DDMACH5_DDMA_MODE_8822B BIT(26) -+#define BIT_DDMACH5_RESET_CHKSUM_STS_8822B BIT(25) -+#define BIT_DDMACH5_CHKSUM_CONT_8822B BIT(24) -+ -+#define BIT_SHIFT_DDMACH5_DLEN_8822B 0 -+#define BIT_MASK_DDMACH5_DLEN_8822B 0x3ffff -+#define BIT_DDMACH5_DLEN_8822B(x) \ -+ (((x) & BIT_MASK_DDMACH5_DLEN_8822B) << BIT_SHIFT_DDMACH5_DLEN_8822B) -+#define BITS_DDMACH5_DLEN_8822B \ -+ (BIT_MASK_DDMACH5_DLEN_8822B << BIT_SHIFT_DDMACH5_DLEN_8822B) -+#define BIT_CLEAR_DDMACH5_DLEN_8822B(x) ((x) & (~BITS_DDMACH5_DLEN_8822B)) -+#define BIT_GET_DDMACH5_DLEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DLEN_8822B) & BIT_MASK_DDMACH5_DLEN_8822B) -+#define BIT_SET_DDMACH5_DLEN_8822B(x, v) \ -+ (BIT_CLEAR_DDMACH5_DLEN_8822B(x) | BIT_DDMACH5_DLEN_8822B(v)) -+ -+/* 2 REG_DDMA_INT_MSK_8822B */ -+#define BIT_DDMACH5_MSK_8822B BIT(5) -+#define BIT_DDMACH4_MSK_8822B BIT(4) -+#define BIT_DDMACH3_MSK_8822B BIT(3) -+#define BIT_DDMACH2_MSK_8822B BIT(2) -+#define BIT_DDMACH1_MSK_8822B BIT(1) -+#define BIT_DDMACH0_MSK_8822B BIT(0) -+ -+/* 2 REG_DDMA_CHSTATUS_8822B */ -+#define BIT_DDMACH5_BUSY_8822B BIT(5) -+#define BIT_DDMACH4_BUSY_8822B BIT(4) -+#define BIT_DDMACH3_BUSY_8822B BIT(3) -+#define BIT_DDMACH2_BUSY_8822B BIT(2) -+#define BIT_DDMACH1_BUSY_8822B BIT(1) -+#define BIT_DDMACH0_BUSY_8822B BIT(0) -+ -+/* 2 REG_DDMA_CHKSUM_8822B */ -+ -+#define BIT_SHIFT_IDDMA0_CHKSUM_8822B 0 -+#define BIT_MASK_IDDMA0_CHKSUM_8822B 0xffff -+#define BIT_IDDMA0_CHKSUM_8822B(x) \ -+ (((x) & BIT_MASK_IDDMA0_CHKSUM_8822B) << BIT_SHIFT_IDDMA0_CHKSUM_8822B) -+#define BITS_IDDMA0_CHKSUM_8822B \ -+ (BIT_MASK_IDDMA0_CHKSUM_8822B << BIT_SHIFT_IDDMA0_CHKSUM_8822B) -+#define BIT_CLEAR_IDDMA0_CHKSUM_8822B(x) ((x) & (~BITS_IDDMA0_CHKSUM_8822B)) -+#define BIT_GET_IDDMA0_CHKSUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_IDDMA0_CHKSUM_8822B) & BIT_MASK_IDDMA0_CHKSUM_8822B) -+#define BIT_SET_IDDMA0_CHKSUM_8822B(x, v) \ -+ (BIT_CLEAR_IDDMA0_CHKSUM_8822B(x) | BIT_IDDMA0_CHKSUM_8822B(v)) -+ -+/* 2 REG_DDMA_MONITOR_8822B */ -+#define BIT_IDDMA0_PERMU_UNDERFLOW_8822B BIT(14) -+#define BIT_IDDMA0_FIFO_UNDERFLOW_8822B BIT(13) -+#define BIT_IDDMA0_FIFO_OVERFLOW_8822B BIT(12) -+#define BIT_CH5_ERR_8822B BIT(5) -+#define BIT_CH4_ERR_8822B BIT(4) -+#define BIT_CH3_ERR_8822B BIT(3) -+#define BIT_CH2_ERR_8822B BIT(2) -+#define BIT_CH1_ERR_8822B BIT(1) -+#define BIT_CH0_ERR_8822B BIT(0) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_PCIE_CTRL_8822B */ -+#define BIT_PCIEIO_PERSTB_SEL_8822B BIT(31) -+ -+#define BIT_SHIFT_PCIE_MAX_RXDMA_8822B 28 -+#define BIT_MASK_PCIE_MAX_RXDMA_8822B 0x7 -+#define BIT_PCIE_MAX_RXDMA_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_RXDMA_8822B) \ -+ << BIT_SHIFT_PCIE_MAX_RXDMA_8822B) -+#define BITS_PCIE_MAX_RXDMA_8822B \ -+ (BIT_MASK_PCIE_MAX_RXDMA_8822B << BIT_SHIFT_PCIE_MAX_RXDMA_8822B) -+#define BIT_CLEAR_PCIE_MAX_RXDMA_8822B(x) ((x) & (~BITS_PCIE_MAX_RXDMA_8822B)) -+#define BIT_GET_PCIE_MAX_RXDMA_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_RXDMA_8822B) & \ -+ BIT_MASK_PCIE_MAX_RXDMA_8822B) -+#define BIT_SET_PCIE_MAX_RXDMA_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_RXDMA_8822B(x) | BIT_PCIE_MAX_RXDMA_8822B(v)) -+ -+#define BIT_MULRW_8822B BIT(27) -+ -+#define BIT_SHIFT_PCIE_MAX_TXDMA_8822B 24 -+#define BIT_MASK_PCIE_MAX_TXDMA_8822B 0x7 -+#define BIT_PCIE_MAX_TXDMA_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_TXDMA_8822B) \ -+ << BIT_SHIFT_PCIE_MAX_TXDMA_8822B) -+#define BITS_PCIE_MAX_TXDMA_8822B \ -+ (BIT_MASK_PCIE_MAX_TXDMA_8822B << BIT_SHIFT_PCIE_MAX_TXDMA_8822B) -+#define BIT_CLEAR_PCIE_MAX_TXDMA_8822B(x) ((x) & (~BITS_PCIE_MAX_TXDMA_8822B)) -+#define BIT_GET_PCIE_MAX_TXDMA_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_TXDMA_8822B) & \ -+ BIT_MASK_PCIE_MAX_TXDMA_8822B) -+#define BIT_SET_PCIE_MAX_TXDMA_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_TXDMA_8822B(x) | BIT_PCIE_MAX_TXDMA_8822B(v)) -+ -+#define BIT_EN_CPL_TIMEOUT_PS_8822B BIT(22) -+#define BIT_REG_TXDMA_FAIL_PS_8822B BIT(21) -+#define BIT_PCIE_RST_TRXDMA_INTF_8822B BIT(20) -+#define BIT_EN_HWENTR_L1_8822B BIT(19) -+#define BIT_EN_ADV_CLKGATE_8822B BIT(18) -+#define BIT_PCIE_EN_SWENT_L23_8822B BIT(17) -+#define BIT_PCIE_EN_HWEXT_L1_8822B BIT(16) -+#define BIT_RX_CLOSE_EN_8822B BIT(15) -+#define BIT_STOP_BCNQ_8822B BIT(14) -+#define BIT_STOP_MGQ_8822B BIT(13) -+#define BIT_STOP_VOQ_8822B BIT(12) -+#define BIT_STOP_VIQ_8822B BIT(11) -+#define BIT_STOP_BEQ_8822B BIT(10) -+#define BIT_STOP_BKQ_8822B BIT(9) -+#define BIT_STOP_RXQ_8822B BIT(8) -+#define BIT_STOP_HI7Q_8822B BIT(7) -+#define BIT_STOP_HI6Q_8822B BIT(6) -+#define BIT_STOP_HI5Q_8822B BIT(5) -+#define BIT_STOP_HI4Q_8822B BIT(4) -+#define BIT_STOP_HI3Q_8822B BIT(3) -+#define BIT_STOP_HI2Q_8822B BIT(2) -+#define BIT_STOP_HI1Q_8822B BIT(1) -+#define BIT_STOP_HI0Q_8822B BIT(0) -+ -+/* 2 REG_INT_MIG_8822B */ -+ -+#define BIT_SHIFT_TXTTIMER_MATCH_NUM_8822B 28 -+#define BIT_MASK_TXTTIMER_MATCH_NUM_8822B 0xf -+#define BIT_TXTTIMER_MATCH_NUM_8822B(x) \ -+ (((x) & BIT_MASK_TXTTIMER_MATCH_NUM_8822B) \ -+ << BIT_SHIFT_TXTTIMER_MATCH_NUM_8822B) -+#define BITS_TXTTIMER_MATCH_NUM_8822B \ -+ (BIT_MASK_TXTTIMER_MATCH_NUM_8822B \ -+ << BIT_SHIFT_TXTTIMER_MATCH_NUM_8822B) -+#define BIT_CLEAR_TXTTIMER_MATCH_NUM_8822B(x) \ -+ ((x) & (~BITS_TXTTIMER_MATCH_NUM_8822B)) -+#define BIT_GET_TXTTIMER_MATCH_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXTTIMER_MATCH_NUM_8822B) & \ -+ BIT_MASK_TXTTIMER_MATCH_NUM_8822B) -+#define BIT_SET_TXTTIMER_MATCH_NUM_8822B(x, v) \ -+ (BIT_CLEAR_TXTTIMER_MATCH_NUM_8822B(x) | \ -+ BIT_TXTTIMER_MATCH_NUM_8822B(v)) -+ -+#define BIT_SHIFT_TXPKT_NUM_MATCH_8822B 24 -+#define BIT_MASK_TXPKT_NUM_MATCH_8822B 0xf -+#define BIT_TXPKT_NUM_MATCH_8822B(x) \ -+ (((x) & BIT_MASK_TXPKT_NUM_MATCH_8822B) \ -+ << BIT_SHIFT_TXPKT_NUM_MATCH_8822B) -+#define BITS_TXPKT_NUM_MATCH_8822B \ -+ (BIT_MASK_TXPKT_NUM_MATCH_8822B << BIT_SHIFT_TXPKT_NUM_MATCH_8822B) -+#define BIT_CLEAR_TXPKT_NUM_MATCH_8822B(x) ((x) & (~BITS_TXPKT_NUM_MATCH_8822B)) -+#define BIT_GET_TXPKT_NUM_MATCH_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXPKT_NUM_MATCH_8822B) & \ -+ BIT_MASK_TXPKT_NUM_MATCH_8822B) -+#define BIT_SET_TXPKT_NUM_MATCH_8822B(x, v) \ -+ (BIT_CLEAR_TXPKT_NUM_MATCH_8822B(x) | BIT_TXPKT_NUM_MATCH_8822B(v)) -+ -+#define BIT_SHIFT_RXTTIMER_MATCH_NUM_8822B 20 -+#define BIT_MASK_RXTTIMER_MATCH_NUM_8822B 0xf -+#define BIT_RXTTIMER_MATCH_NUM_8822B(x) \ -+ (((x) & BIT_MASK_RXTTIMER_MATCH_NUM_8822B) \ -+ << BIT_SHIFT_RXTTIMER_MATCH_NUM_8822B) -+#define BITS_RXTTIMER_MATCH_NUM_8822B \ -+ (BIT_MASK_RXTTIMER_MATCH_NUM_8822B \ -+ << BIT_SHIFT_RXTTIMER_MATCH_NUM_8822B) -+#define BIT_CLEAR_RXTTIMER_MATCH_NUM_8822B(x) \ -+ ((x) & (~BITS_RXTTIMER_MATCH_NUM_8822B)) -+#define BIT_GET_RXTTIMER_MATCH_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXTTIMER_MATCH_NUM_8822B) & \ -+ BIT_MASK_RXTTIMER_MATCH_NUM_8822B) -+#define BIT_SET_RXTTIMER_MATCH_NUM_8822B(x, v) \ -+ (BIT_CLEAR_RXTTIMER_MATCH_NUM_8822B(x) | \ -+ BIT_RXTTIMER_MATCH_NUM_8822B(v)) -+ -+#define BIT_SHIFT_RXPKT_NUM_MATCH_8822B 16 -+#define BIT_MASK_RXPKT_NUM_MATCH_8822B 0xf -+#define BIT_RXPKT_NUM_MATCH_8822B(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_MATCH_8822B) \ -+ << BIT_SHIFT_RXPKT_NUM_MATCH_8822B) -+#define BITS_RXPKT_NUM_MATCH_8822B \ -+ (BIT_MASK_RXPKT_NUM_MATCH_8822B << BIT_SHIFT_RXPKT_NUM_MATCH_8822B) -+#define BIT_CLEAR_RXPKT_NUM_MATCH_8822B(x) ((x) & (~BITS_RXPKT_NUM_MATCH_8822B)) -+#define BIT_GET_RXPKT_NUM_MATCH_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_MATCH_8822B) & \ -+ BIT_MASK_RXPKT_NUM_MATCH_8822B) -+#define BIT_SET_RXPKT_NUM_MATCH_8822B(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_MATCH_8822B(x) | BIT_RXPKT_NUM_MATCH_8822B(v)) -+ -+#define BIT_SHIFT_MIGRATE_TIMER_8822B 0 -+#define BIT_MASK_MIGRATE_TIMER_8822B 0xffff -+#define BIT_MIGRATE_TIMER_8822B(x) \ -+ (((x) & BIT_MASK_MIGRATE_TIMER_8822B) << BIT_SHIFT_MIGRATE_TIMER_8822B) -+#define BITS_MIGRATE_TIMER_8822B \ -+ (BIT_MASK_MIGRATE_TIMER_8822B << BIT_SHIFT_MIGRATE_TIMER_8822B) -+#define BIT_CLEAR_MIGRATE_TIMER_8822B(x) ((x) & (~BITS_MIGRATE_TIMER_8822B)) -+#define BIT_GET_MIGRATE_TIMER_8822B(x) \ -+ (((x) >> BIT_SHIFT_MIGRATE_TIMER_8822B) & BIT_MASK_MIGRATE_TIMER_8822B) -+#define BIT_SET_MIGRATE_TIMER_8822B(x, v) \ -+ (BIT_CLEAR_MIGRATE_TIMER_8822B(x) | BIT_MIGRATE_TIMER_8822B(v)) -+ -+/* 2 REG_BCNQ_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_BCNQ_TXBD_DESA_8822B 0 -+#define BIT_MASK_BCNQ_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_BCNQ_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_BCNQ_TXBD_DESA_8822B) \ -+ << BIT_SHIFT_BCNQ_TXBD_DESA_8822B) -+#define BITS_BCNQ_TXBD_DESA_8822B \ -+ (BIT_MASK_BCNQ_TXBD_DESA_8822B << BIT_SHIFT_BCNQ_TXBD_DESA_8822B) -+#define BIT_CLEAR_BCNQ_TXBD_DESA_8822B(x) ((x) & (~BITS_BCNQ_TXBD_DESA_8822B)) -+#define BIT_GET_BCNQ_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_TXBD_DESA_8822B) & \ -+ BIT_MASK_BCNQ_TXBD_DESA_8822B) -+#define BIT_SET_BCNQ_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_BCNQ_TXBD_DESA_8822B(x) | BIT_BCNQ_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_MGQ_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_MGQ_TXBD_DESA_8822B 0 -+#define BIT_MASK_MGQ_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_MGQ_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_MGQ_TXBD_DESA_8822B) << BIT_SHIFT_MGQ_TXBD_DESA_8822B) -+#define BITS_MGQ_TXBD_DESA_8822B \ -+ (BIT_MASK_MGQ_TXBD_DESA_8822B << BIT_SHIFT_MGQ_TXBD_DESA_8822B) -+#define BIT_CLEAR_MGQ_TXBD_DESA_8822B(x) ((x) & (~BITS_MGQ_TXBD_DESA_8822B)) -+#define BIT_GET_MGQ_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_TXBD_DESA_8822B) & BIT_MASK_MGQ_TXBD_DESA_8822B) -+#define BIT_SET_MGQ_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_MGQ_TXBD_DESA_8822B(x) | BIT_MGQ_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_VOQ_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_VOQ_TXBD_DESA_8822B 0 -+#define BIT_MASK_VOQ_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_VOQ_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_VOQ_TXBD_DESA_8822B) << BIT_SHIFT_VOQ_TXBD_DESA_8822B) -+#define BITS_VOQ_TXBD_DESA_8822B \ -+ (BIT_MASK_VOQ_TXBD_DESA_8822B << BIT_SHIFT_VOQ_TXBD_DESA_8822B) -+#define BIT_CLEAR_VOQ_TXBD_DESA_8822B(x) ((x) & (~BITS_VOQ_TXBD_DESA_8822B)) -+#define BIT_GET_VOQ_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_VOQ_TXBD_DESA_8822B) & BIT_MASK_VOQ_TXBD_DESA_8822B) -+#define BIT_SET_VOQ_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_VOQ_TXBD_DESA_8822B(x) | BIT_VOQ_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_VIQ_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_VIQ_TXBD_DESA_8822B 0 -+#define BIT_MASK_VIQ_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_VIQ_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_VIQ_TXBD_DESA_8822B) << BIT_SHIFT_VIQ_TXBD_DESA_8822B) -+#define BITS_VIQ_TXBD_DESA_8822B \ -+ (BIT_MASK_VIQ_TXBD_DESA_8822B << BIT_SHIFT_VIQ_TXBD_DESA_8822B) -+#define BIT_CLEAR_VIQ_TXBD_DESA_8822B(x) ((x) & (~BITS_VIQ_TXBD_DESA_8822B)) -+#define BIT_GET_VIQ_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_VIQ_TXBD_DESA_8822B) & BIT_MASK_VIQ_TXBD_DESA_8822B) -+#define BIT_SET_VIQ_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_VIQ_TXBD_DESA_8822B(x) | BIT_VIQ_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_BEQ_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_BEQ_TXBD_DESA_8822B 0 -+#define BIT_MASK_BEQ_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_BEQ_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_BEQ_TXBD_DESA_8822B) << BIT_SHIFT_BEQ_TXBD_DESA_8822B) -+#define BITS_BEQ_TXBD_DESA_8822B \ -+ (BIT_MASK_BEQ_TXBD_DESA_8822B << BIT_SHIFT_BEQ_TXBD_DESA_8822B) -+#define BIT_CLEAR_BEQ_TXBD_DESA_8822B(x) ((x) & (~BITS_BEQ_TXBD_DESA_8822B)) -+#define BIT_GET_BEQ_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_BEQ_TXBD_DESA_8822B) & BIT_MASK_BEQ_TXBD_DESA_8822B) -+#define BIT_SET_BEQ_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_BEQ_TXBD_DESA_8822B(x) | BIT_BEQ_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_BKQ_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_BKQ_TXBD_DESA_8822B 0 -+#define BIT_MASK_BKQ_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_BKQ_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_BKQ_TXBD_DESA_8822B) << BIT_SHIFT_BKQ_TXBD_DESA_8822B) -+#define BITS_BKQ_TXBD_DESA_8822B \ -+ (BIT_MASK_BKQ_TXBD_DESA_8822B << BIT_SHIFT_BKQ_TXBD_DESA_8822B) -+#define BIT_CLEAR_BKQ_TXBD_DESA_8822B(x) ((x) & (~BITS_BKQ_TXBD_DESA_8822B)) -+#define BIT_GET_BKQ_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_BKQ_TXBD_DESA_8822B) & BIT_MASK_BKQ_TXBD_DESA_8822B) -+#define BIT_SET_BKQ_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_BKQ_TXBD_DESA_8822B(x) | BIT_BKQ_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_RXQ_RXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_RXQ_RXBD_DESA_8822B 0 -+#define BIT_MASK_RXQ_RXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_RXQ_RXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_RXQ_RXBD_DESA_8822B) << BIT_SHIFT_RXQ_RXBD_DESA_8822B) -+#define BITS_RXQ_RXBD_DESA_8822B \ -+ (BIT_MASK_RXQ_RXBD_DESA_8822B << BIT_SHIFT_RXQ_RXBD_DESA_8822B) -+#define BIT_CLEAR_RXQ_RXBD_DESA_8822B(x) ((x) & (~BITS_RXQ_RXBD_DESA_8822B)) -+#define BIT_GET_RXQ_RXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXQ_RXBD_DESA_8822B) & BIT_MASK_RXQ_RXBD_DESA_8822B) -+#define BIT_SET_RXQ_RXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_RXQ_RXBD_DESA_8822B(x) | BIT_RXQ_RXBD_DESA_8822B(v)) -+ -+/* 2 REG_HI0Q_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_HI0Q_TXBD_DESA_8822B 0 -+#define BIT_MASK_HI0Q_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_HI0Q_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_HI0Q_TXBD_DESA_8822B) \ -+ << BIT_SHIFT_HI0Q_TXBD_DESA_8822B) -+#define BITS_HI0Q_TXBD_DESA_8822B \ -+ (BIT_MASK_HI0Q_TXBD_DESA_8822B << BIT_SHIFT_HI0Q_TXBD_DESA_8822B) -+#define BIT_CLEAR_HI0Q_TXBD_DESA_8822B(x) ((x) & (~BITS_HI0Q_TXBD_DESA_8822B)) -+#define BIT_GET_HI0Q_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_TXBD_DESA_8822B) & \ -+ BIT_MASK_HI0Q_TXBD_DESA_8822B) -+#define BIT_SET_HI0Q_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_HI0Q_TXBD_DESA_8822B(x) | BIT_HI0Q_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_HI1Q_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_HI1Q_TXBD_DESA_8822B 0 -+#define BIT_MASK_HI1Q_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_HI1Q_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_HI1Q_TXBD_DESA_8822B) \ -+ << BIT_SHIFT_HI1Q_TXBD_DESA_8822B) -+#define BITS_HI1Q_TXBD_DESA_8822B \ -+ (BIT_MASK_HI1Q_TXBD_DESA_8822B << BIT_SHIFT_HI1Q_TXBD_DESA_8822B) -+#define BIT_CLEAR_HI1Q_TXBD_DESA_8822B(x) ((x) & (~BITS_HI1Q_TXBD_DESA_8822B)) -+#define BIT_GET_HI1Q_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_TXBD_DESA_8822B) & \ -+ BIT_MASK_HI1Q_TXBD_DESA_8822B) -+#define BIT_SET_HI1Q_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_HI1Q_TXBD_DESA_8822B(x) | BIT_HI1Q_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_HI2Q_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_HI2Q_TXBD_DESA_8822B 0 -+#define BIT_MASK_HI2Q_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_HI2Q_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_HI2Q_TXBD_DESA_8822B) \ -+ << BIT_SHIFT_HI2Q_TXBD_DESA_8822B) -+#define BITS_HI2Q_TXBD_DESA_8822B \ -+ (BIT_MASK_HI2Q_TXBD_DESA_8822B << BIT_SHIFT_HI2Q_TXBD_DESA_8822B) -+#define BIT_CLEAR_HI2Q_TXBD_DESA_8822B(x) ((x) & (~BITS_HI2Q_TXBD_DESA_8822B)) -+#define BIT_GET_HI2Q_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_TXBD_DESA_8822B) & \ -+ BIT_MASK_HI2Q_TXBD_DESA_8822B) -+#define BIT_SET_HI2Q_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_HI2Q_TXBD_DESA_8822B(x) | BIT_HI2Q_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_HI3Q_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_HI3Q_TXBD_DESA_8822B 0 -+#define BIT_MASK_HI3Q_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_HI3Q_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_HI3Q_TXBD_DESA_8822B) \ -+ << BIT_SHIFT_HI3Q_TXBD_DESA_8822B) -+#define BITS_HI3Q_TXBD_DESA_8822B \ -+ (BIT_MASK_HI3Q_TXBD_DESA_8822B << BIT_SHIFT_HI3Q_TXBD_DESA_8822B) -+#define BIT_CLEAR_HI3Q_TXBD_DESA_8822B(x) ((x) & (~BITS_HI3Q_TXBD_DESA_8822B)) -+#define BIT_GET_HI3Q_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_TXBD_DESA_8822B) & \ -+ BIT_MASK_HI3Q_TXBD_DESA_8822B) -+#define BIT_SET_HI3Q_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_HI3Q_TXBD_DESA_8822B(x) | BIT_HI3Q_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_HI4Q_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_HI4Q_TXBD_DESA_8822B 0 -+#define BIT_MASK_HI4Q_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_HI4Q_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_HI4Q_TXBD_DESA_8822B) \ -+ << BIT_SHIFT_HI4Q_TXBD_DESA_8822B) -+#define BITS_HI4Q_TXBD_DESA_8822B \ -+ (BIT_MASK_HI4Q_TXBD_DESA_8822B << BIT_SHIFT_HI4Q_TXBD_DESA_8822B) -+#define BIT_CLEAR_HI4Q_TXBD_DESA_8822B(x) ((x) & (~BITS_HI4Q_TXBD_DESA_8822B)) -+#define BIT_GET_HI4Q_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_TXBD_DESA_8822B) & \ -+ BIT_MASK_HI4Q_TXBD_DESA_8822B) -+#define BIT_SET_HI4Q_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_HI4Q_TXBD_DESA_8822B(x) | BIT_HI4Q_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_HI5Q_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_HI5Q_TXBD_DESA_8822B 0 -+#define BIT_MASK_HI5Q_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_HI5Q_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_HI5Q_TXBD_DESA_8822B) \ -+ << BIT_SHIFT_HI5Q_TXBD_DESA_8822B) -+#define BITS_HI5Q_TXBD_DESA_8822B \ -+ (BIT_MASK_HI5Q_TXBD_DESA_8822B << BIT_SHIFT_HI5Q_TXBD_DESA_8822B) -+#define BIT_CLEAR_HI5Q_TXBD_DESA_8822B(x) ((x) & (~BITS_HI5Q_TXBD_DESA_8822B)) -+#define BIT_GET_HI5Q_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_TXBD_DESA_8822B) & \ -+ BIT_MASK_HI5Q_TXBD_DESA_8822B) -+#define BIT_SET_HI5Q_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_HI5Q_TXBD_DESA_8822B(x) | BIT_HI5Q_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_HI6Q_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_HI6Q_TXBD_DESA_8822B 0 -+#define BIT_MASK_HI6Q_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_HI6Q_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_HI6Q_TXBD_DESA_8822B) \ -+ << BIT_SHIFT_HI6Q_TXBD_DESA_8822B) -+#define BITS_HI6Q_TXBD_DESA_8822B \ -+ (BIT_MASK_HI6Q_TXBD_DESA_8822B << BIT_SHIFT_HI6Q_TXBD_DESA_8822B) -+#define BIT_CLEAR_HI6Q_TXBD_DESA_8822B(x) ((x) & (~BITS_HI6Q_TXBD_DESA_8822B)) -+#define BIT_GET_HI6Q_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_TXBD_DESA_8822B) & \ -+ BIT_MASK_HI6Q_TXBD_DESA_8822B) -+#define BIT_SET_HI6Q_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_HI6Q_TXBD_DESA_8822B(x) | BIT_HI6Q_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_HI7Q_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_HI7Q_TXBD_DESA_8822B 0 -+#define BIT_MASK_HI7Q_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_HI7Q_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_HI7Q_TXBD_DESA_8822B) \ -+ << BIT_SHIFT_HI7Q_TXBD_DESA_8822B) -+#define BITS_HI7Q_TXBD_DESA_8822B \ -+ (BIT_MASK_HI7Q_TXBD_DESA_8822B << BIT_SHIFT_HI7Q_TXBD_DESA_8822B) -+#define BIT_CLEAR_HI7Q_TXBD_DESA_8822B(x) ((x) & (~BITS_HI7Q_TXBD_DESA_8822B)) -+#define BIT_GET_HI7Q_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_TXBD_DESA_8822B) & \ -+ BIT_MASK_HI7Q_TXBD_DESA_8822B) -+#define BIT_SET_HI7Q_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_HI7Q_TXBD_DESA_8822B(x) | BIT_HI7Q_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_MGQ_TXBD_NUM_8822B */ -+#define BIT_PCIE_MGQ_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_MGQ_DESC_MODE_8822B 12 -+#define BIT_MASK_MGQ_DESC_MODE_8822B 0x3 -+#define BIT_MGQ_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_MODE_8822B) << BIT_SHIFT_MGQ_DESC_MODE_8822B) -+#define BITS_MGQ_DESC_MODE_8822B \ -+ (BIT_MASK_MGQ_DESC_MODE_8822B << BIT_SHIFT_MGQ_DESC_MODE_8822B) -+#define BIT_CLEAR_MGQ_DESC_MODE_8822B(x) ((x) & (~BITS_MGQ_DESC_MODE_8822B)) -+#define BIT_GET_MGQ_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_MODE_8822B) & BIT_MASK_MGQ_DESC_MODE_8822B) -+#define BIT_SET_MGQ_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_MODE_8822B(x) | BIT_MGQ_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_MGQ_DESC_NUM_8822B 0 -+#define BIT_MASK_MGQ_DESC_NUM_8822B 0xfff -+#define BIT_MGQ_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_NUM_8822B) << BIT_SHIFT_MGQ_DESC_NUM_8822B) -+#define BITS_MGQ_DESC_NUM_8822B \ -+ (BIT_MASK_MGQ_DESC_NUM_8822B << BIT_SHIFT_MGQ_DESC_NUM_8822B) -+#define BIT_CLEAR_MGQ_DESC_NUM_8822B(x) ((x) & (~BITS_MGQ_DESC_NUM_8822B)) -+#define BIT_GET_MGQ_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_NUM_8822B) & BIT_MASK_MGQ_DESC_NUM_8822B) -+#define BIT_SET_MGQ_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_NUM_8822B(x) | BIT_MGQ_DESC_NUM_8822B(v)) -+ -+/* 2 REG_RX_RXBD_NUM_8822B */ -+#define BIT_SYS_32_64_8822B BIT(15) -+ -+#define BIT_SHIFT_BCNQ_DESC_MODE_8822B 13 -+#define BIT_MASK_BCNQ_DESC_MODE_8822B 0x3 -+#define BIT_BCNQ_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_BCNQ_DESC_MODE_8822B) \ -+ << BIT_SHIFT_BCNQ_DESC_MODE_8822B) -+#define BITS_BCNQ_DESC_MODE_8822B \ -+ (BIT_MASK_BCNQ_DESC_MODE_8822B << BIT_SHIFT_BCNQ_DESC_MODE_8822B) -+#define BIT_CLEAR_BCNQ_DESC_MODE_8822B(x) ((x) & (~BITS_BCNQ_DESC_MODE_8822B)) -+#define BIT_GET_BCNQ_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_DESC_MODE_8822B) & \ -+ BIT_MASK_BCNQ_DESC_MODE_8822B) -+#define BIT_SET_BCNQ_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_BCNQ_DESC_MODE_8822B(x) | BIT_BCNQ_DESC_MODE_8822B(v)) -+ -+#define BIT_PCIE_BCNQ_FLAG_8822B BIT(12) -+ -+#define BIT_SHIFT_RXQ_DESC_NUM_8822B 0 -+#define BIT_MASK_RXQ_DESC_NUM_8822B 0xfff -+#define BIT_RXQ_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_RXQ_DESC_NUM_8822B) << BIT_SHIFT_RXQ_DESC_NUM_8822B) -+#define BITS_RXQ_DESC_NUM_8822B \ -+ (BIT_MASK_RXQ_DESC_NUM_8822B << BIT_SHIFT_RXQ_DESC_NUM_8822B) -+#define BIT_CLEAR_RXQ_DESC_NUM_8822B(x) ((x) & (~BITS_RXQ_DESC_NUM_8822B)) -+#define BIT_GET_RXQ_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXQ_DESC_NUM_8822B) & BIT_MASK_RXQ_DESC_NUM_8822B) -+#define BIT_SET_RXQ_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_RXQ_DESC_NUM_8822B(x) | BIT_RXQ_DESC_NUM_8822B(v)) -+ -+/* 2 REG_VOQ_TXBD_NUM_8822B */ -+#define BIT_PCIE_VOQ_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_VOQ_DESC_MODE_8822B 12 -+#define BIT_MASK_VOQ_DESC_MODE_8822B 0x3 -+#define BIT_VOQ_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_MODE_8822B) << BIT_SHIFT_VOQ_DESC_MODE_8822B) -+#define BITS_VOQ_DESC_MODE_8822B \ -+ (BIT_MASK_VOQ_DESC_MODE_8822B << BIT_SHIFT_VOQ_DESC_MODE_8822B) -+#define BIT_CLEAR_VOQ_DESC_MODE_8822B(x) ((x) & (~BITS_VOQ_DESC_MODE_8822B)) -+#define BIT_GET_VOQ_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_MODE_8822B) & BIT_MASK_VOQ_DESC_MODE_8822B) -+#define BIT_SET_VOQ_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_MODE_8822B(x) | BIT_VOQ_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_VOQ_DESC_NUM_8822B 0 -+#define BIT_MASK_VOQ_DESC_NUM_8822B 0xfff -+#define BIT_VOQ_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_NUM_8822B) << BIT_SHIFT_VOQ_DESC_NUM_8822B) -+#define BITS_VOQ_DESC_NUM_8822B \ -+ (BIT_MASK_VOQ_DESC_NUM_8822B << BIT_SHIFT_VOQ_DESC_NUM_8822B) -+#define BIT_CLEAR_VOQ_DESC_NUM_8822B(x) ((x) & (~BITS_VOQ_DESC_NUM_8822B)) -+#define BIT_GET_VOQ_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_NUM_8822B) & BIT_MASK_VOQ_DESC_NUM_8822B) -+#define BIT_SET_VOQ_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_NUM_8822B(x) | BIT_VOQ_DESC_NUM_8822B(v)) -+ -+/* 2 REG_VIQ_TXBD_NUM_8822B */ -+#define BIT_PCIE_VIQ_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_VIQ_DESC_MODE_8822B 12 -+#define BIT_MASK_VIQ_DESC_MODE_8822B 0x3 -+#define BIT_VIQ_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_MODE_8822B) << BIT_SHIFT_VIQ_DESC_MODE_8822B) -+#define BITS_VIQ_DESC_MODE_8822B \ -+ (BIT_MASK_VIQ_DESC_MODE_8822B << BIT_SHIFT_VIQ_DESC_MODE_8822B) -+#define BIT_CLEAR_VIQ_DESC_MODE_8822B(x) ((x) & (~BITS_VIQ_DESC_MODE_8822B)) -+#define BIT_GET_VIQ_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_MODE_8822B) & BIT_MASK_VIQ_DESC_MODE_8822B) -+#define BIT_SET_VIQ_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_MODE_8822B(x) | BIT_VIQ_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_VIQ_DESC_NUM_8822B 0 -+#define BIT_MASK_VIQ_DESC_NUM_8822B 0xfff -+#define BIT_VIQ_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_NUM_8822B) << BIT_SHIFT_VIQ_DESC_NUM_8822B) -+#define BITS_VIQ_DESC_NUM_8822B \ -+ (BIT_MASK_VIQ_DESC_NUM_8822B << BIT_SHIFT_VIQ_DESC_NUM_8822B) -+#define BIT_CLEAR_VIQ_DESC_NUM_8822B(x) ((x) & (~BITS_VIQ_DESC_NUM_8822B)) -+#define BIT_GET_VIQ_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_NUM_8822B) & BIT_MASK_VIQ_DESC_NUM_8822B) -+#define BIT_SET_VIQ_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_NUM_8822B(x) | BIT_VIQ_DESC_NUM_8822B(v)) -+ -+/* 2 REG_BEQ_TXBD_NUM_8822B */ -+#define BIT_PCIE_BEQ_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_BEQ_DESC_MODE_8822B 12 -+#define BIT_MASK_BEQ_DESC_MODE_8822B 0x3 -+#define BIT_BEQ_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_MODE_8822B) << BIT_SHIFT_BEQ_DESC_MODE_8822B) -+#define BITS_BEQ_DESC_MODE_8822B \ -+ (BIT_MASK_BEQ_DESC_MODE_8822B << BIT_SHIFT_BEQ_DESC_MODE_8822B) -+#define BIT_CLEAR_BEQ_DESC_MODE_8822B(x) ((x) & (~BITS_BEQ_DESC_MODE_8822B)) -+#define BIT_GET_BEQ_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_MODE_8822B) & BIT_MASK_BEQ_DESC_MODE_8822B) -+#define BIT_SET_BEQ_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_MODE_8822B(x) | BIT_BEQ_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_BEQ_DESC_NUM_8822B 0 -+#define BIT_MASK_BEQ_DESC_NUM_8822B 0xfff -+#define BIT_BEQ_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_NUM_8822B) << BIT_SHIFT_BEQ_DESC_NUM_8822B) -+#define BITS_BEQ_DESC_NUM_8822B \ -+ (BIT_MASK_BEQ_DESC_NUM_8822B << BIT_SHIFT_BEQ_DESC_NUM_8822B) -+#define BIT_CLEAR_BEQ_DESC_NUM_8822B(x) ((x) & (~BITS_BEQ_DESC_NUM_8822B)) -+#define BIT_GET_BEQ_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_NUM_8822B) & BIT_MASK_BEQ_DESC_NUM_8822B) -+#define BIT_SET_BEQ_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_NUM_8822B(x) | BIT_BEQ_DESC_NUM_8822B(v)) -+ -+/* 2 REG_BKQ_TXBD_NUM_8822B */ -+#define BIT_PCIE_BKQ_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_BKQ_DESC_MODE_8822B 12 -+#define BIT_MASK_BKQ_DESC_MODE_8822B 0x3 -+#define BIT_BKQ_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_MODE_8822B) << BIT_SHIFT_BKQ_DESC_MODE_8822B) -+#define BITS_BKQ_DESC_MODE_8822B \ -+ (BIT_MASK_BKQ_DESC_MODE_8822B << BIT_SHIFT_BKQ_DESC_MODE_8822B) -+#define BIT_CLEAR_BKQ_DESC_MODE_8822B(x) ((x) & (~BITS_BKQ_DESC_MODE_8822B)) -+#define BIT_GET_BKQ_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_MODE_8822B) & BIT_MASK_BKQ_DESC_MODE_8822B) -+#define BIT_SET_BKQ_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_MODE_8822B(x) | BIT_BKQ_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_BKQ_DESC_NUM_8822B 0 -+#define BIT_MASK_BKQ_DESC_NUM_8822B 0xfff -+#define BIT_BKQ_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_NUM_8822B) << BIT_SHIFT_BKQ_DESC_NUM_8822B) -+#define BITS_BKQ_DESC_NUM_8822B \ -+ (BIT_MASK_BKQ_DESC_NUM_8822B << BIT_SHIFT_BKQ_DESC_NUM_8822B) -+#define BIT_CLEAR_BKQ_DESC_NUM_8822B(x) ((x) & (~BITS_BKQ_DESC_NUM_8822B)) -+#define BIT_GET_BKQ_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_NUM_8822B) & BIT_MASK_BKQ_DESC_NUM_8822B) -+#define BIT_SET_BKQ_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_NUM_8822B(x) | BIT_BKQ_DESC_NUM_8822B(v)) -+ -+/* 2 REG_HI0Q_TXBD_NUM_8822B */ -+#define BIT_HI0Q_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_HI0Q_DESC_MODE_8822B 12 -+#define BIT_MASK_HI0Q_DESC_MODE_8822B 0x3 -+#define BIT_HI0Q_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_MODE_8822B) \ -+ << BIT_SHIFT_HI0Q_DESC_MODE_8822B) -+#define BITS_HI0Q_DESC_MODE_8822B \ -+ (BIT_MASK_HI0Q_DESC_MODE_8822B << BIT_SHIFT_HI0Q_DESC_MODE_8822B) -+#define BIT_CLEAR_HI0Q_DESC_MODE_8822B(x) ((x) & (~BITS_HI0Q_DESC_MODE_8822B)) -+#define BIT_GET_HI0Q_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_MODE_8822B) & \ -+ BIT_MASK_HI0Q_DESC_MODE_8822B) -+#define BIT_SET_HI0Q_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_MODE_8822B(x) | BIT_HI0Q_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_HI0Q_DESC_NUM_8822B 0 -+#define BIT_MASK_HI0Q_DESC_NUM_8822B 0xfff -+#define BIT_HI0Q_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_NUM_8822B) << BIT_SHIFT_HI0Q_DESC_NUM_8822B) -+#define BITS_HI0Q_DESC_NUM_8822B \ -+ (BIT_MASK_HI0Q_DESC_NUM_8822B << BIT_SHIFT_HI0Q_DESC_NUM_8822B) -+#define BIT_CLEAR_HI0Q_DESC_NUM_8822B(x) ((x) & (~BITS_HI0Q_DESC_NUM_8822B)) -+#define BIT_GET_HI0Q_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_NUM_8822B) & BIT_MASK_HI0Q_DESC_NUM_8822B) -+#define BIT_SET_HI0Q_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_NUM_8822B(x) | BIT_HI0Q_DESC_NUM_8822B(v)) -+ -+/* 2 REG_HI1Q_TXBD_NUM_8822B */ -+#define BIT_HI1Q_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_HI1Q_DESC_MODE_8822B 12 -+#define BIT_MASK_HI1Q_DESC_MODE_8822B 0x3 -+#define BIT_HI1Q_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_MODE_8822B) \ -+ << BIT_SHIFT_HI1Q_DESC_MODE_8822B) -+#define BITS_HI1Q_DESC_MODE_8822B \ -+ (BIT_MASK_HI1Q_DESC_MODE_8822B << BIT_SHIFT_HI1Q_DESC_MODE_8822B) -+#define BIT_CLEAR_HI1Q_DESC_MODE_8822B(x) ((x) & (~BITS_HI1Q_DESC_MODE_8822B)) -+#define BIT_GET_HI1Q_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_MODE_8822B) & \ -+ BIT_MASK_HI1Q_DESC_MODE_8822B) -+#define BIT_SET_HI1Q_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_MODE_8822B(x) | BIT_HI1Q_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_HI1Q_DESC_NUM_8822B 0 -+#define BIT_MASK_HI1Q_DESC_NUM_8822B 0xfff -+#define BIT_HI1Q_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_NUM_8822B) << BIT_SHIFT_HI1Q_DESC_NUM_8822B) -+#define BITS_HI1Q_DESC_NUM_8822B \ -+ (BIT_MASK_HI1Q_DESC_NUM_8822B << BIT_SHIFT_HI1Q_DESC_NUM_8822B) -+#define BIT_CLEAR_HI1Q_DESC_NUM_8822B(x) ((x) & (~BITS_HI1Q_DESC_NUM_8822B)) -+#define BIT_GET_HI1Q_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_NUM_8822B) & BIT_MASK_HI1Q_DESC_NUM_8822B) -+#define BIT_SET_HI1Q_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_NUM_8822B(x) | BIT_HI1Q_DESC_NUM_8822B(v)) -+ -+/* 2 REG_HI2Q_TXBD_NUM_8822B */ -+#define BIT_HI2Q_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_HI2Q_DESC_MODE_8822B 12 -+#define BIT_MASK_HI2Q_DESC_MODE_8822B 0x3 -+#define BIT_HI2Q_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_MODE_8822B) \ -+ << BIT_SHIFT_HI2Q_DESC_MODE_8822B) -+#define BITS_HI2Q_DESC_MODE_8822B \ -+ (BIT_MASK_HI2Q_DESC_MODE_8822B << BIT_SHIFT_HI2Q_DESC_MODE_8822B) -+#define BIT_CLEAR_HI2Q_DESC_MODE_8822B(x) ((x) & (~BITS_HI2Q_DESC_MODE_8822B)) -+#define BIT_GET_HI2Q_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_MODE_8822B) & \ -+ BIT_MASK_HI2Q_DESC_MODE_8822B) -+#define BIT_SET_HI2Q_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_MODE_8822B(x) | BIT_HI2Q_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_HI2Q_DESC_NUM_8822B 0 -+#define BIT_MASK_HI2Q_DESC_NUM_8822B 0xfff -+#define BIT_HI2Q_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_NUM_8822B) << BIT_SHIFT_HI2Q_DESC_NUM_8822B) -+#define BITS_HI2Q_DESC_NUM_8822B \ -+ (BIT_MASK_HI2Q_DESC_NUM_8822B << BIT_SHIFT_HI2Q_DESC_NUM_8822B) -+#define BIT_CLEAR_HI2Q_DESC_NUM_8822B(x) ((x) & (~BITS_HI2Q_DESC_NUM_8822B)) -+#define BIT_GET_HI2Q_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_NUM_8822B) & BIT_MASK_HI2Q_DESC_NUM_8822B) -+#define BIT_SET_HI2Q_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_NUM_8822B(x) | BIT_HI2Q_DESC_NUM_8822B(v)) -+ -+/* 2 REG_HI3Q_TXBD_NUM_8822B */ -+#define BIT_HI3Q_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_HI3Q_DESC_MODE_8822B 12 -+#define BIT_MASK_HI3Q_DESC_MODE_8822B 0x3 -+#define BIT_HI3Q_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_MODE_8822B) \ -+ << BIT_SHIFT_HI3Q_DESC_MODE_8822B) -+#define BITS_HI3Q_DESC_MODE_8822B \ -+ (BIT_MASK_HI3Q_DESC_MODE_8822B << BIT_SHIFT_HI3Q_DESC_MODE_8822B) -+#define BIT_CLEAR_HI3Q_DESC_MODE_8822B(x) ((x) & (~BITS_HI3Q_DESC_MODE_8822B)) -+#define BIT_GET_HI3Q_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_MODE_8822B) & \ -+ BIT_MASK_HI3Q_DESC_MODE_8822B) -+#define BIT_SET_HI3Q_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_MODE_8822B(x) | BIT_HI3Q_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_HI3Q_DESC_NUM_8822B 0 -+#define BIT_MASK_HI3Q_DESC_NUM_8822B 0xfff -+#define BIT_HI3Q_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_NUM_8822B) << BIT_SHIFT_HI3Q_DESC_NUM_8822B) -+#define BITS_HI3Q_DESC_NUM_8822B \ -+ (BIT_MASK_HI3Q_DESC_NUM_8822B << BIT_SHIFT_HI3Q_DESC_NUM_8822B) -+#define BIT_CLEAR_HI3Q_DESC_NUM_8822B(x) ((x) & (~BITS_HI3Q_DESC_NUM_8822B)) -+#define BIT_GET_HI3Q_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_NUM_8822B) & BIT_MASK_HI3Q_DESC_NUM_8822B) -+#define BIT_SET_HI3Q_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_NUM_8822B(x) | BIT_HI3Q_DESC_NUM_8822B(v)) -+ -+/* 2 REG_HI4Q_TXBD_NUM_8822B */ -+#define BIT_HI4Q_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_HI4Q_DESC_MODE_8822B 12 -+#define BIT_MASK_HI4Q_DESC_MODE_8822B 0x3 -+#define BIT_HI4Q_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_MODE_8822B) \ -+ << BIT_SHIFT_HI4Q_DESC_MODE_8822B) -+#define BITS_HI4Q_DESC_MODE_8822B \ -+ (BIT_MASK_HI4Q_DESC_MODE_8822B << BIT_SHIFT_HI4Q_DESC_MODE_8822B) -+#define BIT_CLEAR_HI4Q_DESC_MODE_8822B(x) ((x) & (~BITS_HI4Q_DESC_MODE_8822B)) -+#define BIT_GET_HI4Q_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_MODE_8822B) & \ -+ BIT_MASK_HI4Q_DESC_MODE_8822B) -+#define BIT_SET_HI4Q_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_MODE_8822B(x) | BIT_HI4Q_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_HI4Q_DESC_NUM_8822B 0 -+#define BIT_MASK_HI4Q_DESC_NUM_8822B 0xfff -+#define BIT_HI4Q_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_NUM_8822B) << BIT_SHIFT_HI4Q_DESC_NUM_8822B) -+#define BITS_HI4Q_DESC_NUM_8822B \ -+ (BIT_MASK_HI4Q_DESC_NUM_8822B << BIT_SHIFT_HI4Q_DESC_NUM_8822B) -+#define BIT_CLEAR_HI4Q_DESC_NUM_8822B(x) ((x) & (~BITS_HI4Q_DESC_NUM_8822B)) -+#define BIT_GET_HI4Q_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_NUM_8822B) & BIT_MASK_HI4Q_DESC_NUM_8822B) -+#define BIT_SET_HI4Q_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_NUM_8822B(x) | BIT_HI4Q_DESC_NUM_8822B(v)) -+ -+/* 2 REG_HI5Q_TXBD_NUM_8822B */ -+#define BIT_HI5Q_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_HI5Q_DESC_MODE_8822B 12 -+#define BIT_MASK_HI5Q_DESC_MODE_8822B 0x3 -+#define BIT_HI5Q_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_MODE_8822B) \ -+ << BIT_SHIFT_HI5Q_DESC_MODE_8822B) -+#define BITS_HI5Q_DESC_MODE_8822B \ -+ (BIT_MASK_HI5Q_DESC_MODE_8822B << BIT_SHIFT_HI5Q_DESC_MODE_8822B) -+#define BIT_CLEAR_HI5Q_DESC_MODE_8822B(x) ((x) & (~BITS_HI5Q_DESC_MODE_8822B)) -+#define BIT_GET_HI5Q_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_MODE_8822B) & \ -+ BIT_MASK_HI5Q_DESC_MODE_8822B) -+#define BIT_SET_HI5Q_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_MODE_8822B(x) | BIT_HI5Q_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_HI5Q_DESC_NUM_8822B 0 -+#define BIT_MASK_HI5Q_DESC_NUM_8822B 0xfff -+#define BIT_HI5Q_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_NUM_8822B) << BIT_SHIFT_HI5Q_DESC_NUM_8822B) -+#define BITS_HI5Q_DESC_NUM_8822B \ -+ (BIT_MASK_HI5Q_DESC_NUM_8822B << BIT_SHIFT_HI5Q_DESC_NUM_8822B) -+#define BIT_CLEAR_HI5Q_DESC_NUM_8822B(x) ((x) & (~BITS_HI5Q_DESC_NUM_8822B)) -+#define BIT_GET_HI5Q_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_NUM_8822B) & BIT_MASK_HI5Q_DESC_NUM_8822B) -+#define BIT_SET_HI5Q_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_NUM_8822B(x) | BIT_HI5Q_DESC_NUM_8822B(v)) -+ -+/* 2 REG_HI6Q_TXBD_NUM_8822B */ -+#define BIT_HI6Q_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_HI6Q_DESC_MODE_8822B 12 -+#define BIT_MASK_HI6Q_DESC_MODE_8822B 0x3 -+#define BIT_HI6Q_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_MODE_8822B) \ -+ << BIT_SHIFT_HI6Q_DESC_MODE_8822B) -+#define BITS_HI6Q_DESC_MODE_8822B \ -+ (BIT_MASK_HI6Q_DESC_MODE_8822B << BIT_SHIFT_HI6Q_DESC_MODE_8822B) -+#define BIT_CLEAR_HI6Q_DESC_MODE_8822B(x) ((x) & (~BITS_HI6Q_DESC_MODE_8822B)) -+#define BIT_GET_HI6Q_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_MODE_8822B) & \ -+ BIT_MASK_HI6Q_DESC_MODE_8822B) -+#define BIT_SET_HI6Q_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_MODE_8822B(x) | BIT_HI6Q_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_HI6Q_DESC_NUM_8822B 0 -+#define BIT_MASK_HI6Q_DESC_NUM_8822B 0xfff -+#define BIT_HI6Q_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_NUM_8822B) << BIT_SHIFT_HI6Q_DESC_NUM_8822B) -+#define BITS_HI6Q_DESC_NUM_8822B \ -+ (BIT_MASK_HI6Q_DESC_NUM_8822B << BIT_SHIFT_HI6Q_DESC_NUM_8822B) -+#define BIT_CLEAR_HI6Q_DESC_NUM_8822B(x) ((x) & (~BITS_HI6Q_DESC_NUM_8822B)) -+#define BIT_GET_HI6Q_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_NUM_8822B) & BIT_MASK_HI6Q_DESC_NUM_8822B) -+#define BIT_SET_HI6Q_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_NUM_8822B(x) | BIT_HI6Q_DESC_NUM_8822B(v)) -+ -+/* 2 REG_HI7Q_TXBD_NUM_8822B */ -+#define BIT_HI7Q_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_HI7Q_DESC_MODE_8822B 12 -+#define BIT_MASK_HI7Q_DESC_MODE_8822B 0x3 -+#define BIT_HI7Q_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_MODE_8822B) \ -+ << BIT_SHIFT_HI7Q_DESC_MODE_8822B) -+#define BITS_HI7Q_DESC_MODE_8822B \ -+ (BIT_MASK_HI7Q_DESC_MODE_8822B << BIT_SHIFT_HI7Q_DESC_MODE_8822B) -+#define BIT_CLEAR_HI7Q_DESC_MODE_8822B(x) ((x) & (~BITS_HI7Q_DESC_MODE_8822B)) -+#define BIT_GET_HI7Q_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_MODE_8822B) & \ -+ BIT_MASK_HI7Q_DESC_MODE_8822B) -+#define BIT_SET_HI7Q_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_MODE_8822B(x) | BIT_HI7Q_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_HI7Q_DESC_NUM_8822B 0 -+#define BIT_MASK_HI7Q_DESC_NUM_8822B 0xfff -+#define BIT_HI7Q_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_NUM_8822B) << BIT_SHIFT_HI7Q_DESC_NUM_8822B) -+#define BITS_HI7Q_DESC_NUM_8822B \ -+ (BIT_MASK_HI7Q_DESC_NUM_8822B << BIT_SHIFT_HI7Q_DESC_NUM_8822B) -+#define BIT_CLEAR_HI7Q_DESC_NUM_8822B(x) ((x) & (~BITS_HI7Q_DESC_NUM_8822B)) -+#define BIT_GET_HI7Q_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_NUM_8822B) & BIT_MASK_HI7Q_DESC_NUM_8822B) -+#define BIT_SET_HI7Q_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_NUM_8822B(x) | BIT_HI7Q_DESC_NUM_8822B(v)) -+ -+/* 2 REG_TSFTIMER_HCI_8822B */ -+ -+#define BIT_SHIFT_TSFT2_HCI_8822B 16 -+#define BIT_MASK_TSFT2_HCI_8822B 0xffff -+#define BIT_TSFT2_HCI_8822B(x) \ -+ (((x) & BIT_MASK_TSFT2_HCI_8822B) << BIT_SHIFT_TSFT2_HCI_8822B) -+#define BITS_TSFT2_HCI_8822B \ -+ (BIT_MASK_TSFT2_HCI_8822B << BIT_SHIFT_TSFT2_HCI_8822B) -+#define BIT_CLEAR_TSFT2_HCI_8822B(x) ((x) & (~BITS_TSFT2_HCI_8822B)) -+#define BIT_GET_TSFT2_HCI_8822B(x) \ -+ (((x) >> BIT_SHIFT_TSFT2_HCI_8822B) & BIT_MASK_TSFT2_HCI_8822B) -+#define BIT_SET_TSFT2_HCI_8822B(x, v) \ -+ (BIT_CLEAR_TSFT2_HCI_8822B(x) | BIT_TSFT2_HCI_8822B(v)) -+ -+#define BIT_SHIFT_TSFT1_HCI_8822B 0 -+#define BIT_MASK_TSFT1_HCI_8822B 0xffff -+#define BIT_TSFT1_HCI_8822B(x) \ -+ (((x) & BIT_MASK_TSFT1_HCI_8822B) << BIT_SHIFT_TSFT1_HCI_8822B) -+#define BITS_TSFT1_HCI_8822B \ -+ (BIT_MASK_TSFT1_HCI_8822B << BIT_SHIFT_TSFT1_HCI_8822B) -+#define BIT_CLEAR_TSFT1_HCI_8822B(x) ((x) & (~BITS_TSFT1_HCI_8822B)) -+#define BIT_GET_TSFT1_HCI_8822B(x) \ -+ (((x) >> BIT_SHIFT_TSFT1_HCI_8822B) & BIT_MASK_TSFT1_HCI_8822B) -+#define BIT_SET_TSFT1_HCI_8822B(x, v) \ -+ (BIT_CLEAR_TSFT1_HCI_8822B(x) | BIT_TSFT1_HCI_8822B(v)) -+ -+/* 2 REG_BD_RWPTR_CLR_8822B */ -+#define BIT_CLR_HI7Q_HW_IDX_8822B BIT(29) -+#define BIT_CLR_HI6Q_HW_IDX_8822B BIT(28) -+#define BIT_CLR_HI5Q_HW_IDX_8822B BIT(27) -+#define BIT_CLR_HI4Q_HW_IDX_8822B BIT(26) -+#define BIT_CLR_HI3Q_HW_IDX_8822B BIT(25) -+#define BIT_CLR_HI2Q_HW_IDX_8822B BIT(24) -+#define BIT_CLR_HI1Q_HW_IDX_8822B BIT(23) -+#define BIT_CLR_HI0Q_HW_IDX_8822B BIT(22) -+#define BIT_CLR_BKQ_HW_IDX_8822B BIT(21) -+#define BIT_CLR_BEQ_HW_IDX_8822B BIT(20) -+#define BIT_CLR_VIQ_HW_IDX_8822B BIT(19) -+#define BIT_CLR_VOQ_HW_IDX_8822B BIT(18) -+#define BIT_CLR_MGQ_HW_IDX_8822B BIT(17) -+#define BIT_CLR_RXQ_HW_IDX_8822B BIT(16) -+#define BIT_CLR_HI7Q_HOST_IDX_8822B BIT(13) -+#define BIT_CLR_HI6Q_HOST_IDX_8822B BIT(12) -+#define BIT_CLR_HI5Q_HOST_IDX_8822B BIT(11) -+#define BIT_CLR_HI4Q_HOST_IDX_8822B BIT(10) -+#define BIT_CLR_HI3Q_HOST_IDX_8822B BIT(9) -+#define BIT_CLR_HI2Q_HOST_IDX_8822B BIT(8) -+#define BIT_CLR_HI1Q_HOST_IDX_8822B BIT(7) -+#define BIT_CLR_HI0Q_HOST_IDX_8822B BIT(6) -+#define BIT_CLR_BKQ_HOST_IDX_8822B BIT(5) -+#define BIT_CLR_BEQ_HOST_IDX_8822B BIT(4) -+#define BIT_CLR_VIQ_HOST_IDX_8822B BIT(3) -+#define BIT_CLR_VOQ_HOST_IDX_8822B BIT(2) -+#define BIT_CLR_MGQ_HOST_IDX_8822B BIT(1) -+#define BIT_CLR_RXQ_HOST_IDX_8822B BIT(0) -+ -+/* 2 REG_VOQ_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_VOQ_HW_IDX_8822B 16 -+#define BIT_MASK_VOQ_HW_IDX_8822B 0xfff -+#define BIT_VOQ_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_VOQ_HW_IDX_8822B) << BIT_SHIFT_VOQ_HW_IDX_8822B) -+#define BITS_VOQ_HW_IDX_8822B \ -+ (BIT_MASK_VOQ_HW_IDX_8822B << BIT_SHIFT_VOQ_HW_IDX_8822B) -+#define BIT_CLEAR_VOQ_HW_IDX_8822B(x) ((x) & (~BITS_VOQ_HW_IDX_8822B)) -+#define BIT_GET_VOQ_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HW_IDX_8822B) & BIT_MASK_VOQ_HW_IDX_8822B) -+#define BIT_SET_VOQ_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_VOQ_HW_IDX_8822B(x) | BIT_VOQ_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_VOQ_HOST_IDX_8822B 0 -+#define BIT_MASK_VOQ_HOST_IDX_8822B 0xfff -+#define BIT_VOQ_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_VOQ_HOST_IDX_8822B) << BIT_SHIFT_VOQ_HOST_IDX_8822B) -+#define BITS_VOQ_HOST_IDX_8822B \ -+ (BIT_MASK_VOQ_HOST_IDX_8822B << BIT_SHIFT_VOQ_HOST_IDX_8822B) -+#define BIT_CLEAR_VOQ_HOST_IDX_8822B(x) ((x) & (~BITS_VOQ_HOST_IDX_8822B)) -+#define BIT_GET_VOQ_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HOST_IDX_8822B) & BIT_MASK_VOQ_HOST_IDX_8822B) -+#define BIT_SET_VOQ_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_VOQ_HOST_IDX_8822B(x) | BIT_VOQ_HOST_IDX_8822B(v)) -+ -+/* 2 REG_VIQ_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_VIQ_HW_IDX_8822B 16 -+#define BIT_MASK_VIQ_HW_IDX_8822B 0xfff -+#define BIT_VIQ_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_VIQ_HW_IDX_8822B) << BIT_SHIFT_VIQ_HW_IDX_8822B) -+#define BITS_VIQ_HW_IDX_8822B \ -+ (BIT_MASK_VIQ_HW_IDX_8822B << BIT_SHIFT_VIQ_HW_IDX_8822B) -+#define BIT_CLEAR_VIQ_HW_IDX_8822B(x) ((x) & (~BITS_VIQ_HW_IDX_8822B)) -+#define BIT_GET_VIQ_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HW_IDX_8822B) & BIT_MASK_VIQ_HW_IDX_8822B) -+#define BIT_SET_VIQ_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_VIQ_HW_IDX_8822B(x) | BIT_VIQ_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_VIQ_HOST_IDX_8822B 0 -+#define BIT_MASK_VIQ_HOST_IDX_8822B 0xfff -+#define BIT_VIQ_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_VIQ_HOST_IDX_8822B) << BIT_SHIFT_VIQ_HOST_IDX_8822B) -+#define BITS_VIQ_HOST_IDX_8822B \ -+ (BIT_MASK_VIQ_HOST_IDX_8822B << BIT_SHIFT_VIQ_HOST_IDX_8822B) -+#define BIT_CLEAR_VIQ_HOST_IDX_8822B(x) ((x) & (~BITS_VIQ_HOST_IDX_8822B)) -+#define BIT_GET_VIQ_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HOST_IDX_8822B) & BIT_MASK_VIQ_HOST_IDX_8822B) -+#define BIT_SET_VIQ_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_VIQ_HOST_IDX_8822B(x) | BIT_VIQ_HOST_IDX_8822B(v)) -+ -+/* 2 REG_BEQ_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_BEQ_HW_IDX_8822B 16 -+#define BIT_MASK_BEQ_HW_IDX_8822B 0xfff -+#define BIT_BEQ_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_BEQ_HW_IDX_8822B) << BIT_SHIFT_BEQ_HW_IDX_8822B) -+#define BITS_BEQ_HW_IDX_8822B \ -+ (BIT_MASK_BEQ_HW_IDX_8822B << BIT_SHIFT_BEQ_HW_IDX_8822B) -+#define BIT_CLEAR_BEQ_HW_IDX_8822B(x) ((x) & (~BITS_BEQ_HW_IDX_8822B)) -+#define BIT_GET_BEQ_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HW_IDX_8822B) & BIT_MASK_BEQ_HW_IDX_8822B) -+#define BIT_SET_BEQ_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_BEQ_HW_IDX_8822B(x) | BIT_BEQ_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_BEQ_HOST_IDX_8822B 0 -+#define BIT_MASK_BEQ_HOST_IDX_8822B 0xfff -+#define BIT_BEQ_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_BEQ_HOST_IDX_8822B) << BIT_SHIFT_BEQ_HOST_IDX_8822B) -+#define BITS_BEQ_HOST_IDX_8822B \ -+ (BIT_MASK_BEQ_HOST_IDX_8822B << BIT_SHIFT_BEQ_HOST_IDX_8822B) -+#define BIT_CLEAR_BEQ_HOST_IDX_8822B(x) ((x) & (~BITS_BEQ_HOST_IDX_8822B)) -+#define BIT_GET_BEQ_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HOST_IDX_8822B) & BIT_MASK_BEQ_HOST_IDX_8822B) -+#define BIT_SET_BEQ_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_BEQ_HOST_IDX_8822B(x) | BIT_BEQ_HOST_IDX_8822B(v)) -+ -+/* 2 REG_BKQ_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_BKQ_HW_IDX_8822B 16 -+#define BIT_MASK_BKQ_HW_IDX_8822B 0xfff -+#define BIT_BKQ_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_BKQ_HW_IDX_8822B) << BIT_SHIFT_BKQ_HW_IDX_8822B) -+#define BITS_BKQ_HW_IDX_8822B \ -+ (BIT_MASK_BKQ_HW_IDX_8822B << BIT_SHIFT_BKQ_HW_IDX_8822B) -+#define BIT_CLEAR_BKQ_HW_IDX_8822B(x) ((x) & (~BITS_BKQ_HW_IDX_8822B)) -+#define BIT_GET_BKQ_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HW_IDX_8822B) & BIT_MASK_BKQ_HW_IDX_8822B) -+#define BIT_SET_BKQ_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_BKQ_HW_IDX_8822B(x) | BIT_BKQ_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_BKQ_HOST_IDX_8822B 0 -+#define BIT_MASK_BKQ_HOST_IDX_8822B 0xfff -+#define BIT_BKQ_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_BKQ_HOST_IDX_8822B) << BIT_SHIFT_BKQ_HOST_IDX_8822B) -+#define BITS_BKQ_HOST_IDX_8822B \ -+ (BIT_MASK_BKQ_HOST_IDX_8822B << BIT_SHIFT_BKQ_HOST_IDX_8822B) -+#define BIT_CLEAR_BKQ_HOST_IDX_8822B(x) ((x) & (~BITS_BKQ_HOST_IDX_8822B)) -+#define BIT_GET_BKQ_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HOST_IDX_8822B) & BIT_MASK_BKQ_HOST_IDX_8822B) -+#define BIT_SET_BKQ_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_BKQ_HOST_IDX_8822B(x) | BIT_BKQ_HOST_IDX_8822B(v)) -+ -+/* 2 REG_MGQ_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_MGQ_HW_IDX_8822B 16 -+#define BIT_MASK_MGQ_HW_IDX_8822B 0xfff -+#define BIT_MGQ_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_MGQ_HW_IDX_8822B) << BIT_SHIFT_MGQ_HW_IDX_8822B) -+#define BITS_MGQ_HW_IDX_8822B \ -+ (BIT_MASK_MGQ_HW_IDX_8822B << BIT_SHIFT_MGQ_HW_IDX_8822B) -+#define BIT_CLEAR_MGQ_HW_IDX_8822B(x) ((x) & (~BITS_MGQ_HW_IDX_8822B)) -+#define BIT_GET_MGQ_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HW_IDX_8822B) & BIT_MASK_MGQ_HW_IDX_8822B) -+#define BIT_SET_MGQ_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_MGQ_HW_IDX_8822B(x) | BIT_MGQ_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_MGQ_HOST_IDX_8822B 0 -+#define BIT_MASK_MGQ_HOST_IDX_8822B 0xfff -+#define BIT_MGQ_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_MGQ_HOST_IDX_8822B) << BIT_SHIFT_MGQ_HOST_IDX_8822B) -+#define BITS_MGQ_HOST_IDX_8822B \ -+ (BIT_MASK_MGQ_HOST_IDX_8822B << BIT_SHIFT_MGQ_HOST_IDX_8822B) -+#define BIT_CLEAR_MGQ_HOST_IDX_8822B(x) ((x) & (~BITS_MGQ_HOST_IDX_8822B)) -+#define BIT_GET_MGQ_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HOST_IDX_8822B) & BIT_MASK_MGQ_HOST_IDX_8822B) -+#define BIT_SET_MGQ_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_MGQ_HOST_IDX_8822B(x) | BIT_MGQ_HOST_IDX_8822B(v)) -+ -+/* 2 REG_RXQ_RXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_RXQ_HW_IDX_8822B 16 -+#define BIT_MASK_RXQ_HW_IDX_8822B 0xfff -+#define BIT_RXQ_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_RXQ_HW_IDX_8822B) << BIT_SHIFT_RXQ_HW_IDX_8822B) -+#define BITS_RXQ_HW_IDX_8822B \ -+ (BIT_MASK_RXQ_HW_IDX_8822B << BIT_SHIFT_RXQ_HW_IDX_8822B) -+#define BIT_CLEAR_RXQ_HW_IDX_8822B(x) ((x) & (~BITS_RXQ_HW_IDX_8822B)) -+#define BIT_GET_RXQ_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HW_IDX_8822B) & BIT_MASK_RXQ_HW_IDX_8822B) -+#define BIT_SET_RXQ_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_RXQ_HW_IDX_8822B(x) | BIT_RXQ_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_RXQ_HOST_IDX_8822B 0 -+#define BIT_MASK_RXQ_HOST_IDX_8822B 0xfff -+#define BIT_RXQ_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_RXQ_HOST_IDX_8822B) << BIT_SHIFT_RXQ_HOST_IDX_8822B) -+#define BITS_RXQ_HOST_IDX_8822B \ -+ (BIT_MASK_RXQ_HOST_IDX_8822B << BIT_SHIFT_RXQ_HOST_IDX_8822B) -+#define BIT_CLEAR_RXQ_HOST_IDX_8822B(x) ((x) & (~BITS_RXQ_HOST_IDX_8822B)) -+#define BIT_GET_RXQ_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HOST_IDX_8822B) & BIT_MASK_RXQ_HOST_IDX_8822B) -+#define BIT_SET_RXQ_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_RXQ_HOST_IDX_8822B(x) | BIT_RXQ_HOST_IDX_8822B(v)) -+ -+/* 2 REG_HI0Q_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_HI0Q_HW_IDX_8822B 16 -+#define BIT_MASK_HI0Q_HW_IDX_8822B 0xfff -+#define BIT_HI0Q_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI0Q_HW_IDX_8822B) << BIT_SHIFT_HI0Q_HW_IDX_8822B) -+#define BITS_HI0Q_HW_IDX_8822B \ -+ (BIT_MASK_HI0Q_HW_IDX_8822B << BIT_SHIFT_HI0Q_HW_IDX_8822B) -+#define BIT_CLEAR_HI0Q_HW_IDX_8822B(x) ((x) & (~BITS_HI0Q_HW_IDX_8822B)) -+#define BIT_GET_HI0Q_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HW_IDX_8822B) & BIT_MASK_HI0Q_HW_IDX_8822B) -+#define BIT_SET_HI0Q_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI0Q_HW_IDX_8822B(x) | BIT_HI0Q_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_HI0Q_HOST_IDX_8822B 0 -+#define BIT_MASK_HI0Q_HOST_IDX_8822B 0xfff -+#define BIT_HI0Q_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI0Q_HOST_IDX_8822B) << BIT_SHIFT_HI0Q_HOST_IDX_8822B) -+#define BITS_HI0Q_HOST_IDX_8822B \ -+ (BIT_MASK_HI0Q_HOST_IDX_8822B << BIT_SHIFT_HI0Q_HOST_IDX_8822B) -+#define BIT_CLEAR_HI0Q_HOST_IDX_8822B(x) ((x) & (~BITS_HI0Q_HOST_IDX_8822B)) -+#define BIT_GET_HI0Q_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HOST_IDX_8822B) & BIT_MASK_HI0Q_HOST_IDX_8822B) -+#define BIT_SET_HI0Q_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI0Q_HOST_IDX_8822B(x) | BIT_HI0Q_HOST_IDX_8822B(v)) -+ -+/* 2 REG_HI1Q_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_HI1Q_HW_IDX_8822B 16 -+#define BIT_MASK_HI1Q_HW_IDX_8822B 0xfff -+#define BIT_HI1Q_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI1Q_HW_IDX_8822B) << BIT_SHIFT_HI1Q_HW_IDX_8822B) -+#define BITS_HI1Q_HW_IDX_8822B \ -+ (BIT_MASK_HI1Q_HW_IDX_8822B << BIT_SHIFT_HI1Q_HW_IDX_8822B) -+#define BIT_CLEAR_HI1Q_HW_IDX_8822B(x) ((x) & (~BITS_HI1Q_HW_IDX_8822B)) -+#define BIT_GET_HI1Q_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HW_IDX_8822B) & BIT_MASK_HI1Q_HW_IDX_8822B) -+#define BIT_SET_HI1Q_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI1Q_HW_IDX_8822B(x) | BIT_HI1Q_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_HI1Q_HOST_IDX_8822B 0 -+#define BIT_MASK_HI1Q_HOST_IDX_8822B 0xfff -+#define BIT_HI1Q_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI1Q_HOST_IDX_8822B) << BIT_SHIFT_HI1Q_HOST_IDX_8822B) -+#define BITS_HI1Q_HOST_IDX_8822B \ -+ (BIT_MASK_HI1Q_HOST_IDX_8822B << BIT_SHIFT_HI1Q_HOST_IDX_8822B) -+#define BIT_CLEAR_HI1Q_HOST_IDX_8822B(x) ((x) & (~BITS_HI1Q_HOST_IDX_8822B)) -+#define BIT_GET_HI1Q_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HOST_IDX_8822B) & BIT_MASK_HI1Q_HOST_IDX_8822B) -+#define BIT_SET_HI1Q_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI1Q_HOST_IDX_8822B(x) | BIT_HI1Q_HOST_IDX_8822B(v)) -+ -+/* 2 REG_HI2Q_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_HI2Q_HW_IDX_8822B 16 -+#define BIT_MASK_HI2Q_HW_IDX_8822B 0xfff -+#define BIT_HI2Q_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI2Q_HW_IDX_8822B) << BIT_SHIFT_HI2Q_HW_IDX_8822B) -+#define BITS_HI2Q_HW_IDX_8822B \ -+ (BIT_MASK_HI2Q_HW_IDX_8822B << BIT_SHIFT_HI2Q_HW_IDX_8822B) -+#define BIT_CLEAR_HI2Q_HW_IDX_8822B(x) ((x) & (~BITS_HI2Q_HW_IDX_8822B)) -+#define BIT_GET_HI2Q_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HW_IDX_8822B) & BIT_MASK_HI2Q_HW_IDX_8822B) -+#define BIT_SET_HI2Q_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI2Q_HW_IDX_8822B(x) | BIT_HI2Q_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_HI2Q_HOST_IDX_8822B 0 -+#define BIT_MASK_HI2Q_HOST_IDX_8822B 0xfff -+#define BIT_HI2Q_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI2Q_HOST_IDX_8822B) << BIT_SHIFT_HI2Q_HOST_IDX_8822B) -+#define BITS_HI2Q_HOST_IDX_8822B \ -+ (BIT_MASK_HI2Q_HOST_IDX_8822B << BIT_SHIFT_HI2Q_HOST_IDX_8822B) -+#define BIT_CLEAR_HI2Q_HOST_IDX_8822B(x) ((x) & (~BITS_HI2Q_HOST_IDX_8822B)) -+#define BIT_GET_HI2Q_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HOST_IDX_8822B) & BIT_MASK_HI2Q_HOST_IDX_8822B) -+#define BIT_SET_HI2Q_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI2Q_HOST_IDX_8822B(x) | BIT_HI2Q_HOST_IDX_8822B(v)) -+ -+/* 2 REG_HI3Q_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_HI3Q_HW_IDX_8822B 16 -+#define BIT_MASK_HI3Q_HW_IDX_8822B 0xfff -+#define BIT_HI3Q_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI3Q_HW_IDX_8822B) << BIT_SHIFT_HI3Q_HW_IDX_8822B) -+#define BITS_HI3Q_HW_IDX_8822B \ -+ (BIT_MASK_HI3Q_HW_IDX_8822B << BIT_SHIFT_HI3Q_HW_IDX_8822B) -+#define BIT_CLEAR_HI3Q_HW_IDX_8822B(x) ((x) & (~BITS_HI3Q_HW_IDX_8822B)) -+#define BIT_GET_HI3Q_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HW_IDX_8822B) & BIT_MASK_HI3Q_HW_IDX_8822B) -+#define BIT_SET_HI3Q_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI3Q_HW_IDX_8822B(x) | BIT_HI3Q_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_HI3Q_HOST_IDX_8822B 0 -+#define BIT_MASK_HI3Q_HOST_IDX_8822B 0xfff -+#define BIT_HI3Q_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI3Q_HOST_IDX_8822B) << BIT_SHIFT_HI3Q_HOST_IDX_8822B) -+#define BITS_HI3Q_HOST_IDX_8822B \ -+ (BIT_MASK_HI3Q_HOST_IDX_8822B << BIT_SHIFT_HI3Q_HOST_IDX_8822B) -+#define BIT_CLEAR_HI3Q_HOST_IDX_8822B(x) ((x) & (~BITS_HI3Q_HOST_IDX_8822B)) -+#define BIT_GET_HI3Q_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HOST_IDX_8822B) & BIT_MASK_HI3Q_HOST_IDX_8822B) -+#define BIT_SET_HI3Q_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI3Q_HOST_IDX_8822B(x) | BIT_HI3Q_HOST_IDX_8822B(v)) -+ -+/* 2 REG_HI4Q_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_HI4Q_HW_IDX_8822B 16 -+#define BIT_MASK_HI4Q_HW_IDX_8822B 0xfff -+#define BIT_HI4Q_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI4Q_HW_IDX_8822B) << BIT_SHIFT_HI4Q_HW_IDX_8822B) -+#define BITS_HI4Q_HW_IDX_8822B \ -+ (BIT_MASK_HI4Q_HW_IDX_8822B << BIT_SHIFT_HI4Q_HW_IDX_8822B) -+#define BIT_CLEAR_HI4Q_HW_IDX_8822B(x) ((x) & (~BITS_HI4Q_HW_IDX_8822B)) -+#define BIT_GET_HI4Q_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HW_IDX_8822B) & BIT_MASK_HI4Q_HW_IDX_8822B) -+#define BIT_SET_HI4Q_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI4Q_HW_IDX_8822B(x) | BIT_HI4Q_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_HI4Q_HOST_IDX_8822B 0 -+#define BIT_MASK_HI4Q_HOST_IDX_8822B 0xfff -+#define BIT_HI4Q_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI4Q_HOST_IDX_8822B) << BIT_SHIFT_HI4Q_HOST_IDX_8822B) -+#define BITS_HI4Q_HOST_IDX_8822B \ -+ (BIT_MASK_HI4Q_HOST_IDX_8822B << BIT_SHIFT_HI4Q_HOST_IDX_8822B) -+#define BIT_CLEAR_HI4Q_HOST_IDX_8822B(x) ((x) & (~BITS_HI4Q_HOST_IDX_8822B)) -+#define BIT_GET_HI4Q_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HOST_IDX_8822B) & BIT_MASK_HI4Q_HOST_IDX_8822B) -+#define BIT_SET_HI4Q_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI4Q_HOST_IDX_8822B(x) | BIT_HI4Q_HOST_IDX_8822B(v)) -+ -+/* 2 REG_HI5Q_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_HI5Q_HW_IDX_8822B 16 -+#define BIT_MASK_HI5Q_HW_IDX_8822B 0xfff -+#define BIT_HI5Q_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI5Q_HW_IDX_8822B) << BIT_SHIFT_HI5Q_HW_IDX_8822B) -+#define BITS_HI5Q_HW_IDX_8822B \ -+ (BIT_MASK_HI5Q_HW_IDX_8822B << BIT_SHIFT_HI5Q_HW_IDX_8822B) -+#define BIT_CLEAR_HI5Q_HW_IDX_8822B(x) ((x) & (~BITS_HI5Q_HW_IDX_8822B)) -+#define BIT_GET_HI5Q_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HW_IDX_8822B) & BIT_MASK_HI5Q_HW_IDX_8822B) -+#define BIT_SET_HI5Q_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI5Q_HW_IDX_8822B(x) | BIT_HI5Q_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_HI5Q_HOST_IDX_8822B 0 -+#define BIT_MASK_HI5Q_HOST_IDX_8822B 0xfff -+#define BIT_HI5Q_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI5Q_HOST_IDX_8822B) << BIT_SHIFT_HI5Q_HOST_IDX_8822B) -+#define BITS_HI5Q_HOST_IDX_8822B \ -+ (BIT_MASK_HI5Q_HOST_IDX_8822B << BIT_SHIFT_HI5Q_HOST_IDX_8822B) -+#define BIT_CLEAR_HI5Q_HOST_IDX_8822B(x) ((x) & (~BITS_HI5Q_HOST_IDX_8822B)) -+#define BIT_GET_HI5Q_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HOST_IDX_8822B) & BIT_MASK_HI5Q_HOST_IDX_8822B) -+#define BIT_SET_HI5Q_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI5Q_HOST_IDX_8822B(x) | BIT_HI5Q_HOST_IDX_8822B(v)) -+ -+/* 2 REG_HI6Q_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_HI6Q_HW_IDX_8822B 16 -+#define BIT_MASK_HI6Q_HW_IDX_8822B 0xfff -+#define BIT_HI6Q_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI6Q_HW_IDX_8822B) << BIT_SHIFT_HI6Q_HW_IDX_8822B) -+#define BITS_HI6Q_HW_IDX_8822B \ -+ (BIT_MASK_HI6Q_HW_IDX_8822B << BIT_SHIFT_HI6Q_HW_IDX_8822B) -+#define BIT_CLEAR_HI6Q_HW_IDX_8822B(x) ((x) & (~BITS_HI6Q_HW_IDX_8822B)) -+#define BIT_GET_HI6Q_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HW_IDX_8822B) & BIT_MASK_HI6Q_HW_IDX_8822B) -+#define BIT_SET_HI6Q_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI6Q_HW_IDX_8822B(x) | BIT_HI6Q_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_HI6Q_HOST_IDX_8822B 0 -+#define BIT_MASK_HI6Q_HOST_IDX_8822B 0xfff -+#define BIT_HI6Q_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI6Q_HOST_IDX_8822B) << BIT_SHIFT_HI6Q_HOST_IDX_8822B) -+#define BITS_HI6Q_HOST_IDX_8822B \ -+ (BIT_MASK_HI6Q_HOST_IDX_8822B << BIT_SHIFT_HI6Q_HOST_IDX_8822B) -+#define BIT_CLEAR_HI6Q_HOST_IDX_8822B(x) ((x) & (~BITS_HI6Q_HOST_IDX_8822B)) -+#define BIT_GET_HI6Q_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HOST_IDX_8822B) & BIT_MASK_HI6Q_HOST_IDX_8822B) -+#define BIT_SET_HI6Q_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI6Q_HOST_IDX_8822B(x) | BIT_HI6Q_HOST_IDX_8822B(v)) -+ -+/* 2 REG_HI7Q_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_HI7Q_HW_IDX_8822B 16 -+#define BIT_MASK_HI7Q_HW_IDX_8822B 0xfff -+#define BIT_HI7Q_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI7Q_HW_IDX_8822B) << BIT_SHIFT_HI7Q_HW_IDX_8822B) -+#define BITS_HI7Q_HW_IDX_8822B \ -+ (BIT_MASK_HI7Q_HW_IDX_8822B << BIT_SHIFT_HI7Q_HW_IDX_8822B) -+#define BIT_CLEAR_HI7Q_HW_IDX_8822B(x) ((x) & (~BITS_HI7Q_HW_IDX_8822B)) -+#define BIT_GET_HI7Q_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HW_IDX_8822B) & BIT_MASK_HI7Q_HW_IDX_8822B) -+#define BIT_SET_HI7Q_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI7Q_HW_IDX_8822B(x) | BIT_HI7Q_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_HI7Q_HOST_IDX_8822B 0 -+#define BIT_MASK_HI7Q_HOST_IDX_8822B 0xfff -+#define BIT_HI7Q_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HI7Q_HOST_IDX_8822B) << BIT_SHIFT_HI7Q_HOST_IDX_8822B) -+#define BITS_HI7Q_HOST_IDX_8822B \ -+ (BIT_MASK_HI7Q_HOST_IDX_8822B << BIT_SHIFT_HI7Q_HOST_IDX_8822B) -+#define BIT_CLEAR_HI7Q_HOST_IDX_8822B(x) ((x) & (~BITS_HI7Q_HOST_IDX_8822B)) -+#define BIT_GET_HI7Q_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HOST_IDX_8822B) & BIT_MASK_HI7Q_HOST_IDX_8822B) -+#define BIT_SET_HI7Q_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HI7Q_HOST_IDX_8822B(x) | BIT_HI7Q_HOST_IDX_8822B(v)) -+ -+/* 2 REG_DBG_SEL_V1_8822B */ -+ -+#define BIT_SHIFT_DBG_SEL_8822B 0 -+#define BIT_MASK_DBG_SEL_8822B 0xff -+#define BIT_DBG_SEL_8822B(x) \ -+ (((x) & BIT_MASK_DBG_SEL_8822B) << BIT_SHIFT_DBG_SEL_8822B) -+#define BITS_DBG_SEL_8822B (BIT_MASK_DBG_SEL_8822B << BIT_SHIFT_DBG_SEL_8822B) -+#define BIT_CLEAR_DBG_SEL_8822B(x) ((x) & (~BITS_DBG_SEL_8822B)) -+#define BIT_GET_DBG_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_8822B) & BIT_MASK_DBG_SEL_8822B) -+#define BIT_SET_DBG_SEL_8822B(x, v) \ -+ (BIT_CLEAR_DBG_SEL_8822B(x) | BIT_DBG_SEL_8822B(v)) -+ -+/* 2 REG_PCIE_HRPWM1_V1_8822B */ -+ -+#define BIT_SHIFT_PCIE_HRPWM_8822B 0 -+#define BIT_MASK_PCIE_HRPWM_8822B 0xff -+#define BIT_PCIE_HRPWM_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM_8822B) << BIT_SHIFT_PCIE_HRPWM_8822B) -+#define BITS_PCIE_HRPWM_8822B \ -+ (BIT_MASK_PCIE_HRPWM_8822B << BIT_SHIFT_PCIE_HRPWM_8822B) -+#define BIT_CLEAR_PCIE_HRPWM_8822B(x) ((x) & (~BITS_PCIE_HRPWM_8822B)) -+#define BIT_GET_PCIE_HRPWM_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM_8822B) & BIT_MASK_PCIE_HRPWM_8822B) -+#define BIT_SET_PCIE_HRPWM_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM_8822B(x) | BIT_PCIE_HRPWM_8822B(v)) -+ -+/* 2 REG_PCIE_HCPWM1_V1_8822B */ -+ -+#define BIT_SHIFT_PCIE_HCPWM_8822B 0 -+#define BIT_MASK_PCIE_HCPWM_8822B 0xff -+#define BIT_PCIE_HCPWM_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM_8822B) << BIT_SHIFT_PCIE_HCPWM_8822B) -+#define BITS_PCIE_HCPWM_8822B \ -+ (BIT_MASK_PCIE_HCPWM_8822B << BIT_SHIFT_PCIE_HCPWM_8822B) -+#define BIT_CLEAR_PCIE_HCPWM_8822B(x) ((x) & (~BITS_PCIE_HCPWM_8822B)) -+#define BIT_GET_PCIE_HCPWM_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM_8822B) & BIT_MASK_PCIE_HCPWM_8822B) -+#define BIT_SET_PCIE_HCPWM_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM_8822B(x) | BIT_PCIE_HCPWM_8822B(v)) -+ -+/* 2 REG_PCIE_CTRL2_8822B */ -+#define BIT_DIS_TXDMA_PRE_8822B BIT(7) -+#define BIT_DIS_RXDMA_PRE_8822B BIT(6) -+ -+#define BIT_SHIFT_HPS_CLKR_PCIE_8822B 4 -+#define BIT_MASK_HPS_CLKR_PCIE_8822B 0x3 -+#define BIT_HPS_CLKR_PCIE_8822B(x) \ -+ (((x) & BIT_MASK_HPS_CLKR_PCIE_8822B) << BIT_SHIFT_HPS_CLKR_PCIE_8822B) -+#define BITS_HPS_CLKR_PCIE_8822B \ -+ (BIT_MASK_HPS_CLKR_PCIE_8822B << BIT_SHIFT_HPS_CLKR_PCIE_8822B) -+#define BIT_CLEAR_HPS_CLKR_PCIE_8822B(x) ((x) & (~BITS_HPS_CLKR_PCIE_8822B)) -+#define BIT_GET_HPS_CLKR_PCIE_8822B(x) \ -+ (((x) >> BIT_SHIFT_HPS_CLKR_PCIE_8822B) & BIT_MASK_HPS_CLKR_PCIE_8822B) -+#define BIT_SET_HPS_CLKR_PCIE_8822B(x, v) \ -+ (BIT_CLEAR_HPS_CLKR_PCIE_8822B(x) | BIT_HPS_CLKR_PCIE_8822B(v)) -+ -+#define BIT_PCIE_INT_8822B BIT(3) -+#define BIT_TXFLAG_EXIT_L1_EN_8822B BIT(2) -+#define BIT_EN_RXDMA_ALIGN_8822B BIT(1) -+#define BIT_EN_TXDMA_ALIGN_8822B BIT(0) -+ -+/* 2 REG_PCIE_HRPWM2_V1_8822B */ -+ -+#define BIT_SHIFT_PCIE_HRPWM2_8822B 0 -+#define BIT_MASK_PCIE_HRPWM2_8822B 0xffff -+#define BIT_PCIE_HRPWM2_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM2_8822B) << BIT_SHIFT_PCIE_HRPWM2_8822B) -+#define BITS_PCIE_HRPWM2_8822B \ -+ (BIT_MASK_PCIE_HRPWM2_8822B << BIT_SHIFT_PCIE_HRPWM2_8822B) -+#define BIT_CLEAR_PCIE_HRPWM2_8822B(x) ((x) & (~BITS_PCIE_HRPWM2_8822B)) -+#define BIT_GET_PCIE_HRPWM2_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM2_8822B) & BIT_MASK_PCIE_HRPWM2_8822B) -+#define BIT_SET_PCIE_HRPWM2_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM2_8822B(x) | BIT_PCIE_HRPWM2_8822B(v)) -+ -+/* 2 REG_PCIE_HCPWM2_V1_8822B */ -+ -+#define BIT_SHIFT_PCIE_HCPWM2_8822B 0 -+#define BIT_MASK_PCIE_HCPWM2_8822B 0xffff -+#define BIT_PCIE_HCPWM2_8822B(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM2_8822B) << BIT_SHIFT_PCIE_HCPWM2_8822B) -+#define BITS_PCIE_HCPWM2_8822B \ -+ (BIT_MASK_PCIE_HCPWM2_8822B << BIT_SHIFT_PCIE_HCPWM2_8822B) -+#define BIT_CLEAR_PCIE_HCPWM2_8822B(x) ((x) & (~BITS_PCIE_HCPWM2_8822B)) -+#define BIT_GET_PCIE_HCPWM2_8822B(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM2_8822B) & BIT_MASK_PCIE_HCPWM2_8822B) -+#define BIT_SET_PCIE_HCPWM2_8822B(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM2_8822B(x) | BIT_PCIE_HCPWM2_8822B(v)) -+ -+/* 2 REG_PCIE_H2C_MSG_V1_8822B */ -+ -+#define BIT_SHIFT_DRV2FW_INFO_8822B 0 -+#define BIT_MASK_DRV2FW_INFO_8822B 0xffffffffL -+#define BIT_DRV2FW_INFO_8822B(x) \ -+ (((x) & BIT_MASK_DRV2FW_INFO_8822B) << BIT_SHIFT_DRV2FW_INFO_8822B) -+#define BITS_DRV2FW_INFO_8822B \ -+ (BIT_MASK_DRV2FW_INFO_8822B << BIT_SHIFT_DRV2FW_INFO_8822B) -+#define BIT_CLEAR_DRV2FW_INFO_8822B(x) ((x) & (~BITS_DRV2FW_INFO_8822B)) -+#define BIT_GET_DRV2FW_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_DRV2FW_INFO_8822B) & BIT_MASK_DRV2FW_INFO_8822B) -+#define BIT_SET_DRV2FW_INFO_8822B(x, v) \ -+ (BIT_CLEAR_DRV2FW_INFO_8822B(x) | BIT_DRV2FW_INFO_8822B(v)) -+ -+/* 2 REG_PCIE_C2H_MSG_V1_8822B */ -+ -+#define BIT_SHIFT_HCI_PCIE_C2H_MSG_8822B 0 -+#define BIT_MASK_HCI_PCIE_C2H_MSG_8822B 0xffffffffL -+#define BIT_HCI_PCIE_C2H_MSG_8822B(x) \ -+ (((x) & BIT_MASK_HCI_PCIE_C2H_MSG_8822B) \ -+ << BIT_SHIFT_HCI_PCIE_C2H_MSG_8822B) -+#define BITS_HCI_PCIE_C2H_MSG_8822B \ -+ (BIT_MASK_HCI_PCIE_C2H_MSG_8822B << BIT_SHIFT_HCI_PCIE_C2H_MSG_8822B) -+#define BIT_CLEAR_HCI_PCIE_C2H_MSG_8822B(x) \ -+ ((x) & (~BITS_HCI_PCIE_C2H_MSG_8822B)) -+#define BIT_GET_HCI_PCIE_C2H_MSG_8822B(x) \ -+ (((x) >> BIT_SHIFT_HCI_PCIE_C2H_MSG_8822B) & \ -+ BIT_MASK_HCI_PCIE_C2H_MSG_8822B) -+#define BIT_SET_HCI_PCIE_C2H_MSG_8822B(x, v) \ -+ (BIT_CLEAR_HCI_PCIE_C2H_MSG_8822B(x) | BIT_HCI_PCIE_C2H_MSG_8822B(v)) -+ -+/* 2 REG_DBI_WDATA_V1_8822B */ -+ -+#define BIT_SHIFT_DBI_WDATA_8822B 0 -+#define BIT_MASK_DBI_WDATA_8822B 0xffffffffL -+#define BIT_DBI_WDATA_8822B(x) \ -+ (((x) & BIT_MASK_DBI_WDATA_8822B) << BIT_SHIFT_DBI_WDATA_8822B) -+#define BITS_DBI_WDATA_8822B \ -+ (BIT_MASK_DBI_WDATA_8822B << BIT_SHIFT_DBI_WDATA_8822B) -+#define BIT_CLEAR_DBI_WDATA_8822B(x) ((x) & (~BITS_DBI_WDATA_8822B)) -+#define BIT_GET_DBI_WDATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DBI_WDATA_8822B) & BIT_MASK_DBI_WDATA_8822B) -+#define BIT_SET_DBI_WDATA_8822B(x, v) \ -+ (BIT_CLEAR_DBI_WDATA_8822B(x) | BIT_DBI_WDATA_8822B(v)) -+ -+/* 2 REG_DBI_RDATA_V1_8822B */ -+ -+#define BIT_SHIFT_DBI_RDATA_8822B 0 -+#define BIT_MASK_DBI_RDATA_8822B 0xffffffffL -+#define BIT_DBI_RDATA_8822B(x) \ -+ (((x) & BIT_MASK_DBI_RDATA_8822B) << BIT_SHIFT_DBI_RDATA_8822B) -+#define BITS_DBI_RDATA_8822B \ -+ (BIT_MASK_DBI_RDATA_8822B << BIT_SHIFT_DBI_RDATA_8822B) -+#define BIT_CLEAR_DBI_RDATA_8822B(x) ((x) & (~BITS_DBI_RDATA_8822B)) -+#define BIT_GET_DBI_RDATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DBI_RDATA_8822B) & BIT_MASK_DBI_RDATA_8822B) -+#define BIT_SET_DBI_RDATA_8822B(x, v) \ -+ (BIT_CLEAR_DBI_RDATA_8822B(x) | BIT_DBI_RDATA_8822B(v)) -+ -+/* 2 REG_DBI_FLAG_V1_8822B */ -+#define BIT_EN_STUCK_DBG_8822B BIT(26) -+#define BIT_RX_STUCK_8822B BIT(25) -+#define BIT_TX_STUCK_8822B BIT(24) -+#define BIT_DBI_RFLAG_8822B BIT(17) -+#define BIT_DBI_WFLAG_8822B BIT(16) -+ -+#define BIT_SHIFT_DBI_WREN_8822B 12 -+#define BIT_MASK_DBI_WREN_8822B 0xf -+#define BIT_DBI_WREN_8822B(x) \ -+ (((x) & BIT_MASK_DBI_WREN_8822B) << BIT_SHIFT_DBI_WREN_8822B) -+#define BITS_DBI_WREN_8822B \ -+ (BIT_MASK_DBI_WREN_8822B << BIT_SHIFT_DBI_WREN_8822B) -+#define BIT_CLEAR_DBI_WREN_8822B(x) ((x) & (~BITS_DBI_WREN_8822B)) -+#define BIT_GET_DBI_WREN_8822B(x) \ -+ (((x) >> BIT_SHIFT_DBI_WREN_8822B) & BIT_MASK_DBI_WREN_8822B) -+#define BIT_SET_DBI_WREN_8822B(x, v) \ -+ (BIT_CLEAR_DBI_WREN_8822B(x) | BIT_DBI_WREN_8822B(v)) -+ -+#define BIT_SHIFT_DBI_ADDR_8822B 0 -+#define BIT_MASK_DBI_ADDR_8822B 0xfff -+#define BIT_DBI_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_DBI_ADDR_8822B) << BIT_SHIFT_DBI_ADDR_8822B) -+#define BITS_DBI_ADDR_8822B \ -+ (BIT_MASK_DBI_ADDR_8822B << BIT_SHIFT_DBI_ADDR_8822B) -+#define BIT_CLEAR_DBI_ADDR_8822B(x) ((x) & (~BITS_DBI_ADDR_8822B)) -+#define BIT_GET_DBI_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_DBI_ADDR_8822B) & BIT_MASK_DBI_ADDR_8822B) -+#define BIT_SET_DBI_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_DBI_ADDR_8822B(x) | BIT_DBI_ADDR_8822B(v)) -+ -+/* 2 REG_MDIO_V1_8822B */ -+ -+#define BIT_SHIFT_MDIO_RDATA_8822B 16 -+#define BIT_MASK_MDIO_RDATA_8822B 0xffff -+#define BIT_MDIO_RDATA_8822B(x) \ -+ (((x) & BIT_MASK_MDIO_RDATA_8822B) << BIT_SHIFT_MDIO_RDATA_8822B) -+#define BITS_MDIO_RDATA_8822B \ -+ (BIT_MASK_MDIO_RDATA_8822B << BIT_SHIFT_MDIO_RDATA_8822B) -+#define BIT_CLEAR_MDIO_RDATA_8822B(x) ((x) & (~BITS_MDIO_RDATA_8822B)) -+#define BIT_GET_MDIO_RDATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_MDIO_RDATA_8822B) & BIT_MASK_MDIO_RDATA_8822B) -+#define BIT_SET_MDIO_RDATA_8822B(x, v) \ -+ (BIT_CLEAR_MDIO_RDATA_8822B(x) | BIT_MDIO_RDATA_8822B(v)) -+ -+#define BIT_SHIFT_MDIO_WDATA_8822B 0 -+#define BIT_MASK_MDIO_WDATA_8822B 0xffff -+#define BIT_MDIO_WDATA_8822B(x) \ -+ (((x) & BIT_MASK_MDIO_WDATA_8822B) << BIT_SHIFT_MDIO_WDATA_8822B) -+#define BITS_MDIO_WDATA_8822B \ -+ (BIT_MASK_MDIO_WDATA_8822B << BIT_SHIFT_MDIO_WDATA_8822B) -+#define BIT_CLEAR_MDIO_WDATA_8822B(x) ((x) & (~BITS_MDIO_WDATA_8822B)) -+#define BIT_GET_MDIO_WDATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_MDIO_WDATA_8822B) & BIT_MASK_MDIO_WDATA_8822B) -+#define BIT_SET_MDIO_WDATA_8822B(x, v) \ -+ (BIT_CLEAR_MDIO_WDATA_8822B(x) | BIT_MDIO_WDATA_8822B(v)) -+ -+/* 2 REG_PCIE_MIX_CFG_8822B */ -+ -+#define BIT_SHIFT_MDIO_PHY_ADDR_8822B 24 -+#define BIT_MASK_MDIO_PHY_ADDR_8822B 0x1f -+#define BIT_MDIO_PHY_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_MDIO_PHY_ADDR_8822B) << BIT_SHIFT_MDIO_PHY_ADDR_8822B) -+#define BITS_MDIO_PHY_ADDR_8822B \ -+ (BIT_MASK_MDIO_PHY_ADDR_8822B << BIT_SHIFT_MDIO_PHY_ADDR_8822B) -+#define BIT_CLEAR_MDIO_PHY_ADDR_8822B(x) ((x) & (~BITS_MDIO_PHY_ADDR_8822B)) -+#define BIT_GET_MDIO_PHY_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_MDIO_PHY_ADDR_8822B) & BIT_MASK_MDIO_PHY_ADDR_8822B) -+#define BIT_SET_MDIO_PHY_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_MDIO_PHY_ADDR_8822B(x) | BIT_MDIO_PHY_ADDR_8822B(v)) -+ -+#define BIT_SHIFT_WATCH_DOG_RECORD_V1_8822B 10 -+#define BIT_MASK_WATCH_DOG_RECORD_V1_8822B 0x3fff -+#define BIT_WATCH_DOG_RECORD_V1_8822B(x) \ -+ (((x) & BIT_MASK_WATCH_DOG_RECORD_V1_8822B) \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8822B) -+#define BITS_WATCH_DOG_RECORD_V1_8822B \ -+ (BIT_MASK_WATCH_DOG_RECORD_V1_8822B \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8822B) -+#define BIT_CLEAR_WATCH_DOG_RECORD_V1_8822B(x) \ -+ ((x) & (~BITS_WATCH_DOG_RECORD_V1_8822B)) -+#define BIT_GET_WATCH_DOG_RECORD_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_WATCH_DOG_RECORD_V1_8822B) & \ -+ BIT_MASK_WATCH_DOG_RECORD_V1_8822B) -+#define BIT_SET_WATCH_DOG_RECORD_V1_8822B(x, v) \ -+ (BIT_CLEAR_WATCH_DOG_RECORD_V1_8822B(x) | \ -+ BIT_WATCH_DOG_RECORD_V1_8822B(v)) -+ -+#define BIT_R_IO_TIMEOUT_FLAG_V1_8822B BIT(9) -+#define BIT_EN_WATCH_DOG_8822B BIT(8) -+#define BIT_ECRC_EN_V1_8822B BIT(7) -+#define BIT_MDIO_RFLAG_V1_8822B BIT(6) -+#define BIT_MDIO_WFLAG_V1_8822B BIT(5) -+ -+#define BIT_SHIFT_MDIO_REG_ADDR_V1_8822B 0 -+#define BIT_MASK_MDIO_REG_ADDR_V1_8822B 0x1f -+#define BIT_MDIO_REG_ADDR_V1_8822B(x) \ -+ (((x) & BIT_MASK_MDIO_REG_ADDR_V1_8822B) \ -+ << BIT_SHIFT_MDIO_REG_ADDR_V1_8822B) -+#define BITS_MDIO_REG_ADDR_V1_8822B \ -+ (BIT_MASK_MDIO_REG_ADDR_V1_8822B << BIT_SHIFT_MDIO_REG_ADDR_V1_8822B) -+#define BIT_CLEAR_MDIO_REG_ADDR_V1_8822B(x) \ -+ ((x) & (~BITS_MDIO_REG_ADDR_V1_8822B)) -+#define BIT_GET_MDIO_REG_ADDR_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_MDIO_REG_ADDR_V1_8822B) & \ -+ BIT_MASK_MDIO_REG_ADDR_V1_8822B) -+#define BIT_SET_MDIO_REG_ADDR_V1_8822B(x, v) \ -+ (BIT_CLEAR_MDIO_REG_ADDR_V1_8822B(x) | BIT_MDIO_REG_ADDR_V1_8822B(v)) -+ -+/* 2 REG_HCI_MIX_CFG_8822B */ -+#define BIT_HOST_GEN2_SUPPORT_8822B BIT(20) -+ -+#define BIT_SHIFT_TXDMA_ERR_FLAG_8822B 16 -+#define BIT_MASK_TXDMA_ERR_FLAG_8822B 0xf -+#define BIT_TXDMA_ERR_FLAG_8822B(x) \ -+ (((x) & BIT_MASK_TXDMA_ERR_FLAG_8822B) \ -+ << BIT_SHIFT_TXDMA_ERR_FLAG_8822B) -+#define BITS_TXDMA_ERR_FLAG_8822B \ -+ (BIT_MASK_TXDMA_ERR_FLAG_8822B << BIT_SHIFT_TXDMA_ERR_FLAG_8822B) -+#define BIT_CLEAR_TXDMA_ERR_FLAG_8822B(x) ((x) & (~BITS_TXDMA_ERR_FLAG_8822B)) -+#define BIT_GET_TXDMA_ERR_FLAG_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_ERR_FLAG_8822B) & \ -+ BIT_MASK_TXDMA_ERR_FLAG_8822B) -+#define BIT_SET_TXDMA_ERR_FLAG_8822B(x, v) \ -+ (BIT_CLEAR_TXDMA_ERR_FLAG_8822B(x) | BIT_TXDMA_ERR_FLAG_8822B(v)) -+ -+#define BIT_SHIFT_EARLY_MODE_SEL_8822B 12 -+#define BIT_MASK_EARLY_MODE_SEL_8822B 0xf -+#define BIT_EARLY_MODE_SEL_8822B(x) \ -+ (((x) & BIT_MASK_EARLY_MODE_SEL_8822B) \ -+ << BIT_SHIFT_EARLY_MODE_SEL_8822B) -+#define BITS_EARLY_MODE_SEL_8822B \ -+ (BIT_MASK_EARLY_MODE_SEL_8822B << BIT_SHIFT_EARLY_MODE_SEL_8822B) -+#define BIT_CLEAR_EARLY_MODE_SEL_8822B(x) ((x) & (~BITS_EARLY_MODE_SEL_8822B)) -+#define BIT_GET_EARLY_MODE_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_EARLY_MODE_SEL_8822B) & \ -+ BIT_MASK_EARLY_MODE_SEL_8822B) -+#define BIT_SET_EARLY_MODE_SEL_8822B(x, v) \ -+ (BIT_CLEAR_EARLY_MODE_SEL_8822B(x) | BIT_EARLY_MODE_SEL_8822B(v)) -+ -+#define BIT_EPHY_RX50_EN_8822B BIT(11) -+ -+#define BIT_SHIFT_MSI_TIMEOUT_ID_V1_8822B 8 -+#define BIT_MASK_MSI_TIMEOUT_ID_V1_8822B 0x7 -+#define BIT_MSI_TIMEOUT_ID_V1_8822B(x) \ -+ (((x) & BIT_MASK_MSI_TIMEOUT_ID_V1_8822B) \ -+ << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8822B) -+#define BITS_MSI_TIMEOUT_ID_V1_8822B \ -+ (BIT_MASK_MSI_TIMEOUT_ID_V1_8822B << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8822B) -+#define BIT_CLEAR_MSI_TIMEOUT_ID_V1_8822B(x) \ -+ ((x) & (~BITS_MSI_TIMEOUT_ID_V1_8822B)) -+#define BIT_GET_MSI_TIMEOUT_ID_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_MSI_TIMEOUT_ID_V1_8822B) & \ -+ BIT_MASK_MSI_TIMEOUT_ID_V1_8822B) -+#define BIT_SET_MSI_TIMEOUT_ID_V1_8822B(x, v) \ -+ (BIT_CLEAR_MSI_TIMEOUT_ID_V1_8822B(x) | BIT_MSI_TIMEOUT_ID_V1_8822B(v)) -+ -+#define BIT_RADDR_RD_8822B BIT(7) -+#define BIT_EN_MUL_TAG_8822B BIT(6) -+#define BIT_EN_EARLY_MODE_8822B BIT(5) -+#define BIT_L0S_LINK_OFF_8822B BIT(4) -+#define BIT_ACT_LINK_OFF_8822B BIT(3) -+#define BIT_EN_SLOW_MAC_TX_8822B BIT(2) -+#define BIT_EN_SLOW_MAC_RX_8822B BIT(1) -+ -+/* 2 REG_STC_INT_CS_8822B(PCIE STATE CHANGE INTERRUPT CONTROL AND STATUS) */ -+#define BIT_STC_INT_EN_8822B BIT(31) -+ -+#define BIT_SHIFT_STC_INT_FLAG_8822B 16 -+#define BIT_MASK_STC_INT_FLAG_8822B 0xff -+#define BIT_STC_INT_FLAG_8822B(x) \ -+ (((x) & BIT_MASK_STC_INT_FLAG_8822B) << BIT_SHIFT_STC_INT_FLAG_8822B) -+#define BITS_STC_INT_FLAG_8822B \ -+ (BIT_MASK_STC_INT_FLAG_8822B << BIT_SHIFT_STC_INT_FLAG_8822B) -+#define BIT_CLEAR_STC_INT_FLAG_8822B(x) ((x) & (~BITS_STC_INT_FLAG_8822B)) -+#define BIT_GET_STC_INT_FLAG_8822B(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_FLAG_8822B) & BIT_MASK_STC_INT_FLAG_8822B) -+#define BIT_SET_STC_INT_FLAG_8822B(x, v) \ -+ (BIT_CLEAR_STC_INT_FLAG_8822B(x) | BIT_STC_INT_FLAG_8822B(v)) -+ -+#define BIT_SHIFT_STC_INT_IDX_8822B 8 -+#define BIT_MASK_STC_INT_IDX_8822B 0x7 -+#define BIT_STC_INT_IDX_8822B(x) \ -+ (((x) & BIT_MASK_STC_INT_IDX_8822B) << BIT_SHIFT_STC_INT_IDX_8822B) -+#define BITS_STC_INT_IDX_8822B \ -+ (BIT_MASK_STC_INT_IDX_8822B << BIT_SHIFT_STC_INT_IDX_8822B) -+#define BIT_CLEAR_STC_INT_IDX_8822B(x) ((x) & (~BITS_STC_INT_IDX_8822B)) -+#define BIT_GET_STC_INT_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_IDX_8822B) & BIT_MASK_STC_INT_IDX_8822B) -+#define BIT_SET_STC_INT_IDX_8822B(x, v) \ -+ (BIT_CLEAR_STC_INT_IDX_8822B(x) | BIT_STC_INT_IDX_8822B(v)) -+ -+#define BIT_SHIFT_STC_INT_REALTIME_CS_8822B 0 -+#define BIT_MASK_STC_INT_REALTIME_CS_8822B 0x3f -+#define BIT_STC_INT_REALTIME_CS_8822B(x) \ -+ (((x) & BIT_MASK_STC_INT_REALTIME_CS_8822B) \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8822B) -+#define BITS_STC_INT_REALTIME_CS_8822B \ -+ (BIT_MASK_STC_INT_REALTIME_CS_8822B \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8822B) -+#define BIT_CLEAR_STC_INT_REALTIME_CS_8822B(x) \ -+ ((x) & (~BITS_STC_INT_REALTIME_CS_8822B)) -+#define BIT_GET_STC_INT_REALTIME_CS_8822B(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_REALTIME_CS_8822B) & \ -+ BIT_MASK_STC_INT_REALTIME_CS_8822B) -+#define BIT_SET_STC_INT_REALTIME_CS_8822B(x, v) \ -+ (BIT_CLEAR_STC_INT_REALTIME_CS_8822B(x) | \ -+ BIT_STC_INT_REALTIME_CS_8822B(v)) -+ -+/* 2 REG_ST_INT_CFG_8822B(PCIE STATE CHANGE INTERRUPT CONFIGURATION) */ -+#define BIT_STC_INT_GRP_EN_8822B BIT(31) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_LS_8822B 8 -+#define BIT_MASK_STC_INT_EXPECT_LS_8822B 0x3f -+#define BIT_STC_INT_EXPECT_LS_8822B(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_LS_8822B) \ -+ << BIT_SHIFT_STC_INT_EXPECT_LS_8822B) -+#define BITS_STC_INT_EXPECT_LS_8822B \ -+ (BIT_MASK_STC_INT_EXPECT_LS_8822B << BIT_SHIFT_STC_INT_EXPECT_LS_8822B) -+#define BIT_CLEAR_STC_INT_EXPECT_LS_8822B(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_LS_8822B)) -+#define BIT_GET_STC_INT_EXPECT_LS_8822B(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_LS_8822B) & \ -+ BIT_MASK_STC_INT_EXPECT_LS_8822B) -+#define BIT_SET_STC_INT_EXPECT_LS_8822B(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_LS_8822B(x) | BIT_STC_INT_EXPECT_LS_8822B(v)) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_CS_8822B 0 -+#define BIT_MASK_STC_INT_EXPECT_CS_8822B 0x3f -+#define BIT_STC_INT_EXPECT_CS_8822B(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_CS_8822B) \ -+ << BIT_SHIFT_STC_INT_EXPECT_CS_8822B) -+#define BITS_STC_INT_EXPECT_CS_8822B \ -+ (BIT_MASK_STC_INT_EXPECT_CS_8822B << BIT_SHIFT_STC_INT_EXPECT_CS_8822B) -+#define BIT_CLEAR_STC_INT_EXPECT_CS_8822B(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_CS_8822B)) -+#define BIT_GET_STC_INT_EXPECT_CS_8822B(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_CS_8822B) & \ -+ BIT_MASK_STC_INT_EXPECT_CS_8822B) -+#define BIT_SET_STC_INT_EXPECT_CS_8822B(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_CS_8822B(x) | BIT_STC_INT_EXPECT_CS_8822B(v)) -+ -+/* 2 REG_CMU_DLY_CTRL_8822B(PCIE PHY CLOCK MGT UNIT DELAY CONTROL ) */ -+#define BIT_CMU_DLY_EN_8822B BIT(31) -+#define BIT_CMU_DLY_MODE_8822B BIT(30) -+ -+#define BIT_SHIFT_CMU_DLY_PRE_DIV_8822B 0 -+#define BIT_MASK_CMU_DLY_PRE_DIV_8822B 0xff -+#define BIT_CMU_DLY_PRE_DIV_8822B(x) \ -+ (((x) & BIT_MASK_CMU_DLY_PRE_DIV_8822B) \ -+ << BIT_SHIFT_CMU_DLY_PRE_DIV_8822B) -+#define BITS_CMU_DLY_PRE_DIV_8822B \ -+ (BIT_MASK_CMU_DLY_PRE_DIV_8822B << BIT_SHIFT_CMU_DLY_PRE_DIV_8822B) -+#define BIT_CLEAR_CMU_DLY_PRE_DIV_8822B(x) ((x) & (~BITS_CMU_DLY_PRE_DIV_8822B)) -+#define BIT_GET_CMU_DLY_PRE_DIV_8822B(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_PRE_DIV_8822B) & \ -+ BIT_MASK_CMU_DLY_PRE_DIV_8822B) -+#define BIT_SET_CMU_DLY_PRE_DIV_8822B(x, v) \ -+ (BIT_CLEAR_CMU_DLY_PRE_DIV_8822B(x) | BIT_CMU_DLY_PRE_DIV_8822B(v)) -+ -+/* 2 REG_CMU_DLY_CFG_8822B(PCIE PHY CLOCK MGT UNIT DELAY CONFIGURATION ) */ -+ -+#define BIT_SHIFT_CMU_DLY_LTR_A2I_8822B 24 -+#define BIT_MASK_CMU_DLY_LTR_A2I_8822B 0xff -+#define BIT_CMU_DLY_LTR_A2I_8822B(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_A2I_8822B) \ -+ << BIT_SHIFT_CMU_DLY_LTR_A2I_8822B) -+#define BITS_CMU_DLY_LTR_A2I_8822B \ -+ (BIT_MASK_CMU_DLY_LTR_A2I_8822B << BIT_SHIFT_CMU_DLY_LTR_A2I_8822B) -+#define BIT_CLEAR_CMU_DLY_LTR_A2I_8822B(x) ((x) & (~BITS_CMU_DLY_LTR_A2I_8822B)) -+#define BIT_GET_CMU_DLY_LTR_A2I_8822B(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_A2I_8822B) & \ -+ BIT_MASK_CMU_DLY_LTR_A2I_8822B) -+#define BIT_SET_CMU_DLY_LTR_A2I_8822B(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_A2I_8822B(x) | BIT_CMU_DLY_LTR_A2I_8822B(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_I2A_8822B 16 -+#define BIT_MASK_CMU_DLY_LTR_I2A_8822B 0xff -+#define BIT_CMU_DLY_LTR_I2A_8822B(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_I2A_8822B) \ -+ << BIT_SHIFT_CMU_DLY_LTR_I2A_8822B) -+#define BITS_CMU_DLY_LTR_I2A_8822B \ -+ (BIT_MASK_CMU_DLY_LTR_I2A_8822B << BIT_SHIFT_CMU_DLY_LTR_I2A_8822B) -+#define BIT_CLEAR_CMU_DLY_LTR_I2A_8822B(x) ((x) & (~BITS_CMU_DLY_LTR_I2A_8822B)) -+#define BIT_GET_CMU_DLY_LTR_I2A_8822B(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_I2A_8822B) & \ -+ BIT_MASK_CMU_DLY_LTR_I2A_8822B) -+#define BIT_SET_CMU_DLY_LTR_I2A_8822B(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_I2A_8822B(x) | BIT_CMU_DLY_LTR_I2A_8822B(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_IDLE_8822B 8 -+#define BIT_MASK_CMU_DLY_LTR_IDLE_8822B 0xff -+#define BIT_CMU_DLY_LTR_IDLE_8822B(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_IDLE_8822B) \ -+ << BIT_SHIFT_CMU_DLY_LTR_IDLE_8822B) -+#define BITS_CMU_DLY_LTR_IDLE_8822B \ -+ (BIT_MASK_CMU_DLY_LTR_IDLE_8822B << BIT_SHIFT_CMU_DLY_LTR_IDLE_8822B) -+#define BIT_CLEAR_CMU_DLY_LTR_IDLE_8822B(x) \ -+ ((x) & (~BITS_CMU_DLY_LTR_IDLE_8822B)) -+#define BIT_GET_CMU_DLY_LTR_IDLE_8822B(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_IDLE_8822B) & \ -+ BIT_MASK_CMU_DLY_LTR_IDLE_8822B) -+#define BIT_SET_CMU_DLY_LTR_IDLE_8822B(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_IDLE_8822B(x) | BIT_CMU_DLY_LTR_IDLE_8822B(v)) -+ -+#define BIT_SHIFT_CMU_DLY_LTR_ACT_8822B 0 -+#define BIT_MASK_CMU_DLY_LTR_ACT_8822B 0xff -+#define BIT_CMU_DLY_LTR_ACT_8822B(x) \ -+ (((x) & BIT_MASK_CMU_DLY_LTR_ACT_8822B) \ -+ << BIT_SHIFT_CMU_DLY_LTR_ACT_8822B) -+#define BITS_CMU_DLY_LTR_ACT_8822B \ -+ (BIT_MASK_CMU_DLY_LTR_ACT_8822B << BIT_SHIFT_CMU_DLY_LTR_ACT_8822B) -+#define BIT_CLEAR_CMU_DLY_LTR_ACT_8822B(x) ((x) & (~BITS_CMU_DLY_LTR_ACT_8822B)) -+#define BIT_GET_CMU_DLY_LTR_ACT_8822B(x) \ -+ (((x) >> BIT_SHIFT_CMU_DLY_LTR_ACT_8822B) & \ -+ BIT_MASK_CMU_DLY_LTR_ACT_8822B) -+#define BIT_SET_CMU_DLY_LTR_ACT_8822B(x, v) \ -+ (BIT_CLEAR_CMU_DLY_LTR_ACT_8822B(x) | BIT_CMU_DLY_LTR_ACT_8822B(v)) -+ -+/* 2 REG_H2CQ_TXBD_DESA_8822B */ -+ -+#define BIT_SHIFT_H2CQ_TXBD_DESA_8822B 0 -+#define BIT_MASK_H2CQ_TXBD_DESA_8822B 0xffffffffffffffffL -+#define BIT_H2CQ_TXBD_DESA_8822B(x) \ -+ (((x) & BIT_MASK_H2CQ_TXBD_DESA_8822B) \ -+ << BIT_SHIFT_H2CQ_TXBD_DESA_8822B) -+#define BITS_H2CQ_TXBD_DESA_8822B \ -+ (BIT_MASK_H2CQ_TXBD_DESA_8822B << BIT_SHIFT_H2CQ_TXBD_DESA_8822B) -+#define BIT_CLEAR_H2CQ_TXBD_DESA_8822B(x) ((x) & (~BITS_H2CQ_TXBD_DESA_8822B)) -+#define BIT_GET_H2CQ_TXBD_DESA_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_TXBD_DESA_8822B) & \ -+ BIT_MASK_H2CQ_TXBD_DESA_8822B) -+#define BIT_SET_H2CQ_TXBD_DESA_8822B(x, v) \ -+ (BIT_CLEAR_H2CQ_TXBD_DESA_8822B(x) | BIT_H2CQ_TXBD_DESA_8822B(v)) -+ -+/* 2 REG_H2CQ_TXBD_NUM_8822B */ -+#define BIT_PCIE_H2CQ_FLAG_8822B BIT(14) -+ -+#define BIT_SHIFT_H2CQ_DESC_MODE_8822B 12 -+#define BIT_MASK_H2CQ_DESC_MODE_8822B 0x3 -+#define BIT_H2CQ_DESC_MODE_8822B(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_MODE_8822B) \ -+ << BIT_SHIFT_H2CQ_DESC_MODE_8822B) -+#define BITS_H2CQ_DESC_MODE_8822B \ -+ (BIT_MASK_H2CQ_DESC_MODE_8822B << BIT_SHIFT_H2CQ_DESC_MODE_8822B) -+#define BIT_CLEAR_H2CQ_DESC_MODE_8822B(x) ((x) & (~BITS_H2CQ_DESC_MODE_8822B)) -+#define BIT_GET_H2CQ_DESC_MODE_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_MODE_8822B) & \ -+ BIT_MASK_H2CQ_DESC_MODE_8822B) -+#define BIT_SET_H2CQ_DESC_MODE_8822B(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_MODE_8822B(x) | BIT_H2CQ_DESC_MODE_8822B(v)) -+ -+#define BIT_SHIFT_H2CQ_DESC_NUM_8822B 0 -+#define BIT_MASK_H2CQ_DESC_NUM_8822B 0xfff -+#define BIT_H2CQ_DESC_NUM_8822B(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_NUM_8822B) << BIT_SHIFT_H2CQ_DESC_NUM_8822B) -+#define BITS_H2CQ_DESC_NUM_8822B \ -+ (BIT_MASK_H2CQ_DESC_NUM_8822B << BIT_SHIFT_H2CQ_DESC_NUM_8822B) -+#define BIT_CLEAR_H2CQ_DESC_NUM_8822B(x) ((x) & (~BITS_H2CQ_DESC_NUM_8822B)) -+#define BIT_GET_H2CQ_DESC_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_NUM_8822B) & BIT_MASK_H2CQ_DESC_NUM_8822B) -+#define BIT_SET_H2CQ_DESC_NUM_8822B(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_NUM_8822B(x) | BIT_H2CQ_DESC_NUM_8822B(v)) -+ -+/* 2 REG_H2CQ_TXBD_IDX_8822B */ -+ -+#define BIT_SHIFT_H2CQ_HW_IDX_8822B 16 -+#define BIT_MASK_H2CQ_HW_IDX_8822B 0xfff -+#define BIT_H2CQ_HW_IDX_8822B(x) \ -+ (((x) & BIT_MASK_H2CQ_HW_IDX_8822B) << BIT_SHIFT_H2CQ_HW_IDX_8822B) -+#define BITS_H2CQ_HW_IDX_8822B \ -+ (BIT_MASK_H2CQ_HW_IDX_8822B << BIT_SHIFT_H2CQ_HW_IDX_8822B) -+#define BIT_CLEAR_H2CQ_HW_IDX_8822B(x) ((x) & (~BITS_H2CQ_HW_IDX_8822B)) -+#define BIT_GET_H2CQ_HW_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HW_IDX_8822B) & BIT_MASK_H2CQ_HW_IDX_8822B) -+#define BIT_SET_H2CQ_HW_IDX_8822B(x, v) \ -+ (BIT_CLEAR_H2CQ_HW_IDX_8822B(x) | BIT_H2CQ_HW_IDX_8822B(v)) -+ -+#define BIT_SHIFT_H2CQ_HOST_IDX_8822B 0 -+#define BIT_MASK_H2CQ_HOST_IDX_8822B 0xfff -+#define BIT_H2CQ_HOST_IDX_8822B(x) \ -+ (((x) & BIT_MASK_H2CQ_HOST_IDX_8822B) << BIT_SHIFT_H2CQ_HOST_IDX_8822B) -+#define BITS_H2CQ_HOST_IDX_8822B \ -+ (BIT_MASK_H2CQ_HOST_IDX_8822B << BIT_SHIFT_H2CQ_HOST_IDX_8822B) -+#define BIT_CLEAR_H2CQ_HOST_IDX_8822B(x) ((x) & (~BITS_H2CQ_HOST_IDX_8822B)) -+#define BIT_GET_H2CQ_HOST_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HOST_IDX_8822B) & BIT_MASK_H2CQ_HOST_IDX_8822B) -+#define BIT_SET_H2CQ_HOST_IDX_8822B(x, v) \ -+ (BIT_CLEAR_H2CQ_HOST_IDX_8822B(x) | BIT_H2CQ_HOST_IDX_8822B(v)) -+ -+/* 2 REG_H2CQ_CSR_8822B[31:0] (H2CQ CONTROL AND STATUS) */ -+#define BIT_H2CQ_FULL_8822B BIT(31) -+#define BIT_CLR_H2CQ_HOST_IDX_8822B BIT(16) -+#define BIT_CLR_H2CQ_HW_IDX_8822B BIT(8) -+#define BIT_STOP_H2CQ_8822B BIT(0) -+ -+/* 2 REG_CHANGE_PCIE_SPEED_8822B */ -+#define BIT_CHANGE_PCIE_SPEED_8822B BIT(18) -+ -+#define BIT_SHIFT_GEN1_GEN2_8822B 16 -+#define BIT_MASK_GEN1_GEN2_8822B 0x3 -+#define BIT_GEN1_GEN2_8822B(x) \ -+ (((x) & BIT_MASK_GEN1_GEN2_8822B) << BIT_SHIFT_GEN1_GEN2_8822B) -+#define BITS_GEN1_GEN2_8822B \ -+ (BIT_MASK_GEN1_GEN2_8822B << BIT_SHIFT_GEN1_GEN2_8822B) -+#define BIT_CLEAR_GEN1_GEN2_8822B(x) ((x) & (~BITS_GEN1_GEN2_8822B)) -+#define BIT_GET_GEN1_GEN2_8822B(x) \ -+ (((x) >> BIT_SHIFT_GEN1_GEN2_8822B) & BIT_MASK_GEN1_GEN2_8822B) -+#define BIT_SET_GEN1_GEN2_8822B(x, v) \ -+ (BIT_CLEAR_GEN1_GEN2_8822B(x) | BIT_GEN1_GEN2_8822B(v)) -+ -+#define BIT_SHIFT_RXDMA_ERROR_COUNTER_8822B 8 -+#define BIT_MASK_RXDMA_ERROR_COUNTER_8822B 0xff -+#define BIT_RXDMA_ERROR_COUNTER_8822B(x) \ -+ (((x) & BIT_MASK_RXDMA_ERROR_COUNTER_8822B) \ -+ << BIT_SHIFT_RXDMA_ERROR_COUNTER_8822B) -+#define BITS_RXDMA_ERROR_COUNTER_8822B \ -+ (BIT_MASK_RXDMA_ERROR_COUNTER_8822B \ -+ << BIT_SHIFT_RXDMA_ERROR_COUNTER_8822B) -+#define BIT_CLEAR_RXDMA_ERROR_COUNTER_8822B(x) \ -+ ((x) & (~BITS_RXDMA_ERROR_COUNTER_8822B)) -+#define BIT_GET_RXDMA_ERROR_COUNTER_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_ERROR_COUNTER_8822B) & \ -+ BIT_MASK_RXDMA_ERROR_COUNTER_8822B) -+#define BIT_SET_RXDMA_ERROR_COUNTER_8822B(x, v) \ -+ (BIT_CLEAR_RXDMA_ERROR_COUNTER_8822B(x) | \ -+ BIT_RXDMA_ERROR_COUNTER_8822B(v)) -+ -+#define BIT_TXDMA_ERROR_HANDLE_STATUS_8822B BIT(7) -+#define BIT_TXDMA_ERROR_PULSE_8822B BIT(6) -+#define BIT_TXDMA_STUCK_ERROR_HANDLE_ENABLE_8822B BIT(5) -+#define BIT_TXDMA_RETURN_ERROR_ENABLE_8822B BIT(4) -+#define BIT_RXDMA_ERROR_HANDLE_STATUS_8822B BIT(3) -+ -+#define BIT_SHIFT_AUTO_HANG_RELEASE_8822B 0 -+#define BIT_MASK_AUTO_HANG_RELEASE_8822B 0x7 -+#define BIT_AUTO_HANG_RELEASE_8822B(x) \ -+ (((x) & BIT_MASK_AUTO_HANG_RELEASE_8822B) \ -+ << BIT_SHIFT_AUTO_HANG_RELEASE_8822B) -+#define BITS_AUTO_HANG_RELEASE_8822B \ -+ (BIT_MASK_AUTO_HANG_RELEASE_8822B << BIT_SHIFT_AUTO_HANG_RELEASE_8822B) -+#define BIT_CLEAR_AUTO_HANG_RELEASE_8822B(x) \ -+ ((x) & (~BITS_AUTO_HANG_RELEASE_8822B)) -+#define BIT_GET_AUTO_HANG_RELEASE_8822B(x) \ -+ (((x) >> BIT_SHIFT_AUTO_HANG_RELEASE_8822B) & \ -+ BIT_MASK_AUTO_HANG_RELEASE_8822B) -+#define BIT_SET_AUTO_HANG_RELEASE_8822B(x, v) \ -+ (BIT_CLEAR_AUTO_HANG_RELEASE_8822B(x) | BIT_AUTO_HANG_RELEASE_8822B(v)) -+ -+/* 2 REG_OLD_DEHANG_8822B */ -+#define BIT_OLD_DEHANG_8822B BIT(1) -+ -+/* 2 REG_Q0_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q0_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_Q0_V1_8822B 0x7f -+#define BIT_QUEUEMACID_Q0_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q0_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_Q0_V1_8822B) -+#define BITS_QUEUEMACID_Q0_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_Q0_V1_8822B << BIT_SHIFT_QUEUEMACID_Q0_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_Q0_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q0_V1_8822B)) -+#define BIT_GET_QUEUEMACID_Q0_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q0_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_Q0_V1_8822B) -+#define BIT_SET_QUEUEMACID_Q0_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q0_V1_8822B(x) | BIT_QUEUEMACID_Q0_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q0_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_Q0_V1_8822B 0x3 -+#define BIT_QUEUEAC_Q0_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q0_V1_8822B) << BIT_SHIFT_QUEUEAC_Q0_V1_8822B) -+#define BITS_QUEUEAC_Q0_V1_8822B \ -+ (BIT_MASK_QUEUEAC_Q0_V1_8822B << BIT_SHIFT_QUEUEAC_Q0_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_Q0_V1_8822B(x) ((x) & (~BITS_QUEUEAC_Q0_V1_8822B)) -+#define BIT_GET_QUEUEAC_Q0_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q0_V1_8822B) & BIT_MASK_QUEUEAC_Q0_V1_8822B) -+#define BIT_SET_QUEUEAC_Q0_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q0_V1_8822B(x) | BIT_QUEUEAC_Q0_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_Q0_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q0_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_Q0_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_Q0_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q0_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_Q0_V2_8822B) -+#define BITS_TAIL_PKT_Q0_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_Q0_V2_8822B << BIT_SHIFT_TAIL_PKT_Q0_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_Q0_V2_8822B(x) ((x) & (~BITS_TAIL_PKT_Q0_V2_8822B)) -+#define BIT_GET_TAIL_PKT_Q0_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q0_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_Q0_V2_8822B) -+#define BIT_SET_TAIL_PKT_Q0_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q0_V2_8822B(x) | BIT_TAIL_PKT_Q0_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q0_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_Q0_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_Q0_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q0_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_Q0_V1_8822B) -+#define BITS_HEAD_PKT_Q0_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_Q0_V1_8822B << BIT_SHIFT_HEAD_PKT_Q0_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_Q0_V1_8822B(x) ((x) & (~BITS_HEAD_PKT_Q0_V1_8822B)) -+#define BIT_GET_HEAD_PKT_Q0_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q0_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_Q0_V1_8822B) -+#define BIT_SET_HEAD_PKT_Q0_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q0_V1_8822B(x) | BIT_HEAD_PKT_Q0_V1_8822B(v)) -+ -+/* 2 REG_Q1_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q1_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_Q1_V1_8822B 0x7f -+#define BIT_QUEUEMACID_Q1_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q1_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_Q1_V1_8822B) -+#define BITS_QUEUEMACID_Q1_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_Q1_V1_8822B << BIT_SHIFT_QUEUEMACID_Q1_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_Q1_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q1_V1_8822B)) -+#define BIT_GET_QUEUEMACID_Q1_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q1_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_Q1_V1_8822B) -+#define BIT_SET_QUEUEMACID_Q1_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q1_V1_8822B(x) | BIT_QUEUEMACID_Q1_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q1_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_Q1_V1_8822B 0x3 -+#define BIT_QUEUEAC_Q1_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q1_V1_8822B) << BIT_SHIFT_QUEUEAC_Q1_V1_8822B) -+#define BITS_QUEUEAC_Q1_V1_8822B \ -+ (BIT_MASK_QUEUEAC_Q1_V1_8822B << BIT_SHIFT_QUEUEAC_Q1_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_Q1_V1_8822B(x) ((x) & (~BITS_QUEUEAC_Q1_V1_8822B)) -+#define BIT_GET_QUEUEAC_Q1_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q1_V1_8822B) & BIT_MASK_QUEUEAC_Q1_V1_8822B) -+#define BIT_SET_QUEUEAC_Q1_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q1_V1_8822B(x) | BIT_QUEUEAC_Q1_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_Q1_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q1_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_Q1_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_Q1_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q1_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_Q1_V2_8822B) -+#define BITS_TAIL_PKT_Q1_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_Q1_V2_8822B << BIT_SHIFT_TAIL_PKT_Q1_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_Q1_V2_8822B(x) ((x) & (~BITS_TAIL_PKT_Q1_V2_8822B)) -+#define BIT_GET_TAIL_PKT_Q1_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q1_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_Q1_V2_8822B) -+#define BIT_SET_TAIL_PKT_Q1_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q1_V2_8822B(x) | BIT_TAIL_PKT_Q1_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q1_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_Q1_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_Q1_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q1_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_Q1_V1_8822B) -+#define BITS_HEAD_PKT_Q1_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_Q1_V1_8822B << BIT_SHIFT_HEAD_PKT_Q1_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_Q1_V1_8822B(x) ((x) & (~BITS_HEAD_PKT_Q1_V1_8822B)) -+#define BIT_GET_HEAD_PKT_Q1_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q1_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_Q1_V1_8822B) -+#define BIT_SET_HEAD_PKT_Q1_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q1_V1_8822B(x) | BIT_HEAD_PKT_Q1_V1_8822B(v)) -+ -+/* 2 REG_Q2_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q2_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_Q2_V1_8822B 0x7f -+#define BIT_QUEUEMACID_Q2_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q2_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_Q2_V1_8822B) -+#define BITS_QUEUEMACID_Q2_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_Q2_V1_8822B << BIT_SHIFT_QUEUEMACID_Q2_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_Q2_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q2_V1_8822B)) -+#define BIT_GET_QUEUEMACID_Q2_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q2_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_Q2_V1_8822B) -+#define BIT_SET_QUEUEMACID_Q2_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q2_V1_8822B(x) | BIT_QUEUEMACID_Q2_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q2_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_Q2_V1_8822B 0x3 -+#define BIT_QUEUEAC_Q2_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q2_V1_8822B) << BIT_SHIFT_QUEUEAC_Q2_V1_8822B) -+#define BITS_QUEUEAC_Q2_V1_8822B \ -+ (BIT_MASK_QUEUEAC_Q2_V1_8822B << BIT_SHIFT_QUEUEAC_Q2_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_Q2_V1_8822B(x) ((x) & (~BITS_QUEUEAC_Q2_V1_8822B)) -+#define BIT_GET_QUEUEAC_Q2_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q2_V1_8822B) & BIT_MASK_QUEUEAC_Q2_V1_8822B) -+#define BIT_SET_QUEUEAC_Q2_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q2_V1_8822B(x) | BIT_QUEUEAC_Q2_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_Q2_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q2_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_Q2_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_Q2_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q2_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_Q2_V2_8822B) -+#define BITS_TAIL_PKT_Q2_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_Q2_V2_8822B << BIT_SHIFT_TAIL_PKT_Q2_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_Q2_V2_8822B(x) ((x) & (~BITS_TAIL_PKT_Q2_V2_8822B)) -+#define BIT_GET_TAIL_PKT_Q2_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q2_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_Q2_V2_8822B) -+#define BIT_SET_TAIL_PKT_Q2_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q2_V2_8822B(x) | BIT_TAIL_PKT_Q2_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q2_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_Q2_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_Q2_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q2_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_Q2_V1_8822B) -+#define BITS_HEAD_PKT_Q2_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_Q2_V1_8822B << BIT_SHIFT_HEAD_PKT_Q2_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_Q2_V1_8822B(x) ((x) & (~BITS_HEAD_PKT_Q2_V1_8822B)) -+#define BIT_GET_HEAD_PKT_Q2_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q2_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_Q2_V1_8822B) -+#define BIT_SET_HEAD_PKT_Q2_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q2_V1_8822B(x) | BIT_HEAD_PKT_Q2_V1_8822B(v)) -+ -+/* 2 REG_Q3_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q3_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_Q3_V1_8822B 0x7f -+#define BIT_QUEUEMACID_Q3_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q3_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_Q3_V1_8822B) -+#define BITS_QUEUEMACID_Q3_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_Q3_V1_8822B << BIT_SHIFT_QUEUEMACID_Q3_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_Q3_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q3_V1_8822B)) -+#define BIT_GET_QUEUEMACID_Q3_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q3_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_Q3_V1_8822B) -+#define BIT_SET_QUEUEMACID_Q3_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q3_V1_8822B(x) | BIT_QUEUEMACID_Q3_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q3_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_Q3_V1_8822B 0x3 -+#define BIT_QUEUEAC_Q3_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q3_V1_8822B) << BIT_SHIFT_QUEUEAC_Q3_V1_8822B) -+#define BITS_QUEUEAC_Q3_V1_8822B \ -+ (BIT_MASK_QUEUEAC_Q3_V1_8822B << BIT_SHIFT_QUEUEAC_Q3_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_Q3_V1_8822B(x) ((x) & (~BITS_QUEUEAC_Q3_V1_8822B)) -+#define BIT_GET_QUEUEAC_Q3_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q3_V1_8822B) & BIT_MASK_QUEUEAC_Q3_V1_8822B) -+#define BIT_SET_QUEUEAC_Q3_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q3_V1_8822B(x) | BIT_QUEUEAC_Q3_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_Q3_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q3_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_Q3_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_Q3_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q3_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_Q3_V2_8822B) -+#define BITS_TAIL_PKT_Q3_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_Q3_V2_8822B << BIT_SHIFT_TAIL_PKT_Q3_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_Q3_V2_8822B(x) ((x) & (~BITS_TAIL_PKT_Q3_V2_8822B)) -+#define BIT_GET_TAIL_PKT_Q3_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q3_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_Q3_V2_8822B) -+#define BIT_SET_TAIL_PKT_Q3_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q3_V2_8822B(x) | BIT_TAIL_PKT_Q3_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q3_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_Q3_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_Q3_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q3_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_Q3_V1_8822B) -+#define BITS_HEAD_PKT_Q3_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_Q3_V1_8822B << BIT_SHIFT_HEAD_PKT_Q3_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_Q3_V1_8822B(x) ((x) & (~BITS_HEAD_PKT_Q3_V1_8822B)) -+#define BIT_GET_HEAD_PKT_Q3_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q3_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_Q3_V1_8822B) -+#define BIT_SET_HEAD_PKT_Q3_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q3_V1_8822B(x) | BIT_HEAD_PKT_Q3_V1_8822B(v)) -+ -+/* 2 REG_MGQ_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_MGQ_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_MGQ_V1_8822B 0x7f -+#define BIT_QUEUEMACID_MGQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_MGQ_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_MGQ_V1_8822B) -+#define BITS_QUEUEMACID_MGQ_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_MGQ_V1_8822B << BIT_SHIFT_QUEUEMACID_MGQ_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_MGQ_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_MGQ_V1_8822B)) -+#define BIT_GET_QUEUEMACID_MGQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_MGQ_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_MGQ_V1_8822B) -+#define BIT_SET_QUEUEMACID_MGQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_MGQ_V1_8822B(x) | BIT_QUEUEMACID_MGQ_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_MGQ_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_MGQ_V1_8822B 0x3 -+#define BIT_QUEUEAC_MGQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_MGQ_V1_8822B) \ -+ << BIT_SHIFT_QUEUEAC_MGQ_V1_8822B) -+#define BITS_QUEUEAC_MGQ_V1_8822B \ -+ (BIT_MASK_QUEUEAC_MGQ_V1_8822B << BIT_SHIFT_QUEUEAC_MGQ_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_MGQ_V1_8822B(x) ((x) & (~BITS_QUEUEAC_MGQ_V1_8822B)) -+#define BIT_GET_QUEUEAC_MGQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_MGQ_V1_8822B) & \ -+ BIT_MASK_QUEUEAC_MGQ_V1_8822B) -+#define BIT_SET_QUEUEAC_MGQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_MGQ_V1_8822B(x) | BIT_QUEUEAC_MGQ_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_MGQ_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_MGQ_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_MGQ_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_MGQ_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_MGQ_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_MGQ_V2_8822B) -+#define BITS_TAIL_PKT_MGQ_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_MGQ_V2_8822B << BIT_SHIFT_TAIL_PKT_MGQ_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_MGQ_V2_8822B(x) ((x) & (~BITS_TAIL_PKT_MGQ_V2_8822B)) -+#define BIT_GET_TAIL_PKT_MGQ_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_MGQ_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_MGQ_V2_8822B) -+#define BIT_SET_TAIL_PKT_MGQ_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_MGQ_V2_8822B(x) | BIT_TAIL_PKT_MGQ_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_MGQ_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_MGQ_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_MGQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_MGQ_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_MGQ_V1_8822B) -+#define BITS_HEAD_PKT_MGQ_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_MGQ_V1_8822B << BIT_SHIFT_HEAD_PKT_MGQ_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_MGQ_V1_8822B(x) ((x) & (~BITS_HEAD_PKT_MGQ_V1_8822B)) -+#define BIT_GET_HEAD_PKT_MGQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_MGQ_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_MGQ_V1_8822B) -+#define BIT_SET_HEAD_PKT_MGQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_MGQ_V1_8822B(x) | BIT_HEAD_PKT_MGQ_V1_8822B(v)) -+ -+/* 2 REG_HIQ_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_HIQ_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_HIQ_V1_8822B 0x7f -+#define BIT_QUEUEMACID_HIQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_HIQ_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_HIQ_V1_8822B) -+#define BITS_QUEUEMACID_HIQ_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_HIQ_V1_8822B << BIT_SHIFT_QUEUEMACID_HIQ_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_HIQ_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_HIQ_V1_8822B)) -+#define BIT_GET_QUEUEMACID_HIQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_HIQ_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_HIQ_V1_8822B) -+#define BIT_SET_QUEUEMACID_HIQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_HIQ_V1_8822B(x) | BIT_QUEUEMACID_HIQ_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_HIQ_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_HIQ_V1_8822B 0x3 -+#define BIT_QUEUEAC_HIQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_HIQ_V1_8822B) \ -+ << BIT_SHIFT_QUEUEAC_HIQ_V1_8822B) -+#define BITS_QUEUEAC_HIQ_V1_8822B \ -+ (BIT_MASK_QUEUEAC_HIQ_V1_8822B << BIT_SHIFT_QUEUEAC_HIQ_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_HIQ_V1_8822B(x) ((x) & (~BITS_QUEUEAC_HIQ_V1_8822B)) -+#define BIT_GET_QUEUEAC_HIQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_HIQ_V1_8822B) & \ -+ BIT_MASK_QUEUEAC_HIQ_V1_8822B) -+#define BIT_SET_QUEUEAC_HIQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_HIQ_V1_8822B(x) | BIT_QUEUEAC_HIQ_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_HIQ_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_HIQ_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_HIQ_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_HIQ_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_HIQ_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_HIQ_V2_8822B) -+#define BITS_TAIL_PKT_HIQ_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_HIQ_V2_8822B << BIT_SHIFT_TAIL_PKT_HIQ_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_HIQ_V2_8822B(x) ((x) & (~BITS_TAIL_PKT_HIQ_V2_8822B)) -+#define BIT_GET_TAIL_PKT_HIQ_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_HIQ_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_HIQ_V2_8822B) -+#define BIT_SET_TAIL_PKT_HIQ_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_HIQ_V2_8822B(x) | BIT_TAIL_PKT_HIQ_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_HIQ_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_HIQ_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_HIQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_HIQ_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_HIQ_V1_8822B) -+#define BITS_HEAD_PKT_HIQ_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_HIQ_V1_8822B << BIT_SHIFT_HEAD_PKT_HIQ_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_HIQ_V1_8822B(x) ((x) & (~BITS_HEAD_PKT_HIQ_V1_8822B)) -+#define BIT_GET_HEAD_PKT_HIQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_HIQ_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_HIQ_V1_8822B) -+#define BIT_SET_HEAD_PKT_HIQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_HIQ_V1_8822B(x) | BIT_HEAD_PKT_HIQ_V1_8822B(v)) -+ -+/* 2 REG_BCNQ_INFO_8822B */ -+ -+#define BIT_SHIFT_BCNQ_HEAD_PG_V1_8822B 0 -+#define BIT_MASK_BCNQ_HEAD_PG_V1_8822B 0xfff -+#define BIT_BCNQ_HEAD_PG_V1_8822B(x) \ -+ (((x) & BIT_MASK_BCNQ_HEAD_PG_V1_8822B) \ -+ << BIT_SHIFT_BCNQ_HEAD_PG_V1_8822B) -+#define BITS_BCNQ_HEAD_PG_V1_8822B \ -+ (BIT_MASK_BCNQ_HEAD_PG_V1_8822B << BIT_SHIFT_BCNQ_HEAD_PG_V1_8822B) -+#define BIT_CLEAR_BCNQ_HEAD_PG_V1_8822B(x) ((x) & (~BITS_BCNQ_HEAD_PG_V1_8822B)) -+#define BIT_GET_BCNQ_HEAD_PG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_HEAD_PG_V1_8822B) & \ -+ BIT_MASK_BCNQ_HEAD_PG_V1_8822B) -+#define BIT_SET_BCNQ_HEAD_PG_V1_8822B(x, v) \ -+ (BIT_CLEAR_BCNQ_HEAD_PG_V1_8822B(x) | BIT_BCNQ_HEAD_PG_V1_8822B(v)) -+ -+/* 2 REG_TXPKT_EMPTY_8822B */ -+#define BIT_BCNQ_EMPTY_8822B BIT(11) -+#define BIT_HQQ_EMPTY_8822B BIT(10) -+#define BIT_MQQ_EMPTY_8822B BIT(9) -+#define BIT_MGQ_CPU_EMPTY_8822B BIT(8) -+#define BIT_AC7Q_EMPTY_8822B BIT(7) -+#define BIT_AC6Q_EMPTY_8822B BIT(6) -+#define BIT_AC5Q_EMPTY_8822B BIT(5) -+#define BIT_AC4Q_EMPTY_8822B BIT(4) -+#define BIT_AC3Q_EMPTY_8822B BIT(3) -+#define BIT_AC2Q_EMPTY_8822B BIT(2) -+#define BIT_AC1Q_EMPTY_8822B BIT(1) -+#define BIT_AC0Q_EMPTY_8822B BIT(0) -+ -+/* 2 REG_CPU_MGQ_INFO_8822B */ -+#define BIT_BCN1_POLL_8822B BIT(30) -+#define BIT_CPUMGT_POLL_8822B BIT(29) -+#define BIT_BCN_POLL_8822B BIT(28) -+#define BIT_CPUMGQ_FW_NUM_V1_8822B BIT(12) -+ -+#define BIT_SHIFT_FW_FREE_TAIL_V1_8822B 0 -+#define BIT_MASK_FW_FREE_TAIL_V1_8822B 0xfff -+#define BIT_FW_FREE_TAIL_V1_8822B(x) \ -+ (((x) & BIT_MASK_FW_FREE_TAIL_V1_8822B) \ -+ << BIT_SHIFT_FW_FREE_TAIL_V1_8822B) -+#define BITS_FW_FREE_TAIL_V1_8822B \ -+ (BIT_MASK_FW_FREE_TAIL_V1_8822B << BIT_SHIFT_FW_FREE_TAIL_V1_8822B) -+#define BIT_CLEAR_FW_FREE_TAIL_V1_8822B(x) ((x) & (~BITS_FW_FREE_TAIL_V1_8822B)) -+#define BIT_GET_FW_FREE_TAIL_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_FW_FREE_TAIL_V1_8822B) & \ -+ BIT_MASK_FW_FREE_TAIL_V1_8822B) -+#define BIT_SET_FW_FREE_TAIL_V1_8822B(x, v) \ -+ (BIT_CLEAR_FW_FREE_TAIL_V1_8822B(x) | BIT_FW_FREE_TAIL_V1_8822B(v)) -+ -+/* 2 REG_FWHW_TXQ_CTRL_8822B */ -+#define BIT_RTS_LIMIT_IN_OFDM_8822B BIT(23) -+#define BIT_EN_BCNQ_DL_8822B BIT(22) -+#define BIT_EN_RD_RESP_NAV_BK_8822B BIT(21) -+#define BIT_EN_WR_FREE_TAIL_8822B BIT(20) -+ -+#define BIT_SHIFT_EN_QUEUE_RPT_8822B 8 -+#define BIT_MASK_EN_QUEUE_RPT_8822B 0xff -+#define BIT_EN_QUEUE_RPT_8822B(x) \ -+ (((x) & BIT_MASK_EN_QUEUE_RPT_8822B) << BIT_SHIFT_EN_QUEUE_RPT_8822B) -+#define BITS_EN_QUEUE_RPT_8822B \ -+ (BIT_MASK_EN_QUEUE_RPT_8822B << BIT_SHIFT_EN_QUEUE_RPT_8822B) -+#define BIT_CLEAR_EN_QUEUE_RPT_8822B(x) ((x) & (~BITS_EN_QUEUE_RPT_8822B)) -+#define BIT_GET_EN_QUEUE_RPT_8822B(x) \ -+ (((x) >> BIT_SHIFT_EN_QUEUE_RPT_8822B) & BIT_MASK_EN_QUEUE_RPT_8822B) -+#define BIT_SET_EN_QUEUE_RPT_8822B(x, v) \ -+ (BIT_CLEAR_EN_QUEUE_RPT_8822B(x) | BIT_EN_QUEUE_RPT_8822B(v)) -+ -+#define BIT_EN_RTY_BK_8822B BIT(7) -+#define BIT_EN_USE_INI_RAT_8822B BIT(6) -+#define BIT_EN_RTS_NAV_BK_8822B BIT(5) -+#define BIT_DIS_SSN_CHECK_8822B BIT(4) -+#define BIT_MACID_MATCH_RTS_8822B BIT(3) -+#define BIT_EN_BCN_TRXRPT_V1_8822B BIT(2) -+#define BIT_EN_FTMACKRPT_8822B BIT(1) -+#define BIT_EN_FTMRPT_8822B BIT(0) -+ -+/* 2 REG_DATAFB_SEL_8822B */ -+ -+#define BIT_SHIFT__R_DATA_FALLBACK_SEL_8822B 0 -+#define BIT_MASK__R_DATA_FALLBACK_SEL_8822B 0x3 -+#define BIT__R_DATA_FALLBACK_SEL_8822B(x) \ -+ (((x) & BIT_MASK__R_DATA_FALLBACK_SEL_8822B) \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL_8822B) -+#define BITS__R_DATA_FALLBACK_SEL_8822B \ -+ (BIT_MASK__R_DATA_FALLBACK_SEL_8822B \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL_8822B) -+#define BIT_CLEAR__R_DATA_FALLBACK_SEL_8822B(x) \ -+ ((x) & (~BITS__R_DATA_FALLBACK_SEL_8822B)) -+#define BIT_GET__R_DATA_FALLBACK_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT__R_DATA_FALLBACK_SEL_8822B) & \ -+ BIT_MASK__R_DATA_FALLBACK_SEL_8822B) -+#define BIT_SET__R_DATA_FALLBACK_SEL_8822B(x, v) \ -+ (BIT_CLEAR__R_DATA_FALLBACK_SEL_8822B(x) | \ -+ BIT__R_DATA_FALLBACK_SEL_8822B(v)) -+ -+/* 2 REG_BCNQ_BDNY_V1_8822B */ -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_V1_8822B 0 -+#define BIT_MASK_BCNQ_PGBNDY_V1_8822B 0xfff -+#define BIT_BCNQ_PGBNDY_V1_8822B(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_V1_8822B) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_V1_8822B) -+#define BITS_BCNQ_PGBNDY_V1_8822B \ -+ (BIT_MASK_BCNQ_PGBNDY_V1_8822B << BIT_SHIFT_BCNQ_PGBNDY_V1_8822B) -+#define BIT_CLEAR_BCNQ_PGBNDY_V1_8822B(x) ((x) & (~BITS_BCNQ_PGBNDY_V1_8822B)) -+#define BIT_GET_BCNQ_PGBNDY_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_V1_8822B) & \ -+ BIT_MASK_BCNQ_PGBNDY_V1_8822B) -+#define BIT_SET_BCNQ_PGBNDY_V1_8822B(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_V1_8822B(x) | BIT_BCNQ_PGBNDY_V1_8822B(v)) -+ -+/* 2 REG_LIFETIME_EN_8822B */ -+#define BIT_BT_INT_CPU_8822B BIT(7) -+#define BIT_BT_INT_PTA_8822B BIT(6) -+#define BIT_EN_CTRL_RTYBIT_8822B BIT(4) -+#define BIT_LIFETIME_BK_EN_8822B BIT(3) -+#define BIT_LIFETIME_BE_EN_8822B BIT(2) -+#define BIT_LIFETIME_VI_EN_8822B BIT(1) -+#define BIT_LIFETIME_VO_EN_8822B BIT(0) -+ -+/* 2 REG_SPEC_SIFS_8822B */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8822B 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_PTCL_8822B 0xff -+#define BIT_SPEC_SIFS_OFDM_PTCL_8822B(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_PTCL_8822B) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8822B) -+#define BITS_SPEC_SIFS_OFDM_PTCL_8822B \ -+ (BIT_MASK_SPEC_SIFS_OFDM_PTCL_8822B \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8822B) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8822B(x) \ -+ ((x) & (~BITS_SPEC_SIFS_OFDM_PTCL_8822B)) -+#define BIT_GET_SPEC_SIFS_OFDM_PTCL_8822B(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8822B) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_PTCL_8822B) -+#define BIT_SET_SPEC_SIFS_OFDM_PTCL_8822B(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8822B(x) | \ -+ BIT_SPEC_SIFS_OFDM_PTCL_8822B(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8822B 0 -+#define BIT_MASK_SPEC_SIFS_CCK_PTCL_8822B 0xff -+#define BIT_SPEC_SIFS_CCK_PTCL_8822B(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_PTCL_8822B) \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8822B) -+#define BITS_SPEC_SIFS_CCK_PTCL_8822B \ -+ (BIT_MASK_SPEC_SIFS_CCK_PTCL_8822B \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8822B) -+#define BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8822B(x) \ -+ ((x) & (~BITS_SPEC_SIFS_CCK_PTCL_8822B)) -+#define BIT_GET_SPEC_SIFS_CCK_PTCL_8822B(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8822B) & \ -+ BIT_MASK_SPEC_SIFS_CCK_PTCL_8822B) -+#define BIT_SET_SPEC_SIFS_CCK_PTCL_8822B(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8822B(x) | \ -+ BIT_SPEC_SIFS_CCK_PTCL_8822B(v)) -+ -+/* 2 REG_RETRY_LIMIT_8822B */ -+ -+#define BIT_SHIFT_SRL_8822B 8 -+#define BIT_MASK_SRL_8822B 0x3f -+#define BIT_SRL_8822B(x) (((x) & BIT_MASK_SRL_8822B) << BIT_SHIFT_SRL_8822B) -+#define BITS_SRL_8822B (BIT_MASK_SRL_8822B << BIT_SHIFT_SRL_8822B) -+#define BIT_CLEAR_SRL_8822B(x) ((x) & (~BITS_SRL_8822B)) -+#define BIT_GET_SRL_8822B(x) (((x) >> BIT_SHIFT_SRL_8822B) & BIT_MASK_SRL_8822B) -+#define BIT_SET_SRL_8822B(x, v) (BIT_CLEAR_SRL_8822B(x) | BIT_SRL_8822B(v)) -+ -+#define BIT_SHIFT_LRL_8822B 0 -+#define BIT_MASK_LRL_8822B 0x3f -+#define BIT_LRL_8822B(x) (((x) & BIT_MASK_LRL_8822B) << BIT_SHIFT_LRL_8822B) -+#define BITS_LRL_8822B (BIT_MASK_LRL_8822B << BIT_SHIFT_LRL_8822B) -+#define BIT_CLEAR_LRL_8822B(x) ((x) & (~BITS_LRL_8822B)) -+#define BIT_GET_LRL_8822B(x) (((x) >> BIT_SHIFT_LRL_8822B) & BIT_MASK_LRL_8822B) -+#define BIT_SET_LRL_8822B(x, v) (BIT_CLEAR_LRL_8822B(x) | BIT_LRL_8822B(v)) -+ -+/* 2 REG_TXBF_CTRL_8822B */ -+#define BIT_R_ENABLE_NDPA_8822B BIT(31) -+#define BIT_USE_NDPA_PARAMETER_8822B BIT(30) -+#define BIT_R_PROP_TXBF_8822B BIT(29) -+#define BIT_R_EN_NDPA_INT_8822B BIT(28) -+#define BIT_R_TXBF1_80M_8822B BIT(27) -+#define BIT_R_TXBF1_40M_8822B BIT(26) -+#define BIT_R_TXBF1_20M_8822B BIT(25) -+ -+#define BIT_SHIFT_R_TXBF1_AID_8822B 16 -+#define BIT_MASK_R_TXBF1_AID_8822B 0x1ff -+#define BIT_R_TXBF1_AID_8822B(x) \ -+ (((x) & BIT_MASK_R_TXBF1_AID_8822B) << BIT_SHIFT_R_TXBF1_AID_8822B) -+#define BITS_R_TXBF1_AID_8822B \ -+ (BIT_MASK_R_TXBF1_AID_8822B << BIT_SHIFT_R_TXBF1_AID_8822B) -+#define BIT_CLEAR_R_TXBF1_AID_8822B(x) ((x) & (~BITS_R_TXBF1_AID_8822B)) -+#define BIT_GET_R_TXBF1_AID_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF1_AID_8822B) & BIT_MASK_R_TXBF1_AID_8822B) -+#define BIT_SET_R_TXBF1_AID_8822B(x, v) \ -+ (BIT_CLEAR_R_TXBF1_AID_8822B(x) | BIT_R_TXBF1_AID_8822B(v)) -+ -+#define BIT_DIS_NDP_BFEN_8822B BIT(15) -+#define BIT_R_TXBCN_NOBLOCK_NDP_8822B BIT(14) -+#define BIT_R_TXBF0_80M_8822B BIT(11) -+#define BIT_R_TXBF0_40M_8822B BIT(10) -+#define BIT_R_TXBF0_20M_8822B BIT(9) -+ -+#define BIT_SHIFT_R_TXBF0_AID_8822B 0 -+#define BIT_MASK_R_TXBF0_AID_8822B 0x1ff -+#define BIT_R_TXBF0_AID_8822B(x) \ -+ (((x) & BIT_MASK_R_TXBF0_AID_8822B) << BIT_SHIFT_R_TXBF0_AID_8822B) -+#define BITS_R_TXBF0_AID_8822B \ -+ (BIT_MASK_R_TXBF0_AID_8822B << BIT_SHIFT_R_TXBF0_AID_8822B) -+#define BIT_CLEAR_R_TXBF0_AID_8822B(x) ((x) & (~BITS_R_TXBF0_AID_8822B)) -+#define BIT_GET_R_TXBF0_AID_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF0_AID_8822B) & BIT_MASK_R_TXBF0_AID_8822B) -+#define BIT_SET_R_TXBF0_AID_8822B(x, v) \ -+ (BIT_CLEAR_R_TXBF0_AID_8822B(x) | BIT_R_TXBF0_AID_8822B(v)) -+ -+/* 2 REG_DARFRC_8822B */ -+ -+#define BIT_SHIFT_DARF_RC8_8822B (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC8_8822B 0x1f -+#define BIT_DARF_RC8_8822B(x) \ -+ (((x) & BIT_MASK_DARF_RC8_8822B) << BIT_SHIFT_DARF_RC8_8822B) -+#define BITS_DARF_RC8_8822B \ -+ (BIT_MASK_DARF_RC8_8822B << BIT_SHIFT_DARF_RC8_8822B) -+#define BIT_CLEAR_DARF_RC8_8822B(x) ((x) & (~BITS_DARF_RC8_8822B)) -+#define BIT_GET_DARF_RC8_8822B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC8_8822B) & BIT_MASK_DARF_RC8_8822B) -+#define BIT_SET_DARF_RC8_8822B(x, v) \ -+ (BIT_CLEAR_DARF_RC8_8822B(x) | BIT_DARF_RC8_8822B(v)) -+ -+#define BIT_SHIFT_DARF_RC7_8822B (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC7_8822B 0x1f -+#define BIT_DARF_RC7_8822B(x) \ -+ (((x) & BIT_MASK_DARF_RC7_8822B) << BIT_SHIFT_DARF_RC7_8822B) -+#define BITS_DARF_RC7_8822B \ -+ (BIT_MASK_DARF_RC7_8822B << BIT_SHIFT_DARF_RC7_8822B) -+#define BIT_CLEAR_DARF_RC7_8822B(x) ((x) & (~BITS_DARF_RC7_8822B)) -+#define BIT_GET_DARF_RC7_8822B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC7_8822B) & BIT_MASK_DARF_RC7_8822B) -+#define BIT_SET_DARF_RC7_8822B(x, v) \ -+ (BIT_CLEAR_DARF_RC7_8822B(x) | BIT_DARF_RC7_8822B(v)) -+ -+#define BIT_SHIFT_DARF_RC6_8822B (40 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC6_8822B 0x1f -+#define BIT_DARF_RC6_8822B(x) \ -+ (((x) & BIT_MASK_DARF_RC6_8822B) << BIT_SHIFT_DARF_RC6_8822B) -+#define BITS_DARF_RC6_8822B \ -+ (BIT_MASK_DARF_RC6_8822B << BIT_SHIFT_DARF_RC6_8822B) -+#define BIT_CLEAR_DARF_RC6_8822B(x) ((x) & (~BITS_DARF_RC6_8822B)) -+#define BIT_GET_DARF_RC6_8822B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC6_8822B) & BIT_MASK_DARF_RC6_8822B) -+#define BIT_SET_DARF_RC6_8822B(x, v) \ -+ (BIT_CLEAR_DARF_RC6_8822B(x) | BIT_DARF_RC6_8822B(v)) -+ -+#define BIT_SHIFT_DARF_RC5_8822B (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_DARF_RC5_8822B 0x1f -+#define BIT_DARF_RC5_8822B(x) \ -+ (((x) & BIT_MASK_DARF_RC5_8822B) << BIT_SHIFT_DARF_RC5_8822B) -+#define BITS_DARF_RC5_8822B \ -+ (BIT_MASK_DARF_RC5_8822B << BIT_SHIFT_DARF_RC5_8822B) -+#define BIT_CLEAR_DARF_RC5_8822B(x) ((x) & (~BITS_DARF_RC5_8822B)) -+#define BIT_GET_DARF_RC5_8822B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC5_8822B) & BIT_MASK_DARF_RC5_8822B) -+#define BIT_SET_DARF_RC5_8822B(x, v) \ -+ (BIT_CLEAR_DARF_RC5_8822B(x) | BIT_DARF_RC5_8822B(v)) -+ -+#define BIT_SHIFT_DARF_RC4_8822B 24 -+#define BIT_MASK_DARF_RC4_8822B 0x1f -+#define BIT_DARF_RC4_8822B(x) \ -+ (((x) & BIT_MASK_DARF_RC4_8822B) << BIT_SHIFT_DARF_RC4_8822B) -+#define BITS_DARF_RC4_8822B \ -+ (BIT_MASK_DARF_RC4_8822B << BIT_SHIFT_DARF_RC4_8822B) -+#define BIT_CLEAR_DARF_RC4_8822B(x) ((x) & (~BITS_DARF_RC4_8822B)) -+#define BIT_GET_DARF_RC4_8822B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC4_8822B) & BIT_MASK_DARF_RC4_8822B) -+#define BIT_SET_DARF_RC4_8822B(x, v) \ -+ (BIT_CLEAR_DARF_RC4_8822B(x) | BIT_DARF_RC4_8822B(v)) -+ -+#define BIT_SHIFT_DARF_RC3_8822B 16 -+#define BIT_MASK_DARF_RC3_8822B 0x1f -+#define BIT_DARF_RC3_8822B(x) \ -+ (((x) & BIT_MASK_DARF_RC3_8822B) << BIT_SHIFT_DARF_RC3_8822B) -+#define BITS_DARF_RC3_8822B \ -+ (BIT_MASK_DARF_RC3_8822B << BIT_SHIFT_DARF_RC3_8822B) -+#define BIT_CLEAR_DARF_RC3_8822B(x) ((x) & (~BITS_DARF_RC3_8822B)) -+#define BIT_GET_DARF_RC3_8822B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC3_8822B) & BIT_MASK_DARF_RC3_8822B) -+#define BIT_SET_DARF_RC3_8822B(x, v) \ -+ (BIT_CLEAR_DARF_RC3_8822B(x) | BIT_DARF_RC3_8822B(v)) -+ -+#define BIT_SHIFT_DARF_RC2_8822B 8 -+#define BIT_MASK_DARF_RC2_8822B 0x1f -+#define BIT_DARF_RC2_8822B(x) \ -+ (((x) & BIT_MASK_DARF_RC2_8822B) << BIT_SHIFT_DARF_RC2_8822B) -+#define BITS_DARF_RC2_8822B \ -+ (BIT_MASK_DARF_RC2_8822B << BIT_SHIFT_DARF_RC2_8822B) -+#define BIT_CLEAR_DARF_RC2_8822B(x) ((x) & (~BITS_DARF_RC2_8822B)) -+#define BIT_GET_DARF_RC2_8822B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC2_8822B) & BIT_MASK_DARF_RC2_8822B) -+#define BIT_SET_DARF_RC2_8822B(x, v) \ -+ (BIT_CLEAR_DARF_RC2_8822B(x) | BIT_DARF_RC2_8822B(v)) -+ -+#define BIT_SHIFT_DARF_RC1_8822B 0 -+#define BIT_MASK_DARF_RC1_8822B 0x1f -+#define BIT_DARF_RC1_8822B(x) \ -+ (((x) & BIT_MASK_DARF_RC1_8822B) << BIT_SHIFT_DARF_RC1_8822B) -+#define BITS_DARF_RC1_8822B \ -+ (BIT_MASK_DARF_RC1_8822B << BIT_SHIFT_DARF_RC1_8822B) -+#define BIT_CLEAR_DARF_RC1_8822B(x) ((x) & (~BITS_DARF_RC1_8822B)) -+#define BIT_GET_DARF_RC1_8822B(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC1_8822B) & BIT_MASK_DARF_RC1_8822B) -+#define BIT_SET_DARF_RC1_8822B(x, v) \ -+ (BIT_CLEAR_DARF_RC1_8822B(x) | BIT_DARF_RC1_8822B(v)) -+ -+/* 2 REG_RARFRC_8822B */ -+ -+#define BIT_SHIFT_RARF_RC8_8822B (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC8_8822B 0x1f -+#define BIT_RARF_RC8_8822B(x) \ -+ (((x) & BIT_MASK_RARF_RC8_8822B) << BIT_SHIFT_RARF_RC8_8822B) -+#define BITS_RARF_RC8_8822B \ -+ (BIT_MASK_RARF_RC8_8822B << BIT_SHIFT_RARF_RC8_8822B) -+#define BIT_CLEAR_RARF_RC8_8822B(x) ((x) & (~BITS_RARF_RC8_8822B)) -+#define BIT_GET_RARF_RC8_8822B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC8_8822B) & BIT_MASK_RARF_RC8_8822B) -+#define BIT_SET_RARF_RC8_8822B(x, v) \ -+ (BIT_CLEAR_RARF_RC8_8822B(x) | BIT_RARF_RC8_8822B(v)) -+ -+#define BIT_SHIFT_RARF_RC7_8822B (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC7_8822B 0x1f -+#define BIT_RARF_RC7_8822B(x) \ -+ (((x) & BIT_MASK_RARF_RC7_8822B) << BIT_SHIFT_RARF_RC7_8822B) -+#define BITS_RARF_RC7_8822B \ -+ (BIT_MASK_RARF_RC7_8822B << BIT_SHIFT_RARF_RC7_8822B) -+#define BIT_CLEAR_RARF_RC7_8822B(x) ((x) & (~BITS_RARF_RC7_8822B)) -+#define BIT_GET_RARF_RC7_8822B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC7_8822B) & BIT_MASK_RARF_RC7_8822B) -+#define BIT_SET_RARF_RC7_8822B(x, v) \ -+ (BIT_CLEAR_RARF_RC7_8822B(x) | BIT_RARF_RC7_8822B(v)) -+ -+#define BIT_SHIFT_RARF_RC6_8822B (40 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC6_8822B 0x1f -+#define BIT_RARF_RC6_8822B(x) \ -+ (((x) & BIT_MASK_RARF_RC6_8822B) << BIT_SHIFT_RARF_RC6_8822B) -+#define BITS_RARF_RC6_8822B \ -+ (BIT_MASK_RARF_RC6_8822B << BIT_SHIFT_RARF_RC6_8822B) -+#define BIT_CLEAR_RARF_RC6_8822B(x) ((x) & (~BITS_RARF_RC6_8822B)) -+#define BIT_GET_RARF_RC6_8822B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC6_8822B) & BIT_MASK_RARF_RC6_8822B) -+#define BIT_SET_RARF_RC6_8822B(x, v) \ -+ (BIT_CLEAR_RARF_RC6_8822B(x) | BIT_RARF_RC6_8822B(v)) -+ -+#define BIT_SHIFT_RARF_RC5_8822B (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_RARF_RC5_8822B 0x1f -+#define BIT_RARF_RC5_8822B(x) \ -+ (((x) & BIT_MASK_RARF_RC5_8822B) << BIT_SHIFT_RARF_RC5_8822B) -+#define BITS_RARF_RC5_8822B \ -+ (BIT_MASK_RARF_RC5_8822B << BIT_SHIFT_RARF_RC5_8822B) -+#define BIT_CLEAR_RARF_RC5_8822B(x) ((x) & (~BITS_RARF_RC5_8822B)) -+#define BIT_GET_RARF_RC5_8822B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC5_8822B) & BIT_MASK_RARF_RC5_8822B) -+#define BIT_SET_RARF_RC5_8822B(x, v) \ -+ (BIT_CLEAR_RARF_RC5_8822B(x) | BIT_RARF_RC5_8822B(v)) -+ -+#define BIT_SHIFT_RARF_RC4_8822B 24 -+#define BIT_MASK_RARF_RC4_8822B 0x1f -+#define BIT_RARF_RC4_8822B(x) \ -+ (((x) & BIT_MASK_RARF_RC4_8822B) << BIT_SHIFT_RARF_RC4_8822B) -+#define BITS_RARF_RC4_8822B \ -+ (BIT_MASK_RARF_RC4_8822B << BIT_SHIFT_RARF_RC4_8822B) -+#define BIT_CLEAR_RARF_RC4_8822B(x) ((x) & (~BITS_RARF_RC4_8822B)) -+#define BIT_GET_RARF_RC4_8822B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC4_8822B) & BIT_MASK_RARF_RC4_8822B) -+#define BIT_SET_RARF_RC4_8822B(x, v) \ -+ (BIT_CLEAR_RARF_RC4_8822B(x) | BIT_RARF_RC4_8822B(v)) -+ -+#define BIT_SHIFT_RARF_RC3_8822B 16 -+#define BIT_MASK_RARF_RC3_8822B 0x1f -+#define BIT_RARF_RC3_8822B(x) \ -+ (((x) & BIT_MASK_RARF_RC3_8822B) << BIT_SHIFT_RARF_RC3_8822B) -+#define BITS_RARF_RC3_8822B \ -+ (BIT_MASK_RARF_RC3_8822B << BIT_SHIFT_RARF_RC3_8822B) -+#define BIT_CLEAR_RARF_RC3_8822B(x) ((x) & (~BITS_RARF_RC3_8822B)) -+#define BIT_GET_RARF_RC3_8822B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC3_8822B) & BIT_MASK_RARF_RC3_8822B) -+#define BIT_SET_RARF_RC3_8822B(x, v) \ -+ (BIT_CLEAR_RARF_RC3_8822B(x) | BIT_RARF_RC3_8822B(v)) -+ -+#define BIT_SHIFT_RARF_RC2_8822B 8 -+#define BIT_MASK_RARF_RC2_8822B 0x1f -+#define BIT_RARF_RC2_8822B(x) \ -+ (((x) & BIT_MASK_RARF_RC2_8822B) << BIT_SHIFT_RARF_RC2_8822B) -+#define BITS_RARF_RC2_8822B \ -+ (BIT_MASK_RARF_RC2_8822B << BIT_SHIFT_RARF_RC2_8822B) -+#define BIT_CLEAR_RARF_RC2_8822B(x) ((x) & (~BITS_RARF_RC2_8822B)) -+#define BIT_GET_RARF_RC2_8822B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC2_8822B) & BIT_MASK_RARF_RC2_8822B) -+#define BIT_SET_RARF_RC2_8822B(x, v) \ -+ (BIT_CLEAR_RARF_RC2_8822B(x) | BIT_RARF_RC2_8822B(v)) -+ -+#define BIT_SHIFT_RARF_RC1_8822B 0 -+#define BIT_MASK_RARF_RC1_8822B 0x1f -+#define BIT_RARF_RC1_8822B(x) \ -+ (((x) & BIT_MASK_RARF_RC1_8822B) << BIT_SHIFT_RARF_RC1_8822B) -+#define BITS_RARF_RC1_8822B \ -+ (BIT_MASK_RARF_RC1_8822B << BIT_SHIFT_RARF_RC1_8822B) -+#define BIT_CLEAR_RARF_RC1_8822B(x) ((x) & (~BITS_RARF_RC1_8822B)) -+#define BIT_GET_RARF_RC1_8822B(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC1_8822B) & BIT_MASK_RARF_RC1_8822B) -+#define BIT_SET_RARF_RC1_8822B(x, v) \ -+ (BIT_CLEAR_RARF_RC1_8822B(x) | BIT_RARF_RC1_8822B(v)) -+ -+/* 2 REG_RRSR_8822B */ -+ -+#define BIT_SHIFT_RRSR_RSC_8822B 21 -+#define BIT_MASK_RRSR_RSC_8822B 0x3 -+#define BIT_RRSR_RSC_8822B(x) \ -+ (((x) & BIT_MASK_RRSR_RSC_8822B) << BIT_SHIFT_RRSR_RSC_8822B) -+#define BITS_RRSR_RSC_8822B \ -+ (BIT_MASK_RRSR_RSC_8822B << BIT_SHIFT_RRSR_RSC_8822B) -+#define BIT_CLEAR_RRSR_RSC_8822B(x) ((x) & (~BITS_RRSR_RSC_8822B)) -+#define BIT_GET_RRSR_RSC_8822B(x) \ -+ (((x) >> BIT_SHIFT_RRSR_RSC_8822B) & BIT_MASK_RRSR_RSC_8822B) -+#define BIT_SET_RRSR_RSC_8822B(x, v) \ -+ (BIT_CLEAR_RRSR_RSC_8822B(x) | BIT_RRSR_RSC_8822B(v)) -+ -+#define BIT_RRSR_BW_8822B BIT(20) -+ -+#define BIT_SHIFT_RRSC_BITMAP_8822B 0 -+#define BIT_MASK_RRSC_BITMAP_8822B 0xfffff -+#define BIT_RRSC_BITMAP_8822B(x) \ -+ (((x) & BIT_MASK_RRSC_BITMAP_8822B) << BIT_SHIFT_RRSC_BITMAP_8822B) -+#define BITS_RRSC_BITMAP_8822B \ -+ (BIT_MASK_RRSC_BITMAP_8822B << BIT_SHIFT_RRSC_BITMAP_8822B) -+#define BIT_CLEAR_RRSC_BITMAP_8822B(x) ((x) & (~BITS_RRSC_BITMAP_8822B)) -+#define BIT_GET_RRSC_BITMAP_8822B(x) \ -+ (((x) >> BIT_SHIFT_RRSC_BITMAP_8822B) & BIT_MASK_RRSC_BITMAP_8822B) -+#define BIT_SET_RRSC_BITMAP_8822B(x, v) \ -+ (BIT_CLEAR_RRSC_BITMAP_8822B(x) | BIT_RRSC_BITMAP_8822B(v)) -+ -+/* 2 REG_ARFR0_8822B */ -+ -+#define BIT_SHIFT_ARFR0_V1_8822B 0 -+#define BIT_MASK_ARFR0_V1_8822B 0xffffffffffffffffL -+#define BIT_ARFR0_V1_8822B(x) \ -+ (((x) & BIT_MASK_ARFR0_V1_8822B) << BIT_SHIFT_ARFR0_V1_8822B) -+#define BITS_ARFR0_V1_8822B \ -+ (BIT_MASK_ARFR0_V1_8822B << BIT_SHIFT_ARFR0_V1_8822B) -+#define BIT_CLEAR_ARFR0_V1_8822B(x) ((x) & (~BITS_ARFR0_V1_8822B)) -+#define BIT_GET_ARFR0_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_ARFR0_V1_8822B) & BIT_MASK_ARFR0_V1_8822B) -+#define BIT_SET_ARFR0_V1_8822B(x, v) \ -+ (BIT_CLEAR_ARFR0_V1_8822B(x) | BIT_ARFR0_V1_8822B(v)) -+ -+/* 2 REG_ARFR1_V1_8822B */ -+ -+#define BIT_SHIFT_ARFR1_V1_8822B 0 -+#define BIT_MASK_ARFR1_V1_8822B 0xffffffffffffffffL -+#define BIT_ARFR1_V1_8822B(x) \ -+ (((x) & BIT_MASK_ARFR1_V1_8822B) << BIT_SHIFT_ARFR1_V1_8822B) -+#define BITS_ARFR1_V1_8822B \ -+ (BIT_MASK_ARFR1_V1_8822B << BIT_SHIFT_ARFR1_V1_8822B) -+#define BIT_CLEAR_ARFR1_V1_8822B(x) ((x) & (~BITS_ARFR1_V1_8822B)) -+#define BIT_GET_ARFR1_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_ARFR1_V1_8822B) & BIT_MASK_ARFR1_V1_8822B) -+#define BIT_SET_ARFR1_V1_8822B(x, v) \ -+ (BIT_CLEAR_ARFR1_V1_8822B(x) | BIT_ARFR1_V1_8822B(v)) -+ -+/* 2 REG_CCK_CHECK_8822B */ -+#define BIT_CHECK_CCK_EN_8822B BIT(7) -+#define BIT_EN_BCN_PKT_REL_8822B BIT(6) -+#define BIT_BCN_PORT_SEL_8822B BIT(5) -+#define BIT_MOREDATA_BYPASS_8822B BIT(4) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_8822B BIT(3) -+#define BIT_R_EN_SET_MOREDATA_8822B BIT(2) -+#define BIT__R_DIS_CLEAR_MACID_RELEASE_8822B BIT(1) -+#define BIT__R_MACID_RELEASE_EN_8822B BIT(0) -+ -+/* 2 REG_AMPDU_MAX_TIME_V1_8822B */ -+ -+#define BIT_SHIFT_AMPDU_MAX_TIME_8822B 0 -+#define BIT_MASK_AMPDU_MAX_TIME_8822B 0xff -+#define BIT_AMPDU_MAX_TIME_8822B(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_TIME_8822B) \ -+ << BIT_SHIFT_AMPDU_MAX_TIME_8822B) -+#define BITS_AMPDU_MAX_TIME_8822B \ -+ (BIT_MASK_AMPDU_MAX_TIME_8822B << BIT_SHIFT_AMPDU_MAX_TIME_8822B) -+#define BIT_CLEAR_AMPDU_MAX_TIME_8822B(x) ((x) & (~BITS_AMPDU_MAX_TIME_8822B)) -+#define BIT_GET_AMPDU_MAX_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_TIME_8822B) & \ -+ BIT_MASK_AMPDU_MAX_TIME_8822B) -+#define BIT_SET_AMPDU_MAX_TIME_8822B(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_TIME_8822B(x) | BIT_AMPDU_MAX_TIME_8822B(v)) -+ -+/* 2 REG_BCNQ1_BDNY_V1_8822B */ -+ -+#define BIT_SHIFT_BCNQ1_PGBNDY_V1_8822B 0 -+#define BIT_MASK_BCNQ1_PGBNDY_V1_8822B 0xfff -+#define BIT_BCNQ1_PGBNDY_V1_8822B(x) \ -+ (((x) & BIT_MASK_BCNQ1_PGBNDY_V1_8822B) \ -+ << BIT_SHIFT_BCNQ1_PGBNDY_V1_8822B) -+#define BITS_BCNQ1_PGBNDY_V1_8822B \ -+ (BIT_MASK_BCNQ1_PGBNDY_V1_8822B << BIT_SHIFT_BCNQ1_PGBNDY_V1_8822B) -+#define BIT_CLEAR_BCNQ1_PGBNDY_V1_8822B(x) ((x) & (~BITS_BCNQ1_PGBNDY_V1_8822B)) -+#define BIT_GET_BCNQ1_PGBNDY_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNQ1_PGBNDY_V1_8822B) & \ -+ BIT_MASK_BCNQ1_PGBNDY_V1_8822B) -+#define BIT_SET_BCNQ1_PGBNDY_V1_8822B(x, v) \ -+ (BIT_CLEAR_BCNQ1_PGBNDY_V1_8822B(x) | BIT_BCNQ1_PGBNDY_V1_8822B(v)) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_8822B */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_8822B 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_8822B 0xffffffffL -+#define BIT_AMPDU_MAX_LENGTH_8822B(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_8822B) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_8822B) -+#define BITS_AMPDU_MAX_LENGTH_8822B \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_8822B << BIT_SHIFT_AMPDU_MAX_LENGTH_8822B) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_8822B(x) \ -+ ((x) & (~BITS_AMPDU_MAX_LENGTH_8822B)) -+#define BIT_GET_AMPDU_MAX_LENGTH_8822B(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_8822B) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_8822B) -+#define BIT_SET_AMPDU_MAX_LENGTH_8822B(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_8822B(x) | BIT_AMPDU_MAX_LENGTH_8822B(v)) -+ -+/* 2 REG_ACQ_STOP_8822B */ -+#define BIT_AC7Q_STOP_8822B BIT(7) -+#define BIT_AC6Q_STOP_8822B BIT(6) -+#define BIT_AC5Q_STOP_8822B BIT(5) -+#define BIT_AC4Q_STOP_8822B BIT(4) -+#define BIT_AC3Q_STOP_8822B BIT(3) -+#define BIT_AC2Q_STOP_8822B BIT(2) -+#define BIT_AC1Q_STOP_8822B BIT(1) -+#define BIT_AC0Q_STOP_8822B BIT(0) -+ -+/* 2 REG_NDPA_RATE_8822B */ -+ -+#define BIT_SHIFT_R_NDPA_RATE_V1_8822B 0 -+#define BIT_MASK_R_NDPA_RATE_V1_8822B 0xff -+#define BIT_R_NDPA_RATE_V1_8822B(x) \ -+ (((x) & BIT_MASK_R_NDPA_RATE_V1_8822B) \ -+ << BIT_SHIFT_R_NDPA_RATE_V1_8822B) -+#define BITS_R_NDPA_RATE_V1_8822B \ -+ (BIT_MASK_R_NDPA_RATE_V1_8822B << BIT_SHIFT_R_NDPA_RATE_V1_8822B) -+#define BIT_CLEAR_R_NDPA_RATE_V1_8822B(x) ((x) & (~BITS_R_NDPA_RATE_V1_8822B)) -+#define BIT_GET_R_NDPA_RATE_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_RATE_V1_8822B) & \ -+ BIT_MASK_R_NDPA_RATE_V1_8822B) -+#define BIT_SET_R_NDPA_RATE_V1_8822B(x, v) \ -+ (BIT_CLEAR_R_NDPA_RATE_V1_8822B(x) | BIT_R_NDPA_RATE_V1_8822B(v)) -+ -+/* 2 REG_TX_HANG_CTRL_8822B */ -+#define BIT_R_EN_GNT_BT_AWAKE_8822B BIT(3) -+#define BIT_EN_EOF_V1_8822B BIT(2) -+#define BIT_DIS_OQT_BLOCK_8822B BIT(1) -+#define BIT_SEARCH_QUEUE_EN_8822B BIT(0) -+ -+/* 2 REG_NDPA_OPT_CTRL_8822B */ -+#define BIT_R_DIS_MACID_RELEASE_RTY_8822B BIT(5) -+ -+#define BIT_SHIFT_BW_SIGTA_8822B 3 -+#define BIT_MASK_BW_SIGTA_8822B 0x3 -+#define BIT_BW_SIGTA_8822B(x) \ -+ (((x) & BIT_MASK_BW_SIGTA_8822B) << BIT_SHIFT_BW_SIGTA_8822B) -+#define BITS_BW_SIGTA_8822B \ -+ (BIT_MASK_BW_SIGTA_8822B << BIT_SHIFT_BW_SIGTA_8822B) -+#define BIT_CLEAR_BW_SIGTA_8822B(x) ((x) & (~BITS_BW_SIGTA_8822B)) -+#define BIT_GET_BW_SIGTA_8822B(x) \ -+ (((x) >> BIT_SHIFT_BW_SIGTA_8822B) & BIT_MASK_BW_SIGTA_8822B) -+#define BIT_SET_BW_SIGTA_8822B(x, v) \ -+ (BIT_CLEAR_BW_SIGTA_8822B(x) | BIT_BW_SIGTA_8822B(v)) -+ -+#define BIT_EN_BAR_SIGTA_8822B BIT(2) -+ -+#define BIT_SHIFT_R_NDPA_BW_8822B 0 -+#define BIT_MASK_R_NDPA_BW_8822B 0x3 -+#define BIT_R_NDPA_BW_8822B(x) \ -+ (((x) & BIT_MASK_R_NDPA_BW_8822B) << BIT_SHIFT_R_NDPA_BW_8822B) -+#define BITS_R_NDPA_BW_8822B \ -+ (BIT_MASK_R_NDPA_BW_8822B << BIT_SHIFT_R_NDPA_BW_8822B) -+#define BIT_CLEAR_R_NDPA_BW_8822B(x) ((x) & (~BITS_R_NDPA_BW_8822B)) -+#define BIT_GET_R_NDPA_BW_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_BW_8822B) & BIT_MASK_R_NDPA_BW_8822B) -+#define BIT_SET_R_NDPA_BW_8822B(x, v) \ -+ (BIT_CLEAR_R_NDPA_BW_8822B(x) | BIT_R_NDPA_BW_8822B(v)) -+ -+/* 2 REG_RD_RESP_PKT_TH_8822B */ -+ -+#define BIT_SHIFT_RD_RESP_PKT_TH_V1_8822B 0 -+#define BIT_MASK_RD_RESP_PKT_TH_V1_8822B 0x3f -+#define BIT_RD_RESP_PKT_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_RD_RESP_PKT_TH_V1_8822B) \ -+ << BIT_SHIFT_RD_RESP_PKT_TH_V1_8822B) -+#define BITS_RD_RESP_PKT_TH_V1_8822B \ -+ (BIT_MASK_RD_RESP_PKT_TH_V1_8822B << BIT_SHIFT_RD_RESP_PKT_TH_V1_8822B) -+#define BIT_CLEAR_RD_RESP_PKT_TH_V1_8822B(x) \ -+ ((x) & (~BITS_RD_RESP_PKT_TH_V1_8822B)) -+#define BIT_GET_RD_RESP_PKT_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_RD_RESP_PKT_TH_V1_8822B) & \ -+ BIT_MASK_RD_RESP_PKT_TH_V1_8822B) -+#define BIT_SET_RD_RESP_PKT_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_RD_RESP_PKT_TH_V1_8822B(x) | BIT_RD_RESP_PKT_TH_V1_8822B(v)) -+ -+/* 2 REG_CMDQ_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_CMDQ_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_CMDQ_V1_8822B 0x7f -+#define BIT_QUEUEMACID_CMDQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_CMDQ_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_CMDQ_V1_8822B) -+#define BITS_QUEUEMACID_CMDQ_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_CMDQ_V1_8822B \ -+ << BIT_SHIFT_QUEUEMACID_CMDQ_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_CMDQ_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_CMDQ_V1_8822B)) -+#define BIT_GET_QUEUEMACID_CMDQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_CMDQ_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_CMDQ_V1_8822B) -+#define BIT_SET_QUEUEMACID_CMDQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_CMDQ_V1_8822B(x) | \ -+ BIT_QUEUEMACID_CMDQ_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_CMDQ_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_CMDQ_V1_8822B 0x3 -+#define BIT_QUEUEAC_CMDQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_CMDQ_V1_8822B) \ -+ << BIT_SHIFT_QUEUEAC_CMDQ_V1_8822B) -+#define BITS_QUEUEAC_CMDQ_V1_8822B \ -+ (BIT_MASK_QUEUEAC_CMDQ_V1_8822B << BIT_SHIFT_QUEUEAC_CMDQ_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_CMDQ_V1_8822B(x) ((x) & (~BITS_QUEUEAC_CMDQ_V1_8822B)) -+#define BIT_GET_QUEUEAC_CMDQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_CMDQ_V1_8822B) & \ -+ BIT_MASK_QUEUEAC_CMDQ_V1_8822B) -+#define BIT_SET_QUEUEAC_CMDQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_CMDQ_V1_8822B(x) | BIT_QUEUEAC_CMDQ_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_CMDQ_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_CMDQ_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_CMDQ_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_CMDQ_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_CMDQ_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_CMDQ_V2_8822B) -+#define BITS_TAIL_PKT_CMDQ_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_CMDQ_V2_8822B << BIT_SHIFT_TAIL_PKT_CMDQ_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_CMDQ_V2_8822B(x) \ -+ ((x) & (~BITS_TAIL_PKT_CMDQ_V2_8822B)) -+#define BIT_GET_TAIL_PKT_CMDQ_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_CMDQ_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_CMDQ_V2_8822B) -+#define BIT_SET_TAIL_PKT_CMDQ_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_CMDQ_V2_8822B(x) | BIT_TAIL_PKT_CMDQ_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_CMDQ_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_CMDQ_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_CMDQ_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_CMDQ_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_CMDQ_V1_8822B) -+#define BITS_HEAD_PKT_CMDQ_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_CMDQ_V1_8822B << BIT_SHIFT_HEAD_PKT_CMDQ_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_CMDQ_V1_8822B(x) \ -+ ((x) & (~BITS_HEAD_PKT_CMDQ_V1_8822B)) -+#define BIT_GET_HEAD_PKT_CMDQ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_CMDQ_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_CMDQ_V1_8822B) -+#define BIT_SET_HEAD_PKT_CMDQ_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_CMDQ_V1_8822B(x) | BIT_HEAD_PKT_CMDQ_V1_8822B(v)) -+ -+/* 2 REG_Q4_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q4_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_Q4_V1_8822B 0x7f -+#define BIT_QUEUEMACID_Q4_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q4_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_Q4_V1_8822B) -+#define BITS_QUEUEMACID_Q4_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_Q4_V1_8822B << BIT_SHIFT_QUEUEMACID_Q4_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_Q4_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q4_V1_8822B)) -+#define BIT_GET_QUEUEMACID_Q4_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q4_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_Q4_V1_8822B) -+#define BIT_SET_QUEUEMACID_Q4_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q4_V1_8822B(x) | BIT_QUEUEMACID_Q4_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q4_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_Q4_V1_8822B 0x3 -+#define BIT_QUEUEAC_Q4_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q4_V1_8822B) << BIT_SHIFT_QUEUEAC_Q4_V1_8822B) -+#define BITS_QUEUEAC_Q4_V1_8822B \ -+ (BIT_MASK_QUEUEAC_Q4_V1_8822B << BIT_SHIFT_QUEUEAC_Q4_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_Q4_V1_8822B(x) ((x) & (~BITS_QUEUEAC_Q4_V1_8822B)) -+#define BIT_GET_QUEUEAC_Q4_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q4_V1_8822B) & BIT_MASK_QUEUEAC_Q4_V1_8822B) -+#define BIT_SET_QUEUEAC_Q4_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q4_V1_8822B(x) | BIT_QUEUEAC_Q4_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_Q4_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q4_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_Q4_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_Q4_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q4_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_Q4_V2_8822B) -+#define BITS_TAIL_PKT_Q4_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_Q4_V2_8822B << BIT_SHIFT_TAIL_PKT_Q4_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_Q4_V2_8822B(x) ((x) & (~BITS_TAIL_PKT_Q4_V2_8822B)) -+#define BIT_GET_TAIL_PKT_Q4_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q4_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_Q4_V2_8822B) -+#define BIT_SET_TAIL_PKT_Q4_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q4_V2_8822B(x) | BIT_TAIL_PKT_Q4_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q4_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_Q4_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_Q4_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q4_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_Q4_V1_8822B) -+#define BITS_HEAD_PKT_Q4_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_Q4_V1_8822B << BIT_SHIFT_HEAD_PKT_Q4_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_Q4_V1_8822B(x) ((x) & (~BITS_HEAD_PKT_Q4_V1_8822B)) -+#define BIT_GET_HEAD_PKT_Q4_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q4_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_Q4_V1_8822B) -+#define BIT_SET_HEAD_PKT_Q4_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q4_V1_8822B(x) | BIT_HEAD_PKT_Q4_V1_8822B(v)) -+ -+/* 2 REG_Q5_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q5_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_Q5_V1_8822B 0x7f -+#define BIT_QUEUEMACID_Q5_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q5_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_Q5_V1_8822B) -+#define BITS_QUEUEMACID_Q5_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_Q5_V1_8822B << BIT_SHIFT_QUEUEMACID_Q5_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_Q5_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q5_V1_8822B)) -+#define BIT_GET_QUEUEMACID_Q5_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q5_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_Q5_V1_8822B) -+#define BIT_SET_QUEUEMACID_Q5_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q5_V1_8822B(x) | BIT_QUEUEMACID_Q5_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q5_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_Q5_V1_8822B 0x3 -+#define BIT_QUEUEAC_Q5_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q5_V1_8822B) << BIT_SHIFT_QUEUEAC_Q5_V1_8822B) -+#define BITS_QUEUEAC_Q5_V1_8822B \ -+ (BIT_MASK_QUEUEAC_Q5_V1_8822B << BIT_SHIFT_QUEUEAC_Q5_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_Q5_V1_8822B(x) ((x) & (~BITS_QUEUEAC_Q5_V1_8822B)) -+#define BIT_GET_QUEUEAC_Q5_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q5_V1_8822B) & BIT_MASK_QUEUEAC_Q5_V1_8822B) -+#define BIT_SET_QUEUEAC_Q5_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q5_V1_8822B(x) | BIT_QUEUEAC_Q5_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_Q5_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q5_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_Q5_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_Q5_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q5_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_Q5_V2_8822B) -+#define BITS_TAIL_PKT_Q5_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_Q5_V2_8822B << BIT_SHIFT_TAIL_PKT_Q5_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_Q5_V2_8822B(x) ((x) & (~BITS_TAIL_PKT_Q5_V2_8822B)) -+#define BIT_GET_TAIL_PKT_Q5_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q5_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_Q5_V2_8822B) -+#define BIT_SET_TAIL_PKT_Q5_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q5_V2_8822B(x) | BIT_TAIL_PKT_Q5_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q5_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_Q5_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_Q5_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q5_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_Q5_V1_8822B) -+#define BITS_HEAD_PKT_Q5_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_Q5_V1_8822B << BIT_SHIFT_HEAD_PKT_Q5_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_Q5_V1_8822B(x) ((x) & (~BITS_HEAD_PKT_Q5_V1_8822B)) -+#define BIT_GET_HEAD_PKT_Q5_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q5_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_Q5_V1_8822B) -+#define BIT_SET_HEAD_PKT_Q5_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q5_V1_8822B(x) | BIT_HEAD_PKT_Q5_V1_8822B(v)) -+ -+/* 2 REG_Q6_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q6_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_Q6_V1_8822B 0x7f -+#define BIT_QUEUEMACID_Q6_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q6_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_Q6_V1_8822B) -+#define BITS_QUEUEMACID_Q6_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_Q6_V1_8822B << BIT_SHIFT_QUEUEMACID_Q6_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_Q6_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q6_V1_8822B)) -+#define BIT_GET_QUEUEMACID_Q6_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q6_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_Q6_V1_8822B) -+#define BIT_SET_QUEUEMACID_Q6_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q6_V1_8822B(x) | BIT_QUEUEMACID_Q6_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q6_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_Q6_V1_8822B 0x3 -+#define BIT_QUEUEAC_Q6_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q6_V1_8822B) << BIT_SHIFT_QUEUEAC_Q6_V1_8822B) -+#define BITS_QUEUEAC_Q6_V1_8822B \ -+ (BIT_MASK_QUEUEAC_Q6_V1_8822B << BIT_SHIFT_QUEUEAC_Q6_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_Q6_V1_8822B(x) ((x) & (~BITS_QUEUEAC_Q6_V1_8822B)) -+#define BIT_GET_QUEUEAC_Q6_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q6_V1_8822B) & BIT_MASK_QUEUEAC_Q6_V1_8822B) -+#define BIT_SET_QUEUEAC_Q6_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q6_V1_8822B(x) | BIT_QUEUEAC_Q6_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_Q6_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q6_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_Q6_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_Q6_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q6_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_Q6_V2_8822B) -+#define BITS_TAIL_PKT_Q6_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_Q6_V2_8822B << BIT_SHIFT_TAIL_PKT_Q6_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_Q6_V2_8822B(x) ((x) & (~BITS_TAIL_PKT_Q6_V2_8822B)) -+#define BIT_GET_TAIL_PKT_Q6_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q6_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_Q6_V2_8822B) -+#define BIT_SET_TAIL_PKT_Q6_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q6_V2_8822B(x) | BIT_TAIL_PKT_Q6_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q6_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_Q6_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_Q6_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q6_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_Q6_V1_8822B) -+#define BITS_HEAD_PKT_Q6_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_Q6_V1_8822B << BIT_SHIFT_HEAD_PKT_Q6_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_Q6_V1_8822B(x) ((x) & (~BITS_HEAD_PKT_Q6_V1_8822B)) -+#define BIT_GET_HEAD_PKT_Q6_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q6_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_Q6_V1_8822B) -+#define BIT_SET_HEAD_PKT_Q6_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q6_V1_8822B(x) | BIT_HEAD_PKT_Q6_V1_8822B(v)) -+ -+/* 2 REG_Q7_INFO_8822B */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q7_V1_8822B 25 -+#define BIT_MASK_QUEUEMACID_Q7_V1_8822B 0x7f -+#define BIT_QUEUEMACID_Q7_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q7_V1_8822B) \ -+ << BIT_SHIFT_QUEUEMACID_Q7_V1_8822B) -+#define BITS_QUEUEMACID_Q7_V1_8822B \ -+ (BIT_MASK_QUEUEMACID_Q7_V1_8822B << BIT_SHIFT_QUEUEMACID_Q7_V1_8822B) -+#define BIT_CLEAR_QUEUEMACID_Q7_V1_8822B(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q7_V1_8822B)) -+#define BIT_GET_QUEUEMACID_Q7_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q7_V1_8822B) & \ -+ BIT_MASK_QUEUEMACID_Q7_V1_8822B) -+#define BIT_SET_QUEUEMACID_Q7_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q7_V1_8822B(x) | BIT_QUEUEMACID_Q7_V1_8822B(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q7_V1_8822B 23 -+#define BIT_MASK_QUEUEAC_Q7_V1_8822B 0x3 -+#define BIT_QUEUEAC_Q7_V1_8822B(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q7_V1_8822B) << BIT_SHIFT_QUEUEAC_Q7_V1_8822B) -+#define BITS_QUEUEAC_Q7_V1_8822B \ -+ (BIT_MASK_QUEUEAC_Q7_V1_8822B << BIT_SHIFT_QUEUEAC_Q7_V1_8822B) -+#define BIT_CLEAR_QUEUEAC_Q7_V1_8822B(x) ((x) & (~BITS_QUEUEAC_Q7_V1_8822B)) -+#define BIT_GET_QUEUEAC_Q7_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q7_V1_8822B) & BIT_MASK_QUEUEAC_Q7_V1_8822B) -+#define BIT_SET_QUEUEAC_Q7_V1_8822B(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q7_V1_8822B(x) | BIT_QUEUEAC_Q7_V1_8822B(v)) -+ -+#define BIT_TIDEMPTY_Q7_V1_8822B BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q7_V2_8822B 11 -+#define BIT_MASK_TAIL_PKT_Q7_V2_8822B 0x7ff -+#define BIT_TAIL_PKT_Q7_V2_8822B(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q7_V2_8822B) \ -+ << BIT_SHIFT_TAIL_PKT_Q7_V2_8822B) -+#define BITS_TAIL_PKT_Q7_V2_8822B \ -+ (BIT_MASK_TAIL_PKT_Q7_V2_8822B << BIT_SHIFT_TAIL_PKT_Q7_V2_8822B) -+#define BIT_CLEAR_TAIL_PKT_Q7_V2_8822B(x) ((x) & (~BITS_TAIL_PKT_Q7_V2_8822B)) -+#define BIT_GET_TAIL_PKT_Q7_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q7_V2_8822B) & \ -+ BIT_MASK_TAIL_PKT_Q7_V2_8822B) -+#define BIT_SET_TAIL_PKT_Q7_V2_8822B(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q7_V2_8822B(x) | BIT_TAIL_PKT_Q7_V2_8822B(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q7_V1_8822B 0 -+#define BIT_MASK_HEAD_PKT_Q7_V1_8822B 0x7ff -+#define BIT_HEAD_PKT_Q7_V1_8822B(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q7_V1_8822B) \ -+ << BIT_SHIFT_HEAD_PKT_Q7_V1_8822B) -+#define BITS_HEAD_PKT_Q7_V1_8822B \ -+ (BIT_MASK_HEAD_PKT_Q7_V1_8822B << BIT_SHIFT_HEAD_PKT_Q7_V1_8822B) -+#define BIT_CLEAR_HEAD_PKT_Q7_V1_8822B(x) ((x) & (~BITS_HEAD_PKT_Q7_V1_8822B)) -+#define BIT_GET_HEAD_PKT_Q7_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q7_V1_8822B) & \ -+ BIT_MASK_HEAD_PKT_Q7_V1_8822B) -+#define BIT_SET_HEAD_PKT_Q7_V1_8822B(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q7_V1_8822B(x) | BIT_HEAD_PKT_Q7_V1_8822B(v)) -+ -+/* 2 REG_WMAC_LBK_BUF_HD_V1_8822B */ -+ -+#define BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8822B 0 -+#define BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8822B 0xfff -+#define BIT_WMAC_LBK_BUF_HEAD_V1_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8822B) \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8822B) -+#define BITS_WMAC_LBK_BUF_HEAD_V1_8822B \ -+ (BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8822B \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8822B) -+#define BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8822B(x) \ -+ ((x) & (~BITS_WMAC_LBK_BUF_HEAD_V1_8822B)) -+#define BIT_GET_WMAC_LBK_BUF_HEAD_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8822B) & \ -+ BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8822B) -+#define BIT_SET_WMAC_LBK_BUF_HEAD_V1_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8822B(x) | \ -+ BIT_WMAC_LBK_BUF_HEAD_V1_8822B(v)) -+ -+/* 2 REG_MGQ_BDNY_V1_8822B */ -+ -+#define BIT_SHIFT_MGQ_PGBNDY_V1_8822B 0 -+#define BIT_MASK_MGQ_PGBNDY_V1_8822B 0xfff -+#define BIT_MGQ_PGBNDY_V1_8822B(x) \ -+ (((x) & BIT_MASK_MGQ_PGBNDY_V1_8822B) << BIT_SHIFT_MGQ_PGBNDY_V1_8822B) -+#define BITS_MGQ_PGBNDY_V1_8822B \ -+ (BIT_MASK_MGQ_PGBNDY_V1_8822B << BIT_SHIFT_MGQ_PGBNDY_V1_8822B) -+#define BIT_CLEAR_MGQ_PGBNDY_V1_8822B(x) ((x) & (~BITS_MGQ_PGBNDY_V1_8822B)) -+#define BIT_GET_MGQ_PGBNDY_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PGBNDY_V1_8822B) & BIT_MASK_MGQ_PGBNDY_V1_8822B) -+#define BIT_SET_MGQ_PGBNDY_V1_8822B(x, v) \ -+ (BIT_CLEAR_MGQ_PGBNDY_V1_8822B(x) | BIT_MGQ_PGBNDY_V1_8822B(v)) -+ -+/* 2 REG_TXRPT_CTRL_8822B */ -+ -+#define BIT_SHIFT_TRXRPT_TIMER_TH_8822B 24 -+#define BIT_MASK_TRXRPT_TIMER_TH_8822B 0xff -+#define BIT_TRXRPT_TIMER_TH_8822B(x) \ -+ (((x) & BIT_MASK_TRXRPT_TIMER_TH_8822B) \ -+ << BIT_SHIFT_TRXRPT_TIMER_TH_8822B) -+#define BITS_TRXRPT_TIMER_TH_8822B \ -+ (BIT_MASK_TRXRPT_TIMER_TH_8822B << BIT_SHIFT_TRXRPT_TIMER_TH_8822B) -+#define BIT_CLEAR_TRXRPT_TIMER_TH_8822B(x) ((x) & (~BITS_TRXRPT_TIMER_TH_8822B)) -+#define BIT_GET_TRXRPT_TIMER_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_TIMER_TH_8822B) & \ -+ BIT_MASK_TRXRPT_TIMER_TH_8822B) -+#define BIT_SET_TRXRPT_TIMER_TH_8822B(x, v) \ -+ (BIT_CLEAR_TRXRPT_TIMER_TH_8822B(x) | BIT_TRXRPT_TIMER_TH_8822B(v)) -+ -+#define BIT_SHIFT_TRXRPT_LEN_TH_8822B 16 -+#define BIT_MASK_TRXRPT_LEN_TH_8822B 0xff -+#define BIT_TRXRPT_LEN_TH_8822B(x) \ -+ (((x) & BIT_MASK_TRXRPT_LEN_TH_8822B) << BIT_SHIFT_TRXRPT_LEN_TH_8822B) -+#define BITS_TRXRPT_LEN_TH_8822B \ -+ (BIT_MASK_TRXRPT_LEN_TH_8822B << BIT_SHIFT_TRXRPT_LEN_TH_8822B) -+#define BIT_CLEAR_TRXRPT_LEN_TH_8822B(x) ((x) & (~BITS_TRXRPT_LEN_TH_8822B)) -+#define BIT_GET_TRXRPT_LEN_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_LEN_TH_8822B) & BIT_MASK_TRXRPT_LEN_TH_8822B) -+#define BIT_SET_TRXRPT_LEN_TH_8822B(x, v) \ -+ (BIT_CLEAR_TRXRPT_LEN_TH_8822B(x) | BIT_TRXRPT_LEN_TH_8822B(v)) -+ -+#define BIT_SHIFT_TRXRPT_READ_PTR_8822B 8 -+#define BIT_MASK_TRXRPT_READ_PTR_8822B 0xff -+#define BIT_TRXRPT_READ_PTR_8822B(x) \ -+ (((x) & BIT_MASK_TRXRPT_READ_PTR_8822B) \ -+ << BIT_SHIFT_TRXRPT_READ_PTR_8822B) -+#define BITS_TRXRPT_READ_PTR_8822B \ -+ (BIT_MASK_TRXRPT_READ_PTR_8822B << BIT_SHIFT_TRXRPT_READ_PTR_8822B) -+#define BIT_CLEAR_TRXRPT_READ_PTR_8822B(x) ((x) & (~BITS_TRXRPT_READ_PTR_8822B)) -+#define BIT_GET_TRXRPT_READ_PTR_8822B(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_READ_PTR_8822B) & \ -+ BIT_MASK_TRXRPT_READ_PTR_8822B) -+#define BIT_SET_TRXRPT_READ_PTR_8822B(x, v) \ -+ (BIT_CLEAR_TRXRPT_READ_PTR_8822B(x) | BIT_TRXRPT_READ_PTR_8822B(v)) -+ -+#define BIT_SHIFT_TRXRPT_WRITE_PTR_8822B 0 -+#define BIT_MASK_TRXRPT_WRITE_PTR_8822B 0xff -+#define BIT_TRXRPT_WRITE_PTR_8822B(x) \ -+ (((x) & BIT_MASK_TRXRPT_WRITE_PTR_8822B) \ -+ << BIT_SHIFT_TRXRPT_WRITE_PTR_8822B) -+#define BITS_TRXRPT_WRITE_PTR_8822B \ -+ (BIT_MASK_TRXRPT_WRITE_PTR_8822B << BIT_SHIFT_TRXRPT_WRITE_PTR_8822B) -+#define BIT_CLEAR_TRXRPT_WRITE_PTR_8822B(x) \ -+ ((x) & (~BITS_TRXRPT_WRITE_PTR_8822B)) -+#define BIT_GET_TRXRPT_WRITE_PTR_8822B(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_WRITE_PTR_8822B) & \ -+ BIT_MASK_TRXRPT_WRITE_PTR_8822B) -+#define BIT_SET_TRXRPT_WRITE_PTR_8822B(x, v) \ -+ (BIT_CLEAR_TRXRPT_WRITE_PTR_8822B(x) | BIT_TRXRPT_WRITE_PTR_8822B(v)) -+ -+/* 2 REG_INIRTS_RATE_SEL_8822B */ -+#define BIT_LEAG_RTS_BW_DUP_8822B BIT(5) -+ -+/* 2 REG_BASIC_CFEND_RATE_8822B */ -+ -+#define BIT_SHIFT_BASIC_CFEND_RATE_8822B 0 -+#define BIT_MASK_BASIC_CFEND_RATE_8822B 0x1f -+#define BIT_BASIC_CFEND_RATE_8822B(x) \ -+ (((x) & BIT_MASK_BASIC_CFEND_RATE_8822B) \ -+ << BIT_SHIFT_BASIC_CFEND_RATE_8822B) -+#define BITS_BASIC_CFEND_RATE_8822B \ -+ (BIT_MASK_BASIC_CFEND_RATE_8822B << BIT_SHIFT_BASIC_CFEND_RATE_8822B) -+#define BIT_CLEAR_BASIC_CFEND_RATE_8822B(x) \ -+ ((x) & (~BITS_BASIC_CFEND_RATE_8822B)) -+#define BIT_GET_BASIC_CFEND_RATE_8822B(x) \ -+ (((x) >> BIT_SHIFT_BASIC_CFEND_RATE_8822B) & \ -+ BIT_MASK_BASIC_CFEND_RATE_8822B) -+#define BIT_SET_BASIC_CFEND_RATE_8822B(x, v) \ -+ (BIT_CLEAR_BASIC_CFEND_RATE_8822B(x) | BIT_BASIC_CFEND_RATE_8822B(v)) -+ -+/* 2 REG_STBC_CFEND_RATE_8822B */ -+ -+#define BIT_SHIFT_STBC_CFEND_RATE_8822B 0 -+#define BIT_MASK_STBC_CFEND_RATE_8822B 0x1f -+#define BIT_STBC_CFEND_RATE_8822B(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_RATE_8822B) \ -+ << BIT_SHIFT_STBC_CFEND_RATE_8822B) -+#define BITS_STBC_CFEND_RATE_8822B \ -+ (BIT_MASK_STBC_CFEND_RATE_8822B << BIT_SHIFT_STBC_CFEND_RATE_8822B) -+#define BIT_CLEAR_STBC_CFEND_RATE_8822B(x) ((x) & (~BITS_STBC_CFEND_RATE_8822B)) -+#define BIT_GET_STBC_CFEND_RATE_8822B(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_RATE_8822B) & \ -+ BIT_MASK_STBC_CFEND_RATE_8822B) -+#define BIT_SET_STBC_CFEND_RATE_8822B(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_RATE_8822B(x) | BIT_STBC_CFEND_RATE_8822B(v)) -+ -+/* 2 REG_DATA_SC_8822B */ -+ -+#define BIT_SHIFT_TXSC_40M_8822B 4 -+#define BIT_MASK_TXSC_40M_8822B 0xf -+#define BIT_TXSC_40M_8822B(x) \ -+ (((x) & BIT_MASK_TXSC_40M_8822B) << BIT_SHIFT_TXSC_40M_8822B) -+#define BITS_TXSC_40M_8822B \ -+ (BIT_MASK_TXSC_40M_8822B << BIT_SHIFT_TXSC_40M_8822B) -+#define BIT_CLEAR_TXSC_40M_8822B(x) ((x) & (~BITS_TXSC_40M_8822B)) -+#define BIT_GET_TXSC_40M_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXSC_40M_8822B) & BIT_MASK_TXSC_40M_8822B) -+#define BIT_SET_TXSC_40M_8822B(x, v) \ -+ (BIT_CLEAR_TXSC_40M_8822B(x) | BIT_TXSC_40M_8822B(v)) -+ -+#define BIT_SHIFT_TXSC_20M_8822B 0 -+#define BIT_MASK_TXSC_20M_8822B 0xf -+#define BIT_TXSC_20M_8822B(x) \ -+ (((x) & BIT_MASK_TXSC_20M_8822B) << BIT_SHIFT_TXSC_20M_8822B) -+#define BITS_TXSC_20M_8822B \ -+ (BIT_MASK_TXSC_20M_8822B << BIT_SHIFT_TXSC_20M_8822B) -+#define BIT_CLEAR_TXSC_20M_8822B(x) ((x) & (~BITS_TXSC_20M_8822B)) -+#define BIT_GET_TXSC_20M_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXSC_20M_8822B) & BIT_MASK_TXSC_20M_8822B) -+#define BIT_SET_TXSC_20M_8822B(x, v) \ -+ (BIT_CLEAR_TXSC_20M_8822B(x) | BIT_TXSC_20M_8822B(v)) -+ -+/* 2 REG_MACID_SLEEP3_8822B */ -+ -+#define BIT_SHIFT_MACID127_96_PKTSLEEP_8822B 0 -+#define BIT_MASK_MACID127_96_PKTSLEEP_8822B 0xffffffffL -+#define BIT_MACID127_96_PKTSLEEP_8822B(x) \ -+ (((x) & BIT_MASK_MACID127_96_PKTSLEEP_8822B) \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP_8822B) -+#define BITS_MACID127_96_PKTSLEEP_8822B \ -+ (BIT_MASK_MACID127_96_PKTSLEEP_8822B \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP_8822B) -+#define BIT_CLEAR_MACID127_96_PKTSLEEP_8822B(x) \ -+ ((x) & (~BITS_MACID127_96_PKTSLEEP_8822B)) -+#define BIT_GET_MACID127_96_PKTSLEEP_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_PKTSLEEP_8822B) & \ -+ BIT_MASK_MACID127_96_PKTSLEEP_8822B) -+#define BIT_SET_MACID127_96_PKTSLEEP_8822B(x, v) \ -+ (BIT_CLEAR_MACID127_96_PKTSLEEP_8822B(x) | \ -+ BIT_MACID127_96_PKTSLEEP_8822B(v)) -+ -+/* 2 REG_MACID_SLEEP1_8822B */ -+ -+#define BIT_SHIFT_MACID63_32_PKTSLEEP_8822B 0 -+#define BIT_MASK_MACID63_32_PKTSLEEP_8822B 0xffffffffL -+#define BIT_MACID63_32_PKTSLEEP_8822B(x) \ -+ (((x) & BIT_MASK_MACID63_32_PKTSLEEP_8822B) \ -+ << BIT_SHIFT_MACID63_32_PKTSLEEP_8822B) -+#define BITS_MACID63_32_PKTSLEEP_8822B \ -+ (BIT_MASK_MACID63_32_PKTSLEEP_8822B \ -+ << BIT_SHIFT_MACID63_32_PKTSLEEP_8822B) -+#define BIT_CLEAR_MACID63_32_PKTSLEEP_8822B(x) \ -+ ((x) & (~BITS_MACID63_32_PKTSLEEP_8822B)) -+#define BIT_GET_MACID63_32_PKTSLEEP_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_PKTSLEEP_8822B) & \ -+ BIT_MASK_MACID63_32_PKTSLEEP_8822B) -+#define BIT_SET_MACID63_32_PKTSLEEP_8822B(x, v) \ -+ (BIT_CLEAR_MACID63_32_PKTSLEEP_8822B(x) | \ -+ BIT_MACID63_32_PKTSLEEP_8822B(v)) -+ -+/* 2 REG_ARFR2_V1_8822B */ -+ -+#define BIT_SHIFT_ARFR2_V1_8822B 0 -+#define BIT_MASK_ARFR2_V1_8822B 0xffffffffffffffffL -+#define BIT_ARFR2_V1_8822B(x) \ -+ (((x) & BIT_MASK_ARFR2_V1_8822B) << BIT_SHIFT_ARFR2_V1_8822B) -+#define BITS_ARFR2_V1_8822B \ -+ (BIT_MASK_ARFR2_V1_8822B << BIT_SHIFT_ARFR2_V1_8822B) -+#define BIT_CLEAR_ARFR2_V1_8822B(x) ((x) & (~BITS_ARFR2_V1_8822B)) -+#define BIT_GET_ARFR2_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_ARFR2_V1_8822B) & BIT_MASK_ARFR2_V1_8822B) -+#define BIT_SET_ARFR2_V1_8822B(x, v) \ -+ (BIT_CLEAR_ARFR2_V1_8822B(x) | BIT_ARFR2_V1_8822B(v)) -+ -+/* 2 REG_ARFR3_V1_8822B */ -+ -+#define BIT_SHIFT_ARFR3_V1_8822B 0 -+#define BIT_MASK_ARFR3_V1_8822B 0xffffffffffffffffL -+#define BIT_ARFR3_V1_8822B(x) \ -+ (((x) & BIT_MASK_ARFR3_V1_8822B) << BIT_SHIFT_ARFR3_V1_8822B) -+#define BITS_ARFR3_V1_8822B \ -+ (BIT_MASK_ARFR3_V1_8822B << BIT_SHIFT_ARFR3_V1_8822B) -+#define BIT_CLEAR_ARFR3_V1_8822B(x) ((x) & (~BITS_ARFR3_V1_8822B)) -+#define BIT_GET_ARFR3_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_ARFR3_V1_8822B) & BIT_MASK_ARFR3_V1_8822B) -+#define BIT_SET_ARFR3_V1_8822B(x, v) \ -+ (BIT_CLEAR_ARFR3_V1_8822B(x) | BIT_ARFR3_V1_8822B(v)) -+ -+/* 2 REG_ARFR4_8822B */ -+ -+#define BIT_SHIFT_ARFR4_8822B 0 -+#define BIT_MASK_ARFR4_8822B 0xffffffffffffffffL -+#define BIT_ARFR4_8822B(x) \ -+ (((x) & BIT_MASK_ARFR4_8822B) << BIT_SHIFT_ARFR4_8822B) -+#define BITS_ARFR4_8822B (BIT_MASK_ARFR4_8822B << BIT_SHIFT_ARFR4_8822B) -+#define BIT_CLEAR_ARFR4_8822B(x) ((x) & (~BITS_ARFR4_8822B)) -+#define BIT_GET_ARFR4_8822B(x) \ -+ (((x) >> BIT_SHIFT_ARFR4_8822B) & BIT_MASK_ARFR4_8822B) -+#define BIT_SET_ARFR4_8822B(x, v) \ -+ (BIT_CLEAR_ARFR4_8822B(x) | BIT_ARFR4_8822B(v)) -+ -+/* 2 REG_ARFR5_8822B */ -+ -+#define BIT_SHIFT_ARFR5_8822B 0 -+#define BIT_MASK_ARFR5_8822B 0xffffffffffffffffL -+#define BIT_ARFR5_8822B(x) \ -+ (((x) & BIT_MASK_ARFR5_8822B) << BIT_SHIFT_ARFR5_8822B) -+#define BITS_ARFR5_8822B (BIT_MASK_ARFR5_8822B << BIT_SHIFT_ARFR5_8822B) -+#define BIT_CLEAR_ARFR5_8822B(x) ((x) & (~BITS_ARFR5_8822B)) -+#define BIT_GET_ARFR5_8822B(x) \ -+ (((x) >> BIT_SHIFT_ARFR5_8822B) & BIT_MASK_ARFR5_8822B) -+#define BIT_SET_ARFR5_8822B(x, v) \ -+ (BIT_CLEAR_ARFR5_8822B(x) | BIT_ARFR5_8822B(v)) -+ -+/* 2 REG_TXRPT_START_OFFSET_8822B */ -+ -+#define BIT_SHIFT_MACID_MURATE_OFFSET_8822B 24 -+#define BIT_MASK_MACID_MURATE_OFFSET_8822B 0xff -+#define BIT_MACID_MURATE_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_MACID_MURATE_OFFSET_8822B) \ -+ << BIT_SHIFT_MACID_MURATE_OFFSET_8822B) -+#define BITS_MACID_MURATE_OFFSET_8822B \ -+ (BIT_MASK_MACID_MURATE_OFFSET_8822B \ -+ << BIT_SHIFT_MACID_MURATE_OFFSET_8822B) -+#define BIT_CLEAR_MACID_MURATE_OFFSET_8822B(x) \ -+ ((x) & (~BITS_MACID_MURATE_OFFSET_8822B)) -+#define BIT_GET_MACID_MURATE_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID_MURATE_OFFSET_8822B) & \ -+ BIT_MASK_MACID_MURATE_OFFSET_8822B) -+#define BIT_SET_MACID_MURATE_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_MACID_MURATE_OFFSET_8822B(x) | \ -+ BIT_MACID_MURATE_OFFSET_8822B(v)) -+ -+#define BIT_RPTFIFO_SIZE_OPT_8822B BIT(16) -+ -+#define BIT_SHIFT_MACID_CTRL_OFFSET_8822B 8 -+#define BIT_MASK_MACID_CTRL_OFFSET_8822B 0xff -+#define BIT_MACID_CTRL_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_MACID_CTRL_OFFSET_8822B) \ -+ << BIT_SHIFT_MACID_CTRL_OFFSET_8822B) -+#define BITS_MACID_CTRL_OFFSET_8822B \ -+ (BIT_MASK_MACID_CTRL_OFFSET_8822B << BIT_SHIFT_MACID_CTRL_OFFSET_8822B) -+#define BIT_CLEAR_MACID_CTRL_OFFSET_8822B(x) \ -+ ((x) & (~BITS_MACID_CTRL_OFFSET_8822B)) -+#define BIT_GET_MACID_CTRL_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID_CTRL_OFFSET_8822B) & \ -+ BIT_MASK_MACID_CTRL_OFFSET_8822B) -+#define BIT_SET_MACID_CTRL_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_MACID_CTRL_OFFSET_8822B(x) | BIT_MACID_CTRL_OFFSET_8822B(v)) -+ -+#define BIT_SHIFT_AMPDU_TXRPT_OFFSET_8822B 0 -+#define BIT_MASK_AMPDU_TXRPT_OFFSET_8822B 0xff -+#define BIT_AMPDU_TXRPT_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_AMPDU_TXRPT_OFFSET_8822B) \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_8822B) -+#define BITS_AMPDU_TXRPT_OFFSET_8822B \ -+ (BIT_MASK_AMPDU_TXRPT_OFFSET_8822B \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_8822B) -+#define BIT_CLEAR_AMPDU_TXRPT_OFFSET_8822B(x) \ -+ ((x) & (~BITS_AMPDU_TXRPT_OFFSET_8822B)) -+#define BIT_GET_AMPDU_TXRPT_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_TXRPT_OFFSET_8822B) & \ -+ BIT_MASK_AMPDU_TXRPT_OFFSET_8822B) -+#define BIT_SET_AMPDU_TXRPT_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_AMPDU_TXRPT_OFFSET_8822B(x) | \ -+ BIT_AMPDU_TXRPT_OFFSET_8822B(v)) -+ -+/* 2 REG_POWER_STAGE1_8822B */ -+#define BIT_PTA_WL_PRI_MASK_CPU_MGQ_8822B BIT(31) -+#define BIT_PTA_WL_PRI_MASK_BCNQ_8822B BIT(30) -+#define BIT_PTA_WL_PRI_MASK_HIQ_8822B BIT(29) -+#define BIT_PTA_WL_PRI_MASK_MGQ_8822B BIT(28) -+#define BIT_PTA_WL_PRI_MASK_BK_8822B BIT(27) -+#define BIT_PTA_WL_PRI_MASK_BE_8822B BIT(26) -+#define BIT_PTA_WL_PRI_MASK_VI_8822B BIT(25) -+#define BIT_PTA_WL_PRI_MASK_VO_8822B BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE1_8822B 0 -+#define BIT_MASK_POWER_STAGE1_8822B 0xffffff -+#define BIT_POWER_STAGE1_8822B(x) \ -+ (((x) & BIT_MASK_POWER_STAGE1_8822B) << BIT_SHIFT_POWER_STAGE1_8822B) -+#define BITS_POWER_STAGE1_8822B \ -+ (BIT_MASK_POWER_STAGE1_8822B << BIT_SHIFT_POWER_STAGE1_8822B) -+#define BIT_CLEAR_POWER_STAGE1_8822B(x) ((x) & (~BITS_POWER_STAGE1_8822B)) -+#define BIT_GET_POWER_STAGE1_8822B(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE1_8822B) & BIT_MASK_POWER_STAGE1_8822B) -+#define BIT_SET_POWER_STAGE1_8822B(x, v) \ -+ (BIT_CLEAR_POWER_STAGE1_8822B(x) | BIT_POWER_STAGE1_8822B(v)) -+ -+/* 2 REG_POWER_STAGE2_8822B */ -+#define BIT__R_CTRL_PKT_POW_ADJ_8822B BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE2_8822B 0 -+#define BIT_MASK_POWER_STAGE2_8822B 0xffffff -+#define BIT_POWER_STAGE2_8822B(x) \ -+ (((x) & BIT_MASK_POWER_STAGE2_8822B) << BIT_SHIFT_POWER_STAGE2_8822B) -+#define BITS_POWER_STAGE2_8822B \ -+ (BIT_MASK_POWER_STAGE2_8822B << BIT_SHIFT_POWER_STAGE2_8822B) -+#define BIT_CLEAR_POWER_STAGE2_8822B(x) ((x) & (~BITS_POWER_STAGE2_8822B)) -+#define BIT_GET_POWER_STAGE2_8822B(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE2_8822B) & BIT_MASK_POWER_STAGE2_8822B) -+#define BIT_SET_POWER_STAGE2_8822B(x, v) \ -+ (BIT_CLEAR_POWER_STAGE2_8822B(x) | BIT_POWER_STAGE2_8822B(v)) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL_8822B */ -+ -+#define BIT_SHIFT_PAD_NUM_THRES_8822B 24 -+#define BIT_MASK_PAD_NUM_THRES_8822B 0x3f -+#define BIT_PAD_NUM_THRES_8822B(x) \ -+ (((x) & BIT_MASK_PAD_NUM_THRES_8822B) << BIT_SHIFT_PAD_NUM_THRES_8822B) -+#define BITS_PAD_NUM_THRES_8822B \ -+ (BIT_MASK_PAD_NUM_THRES_8822B << BIT_SHIFT_PAD_NUM_THRES_8822B) -+#define BIT_CLEAR_PAD_NUM_THRES_8822B(x) ((x) & (~BITS_PAD_NUM_THRES_8822B)) -+#define BIT_GET_PAD_NUM_THRES_8822B(x) \ -+ (((x) >> BIT_SHIFT_PAD_NUM_THRES_8822B) & BIT_MASK_PAD_NUM_THRES_8822B) -+#define BIT_SET_PAD_NUM_THRES_8822B(x, v) \ -+ (BIT_CLEAR_PAD_NUM_THRES_8822B(x) | BIT_PAD_NUM_THRES_8822B(v)) -+ -+#define BIT_R_DMA_THIS_QUEUE_BK_8822B BIT(23) -+#define BIT_R_DMA_THIS_QUEUE_BE_8822B BIT(22) -+#define BIT_R_DMA_THIS_QUEUE_VI_8822B BIT(21) -+#define BIT_R_DMA_THIS_QUEUE_VO_8822B BIT(20) -+ -+#define BIT_SHIFT_R_TOTAL_LEN_TH_8822B 8 -+#define BIT_MASK_R_TOTAL_LEN_TH_8822B 0xfff -+#define BIT_R_TOTAL_LEN_TH_8822B(x) \ -+ (((x) & BIT_MASK_R_TOTAL_LEN_TH_8822B) \ -+ << BIT_SHIFT_R_TOTAL_LEN_TH_8822B) -+#define BITS_R_TOTAL_LEN_TH_8822B \ -+ (BIT_MASK_R_TOTAL_LEN_TH_8822B << BIT_SHIFT_R_TOTAL_LEN_TH_8822B) -+#define BIT_CLEAR_R_TOTAL_LEN_TH_8822B(x) ((x) & (~BITS_R_TOTAL_LEN_TH_8822B)) -+#define BIT_GET_R_TOTAL_LEN_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_TOTAL_LEN_TH_8822B) & \ -+ BIT_MASK_R_TOTAL_LEN_TH_8822B) -+#define BIT_SET_R_TOTAL_LEN_TH_8822B(x, v) \ -+ (BIT_CLEAR_R_TOTAL_LEN_TH_8822B(x) | BIT_R_TOTAL_LEN_TH_8822B(v)) -+ -+#define BIT_EN_NEW_EARLY_8822B BIT(7) -+#define BIT_PRE_TX_CMD_8822B BIT(6) -+ -+#define BIT_SHIFT_NUM_SCL_EN_8822B 4 -+#define BIT_MASK_NUM_SCL_EN_8822B 0x3 -+#define BIT_NUM_SCL_EN_8822B(x) \ -+ (((x) & BIT_MASK_NUM_SCL_EN_8822B) << BIT_SHIFT_NUM_SCL_EN_8822B) -+#define BITS_NUM_SCL_EN_8822B \ -+ (BIT_MASK_NUM_SCL_EN_8822B << BIT_SHIFT_NUM_SCL_EN_8822B) -+#define BIT_CLEAR_NUM_SCL_EN_8822B(x) ((x) & (~BITS_NUM_SCL_EN_8822B)) -+#define BIT_GET_NUM_SCL_EN_8822B(x) \ -+ (((x) >> BIT_SHIFT_NUM_SCL_EN_8822B) & BIT_MASK_NUM_SCL_EN_8822B) -+#define BIT_SET_NUM_SCL_EN_8822B(x, v) \ -+ (BIT_CLEAR_NUM_SCL_EN_8822B(x) | BIT_NUM_SCL_EN_8822B(v)) -+ -+#define BIT_BK_EN_8822B BIT(3) -+#define BIT_BE_EN_8822B BIT(2) -+#define BIT_VI_EN_8822B BIT(1) -+#define BIT_VO_EN_8822B BIT(0) -+ -+/* 2 REG_PKT_LIFE_TIME_8822B */ -+ -+#define BIT_SHIFT_PKT_LIFTIME_BEBK_8822B 16 -+#define BIT_MASK_PKT_LIFTIME_BEBK_8822B 0xffff -+#define BIT_PKT_LIFTIME_BEBK_8822B(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_BEBK_8822B) \ -+ << BIT_SHIFT_PKT_LIFTIME_BEBK_8822B) -+#define BITS_PKT_LIFTIME_BEBK_8822B \ -+ (BIT_MASK_PKT_LIFTIME_BEBK_8822B << BIT_SHIFT_PKT_LIFTIME_BEBK_8822B) -+#define BIT_CLEAR_PKT_LIFTIME_BEBK_8822B(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_BEBK_8822B)) -+#define BIT_GET_PKT_LIFTIME_BEBK_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_BEBK_8822B) & \ -+ BIT_MASK_PKT_LIFTIME_BEBK_8822B) -+#define BIT_SET_PKT_LIFTIME_BEBK_8822B(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_BEBK_8822B(x) | BIT_PKT_LIFTIME_BEBK_8822B(v)) -+ -+#define BIT_SHIFT_PKT_LIFTIME_VOVI_8822B 0 -+#define BIT_MASK_PKT_LIFTIME_VOVI_8822B 0xffff -+#define BIT_PKT_LIFTIME_VOVI_8822B(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_VOVI_8822B) \ -+ << BIT_SHIFT_PKT_LIFTIME_VOVI_8822B) -+#define BITS_PKT_LIFTIME_VOVI_8822B \ -+ (BIT_MASK_PKT_LIFTIME_VOVI_8822B << BIT_SHIFT_PKT_LIFTIME_VOVI_8822B) -+#define BIT_CLEAR_PKT_LIFTIME_VOVI_8822B(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_VOVI_8822B)) -+#define BIT_GET_PKT_LIFTIME_VOVI_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_VOVI_8822B) & \ -+ BIT_MASK_PKT_LIFTIME_VOVI_8822B) -+#define BIT_SET_PKT_LIFTIME_VOVI_8822B(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_VOVI_8822B(x) | BIT_PKT_LIFTIME_VOVI_8822B(v)) -+ -+/* 2 REG_STBC_SETTING_8822B */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_L_8822B 4 -+#define BIT_MASK_CDEND_TXTIME_L_8822B 0xf -+#define BIT_CDEND_TXTIME_L_8822B(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_L_8822B) \ -+ << BIT_SHIFT_CDEND_TXTIME_L_8822B) -+#define BITS_CDEND_TXTIME_L_8822B \ -+ (BIT_MASK_CDEND_TXTIME_L_8822B << BIT_SHIFT_CDEND_TXTIME_L_8822B) -+#define BIT_CLEAR_CDEND_TXTIME_L_8822B(x) ((x) & (~BITS_CDEND_TXTIME_L_8822B)) -+#define BIT_GET_CDEND_TXTIME_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_L_8822B) & \ -+ BIT_MASK_CDEND_TXTIME_L_8822B) -+#define BIT_SET_CDEND_TXTIME_L_8822B(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_L_8822B(x) | BIT_CDEND_TXTIME_L_8822B(v)) -+ -+#define BIT_SHIFT_NESS_8822B 2 -+#define BIT_MASK_NESS_8822B 0x3 -+#define BIT_NESS_8822B(x) (((x) & BIT_MASK_NESS_8822B) << BIT_SHIFT_NESS_8822B) -+#define BITS_NESS_8822B (BIT_MASK_NESS_8822B << BIT_SHIFT_NESS_8822B) -+#define BIT_CLEAR_NESS_8822B(x) ((x) & (~BITS_NESS_8822B)) -+#define BIT_GET_NESS_8822B(x) \ -+ (((x) >> BIT_SHIFT_NESS_8822B) & BIT_MASK_NESS_8822B) -+#define BIT_SET_NESS_8822B(x, v) (BIT_CLEAR_NESS_8822B(x) | BIT_NESS_8822B(v)) -+ -+#define BIT_SHIFT_STBC_CFEND_8822B 0 -+#define BIT_MASK_STBC_CFEND_8822B 0x3 -+#define BIT_STBC_CFEND_8822B(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_8822B) << BIT_SHIFT_STBC_CFEND_8822B) -+#define BITS_STBC_CFEND_8822B \ -+ (BIT_MASK_STBC_CFEND_8822B << BIT_SHIFT_STBC_CFEND_8822B) -+#define BIT_CLEAR_STBC_CFEND_8822B(x) ((x) & (~BITS_STBC_CFEND_8822B)) -+#define BIT_GET_STBC_CFEND_8822B(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_8822B) & BIT_MASK_STBC_CFEND_8822B) -+#define BIT_SET_STBC_CFEND_8822B(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_8822B(x) | BIT_STBC_CFEND_8822B(v)) -+ -+/* 2 REG_STBC_SETTING2_8822B */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_H_8822B 0 -+#define BIT_MASK_CDEND_TXTIME_H_8822B 0x1f -+#define BIT_CDEND_TXTIME_H_8822B(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_H_8822B) \ -+ << BIT_SHIFT_CDEND_TXTIME_H_8822B) -+#define BITS_CDEND_TXTIME_H_8822B \ -+ (BIT_MASK_CDEND_TXTIME_H_8822B << BIT_SHIFT_CDEND_TXTIME_H_8822B) -+#define BIT_CLEAR_CDEND_TXTIME_H_8822B(x) ((x) & (~BITS_CDEND_TXTIME_H_8822B)) -+#define BIT_GET_CDEND_TXTIME_H_8822B(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_H_8822B) & \ -+ BIT_MASK_CDEND_TXTIME_H_8822B) -+#define BIT_SET_CDEND_TXTIME_H_8822B(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_H_8822B(x) | BIT_CDEND_TXTIME_H_8822B(v)) -+ -+/* 2 REG_QUEUE_CTRL_8822B */ -+#define BIT_PTA_EDCCA_EN_8822B BIT(5) -+#define BIT_PTA_WL_TX_EN_8822B BIT(4) -+#define BIT_R_USE_DATA_BW_8822B BIT(3) -+#define BIT_TRI_PKT_INT_MODE1_8822B BIT(2) -+#define BIT_TRI_PKT_INT_MODE0_8822B BIT(1) -+#define BIT_ACQ_MODE_SEL_8822B BIT(0) -+ -+/* 2 REG_SINGLE_AMPDU_CTRL_8822B */ -+#define BIT_EN_SINGLE_APMDU_8822B BIT(7) -+ -+/* 2 REG_PROT_MODE_CTRL_8822B */ -+ -+#define BIT_SHIFT_RTS_MAX_AGG_NUM_8822B 24 -+#define BIT_MASK_RTS_MAX_AGG_NUM_8822B 0x3f -+#define BIT_RTS_MAX_AGG_NUM_8822B(x) \ -+ (((x) & BIT_MASK_RTS_MAX_AGG_NUM_8822B) \ -+ << BIT_SHIFT_RTS_MAX_AGG_NUM_8822B) -+#define BITS_RTS_MAX_AGG_NUM_8822B \ -+ (BIT_MASK_RTS_MAX_AGG_NUM_8822B << BIT_SHIFT_RTS_MAX_AGG_NUM_8822B) -+#define BIT_CLEAR_RTS_MAX_AGG_NUM_8822B(x) ((x) & (~BITS_RTS_MAX_AGG_NUM_8822B)) -+#define BIT_GET_RTS_MAX_AGG_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_RTS_MAX_AGG_NUM_8822B) & \ -+ BIT_MASK_RTS_MAX_AGG_NUM_8822B) -+#define BIT_SET_RTS_MAX_AGG_NUM_8822B(x, v) \ -+ (BIT_CLEAR_RTS_MAX_AGG_NUM_8822B(x) | BIT_RTS_MAX_AGG_NUM_8822B(v)) -+ -+#define BIT_SHIFT_MAX_AGG_NUM_8822B 16 -+#define BIT_MASK_MAX_AGG_NUM_8822B 0x3f -+#define BIT_MAX_AGG_NUM_8822B(x) \ -+ (((x) & BIT_MASK_MAX_AGG_NUM_8822B) << BIT_SHIFT_MAX_AGG_NUM_8822B) -+#define BITS_MAX_AGG_NUM_8822B \ -+ (BIT_MASK_MAX_AGG_NUM_8822B << BIT_SHIFT_MAX_AGG_NUM_8822B) -+#define BIT_CLEAR_MAX_AGG_NUM_8822B(x) ((x) & (~BITS_MAX_AGG_NUM_8822B)) -+#define BIT_GET_MAX_AGG_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_MAX_AGG_NUM_8822B) & BIT_MASK_MAX_AGG_NUM_8822B) -+#define BIT_SET_MAX_AGG_NUM_8822B(x, v) \ -+ (BIT_CLEAR_MAX_AGG_NUM_8822B(x) | BIT_MAX_AGG_NUM_8822B(v)) -+ -+#define BIT_SHIFT_RTS_TXTIME_TH_8822B 8 -+#define BIT_MASK_RTS_TXTIME_TH_8822B 0xff -+#define BIT_RTS_TXTIME_TH_8822B(x) \ -+ (((x) & BIT_MASK_RTS_TXTIME_TH_8822B) << BIT_SHIFT_RTS_TXTIME_TH_8822B) -+#define BITS_RTS_TXTIME_TH_8822B \ -+ (BIT_MASK_RTS_TXTIME_TH_8822B << BIT_SHIFT_RTS_TXTIME_TH_8822B) -+#define BIT_CLEAR_RTS_TXTIME_TH_8822B(x) ((x) & (~BITS_RTS_TXTIME_TH_8822B)) -+#define BIT_GET_RTS_TXTIME_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_RTS_TXTIME_TH_8822B) & BIT_MASK_RTS_TXTIME_TH_8822B) -+#define BIT_SET_RTS_TXTIME_TH_8822B(x, v) \ -+ (BIT_CLEAR_RTS_TXTIME_TH_8822B(x) | BIT_RTS_TXTIME_TH_8822B(v)) -+ -+#define BIT_SHIFT_RTS_LEN_TH_8822B 0 -+#define BIT_MASK_RTS_LEN_TH_8822B 0xff -+#define BIT_RTS_LEN_TH_8822B(x) \ -+ (((x) & BIT_MASK_RTS_LEN_TH_8822B) << BIT_SHIFT_RTS_LEN_TH_8822B) -+#define BITS_RTS_LEN_TH_8822B \ -+ (BIT_MASK_RTS_LEN_TH_8822B << BIT_SHIFT_RTS_LEN_TH_8822B) -+#define BIT_CLEAR_RTS_LEN_TH_8822B(x) ((x) & (~BITS_RTS_LEN_TH_8822B)) -+#define BIT_GET_RTS_LEN_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_RTS_LEN_TH_8822B) & BIT_MASK_RTS_LEN_TH_8822B) -+#define BIT_SET_RTS_LEN_TH_8822B(x, v) \ -+ (BIT_CLEAR_RTS_LEN_TH_8822B(x) | BIT_RTS_LEN_TH_8822B(v)) -+ -+/* 2 REG_BAR_MODE_CTRL_8822B */ -+ -+#define BIT_SHIFT_BAR_RTY_LMT_8822B 16 -+#define BIT_MASK_BAR_RTY_LMT_8822B 0x3 -+#define BIT_BAR_RTY_LMT_8822B(x) \ -+ (((x) & BIT_MASK_BAR_RTY_LMT_8822B) << BIT_SHIFT_BAR_RTY_LMT_8822B) -+#define BITS_BAR_RTY_LMT_8822B \ -+ (BIT_MASK_BAR_RTY_LMT_8822B << BIT_SHIFT_BAR_RTY_LMT_8822B) -+#define BIT_CLEAR_BAR_RTY_LMT_8822B(x) ((x) & (~BITS_BAR_RTY_LMT_8822B)) -+#define BIT_GET_BAR_RTY_LMT_8822B(x) \ -+ (((x) >> BIT_SHIFT_BAR_RTY_LMT_8822B) & BIT_MASK_BAR_RTY_LMT_8822B) -+#define BIT_SET_BAR_RTY_LMT_8822B(x, v) \ -+ (BIT_CLEAR_BAR_RTY_LMT_8822B(x) | BIT_BAR_RTY_LMT_8822B(v)) -+ -+#define BIT_SHIFT_BAR_PKT_TXTIME_TH_8822B 8 -+#define BIT_MASK_BAR_PKT_TXTIME_TH_8822B 0xff -+#define BIT_BAR_PKT_TXTIME_TH_8822B(x) \ -+ (((x) & BIT_MASK_BAR_PKT_TXTIME_TH_8822B) \ -+ << BIT_SHIFT_BAR_PKT_TXTIME_TH_8822B) -+#define BITS_BAR_PKT_TXTIME_TH_8822B \ -+ (BIT_MASK_BAR_PKT_TXTIME_TH_8822B << BIT_SHIFT_BAR_PKT_TXTIME_TH_8822B) -+#define BIT_CLEAR_BAR_PKT_TXTIME_TH_8822B(x) \ -+ ((x) & (~BITS_BAR_PKT_TXTIME_TH_8822B)) -+#define BIT_GET_BAR_PKT_TXTIME_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKT_TXTIME_TH_8822B) & \ -+ BIT_MASK_BAR_PKT_TXTIME_TH_8822B) -+#define BIT_SET_BAR_PKT_TXTIME_TH_8822B(x, v) \ -+ (BIT_CLEAR_BAR_PKT_TXTIME_TH_8822B(x) | BIT_BAR_PKT_TXTIME_TH_8822B(v)) -+ -+#define BIT_BAR_EN_V1_8822B BIT(6) -+ -+#define BIT_SHIFT_BAR_PKTNUM_TH_V1_8822B 0 -+#define BIT_MASK_BAR_PKTNUM_TH_V1_8822B 0x3f -+#define BIT_BAR_PKTNUM_TH_V1_8822B(x) \ -+ (((x) & BIT_MASK_BAR_PKTNUM_TH_V1_8822B) \ -+ << BIT_SHIFT_BAR_PKTNUM_TH_V1_8822B) -+#define BITS_BAR_PKTNUM_TH_V1_8822B \ -+ (BIT_MASK_BAR_PKTNUM_TH_V1_8822B << BIT_SHIFT_BAR_PKTNUM_TH_V1_8822B) -+#define BIT_CLEAR_BAR_PKTNUM_TH_V1_8822B(x) \ -+ ((x) & (~BITS_BAR_PKTNUM_TH_V1_8822B)) -+#define BIT_GET_BAR_PKTNUM_TH_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKTNUM_TH_V1_8822B) & \ -+ BIT_MASK_BAR_PKTNUM_TH_V1_8822B) -+#define BIT_SET_BAR_PKTNUM_TH_V1_8822B(x, v) \ -+ (BIT_CLEAR_BAR_PKTNUM_TH_V1_8822B(x) | BIT_BAR_PKTNUM_TH_V1_8822B(v)) -+ -+/* 2 REG_RA_TRY_RATE_AGG_LMT_8822B */ -+ -+#define BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8822B 0 -+#define BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8822B 0x3f -+#define BIT_RA_TRY_RATE_AGG_LMT_V1_8822B(x) \ -+ (((x) & BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8822B) \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8822B) -+#define BITS_RA_TRY_RATE_AGG_LMT_V1_8822B \ -+ (BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8822B \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8822B) -+#define BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8822B(x) \ -+ ((x) & (~BITS_RA_TRY_RATE_AGG_LMT_V1_8822B)) -+#define BIT_GET_RA_TRY_RATE_AGG_LMT_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8822B) & \ -+ BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8822B) -+#define BIT_SET_RA_TRY_RATE_AGG_LMT_V1_8822B(x, v) \ -+ (BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8822B(x) | \ -+ BIT_RA_TRY_RATE_AGG_LMT_V1_8822B(v)) -+ -+/* 2 REG_MACID_SLEEP2_8822B */ -+ -+#define BIT_SHIFT_MACID95_64PKTSLEEP_8822B 0 -+#define BIT_MASK_MACID95_64PKTSLEEP_8822B 0xffffffffL -+#define BIT_MACID95_64PKTSLEEP_8822B(x) \ -+ (((x) & BIT_MASK_MACID95_64PKTSLEEP_8822B) \ -+ << BIT_SHIFT_MACID95_64PKTSLEEP_8822B) -+#define BITS_MACID95_64PKTSLEEP_8822B \ -+ (BIT_MASK_MACID95_64PKTSLEEP_8822B \ -+ << BIT_SHIFT_MACID95_64PKTSLEEP_8822B) -+#define BIT_CLEAR_MACID95_64PKTSLEEP_8822B(x) \ -+ ((x) & (~BITS_MACID95_64PKTSLEEP_8822B)) -+#define BIT_GET_MACID95_64PKTSLEEP_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64PKTSLEEP_8822B) & \ -+ BIT_MASK_MACID95_64PKTSLEEP_8822B) -+#define BIT_SET_MACID95_64PKTSLEEP_8822B(x, v) \ -+ (BIT_CLEAR_MACID95_64PKTSLEEP_8822B(x) | \ -+ BIT_MACID95_64PKTSLEEP_8822B(v)) -+ -+/* 2 REG_MACID_SLEEP_8822B */ -+ -+#define BIT_SHIFT_MACID31_0_PKTSLEEP_8822B 0 -+#define BIT_MASK_MACID31_0_PKTSLEEP_8822B 0xffffffffL -+#define BIT_MACID31_0_PKTSLEEP_8822B(x) \ -+ (((x) & BIT_MASK_MACID31_0_PKTSLEEP_8822B) \ -+ << BIT_SHIFT_MACID31_0_PKTSLEEP_8822B) -+#define BITS_MACID31_0_PKTSLEEP_8822B \ -+ (BIT_MASK_MACID31_0_PKTSLEEP_8822B \ -+ << BIT_SHIFT_MACID31_0_PKTSLEEP_8822B) -+#define BIT_CLEAR_MACID31_0_PKTSLEEP_8822B(x) \ -+ ((x) & (~BITS_MACID31_0_PKTSLEEP_8822B)) -+#define BIT_GET_MACID31_0_PKTSLEEP_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_PKTSLEEP_8822B) & \ -+ BIT_MASK_MACID31_0_PKTSLEEP_8822B) -+#define BIT_SET_MACID31_0_PKTSLEEP_8822B(x, v) \ -+ (BIT_CLEAR_MACID31_0_PKTSLEEP_8822B(x) | \ -+ BIT_MACID31_0_PKTSLEEP_8822B(v)) -+ -+/* 2 REG_HW_SEQ0_8822B */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ0_8822B 0 -+#define BIT_MASK_HW_SSN_SEQ0_8822B 0xfff -+#define BIT_HW_SSN_SEQ0_8822B(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ0_8822B) << BIT_SHIFT_HW_SSN_SEQ0_8822B) -+#define BITS_HW_SSN_SEQ0_8822B \ -+ (BIT_MASK_HW_SSN_SEQ0_8822B << BIT_SHIFT_HW_SSN_SEQ0_8822B) -+#define BIT_CLEAR_HW_SSN_SEQ0_8822B(x) ((x) & (~BITS_HW_SSN_SEQ0_8822B)) -+#define BIT_GET_HW_SSN_SEQ0_8822B(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ0_8822B) & BIT_MASK_HW_SSN_SEQ0_8822B) -+#define BIT_SET_HW_SSN_SEQ0_8822B(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ0_8822B(x) | BIT_HW_SSN_SEQ0_8822B(v)) -+ -+/* 2 REG_HW_SEQ1_8822B */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ1_8822B 0 -+#define BIT_MASK_HW_SSN_SEQ1_8822B 0xfff -+#define BIT_HW_SSN_SEQ1_8822B(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ1_8822B) << BIT_SHIFT_HW_SSN_SEQ1_8822B) -+#define BITS_HW_SSN_SEQ1_8822B \ -+ (BIT_MASK_HW_SSN_SEQ1_8822B << BIT_SHIFT_HW_SSN_SEQ1_8822B) -+#define BIT_CLEAR_HW_SSN_SEQ1_8822B(x) ((x) & (~BITS_HW_SSN_SEQ1_8822B)) -+#define BIT_GET_HW_SSN_SEQ1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ1_8822B) & BIT_MASK_HW_SSN_SEQ1_8822B) -+#define BIT_SET_HW_SSN_SEQ1_8822B(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ1_8822B(x) | BIT_HW_SSN_SEQ1_8822B(v)) -+ -+/* 2 REG_HW_SEQ2_8822B */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ2_8822B 0 -+#define BIT_MASK_HW_SSN_SEQ2_8822B 0xfff -+#define BIT_HW_SSN_SEQ2_8822B(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ2_8822B) << BIT_SHIFT_HW_SSN_SEQ2_8822B) -+#define BITS_HW_SSN_SEQ2_8822B \ -+ (BIT_MASK_HW_SSN_SEQ2_8822B << BIT_SHIFT_HW_SSN_SEQ2_8822B) -+#define BIT_CLEAR_HW_SSN_SEQ2_8822B(x) ((x) & (~BITS_HW_SSN_SEQ2_8822B)) -+#define BIT_GET_HW_SSN_SEQ2_8822B(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ2_8822B) & BIT_MASK_HW_SSN_SEQ2_8822B) -+#define BIT_SET_HW_SSN_SEQ2_8822B(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ2_8822B(x) | BIT_HW_SSN_SEQ2_8822B(v)) -+ -+/* 2 REG_HW_SEQ3_8822B */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ3_8822B 0 -+#define BIT_MASK_HW_SSN_SEQ3_8822B 0xfff -+#define BIT_HW_SSN_SEQ3_8822B(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ3_8822B) << BIT_SHIFT_HW_SSN_SEQ3_8822B) -+#define BITS_HW_SSN_SEQ3_8822B \ -+ (BIT_MASK_HW_SSN_SEQ3_8822B << BIT_SHIFT_HW_SSN_SEQ3_8822B) -+#define BIT_CLEAR_HW_SSN_SEQ3_8822B(x) ((x) & (~BITS_HW_SSN_SEQ3_8822B)) -+#define BIT_GET_HW_SSN_SEQ3_8822B(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ3_8822B) & BIT_MASK_HW_SSN_SEQ3_8822B) -+#define BIT_SET_HW_SSN_SEQ3_8822B(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ3_8822B(x) | BIT_HW_SSN_SEQ3_8822B(v)) -+ -+/* 2 REG_NULL_PKT_STATUS_V1_8822B */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V2_8822B 2 -+#define BIT_MASK_PTCL_TOTAL_PG_V2_8822B 0x3fff -+#define BIT_PTCL_TOTAL_PG_V2_8822B(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V2_8822B) \ -+ << BIT_SHIFT_PTCL_TOTAL_PG_V2_8822B) -+#define BITS_PTCL_TOTAL_PG_V2_8822B \ -+ (BIT_MASK_PTCL_TOTAL_PG_V2_8822B << BIT_SHIFT_PTCL_TOTAL_PG_V2_8822B) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V2_8822B(x) \ -+ ((x) & (~BITS_PTCL_TOTAL_PG_V2_8822B)) -+#define BIT_GET_PTCL_TOTAL_PG_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V2_8822B) & \ -+ BIT_MASK_PTCL_TOTAL_PG_V2_8822B) -+#define BIT_SET_PTCL_TOTAL_PG_V2_8822B(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V2_8822B(x) | BIT_PTCL_TOTAL_PG_V2_8822B(v)) -+ -+#define BIT_TX_NULL_1_8822B BIT(1) -+#define BIT_TX_NULL_0_8822B BIT(0) -+ -+/* 2 REG_PTCL_ERR_STATUS_8822B */ -+#define BIT_PTCL_RATE_TABLE_INVALID_8822B BIT(7) -+#define BIT_FTM_T2R_ERROR_8822B BIT(6) -+#define BIT_PTCL_ERR0_8822B BIT(5) -+#define BIT_PTCL_ERR1_8822B BIT(4) -+#define BIT_PTCL_ERR2_8822B BIT(3) -+#define BIT_PTCL_ERR3_8822B BIT(2) -+#define BIT_PTCL_ERR4_8822B BIT(1) -+#define BIT_PTCL_ERR5_8822B BIT(0) -+ -+/* 2 REG_NULL_PKT_STATUS_EXTEND_8822B */ -+#define BIT_CLI3_TX_NULL_1_8822B BIT(7) -+#define BIT_CLI3_TX_NULL_0_8822B BIT(6) -+#define BIT_CLI2_TX_NULL_1_8822B BIT(5) -+#define BIT_CLI2_TX_NULL_0_8822B BIT(4) -+#define BIT_CLI1_TX_NULL_1_8822B BIT(3) -+#define BIT_CLI1_TX_NULL_0_8822B BIT(2) -+#define BIT_CLI0_TX_NULL_1_8822B BIT(1) -+#define BIT_CLI0_TX_NULL_0_8822B BIT(0) -+ -+/* 2 REG_VIDEO_ENHANCEMENT_FUN_8822B */ -+#define BIT_VIDEO_JUST_DROP_8822B BIT(1) -+#define BIT_VIDEO_ENHANCEMENT_FUN_EN_8822B BIT(0) -+ -+/* 2 REG_BT_POLLUTE_PKT_CNT_8822B */ -+ -+#define BIT_SHIFT_BT_POLLUTE_PKT_CNT_8822B 0 -+#define BIT_MASK_BT_POLLUTE_PKT_CNT_8822B 0xffff -+#define BIT_BT_POLLUTE_PKT_CNT_8822B(x) \ -+ (((x) & BIT_MASK_BT_POLLUTE_PKT_CNT_8822B) \ -+ << BIT_SHIFT_BT_POLLUTE_PKT_CNT_8822B) -+#define BITS_BT_POLLUTE_PKT_CNT_8822B \ -+ (BIT_MASK_BT_POLLUTE_PKT_CNT_8822B \ -+ << BIT_SHIFT_BT_POLLUTE_PKT_CNT_8822B) -+#define BIT_CLEAR_BT_POLLUTE_PKT_CNT_8822B(x) \ -+ ((x) & (~BITS_BT_POLLUTE_PKT_CNT_8822B)) -+#define BIT_GET_BT_POLLUTE_PKT_CNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_POLLUTE_PKT_CNT_8822B) & \ -+ BIT_MASK_BT_POLLUTE_PKT_CNT_8822B) -+#define BIT_SET_BT_POLLUTE_PKT_CNT_8822B(x, v) \ -+ (BIT_CLEAR_BT_POLLUTE_PKT_CNT_8822B(x) | \ -+ BIT_BT_POLLUTE_PKT_CNT_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_PTCL_DBG_8822B */ -+ -+#define BIT_SHIFT_PTCL_DBG_8822B 0 -+#define BIT_MASK_PTCL_DBG_8822B 0xffffffffL -+#define BIT_PTCL_DBG_8822B(x) \ -+ (((x) & BIT_MASK_PTCL_DBG_8822B) << BIT_SHIFT_PTCL_DBG_8822B) -+#define BITS_PTCL_DBG_8822B \ -+ (BIT_MASK_PTCL_DBG_8822B << BIT_SHIFT_PTCL_DBG_8822B) -+#define BIT_CLEAR_PTCL_DBG_8822B(x) ((x) & (~BITS_PTCL_DBG_8822B)) -+#define BIT_GET_PTCL_DBG_8822B(x) \ -+ (((x) >> BIT_SHIFT_PTCL_DBG_8822B) & BIT_MASK_PTCL_DBG_8822B) -+#define BIT_SET_PTCL_DBG_8822B(x, v) \ -+ (BIT_CLEAR_PTCL_DBG_8822B(x) | BIT_PTCL_DBG_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_CPUMGQ_TIMER_CTRL2_8822B */ -+ -+#define BIT_SHIFT_TRI_HEAD_ADDR_8822B 16 -+#define BIT_MASK_TRI_HEAD_ADDR_8822B 0xfff -+#define BIT_TRI_HEAD_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_TRI_HEAD_ADDR_8822B) << BIT_SHIFT_TRI_HEAD_ADDR_8822B) -+#define BITS_TRI_HEAD_ADDR_8822B \ -+ (BIT_MASK_TRI_HEAD_ADDR_8822B << BIT_SHIFT_TRI_HEAD_ADDR_8822B) -+#define BIT_CLEAR_TRI_HEAD_ADDR_8822B(x) ((x) & (~BITS_TRI_HEAD_ADDR_8822B)) -+#define BIT_GET_TRI_HEAD_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_TRI_HEAD_ADDR_8822B) & BIT_MASK_TRI_HEAD_ADDR_8822B) -+#define BIT_SET_TRI_HEAD_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_TRI_HEAD_ADDR_8822B(x) | BIT_TRI_HEAD_ADDR_8822B(v)) -+ -+#define BIT_DROP_TH_EN_8822B BIT(8) -+ -+#define BIT_SHIFT_DROP_TH_8822B 0 -+#define BIT_MASK_DROP_TH_8822B 0xff -+#define BIT_DROP_TH_8822B(x) \ -+ (((x) & BIT_MASK_DROP_TH_8822B) << BIT_SHIFT_DROP_TH_8822B) -+#define BITS_DROP_TH_8822B (BIT_MASK_DROP_TH_8822B << BIT_SHIFT_DROP_TH_8822B) -+#define BIT_CLEAR_DROP_TH_8822B(x) ((x) & (~BITS_DROP_TH_8822B)) -+#define BIT_GET_DROP_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_DROP_TH_8822B) & BIT_MASK_DROP_TH_8822B) -+#define BIT_SET_DROP_TH_8822B(x, v) \ -+ (BIT_CLEAR_DROP_TH_8822B(x) | BIT_DROP_TH_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_DUMMY_PAGE4_V1_8822B */ -+#define BIT_BCN_EN_EXTHWSEQ_8822B BIT(1) -+#define BIT_BCN_EN_HWSEQ_8822B BIT(0) -+ -+/* 2 REG_MOREDATA_8822B */ -+#define BIT_MOREDATA_CTRL2_EN_V1_8822B BIT(3) -+#define BIT_MOREDATA_CTRL1_EN_V1_8822B BIT(2) -+#define BIT_PKTIN_MOREDATA_REPLACE_ENABLE_V1_8822B BIT(0) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_Q0_Q1_INFO_8822B */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8822B BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8822B 28 -+#define BIT_MASK_GTAB_ID_8822B 0x7 -+#define BIT_GTAB_ID_8822B(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8822B) << BIT_SHIFT_GTAB_ID_8822B) -+#define BITS_GTAB_ID_8822B (BIT_MASK_GTAB_ID_8822B << BIT_SHIFT_GTAB_ID_8822B) -+#define BIT_CLEAR_GTAB_ID_8822B(x) ((x) & (~BITS_GTAB_ID_8822B)) -+#define BIT_GET_GTAB_ID_8822B(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8822B) & BIT_MASK_GTAB_ID_8822B) -+#define BIT_SET_GTAB_ID_8822B(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8822B(x) | BIT_GTAB_ID_8822B(v)) -+ -+#define BIT_SHIFT_AC1_PKT_INFO_8822B 16 -+#define BIT_MASK_AC1_PKT_INFO_8822B 0xfff -+#define BIT_AC1_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_AC1_PKT_INFO_8822B) << BIT_SHIFT_AC1_PKT_INFO_8822B) -+#define BITS_AC1_PKT_INFO_8822B \ -+ (BIT_MASK_AC1_PKT_INFO_8822B << BIT_SHIFT_AC1_PKT_INFO_8822B) -+#define BIT_CLEAR_AC1_PKT_INFO_8822B(x) ((x) & (~BITS_AC1_PKT_INFO_8822B)) -+#define BIT_GET_AC1_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_AC1_PKT_INFO_8822B) & BIT_MASK_AC1_PKT_INFO_8822B) -+#define BIT_SET_AC1_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_AC1_PKT_INFO_8822B(x) | BIT_AC1_PKT_INFO_8822B(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8822B BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8822B 12 -+#define BIT_MASK_GTAB_ID_V1_8822B 0x7 -+#define BIT_GTAB_ID_V1_8822B(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8822B) << BIT_SHIFT_GTAB_ID_V1_8822B) -+#define BITS_GTAB_ID_V1_8822B \ -+ (BIT_MASK_GTAB_ID_V1_8822B << BIT_SHIFT_GTAB_ID_V1_8822B) -+#define BIT_CLEAR_GTAB_ID_V1_8822B(x) ((x) & (~BITS_GTAB_ID_V1_8822B)) -+#define BIT_GET_GTAB_ID_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8822B) & BIT_MASK_GTAB_ID_V1_8822B) -+#define BIT_SET_GTAB_ID_V1_8822B(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8822B(x) | BIT_GTAB_ID_V1_8822B(v)) -+ -+#define BIT_SHIFT_AC0_PKT_INFO_8822B 0 -+#define BIT_MASK_AC0_PKT_INFO_8822B 0xfff -+#define BIT_AC0_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_AC0_PKT_INFO_8822B) << BIT_SHIFT_AC0_PKT_INFO_8822B) -+#define BITS_AC0_PKT_INFO_8822B \ -+ (BIT_MASK_AC0_PKT_INFO_8822B << BIT_SHIFT_AC0_PKT_INFO_8822B) -+#define BIT_CLEAR_AC0_PKT_INFO_8822B(x) ((x) & (~BITS_AC0_PKT_INFO_8822B)) -+#define BIT_GET_AC0_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_AC0_PKT_INFO_8822B) & BIT_MASK_AC0_PKT_INFO_8822B) -+#define BIT_SET_AC0_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_AC0_PKT_INFO_8822B(x) | BIT_AC0_PKT_INFO_8822B(v)) -+ -+/* 2 REG_Q2_Q3_INFO_8822B */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8822B BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8822B 28 -+#define BIT_MASK_GTAB_ID_8822B 0x7 -+#define BIT_GTAB_ID_8822B(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8822B) << BIT_SHIFT_GTAB_ID_8822B) -+#define BITS_GTAB_ID_8822B (BIT_MASK_GTAB_ID_8822B << BIT_SHIFT_GTAB_ID_8822B) -+#define BIT_CLEAR_GTAB_ID_8822B(x) ((x) & (~BITS_GTAB_ID_8822B)) -+#define BIT_GET_GTAB_ID_8822B(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8822B) & BIT_MASK_GTAB_ID_8822B) -+#define BIT_SET_GTAB_ID_8822B(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8822B(x) | BIT_GTAB_ID_8822B(v)) -+ -+#define BIT_SHIFT_AC3_PKT_INFO_8822B 16 -+#define BIT_MASK_AC3_PKT_INFO_8822B 0xfff -+#define BIT_AC3_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_AC3_PKT_INFO_8822B) << BIT_SHIFT_AC3_PKT_INFO_8822B) -+#define BITS_AC3_PKT_INFO_8822B \ -+ (BIT_MASK_AC3_PKT_INFO_8822B << BIT_SHIFT_AC3_PKT_INFO_8822B) -+#define BIT_CLEAR_AC3_PKT_INFO_8822B(x) ((x) & (~BITS_AC3_PKT_INFO_8822B)) -+#define BIT_GET_AC3_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_AC3_PKT_INFO_8822B) & BIT_MASK_AC3_PKT_INFO_8822B) -+#define BIT_SET_AC3_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_AC3_PKT_INFO_8822B(x) | BIT_AC3_PKT_INFO_8822B(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8822B BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8822B 12 -+#define BIT_MASK_GTAB_ID_V1_8822B 0x7 -+#define BIT_GTAB_ID_V1_8822B(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8822B) << BIT_SHIFT_GTAB_ID_V1_8822B) -+#define BITS_GTAB_ID_V1_8822B \ -+ (BIT_MASK_GTAB_ID_V1_8822B << BIT_SHIFT_GTAB_ID_V1_8822B) -+#define BIT_CLEAR_GTAB_ID_V1_8822B(x) ((x) & (~BITS_GTAB_ID_V1_8822B)) -+#define BIT_GET_GTAB_ID_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8822B) & BIT_MASK_GTAB_ID_V1_8822B) -+#define BIT_SET_GTAB_ID_V1_8822B(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8822B(x) | BIT_GTAB_ID_V1_8822B(v)) -+ -+#define BIT_SHIFT_AC2_PKT_INFO_8822B 0 -+#define BIT_MASK_AC2_PKT_INFO_8822B 0xfff -+#define BIT_AC2_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_AC2_PKT_INFO_8822B) << BIT_SHIFT_AC2_PKT_INFO_8822B) -+#define BITS_AC2_PKT_INFO_8822B \ -+ (BIT_MASK_AC2_PKT_INFO_8822B << BIT_SHIFT_AC2_PKT_INFO_8822B) -+#define BIT_CLEAR_AC2_PKT_INFO_8822B(x) ((x) & (~BITS_AC2_PKT_INFO_8822B)) -+#define BIT_GET_AC2_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_AC2_PKT_INFO_8822B) & BIT_MASK_AC2_PKT_INFO_8822B) -+#define BIT_SET_AC2_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_AC2_PKT_INFO_8822B(x) | BIT_AC2_PKT_INFO_8822B(v)) -+ -+/* 2 REG_Q4_Q5_INFO_8822B */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8822B BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8822B 28 -+#define BIT_MASK_GTAB_ID_8822B 0x7 -+#define BIT_GTAB_ID_8822B(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8822B) << BIT_SHIFT_GTAB_ID_8822B) -+#define BITS_GTAB_ID_8822B (BIT_MASK_GTAB_ID_8822B << BIT_SHIFT_GTAB_ID_8822B) -+#define BIT_CLEAR_GTAB_ID_8822B(x) ((x) & (~BITS_GTAB_ID_8822B)) -+#define BIT_GET_GTAB_ID_8822B(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8822B) & BIT_MASK_GTAB_ID_8822B) -+#define BIT_SET_GTAB_ID_8822B(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8822B(x) | BIT_GTAB_ID_8822B(v)) -+ -+#define BIT_SHIFT_AC5_PKT_INFO_8822B 16 -+#define BIT_MASK_AC5_PKT_INFO_8822B 0xfff -+#define BIT_AC5_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_AC5_PKT_INFO_8822B) << BIT_SHIFT_AC5_PKT_INFO_8822B) -+#define BITS_AC5_PKT_INFO_8822B \ -+ (BIT_MASK_AC5_PKT_INFO_8822B << BIT_SHIFT_AC5_PKT_INFO_8822B) -+#define BIT_CLEAR_AC5_PKT_INFO_8822B(x) ((x) & (~BITS_AC5_PKT_INFO_8822B)) -+#define BIT_GET_AC5_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_AC5_PKT_INFO_8822B) & BIT_MASK_AC5_PKT_INFO_8822B) -+#define BIT_SET_AC5_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_AC5_PKT_INFO_8822B(x) | BIT_AC5_PKT_INFO_8822B(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8822B BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8822B 12 -+#define BIT_MASK_GTAB_ID_V1_8822B 0x7 -+#define BIT_GTAB_ID_V1_8822B(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8822B) << BIT_SHIFT_GTAB_ID_V1_8822B) -+#define BITS_GTAB_ID_V1_8822B \ -+ (BIT_MASK_GTAB_ID_V1_8822B << BIT_SHIFT_GTAB_ID_V1_8822B) -+#define BIT_CLEAR_GTAB_ID_V1_8822B(x) ((x) & (~BITS_GTAB_ID_V1_8822B)) -+#define BIT_GET_GTAB_ID_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8822B) & BIT_MASK_GTAB_ID_V1_8822B) -+#define BIT_SET_GTAB_ID_V1_8822B(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8822B(x) | BIT_GTAB_ID_V1_8822B(v)) -+ -+#define BIT_SHIFT_AC4_PKT_INFO_8822B 0 -+#define BIT_MASK_AC4_PKT_INFO_8822B 0xfff -+#define BIT_AC4_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_AC4_PKT_INFO_8822B) << BIT_SHIFT_AC4_PKT_INFO_8822B) -+#define BITS_AC4_PKT_INFO_8822B \ -+ (BIT_MASK_AC4_PKT_INFO_8822B << BIT_SHIFT_AC4_PKT_INFO_8822B) -+#define BIT_CLEAR_AC4_PKT_INFO_8822B(x) ((x) & (~BITS_AC4_PKT_INFO_8822B)) -+#define BIT_GET_AC4_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_AC4_PKT_INFO_8822B) & BIT_MASK_AC4_PKT_INFO_8822B) -+#define BIT_SET_AC4_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_AC4_PKT_INFO_8822B(x) | BIT_AC4_PKT_INFO_8822B(v)) -+ -+/* 2 REG_Q6_Q7_INFO_8822B */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8822B BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8822B 28 -+#define BIT_MASK_GTAB_ID_8822B 0x7 -+#define BIT_GTAB_ID_8822B(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8822B) << BIT_SHIFT_GTAB_ID_8822B) -+#define BITS_GTAB_ID_8822B (BIT_MASK_GTAB_ID_8822B << BIT_SHIFT_GTAB_ID_8822B) -+#define BIT_CLEAR_GTAB_ID_8822B(x) ((x) & (~BITS_GTAB_ID_8822B)) -+#define BIT_GET_GTAB_ID_8822B(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8822B) & BIT_MASK_GTAB_ID_8822B) -+#define BIT_SET_GTAB_ID_8822B(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8822B(x) | BIT_GTAB_ID_8822B(v)) -+ -+#define BIT_SHIFT_AC7_PKT_INFO_8822B 16 -+#define BIT_MASK_AC7_PKT_INFO_8822B 0xfff -+#define BIT_AC7_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_AC7_PKT_INFO_8822B) << BIT_SHIFT_AC7_PKT_INFO_8822B) -+#define BITS_AC7_PKT_INFO_8822B \ -+ (BIT_MASK_AC7_PKT_INFO_8822B << BIT_SHIFT_AC7_PKT_INFO_8822B) -+#define BIT_CLEAR_AC7_PKT_INFO_8822B(x) ((x) & (~BITS_AC7_PKT_INFO_8822B)) -+#define BIT_GET_AC7_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_AC7_PKT_INFO_8822B) & BIT_MASK_AC7_PKT_INFO_8822B) -+#define BIT_SET_AC7_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_AC7_PKT_INFO_8822B(x) | BIT_AC7_PKT_INFO_8822B(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8822B BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8822B 12 -+#define BIT_MASK_GTAB_ID_V1_8822B 0x7 -+#define BIT_GTAB_ID_V1_8822B(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8822B) << BIT_SHIFT_GTAB_ID_V1_8822B) -+#define BITS_GTAB_ID_V1_8822B \ -+ (BIT_MASK_GTAB_ID_V1_8822B << BIT_SHIFT_GTAB_ID_V1_8822B) -+#define BIT_CLEAR_GTAB_ID_V1_8822B(x) ((x) & (~BITS_GTAB_ID_V1_8822B)) -+#define BIT_GET_GTAB_ID_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8822B) & BIT_MASK_GTAB_ID_V1_8822B) -+#define BIT_SET_GTAB_ID_V1_8822B(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8822B(x) | BIT_GTAB_ID_V1_8822B(v)) -+ -+#define BIT_SHIFT_AC6_PKT_INFO_8822B 0 -+#define BIT_MASK_AC6_PKT_INFO_8822B 0xfff -+#define BIT_AC6_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_AC6_PKT_INFO_8822B) << BIT_SHIFT_AC6_PKT_INFO_8822B) -+#define BITS_AC6_PKT_INFO_8822B \ -+ (BIT_MASK_AC6_PKT_INFO_8822B << BIT_SHIFT_AC6_PKT_INFO_8822B) -+#define BIT_CLEAR_AC6_PKT_INFO_8822B(x) ((x) & (~BITS_AC6_PKT_INFO_8822B)) -+#define BIT_GET_AC6_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_AC6_PKT_INFO_8822B) & BIT_MASK_AC6_PKT_INFO_8822B) -+#define BIT_SET_AC6_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_AC6_PKT_INFO_8822B(x) | BIT_AC6_PKT_INFO_8822B(v)) -+ -+/* 2 REG_MGQ_HIQ_INFO_8822B */ -+ -+#define BIT_SHIFT_HIQ_PKT_INFO_8822B 16 -+#define BIT_MASK_HIQ_PKT_INFO_8822B 0xfff -+#define BIT_HIQ_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_HIQ_PKT_INFO_8822B) << BIT_SHIFT_HIQ_PKT_INFO_8822B) -+#define BITS_HIQ_PKT_INFO_8822B \ -+ (BIT_MASK_HIQ_PKT_INFO_8822B << BIT_SHIFT_HIQ_PKT_INFO_8822B) -+#define BIT_CLEAR_HIQ_PKT_INFO_8822B(x) ((x) & (~BITS_HIQ_PKT_INFO_8822B)) -+#define BIT_GET_HIQ_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_HIQ_PKT_INFO_8822B) & BIT_MASK_HIQ_PKT_INFO_8822B) -+#define BIT_SET_HIQ_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_HIQ_PKT_INFO_8822B(x) | BIT_HIQ_PKT_INFO_8822B(v)) -+ -+#define BIT_SHIFT_MGQ_PKT_INFO_8822B 0 -+#define BIT_MASK_MGQ_PKT_INFO_8822B 0xfff -+#define BIT_MGQ_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_MGQ_PKT_INFO_8822B) << BIT_SHIFT_MGQ_PKT_INFO_8822B) -+#define BITS_MGQ_PKT_INFO_8822B \ -+ (BIT_MASK_MGQ_PKT_INFO_8822B << BIT_SHIFT_MGQ_PKT_INFO_8822B) -+#define BIT_CLEAR_MGQ_PKT_INFO_8822B(x) ((x) & (~BITS_MGQ_PKT_INFO_8822B)) -+#define BIT_GET_MGQ_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PKT_INFO_8822B) & BIT_MASK_MGQ_PKT_INFO_8822B) -+#define BIT_SET_MGQ_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_MGQ_PKT_INFO_8822B(x) | BIT_MGQ_PKT_INFO_8822B(v)) -+ -+/* 2 REG_CMDQ_BCNQ_INFO_8822B */ -+ -+#define BIT_SHIFT_CMDQ_PKT_INFO_8822B 16 -+#define BIT_MASK_CMDQ_PKT_INFO_8822B 0xfff -+#define BIT_CMDQ_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_CMDQ_PKT_INFO_8822B) << BIT_SHIFT_CMDQ_PKT_INFO_8822B) -+#define BITS_CMDQ_PKT_INFO_8822B \ -+ (BIT_MASK_CMDQ_PKT_INFO_8822B << BIT_SHIFT_CMDQ_PKT_INFO_8822B) -+#define BIT_CLEAR_CMDQ_PKT_INFO_8822B(x) ((x) & (~BITS_CMDQ_PKT_INFO_8822B)) -+#define BIT_GET_CMDQ_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_CMDQ_PKT_INFO_8822B) & BIT_MASK_CMDQ_PKT_INFO_8822B) -+#define BIT_SET_CMDQ_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_CMDQ_PKT_INFO_8822B(x) | BIT_CMDQ_PKT_INFO_8822B(v)) -+ -+#define BIT_SHIFT_BCNQ_PKT_INFO_8822B 0 -+#define BIT_MASK_BCNQ_PKT_INFO_8822B 0xfff -+#define BIT_BCNQ_PKT_INFO_8822B(x) \ -+ (((x) & BIT_MASK_BCNQ_PKT_INFO_8822B) << BIT_SHIFT_BCNQ_PKT_INFO_8822B) -+#define BITS_BCNQ_PKT_INFO_8822B \ -+ (BIT_MASK_BCNQ_PKT_INFO_8822B << BIT_SHIFT_BCNQ_PKT_INFO_8822B) -+#define BIT_CLEAR_BCNQ_PKT_INFO_8822B(x) ((x) & (~BITS_BCNQ_PKT_INFO_8822B)) -+#define BIT_GET_BCNQ_PKT_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PKT_INFO_8822B) & BIT_MASK_BCNQ_PKT_INFO_8822B) -+#define BIT_SET_BCNQ_PKT_INFO_8822B(x, v) \ -+ (BIT_CLEAR_BCNQ_PKT_INFO_8822B(x) | BIT_BCNQ_PKT_INFO_8822B(v)) -+ -+/* 2 REG_USEREG_SETTING_8822B */ -+#define BIT_NDPA_USEREG_8822B BIT(21) -+ -+#define BIT_SHIFT_RETRY_USEREG_8822B 19 -+#define BIT_MASK_RETRY_USEREG_8822B 0x3 -+#define BIT_RETRY_USEREG_8822B(x) \ -+ (((x) & BIT_MASK_RETRY_USEREG_8822B) << BIT_SHIFT_RETRY_USEREG_8822B) -+#define BITS_RETRY_USEREG_8822B \ -+ (BIT_MASK_RETRY_USEREG_8822B << BIT_SHIFT_RETRY_USEREG_8822B) -+#define BIT_CLEAR_RETRY_USEREG_8822B(x) ((x) & (~BITS_RETRY_USEREG_8822B)) -+#define BIT_GET_RETRY_USEREG_8822B(x) \ -+ (((x) >> BIT_SHIFT_RETRY_USEREG_8822B) & BIT_MASK_RETRY_USEREG_8822B) -+#define BIT_SET_RETRY_USEREG_8822B(x, v) \ -+ (BIT_CLEAR_RETRY_USEREG_8822B(x) | BIT_RETRY_USEREG_8822B(v)) -+ -+#define BIT_SHIFT_TRYPKT_USEREG_8822B 17 -+#define BIT_MASK_TRYPKT_USEREG_8822B 0x3 -+#define BIT_TRYPKT_USEREG_8822B(x) \ -+ (((x) & BIT_MASK_TRYPKT_USEREG_8822B) << BIT_SHIFT_TRYPKT_USEREG_8822B) -+#define BITS_TRYPKT_USEREG_8822B \ -+ (BIT_MASK_TRYPKT_USEREG_8822B << BIT_SHIFT_TRYPKT_USEREG_8822B) -+#define BIT_CLEAR_TRYPKT_USEREG_8822B(x) ((x) & (~BITS_TRYPKT_USEREG_8822B)) -+#define BIT_GET_TRYPKT_USEREG_8822B(x) \ -+ (((x) >> BIT_SHIFT_TRYPKT_USEREG_8822B) & BIT_MASK_TRYPKT_USEREG_8822B) -+#define BIT_SET_TRYPKT_USEREG_8822B(x, v) \ -+ (BIT_CLEAR_TRYPKT_USEREG_8822B(x) | BIT_TRYPKT_USEREG_8822B(v)) -+ -+#define BIT_CTLPKT_USEREG_8822B BIT(16) -+ -+/* 2 REG_AESIV_SETTING_8822B */ -+ -+#define BIT_SHIFT_AESIV_OFFSET_8822B 0 -+#define BIT_MASK_AESIV_OFFSET_8822B 0xfff -+#define BIT_AESIV_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_AESIV_OFFSET_8822B) << BIT_SHIFT_AESIV_OFFSET_8822B) -+#define BITS_AESIV_OFFSET_8822B \ -+ (BIT_MASK_AESIV_OFFSET_8822B << BIT_SHIFT_AESIV_OFFSET_8822B) -+#define BIT_CLEAR_AESIV_OFFSET_8822B(x) ((x) & (~BITS_AESIV_OFFSET_8822B)) -+#define BIT_GET_AESIV_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_AESIV_OFFSET_8822B) & BIT_MASK_AESIV_OFFSET_8822B) -+#define BIT_SET_AESIV_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_AESIV_OFFSET_8822B(x) | BIT_AESIV_OFFSET_8822B(v)) -+ -+/* 2 REG_BF0_TIME_SETTING_8822B */ -+#define BIT_BF0_TIMER_SET_8822B BIT(31) -+#define BIT_BF0_TIMER_CLR_8822B BIT(30) -+#define BIT_BF0_UPDATE_EN_8822B BIT(29) -+#define BIT_BF0_TIMER_EN_8822B BIT(28) -+ -+#define BIT_SHIFT_BF0_PRETIME_OVER_8822B 16 -+#define BIT_MASK_BF0_PRETIME_OVER_8822B 0xfff -+#define BIT_BF0_PRETIME_OVER_8822B(x) \ -+ (((x) & BIT_MASK_BF0_PRETIME_OVER_8822B) \ -+ << BIT_SHIFT_BF0_PRETIME_OVER_8822B) -+#define BITS_BF0_PRETIME_OVER_8822B \ -+ (BIT_MASK_BF0_PRETIME_OVER_8822B << BIT_SHIFT_BF0_PRETIME_OVER_8822B) -+#define BIT_CLEAR_BF0_PRETIME_OVER_8822B(x) \ -+ ((x) & (~BITS_BF0_PRETIME_OVER_8822B)) -+#define BIT_GET_BF0_PRETIME_OVER_8822B(x) \ -+ (((x) >> BIT_SHIFT_BF0_PRETIME_OVER_8822B) & \ -+ BIT_MASK_BF0_PRETIME_OVER_8822B) -+#define BIT_SET_BF0_PRETIME_OVER_8822B(x, v) \ -+ (BIT_CLEAR_BF0_PRETIME_OVER_8822B(x) | BIT_BF0_PRETIME_OVER_8822B(v)) -+ -+#define BIT_SHIFT_BF0_LIFETIME_8822B 0 -+#define BIT_MASK_BF0_LIFETIME_8822B 0xffff -+#define BIT_BF0_LIFETIME_8822B(x) \ -+ (((x) & BIT_MASK_BF0_LIFETIME_8822B) << BIT_SHIFT_BF0_LIFETIME_8822B) -+#define BITS_BF0_LIFETIME_8822B \ -+ (BIT_MASK_BF0_LIFETIME_8822B << BIT_SHIFT_BF0_LIFETIME_8822B) -+#define BIT_CLEAR_BF0_LIFETIME_8822B(x) ((x) & (~BITS_BF0_LIFETIME_8822B)) -+#define BIT_GET_BF0_LIFETIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_BF0_LIFETIME_8822B) & BIT_MASK_BF0_LIFETIME_8822B) -+#define BIT_SET_BF0_LIFETIME_8822B(x, v) \ -+ (BIT_CLEAR_BF0_LIFETIME_8822B(x) | BIT_BF0_LIFETIME_8822B(v)) -+ -+/* 2 REG_BF1_TIME_SETTING_8822B */ -+#define BIT_BF1_TIMER_SET_8822B BIT(31) -+#define BIT_BF1_TIMER_CLR_8822B BIT(30) -+#define BIT_BF1_UPDATE_EN_8822B BIT(29) -+#define BIT_BF1_TIMER_EN_8822B BIT(28) -+ -+#define BIT_SHIFT_BF1_PRETIME_OVER_8822B 16 -+#define BIT_MASK_BF1_PRETIME_OVER_8822B 0xfff -+#define BIT_BF1_PRETIME_OVER_8822B(x) \ -+ (((x) & BIT_MASK_BF1_PRETIME_OVER_8822B) \ -+ << BIT_SHIFT_BF1_PRETIME_OVER_8822B) -+#define BITS_BF1_PRETIME_OVER_8822B \ -+ (BIT_MASK_BF1_PRETIME_OVER_8822B << BIT_SHIFT_BF1_PRETIME_OVER_8822B) -+#define BIT_CLEAR_BF1_PRETIME_OVER_8822B(x) \ -+ ((x) & (~BITS_BF1_PRETIME_OVER_8822B)) -+#define BIT_GET_BF1_PRETIME_OVER_8822B(x) \ -+ (((x) >> BIT_SHIFT_BF1_PRETIME_OVER_8822B) & \ -+ BIT_MASK_BF1_PRETIME_OVER_8822B) -+#define BIT_SET_BF1_PRETIME_OVER_8822B(x, v) \ -+ (BIT_CLEAR_BF1_PRETIME_OVER_8822B(x) | BIT_BF1_PRETIME_OVER_8822B(v)) -+ -+#define BIT_SHIFT_BF1_LIFETIME_8822B 0 -+#define BIT_MASK_BF1_LIFETIME_8822B 0xffff -+#define BIT_BF1_LIFETIME_8822B(x) \ -+ (((x) & BIT_MASK_BF1_LIFETIME_8822B) << BIT_SHIFT_BF1_LIFETIME_8822B) -+#define BITS_BF1_LIFETIME_8822B \ -+ (BIT_MASK_BF1_LIFETIME_8822B << BIT_SHIFT_BF1_LIFETIME_8822B) -+#define BIT_CLEAR_BF1_LIFETIME_8822B(x) ((x) & (~BITS_BF1_LIFETIME_8822B)) -+#define BIT_GET_BF1_LIFETIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_BF1_LIFETIME_8822B) & BIT_MASK_BF1_LIFETIME_8822B) -+#define BIT_SET_BF1_LIFETIME_8822B(x, v) \ -+ (BIT_CLEAR_BF1_LIFETIME_8822B(x) | BIT_BF1_LIFETIME_8822B(v)) -+ -+/* 2 REG_BF_TIMEOUT_EN_8822B */ -+#define BIT_EN_VHT_LDPC_8822B BIT(9) -+#define BIT_EN_HT_LDPC_8822B BIT(8) -+#define BIT_BF1_TIMEOUT_EN_8822B BIT(1) -+#define BIT_BF0_TIMEOUT_EN_8822B BIT(0) -+ -+/* 2 REG_MACID_RELEASE0_8822B */ -+ -+#define BIT_SHIFT_MACID31_0_RELEASE_8822B 0 -+#define BIT_MASK_MACID31_0_RELEASE_8822B 0xffffffffL -+#define BIT_MACID31_0_RELEASE_8822B(x) \ -+ (((x) & BIT_MASK_MACID31_0_RELEASE_8822B) \ -+ << BIT_SHIFT_MACID31_0_RELEASE_8822B) -+#define BITS_MACID31_0_RELEASE_8822B \ -+ (BIT_MASK_MACID31_0_RELEASE_8822B << BIT_SHIFT_MACID31_0_RELEASE_8822B) -+#define BIT_CLEAR_MACID31_0_RELEASE_8822B(x) \ -+ ((x) & (~BITS_MACID31_0_RELEASE_8822B)) -+#define BIT_GET_MACID31_0_RELEASE_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_RELEASE_8822B) & \ -+ BIT_MASK_MACID31_0_RELEASE_8822B) -+#define BIT_SET_MACID31_0_RELEASE_8822B(x, v) \ -+ (BIT_CLEAR_MACID31_0_RELEASE_8822B(x) | BIT_MACID31_0_RELEASE_8822B(v)) -+ -+/* 2 REG_MACID_RELEASE1_8822B */ -+ -+#define BIT_SHIFT_MACID63_32_RELEASE_8822B 0 -+#define BIT_MASK_MACID63_32_RELEASE_8822B 0xffffffffL -+#define BIT_MACID63_32_RELEASE_8822B(x) \ -+ (((x) & BIT_MASK_MACID63_32_RELEASE_8822B) \ -+ << BIT_SHIFT_MACID63_32_RELEASE_8822B) -+#define BITS_MACID63_32_RELEASE_8822B \ -+ (BIT_MASK_MACID63_32_RELEASE_8822B \ -+ << BIT_SHIFT_MACID63_32_RELEASE_8822B) -+#define BIT_CLEAR_MACID63_32_RELEASE_8822B(x) \ -+ ((x) & (~BITS_MACID63_32_RELEASE_8822B)) -+#define BIT_GET_MACID63_32_RELEASE_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_RELEASE_8822B) & \ -+ BIT_MASK_MACID63_32_RELEASE_8822B) -+#define BIT_SET_MACID63_32_RELEASE_8822B(x, v) \ -+ (BIT_CLEAR_MACID63_32_RELEASE_8822B(x) | \ -+ BIT_MACID63_32_RELEASE_8822B(v)) -+ -+/* 2 REG_MACID_RELEASE2_8822B */ -+ -+#define BIT_SHIFT_MACID95_64_RELEASE_8822B 0 -+#define BIT_MASK_MACID95_64_RELEASE_8822B 0xffffffffL -+#define BIT_MACID95_64_RELEASE_8822B(x) \ -+ (((x) & BIT_MASK_MACID95_64_RELEASE_8822B) \ -+ << BIT_SHIFT_MACID95_64_RELEASE_8822B) -+#define BITS_MACID95_64_RELEASE_8822B \ -+ (BIT_MASK_MACID95_64_RELEASE_8822B \ -+ << BIT_SHIFT_MACID95_64_RELEASE_8822B) -+#define BIT_CLEAR_MACID95_64_RELEASE_8822B(x) \ -+ ((x) & (~BITS_MACID95_64_RELEASE_8822B)) -+#define BIT_GET_MACID95_64_RELEASE_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_RELEASE_8822B) & \ -+ BIT_MASK_MACID95_64_RELEASE_8822B) -+#define BIT_SET_MACID95_64_RELEASE_8822B(x, v) \ -+ (BIT_CLEAR_MACID95_64_RELEASE_8822B(x) | \ -+ BIT_MACID95_64_RELEASE_8822B(v)) -+ -+/* 2 REG_MACID_RELEASE3_8822B */ -+ -+#define BIT_SHIFT_MACID127_96_RELEASE_8822B 0 -+#define BIT_MASK_MACID127_96_RELEASE_8822B 0xffffffffL -+#define BIT_MACID127_96_RELEASE_8822B(x) \ -+ (((x) & BIT_MASK_MACID127_96_RELEASE_8822B) \ -+ << BIT_SHIFT_MACID127_96_RELEASE_8822B) -+#define BITS_MACID127_96_RELEASE_8822B \ -+ (BIT_MASK_MACID127_96_RELEASE_8822B \ -+ << BIT_SHIFT_MACID127_96_RELEASE_8822B) -+#define BIT_CLEAR_MACID127_96_RELEASE_8822B(x) \ -+ ((x) & (~BITS_MACID127_96_RELEASE_8822B)) -+#define BIT_GET_MACID127_96_RELEASE_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_RELEASE_8822B) & \ -+ BIT_MASK_MACID127_96_RELEASE_8822B) -+#define BIT_SET_MACID127_96_RELEASE_8822B(x, v) \ -+ (BIT_CLEAR_MACID127_96_RELEASE_8822B(x) | \ -+ BIT_MACID127_96_RELEASE_8822B(v)) -+ -+/* 2 REG_MACID_RELEASE_SETTING_8822B */ -+#define BIT_MACID_VALUE_8822B BIT(7) -+ -+#define BIT_SHIFT_MACID_OFFSET_8822B 0 -+#define BIT_MASK_MACID_OFFSET_8822B 0x7f -+#define BIT_MACID_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_MACID_OFFSET_8822B) << BIT_SHIFT_MACID_OFFSET_8822B) -+#define BITS_MACID_OFFSET_8822B \ -+ (BIT_MASK_MACID_OFFSET_8822B << BIT_SHIFT_MACID_OFFSET_8822B) -+#define BIT_CLEAR_MACID_OFFSET_8822B(x) ((x) & (~BITS_MACID_OFFSET_8822B)) -+#define BIT_GET_MACID_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID_OFFSET_8822B) & BIT_MASK_MACID_OFFSET_8822B) -+#define BIT_SET_MACID_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_MACID_OFFSET_8822B(x) | BIT_MACID_OFFSET_8822B(v)) -+ -+/* 2 REG_FAST_EDCA_VOVI_SETTING_8822B */ -+ -+#define BIT_SHIFT_VI_FAST_EDCA_TO_8822B 24 -+#define BIT_MASK_VI_FAST_EDCA_TO_8822B 0xff -+#define BIT_VI_FAST_EDCA_TO_8822B(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_TO_8822B) \ -+ << BIT_SHIFT_VI_FAST_EDCA_TO_8822B) -+#define BITS_VI_FAST_EDCA_TO_8822B \ -+ (BIT_MASK_VI_FAST_EDCA_TO_8822B << BIT_SHIFT_VI_FAST_EDCA_TO_8822B) -+#define BIT_CLEAR_VI_FAST_EDCA_TO_8822B(x) ((x) & (~BITS_VI_FAST_EDCA_TO_8822B)) -+#define BIT_GET_VI_FAST_EDCA_TO_8822B(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_TO_8822B) & \ -+ BIT_MASK_VI_FAST_EDCA_TO_8822B) -+#define BIT_SET_VI_FAST_EDCA_TO_8822B(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_TO_8822B(x) | BIT_VI_FAST_EDCA_TO_8822B(v)) -+ -+#define BIT_VI_THRESHOLD_SEL_8822B BIT(23) -+ -+#define BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8822B 16 -+#define BIT_MASK_VI_FAST_EDCA_PKT_TH_8822B 0x7f -+#define BIT_VI_FAST_EDCA_PKT_TH_8822B(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_PKT_TH_8822B) \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8822B) -+#define BITS_VI_FAST_EDCA_PKT_TH_8822B \ -+ (BIT_MASK_VI_FAST_EDCA_PKT_TH_8822B \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8822B) -+#define BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8822B(x) \ -+ ((x) & (~BITS_VI_FAST_EDCA_PKT_TH_8822B)) -+#define BIT_GET_VI_FAST_EDCA_PKT_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8822B) & \ -+ BIT_MASK_VI_FAST_EDCA_PKT_TH_8822B) -+#define BIT_SET_VI_FAST_EDCA_PKT_TH_8822B(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8822B(x) | \ -+ BIT_VI_FAST_EDCA_PKT_TH_8822B(v)) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_TO_8822B 8 -+#define BIT_MASK_VO_FAST_EDCA_TO_8822B 0xff -+#define BIT_VO_FAST_EDCA_TO_8822B(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_TO_8822B) \ -+ << BIT_SHIFT_VO_FAST_EDCA_TO_8822B) -+#define BITS_VO_FAST_EDCA_TO_8822B \ -+ (BIT_MASK_VO_FAST_EDCA_TO_8822B << BIT_SHIFT_VO_FAST_EDCA_TO_8822B) -+#define BIT_CLEAR_VO_FAST_EDCA_TO_8822B(x) ((x) & (~BITS_VO_FAST_EDCA_TO_8822B)) -+#define BIT_GET_VO_FAST_EDCA_TO_8822B(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_TO_8822B) & \ -+ BIT_MASK_VO_FAST_EDCA_TO_8822B) -+#define BIT_SET_VO_FAST_EDCA_TO_8822B(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_TO_8822B(x) | BIT_VO_FAST_EDCA_TO_8822B(v)) -+ -+#define BIT_VO_THRESHOLD_SEL_8822B BIT(7) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8822B 0 -+#define BIT_MASK_VO_FAST_EDCA_PKT_TH_8822B 0x7f -+#define BIT_VO_FAST_EDCA_PKT_TH_8822B(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_PKT_TH_8822B) \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8822B) -+#define BITS_VO_FAST_EDCA_PKT_TH_8822B \ -+ (BIT_MASK_VO_FAST_EDCA_PKT_TH_8822B \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8822B) -+#define BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8822B(x) \ -+ ((x) & (~BITS_VO_FAST_EDCA_PKT_TH_8822B)) -+#define BIT_GET_VO_FAST_EDCA_PKT_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8822B) & \ -+ BIT_MASK_VO_FAST_EDCA_PKT_TH_8822B) -+#define BIT_SET_VO_FAST_EDCA_PKT_TH_8822B(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8822B(x) | \ -+ BIT_VO_FAST_EDCA_PKT_TH_8822B(v)) -+ -+/* 2 REG_FAST_EDCA_BEBK_SETTING_8822B */ -+ -+#define BIT_SHIFT_BK_FAST_EDCA_TO_8822B 24 -+#define BIT_MASK_BK_FAST_EDCA_TO_8822B 0xff -+#define BIT_BK_FAST_EDCA_TO_8822B(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_TO_8822B) \ -+ << BIT_SHIFT_BK_FAST_EDCA_TO_8822B) -+#define BITS_BK_FAST_EDCA_TO_8822B \ -+ (BIT_MASK_BK_FAST_EDCA_TO_8822B << BIT_SHIFT_BK_FAST_EDCA_TO_8822B) -+#define BIT_CLEAR_BK_FAST_EDCA_TO_8822B(x) ((x) & (~BITS_BK_FAST_EDCA_TO_8822B)) -+#define BIT_GET_BK_FAST_EDCA_TO_8822B(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_TO_8822B) & \ -+ BIT_MASK_BK_FAST_EDCA_TO_8822B) -+#define BIT_SET_BK_FAST_EDCA_TO_8822B(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_TO_8822B(x) | BIT_BK_FAST_EDCA_TO_8822B(v)) -+ -+#define BIT_BK_THRESHOLD_SEL_8822B BIT(23) -+ -+#define BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8822B 16 -+#define BIT_MASK_BK_FAST_EDCA_PKT_TH_8822B 0x7f -+#define BIT_BK_FAST_EDCA_PKT_TH_8822B(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_PKT_TH_8822B) \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8822B) -+#define BITS_BK_FAST_EDCA_PKT_TH_8822B \ -+ (BIT_MASK_BK_FAST_EDCA_PKT_TH_8822B \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8822B) -+#define BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8822B(x) \ -+ ((x) & (~BITS_BK_FAST_EDCA_PKT_TH_8822B)) -+#define BIT_GET_BK_FAST_EDCA_PKT_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8822B) & \ -+ BIT_MASK_BK_FAST_EDCA_PKT_TH_8822B) -+#define BIT_SET_BK_FAST_EDCA_PKT_TH_8822B(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8822B(x) | \ -+ BIT_BK_FAST_EDCA_PKT_TH_8822B(v)) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_TO_8822B 8 -+#define BIT_MASK_BE_FAST_EDCA_TO_8822B 0xff -+#define BIT_BE_FAST_EDCA_TO_8822B(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_TO_8822B) \ -+ << BIT_SHIFT_BE_FAST_EDCA_TO_8822B) -+#define BITS_BE_FAST_EDCA_TO_8822B \ -+ (BIT_MASK_BE_FAST_EDCA_TO_8822B << BIT_SHIFT_BE_FAST_EDCA_TO_8822B) -+#define BIT_CLEAR_BE_FAST_EDCA_TO_8822B(x) ((x) & (~BITS_BE_FAST_EDCA_TO_8822B)) -+#define BIT_GET_BE_FAST_EDCA_TO_8822B(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_TO_8822B) & \ -+ BIT_MASK_BE_FAST_EDCA_TO_8822B) -+#define BIT_SET_BE_FAST_EDCA_TO_8822B(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_TO_8822B(x) | BIT_BE_FAST_EDCA_TO_8822B(v)) -+ -+#define BIT_BE_THRESHOLD_SEL_8822B BIT(7) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8822B 0 -+#define BIT_MASK_BE_FAST_EDCA_PKT_TH_8822B 0x7f -+#define BIT_BE_FAST_EDCA_PKT_TH_8822B(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_PKT_TH_8822B) \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8822B) -+#define BITS_BE_FAST_EDCA_PKT_TH_8822B \ -+ (BIT_MASK_BE_FAST_EDCA_PKT_TH_8822B \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8822B) -+#define BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8822B(x) \ -+ ((x) & (~BITS_BE_FAST_EDCA_PKT_TH_8822B)) -+#define BIT_GET_BE_FAST_EDCA_PKT_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8822B) & \ -+ BIT_MASK_BE_FAST_EDCA_PKT_TH_8822B) -+#define BIT_SET_BE_FAST_EDCA_PKT_TH_8822B(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8822B(x) | \ -+ BIT_BE_FAST_EDCA_PKT_TH_8822B(v)) -+ -+/* 2 REG_MACID_DROP0_8822B */ -+ -+#define BIT_SHIFT_MACID31_0_DROP_8822B 0 -+#define BIT_MASK_MACID31_0_DROP_8822B 0xffffffffL -+#define BIT_MACID31_0_DROP_8822B(x) \ -+ (((x) & BIT_MASK_MACID31_0_DROP_8822B) \ -+ << BIT_SHIFT_MACID31_0_DROP_8822B) -+#define BITS_MACID31_0_DROP_8822B \ -+ (BIT_MASK_MACID31_0_DROP_8822B << BIT_SHIFT_MACID31_0_DROP_8822B) -+#define BIT_CLEAR_MACID31_0_DROP_8822B(x) ((x) & (~BITS_MACID31_0_DROP_8822B)) -+#define BIT_GET_MACID31_0_DROP_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_DROP_8822B) & \ -+ BIT_MASK_MACID31_0_DROP_8822B) -+#define BIT_SET_MACID31_0_DROP_8822B(x, v) \ -+ (BIT_CLEAR_MACID31_0_DROP_8822B(x) | BIT_MACID31_0_DROP_8822B(v)) -+ -+/* 2 REG_MACID_DROP1_8822B */ -+ -+#define BIT_SHIFT_MACID63_32_DROP_8822B 0 -+#define BIT_MASK_MACID63_32_DROP_8822B 0xffffffffL -+#define BIT_MACID63_32_DROP_8822B(x) \ -+ (((x) & BIT_MASK_MACID63_32_DROP_8822B) \ -+ << BIT_SHIFT_MACID63_32_DROP_8822B) -+#define BITS_MACID63_32_DROP_8822B \ -+ (BIT_MASK_MACID63_32_DROP_8822B << BIT_SHIFT_MACID63_32_DROP_8822B) -+#define BIT_CLEAR_MACID63_32_DROP_8822B(x) ((x) & (~BITS_MACID63_32_DROP_8822B)) -+#define BIT_GET_MACID63_32_DROP_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_DROP_8822B) & \ -+ BIT_MASK_MACID63_32_DROP_8822B) -+#define BIT_SET_MACID63_32_DROP_8822B(x, v) \ -+ (BIT_CLEAR_MACID63_32_DROP_8822B(x) | BIT_MACID63_32_DROP_8822B(v)) -+ -+/* 2 REG_MACID_DROP2_8822B */ -+ -+#define BIT_SHIFT_MACID95_64_DROP_8822B 0 -+#define BIT_MASK_MACID95_64_DROP_8822B 0xffffffffL -+#define BIT_MACID95_64_DROP_8822B(x) \ -+ (((x) & BIT_MASK_MACID95_64_DROP_8822B) \ -+ << BIT_SHIFT_MACID95_64_DROP_8822B) -+#define BITS_MACID95_64_DROP_8822B \ -+ (BIT_MASK_MACID95_64_DROP_8822B << BIT_SHIFT_MACID95_64_DROP_8822B) -+#define BIT_CLEAR_MACID95_64_DROP_8822B(x) ((x) & (~BITS_MACID95_64_DROP_8822B)) -+#define BIT_GET_MACID95_64_DROP_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_DROP_8822B) & \ -+ BIT_MASK_MACID95_64_DROP_8822B) -+#define BIT_SET_MACID95_64_DROP_8822B(x, v) \ -+ (BIT_CLEAR_MACID95_64_DROP_8822B(x) | BIT_MACID95_64_DROP_8822B(v)) -+ -+/* 2 REG_MACID_DROP3_8822B */ -+ -+#define BIT_SHIFT_MACID127_96_DROP_8822B 0 -+#define BIT_MASK_MACID127_96_DROP_8822B 0xffffffffL -+#define BIT_MACID127_96_DROP_8822B(x) \ -+ (((x) & BIT_MASK_MACID127_96_DROP_8822B) \ -+ << BIT_SHIFT_MACID127_96_DROP_8822B) -+#define BITS_MACID127_96_DROP_8822B \ -+ (BIT_MASK_MACID127_96_DROP_8822B << BIT_SHIFT_MACID127_96_DROP_8822B) -+#define BIT_CLEAR_MACID127_96_DROP_8822B(x) \ -+ ((x) & (~BITS_MACID127_96_DROP_8822B)) -+#define BIT_GET_MACID127_96_DROP_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_DROP_8822B) & \ -+ BIT_MASK_MACID127_96_DROP_8822B) -+#define BIT_SET_MACID127_96_DROP_8822B(x, v) \ -+ (BIT_CLEAR_MACID127_96_DROP_8822B(x) | BIT_MACID127_96_DROP_8822B(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_0_8822B */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8822B 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8822B 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_0_8822B(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8822B) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8822B) -+#define BITS_R_MACID_RELEASE_SUCCESS_0_8822B \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8822B \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8822B) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0_8822B(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_0_8822B)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8822B) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8822B) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_0_8822B(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0_8822B(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_0_8822B(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_1_8822B */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8822B 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8822B 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_1_8822B(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8822B) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8822B) -+#define BITS_R_MACID_RELEASE_SUCCESS_1_8822B \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8822B \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8822B) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1_8822B(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_1_8822B)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_1_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8822B) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8822B) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_1_8822B(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1_8822B(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_1_8822B(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_2_8822B */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8822B 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8822B 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_2_8822B(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8822B) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8822B) -+#define BITS_R_MACID_RELEASE_SUCCESS_2_8822B \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8822B \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8822B) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2_8822B(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_2_8822B)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_2_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8822B) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8822B) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_2_8822B(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2_8822B(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_2_8822B(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_3_8822B */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8822B 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8822B 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_3_8822B(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8822B) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8822B) -+#define BITS_R_MACID_RELEASE_SUCCESS_3_8822B \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8822B \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8822B) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3_8822B(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_3_8822B)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_3_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8822B) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8822B) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_3_8822B(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3_8822B(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_3_8822B(v)) -+ -+/* 2 REG_MGG_FIFO_CRTL_8822B */ -+#define BIT_R_MGG_FIFO_EN_8822B BIT(31) -+ -+#define BIT_SHIFT_R_MGG_FIFO_PG_SIZE_8822B 28 -+#define BIT_MASK_R_MGG_FIFO_PG_SIZE_8822B 0x7 -+#define BIT_R_MGG_FIFO_PG_SIZE_8822B(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_PG_SIZE_8822B) \ -+ << BIT_SHIFT_R_MGG_FIFO_PG_SIZE_8822B) -+#define BITS_R_MGG_FIFO_PG_SIZE_8822B \ -+ (BIT_MASK_R_MGG_FIFO_PG_SIZE_8822B \ -+ << BIT_SHIFT_R_MGG_FIFO_PG_SIZE_8822B) -+#define BIT_CLEAR_R_MGG_FIFO_PG_SIZE_8822B(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_PG_SIZE_8822B)) -+#define BIT_GET_R_MGG_FIFO_PG_SIZE_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_PG_SIZE_8822B) & \ -+ BIT_MASK_R_MGG_FIFO_PG_SIZE_8822B) -+#define BIT_SET_R_MGG_FIFO_PG_SIZE_8822B(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_PG_SIZE_8822B(x) | \ -+ BIT_R_MGG_FIFO_PG_SIZE_8822B(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_START_PG_8822B 16 -+#define BIT_MASK_R_MGG_FIFO_START_PG_8822B 0xfff -+#define BIT_R_MGG_FIFO_START_PG_8822B(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_START_PG_8822B) \ -+ << BIT_SHIFT_R_MGG_FIFO_START_PG_8822B) -+#define BITS_R_MGG_FIFO_START_PG_8822B \ -+ (BIT_MASK_R_MGG_FIFO_START_PG_8822B \ -+ << BIT_SHIFT_R_MGG_FIFO_START_PG_8822B) -+#define BIT_CLEAR_R_MGG_FIFO_START_PG_8822B(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_START_PG_8822B)) -+#define BIT_GET_R_MGG_FIFO_START_PG_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_START_PG_8822B) & \ -+ BIT_MASK_R_MGG_FIFO_START_PG_8822B) -+#define BIT_SET_R_MGG_FIFO_START_PG_8822B(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_START_PG_8822B(x) | \ -+ BIT_R_MGG_FIFO_START_PG_8822B(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_SIZE_8822B 14 -+#define BIT_MASK_R_MGG_FIFO_SIZE_8822B 0x3 -+#define BIT_R_MGG_FIFO_SIZE_8822B(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_SIZE_8822B) \ -+ << BIT_SHIFT_R_MGG_FIFO_SIZE_8822B) -+#define BITS_R_MGG_FIFO_SIZE_8822B \ -+ (BIT_MASK_R_MGG_FIFO_SIZE_8822B << BIT_SHIFT_R_MGG_FIFO_SIZE_8822B) -+#define BIT_CLEAR_R_MGG_FIFO_SIZE_8822B(x) ((x) & (~BITS_R_MGG_FIFO_SIZE_8822B)) -+#define BIT_GET_R_MGG_FIFO_SIZE_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_SIZE_8822B) & \ -+ BIT_MASK_R_MGG_FIFO_SIZE_8822B) -+#define BIT_SET_R_MGG_FIFO_SIZE_8822B(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_SIZE_8822B(x) | BIT_R_MGG_FIFO_SIZE_8822B(v)) -+ -+#define BIT_R_MGG_FIFO_PAUSE_8822B BIT(13) -+ -+#define BIT_SHIFT_R_MGG_FIFO_RPTR_8822B 8 -+#define BIT_MASK_R_MGG_FIFO_RPTR_8822B 0x1f -+#define BIT_R_MGG_FIFO_RPTR_8822B(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_RPTR_8822B) \ -+ << BIT_SHIFT_R_MGG_FIFO_RPTR_8822B) -+#define BITS_R_MGG_FIFO_RPTR_8822B \ -+ (BIT_MASK_R_MGG_FIFO_RPTR_8822B << BIT_SHIFT_R_MGG_FIFO_RPTR_8822B) -+#define BIT_CLEAR_R_MGG_FIFO_RPTR_8822B(x) ((x) & (~BITS_R_MGG_FIFO_RPTR_8822B)) -+#define BIT_GET_R_MGG_FIFO_RPTR_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_RPTR_8822B) & \ -+ BIT_MASK_R_MGG_FIFO_RPTR_8822B) -+#define BIT_SET_R_MGG_FIFO_RPTR_8822B(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_RPTR_8822B(x) | BIT_R_MGG_FIFO_RPTR_8822B(v)) -+ -+#define BIT_R_MGG_FIFO_OV_8822B BIT(7) -+#define BIT_R_MGG_FIFO_WPTR_ERROR_8822B BIT(6) -+#define BIT_R_EN_CPU_LIFETIME_8822B BIT(5) -+ -+#define BIT_SHIFT_R_MGG_FIFO_WPTR_8822B 0 -+#define BIT_MASK_R_MGG_FIFO_WPTR_8822B 0x1f -+#define BIT_R_MGG_FIFO_WPTR_8822B(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_WPTR_8822B) \ -+ << BIT_SHIFT_R_MGG_FIFO_WPTR_8822B) -+#define BITS_R_MGG_FIFO_WPTR_8822B \ -+ (BIT_MASK_R_MGG_FIFO_WPTR_8822B << BIT_SHIFT_R_MGG_FIFO_WPTR_8822B) -+#define BIT_CLEAR_R_MGG_FIFO_WPTR_8822B(x) ((x) & (~BITS_R_MGG_FIFO_WPTR_8822B)) -+#define BIT_GET_R_MGG_FIFO_WPTR_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_WPTR_8822B) & \ -+ BIT_MASK_R_MGG_FIFO_WPTR_8822B) -+#define BIT_SET_R_MGG_FIFO_WPTR_8822B(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_WPTR_8822B(x) | BIT_R_MGG_FIFO_WPTR_8822B(v)) -+ -+/* 2 REG_MGG_FIFO_INT_8822B */ -+ -+#define BIT_SHIFT_R_MGG_FIFO_INT_FLAG_8822B 16 -+#define BIT_MASK_R_MGG_FIFO_INT_FLAG_8822B 0xffff -+#define BIT_R_MGG_FIFO_INT_FLAG_8822B(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_INT_FLAG_8822B) \ -+ << BIT_SHIFT_R_MGG_FIFO_INT_FLAG_8822B) -+#define BITS_R_MGG_FIFO_INT_FLAG_8822B \ -+ (BIT_MASK_R_MGG_FIFO_INT_FLAG_8822B \ -+ << BIT_SHIFT_R_MGG_FIFO_INT_FLAG_8822B) -+#define BIT_CLEAR_R_MGG_FIFO_INT_FLAG_8822B(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_INT_FLAG_8822B)) -+#define BIT_GET_R_MGG_FIFO_INT_FLAG_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_INT_FLAG_8822B) & \ -+ BIT_MASK_R_MGG_FIFO_INT_FLAG_8822B) -+#define BIT_SET_R_MGG_FIFO_INT_FLAG_8822B(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_INT_FLAG_8822B(x) | \ -+ BIT_R_MGG_FIFO_INT_FLAG_8822B(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_INT_MASK_8822B 0 -+#define BIT_MASK_R_MGG_FIFO_INT_MASK_8822B 0xffff -+#define BIT_R_MGG_FIFO_INT_MASK_8822B(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_INT_MASK_8822B) \ -+ << BIT_SHIFT_R_MGG_FIFO_INT_MASK_8822B) -+#define BITS_R_MGG_FIFO_INT_MASK_8822B \ -+ (BIT_MASK_R_MGG_FIFO_INT_MASK_8822B \ -+ << BIT_SHIFT_R_MGG_FIFO_INT_MASK_8822B) -+#define BIT_CLEAR_R_MGG_FIFO_INT_MASK_8822B(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_INT_MASK_8822B)) -+#define BIT_GET_R_MGG_FIFO_INT_MASK_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_INT_MASK_8822B) & \ -+ BIT_MASK_R_MGG_FIFO_INT_MASK_8822B) -+#define BIT_SET_R_MGG_FIFO_INT_MASK_8822B(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_INT_MASK_8822B(x) | \ -+ BIT_R_MGG_FIFO_INT_MASK_8822B(v)) -+ -+/* 2 REG_MGG_FIFO_LIFETIME_8822B */ -+ -+#define BIT_SHIFT_R_MGG_FIFO_LIFETIME_8822B 16 -+#define BIT_MASK_R_MGG_FIFO_LIFETIME_8822B 0xffff -+#define BIT_R_MGG_FIFO_LIFETIME_8822B(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_LIFETIME_8822B) \ -+ << BIT_SHIFT_R_MGG_FIFO_LIFETIME_8822B) -+#define BITS_R_MGG_FIFO_LIFETIME_8822B \ -+ (BIT_MASK_R_MGG_FIFO_LIFETIME_8822B \ -+ << BIT_SHIFT_R_MGG_FIFO_LIFETIME_8822B) -+#define BIT_CLEAR_R_MGG_FIFO_LIFETIME_8822B(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_LIFETIME_8822B)) -+#define BIT_GET_R_MGG_FIFO_LIFETIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_LIFETIME_8822B) & \ -+ BIT_MASK_R_MGG_FIFO_LIFETIME_8822B) -+#define BIT_SET_R_MGG_FIFO_LIFETIME_8822B(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_LIFETIME_8822B(x) | \ -+ BIT_R_MGG_FIFO_LIFETIME_8822B(v)) -+ -+#define BIT_SHIFT_R_MGG_FIFO_VALID_MAP_8822B 0 -+#define BIT_MASK_R_MGG_FIFO_VALID_MAP_8822B 0xffff -+#define BIT_R_MGG_FIFO_VALID_MAP_8822B(x) \ -+ (((x) & BIT_MASK_R_MGG_FIFO_VALID_MAP_8822B) \ -+ << BIT_SHIFT_R_MGG_FIFO_VALID_MAP_8822B) -+#define BITS_R_MGG_FIFO_VALID_MAP_8822B \ -+ (BIT_MASK_R_MGG_FIFO_VALID_MAP_8822B \ -+ << BIT_SHIFT_R_MGG_FIFO_VALID_MAP_8822B) -+#define BIT_CLEAR_R_MGG_FIFO_VALID_MAP_8822B(x) \ -+ ((x) & (~BITS_R_MGG_FIFO_VALID_MAP_8822B)) -+#define BIT_GET_R_MGG_FIFO_VALID_MAP_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MGG_FIFO_VALID_MAP_8822B) & \ -+ BIT_MASK_R_MGG_FIFO_VALID_MAP_8822B) -+#define BIT_SET_R_MGG_FIFO_VALID_MAP_8822B(x, v) \ -+ (BIT_CLEAR_R_MGG_FIFO_VALID_MAP_8822B(x) | \ -+ BIT_R_MGG_FIFO_VALID_MAP_8822B(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B 0x7f -+#define BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B) -+#define BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B(v)) -+ -+/* 2 REG_SHCUT_SETTING_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE0_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE1_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_SHCUT_LLC_OUI0_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_SHCUT_LLC_OUI1_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_SHCUT_LLC_OUI2_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_SHCUT_LLC_OUI3_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_MU_TX_CTL_8822B */ -+#define BIT_R_EN_REVERS_GTAB_8822B BIT(6) -+ -+#define BIT_SHIFT_R_MU_TABLE_VALID_8822B 0 -+#define BIT_MASK_R_MU_TABLE_VALID_8822B 0x3f -+#define BIT_R_MU_TABLE_VALID_8822B(x) \ -+ (((x) & BIT_MASK_R_MU_TABLE_VALID_8822B) \ -+ << BIT_SHIFT_R_MU_TABLE_VALID_8822B) -+#define BITS_R_MU_TABLE_VALID_8822B \ -+ (BIT_MASK_R_MU_TABLE_VALID_8822B << BIT_SHIFT_R_MU_TABLE_VALID_8822B) -+#define BIT_CLEAR_R_MU_TABLE_VALID_8822B(x) \ -+ ((x) & (~BITS_R_MU_TABLE_VALID_8822B)) -+#define BIT_GET_R_MU_TABLE_VALID_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MU_TABLE_VALID_8822B) & \ -+ BIT_MASK_R_MU_TABLE_VALID_8822B) -+#define BIT_SET_R_MU_TABLE_VALID_8822B(x, v) \ -+ (BIT_CLEAR_R_MU_TABLE_VALID_8822B(x) | BIT_R_MU_TABLE_VALID_8822B(v)) -+ -+/* 2 REG_MU_STA_GID_VLD_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B 0 -+#define BIT_MASK_R_MU_STA_GTAB_VALID_8822B 0xffffffffL -+#define BIT_R_MU_STA_GTAB_VALID_8822B(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_VALID_8822B) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) -+#define BITS_R_MU_STA_GTAB_VALID_8822B \ -+ (BIT_MASK_R_MU_STA_GTAB_VALID_8822B \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) -+#define BIT_CLEAR_R_MU_STA_GTAB_VALID_8822B(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_VALID_8822B)) -+#define BIT_GET_R_MU_STA_GTAB_VALID_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) & \ -+ BIT_MASK_R_MU_STA_GTAB_VALID_8822B) -+#define BIT_SET_R_MU_STA_GTAB_VALID_8822B(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_VALID_8822B(x) | \ -+ BIT_R_MU_STA_GTAB_VALID_8822B(v)) -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B 0 -+#define BIT_MASK_R_MU_STA_GTAB_VALID_8822B 0xffffffffL -+#define BIT_R_MU_STA_GTAB_VALID_8822B(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_VALID_8822B) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) -+#define BITS_R_MU_STA_GTAB_VALID_8822B \ -+ (BIT_MASK_R_MU_STA_GTAB_VALID_8822B \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) -+#define BIT_CLEAR_R_MU_STA_GTAB_VALID_8822B(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_VALID_8822B)) -+#define BIT_GET_R_MU_STA_GTAB_VALID_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) & \ -+ BIT_MASK_R_MU_STA_GTAB_VALID_8822B) -+#define BIT_SET_R_MU_STA_GTAB_VALID_8822B(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_VALID_8822B(x) | \ -+ BIT_R_MU_STA_GTAB_VALID_8822B(v)) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_8822B 0xffffffffffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_8822B) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) -+#define BITS_R_MU_STA_GTAB_POSITION_8822B \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_8822B \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_8822B)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_8822B) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_8822B(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_8822B(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_8822B(v)) -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_8822B 0xffffffffffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_8822B) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) -+#define BITS_R_MU_STA_GTAB_POSITION_8822B \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_8822B \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_8822B)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_8822B) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_8822B(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_8822B(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_8822B(v)) -+ -+/* 2 REG_MU_TRX_DBG_CNT_8822B */ -+#define BIT_MU_DNGCNT_RST_8822B BIT(20) -+ -+#define BIT_SHIFT_MU_DBGCNT_SEL_8822B 16 -+#define BIT_MASK_MU_DBGCNT_SEL_8822B 0xf -+#define BIT_MU_DBGCNT_SEL_8822B(x) \ -+ (((x) & BIT_MASK_MU_DBGCNT_SEL_8822B) << BIT_SHIFT_MU_DBGCNT_SEL_8822B) -+#define BITS_MU_DBGCNT_SEL_8822B \ -+ (BIT_MASK_MU_DBGCNT_SEL_8822B << BIT_SHIFT_MU_DBGCNT_SEL_8822B) -+#define BIT_CLEAR_MU_DBGCNT_SEL_8822B(x) ((x) & (~BITS_MU_DBGCNT_SEL_8822B)) -+#define BIT_GET_MU_DBGCNT_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_MU_DBGCNT_SEL_8822B) & BIT_MASK_MU_DBGCNT_SEL_8822B) -+#define BIT_SET_MU_DBGCNT_SEL_8822B(x, v) \ -+ (BIT_CLEAR_MU_DBGCNT_SEL_8822B(x) | BIT_MU_DBGCNT_SEL_8822B(v)) -+ -+#define BIT_SHIFT_MU_DNGCNT_8822B 0 -+#define BIT_MASK_MU_DNGCNT_8822B 0xffff -+#define BIT_MU_DNGCNT_8822B(x) \ -+ (((x) & BIT_MASK_MU_DNGCNT_8822B) << BIT_SHIFT_MU_DNGCNT_8822B) -+#define BITS_MU_DNGCNT_8822B \ -+ (BIT_MASK_MU_DNGCNT_8822B << BIT_SHIFT_MU_DNGCNT_8822B) -+#define BIT_CLEAR_MU_DNGCNT_8822B(x) ((x) & (~BITS_MU_DNGCNT_8822B)) -+#define BIT_GET_MU_DNGCNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_MU_DNGCNT_8822B) & BIT_MASK_MU_DNGCNT_8822B) -+#define BIT_SET_MU_DNGCNT_8822B(x, v) \ -+ (BIT_CLEAR_MU_DNGCNT_8822B(x) | BIT_MU_DNGCNT_8822B(v)) -+ -+/* 2 REG_MU_TX_CTL_8822B */ -+#define BIT_R_EN_REVERS_GTAB_8822B BIT(6) -+ -+#define BIT_SHIFT_R_MU_TABLE_VALID_8822B 0 -+#define BIT_MASK_R_MU_TABLE_VALID_8822B 0x3f -+#define BIT_R_MU_TABLE_VALID_8822B(x) \ -+ (((x) & BIT_MASK_R_MU_TABLE_VALID_8822B) \ -+ << BIT_SHIFT_R_MU_TABLE_VALID_8822B) -+#define BITS_R_MU_TABLE_VALID_8822B \ -+ (BIT_MASK_R_MU_TABLE_VALID_8822B << BIT_SHIFT_R_MU_TABLE_VALID_8822B) -+#define BIT_CLEAR_R_MU_TABLE_VALID_8822B(x) \ -+ ((x) & (~BITS_R_MU_TABLE_VALID_8822B)) -+#define BIT_GET_R_MU_TABLE_VALID_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MU_TABLE_VALID_8822B) & \ -+ BIT_MASK_R_MU_TABLE_VALID_8822B) -+#define BIT_SET_R_MU_TABLE_VALID_8822B(x, v) \ -+ (BIT_CLEAR_R_MU_TABLE_VALID_8822B(x) | BIT_R_MU_TABLE_VALID_8822B(v)) -+ -+/* 2 REG_MU_STA_GID_VLD_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B 0 -+#define BIT_MASK_R_MU_STA_GTAB_VALID_8822B 0xffffffffL -+#define BIT_R_MU_STA_GTAB_VALID_8822B(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_VALID_8822B) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) -+#define BITS_R_MU_STA_GTAB_VALID_8822B \ -+ (BIT_MASK_R_MU_STA_GTAB_VALID_8822B \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) -+#define BIT_CLEAR_R_MU_STA_GTAB_VALID_8822B(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_VALID_8822B)) -+#define BIT_GET_R_MU_STA_GTAB_VALID_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) & \ -+ BIT_MASK_R_MU_STA_GTAB_VALID_8822B) -+#define BIT_SET_R_MU_STA_GTAB_VALID_8822B(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_VALID_8822B(x) | \ -+ BIT_R_MU_STA_GTAB_VALID_8822B(v)) -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B 0 -+#define BIT_MASK_R_MU_STA_GTAB_VALID_8822B 0xffffffffL -+#define BIT_R_MU_STA_GTAB_VALID_8822B(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_VALID_8822B) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) -+#define BITS_R_MU_STA_GTAB_VALID_8822B \ -+ (BIT_MASK_R_MU_STA_GTAB_VALID_8822B \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) -+#define BIT_CLEAR_R_MU_STA_GTAB_VALID_8822B(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_VALID_8822B)) -+#define BIT_GET_R_MU_STA_GTAB_VALID_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_VALID_8822B) & \ -+ BIT_MASK_R_MU_STA_GTAB_VALID_8822B) -+#define BIT_SET_R_MU_STA_GTAB_VALID_8822B(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_VALID_8822B(x) | \ -+ BIT_R_MU_STA_GTAB_VALID_8822B(v)) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_8822B 0xffffffffffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_8822B) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) -+#define BITS_R_MU_STA_GTAB_POSITION_8822B \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_8822B \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_8822B)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_8822B) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_8822B(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_8822B(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_8822B(v)) -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_8822B 0xffffffffffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_8822B) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) -+#define BITS_R_MU_STA_GTAB_POSITION_8822B \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_8822B \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_8822B)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_8822B) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_8822B) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_8822B(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_8822B(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_8822B(v)) -+ -+/* 2 REG_MU_TRX_DBG_CNT_8822B */ -+#define BIT_MU_DNGCNT_RST_8822B BIT(20) -+ -+#define BIT_SHIFT_MU_DBGCNT_SEL_8822B 16 -+#define BIT_MASK_MU_DBGCNT_SEL_8822B 0xf -+#define BIT_MU_DBGCNT_SEL_8822B(x) \ -+ (((x) & BIT_MASK_MU_DBGCNT_SEL_8822B) << BIT_SHIFT_MU_DBGCNT_SEL_8822B) -+#define BITS_MU_DBGCNT_SEL_8822B \ -+ (BIT_MASK_MU_DBGCNT_SEL_8822B << BIT_SHIFT_MU_DBGCNT_SEL_8822B) -+#define BIT_CLEAR_MU_DBGCNT_SEL_8822B(x) ((x) & (~BITS_MU_DBGCNT_SEL_8822B)) -+#define BIT_GET_MU_DBGCNT_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_MU_DBGCNT_SEL_8822B) & BIT_MASK_MU_DBGCNT_SEL_8822B) -+#define BIT_SET_MU_DBGCNT_SEL_8822B(x, v) \ -+ (BIT_CLEAR_MU_DBGCNT_SEL_8822B(x) | BIT_MU_DBGCNT_SEL_8822B(v)) -+ -+#define BIT_SHIFT_MU_DNGCNT_8822B 0 -+#define BIT_MASK_MU_DNGCNT_8822B 0xffff -+#define BIT_MU_DNGCNT_8822B(x) \ -+ (((x) & BIT_MASK_MU_DNGCNT_8822B) << BIT_SHIFT_MU_DNGCNT_8822B) -+#define BITS_MU_DNGCNT_8822B \ -+ (BIT_MASK_MU_DNGCNT_8822B << BIT_SHIFT_MU_DNGCNT_8822B) -+#define BIT_CLEAR_MU_DNGCNT_8822B(x) ((x) & (~BITS_MU_DNGCNT_8822B)) -+#define BIT_GET_MU_DNGCNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_MU_DNGCNT_8822B) & BIT_MASK_MU_DNGCNT_8822B) -+#define BIT_SET_MU_DNGCNT_8822B(x, v) \ -+ (BIT_CLEAR_MU_DNGCNT_8822B(x) | BIT_MU_DNGCNT_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_EDCA_VO_PARAM_8822B */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8822B 16 -+#define BIT_MASK_TXOPLIMIT_8822B 0x7ff -+#define BIT_TXOPLIMIT_8822B(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8822B) << BIT_SHIFT_TXOPLIMIT_8822B) -+#define BITS_TXOPLIMIT_8822B \ -+ (BIT_MASK_TXOPLIMIT_8822B << BIT_SHIFT_TXOPLIMIT_8822B) -+#define BIT_CLEAR_TXOPLIMIT_8822B(x) ((x) & (~BITS_TXOPLIMIT_8822B)) -+#define BIT_GET_TXOPLIMIT_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8822B) & BIT_MASK_TXOPLIMIT_8822B) -+#define BIT_SET_TXOPLIMIT_8822B(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8822B(x) | BIT_TXOPLIMIT_8822B(v)) -+ -+#define BIT_SHIFT_CW_8822B 8 -+#define BIT_MASK_CW_8822B 0xff -+#define BIT_CW_8822B(x) (((x) & BIT_MASK_CW_8822B) << BIT_SHIFT_CW_8822B) -+#define BITS_CW_8822B (BIT_MASK_CW_8822B << BIT_SHIFT_CW_8822B) -+#define BIT_CLEAR_CW_8822B(x) ((x) & (~BITS_CW_8822B)) -+#define BIT_GET_CW_8822B(x) (((x) >> BIT_SHIFT_CW_8822B) & BIT_MASK_CW_8822B) -+#define BIT_SET_CW_8822B(x, v) (BIT_CLEAR_CW_8822B(x) | BIT_CW_8822B(v)) -+ -+#define BIT_SHIFT_AIFS_8822B 0 -+#define BIT_MASK_AIFS_8822B 0xff -+#define BIT_AIFS_8822B(x) (((x) & BIT_MASK_AIFS_8822B) << BIT_SHIFT_AIFS_8822B) -+#define BITS_AIFS_8822B (BIT_MASK_AIFS_8822B << BIT_SHIFT_AIFS_8822B) -+#define BIT_CLEAR_AIFS_8822B(x) ((x) & (~BITS_AIFS_8822B)) -+#define BIT_GET_AIFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8822B) & BIT_MASK_AIFS_8822B) -+#define BIT_SET_AIFS_8822B(x, v) (BIT_CLEAR_AIFS_8822B(x) | BIT_AIFS_8822B(v)) -+ -+/* 2 REG_EDCA_VI_PARAM_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8822B 16 -+#define BIT_MASK_TXOPLIMIT_8822B 0x7ff -+#define BIT_TXOPLIMIT_8822B(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8822B) << BIT_SHIFT_TXOPLIMIT_8822B) -+#define BITS_TXOPLIMIT_8822B \ -+ (BIT_MASK_TXOPLIMIT_8822B << BIT_SHIFT_TXOPLIMIT_8822B) -+#define BIT_CLEAR_TXOPLIMIT_8822B(x) ((x) & (~BITS_TXOPLIMIT_8822B)) -+#define BIT_GET_TXOPLIMIT_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8822B) & BIT_MASK_TXOPLIMIT_8822B) -+#define BIT_SET_TXOPLIMIT_8822B(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8822B(x) | BIT_TXOPLIMIT_8822B(v)) -+ -+#define BIT_SHIFT_CW_8822B 8 -+#define BIT_MASK_CW_8822B 0xff -+#define BIT_CW_8822B(x) (((x) & BIT_MASK_CW_8822B) << BIT_SHIFT_CW_8822B) -+#define BITS_CW_8822B (BIT_MASK_CW_8822B << BIT_SHIFT_CW_8822B) -+#define BIT_CLEAR_CW_8822B(x) ((x) & (~BITS_CW_8822B)) -+#define BIT_GET_CW_8822B(x) (((x) >> BIT_SHIFT_CW_8822B) & BIT_MASK_CW_8822B) -+#define BIT_SET_CW_8822B(x, v) (BIT_CLEAR_CW_8822B(x) | BIT_CW_8822B(v)) -+ -+#define BIT_SHIFT_AIFS_8822B 0 -+#define BIT_MASK_AIFS_8822B 0xff -+#define BIT_AIFS_8822B(x) (((x) & BIT_MASK_AIFS_8822B) << BIT_SHIFT_AIFS_8822B) -+#define BITS_AIFS_8822B (BIT_MASK_AIFS_8822B << BIT_SHIFT_AIFS_8822B) -+#define BIT_CLEAR_AIFS_8822B(x) ((x) & (~BITS_AIFS_8822B)) -+#define BIT_GET_AIFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8822B) & BIT_MASK_AIFS_8822B) -+#define BIT_SET_AIFS_8822B(x, v) (BIT_CLEAR_AIFS_8822B(x) | BIT_AIFS_8822B(v)) -+ -+/* 2 REG_EDCA_BE_PARAM_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8822B 16 -+#define BIT_MASK_TXOPLIMIT_8822B 0x7ff -+#define BIT_TXOPLIMIT_8822B(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8822B) << BIT_SHIFT_TXOPLIMIT_8822B) -+#define BITS_TXOPLIMIT_8822B \ -+ (BIT_MASK_TXOPLIMIT_8822B << BIT_SHIFT_TXOPLIMIT_8822B) -+#define BIT_CLEAR_TXOPLIMIT_8822B(x) ((x) & (~BITS_TXOPLIMIT_8822B)) -+#define BIT_GET_TXOPLIMIT_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8822B) & BIT_MASK_TXOPLIMIT_8822B) -+#define BIT_SET_TXOPLIMIT_8822B(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8822B(x) | BIT_TXOPLIMIT_8822B(v)) -+ -+#define BIT_SHIFT_CW_8822B 8 -+#define BIT_MASK_CW_8822B 0xff -+#define BIT_CW_8822B(x) (((x) & BIT_MASK_CW_8822B) << BIT_SHIFT_CW_8822B) -+#define BITS_CW_8822B (BIT_MASK_CW_8822B << BIT_SHIFT_CW_8822B) -+#define BIT_CLEAR_CW_8822B(x) ((x) & (~BITS_CW_8822B)) -+#define BIT_GET_CW_8822B(x) (((x) >> BIT_SHIFT_CW_8822B) & BIT_MASK_CW_8822B) -+#define BIT_SET_CW_8822B(x, v) (BIT_CLEAR_CW_8822B(x) | BIT_CW_8822B(v)) -+ -+#define BIT_SHIFT_AIFS_8822B 0 -+#define BIT_MASK_AIFS_8822B 0xff -+#define BIT_AIFS_8822B(x) (((x) & BIT_MASK_AIFS_8822B) << BIT_SHIFT_AIFS_8822B) -+#define BITS_AIFS_8822B (BIT_MASK_AIFS_8822B << BIT_SHIFT_AIFS_8822B) -+#define BIT_CLEAR_AIFS_8822B(x) ((x) & (~BITS_AIFS_8822B)) -+#define BIT_GET_AIFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8822B) & BIT_MASK_AIFS_8822B) -+#define BIT_SET_AIFS_8822B(x, v) (BIT_CLEAR_AIFS_8822B(x) | BIT_AIFS_8822B(v)) -+ -+/* 2 REG_EDCA_BK_PARAM_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8822B 16 -+#define BIT_MASK_TXOPLIMIT_8822B 0x7ff -+#define BIT_TXOPLIMIT_8822B(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8822B) << BIT_SHIFT_TXOPLIMIT_8822B) -+#define BITS_TXOPLIMIT_8822B \ -+ (BIT_MASK_TXOPLIMIT_8822B << BIT_SHIFT_TXOPLIMIT_8822B) -+#define BIT_CLEAR_TXOPLIMIT_8822B(x) ((x) & (~BITS_TXOPLIMIT_8822B)) -+#define BIT_GET_TXOPLIMIT_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8822B) & BIT_MASK_TXOPLIMIT_8822B) -+#define BIT_SET_TXOPLIMIT_8822B(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8822B(x) | BIT_TXOPLIMIT_8822B(v)) -+ -+#define BIT_SHIFT_CW_8822B 8 -+#define BIT_MASK_CW_8822B 0xff -+#define BIT_CW_8822B(x) (((x) & BIT_MASK_CW_8822B) << BIT_SHIFT_CW_8822B) -+#define BITS_CW_8822B (BIT_MASK_CW_8822B << BIT_SHIFT_CW_8822B) -+#define BIT_CLEAR_CW_8822B(x) ((x) & (~BITS_CW_8822B)) -+#define BIT_GET_CW_8822B(x) (((x) >> BIT_SHIFT_CW_8822B) & BIT_MASK_CW_8822B) -+#define BIT_SET_CW_8822B(x, v) (BIT_CLEAR_CW_8822B(x) | BIT_CW_8822B(v)) -+ -+#define BIT_SHIFT_AIFS_8822B 0 -+#define BIT_MASK_AIFS_8822B 0xff -+#define BIT_AIFS_8822B(x) (((x) & BIT_MASK_AIFS_8822B) << BIT_SHIFT_AIFS_8822B) -+#define BITS_AIFS_8822B (BIT_MASK_AIFS_8822B << BIT_SHIFT_AIFS_8822B) -+#define BIT_CLEAR_AIFS_8822B(x) ((x) & (~BITS_AIFS_8822B)) -+#define BIT_GET_AIFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8822B) & BIT_MASK_AIFS_8822B) -+#define BIT_SET_AIFS_8822B(x, v) (BIT_CLEAR_AIFS_8822B(x) | BIT_AIFS_8822B(v)) -+ -+/* 2 REG_BCNTCFG_8822B */ -+ -+#define BIT_SHIFT_BCNCW_MAX_8822B 12 -+#define BIT_MASK_BCNCW_MAX_8822B 0xf -+#define BIT_BCNCW_MAX_8822B(x) \ -+ (((x) & BIT_MASK_BCNCW_MAX_8822B) << BIT_SHIFT_BCNCW_MAX_8822B) -+#define BITS_BCNCW_MAX_8822B \ -+ (BIT_MASK_BCNCW_MAX_8822B << BIT_SHIFT_BCNCW_MAX_8822B) -+#define BIT_CLEAR_BCNCW_MAX_8822B(x) ((x) & (~BITS_BCNCW_MAX_8822B)) -+#define BIT_GET_BCNCW_MAX_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MAX_8822B) & BIT_MASK_BCNCW_MAX_8822B) -+#define BIT_SET_BCNCW_MAX_8822B(x, v) \ -+ (BIT_CLEAR_BCNCW_MAX_8822B(x) | BIT_BCNCW_MAX_8822B(v)) -+ -+#define BIT_SHIFT_BCNCW_MIN_8822B 8 -+#define BIT_MASK_BCNCW_MIN_8822B 0xf -+#define BIT_BCNCW_MIN_8822B(x) \ -+ (((x) & BIT_MASK_BCNCW_MIN_8822B) << BIT_SHIFT_BCNCW_MIN_8822B) -+#define BITS_BCNCW_MIN_8822B \ -+ (BIT_MASK_BCNCW_MIN_8822B << BIT_SHIFT_BCNCW_MIN_8822B) -+#define BIT_CLEAR_BCNCW_MIN_8822B(x) ((x) & (~BITS_BCNCW_MIN_8822B)) -+#define BIT_GET_BCNCW_MIN_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MIN_8822B) & BIT_MASK_BCNCW_MIN_8822B) -+#define BIT_SET_BCNCW_MIN_8822B(x, v) \ -+ (BIT_CLEAR_BCNCW_MIN_8822B(x) | BIT_BCNCW_MIN_8822B(v)) -+ -+#define BIT_SHIFT_BCNIFS_8822B 0 -+#define BIT_MASK_BCNIFS_8822B 0xff -+#define BIT_BCNIFS_8822B(x) \ -+ (((x) & BIT_MASK_BCNIFS_8822B) << BIT_SHIFT_BCNIFS_8822B) -+#define BITS_BCNIFS_8822B (BIT_MASK_BCNIFS_8822B << BIT_SHIFT_BCNIFS_8822B) -+#define BIT_CLEAR_BCNIFS_8822B(x) ((x) & (~BITS_BCNIFS_8822B)) -+#define BIT_GET_BCNIFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNIFS_8822B) & BIT_MASK_BCNIFS_8822B) -+#define BIT_SET_BCNIFS_8822B(x, v) \ -+ (BIT_CLEAR_BCNIFS_8822B(x) | BIT_BCNIFS_8822B(v)) -+ -+/* 2 REG_PIFS_8822B */ -+ -+#define BIT_SHIFT_PIFS_8822B 0 -+#define BIT_MASK_PIFS_8822B 0xff -+#define BIT_PIFS_8822B(x) (((x) & BIT_MASK_PIFS_8822B) << BIT_SHIFT_PIFS_8822B) -+#define BITS_PIFS_8822B (BIT_MASK_PIFS_8822B << BIT_SHIFT_PIFS_8822B) -+#define BIT_CLEAR_PIFS_8822B(x) ((x) & (~BITS_PIFS_8822B)) -+#define BIT_GET_PIFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_PIFS_8822B) & BIT_MASK_PIFS_8822B) -+#define BIT_SET_PIFS_8822B(x, v) (BIT_CLEAR_PIFS_8822B(x) | BIT_PIFS_8822B(v)) -+ -+/* 2 REG_RDG_PIFS_8822B */ -+ -+#define BIT_SHIFT_RDG_PIFS_8822B 0 -+#define BIT_MASK_RDG_PIFS_8822B 0xff -+#define BIT_RDG_PIFS_8822B(x) \ -+ (((x) & BIT_MASK_RDG_PIFS_8822B) << BIT_SHIFT_RDG_PIFS_8822B) -+#define BITS_RDG_PIFS_8822B \ -+ (BIT_MASK_RDG_PIFS_8822B << BIT_SHIFT_RDG_PIFS_8822B) -+#define BIT_CLEAR_RDG_PIFS_8822B(x) ((x) & (~BITS_RDG_PIFS_8822B)) -+#define BIT_GET_RDG_PIFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_RDG_PIFS_8822B) & BIT_MASK_RDG_PIFS_8822B) -+#define BIT_SET_RDG_PIFS_8822B(x, v) \ -+ (BIT_CLEAR_RDG_PIFS_8822B(x) | BIT_RDG_PIFS_8822B(v)) -+ -+/* 2 REG_SIFS_8822B */ -+ -+#define BIT_SHIFT_SIFS_OFDM_TRX_8822B 24 -+#define BIT_MASK_SIFS_OFDM_TRX_8822B 0xff -+#define BIT_SIFS_OFDM_TRX_8822B(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_TRX_8822B) << BIT_SHIFT_SIFS_OFDM_TRX_8822B) -+#define BITS_SIFS_OFDM_TRX_8822B \ -+ (BIT_MASK_SIFS_OFDM_TRX_8822B << BIT_SHIFT_SIFS_OFDM_TRX_8822B) -+#define BIT_CLEAR_SIFS_OFDM_TRX_8822B(x) ((x) & (~BITS_SIFS_OFDM_TRX_8822B)) -+#define BIT_GET_SIFS_OFDM_TRX_8822B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_TRX_8822B) & BIT_MASK_SIFS_OFDM_TRX_8822B) -+#define BIT_SET_SIFS_OFDM_TRX_8822B(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_TRX_8822B(x) | BIT_SIFS_OFDM_TRX_8822B(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_TRX_8822B 16 -+#define BIT_MASK_SIFS_CCK_TRX_8822B 0xff -+#define BIT_SIFS_CCK_TRX_8822B(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_TRX_8822B) << BIT_SHIFT_SIFS_CCK_TRX_8822B) -+#define BITS_SIFS_CCK_TRX_8822B \ -+ (BIT_MASK_SIFS_CCK_TRX_8822B << BIT_SHIFT_SIFS_CCK_TRX_8822B) -+#define BIT_CLEAR_SIFS_CCK_TRX_8822B(x) ((x) & (~BITS_SIFS_CCK_TRX_8822B)) -+#define BIT_GET_SIFS_CCK_TRX_8822B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_TRX_8822B) & BIT_MASK_SIFS_CCK_TRX_8822B) -+#define BIT_SET_SIFS_CCK_TRX_8822B(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_TRX_8822B(x) | BIT_SIFS_CCK_TRX_8822B(v)) -+ -+#define BIT_SHIFT_SIFS_OFDM_CTX_8822B 8 -+#define BIT_MASK_SIFS_OFDM_CTX_8822B 0xff -+#define BIT_SIFS_OFDM_CTX_8822B(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_CTX_8822B) << BIT_SHIFT_SIFS_OFDM_CTX_8822B) -+#define BITS_SIFS_OFDM_CTX_8822B \ -+ (BIT_MASK_SIFS_OFDM_CTX_8822B << BIT_SHIFT_SIFS_OFDM_CTX_8822B) -+#define BIT_CLEAR_SIFS_OFDM_CTX_8822B(x) ((x) & (~BITS_SIFS_OFDM_CTX_8822B)) -+#define BIT_GET_SIFS_OFDM_CTX_8822B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_CTX_8822B) & BIT_MASK_SIFS_OFDM_CTX_8822B) -+#define BIT_SET_SIFS_OFDM_CTX_8822B(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_CTX_8822B(x) | BIT_SIFS_OFDM_CTX_8822B(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_CTX_8822B 0 -+#define BIT_MASK_SIFS_CCK_CTX_8822B 0xff -+#define BIT_SIFS_CCK_CTX_8822B(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_CTX_8822B) << BIT_SHIFT_SIFS_CCK_CTX_8822B) -+#define BITS_SIFS_CCK_CTX_8822B \ -+ (BIT_MASK_SIFS_CCK_CTX_8822B << BIT_SHIFT_SIFS_CCK_CTX_8822B) -+#define BIT_CLEAR_SIFS_CCK_CTX_8822B(x) ((x) & (~BITS_SIFS_CCK_CTX_8822B)) -+#define BIT_GET_SIFS_CCK_CTX_8822B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_CTX_8822B) & BIT_MASK_SIFS_CCK_CTX_8822B) -+#define BIT_SET_SIFS_CCK_CTX_8822B(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_CTX_8822B(x) | BIT_SIFS_CCK_CTX_8822B(v)) -+ -+/* 2 REG_TSFTR_SYN_OFFSET_8822B */ -+ -+#define BIT_SHIFT_TSFTR_SNC_OFFSET_8822B 0 -+#define BIT_MASK_TSFTR_SNC_OFFSET_8822B 0xffff -+#define BIT_TSFTR_SNC_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_TSFTR_SNC_OFFSET_8822B) \ -+ << BIT_SHIFT_TSFTR_SNC_OFFSET_8822B) -+#define BITS_TSFTR_SNC_OFFSET_8822B \ -+ (BIT_MASK_TSFTR_SNC_OFFSET_8822B << BIT_SHIFT_TSFTR_SNC_OFFSET_8822B) -+#define BIT_CLEAR_TSFTR_SNC_OFFSET_8822B(x) \ -+ ((x) & (~BITS_TSFTR_SNC_OFFSET_8822B)) -+#define BIT_GET_TSFTR_SNC_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_TSFTR_SNC_OFFSET_8822B) & \ -+ BIT_MASK_TSFTR_SNC_OFFSET_8822B) -+#define BIT_SET_TSFTR_SNC_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_TSFTR_SNC_OFFSET_8822B(x) | BIT_TSFTR_SNC_OFFSET_8822B(v)) -+ -+/* 2 REG_AGGR_BREAK_TIME_8822B */ -+ -+#define BIT_SHIFT_AGGR_BK_TIME_8822B 0 -+#define BIT_MASK_AGGR_BK_TIME_8822B 0xff -+#define BIT_AGGR_BK_TIME_8822B(x) \ -+ (((x) & BIT_MASK_AGGR_BK_TIME_8822B) << BIT_SHIFT_AGGR_BK_TIME_8822B) -+#define BITS_AGGR_BK_TIME_8822B \ -+ (BIT_MASK_AGGR_BK_TIME_8822B << BIT_SHIFT_AGGR_BK_TIME_8822B) -+#define BIT_CLEAR_AGGR_BK_TIME_8822B(x) ((x) & (~BITS_AGGR_BK_TIME_8822B)) -+#define BIT_GET_AGGR_BK_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_AGGR_BK_TIME_8822B) & BIT_MASK_AGGR_BK_TIME_8822B) -+#define BIT_SET_AGGR_BK_TIME_8822B(x, v) \ -+ (BIT_CLEAR_AGGR_BK_TIME_8822B(x) | BIT_AGGR_BK_TIME_8822B(v)) -+ -+/* 2 REG_SLOT_8822B */ -+ -+#define BIT_SHIFT_SLOT_8822B 0 -+#define BIT_MASK_SLOT_8822B 0xff -+#define BIT_SLOT_8822B(x) (((x) & BIT_MASK_SLOT_8822B) << BIT_SHIFT_SLOT_8822B) -+#define BITS_SLOT_8822B (BIT_MASK_SLOT_8822B << BIT_SHIFT_SLOT_8822B) -+#define BIT_CLEAR_SLOT_8822B(x) ((x) & (~BITS_SLOT_8822B)) -+#define BIT_GET_SLOT_8822B(x) \ -+ (((x) >> BIT_SHIFT_SLOT_8822B) & BIT_MASK_SLOT_8822B) -+#define BIT_SET_SLOT_8822B(x, v) (BIT_CLEAR_SLOT_8822B(x) | BIT_SLOT_8822B(v)) -+ -+/* 2 REG_TX_PTCL_CTRL_8822B */ -+#define BIT_DIS_EDCCA_8822B BIT(15) -+#define BIT_DIS_CCA_8822B BIT(14) -+#define BIT_LSIG_TXOP_TXCMD_NAV_8822B BIT(13) -+#define BIT_SIFS_BK_EN_8822B BIT(12) -+ -+#define BIT_SHIFT_TXQ_NAV_MSK_8822B 8 -+#define BIT_MASK_TXQ_NAV_MSK_8822B 0xf -+#define BIT_TXQ_NAV_MSK_8822B(x) \ -+ (((x) & BIT_MASK_TXQ_NAV_MSK_8822B) << BIT_SHIFT_TXQ_NAV_MSK_8822B) -+#define BITS_TXQ_NAV_MSK_8822B \ -+ (BIT_MASK_TXQ_NAV_MSK_8822B << BIT_SHIFT_TXQ_NAV_MSK_8822B) -+#define BIT_CLEAR_TXQ_NAV_MSK_8822B(x) ((x) & (~BITS_TXQ_NAV_MSK_8822B)) -+#define BIT_GET_TXQ_NAV_MSK_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXQ_NAV_MSK_8822B) & BIT_MASK_TXQ_NAV_MSK_8822B) -+#define BIT_SET_TXQ_NAV_MSK_8822B(x, v) \ -+ (BIT_CLEAR_TXQ_NAV_MSK_8822B(x) | BIT_TXQ_NAV_MSK_8822B(v)) -+ -+#define BIT_DIS_CW_8822B BIT(7) -+#define BIT_NAV_END_TXOP_8822B BIT(6) -+#define BIT_RDG_END_TXOP_8822B BIT(5) -+#define BIT_AC_INBCN_HOLD_8822B BIT(4) -+#define BIT_MGTQ_TXOP_EN_8822B BIT(3) -+#define BIT_MGTQ_RTSMF_EN_8822B BIT(2) -+#define BIT_HIQ_RTSMF_EN_8822B BIT(1) -+#define BIT_BCN_RTSMF_EN_8822B BIT(0) -+ -+/* 2 REG_TXPAUSE_8822B */ -+#define BIT_STOP_BCN_HI_MGT_8822B BIT(7) -+#define BIT_MAC_STOPBCNQ_8822B BIT(6) -+#define BIT_MAC_STOPHIQ_8822B BIT(5) -+#define BIT_MAC_STOPMGQ_8822B BIT(4) -+#define BIT_MAC_STOPBK_8822B BIT(3) -+#define BIT_MAC_STOPBE_8822B BIT(2) -+#define BIT_MAC_STOPVI_8822B BIT(1) -+#define BIT_MAC_STOPVO_8822B BIT(0) -+ -+/* 2 REG_DIS_TXREQ_CLR_8822B */ -+#define BIT_DIS_BT_CCA_8822B BIT(7) -+#define BIT_DIS_TXREQ_CLR_HI_8822B BIT(5) -+#define BIT_DIS_TXREQ_CLR_MGQ_8822B BIT(4) -+#define BIT_DIS_TXREQ_CLR_VO_8822B BIT(3) -+#define BIT_DIS_TXREQ_CLR_VI_8822B BIT(2) -+#define BIT_DIS_TXREQ_CLR_BE_8822B BIT(1) -+#define BIT_DIS_TXREQ_CLR_BK_8822B BIT(0) -+ -+/* 2 REG_RD_CTRL_8822B */ -+#define BIT_EN_CLR_TXREQ_INCCA_8822B BIT(15) -+#define BIT_DIS_TX_OVER_BCNQ_8822B BIT(14) -+#define BIT_EN_BCNERR_INCCCA_8822B BIT(13) -+#define BIT_EDCCA_MSK_CNTDOWN_EN_8822B BIT(11) -+#define BIT_DIS_TXOP_CFE_8822B BIT(10) -+#define BIT_DIS_LSIG_CFE_8822B BIT(9) -+#define BIT_DIS_STBC_CFE_8822B BIT(8) -+#define BIT_BKQ_RD_INIT_EN_8822B BIT(7) -+#define BIT_BEQ_RD_INIT_EN_8822B BIT(6) -+#define BIT_VIQ_RD_INIT_EN_8822B BIT(5) -+#define BIT_VOQ_RD_INIT_EN_8822B BIT(4) -+#define BIT_BKQ_RD_RESP_EN_8822B BIT(3) -+#define BIT_BEQ_RD_RESP_EN_8822B BIT(2) -+#define BIT_VIQ_RD_RESP_EN_8822B BIT(1) -+#define BIT_VOQ_RD_RESP_EN_8822B BIT(0) -+ -+/* 2 REG_MBSSID_CTRL_8822B */ -+#define BIT_MBID_BCNQ7_EN_8822B BIT(7) -+#define BIT_MBID_BCNQ6_EN_8822B BIT(6) -+#define BIT_MBID_BCNQ5_EN_8822B BIT(5) -+#define BIT_MBID_BCNQ4_EN_8822B BIT(4) -+#define BIT_MBID_BCNQ3_EN_8822B BIT(3) -+#define BIT_MBID_BCNQ2_EN_8822B BIT(2) -+#define BIT_MBID_BCNQ1_EN_8822B BIT(1) -+#define BIT_MBID_BCNQ0_EN_8822B BIT(0) -+ -+/* 2 REG_P2PPS_CTRL_8822B */ -+#define BIT_P2P_CTW_ALLSTASLEEP_8822B BIT(7) -+#define BIT_P2P_OFF_DISTX_EN_8822B BIT(6) -+#define BIT_PWR_MGT_EN_8822B BIT(5) -+#define BIT_P2P_NOA1_EN_8822B BIT(2) -+#define BIT_P2P_NOA0_EN_8822B BIT(1) -+ -+/* 2 REG_PKT_LIFETIME_CTRL_8822B */ -+#define BIT_EN_P2P_CTWND1_8822B BIT(23) -+#define BIT_EN_BKF_CLR_TXREQ_8822B BIT(22) -+#define BIT_EN_TSFBIT32_RST_P2P_8822B BIT(21) -+#define BIT_EN_BCN_TX_BTCCA_8822B BIT(20) -+#define BIT_DIS_PKT_TX_ATIM_8822B BIT(19) -+#define BIT_DIS_BCN_DIS_CTN_8822B BIT(18) -+#define BIT_EN_NAVEND_RST_TXOP_8822B BIT(17) -+#define BIT_EN_FILTER_CCA_8822B BIT(16) -+ -+#define BIT_SHIFT_CCA_FILTER_THRS_8822B 8 -+#define BIT_MASK_CCA_FILTER_THRS_8822B 0xff -+#define BIT_CCA_FILTER_THRS_8822B(x) \ -+ (((x) & BIT_MASK_CCA_FILTER_THRS_8822B) \ -+ << BIT_SHIFT_CCA_FILTER_THRS_8822B) -+#define BITS_CCA_FILTER_THRS_8822B \ -+ (BIT_MASK_CCA_FILTER_THRS_8822B << BIT_SHIFT_CCA_FILTER_THRS_8822B) -+#define BIT_CLEAR_CCA_FILTER_THRS_8822B(x) ((x) & (~BITS_CCA_FILTER_THRS_8822B)) -+#define BIT_GET_CCA_FILTER_THRS_8822B(x) \ -+ (((x) >> BIT_SHIFT_CCA_FILTER_THRS_8822B) & \ -+ BIT_MASK_CCA_FILTER_THRS_8822B) -+#define BIT_SET_CCA_FILTER_THRS_8822B(x, v) \ -+ (BIT_CLEAR_CCA_FILTER_THRS_8822B(x) | BIT_CCA_FILTER_THRS_8822B(v)) -+ -+#define BIT_SHIFT_EDCCA_THRS_8822B 0 -+#define BIT_MASK_EDCCA_THRS_8822B 0xff -+#define BIT_EDCCA_THRS_8822B(x) \ -+ (((x) & BIT_MASK_EDCCA_THRS_8822B) << BIT_SHIFT_EDCCA_THRS_8822B) -+#define BITS_EDCCA_THRS_8822B \ -+ (BIT_MASK_EDCCA_THRS_8822B << BIT_SHIFT_EDCCA_THRS_8822B) -+#define BIT_CLEAR_EDCCA_THRS_8822B(x) ((x) & (~BITS_EDCCA_THRS_8822B)) -+#define BIT_GET_EDCCA_THRS_8822B(x) \ -+ (((x) >> BIT_SHIFT_EDCCA_THRS_8822B) & BIT_MASK_EDCCA_THRS_8822B) -+#define BIT_SET_EDCCA_THRS_8822B(x, v) \ -+ (BIT_CLEAR_EDCCA_THRS_8822B(x) | BIT_EDCCA_THRS_8822B(v)) -+ -+/* 2 REG_P2PPS_SPEC_STATE_8822B */ -+#define BIT_SPEC_POWER_STATE_8822B BIT(7) -+#define BIT_SPEC_CTWINDOW_ON_8822B BIT(6) -+#define BIT_SPEC_BEACON_AREA_ON_8822B BIT(5) -+#define BIT_SPEC_CTWIN_EARLY_DISTX_8822B BIT(4) -+#define BIT_SPEC_NOA1_OFF_PERIOD_8822B BIT(3) -+#define BIT_SPEC_FORCE_DOZE1_8822B BIT(2) -+#define BIT_SPEC_NOA0_OFF_PERIOD_8822B BIT(1) -+#define BIT_SPEC_FORCE_DOZE0_8822B BIT(0) -+ -+/* 2 REG_TXOP_LIMIT_CTRL_8822B */ -+ -+#define BIT_SHIFT_TXOP_TBTT_CNT_8822B 24 -+#define BIT_MASK_TXOP_TBTT_CNT_8822B 0xff -+#define BIT_TXOP_TBTT_CNT_8822B(x) \ -+ (((x) & BIT_MASK_TXOP_TBTT_CNT_8822B) << BIT_SHIFT_TXOP_TBTT_CNT_8822B) -+#define BITS_TXOP_TBTT_CNT_8822B \ -+ (BIT_MASK_TXOP_TBTT_CNT_8822B << BIT_SHIFT_TXOP_TBTT_CNT_8822B) -+#define BIT_CLEAR_TXOP_TBTT_CNT_8822B(x) ((x) & (~BITS_TXOP_TBTT_CNT_8822B)) -+#define BIT_GET_TXOP_TBTT_CNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_TBTT_CNT_8822B) & BIT_MASK_TXOP_TBTT_CNT_8822B) -+#define BIT_SET_TXOP_TBTT_CNT_8822B(x, v) \ -+ (BIT_CLEAR_TXOP_TBTT_CNT_8822B(x) | BIT_TXOP_TBTT_CNT_8822B(v)) -+ -+#define BIT_SHIFT_TXOP_TBTT_CNT_SEL_8822B 20 -+#define BIT_MASK_TXOP_TBTT_CNT_SEL_8822B 0xf -+#define BIT_TXOP_TBTT_CNT_SEL_8822B(x) \ -+ (((x) & BIT_MASK_TXOP_TBTT_CNT_SEL_8822B) \ -+ << BIT_SHIFT_TXOP_TBTT_CNT_SEL_8822B) -+#define BITS_TXOP_TBTT_CNT_SEL_8822B \ -+ (BIT_MASK_TXOP_TBTT_CNT_SEL_8822B << BIT_SHIFT_TXOP_TBTT_CNT_SEL_8822B) -+#define BIT_CLEAR_TXOP_TBTT_CNT_SEL_8822B(x) \ -+ ((x) & (~BITS_TXOP_TBTT_CNT_SEL_8822B)) -+#define BIT_GET_TXOP_TBTT_CNT_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_TBTT_CNT_SEL_8822B) & \ -+ BIT_MASK_TXOP_TBTT_CNT_SEL_8822B) -+#define BIT_SET_TXOP_TBTT_CNT_SEL_8822B(x, v) \ -+ (BIT_CLEAR_TXOP_TBTT_CNT_SEL_8822B(x) | BIT_TXOP_TBTT_CNT_SEL_8822B(v)) -+ -+#define BIT_SHIFT_TXOP_LMT_EN_8822B 16 -+#define BIT_MASK_TXOP_LMT_EN_8822B 0xf -+#define BIT_TXOP_LMT_EN_8822B(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_EN_8822B) << BIT_SHIFT_TXOP_LMT_EN_8822B) -+#define BITS_TXOP_LMT_EN_8822B \ -+ (BIT_MASK_TXOP_LMT_EN_8822B << BIT_SHIFT_TXOP_LMT_EN_8822B) -+#define BIT_CLEAR_TXOP_LMT_EN_8822B(x) ((x) & (~BITS_TXOP_LMT_EN_8822B)) -+#define BIT_GET_TXOP_LMT_EN_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_EN_8822B) & BIT_MASK_TXOP_LMT_EN_8822B) -+#define BIT_SET_TXOP_LMT_EN_8822B(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_EN_8822B(x) | BIT_TXOP_LMT_EN_8822B(v)) -+ -+#define BIT_SHIFT_TXOP_LMT_TX_TIME_8822B 8 -+#define BIT_MASK_TXOP_LMT_TX_TIME_8822B 0xff -+#define BIT_TXOP_LMT_TX_TIME_8822B(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_TX_TIME_8822B) \ -+ << BIT_SHIFT_TXOP_LMT_TX_TIME_8822B) -+#define BITS_TXOP_LMT_TX_TIME_8822B \ -+ (BIT_MASK_TXOP_LMT_TX_TIME_8822B << BIT_SHIFT_TXOP_LMT_TX_TIME_8822B) -+#define BIT_CLEAR_TXOP_LMT_TX_TIME_8822B(x) \ -+ ((x) & (~BITS_TXOP_LMT_TX_TIME_8822B)) -+#define BIT_GET_TXOP_LMT_TX_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_TX_TIME_8822B) & \ -+ BIT_MASK_TXOP_LMT_TX_TIME_8822B) -+#define BIT_SET_TXOP_LMT_TX_TIME_8822B(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_TX_TIME_8822B(x) | BIT_TXOP_LMT_TX_TIME_8822B(v)) -+ -+#define BIT_TXOP_CNT_TRIGGER_RESET_8822B BIT(7) -+ -+#define BIT_SHIFT_TXOP_LMT_PKT_NUM_8822B 0 -+#define BIT_MASK_TXOP_LMT_PKT_NUM_8822B 0x3f -+#define BIT_TXOP_LMT_PKT_NUM_8822B(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_PKT_NUM_8822B) \ -+ << BIT_SHIFT_TXOP_LMT_PKT_NUM_8822B) -+#define BITS_TXOP_LMT_PKT_NUM_8822B \ -+ (BIT_MASK_TXOP_LMT_PKT_NUM_8822B << BIT_SHIFT_TXOP_LMT_PKT_NUM_8822B) -+#define BIT_CLEAR_TXOP_LMT_PKT_NUM_8822B(x) \ -+ ((x) & (~BITS_TXOP_LMT_PKT_NUM_8822B)) -+#define BIT_GET_TXOP_LMT_PKT_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_PKT_NUM_8822B) & \ -+ BIT_MASK_TXOP_LMT_PKT_NUM_8822B) -+#define BIT_SET_TXOP_LMT_PKT_NUM_8822B(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_PKT_NUM_8822B(x) | BIT_TXOP_LMT_PKT_NUM_8822B(v)) -+ -+/* 2 REG_BAR_TX_CTRL_8822B */ -+ -+/* 2 REG_P2PON_DIS_TXTIME_8822B */ -+ -+#define BIT_SHIFT_P2PON_DIS_TXTIME_8822B 0 -+#define BIT_MASK_P2PON_DIS_TXTIME_8822B 0xff -+#define BIT_P2PON_DIS_TXTIME_8822B(x) \ -+ (((x) & BIT_MASK_P2PON_DIS_TXTIME_8822B) \ -+ << BIT_SHIFT_P2PON_DIS_TXTIME_8822B) -+#define BITS_P2PON_DIS_TXTIME_8822B \ -+ (BIT_MASK_P2PON_DIS_TXTIME_8822B << BIT_SHIFT_P2PON_DIS_TXTIME_8822B) -+#define BIT_CLEAR_P2PON_DIS_TXTIME_8822B(x) \ -+ ((x) & (~BITS_P2PON_DIS_TXTIME_8822B)) -+#define BIT_GET_P2PON_DIS_TXTIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_P2PON_DIS_TXTIME_8822B) & \ -+ BIT_MASK_P2PON_DIS_TXTIME_8822B) -+#define BIT_SET_P2PON_DIS_TXTIME_8822B(x, v) \ -+ (BIT_CLEAR_P2PON_DIS_TXTIME_8822B(x) | BIT_P2PON_DIS_TXTIME_8822B(v)) -+ -+/* 2 REG_QUEUE_INCOL_THR_8822B */ -+ -+#define BIT_SHIFT_BK_QUEUE_THR_8822B 24 -+#define BIT_MASK_BK_QUEUE_THR_8822B 0xff -+#define BIT_BK_QUEUE_THR_8822B(x) \ -+ (((x) & BIT_MASK_BK_QUEUE_THR_8822B) << BIT_SHIFT_BK_QUEUE_THR_8822B) -+#define BITS_BK_QUEUE_THR_8822B \ -+ (BIT_MASK_BK_QUEUE_THR_8822B << BIT_SHIFT_BK_QUEUE_THR_8822B) -+#define BIT_CLEAR_BK_QUEUE_THR_8822B(x) ((x) & (~BITS_BK_QUEUE_THR_8822B)) -+#define BIT_GET_BK_QUEUE_THR_8822B(x) \ -+ (((x) >> BIT_SHIFT_BK_QUEUE_THR_8822B) & BIT_MASK_BK_QUEUE_THR_8822B) -+#define BIT_SET_BK_QUEUE_THR_8822B(x, v) \ -+ (BIT_CLEAR_BK_QUEUE_THR_8822B(x) | BIT_BK_QUEUE_THR_8822B(v)) -+ -+#define BIT_SHIFT_BE_QUEUE_THR_8822B 16 -+#define BIT_MASK_BE_QUEUE_THR_8822B 0xff -+#define BIT_BE_QUEUE_THR_8822B(x) \ -+ (((x) & BIT_MASK_BE_QUEUE_THR_8822B) << BIT_SHIFT_BE_QUEUE_THR_8822B) -+#define BITS_BE_QUEUE_THR_8822B \ -+ (BIT_MASK_BE_QUEUE_THR_8822B << BIT_SHIFT_BE_QUEUE_THR_8822B) -+#define BIT_CLEAR_BE_QUEUE_THR_8822B(x) ((x) & (~BITS_BE_QUEUE_THR_8822B)) -+#define BIT_GET_BE_QUEUE_THR_8822B(x) \ -+ (((x) >> BIT_SHIFT_BE_QUEUE_THR_8822B) & BIT_MASK_BE_QUEUE_THR_8822B) -+#define BIT_SET_BE_QUEUE_THR_8822B(x, v) \ -+ (BIT_CLEAR_BE_QUEUE_THR_8822B(x) | BIT_BE_QUEUE_THR_8822B(v)) -+ -+#define BIT_SHIFT_VI_QUEUE_THR_8822B 8 -+#define BIT_MASK_VI_QUEUE_THR_8822B 0xff -+#define BIT_VI_QUEUE_THR_8822B(x) \ -+ (((x) & BIT_MASK_VI_QUEUE_THR_8822B) << BIT_SHIFT_VI_QUEUE_THR_8822B) -+#define BITS_VI_QUEUE_THR_8822B \ -+ (BIT_MASK_VI_QUEUE_THR_8822B << BIT_SHIFT_VI_QUEUE_THR_8822B) -+#define BIT_CLEAR_VI_QUEUE_THR_8822B(x) ((x) & (~BITS_VI_QUEUE_THR_8822B)) -+#define BIT_GET_VI_QUEUE_THR_8822B(x) \ -+ (((x) >> BIT_SHIFT_VI_QUEUE_THR_8822B) & BIT_MASK_VI_QUEUE_THR_8822B) -+#define BIT_SET_VI_QUEUE_THR_8822B(x, v) \ -+ (BIT_CLEAR_VI_QUEUE_THR_8822B(x) | BIT_VI_QUEUE_THR_8822B(v)) -+ -+#define BIT_SHIFT_VO_QUEUE_THR_8822B 0 -+#define BIT_MASK_VO_QUEUE_THR_8822B 0xff -+#define BIT_VO_QUEUE_THR_8822B(x) \ -+ (((x) & BIT_MASK_VO_QUEUE_THR_8822B) << BIT_SHIFT_VO_QUEUE_THR_8822B) -+#define BITS_VO_QUEUE_THR_8822B \ -+ (BIT_MASK_VO_QUEUE_THR_8822B << BIT_SHIFT_VO_QUEUE_THR_8822B) -+#define BIT_CLEAR_VO_QUEUE_THR_8822B(x) ((x) & (~BITS_VO_QUEUE_THR_8822B)) -+#define BIT_GET_VO_QUEUE_THR_8822B(x) \ -+ (((x) >> BIT_SHIFT_VO_QUEUE_THR_8822B) & BIT_MASK_VO_QUEUE_THR_8822B) -+#define BIT_SET_VO_QUEUE_THR_8822B(x, v) \ -+ (BIT_CLEAR_VO_QUEUE_THR_8822B(x) | BIT_VO_QUEUE_THR_8822B(v)) -+ -+/* 2 REG_QUEUE_INCOL_EN_8822B */ -+#define BIT_QUEUE_INCOL_EN_8822B BIT(16) -+ -+#define BIT_SHIFT_BE_TRIGGER_NUM_8822B 12 -+#define BIT_MASK_BE_TRIGGER_NUM_8822B 0xf -+#define BIT_BE_TRIGGER_NUM_8822B(x) \ -+ (((x) & BIT_MASK_BE_TRIGGER_NUM_8822B) \ -+ << BIT_SHIFT_BE_TRIGGER_NUM_8822B) -+#define BITS_BE_TRIGGER_NUM_8822B \ -+ (BIT_MASK_BE_TRIGGER_NUM_8822B << BIT_SHIFT_BE_TRIGGER_NUM_8822B) -+#define BIT_CLEAR_BE_TRIGGER_NUM_8822B(x) ((x) & (~BITS_BE_TRIGGER_NUM_8822B)) -+#define BIT_GET_BE_TRIGGER_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_BE_TRIGGER_NUM_8822B) & \ -+ BIT_MASK_BE_TRIGGER_NUM_8822B) -+#define BIT_SET_BE_TRIGGER_NUM_8822B(x, v) \ -+ (BIT_CLEAR_BE_TRIGGER_NUM_8822B(x) | BIT_BE_TRIGGER_NUM_8822B(v)) -+ -+#define BIT_SHIFT_BK_TRIGGER_NUM_8822B 8 -+#define BIT_MASK_BK_TRIGGER_NUM_8822B 0xf -+#define BIT_BK_TRIGGER_NUM_8822B(x) \ -+ (((x) & BIT_MASK_BK_TRIGGER_NUM_8822B) \ -+ << BIT_SHIFT_BK_TRIGGER_NUM_8822B) -+#define BITS_BK_TRIGGER_NUM_8822B \ -+ (BIT_MASK_BK_TRIGGER_NUM_8822B << BIT_SHIFT_BK_TRIGGER_NUM_8822B) -+#define BIT_CLEAR_BK_TRIGGER_NUM_8822B(x) ((x) & (~BITS_BK_TRIGGER_NUM_8822B)) -+#define BIT_GET_BK_TRIGGER_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_BK_TRIGGER_NUM_8822B) & \ -+ BIT_MASK_BK_TRIGGER_NUM_8822B) -+#define BIT_SET_BK_TRIGGER_NUM_8822B(x, v) \ -+ (BIT_CLEAR_BK_TRIGGER_NUM_8822B(x) | BIT_BK_TRIGGER_NUM_8822B(v)) -+ -+#define BIT_SHIFT_VI_TRIGGER_NUM_8822B 4 -+#define BIT_MASK_VI_TRIGGER_NUM_8822B 0xf -+#define BIT_VI_TRIGGER_NUM_8822B(x) \ -+ (((x) & BIT_MASK_VI_TRIGGER_NUM_8822B) \ -+ << BIT_SHIFT_VI_TRIGGER_NUM_8822B) -+#define BITS_VI_TRIGGER_NUM_8822B \ -+ (BIT_MASK_VI_TRIGGER_NUM_8822B << BIT_SHIFT_VI_TRIGGER_NUM_8822B) -+#define BIT_CLEAR_VI_TRIGGER_NUM_8822B(x) ((x) & (~BITS_VI_TRIGGER_NUM_8822B)) -+#define BIT_GET_VI_TRIGGER_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_VI_TRIGGER_NUM_8822B) & \ -+ BIT_MASK_VI_TRIGGER_NUM_8822B) -+#define BIT_SET_VI_TRIGGER_NUM_8822B(x, v) \ -+ (BIT_CLEAR_VI_TRIGGER_NUM_8822B(x) | BIT_VI_TRIGGER_NUM_8822B(v)) -+ -+#define BIT_SHIFT_VO_TRIGGER_NUM_8822B 0 -+#define BIT_MASK_VO_TRIGGER_NUM_8822B 0xf -+#define BIT_VO_TRIGGER_NUM_8822B(x) \ -+ (((x) & BIT_MASK_VO_TRIGGER_NUM_8822B) \ -+ << BIT_SHIFT_VO_TRIGGER_NUM_8822B) -+#define BITS_VO_TRIGGER_NUM_8822B \ -+ (BIT_MASK_VO_TRIGGER_NUM_8822B << BIT_SHIFT_VO_TRIGGER_NUM_8822B) -+#define BIT_CLEAR_VO_TRIGGER_NUM_8822B(x) ((x) & (~BITS_VO_TRIGGER_NUM_8822B)) -+#define BIT_GET_VO_TRIGGER_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_VO_TRIGGER_NUM_8822B) & \ -+ BIT_MASK_VO_TRIGGER_NUM_8822B) -+#define BIT_SET_VO_TRIGGER_NUM_8822B(x, v) \ -+ (BIT_CLEAR_VO_TRIGGER_NUM_8822B(x) | BIT_VO_TRIGGER_NUM_8822B(v)) -+ -+/* 2 REG_TBTT_PROHIBIT_8822B */ -+ -+#define BIT_SHIFT_TBTT_HOLD_TIME_AP_8822B 8 -+#define BIT_MASK_TBTT_HOLD_TIME_AP_8822B 0xfff -+#define BIT_TBTT_HOLD_TIME_AP_8822B(x) \ -+ (((x) & BIT_MASK_TBTT_HOLD_TIME_AP_8822B) \ -+ << BIT_SHIFT_TBTT_HOLD_TIME_AP_8822B) -+#define BITS_TBTT_HOLD_TIME_AP_8822B \ -+ (BIT_MASK_TBTT_HOLD_TIME_AP_8822B << BIT_SHIFT_TBTT_HOLD_TIME_AP_8822B) -+#define BIT_CLEAR_TBTT_HOLD_TIME_AP_8822B(x) \ -+ ((x) & (~BITS_TBTT_HOLD_TIME_AP_8822B)) -+#define BIT_GET_TBTT_HOLD_TIME_AP_8822B(x) \ -+ (((x) >> BIT_SHIFT_TBTT_HOLD_TIME_AP_8822B) & \ -+ BIT_MASK_TBTT_HOLD_TIME_AP_8822B) -+#define BIT_SET_TBTT_HOLD_TIME_AP_8822B(x, v) \ -+ (BIT_CLEAR_TBTT_HOLD_TIME_AP_8822B(x) | BIT_TBTT_HOLD_TIME_AP_8822B(v)) -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_SETUP_8822B 0 -+#define BIT_MASK_TBTT_PROHIBIT_SETUP_8822B 0xf -+#define BIT_TBTT_PROHIBIT_SETUP_8822B(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_SETUP_8822B) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8822B) -+#define BITS_TBTT_PROHIBIT_SETUP_8822B \ -+ (BIT_MASK_TBTT_PROHIBIT_SETUP_8822B \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8822B) -+#define BIT_CLEAR_TBTT_PROHIBIT_SETUP_8822B(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_SETUP_8822B)) -+#define BIT_GET_TBTT_PROHIBIT_SETUP_8822B(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_SETUP_8822B) & \ -+ BIT_MASK_TBTT_PROHIBIT_SETUP_8822B) -+#define BIT_SET_TBTT_PROHIBIT_SETUP_8822B(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_SETUP_8822B(x) | \ -+ BIT_TBTT_PROHIBIT_SETUP_8822B(v)) -+ -+/* 2 REG_P2PPS_STATE_8822B */ -+#define BIT_POWER_STATE_8822B BIT(7) -+#define BIT_CTWINDOW_ON_8822B BIT(6) -+#define BIT_BEACON_AREA_ON_8822B BIT(5) -+#define BIT_CTWIN_EARLY_DISTX_8822B BIT(4) -+#define BIT_NOA1_OFF_PERIOD_8822B BIT(3) -+#define BIT_FORCE_DOZE1_8822B BIT(2) -+#define BIT_NOA0_OFF_PERIOD_8822B BIT(1) -+#define BIT_FORCE_DOZE0_8822B BIT(0) -+ -+/* 2 REG_RD_NAV_NXT_8822B */ -+ -+#define BIT_SHIFT_RD_NAV_PROT_NXT_8822B 0 -+#define BIT_MASK_RD_NAV_PROT_NXT_8822B 0xffff -+#define BIT_RD_NAV_PROT_NXT_8822B(x) \ -+ (((x) & BIT_MASK_RD_NAV_PROT_NXT_8822B) \ -+ << BIT_SHIFT_RD_NAV_PROT_NXT_8822B) -+#define BITS_RD_NAV_PROT_NXT_8822B \ -+ (BIT_MASK_RD_NAV_PROT_NXT_8822B << BIT_SHIFT_RD_NAV_PROT_NXT_8822B) -+#define BIT_CLEAR_RD_NAV_PROT_NXT_8822B(x) ((x) & (~BITS_RD_NAV_PROT_NXT_8822B)) -+#define BIT_GET_RD_NAV_PROT_NXT_8822B(x) \ -+ (((x) >> BIT_SHIFT_RD_NAV_PROT_NXT_8822B) & \ -+ BIT_MASK_RD_NAV_PROT_NXT_8822B) -+#define BIT_SET_RD_NAV_PROT_NXT_8822B(x, v) \ -+ (BIT_CLEAR_RD_NAV_PROT_NXT_8822B(x) | BIT_RD_NAV_PROT_NXT_8822B(v)) -+ -+/* 2 REG_NAV_PROT_LEN_8822B */ -+ -+#define BIT_SHIFT_NAV_PROT_LEN_8822B 0 -+#define BIT_MASK_NAV_PROT_LEN_8822B 0xffff -+#define BIT_NAV_PROT_LEN_8822B(x) \ -+ (((x) & BIT_MASK_NAV_PROT_LEN_8822B) << BIT_SHIFT_NAV_PROT_LEN_8822B) -+#define BITS_NAV_PROT_LEN_8822B \ -+ (BIT_MASK_NAV_PROT_LEN_8822B << BIT_SHIFT_NAV_PROT_LEN_8822B) -+#define BIT_CLEAR_NAV_PROT_LEN_8822B(x) ((x) & (~BITS_NAV_PROT_LEN_8822B)) -+#define BIT_GET_NAV_PROT_LEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_NAV_PROT_LEN_8822B) & BIT_MASK_NAV_PROT_LEN_8822B) -+#define BIT_SET_NAV_PROT_LEN_8822B(x, v) \ -+ (BIT_CLEAR_NAV_PROT_LEN_8822B(x) | BIT_NAV_PROT_LEN_8822B(v)) -+ -+/* 2 REG_BCN_CTRL_8822B */ -+#define BIT_DIS_RX_BSSID_FIT_8822B BIT(6) -+#define BIT_P0_EN_TXBCN_RPT_8822B BIT(5) -+#define BIT_DIS_TSF_UDT_8822B BIT(4) -+#define BIT_EN_BCN_FUNCTION_8822B BIT(3) -+#define BIT_P0_EN_RXBCN_RPT_8822B BIT(2) -+#define BIT_EN_P2P_CTWINDOW_8822B BIT(1) -+#define BIT_EN_P2P_BCNQ_AREA_8822B BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT0_8822B */ -+#define BIT_CLI0_DIS_RX_BSSID_FIT_8822B BIT(6) -+#define BIT_CLI0_DIS_TSF_UDT_8822B BIT(4) -+#define BIT_CLI0_EN_BCN_FUNCTION_8822B BIT(3) -+#define BIT_CLI0_EN_RXBCN_RPT_8822B BIT(2) -+#define BIT_CLI0_ENP2P_CTWINDOW_8822B BIT(1) -+#define BIT_CLI0_ENP2P_BCNQ_AREA_8822B BIT(0) -+ -+/* 2 REG_MBID_NUM_8822B */ -+#define BIT_EN_PRE_DL_BEACON_8822B BIT(3) -+ -+#define BIT_SHIFT_MBID_BCN_NUM_8822B 0 -+#define BIT_MASK_MBID_BCN_NUM_8822B 0x7 -+#define BIT_MBID_BCN_NUM_8822B(x) \ -+ (((x) & BIT_MASK_MBID_BCN_NUM_8822B) << BIT_SHIFT_MBID_BCN_NUM_8822B) -+#define BITS_MBID_BCN_NUM_8822B \ -+ (BIT_MASK_MBID_BCN_NUM_8822B << BIT_SHIFT_MBID_BCN_NUM_8822B) -+#define BIT_CLEAR_MBID_BCN_NUM_8822B(x) ((x) & (~BITS_MBID_BCN_NUM_8822B)) -+#define BIT_GET_MBID_BCN_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCN_NUM_8822B) & BIT_MASK_MBID_BCN_NUM_8822B) -+#define BIT_SET_MBID_BCN_NUM_8822B(x, v) \ -+ (BIT_CLEAR_MBID_BCN_NUM_8822B(x) | BIT_MBID_BCN_NUM_8822B(v)) -+ -+/* 2 REG_DUAL_TSF_RST_8822B */ -+#define BIT_FREECNT_RST_8822B BIT(5) -+#define BIT_TSFTR_CLI3_RST_8822B BIT(4) -+#define BIT_TSFTR_CLI2_RST_8822B BIT(3) -+#define BIT_TSFTR_CLI1_RST_8822B BIT(2) -+#define BIT_TSFTR_CLI0_RST_8822B BIT(1) -+#define BIT_TSFTR_RST_8822B BIT(0) -+ -+/* 2 REG_MBSSID_BCN_SPACE_8822B */ -+ -+#define BIT_SHIFT_BCN_TIMER_SEL_FWRD_8822B 28 -+#define BIT_MASK_BCN_TIMER_SEL_FWRD_8822B 0x7 -+#define BIT_BCN_TIMER_SEL_FWRD_8822B(x) \ -+ (((x) & BIT_MASK_BCN_TIMER_SEL_FWRD_8822B) \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_8822B) -+#define BITS_BCN_TIMER_SEL_FWRD_8822B \ -+ (BIT_MASK_BCN_TIMER_SEL_FWRD_8822B \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_8822B) -+#define BIT_CLEAR_BCN_TIMER_SEL_FWRD_8822B(x) \ -+ ((x) & (~BITS_BCN_TIMER_SEL_FWRD_8822B)) -+#define BIT_GET_BCN_TIMER_SEL_FWRD_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCN_TIMER_SEL_FWRD_8822B) & \ -+ BIT_MASK_BCN_TIMER_SEL_FWRD_8822B) -+#define BIT_SET_BCN_TIMER_SEL_FWRD_8822B(x, v) \ -+ (BIT_CLEAR_BCN_TIMER_SEL_FWRD_8822B(x) | \ -+ BIT_BCN_TIMER_SEL_FWRD_8822B(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT0_8822B 16 -+#define BIT_MASK_BCN_SPACE_CLINT0_8822B 0xfff -+#define BIT_BCN_SPACE_CLINT0_8822B(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT0_8822B) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT0_8822B) -+#define BITS_BCN_SPACE_CLINT0_8822B \ -+ (BIT_MASK_BCN_SPACE_CLINT0_8822B << BIT_SHIFT_BCN_SPACE_CLINT0_8822B) -+#define BIT_CLEAR_BCN_SPACE_CLINT0_8822B(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT0_8822B)) -+#define BIT_GET_BCN_SPACE_CLINT0_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT0_8822B) & \ -+ BIT_MASK_BCN_SPACE_CLINT0_8822B) -+#define BIT_SET_BCN_SPACE_CLINT0_8822B(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT0_8822B(x) | BIT_BCN_SPACE_CLINT0_8822B(v)) -+ -+#define BIT_SHIFT_BCN_SPACE0_8822B 0 -+#define BIT_MASK_BCN_SPACE0_8822B 0xffff -+#define BIT_BCN_SPACE0_8822B(x) \ -+ (((x) & BIT_MASK_BCN_SPACE0_8822B) << BIT_SHIFT_BCN_SPACE0_8822B) -+#define BITS_BCN_SPACE0_8822B \ -+ (BIT_MASK_BCN_SPACE0_8822B << BIT_SHIFT_BCN_SPACE0_8822B) -+#define BIT_CLEAR_BCN_SPACE0_8822B(x) ((x) & (~BITS_BCN_SPACE0_8822B)) -+#define BIT_GET_BCN_SPACE0_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE0_8822B) & BIT_MASK_BCN_SPACE0_8822B) -+#define BIT_SET_BCN_SPACE0_8822B(x, v) \ -+ (BIT_CLEAR_BCN_SPACE0_8822B(x) | BIT_BCN_SPACE0_8822B(v)) -+ -+/* 2 REG_DRVERLYINT_8822B */ -+ -+#define BIT_SHIFT_DRVERLYITV_8822B 0 -+#define BIT_MASK_DRVERLYITV_8822B 0xff -+#define BIT_DRVERLYITV_8822B(x) \ -+ (((x) & BIT_MASK_DRVERLYITV_8822B) << BIT_SHIFT_DRVERLYITV_8822B) -+#define BITS_DRVERLYITV_8822B \ -+ (BIT_MASK_DRVERLYITV_8822B << BIT_SHIFT_DRVERLYITV_8822B) -+#define BIT_CLEAR_DRVERLYITV_8822B(x) ((x) & (~BITS_DRVERLYITV_8822B)) -+#define BIT_GET_DRVERLYITV_8822B(x) \ -+ (((x) >> BIT_SHIFT_DRVERLYITV_8822B) & BIT_MASK_DRVERLYITV_8822B) -+#define BIT_SET_DRVERLYITV_8822B(x, v) \ -+ (BIT_CLEAR_DRVERLYITV_8822B(x) | BIT_DRVERLYITV_8822B(v)) -+ -+/* 2 REG_BCNDMATIM_8822B */ -+ -+#define BIT_SHIFT_BCNDMATIM_8822B 0 -+#define BIT_MASK_BCNDMATIM_8822B 0xff -+#define BIT_BCNDMATIM_8822B(x) \ -+ (((x) & BIT_MASK_BCNDMATIM_8822B) << BIT_SHIFT_BCNDMATIM_8822B) -+#define BITS_BCNDMATIM_8822B \ -+ (BIT_MASK_BCNDMATIM_8822B << BIT_SHIFT_BCNDMATIM_8822B) -+#define BIT_CLEAR_BCNDMATIM_8822B(x) ((x) & (~BITS_BCNDMATIM_8822B)) -+#define BIT_GET_BCNDMATIM_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNDMATIM_8822B) & BIT_MASK_BCNDMATIM_8822B) -+#define BIT_SET_BCNDMATIM_8822B(x, v) \ -+ (BIT_CLEAR_BCNDMATIM_8822B(x) | BIT_BCNDMATIM_8822B(v)) -+ -+/* 2 REG_ATIMWND_8822B */ -+ -+#define BIT_SHIFT_ATIMWND0_8822B 0 -+#define BIT_MASK_ATIMWND0_8822B 0xffff -+#define BIT_ATIMWND0_8822B(x) \ -+ (((x) & BIT_MASK_ATIMWND0_8822B) << BIT_SHIFT_ATIMWND0_8822B) -+#define BITS_ATIMWND0_8822B \ -+ (BIT_MASK_ATIMWND0_8822B << BIT_SHIFT_ATIMWND0_8822B) -+#define BIT_CLEAR_ATIMWND0_8822B(x) ((x) & (~BITS_ATIMWND0_8822B)) -+#define BIT_GET_ATIMWND0_8822B(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND0_8822B) & BIT_MASK_ATIMWND0_8822B) -+#define BIT_SET_ATIMWND0_8822B(x, v) \ -+ (BIT_CLEAR_ATIMWND0_8822B(x) | BIT_ATIMWND0_8822B(v)) -+ -+/* 2 REG_USTIME_TSF_8822B */ -+ -+#define BIT_SHIFT_USTIME_TSF_V1_8822B 0 -+#define BIT_MASK_USTIME_TSF_V1_8822B 0xff -+#define BIT_USTIME_TSF_V1_8822B(x) \ -+ (((x) & BIT_MASK_USTIME_TSF_V1_8822B) << BIT_SHIFT_USTIME_TSF_V1_8822B) -+#define BITS_USTIME_TSF_V1_8822B \ -+ (BIT_MASK_USTIME_TSF_V1_8822B << BIT_SHIFT_USTIME_TSF_V1_8822B) -+#define BIT_CLEAR_USTIME_TSF_V1_8822B(x) ((x) & (~BITS_USTIME_TSF_V1_8822B)) -+#define BIT_GET_USTIME_TSF_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_USTIME_TSF_V1_8822B) & BIT_MASK_USTIME_TSF_V1_8822B) -+#define BIT_SET_USTIME_TSF_V1_8822B(x, v) \ -+ (BIT_CLEAR_USTIME_TSF_V1_8822B(x) | BIT_USTIME_TSF_V1_8822B(v)) -+ -+/* 2 REG_BCN_MAX_ERR_8822B */ -+ -+#define BIT_SHIFT_BCN_MAX_ERR_8822B 0 -+#define BIT_MASK_BCN_MAX_ERR_8822B 0xff -+#define BIT_BCN_MAX_ERR_8822B(x) \ -+ (((x) & BIT_MASK_BCN_MAX_ERR_8822B) << BIT_SHIFT_BCN_MAX_ERR_8822B) -+#define BITS_BCN_MAX_ERR_8822B \ -+ (BIT_MASK_BCN_MAX_ERR_8822B << BIT_SHIFT_BCN_MAX_ERR_8822B) -+#define BIT_CLEAR_BCN_MAX_ERR_8822B(x) ((x) & (~BITS_BCN_MAX_ERR_8822B)) -+#define BIT_GET_BCN_MAX_ERR_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCN_MAX_ERR_8822B) & BIT_MASK_BCN_MAX_ERR_8822B) -+#define BIT_SET_BCN_MAX_ERR_8822B(x, v) \ -+ (BIT_CLEAR_BCN_MAX_ERR_8822B(x) | BIT_BCN_MAX_ERR_8822B(v)) -+ -+/* 2 REG_RXTSF_OFFSET_CCK_8822B */ -+ -+#define BIT_SHIFT_CCK_RXTSF_OFFSET_8822B 0 -+#define BIT_MASK_CCK_RXTSF_OFFSET_8822B 0xff -+#define BIT_CCK_RXTSF_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_CCK_RXTSF_OFFSET_8822B) \ -+ << BIT_SHIFT_CCK_RXTSF_OFFSET_8822B) -+#define BITS_CCK_RXTSF_OFFSET_8822B \ -+ (BIT_MASK_CCK_RXTSF_OFFSET_8822B << BIT_SHIFT_CCK_RXTSF_OFFSET_8822B) -+#define BIT_CLEAR_CCK_RXTSF_OFFSET_8822B(x) \ -+ ((x) & (~BITS_CCK_RXTSF_OFFSET_8822B)) -+#define BIT_GET_CCK_RXTSF_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_CCK_RXTSF_OFFSET_8822B) & \ -+ BIT_MASK_CCK_RXTSF_OFFSET_8822B) -+#define BIT_SET_CCK_RXTSF_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_CCK_RXTSF_OFFSET_8822B(x) | BIT_CCK_RXTSF_OFFSET_8822B(v)) -+ -+/* 2 REG_RXTSF_OFFSET_OFDM_8822B */ -+ -+#define BIT_SHIFT_OFDM_RXTSF_OFFSET_8822B 0 -+#define BIT_MASK_OFDM_RXTSF_OFFSET_8822B 0xff -+#define BIT_OFDM_RXTSF_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_OFDM_RXTSF_OFFSET_8822B) \ -+ << BIT_SHIFT_OFDM_RXTSF_OFFSET_8822B) -+#define BITS_OFDM_RXTSF_OFFSET_8822B \ -+ (BIT_MASK_OFDM_RXTSF_OFFSET_8822B << BIT_SHIFT_OFDM_RXTSF_OFFSET_8822B) -+#define BIT_CLEAR_OFDM_RXTSF_OFFSET_8822B(x) \ -+ ((x) & (~BITS_OFDM_RXTSF_OFFSET_8822B)) -+#define BIT_GET_OFDM_RXTSF_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_OFDM_RXTSF_OFFSET_8822B) & \ -+ BIT_MASK_OFDM_RXTSF_OFFSET_8822B) -+#define BIT_SET_OFDM_RXTSF_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_OFDM_RXTSF_OFFSET_8822B(x) | BIT_OFDM_RXTSF_OFFSET_8822B(v)) -+ -+/* 2 REG_TSFTR_8822B */ -+ -+#define BIT_SHIFT_TSF_TIMER_8822B 0 -+#define BIT_MASK_TSF_TIMER_8822B 0xffffffffffffffffL -+#define BIT_TSF_TIMER_8822B(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_8822B) << BIT_SHIFT_TSF_TIMER_8822B) -+#define BITS_TSF_TIMER_8822B \ -+ (BIT_MASK_TSF_TIMER_8822B << BIT_SHIFT_TSF_TIMER_8822B) -+#define BIT_CLEAR_TSF_TIMER_8822B(x) ((x) & (~BITS_TSF_TIMER_8822B)) -+#define BIT_GET_TSF_TIMER_8822B(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_8822B) & BIT_MASK_TSF_TIMER_8822B) -+#define BIT_SET_TSF_TIMER_8822B(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_8822B(x) | BIT_TSF_TIMER_8822B(v)) -+ -+/* 2 REG_FREERUN_CNT_8822B */ -+ -+#define BIT_SHIFT_FREERUN_CNT_8822B 0 -+#define BIT_MASK_FREERUN_CNT_8822B 0xffffffffffffffffL -+#define BIT_FREERUN_CNT_8822B(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_8822B) << BIT_SHIFT_FREERUN_CNT_8822B) -+#define BITS_FREERUN_CNT_8822B \ -+ (BIT_MASK_FREERUN_CNT_8822B << BIT_SHIFT_FREERUN_CNT_8822B) -+#define BIT_CLEAR_FREERUN_CNT_8822B(x) ((x) & (~BITS_FREERUN_CNT_8822B)) -+#define BIT_GET_FREERUN_CNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_8822B) & BIT_MASK_FREERUN_CNT_8822B) -+#define BIT_SET_FREERUN_CNT_8822B(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_8822B(x) | BIT_FREERUN_CNT_8822B(v)) -+ -+/* 2 REG_ATIMWND1_V1_8822B */ -+ -+#define BIT_SHIFT_ATIMWND1_V1_8822B 0 -+#define BIT_MASK_ATIMWND1_V1_8822B 0xff -+#define BIT_ATIMWND1_V1_8822B(x) \ -+ (((x) & BIT_MASK_ATIMWND1_V1_8822B) << BIT_SHIFT_ATIMWND1_V1_8822B) -+#define BITS_ATIMWND1_V1_8822B \ -+ (BIT_MASK_ATIMWND1_V1_8822B << BIT_SHIFT_ATIMWND1_V1_8822B) -+#define BIT_CLEAR_ATIMWND1_V1_8822B(x) ((x) & (~BITS_ATIMWND1_V1_8822B)) -+#define BIT_GET_ATIMWND1_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND1_V1_8822B) & BIT_MASK_ATIMWND1_V1_8822B) -+#define BIT_SET_ATIMWND1_V1_8822B(x, v) \ -+ (BIT_CLEAR_ATIMWND1_V1_8822B(x) | BIT_ATIMWND1_V1_8822B(v)) -+ -+/* 2 REG_TBTT_PROHIBIT_INFRA_8822B */ -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_INFRA_8822B 0 -+#define BIT_MASK_TBTT_PROHIBIT_INFRA_8822B 0xff -+#define BIT_TBTT_PROHIBIT_INFRA_8822B(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_INFRA_8822B) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_INFRA_8822B) -+#define BITS_TBTT_PROHIBIT_INFRA_8822B \ -+ (BIT_MASK_TBTT_PROHIBIT_INFRA_8822B \ -+ << BIT_SHIFT_TBTT_PROHIBIT_INFRA_8822B) -+#define BIT_CLEAR_TBTT_PROHIBIT_INFRA_8822B(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_INFRA_8822B)) -+#define BIT_GET_TBTT_PROHIBIT_INFRA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_INFRA_8822B) & \ -+ BIT_MASK_TBTT_PROHIBIT_INFRA_8822B) -+#define BIT_SET_TBTT_PROHIBIT_INFRA_8822B(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_INFRA_8822B(x) | \ -+ BIT_TBTT_PROHIBIT_INFRA_8822B(v)) -+ -+/* 2 REG_CTWND_8822B */ -+ -+#define BIT_SHIFT_CTWND_8822B 0 -+#define BIT_MASK_CTWND_8822B 0xff -+#define BIT_CTWND_8822B(x) \ -+ (((x) & BIT_MASK_CTWND_8822B) << BIT_SHIFT_CTWND_8822B) -+#define BITS_CTWND_8822B (BIT_MASK_CTWND_8822B << BIT_SHIFT_CTWND_8822B) -+#define BIT_CLEAR_CTWND_8822B(x) ((x) & (~BITS_CTWND_8822B)) -+#define BIT_GET_CTWND_8822B(x) \ -+ (((x) >> BIT_SHIFT_CTWND_8822B) & BIT_MASK_CTWND_8822B) -+#define BIT_SET_CTWND_8822B(x, v) \ -+ (BIT_CLEAR_CTWND_8822B(x) | BIT_CTWND_8822B(v)) -+ -+/* 2 REG_BCNIVLCUNT_8822B */ -+ -+#define BIT_SHIFT_BCNIVLCUNT_8822B 0 -+#define BIT_MASK_BCNIVLCUNT_8822B 0x7f -+#define BIT_BCNIVLCUNT_8822B(x) \ -+ (((x) & BIT_MASK_BCNIVLCUNT_8822B) << BIT_SHIFT_BCNIVLCUNT_8822B) -+#define BITS_BCNIVLCUNT_8822B \ -+ (BIT_MASK_BCNIVLCUNT_8822B << BIT_SHIFT_BCNIVLCUNT_8822B) -+#define BIT_CLEAR_BCNIVLCUNT_8822B(x) ((x) & (~BITS_BCNIVLCUNT_8822B)) -+#define BIT_GET_BCNIVLCUNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCNIVLCUNT_8822B) & BIT_MASK_BCNIVLCUNT_8822B) -+#define BIT_SET_BCNIVLCUNT_8822B(x, v) \ -+ (BIT_CLEAR_BCNIVLCUNT_8822B(x) | BIT_BCNIVLCUNT_8822B(v)) -+ -+/* 2 REG_BCNDROPCTRL_8822B */ -+#define BIT_BEACON_DROP_EN_8822B BIT(7) -+ -+#define BIT_SHIFT_BEACON_DROP_IVL_8822B 0 -+#define BIT_MASK_BEACON_DROP_IVL_8822B 0x7f -+#define BIT_BEACON_DROP_IVL_8822B(x) \ -+ (((x) & BIT_MASK_BEACON_DROP_IVL_8822B) \ -+ << BIT_SHIFT_BEACON_DROP_IVL_8822B) -+#define BITS_BEACON_DROP_IVL_8822B \ -+ (BIT_MASK_BEACON_DROP_IVL_8822B << BIT_SHIFT_BEACON_DROP_IVL_8822B) -+#define BIT_CLEAR_BEACON_DROP_IVL_8822B(x) ((x) & (~BITS_BEACON_DROP_IVL_8822B)) -+#define BIT_GET_BEACON_DROP_IVL_8822B(x) \ -+ (((x) >> BIT_SHIFT_BEACON_DROP_IVL_8822B) & \ -+ BIT_MASK_BEACON_DROP_IVL_8822B) -+#define BIT_SET_BEACON_DROP_IVL_8822B(x, v) \ -+ (BIT_CLEAR_BEACON_DROP_IVL_8822B(x) | BIT_BEACON_DROP_IVL_8822B(v)) -+ -+/* 2 REG_HGQ_TIMEOUT_PERIOD_8822B */ -+ -+#define BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8822B 0 -+#define BIT_MASK_HGQ_TIMEOUT_PERIOD_8822B 0xff -+#define BIT_HGQ_TIMEOUT_PERIOD_8822B(x) \ -+ (((x) & BIT_MASK_HGQ_TIMEOUT_PERIOD_8822B) \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8822B) -+#define BITS_HGQ_TIMEOUT_PERIOD_8822B \ -+ (BIT_MASK_HGQ_TIMEOUT_PERIOD_8822B \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8822B) -+#define BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8822B(x) \ -+ ((x) & (~BITS_HGQ_TIMEOUT_PERIOD_8822B)) -+#define BIT_GET_HGQ_TIMEOUT_PERIOD_8822B(x) \ -+ (((x) >> BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8822B) & \ -+ BIT_MASK_HGQ_TIMEOUT_PERIOD_8822B) -+#define BIT_SET_HGQ_TIMEOUT_PERIOD_8822B(x, v) \ -+ (BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8822B(x) | \ -+ BIT_HGQ_TIMEOUT_PERIOD_8822B(v)) -+ -+/* 2 REG_TXCMD_TIMEOUT_PERIOD_8822B */ -+ -+#define BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8822B 0 -+#define BIT_MASK_TXCMD_TIMEOUT_PERIOD_8822B 0xff -+#define BIT_TXCMD_TIMEOUT_PERIOD_8822B(x) \ -+ (((x) & BIT_MASK_TXCMD_TIMEOUT_PERIOD_8822B) \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8822B) -+#define BITS_TXCMD_TIMEOUT_PERIOD_8822B \ -+ (BIT_MASK_TXCMD_TIMEOUT_PERIOD_8822B \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8822B) -+#define BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8822B(x) \ -+ ((x) & (~BITS_TXCMD_TIMEOUT_PERIOD_8822B)) -+#define BIT_GET_TXCMD_TIMEOUT_PERIOD_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8822B) & \ -+ BIT_MASK_TXCMD_TIMEOUT_PERIOD_8822B) -+#define BIT_SET_TXCMD_TIMEOUT_PERIOD_8822B(x, v) \ -+ (BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8822B(x) | \ -+ BIT_TXCMD_TIMEOUT_PERIOD_8822B(v)) -+ -+/* 2 REG_MISC_CTRL_8822B */ -+#define BIT_AUTO_SYNC_BY_TBTT_8822B BIT(6) -+#define BIT_DIS_TRX_CAL_BCN_8822B BIT(5) -+#define BIT_DIS_TX_CAL_TBTT_8822B BIT(4) -+#define BIT_EN_FREECNT_8822B BIT(3) -+#define BIT_BCN_AGGRESSION_8822B BIT(2) -+ -+#define BIT_SHIFT_DIS_SECONDARY_CCA_8822B 0 -+#define BIT_MASK_DIS_SECONDARY_CCA_8822B 0x3 -+#define BIT_DIS_SECONDARY_CCA_8822B(x) \ -+ (((x) & BIT_MASK_DIS_SECONDARY_CCA_8822B) \ -+ << BIT_SHIFT_DIS_SECONDARY_CCA_8822B) -+#define BITS_DIS_SECONDARY_CCA_8822B \ -+ (BIT_MASK_DIS_SECONDARY_CCA_8822B << BIT_SHIFT_DIS_SECONDARY_CCA_8822B) -+#define BIT_CLEAR_DIS_SECONDARY_CCA_8822B(x) \ -+ ((x) & (~BITS_DIS_SECONDARY_CCA_8822B)) -+#define BIT_GET_DIS_SECONDARY_CCA_8822B(x) \ -+ (((x) >> BIT_SHIFT_DIS_SECONDARY_CCA_8822B) & \ -+ BIT_MASK_DIS_SECONDARY_CCA_8822B) -+#define BIT_SET_DIS_SECONDARY_CCA_8822B(x, v) \ -+ (BIT_CLEAR_DIS_SECONDARY_CCA_8822B(x) | BIT_DIS_SECONDARY_CCA_8822B(v)) -+ -+/* 2 REG_BCN_CTRL_CLINT1_8822B */ -+#define BIT_CLI1_DIS_RX_BSSID_FIT_8822B BIT(6) -+#define BIT_CLI1_DIS_TSF_UDT_8822B BIT(4) -+#define BIT_CLI1_EN_BCN_FUNCTION_8822B BIT(3) -+#define BIT_CLI1_EN_RXBCN_RPT_8822B BIT(2) -+#define BIT_CLI1_ENP2P_CTWINDOW_8822B BIT(1) -+#define BIT_CLI1_ENP2P_BCNQ_AREA_8822B BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT2_8822B */ -+#define BIT_CLI2_DIS_RX_BSSID_FIT_8822B BIT(6) -+#define BIT_CLI2_DIS_TSF_UDT_8822B BIT(4) -+#define BIT_CLI2_EN_BCN_FUNCTION_8822B BIT(3) -+#define BIT_CLI2_EN_RXBCN_RPT_8822B BIT(2) -+#define BIT_CLI2_ENP2P_CTWINDOW_8822B BIT(1) -+#define BIT_CLI2_ENP2P_BCNQ_AREA_8822B BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT3_8822B */ -+#define BIT_CLI3_DIS_RX_BSSID_FIT_8822B BIT(6) -+#define BIT_CLI3_DIS_TSF_UDT_8822B BIT(4) -+#define BIT_CLI3_EN_BCN_FUNCTION_8822B BIT(3) -+#define BIT_CLI3_EN_RXBCN_RPT_8822B BIT(2) -+#define BIT_CLI3_ENP2P_CTWINDOW_8822B BIT(1) -+#define BIT_CLI3_ENP2P_BCNQ_AREA_8822B BIT(0) -+ -+/* 2 REG_EXTEND_CTRL_8822B */ -+#define BIT_EN_TSFBIT32_RST_P2P2_8822B BIT(5) -+#define BIT_EN_TSFBIT32_RST_P2P1_8822B BIT(4) -+ -+#define BIT_SHIFT_PORT_SEL_8822B 0 -+#define BIT_MASK_PORT_SEL_8822B 0x7 -+#define BIT_PORT_SEL_8822B(x) \ -+ (((x) & BIT_MASK_PORT_SEL_8822B) << BIT_SHIFT_PORT_SEL_8822B) -+#define BITS_PORT_SEL_8822B \ -+ (BIT_MASK_PORT_SEL_8822B << BIT_SHIFT_PORT_SEL_8822B) -+#define BIT_CLEAR_PORT_SEL_8822B(x) ((x) & (~BITS_PORT_SEL_8822B)) -+#define BIT_GET_PORT_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_PORT_SEL_8822B) & BIT_MASK_PORT_SEL_8822B) -+#define BIT_SET_PORT_SEL_8822B(x, v) \ -+ (BIT_CLEAR_PORT_SEL_8822B(x) | BIT_PORT_SEL_8822B(v)) -+ -+/* 2 REG_P2PPS1_SPEC_STATE_8822B */ -+#define BIT_P2P1_SPEC_POWER_STATE_8822B BIT(7) -+#define BIT_P2P1_SPEC_CTWINDOW_ON_8822B BIT(6) -+#define BIT_P2P1_SPEC_BCN_AREA_ON_8822B BIT(5) -+#define BIT_P2P1_SPEC_CTWIN_EARLY_DISTX_8822B BIT(4) -+#define BIT_P2P1_SPEC_NOA1_OFF_PERIOD_8822B BIT(3) -+#define BIT_P2P1_SPEC_FORCE_DOZE1_8822B BIT(2) -+#define BIT_P2P1_SPEC_NOA0_OFF_PERIOD_8822B BIT(1) -+#define BIT_P2P1_SPEC_FORCE_DOZE0_8822B BIT(0) -+ -+/* 2 REG_P2PPS1_STATE_8822B */ -+#define BIT_P2P1_POWER_STATE_8822B BIT(7) -+#define BIT_P2P1_CTWINDOW_ON_8822B BIT(6) -+#define BIT_P2P1_BEACON_AREA_ON_8822B BIT(5) -+#define BIT_P2P1_CTWIN_EARLY_DISTX_8822B BIT(4) -+#define BIT_P2P1_NOA1_OFF_PERIOD_8822B BIT(3) -+#define BIT_P2P1_FORCE_DOZE1_8822B BIT(2) -+#define BIT_P2P1_NOA0_OFF_PERIOD_8822B BIT(1) -+#define BIT_P2P1_FORCE_DOZE0_8822B BIT(0) -+ -+/* 2 REG_P2PPS2_SPEC_STATE_8822B */ -+#define BIT_P2P2_SPEC_POWER_STATE_8822B BIT(7) -+#define BIT_P2P2_SPEC_CTWINDOW_ON_8822B BIT(6) -+#define BIT_P2P2_SPEC_BCN_AREA_ON_8822B BIT(5) -+#define BIT_P2P2_SPEC_CTWIN_EARLY_DISTX_8822B BIT(4) -+#define BIT_P2P2_SPEC_NOA1_OFF_PERIOD_8822B BIT(3) -+#define BIT_P2P2_SPEC_FORCE_DOZE1_8822B BIT(2) -+#define BIT_P2P2_SPEC_NOA0_OFF_PERIOD_8822B BIT(1) -+#define BIT_P2P2_SPEC_FORCE_DOZE0_8822B BIT(0) -+ -+/* 2 REG_P2PPS2_STATE_8822B */ -+#define BIT_P2P2_POWER_STATE_8822B BIT(7) -+#define BIT_P2P2_CTWINDOW_ON_8822B BIT(6) -+#define BIT_P2P2_BEACON_AREA_ON_8822B BIT(5) -+#define BIT_P2P2_CTWIN_EARLY_DISTX_8822B BIT(4) -+#define BIT_P2P2_NOA1_OFF_PERIOD_8822B BIT(3) -+#define BIT_P2P2_FORCE_DOZE1_8822B BIT(2) -+#define BIT_P2P2_NOA0_OFF_PERIOD_8822B BIT(1) -+#define BIT_P2P2_FORCE_DOZE0_8822B BIT(0) -+ -+/* 2 REG_PS_TIMER0_8822B */ -+ -+#define BIT_SHIFT_PSTIMER0_INT_8822B 5 -+#define BIT_MASK_PSTIMER0_INT_8822B 0x7ffffff -+#define BIT_PSTIMER0_INT_8822B(x) \ -+ (((x) & BIT_MASK_PSTIMER0_INT_8822B) << BIT_SHIFT_PSTIMER0_INT_8822B) -+#define BITS_PSTIMER0_INT_8822B \ -+ (BIT_MASK_PSTIMER0_INT_8822B << BIT_SHIFT_PSTIMER0_INT_8822B) -+#define BIT_CLEAR_PSTIMER0_INT_8822B(x) ((x) & (~BITS_PSTIMER0_INT_8822B)) -+#define BIT_GET_PSTIMER0_INT_8822B(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER0_INT_8822B) & BIT_MASK_PSTIMER0_INT_8822B) -+#define BIT_SET_PSTIMER0_INT_8822B(x, v) \ -+ (BIT_CLEAR_PSTIMER0_INT_8822B(x) | BIT_PSTIMER0_INT_8822B(v)) -+ -+/* 2 REG_PS_TIMER1_8822B */ -+ -+#define BIT_SHIFT_PSTIMER1_INT_8822B 5 -+#define BIT_MASK_PSTIMER1_INT_8822B 0x7ffffff -+#define BIT_PSTIMER1_INT_8822B(x) \ -+ (((x) & BIT_MASK_PSTIMER1_INT_8822B) << BIT_SHIFT_PSTIMER1_INT_8822B) -+#define BITS_PSTIMER1_INT_8822B \ -+ (BIT_MASK_PSTIMER1_INT_8822B << BIT_SHIFT_PSTIMER1_INT_8822B) -+#define BIT_CLEAR_PSTIMER1_INT_8822B(x) ((x) & (~BITS_PSTIMER1_INT_8822B)) -+#define BIT_GET_PSTIMER1_INT_8822B(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER1_INT_8822B) & BIT_MASK_PSTIMER1_INT_8822B) -+#define BIT_SET_PSTIMER1_INT_8822B(x, v) \ -+ (BIT_CLEAR_PSTIMER1_INT_8822B(x) | BIT_PSTIMER1_INT_8822B(v)) -+ -+/* 2 REG_PS_TIMER2_8822B */ -+ -+#define BIT_SHIFT_PSTIMER2_INT_8822B 5 -+#define BIT_MASK_PSTIMER2_INT_8822B 0x7ffffff -+#define BIT_PSTIMER2_INT_8822B(x) \ -+ (((x) & BIT_MASK_PSTIMER2_INT_8822B) << BIT_SHIFT_PSTIMER2_INT_8822B) -+#define BITS_PSTIMER2_INT_8822B \ -+ (BIT_MASK_PSTIMER2_INT_8822B << BIT_SHIFT_PSTIMER2_INT_8822B) -+#define BIT_CLEAR_PSTIMER2_INT_8822B(x) ((x) & (~BITS_PSTIMER2_INT_8822B)) -+#define BIT_GET_PSTIMER2_INT_8822B(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER2_INT_8822B) & BIT_MASK_PSTIMER2_INT_8822B) -+#define BIT_SET_PSTIMER2_INT_8822B(x, v) \ -+ (BIT_CLEAR_PSTIMER2_INT_8822B(x) | BIT_PSTIMER2_INT_8822B(v)) -+ -+/* 2 REG_TBTT_CTN_AREA_8822B */ -+ -+#define BIT_SHIFT_TBTT_CTN_AREA_8822B 0 -+#define BIT_MASK_TBTT_CTN_AREA_8822B 0xff -+#define BIT_TBTT_CTN_AREA_8822B(x) \ -+ (((x) & BIT_MASK_TBTT_CTN_AREA_8822B) << BIT_SHIFT_TBTT_CTN_AREA_8822B) -+#define BITS_TBTT_CTN_AREA_8822B \ -+ (BIT_MASK_TBTT_CTN_AREA_8822B << BIT_SHIFT_TBTT_CTN_AREA_8822B) -+#define BIT_CLEAR_TBTT_CTN_AREA_8822B(x) ((x) & (~BITS_TBTT_CTN_AREA_8822B)) -+#define BIT_GET_TBTT_CTN_AREA_8822B(x) \ -+ (((x) >> BIT_SHIFT_TBTT_CTN_AREA_8822B) & BIT_MASK_TBTT_CTN_AREA_8822B) -+#define BIT_SET_TBTT_CTN_AREA_8822B(x, v) \ -+ (BIT_CLEAR_TBTT_CTN_AREA_8822B(x) | BIT_TBTT_CTN_AREA_8822B(v)) -+ -+/* 2 REG_FORCE_BCN_IFS_8822B */ -+ -+#define BIT_SHIFT_FORCE_BCN_IFS_8822B 0 -+#define BIT_MASK_FORCE_BCN_IFS_8822B 0xff -+#define BIT_FORCE_BCN_IFS_8822B(x) \ -+ (((x) & BIT_MASK_FORCE_BCN_IFS_8822B) << BIT_SHIFT_FORCE_BCN_IFS_8822B) -+#define BITS_FORCE_BCN_IFS_8822B \ -+ (BIT_MASK_FORCE_BCN_IFS_8822B << BIT_SHIFT_FORCE_BCN_IFS_8822B) -+#define BIT_CLEAR_FORCE_BCN_IFS_8822B(x) ((x) & (~BITS_FORCE_BCN_IFS_8822B)) -+#define BIT_GET_FORCE_BCN_IFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_FORCE_BCN_IFS_8822B) & BIT_MASK_FORCE_BCN_IFS_8822B) -+#define BIT_SET_FORCE_BCN_IFS_8822B(x, v) \ -+ (BIT_CLEAR_FORCE_BCN_IFS_8822B(x) | BIT_FORCE_BCN_IFS_8822B(v)) -+ -+/* 2 REG_TXOP_MIN_8822B */ -+ -+#define BIT_SHIFT_TXOP_MIN_8822B 0 -+#define BIT_MASK_TXOP_MIN_8822B 0x3fff -+#define BIT_TXOP_MIN_8822B(x) \ -+ (((x) & BIT_MASK_TXOP_MIN_8822B) << BIT_SHIFT_TXOP_MIN_8822B) -+#define BITS_TXOP_MIN_8822B \ -+ (BIT_MASK_TXOP_MIN_8822B << BIT_SHIFT_TXOP_MIN_8822B) -+#define BIT_CLEAR_TXOP_MIN_8822B(x) ((x) & (~BITS_TXOP_MIN_8822B)) -+#define BIT_GET_TXOP_MIN_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXOP_MIN_8822B) & BIT_MASK_TXOP_MIN_8822B) -+#define BIT_SET_TXOP_MIN_8822B(x, v) \ -+ (BIT_CLEAR_TXOP_MIN_8822B(x) | BIT_TXOP_MIN_8822B(v)) -+ -+/* 2 REG_PRE_BKF_TIME_8822B */ -+ -+#define BIT_SHIFT_PRE_BKF_TIME_8822B 0 -+#define BIT_MASK_PRE_BKF_TIME_8822B 0xff -+#define BIT_PRE_BKF_TIME_8822B(x) \ -+ (((x) & BIT_MASK_PRE_BKF_TIME_8822B) << BIT_SHIFT_PRE_BKF_TIME_8822B) -+#define BITS_PRE_BKF_TIME_8822B \ -+ (BIT_MASK_PRE_BKF_TIME_8822B << BIT_SHIFT_PRE_BKF_TIME_8822B) -+#define BIT_CLEAR_PRE_BKF_TIME_8822B(x) ((x) & (~BITS_PRE_BKF_TIME_8822B)) -+#define BIT_GET_PRE_BKF_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_PRE_BKF_TIME_8822B) & BIT_MASK_PRE_BKF_TIME_8822B) -+#define BIT_SET_PRE_BKF_TIME_8822B(x, v) \ -+ (BIT_CLEAR_PRE_BKF_TIME_8822B(x) | BIT_PRE_BKF_TIME_8822B(v)) -+ -+/* 2 REG_CROSS_TXOP_CTRL_8822B */ -+#define BIT_DTIM_BYPASS_8822B BIT(2) -+#define BIT_RTS_NAV_TXOP_8822B BIT(1) -+#define BIT_NOT_CROSS_TXOP_8822B BIT(0) -+ -+/* 2 REG_ATIMWND2_8822B */ -+ -+#define BIT_SHIFT_ATIMWND2_8822B 0 -+#define BIT_MASK_ATIMWND2_8822B 0xff -+#define BIT_ATIMWND2_8822B(x) \ -+ (((x) & BIT_MASK_ATIMWND2_8822B) << BIT_SHIFT_ATIMWND2_8822B) -+#define BITS_ATIMWND2_8822B \ -+ (BIT_MASK_ATIMWND2_8822B << BIT_SHIFT_ATIMWND2_8822B) -+#define BIT_CLEAR_ATIMWND2_8822B(x) ((x) & (~BITS_ATIMWND2_8822B)) -+#define BIT_GET_ATIMWND2_8822B(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND2_8822B) & BIT_MASK_ATIMWND2_8822B) -+#define BIT_SET_ATIMWND2_8822B(x, v) \ -+ (BIT_CLEAR_ATIMWND2_8822B(x) | BIT_ATIMWND2_8822B(v)) -+ -+/* 2 REG_ATIMWND3_8822B */ -+ -+#define BIT_SHIFT_ATIMWND3_8822B 0 -+#define BIT_MASK_ATIMWND3_8822B 0xff -+#define BIT_ATIMWND3_8822B(x) \ -+ (((x) & BIT_MASK_ATIMWND3_8822B) << BIT_SHIFT_ATIMWND3_8822B) -+#define BITS_ATIMWND3_8822B \ -+ (BIT_MASK_ATIMWND3_8822B << BIT_SHIFT_ATIMWND3_8822B) -+#define BIT_CLEAR_ATIMWND3_8822B(x) ((x) & (~BITS_ATIMWND3_8822B)) -+#define BIT_GET_ATIMWND3_8822B(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND3_8822B) & BIT_MASK_ATIMWND3_8822B) -+#define BIT_SET_ATIMWND3_8822B(x, v) \ -+ (BIT_CLEAR_ATIMWND3_8822B(x) | BIT_ATIMWND3_8822B(v)) -+ -+/* 2 REG_ATIMWND4_8822B */ -+ -+#define BIT_SHIFT_ATIMWND4_8822B 0 -+#define BIT_MASK_ATIMWND4_8822B 0xff -+#define BIT_ATIMWND4_8822B(x) \ -+ (((x) & BIT_MASK_ATIMWND4_8822B) << BIT_SHIFT_ATIMWND4_8822B) -+#define BITS_ATIMWND4_8822B \ -+ (BIT_MASK_ATIMWND4_8822B << BIT_SHIFT_ATIMWND4_8822B) -+#define BIT_CLEAR_ATIMWND4_8822B(x) ((x) & (~BITS_ATIMWND4_8822B)) -+#define BIT_GET_ATIMWND4_8822B(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND4_8822B) & BIT_MASK_ATIMWND4_8822B) -+#define BIT_SET_ATIMWND4_8822B(x, v) \ -+ (BIT_CLEAR_ATIMWND4_8822B(x) | BIT_ATIMWND4_8822B(v)) -+ -+/* 2 REG_ATIMWND5_8822B */ -+ -+#define BIT_SHIFT_ATIMWND5_8822B 0 -+#define BIT_MASK_ATIMWND5_8822B 0xff -+#define BIT_ATIMWND5_8822B(x) \ -+ (((x) & BIT_MASK_ATIMWND5_8822B) << BIT_SHIFT_ATIMWND5_8822B) -+#define BITS_ATIMWND5_8822B \ -+ (BIT_MASK_ATIMWND5_8822B << BIT_SHIFT_ATIMWND5_8822B) -+#define BIT_CLEAR_ATIMWND5_8822B(x) ((x) & (~BITS_ATIMWND5_8822B)) -+#define BIT_GET_ATIMWND5_8822B(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND5_8822B) & BIT_MASK_ATIMWND5_8822B) -+#define BIT_SET_ATIMWND5_8822B(x, v) \ -+ (BIT_CLEAR_ATIMWND5_8822B(x) | BIT_ATIMWND5_8822B(v)) -+ -+/* 2 REG_ATIMWND6_8822B */ -+ -+#define BIT_SHIFT_ATIMWND6_8822B 0 -+#define BIT_MASK_ATIMWND6_8822B 0xff -+#define BIT_ATIMWND6_8822B(x) \ -+ (((x) & BIT_MASK_ATIMWND6_8822B) << BIT_SHIFT_ATIMWND6_8822B) -+#define BITS_ATIMWND6_8822B \ -+ (BIT_MASK_ATIMWND6_8822B << BIT_SHIFT_ATIMWND6_8822B) -+#define BIT_CLEAR_ATIMWND6_8822B(x) ((x) & (~BITS_ATIMWND6_8822B)) -+#define BIT_GET_ATIMWND6_8822B(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND6_8822B) & BIT_MASK_ATIMWND6_8822B) -+#define BIT_SET_ATIMWND6_8822B(x, v) \ -+ (BIT_CLEAR_ATIMWND6_8822B(x) | BIT_ATIMWND6_8822B(v)) -+ -+/* 2 REG_ATIMWND7_8822B */ -+ -+#define BIT_SHIFT_ATIMWND7_8822B 0 -+#define BIT_MASK_ATIMWND7_8822B 0xff -+#define BIT_ATIMWND7_8822B(x) \ -+ (((x) & BIT_MASK_ATIMWND7_8822B) << BIT_SHIFT_ATIMWND7_8822B) -+#define BITS_ATIMWND7_8822B \ -+ (BIT_MASK_ATIMWND7_8822B << BIT_SHIFT_ATIMWND7_8822B) -+#define BIT_CLEAR_ATIMWND7_8822B(x) ((x) & (~BITS_ATIMWND7_8822B)) -+#define BIT_GET_ATIMWND7_8822B(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND7_8822B) & BIT_MASK_ATIMWND7_8822B) -+#define BIT_SET_ATIMWND7_8822B(x, v) \ -+ (BIT_CLEAR_ATIMWND7_8822B(x) | BIT_ATIMWND7_8822B(v)) -+ -+/* 2 REG_ATIMUGT_8822B */ -+ -+#define BIT_SHIFT_ATIM_URGENT_8822B 0 -+#define BIT_MASK_ATIM_URGENT_8822B 0xff -+#define BIT_ATIM_URGENT_8822B(x) \ -+ (((x) & BIT_MASK_ATIM_URGENT_8822B) << BIT_SHIFT_ATIM_URGENT_8822B) -+#define BITS_ATIM_URGENT_8822B \ -+ (BIT_MASK_ATIM_URGENT_8822B << BIT_SHIFT_ATIM_URGENT_8822B) -+#define BIT_CLEAR_ATIM_URGENT_8822B(x) ((x) & (~BITS_ATIM_URGENT_8822B)) -+#define BIT_GET_ATIM_URGENT_8822B(x) \ -+ (((x) >> BIT_SHIFT_ATIM_URGENT_8822B) & BIT_MASK_ATIM_URGENT_8822B) -+#define BIT_SET_ATIM_URGENT_8822B(x, v) \ -+ (BIT_CLEAR_ATIM_URGENT_8822B(x) | BIT_ATIM_URGENT_8822B(v)) -+ -+/* 2 REG_HIQ_NO_LMT_EN_8822B */ -+#define BIT_HIQ_NO_LMT_EN_VAP7_8822B BIT(7) -+#define BIT_HIQ_NO_LMT_EN_VAP6_8822B BIT(6) -+#define BIT_HIQ_NO_LMT_EN_VAP5_8822B BIT(5) -+#define BIT_HIQ_NO_LMT_EN_VAP4_8822B BIT(4) -+#define BIT_HIQ_NO_LMT_EN_VAP3_8822B BIT(3) -+#define BIT_HIQ_NO_LMT_EN_VAP2_8822B BIT(2) -+#define BIT_HIQ_NO_LMT_EN_VAP1_8822B BIT(1) -+#define BIT_HIQ_NO_LMT_EN_ROOT_8822B BIT(0) -+ -+/* 2 REG_DTIM_COUNTER_ROOT_8822B */ -+ -+#define BIT_SHIFT_DTIM_COUNT_ROOT_8822B 0 -+#define BIT_MASK_DTIM_COUNT_ROOT_8822B 0xff -+#define BIT_DTIM_COUNT_ROOT_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_ROOT_8822B) \ -+ << BIT_SHIFT_DTIM_COUNT_ROOT_8822B) -+#define BITS_DTIM_COUNT_ROOT_8822B \ -+ (BIT_MASK_DTIM_COUNT_ROOT_8822B << BIT_SHIFT_DTIM_COUNT_ROOT_8822B) -+#define BIT_CLEAR_DTIM_COUNT_ROOT_8822B(x) ((x) & (~BITS_DTIM_COUNT_ROOT_8822B)) -+#define BIT_GET_DTIM_COUNT_ROOT_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_ROOT_8822B) & \ -+ BIT_MASK_DTIM_COUNT_ROOT_8822B) -+#define BIT_SET_DTIM_COUNT_ROOT_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_ROOT_8822B(x) | BIT_DTIM_COUNT_ROOT_8822B(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP1_8822B */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP1_8822B 0 -+#define BIT_MASK_DTIM_COUNT_VAP1_8822B 0xff -+#define BIT_DTIM_COUNT_VAP1_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP1_8822B) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP1_8822B) -+#define BITS_DTIM_COUNT_VAP1_8822B \ -+ (BIT_MASK_DTIM_COUNT_VAP1_8822B << BIT_SHIFT_DTIM_COUNT_VAP1_8822B) -+#define BIT_CLEAR_DTIM_COUNT_VAP1_8822B(x) ((x) & (~BITS_DTIM_COUNT_VAP1_8822B)) -+#define BIT_GET_DTIM_COUNT_VAP1_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP1_8822B) & \ -+ BIT_MASK_DTIM_COUNT_VAP1_8822B) -+#define BIT_SET_DTIM_COUNT_VAP1_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP1_8822B(x) | BIT_DTIM_COUNT_VAP1_8822B(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP2_8822B */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP2_8822B 0 -+#define BIT_MASK_DTIM_COUNT_VAP2_8822B 0xff -+#define BIT_DTIM_COUNT_VAP2_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP2_8822B) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP2_8822B) -+#define BITS_DTIM_COUNT_VAP2_8822B \ -+ (BIT_MASK_DTIM_COUNT_VAP2_8822B << BIT_SHIFT_DTIM_COUNT_VAP2_8822B) -+#define BIT_CLEAR_DTIM_COUNT_VAP2_8822B(x) ((x) & (~BITS_DTIM_COUNT_VAP2_8822B)) -+#define BIT_GET_DTIM_COUNT_VAP2_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP2_8822B) & \ -+ BIT_MASK_DTIM_COUNT_VAP2_8822B) -+#define BIT_SET_DTIM_COUNT_VAP2_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP2_8822B(x) | BIT_DTIM_COUNT_VAP2_8822B(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP3_8822B */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP3_8822B 0 -+#define BIT_MASK_DTIM_COUNT_VAP3_8822B 0xff -+#define BIT_DTIM_COUNT_VAP3_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP3_8822B) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP3_8822B) -+#define BITS_DTIM_COUNT_VAP3_8822B \ -+ (BIT_MASK_DTIM_COUNT_VAP3_8822B << BIT_SHIFT_DTIM_COUNT_VAP3_8822B) -+#define BIT_CLEAR_DTIM_COUNT_VAP3_8822B(x) ((x) & (~BITS_DTIM_COUNT_VAP3_8822B)) -+#define BIT_GET_DTIM_COUNT_VAP3_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP3_8822B) & \ -+ BIT_MASK_DTIM_COUNT_VAP3_8822B) -+#define BIT_SET_DTIM_COUNT_VAP3_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP3_8822B(x) | BIT_DTIM_COUNT_VAP3_8822B(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP4_8822B */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP4_8822B 0 -+#define BIT_MASK_DTIM_COUNT_VAP4_8822B 0xff -+#define BIT_DTIM_COUNT_VAP4_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP4_8822B) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP4_8822B) -+#define BITS_DTIM_COUNT_VAP4_8822B \ -+ (BIT_MASK_DTIM_COUNT_VAP4_8822B << BIT_SHIFT_DTIM_COUNT_VAP4_8822B) -+#define BIT_CLEAR_DTIM_COUNT_VAP4_8822B(x) ((x) & (~BITS_DTIM_COUNT_VAP4_8822B)) -+#define BIT_GET_DTIM_COUNT_VAP4_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP4_8822B) & \ -+ BIT_MASK_DTIM_COUNT_VAP4_8822B) -+#define BIT_SET_DTIM_COUNT_VAP4_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP4_8822B(x) | BIT_DTIM_COUNT_VAP4_8822B(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP5_8822B */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP5_8822B 0 -+#define BIT_MASK_DTIM_COUNT_VAP5_8822B 0xff -+#define BIT_DTIM_COUNT_VAP5_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP5_8822B) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP5_8822B) -+#define BITS_DTIM_COUNT_VAP5_8822B \ -+ (BIT_MASK_DTIM_COUNT_VAP5_8822B << BIT_SHIFT_DTIM_COUNT_VAP5_8822B) -+#define BIT_CLEAR_DTIM_COUNT_VAP5_8822B(x) ((x) & (~BITS_DTIM_COUNT_VAP5_8822B)) -+#define BIT_GET_DTIM_COUNT_VAP5_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP5_8822B) & \ -+ BIT_MASK_DTIM_COUNT_VAP5_8822B) -+#define BIT_SET_DTIM_COUNT_VAP5_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP5_8822B(x) | BIT_DTIM_COUNT_VAP5_8822B(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP6_8822B */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP6_8822B 0 -+#define BIT_MASK_DTIM_COUNT_VAP6_8822B 0xff -+#define BIT_DTIM_COUNT_VAP6_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP6_8822B) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP6_8822B) -+#define BITS_DTIM_COUNT_VAP6_8822B \ -+ (BIT_MASK_DTIM_COUNT_VAP6_8822B << BIT_SHIFT_DTIM_COUNT_VAP6_8822B) -+#define BIT_CLEAR_DTIM_COUNT_VAP6_8822B(x) ((x) & (~BITS_DTIM_COUNT_VAP6_8822B)) -+#define BIT_GET_DTIM_COUNT_VAP6_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP6_8822B) & \ -+ BIT_MASK_DTIM_COUNT_VAP6_8822B) -+#define BIT_SET_DTIM_COUNT_VAP6_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP6_8822B(x) | BIT_DTIM_COUNT_VAP6_8822B(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP7_8822B */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP7_8822B 0 -+#define BIT_MASK_DTIM_COUNT_VAP7_8822B 0xff -+#define BIT_DTIM_COUNT_VAP7_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP7_8822B) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP7_8822B) -+#define BITS_DTIM_COUNT_VAP7_8822B \ -+ (BIT_MASK_DTIM_COUNT_VAP7_8822B << BIT_SHIFT_DTIM_COUNT_VAP7_8822B) -+#define BIT_CLEAR_DTIM_COUNT_VAP7_8822B(x) ((x) & (~BITS_DTIM_COUNT_VAP7_8822B)) -+#define BIT_GET_DTIM_COUNT_VAP7_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP7_8822B) & \ -+ BIT_MASK_DTIM_COUNT_VAP7_8822B) -+#define BIT_SET_DTIM_COUNT_VAP7_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP7_8822B(x) | BIT_DTIM_COUNT_VAP7_8822B(v)) -+ -+/* 2 REG_DIS_ATIM_8822B */ -+#define BIT_DIS_ATIM_VAP7_8822B BIT(7) -+#define BIT_DIS_ATIM_VAP6_8822B BIT(6) -+#define BIT_DIS_ATIM_VAP5_8822B BIT(5) -+#define BIT_DIS_ATIM_VAP4_8822B BIT(4) -+#define BIT_DIS_ATIM_VAP3_8822B BIT(3) -+#define BIT_DIS_ATIM_VAP2_8822B BIT(2) -+#define BIT_DIS_ATIM_VAP1_8822B BIT(1) -+#define BIT_DIS_ATIM_ROOT_8822B BIT(0) -+ -+/* 2 REG_EARLY_128US_8822B */ -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER1_8822B 3 -+#define BIT_MASK_TSFT_SEL_TIMER1_8822B 0x7 -+#define BIT_TSFT_SEL_TIMER1_8822B(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER1_8822B) \ -+ << BIT_SHIFT_TSFT_SEL_TIMER1_8822B) -+#define BITS_TSFT_SEL_TIMER1_8822B \ -+ (BIT_MASK_TSFT_SEL_TIMER1_8822B << BIT_SHIFT_TSFT_SEL_TIMER1_8822B) -+#define BIT_CLEAR_TSFT_SEL_TIMER1_8822B(x) ((x) & (~BITS_TSFT_SEL_TIMER1_8822B)) -+#define BIT_GET_TSFT_SEL_TIMER1_8822B(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER1_8822B) & \ -+ BIT_MASK_TSFT_SEL_TIMER1_8822B) -+#define BIT_SET_TSFT_SEL_TIMER1_8822B(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER1_8822B(x) | BIT_TSFT_SEL_TIMER1_8822B(v)) -+ -+#define BIT_SHIFT_EARLY_128US_8822B 0 -+#define BIT_MASK_EARLY_128US_8822B 0x7 -+#define BIT_EARLY_128US_8822B(x) \ -+ (((x) & BIT_MASK_EARLY_128US_8822B) << BIT_SHIFT_EARLY_128US_8822B) -+#define BITS_EARLY_128US_8822B \ -+ (BIT_MASK_EARLY_128US_8822B << BIT_SHIFT_EARLY_128US_8822B) -+#define BIT_CLEAR_EARLY_128US_8822B(x) ((x) & (~BITS_EARLY_128US_8822B)) -+#define BIT_GET_EARLY_128US_8822B(x) \ -+ (((x) >> BIT_SHIFT_EARLY_128US_8822B) & BIT_MASK_EARLY_128US_8822B) -+#define BIT_SET_EARLY_128US_8822B(x, v) \ -+ (BIT_CLEAR_EARLY_128US_8822B(x) | BIT_EARLY_128US_8822B(v)) -+ -+/* 2 REG_P2PPS1_CTRL_8822B */ -+#define BIT_P2P1_CTW_ALLSTASLEEP_8822B BIT(7) -+#define BIT_P2P1_OFF_DISTX_EN_8822B BIT(6) -+#define BIT_P2P1_PWR_MGT_EN_8822B BIT(5) -+#define BIT_P2P1_NOA1_EN_8822B BIT(2) -+#define BIT_P2P1_NOA0_EN_8822B BIT(1) -+ -+/* 2 REG_P2PPS2_CTRL_8822B */ -+#define BIT_P2P2_CTW_ALLSTASLEEP_8822B BIT(7) -+#define BIT_P2P2_OFF_DISTX_EN_8822B BIT(6) -+#define BIT_P2P2_PWR_MGT_EN_8822B BIT(5) -+#define BIT_P2P2_NOA1_EN_8822B BIT(2) -+#define BIT_P2P2_NOA0_EN_8822B BIT(1) -+ -+/* 2 REG_TIMER0_SRC_SEL_8822B */ -+ -+#define BIT_SHIFT_SYNC_CLI_SEL_8822B 4 -+#define BIT_MASK_SYNC_CLI_SEL_8822B 0x7 -+#define BIT_SYNC_CLI_SEL_8822B(x) \ -+ (((x) & BIT_MASK_SYNC_CLI_SEL_8822B) << BIT_SHIFT_SYNC_CLI_SEL_8822B) -+#define BITS_SYNC_CLI_SEL_8822B \ -+ (BIT_MASK_SYNC_CLI_SEL_8822B << BIT_SHIFT_SYNC_CLI_SEL_8822B) -+#define BIT_CLEAR_SYNC_CLI_SEL_8822B(x) ((x) & (~BITS_SYNC_CLI_SEL_8822B)) -+#define BIT_GET_SYNC_CLI_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_SYNC_CLI_SEL_8822B) & BIT_MASK_SYNC_CLI_SEL_8822B) -+#define BIT_SET_SYNC_CLI_SEL_8822B(x, v) \ -+ (BIT_CLEAR_SYNC_CLI_SEL_8822B(x) | BIT_SYNC_CLI_SEL_8822B(v)) -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER0_8822B 0 -+#define BIT_MASK_TSFT_SEL_TIMER0_8822B 0x7 -+#define BIT_TSFT_SEL_TIMER0_8822B(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER0_8822B) \ -+ << BIT_SHIFT_TSFT_SEL_TIMER0_8822B) -+#define BITS_TSFT_SEL_TIMER0_8822B \ -+ (BIT_MASK_TSFT_SEL_TIMER0_8822B << BIT_SHIFT_TSFT_SEL_TIMER0_8822B) -+#define BIT_CLEAR_TSFT_SEL_TIMER0_8822B(x) ((x) & (~BITS_TSFT_SEL_TIMER0_8822B)) -+#define BIT_GET_TSFT_SEL_TIMER0_8822B(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER0_8822B) & \ -+ BIT_MASK_TSFT_SEL_TIMER0_8822B) -+#define BIT_SET_TSFT_SEL_TIMER0_8822B(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER0_8822B(x) | BIT_TSFT_SEL_TIMER0_8822B(v)) -+ -+/* 2 REG_NOA_UNIT_SEL_8822B */ -+ -+#define BIT_SHIFT_NOA_UNIT2_SEL_8822B 8 -+#define BIT_MASK_NOA_UNIT2_SEL_8822B 0x7 -+#define BIT_NOA_UNIT2_SEL_8822B(x) \ -+ (((x) & BIT_MASK_NOA_UNIT2_SEL_8822B) << BIT_SHIFT_NOA_UNIT2_SEL_8822B) -+#define BITS_NOA_UNIT2_SEL_8822B \ -+ (BIT_MASK_NOA_UNIT2_SEL_8822B << BIT_SHIFT_NOA_UNIT2_SEL_8822B) -+#define BIT_CLEAR_NOA_UNIT2_SEL_8822B(x) ((x) & (~BITS_NOA_UNIT2_SEL_8822B)) -+#define BIT_GET_NOA_UNIT2_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT2_SEL_8822B) & BIT_MASK_NOA_UNIT2_SEL_8822B) -+#define BIT_SET_NOA_UNIT2_SEL_8822B(x, v) \ -+ (BIT_CLEAR_NOA_UNIT2_SEL_8822B(x) | BIT_NOA_UNIT2_SEL_8822B(v)) -+ -+#define BIT_SHIFT_NOA_UNIT1_SEL_8822B 4 -+#define BIT_MASK_NOA_UNIT1_SEL_8822B 0x7 -+#define BIT_NOA_UNIT1_SEL_8822B(x) \ -+ (((x) & BIT_MASK_NOA_UNIT1_SEL_8822B) << BIT_SHIFT_NOA_UNIT1_SEL_8822B) -+#define BITS_NOA_UNIT1_SEL_8822B \ -+ (BIT_MASK_NOA_UNIT1_SEL_8822B << BIT_SHIFT_NOA_UNIT1_SEL_8822B) -+#define BIT_CLEAR_NOA_UNIT1_SEL_8822B(x) ((x) & (~BITS_NOA_UNIT1_SEL_8822B)) -+#define BIT_GET_NOA_UNIT1_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT1_SEL_8822B) & BIT_MASK_NOA_UNIT1_SEL_8822B) -+#define BIT_SET_NOA_UNIT1_SEL_8822B(x, v) \ -+ (BIT_CLEAR_NOA_UNIT1_SEL_8822B(x) | BIT_NOA_UNIT1_SEL_8822B(v)) -+ -+#define BIT_SHIFT_NOA_UNIT0_SEL_8822B 0 -+#define BIT_MASK_NOA_UNIT0_SEL_8822B 0x7 -+#define BIT_NOA_UNIT0_SEL_8822B(x) \ -+ (((x) & BIT_MASK_NOA_UNIT0_SEL_8822B) << BIT_SHIFT_NOA_UNIT0_SEL_8822B) -+#define BITS_NOA_UNIT0_SEL_8822B \ -+ (BIT_MASK_NOA_UNIT0_SEL_8822B << BIT_SHIFT_NOA_UNIT0_SEL_8822B) -+#define BIT_CLEAR_NOA_UNIT0_SEL_8822B(x) ((x) & (~BITS_NOA_UNIT0_SEL_8822B)) -+#define BIT_GET_NOA_UNIT0_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT0_SEL_8822B) & BIT_MASK_NOA_UNIT0_SEL_8822B) -+#define BIT_SET_NOA_UNIT0_SEL_8822B(x, v) \ -+ (BIT_CLEAR_NOA_UNIT0_SEL_8822B(x) | BIT_NOA_UNIT0_SEL_8822B(v)) -+ -+/* 2 REG_P2POFF_DIS_TXTIME_8822B */ -+ -+#define BIT_SHIFT_P2POFF_DIS_TXTIME_8822B 0 -+#define BIT_MASK_P2POFF_DIS_TXTIME_8822B 0xff -+#define BIT_P2POFF_DIS_TXTIME_8822B(x) \ -+ (((x) & BIT_MASK_P2POFF_DIS_TXTIME_8822B) \ -+ << BIT_SHIFT_P2POFF_DIS_TXTIME_8822B) -+#define BITS_P2POFF_DIS_TXTIME_8822B \ -+ (BIT_MASK_P2POFF_DIS_TXTIME_8822B << BIT_SHIFT_P2POFF_DIS_TXTIME_8822B) -+#define BIT_CLEAR_P2POFF_DIS_TXTIME_8822B(x) \ -+ ((x) & (~BITS_P2POFF_DIS_TXTIME_8822B)) -+#define BIT_GET_P2POFF_DIS_TXTIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_P2POFF_DIS_TXTIME_8822B) & \ -+ BIT_MASK_P2POFF_DIS_TXTIME_8822B) -+#define BIT_SET_P2POFF_DIS_TXTIME_8822B(x, v) \ -+ (BIT_CLEAR_P2POFF_DIS_TXTIME_8822B(x) | BIT_P2POFF_DIS_TXTIME_8822B(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE2_8822B */ -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT2_8822B 16 -+#define BIT_MASK_BCN_SPACE_CLINT2_8822B 0xfff -+#define BIT_BCN_SPACE_CLINT2_8822B(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT2_8822B) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT2_8822B) -+#define BITS_BCN_SPACE_CLINT2_8822B \ -+ (BIT_MASK_BCN_SPACE_CLINT2_8822B << BIT_SHIFT_BCN_SPACE_CLINT2_8822B) -+#define BIT_CLEAR_BCN_SPACE_CLINT2_8822B(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT2_8822B)) -+#define BIT_GET_BCN_SPACE_CLINT2_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT2_8822B) & \ -+ BIT_MASK_BCN_SPACE_CLINT2_8822B) -+#define BIT_SET_BCN_SPACE_CLINT2_8822B(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT2_8822B(x) | BIT_BCN_SPACE_CLINT2_8822B(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT1_8822B 0 -+#define BIT_MASK_BCN_SPACE_CLINT1_8822B 0xfff -+#define BIT_BCN_SPACE_CLINT1_8822B(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT1_8822B) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT1_8822B) -+#define BITS_BCN_SPACE_CLINT1_8822B \ -+ (BIT_MASK_BCN_SPACE_CLINT1_8822B << BIT_SHIFT_BCN_SPACE_CLINT1_8822B) -+#define BIT_CLEAR_BCN_SPACE_CLINT1_8822B(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT1_8822B)) -+#define BIT_GET_BCN_SPACE_CLINT1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT1_8822B) & \ -+ BIT_MASK_BCN_SPACE_CLINT1_8822B) -+#define BIT_SET_BCN_SPACE_CLINT1_8822B(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT1_8822B(x) | BIT_BCN_SPACE_CLINT1_8822B(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE3_8822B */ -+ -+#define BIT_SHIFT_SUB_BCN_SPACE_8822B 16 -+#define BIT_MASK_SUB_BCN_SPACE_8822B 0xff -+#define BIT_SUB_BCN_SPACE_8822B(x) \ -+ (((x) & BIT_MASK_SUB_BCN_SPACE_8822B) << BIT_SHIFT_SUB_BCN_SPACE_8822B) -+#define BITS_SUB_BCN_SPACE_8822B \ -+ (BIT_MASK_SUB_BCN_SPACE_8822B << BIT_SHIFT_SUB_BCN_SPACE_8822B) -+#define BIT_CLEAR_SUB_BCN_SPACE_8822B(x) ((x) & (~BITS_SUB_BCN_SPACE_8822B)) -+#define BIT_GET_SUB_BCN_SPACE_8822B(x) \ -+ (((x) >> BIT_SHIFT_SUB_BCN_SPACE_8822B) & BIT_MASK_SUB_BCN_SPACE_8822B) -+#define BIT_SET_SUB_BCN_SPACE_8822B(x, v) \ -+ (BIT_CLEAR_SUB_BCN_SPACE_8822B(x) | BIT_SUB_BCN_SPACE_8822B(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT3_8822B 0 -+#define BIT_MASK_BCN_SPACE_CLINT3_8822B 0xfff -+#define BIT_BCN_SPACE_CLINT3_8822B(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT3_8822B) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT3_8822B) -+#define BITS_BCN_SPACE_CLINT3_8822B \ -+ (BIT_MASK_BCN_SPACE_CLINT3_8822B << BIT_SHIFT_BCN_SPACE_CLINT3_8822B) -+#define BIT_CLEAR_BCN_SPACE_CLINT3_8822B(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT3_8822B)) -+#define BIT_GET_BCN_SPACE_CLINT3_8822B(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT3_8822B) & \ -+ BIT_MASK_BCN_SPACE_CLINT3_8822B) -+#define BIT_SET_BCN_SPACE_CLINT3_8822B(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT3_8822B(x) | BIT_BCN_SPACE_CLINT3_8822B(v)) -+ -+/* 2 REG_ACMHWCTRL_8822B */ -+#define BIT_BEQ_ACM_STATUS_8822B BIT(7) -+#define BIT_VIQ_ACM_STATUS_8822B BIT(6) -+#define BIT_VOQ_ACM_STATUS_8822B BIT(5) -+#define BIT_BEQ_ACM_EN_8822B BIT(3) -+#define BIT_VIQ_ACM_EN_8822B BIT(2) -+#define BIT_VOQ_ACM_EN_8822B BIT(1) -+#define BIT_ACMHWEN_8822B BIT(0) -+ -+/* 2 REG_ACMRSTCTRL_8822B */ -+#define BIT_BE_ACM_RESET_USED_TIME_8822B BIT(2) -+#define BIT_VI_ACM_RESET_USED_TIME_8822B BIT(1) -+#define BIT_VO_ACM_RESET_USED_TIME_8822B BIT(0) -+ -+/* 2 REG_ACMAVG_8822B */ -+ -+#define BIT_SHIFT_AVGPERIOD_8822B 0 -+#define BIT_MASK_AVGPERIOD_8822B 0xffff -+#define BIT_AVGPERIOD_8822B(x) \ -+ (((x) & BIT_MASK_AVGPERIOD_8822B) << BIT_SHIFT_AVGPERIOD_8822B) -+#define BITS_AVGPERIOD_8822B \ -+ (BIT_MASK_AVGPERIOD_8822B << BIT_SHIFT_AVGPERIOD_8822B) -+#define BIT_CLEAR_AVGPERIOD_8822B(x) ((x) & (~BITS_AVGPERIOD_8822B)) -+#define BIT_GET_AVGPERIOD_8822B(x) \ -+ (((x) >> BIT_SHIFT_AVGPERIOD_8822B) & BIT_MASK_AVGPERIOD_8822B) -+#define BIT_SET_AVGPERIOD_8822B(x, v) \ -+ (BIT_CLEAR_AVGPERIOD_8822B(x) | BIT_AVGPERIOD_8822B(v)) -+ -+/* 2 REG_VO_ADMTIME_8822B */ -+ -+#define BIT_SHIFT_VO_ADMITTED_TIME_8822B 0 -+#define BIT_MASK_VO_ADMITTED_TIME_8822B 0xffff -+#define BIT_VO_ADMITTED_TIME_8822B(x) \ -+ (((x) & BIT_MASK_VO_ADMITTED_TIME_8822B) \ -+ << BIT_SHIFT_VO_ADMITTED_TIME_8822B) -+#define BITS_VO_ADMITTED_TIME_8822B \ -+ (BIT_MASK_VO_ADMITTED_TIME_8822B << BIT_SHIFT_VO_ADMITTED_TIME_8822B) -+#define BIT_CLEAR_VO_ADMITTED_TIME_8822B(x) \ -+ ((x) & (~BITS_VO_ADMITTED_TIME_8822B)) -+#define BIT_GET_VO_ADMITTED_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_VO_ADMITTED_TIME_8822B) & \ -+ BIT_MASK_VO_ADMITTED_TIME_8822B) -+#define BIT_SET_VO_ADMITTED_TIME_8822B(x, v) \ -+ (BIT_CLEAR_VO_ADMITTED_TIME_8822B(x) | BIT_VO_ADMITTED_TIME_8822B(v)) -+ -+/* 2 REG_VI_ADMTIME_8822B */ -+ -+#define BIT_SHIFT_VI_ADMITTED_TIME_8822B 0 -+#define BIT_MASK_VI_ADMITTED_TIME_8822B 0xffff -+#define BIT_VI_ADMITTED_TIME_8822B(x) \ -+ (((x) & BIT_MASK_VI_ADMITTED_TIME_8822B) \ -+ << BIT_SHIFT_VI_ADMITTED_TIME_8822B) -+#define BITS_VI_ADMITTED_TIME_8822B \ -+ (BIT_MASK_VI_ADMITTED_TIME_8822B << BIT_SHIFT_VI_ADMITTED_TIME_8822B) -+#define BIT_CLEAR_VI_ADMITTED_TIME_8822B(x) \ -+ ((x) & (~BITS_VI_ADMITTED_TIME_8822B)) -+#define BIT_GET_VI_ADMITTED_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_VI_ADMITTED_TIME_8822B) & \ -+ BIT_MASK_VI_ADMITTED_TIME_8822B) -+#define BIT_SET_VI_ADMITTED_TIME_8822B(x, v) \ -+ (BIT_CLEAR_VI_ADMITTED_TIME_8822B(x) | BIT_VI_ADMITTED_TIME_8822B(v)) -+ -+/* 2 REG_BE_ADMTIME_8822B */ -+ -+#define BIT_SHIFT_BE_ADMITTED_TIME_8822B 0 -+#define BIT_MASK_BE_ADMITTED_TIME_8822B 0xffff -+#define BIT_BE_ADMITTED_TIME_8822B(x) \ -+ (((x) & BIT_MASK_BE_ADMITTED_TIME_8822B) \ -+ << BIT_SHIFT_BE_ADMITTED_TIME_8822B) -+#define BITS_BE_ADMITTED_TIME_8822B \ -+ (BIT_MASK_BE_ADMITTED_TIME_8822B << BIT_SHIFT_BE_ADMITTED_TIME_8822B) -+#define BIT_CLEAR_BE_ADMITTED_TIME_8822B(x) \ -+ ((x) & (~BITS_BE_ADMITTED_TIME_8822B)) -+#define BIT_GET_BE_ADMITTED_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_BE_ADMITTED_TIME_8822B) & \ -+ BIT_MASK_BE_ADMITTED_TIME_8822B) -+#define BIT_SET_BE_ADMITTED_TIME_8822B(x, v) \ -+ (BIT_CLEAR_BE_ADMITTED_TIME_8822B(x) | BIT_BE_ADMITTED_TIME_8822B(v)) -+ -+/* 2 REG_EDCA_RANDOM_GEN_8822B */ -+ -+#define BIT_SHIFT_RANDOM_GEN_8822B 0 -+#define BIT_MASK_RANDOM_GEN_8822B 0xffffff -+#define BIT_RANDOM_GEN_8822B(x) \ -+ (((x) & BIT_MASK_RANDOM_GEN_8822B) << BIT_SHIFT_RANDOM_GEN_8822B) -+#define BITS_RANDOM_GEN_8822B \ -+ (BIT_MASK_RANDOM_GEN_8822B << BIT_SHIFT_RANDOM_GEN_8822B) -+#define BIT_CLEAR_RANDOM_GEN_8822B(x) ((x) & (~BITS_RANDOM_GEN_8822B)) -+#define BIT_GET_RANDOM_GEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_RANDOM_GEN_8822B) & BIT_MASK_RANDOM_GEN_8822B) -+#define BIT_SET_RANDOM_GEN_8822B(x, v) \ -+ (BIT_CLEAR_RANDOM_GEN_8822B(x) | BIT_RANDOM_GEN_8822B(v)) -+ -+/* 2 REG_TXCMD_NOA_SEL_8822B */ -+ -+#define BIT_SHIFT_NOA_SEL_V2_8822B 4 -+#define BIT_MASK_NOA_SEL_V2_8822B 0x7 -+#define BIT_NOA_SEL_V2_8822B(x) \ -+ (((x) & BIT_MASK_NOA_SEL_V2_8822B) << BIT_SHIFT_NOA_SEL_V2_8822B) -+#define BITS_NOA_SEL_V2_8822B \ -+ (BIT_MASK_NOA_SEL_V2_8822B << BIT_SHIFT_NOA_SEL_V2_8822B) -+#define BIT_CLEAR_NOA_SEL_V2_8822B(x) ((x) & (~BITS_NOA_SEL_V2_8822B)) -+#define BIT_GET_NOA_SEL_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_NOA_SEL_V2_8822B) & BIT_MASK_NOA_SEL_V2_8822B) -+#define BIT_SET_NOA_SEL_V2_8822B(x, v) \ -+ (BIT_CLEAR_NOA_SEL_V2_8822B(x) | BIT_NOA_SEL_V2_8822B(v)) -+ -+#define BIT_SHIFT_TXCMD_SEG_SEL_8822B 0 -+#define BIT_MASK_TXCMD_SEG_SEL_8822B 0xf -+#define BIT_TXCMD_SEG_SEL_8822B(x) \ -+ (((x) & BIT_MASK_TXCMD_SEG_SEL_8822B) << BIT_SHIFT_TXCMD_SEG_SEL_8822B) -+#define BITS_TXCMD_SEG_SEL_8822B \ -+ (BIT_MASK_TXCMD_SEG_SEL_8822B << BIT_SHIFT_TXCMD_SEG_SEL_8822B) -+#define BIT_CLEAR_TXCMD_SEG_SEL_8822B(x) ((x) & (~BITS_TXCMD_SEG_SEL_8822B)) -+#define BIT_GET_TXCMD_SEG_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_SEG_SEL_8822B) & BIT_MASK_TXCMD_SEG_SEL_8822B) -+#define BIT_SET_TXCMD_SEG_SEL_8822B(x, v) \ -+ (BIT_CLEAR_TXCMD_SEG_SEL_8822B(x) | BIT_TXCMD_SEG_SEL_8822B(v)) -+ -+/* 2 REG_NOA_PARAM_8822B */ -+ -+#define BIT_SHIFT_NOA_COUNT_8822B (96 & CPU_OPT_WIDTH) -+#define BIT_MASK_NOA_COUNT_8822B 0xff -+#define BIT_NOA_COUNT_8822B(x) \ -+ (((x) & BIT_MASK_NOA_COUNT_8822B) << BIT_SHIFT_NOA_COUNT_8822B) -+#define BITS_NOA_COUNT_8822B \ -+ (BIT_MASK_NOA_COUNT_8822B << BIT_SHIFT_NOA_COUNT_8822B) -+#define BIT_CLEAR_NOA_COUNT_8822B(x) ((x) & (~BITS_NOA_COUNT_8822B)) -+#define BIT_GET_NOA_COUNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_NOA_COUNT_8822B) & BIT_MASK_NOA_COUNT_8822B) -+#define BIT_SET_NOA_COUNT_8822B(x, v) \ -+ (BIT_CLEAR_NOA_COUNT_8822B(x) | BIT_NOA_COUNT_8822B(v)) -+ -+#define BIT_SHIFT_NOA_START_TIME_8822B (64 & CPU_OPT_WIDTH) -+#define BIT_MASK_NOA_START_TIME_8822B 0xffffffffL -+#define BIT_NOA_START_TIME_8822B(x) \ -+ (((x) & BIT_MASK_NOA_START_TIME_8822B) \ -+ << BIT_SHIFT_NOA_START_TIME_8822B) -+#define BITS_NOA_START_TIME_8822B \ -+ (BIT_MASK_NOA_START_TIME_8822B << BIT_SHIFT_NOA_START_TIME_8822B) -+#define BIT_CLEAR_NOA_START_TIME_8822B(x) ((x) & (~BITS_NOA_START_TIME_8822B)) -+#define BIT_GET_NOA_START_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_NOA_START_TIME_8822B) & \ -+ BIT_MASK_NOA_START_TIME_8822B) -+#define BIT_SET_NOA_START_TIME_8822B(x, v) \ -+ (BIT_CLEAR_NOA_START_TIME_8822B(x) | BIT_NOA_START_TIME_8822B(v)) -+ -+#define BIT_SHIFT_NOA_INTERVAL_8822B (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_NOA_INTERVAL_8822B 0xffffffffL -+#define BIT_NOA_INTERVAL_8822B(x) \ -+ (((x) & BIT_MASK_NOA_INTERVAL_8822B) << BIT_SHIFT_NOA_INTERVAL_8822B) -+#define BITS_NOA_INTERVAL_8822B \ -+ (BIT_MASK_NOA_INTERVAL_8822B << BIT_SHIFT_NOA_INTERVAL_8822B) -+#define BIT_CLEAR_NOA_INTERVAL_8822B(x) ((x) & (~BITS_NOA_INTERVAL_8822B)) -+#define BIT_GET_NOA_INTERVAL_8822B(x) \ -+ (((x) >> BIT_SHIFT_NOA_INTERVAL_8822B) & BIT_MASK_NOA_INTERVAL_8822B) -+#define BIT_SET_NOA_INTERVAL_8822B(x, v) \ -+ (BIT_CLEAR_NOA_INTERVAL_8822B(x) | BIT_NOA_INTERVAL_8822B(v)) -+ -+#define BIT_SHIFT_NOA_DURATION_8822B 0 -+#define BIT_MASK_NOA_DURATION_8822B 0xffffffffL -+#define BIT_NOA_DURATION_8822B(x) \ -+ (((x) & BIT_MASK_NOA_DURATION_8822B) << BIT_SHIFT_NOA_DURATION_8822B) -+#define BITS_NOA_DURATION_8822B \ -+ (BIT_MASK_NOA_DURATION_8822B << BIT_SHIFT_NOA_DURATION_8822B) -+#define BIT_CLEAR_NOA_DURATION_8822B(x) ((x) & (~BITS_NOA_DURATION_8822B)) -+#define BIT_GET_NOA_DURATION_8822B(x) \ -+ (((x) >> BIT_SHIFT_NOA_DURATION_8822B) & BIT_MASK_NOA_DURATION_8822B) -+#define BIT_SET_NOA_DURATION_8822B(x, v) \ -+ (BIT_CLEAR_NOA_DURATION_8822B(x) | BIT_NOA_DURATION_8822B(v)) -+ -+/* 2 REG_P2P_RST_8822B */ -+#define BIT_P2P2_PWR_RST1_8822B BIT(5) -+#define BIT_P2P2_PWR_RST0_8822B BIT(4) -+#define BIT_P2P1_PWR_RST1_8822B BIT(3) -+#define BIT_P2P1_PWR_RST0_8822B BIT(2) -+#define BIT_P2P_PWR_RST1_V1_8822B BIT(1) -+#define BIT_P2P_PWR_RST0_V1_8822B BIT(0) -+ -+/* 2 REG_SCHEDULER_RST_8822B */ -+#define BIT_SYNC_CLI_ONCE_RIGHT_NOW_8822B BIT(2) -+#define BIT_SYNC_CLI_ONCE_BY_TBTT_8822B BIT(1) -+#define BIT_SCHEDULER_RST_V1_8822B BIT(0) -+ -+/* 2 REG_SCH_TXCMD_8822B */ -+ -+#define BIT_SHIFT_SCH_TXCMD_8822B 0 -+#define BIT_MASK_SCH_TXCMD_8822B 0xffffffffL -+#define BIT_SCH_TXCMD_8822B(x) \ -+ (((x) & BIT_MASK_SCH_TXCMD_8822B) << BIT_SHIFT_SCH_TXCMD_8822B) -+#define BITS_SCH_TXCMD_8822B \ -+ (BIT_MASK_SCH_TXCMD_8822B << BIT_SHIFT_SCH_TXCMD_8822B) -+#define BIT_CLEAR_SCH_TXCMD_8822B(x) ((x) & (~BITS_SCH_TXCMD_8822B)) -+#define BIT_GET_SCH_TXCMD_8822B(x) \ -+ (((x) >> BIT_SHIFT_SCH_TXCMD_8822B) & BIT_MASK_SCH_TXCMD_8822B) -+#define BIT_SET_SCH_TXCMD_8822B(x, v) \ -+ (BIT_CLEAR_SCH_TXCMD_8822B(x) | BIT_SCH_TXCMD_8822B(v)) -+ -+/* 2 REG_PAGE5_DUMMY_8822B */ -+ -+/* 2 REG_CPUMGQ_TX_TIMER_8822B */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8822B 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_V1_8822B 0xffffffffL -+#define BIT_CPUMGQ_TX_TIMER_V1_8822B(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_V1_8822B) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8822B) -+#define BITS_CPUMGQ_TX_TIMER_V1_8822B \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_V1_8822B \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8822B) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8822B(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_V1_8822B)) -+#define BIT_GET_CPUMGQ_TX_TIMER_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8822B) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_V1_8822B) -+#define BIT_SET_CPUMGQ_TX_TIMER_V1_8822B(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8822B(x) | \ -+ BIT_CPUMGQ_TX_TIMER_V1_8822B(v)) -+ -+/* 2 REG_PS_TIMER_A_8822B */ -+ -+#define BIT_SHIFT_PS_TIMER_A_V1_8822B 0 -+#define BIT_MASK_PS_TIMER_A_V1_8822B 0xffffffffL -+#define BIT_PS_TIMER_A_V1_8822B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_V1_8822B) << BIT_SHIFT_PS_TIMER_A_V1_8822B) -+#define BITS_PS_TIMER_A_V1_8822B \ -+ (BIT_MASK_PS_TIMER_A_V1_8822B << BIT_SHIFT_PS_TIMER_A_V1_8822B) -+#define BIT_CLEAR_PS_TIMER_A_V1_8822B(x) ((x) & (~BITS_PS_TIMER_A_V1_8822B)) -+#define BIT_GET_PS_TIMER_A_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_V1_8822B) & BIT_MASK_PS_TIMER_A_V1_8822B) -+#define BIT_SET_PS_TIMER_A_V1_8822B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_V1_8822B(x) | BIT_PS_TIMER_A_V1_8822B(v)) -+ -+/* 2 REG_PS_TIMER_B_8822B */ -+ -+#define BIT_SHIFT_PS_TIMER_B_V1_8822B 0 -+#define BIT_MASK_PS_TIMER_B_V1_8822B 0xffffffffL -+#define BIT_PS_TIMER_B_V1_8822B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_V1_8822B) << BIT_SHIFT_PS_TIMER_B_V1_8822B) -+#define BITS_PS_TIMER_B_V1_8822B \ -+ (BIT_MASK_PS_TIMER_B_V1_8822B << BIT_SHIFT_PS_TIMER_B_V1_8822B) -+#define BIT_CLEAR_PS_TIMER_B_V1_8822B(x) ((x) & (~BITS_PS_TIMER_B_V1_8822B)) -+#define BIT_GET_PS_TIMER_B_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_V1_8822B) & BIT_MASK_PS_TIMER_B_V1_8822B) -+#define BIT_SET_PS_TIMER_B_V1_8822B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_V1_8822B(x) | BIT_PS_TIMER_B_V1_8822B(v)) -+ -+/* 2 REG_PS_TIMER_C_8822B */ -+ -+#define BIT_SHIFT_PS_TIMER_C_V1_8822B 0 -+#define BIT_MASK_PS_TIMER_C_V1_8822B 0xffffffffL -+#define BIT_PS_TIMER_C_V1_8822B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_V1_8822B) << BIT_SHIFT_PS_TIMER_C_V1_8822B) -+#define BITS_PS_TIMER_C_V1_8822B \ -+ (BIT_MASK_PS_TIMER_C_V1_8822B << BIT_SHIFT_PS_TIMER_C_V1_8822B) -+#define BIT_CLEAR_PS_TIMER_C_V1_8822B(x) ((x) & (~BITS_PS_TIMER_C_V1_8822B)) -+#define BIT_GET_PS_TIMER_C_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_V1_8822B) & BIT_MASK_PS_TIMER_C_V1_8822B) -+#define BIT_SET_PS_TIMER_C_V1_8822B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_V1_8822B(x) | BIT_PS_TIMER_C_V1_8822B(v)) -+ -+/* 2 REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL_8822B */ -+#define BIT_CPUMGQ_TIMER_EN_8822B BIT(31) -+#define BIT_CPUMGQ_TX_EN_8822B BIT(28) -+ -+#define BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8822B 24 -+#define BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8822B 0x7 -+#define BIT_CPUMGQ_TIMER_TSF_SEL_8822B(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8822B) \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8822B) -+#define BITS_CPUMGQ_TIMER_TSF_SEL_8822B \ -+ (BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8822B \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8822B) -+#define BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_8822B(x) \ -+ ((x) & (~BITS_CPUMGQ_TIMER_TSF_SEL_8822B)) -+#define BIT_GET_CPUMGQ_TIMER_TSF_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8822B) & \ -+ BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8822B) -+#define BIT_SET_CPUMGQ_TIMER_TSF_SEL_8822B(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_8822B(x) | \ -+ BIT_CPUMGQ_TIMER_TSF_SEL_8822B(v)) -+ -+#define BIT_PS_TIMER_C_EN_8822B BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_C_TSF_SEL_8822B 16 -+#define BIT_MASK_PS_TIMER_C_TSF_SEL_8822B 0x7 -+#define BIT_PS_TIMER_C_TSF_SEL_8822B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_TSF_SEL_8822B) \ -+ << BIT_SHIFT_PS_TIMER_C_TSF_SEL_8822B) -+#define BITS_PS_TIMER_C_TSF_SEL_8822B \ -+ (BIT_MASK_PS_TIMER_C_TSF_SEL_8822B \ -+ << BIT_SHIFT_PS_TIMER_C_TSF_SEL_8822B) -+#define BIT_CLEAR_PS_TIMER_C_TSF_SEL_8822B(x) \ -+ ((x) & (~BITS_PS_TIMER_C_TSF_SEL_8822B)) -+#define BIT_GET_PS_TIMER_C_TSF_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_TSF_SEL_8822B) & \ -+ BIT_MASK_PS_TIMER_C_TSF_SEL_8822B) -+#define BIT_SET_PS_TIMER_C_TSF_SEL_8822B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_TSF_SEL_8822B(x) | \ -+ BIT_PS_TIMER_C_TSF_SEL_8822B(v)) -+ -+#define BIT_PS_TIMER_B_EN_8822B BIT(15) -+ -+#define BIT_SHIFT_PS_TIMER_B_TSF_SEL_8822B 8 -+#define BIT_MASK_PS_TIMER_B_TSF_SEL_8822B 0x7 -+#define BIT_PS_TIMER_B_TSF_SEL_8822B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_TSF_SEL_8822B) \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_8822B) -+#define BITS_PS_TIMER_B_TSF_SEL_8822B \ -+ (BIT_MASK_PS_TIMER_B_TSF_SEL_8822B \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_8822B) -+#define BIT_CLEAR_PS_TIMER_B_TSF_SEL_8822B(x) \ -+ ((x) & (~BITS_PS_TIMER_B_TSF_SEL_8822B)) -+#define BIT_GET_PS_TIMER_B_TSF_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_TSF_SEL_8822B) & \ -+ BIT_MASK_PS_TIMER_B_TSF_SEL_8822B) -+#define BIT_SET_PS_TIMER_B_TSF_SEL_8822B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_TSF_SEL_8822B(x) | \ -+ BIT_PS_TIMER_B_TSF_SEL_8822B(v)) -+ -+#define BIT_PS_TIMER_A_EN_8822B BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_A_TSF_SEL_8822B 0 -+#define BIT_MASK_PS_TIMER_A_TSF_SEL_8822B 0x7 -+#define BIT_PS_TIMER_A_TSF_SEL_8822B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_TSF_SEL_8822B) \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_8822B) -+#define BITS_PS_TIMER_A_TSF_SEL_8822B \ -+ (BIT_MASK_PS_TIMER_A_TSF_SEL_8822B \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_8822B) -+#define BIT_CLEAR_PS_TIMER_A_TSF_SEL_8822B(x) \ -+ ((x) & (~BITS_PS_TIMER_A_TSF_SEL_8822B)) -+#define BIT_GET_PS_TIMER_A_TSF_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_TSF_SEL_8822B) & \ -+ BIT_MASK_PS_TIMER_A_TSF_SEL_8822B) -+#define BIT_SET_PS_TIMER_A_TSF_SEL_8822B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_TSF_SEL_8822B(x) | \ -+ BIT_PS_TIMER_A_TSF_SEL_8822B(v)) -+ -+/* 2 REG_CPUMGQ_TX_TIMER_EARLY_8822B */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8822B 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8822B 0xff -+#define BIT_CPUMGQ_TX_TIMER_EARLY_8822B(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8822B) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8822B) -+#define BITS_CPUMGQ_TX_TIMER_EARLY_8822B \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8822B \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8822B) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_8822B(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_EARLY_8822B)) -+#define BIT_GET_CPUMGQ_TX_TIMER_EARLY_8822B(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8822B) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8822B) -+#define BIT_SET_CPUMGQ_TX_TIMER_EARLY_8822B(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_8822B(x) | \ -+ BIT_CPUMGQ_TX_TIMER_EARLY_8822B(v)) -+ -+/* 2 REG_PS_TIMER_A_EARLY_8822B */ -+ -+#define BIT_SHIFT_PS_TIMER_A_EARLY_8822B 0 -+#define BIT_MASK_PS_TIMER_A_EARLY_8822B 0xff -+#define BIT_PS_TIMER_A_EARLY_8822B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_EARLY_8822B) \ -+ << BIT_SHIFT_PS_TIMER_A_EARLY_8822B) -+#define BITS_PS_TIMER_A_EARLY_8822B \ -+ (BIT_MASK_PS_TIMER_A_EARLY_8822B << BIT_SHIFT_PS_TIMER_A_EARLY_8822B) -+#define BIT_CLEAR_PS_TIMER_A_EARLY_8822B(x) \ -+ ((x) & (~BITS_PS_TIMER_A_EARLY_8822B)) -+#define BIT_GET_PS_TIMER_A_EARLY_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_EARLY_8822B) & \ -+ BIT_MASK_PS_TIMER_A_EARLY_8822B) -+#define BIT_SET_PS_TIMER_A_EARLY_8822B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_EARLY_8822B(x) | BIT_PS_TIMER_A_EARLY_8822B(v)) -+ -+/* 2 REG_PS_TIMER_B_EARLY_8822B */ -+ -+#define BIT_SHIFT_PS_TIMER_B_EARLY_8822B 0 -+#define BIT_MASK_PS_TIMER_B_EARLY_8822B 0xff -+#define BIT_PS_TIMER_B_EARLY_8822B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_EARLY_8822B) \ -+ << BIT_SHIFT_PS_TIMER_B_EARLY_8822B) -+#define BITS_PS_TIMER_B_EARLY_8822B \ -+ (BIT_MASK_PS_TIMER_B_EARLY_8822B << BIT_SHIFT_PS_TIMER_B_EARLY_8822B) -+#define BIT_CLEAR_PS_TIMER_B_EARLY_8822B(x) \ -+ ((x) & (~BITS_PS_TIMER_B_EARLY_8822B)) -+#define BIT_GET_PS_TIMER_B_EARLY_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_EARLY_8822B) & \ -+ BIT_MASK_PS_TIMER_B_EARLY_8822B) -+#define BIT_SET_PS_TIMER_B_EARLY_8822B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_EARLY_8822B(x) | BIT_PS_TIMER_B_EARLY_8822B(v)) -+ -+/* 2 REG_PS_TIMER_C_EARLY_8822B */ -+ -+#define BIT_SHIFT_PS_TIMER_C_EARLY_8822B 0 -+#define BIT_MASK_PS_TIMER_C_EARLY_8822B 0xff -+#define BIT_PS_TIMER_C_EARLY_8822B(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_EARLY_8822B) \ -+ << BIT_SHIFT_PS_TIMER_C_EARLY_8822B) -+#define BITS_PS_TIMER_C_EARLY_8822B \ -+ (BIT_MASK_PS_TIMER_C_EARLY_8822B << BIT_SHIFT_PS_TIMER_C_EARLY_8822B) -+#define BIT_CLEAR_PS_TIMER_C_EARLY_8822B(x) \ -+ ((x) & (~BITS_PS_TIMER_C_EARLY_8822B)) -+#define BIT_GET_PS_TIMER_C_EARLY_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_EARLY_8822B) & \ -+ BIT_MASK_PS_TIMER_C_EARLY_8822B) -+#define BIT_SET_PS_TIMER_C_EARLY_8822B(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_EARLY_8822B(x) | BIT_PS_TIMER_C_EARLY_8822B(v)) -+ -+/* 2 REG_CPUMGQ_PARAMETER_8822B */ -+ -+/* 2 REG_NOT_VALID_8822B */ -+#define BIT_MAC_STOP_CPUMGQ_8822B BIT(16) -+ -+#define BIT_SHIFT_CW_8822B 8 -+#define BIT_MASK_CW_8822B 0xff -+#define BIT_CW_8822B(x) (((x) & BIT_MASK_CW_8822B) << BIT_SHIFT_CW_8822B) -+#define BITS_CW_8822B (BIT_MASK_CW_8822B << BIT_SHIFT_CW_8822B) -+#define BIT_CLEAR_CW_8822B(x) ((x) & (~BITS_CW_8822B)) -+#define BIT_GET_CW_8822B(x) (((x) >> BIT_SHIFT_CW_8822B) & BIT_MASK_CW_8822B) -+#define BIT_SET_CW_8822B(x, v) (BIT_CLEAR_CW_8822B(x) | BIT_CW_8822B(v)) -+ -+#define BIT_SHIFT_AIFS_8822B 0 -+#define BIT_MASK_AIFS_8822B 0xff -+#define BIT_AIFS_8822B(x) (((x) & BIT_MASK_AIFS_8822B) << BIT_SHIFT_AIFS_8822B) -+#define BITS_AIFS_8822B (BIT_MASK_AIFS_8822B << BIT_SHIFT_AIFS_8822B) -+#define BIT_CLEAR_AIFS_8822B(x) ((x) & (~BITS_AIFS_8822B)) -+#define BIT_GET_AIFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8822B) & BIT_MASK_AIFS_8822B) -+#define BIT_SET_AIFS_8822B(x, v) (BIT_CLEAR_AIFS_8822B(x) | BIT_AIFS_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_BWOPMODE_8822B (BW OPERATION MODE REGISTER) */ -+ -+/* 2 REG_WMAC_FWPKT_CR_8822B */ -+#define BIT_FWEN_8822B BIT(7) -+#define BIT_PHYSTS_PKT_CTRL_8822B BIT(6) -+#define BIT_APPHDR_MIDSRCH_FAIL_8822B BIT(4) -+#define BIT_FWPARSING_EN_8822B BIT(3) -+ -+#define BIT_SHIFT_APPEND_MHDR_LEN_8822B 0 -+#define BIT_MASK_APPEND_MHDR_LEN_8822B 0x7 -+#define BIT_APPEND_MHDR_LEN_8822B(x) \ -+ (((x) & BIT_MASK_APPEND_MHDR_LEN_8822B) \ -+ << BIT_SHIFT_APPEND_MHDR_LEN_8822B) -+#define BITS_APPEND_MHDR_LEN_8822B \ -+ (BIT_MASK_APPEND_MHDR_LEN_8822B << BIT_SHIFT_APPEND_MHDR_LEN_8822B) -+#define BIT_CLEAR_APPEND_MHDR_LEN_8822B(x) ((x) & (~BITS_APPEND_MHDR_LEN_8822B)) -+#define BIT_GET_APPEND_MHDR_LEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_APPEND_MHDR_LEN_8822B) & \ -+ BIT_MASK_APPEND_MHDR_LEN_8822B) -+#define BIT_SET_APPEND_MHDR_LEN_8822B(x, v) \ -+ (BIT_CLEAR_APPEND_MHDR_LEN_8822B(x) | BIT_APPEND_MHDR_LEN_8822B(v)) -+ -+/* 2 REG_WMAC_CR_8822B (WMAC CR AND APSD CONTROL REGISTER) */ -+#define BIT_IC_MACPHY_M_8822B BIT(0) -+ -+/* 2 REG_TCR_8822B (TRANSMISSION CONFIGURATION REGISTER) */ -+#define BIT_WMAC_EN_RTS_ADDR_8822B BIT(31) -+#define BIT_WMAC_DISABLE_CCK_8822B BIT(30) -+#define BIT_WMAC_RAW_LEN_8822B BIT(29) -+#define BIT_WMAC_NOTX_IN_RXNDP_8822B BIT(28) -+#define BIT_WMAC_EN_EOF_8822B BIT(27) -+#define BIT_WMAC_BF_SEL_8822B BIT(26) -+#define BIT_WMAC_ANTMODE_SEL_8822B BIT(25) -+#define BIT_WMAC_TCRPWRMGT_HWCTL_8822B BIT(24) -+#define BIT_WMAC_SMOOTH_VAL_8822B BIT(23) -+#define BIT_FETCH_MPDU_AFTER_WSEC_RDY_8822B BIT(20) -+#define BIT_WMAC_TCR_EN_20MST_8822B BIT(19) -+#define BIT_WMAC_DIS_SIGTA_8822B BIT(18) -+#define BIT_WMAC_DIS_A2B0_8822B BIT(17) -+#define BIT_WMAC_MSK_SIGBCRC_8822B BIT(16) -+#define BIT_WMAC_TCR_ERRSTEN_3_8822B BIT(15) -+#define BIT_WMAC_TCR_ERRSTEN_2_8822B BIT(14) -+#define BIT_WMAC_TCR_ERRSTEN_1_8822B BIT(13) -+#define BIT_WMAC_TCR_ERRSTEN_0_8822B BIT(12) -+#define BIT_WMAC_TCR_TXSK_PERPKT_8822B BIT(11) -+#define BIT_ICV_8822B BIT(10) -+#define BIT_CFEND_FORMAT_8822B BIT(9) -+#define BIT_CRC_8822B BIT(8) -+#define BIT_PWRBIT_OW_EN_8822B BIT(7) -+#define BIT_PWR_ST_8822B BIT(6) -+#define BIT_WMAC_TCR_UPD_TIMIE_8822B BIT(5) -+#define BIT_WMAC_TCR_UPD_HGQMD_8822B BIT(4) -+#define BIT_VHTSIGA1_TXPS_8822B BIT(3) -+#define BIT_PAD_SEL_8822B BIT(2) -+#define BIT_DIS_GCLK_8822B BIT(1) -+ -+/* 2 REG_RCR_8822B (RECEIVE CONFIGURATION REGISTER) */ -+#define BIT_APP_FCS_8822B BIT(31) -+#define BIT_APP_MIC_8822B BIT(30) -+#define BIT_APP_ICV_8822B BIT(29) -+#define BIT_APP_PHYSTS_8822B BIT(28) -+#define BIT_APP_BASSN_8822B BIT(27) -+#define BIT_VHT_DACK_8822B BIT(26) -+#define BIT_TCPOFLD_EN_8822B BIT(25) -+#define BIT_ENMBID_8822B BIT(24) -+#define BIT_LSIGEN_8822B BIT(23) -+#define BIT_MFBEN_8822B BIT(22) -+#define BIT_DISCHKPPDLLEN_8822B BIT(21) -+#define BIT_PKTCTL_DLEN_8822B BIT(20) -+#define BIT_TIM_PARSER_EN_8822B BIT(18) -+#define BIT_BC_MD_EN_8822B BIT(17) -+#define BIT_UC_MD_EN_8822B BIT(16) -+#define BIT_RXSK_PERPKT_8822B BIT(15) -+#define BIT_HTC_LOC_CTRL_8822B BIT(14) -+#define BIT_RPFM_CAM_ENABLE_8822B BIT(12) -+#define BIT_TA_BCN_8822B BIT(11) -+#define BIT_DISDECMYPKT_8822B BIT(10) -+#define BIT_AICV_8822B BIT(9) -+#define BIT_ACRC32_8822B BIT(8) -+#define BIT_CBSSID_BCN_8822B BIT(7) -+#define BIT_CBSSID_DATA_8822B BIT(6) -+#define BIT_APWRMGT_8822B BIT(5) -+#define BIT_ADD3_8822B BIT(4) -+#define BIT_AB_8822B BIT(3) -+#define BIT_AM_8822B BIT(2) -+#define BIT_APM_8822B BIT(1) -+#define BIT_AAP_8822B BIT(0) -+ -+/* 2 REG_RX_DRVINFO_SZ_8822B (RX DRIVER INFO SIZE REGISTER) */ -+#define BIT_PHYSTS_PER_PKT_MODE_8822B BIT(7) -+ -+#define BIT_SHIFT_DRVINFO_SZ_V1_8822B 0 -+#define BIT_MASK_DRVINFO_SZ_V1_8822B 0xf -+#define BIT_DRVINFO_SZ_V1_8822B(x) \ -+ (((x) & BIT_MASK_DRVINFO_SZ_V1_8822B) << BIT_SHIFT_DRVINFO_SZ_V1_8822B) -+#define BITS_DRVINFO_SZ_V1_8822B \ -+ (BIT_MASK_DRVINFO_SZ_V1_8822B << BIT_SHIFT_DRVINFO_SZ_V1_8822B) -+#define BIT_CLEAR_DRVINFO_SZ_V1_8822B(x) ((x) & (~BITS_DRVINFO_SZ_V1_8822B)) -+#define BIT_GET_DRVINFO_SZ_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_DRVINFO_SZ_V1_8822B) & BIT_MASK_DRVINFO_SZ_V1_8822B) -+#define BIT_SET_DRVINFO_SZ_V1_8822B(x, v) \ -+ (BIT_CLEAR_DRVINFO_SZ_V1_8822B(x) | BIT_DRVINFO_SZ_V1_8822B(v)) -+ -+/* 2 REG_RX_DLK_TIME_8822B (RX DEADLOCK TIME REGISTER) */ -+ -+#define BIT_SHIFT_RX_DLK_TIME_8822B 0 -+#define BIT_MASK_RX_DLK_TIME_8822B 0xff -+#define BIT_RX_DLK_TIME_8822B(x) \ -+ (((x) & BIT_MASK_RX_DLK_TIME_8822B) << BIT_SHIFT_RX_DLK_TIME_8822B) -+#define BITS_RX_DLK_TIME_8822B \ -+ (BIT_MASK_RX_DLK_TIME_8822B << BIT_SHIFT_RX_DLK_TIME_8822B) -+#define BIT_CLEAR_RX_DLK_TIME_8822B(x) ((x) & (~BITS_RX_DLK_TIME_8822B)) -+#define BIT_GET_RX_DLK_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_RX_DLK_TIME_8822B) & BIT_MASK_RX_DLK_TIME_8822B) -+#define BIT_SET_RX_DLK_TIME_8822B(x, v) \ -+ (BIT_CLEAR_RX_DLK_TIME_8822B(x) | BIT_RX_DLK_TIME_8822B(v)) -+ -+/* 2 REG_RX_PKT_LIMIT_8822B (RX PACKET LENGTH LIMIT REGISTER) */ -+ -+#define BIT_SHIFT_RXPKTLMT_8822B 0 -+#define BIT_MASK_RXPKTLMT_8822B 0x3f -+#define BIT_RXPKTLMT_8822B(x) \ -+ (((x) & BIT_MASK_RXPKTLMT_8822B) << BIT_SHIFT_RXPKTLMT_8822B) -+#define BITS_RXPKTLMT_8822B \ -+ (BIT_MASK_RXPKTLMT_8822B << BIT_SHIFT_RXPKTLMT_8822B) -+#define BIT_CLEAR_RXPKTLMT_8822B(x) ((x) & (~BITS_RXPKTLMT_8822B)) -+#define BIT_GET_RXPKTLMT_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXPKTLMT_8822B) & BIT_MASK_RXPKTLMT_8822B) -+#define BIT_SET_RXPKTLMT_8822B(x, v) \ -+ (BIT_CLEAR_RXPKTLMT_8822B(x) | BIT_RXPKTLMT_8822B(v)) -+ -+/* 2 REG_MACID_8822B (MAC ID REGISTER) */ -+ -+#define BIT_SHIFT_MACID_8822B 0 -+#define BIT_MASK_MACID_8822B 0xffffffffffffL -+#define BIT_MACID_8822B(x) \ -+ (((x) & BIT_MASK_MACID_8822B) << BIT_SHIFT_MACID_8822B) -+#define BITS_MACID_8822B (BIT_MASK_MACID_8822B << BIT_SHIFT_MACID_8822B) -+#define BIT_CLEAR_MACID_8822B(x) ((x) & (~BITS_MACID_8822B)) -+#define BIT_GET_MACID_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID_8822B) & BIT_MASK_MACID_8822B) -+#define BIT_SET_MACID_8822B(x, v) \ -+ (BIT_CLEAR_MACID_8822B(x) | BIT_MACID_8822B(v)) -+ -+/* 2 REG_BSSID_8822B (BSSID REGISTER) */ -+ -+#define BIT_SHIFT_BSSID_8822B 0 -+#define BIT_MASK_BSSID_8822B 0xffffffffffffL -+#define BIT_BSSID_8822B(x) \ -+ (((x) & BIT_MASK_BSSID_8822B) << BIT_SHIFT_BSSID_8822B) -+#define BITS_BSSID_8822B (BIT_MASK_BSSID_8822B << BIT_SHIFT_BSSID_8822B) -+#define BIT_CLEAR_BSSID_8822B(x) ((x) & (~BITS_BSSID_8822B)) -+#define BIT_GET_BSSID_8822B(x) \ -+ (((x) >> BIT_SHIFT_BSSID_8822B) & BIT_MASK_BSSID_8822B) -+#define BIT_SET_BSSID_8822B(x, v) \ -+ (BIT_CLEAR_BSSID_8822B(x) | BIT_BSSID_8822B(v)) -+ -+/* 2 REG_MAR_8822B (MULTICAST ADDRESS REGISTER) */ -+ -+#define BIT_SHIFT_MAR_8822B 0 -+#define BIT_MASK_MAR_8822B 0xffffffffffffffffL -+#define BIT_MAR_8822B(x) (((x) & BIT_MASK_MAR_8822B) << BIT_SHIFT_MAR_8822B) -+#define BITS_MAR_8822B (BIT_MASK_MAR_8822B << BIT_SHIFT_MAR_8822B) -+#define BIT_CLEAR_MAR_8822B(x) ((x) & (~BITS_MAR_8822B)) -+#define BIT_GET_MAR_8822B(x) (((x) >> BIT_SHIFT_MAR_8822B) & BIT_MASK_MAR_8822B) -+#define BIT_SET_MAR_8822B(x, v) (BIT_CLEAR_MAR_8822B(x) | BIT_MAR_8822B(v)) -+ -+/* 2 REG_MBIDCAMCFG_1_8822B (MBSSID CAM CONFIGURATION REGISTER) */ -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_L_8822B 0 -+#define BIT_MASK_MBIDCAM_RWDATA_L_8822B 0xffffffffL -+#define BIT_MBIDCAM_RWDATA_L_8822B(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_L_8822B) \ -+ << BIT_SHIFT_MBIDCAM_RWDATA_L_8822B) -+#define BITS_MBIDCAM_RWDATA_L_8822B \ -+ (BIT_MASK_MBIDCAM_RWDATA_L_8822B << BIT_SHIFT_MBIDCAM_RWDATA_L_8822B) -+#define BIT_CLEAR_MBIDCAM_RWDATA_L_8822B(x) \ -+ ((x) & (~BITS_MBIDCAM_RWDATA_L_8822B)) -+#define BIT_GET_MBIDCAM_RWDATA_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_L_8822B) & \ -+ BIT_MASK_MBIDCAM_RWDATA_L_8822B) -+#define BIT_SET_MBIDCAM_RWDATA_L_8822B(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_L_8822B(x) | BIT_MBIDCAM_RWDATA_L_8822B(v)) -+ -+/* 2 REG_MBIDCAMCFG_2_8822B (MBSSID CAM CONFIGURATION REGISTER) */ -+#define BIT_MBIDCAM_POLL_8822B BIT(31) -+#define BIT_MBIDCAM_WT_EN_8822B BIT(30) -+ -+#define BIT_SHIFT_MBIDCAM_ADDR_8822B 24 -+#define BIT_MASK_MBIDCAM_ADDR_8822B 0x1f -+#define BIT_MBIDCAM_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_MBIDCAM_ADDR_8822B) << BIT_SHIFT_MBIDCAM_ADDR_8822B) -+#define BITS_MBIDCAM_ADDR_8822B \ -+ (BIT_MASK_MBIDCAM_ADDR_8822B << BIT_SHIFT_MBIDCAM_ADDR_8822B) -+#define BIT_CLEAR_MBIDCAM_ADDR_8822B(x) ((x) & (~BITS_MBIDCAM_ADDR_8822B)) -+#define BIT_GET_MBIDCAM_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_ADDR_8822B) & BIT_MASK_MBIDCAM_ADDR_8822B) -+#define BIT_SET_MBIDCAM_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_MBIDCAM_ADDR_8822B(x) | BIT_MBIDCAM_ADDR_8822B(v)) -+ -+#define BIT_MBIDCAM_VALID_8822B BIT(23) -+#define BIT_LSIC_TXOP_EN_8822B BIT(17) -+#define BIT_CTS_EN_8822B BIT(16) -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_H_8822B 0 -+#define BIT_MASK_MBIDCAM_RWDATA_H_8822B 0xffff -+#define BIT_MBIDCAM_RWDATA_H_8822B(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_H_8822B) \ -+ << BIT_SHIFT_MBIDCAM_RWDATA_H_8822B) -+#define BITS_MBIDCAM_RWDATA_H_8822B \ -+ (BIT_MASK_MBIDCAM_RWDATA_H_8822B << BIT_SHIFT_MBIDCAM_RWDATA_H_8822B) -+#define BIT_CLEAR_MBIDCAM_RWDATA_H_8822B(x) \ -+ ((x) & (~BITS_MBIDCAM_RWDATA_H_8822B)) -+#define BIT_GET_MBIDCAM_RWDATA_H_8822B(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_H_8822B) & \ -+ BIT_MASK_MBIDCAM_RWDATA_H_8822B) -+#define BIT_SET_MBIDCAM_RWDATA_H_8822B(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_H_8822B(x) | BIT_MBIDCAM_RWDATA_H_8822B(v)) -+ -+/* 2 REG_ZLD_NUM_8822B */ -+ -+#define BIT_SHIFT_ZLD_NUM_8822B 0 -+#define BIT_MASK_ZLD_NUM_8822B 0xff -+#define BIT_ZLD_NUM_8822B(x) \ -+ (((x) & BIT_MASK_ZLD_NUM_8822B) << BIT_SHIFT_ZLD_NUM_8822B) -+#define BITS_ZLD_NUM_8822B (BIT_MASK_ZLD_NUM_8822B << BIT_SHIFT_ZLD_NUM_8822B) -+#define BIT_CLEAR_ZLD_NUM_8822B(x) ((x) & (~BITS_ZLD_NUM_8822B)) -+#define BIT_GET_ZLD_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_ZLD_NUM_8822B) & BIT_MASK_ZLD_NUM_8822B) -+#define BIT_SET_ZLD_NUM_8822B(x, v) \ -+ (BIT_CLEAR_ZLD_NUM_8822B(x) | BIT_ZLD_NUM_8822B(v)) -+ -+/* 2 REG_UDF_THSD_8822B */ -+ -+#define BIT_SHIFT_UDF_THSD_8822B 0 -+#define BIT_MASK_UDF_THSD_8822B 0xff -+#define BIT_UDF_THSD_8822B(x) \ -+ (((x) & BIT_MASK_UDF_THSD_8822B) << BIT_SHIFT_UDF_THSD_8822B) -+#define BITS_UDF_THSD_8822B \ -+ (BIT_MASK_UDF_THSD_8822B << BIT_SHIFT_UDF_THSD_8822B) -+#define BIT_CLEAR_UDF_THSD_8822B(x) ((x) & (~BITS_UDF_THSD_8822B)) -+#define BIT_GET_UDF_THSD_8822B(x) \ -+ (((x) >> BIT_SHIFT_UDF_THSD_8822B) & BIT_MASK_UDF_THSD_8822B) -+#define BIT_SET_UDF_THSD_8822B(x, v) \ -+ (BIT_CLEAR_UDF_THSD_8822B(x) | BIT_UDF_THSD_8822B(v)) -+ -+/* 2 REG_WMAC_TCR_TSFT_OFS_8822B */ -+ -+#define BIT_SHIFT_WMAC_TCR_TSFT_OFS_8822B 0 -+#define BIT_MASK_WMAC_TCR_TSFT_OFS_8822B 0xffff -+#define BIT_WMAC_TCR_TSFT_OFS_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_TCR_TSFT_OFS_8822B) \ -+ << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8822B) -+#define BITS_WMAC_TCR_TSFT_OFS_8822B \ -+ (BIT_MASK_WMAC_TCR_TSFT_OFS_8822B << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8822B) -+#define BIT_CLEAR_WMAC_TCR_TSFT_OFS_8822B(x) \ -+ ((x) & (~BITS_WMAC_TCR_TSFT_OFS_8822B)) -+#define BIT_GET_WMAC_TCR_TSFT_OFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TCR_TSFT_OFS_8822B) & \ -+ BIT_MASK_WMAC_TCR_TSFT_OFS_8822B) -+#define BIT_SET_WMAC_TCR_TSFT_OFS_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_TCR_TSFT_OFS_8822B(x) | BIT_WMAC_TCR_TSFT_OFS_8822B(v)) -+ -+/* 2 REG_MCU_TEST_2_V1_8822B */ -+ -+#define BIT_SHIFT_MCU_RSVD_2_V1_8822B 0 -+#define BIT_MASK_MCU_RSVD_2_V1_8822B 0xffff -+#define BIT_MCU_RSVD_2_V1_8822B(x) \ -+ (((x) & BIT_MASK_MCU_RSVD_2_V1_8822B) << BIT_SHIFT_MCU_RSVD_2_V1_8822B) -+#define BITS_MCU_RSVD_2_V1_8822B \ -+ (BIT_MASK_MCU_RSVD_2_V1_8822B << BIT_SHIFT_MCU_RSVD_2_V1_8822B) -+#define BIT_CLEAR_MCU_RSVD_2_V1_8822B(x) ((x) & (~BITS_MCU_RSVD_2_V1_8822B)) -+#define BIT_GET_MCU_RSVD_2_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_MCU_RSVD_2_V1_8822B) & BIT_MASK_MCU_RSVD_2_V1_8822B) -+#define BIT_SET_MCU_RSVD_2_V1_8822B(x, v) \ -+ (BIT_CLEAR_MCU_RSVD_2_V1_8822B(x) | BIT_MCU_RSVD_2_V1_8822B(v)) -+ -+/* 2 REG_WMAC_TXTIMEOUT_8822B */ -+ -+#define BIT_SHIFT_WMAC_TXTIMEOUT_8822B 0 -+#define BIT_MASK_WMAC_TXTIMEOUT_8822B 0xff -+#define BIT_WMAC_TXTIMEOUT_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_TXTIMEOUT_8822B) \ -+ << BIT_SHIFT_WMAC_TXTIMEOUT_8822B) -+#define BITS_WMAC_TXTIMEOUT_8822B \ -+ (BIT_MASK_WMAC_TXTIMEOUT_8822B << BIT_SHIFT_WMAC_TXTIMEOUT_8822B) -+#define BIT_CLEAR_WMAC_TXTIMEOUT_8822B(x) ((x) & (~BITS_WMAC_TXTIMEOUT_8822B)) -+#define BIT_GET_WMAC_TXTIMEOUT_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXTIMEOUT_8822B) & \ -+ BIT_MASK_WMAC_TXTIMEOUT_8822B) -+#define BIT_SET_WMAC_TXTIMEOUT_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_TXTIMEOUT_8822B(x) | BIT_WMAC_TXTIMEOUT_8822B(v)) -+ -+/* 2 REG_STMP_THSD_8822B */ -+ -+#define BIT_SHIFT_STMP_THSD_8822B 0 -+#define BIT_MASK_STMP_THSD_8822B 0xff -+#define BIT_STMP_THSD_8822B(x) \ -+ (((x) & BIT_MASK_STMP_THSD_8822B) << BIT_SHIFT_STMP_THSD_8822B) -+#define BITS_STMP_THSD_8822B \ -+ (BIT_MASK_STMP_THSD_8822B << BIT_SHIFT_STMP_THSD_8822B) -+#define BIT_CLEAR_STMP_THSD_8822B(x) ((x) & (~BITS_STMP_THSD_8822B)) -+#define BIT_GET_STMP_THSD_8822B(x) \ -+ (((x) >> BIT_SHIFT_STMP_THSD_8822B) & BIT_MASK_STMP_THSD_8822B) -+#define BIT_SET_STMP_THSD_8822B(x, v) \ -+ (BIT_CLEAR_STMP_THSD_8822B(x) | BIT_STMP_THSD_8822B(v)) -+ -+/* 2 REG_MAC_SPEC_SIFS_8822B (SPECIFICATION SIFS REGISTER) */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_8822B 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_8822B 0xff -+#define BIT_SPEC_SIFS_OFDM_8822B(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_8822B) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_8822B) -+#define BITS_SPEC_SIFS_OFDM_8822B \ -+ (BIT_MASK_SPEC_SIFS_OFDM_8822B << BIT_SHIFT_SPEC_SIFS_OFDM_8822B) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_8822B(x) ((x) & (~BITS_SPEC_SIFS_OFDM_8822B)) -+#define BIT_GET_SPEC_SIFS_OFDM_8822B(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_8822B) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_8822B) -+#define BIT_SET_SPEC_SIFS_OFDM_8822B(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_8822B(x) | BIT_SPEC_SIFS_OFDM_8822B(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_8822B 0 -+#define BIT_MASK_SPEC_SIFS_CCK_8822B 0xff -+#define BIT_SPEC_SIFS_CCK_8822B(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_8822B) << BIT_SHIFT_SPEC_SIFS_CCK_8822B) -+#define BITS_SPEC_SIFS_CCK_8822B \ -+ (BIT_MASK_SPEC_SIFS_CCK_8822B << BIT_SHIFT_SPEC_SIFS_CCK_8822B) -+#define BIT_CLEAR_SPEC_SIFS_CCK_8822B(x) ((x) & (~BITS_SPEC_SIFS_CCK_8822B)) -+#define BIT_GET_SPEC_SIFS_CCK_8822B(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_8822B) & BIT_MASK_SPEC_SIFS_CCK_8822B) -+#define BIT_SET_SPEC_SIFS_CCK_8822B(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_8822B(x) | BIT_SPEC_SIFS_CCK_8822B(v)) -+ -+/* 2 REG_USTIME_EDCA_8822B (US TIME TUNING FOR EDCA REGISTER) */ -+ -+#define BIT_SHIFT_USTIME_EDCA_V1_8822B 0 -+#define BIT_MASK_USTIME_EDCA_V1_8822B 0x1ff -+#define BIT_USTIME_EDCA_V1_8822B(x) \ -+ (((x) & BIT_MASK_USTIME_EDCA_V1_8822B) \ -+ << BIT_SHIFT_USTIME_EDCA_V1_8822B) -+#define BITS_USTIME_EDCA_V1_8822B \ -+ (BIT_MASK_USTIME_EDCA_V1_8822B << BIT_SHIFT_USTIME_EDCA_V1_8822B) -+#define BIT_CLEAR_USTIME_EDCA_V1_8822B(x) ((x) & (~BITS_USTIME_EDCA_V1_8822B)) -+#define BIT_GET_USTIME_EDCA_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_USTIME_EDCA_V1_8822B) & \ -+ BIT_MASK_USTIME_EDCA_V1_8822B) -+#define BIT_SET_USTIME_EDCA_V1_8822B(x, v) \ -+ (BIT_CLEAR_USTIME_EDCA_V1_8822B(x) | BIT_USTIME_EDCA_V1_8822B(v)) -+ -+/* 2 REG_RESP_SIFS_OFDM_8822B (RESPONSE SIFS FOR OFDM REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_OFDM_8822B 8 -+#define BIT_MASK_SIFS_R2T_OFDM_8822B 0xff -+#define BIT_SIFS_R2T_OFDM_8822B(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_OFDM_8822B) << BIT_SHIFT_SIFS_R2T_OFDM_8822B) -+#define BITS_SIFS_R2T_OFDM_8822B \ -+ (BIT_MASK_SIFS_R2T_OFDM_8822B << BIT_SHIFT_SIFS_R2T_OFDM_8822B) -+#define BIT_CLEAR_SIFS_R2T_OFDM_8822B(x) ((x) & (~BITS_SIFS_R2T_OFDM_8822B)) -+#define BIT_GET_SIFS_R2T_OFDM_8822B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_OFDM_8822B) & BIT_MASK_SIFS_R2T_OFDM_8822B) -+#define BIT_SET_SIFS_R2T_OFDM_8822B(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_OFDM_8822B(x) | BIT_SIFS_R2T_OFDM_8822B(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_OFDM_8822B 0 -+#define BIT_MASK_SIFS_T2T_OFDM_8822B 0xff -+#define BIT_SIFS_T2T_OFDM_8822B(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_OFDM_8822B) << BIT_SHIFT_SIFS_T2T_OFDM_8822B) -+#define BITS_SIFS_T2T_OFDM_8822B \ -+ (BIT_MASK_SIFS_T2T_OFDM_8822B << BIT_SHIFT_SIFS_T2T_OFDM_8822B) -+#define BIT_CLEAR_SIFS_T2T_OFDM_8822B(x) ((x) & (~BITS_SIFS_T2T_OFDM_8822B)) -+#define BIT_GET_SIFS_T2T_OFDM_8822B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_OFDM_8822B) & BIT_MASK_SIFS_T2T_OFDM_8822B) -+#define BIT_SET_SIFS_T2T_OFDM_8822B(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_OFDM_8822B(x) | BIT_SIFS_T2T_OFDM_8822B(v)) -+ -+/* 2 REG_RESP_SIFS_CCK_8822B (RESPONSE SIFS FOR CCK REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_CCK_8822B 8 -+#define BIT_MASK_SIFS_R2T_CCK_8822B 0xff -+#define BIT_SIFS_R2T_CCK_8822B(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_CCK_8822B) << BIT_SHIFT_SIFS_R2T_CCK_8822B) -+#define BITS_SIFS_R2T_CCK_8822B \ -+ (BIT_MASK_SIFS_R2T_CCK_8822B << BIT_SHIFT_SIFS_R2T_CCK_8822B) -+#define BIT_CLEAR_SIFS_R2T_CCK_8822B(x) ((x) & (~BITS_SIFS_R2T_CCK_8822B)) -+#define BIT_GET_SIFS_R2T_CCK_8822B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_CCK_8822B) & BIT_MASK_SIFS_R2T_CCK_8822B) -+#define BIT_SET_SIFS_R2T_CCK_8822B(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_CCK_8822B(x) | BIT_SIFS_R2T_CCK_8822B(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_CCK_8822B 0 -+#define BIT_MASK_SIFS_T2T_CCK_8822B 0xff -+#define BIT_SIFS_T2T_CCK_8822B(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_CCK_8822B) << BIT_SHIFT_SIFS_T2T_CCK_8822B) -+#define BITS_SIFS_T2T_CCK_8822B \ -+ (BIT_MASK_SIFS_T2T_CCK_8822B << BIT_SHIFT_SIFS_T2T_CCK_8822B) -+#define BIT_CLEAR_SIFS_T2T_CCK_8822B(x) ((x) & (~BITS_SIFS_T2T_CCK_8822B)) -+#define BIT_GET_SIFS_T2T_CCK_8822B(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_CCK_8822B) & BIT_MASK_SIFS_T2T_CCK_8822B) -+#define BIT_SET_SIFS_T2T_CCK_8822B(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_CCK_8822B(x) | BIT_SIFS_T2T_CCK_8822B(v)) -+ -+/* 2 REG_EIFS_8822B (EIFS REGISTER) */ -+ -+#define BIT_SHIFT_EIFS_8822B 0 -+#define BIT_MASK_EIFS_8822B 0xffff -+#define BIT_EIFS_8822B(x) (((x) & BIT_MASK_EIFS_8822B) << BIT_SHIFT_EIFS_8822B) -+#define BITS_EIFS_8822B (BIT_MASK_EIFS_8822B << BIT_SHIFT_EIFS_8822B) -+#define BIT_CLEAR_EIFS_8822B(x) ((x) & (~BITS_EIFS_8822B)) -+#define BIT_GET_EIFS_8822B(x) \ -+ (((x) >> BIT_SHIFT_EIFS_8822B) & BIT_MASK_EIFS_8822B) -+#define BIT_SET_EIFS_8822B(x, v) (BIT_CLEAR_EIFS_8822B(x) | BIT_EIFS_8822B(v)) -+ -+/* 2 REG_CTS2TO_8822B (CTS2 TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_CTS2TO_8822B 0 -+#define BIT_MASK_CTS2TO_8822B 0xff -+#define BIT_CTS2TO_8822B(x) \ -+ (((x) & BIT_MASK_CTS2TO_8822B) << BIT_SHIFT_CTS2TO_8822B) -+#define BITS_CTS2TO_8822B (BIT_MASK_CTS2TO_8822B << BIT_SHIFT_CTS2TO_8822B) -+#define BIT_CLEAR_CTS2TO_8822B(x) ((x) & (~BITS_CTS2TO_8822B)) -+#define BIT_GET_CTS2TO_8822B(x) \ -+ (((x) >> BIT_SHIFT_CTS2TO_8822B) & BIT_MASK_CTS2TO_8822B) -+#define BIT_SET_CTS2TO_8822B(x, v) \ -+ (BIT_CLEAR_CTS2TO_8822B(x) | BIT_CTS2TO_8822B(v)) -+ -+/* 2 REG_ACKTO_8822B (ACK TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_ACKTO_8822B 0 -+#define BIT_MASK_ACKTO_8822B 0xff -+#define BIT_ACKTO_8822B(x) \ -+ (((x) & BIT_MASK_ACKTO_8822B) << BIT_SHIFT_ACKTO_8822B) -+#define BITS_ACKTO_8822B (BIT_MASK_ACKTO_8822B << BIT_SHIFT_ACKTO_8822B) -+#define BIT_CLEAR_ACKTO_8822B(x) ((x) & (~BITS_ACKTO_8822B)) -+#define BIT_GET_ACKTO_8822B(x) \ -+ (((x) >> BIT_SHIFT_ACKTO_8822B) & BIT_MASK_ACKTO_8822B) -+#define BIT_SET_ACKTO_8822B(x, v) \ -+ (BIT_CLEAR_ACKTO_8822B(x) | BIT_ACKTO_8822B(v)) -+ -+/* 2 REG_NAV_CTRL_8822B (NAV CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_NAV_UPPER_8822B 16 -+#define BIT_MASK_NAV_UPPER_8822B 0xff -+#define BIT_NAV_UPPER_8822B(x) \ -+ (((x) & BIT_MASK_NAV_UPPER_8822B) << BIT_SHIFT_NAV_UPPER_8822B) -+#define BITS_NAV_UPPER_8822B \ -+ (BIT_MASK_NAV_UPPER_8822B << BIT_SHIFT_NAV_UPPER_8822B) -+#define BIT_CLEAR_NAV_UPPER_8822B(x) ((x) & (~BITS_NAV_UPPER_8822B)) -+#define BIT_GET_NAV_UPPER_8822B(x) \ -+ (((x) >> BIT_SHIFT_NAV_UPPER_8822B) & BIT_MASK_NAV_UPPER_8822B) -+#define BIT_SET_NAV_UPPER_8822B(x, v) \ -+ (BIT_CLEAR_NAV_UPPER_8822B(x) | BIT_NAV_UPPER_8822B(v)) -+ -+#define BIT_SHIFT_RXMYRTS_NAV_8822B 8 -+#define BIT_MASK_RXMYRTS_NAV_8822B 0xf -+#define BIT_RXMYRTS_NAV_8822B(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_8822B) << BIT_SHIFT_RXMYRTS_NAV_8822B) -+#define BITS_RXMYRTS_NAV_8822B \ -+ (BIT_MASK_RXMYRTS_NAV_8822B << BIT_SHIFT_RXMYRTS_NAV_8822B) -+#define BIT_CLEAR_RXMYRTS_NAV_8822B(x) ((x) & (~BITS_RXMYRTS_NAV_8822B)) -+#define BIT_GET_RXMYRTS_NAV_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_8822B) & BIT_MASK_RXMYRTS_NAV_8822B) -+#define BIT_SET_RXMYRTS_NAV_8822B(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_8822B(x) | BIT_RXMYRTS_NAV_8822B(v)) -+ -+#define BIT_SHIFT_RTSRST_8822B 0 -+#define BIT_MASK_RTSRST_8822B 0xff -+#define BIT_RTSRST_8822B(x) \ -+ (((x) & BIT_MASK_RTSRST_8822B) << BIT_SHIFT_RTSRST_8822B) -+#define BITS_RTSRST_8822B (BIT_MASK_RTSRST_8822B << BIT_SHIFT_RTSRST_8822B) -+#define BIT_CLEAR_RTSRST_8822B(x) ((x) & (~BITS_RTSRST_8822B)) -+#define BIT_GET_RTSRST_8822B(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_8822B) & BIT_MASK_RTSRST_8822B) -+#define BIT_SET_RTSRST_8822B(x, v) \ -+ (BIT_CLEAR_RTSRST_8822B(x) | BIT_RTSRST_8822B(v)) -+ -+/* 2 REG_BACAMCMD_8822B (BLOCK ACK CAM COMMAND REGISTER) */ -+#define BIT_BACAM_POLL_8822B BIT(31) -+#define BIT_BACAM_RST_8822B BIT(17) -+#define BIT_BACAM_RW_8822B BIT(16) -+ -+#define BIT_SHIFT_TXSBM_8822B 14 -+#define BIT_MASK_TXSBM_8822B 0x3 -+#define BIT_TXSBM_8822B(x) \ -+ (((x) & BIT_MASK_TXSBM_8822B) << BIT_SHIFT_TXSBM_8822B) -+#define BITS_TXSBM_8822B (BIT_MASK_TXSBM_8822B << BIT_SHIFT_TXSBM_8822B) -+#define BIT_CLEAR_TXSBM_8822B(x) ((x) & (~BITS_TXSBM_8822B)) -+#define BIT_GET_TXSBM_8822B(x) \ -+ (((x) >> BIT_SHIFT_TXSBM_8822B) & BIT_MASK_TXSBM_8822B) -+#define BIT_SET_TXSBM_8822B(x, v) \ -+ (BIT_CLEAR_TXSBM_8822B(x) | BIT_TXSBM_8822B(v)) -+ -+#define BIT_SHIFT_BACAM_ADDR_8822B 0 -+#define BIT_MASK_BACAM_ADDR_8822B 0x3f -+#define BIT_BACAM_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_BACAM_ADDR_8822B) << BIT_SHIFT_BACAM_ADDR_8822B) -+#define BITS_BACAM_ADDR_8822B \ -+ (BIT_MASK_BACAM_ADDR_8822B << BIT_SHIFT_BACAM_ADDR_8822B) -+#define BIT_CLEAR_BACAM_ADDR_8822B(x) ((x) & (~BITS_BACAM_ADDR_8822B)) -+#define BIT_GET_BACAM_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_BACAM_ADDR_8822B) & BIT_MASK_BACAM_ADDR_8822B) -+#define BIT_SET_BACAM_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_BACAM_ADDR_8822B(x) | BIT_BACAM_ADDR_8822B(v)) -+ -+/* 2 REG_BACAMCONTENT_8822B (BLOCK ACK CAM CONTENT REGISTER) */ -+ -+#define BIT_SHIFT_BA_CONTENT_H_8822B (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_BA_CONTENT_H_8822B 0xffffffffL -+#define BIT_BA_CONTENT_H_8822B(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_H_8822B) << BIT_SHIFT_BA_CONTENT_H_8822B) -+#define BITS_BA_CONTENT_H_8822B \ -+ (BIT_MASK_BA_CONTENT_H_8822B << BIT_SHIFT_BA_CONTENT_H_8822B) -+#define BIT_CLEAR_BA_CONTENT_H_8822B(x) ((x) & (~BITS_BA_CONTENT_H_8822B)) -+#define BIT_GET_BA_CONTENT_H_8822B(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_H_8822B) & BIT_MASK_BA_CONTENT_H_8822B) -+#define BIT_SET_BA_CONTENT_H_8822B(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_H_8822B(x) | BIT_BA_CONTENT_H_8822B(v)) -+ -+#define BIT_SHIFT_BA_CONTENT_L_8822B 0 -+#define BIT_MASK_BA_CONTENT_L_8822B 0xffffffffL -+#define BIT_BA_CONTENT_L_8822B(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_L_8822B) << BIT_SHIFT_BA_CONTENT_L_8822B) -+#define BITS_BA_CONTENT_L_8822B \ -+ (BIT_MASK_BA_CONTENT_L_8822B << BIT_SHIFT_BA_CONTENT_L_8822B) -+#define BIT_CLEAR_BA_CONTENT_L_8822B(x) ((x) & (~BITS_BA_CONTENT_L_8822B)) -+#define BIT_GET_BA_CONTENT_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_L_8822B) & BIT_MASK_BA_CONTENT_L_8822B) -+#define BIT_SET_BA_CONTENT_L_8822B(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_L_8822B(x) | BIT_BA_CONTENT_L_8822B(v)) -+ -+/* 2 REG_WMAC_BITMAP_CTL_8822B */ -+#define BIT_BITMAP_VO_8822B BIT(7) -+#define BIT_BITMAP_VI_8822B BIT(6) -+#define BIT_BITMAP_BE_8822B BIT(5) -+#define BIT_BITMAP_BK_8822B BIT(4) -+ -+#define BIT_SHIFT_BITMAP_CONDITION_8822B 2 -+#define BIT_MASK_BITMAP_CONDITION_8822B 0x3 -+#define BIT_BITMAP_CONDITION_8822B(x) \ -+ (((x) & BIT_MASK_BITMAP_CONDITION_8822B) \ -+ << BIT_SHIFT_BITMAP_CONDITION_8822B) -+#define BITS_BITMAP_CONDITION_8822B \ -+ (BIT_MASK_BITMAP_CONDITION_8822B << BIT_SHIFT_BITMAP_CONDITION_8822B) -+#define BIT_CLEAR_BITMAP_CONDITION_8822B(x) \ -+ ((x) & (~BITS_BITMAP_CONDITION_8822B)) -+#define BIT_GET_BITMAP_CONDITION_8822B(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_CONDITION_8822B) & \ -+ BIT_MASK_BITMAP_CONDITION_8822B) -+#define BIT_SET_BITMAP_CONDITION_8822B(x, v) \ -+ (BIT_CLEAR_BITMAP_CONDITION_8822B(x) | BIT_BITMAP_CONDITION_8822B(v)) -+ -+#define BIT_BITMAP_SSNBK_COUNTER_CLR_8822B BIT(1) -+#define BIT_BITMAP_FORCE_8822B BIT(0) -+ -+/* 2 REG_TX_RX_8822B STATUS */ -+ -+#define BIT_SHIFT_RXPKT_TYPE_8822B 2 -+#define BIT_MASK_RXPKT_TYPE_8822B 0x3f -+#define BIT_RXPKT_TYPE_8822B(x) \ -+ (((x) & BIT_MASK_RXPKT_TYPE_8822B) << BIT_SHIFT_RXPKT_TYPE_8822B) -+#define BITS_RXPKT_TYPE_8822B \ -+ (BIT_MASK_RXPKT_TYPE_8822B << BIT_SHIFT_RXPKT_TYPE_8822B) -+#define BIT_CLEAR_RXPKT_TYPE_8822B(x) ((x) & (~BITS_RXPKT_TYPE_8822B)) -+#define BIT_GET_RXPKT_TYPE_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_TYPE_8822B) & BIT_MASK_RXPKT_TYPE_8822B) -+#define BIT_SET_RXPKT_TYPE_8822B(x, v) \ -+ (BIT_CLEAR_RXPKT_TYPE_8822B(x) | BIT_RXPKT_TYPE_8822B(v)) -+ -+#define BIT_TXACT_IND_8822B BIT(1) -+#define BIT_RXACT_IND_8822B BIT(0) -+ -+/* 2 REG_WMAC_BACAM_RPMEN_8822B */ -+ -+#define BIT_SHIFT_BITMAP_SSNBK_COUNTER_8822B 2 -+#define BIT_MASK_BITMAP_SSNBK_COUNTER_8822B 0x3f -+#define BIT_BITMAP_SSNBK_COUNTER_8822B(x) \ -+ (((x) & BIT_MASK_BITMAP_SSNBK_COUNTER_8822B) \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8822B) -+#define BITS_BITMAP_SSNBK_COUNTER_8822B \ -+ (BIT_MASK_BITMAP_SSNBK_COUNTER_8822B \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8822B) -+#define BIT_CLEAR_BITMAP_SSNBK_COUNTER_8822B(x) \ -+ ((x) & (~BITS_BITMAP_SSNBK_COUNTER_8822B)) -+#define BIT_GET_BITMAP_SSNBK_COUNTER_8822B(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_SSNBK_COUNTER_8822B) & \ -+ BIT_MASK_BITMAP_SSNBK_COUNTER_8822B) -+#define BIT_SET_BITMAP_SSNBK_COUNTER_8822B(x, v) \ -+ (BIT_CLEAR_BITMAP_SSNBK_COUNTER_8822B(x) | \ -+ BIT_BITMAP_SSNBK_COUNTER_8822B(v)) -+ -+#define BIT_BITMAP_EN_8822B BIT(1) -+#define BIT_WMAC_BACAM_RPMEN_8822B BIT(0) -+ -+/* 2 REG_LBDLY_8822B (LOOPBACK DELAY REGISTER) */ -+ -+#define BIT_SHIFT_LBDLY_8822B 0 -+#define BIT_MASK_LBDLY_8822B 0x1f -+#define BIT_LBDLY_8822B(x) \ -+ (((x) & BIT_MASK_LBDLY_8822B) << BIT_SHIFT_LBDLY_8822B) -+#define BITS_LBDLY_8822B (BIT_MASK_LBDLY_8822B << BIT_SHIFT_LBDLY_8822B) -+#define BIT_CLEAR_LBDLY_8822B(x) ((x) & (~BITS_LBDLY_8822B)) -+#define BIT_GET_LBDLY_8822B(x) \ -+ (((x) >> BIT_SHIFT_LBDLY_8822B) & BIT_MASK_LBDLY_8822B) -+#define BIT_SET_LBDLY_8822B(x, v) \ -+ (BIT_CLEAR_LBDLY_8822B(x) | BIT_LBDLY_8822B(v)) -+ -+/* 2 REG_RXERR_RPT_8822B (RX ERROR REPORT REGISTER) */ -+ -+#define BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8822B 28 -+#define BIT_MASK_RXERR_RPT_SEL_V1_3_0_8822B 0xf -+#define BIT_RXERR_RPT_SEL_V1_3_0_8822B(x) \ -+ (((x) & BIT_MASK_RXERR_RPT_SEL_V1_3_0_8822B) \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8822B) -+#define BITS_RXERR_RPT_SEL_V1_3_0_8822B \ -+ (BIT_MASK_RXERR_RPT_SEL_V1_3_0_8822B \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8822B) -+#define BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8822B(x) \ -+ ((x) & (~BITS_RXERR_RPT_SEL_V1_3_0_8822B)) -+#define BIT_GET_RXERR_RPT_SEL_V1_3_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8822B) & \ -+ BIT_MASK_RXERR_RPT_SEL_V1_3_0_8822B) -+#define BIT_SET_RXERR_RPT_SEL_V1_3_0_8822B(x, v) \ -+ (BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8822B(x) | \ -+ BIT_RXERR_RPT_SEL_V1_3_0_8822B(v)) -+ -+#define BIT_RXERR_RPT_RST_8822B BIT(27) -+#define BIT_RXERR_RPT_SEL_V1_4_8822B BIT(26) -+#define BIT_W1S_8822B BIT(23) -+#define BIT_UD_SELECT_BSSID_8822B BIT(22) -+ -+#define BIT_SHIFT_UD_SUB_TYPE_8822B 18 -+#define BIT_MASK_UD_SUB_TYPE_8822B 0xf -+#define BIT_UD_SUB_TYPE_8822B(x) \ -+ (((x) & BIT_MASK_UD_SUB_TYPE_8822B) << BIT_SHIFT_UD_SUB_TYPE_8822B) -+#define BITS_UD_SUB_TYPE_8822B \ -+ (BIT_MASK_UD_SUB_TYPE_8822B << BIT_SHIFT_UD_SUB_TYPE_8822B) -+#define BIT_CLEAR_UD_SUB_TYPE_8822B(x) ((x) & (~BITS_UD_SUB_TYPE_8822B)) -+#define BIT_GET_UD_SUB_TYPE_8822B(x) \ -+ (((x) >> BIT_SHIFT_UD_SUB_TYPE_8822B) & BIT_MASK_UD_SUB_TYPE_8822B) -+#define BIT_SET_UD_SUB_TYPE_8822B(x, v) \ -+ (BIT_CLEAR_UD_SUB_TYPE_8822B(x) | BIT_UD_SUB_TYPE_8822B(v)) -+ -+#define BIT_SHIFT_UD_TYPE_8822B 16 -+#define BIT_MASK_UD_TYPE_8822B 0x3 -+#define BIT_UD_TYPE_8822B(x) \ -+ (((x) & BIT_MASK_UD_TYPE_8822B) << BIT_SHIFT_UD_TYPE_8822B) -+#define BITS_UD_TYPE_8822B (BIT_MASK_UD_TYPE_8822B << BIT_SHIFT_UD_TYPE_8822B) -+#define BIT_CLEAR_UD_TYPE_8822B(x) ((x) & (~BITS_UD_TYPE_8822B)) -+#define BIT_GET_UD_TYPE_8822B(x) \ -+ (((x) >> BIT_SHIFT_UD_TYPE_8822B) & BIT_MASK_UD_TYPE_8822B) -+#define BIT_SET_UD_TYPE_8822B(x, v) \ -+ (BIT_CLEAR_UD_TYPE_8822B(x) | BIT_UD_TYPE_8822B(v)) -+ -+#define BIT_SHIFT_RPT_COUNTER_8822B 0 -+#define BIT_MASK_RPT_COUNTER_8822B 0xffff -+#define BIT_RPT_COUNTER_8822B(x) \ -+ (((x) & BIT_MASK_RPT_COUNTER_8822B) << BIT_SHIFT_RPT_COUNTER_8822B) -+#define BITS_RPT_COUNTER_8822B \ -+ (BIT_MASK_RPT_COUNTER_8822B << BIT_SHIFT_RPT_COUNTER_8822B) -+#define BIT_CLEAR_RPT_COUNTER_8822B(x) ((x) & (~BITS_RPT_COUNTER_8822B)) -+#define BIT_GET_RPT_COUNTER_8822B(x) \ -+ (((x) >> BIT_SHIFT_RPT_COUNTER_8822B) & BIT_MASK_RPT_COUNTER_8822B) -+#define BIT_SET_RPT_COUNTER_8822B(x, v) \ -+ (BIT_CLEAR_RPT_COUNTER_8822B(x) | BIT_RPT_COUNTER_8822B(v)) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_8822B (WMAC TX/RX PROTOCOL CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_ACKBA_TYPSEL_8822B (60 & CPU_OPT_WIDTH) -+#define BIT_MASK_ACKBA_TYPSEL_8822B 0xf -+#define BIT_ACKBA_TYPSEL_8822B(x) \ -+ (((x) & BIT_MASK_ACKBA_TYPSEL_8822B) << BIT_SHIFT_ACKBA_TYPSEL_8822B) -+#define BITS_ACKBA_TYPSEL_8822B \ -+ (BIT_MASK_ACKBA_TYPSEL_8822B << BIT_SHIFT_ACKBA_TYPSEL_8822B) -+#define BIT_CLEAR_ACKBA_TYPSEL_8822B(x) ((x) & (~BITS_ACKBA_TYPSEL_8822B)) -+#define BIT_GET_ACKBA_TYPSEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_TYPSEL_8822B) & BIT_MASK_ACKBA_TYPSEL_8822B) -+#define BIT_SET_ACKBA_TYPSEL_8822B(x, v) \ -+ (BIT_CLEAR_ACKBA_TYPSEL_8822B(x) | BIT_ACKBA_TYPSEL_8822B(v)) -+ -+#define BIT_SHIFT_ACKBA_ACKPCHK_8822B (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_ACKBA_ACKPCHK_8822B 0xf -+#define BIT_ACKBA_ACKPCHK_8822B(x) \ -+ (((x) & BIT_MASK_ACKBA_ACKPCHK_8822B) << BIT_SHIFT_ACKBA_ACKPCHK_8822B) -+#define BITS_ACKBA_ACKPCHK_8822B \ -+ (BIT_MASK_ACKBA_ACKPCHK_8822B << BIT_SHIFT_ACKBA_ACKPCHK_8822B) -+#define BIT_CLEAR_ACKBA_ACKPCHK_8822B(x) ((x) & (~BITS_ACKBA_ACKPCHK_8822B)) -+#define BIT_GET_ACKBA_ACKPCHK_8822B(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_ACKPCHK_8822B) & BIT_MASK_ACKBA_ACKPCHK_8822B) -+#define BIT_SET_ACKBA_ACKPCHK_8822B(x, v) \ -+ (BIT_CLEAR_ACKBA_ACKPCHK_8822B(x) | BIT_ACKBA_ACKPCHK_8822B(v)) -+ -+#define BIT_SHIFT_ACKBAR_TYPESEL_8822B (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_ACKBAR_TYPESEL_8822B 0xff -+#define BIT_ACKBAR_TYPESEL_8822B(x) \ -+ (((x) & BIT_MASK_ACKBAR_TYPESEL_8822B) \ -+ << BIT_SHIFT_ACKBAR_TYPESEL_8822B) -+#define BITS_ACKBAR_TYPESEL_8822B \ -+ (BIT_MASK_ACKBAR_TYPESEL_8822B << BIT_SHIFT_ACKBAR_TYPESEL_8822B) -+#define BIT_CLEAR_ACKBAR_TYPESEL_8822B(x) ((x) & (~BITS_ACKBAR_TYPESEL_8822B)) -+#define BIT_GET_ACKBAR_TYPESEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_TYPESEL_8822B) & \ -+ BIT_MASK_ACKBAR_TYPESEL_8822B) -+#define BIT_SET_ACKBAR_TYPESEL_8822B(x, v) \ -+ (BIT_CLEAR_ACKBAR_TYPESEL_8822B(x) | BIT_ACKBAR_TYPESEL_8822B(v)) -+ -+#define BIT_SHIFT_ACKBAR_ACKPCHK_8822B (44 & CPU_OPT_WIDTH) -+#define BIT_MASK_ACKBAR_ACKPCHK_8822B 0xf -+#define BIT_ACKBAR_ACKPCHK_8822B(x) \ -+ (((x) & BIT_MASK_ACKBAR_ACKPCHK_8822B) \ -+ << BIT_SHIFT_ACKBAR_ACKPCHK_8822B) -+#define BITS_ACKBAR_ACKPCHK_8822B \ -+ (BIT_MASK_ACKBAR_ACKPCHK_8822B << BIT_SHIFT_ACKBAR_ACKPCHK_8822B) -+#define BIT_CLEAR_ACKBAR_ACKPCHK_8822B(x) ((x) & (~BITS_ACKBAR_ACKPCHK_8822B)) -+#define BIT_GET_ACKBAR_ACKPCHK_8822B(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_ACKPCHK_8822B) & \ -+ BIT_MASK_ACKBAR_ACKPCHK_8822B) -+#define BIT_SET_ACKBAR_ACKPCHK_8822B(x, v) \ -+ (BIT_CLEAR_ACKBAR_ACKPCHK_8822B(x) | BIT_ACKBAR_ACKPCHK_8822B(v)) -+ -+#define BIT_RXBA_IGNOREA2_8822B BIT(42) -+#define BIT_EN_SAVE_ALL_TXOPADDR_8822B BIT(41) -+#define BIT_EN_TXCTS_TO_TXOPOWNER_INRXNAV_8822B BIT(40) -+#define BIT_DIS_TXBA_AMPDUFCSERR_8822B BIT(39) -+#define BIT_DIS_TXBA_RXBARINFULL_8822B BIT(38) -+#define BIT_DIS_TXCFE_INFULL_8822B BIT(37) -+#define BIT_DIS_TXCTS_INFULL_8822B BIT(36) -+#define BIT_EN_TXACKBA_IN_TX_RDG_8822B BIT(35) -+#define BIT_EN_TXACKBA_IN_TXOP_8822B BIT(34) -+#define BIT_EN_TXCTS_IN_RXNAV_8822B BIT(33) -+#define BIT_EN_TXCTS_INTXOP_8822B BIT(32) -+#define BIT_BLK_EDCA_BBSLP_8822B BIT(31) -+#define BIT_BLK_EDCA_BBSBY_8822B BIT(30) -+#define BIT_ACKTO_BLOCK_SCH_EN_8822B BIT(27) -+#define BIT_EIFS_BLOCK_SCH_EN_8822B BIT(26) -+#define BIT_PLCPCHK_RST_EIFS_8822B BIT(25) -+#define BIT_CCA_RST_EIFS_8822B BIT(24) -+#define BIT_DIS_UPD_MYRXPKTNAV_8822B BIT(23) -+#define BIT_EARLY_TXBA_8822B BIT(22) -+ -+#define BIT_SHIFT_RESP_CHNBUSY_8822B 20 -+#define BIT_MASK_RESP_CHNBUSY_8822B 0x3 -+#define BIT_RESP_CHNBUSY_8822B(x) \ -+ (((x) & BIT_MASK_RESP_CHNBUSY_8822B) << BIT_SHIFT_RESP_CHNBUSY_8822B) -+#define BITS_RESP_CHNBUSY_8822B \ -+ (BIT_MASK_RESP_CHNBUSY_8822B << BIT_SHIFT_RESP_CHNBUSY_8822B) -+#define BIT_CLEAR_RESP_CHNBUSY_8822B(x) ((x) & (~BITS_RESP_CHNBUSY_8822B)) -+#define BIT_GET_RESP_CHNBUSY_8822B(x) \ -+ (((x) >> BIT_SHIFT_RESP_CHNBUSY_8822B) & BIT_MASK_RESP_CHNBUSY_8822B) -+#define BIT_SET_RESP_CHNBUSY_8822B(x, v) \ -+ (BIT_CLEAR_RESP_CHNBUSY_8822B(x) | BIT_RESP_CHNBUSY_8822B(v)) -+ -+#define BIT_RESP_DCTS_EN_8822B BIT(19) -+#define BIT_RESP_DCFE_EN_8822B BIT(18) -+#define BIT_RESP_SPLCPEN_8822B BIT(17) -+#define BIT_RESP_SGIEN_8822B BIT(16) -+#define BIT_RESP_LDPC_EN_8822B BIT(15) -+#define BIT_DIS_RESP_ACKINCCA_8822B BIT(14) -+#define BIT_DIS_RESP_CTSINCCA_8822B BIT(13) -+ -+#define BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8822B 10 -+#define BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8822B 0x7 -+#define BIT_R_WMAC_SECOND_CCA_TIMER_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8822B) \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8822B) -+#define BITS_R_WMAC_SECOND_CCA_TIMER_8822B \ -+ (BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8822B \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8822B) -+#define BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_SECOND_CCA_TIMER_8822B)) -+#define BIT_GET_R_WMAC_SECOND_CCA_TIMER_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8822B) & \ -+ BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8822B) -+#define BIT_SET_R_WMAC_SECOND_CCA_TIMER_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8822B(x) | \ -+ BIT_R_WMAC_SECOND_CCA_TIMER_8822B(v)) -+ -+#define BIT_SHIFT_RFMOD_8822B 7 -+#define BIT_MASK_RFMOD_8822B 0x3 -+#define BIT_RFMOD_8822B(x) \ -+ (((x) & BIT_MASK_RFMOD_8822B) << BIT_SHIFT_RFMOD_8822B) -+#define BITS_RFMOD_8822B (BIT_MASK_RFMOD_8822B << BIT_SHIFT_RFMOD_8822B) -+#define BIT_CLEAR_RFMOD_8822B(x) ((x) & (~BITS_RFMOD_8822B)) -+#define BIT_GET_RFMOD_8822B(x) \ -+ (((x) >> BIT_SHIFT_RFMOD_8822B) & BIT_MASK_RFMOD_8822B) -+#define BIT_SET_RFMOD_8822B(x, v) \ -+ (BIT_CLEAR_RFMOD_8822B(x) | BIT_RFMOD_8822B(v)) -+ -+#define BIT_SHIFT_RESP_CTS_DYNBW_SEL_8822B 5 -+#define BIT_MASK_RESP_CTS_DYNBW_SEL_8822B 0x3 -+#define BIT_RESP_CTS_DYNBW_SEL_8822B(x) \ -+ (((x) & BIT_MASK_RESP_CTS_DYNBW_SEL_8822B) \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8822B) -+#define BITS_RESP_CTS_DYNBW_SEL_8822B \ -+ (BIT_MASK_RESP_CTS_DYNBW_SEL_8822B \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8822B) -+#define BIT_CLEAR_RESP_CTS_DYNBW_SEL_8822B(x) \ -+ ((x) & (~BITS_RESP_CTS_DYNBW_SEL_8822B)) -+#define BIT_GET_RESP_CTS_DYNBW_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_RESP_CTS_DYNBW_SEL_8822B) & \ -+ BIT_MASK_RESP_CTS_DYNBW_SEL_8822B) -+#define BIT_SET_RESP_CTS_DYNBW_SEL_8822B(x, v) \ -+ (BIT_CLEAR_RESP_CTS_DYNBW_SEL_8822B(x) | \ -+ BIT_RESP_CTS_DYNBW_SEL_8822B(v)) -+ -+#define BIT_DLY_TX_WAIT_RXANTSEL_8822B BIT(4) -+#define BIT_TXRESP_BY_RXANTSEL_8822B BIT(3) -+ -+#define BIT_SHIFT_ORIG_DCTS_CHK_8822B 0 -+#define BIT_MASK_ORIG_DCTS_CHK_8822B 0x3 -+#define BIT_ORIG_DCTS_CHK_8822B(x) \ -+ (((x) & BIT_MASK_ORIG_DCTS_CHK_8822B) << BIT_SHIFT_ORIG_DCTS_CHK_8822B) -+#define BITS_ORIG_DCTS_CHK_8822B \ -+ (BIT_MASK_ORIG_DCTS_CHK_8822B << BIT_SHIFT_ORIG_DCTS_CHK_8822B) -+#define BIT_CLEAR_ORIG_DCTS_CHK_8822B(x) ((x) & (~BITS_ORIG_DCTS_CHK_8822B)) -+#define BIT_GET_ORIG_DCTS_CHK_8822B(x) \ -+ (((x) >> BIT_SHIFT_ORIG_DCTS_CHK_8822B) & BIT_MASK_ORIG_DCTS_CHK_8822B) -+#define BIT_SET_ORIG_DCTS_CHK_8822B(x, v) \ -+ (BIT_CLEAR_ORIG_DCTS_CHK_8822B(x) | BIT_ORIG_DCTS_CHK_8822B(v)) -+ -+/* 2 REG_CAMCMD_8822B (CAM COMMAND REGISTER) */ -+#define BIT_SECCAM_POLLING_8822B BIT(31) -+#define BIT_SECCAM_CLR_8822B BIT(30) -+#define BIT_MFBCAM_CLR_8822B BIT(29) -+#define BIT_SECCAM_WE_8822B BIT(16) -+ -+#define BIT_SHIFT_SECCAM_ADDR_V2_8822B 0 -+#define BIT_MASK_SECCAM_ADDR_V2_8822B 0x3ff -+#define BIT_SECCAM_ADDR_V2_8822B(x) \ -+ (((x) & BIT_MASK_SECCAM_ADDR_V2_8822B) \ -+ << BIT_SHIFT_SECCAM_ADDR_V2_8822B) -+#define BITS_SECCAM_ADDR_V2_8822B \ -+ (BIT_MASK_SECCAM_ADDR_V2_8822B << BIT_SHIFT_SECCAM_ADDR_V2_8822B) -+#define BIT_CLEAR_SECCAM_ADDR_V2_8822B(x) ((x) & (~BITS_SECCAM_ADDR_V2_8822B)) -+#define BIT_GET_SECCAM_ADDR_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_SECCAM_ADDR_V2_8822B) & \ -+ BIT_MASK_SECCAM_ADDR_V2_8822B) -+#define BIT_SET_SECCAM_ADDR_V2_8822B(x, v) \ -+ (BIT_CLEAR_SECCAM_ADDR_V2_8822B(x) | BIT_SECCAM_ADDR_V2_8822B(v)) -+ -+/* 2 REG_CAMWRITE_8822B (CAM WRITE REGISTER) */ -+ -+#define BIT_SHIFT_CAMW_DATA_8822B 0 -+#define BIT_MASK_CAMW_DATA_8822B 0xffffffffL -+#define BIT_CAMW_DATA_8822B(x) \ -+ (((x) & BIT_MASK_CAMW_DATA_8822B) << BIT_SHIFT_CAMW_DATA_8822B) -+#define BITS_CAMW_DATA_8822B \ -+ (BIT_MASK_CAMW_DATA_8822B << BIT_SHIFT_CAMW_DATA_8822B) -+#define BIT_CLEAR_CAMW_DATA_8822B(x) ((x) & (~BITS_CAMW_DATA_8822B)) -+#define BIT_GET_CAMW_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_CAMW_DATA_8822B) & BIT_MASK_CAMW_DATA_8822B) -+#define BIT_SET_CAMW_DATA_8822B(x, v) \ -+ (BIT_CLEAR_CAMW_DATA_8822B(x) | BIT_CAMW_DATA_8822B(v)) -+ -+/* 2 REG_CAMREAD_8822B (CAM READ REGISTER) */ -+ -+#define BIT_SHIFT_CAMR_DATA_8822B 0 -+#define BIT_MASK_CAMR_DATA_8822B 0xffffffffL -+#define BIT_CAMR_DATA_8822B(x) \ -+ (((x) & BIT_MASK_CAMR_DATA_8822B) << BIT_SHIFT_CAMR_DATA_8822B) -+#define BITS_CAMR_DATA_8822B \ -+ (BIT_MASK_CAMR_DATA_8822B << BIT_SHIFT_CAMR_DATA_8822B) -+#define BIT_CLEAR_CAMR_DATA_8822B(x) ((x) & (~BITS_CAMR_DATA_8822B)) -+#define BIT_GET_CAMR_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_CAMR_DATA_8822B) & BIT_MASK_CAMR_DATA_8822B) -+#define BIT_SET_CAMR_DATA_8822B(x, v) \ -+ (BIT_CLEAR_CAMR_DATA_8822B(x) | BIT_CAMR_DATA_8822B(v)) -+ -+/* 2 REG_CAMDBG_8822B (CAM DEBUG REGISTER) */ -+#define BIT_SECCAM_INFO_8822B BIT(31) -+#define BIT_SEC_KEYFOUND_8822B BIT(15) -+ -+#define BIT_SHIFT_CAMDBG_SEC_TYPE_8822B 12 -+#define BIT_MASK_CAMDBG_SEC_TYPE_8822B 0x7 -+#define BIT_CAMDBG_SEC_TYPE_8822B(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_TYPE_8822B) \ -+ << BIT_SHIFT_CAMDBG_SEC_TYPE_8822B) -+#define BITS_CAMDBG_SEC_TYPE_8822B \ -+ (BIT_MASK_CAMDBG_SEC_TYPE_8822B << BIT_SHIFT_CAMDBG_SEC_TYPE_8822B) -+#define BIT_CLEAR_CAMDBG_SEC_TYPE_8822B(x) ((x) & (~BITS_CAMDBG_SEC_TYPE_8822B)) -+#define BIT_GET_CAMDBG_SEC_TYPE_8822B(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_TYPE_8822B) & \ -+ BIT_MASK_CAMDBG_SEC_TYPE_8822B) -+#define BIT_SET_CAMDBG_SEC_TYPE_8822B(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_TYPE_8822B(x) | BIT_CAMDBG_SEC_TYPE_8822B(v)) -+ -+#define BIT_CAMDBG_EXT_SECTYPE_8822B BIT(11) -+ -+#define BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8822B 5 -+#define BIT_MASK_CAMDBG_MIC_KEY_IDX_8822B 0x1f -+#define BIT_CAMDBG_MIC_KEY_IDX_8822B(x) \ -+ (((x) & BIT_MASK_CAMDBG_MIC_KEY_IDX_8822B) \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8822B) -+#define BITS_CAMDBG_MIC_KEY_IDX_8822B \ -+ (BIT_MASK_CAMDBG_MIC_KEY_IDX_8822B \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8822B) -+#define BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8822B(x) \ -+ ((x) & (~BITS_CAMDBG_MIC_KEY_IDX_8822B)) -+#define BIT_GET_CAMDBG_MIC_KEY_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8822B) & \ -+ BIT_MASK_CAMDBG_MIC_KEY_IDX_8822B) -+#define BIT_SET_CAMDBG_MIC_KEY_IDX_8822B(x, v) \ -+ (BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8822B(x) | \ -+ BIT_CAMDBG_MIC_KEY_IDX_8822B(v)) -+ -+#define BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8822B 0 -+#define BIT_MASK_CAMDBG_SEC_KEY_IDX_8822B 0x1f -+#define BIT_CAMDBG_SEC_KEY_IDX_8822B(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_KEY_IDX_8822B) \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8822B) -+#define BITS_CAMDBG_SEC_KEY_IDX_8822B \ -+ (BIT_MASK_CAMDBG_SEC_KEY_IDX_8822B \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8822B) -+#define BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8822B(x) \ -+ ((x) & (~BITS_CAMDBG_SEC_KEY_IDX_8822B)) -+#define BIT_GET_CAMDBG_SEC_KEY_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8822B) & \ -+ BIT_MASK_CAMDBG_SEC_KEY_IDX_8822B) -+#define BIT_SET_CAMDBG_SEC_KEY_IDX_8822B(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8822B(x) | \ -+ BIT_CAMDBG_SEC_KEY_IDX_8822B(v)) -+ -+/* 2 REG_RXFILTER_ACTION_1_8822B */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_1_8822B 0 -+#define BIT_MASK_RXFILTER_ACTION_1_8822B 0xff -+#define BIT_RXFILTER_ACTION_1_8822B(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_1_8822B) \ -+ << BIT_SHIFT_RXFILTER_ACTION_1_8822B) -+#define BITS_RXFILTER_ACTION_1_8822B \ -+ (BIT_MASK_RXFILTER_ACTION_1_8822B << BIT_SHIFT_RXFILTER_ACTION_1_8822B) -+#define BIT_CLEAR_RXFILTER_ACTION_1_8822B(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_1_8822B)) -+#define BIT_GET_RXFILTER_ACTION_1_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_1_8822B) & \ -+ BIT_MASK_RXFILTER_ACTION_1_8822B) -+#define BIT_SET_RXFILTER_ACTION_1_8822B(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_1_8822B(x) | BIT_RXFILTER_ACTION_1_8822B(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_1_8822B */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_1_8822B 0 -+#define BIT_MASK_RXFILTER_CATEGORY_1_8822B 0xff -+#define BIT_RXFILTER_CATEGORY_1_8822B(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_1_8822B) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8822B) -+#define BITS_RXFILTER_CATEGORY_1_8822B \ -+ (BIT_MASK_RXFILTER_CATEGORY_1_8822B \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8822B) -+#define BIT_CLEAR_RXFILTER_CATEGORY_1_8822B(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_1_8822B)) -+#define BIT_GET_RXFILTER_CATEGORY_1_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_1_8822B) & \ -+ BIT_MASK_RXFILTER_CATEGORY_1_8822B) -+#define BIT_SET_RXFILTER_CATEGORY_1_8822B(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_1_8822B(x) | \ -+ BIT_RXFILTER_CATEGORY_1_8822B(v)) -+ -+/* 2 REG_SECCFG_8822B (SECURITY CONFIGURATION REGISTER) */ -+#define BIT_DIS_GCLK_WAPI_8822B BIT(15) -+#define BIT_DIS_GCLK_AES_8822B BIT(14) -+#define BIT_DIS_GCLK_TKIP_8822B BIT(13) -+#define BIT_AES_SEL_QC_1_8822B BIT(12) -+#define BIT_AES_SEL_QC_0_8822B BIT(11) -+#define BIT_CHK_BMC_8822B BIT(9) -+#define BIT_CHK_KEYID_8822B BIT(8) -+#define BIT_RXBCUSEDK_8822B BIT(7) -+#define BIT_TXBCUSEDK_8822B BIT(6) -+#define BIT_NOSKMC_8822B BIT(5) -+#define BIT_SKBYA2_8822B BIT(4) -+#define BIT_RXDEC_8822B BIT(3) -+#define BIT_TXENC_8822B BIT(2) -+#define BIT_RXUHUSEDK_8822B BIT(1) -+#define BIT_TXUHUSEDK_8822B BIT(0) -+ -+/* 2 REG_RXFILTER_ACTION_3_8822B */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_3_8822B 0 -+#define BIT_MASK_RXFILTER_ACTION_3_8822B 0xff -+#define BIT_RXFILTER_ACTION_3_8822B(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_3_8822B) \ -+ << BIT_SHIFT_RXFILTER_ACTION_3_8822B) -+#define BITS_RXFILTER_ACTION_3_8822B \ -+ (BIT_MASK_RXFILTER_ACTION_3_8822B << BIT_SHIFT_RXFILTER_ACTION_3_8822B) -+#define BIT_CLEAR_RXFILTER_ACTION_3_8822B(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_3_8822B)) -+#define BIT_GET_RXFILTER_ACTION_3_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_3_8822B) & \ -+ BIT_MASK_RXFILTER_ACTION_3_8822B) -+#define BIT_SET_RXFILTER_ACTION_3_8822B(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_3_8822B(x) | BIT_RXFILTER_ACTION_3_8822B(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_3_8822B */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_3_8822B 0 -+#define BIT_MASK_RXFILTER_CATEGORY_3_8822B 0xff -+#define BIT_RXFILTER_CATEGORY_3_8822B(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_3_8822B) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8822B) -+#define BITS_RXFILTER_CATEGORY_3_8822B \ -+ (BIT_MASK_RXFILTER_CATEGORY_3_8822B \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8822B) -+#define BIT_CLEAR_RXFILTER_CATEGORY_3_8822B(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_3_8822B)) -+#define BIT_GET_RXFILTER_CATEGORY_3_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_3_8822B) & \ -+ BIT_MASK_RXFILTER_CATEGORY_3_8822B) -+#define BIT_SET_RXFILTER_CATEGORY_3_8822B(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_3_8822B(x) | \ -+ BIT_RXFILTER_CATEGORY_3_8822B(v)) -+ -+/* 2 REG_RXFILTER_ACTION_2_8822B */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_2_8822B 0 -+#define BIT_MASK_RXFILTER_ACTION_2_8822B 0xff -+#define BIT_RXFILTER_ACTION_2_8822B(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_2_8822B) \ -+ << BIT_SHIFT_RXFILTER_ACTION_2_8822B) -+#define BITS_RXFILTER_ACTION_2_8822B \ -+ (BIT_MASK_RXFILTER_ACTION_2_8822B << BIT_SHIFT_RXFILTER_ACTION_2_8822B) -+#define BIT_CLEAR_RXFILTER_ACTION_2_8822B(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_2_8822B)) -+#define BIT_GET_RXFILTER_ACTION_2_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_2_8822B) & \ -+ BIT_MASK_RXFILTER_ACTION_2_8822B) -+#define BIT_SET_RXFILTER_ACTION_2_8822B(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_2_8822B(x) | BIT_RXFILTER_ACTION_2_8822B(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_2_8822B */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_2_8822B 0 -+#define BIT_MASK_RXFILTER_CATEGORY_2_8822B 0xff -+#define BIT_RXFILTER_CATEGORY_2_8822B(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_2_8822B) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8822B) -+#define BITS_RXFILTER_CATEGORY_2_8822B \ -+ (BIT_MASK_RXFILTER_CATEGORY_2_8822B \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8822B) -+#define BIT_CLEAR_RXFILTER_CATEGORY_2_8822B(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_2_8822B)) -+#define BIT_GET_RXFILTER_CATEGORY_2_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_2_8822B) & \ -+ BIT_MASK_RXFILTER_CATEGORY_2_8822B) -+#define BIT_SET_RXFILTER_CATEGORY_2_8822B(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_2_8822B(x) | \ -+ BIT_RXFILTER_CATEGORY_2_8822B(v)) -+ -+/* 2 REG_RXFLTMAP4_8822B (RX FILTER MAP GROUP 4) */ -+#define BIT_CTRLFLT15EN_FW_8822B BIT(15) -+#define BIT_CTRLFLT14EN_FW_8822B BIT(14) -+#define BIT_CTRLFLT13EN_FW_8822B BIT(13) -+#define BIT_CTRLFLT12EN_FW_8822B BIT(12) -+#define BIT_CTRLFLT11EN_FW_8822B BIT(11) -+#define BIT_CTRLFLT10EN_FW_8822B BIT(10) -+#define BIT_CTRLFLT9EN_FW_8822B BIT(9) -+#define BIT_CTRLFLT8EN_FW_8822B BIT(8) -+#define BIT_CTRLFLT7EN_FW_8822B BIT(7) -+#define BIT_CTRLFLT6EN_FW_8822B BIT(6) -+#define BIT_CTRLFLT5EN_FW_8822B BIT(5) -+#define BIT_CTRLFLT4EN_FW_8822B BIT(4) -+#define BIT_CTRLFLT3EN_FW_8822B BIT(3) -+#define BIT_CTRLFLT2EN_FW_8822B BIT(2) -+#define BIT_CTRLFLT1EN_FW_8822B BIT(1) -+#define BIT_CTRLFLT0EN_FW_8822B BIT(0) -+ -+/* 2 REG_RXFLTMAP3_8822B (RX FILTER MAP GROUP 3) */ -+#define BIT_MGTFLT15EN_FW_8822B BIT(15) -+#define BIT_MGTFLT14EN_FW_8822B BIT(14) -+#define BIT_MGTFLT13EN_FW_8822B BIT(13) -+#define BIT_MGTFLT12EN_FW_8822B BIT(12) -+#define BIT_MGTFLT11EN_FW_8822B BIT(11) -+#define BIT_MGTFLT10EN_FW_8822B BIT(10) -+#define BIT_MGTFLT9EN_FW_8822B BIT(9) -+#define BIT_MGTFLT8EN_FW_8822B BIT(8) -+#define BIT_MGTFLT7EN_FW_8822B BIT(7) -+#define BIT_MGTFLT6EN_FW_8822B BIT(6) -+#define BIT_MGTFLT5EN_FW_8822B BIT(5) -+#define BIT_MGTFLT4EN_FW_8822B BIT(4) -+#define BIT_MGTFLT3EN_FW_8822B BIT(3) -+#define BIT_MGTFLT2EN_FW_8822B BIT(2) -+#define BIT_MGTFLT1EN_FW_8822B BIT(1) -+#define BIT_MGTFLT0EN_FW_8822B BIT(0) -+ -+/* 2 REG_RXFLTMAP6_8822B (RX FILTER MAP GROUP 6) */ -+#define BIT_ACTIONFLT15EN_FW_8822B BIT(15) -+#define BIT_ACTIONFLT14EN_FW_8822B BIT(14) -+#define BIT_ACTIONFLT13EN_FW_8822B BIT(13) -+#define BIT_ACTIONFLT12EN_FW_8822B BIT(12) -+#define BIT_ACTIONFLT11EN_FW_8822B BIT(11) -+#define BIT_ACTIONFLT10EN_FW_8822B BIT(10) -+#define BIT_ACTIONFLT9EN_FW_8822B BIT(9) -+#define BIT_ACTIONFLT8EN_FW_8822B BIT(8) -+#define BIT_ACTIONFLT7EN_FW_8822B BIT(7) -+#define BIT_ACTIONFLT6EN_FW_8822B BIT(6) -+#define BIT_ACTIONFLT5EN_FW_8822B BIT(5) -+#define BIT_ACTIONFLT4EN_FW_8822B BIT(4) -+#define BIT_ACTIONFLT3EN_FW_8822B BIT(3) -+#define BIT_ACTIONFLT2EN_FW_8822B BIT(2) -+#define BIT_ACTIONFLT1EN_FW_8822B BIT(1) -+#define BIT_ACTIONFLT0EN_FW_8822B BIT(0) -+ -+/* 2 REG_RXFLTMAP5_8822B (RX FILTER MAP GROUP 5) */ -+#define BIT_DATAFLT15EN_FW_8822B BIT(15) -+#define BIT_DATAFLT14EN_FW_8822B BIT(14) -+#define BIT_DATAFLT13EN_FW_8822B BIT(13) -+#define BIT_DATAFLT12EN_FW_8822B BIT(12) -+#define BIT_DATAFLT11EN_FW_8822B BIT(11) -+#define BIT_DATAFLT10EN_FW_8822B BIT(10) -+#define BIT_DATAFLT9EN_FW_8822B BIT(9) -+#define BIT_DATAFLT8EN_FW_8822B BIT(8) -+#define BIT_DATAFLT7EN_FW_8822B BIT(7) -+#define BIT_DATAFLT6EN_FW_8822B BIT(6) -+#define BIT_DATAFLT5EN_FW_8822B BIT(5) -+#define BIT_DATAFLT4EN_FW_8822B BIT(4) -+#define BIT_DATAFLT3EN_FW_8822B BIT(3) -+#define BIT_DATAFLT2EN_FW_8822B BIT(2) -+#define BIT_DATAFLT1EN_FW_8822B BIT(1) -+#define BIT_DATAFLT0EN_FW_8822B BIT(0) -+ -+/* 2 REG_WMMPS_UAPSD_TID_8822B (WMM POWER SAVE UAPSD TID REGISTER) */ -+#define BIT_WMMPS_UAPSD_TID7_8822B BIT(7) -+#define BIT_WMMPS_UAPSD_TID6_8822B BIT(6) -+#define BIT_WMMPS_UAPSD_TID5_8822B BIT(5) -+#define BIT_WMMPS_UAPSD_TID4_8822B BIT(4) -+#define BIT_WMMPS_UAPSD_TID3_8822B BIT(3) -+#define BIT_WMMPS_UAPSD_TID2_8822B BIT(2) -+#define BIT_WMMPS_UAPSD_TID1_8822B BIT(1) -+#define BIT_WMMPS_UAPSD_TID0_8822B BIT(0) -+ -+/* 2 REG_PS_RX_INFO_8822B (POWER SAVE RX INFORMATION REGISTER) */ -+ -+#define BIT_SHIFT_PORTSEL__PS_RX_INFO_8822B 5 -+#define BIT_MASK_PORTSEL__PS_RX_INFO_8822B 0x7 -+#define BIT_PORTSEL__PS_RX_INFO_8822B(x) \ -+ (((x) & BIT_MASK_PORTSEL__PS_RX_INFO_8822B) \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8822B) -+#define BITS_PORTSEL__PS_RX_INFO_8822B \ -+ (BIT_MASK_PORTSEL__PS_RX_INFO_8822B \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8822B) -+#define BIT_CLEAR_PORTSEL__PS_RX_INFO_8822B(x) \ -+ ((x) & (~BITS_PORTSEL__PS_RX_INFO_8822B)) -+#define BIT_GET_PORTSEL__PS_RX_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_PORTSEL__PS_RX_INFO_8822B) & \ -+ BIT_MASK_PORTSEL__PS_RX_INFO_8822B) -+#define BIT_SET_PORTSEL__PS_RX_INFO_8822B(x, v) \ -+ (BIT_CLEAR_PORTSEL__PS_RX_INFO_8822B(x) | \ -+ BIT_PORTSEL__PS_RX_INFO_8822B(v)) -+ -+#define BIT_RXCTRLIN0_8822B BIT(4) -+#define BIT_RXMGTIN0_8822B BIT(3) -+#define BIT_RXDATAIN2_8822B BIT(2) -+#define BIT_RXDATAIN1_8822B BIT(1) -+#define BIT_RXDATAIN0_8822B BIT(0) -+ -+/* 2 REG_NAN_RX_TSF_FILTER_8822B(NAN_RX_TSF_ADDRESS_FILTER) */ -+#define BIT_CHK_TSF_TA_8822B BIT(2) -+#define BIT_CHK_TSF_CBSSID_8822B BIT(1) -+#define BIT_CHK_TSF_EN_8822B BIT(0) -+ -+/* 2 REG_WOW_CTRL_8822B (WAKE ON WLAN CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_PSF_BSSIDSEL_B2B1_8822B 6 -+#define BIT_MASK_PSF_BSSIDSEL_B2B1_8822B 0x3 -+#define BIT_PSF_BSSIDSEL_B2B1_8822B(x) \ -+ (((x) & BIT_MASK_PSF_BSSIDSEL_B2B1_8822B) \ -+ << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8822B) -+#define BITS_PSF_BSSIDSEL_B2B1_8822B \ -+ (BIT_MASK_PSF_BSSIDSEL_B2B1_8822B << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8822B) -+#define BIT_CLEAR_PSF_BSSIDSEL_B2B1_8822B(x) \ -+ ((x) & (~BITS_PSF_BSSIDSEL_B2B1_8822B)) -+#define BIT_GET_PSF_BSSIDSEL_B2B1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PSF_BSSIDSEL_B2B1_8822B) & \ -+ BIT_MASK_PSF_BSSIDSEL_B2B1_8822B) -+#define BIT_SET_PSF_BSSIDSEL_B2B1_8822B(x, v) \ -+ (BIT_CLEAR_PSF_BSSIDSEL_B2B1_8822B(x) | BIT_PSF_BSSIDSEL_B2B1_8822B(v)) -+ -+#define BIT_WOWHCI_8822B BIT(5) -+#define BIT_PSF_BSSIDSEL_B0_8822B BIT(4) -+#define BIT_UWF_8822B BIT(3) -+#define BIT_MAGIC_8822B BIT(2) -+#define BIT_WOWEN_8822B BIT(1) -+#define BIT_FORCE_WAKEUP_8822B BIT(0) -+ -+/* 2 REG_LPNAV_CTRL_8822B (LOW POWER NAV CONTROL REGISTER) */ -+#define BIT_LPNAV_EN_8822B BIT(31) -+ -+#define BIT_SHIFT_LPNAV_EARLY_8822B 16 -+#define BIT_MASK_LPNAV_EARLY_8822B 0x7fff -+#define BIT_LPNAV_EARLY_8822B(x) \ -+ (((x) & BIT_MASK_LPNAV_EARLY_8822B) << BIT_SHIFT_LPNAV_EARLY_8822B) -+#define BITS_LPNAV_EARLY_8822B \ -+ (BIT_MASK_LPNAV_EARLY_8822B << BIT_SHIFT_LPNAV_EARLY_8822B) -+#define BIT_CLEAR_LPNAV_EARLY_8822B(x) ((x) & (~BITS_LPNAV_EARLY_8822B)) -+#define BIT_GET_LPNAV_EARLY_8822B(x) \ -+ (((x) >> BIT_SHIFT_LPNAV_EARLY_8822B) & BIT_MASK_LPNAV_EARLY_8822B) -+#define BIT_SET_LPNAV_EARLY_8822B(x, v) \ -+ (BIT_CLEAR_LPNAV_EARLY_8822B(x) | BIT_LPNAV_EARLY_8822B(v)) -+ -+#define BIT_SHIFT_LPNAV_TH_8822B 0 -+#define BIT_MASK_LPNAV_TH_8822B 0xffff -+#define BIT_LPNAV_TH_8822B(x) \ -+ (((x) & BIT_MASK_LPNAV_TH_8822B) << BIT_SHIFT_LPNAV_TH_8822B) -+#define BITS_LPNAV_TH_8822B \ -+ (BIT_MASK_LPNAV_TH_8822B << BIT_SHIFT_LPNAV_TH_8822B) -+#define BIT_CLEAR_LPNAV_TH_8822B(x) ((x) & (~BITS_LPNAV_TH_8822B)) -+#define BIT_GET_LPNAV_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_LPNAV_TH_8822B) & BIT_MASK_LPNAV_TH_8822B) -+#define BIT_SET_LPNAV_TH_8822B(x, v) \ -+ (BIT_CLEAR_LPNAV_TH_8822B(x) | BIT_LPNAV_TH_8822B(v)) -+ -+/* 2 REG_WKFMCAM_CMD_8822B (WAKEUP FRAME CAM COMMAND REGISTER) */ -+#define BIT_WKFCAM_POLLING_V1_8822B BIT(31) -+#define BIT_WKFCAM_CLR_V1_8822B BIT(30) -+#define BIT_WKFCAM_WE_8822B BIT(16) -+ -+#define BIT_SHIFT_WKFCAM_ADDR_V2_8822B 8 -+#define BIT_MASK_WKFCAM_ADDR_V2_8822B 0xff -+#define BIT_WKFCAM_ADDR_V2_8822B(x) \ -+ (((x) & BIT_MASK_WKFCAM_ADDR_V2_8822B) \ -+ << BIT_SHIFT_WKFCAM_ADDR_V2_8822B) -+#define BITS_WKFCAM_ADDR_V2_8822B \ -+ (BIT_MASK_WKFCAM_ADDR_V2_8822B << BIT_SHIFT_WKFCAM_ADDR_V2_8822B) -+#define BIT_CLEAR_WKFCAM_ADDR_V2_8822B(x) ((x) & (~BITS_WKFCAM_ADDR_V2_8822B)) -+#define BIT_GET_WKFCAM_ADDR_V2_8822B(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_ADDR_V2_8822B) & \ -+ BIT_MASK_WKFCAM_ADDR_V2_8822B) -+#define BIT_SET_WKFCAM_ADDR_V2_8822B(x, v) \ -+ (BIT_CLEAR_WKFCAM_ADDR_V2_8822B(x) | BIT_WKFCAM_ADDR_V2_8822B(v)) -+ -+#define BIT_SHIFT_WKFCAM_CAM_NUM_V1_8822B 0 -+#define BIT_MASK_WKFCAM_CAM_NUM_V1_8822B 0xff -+#define BIT_WKFCAM_CAM_NUM_V1_8822B(x) \ -+ (((x) & BIT_MASK_WKFCAM_CAM_NUM_V1_8822B) \ -+ << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8822B) -+#define BITS_WKFCAM_CAM_NUM_V1_8822B \ -+ (BIT_MASK_WKFCAM_CAM_NUM_V1_8822B << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8822B) -+#define BIT_CLEAR_WKFCAM_CAM_NUM_V1_8822B(x) \ -+ ((x) & (~BITS_WKFCAM_CAM_NUM_V1_8822B)) -+#define BIT_GET_WKFCAM_CAM_NUM_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_CAM_NUM_V1_8822B) & \ -+ BIT_MASK_WKFCAM_CAM_NUM_V1_8822B) -+#define BIT_SET_WKFCAM_CAM_NUM_V1_8822B(x, v) \ -+ (BIT_CLEAR_WKFCAM_CAM_NUM_V1_8822B(x) | BIT_WKFCAM_CAM_NUM_V1_8822B(v)) -+ -+/* 2 REG_WKFMCAM_RWD_8822B (WAKEUP FRAME READ/WRITE DATA) */ -+ -+#define BIT_SHIFT_WKFMCAM_RWD_8822B 0 -+#define BIT_MASK_WKFMCAM_RWD_8822B 0xffffffffL -+#define BIT_WKFMCAM_RWD_8822B(x) \ -+ (((x) & BIT_MASK_WKFMCAM_RWD_8822B) << BIT_SHIFT_WKFMCAM_RWD_8822B) -+#define BITS_WKFMCAM_RWD_8822B \ -+ (BIT_MASK_WKFMCAM_RWD_8822B << BIT_SHIFT_WKFMCAM_RWD_8822B) -+#define BIT_CLEAR_WKFMCAM_RWD_8822B(x) ((x) & (~BITS_WKFMCAM_RWD_8822B)) -+#define BIT_GET_WKFMCAM_RWD_8822B(x) \ -+ (((x) >> BIT_SHIFT_WKFMCAM_RWD_8822B) & BIT_MASK_WKFMCAM_RWD_8822B) -+#define BIT_SET_WKFMCAM_RWD_8822B(x, v) \ -+ (BIT_CLEAR_WKFMCAM_RWD_8822B(x) | BIT_WKFMCAM_RWD_8822B(v)) -+ -+/* 2 REG_RXFLTMAP1_8822B (RX FILTER MAP GROUP 1) */ -+#define BIT_CTRLFLT15EN_8822B BIT(15) -+#define BIT_CTRLFLT14EN_8822B BIT(14) -+#define BIT_CTRLFLT13EN_8822B BIT(13) -+#define BIT_CTRLFLT12EN_8822B BIT(12) -+#define BIT_CTRLFLT11EN_8822B BIT(11) -+#define BIT_CTRLFLT10EN_8822B BIT(10) -+#define BIT_CTRLFLT9EN_8822B BIT(9) -+#define BIT_CTRLFLT8EN_8822B BIT(8) -+#define BIT_CTRLFLT7EN_8822B BIT(7) -+#define BIT_CTRLFLT6EN_8822B BIT(6) -+#define BIT_CTRLFLT5EN_8822B BIT(5) -+#define BIT_CTRLFLT4EN_8822B BIT(4) -+#define BIT_CTRLFLT3EN_8822B BIT(3) -+#define BIT_CTRLFLT2EN_8822B BIT(2) -+#define BIT_CTRLFLT1EN_8822B BIT(1) -+#define BIT_CTRLFLT0EN_8822B BIT(0) -+ -+/* 2 REG_RXFLTMAP0_8822B (RX FILTER MAP GROUP 0) */ -+#define BIT_MGTFLT15EN_8822B BIT(15) -+#define BIT_MGTFLT14EN_8822B BIT(14) -+#define BIT_MGTFLT13EN_8822B BIT(13) -+#define BIT_MGTFLT12EN_8822B BIT(12) -+#define BIT_MGTFLT11EN_8822B BIT(11) -+#define BIT_MGTFLT10EN_8822B BIT(10) -+#define BIT_MGTFLT9EN_8822B BIT(9) -+#define BIT_MGTFLT8EN_8822B BIT(8) -+#define BIT_MGTFLT7EN_8822B BIT(7) -+#define BIT_MGTFLT6EN_8822B BIT(6) -+#define BIT_MGTFLT5EN_8822B BIT(5) -+#define BIT_MGTFLT4EN_8822B BIT(4) -+#define BIT_MGTFLT3EN_8822B BIT(3) -+#define BIT_MGTFLT2EN_8822B BIT(2) -+#define BIT_MGTFLT1EN_8822B BIT(1) -+#define BIT_MGTFLT0EN_8822B BIT(0) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_RXFLTMAP2_8822B (RX FILTER MAP GROUP 2) */ -+#define BIT_DATAFLT15EN_8822B BIT(15) -+#define BIT_DATAFLT14EN_8822B BIT(14) -+#define BIT_DATAFLT13EN_8822B BIT(13) -+#define BIT_DATAFLT12EN_8822B BIT(12) -+#define BIT_DATAFLT11EN_8822B BIT(11) -+#define BIT_DATAFLT10EN_8822B BIT(10) -+#define BIT_DATAFLT9EN_8822B BIT(9) -+#define BIT_DATAFLT8EN_8822B BIT(8) -+#define BIT_DATAFLT7EN_8822B BIT(7) -+#define BIT_DATAFLT6EN_8822B BIT(6) -+#define BIT_DATAFLT5EN_8822B BIT(5) -+#define BIT_DATAFLT4EN_8822B BIT(4) -+#define BIT_DATAFLT3EN_8822B BIT(3) -+#define BIT_DATAFLT2EN_8822B BIT(2) -+#define BIT_DATAFLT1EN_8822B BIT(1) -+#define BIT_DATAFLT0EN_8822B BIT(0) -+ -+/* 2 REG_BCN_PSR_RPT_8822B (BEACON PARSER REPORT REGISTER) */ -+ -+#define BIT_SHIFT_DTIM_CNT_8822B 24 -+#define BIT_MASK_DTIM_CNT_8822B 0xff -+#define BIT_DTIM_CNT_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_CNT_8822B) << BIT_SHIFT_DTIM_CNT_8822B) -+#define BITS_DTIM_CNT_8822B \ -+ (BIT_MASK_DTIM_CNT_8822B << BIT_SHIFT_DTIM_CNT_8822B) -+#define BIT_CLEAR_DTIM_CNT_8822B(x) ((x) & (~BITS_DTIM_CNT_8822B)) -+#define BIT_GET_DTIM_CNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT_8822B) & BIT_MASK_DTIM_CNT_8822B) -+#define BIT_SET_DTIM_CNT_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_CNT_8822B(x) | BIT_DTIM_CNT_8822B(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD_8822B 16 -+#define BIT_MASK_DTIM_PERIOD_8822B 0xff -+#define BIT_DTIM_PERIOD_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD_8822B) << BIT_SHIFT_DTIM_PERIOD_8822B) -+#define BITS_DTIM_PERIOD_8822B \ -+ (BIT_MASK_DTIM_PERIOD_8822B << BIT_SHIFT_DTIM_PERIOD_8822B) -+#define BIT_CLEAR_DTIM_PERIOD_8822B(x) ((x) & (~BITS_DTIM_PERIOD_8822B)) -+#define BIT_GET_DTIM_PERIOD_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD_8822B) & BIT_MASK_DTIM_PERIOD_8822B) -+#define BIT_SET_DTIM_PERIOD_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD_8822B(x) | BIT_DTIM_PERIOD_8822B(v)) -+ -+#define BIT_DTIM_8822B BIT(15) -+#define BIT_TIM_8822B BIT(14) -+ -+#define BIT_SHIFT_PS_AID_0_8822B 0 -+#define BIT_MASK_PS_AID_0_8822B 0x7ff -+#define BIT_PS_AID_0_8822B(x) \ -+ (((x) & BIT_MASK_PS_AID_0_8822B) << BIT_SHIFT_PS_AID_0_8822B) -+#define BITS_PS_AID_0_8822B \ -+ (BIT_MASK_PS_AID_0_8822B << BIT_SHIFT_PS_AID_0_8822B) -+#define BIT_CLEAR_PS_AID_0_8822B(x) ((x) & (~BITS_PS_AID_0_8822B)) -+#define BIT_GET_PS_AID_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_0_8822B) & BIT_MASK_PS_AID_0_8822B) -+#define BIT_SET_PS_AID_0_8822B(x, v) \ -+ (BIT_CLEAR_PS_AID_0_8822B(x) | BIT_PS_AID_0_8822B(v)) -+ -+/* 2 REG_FLC_TRPC_8822B (TIMER OF FLC_RPC) */ -+#define BIT_FLC_RPCT_V1_8822B BIT(7) -+#define BIT_MODE_8822B BIT(6) -+ -+#define BIT_SHIFT_TRPCD_8822B 0 -+#define BIT_MASK_TRPCD_8822B 0x3f -+#define BIT_TRPCD_8822B(x) \ -+ (((x) & BIT_MASK_TRPCD_8822B) << BIT_SHIFT_TRPCD_8822B) -+#define BITS_TRPCD_8822B (BIT_MASK_TRPCD_8822B << BIT_SHIFT_TRPCD_8822B) -+#define BIT_CLEAR_TRPCD_8822B(x) ((x) & (~BITS_TRPCD_8822B)) -+#define BIT_GET_TRPCD_8822B(x) \ -+ (((x) >> BIT_SHIFT_TRPCD_8822B) & BIT_MASK_TRPCD_8822B) -+#define BIT_SET_TRPCD_8822B(x, v) \ -+ (BIT_CLEAR_TRPCD_8822B(x) | BIT_TRPCD_8822B(v)) -+ -+/* 2 REG_FLC_PTS_8822B (PKT TYPE SELECTION OF FLC_RPC T) */ -+#define BIT_CMF_8822B BIT(2) -+#define BIT_CCF_8822B BIT(1) -+#define BIT_CDF_8822B BIT(0) -+ -+/* 2 REG_FLC_RPCT_8822B (FLC_RPC THRESHOLD) */ -+ -+#define BIT_SHIFT_FLC_RPCT_8822B 0 -+#define BIT_MASK_FLC_RPCT_8822B 0xff -+#define BIT_FLC_RPCT_8822B(x) \ -+ (((x) & BIT_MASK_FLC_RPCT_8822B) << BIT_SHIFT_FLC_RPCT_8822B) -+#define BITS_FLC_RPCT_8822B \ -+ (BIT_MASK_FLC_RPCT_8822B << BIT_SHIFT_FLC_RPCT_8822B) -+#define BIT_CLEAR_FLC_RPCT_8822B(x) ((x) & (~BITS_FLC_RPCT_8822B)) -+#define BIT_GET_FLC_RPCT_8822B(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPCT_8822B) & BIT_MASK_FLC_RPCT_8822B) -+#define BIT_SET_FLC_RPCT_8822B(x, v) \ -+ (BIT_CLEAR_FLC_RPCT_8822B(x) | BIT_FLC_RPCT_8822B(v)) -+ -+/* 2 REG_FLC_RPC_8822B (FW LPS CONDITION -- RX PKT COUNTER) */ -+ -+#define BIT_SHIFT_FLC_RPC_8822B 0 -+#define BIT_MASK_FLC_RPC_8822B 0xff -+#define BIT_FLC_RPC_8822B(x) \ -+ (((x) & BIT_MASK_FLC_RPC_8822B) << BIT_SHIFT_FLC_RPC_8822B) -+#define BITS_FLC_RPC_8822B (BIT_MASK_FLC_RPC_8822B << BIT_SHIFT_FLC_RPC_8822B) -+#define BIT_CLEAR_FLC_RPC_8822B(x) ((x) & (~BITS_FLC_RPC_8822B)) -+#define BIT_GET_FLC_RPC_8822B(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPC_8822B) & BIT_MASK_FLC_RPC_8822B) -+#define BIT_SET_FLC_RPC_8822B(x, v) \ -+ (BIT_CLEAR_FLC_RPC_8822B(x) | BIT_FLC_RPC_8822B(v)) -+ -+/* 2 REG_RXPKTMON_CTRL_8822B */ -+ -+#define BIT_SHIFT_RXBKQPKT_SEQ_8822B 20 -+#define BIT_MASK_RXBKQPKT_SEQ_8822B 0xf -+#define BIT_RXBKQPKT_SEQ_8822B(x) \ -+ (((x) & BIT_MASK_RXBKQPKT_SEQ_8822B) << BIT_SHIFT_RXBKQPKT_SEQ_8822B) -+#define BITS_RXBKQPKT_SEQ_8822B \ -+ (BIT_MASK_RXBKQPKT_SEQ_8822B << BIT_SHIFT_RXBKQPKT_SEQ_8822B) -+#define BIT_CLEAR_RXBKQPKT_SEQ_8822B(x) ((x) & (~BITS_RXBKQPKT_SEQ_8822B)) -+#define BIT_GET_RXBKQPKT_SEQ_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXBKQPKT_SEQ_8822B) & BIT_MASK_RXBKQPKT_SEQ_8822B) -+#define BIT_SET_RXBKQPKT_SEQ_8822B(x, v) \ -+ (BIT_CLEAR_RXBKQPKT_SEQ_8822B(x) | BIT_RXBKQPKT_SEQ_8822B(v)) -+ -+#define BIT_SHIFT_RXBEQPKT_SEQ_8822B 16 -+#define BIT_MASK_RXBEQPKT_SEQ_8822B 0xf -+#define BIT_RXBEQPKT_SEQ_8822B(x) \ -+ (((x) & BIT_MASK_RXBEQPKT_SEQ_8822B) << BIT_SHIFT_RXBEQPKT_SEQ_8822B) -+#define BITS_RXBEQPKT_SEQ_8822B \ -+ (BIT_MASK_RXBEQPKT_SEQ_8822B << BIT_SHIFT_RXBEQPKT_SEQ_8822B) -+#define BIT_CLEAR_RXBEQPKT_SEQ_8822B(x) ((x) & (~BITS_RXBEQPKT_SEQ_8822B)) -+#define BIT_GET_RXBEQPKT_SEQ_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXBEQPKT_SEQ_8822B) & BIT_MASK_RXBEQPKT_SEQ_8822B) -+#define BIT_SET_RXBEQPKT_SEQ_8822B(x, v) \ -+ (BIT_CLEAR_RXBEQPKT_SEQ_8822B(x) | BIT_RXBEQPKT_SEQ_8822B(v)) -+ -+#define BIT_SHIFT_RXVIQPKT_SEQ_8822B 12 -+#define BIT_MASK_RXVIQPKT_SEQ_8822B 0xf -+#define BIT_RXVIQPKT_SEQ_8822B(x) \ -+ (((x) & BIT_MASK_RXVIQPKT_SEQ_8822B) << BIT_SHIFT_RXVIQPKT_SEQ_8822B) -+#define BITS_RXVIQPKT_SEQ_8822B \ -+ (BIT_MASK_RXVIQPKT_SEQ_8822B << BIT_SHIFT_RXVIQPKT_SEQ_8822B) -+#define BIT_CLEAR_RXVIQPKT_SEQ_8822B(x) ((x) & (~BITS_RXVIQPKT_SEQ_8822B)) -+#define BIT_GET_RXVIQPKT_SEQ_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXVIQPKT_SEQ_8822B) & BIT_MASK_RXVIQPKT_SEQ_8822B) -+#define BIT_SET_RXVIQPKT_SEQ_8822B(x, v) \ -+ (BIT_CLEAR_RXVIQPKT_SEQ_8822B(x) | BIT_RXVIQPKT_SEQ_8822B(v)) -+ -+#define BIT_SHIFT_RXVOQPKT_SEQ_8822B 8 -+#define BIT_MASK_RXVOQPKT_SEQ_8822B 0xf -+#define BIT_RXVOQPKT_SEQ_8822B(x) \ -+ (((x) & BIT_MASK_RXVOQPKT_SEQ_8822B) << BIT_SHIFT_RXVOQPKT_SEQ_8822B) -+#define BITS_RXVOQPKT_SEQ_8822B \ -+ (BIT_MASK_RXVOQPKT_SEQ_8822B << BIT_SHIFT_RXVOQPKT_SEQ_8822B) -+#define BIT_CLEAR_RXVOQPKT_SEQ_8822B(x) ((x) & (~BITS_RXVOQPKT_SEQ_8822B)) -+#define BIT_GET_RXVOQPKT_SEQ_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXVOQPKT_SEQ_8822B) & BIT_MASK_RXVOQPKT_SEQ_8822B) -+#define BIT_SET_RXVOQPKT_SEQ_8822B(x, v) \ -+ (BIT_CLEAR_RXVOQPKT_SEQ_8822B(x) | BIT_RXVOQPKT_SEQ_8822B(v)) -+ -+#define BIT_RXBKQPKT_ERR_8822B BIT(7) -+#define BIT_RXBEQPKT_ERR_8822B BIT(6) -+#define BIT_RXVIQPKT_ERR_8822B BIT(5) -+#define BIT_RXVOQPKT_ERR_8822B BIT(4) -+#define BIT_RXDMA_MON_EN_8822B BIT(2) -+#define BIT_RXPKT_MON_RST_8822B BIT(1) -+#define BIT_RXPKT_MON_EN_8822B BIT(0) -+ -+/* 2 REG_STATE_MON_8822B */ -+ -+#define BIT_SHIFT_STATE_SEL_8822B 24 -+#define BIT_MASK_STATE_SEL_8822B 0x1f -+#define BIT_STATE_SEL_8822B(x) \ -+ (((x) & BIT_MASK_STATE_SEL_8822B) << BIT_SHIFT_STATE_SEL_8822B) -+#define BITS_STATE_SEL_8822B \ -+ (BIT_MASK_STATE_SEL_8822B << BIT_SHIFT_STATE_SEL_8822B) -+#define BIT_CLEAR_STATE_SEL_8822B(x) ((x) & (~BITS_STATE_SEL_8822B)) -+#define BIT_GET_STATE_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_STATE_SEL_8822B) & BIT_MASK_STATE_SEL_8822B) -+#define BIT_SET_STATE_SEL_8822B(x, v) \ -+ (BIT_CLEAR_STATE_SEL_8822B(x) | BIT_STATE_SEL_8822B(v)) -+ -+#define BIT_SHIFT_STATE_INFO_8822B 8 -+#define BIT_MASK_STATE_INFO_8822B 0xff -+#define BIT_STATE_INFO_8822B(x) \ -+ (((x) & BIT_MASK_STATE_INFO_8822B) << BIT_SHIFT_STATE_INFO_8822B) -+#define BITS_STATE_INFO_8822B \ -+ (BIT_MASK_STATE_INFO_8822B << BIT_SHIFT_STATE_INFO_8822B) -+#define BIT_CLEAR_STATE_INFO_8822B(x) ((x) & (~BITS_STATE_INFO_8822B)) -+#define BIT_GET_STATE_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_STATE_INFO_8822B) & BIT_MASK_STATE_INFO_8822B) -+#define BIT_SET_STATE_INFO_8822B(x, v) \ -+ (BIT_CLEAR_STATE_INFO_8822B(x) | BIT_STATE_INFO_8822B(v)) -+ -+#define BIT_UPD_NXT_STATE_8822B BIT(7) -+ -+#define BIT_SHIFT_CUR_STATE_8822B 0 -+#define BIT_MASK_CUR_STATE_8822B 0x7f -+#define BIT_CUR_STATE_8822B(x) \ -+ (((x) & BIT_MASK_CUR_STATE_8822B) << BIT_SHIFT_CUR_STATE_8822B) -+#define BITS_CUR_STATE_8822B \ -+ (BIT_MASK_CUR_STATE_8822B << BIT_SHIFT_CUR_STATE_8822B) -+#define BIT_CLEAR_CUR_STATE_8822B(x) ((x) & (~BITS_CUR_STATE_8822B)) -+#define BIT_GET_CUR_STATE_8822B(x) \ -+ (((x) >> BIT_SHIFT_CUR_STATE_8822B) & BIT_MASK_CUR_STATE_8822B) -+#define BIT_SET_CUR_STATE_8822B(x, v) \ -+ (BIT_CLEAR_CUR_STATE_8822B(x) | BIT_CUR_STATE_8822B(v)) -+ -+/* 2 REG_ERROR_MON_8822B */ -+#define BIT_MACRX_ERR_1_8822B BIT(17) -+#define BIT_MACRX_ERR_0_8822B BIT(16) -+#define BIT_MACTX_ERR_3_8822B BIT(3) -+#define BIT_MACTX_ERR_2_8822B BIT(2) -+#define BIT_MACTX_ERR_1_8822B BIT(1) -+#define BIT_MACTX_ERR_0_8822B BIT(0) -+ -+/* 2 REG_SEARCH_MACID_8822B */ -+#define BIT_EN_TXRPTBUF_CLK_8822B BIT(31) -+ -+#define BIT_SHIFT_INFO_INDEX_OFFSET_8822B 16 -+#define BIT_MASK_INFO_INDEX_OFFSET_8822B 0x1fff -+#define BIT_INFO_INDEX_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_INFO_INDEX_OFFSET_8822B) \ -+ << BIT_SHIFT_INFO_INDEX_OFFSET_8822B) -+#define BITS_INFO_INDEX_OFFSET_8822B \ -+ (BIT_MASK_INFO_INDEX_OFFSET_8822B << BIT_SHIFT_INFO_INDEX_OFFSET_8822B) -+#define BIT_CLEAR_INFO_INDEX_OFFSET_8822B(x) \ -+ ((x) & (~BITS_INFO_INDEX_OFFSET_8822B)) -+#define BIT_GET_INFO_INDEX_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_INFO_INDEX_OFFSET_8822B) & \ -+ BIT_MASK_INFO_INDEX_OFFSET_8822B) -+#define BIT_SET_INFO_INDEX_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_INFO_INDEX_OFFSET_8822B(x) | BIT_INFO_INDEX_OFFSET_8822B(v)) -+ -+#define BIT_WMAC_SRCH_FIFOFULL_8822B BIT(15) -+#define BIT_DIS_INFOSRCH_8822B BIT(14) -+#define BIT_DISABLE_B0_8822B BIT(13) -+ -+#define BIT_SHIFT_INFO_ADDR_OFFSET_8822B 0 -+#define BIT_MASK_INFO_ADDR_OFFSET_8822B 0x1fff -+#define BIT_INFO_ADDR_OFFSET_8822B(x) \ -+ (((x) & BIT_MASK_INFO_ADDR_OFFSET_8822B) \ -+ << BIT_SHIFT_INFO_ADDR_OFFSET_8822B) -+#define BITS_INFO_ADDR_OFFSET_8822B \ -+ (BIT_MASK_INFO_ADDR_OFFSET_8822B << BIT_SHIFT_INFO_ADDR_OFFSET_8822B) -+#define BIT_CLEAR_INFO_ADDR_OFFSET_8822B(x) \ -+ ((x) & (~BITS_INFO_ADDR_OFFSET_8822B)) -+#define BIT_GET_INFO_ADDR_OFFSET_8822B(x) \ -+ (((x) >> BIT_SHIFT_INFO_ADDR_OFFSET_8822B) & \ -+ BIT_MASK_INFO_ADDR_OFFSET_8822B) -+#define BIT_SET_INFO_ADDR_OFFSET_8822B(x, v) \ -+ (BIT_CLEAR_INFO_ADDR_OFFSET_8822B(x) | BIT_INFO_ADDR_OFFSET_8822B(v)) -+ -+/* 2 REG_BT_COEX_TABLE_8822B (BT-COEXISTENCE CONTROL REGISTER) */ -+#define BIT_PRI_MASK_RX_RESP_8822B BIT(126) -+#define BIT_PRI_MASK_RXOFDM_8822B BIT(125) -+#define BIT_PRI_MASK_RXCCK_8822B BIT(124) -+ -+#define BIT_SHIFT_PRI_MASK_TXAC_8822B (117 & CPU_OPT_WIDTH) -+#define BIT_MASK_PRI_MASK_TXAC_8822B 0x7f -+#define BIT_PRI_MASK_TXAC_8822B(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TXAC_8822B) << BIT_SHIFT_PRI_MASK_TXAC_8822B) -+#define BITS_PRI_MASK_TXAC_8822B \ -+ (BIT_MASK_PRI_MASK_TXAC_8822B << BIT_SHIFT_PRI_MASK_TXAC_8822B) -+#define BIT_CLEAR_PRI_MASK_TXAC_8822B(x) ((x) & (~BITS_PRI_MASK_TXAC_8822B)) -+#define BIT_GET_PRI_MASK_TXAC_8822B(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TXAC_8822B) & BIT_MASK_PRI_MASK_TXAC_8822B) -+#define BIT_SET_PRI_MASK_TXAC_8822B(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TXAC_8822B(x) | BIT_PRI_MASK_TXAC_8822B(v)) -+ -+#define BIT_SHIFT_PRI_MASK_NAV_8822B (109 & CPU_OPT_WIDTH) -+#define BIT_MASK_PRI_MASK_NAV_8822B 0xff -+#define BIT_PRI_MASK_NAV_8822B(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NAV_8822B) << BIT_SHIFT_PRI_MASK_NAV_8822B) -+#define BITS_PRI_MASK_NAV_8822B \ -+ (BIT_MASK_PRI_MASK_NAV_8822B << BIT_SHIFT_PRI_MASK_NAV_8822B) -+#define BIT_CLEAR_PRI_MASK_NAV_8822B(x) ((x) & (~BITS_PRI_MASK_NAV_8822B)) -+#define BIT_GET_PRI_MASK_NAV_8822B(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NAV_8822B) & BIT_MASK_PRI_MASK_NAV_8822B) -+#define BIT_SET_PRI_MASK_NAV_8822B(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NAV_8822B(x) | BIT_PRI_MASK_NAV_8822B(v)) -+ -+#define BIT_PRI_MASK_CCK_8822B BIT(108) -+#define BIT_PRI_MASK_OFDM_8822B BIT(107) -+#define BIT_PRI_MASK_RTY_8822B BIT(106) -+ -+#define BIT_SHIFT_PRI_MASK_NUM_8822B (102 & CPU_OPT_WIDTH) -+#define BIT_MASK_PRI_MASK_NUM_8822B 0xf -+#define BIT_PRI_MASK_NUM_8822B(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NUM_8822B) << BIT_SHIFT_PRI_MASK_NUM_8822B) -+#define BITS_PRI_MASK_NUM_8822B \ -+ (BIT_MASK_PRI_MASK_NUM_8822B << BIT_SHIFT_PRI_MASK_NUM_8822B) -+#define BIT_CLEAR_PRI_MASK_NUM_8822B(x) ((x) & (~BITS_PRI_MASK_NUM_8822B)) -+#define BIT_GET_PRI_MASK_NUM_8822B(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NUM_8822B) & BIT_MASK_PRI_MASK_NUM_8822B) -+#define BIT_SET_PRI_MASK_NUM_8822B(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NUM_8822B(x) | BIT_PRI_MASK_NUM_8822B(v)) -+ -+#define BIT_SHIFT_PRI_MASK_TYPE_8822B (98 & CPU_OPT_WIDTH) -+#define BIT_MASK_PRI_MASK_TYPE_8822B 0xf -+#define BIT_PRI_MASK_TYPE_8822B(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TYPE_8822B) << BIT_SHIFT_PRI_MASK_TYPE_8822B) -+#define BITS_PRI_MASK_TYPE_8822B \ -+ (BIT_MASK_PRI_MASK_TYPE_8822B << BIT_SHIFT_PRI_MASK_TYPE_8822B) -+#define BIT_CLEAR_PRI_MASK_TYPE_8822B(x) ((x) & (~BITS_PRI_MASK_TYPE_8822B)) -+#define BIT_GET_PRI_MASK_TYPE_8822B(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TYPE_8822B) & BIT_MASK_PRI_MASK_TYPE_8822B) -+#define BIT_SET_PRI_MASK_TYPE_8822B(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TYPE_8822B(x) | BIT_PRI_MASK_TYPE_8822B(v)) -+ -+#define BIT_OOB_8822B BIT(97) -+#define BIT_ANT_SEL_8822B BIT(96) -+ -+#define BIT_SHIFT_BREAK_TABLE_2_8822B (80 & CPU_OPT_WIDTH) -+#define BIT_MASK_BREAK_TABLE_2_8822B 0xffff -+#define BIT_BREAK_TABLE_2_8822B(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_2_8822B) << BIT_SHIFT_BREAK_TABLE_2_8822B) -+#define BITS_BREAK_TABLE_2_8822B \ -+ (BIT_MASK_BREAK_TABLE_2_8822B << BIT_SHIFT_BREAK_TABLE_2_8822B) -+#define BIT_CLEAR_BREAK_TABLE_2_8822B(x) ((x) & (~BITS_BREAK_TABLE_2_8822B)) -+#define BIT_GET_BREAK_TABLE_2_8822B(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_2_8822B) & BIT_MASK_BREAK_TABLE_2_8822B) -+#define BIT_SET_BREAK_TABLE_2_8822B(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_2_8822B(x) | BIT_BREAK_TABLE_2_8822B(v)) -+ -+#define BIT_SHIFT_BREAK_TABLE_1_8822B (64 & CPU_OPT_WIDTH) -+#define BIT_MASK_BREAK_TABLE_1_8822B 0xffff -+#define BIT_BREAK_TABLE_1_8822B(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_1_8822B) << BIT_SHIFT_BREAK_TABLE_1_8822B) -+#define BITS_BREAK_TABLE_1_8822B \ -+ (BIT_MASK_BREAK_TABLE_1_8822B << BIT_SHIFT_BREAK_TABLE_1_8822B) -+#define BIT_CLEAR_BREAK_TABLE_1_8822B(x) ((x) & (~BITS_BREAK_TABLE_1_8822B)) -+#define BIT_GET_BREAK_TABLE_1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_1_8822B) & BIT_MASK_BREAK_TABLE_1_8822B) -+#define BIT_SET_BREAK_TABLE_1_8822B(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_1_8822B(x) | BIT_BREAK_TABLE_1_8822B(v)) -+ -+#define BIT_SHIFT_COEX_TABLE_2_8822B (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_COEX_TABLE_2_8822B 0xffffffffL -+#define BIT_COEX_TABLE_2_8822B(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_2_8822B) << BIT_SHIFT_COEX_TABLE_2_8822B) -+#define BITS_COEX_TABLE_2_8822B \ -+ (BIT_MASK_COEX_TABLE_2_8822B << BIT_SHIFT_COEX_TABLE_2_8822B) -+#define BIT_CLEAR_COEX_TABLE_2_8822B(x) ((x) & (~BITS_COEX_TABLE_2_8822B)) -+#define BIT_GET_COEX_TABLE_2_8822B(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_2_8822B) & BIT_MASK_COEX_TABLE_2_8822B) -+#define BIT_SET_COEX_TABLE_2_8822B(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_2_8822B(x) | BIT_COEX_TABLE_2_8822B(v)) -+ -+#define BIT_SHIFT_COEX_TABLE_1_8822B 0 -+#define BIT_MASK_COEX_TABLE_1_8822B 0xffffffffL -+#define BIT_COEX_TABLE_1_8822B(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_1_8822B) << BIT_SHIFT_COEX_TABLE_1_8822B) -+#define BITS_COEX_TABLE_1_8822B \ -+ (BIT_MASK_COEX_TABLE_1_8822B << BIT_SHIFT_COEX_TABLE_1_8822B) -+#define BIT_CLEAR_COEX_TABLE_1_8822B(x) ((x) & (~BITS_COEX_TABLE_1_8822B)) -+#define BIT_GET_COEX_TABLE_1_8822B(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_1_8822B) & BIT_MASK_COEX_TABLE_1_8822B) -+#define BIT_SET_COEX_TABLE_1_8822B(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_1_8822B(x) | BIT_COEX_TABLE_1_8822B(v)) -+ -+/* 2 REG_RXCMD_0_8822B */ -+#define BIT_RXCMD_EN_8822B BIT(31) -+ -+#define BIT_SHIFT_RXCMD_INFO_8822B 0 -+#define BIT_MASK_RXCMD_INFO_8822B 0x7fffffffL -+#define BIT_RXCMD_INFO_8822B(x) \ -+ (((x) & BIT_MASK_RXCMD_INFO_8822B) << BIT_SHIFT_RXCMD_INFO_8822B) -+#define BITS_RXCMD_INFO_8822B \ -+ (BIT_MASK_RXCMD_INFO_8822B << BIT_SHIFT_RXCMD_INFO_8822B) -+#define BIT_CLEAR_RXCMD_INFO_8822B(x) ((x) & (~BITS_RXCMD_INFO_8822B)) -+#define BIT_GET_RXCMD_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_INFO_8822B) & BIT_MASK_RXCMD_INFO_8822B) -+#define BIT_SET_RXCMD_INFO_8822B(x, v) \ -+ (BIT_CLEAR_RXCMD_INFO_8822B(x) | BIT_RXCMD_INFO_8822B(v)) -+ -+/* 2 REG_RXCMD_1_8822B */ -+ -+#define BIT_SHIFT_RXCMD_PRD_8822B 0 -+#define BIT_MASK_RXCMD_PRD_8822B 0xffff -+#define BIT_RXCMD_PRD_8822B(x) \ -+ (((x) & BIT_MASK_RXCMD_PRD_8822B) << BIT_SHIFT_RXCMD_PRD_8822B) -+#define BITS_RXCMD_PRD_8822B \ -+ (BIT_MASK_RXCMD_PRD_8822B << BIT_SHIFT_RXCMD_PRD_8822B) -+#define BIT_CLEAR_RXCMD_PRD_8822B(x) ((x) & (~BITS_RXCMD_PRD_8822B)) -+#define BIT_GET_RXCMD_PRD_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_PRD_8822B) & BIT_MASK_RXCMD_PRD_8822B) -+#define BIT_SET_RXCMD_PRD_8822B(x, v) \ -+ (BIT_CLEAR_RXCMD_PRD_8822B(x) | BIT_RXCMD_PRD_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_WMAC_RESP_TXINFO_8822B (RESPONSE TXINFO REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_MFB_8822B 25 -+#define BIT_MASK_WMAC_RESP_MFB_8822B 0x7f -+#define BIT_WMAC_RESP_MFB_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_MFB_8822B) << BIT_SHIFT_WMAC_RESP_MFB_8822B) -+#define BITS_WMAC_RESP_MFB_8822B \ -+ (BIT_MASK_WMAC_RESP_MFB_8822B << BIT_SHIFT_WMAC_RESP_MFB_8822B) -+#define BIT_CLEAR_WMAC_RESP_MFB_8822B(x) ((x) & (~BITS_WMAC_RESP_MFB_8822B)) -+#define BIT_GET_WMAC_RESP_MFB_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_MFB_8822B) & BIT_MASK_WMAC_RESP_MFB_8822B) -+#define BIT_SET_WMAC_RESP_MFB_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_MFB_8822B(x) | BIT_WMAC_RESP_MFB_8822B(v)) -+ -+#define BIT_SHIFT_WMAC_ANTINF_SEL_8822B 23 -+#define BIT_MASK_WMAC_ANTINF_SEL_8822B 0x3 -+#define BIT_WMAC_ANTINF_SEL_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_ANTINF_SEL_8822B) \ -+ << BIT_SHIFT_WMAC_ANTINF_SEL_8822B) -+#define BITS_WMAC_ANTINF_SEL_8822B \ -+ (BIT_MASK_WMAC_ANTINF_SEL_8822B << BIT_SHIFT_WMAC_ANTINF_SEL_8822B) -+#define BIT_CLEAR_WMAC_ANTINF_SEL_8822B(x) ((x) & (~BITS_WMAC_ANTINF_SEL_8822B)) -+#define BIT_GET_WMAC_ANTINF_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTINF_SEL_8822B) & \ -+ BIT_MASK_WMAC_ANTINF_SEL_8822B) -+#define BIT_SET_WMAC_ANTINF_SEL_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_ANTINF_SEL_8822B(x) | BIT_WMAC_ANTINF_SEL_8822B(v)) -+ -+#define BIT_SHIFT_WMAC_ANTSEL_SEL_8822B 21 -+#define BIT_MASK_WMAC_ANTSEL_SEL_8822B 0x3 -+#define BIT_WMAC_ANTSEL_SEL_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_ANTSEL_SEL_8822B) \ -+ << BIT_SHIFT_WMAC_ANTSEL_SEL_8822B) -+#define BITS_WMAC_ANTSEL_SEL_8822B \ -+ (BIT_MASK_WMAC_ANTSEL_SEL_8822B << BIT_SHIFT_WMAC_ANTSEL_SEL_8822B) -+#define BIT_CLEAR_WMAC_ANTSEL_SEL_8822B(x) ((x) & (~BITS_WMAC_ANTSEL_SEL_8822B)) -+#define BIT_GET_WMAC_ANTSEL_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTSEL_SEL_8822B) & \ -+ BIT_MASK_WMAC_ANTSEL_SEL_8822B) -+#define BIT_SET_WMAC_ANTSEL_SEL_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_ANTSEL_SEL_8822B(x) | BIT_WMAC_ANTSEL_SEL_8822B(v)) -+ -+#define BIT_SHIFT_R_WMAC_RESP_TXPOWER_8822B 18 -+#define BIT_MASK_R_WMAC_RESP_TXPOWER_8822B 0x7 -+#define BIT_R_WMAC_RESP_TXPOWER_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_RESP_TXPOWER_8822B) \ -+ << BIT_SHIFT_R_WMAC_RESP_TXPOWER_8822B) -+#define BITS_R_WMAC_RESP_TXPOWER_8822B \ -+ (BIT_MASK_R_WMAC_RESP_TXPOWER_8822B \ -+ << BIT_SHIFT_R_WMAC_RESP_TXPOWER_8822B) -+#define BIT_CLEAR_R_WMAC_RESP_TXPOWER_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_RESP_TXPOWER_8822B)) -+#define BIT_GET_R_WMAC_RESP_TXPOWER_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RESP_TXPOWER_8822B) & \ -+ BIT_MASK_R_WMAC_RESP_TXPOWER_8822B) -+#define BIT_SET_R_WMAC_RESP_TXPOWER_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_RESP_TXPOWER_8822B(x) | \ -+ BIT_R_WMAC_RESP_TXPOWER_8822B(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXANT_8822B 0 -+#define BIT_MASK_WMAC_RESP_TXANT_8822B 0x3ffff -+#define BIT_WMAC_RESP_TXANT_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXANT_8822B) \ -+ << BIT_SHIFT_WMAC_RESP_TXANT_8822B) -+#define BITS_WMAC_RESP_TXANT_8822B \ -+ (BIT_MASK_WMAC_RESP_TXANT_8822B << BIT_SHIFT_WMAC_RESP_TXANT_8822B) -+#define BIT_CLEAR_WMAC_RESP_TXANT_8822B(x) ((x) & (~BITS_WMAC_RESP_TXANT_8822B)) -+#define BIT_GET_WMAC_RESP_TXANT_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXANT_8822B) & \ -+ BIT_MASK_WMAC_RESP_TXANT_8822B) -+#define BIT_SET_WMAC_RESP_TXANT_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXANT_8822B(x) | BIT_WMAC_RESP_TXANT_8822B(v)) -+ -+/* 2 REG_BBPSF_CTRL_8822B */ -+#define BIT_CTL_IDLE_CLR_CSI_RPT_8822B BIT(31) -+#define BIT_WMAC_USE_NDPARATE_8822B BIT(30) -+ -+#define BIT_SHIFT_WMAC_CSI_RATE_8822B 24 -+#define BIT_MASK_WMAC_CSI_RATE_8822B 0x3f -+#define BIT_WMAC_CSI_RATE_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_CSI_RATE_8822B) << BIT_SHIFT_WMAC_CSI_RATE_8822B) -+#define BITS_WMAC_CSI_RATE_8822B \ -+ (BIT_MASK_WMAC_CSI_RATE_8822B << BIT_SHIFT_WMAC_CSI_RATE_8822B) -+#define BIT_CLEAR_WMAC_CSI_RATE_8822B(x) ((x) & (~BITS_WMAC_CSI_RATE_8822B)) -+#define BIT_GET_WMAC_CSI_RATE_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_CSI_RATE_8822B) & BIT_MASK_WMAC_CSI_RATE_8822B) -+#define BIT_SET_WMAC_CSI_RATE_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_CSI_RATE_8822B(x) | BIT_WMAC_CSI_RATE_8822B(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXRATE_8822B 16 -+#define BIT_MASK_WMAC_RESP_TXRATE_8822B 0xff -+#define BIT_WMAC_RESP_TXRATE_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXRATE_8822B) \ -+ << BIT_SHIFT_WMAC_RESP_TXRATE_8822B) -+#define BITS_WMAC_RESP_TXRATE_8822B \ -+ (BIT_MASK_WMAC_RESP_TXRATE_8822B << BIT_SHIFT_WMAC_RESP_TXRATE_8822B) -+#define BIT_CLEAR_WMAC_RESP_TXRATE_8822B(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXRATE_8822B)) -+#define BIT_GET_WMAC_RESP_TXRATE_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXRATE_8822B) & \ -+ BIT_MASK_WMAC_RESP_TXRATE_8822B) -+#define BIT_SET_WMAC_RESP_TXRATE_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXRATE_8822B(x) | BIT_WMAC_RESP_TXRATE_8822B(v)) -+ -+#define BIT_BBPSF_MPDUCHKEN_8822B BIT(5) -+#define BIT_BBPSF_MHCHKEN_8822B BIT(4) -+#define BIT_BBPSF_ERRCHKEN_8822B BIT(3) -+ -+#define BIT_SHIFT_BBPSF_ERRTHR_8822B 0 -+#define BIT_MASK_BBPSF_ERRTHR_8822B 0x7 -+#define BIT_BBPSF_ERRTHR_8822B(x) \ -+ (((x) & BIT_MASK_BBPSF_ERRTHR_8822B) << BIT_SHIFT_BBPSF_ERRTHR_8822B) -+#define BITS_BBPSF_ERRTHR_8822B \ -+ (BIT_MASK_BBPSF_ERRTHR_8822B << BIT_SHIFT_BBPSF_ERRTHR_8822B) -+#define BIT_CLEAR_BBPSF_ERRTHR_8822B(x) ((x) & (~BITS_BBPSF_ERRTHR_8822B)) -+#define BIT_GET_BBPSF_ERRTHR_8822B(x) \ -+ (((x) >> BIT_SHIFT_BBPSF_ERRTHR_8822B) & BIT_MASK_BBPSF_ERRTHR_8822B) -+#define BIT_SET_BBPSF_ERRTHR_8822B(x, v) \ -+ (BIT_CLEAR_BBPSF_ERRTHR_8822B(x) | BIT_BBPSF_ERRTHR_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_P2P_RX_BCN_NOA_8822B (P2P RX BEACON NOA REGISTER) */ -+#define BIT_NOA_PARSER_EN_8822B BIT(15) -+#define BIT_BSSID_SEL_8822B BIT(14) -+ -+#define BIT_SHIFT_P2P_OUI_TYPE_8822B 0 -+#define BIT_MASK_P2P_OUI_TYPE_8822B 0xff -+#define BIT_P2P_OUI_TYPE_8822B(x) \ -+ (((x) & BIT_MASK_P2P_OUI_TYPE_8822B) << BIT_SHIFT_P2P_OUI_TYPE_8822B) -+#define BITS_P2P_OUI_TYPE_8822B \ -+ (BIT_MASK_P2P_OUI_TYPE_8822B << BIT_SHIFT_P2P_OUI_TYPE_8822B) -+#define BIT_CLEAR_P2P_OUI_TYPE_8822B(x) ((x) & (~BITS_P2P_OUI_TYPE_8822B)) -+#define BIT_GET_P2P_OUI_TYPE_8822B(x) \ -+ (((x) >> BIT_SHIFT_P2P_OUI_TYPE_8822B) & BIT_MASK_P2P_OUI_TYPE_8822B) -+#define BIT_SET_P2P_OUI_TYPE_8822B(x, v) \ -+ (BIT_CLEAR_P2P_OUI_TYPE_8822B(x) | BIT_P2P_OUI_TYPE_8822B(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_8822B (ASSOCIATED BEAMFORMER0 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID0_8822B (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_TXCSI_AID0_8822B 0x1ff -+#define BIT_R_WMAC_TXCSI_AID0_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID0_8822B) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID0_8822B) -+#define BITS_R_WMAC_TXCSI_AID0_8822B \ -+ (BIT_MASK_R_WMAC_TXCSI_AID0_8822B << BIT_SHIFT_R_WMAC_TXCSI_AID0_8822B) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID0_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID0_8822B)) -+#define BIT_GET_R_WMAC_TXCSI_AID0_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID0_8822B) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID0_8822B) -+#define BIT_SET_R_WMAC_TXCSI_AID0_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID0_8822B(x) | BIT_R_WMAC_TXCSI_AID0_8822B(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_8822B 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_8822B 0xffffffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_8822B) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_8822B) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_8822B \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_8822B \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_8822B) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_8822B)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_8822B) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_8822B) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_8822B(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_8822B(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_8822B (ASSOCIATED BEAMFORMER1 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID1_8822B (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_TXCSI_AID1_8822B 0x1ff -+#define BIT_R_WMAC_TXCSI_AID1_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID1_8822B) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID1_8822B) -+#define BITS_R_WMAC_TXCSI_AID1_8822B \ -+ (BIT_MASK_R_WMAC_TXCSI_AID1_8822B << BIT_SHIFT_R_WMAC_TXCSI_AID1_8822B) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID1_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID1_8822B)) -+#define BIT_GET_R_WMAC_TXCSI_AID1_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID1_8822B) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID1_8822B) -+#define BIT_SET_R_WMAC_TXCSI_AID1_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID1_8822B(x) | BIT_R_WMAC_TXCSI_AID1_8822B(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_8822B 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_8822B 0xffffffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_8822B) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_8822B) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_8822B \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_8822B \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_8822B) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_8822B)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_8822B) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_8822B) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_8822B(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_8822B(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW20_8822B (TX CSI REPORT PARAMETER REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_1_8822B 16 -+#define BIT_MASK_R_WMAC_BFINFO_20M_1_8822B 0xfff -+#define BIT_R_WMAC_BFINFO_20M_1_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_1_8822B) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8822B) -+#define BITS_R_WMAC_BFINFO_20M_1_8822B \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_1_8822B \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8822B) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_1_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_1_8822B)) -+#define BIT_GET_R_WMAC_BFINFO_20M_1_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_1_8822B) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_1_8822B) -+#define BIT_SET_R_WMAC_BFINFO_20M_1_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_1_8822B(x) | \ -+ BIT_R_WMAC_BFINFO_20M_1_8822B(v)) -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_0_8822B 0 -+#define BIT_MASK_R_WMAC_BFINFO_20M_0_8822B 0xfff -+#define BIT_R_WMAC_BFINFO_20M_0_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_0_8822B) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8822B) -+#define BITS_R_WMAC_BFINFO_20M_0_8822B \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_0_8822B \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8822B) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_0_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_0_8822B)) -+#define BIT_GET_R_WMAC_BFINFO_20M_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_0_8822B) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_0_8822B) -+#define BIT_SET_R_WMAC_BFINFO_20M_0_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_0_8822B(x) | \ -+ BIT_R_WMAC_BFINFO_20M_0_8822B(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW40_8822B (TX CSI REPORT PARAMETER_BW40 REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_ANTCD_8822B 0 -+#define BIT_MASK_WMAC_RESP_ANTCD_8822B 0xf -+#define BIT_WMAC_RESP_ANTCD_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTCD_8822B) \ -+ << BIT_SHIFT_WMAC_RESP_ANTCD_8822B) -+#define BITS_WMAC_RESP_ANTCD_8822B \ -+ (BIT_MASK_WMAC_RESP_ANTCD_8822B << BIT_SHIFT_WMAC_RESP_ANTCD_8822B) -+#define BIT_CLEAR_WMAC_RESP_ANTCD_8822B(x) ((x) & (~BITS_WMAC_RESP_ANTCD_8822B)) -+#define BIT_GET_WMAC_RESP_ANTCD_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTCD_8822B) & \ -+ BIT_MASK_WMAC_RESP_ANTCD_8822B) -+#define BIT_SET_WMAC_RESP_ANTCD_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTCD_8822B(x) | BIT_WMAC_RESP_ANTCD_8822B(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW80_8822B (TX CSI REPORT PARAMETER_BW80 REGISTER) */ -+ -+/* 2 REG_BCN_PSR_RPT2_8822B (BEACON PARSER REPORT REGISTER2) */ -+ -+#define BIT_SHIFT_DTIM_CNT2_8822B 24 -+#define BIT_MASK_DTIM_CNT2_8822B 0xff -+#define BIT_DTIM_CNT2_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_CNT2_8822B) << BIT_SHIFT_DTIM_CNT2_8822B) -+#define BITS_DTIM_CNT2_8822B \ -+ (BIT_MASK_DTIM_CNT2_8822B << BIT_SHIFT_DTIM_CNT2_8822B) -+#define BIT_CLEAR_DTIM_CNT2_8822B(x) ((x) & (~BITS_DTIM_CNT2_8822B)) -+#define BIT_GET_DTIM_CNT2_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT2_8822B) & BIT_MASK_DTIM_CNT2_8822B) -+#define BIT_SET_DTIM_CNT2_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_CNT2_8822B(x) | BIT_DTIM_CNT2_8822B(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD2_8822B 16 -+#define BIT_MASK_DTIM_PERIOD2_8822B 0xff -+#define BIT_DTIM_PERIOD2_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD2_8822B) << BIT_SHIFT_DTIM_PERIOD2_8822B) -+#define BITS_DTIM_PERIOD2_8822B \ -+ (BIT_MASK_DTIM_PERIOD2_8822B << BIT_SHIFT_DTIM_PERIOD2_8822B) -+#define BIT_CLEAR_DTIM_PERIOD2_8822B(x) ((x) & (~BITS_DTIM_PERIOD2_8822B)) -+#define BIT_GET_DTIM_PERIOD2_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD2_8822B) & BIT_MASK_DTIM_PERIOD2_8822B) -+#define BIT_SET_DTIM_PERIOD2_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD2_8822B(x) | BIT_DTIM_PERIOD2_8822B(v)) -+ -+#define BIT_DTIM2_8822B BIT(15) -+#define BIT_TIM2_8822B BIT(14) -+ -+#define BIT_SHIFT_PS_AID_2_8822B 0 -+#define BIT_MASK_PS_AID_2_8822B 0x7ff -+#define BIT_PS_AID_2_8822B(x) \ -+ (((x) & BIT_MASK_PS_AID_2_8822B) << BIT_SHIFT_PS_AID_2_8822B) -+#define BITS_PS_AID_2_8822B \ -+ (BIT_MASK_PS_AID_2_8822B << BIT_SHIFT_PS_AID_2_8822B) -+#define BIT_CLEAR_PS_AID_2_8822B(x) ((x) & (~BITS_PS_AID_2_8822B)) -+#define BIT_GET_PS_AID_2_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_2_8822B) & BIT_MASK_PS_AID_2_8822B) -+#define BIT_SET_PS_AID_2_8822B(x, v) \ -+ (BIT_CLEAR_PS_AID_2_8822B(x) | BIT_PS_AID_2_8822B(v)) -+ -+/* 2 REG_BCN_PSR_RPT3_8822B (BEACON PARSER REPORT REGISTER3) */ -+ -+#define BIT_SHIFT_DTIM_CNT3_8822B 24 -+#define BIT_MASK_DTIM_CNT3_8822B 0xff -+#define BIT_DTIM_CNT3_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_CNT3_8822B) << BIT_SHIFT_DTIM_CNT3_8822B) -+#define BITS_DTIM_CNT3_8822B \ -+ (BIT_MASK_DTIM_CNT3_8822B << BIT_SHIFT_DTIM_CNT3_8822B) -+#define BIT_CLEAR_DTIM_CNT3_8822B(x) ((x) & (~BITS_DTIM_CNT3_8822B)) -+#define BIT_GET_DTIM_CNT3_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT3_8822B) & BIT_MASK_DTIM_CNT3_8822B) -+#define BIT_SET_DTIM_CNT3_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_CNT3_8822B(x) | BIT_DTIM_CNT3_8822B(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD3_8822B 16 -+#define BIT_MASK_DTIM_PERIOD3_8822B 0xff -+#define BIT_DTIM_PERIOD3_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD3_8822B) << BIT_SHIFT_DTIM_PERIOD3_8822B) -+#define BITS_DTIM_PERIOD3_8822B \ -+ (BIT_MASK_DTIM_PERIOD3_8822B << BIT_SHIFT_DTIM_PERIOD3_8822B) -+#define BIT_CLEAR_DTIM_PERIOD3_8822B(x) ((x) & (~BITS_DTIM_PERIOD3_8822B)) -+#define BIT_GET_DTIM_PERIOD3_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD3_8822B) & BIT_MASK_DTIM_PERIOD3_8822B) -+#define BIT_SET_DTIM_PERIOD3_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD3_8822B(x) | BIT_DTIM_PERIOD3_8822B(v)) -+ -+#define BIT_DTIM3_8822B BIT(15) -+#define BIT_TIM3_8822B BIT(14) -+ -+#define BIT_SHIFT_PS_AID_3_8822B 0 -+#define BIT_MASK_PS_AID_3_8822B 0x7ff -+#define BIT_PS_AID_3_8822B(x) \ -+ (((x) & BIT_MASK_PS_AID_3_8822B) << BIT_SHIFT_PS_AID_3_8822B) -+#define BITS_PS_AID_3_8822B \ -+ (BIT_MASK_PS_AID_3_8822B << BIT_SHIFT_PS_AID_3_8822B) -+#define BIT_CLEAR_PS_AID_3_8822B(x) ((x) & (~BITS_PS_AID_3_8822B)) -+#define BIT_GET_PS_AID_3_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_3_8822B) & BIT_MASK_PS_AID_3_8822B) -+#define BIT_SET_PS_AID_3_8822B(x, v) \ -+ (BIT_CLEAR_PS_AID_3_8822B(x) | BIT_PS_AID_3_8822B(v)) -+ -+/* 2 REG_BCN_PSR_RPT4_8822B (BEACON PARSER REPORT REGISTER4) */ -+ -+#define BIT_SHIFT_DTIM_CNT4_8822B 24 -+#define BIT_MASK_DTIM_CNT4_8822B 0xff -+#define BIT_DTIM_CNT4_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_CNT4_8822B) << BIT_SHIFT_DTIM_CNT4_8822B) -+#define BITS_DTIM_CNT4_8822B \ -+ (BIT_MASK_DTIM_CNT4_8822B << BIT_SHIFT_DTIM_CNT4_8822B) -+#define BIT_CLEAR_DTIM_CNT4_8822B(x) ((x) & (~BITS_DTIM_CNT4_8822B)) -+#define BIT_GET_DTIM_CNT4_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT4_8822B) & BIT_MASK_DTIM_CNT4_8822B) -+#define BIT_SET_DTIM_CNT4_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_CNT4_8822B(x) | BIT_DTIM_CNT4_8822B(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD4_8822B 16 -+#define BIT_MASK_DTIM_PERIOD4_8822B 0xff -+#define BIT_DTIM_PERIOD4_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD4_8822B) << BIT_SHIFT_DTIM_PERIOD4_8822B) -+#define BITS_DTIM_PERIOD4_8822B \ -+ (BIT_MASK_DTIM_PERIOD4_8822B << BIT_SHIFT_DTIM_PERIOD4_8822B) -+#define BIT_CLEAR_DTIM_PERIOD4_8822B(x) ((x) & (~BITS_DTIM_PERIOD4_8822B)) -+#define BIT_GET_DTIM_PERIOD4_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD4_8822B) & BIT_MASK_DTIM_PERIOD4_8822B) -+#define BIT_SET_DTIM_PERIOD4_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD4_8822B(x) | BIT_DTIM_PERIOD4_8822B(v)) -+ -+#define BIT_DTIM4_8822B BIT(15) -+#define BIT_TIM4_8822B BIT(14) -+ -+#define BIT_SHIFT_PS_AID_4_8822B 0 -+#define BIT_MASK_PS_AID_4_8822B 0x7ff -+#define BIT_PS_AID_4_8822B(x) \ -+ (((x) & BIT_MASK_PS_AID_4_8822B) << BIT_SHIFT_PS_AID_4_8822B) -+#define BITS_PS_AID_4_8822B \ -+ (BIT_MASK_PS_AID_4_8822B << BIT_SHIFT_PS_AID_4_8822B) -+#define BIT_CLEAR_PS_AID_4_8822B(x) ((x) & (~BITS_PS_AID_4_8822B)) -+#define BIT_GET_PS_AID_4_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_4_8822B) & BIT_MASK_PS_AID_4_8822B) -+#define BIT_SET_PS_AID_4_8822B(x, v) \ -+ (BIT_CLEAR_PS_AID_4_8822B(x) | BIT_PS_AID_4_8822B(v)) -+ -+/* 2 REG_A1_ADDR_MASK_8822B (A1 ADDR MASK REGISTER) */ -+ -+#define BIT_SHIFT_A1_ADDR_MASK_8822B 0 -+#define BIT_MASK_A1_ADDR_MASK_8822B 0xffffffffL -+#define BIT_A1_ADDR_MASK_8822B(x) \ -+ (((x) & BIT_MASK_A1_ADDR_MASK_8822B) << BIT_SHIFT_A1_ADDR_MASK_8822B) -+#define BITS_A1_ADDR_MASK_8822B \ -+ (BIT_MASK_A1_ADDR_MASK_8822B << BIT_SHIFT_A1_ADDR_MASK_8822B) -+#define BIT_CLEAR_A1_ADDR_MASK_8822B(x) ((x) & (~BITS_A1_ADDR_MASK_8822B)) -+#define BIT_GET_A1_ADDR_MASK_8822B(x) \ -+ (((x) >> BIT_SHIFT_A1_ADDR_MASK_8822B) & BIT_MASK_A1_ADDR_MASK_8822B) -+#define BIT_SET_A1_ADDR_MASK_8822B(x, v) \ -+ (BIT_CLEAR_A1_ADDR_MASK_8822B(x) | BIT_A1_ADDR_MASK_8822B(v)) -+ -+/* 2 REG_MACID2_8822B (MAC ID2 REGISTER) */ -+ -+#define BIT_SHIFT_MACID2_8822B 0 -+#define BIT_MASK_MACID2_8822B 0xffffffffffffL -+#define BIT_MACID2_8822B(x) \ -+ (((x) & BIT_MASK_MACID2_8822B) << BIT_SHIFT_MACID2_8822B) -+#define BITS_MACID2_8822B (BIT_MASK_MACID2_8822B << BIT_SHIFT_MACID2_8822B) -+#define BIT_CLEAR_MACID2_8822B(x) ((x) & (~BITS_MACID2_8822B)) -+#define BIT_GET_MACID2_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID2_8822B) & BIT_MASK_MACID2_8822B) -+#define BIT_SET_MACID2_8822B(x, v) \ -+ (BIT_CLEAR_MACID2_8822B(x) | BIT_MACID2_8822B(v)) -+ -+/* 2 REG_BSSID2_8822B (BSSID2 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID2_8822B 0 -+#define BIT_MASK_BSSID2_8822B 0xffffffffffffL -+#define BIT_BSSID2_8822B(x) \ -+ (((x) & BIT_MASK_BSSID2_8822B) << BIT_SHIFT_BSSID2_8822B) -+#define BITS_BSSID2_8822B (BIT_MASK_BSSID2_8822B << BIT_SHIFT_BSSID2_8822B) -+#define BIT_CLEAR_BSSID2_8822B(x) ((x) & (~BITS_BSSID2_8822B)) -+#define BIT_GET_BSSID2_8822B(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_8822B) & BIT_MASK_BSSID2_8822B) -+#define BIT_SET_BSSID2_8822B(x, v) \ -+ (BIT_CLEAR_BSSID2_8822B(x) | BIT_BSSID2_8822B(v)) -+ -+/* 2 REG_MACID3_8822B (MAC ID3 REGISTER) */ -+ -+#define BIT_SHIFT_MACID3_8822B 0 -+#define BIT_MASK_MACID3_8822B 0xffffffffffffL -+#define BIT_MACID3_8822B(x) \ -+ (((x) & BIT_MASK_MACID3_8822B) << BIT_SHIFT_MACID3_8822B) -+#define BITS_MACID3_8822B (BIT_MASK_MACID3_8822B << BIT_SHIFT_MACID3_8822B) -+#define BIT_CLEAR_MACID3_8822B(x) ((x) & (~BITS_MACID3_8822B)) -+#define BIT_GET_MACID3_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID3_8822B) & BIT_MASK_MACID3_8822B) -+#define BIT_SET_MACID3_8822B(x, v) \ -+ (BIT_CLEAR_MACID3_8822B(x) | BIT_MACID3_8822B(v)) -+ -+/* 2 REG_BSSID3_8822B (BSSID3 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID3_8822B 0 -+#define BIT_MASK_BSSID3_8822B 0xffffffffffffL -+#define BIT_BSSID3_8822B(x) \ -+ (((x) & BIT_MASK_BSSID3_8822B) << BIT_SHIFT_BSSID3_8822B) -+#define BITS_BSSID3_8822B (BIT_MASK_BSSID3_8822B << BIT_SHIFT_BSSID3_8822B) -+#define BIT_CLEAR_BSSID3_8822B(x) ((x) & (~BITS_BSSID3_8822B)) -+#define BIT_GET_BSSID3_8822B(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_8822B) & BIT_MASK_BSSID3_8822B) -+#define BIT_SET_BSSID3_8822B(x, v) \ -+ (BIT_CLEAR_BSSID3_8822B(x) | BIT_BSSID3_8822B(v)) -+ -+/* 2 REG_MACID4_8822B (MAC ID4 REGISTER) */ -+ -+#define BIT_SHIFT_MACID4_8822B 0 -+#define BIT_MASK_MACID4_8822B 0xffffffffffffL -+#define BIT_MACID4_8822B(x) \ -+ (((x) & BIT_MASK_MACID4_8822B) << BIT_SHIFT_MACID4_8822B) -+#define BITS_MACID4_8822B (BIT_MASK_MACID4_8822B << BIT_SHIFT_MACID4_8822B) -+#define BIT_CLEAR_MACID4_8822B(x) ((x) & (~BITS_MACID4_8822B)) -+#define BIT_GET_MACID4_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID4_8822B) & BIT_MASK_MACID4_8822B) -+#define BIT_SET_MACID4_8822B(x, v) \ -+ (BIT_CLEAR_MACID4_8822B(x) | BIT_MACID4_8822B(v)) -+ -+/* 2 REG_BSSID4_8822B (BSSID4 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID4_8822B 0 -+#define BIT_MASK_BSSID4_8822B 0xffffffffffffL -+#define BIT_BSSID4_8822B(x) \ -+ (((x) & BIT_MASK_BSSID4_8822B) << BIT_SHIFT_BSSID4_8822B) -+#define BITS_BSSID4_8822B (BIT_MASK_BSSID4_8822B << BIT_SHIFT_BSSID4_8822B) -+#define BIT_CLEAR_BSSID4_8822B(x) ((x) & (~BITS_BSSID4_8822B)) -+#define BIT_GET_BSSID4_8822B(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_8822B) & BIT_MASK_BSSID4_8822B) -+#define BIT_SET_BSSID4_8822B(x, v) \ -+ (BIT_CLEAR_BSSID4_8822B(x) | BIT_BSSID4_8822B(v)) -+ -+/* 2 REG_NOA_REPORT_8822B */ -+ -+/* 2 REG_PWRBIT_SETTING_8822B */ -+#define BIT_CLI3_PWRBIT_OW_EN_8822B BIT(7) -+#define BIT_CLI3_PWR_ST_8822B BIT(6) -+#define BIT_CLI2_PWRBIT_OW_EN_8822B BIT(5) -+#define BIT_CLI2_PWR_ST_8822B BIT(4) -+#define BIT_CLI1_PWRBIT_OW_EN_8822B BIT(3) -+#define BIT_CLI1_PWR_ST_8822B BIT(2) -+#define BIT_CLI0_PWRBIT_OW_EN_8822B BIT(1) -+#define BIT_CLI0_PWR_ST_8822B BIT(0) -+ -+/* 2 REG_MACRX_HANG_TIMER_CONTROL_8822B */ -+#define BIT_TIMEOUT_COUNTER_EN_8822B BIT(7) -+#define BIT_RESET_FIFO_CONTROL_8822B BIT(5) -+ -+#define BIT_SHIFT_COUNT_TIMEOUT_8822B 0 -+#define BIT_MASK_COUNT_TIMEOUT_8822B 0x1f -+#define BIT_COUNT_TIMEOUT_8822B(x) \ -+ (((x) & BIT_MASK_COUNT_TIMEOUT_8822B) << BIT_SHIFT_COUNT_TIMEOUT_8822B) -+#define BITS_COUNT_TIMEOUT_8822B \ -+ (BIT_MASK_COUNT_TIMEOUT_8822B << BIT_SHIFT_COUNT_TIMEOUT_8822B) -+#define BIT_CLEAR_COUNT_TIMEOUT_8822B(x) ((x) & (~BITS_COUNT_TIMEOUT_8822B)) -+#define BIT_GET_COUNT_TIMEOUT_8822B(x) \ -+ (((x) >> BIT_SHIFT_COUNT_TIMEOUT_8822B) & BIT_MASK_COUNT_TIMEOUT_8822B) -+#define BIT_SET_COUNT_TIMEOUT_8822B(x, v) \ -+ (BIT_CLEAR_COUNT_TIMEOUT_8822B(x) | BIT_COUNT_TIMEOUT_8822B(v)) -+ -+/* 2 REG_WMAC_MU_BF_OPTION_8822B */ -+#define BIT_WMAC_RESP_NONSTA1_DIS_8822B BIT(7) -+#define BIT_BIT_WMAC_TXMU_ACKPOLICY_EN_8822B BIT(6) -+ -+#define BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8822B 4 -+#define BIT_MASK_WMAC_TXMU_ACKPOLICY_8822B 0x3 -+#define BIT_WMAC_TXMU_ACKPOLICY_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_TXMU_ACKPOLICY_8822B) \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8822B) -+#define BITS_WMAC_TXMU_ACKPOLICY_8822B \ -+ (BIT_MASK_WMAC_TXMU_ACKPOLICY_8822B \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8822B) -+#define BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8822B(x) \ -+ ((x) & (~BITS_WMAC_TXMU_ACKPOLICY_8822B)) -+#define BIT_GET_WMAC_TXMU_ACKPOLICY_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8822B) & \ -+ BIT_MASK_WMAC_TXMU_ACKPOLICY_8822B) -+#define BIT_SET_WMAC_TXMU_ACKPOLICY_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8822B(x) | \ -+ BIT_WMAC_TXMU_ACKPOLICY_8822B(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8822B 1 -+#define BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8822B 0x7 -+#define BIT_WMAC_MU_BFEE_PORT_SEL_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8822B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8822B) -+#define BITS_WMAC_MU_BFEE_PORT_SEL_8822B \ -+ (BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8822B \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8822B) -+#define BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8822B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE_PORT_SEL_8822B)) -+#define BIT_GET_WMAC_MU_BFEE_PORT_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8822B) & \ -+ BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8822B) -+#define BIT_SET_WMAC_MU_BFEE_PORT_SEL_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8822B(x) | \ -+ BIT_WMAC_MU_BFEE_PORT_SEL_8822B(v)) -+ -+#define BIT_WMAC_MU_BFEE_DIS_8822B BIT(0) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8822B 0 -+#define BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8822B 0xff -+#define BIT_WMAC_PAUSE_BB_CLR_TH_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8822B) \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8822B) -+#define BITS_WMAC_PAUSE_BB_CLR_TH_8822B \ -+ (BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8822B \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8822B) -+#define BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8822B(x) \ -+ ((x) & (~BITS_WMAC_PAUSE_BB_CLR_TH_8822B)) -+#define BIT_GET_WMAC_PAUSE_BB_CLR_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8822B) & \ -+ BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8822B) -+#define BIT_SET_WMAC_PAUSE_BB_CLR_TH_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8822B(x) | \ -+ BIT_WMAC_PAUSE_BB_CLR_TH_8822B(v)) -+ -+/* 2 REG_WMAC_MU_ARB_8822B */ -+#define BIT_WMAC_ARB_HW_ADAPT_EN_8822B BIT(7) -+#define BIT_WMAC_ARB_SW_EN_8822B BIT(6) -+ -+#define BIT_SHIFT_WMAC_ARB_SW_STATE_8822B 0 -+#define BIT_MASK_WMAC_ARB_SW_STATE_8822B 0x3f -+#define BIT_WMAC_ARB_SW_STATE_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_ARB_SW_STATE_8822B) \ -+ << BIT_SHIFT_WMAC_ARB_SW_STATE_8822B) -+#define BITS_WMAC_ARB_SW_STATE_8822B \ -+ (BIT_MASK_WMAC_ARB_SW_STATE_8822B << BIT_SHIFT_WMAC_ARB_SW_STATE_8822B) -+#define BIT_CLEAR_WMAC_ARB_SW_STATE_8822B(x) \ -+ ((x) & (~BITS_WMAC_ARB_SW_STATE_8822B)) -+#define BIT_GET_WMAC_ARB_SW_STATE_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARB_SW_STATE_8822B) & \ -+ BIT_MASK_WMAC_ARB_SW_STATE_8822B) -+#define BIT_SET_WMAC_ARB_SW_STATE_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_ARB_SW_STATE_8822B(x) | BIT_WMAC_ARB_SW_STATE_8822B(v)) -+ -+/* 2 REG_WMAC_MU_OPTION_8822B */ -+ -+#define BIT_SHIFT_WMAC_MU_DBGSEL_8822B 5 -+#define BIT_MASK_WMAC_MU_DBGSEL_8822B 0x3 -+#define BIT_WMAC_MU_DBGSEL_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_DBGSEL_8822B) \ -+ << BIT_SHIFT_WMAC_MU_DBGSEL_8822B) -+#define BITS_WMAC_MU_DBGSEL_8822B \ -+ (BIT_MASK_WMAC_MU_DBGSEL_8822B << BIT_SHIFT_WMAC_MU_DBGSEL_8822B) -+#define BIT_CLEAR_WMAC_MU_DBGSEL_8822B(x) ((x) & (~BITS_WMAC_MU_DBGSEL_8822B)) -+#define BIT_GET_WMAC_MU_DBGSEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_DBGSEL_8822B) & \ -+ BIT_MASK_WMAC_MU_DBGSEL_8822B) -+#define BIT_SET_WMAC_MU_DBGSEL_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_DBGSEL_8822B(x) | BIT_WMAC_MU_DBGSEL_8822B(v)) -+ -+#define BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8822B 0 -+#define BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8822B 0x1f -+#define BIT_WMAC_MU_CPRD_TIMEOUT_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8822B) \ -+ << BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8822B) -+#define BITS_WMAC_MU_CPRD_TIMEOUT_8822B \ -+ (BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8822B \ -+ << BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8822B) -+#define BIT_CLEAR_WMAC_MU_CPRD_TIMEOUT_8822B(x) \ -+ ((x) & (~BITS_WMAC_MU_CPRD_TIMEOUT_8822B)) -+#define BIT_GET_WMAC_MU_CPRD_TIMEOUT_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_CPRD_TIMEOUT_8822B) & \ -+ BIT_MASK_WMAC_MU_CPRD_TIMEOUT_8822B) -+#define BIT_SET_WMAC_MU_CPRD_TIMEOUT_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_CPRD_TIMEOUT_8822B(x) | \ -+ BIT_WMAC_MU_CPRD_TIMEOUT_8822B(v)) -+ -+/* 2 REG_WMAC_MU_BF_CTL_8822B */ -+#define BIT_WMAC_INVLD_BFPRT_CHK_8822B BIT(15) -+#define BIT_WMAC_RETXBFRPTSEQ_UPD_8822B BIT(14) -+ -+#define BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8822B 12 -+#define BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8822B 0x3 -+#define BIT_WMAC_MU_BFRPTSEG_SEL_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8822B) \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8822B) -+#define BITS_WMAC_MU_BFRPTSEG_SEL_8822B \ -+ (BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8822B \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8822B) -+#define BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8822B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFRPTSEG_SEL_8822B)) -+#define BIT_GET_WMAC_MU_BFRPTSEG_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8822B) & \ -+ BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8822B) -+#define BIT_SET_WMAC_MU_BFRPTSEG_SEL_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8822B(x) | \ -+ BIT_WMAC_MU_BFRPTSEG_SEL_8822B(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BF_MYAID_8822B 0 -+#define BIT_MASK_WMAC_MU_BF_MYAID_8822B 0xfff -+#define BIT_WMAC_MU_BF_MYAID_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BF_MYAID_8822B) \ -+ << BIT_SHIFT_WMAC_MU_BF_MYAID_8822B) -+#define BITS_WMAC_MU_BF_MYAID_8822B \ -+ (BIT_MASK_WMAC_MU_BF_MYAID_8822B << BIT_SHIFT_WMAC_MU_BF_MYAID_8822B) -+#define BIT_CLEAR_WMAC_MU_BF_MYAID_8822B(x) \ -+ ((x) & (~BITS_WMAC_MU_BF_MYAID_8822B)) -+#define BIT_GET_WMAC_MU_BF_MYAID_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BF_MYAID_8822B) & \ -+ BIT_MASK_WMAC_MU_BF_MYAID_8822B) -+#define BIT_SET_WMAC_MU_BF_MYAID_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BF_MYAID_8822B(x) | BIT_WMAC_MU_BF_MYAID_8822B(v)) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA_8822B */ -+ -+#define BIT_SHIFT_BIT_BFRPT_PARA_USERID_SEL_8822B 12 -+#define BIT_MASK_BIT_BFRPT_PARA_USERID_SEL_8822B 0x7 -+#define BIT_BIT_BFRPT_PARA_USERID_SEL_8822B(x) \ -+ (((x) & BIT_MASK_BIT_BFRPT_PARA_USERID_SEL_8822B) \ -+ << BIT_SHIFT_BIT_BFRPT_PARA_USERID_SEL_8822B) -+#define BITS_BIT_BFRPT_PARA_USERID_SEL_8822B \ -+ (BIT_MASK_BIT_BFRPT_PARA_USERID_SEL_8822B \ -+ << BIT_SHIFT_BIT_BFRPT_PARA_USERID_SEL_8822B) -+#define BIT_CLEAR_BIT_BFRPT_PARA_USERID_SEL_8822B(x) \ -+ ((x) & (~BITS_BIT_BFRPT_PARA_USERID_SEL_8822B)) -+#define BIT_GET_BIT_BFRPT_PARA_USERID_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_BIT_BFRPT_PARA_USERID_SEL_8822B) & \ -+ BIT_MASK_BIT_BFRPT_PARA_USERID_SEL_8822B) -+#define BIT_SET_BIT_BFRPT_PARA_USERID_SEL_8822B(x, v) \ -+ (BIT_CLEAR_BIT_BFRPT_PARA_USERID_SEL_8822B(x) | \ -+ BIT_BIT_BFRPT_PARA_USERID_SEL_8822B(v)) -+ -+#define BIT_SHIFT_BFRPT_PARA_8822B 0 -+#define BIT_MASK_BFRPT_PARA_8822B 0xfff -+#define BIT_BFRPT_PARA_8822B(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_8822B) << BIT_SHIFT_BFRPT_PARA_8822B) -+#define BITS_BFRPT_PARA_8822B \ -+ (BIT_MASK_BFRPT_PARA_8822B << BIT_SHIFT_BFRPT_PARA_8822B) -+#define BIT_CLEAR_BFRPT_PARA_8822B(x) ((x) & (~BITS_BFRPT_PARA_8822B)) -+#define BIT_GET_BFRPT_PARA_8822B(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_8822B) & BIT_MASK_BFRPT_PARA_8822B) -+#define BIT_SET_BFRPT_PARA_8822B(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_8822B(x) | BIT_BFRPT_PARA_8822B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE2_8822B */ -+#define BIT_STATUS_BFEE2_8822B BIT(10) -+#define BIT_WMAC_MU_BFEE2_EN_8822B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE2_AID_8822B 0 -+#define BIT_MASK_WMAC_MU_BFEE2_AID_8822B 0x1ff -+#define BIT_WMAC_MU_BFEE2_AID_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE2_AID_8822B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE2_AID_8822B) -+#define BITS_WMAC_MU_BFEE2_AID_8822B \ -+ (BIT_MASK_WMAC_MU_BFEE2_AID_8822B << BIT_SHIFT_WMAC_MU_BFEE2_AID_8822B) -+#define BIT_CLEAR_WMAC_MU_BFEE2_AID_8822B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE2_AID_8822B)) -+#define BIT_GET_WMAC_MU_BFEE2_AID_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE2_AID_8822B) & \ -+ BIT_MASK_WMAC_MU_BFEE2_AID_8822B) -+#define BIT_SET_WMAC_MU_BFEE2_AID_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE2_AID_8822B(x) | BIT_WMAC_MU_BFEE2_AID_8822B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE3_8822B */ -+#define BIT_STATUS_BFEE3_8822B BIT(10) -+#define BIT_WMAC_MU_BFEE3_EN_8822B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE3_AID_8822B 0 -+#define BIT_MASK_WMAC_MU_BFEE3_AID_8822B 0x1ff -+#define BIT_WMAC_MU_BFEE3_AID_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE3_AID_8822B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE3_AID_8822B) -+#define BITS_WMAC_MU_BFEE3_AID_8822B \ -+ (BIT_MASK_WMAC_MU_BFEE3_AID_8822B << BIT_SHIFT_WMAC_MU_BFEE3_AID_8822B) -+#define BIT_CLEAR_WMAC_MU_BFEE3_AID_8822B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE3_AID_8822B)) -+#define BIT_GET_WMAC_MU_BFEE3_AID_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE3_AID_8822B) & \ -+ BIT_MASK_WMAC_MU_BFEE3_AID_8822B) -+#define BIT_SET_WMAC_MU_BFEE3_AID_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE3_AID_8822B(x) | BIT_WMAC_MU_BFEE3_AID_8822B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE4_8822B */ -+#define BIT_STATUS_BFEE4_8822B BIT(10) -+#define BIT_WMAC_MU_BFEE4_EN_8822B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE4_AID_8822B 0 -+#define BIT_MASK_WMAC_MU_BFEE4_AID_8822B 0x1ff -+#define BIT_WMAC_MU_BFEE4_AID_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE4_AID_8822B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE4_AID_8822B) -+#define BITS_WMAC_MU_BFEE4_AID_8822B \ -+ (BIT_MASK_WMAC_MU_BFEE4_AID_8822B << BIT_SHIFT_WMAC_MU_BFEE4_AID_8822B) -+#define BIT_CLEAR_WMAC_MU_BFEE4_AID_8822B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE4_AID_8822B)) -+#define BIT_GET_WMAC_MU_BFEE4_AID_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE4_AID_8822B) & \ -+ BIT_MASK_WMAC_MU_BFEE4_AID_8822B) -+#define BIT_SET_WMAC_MU_BFEE4_AID_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE4_AID_8822B(x) | BIT_WMAC_MU_BFEE4_AID_8822B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE5_8822B */ -+#define BIT_STATUS_BFEE5_8822B BIT(10) -+#define BIT_WMAC_MU_BFEE5_EN_8822B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE5_AID_8822B 0 -+#define BIT_MASK_WMAC_MU_BFEE5_AID_8822B 0x1ff -+#define BIT_WMAC_MU_BFEE5_AID_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE5_AID_8822B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE5_AID_8822B) -+#define BITS_WMAC_MU_BFEE5_AID_8822B \ -+ (BIT_MASK_WMAC_MU_BFEE5_AID_8822B << BIT_SHIFT_WMAC_MU_BFEE5_AID_8822B) -+#define BIT_CLEAR_WMAC_MU_BFEE5_AID_8822B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE5_AID_8822B)) -+#define BIT_GET_WMAC_MU_BFEE5_AID_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE5_AID_8822B) & \ -+ BIT_MASK_WMAC_MU_BFEE5_AID_8822B) -+#define BIT_SET_WMAC_MU_BFEE5_AID_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE5_AID_8822B(x) | BIT_WMAC_MU_BFEE5_AID_8822B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE6_8822B */ -+#define BIT_STATUS_BFEE6_8822B BIT(10) -+#define BIT_WMAC_MU_BFEE6_EN_8822B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE6_AID_8822B 0 -+#define BIT_MASK_WMAC_MU_BFEE6_AID_8822B 0x1ff -+#define BIT_WMAC_MU_BFEE6_AID_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE6_AID_8822B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE6_AID_8822B) -+#define BITS_WMAC_MU_BFEE6_AID_8822B \ -+ (BIT_MASK_WMAC_MU_BFEE6_AID_8822B << BIT_SHIFT_WMAC_MU_BFEE6_AID_8822B) -+#define BIT_CLEAR_WMAC_MU_BFEE6_AID_8822B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE6_AID_8822B)) -+#define BIT_GET_WMAC_MU_BFEE6_AID_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE6_AID_8822B) & \ -+ BIT_MASK_WMAC_MU_BFEE6_AID_8822B) -+#define BIT_SET_WMAC_MU_BFEE6_AID_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE6_AID_8822B(x) | BIT_WMAC_MU_BFEE6_AID_8822B(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE7_8822B */ -+#define BIT_STATUS_BFEE7_8822B BIT(10) -+#define BIT_WMAC_MU_BFEE7_EN_8822B BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE7_AID_8822B 0 -+#define BIT_MASK_WMAC_MU_BFEE7_AID_8822B 0x1ff -+#define BIT_WMAC_MU_BFEE7_AID_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE7_AID_8822B) \ -+ << BIT_SHIFT_WMAC_MU_BFEE7_AID_8822B) -+#define BITS_WMAC_MU_BFEE7_AID_8822B \ -+ (BIT_MASK_WMAC_MU_BFEE7_AID_8822B << BIT_SHIFT_WMAC_MU_BFEE7_AID_8822B) -+#define BIT_CLEAR_WMAC_MU_BFEE7_AID_8822B(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE7_AID_8822B)) -+#define BIT_GET_WMAC_MU_BFEE7_AID_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE7_AID_8822B) & \ -+ BIT_MASK_WMAC_MU_BFEE7_AID_8822B) -+#define BIT_SET_WMAC_MU_BFEE7_AID_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE7_AID_8822B(x) | BIT_WMAC_MU_BFEE7_AID_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+#define BIT_RST_ALL_COUNTER_8822B BIT(31) -+ -+#define BIT_SHIFT_ABORT_RX_VBON_COUNTER_8822B 16 -+#define BIT_MASK_ABORT_RX_VBON_COUNTER_8822B 0xff -+#define BIT_ABORT_RX_VBON_COUNTER_8822B(x) \ -+ (((x) & BIT_MASK_ABORT_RX_VBON_COUNTER_8822B) \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8822B) -+#define BITS_ABORT_RX_VBON_COUNTER_8822B \ -+ (BIT_MASK_ABORT_RX_VBON_COUNTER_8822B \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8822B) -+#define BIT_CLEAR_ABORT_RX_VBON_COUNTER_8822B(x) \ -+ ((x) & (~BITS_ABORT_RX_VBON_COUNTER_8822B)) -+#define BIT_GET_ABORT_RX_VBON_COUNTER_8822B(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_VBON_COUNTER_8822B) & \ -+ BIT_MASK_ABORT_RX_VBON_COUNTER_8822B) -+#define BIT_SET_ABORT_RX_VBON_COUNTER_8822B(x, v) \ -+ (BIT_CLEAR_ABORT_RX_VBON_COUNTER_8822B(x) | \ -+ BIT_ABORT_RX_VBON_COUNTER_8822B(v)) -+ -+#define BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8822B 8 -+#define BIT_MASK_ABORT_RX_RDRDY_COUNTER_8822B 0xff -+#define BIT_ABORT_RX_RDRDY_COUNTER_8822B(x) \ -+ (((x) & BIT_MASK_ABORT_RX_RDRDY_COUNTER_8822B) \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8822B) -+#define BITS_ABORT_RX_RDRDY_COUNTER_8822B \ -+ (BIT_MASK_ABORT_RX_RDRDY_COUNTER_8822B \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8822B) -+#define BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8822B(x) \ -+ ((x) & (~BITS_ABORT_RX_RDRDY_COUNTER_8822B)) -+#define BIT_GET_ABORT_RX_RDRDY_COUNTER_8822B(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8822B) & \ -+ BIT_MASK_ABORT_RX_RDRDY_COUNTER_8822B) -+#define BIT_SET_ABORT_RX_RDRDY_COUNTER_8822B(x, v) \ -+ (BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8822B(x) | \ -+ BIT_ABORT_RX_RDRDY_COUNTER_8822B(v)) -+ -+#define BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8822B 0 -+#define BIT_MASK_VBON_EARLY_FALLING_COUNTER_8822B 0xff -+#define BIT_VBON_EARLY_FALLING_COUNTER_8822B(x) \ -+ (((x) & BIT_MASK_VBON_EARLY_FALLING_COUNTER_8822B) \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8822B) -+#define BITS_VBON_EARLY_FALLING_COUNTER_8822B \ -+ (BIT_MASK_VBON_EARLY_FALLING_COUNTER_8822B \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8822B) -+#define BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8822B(x) \ -+ ((x) & (~BITS_VBON_EARLY_FALLING_COUNTER_8822B)) -+#define BIT_GET_VBON_EARLY_FALLING_COUNTER_8822B(x) \ -+ (((x) >> BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8822B) & \ -+ BIT_MASK_VBON_EARLY_FALLING_COUNTER_8822B) -+#define BIT_SET_VBON_EARLY_FALLING_COUNTER_8822B(x, v) \ -+ (BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8822B(x) | \ -+ BIT_VBON_EARLY_FALLING_COUNTER_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+#define BIT_WMAC_PLCP_TRX_SEL_8822B BIT(31) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8822B 28 -+#define BIT_MASK_WMAC_PLCP_RDSIG_SEL_8822B 0x7 -+#define BIT_WMAC_PLCP_RDSIG_SEL_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_SEL_8822B) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8822B) -+#define BITS_WMAC_PLCP_RDSIG_SEL_8822B \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_SEL_8822B \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8822B) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8822B(x) \ -+ ((x) & (~BITS_WMAC_PLCP_RDSIG_SEL_8822B)) -+#define BIT_GET_WMAC_PLCP_RDSIG_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8822B) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_SEL_8822B) -+#define BIT_SET_WMAC_PLCP_RDSIG_SEL_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8822B(x) | \ -+ BIT_WMAC_PLCP_RDSIG_SEL_8822B(v)) -+ -+#define BIT_SHIFT_WMAC_RATE_IDX_8822B 24 -+#define BIT_MASK_WMAC_RATE_IDX_8822B 0xf -+#define BIT_WMAC_RATE_IDX_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_RATE_IDX_8822B) << BIT_SHIFT_WMAC_RATE_IDX_8822B) -+#define BITS_WMAC_RATE_IDX_8822B \ -+ (BIT_MASK_WMAC_RATE_IDX_8822B << BIT_SHIFT_WMAC_RATE_IDX_8822B) -+#define BIT_CLEAR_WMAC_RATE_IDX_8822B(x) ((x) & (~BITS_WMAC_RATE_IDX_8822B)) -+#define BIT_GET_WMAC_RATE_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RATE_IDX_8822B) & BIT_MASK_WMAC_RATE_IDX_8822B) -+#define BIT_SET_WMAC_RATE_IDX_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_RATE_IDX_8822B(x) | BIT_WMAC_RATE_IDX_8822B(v)) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_8822B 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG_8822B 0xffffff -+#define BIT_WMAC_PLCP_RDSIG_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_8822B) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_8822B) -+#define BITS_WMAC_PLCP_RDSIG_8822B \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_8822B << BIT_SHIFT_WMAC_PLCP_RDSIG_8822B) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_8822B(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_8822B)) -+#define BIT_GET_WMAC_PLCP_RDSIG_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_8822B) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_8822B) -+#define BIT_SET_WMAC_PLCP_RDSIG_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_8822B(x) | BIT_WMAC_PLCP_RDSIG_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+#define BIT_WMAC_MUTX_IDX_8822B BIT(24) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_8822B 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG_8822B 0xffffff -+#define BIT_WMAC_PLCP_RDSIG_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_8822B) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_8822B) -+#define BITS_WMAC_PLCP_RDSIG_8822B \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_8822B << BIT_SHIFT_WMAC_PLCP_RDSIG_8822B) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_8822B(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_8822B)) -+#define BIT_GET_WMAC_PLCP_RDSIG_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_8822B) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_8822B) -+#define BIT_SET_WMAC_PLCP_RDSIG_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_8822B(x) | BIT_WMAC_PLCP_RDSIG_8822B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_8822B (TA0 REGISTER) */ -+ -+#define BIT_SHIFT_TA0_8822B 0 -+#define BIT_MASK_TA0_8822B 0xffffffffffffL -+#define BIT_TA0_8822B(x) (((x) & BIT_MASK_TA0_8822B) << BIT_SHIFT_TA0_8822B) -+#define BITS_TA0_8822B (BIT_MASK_TA0_8822B << BIT_SHIFT_TA0_8822B) -+#define BIT_CLEAR_TA0_8822B(x) ((x) & (~BITS_TA0_8822B)) -+#define BIT_GET_TA0_8822B(x) (((x) >> BIT_SHIFT_TA0_8822B) & BIT_MASK_TA0_8822B) -+#define BIT_SET_TA0_8822B(x, v) (BIT_CLEAR_TA0_8822B(x) | BIT_TA0_8822B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_8822B (TA1 REGISTER) */ -+ -+#define BIT_SHIFT_TA1_8822B 0 -+#define BIT_MASK_TA1_8822B 0xffffffffffffL -+#define BIT_TA1_8822B(x) (((x) & BIT_MASK_TA1_8822B) << BIT_SHIFT_TA1_8822B) -+#define BITS_TA1_8822B (BIT_MASK_TA1_8822B << BIT_SHIFT_TA1_8822B) -+#define BIT_CLEAR_TA1_8822B(x) ((x) & (~BITS_TA1_8822B)) -+#define BIT_GET_TA1_8822B(x) (((x) >> BIT_SHIFT_TA1_8822B) & BIT_MASK_TA1_8822B) -+#define BIT_SET_TA1_8822B(x, v) (BIT_CLEAR_TA1_8822B(x) | BIT_TA1_8822B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_8822B (TA2 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_8822B 0 -+#define BIT_MASK_TA2_8822B 0xffffffffffffL -+#define BIT_TA2_8822B(x) (((x) & BIT_MASK_TA2_8822B) << BIT_SHIFT_TA2_8822B) -+#define BITS_TA2_8822B (BIT_MASK_TA2_8822B << BIT_SHIFT_TA2_8822B) -+#define BIT_CLEAR_TA2_8822B(x) ((x) & (~BITS_TA2_8822B)) -+#define BIT_GET_TA2_8822B(x) (((x) >> BIT_SHIFT_TA2_8822B) & BIT_MASK_TA2_8822B) -+#define BIT_SET_TA2_8822B(x, v) (BIT_CLEAR_TA2_8822B(x) | BIT_TA2_8822B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_8822B (TA3 REGISTER) */ -+ -+#define BIT_SHIFT_TA3_8822B 0 -+#define BIT_MASK_TA3_8822B 0xffffffffffffL -+#define BIT_TA3_8822B(x) (((x) & BIT_MASK_TA3_8822B) << BIT_SHIFT_TA3_8822B) -+#define BITS_TA3_8822B (BIT_MASK_TA3_8822B << BIT_SHIFT_TA3_8822B) -+#define BIT_CLEAR_TA3_8822B(x) ((x) & (~BITS_TA3_8822B)) -+#define BIT_GET_TA3_8822B(x) (((x) >> BIT_SHIFT_TA3_8822B) & BIT_MASK_TA3_8822B) -+#define BIT_SET_TA3_8822B(x, v) (BIT_CLEAR_TA3_8822B(x) | BIT_TA3_8822B(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_8822B (TA4 REGISTER) */ -+ -+#define BIT_SHIFT_TA4_8822B 0 -+#define BIT_MASK_TA4_8822B 0xffffffffffffL -+#define BIT_TA4_8822B(x) (((x) & BIT_MASK_TA4_8822B) << BIT_SHIFT_TA4_8822B) -+#define BITS_TA4_8822B (BIT_MASK_TA4_8822B << BIT_SHIFT_TA4_8822B) -+#define BIT_CLEAR_TA4_8822B(x) ((x) & (~BITS_TA4_8822B)) -+#define BIT_GET_TA4_8822B(x) (((x) >> BIT_SHIFT_TA4_8822B) & BIT_MASK_TA4_8822B) -+#define BIT_SET_TA4_8822B(x, v) (BIT_CLEAR_TA4_8822B(x) | BIT_TA4_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_MACID1_8822B */ -+ -+#define BIT_SHIFT_MACID1_8822B 0 -+#define BIT_MASK_MACID1_8822B 0xffffffffffffL -+#define BIT_MACID1_8822B(x) \ -+ (((x) & BIT_MASK_MACID1_8822B) << BIT_SHIFT_MACID1_8822B) -+#define BITS_MACID1_8822B (BIT_MASK_MACID1_8822B << BIT_SHIFT_MACID1_8822B) -+#define BIT_CLEAR_MACID1_8822B(x) ((x) & (~BITS_MACID1_8822B)) -+#define BIT_GET_MACID1_8822B(x) \ -+ (((x) >> BIT_SHIFT_MACID1_8822B) & BIT_MASK_MACID1_8822B) -+#define BIT_SET_MACID1_8822B(x, v) \ -+ (BIT_CLEAR_MACID1_8822B(x) | BIT_MACID1_8822B(v)) -+ -+/* 2 REG_BSSID1_8822B */ -+ -+#define BIT_SHIFT_BSSID1_8822B 0 -+#define BIT_MASK_BSSID1_8822B 0xffffffffffffL -+#define BIT_BSSID1_8822B(x) \ -+ (((x) & BIT_MASK_BSSID1_8822B) << BIT_SHIFT_BSSID1_8822B) -+#define BITS_BSSID1_8822B (BIT_MASK_BSSID1_8822B << BIT_SHIFT_BSSID1_8822B) -+#define BIT_CLEAR_BSSID1_8822B(x) ((x) & (~BITS_BSSID1_8822B)) -+#define BIT_GET_BSSID1_8822B(x) \ -+ (((x) >> BIT_SHIFT_BSSID1_8822B) & BIT_MASK_BSSID1_8822B) -+#define BIT_SET_BSSID1_8822B(x, v) \ -+ (BIT_CLEAR_BSSID1_8822B(x) | BIT_BSSID1_8822B(v)) -+ -+/* 2 REG_BCN_PSR_RPT1_8822B */ -+ -+#define BIT_SHIFT_DTIM_CNT1_8822B 24 -+#define BIT_MASK_DTIM_CNT1_8822B 0xff -+#define BIT_DTIM_CNT1_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_CNT1_8822B) << BIT_SHIFT_DTIM_CNT1_8822B) -+#define BITS_DTIM_CNT1_8822B \ -+ (BIT_MASK_DTIM_CNT1_8822B << BIT_SHIFT_DTIM_CNT1_8822B) -+#define BIT_CLEAR_DTIM_CNT1_8822B(x) ((x) & (~BITS_DTIM_CNT1_8822B)) -+#define BIT_GET_DTIM_CNT1_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT1_8822B) & BIT_MASK_DTIM_CNT1_8822B) -+#define BIT_SET_DTIM_CNT1_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_CNT1_8822B(x) | BIT_DTIM_CNT1_8822B(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD1_8822B 16 -+#define BIT_MASK_DTIM_PERIOD1_8822B 0xff -+#define BIT_DTIM_PERIOD1_8822B(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD1_8822B) << BIT_SHIFT_DTIM_PERIOD1_8822B) -+#define BITS_DTIM_PERIOD1_8822B \ -+ (BIT_MASK_DTIM_PERIOD1_8822B << BIT_SHIFT_DTIM_PERIOD1_8822B) -+#define BIT_CLEAR_DTIM_PERIOD1_8822B(x) ((x) & (~BITS_DTIM_PERIOD1_8822B)) -+#define BIT_GET_DTIM_PERIOD1_8822B(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD1_8822B) & BIT_MASK_DTIM_PERIOD1_8822B) -+#define BIT_SET_DTIM_PERIOD1_8822B(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD1_8822B(x) | BIT_DTIM_PERIOD1_8822B(v)) -+ -+#define BIT_DTIM1_8822B BIT(15) -+#define BIT_TIM1_8822B BIT(14) -+ -+#define BIT_SHIFT_PS_AID_1_8822B 0 -+#define BIT_MASK_PS_AID_1_8822B 0x7ff -+#define BIT_PS_AID_1_8822B(x) \ -+ (((x) & BIT_MASK_PS_AID_1_8822B) << BIT_SHIFT_PS_AID_1_8822B) -+#define BITS_PS_AID_1_8822B \ -+ (BIT_MASK_PS_AID_1_8822B << BIT_SHIFT_PS_AID_1_8822B) -+#define BIT_CLEAR_PS_AID_1_8822B(x) ((x) & (~BITS_PS_AID_1_8822B)) -+#define BIT_GET_PS_AID_1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_1_8822B) & BIT_MASK_PS_AID_1_8822B) -+#define BIT_SET_PS_AID_1_8822B(x, v) \ -+ (BIT_CLEAR_PS_AID_1_8822B(x) | BIT_PS_AID_1_8822B(v)) -+ -+/* 2 REG_ASSOCIATED_BFMEE_SEL_8822B */ -+#define BIT_TXUSER_ID1_8822B BIT(25) -+ -+#define BIT_SHIFT_AID1_8822B 16 -+#define BIT_MASK_AID1_8822B 0x1ff -+#define BIT_AID1_8822B(x) (((x) & BIT_MASK_AID1_8822B) << BIT_SHIFT_AID1_8822B) -+#define BITS_AID1_8822B (BIT_MASK_AID1_8822B << BIT_SHIFT_AID1_8822B) -+#define BIT_CLEAR_AID1_8822B(x) ((x) & (~BITS_AID1_8822B)) -+#define BIT_GET_AID1_8822B(x) \ -+ (((x) >> BIT_SHIFT_AID1_8822B) & BIT_MASK_AID1_8822B) -+#define BIT_SET_AID1_8822B(x, v) (BIT_CLEAR_AID1_8822B(x) | BIT_AID1_8822B(v)) -+ -+#define BIT_TXUSER_ID0_8822B BIT(9) -+ -+#define BIT_SHIFT_AID0_8822B 0 -+#define BIT_MASK_AID0_8822B 0x1ff -+#define BIT_AID0_8822B(x) (((x) & BIT_MASK_AID0_8822B) << BIT_SHIFT_AID0_8822B) -+#define BITS_AID0_8822B (BIT_MASK_AID0_8822B << BIT_SHIFT_AID0_8822B) -+#define BIT_CLEAR_AID0_8822B(x) ((x) & (~BITS_AID0_8822B)) -+#define BIT_GET_AID0_8822B(x) \ -+ (((x) >> BIT_SHIFT_AID0_8822B) & BIT_MASK_AID0_8822B) -+#define BIT_SET_AID0_8822B(x, v) (BIT_CLEAR_AID0_8822B(x) | BIT_AID0_8822B(v)) -+ -+/* 2 REG_SND_PTCL_CTRL_8822B */ -+ -+#define BIT_SHIFT_NDP_RX_STANDBY_TIMER_8822B 24 -+#define BIT_MASK_NDP_RX_STANDBY_TIMER_8822B 0xff -+#define BIT_NDP_RX_STANDBY_TIMER_8822B(x) \ -+ (((x) & BIT_MASK_NDP_RX_STANDBY_TIMER_8822B) \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8822B) -+#define BITS_NDP_RX_STANDBY_TIMER_8822B \ -+ (BIT_MASK_NDP_RX_STANDBY_TIMER_8822B \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8822B) -+#define BIT_CLEAR_NDP_RX_STANDBY_TIMER_8822B(x) \ -+ ((x) & (~BITS_NDP_RX_STANDBY_TIMER_8822B)) -+#define BIT_GET_NDP_RX_STANDBY_TIMER_8822B(x) \ -+ (((x) >> BIT_SHIFT_NDP_RX_STANDBY_TIMER_8822B) & \ -+ BIT_MASK_NDP_RX_STANDBY_TIMER_8822B) -+#define BIT_SET_NDP_RX_STANDBY_TIMER_8822B(x, v) \ -+ (BIT_CLEAR_NDP_RX_STANDBY_TIMER_8822B(x) | \ -+ BIT_NDP_RX_STANDBY_TIMER_8822B(v)) -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8822B 16 -+#define BIT_MASK_CSI_RPT_OFFSET_HT_V1_8822B 0x3f -+#define BIT_CSI_RPT_OFFSET_HT_V1_8822B(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_HT_V1_8822B) \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8822B) -+#define BITS_CSI_RPT_OFFSET_HT_V1_8822B \ -+ (BIT_MASK_CSI_RPT_OFFSET_HT_V1_8822B \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8822B) -+#define BIT_CLEAR_CSI_RPT_OFFSET_HT_V1_8822B(x) \ -+ ((x) & (~BITS_CSI_RPT_OFFSET_HT_V1_8822B)) -+#define BIT_GET_CSI_RPT_OFFSET_HT_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8822B) & \ -+ BIT_MASK_CSI_RPT_OFFSET_HT_V1_8822B) -+#define BIT_SET_CSI_RPT_OFFSET_HT_V1_8822B(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_HT_V1_8822B(x) | \ -+ BIT_CSI_RPT_OFFSET_HT_V1_8822B(v)) -+ -+#define BIT_VHTNDP_RPTPOLL_CSI_STR_OFFSET_SEL_8822B BIT(15) -+#define BIT_NDPVLD_POS_RST_FFPTR_DIS_8822B BIT(14) -+ -+#define BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1_8822B 8 -+#define BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1_8822B 0x3f -+#define BIT_R_CSI_RPT_OFFSET_VHT_V1_8822B(x) \ -+ (((x) & BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1_8822B) \ -+ << BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1_8822B) -+#define BITS_R_CSI_RPT_OFFSET_VHT_V1_8822B \ -+ (BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1_8822B \ -+ << BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1_8822B) -+#define BIT_CLEAR_R_CSI_RPT_OFFSET_VHT_V1_8822B(x) \ -+ ((x) & (~BITS_R_CSI_RPT_OFFSET_VHT_V1_8822B)) -+#define BIT_GET_R_CSI_RPT_OFFSET_VHT_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_CSI_RPT_OFFSET_VHT_V1_8822B) & \ -+ BIT_MASK_R_CSI_RPT_OFFSET_VHT_V1_8822B) -+#define BIT_SET_R_CSI_RPT_OFFSET_VHT_V1_8822B(x, v) \ -+ (BIT_CLEAR_R_CSI_RPT_OFFSET_VHT_V1_8822B(x) | \ -+ BIT_R_CSI_RPT_OFFSET_VHT_V1_8822B(v)) -+ -+#define BIT_R_WMAC_USE_NSTS_8822B BIT(7) -+#define BIT_R_DISABLE_CHECK_VHTSIGB_CRC_8822B BIT(6) -+#define BIT_R_DISABLE_CHECK_VHTSIGA_CRC_8822B BIT(5) -+#define BIT_R_WMAC_BFPARAM_SEL_8822B BIT(4) -+#define BIT_R_WMAC_CSISEQ_SEL_8822B BIT(3) -+#define BIT_R_WMAC_CSI_WITHHTC_EN_8822B BIT(2) -+#define BIT_R_WMAC_HT_NDPA_EN_8822B BIT(1) -+#define BIT_R_WMAC_VHT_NDPA_EN_8822B BIT(0) -+ -+/* 2 REG_RX_CSI_RPT_INFO_8822B */ -+ -+/* 2 REG_NS_ARP_CTRL_8822B */ -+#define BIT_R_WMAC_NSARP_RSPEN_8822B BIT(15) -+#define BIT_R_WMAC_NSARP_RARP_8822B BIT(9) -+#define BIT_R_WMAC_NSARP_RIPV6_8822B BIT(8) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_MODEN_8822B 6 -+#define BIT_MASK_R_WMAC_NSARP_MODEN_8822B 0x3 -+#define BIT_R_WMAC_NSARP_MODEN_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_MODEN_8822B) \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8822B) -+#define BITS_R_WMAC_NSARP_MODEN_8822B \ -+ (BIT_MASK_R_WMAC_NSARP_MODEN_8822B \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8822B) -+#define BIT_CLEAR_R_WMAC_NSARP_MODEN_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_MODEN_8822B)) -+#define BIT_GET_R_WMAC_NSARP_MODEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_MODEN_8822B) & \ -+ BIT_MASK_R_WMAC_NSARP_MODEN_8822B) -+#define BIT_SET_R_WMAC_NSARP_MODEN_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_MODEN_8822B(x) | \ -+ BIT_R_WMAC_NSARP_MODEN_8822B(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8822B 4 -+#define BIT_MASK_R_WMAC_NSARP_RSPFTP_8822B 0x3 -+#define BIT_R_WMAC_NSARP_RSPFTP_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPFTP_8822B) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8822B) -+#define BITS_R_WMAC_NSARP_RSPFTP_8822B \ -+ (BIT_MASK_R_WMAC_NSARP_RSPFTP_8822B \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8822B) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPFTP_8822B)) -+#define BIT_GET_R_WMAC_NSARP_RSPFTP_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8822B) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPFTP_8822B) -+#define BIT_SET_R_WMAC_NSARP_RSPFTP_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8822B(x) | \ -+ BIT_R_WMAC_NSARP_RSPFTP_8822B(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8822B 0 -+#define BIT_MASK_R_WMAC_NSARP_RSPSEC_8822B 0xf -+#define BIT_R_WMAC_NSARP_RSPSEC_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPSEC_8822B) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8822B) -+#define BITS_R_WMAC_NSARP_RSPSEC_8822B \ -+ (BIT_MASK_R_WMAC_NSARP_RSPSEC_8822B \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8822B) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPSEC_8822B)) -+#define BIT_GET_R_WMAC_NSARP_RSPSEC_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8822B) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPSEC_8822B) -+#define BIT_SET_R_WMAC_NSARP_RSPSEC_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8822B(x) | \ -+ BIT_R_WMAC_NSARP_RSPSEC_8822B(v)) -+ -+/* 2 REG_NS_ARP_INFO_8822B */ -+#define BIT_REQ_IS_MCNS_8822B BIT(23) -+#define BIT_REQ_IS_UCNS_8822B BIT(22) -+#define BIT_REQ_IS_USNS_8822B BIT(21) -+#define BIT_REQ_IS_ARP_8822B BIT(20) -+#define BIT_EXPRSP_MH_WITHQC_8822B BIT(19) -+ -+#define BIT_SHIFT_EXPRSP_SECTYPE_8822B 16 -+#define BIT_MASK_EXPRSP_SECTYPE_8822B 0x7 -+#define BIT_EXPRSP_SECTYPE_8822B(x) \ -+ (((x) & BIT_MASK_EXPRSP_SECTYPE_8822B) \ -+ << BIT_SHIFT_EXPRSP_SECTYPE_8822B) -+#define BITS_EXPRSP_SECTYPE_8822B \ -+ (BIT_MASK_EXPRSP_SECTYPE_8822B << BIT_SHIFT_EXPRSP_SECTYPE_8822B) -+#define BIT_CLEAR_EXPRSP_SECTYPE_8822B(x) ((x) & (~BITS_EXPRSP_SECTYPE_8822B)) -+#define BIT_GET_EXPRSP_SECTYPE_8822B(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_SECTYPE_8822B) & \ -+ BIT_MASK_EXPRSP_SECTYPE_8822B) -+#define BIT_SET_EXPRSP_SECTYPE_8822B(x, v) \ -+ (BIT_CLEAR_EXPRSP_SECTYPE_8822B(x) | BIT_EXPRSP_SECTYPE_8822B(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8822B 8 -+#define BIT_MASK_EXPRSP_CHKSM_7_TO_0_8822B 0xff -+#define BIT_EXPRSP_CHKSM_7_TO_0_8822B(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_7_TO_0_8822B) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8822B) -+#define BITS_EXPRSP_CHKSM_7_TO_0_8822B \ -+ (BIT_MASK_EXPRSP_CHKSM_7_TO_0_8822B \ -+ << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8822B) -+#define BIT_CLEAR_EXPRSP_CHKSM_7_TO_0_8822B(x) \ -+ ((x) & (~BITS_EXPRSP_CHKSM_7_TO_0_8822B)) -+#define BIT_GET_EXPRSP_CHKSM_7_TO_0_8822B(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8822B) & \ -+ BIT_MASK_EXPRSP_CHKSM_7_TO_0_8822B) -+#define BIT_SET_EXPRSP_CHKSM_7_TO_0_8822B(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_7_TO_0_8822B(x) | \ -+ BIT_EXPRSP_CHKSM_7_TO_0_8822B(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8822B 0 -+#define BIT_MASK_EXPRSP_CHKSM_15_TO_8_8822B 0xff -+#define BIT_EXPRSP_CHKSM_15_TO_8_8822B(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_15_TO_8_8822B) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8822B) -+#define BITS_EXPRSP_CHKSM_15_TO_8_8822B \ -+ (BIT_MASK_EXPRSP_CHKSM_15_TO_8_8822B \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8822B) -+#define BIT_CLEAR_EXPRSP_CHKSM_15_TO_8_8822B(x) \ -+ ((x) & (~BITS_EXPRSP_CHKSM_15_TO_8_8822B)) -+#define BIT_GET_EXPRSP_CHKSM_15_TO_8_8822B(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8822B) & \ -+ BIT_MASK_EXPRSP_CHKSM_15_TO_8_8822B) -+#define BIT_SET_EXPRSP_CHKSM_15_TO_8_8822B(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_15_TO_8_8822B(x) | \ -+ BIT_EXPRSP_CHKSM_15_TO_8_8822B(v)) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_V1_8822B */ -+ -+#define BIT_SHIFT_WMAC_ARPIP_8822B 0 -+#define BIT_MASK_WMAC_ARPIP_8822B 0xffffffffL -+#define BIT_WMAC_ARPIP_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_ARPIP_8822B) << BIT_SHIFT_WMAC_ARPIP_8822B) -+#define BITS_WMAC_ARPIP_8822B \ -+ (BIT_MASK_WMAC_ARPIP_8822B << BIT_SHIFT_WMAC_ARPIP_8822B) -+#define BIT_CLEAR_WMAC_ARPIP_8822B(x) ((x) & (~BITS_WMAC_ARPIP_8822B)) -+#define BIT_GET_WMAC_ARPIP_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARPIP_8822B) & BIT_MASK_WMAC_ARPIP_8822B) -+#define BIT_SET_WMAC_ARPIP_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_ARPIP_8822B(x) | BIT_WMAC_ARPIP_8822B(v)) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_8822B */ -+ -+#define BIT_SHIFT_BEAMFORMING_INFO_8822B 0 -+#define BIT_MASK_BEAMFORMING_INFO_8822B 0xffffffffL -+#define BIT_BEAMFORMING_INFO_8822B(x) \ -+ (((x) & BIT_MASK_BEAMFORMING_INFO_8822B) \ -+ << BIT_SHIFT_BEAMFORMING_INFO_8822B) -+#define BITS_BEAMFORMING_INFO_8822B \ -+ (BIT_MASK_BEAMFORMING_INFO_8822B << BIT_SHIFT_BEAMFORMING_INFO_8822B) -+#define BIT_CLEAR_BEAMFORMING_INFO_8822B(x) \ -+ ((x) & (~BITS_BEAMFORMING_INFO_8822B)) -+#define BIT_GET_BEAMFORMING_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_BEAMFORMING_INFO_8822B) & \ -+ BIT_MASK_BEAMFORMING_INFO_8822B) -+#define BIT_SET_BEAMFORMING_INFO_8822B(x, v) \ -+ (BIT_CLEAR_BEAMFORMING_INFO_8822B(x) | BIT_BEAMFORMING_INFO_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_8822B 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_8822B 0xffffffffffffffffffffffffffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_8822B) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_8822B) -+#define BITS_R_WMAC_IPV6_MYIPAD_8822B \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_8822B \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_8822B) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_8822B)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_8822B) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_8822B) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_8822B(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_8822B(v)) -+ -+/* 2 REG_RSVD_0X740_8822B */ -+ -+/* 2 REG_WMAC_RTX_CTX_SUBTYPE_CFG_8822B */ -+ -+#define BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8822B 4 -+#define BIT_MASK_R_WMAC_CTX_SUBTYPE_8822B 0xf -+#define BIT_R_WMAC_CTX_SUBTYPE_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_CTX_SUBTYPE_8822B) \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8822B) -+#define BITS_R_WMAC_CTX_SUBTYPE_8822B \ -+ (BIT_MASK_R_WMAC_CTX_SUBTYPE_8822B \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8822B) -+#define BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_CTX_SUBTYPE_8822B)) -+#define BIT_GET_R_WMAC_CTX_SUBTYPE_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8822B) & \ -+ BIT_MASK_R_WMAC_CTX_SUBTYPE_8822B) -+#define BIT_SET_R_WMAC_CTX_SUBTYPE_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8822B(x) | \ -+ BIT_R_WMAC_CTX_SUBTYPE_8822B(v)) -+ -+#define BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8822B 0 -+#define BIT_MASK_R_WMAC_RTX_SUBTYPE_8822B 0xf -+#define BIT_R_WMAC_RTX_SUBTYPE_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_RTX_SUBTYPE_8822B) \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8822B) -+#define BITS_R_WMAC_RTX_SUBTYPE_8822B \ -+ (BIT_MASK_R_WMAC_RTX_SUBTYPE_8822B \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8822B) -+#define BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_RTX_SUBTYPE_8822B)) -+#define BIT_GET_R_WMAC_RTX_SUBTYPE_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8822B) & \ -+ BIT_MASK_R_WMAC_RTX_SUBTYPE_8822B) -+#define BIT_SET_R_WMAC_RTX_SUBTYPE_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8822B(x) | \ -+ BIT_R_WMAC_RTX_SUBTYPE_8822B(v)) -+ -+/* 2 REG_WMAC_SWAES_CFG_8822B */ -+ -+/* 2 REG_BT_COEX_V2_8822B */ -+#define BIT_GNT_BT_POLARITY_8822B BIT(12) -+#define BIT_GNT_BT_BYPASS_PRIORITY_8822B BIT(8) -+ -+#define BIT_SHIFT_TIMER_8822B 0 -+#define BIT_MASK_TIMER_8822B 0xff -+#define BIT_TIMER_8822B(x) \ -+ (((x) & BIT_MASK_TIMER_8822B) << BIT_SHIFT_TIMER_8822B) -+#define BITS_TIMER_8822B (BIT_MASK_TIMER_8822B << BIT_SHIFT_TIMER_8822B) -+#define BIT_CLEAR_TIMER_8822B(x) ((x) & (~BITS_TIMER_8822B)) -+#define BIT_GET_TIMER_8822B(x) \ -+ (((x) >> BIT_SHIFT_TIMER_8822B) & BIT_MASK_TIMER_8822B) -+#define BIT_SET_TIMER_8822B(x, v) \ -+ (BIT_CLEAR_TIMER_8822B(x) | BIT_TIMER_8822B(v)) -+ -+/* 2 REG_BT_COEX_8822B */ -+#define BIT_R_GNT_BT_RFC_SW_8822B BIT(12) -+#define BIT_R_GNT_BT_RFC_SW_EN_8822B BIT(11) -+#define BIT_R_GNT_BT_BB_SW_8822B BIT(10) -+#define BIT_R_GNT_BT_BB_SW_EN_8822B BIT(9) -+#define BIT_R_BT_CNT_THREN_8822B BIT(8) -+ -+#define BIT_SHIFT_R_BT_CNT_THR_8822B 0 -+#define BIT_MASK_R_BT_CNT_THR_8822B 0xff -+#define BIT_R_BT_CNT_THR_8822B(x) \ -+ (((x) & BIT_MASK_R_BT_CNT_THR_8822B) << BIT_SHIFT_R_BT_CNT_THR_8822B) -+#define BITS_R_BT_CNT_THR_8822B \ -+ (BIT_MASK_R_BT_CNT_THR_8822B << BIT_SHIFT_R_BT_CNT_THR_8822B) -+#define BIT_CLEAR_R_BT_CNT_THR_8822B(x) ((x) & (~BITS_R_BT_CNT_THR_8822B)) -+#define BIT_GET_R_BT_CNT_THR_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CNT_THR_8822B) & BIT_MASK_R_BT_CNT_THR_8822B) -+#define BIT_SET_R_BT_CNT_THR_8822B(x, v) \ -+ (BIT_CLEAR_R_BT_CNT_THR_8822B(x) | BIT_R_BT_CNT_THR_8822B(v)) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_8822B */ -+#define BIT_WLRX_TER_BY_CTL_8822B BIT(43) -+#define BIT_WLRX_TER_BY_AD_8822B BIT(42) -+#define BIT_ANT_DIVERSITY_SEL_8822B BIT(41) -+#define BIT_ANTSEL_FOR_BT_CTRL_EN_8822B BIT(40) -+#define BIT_WLACT_LOW_GNTWL_EN_8822B BIT(34) -+#define BIT_WLACT_HIGH_GNTBT_EN_8822B BIT(33) -+#define BIT_NAV_UPPER_V1_8822B BIT(32) -+ -+#define BIT_SHIFT_RXMYRTS_NAV_V1_8822B 8 -+#define BIT_MASK_RXMYRTS_NAV_V1_8822B 0xff -+#define BIT_RXMYRTS_NAV_V1_8822B(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_V1_8822B) \ -+ << BIT_SHIFT_RXMYRTS_NAV_V1_8822B) -+#define BITS_RXMYRTS_NAV_V1_8822B \ -+ (BIT_MASK_RXMYRTS_NAV_V1_8822B << BIT_SHIFT_RXMYRTS_NAV_V1_8822B) -+#define BIT_CLEAR_RXMYRTS_NAV_V1_8822B(x) ((x) & (~BITS_RXMYRTS_NAV_V1_8822B)) -+#define BIT_GET_RXMYRTS_NAV_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_V1_8822B) & \ -+ BIT_MASK_RXMYRTS_NAV_V1_8822B) -+#define BIT_SET_RXMYRTS_NAV_V1_8822B(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_V1_8822B(x) | BIT_RXMYRTS_NAV_V1_8822B(v)) -+ -+#define BIT_SHIFT_RTSRST_V1_8822B 0 -+#define BIT_MASK_RTSRST_V1_8822B 0xff -+#define BIT_RTSRST_V1_8822B(x) \ -+ (((x) & BIT_MASK_RTSRST_V1_8822B) << BIT_SHIFT_RTSRST_V1_8822B) -+#define BITS_RTSRST_V1_8822B \ -+ (BIT_MASK_RTSRST_V1_8822B << BIT_SHIFT_RTSRST_V1_8822B) -+#define BIT_CLEAR_RTSRST_V1_8822B(x) ((x) & (~BITS_RTSRST_V1_8822B)) -+#define BIT_GET_RTSRST_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_V1_8822B) & BIT_MASK_RTSRST_V1_8822B) -+#define BIT_SET_RTSRST_V1_8822B(x, v) \ -+ (BIT_CLEAR_RTSRST_V1_8822B(x) | BIT_RTSRST_V1_8822B(v)) -+ -+/* 2 REG_BT_COEX_ENHANCED_INTR_CTRL_8822B */ -+ -+#define BIT_SHIFT_BT_STAT_DELAY_8822B 12 -+#define BIT_MASK_BT_STAT_DELAY_8822B 0xf -+#define BIT_BT_STAT_DELAY_8822B(x) \ -+ (((x) & BIT_MASK_BT_STAT_DELAY_8822B) << BIT_SHIFT_BT_STAT_DELAY_8822B) -+#define BITS_BT_STAT_DELAY_8822B \ -+ (BIT_MASK_BT_STAT_DELAY_8822B << BIT_SHIFT_BT_STAT_DELAY_8822B) -+#define BIT_CLEAR_BT_STAT_DELAY_8822B(x) ((x) & (~BITS_BT_STAT_DELAY_8822B)) -+#define BIT_GET_BT_STAT_DELAY_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_STAT_DELAY_8822B) & BIT_MASK_BT_STAT_DELAY_8822B) -+#define BIT_SET_BT_STAT_DELAY_8822B(x, v) \ -+ (BIT_CLEAR_BT_STAT_DELAY_8822B(x) | BIT_BT_STAT_DELAY_8822B(v)) -+ -+#define BIT_SHIFT_BT_TRX_INIT_DETECT_8822B 8 -+#define BIT_MASK_BT_TRX_INIT_DETECT_8822B 0xf -+#define BIT_BT_TRX_INIT_DETECT_8822B(x) \ -+ (((x) & BIT_MASK_BT_TRX_INIT_DETECT_8822B) \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8822B) -+#define BITS_BT_TRX_INIT_DETECT_8822B \ -+ (BIT_MASK_BT_TRX_INIT_DETECT_8822B \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8822B) -+#define BIT_CLEAR_BT_TRX_INIT_DETECT_8822B(x) \ -+ ((x) & (~BITS_BT_TRX_INIT_DETECT_8822B)) -+#define BIT_GET_BT_TRX_INIT_DETECT_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_TRX_INIT_DETECT_8822B) & \ -+ BIT_MASK_BT_TRX_INIT_DETECT_8822B) -+#define BIT_SET_BT_TRX_INIT_DETECT_8822B(x, v) \ -+ (BIT_CLEAR_BT_TRX_INIT_DETECT_8822B(x) | \ -+ BIT_BT_TRX_INIT_DETECT_8822B(v)) -+ -+#define BIT_SHIFT_BT_PRI_DETECT_TO_8822B 4 -+#define BIT_MASK_BT_PRI_DETECT_TO_8822B 0xf -+#define BIT_BT_PRI_DETECT_TO_8822B(x) \ -+ (((x) & BIT_MASK_BT_PRI_DETECT_TO_8822B) \ -+ << BIT_SHIFT_BT_PRI_DETECT_TO_8822B) -+#define BITS_BT_PRI_DETECT_TO_8822B \ -+ (BIT_MASK_BT_PRI_DETECT_TO_8822B << BIT_SHIFT_BT_PRI_DETECT_TO_8822B) -+#define BIT_CLEAR_BT_PRI_DETECT_TO_8822B(x) \ -+ ((x) & (~BITS_BT_PRI_DETECT_TO_8822B)) -+#define BIT_GET_BT_PRI_DETECT_TO_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_PRI_DETECT_TO_8822B) & \ -+ BIT_MASK_BT_PRI_DETECT_TO_8822B) -+#define BIT_SET_BT_PRI_DETECT_TO_8822B(x, v) \ -+ (BIT_CLEAR_BT_PRI_DETECT_TO_8822B(x) | BIT_BT_PRI_DETECT_TO_8822B(v)) -+ -+#define BIT_R_GRANTALL_WLMASK_8822B BIT(3) -+#define BIT_STATIS_BT_EN_8822B BIT(2) -+#define BIT_WL_ACT_MASK_ENABLE_8822B BIT(1) -+#define BIT_ENHANCED_BT_8822B BIT(0) -+ -+/* 2 REG_BT_ACT_STATISTICS_8822B */ -+ -+#define BIT_SHIFT_STATIS_BT_LO_RX_8822B (48 & CPU_OPT_WIDTH) -+#define BIT_MASK_STATIS_BT_LO_RX_8822B 0xffff -+#define BIT_STATIS_BT_LO_RX_8822B(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_RX_8822B) \ -+ << BIT_SHIFT_STATIS_BT_LO_RX_8822B) -+#define BITS_STATIS_BT_LO_RX_8822B \ -+ (BIT_MASK_STATIS_BT_LO_RX_8822B << BIT_SHIFT_STATIS_BT_LO_RX_8822B) -+#define BIT_CLEAR_STATIS_BT_LO_RX_8822B(x) ((x) & (~BITS_STATIS_BT_LO_RX_8822B)) -+#define BIT_GET_STATIS_BT_LO_RX_8822B(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_RX_8822B) & \ -+ BIT_MASK_STATIS_BT_LO_RX_8822B) -+#define BIT_SET_STATIS_BT_LO_RX_8822B(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_RX_8822B(x) | BIT_STATIS_BT_LO_RX_8822B(v)) -+ -+#define BIT_SHIFT_STATIS_BT_LO_TX_8822B (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_STATIS_BT_LO_TX_8822B 0xffff -+#define BIT_STATIS_BT_LO_TX_8822B(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_TX_8822B) \ -+ << BIT_SHIFT_STATIS_BT_LO_TX_8822B) -+#define BITS_STATIS_BT_LO_TX_8822B \ -+ (BIT_MASK_STATIS_BT_LO_TX_8822B << BIT_SHIFT_STATIS_BT_LO_TX_8822B) -+#define BIT_CLEAR_STATIS_BT_LO_TX_8822B(x) ((x) & (~BITS_STATIS_BT_LO_TX_8822B)) -+#define BIT_GET_STATIS_BT_LO_TX_8822B(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_TX_8822B) & \ -+ BIT_MASK_STATIS_BT_LO_TX_8822B) -+#define BIT_SET_STATIS_BT_LO_TX_8822B(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_TX_8822B(x) | BIT_STATIS_BT_LO_TX_8822B(v)) -+ -+#define BIT_SHIFT_STATIS_BT_HI_RX_8822B 16 -+#define BIT_MASK_STATIS_BT_HI_RX_8822B 0xffff -+#define BIT_STATIS_BT_HI_RX_8822B(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_RX_8822B) \ -+ << BIT_SHIFT_STATIS_BT_HI_RX_8822B) -+#define BITS_STATIS_BT_HI_RX_8822B \ -+ (BIT_MASK_STATIS_BT_HI_RX_8822B << BIT_SHIFT_STATIS_BT_HI_RX_8822B) -+#define BIT_CLEAR_STATIS_BT_HI_RX_8822B(x) ((x) & (~BITS_STATIS_BT_HI_RX_8822B)) -+#define BIT_GET_STATIS_BT_HI_RX_8822B(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_RX_8822B) & \ -+ BIT_MASK_STATIS_BT_HI_RX_8822B) -+#define BIT_SET_STATIS_BT_HI_RX_8822B(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_RX_8822B(x) | BIT_STATIS_BT_HI_RX_8822B(v)) -+ -+#define BIT_SHIFT_STATIS_BT_HI_TX_8822B 0 -+#define BIT_MASK_STATIS_BT_HI_TX_8822B 0xffff -+#define BIT_STATIS_BT_HI_TX_8822B(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_TX_8822B) \ -+ << BIT_SHIFT_STATIS_BT_HI_TX_8822B) -+#define BITS_STATIS_BT_HI_TX_8822B \ -+ (BIT_MASK_STATIS_BT_HI_TX_8822B << BIT_SHIFT_STATIS_BT_HI_TX_8822B) -+#define BIT_CLEAR_STATIS_BT_HI_TX_8822B(x) ((x) & (~BITS_STATIS_BT_HI_TX_8822B)) -+#define BIT_GET_STATIS_BT_HI_TX_8822B(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_TX_8822B) & \ -+ BIT_MASK_STATIS_BT_HI_TX_8822B) -+#define BIT_SET_STATIS_BT_HI_TX_8822B(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_TX_8822B(x) | BIT_STATIS_BT_HI_TX_8822B(v)) -+ -+/* 2 REG_BT_STATISTICS_CONTROL_REGISTER_8822B */ -+ -+#define BIT_SHIFT_R_BT_CMD_RPT_8822B 16 -+#define BIT_MASK_R_BT_CMD_RPT_8822B 0xffff -+#define BIT_R_BT_CMD_RPT_8822B(x) \ -+ (((x) & BIT_MASK_R_BT_CMD_RPT_8822B) << BIT_SHIFT_R_BT_CMD_RPT_8822B) -+#define BITS_R_BT_CMD_RPT_8822B \ -+ (BIT_MASK_R_BT_CMD_RPT_8822B << BIT_SHIFT_R_BT_CMD_RPT_8822B) -+#define BIT_CLEAR_R_BT_CMD_RPT_8822B(x) ((x) & (~BITS_R_BT_CMD_RPT_8822B)) -+#define BIT_GET_R_BT_CMD_RPT_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CMD_RPT_8822B) & BIT_MASK_R_BT_CMD_RPT_8822B) -+#define BIT_SET_R_BT_CMD_RPT_8822B(x, v) \ -+ (BIT_CLEAR_R_BT_CMD_RPT_8822B(x) | BIT_R_BT_CMD_RPT_8822B(v)) -+ -+#define BIT_SHIFT_R_RPT_FROM_BT_8822B 8 -+#define BIT_MASK_R_RPT_FROM_BT_8822B 0xff -+#define BIT_R_RPT_FROM_BT_8822B(x) \ -+ (((x) & BIT_MASK_R_RPT_FROM_BT_8822B) << BIT_SHIFT_R_RPT_FROM_BT_8822B) -+#define BITS_R_RPT_FROM_BT_8822B \ -+ (BIT_MASK_R_RPT_FROM_BT_8822B << BIT_SHIFT_R_RPT_FROM_BT_8822B) -+#define BIT_CLEAR_R_RPT_FROM_BT_8822B(x) ((x) & (~BITS_R_RPT_FROM_BT_8822B)) -+#define BIT_GET_R_RPT_FROM_BT_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_RPT_FROM_BT_8822B) & BIT_MASK_R_RPT_FROM_BT_8822B) -+#define BIT_SET_R_RPT_FROM_BT_8822B(x, v) \ -+ (BIT_CLEAR_R_RPT_FROM_BT_8822B(x) | BIT_R_RPT_FROM_BT_8822B(v)) -+ -+#define BIT_SHIFT_BT_HID_ISR_SET_8822B 6 -+#define BIT_MASK_BT_HID_ISR_SET_8822B 0x3 -+#define BIT_BT_HID_ISR_SET_8822B(x) \ -+ (((x) & BIT_MASK_BT_HID_ISR_SET_8822B) \ -+ << BIT_SHIFT_BT_HID_ISR_SET_8822B) -+#define BITS_BT_HID_ISR_SET_8822B \ -+ (BIT_MASK_BT_HID_ISR_SET_8822B << BIT_SHIFT_BT_HID_ISR_SET_8822B) -+#define BIT_CLEAR_BT_HID_ISR_SET_8822B(x) ((x) & (~BITS_BT_HID_ISR_SET_8822B)) -+#define BIT_GET_BT_HID_ISR_SET_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_HID_ISR_SET_8822B) & \ -+ BIT_MASK_BT_HID_ISR_SET_8822B) -+#define BIT_SET_BT_HID_ISR_SET_8822B(x, v) \ -+ (BIT_CLEAR_BT_HID_ISR_SET_8822B(x) | BIT_BT_HID_ISR_SET_8822B(v)) -+ -+#define BIT_TDMA_BT_START_NOTIFY_8822B BIT(5) -+#define BIT_ENABLE_TDMA_FW_MODE_8822B BIT(4) -+#define BIT_ENABLE_PTA_TDMA_MODE_8822B BIT(3) -+#define BIT_ENABLE_COEXIST_TAB_IN_TDMA_8822B BIT(2) -+#define BIT_GPIO2_GPIO3_EXANGE_OR_NO_BT_CCA_8822B BIT(1) -+#define BIT_RTK_BT_ENABLE_8822B BIT(0) -+ -+/* 2 REG_BT_STATUS_REPORT_REGISTER_8822B */ -+ -+#define BIT_SHIFT_BT_PROFILE_8822B 24 -+#define BIT_MASK_BT_PROFILE_8822B 0xff -+#define BIT_BT_PROFILE_8822B(x) \ -+ (((x) & BIT_MASK_BT_PROFILE_8822B) << BIT_SHIFT_BT_PROFILE_8822B) -+#define BITS_BT_PROFILE_8822B \ -+ (BIT_MASK_BT_PROFILE_8822B << BIT_SHIFT_BT_PROFILE_8822B) -+#define BIT_CLEAR_BT_PROFILE_8822B(x) ((x) & (~BITS_BT_PROFILE_8822B)) -+#define BIT_GET_BT_PROFILE_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_PROFILE_8822B) & BIT_MASK_BT_PROFILE_8822B) -+#define BIT_SET_BT_PROFILE_8822B(x, v) \ -+ (BIT_CLEAR_BT_PROFILE_8822B(x) | BIT_BT_PROFILE_8822B(v)) -+ -+#define BIT_SHIFT_BT_POWER_8822B 16 -+#define BIT_MASK_BT_POWER_8822B 0xff -+#define BIT_BT_POWER_8822B(x) \ -+ (((x) & BIT_MASK_BT_POWER_8822B) << BIT_SHIFT_BT_POWER_8822B) -+#define BITS_BT_POWER_8822B \ -+ (BIT_MASK_BT_POWER_8822B << BIT_SHIFT_BT_POWER_8822B) -+#define BIT_CLEAR_BT_POWER_8822B(x) ((x) & (~BITS_BT_POWER_8822B)) -+#define BIT_GET_BT_POWER_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_POWER_8822B) & BIT_MASK_BT_POWER_8822B) -+#define BIT_SET_BT_POWER_8822B(x, v) \ -+ (BIT_CLEAR_BT_POWER_8822B(x) | BIT_BT_POWER_8822B(v)) -+ -+#define BIT_SHIFT_BT_PREDECT_STATUS_8822B 8 -+#define BIT_MASK_BT_PREDECT_STATUS_8822B 0xff -+#define BIT_BT_PREDECT_STATUS_8822B(x) \ -+ (((x) & BIT_MASK_BT_PREDECT_STATUS_8822B) \ -+ << BIT_SHIFT_BT_PREDECT_STATUS_8822B) -+#define BITS_BT_PREDECT_STATUS_8822B \ -+ (BIT_MASK_BT_PREDECT_STATUS_8822B << BIT_SHIFT_BT_PREDECT_STATUS_8822B) -+#define BIT_CLEAR_BT_PREDECT_STATUS_8822B(x) \ -+ ((x) & (~BITS_BT_PREDECT_STATUS_8822B)) -+#define BIT_GET_BT_PREDECT_STATUS_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_PREDECT_STATUS_8822B) & \ -+ BIT_MASK_BT_PREDECT_STATUS_8822B) -+#define BIT_SET_BT_PREDECT_STATUS_8822B(x, v) \ -+ (BIT_CLEAR_BT_PREDECT_STATUS_8822B(x) | BIT_BT_PREDECT_STATUS_8822B(v)) -+ -+#define BIT_SHIFT_BT_CMD_INFO_8822B 0 -+#define BIT_MASK_BT_CMD_INFO_8822B 0xff -+#define BIT_BT_CMD_INFO_8822B(x) \ -+ (((x) & BIT_MASK_BT_CMD_INFO_8822B) << BIT_SHIFT_BT_CMD_INFO_8822B) -+#define BITS_BT_CMD_INFO_8822B \ -+ (BIT_MASK_BT_CMD_INFO_8822B << BIT_SHIFT_BT_CMD_INFO_8822B) -+#define BIT_CLEAR_BT_CMD_INFO_8822B(x) ((x) & (~BITS_BT_CMD_INFO_8822B)) -+#define BIT_GET_BT_CMD_INFO_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_CMD_INFO_8822B) & BIT_MASK_BT_CMD_INFO_8822B) -+#define BIT_SET_BT_CMD_INFO_8822B(x, v) \ -+ (BIT_CLEAR_BT_CMD_INFO_8822B(x) | BIT_BT_CMD_INFO_8822B(v)) -+ -+/* 2 REG_BT_INTERRUPT_CONTROL_REGISTER_8822B */ -+#define BIT_EN_MAC_NULL_PKT_NOTIFY_8822B BIT(31) -+#define BIT_EN_WLAN_RPT_AND_BT_QUERY_8822B BIT(30) -+#define BIT_EN_BT_STSTUS_RPT_8822B BIT(29) -+#define BIT_EN_BT_POWER_8822B BIT(28) -+#define BIT_EN_BT_CHANNEL_8822B BIT(27) -+#define BIT_EN_BT_SLOT_CHANGE_8822B BIT(26) -+#define BIT_EN_BT_PROFILE_OR_HID_8822B BIT(25) -+#define BIT_WLAN_RPT_NOTIFY_8822B BIT(24) -+ -+#define BIT_SHIFT_WLAN_RPT_DATA_8822B 16 -+#define BIT_MASK_WLAN_RPT_DATA_8822B 0xff -+#define BIT_WLAN_RPT_DATA_8822B(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_DATA_8822B) << BIT_SHIFT_WLAN_RPT_DATA_8822B) -+#define BITS_WLAN_RPT_DATA_8822B \ -+ (BIT_MASK_WLAN_RPT_DATA_8822B << BIT_SHIFT_WLAN_RPT_DATA_8822B) -+#define BIT_CLEAR_WLAN_RPT_DATA_8822B(x) ((x) & (~BITS_WLAN_RPT_DATA_8822B)) -+#define BIT_GET_WLAN_RPT_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_DATA_8822B) & BIT_MASK_WLAN_RPT_DATA_8822B) -+#define BIT_SET_WLAN_RPT_DATA_8822B(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_DATA_8822B(x) | BIT_WLAN_RPT_DATA_8822B(v)) -+ -+#define BIT_SHIFT_CMD_ID_8822B 8 -+#define BIT_MASK_CMD_ID_8822B 0xff -+#define BIT_CMD_ID_8822B(x) \ -+ (((x) & BIT_MASK_CMD_ID_8822B) << BIT_SHIFT_CMD_ID_8822B) -+#define BITS_CMD_ID_8822B (BIT_MASK_CMD_ID_8822B << BIT_SHIFT_CMD_ID_8822B) -+#define BIT_CLEAR_CMD_ID_8822B(x) ((x) & (~BITS_CMD_ID_8822B)) -+#define BIT_GET_CMD_ID_8822B(x) \ -+ (((x) >> BIT_SHIFT_CMD_ID_8822B) & BIT_MASK_CMD_ID_8822B) -+#define BIT_SET_CMD_ID_8822B(x, v) \ -+ (BIT_CLEAR_CMD_ID_8822B(x) | BIT_CMD_ID_8822B(v)) -+ -+#define BIT_SHIFT_BT_DATA_8822B 0 -+#define BIT_MASK_BT_DATA_8822B 0xff -+#define BIT_BT_DATA_8822B(x) \ -+ (((x) & BIT_MASK_BT_DATA_8822B) << BIT_SHIFT_BT_DATA_8822B) -+#define BITS_BT_DATA_8822B (BIT_MASK_BT_DATA_8822B << BIT_SHIFT_BT_DATA_8822B) -+#define BIT_CLEAR_BT_DATA_8822B(x) ((x) & (~BITS_BT_DATA_8822B)) -+#define BIT_GET_BT_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_DATA_8822B) & BIT_MASK_BT_DATA_8822B) -+#define BIT_SET_BT_DATA_8822B(x, v) \ -+ (BIT_CLEAR_BT_DATA_8822B(x) | BIT_BT_DATA_8822B(v)) -+ -+/* 2 REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8822B */ -+ -+#define BIT_SHIFT_WLAN_RPT_TO_8822B 0 -+#define BIT_MASK_WLAN_RPT_TO_8822B 0xff -+#define BIT_WLAN_RPT_TO_8822B(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_TO_8822B) << BIT_SHIFT_WLAN_RPT_TO_8822B) -+#define BITS_WLAN_RPT_TO_8822B \ -+ (BIT_MASK_WLAN_RPT_TO_8822B << BIT_SHIFT_WLAN_RPT_TO_8822B) -+#define BIT_CLEAR_WLAN_RPT_TO_8822B(x) ((x) & (~BITS_WLAN_RPT_TO_8822B)) -+#define BIT_GET_WLAN_RPT_TO_8822B(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_TO_8822B) & BIT_MASK_WLAN_RPT_TO_8822B) -+#define BIT_SET_WLAN_RPT_TO_8822B(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_TO_8822B(x) | BIT_WLAN_RPT_TO_8822B(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8822B */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_8822B 1 -+#define BIT_MASK_ISOLATION_CHK_8822B 0x7fffffffffffffffffffL -+#define BIT_ISOLATION_CHK_8822B(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_8822B) << BIT_SHIFT_ISOLATION_CHK_8822B) -+#define BITS_ISOLATION_CHK_8822B \ -+ (BIT_MASK_ISOLATION_CHK_8822B << BIT_SHIFT_ISOLATION_CHK_8822B) -+#define BIT_CLEAR_ISOLATION_CHK_8822B(x) ((x) & (~BITS_ISOLATION_CHK_8822B)) -+#define BIT_GET_ISOLATION_CHK_8822B(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_8822B) & BIT_MASK_ISOLATION_CHK_8822B) -+#define BIT_SET_ISOLATION_CHK_8822B(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_8822B(x) | BIT_ISOLATION_CHK_8822B(v)) -+ -+#define BIT_ISOLATION_EN_8822B BIT(0) -+ -+/* 2 REG_BT_INTERRUPT_STATUS_REGISTER_8822B */ -+#define BIT_BT_HID_ISR_8822B BIT(7) -+#define BIT_BT_QUERY_ISR_8822B BIT(6) -+#define BIT_MAC_NULL_PKT_NOTIFY_ISR_8822B BIT(5) -+#define BIT_WLAN_RPT_ISR_8822B BIT(4) -+#define BIT_BT_POWER_ISR_8822B BIT(3) -+#define BIT_BT_CHANNEL_ISR_8822B BIT(2) -+#define BIT_BT_SLOT_CHANGE_ISR_8822B BIT(1) -+#define BIT_BT_PROFILE_ISR_8822B BIT(0) -+ -+/* 2 REG_BT_TDMA_TIME_REGISTER_8822B */ -+ -+#define BIT_SHIFT_BT_TIME_8822B 6 -+#define BIT_MASK_BT_TIME_8822B 0x3ffffff -+#define BIT_BT_TIME_8822B(x) \ -+ (((x) & BIT_MASK_BT_TIME_8822B) << BIT_SHIFT_BT_TIME_8822B) -+#define BITS_BT_TIME_8822B (BIT_MASK_BT_TIME_8822B << BIT_SHIFT_BT_TIME_8822B) -+#define BIT_CLEAR_BT_TIME_8822B(x) ((x) & (~BITS_BT_TIME_8822B)) -+#define BIT_GET_BT_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_TIME_8822B) & BIT_MASK_BT_TIME_8822B) -+#define BIT_SET_BT_TIME_8822B(x, v) \ -+ (BIT_CLEAR_BT_TIME_8822B(x) | BIT_BT_TIME_8822B(v)) -+ -+#define BIT_SHIFT_BT_RPT_SAMPLE_RATE_8822B 0 -+#define BIT_MASK_BT_RPT_SAMPLE_RATE_8822B 0x3f -+#define BIT_BT_RPT_SAMPLE_RATE_8822B(x) \ -+ (((x) & BIT_MASK_BT_RPT_SAMPLE_RATE_8822B) \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8822B) -+#define BITS_BT_RPT_SAMPLE_RATE_8822B \ -+ (BIT_MASK_BT_RPT_SAMPLE_RATE_8822B \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8822B) -+#define BIT_CLEAR_BT_RPT_SAMPLE_RATE_8822B(x) \ -+ ((x) & (~BITS_BT_RPT_SAMPLE_RATE_8822B)) -+#define BIT_GET_BT_RPT_SAMPLE_RATE_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_RPT_SAMPLE_RATE_8822B) & \ -+ BIT_MASK_BT_RPT_SAMPLE_RATE_8822B) -+#define BIT_SET_BT_RPT_SAMPLE_RATE_8822B(x, v) \ -+ (BIT_CLEAR_BT_RPT_SAMPLE_RATE_8822B(x) | \ -+ BIT_BT_RPT_SAMPLE_RATE_8822B(v)) -+ -+/* 2 REG_BT_ACT_REGISTER_8822B */ -+ -+#define BIT_SHIFT_BT_EISR_EN_8822B 16 -+#define BIT_MASK_BT_EISR_EN_8822B 0xff -+#define BIT_BT_EISR_EN_8822B(x) \ -+ (((x) & BIT_MASK_BT_EISR_EN_8822B) << BIT_SHIFT_BT_EISR_EN_8822B) -+#define BITS_BT_EISR_EN_8822B \ -+ (BIT_MASK_BT_EISR_EN_8822B << BIT_SHIFT_BT_EISR_EN_8822B) -+#define BIT_CLEAR_BT_EISR_EN_8822B(x) ((x) & (~BITS_BT_EISR_EN_8822B)) -+#define BIT_GET_BT_EISR_EN_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_EISR_EN_8822B) & BIT_MASK_BT_EISR_EN_8822B) -+#define BIT_SET_BT_EISR_EN_8822B(x, v) \ -+ (BIT_CLEAR_BT_EISR_EN_8822B(x) | BIT_BT_EISR_EN_8822B(v)) -+ -+#define BIT_BT_ACT_FALLING_ISR_8822B BIT(10) -+#define BIT_BT_ACT_RISING_ISR_8822B BIT(9) -+#define BIT_TDMA_TO_ISR_8822B BIT(8) -+ -+#define BIT_SHIFT_BT_CH_8822B 0 -+#define BIT_MASK_BT_CH_8822B 0xff -+#define BIT_BT_CH_8822B(x) \ -+ (((x) & BIT_MASK_BT_CH_8822B) << BIT_SHIFT_BT_CH_8822B) -+#define BITS_BT_CH_8822B (BIT_MASK_BT_CH_8822B << BIT_SHIFT_BT_CH_8822B) -+#define BIT_CLEAR_BT_CH_8822B(x) ((x) & (~BITS_BT_CH_8822B)) -+#define BIT_GET_BT_CH_8822B(x) \ -+ (((x) >> BIT_SHIFT_BT_CH_8822B) & BIT_MASK_BT_CH_8822B) -+#define BIT_SET_BT_CH_8822B(x, v) \ -+ (BIT_CLEAR_BT_CH_8822B(x) | BIT_BT_CH_8822B(v)) -+ -+/* 2 REG_OBFF_CTRL_BASIC_8822B */ -+#define BIT_OBFF_EN_V1_8822B BIT(31) -+ -+#define BIT_SHIFT_OBFF_STATE_V1_8822B 28 -+#define BIT_MASK_OBFF_STATE_V1_8822B 0x3 -+#define BIT_OBFF_STATE_V1_8822B(x) \ -+ (((x) & BIT_MASK_OBFF_STATE_V1_8822B) << BIT_SHIFT_OBFF_STATE_V1_8822B) -+#define BITS_OBFF_STATE_V1_8822B \ -+ (BIT_MASK_OBFF_STATE_V1_8822B << BIT_SHIFT_OBFF_STATE_V1_8822B) -+#define BIT_CLEAR_OBFF_STATE_V1_8822B(x) ((x) & (~BITS_OBFF_STATE_V1_8822B)) -+#define BIT_GET_OBFF_STATE_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_OBFF_STATE_V1_8822B) & BIT_MASK_OBFF_STATE_V1_8822B) -+#define BIT_SET_OBFF_STATE_V1_8822B(x, v) \ -+ (BIT_CLEAR_OBFF_STATE_V1_8822B(x) | BIT_OBFF_STATE_V1_8822B(v)) -+ -+#define BIT_OBFF_ACT_RXDMA_EN_8822B BIT(27) -+#define BIT_OBFF_BLOCK_INT_EN_8822B BIT(26) -+#define BIT_OBFF_AUTOACT_EN_8822B BIT(25) -+#define BIT_OBFF_AUTOIDLE_EN_8822B BIT(24) -+ -+#define BIT_SHIFT_WAKE_MAX_PLS_8822B 20 -+#define BIT_MASK_WAKE_MAX_PLS_8822B 0x7 -+#define BIT_WAKE_MAX_PLS_8822B(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_PLS_8822B) << BIT_SHIFT_WAKE_MAX_PLS_8822B) -+#define BITS_WAKE_MAX_PLS_8822B \ -+ (BIT_MASK_WAKE_MAX_PLS_8822B << BIT_SHIFT_WAKE_MAX_PLS_8822B) -+#define BIT_CLEAR_WAKE_MAX_PLS_8822B(x) ((x) & (~BITS_WAKE_MAX_PLS_8822B)) -+#define BIT_GET_WAKE_MAX_PLS_8822B(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_PLS_8822B) & BIT_MASK_WAKE_MAX_PLS_8822B) -+#define BIT_SET_WAKE_MAX_PLS_8822B(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_PLS_8822B(x) | BIT_WAKE_MAX_PLS_8822B(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_PLS_8822B 16 -+#define BIT_MASK_WAKE_MIN_PLS_8822B 0x7 -+#define BIT_WAKE_MIN_PLS_8822B(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_PLS_8822B) << BIT_SHIFT_WAKE_MIN_PLS_8822B) -+#define BITS_WAKE_MIN_PLS_8822B \ -+ (BIT_MASK_WAKE_MIN_PLS_8822B << BIT_SHIFT_WAKE_MIN_PLS_8822B) -+#define BIT_CLEAR_WAKE_MIN_PLS_8822B(x) ((x) & (~BITS_WAKE_MIN_PLS_8822B)) -+#define BIT_GET_WAKE_MIN_PLS_8822B(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_PLS_8822B) & BIT_MASK_WAKE_MIN_PLS_8822B) -+#define BIT_SET_WAKE_MIN_PLS_8822B(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_PLS_8822B(x) | BIT_WAKE_MIN_PLS_8822B(v)) -+ -+#define BIT_SHIFT_WAKE_MAX_F2F_8822B 12 -+#define BIT_MASK_WAKE_MAX_F2F_8822B 0x7 -+#define BIT_WAKE_MAX_F2F_8822B(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_F2F_8822B) << BIT_SHIFT_WAKE_MAX_F2F_8822B) -+#define BITS_WAKE_MAX_F2F_8822B \ -+ (BIT_MASK_WAKE_MAX_F2F_8822B << BIT_SHIFT_WAKE_MAX_F2F_8822B) -+#define BIT_CLEAR_WAKE_MAX_F2F_8822B(x) ((x) & (~BITS_WAKE_MAX_F2F_8822B)) -+#define BIT_GET_WAKE_MAX_F2F_8822B(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_F2F_8822B) & BIT_MASK_WAKE_MAX_F2F_8822B) -+#define BIT_SET_WAKE_MAX_F2F_8822B(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_F2F_8822B(x) | BIT_WAKE_MAX_F2F_8822B(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_F2F_8822B 8 -+#define BIT_MASK_WAKE_MIN_F2F_8822B 0x7 -+#define BIT_WAKE_MIN_F2F_8822B(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_F2F_8822B) << BIT_SHIFT_WAKE_MIN_F2F_8822B) -+#define BITS_WAKE_MIN_F2F_8822B \ -+ (BIT_MASK_WAKE_MIN_F2F_8822B << BIT_SHIFT_WAKE_MIN_F2F_8822B) -+#define BIT_CLEAR_WAKE_MIN_F2F_8822B(x) ((x) & (~BITS_WAKE_MIN_F2F_8822B)) -+#define BIT_GET_WAKE_MIN_F2F_8822B(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_F2F_8822B) & BIT_MASK_WAKE_MIN_F2F_8822B) -+#define BIT_SET_WAKE_MIN_F2F_8822B(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_F2F_8822B(x) | BIT_WAKE_MIN_F2F_8822B(v)) -+ -+#define BIT_APP_CPU_ACT_V1_8822B BIT(3) -+#define BIT_APP_OBFF_V1_8822B BIT(2) -+#define BIT_APP_IDLE_V1_8822B BIT(1) -+#define BIT_APP_INIT_V1_8822B BIT(0) -+ -+/* 2 REG_OBFF_CTRL2_TIMER_8822B */ -+ -+#define BIT_SHIFT_RX_HIGH_TIMER_IDX_8822B 24 -+#define BIT_MASK_RX_HIGH_TIMER_IDX_8822B 0x7 -+#define BIT_RX_HIGH_TIMER_IDX_8822B(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TIMER_IDX_8822B) \ -+ << BIT_SHIFT_RX_HIGH_TIMER_IDX_8822B) -+#define BITS_RX_HIGH_TIMER_IDX_8822B \ -+ (BIT_MASK_RX_HIGH_TIMER_IDX_8822B << BIT_SHIFT_RX_HIGH_TIMER_IDX_8822B) -+#define BIT_CLEAR_RX_HIGH_TIMER_IDX_8822B(x) \ -+ ((x) & (~BITS_RX_HIGH_TIMER_IDX_8822B)) -+#define BIT_GET_RX_HIGH_TIMER_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TIMER_IDX_8822B) & \ -+ BIT_MASK_RX_HIGH_TIMER_IDX_8822B) -+#define BIT_SET_RX_HIGH_TIMER_IDX_8822B(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TIMER_IDX_8822B(x) | BIT_RX_HIGH_TIMER_IDX_8822B(v)) -+ -+#define BIT_SHIFT_RX_MED_TIMER_IDX_8822B 16 -+#define BIT_MASK_RX_MED_TIMER_IDX_8822B 0x7 -+#define BIT_RX_MED_TIMER_IDX_8822B(x) \ -+ (((x) & BIT_MASK_RX_MED_TIMER_IDX_8822B) \ -+ << BIT_SHIFT_RX_MED_TIMER_IDX_8822B) -+#define BITS_RX_MED_TIMER_IDX_8822B \ -+ (BIT_MASK_RX_MED_TIMER_IDX_8822B << BIT_SHIFT_RX_MED_TIMER_IDX_8822B) -+#define BIT_CLEAR_RX_MED_TIMER_IDX_8822B(x) \ -+ ((x) & (~BITS_RX_MED_TIMER_IDX_8822B)) -+#define BIT_GET_RX_MED_TIMER_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TIMER_IDX_8822B) & \ -+ BIT_MASK_RX_MED_TIMER_IDX_8822B) -+#define BIT_SET_RX_MED_TIMER_IDX_8822B(x, v) \ -+ (BIT_CLEAR_RX_MED_TIMER_IDX_8822B(x) | BIT_RX_MED_TIMER_IDX_8822B(v)) -+ -+#define BIT_SHIFT_RX_LOW_TIMER_IDX_8822B 8 -+#define BIT_MASK_RX_LOW_TIMER_IDX_8822B 0x7 -+#define BIT_RX_LOW_TIMER_IDX_8822B(x) \ -+ (((x) & BIT_MASK_RX_LOW_TIMER_IDX_8822B) \ -+ << BIT_SHIFT_RX_LOW_TIMER_IDX_8822B) -+#define BITS_RX_LOW_TIMER_IDX_8822B \ -+ (BIT_MASK_RX_LOW_TIMER_IDX_8822B << BIT_SHIFT_RX_LOW_TIMER_IDX_8822B) -+#define BIT_CLEAR_RX_LOW_TIMER_IDX_8822B(x) \ -+ ((x) & (~BITS_RX_LOW_TIMER_IDX_8822B)) -+#define BIT_GET_RX_LOW_TIMER_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TIMER_IDX_8822B) & \ -+ BIT_MASK_RX_LOW_TIMER_IDX_8822B) -+#define BIT_SET_RX_LOW_TIMER_IDX_8822B(x, v) \ -+ (BIT_CLEAR_RX_LOW_TIMER_IDX_8822B(x) | BIT_RX_LOW_TIMER_IDX_8822B(v)) -+ -+#define BIT_SHIFT_OBFF_INT_TIMER_IDX_8822B 0 -+#define BIT_MASK_OBFF_INT_TIMER_IDX_8822B 0x7 -+#define BIT_OBFF_INT_TIMER_IDX_8822B(x) \ -+ (((x) & BIT_MASK_OBFF_INT_TIMER_IDX_8822B) \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8822B) -+#define BITS_OBFF_INT_TIMER_IDX_8822B \ -+ (BIT_MASK_OBFF_INT_TIMER_IDX_8822B \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8822B) -+#define BIT_CLEAR_OBFF_INT_TIMER_IDX_8822B(x) \ -+ ((x) & (~BITS_OBFF_INT_TIMER_IDX_8822B)) -+#define BIT_GET_OBFF_INT_TIMER_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_OBFF_INT_TIMER_IDX_8822B) & \ -+ BIT_MASK_OBFF_INT_TIMER_IDX_8822B) -+#define BIT_SET_OBFF_INT_TIMER_IDX_8822B(x, v) \ -+ (BIT_CLEAR_OBFF_INT_TIMER_IDX_8822B(x) | \ -+ BIT_OBFF_INT_TIMER_IDX_8822B(v)) -+ -+/* 2 REG_LTR_CTRL_BASIC_8822B */ -+#define BIT_LTR_EN_V1_8822B BIT(31) -+#define BIT_LTR_HW_EN_V1_8822B BIT(30) -+#define BIT_LRT_ACT_CTS_EN_8822B BIT(29) -+#define BIT_LTR_ACT_RXPKT_EN_8822B BIT(28) -+#define BIT_LTR_ACT_RXDMA_EN_8822B BIT(27) -+#define BIT_LTR_IDLE_NO_SNOOP_8822B BIT(26) -+#define BIT_SPDUP_MGTPKT_8822B BIT(25) -+#define BIT_RX_AGG_EN_8822B BIT(24) -+#define BIT_APP_LTR_ACT_8822B BIT(23) -+#define BIT_APP_LTR_IDLE_8822B BIT(22) -+ -+#define BIT_SHIFT_HIGH_RATE_TRIG_SEL_8822B 20 -+#define BIT_MASK_HIGH_RATE_TRIG_SEL_8822B 0x3 -+#define BIT_HIGH_RATE_TRIG_SEL_8822B(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_TRIG_SEL_8822B) \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8822B) -+#define BITS_HIGH_RATE_TRIG_SEL_8822B \ -+ (BIT_MASK_HIGH_RATE_TRIG_SEL_8822B \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8822B) -+#define BIT_CLEAR_HIGH_RATE_TRIG_SEL_8822B(x) \ -+ ((x) & (~BITS_HIGH_RATE_TRIG_SEL_8822B)) -+#define BIT_GET_HIGH_RATE_TRIG_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_TRIG_SEL_8822B) & \ -+ BIT_MASK_HIGH_RATE_TRIG_SEL_8822B) -+#define BIT_SET_HIGH_RATE_TRIG_SEL_8822B(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_TRIG_SEL_8822B(x) | \ -+ BIT_HIGH_RATE_TRIG_SEL_8822B(v)) -+ -+#define BIT_SHIFT_MED_RATE_TRIG_SEL_8822B 18 -+#define BIT_MASK_MED_RATE_TRIG_SEL_8822B 0x3 -+#define BIT_MED_RATE_TRIG_SEL_8822B(x) \ -+ (((x) & BIT_MASK_MED_RATE_TRIG_SEL_8822B) \ -+ << BIT_SHIFT_MED_RATE_TRIG_SEL_8822B) -+#define BITS_MED_RATE_TRIG_SEL_8822B \ -+ (BIT_MASK_MED_RATE_TRIG_SEL_8822B << BIT_SHIFT_MED_RATE_TRIG_SEL_8822B) -+#define BIT_CLEAR_MED_RATE_TRIG_SEL_8822B(x) \ -+ ((x) & (~BITS_MED_RATE_TRIG_SEL_8822B)) -+#define BIT_GET_MED_RATE_TRIG_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_MED_RATE_TRIG_SEL_8822B) & \ -+ BIT_MASK_MED_RATE_TRIG_SEL_8822B) -+#define BIT_SET_MED_RATE_TRIG_SEL_8822B(x, v) \ -+ (BIT_CLEAR_MED_RATE_TRIG_SEL_8822B(x) | BIT_MED_RATE_TRIG_SEL_8822B(v)) -+ -+#define BIT_SHIFT_LOW_RATE_TRIG_SEL_8822B 16 -+#define BIT_MASK_LOW_RATE_TRIG_SEL_8822B 0x3 -+#define BIT_LOW_RATE_TRIG_SEL_8822B(x) \ -+ (((x) & BIT_MASK_LOW_RATE_TRIG_SEL_8822B) \ -+ << BIT_SHIFT_LOW_RATE_TRIG_SEL_8822B) -+#define BITS_LOW_RATE_TRIG_SEL_8822B \ -+ (BIT_MASK_LOW_RATE_TRIG_SEL_8822B << BIT_SHIFT_LOW_RATE_TRIG_SEL_8822B) -+#define BIT_CLEAR_LOW_RATE_TRIG_SEL_8822B(x) \ -+ ((x) & (~BITS_LOW_RATE_TRIG_SEL_8822B)) -+#define BIT_GET_LOW_RATE_TRIG_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_TRIG_SEL_8822B) & \ -+ BIT_MASK_LOW_RATE_TRIG_SEL_8822B) -+#define BIT_SET_LOW_RATE_TRIG_SEL_8822B(x, v) \ -+ (BIT_CLEAR_LOW_RATE_TRIG_SEL_8822B(x) | BIT_LOW_RATE_TRIG_SEL_8822B(v)) -+ -+#define BIT_SHIFT_HIGH_RATE_BD_IDX_8822B 8 -+#define BIT_MASK_HIGH_RATE_BD_IDX_8822B 0x7f -+#define BIT_HIGH_RATE_BD_IDX_8822B(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_BD_IDX_8822B) \ -+ << BIT_SHIFT_HIGH_RATE_BD_IDX_8822B) -+#define BITS_HIGH_RATE_BD_IDX_8822B \ -+ (BIT_MASK_HIGH_RATE_BD_IDX_8822B << BIT_SHIFT_HIGH_RATE_BD_IDX_8822B) -+#define BIT_CLEAR_HIGH_RATE_BD_IDX_8822B(x) \ -+ ((x) & (~BITS_HIGH_RATE_BD_IDX_8822B)) -+#define BIT_GET_HIGH_RATE_BD_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_BD_IDX_8822B) & \ -+ BIT_MASK_HIGH_RATE_BD_IDX_8822B) -+#define BIT_SET_HIGH_RATE_BD_IDX_8822B(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_BD_IDX_8822B(x) | BIT_HIGH_RATE_BD_IDX_8822B(v)) -+ -+#define BIT_SHIFT_LOW_RATE_BD_IDX_8822B 0 -+#define BIT_MASK_LOW_RATE_BD_IDX_8822B 0x7f -+#define BIT_LOW_RATE_BD_IDX_8822B(x) \ -+ (((x) & BIT_MASK_LOW_RATE_BD_IDX_8822B) \ -+ << BIT_SHIFT_LOW_RATE_BD_IDX_8822B) -+#define BITS_LOW_RATE_BD_IDX_8822B \ -+ (BIT_MASK_LOW_RATE_BD_IDX_8822B << BIT_SHIFT_LOW_RATE_BD_IDX_8822B) -+#define BIT_CLEAR_LOW_RATE_BD_IDX_8822B(x) ((x) & (~BITS_LOW_RATE_BD_IDX_8822B)) -+#define BIT_GET_LOW_RATE_BD_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_BD_IDX_8822B) & \ -+ BIT_MASK_LOW_RATE_BD_IDX_8822B) -+#define BIT_SET_LOW_RATE_BD_IDX_8822B(x, v) \ -+ (BIT_CLEAR_LOW_RATE_BD_IDX_8822B(x) | BIT_LOW_RATE_BD_IDX_8822B(v)) -+ -+/* 2 REG_LTR_CTRL2_TIMER_THRESHOLD_8822B */ -+ -+#define BIT_SHIFT_RX_EMPTY_TIMER_IDX_8822B 24 -+#define BIT_MASK_RX_EMPTY_TIMER_IDX_8822B 0x7 -+#define BIT_RX_EMPTY_TIMER_IDX_8822B(x) \ -+ (((x) & BIT_MASK_RX_EMPTY_TIMER_IDX_8822B) \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8822B) -+#define BITS_RX_EMPTY_TIMER_IDX_8822B \ -+ (BIT_MASK_RX_EMPTY_TIMER_IDX_8822B \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8822B) -+#define BIT_CLEAR_RX_EMPTY_TIMER_IDX_8822B(x) \ -+ ((x) & (~BITS_RX_EMPTY_TIMER_IDX_8822B)) -+#define BIT_GET_RX_EMPTY_TIMER_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_RX_EMPTY_TIMER_IDX_8822B) & \ -+ BIT_MASK_RX_EMPTY_TIMER_IDX_8822B) -+#define BIT_SET_RX_EMPTY_TIMER_IDX_8822B(x, v) \ -+ (BIT_CLEAR_RX_EMPTY_TIMER_IDX_8822B(x) | \ -+ BIT_RX_EMPTY_TIMER_IDX_8822B(v)) -+ -+#define BIT_SHIFT_RX_AFULL_TH_IDX_8822B 20 -+#define BIT_MASK_RX_AFULL_TH_IDX_8822B 0x7 -+#define BIT_RX_AFULL_TH_IDX_8822B(x) \ -+ (((x) & BIT_MASK_RX_AFULL_TH_IDX_8822B) \ -+ << BIT_SHIFT_RX_AFULL_TH_IDX_8822B) -+#define BITS_RX_AFULL_TH_IDX_8822B \ -+ (BIT_MASK_RX_AFULL_TH_IDX_8822B << BIT_SHIFT_RX_AFULL_TH_IDX_8822B) -+#define BIT_CLEAR_RX_AFULL_TH_IDX_8822B(x) ((x) & (~BITS_RX_AFULL_TH_IDX_8822B)) -+#define BIT_GET_RX_AFULL_TH_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_RX_AFULL_TH_IDX_8822B) & \ -+ BIT_MASK_RX_AFULL_TH_IDX_8822B) -+#define BIT_SET_RX_AFULL_TH_IDX_8822B(x, v) \ -+ (BIT_CLEAR_RX_AFULL_TH_IDX_8822B(x) | BIT_RX_AFULL_TH_IDX_8822B(v)) -+ -+#define BIT_SHIFT_RX_HIGH_TH_IDX_8822B 16 -+#define BIT_MASK_RX_HIGH_TH_IDX_8822B 0x7 -+#define BIT_RX_HIGH_TH_IDX_8822B(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TH_IDX_8822B) \ -+ << BIT_SHIFT_RX_HIGH_TH_IDX_8822B) -+#define BITS_RX_HIGH_TH_IDX_8822B \ -+ (BIT_MASK_RX_HIGH_TH_IDX_8822B << BIT_SHIFT_RX_HIGH_TH_IDX_8822B) -+#define BIT_CLEAR_RX_HIGH_TH_IDX_8822B(x) ((x) & (~BITS_RX_HIGH_TH_IDX_8822B)) -+#define BIT_GET_RX_HIGH_TH_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TH_IDX_8822B) & \ -+ BIT_MASK_RX_HIGH_TH_IDX_8822B) -+#define BIT_SET_RX_HIGH_TH_IDX_8822B(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TH_IDX_8822B(x) | BIT_RX_HIGH_TH_IDX_8822B(v)) -+ -+#define BIT_SHIFT_RX_MED_TH_IDX_8822B 12 -+#define BIT_MASK_RX_MED_TH_IDX_8822B 0x7 -+#define BIT_RX_MED_TH_IDX_8822B(x) \ -+ (((x) & BIT_MASK_RX_MED_TH_IDX_8822B) << BIT_SHIFT_RX_MED_TH_IDX_8822B) -+#define BITS_RX_MED_TH_IDX_8822B \ -+ (BIT_MASK_RX_MED_TH_IDX_8822B << BIT_SHIFT_RX_MED_TH_IDX_8822B) -+#define BIT_CLEAR_RX_MED_TH_IDX_8822B(x) ((x) & (~BITS_RX_MED_TH_IDX_8822B)) -+#define BIT_GET_RX_MED_TH_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TH_IDX_8822B) & BIT_MASK_RX_MED_TH_IDX_8822B) -+#define BIT_SET_RX_MED_TH_IDX_8822B(x, v) \ -+ (BIT_CLEAR_RX_MED_TH_IDX_8822B(x) | BIT_RX_MED_TH_IDX_8822B(v)) -+ -+#define BIT_SHIFT_RX_LOW_TH_IDX_8822B 8 -+#define BIT_MASK_RX_LOW_TH_IDX_8822B 0x7 -+#define BIT_RX_LOW_TH_IDX_8822B(x) \ -+ (((x) & BIT_MASK_RX_LOW_TH_IDX_8822B) << BIT_SHIFT_RX_LOW_TH_IDX_8822B) -+#define BITS_RX_LOW_TH_IDX_8822B \ -+ (BIT_MASK_RX_LOW_TH_IDX_8822B << BIT_SHIFT_RX_LOW_TH_IDX_8822B) -+#define BIT_CLEAR_RX_LOW_TH_IDX_8822B(x) ((x) & (~BITS_RX_LOW_TH_IDX_8822B)) -+#define BIT_GET_RX_LOW_TH_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TH_IDX_8822B) & BIT_MASK_RX_LOW_TH_IDX_8822B) -+#define BIT_SET_RX_LOW_TH_IDX_8822B(x, v) \ -+ (BIT_CLEAR_RX_LOW_TH_IDX_8822B(x) | BIT_RX_LOW_TH_IDX_8822B(v)) -+ -+#define BIT_SHIFT_LTR_SPACE_IDX_8822B 4 -+#define BIT_MASK_LTR_SPACE_IDX_8822B 0x3 -+#define BIT_LTR_SPACE_IDX_8822B(x) \ -+ (((x) & BIT_MASK_LTR_SPACE_IDX_8822B) << BIT_SHIFT_LTR_SPACE_IDX_8822B) -+#define BITS_LTR_SPACE_IDX_8822B \ -+ (BIT_MASK_LTR_SPACE_IDX_8822B << BIT_SHIFT_LTR_SPACE_IDX_8822B) -+#define BIT_CLEAR_LTR_SPACE_IDX_8822B(x) ((x) & (~BITS_LTR_SPACE_IDX_8822B)) -+#define BIT_GET_LTR_SPACE_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_LTR_SPACE_IDX_8822B) & BIT_MASK_LTR_SPACE_IDX_8822B) -+#define BIT_SET_LTR_SPACE_IDX_8822B(x, v) \ -+ (BIT_CLEAR_LTR_SPACE_IDX_8822B(x) | BIT_LTR_SPACE_IDX_8822B(v)) -+ -+#define BIT_SHIFT_LTR_IDLE_TIMER_IDX_8822B 0 -+#define BIT_MASK_LTR_IDLE_TIMER_IDX_8822B 0x7 -+#define BIT_LTR_IDLE_TIMER_IDX_8822B(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_TIMER_IDX_8822B) \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8822B) -+#define BITS_LTR_IDLE_TIMER_IDX_8822B \ -+ (BIT_MASK_LTR_IDLE_TIMER_IDX_8822B \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8822B) -+#define BIT_CLEAR_LTR_IDLE_TIMER_IDX_8822B(x) \ -+ ((x) & (~BITS_LTR_IDLE_TIMER_IDX_8822B)) -+#define BIT_GET_LTR_IDLE_TIMER_IDX_8822B(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_TIMER_IDX_8822B) & \ -+ BIT_MASK_LTR_IDLE_TIMER_IDX_8822B) -+#define BIT_SET_LTR_IDLE_TIMER_IDX_8822B(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_TIMER_IDX_8822B(x) | \ -+ BIT_LTR_IDLE_TIMER_IDX_8822B(v)) -+ -+/* 2 REG_LTR_IDLE_LATENCY_V1_8822B */ -+ -+#define BIT_SHIFT_LTR_IDLE_L_8822B 0 -+#define BIT_MASK_LTR_IDLE_L_8822B 0xffffffffL -+#define BIT_LTR_IDLE_L_8822B(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_L_8822B) << BIT_SHIFT_LTR_IDLE_L_8822B) -+#define BITS_LTR_IDLE_L_8822B \ -+ (BIT_MASK_LTR_IDLE_L_8822B << BIT_SHIFT_LTR_IDLE_L_8822B) -+#define BIT_CLEAR_LTR_IDLE_L_8822B(x) ((x) & (~BITS_LTR_IDLE_L_8822B)) -+#define BIT_GET_LTR_IDLE_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_L_8822B) & BIT_MASK_LTR_IDLE_L_8822B) -+#define BIT_SET_LTR_IDLE_L_8822B(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_L_8822B(x) | BIT_LTR_IDLE_L_8822B(v)) -+ -+/* 2 REG_LTR_ACTIVE_LATENCY_V1_8822B */ -+ -+#define BIT_SHIFT_LTR_ACT_L_8822B 0 -+#define BIT_MASK_LTR_ACT_L_8822B 0xffffffffL -+#define BIT_LTR_ACT_L_8822B(x) \ -+ (((x) & BIT_MASK_LTR_ACT_L_8822B) << BIT_SHIFT_LTR_ACT_L_8822B) -+#define BITS_LTR_ACT_L_8822B \ -+ (BIT_MASK_LTR_ACT_L_8822B << BIT_SHIFT_LTR_ACT_L_8822B) -+#define BIT_CLEAR_LTR_ACT_L_8822B(x) ((x) & (~BITS_LTR_ACT_L_8822B)) -+#define BIT_GET_LTR_ACT_L_8822B(x) \ -+ (((x) >> BIT_SHIFT_LTR_ACT_L_8822B) & BIT_MASK_LTR_ACT_L_8822B) -+#define BIT_SET_LTR_ACT_L_8822B(x, v) \ -+ (BIT_CLEAR_LTR_ACT_L_8822B(x) | BIT_LTR_ACT_L_8822B(v)) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER_8822B */ -+#define BIT_APPEND_MACID_IN_RESP_EN_8822B BIT(50) -+#define BIT_ADDR2_MATCH_EN_8822B BIT(49) -+#define BIT_ANTTRN_EN_8822B BIT(48) -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR_8822B 0 -+#define BIT_MASK_TRAIN_STA_ADDR_8822B 0xffffffffffffL -+#define BIT_TRAIN_STA_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR_8822B) \ -+ << BIT_SHIFT_TRAIN_STA_ADDR_8822B) -+#define BITS_TRAIN_STA_ADDR_8822B \ -+ (BIT_MASK_TRAIN_STA_ADDR_8822B << BIT_SHIFT_TRAIN_STA_ADDR_8822B) -+#define BIT_CLEAR_TRAIN_STA_ADDR_8822B(x) ((x) & (~BITS_TRAIN_STA_ADDR_8822B)) -+#define BIT_GET_TRAIN_STA_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR_8822B) & \ -+ BIT_MASK_TRAIN_STA_ADDR_8822B) -+#define BIT_SET_TRAIN_STA_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR_8822B(x) | BIT_TRAIN_STA_ADDR_8822B(v)) -+ -+/* 2 REG_RSVD_0X7B4_8822B */ -+ -+/* 2 REG_WMAC_PKTCNT_RWD_8822B */ -+ -+#define BIT_SHIFT_PKTCNT_BSSIDMAP_8822B 4 -+#define BIT_MASK_PKTCNT_BSSIDMAP_8822B 0xf -+#define BIT_PKTCNT_BSSIDMAP_8822B(x) \ -+ (((x) & BIT_MASK_PKTCNT_BSSIDMAP_8822B) \ -+ << BIT_SHIFT_PKTCNT_BSSIDMAP_8822B) -+#define BITS_PKTCNT_BSSIDMAP_8822B \ -+ (BIT_MASK_PKTCNT_BSSIDMAP_8822B << BIT_SHIFT_PKTCNT_BSSIDMAP_8822B) -+#define BIT_CLEAR_PKTCNT_BSSIDMAP_8822B(x) ((x) & (~BITS_PKTCNT_BSSIDMAP_8822B)) -+#define BIT_GET_PKTCNT_BSSIDMAP_8822B(x) \ -+ (((x) >> BIT_SHIFT_PKTCNT_BSSIDMAP_8822B) & \ -+ BIT_MASK_PKTCNT_BSSIDMAP_8822B) -+#define BIT_SET_PKTCNT_BSSIDMAP_8822B(x, v) \ -+ (BIT_CLEAR_PKTCNT_BSSIDMAP_8822B(x) | BIT_PKTCNT_BSSIDMAP_8822B(v)) -+ -+#define BIT_PKTCNT_CNTRST_8822B BIT(1) -+#define BIT_PKTCNT_CNTEN_8822B BIT(0) -+ -+/* 2 REG_WMAC_PKTCNT_CTRL_8822B */ -+#define BIT_WMAC_PKTCNT_TRST_8822B BIT(9) -+#define BIT_WMAC_PKTCNT_FEN_8822B BIT(8) -+ -+#define BIT_SHIFT_WMAC_PKTCNT_CFGAD_8822B 0 -+#define BIT_MASK_WMAC_PKTCNT_CFGAD_8822B 0xff -+#define BIT_WMAC_PKTCNT_CFGAD_8822B(x) \ -+ (((x) & BIT_MASK_WMAC_PKTCNT_CFGAD_8822B) \ -+ << BIT_SHIFT_WMAC_PKTCNT_CFGAD_8822B) -+#define BITS_WMAC_PKTCNT_CFGAD_8822B \ -+ (BIT_MASK_WMAC_PKTCNT_CFGAD_8822B << BIT_SHIFT_WMAC_PKTCNT_CFGAD_8822B) -+#define BIT_CLEAR_WMAC_PKTCNT_CFGAD_8822B(x) \ -+ ((x) & (~BITS_WMAC_PKTCNT_CFGAD_8822B)) -+#define BIT_GET_WMAC_PKTCNT_CFGAD_8822B(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PKTCNT_CFGAD_8822B) & \ -+ BIT_MASK_WMAC_PKTCNT_CFGAD_8822B) -+#define BIT_SET_WMAC_PKTCNT_CFGAD_8822B(x, v) \ -+ (BIT_CLEAR_WMAC_PKTCNT_CFGAD_8822B(x) | BIT_WMAC_PKTCNT_CFGAD_8822B(v)) -+ -+/* 2 REG_IQ_DUMP_8822B */ -+ -+#define BIT_SHIFT_R_WMAC_MATCH_REF_MAC_8822B (64 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_MATCH_REF_MAC_8822B 0xffffffffL -+#define BIT_R_WMAC_MATCH_REF_MAC_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_MATCH_REF_MAC_8822B) \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_8822B) -+#define BITS_R_WMAC_MATCH_REF_MAC_8822B \ -+ (BIT_MASK_R_WMAC_MATCH_REF_MAC_8822B \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_8822B) -+#define BIT_CLEAR_R_WMAC_MATCH_REF_MAC_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_MATCH_REF_MAC_8822B)) -+#define BIT_GET_R_WMAC_MATCH_REF_MAC_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MATCH_REF_MAC_8822B) & \ -+ BIT_MASK_R_WMAC_MATCH_REF_MAC_8822B) -+#define BIT_SET_R_WMAC_MATCH_REF_MAC_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_MATCH_REF_MAC_8822B(x) | \ -+ BIT_R_WMAC_MATCH_REF_MAC_8822B(v)) -+ -+#define BIT_SHIFT_R_WMAC_MASK_LA_MAC_8822B (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_MASK_LA_MAC_8822B 0xffffffffL -+#define BIT_R_WMAC_MASK_LA_MAC_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_MASK_LA_MAC_8822B) \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_8822B) -+#define BITS_R_WMAC_MASK_LA_MAC_8822B \ -+ (BIT_MASK_R_WMAC_MASK_LA_MAC_8822B \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_8822B) -+#define BIT_CLEAR_R_WMAC_MASK_LA_MAC_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_MASK_LA_MAC_8822B)) -+#define BIT_GET_R_WMAC_MASK_LA_MAC_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MASK_LA_MAC_8822B) & \ -+ BIT_MASK_R_WMAC_MASK_LA_MAC_8822B) -+#define BIT_SET_R_WMAC_MASK_LA_MAC_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_MASK_LA_MAC_8822B(x) | \ -+ BIT_R_WMAC_MASK_LA_MAC_8822B(v)) -+ -+#define BIT_SHIFT_DUMP_OK_ADDR_8822B 16 -+#define BIT_MASK_DUMP_OK_ADDR_8822B 0xffff -+#define BIT_DUMP_OK_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_DUMP_OK_ADDR_8822B) << BIT_SHIFT_DUMP_OK_ADDR_8822B) -+#define BITS_DUMP_OK_ADDR_8822B \ -+ (BIT_MASK_DUMP_OK_ADDR_8822B << BIT_SHIFT_DUMP_OK_ADDR_8822B) -+#define BIT_CLEAR_DUMP_OK_ADDR_8822B(x) ((x) & (~BITS_DUMP_OK_ADDR_8822B)) -+#define BIT_GET_DUMP_OK_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_DUMP_OK_ADDR_8822B) & BIT_MASK_DUMP_OK_ADDR_8822B) -+#define BIT_SET_DUMP_OK_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_DUMP_OK_ADDR_8822B(x) | BIT_DUMP_OK_ADDR_8822B(v)) -+ -+#define BIT_SHIFT_R_TRIG_TIME_SEL_8822B 8 -+#define BIT_MASK_R_TRIG_TIME_SEL_8822B 0x7f -+#define BIT_R_TRIG_TIME_SEL_8822B(x) \ -+ (((x) & BIT_MASK_R_TRIG_TIME_SEL_8822B) \ -+ << BIT_SHIFT_R_TRIG_TIME_SEL_8822B) -+#define BITS_R_TRIG_TIME_SEL_8822B \ -+ (BIT_MASK_R_TRIG_TIME_SEL_8822B << BIT_SHIFT_R_TRIG_TIME_SEL_8822B) -+#define BIT_CLEAR_R_TRIG_TIME_SEL_8822B(x) ((x) & (~BITS_R_TRIG_TIME_SEL_8822B)) -+#define BIT_GET_R_TRIG_TIME_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_TRIG_TIME_SEL_8822B) & \ -+ BIT_MASK_R_TRIG_TIME_SEL_8822B) -+#define BIT_SET_R_TRIG_TIME_SEL_8822B(x, v) \ -+ (BIT_CLEAR_R_TRIG_TIME_SEL_8822B(x) | BIT_R_TRIG_TIME_SEL_8822B(v)) -+ -+#define BIT_SHIFT_R_MAC_TRIG_SEL_8822B 6 -+#define BIT_MASK_R_MAC_TRIG_SEL_8822B 0x3 -+#define BIT_R_MAC_TRIG_SEL_8822B(x) \ -+ (((x) & BIT_MASK_R_MAC_TRIG_SEL_8822B) \ -+ << BIT_SHIFT_R_MAC_TRIG_SEL_8822B) -+#define BITS_R_MAC_TRIG_SEL_8822B \ -+ (BIT_MASK_R_MAC_TRIG_SEL_8822B << BIT_SHIFT_R_MAC_TRIG_SEL_8822B) -+#define BIT_CLEAR_R_MAC_TRIG_SEL_8822B(x) ((x) & (~BITS_R_MAC_TRIG_SEL_8822B)) -+#define BIT_GET_R_MAC_TRIG_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_TRIG_SEL_8822B) & \ -+ BIT_MASK_R_MAC_TRIG_SEL_8822B) -+#define BIT_SET_R_MAC_TRIG_SEL_8822B(x, v) \ -+ (BIT_CLEAR_R_MAC_TRIG_SEL_8822B(x) | BIT_R_MAC_TRIG_SEL_8822B(v)) -+ -+#define BIT_MAC_TRIG_REG_8822B BIT(5) -+ -+#define BIT_SHIFT_R_LEVEL_PULSE_SEL_8822B 3 -+#define BIT_MASK_R_LEVEL_PULSE_SEL_8822B 0x3 -+#define BIT_R_LEVEL_PULSE_SEL_8822B(x) \ -+ (((x) & BIT_MASK_R_LEVEL_PULSE_SEL_8822B) \ -+ << BIT_SHIFT_R_LEVEL_PULSE_SEL_8822B) -+#define BITS_R_LEVEL_PULSE_SEL_8822B \ -+ (BIT_MASK_R_LEVEL_PULSE_SEL_8822B << BIT_SHIFT_R_LEVEL_PULSE_SEL_8822B) -+#define BIT_CLEAR_R_LEVEL_PULSE_SEL_8822B(x) \ -+ ((x) & (~BITS_R_LEVEL_PULSE_SEL_8822B)) -+#define BIT_GET_R_LEVEL_PULSE_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_LEVEL_PULSE_SEL_8822B) & \ -+ BIT_MASK_R_LEVEL_PULSE_SEL_8822B) -+#define BIT_SET_R_LEVEL_PULSE_SEL_8822B(x, v) \ -+ (BIT_CLEAR_R_LEVEL_PULSE_SEL_8822B(x) | BIT_R_LEVEL_PULSE_SEL_8822B(v)) -+ -+#define BIT_EN_LA_MAC_8822B BIT(2) -+#define BIT_R_EN_IQDUMP_8822B BIT(1) -+#define BIT_R_IQDATA_DUMP_8822B BIT(0) -+ -+/* 2 REG_WMAC_FTM_CTL_8822B */ -+#define BIT_RXFTM_TXACK_SC_8822B BIT(6) -+#define BIT_RXFTM_TXACK_BW_8822B BIT(5) -+#define BIT_RXFTM_EN_8822B BIT(3) -+#define BIT_RXFTMREQ_BYDRV_8822B BIT(2) -+#define BIT_RXFTMREQ_EN_8822B BIT(1) -+#define BIT_FTM_EN_8822B BIT(0) -+ -+/* 2 REG_WMAC_IQ_MDPK_FUNC_8822B */ -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_8822B */ -+ -+#define BIT_SHIFT_R_WMAC_RX_FIL_LEN_8822B (64 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_RX_FIL_LEN_8822B 0xffff -+#define BIT_R_WMAC_RX_FIL_LEN_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_RX_FIL_LEN_8822B) \ -+ << BIT_SHIFT_R_WMAC_RX_FIL_LEN_8822B) -+#define BITS_R_WMAC_RX_FIL_LEN_8822B \ -+ (BIT_MASK_R_WMAC_RX_FIL_LEN_8822B << BIT_SHIFT_R_WMAC_RX_FIL_LEN_8822B) -+#define BIT_CLEAR_R_WMAC_RX_FIL_LEN_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_RX_FIL_LEN_8822B)) -+#define BIT_GET_R_WMAC_RX_FIL_LEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RX_FIL_LEN_8822B) & \ -+ BIT_MASK_R_WMAC_RX_FIL_LEN_8822B) -+#define BIT_SET_R_WMAC_RX_FIL_LEN_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_RX_FIL_LEN_8822B(x) | BIT_R_WMAC_RX_FIL_LEN_8822B(v)) -+ -+#define BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_8822B (56 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_WMAC_RXFIFO_FULL_TH_8822B 0xff -+#define BIT_R_WMAC_RXFIFO_FULL_TH_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_RXFIFO_FULL_TH_8822B) \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_8822B) -+#define BITS_R_WMAC_RXFIFO_FULL_TH_8822B \ -+ (BIT_MASK_R_WMAC_RXFIFO_FULL_TH_8822B \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_8822B) -+#define BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_RXFIFO_FULL_TH_8822B)) -+#define BIT_GET_R_WMAC_RXFIFO_FULL_TH_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_8822B) & \ -+ BIT_MASK_R_WMAC_RXFIFO_FULL_TH_8822B) -+#define BIT_SET_R_WMAC_RXFIFO_FULL_TH_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_8822B(x) | \ -+ BIT_R_WMAC_RXFIFO_FULL_TH_8822B(v)) -+ -+#define BIT_R_WMAC_RX_SYNCFIFO_SYNC_8822B BIT(55) -+#define BIT_R_WMAC_RXRST_DLY_8822B BIT(54) -+#define BIT_R_WMAC_SRCH_TXRPT_REF_DROP_8822B BIT(53) -+#define BIT_R_WMAC_SRCH_TXRPT_UA1_8822B BIT(52) -+#define BIT_R_WMAC_SRCH_TXRPT_TYPE_8822B BIT(51) -+#define BIT_R_WMAC_NDP_RST_8822B BIT(50) -+#define BIT_R_WMAC_POWINT_EN_8822B BIT(49) -+#define BIT_R_WMAC_SRCH_TXRPT_PERPKT_8822B BIT(48) -+#define BIT_R_WMAC_SRCH_TXRPT_MID_8822B BIT(47) -+#define BIT_R_WMAC_PFIN_TOEN_8822B BIT(46) -+#define BIT_R_WMAC_FIL_SECERR_8822B BIT(45) -+#define BIT_R_WMAC_FIL_CTLPKTLEN_8822B BIT(44) -+#define BIT_R_WMAC_FIL_FCTYPE_8822B BIT(43) -+#define BIT_R_WMAC_FIL_FCPROVER_8822B BIT(42) -+#define BIT_R_WMAC_PHYSTS_SNIF_8822B BIT(41) -+#define BIT_R_WMAC_PHYSTS_PLCP_8822B BIT(40) -+#define BIT_R_MAC_TCR_VBONF_RD_8822B BIT(39) -+#define BIT_R_WMAC_TCR_MPAR_NDP_8822B BIT(38) -+#define BIT_R_WMAC_NDP_FILTER_8822B BIT(37) -+#define BIT_R_WMAC_RXLEN_SEL_8822B BIT(36) -+#define BIT_R_WMAC_RXLEN_SEL1_8822B BIT(35) -+#define BIT_R_OFDM_FILTER_8822B BIT(34) -+#define BIT_R_WMAC_CHK_OFDM_LEN_8822B BIT(33) -+#define BIT_R_WMAC_CHK_CCK_LEN_8822B BIT(32) -+ -+#define BIT_SHIFT_R_OFDM_LEN_8822B 26 -+#define BIT_MASK_R_OFDM_LEN_8822B 0x3f -+#define BIT_R_OFDM_LEN_8822B(x) \ -+ (((x) & BIT_MASK_R_OFDM_LEN_8822B) << BIT_SHIFT_R_OFDM_LEN_8822B) -+#define BITS_R_OFDM_LEN_8822B \ -+ (BIT_MASK_R_OFDM_LEN_8822B << BIT_SHIFT_R_OFDM_LEN_8822B) -+#define BIT_CLEAR_R_OFDM_LEN_8822B(x) ((x) & (~BITS_R_OFDM_LEN_8822B)) -+#define BIT_GET_R_OFDM_LEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_OFDM_LEN_8822B) & BIT_MASK_R_OFDM_LEN_8822B) -+#define BIT_SET_R_OFDM_LEN_8822B(x, v) \ -+ (BIT_CLEAR_R_OFDM_LEN_8822B(x) | BIT_R_OFDM_LEN_8822B(v)) -+ -+#define BIT_SHIFT_R_CCK_LEN_8822B 0 -+#define BIT_MASK_R_CCK_LEN_8822B 0xffff -+#define BIT_R_CCK_LEN_8822B(x) \ -+ (((x) & BIT_MASK_R_CCK_LEN_8822B) << BIT_SHIFT_R_CCK_LEN_8822B) -+#define BITS_R_CCK_LEN_8822B \ -+ (BIT_MASK_R_CCK_LEN_8822B << BIT_SHIFT_R_CCK_LEN_8822B) -+#define BIT_CLEAR_R_CCK_LEN_8822B(x) ((x) & (~BITS_R_CCK_LEN_8822B)) -+#define BIT_GET_R_CCK_LEN_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_CCK_LEN_8822B) & BIT_MASK_R_CCK_LEN_8822B) -+#define BIT_SET_R_CCK_LEN_8822B(x, v) \ -+ (BIT_CLEAR_R_CCK_LEN_8822B(x) | BIT_R_CCK_LEN_8822B(v)) -+ -+/* 2 REG_RX_FILTER_FUNCTION_8822B */ -+#define BIT_R_WMAC_MHRDDY_LATCH_8822B BIT(14) -+#define BIT_R_WMAC_MHRDDY_CLR_8822B BIT(13) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY1_8822B BIT(12) -+#define BIT_WMAC_DIS_VHT_PLCP_CHK_MU_8822B BIT(11) -+#define BIT_R_CHK_DELIMIT_LEN_8822B BIT(10) -+#define BIT_R_REAPTER_ADDR_MATCH_8822B BIT(9) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY_8822B BIT(8) -+#define BIT_R_LATCH_MACHRDY_8822B BIT(7) -+#define BIT_R_WMAC_RXFIL_REND_8822B BIT(6) -+#define BIT_R_WMAC_MPDURDY_CLR_8822B BIT(5) -+#define BIT_R_WMAC_CLRRXSEC_8822B BIT(4) -+#define BIT_R_WMAC_RXFIL_RDEL_8822B BIT(3) -+#define BIT_R_WMAC_RXFIL_FCSE_8822B BIT(2) -+#define BIT_R_WMAC_RXFIL_MESH_DEL_8822B BIT(1) -+#define BIT_R_WMAC_RXFIL_MASKM_8822B BIT(0) -+ -+/* 2 REG_NDP_SIG_8822B */ -+ -+#define BIT_SHIFT_R_WMAC_TXNDP_SIGB_8822B 0 -+#define BIT_MASK_R_WMAC_TXNDP_SIGB_8822B 0x1fffff -+#define BIT_R_WMAC_TXNDP_SIGB_8822B(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXNDP_SIGB_8822B) \ -+ << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8822B) -+#define BITS_R_WMAC_TXNDP_SIGB_8822B \ -+ (BIT_MASK_R_WMAC_TXNDP_SIGB_8822B << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8822B) -+#define BIT_CLEAR_R_WMAC_TXNDP_SIGB_8822B(x) \ -+ ((x) & (~BITS_R_WMAC_TXNDP_SIGB_8822B)) -+#define BIT_GET_R_WMAC_TXNDP_SIGB_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXNDP_SIGB_8822B) & \ -+ BIT_MASK_R_WMAC_TXNDP_SIGB_8822B) -+#define BIT_SET_R_WMAC_TXNDP_SIGB_8822B(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXNDP_SIGB_8822B(x) | BIT_R_WMAC_TXNDP_SIGB_8822B(v)) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_8822B */ -+ -+#define BIT_SHIFT_R_MAC_DEBUG_8822B (32 & CPU_OPT_WIDTH) -+#define BIT_MASK_R_MAC_DEBUG_8822B 0xffffffffL -+#define BIT_R_MAC_DEBUG_8822B(x) \ -+ (((x) & BIT_MASK_R_MAC_DEBUG_8822B) << BIT_SHIFT_R_MAC_DEBUG_8822B) -+#define BITS_R_MAC_DEBUG_8822B \ -+ (BIT_MASK_R_MAC_DEBUG_8822B << BIT_SHIFT_R_MAC_DEBUG_8822B) -+#define BIT_CLEAR_R_MAC_DEBUG_8822B(x) ((x) & (~BITS_R_MAC_DEBUG_8822B)) -+#define BIT_GET_R_MAC_DEBUG_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DEBUG_8822B) & BIT_MASK_R_MAC_DEBUG_8822B) -+#define BIT_SET_R_MAC_DEBUG_8822B(x, v) \ -+ (BIT_CLEAR_R_MAC_DEBUG_8822B(x) | BIT_R_MAC_DEBUG_8822B(v)) -+ -+#define BIT_SHIFT_R_MAC_DBG_SHIFT_8822B 8 -+#define BIT_MASK_R_MAC_DBG_SHIFT_8822B 0x7 -+#define BIT_R_MAC_DBG_SHIFT_8822B(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SHIFT_8822B) \ -+ << BIT_SHIFT_R_MAC_DBG_SHIFT_8822B) -+#define BITS_R_MAC_DBG_SHIFT_8822B \ -+ (BIT_MASK_R_MAC_DBG_SHIFT_8822B << BIT_SHIFT_R_MAC_DBG_SHIFT_8822B) -+#define BIT_CLEAR_R_MAC_DBG_SHIFT_8822B(x) ((x) & (~BITS_R_MAC_DBG_SHIFT_8822B)) -+#define BIT_GET_R_MAC_DBG_SHIFT_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SHIFT_8822B) & \ -+ BIT_MASK_R_MAC_DBG_SHIFT_8822B) -+#define BIT_SET_R_MAC_DBG_SHIFT_8822B(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SHIFT_8822B(x) | BIT_R_MAC_DBG_SHIFT_8822B(v)) -+ -+#define BIT_SHIFT_R_MAC_DBG_SEL_8822B 0 -+#define BIT_MASK_R_MAC_DBG_SEL_8822B 0x3 -+#define BIT_R_MAC_DBG_SEL_8822B(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SEL_8822B) << BIT_SHIFT_R_MAC_DBG_SEL_8822B) -+#define BITS_R_MAC_DBG_SEL_8822B \ -+ (BIT_MASK_R_MAC_DBG_SEL_8822B << BIT_SHIFT_R_MAC_DBG_SEL_8822B) -+#define BIT_CLEAR_R_MAC_DBG_SEL_8822B(x) ((x) & (~BITS_R_MAC_DBG_SEL_8822B)) -+#define BIT_GET_R_MAC_DBG_SEL_8822B(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SEL_8822B) & BIT_MASK_R_MAC_DBG_SEL_8822B) -+#define BIT_SET_R_MAC_DBG_SEL_8822B(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SEL_8822B(x) | BIT_R_MAC_DBG_SEL_8822B(v)) -+ -+/* 2 REG_RTS_ADDRESS_0_8822B */ -+ -+/* 2 REG_RTS_ADDRESS_1_8822B */ -+ -+/* 2 REG_RPFM_MAP1_8822B */ -+#define BIT_DATA_RPFM15EN_8822B BIT(15) -+#define BIT_DATA_RPFM14EN_8822B BIT(14) -+#define BIT_DATA_RPFM13EN_8822B BIT(13) -+#define BIT_DATA_RPFM12EN_8822B BIT(12) -+#define BIT_DATA_RPFM11EN_8822B BIT(11) -+#define BIT_DATA_RPFM10EN_8822B BIT(10) -+#define BIT_DATA_RPFM9EN_8822B BIT(9) -+#define BIT_DATA_RPFM8EN_8822B BIT(8) -+#define BIT_DATA_RPFM7EN_8822B BIT(7) -+#define BIT_DATA_RPFM6EN_8822B BIT(6) -+#define BIT_DATA_RPFM5EN_8822B BIT(5) -+#define BIT_DATA_RPFM4EN_8822B BIT(4) -+#define BIT_DATA_RPFM3EN_8822B BIT(3) -+#define BIT_DATA_RPFM2EN_8822B BIT(2) -+#define BIT_DATA_RPFM1EN_8822B BIT(1) -+#define BIT_DATA_RPFM0EN_8822B BIT(0) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8822B */ -+#define BIT_LTECOEX_ACCESS_START_V1_8822B BIT(31) -+#define BIT_LTECOEX_WRITE_MODE_V1_8822B BIT(30) -+#define BIT_LTECOEX_READY_BIT_V1_8822B BIT(29) -+ -+#define BIT_SHIFT_WRITE_BYTE_EN_V1_8822B 16 -+#define BIT_MASK_WRITE_BYTE_EN_V1_8822B 0xf -+#define BIT_WRITE_BYTE_EN_V1_8822B(x) \ -+ (((x) & BIT_MASK_WRITE_BYTE_EN_V1_8822B) \ -+ << BIT_SHIFT_WRITE_BYTE_EN_V1_8822B) -+#define BITS_WRITE_BYTE_EN_V1_8822B \ -+ (BIT_MASK_WRITE_BYTE_EN_V1_8822B << BIT_SHIFT_WRITE_BYTE_EN_V1_8822B) -+#define BIT_CLEAR_WRITE_BYTE_EN_V1_8822B(x) \ -+ ((x) & (~BITS_WRITE_BYTE_EN_V1_8822B)) -+#define BIT_GET_WRITE_BYTE_EN_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_WRITE_BYTE_EN_V1_8822B) & \ -+ BIT_MASK_WRITE_BYTE_EN_V1_8822B) -+#define BIT_SET_WRITE_BYTE_EN_V1_8822B(x, v) \ -+ (BIT_CLEAR_WRITE_BYTE_EN_V1_8822B(x) | BIT_WRITE_BYTE_EN_V1_8822B(v)) -+ -+#define BIT_SHIFT_LTECOEX_REG_ADDR_V1_8822B 0 -+#define BIT_MASK_LTECOEX_REG_ADDR_V1_8822B 0xffff -+#define BIT_LTECOEX_REG_ADDR_V1_8822B(x) \ -+ (((x) & BIT_MASK_LTECOEX_REG_ADDR_V1_8822B) \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8822B) -+#define BITS_LTECOEX_REG_ADDR_V1_8822B \ -+ (BIT_MASK_LTECOEX_REG_ADDR_V1_8822B \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8822B) -+#define BIT_CLEAR_LTECOEX_REG_ADDR_V1_8822B(x) \ -+ ((x) & (~BITS_LTECOEX_REG_ADDR_V1_8822B)) -+#define BIT_GET_LTECOEX_REG_ADDR_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_REG_ADDR_V1_8822B) & \ -+ BIT_MASK_LTECOEX_REG_ADDR_V1_8822B) -+#define BIT_SET_LTECOEX_REG_ADDR_V1_8822B(x, v) \ -+ (BIT_CLEAR_LTECOEX_REG_ADDR_V1_8822B(x) | \ -+ BIT_LTECOEX_REG_ADDR_V1_8822B(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8822B */ -+ -+#define BIT_SHIFT_LTECOEX_W_DATA_V1_8822B 0 -+#define BIT_MASK_LTECOEX_W_DATA_V1_8822B 0xffffffffL -+#define BIT_LTECOEX_W_DATA_V1_8822B(x) \ -+ (((x) & BIT_MASK_LTECOEX_W_DATA_V1_8822B) \ -+ << BIT_SHIFT_LTECOEX_W_DATA_V1_8822B) -+#define BITS_LTECOEX_W_DATA_V1_8822B \ -+ (BIT_MASK_LTECOEX_W_DATA_V1_8822B << BIT_SHIFT_LTECOEX_W_DATA_V1_8822B) -+#define BIT_CLEAR_LTECOEX_W_DATA_V1_8822B(x) \ -+ ((x) & (~BITS_LTECOEX_W_DATA_V1_8822B)) -+#define BIT_GET_LTECOEX_W_DATA_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_W_DATA_V1_8822B) & \ -+ BIT_MASK_LTECOEX_W_DATA_V1_8822B) -+#define BIT_SET_LTECOEX_W_DATA_V1_8822B(x, v) \ -+ (BIT_CLEAR_LTECOEX_W_DATA_V1_8822B(x) | BIT_LTECOEX_W_DATA_V1_8822B(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8822B */ -+ -+#define BIT_SHIFT_LTECOEX_R_DATA_V1_8822B 0 -+#define BIT_MASK_LTECOEX_R_DATA_V1_8822B 0xffffffffL -+#define BIT_LTECOEX_R_DATA_V1_8822B(x) \ -+ (((x) & BIT_MASK_LTECOEX_R_DATA_V1_8822B) \ -+ << BIT_SHIFT_LTECOEX_R_DATA_V1_8822B) -+#define BITS_LTECOEX_R_DATA_V1_8822B \ -+ (BIT_MASK_LTECOEX_R_DATA_V1_8822B << BIT_SHIFT_LTECOEX_R_DATA_V1_8822B) -+#define BIT_CLEAR_LTECOEX_R_DATA_V1_8822B(x) \ -+ ((x) & (~BITS_LTECOEX_R_DATA_V1_8822B)) -+#define BIT_GET_LTECOEX_R_DATA_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_R_DATA_V1_8822B) & \ -+ BIT_MASK_LTECOEX_R_DATA_V1_8822B) -+#define BIT_SET_LTECOEX_R_DATA_V1_8822B(x, v) \ -+ (BIT_CLEAR_LTECOEX_R_DATA_V1_8822B(x) | BIT_LTECOEX_R_DATA_V1_8822B(v)) -+ -+/* 2 REG_NOT_VALID_8822B */ -+ -+/* 2 REG_SDIO_TX_CTRL_8822B */ -+ -+#define BIT_SHIFT_SDIO_INT_TIMEOUT_8822B 16 -+#define BIT_MASK_SDIO_INT_TIMEOUT_8822B 0xffff -+#define BIT_SDIO_INT_TIMEOUT_8822B(x) \ -+ (((x) & BIT_MASK_SDIO_INT_TIMEOUT_8822B) \ -+ << BIT_SHIFT_SDIO_INT_TIMEOUT_8822B) -+#define BITS_SDIO_INT_TIMEOUT_8822B \ -+ (BIT_MASK_SDIO_INT_TIMEOUT_8822B << BIT_SHIFT_SDIO_INT_TIMEOUT_8822B) -+#define BIT_CLEAR_SDIO_INT_TIMEOUT_8822B(x) \ -+ ((x) & (~BITS_SDIO_INT_TIMEOUT_8822B)) -+#define BIT_GET_SDIO_INT_TIMEOUT_8822B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_INT_TIMEOUT_8822B) & \ -+ BIT_MASK_SDIO_INT_TIMEOUT_8822B) -+#define BIT_SET_SDIO_INT_TIMEOUT_8822B(x, v) \ -+ (BIT_CLEAR_SDIO_INT_TIMEOUT_8822B(x) | BIT_SDIO_INT_TIMEOUT_8822B(v)) -+ -+#define BIT_IO_ERR_STATUS_8822B BIT(15) -+#define BIT_REPLY_ERRCRC_IN_DATA_8822B BIT(9) -+#define BIT_EN_CMD53_OVERLAP_8822B BIT(8) -+#define BIT_REPLY_ERR_IN_R5_8822B BIT(7) -+#define BIT_R18A_EN_8822B BIT(6) -+#define BIT_SDIO_CMD_FORCE_VLD_8822B BIT(5) -+#define BIT_INIT_CMD_EN_8822B BIT(4) -+#define BIT_EN_RXDMA_MASK_INT_8822B BIT(2) -+#define BIT_EN_MASK_TIMER_8822B BIT(1) -+#define BIT_CMD_ERR_STOP_INT_EN_8822B BIT(0) -+ -+/* 2 REG_SDIO_HIMR_8822B */ -+#define BIT_SDIO_CRCERR_MSK_8822B BIT(31) -+#define BIT_SDIO_HSISR3_IND_MSK_8822B BIT(30) -+#define BIT_SDIO_HSISR2_IND_MSK_8822B BIT(29) -+#define BIT_SDIO_HEISR_IND_MSK_8822B BIT(28) -+#define BIT_SDIO_CTWEND_MSK_8822B BIT(27) -+#define BIT_SDIO_ATIMEND_E_MSK_8822B BIT(26) -+#define BIT_SDIIO_ATIMEND_MSK_8822B BIT(25) -+#define BIT_SDIO_OCPINT_MSK_8822B BIT(24) -+#define BIT_SDIO_PSTIMEOUT_MSK_8822B BIT(23) -+#define BIT_SDIO_GTINT4_MSK_8822B BIT(22) -+#define BIT_SDIO_GTINT3_MSK_8822B BIT(21) -+#define BIT_SDIO_HSISR_IND_MSK_8822B BIT(20) -+#define BIT_SDIO_CPWM2_MSK_8822B BIT(19) -+#define BIT_SDIO_CPWM1_MSK_8822B BIT(18) -+#define BIT_SDIO_C2HCMD_INT_MSK_8822B BIT(17) -+#define BIT_SDIO_BCNERLY_INT_MSK_8822B BIT(16) -+#define BIT_SDIO_TXBCNERR_MSK_8822B BIT(7) -+#define BIT_SDIO_TXBCNOK_MSK_8822B BIT(6) -+#define BIT_SDIO_RXFOVW_MSK_8822B BIT(5) -+#define BIT_SDIO_TXFOVW_MSK_8822B BIT(4) -+#define BIT_SDIO_RXERR_MSK_8822B BIT(3) -+#define BIT_SDIO_TXERR_MSK_8822B BIT(2) -+#define BIT_SDIO_AVAL_MSK_8822B BIT(1) -+#define BIT_RX_REQUEST_MSK_8822B BIT(0) -+ -+/* 2 REG_SDIO_HISR_8822B */ -+#define BIT_SDIO_CRCERR_8822B BIT(31) -+#define BIT_SDIO_HSISR3_IND_8822B BIT(30) -+#define BIT_SDIO_HSISR2_IND_8822B BIT(29) -+#define BIT_SDIO_HEISR_IND_8822B BIT(28) -+#define BIT_SDIO_CTWEND_8822B BIT(27) -+#define BIT_SDIO_ATIMEND_E_8822B BIT(26) -+#define BIT_SDIO_ATIMEND_8822B BIT(25) -+#define BIT_SDIO_OCPINT_8822B BIT(24) -+#define BIT_SDIO_PSTIMEOUT_8822B BIT(23) -+#define BIT_SDIO_GTINT4_8822B BIT(22) -+#define BIT_SDIO_GTINT3_8822B BIT(21) -+#define BIT_SDIO_HSISR_IND_8822B BIT(20) -+#define BIT_SDIO_CPWM2_8822B BIT(19) -+#define BIT_SDIO_CPWM1_8822B BIT(18) -+#define BIT_SDIO_C2HCMD_INT_8822B BIT(17) -+#define BIT_SDIO_BCNERLY_INT_8822B BIT(16) -+#define BIT_SDIO_TXBCNERR_8822B BIT(7) -+#define BIT_SDIO_TXBCNOK_8822B BIT(6) -+#define BIT_SDIO_RXFOVW_8822B BIT(5) -+#define BIT_SDIO_TXFOVW_8822B BIT(4) -+#define BIT_SDIO_RXERR_8822B BIT(3) -+#define BIT_SDIO_TXERR_8822B BIT(2) -+#define BIT_SDIO_AVAL_8822B BIT(1) -+#define BIT_RX_REQUEST_8822B BIT(0) -+ -+/* 2 REG_SDIO_RX_REQ_LEN_8822B */ -+ -+#define BIT_SHIFT_RX_REQ_LEN_V1_8822B 0 -+#define BIT_MASK_RX_REQ_LEN_V1_8822B 0x3ffff -+#define BIT_RX_REQ_LEN_V1_8822B(x) \ -+ (((x) & BIT_MASK_RX_REQ_LEN_V1_8822B) << BIT_SHIFT_RX_REQ_LEN_V1_8822B) -+#define BITS_RX_REQ_LEN_V1_8822B \ -+ (BIT_MASK_RX_REQ_LEN_V1_8822B << BIT_SHIFT_RX_REQ_LEN_V1_8822B) -+#define BIT_CLEAR_RX_REQ_LEN_V1_8822B(x) ((x) & (~BITS_RX_REQ_LEN_V1_8822B)) -+#define BIT_GET_RX_REQ_LEN_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_RX_REQ_LEN_V1_8822B) & BIT_MASK_RX_REQ_LEN_V1_8822B) -+#define BIT_SET_RX_REQ_LEN_V1_8822B(x, v) \ -+ (BIT_CLEAR_RX_REQ_LEN_V1_8822B(x) | BIT_RX_REQ_LEN_V1_8822B(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG_SEQ_V1_8822B */ -+ -+#define BIT_SHIFT_FREE_TXPG_SEQ_8822B 0 -+#define BIT_MASK_FREE_TXPG_SEQ_8822B 0xff -+#define BIT_FREE_TXPG_SEQ_8822B(x) \ -+ (((x) & BIT_MASK_FREE_TXPG_SEQ_8822B) << BIT_SHIFT_FREE_TXPG_SEQ_8822B) -+#define BITS_FREE_TXPG_SEQ_8822B \ -+ (BIT_MASK_FREE_TXPG_SEQ_8822B << BIT_SHIFT_FREE_TXPG_SEQ_8822B) -+#define BIT_CLEAR_FREE_TXPG_SEQ_8822B(x) ((x) & (~BITS_FREE_TXPG_SEQ_8822B)) -+#define BIT_GET_FREE_TXPG_SEQ_8822B(x) \ -+ (((x) >> BIT_SHIFT_FREE_TXPG_SEQ_8822B) & BIT_MASK_FREE_TXPG_SEQ_8822B) -+#define BIT_SET_FREE_TXPG_SEQ_8822B(x, v) \ -+ (BIT_CLEAR_FREE_TXPG_SEQ_8822B(x) | BIT_FREE_TXPG_SEQ_8822B(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG_8822B */ -+ -+#define BIT_SHIFT_MID_FREEPG_V1_8822B 16 -+#define BIT_MASK_MID_FREEPG_V1_8822B 0xfff -+#define BIT_MID_FREEPG_V1_8822B(x) \ -+ (((x) & BIT_MASK_MID_FREEPG_V1_8822B) << BIT_SHIFT_MID_FREEPG_V1_8822B) -+#define BITS_MID_FREEPG_V1_8822B \ -+ (BIT_MASK_MID_FREEPG_V1_8822B << BIT_SHIFT_MID_FREEPG_V1_8822B) -+#define BIT_CLEAR_MID_FREEPG_V1_8822B(x) ((x) & (~BITS_MID_FREEPG_V1_8822B)) -+#define BIT_GET_MID_FREEPG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_MID_FREEPG_V1_8822B) & BIT_MASK_MID_FREEPG_V1_8822B) -+#define BIT_SET_MID_FREEPG_V1_8822B(x, v) \ -+ (BIT_CLEAR_MID_FREEPG_V1_8822B(x) | BIT_MID_FREEPG_V1_8822B(v)) -+ -+#define BIT_SHIFT_HIQ_FREEPG_V1_8822B 0 -+#define BIT_MASK_HIQ_FREEPG_V1_8822B 0xfff -+#define BIT_HIQ_FREEPG_V1_8822B(x) \ -+ (((x) & BIT_MASK_HIQ_FREEPG_V1_8822B) << BIT_SHIFT_HIQ_FREEPG_V1_8822B) -+#define BITS_HIQ_FREEPG_V1_8822B \ -+ (BIT_MASK_HIQ_FREEPG_V1_8822B << BIT_SHIFT_HIQ_FREEPG_V1_8822B) -+#define BIT_CLEAR_HIQ_FREEPG_V1_8822B(x) ((x) & (~BITS_HIQ_FREEPG_V1_8822B)) -+#define BIT_GET_HIQ_FREEPG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HIQ_FREEPG_V1_8822B) & BIT_MASK_HIQ_FREEPG_V1_8822B) -+#define BIT_SET_HIQ_FREEPG_V1_8822B(x, v) \ -+ (BIT_CLEAR_HIQ_FREEPG_V1_8822B(x) | BIT_HIQ_FREEPG_V1_8822B(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG2_8822B */ -+ -+#define BIT_SHIFT_PUB_FREEPG_V1_8822B 16 -+#define BIT_MASK_PUB_FREEPG_V1_8822B 0xfff -+#define BIT_PUB_FREEPG_V1_8822B(x) \ -+ (((x) & BIT_MASK_PUB_FREEPG_V1_8822B) << BIT_SHIFT_PUB_FREEPG_V1_8822B) -+#define BITS_PUB_FREEPG_V1_8822B \ -+ (BIT_MASK_PUB_FREEPG_V1_8822B << BIT_SHIFT_PUB_FREEPG_V1_8822B) -+#define BIT_CLEAR_PUB_FREEPG_V1_8822B(x) ((x) & (~BITS_PUB_FREEPG_V1_8822B)) -+#define BIT_GET_PUB_FREEPG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_PUB_FREEPG_V1_8822B) & BIT_MASK_PUB_FREEPG_V1_8822B) -+#define BIT_SET_PUB_FREEPG_V1_8822B(x, v) \ -+ (BIT_CLEAR_PUB_FREEPG_V1_8822B(x) | BIT_PUB_FREEPG_V1_8822B(v)) -+ -+#define BIT_SHIFT_LOW_FREEPG_V1_8822B 0 -+#define BIT_MASK_LOW_FREEPG_V1_8822B 0xfff -+#define BIT_LOW_FREEPG_V1_8822B(x) \ -+ (((x) & BIT_MASK_LOW_FREEPG_V1_8822B) << BIT_SHIFT_LOW_FREEPG_V1_8822B) -+#define BITS_LOW_FREEPG_V1_8822B \ -+ (BIT_MASK_LOW_FREEPG_V1_8822B << BIT_SHIFT_LOW_FREEPG_V1_8822B) -+#define BIT_CLEAR_LOW_FREEPG_V1_8822B(x) ((x) & (~BITS_LOW_FREEPG_V1_8822B)) -+#define BIT_GET_LOW_FREEPG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_LOW_FREEPG_V1_8822B) & BIT_MASK_LOW_FREEPG_V1_8822B) -+#define BIT_SET_LOW_FREEPG_V1_8822B(x, v) \ -+ (BIT_CLEAR_LOW_FREEPG_V1_8822B(x) | BIT_LOW_FREEPG_V1_8822B(v)) -+ -+/* 2 REG_SDIO_OQT_FREE_TXPG_V1_8822B */ -+ -+#define BIT_SHIFT_NOAC_OQT_FREEPG_V1_8822B 24 -+#define BIT_MASK_NOAC_OQT_FREEPG_V1_8822B 0xff -+#define BIT_NOAC_OQT_FREEPG_V1_8822B(x) \ -+ (((x) & BIT_MASK_NOAC_OQT_FREEPG_V1_8822B) \ -+ << BIT_SHIFT_NOAC_OQT_FREEPG_V1_8822B) -+#define BITS_NOAC_OQT_FREEPG_V1_8822B \ -+ (BIT_MASK_NOAC_OQT_FREEPG_V1_8822B \ -+ << BIT_SHIFT_NOAC_OQT_FREEPG_V1_8822B) -+#define BIT_CLEAR_NOAC_OQT_FREEPG_V1_8822B(x) \ -+ ((x) & (~BITS_NOAC_OQT_FREEPG_V1_8822B)) -+#define BIT_GET_NOAC_OQT_FREEPG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_NOAC_OQT_FREEPG_V1_8822B) & \ -+ BIT_MASK_NOAC_OQT_FREEPG_V1_8822B) -+#define BIT_SET_NOAC_OQT_FREEPG_V1_8822B(x, v) \ -+ (BIT_CLEAR_NOAC_OQT_FREEPG_V1_8822B(x) | \ -+ BIT_NOAC_OQT_FREEPG_V1_8822B(v)) -+ -+#define BIT_SHIFT_AC_OQT_FREEPG_V1_8822B 16 -+#define BIT_MASK_AC_OQT_FREEPG_V1_8822B 0xff -+#define BIT_AC_OQT_FREEPG_V1_8822B(x) \ -+ (((x) & BIT_MASK_AC_OQT_FREEPG_V1_8822B) \ -+ << BIT_SHIFT_AC_OQT_FREEPG_V1_8822B) -+#define BITS_AC_OQT_FREEPG_V1_8822B \ -+ (BIT_MASK_AC_OQT_FREEPG_V1_8822B << BIT_SHIFT_AC_OQT_FREEPG_V1_8822B) -+#define BIT_CLEAR_AC_OQT_FREEPG_V1_8822B(x) \ -+ ((x) & (~BITS_AC_OQT_FREEPG_V1_8822B)) -+#define BIT_GET_AC_OQT_FREEPG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_AC_OQT_FREEPG_V1_8822B) & \ -+ BIT_MASK_AC_OQT_FREEPG_V1_8822B) -+#define BIT_SET_AC_OQT_FREEPG_V1_8822B(x, v) \ -+ (BIT_CLEAR_AC_OQT_FREEPG_V1_8822B(x) | BIT_AC_OQT_FREEPG_V1_8822B(v)) -+ -+#define BIT_SHIFT_EXQ_FREEPG_V1_8822B 0 -+#define BIT_MASK_EXQ_FREEPG_V1_8822B 0xfff -+#define BIT_EXQ_FREEPG_V1_8822B(x) \ -+ (((x) & BIT_MASK_EXQ_FREEPG_V1_8822B) << BIT_SHIFT_EXQ_FREEPG_V1_8822B) -+#define BITS_EXQ_FREEPG_V1_8822B \ -+ (BIT_MASK_EXQ_FREEPG_V1_8822B << BIT_SHIFT_EXQ_FREEPG_V1_8822B) -+#define BIT_CLEAR_EXQ_FREEPG_V1_8822B(x) ((x) & (~BITS_EXQ_FREEPG_V1_8822B)) -+#define BIT_GET_EXQ_FREEPG_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_EXQ_FREEPG_V1_8822B) & BIT_MASK_EXQ_FREEPG_V1_8822B) -+#define BIT_SET_EXQ_FREEPG_V1_8822B(x, v) \ -+ (BIT_CLEAR_EXQ_FREEPG_V1_8822B(x) | BIT_EXQ_FREEPG_V1_8822B(v)) -+ -+/* 2 REG_SDIO_HTSFR_INFO_8822B */ -+ -+#define BIT_SHIFT_HTSFR1_8822B 16 -+#define BIT_MASK_HTSFR1_8822B 0xffff -+#define BIT_HTSFR1_8822B(x) \ -+ (((x) & BIT_MASK_HTSFR1_8822B) << BIT_SHIFT_HTSFR1_8822B) -+#define BITS_HTSFR1_8822B (BIT_MASK_HTSFR1_8822B << BIT_SHIFT_HTSFR1_8822B) -+#define BIT_CLEAR_HTSFR1_8822B(x) ((x) & (~BITS_HTSFR1_8822B)) -+#define BIT_GET_HTSFR1_8822B(x) \ -+ (((x) >> BIT_SHIFT_HTSFR1_8822B) & BIT_MASK_HTSFR1_8822B) -+#define BIT_SET_HTSFR1_8822B(x, v) \ -+ (BIT_CLEAR_HTSFR1_8822B(x) | BIT_HTSFR1_8822B(v)) -+ -+#define BIT_SHIFT_HTSFR0_8822B 0 -+#define BIT_MASK_HTSFR0_8822B 0xffff -+#define BIT_HTSFR0_8822B(x) \ -+ (((x) & BIT_MASK_HTSFR0_8822B) << BIT_SHIFT_HTSFR0_8822B) -+#define BITS_HTSFR0_8822B (BIT_MASK_HTSFR0_8822B << BIT_SHIFT_HTSFR0_8822B) -+#define BIT_CLEAR_HTSFR0_8822B(x) ((x) & (~BITS_HTSFR0_8822B)) -+#define BIT_GET_HTSFR0_8822B(x) \ -+ (((x) >> BIT_SHIFT_HTSFR0_8822B) & BIT_MASK_HTSFR0_8822B) -+#define BIT_SET_HTSFR0_8822B(x, v) \ -+ (BIT_CLEAR_HTSFR0_8822B(x) | BIT_HTSFR0_8822B(v)) -+ -+/* 2 REG_SDIO_HCPWM1_V2_8822B */ -+#define BIT_TOGGLE_8822B BIT(7) -+#define BIT_CUR_PS_8822B BIT(0) -+ -+/* 2 REG_SDIO_HCPWM2_V2_8822B */ -+ -+/* 2 REG_SDIO_INDIRECT_REG_CFG_8822B */ -+#define BIT_INDIRECT_REG_RDY_8822B BIT(20) -+#define BIT_INDIRECT_REG_R_8822B BIT(19) -+#define BIT_INDIRECT_REG_W_8822B BIT(18) -+ -+#define BIT_SHIFT_INDIRECT_REG_SIZE_8822B 16 -+#define BIT_MASK_INDIRECT_REG_SIZE_8822B 0x3 -+#define BIT_INDIRECT_REG_SIZE_8822B(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_SIZE_8822B) \ -+ << BIT_SHIFT_INDIRECT_REG_SIZE_8822B) -+#define BITS_INDIRECT_REG_SIZE_8822B \ -+ (BIT_MASK_INDIRECT_REG_SIZE_8822B << BIT_SHIFT_INDIRECT_REG_SIZE_8822B) -+#define BIT_CLEAR_INDIRECT_REG_SIZE_8822B(x) \ -+ ((x) & (~BITS_INDIRECT_REG_SIZE_8822B)) -+#define BIT_GET_INDIRECT_REG_SIZE_8822B(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_SIZE_8822B) & \ -+ BIT_MASK_INDIRECT_REG_SIZE_8822B) -+#define BIT_SET_INDIRECT_REG_SIZE_8822B(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_SIZE_8822B(x) | BIT_INDIRECT_REG_SIZE_8822B(v)) -+ -+#define BIT_SHIFT_INDIRECT_REG_ADDR_8822B 0 -+#define BIT_MASK_INDIRECT_REG_ADDR_8822B 0xffff -+#define BIT_INDIRECT_REG_ADDR_8822B(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_ADDR_8822B) \ -+ << BIT_SHIFT_INDIRECT_REG_ADDR_8822B) -+#define BITS_INDIRECT_REG_ADDR_8822B \ -+ (BIT_MASK_INDIRECT_REG_ADDR_8822B << BIT_SHIFT_INDIRECT_REG_ADDR_8822B) -+#define BIT_CLEAR_INDIRECT_REG_ADDR_8822B(x) \ -+ ((x) & (~BITS_INDIRECT_REG_ADDR_8822B)) -+#define BIT_GET_INDIRECT_REG_ADDR_8822B(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_ADDR_8822B) & \ -+ BIT_MASK_INDIRECT_REG_ADDR_8822B) -+#define BIT_SET_INDIRECT_REG_ADDR_8822B(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_ADDR_8822B(x) | BIT_INDIRECT_REG_ADDR_8822B(v)) -+ -+/* 2 REG_SDIO_INDIRECT_REG_DATA_8822B */ -+ -+#define BIT_SHIFT_INDIRECT_REG_DATA_8822B 0 -+#define BIT_MASK_INDIRECT_REG_DATA_8822B 0xffffffffL -+#define BIT_INDIRECT_REG_DATA_8822B(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_DATA_8822B) \ -+ << BIT_SHIFT_INDIRECT_REG_DATA_8822B) -+#define BITS_INDIRECT_REG_DATA_8822B \ -+ (BIT_MASK_INDIRECT_REG_DATA_8822B << BIT_SHIFT_INDIRECT_REG_DATA_8822B) -+#define BIT_CLEAR_INDIRECT_REG_DATA_8822B(x) \ -+ ((x) & (~BITS_INDIRECT_REG_DATA_8822B)) -+#define BIT_GET_INDIRECT_REG_DATA_8822B(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_DATA_8822B) & \ -+ BIT_MASK_INDIRECT_REG_DATA_8822B) -+#define BIT_SET_INDIRECT_REG_DATA_8822B(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_DATA_8822B(x) | BIT_INDIRECT_REG_DATA_8822B(v)) -+ -+/* 2 REG_SDIO_H2C_8822B */ -+ -+#define BIT_SHIFT_SDIO_H2C_MSG_8822B 0 -+#define BIT_MASK_SDIO_H2C_MSG_8822B 0xffffffffL -+#define BIT_SDIO_H2C_MSG_8822B(x) \ -+ (((x) & BIT_MASK_SDIO_H2C_MSG_8822B) << BIT_SHIFT_SDIO_H2C_MSG_8822B) -+#define BITS_SDIO_H2C_MSG_8822B \ -+ (BIT_MASK_SDIO_H2C_MSG_8822B << BIT_SHIFT_SDIO_H2C_MSG_8822B) -+#define BIT_CLEAR_SDIO_H2C_MSG_8822B(x) ((x) & (~BITS_SDIO_H2C_MSG_8822B)) -+#define BIT_GET_SDIO_H2C_MSG_8822B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_H2C_MSG_8822B) & BIT_MASK_SDIO_H2C_MSG_8822B) -+#define BIT_SET_SDIO_H2C_MSG_8822B(x, v) \ -+ (BIT_CLEAR_SDIO_H2C_MSG_8822B(x) | BIT_SDIO_H2C_MSG_8822B(v)) -+ -+/* 2 REG_SDIO_C2H_8822B */ -+ -+#define BIT_SHIFT_SDIO_C2H_MSG_8822B 0 -+#define BIT_MASK_SDIO_C2H_MSG_8822B 0xffffffffL -+#define BIT_SDIO_C2H_MSG_8822B(x) \ -+ (((x) & BIT_MASK_SDIO_C2H_MSG_8822B) << BIT_SHIFT_SDIO_C2H_MSG_8822B) -+#define BITS_SDIO_C2H_MSG_8822B \ -+ (BIT_MASK_SDIO_C2H_MSG_8822B << BIT_SHIFT_SDIO_C2H_MSG_8822B) -+#define BIT_CLEAR_SDIO_C2H_MSG_8822B(x) ((x) & (~BITS_SDIO_C2H_MSG_8822B)) -+#define BIT_GET_SDIO_C2H_MSG_8822B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_C2H_MSG_8822B) & BIT_MASK_SDIO_C2H_MSG_8822B) -+#define BIT_SET_SDIO_C2H_MSG_8822B(x, v) \ -+ (BIT_CLEAR_SDIO_C2H_MSG_8822B(x) | BIT_SDIO_C2H_MSG_8822B(v)) -+ -+/* 2 REG_SDIO_HRPWM1_8822B */ -+#define BIT_TOGGLE_8822B BIT(7) -+#define BIT_ACK_8822B BIT(6) -+#define BIT_REQ_PS_8822B BIT(0) -+ -+/* 2 REG_SDIO_HRPWM2_8822B */ -+ -+/* 2 REG_SDIO_HPS_CLKR_8822B */ -+ -+/* 2 REG_SDIO_BUS_CTRL_8822B */ -+#define BIT_PAD_CLK_XHGE_EN_8822B BIT(3) -+#define BIT_INTER_CLK_EN_8822B BIT(2) -+#define BIT_EN_RPT_TXCRC_8822B BIT(1) -+#define BIT_DIS_RXDMA_STS_8822B BIT(0) -+ -+/* 2 REG_SDIO_HSUS_CTRL_8822B */ -+#define BIT_INTR_CTRL_8822B BIT(4) -+#define BIT_SDIO_VOLTAGE_8822B BIT(3) -+#define BIT_BYPASS_INIT_8822B BIT(2) -+#define BIT_HCI_RESUME_RDY_8822B BIT(1) -+#define BIT_HCI_SUS_REQ_8822B BIT(0) -+ -+/* 2 REG_SDIO_RESPONSE_TIMER_8822B */ -+ -+#define BIT_SHIFT_CMDIN_2RESP_TIMER_8822B 0 -+#define BIT_MASK_CMDIN_2RESP_TIMER_8822B 0xffff -+#define BIT_CMDIN_2RESP_TIMER_8822B(x) \ -+ (((x) & BIT_MASK_CMDIN_2RESP_TIMER_8822B) \ -+ << BIT_SHIFT_CMDIN_2RESP_TIMER_8822B) -+#define BITS_CMDIN_2RESP_TIMER_8822B \ -+ (BIT_MASK_CMDIN_2RESP_TIMER_8822B << BIT_SHIFT_CMDIN_2RESP_TIMER_8822B) -+#define BIT_CLEAR_CMDIN_2RESP_TIMER_8822B(x) \ -+ ((x) & (~BITS_CMDIN_2RESP_TIMER_8822B)) -+#define BIT_GET_CMDIN_2RESP_TIMER_8822B(x) \ -+ (((x) >> BIT_SHIFT_CMDIN_2RESP_TIMER_8822B) & \ -+ BIT_MASK_CMDIN_2RESP_TIMER_8822B) -+#define BIT_SET_CMDIN_2RESP_TIMER_8822B(x, v) \ -+ (BIT_CLEAR_CMDIN_2RESP_TIMER_8822B(x) | BIT_CMDIN_2RESP_TIMER_8822B(v)) -+ -+/* 2 REG_SDIO_CMD_CRC_8822B */ -+ -+#define BIT_SHIFT_SDIO_CMD_CRC_V1_8822B 0 -+#define BIT_MASK_SDIO_CMD_CRC_V1_8822B 0xff -+#define BIT_SDIO_CMD_CRC_V1_8822B(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_CRC_V1_8822B) \ -+ << BIT_SHIFT_SDIO_CMD_CRC_V1_8822B) -+#define BITS_SDIO_CMD_CRC_V1_8822B \ -+ (BIT_MASK_SDIO_CMD_CRC_V1_8822B << BIT_SHIFT_SDIO_CMD_CRC_V1_8822B) -+#define BIT_CLEAR_SDIO_CMD_CRC_V1_8822B(x) ((x) & (~BITS_SDIO_CMD_CRC_V1_8822B)) -+#define BIT_GET_SDIO_CMD_CRC_V1_8822B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_CRC_V1_8822B) & \ -+ BIT_MASK_SDIO_CMD_CRC_V1_8822B) -+#define BIT_SET_SDIO_CMD_CRC_V1_8822B(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_CRC_V1_8822B(x) | BIT_SDIO_CMD_CRC_V1_8822B(v)) -+ -+/* 2 REG_SDIO_HSISR_8822B */ -+#define BIT_DRV_WLAN_INT_CLR_8822B BIT(1) -+#define BIT_DRV_WLAN_INT_8822B BIT(0) -+ -+/* 2 REG_SDIO_ERR_RPT_8822B */ -+#define BIT_HR_FF_OVF_8822B BIT(6) -+#define BIT_HR_FF_UDN_8822B BIT(5) -+#define BIT_TXDMA_BUSY_ERR_8822B BIT(4) -+#define BIT_TXDMA_VLD_ERR_8822B BIT(3) -+#define BIT_QSEL_UNKNOWN_ERR_8822B BIT(2) -+#define BIT_QSEL_MIS_ERR_8822B BIT(1) -+#define BIT_SDIO_OVERRD_ERR_8822B BIT(0) -+ -+/* 2 REG_SDIO_CMD_ERRCNT_8822B */ -+ -+#define BIT_SHIFT_CMD_CRC_ERR_CNT_8822B 0 -+#define BIT_MASK_CMD_CRC_ERR_CNT_8822B 0xff -+#define BIT_CMD_CRC_ERR_CNT_8822B(x) \ -+ (((x) & BIT_MASK_CMD_CRC_ERR_CNT_8822B) \ -+ << BIT_SHIFT_CMD_CRC_ERR_CNT_8822B) -+#define BITS_CMD_CRC_ERR_CNT_8822B \ -+ (BIT_MASK_CMD_CRC_ERR_CNT_8822B << BIT_SHIFT_CMD_CRC_ERR_CNT_8822B) -+#define BIT_CLEAR_CMD_CRC_ERR_CNT_8822B(x) ((x) & (~BITS_CMD_CRC_ERR_CNT_8822B)) -+#define BIT_GET_CMD_CRC_ERR_CNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_CMD_CRC_ERR_CNT_8822B) & \ -+ BIT_MASK_CMD_CRC_ERR_CNT_8822B) -+#define BIT_SET_CMD_CRC_ERR_CNT_8822B(x, v) \ -+ (BIT_CLEAR_CMD_CRC_ERR_CNT_8822B(x) | BIT_CMD_CRC_ERR_CNT_8822B(v)) -+ -+/* 2 REG_SDIO_DATA_ERRCNT_8822B */ -+ -+#define BIT_SHIFT_DATA_CRC_ERR_CNT_8822B 0 -+#define BIT_MASK_DATA_CRC_ERR_CNT_8822B 0xff -+#define BIT_DATA_CRC_ERR_CNT_8822B(x) \ -+ (((x) & BIT_MASK_DATA_CRC_ERR_CNT_8822B) \ -+ << BIT_SHIFT_DATA_CRC_ERR_CNT_8822B) -+#define BITS_DATA_CRC_ERR_CNT_8822B \ -+ (BIT_MASK_DATA_CRC_ERR_CNT_8822B << BIT_SHIFT_DATA_CRC_ERR_CNT_8822B) -+#define BIT_CLEAR_DATA_CRC_ERR_CNT_8822B(x) \ -+ ((x) & (~BITS_DATA_CRC_ERR_CNT_8822B)) -+#define BIT_GET_DATA_CRC_ERR_CNT_8822B(x) \ -+ (((x) >> BIT_SHIFT_DATA_CRC_ERR_CNT_8822B) & \ -+ BIT_MASK_DATA_CRC_ERR_CNT_8822B) -+#define BIT_SET_DATA_CRC_ERR_CNT_8822B(x, v) \ -+ (BIT_CLEAR_DATA_CRC_ERR_CNT_8822B(x) | BIT_DATA_CRC_ERR_CNT_8822B(v)) -+ -+/* 2 REG_SDIO_CMD_ERR_CONTENT_8822B */ -+ -+#define BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8822B 0 -+#define BIT_MASK_SDIO_CMD_ERR_CONTENT_8822B 0xffffffffffL -+#define BIT_SDIO_CMD_ERR_CONTENT_8822B(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_ERR_CONTENT_8822B) \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8822B) -+#define BITS_SDIO_CMD_ERR_CONTENT_8822B \ -+ (BIT_MASK_SDIO_CMD_ERR_CONTENT_8822B \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8822B) -+#define BIT_CLEAR_SDIO_CMD_ERR_CONTENT_8822B(x) \ -+ ((x) & (~BITS_SDIO_CMD_ERR_CONTENT_8822B)) -+#define BIT_GET_SDIO_CMD_ERR_CONTENT_8822B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8822B) & \ -+ BIT_MASK_SDIO_CMD_ERR_CONTENT_8822B) -+#define BIT_SET_SDIO_CMD_ERR_CONTENT_8822B(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_ERR_CONTENT_8822B(x) | \ -+ BIT_SDIO_CMD_ERR_CONTENT_8822B(v)) -+ -+/* 2 REG_SDIO_CRC_ERR_IDX_8822B */ -+#define BIT_D3_CRC_ERR_8822B BIT(4) -+#define BIT_D2_CRC_ERR_8822B BIT(3) -+#define BIT_D1_CRC_ERR_8822B BIT(2) -+#define BIT_D0_CRC_ERR_8822B BIT(1) -+#define BIT_CMD_CRC_ERR_8822B BIT(0) -+ -+/* 2 REG_SDIO_DATA_CRC_8822B */ -+ -+#define BIT_SHIFT_SDIO_DATA_CRC_8822B 0 -+#define BIT_MASK_SDIO_DATA_CRC_8822B 0xffff -+#define BIT_SDIO_DATA_CRC_8822B(x) \ -+ (((x) & BIT_MASK_SDIO_DATA_CRC_8822B) << BIT_SHIFT_SDIO_DATA_CRC_8822B) -+#define BITS_SDIO_DATA_CRC_8822B \ -+ (BIT_MASK_SDIO_DATA_CRC_8822B << BIT_SHIFT_SDIO_DATA_CRC_8822B) -+#define BIT_CLEAR_SDIO_DATA_CRC_8822B(x) ((x) & (~BITS_SDIO_DATA_CRC_8822B)) -+#define BIT_GET_SDIO_DATA_CRC_8822B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DATA_CRC_8822B) & BIT_MASK_SDIO_DATA_CRC_8822B) -+#define BIT_SET_SDIO_DATA_CRC_8822B(x, v) \ -+ (BIT_CLEAR_SDIO_DATA_CRC_8822B(x) | BIT_SDIO_DATA_CRC_8822B(v)) -+ -+/* 2 REG_SDIO_DATA_REPLY_TIME_8822B */ -+ -+#define BIT_SHIFT_SDIO_DATA_REPLY_TIME_8822B 0 -+#define BIT_MASK_SDIO_DATA_REPLY_TIME_8822B 0x7 -+#define BIT_SDIO_DATA_REPLY_TIME_8822B(x) \ -+ (((x) & BIT_MASK_SDIO_DATA_REPLY_TIME_8822B) \ -+ << BIT_SHIFT_SDIO_DATA_REPLY_TIME_8822B) -+#define BITS_SDIO_DATA_REPLY_TIME_8822B \ -+ (BIT_MASK_SDIO_DATA_REPLY_TIME_8822B \ -+ << BIT_SHIFT_SDIO_DATA_REPLY_TIME_8822B) -+#define BIT_CLEAR_SDIO_DATA_REPLY_TIME_8822B(x) \ -+ ((x) & (~BITS_SDIO_DATA_REPLY_TIME_8822B)) -+#define BIT_GET_SDIO_DATA_REPLY_TIME_8822B(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DATA_REPLY_TIME_8822B) & \ -+ BIT_MASK_SDIO_DATA_REPLY_TIME_8822B) -+#define BIT_SET_SDIO_DATA_REPLY_TIME_8822B(x, v) \ -+ (BIT_CLEAR_SDIO_DATA_REPLY_TIME_8822B(x) | \ -+ BIT_SDIO_DATA_REPLY_TIME_8822B(v)) -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8822c.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8822c.h -new file mode 100644 -index 000000000..38a2a3d8f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_bit_8822c.h -@@ -0,0 +1,21873 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_BIT_8822C_H -+#define __INC_HALMAC_BIT_8822C_H -+ -+#define CPU_OPT_WIDTH 0x1F -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_SYS_ISO_CTRL_8822C */ -+#define BIT_PWC_EV12V_8822C BIT(15) -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_PA33V_EN_8822C BIT(13) -+#define BIT_PA12V_EN_8822C BIT(12) -+#define BIT_UA33V_EN_8822C BIT(11) -+#define BIT_UA12V_EN_8822C BIT(10) -+#define BIT_ISO_RFDIO_8822C BIT(9) -+#define BIT_ISO_EB2CORE_8822C BIT(8) -+#define BIT_ISO_DIOE_8822C BIT(7) -+#define BIT_ISO_WLPON2PP_8822C BIT(6) -+#define BIT_ISO_IP2MAC_WA2PP_8822C BIT(5) -+#define BIT_ISO_PD2CORE_8822C BIT(4) -+#define BIT_ISO_PA2PCIE_8822C BIT(3) -+#define BIT_ISO_UD2CORE_8822C BIT(2) -+#define BIT_ISO_UA2USB_8822C BIT(1) -+#define BIT_ISO_WD2PP_8822C BIT(0) -+ -+/* 2 REG_SYS_FUNC_EN_8822C */ -+#define BIT_FEN_MREGEN_8822C BIT(15) -+#define BIT_FEN_HWPDN_8822C BIT(14) -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_FEN_ELDR_8822C BIT(12) -+#define BIT_FEN_DCORE_8822C BIT(11) -+#define BIT_FEN_CPUEN_8822C BIT(10) -+#define BIT_FEN_DIOE_8822C BIT(9) -+#define BIT_FEN_PCIED_8822C BIT(8) -+#define BIT_FEN_PPLL_8822C BIT(7) -+#define BIT_FEN_PCIEA_8822C BIT(6) -+#define BIT_FEN_DIO_PCIE_8822C BIT(5) -+#define BIT_FEN_USBD_8822C BIT(4) -+#define BIT_FEN_UPLL_8822C BIT(3) -+#define BIT_FEN_USBA_8822C BIT(2) -+#define BIT_FEN_BB_GLB_RSTN_8822C BIT(1) -+#define BIT_FEN_BBRSTB_8822C BIT(0) -+ -+/* 2 REG_SYS_PW_CTRL_8822C */ -+#define BIT_SOP_EABM_8822C BIT(31) -+#define BIT_SOP_ACKF_8822C BIT(30) -+#define BIT_SOP_ERCK_8822C BIT(29) -+#define BIT_SOP_ESWR_8822C BIT(28) -+#define BIT_SOP_PWMM_8822C BIT(27) -+#define BIT_SOP_EECK_8822C BIT(26) -+#define BIT_SOP_ANA_CLK_DIVISION_2_8822C BIT(25) -+#define BIT_SOP_EXTL_8822C BIT(24) -+#define BIT_SYM_OP_RING_12M_8822C BIT(22) -+#define BIT_ROP_SWPR_8822C BIT(21) -+#define BIT_DIS_HW_LPLDM_8822C BIT(20) -+#define BIT_OPT_SWRST_WLMCU_8822C BIT(19) -+#define BIT_RDY_SYSPWR_8822C BIT(17) -+#define BIT_EN_WLON_8822C BIT(16) -+#define BIT_APDM_HPDN_8822C BIT(15) -+#define BIT_AFSM_PCIE_SUS_EN_8822C BIT(12) -+#define BIT_AFSM_WLSUS_EN_8822C BIT(11) -+#define BIT_APFM_SWLPS_8822C BIT(10) -+#define BIT_APFM_OFFMAC_8822C BIT(9) -+#define BIT_APFN_ONMAC_8822C BIT(8) -+#define BIT_CHIP_PDN_EN_8822C BIT(7) -+#define BIT_RDY_MACDIS_8822C BIT(6) -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_PFM_WOWL_8822C BIT(3) -+#define BIT_PFM_LDKP_8822C BIT(2) -+#define BIT_WL_HCI_ALD_8822C BIT(1) -+#define BIT_PFM_LDALL_8822C BIT(0) -+ -+/* 2 REG_SYS_CLK_CTRL_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_CPU_CLK_EN_8822C BIT(14) -+#define BIT_SYMREG_CLK_EN_8822C BIT(13) -+#define BIT_HCI_CLK_EN_8822C BIT(12) -+#define BIT_MAC_CLK_EN_8822C BIT(11) -+#define BIT_SEC_CLK_EN_8822C BIT(10) -+#define BIT_PHY_SSC_RSTB_8822C BIT(9) -+#define BIT_EXT_32K_EN_8822C BIT(8) -+#define BIT_WL_CLK_TEST_8822C BIT(7) -+#define BIT_OP_SPS_PWM_EN_8822C BIT(6) -+#define BIT_LOADER_CLK_EN_8822C BIT(5) -+#define BIT_MACSLP_8822C BIT(4) -+#define BIT_WAKEPAD_EN_8822C BIT(3) -+#define BIT_ROMD16V_EN_8822C BIT(2) -+#define BIT_ANA_CLK_DIVISION_2_8822C BIT(1) -+#define BIT_CNTD16V_EN_8822C BIT(0) -+ -+/* 2 REG_SYS_EEPROM_CTRL_8822C */ -+ -+#define BIT_SHIFT_VPDIDX_8822C 8 -+#define BIT_MASK_VPDIDX_8822C 0xff -+#define BIT_VPDIDX_8822C(x) \ -+ (((x) & BIT_MASK_VPDIDX_8822C) << BIT_SHIFT_VPDIDX_8822C) -+#define BITS_VPDIDX_8822C (BIT_MASK_VPDIDX_8822C << BIT_SHIFT_VPDIDX_8822C) -+#define BIT_CLEAR_VPDIDX_8822C(x) ((x) & (~BITS_VPDIDX_8822C)) -+#define BIT_GET_VPDIDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_VPDIDX_8822C) & BIT_MASK_VPDIDX_8822C) -+#define BIT_SET_VPDIDX_8822C(x, v) \ -+ (BIT_CLEAR_VPDIDX_8822C(x) | BIT_VPDIDX_8822C(v)) -+ -+#define BIT_SHIFT_EEM1_0_8822C 6 -+#define BIT_MASK_EEM1_0_8822C 0x3 -+#define BIT_EEM1_0_8822C(x) \ -+ (((x) & BIT_MASK_EEM1_0_8822C) << BIT_SHIFT_EEM1_0_8822C) -+#define BITS_EEM1_0_8822C (BIT_MASK_EEM1_0_8822C << BIT_SHIFT_EEM1_0_8822C) -+#define BIT_CLEAR_EEM1_0_8822C(x) ((x) & (~BITS_EEM1_0_8822C)) -+#define BIT_GET_EEM1_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_EEM1_0_8822C) & BIT_MASK_EEM1_0_8822C) -+#define BIT_SET_EEM1_0_8822C(x, v) \ -+ (BIT_CLEAR_EEM1_0_8822C(x) | BIT_EEM1_0_8822C(v)) -+ -+#define BIT_AUTOLOAD_SUS_8822C BIT(5) -+#define BIT_EERPOMSEL_8822C BIT(4) -+#define BIT_EECS_V1_8822C BIT(3) -+#define BIT_EESK_V1_8822C BIT(2) -+#define BIT_EEDI_V1_8822C BIT(1) -+#define BIT_EEDO_V1_8822C BIT(0) -+ -+/* 2 REG_EE_VPD_8822C */ -+ -+#define BIT_SHIFT_VPD_DATA_8822C 0 -+#define BIT_MASK_VPD_DATA_8822C 0xffffffffL -+#define BIT_VPD_DATA_8822C(x) \ -+ (((x) & BIT_MASK_VPD_DATA_8822C) << BIT_SHIFT_VPD_DATA_8822C) -+#define BITS_VPD_DATA_8822C \ -+ (BIT_MASK_VPD_DATA_8822C << BIT_SHIFT_VPD_DATA_8822C) -+#define BIT_CLEAR_VPD_DATA_8822C(x) ((x) & (~BITS_VPD_DATA_8822C)) -+#define BIT_GET_VPD_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_VPD_DATA_8822C) & BIT_MASK_VPD_DATA_8822C) -+#define BIT_SET_VPD_DATA_8822C(x, v) \ -+ (BIT_CLEAR_VPD_DATA_8822C(x) | BIT_VPD_DATA_8822C(v)) -+ -+/* 2 REG_SYS_SWR_CTRL1_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_R_SYM_CTRL_SPS_PWMFREQ_8822C BIT(10) -+#define BIT_HW_AUTO_CTRL_EXT_SWR_8822C BIT(9) -+#define BIT_USE_INTERNAL_SWR_AND_LDO_8822C BIT(8) -+#define BIT_MAC_ID_EN_8822C BIT(7) -+#define BIT_OPTION_DIS_XTAL_BG_8822C BIT(2) -+ -+/* 2 REG_SYS_SWR_CTRL2_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_SW18_SEL_8822C BIT(13) -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_SW18_SD_8822C BIT(10) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_SYS_SWR_CTRL3_8822C */ -+#define BIT_SPS18_OCP_DIS_8822C BIT(31) -+ -+#define BIT_SHIFT_SPS18_OCP_TH_8822C 16 -+#define BIT_MASK_SPS18_OCP_TH_8822C 0x7fff -+#define BIT_SPS18_OCP_TH_8822C(x) \ -+ (((x) & BIT_MASK_SPS18_OCP_TH_8822C) << BIT_SHIFT_SPS18_OCP_TH_8822C) -+#define BITS_SPS18_OCP_TH_8822C \ -+ (BIT_MASK_SPS18_OCP_TH_8822C << BIT_SHIFT_SPS18_OCP_TH_8822C) -+#define BIT_CLEAR_SPS18_OCP_TH_8822C(x) ((x) & (~BITS_SPS18_OCP_TH_8822C)) -+#define BIT_GET_SPS18_OCP_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_SPS18_OCP_TH_8822C) & BIT_MASK_SPS18_OCP_TH_8822C) -+#define BIT_SET_SPS18_OCP_TH_8822C(x, v) \ -+ (BIT_CLEAR_SPS18_OCP_TH_8822C(x) | BIT_SPS18_OCP_TH_8822C(v)) -+ -+#define BIT_SHIFT_OCP_WINDOW_8822C 0 -+#define BIT_MASK_OCP_WINDOW_8822C 0xffff -+#define BIT_OCP_WINDOW_8822C(x) \ -+ (((x) & BIT_MASK_OCP_WINDOW_8822C) << BIT_SHIFT_OCP_WINDOW_8822C) -+#define BITS_OCP_WINDOW_8822C \ -+ (BIT_MASK_OCP_WINDOW_8822C << BIT_SHIFT_OCP_WINDOW_8822C) -+#define BIT_CLEAR_OCP_WINDOW_8822C(x) ((x) & (~BITS_OCP_WINDOW_8822C)) -+#define BIT_GET_OCP_WINDOW_8822C(x) \ -+ (((x) >> BIT_SHIFT_OCP_WINDOW_8822C) & BIT_MASK_OCP_WINDOW_8822C) -+#define BIT_SET_OCP_WINDOW_8822C(x, v) \ -+ (BIT_CLEAR_OCP_WINDOW_8822C(x) | BIT_OCP_WINDOW_8822C(v)) -+ -+/* 2 REG_RSV_CTRL_8822C */ -+#define BIT_HREG_DBG_8822C BIT(23) -+#define BIT_WLMCUIOIF_8822C BIT(8) -+#define BIT_LOCK_ALL_EN_8822C BIT(7) -+#define BIT_R_DIS_PRST_8822C BIT(6) -+#define BIT_WLOCK_1C_B6_8822C BIT(5) -+#define BIT_WLOCK_40_8822C BIT(4) -+#define BIT_WLOCK_08_8822C BIT(3) -+#define BIT_WLOCK_04_8822C BIT(2) -+#define BIT_WLOCK_00_8822C BIT(1) -+#define BIT_WLOCK_ALL_8822C BIT(0) -+ -+/* 2 REG_RF_CTRL_8822C */ -+#define BIT_S0_RFC_WO_0_8822C BIT(7) -+#define BIT_S0_RFC_WT_0_8822C BIT(6) -+#define BIT_S0_RFC_RSTB_8822C BIT(1) -+ -+/* 2 REG_AFE_LDO_CTRL_8822C */ -+#define BIT_R_SYM_WLPON_EMEM1_EN_8822C BIT(31) -+#define BIT_R_SYM_WLPON_EMEM0_EN_8822C BIT(30) -+#define BIT_R_SYM_WLPOFF_P4EN_8822C BIT(28) -+#define BIT_R_SYM_WLPOFF_P3EN_8822C BIT(27) -+#define BIT_R_SYM_WLPOFF_P2EN_8822C BIT(26) -+#define BIT_R_SYM_WLPOFF_P1EN_8822C BIT(25) -+#define BIT_R_SYM_WLPOFF_EN_8822C BIT(24) -+#define BIT_R_SYM_WLPON_P3EN_8822C BIT(21) -+#define BIT_R_SYM_WLPON_P2EN_8822C BIT(20) -+#define BIT_R_SYM_WLPON_P1EN_8822C BIT(19) -+#define BIT_R_SYM_WLPON_EN_8822C BIT(18) -+#define BIT_R_SYM_LDOV12D_STBY_8822C BIT(16) -+#define BIT_R_SYM_WLBBOFF1_P4_EN_8822C BIT(9) -+#define BIT_R_SYM_WLBBOFF1_P3_EN_8822C BIT(8) -+#define BIT_R_SYM_WLBBOFF1_P2_EN_8822C BIT(7) -+#define BIT_R_SYM_WLBBOFF1_P1_EN_8822C BIT(6) -+#define BIT_R_SYM_WLBBOFF_P4_EN_8822C BIT(4) -+#define BIT_R_SYM_WLBBOFF_P3_EN_8822C BIT(3) -+#define BIT_R_SYM_WLBBOFF_P2_EN_8822C BIT(2) -+#define BIT_R_SYM_WLBBOFF_P1_EN_8822C BIT(1) -+#define BIT_R_SYM_WLBBOFF_EN_8822C BIT(0) -+ -+/* 2 REG_AFE_CTRL1_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_MAC_CLK_SEL_8822C 20 -+#define BIT_MASK_MAC_CLK_SEL_8822C 0x3 -+#define BIT_MAC_CLK_SEL_8822C(x) \ -+ (((x) & BIT_MASK_MAC_CLK_SEL_8822C) << BIT_SHIFT_MAC_CLK_SEL_8822C) -+#define BITS_MAC_CLK_SEL_8822C \ -+ (BIT_MASK_MAC_CLK_SEL_8822C << BIT_SHIFT_MAC_CLK_SEL_8822C) -+#define BIT_CLEAR_MAC_CLK_SEL_8822C(x) ((x) & (~BITS_MAC_CLK_SEL_8822C)) -+#define BIT_GET_MAC_CLK_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAC_CLK_SEL_8822C) & BIT_MASK_MAC_CLK_SEL_8822C) -+#define BIT_SET_MAC_CLK_SEL_8822C(x, v) \ -+ (BIT_CLEAR_MAC_CLK_SEL_8822C(x) | BIT_MAC_CLK_SEL_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_ANAPARSW_POW_MAC_8822C */ -+#define BIT_POW_LDO15_8822C BIT(2) -+#define BIT_POW_SW_8822C BIT(1) -+#define BIT_POW_LDO14_8822C BIT(0) -+ -+/* 2 REG_ANAPARLDO_POW_MAC_8822C */ -+#define BIT_LDOE25_POW_L_8822C BIT(0) -+ -+/* 2 REG_ANAPAR_POW_MAC_8822C */ -+#define BIT_DUMMY_V4_8822C BIT(7) -+#define BIT_DUMMY_V3_8822C BIT(6) -+#define BIT_DUMMY_V2_8822C BIT(5) -+#define BIT_DUMMY_V1_8822C BIT(4) -+#define BIT_POW_PC_LDO_PORT1_8822C BIT(3) -+#define BIT_POW_PC_LDO_PORT0_8822C BIT(2) -+#define BIT_POW_PLL_V1_8822C BIT(1) -+#define BIT_POW_POWER_CUT_POW_LDO_8822C BIT(0) -+ -+/* 2 REG_ANAPAR_POW_XTAL_8822C */ -+#define BIT_POW_XTAL_8822C BIT(1) -+#define BIT_POW_BG_8822C BIT(0) -+ -+/* 2 REG_ANAPARLDO_MAC_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_REG_STANDBY_L_8822C BIT(19) -+#define BIT_PD_REGU_L_8822C BIT(18) -+#define BIT_EN_PC_BT_L_8822C BIT(17) -+ -+#define BIT_SHIFT_REG_LDOADJ_L_8822C 13 -+#define BIT_MASK_REG_LDOADJ_L_8822C 0xf -+#define BIT_REG_LDOADJ_L_8822C(x) \ -+ (((x) & BIT_MASK_REG_LDOADJ_L_8822C) << BIT_SHIFT_REG_LDOADJ_L_8822C) -+#define BITS_REG_LDOADJ_L_8822C \ -+ (BIT_MASK_REG_LDOADJ_L_8822C << BIT_SHIFT_REG_LDOADJ_L_8822C) -+#define BIT_CLEAR_REG_LDOADJ_L_8822C(x) ((x) & (~BITS_REG_LDOADJ_L_8822C)) -+#define BIT_GET_REG_LDOADJ_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LDOADJ_L_8822C) & BIT_MASK_REG_LDOADJ_L_8822C) -+#define BIT_SET_REG_LDOADJ_L_8822C(x, v) \ -+ (BIT_CLEAR_REG_LDOADJ_L_8822C(x) | BIT_REG_LDOADJ_L_8822C(v)) -+ -+#define BIT_CK12M_EN_8822C BIT(11) -+#define BIT_CK12M_SEL_8822C BIT(10) -+#define BIT_EN_25_L_8822C BIT(9) -+#define BIT_EN_SLEEP_8822C BIT(8) -+ -+#define BIT_SHIFT_LDOH12_V12ADJ_L_8822C 4 -+#define BIT_MASK_LDOH12_V12ADJ_L_8822C 0xf -+#define BIT_LDOH12_V12ADJ_L_8822C(x) \ -+ (((x) & BIT_MASK_LDOH12_V12ADJ_L_8822C) \ -+ << BIT_SHIFT_LDOH12_V12ADJ_L_8822C) -+#define BITS_LDOH12_V12ADJ_L_8822C \ -+ (BIT_MASK_LDOH12_V12ADJ_L_8822C << BIT_SHIFT_LDOH12_V12ADJ_L_8822C) -+#define BIT_CLEAR_LDOH12_V12ADJ_L_8822C(x) ((x) & (~BITS_LDOH12_V12ADJ_L_8822C)) -+#define BIT_GET_LDOH12_V12ADJ_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_LDOH12_V12ADJ_L_8822C) & \ -+ BIT_MASK_LDOH12_V12ADJ_L_8822C) -+#define BIT_SET_LDOH12_V12ADJ_L_8822C(x, v) \ -+ (BIT_CLEAR_LDOH12_V12ADJ_L_8822C(x) | BIT_LDOH12_V12ADJ_L_8822C(v)) -+ -+#define BIT_SHIFT_LDOE25_V12ADJ_L_V1_8822C 0 -+#define BIT_MASK_LDOE25_V12ADJ_L_V1_8822C 0xf -+#define BIT_LDOE25_V12ADJ_L_V1_8822C(x) \ -+ (((x) & BIT_MASK_LDOE25_V12ADJ_L_V1_8822C) \ -+ << BIT_SHIFT_LDOE25_V12ADJ_L_V1_8822C) -+#define BITS_LDOE25_V12ADJ_L_V1_8822C \ -+ (BIT_MASK_LDOE25_V12ADJ_L_V1_8822C \ -+ << BIT_SHIFT_LDOE25_V12ADJ_L_V1_8822C) -+#define BIT_CLEAR_LDOE25_V12ADJ_L_V1_8822C(x) \ -+ ((x) & (~BITS_LDOE25_V12ADJ_L_V1_8822C)) -+#define BIT_GET_LDOE25_V12ADJ_L_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_LDOE25_V12ADJ_L_V1_8822C) & \ -+ BIT_MASK_LDOE25_V12ADJ_L_V1_8822C) -+#define BIT_SET_LDOE25_V12ADJ_L_V1_8822C(x, v) \ -+ (BIT_CLEAR_LDOE25_V12ADJ_L_V1_8822C(x) | \ -+ BIT_LDOE25_V12ADJ_L_V1_8822C(v)) -+ -+/* 2 REG_EFUSE_CTRL_8822C */ -+#define BIT_EF_FLAG_8822C BIT(31) -+ -+#define BIT_SHIFT_EF_PGPD_8822C 28 -+#define BIT_MASK_EF_PGPD_8822C 0x7 -+#define BIT_EF_PGPD_8822C(x) \ -+ (((x) & BIT_MASK_EF_PGPD_8822C) << BIT_SHIFT_EF_PGPD_8822C) -+#define BITS_EF_PGPD_8822C (BIT_MASK_EF_PGPD_8822C << BIT_SHIFT_EF_PGPD_8822C) -+#define BIT_CLEAR_EF_PGPD_8822C(x) ((x) & (~BITS_EF_PGPD_8822C)) -+#define BIT_GET_EF_PGPD_8822C(x) \ -+ (((x) >> BIT_SHIFT_EF_PGPD_8822C) & BIT_MASK_EF_PGPD_8822C) -+#define BIT_SET_EF_PGPD_8822C(x, v) \ -+ (BIT_CLEAR_EF_PGPD_8822C(x) | BIT_EF_PGPD_8822C(v)) -+ -+#define BIT_SHIFT_EF_RDT_8822C 24 -+#define BIT_MASK_EF_RDT_8822C 0xf -+#define BIT_EF_RDT_8822C(x) \ -+ (((x) & BIT_MASK_EF_RDT_8822C) << BIT_SHIFT_EF_RDT_8822C) -+#define BITS_EF_RDT_8822C (BIT_MASK_EF_RDT_8822C << BIT_SHIFT_EF_RDT_8822C) -+#define BIT_CLEAR_EF_RDT_8822C(x) ((x) & (~BITS_EF_RDT_8822C)) -+#define BIT_GET_EF_RDT_8822C(x) \ -+ (((x) >> BIT_SHIFT_EF_RDT_8822C) & BIT_MASK_EF_RDT_8822C) -+#define BIT_SET_EF_RDT_8822C(x, v) \ -+ (BIT_CLEAR_EF_RDT_8822C(x) | BIT_EF_RDT_8822C(v)) -+ -+#define BIT_SHIFT_EF_PGTS_8822C 20 -+#define BIT_MASK_EF_PGTS_8822C 0xf -+#define BIT_EF_PGTS_8822C(x) \ -+ (((x) & BIT_MASK_EF_PGTS_8822C) << BIT_SHIFT_EF_PGTS_8822C) -+#define BITS_EF_PGTS_8822C (BIT_MASK_EF_PGTS_8822C << BIT_SHIFT_EF_PGTS_8822C) -+#define BIT_CLEAR_EF_PGTS_8822C(x) ((x) & (~BITS_EF_PGTS_8822C)) -+#define BIT_GET_EF_PGTS_8822C(x) \ -+ (((x) >> BIT_SHIFT_EF_PGTS_8822C) & BIT_MASK_EF_PGTS_8822C) -+#define BIT_SET_EF_PGTS_8822C(x, v) \ -+ (BIT_CLEAR_EF_PGTS_8822C(x) | BIT_EF_PGTS_8822C(v)) -+ -+#define BIT_EF_PDWN_8822C BIT(19) -+#define BIT_EF_ALDEN_8822C BIT(18) -+ -+#define BIT_SHIFT_EF_ADDR_8822C 8 -+#define BIT_MASK_EF_ADDR_8822C 0x3ff -+#define BIT_EF_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_EF_ADDR_8822C) << BIT_SHIFT_EF_ADDR_8822C) -+#define BITS_EF_ADDR_8822C (BIT_MASK_EF_ADDR_8822C << BIT_SHIFT_EF_ADDR_8822C) -+#define BIT_CLEAR_EF_ADDR_8822C(x) ((x) & (~BITS_EF_ADDR_8822C)) -+#define BIT_GET_EF_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_EF_ADDR_8822C) & BIT_MASK_EF_ADDR_8822C) -+#define BIT_SET_EF_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_EF_ADDR_8822C(x) | BIT_EF_ADDR_8822C(v)) -+ -+#define BIT_SHIFT_EF_DATA_8822C 0 -+#define BIT_MASK_EF_DATA_8822C 0xff -+#define BIT_EF_DATA_8822C(x) \ -+ (((x) & BIT_MASK_EF_DATA_8822C) << BIT_SHIFT_EF_DATA_8822C) -+#define BITS_EF_DATA_8822C (BIT_MASK_EF_DATA_8822C << BIT_SHIFT_EF_DATA_8822C) -+#define BIT_CLEAR_EF_DATA_8822C(x) ((x) & (~BITS_EF_DATA_8822C)) -+#define BIT_GET_EF_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_EF_DATA_8822C) & BIT_MASK_EF_DATA_8822C) -+#define BIT_SET_EF_DATA_8822C(x, v) \ -+ (BIT_CLEAR_EF_DATA_8822C(x) | BIT_EF_DATA_8822C(v)) -+ -+/* 2 REG_LDO_EFUSE_CTRL_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_EF_CRES_SEL_8822C BIT(26) -+ -+#define BIT_SHIFT_EF_SCAN_START_V1_8822C 16 -+#define BIT_MASK_EF_SCAN_START_V1_8822C 0x3ff -+#define BIT_EF_SCAN_START_V1_8822C(x) \ -+ (((x) & BIT_MASK_EF_SCAN_START_V1_8822C) \ -+ << BIT_SHIFT_EF_SCAN_START_V1_8822C) -+#define BITS_EF_SCAN_START_V1_8822C \ -+ (BIT_MASK_EF_SCAN_START_V1_8822C << BIT_SHIFT_EF_SCAN_START_V1_8822C) -+#define BIT_CLEAR_EF_SCAN_START_V1_8822C(x) \ -+ ((x) & (~BITS_EF_SCAN_START_V1_8822C)) -+#define BIT_GET_EF_SCAN_START_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_START_V1_8822C) & \ -+ BIT_MASK_EF_SCAN_START_V1_8822C) -+#define BIT_SET_EF_SCAN_START_V1_8822C(x, v) \ -+ (BIT_CLEAR_EF_SCAN_START_V1_8822C(x) | BIT_EF_SCAN_START_V1_8822C(v)) -+ -+#define BIT_SHIFT_EF_SCAN_END_8822C 12 -+#define BIT_MASK_EF_SCAN_END_8822C 0xf -+#define BIT_EF_SCAN_END_8822C(x) \ -+ (((x) & BIT_MASK_EF_SCAN_END_8822C) << BIT_SHIFT_EF_SCAN_END_8822C) -+#define BITS_EF_SCAN_END_8822C \ -+ (BIT_MASK_EF_SCAN_END_8822C << BIT_SHIFT_EF_SCAN_END_8822C) -+#define BIT_CLEAR_EF_SCAN_END_8822C(x) ((x) & (~BITS_EF_SCAN_END_8822C)) -+#define BIT_GET_EF_SCAN_END_8822C(x) \ -+ (((x) >> BIT_SHIFT_EF_SCAN_END_8822C) & BIT_MASK_EF_SCAN_END_8822C) -+#define BIT_SET_EF_SCAN_END_8822C(x, v) \ -+ (BIT_CLEAR_EF_SCAN_END_8822C(x) | BIT_EF_SCAN_END_8822C(v)) -+ -+#define BIT_EF_PD_DIS_8822C BIT(11) -+ -+#define BIT_SHIFT_EF_CELL_SEL_8822C 8 -+#define BIT_MASK_EF_CELL_SEL_8822C 0x3 -+#define BIT_EF_CELL_SEL_8822C(x) \ -+ (((x) & BIT_MASK_EF_CELL_SEL_8822C) << BIT_SHIFT_EF_CELL_SEL_8822C) -+#define BITS_EF_CELL_SEL_8822C \ -+ (BIT_MASK_EF_CELL_SEL_8822C << BIT_SHIFT_EF_CELL_SEL_8822C) -+#define BIT_CLEAR_EF_CELL_SEL_8822C(x) ((x) & (~BITS_EF_CELL_SEL_8822C)) -+#define BIT_GET_EF_CELL_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_EF_CELL_SEL_8822C) & BIT_MASK_EF_CELL_SEL_8822C) -+#define BIT_SET_EF_CELL_SEL_8822C(x, v) \ -+ (BIT_CLEAR_EF_CELL_SEL_8822C(x) | BIT_EF_CELL_SEL_8822C(v)) -+ -+#define BIT_EF_TRPT_8822C BIT(7) -+ -+#define BIT_SHIFT_EF_TTHD_8822C 0 -+#define BIT_MASK_EF_TTHD_8822C 0x7f -+#define BIT_EF_TTHD_8822C(x) \ -+ (((x) & BIT_MASK_EF_TTHD_8822C) << BIT_SHIFT_EF_TTHD_8822C) -+#define BITS_EF_TTHD_8822C (BIT_MASK_EF_TTHD_8822C << BIT_SHIFT_EF_TTHD_8822C) -+#define BIT_CLEAR_EF_TTHD_8822C(x) ((x) & (~BITS_EF_TTHD_8822C)) -+#define BIT_GET_EF_TTHD_8822C(x) \ -+ (((x) >> BIT_SHIFT_EF_TTHD_8822C) & BIT_MASK_EF_TTHD_8822C) -+#define BIT_SET_EF_TTHD_8822C(x, v) \ -+ (BIT_CLEAR_EF_TTHD_8822C(x) | BIT_EF_TTHD_8822C(v)) -+ -+/* 2 REG_PWR_OPTION_CTRL_8822C */ -+ -+#define BIT_SHIFT_DBG_SEL_V1_8822C 16 -+#define BIT_MASK_DBG_SEL_V1_8822C 0xff -+#define BIT_DBG_SEL_V1_8822C(x) \ -+ (((x) & BIT_MASK_DBG_SEL_V1_8822C) << BIT_SHIFT_DBG_SEL_V1_8822C) -+#define BITS_DBG_SEL_V1_8822C \ -+ (BIT_MASK_DBG_SEL_V1_8822C << BIT_SHIFT_DBG_SEL_V1_8822C) -+#define BIT_CLEAR_DBG_SEL_V1_8822C(x) ((x) & (~BITS_DBG_SEL_V1_8822C)) -+#define BIT_GET_DBG_SEL_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_V1_8822C) & BIT_MASK_DBG_SEL_V1_8822C) -+#define BIT_SET_DBG_SEL_V1_8822C(x, v) \ -+ (BIT_CLEAR_DBG_SEL_V1_8822C(x) | BIT_DBG_SEL_V1_8822C(v)) -+ -+#define BIT_SHIFT_DBG_SEL_BYTE_8822C 14 -+#define BIT_MASK_DBG_SEL_BYTE_8822C 0x3 -+#define BIT_DBG_SEL_BYTE_8822C(x) \ -+ (((x) & BIT_MASK_DBG_SEL_BYTE_8822C) << BIT_SHIFT_DBG_SEL_BYTE_8822C) -+#define BITS_DBG_SEL_BYTE_8822C \ -+ (BIT_MASK_DBG_SEL_BYTE_8822C << BIT_SHIFT_DBG_SEL_BYTE_8822C) -+#define BIT_CLEAR_DBG_SEL_BYTE_8822C(x) ((x) & (~BITS_DBG_SEL_BYTE_8822C)) -+#define BIT_GET_DBG_SEL_BYTE_8822C(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_BYTE_8822C) & BIT_MASK_DBG_SEL_BYTE_8822C) -+#define BIT_SET_DBG_SEL_BYTE_8822C(x, v) \ -+ (BIT_CLEAR_DBG_SEL_BYTE_8822C(x) | BIT_DBG_SEL_BYTE_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_SYSON_DBG_PAD_E2_8822C BIT(11) -+#define BIT_SYSON_LED_PAD_E2_8822C BIT(10) -+#define BIT_SYSON_GPEE_PAD_E2_8822C BIT(9) -+#define BIT_SYSON_PCI_PAD_E2_8822C BIT(8) -+#define BIT_AUTO_SW_LDO_VOL_EN_8822C BIT(7) -+ -+#define BIT_SHIFT_SYSON_SPS0WWV_WT_8822C 4 -+#define BIT_MASK_SYSON_SPS0WWV_WT_8822C 0x3 -+#define BIT_SYSON_SPS0WWV_WT_8822C(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0WWV_WT_8822C) \ -+ << BIT_SHIFT_SYSON_SPS0WWV_WT_8822C) -+#define BITS_SYSON_SPS0WWV_WT_8822C \ -+ (BIT_MASK_SYSON_SPS0WWV_WT_8822C << BIT_SHIFT_SYSON_SPS0WWV_WT_8822C) -+#define BIT_CLEAR_SYSON_SPS0WWV_WT_8822C(x) \ -+ ((x) & (~BITS_SYSON_SPS0WWV_WT_8822C)) -+#define BIT_GET_SYSON_SPS0WWV_WT_8822C(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0WWV_WT_8822C) & \ -+ BIT_MASK_SYSON_SPS0WWV_WT_8822C) -+#define BIT_SET_SYSON_SPS0WWV_WT_8822C(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0WWV_WT_8822C(x) | BIT_SYSON_SPS0WWV_WT_8822C(v)) -+ -+#define BIT_SHIFT_SYSON_SPS0LDO_WT_8822C 2 -+#define BIT_MASK_SYSON_SPS0LDO_WT_8822C 0x3 -+#define BIT_SYSON_SPS0LDO_WT_8822C(x) \ -+ (((x) & BIT_MASK_SYSON_SPS0LDO_WT_8822C) \ -+ << BIT_SHIFT_SYSON_SPS0LDO_WT_8822C) -+#define BITS_SYSON_SPS0LDO_WT_8822C \ -+ (BIT_MASK_SYSON_SPS0LDO_WT_8822C << BIT_SHIFT_SYSON_SPS0LDO_WT_8822C) -+#define BIT_CLEAR_SYSON_SPS0LDO_WT_8822C(x) \ -+ ((x) & (~BITS_SYSON_SPS0LDO_WT_8822C)) -+#define BIT_GET_SYSON_SPS0LDO_WT_8822C(x) \ -+ (((x) >> BIT_SHIFT_SYSON_SPS0LDO_WT_8822C) & \ -+ BIT_MASK_SYSON_SPS0LDO_WT_8822C) -+#define BIT_SET_SYSON_SPS0LDO_WT_8822C(x, v) \ -+ (BIT_CLEAR_SYSON_SPS0LDO_WT_8822C(x) | BIT_SYSON_SPS0LDO_WT_8822C(v)) -+ -+#define BIT_SHIFT_SYSON_RCLK_SCALE_8822C 0 -+#define BIT_MASK_SYSON_RCLK_SCALE_8822C 0x3 -+#define BIT_SYSON_RCLK_SCALE_8822C(x) \ -+ (((x) & BIT_MASK_SYSON_RCLK_SCALE_8822C) \ -+ << BIT_SHIFT_SYSON_RCLK_SCALE_8822C) -+#define BITS_SYSON_RCLK_SCALE_8822C \ -+ (BIT_MASK_SYSON_RCLK_SCALE_8822C << BIT_SHIFT_SYSON_RCLK_SCALE_8822C) -+#define BIT_CLEAR_SYSON_RCLK_SCALE_8822C(x) \ -+ ((x) & (~BITS_SYSON_RCLK_SCALE_8822C)) -+#define BIT_GET_SYSON_RCLK_SCALE_8822C(x) \ -+ (((x) >> BIT_SHIFT_SYSON_RCLK_SCALE_8822C) & \ -+ BIT_MASK_SYSON_RCLK_SCALE_8822C) -+#define BIT_SET_SYSON_RCLK_SCALE_8822C(x, v) \ -+ (BIT_CLEAR_SYSON_RCLK_SCALE_8822C(x) | BIT_SYSON_RCLK_SCALE_8822C(v)) -+ -+/* 2 REG_CAL_TIMER_8822C */ -+ -+#define BIT_SHIFT_MATCH_CNT_8822C 8 -+#define BIT_MASK_MATCH_CNT_8822C 0xff -+#define BIT_MATCH_CNT_8822C(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8822C) << BIT_SHIFT_MATCH_CNT_8822C) -+#define BITS_MATCH_CNT_8822C \ -+ (BIT_MASK_MATCH_CNT_8822C << BIT_SHIFT_MATCH_CNT_8822C) -+#define BIT_CLEAR_MATCH_CNT_8822C(x) ((x) & (~BITS_MATCH_CNT_8822C)) -+#define BIT_GET_MATCH_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8822C) & BIT_MASK_MATCH_CNT_8822C) -+#define BIT_SET_MATCH_CNT_8822C(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8822C(x) | BIT_MATCH_CNT_8822C(v)) -+ -+#define BIT_SHIFT_CAL_SCAL_8822C 0 -+#define BIT_MASK_CAL_SCAL_8822C 0xff -+#define BIT_CAL_SCAL_8822C(x) \ -+ (((x) & BIT_MASK_CAL_SCAL_8822C) << BIT_SHIFT_CAL_SCAL_8822C) -+#define BITS_CAL_SCAL_8822C \ -+ (BIT_MASK_CAL_SCAL_8822C << BIT_SHIFT_CAL_SCAL_8822C) -+#define BIT_CLEAR_CAL_SCAL_8822C(x) ((x) & (~BITS_CAL_SCAL_8822C)) -+#define BIT_GET_CAL_SCAL_8822C(x) \ -+ (((x) >> BIT_SHIFT_CAL_SCAL_8822C) & BIT_MASK_CAL_SCAL_8822C) -+#define BIT_SET_CAL_SCAL_8822C(x, v) \ -+ (BIT_CLEAR_CAL_SCAL_8822C(x) | BIT_CAL_SCAL_8822C(v)) -+ -+/* 2 REG_ACLK_MON_8822C */ -+ -+#define BIT_SHIFT_RCLK_MON_8822C 5 -+#define BIT_MASK_RCLK_MON_8822C 0x7ff -+#define BIT_RCLK_MON_8822C(x) \ -+ (((x) & BIT_MASK_RCLK_MON_8822C) << BIT_SHIFT_RCLK_MON_8822C) -+#define BITS_RCLK_MON_8822C \ -+ (BIT_MASK_RCLK_MON_8822C << BIT_SHIFT_RCLK_MON_8822C) -+#define BIT_CLEAR_RCLK_MON_8822C(x) ((x) & (~BITS_RCLK_MON_8822C)) -+#define BIT_GET_RCLK_MON_8822C(x) \ -+ (((x) >> BIT_SHIFT_RCLK_MON_8822C) & BIT_MASK_RCLK_MON_8822C) -+#define BIT_SET_RCLK_MON_8822C(x, v) \ -+ (BIT_CLEAR_RCLK_MON_8822C(x) | BIT_RCLK_MON_8822C(v)) -+ -+#define BIT_CAL_EN_8822C BIT(4) -+ -+#define BIT_SHIFT_DPSTU_8822C 2 -+#define BIT_MASK_DPSTU_8822C 0x3 -+#define BIT_DPSTU_8822C(x) \ -+ (((x) & BIT_MASK_DPSTU_8822C) << BIT_SHIFT_DPSTU_8822C) -+#define BITS_DPSTU_8822C (BIT_MASK_DPSTU_8822C << BIT_SHIFT_DPSTU_8822C) -+#define BIT_CLEAR_DPSTU_8822C(x) ((x) & (~BITS_DPSTU_8822C)) -+#define BIT_GET_DPSTU_8822C(x) \ -+ (((x) >> BIT_SHIFT_DPSTU_8822C) & BIT_MASK_DPSTU_8822C) -+#define BIT_SET_DPSTU_8822C(x, v) \ -+ (BIT_CLEAR_DPSTU_8822C(x) | BIT_DPSTU_8822C(v)) -+ -+#define BIT_SUS_16X_8822C BIT(1) -+ -+/* 2 REG_GPIO_MUXCFG_2_8822C */ -+#define BIT_SOUT_GPIO8_8822C BIT(7) -+#define BIT_SOUT_GPIO5_8822C BIT(6) -+#define BIT_RFE_CTRL_5_GPIO14_V1_8822C BIT(5) -+#define BIT_RFE_CTRL_10_GPIO13_V1_8822C BIT(4) -+#define BIT_RFE_CTRL_11_GPIO4_V1_8822C BIT(3) -+#define BIT_RFE_CTRL_5_GPIO14_8822C BIT(2) -+#define BIT_RFE_CTRL_10_GPIO13_8822C BIT(1) -+#define BIT_RFE_CTRL_11_GPIO4_8822C BIT(0) -+ -+/* 2 REG_GPIO_MUXCFG_8822C */ -+#define BIT_RFE_CTRL_3_GPIO12_8822C BIT(31) -+#define BIT_BT_RFE_CTRL_5_GPIO12_8822C BIT(30) -+#define BIT_S0_TRSW_GPIO12_8822C BIT(29) -+#define BIT_RFE_CTRL_9_GPIO13_8822C BIT(28) -+#define BIT_RFE_CTRL_9_GPIO12_8822C BIT(27) -+#define BIT_RFE_CTRL_8_GPIO4_8822C BIT(26) -+#define BIT_BT_RFE_CTRL_1_GPIO13_8822C BIT(25) -+#define BIT_BT_RFE_CTRL_1_GPIO12_8822C BIT(24) -+#define BIT_BT_RFE_CTRL_0_GPIO4_8822C BIT(23) -+#define BIT_ANTSW_GPIO13_8822C BIT(22) -+#define BIT_ANTSW_GPIO12_8822C BIT(21) -+#define BIT_ANTSWB_GPIO4_8822C BIT(20) -+#define BIT_FSPI_EN_8822C BIT(19) -+#define BIT_WL_RTS_EXT_32K_SEL_8822C BIT(18) -+#define BIT_WLBT_DPDT_SEL_EN_8822C BIT(17) -+#define BIT_WLBT_LNAON_SEL_EN_8822C BIT(16) -+#define BIT_SIC_LBK_8822C BIT(15) -+#define BIT_ENHTP_8822C BIT(14) -+#define BIT_BT_AOD_GPIO3_8822C BIT(13) -+#define BIT_ENSIC_8822C BIT(12) -+#define BIT_SIC_SWRST_8822C BIT(11) -+#define BIT_PO_WIFI_PTA_PINS_8822C BIT(10) -+#define BIT_PO_BT_PTA_PINS_8822C BIT(9) -+#define BIT_ENUART_8822C BIT(8) -+ -+#define BIT_SHIFT_BTMODE_8822C 6 -+#define BIT_MASK_BTMODE_8822C 0x3 -+#define BIT_BTMODE_8822C(x) \ -+ (((x) & BIT_MASK_BTMODE_8822C) << BIT_SHIFT_BTMODE_8822C) -+#define BITS_BTMODE_8822C (BIT_MASK_BTMODE_8822C << BIT_SHIFT_BTMODE_8822C) -+#define BIT_CLEAR_BTMODE_8822C(x) ((x) & (~BITS_BTMODE_8822C)) -+#define BIT_GET_BTMODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_BTMODE_8822C) & BIT_MASK_BTMODE_8822C) -+#define BIT_SET_BTMODE_8822C(x, v) \ -+ (BIT_CLEAR_BTMODE_8822C(x) | BIT_BTMODE_8822C(v)) -+ -+#define BIT_ENBT_8822C BIT(5) -+#define BIT_EROM_EN_8822C BIT(4) -+#define BIT_WLRFE_6_7_EN_8822C BIT(3) -+#define BIT_WLRFE_4_5_EN_8822C BIT(2) -+ -+#define BIT_SHIFT_GPIOSEL_8822C 0 -+#define BIT_MASK_GPIOSEL_8822C 0x3 -+#define BIT_GPIOSEL_8822C(x) \ -+ (((x) & BIT_MASK_GPIOSEL_8822C) << BIT_SHIFT_GPIOSEL_8822C) -+#define BITS_GPIOSEL_8822C (BIT_MASK_GPIOSEL_8822C << BIT_SHIFT_GPIOSEL_8822C) -+#define BIT_CLEAR_GPIOSEL_8822C(x) ((x) & (~BITS_GPIOSEL_8822C)) -+#define BIT_GET_GPIOSEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_GPIOSEL_8822C) & BIT_MASK_GPIOSEL_8822C) -+#define BIT_SET_GPIOSEL_8822C(x, v) \ -+ (BIT_CLEAR_GPIOSEL_8822C(x) | BIT_GPIOSEL_8822C(v)) -+ -+/* 2 REG_GPIO_PIN_CTRL_8822C */ -+ -+#define BIT_SHIFT_GPIO_MOD_7_TO_0_8822C 24 -+#define BIT_MASK_GPIO_MOD_7_TO_0_8822C 0xff -+#define BIT_GPIO_MOD_7_TO_0_8822C(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_7_TO_0_8822C) \ -+ << BIT_SHIFT_GPIO_MOD_7_TO_0_8822C) -+#define BITS_GPIO_MOD_7_TO_0_8822C \ -+ (BIT_MASK_GPIO_MOD_7_TO_0_8822C << BIT_SHIFT_GPIO_MOD_7_TO_0_8822C) -+#define BIT_CLEAR_GPIO_MOD_7_TO_0_8822C(x) ((x) & (~BITS_GPIO_MOD_7_TO_0_8822C)) -+#define BIT_GET_GPIO_MOD_7_TO_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_7_TO_0_8822C) & \ -+ BIT_MASK_GPIO_MOD_7_TO_0_8822C) -+#define BIT_SET_GPIO_MOD_7_TO_0_8822C(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_7_TO_0_8822C(x) | BIT_GPIO_MOD_7_TO_0_8822C(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8822C 16 -+#define BIT_MASK_GPIO_IO_SEL_7_TO_0_8822C 0xff -+#define BIT_GPIO_IO_SEL_7_TO_0_8822C(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_7_TO_0_8822C) \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8822C) -+#define BITS_GPIO_IO_SEL_7_TO_0_8822C \ -+ (BIT_MASK_GPIO_IO_SEL_7_TO_0_8822C \ -+ << BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8822C) -+#define BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8822C(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_7_TO_0_8822C)) -+#define BIT_GET_GPIO_IO_SEL_7_TO_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_7_TO_0_8822C) & \ -+ BIT_MASK_GPIO_IO_SEL_7_TO_0_8822C) -+#define BIT_SET_GPIO_IO_SEL_7_TO_0_8822C(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_7_TO_0_8822C(x) | \ -+ BIT_GPIO_IO_SEL_7_TO_0_8822C(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_7_TO_0_8822C 8 -+#define BIT_MASK_GPIO_OUT_7_TO_0_8822C 0xff -+#define BIT_GPIO_OUT_7_TO_0_8822C(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_7_TO_0_8822C) \ -+ << BIT_SHIFT_GPIO_OUT_7_TO_0_8822C) -+#define BITS_GPIO_OUT_7_TO_0_8822C \ -+ (BIT_MASK_GPIO_OUT_7_TO_0_8822C << BIT_SHIFT_GPIO_OUT_7_TO_0_8822C) -+#define BIT_CLEAR_GPIO_OUT_7_TO_0_8822C(x) ((x) & (~BITS_GPIO_OUT_7_TO_0_8822C)) -+#define BIT_GET_GPIO_OUT_7_TO_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_7_TO_0_8822C) & \ -+ BIT_MASK_GPIO_OUT_7_TO_0_8822C) -+#define BIT_SET_GPIO_OUT_7_TO_0_8822C(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_7_TO_0_8822C(x) | BIT_GPIO_OUT_7_TO_0_8822C(v)) -+ -+#define BIT_SHIFT_GPIO_IN_7_TO_0_8822C 0 -+#define BIT_MASK_GPIO_IN_7_TO_0_8822C 0xff -+#define BIT_GPIO_IN_7_TO_0_8822C(x) \ -+ (((x) & BIT_MASK_GPIO_IN_7_TO_0_8822C) \ -+ << BIT_SHIFT_GPIO_IN_7_TO_0_8822C) -+#define BITS_GPIO_IN_7_TO_0_8822C \ -+ (BIT_MASK_GPIO_IN_7_TO_0_8822C << BIT_SHIFT_GPIO_IN_7_TO_0_8822C) -+#define BIT_CLEAR_GPIO_IN_7_TO_0_8822C(x) ((x) & (~BITS_GPIO_IN_7_TO_0_8822C)) -+#define BIT_GET_GPIO_IN_7_TO_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_7_TO_0_8822C) & \ -+ BIT_MASK_GPIO_IN_7_TO_0_8822C) -+#define BIT_SET_GPIO_IN_7_TO_0_8822C(x, v) \ -+ (BIT_CLEAR_GPIO_IN_7_TO_0_8822C(x) | BIT_GPIO_IN_7_TO_0_8822C(v)) -+ -+/* 2 REG_GPIO_INTM_8822C */ -+ -+#define BIT_SHIFT_MUXDBG_SEL_8822C 30 -+#define BIT_MASK_MUXDBG_SEL_8822C 0x3 -+#define BIT_MUXDBG_SEL_8822C(x) \ -+ (((x) & BIT_MASK_MUXDBG_SEL_8822C) << BIT_SHIFT_MUXDBG_SEL_8822C) -+#define BITS_MUXDBG_SEL_8822C \ -+ (BIT_MASK_MUXDBG_SEL_8822C << BIT_SHIFT_MUXDBG_SEL_8822C) -+#define BIT_CLEAR_MUXDBG_SEL_8822C(x) ((x) & (~BITS_MUXDBG_SEL_8822C)) -+#define BIT_GET_MUXDBG_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_MUXDBG_SEL_8822C) & BIT_MASK_MUXDBG_SEL_8822C) -+#define BIT_SET_MUXDBG_SEL_8822C(x, v) \ -+ (BIT_CLEAR_MUXDBG_SEL_8822C(x) | BIT_MUXDBG_SEL_8822C(v)) -+ -+#define BIT_EXTWOL_SEL_8822C BIT(17) -+#define BIT_EXTWOL_EN_8822C BIT(16) -+#define BIT_GPIOF_INT_MD_8822C BIT(15) -+#define BIT_GPIOE_INT_MD_8822C BIT(14) -+#define BIT_GPIOD_INT_MD_8822C BIT(13) -+#define BIT_GPIOF_INT_MD_8822C BIT(15) -+#define BIT_GPIOE_INT_MD_8822C BIT(14) -+#define BIT_GPIOD_INT_MD_8822C BIT(13) -+#define BIT_GPIOC_INT_MD_8822C BIT(12) -+#define BIT_GPIOB_INT_MD_8822C BIT(11) -+#define BIT_GPIOA_INT_MD_8822C BIT(10) -+#define BIT_GPIO9_INT_MD_8822C BIT(9) -+#define BIT_GPIO8_INT_MD_8822C BIT(8) -+#define BIT_GPIO7_INT_MD_8822C BIT(7) -+#define BIT_GPIO6_INT_MD_8822C BIT(6) -+#define BIT_GPIO5_INT_MD_8822C BIT(5) -+#define BIT_GPIO4_INT_MD_8822C BIT(4) -+#define BIT_GPIO3_INT_MD_8822C BIT(3) -+#define BIT_GPIO2_INT_MD_8822C BIT(2) -+#define BIT_GPIO1_INT_MD_8822C BIT(1) -+#define BIT_GPIO0_INT_MD_8822C BIT(0) -+ -+/* 2 REG_LED_CFG_8822C */ -+#define BIT_MAILBOX_1WIRE_GPIO_CFG_8822C BIT(31) -+#define BIT_BT_RF_GPIO_CFG_8822C BIT(30) -+#define BIT_BT_SDIO_INT_GPIO_CFG_8822C BIT(29) -+#define BIT_MAILBOX_3WIRE_GPIO_CFG_8822C BIT(28) -+#define BIT_WLBT_PAPE_SEL_EN_8822C BIT(27) -+#define BIT_LNAON_SEL_EN_8822C BIT(26) -+#define BIT_PAPE_SEL_EN_8822C BIT(25) -+#define BIT_DPDT_WLBT_SEL_8822C BIT(24) -+#define BIT_DPDT_SEL_EN_8822C BIT(23) -+#define BIT_GPIO13_14_WL_CTRL_EN_8822C BIT(22) -+#define BIT_LED2DIS_8822C BIT(21) -+#define BIT_LED2PL_8822C BIT(20) -+#define BIT_LED2SV_8822C BIT(19) -+ -+#define BIT_SHIFT_LED2CM_8822C 16 -+#define BIT_MASK_LED2CM_8822C 0x7 -+#define BIT_LED2CM_8822C(x) \ -+ (((x) & BIT_MASK_LED2CM_8822C) << BIT_SHIFT_LED2CM_8822C) -+#define BITS_LED2CM_8822C (BIT_MASK_LED2CM_8822C << BIT_SHIFT_LED2CM_8822C) -+#define BIT_CLEAR_LED2CM_8822C(x) ((x) & (~BITS_LED2CM_8822C)) -+#define BIT_GET_LED2CM_8822C(x) \ -+ (((x) >> BIT_SHIFT_LED2CM_8822C) & BIT_MASK_LED2CM_8822C) -+#define BIT_SET_LED2CM_8822C(x, v) \ -+ (BIT_CLEAR_LED2CM_8822C(x) | BIT_LED2CM_8822C(v)) -+ -+#define BIT_LED1DIS_8822C BIT(15) -+#define BIT_LED1PL_8822C BIT(12) -+#define BIT_LED1SV_8822C BIT(11) -+ -+#define BIT_SHIFT_LED1CM_8822C 8 -+#define BIT_MASK_LED1CM_8822C 0x7 -+#define BIT_LED1CM_8822C(x) \ -+ (((x) & BIT_MASK_LED1CM_8822C) << BIT_SHIFT_LED1CM_8822C) -+#define BITS_LED1CM_8822C (BIT_MASK_LED1CM_8822C << BIT_SHIFT_LED1CM_8822C) -+#define BIT_CLEAR_LED1CM_8822C(x) ((x) & (~BITS_LED1CM_8822C)) -+#define BIT_GET_LED1CM_8822C(x) \ -+ (((x) >> BIT_SHIFT_LED1CM_8822C) & BIT_MASK_LED1CM_8822C) -+#define BIT_SET_LED1CM_8822C(x, v) \ -+ (BIT_CLEAR_LED1CM_8822C(x) | BIT_LED1CM_8822C(v)) -+ -+#define BIT_LED0DIS_8822C BIT(7) -+ -+#define BIT_SHIFT_AFE_LDO_SWR_CHECK_8822C 5 -+#define BIT_MASK_AFE_LDO_SWR_CHECK_8822C 0x3 -+#define BIT_AFE_LDO_SWR_CHECK_8822C(x) \ -+ (((x) & BIT_MASK_AFE_LDO_SWR_CHECK_8822C) \ -+ << BIT_SHIFT_AFE_LDO_SWR_CHECK_8822C) -+#define BITS_AFE_LDO_SWR_CHECK_8822C \ -+ (BIT_MASK_AFE_LDO_SWR_CHECK_8822C << BIT_SHIFT_AFE_LDO_SWR_CHECK_8822C) -+#define BIT_CLEAR_AFE_LDO_SWR_CHECK_8822C(x) \ -+ ((x) & (~BITS_AFE_LDO_SWR_CHECK_8822C)) -+#define BIT_GET_AFE_LDO_SWR_CHECK_8822C(x) \ -+ (((x) >> BIT_SHIFT_AFE_LDO_SWR_CHECK_8822C) & \ -+ BIT_MASK_AFE_LDO_SWR_CHECK_8822C) -+#define BIT_SET_AFE_LDO_SWR_CHECK_8822C(x, v) \ -+ (BIT_CLEAR_AFE_LDO_SWR_CHECK_8822C(x) | BIT_AFE_LDO_SWR_CHECK_8822C(v)) -+ -+#define BIT_LED0PL_8822C BIT(4) -+#define BIT_LED0SV_8822C BIT(3) -+ -+#define BIT_SHIFT_LED0CM_8822C 0 -+#define BIT_MASK_LED0CM_8822C 0x7 -+#define BIT_LED0CM_8822C(x) \ -+ (((x) & BIT_MASK_LED0CM_8822C) << BIT_SHIFT_LED0CM_8822C) -+#define BITS_LED0CM_8822C (BIT_MASK_LED0CM_8822C << BIT_SHIFT_LED0CM_8822C) -+#define BIT_CLEAR_LED0CM_8822C(x) ((x) & (~BITS_LED0CM_8822C)) -+#define BIT_GET_LED0CM_8822C(x) \ -+ (((x) >> BIT_SHIFT_LED0CM_8822C) & BIT_MASK_LED0CM_8822C) -+#define BIT_SET_LED0CM_8822C(x, v) \ -+ (BIT_CLEAR_LED0CM_8822C(x) | BIT_LED0CM_8822C(v)) -+ -+/* 2 REG_FSIMR_8822C */ -+#define BIT_FS_PDNINT_EN_8822C BIT(31) -+#define BIT_FS_SPS_OCP_INT_EN_8822C BIT(29) -+#define BIT_FS_PWMERR_INT_EN_8822C BIT(28) -+#define BIT_FS_GPIOF_INT_EN_8822C BIT(27) -+#define BIT_FS_GPIOE_INT_EN_8822C BIT(26) -+#define BIT_FS_GPIOD_INT_EN_8822C BIT(25) -+#define BIT_FS_GPIOC_INT_EN_8822C BIT(24) -+#define BIT_FS_GPIOB_INT_EN_8822C BIT(23) -+#define BIT_FS_GPIOA_INT_EN_8822C BIT(22) -+#define BIT_FS_GPIO9_INT_EN_8822C BIT(21) -+#define BIT_FS_GPIO8_INT_EN_8822C BIT(20) -+#define BIT_FS_GPIO7_INT_EN_8822C BIT(19) -+#define BIT_FS_GPIO6_INT_EN_8822C BIT(18) -+#define BIT_FS_GPIO5_INT_EN_8822C BIT(17) -+#define BIT_FS_GPIO4_INT_EN_8822C BIT(16) -+#define BIT_FS_GPIO3_INT_EN_8822C BIT(15) -+#define BIT_FS_GPIO2_INT_EN_8822C BIT(14) -+#define BIT_FS_GPIO1_INT_EN_8822C BIT(13) -+#define BIT_FS_GPIO0_INT_EN_8822C BIT(12) -+#define BIT_FS_HCI_SUS_EN_8822C BIT(11) -+#define BIT_FS_HCI_RES_EN_8822C BIT(10) -+#define BIT_FS_HCI_RESET_EN_8822C BIT(9) -+#define BIT_USB_SCSI_CMD_EN_8822C BIT(8) -+#define BIT_FS_BTON_STS_UPDATE_MSK_EN_8822C BIT(7) -+#define BIT_ACT2RECOVERY_INT_EN_V1_8822C BIT(6) -+#define BIT_GEN1GEN2_SWITCH_8822C BIT(5) -+#define BIT_HCI_TXDMA_REQ_HIMR_8822C BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_MAK_8822C BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_MAK_8822C BIT(2) -+#define BIT_FS_USB_LPMRSM_MSK_8822C BIT(1) -+#define BIT_FS_USB_LPMINT_MSK_8822C BIT(0) -+ -+/* 2 REG_FSISR_8822C */ -+#define BIT_FS_PDNINT_8822C BIT(31) -+#define BIT_FS_SPS_OCP_INT_8822C BIT(29) -+#define BIT_FS_PWMERR_INT_8822C BIT(28) -+#define BIT_FS_GPIOF_INT_8822C BIT(27) -+#define BIT_FS_GPIOE_INT_8822C BIT(26) -+#define BIT_FS_GPIOD_INT_8822C BIT(25) -+#define BIT_FS_GPIOC_INT_8822C BIT(24) -+#define BIT_FS_GPIOB_INT_8822C BIT(23) -+#define BIT_FS_GPIOA_INT_8822C BIT(22) -+#define BIT_FS_GPIO9_INT_8822C BIT(21) -+#define BIT_FS_GPIO8_INT_8822C BIT(20) -+#define BIT_FS_GPIO7_INT_8822C BIT(19) -+#define BIT_FS_GPIO6_INT_8822C BIT(18) -+#define BIT_FS_GPIO5_INT_8822C BIT(17) -+#define BIT_FS_GPIO4_INT_8822C BIT(16) -+#define BIT_FS_GPIO3_INT_8822C BIT(15) -+#define BIT_FS_GPIO2_INT_8822C BIT(14) -+#define BIT_FS_GPIO1_INT_8822C BIT(13) -+#define BIT_FS_GPIO0_INT_8822C BIT(12) -+#define BIT_FS_HCI_SUS_INT_8822C BIT(11) -+#define BIT_FS_HCI_RES_INT_8822C BIT(10) -+#define BIT_FS_HCI_RESET_INT_8822C BIT(9) -+#define BIT_USB_SCSI_CMD_INT_8822C BIT(8) -+#define BIT_ACT2RECOVERY_8822C BIT(6) -+#define BIT_GEN1GEN2_SWITCH_8822C BIT(5) -+#define BIT_HCI_TXDMA_REQ_HISR_8822C BIT(4) -+#define BIT_FS_32K_LEAVE_SETTING_INT_8822C BIT(3) -+#define BIT_FS_32K_ENTER_SETTING_INT_8822C BIT(2) -+#define BIT_FS_USB_LPMRSM_INT_8822C BIT(1) -+#define BIT_FS_USB_LPMINT_INT_8822C BIT(0) -+ -+/* 2 REG_HSIMR_8822C */ -+#define BIT_GPIOF_INT_EN_8822C BIT(31) -+#define BIT_GPIOE_INT_EN_8822C BIT(30) -+#define BIT_GPIOD_INT_EN_8822C BIT(29) -+#define BIT_GPIOC_INT_EN_8822C BIT(28) -+#define BIT_GPIOB_INT_EN_8822C BIT(27) -+#define BIT_GPIOA_INT_EN_8822C BIT(26) -+#define BIT_GPIO9_INT_EN_8822C BIT(25) -+#define BIT_GPIO8_INT_EN_8822C BIT(24) -+#define BIT_GPIO7_INT_EN_8822C BIT(23) -+#define BIT_GPIO6_INT_EN_8822C BIT(22) -+#define BIT_GPIO5_INT_EN_8822C BIT(21) -+#define BIT_GPIO4_INT_EN_8822C BIT(20) -+#define BIT_GPIO3_INT_EN_8822C BIT(19) -+#define BIT_GPIO2_INT_EN_V1_8822C BIT(18) -+#define BIT_GPIO1_INT_EN_8822C BIT(17) -+#define BIT_GPIO0_INT_EN_8822C BIT(16) -+#define BIT_PDNINT_EN_8822C BIT(7) -+#define BIT_RON_INT_EN_8822C BIT(6) -+#define BIT_SPS_OCP_INT_EN_8822C BIT(5) -+#define BIT_GPIO15_0_INT_EN_8822C BIT(0) -+ -+/* 2 REG_HSISR_8822C */ -+#define BIT_GPIOF_INT_8822C BIT(31) -+#define BIT_GPIOE_INT_8822C BIT(30) -+#define BIT_GPIOD_INT_8822C BIT(29) -+#define BIT_GPIOC_INT_8822C BIT(28) -+#define BIT_GPIOB_INT_8822C BIT(27) -+#define BIT_GPIOA_INT_8822C BIT(26) -+#define BIT_GPIO9_INT_8822C BIT(25) -+#define BIT_GPIO8_INT_8822C BIT(24) -+#define BIT_GPIO7_INT_8822C BIT(23) -+#define BIT_GPIO6_INT_8822C BIT(22) -+#define BIT_GPIO5_INT_8822C BIT(21) -+#define BIT_GPIO4_INT_8822C BIT(20) -+#define BIT_GPIO3_INT_8822C BIT(19) -+#define BIT_GPIO2_INT_V1_8822C BIT(18) -+#define BIT_GPIO1_INT_8822C BIT(17) -+#define BIT_GPIO0_INT_8822C BIT(16) -+#define BIT_PDNINT_8822C BIT(7) -+#define BIT_RON_INT_8822C BIT(6) -+#define BIT_SPS_OCP_INT_8822C BIT(5) -+#define BIT_GPIO15_0_INT_8822C BIT(0) -+ -+/* 2 REG_GPIO_EXT_CTRL_8822C */ -+ -+#define BIT_SHIFT_GPIO_MOD_15_TO_8_8822C 24 -+#define BIT_MASK_GPIO_MOD_15_TO_8_8822C 0xff -+#define BIT_GPIO_MOD_15_TO_8_8822C(x) \ -+ (((x) & BIT_MASK_GPIO_MOD_15_TO_8_8822C) \ -+ << BIT_SHIFT_GPIO_MOD_15_TO_8_8822C) -+#define BITS_GPIO_MOD_15_TO_8_8822C \ -+ (BIT_MASK_GPIO_MOD_15_TO_8_8822C << BIT_SHIFT_GPIO_MOD_15_TO_8_8822C) -+#define BIT_CLEAR_GPIO_MOD_15_TO_8_8822C(x) \ -+ ((x) & (~BITS_GPIO_MOD_15_TO_8_8822C)) -+#define BIT_GET_GPIO_MOD_15_TO_8_8822C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_MOD_15_TO_8_8822C) & \ -+ BIT_MASK_GPIO_MOD_15_TO_8_8822C) -+#define BIT_SET_GPIO_MOD_15_TO_8_8822C(x, v) \ -+ (BIT_CLEAR_GPIO_MOD_15_TO_8_8822C(x) | BIT_GPIO_MOD_15_TO_8_8822C(v)) -+ -+#define BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8822C 16 -+#define BIT_MASK_GPIO_IO_SEL_15_TO_8_8822C 0xff -+#define BIT_GPIO_IO_SEL_15_TO_8_8822C(x) \ -+ (((x) & BIT_MASK_GPIO_IO_SEL_15_TO_8_8822C) \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8822C) -+#define BITS_GPIO_IO_SEL_15_TO_8_8822C \ -+ (BIT_MASK_GPIO_IO_SEL_15_TO_8_8822C \ -+ << BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8822C) -+#define BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8822C(x) \ -+ ((x) & (~BITS_GPIO_IO_SEL_15_TO_8_8822C)) -+#define BIT_GET_GPIO_IO_SEL_15_TO_8_8822C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IO_SEL_15_TO_8_8822C) & \ -+ BIT_MASK_GPIO_IO_SEL_15_TO_8_8822C) -+#define BIT_SET_GPIO_IO_SEL_15_TO_8_8822C(x, v) \ -+ (BIT_CLEAR_GPIO_IO_SEL_15_TO_8_8822C(x) | \ -+ BIT_GPIO_IO_SEL_15_TO_8_8822C(v)) -+ -+#define BIT_SHIFT_GPIO_OUT_15_TO_8_8822C 8 -+#define BIT_MASK_GPIO_OUT_15_TO_8_8822C 0xff -+#define BIT_GPIO_OUT_15_TO_8_8822C(x) \ -+ (((x) & BIT_MASK_GPIO_OUT_15_TO_8_8822C) \ -+ << BIT_SHIFT_GPIO_OUT_15_TO_8_8822C) -+#define BITS_GPIO_OUT_15_TO_8_8822C \ -+ (BIT_MASK_GPIO_OUT_15_TO_8_8822C << BIT_SHIFT_GPIO_OUT_15_TO_8_8822C) -+#define BIT_CLEAR_GPIO_OUT_15_TO_8_8822C(x) \ -+ ((x) & (~BITS_GPIO_OUT_15_TO_8_8822C)) -+#define BIT_GET_GPIO_OUT_15_TO_8_8822C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_OUT_15_TO_8_8822C) & \ -+ BIT_MASK_GPIO_OUT_15_TO_8_8822C) -+#define BIT_SET_GPIO_OUT_15_TO_8_8822C(x, v) \ -+ (BIT_CLEAR_GPIO_OUT_15_TO_8_8822C(x) | BIT_GPIO_OUT_15_TO_8_8822C(v)) -+ -+#define BIT_SHIFT_GPIO_IN_15_TO_8_8822C 0 -+#define BIT_MASK_GPIO_IN_15_TO_8_8822C 0xff -+#define BIT_GPIO_IN_15_TO_8_8822C(x) \ -+ (((x) & BIT_MASK_GPIO_IN_15_TO_8_8822C) \ -+ << BIT_SHIFT_GPIO_IN_15_TO_8_8822C) -+#define BITS_GPIO_IN_15_TO_8_8822C \ -+ (BIT_MASK_GPIO_IN_15_TO_8_8822C << BIT_SHIFT_GPIO_IN_15_TO_8_8822C) -+#define BIT_CLEAR_GPIO_IN_15_TO_8_8822C(x) ((x) & (~BITS_GPIO_IN_15_TO_8_8822C)) -+#define BIT_GET_GPIO_IN_15_TO_8_8822C(x) \ -+ (((x) >> BIT_SHIFT_GPIO_IN_15_TO_8_8822C) & \ -+ BIT_MASK_GPIO_IN_15_TO_8_8822C) -+#define BIT_SET_GPIO_IN_15_TO_8_8822C(x, v) \ -+ (BIT_CLEAR_GPIO_IN_15_TO_8_8822C(x) | BIT_GPIO_IN_15_TO_8_8822C(v)) -+ -+/* 2 REG_PAD_CTRL1_8822C */ -+#define BIT_PAPE_WLBT_SEL_8822C BIT(29) -+#define BIT_LNAON_WLBT_SEL_8822C BIT(28) -+#define BIT_BT_BQB_GPIO_SEL_8822C BIT(27) -+#define BIT_BTGP_GPG3_FEN_8822C BIT(26) -+#define BIT_BTGP_GPG2_FEN_8822C BIT(25) -+#define BIT_BTGP_JTAG_EN_8822C BIT(24) -+#define BIT_XTAL_CLK_EXTARNAL_EN_8822C BIT(23) -+#define BIT_BTGP_UART0_EN_8822C BIT(22) -+#define BIT_BTGP_UART1_EN_8822C BIT(21) -+#define BIT_BTGP_SPI_EN_8822C BIT(20) -+#define BIT_BTGP_GPIO_E2_8822C BIT(19) -+#define BIT_BTGP_GPIO_EN_8822C BIT(18) -+ -+#define BIT_SHIFT_BTGP_GPIO_SL_8822C 16 -+#define BIT_MASK_BTGP_GPIO_SL_8822C 0x3 -+#define BIT_BTGP_GPIO_SL_8822C(x) \ -+ (((x) & BIT_MASK_BTGP_GPIO_SL_8822C) << BIT_SHIFT_BTGP_GPIO_SL_8822C) -+#define BITS_BTGP_GPIO_SL_8822C \ -+ (BIT_MASK_BTGP_GPIO_SL_8822C << BIT_SHIFT_BTGP_GPIO_SL_8822C) -+#define BIT_CLEAR_BTGP_GPIO_SL_8822C(x) ((x) & (~BITS_BTGP_GPIO_SL_8822C)) -+#define BIT_GET_BTGP_GPIO_SL_8822C(x) \ -+ (((x) >> BIT_SHIFT_BTGP_GPIO_SL_8822C) & BIT_MASK_BTGP_GPIO_SL_8822C) -+#define BIT_SET_BTGP_GPIO_SL_8822C(x, v) \ -+ (BIT_CLEAR_BTGP_GPIO_SL_8822C(x) | BIT_BTGP_GPIO_SL_8822C(v)) -+ -+#define BIT_PAD_SDIO_SR_8822C BIT(14) -+#define BIT_GPIO14_OUTPUT_PL_8822C BIT(13) -+#define BIT_HOST_WAKE_PAD_PULL_EN_8822C BIT(12) -+#define BIT_HOST_WAKE_PAD_SL_8822C BIT(11) -+#define BIT_PAD_LNAON_SR_8822C BIT(10) -+#define BIT_PAD_LNAON_E2_8822C BIT(9) -+#define BIT_SW_LNAON_G_SEL_DATA_8822C BIT(8) -+#define BIT_SW_LNAON_A_SEL_DATA_8822C BIT(7) -+#define BIT_PAD_PAPE_SR_8822C BIT(6) -+#define BIT_PAD_PAPE_E2_8822C BIT(5) -+#define BIT_SW_PAPE_G_SEL_DATA_8822C BIT(4) -+#define BIT_SW_PAPE_A_SEL_DATA_8822C BIT(3) -+#define BIT_PAD_DPDT_SR_8822C BIT(2) -+#define BIT_PAD_DPDT_PAD_E2_8822C BIT(1) -+#define BIT_SW_DPDT_SEL_DATA_8822C BIT(0) -+ -+/* 2 REG_WL_BT_PWR_CTRL_8822C */ -+#define BIT_ISO_BD2PP_8822C BIT(31) -+#define BIT_LDOV12B_EN_8822C BIT(30) -+#define BIT_CKEN_BTGPS_8822C BIT(29) -+#define BIT_FEN_BTGPS_8822C BIT(28) -+#define BIT_BTCPU_BOOTSEL_8822C BIT(27) -+#define BIT_SPI_SPEEDUP_8822C BIT(26) -+#define BIT_BT_LDO_MODE_8822C BIT(25) -+#define BIT_DEVWAKE_PAD_TYPE_SEL_8822C BIT(24) -+#define BIT_CLKREQ_PAD_TYPE_SEL_8822C BIT(23) -+#define BIT_ISO_BTPON2PP_8822C BIT(22) -+#define BIT_BT_HWROF_EN_8822C BIT(19) -+#define BIT_BT_FUNC_EN_8822C BIT(18) -+#define BIT_BT_HWPDN_SL_8822C BIT(17) -+#define BIT_BT_DISN_EN_8822C BIT(16) -+#define BIT_BT_PDN_PULL_EN_8822C BIT(15) -+#define BIT_WL_PDN_PULL_EN_8822C BIT(14) -+#define BIT_EXTERNAL_REQUEST_PL_8822C BIT(13) -+#define BIT_GPIO0_2_3_PULL_LOW_EN_8822C BIT(12) -+#define BIT_ISO_BA2PP_8822C BIT(11) -+#define BIT_BT_AFE_LDO_EN_8822C BIT(10) -+#define BIT_BT_AFE_PLL_EN_8822C BIT(9) -+#define BIT_BT_DIG_CLK_EN_8822C BIT(8) -+#define BIT_WLAN_32K_SEL_8822C BIT(6) -+#define BIT_WL_DRV_EXIST_IDX_8822C BIT(5) -+#define BIT_DOP_EHPAD_8822C BIT(4) -+#define BIT_WL_HWROF_EN_8822C BIT(3) -+#define BIT_WL_FUNC_EN_8822C BIT(2) -+#define BIT_WL_HWPDN_SL_8822C BIT(1) -+#define BIT_WL_HWPDN_EN_8822C BIT(0) -+ -+/* 2 REG_SDM_DEBUG_8822C */ -+#define BIT_GPIO_IE_V18_8822C BIT(10) -+#define BIT_PCIE_IE_V18_8822C BIT(9) -+#define BIT_UART_IE_V18_8822C BIT(8) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_WLCLK_PHASE_8822C 0 -+#define BIT_MASK_WLCLK_PHASE_8822C 0x1f -+#define BIT_WLCLK_PHASE_8822C(x) \ -+ (((x) & BIT_MASK_WLCLK_PHASE_8822C) << BIT_SHIFT_WLCLK_PHASE_8822C) -+#define BITS_WLCLK_PHASE_8822C \ -+ (BIT_MASK_WLCLK_PHASE_8822C << BIT_SHIFT_WLCLK_PHASE_8822C) -+#define BIT_CLEAR_WLCLK_PHASE_8822C(x) ((x) & (~BITS_WLCLK_PHASE_8822C)) -+#define BIT_GET_WLCLK_PHASE_8822C(x) \ -+ (((x) >> BIT_SHIFT_WLCLK_PHASE_8822C) & BIT_MASK_WLCLK_PHASE_8822C) -+#define BIT_SET_WLCLK_PHASE_8822C(x, v) \ -+ (BIT_CLEAR_WLCLK_PHASE_8822C(x) | BIT_WLCLK_PHASE_8822C(v)) -+ -+/* 2 REG_SYS_SDIO_CTRL_8822C */ -+#define BIT_DBG_GNT_WL_BT_8822C BIT(27) -+#define BIT_LTE_MUX_CTRL_PATH_8822C BIT(26) -+#define BIT_LTE_COEX_UART_8822C BIT(25) -+#define BIT_3W_LTE_WL_GPIO_8822C BIT(24) -+#define BIT_SDIO_INT_POLARITY_8822C BIT(19) -+#define BIT_SDIO_INT_8822C BIT(18) -+#define BIT_SDIO_OFF_EN_8822C BIT(17) -+#define BIT_SDIO_ON_EN_8822C BIT(16) -+#define BIT_PCIE_FORCE_PWR_NGAT_8822C BIT(13) -+#define BIT_PCIE_CALIB_EN_V1_8822C BIT(12) -+#define BIT_PAGE3_AUXCLK_GATE_8822C BIT(11) -+#define BIT_PCIE_WAIT_TIMEOUT_EVENT_8822C BIT(10) -+#define BIT_PCIE_WAIT_TIME_8822C BIT(9) -+#define BIT_MPCIE_REFCLK_XTAL_SEL_8822C BIT(8) -+#define BIT_BT_CTRL_USB_PWR_BACKDOOR_8822C BIT(5) -+#define BIT_USB_D_STATE_HOLD_8822C BIT(4) -+#define BIT_REG_FORCE_DP_8822C BIT(3) -+#define BIT_REG_DP_MODE_8822C BIT(2) -+#define BIT_RES_USB_MASS_STORAGE_DESC_8822C BIT(1) -+#define BIT_USB_WAIT_TIME_8822C BIT(0) -+ -+/* 2 REG_HCI_OPT_CTRL_8822C */ -+ -+#define BIT_SHIFT_TSFT_SEL_8822C 29 -+#define BIT_MASK_TSFT_SEL_8822C 0x7 -+#define BIT_TSFT_SEL_8822C(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_8822C) << BIT_SHIFT_TSFT_SEL_8822C) -+#define BITS_TSFT_SEL_8822C \ -+ (BIT_MASK_TSFT_SEL_8822C << BIT_SHIFT_TSFT_SEL_8822C) -+#define BIT_CLEAR_TSFT_SEL_8822C(x) ((x) & (~BITS_TSFT_SEL_8822C)) -+#define BIT_GET_TSFT_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_8822C) & BIT_MASK_TSFT_SEL_8822C) -+#define BIT_SET_TSFT_SEL_8822C(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_8822C(x) | BIT_TSFT_SEL_8822C(v)) -+ -+#define BIT_SDIO_PAD_E5_8822C BIT(18) -+#define BIT_USB_HOST_PWR_OFF_EN_8822C BIT(12) -+#define BIT_SYM_LPS_BLOCK_EN_8822C BIT(11) -+#define BIT_USB_LPM_ACT_EN_8822C BIT(10) -+#define BIT_USB_LPM_NY_8822C BIT(9) -+#define BIT_USB_SUS_DIS_8822C BIT(8) -+ -+#define BIT_SHIFT_SDIO_PAD_E_8822C 5 -+#define BIT_MASK_SDIO_PAD_E_8822C 0x7 -+#define BIT_SDIO_PAD_E_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_PAD_E_8822C) << BIT_SHIFT_SDIO_PAD_E_8822C) -+#define BITS_SDIO_PAD_E_8822C \ -+ (BIT_MASK_SDIO_PAD_E_8822C << BIT_SHIFT_SDIO_PAD_E_8822C) -+#define BIT_CLEAR_SDIO_PAD_E_8822C(x) ((x) & (~BITS_SDIO_PAD_E_8822C)) -+#define BIT_GET_SDIO_PAD_E_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_PAD_E_8822C) & BIT_MASK_SDIO_PAD_E_8822C) -+#define BIT_SET_SDIO_PAD_E_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_PAD_E_8822C(x) | BIT_SDIO_PAD_E_8822C(v)) -+ -+#define BIT_USB_LPPLL_EN_8822C BIT(4) -+#define BIT_USB1_1_USB2_0_DECISION_8822C BIT(3) -+#define BIT_ROP_SW15_8822C BIT(2) -+#define BIT_PCI_CKRDY_OPT_8822C BIT(1) -+#define BIT_PCI_VAUX_EN_8822C BIT(0) -+ -+/* 2 REG_HCI_BG_CTRL_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_IBX_EN_VALUE_8822C BIT(9) -+#define BIT_IB_EN_VALUE_8822C BIT(8) -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_FORCED_IB_EN_8822C BIT(4) -+#define BIT_EN_REGBG_8822C BIT(3) -+#define BIT_REG_BG_LPF_8822C BIT(2) -+ -+#define BIT_SHIFT_REG_BG_8822C 0 -+#define BIT_MASK_REG_BG_8822C 0x3 -+#define BIT_REG_BG_8822C(x) \ -+ (((x) & BIT_MASK_REG_BG_8822C) << BIT_SHIFT_REG_BG_8822C) -+#define BITS_REG_BG_8822C (BIT_MASK_REG_BG_8822C << BIT_SHIFT_REG_BG_8822C) -+#define BIT_CLEAR_REG_BG_8822C(x) ((x) & (~BITS_REG_BG_8822C)) -+#define BIT_GET_REG_BG_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_BG_8822C) & BIT_MASK_REG_BG_8822C) -+#define BIT_SET_REG_BG_8822C(x, v) \ -+ (BIT_CLEAR_REG_BG_8822C(x) | BIT_REG_BG_8822C(v)) -+ -+/* 2 REG_HCI_LDO_CTRL_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_EN_LW_PWR_8822C BIT(6) -+#define BIT_EN_REGU_8822C BIT(5) -+#define BIT_EN_PC_8822C BIT(4) -+ -+#define BIT_SHIFT_REG_VADJ_8822C 0 -+#define BIT_MASK_REG_VADJ_8822C 0xf -+#define BIT_REG_VADJ_8822C(x) \ -+ (((x) & BIT_MASK_REG_VADJ_8822C) << BIT_SHIFT_REG_VADJ_8822C) -+#define BITS_REG_VADJ_8822C \ -+ (BIT_MASK_REG_VADJ_8822C << BIT_SHIFT_REG_VADJ_8822C) -+#define BIT_CLEAR_REG_VADJ_8822C(x) ((x) & (~BITS_REG_VADJ_8822C)) -+#define BIT_GET_REG_VADJ_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_VADJ_8822C) & BIT_MASK_REG_VADJ_8822C) -+#define BIT_SET_REG_VADJ_8822C(x, v) \ -+ (BIT_CLEAR_REG_VADJ_8822C(x) | BIT_REG_VADJ_8822C(v)) -+ -+/* 2 REG_LDO_SWR_CTRL_8822C */ -+#define BIT_EXT_SWR_CTRL_EN_8822C BIT(31) -+#define BIT_ZCD_HW_AUTO_EN_8822C BIT(27) -+#define BIT_ZCD_REGSEL_8822C BIT(26) -+ -+#define BIT_SHIFT_AUTO_ZCD_IN_CODE_8822C 21 -+#define BIT_MASK_AUTO_ZCD_IN_CODE_8822C 0x1f -+#define BIT_AUTO_ZCD_IN_CODE_8822C(x) \ -+ (((x) & BIT_MASK_AUTO_ZCD_IN_CODE_8822C) \ -+ << BIT_SHIFT_AUTO_ZCD_IN_CODE_8822C) -+#define BITS_AUTO_ZCD_IN_CODE_8822C \ -+ (BIT_MASK_AUTO_ZCD_IN_CODE_8822C << BIT_SHIFT_AUTO_ZCD_IN_CODE_8822C) -+#define BIT_CLEAR_AUTO_ZCD_IN_CODE_8822C(x) \ -+ ((x) & (~BITS_AUTO_ZCD_IN_CODE_8822C)) -+#define BIT_GET_AUTO_ZCD_IN_CODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_AUTO_ZCD_IN_CODE_8822C) & \ -+ BIT_MASK_AUTO_ZCD_IN_CODE_8822C) -+#define BIT_SET_AUTO_ZCD_IN_CODE_8822C(x, v) \ -+ (BIT_CLEAR_AUTO_ZCD_IN_CODE_8822C(x) | BIT_AUTO_ZCD_IN_CODE_8822C(v)) -+ -+#define BIT_SHIFT_ZCD_CODE_IN_L_8822C 16 -+#define BIT_MASK_ZCD_CODE_IN_L_8822C 0x1f -+#define BIT_ZCD_CODE_IN_L_8822C(x) \ -+ (((x) & BIT_MASK_ZCD_CODE_IN_L_8822C) << BIT_SHIFT_ZCD_CODE_IN_L_8822C) -+#define BITS_ZCD_CODE_IN_L_8822C \ -+ (BIT_MASK_ZCD_CODE_IN_L_8822C << BIT_SHIFT_ZCD_CODE_IN_L_8822C) -+#define BIT_CLEAR_ZCD_CODE_IN_L_8822C(x) ((x) & (~BITS_ZCD_CODE_IN_L_8822C)) -+#define BIT_GET_ZCD_CODE_IN_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_ZCD_CODE_IN_L_8822C) & BIT_MASK_ZCD_CODE_IN_L_8822C) -+#define BIT_SET_ZCD_CODE_IN_L_8822C(x, v) \ -+ (BIT_CLEAR_ZCD_CODE_IN_L_8822C(x) | BIT_ZCD_CODE_IN_L_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_MCUFW_CTRL_8822C */ -+ -+#define BIT_SHIFT_RPWM_8822C 24 -+#define BIT_MASK_RPWM_8822C 0xff -+#define BIT_RPWM_8822C(x) (((x) & BIT_MASK_RPWM_8822C) << BIT_SHIFT_RPWM_8822C) -+#define BITS_RPWM_8822C (BIT_MASK_RPWM_8822C << BIT_SHIFT_RPWM_8822C) -+#define BIT_CLEAR_RPWM_8822C(x) ((x) & (~BITS_RPWM_8822C)) -+#define BIT_GET_RPWM_8822C(x) \ -+ (((x) >> BIT_SHIFT_RPWM_8822C) & BIT_MASK_RPWM_8822C) -+#define BIT_SET_RPWM_8822C(x, v) (BIT_CLEAR_RPWM_8822C(x) | BIT_RPWM_8822C(v)) -+ -+#define BIT_ANA_PORT_EN_8822C BIT(22) -+#define BIT_MAC_PORT_EN_8822C BIT(21) -+#define BIT_BOOT_FSPI_EN_8822C BIT(20) -+#define BIT_ROM_DLEN_8822C BIT(19) -+ -+#define BIT_SHIFT_ROM_PGE_8822C 16 -+#define BIT_MASK_ROM_PGE_8822C 0x7 -+#define BIT_ROM_PGE_8822C(x) \ -+ (((x) & BIT_MASK_ROM_PGE_8822C) << BIT_SHIFT_ROM_PGE_8822C) -+#define BITS_ROM_PGE_8822C (BIT_MASK_ROM_PGE_8822C << BIT_SHIFT_ROM_PGE_8822C) -+#define BIT_CLEAR_ROM_PGE_8822C(x) ((x) & (~BITS_ROM_PGE_8822C)) -+#define BIT_GET_ROM_PGE_8822C(x) \ -+ (((x) >> BIT_SHIFT_ROM_PGE_8822C) & BIT_MASK_ROM_PGE_8822C) -+#define BIT_SET_ROM_PGE_8822C(x, v) \ -+ (BIT_CLEAR_ROM_PGE_8822C(x) | BIT_ROM_PGE_8822C(v)) -+ -+#define BIT_FW_INIT_RDY_8822C BIT(15) -+#define BIT_FW_DW_RDY_8822C BIT(14) -+ -+#define BIT_SHIFT_CPU_CLK_SEL_8822C 12 -+#define BIT_MASK_CPU_CLK_SEL_8822C 0x3 -+#define BIT_CPU_CLK_SEL_8822C(x) \ -+ (((x) & BIT_MASK_CPU_CLK_SEL_8822C) << BIT_SHIFT_CPU_CLK_SEL_8822C) -+#define BITS_CPU_CLK_SEL_8822C \ -+ (BIT_MASK_CPU_CLK_SEL_8822C << BIT_SHIFT_CPU_CLK_SEL_8822C) -+#define BIT_CLEAR_CPU_CLK_SEL_8822C(x) ((x) & (~BITS_CPU_CLK_SEL_8822C)) -+#define BIT_GET_CPU_CLK_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_CPU_CLK_SEL_8822C) & BIT_MASK_CPU_CLK_SEL_8822C) -+#define BIT_SET_CPU_CLK_SEL_8822C(x, v) \ -+ (BIT_CLEAR_CPU_CLK_SEL_8822C(x) | BIT_CPU_CLK_SEL_8822C(v)) -+ -+#define BIT_CCLK_CHG_MASK_8822C BIT(11) -+#define BIT_EMEM__TXBUF_CHKSUM_OK_8822C BIT(10) -+#define BIT_EMEM_TXBUF_DW_RDY_8822C BIT(9) -+#define BIT_EMEM_CHKSUM_OK_8822C BIT(8) -+#define BIT_EMEM_DW_OK_8822C BIT(7) -+#define BIT_DMEM_CHKSUM_OK_8822C BIT(6) -+#define BIT_DMEM_DW_OK_8822C BIT(5) -+#define BIT_IMEM_CHKSUM_OK_8822C BIT(4) -+#define BIT_IMEM_DW_OK_8822C BIT(3) -+#define BIT_IMEM_BOOT_LOAD_CHKSUM_OK_8822C BIT(2) -+#define BIT_IMEM_BOOT_LOAD_DW_OK_8822C BIT(1) -+#define BIT_MCUFWDL_EN_8822C BIT(0) -+ -+/* 2 REG_MCU_TST_CFG_8822C */ -+ -+#define BIT_SHIFT_LBKTST_8822C 0 -+#define BIT_MASK_LBKTST_8822C 0xffff -+#define BIT_LBKTST_8822C(x) \ -+ (((x) & BIT_MASK_LBKTST_8822C) << BIT_SHIFT_LBKTST_8822C) -+#define BITS_LBKTST_8822C (BIT_MASK_LBKTST_8822C << BIT_SHIFT_LBKTST_8822C) -+#define BIT_CLEAR_LBKTST_8822C(x) ((x) & (~BITS_LBKTST_8822C)) -+#define BIT_GET_LBKTST_8822C(x) \ -+ (((x) >> BIT_SHIFT_LBKTST_8822C) & BIT_MASK_LBKTST_8822C) -+#define BIT_SET_LBKTST_8822C(x, v) \ -+ (BIT_CLEAR_LBKTST_8822C(x) | BIT_LBKTST_8822C(v)) -+ -+/* 2 REG_HMEBOX_E0_E1_8822C */ -+ -+#define BIT_SHIFT_HOST_MSG_E1_8822C 16 -+#define BIT_MASK_HOST_MSG_E1_8822C 0xffff -+#define BIT_HOST_MSG_E1_8822C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E1_8822C) << BIT_SHIFT_HOST_MSG_E1_8822C) -+#define BITS_HOST_MSG_E1_8822C \ -+ (BIT_MASK_HOST_MSG_E1_8822C << BIT_SHIFT_HOST_MSG_E1_8822C) -+#define BIT_CLEAR_HOST_MSG_E1_8822C(x) ((x) & (~BITS_HOST_MSG_E1_8822C)) -+#define BIT_GET_HOST_MSG_E1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E1_8822C) & BIT_MASK_HOST_MSG_E1_8822C) -+#define BIT_SET_HOST_MSG_E1_8822C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E1_8822C(x) | BIT_HOST_MSG_E1_8822C(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E0_8822C 0 -+#define BIT_MASK_HOST_MSG_E0_8822C 0xffff -+#define BIT_HOST_MSG_E0_8822C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E0_8822C) << BIT_SHIFT_HOST_MSG_E0_8822C) -+#define BITS_HOST_MSG_E0_8822C \ -+ (BIT_MASK_HOST_MSG_E0_8822C << BIT_SHIFT_HOST_MSG_E0_8822C) -+#define BIT_CLEAR_HOST_MSG_E0_8822C(x) ((x) & (~BITS_HOST_MSG_E0_8822C)) -+#define BIT_GET_HOST_MSG_E0_8822C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E0_8822C) & BIT_MASK_HOST_MSG_E0_8822C) -+#define BIT_SET_HOST_MSG_E0_8822C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E0_8822C(x) | BIT_HOST_MSG_E0_8822C(v)) -+ -+/* 2 REG_HMEBOX_E2_E3_8822C */ -+ -+#define BIT_SHIFT_HOST_MSG_E3_8822C 16 -+#define BIT_MASK_HOST_MSG_E3_8822C 0xffff -+#define BIT_HOST_MSG_E3_8822C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E3_8822C) << BIT_SHIFT_HOST_MSG_E3_8822C) -+#define BITS_HOST_MSG_E3_8822C \ -+ (BIT_MASK_HOST_MSG_E3_8822C << BIT_SHIFT_HOST_MSG_E3_8822C) -+#define BIT_CLEAR_HOST_MSG_E3_8822C(x) ((x) & (~BITS_HOST_MSG_E3_8822C)) -+#define BIT_GET_HOST_MSG_E3_8822C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E3_8822C) & BIT_MASK_HOST_MSG_E3_8822C) -+#define BIT_SET_HOST_MSG_E3_8822C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E3_8822C(x) | BIT_HOST_MSG_E3_8822C(v)) -+ -+#define BIT_SHIFT_HOST_MSG_E2_8822C 0 -+#define BIT_MASK_HOST_MSG_E2_8822C 0xffff -+#define BIT_HOST_MSG_E2_8822C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_E2_8822C) << BIT_SHIFT_HOST_MSG_E2_8822C) -+#define BITS_HOST_MSG_E2_8822C \ -+ (BIT_MASK_HOST_MSG_E2_8822C << BIT_SHIFT_HOST_MSG_E2_8822C) -+#define BIT_CLEAR_HOST_MSG_E2_8822C(x) ((x) & (~BITS_HOST_MSG_E2_8822C)) -+#define BIT_GET_HOST_MSG_E2_8822C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_E2_8822C) & BIT_MASK_HOST_MSG_E2_8822C) -+#define BIT_SET_HOST_MSG_E2_8822C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_E2_8822C(x) | BIT_HOST_MSG_E2_8822C(v)) -+ -+/* 2 REG_WLLPS_CTRL_8822C */ -+#define BIT_WLLPSOP_EABM_8822C BIT(31) -+#define BIT_WLLPSOP_ACKF_8822C BIT(30) -+#define BIT_WLLPSOP_DLDM_8822C BIT(29) -+#define BIT_WLLPSOP_ESWR_8822C BIT(28) -+#define BIT_WLLPSOP_PWMM_8822C BIT(27) -+#define BIT_WLLPSOP_EECK_8822C BIT(26) -+#define BIT_WLLPSOP_WLMACOFF_8822C BIT(25) -+#define BIT_WLLPSOP_EXTAL_8822C BIT(24) -+#define BIT_WL_SYNPON_VOLTSPDN_8822C BIT(23) -+#define BIT_WLLPSOP_WLBBOFF_8822C BIT(22) -+#define BIT_WLLPSOP_WLMEM_DS_8822C BIT(21) -+#define BIT_WLLPSOP_LDO_WAIT_TIME_8822C BIT(20) -+#define BIT_WLLPSOP_ANA_CLK_DIVISION_2_8822C BIT(19) -+#define BIT_AFE_BCN_8822C BIT(18) -+ -+#define BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8822C 12 -+#define BIT_MASK_LPLDH12_VADJ_STEP_DN_8822C 0xf -+#define BIT_LPLDH12_VADJ_STEP_DN_8822C(x) \ -+ (((x) & BIT_MASK_LPLDH12_VADJ_STEP_DN_8822C) \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8822C) -+#define BITS_LPLDH12_VADJ_STEP_DN_8822C \ -+ (BIT_MASK_LPLDH12_VADJ_STEP_DN_8822C \ -+ << BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8822C) -+#define BIT_CLEAR_LPLDH12_VADJ_STEP_DN_8822C(x) \ -+ ((x) & (~BITS_LPLDH12_VADJ_STEP_DN_8822C)) -+#define BIT_GET_LPLDH12_VADJ_STEP_DN_8822C(x) \ -+ (((x) >> BIT_SHIFT_LPLDH12_VADJ_STEP_DN_8822C) & \ -+ BIT_MASK_LPLDH12_VADJ_STEP_DN_8822C) -+#define BIT_SET_LPLDH12_VADJ_STEP_DN_8822C(x, v) \ -+ (BIT_CLEAR_LPLDH12_VADJ_STEP_DN_8822C(x) | \ -+ BIT_LPLDH12_VADJ_STEP_DN_8822C(v)) -+ -+#define BIT_SHIFT_V15ADJ_L1_STEP_DN_V1_8822C 8 -+#define BIT_MASK_V15ADJ_L1_STEP_DN_V1_8822C 0xf -+#define BIT_V15ADJ_L1_STEP_DN_V1_8822C(x) \ -+ (((x) & BIT_MASK_V15ADJ_L1_STEP_DN_V1_8822C) \ -+ << BIT_SHIFT_V15ADJ_L1_STEP_DN_V1_8822C) -+#define BITS_V15ADJ_L1_STEP_DN_V1_8822C \ -+ (BIT_MASK_V15ADJ_L1_STEP_DN_V1_8822C \ -+ << BIT_SHIFT_V15ADJ_L1_STEP_DN_V1_8822C) -+#define BIT_CLEAR_V15ADJ_L1_STEP_DN_V1_8822C(x) \ -+ ((x) & (~BITS_V15ADJ_L1_STEP_DN_V1_8822C)) -+#define BIT_GET_V15ADJ_L1_STEP_DN_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L1_STEP_DN_V1_8822C) & \ -+ BIT_MASK_V15ADJ_L1_STEP_DN_V1_8822C) -+#define BIT_SET_V15ADJ_L1_STEP_DN_V1_8822C(x, v) \ -+ (BIT_CLEAR_V15ADJ_L1_STEP_DN_V1_8822C(x) | \ -+ BIT_V15ADJ_L1_STEP_DN_V1_8822C(v)) -+ -+#define BIT_FORCE_LEAVE_LPS_8822C BIT(3) -+#define BIT_SW_AFE_MODE_8822C BIT(2) -+#define BIT_REGU_32K_CLK_EN_8822C BIT(1) -+#define BIT_WL_LPS_EN_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_GPIO_DEBOUNCE_CTRL_8822C */ -+#define BIT_WLGP_DBC1EN_8822C BIT(15) -+ -+#define BIT_SHIFT_WLGP_DBC1_8822C 8 -+#define BIT_MASK_WLGP_DBC1_8822C 0xf -+#define BIT_WLGP_DBC1_8822C(x) \ -+ (((x) & BIT_MASK_WLGP_DBC1_8822C) << BIT_SHIFT_WLGP_DBC1_8822C) -+#define BITS_WLGP_DBC1_8822C \ -+ (BIT_MASK_WLGP_DBC1_8822C << BIT_SHIFT_WLGP_DBC1_8822C) -+#define BIT_CLEAR_WLGP_DBC1_8822C(x) ((x) & (~BITS_WLGP_DBC1_8822C)) -+#define BIT_GET_WLGP_DBC1_8822C(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC1_8822C) & BIT_MASK_WLGP_DBC1_8822C) -+#define BIT_SET_WLGP_DBC1_8822C(x, v) \ -+ (BIT_CLEAR_WLGP_DBC1_8822C(x) | BIT_WLGP_DBC1_8822C(v)) -+ -+#define BIT_WLGP_DBC0EN_8822C BIT(7) -+ -+#define BIT_SHIFT_WLGP_DBC0_8822C 0 -+#define BIT_MASK_WLGP_DBC0_8822C 0xf -+#define BIT_WLGP_DBC0_8822C(x) \ -+ (((x) & BIT_MASK_WLGP_DBC0_8822C) << BIT_SHIFT_WLGP_DBC0_8822C) -+#define BITS_WLGP_DBC0_8822C \ -+ (BIT_MASK_WLGP_DBC0_8822C << BIT_SHIFT_WLGP_DBC0_8822C) -+#define BIT_CLEAR_WLGP_DBC0_8822C(x) ((x) & (~BITS_WLGP_DBC0_8822C)) -+#define BIT_GET_WLGP_DBC0_8822C(x) \ -+ (((x) >> BIT_SHIFT_WLGP_DBC0_8822C) & BIT_MASK_WLGP_DBC0_8822C) -+#define BIT_SET_WLGP_DBC0_8822C(x, v) \ -+ (BIT_CLEAR_WLGP_DBC0_8822C(x) | BIT_WLGP_DBC0_8822C(v)) -+ -+/* 2 REG_RPWM2_8822C */ -+ -+#define BIT_SHIFT_RPWM2_8822C 16 -+#define BIT_MASK_RPWM2_8822C 0xffff -+#define BIT_RPWM2_8822C(x) \ -+ (((x) & BIT_MASK_RPWM2_8822C) << BIT_SHIFT_RPWM2_8822C) -+#define BITS_RPWM2_8822C (BIT_MASK_RPWM2_8822C << BIT_SHIFT_RPWM2_8822C) -+#define BIT_CLEAR_RPWM2_8822C(x) ((x) & (~BITS_RPWM2_8822C)) -+#define BIT_GET_RPWM2_8822C(x) \ -+ (((x) >> BIT_SHIFT_RPWM2_8822C) & BIT_MASK_RPWM2_8822C) -+#define BIT_SET_RPWM2_8822C(x, v) \ -+ (BIT_CLEAR_RPWM2_8822C(x) | BIT_RPWM2_8822C(v)) -+ -+/* 2 REG_SYSON_FSM_MON_8822C */ -+ -+#define BIT_SHIFT_FSM_MON_SEL_8822C 24 -+#define BIT_MASK_FSM_MON_SEL_8822C 0x7 -+#define BIT_FSM_MON_SEL_8822C(x) \ -+ (((x) & BIT_MASK_FSM_MON_SEL_8822C) << BIT_SHIFT_FSM_MON_SEL_8822C) -+#define BITS_FSM_MON_SEL_8822C \ -+ (BIT_MASK_FSM_MON_SEL_8822C << BIT_SHIFT_FSM_MON_SEL_8822C) -+#define BIT_CLEAR_FSM_MON_SEL_8822C(x) ((x) & (~BITS_FSM_MON_SEL_8822C)) -+#define BIT_GET_FSM_MON_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_FSM_MON_SEL_8822C) & BIT_MASK_FSM_MON_SEL_8822C) -+#define BIT_SET_FSM_MON_SEL_8822C(x, v) \ -+ (BIT_CLEAR_FSM_MON_SEL_8822C(x) | BIT_FSM_MON_SEL_8822C(v)) -+ -+#define BIT_DOP_ELDO_8822C BIT(23) -+#define BIT_FSM_MON_UPD_8822C BIT(15) -+ -+#define BIT_SHIFT_FSM_PAR_8822C 0 -+#define BIT_MASK_FSM_PAR_8822C 0x7fff -+#define BIT_FSM_PAR_8822C(x) \ -+ (((x) & BIT_MASK_FSM_PAR_8822C) << BIT_SHIFT_FSM_PAR_8822C) -+#define BITS_FSM_PAR_8822C (BIT_MASK_FSM_PAR_8822C << BIT_SHIFT_FSM_PAR_8822C) -+#define BIT_CLEAR_FSM_PAR_8822C(x) ((x) & (~BITS_FSM_PAR_8822C)) -+#define BIT_GET_FSM_PAR_8822C(x) \ -+ (((x) >> BIT_SHIFT_FSM_PAR_8822C) & BIT_MASK_FSM_PAR_8822C) -+#define BIT_SET_FSM_PAR_8822C(x, v) \ -+ (BIT_CLEAR_FSM_PAR_8822C(x) | BIT_FSM_PAR_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_PMC_DBG_CTRL1_8822C */ -+#define BIT_BT_INT_EN_8822C BIT(31) -+ -+#define BIT_SHIFT_RD_WR_WIFI_BT_INFO_8822C 16 -+#define BIT_MASK_RD_WR_WIFI_BT_INFO_8822C 0x7fff -+#define BIT_RD_WR_WIFI_BT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_RD_WR_WIFI_BT_INFO_8822C) \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8822C) -+#define BITS_RD_WR_WIFI_BT_INFO_8822C \ -+ (BIT_MASK_RD_WR_WIFI_BT_INFO_8822C \ -+ << BIT_SHIFT_RD_WR_WIFI_BT_INFO_8822C) -+#define BIT_CLEAR_RD_WR_WIFI_BT_INFO_8822C(x) \ -+ ((x) & (~BITS_RD_WR_WIFI_BT_INFO_8822C)) -+#define BIT_GET_RD_WR_WIFI_BT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_RD_WR_WIFI_BT_INFO_8822C) & \ -+ BIT_MASK_RD_WR_WIFI_BT_INFO_8822C) -+#define BIT_SET_RD_WR_WIFI_BT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_RD_WR_WIFI_BT_INFO_8822C(x) | \ -+ BIT_RD_WR_WIFI_BT_INFO_8822C(v)) -+ -+#define BIT_PMC_WR_OVF_8822C BIT(8) -+ -+#define BIT_SHIFT_WLPMC_ERRINT_8822C 0 -+#define BIT_MASK_WLPMC_ERRINT_8822C 0xff -+#define BIT_WLPMC_ERRINT_8822C(x) \ -+ (((x) & BIT_MASK_WLPMC_ERRINT_8822C) << BIT_SHIFT_WLPMC_ERRINT_8822C) -+#define BITS_WLPMC_ERRINT_8822C \ -+ (BIT_MASK_WLPMC_ERRINT_8822C << BIT_SHIFT_WLPMC_ERRINT_8822C) -+#define BIT_CLEAR_WLPMC_ERRINT_8822C(x) ((x) & (~BITS_WLPMC_ERRINT_8822C)) -+#define BIT_GET_WLPMC_ERRINT_8822C(x) \ -+ (((x) >> BIT_SHIFT_WLPMC_ERRINT_8822C) & BIT_MASK_WLPMC_ERRINT_8822C) -+#define BIT_SET_WLPMC_ERRINT_8822C(x, v) \ -+ (BIT_CLEAR_WLPMC_ERRINT_8822C(x) | BIT_WLPMC_ERRINT_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_HIMR0_8822C */ -+#define BIT_TIMEOUT_INTERRUPT2_MASK_8822C BIT(31) -+#define BIT_TIMEOUT_INTERRUTP1_MASK_8822C BIT(30) -+#define BIT_PSTIMEOUT_MSK_8822C BIT(29) -+#define BIT_GTINT4_MSK_8822C BIT(28) -+#define BIT_GTINT3_MSK_8822C BIT(27) -+#define BIT_TXBCN0ERR_MSK_8822C BIT(26) -+#define BIT_TXBCN0OK_MSK_8822C BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_MSK_8822C BIT(24) -+#define BIT_BCNDMAINT0_MSK_8822C BIT(20) -+#define BIT_BCNDERR0_MSK_8822C BIT(16) -+#define BIT_HSISR_IND_ON_INT_MSK_8822C BIT(15) -+#define BIT_BCNDMAINT_E_MSK_8822C BIT(14) -+#define BIT_CTWEND_MSK_8822C BIT(12) -+#define BIT_HISR1_IND_MSK_8822C BIT(11) -+#define BIT_C2HCMD_MSK_8822C BIT(10) -+#define BIT_CPWM2_MSK_8822C BIT(9) -+#define BIT_CPWM_MSK_8822C BIT(8) -+#define BIT_HIGHDOK_MSK_8822C BIT(7) -+#define BIT_MGTDOK_MSK_8822C BIT(6) -+#define BIT_BKDOK_MSK_8822C BIT(5) -+#define BIT_BEDOK_MSK_8822C BIT(4) -+#define BIT_VIDOK_MSK_8822C BIT(3) -+#define BIT_VODOK_MSK_8822C BIT(2) -+#define BIT_RDU_MSK_8822C BIT(1) -+#define BIT_RXOK_MSK_8822C BIT(0) -+ -+/* 2 REG_HISR0_8822C */ -+#define BIT_PSTIMEOUT2_8822C BIT(31) -+#define BIT_PSTIMEOUT1_8822C BIT(30) -+#define BIT_PSTIMEOUT_8822C BIT(29) -+#define BIT_GTINT4_8822C BIT(28) -+#define BIT_GTINT3_8822C BIT(27) -+#define BIT_TXBCN0ERR_8822C BIT(26) -+#define BIT_TXBCN0OK_8822C BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_8822C BIT(24) -+#define BIT_BCNDMAINT0_8822C BIT(20) -+#define BIT_BCNDERR0_8822C BIT(16) -+#define BIT_HSISR_IND_ON_INT_8822C BIT(15) -+#define BIT_BCNDMAINT_E_8822C BIT(14) -+#define BIT_CTWEND_8822C BIT(12) -+#define BIT_HISR1_IND_INT_8822C BIT(11) -+#define BIT_C2HCMD_8822C BIT(10) -+#define BIT_CPWM2_8822C BIT(9) -+#define BIT_CPWM_8822C BIT(8) -+#define BIT_HIGHDOK_8822C BIT(7) -+#define BIT_MGTDOK_8822C BIT(6) -+#define BIT_BKDOK_8822C BIT(5) -+#define BIT_BEDOK_8822C BIT(4) -+#define BIT_VIDOK_8822C BIT(3) -+#define BIT_VODOK_8822C BIT(2) -+#define BIT_RDU_8822C BIT(1) -+#define BIT_RXOK_8822C BIT(0) -+ -+/* 2 REG_HIMR1_8822C */ -+#define BIT_TXFIFO_TH_INT_8822C BIT(30) -+#define BIT_BTON_STS_UPDATE_MASK_8822C BIT(29) -+#define BIT_MCU_ERR_MASK_8822C BIT(28) -+#define BIT_BCNDMAINT7__MSK_8822C BIT(27) -+#define BIT_BCNDMAINT6__MSK_8822C BIT(26) -+#define BIT_BCNDMAINT5__MSK_8822C BIT(25) -+#define BIT_BCNDMAINT4__MSK_8822C BIT(24) -+#define BIT_BCNDMAINT3_MSK_8822C BIT(23) -+#define BIT_BCNDMAINT2_MSK_8822C BIT(22) -+#define BIT_BCNDMAINT1_MSK_8822C BIT(21) -+#define BIT_BCNDERR7_MSK_8822C BIT(20) -+#define BIT_BCNDERR6_MSK_8822C BIT(19) -+#define BIT_BCNDERR5_MSK_8822C BIT(18) -+#define BIT_BCNDERR4_MSK_8822C BIT(17) -+#define BIT_BCNDERR3_MSK_8822C BIT(16) -+#define BIT_BCNDERR2_MSK_8822C BIT(15) -+#define BIT_BCNDERR1_MSK_8822C BIT(14) -+#define BIT_ATIMEND_E_MSK_8822C BIT(13) -+#define BIT_ATIMEND__MSK_8822C BIT(12) -+#define BIT_TXERR_MSK_8822C BIT(11) -+#define BIT_RXERR_MSK_8822C BIT(10) -+#define BIT_TXFOVW_MSK_8822C BIT(9) -+#define BIT_FOVW_MSK_8822C BIT(8) -+#define BIT_CPU_MGQ_TXDONE_MSK_8822C BIT(5) -+#define BIT_PS_TIMER_C_MSK_8822C BIT(4) -+#define BIT_PS_TIMER_B_MSK_8822C BIT(3) -+#define BIT_PS_TIMER_A_MSK_8822C BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_MSK_8822C BIT(1) -+ -+/* 2 REG_HISR1_8822C */ -+#define BIT_TXFIFO_TH_INT_8822C BIT(30) -+#define BIT_BTON_STS_UPDATE_INT_8822C BIT(29) -+#define BIT_MCU_ERR_8822C BIT(28) -+#define BIT_BCNDMAINT7_8822C BIT(27) -+#define BIT_BCNDMAINT6_8822C BIT(26) -+#define BIT_BCNDMAINT5_8822C BIT(25) -+#define BIT_BCNDMAINT4_8822C BIT(24) -+#define BIT_BCNDMAINT3_8822C BIT(23) -+#define BIT_BCNDMAINT2_8822C BIT(22) -+#define BIT_BCNDMAINT1_8822C BIT(21) -+#define BIT_BCNDERR7_8822C BIT(20) -+#define BIT_BCNDERR6_8822C BIT(19) -+#define BIT_BCNDERR5_8822C BIT(18) -+#define BIT_BCNDERR4_8822C BIT(17) -+#define BIT_BCNDERR3_8822C BIT(16) -+#define BIT_BCNDERR2_8822C BIT(15) -+#define BIT_BCNDERR1_8822C BIT(14) -+#define BIT_ATIMEND_E_8822C BIT(13) -+#define BIT_ATIMEND_8822C BIT(12) -+#define BIT_TXERR_INT_8822C BIT(11) -+#define BIT_RXERR_INT_8822C BIT(10) -+#define BIT_TXFOVW_8822C BIT(9) -+#define BIT_FOVW_8822C BIT(8) -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_CPU_MGQ_TXDONE_8822C BIT(5) -+#define BIT_PS_TIMER_C_8822C BIT(4) -+#define BIT_PS_TIMER_B_8822C BIT(3) -+#define BIT_PS_TIMER_A_8822C BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_8822C BIT(1) -+ -+/* 2 REG_DBG_PORT_SEL_8822C */ -+ -+#define BIT_SHIFT_DEBUG_ST_8822C 0 -+#define BIT_MASK_DEBUG_ST_8822C 0xffffffffL -+#define BIT_DEBUG_ST_8822C(x) \ -+ (((x) & BIT_MASK_DEBUG_ST_8822C) << BIT_SHIFT_DEBUG_ST_8822C) -+#define BITS_DEBUG_ST_8822C \ -+ (BIT_MASK_DEBUG_ST_8822C << BIT_SHIFT_DEBUG_ST_8822C) -+#define BIT_CLEAR_DEBUG_ST_8822C(x) ((x) & (~BITS_DEBUG_ST_8822C)) -+#define BIT_GET_DEBUG_ST_8822C(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_ST_8822C) & BIT_MASK_DEBUG_ST_8822C) -+#define BIT_SET_DEBUG_ST_8822C(x, v) \ -+ (BIT_CLEAR_DEBUG_ST_8822C(x) | BIT_DEBUG_ST_8822C(v)) -+ -+/* 2 REG_PAD_CTRL2_8822C */ -+#define BIT_USB3_USB2_TRANSITION_8822C BIT(20) -+ -+#define BIT_SHIFT_USB23_SW_MODE_V1_8822C 18 -+#define BIT_MASK_USB23_SW_MODE_V1_8822C 0x3 -+#define BIT_USB23_SW_MODE_V1_8822C(x) \ -+ (((x) & BIT_MASK_USB23_SW_MODE_V1_8822C) \ -+ << BIT_SHIFT_USB23_SW_MODE_V1_8822C) -+#define BITS_USB23_SW_MODE_V1_8822C \ -+ (BIT_MASK_USB23_SW_MODE_V1_8822C << BIT_SHIFT_USB23_SW_MODE_V1_8822C) -+#define BIT_CLEAR_USB23_SW_MODE_V1_8822C(x) \ -+ ((x) & (~BITS_USB23_SW_MODE_V1_8822C)) -+#define BIT_GET_USB23_SW_MODE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_USB23_SW_MODE_V1_8822C) & \ -+ BIT_MASK_USB23_SW_MODE_V1_8822C) -+#define BIT_SET_USB23_SW_MODE_V1_8822C(x, v) \ -+ (BIT_CLEAR_USB23_SW_MODE_V1_8822C(x) | BIT_USB23_SW_MODE_V1_8822C(v)) -+ -+#define BIT_NO_PDN_CHIPOFF_V1_8822C BIT(17) -+#define BIT_RSM_EN_V1_8822C BIT(16) -+ -+#define BIT_SHIFT_MATCH_CNT_8822C 8 -+#define BIT_MASK_MATCH_CNT_8822C 0xff -+#define BIT_MATCH_CNT_8822C(x) \ -+ (((x) & BIT_MASK_MATCH_CNT_8822C) << BIT_SHIFT_MATCH_CNT_8822C) -+#define BITS_MATCH_CNT_8822C \ -+ (BIT_MASK_MATCH_CNT_8822C << BIT_SHIFT_MATCH_CNT_8822C) -+#define BIT_CLEAR_MATCH_CNT_8822C(x) ((x) & (~BITS_MATCH_CNT_8822C)) -+#define BIT_GET_MATCH_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_MATCH_CNT_8822C) & BIT_MASK_MATCH_CNT_8822C) -+#define BIT_SET_MATCH_CNT_8822C(x, v) \ -+ (BIT_CLEAR_MATCH_CNT_8822C(x) | BIT_MATCH_CNT_8822C(v)) -+ -+#define BIT_LD_B12V_EN_8822C BIT(7) -+#define BIT_EECS_IOSEL_V1_8822C BIT(6) -+#define BIT_EECS_DATA_O_V1_8822C BIT(5) -+#define BIT_EECS_DATA_I_V1_8822C BIT(4) -+#define BIT_EESK_IOSEL_V1_8822C BIT(2) -+#define BIT_EESK_DATA_O_V1_8822C BIT(1) -+#define BIT_EESK_DATA_I_V1_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_PMC_DBG_CTRL2_8822C */ -+ -+#define BIT_SHIFT_EFUSE_BURN_GNT_8822C 24 -+#define BIT_MASK_EFUSE_BURN_GNT_8822C 0xff -+#define BIT_EFUSE_BURN_GNT_8822C(x) \ -+ (((x) & BIT_MASK_EFUSE_BURN_GNT_8822C) \ -+ << BIT_SHIFT_EFUSE_BURN_GNT_8822C) -+#define BITS_EFUSE_BURN_GNT_8822C \ -+ (BIT_MASK_EFUSE_BURN_GNT_8822C << BIT_SHIFT_EFUSE_BURN_GNT_8822C) -+#define BIT_CLEAR_EFUSE_BURN_GNT_8822C(x) ((x) & (~BITS_EFUSE_BURN_GNT_8822C)) -+#define BIT_GET_EFUSE_BURN_GNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_EFUSE_BURN_GNT_8822C) & \ -+ BIT_MASK_EFUSE_BURN_GNT_8822C) -+#define BIT_SET_EFUSE_BURN_GNT_8822C(x, v) \ -+ (BIT_CLEAR_EFUSE_BURN_GNT_8822C(x) | BIT_EFUSE_BURN_GNT_8822C(v)) -+ -+#define BIT_STOP_WL_PMC_8822C BIT(9) -+#define BIT_STOP_SYM_PMC_8822C BIT(8) -+#define BIT_BT_ACCESS_WL_PAGE0_8822C BIT(6) -+#define BIT_REG_RST_WLPMC_8822C BIT(5) -+#define BIT_REG_RST_PD12N_8822C BIT(4) -+#define BIT_SYSON_DIS_WLREG_WRMSK_8822C BIT(3) -+#define BIT_SYSON_DIS_PMCREG_WRMSK_8822C BIT(2) -+ -+#define BIT_SHIFT_SYSON_REG_ARB_8822C 0 -+#define BIT_MASK_SYSON_REG_ARB_8822C 0x3 -+#define BIT_SYSON_REG_ARB_8822C(x) \ -+ (((x) & BIT_MASK_SYSON_REG_ARB_8822C) << BIT_SHIFT_SYSON_REG_ARB_8822C) -+#define BITS_SYSON_REG_ARB_8822C \ -+ (BIT_MASK_SYSON_REG_ARB_8822C << BIT_SHIFT_SYSON_REG_ARB_8822C) -+#define BIT_CLEAR_SYSON_REG_ARB_8822C(x) ((x) & (~BITS_SYSON_REG_ARB_8822C)) -+#define BIT_GET_SYSON_REG_ARB_8822C(x) \ -+ (((x) >> BIT_SHIFT_SYSON_REG_ARB_8822C) & BIT_MASK_SYSON_REG_ARB_8822C) -+#define BIT_SET_SYSON_REG_ARB_8822C(x, v) \ -+ (BIT_CLEAR_SYSON_REG_ARB_8822C(x) | BIT_SYSON_REG_ARB_8822C(v)) -+ -+/* 2 REG_BIST_CTRL_8822C */ -+#define BIT_BIST_USB_DIS_8822C BIT(27) -+#define BIT_BIST_PCI_DIS_8822C BIT(26) -+#define BIT_BIST_BT_DIS_8822C BIT(25) -+#define BIT_BIST_WL_DIS_8822C BIT(24) -+ -+#define BIT_SHIFT_BIST_RPT_SEL_8822C 16 -+#define BIT_MASK_BIST_RPT_SEL_8822C 0xf -+#define BIT_BIST_RPT_SEL_8822C(x) \ -+ (((x) & BIT_MASK_BIST_RPT_SEL_8822C) << BIT_SHIFT_BIST_RPT_SEL_8822C) -+#define BITS_BIST_RPT_SEL_8822C \ -+ (BIT_MASK_BIST_RPT_SEL_8822C << BIT_SHIFT_BIST_RPT_SEL_8822C) -+#define BIT_CLEAR_BIST_RPT_SEL_8822C(x) ((x) & (~BITS_BIST_RPT_SEL_8822C)) -+#define BIT_GET_BIST_RPT_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_BIST_RPT_SEL_8822C) & BIT_MASK_BIST_RPT_SEL_8822C) -+#define BIT_SET_BIST_RPT_SEL_8822C(x, v) \ -+ (BIT_CLEAR_BIST_RPT_SEL_8822C(x) | BIT_BIST_RPT_SEL_8822C(v)) -+ -+#define BIT_BIST_RESUME_PS_8822C BIT(4) -+#define BIT_BIST_RESUME_8822C BIT(3) -+#define BIT_BIST_NORMAL_8822C BIT(2) -+#define BIT_BIST_RSTN_8822C BIT(1) -+#define BIT_BIST_CLK_EN_8822C BIT(0) -+ -+/* 2 REG_BIST_RPT_8822C */ -+ -+#define BIT_SHIFT_MBIST_REPORT_8822C 0 -+#define BIT_MASK_MBIST_REPORT_8822C 0xffffffffL -+#define BIT_MBIST_REPORT_8822C(x) \ -+ (((x) & BIT_MASK_MBIST_REPORT_8822C) << BIT_SHIFT_MBIST_REPORT_8822C) -+#define BITS_MBIST_REPORT_8822C \ -+ (BIT_MASK_MBIST_REPORT_8822C << BIT_SHIFT_MBIST_REPORT_8822C) -+#define BIT_CLEAR_MBIST_REPORT_8822C(x) ((x) & (~BITS_MBIST_REPORT_8822C)) -+#define BIT_GET_MBIST_REPORT_8822C(x) \ -+ (((x) >> BIT_SHIFT_MBIST_REPORT_8822C) & BIT_MASK_MBIST_REPORT_8822C) -+#define BIT_SET_MBIST_REPORT_8822C(x, v) \ -+ (BIT_CLEAR_MBIST_REPORT_8822C(x) | BIT_MBIST_REPORT_8822C(v)) -+ -+/* 2 REG_MEM_CTRL_8822C */ -+#define BIT_UMEM_RME_8822C BIT(31) -+ -+#define BIT_SHIFT_BT_SPRAM_8822C 28 -+#define BIT_MASK_BT_SPRAM_8822C 0x3 -+#define BIT_BT_SPRAM_8822C(x) \ -+ (((x) & BIT_MASK_BT_SPRAM_8822C) << BIT_SHIFT_BT_SPRAM_8822C) -+#define BITS_BT_SPRAM_8822C \ -+ (BIT_MASK_BT_SPRAM_8822C << BIT_SHIFT_BT_SPRAM_8822C) -+#define BIT_CLEAR_BT_SPRAM_8822C(x) ((x) & (~BITS_BT_SPRAM_8822C)) -+#define BIT_GET_BT_SPRAM_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_SPRAM_8822C) & BIT_MASK_BT_SPRAM_8822C) -+#define BIT_SET_BT_SPRAM_8822C(x, v) \ -+ (BIT_CLEAR_BT_SPRAM_8822C(x) | BIT_BT_SPRAM_8822C(v)) -+ -+#define BIT_SHIFT_BT_ROM_8822C 24 -+#define BIT_MASK_BT_ROM_8822C 0xf -+#define BIT_BT_ROM_8822C(x) \ -+ (((x) & BIT_MASK_BT_ROM_8822C) << BIT_SHIFT_BT_ROM_8822C) -+#define BITS_BT_ROM_8822C (BIT_MASK_BT_ROM_8822C << BIT_SHIFT_BT_ROM_8822C) -+#define BIT_CLEAR_BT_ROM_8822C(x) ((x) & (~BITS_BT_ROM_8822C)) -+#define BIT_GET_BT_ROM_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_ROM_8822C) & BIT_MASK_BT_ROM_8822C) -+#define BIT_SET_BT_ROM_8822C(x, v) \ -+ (BIT_CLEAR_BT_ROM_8822C(x) | BIT_BT_ROM_8822C(v)) -+ -+#define BIT_SHIFT_PCI_DPRAM_8822C 10 -+#define BIT_MASK_PCI_DPRAM_8822C 0x3 -+#define BIT_PCI_DPRAM_8822C(x) \ -+ (((x) & BIT_MASK_PCI_DPRAM_8822C) << BIT_SHIFT_PCI_DPRAM_8822C) -+#define BITS_PCI_DPRAM_8822C \ -+ (BIT_MASK_PCI_DPRAM_8822C << BIT_SHIFT_PCI_DPRAM_8822C) -+#define BIT_CLEAR_PCI_DPRAM_8822C(x) ((x) & (~BITS_PCI_DPRAM_8822C)) -+#define BIT_GET_PCI_DPRAM_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCI_DPRAM_8822C) & BIT_MASK_PCI_DPRAM_8822C) -+#define BIT_SET_PCI_DPRAM_8822C(x, v) \ -+ (BIT_CLEAR_PCI_DPRAM_8822C(x) | BIT_PCI_DPRAM_8822C(v)) -+ -+#define BIT_SHIFT_PCI_SPRAM_8822C 8 -+#define BIT_MASK_PCI_SPRAM_8822C 0x3 -+#define BIT_PCI_SPRAM_8822C(x) \ -+ (((x) & BIT_MASK_PCI_SPRAM_8822C) << BIT_SHIFT_PCI_SPRAM_8822C) -+#define BITS_PCI_SPRAM_8822C \ -+ (BIT_MASK_PCI_SPRAM_8822C << BIT_SHIFT_PCI_SPRAM_8822C) -+#define BIT_CLEAR_PCI_SPRAM_8822C(x) ((x) & (~BITS_PCI_SPRAM_8822C)) -+#define BIT_GET_PCI_SPRAM_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCI_SPRAM_8822C) & BIT_MASK_PCI_SPRAM_8822C) -+#define BIT_SET_PCI_SPRAM_8822C(x, v) \ -+ (BIT_CLEAR_PCI_SPRAM_8822C(x) | BIT_PCI_SPRAM_8822C(v)) -+ -+#define BIT_SHIFT_USB_SPRAM_8822C 6 -+#define BIT_MASK_USB_SPRAM_8822C 0x3 -+#define BIT_USB_SPRAM_8822C(x) \ -+ (((x) & BIT_MASK_USB_SPRAM_8822C) << BIT_SHIFT_USB_SPRAM_8822C) -+#define BITS_USB_SPRAM_8822C \ -+ (BIT_MASK_USB_SPRAM_8822C << BIT_SHIFT_USB_SPRAM_8822C) -+#define BIT_CLEAR_USB_SPRAM_8822C(x) ((x) & (~BITS_USB_SPRAM_8822C)) -+#define BIT_GET_USB_SPRAM_8822C(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRAM_8822C) & BIT_MASK_USB_SPRAM_8822C) -+#define BIT_SET_USB_SPRAM_8822C(x, v) \ -+ (BIT_CLEAR_USB_SPRAM_8822C(x) | BIT_USB_SPRAM_8822C(v)) -+ -+#define BIT_SHIFT_USB_SPRF_8822C 4 -+#define BIT_MASK_USB_SPRF_8822C 0x3 -+#define BIT_USB_SPRF_8822C(x) \ -+ (((x) & BIT_MASK_USB_SPRF_8822C) << BIT_SHIFT_USB_SPRF_8822C) -+#define BITS_USB_SPRF_8822C \ -+ (BIT_MASK_USB_SPRF_8822C << BIT_SHIFT_USB_SPRF_8822C) -+#define BIT_CLEAR_USB_SPRF_8822C(x) ((x) & (~BITS_USB_SPRF_8822C)) -+#define BIT_GET_USB_SPRF_8822C(x) \ -+ (((x) >> BIT_SHIFT_USB_SPRF_8822C) & BIT_MASK_USB_SPRF_8822C) -+#define BIT_SET_USB_SPRF_8822C(x, v) \ -+ (BIT_CLEAR_USB_SPRF_8822C(x) | BIT_USB_SPRF_8822C(v)) -+ -+#define BIT_SHIFT_MCU_ROM_8822C 0 -+#define BIT_MASK_MCU_ROM_8822C 0xf -+#define BIT_MCU_ROM_8822C(x) \ -+ (((x) & BIT_MASK_MCU_ROM_8822C) << BIT_SHIFT_MCU_ROM_8822C) -+#define BITS_MCU_ROM_8822C (BIT_MASK_MCU_ROM_8822C << BIT_SHIFT_MCU_ROM_8822C) -+#define BIT_CLEAR_MCU_ROM_8822C(x) ((x) & (~BITS_MCU_ROM_8822C)) -+#define BIT_GET_MCU_ROM_8822C(x) \ -+ (((x) >> BIT_SHIFT_MCU_ROM_8822C) & BIT_MASK_MCU_ROM_8822C) -+#define BIT_SET_MCU_ROM_8822C(x, v) \ -+ (BIT_CLEAR_MCU_ROM_8822C(x) | BIT_MCU_ROM_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_USB_SIE_INTF_8822C */ -+#define BIT_RD_SEL_8822C BIT(31) -+#define BIT_USB_SIE_INTF_WE_V1_8822C BIT(30) -+#define BIT_USB_SIE_INTF_BYIOREG_V1_8822C BIT(29) -+#define BIT_USB_SIE_SELECT_8822C BIT(28) -+ -+#define BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8822C 16 -+#define BIT_MASK_USB_SIE_INTF_ADDR_V1_8822C 0x1ff -+#define BIT_USB_SIE_INTF_ADDR_V1_8822C(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_ADDR_V1_8822C) \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8822C) -+#define BITS_USB_SIE_INTF_ADDR_V1_8822C \ -+ (BIT_MASK_USB_SIE_INTF_ADDR_V1_8822C \ -+ << BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8822C) -+#define BIT_CLEAR_USB_SIE_INTF_ADDR_V1_8822C(x) \ -+ ((x) & (~BITS_USB_SIE_INTF_ADDR_V1_8822C)) -+#define BIT_GET_USB_SIE_INTF_ADDR_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_ADDR_V1_8822C) & \ -+ BIT_MASK_USB_SIE_INTF_ADDR_V1_8822C) -+#define BIT_SET_USB_SIE_INTF_ADDR_V1_8822C(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_ADDR_V1_8822C(x) | \ -+ BIT_USB_SIE_INTF_ADDR_V1_8822C(v)) -+ -+#define BIT_SHIFT_USB_SIE_INTF_RD_8822C 8 -+#define BIT_MASK_USB_SIE_INTF_RD_8822C 0xff -+#define BIT_USB_SIE_INTF_RD_8822C(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_RD_8822C) \ -+ << BIT_SHIFT_USB_SIE_INTF_RD_8822C) -+#define BITS_USB_SIE_INTF_RD_8822C \ -+ (BIT_MASK_USB_SIE_INTF_RD_8822C << BIT_SHIFT_USB_SIE_INTF_RD_8822C) -+#define BIT_CLEAR_USB_SIE_INTF_RD_8822C(x) ((x) & (~BITS_USB_SIE_INTF_RD_8822C)) -+#define BIT_GET_USB_SIE_INTF_RD_8822C(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_RD_8822C) & \ -+ BIT_MASK_USB_SIE_INTF_RD_8822C) -+#define BIT_SET_USB_SIE_INTF_RD_8822C(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_RD_8822C(x) | BIT_USB_SIE_INTF_RD_8822C(v)) -+ -+#define BIT_SHIFT_USB_SIE_INTF_WD_8822C 0 -+#define BIT_MASK_USB_SIE_INTF_WD_8822C 0xff -+#define BIT_USB_SIE_INTF_WD_8822C(x) \ -+ (((x) & BIT_MASK_USB_SIE_INTF_WD_8822C) \ -+ << BIT_SHIFT_USB_SIE_INTF_WD_8822C) -+#define BITS_USB_SIE_INTF_WD_8822C \ -+ (BIT_MASK_USB_SIE_INTF_WD_8822C << BIT_SHIFT_USB_SIE_INTF_WD_8822C) -+#define BIT_CLEAR_USB_SIE_INTF_WD_8822C(x) ((x) & (~BITS_USB_SIE_INTF_WD_8822C)) -+#define BIT_GET_USB_SIE_INTF_WD_8822C(x) \ -+ (((x) >> BIT_SHIFT_USB_SIE_INTF_WD_8822C) & \ -+ BIT_MASK_USB_SIE_INTF_WD_8822C) -+#define BIT_SET_USB_SIE_INTF_WD_8822C(x, v) \ -+ (BIT_CLEAR_USB_SIE_INTF_WD_8822C(x) | BIT_USB_SIE_INTF_WD_8822C(v)) -+ -+/* 2 REG_PCIE_MIO_INTF_8822C */ -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8822C 16 -+#define BIT_MASK_PCIE_MIO_ADDR_PAGE_8822C 0x3 -+#define BIT_PCIE_MIO_ADDR_PAGE_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_PAGE_8822C) \ -+ << BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8822C) -+#define BITS_PCIE_MIO_ADDR_PAGE_8822C \ -+ (BIT_MASK_PCIE_MIO_ADDR_PAGE_8822C \ -+ << BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8822C) -+#define BIT_CLEAR_PCIE_MIO_ADDR_PAGE_8822C(x) \ -+ ((x) & (~BITS_PCIE_MIO_ADDR_PAGE_8822C)) -+#define BIT_GET_PCIE_MIO_ADDR_PAGE_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_PAGE_8822C) & \ -+ BIT_MASK_PCIE_MIO_ADDR_PAGE_8822C) -+#define BIT_SET_PCIE_MIO_ADDR_PAGE_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_PAGE_8822C(x) | \ -+ BIT_PCIE_MIO_ADDR_PAGE_8822C(v)) -+ -+#define BIT_PCIE_MIO_BYIOREG_8822C BIT(13) -+#define BIT_PCIE_MIO_RE_8822C BIT(12) -+ -+#define BIT_SHIFT_PCIE_MIO_WE_8822C 8 -+#define BIT_MASK_PCIE_MIO_WE_8822C 0xf -+#define BIT_PCIE_MIO_WE_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_WE_8822C) << BIT_SHIFT_PCIE_MIO_WE_8822C) -+#define BITS_PCIE_MIO_WE_8822C \ -+ (BIT_MASK_PCIE_MIO_WE_8822C << BIT_SHIFT_PCIE_MIO_WE_8822C) -+#define BIT_CLEAR_PCIE_MIO_WE_8822C(x) ((x) & (~BITS_PCIE_MIO_WE_8822C)) -+#define BIT_GET_PCIE_MIO_WE_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_WE_8822C) & BIT_MASK_PCIE_MIO_WE_8822C) -+#define BIT_SET_PCIE_MIO_WE_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_WE_8822C(x) | BIT_PCIE_MIO_WE_8822C(v)) -+ -+#define BIT_SHIFT_PCIE_MIO_ADDR_8822C 0 -+#define BIT_MASK_PCIE_MIO_ADDR_8822C 0xff -+#define BIT_PCIE_MIO_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_ADDR_8822C) << BIT_SHIFT_PCIE_MIO_ADDR_8822C) -+#define BITS_PCIE_MIO_ADDR_8822C \ -+ (BIT_MASK_PCIE_MIO_ADDR_8822C << BIT_SHIFT_PCIE_MIO_ADDR_8822C) -+#define BIT_CLEAR_PCIE_MIO_ADDR_8822C(x) ((x) & (~BITS_PCIE_MIO_ADDR_8822C)) -+#define BIT_GET_PCIE_MIO_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_ADDR_8822C) & BIT_MASK_PCIE_MIO_ADDR_8822C) -+#define BIT_SET_PCIE_MIO_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_ADDR_8822C(x) | BIT_PCIE_MIO_ADDR_8822C(v)) -+ -+/* 2 REG_PCIE_MIO_INTD_8822C */ -+ -+#define BIT_SHIFT_PCIE_MIO_DATA_8822C 0 -+#define BIT_MASK_PCIE_MIO_DATA_8822C 0xffffffffL -+#define BIT_PCIE_MIO_DATA_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_MIO_DATA_8822C) << BIT_SHIFT_PCIE_MIO_DATA_8822C) -+#define BITS_PCIE_MIO_DATA_8822C \ -+ (BIT_MASK_PCIE_MIO_DATA_8822C << BIT_SHIFT_PCIE_MIO_DATA_8822C) -+#define BIT_CLEAR_PCIE_MIO_DATA_8822C(x) ((x) & (~BITS_PCIE_MIO_DATA_8822C)) -+#define BIT_GET_PCIE_MIO_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MIO_DATA_8822C) & BIT_MASK_PCIE_MIO_DATA_8822C) -+#define BIT_SET_PCIE_MIO_DATA_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_MIO_DATA_8822C(x) | BIT_PCIE_MIO_DATA_8822C(v)) -+ -+/* 2 REG_WLRF1_8822C */ -+#define BIT_S1_RFC_WO_0_8822C BIT(31) -+#define BIT_S1_RFC_WT_0_8822C BIT(30) -+#define BIT_S1_RFC_RSTB_8822C BIT(25) -+ -+/* 2 REG_SYS_CFG1_8822C */ -+ -+#define BIT_SHIFT_TRP_ICFG_8822C 28 -+#define BIT_MASK_TRP_ICFG_8822C 0xf -+#define BIT_TRP_ICFG_8822C(x) \ -+ (((x) & BIT_MASK_TRP_ICFG_8822C) << BIT_SHIFT_TRP_ICFG_8822C) -+#define BITS_TRP_ICFG_8822C \ -+ (BIT_MASK_TRP_ICFG_8822C << BIT_SHIFT_TRP_ICFG_8822C) -+#define BIT_CLEAR_TRP_ICFG_8822C(x) ((x) & (~BITS_TRP_ICFG_8822C)) -+#define BIT_GET_TRP_ICFG_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRP_ICFG_8822C) & BIT_MASK_TRP_ICFG_8822C) -+#define BIT_SET_TRP_ICFG_8822C(x, v) \ -+ (BIT_CLEAR_TRP_ICFG_8822C(x) | BIT_TRP_ICFG_8822C(v)) -+ -+#define BIT_RF_TYPE_ID_8822C BIT(27) -+#define BIT_BD_HCI_SEL_8822C BIT(26) -+#define BIT_BD_PKG_SEL_8822C BIT(25) -+#define BIT_INTERNAL_EXTERNAL_SWR_8822C BIT(24) -+#define BIT_RTL_ID_8822C BIT(23) -+#define BIT_PAD_HWPD_IDN_8822C BIT(22) -+#define BIT_TESTMODE_8822C BIT(20) -+ -+#define BIT_SHIFT_VENDOR_ID_8822C 16 -+#define BIT_MASK_VENDOR_ID_8822C 0xf -+#define BIT_VENDOR_ID_8822C(x) \ -+ (((x) & BIT_MASK_VENDOR_ID_8822C) << BIT_SHIFT_VENDOR_ID_8822C) -+#define BITS_VENDOR_ID_8822C \ -+ (BIT_MASK_VENDOR_ID_8822C << BIT_SHIFT_VENDOR_ID_8822C) -+#define BIT_CLEAR_VENDOR_ID_8822C(x) ((x) & (~BITS_VENDOR_ID_8822C)) -+#define BIT_GET_VENDOR_ID_8822C(x) \ -+ (((x) >> BIT_SHIFT_VENDOR_ID_8822C) & BIT_MASK_VENDOR_ID_8822C) -+#define BIT_SET_VENDOR_ID_8822C(x, v) \ -+ (BIT_CLEAR_VENDOR_ID_8822C(x) | BIT_VENDOR_ID_8822C(v)) -+ -+#define BIT_SHIFT_CHIP_VER_8822C 12 -+#define BIT_MASK_CHIP_VER_8822C 0xf -+#define BIT_CHIP_VER_8822C(x) \ -+ (((x) & BIT_MASK_CHIP_VER_8822C) << BIT_SHIFT_CHIP_VER_8822C) -+#define BITS_CHIP_VER_8822C \ -+ (BIT_MASK_CHIP_VER_8822C << BIT_SHIFT_CHIP_VER_8822C) -+#define BIT_CLEAR_CHIP_VER_8822C(x) ((x) & (~BITS_CHIP_VER_8822C)) -+#define BIT_GET_CHIP_VER_8822C(x) \ -+ (((x) >> BIT_SHIFT_CHIP_VER_8822C) & BIT_MASK_CHIP_VER_8822C) -+#define BIT_SET_CHIP_VER_8822C(x, v) \ -+ (BIT_CLEAR_CHIP_VER_8822C(x) | BIT_CHIP_VER_8822C(v)) -+ -+#define BIT_BD_MAC3_8822C BIT(11) -+#define BIT_BD_MAC1_8822C BIT(10) -+#define BIT_BD_MAC2_8822C BIT(9) -+#define BIT_SIC_IDLE_8822C BIT(8) -+#define BIT_SW_OFFLOAD_EN_8822C BIT(7) -+#define BIT_OCP_SHUTDN_8822C BIT(6) -+#define BIT_V15_VLD_8822C BIT(5) -+#define BIT_PCIRSTB_8822C BIT(4) -+#define BIT_PCLK_VLD_8822C BIT(3) -+#define BIT_UCLK_VLD_8822C BIT(2) -+#define BIT_ACLK_VLD_8822C BIT(1) -+#define BIT_XCLK_VLD_8822C BIT(0) -+ -+/* 2 REG_SYS_STATUS1_8822C */ -+ -+#define BIT_SHIFT_RF_RL_ID_8822C 28 -+#define BIT_MASK_RF_RL_ID_8822C 0xf -+#define BIT_RF_RL_ID_8822C(x) \ -+ (((x) & BIT_MASK_RF_RL_ID_8822C) << BIT_SHIFT_RF_RL_ID_8822C) -+#define BITS_RF_RL_ID_8822C \ -+ (BIT_MASK_RF_RL_ID_8822C << BIT_SHIFT_RF_RL_ID_8822C) -+#define BIT_CLEAR_RF_RL_ID_8822C(x) ((x) & (~BITS_RF_RL_ID_8822C)) -+#define BIT_GET_RF_RL_ID_8822C(x) \ -+ (((x) >> BIT_SHIFT_RF_RL_ID_8822C) & BIT_MASK_RF_RL_ID_8822C) -+#define BIT_SET_RF_RL_ID_8822C(x, v) \ -+ (BIT_CLEAR_RF_RL_ID_8822C(x) | BIT_RF_RL_ID_8822C(v)) -+ -+#define BIT_HPHY_ICFG_8822C BIT(19) -+ -+#define BIT_SHIFT_SEL_0XC0_8822C 16 -+#define BIT_MASK_SEL_0XC0_8822C 0x3 -+#define BIT_SEL_0XC0_8822C(x) \ -+ (((x) & BIT_MASK_SEL_0XC0_8822C) << BIT_SHIFT_SEL_0XC0_8822C) -+#define BITS_SEL_0XC0_8822C \ -+ (BIT_MASK_SEL_0XC0_8822C << BIT_SHIFT_SEL_0XC0_8822C) -+#define BIT_CLEAR_SEL_0XC0_8822C(x) ((x) & (~BITS_SEL_0XC0_8822C)) -+#define BIT_GET_SEL_0XC0_8822C(x) \ -+ (((x) >> BIT_SHIFT_SEL_0XC0_8822C) & BIT_MASK_SEL_0XC0_8822C) -+#define BIT_SET_SEL_0XC0_8822C(x, v) \ -+ (BIT_CLEAR_SEL_0XC0_8822C(x) | BIT_SEL_0XC0_8822C(v)) -+ -+#define BIT_SHIFT_HCI_SEL_V4_8822C 12 -+#define BIT_MASK_HCI_SEL_V4_8822C 0x3 -+#define BIT_HCI_SEL_V4_8822C(x) \ -+ (((x) & BIT_MASK_HCI_SEL_V4_8822C) << BIT_SHIFT_HCI_SEL_V4_8822C) -+#define BITS_HCI_SEL_V4_8822C \ -+ (BIT_MASK_HCI_SEL_V4_8822C << BIT_SHIFT_HCI_SEL_V4_8822C) -+#define BIT_CLEAR_HCI_SEL_V4_8822C(x) ((x) & (~BITS_HCI_SEL_V4_8822C)) -+#define BIT_GET_HCI_SEL_V4_8822C(x) \ -+ (((x) >> BIT_SHIFT_HCI_SEL_V4_8822C) & BIT_MASK_HCI_SEL_V4_8822C) -+#define BIT_SET_HCI_SEL_V4_8822C(x, v) \ -+ (BIT_CLEAR_HCI_SEL_V4_8822C(x) | BIT_HCI_SEL_V4_8822C(v)) -+ -+#define BIT_USB_OPERATION_MODE_8822C BIT(10) -+#define BIT_BT_PDN_8822C BIT(9) -+#define BIT_AUTO_WLPON_8822C BIT(8) -+#define BIT_WL_MODE_8822C BIT(7) -+#define BIT_PKG_SEL_HCI_8822C BIT(6) -+ -+#define BIT_SHIFT_PAD_HCI_SEL_V2_8822C 3 -+#define BIT_MASK_PAD_HCI_SEL_V2_8822C 0x3 -+#define BIT_PAD_HCI_SEL_V2_8822C(x) \ -+ (((x) & BIT_MASK_PAD_HCI_SEL_V2_8822C) \ -+ << BIT_SHIFT_PAD_HCI_SEL_V2_8822C) -+#define BITS_PAD_HCI_SEL_V2_8822C \ -+ (BIT_MASK_PAD_HCI_SEL_V2_8822C << BIT_SHIFT_PAD_HCI_SEL_V2_8822C) -+#define BIT_CLEAR_PAD_HCI_SEL_V2_8822C(x) ((x) & (~BITS_PAD_HCI_SEL_V2_8822C)) -+#define BIT_GET_PAD_HCI_SEL_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_PAD_HCI_SEL_V2_8822C) & \ -+ BIT_MASK_PAD_HCI_SEL_V2_8822C) -+#define BIT_SET_PAD_HCI_SEL_V2_8822C(x, v) \ -+ (BIT_CLEAR_PAD_HCI_SEL_V2_8822C(x) | BIT_PAD_HCI_SEL_V2_8822C(v)) -+ -+#define BIT_SHIFT_EFS_HCI_SEL_V1_8822C 0 -+#define BIT_MASK_EFS_HCI_SEL_V1_8822C 0x7 -+#define BIT_EFS_HCI_SEL_V1_8822C(x) \ -+ (((x) & BIT_MASK_EFS_HCI_SEL_V1_8822C) \ -+ << BIT_SHIFT_EFS_HCI_SEL_V1_8822C) -+#define BITS_EFS_HCI_SEL_V1_8822C \ -+ (BIT_MASK_EFS_HCI_SEL_V1_8822C << BIT_SHIFT_EFS_HCI_SEL_V1_8822C) -+#define BIT_CLEAR_EFS_HCI_SEL_V1_8822C(x) ((x) & (~BITS_EFS_HCI_SEL_V1_8822C)) -+#define BIT_GET_EFS_HCI_SEL_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_EFS_HCI_SEL_V1_8822C) & \ -+ BIT_MASK_EFS_HCI_SEL_V1_8822C) -+#define BIT_SET_EFS_HCI_SEL_V1_8822C(x, v) \ -+ (BIT_CLEAR_EFS_HCI_SEL_V1_8822C(x) | BIT_EFS_HCI_SEL_V1_8822C(v)) -+ -+/* 2 REG_SYS_STATUS2_8822C */ -+#define BIT_HIOE_ON_TIMEOUT_8822C BIT(23) -+#define BIT_SIC_ON_TIMEOUT_8822C BIT(22) -+#define BIT_CPU_ON_TIMEOUT_8822C BIT(21) -+#define BIT_HCI_ON_TIMEOUT_8822C BIT(20) -+#define BIT_SIO_ALDN_8822C BIT(19) -+#define BIT_USB_ALDN_8822C BIT(18) -+#define BIT_PCI_ALDN_8822C BIT(17) -+#define BIT_SYS_ALDN_8822C BIT(16) -+ -+#define BIT_SHIFT_EPVID1_8822C 8 -+#define BIT_MASK_EPVID1_8822C 0xff -+#define BIT_EPVID1_8822C(x) \ -+ (((x) & BIT_MASK_EPVID1_8822C) << BIT_SHIFT_EPVID1_8822C) -+#define BITS_EPVID1_8822C (BIT_MASK_EPVID1_8822C << BIT_SHIFT_EPVID1_8822C) -+#define BIT_CLEAR_EPVID1_8822C(x) ((x) & (~BITS_EPVID1_8822C)) -+#define BIT_GET_EPVID1_8822C(x) \ -+ (((x) >> BIT_SHIFT_EPVID1_8822C) & BIT_MASK_EPVID1_8822C) -+#define BIT_SET_EPVID1_8822C(x, v) \ -+ (BIT_CLEAR_EPVID1_8822C(x) | BIT_EPVID1_8822C(v)) -+ -+#define BIT_SHIFT_EPVID0_8822C 0 -+#define BIT_MASK_EPVID0_8822C 0xff -+#define BIT_EPVID0_8822C(x) \ -+ (((x) & BIT_MASK_EPVID0_8822C) << BIT_SHIFT_EPVID0_8822C) -+#define BITS_EPVID0_8822C (BIT_MASK_EPVID0_8822C << BIT_SHIFT_EPVID0_8822C) -+#define BIT_CLEAR_EPVID0_8822C(x) ((x) & (~BITS_EPVID0_8822C)) -+#define BIT_GET_EPVID0_8822C(x) \ -+ (((x) >> BIT_SHIFT_EPVID0_8822C) & BIT_MASK_EPVID0_8822C) -+#define BIT_SET_EPVID0_8822C(x, v) \ -+ (BIT_CLEAR_EPVID0_8822C(x) | BIT_EPVID0_8822C(v)) -+ -+/* 2 REG_SYS_CFG2_8822C */ -+#define BIT_HCI_SEL_EMBEDDED_8822C BIT(8) -+ -+#define BIT_SHIFT_HW_ID_8822C 0 -+#define BIT_MASK_HW_ID_8822C 0xff -+#define BIT_HW_ID_8822C(x) \ -+ (((x) & BIT_MASK_HW_ID_8822C) << BIT_SHIFT_HW_ID_8822C) -+#define BITS_HW_ID_8822C (BIT_MASK_HW_ID_8822C << BIT_SHIFT_HW_ID_8822C) -+#define BIT_CLEAR_HW_ID_8822C(x) ((x) & (~BITS_HW_ID_8822C)) -+#define BIT_GET_HW_ID_8822C(x) \ -+ (((x) >> BIT_SHIFT_HW_ID_8822C) & BIT_MASK_HW_ID_8822C) -+#define BIT_SET_HW_ID_8822C(x, v) \ -+ (BIT_CLEAR_HW_ID_8822C(x) | BIT_HW_ID_8822C(v)) -+ -+/* 2 REG_SYS_CFG3_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_ANAPARSW_MAC_0_8822C */ -+#define BIT_OCP_L_8822C BIT(31) -+#define BIT_POWOCP_L_8822C BIT(30) -+ -+#define BIT_SHIFT_CF_L_V2_8822C 28 -+#define BIT_MASK_CF_L_V2_8822C 0x3 -+#define BIT_CF_L_V2_8822C(x) \ -+ (((x) & BIT_MASK_CF_L_V2_8822C) << BIT_SHIFT_CF_L_V2_8822C) -+#define BITS_CF_L_V2_8822C (BIT_MASK_CF_L_V2_8822C << BIT_SHIFT_CF_L_V2_8822C) -+#define BIT_CLEAR_CF_L_V2_8822C(x) ((x) & (~BITS_CF_L_V2_8822C)) -+#define BIT_GET_CF_L_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_CF_L_V2_8822C) & BIT_MASK_CF_L_V2_8822C) -+#define BIT_SET_CF_L_V2_8822C(x, v) \ -+ (BIT_CLEAR_CF_L_V2_8822C(x) | BIT_CF_L_V2_8822C(v)) -+ -+#define BIT_SHIFT_CFC_L_V2_8822C 26 -+#define BIT_MASK_CFC_L_V2_8822C 0x3 -+#define BIT_CFC_L_V2_8822C(x) \ -+ (((x) & BIT_MASK_CFC_L_V2_8822C) << BIT_SHIFT_CFC_L_V2_8822C) -+#define BITS_CFC_L_V2_8822C \ -+ (BIT_MASK_CFC_L_V2_8822C << BIT_SHIFT_CFC_L_V2_8822C) -+#define BIT_CLEAR_CFC_L_V2_8822C(x) ((x) & (~BITS_CFC_L_V2_8822C)) -+#define BIT_GET_CFC_L_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_CFC_L_V2_8822C) & BIT_MASK_CFC_L_V2_8822C) -+#define BIT_SET_CFC_L_V2_8822C(x, v) \ -+ (BIT_CLEAR_CFC_L_V2_8822C(x) | BIT_CFC_L_V2_8822C(v)) -+ -+#define BIT_SHIFT_R3_L_V2_8822C 24 -+#define BIT_MASK_R3_L_V2_8822C 0x3 -+#define BIT_R3_L_V2_8822C(x) \ -+ (((x) & BIT_MASK_R3_L_V2_8822C) << BIT_SHIFT_R3_L_V2_8822C) -+#define BITS_R3_L_V2_8822C (BIT_MASK_R3_L_V2_8822C << BIT_SHIFT_R3_L_V2_8822C) -+#define BIT_CLEAR_R3_L_V2_8822C(x) ((x) & (~BITS_R3_L_V2_8822C)) -+#define BIT_GET_R3_L_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_R3_L_V2_8822C) & BIT_MASK_R3_L_V2_8822C) -+#define BIT_SET_R3_L_V2_8822C(x, v) \ -+ (BIT_CLEAR_R3_L_V2_8822C(x) | BIT_R3_L_V2_8822C(v)) -+ -+#define BIT_SHIFT_R2_L_8822C 22 -+#define BIT_MASK_R2_L_8822C 0x3 -+#define BIT_R2_L_8822C(x) (((x) & BIT_MASK_R2_L_8822C) << BIT_SHIFT_R2_L_8822C) -+#define BITS_R2_L_8822C (BIT_MASK_R2_L_8822C << BIT_SHIFT_R2_L_8822C) -+#define BIT_CLEAR_R2_L_8822C(x) ((x) & (~BITS_R2_L_8822C)) -+#define BIT_GET_R2_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_R2_L_8822C) & BIT_MASK_R2_L_8822C) -+#define BIT_SET_R2_L_8822C(x, v) (BIT_CLEAR_R2_L_8822C(x) | BIT_R2_L_8822C(v)) -+ -+#define BIT_SHIFT_R1_L_8822C 20 -+#define BIT_MASK_R1_L_8822C 0x3 -+#define BIT_R1_L_8822C(x) (((x) & BIT_MASK_R1_L_8822C) << BIT_SHIFT_R1_L_8822C) -+#define BITS_R1_L_8822C (BIT_MASK_R1_L_8822C << BIT_SHIFT_R1_L_8822C) -+#define BIT_CLEAR_R1_L_8822C(x) ((x) & (~BITS_R1_L_8822C)) -+#define BIT_GET_R1_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_R1_L_8822C) & BIT_MASK_R1_L_8822C) -+#define BIT_SET_R1_L_8822C(x, v) (BIT_CLEAR_R1_L_8822C(x) | BIT_R1_L_8822C(v)) -+ -+#define BIT_SHIFT_C3_L_8822C 18 -+#define BIT_MASK_C3_L_8822C 0x3 -+#define BIT_C3_L_8822C(x) (((x) & BIT_MASK_C3_L_8822C) << BIT_SHIFT_C3_L_8822C) -+#define BITS_C3_L_8822C (BIT_MASK_C3_L_8822C << BIT_SHIFT_C3_L_8822C) -+#define BIT_CLEAR_C3_L_8822C(x) ((x) & (~BITS_C3_L_8822C)) -+#define BIT_GET_C3_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_C3_L_8822C) & BIT_MASK_C3_L_8822C) -+#define BIT_SET_C3_L_8822C(x, v) (BIT_CLEAR_C3_L_8822C(x) | BIT_C3_L_8822C(v)) -+ -+#define BIT_SHIFT_C2_L_8822C 16 -+#define BIT_MASK_C2_L_8822C 0x3 -+#define BIT_C2_L_8822C(x) (((x) & BIT_MASK_C2_L_8822C) << BIT_SHIFT_C2_L_8822C) -+#define BITS_C2_L_8822C (BIT_MASK_C2_L_8822C << BIT_SHIFT_C2_L_8822C) -+#define BIT_CLEAR_C2_L_8822C(x) ((x) & (~BITS_C2_L_8822C)) -+#define BIT_GET_C2_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_C2_L_8822C) & BIT_MASK_C2_L_8822C) -+#define BIT_SET_C2_L_8822C(x, v) (BIT_CLEAR_C2_L_8822C(x) | BIT_C2_L_8822C(v)) -+ -+#define BIT_SHIFT_C1_L_V2_8822C 14 -+#define BIT_MASK_C1_L_V2_8822C 0x3 -+#define BIT_C1_L_V2_8822C(x) \ -+ (((x) & BIT_MASK_C1_L_V2_8822C) << BIT_SHIFT_C1_L_V2_8822C) -+#define BITS_C1_L_V2_8822C (BIT_MASK_C1_L_V2_8822C << BIT_SHIFT_C1_L_V2_8822C) -+#define BIT_CLEAR_C1_L_V2_8822C(x) ((x) & (~BITS_C1_L_V2_8822C)) -+#define BIT_GET_C1_L_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_C1_L_V2_8822C) & BIT_MASK_C1_L_V2_8822C) -+#define BIT_SET_C1_L_V2_8822C(x, v) \ -+ (BIT_CLEAR_C1_L_V2_8822C(x) | BIT_C1_L_V2_8822C(v)) -+ -+#define BIT_REG_OCPS_L_V2_8822C BIT(13) -+#define BIT_REG_PWM_L_8822C BIT(12) -+ -+#define BIT_SHIFT_V15ADJ_L_8822C 9 -+#define BIT_MASK_V15ADJ_L_8822C 0x7 -+#define BIT_V15ADJ_L_8822C(x) \ -+ (((x) & BIT_MASK_V15ADJ_L_8822C) << BIT_SHIFT_V15ADJ_L_8822C) -+#define BITS_V15ADJ_L_8822C \ -+ (BIT_MASK_V15ADJ_L_8822C << BIT_SHIFT_V15ADJ_L_8822C) -+#define BIT_CLEAR_V15ADJ_L_8822C(x) ((x) & (~BITS_V15ADJ_L_8822C)) -+#define BIT_GET_V15ADJ_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_V15ADJ_L_8822C) & BIT_MASK_V15ADJ_L_8822C) -+#define BIT_SET_V15ADJ_L_8822C(x, v) \ -+ (BIT_CLEAR_V15ADJ_L_8822C(x) | BIT_V15ADJ_L_8822C(v)) -+ -+#define BIT_SHIFT_IN_L_8822C 6 -+#define BIT_MASK_IN_L_8822C 0x7 -+#define BIT_IN_L_8822C(x) (((x) & BIT_MASK_IN_L_8822C) << BIT_SHIFT_IN_L_8822C) -+#define BITS_IN_L_8822C (BIT_MASK_IN_L_8822C << BIT_SHIFT_IN_L_8822C) -+#define BIT_CLEAR_IN_L_8822C(x) ((x) & (~BITS_IN_L_8822C)) -+#define BIT_GET_IN_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_IN_L_8822C) & BIT_MASK_IN_L_8822C) -+#define BIT_SET_IN_L_8822C(x, v) (BIT_CLEAR_IN_L_8822C(x) | BIT_IN_L_8822C(v)) -+ -+#define BIT_SHIFT_STD_L_8822C 4 -+#define BIT_MASK_STD_L_8822C 0x3 -+#define BIT_STD_L_8822C(x) \ -+ (((x) & BIT_MASK_STD_L_8822C) << BIT_SHIFT_STD_L_8822C) -+#define BITS_STD_L_8822C (BIT_MASK_STD_L_8822C << BIT_SHIFT_STD_L_8822C) -+#define BIT_CLEAR_STD_L_8822C(x) ((x) & (~BITS_STD_L_8822C)) -+#define BIT_GET_STD_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_STD_L_8822C) & BIT_MASK_STD_L_8822C) -+#define BIT_SET_STD_L_8822C(x, v) \ -+ (BIT_CLEAR_STD_L_8822C(x) | BIT_STD_L_8822C(v)) -+ -+#define BIT_SHIFT_VOL_L_8822C 0 -+#define BIT_MASK_VOL_L_8822C 0xf -+#define BIT_VOL_L_8822C(x) \ -+ (((x) & BIT_MASK_VOL_L_8822C) << BIT_SHIFT_VOL_L_8822C) -+#define BITS_VOL_L_8822C (BIT_MASK_VOL_L_8822C << BIT_SHIFT_VOL_L_8822C) -+#define BIT_CLEAR_VOL_L_8822C(x) ((x) & (~BITS_VOL_L_8822C)) -+#define BIT_GET_VOL_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_VOL_L_8822C) & BIT_MASK_VOL_L_8822C) -+#define BIT_SET_VOL_L_8822C(x, v) \ -+ (BIT_CLEAR_VOL_L_8822C(x) | BIT_VOL_L_8822C(v)) -+ -+/* 2 REG_ANAPARSW_MAC_1_8822C */ -+ -+#define BIT_SHIFT_OCP_L_PFM_8822C 29 -+#define BIT_MASK_OCP_L_PFM_8822C 0x7 -+#define BIT_OCP_L_PFM_8822C(x) \ -+ (((x) & BIT_MASK_OCP_L_PFM_8822C) << BIT_SHIFT_OCP_L_PFM_8822C) -+#define BITS_OCP_L_PFM_8822C \ -+ (BIT_MASK_OCP_L_PFM_8822C << BIT_SHIFT_OCP_L_PFM_8822C) -+#define BIT_CLEAR_OCP_L_PFM_8822C(x) ((x) & (~BITS_OCP_L_PFM_8822C)) -+#define BIT_GET_OCP_L_PFM_8822C(x) \ -+ (((x) >> BIT_SHIFT_OCP_L_PFM_8822C) & BIT_MASK_OCP_L_PFM_8822C) -+#define BIT_SET_OCP_L_PFM_8822C(x, v) \ -+ (BIT_CLEAR_OCP_L_PFM_8822C(x) | BIT_OCP_L_PFM_8822C(v)) -+ -+#define BIT_SHIFT_CFC_L_PFM_8822C 27 -+#define BIT_MASK_CFC_L_PFM_8822C 0x3 -+#define BIT_CFC_L_PFM_8822C(x) \ -+ (((x) & BIT_MASK_CFC_L_PFM_8822C) << BIT_SHIFT_CFC_L_PFM_8822C) -+#define BITS_CFC_L_PFM_8822C \ -+ (BIT_MASK_CFC_L_PFM_8822C << BIT_SHIFT_CFC_L_PFM_8822C) -+#define BIT_CLEAR_CFC_L_PFM_8822C(x) ((x) & (~BITS_CFC_L_PFM_8822C)) -+#define BIT_GET_CFC_L_PFM_8822C(x) \ -+ (((x) >> BIT_SHIFT_CFC_L_PFM_8822C) & BIT_MASK_CFC_L_PFM_8822C) -+#define BIT_SET_CFC_L_PFM_8822C(x, v) \ -+ (BIT_CLEAR_CFC_L_PFM_8822C(x) | BIT_CFC_L_PFM_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_REG_FREQ_L_V1_8822C 20 -+#define BIT_MASK_REG_FREQ_L_V1_8822C 0x7 -+#define BIT_REG_FREQ_L_V1_8822C(x) \ -+ (((x) & BIT_MASK_REG_FREQ_L_V1_8822C) << BIT_SHIFT_REG_FREQ_L_V1_8822C) -+#define BITS_REG_FREQ_L_V1_8822C \ -+ (BIT_MASK_REG_FREQ_L_V1_8822C << BIT_SHIFT_REG_FREQ_L_V1_8822C) -+#define BIT_CLEAR_REG_FREQ_L_V1_8822C(x) ((x) & (~BITS_REG_FREQ_L_V1_8822C)) -+#define BIT_GET_REG_FREQ_L_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_FREQ_L_V1_8822C) & BIT_MASK_REG_FREQ_L_V1_8822C) -+#define BIT_SET_REG_FREQ_L_V1_8822C(x, v) \ -+ (BIT_CLEAR_REG_FREQ_L_V1_8822C(x) | BIT_REG_FREQ_L_V1_8822C(v)) -+ -+#define BIT_EN_DUTY_8822C BIT(19) -+ -+#define BIT_SHIFT_REG_MODE_V2_8822C 17 -+#define BIT_MASK_REG_MODE_V2_8822C 0x3 -+#define BIT_REG_MODE_V2_8822C(x) \ -+ (((x) & BIT_MASK_REG_MODE_V2_8822C) << BIT_SHIFT_REG_MODE_V2_8822C) -+#define BITS_REG_MODE_V2_8822C \ -+ (BIT_MASK_REG_MODE_V2_8822C << BIT_SHIFT_REG_MODE_V2_8822C) -+#define BIT_CLEAR_REG_MODE_V2_8822C(x) ((x) & (~BITS_REG_MODE_V2_8822C)) -+#define BIT_GET_REG_MODE_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_MODE_V2_8822C) & BIT_MASK_REG_MODE_V2_8822C) -+#define BIT_SET_REG_MODE_V2_8822C(x, v) \ -+ (BIT_CLEAR_REG_MODE_V2_8822C(x) | BIT_REG_MODE_V2_8822C(v)) -+ -+#define BIT_EN_SP_8822C BIT(16) -+#define BIT_REG_AUTO_L_V2_8822C BIT(15) -+#define BIT_REG_LDOF_L_V2_8822C BIT(14) -+#define BIT_REG_TYPE_L_V2_8822C BIT(13) -+#define BIT_VO15_V1P05_H_8822C BIT(12) -+#define BIT_ARENB_L_V2_8822C BIT(11) -+ -+#define BIT_SHIFT_TBOX_L1_V2_8822C 9 -+#define BIT_MASK_TBOX_L1_V2_8822C 0x3 -+#define BIT_TBOX_L1_V2_8822C(x) \ -+ (((x) & BIT_MASK_TBOX_L1_V2_8822C) << BIT_SHIFT_TBOX_L1_V2_8822C) -+#define BITS_TBOX_L1_V2_8822C \ -+ (BIT_MASK_TBOX_L1_V2_8822C << BIT_SHIFT_TBOX_L1_V2_8822C) -+#define BIT_CLEAR_TBOX_L1_V2_8822C(x) ((x) & (~BITS_TBOX_L1_V2_8822C)) -+#define BIT_GET_TBOX_L1_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TBOX_L1_V2_8822C) & BIT_MASK_TBOX_L1_V2_8822C) -+#define BIT_SET_TBOX_L1_V2_8822C(x, v) \ -+ (BIT_CLEAR_TBOX_L1_V2_8822C(x) | BIT_TBOX_L1_V2_8822C(v)) -+ -+#define BIT_SHIFT_REG_DELAY_L_8822C 7 -+#define BIT_MASK_REG_DELAY_L_8822C 0x3 -+#define BIT_REG_DELAY_L_8822C(x) \ -+ (((x) & BIT_MASK_REG_DELAY_L_8822C) << BIT_SHIFT_REG_DELAY_L_8822C) -+#define BITS_REG_DELAY_L_8822C \ -+ (BIT_MASK_REG_DELAY_L_8822C << BIT_SHIFT_REG_DELAY_L_8822C) -+#define BIT_CLEAR_REG_DELAY_L_8822C(x) ((x) & (~BITS_REG_DELAY_L_8822C)) -+#define BIT_GET_REG_DELAY_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_DELAY_L_8822C) & BIT_MASK_REG_DELAY_L_8822C) -+#define BIT_SET_REG_DELAY_L_8822C(x, v) \ -+ (BIT_CLEAR_REG_DELAY_L_8822C(x) | BIT_REG_DELAY_L_8822C(v)) -+ -+#define BIT_REG_CLAMP_D_L_8822C BIT(6) -+#define BIT_REG_BYPASS_L_V2_8822C BIT(5) -+#define BIT_REG_AUTOZCD_L_8822C BIT(4) -+#define BIT_POW_ZCD_L_V2_8822C BIT(3) -+#define BIT_REG_HALF_L_8822C BIT(2) -+ -+#define BIT_SHIFT_OCP_L_V2_8822C 0 -+#define BIT_MASK_OCP_L_V2_8822C 0x3 -+#define BIT_OCP_L_V2_8822C(x) \ -+ (((x) & BIT_MASK_OCP_L_V2_8822C) << BIT_SHIFT_OCP_L_V2_8822C) -+#define BITS_OCP_L_V2_8822C \ -+ (BIT_MASK_OCP_L_V2_8822C << BIT_SHIFT_OCP_L_V2_8822C) -+#define BIT_CLEAR_OCP_L_V2_8822C(x) ((x) & (~BITS_OCP_L_V2_8822C)) -+#define BIT_GET_OCP_L_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_OCP_L_V2_8822C) & BIT_MASK_OCP_L_V2_8822C) -+#define BIT_SET_OCP_L_V2_8822C(x, v) \ -+ (BIT_CLEAR_OCP_L_V2_8822C(x) | BIT_OCP_L_V2_8822C(v)) -+ -+/* 2 REG_ANAPAR_MAC_0_8822C */ -+ -+#define BIT_SHIFT_REG_LPF_R3_8822C 29 -+#define BIT_MASK_REG_LPF_R3_8822C 0x7 -+#define BIT_REG_LPF_R3_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_R3_8822C) << BIT_SHIFT_REG_LPF_R3_8822C) -+#define BITS_REG_LPF_R3_8822C \ -+ (BIT_MASK_REG_LPF_R3_8822C << BIT_SHIFT_REG_LPF_R3_8822C) -+#define BIT_CLEAR_REG_LPF_R3_8822C(x) ((x) & (~BITS_REG_LPF_R3_8822C)) -+#define BIT_GET_REG_LPF_R3_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R3_8822C) & BIT_MASK_REG_LPF_R3_8822C) -+#define BIT_SET_REG_LPF_R3_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_R3_8822C(x) | BIT_REG_LPF_R3_8822C(v)) -+ -+#define BIT_SHIFT_REG_LPF_R2_8822C 24 -+#define BIT_MASK_REG_LPF_R2_8822C 0x1f -+#define BIT_REG_LPF_R2_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_R2_8822C) << BIT_SHIFT_REG_LPF_R2_8822C) -+#define BITS_REG_LPF_R2_8822C \ -+ (BIT_MASK_REG_LPF_R2_8822C << BIT_SHIFT_REG_LPF_R2_8822C) -+#define BIT_CLEAR_REG_LPF_R2_8822C(x) ((x) & (~BITS_REG_LPF_R2_8822C)) -+#define BIT_GET_REG_LPF_R2_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R2_8822C) & BIT_MASK_REG_LPF_R2_8822C) -+#define BIT_SET_REG_LPF_R2_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_R2_8822C(x) | BIT_REG_LPF_R2_8822C(v)) -+ -+#define BIT_SHIFT_REG_LPF_C3_8822C 21 -+#define BIT_MASK_REG_LPF_C3_8822C 0x7 -+#define BIT_REG_LPF_C3_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_C3_8822C) << BIT_SHIFT_REG_LPF_C3_8822C) -+#define BITS_REG_LPF_C3_8822C \ -+ (BIT_MASK_REG_LPF_C3_8822C << BIT_SHIFT_REG_LPF_C3_8822C) -+#define BIT_CLEAR_REG_LPF_C3_8822C(x) ((x) & (~BITS_REG_LPF_C3_8822C)) -+#define BIT_GET_REG_LPF_C3_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C3_8822C) & BIT_MASK_REG_LPF_C3_8822C) -+#define BIT_SET_REG_LPF_C3_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_C3_8822C(x) | BIT_REG_LPF_C3_8822C(v)) -+ -+#define BIT_SHIFT_REG_LPF_C2_8822C 18 -+#define BIT_MASK_REG_LPF_C2_8822C 0x7 -+#define BIT_REG_LPF_C2_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_C2_8822C) << BIT_SHIFT_REG_LPF_C2_8822C) -+#define BITS_REG_LPF_C2_8822C \ -+ (BIT_MASK_REG_LPF_C2_8822C << BIT_SHIFT_REG_LPF_C2_8822C) -+#define BIT_CLEAR_REG_LPF_C2_8822C(x) ((x) & (~BITS_REG_LPF_C2_8822C)) -+#define BIT_GET_REG_LPF_C2_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C2_8822C) & BIT_MASK_REG_LPF_C2_8822C) -+#define BIT_SET_REG_LPF_C2_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_C2_8822C(x) | BIT_REG_LPF_C2_8822C(v)) -+ -+#define BIT_SHIFT_REG_LPF_C1_8822C 15 -+#define BIT_MASK_REG_LPF_C1_8822C 0x7 -+#define BIT_REG_LPF_C1_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_C1_8822C) << BIT_SHIFT_REG_LPF_C1_8822C) -+#define BITS_REG_LPF_C1_8822C \ -+ (BIT_MASK_REG_LPF_C1_8822C << BIT_SHIFT_REG_LPF_C1_8822C) -+#define BIT_CLEAR_REG_LPF_C1_8822C(x) ((x) & (~BITS_REG_LPF_C1_8822C)) -+#define BIT_GET_REG_LPF_C1_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C1_8822C) & BIT_MASK_REG_LPF_C1_8822C) -+#define BIT_SET_REG_LPF_C1_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_C1_8822C(x) | BIT_REG_LPF_C1_8822C(v)) -+ -+#define BIT_SHIFT_REG_LDO_SEL_V1_8822C 13 -+#define BIT_MASK_REG_LDO_SEL_V1_8822C 0x3 -+#define BIT_REG_LDO_SEL_V1_8822C(x) \ -+ (((x) & BIT_MASK_REG_LDO_SEL_V1_8822C) \ -+ << BIT_SHIFT_REG_LDO_SEL_V1_8822C) -+#define BITS_REG_LDO_SEL_V1_8822C \ -+ (BIT_MASK_REG_LDO_SEL_V1_8822C << BIT_SHIFT_REG_LDO_SEL_V1_8822C) -+#define BIT_CLEAR_REG_LDO_SEL_V1_8822C(x) ((x) & (~BITS_REG_LDO_SEL_V1_8822C)) -+#define BIT_GET_REG_LDO_SEL_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LDO_SEL_V1_8822C) & \ -+ BIT_MASK_REG_LDO_SEL_V1_8822C) -+#define BIT_SET_REG_LDO_SEL_V1_8822C(x, v) \ -+ (BIT_CLEAR_REG_LDO_SEL_V1_8822C(x) | BIT_REG_LDO_SEL_V1_8822C(v)) -+ -+#define BIT_REG_CP_ICPX2_8822C BIT(12) -+ -+#define BIT_SHIFT_REG_CP_ICP_SEL_FAST_8822C 9 -+#define BIT_MASK_REG_CP_ICP_SEL_FAST_8822C 0x7 -+#define BIT_REG_CP_ICP_SEL_FAST_8822C(x) \ -+ (((x) & BIT_MASK_REG_CP_ICP_SEL_FAST_8822C) \ -+ << BIT_SHIFT_REG_CP_ICP_SEL_FAST_8822C) -+#define BITS_REG_CP_ICP_SEL_FAST_8822C \ -+ (BIT_MASK_REG_CP_ICP_SEL_FAST_8822C \ -+ << BIT_SHIFT_REG_CP_ICP_SEL_FAST_8822C) -+#define BIT_CLEAR_REG_CP_ICP_SEL_FAST_8822C(x) \ -+ ((x) & (~BITS_REG_CP_ICP_SEL_FAST_8822C)) -+#define BIT_GET_REG_CP_ICP_SEL_FAST_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_ICP_SEL_FAST_8822C) & \ -+ BIT_MASK_REG_CP_ICP_SEL_FAST_8822C) -+#define BIT_SET_REG_CP_ICP_SEL_FAST_8822C(x, v) \ -+ (BIT_CLEAR_REG_CP_ICP_SEL_FAST_8822C(x) | \ -+ BIT_REG_CP_ICP_SEL_FAST_8822C(v)) -+ -+#define BIT_SHIFT_REG_CP_ICP_SEL_8822C 6 -+#define BIT_MASK_REG_CP_ICP_SEL_8822C 0x7 -+#define BIT_REG_CP_ICP_SEL_8822C(x) \ -+ (((x) & BIT_MASK_REG_CP_ICP_SEL_8822C) \ -+ << BIT_SHIFT_REG_CP_ICP_SEL_8822C) -+#define BITS_REG_CP_ICP_SEL_8822C \ -+ (BIT_MASK_REG_CP_ICP_SEL_8822C << BIT_SHIFT_REG_CP_ICP_SEL_8822C) -+#define BIT_CLEAR_REG_CP_ICP_SEL_8822C(x) ((x) & (~BITS_REG_CP_ICP_SEL_8822C)) -+#define BIT_GET_REG_CP_ICP_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_CP_ICP_SEL_8822C) & \ -+ BIT_MASK_REG_CP_ICP_SEL_8822C) -+#define BIT_SET_REG_CP_ICP_SEL_8822C(x, v) \ -+ (BIT_CLEAR_REG_CP_ICP_SEL_8822C(x) | BIT_REG_CP_ICP_SEL_8822C(v)) -+ -+#define BIT_SHIFT_REG_IB_PI_8822C 4 -+#define BIT_MASK_REG_IB_PI_8822C 0x3 -+#define BIT_REG_IB_PI_8822C(x) \ -+ (((x) & BIT_MASK_REG_IB_PI_8822C) << BIT_SHIFT_REG_IB_PI_8822C) -+#define BITS_REG_IB_PI_8822C \ -+ (BIT_MASK_REG_IB_PI_8822C << BIT_SHIFT_REG_IB_PI_8822C) -+#define BIT_CLEAR_REG_IB_PI_8822C(x) ((x) & (~BITS_REG_IB_PI_8822C)) -+#define BIT_GET_REG_IB_PI_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_IB_PI_8822C) & BIT_MASK_REG_IB_PI_8822C) -+#define BIT_SET_REG_IB_PI_8822C(x, v) \ -+ (BIT_CLEAR_REG_IB_PI_8822C(x) | BIT_REG_IB_PI_8822C(v)) -+ -+#define BIT_LDO2PWRCUT_8822C BIT(3) -+#define BIT_VPULSE_LDO_8822C BIT(2) -+ -+#define BIT_SHIFT_LDO_VSEL_8822C 0 -+#define BIT_MASK_LDO_VSEL_8822C 0x3 -+#define BIT_LDO_VSEL_8822C(x) \ -+ (((x) & BIT_MASK_LDO_VSEL_8822C) << BIT_SHIFT_LDO_VSEL_8822C) -+#define BITS_LDO_VSEL_8822C \ -+ (BIT_MASK_LDO_VSEL_8822C << BIT_SHIFT_LDO_VSEL_8822C) -+#define BIT_CLEAR_LDO_VSEL_8822C(x) ((x) & (~BITS_LDO_VSEL_8822C)) -+#define BIT_GET_LDO_VSEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_LDO_VSEL_8822C) & BIT_MASK_LDO_VSEL_8822C) -+#define BIT_SET_LDO_VSEL_8822C(x, v) \ -+ (BIT_CLEAR_LDO_VSEL_8822C(x) | BIT_LDO_VSEL_8822C(v)) -+ -+/* 2 REG_ANAPAR_MAC_1_8822C */ -+ -+#define BIT_SHIFT_REG_CK_MON_SEL_8822C 29 -+#define BIT_MASK_REG_CK_MON_SEL_8822C 0x7 -+#define BIT_REG_CK_MON_SEL_8822C(x) \ -+ (((x) & BIT_MASK_REG_CK_MON_SEL_8822C) \ -+ << BIT_SHIFT_REG_CK_MON_SEL_8822C) -+#define BITS_REG_CK_MON_SEL_8822C \ -+ (BIT_MASK_REG_CK_MON_SEL_8822C << BIT_SHIFT_REG_CK_MON_SEL_8822C) -+#define BIT_CLEAR_REG_CK_MON_SEL_8822C(x) ((x) & (~BITS_REG_CK_MON_SEL_8822C)) -+#define BIT_GET_REG_CK_MON_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_CK_MON_SEL_8822C) & \ -+ BIT_MASK_REG_CK_MON_SEL_8822C) -+#define BIT_SET_REG_CK_MON_SEL_8822C(x, v) \ -+ (BIT_CLEAR_REG_CK_MON_SEL_8822C(x) | BIT_REG_CK_MON_SEL_8822C(v)) -+ -+#define BIT_REG_CK_MON_EN_8822C BIT(28) -+#define BIT_REG_XTAL_FREQ_SEL_8822C BIT(27) -+#define BIT_REG_XTAL_EDGE_SEL_8822C BIT(26) -+#define BIT_REG_VCO_KVCO_8822C BIT(25) -+#define BIT_REG_SDM_EDGE_SEL_8822C BIT(24) -+#define BIT_REG_SDM_CK_SEL_8822C BIT(23) -+#define BIT_REG_SDM_CK_GATED_8822C BIT(22) -+#define BIT_REG_PFD_RESET_GATED_8822C BIT(21) -+ -+#define BIT_SHIFT_REG_LPF_R3_FAST_8822C 16 -+#define BIT_MASK_REG_LPF_R3_FAST_8822C 0x1f -+#define BIT_REG_LPF_R3_FAST_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_R3_FAST_8822C) \ -+ << BIT_SHIFT_REG_LPF_R3_FAST_8822C) -+#define BITS_REG_LPF_R3_FAST_8822C \ -+ (BIT_MASK_REG_LPF_R3_FAST_8822C << BIT_SHIFT_REG_LPF_R3_FAST_8822C) -+#define BIT_CLEAR_REG_LPF_R3_FAST_8822C(x) ((x) & (~BITS_REG_LPF_R3_FAST_8822C)) -+#define BIT_GET_REG_LPF_R3_FAST_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R3_FAST_8822C) & \ -+ BIT_MASK_REG_LPF_R3_FAST_8822C) -+#define BIT_SET_REG_LPF_R3_FAST_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_R3_FAST_8822C(x) | BIT_REG_LPF_R3_FAST_8822C(v)) -+ -+#define BIT_SHIFT_REG_LPF_R2_FAST_8822C 11 -+#define BIT_MASK_REG_LPF_R2_FAST_8822C 0x1f -+#define BIT_REG_LPF_R2_FAST_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_R2_FAST_8822C) \ -+ << BIT_SHIFT_REG_LPF_R2_FAST_8822C) -+#define BITS_REG_LPF_R2_FAST_8822C \ -+ (BIT_MASK_REG_LPF_R2_FAST_8822C << BIT_SHIFT_REG_LPF_R2_FAST_8822C) -+#define BIT_CLEAR_REG_LPF_R2_FAST_8822C(x) ((x) & (~BITS_REG_LPF_R2_FAST_8822C)) -+#define BIT_GET_REG_LPF_R2_FAST_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R2_FAST_8822C) & \ -+ BIT_MASK_REG_LPF_R2_FAST_8822C) -+#define BIT_SET_REG_LPF_R2_FAST_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_R2_FAST_8822C(x) | BIT_REG_LPF_R2_FAST_8822C(v)) -+ -+#define BIT_SHIFT_REG_LPF_C3_FAST_8822C 8 -+#define BIT_MASK_REG_LPF_C3_FAST_8822C 0x7 -+#define BIT_REG_LPF_C3_FAST_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_C3_FAST_8822C) \ -+ << BIT_SHIFT_REG_LPF_C3_FAST_8822C) -+#define BITS_REG_LPF_C3_FAST_8822C \ -+ (BIT_MASK_REG_LPF_C3_FAST_8822C << BIT_SHIFT_REG_LPF_C3_FAST_8822C) -+#define BIT_CLEAR_REG_LPF_C3_FAST_8822C(x) ((x) & (~BITS_REG_LPF_C3_FAST_8822C)) -+#define BIT_GET_REG_LPF_C3_FAST_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C3_FAST_8822C) & \ -+ BIT_MASK_REG_LPF_C3_FAST_8822C) -+#define BIT_SET_REG_LPF_C3_FAST_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_C3_FAST_8822C(x) | BIT_REG_LPF_C3_FAST_8822C(v)) -+ -+#define BIT_SHIFT_REG_LPF_C2_FAST_8822C 5 -+#define BIT_MASK_REG_LPF_C2_FAST_8822C 0x7 -+#define BIT_REG_LPF_C2_FAST_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_C2_FAST_8822C) \ -+ << BIT_SHIFT_REG_LPF_C2_FAST_8822C) -+#define BITS_REG_LPF_C2_FAST_8822C \ -+ (BIT_MASK_REG_LPF_C2_FAST_8822C << BIT_SHIFT_REG_LPF_C2_FAST_8822C) -+#define BIT_CLEAR_REG_LPF_C2_FAST_8822C(x) ((x) & (~BITS_REG_LPF_C2_FAST_8822C)) -+#define BIT_GET_REG_LPF_C2_FAST_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C2_FAST_8822C) & \ -+ BIT_MASK_REG_LPF_C2_FAST_8822C) -+#define BIT_SET_REG_LPF_C2_FAST_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_C2_FAST_8822C(x) | BIT_REG_LPF_C2_FAST_8822C(v)) -+ -+#define BIT_SHIFT_REG_LPF_C1_FAST_8822C 2 -+#define BIT_MASK_REG_LPF_C1_FAST_8822C 0x7 -+#define BIT_REG_LPF_C1_FAST_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_C1_FAST_8822C) \ -+ << BIT_SHIFT_REG_LPF_C1_FAST_8822C) -+#define BITS_REG_LPF_C1_FAST_8822C \ -+ (BIT_MASK_REG_LPF_C1_FAST_8822C << BIT_SHIFT_REG_LPF_C1_FAST_8822C) -+#define BIT_CLEAR_REG_LPF_C1_FAST_8822C(x) ((x) & (~BITS_REG_LPF_C1_FAST_8822C)) -+#define BIT_GET_REG_LPF_C1_FAST_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_C1_FAST_8822C) & \ -+ BIT_MASK_REG_LPF_C1_FAST_8822C) -+#define BIT_SET_REG_LPF_C1_FAST_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_C1_FAST_8822C(x) | BIT_REG_LPF_C1_FAST_8822C(v)) -+ -+#define BIT_SHIFT_REG_LPF_R3_V1_8822C 0 -+#define BIT_MASK_REG_LPF_R3_V1_8822C 0x3 -+#define BIT_REG_LPF_R3_V1_8822C(x) \ -+ (((x) & BIT_MASK_REG_LPF_R3_V1_8822C) << BIT_SHIFT_REG_LPF_R3_V1_8822C) -+#define BITS_REG_LPF_R3_V1_8822C \ -+ (BIT_MASK_REG_LPF_R3_V1_8822C << BIT_SHIFT_REG_LPF_R3_V1_8822C) -+#define BIT_CLEAR_REG_LPF_R3_V1_8822C(x) ((x) & (~BITS_REG_LPF_R3_V1_8822C)) -+#define BIT_GET_REG_LPF_R3_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_LPF_R3_V1_8822C) & BIT_MASK_REG_LPF_R3_V1_8822C) -+#define BIT_SET_REG_LPF_R3_V1_8822C(x, v) \ -+ (BIT_CLEAR_REG_LPF_R3_V1_8822C(x) | BIT_REG_LPF_R3_V1_8822C(v)) -+ -+/* 2 REG_ANAPAR_MAC_2_8822C */ -+ -+#define BIT_SHIFT_AGPIO_DRV_V1_8822C 30 -+#define BIT_MASK_AGPIO_DRV_V1_8822C 0x3 -+#define BIT_AGPIO_DRV_V1_8822C(x) \ -+ (((x) & BIT_MASK_AGPIO_DRV_V1_8822C) << BIT_SHIFT_AGPIO_DRV_V1_8822C) -+#define BITS_AGPIO_DRV_V1_8822C \ -+ (BIT_MASK_AGPIO_DRV_V1_8822C << BIT_SHIFT_AGPIO_DRV_V1_8822C) -+#define BIT_CLEAR_AGPIO_DRV_V1_8822C(x) ((x) & (~BITS_AGPIO_DRV_V1_8822C)) -+#define BIT_GET_AGPIO_DRV_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_AGPIO_DRV_V1_8822C) & BIT_MASK_AGPIO_DRV_V1_8822C) -+#define BIT_SET_AGPIO_DRV_V1_8822C(x, v) \ -+ (BIT_CLEAR_AGPIO_DRV_V1_8822C(x) | BIT_AGPIO_DRV_V1_8822C(v)) -+ -+#define BIT_AGPIO_GPO_V1_8822C BIT(29) -+#define BIT_AGPIO_GPE_V1_8822C BIT(28) -+#define BIT_SEL_CLK_8822C BIT(27) -+ -+#define BIT_SHIFT_LS_XTAL_SEL_8822C 23 -+#define BIT_MASK_LS_XTAL_SEL_8822C 0xf -+#define BIT_LS_XTAL_SEL_8822C(x) \ -+ (((x) & BIT_MASK_LS_XTAL_SEL_8822C) << BIT_SHIFT_LS_XTAL_SEL_8822C) -+#define BITS_LS_XTAL_SEL_8822C \ -+ (BIT_MASK_LS_XTAL_SEL_8822C << BIT_SHIFT_LS_XTAL_SEL_8822C) -+#define BIT_CLEAR_LS_XTAL_SEL_8822C(x) ((x) & (~BITS_LS_XTAL_SEL_8822C)) -+#define BIT_GET_LS_XTAL_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_LS_XTAL_SEL_8822C) & BIT_MASK_LS_XTAL_SEL_8822C) -+#define BIT_SET_LS_XTAL_SEL_8822C(x, v) \ -+ (BIT_CLEAR_LS_XTAL_SEL_8822C(x) | BIT_LS_XTAL_SEL_8822C(v)) -+ -+#define BIT_LS_SDM_ORDER_V1_8822C BIT(22) -+#define BIT_LS_DELAY_PH_8822C BIT(21) -+#define BIT_DIVIDER_SEL_8822C BIT(20) -+ -+#define BIT_SHIFT_PCODE_8822C 15 -+#define BIT_MASK_PCODE_8822C 0x1f -+#define BIT_PCODE_8822C(x) \ -+ (((x) & BIT_MASK_PCODE_8822C) << BIT_SHIFT_PCODE_8822C) -+#define BITS_PCODE_8822C (BIT_MASK_PCODE_8822C << BIT_SHIFT_PCODE_8822C) -+#define BIT_CLEAR_PCODE_8822C(x) ((x) & (~BITS_PCODE_8822C)) -+#define BIT_GET_PCODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCODE_8822C) & BIT_MASK_PCODE_8822C) -+#define BIT_SET_PCODE_8822C(x, v) \ -+ (BIT_CLEAR_PCODE_8822C(x) | BIT_PCODE_8822C(v)) -+ -+#define BIT_SHIFT_NCODE_8822C 7 -+#define BIT_MASK_NCODE_8822C 0xff -+#define BIT_NCODE_8822C(x) \ -+ (((x) & BIT_MASK_NCODE_8822C) << BIT_SHIFT_NCODE_8822C) -+#define BITS_NCODE_8822C (BIT_MASK_NCODE_8822C << BIT_SHIFT_NCODE_8822C) -+#define BIT_CLEAR_NCODE_8822C(x) ((x) & (~BITS_NCODE_8822C)) -+#define BIT_GET_NCODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_NCODE_8822C) & BIT_MASK_NCODE_8822C) -+#define BIT_SET_NCODE_8822C(x, v) \ -+ (BIT_CLEAR_NCODE_8822C(x) | BIT_NCODE_8822C(v)) -+ -+#define BIT_REG_BEACON_8822C BIT(6) -+#define BIT_REG_MBIASE_8822C BIT(5) -+ -+#define BIT_SHIFT_REG_FAST_SEL_8822C 3 -+#define BIT_MASK_REG_FAST_SEL_8822C 0x3 -+#define BIT_REG_FAST_SEL_8822C(x) \ -+ (((x) & BIT_MASK_REG_FAST_SEL_8822C) << BIT_SHIFT_REG_FAST_SEL_8822C) -+#define BITS_REG_FAST_SEL_8822C \ -+ (BIT_MASK_REG_FAST_SEL_8822C << BIT_SHIFT_REG_FAST_SEL_8822C) -+#define BIT_CLEAR_REG_FAST_SEL_8822C(x) ((x) & (~BITS_REG_FAST_SEL_8822C)) -+#define BIT_GET_REG_FAST_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_FAST_SEL_8822C) & BIT_MASK_REG_FAST_SEL_8822C) -+#define BIT_SET_REG_FAST_SEL_8822C(x, v) \ -+ (BIT_CLEAR_REG_FAST_SEL_8822C(x) | BIT_REG_FAST_SEL_8822C(v)) -+ -+#define BIT_REG_CK960M_EN_8822C BIT(2) -+#define BIT_REG_CK320M_EN_8822C BIT(1) -+#define BIT_REG_CK_5M_EN_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_ANAPAR_XTAL_0_8822C */ -+#define BIT_XTAL_SC_LPS_8822C BIT(31) -+ -+#define BIT_SHIFT_XTAL_SC_INIT_8822C 24 -+#define BIT_MASK_XTAL_SC_INIT_8822C 0x7f -+#define BIT_XTAL_SC_INIT_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_SC_INIT_8822C) << BIT_SHIFT_XTAL_SC_INIT_8822C) -+#define BITS_XTAL_SC_INIT_8822C \ -+ (BIT_MASK_XTAL_SC_INIT_8822C << BIT_SHIFT_XTAL_SC_INIT_8822C) -+#define BIT_CLEAR_XTAL_SC_INIT_8822C(x) ((x) & (~BITS_XTAL_SC_INIT_8822C)) -+#define BIT_GET_XTAL_SC_INIT_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_INIT_8822C) & BIT_MASK_XTAL_SC_INIT_8822C) -+#define BIT_SET_XTAL_SC_INIT_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_SC_INIT_8822C(x) | BIT_XTAL_SC_INIT_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_SC_XO_8822C 17 -+#define BIT_MASK_XTAL_SC_XO_8822C 0x7f -+#define BIT_XTAL_SC_XO_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_SC_XO_8822C) << BIT_SHIFT_XTAL_SC_XO_8822C) -+#define BITS_XTAL_SC_XO_8822C \ -+ (BIT_MASK_XTAL_SC_XO_8822C << BIT_SHIFT_XTAL_SC_XO_8822C) -+#define BIT_CLEAR_XTAL_SC_XO_8822C(x) ((x) & (~BITS_XTAL_SC_XO_8822C)) -+#define BIT_GET_XTAL_SC_XO_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_XO_8822C) & BIT_MASK_XTAL_SC_XO_8822C) -+#define BIT_SET_XTAL_SC_XO_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_SC_XO_8822C(x) | BIT_XTAL_SC_XO_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_SC_XI_8822C 10 -+#define BIT_MASK_XTAL_SC_XI_8822C 0x7f -+#define BIT_XTAL_SC_XI_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_SC_XI_8822C) << BIT_SHIFT_XTAL_SC_XI_8822C) -+#define BITS_XTAL_SC_XI_8822C \ -+ (BIT_MASK_XTAL_SC_XI_8822C << BIT_SHIFT_XTAL_SC_XI_8822C) -+#define BIT_CLEAR_XTAL_SC_XI_8822C(x) ((x) & (~BITS_XTAL_SC_XI_8822C)) -+#define BIT_GET_XTAL_SC_XI_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_XI_8822C) & BIT_MASK_XTAL_SC_XI_8822C) -+#define BIT_SET_XTAL_SC_XI_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_SC_XI_8822C(x) | BIT_XTAL_SC_XI_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_GMN_V3_8822C 5 -+#define BIT_MASK_XTAL_GMN_V3_8822C 0x1f -+#define BIT_XTAL_GMN_V3_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_GMN_V3_8822C) << BIT_SHIFT_XTAL_GMN_V3_8822C) -+#define BITS_XTAL_GMN_V3_8822C \ -+ (BIT_MASK_XTAL_GMN_V3_8822C << BIT_SHIFT_XTAL_GMN_V3_8822C) -+#define BIT_CLEAR_XTAL_GMN_V3_8822C(x) ((x) & (~BITS_XTAL_GMN_V3_8822C)) -+#define BIT_GET_XTAL_GMN_V3_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMN_V3_8822C) & BIT_MASK_XTAL_GMN_V3_8822C) -+#define BIT_SET_XTAL_GMN_V3_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_GMN_V3_8822C(x) | BIT_XTAL_GMN_V3_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_GMP_V3_8822C 0 -+#define BIT_MASK_XTAL_GMP_V3_8822C 0x1f -+#define BIT_XTAL_GMP_V3_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_GMP_V3_8822C) << BIT_SHIFT_XTAL_GMP_V3_8822C) -+#define BITS_XTAL_GMP_V3_8822C \ -+ (BIT_MASK_XTAL_GMP_V3_8822C << BIT_SHIFT_XTAL_GMP_V3_8822C) -+#define BIT_CLEAR_XTAL_GMP_V3_8822C(x) ((x) & (~BITS_XTAL_GMP_V3_8822C)) -+#define BIT_GET_XTAL_GMP_V3_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GMP_V3_8822C) & BIT_MASK_XTAL_GMP_V3_8822C) -+#define BIT_SET_XTAL_GMP_V3_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_GMP_V3_8822C(x) | BIT_XTAL_GMP_V3_8822C(v)) -+ -+/* 2 REG_ANAPAR_XTAL_1_8822C */ -+#define BIT_XTAL_SEL_TOK_V1_8822C BIT(31) -+#define BIT_XTAL_DELAY_DIGI_V2_8822C BIT(30) -+#define BIT_XTAL_DELAY_USB_V2_8822C BIT(29) -+#define BIT_XTAL_DELAY_AFE_V2_8822C BIT(28) -+ -+#define BIT_SHIFT_XTAL_DRV_DIGI_V2_8822C 26 -+#define BIT_MASK_XTAL_DRV_DIGI_V2_8822C 0x3 -+#define BIT_XTAL_DRV_DIGI_V2_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_DIGI_V2_8822C) \ -+ << BIT_SHIFT_XTAL_DRV_DIGI_V2_8822C) -+#define BITS_XTAL_DRV_DIGI_V2_8822C \ -+ (BIT_MASK_XTAL_DRV_DIGI_V2_8822C << BIT_SHIFT_XTAL_DRV_DIGI_V2_8822C) -+#define BIT_CLEAR_XTAL_DRV_DIGI_V2_8822C(x) \ -+ ((x) & (~BITS_XTAL_DRV_DIGI_V2_8822C)) -+#define BIT_GET_XTAL_DRV_DIGI_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_DIGI_V2_8822C) & \ -+ BIT_MASK_XTAL_DRV_DIGI_V2_8822C) -+#define BIT_SET_XTAL_DRV_DIGI_V2_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_DIGI_V2_8822C(x) | BIT_XTAL_DRV_DIGI_V2_8822C(v)) -+ -+#define BIT_EN_XTAL_DRV_LPS_8822C BIT(25) -+#define BIT_EN_XTAL_DRV_DIGI_V2_8822C BIT(24) -+ -+#define BIT_SHIFT_XTAL_DRV_USB_8822C 22 -+#define BIT_MASK_XTAL_DRV_USB_8822C 0x3 -+#define BIT_XTAL_DRV_USB_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_USB_8822C) << BIT_SHIFT_XTAL_DRV_USB_8822C) -+#define BITS_XTAL_DRV_USB_8822C \ -+ (BIT_MASK_XTAL_DRV_USB_8822C << BIT_SHIFT_XTAL_DRV_USB_8822C) -+#define BIT_CLEAR_XTAL_DRV_USB_8822C(x) ((x) & (~BITS_XTAL_DRV_USB_8822C)) -+#define BIT_GET_XTAL_DRV_USB_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_USB_8822C) & BIT_MASK_XTAL_DRV_USB_8822C) -+#define BIT_SET_XTAL_DRV_USB_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_USB_8822C(x) | BIT_XTAL_DRV_USB_8822C(v)) -+ -+#define BIT_EN_XTAL_DRV_USB_8822C BIT(21) -+ -+#define BIT_SHIFT_XTAL_DRV_AFE_V2_8822C 19 -+#define BIT_MASK_XTAL_DRV_AFE_V2_8822C 0x3 -+#define BIT_XTAL_DRV_AFE_V2_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_AFE_V2_8822C) \ -+ << BIT_SHIFT_XTAL_DRV_AFE_V2_8822C) -+#define BITS_XTAL_DRV_AFE_V2_8822C \ -+ (BIT_MASK_XTAL_DRV_AFE_V2_8822C << BIT_SHIFT_XTAL_DRV_AFE_V2_8822C) -+#define BIT_CLEAR_XTAL_DRV_AFE_V2_8822C(x) ((x) & (~BITS_XTAL_DRV_AFE_V2_8822C)) -+#define BIT_GET_XTAL_DRV_AFE_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_AFE_V2_8822C) & \ -+ BIT_MASK_XTAL_DRV_AFE_V2_8822C) -+#define BIT_SET_XTAL_DRV_AFE_V2_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_AFE_V2_8822C(x) | BIT_XTAL_DRV_AFE_V2_8822C(v)) -+ -+#define BIT_EN_XTAL_DRV_AFE_8822C BIT(18) -+ -+#define BIT_SHIFT_XTAL_DRV_RF2_V2_8822C 16 -+#define BIT_MASK_XTAL_DRV_RF2_V2_8822C 0x3 -+#define BIT_XTAL_DRV_RF2_V2_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF2_V2_8822C) \ -+ << BIT_SHIFT_XTAL_DRV_RF2_V2_8822C) -+#define BITS_XTAL_DRV_RF2_V2_8822C \ -+ (BIT_MASK_XTAL_DRV_RF2_V2_8822C << BIT_SHIFT_XTAL_DRV_RF2_V2_8822C) -+#define BIT_CLEAR_XTAL_DRV_RF2_V2_8822C(x) ((x) & (~BITS_XTAL_DRV_RF2_V2_8822C)) -+#define BIT_GET_XTAL_DRV_RF2_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF2_V2_8822C) & \ -+ BIT_MASK_XTAL_DRV_RF2_V2_8822C) -+#define BIT_SET_XTAL_DRV_RF2_V2_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF2_V2_8822C(x) | BIT_XTAL_DRV_RF2_V2_8822C(v)) -+ -+#define BIT_EN_XTAL_DRV_RF2_8822C BIT(15) -+ -+#define BIT_SHIFT_XTAL_DRV_RF1_8822C 13 -+#define BIT_MASK_XTAL_DRV_RF1_8822C 0x3 -+#define BIT_XTAL_DRV_RF1_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_DRV_RF1_8822C) << BIT_SHIFT_XTAL_DRV_RF1_8822C) -+#define BITS_XTAL_DRV_RF1_8822C \ -+ (BIT_MASK_XTAL_DRV_RF1_8822C << BIT_SHIFT_XTAL_DRV_RF1_8822C) -+#define BIT_CLEAR_XTAL_DRV_RF1_8822C(x) ((x) & (~BITS_XTAL_DRV_RF1_8822C)) -+#define BIT_GET_XTAL_DRV_RF1_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DRV_RF1_8822C) & BIT_MASK_XTAL_DRV_RF1_8822C) -+#define BIT_SET_XTAL_DRV_RF1_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_DRV_RF1_8822C(x) | BIT_XTAL_DRV_RF1_8822C(v)) -+ -+#define BIT_EN_XTAL_DRV_RF1_8822C BIT(12) -+#define BIT_XTAL_DRV_RF_LATCH_V4_8822C BIT(11) -+#define BIT_XTAL_GM_SEP_V3_8822C BIT(10) -+#define BIT_XQSEL_RF_AWAKE_V3_8822C BIT(9) -+#define BIT_XQSEL_RF_INITIAL_V3_8822C BIT(8) -+#define BIT_XQSEL_V2_8822C BIT(7) -+#define BIT_GATED_XTAL_OK0_V2_8822C BIT(6) -+ -+#define BIT_SHIFT_XTAL_SC_LPS_V2_8822C 0 -+#define BIT_MASK_XTAL_SC_LPS_V2_8822C 0x3f -+#define BIT_XTAL_SC_LPS_V2_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_SC_LPS_V2_8822C) \ -+ << BIT_SHIFT_XTAL_SC_LPS_V2_8822C) -+#define BITS_XTAL_SC_LPS_V2_8822C \ -+ (BIT_MASK_XTAL_SC_LPS_V2_8822C << BIT_SHIFT_XTAL_SC_LPS_V2_8822C) -+#define BIT_CLEAR_XTAL_SC_LPS_V2_8822C(x) ((x) & (~BITS_XTAL_SC_LPS_V2_8822C)) -+#define BIT_GET_XTAL_SC_LPS_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SC_LPS_V2_8822C) & \ -+ BIT_MASK_XTAL_SC_LPS_V2_8822C) -+#define BIT_SET_XTAL_SC_LPS_V2_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_SC_LPS_V2_8822C(x) | BIT_XTAL_SC_LPS_V2_8822C(v)) -+ -+/* 2 REG_ANAPAR_XTAL_2_8822C */ -+#define BIT_XTAL_AAC_CAP_8822C BIT(31) -+ -+#define BIT_SHIFT_XTAL_PDSW_8822C 29 -+#define BIT_MASK_XTAL_PDSW_8822C 0x3 -+#define BIT_XTAL_PDSW_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_PDSW_8822C) << BIT_SHIFT_XTAL_PDSW_8822C) -+#define BITS_XTAL_PDSW_8822C \ -+ (BIT_MASK_XTAL_PDSW_8822C << BIT_SHIFT_XTAL_PDSW_8822C) -+#define BIT_CLEAR_XTAL_PDSW_8822C(x) ((x) & (~BITS_XTAL_PDSW_8822C)) -+#define BIT_GET_XTAL_PDSW_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_PDSW_8822C) & BIT_MASK_XTAL_PDSW_8822C) -+#define BIT_SET_XTAL_PDSW_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_PDSW_8822C(x) | BIT_XTAL_PDSW_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_LPS_BUF_VB_8822C 27 -+#define BIT_MASK_XTAL_LPS_BUF_VB_8822C 0x3 -+#define BIT_XTAL_LPS_BUF_VB_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_LPS_BUF_VB_8822C) \ -+ << BIT_SHIFT_XTAL_LPS_BUF_VB_8822C) -+#define BITS_XTAL_LPS_BUF_VB_8822C \ -+ (BIT_MASK_XTAL_LPS_BUF_VB_8822C << BIT_SHIFT_XTAL_LPS_BUF_VB_8822C) -+#define BIT_CLEAR_XTAL_LPS_BUF_VB_8822C(x) ((x) & (~BITS_XTAL_LPS_BUF_VB_8822C)) -+#define BIT_GET_XTAL_LPS_BUF_VB_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LPS_BUF_VB_8822C) & \ -+ BIT_MASK_XTAL_LPS_BUF_VB_8822C) -+#define BIT_SET_XTAL_LPS_BUF_VB_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_LPS_BUF_VB_8822C(x) | BIT_XTAL_LPS_BUF_VB_8822C(v)) -+ -+#define BIT_XTAL_PDCK_MANU_8822C BIT(26) -+#define BIT_XTAL_PDCK_OK_MANU_8822C BIT(25) -+ -+#define BIT_SHIFT_XTAL_VREF_SEL_8822C 20 -+#define BIT_MASK_XTAL_VREF_SEL_8822C 0x1f -+#define BIT_XTAL_VREF_SEL_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_VREF_SEL_8822C) << BIT_SHIFT_XTAL_VREF_SEL_8822C) -+#define BITS_XTAL_VREF_SEL_8822C \ -+ (BIT_MASK_XTAL_VREF_SEL_8822C << BIT_SHIFT_XTAL_VREF_SEL_8822C) -+#define BIT_CLEAR_XTAL_VREF_SEL_8822C(x) ((x) & (~BITS_XTAL_VREF_SEL_8822C)) -+#define BIT_GET_XTAL_VREF_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_VREF_SEL_8822C) & BIT_MASK_XTAL_VREF_SEL_8822C) -+#define BIT_SET_XTAL_VREF_SEL_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_VREF_SEL_8822C(x) | BIT_XTAL_VREF_SEL_8822C(v)) -+ -+#define BIT_EN_XTAL_PDCK_VREF_8822C BIT(19) -+#define BIT_XTAL_SEL_PWR_V1_8822C BIT(18) -+#define BIT_XTAL_LPS_DIVISOR_8822C BIT(17) -+#define BIT_XTAL_CKDIGI_SEL_8822C BIT(16) -+#define BIT_EN_XTAL_LPS_CLK_8822C BIT(15) -+#define BIT_EN_XTAL_SCHMITT_8822C BIT(14) -+#define BIT_XTAL_PK_SEL_OFFSET_8822C BIT(13) -+ -+#define BIT_SHIFT_XTAL_MANU_PK_SEL_8822C 11 -+#define BIT_MASK_XTAL_MANU_PK_SEL_8822C 0x3 -+#define BIT_XTAL_MANU_PK_SEL_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_MANU_PK_SEL_8822C) \ -+ << BIT_SHIFT_XTAL_MANU_PK_SEL_8822C) -+#define BITS_XTAL_MANU_PK_SEL_8822C \ -+ (BIT_MASK_XTAL_MANU_PK_SEL_8822C << BIT_SHIFT_XTAL_MANU_PK_SEL_8822C) -+#define BIT_CLEAR_XTAL_MANU_PK_SEL_8822C(x) \ -+ ((x) & (~BITS_XTAL_MANU_PK_SEL_8822C)) -+#define BIT_GET_XTAL_MANU_PK_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_MANU_PK_SEL_8822C) & \ -+ BIT_MASK_XTAL_MANU_PK_SEL_8822C) -+#define BIT_SET_XTAL_MANU_PK_SEL_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_MANU_PK_SEL_8822C(x) | BIT_XTAL_MANU_PK_SEL_8822C(v)) -+ -+#define BIT_XTAL_AACK_PK_MANU_8822C BIT(10) -+#define BIT_EN_XTAL_AAC_PKDET_V1_8822C BIT(9) -+#define BIT_EN_XTAL_AAC_GM_V1_8822C BIT(8) -+#define BIT_XTAL_LDO_OPVB_SEL_8822C BIT(7) -+#define BIT_XTAL_LDO_NC_8822C BIT(6) -+ -+#define BIT_SHIFT_XTAL_LDO_VREF_V2_8822C 3 -+#define BIT_MASK_XTAL_LDO_VREF_V2_8822C 0x7 -+#define BIT_XTAL_LDO_VREF_V2_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_VREF_V2_8822C) \ -+ << BIT_SHIFT_XTAL_LDO_VREF_V2_8822C) -+#define BITS_XTAL_LDO_VREF_V2_8822C \ -+ (BIT_MASK_XTAL_LDO_VREF_V2_8822C << BIT_SHIFT_XTAL_LDO_VREF_V2_8822C) -+#define BIT_CLEAR_XTAL_LDO_VREF_V2_8822C(x) \ -+ ((x) & (~BITS_XTAL_LDO_VREF_V2_8822C)) -+#define BIT_GET_XTAL_LDO_VREF_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_VREF_V2_8822C) & \ -+ BIT_MASK_XTAL_LDO_VREF_V2_8822C) -+#define BIT_SET_XTAL_LDO_VREF_V2_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_VREF_V2_8822C(x) | BIT_XTAL_LDO_VREF_V2_8822C(v)) -+ -+#define BIT_XTAL_LPMODE_V1_8822C BIT(2) -+ -+#define BIT_SHIFT_XTAL_SEL_TOK_V3_8822C 0 -+#define BIT_MASK_XTAL_SEL_TOK_V3_8822C 0x3 -+#define BIT_XTAL_SEL_TOK_V3_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_SEL_TOK_V3_8822C) \ -+ << BIT_SHIFT_XTAL_SEL_TOK_V3_8822C) -+#define BITS_XTAL_SEL_TOK_V3_8822C \ -+ (BIT_MASK_XTAL_SEL_TOK_V3_8822C << BIT_SHIFT_XTAL_SEL_TOK_V3_8822C) -+#define BIT_CLEAR_XTAL_SEL_TOK_V3_8822C(x) ((x) & (~BITS_XTAL_SEL_TOK_V3_8822C)) -+#define BIT_GET_XTAL_SEL_TOK_V3_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_SEL_TOK_V3_8822C) & \ -+ BIT_MASK_XTAL_SEL_TOK_V3_8822C) -+#define BIT_SET_XTAL_SEL_TOK_V3_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_SEL_TOK_V3_8822C(x) | BIT_XTAL_SEL_TOK_V3_8822C(v)) -+ -+/* 2 REG_ANAPAR_XTAL_3_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_XTAL_DUMMY_V1_8822C 7 -+#define BIT_MASK_XTAL_DUMMY_V1_8822C 0x3f -+#define BIT_XTAL_DUMMY_V1_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_DUMMY_V1_8822C) << BIT_SHIFT_XTAL_DUMMY_V1_8822C) -+#define BITS_XTAL_DUMMY_V1_8822C \ -+ (BIT_MASK_XTAL_DUMMY_V1_8822C << BIT_SHIFT_XTAL_DUMMY_V1_8822C) -+#define BIT_CLEAR_XTAL_DUMMY_V1_8822C(x) ((x) & (~BITS_XTAL_DUMMY_V1_8822C)) -+#define BIT_GET_XTAL_DUMMY_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_DUMMY_V1_8822C) & BIT_MASK_XTAL_DUMMY_V1_8822C) -+#define BIT_SET_XTAL_DUMMY_V1_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_DUMMY_V1_8822C(x) | BIT_XTAL_DUMMY_V1_8822C(v)) -+ -+#define BIT_XTAL_EN_LNBUF_8822C BIT(6) -+#define BIT_XTAL__AAC_TIE_MID_8822C BIT(5) -+ -+#define BIT_SHIFT_XTAL_AAC_OPCUR_8822C 3 -+#define BIT_MASK_XTAL_AAC_OPCUR_8822C 0x3 -+#define BIT_XTAL_AAC_OPCUR_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_AAC_OPCUR_8822C) \ -+ << BIT_SHIFT_XTAL_AAC_OPCUR_8822C) -+#define BITS_XTAL_AAC_OPCUR_8822C \ -+ (BIT_MASK_XTAL_AAC_OPCUR_8822C << BIT_SHIFT_XTAL_AAC_OPCUR_8822C) -+#define BIT_CLEAR_XTAL_AAC_OPCUR_8822C(x) ((x) & (~BITS_XTAL_AAC_OPCUR_8822C)) -+#define BIT_GET_XTAL_AAC_OPCUR_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_AAC_OPCUR_8822C) & \ -+ BIT_MASK_XTAL_AAC_OPCUR_8822C) -+#define BIT_SET_XTAL_AAC_OPCUR_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_AAC_OPCUR_8822C(x) | BIT_XTAL_AAC_OPCUR_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_AAC_IOFFSET_8822C 1 -+#define BIT_MASK_XTAL_AAC_IOFFSET_8822C 0x3 -+#define BIT_XTAL_AAC_IOFFSET_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_AAC_IOFFSET_8822C) \ -+ << BIT_SHIFT_XTAL_AAC_IOFFSET_8822C) -+#define BITS_XTAL_AAC_IOFFSET_8822C \ -+ (BIT_MASK_XTAL_AAC_IOFFSET_8822C << BIT_SHIFT_XTAL_AAC_IOFFSET_8822C) -+#define BIT_CLEAR_XTAL_AAC_IOFFSET_8822C(x) \ -+ ((x) & (~BITS_XTAL_AAC_IOFFSET_8822C)) -+#define BIT_GET_XTAL_AAC_IOFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_AAC_IOFFSET_8822C) & \ -+ BIT_MASK_XTAL_AAC_IOFFSET_8822C) -+#define BIT_SET_XTAL_AAC_IOFFSET_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_AAC_IOFFSET_8822C(x) | BIT_XTAL_AAC_IOFFSET_8822C(v)) -+ -+#define BIT_XTAL_AAC_CAP_V1_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_ANAPAR_XTAL_AACK_0_8822C */ -+#define BIT_XAAC_LPOW_8822C BIT(31) -+ -+#define BIT_SHIFT_AAC_MODE_8822C 29 -+#define BIT_MASK_AAC_MODE_8822C 0x3 -+#define BIT_AAC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_AAC_MODE_8822C) << BIT_SHIFT_AAC_MODE_8822C) -+#define BITS_AAC_MODE_8822C \ -+ (BIT_MASK_AAC_MODE_8822C << BIT_SHIFT_AAC_MODE_8822C) -+#define BIT_CLEAR_AAC_MODE_8822C(x) ((x) & (~BITS_AAC_MODE_8822C)) -+#define BIT_GET_AAC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_AAC_MODE_8822C) & BIT_MASK_AAC_MODE_8822C) -+#define BIT_SET_AAC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_AAC_MODE_8822C(x) | BIT_AAC_MODE_8822C(v)) -+ -+#define BIT_EN_XTAL_AAC_TRIG_8822C BIT(28) -+#define BIT_EN_XTAL_AAC_8822C BIT(27) -+#define BIT_EN_XTAL_AAC_DIGI_8822C BIT(26) -+ -+#define BIT_SHIFT_GM_MANUAL_8822C 21 -+#define BIT_MASK_GM_MANUAL_8822C 0x1f -+#define BIT_GM_MANUAL_8822C(x) \ -+ (((x) & BIT_MASK_GM_MANUAL_8822C) << BIT_SHIFT_GM_MANUAL_8822C) -+#define BITS_GM_MANUAL_8822C \ -+ (BIT_MASK_GM_MANUAL_8822C << BIT_SHIFT_GM_MANUAL_8822C) -+#define BIT_CLEAR_GM_MANUAL_8822C(x) ((x) & (~BITS_GM_MANUAL_8822C)) -+#define BIT_GET_GM_MANUAL_8822C(x) \ -+ (((x) >> BIT_SHIFT_GM_MANUAL_8822C) & BIT_MASK_GM_MANUAL_8822C) -+#define BIT_SET_GM_MANUAL_8822C(x, v) \ -+ (BIT_CLEAR_GM_MANUAL_8822C(x) | BIT_GM_MANUAL_8822C(v)) -+ -+#define BIT_SHIFT_GM_STUP_8822C 16 -+#define BIT_MASK_GM_STUP_8822C 0x1f -+#define BIT_GM_STUP_8822C(x) \ -+ (((x) & BIT_MASK_GM_STUP_8822C) << BIT_SHIFT_GM_STUP_8822C) -+#define BITS_GM_STUP_8822C (BIT_MASK_GM_STUP_8822C << BIT_SHIFT_GM_STUP_8822C) -+#define BIT_CLEAR_GM_STUP_8822C(x) ((x) & (~BITS_GM_STUP_8822C)) -+#define BIT_GET_GM_STUP_8822C(x) \ -+ (((x) >> BIT_SHIFT_GM_STUP_8822C) & BIT_MASK_GM_STUP_8822C) -+#define BIT_SET_GM_STUP_8822C(x, v) \ -+ (BIT_CLEAR_GM_STUP_8822C(x) | BIT_GM_STUP_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_CK_SET_8822C 13 -+#define BIT_MASK_XTAL_CK_SET_8822C 0x7 -+#define BIT_XTAL_CK_SET_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_CK_SET_8822C) << BIT_SHIFT_XTAL_CK_SET_8822C) -+#define BITS_XTAL_CK_SET_8822C \ -+ (BIT_MASK_XTAL_CK_SET_8822C << BIT_SHIFT_XTAL_CK_SET_8822C) -+#define BIT_CLEAR_XTAL_CK_SET_8822C(x) ((x) & (~BITS_XTAL_CK_SET_8822C)) -+#define BIT_GET_XTAL_CK_SET_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_CK_SET_8822C) & BIT_MASK_XTAL_CK_SET_8822C) -+#define BIT_SET_XTAL_CK_SET_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_CK_SET_8822C(x) | BIT_XTAL_CK_SET_8822C(v)) -+ -+#define BIT_SHIFT_GM_INIT_8822C 8 -+#define BIT_MASK_GM_INIT_8822C 0x1f -+#define BIT_GM_INIT_8822C(x) \ -+ (((x) & BIT_MASK_GM_INIT_8822C) << BIT_SHIFT_GM_INIT_8822C) -+#define BITS_GM_INIT_8822C (BIT_MASK_GM_INIT_8822C << BIT_SHIFT_GM_INIT_8822C) -+#define BIT_CLEAR_GM_INIT_8822C(x) ((x) & (~BITS_GM_INIT_8822C)) -+#define BIT_GET_GM_INIT_8822C(x) \ -+ (((x) >> BIT_SHIFT_GM_INIT_8822C) & BIT_MASK_GM_INIT_8822C) -+#define BIT_SET_GM_INIT_8822C(x, v) \ -+ (BIT_CLEAR_GM_INIT_8822C(x) | BIT_GM_INIT_8822C(v)) -+ -+#define BIT_GM_STEP_8822C BIT(7) -+ -+#define BIT_SHIFT_XAAC_GM_OFFSET_8822C 2 -+#define BIT_MASK_XAAC_GM_OFFSET_8822C 0x1f -+#define BIT_XAAC_GM_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_XAAC_GM_OFFSET_8822C) \ -+ << BIT_SHIFT_XAAC_GM_OFFSET_8822C) -+#define BITS_XAAC_GM_OFFSET_8822C \ -+ (BIT_MASK_XAAC_GM_OFFSET_8822C << BIT_SHIFT_XAAC_GM_OFFSET_8822C) -+#define BIT_CLEAR_XAAC_GM_OFFSET_8822C(x) ((x) & (~BITS_XAAC_GM_OFFSET_8822C)) -+#define BIT_GET_XAAC_GM_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_XAAC_GM_OFFSET_8822C) & \ -+ BIT_MASK_XAAC_GM_OFFSET_8822C) -+#define BIT_SET_XAAC_GM_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_XAAC_GM_OFFSET_8822C(x) | BIT_XAAC_GM_OFFSET_8822C(v)) -+ -+#define BIT_OFFSET_PLUS_8822C BIT(1) -+#define BIT_RESET_N_8822C BIT(0) -+ -+/* 2 REG_ANAPAR_XTAL_AACK_1_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_PK_END_AR_8822C 3 -+#define BIT_MASK_PK_END_AR_8822C 0x3 -+#define BIT_PK_END_AR_8822C(x) \ -+ (((x) & BIT_MASK_PK_END_AR_8822C) << BIT_SHIFT_PK_END_AR_8822C) -+#define BITS_PK_END_AR_8822C \ -+ (BIT_MASK_PK_END_AR_8822C << BIT_SHIFT_PK_END_AR_8822C) -+#define BIT_CLEAR_PK_END_AR_8822C(x) ((x) & (~BITS_PK_END_AR_8822C)) -+#define BIT_GET_PK_END_AR_8822C(x) \ -+ (((x) >> BIT_SHIFT_PK_END_AR_8822C) & BIT_MASK_PK_END_AR_8822C) -+#define BIT_SET_PK_END_AR_8822C(x, v) \ -+ (BIT_CLEAR_PK_END_AR_8822C(x) | BIT_PK_END_AR_8822C(v)) -+ -+#define BIT_SHIFT_PK_START_AR_8822C 1 -+#define BIT_MASK_PK_START_AR_8822C 0x3 -+#define BIT_PK_START_AR_8822C(x) \ -+ (((x) & BIT_MASK_PK_START_AR_8822C) << BIT_SHIFT_PK_START_AR_8822C) -+#define BITS_PK_START_AR_8822C \ -+ (BIT_MASK_PK_START_AR_8822C << BIT_SHIFT_PK_START_AR_8822C) -+#define BIT_CLEAR_PK_START_AR_8822C(x) ((x) & (~BITS_PK_START_AR_8822C)) -+#define BIT_GET_PK_START_AR_8822C(x) \ -+ (((x) >> BIT_SHIFT_PK_START_AR_8822C) & BIT_MASK_PK_START_AR_8822C) -+#define BIT_SET_PK_START_AR_8822C(x, v) \ -+ (BIT_CLEAR_PK_START_AR_8822C(x) | BIT_PK_START_AR_8822C(v)) -+ -+#define BIT_XAAC_LUT_MANUAL_EN_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_XTAL_AAC_OUTPUT_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_XTAL_PEAKDET_OUT_8822C BIT(9) -+#define BIT_XAAC_BUSY_8822C BIT(8) -+#define BIT_XAAC_READY_V1_8822C BIT(7) -+ -+#define BIT_SHIFT_XAAC_PK_SEL_8822C 5 -+#define BIT_MASK_XAAC_PK_SEL_8822C 0x3 -+#define BIT_XAAC_PK_SEL_8822C(x) \ -+ (((x) & BIT_MASK_XAAC_PK_SEL_8822C) << BIT_SHIFT_XAAC_PK_SEL_8822C) -+#define BITS_XAAC_PK_SEL_8822C \ -+ (BIT_MASK_XAAC_PK_SEL_8822C << BIT_SHIFT_XAAC_PK_SEL_8822C) -+#define BIT_CLEAR_XAAC_PK_SEL_8822C(x) ((x) & (~BITS_XAAC_PK_SEL_8822C)) -+#define BIT_GET_XAAC_PK_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_XAAC_PK_SEL_8822C) & BIT_MASK_XAAC_PK_SEL_8822C) -+#define BIT_SET_XAAC_PK_SEL_8822C(x, v) \ -+ (BIT_CLEAR_XAAC_PK_SEL_8822C(x) | BIT_XAAC_PK_SEL_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_GM_OUT_8822C 0 -+#define BIT_MASK_XTAL_GM_OUT_8822C 0x1f -+#define BIT_XTAL_GM_OUT_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_GM_OUT_8822C) << BIT_SHIFT_XTAL_GM_OUT_8822C) -+#define BITS_XTAL_GM_OUT_8822C \ -+ (BIT_MASK_XTAL_GM_OUT_8822C << BIT_SHIFT_XTAL_GM_OUT_8822C) -+#define BIT_CLEAR_XTAL_GM_OUT_8822C(x) ((x) & (~BITS_XTAL_GM_OUT_8822C)) -+#define BIT_GET_XTAL_GM_OUT_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_GM_OUT_8822C) & BIT_MASK_XTAL_GM_OUT_8822C) -+#define BIT_SET_XTAL_GM_OUT_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_GM_OUT_8822C(x) | BIT_XTAL_GM_OUT_8822C(v)) -+ -+/* 2 REG_ANAPAR_XTAL_MODE_DECODER_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_XTAL_LDO_LPS_8822C 21 -+#define BIT_MASK_XTAL_LDO_LPS_8822C 0x7 -+#define BIT_XTAL_LDO_LPS_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_LPS_8822C) << BIT_SHIFT_XTAL_LDO_LPS_8822C) -+#define BITS_XTAL_LDO_LPS_8822C \ -+ (BIT_MASK_XTAL_LDO_LPS_8822C << BIT_SHIFT_XTAL_LDO_LPS_8822C) -+#define BIT_CLEAR_XTAL_LDO_LPS_8822C(x) ((x) & (~BITS_XTAL_LDO_LPS_8822C)) -+#define BIT_GET_XTAL_LDO_LPS_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_LPS_8822C) & BIT_MASK_XTAL_LDO_LPS_8822C) -+#define BIT_SET_XTAL_LDO_LPS_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_LPS_8822C(x) | BIT_XTAL_LDO_LPS_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_WAIT_CYC_8822C 15 -+#define BIT_MASK_XTAL_WAIT_CYC_8822C 0x3f -+#define BIT_XTAL_WAIT_CYC_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_WAIT_CYC_8822C) << BIT_SHIFT_XTAL_WAIT_CYC_8822C) -+#define BITS_XTAL_WAIT_CYC_8822C \ -+ (BIT_MASK_XTAL_WAIT_CYC_8822C << BIT_SHIFT_XTAL_WAIT_CYC_8822C) -+#define BIT_CLEAR_XTAL_WAIT_CYC_8822C(x) ((x) & (~BITS_XTAL_WAIT_CYC_8822C)) -+#define BIT_GET_XTAL_WAIT_CYC_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_WAIT_CYC_8822C) & BIT_MASK_XTAL_WAIT_CYC_8822C) -+#define BIT_SET_XTAL_WAIT_CYC_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_WAIT_CYC_8822C(x) | BIT_XTAL_WAIT_CYC_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_LDO_OK_8822C 12 -+#define BIT_MASK_XTAL_LDO_OK_8822C 0x7 -+#define BIT_XTAL_LDO_OK_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_LDO_OK_8822C) << BIT_SHIFT_XTAL_LDO_OK_8822C) -+#define BITS_XTAL_LDO_OK_8822C \ -+ (BIT_MASK_XTAL_LDO_OK_8822C << BIT_SHIFT_XTAL_LDO_OK_8822C) -+#define BIT_CLEAR_XTAL_LDO_OK_8822C(x) ((x) & (~BITS_XTAL_LDO_OK_8822C)) -+#define BIT_GET_XTAL_LDO_OK_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_LDO_OK_8822C) & BIT_MASK_XTAL_LDO_OK_8822C) -+#define BIT_SET_XTAL_LDO_OK_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_LDO_OK_8822C(x) | BIT_XTAL_LDO_OK_8822C(v)) -+ -+#define BIT_XTAL_MD_LPOW_8822C BIT(11) -+ -+#define BIT_SHIFT_XTAL_OV_RATIO_8822C 9 -+#define BIT_MASK_XTAL_OV_RATIO_8822C 0x3 -+#define BIT_XTAL_OV_RATIO_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_OV_RATIO_8822C) << BIT_SHIFT_XTAL_OV_RATIO_8822C) -+#define BITS_XTAL_OV_RATIO_8822C \ -+ (BIT_MASK_XTAL_OV_RATIO_8822C << BIT_SHIFT_XTAL_OV_RATIO_8822C) -+#define BIT_CLEAR_XTAL_OV_RATIO_8822C(x) ((x) & (~BITS_XTAL_OV_RATIO_8822C)) -+#define BIT_GET_XTAL_OV_RATIO_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_OV_RATIO_8822C) & BIT_MASK_XTAL_OV_RATIO_8822C) -+#define BIT_SET_XTAL_OV_RATIO_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_OV_RATIO_8822C(x) | BIT_XTAL_OV_RATIO_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_OV_UNIT_8822C 6 -+#define BIT_MASK_XTAL_OV_UNIT_8822C 0x7 -+#define BIT_XTAL_OV_UNIT_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_OV_UNIT_8822C) << BIT_SHIFT_XTAL_OV_UNIT_8822C) -+#define BITS_XTAL_OV_UNIT_8822C \ -+ (BIT_MASK_XTAL_OV_UNIT_8822C << BIT_SHIFT_XTAL_OV_UNIT_8822C) -+#define BIT_CLEAR_XTAL_OV_UNIT_8822C(x) ((x) & (~BITS_XTAL_OV_UNIT_8822C)) -+#define BIT_GET_XTAL_OV_UNIT_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_OV_UNIT_8822C) & BIT_MASK_XTAL_OV_UNIT_8822C) -+#define BIT_SET_XTAL_OV_UNIT_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_OV_UNIT_8822C(x) | BIT_XTAL_OV_UNIT_8822C(v)) -+ -+#define BIT_SHIFT_XTAL_MODE_MANUAL_8822C 4 -+#define BIT_MASK_XTAL_MODE_MANUAL_8822C 0x3 -+#define BIT_XTAL_MODE_MANUAL_8822C(x) \ -+ (((x) & BIT_MASK_XTAL_MODE_MANUAL_8822C) \ -+ << BIT_SHIFT_XTAL_MODE_MANUAL_8822C) -+#define BITS_XTAL_MODE_MANUAL_8822C \ -+ (BIT_MASK_XTAL_MODE_MANUAL_8822C << BIT_SHIFT_XTAL_MODE_MANUAL_8822C) -+#define BIT_CLEAR_XTAL_MODE_MANUAL_8822C(x) \ -+ ((x) & (~BITS_XTAL_MODE_MANUAL_8822C)) -+#define BIT_GET_XTAL_MODE_MANUAL_8822C(x) \ -+ (((x) >> BIT_SHIFT_XTAL_MODE_MANUAL_8822C) & \ -+ BIT_MASK_XTAL_MODE_MANUAL_8822C) -+#define BIT_SET_XTAL_MODE_MANUAL_8822C(x, v) \ -+ (BIT_CLEAR_XTAL_MODE_MANUAL_8822C(x) | BIT_XTAL_MODE_MANUAL_8822C(v)) -+ -+#define BIT_XTAL_MANU_SEL_8822C BIT(3) -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_XTAL_MODE_8822C BIT(1) -+#define BIT_RESET_N_DECODER_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_SYS_CFG5_8822C */ -+#define BIT_LPS_STATUS_8822C BIT(3) -+#define BIT_HCI_TXDMA_BUSY_8822C BIT(2) -+#define BIT_HCI_TXDMA_ALLOW_8822C BIT(1) -+#define BIT_FW_CTRL_HCI_TXDMA_EN_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_CPU_DMEM_CON_8822C */ -+#define BIT_WDT_AUTO_MODE_8822C BIT(22) -+#define BIT_WDT_PLATFORM_EN_8822C BIT(21) -+#define BIT_WDT_CPU_EN_8822C BIT(20) -+#define BIT_WDT_OPT_IOWRAPPER_8822C BIT(19) -+#define BIT_ANA_PORT_IDLE_8822C BIT(18) -+#define BIT_MAC_PORT_IDLE_8822C BIT(17) -+#define BIT_WL_PLATFORM_RST_8822C BIT(16) -+#define BIT_WL_SECURITY_CLK_8822C BIT(15) -+#define BIT_DDMA_EN_8822C BIT(8) -+ -+#define BIT_SHIFT_CPU_DMEM_CON_8822C 0 -+#define BIT_MASK_CPU_DMEM_CON_8822C 0xff -+#define BIT_CPU_DMEM_CON_8822C(x) \ -+ (((x) & BIT_MASK_CPU_DMEM_CON_8822C) << BIT_SHIFT_CPU_DMEM_CON_8822C) -+#define BITS_CPU_DMEM_CON_8822C \ -+ (BIT_MASK_CPU_DMEM_CON_8822C << BIT_SHIFT_CPU_DMEM_CON_8822C) -+#define BIT_CLEAR_CPU_DMEM_CON_8822C(x) ((x) & (~BITS_CPU_DMEM_CON_8822C)) -+#define BIT_GET_CPU_DMEM_CON_8822C(x) \ -+ (((x) >> BIT_SHIFT_CPU_DMEM_CON_8822C) & BIT_MASK_CPU_DMEM_CON_8822C) -+#define BIT_SET_CPU_DMEM_CON_8822C(x, v) \ -+ (BIT_CLEAR_CPU_DMEM_CON_8822C(x) | BIT_CPU_DMEM_CON_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_BOOT_REASON_8822C */ -+ -+#define BIT_SHIFT_BOOT_REASON_V1_8822C 0 -+#define BIT_MASK_BOOT_REASON_V1_8822C 0x7 -+#define BIT_BOOT_REASON_V1_8822C(x) \ -+ (((x) & BIT_MASK_BOOT_REASON_V1_8822C) \ -+ << BIT_SHIFT_BOOT_REASON_V1_8822C) -+#define BITS_BOOT_REASON_V1_8822C \ -+ (BIT_MASK_BOOT_REASON_V1_8822C << BIT_SHIFT_BOOT_REASON_V1_8822C) -+#define BIT_CLEAR_BOOT_REASON_V1_8822C(x) ((x) & (~BITS_BOOT_REASON_V1_8822C)) -+#define BIT_GET_BOOT_REASON_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BOOT_REASON_V1_8822C) & \ -+ BIT_MASK_BOOT_REASON_V1_8822C) -+#define BIT_SET_BOOT_REASON_V1_8822C(x, v) \ -+ (BIT_CLEAR_BOOT_REASON_V1_8822C(x) | BIT_BOOT_REASON_V1_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_HIMR2_8822C */ -+#define BIT_BCNDMAINT_P4_MSK_8822C BIT(31) -+#define BIT_BCNDMAINT_P3_MSK_8822C BIT(30) -+#define BIT_BCNDMAINT_P2_MSK_8822C BIT(29) -+#define BIT_BCNDMAINT_P1_MSK_8822C BIT(28) -+#define BIT_ATIMEND7_MSK_8822C BIT(22) -+#define BIT_ATIMEND6_MSK_8822C BIT(21) -+#define BIT_ATIMEND5_MSK_8822C BIT(20) -+#define BIT_ATIMEND4_MSK_8822C BIT(19) -+#define BIT_ATIMEND3_MSK_8822C BIT(18) -+#define BIT_ATIMEND2_MSK_8822C BIT(17) -+#define BIT_ATIMEND1_MSK_8822C BIT(16) -+#define BIT_TXBCN7OK_MSK_8822C BIT(14) -+#define BIT_TXBCN6OK_MSK_8822C BIT(13) -+#define BIT_TXBCN5OK_MSK_8822C BIT(12) -+#define BIT_TXBCN4OK_MSK_8822C BIT(11) -+#define BIT_TXBCN3OK_MSK_8822C BIT(10) -+#define BIT_TXBCN2OK_MSK_8822C BIT(9) -+#define BIT_TXBCN1OK_MSK_V1_8822C BIT(8) -+#define BIT_TXBCN7ERR_MSK_8822C BIT(6) -+#define BIT_TXBCN6ERR_MSK_8822C BIT(5) -+#define BIT_TXBCN5ERR_MSK_8822C BIT(4) -+#define BIT_TXBCN4ERR_MSK_8822C BIT(3) -+#define BIT_TXBCN3ERR_MSK_8822C BIT(2) -+#define BIT_TXBCN2ERR_MSK_8822C BIT(1) -+#define BIT_TXBCN1ERR_MSK_V1_8822C BIT(0) -+ -+/* 2 REG_HISR2_8822C */ -+#define BIT_BCNDMAINT_P4_8822C BIT(31) -+#define BIT_BCNDMAINT_P3_8822C BIT(30) -+#define BIT_BCNDMAINT_P2_8822C BIT(29) -+#define BIT_BCNDMAINT_P1_8822C BIT(28) -+#define BIT_ATIMEND7_8822C BIT(22) -+#define BIT_ATIMEND6_8822C BIT(21) -+#define BIT_ATIMEND5_8822C BIT(20) -+#define BIT_ATIMEND4_8822C BIT(19) -+#define BIT_ATIMEND3_8822C BIT(18) -+#define BIT_ATIMEND2_8822C BIT(17) -+#define BIT_ATIMEND1_8822C BIT(16) -+#define BIT_TXBCN7OK_8822C BIT(14) -+#define BIT_TXBCN6OK_8822C BIT(13) -+#define BIT_TXBCN5OK_8822C BIT(12) -+#define BIT_TXBCN4OK_8822C BIT(11) -+#define BIT_TXBCN3OK_8822C BIT(10) -+#define BIT_TXBCN2OK_8822C BIT(9) -+#define BIT_TXBCN1OK_8822C BIT(8) -+#define BIT_TXBCN7ERR_8822C BIT(6) -+#define BIT_TXBCN6ERR_8822C BIT(5) -+#define BIT_TXBCN5ERR_8822C BIT(4) -+#define BIT_TXBCN4ERR_8822C BIT(3) -+#define BIT_TXBCN3ERR_8822C BIT(2) -+#define BIT_TXBCN2ERR_8822C BIT(1) -+#define BIT_TXBCN1ERR_8822C BIT(0) -+ -+/* 2 REG_HIMR3_8822C */ -+#define BIT_WDT_PLATFORM_INT_MSK_8822C BIT(18) -+#define BIT_WDT_CPU_INT_MSK_8822C BIT(17) -+#define BIT_SETH2CDOK_MASK_8822C BIT(16) -+#define BIT_H2C_CMD_FULL_MASK_8822C BIT(15) -+#define BIT_PWR_INT_127_MASK_8822C BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_MASK_8822C BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_MASK_8822C BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_MASK_8822C BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_MAS_8822C BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_MASK_8822C BIT(9) -+#define BIT_PWR_INT_127_MASK_V1_8822C BIT(8) -+#define BIT_PWR_INT_126TO96_MASK_8822C BIT(7) -+#define BIT_PWR_INT_95TO64_MASK_8822C BIT(6) -+#define BIT_PWR_INT_63TO32_MASK_8822C BIT(5) -+#define BIT_PWR_INT_31TO0_MASK_8822C BIT(4) -+#define BIT_RX_DMA_STUCK_MSK_8822C BIT(3) -+#define BIT_TX_DMA_STUCK_MSK_8822C BIT(2) -+#define BIT_DDMA0_LP_INT_MSK_8822C BIT(1) -+#define BIT_DDMA0_HP_INT_MSK_8822C BIT(0) -+ -+/* 2 REG_HISR3_8822C */ -+#define BIT_WDT_PLATFORM_INT_8822C BIT(18) -+#define BIT_WDT_CPU_INT_8822C BIT(17) -+#define BIT_SETH2CDOK_8822C BIT(16) -+#define BIT_H2C_CMD_FULL_8822C BIT(15) -+#define BIT_PWR_INT_127_8822C BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_8822C BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_8822C BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_8822C BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_8822C BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_8822C BIT(9) -+#define BIT_PWR_INT_127_V1_8822C BIT(8) -+#define BIT_PWR_INT_126TO96_8822C BIT(7) -+#define BIT_PWR_INT_95TO64_8822C BIT(6) -+#define BIT_PWR_INT_63TO32_8822C BIT(5) -+#define BIT_PWR_INT_31TO0_8822C BIT(4) -+#define BIT_RX_DMA_STUCK_8822C BIT(3) -+#define BIT_TX_DMA_STUCK_8822C BIT(2) -+#define BIT_DDMA0_LP_INT_8822C BIT(1) -+#define BIT_DDMA0_HP_INT_8822C BIT(0) -+ -+/* 2 REG_SW_MDIO_8822C */ -+#define BIT_DIS_TIMEOUT_IO_8822C BIT(24) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_H2C_PKT_READADDR_8822C */ -+ -+#define BIT_SHIFT_H2C_PKT_READADDR_8822C 0 -+#define BIT_MASK_H2C_PKT_READADDR_8822C 0x3ffff -+#define BIT_H2C_PKT_READADDR_8822C(x) \ -+ (((x) & BIT_MASK_H2C_PKT_READADDR_8822C) \ -+ << BIT_SHIFT_H2C_PKT_READADDR_8822C) -+#define BITS_H2C_PKT_READADDR_8822C \ -+ (BIT_MASK_H2C_PKT_READADDR_8822C << BIT_SHIFT_H2C_PKT_READADDR_8822C) -+#define BIT_CLEAR_H2C_PKT_READADDR_8822C(x) \ -+ ((x) & (~BITS_H2C_PKT_READADDR_8822C)) -+#define BIT_GET_H2C_PKT_READADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_READADDR_8822C) & \ -+ BIT_MASK_H2C_PKT_READADDR_8822C) -+#define BIT_SET_H2C_PKT_READADDR_8822C(x, v) \ -+ (BIT_CLEAR_H2C_PKT_READADDR_8822C(x) | BIT_H2C_PKT_READADDR_8822C(v)) -+ -+/* 2 REG_H2C_PKT_WRITEADDR_8822C */ -+ -+#define BIT_SHIFT_H2C_PKT_WRITEADDR_8822C 0 -+#define BIT_MASK_H2C_PKT_WRITEADDR_8822C 0x3ffff -+#define BIT_H2C_PKT_WRITEADDR_8822C(x) \ -+ (((x) & BIT_MASK_H2C_PKT_WRITEADDR_8822C) \ -+ << BIT_SHIFT_H2C_PKT_WRITEADDR_8822C) -+#define BITS_H2C_PKT_WRITEADDR_8822C \ -+ (BIT_MASK_H2C_PKT_WRITEADDR_8822C << BIT_SHIFT_H2C_PKT_WRITEADDR_8822C) -+#define BIT_CLEAR_H2C_PKT_WRITEADDR_8822C(x) \ -+ ((x) & (~BITS_H2C_PKT_WRITEADDR_8822C)) -+#define BIT_GET_H2C_PKT_WRITEADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2C_PKT_WRITEADDR_8822C) & \ -+ BIT_MASK_H2C_PKT_WRITEADDR_8822C) -+#define BIT_SET_H2C_PKT_WRITEADDR_8822C(x, v) \ -+ (BIT_CLEAR_H2C_PKT_WRITEADDR_8822C(x) | BIT_H2C_PKT_WRITEADDR_8822C(v)) -+ -+/* 2 REG_MEM_PWR_CRTL_8822C */ -+#define BIT_MEM_BB_SD_8822C BIT(17) -+#define BIT_MEM_BB_DS_8822C BIT(16) -+#define BIT_MEM_BT_DS_8822C BIT(10) -+#define BIT_MEM_SDIO_LS_8822C BIT(9) -+#define BIT_MEM_SDIO_DS_8822C BIT(8) -+#define BIT_MEM_USB_LS_8822C BIT(7) -+#define BIT_MEM_USB_DS_8822C BIT(6) -+#define BIT_MEM_PCI_LS_8822C BIT(5) -+#define BIT_MEM_PCI_DS_8822C BIT(4) -+#define BIT_MEM_WLMAC_LS_8822C BIT(3) -+#define BIT_MEM_WLMAC_DS_8822C BIT(2) -+#define BIT_MEM_WLMCU_LS_8822C BIT(1) -+#define BIT_MEM_WLMCU_DS_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_FW_DBG6_8822C */ -+ -+#define BIT_SHIFT_FW_DBG6_8822C 0 -+#define BIT_MASK_FW_DBG6_8822C 0xffffffffL -+#define BIT_FW_DBG6_8822C(x) \ -+ (((x) & BIT_MASK_FW_DBG6_8822C) << BIT_SHIFT_FW_DBG6_8822C) -+#define BITS_FW_DBG6_8822C (BIT_MASK_FW_DBG6_8822C << BIT_SHIFT_FW_DBG6_8822C) -+#define BIT_CLEAR_FW_DBG6_8822C(x) ((x) & (~BITS_FW_DBG6_8822C)) -+#define BIT_GET_FW_DBG6_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG6_8822C) & BIT_MASK_FW_DBG6_8822C) -+#define BIT_SET_FW_DBG6_8822C(x, v) \ -+ (BIT_CLEAR_FW_DBG6_8822C(x) | BIT_FW_DBG6_8822C(v)) -+ -+/* 2 REG_FW_DBG7_8822C */ -+ -+#define BIT_SHIFT_FW_DBG7_8822C 0 -+#define BIT_MASK_FW_DBG7_8822C 0xffffffffL -+#define BIT_FW_DBG7_8822C(x) \ -+ (((x) & BIT_MASK_FW_DBG7_8822C) << BIT_SHIFT_FW_DBG7_8822C) -+#define BITS_FW_DBG7_8822C (BIT_MASK_FW_DBG7_8822C << BIT_SHIFT_FW_DBG7_8822C) -+#define BIT_CLEAR_FW_DBG7_8822C(x) ((x) & (~BITS_FW_DBG7_8822C)) -+#define BIT_GET_FW_DBG7_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_DBG7_8822C) & BIT_MASK_FW_DBG7_8822C) -+#define BIT_SET_FW_DBG7_8822C(x, v) \ -+ (BIT_CLEAR_FW_DBG7_8822C(x) | BIT_FW_DBG7_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_CR_8822C */ -+ -+#define BIT_SHIFT_LBMODE_8822C 24 -+#define BIT_MASK_LBMODE_8822C 0x1f -+#define BIT_LBMODE_8822C(x) \ -+ (((x) & BIT_MASK_LBMODE_8822C) << BIT_SHIFT_LBMODE_8822C) -+#define BITS_LBMODE_8822C (BIT_MASK_LBMODE_8822C << BIT_SHIFT_LBMODE_8822C) -+#define BIT_CLEAR_LBMODE_8822C(x) ((x) & (~BITS_LBMODE_8822C)) -+#define BIT_GET_LBMODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_LBMODE_8822C) & BIT_MASK_LBMODE_8822C) -+#define BIT_SET_LBMODE_8822C(x, v) \ -+ (BIT_CLEAR_LBMODE_8822C(x) | BIT_LBMODE_8822C(v)) -+ -+#define BIT_SHIFT_NETYPE1_8822C 18 -+#define BIT_MASK_NETYPE1_8822C 0x3 -+#define BIT_NETYPE1_8822C(x) \ -+ (((x) & BIT_MASK_NETYPE1_8822C) << BIT_SHIFT_NETYPE1_8822C) -+#define BITS_NETYPE1_8822C (BIT_MASK_NETYPE1_8822C << BIT_SHIFT_NETYPE1_8822C) -+#define BIT_CLEAR_NETYPE1_8822C(x) ((x) & (~BITS_NETYPE1_8822C)) -+#define BIT_GET_NETYPE1_8822C(x) \ -+ (((x) >> BIT_SHIFT_NETYPE1_8822C) & BIT_MASK_NETYPE1_8822C) -+#define BIT_SET_NETYPE1_8822C(x, v) \ -+ (BIT_CLEAR_NETYPE1_8822C(x) | BIT_NETYPE1_8822C(v)) -+ -+#define BIT_SHIFT_NETYPE0_8822C 16 -+#define BIT_MASK_NETYPE0_8822C 0x3 -+#define BIT_NETYPE0_8822C(x) \ -+ (((x) & BIT_MASK_NETYPE0_8822C) << BIT_SHIFT_NETYPE0_8822C) -+#define BITS_NETYPE0_8822C (BIT_MASK_NETYPE0_8822C << BIT_SHIFT_NETYPE0_8822C) -+#define BIT_CLEAR_NETYPE0_8822C(x) ((x) & (~BITS_NETYPE0_8822C)) -+#define BIT_GET_NETYPE0_8822C(x) \ -+ (((x) >> BIT_SHIFT_NETYPE0_8822C) & BIT_MASK_NETYPE0_8822C) -+#define BIT_SET_NETYPE0_8822C(x, v) \ -+ (BIT_CLEAR_NETYPE0_8822C(x) | BIT_NETYPE0_8822C(v)) -+ -+#define BIT_COUNTER_STS_EN_8822C BIT(13) -+#define BIT_I2C_MAILBOX_EN_8822C BIT(12) -+#define BIT_SHCUT_EN_8822C BIT(11) -+#define BIT_32K_CAL_TMR_EN_8822C BIT(10) -+#define BIT_MAC_SEC_EN_8822C BIT(9) -+#define BIT_ENSWBCN_8822C BIT(8) -+#define BIT_MACRXEN_8822C BIT(7) -+#define BIT_MACTXEN_8822C BIT(6) -+#define BIT_SCHEDULE_EN_8822C BIT(5) -+#define BIT_PROTOCOL_EN_8822C BIT(4) -+#define BIT_RXDMA_EN_8822C BIT(3) -+#define BIT_TXDMA_EN_8822C BIT(2) -+#define BIT_HCI_RXDMA_EN_8822C BIT(1) -+#define BIT_HCI_TXDMA_EN_8822C BIT(0) -+ -+/* 2 REG_PG_SIZE_8822C */ -+ -+#define BIT_SHIFT_DBG_FIFO_SEL_8822C 16 -+#define BIT_MASK_DBG_FIFO_SEL_8822C 0xff -+#define BIT_DBG_FIFO_SEL_8822C(x) \ -+ (((x) & BIT_MASK_DBG_FIFO_SEL_8822C) << BIT_SHIFT_DBG_FIFO_SEL_8822C) -+#define BITS_DBG_FIFO_SEL_8822C \ -+ (BIT_MASK_DBG_FIFO_SEL_8822C << BIT_SHIFT_DBG_FIFO_SEL_8822C) -+#define BIT_CLEAR_DBG_FIFO_SEL_8822C(x) ((x) & (~BITS_DBG_FIFO_SEL_8822C)) -+#define BIT_GET_DBG_FIFO_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_DBG_FIFO_SEL_8822C) & BIT_MASK_DBG_FIFO_SEL_8822C) -+#define BIT_SET_DBG_FIFO_SEL_8822C(x, v) \ -+ (BIT_CLEAR_DBG_FIFO_SEL_8822C(x) | BIT_DBG_FIFO_SEL_8822C(v)) -+ -+/* 2 REG_PKT_BUFF_ACCESS_CTRL_8822C */ -+ -+#define BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8822C 0 -+#define BIT_MASK_PKT_BUFF_ACCESS_CTRL_8822C 0xff -+#define BIT_PKT_BUFF_ACCESS_CTRL_8822C(x) \ -+ (((x) & BIT_MASK_PKT_BUFF_ACCESS_CTRL_8822C) \ -+ << BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8822C) -+#define BITS_PKT_BUFF_ACCESS_CTRL_8822C \ -+ (BIT_MASK_PKT_BUFF_ACCESS_CTRL_8822C \ -+ << BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8822C) -+#define BIT_CLEAR_PKT_BUFF_ACCESS_CTRL_8822C(x) \ -+ ((x) & (~BITS_PKT_BUFF_ACCESS_CTRL_8822C)) -+#define BIT_GET_PKT_BUFF_ACCESS_CTRL_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKT_BUFF_ACCESS_CTRL_8822C) & \ -+ BIT_MASK_PKT_BUFF_ACCESS_CTRL_8822C) -+#define BIT_SET_PKT_BUFF_ACCESS_CTRL_8822C(x, v) \ -+ (BIT_CLEAR_PKT_BUFF_ACCESS_CTRL_8822C(x) | \ -+ BIT_PKT_BUFF_ACCESS_CTRL_8822C(v)) -+ -+/* 2 REG_TSF_CLK_STATE_8822C */ -+#define BIT_TSF_CLK_STABLE_8822C BIT(15) -+ -+/* 2 REG_TXDMA_PQ_MAP_8822C */ -+#define BIT_CSI_BW_EN_8822C BIT(31) -+ -+#define BIT_SHIFT_TXDMA_H2C_MAP_8822C 16 -+#define BIT_MASK_TXDMA_H2C_MAP_8822C 0x3 -+#define BIT_TXDMA_H2C_MAP_8822C(x) \ -+ (((x) & BIT_MASK_TXDMA_H2C_MAP_8822C) << BIT_SHIFT_TXDMA_H2C_MAP_8822C) -+#define BITS_TXDMA_H2C_MAP_8822C \ -+ (BIT_MASK_TXDMA_H2C_MAP_8822C << BIT_SHIFT_TXDMA_H2C_MAP_8822C) -+#define BIT_CLEAR_TXDMA_H2C_MAP_8822C(x) ((x) & (~BITS_TXDMA_H2C_MAP_8822C)) -+#define BIT_GET_TXDMA_H2C_MAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_H2C_MAP_8822C) & BIT_MASK_TXDMA_H2C_MAP_8822C) -+#define BIT_SET_TXDMA_H2C_MAP_8822C(x, v) \ -+ (BIT_CLEAR_TXDMA_H2C_MAP_8822C(x) | BIT_TXDMA_H2C_MAP_8822C(v)) -+ -+#define BIT_SHIFT_TXDMA_HIQ_MAP_8822C 14 -+#define BIT_MASK_TXDMA_HIQ_MAP_8822C 0x3 -+#define BIT_TXDMA_HIQ_MAP_8822C(x) \ -+ (((x) & BIT_MASK_TXDMA_HIQ_MAP_8822C) << BIT_SHIFT_TXDMA_HIQ_MAP_8822C) -+#define BITS_TXDMA_HIQ_MAP_8822C \ -+ (BIT_MASK_TXDMA_HIQ_MAP_8822C << BIT_SHIFT_TXDMA_HIQ_MAP_8822C) -+#define BIT_CLEAR_TXDMA_HIQ_MAP_8822C(x) ((x) & (~BITS_TXDMA_HIQ_MAP_8822C)) -+#define BIT_GET_TXDMA_HIQ_MAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_HIQ_MAP_8822C) & BIT_MASK_TXDMA_HIQ_MAP_8822C) -+#define BIT_SET_TXDMA_HIQ_MAP_8822C(x, v) \ -+ (BIT_CLEAR_TXDMA_HIQ_MAP_8822C(x) | BIT_TXDMA_HIQ_MAP_8822C(v)) -+ -+#define BIT_SHIFT_TXDMA_MGQ_MAP_8822C 12 -+#define BIT_MASK_TXDMA_MGQ_MAP_8822C 0x3 -+#define BIT_TXDMA_MGQ_MAP_8822C(x) \ -+ (((x) & BIT_MASK_TXDMA_MGQ_MAP_8822C) << BIT_SHIFT_TXDMA_MGQ_MAP_8822C) -+#define BITS_TXDMA_MGQ_MAP_8822C \ -+ (BIT_MASK_TXDMA_MGQ_MAP_8822C << BIT_SHIFT_TXDMA_MGQ_MAP_8822C) -+#define BIT_CLEAR_TXDMA_MGQ_MAP_8822C(x) ((x) & (~BITS_TXDMA_MGQ_MAP_8822C)) -+#define BIT_GET_TXDMA_MGQ_MAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_MGQ_MAP_8822C) & BIT_MASK_TXDMA_MGQ_MAP_8822C) -+#define BIT_SET_TXDMA_MGQ_MAP_8822C(x, v) \ -+ (BIT_CLEAR_TXDMA_MGQ_MAP_8822C(x) | BIT_TXDMA_MGQ_MAP_8822C(v)) -+ -+#define BIT_SHIFT_TXDMA_BKQ_MAP_8822C 10 -+#define BIT_MASK_TXDMA_BKQ_MAP_8822C 0x3 -+#define BIT_TXDMA_BKQ_MAP_8822C(x) \ -+ (((x) & BIT_MASK_TXDMA_BKQ_MAP_8822C) << BIT_SHIFT_TXDMA_BKQ_MAP_8822C) -+#define BITS_TXDMA_BKQ_MAP_8822C \ -+ (BIT_MASK_TXDMA_BKQ_MAP_8822C << BIT_SHIFT_TXDMA_BKQ_MAP_8822C) -+#define BIT_CLEAR_TXDMA_BKQ_MAP_8822C(x) ((x) & (~BITS_TXDMA_BKQ_MAP_8822C)) -+#define BIT_GET_TXDMA_BKQ_MAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BKQ_MAP_8822C) & BIT_MASK_TXDMA_BKQ_MAP_8822C) -+#define BIT_SET_TXDMA_BKQ_MAP_8822C(x, v) \ -+ (BIT_CLEAR_TXDMA_BKQ_MAP_8822C(x) | BIT_TXDMA_BKQ_MAP_8822C(v)) -+ -+#define BIT_SHIFT_TXDMA_BEQ_MAP_8822C 8 -+#define BIT_MASK_TXDMA_BEQ_MAP_8822C 0x3 -+#define BIT_TXDMA_BEQ_MAP_8822C(x) \ -+ (((x) & BIT_MASK_TXDMA_BEQ_MAP_8822C) << BIT_SHIFT_TXDMA_BEQ_MAP_8822C) -+#define BITS_TXDMA_BEQ_MAP_8822C \ -+ (BIT_MASK_TXDMA_BEQ_MAP_8822C << BIT_SHIFT_TXDMA_BEQ_MAP_8822C) -+#define BIT_CLEAR_TXDMA_BEQ_MAP_8822C(x) ((x) & (~BITS_TXDMA_BEQ_MAP_8822C)) -+#define BIT_GET_TXDMA_BEQ_MAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_BEQ_MAP_8822C) & BIT_MASK_TXDMA_BEQ_MAP_8822C) -+#define BIT_SET_TXDMA_BEQ_MAP_8822C(x, v) \ -+ (BIT_CLEAR_TXDMA_BEQ_MAP_8822C(x) | BIT_TXDMA_BEQ_MAP_8822C(v)) -+ -+#define BIT_SHIFT_TXDMA_VIQ_MAP_8822C 6 -+#define BIT_MASK_TXDMA_VIQ_MAP_8822C 0x3 -+#define BIT_TXDMA_VIQ_MAP_8822C(x) \ -+ (((x) & BIT_MASK_TXDMA_VIQ_MAP_8822C) << BIT_SHIFT_TXDMA_VIQ_MAP_8822C) -+#define BITS_TXDMA_VIQ_MAP_8822C \ -+ (BIT_MASK_TXDMA_VIQ_MAP_8822C << BIT_SHIFT_TXDMA_VIQ_MAP_8822C) -+#define BIT_CLEAR_TXDMA_VIQ_MAP_8822C(x) ((x) & (~BITS_TXDMA_VIQ_MAP_8822C)) -+#define BIT_GET_TXDMA_VIQ_MAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VIQ_MAP_8822C) & BIT_MASK_TXDMA_VIQ_MAP_8822C) -+#define BIT_SET_TXDMA_VIQ_MAP_8822C(x, v) \ -+ (BIT_CLEAR_TXDMA_VIQ_MAP_8822C(x) | BIT_TXDMA_VIQ_MAP_8822C(v)) -+ -+#define BIT_SHIFT_TXDMA_VOQ_MAP_8822C 4 -+#define BIT_MASK_TXDMA_VOQ_MAP_8822C 0x3 -+#define BIT_TXDMA_VOQ_MAP_8822C(x) \ -+ (((x) & BIT_MASK_TXDMA_VOQ_MAP_8822C) << BIT_SHIFT_TXDMA_VOQ_MAP_8822C) -+#define BITS_TXDMA_VOQ_MAP_8822C \ -+ (BIT_MASK_TXDMA_VOQ_MAP_8822C << BIT_SHIFT_TXDMA_VOQ_MAP_8822C) -+#define BIT_CLEAR_TXDMA_VOQ_MAP_8822C(x) ((x) & (~BITS_TXDMA_VOQ_MAP_8822C)) -+#define BIT_GET_TXDMA_VOQ_MAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_VOQ_MAP_8822C) & BIT_MASK_TXDMA_VOQ_MAP_8822C) -+#define BIT_SET_TXDMA_VOQ_MAP_8822C(x, v) \ -+ (BIT_CLEAR_TXDMA_VOQ_MAP_8822C(x) | BIT_TXDMA_VOQ_MAP_8822C(v)) -+ -+#define BIT_TXDMA_BW_EN_8822C BIT(3) -+#define BIT_RXDMA_AGG_EN_8822C BIT(2) -+#define BIT_RXSHFT_EN_8822C BIT(1) -+#define BIT_RXDMA_ARBBW_EN_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_TRXFF_BNDY_8822C */ -+ -+#define BIT_SHIFT_FWFFOVFL_RSV_8822C 16 -+#define BIT_MASK_FWFFOVFL_RSV_8822C 0xf -+#define BIT_FWFFOVFL_RSV_8822C(x) \ -+ (((x) & BIT_MASK_FWFFOVFL_RSV_8822C) << BIT_SHIFT_FWFFOVFL_RSV_8822C) -+#define BITS_FWFFOVFL_RSV_8822C \ -+ (BIT_MASK_FWFFOVFL_RSV_8822C << BIT_SHIFT_FWFFOVFL_RSV_8822C) -+#define BIT_CLEAR_FWFFOVFL_RSV_8822C(x) ((x) & (~BITS_FWFFOVFL_RSV_8822C)) -+#define BIT_GET_FWFFOVFL_RSV_8822C(x) \ -+ (((x) >> BIT_SHIFT_FWFFOVFL_RSV_8822C) & BIT_MASK_FWFFOVFL_RSV_8822C) -+#define BIT_SET_FWFFOVFL_RSV_8822C(x, v) \ -+ (BIT_CLEAR_FWFFOVFL_RSV_8822C(x) | BIT_FWFFOVFL_RSV_8822C(v)) -+ -+#define BIT_SHIFT_RXFFOVFL_RSV_V2_8822C 8 -+#define BIT_MASK_RXFFOVFL_RSV_V2_8822C 0xf -+#define BIT_RXFFOVFL_RSV_V2_8822C(x) \ -+ (((x) & BIT_MASK_RXFFOVFL_RSV_V2_8822C) \ -+ << BIT_SHIFT_RXFFOVFL_RSV_V2_8822C) -+#define BITS_RXFFOVFL_RSV_V2_8822C \ -+ (BIT_MASK_RXFFOVFL_RSV_V2_8822C << BIT_SHIFT_RXFFOVFL_RSV_V2_8822C) -+#define BIT_CLEAR_RXFFOVFL_RSV_V2_8822C(x) ((x) & (~BITS_RXFFOVFL_RSV_V2_8822C)) -+#define BIT_GET_RXFFOVFL_RSV_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXFFOVFL_RSV_V2_8822C) & \ -+ BIT_MASK_RXFFOVFL_RSV_V2_8822C) -+#define BIT_SET_RXFFOVFL_RSV_V2_8822C(x, v) \ -+ (BIT_CLEAR_RXFFOVFL_RSV_V2_8822C(x) | BIT_RXFFOVFL_RSV_V2_8822C(v)) -+ -+/* 2 REG_PTA_I2C_MBOX_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_I2C_M_STATUS_8822C 8 -+#define BIT_MASK_I2C_M_STATUS_8822C 0xf -+#define BIT_I2C_M_STATUS_8822C(x) \ -+ (((x) & BIT_MASK_I2C_M_STATUS_8822C) << BIT_SHIFT_I2C_M_STATUS_8822C) -+#define BITS_I2C_M_STATUS_8822C \ -+ (BIT_MASK_I2C_M_STATUS_8822C << BIT_SHIFT_I2C_M_STATUS_8822C) -+#define BIT_CLEAR_I2C_M_STATUS_8822C(x) ((x) & (~BITS_I2C_M_STATUS_8822C)) -+#define BIT_GET_I2C_M_STATUS_8822C(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_STATUS_8822C) & BIT_MASK_I2C_M_STATUS_8822C) -+#define BIT_SET_I2C_M_STATUS_8822C(x, v) \ -+ (BIT_CLEAR_I2C_M_STATUS_8822C(x) | BIT_I2C_M_STATUS_8822C(v)) -+ -+#define BIT_SHIFT_I2C_M_BUS_GNT_FW_8822C 4 -+#define BIT_MASK_I2C_M_BUS_GNT_FW_8822C 0x7 -+#define BIT_I2C_M_BUS_GNT_FW_8822C(x) \ -+ (((x) & BIT_MASK_I2C_M_BUS_GNT_FW_8822C) \ -+ << BIT_SHIFT_I2C_M_BUS_GNT_FW_8822C) -+#define BITS_I2C_M_BUS_GNT_FW_8822C \ -+ (BIT_MASK_I2C_M_BUS_GNT_FW_8822C << BIT_SHIFT_I2C_M_BUS_GNT_FW_8822C) -+#define BIT_CLEAR_I2C_M_BUS_GNT_FW_8822C(x) \ -+ ((x) & (~BITS_I2C_M_BUS_GNT_FW_8822C)) -+#define BIT_GET_I2C_M_BUS_GNT_FW_8822C(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_BUS_GNT_FW_8822C) & \ -+ BIT_MASK_I2C_M_BUS_GNT_FW_8822C) -+#define BIT_SET_I2C_M_BUS_GNT_FW_8822C(x, v) \ -+ (BIT_CLEAR_I2C_M_BUS_GNT_FW_8822C(x) | BIT_I2C_M_BUS_GNT_FW_8822C(v)) -+ -+#define BIT_I2C_M_GNT_FW_8822C BIT(3) -+ -+#define BIT_SHIFT_I2C_M_SPEED_8822C 1 -+#define BIT_MASK_I2C_M_SPEED_8822C 0x3 -+#define BIT_I2C_M_SPEED_8822C(x) \ -+ (((x) & BIT_MASK_I2C_M_SPEED_8822C) << BIT_SHIFT_I2C_M_SPEED_8822C) -+#define BITS_I2C_M_SPEED_8822C \ -+ (BIT_MASK_I2C_M_SPEED_8822C << BIT_SHIFT_I2C_M_SPEED_8822C) -+#define BIT_CLEAR_I2C_M_SPEED_8822C(x) ((x) & (~BITS_I2C_M_SPEED_8822C)) -+#define BIT_GET_I2C_M_SPEED_8822C(x) \ -+ (((x) >> BIT_SHIFT_I2C_M_SPEED_8822C) & BIT_MASK_I2C_M_SPEED_8822C) -+#define BIT_SET_I2C_M_SPEED_8822C(x, v) \ -+ (BIT_CLEAR_I2C_M_SPEED_8822C(x) | BIT_I2C_M_SPEED_8822C(v)) -+ -+#define BIT_I2C_M_UNLOCK_8822C BIT(0) -+ -+/* 2 REG_RXFF_BNDY_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_RXFF0_BNDY_V2_8822C 0 -+#define BIT_MASK_RXFF0_BNDY_V2_8822C 0x3ffff -+#define BIT_RXFF0_BNDY_V2_8822C(x) \ -+ (((x) & BIT_MASK_RXFF0_BNDY_V2_8822C) << BIT_SHIFT_RXFF0_BNDY_V2_8822C) -+#define BITS_RXFF0_BNDY_V2_8822C \ -+ (BIT_MASK_RXFF0_BNDY_V2_8822C << BIT_SHIFT_RXFF0_BNDY_V2_8822C) -+#define BIT_CLEAR_RXFF0_BNDY_V2_8822C(x) ((x) & (~BITS_RXFF0_BNDY_V2_8822C)) -+#define BIT_GET_RXFF0_BNDY_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_BNDY_V2_8822C) & BIT_MASK_RXFF0_BNDY_V2_8822C) -+#define BIT_SET_RXFF0_BNDY_V2_8822C(x, v) \ -+ (BIT_CLEAR_RXFF0_BNDY_V2_8822C(x) | BIT_RXFF0_BNDY_V2_8822C(v)) -+ -+/* 2 REG_FE1IMR_8822C */ -+#define BIT_FS_SW_PLL_LEAVE_32K_INT_EN_8822C BIT(31) -+#define BIT_FS_FWFF_FULL_INT_EN_8822C BIT(30) -+#define BIT_FS_BB_STOP_RX_INT_EN_8822C BIT(29) -+#define BIT_FS_RXDMA2_DONE_INT_EN_8822C BIT(28) -+#define BIT_FS_RXDONE2_INT_EN_8822C BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_EN_8822C BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_EN_8822C BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_EN_8822C BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_EN_8822C BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_EN_8822C BIT(21) -+#define BIT_FS_RX_UMD0_INT_EN_8822C BIT(20) -+#define BIT_FS_RX_UMD1_INT_EN_8822C BIT(19) -+#define BIT_FS_RX_BMD0_INT_EN_8822C BIT(18) -+#define BIT_FS_RX_BMD1_INT_EN_8822C BIT(17) -+#define BIT_FS_RXDONE_INT_EN_8822C BIT(16) -+#define BIT_FS_WWLAN_INT_EN_8822C BIT(15) -+#define BIT_FS_SOUND_DONE_INT_EN_8822C BIT(14) -+#define BIT_FS_BF1_PRETO_INT_EN_8822C BIT(11) -+#define BIT_FS_BF0_PRETO_INT_EN_8822C BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_EN_8822C BIT(9) -+#define BIT_FS_PRETX_ERRHLD_INT_EN_8822C BIT(8) -+#define BIT_FS_LTE_COEX_EN_8822C BIT(6) -+#define BIT_FS_WLACTOFF_INT_EN_8822C BIT(5) -+#define BIT_FS_WLACTON_INT_EN_8822C BIT(4) -+#define BIT_FS_BTCMD_INT_EN_8822C BIT(3) -+#define BIT_FS_REG_MAILBOX_TO_I2C_INT_EN_8822C BIT(2) -+#define BIT_FS_TRPC_TO_INT_EN_V1_8822C BIT(1) -+#define BIT_FS_RPC_O_T_INT_EN_V1_8822C BIT(0) -+ -+/* 2 REG_FE1ISR_8822C */ -+#define BIT_FS_SW_PLL_LEAVE_32K_INT_8822C BIT(31) -+#define BIT_FS_FS_FWFF_FULL_INT_8822C BIT(30) -+#define BIT_FS_BB_STOP_RX_INT_8822C BIT(29) -+#define BIT_FS_RXDMA2_DONE_INT_8822C BIT(28) -+#define BIT_FS_RXDONE2_INT_8822C BIT(26) -+#define BIT_FS_RX_BCN_P4_INT_8822C BIT(25) -+#define BIT_FS_RX_BCN_P3_INT_8822C BIT(24) -+#define BIT_FS_RX_BCN_P2_INT_8822C BIT(23) -+#define BIT_FS_RX_BCN_P1_INT_8822C BIT(22) -+#define BIT_FS_RX_BCN_P0_INT_8822C BIT(21) -+#define BIT_FS_RX_UMD0_INT_8822C BIT(20) -+#define BIT_FS_RX_UMD1_INT_8822C BIT(19) -+#define BIT_FS_RX_BMD0_INT_8822C BIT(18) -+#define BIT_FS_RX_BMD1_INT_8822C BIT(17) -+#define BIT_FS_RXDONE_INT_8822C BIT(16) -+#define BIT_FS_WWLAN_INT_8822C BIT(15) -+#define BIT_FS_SOUND_DONE_INT_8822C BIT(14) -+#define BIT_FS_BF1_PRETO_INT_8822C BIT(11) -+#define BIT_FS_BF0_PRETO_INT_8822C BIT(10) -+#define BIT_FS_PTCL_RELEASE_MACID_INT_8822C BIT(9) -+#define BIT_FS_PRETX_ERRHLD_INT_8822C BIT(8) -+#define BIT_FS_LTE_COEX_INT_8822C BIT(6) -+#define BIT_FS_WLACTOFF_INT_8822C BIT(5) -+#define BIT_FS_WLACTON_INT_8822C BIT(4) -+#define BIT_FS_BCN_RX_INT_INT_8822C BIT(3) -+#define BIT_FS_MAILBOX_TO_I2C_INT_8822C BIT(2) -+#define BIT_FS_TRPC_TO_INT_8822C BIT(1) -+#define BIT_FS_RPC_O_T_INT_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_CPWM_8822C */ -+#define BIT_CPWM_TOGGLING_8822C BIT(31) -+ -+#define BIT_SHIFT_CPWM_MOD_8822C 24 -+#define BIT_MASK_CPWM_MOD_8822C 0x7f -+#define BIT_CPWM_MOD_8822C(x) \ -+ (((x) & BIT_MASK_CPWM_MOD_8822C) << BIT_SHIFT_CPWM_MOD_8822C) -+#define BITS_CPWM_MOD_8822C \ -+ (BIT_MASK_CPWM_MOD_8822C << BIT_SHIFT_CPWM_MOD_8822C) -+#define BIT_CLEAR_CPWM_MOD_8822C(x) ((x) & (~BITS_CPWM_MOD_8822C)) -+#define BIT_GET_CPWM_MOD_8822C(x) \ -+ (((x) >> BIT_SHIFT_CPWM_MOD_8822C) & BIT_MASK_CPWM_MOD_8822C) -+#define BIT_SET_CPWM_MOD_8822C(x, v) \ -+ (BIT_CLEAR_CPWM_MOD_8822C(x) | BIT_CPWM_MOD_8822C(v)) -+ -+/* 2 REG_FWIMR_8822C */ -+#define BIT_FS_TXBCNOK_MB7_INT_EN_8822C BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_EN_8822C BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_EN_8822C BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_EN_8822C BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_EN_8822C BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_EN_8822C BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_EN_8822C BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_EN_8822C BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_EN_8822C BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_EN_8822C BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_EN_8822C BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_EN_8822C BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_EN_8822C BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_EN_8822C BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_EN_8822C BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_EN_8822C BIT(16) -+#define BIT_CPU_MGQ_TXDONE_INT_EN_8822C BIT(15) -+#define BIT_SIFS_OVERSPEC_INT_EN_8822C BIT(14) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_EN_8822C BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_EN_8822C BIT(12) -+#define BIT_FS_CPUMGQ_ERR_INT_EN_8822C BIT(11) -+#define BIT_FS_DDMA0_LP_INT_EN_8822C BIT(9) -+#define BIT_FS_DDMA0_HP_INT_EN_8822C BIT(8) -+#define BIT_FS_TRXRPT_INT_EN_8822C BIT(7) -+#define BIT_FS_C2H_W_READY_INT_EN_8822C BIT(6) -+#define BIT_FS_HRCV_INT_EN_8822C BIT(5) -+#define BIT_FS_H2CCMD_INT_EN_8822C BIT(4) -+#define BIT_FS_TXPKTIN_INT_EN_8822C BIT(3) -+#define BIT_FS_ERRORHDL_INT_EN_8822C BIT(2) -+#define BIT_FS_TXCCX_INT_EN_8822C BIT(1) -+#define BIT_FS_TXCLOSE_INT_EN_8822C BIT(0) -+ -+/* 2 REG_FWISR_8822C */ -+#define BIT_FS_TXBCNOK_MB7_INT_8822C BIT(31) -+#define BIT_FS_TXBCNOK_MB6_INT_8822C BIT(30) -+#define BIT_FS_TXBCNOK_MB5_INT_8822C BIT(29) -+#define BIT_FS_TXBCNOK_MB4_INT_8822C BIT(28) -+#define BIT_FS_TXBCNOK_MB3_INT_8822C BIT(27) -+#define BIT_FS_TXBCNOK_MB2_INT_8822C BIT(26) -+#define BIT_FS_TXBCNOK_MB1_INT_8822C BIT(25) -+#define BIT_FS_TXBCNOK_MB0_INT_8822C BIT(24) -+#define BIT_FS_TXBCNERR_MB7_INT_8822C BIT(23) -+#define BIT_FS_TXBCNERR_MB6_INT_8822C BIT(22) -+#define BIT_FS_TXBCNERR_MB5_INT_8822C BIT(21) -+#define BIT_FS_TXBCNERR_MB4_INT_8822C BIT(20) -+#define BIT_FS_TXBCNERR_MB3_INT_8822C BIT(19) -+#define BIT_FS_TXBCNERR_MB2_INT_8822C BIT(18) -+#define BIT_FS_TXBCNERR_MB1_INT_8822C BIT(17) -+#define BIT_FS_TXBCNERR_MB0_INT_8822C BIT(16) -+#define BIT_CPU_MGQ_TXDONE_INT_8822C BIT(15) -+#define BIT_SIFS_OVERSPEC_INT_8822C BIT(14) -+#define BIT_FS_MGNTQ_RPTR_RELEASE_INT_8822C BIT(13) -+#define BIT_FS_MGNTQFF_TO_INT_8822C BIT(12) -+#define BIT_FS_CPUMGQ_ERR_INT_8822C BIT(11) -+#define BIT_FS_DDMA0_LP_INT_8822C BIT(9) -+#define BIT_FS_DDMA0_HP_INT_8822C BIT(8) -+#define BIT_FS_TRXRPT_INT_8822C BIT(7) -+#define BIT_FS_C2H_W_READY_INT_8822C BIT(6) -+#define BIT_FS_HRCV_INT_8822C BIT(5) -+#define BIT_FS_H2CCMD_INT_8822C BIT(4) -+#define BIT_FS_TXPKTIN_INT_8822C BIT(3) -+#define BIT_FS_ERRORHDL_INT_8822C BIT(2) -+#define BIT_FS_TXCCX_INT_8822C BIT(1) -+#define BIT_FS_TXCLOSE_INT_8822C BIT(0) -+ -+/* 2 REG_FTIMR_8822C */ -+#define BIT_PS_TIMER_C_EARLY_INT_EN_8822C BIT(23) -+#define BIT_PS_TIMER_B_EARLY_INT_EN_8822C BIT(22) -+#define BIT_PS_TIMER_A_EARLY_INT_EN_8822C BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_EN_8822C BIT(20) -+#define BIT_PS_TIMER_C_INT_EN_8822C BIT(19) -+#define BIT_PS_TIMER_B_INT_EN_8822C BIT(18) -+#define BIT_PS_TIMER_A_INT_EN_8822C BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_EN_8822C BIT(16) -+#define BIT_FS_PS_TIMEOUT2_EN_8822C BIT(15) -+#define BIT_FS_PS_TIMEOUT1_EN_8822C BIT(14) -+#define BIT_FS_PS_TIMEOUT0_EN_8822C BIT(13) -+#define BIT_FS_GTINT8_EN_8822C BIT(8) -+#define BIT_FS_GTINT7_EN_8822C BIT(7) -+#define BIT_FS_GTINT6_EN_8822C BIT(6) -+#define BIT_FS_GTINT5_EN_8822C BIT(5) -+#define BIT_FS_GTINT4_EN_8822C BIT(4) -+#define BIT_FS_GTINT3_EN_8822C BIT(3) -+#define BIT_FS_GTINT2_EN_8822C BIT(2) -+#define BIT_FS_GTINT1_EN_8822C BIT(1) -+#define BIT_FS_GTINT0_EN_8822C BIT(0) -+ -+/* 2 REG_FTISR_8822C */ -+#define BIT_PS_TIMER_C_EARLY__INT_8822C BIT(23) -+#define BIT_PS_TIMER_B_EARLY__INT_8822C BIT(22) -+#define BIT_PS_TIMER_A_EARLY__INT_8822C BIT(21) -+#define BIT_CPUMGQ_TX_TIMER_EARLY_INT_8822C BIT(20) -+#define BIT_PS_TIMER_C_INT_8822C BIT(19) -+#define BIT_PS_TIMER_B_INT_8822C BIT(18) -+#define BIT_PS_TIMER_A_INT_8822C BIT(17) -+#define BIT_CPUMGQ_TX_TIMER_INT_8822C BIT(16) -+#define BIT_FS_PS_TIMEOUT2_INT_8822C BIT(15) -+#define BIT_FS_PS_TIMEOUT1_INT_8822C BIT(14) -+#define BIT_FS_PS_TIMEOUT0_INT_8822C BIT(13) -+#define BIT_FS_GTINT8_INT_8822C BIT(8) -+#define BIT_FS_GTINT7_INT_8822C BIT(7) -+#define BIT_FS_GTINT6_INT_8822C BIT(6) -+#define BIT_FS_GTINT5_INT_8822C BIT(5) -+#define BIT_FS_GTINT4_INT_8822C BIT(4) -+#define BIT_FS_GTINT3_INT_8822C BIT(3) -+#define BIT_FS_GTINT2_INT_8822C BIT(2) -+#define BIT_FS_GTINT1_INT_8822C BIT(1) -+#define BIT_FS_GTINT0_INT_8822C BIT(0) -+ -+/* 2 REG_PKTBUF_DBG_CTRL_8822C */ -+ -+#define BIT_SHIFT_PKTBUF_WRITE_EN_8822C 24 -+#define BIT_MASK_PKTBUF_WRITE_EN_8822C 0xff -+#define BIT_PKTBUF_WRITE_EN_8822C(x) \ -+ (((x) & BIT_MASK_PKTBUF_WRITE_EN_8822C) \ -+ << BIT_SHIFT_PKTBUF_WRITE_EN_8822C) -+#define BITS_PKTBUF_WRITE_EN_8822C \ -+ (BIT_MASK_PKTBUF_WRITE_EN_8822C << BIT_SHIFT_PKTBUF_WRITE_EN_8822C) -+#define BIT_CLEAR_PKTBUF_WRITE_EN_8822C(x) ((x) & (~BITS_PKTBUF_WRITE_EN_8822C)) -+#define BIT_GET_PKTBUF_WRITE_EN_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_WRITE_EN_8822C) & \ -+ BIT_MASK_PKTBUF_WRITE_EN_8822C) -+#define BIT_SET_PKTBUF_WRITE_EN_8822C(x, v) \ -+ (BIT_CLEAR_PKTBUF_WRITE_EN_8822C(x) | BIT_PKTBUF_WRITE_EN_8822C(v)) -+ -+#define BIT_TXRPTBUF_DBG_8822C BIT(23) -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_TXPKTBUF_DBG_V2_8822C BIT(20) -+#define BIT_RXPKTBUF_DBG_8822C BIT(16) -+ -+#define BIT_SHIFT_PKTBUF_DBG_ADDR_8822C 0 -+#define BIT_MASK_PKTBUF_DBG_ADDR_8822C 0x1fff -+#define BIT_PKTBUF_DBG_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_ADDR_8822C) \ -+ << BIT_SHIFT_PKTBUF_DBG_ADDR_8822C) -+#define BITS_PKTBUF_DBG_ADDR_8822C \ -+ (BIT_MASK_PKTBUF_DBG_ADDR_8822C << BIT_SHIFT_PKTBUF_DBG_ADDR_8822C) -+#define BIT_CLEAR_PKTBUF_DBG_ADDR_8822C(x) ((x) & (~BITS_PKTBUF_DBG_ADDR_8822C)) -+#define BIT_GET_PKTBUF_DBG_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_ADDR_8822C) & \ -+ BIT_MASK_PKTBUF_DBG_ADDR_8822C) -+#define BIT_SET_PKTBUF_DBG_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_ADDR_8822C(x) | BIT_PKTBUF_DBG_ADDR_8822C(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_L_8822C */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_L_8822C 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_L_8822C 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_L_8822C(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_L_8822C) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_L_8822C) -+#define BITS_PKTBUF_DBG_DATA_L_8822C \ -+ (BIT_MASK_PKTBUF_DBG_DATA_L_8822C << BIT_SHIFT_PKTBUF_DBG_DATA_L_8822C) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_L_8822C(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_L_8822C)) -+#define BIT_GET_PKTBUF_DBG_DATA_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_L_8822C) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_L_8822C) -+#define BIT_SET_PKTBUF_DBG_DATA_L_8822C(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_L_8822C(x) | BIT_PKTBUF_DBG_DATA_L_8822C(v)) -+ -+/* 2 REG_PKTBUF_DBG_DATA_H_8822C */ -+ -+#define BIT_SHIFT_PKTBUF_DBG_DATA_H_8822C 0 -+#define BIT_MASK_PKTBUF_DBG_DATA_H_8822C 0xffffffffL -+#define BIT_PKTBUF_DBG_DATA_H_8822C(x) \ -+ (((x) & BIT_MASK_PKTBUF_DBG_DATA_H_8822C) \ -+ << BIT_SHIFT_PKTBUF_DBG_DATA_H_8822C) -+#define BITS_PKTBUF_DBG_DATA_H_8822C \ -+ (BIT_MASK_PKTBUF_DBG_DATA_H_8822C << BIT_SHIFT_PKTBUF_DBG_DATA_H_8822C) -+#define BIT_CLEAR_PKTBUF_DBG_DATA_H_8822C(x) \ -+ ((x) & (~BITS_PKTBUF_DBG_DATA_H_8822C)) -+#define BIT_GET_PKTBUF_DBG_DATA_H_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKTBUF_DBG_DATA_H_8822C) & \ -+ BIT_MASK_PKTBUF_DBG_DATA_H_8822C) -+#define BIT_SET_PKTBUF_DBG_DATA_H_8822C(x, v) \ -+ (BIT_CLEAR_PKTBUF_DBG_DATA_H_8822C(x) | BIT_PKTBUF_DBG_DATA_H_8822C(v)) -+ -+/* 2 REG_CPWM2_8822C */ -+ -+#define BIT_SHIFT_L0S_TO_RCVY_NUM_8822C 16 -+#define BIT_MASK_L0S_TO_RCVY_NUM_8822C 0xff -+#define BIT_L0S_TO_RCVY_NUM_8822C(x) \ -+ (((x) & BIT_MASK_L0S_TO_RCVY_NUM_8822C) \ -+ << BIT_SHIFT_L0S_TO_RCVY_NUM_8822C) -+#define BITS_L0S_TO_RCVY_NUM_8822C \ -+ (BIT_MASK_L0S_TO_RCVY_NUM_8822C << BIT_SHIFT_L0S_TO_RCVY_NUM_8822C) -+#define BIT_CLEAR_L0S_TO_RCVY_NUM_8822C(x) ((x) & (~BITS_L0S_TO_RCVY_NUM_8822C)) -+#define BIT_GET_L0S_TO_RCVY_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_L0S_TO_RCVY_NUM_8822C) & \ -+ BIT_MASK_L0S_TO_RCVY_NUM_8822C) -+#define BIT_SET_L0S_TO_RCVY_NUM_8822C(x, v) \ -+ (BIT_CLEAR_L0S_TO_RCVY_NUM_8822C(x) | BIT_L0S_TO_RCVY_NUM_8822C(v)) -+ -+#define BIT_CPWM2_TOGGLING_8822C BIT(15) -+ -+#define BIT_SHIFT_CPWM2_MOD_8822C 0 -+#define BIT_MASK_CPWM2_MOD_8822C 0x7fff -+#define BIT_CPWM2_MOD_8822C(x) \ -+ (((x) & BIT_MASK_CPWM2_MOD_8822C) << BIT_SHIFT_CPWM2_MOD_8822C) -+#define BITS_CPWM2_MOD_8822C \ -+ (BIT_MASK_CPWM2_MOD_8822C << BIT_SHIFT_CPWM2_MOD_8822C) -+#define BIT_CLEAR_CPWM2_MOD_8822C(x) ((x) & (~BITS_CPWM2_MOD_8822C)) -+#define BIT_GET_CPWM2_MOD_8822C(x) \ -+ (((x) >> BIT_SHIFT_CPWM2_MOD_8822C) & BIT_MASK_CPWM2_MOD_8822C) -+#define BIT_SET_CPWM2_MOD_8822C(x, v) \ -+ (BIT_CLEAR_CPWM2_MOD_8822C(x) | BIT_CPWM2_MOD_8822C(v)) -+ -+/* 2 REG_TC0_CTRL_8822C */ -+#define BIT_TC0INT_EN_8822C BIT(26) -+#define BIT_TC0MODE_8822C BIT(25) -+#define BIT_TC0EN_8822C BIT(24) -+ -+#define BIT_SHIFT_TC0DATA_8822C 0 -+#define BIT_MASK_TC0DATA_8822C 0xffffff -+#define BIT_TC0DATA_8822C(x) \ -+ (((x) & BIT_MASK_TC0DATA_8822C) << BIT_SHIFT_TC0DATA_8822C) -+#define BITS_TC0DATA_8822C (BIT_MASK_TC0DATA_8822C << BIT_SHIFT_TC0DATA_8822C) -+#define BIT_CLEAR_TC0DATA_8822C(x) ((x) & (~BITS_TC0DATA_8822C)) -+#define BIT_GET_TC0DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TC0DATA_8822C) & BIT_MASK_TC0DATA_8822C) -+#define BIT_SET_TC0DATA_8822C(x, v) \ -+ (BIT_CLEAR_TC0DATA_8822C(x) | BIT_TC0DATA_8822C(v)) -+ -+/* 2 REG_TC1_CTRL_8822C */ -+#define BIT_TC1INT_EN_8822C BIT(26) -+#define BIT_TC1MODE_8822C BIT(25) -+#define BIT_TC1EN_8822C BIT(24) -+ -+#define BIT_SHIFT_TC1DATA_8822C 0 -+#define BIT_MASK_TC1DATA_8822C 0xffffff -+#define BIT_TC1DATA_8822C(x) \ -+ (((x) & BIT_MASK_TC1DATA_8822C) << BIT_SHIFT_TC1DATA_8822C) -+#define BITS_TC1DATA_8822C (BIT_MASK_TC1DATA_8822C << BIT_SHIFT_TC1DATA_8822C) -+#define BIT_CLEAR_TC1DATA_8822C(x) ((x) & (~BITS_TC1DATA_8822C)) -+#define BIT_GET_TC1DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TC1DATA_8822C) & BIT_MASK_TC1DATA_8822C) -+#define BIT_SET_TC1DATA_8822C(x, v) \ -+ (BIT_CLEAR_TC1DATA_8822C(x) | BIT_TC1DATA_8822C(v)) -+ -+/* 2 REG_TC2_CTRL_8822C */ -+#define BIT_TC2INT_EN_8822C BIT(26) -+#define BIT_TC2MODE_8822C BIT(25) -+#define BIT_TC2EN_8822C BIT(24) -+ -+#define BIT_SHIFT_TC2DATA_8822C 0 -+#define BIT_MASK_TC2DATA_8822C 0xffffff -+#define BIT_TC2DATA_8822C(x) \ -+ (((x) & BIT_MASK_TC2DATA_8822C) << BIT_SHIFT_TC2DATA_8822C) -+#define BITS_TC2DATA_8822C (BIT_MASK_TC2DATA_8822C << BIT_SHIFT_TC2DATA_8822C) -+#define BIT_CLEAR_TC2DATA_8822C(x) ((x) & (~BITS_TC2DATA_8822C)) -+#define BIT_GET_TC2DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TC2DATA_8822C) & BIT_MASK_TC2DATA_8822C) -+#define BIT_SET_TC2DATA_8822C(x, v) \ -+ (BIT_CLEAR_TC2DATA_8822C(x) | BIT_TC2DATA_8822C(v)) -+ -+/* 2 REG_TC3_CTRL_8822C */ -+#define BIT_TC3INT_EN_8822C BIT(26) -+#define BIT_TC3MODE_8822C BIT(25) -+#define BIT_TC3EN_8822C BIT(24) -+ -+#define BIT_SHIFT_TC3DATA_8822C 0 -+#define BIT_MASK_TC3DATA_8822C 0xffffff -+#define BIT_TC3DATA_8822C(x) \ -+ (((x) & BIT_MASK_TC3DATA_8822C) << BIT_SHIFT_TC3DATA_8822C) -+#define BITS_TC3DATA_8822C (BIT_MASK_TC3DATA_8822C << BIT_SHIFT_TC3DATA_8822C) -+#define BIT_CLEAR_TC3DATA_8822C(x) ((x) & (~BITS_TC3DATA_8822C)) -+#define BIT_GET_TC3DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TC3DATA_8822C) & BIT_MASK_TC3DATA_8822C) -+#define BIT_SET_TC3DATA_8822C(x, v) \ -+ (BIT_CLEAR_TC3DATA_8822C(x) | BIT_TC3DATA_8822C(v)) -+ -+/* 2 REG_TC4_CTRL_8822C */ -+#define BIT_TC4INT_EN_8822C BIT(26) -+#define BIT_TC4MODE_8822C BIT(25) -+#define BIT_TC4EN_8822C BIT(24) -+ -+#define BIT_SHIFT_TC4DATA_8822C 0 -+#define BIT_MASK_TC4DATA_8822C 0xffffff -+#define BIT_TC4DATA_8822C(x) \ -+ (((x) & BIT_MASK_TC4DATA_8822C) << BIT_SHIFT_TC4DATA_8822C) -+#define BITS_TC4DATA_8822C (BIT_MASK_TC4DATA_8822C << BIT_SHIFT_TC4DATA_8822C) -+#define BIT_CLEAR_TC4DATA_8822C(x) ((x) & (~BITS_TC4DATA_8822C)) -+#define BIT_GET_TC4DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TC4DATA_8822C) & BIT_MASK_TC4DATA_8822C) -+#define BIT_SET_TC4DATA_8822C(x, v) \ -+ (BIT_CLEAR_TC4DATA_8822C(x) | BIT_TC4DATA_8822C(v)) -+ -+/* 2 REG_TCUNIT_BASE_8822C */ -+ -+#define BIT_SHIFT_TCUNIT_BASE_8822C 0 -+#define BIT_MASK_TCUNIT_BASE_8822C 0x3fff -+#define BIT_TCUNIT_BASE_8822C(x) \ -+ (((x) & BIT_MASK_TCUNIT_BASE_8822C) << BIT_SHIFT_TCUNIT_BASE_8822C) -+#define BITS_TCUNIT_BASE_8822C \ -+ (BIT_MASK_TCUNIT_BASE_8822C << BIT_SHIFT_TCUNIT_BASE_8822C) -+#define BIT_CLEAR_TCUNIT_BASE_8822C(x) ((x) & (~BITS_TCUNIT_BASE_8822C)) -+#define BIT_GET_TCUNIT_BASE_8822C(x) \ -+ (((x) >> BIT_SHIFT_TCUNIT_BASE_8822C) & BIT_MASK_TCUNIT_BASE_8822C) -+#define BIT_SET_TCUNIT_BASE_8822C(x, v) \ -+ (BIT_CLEAR_TCUNIT_BASE_8822C(x) | BIT_TCUNIT_BASE_8822C(v)) -+ -+/* 2 REG_TC5_CTRL_8822C */ -+#define BIT_TC5INT_EN_8822C BIT(26) -+#define BIT_TC5MODE_8822C BIT(25) -+#define BIT_TC5EN_8822C BIT(24) -+ -+#define BIT_SHIFT_TC5DATA_8822C 0 -+#define BIT_MASK_TC5DATA_8822C 0xffffff -+#define BIT_TC5DATA_8822C(x) \ -+ (((x) & BIT_MASK_TC5DATA_8822C) << BIT_SHIFT_TC5DATA_8822C) -+#define BITS_TC5DATA_8822C (BIT_MASK_TC5DATA_8822C << BIT_SHIFT_TC5DATA_8822C) -+#define BIT_CLEAR_TC5DATA_8822C(x) ((x) & (~BITS_TC5DATA_8822C)) -+#define BIT_GET_TC5DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TC5DATA_8822C) & BIT_MASK_TC5DATA_8822C) -+#define BIT_SET_TC5DATA_8822C(x, v) \ -+ (BIT_CLEAR_TC5DATA_8822C(x) | BIT_TC5DATA_8822C(v)) -+ -+/* 2 REG_TC6_CTRL_8822C */ -+#define BIT_TC6INT_EN_8822C BIT(26) -+#define BIT_TC6MODE_8822C BIT(25) -+#define BIT_TC6EN_8822C BIT(24) -+ -+#define BIT_SHIFT_TC6DATA_8822C 0 -+#define BIT_MASK_TC6DATA_8822C 0xffffff -+#define BIT_TC6DATA_8822C(x) \ -+ (((x) & BIT_MASK_TC6DATA_8822C) << BIT_SHIFT_TC6DATA_8822C) -+#define BITS_TC6DATA_8822C (BIT_MASK_TC6DATA_8822C << BIT_SHIFT_TC6DATA_8822C) -+#define BIT_CLEAR_TC6DATA_8822C(x) ((x) & (~BITS_TC6DATA_8822C)) -+#define BIT_GET_TC6DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TC6DATA_8822C) & BIT_MASK_TC6DATA_8822C) -+#define BIT_SET_TC6DATA_8822C(x, v) \ -+ (BIT_CLEAR_TC6DATA_8822C(x) | BIT_TC6DATA_8822C(v)) -+ -+/* 2 REG_MBIST_DRF_FAIL_8822C */ -+ -+#define BIT_SHIFT_8051_MBIST_DRF_FAIL_8822C 26 -+#define BIT_MASK_8051_MBIST_DRF_FAIL_8822C 0x3f -+#define BIT_8051_MBIST_DRF_FAIL_8822C(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DRF_FAIL_8822C) \ -+ << BIT_SHIFT_8051_MBIST_DRF_FAIL_8822C) -+#define BITS_8051_MBIST_DRF_FAIL_8822C \ -+ (BIT_MASK_8051_MBIST_DRF_FAIL_8822C \ -+ << BIT_SHIFT_8051_MBIST_DRF_FAIL_8822C) -+#define BIT_CLEAR_8051_MBIST_DRF_FAIL_8822C(x) \ -+ ((x) & (~BITS_8051_MBIST_DRF_FAIL_8822C)) -+#define BIT_GET_8051_MBIST_DRF_FAIL_8822C(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DRF_FAIL_8822C) & \ -+ BIT_MASK_8051_MBIST_DRF_FAIL_8822C) -+#define BIT_SET_8051_MBIST_DRF_FAIL_8822C(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DRF_FAIL_8822C(x) | \ -+ BIT_8051_MBIST_DRF_FAIL_8822C(v)) -+ -+#define BIT_SHIFT_USB_MBIST_DRF_FAIL_8822C 24 -+#define BIT_MASK_USB_MBIST_DRF_FAIL_8822C 0x3 -+#define BIT_USB_MBIST_DRF_FAIL_8822C(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DRF_FAIL_8822C) \ -+ << BIT_SHIFT_USB_MBIST_DRF_FAIL_8822C) -+#define BITS_USB_MBIST_DRF_FAIL_8822C \ -+ (BIT_MASK_USB_MBIST_DRF_FAIL_8822C \ -+ << BIT_SHIFT_USB_MBIST_DRF_FAIL_8822C) -+#define BIT_CLEAR_USB_MBIST_DRF_FAIL_8822C(x) \ -+ ((x) & (~BITS_USB_MBIST_DRF_FAIL_8822C)) -+#define BIT_GET_USB_MBIST_DRF_FAIL_8822C(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DRF_FAIL_8822C) & \ -+ BIT_MASK_USB_MBIST_DRF_FAIL_8822C) -+#define BIT_SET_USB_MBIST_DRF_FAIL_8822C(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DRF_FAIL_8822C(x) | \ -+ BIT_USB_MBIST_DRF_FAIL_8822C(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8822C 18 -+#define BIT_MASK_PCIE_MBIST_DRF_FAIL_8822C 0x3f -+#define BIT_PCIE_MBIST_DRF_FAIL_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DRF_FAIL_8822C) \ -+ << BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8822C) -+#define BITS_PCIE_MBIST_DRF_FAIL_8822C \ -+ (BIT_MASK_PCIE_MBIST_DRF_FAIL_8822C \ -+ << BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8822C) -+#define BIT_CLEAR_PCIE_MBIST_DRF_FAIL_8822C(x) \ -+ ((x) & (~BITS_PCIE_MBIST_DRF_FAIL_8822C)) -+#define BIT_GET_PCIE_MBIST_DRF_FAIL_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DRF_FAIL_8822C) & \ -+ BIT_MASK_PCIE_MBIST_DRF_FAIL_8822C) -+#define BIT_SET_PCIE_MBIST_DRF_FAIL_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DRF_FAIL_8822C(x) | \ -+ BIT_PCIE_MBIST_DRF_FAIL_8822C(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_DRF_FAIL_8822C 0 -+#define BIT_MASK_MAC_MBIST_DRF_FAIL_8822C 0x3ffff -+#define BIT_MAC_MBIST_DRF_FAIL_8822C(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DRF_FAIL_8822C) \ -+ << BIT_SHIFT_MAC_MBIST_DRF_FAIL_8822C) -+#define BITS_MAC_MBIST_DRF_FAIL_8822C \ -+ (BIT_MASK_MAC_MBIST_DRF_FAIL_8822C \ -+ << BIT_SHIFT_MAC_MBIST_DRF_FAIL_8822C) -+#define BIT_CLEAR_MAC_MBIST_DRF_FAIL_8822C(x) \ -+ ((x) & (~BITS_MAC_MBIST_DRF_FAIL_8822C)) -+#define BIT_GET_MAC_MBIST_DRF_FAIL_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DRF_FAIL_8822C) & \ -+ BIT_MASK_MAC_MBIST_DRF_FAIL_8822C) -+#define BIT_SET_MAC_MBIST_DRF_FAIL_8822C(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DRF_FAIL_8822C(x) | \ -+ BIT_MAC_MBIST_DRF_FAIL_8822C(v)) -+ -+/* 2 REG_MBIST_START_PAUSE_8822C */ -+ -+#define BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8822C 26 -+#define BIT_MASK_8051_MBIST_START_PAUSE_V1_8822C 0x3f -+#define BIT_8051_MBIST_START_PAUSE_V1_8822C(x) \ -+ (((x) & BIT_MASK_8051_MBIST_START_PAUSE_V1_8822C) \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8822C) -+#define BITS_8051_MBIST_START_PAUSE_V1_8822C \ -+ (BIT_MASK_8051_MBIST_START_PAUSE_V1_8822C \ -+ << BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8822C) -+#define BIT_CLEAR_8051_MBIST_START_PAUSE_V1_8822C(x) \ -+ ((x) & (~BITS_8051_MBIST_START_PAUSE_V1_8822C)) -+#define BIT_GET_8051_MBIST_START_PAUSE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_START_PAUSE_V1_8822C) & \ -+ BIT_MASK_8051_MBIST_START_PAUSE_V1_8822C) -+#define BIT_SET_8051_MBIST_START_PAUSE_V1_8822C(x, v) \ -+ (BIT_CLEAR_8051_MBIST_START_PAUSE_V1_8822C(x) | \ -+ BIT_8051_MBIST_START_PAUSE_V1_8822C(v)) -+ -+#define BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8822C 24 -+#define BIT_MASK_USB_MBIST_START_PAUSE_V1_8822C 0x3 -+#define BIT_USB_MBIST_START_PAUSE_V1_8822C(x) \ -+ (((x) & BIT_MASK_USB_MBIST_START_PAUSE_V1_8822C) \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8822C) -+#define BITS_USB_MBIST_START_PAUSE_V1_8822C \ -+ (BIT_MASK_USB_MBIST_START_PAUSE_V1_8822C \ -+ << BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8822C) -+#define BIT_CLEAR_USB_MBIST_START_PAUSE_V1_8822C(x) \ -+ ((x) & (~BITS_USB_MBIST_START_PAUSE_V1_8822C)) -+#define BIT_GET_USB_MBIST_START_PAUSE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_START_PAUSE_V1_8822C) & \ -+ BIT_MASK_USB_MBIST_START_PAUSE_V1_8822C) -+#define BIT_SET_USB_MBIST_START_PAUSE_V1_8822C(x, v) \ -+ (BIT_CLEAR_USB_MBIST_START_PAUSE_V1_8822C(x) | \ -+ BIT_USB_MBIST_START_PAUSE_V1_8822C(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8822C 18 -+#define BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8822C 0x3f -+#define BIT_PCIE_MBIST_START_PAUSE_V1_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8822C) \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8822C) -+#define BITS_PCIE_MBIST_START_PAUSE_V1_8822C \ -+ (BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8822C \ -+ << BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8822C) -+#define BIT_CLEAR_PCIE_MBIST_START_PAUSE_V1_8822C(x) \ -+ ((x) & (~BITS_PCIE_MBIST_START_PAUSE_V1_8822C)) -+#define BIT_GET_PCIE_MBIST_START_PAUSE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_START_PAUSE_V1_8822C) & \ -+ BIT_MASK_PCIE_MBIST_START_PAUSE_V1_8822C) -+#define BIT_SET_PCIE_MBIST_START_PAUSE_V1_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_START_PAUSE_V1_8822C(x) | \ -+ BIT_PCIE_MBIST_START_PAUSE_V1_8822C(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8822C 0 -+#define BIT_MASK_MAC_MBIST_START_PAUSE_V1_8822C 0x3ffff -+#define BIT_MAC_MBIST_START_PAUSE_V1_8822C(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_START_PAUSE_V1_8822C) \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8822C) -+#define BITS_MAC_MBIST_START_PAUSE_V1_8822C \ -+ (BIT_MASK_MAC_MBIST_START_PAUSE_V1_8822C \ -+ << BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8822C) -+#define BIT_CLEAR_MAC_MBIST_START_PAUSE_V1_8822C(x) \ -+ ((x) & (~BITS_MAC_MBIST_START_PAUSE_V1_8822C)) -+#define BIT_GET_MAC_MBIST_START_PAUSE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_START_PAUSE_V1_8822C) & \ -+ BIT_MASK_MAC_MBIST_START_PAUSE_V1_8822C) -+#define BIT_SET_MAC_MBIST_START_PAUSE_V1_8822C(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_START_PAUSE_V1_8822C(x) | \ -+ BIT_MAC_MBIST_START_PAUSE_V1_8822C(v)) -+ -+/* 2 REG_MBIST_DONE_8822C */ -+ -+#define BIT_SHIFT_8051_MBIST_DONE_V1_8822C 26 -+#define BIT_MASK_8051_MBIST_DONE_V1_8822C 0x3f -+#define BIT_8051_MBIST_DONE_V1_8822C(x) \ -+ (((x) & BIT_MASK_8051_MBIST_DONE_V1_8822C) \ -+ << BIT_SHIFT_8051_MBIST_DONE_V1_8822C) -+#define BITS_8051_MBIST_DONE_V1_8822C \ -+ (BIT_MASK_8051_MBIST_DONE_V1_8822C \ -+ << BIT_SHIFT_8051_MBIST_DONE_V1_8822C) -+#define BIT_CLEAR_8051_MBIST_DONE_V1_8822C(x) \ -+ ((x) & (~BITS_8051_MBIST_DONE_V1_8822C)) -+#define BIT_GET_8051_MBIST_DONE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_8051_MBIST_DONE_V1_8822C) & \ -+ BIT_MASK_8051_MBIST_DONE_V1_8822C) -+#define BIT_SET_8051_MBIST_DONE_V1_8822C(x, v) \ -+ (BIT_CLEAR_8051_MBIST_DONE_V1_8822C(x) | \ -+ BIT_8051_MBIST_DONE_V1_8822C(v)) -+ -+#define BIT_SHIFT_USB_MBIST_DONE_V1_8822C 24 -+#define BIT_MASK_USB_MBIST_DONE_V1_8822C 0x3 -+#define BIT_USB_MBIST_DONE_V1_8822C(x) \ -+ (((x) & BIT_MASK_USB_MBIST_DONE_V1_8822C) \ -+ << BIT_SHIFT_USB_MBIST_DONE_V1_8822C) -+#define BITS_USB_MBIST_DONE_V1_8822C \ -+ (BIT_MASK_USB_MBIST_DONE_V1_8822C << BIT_SHIFT_USB_MBIST_DONE_V1_8822C) -+#define BIT_CLEAR_USB_MBIST_DONE_V1_8822C(x) \ -+ ((x) & (~BITS_USB_MBIST_DONE_V1_8822C)) -+#define BIT_GET_USB_MBIST_DONE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_USB_MBIST_DONE_V1_8822C) & \ -+ BIT_MASK_USB_MBIST_DONE_V1_8822C) -+#define BIT_SET_USB_MBIST_DONE_V1_8822C(x, v) \ -+ (BIT_CLEAR_USB_MBIST_DONE_V1_8822C(x) | BIT_USB_MBIST_DONE_V1_8822C(v)) -+ -+#define BIT_SHIFT_PCIE_MBIST_DONE_V1_8822C 18 -+#define BIT_MASK_PCIE_MBIST_DONE_V1_8822C 0x3f -+#define BIT_PCIE_MBIST_DONE_V1_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_MBIST_DONE_V1_8822C) \ -+ << BIT_SHIFT_PCIE_MBIST_DONE_V1_8822C) -+#define BITS_PCIE_MBIST_DONE_V1_8822C \ -+ (BIT_MASK_PCIE_MBIST_DONE_V1_8822C \ -+ << BIT_SHIFT_PCIE_MBIST_DONE_V1_8822C) -+#define BIT_CLEAR_PCIE_MBIST_DONE_V1_8822C(x) \ -+ ((x) & (~BITS_PCIE_MBIST_DONE_V1_8822C)) -+#define BIT_GET_PCIE_MBIST_DONE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MBIST_DONE_V1_8822C) & \ -+ BIT_MASK_PCIE_MBIST_DONE_V1_8822C) -+#define BIT_SET_PCIE_MBIST_DONE_V1_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_MBIST_DONE_V1_8822C(x) | \ -+ BIT_PCIE_MBIST_DONE_V1_8822C(v)) -+ -+#define BIT_SHIFT_MAC_MBIST_DONE_V1_8822C 0 -+#define BIT_MASK_MAC_MBIST_DONE_V1_8822C 0x3ffff -+#define BIT_MAC_MBIST_DONE_V1_8822C(x) \ -+ (((x) & BIT_MASK_MAC_MBIST_DONE_V1_8822C) \ -+ << BIT_SHIFT_MAC_MBIST_DONE_V1_8822C) -+#define BITS_MAC_MBIST_DONE_V1_8822C \ -+ (BIT_MASK_MAC_MBIST_DONE_V1_8822C << BIT_SHIFT_MAC_MBIST_DONE_V1_8822C) -+#define BIT_CLEAR_MAC_MBIST_DONE_V1_8822C(x) \ -+ ((x) & (~BITS_MAC_MBIST_DONE_V1_8822C)) -+#define BIT_GET_MAC_MBIST_DONE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAC_MBIST_DONE_V1_8822C) & \ -+ BIT_MASK_MAC_MBIST_DONE_V1_8822C) -+#define BIT_SET_MAC_MBIST_DONE_V1_8822C(x, v) \ -+ (BIT_CLEAR_MAC_MBIST_DONE_V1_8822C(x) | BIT_MAC_MBIST_DONE_V1_8822C(v)) -+ -+/* 2 REG_MBIST_READ_BIST_RPT_8822C */ -+ -+#define BIT_SHIFT_MBIST_READ_BIST_RPT_8822C 0 -+#define BIT_MASK_MBIST_READ_BIST_RPT_8822C 0xffffffffL -+#define BIT_MBIST_READ_BIST_RPT_8822C(x) \ -+ (((x) & BIT_MASK_MBIST_READ_BIST_RPT_8822C) \ -+ << BIT_SHIFT_MBIST_READ_BIST_RPT_8822C) -+#define BITS_MBIST_READ_BIST_RPT_8822C \ -+ (BIT_MASK_MBIST_READ_BIST_RPT_8822C \ -+ << BIT_SHIFT_MBIST_READ_BIST_RPT_8822C) -+#define BIT_CLEAR_MBIST_READ_BIST_RPT_8822C(x) \ -+ ((x) & (~BITS_MBIST_READ_BIST_RPT_8822C)) -+#define BIT_GET_MBIST_READ_BIST_RPT_8822C(x) \ -+ (((x) >> BIT_SHIFT_MBIST_READ_BIST_RPT_8822C) & \ -+ BIT_MASK_MBIST_READ_BIST_RPT_8822C) -+#define BIT_SET_MBIST_READ_BIST_RPT_8822C(x, v) \ -+ (BIT_CLEAR_MBIST_READ_BIST_RPT_8822C(x) | \ -+ BIT_MBIST_READ_BIST_RPT_8822C(v)) -+ -+/* 2 REG_AES_DECRPT_DATA_8822C */ -+ -+#define BIT_SHIFT_IPS_CFG_ADDR_8822C 0 -+#define BIT_MASK_IPS_CFG_ADDR_8822C 0xff -+#define BIT_IPS_CFG_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_IPS_CFG_ADDR_8822C) << BIT_SHIFT_IPS_CFG_ADDR_8822C) -+#define BITS_IPS_CFG_ADDR_8822C \ -+ (BIT_MASK_IPS_CFG_ADDR_8822C << BIT_SHIFT_IPS_CFG_ADDR_8822C) -+#define BIT_CLEAR_IPS_CFG_ADDR_8822C(x) ((x) & (~BITS_IPS_CFG_ADDR_8822C)) -+#define BIT_GET_IPS_CFG_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_ADDR_8822C) & BIT_MASK_IPS_CFG_ADDR_8822C) -+#define BIT_SET_IPS_CFG_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_IPS_CFG_ADDR_8822C(x) | BIT_IPS_CFG_ADDR_8822C(v)) -+ -+/* 2 REG_AES_DECRPT_CFG_8822C */ -+ -+#define BIT_SHIFT_IPS_CFG_DATA_8822C 0 -+#define BIT_MASK_IPS_CFG_DATA_8822C 0xffffffffL -+#define BIT_IPS_CFG_DATA_8822C(x) \ -+ (((x) & BIT_MASK_IPS_CFG_DATA_8822C) << BIT_SHIFT_IPS_CFG_DATA_8822C) -+#define BITS_IPS_CFG_DATA_8822C \ -+ (BIT_MASK_IPS_CFG_DATA_8822C << BIT_SHIFT_IPS_CFG_DATA_8822C) -+#define BIT_CLEAR_IPS_CFG_DATA_8822C(x) ((x) & (~BITS_IPS_CFG_DATA_8822C)) -+#define BIT_GET_IPS_CFG_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_IPS_CFG_DATA_8822C) & BIT_MASK_IPS_CFG_DATA_8822C) -+#define BIT_SET_IPS_CFG_DATA_8822C(x, v) \ -+ (BIT_CLEAR_IPS_CFG_DATA_8822C(x) | BIT_IPS_CFG_DATA_8822C(v)) -+ -+/* 2 REG_HIOE_CTRL_8822C */ -+#define BIT_HIOE_CFG_FILE_LOC_SEL_8822C BIT(31) -+#define BIT_HIOE_WRITE_REQ_8822C BIT(30) -+#define BIT_HIOE_READ_REQ_8822C BIT(29) -+#define BIT_INST_FORMAT_ERR_8822C BIT(25) -+#define BIT_OP_TIMEOUT_ERR_8822C BIT(24) -+ -+#define BIT_SHIFT_HIOE_OP_TIMEOUT_8822C 16 -+#define BIT_MASK_HIOE_OP_TIMEOUT_8822C 0xff -+#define BIT_HIOE_OP_TIMEOUT_8822C(x) \ -+ (((x) & BIT_MASK_HIOE_OP_TIMEOUT_8822C) \ -+ << BIT_SHIFT_HIOE_OP_TIMEOUT_8822C) -+#define BITS_HIOE_OP_TIMEOUT_8822C \ -+ (BIT_MASK_HIOE_OP_TIMEOUT_8822C << BIT_SHIFT_HIOE_OP_TIMEOUT_8822C) -+#define BIT_CLEAR_HIOE_OP_TIMEOUT_8822C(x) ((x) & (~BITS_HIOE_OP_TIMEOUT_8822C)) -+#define BIT_GET_HIOE_OP_TIMEOUT_8822C(x) \ -+ (((x) >> BIT_SHIFT_HIOE_OP_TIMEOUT_8822C) & \ -+ BIT_MASK_HIOE_OP_TIMEOUT_8822C) -+#define BIT_SET_HIOE_OP_TIMEOUT_8822C(x, v) \ -+ (BIT_CLEAR_HIOE_OP_TIMEOUT_8822C(x) | BIT_HIOE_OP_TIMEOUT_8822C(v)) -+ -+#define BIT_SHIFT_BITDATA_CHECKSUM_8822C 0 -+#define BIT_MASK_BITDATA_CHECKSUM_8822C 0xffff -+#define BIT_BITDATA_CHECKSUM_8822C(x) \ -+ (((x) & BIT_MASK_BITDATA_CHECKSUM_8822C) \ -+ << BIT_SHIFT_BITDATA_CHECKSUM_8822C) -+#define BITS_BITDATA_CHECKSUM_8822C \ -+ (BIT_MASK_BITDATA_CHECKSUM_8822C << BIT_SHIFT_BITDATA_CHECKSUM_8822C) -+#define BIT_CLEAR_BITDATA_CHECKSUM_8822C(x) \ -+ ((x) & (~BITS_BITDATA_CHECKSUM_8822C)) -+#define BIT_GET_BITDATA_CHECKSUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_BITDATA_CHECKSUM_8822C) & \ -+ BIT_MASK_BITDATA_CHECKSUM_8822C) -+#define BIT_SET_BITDATA_CHECKSUM_8822C(x, v) \ -+ (BIT_CLEAR_BITDATA_CHECKSUM_8822C(x) | BIT_BITDATA_CHECKSUM_8822C(v)) -+ -+/* 2 REG_HIOE_CFG_FILE_8822C */ -+ -+#define BIT_SHIFT_TXBF_END_ADDR_8822C 16 -+#define BIT_MASK_TXBF_END_ADDR_8822C 0xffff -+#define BIT_TXBF_END_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_TXBF_END_ADDR_8822C) << BIT_SHIFT_TXBF_END_ADDR_8822C) -+#define BITS_TXBF_END_ADDR_8822C \ -+ (BIT_MASK_TXBF_END_ADDR_8822C << BIT_SHIFT_TXBF_END_ADDR_8822C) -+#define BIT_CLEAR_TXBF_END_ADDR_8822C(x) ((x) & (~BITS_TXBF_END_ADDR_8822C)) -+#define BIT_GET_TXBF_END_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXBF_END_ADDR_8822C) & BIT_MASK_TXBF_END_ADDR_8822C) -+#define BIT_SET_TXBF_END_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_TXBF_END_ADDR_8822C(x) | BIT_TXBF_END_ADDR_8822C(v)) -+ -+#define BIT_SHIFT_TXBF_STR_ADDR_8822C 0 -+#define BIT_MASK_TXBF_STR_ADDR_8822C 0xffff -+#define BIT_TXBF_STR_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_TXBF_STR_ADDR_8822C) << BIT_SHIFT_TXBF_STR_ADDR_8822C) -+#define BITS_TXBF_STR_ADDR_8822C \ -+ (BIT_MASK_TXBF_STR_ADDR_8822C << BIT_SHIFT_TXBF_STR_ADDR_8822C) -+#define BIT_CLEAR_TXBF_STR_ADDR_8822C(x) ((x) & (~BITS_TXBF_STR_ADDR_8822C)) -+#define BIT_GET_TXBF_STR_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXBF_STR_ADDR_8822C) & BIT_MASK_TXBF_STR_ADDR_8822C) -+#define BIT_SET_TXBF_STR_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_TXBF_STR_ADDR_8822C(x) | BIT_TXBF_STR_ADDR_8822C(v)) -+ -+/* 2 REG_TMETER_8822C */ -+#define BIT_TEMP_VALID_8822C BIT(31) -+ -+#define BIT_SHIFT_TEMP_VALUE_8822C 24 -+#define BIT_MASK_TEMP_VALUE_8822C 0x3f -+#define BIT_TEMP_VALUE_8822C(x) \ -+ (((x) & BIT_MASK_TEMP_VALUE_8822C) << BIT_SHIFT_TEMP_VALUE_8822C) -+#define BITS_TEMP_VALUE_8822C \ -+ (BIT_MASK_TEMP_VALUE_8822C << BIT_SHIFT_TEMP_VALUE_8822C) -+#define BIT_CLEAR_TEMP_VALUE_8822C(x) ((x) & (~BITS_TEMP_VALUE_8822C)) -+#define BIT_GET_TEMP_VALUE_8822C(x) \ -+ (((x) >> BIT_SHIFT_TEMP_VALUE_8822C) & BIT_MASK_TEMP_VALUE_8822C) -+#define BIT_SET_TEMP_VALUE_8822C(x, v) \ -+ (BIT_CLEAR_TEMP_VALUE_8822C(x) | BIT_TEMP_VALUE_8822C(v)) -+ -+#define BIT_SHIFT_REG_TMETER_TIMER_8822C 8 -+#define BIT_MASK_REG_TMETER_TIMER_8822C 0xfff -+#define BIT_REG_TMETER_TIMER_8822C(x) \ -+ (((x) & BIT_MASK_REG_TMETER_TIMER_8822C) \ -+ << BIT_SHIFT_REG_TMETER_TIMER_8822C) -+#define BITS_REG_TMETER_TIMER_8822C \ -+ (BIT_MASK_REG_TMETER_TIMER_8822C << BIT_SHIFT_REG_TMETER_TIMER_8822C) -+#define BIT_CLEAR_REG_TMETER_TIMER_8822C(x) \ -+ ((x) & (~BITS_REG_TMETER_TIMER_8822C)) -+#define BIT_GET_REG_TMETER_TIMER_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_TMETER_TIMER_8822C) & \ -+ BIT_MASK_REG_TMETER_TIMER_8822C) -+#define BIT_SET_REG_TMETER_TIMER_8822C(x, v) \ -+ (BIT_CLEAR_REG_TMETER_TIMER_8822C(x) | BIT_REG_TMETER_TIMER_8822C(v)) -+ -+#define BIT_SHIFT_REG_TEMP_DELTA_8822C 2 -+#define BIT_MASK_REG_TEMP_DELTA_8822C 0x3f -+#define BIT_REG_TEMP_DELTA_8822C(x) \ -+ (((x) & BIT_MASK_REG_TEMP_DELTA_8822C) \ -+ << BIT_SHIFT_REG_TEMP_DELTA_8822C) -+#define BITS_REG_TEMP_DELTA_8822C \ -+ (BIT_MASK_REG_TEMP_DELTA_8822C << BIT_SHIFT_REG_TEMP_DELTA_8822C) -+#define BIT_CLEAR_REG_TEMP_DELTA_8822C(x) ((x) & (~BITS_REG_TEMP_DELTA_8822C)) -+#define BIT_GET_REG_TEMP_DELTA_8822C(x) \ -+ (((x) >> BIT_SHIFT_REG_TEMP_DELTA_8822C) & \ -+ BIT_MASK_REG_TEMP_DELTA_8822C) -+#define BIT_SET_REG_TEMP_DELTA_8822C(x, v) \ -+ (BIT_CLEAR_REG_TEMP_DELTA_8822C(x) | BIT_REG_TEMP_DELTA_8822C(v)) -+ -+#define BIT_REG_TMETER_EN_8822C BIT(0) -+ -+/* 2 REG_OSC_32K_CTRL_8822C */ -+ -+#define BIT_SHIFT_OSC_32K_CLKGEN_0_8822C 16 -+#define BIT_MASK_OSC_32K_CLKGEN_0_8822C 0xffff -+#define BIT_OSC_32K_CLKGEN_0_8822C(x) \ -+ (((x) & BIT_MASK_OSC_32K_CLKGEN_0_8822C) \ -+ << BIT_SHIFT_OSC_32K_CLKGEN_0_8822C) -+#define BITS_OSC_32K_CLKGEN_0_8822C \ -+ (BIT_MASK_OSC_32K_CLKGEN_0_8822C << BIT_SHIFT_OSC_32K_CLKGEN_0_8822C) -+#define BIT_CLEAR_OSC_32K_CLKGEN_0_8822C(x) \ -+ ((x) & (~BITS_OSC_32K_CLKGEN_0_8822C)) -+#define BIT_GET_OSC_32K_CLKGEN_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_CLKGEN_0_8822C) & \ -+ BIT_MASK_OSC_32K_CLKGEN_0_8822C) -+#define BIT_SET_OSC_32K_CLKGEN_0_8822C(x, v) \ -+ (BIT_CLEAR_OSC_32K_CLKGEN_0_8822C(x) | BIT_OSC_32K_CLKGEN_0_8822C(v)) -+ -+#define BIT_SHIFT_OSC_32K_RES_COMP_8822C 4 -+#define BIT_MASK_OSC_32K_RES_COMP_8822C 0x3 -+#define BIT_OSC_32K_RES_COMP_8822C(x) \ -+ (((x) & BIT_MASK_OSC_32K_RES_COMP_8822C) \ -+ << BIT_SHIFT_OSC_32K_RES_COMP_8822C) -+#define BITS_OSC_32K_RES_COMP_8822C \ -+ (BIT_MASK_OSC_32K_RES_COMP_8822C << BIT_SHIFT_OSC_32K_RES_COMP_8822C) -+#define BIT_CLEAR_OSC_32K_RES_COMP_8822C(x) \ -+ ((x) & (~BITS_OSC_32K_RES_COMP_8822C)) -+#define BIT_GET_OSC_32K_RES_COMP_8822C(x) \ -+ (((x) >> BIT_SHIFT_OSC_32K_RES_COMP_8822C) & \ -+ BIT_MASK_OSC_32K_RES_COMP_8822C) -+#define BIT_SET_OSC_32K_RES_COMP_8822C(x, v) \ -+ (BIT_CLEAR_OSC_32K_RES_COMP_8822C(x) | BIT_OSC_32K_RES_COMP_8822C(v)) -+ -+#define BIT_OSC_32K_OUT_SEL_8822C BIT(3) -+#define BIT_ISO_WL_2_OSC_32K_8822C BIT(1) -+#define BIT_POW_CKGEN_8822C BIT(0) -+ -+/* 2 REG_32K_CAL_REG1_8822C */ -+#define BIT_CAL_32K_REG_WR_8822C BIT(31) -+#define BIT_CAL_32K_DBG_SEL_8822C BIT(22) -+ -+#define BIT_SHIFT_CAL_32K_REG_ADDR_8822C 16 -+#define BIT_MASK_CAL_32K_REG_ADDR_8822C 0x3f -+#define BIT_CAL_32K_REG_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_ADDR_8822C) \ -+ << BIT_SHIFT_CAL_32K_REG_ADDR_8822C) -+#define BITS_CAL_32K_REG_ADDR_8822C \ -+ (BIT_MASK_CAL_32K_REG_ADDR_8822C << BIT_SHIFT_CAL_32K_REG_ADDR_8822C) -+#define BIT_CLEAR_CAL_32K_REG_ADDR_8822C(x) \ -+ ((x) & (~BITS_CAL_32K_REG_ADDR_8822C)) -+#define BIT_GET_CAL_32K_REG_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_ADDR_8822C) & \ -+ BIT_MASK_CAL_32K_REG_ADDR_8822C) -+#define BIT_SET_CAL_32K_REG_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_ADDR_8822C(x) | BIT_CAL_32K_REG_ADDR_8822C(v)) -+ -+#define BIT_SHIFT_CAL_32K_REG_DATA_8822C 0 -+#define BIT_MASK_CAL_32K_REG_DATA_8822C 0xffff -+#define BIT_CAL_32K_REG_DATA_8822C(x) \ -+ (((x) & BIT_MASK_CAL_32K_REG_DATA_8822C) \ -+ << BIT_SHIFT_CAL_32K_REG_DATA_8822C) -+#define BITS_CAL_32K_REG_DATA_8822C \ -+ (BIT_MASK_CAL_32K_REG_DATA_8822C << BIT_SHIFT_CAL_32K_REG_DATA_8822C) -+#define BIT_CLEAR_CAL_32K_REG_DATA_8822C(x) \ -+ ((x) & (~BITS_CAL_32K_REG_DATA_8822C)) -+#define BIT_GET_CAL_32K_REG_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_CAL_32K_REG_DATA_8822C) & \ -+ BIT_MASK_CAL_32K_REG_DATA_8822C) -+#define BIT_SET_CAL_32K_REG_DATA_8822C(x, v) \ -+ (BIT_CLEAR_CAL_32K_REG_DATA_8822C(x) | BIT_CAL_32K_REG_DATA_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_C2HEVT_8822C */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_V1_8822C 0 -+#define BIT_MASK_C2HEVT_MSG_V1_8822C 0xffffffffL -+#define BIT_C2HEVT_MSG_V1_8822C(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_V1_8822C) << BIT_SHIFT_C2HEVT_MSG_V1_8822C) -+#define BITS_C2HEVT_MSG_V1_8822C \ -+ (BIT_MASK_C2HEVT_MSG_V1_8822C << BIT_SHIFT_C2HEVT_MSG_V1_8822C) -+#define BIT_CLEAR_C2HEVT_MSG_V1_8822C(x) ((x) & (~BITS_C2HEVT_MSG_V1_8822C)) -+#define BIT_GET_C2HEVT_MSG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_V1_8822C) & BIT_MASK_C2HEVT_MSG_V1_8822C) -+#define BIT_SET_C2HEVT_MSG_V1_8822C(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_V1_8822C(x) | BIT_C2HEVT_MSG_V1_8822C(v)) -+ -+/* 2 REG_C2HEVT_1_8822C */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_1_8822C 0 -+#define BIT_MASK_C2HEVT_MSG_1_8822C 0xffffffffL -+#define BIT_C2HEVT_MSG_1_8822C(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_1_8822C) << BIT_SHIFT_C2HEVT_MSG_1_8822C) -+#define BITS_C2HEVT_MSG_1_8822C \ -+ (BIT_MASK_C2HEVT_MSG_1_8822C << BIT_SHIFT_C2HEVT_MSG_1_8822C) -+#define BIT_CLEAR_C2HEVT_MSG_1_8822C(x) ((x) & (~BITS_C2HEVT_MSG_1_8822C)) -+#define BIT_GET_C2HEVT_MSG_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_1_8822C) & BIT_MASK_C2HEVT_MSG_1_8822C) -+#define BIT_SET_C2HEVT_MSG_1_8822C(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_1_8822C(x) | BIT_C2HEVT_MSG_1_8822C(v)) -+ -+/* 2 REG_C2HEVT_2_8822C */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_2_8822C 0 -+#define BIT_MASK_C2HEVT_MSG_2_8822C 0xffffffffL -+#define BIT_C2HEVT_MSG_2_8822C(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_2_8822C) << BIT_SHIFT_C2HEVT_MSG_2_8822C) -+#define BITS_C2HEVT_MSG_2_8822C \ -+ (BIT_MASK_C2HEVT_MSG_2_8822C << BIT_SHIFT_C2HEVT_MSG_2_8822C) -+#define BIT_CLEAR_C2HEVT_MSG_2_8822C(x) ((x) & (~BITS_C2HEVT_MSG_2_8822C)) -+#define BIT_GET_C2HEVT_MSG_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_2_8822C) & BIT_MASK_C2HEVT_MSG_2_8822C) -+#define BIT_SET_C2HEVT_MSG_2_8822C(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_2_8822C(x) | BIT_C2HEVT_MSG_2_8822C(v)) -+ -+/* 2 REG_C2HEVT_3_8822C */ -+ -+#define BIT_SHIFT_C2HEVT_MSG_3_8822C 0 -+#define BIT_MASK_C2HEVT_MSG_3_8822C 0xffffffffL -+#define BIT_C2HEVT_MSG_3_8822C(x) \ -+ (((x) & BIT_MASK_C2HEVT_MSG_3_8822C) << BIT_SHIFT_C2HEVT_MSG_3_8822C) -+#define BITS_C2HEVT_MSG_3_8822C \ -+ (BIT_MASK_C2HEVT_MSG_3_8822C << BIT_SHIFT_C2HEVT_MSG_3_8822C) -+#define BIT_CLEAR_C2HEVT_MSG_3_8822C(x) ((x) & (~BITS_C2HEVT_MSG_3_8822C)) -+#define BIT_GET_C2HEVT_MSG_3_8822C(x) \ -+ (((x) >> BIT_SHIFT_C2HEVT_MSG_3_8822C) & BIT_MASK_C2HEVT_MSG_3_8822C) -+#define BIT_SET_C2HEVT_MSG_3_8822C(x, v) \ -+ (BIT_CLEAR_C2HEVT_MSG_3_8822C(x) | BIT_C2HEVT_MSG_3_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_SW_DEFINED_PAGE1_8822C */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE1_V1_8822C 0 -+#define BIT_MASK_SW_DEFINED_PAGE1_V1_8822C 0xffffffffL -+#define BIT_SW_DEFINED_PAGE1_V1_8822C(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE1_V1_8822C) \ -+ << BIT_SHIFT_SW_DEFINED_PAGE1_V1_8822C) -+#define BITS_SW_DEFINED_PAGE1_V1_8822C \ -+ (BIT_MASK_SW_DEFINED_PAGE1_V1_8822C \ -+ << BIT_SHIFT_SW_DEFINED_PAGE1_V1_8822C) -+#define BIT_CLEAR_SW_DEFINED_PAGE1_V1_8822C(x) \ -+ ((x) & (~BITS_SW_DEFINED_PAGE1_V1_8822C)) -+#define BIT_GET_SW_DEFINED_PAGE1_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE1_V1_8822C) & \ -+ BIT_MASK_SW_DEFINED_PAGE1_V1_8822C) -+#define BIT_SET_SW_DEFINED_PAGE1_V1_8822C(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE1_V1_8822C(x) | \ -+ BIT_SW_DEFINED_PAGE1_V1_8822C(v)) -+ -+/* 2 REG_SW_DEFINED_PAGE2_8822C */ -+ -+#define BIT_SHIFT_SW_DEFINED_PAGE2_8822C 0 -+#define BIT_MASK_SW_DEFINED_PAGE2_8822C 0xffffffffL -+#define BIT_SW_DEFINED_PAGE2_8822C(x) \ -+ (((x) & BIT_MASK_SW_DEFINED_PAGE2_8822C) \ -+ << BIT_SHIFT_SW_DEFINED_PAGE2_8822C) -+#define BITS_SW_DEFINED_PAGE2_8822C \ -+ (BIT_MASK_SW_DEFINED_PAGE2_8822C << BIT_SHIFT_SW_DEFINED_PAGE2_8822C) -+#define BIT_CLEAR_SW_DEFINED_PAGE2_8822C(x) \ -+ ((x) & (~BITS_SW_DEFINED_PAGE2_8822C)) -+#define BIT_GET_SW_DEFINED_PAGE2_8822C(x) \ -+ (((x) >> BIT_SHIFT_SW_DEFINED_PAGE2_8822C) & \ -+ BIT_MASK_SW_DEFINED_PAGE2_8822C) -+#define BIT_SET_SW_DEFINED_PAGE2_8822C(x, v) \ -+ (BIT_CLEAR_SW_DEFINED_PAGE2_8822C(x) | BIT_SW_DEFINED_PAGE2_8822C(v)) -+ -+/* 2 REG_MCUTST_I_8822C */ -+ -+#define BIT_SHIFT_MCUDMSG_I_8822C 0 -+#define BIT_MASK_MCUDMSG_I_8822C 0xffffffffL -+#define BIT_MCUDMSG_I_8822C(x) \ -+ (((x) & BIT_MASK_MCUDMSG_I_8822C) << BIT_SHIFT_MCUDMSG_I_8822C) -+#define BITS_MCUDMSG_I_8822C \ -+ (BIT_MASK_MCUDMSG_I_8822C << BIT_SHIFT_MCUDMSG_I_8822C) -+#define BIT_CLEAR_MCUDMSG_I_8822C(x) ((x) & (~BITS_MCUDMSG_I_8822C)) -+#define BIT_GET_MCUDMSG_I_8822C(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_I_8822C) & BIT_MASK_MCUDMSG_I_8822C) -+#define BIT_SET_MCUDMSG_I_8822C(x, v) \ -+ (BIT_CLEAR_MCUDMSG_I_8822C(x) | BIT_MCUDMSG_I_8822C(v)) -+ -+/* 2 REG_MCUTST_II_8822C */ -+ -+#define BIT_SHIFT_MCUDMSG_II_8822C 0 -+#define BIT_MASK_MCUDMSG_II_8822C 0xffffffffL -+#define BIT_MCUDMSG_II_8822C(x) \ -+ (((x) & BIT_MASK_MCUDMSG_II_8822C) << BIT_SHIFT_MCUDMSG_II_8822C) -+#define BITS_MCUDMSG_II_8822C \ -+ (BIT_MASK_MCUDMSG_II_8822C << BIT_SHIFT_MCUDMSG_II_8822C) -+#define BIT_CLEAR_MCUDMSG_II_8822C(x) ((x) & (~BITS_MCUDMSG_II_8822C)) -+#define BIT_GET_MCUDMSG_II_8822C(x) \ -+ (((x) >> BIT_SHIFT_MCUDMSG_II_8822C) & BIT_MASK_MCUDMSG_II_8822C) -+#define BIT_SET_MCUDMSG_II_8822C(x, v) \ -+ (BIT_CLEAR_MCUDMSG_II_8822C(x) | BIT_MCUDMSG_II_8822C(v)) -+ -+/* 2 REG_FMETHR_8822C */ -+#define BIT_FMSG_INT_8822C BIT(31) -+ -+#define BIT_SHIFT_FW_MSG_8822C 0 -+#define BIT_MASK_FW_MSG_8822C 0xffffffffL -+#define BIT_FW_MSG_8822C(x) \ -+ (((x) & BIT_MASK_FW_MSG_8822C) << BIT_SHIFT_FW_MSG_8822C) -+#define BITS_FW_MSG_8822C (BIT_MASK_FW_MSG_8822C << BIT_SHIFT_FW_MSG_8822C) -+#define BIT_CLEAR_FW_MSG_8822C(x) ((x) & (~BITS_FW_MSG_8822C)) -+#define BIT_GET_FW_MSG_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_8822C) & BIT_MASK_FW_MSG_8822C) -+#define BIT_SET_FW_MSG_8822C(x, v) \ -+ (BIT_CLEAR_FW_MSG_8822C(x) | BIT_FW_MSG_8822C(v)) -+ -+/* 2 REG_HMETFR_8822C */ -+ -+#define BIT_SHIFT_HRCV_MSG_8822C 24 -+#define BIT_MASK_HRCV_MSG_8822C 0xff -+#define BIT_HRCV_MSG_8822C(x) \ -+ (((x) & BIT_MASK_HRCV_MSG_8822C) << BIT_SHIFT_HRCV_MSG_8822C) -+#define BITS_HRCV_MSG_8822C \ -+ (BIT_MASK_HRCV_MSG_8822C << BIT_SHIFT_HRCV_MSG_8822C) -+#define BIT_CLEAR_HRCV_MSG_8822C(x) ((x) & (~BITS_HRCV_MSG_8822C)) -+#define BIT_GET_HRCV_MSG_8822C(x) \ -+ (((x) >> BIT_SHIFT_HRCV_MSG_8822C) & BIT_MASK_HRCV_MSG_8822C) -+#define BIT_SET_HRCV_MSG_8822C(x, v) \ -+ (BIT_CLEAR_HRCV_MSG_8822C(x) | BIT_HRCV_MSG_8822C(v)) -+ -+#define BIT_INT_BOX3_8822C BIT(3) -+#define BIT_INT_BOX2_8822C BIT(2) -+#define BIT_INT_BOX1_8822C BIT(1) -+#define BIT_INT_BOX0_8822C BIT(0) -+ -+/* 2 REG_HMEBOX0_8822C */ -+ -+#define BIT_SHIFT_HOST_MSG_0_8822C 0 -+#define BIT_MASK_HOST_MSG_0_8822C 0xffffffffL -+#define BIT_HOST_MSG_0_8822C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_0_8822C) << BIT_SHIFT_HOST_MSG_0_8822C) -+#define BITS_HOST_MSG_0_8822C \ -+ (BIT_MASK_HOST_MSG_0_8822C << BIT_SHIFT_HOST_MSG_0_8822C) -+#define BIT_CLEAR_HOST_MSG_0_8822C(x) ((x) & (~BITS_HOST_MSG_0_8822C)) -+#define BIT_GET_HOST_MSG_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_0_8822C) & BIT_MASK_HOST_MSG_0_8822C) -+#define BIT_SET_HOST_MSG_0_8822C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_0_8822C(x) | BIT_HOST_MSG_0_8822C(v)) -+ -+/* 2 REG_HMEBOX1_8822C */ -+ -+#define BIT_SHIFT_HOST_MSG_1_8822C 0 -+#define BIT_MASK_HOST_MSG_1_8822C 0xffffffffL -+#define BIT_HOST_MSG_1_8822C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_1_8822C) << BIT_SHIFT_HOST_MSG_1_8822C) -+#define BITS_HOST_MSG_1_8822C \ -+ (BIT_MASK_HOST_MSG_1_8822C << BIT_SHIFT_HOST_MSG_1_8822C) -+#define BIT_CLEAR_HOST_MSG_1_8822C(x) ((x) & (~BITS_HOST_MSG_1_8822C)) -+#define BIT_GET_HOST_MSG_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_1_8822C) & BIT_MASK_HOST_MSG_1_8822C) -+#define BIT_SET_HOST_MSG_1_8822C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_1_8822C(x) | BIT_HOST_MSG_1_8822C(v)) -+ -+/* 2 REG_HMEBOX2_8822C */ -+ -+#define BIT_SHIFT_HOST_MSG_2_8822C 0 -+#define BIT_MASK_HOST_MSG_2_8822C 0xffffffffL -+#define BIT_HOST_MSG_2_8822C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_2_8822C) << BIT_SHIFT_HOST_MSG_2_8822C) -+#define BITS_HOST_MSG_2_8822C \ -+ (BIT_MASK_HOST_MSG_2_8822C << BIT_SHIFT_HOST_MSG_2_8822C) -+#define BIT_CLEAR_HOST_MSG_2_8822C(x) ((x) & (~BITS_HOST_MSG_2_8822C)) -+#define BIT_GET_HOST_MSG_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_2_8822C) & BIT_MASK_HOST_MSG_2_8822C) -+#define BIT_SET_HOST_MSG_2_8822C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_2_8822C(x) | BIT_HOST_MSG_2_8822C(v)) -+ -+/* 2 REG_HMEBOX3_8822C */ -+ -+#define BIT_SHIFT_HOST_MSG_3_8822C 0 -+#define BIT_MASK_HOST_MSG_3_8822C 0xffffffffL -+#define BIT_HOST_MSG_3_8822C(x) \ -+ (((x) & BIT_MASK_HOST_MSG_3_8822C) << BIT_SHIFT_HOST_MSG_3_8822C) -+#define BITS_HOST_MSG_3_8822C \ -+ (BIT_MASK_HOST_MSG_3_8822C << BIT_SHIFT_HOST_MSG_3_8822C) -+#define BIT_CLEAR_HOST_MSG_3_8822C(x) ((x) & (~BITS_HOST_MSG_3_8822C)) -+#define BIT_GET_HOST_MSG_3_8822C(x) \ -+ (((x) >> BIT_SHIFT_HOST_MSG_3_8822C) & BIT_MASK_HOST_MSG_3_8822C) -+#define BIT_SET_HOST_MSG_3_8822C(x, v) \ -+ (BIT_CLEAR_HOST_MSG_3_8822C(x) | BIT_HOST_MSG_3_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_BB_ACCESS_CTRL_8822C */ -+ -+#define BIT_SHIFT_BB_WRITE_READ_8822C 30 -+#define BIT_MASK_BB_WRITE_READ_8822C 0x3 -+#define BIT_BB_WRITE_READ_8822C(x) \ -+ (((x) & BIT_MASK_BB_WRITE_READ_8822C) << BIT_SHIFT_BB_WRITE_READ_8822C) -+#define BITS_BB_WRITE_READ_8822C \ -+ (BIT_MASK_BB_WRITE_READ_8822C << BIT_SHIFT_BB_WRITE_READ_8822C) -+#define BIT_CLEAR_BB_WRITE_READ_8822C(x) ((x) & (~BITS_BB_WRITE_READ_8822C)) -+#define BIT_GET_BB_WRITE_READ_8822C(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_READ_8822C) & BIT_MASK_BB_WRITE_READ_8822C) -+#define BIT_SET_BB_WRITE_READ_8822C(x, v) \ -+ (BIT_CLEAR_BB_WRITE_READ_8822C(x) | BIT_BB_WRITE_READ_8822C(v)) -+ -+#define BIT_SHIFT_BB_WRITE_EN_8822C 12 -+#define BIT_MASK_BB_WRITE_EN_8822C 0xf -+#define BIT_BB_WRITE_EN_8822C(x) \ -+ (((x) & BIT_MASK_BB_WRITE_EN_8822C) << BIT_SHIFT_BB_WRITE_EN_8822C) -+#define BITS_BB_WRITE_EN_8822C \ -+ (BIT_MASK_BB_WRITE_EN_8822C << BIT_SHIFT_BB_WRITE_EN_8822C) -+#define BIT_CLEAR_BB_WRITE_EN_8822C(x) ((x) & (~BITS_BB_WRITE_EN_8822C)) -+#define BIT_GET_BB_WRITE_EN_8822C(x) \ -+ (((x) >> BIT_SHIFT_BB_WRITE_EN_8822C) & BIT_MASK_BB_WRITE_EN_8822C) -+#define BIT_SET_BB_WRITE_EN_8822C(x, v) \ -+ (BIT_CLEAR_BB_WRITE_EN_8822C(x) | BIT_BB_WRITE_EN_8822C(v)) -+ -+#define BIT_SHIFT_BB_ADDR_8822C 2 -+#define BIT_MASK_BB_ADDR_8822C 0x1ff -+#define BIT_BB_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_BB_ADDR_8822C) << BIT_SHIFT_BB_ADDR_8822C) -+#define BITS_BB_ADDR_8822C (BIT_MASK_BB_ADDR_8822C << BIT_SHIFT_BB_ADDR_8822C) -+#define BIT_CLEAR_BB_ADDR_8822C(x) ((x) & (~BITS_BB_ADDR_8822C)) -+#define BIT_GET_BB_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_BB_ADDR_8822C) & BIT_MASK_BB_ADDR_8822C) -+#define BIT_SET_BB_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_BB_ADDR_8822C(x) | BIT_BB_ADDR_8822C(v)) -+ -+#define BIT_BB_ERRACC_8822C BIT(0) -+ -+/* 2 REG_BB_ACCESS_DATA_8822C */ -+ -+#define BIT_SHIFT_BB_DATA_8822C 0 -+#define BIT_MASK_BB_DATA_8822C 0xffffffffL -+#define BIT_BB_DATA_8822C(x) \ -+ (((x) & BIT_MASK_BB_DATA_8822C) << BIT_SHIFT_BB_DATA_8822C) -+#define BITS_BB_DATA_8822C (BIT_MASK_BB_DATA_8822C << BIT_SHIFT_BB_DATA_8822C) -+#define BIT_CLEAR_BB_DATA_8822C(x) ((x) & (~BITS_BB_DATA_8822C)) -+#define BIT_GET_BB_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_BB_DATA_8822C) & BIT_MASK_BB_DATA_8822C) -+#define BIT_SET_BB_DATA_8822C(x, v) \ -+ (BIT_CLEAR_BB_DATA_8822C(x) | BIT_BB_DATA_8822C(v)) -+ -+/* 2 REG_HMEBOX_E0_8822C */ -+ -+#define BIT_SHIFT_HMEBOX_E0_8822C 0 -+#define BIT_MASK_HMEBOX_E0_8822C 0xffffffffL -+#define BIT_HMEBOX_E0_8822C(x) \ -+ (((x) & BIT_MASK_HMEBOX_E0_8822C) << BIT_SHIFT_HMEBOX_E0_8822C) -+#define BITS_HMEBOX_E0_8822C \ -+ (BIT_MASK_HMEBOX_E0_8822C << BIT_SHIFT_HMEBOX_E0_8822C) -+#define BIT_CLEAR_HMEBOX_E0_8822C(x) ((x) & (~BITS_HMEBOX_E0_8822C)) -+#define BIT_GET_HMEBOX_E0_8822C(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E0_8822C) & BIT_MASK_HMEBOX_E0_8822C) -+#define BIT_SET_HMEBOX_E0_8822C(x, v) \ -+ (BIT_CLEAR_HMEBOX_E0_8822C(x) | BIT_HMEBOX_E0_8822C(v)) -+ -+/* 2 REG_HMEBOX_E1_8822C */ -+ -+#define BIT_SHIFT_HMEBOX_E1_8822C 0 -+#define BIT_MASK_HMEBOX_E1_8822C 0xffffffffL -+#define BIT_HMEBOX_E1_8822C(x) \ -+ (((x) & BIT_MASK_HMEBOX_E1_8822C) << BIT_SHIFT_HMEBOX_E1_8822C) -+#define BITS_HMEBOX_E1_8822C \ -+ (BIT_MASK_HMEBOX_E1_8822C << BIT_SHIFT_HMEBOX_E1_8822C) -+#define BIT_CLEAR_HMEBOX_E1_8822C(x) ((x) & (~BITS_HMEBOX_E1_8822C)) -+#define BIT_GET_HMEBOX_E1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E1_8822C) & BIT_MASK_HMEBOX_E1_8822C) -+#define BIT_SET_HMEBOX_E1_8822C(x, v) \ -+ (BIT_CLEAR_HMEBOX_E1_8822C(x) | BIT_HMEBOX_E1_8822C(v)) -+ -+/* 2 REG_HMEBOX_E2_8822C */ -+ -+#define BIT_SHIFT_HMEBOX_E2_8822C 0 -+#define BIT_MASK_HMEBOX_E2_8822C 0xffffffffL -+#define BIT_HMEBOX_E2_8822C(x) \ -+ (((x) & BIT_MASK_HMEBOX_E2_8822C) << BIT_SHIFT_HMEBOX_E2_8822C) -+#define BITS_HMEBOX_E2_8822C \ -+ (BIT_MASK_HMEBOX_E2_8822C << BIT_SHIFT_HMEBOX_E2_8822C) -+#define BIT_CLEAR_HMEBOX_E2_8822C(x) ((x) & (~BITS_HMEBOX_E2_8822C)) -+#define BIT_GET_HMEBOX_E2_8822C(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E2_8822C) & BIT_MASK_HMEBOX_E2_8822C) -+#define BIT_SET_HMEBOX_E2_8822C(x, v) \ -+ (BIT_CLEAR_HMEBOX_E2_8822C(x) | BIT_HMEBOX_E2_8822C(v)) -+ -+/* 2 REG_HMEBOX_E3_8822C */ -+ -+#define BIT_SHIFT_HMEBOX_E3_8822C 0 -+#define BIT_MASK_HMEBOX_E3_8822C 0xffffffffL -+#define BIT_HMEBOX_E3_8822C(x) \ -+ (((x) & BIT_MASK_HMEBOX_E3_8822C) << BIT_SHIFT_HMEBOX_E3_8822C) -+#define BITS_HMEBOX_E3_8822C \ -+ (BIT_MASK_HMEBOX_E3_8822C << BIT_SHIFT_HMEBOX_E3_8822C) -+#define BIT_CLEAR_HMEBOX_E3_8822C(x) ((x) & (~BITS_HMEBOX_E3_8822C)) -+#define BIT_GET_HMEBOX_E3_8822C(x) \ -+ (((x) >> BIT_SHIFT_HMEBOX_E3_8822C) & BIT_MASK_HMEBOX_E3_8822C) -+#define BIT_SET_HMEBOX_E3_8822C(x, v) \ -+ (BIT_CLEAR_HMEBOX_E3_8822C(x) | BIT_HMEBOX_E3_8822C(v)) -+ -+/* 2 REG_CR_EXT_8822C */ -+ -+#define BIT_SHIFT_PHY_REQ_DELAY_8822C 24 -+#define BIT_MASK_PHY_REQ_DELAY_8822C 0xf -+#define BIT_PHY_REQ_DELAY_8822C(x) \ -+ (((x) & BIT_MASK_PHY_REQ_DELAY_8822C) << BIT_SHIFT_PHY_REQ_DELAY_8822C) -+#define BITS_PHY_REQ_DELAY_8822C \ -+ (BIT_MASK_PHY_REQ_DELAY_8822C << BIT_SHIFT_PHY_REQ_DELAY_8822C) -+#define BIT_CLEAR_PHY_REQ_DELAY_8822C(x) ((x) & (~BITS_PHY_REQ_DELAY_8822C)) -+#define BIT_GET_PHY_REQ_DELAY_8822C(x) \ -+ (((x) >> BIT_SHIFT_PHY_REQ_DELAY_8822C) & BIT_MASK_PHY_REQ_DELAY_8822C) -+#define BIT_SET_PHY_REQ_DELAY_8822C(x, v) \ -+ (BIT_CLEAR_PHY_REQ_DELAY_8822C(x) | BIT_PHY_REQ_DELAY_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_SPD_DOWN_8822C BIT(16) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_NETYPE4_8822C 4 -+#define BIT_MASK_NETYPE4_8822C 0x3 -+#define BIT_NETYPE4_8822C(x) \ -+ (((x) & BIT_MASK_NETYPE4_8822C) << BIT_SHIFT_NETYPE4_8822C) -+#define BITS_NETYPE4_8822C (BIT_MASK_NETYPE4_8822C << BIT_SHIFT_NETYPE4_8822C) -+#define BIT_CLEAR_NETYPE4_8822C(x) ((x) & (~BITS_NETYPE4_8822C)) -+#define BIT_GET_NETYPE4_8822C(x) \ -+ (((x) >> BIT_SHIFT_NETYPE4_8822C) & BIT_MASK_NETYPE4_8822C) -+#define BIT_SET_NETYPE4_8822C(x, v) \ -+ (BIT_CLEAR_NETYPE4_8822C(x) | BIT_NETYPE4_8822C(v)) -+ -+#define BIT_SHIFT_NETYPE3_8822C 2 -+#define BIT_MASK_NETYPE3_8822C 0x3 -+#define BIT_NETYPE3_8822C(x) \ -+ (((x) & BIT_MASK_NETYPE3_8822C) << BIT_SHIFT_NETYPE3_8822C) -+#define BITS_NETYPE3_8822C (BIT_MASK_NETYPE3_8822C << BIT_SHIFT_NETYPE3_8822C) -+#define BIT_CLEAR_NETYPE3_8822C(x) ((x) & (~BITS_NETYPE3_8822C)) -+#define BIT_GET_NETYPE3_8822C(x) \ -+ (((x) >> BIT_SHIFT_NETYPE3_8822C) & BIT_MASK_NETYPE3_8822C) -+#define BIT_SET_NETYPE3_8822C(x, v) \ -+ (BIT_CLEAR_NETYPE3_8822C(x) | BIT_NETYPE3_8822C(v)) -+ -+#define BIT_SHIFT_NETYPE2_8822C 0 -+#define BIT_MASK_NETYPE2_8822C 0x3 -+#define BIT_NETYPE2_8822C(x) \ -+ (((x) & BIT_MASK_NETYPE2_8822C) << BIT_SHIFT_NETYPE2_8822C) -+#define BITS_NETYPE2_8822C (BIT_MASK_NETYPE2_8822C << BIT_SHIFT_NETYPE2_8822C) -+#define BIT_CLEAR_NETYPE2_8822C(x) ((x) & (~BITS_NETYPE2_8822C)) -+#define BIT_GET_NETYPE2_8822C(x) \ -+ (((x) >> BIT_SHIFT_NETYPE2_8822C) & BIT_MASK_NETYPE2_8822C) -+#define BIT_SET_NETYPE2_8822C(x, v) \ -+ (BIT_CLEAR_NETYPE2_8822C(x) | BIT_NETYPE2_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_FWFF_8822C */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V1_8822C 24 -+#define BIT_MASK_PKTNUM_TH_V1_8822C 0xff -+#define BIT_PKTNUM_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V1_8822C) << BIT_SHIFT_PKTNUM_TH_V1_8822C) -+#define BITS_PKTNUM_TH_V1_8822C \ -+ (BIT_MASK_PKTNUM_TH_V1_8822C << BIT_SHIFT_PKTNUM_TH_V1_8822C) -+#define BIT_CLEAR_PKTNUM_TH_V1_8822C(x) ((x) & (~BITS_PKTNUM_TH_V1_8822C)) -+#define BIT_GET_PKTNUM_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V1_8822C) & BIT_MASK_PKTNUM_TH_V1_8822C) -+#define BIT_SET_PKTNUM_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V1_8822C(x) | BIT_PKTNUM_TH_V1_8822C(v)) -+ -+#define BIT_SHIFT_TIMER_TH_8822C 16 -+#define BIT_MASK_TIMER_TH_8822C 0xff -+#define BIT_TIMER_TH_8822C(x) \ -+ (((x) & BIT_MASK_TIMER_TH_8822C) << BIT_SHIFT_TIMER_TH_8822C) -+#define BITS_TIMER_TH_8822C \ -+ (BIT_MASK_TIMER_TH_8822C << BIT_SHIFT_TIMER_TH_8822C) -+#define BIT_CLEAR_TIMER_TH_8822C(x) ((x) & (~BITS_TIMER_TH_8822C)) -+#define BIT_GET_TIMER_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_TIMER_TH_8822C) & BIT_MASK_TIMER_TH_8822C) -+#define BIT_SET_TIMER_TH_8822C(x, v) \ -+ (BIT_CLEAR_TIMER_TH_8822C(x) | BIT_TIMER_TH_8822C(v)) -+ -+#define BIT_SHIFT_RXPKT1ENADDR_8822C 0 -+#define BIT_MASK_RXPKT1ENADDR_8822C 0xffff -+#define BIT_RXPKT1ENADDR_8822C(x) \ -+ (((x) & BIT_MASK_RXPKT1ENADDR_8822C) << BIT_SHIFT_RXPKT1ENADDR_8822C) -+#define BITS_RXPKT1ENADDR_8822C \ -+ (BIT_MASK_RXPKT1ENADDR_8822C << BIT_SHIFT_RXPKT1ENADDR_8822C) -+#define BIT_CLEAR_RXPKT1ENADDR_8822C(x) ((x) & (~BITS_RXPKT1ENADDR_8822C)) -+#define BIT_GET_RXPKT1ENADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXPKT1ENADDR_8822C) & BIT_MASK_RXPKT1ENADDR_8822C) -+#define BIT_SET_RXPKT1ENADDR_8822C(x, v) \ -+ (BIT_CLEAR_RXPKT1ENADDR_8822C(x) | BIT_RXPKT1ENADDR_8822C(v)) -+ -+/* 2 REG_RXFF_PTR_V1_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_RXFF0_RDPTR_V2_8822C 0 -+#define BIT_MASK_RXFF0_RDPTR_V2_8822C 0x3ffff -+#define BIT_RXFF0_RDPTR_V2_8822C(x) \ -+ (((x) & BIT_MASK_RXFF0_RDPTR_V2_8822C) \ -+ << BIT_SHIFT_RXFF0_RDPTR_V2_8822C) -+#define BITS_RXFF0_RDPTR_V2_8822C \ -+ (BIT_MASK_RXFF0_RDPTR_V2_8822C << BIT_SHIFT_RXFF0_RDPTR_V2_8822C) -+#define BIT_CLEAR_RXFF0_RDPTR_V2_8822C(x) ((x) & (~BITS_RXFF0_RDPTR_V2_8822C)) -+#define BIT_GET_RXFF0_RDPTR_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_RDPTR_V2_8822C) & \ -+ BIT_MASK_RXFF0_RDPTR_V2_8822C) -+#define BIT_SET_RXFF0_RDPTR_V2_8822C(x, v) \ -+ (BIT_CLEAR_RXFF0_RDPTR_V2_8822C(x) | BIT_RXFF0_RDPTR_V2_8822C(v)) -+ -+/* 2 REG_RXFF_WTR_V1_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_RXFF0_WTPTR_V2_8822C 0 -+#define BIT_MASK_RXFF0_WTPTR_V2_8822C 0x3ffff -+#define BIT_RXFF0_WTPTR_V2_8822C(x) \ -+ (((x) & BIT_MASK_RXFF0_WTPTR_V2_8822C) \ -+ << BIT_SHIFT_RXFF0_WTPTR_V2_8822C) -+#define BITS_RXFF0_WTPTR_V2_8822C \ -+ (BIT_MASK_RXFF0_WTPTR_V2_8822C << BIT_SHIFT_RXFF0_WTPTR_V2_8822C) -+#define BIT_CLEAR_RXFF0_WTPTR_V2_8822C(x) ((x) & (~BITS_RXFF0_WTPTR_V2_8822C)) -+#define BIT_GET_RXFF0_WTPTR_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXFF0_WTPTR_V2_8822C) & \ -+ BIT_MASK_RXFF0_WTPTR_V2_8822C) -+#define BIT_SET_RXFF0_WTPTR_V2_8822C(x, v) \ -+ (BIT_CLEAR_RXFF0_WTPTR_V2_8822C(x) | BIT_RXFF0_WTPTR_V2_8822C(v)) -+ -+/* 2 REG_FE2IMR_8822C */ -+#define BIT__FE4ISR__IND_MSK_8822C BIT(29) -+#define BIT_FS_TXSC_DESC_DONE_INT_EN_8822C BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_EN_8822C BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_EN_8822C BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_EN_8822C BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_EN_8822C BIT(24) -+#define BIT_FS_ATIM_MB7_INT_EN_8822C BIT(23) -+#define BIT_FS_ATIM_MB6_INT_EN_8822C BIT(22) -+#define BIT_FS_ATIM_MB5_INT_EN_8822C BIT(21) -+#define BIT_FS_ATIM_MB4_INT_EN_8822C BIT(20) -+#define BIT_FS_ATIM_MB3_INT_EN_8822C BIT(19) -+#define BIT_FS_ATIM_MB2_INT_EN_8822C BIT(18) -+#define BIT_FS_ATIM_MB1_INT_EN_8822C BIT(17) -+#define BIT_FS_ATIM_MB0_INT_EN_8822C BIT(16) -+#define BIT_FS_TBTT4INT_EN_8822C BIT(11) -+#define BIT_FS_TBTT3INT_EN_8822C BIT(10) -+#define BIT_FS_TBTT2INT_EN_8822C BIT(9) -+#define BIT_FS_TBTT1INT_EN_8822C BIT(8) -+#define BIT_FS_TBTT0_MB7INT_EN_8822C BIT(7) -+#define BIT_FS_TBTT0_MB6INT_EN_8822C BIT(6) -+#define BIT_FS_TBTT0_MB5INT_EN_8822C BIT(5) -+#define BIT_FS_TBTT0_MB4INT_EN_8822C BIT(4) -+#define BIT_FS_TBTT0_MB3INT_EN_8822C BIT(3) -+#define BIT_FS_TBTT0_MB2INT_EN_8822C BIT(2) -+#define BIT_FS_TBTT0_MB1INT_EN_8822C BIT(1) -+#define BIT_FS_TBTT0_INT_EN_8822C BIT(0) -+ -+/* 2 REG_FE2ISR_8822C */ -+#define BIT__FE4ISR__IND_INT_8822C BIT(29) -+#define BIT_FS_TXSC_DESC_DONE_INT_8822C BIT(28) -+#define BIT_FS_TXSC_BKDONE_INT_8822C BIT(27) -+#define BIT_FS_TXSC_BEDONE_INT_8822C BIT(26) -+#define BIT_FS_TXSC_VIDONE_INT_8822C BIT(25) -+#define BIT_FS_TXSC_VODONE_INT_8822C BIT(24) -+#define BIT_FS_ATIM_MB7_INT_8822C BIT(23) -+#define BIT_FS_ATIM_MB6_INT_8822C BIT(22) -+#define BIT_FS_ATIM_MB5_INT_8822C BIT(21) -+#define BIT_FS_ATIM_MB4_INT_8822C BIT(20) -+#define BIT_FS_ATIM_MB3_INT_8822C BIT(19) -+#define BIT_FS_ATIM_MB2_INT_8822C BIT(18) -+#define BIT_FS_ATIM_MB1_INT_8822C BIT(17) -+#define BIT_FS_ATIM_MB0_INT_8822C BIT(16) -+#define BIT_FS_TBTT4INT_8822C BIT(11) -+#define BIT_FS_TBTT3INT_8822C BIT(10) -+#define BIT_FS_TBTT2INT_8822C BIT(9) -+#define BIT_FS_TBTT1INT_8822C BIT(8) -+#define BIT_FS_TBTT0_MB7INT_8822C BIT(7) -+#define BIT_FS_TBTT0_MB6INT_8822C BIT(6) -+#define BIT_FS_TBTT0_MB5INT_8822C BIT(5) -+#define BIT_FS_TBTT0_MB4INT_8822C BIT(4) -+#define BIT_FS_TBTT0_MB3INT_8822C BIT(3) -+#define BIT_FS_TBTT0_MB2INT_8822C BIT(2) -+#define BIT_FS_TBTT0_MB1INT_8822C BIT(1) -+#define BIT_FS_TBTT0_INT_8822C BIT(0) -+ -+/* 2 REG_FE3IMR_8822C */ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT__EN_8822C BIT(31) -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT__EN_8822C BIT(30) -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT__EN_8822C BIT(29) -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT__EN_8822C BIT(28) -+#define BIT_FS_BCNDMA4_INT_EN_8822C BIT(27) -+#define BIT_FS_BCNDMA3_INT_EN_8822C BIT(26) -+#define BIT_FS_BCNDMA2_INT_EN_8822C BIT(25) -+#define BIT_FS_BCNDMA1_INT_EN_8822C BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_EN_8822C BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_EN_8822C BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_EN_8822C BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_EN_8822C BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_EN_8822C BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_EN_8822C BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_EN_8822C BIT(17) -+#define BIT_FS_BCNDMA0_INT_EN_8822C BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT__EN_8822C BIT(15) -+#define BIT_FS_BCNERLY4_INT_EN_8822C BIT(11) -+#define BIT_FS_BCNERLY3_INT_EN_8822C BIT(10) -+#define BIT_FS_BCNERLY2_INT_EN_8822C BIT(9) -+#define BIT_FS_BCNERLY1_INT_EN_8822C BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_EN_8822C BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_EN_8822C BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_EN_8822C BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_EN_8822C BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_EN_8822C BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_EN_8822C BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_EN_8822C BIT(1) -+#define BIT_FS_BCNERLY0_INT_EN_8822C BIT(0) -+ -+/* 2 REG_FE3ISR_8822C */ -+#define BIT_FS_CLI3_MTI_BCNIVLEAR_INT_8822C BIT(31) -+#define BIT_FS_CLI2_MTI_BCNIVLEAR_INT_8822C BIT(30) -+#define BIT_FS_CLI1_MTI_BCNIVLEAR_INT_8822C BIT(29) -+#define BIT_FS_CLI0_MTI_BCNIVLEAR_INT_8822C BIT(28) -+#define BIT_FS_BCNDMA4_INT_8822C BIT(27) -+#define BIT_FS_BCNDMA3_INT_8822C BIT(26) -+#define BIT_FS_BCNDMA2_INT_8822C BIT(25) -+#define BIT_FS_BCNDMA1_INT_8822C BIT(24) -+#define BIT_FS_BCNDMA0_MB7_INT_8822C BIT(23) -+#define BIT_FS_BCNDMA0_MB6_INT_8822C BIT(22) -+#define BIT_FS_BCNDMA0_MB5_INT_8822C BIT(21) -+#define BIT_FS_BCNDMA0_MB4_INT_8822C BIT(20) -+#define BIT_FS_BCNDMA0_MB3_INT_8822C BIT(19) -+#define BIT_FS_BCNDMA0_MB2_INT_8822C BIT(18) -+#define BIT_FS_BCNDMA0_MB1_INT_8822C BIT(17) -+#define BIT_FS_BCNDMA0_INT_8822C BIT(16) -+#define BIT_FS_MTI_BCNIVLEAR_INT_8822C BIT(15) -+#define BIT_FS_BCNERLY4_INT_8822C BIT(11) -+#define BIT_FS_BCNERLY3_INT_8822C BIT(10) -+#define BIT_FS_BCNERLY2_INT_8822C BIT(9) -+#define BIT_FS_BCNERLY1_INT_8822C BIT(8) -+#define BIT_FS_BCNERLY0_MB7INT_8822C BIT(7) -+#define BIT_FS_BCNERLY0_MB6INT_8822C BIT(6) -+#define BIT_FS_BCNERLY0_MB5INT_8822C BIT(5) -+#define BIT_FS_BCNERLY0_MB4INT_8822C BIT(4) -+#define BIT_FS_BCNERLY0_MB3INT_8822C BIT(3) -+#define BIT_FS_BCNERLY0_MB2INT_8822C BIT(2) -+#define BIT_FS_BCNERLY0_MB1INT_8822C BIT(1) -+#define BIT_FS_BCNERLY0_INT_8822C BIT(0) -+ -+/* 2 REG_FE4IMR_8822C */ -+#define BIT_FS_CLI3_TXPKTIN_INT_EN_8822C BIT(19) -+#define BIT_FS_CLI2_TXPKTIN_INT_EN_8822C BIT(18) -+#define BIT_FS_CLI1_TXPKTIN_INT_EN_8822C BIT(17) -+#define BIT_FS_CLI0_TXPKTIN_INT_EN_8822C BIT(16) -+#define BIT_FS_CLI3_RX_UMD0_INT_EN_8822C BIT(15) -+#define BIT_FS_CLI3_RX_UMD1_INT_EN_8822C BIT(14) -+#define BIT_FS_CLI3_RX_BMD0_INT_EN_8822C BIT(13) -+#define BIT_FS_CLI3_RX_BMD1_INT_EN_8822C BIT(12) -+#define BIT_FS_CLI2_RX_UMD0_INT_EN_8822C BIT(11) -+#define BIT_FS_CLI2_RX_UMD1_INT_EN_8822C BIT(10) -+#define BIT_FS_CLI2_RX_BMD0_INT_EN_8822C BIT(9) -+#define BIT_FS_CLI2_RX_BMD1_INT_EN_8822C BIT(8) -+#define BIT_FS_CLI1_RX_UMD0_INT_EN_8822C BIT(7) -+#define BIT_FS_CLI1_RX_UMD1_INT_EN_8822C BIT(6) -+#define BIT_FS_CLI1_RX_BMD0_INT_EN_8822C BIT(5) -+#define BIT_FS_CLI1_RX_BMD1_INT_EN_8822C BIT(4) -+#define BIT_FS_CLI0_RX_UMD0_INT_EN_8822C BIT(3) -+#define BIT_FS_CLI0_RX_UMD1_INT_EN_8822C BIT(2) -+#define BIT_FS_CLI0_RX_BMD0_INT_EN_8822C BIT(1) -+#define BIT_FS_CLI0_RX_BMD1_INT_EN_8822C BIT(0) -+ -+/* 2 REG_FE4ISR_8822C */ -+#define BIT_FS_CLI3_TXPKTIN_INT_8822C BIT(19) -+#define BIT_FS_CLI2_TXPKTIN_INT_8822C BIT(18) -+#define BIT_FS_CLI1_TXPKTIN_INT_8822C BIT(17) -+#define BIT_FS_CLI0_TXPKTIN_INT_8822C BIT(16) -+#define BIT_FS_CLI3_RX_UMD0_INT_8822C BIT(15) -+#define BIT_FS_CLI3_RX_UMD1_INT_8822C BIT(14) -+#define BIT_FS_CLI3_RX_BMD0_INT_8822C BIT(13) -+#define BIT_FS_CLI3_RX_BMD1_INT_8822C BIT(12) -+#define BIT_FS_CLI2_RX_UMD0_INT_8822C BIT(11) -+#define BIT_FS_CLI2_RX_UMD1_INT_8822C BIT(10) -+#define BIT_FS_CLI2_RX_BMD0_INT_8822C BIT(9) -+#define BIT_FS_CLI2_RX_BMD1_INT_8822C BIT(8) -+#define BIT_FS_CLI1_RX_UMD0_INT_8822C BIT(7) -+#define BIT_FS_CLI1_RX_UMD1_INT_8822C BIT(6) -+#define BIT_FS_CLI1_RX_BMD0_INT_8822C BIT(5) -+#define BIT_FS_CLI1_RX_BMD1_INT_8822C BIT(4) -+#define BIT_FS_CLI0_RX_UMD0_INT_8822C BIT(3) -+#define BIT_FS_CLI0_RX_UMD1_INT_8822C BIT(2) -+#define BIT_FS_CLI0_RX_BMD0_INT_8822C BIT(1) -+#define BIT_FS_CLI0_RX_BMD1_INT_8822C BIT(0) -+ -+/* 2 REG_FT1IMR_8822C */ -+#define BIT__FT2ISR__IND_MSK_8822C BIT(30) -+#define BIT_FTM_PTT_INT_EN_8822C BIT(29) -+#define BIT_RXFTMREQ_INT_EN_8822C BIT(28) -+#define BIT_RXFTM_INT_EN_8822C BIT(27) -+#define BIT_TXFTM_INT_EN_8822C BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_EN_8822C BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_EN_8822C BIT(24) -+#define BIT_FS_MACID_PWRCHANGE5_INT_EN_8822C BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_EN_8822C BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_EN_8822C BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_EN_8822C BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_EN_8822C BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_EN_8822C BIT(18) -+#define BIT_FS_CTWEND2_INT_EN_8822C BIT(17) -+#define BIT_FS_CTWEND1_INT_EN_8822C BIT(16) -+#define BIT_FS_CTWEND0_INT_EN_8822C BIT(15) -+#define BIT_FS_TX_NULL1_INT_EN_8822C BIT(14) -+#define BIT_FS_TX_NULL0_INT_EN_8822C BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_EN_8822C BIT(12) -+#define BIT_FS_P2P_RFON2_INT_EN_8822C BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_EN_8822C BIT(10) -+#define BIT_FS_P2P_RFON1_INT_EN_8822C BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_EN_8822C BIT(8) -+#define BIT_FS_P2P_RFON0_INT_EN_8822C BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_EN_8822C BIT(6) -+#define BIT_FS_RX_UAPSDMD1_EN_8822C BIT(5) -+#define BIT_FS_RX_UAPSDMD0_EN_8822C BIT(4) -+#define BIT_FS_TRIGGER_PKT_EN_8822C BIT(3) -+#define BIT_FS_EOSP_INT_EN_8822C BIT(2) -+#define BIT_FS_RPWM2_INT_EN_8822C BIT(1) -+#define BIT_FS_RPWM_INT_EN_8822C BIT(0) -+ -+/* 2 REG_FT1ISR_8822C */ -+#define BIT__FT2ISR__IND_INT_8822C BIT(30) -+#define BIT_FTM_PTT_INT_8822C BIT(29) -+#define BIT_RXFTMREQ_INT_8822C BIT(28) -+#define BIT_RXFTM_INT_8822C BIT(27) -+#define BIT_TXFTM_INT_8822C BIT(26) -+#define BIT_FS_H2C_CMD_OK_INT_8822C BIT(25) -+#define BIT_FS_H2C_CMD_FULL_INT_8822C BIT(24) -+#define BIT_FS_MACID_PWRCHANGE5_INT_8822C BIT(23) -+#define BIT_FS_MACID_PWRCHANGE4_INT_8822C BIT(22) -+#define BIT_FS_MACID_PWRCHANGE3_INT_8822C BIT(21) -+#define BIT_FS_MACID_PWRCHANGE2_INT_8822C BIT(20) -+#define BIT_FS_MACID_PWRCHANGE1_INT_8822C BIT(19) -+#define BIT_FS_MACID_PWRCHANGE0_INT_8822C BIT(18) -+#define BIT_FS_CTWEND2_INT_8822C BIT(17) -+#define BIT_FS_CTWEND1_INT_8822C BIT(16) -+#define BIT_FS_CTWEND0_INT_8822C BIT(15) -+#define BIT_FS_TX_NULL1_INT_8822C BIT(14) -+#define BIT_FS_TX_NULL0_INT_8822C BIT(13) -+#define BIT_FS_TSF_BIT32_TOGGLE_INT_8822C BIT(12) -+#define BIT_FS_P2P_RFON2_INT_8822C BIT(11) -+#define BIT_FS_P2P_RFOFF2_INT_8822C BIT(10) -+#define BIT_FS_P2P_RFON1_INT_8822C BIT(9) -+#define BIT_FS_P2P_RFOFF1_INT_8822C BIT(8) -+#define BIT_FS_P2P_RFON0_INT_8822C BIT(7) -+#define BIT_FS_P2P_RFOFF0_INT_8822C BIT(6) -+#define BIT_FS_RX_UAPSDMD1_INT_8822C BIT(5) -+#define BIT_FS_RX_UAPSDMD0_INT_8822C BIT(4) -+#define BIT_FS_TRIGGER_PKT_INT_8822C BIT(3) -+#define BIT_FS_EOSP_INT_8822C BIT(2) -+#define BIT_FS_RPWM2_INT_8822C BIT(1) -+#define BIT_FS_RPWM_INT_8822C BIT(0) -+ -+/* 2 REG_SPWR0_8822C */ -+ -+#define BIT_SHIFT_MID_31TO0_8822C 0 -+#define BIT_MASK_MID_31TO0_8822C 0xffffffffL -+#define BIT_MID_31TO0_8822C(x) \ -+ (((x) & BIT_MASK_MID_31TO0_8822C) << BIT_SHIFT_MID_31TO0_8822C) -+#define BITS_MID_31TO0_8822C \ -+ (BIT_MASK_MID_31TO0_8822C << BIT_SHIFT_MID_31TO0_8822C) -+#define BIT_CLEAR_MID_31TO0_8822C(x) ((x) & (~BITS_MID_31TO0_8822C)) -+#define BIT_GET_MID_31TO0_8822C(x) \ -+ (((x) >> BIT_SHIFT_MID_31TO0_8822C) & BIT_MASK_MID_31TO0_8822C) -+#define BIT_SET_MID_31TO0_8822C(x, v) \ -+ (BIT_CLEAR_MID_31TO0_8822C(x) | BIT_MID_31TO0_8822C(v)) -+ -+/* 2 REG_SPWR1_8822C */ -+ -+#define BIT_SHIFT_MID_63TO32_8822C 0 -+#define BIT_MASK_MID_63TO32_8822C 0xffffffffL -+#define BIT_MID_63TO32_8822C(x) \ -+ (((x) & BIT_MASK_MID_63TO32_8822C) << BIT_SHIFT_MID_63TO32_8822C) -+#define BITS_MID_63TO32_8822C \ -+ (BIT_MASK_MID_63TO32_8822C << BIT_SHIFT_MID_63TO32_8822C) -+#define BIT_CLEAR_MID_63TO32_8822C(x) ((x) & (~BITS_MID_63TO32_8822C)) -+#define BIT_GET_MID_63TO32_8822C(x) \ -+ (((x) >> BIT_SHIFT_MID_63TO32_8822C) & BIT_MASK_MID_63TO32_8822C) -+#define BIT_SET_MID_63TO32_8822C(x, v) \ -+ (BIT_CLEAR_MID_63TO32_8822C(x) | BIT_MID_63TO32_8822C(v)) -+ -+/* 2 REG_SPWR2_8822C */ -+ -+#define BIT_SHIFT_MID_95O64_8822C 0 -+#define BIT_MASK_MID_95O64_8822C 0xffffffffL -+#define BIT_MID_95O64_8822C(x) \ -+ (((x) & BIT_MASK_MID_95O64_8822C) << BIT_SHIFT_MID_95O64_8822C) -+#define BITS_MID_95O64_8822C \ -+ (BIT_MASK_MID_95O64_8822C << BIT_SHIFT_MID_95O64_8822C) -+#define BIT_CLEAR_MID_95O64_8822C(x) ((x) & (~BITS_MID_95O64_8822C)) -+#define BIT_GET_MID_95O64_8822C(x) \ -+ (((x) >> BIT_SHIFT_MID_95O64_8822C) & BIT_MASK_MID_95O64_8822C) -+#define BIT_SET_MID_95O64_8822C(x, v) \ -+ (BIT_CLEAR_MID_95O64_8822C(x) | BIT_MID_95O64_8822C(v)) -+ -+/* 2 REG_SPWR3_8822C */ -+ -+#define BIT_SHIFT_MID_127TO96_8822C 0 -+#define BIT_MASK_MID_127TO96_8822C 0xffffffffL -+#define BIT_MID_127TO96_8822C(x) \ -+ (((x) & BIT_MASK_MID_127TO96_8822C) << BIT_SHIFT_MID_127TO96_8822C) -+#define BITS_MID_127TO96_8822C \ -+ (BIT_MASK_MID_127TO96_8822C << BIT_SHIFT_MID_127TO96_8822C) -+#define BIT_CLEAR_MID_127TO96_8822C(x) ((x) & (~BITS_MID_127TO96_8822C)) -+#define BIT_GET_MID_127TO96_8822C(x) \ -+ (((x) >> BIT_SHIFT_MID_127TO96_8822C) & BIT_MASK_MID_127TO96_8822C) -+#define BIT_SET_MID_127TO96_8822C(x, v) \ -+ (BIT_CLEAR_MID_127TO96_8822C(x) | BIT_MID_127TO96_8822C(v)) -+ -+/* 2 REG_POWSEQ_8822C */ -+ -+#define BIT_SHIFT_SEQNUM_MID_8822C 16 -+#define BIT_MASK_SEQNUM_MID_8822C 0xffff -+#define BIT_SEQNUM_MID_8822C(x) \ -+ (((x) & BIT_MASK_SEQNUM_MID_8822C) << BIT_SHIFT_SEQNUM_MID_8822C) -+#define BITS_SEQNUM_MID_8822C \ -+ (BIT_MASK_SEQNUM_MID_8822C << BIT_SHIFT_SEQNUM_MID_8822C) -+#define BIT_CLEAR_SEQNUM_MID_8822C(x) ((x) & (~BITS_SEQNUM_MID_8822C)) -+#define BIT_GET_SEQNUM_MID_8822C(x) \ -+ (((x) >> BIT_SHIFT_SEQNUM_MID_8822C) & BIT_MASK_SEQNUM_MID_8822C) -+#define BIT_SET_SEQNUM_MID_8822C(x, v) \ -+ (BIT_CLEAR_SEQNUM_MID_8822C(x) | BIT_SEQNUM_MID_8822C(v)) -+ -+#define BIT_SHIFT_REF_MID_8822C 0 -+#define BIT_MASK_REF_MID_8822C 0x7f -+#define BIT_REF_MID_8822C(x) \ -+ (((x) & BIT_MASK_REF_MID_8822C) << BIT_SHIFT_REF_MID_8822C) -+#define BITS_REF_MID_8822C (BIT_MASK_REF_MID_8822C << BIT_SHIFT_REF_MID_8822C) -+#define BIT_CLEAR_REF_MID_8822C(x) ((x) & (~BITS_REF_MID_8822C)) -+#define BIT_GET_REF_MID_8822C(x) \ -+ (((x) >> BIT_SHIFT_REF_MID_8822C) & BIT_MASK_REF_MID_8822C) -+#define BIT_SET_REF_MID_8822C(x, v) \ -+ (BIT_CLEAR_REF_MID_8822C(x) | BIT_REF_MID_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_TC7_CTRL_V1_8822C */ -+#define BIT_TC7INT_EN_8822C BIT(26) -+#define BIT_TC7MODE_8822C BIT(25) -+#define BIT_TC7EN_8822C BIT(24) -+ -+#define BIT_SHIFT_TC7DATA_8822C 0 -+#define BIT_MASK_TC7DATA_8822C 0xffffff -+#define BIT_TC7DATA_8822C(x) \ -+ (((x) & BIT_MASK_TC7DATA_8822C) << BIT_SHIFT_TC7DATA_8822C) -+#define BITS_TC7DATA_8822C (BIT_MASK_TC7DATA_8822C << BIT_SHIFT_TC7DATA_8822C) -+#define BIT_CLEAR_TC7DATA_8822C(x) ((x) & (~BITS_TC7DATA_8822C)) -+#define BIT_GET_TC7DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TC7DATA_8822C) & BIT_MASK_TC7DATA_8822C) -+#define BIT_SET_TC7DATA_8822C(x, v) \ -+ (BIT_CLEAR_TC7DATA_8822C(x) | BIT_TC7DATA_8822C(v)) -+ -+/* 2 REG_TC8_CTRL_V1_8822C */ -+#define BIT_TC8INT_EN_8822C BIT(26) -+#define BIT_TC8MODE_8822C BIT(25) -+#define BIT_TC8EN_8822C BIT(24) -+ -+#define BIT_SHIFT_TC8DATA_8822C 0 -+#define BIT_MASK_TC8DATA_8822C 0xffffff -+#define BIT_TC8DATA_8822C(x) \ -+ (((x) & BIT_MASK_TC8DATA_8822C) << BIT_SHIFT_TC8DATA_8822C) -+#define BITS_TC8DATA_8822C (BIT_MASK_TC8DATA_8822C << BIT_SHIFT_TC8DATA_8822C) -+#define BIT_CLEAR_TC8DATA_8822C(x) ((x) & (~BITS_TC8DATA_8822C)) -+#define BIT_GET_TC8DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TC8DATA_8822C) & BIT_MASK_TC8DATA_8822C) -+#define BIT_SET_TC8DATA_8822C(x, v) \ -+ (BIT_CLEAR_TC8DATA_8822C(x) | BIT_TC8DATA_8822C(v)) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL0_8822C */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8822C 24 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8822C 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT2_8822C(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8822C) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8822C) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT2_8822C \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8822C \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8822C) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT2_8822C(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT2_8822C)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT2_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT2_8822C) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT2_8822C) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT2_8822C(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT2_8822C(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT2_8822C(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8822C 16 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8822C 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT1_8822C(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8822C) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8822C) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT1_8822C \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8822C \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8822C) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT1_8822C(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT1_8822C)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT1_8822C) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT1_8822C) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT1_8822C(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT1_8822C(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT1_8822C(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8822C 8 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8822C 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT0_8822C(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8822C) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8822C) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT0_8822C \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8822C \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8822C) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT0_8822C(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT0_8822C)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT0_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT0_8822C) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT0_8822C) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT0_8822C(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT0_8822C(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT0_8822C(v)) -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8822C 0 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8822C 0xff -+#define BIT_RX_BCN_TBTT_ITVL_PORT0_8822C(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8822C) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8822C) -+#define BITS_RX_BCN_TBTT_ITVL_PORT0_8822C \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8822C \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8822C) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_PORT0_8822C(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_PORT0_8822C)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_PORT0_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_PORT0_8822C) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_PORT0_8822C) -+#define BIT_SET_RX_BCN_TBTT_ITVL_PORT0_8822C(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_PORT0_8822C(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_PORT0_8822C(v)) -+ -+/* 2 REG_RX_BCN_TBTT_ITVL1_8822C */ -+ -+#define BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8822C 0 -+#define BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8822C 0xff -+#define BIT_RX_BCN_TBTT_ITVL_CLIENT3_8822C(x) \ -+ (((x) & BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8822C) \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8822C) -+#define BITS_RX_BCN_TBTT_ITVL_CLIENT3_8822C \ -+ (BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8822C \ -+ << BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8822C) -+#define BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT3_8822C(x) \ -+ ((x) & (~BITS_RX_BCN_TBTT_ITVL_CLIENT3_8822C)) -+#define BIT_GET_RX_BCN_TBTT_ITVL_CLIENT3_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_BCN_TBTT_ITVL_CLIENT3_8822C) & \ -+ BIT_MASK_RX_BCN_TBTT_ITVL_CLIENT3_8822C) -+#define BIT_SET_RX_BCN_TBTT_ITVL_CLIENT3_8822C(x, v) \ -+ (BIT_CLEAR_RX_BCN_TBTT_ITVL_CLIENT3_8822C(x) | \ -+ BIT_RX_BCN_TBTT_ITVL_CLIENT3_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_IO_WRAP_ERR_FLAG_8822C */ -+#define BIT_IO_WRAP_ERR_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_SPEED_SENSOR_8822C */ -+#define BIT_DSS_1_RST_N_8822C BIT(31) -+#define BIT_DSS_1_SPEED_EN_8822C BIT(30) -+#define BIT_DSS_1_WIRE_SEL_8822C BIT(29) -+#define BIT_DSS_ENCLK_8822C BIT(28) -+ -+#define BIT_SHIFT_DSS_1_RO_SEL_8822C 24 -+#define BIT_MASK_DSS_1_RO_SEL_8822C 0x7 -+#define BIT_DSS_1_RO_SEL_8822C(x) \ -+ (((x) & BIT_MASK_DSS_1_RO_SEL_8822C) << BIT_SHIFT_DSS_1_RO_SEL_8822C) -+#define BITS_DSS_1_RO_SEL_8822C \ -+ (BIT_MASK_DSS_1_RO_SEL_8822C << BIT_SHIFT_DSS_1_RO_SEL_8822C) -+#define BIT_CLEAR_DSS_1_RO_SEL_8822C(x) ((x) & (~BITS_DSS_1_RO_SEL_8822C)) -+#define BIT_GET_DSS_1_RO_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_RO_SEL_8822C) & BIT_MASK_DSS_1_RO_SEL_8822C) -+#define BIT_SET_DSS_1_RO_SEL_8822C(x, v) \ -+ (BIT_CLEAR_DSS_1_RO_SEL_8822C(x) | BIT_DSS_1_RO_SEL_8822C(v)) -+ -+#define BIT_SHIFT_DSS_1_DATA_IN_8822C 0 -+#define BIT_MASK_DSS_1_DATA_IN_8822C 0xfffff -+#define BIT_DSS_1_DATA_IN_8822C(x) \ -+ (((x) & BIT_MASK_DSS_1_DATA_IN_8822C) << BIT_SHIFT_DSS_1_DATA_IN_8822C) -+#define BITS_DSS_1_DATA_IN_8822C \ -+ (BIT_MASK_DSS_1_DATA_IN_8822C << BIT_SHIFT_DSS_1_DATA_IN_8822C) -+#define BIT_CLEAR_DSS_1_DATA_IN_8822C(x) ((x) & (~BITS_DSS_1_DATA_IN_8822C)) -+#define BIT_GET_DSS_1_DATA_IN_8822C(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_DATA_IN_8822C) & BIT_MASK_DSS_1_DATA_IN_8822C) -+#define BIT_SET_DSS_1_DATA_IN_8822C(x, v) \ -+ (BIT_CLEAR_DSS_1_DATA_IN_8822C(x) | BIT_DSS_1_DATA_IN_8822C(v)) -+ -+/* 2 REG_SPEED_SENSOR1_8822C */ -+#define BIT_DSS_1_READY_8822C BIT(31) -+#define BIT_DSS_1_WSORT_GO_8822C BIT(30) -+ -+#define BIT_SHIFT_DSS_1_COUNT_OUT_8822C 0 -+#define BIT_MASK_DSS_1_COUNT_OUT_8822C 0xfffff -+#define BIT_DSS_1_COUNT_OUT_8822C(x) \ -+ (((x) & BIT_MASK_DSS_1_COUNT_OUT_8822C) \ -+ << BIT_SHIFT_DSS_1_COUNT_OUT_8822C) -+#define BITS_DSS_1_COUNT_OUT_8822C \ -+ (BIT_MASK_DSS_1_COUNT_OUT_8822C << BIT_SHIFT_DSS_1_COUNT_OUT_8822C) -+#define BIT_CLEAR_DSS_1_COUNT_OUT_8822C(x) ((x) & (~BITS_DSS_1_COUNT_OUT_8822C)) -+#define BIT_GET_DSS_1_COUNT_OUT_8822C(x) \ -+ (((x) >> BIT_SHIFT_DSS_1_COUNT_OUT_8822C) & \ -+ BIT_MASK_DSS_1_COUNT_OUT_8822C) -+#define BIT_SET_DSS_1_COUNT_OUT_8822C(x, v) \ -+ (BIT_CLEAR_DSS_1_COUNT_OUT_8822C(x) | BIT_DSS_1_COUNT_OUT_8822C(v)) -+ -+/* 2 REG_SPEED_SENSOR2_8822C */ -+#define BIT_DSS_2_RST_N_8822C BIT(31) -+#define BIT_DSS_2_SPEED_EN_8822C BIT(30) -+#define BIT_DSS_2_WIRE_SEL_8822C BIT(29) -+#define BIT_DSS_ENCLK_8822C BIT(28) -+ -+#define BIT_SHIFT_DSS_2_RO_SEL_8822C 24 -+#define BIT_MASK_DSS_2_RO_SEL_8822C 0x7 -+#define BIT_DSS_2_RO_SEL_8822C(x) \ -+ (((x) & BIT_MASK_DSS_2_RO_SEL_8822C) << BIT_SHIFT_DSS_2_RO_SEL_8822C) -+#define BITS_DSS_2_RO_SEL_8822C \ -+ (BIT_MASK_DSS_2_RO_SEL_8822C << BIT_SHIFT_DSS_2_RO_SEL_8822C) -+#define BIT_CLEAR_DSS_2_RO_SEL_8822C(x) ((x) & (~BITS_DSS_2_RO_SEL_8822C)) -+#define BIT_GET_DSS_2_RO_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_RO_SEL_8822C) & BIT_MASK_DSS_2_RO_SEL_8822C) -+#define BIT_SET_DSS_2_RO_SEL_8822C(x, v) \ -+ (BIT_CLEAR_DSS_2_RO_SEL_8822C(x) | BIT_DSS_2_RO_SEL_8822C(v)) -+ -+#define BIT_SHIFT_DSS_2_DATA_IN_8822C 0 -+#define BIT_MASK_DSS_2_DATA_IN_8822C 0xfffff -+#define BIT_DSS_2_DATA_IN_8822C(x) \ -+ (((x) & BIT_MASK_DSS_2_DATA_IN_8822C) << BIT_SHIFT_DSS_2_DATA_IN_8822C) -+#define BITS_DSS_2_DATA_IN_8822C \ -+ (BIT_MASK_DSS_2_DATA_IN_8822C << BIT_SHIFT_DSS_2_DATA_IN_8822C) -+#define BIT_CLEAR_DSS_2_DATA_IN_8822C(x) ((x) & (~BITS_DSS_2_DATA_IN_8822C)) -+#define BIT_GET_DSS_2_DATA_IN_8822C(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_DATA_IN_8822C) & BIT_MASK_DSS_2_DATA_IN_8822C) -+#define BIT_SET_DSS_2_DATA_IN_8822C(x, v) \ -+ (BIT_CLEAR_DSS_2_DATA_IN_8822C(x) | BIT_DSS_2_DATA_IN_8822C(v)) -+ -+/* 2 REG_SPEED_SENSOR3_8822C */ -+#define BIT_DSS_2_READY_8822C BIT(31) -+#define BIT_DSS_2_WSORT_GO_8822C BIT(30) -+ -+#define BIT_SHIFT_DSS_2_COUNT_OUT_8822C 0 -+#define BIT_MASK_DSS_2_COUNT_OUT_8822C 0xfffff -+#define BIT_DSS_2_COUNT_OUT_8822C(x) \ -+ (((x) & BIT_MASK_DSS_2_COUNT_OUT_8822C) \ -+ << BIT_SHIFT_DSS_2_COUNT_OUT_8822C) -+#define BITS_DSS_2_COUNT_OUT_8822C \ -+ (BIT_MASK_DSS_2_COUNT_OUT_8822C << BIT_SHIFT_DSS_2_COUNT_OUT_8822C) -+#define BIT_CLEAR_DSS_2_COUNT_OUT_8822C(x) ((x) & (~BITS_DSS_2_COUNT_OUT_8822C)) -+#define BIT_GET_DSS_2_COUNT_OUT_8822C(x) \ -+ (((x) >> BIT_SHIFT_DSS_2_COUNT_OUT_8822C) & \ -+ BIT_MASK_DSS_2_COUNT_OUT_8822C) -+#define BIT_SET_DSS_2_COUNT_OUT_8822C(x, v) \ -+ (BIT_CLEAR_DSS_2_COUNT_OUT_8822C(x) | BIT_DSS_2_COUNT_OUT_8822C(v)) -+ -+/* 2 REG_SPEED_SENSOR4_8822C */ -+#define BIT_DSS_3_RST_N_8822C BIT(31) -+#define BIT_DSS_3_SPEED_EN_8822C BIT(30) -+#define BIT_DSS_3_WIRE_SEL_8822C BIT(29) -+#define BIT_DSS_ENCLK_8822C BIT(28) -+ -+#define BIT_SHIFT_DSS_3_RO_SEL_8822C 24 -+#define BIT_MASK_DSS_3_RO_SEL_8822C 0x7 -+#define BIT_DSS_3_RO_SEL_8822C(x) \ -+ (((x) & BIT_MASK_DSS_3_RO_SEL_8822C) << BIT_SHIFT_DSS_3_RO_SEL_8822C) -+#define BITS_DSS_3_RO_SEL_8822C \ -+ (BIT_MASK_DSS_3_RO_SEL_8822C << BIT_SHIFT_DSS_3_RO_SEL_8822C) -+#define BIT_CLEAR_DSS_3_RO_SEL_8822C(x) ((x) & (~BITS_DSS_3_RO_SEL_8822C)) -+#define BIT_GET_DSS_3_RO_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_RO_SEL_8822C) & BIT_MASK_DSS_3_RO_SEL_8822C) -+#define BIT_SET_DSS_3_RO_SEL_8822C(x, v) \ -+ (BIT_CLEAR_DSS_3_RO_SEL_8822C(x) | BIT_DSS_3_RO_SEL_8822C(v)) -+ -+#define BIT_SHIFT_DSS_3_DATA_IN_8822C 0 -+#define BIT_MASK_DSS_3_DATA_IN_8822C 0xfffff -+#define BIT_DSS_3_DATA_IN_8822C(x) \ -+ (((x) & BIT_MASK_DSS_3_DATA_IN_8822C) << BIT_SHIFT_DSS_3_DATA_IN_8822C) -+#define BITS_DSS_3_DATA_IN_8822C \ -+ (BIT_MASK_DSS_3_DATA_IN_8822C << BIT_SHIFT_DSS_3_DATA_IN_8822C) -+#define BIT_CLEAR_DSS_3_DATA_IN_8822C(x) ((x) & (~BITS_DSS_3_DATA_IN_8822C)) -+#define BIT_GET_DSS_3_DATA_IN_8822C(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_DATA_IN_8822C) & BIT_MASK_DSS_3_DATA_IN_8822C) -+#define BIT_SET_DSS_3_DATA_IN_8822C(x, v) \ -+ (BIT_CLEAR_DSS_3_DATA_IN_8822C(x) | BIT_DSS_3_DATA_IN_8822C(v)) -+ -+/* 2 REG_SPEED_SENSOR5_8822C */ -+#define BIT_DSS_3_READY_8822C BIT(31) -+#define BIT_DSS_3_WSORT_GO_8822C BIT(30) -+ -+#define BIT_SHIFT_DSS_3_COUNT_OUT_8822C 0 -+#define BIT_MASK_DSS_3_COUNT_OUT_8822C 0xfffff -+#define BIT_DSS_3_COUNT_OUT_8822C(x) \ -+ (((x) & BIT_MASK_DSS_3_COUNT_OUT_8822C) \ -+ << BIT_SHIFT_DSS_3_COUNT_OUT_8822C) -+#define BITS_DSS_3_COUNT_OUT_8822C \ -+ (BIT_MASK_DSS_3_COUNT_OUT_8822C << BIT_SHIFT_DSS_3_COUNT_OUT_8822C) -+#define BIT_CLEAR_DSS_3_COUNT_OUT_8822C(x) ((x) & (~BITS_DSS_3_COUNT_OUT_8822C)) -+#define BIT_GET_DSS_3_COUNT_OUT_8822C(x) \ -+ (((x) >> BIT_SHIFT_DSS_3_COUNT_OUT_8822C) & \ -+ BIT_MASK_DSS_3_COUNT_OUT_8822C) -+#define BIT_SET_DSS_3_COUNT_OUT_8822C(x, v) \ -+ (BIT_CLEAR_DSS_3_COUNT_OUT_8822C(x) | BIT_DSS_3_COUNT_OUT_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_COUNTER_CTRL_8822C */ -+ -+#define BIT_SHIFT_COUNTER_BASE_8822C 16 -+#define BIT_MASK_COUNTER_BASE_8822C 0x1fff -+#define BIT_COUNTER_BASE_8822C(x) \ -+ (((x) & BIT_MASK_COUNTER_BASE_8822C) << BIT_SHIFT_COUNTER_BASE_8822C) -+#define BITS_COUNTER_BASE_8822C \ -+ (BIT_MASK_COUNTER_BASE_8822C << BIT_SHIFT_COUNTER_BASE_8822C) -+#define BIT_CLEAR_COUNTER_BASE_8822C(x) ((x) & (~BITS_COUNTER_BASE_8822C)) -+#define BIT_GET_COUNTER_BASE_8822C(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_BASE_8822C) & BIT_MASK_COUNTER_BASE_8822C) -+#define BIT_SET_COUNTER_BASE_8822C(x, v) \ -+ (BIT_CLEAR_COUNTER_BASE_8822C(x) | BIT_COUNTER_BASE_8822C(v)) -+ -+#define BIT_EN_RTS_REQ_8822C BIT(9) -+#define BIT_EN_EDCA_REQ_8822C BIT(8) -+#define BIT_EN_PTCL_REQ_8822C BIT(7) -+#define BIT_EN_SCH_REQ_8822C BIT(6) -+#define BIT_USB_COUNT_EN_8822C BIT(5) -+#define BIT_PCIE_COUNT_EN_8822C BIT(4) -+#define BIT_RQPN_COUNT_EN_8822C BIT(3) -+#define BIT_RDE_COUNT_EN_8822C BIT(2) -+#define BIT_TDE_COUNT_EN_8822C BIT(1) -+#define BIT_DISABLE_COUNTER_8822C BIT(0) -+ -+/* 2 REG_COUNTER_THRESHOLD_8822C */ -+#define BIT_SEL_ALL_MACID_8822C BIT(31) -+ -+#define BIT_SHIFT_COUNTER_MACID_8822C 24 -+#define BIT_MASK_COUNTER_MACID_8822C 0x7f -+#define BIT_COUNTER_MACID_8822C(x) \ -+ (((x) & BIT_MASK_COUNTER_MACID_8822C) << BIT_SHIFT_COUNTER_MACID_8822C) -+#define BITS_COUNTER_MACID_8822C \ -+ (BIT_MASK_COUNTER_MACID_8822C << BIT_SHIFT_COUNTER_MACID_8822C) -+#define BIT_CLEAR_COUNTER_MACID_8822C(x) ((x) & (~BITS_COUNTER_MACID_8822C)) -+#define BIT_GET_COUNTER_MACID_8822C(x) \ -+ (((x) >> BIT_SHIFT_COUNTER_MACID_8822C) & BIT_MASK_COUNTER_MACID_8822C) -+#define BIT_SET_COUNTER_MACID_8822C(x, v) \ -+ (BIT_CLEAR_COUNTER_MACID_8822C(x) | BIT_COUNTER_MACID_8822C(v)) -+ -+#define BIT_SHIFT_AGG_VALUE2_8822C 16 -+#define BIT_MASK_AGG_VALUE2_8822C 0x7f -+#define BIT_AGG_VALUE2_8822C(x) \ -+ (((x) & BIT_MASK_AGG_VALUE2_8822C) << BIT_SHIFT_AGG_VALUE2_8822C) -+#define BITS_AGG_VALUE2_8822C \ -+ (BIT_MASK_AGG_VALUE2_8822C << BIT_SHIFT_AGG_VALUE2_8822C) -+#define BIT_CLEAR_AGG_VALUE2_8822C(x) ((x) & (~BITS_AGG_VALUE2_8822C)) -+#define BIT_GET_AGG_VALUE2_8822C(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE2_8822C) & BIT_MASK_AGG_VALUE2_8822C) -+#define BIT_SET_AGG_VALUE2_8822C(x, v) \ -+ (BIT_CLEAR_AGG_VALUE2_8822C(x) | BIT_AGG_VALUE2_8822C(v)) -+ -+#define BIT_SHIFT_AGG_VALUE1_8822C 8 -+#define BIT_MASK_AGG_VALUE1_8822C 0x7f -+#define BIT_AGG_VALUE1_8822C(x) \ -+ (((x) & BIT_MASK_AGG_VALUE1_8822C) << BIT_SHIFT_AGG_VALUE1_8822C) -+#define BITS_AGG_VALUE1_8822C \ -+ (BIT_MASK_AGG_VALUE1_8822C << BIT_SHIFT_AGG_VALUE1_8822C) -+#define BIT_CLEAR_AGG_VALUE1_8822C(x) ((x) & (~BITS_AGG_VALUE1_8822C)) -+#define BIT_GET_AGG_VALUE1_8822C(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE1_8822C) & BIT_MASK_AGG_VALUE1_8822C) -+#define BIT_SET_AGG_VALUE1_8822C(x, v) \ -+ (BIT_CLEAR_AGG_VALUE1_8822C(x) | BIT_AGG_VALUE1_8822C(v)) -+ -+#define BIT_SHIFT_AGG_VALUE0_8822C 0 -+#define BIT_MASK_AGG_VALUE0_8822C 0x7f -+#define BIT_AGG_VALUE0_8822C(x) \ -+ (((x) & BIT_MASK_AGG_VALUE0_8822C) << BIT_SHIFT_AGG_VALUE0_8822C) -+#define BITS_AGG_VALUE0_8822C \ -+ (BIT_MASK_AGG_VALUE0_8822C << BIT_SHIFT_AGG_VALUE0_8822C) -+#define BIT_CLEAR_AGG_VALUE0_8822C(x) ((x) & (~BITS_AGG_VALUE0_8822C)) -+#define BIT_GET_AGG_VALUE0_8822C(x) \ -+ (((x) >> BIT_SHIFT_AGG_VALUE0_8822C) & BIT_MASK_AGG_VALUE0_8822C) -+#define BIT_SET_AGG_VALUE0_8822C(x, v) \ -+ (BIT_CLEAR_AGG_VALUE0_8822C(x) | BIT_AGG_VALUE0_8822C(v)) -+ -+/* 2 REG_COUNTER_SET_8822C */ -+ -+#define BIT_SHIFT_REQUEST_RESET_8822C 16 -+#define BIT_MASK_REQUEST_RESET_8822C 0xffff -+#define BIT_REQUEST_RESET_8822C(x) \ -+ (((x) & BIT_MASK_REQUEST_RESET_8822C) << BIT_SHIFT_REQUEST_RESET_8822C) -+#define BITS_REQUEST_RESET_8822C \ -+ (BIT_MASK_REQUEST_RESET_8822C << BIT_SHIFT_REQUEST_RESET_8822C) -+#define BIT_CLEAR_REQUEST_RESET_8822C(x) ((x) & (~BITS_REQUEST_RESET_8822C)) -+#define BIT_GET_REQUEST_RESET_8822C(x) \ -+ (((x) >> BIT_SHIFT_REQUEST_RESET_8822C) & BIT_MASK_REQUEST_RESET_8822C) -+#define BIT_SET_REQUEST_RESET_8822C(x, v) \ -+ (BIT_CLEAR_REQUEST_RESET_8822C(x) | BIT_REQUEST_RESET_8822C(v)) -+ -+#define BIT_SHIFT_REQUEST_START_8822C 0 -+#define BIT_MASK_REQUEST_START_8822C 0xffff -+#define BIT_REQUEST_START_8822C(x) \ -+ (((x) & BIT_MASK_REQUEST_START_8822C) << BIT_SHIFT_REQUEST_START_8822C) -+#define BITS_REQUEST_START_8822C \ -+ (BIT_MASK_REQUEST_START_8822C << BIT_SHIFT_REQUEST_START_8822C) -+#define BIT_CLEAR_REQUEST_START_8822C(x) ((x) & (~BITS_REQUEST_START_8822C)) -+#define BIT_GET_REQUEST_START_8822C(x) \ -+ (((x) >> BIT_SHIFT_REQUEST_START_8822C) & BIT_MASK_REQUEST_START_8822C) -+#define BIT_SET_REQUEST_START_8822C(x, v) \ -+ (BIT_CLEAR_REQUEST_START_8822C(x) | BIT_REQUEST_START_8822C(v)) -+ -+/* 2 REG_COUNTER_OVERFLOW_8822C */ -+ -+#define BIT_SHIFT_CNT_OVF_REG_8822C 0 -+#define BIT_MASK_CNT_OVF_REG_8822C 0xffff -+#define BIT_CNT_OVF_REG_8822C(x) \ -+ (((x) & BIT_MASK_CNT_OVF_REG_8822C) << BIT_SHIFT_CNT_OVF_REG_8822C) -+#define BITS_CNT_OVF_REG_8822C \ -+ (BIT_MASK_CNT_OVF_REG_8822C << BIT_SHIFT_CNT_OVF_REG_8822C) -+#define BIT_CLEAR_CNT_OVF_REG_8822C(x) ((x) & (~BITS_CNT_OVF_REG_8822C)) -+#define BIT_GET_CNT_OVF_REG_8822C(x) \ -+ (((x) >> BIT_SHIFT_CNT_OVF_REG_8822C) & BIT_MASK_CNT_OVF_REG_8822C) -+#define BIT_SET_CNT_OVF_REG_8822C(x, v) \ -+ (BIT_CLEAR_CNT_OVF_REG_8822C(x) | BIT_CNT_OVF_REG_8822C(v)) -+ -+/* 2 REG_TXDMA_LEN_THRESHOLD_8822C */ -+ -+#define BIT_SHIFT_TDE_LEN_TH1_8822C 16 -+#define BIT_MASK_TDE_LEN_TH1_8822C 0xffff -+#define BIT_TDE_LEN_TH1_8822C(x) \ -+ (((x) & BIT_MASK_TDE_LEN_TH1_8822C) << BIT_SHIFT_TDE_LEN_TH1_8822C) -+#define BITS_TDE_LEN_TH1_8822C \ -+ (BIT_MASK_TDE_LEN_TH1_8822C << BIT_SHIFT_TDE_LEN_TH1_8822C) -+#define BIT_CLEAR_TDE_LEN_TH1_8822C(x) ((x) & (~BITS_TDE_LEN_TH1_8822C)) -+#define BIT_GET_TDE_LEN_TH1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TDE_LEN_TH1_8822C) & BIT_MASK_TDE_LEN_TH1_8822C) -+#define BIT_SET_TDE_LEN_TH1_8822C(x, v) \ -+ (BIT_CLEAR_TDE_LEN_TH1_8822C(x) | BIT_TDE_LEN_TH1_8822C(v)) -+ -+#define BIT_SHIFT_TDE_LEN_TH0_8822C 0 -+#define BIT_MASK_TDE_LEN_TH0_8822C 0xffff -+#define BIT_TDE_LEN_TH0_8822C(x) \ -+ (((x) & BIT_MASK_TDE_LEN_TH0_8822C) << BIT_SHIFT_TDE_LEN_TH0_8822C) -+#define BITS_TDE_LEN_TH0_8822C \ -+ (BIT_MASK_TDE_LEN_TH0_8822C << BIT_SHIFT_TDE_LEN_TH0_8822C) -+#define BIT_CLEAR_TDE_LEN_TH0_8822C(x) ((x) & (~BITS_TDE_LEN_TH0_8822C)) -+#define BIT_GET_TDE_LEN_TH0_8822C(x) \ -+ (((x) >> BIT_SHIFT_TDE_LEN_TH0_8822C) & BIT_MASK_TDE_LEN_TH0_8822C) -+#define BIT_SET_TDE_LEN_TH0_8822C(x, v) \ -+ (BIT_CLEAR_TDE_LEN_TH0_8822C(x) | BIT_TDE_LEN_TH0_8822C(v)) -+ -+/* 2 REG_RXDMA_LEN_THRESHOLD_8822C */ -+ -+#define BIT_SHIFT_RDE_LEN_TH1_8822C 16 -+#define BIT_MASK_RDE_LEN_TH1_8822C 0xffff -+#define BIT_RDE_LEN_TH1_8822C(x) \ -+ (((x) & BIT_MASK_RDE_LEN_TH1_8822C) << BIT_SHIFT_RDE_LEN_TH1_8822C) -+#define BITS_RDE_LEN_TH1_8822C \ -+ (BIT_MASK_RDE_LEN_TH1_8822C << BIT_SHIFT_RDE_LEN_TH1_8822C) -+#define BIT_CLEAR_RDE_LEN_TH1_8822C(x) ((x) & (~BITS_RDE_LEN_TH1_8822C)) -+#define BIT_GET_RDE_LEN_TH1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RDE_LEN_TH1_8822C) & BIT_MASK_RDE_LEN_TH1_8822C) -+#define BIT_SET_RDE_LEN_TH1_8822C(x, v) \ -+ (BIT_CLEAR_RDE_LEN_TH1_8822C(x) | BIT_RDE_LEN_TH1_8822C(v)) -+ -+#define BIT_SHIFT_RDE_LEN_TH0_8822C 0 -+#define BIT_MASK_RDE_LEN_TH0_8822C 0xffff -+#define BIT_RDE_LEN_TH0_8822C(x) \ -+ (((x) & BIT_MASK_RDE_LEN_TH0_8822C) << BIT_SHIFT_RDE_LEN_TH0_8822C) -+#define BITS_RDE_LEN_TH0_8822C \ -+ (BIT_MASK_RDE_LEN_TH0_8822C << BIT_SHIFT_RDE_LEN_TH0_8822C) -+#define BIT_CLEAR_RDE_LEN_TH0_8822C(x) ((x) & (~BITS_RDE_LEN_TH0_8822C)) -+#define BIT_GET_RDE_LEN_TH0_8822C(x) \ -+ (((x) >> BIT_SHIFT_RDE_LEN_TH0_8822C) & BIT_MASK_RDE_LEN_TH0_8822C) -+#define BIT_SET_RDE_LEN_TH0_8822C(x, v) \ -+ (BIT_CLEAR_RDE_LEN_TH0_8822C(x) | BIT_RDE_LEN_TH0_8822C(v)) -+ -+/* 2 REG_PCIE_EXEC_TIME_THRESHOLD_8822C */ -+ -+#define BIT_SHIFT_COUNT_INT_SEL_8822C 16 -+#define BIT_MASK_COUNT_INT_SEL_8822C 0x3 -+#define BIT_COUNT_INT_SEL_8822C(x) \ -+ (((x) & BIT_MASK_COUNT_INT_SEL_8822C) << BIT_SHIFT_COUNT_INT_SEL_8822C) -+#define BITS_COUNT_INT_SEL_8822C \ -+ (BIT_MASK_COUNT_INT_SEL_8822C << BIT_SHIFT_COUNT_INT_SEL_8822C) -+#define BIT_CLEAR_COUNT_INT_SEL_8822C(x) ((x) & (~BITS_COUNT_INT_SEL_8822C)) -+#define BIT_GET_COUNT_INT_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_COUNT_INT_SEL_8822C) & BIT_MASK_COUNT_INT_SEL_8822C) -+#define BIT_SET_COUNT_INT_SEL_8822C(x, v) \ -+ (BIT_CLEAR_COUNT_INT_SEL_8822C(x) | BIT_COUNT_INT_SEL_8822C(v)) -+ -+#define BIT_SHIFT_EXEC_TIME_TH_8822C 0 -+#define BIT_MASK_EXEC_TIME_TH_8822C 0xffff -+#define BIT_EXEC_TIME_TH_8822C(x) \ -+ (((x) & BIT_MASK_EXEC_TIME_TH_8822C) << BIT_SHIFT_EXEC_TIME_TH_8822C) -+#define BITS_EXEC_TIME_TH_8822C \ -+ (BIT_MASK_EXEC_TIME_TH_8822C << BIT_SHIFT_EXEC_TIME_TH_8822C) -+#define BIT_CLEAR_EXEC_TIME_TH_8822C(x) ((x) & (~BITS_EXEC_TIME_TH_8822C)) -+#define BIT_GET_EXEC_TIME_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_EXEC_TIME_TH_8822C) & BIT_MASK_EXEC_TIME_TH_8822C) -+#define BIT_SET_EXEC_TIME_TH_8822C(x, v) \ -+ (BIT_CLEAR_EXEC_TIME_TH_8822C(x) | BIT_EXEC_TIME_TH_8822C(v)) -+ -+/* 2 REG_FT2IMR_8822C */ -+#define BIT_FS_CLI3_RX_UAPSDMD1_EN_8822C BIT(31) -+#define BIT_FS_CLI3_RX_UAPSDMD0_EN_8822C BIT(30) -+#define BIT_FS_CLI3_TRIGGER_PKT_EN_8822C BIT(29) -+#define BIT_FS_CLI3_EOSP_INT_EN_8822C BIT(28) -+#define BIT_FS_CLI2_RX_UAPSDMD1_EN_8822C BIT(27) -+#define BIT_FS_CLI2_RX_UAPSDMD0_EN_8822C BIT(26) -+#define BIT_FS_CLI2_TRIGGER_PKT_EN_8822C BIT(25) -+#define BIT_FS_CLI2_EOSP_INT_EN_8822C BIT(24) -+#define BIT_FS_CLI1_RX_UAPSDMD1_EN_8822C BIT(23) -+#define BIT_FS_CLI1_RX_UAPSDMD0_EN_8822C BIT(22) -+#define BIT_FS_CLI1_TRIGGER_PKT_EN_8822C BIT(21) -+#define BIT_FS_CLI1_EOSP_INT_EN_8822C BIT(20) -+#define BIT_FS_CLI0_RX_UAPSDMD1_EN_8822C BIT(19) -+#define BIT_FS_CLI0_RX_UAPSDMD0_EN_8822C BIT(18) -+#define BIT_FS_CLI0_TRIGGER_PKT_EN_8822C BIT(17) -+#define BIT_FS_CLI0_EOSP_INT_EN_8822C BIT(16) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_EN_8822C BIT(9) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_EN_8822C BIT(8) -+#define BIT_FS_CLI3_TX_NULL1_INT_EN_8822C BIT(7) -+#define BIT_FS_CLI3_TX_NULL0_INT_EN_8822C BIT(6) -+#define BIT_FS_CLI2_TX_NULL1_INT_EN_8822C BIT(5) -+#define BIT_FS_CLI2_TX_NULL0_INT_EN_8822C BIT(4) -+#define BIT_FS_CLI1_TX_NULL1_INT_EN_8822C BIT(3) -+#define BIT_FS_CLI1_TX_NULL0_INT_EN_8822C BIT(2) -+#define BIT_FS_CLI0_TX_NULL1_INT_EN_8822C BIT(1) -+#define BIT_FS_CLI0_TX_NULL0_INT_EN_8822C BIT(0) -+ -+/* 2 REG_FT2ISR_8822C */ -+#define BIT_FS_CLI3_RX_UAPSDMD1_INT_8822C BIT(31) -+#define BIT_FS_CLI3_RX_UAPSDMD0_INT_8822C BIT(30) -+#define BIT_FS_CLI3_TRIGGER_PKT_INT_8822C BIT(29) -+#define BIT_FS_CLI3_EOSP_INT_8822C BIT(28) -+#define BIT_FS_CLI2_RX_UAPSDMD1_INT_8822C BIT(27) -+#define BIT_FS_CLI2_RX_UAPSDMD0_INT_8822C BIT(26) -+#define BIT_FS_CLI2_TRIGGER_PKT_INT_8822C BIT(25) -+#define BIT_FS_CLI2_EOSP_INT_8822C BIT(24) -+#define BIT_FS_CLI1_RX_UAPSDMD1_INT_8822C BIT(23) -+#define BIT_FS_CLI1_RX_UAPSDMD0_INT_8822C BIT(22) -+#define BIT_FS_CLI1_TRIGGER_PKT_INT_8822C BIT(21) -+#define BIT_FS_CLI1_EOSP_INT_8822C BIT(20) -+#define BIT_FS_CLI0_RX_UAPSDMD1_INT_8822C BIT(19) -+#define BIT_FS_CLI0_RX_UAPSDMD0_INT_8822C BIT(18) -+#define BIT_FS_CLI0_TRIGGER_PKT_INT_8822C BIT(17) -+#define BIT_FS_CLI0_EOSP_INT_8822C BIT(16) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P2_INT_8822C BIT(9) -+#define BIT_FS_TSF_BIT32_TOGGLE_P2P1_INT_8822C BIT(8) -+#define BIT_FS_CLI3_TX_NULL1_INT_8822C BIT(7) -+#define BIT_FS_CLI3_TX_NULL0_INT_8822C BIT(6) -+#define BIT_FS_CLI2_TX_NULL1_INT_8822C BIT(5) -+#define BIT_FS_CLI2_TX_NULL0_INT_8822C BIT(4) -+#define BIT_FS_CLI1_TX_NULL1_INT_8822C BIT(3) -+#define BIT_FS_CLI1_TX_NULL0_INT_8822C BIT(2) -+#define BIT_FS_CLI0_TX_NULL1_INT_8822C BIT(1) -+#define BIT_FS_CLI0_TX_NULL0_INT_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_MSG2_8822C */ -+ -+#define BIT_SHIFT_FW_MSG2_8822C 0 -+#define BIT_MASK_FW_MSG2_8822C 0xffffffffL -+#define BIT_FW_MSG2_8822C(x) \ -+ (((x) & BIT_MASK_FW_MSG2_8822C) << BIT_SHIFT_FW_MSG2_8822C) -+#define BITS_FW_MSG2_8822C (BIT_MASK_FW_MSG2_8822C << BIT_SHIFT_FW_MSG2_8822C) -+#define BIT_CLEAR_FW_MSG2_8822C(x) ((x) & (~BITS_FW_MSG2_8822C)) -+#define BIT_GET_FW_MSG2_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG2_8822C) & BIT_MASK_FW_MSG2_8822C) -+#define BIT_SET_FW_MSG2_8822C(x, v) \ -+ (BIT_CLEAR_FW_MSG2_8822C(x) | BIT_FW_MSG2_8822C(v)) -+ -+/* 2 REG_MSG3_8822C */ -+ -+#define BIT_SHIFT_FW_MSG3_8822C 0 -+#define BIT_MASK_FW_MSG3_8822C 0xffffffffL -+#define BIT_FW_MSG3_8822C(x) \ -+ (((x) & BIT_MASK_FW_MSG3_8822C) << BIT_SHIFT_FW_MSG3_8822C) -+#define BITS_FW_MSG3_8822C (BIT_MASK_FW_MSG3_8822C << BIT_SHIFT_FW_MSG3_8822C) -+#define BIT_CLEAR_FW_MSG3_8822C(x) ((x) & (~BITS_FW_MSG3_8822C)) -+#define BIT_GET_FW_MSG3_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG3_8822C) & BIT_MASK_FW_MSG3_8822C) -+#define BIT_SET_FW_MSG3_8822C(x, v) \ -+ (BIT_CLEAR_FW_MSG3_8822C(x) | BIT_FW_MSG3_8822C(v)) -+ -+/* 2 REG_MSG4_8822C */ -+ -+#define BIT_SHIFT_FW_MSG4_8822C 0 -+#define BIT_MASK_FW_MSG4_8822C 0xffffffffL -+#define BIT_FW_MSG4_8822C(x) \ -+ (((x) & BIT_MASK_FW_MSG4_8822C) << BIT_SHIFT_FW_MSG4_8822C) -+#define BITS_FW_MSG4_8822C (BIT_MASK_FW_MSG4_8822C << BIT_SHIFT_FW_MSG4_8822C) -+#define BIT_CLEAR_FW_MSG4_8822C(x) ((x) & (~BITS_FW_MSG4_8822C)) -+#define BIT_GET_FW_MSG4_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG4_8822C) & BIT_MASK_FW_MSG4_8822C) -+#define BIT_SET_FW_MSG4_8822C(x, v) \ -+ (BIT_CLEAR_FW_MSG4_8822C(x) | BIT_FW_MSG4_8822C(v)) -+ -+/* 2 REG_MSG5_8822C */ -+ -+#define BIT_SHIFT_FW_MSG5_8822C 0 -+#define BIT_MASK_FW_MSG5_8822C 0xffffffffL -+#define BIT_FW_MSG5_8822C(x) \ -+ (((x) & BIT_MASK_FW_MSG5_8822C) << BIT_SHIFT_FW_MSG5_8822C) -+#define BITS_FW_MSG5_8822C (BIT_MASK_FW_MSG5_8822C << BIT_SHIFT_FW_MSG5_8822C) -+#define BIT_CLEAR_FW_MSG5_8822C(x) ((x) & (~BITS_FW_MSG5_8822C)) -+#define BIT_GET_FW_MSG5_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG5_8822C) & BIT_MASK_FW_MSG5_8822C) -+#define BIT_SET_FW_MSG5_8822C(x, v) \ -+ (BIT_CLEAR_FW_MSG5_8822C(x) | BIT_FW_MSG5_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_FIFOPAGE_CTRL_1_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8822C 16 -+#define BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8822C 0xff -+#define BIT_TX_OQT_HE_FREE_SPACE_V1_8822C(x) \ -+ (((x) & BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8822C) \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8822C) -+#define BITS_TX_OQT_HE_FREE_SPACE_V1_8822C \ -+ (BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8822C \ -+ << BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8822C) -+#define BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1_8822C(x) \ -+ ((x) & (~BITS_TX_OQT_HE_FREE_SPACE_V1_8822C)) -+#define BIT_GET_TX_OQT_HE_FREE_SPACE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_HE_FREE_SPACE_V1_8822C) & \ -+ BIT_MASK_TX_OQT_HE_FREE_SPACE_V1_8822C) -+#define BIT_SET_TX_OQT_HE_FREE_SPACE_V1_8822C(x, v) \ -+ (BIT_CLEAR_TX_OQT_HE_FREE_SPACE_V1_8822C(x) | \ -+ BIT_TX_OQT_HE_FREE_SPACE_V1_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8822C 0 -+#define BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8822C 0xff -+#define BIT_TX_OQT_NL_FREE_SPACE_V1_8822C(x) \ -+ (((x) & BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8822C) \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8822C) -+#define BITS_TX_OQT_NL_FREE_SPACE_V1_8822C \ -+ (BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8822C \ -+ << BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8822C) -+#define BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1_8822C(x) \ -+ ((x) & (~BITS_TX_OQT_NL_FREE_SPACE_V1_8822C)) -+#define BIT_GET_TX_OQT_NL_FREE_SPACE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TX_OQT_NL_FREE_SPACE_V1_8822C) & \ -+ BIT_MASK_TX_OQT_NL_FREE_SPACE_V1_8822C) -+#define BIT_SET_TX_OQT_NL_FREE_SPACE_V1_8822C(x, v) \ -+ (BIT_CLEAR_TX_OQT_NL_FREE_SPACE_V1_8822C(x) | \ -+ BIT_TX_OQT_NL_FREE_SPACE_V1_8822C(v)) -+ -+/* 2 REG_FIFOPAGE_CTRL_2_8822C */ -+#define BIT_BCN_VALID_1_V1_8822C BIT(31) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_BCN_HEAD_1_V1_8822C 16 -+#define BIT_MASK_BCN_HEAD_1_V1_8822C 0xfff -+#define BIT_BCN_HEAD_1_V1_8822C(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_1_V1_8822C) << BIT_SHIFT_BCN_HEAD_1_V1_8822C) -+#define BITS_BCN_HEAD_1_V1_8822C \ -+ (BIT_MASK_BCN_HEAD_1_V1_8822C << BIT_SHIFT_BCN_HEAD_1_V1_8822C) -+#define BIT_CLEAR_BCN_HEAD_1_V1_8822C(x) ((x) & (~BITS_BCN_HEAD_1_V1_8822C)) -+#define BIT_GET_BCN_HEAD_1_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_1_V1_8822C) & BIT_MASK_BCN_HEAD_1_V1_8822C) -+#define BIT_SET_BCN_HEAD_1_V1_8822C(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_1_V1_8822C(x) | BIT_BCN_HEAD_1_V1_8822C(v)) -+ -+#define BIT_BCN_VALID_V1_8822C BIT(15) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_BCN_HEAD_V1_8822C 0 -+#define BIT_MASK_BCN_HEAD_V1_8822C 0xfff -+#define BIT_BCN_HEAD_V1_8822C(x) \ -+ (((x) & BIT_MASK_BCN_HEAD_V1_8822C) << BIT_SHIFT_BCN_HEAD_V1_8822C) -+#define BITS_BCN_HEAD_V1_8822C \ -+ (BIT_MASK_BCN_HEAD_V1_8822C << BIT_SHIFT_BCN_HEAD_V1_8822C) -+#define BIT_CLEAR_BCN_HEAD_V1_8822C(x) ((x) & (~BITS_BCN_HEAD_V1_8822C)) -+#define BIT_GET_BCN_HEAD_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCN_HEAD_V1_8822C) & BIT_MASK_BCN_HEAD_V1_8822C) -+#define BIT_SET_BCN_HEAD_V1_8822C(x, v) \ -+ (BIT_CLEAR_BCN_HEAD_V1_8822C(x) | BIT_BCN_HEAD_V1_8822C(v)) -+ -+/* 2 REG_AUTO_LLT_V1_8822C */ -+ -+#define BIT_SHIFT_MAX_TX_PKT_V1_8822C 24 -+#define BIT_MASK_MAX_TX_PKT_V1_8822C 0xff -+#define BIT_MAX_TX_PKT_V1_8822C(x) \ -+ (((x) & BIT_MASK_MAX_TX_PKT_V1_8822C) << BIT_SHIFT_MAX_TX_PKT_V1_8822C) -+#define BITS_MAX_TX_PKT_V1_8822C \ -+ (BIT_MASK_MAX_TX_PKT_V1_8822C << BIT_SHIFT_MAX_TX_PKT_V1_8822C) -+#define BIT_CLEAR_MAX_TX_PKT_V1_8822C(x) ((x) & (~BITS_MAX_TX_PKT_V1_8822C)) -+#define BIT_GET_MAX_TX_PKT_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAX_TX_PKT_V1_8822C) & BIT_MASK_MAX_TX_PKT_V1_8822C) -+#define BIT_SET_MAX_TX_PKT_V1_8822C(x, v) \ -+ (BIT_CLEAR_MAX_TX_PKT_V1_8822C(x) | BIT_MAX_TX_PKT_V1_8822C(v)) -+ -+#define BIT_TDE_ERROR_STOP_V1_8822C BIT(23) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_LLT_FREE_PAGE_V2_8822C 8 -+#define BIT_MASK_LLT_FREE_PAGE_V2_8822C 0xfff -+#define BIT_LLT_FREE_PAGE_V2_8822C(x) \ -+ (((x) & BIT_MASK_LLT_FREE_PAGE_V2_8822C) \ -+ << BIT_SHIFT_LLT_FREE_PAGE_V2_8822C) -+#define BITS_LLT_FREE_PAGE_V2_8822C \ -+ (BIT_MASK_LLT_FREE_PAGE_V2_8822C << BIT_SHIFT_LLT_FREE_PAGE_V2_8822C) -+#define BIT_CLEAR_LLT_FREE_PAGE_V2_8822C(x) \ -+ ((x) & (~BITS_LLT_FREE_PAGE_V2_8822C)) -+#define BIT_GET_LLT_FREE_PAGE_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_LLT_FREE_PAGE_V2_8822C) & \ -+ BIT_MASK_LLT_FREE_PAGE_V2_8822C) -+#define BIT_SET_LLT_FREE_PAGE_V2_8822C(x, v) \ -+ (BIT_CLEAR_LLT_FREE_PAGE_V2_8822C(x) | BIT_LLT_FREE_PAGE_V2_8822C(v)) -+ -+#define BIT_SHIFT_BLK_DESC_NUM_8822C 4 -+#define BIT_MASK_BLK_DESC_NUM_8822C 0xf -+#define BIT_BLK_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_BLK_DESC_NUM_8822C) << BIT_SHIFT_BLK_DESC_NUM_8822C) -+#define BITS_BLK_DESC_NUM_8822C \ -+ (BIT_MASK_BLK_DESC_NUM_8822C << BIT_SHIFT_BLK_DESC_NUM_8822C) -+#define BIT_CLEAR_BLK_DESC_NUM_8822C(x) ((x) & (~BITS_BLK_DESC_NUM_8822C)) -+#define BIT_GET_BLK_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_BLK_DESC_NUM_8822C) & BIT_MASK_BLK_DESC_NUM_8822C) -+#define BIT_SET_BLK_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_BLK_DESC_NUM_8822C(x) | BIT_BLK_DESC_NUM_8822C(v)) -+ -+#define BIT_R_BCN_HEAD_SEL_8822C BIT(3) -+#define BIT_R_EN_BCN_SW_HEAD_SEL_8822C BIT(2) -+#define BIT_LLT_DBG_SEL_8822C BIT(1) -+#define BIT_AUTO_INIT_LLT_V1_8822C BIT(0) -+ -+/* 2 REG_TXDMA_OFFSET_CHK_8822C */ -+#define BIT_EM_CHKSUM_FIN_8822C BIT(31) -+#define BIT_EMN_PCIE_DMA_MOD_8822C BIT(30) -+#define BIT_EN_TXQUE_CLR_8822C BIT(29) -+#define BIT_EN_PCIE_FIFO_MODE_8822C BIT(28) -+ -+#define BIT_SHIFT_PG_UNDER_TH_V1_8822C 16 -+#define BIT_MASK_PG_UNDER_TH_V1_8822C 0xfff -+#define BIT_PG_UNDER_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_PG_UNDER_TH_V1_8822C) \ -+ << BIT_SHIFT_PG_UNDER_TH_V1_8822C) -+#define BITS_PG_UNDER_TH_V1_8822C \ -+ (BIT_MASK_PG_UNDER_TH_V1_8822C << BIT_SHIFT_PG_UNDER_TH_V1_8822C) -+#define BIT_CLEAR_PG_UNDER_TH_V1_8822C(x) ((x) & (~BITS_PG_UNDER_TH_V1_8822C)) -+#define BIT_GET_PG_UNDER_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PG_UNDER_TH_V1_8822C) & \ -+ BIT_MASK_PG_UNDER_TH_V1_8822C) -+#define BIT_SET_PG_UNDER_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_PG_UNDER_TH_V1_8822C(x) | BIT_PG_UNDER_TH_V1_8822C(v)) -+ -+#define BIT_R_EN_RESET_RESTORE_H2C_8822C BIT(15) -+#define BIT_SDIO_TDE_FINISH_8822C BIT(14) -+#define BIT_SDIO_TXDESC_CHKSUM_EN_8822C BIT(13) -+#define BIT_RST_RDPTR_8822C BIT(12) -+#define BIT_RST_WRPTR_8822C BIT(11) -+#define BIT_CHK_PG_TH_EN_8822C BIT(10) -+#define BIT_DROP_DATA_EN_8822C BIT(9) -+#define BIT_CHECK_OFFSET_EN_8822C BIT(8) -+ -+#define BIT_SHIFT_CHECK_OFFSET_8822C 0 -+#define BIT_MASK_CHECK_OFFSET_8822C 0xff -+#define BIT_CHECK_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_CHECK_OFFSET_8822C) << BIT_SHIFT_CHECK_OFFSET_8822C) -+#define BITS_CHECK_OFFSET_8822C \ -+ (BIT_MASK_CHECK_OFFSET_8822C << BIT_SHIFT_CHECK_OFFSET_8822C) -+#define BIT_CLEAR_CHECK_OFFSET_8822C(x) ((x) & (~BITS_CHECK_OFFSET_8822C)) -+#define BIT_GET_CHECK_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_CHECK_OFFSET_8822C) & BIT_MASK_CHECK_OFFSET_8822C) -+#define BIT_SET_CHECK_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_CHECK_OFFSET_8822C(x) | BIT_CHECK_OFFSET_8822C(v)) -+ -+/* 2 REG_TXDMA_STATUS_8822C */ -+#define BIT_TXPKTBUF_REQ_ERR_8822C BIT(18) -+#define BIT_HI_OQT_UDN_8822C BIT(17) -+#define BIT_HI_OQT_OVF_8822C BIT(16) -+#define BIT_PAYLOAD_CHKSUM_ERR_8822C BIT(15) -+#define BIT_PAYLOAD_UDN_8822C BIT(14) -+#define BIT_PAYLOAD_OVF_8822C BIT(13) -+#define BIT_DSC_CHKSUM_FAIL_8822C BIT(12) -+#define BIT_UNKNOWN_QSEL_8822C BIT(11) -+#define BIT_EP_QSEL_DIFF_8822C BIT(10) -+#define BIT_TX_OFFS_UNMATCH_8822C BIT(9) -+#define BIT_TXOQT_UDN_8822C BIT(8) -+#define BIT_TXOQT_OVF_8822C BIT(7) -+#define BIT_TXDMA_SFF_UDN_8822C BIT(6) -+#define BIT_TXDMA_SFF_OVF_8822C BIT(5) -+#define BIT_LLT_NULL_PG_8822C BIT(4) -+#define BIT_PAGE_UDN_8822C BIT(3) -+#define BIT_PAGE_OVF_8822C BIT(2) -+#define BIT_TXFF_PG_UDN_8822C BIT(1) -+#define BIT_TXFF_PG_OVF_8822C BIT(0) -+ -+/* 2 REG_TX_DMA_DBG_8822C */ -+ -+/* 2 REG_TQPNT1_8822C */ -+#define BIT_HPQ_INT_EN_8822C BIT(31) -+ -+#define BIT_SHIFT_HPQ_HIGH_TH_V1_8822C 16 -+#define BIT_MASK_HPQ_HIGH_TH_V1_8822C 0xfff -+#define BIT_HPQ_HIGH_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_HPQ_HIGH_TH_V1_8822C) \ -+ << BIT_SHIFT_HPQ_HIGH_TH_V1_8822C) -+#define BITS_HPQ_HIGH_TH_V1_8822C \ -+ (BIT_MASK_HPQ_HIGH_TH_V1_8822C << BIT_SHIFT_HPQ_HIGH_TH_V1_8822C) -+#define BIT_CLEAR_HPQ_HIGH_TH_V1_8822C(x) ((x) & (~BITS_HPQ_HIGH_TH_V1_8822C)) -+#define BIT_GET_HPQ_HIGH_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HPQ_HIGH_TH_V1_8822C) & \ -+ BIT_MASK_HPQ_HIGH_TH_V1_8822C) -+#define BIT_SET_HPQ_HIGH_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_HPQ_HIGH_TH_V1_8822C(x) | BIT_HPQ_HIGH_TH_V1_8822C(v)) -+ -+#define BIT_SHIFT_HPQ_LOW_TH_V1_8822C 0 -+#define BIT_MASK_HPQ_LOW_TH_V1_8822C 0xfff -+#define BIT_HPQ_LOW_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_HPQ_LOW_TH_V1_8822C) << BIT_SHIFT_HPQ_LOW_TH_V1_8822C) -+#define BITS_HPQ_LOW_TH_V1_8822C \ -+ (BIT_MASK_HPQ_LOW_TH_V1_8822C << BIT_SHIFT_HPQ_LOW_TH_V1_8822C) -+#define BIT_CLEAR_HPQ_LOW_TH_V1_8822C(x) ((x) & (~BITS_HPQ_LOW_TH_V1_8822C)) -+#define BIT_GET_HPQ_LOW_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HPQ_LOW_TH_V1_8822C) & BIT_MASK_HPQ_LOW_TH_V1_8822C) -+#define BIT_SET_HPQ_LOW_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_HPQ_LOW_TH_V1_8822C(x) | BIT_HPQ_LOW_TH_V1_8822C(v)) -+ -+/* 2 REG_TQPNT2_8822C */ -+#define BIT_NPQ_INT_EN_8822C BIT(31) -+ -+#define BIT_SHIFT_NPQ_HIGH_TH_V1_8822C 16 -+#define BIT_MASK_NPQ_HIGH_TH_V1_8822C 0xfff -+#define BIT_NPQ_HIGH_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_NPQ_HIGH_TH_V1_8822C) \ -+ << BIT_SHIFT_NPQ_HIGH_TH_V1_8822C) -+#define BITS_NPQ_HIGH_TH_V1_8822C \ -+ (BIT_MASK_NPQ_HIGH_TH_V1_8822C << BIT_SHIFT_NPQ_HIGH_TH_V1_8822C) -+#define BIT_CLEAR_NPQ_HIGH_TH_V1_8822C(x) ((x) & (~BITS_NPQ_HIGH_TH_V1_8822C)) -+#define BIT_GET_NPQ_HIGH_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_NPQ_HIGH_TH_V1_8822C) & \ -+ BIT_MASK_NPQ_HIGH_TH_V1_8822C) -+#define BIT_SET_NPQ_HIGH_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_NPQ_HIGH_TH_V1_8822C(x) | BIT_NPQ_HIGH_TH_V1_8822C(v)) -+ -+#define BIT_SHIFT_NPQ_LOW_TH_V1_8822C 0 -+#define BIT_MASK_NPQ_LOW_TH_V1_8822C 0xfff -+#define BIT_NPQ_LOW_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_NPQ_LOW_TH_V1_8822C) << BIT_SHIFT_NPQ_LOW_TH_V1_8822C) -+#define BITS_NPQ_LOW_TH_V1_8822C \ -+ (BIT_MASK_NPQ_LOW_TH_V1_8822C << BIT_SHIFT_NPQ_LOW_TH_V1_8822C) -+#define BIT_CLEAR_NPQ_LOW_TH_V1_8822C(x) ((x) & (~BITS_NPQ_LOW_TH_V1_8822C)) -+#define BIT_GET_NPQ_LOW_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_NPQ_LOW_TH_V1_8822C) & BIT_MASK_NPQ_LOW_TH_V1_8822C) -+#define BIT_SET_NPQ_LOW_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_NPQ_LOW_TH_V1_8822C(x) | BIT_NPQ_LOW_TH_V1_8822C(v)) -+ -+/* 2 REG_TQPNT3_8822C */ -+#define BIT_LPQ_INT_EN_8822C BIT(31) -+ -+#define BIT_SHIFT_LPQ_HIGH_TH_V1_8822C 16 -+#define BIT_MASK_LPQ_HIGH_TH_V1_8822C 0xfff -+#define BIT_LPQ_HIGH_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_LPQ_HIGH_TH_V1_8822C) \ -+ << BIT_SHIFT_LPQ_HIGH_TH_V1_8822C) -+#define BITS_LPQ_HIGH_TH_V1_8822C \ -+ (BIT_MASK_LPQ_HIGH_TH_V1_8822C << BIT_SHIFT_LPQ_HIGH_TH_V1_8822C) -+#define BIT_CLEAR_LPQ_HIGH_TH_V1_8822C(x) ((x) & (~BITS_LPQ_HIGH_TH_V1_8822C)) -+#define BIT_GET_LPQ_HIGH_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_LPQ_HIGH_TH_V1_8822C) & \ -+ BIT_MASK_LPQ_HIGH_TH_V1_8822C) -+#define BIT_SET_LPQ_HIGH_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_LPQ_HIGH_TH_V1_8822C(x) | BIT_LPQ_HIGH_TH_V1_8822C(v)) -+ -+#define BIT_SHIFT_LPQ_LOW_TH_V1_8822C 0 -+#define BIT_MASK_LPQ_LOW_TH_V1_8822C 0xfff -+#define BIT_LPQ_LOW_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_LPQ_LOW_TH_V1_8822C) << BIT_SHIFT_LPQ_LOW_TH_V1_8822C) -+#define BITS_LPQ_LOW_TH_V1_8822C \ -+ (BIT_MASK_LPQ_LOW_TH_V1_8822C << BIT_SHIFT_LPQ_LOW_TH_V1_8822C) -+#define BIT_CLEAR_LPQ_LOW_TH_V1_8822C(x) ((x) & (~BITS_LPQ_LOW_TH_V1_8822C)) -+#define BIT_GET_LPQ_LOW_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_LPQ_LOW_TH_V1_8822C) & BIT_MASK_LPQ_LOW_TH_V1_8822C) -+#define BIT_SET_LPQ_LOW_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_LPQ_LOW_TH_V1_8822C(x) | BIT_LPQ_LOW_TH_V1_8822C(v)) -+ -+/* 2 REG_TQPNT4_8822C */ -+#define BIT_EXQ_INT_EN_8822C BIT(31) -+ -+#define BIT_SHIFT_EXQ_HIGH_TH_V1_8822C 16 -+#define BIT_MASK_EXQ_HIGH_TH_V1_8822C 0xfff -+#define BIT_EXQ_HIGH_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_EXQ_HIGH_TH_V1_8822C) \ -+ << BIT_SHIFT_EXQ_HIGH_TH_V1_8822C) -+#define BITS_EXQ_HIGH_TH_V1_8822C \ -+ (BIT_MASK_EXQ_HIGH_TH_V1_8822C << BIT_SHIFT_EXQ_HIGH_TH_V1_8822C) -+#define BIT_CLEAR_EXQ_HIGH_TH_V1_8822C(x) ((x) & (~BITS_EXQ_HIGH_TH_V1_8822C)) -+#define BIT_GET_EXQ_HIGH_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_EXQ_HIGH_TH_V1_8822C) & \ -+ BIT_MASK_EXQ_HIGH_TH_V1_8822C) -+#define BIT_SET_EXQ_HIGH_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_EXQ_HIGH_TH_V1_8822C(x) | BIT_EXQ_HIGH_TH_V1_8822C(v)) -+ -+#define BIT_SHIFT_EXQ_LOW_TH_V1_8822C 0 -+#define BIT_MASK_EXQ_LOW_TH_V1_8822C 0xfff -+#define BIT_EXQ_LOW_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_EXQ_LOW_TH_V1_8822C) << BIT_SHIFT_EXQ_LOW_TH_V1_8822C) -+#define BITS_EXQ_LOW_TH_V1_8822C \ -+ (BIT_MASK_EXQ_LOW_TH_V1_8822C << BIT_SHIFT_EXQ_LOW_TH_V1_8822C) -+#define BIT_CLEAR_EXQ_LOW_TH_V1_8822C(x) ((x) & (~BITS_EXQ_LOW_TH_V1_8822C)) -+#define BIT_GET_EXQ_LOW_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_EXQ_LOW_TH_V1_8822C) & BIT_MASK_EXQ_LOW_TH_V1_8822C) -+#define BIT_SET_EXQ_LOW_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_EXQ_LOW_TH_V1_8822C(x) | BIT_EXQ_LOW_TH_V1_8822C(v)) -+ -+/* 2 REG_RQPN_CTRL_1_8822C */ -+ -+#define BIT_SHIFT_TXPKTNUM_H_V2_8822C 16 -+#define BIT_MASK_TXPKTNUM_H_V2_8822C 0xfff -+#define BIT_TXPKTNUM_H_V2_8822C(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_H_V2_8822C) << BIT_SHIFT_TXPKTNUM_H_V2_8822C) -+#define BITS_TXPKTNUM_H_V2_8822C \ -+ (BIT_MASK_TXPKTNUM_H_V2_8822C << BIT_SHIFT_TXPKTNUM_H_V2_8822C) -+#define BIT_CLEAR_TXPKTNUM_H_V2_8822C(x) ((x) & (~BITS_TXPKTNUM_H_V2_8822C)) -+#define BIT_GET_TXPKTNUM_H_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_H_V2_8822C) & BIT_MASK_TXPKTNUM_H_V2_8822C) -+#define BIT_SET_TXPKTNUM_H_V2_8822C(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_H_V2_8822C(x) | BIT_TXPKTNUM_H_V2_8822C(v)) -+ -+#define BIT_SHIFT_TXPKTNUM_V3_8822C 0 -+#define BIT_MASK_TXPKTNUM_V3_8822C 0xfff -+#define BIT_TXPKTNUM_V3_8822C(x) \ -+ (((x) & BIT_MASK_TXPKTNUM_V3_8822C) << BIT_SHIFT_TXPKTNUM_V3_8822C) -+#define BITS_TXPKTNUM_V3_8822C \ -+ (BIT_MASK_TXPKTNUM_V3_8822C << BIT_SHIFT_TXPKTNUM_V3_8822C) -+#define BIT_CLEAR_TXPKTNUM_V3_8822C(x) ((x) & (~BITS_TXPKTNUM_V3_8822C)) -+#define BIT_GET_TXPKTNUM_V3_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXPKTNUM_V3_8822C) & BIT_MASK_TXPKTNUM_V3_8822C) -+#define BIT_SET_TXPKTNUM_V3_8822C(x, v) \ -+ (BIT_CLEAR_TXPKTNUM_V3_8822C(x) | BIT_TXPKTNUM_V3_8822C(v)) -+ -+/* 2 REG_RQPN_CTRL_2_8822C */ -+#define BIT_LD_RQPN_8822C BIT(31) -+#define BIT_EXQ_PUBLIC_DIS_V1_8822C BIT(19) -+#define BIT_NPQ_PUBLIC_DIS_V1_8822C BIT(18) -+#define BIT_LPQ_PUBLIC_DIS_V1_8822C BIT(17) -+#define BIT_HPQ_PUBLIC_DIS_V1_8822C BIT(16) -+#define BIT_SDIO_TXAGG_ALIGN_ADJUST_EN_8822C BIT(15) -+ -+#define BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8822C 0 -+#define BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8822C 0xfff -+#define BIT_SDIO_TXAGG_ALIGN_SIZE_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8822C) \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8822C) -+#define BITS_SDIO_TXAGG_ALIGN_SIZE_8822C \ -+ (BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8822C \ -+ << BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8822C) -+#define BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE_8822C(x) \ -+ ((x) & (~BITS_SDIO_TXAGG_ALIGN_SIZE_8822C)) -+#define BIT_GET_SDIO_TXAGG_ALIGN_SIZE_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_TXAGG_ALIGN_SIZE_8822C) & \ -+ BIT_MASK_SDIO_TXAGG_ALIGN_SIZE_8822C) -+#define BIT_SET_SDIO_TXAGG_ALIGN_SIZE_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_TXAGG_ALIGN_SIZE_8822C(x) | \ -+ BIT_SDIO_TXAGG_ALIGN_SIZE_8822C(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_1_8822C */ -+ -+#define BIT_SHIFT_HPQ_AVAL_PG_V1_8822C 16 -+#define BIT_MASK_HPQ_AVAL_PG_V1_8822C 0xfff -+#define BIT_HPQ_AVAL_PG_V1_8822C(x) \ -+ (((x) & BIT_MASK_HPQ_AVAL_PG_V1_8822C) \ -+ << BIT_SHIFT_HPQ_AVAL_PG_V1_8822C) -+#define BITS_HPQ_AVAL_PG_V1_8822C \ -+ (BIT_MASK_HPQ_AVAL_PG_V1_8822C << BIT_SHIFT_HPQ_AVAL_PG_V1_8822C) -+#define BIT_CLEAR_HPQ_AVAL_PG_V1_8822C(x) ((x) & (~BITS_HPQ_AVAL_PG_V1_8822C)) -+#define BIT_GET_HPQ_AVAL_PG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HPQ_AVAL_PG_V1_8822C) & \ -+ BIT_MASK_HPQ_AVAL_PG_V1_8822C) -+#define BIT_SET_HPQ_AVAL_PG_V1_8822C(x, v) \ -+ (BIT_CLEAR_HPQ_AVAL_PG_V1_8822C(x) | BIT_HPQ_AVAL_PG_V1_8822C(v)) -+ -+#define BIT_SHIFT_HPQ_V1_8822C 0 -+#define BIT_MASK_HPQ_V1_8822C 0xfff -+#define BIT_HPQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_HPQ_V1_8822C) << BIT_SHIFT_HPQ_V1_8822C) -+#define BITS_HPQ_V1_8822C (BIT_MASK_HPQ_V1_8822C << BIT_SHIFT_HPQ_V1_8822C) -+#define BIT_CLEAR_HPQ_V1_8822C(x) ((x) & (~BITS_HPQ_V1_8822C)) -+#define BIT_GET_HPQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HPQ_V1_8822C) & BIT_MASK_HPQ_V1_8822C) -+#define BIT_SET_HPQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_HPQ_V1_8822C(x) | BIT_HPQ_V1_8822C(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_2_8822C */ -+ -+#define BIT_SHIFT_LPQ_AVAL_PG_V1_8822C 16 -+#define BIT_MASK_LPQ_AVAL_PG_V1_8822C 0xfff -+#define BIT_LPQ_AVAL_PG_V1_8822C(x) \ -+ (((x) & BIT_MASK_LPQ_AVAL_PG_V1_8822C) \ -+ << BIT_SHIFT_LPQ_AVAL_PG_V1_8822C) -+#define BITS_LPQ_AVAL_PG_V1_8822C \ -+ (BIT_MASK_LPQ_AVAL_PG_V1_8822C << BIT_SHIFT_LPQ_AVAL_PG_V1_8822C) -+#define BIT_CLEAR_LPQ_AVAL_PG_V1_8822C(x) ((x) & (~BITS_LPQ_AVAL_PG_V1_8822C)) -+#define BIT_GET_LPQ_AVAL_PG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_LPQ_AVAL_PG_V1_8822C) & \ -+ BIT_MASK_LPQ_AVAL_PG_V1_8822C) -+#define BIT_SET_LPQ_AVAL_PG_V1_8822C(x, v) \ -+ (BIT_CLEAR_LPQ_AVAL_PG_V1_8822C(x) | BIT_LPQ_AVAL_PG_V1_8822C(v)) -+ -+#define BIT_SHIFT_LPQ_V1_8822C 0 -+#define BIT_MASK_LPQ_V1_8822C 0xfff -+#define BIT_LPQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_LPQ_V1_8822C) << BIT_SHIFT_LPQ_V1_8822C) -+#define BITS_LPQ_V1_8822C (BIT_MASK_LPQ_V1_8822C << BIT_SHIFT_LPQ_V1_8822C) -+#define BIT_CLEAR_LPQ_V1_8822C(x) ((x) & (~BITS_LPQ_V1_8822C)) -+#define BIT_GET_LPQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_LPQ_V1_8822C) & BIT_MASK_LPQ_V1_8822C) -+#define BIT_SET_LPQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_LPQ_V1_8822C(x) | BIT_LPQ_V1_8822C(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_3_8822C */ -+ -+#define BIT_SHIFT_NPQ_AVAL_PG_V1_8822C 16 -+#define BIT_MASK_NPQ_AVAL_PG_V1_8822C 0xfff -+#define BIT_NPQ_AVAL_PG_V1_8822C(x) \ -+ (((x) & BIT_MASK_NPQ_AVAL_PG_V1_8822C) \ -+ << BIT_SHIFT_NPQ_AVAL_PG_V1_8822C) -+#define BITS_NPQ_AVAL_PG_V1_8822C \ -+ (BIT_MASK_NPQ_AVAL_PG_V1_8822C << BIT_SHIFT_NPQ_AVAL_PG_V1_8822C) -+#define BIT_CLEAR_NPQ_AVAL_PG_V1_8822C(x) ((x) & (~BITS_NPQ_AVAL_PG_V1_8822C)) -+#define BIT_GET_NPQ_AVAL_PG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_NPQ_AVAL_PG_V1_8822C) & \ -+ BIT_MASK_NPQ_AVAL_PG_V1_8822C) -+#define BIT_SET_NPQ_AVAL_PG_V1_8822C(x, v) \ -+ (BIT_CLEAR_NPQ_AVAL_PG_V1_8822C(x) | BIT_NPQ_AVAL_PG_V1_8822C(v)) -+ -+#define BIT_SHIFT_NPQ_V1_8822C 0 -+#define BIT_MASK_NPQ_V1_8822C 0xfff -+#define BIT_NPQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_NPQ_V1_8822C) << BIT_SHIFT_NPQ_V1_8822C) -+#define BITS_NPQ_V1_8822C (BIT_MASK_NPQ_V1_8822C << BIT_SHIFT_NPQ_V1_8822C) -+#define BIT_CLEAR_NPQ_V1_8822C(x) ((x) & (~BITS_NPQ_V1_8822C)) -+#define BIT_GET_NPQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_NPQ_V1_8822C) & BIT_MASK_NPQ_V1_8822C) -+#define BIT_SET_NPQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_NPQ_V1_8822C(x) | BIT_NPQ_V1_8822C(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_4_8822C */ -+ -+#define BIT_SHIFT_EXQ_AVAL_PG_V1_8822C 16 -+#define BIT_MASK_EXQ_AVAL_PG_V1_8822C 0xfff -+#define BIT_EXQ_AVAL_PG_V1_8822C(x) \ -+ (((x) & BIT_MASK_EXQ_AVAL_PG_V1_8822C) \ -+ << BIT_SHIFT_EXQ_AVAL_PG_V1_8822C) -+#define BITS_EXQ_AVAL_PG_V1_8822C \ -+ (BIT_MASK_EXQ_AVAL_PG_V1_8822C << BIT_SHIFT_EXQ_AVAL_PG_V1_8822C) -+#define BIT_CLEAR_EXQ_AVAL_PG_V1_8822C(x) ((x) & (~BITS_EXQ_AVAL_PG_V1_8822C)) -+#define BIT_GET_EXQ_AVAL_PG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_EXQ_AVAL_PG_V1_8822C) & \ -+ BIT_MASK_EXQ_AVAL_PG_V1_8822C) -+#define BIT_SET_EXQ_AVAL_PG_V1_8822C(x, v) \ -+ (BIT_CLEAR_EXQ_AVAL_PG_V1_8822C(x) | BIT_EXQ_AVAL_PG_V1_8822C(v)) -+ -+#define BIT_SHIFT_EXQ_V1_8822C 0 -+#define BIT_MASK_EXQ_V1_8822C 0xfff -+#define BIT_EXQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_EXQ_V1_8822C) << BIT_SHIFT_EXQ_V1_8822C) -+#define BITS_EXQ_V1_8822C (BIT_MASK_EXQ_V1_8822C << BIT_SHIFT_EXQ_V1_8822C) -+#define BIT_CLEAR_EXQ_V1_8822C(x) ((x) & (~BITS_EXQ_V1_8822C)) -+#define BIT_GET_EXQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_EXQ_V1_8822C) & BIT_MASK_EXQ_V1_8822C) -+#define BIT_SET_EXQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_EXQ_V1_8822C(x) | BIT_EXQ_V1_8822C(v)) -+ -+/* 2 REG_FIFOPAGE_INFO_5_8822C */ -+ -+#define BIT_SHIFT_PUBQ_AVAL_PG_V1_8822C 16 -+#define BIT_MASK_PUBQ_AVAL_PG_V1_8822C 0xfff -+#define BIT_PUBQ_AVAL_PG_V1_8822C(x) \ -+ (((x) & BIT_MASK_PUBQ_AVAL_PG_V1_8822C) \ -+ << BIT_SHIFT_PUBQ_AVAL_PG_V1_8822C) -+#define BITS_PUBQ_AVAL_PG_V1_8822C \ -+ (BIT_MASK_PUBQ_AVAL_PG_V1_8822C << BIT_SHIFT_PUBQ_AVAL_PG_V1_8822C) -+#define BIT_CLEAR_PUBQ_AVAL_PG_V1_8822C(x) ((x) & (~BITS_PUBQ_AVAL_PG_V1_8822C)) -+#define BIT_GET_PUBQ_AVAL_PG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_AVAL_PG_V1_8822C) & \ -+ BIT_MASK_PUBQ_AVAL_PG_V1_8822C) -+#define BIT_SET_PUBQ_AVAL_PG_V1_8822C(x, v) \ -+ (BIT_CLEAR_PUBQ_AVAL_PG_V1_8822C(x) | BIT_PUBQ_AVAL_PG_V1_8822C(v)) -+ -+#define BIT_SHIFT_PUBQ_V1_8822C 0 -+#define BIT_MASK_PUBQ_V1_8822C 0xfff -+#define BIT_PUBQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_PUBQ_V1_8822C) << BIT_SHIFT_PUBQ_V1_8822C) -+#define BITS_PUBQ_V1_8822C (BIT_MASK_PUBQ_V1_8822C << BIT_SHIFT_PUBQ_V1_8822C) -+#define BIT_CLEAR_PUBQ_V1_8822C(x) ((x) & (~BITS_PUBQ_V1_8822C)) -+#define BIT_GET_PUBQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PUBQ_V1_8822C) & BIT_MASK_PUBQ_V1_8822C) -+#define BIT_SET_PUBQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_PUBQ_V1_8822C(x) | BIT_PUBQ_V1_8822C(v)) -+ -+/* 2 REG_H2C_HEAD_8822C */ -+ -+#define BIT_SHIFT_H2C_HEAD_8822C 0 -+#define BIT_MASK_H2C_HEAD_8822C 0x3ffff -+#define BIT_H2C_HEAD_8822C(x) \ -+ (((x) & BIT_MASK_H2C_HEAD_8822C) << BIT_SHIFT_H2C_HEAD_8822C) -+#define BITS_H2C_HEAD_8822C \ -+ (BIT_MASK_H2C_HEAD_8822C << BIT_SHIFT_H2C_HEAD_8822C) -+#define BIT_CLEAR_H2C_HEAD_8822C(x) ((x) & (~BITS_H2C_HEAD_8822C)) -+#define BIT_GET_H2C_HEAD_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2C_HEAD_8822C) & BIT_MASK_H2C_HEAD_8822C) -+#define BIT_SET_H2C_HEAD_8822C(x, v) \ -+ (BIT_CLEAR_H2C_HEAD_8822C(x) | BIT_H2C_HEAD_8822C(v)) -+ -+/* 2 REG_H2C_TAIL_8822C */ -+ -+#define BIT_SHIFT_H2C_TAIL_8822C 0 -+#define BIT_MASK_H2C_TAIL_8822C 0x3ffff -+#define BIT_H2C_TAIL_8822C(x) \ -+ (((x) & BIT_MASK_H2C_TAIL_8822C) << BIT_SHIFT_H2C_TAIL_8822C) -+#define BITS_H2C_TAIL_8822C \ -+ (BIT_MASK_H2C_TAIL_8822C << BIT_SHIFT_H2C_TAIL_8822C) -+#define BIT_CLEAR_H2C_TAIL_8822C(x) ((x) & (~BITS_H2C_TAIL_8822C)) -+#define BIT_GET_H2C_TAIL_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2C_TAIL_8822C) & BIT_MASK_H2C_TAIL_8822C) -+#define BIT_SET_H2C_TAIL_8822C(x, v) \ -+ (BIT_CLEAR_H2C_TAIL_8822C(x) | BIT_H2C_TAIL_8822C(v)) -+ -+/* 2 REG_H2C_READ_ADDR_8822C */ -+ -+#define BIT_SHIFT_H2C_READ_ADDR_8822C 0 -+#define BIT_MASK_H2C_READ_ADDR_8822C 0x3ffff -+#define BIT_H2C_READ_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_H2C_READ_ADDR_8822C) << BIT_SHIFT_H2C_READ_ADDR_8822C) -+#define BITS_H2C_READ_ADDR_8822C \ -+ (BIT_MASK_H2C_READ_ADDR_8822C << BIT_SHIFT_H2C_READ_ADDR_8822C) -+#define BIT_CLEAR_H2C_READ_ADDR_8822C(x) ((x) & (~BITS_H2C_READ_ADDR_8822C)) -+#define BIT_GET_H2C_READ_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2C_READ_ADDR_8822C) & BIT_MASK_H2C_READ_ADDR_8822C) -+#define BIT_SET_H2C_READ_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_H2C_READ_ADDR_8822C(x) | BIT_H2C_READ_ADDR_8822C(v)) -+ -+/* 2 REG_H2C_WR_ADDR_8822C */ -+ -+#define BIT_SHIFT_H2C_WR_ADDR_8822C 0 -+#define BIT_MASK_H2C_WR_ADDR_8822C 0x3ffff -+#define BIT_H2C_WR_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_H2C_WR_ADDR_8822C) << BIT_SHIFT_H2C_WR_ADDR_8822C) -+#define BITS_H2C_WR_ADDR_8822C \ -+ (BIT_MASK_H2C_WR_ADDR_8822C << BIT_SHIFT_H2C_WR_ADDR_8822C) -+#define BIT_CLEAR_H2C_WR_ADDR_8822C(x) ((x) & (~BITS_H2C_WR_ADDR_8822C)) -+#define BIT_GET_H2C_WR_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2C_WR_ADDR_8822C) & BIT_MASK_H2C_WR_ADDR_8822C) -+#define BIT_SET_H2C_WR_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_H2C_WR_ADDR_8822C(x) | BIT_H2C_WR_ADDR_8822C(v)) -+ -+/* 2 REG_H2C_INFO_8822C */ -+#define BIT_H2C_SPACE_VLD_8822C BIT(3) -+#define BIT_H2C_WR_ADDR_RST_8822C BIT(2) -+ -+#define BIT_SHIFT_H2C_LEN_SEL_8822C 0 -+#define BIT_MASK_H2C_LEN_SEL_8822C 0x3 -+#define BIT_H2C_LEN_SEL_8822C(x) \ -+ (((x) & BIT_MASK_H2C_LEN_SEL_8822C) << BIT_SHIFT_H2C_LEN_SEL_8822C) -+#define BITS_H2C_LEN_SEL_8822C \ -+ (BIT_MASK_H2C_LEN_SEL_8822C << BIT_SHIFT_H2C_LEN_SEL_8822C) -+#define BIT_CLEAR_H2C_LEN_SEL_8822C(x) ((x) & (~BITS_H2C_LEN_SEL_8822C)) -+#define BIT_GET_H2C_LEN_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2C_LEN_SEL_8822C) & BIT_MASK_H2C_LEN_SEL_8822C) -+#define BIT_SET_H2C_LEN_SEL_8822C(x, v) \ -+ (BIT_CLEAR_H2C_LEN_SEL_8822C(x) | BIT_H2C_LEN_SEL_8822C(v)) -+ -+/* 2 REG_PGSUB_CNT_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_RST_PGSUB_CNT_8822C BIT(1) -+#define BIT_PGSUB_CNT_EN_8822C BIT(0) -+ -+/* 2 REG_PGSUB_H_8822C */ -+ -+#define BIT_SHIFT_HPQ_PGSUB_CNT_8822C 0 -+#define BIT_MASK_HPQ_PGSUB_CNT_8822C 0xffffffffL -+#define BIT_HPQ_PGSUB_CNT_8822C(x) \ -+ (((x) & BIT_MASK_HPQ_PGSUB_CNT_8822C) << BIT_SHIFT_HPQ_PGSUB_CNT_8822C) -+#define BITS_HPQ_PGSUB_CNT_8822C \ -+ (BIT_MASK_HPQ_PGSUB_CNT_8822C << BIT_SHIFT_HPQ_PGSUB_CNT_8822C) -+#define BIT_CLEAR_HPQ_PGSUB_CNT_8822C(x) ((x) & (~BITS_HPQ_PGSUB_CNT_8822C)) -+#define BIT_GET_HPQ_PGSUB_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_HPQ_PGSUB_CNT_8822C) & BIT_MASK_HPQ_PGSUB_CNT_8822C) -+#define BIT_SET_HPQ_PGSUB_CNT_8822C(x, v) \ -+ (BIT_CLEAR_HPQ_PGSUB_CNT_8822C(x) | BIT_HPQ_PGSUB_CNT_8822C(v)) -+ -+/* 2 REG_PGSUB_N_8822C */ -+ -+#define BIT_SHIFT_NPQ_PGSUB_CNT_8822C 0 -+#define BIT_MASK_NPQ_PGSUB_CNT_8822C 0xffffffffL -+#define BIT_NPQ_PGSUB_CNT_8822C(x) \ -+ (((x) & BIT_MASK_NPQ_PGSUB_CNT_8822C) << BIT_SHIFT_NPQ_PGSUB_CNT_8822C) -+#define BITS_NPQ_PGSUB_CNT_8822C \ -+ (BIT_MASK_NPQ_PGSUB_CNT_8822C << BIT_SHIFT_NPQ_PGSUB_CNT_8822C) -+#define BIT_CLEAR_NPQ_PGSUB_CNT_8822C(x) ((x) & (~BITS_NPQ_PGSUB_CNT_8822C)) -+#define BIT_GET_NPQ_PGSUB_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_NPQ_PGSUB_CNT_8822C) & BIT_MASK_NPQ_PGSUB_CNT_8822C) -+#define BIT_SET_NPQ_PGSUB_CNT_8822C(x, v) \ -+ (BIT_CLEAR_NPQ_PGSUB_CNT_8822C(x) | BIT_NPQ_PGSUB_CNT_8822C(v)) -+ -+/* 2 REG_PGSUB_L_8822C */ -+ -+#define BIT_SHIFT_LPQ_PGSUB_CNT_8822C 0 -+#define BIT_MASK_LPQ_PGSUB_CNT_8822C 0xffffffffL -+#define BIT_LPQ_PGSUB_CNT_8822C(x) \ -+ (((x) & BIT_MASK_LPQ_PGSUB_CNT_8822C) << BIT_SHIFT_LPQ_PGSUB_CNT_8822C) -+#define BITS_LPQ_PGSUB_CNT_8822C \ -+ (BIT_MASK_LPQ_PGSUB_CNT_8822C << BIT_SHIFT_LPQ_PGSUB_CNT_8822C) -+#define BIT_CLEAR_LPQ_PGSUB_CNT_8822C(x) ((x) & (~BITS_LPQ_PGSUB_CNT_8822C)) -+#define BIT_GET_LPQ_PGSUB_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_LPQ_PGSUB_CNT_8822C) & BIT_MASK_LPQ_PGSUB_CNT_8822C) -+#define BIT_SET_LPQ_PGSUB_CNT_8822C(x, v) \ -+ (BIT_CLEAR_LPQ_PGSUB_CNT_8822C(x) | BIT_LPQ_PGSUB_CNT_8822C(v)) -+ -+/* 2 REG_PGSUB_E_8822C */ -+ -+#define BIT_SHIFT_EPQ_PGSUB_CNT_8822C 0 -+#define BIT_MASK_EPQ_PGSUB_CNT_8822C 0xffffffffL -+#define BIT_EPQ_PGSUB_CNT_8822C(x) \ -+ (((x) & BIT_MASK_EPQ_PGSUB_CNT_8822C) << BIT_SHIFT_EPQ_PGSUB_CNT_8822C) -+#define BITS_EPQ_PGSUB_CNT_8822C \ -+ (BIT_MASK_EPQ_PGSUB_CNT_8822C << BIT_SHIFT_EPQ_PGSUB_CNT_8822C) -+#define BIT_CLEAR_EPQ_PGSUB_CNT_8822C(x) ((x) & (~BITS_EPQ_PGSUB_CNT_8822C)) -+#define BIT_GET_EPQ_PGSUB_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_EPQ_PGSUB_CNT_8822C) & BIT_MASK_EPQ_PGSUB_CNT_8822C) -+#define BIT_SET_EPQ_PGSUB_CNT_8822C(x, v) \ -+ (BIT_CLEAR_EPQ_PGSUB_CNT_8822C(x) | BIT_EPQ_PGSUB_CNT_8822C(v)) -+ -+/* 2 REG_RXDMA_AGG_PG_TH_8822C */ -+#define BIT_USB_RXDMA_AGG_EN_8822C BIT(31) -+#define BIT_EN_FW_ADD_8822C BIT(30) -+#define BIT_EN_PRE_CALC_8822C BIT(29) -+#define BIT_RXAGG_SW_EN_8822C BIT(28) -+#define BIT_RXAGG_SW_TRIG_8822C BIT(27) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_DMA_AGG_TO_V1_8822C 8 -+#define BIT_MASK_DMA_AGG_TO_V1_8822C 0xff -+#define BIT_DMA_AGG_TO_V1_8822C(x) \ -+ (((x) & BIT_MASK_DMA_AGG_TO_V1_8822C) << BIT_SHIFT_DMA_AGG_TO_V1_8822C) -+#define BITS_DMA_AGG_TO_V1_8822C \ -+ (BIT_MASK_DMA_AGG_TO_V1_8822C << BIT_SHIFT_DMA_AGG_TO_V1_8822C) -+#define BIT_CLEAR_DMA_AGG_TO_V1_8822C(x) ((x) & (~BITS_DMA_AGG_TO_V1_8822C)) -+#define BIT_GET_DMA_AGG_TO_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DMA_AGG_TO_V1_8822C) & BIT_MASK_DMA_AGG_TO_V1_8822C) -+#define BIT_SET_DMA_AGG_TO_V1_8822C(x, v) \ -+ (BIT_CLEAR_DMA_AGG_TO_V1_8822C(x) | BIT_DMA_AGG_TO_V1_8822C(v)) -+ -+#define BIT_SHIFT_RXDMA_AGG_PG_TH_8822C 0 -+#define BIT_MASK_RXDMA_AGG_PG_TH_8822C 0xff -+#define BIT_RXDMA_AGG_PG_TH_8822C(x) \ -+ (((x) & BIT_MASK_RXDMA_AGG_PG_TH_8822C) \ -+ << BIT_SHIFT_RXDMA_AGG_PG_TH_8822C) -+#define BITS_RXDMA_AGG_PG_TH_8822C \ -+ (BIT_MASK_RXDMA_AGG_PG_TH_8822C << BIT_SHIFT_RXDMA_AGG_PG_TH_8822C) -+#define BIT_CLEAR_RXDMA_AGG_PG_TH_8822C(x) ((x) & (~BITS_RXDMA_AGG_PG_TH_8822C)) -+#define BIT_GET_RXDMA_AGG_PG_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_AGG_PG_TH_8822C) & \ -+ BIT_MASK_RXDMA_AGG_PG_TH_8822C) -+#define BIT_SET_RXDMA_AGG_PG_TH_8822C(x, v) \ -+ (BIT_CLEAR_RXDMA_AGG_PG_TH_8822C(x) | BIT_RXDMA_AGG_PG_TH_8822C(v)) -+ -+/* 2 REG_RXPKT_NUM_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8822C 20 -+#define BIT_MASK_FW_UPD_RDPTR19_TO_16_8822C 0xf -+#define BIT_FW_UPD_RDPTR19_TO_16_8822C(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR19_TO_16_8822C) \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8822C) -+#define BITS_FW_UPD_RDPTR19_TO_16_8822C \ -+ (BIT_MASK_FW_UPD_RDPTR19_TO_16_8822C \ -+ << BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8822C) -+#define BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8822C(x) \ -+ ((x) & (~BITS_FW_UPD_RDPTR19_TO_16_8822C)) -+#define BIT_GET_FW_UPD_RDPTR19_TO_16_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR19_TO_16_8822C) & \ -+ BIT_MASK_FW_UPD_RDPTR19_TO_16_8822C) -+#define BIT_SET_FW_UPD_RDPTR19_TO_16_8822C(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR19_TO_16_8822C(x) | \ -+ BIT_FW_UPD_RDPTR19_TO_16_8822C(v)) -+ -+#define BIT_RXDMA_REQ_8822C BIT(19) -+#define BIT_RW_RELEASE_EN_8822C BIT(18) -+#define BIT_RXDMA_IDLE_8822C BIT(17) -+#define BIT_RXPKT_RELEASE_POLL_8822C BIT(16) -+ -+#define BIT_SHIFT_FW_UPD_RDPTR_8822C 0 -+#define BIT_MASK_FW_UPD_RDPTR_8822C 0xffff -+#define BIT_FW_UPD_RDPTR_8822C(x) \ -+ (((x) & BIT_MASK_FW_UPD_RDPTR_8822C) << BIT_SHIFT_FW_UPD_RDPTR_8822C) -+#define BITS_FW_UPD_RDPTR_8822C \ -+ (BIT_MASK_FW_UPD_RDPTR_8822C << BIT_SHIFT_FW_UPD_RDPTR_8822C) -+#define BIT_CLEAR_FW_UPD_RDPTR_8822C(x) ((x) & (~BITS_FW_UPD_RDPTR_8822C)) -+#define BIT_GET_FW_UPD_RDPTR_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_UPD_RDPTR_8822C) & BIT_MASK_FW_UPD_RDPTR_8822C) -+#define BIT_SET_FW_UPD_RDPTR_8822C(x, v) \ -+ (BIT_CLEAR_FW_UPD_RDPTR_8822C(x) | BIT_FW_UPD_RDPTR_8822C(v)) -+ -+/* 2 REG_RXDMA_STATUS_8822C */ -+#define BIT_C2H_PKT_OVF_8822C BIT(7) -+#define BIT_AGG_CONFGI_ISSUE_8822C BIT(6) -+#define BIT_FW_POLL_ISSUE_8822C BIT(5) -+#define BIT_RX_DATA_UDN_8822C BIT(4) -+#define BIT_RX_SFF_UDN_8822C BIT(3) -+#define BIT_RX_SFF_OVF_8822C BIT(2) -+#define BIT_RXPKT_OVF_8822C BIT(0) -+ -+/* 2 REG_RXDMA_DPR_8822C */ -+ -+#define BIT_SHIFT_RDE_DEBUG_8822C 0 -+#define BIT_MASK_RDE_DEBUG_8822C 0xffffffffL -+#define BIT_RDE_DEBUG_8822C(x) \ -+ (((x) & BIT_MASK_RDE_DEBUG_8822C) << BIT_SHIFT_RDE_DEBUG_8822C) -+#define BITS_RDE_DEBUG_8822C \ -+ (BIT_MASK_RDE_DEBUG_8822C << BIT_SHIFT_RDE_DEBUG_8822C) -+#define BIT_CLEAR_RDE_DEBUG_8822C(x) ((x) & (~BITS_RDE_DEBUG_8822C)) -+#define BIT_GET_RDE_DEBUG_8822C(x) \ -+ (((x) >> BIT_SHIFT_RDE_DEBUG_8822C) & BIT_MASK_RDE_DEBUG_8822C) -+#define BIT_SET_RDE_DEBUG_8822C(x, v) \ -+ (BIT_CLEAR_RDE_DEBUG_8822C(x) | BIT_RDE_DEBUG_8822C(v)) -+ -+/* 2 REG_RXDMA_MODE_8822C */ -+ -+#define BIT_SHIFT_PKTNUM_TH_V2_8822C 24 -+#define BIT_MASK_PKTNUM_TH_V2_8822C 0x1f -+#define BIT_PKTNUM_TH_V2_8822C(x) \ -+ (((x) & BIT_MASK_PKTNUM_TH_V2_8822C) << BIT_SHIFT_PKTNUM_TH_V2_8822C) -+#define BITS_PKTNUM_TH_V2_8822C \ -+ (BIT_MASK_PKTNUM_TH_V2_8822C << BIT_SHIFT_PKTNUM_TH_V2_8822C) -+#define BIT_CLEAR_PKTNUM_TH_V2_8822C(x) ((x) & (~BITS_PKTNUM_TH_V2_8822C)) -+#define BIT_GET_PKTNUM_TH_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKTNUM_TH_V2_8822C) & BIT_MASK_PKTNUM_TH_V2_8822C) -+#define BIT_SET_PKTNUM_TH_V2_8822C(x, v) \ -+ (BIT_CLEAR_PKTNUM_TH_V2_8822C(x) | BIT_PKTNUM_TH_V2_8822C(v)) -+ -+#define BIT_TXBA_BREAK_USBAGG_8822C BIT(23) -+ -+#define BIT_SHIFT_PKTLEN_PARA_8822C 16 -+#define BIT_MASK_PKTLEN_PARA_8822C 0x7 -+#define BIT_PKTLEN_PARA_8822C(x) \ -+ (((x) & BIT_MASK_PKTLEN_PARA_8822C) << BIT_SHIFT_PKTLEN_PARA_8822C) -+#define BITS_PKTLEN_PARA_8822C \ -+ (BIT_MASK_PKTLEN_PARA_8822C << BIT_SHIFT_PKTLEN_PARA_8822C) -+#define BIT_CLEAR_PKTLEN_PARA_8822C(x) ((x) & (~BITS_PKTLEN_PARA_8822C)) -+#define BIT_GET_PKTLEN_PARA_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKTLEN_PARA_8822C) & BIT_MASK_PKTLEN_PARA_8822C) -+#define BIT_SET_PKTLEN_PARA_8822C(x, v) \ -+ (BIT_CLEAR_PKTLEN_PARA_8822C(x) | BIT_PKTLEN_PARA_8822C(v)) -+ -+#define BIT_RX_DBG_SEL_8822C BIT(7) -+#define BIT_EN_SPD_8822C BIT(6) -+ -+#define BIT_SHIFT_BURST_SIZE_8822C 4 -+#define BIT_MASK_BURST_SIZE_8822C 0x3 -+#define BIT_BURST_SIZE_8822C(x) \ -+ (((x) & BIT_MASK_BURST_SIZE_8822C) << BIT_SHIFT_BURST_SIZE_8822C) -+#define BITS_BURST_SIZE_8822C \ -+ (BIT_MASK_BURST_SIZE_8822C << BIT_SHIFT_BURST_SIZE_8822C) -+#define BIT_CLEAR_BURST_SIZE_8822C(x) ((x) & (~BITS_BURST_SIZE_8822C)) -+#define BIT_GET_BURST_SIZE_8822C(x) \ -+ (((x) >> BIT_SHIFT_BURST_SIZE_8822C) & BIT_MASK_BURST_SIZE_8822C) -+#define BIT_SET_BURST_SIZE_8822C(x, v) \ -+ (BIT_CLEAR_BURST_SIZE_8822C(x) | BIT_BURST_SIZE_8822C(v)) -+ -+#define BIT_SHIFT_BURST_CNT_8822C 2 -+#define BIT_MASK_BURST_CNT_8822C 0x3 -+#define BIT_BURST_CNT_8822C(x) \ -+ (((x) & BIT_MASK_BURST_CNT_8822C) << BIT_SHIFT_BURST_CNT_8822C) -+#define BITS_BURST_CNT_8822C \ -+ (BIT_MASK_BURST_CNT_8822C << BIT_SHIFT_BURST_CNT_8822C) -+#define BIT_CLEAR_BURST_CNT_8822C(x) ((x) & (~BITS_BURST_CNT_8822C)) -+#define BIT_GET_BURST_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_BURST_CNT_8822C) & BIT_MASK_BURST_CNT_8822C) -+#define BIT_SET_BURST_CNT_8822C(x, v) \ -+ (BIT_CLEAR_BURST_CNT_8822C(x) | BIT_BURST_CNT_8822C(v)) -+ -+#define BIT_DMA_MODE_8822C BIT(1) -+ -+/* 2 REG_C2H_PKT_8822C */ -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8822C 24 -+#define BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8822C 0xf -+#define BIT_R_C2H_STR_ADDR_16_TO_19_8822C(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8822C) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8822C) -+#define BITS_R_C2H_STR_ADDR_16_TO_19_8822C \ -+ (BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8822C \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8822C) -+#define BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8822C(x) \ -+ ((x) & (~BITS_R_C2H_STR_ADDR_16_TO_19_8822C)) -+#define BIT_GET_R_C2H_STR_ADDR_16_TO_19_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_16_TO_19_8822C) & \ -+ BIT_MASK_R_C2H_STR_ADDR_16_TO_19_8822C) -+#define BIT_SET_R_C2H_STR_ADDR_16_TO_19_8822C(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_16_TO_19_8822C(x) | \ -+ BIT_R_C2H_STR_ADDR_16_TO_19_8822C(v)) -+ -+#define BIT_R_C2H_PKT_REQ_8822C BIT(16) -+ -+#define BIT_SHIFT_R_C2H_STR_ADDR_8822C 0 -+#define BIT_MASK_R_C2H_STR_ADDR_8822C 0xffff -+#define BIT_R_C2H_STR_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_R_C2H_STR_ADDR_8822C) \ -+ << BIT_SHIFT_R_C2H_STR_ADDR_8822C) -+#define BITS_R_C2H_STR_ADDR_8822C \ -+ (BIT_MASK_R_C2H_STR_ADDR_8822C << BIT_SHIFT_R_C2H_STR_ADDR_8822C) -+#define BIT_CLEAR_R_C2H_STR_ADDR_8822C(x) ((x) & (~BITS_R_C2H_STR_ADDR_8822C)) -+#define BIT_GET_R_C2H_STR_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_C2H_STR_ADDR_8822C) & \ -+ BIT_MASK_R_C2H_STR_ADDR_8822C) -+#define BIT_SET_R_C2H_STR_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_R_C2H_STR_ADDR_8822C(x) | BIT_R_C2H_STR_ADDR_8822C(v)) -+ -+/* 2 REG_FWFF_C2H_8822C */ -+ -+#define BIT_SHIFT_C2H_DMA_ADDR_8822C 0 -+#define BIT_MASK_C2H_DMA_ADDR_8822C 0x3ffff -+#define BIT_C2H_DMA_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_C2H_DMA_ADDR_8822C) << BIT_SHIFT_C2H_DMA_ADDR_8822C) -+#define BITS_C2H_DMA_ADDR_8822C \ -+ (BIT_MASK_C2H_DMA_ADDR_8822C << BIT_SHIFT_C2H_DMA_ADDR_8822C) -+#define BIT_CLEAR_C2H_DMA_ADDR_8822C(x) ((x) & (~BITS_C2H_DMA_ADDR_8822C)) -+#define BIT_GET_C2H_DMA_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_C2H_DMA_ADDR_8822C) & BIT_MASK_C2H_DMA_ADDR_8822C) -+#define BIT_SET_C2H_DMA_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_C2H_DMA_ADDR_8822C(x) | BIT_C2H_DMA_ADDR_8822C(v)) -+ -+/* 2 REG_FWFF_CTRL_8822C */ -+#define BIT_FWFF_DMAPKT_REQ_8822C BIT(31) -+ -+#define BIT_SHIFT_FWFF_DMA_PKT_NUM_8822C 16 -+#define BIT_MASK_FWFF_DMA_PKT_NUM_8822C 0xff -+#define BIT_FWFF_DMA_PKT_NUM_8822C(x) \ -+ (((x) & BIT_MASK_FWFF_DMA_PKT_NUM_8822C) \ -+ << BIT_SHIFT_FWFF_DMA_PKT_NUM_8822C) -+#define BITS_FWFF_DMA_PKT_NUM_8822C \ -+ (BIT_MASK_FWFF_DMA_PKT_NUM_8822C << BIT_SHIFT_FWFF_DMA_PKT_NUM_8822C) -+#define BIT_CLEAR_FWFF_DMA_PKT_NUM_8822C(x) \ -+ ((x) & (~BITS_FWFF_DMA_PKT_NUM_8822C)) -+#define BIT_GET_FWFF_DMA_PKT_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_FWFF_DMA_PKT_NUM_8822C) & \ -+ BIT_MASK_FWFF_DMA_PKT_NUM_8822C) -+#define BIT_SET_FWFF_DMA_PKT_NUM_8822C(x, v) \ -+ (BIT_CLEAR_FWFF_DMA_PKT_NUM_8822C(x) | BIT_FWFF_DMA_PKT_NUM_8822C(v)) -+ -+#define BIT_SHIFT_FWFF_STR_ADDR_8822C 0 -+#define BIT_MASK_FWFF_STR_ADDR_8822C 0xffff -+#define BIT_FWFF_STR_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_FWFF_STR_ADDR_8822C) << BIT_SHIFT_FWFF_STR_ADDR_8822C) -+#define BITS_FWFF_STR_ADDR_8822C \ -+ (BIT_MASK_FWFF_STR_ADDR_8822C << BIT_SHIFT_FWFF_STR_ADDR_8822C) -+#define BIT_CLEAR_FWFF_STR_ADDR_8822C(x) ((x) & (~BITS_FWFF_STR_ADDR_8822C)) -+#define BIT_GET_FWFF_STR_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_FWFF_STR_ADDR_8822C) & BIT_MASK_FWFF_STR_ADDR_8822C) -+#define BIT_SET_FWFF_STR_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_FWFF_STR_ADDR_8822C(x) | BIT_FWFF_STR_ADDR_8822C(v)) -+ -+/* 2 REG_FWFF_PKT_INFO_8822C */ -+ -+#define BIT_SHIFT_FWFF_PKT_QUEUED_8822C 16 -+#define BIT_MASK_FWFF_PKT_QUEUED_8822C 0xff -+#define BIT_FWFF_PKT_QUEUED_8822C(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_QUEUED_8822C) \ -+ << BIT_SHIFT_FWFF_PKT_QUEUED_8822C) -+#define BITS_FWFF_PKT_QUEUED_8822C \ -+ (BIT_MASK_FWFF_PKT_QUEUED_8822C << BIT_SHIFT_FWFF_PKT_QUEUED_8822C) -+#define BIT_CLEAR_FWFF_PKT_QUEUED_8822C(x) ((x) & (~BITS_FWFF_PKT_QUEUED_8822C)) -+#define BIT_GET_FWFF_PKT_QUEUED_8822C(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_QUEUED_8822C) & \ -+ BIT_MASK_FWFF_PKT_QUEUED_8822C) -+#define BIT_SET_FWFF_PKT_QUEUED_8822C(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_QUEUED_8822C(x) | BIT_FWFF_PKT_QUEUED_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_FWFF_PKT_STR_ADDR_V2_8822C 0 -+#define BIT_MASK_FWFF_PKT_STR_ADDR_V2_8822C 0x3fff -+#define BIT_FWFF_PKT_STR_ADDR_V2_8822C(x) \ -+ (((x) & BIT_MASK_FWFF_PKT_STR_ADDR_V2_8822C) \ -+ << BIT_SHIFT_FWFF_PKT_STR_ADDR_V2_8822C) -+#define BITS_FWFF_PKT_STR_ADDR_V2_8822C \ -+ (BIT_MASK_FWFF_PKT_STR_ADDR_V2_8822C \ -+ << BIT_SHIFT_FWFF_PKT_STR_ADDR_V2_8822C) -+#define BIT_CLEAR_FWFF_PKT_STR_ADDR_V2_8822C(x) \ -+ ((x) & (~BITS_FWFF_PKT_STR_ADDR_V2_8822C)) -+#define BIT_GET_FWFF_PKT_STR_ADDR_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_FWFF_PKT_STR_ADDR_V2_8822C) & \ -+ BIT_MASK_FWFF_PKT_STR_ADDR_V2_8822C) -+#define BIT_SET_FWFF_PKT_STR_ADDR_V2_8822C(x, v) \ -+ (BIT_CLEAR_FWFF_PKT_STR_ADDR_V2_8822C(x) | \ -+ BIT_FWFF_PKT_STR_ADDR_V2_8822C(v)) -+ -+/* 2 REG_RXPKTNUM_8822C */ -+ -+#define BIT_SHIFT_PKT_NUM_WOL_V1_8822C 16 -+#define BIT_MASK_PKT_NUM_WOL_V1_8822C 0xffff -+#define BIT_PKT_NUM_WOL_V1_8822C(x) \ -+ (((x) & BIT_MASK_PKT_NUM_WOL_V1_8822C) \ -+ << BIT_SHIFT_PKT_NUM_WOL_V1_8822C) -+#define BITS_PKT_NUM_WOL_V1_8822C \ -+ (BIT_MASK_PKT_NUM_WOL_V1_8822C << BIT_SHIFT_PKT_NUM_WOL_V1_8822C) -+#define BIT_CLEAR_PKT_NUM_WOL_V1_8822C(x) ((x) & (~BITS_PKT_NUM_WOL_V1_8822C)) -+#define BIT_GET_PKT_NUM_WOL_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKT_NUM_WOL_V1_8822C) & \ -+ BIT_MASK_PKT_NUM_WOL_V1_8822C) -+#define BIT_SET_PKT_NUM_WOL_V1_8822C(x, v) \ -+ (BIT_CLEAR_PKT_NUM_WOL_V1_8822C(x) | BIT_PKT_NUM_WOL_V1_8822C(v)) -+ -+#define BIT_SHIFT_RXPKT_NUM_V1_8822C 0 -+#define BIT_MASK_RXPKT_NUM_V1_8822C 0xffff -+#define BIT_RXPKT_NUM_V1_8822C(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_V1_8822C) << BIT_SHIFT_RXPKT_NUM_V1_8822C) -+#define BITS_RXPKT_NUM_V1_8822C \ -+ (BIT_MASK_RXPKT_NUM_V1_8822C << BIT_SHIFT_RXPKT_NUM_V1_8822C) -+#define BIT_CLEAR_RXPKT_NUM_V1_8822C(x) ((x) & (~BITS_RXPKT_NUM_V1_8822C)) -+#define BIT_GET_RXPKT_NUM_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_V1_8822C) & BIT_MASK_RXPKT_NUM_V1_8822C) -+#define BIT_SET_RXPKT_NUM_V1_8822C(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_V1_8822C(x) | BIT_RXPKT_NUM_V1_8822C(v)) -+ -+/* 2 REG_RXPKTNUM_TH_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_RXPKT_NUM_TH_8822C 0 -+#define BIT_MASK_RXPKT_NUM_TH_8822C 0xff -+#define BIT_RXPKT_NUM_TH_8822C(x) \ -+ (((x) & BIT_MASK_RXPKT_NUM_TH_8822C) << BIT_SHIFT_RXPKT_NUM_TH_8822C) -+#define BITS_RXPKT_NUM_TH_8822C \ -+ (BIT_MASK_RXPKT_NUM_TH_8822C << BIT_SHIFT_RXPKT_NUM_TH_8822C) -+#define BIT_CLEAR_RXPKT_NUM_TH_8822C(x) ((x) & (~BITS_RXPKT_NUM_TH_8822C)) -+#define BIT_GET_RXPKT_NUM_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_NUM_TH_8822C) & BIT_MASK_RXPKT_NUM_TH_8822C) -+#define BIT_SET_RXPKT_NUM_TH_8822C(x, v) \ -+ (BIT_CLEAR_RXPKT_NUM_TH_8822C(x) | BIT_RXPKT_NUM_TH_8822C(v)) -+ -+/* 2 REG_FW_MSG1_8822C */ -+ -+#define BIT_SHIFT_FW_MSG_REG1_8822C 0 -+#define BIT_MASK_FW_MSG_REG1_8822C 0xffffffffL -+#define BIT_FW_MSG_REG1_8822C(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG1_8822C) << BIT_SHIFT_FW_MSG_REG1_8822C) -+#define BITS_FW_MSG_REG1_8822C \ -+ (BIT_MASK_FW_MSG_REG1_8822C << BIT_SHIFT_FW_MSG_REG1_8822C) -+#define BIT_CLEAR_FW_MSG_REG1_8822C(x) ((x) & (~BITS_FW_MSG_REG1_8822C)) -+#define BIT_GET_FW_MSG_REG1_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG1_8822C) & BIT_MASK_FW_MSG_REG1_8822C) -+#define BIT_SET_FW_MSG_REG1_8822C(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG1_8822C(x) | BIT_FW_MSG_REG1_8822C(v)) -+ -+/* 2 REG_FW_MSG2_8822C */ -+ -+#define BIT_SHIFT_FW_MSG_REG2_8822C 0 -+#define BIT_MASK_FW_MSG_REG2_8822C 0xffffffffL -+#define BIT_FW_MSG_REG2_8822C(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG2_8822C) << BIT_SHIFT_FW_MSG_REG2_8822C) -+#define BITS_FW_MSG_REG2_8822C \ -+ (BIT_MASK_FW_MSG_REG2_8822C << BIT_SHIFT_FW_MSG_REG2_8822C) -+#define BIT_CLEAR_FW_MSG_REG2_8822C(x) ((x) & (~BITS_FW_MSG_REG2_8822C)) -+#define BIT_GET_FW_MSG_REG2_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG2_8822C) & BIT_MASK_FW_MSG_REG2_8822C) -+#define BIT_SET_FW_MSG_REG2_8822C(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG2_8822C(x) | BIT_FW_MSG_REG2_8822C(v)) -+ -+/* 2 REG_FW_MSG3_8822C */ -+ -+#define BIT_SHIFT_FW_MSG_REG3_8822C 0 -+#define BIT_MASK_FW_MSG_REG3_8822C 0xffffffffL -+#define BIT_FW_MSG_REG3_8822C(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG3_8822C) << BIT_SHIFT_FW_MSG_REG3_8822C) -+#define BITS_FW_MSG_REG3_8822C \ -+ (BIT_MASK_FW_MSG_REG3_8822C << BIT_SHIFT_FW_MSG_REG3_8822C) -+#define BIT_CLEAR_FW_MSG_REG3_8822C(x) ((x) & (~BITS_FW_MSG_REG3_8822C)) -+#define BIT_GET_FW_MSG_REG3_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG3_8822C) & BIT_MASK_FW_MSG_REG3_8822C) -+#define BIT_SET_FW_MSG_REG3_8822C(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG3_8822C(x) | BIT_FW_MSG_REG3_8822C(v)) -+ -+/* 2 REG_FW_MSG4_8822C */ -+ -+#define BIT_SHIFT_FW_MSG_REG4_8822C 0 -+#define BIT_MASK_FW_MSG_REG4_8822C 0xffffffffL -+#define BIT_FW_MSG_REG4_8822C(x) \ -+ (((x) & BIT_MASK_FW_MSG_REG4_8822C) << BIT_SHIFT_FW_MSG_REG4_8822C) -+#define BITS_FW_MSG_REG4_8822C \ -+ (BIT_MASK_FW_MSG_REG4_8822C << BIT_SHIFT_FW_MSG_REG4_8822C) -+#define BIT_CLEAR_FW_MSG_REG4_8822C(x) ((x) & (~BITS_FW_MSG_REG4_8822C)) -+#define BIT_GET_FW_MSG_REG4_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_MSG_REG4_8822C) & BIT_MASK_FW_MSG_REG4_8822C) -+#define BIT_SET_FW_MSG_REG4_8822C(x, v) \ -+ (BIT_CLEAR_FW_MSG_REG4_8822C(x) | BIT_FW_MSG_REG4_8822C(v)) -+ -+/* 2 REG_DDMA_CH0SA_8822C */ -+ -+#define BIT_SHIFT_DDMACH0_SA_8822C 0 -+#define BIT_MASK_DDMACH0_SA_8822C 0xffffffffL -+#define BIT_DDMACH0_SA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH0_SA_8822C) << BIT_SHIFT_DDMACH0_SA_8822C) -+#define BITS_DDMACH0_SA_8822C \ -+ (BIT_MASK_DDMACH0_SA_8822C << BIT_SHIFT_DDMACH0_SA_8822C) -+#define BIT_CLEAR_DDMACH0_SA_8822C(x) ((x) & (~BITS_DDMACH0_SA_8822C)) -+#define BIT_GET_DDMACH0_SA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_SA_8822C) & BIT_MASK_DDMACH0_SA_8822C) -+#define BIT_SET_DDMACH0_SA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH0_SA_8822C(x) | BIT_DDMACH0_SA_8822C(v)) -+ -+/* 2 REG_DDMA_CH0DA_8822C */ -+ -+#define BIT_SHIFT_DDMACH0_DA_8822C 0 -+#define BIT_MASK_DDMACH0_DA_8822C 0xffffffffL -+#define BIT_DDMACH0_DA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH0_DA_8822C) << BIT_SHIFT_DDMACH0_DA_8822C) -+#define BITS_DDMACH0_DA_8822C \ -+ (BIT_MASK_DDMACH0_DA_8822C << BIT_SHIFT_DDMACH0_DA_8822C) -+#define BIT_CLEAR_DDMACH0_DA_8822C(x) ((x) & (~BITS_DDMACH0_DA_8822C)) -+#define BIT_GET_DDMACH0_DA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DA_8822C) & BIT_MASK_DDMACH0_DA_8822C) -+#define BIT_SET_DDMACH0_DA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH0_DA_8822C(x) | BIT_DDMACH0_DA_8822C(v)) -+ -+/* 2 REG_DDMA_CH0CTRL_8822C */ -+#define BIT_DDMACH0_OWN_8822C BIT(31) -+#define BIT_DDMACH0_IDMEM_ERR_8822C BIT(30) -+#define BIT_DDMACH0_CHKSUM_EN_8822C BIT(29) -+#define BIT_DDMACH0_DA_W_DISABLE_8822C BIT(28) -+#define BIT_DDMACH0_CHKSUM_STS_8822C BIT(27) -+#define BIT_DDMACH0_DDMA_MODE_8822C BIT(26) -+#define BIT_DDMACH0_RESET_CHKSUM_STS_8822C BIT(25) -+#define BIT_DDMACH0_CHKSUM_CONT_8822C BIT(24) -+ -+#define BIT_SHIFT_DDMACH0_DLEN_8822C 0 -+#define BIT_MASK_DDMACH0_DLEN_8822C 0x3ffff -+#define BIT_DDMACH0_DLEN_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH0_DLEN_8822C) << BIT_SHIFT_DDMACH0_DLEN_8822C) -+#define BITS_DDMACH0_DLEN_8822C \ -+ (BIT_MASK_DDMACH0_DLEN_8822C << BIT_SHIFT_DDMACH0_DLEN_8822C) -+#define BIT_CLEAR_DDMACH0_DLEN_8822C(x) ((x) & (~BITS_DDMACH0_DLEN_8822C)) -+#define BIT_GET_DDMACH0_DLEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH0_DLEN_8822C) & BIT_MASK_DDMACH0_DLEN_8822C) -+#define BIT_SET_DDMACH0_DLEN_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH0_DLEN_8822C(x) | BIT_DDMACH0_DLEN_8822C(v)) -+ -+/* 2 REG_DDMA_CH1SA_8822C */ -+ -+#define BIT_SHIFT_DDMACH1_SA_8822C 0 -+#define BIT_MASK_DDMACH1_SA_8822C 0xffffffffL -+#define BIT_DDMACH1_SA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH1_SA_8822C) << BIT_SHIFT_DDMACH1_SA_8822C) -+#define BITS_DDMACH1_SA_8822C \ -+ (BIT_MASK_DDMACH1_SA_8822C << BIT_SHIFT_DDMACH1_SA_8822C) -+#define BIT_CLEAR_DDMACH1_SA_8822C(x) ((x) & (~BITS_DDMACH1_SA_8822C)) -+#define BIT_GET_DDMACH1_SA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_SA_8822C) & BIT_MASK_DDMACH1_SA_8822C) -+#define BIT_SET_DDMACH1_SA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH1_SA_8822C(x) | BIT_DDMACH1_SA_8822C(v)) -+ -+/* 2 REG_DDMA_CH1DA_8822C */ -+ -+#define BIT_SHIFT_DDMACH1_DA_8822C 0 -+#define BIT_MASK_DDMACH1_DA_8822C 0xffffffffL -+#define BIT_DDMACH1_DA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH1_DA_8822C) << BIT_SHIFT_DDMACH1_DA_8822C) -+#define BITS_DDMACH1_DA_8822C \ -+ (BIT_MASK_DDMACH1_DA_8822C << BIT_SHIFT_DDMACH1_DA_8822C) -+#define BIT_CLEAR_DDMACH1_DA_8822C(x) ((x) & (~BITS_DDMACH1_DA_8822C)) -+#define BIT_GET_DDMACH1_DA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DA_8822C) & BIT_MASK_DDMACH1_DA_8822C) -+#define BIT_SET_DDMACH1_DA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH1_DA_8822C(x) | BIT_DDMACH1_DA_8822C(v)) -+ -+/* 2 REG_DDMA_CH1CTRL_8822C */ -+#define BIT_DDMACH1_OWN_8822C BIT(31) -+#define BIT_DDMACH1_IDMEM_ERR_8822C BIT(30) -+#define BIT_DDMACH1_CHKSUM_EN_8822C BIT(29) -+#define BIT_DDMACH1_DA_W_DISABLE_8822C BIT(28) -+#define BIT_DDMACH1_CHKSUM_STS_8822C BIT(27) -+#define BIT_DDMACH1_DDMA_MODE_8822C BIT(26) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_DDMACH1_DLEN_8822C 0 -+#define BIT_MASK_DDMACH1_DLEN_8822C 0x3ffff -+#define BIT_DDMACH1_DLEN_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH1_DLEN_8822C) << BIT_SHIFT_DDMACH1_DLEN_8822C) -+#define BITS_DDMACH1_DLEN_8822C \ -+ (BIT_MASK_DDMACH1_DLEN_8822C << BIT_SHIFT_DDMACH1_DLEN_8822C) -+#define BIT_CLEAR_DDMACH1_DLEN_8822C(x) ((x) & (~BITS_DDMACH1_DLEN_8822C)) -+#define BIT_GET_DDMACH1_DLEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH1_DLEN_8822C) & BIT_MASK_DDMACH1_DLEN_8822C) -+#define BIT_SET_DDMACH1_DLEN_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH1_DLEN_8822C(x) | BIT_DDMACH1_DLEN_8822C(v)) -+ -+/* 2 REG_DDMA_CH2SA_8822C */ -+ -+#define BIT_SHIFT_DDMACH2_SA_8822C 0 -+#define BIT_MASK_DDMACH2_SA_8822C 0xffffffffL -+#define BIT_DDMACH2_SA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH2_SA_8822C) << BIT_SHIFT_DDMACH2_SA_8822C) -+#define BITS_DDMACH2_SA_8822C \ -+ (BIT_MASK_DDMACH2_SA_8822C << BIT_SHIFT_DDMACH2_SA_8822C) -+#define BIT_CLEAR_DDMACH2_SA_8822C(x) ((x) & (~BITS_DDMACH2_SA_8822C)) -+#define BIT_GET_DDMACH2_SA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_SA_8822C) & BIT_MASK_DDMACH2_SA_8822C) -+#define BIT_SET_DDMACH2_SA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH2_SA_8822C(x) | BIT_DDMACH2_SA_8822C(v)) -+ -+/* 2 REG_DDMA_CH2DA_8822C */ -+ -+#define BIT_SHIFT_DDMACH2_DA_8822C 0 -+#define BIT_MASK_DDMACH2_DA_8822C 0xffffffffL -+#define BIT_DDMACH2_DA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH2_DA_8822C) << BIT_SHIFT_DDMACH2_DA_8822C) -+#define BITS_DDMACH2_DA_8822C \ -+ (BIT_MASK_DDMACH2_DA_8822C << BIT_SHIFT_DDMACH2_DA_8822C) -+#define BIT_CLEAR_DDMACH2_DA_8822C(x) ((x) & (~BITS_DDMACH2_DA_8822C)) -+#define BIT_GET_DDMACH2_DA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DA_8822C) & BIT_MASK_DDMACH2_DA_8822C) -+#define BIT_SET_DDMACH2_DA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH2_DA_8822C(x) | BIT_DDMACH2_DA_8822C(v)) -+ -+/* 2 REG_DDMA_CH2CTRL_8822C */ -+#define BIT_DDMACH2_OWN_8822C BIT(31) -+#define BIT_DDMACH2_IDMEM_ERR_8822C BIT(30) -+#define BIT_DDMACH2_CHKSUM_EN_8822C BIT(29) -+#define BIT_DDMACH2_DA_W_DISABLE_8822C BIT(28) -+#define BIT_DDMACH2_CHKSUM_STS_8822C BIT(27) -+#define BIT_DDMACH2_DDMA_MODE_8822C BIT(26) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_DDMACH2_DLEN_8822C 0 -+#define BIT_MASK_DDMACH2_DLEN_8822C 0x3ffff -+#define BIT_DDMACH2_DLEN_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH2_DLEN_8822C) << BIT_SHIFT_DDMACH2_DLEN_8822C) -+#define BITS_DDMACH2_DLEN_8822C \ -+ (BIT_MASK_DDMACH2_DLEN_8822C << BIT_SHIFT_DDMACH2_DLEN_8822C) -+#define BIT_CLEAR_DDMACH2_DLEN_8822C(x) ((x) & (~BITS_DDMACH2_DLEN_8822C)) -+#define BIT_GET_DDMACH2_DLEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH2_DLEN_8822C) & BIT_MASK_DDMACH2_DLEN_8822C) -+#define BIT_SET_DDMACH2_DLEN_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH2_DLEN_8822C(x) | BIT_DDMACH2_DLEN_8822C(v)) -+ -+/* 2 REG_DDMA_CH3SA_8822C */ -+ -+#define BIT_SHIFT_DDMACH3_SA_8822C 0 -+#define BIT_MASK_DDMACH3_SA_8822C 0xffffffffL -+#define BIT_DDMACH3_SA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH3_SA_8822C) << BIT_SHIFT_DDMACH3_SA_8822C) -+#define BITS_DDMACH3_SA_8822C \ -+ (BIT_MASK_DDMACH3_SA_8822C << BIT_SHIFT_DDMACH3_SA_8822C) -+#define BIT_CLEAR_DDMACH3_SA_8822C(x) ((x) & (~BITS_DDMACH3_SA_8822C)) -+#define BIT_GET_DDMACH3_SA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_SA_8822C) & BIT_MASK_DDMACH3_SA_8822C) -+#define BIT_SET_DDMACH3_SA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH3_SA_8822C(x) | BIT_DDMACH3_SA_8822C(v)) -+ -+/* 2 REG_DDMA_CH3DA_8822C */ -+ -+#define BIT_SHIFT_DDMACH3_DA_8822C 0 -+#define BIT_MASK_DDMACH3_DA_8822C 0xffffffffL -+#define BIT_DDMACH3_DA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH3_DA_8822C) << BIT_SHIFT_DDMACH3_DA_8822C) -+#define BITS_DDMACH3_DA_8822C \ -+ (BIT_MASK_DDMACH3_DA_8822C << BIT_SHIFT_DDMACH3_DA_8822C) -+#define BIT_CLEAR_DDMACH3_DA_8822C(x) ((x) & (~BITS_DDMACH3_DA_8822C)) -+#define BIT_GET_DDMACH3_DA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DA_8822C) & BIT_MASK_DDMACH3_DA_8822C) -+#define BIT_SET_DDMACH3_DA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH3_DA_8822C(x) | BIT_DDMACH3_DA_8822C(v)) -+ -+/* 2 REG_DDMA_CH3CTRL_8822C */ -+#define BIT_DDMACH3_OWN_8822C BIT(31) -+#define BIT_DDMACH3_IDMEM_ERR_8822C BIT(30) -+#define BIT_DDMACH3_CHKSUM_EN_8822C BIT(29) -+#define BIT_DDMACH3_DA_W_DISABLE_8822C BIT(28) -+#define BIT_DDMACH3_CHKSUM_STS_8822C BIT(27) -+#define BIT_DDMACH3_DDMA_MODE_8822C BIT(26) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_DDMACH3_DLEN_8822C 0 -+#define BIT_MASK_DDMACH3_DLEN_8822C 0x3ffff -+#define BIT_DDMACH3_DLEN_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH3_DLEN_8822C) << BIT_SHIFT_DDMACH3_DLEN_8822C) -+#define BITS_DDMACH3_DLEN_8822C \ -+ (BIT_MASK_DDMACH3_DLEN_8822C << BIT_SHIFT_DDMACH3_DLEN_8822C) -+#define BIT_CLEAR_DDMACH3_DLEN_8822C(x) ((x) & (~BITS_DDMACH3_DLEN_8822C)) -+#define BIT_GET_DDMACH3_DLEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH3_DLEN_8822C) & BIT_MASK_DDMACH3_DLEN_8822C) -+#define BIT_SET_DDMACH3_DLEN_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH3_DLEN_8822C(x) | BIT_DDMACH3_DLEN_8822C(v)) -+ -+/* 2 REG_DDMA_CH4SA_8822C */ -+ -+#define BIT_SHIFT_DDMACH4_SA_8822C 0 -+#define BIT_MASK_DDMACH4_SA_8822C 0xffffffffL -+#define BIT_DDMACH4_SA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH4_SA_8822C) << BIT_SHIFT_DDMACH4_SA_8822C) -+#define BITS_DDMACH4_SA_8822C \ -+ (BIT_MASK_DDMACH4_SA_8822C << BIT_SHIFT_DDMACH4_SA_8822C) -+#define BIT_CLEAR_DDMACH4_SA_8822C(x) ((x) & (~BITS_DDMACH4_SA_8822C)) -+#define BIT_GET_DDMACH4_SA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_SA_8822C) & BIT_MASK_DDMACH4_SA_8822C) -+#define BIT_SET_DDMACH4_SA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH4_SA_8822C(x) | BIT_DDMACH4_SA_8822C(v)) -+ -+/* 2 REG_DDMA_CH4DA_8822C */ -+ -+#define BIT_SHIFT_DDMACH4_DA_8822C 0 -+#define BIT_MASK_DDMACH4_DA_8822C 0xffffffffL -+#define BIT_DDMACH4_DA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH4_DA_8822C) << BIT_SHIFT_DDMACH4_DA_8822C) -+#define BITS_DDMACH4_DA_8822C \ -+ (BIT_MASK_DDMACH4_DA_8822C << BIT_SHIFT_DDMACH4_DA_8822C) -+#define BIT_CLEAR_DDMACH4_DA_8822C(x) ((x) & (~BITS_DDMACH4_DA_8822C)) -+#define BIT_GET_DDMACH4_DA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DA_8822C) & BIT_MASK_DDMACH4_DA_8822C) -+#define BIT_SET_DDMACH4_DA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH4_DA_8822C(x) | BIT_DDMACH4_DA_8822C(v)) -+ -+/* 2 REG_DDMA_CH4CTRL_8822C */ -+#define BIT_DDMACH4_OWN_8822C BIT(31) -+#define BIT_DDMACH4_IDMEM_ERR_8822C BIT(30) -+#define BIT_DDMACH4_CHKSUM_EN_8822C BIT(29) -+#define BIT_DDMACH4_DA_W_DISABLE_8822C BIT(28) -+#define BIT_DDMACH4_CHKSUM_STS_8822C BIT(27) -+#define BIT_DDMACH4_DDMA_MODE_8822C BIT(26) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_DDMACH4_DLEN_8822C 0 -+#define BIT_MASK_DDMACH4_DLEN_8822C 0x3ffff -+#define BIT_DDMACH4_DLEN_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH4_DLEN_8822C) << BIT_SHIFT_DDMACH4_DLEN_8822C) -+#define BITS_DDMACH4_DLEN_8822C \ -+ (BIT_MASK_DDMACH4_DLEN_8822C << BIT_SHIFT_DDMACH4_DLEN_8822C) -+#define BIT_CLEAR_DDMACH4_DLEN_8822C(x) ((x) & (~BITS_DDMACH4_DLEN_8822C)) -+#define BIT_GET_DDMACH4_DLEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH4_DLEN_8822C) & BIT_MASK_DDMACH4_DLEN_8822C) -+#define BIT_SET_DDMACH4_DLEN_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH4_DLEN_8822C(x) | BIT_DDMACH4_DLEN_8822C(v)) -+ -+/* 2 REG_DDMA_CH5SA_8822C */ -+ -+#define BIT_SHIFT_DDMACH5_SA_8822C 0 -+#define BIT_MASK_DDMACH5_SA_8822C 0xffffffffL -+#define BIT_DDMACH5_SA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH5_SA_8822C) << BIT_SHIFT_DDMACH5_SA_8822C) -+#define BITS_DDMACH5_SA_8822C \ -+ (BIT_MASK_DDMACH5_SA_8822C << BIT_SHIFT_DDMACH5_SA_8822C) -+#define BIT_CLEAR_DDMACH5_SA_8822C(x) ((x) & (~BITS_DDMACH5_SA_8822C)) -+#define BIT_GET_DDMACH5_SA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_SA_8822C) & BIT_MASK_DDMACH5_SA_8822C) -+#define BIT_SET_DDMACH5_SA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH5_SA_8822C(x) | BIT_DDMACH5_SA_8822C(v)) -+ -+/* 2 REG_DDMA_CH5DA_8822C */ -+ -+#define BIT_SHIFT_DDMACH5_DA_8822C 0 -+#define BIT_MASK_DDMACH5_DA_8822C 0xffffffffL -+#define BIT_DDMACH5_DA_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH5_DA_8822C) << BIT_SHIFT_DDMACH5_DA_8822C) -+#define BITS_DDMACH5_DA_8822C \ -+ (BIT_MASK_DDMACH5_DA_8822C << BIT_SHIFT_DDMACH5_DA_8822C) -+#define BIT_CLEAR_DDMACH5_DA_8822C(x) ((x) & (~BITS_DDMACH5_DA_8822C)) -+#define BIT_GET_DDMACH5_DA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DA_8822C) & BIT_MASK_DDMACH5_DA_8822C) -+#define BIT_SET_DDMACH5_DA_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH5_DA_8822C(x) | BIT_DDMACH5_DA_8822C(v)) -+ -+/* 2 REG_DDMA_CH5CTRL_8822C */ -+#define BIT_DDMACH5_OWN_8822C BIT(31) -+#define BIT_DDMACH5_IDMEM_ERR_8822C BIT(30) -+#define BIT_DDMACH5_CHKSUM_EN_8822C BIT(29) -+#define BIT_DDMACH5_DA_W_DISABLE_8822C BIT(28) -+#define BIT_DDMACH5_CHKSUM_STS_8822C BIT(27) -+#define BIT_DDMACH5_DDMA_MODE_8822C BIT(26) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_DDMACH5_DLEN_8822C 0 -+#define BIT_MASK_DDMACH5_DLEN_8822C 0x3ffff -+#define BIT_DDMACH5_DLEN_8822C(x) \ -+ (((x) & BIT_MASK_DDMACH5_DLEN_8822C) << BIT_SHIFT_DDMACH5_DLEN_8822C) -+#define BITS_DDMACH5_DLEN_8822C \ -+ (BIT_MASK_DDMACH5_DLEN_8822C << BIT_SHIFT_DDMACH5_DLEN_8822C) -+#define BIT_CLEAR_DDMACH5_DLEN_8822C(x) ((x) & (~BITS_DDMACH5_DLEN_8822C)) -+#define BIT_GET_DDMACH5_DLEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_DDMACH5_DLEN_8822C) & BIT_MASK_DDMACH5_DLEN_8822C) -+#define BIT_SET_DDMACH5_DLEN_8822C(x, v) \ -+ (BIT_CLEAR_DDMACH5_DLEN_8822C(x) | BIT_DDMACH5_DLEN_8822C(v)) -+ -+/* 2 REG_DDMA_INT_MSK_8822C */ -+#define BIT_DDMACH5_MSK_8822C BIT(5) -+#define BIT_DDMACH4_MSK_8822C BIT(4) -+#define BIT_DDMACH3_MSK_8822C BIT(3) -+#define BIT_DDMACH2_MSK_8822C BIT(2) -+#define BIT_DDMACH1_MSK_8822C BIT(1) -+#define BIT_DDMACH0_MSK_8822C BIT(0) -+ -+/* 2 REG_DDMA_CHSTATUS_8822C */ -+#define BIT_DDMACH5_BUSY_8822C BIT(5) -+#define BIT_DDMACH4_BUSY_8822C BIT(4) -+#define BIT_DDMACH3_BUSY_8822C BIT(3) -+#define BIT_DDMACH2_BUSY_8822C BIT(2) -+#define BIT_DDMACH1_BUSY_8822C BIT(1) -+#define BIT_DDMACH0_BUSY_8822C BIT(0) -+ -+/* 2 REG_DDMA_CHKSUM_8822C */ -+ -+#define BIT_SHIFT_IDDMA0_CHKSUM_8822C 0 -+#define BIT_MASK_IDDMA0_CHKSUM_8822C 0xffff -+#define BIT_IDDMA0_CHKSUM_8822C(x) \ -+ (((x) & BIT_MASK_IDDMA0_CHKSUM_8822C) << BIT_SHIFT_IDDMA0_CHKSUM_8822C) -+#define BITS_IDDMA0_CHKSUM_8822C \ -+ (BIT_MASK_IDDMA0_CHKSUM_8822C << BIT_SHIFT_IDDMA0_CHKSUM_8822C) -+#define BIT_CLEAR_IDDMA0_CHKSUM_8822C(x) ((x) & (~BITS_IDDMA0_CHKSUM_8822C)) -+#define BIT_GET_IDDMA0_CHKSUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_IDDMA0_CHKSUM_8822C) & BIT_MASK_IDDMA0_CHKSUM_8822C) -+#define BIT_SET_IDDMA0_CHKSUM_8822C(x, v) \ -+ (BIT_CLEAR_IDDMA0_CHKSUM_8822C(x) | BIT_IDDMA0_CHKSUM_8822C(v)) -+ -+/* 2 REG_DDMA_MONITOR_8822C */ -+#define BIT_IDDMA0_PERMU_UNDERFLOW_8822C BIT(14) -+#define BIT_IDDMA0_FIFO_UNDERFLOW_8822C BIT(13) -+#define BIT_IDDMA0_FIFO_OVERFLOW_8822C BIT(12) -+#define BIT_CH5_ERR_8822C BIT(5) -+#define BIT_CH4_ERR_8822C BIT(4) -+#define BIT_CH3_ERR_8822C BIT(3) -+#define BIT_CH2_ERR_8822C BIT(2) -+#define BIT_CH1_ERR_8822C BIT(1) -+#define BIT_CH0_ERR_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_PCIE_CTRL_8822C */ -+#define BIT_PCIEIO_PERSTB_SEL_8822C BIT(31) -+ -+#define BIT_SHIFT_PCIE_MAX_RXDMA_8822C 28 -+#define BIT_MASK_PCIE_MAX_RXDMA_8822C 0x7 -+#define BIT_PCIE_MAX_RXDMA_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_RXDMA_8822C) \ -+ << BIT_SHIFT_PCIE_MAX_RXDMA_8822C) -+#define BITS_PCIE_MAX_RXDMA_8822C \ -+ (BIT_MASK_PCIE_MAX_RXDMA_8822C << BIT_SHIFT_PCIE_MAX_RXDMA_8822C) -+#define BIT_CLEAR_PCIE_MAX_RXDMA_8822C(x) ((x) & (~BITS_PCIE_MAX_RXDMA_8822C)) -+#define BIT_GET_PCIE_MAX_RXDMA_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_RXDMA_8822C) & \ -+ BIT_MASK_PCIE_MAX_RXDMA_8822C) -+#define BIT_SET_PCIE_MAX_RXDMA_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_RXDMA_8822C(x) | BIT_PCIE_MAX_RXDMA_8822C(v)) -+ -+#define BIT_SHIFT_PCIE_MAX_TXDMA_8822C 24 -+#define BIT_MASK_PCIE_MAX_TXDMA_8822C 0x7 -+#define BIT_PCIE_MAX_TXDMA_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_MAX_TXDMA_8822C) \ -+ << BIT_SHIFT_PCIE_MAX_TXDMA_8822C) -+#define BITS_PCIE_MAX_TXDMA_8822C \ -+ (BIT_MASK_PCIE_MAX_TXDMA_8822C << BIT_SHIFT_PCIE_MAX_TXDMA_8822C) -+#define BIT_CLEAR_PCIE_MAX_TXDMA_8822C(x) ((x) & (~BITS_PCIE_MAX_TXDMA_8822C)) -+#define BIT_GET_PCIE_MAX_TXDMA_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_MAX_TXDMA_8822C) & \ -+ BIT_MASK_PCIE_MAX_TXDMA_8822C) -+#define BIT_SET_PCIE_MAX_TXDMA_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_MAX_TXDMA_8822C(x) | BIT_PCIE_MAX_TXDMA_8822C(v)) -+ -+#define BIT_EN_CPL_TIMEOUT_PS_8822C BIT(22) -+#define BIT_REG_TXDMA_FAIL_PS_8822C BIT(21) -+#define BIT_PCIE_RST_TRXDMA_INTF_8822C BIT(20) -+#define BIT_EN_HWENTR_L1_8822C BIT(19) -+#define BIT_EN_ADV_CLKGATE_8822C BIT(18) -+#define BIT_PCIE_EN_SWENT_L23_8822C BIT(17) -+#define BIT_PCIE_EN_HWEXT_L1_8822C BIT(16) -+#define BIT_RX_CLOSE_EN_8822C BIT(15) -+#define BIT_STOP_BCNQ_8822C BIT(14) -+#define BIT_STOP_MGQ_8822C BIT(13) -+#define BIT_STOP_VOQ_8822C BIT(12) -+#define BIT_STOP_VIQ_8822C BIT(11) -+#define BIT_STOP_BEQ_8822C BIT(10) -+#define BIT_STOP_BKQ_8822C BIT(9) -+#define BIT_STOP_RXQ_8822C BIT(8) -+#define BIT_STOP_HI7Q_8822C BIT(7) -+#define BIT_STOP_HI6Q_8822C BIT(6) -+#define BIT_STOP_HI5Q_8822C BIT(5) -+#define BIT_STOP_HI4Q_8822C BIT(4) -+#define BIT_STOP_HI3Q_8822C BIT(3) -+#define BIT_STOP_HI2Q_8822C BIT(2) -+#define BIT_STOP_HI1Q_8822C BIT(1) -+#define BIT_STOP_HI0Q_8822C BIT(0) -+ -+/* 2 REG_INT_MIG_8822C */ -+ -+#define BIT_SHIFT_TRXCOUNTER_MATCH_8822C 24 -+#define BIT_MASK_TRXCOUNTER_MATCH_8822C 0xff -+#define BIT_TRXCOUNTER_MATCH_8822C(x) \ -+ (((x) & BIT_MASK_TRXCOUNTER_MATCH_8822C) \ -+ << BIT_SHIFT_TRXCOUNTER_MATCH_8822C) -+#define BITS_TRXCOUNTER_MATCH_8822C \ -+ (BIT_MASK_TRXCOUNTER_MATCH_8822C << BIT_SHIFT_TRXCOUNTER_MATCH_8822C) -+#define BIT_CLEAR_TRXCOUNTER_MATCH_8822C(x) \ -+ ((x) & (~BITS_TRXCOUNTER_MATCH_8822C)) -+#define BIT_GET_TRXCOUNTER_MATCH_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRXCOUNTER_MATCH_8822C) & \ -+ BIT_MASK_TRXCOUNTER_MATCH_8822C) -+#define BIT_SET_TRXCOUNTER_MATCH_8822C(x, v) \ -+ (BIT_CLEAR_TRXCOUNTER_MATCH_8822C(x) | BIT_TRXCOUNTER_MATCH_8822C(v)) -+ -+#define BIT_SHIFT_TRXTIMER_MATCH_8822C 16 -+#define BIT_MASK_TRXTIMER_MATCH_8822C 0xff -+#define BIT_TRXTIMER_MATCH_8822C(x) \ -+ (((x) & BIT_MASK_TRXTIMER_MATCH_8822C) \ -+ << BIT_SHIFT_TRXTIMER_MATCH_8822C) -+#define BITS_TRXTIMER_MATCH_8822C \ -+ (BIT_MASK_TRXTIMER_MATCH_8822C << BIT_SHIFT_TRXTIMER_MATCH_8822C) -+#define BIT_CLEAR_TRXTIMER_MATCH_8822C(x) ((x) & (~BITS_TRXTIMER_MATCH_8822C)) -+#define BIT_GET_TRXTIMER_MATCH_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRXTIMER_MATCH_8822C) & \ -+ BIT_MASK_TRXTIMER_MATCH_8822C) -+#define BIT_SET_TRXTIMER_MATCH_8822C(x, v) \ -+ (BIT_CLEAR_TRXTIMER_MATCH_8822C(x) | BIT_TRXTIMER_MATCH_8822C(v)) -+ -+#define BIT_SHIFT_TRXTIMER_UNIT_8822C 0 -+#define BIT_MASK_TRXTIMER_UNIT_8822C 0x3 -+#define BIT_TRXTIMER_UNIT_8822C(x) \ -+ (((x) & BIT_MASK_TRXTIMER_UNIT_8822C) << BIT_SHIFT_TRXTIMER_UNIT_8822C) -+#define BITS_TRXTIMER_UNIT_8822C \ -+ (BIT_MASK_TRXTIMER_UNIT_8822C << BIT_SHIFT_TRXTIMER_UNIT_8822C) -+#define BIT_CLEAR_TRXTIMER_UNIT_8822C(x) ((x) & (~BITS_TRXTIMER_UNIT_8822C)) -+#define BIT_GET_TRXTIMER_UNIT_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRXTIMER_UNIT_8822C) & BIT_MASK_TRXTIMER_UNIT_8822C) -+#define BIT_SET_TRXTIMER_UNIT_8822C(x, v) \ -+ (BIT_CLEAR_TRXTIMER_UNIT_8822C(x) | BIT_TRXTIMER_UNIT_8822C(v)) -+ -+/* 2 REG_BCNQ_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_BCNQ_TXBD_DESA_8822C 0 -+#define BIT_MASK_BCNQ_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_BCNQ_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_BCNQ_TXBD_DESA_8822C) \ -+ << BIT_SHIFT_BCNQ_TXBD_DESA_8822C) -+#define BITS_BCNQ_TXBD_DESA_8822C \ -+ (BIT_MASK_BCNQ_TXBD_DESA_8822C << BIT_SHIFT_BCNQ_TXBD_DESA_8822C) -+#define BIT_CLEAR_BCNQ_TXBD_DESA_8822C(x) ((x) & (~BITS_BCNQ_TXBD_DESA_8822C)) -+#define BIT_GET_BCNQ_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_TXBD_DESA_8822C) & \ -+ BIT_MASK_BCNQ_TXBD_DESA_8822C) -+#define BIT_SET_BCNQ_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_BCNQ_TXBD_DESA_8822C(x) | BIT_BCNQ_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_MGQ_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_MGQ_TXBD_DESA_8822C 0 -+#define BIT_MASK_MGQ_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_MGQ_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_TXBD_DESA_8822C) << BIT_SHIFT_MGQ_TXBD_DESA_8822C) -+#define BITS_MGQ_TXBD_DESA_8822C \ -+ (BIT_MASK_MGQ_TXBD_DESA_8822C << BIT_SHIFT_MGQ_TXBD_DESA_8822C) -+#define BIT_CLEAR_MGQ_TXBD_DESA_8822C(x) ((x) & (~BITS_MGQ_TXBD_DESA_8822C)) -+#define BIT_GET_MGQ_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_TXBD_DESA_8822C) & BIT_MASK_MGQ_TXBD_DESA_8822C) -+#define BIT_SET_MGQ_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_TXBD_DESA_8822C(x) | BIT_MGQ_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_VOQ_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_VOQ_TXBD_DESA_8822C 0 -+#define BIT_MASK_VOQ_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_VOQ_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_VOQ_TXBD_DESA_8822C) << BIT_SHIFT_VOQ_TXBD_DESA_8822C) -+#define BITS_VOQ_TXBD_DESA_8822C \ -+ (BIT_MASK_VOQ_TXBD_DESA_8822C << BIT_SHIFT_VOQ_TXBD_DESA_8822C) -+#define BIT_CLEAR_VOQ_TXBD_DESA_8822C(x) ((x) & (~BITS_VOQ_TXBD_DESA_8822C)) -+#define BIT_GET_VOQ_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_VOQ_TXBD_DESA_8822C) & BIT_MASK_VOQ_TXBD_DESA_8822C) -+#define BIT_SET_VOQ_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_VOQ_TXBD_DESA_8822C(x) | BIT_VOQ_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_VIQ_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_VIQ_TXBD_DESA_8822C 0 -+#define BIT_MASK_VIQ_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_VIQ_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_VIQ_TXBD_DESA_8822C) << BIT_SHIFT_VIQ_TXBD_DESA_8822C) -+#define BITS_VIQ_TXBD_DESA_8822C \ -+ (BIT_MASK_VIQ_TXBD_DESA_8822C << BIT_SHIFT_VIQ_TXBD_DESA_8822C) -+#define BIT_CLEAR_VIQ_TXBD_DESA_8822C(x) ((x) & (~BITS_VIQ_TXBD_DESA_8822C)) -+#define BIT_GET_VIQ_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_VIQ_TXBD_DESA_8822C) & BIT_MASK_VIQ_TXBD_DESA_8822C) -+#define BIT_SET_VIQ_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_VIQ_TXBD_DESA_8822C(x) | BIT_VIQ_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_BEQ_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_BEQ_TXBD_DESA_8822C 0 -+#define BIT_MASK_BEQ_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_BEQ_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_BEQ_TXBD_DESA_8822C) << BIT_SHIFT_BEQ_TXBD_DESA_8822C) -+#define BITS_BEQ_TXBD_DESA_8822C \ -+ (BIT_MASK_BEQ_TXBD_DESA_8822C << BIT_SHIFT_BEQ_TXBD_DESA_8822C) -+#define BIT_CLEAR_BEQ_TXBD_DESA_8822C(x) ((x) & (~BITS_BEQ_TXBD_DESA_8822C)) -+#define BIT_GET_BEQ_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_BEQ_TXBD_DESA_8822C) & BIT_MASK_BEQ_TXBD_DESA_8822C) -+#define BIT_SET_BEQ_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_BEQ_TXBD_DESA_8822C(x) | BIT_BEQ_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_BKQ_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_BKQ_TXBD_DESA_8822C 0 -+#define BIT_MASK_BKQ_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_BKQ_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_BKQ_TXBD_DESA_8822C) << BIT_SHIFT_BKQ_TXBD_DESA_8822C) -+#define BITS_BKQ_TXBD_DESA_8822C \ -+ (BIT_MASK_BKQ_TXBD_DESA_8822C << BIT_SHIFT_BKQ_TXBD_DESA_8822C) -+#define BIT_CLEAR_BKQ_TXBD_DESA_8822C(x) ((x) & (~BITS_BKQ_TXBD_DESA_8822C)) -+#define BIT_GET_BKQ_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_BKQ_TXBD_DESA_8822C) & BIT_MASK_BKQ_TXBD_DESA_8822C) -+#define BIT_SET_BKQ_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_BKQ_TXBD_DESA_8822C(x) | BIT_BKQ_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_RXQ_RXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_RXQ_RXBD_DESA_8822C 0 -+#define BIT_MASK_RXQ_RXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_RXQ_RXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_RXQ_RXBD_DESA_8822C) << BIT_SHIFT_RXQ_RXBD_DESA_8822C) -+#define BITS_RXQ_RXBD_DESA_8822C \ -+ (BIT_MASK_RXQ_RXBD_DESA_8822C << BIT_SHIFT_RXQ_RXBD_DESA_8822C) -+#define BIT_CLEAR_RXQ_RXBD_DESA_8822C(x) ((x) & (~BITS_RXQ_RXBD_DESA_8822C)) -+#define BIT_GET_RXQ_RXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXQ_RXBD_DESA_8822C) & BIT_MASK_RXQ_RXBD_DESA_8822C) -+#define BIT_SET_RXQ_RXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_RXQ_RXBD_DESA_8822C(x) | BIT_RXQ_RXBD_DESA_8822C(v)) -+ -+/* 2 REG_HI0Q_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_HI0Q_TXBD_DESA_8822C 0 -+#define BIT_MASK_HI0Q_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_HI0Q_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_HI0Q_TXBD_DESA_8822C) \ -+ << BIT_SHIFT_HI0Q_TXBD_DESA_8822C) -+#define BITS_HI0Q_TXBD_DESA_8822C \ -+ (BIT_MASK_HI0Q_TXBD_DESA_8822C << BIT_SHIFT_HI0Q_TXBD_DESA_8822C) -+#define BIT_CLEAR_HI0Q_TXBD_DESA_8822C(x) ((x) & (~BITS_HI0Q_TXBD_DESA_8822C)) -+#define BIT_GET_HI0Q_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_TXBD_DESA_8822C) & \ -+ BIT_MASK_HI0Q_TXBD_DESA_8822C) -+#define BIT_SET_HI0Q_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_HI0Q_TXBD_DESA_8822C(x) | BIT_HI0Q_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_HI1Q_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_HI1Q_TXBD_DESA_8822C 0 -+#define BIT_MASK_HI1Q_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_HI1Q_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_HI1Q_TXBD_DESA_8822C) \ -+ << BIT_SHIFT_HI1Q_TXBD_DESA_8822C) -+#define BITS_HI1Q_TXBD_DESA_8822C \ -+ (BIT_MASK_HI1Q_TXBD_DESA_8822C << BIT_SHIFT_HI1Q_TXBD_DESA_8822C) -+#define BIT_CLEAR_HI1Q_TXBD_DESA_8822C(x) ((x) & (~BITS_HI1Q_TXBD_DESA_8822C)) -+#define BIT_GET_HI1Q_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_TXBD_DESA_8822C) & \ -+ BIT_MASK_HI1Q_TXBD_DESA_8822C) -+#define BIT_SET_HI1Q_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_HI1Q_TXBD_DESA_8822C(x) | BIT_HI1Q_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_HI2Q_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_HI2Q_TXBD_DESA_8822C 0 -+#define BIT_MASK_HI2Q_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_HI2Q_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_HI2Q_TXBD_DESA_8822C) \ -+ << BIT_SHIFT_HI2Q_TXBD_DESA_8822C) -+#define BITS_HI2Q_TXBD_DESA_8822C \ -+ (BIT_MASK_HI2Q_TXBD_DESA_8822C << BIT_SHIFT_HI2Q_TXBD_DESA_8822C) -+#define BIT_CLEAR_HI2Q_TXBD_DESA_8822C(x) ((x) & (~BITS_HI2Q_TXBD_DESA_8822C)) -+#define BIT_GET_HI2Q_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_TXBD_DESA_8822C) & \ -+ BIT_MASK_HI2Q_TXBD_DESA_8822C) -+#define BIT_SET_HI2Q_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_HI2Q_TXBD_DESA_8822C(x) | BIT_HI2Q_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_HI3Q_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_HI3Q_TXBD_DESA_8822C 0 -+#define BIT_MASK_HI3Q_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_HI3Q_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_HI3Q_TXBD_DESA_8822C) \ -+ << BIT_SHIFT_HI3Q_TXBD_DESA_8822C) -+#define BITS_HI3Q_TXBD_DESA_8822C \ -+ (BIT_MASK_HI3Q_TXBD_DESA_8822C << BIT_SHIFT_HI3Q_TXBD_DESA_8822C) -+#define BIT_CLEAR_HI3Q_TXBD_DESA_8822C(x) ((x) & (~BITS_HI3Q_TXBD_DESA_8822C)) -+#define BIT_GET_HI3Q_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_TXBD_DESA_8822C) & \ -+ BIT_MASK_HI3Q_TXBD_DESA_8822C) -+#define BIT_SET_HI3Q_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_HI3Q_TXBD_DESA_8822C(x) | BIT_HI3Q_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_HI4Q_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_HI4Q_TXBD_DESA_8822C 0 -+#define BIT_MASK_HI4Q_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_HI4Q_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_HI4Q_TXBD_DESA_8822C) \ -+ << BIT_SHIFT_HI4Q_TXBD_DESA_8822C) -+#define BITS_HI4Q_TXBD_DESA_8822C \ -+ (BIT_MASK_HI4Q_TXBD_DESA_8822C << BIT_SHIFT_HI4Q_TXBD_DESA_8822C) -+#define BIT_CLEAR_HI4Q_TXBD_DESA_8822C(x) ((x) & (~BITS_HI4Q_TXBD_DESA_8822C)) -+#define BIT_GET_HI4Q_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_TXBD_DESA_8822C) & \ -+ BIT_MASK_HI4Q_TXBD_DESA_8822C) -+#define BIT_SET_HI4Q_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_HI4Q_TXBD_DESA_8822C(x) | BIT_HI4Q_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_HI5Q_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_HI5Q_TXBD_DESA_8822C 0 -+#define BIT_MASK_HI5Q_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_HI5Q_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_HI5Q_TXBD_DESA_8822C) \ -+ << BIT_SHIFT_HI5Q_TXBD_DESA_8822C) -+#define BITS_HI5Q_TXBD_DESA_8822C \ -+ (BIT_MASK_HI5Q_TXBD_DESA_8822C << BIT_SHIFT_HI5Q_TXBD_DESA_8822C) -+#define BIT_CLEAR_HI5Q_TXBD_DESA_8822C(x) ((x) & (~BITS_HI5Q_TXBD_DESA_8822C)) -+#define BIT_GET_HI5Q_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_TXBD_DESA_8822C) & \ -+ BIT_MASK_HI5Q_TXBD_DESA_8822C) -+#define BIT_SET_HI5Q_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_HI5Q_TXBD_DESA_8822C(x) | BIT_HI5Q_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_HI6Q_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_HI6Q_TXBD_DESA_8822C 0 -+#define BIT_MASK_HI6Q_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_HI6Q_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_HI6Q_TXBD_DESA_8822C) \ -+ << BIT_SHIFT_HI6Q_TXBD_DESA_8822C) -+#define BITS_HI6Q_TXBD_DESA_8822C \ -+ (BIT_MASK_HI6Q_TXBD_DESA_8822C << BIT_SHIFT_HI6Q_TXBD_DESA_8822C) -+#define BIT_CLEAR_HI6Q_TXBD_DESA_8822C(x) ((x) & (~BITS_HI6Q_TXBD_DESA_8822C)) -+#define BIT_GET_HI6Q_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_TXBD_DESA_8822C) & \ -+ BIT_MASK_HI6Q_TXBD_DESA_8822C) -+#define BIT_SET_HI6Q_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_HI6Q_TXBD_DESA_8822C(x) | BIT_HI6Q_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_HI7Q_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_HI7Q_TXBD_DESA_8822C 0 -+#define BIT_MASK_HI7Q_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_HI7Q_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_HI7Q_TXBD_DESA_8822C) \ -+ << BIT_SHIFT_HI7Q_TXBD_DESA_8822C) -+#define BITS_HI7Q_TXBD_DESA_8822C \ -+ (BIT_MASK_HI7Q_TXBD_DESA_8822C << BIT_SHIFT_HI7Q_TXBD_DESA_8822C) -+#define BIT_CLEAR_HI7Q_TXBD_DESA_8822C(x) ((x) & (~BITS_HI7Q_TXBD_DESA_8822C)) -+#define BIT_GET_HI7Q_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_TXBD_DESA_8822C) & \ -+ BIT_MASK_HI7Q_TXBD_DESA_8822C) -+#define BIT_SET_HI7Q_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_HI7Q_TXBD_DESA_8822C(x) | BIT_HI7Q_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_MGQ_TXBD_NUM_8822C */ -+#define BIT_PCIE_MGQ_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_MGQ_DESC_MODE_8822C 12 -+#define BIT_MASK_MGQ_DESC_MODE_8822C 0x3 -+#define BIT_MGQ_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_MODE_8822C) << BIT_SHIFT_MGQ_DESC_MODE_8822C) -+#define BITS_MGQ_DESC_MODE_8822C \ -+ (BIT_MASK_MGQ_DESC_MODE_8822C << BIT_SHIFT_MGQ_DESC_MODE_8822C) -+#define BIT_CLEAR_MGQ_DESC_MODE_8822C(x) ((x) & (~BITS_MGQ_DESC_MODE_8822C)) -+#define BIT_GET_MGQ_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_MODE_8822C) & BIT_MASK_MGQ_DESC_MODE_8822C) -+#define BIT_SET_MGQ_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_MODE_8822C(x) | BIT_MGQ_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_MGQ_DESC_NUM_8822C 0 -+#define BIT_MASK_MGQ_DESC_NUM_8822C 0xfff -+#define BIT_MGQ_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_DESC_NUM_8822C) << BIT_SHIFT_MGQ_DESC_NUM_8822C) -+#define BITS_MGQ_DESC_NUM_8822C \ -+ (BIT_MASK_MGQ_DESC_NUM_8822C << BIT_SHIFT_MGQ_DESC_NUM_8822C) -+#define BIT_CLEAR_MGQ_DESC_NUM_8822C(x) ((x) & (~BITS_MGQ_DESC_NUM_8822C)) -+#define BIT_GET_MGQ_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_DESC_NUM_8822C) & BIT_MASK_MGQ_DESC_NUM_8822C) -+#define BIT_SET_MGQ_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_DESC_NUM_8822C(x) | BIT_MGQ_DESC_NUM_8822C(v)) -+ -+/* 2 REG_RX_RXBD_NUM_8822C */ -+#define BIT_SYS_32_64_8822C BIT(15) -+ -+#define BIT_SHIFT_BCNQ_DESC_MODE_8822C 13 -+#define BIT_MASK_BCNQ_DESC_MODE_8822C 0x3 -+#define BIT_BCNQ_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_BCNQ_DESC_MODE_8822C) \ -+ << BIT_SHIFT_BCNQ_DESC_MODE_8822C) -+#define BITS_BCNQ_DESC_MODE_8822C \ -+ (BIT_MASK_BCNQ_DESC_MODE_8822C << BIT_SHIFT_BCNQ_DESC_MODE_8822C) -+#define BIT_CLEAR_BCNQ_DESC_MODE_8822C(x) ((x) & (~BITS_BCNQ_DESC_MODE_8822C)) -+#define BIT_GET_BCNQ_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_DESC_MODE_8822C) & \ -+ BIT_MASK_BCNQ_DESC_MODE_8822C) -+#define BIT_SET_BCNQ_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_BCNQ_DESC_MODE_8822C(x) | BIT_BCNQ_DESC_MODE_8822C(v)) -+ -+#define BIT_PCIE_BCNQ_FLAG_8822C BIT(12) -+ -+#define BIT_SHIFT_RXQ_DESC_NUM_8822C 0 -+#define BIT_MASK_RXQ_DESC_NUM_8822C 0xfff -+#define BIT_RXQ_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_RXQ_DESC_NUM_8822C) << BIT_SHIFT_RXQ_DESC_NUM_8822C) -+#define BITS_RXQ_DESC_NUM_8822C \ -+ (BIT_MASK_RXQ_DESC_NUM_8822C << BIT_SHIFT_RXQ_DESC_NUM_8822C) -+#define BIT_CLEAR_RXQ_DESC_NUM_8822C(x) ((x) & (~BITS_RXQ_DESC_NUM_8822C)) -+#define BIT_GET_RXQ_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXQ_DESC_NUM_8822C) & BIT_MASK_RXQ_DESC_NUM_8822C) -+#define BIT_SET_RXQ_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_RXQ_DESC_NUM_8822C(x) | BIT_RXQ_DESC_NUM_8822C(v)) -+ -+/* 2 REG_VOQ_TXBD_NUM_8822C */ -+#define BIT_PCIE_VOQ_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_VOQ_DESC_MODE_8822C 12 -+#define BIT_MASK_VOQ_DESC_MODE_8822C 0x3 -+#define BIT_VOQ_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_MODE_8822C) << BIT_SHIFT_VOQ_DESC_MODE_8822C) -+#define BITS_VOQ_DESC_MODE_8822C \ -+ (BIT_MASK_VOQ_DESC_MODE_8822C << BIT_SHIFT_VOQ_DESC_MODE_8822C) -+#define BIT_CLEAR_VOQ_DESC_MODE_8822C(x) ((x) & (~BITS_VOQ_DESC_MODE_8822C)) -+#define BIT_GET_VOQ_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_MODE_8822C) & BIT_MASK_VOQ_DESC_MODE_8822C) -+#define BIT_SET_VOQ_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_MODE_8822C(x) | BIT_VOQ_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_VOQ_DESC_NUM_8822C 0 -+#define BIT_MASK_VOQ_DESC_NUM_8822C 0xfff -+#define BIT_VOQ_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_VOQ_DESC_NUM_8822C) << BIT_SHIFT_VOQ_DESC_NUM_8822C) -+#define BITS_VOQ_DESC_NUM_8822C \ -+ (BIT_MASK_VOQ_DESC_NUM_8822C << BIT_SHIFT_VOQ_DESC_NUM_8822C) -+#define BIT_CLEAR_VOQ_DESC_NUM_8822C(x) ((x) & (~BITS_VOQ_DESC_NUM_8822C)) -+#define BIT_GET_VOQ_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_VOQ_DESC_NUM_8822C) & BIT_MASK_VOQ_DESC_NUM_8822C) -+#define BIT_SET_VOQ_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_VOQ_DESC_NUM_8822C(x) | BIT_VOQ_DESC_NUM_8822C(v)) -+ -+/* 2 REG_VIQ_TXBD_NUM_8822C */ -+#define BIT_PCIE_VIQ_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_VIQ_DESC_MODE_8822C 12 -+#define BIT_MASK_VIQ_DESC_MODE_8822C 0x3 -+#define BIT_VIQ_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_MODE_8822C) << BIT_SHIFT_VIQ_DESC_MODE_8822C) -+#define BITS_VIQ_DESC_MODE_8822C \ -+ (BIT_MASK_VIQ_DESC_MODE_8822C << BIT_SHIFT_VIQ_DESC_MODE_8822C) -+#define BIT_CLEAR_VIQ_DESC_MODE_8822C(x) ((x) & (~BITS_VIQ_DESC_MODE_8822C)) -+#define BIT_GET_VIQ_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_MODE_8822C) & BIT_MASK_VIQ_DESC_MODE_8822C) -+#define BIT_SET_VIQ_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_MODE_8822C(x) | BIT_VIQ_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_VIQ_DESC_NUM_8822C 0 -+#define BIT_MASK_VIQ_DESC_NUM_8822C 0xfff -+#define BIT_VIQ_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_VIQ_DESC_NUM_8822C) << BIT_SHIFT_VIQ_DESC_NUM_8822C) -+#define BITS_VIQ_DESC_NUM_8822C \ -+ (BIT_MASK_VIQ_DESC_NUM_8822C << BIT_SHIFT_VIQ_DESC_NUM_8822C) -+#define BIT_CLEAR_VIQ_DESC_NUM_8822C(x) ((x) & (~BITS_VIQ_DESC_NUM_8822C)) -+#define BIT_GET_VIQ_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_VIQ_DESC_NUM_8822C) & BIT_MASK_VIQ_DESC_NUM_8822C) -+#define BIT_SET_VIQ_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_VIQ_DESC_NUM_8822C(x) | BIT_VIQ_DESC_NUM_8822C(v)) -+ -+/* 2 REG_BEQ_TXBD_NUM_8822C */ -+#define BIT_PCIE_BEQ_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_BEQ_DESC_MODE_8822C 12 -+#define BIT_MASK_BEQ_DESC_MODE_8822C 0x3 -+#define BIT_BEQ_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_MODE_8822C) << BIT_SHIFT_BEQ_DESC_MODE_8822C) -+#define BITS_BEQ_DESC_MODE_8822C \ -+ (BIT_MASK_BEQ_DESC_MODE_8822C << BIT_SHIFT_BEQ_DESC_MODE_8822C) -+#define BIT_CLEAR_BEQ_DESC_MODE_8822C(x) ((x) & (~BITS_BEQ_DESC_MODE_8822C)) -+#define BIT_GET_BEQ_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_MODE_8822C) & BIT_MASK_BEQ_DESC_MODE_8822C) -+#define BIT_SET_BEQ_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_MODE_8822C(x) | BIT_BEQ_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_BEQ_DESC_NUM_8822C 0 -+#define BIT_MASK_BEQ_DESC_NUM_8822C 0xfff -+#define BIT_BEQ_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_BEQ_DESC_NUM_8822C) << BIT_SHIFT_BEQ_DESC_NUM_8822C) -+#define BITS_BEQ_DESC_NUM_8822C \ -+ (BIT_MASK_BEQ_DESC_NUM_8822C << BIT_SHIFT_BEQ_DESC_NUM_8822C) -+#define BIT_CLEAR_BEQ_DESC_NUM_8822C(x) ((x) & (~BITS_BEQ_DESC_NUM_8822C)) -+#define BIT_GET_BEQ_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_BEQ_DESC_NUM_8822C) & BIT_MASK_BEQ_DESC_NUM_8822C) -+#define BIT_SET_BEQ_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_BEQ_DESC_NUM_8822C(x) | BIT_BEQ_DESC_NUM_8822C(v)) -+ -+/* 2 REG_BKQ_TXBD_NUM_8822C */ -+#define BIT_PCIE_BKQ_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_BKQ_DESC_MODE_8822C 12 -+#define BIT_MASK_BKQ_DESC_MODE_8822C 0x3 -+#define BIT_BKQ_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_MODE_8822C) << BIT_SHIFT_BKQ_DESC_MODE_8822C) -+#define BITS_BKQ_DESC_MODE_8822C \ -+ (BIT_MASK_BKQ_DESC_MODE_8822C << BIT_SHIFT_BKQ_DESC_MODE_8822C) -+#define BIT_CLEAR_BKQ_DESC_MODE_8822C(x) ((x) & (~BITS_BKQ_DESC_MODE_8822C)) -+#define BIT_GET_BKQ_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_MODE_8822C) & BIT_MASK_BKQ_DESC_MODE_8822C) -+#define BIT_SET_BKQ_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_MODE_8822C(x) | BIT_BKQ_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_BKQ_DESC_NUM_8822C 0 -+#define BIT_MASK_BKQ_DESC_NUM_8822C 0xfff -+#define BIT_BKQ_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_BKQ_DESC_NUM_8822C) << BIT_SHIFT_BKQ_DESC_NUM_8822C) -+#define BITS_BKQ_DESC_NUM_8822C \ -+ (BIT_MASK_BKQ_DESC_NUM_8822C << BIT_SHIFT_BKQ_DESC_NUM_8822C) -+#define BIT_CLEAR_BKQ_DESC_NUM_8822C(x) ((x) & (~BITS_BKQ_DESC_NUM_8822C)) -+#define BIT_GET_BKQ_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_BKQ_DESC_NUM_8822C) & BIT_MASK_BKQ_DESC_NUM_8822C) -+#define BIT_SET_BKQ_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_BKQ_DESC_NUM_8822C(x) | BIT_BKQ_DESC_NUM_8822C(v)) -+ -+/* 2 REG_HI0Q_TXBD_NUM_8822C */ -+#define BIT_HI0Q_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_HI0Q_DESC_MODE_8822C 12 -+#define BIT_MASK_HI0Q_DESC_MODE_8822C 0x3 -+#define BIT_HI0Q_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_MODE_8822C) \ -+ << BIT_SHIFT_HI0Q_DESC_MODE_8822C) -+#define BITS_HI0Q_DESC_MODE_8822C \ -+ (BIT_MASK_HI0Q_DESC_MODE_8822C << BIT_SHIFT_HI0Q_DESC_MODE_8822C) -+#define BIT_CLEAR_HI0Q_DESC_MODE_8822C(x) ((x) & (~BITS_HI0Q_DESC_MODE_8822C)) -+#define BIT_GET_HI0Q_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_MODE_8822C) & \ -+ BIT_MASK_HI0Q_DESC_MODE_8822C) -+#define BIT_SET_HI0Q_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_MODE_8822C(x) | BIT_HI0Q_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_HI0Q_DESC_NUM_8822C 0 -+#define BIT_MASK_HI0Q_DESC_NUM_8822C 0xfff -+#define BIT_HI0Q_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_HI0Q_DESC_NUM_8822C) << BIT_SHIFT_HI0Q_DESC_NUM_8822C) -+#define BITS_HI0Q_DESC_NUM_8822C \ -+ (BIT_MASK_HI0Q_DESC_NUM_8822C << BIT_SHIFT_HI0Q_DESC_NUM_8822C) -+#define BIT_CLEAR_HI0Q_DESC_NUM_8822C(x) ((x) & (~BITS_HI0Q_DESC_NUM_8822C)) -+#define BIT_GET_HI0Q_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_DESC_NUM_8822C) & BIT_MASK_HI0Q_DESC_NUM_8822C) -+#define BIT_SET_HI0Q_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_HI0Q_DESC_NUM_8822C(x) | BIT_HI0Q_DESC_NUM_8822C(v)) -+ -+/* 2 REG_HI1Q_TXBD_NUM_8822C */ -+#define BIT_HI1Q_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_HI1Q_DESC_MODE_8822C 12 -+#define BIT_MASK_HI1Q_DESC_MODE_8822C 0x3 -+#define BIT_HI1Q_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_MODE_8822C) \ -+ << BIT_SHIFT_HI1Q_DESC_MODE_8822C) -+#define BITS_HI1Q_DESC_MODE_8822C \ -+ (BIT_MASK_HI1Q_DESC_MODE_8822C << BIT_SHIFT_HI1Q_DESC_MODE_8822C) -+#define BIT_CLEAR_HI1Q_DESC_MODE_8822C(x) ((x) & (~BITS_HI1Q_DESC_MODE_8822C)) -+#define BIT_GET_HI1Q_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_MODE_8822C) & \ -+ BIT_MASK_HI1Q_DESC_MODE_8822C) -+#define BIT_SET_HI1Q_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_MODE_8822C(x) | BIT_HI1Q_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_HI1Q_DESC_NUM_8822C 0 -+#define BIT_MASK_HI1Q_DESC_NUM_8822C 0xfff -+#define BIT_HI1Q_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_HI1Q_DESC_NUM_8822C) << BIT_SHIFT_HI1Q_DESC_NUM_8822C) -+#define BITS_HI1Q_DESC_NUM_8822C \ -+ (BIT_MASK_HI1Q_DESC_NUM_8822C << BIT_SHIFT_HI1Q_DESC_NUM_8822C) -+#define BIT_CLEAR_HI1Q_DESC_NUM_8822C(x) ((x) & (~BITS_HI1Q_DESC_NUM_8822C)) -+#define BIT_GET_HI1Q_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_DESC_NUM_8822C) & BIT_MASK_HI1Q_DESC_NUM_8822C) -+#define BIT_SET_HI1Q_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_HI1Q_DESC_NUM_8822C(x) | BIT_HI1Q_DESC_NUM_8822C(v)) -+ -+/* 2 REG_HI2Q_TXBD_NUM_8822C */ -+#define BIT_HI2Q_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_HI2Q_DESC_MODE_8822C 12 -+#define BIT_MASK_HI2Q_DESC_MODE_8822C 0x3 -+#define BIT_HI2Q_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_MODE_8822C) \ -+ << BIT_SHIFT_HI2Q_DESC_MODE_8822C) -+#define BITS_HI2Q_DESC_MODE_8822C \ -+ (BIT_MASK_HI2Q_DESC_MODE_8822C << BIT_SHIFT_HI2Q_DESC_MODE_8822C) -+#define BIT_CLEAR_HI2Q_DESC_MODE_8822C(x) ((x) & (~BITS_HI2Q_DESC_MODE_8822C)) -+#define BIT_GET_HI2Q_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_MODE_8822C) & \ -+ BIT_MASK_HI2Q_DESC_MODE_8822C) -+#define BIT_SET_HI2Q_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_MODE_8822C(x) | BIT_HI2Q_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_HI2Q_DESC_NUM_8822C 0 -+#define BIT_MASK_HI2Q_DESC_NUM_8822C 0xfff -+#define BIT_HI2Q_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_HI2Q_DESC_NUM_8822C) << BIT_SHIFT_HI2Q_DESC_NUM_8822C) -+#define BITS_HI2Q_DESC_NUM_8822C \ -+ (BIT_MASK_HI2Q_DESC_NUM_8822C << BIT_SHIFT_HI2Q_DESC_NUM_8822C) -+#define BIT_CLEAR_HI2Q_DESC_NUM_8822C(x) ((x) & (~BITS_HI2Q_DESC_NUM_8822C)) -+#define BIT_GET_HI2Q_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_DESC_NUM_8822C) & BIT_MASK_HI2Q_DESC_NUM_8822C) -+#define BIT_SET_HI2Q_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_HI2Q_DESC_NUM_8822C(x) | BIT_HI2Q_DESC_NUM_8822C(v)) -+ -+/* 2 REG_HI3Q_TXBD_NUM_8822C */ -+#define BIT_HI3Q_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_HI3Q_DESC_MODE_8822C 12 -+#define BIT_MASK_HI3Q_DESC_MODE_8822C 0x3 -+#define BIT_HI3Q_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_MODE_8822C) \ -+ << BIT_SHIFT_HI3Q_DESC_MODE_8822C) -+#define BITS_HI3Q_DESC_MODE_8822C \ -+ (BIT_MASK_HI3Q_DESC_MODE_8822C << BIT_SHIFT_HI3Q_DESC_MODE_8822C) -+#define BIT_CLEAR_HI3Q_DESC_MODE_8822C(x) ((x) & (~BITS_HI3Q_DESC_MODE_8822C)) -+#define BIT_GET_HI3Q_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_MODE_8822C) & \ -+ BIT_MASK_HI3Q_DESC_MODE_8822C) -+#define BIT_SET_HI3Q_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_MODE_8822C(x) | BIT_HI3Q_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_HI3Q_DESC_NUM_8822C 0 -+#define BIT_MASK_HI3Q_DESC_NUM_8822C 0xfff -+#define BIT_HI3Q_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_HI3Q_DESC_NUM_8822C) << BIT_SHIFT_HI3Q_DESC_NUM_8822C) -+#define BITS_HI3Q_DESC_NUM_8822C \ -+ (BIT_MASK_HI3Q_DESC_NUM_8822C << BIT_SHIFT_HI3Q_DESC_NUM_8822C) -+#define BIT_CLEAR_HI3Q_DESC_NUM_8822C(x) ((x) & (~BITS_HI3Q_DESC_NUM_8822C)) -+#define BIT_GET_HI3Q_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_DESC_NUM_8822C) & BIT_MASK_HI3Q_DESC_NUM_8822C) -+#define BIT_SET_HI3Q_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_HI3Q_DESC_NUM_8822C(x) | BIT_HI3Q_DESC_NUM_8822C(v)) -+ -+/* 2 REG_HI4Q_TXBD_NUM_8822C */ -+#define BIT_HI4Q_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_HI4Q_DESC_MODE_8822C 12 -+#define BIT_MASK_HI4Q_DESC_MODE_8822C 0x3 -+#define BIT_HI4Q_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_MODE_8822C) \ -+ << BIT_SHIFT_HI4Q_DESC_MODE_8822C) -+#define BITS_HI4Q_DESC_MODE_8822C \ -+ (BIT_MASK_HI4Q_DESC_MODE_8822C << BIT_SHIFT_HI4Q_DESC_MODE_8822C) -+#define BIT_CLEAR_HI4Q_DESC_MODE_8822C(x) ((x) & (~BITS_HI4Q_DESC_MODE_8822C)) -+#define BIT_GET_HI4Q_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_MODE_8822C) & \ -+ BIT_MASK_HI4Q_DESC_MODE_8822C) -+#define BIT_SET_HI4Q_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_MODE_8822C(x) | BIT_HI4Q_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_HI4Q_DESC_NUM_8822C 0 -+#define BIT_MASK_HI4Q_DESC_NUM_8822C 0xfff -+#define BIT_HI4Q_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_HI4Q_DESC_NUM_8822C) << BIT_SHIFT_HI4Q_DESC_NUM_8822C) -+#define BITS_HI4Q_DESC_NUM_8822C \ -+ (BIT_MASK_HI4Q_DESC_NUM_8822C << BIT_SHIFT_HI4Q_DESC_NUM_8822C) -+#define BIT_CLEAR_HI4Q_DESC_NUM_8822C(x) ((x) & (~BITS_HI4Q_DESC_NUM_8822C)) -+#define BIT_GET_HI4Q_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_DESC_NUM_8822C) & BIT_MASK_HI4Q_DESC_NUM_8822C) -+#define BIT_SET_HI4Q_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_HI4Q_DESC_NUM_8822C(x) | BIT_HI4Q_DESC_NUM_8822C(v)) -+ -+/* 2 REG_HI5Q_TXBD_NUM_8822C */ -+#define BIT_HI5Q_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_HI5Q_DESC_MODE_8822C 12 -+#define BIT_MASK_HI5Q_DESC_MODE_8822C 0x3 -+#define BIT_HI5Q_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_MODE_8822C) \ -+ << BIT_SHIFT_HI5Q_DESC_MODE_8822C) -+#define BITS_HI5Q_DESC_MODE_8822C \ -+ (BIT_MASK_HI5Q_DESC_MODE_8822C << BIT_SHIFT_HI5Q_DESC_MODE_8822C) -+#define BIT_CLEAR_HI5Q_DESC_MODE_8822C(x) ((x) & (~BITS_HI5Q_DESC_MODE_8822C)) -+#define BIT_GET_HI5Q_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_MODE_8822C) & \ -+ BIT_MASK_HI5Q_DESC_MODE_8822C) -+#define BIT_SET_HI5Q_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_MODE_8822C(x) | BIT_HI5Q_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_HI5Q_DESC_NUM_8822C 0 -+#define BIT_MASK_HI5Q_DESC_NUM_8822C 0xfff -+#define BIT_HI5Q_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_HI5Q_DESC_NUM_8822C) << BIT_SHIFT_HI5Q_DESC_NUM_8822C) -+#define BITS_HI5Q_DESC_NUM_8822C \ -+ (BIT_MASK_HI5Q_DESC_NUM_8822C << BIT_SHIFT_HI5Q_DESC_NUM_8822C) -+#define BIT_CLEAR_HI5Q_DESC_NUM_8822C(x) ((x) & (~BITS_HI5Q_DESC_NUM_8822C)) -+#define BIT_GET_HI5Q_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_DESC_NUM_8822C) & BIT_MASK_HI5Q_DESC_NUM_8822C) -+#define BIT_SET_HI5Q_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_HI5Q_DESC_NUM_8822C(x) | BIT_HI5Q_DESC_NUM_8822C(v)) -+ -+/* 2 REG_HI6Q_TXBD_NUM_8822C */ -+#define BIT_HI6Q_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_HI6Q_DESC_MODE_8822C 12 -+#define BIT_MASK_HI6Q_DESC_MODE_8822C 0x3 -+#define BIT_HI6Q_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_MODE_8822C) \ -+ << BIT_SHIFT_HI6Q_DESC_MODE_8822C) -+#define BITS_HI6Q_DESC_MODE_8822C \ -+ (BIT_MASK_HI6Q_DESC_MODE_8822C << BIT_SHIFT_HI6Q_DESC_MODE_8822C) -+#define BIT_CLEAR_HI6Q_DESC_MODE_8822C(x) ((x) & (~BITS_HI6Q_DESC_MODE_8822C)) -+#define BIT_GET_HI6Q_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_MODE_8822C) & \ -+ BIT_MASK_HI6Q_DESC_MODE_8822C) -+#define BIT_SET_HI6Q_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_MODE_8822C(x) | BIT_HI6Q_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_HI6Q_DESC_NUM_8822C 0 -+#define BIT_MASK_HI6Q_DESC_NUM_8822C 0xfff -+#define BIT_HI6Q_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_HI6Q_DESC_NUM_8822C) << BIT_SHIFT_HI6Q_DESC_NUM_8822C) -+#define BITS_HI6Q_DESC_NUM_8822C \ -+ (BIT_MASK_HI6Q_DESC_NUM_8822C << BIT_SHIFT_HI6Q_DESC_NUM_8822C) -+#define BIT_CLEAR_HI6Q_DESC_NUM_8822C(x) ((x) & (~BITS_HI6Q_DESC_NUM_8822C)) -+#define BIT_GET_HI6Q_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_DESC_NUM_8822C) & BIT_MASK_HI6Q_DESC_NUM_8822C) -+#define BIT_SET_HI6Q_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_HI6Q_DESC_NUM_8822C(x) | BIT_HI6Q_DESC_NUM_8822C(v)) -+ -+/* 2 REG_HI7Q_TXBD_NUM_8822C */ -+#define BIT_HI7Q_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_HI7Q_DESC_MODE_8822C 12 -+#define BIT_MASK_HI7Q_DESC_MODE_8822C 0x3 -+#define BIT_HI7Q_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_MODE_8822C) \ -+ << BIT_SHIFT_HI7Q_DESC_MODE_8822C) -+#define BITS_HI7Q_DESC_MODE_8822C \ -+ (BIT_MASK_HI7Q_DESC_MODE_8822C << BIT_SHIFT_HI7Q_DESC_MODE_8822C) -+#define BIT_CLEAR_HI7Q_DESC_MODE_8822C(x) ((x) & (~BITS_HI7Q_DESC_MODE_8822C)) -+#define BIT_GET_HI7Q_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_MODE_8822C) & \ -+ BIT_MASK_HI7Q_DESC_MODE_8822C) -+#define BIT_SET_HI7Q_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_MODE_8822C(x) | BIT_HI7Q_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_HI7Q_DESC_NUM_8822C 0 -+#define BIT_MASK_HI7Q_DESC_NUM_8822C 0xfff -+#define BIT_HI7Q_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_HI7Q_DESC_NUM_8822C) << BIT_SHIFT_HI7Q_DESC_NUM_8822C) -+#define BITS_HI7Q_DESC_NUM_8822C \ -+ (BIT_MASK_HI7Q_DESC_NUM_8822C << BIT_SHIFT_HI7Q_DESC_NUM_8822C) -+#define BIT_CLEAR_HI7Q_DESC_NUM_8822C(x) ((x) & (~BITS_HI7Q_DESC_NUM_8822C)) -+#define BIT_GET_HI7Q_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_DESC_NUM_8822C) & BIT_MASK_HI7Q_DESC_NUM_8822C) -+#define BIT_SET_HI7Q_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_HI7Q_DESC_NUM_8822C(x) | BIT_HI7Q_DESC_NUM_8822C(v)) -+ -+/* 2 REG_TSFTIMER_HCI_8822C */ -+ -+#define BIT_SHIFT_TSFT2_HCI_8822C 16 -+#define BIT_MASK_TSFT2_HCI_8822C 0xffff -+#define BIT_TSFT2_HCI_8822C(x) \ -+ (((x) & BIT_MASK_TSFT2_HCI_8822C) << BIT_SHIFT_TSFT2_HCI_8822C) -+#define BITS_TSFT2_HCI_8822C \ -+ (BIT_MASK_TSFT2_HCI_8822C << BIT_SHIFT_TSFT2_HCI_8822C) -+#define BIT_CLEAR_TSFT2_HCI_8822C(x) ((x) & (~BITS_TSFT2_HCI_8822C)) -+#define BIT_GET_TSFT2_HCI_8822C(x) \ -+ (((x) >> BIT_SHIFT_TSFT2_HCI_8822C) & BIT_MASK_TSFT2_HCI_8822C) -+#define BIT_SET_TSFT2_HCI_8822C(x, v) \ -+ (BIT_CLEAR_TSFT2_HCI_8822C(x) | BIT_TSFT2_HCI_8822C(v)) -+ -+#define BIT_SHIFT_TSFT1_HCI_8822C 0 -+#define BIT_MASK_TSFT1_HCI_8822C 0xffff -+#define BIT_TSFT1_HCI_8822C(x) \ -+ (((x) & BIT_MASK_TSFT1_HCI_8822C) << BIT_SHIFT_TSFT1_HCI_8822C) -+#define BITS_TSFT1_HCI_8822C \ -+ (BIT_MASK_TSFT1_HCI_8822C << BIT_SHIFT_TSFT1_HCI_8822C) -+#define BIT_CLEAR_TSFT1_HCI_8822C(x) ((x) & (~BITS_TSFT1_HCI_8822C)) -+#define BIT_GET_TSFT1_HCI_8822C(x) \ -+ (((x) >> BIT_SHIFT_TSFT1_HCI_8822C) & BIT_MASK_TSFT1_HCI_8822C) -+#define BIT_SET_TSFT1_HCI_8822C(x, v) \ -+ (BIT_CLEAR_TSFT1_HCI_8822C(x) | BIT_TSFT1_HCI_8822C(v)) -+ -+/* 2 REG_BD_RWPTR_CLR_8822C */ -+#define BIT_CLR_HI7Q_HW_IDX_8822C BIT(29) -+#define BIT_CLR_HI6Q_HW_IDX_8822C BIT(28) -+#define BIT_CLR_HI5Q_HW_IDX_8822C BIT(27) -+#define BIT_CLR_HI4Q_HW_IDX_8822C BIT(26) -+#define BIT_CLR_HI3Q_HW_IDX_8822C BIT(25) -+#define BIT_CLR_HI2Q_HW_IDX_8822C BIT(24) -+#define BIT_CLR_HI1Q_HW_IDX_8822C BIT(23) -+#define BIT_CLR_HI0Q_HW_IDX_8822C BIT(22) -+#define BIT_CLR_BKQ_HW_IDX_8822C BIT(21) -+#define BIT_CLR_BEQ_HW_IDX_8822C BIT(20) -+#define BIT_CLR_VIQ_HW_IDX_8822C BIT(19) -+#define BIT_CLR_VOQ_HW_IDX_8822C BIT(18) -+#define BIT_CLR_MGQ_HW_IDX_8822C BIT(17) -+#define BIT_CLR_RXQ_HW_IDX_8822C BIT(16) -+#define BIT_CLR_HI7Q_HOST_IDX_8822C BIT(13) -+#define BIT_CLR_HI6Q_HOST_IDX_8822C BIT(12) -+#define BIT_CLR_HI5Q_HOST_IDX_8822C BIT(11) -+#define BIT_CLR_HI4Q_HOST_IDX_8822C BIT(10) -+#define BIT_CLR_HI3Q_HOST_IDX_8822C BIT(9) -+#define BIT_CLR_HI2Q_HOST_IDX_8822C BIT(8) -+#define BIT_CLR_HI1Q_HOST_IDX_8822C BIT(7) -+#define BIT_CLR_HI0Q_HOST_IDX_8822C BIT(6) -+#define BIT_CLR_BKQ_HOST_IDX_8822C BIT(5) -+#define BIT_CLR_BEQ_HOST_IDX_8822C BIT(4) -+#define BIT_CLR_VIQ_HOST_IDX_8822C BIT(3) -+#define BIT_CLR_VOQ_HOST_IDX_8822C BIT(2) -+#define BIT_CLR_MGQ_HOST_IDX_8822C BIT(1) -+#define BIT_CLR_RXQ_HOST_IDX_8822C BIT(0) -+ -+/* 2 REG_VOQ_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_VOQ_HW_IDX_8822C 16 -+#define BIT_MASK_VOQ_HW_IDX_8822C 0xfff -+#define BIT_VOQ_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_VOQ_HW_IDX_8822C) << BIT_SHIFT_VOQ_HW_IDX_8822C) -+#define BITS_VOQ_HW_IDX_8822C \ -+ (BIT_MASK_VOQ_HW_IDX_8822C << BIT_SHIFT_VOQ_HW_IDX_8822C) -+#define BIT_CLEAR_VOQ_HW_IDX_8822C(x) ((x) & (~BITS_VOQ_HW_IDX_8822C)) -+#define BIT_GET_VOQ_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HW_IDX_8822C) & BIT_MASK_VOQ_HW_IDX_8822C) -+#define BIT_SET_VOQ_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_VOQ_HW_IDX_8822C(x) | BIT_VOQ_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_VOQ_HOST_IDX_8822C 0 -+#define BIT_MASK_VOQ_HOST_IDX_8822C 0xfff -+#define BIT_VOQ_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_VOQ_HOST_IDX_8822C) << BIT_SHIFT_VOQ_HOST_IDX_8822C) -+#define BITS_VOQ_HOST_IDX_8822C \ -+ (BIT_MASK_VOQ_HOST_IDX_8822C << BIT_SHIFT_VOQ_HOST_IDX_8822C) -+#define BIT_CLEAR_VOQ_HOST_IDX_8822C(x) ((x) & (~BITS_VOQ_HOST_IDX_8822C)) -+#define BIT_GET_VOQ_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_VOQ_HOST_IDX_8822C) & BIT_MASK_VOQ_HOST_IDX_8822C) -+#define BIT_SET_VOQ_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_VOQ_HOST_IDX_8822C(x) | BIT_VOQ_HOST_IDX_8822C(v)) -+ -+/* 2 REG_VIQ_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_VIQ_HW_IDX_8822C 16 -+#define BIT_MASK_VIQ_HW_IDX_8822C 0xfff -+#define BIT_VIQ_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_VIQ_HW_IDX_8822C) << BIT_SHIFT_VIQ_HW_IDX_8822C) -+#define BITS_VIQ_HW_IDX_8822C \ -+ (BIT_MASK_VIQ_HW_IDX_8822C << BIT_SHIFT_VIQ_HW_IDX_8822C) -+#define BIT_CLEAR_VIQ_HW_IDX_8822C(x) ((x) & (~BITS_VIQ_HW_IDX_8822C)) -+#define BIT_GET_VIQ_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HW_IDX_8822C) & BIT_MASK_VIQ_HW_IDX_8822C) -+#define BIT_SET_VIQ_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_VIQ_HW_IDX_8822C(x) | BIT_VIQ_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_VIQ_HOST_IDX_8822C 0 -+#define BIT_MASK_VIQ_HOST_IDX_8822C 0xfff -+#define BIT_VIQ_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_VIQ_HOST_IDX_8822C) << BIT_SHIFT_VIQ_HOST_IDX_8822C) -+#define BITS_VIQ_HOST_IDX_8822C \ -+ (BIT_MASK_VIQ_HOST_IDX_8822C << BIT_SHIFT_VIQ_HOST_IDX_8822C) -+#define BIT_CLEAR_VIQ_HOST_IDX_8822C(x) ((x) & (~BITS_VIQ_HOST_IDX_8822C)) -+#define BIT_GET_VIQ_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_VIQ_HOST_IDX_8822C) & BIT_MASK_VIQ_HOST_IDX_8822C) -+#define BIT_SET_VIQ_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_VIQ_HOST_IDX_8822C(x) | BIT_VIQ_HOST_IDX_8822C(v)) -+ -+/* 2 REG_BEQ_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_BEQ_HW_IDX_8822C 16 -+#define BIT_MASK_BEQ_HW_IDX_8822C 0xfff -+#define BIT_BEQ_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_BEQ_HW_IDX_8822C) << BIT_SHIFT_BEQ_HW_IDX_8822C) -+#define BITS_BEQ_HW_IDX_8822C \ -+ (BIT_MASK_BEQ_HW_IDX_8822C << BIT_SHIFT_BEQ_HW_IDX_8822C) -+#define BIT_CLEAR_BEQ_HW_IDX_8822C(x) ((x) & (~BITS_BEQ_HW_IDX_8822C)) -+#define BIT_GET_BEQ_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HW_IDX_8822C) & BIT_MASK_BEQ_HW_IDX_8822C) -+#define BIT_SET_BEQ_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_BEQ_HW_IDX_8822C(x) | BIT_BEQ_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_BEQ_HOST_IDX_8822C 0 -+#define BIT_MASK_BEQ_HOST_IDX_8822C 0xfff -+#define BIT_BEQ_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_BEQ_HOST_IDX_8822C) << BIT_SHIFT_BEQ_HOST_IDX_8822C) -+#define BITS_BEQ_HOST_IDX_8822C \ -+ (BIT_MASK_BEQ_HOST_IDX_8822C << BIT_SHIFT_BEQ_HOST_IDX_8822C) -+#define BIT_CLEAR_BEQ_HOST_IDX_8822C(x) ((x) & (~BITS_BEQ_HOST_IDX_8822C)) -+#define BIT_GET_BEQ_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_BEQ_HOST_IDX_8822C) & BIT_MASK_BEQ_HOST_IDX_8822C) -+#define BIT_SET_BEQ_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_BEQ_HOST_IDX_8822C(x) | BIT_BEQ_HOST_IDX_8822C(v)) -+ -+/* 2 REG_BKQ_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_BKQ_HW_IDX_8822C 16 -+#define BIT_MASK_BKQ_HW_IDX_8822C 0xfff -+#define BIT_BKQ_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_BKQ_HW_IDX_8822C) << BIT_SHIFT_BKQ_HW_IDX_8822C) -+#define BITS_BKQ_HW_IDX_8822C \ -+ (BIT_MASK_BKQ_HW_IDX_8822C << BIT_SHIFT_BKQ_HW_IDX_8822C) -+#define BIT_CLEAR_BKQ_HW_IDX_8822C(x) ((x) & (~BITS_BKQ_HW_IDX_8822C)) -+#define BIT_GET_BKQ_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HW_IDX_8822C) & BIT_MASK_BKQ_HW_IDX_8822C) -+#define BIT_SET_BKQ_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_BKQ_HW_IDX_8822C(x) | BIT_BKQ_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_BKQ_HOST_IDX_8822C 0 -+#define BIT_MASK_BKQ_HOST_IDX_8822C 0xfff -+#define BIT_BKQ_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_BKQ_HOST_IDX_8822C) << BIT_SHIFT_BKQ_HOST_IDX_8822C) -+#define BITS_BKQ_HOST_IDX_8822C \ -+ (BIT_MASK_BKQ_HOST_IDX_8822C << BIT_SHIFT_BKQ_HOST_IDX_8822C) -+#define BIT_CLEAR_BKQ_HOST_IDX_8822C(x) ((x) & (~BITS_BKQ_HOST_IDX_8822C)) -+#define BIT_GET_BKQ_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_BKQ_HOST_IDX_8822C) & BIT_MASK_BKQ_HOST_IDX_8822C) -+#define BIT_SET_BKQ_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_BKQ_HOST_IDX_8822C(x) | BIT_BKQ_HOST_IDX_8822C(v)) -+ -+/* 2 REG_MGQ_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_MGQ_HW_IDX_8822C 16 -+#define BIT_MASK_MGQ_HW_IDX_8822C 0xfff -+#define BIT_MGQ_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_HW_IDX_8822C) << BIT_SHIFT_MGQ_HW_IDX_8822C) -+#define BITS_MGQ_HW_IDX_8822C \ -+ (BIT_MASK_MGQ_HW_IDX_8822C << BIT_SHIFT_MGQ_HW_IDX_8822C) -+#define BIT_CLEAR_MGQ_HW_IDX_8822C(x) ((x) & (~BITS_MGQ_HW_IDX_8822C)) -+#define BIT_GET_MGQ_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HW_IDX_8822C) & BIT_MASK_MGQ_HW_IDX_8822C) -+#define BIT_SET_MGQ_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_HW_IDX_8822C(x) | BIT_MGQ_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_MGQ_HOST_IDX_8822C 0 -+#define BIT_MASK_MGQ_HOST_IDX_8822C 0xfff -+#define BIT_MGQ_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_HOST_IDX_8822C) << BIT_SHIFT_MGQ_HOST_IDX_8822C) -+#define BITS_MGQ_HOST_IDX_8822C \ -+ (BIT_MASK_MGQ_HOST_IDX_8822C << BIT_SHIFT_MGQ_HOST_IDX_8822C) -+#define BIT_CLEAR_MGQ_HOST_IDX_8822C(x) ((x) & (~BITS_MGQ_HOST_IDX_8822C)) -+#define BIT_GET_MGQ_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_HOST_IDX_8822C) & BIT_MASK_MGQ_HOST_IDX_8822C) -+#define BIT_SET_MGQ_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_HOST_IDX_8822C(x) | BIT_MGQ_HOST_IDX_8822C(v)) -+ -+/* 2 REG_RXQ_RXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_RXQ_HW_IDX_8822C 16 -+#define BIT_MASK_RXQ_HW_IDX_8822C 0xfff -+#define BIT_RXQ_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_RXQ_HW_IDX_8822C) << BIT_SHIFT_RXQ_HW_IDX_8822C) -+#define BITS_RXQ_HW_IDX_8822C \ -+ (BIT_MASK_RXQ_HW_IDX_8822C << BIT_SHIFT_RXQ_HW_IDX_8822C) -+#define BIT_CLEAR_RXQ_HW_IDX_8822C(x) ((x) & (~BITS_RXQ_HW_IDX_8822C)) -+#define BIT_GET_RXQ_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HW_IDX_8822C) & BIT_MASK_RXQ_HW_IDX_8822C) -+#define BIT_SET_RXQ_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_RXQ_HW_IDX_8822C(x) | BIT_RXQ_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_RXQ_HOST_IDX_8822C 0 -+#define BIT_MASK_RXQ_HOST_IDX_8822C 0xfff -+#define BIT_RXQ_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_RXQ_HOST_IDX_8822C) << BIT_SHIFT_RXQ_HOST_IDX_8822C) -+#define BITS_RXQ_HOST_IDX_8822C \ -+ (BIT_MASK_RXQ_HOST_IDX_8822C << BIT_SHIFT_RXQ_HOST_IDX_8822C) -+#define BIT_CLEAR_RXQ_HOST_IDX_8822C(x) ((x) & (~BITS_RXQ_HOST_IDX_8822C)) -+#define BIT_GET_RXQ_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXQ_HOST_IDX_8822C) & BIT_MASK_RXQ_HOST_IDX_8822C) -+#define BIT_SET_RXQ_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_RXQ_HOST_IDX_8822C(x) | BIT_RXQ_HOST_IDX_8822C(v)) -+ -+/* 2 REG_HI0Q_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_HI0Q_HW_IDX_8822C 16 -+#define BIT_MASK_HI0Q_HW_IDX_8822C 0xfff -+#define BIT_HI0Q_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI0Q_HW_IDX_8822C) << BIT_SHIFT_HI0Q_HW_IDX_8822C) -+#define BITS_HI0Q_HW_IDX_8822C \ -+ (BIT_MASK_HI0Q_HW_IDX_8822C << BIT_SHIFT_HI0Q_HW_IDX_8822C) -+#define BIT_CLEAR_HI0Q_HW_IDX_8822C(x) ((x) & (~BITS_HI0Q_HW_IDX_8822C)) -+#define BIT_GET_HI0Q_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HW_IDX_8822C) & BIT_MASK_HI0Q_HW_IDX_8822C) -+#define BIT_SET_HI0Q_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI0Q_HW_IDX_8822C(x) | BIT_HI0Q_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_HI0Q_HOST_IDX_8822C 0 -+#define BIT_MASK_HI0Q_HOST_IDX_8822C 0xfff -+#define BIT_HI0Q_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI0Q_HOST_IDX_8822C) << BIT_SHIFT_HI0Q_HOST_IDX_8822C) -+#define BITS_HI0Q_HOST_IDX_8822C \ -+ (BIT_MASK_HI0Q_HOST_IDX_8822C << BIT_SHIFT_HI0Q_HOST_IDX_8822C) -+#define BIT_CLEAR_HI0Q_HOST_IDX_8822C(x) ((x) & (~BITS_HI0Q_HOST_IDX_8822C)) -+#define BIT_GET_HI0Q_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI0Q_HOST_IDX_8822C) & BIT_MASK_HI0Q_HOST_IDX_8822C) -+#define BIT_SET_HI0Q_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI0Q_HOST_IDX_8822C(x) | BIT_HI0Q_HOST_IDX_8822C(v)) -+ -+/* 2 REG_HI1Q_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_HI1Q_HW_IDX_8822C 16 -+#define BIT_MASK_HI1Q_HW_IDX_8822C 0xfff -+#define BIT_HI1Q_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI1Q_HW_IDX_8822C) << BIT_SHIFT_HI1Q_HW_IDX_8822C) -+#define BITS_HI1Q_HW_IDX_8822C \ -+ (BIT_MASK_HI1Q_HW_IDX_8822C << BIT_SHIFT_HI1Q_HW_IDX_8822C) -+#define BIT_CLEAR_HI1Q_HW_IDX_8822C(x) ((x) & (~BITS_HI1Q_HW_IDX_8822C)) -+#define BIT_GET_HI1Q_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HW_IDX_8822C) & BIT_MASK_HI1Q_HW_IDX_8822C) -+#define BIT_SET_HI1Q_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI1Q_HW_IDX_8822C(x) | BIT_HI1Q_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_HI1Q_HOST_IDX_8822C 0 -+#define BIT_MASK_HI1Q_HOST_IDX_8822C 0xfff -+#define BIT_HI1Q_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI1Q_HOST_IDX_8822C) << BIT_SHIFT_HI1Q_HOST_IDX_8822C) -+#define BITS_HI1Q_HOST_IDX_8822C \ -+ (BIT_MASK_HI1Q_HOST_IDX_8822C << BIT_SHIFT_HI1Q_HOST_IDX_8822C) -+#define BIT_CLEAR_HI1Q_HOST_IDX_8822C(x) ((x) & (~BITS_HI1Q_HOST_IDX_8822C)) -+#define BIT_GET_HI1Q_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI1Q_HOST_IDX_8822C) & BIT_MASK_HI1Q_HOST_IDX_8822C) -+#define BIT_SET_HI1Q_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI1Q_HOST_IDX_8822C(x) | BIT_HI1Q_HOST_IDX_8822C(v)) -+ -+/* 2 REG_HI2Q_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_HI2Q_HW_IDX_8822C 16 -+#define BIT_MASK_HI2Q_HW_IDX_8822C 0xfff -+#define BIT_HI2Q_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI2Q_HW_IDX_8822C) << BIT_SHIFT_HI2Q_HW_IDX_8822C) -+#define BITS_HI2Q_HW_IDX_8822C \ -+ (BIT_MASK_HI2Q_HW_IDX_8822C << BIT_SHIFT_HI2Q_HW_IDX_8822C) -+#define BIT_CLEAR_HI2Q_HW_IDX_8822C(x) ((x) & (~BITS_HI2Q_HW_IDX_8822C)) -+#define BIT_GET_HI2Q_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HW_IDX_8822C) & BIT_MASK_HI2Q_HW_IDX_8822C) -+#define BIT_SET_HI2Q_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI2Q_HW_IDX_8822C(x) | BIT_HI2Q_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_HI2Q_HOST_IDX_8822C 0 -+#define BIT_MASK_HI2Q_HOST_IDX_8822C 0xfff -+#define BIT_HI2Q_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI2Q_HOST_IDX_8822C) << BIT_SHIFT_HI2Q_HOST_IDX_8822C) -+#define BITS_HI2Q_HOST_IDX_8822C \ -+ (BIT_MASK_HI2Q_HOST_IDX_8822C << BIT_SHIFT_HI2Q_HOST_IDX_8822C) -+#define BIT_CLEAR_HI2Q_HOST_IDX_8822C(x) ((x) & (~BITS_HI2Q_HOST_IDX_8822C)) -+#define BIT_GET_HI2Q_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI2Q_HOST_IDX_8822C) & BIT_MASK_HI2Q_HOST_IDX_8822C) -+#define BIT_SET_HI2Q_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI2Q_HOST_IDX_8822C(x) | BIT_HI2Q_HOST_IDX_8822C(v)) -+ -+/* 2 REG_HI3Q_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_HI3Q_HW_IDX_8822C 16 -+#define BIT_MASK_HI3Q_HW_IDX_8822C 0xfff -+#define BIT_HI3Q_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI3Q_HW_IDX_8822C) << BIT_SHIFT_HI3Q_HW_IDX_8822C) -+#define BITS_HI3Q_HW_IDX_8822C \ -+ (BIT_MASK_HI3Q_HW_IDX_8822C << BIT_SHIFT_HI3Q_HW_IDX_8822C) -+#define BIT_CLEAR_HI3Q_HW_IDX_8822C(x) ((x) & (~BITS_HI3Q_HW_IDX_8822C)) -+#define BIT_GET_HI3Q_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HW_IDX_8822C) & BIT_MASK_HI3Q_HW_IDX_8822C) -+#define BIT_SET_HI3Q_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI3Q_HW_IDX_8822C(x) | BIT_HI3Q_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_HI3Q_HOST_IDX_8822C 0 -+#define BIT_MASK_HI3Q_HOST_IDX_8822C 0xfff -+#define BIT_HI3Q_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI3Q_HOST_IDX_8822C) << BIT_SHIFT_HI3Q_HOST_IDX_8822C) -+#define BITS_HI3Q_HOST_IDX_8822C \ -+ (BIT_MASK_HI3Q_HOST_IDX_8822C << BIT_SHIFT_HI3Q_HOST_IDX_8822C) -+#define BIT_CLEAR_HI3Q_HOST_IDX_8822C(x) ((x) & (~BITS_HI3Q_HOST_IDX_8822C)) -+#define BIT_GET_HI3Q_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI3Q_HOST_IDX_8822C) & BIT_MASK_HI3Q_HOST_IDX_8822C) -+#define BIT_SET_HI3Q_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI3Q_HOST_IDX_8822C(x) | BIT_HI3Q_HOST_IDX_8822C(v)) -+ -+/* 2 REG_HI4Q_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_HI4Q_HW_IDX_8822C 16 -+#define BIT_MASK_HI4Q_HW_IDX_8822C 0xfff -+#define BIT_HI4Q_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI4Q_HW_IDX_8822C) << BIT_SHIFT_HI4Q_HW_IDX_8822C) -+#define BITS_HI4Q_HW_IDX_8822C \ -+ (BIT_MASK_HI4Q_HW_IDX_8822C << BIT_SHIFT_HI4Q_HW_IDX_8822C) -+#define BIT_CLEAR_HI4Q_HW_IDX_8822C(x) ((x) & (~BITS_HI4Q_HW_IDX_8822C)) -+#define BIT_GET_HI4Q_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HW_IDX_8822C) & BIT_MASK_HI4Q_HW_IDX_8822C) -+#define BIT_SET_HI4Q_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI4Q_HW_IDX_8822C(x) | BIT_HI4Q_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_HI4Q_HOST_IDX_8822C 0 -+#define BIT_MASK_HI4Q_HOST_IDX_8822C 0xfff -+#define BIT_HI4Q_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI4Q_HOST_IDX_8822C) << BIT_SHIFT_HI4Q_HOST_IDX_8822C) -+#define BITS_HI4Q_HOST_IDX_8822C \ -+ (BIT_MASK_HI4Q_HOST_IDX_8822C << BIT_SHIFT_HI4Q_HOST_IDX_8822C) -+#define BIT_CLEAR_HI4Q_HOST_IDX_8822C(x) ((x) & (~BITS_HI4Q_HOST_IDX_8822C)) -+#define BIT_GET_HI4Q_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI4Q_HOST_IDX_8822C) & BIT_MASK_HI4Q_HOST_IDX_8822C) -+#define BIT_SET_HI4Q_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI4Q_HOST_IDX_8822C(x) | BIT_HI4Q_HOST_IDX_8822C(v)) -+ -+/* 2 REG_HI5Q_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_HI5Q_HW_IDX_8822C 16 -+#define BIT_MASK_HI5Q_HW_IDX_8822C 0xfff -+#define BIT_HI5Q_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI5Q_HW_IDX_8822C) << BIT_SHIFT_HI5Q_HW_IDX_8822C) -+#define BITS_HI5Q_HW_IDX_8822C \ -+ (BIT_MASK_HI5Q_HW_IDX_8822C << BIT_SHIFT_HI5Q_HW_IDX_8822C) -+#define BIT_CLEAR_HI5Q_HW_IDX_8822C(x) ((x) & (~BITS_HI5Q_HW_IDX_8822C)) -+#define BIT_GET_HI5Q_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HW_IDX_8822C) & BIT_MASK_HI5Q_HW_IDX_8822C) -+#define BIT_SET_HI5Q_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI5Q_HW_IDX_8822C(x) | BIT_HI5Q_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_HI5Q_HOST_IDX_8822C 0 -+#define BIT_MASK_HI5Q_HOST_IDX_8822C 0xfff -+#define BIT_HI5Q_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI5Q_HOST_IDX_8822C) << BIT_SHIFT_HI5Q_HOST_IDX_8822C) -+#define BITS_HI5Q_HOST_IDX_8822C \ -+ (BIT_MASK_HI5Q_HOST_IDX_8822C << BIT_SHIFT_HI5Q_HOST_IDX_8822C) -+#define BIT_CLEAR_HI5Q_HOST_IDX_8822C(x) ((x) & (~BITS_HI5Q_HOST_IDX_8822C)) -+#define BIT_GET_HI5Q_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI5Q_HOST_IDX_8822C) & BIT_MASK_HI5Q_HOST_IDX_8822C) -+#define BIT_SET_HI5Q_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI5Q_HOST_IDX_8822C(x) | BIT_HI5Q_HOST_IDX_8822C(v)) -+ -+/* 2 REG_HI6Q_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_HI6Q_HW_IDX_8822C 16 -+#define BIT_MASK_HI6Q_HW_IDX_8822C 0xfff -+#define BIT_HI6Q_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI6Q_HW_IDX_8822C) << BIT_SHIFT_HI6Q_HW_IDX_8822C) -+#define BITS_HI6Q_HW_IDX_8822C \ -+ (BIT_MASK_HI6Q_HW_IDX_8822C << BIT_SHIFT_HI6Q_HW_IDX_8822C) -+#define BIT_CLEAR_HI6Q_HW_IDX_8822C(x) ((x) & (~BITS_HI6Q_HW_IDX_8822C)) -+#define BIT_GET_HI6Q_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HW_IDX_8822C) & BIT_MASK_HI6Q_HW_IDX_8822C) -+#define BIT_SET_HI6Q_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI6Q_HW_IDX_8822C(x) | BIT_HI6Q_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_HI6Q_HOST_IDX_8822C 0 -+#define BIT_MASK_HI6Q_HOST_IDX_8822C 0xfff -+#define BIT_HI6Q_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI6Q_HOST_IDX_8822C) << BIT_SHIFT_HI6Q_HOST_IDX_8822C) -+#define BITS_HI6Q_HOST_IDX_8822C \ -+ (BIT_MASK_HI6Q_HOST_IDX_8822C << BIT_SHIFT_HI6Q_HOST_IDX_8822C) -+#define BIT_CLEAR_HI6Q_HOST_IDX_8822C(x) ((x) & (~BITS_HI6Q_HOST_IDX_8822C)) -+#define BIT_GET_HI6Q_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI6Q_HOST_IDX_8822C) & BIT_MASK_HI6Q_HOST_IDX_8822C) -+#define BIT_SET_HI6Q_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI6Q_HOST_IDX_8822C(x) | BIT_HI6Q_HOST_IDX_8822C(v)) -+ -+/* 2 REG_HI7Q_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_HI7Q_HW_IDX_8822C 16 -+#define BIT_MASK_HI7Q_HW_IDX_8822C 0xfff -+#define BIT_HI7Q_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI7Q_HW_IDX_8822C) << BIT_SHIFT_HI7Q_HW_IDX_8822C) -+#define BITS_HI7Q_HW_IDX_8822C \ -+ (BIT_MASK_HI7Q_HW_IDX_8822C << BIT_SHIFT_HI7Q_HW_IDX_8822C) -+#define BIT_CLEAR_HI7Q_HW_IDX_8822C(x) ((x) & (~BITS_HI7Q_HW_IDX_8822C)) -+#define BIT_GET_HI7Q_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HW_IDX_8822C) & BIT_MASK_HI7Q_HW_IDX_8822C) -+#define BIT_SET_HI7Q_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI7Q_HW_IDX_8822C(x) | BIT_HI7Q_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_HI7Q_HOST_IDX_8822C 0 -+#define BIT_MASK_HI7Q_HOST_IDX_8822C 0xfff -+#define BIT_HI7Q_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HI7Q_HOST_IDX_8822C) << BIT_SHIFT_HI7Q_HOST_IDX_8822C) -+#define BITS_HI7Q_HOST_IDX_8822C \ -+ (BIT_MASK_HI7Q_HOST_IDX_8822C << BIT_SHIFT_HI7Q_HOST_IDX_8822C) -+#define BIT_CLEAR_HI7Q_HOST_IDX_8822C(x) ((x) & (~BITS_HI7Q_HOST_IDX_8822C)) -+#define BIT_GET_HI7Q_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HI7Q_HOST_IDX_8822C) & BIT_MASK_HI7Q_HOST_IDX_8822C) -+#define BIT_SET_HI7Q_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HI7Q_HOST_IDX_8822C(x) | BIT_HI7Q_HOST_IDX_8822C(v)) -+ -+/* 2 REG_DBG_SEL_V1_8822C */ -+ -+#define BIT_SHIFT_DBG_SEL_8822C 0 -+#define BIT_MASK_DBG_SEL_8822C 0xff -+#define BIT_DBG_SEL_8822C(x) \ -+ (((x) & BIT_MASK_DBG_SEL_8822C) << BIT_SHIFT_DBG_SEL_8822C) -+#define BITS_DBG_SEL_8822C (BIT_MASK_DBG_SEL_8822C << BIT_SHIFT_DBG_SEL_8822C) -+#define BIT_CLEAR_DBG_SEL_8822C(x) ((x) & (~BITS_DBG_SEL_8822C)) -+#define BIT_GET_DBG_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_DBG_SEL_8822C) & BIT_MASK_DBG_SEL_8822C) -+#define BIT_SET_DBG_SEL_8822C(x, v) \ -+ (BIT_CLEAR_DBG_SEL_8822C(x) | BIT_DBG_SEL_8822C(v)) -+ -+/* 2 REG_PCIE_HRPWM1_V1_8822C */ -+ -+#define BIT_SHIFT_PCIE_HRPWM_8822C 0 -+#define BIT_MASK_PCIE_HRPWM_8822C 0xff -+#define BIT_PCIE_HRPWM_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM_8822C) << BIT_SHIFT_PCIE_HRPWM_8822C) -+#define BITS_PCIE_HRPWM_8822C \ -+ (BIT_MASK_PCIE_HRPWM_8822C << BIT_SHIFT_PCIE_HRPWM_8822C) -+#define BIT_CLEAR_PCIE_HRPWM_8822C(x) ((x) & (~BITS_PCIE_HRPWM_8822C)) -+#define BIT_GET_PCIE_HRPWM_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM_8822C) & BIT_MASK_PCIE_HRPWM_8822C) -+#define BIT_SET_PCIE_HRPWM_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM_8822C(x) | BIT_PCIE_HRPWM_8822C(v)) -+ -+/* 2 REG_PCIE_HCPWM1_V1_8822C */ -+ -+#define BIT_SHIFT_PCIE_HCPWM_8822C 0 -+#define BIT_MASK_PCIE_HCPWM_8822C 0xff -+#define BIT_PCIE_HCPWM_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM_8822C) << BIT_SHIFT_PCIE_HCPWM_8822C) -+#define BITS_PCIE_HCPWM_8822C \ -+ (BIT_MASK_PCIE_HCPWM_8822C << BIT_SHIFT_PCIE_HCPWM_8822C) -+#define BIT_CLEAR_PCIE_HCPWM_8822C(x) ((x) & (~BITS_PCIE_HCPWM_8822C)) -+#define BIT_GET_PCIE_HCPWM_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM_8822C) & BIT_MASK_PCIE_HCPWM_8822C) -+#define BIT_SET_PCIE_HCPWM_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM_8822C(x) | BIT_PCIE_HCPWM_8822C(v)) -+ -+/* 2 REG_PCIE_CTRL2_8822C */ -+#define BIT_DIS_TXDMA_PRE_8822C BIT(7) -+#define BIT_DIS_RXDMA_PRE_8822C BIT(6) -+ -+#define BIT_SHIFT_HPS_CLKR_PCIE_8822C 4 -+#define BIT_MASK_HPS_CLKR_PCIE_8822C 0x3 -+#define BIT_HPS_CLKR_PCIE_8822C(x) \ -+ (((x) & BIT_MASK_HPS_CLKR_PCIE_8822C) << BIT_SHIFT_HPS_CLKR_PCIE_8822C) -+#define BITS_HPS_CLKR_PCIE_8822C \ -+ (BIT_MASK_HPS_CLKR_PCIE_8822C << BIT_SHIFT_HPS_CLKR_PCIE_8822C) -+#define BIT_CLEAR_HPS_CLKR_PCIE_8822C(x) ((x) & (~BITS_HPS_CLKR_PCIE_8822C)) -+#define BIT_GET_HPS_CLKR_PCIE_8822C(x) \ -+ (((x) >> BIT_SHIFT_HPS_CLKR_PCIE_8822C) & BIT_MASK_HPS_CLKR_PCIE_8822C) -+#define BIT_SET_HPS_CLKR_PCIE_8822C(x, v) \ -+ (BIT_CLEAR_HPS_CLKR_PCIE_8822C(x) | BIT_HPS_CLKR_PCIE_8822C(v)) -+ -+#define BIT_PCIE_INT_8822C BIT(3) -+#define BIT_TXFLAG_EXIT_L1_EN_8822C BIT(2) -+#define BIT_EN_RXDMA_ALIGN_8822C BIT(1) -+#define BIT_EN_TXDMA_ALIGN_8822C BIT(0) -+ -+/* 2 REG_PCIE_HRPWM2_V1_8822C */ -+ -+#define BIT_SHIFT_PCIE_HRPWM2_8822C 0 -+#define BIT_MASK_PCIE_HRPWM2_8822C 0xffff -+#define BIT_PCIE_HRPWM2_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_HRPWM2_8822C) << BIT_SHIFT_PCIE_HRPWM2_8822C) -+#define BITS_PCIE_HRPWM2_8822C \ -+ (BIT_MASK_PCIE_HRPWM2_8822C << BIT_SHIFT_PCIE_HRPWM2_8822C) -+#define BIT_CLEAR_PCIE_HRPWM2_8822C(x) ((x) & (~BITS_PCIE_HRPWM2_8822C)) -+#define BIT_GET_PCIE_HRPWM2_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HRPWM2_8822C) & BIT_MASK_PCIE_HRPWM2_8822C) -+#define BIT_SET_PCIE_HRPWM2_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_HRPWM2_8822C(x) | BIT_PCIE_HRPWM2_8822C(v)) -+ -+/* 2 REG_PCIE_HCPWM2_V1_8822C */ -+ -+#define BIT_SHIFT_PCIE_HCPWM2_8822C 0 -+#define BIT_MASK_PCIE_HCPWM2_8822C 0xffff -+#define BIT_PCIE_HCPWM2_8822C(x) \ -+ (((x) & BIT_MASK_PCIE_HCPWM2_8822C) << BIT_SHIFT_PCIE_HCPWM2_8822C) -+#define BITS_PCIE_HCPWM2_8822C \ -+ (BIT_MASK_PCIE_HCPWM2_8822C << BIT_SHIFT_PCIE_HCPWM2_8822C) -+#define BIT_CLEAR_PCIE_HCPWM2_8822C(x) ((x) & (~BITS_PCIE_HCPWM2_8822C)) -+#define BIT_GET_PCIE_HCPWM2_8822C(x) \ -+ (((x) >> BIT_SHIFT_PCIE_HCPWM2_8822C) & BIT_MASK_PCIE_HCPWM2_8822C) -+#define BIT_SET_PCIE_HCPWM2_8822C(x, v) \ -+ (BIT_CLEAR_PCIE_HCPWM2_8822C(x) | BIT_PCIE_HCPWM2_8822C(v)) -+ -+/* 2 REG_PCIE_H2C_MSG_V1_8822C */ -+ -+#define BIT_SHIFT_DRV2FW_INFO_8822C 0 -+#define BIT_MASK_DRV2FW_INFO_8822C 0xffffffffL -+#define BIT_DRV2FW_INFO_8822C(x) \ -+ (((x) & BIT_MASK_DRV2FW_INFO_8822C) << BIT_SHIFT_DRV2FW_INFO_8822C) -+#define BITS_DRV2FW_INFO_8822C \ -+ (BIT_MASK_DRV2FW_INFO_8822C << BIT_SHIFT_DRV2FW_INFO_8822C) -+#define BIT_CLEAR_DRV2FW_INFO_8822C(x) ((x) & (~BITS_DRV2FW_INFO_8822C)) -+#define BIT_GET_DRV2FW_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_DRV2FW_INFO_8822C) & BIT_MASK_DRV2FW_INFO_8822C) -+#define BIT_SET_DRV2FW_INFO_8822C(x, v) \ -+ (BIT_CLEAR_DRV2FW_INFO_8822C(x) | BIT_DRV2FW_INFO_8822C(v)) -+ -+/* 2 REG_PCIE_C2H_MSG_V1_8822C */ -+ -+#define BIT_SHIFT_HCI_PCIE_C2H_MSG_8822C 0 -+#define BIT_MASK_HCI_PCIE_C2H_MSG_8822C 0xffffffffL -+#define BIT_HCI_PCIE_C2H_MSG_8822C(x) \ -+ (((x) & BIT_MASK_HCI_PCIE_C2H_MSG_8822C) \ -+ << BIT_SHIFT_HCI_PCIE_C2H_MSG_8822C) -+#define BITS_HCI_PCIE_C2H_MSG_8822C \ -+ (BIT_MASK_HCI_PCIE_C2H_MSG_8822C << BIT_SHIFT_HCI_PCIE_C2H_MSG_8822C) -+#define BIT_CLEAR_HCI_PCIE_C2H_MSG_8822C(x) \ -+ ((x) & (~BITS_HCI_PCIE_C2H_MSG_8822C)) -+#define BIT_GET_HCI_PCIE_C2H_MSG_8822C(x) \ -+ (((x) >> BIT_SHIFT_HCI_PCIE_C2H_MSG_8822C) & \ -+ BIT_MASK_HCI_PCIE_C2H_MSG_8822C) -+#define BIT_SET_HCI_PCIE_C2H_MSG_8822C(x, v) \ -+ (BIT_CLEAR_HCI_PCIE_C2H_MSG_8822C(x) | BIT_HCI_PCIE_C2H_MSG_8822C(v)) -+ -+/* 2 REG_DBI_WDATA_V1_8822C */ -+ -+#define BIT_SHIFT_DBI_WDATA_8822C 0 -+#define BIT_MASK_DBI_WDATA_8822C 0xffffffffL -+#define BIT_DBI_WDATA_8822C(x) \ -+ (((x) & BIT_MASK_DBI_WDATA_8822C) << BIT_SHIFT_DBI_WDATA_8822C) -+#define BITS_DBI_WDATA_8822C \ -+ (BIT_MASK_DBI_WDATA_8822C << BIT_SHIFT_DBI_WDATA_8822C) -+#define BIT_CLEAR_DBI_WDATA_8822C(x) ((x) & (~BITS_DBI_WDATA_8822C)) -+#define BIT_GET_DBI_WDATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DBI_WDATA_8822C) & BIT_MASK_DBI_WDATA_8822C) -+#define BIT_SET_DBI_WDATA_8822C(x, v) \ -+ (BIT_CLEAR_DBI_WDATA_8822C(x) | BIT_DBI_WDATA_8822C(v)) -+ -+/* 2 REG_DBI_RDATA_V1_8822C */ -+ -+#define BIT_SHIFT_DBI_RDATA_8822C 0 -+#define BIT_MASK_DBI_RDATA_8822C 0xffffffffL -+#define BIT_DBI_RDATA_8822C(x) \ -+ (((x) & BIT_MASK_DBI_RDATA_8822C) << BIT_SHIFT_DBI_RDATA_8822C) -+#define BITS_DBI_RDATA_8822C \ -+ (BIT_MASK_DBI_RDATA_8822C << BIT_SHIFT_DBI_RDATA_8822C) -+#define BIT_CLEAR_DBI_RDATA_8822C(x) ((x) & (~BITS_DBI_RDATA_8822C)) -+#define BIT_GET_DBI_RDATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DBI_RDATA_8822C) & BIT_MASK_DBI_RDATA_8822C) -+#define BIT_SET_DBI_RDATA_8822C(x, v) \ -+ (BIT_CLEAR_DBI_RDATA_8822C(x) | BIT_DBI_RDATA_8822C(v)) -+ -+/* 2 REG_DBI_FLAG_V1_8822C */ -+#define BIT_EN_STUCK_DBG_8822C BIT(26) -+#define BIT_RX_STUCK_8822C BIT(25) -+#define BIT_TX_STUCK_8822C BIT(24) -+#define BIT_DBI_RFLAG_8822C BIT(17) -+#define BIT_DBI_WFLAG_8822C BIT(16) -+ -+#define BIT_SHIFT_DBI_WREN_8822C 12 -+#define BIT_MASK_DBI_WREN_8822C 0xf -+#define BIT_DBI_WREN_8822C(x) \ -+ (((x) & BIT_MASK_DBI_WREN_8822C) << BIT_SHIFT_DBI_WREN_8822C) -+#define BITS_DBI_WREN_8822C \ -+ (BIT_MASK_DBI_WREN_8822C << BIT_SHIFT_DBI_WREN_8822C) -+#define BIT_CLEAR_DBI_WREN_8822C(x) ((x) & (~BITS_DBI_WREN_8822C)) -+#define BIT_GET_DBI_WREN_8822C(x) \ -+ (((x) >> BIT_SHIFT_DBI_WREN_8822C) & BIT_MASK_DBI_WREN_8822C) -+#define BIT_SET_DBI_WREN_8822C(x, v) \ -+ (BIT_CLEAR_DBI_WREN_8822C(x) | BIT_DBI_WREN_8822C(v)) -+ -+#define BIT_SHIFT_DBI_ADDR_8822C 0 -+#define BIT_MASK_DBI_ADDR_8822C 0xfff -+#define BIT_DBI_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_DBI_ADDR_8822C) << BIT_SHIFT_DBI_ADDR_8822C) -+#define BITS_DBI_ADDR_8822C \ -+ (BIT_MASK_DBI_ADDR_8822C << BIT_SHIFT_DBI_ADDR_8822C) -+#define BIT_CLEAR_DBI_ADDR_8822C(x) ((x) & (~BITS_DBI_ADDR_8822C)) -+#define BIT_GET_DBI_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_DBI_ADDR_8822C) & BIT_MASK_DBI_ADDR_8822C) -+#define BIT_SET_DBI_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_DBI_ADDR_8822C(x) | BIT_DBI_ADDR_8822C(v)) -+ -+/* 2 REG_MDIO_V1_8822C */ -+ -+#define BIT_SHIFT_MDIO_RDATA_8822C 16 -+#define BIT_MASK_MDIO_RDATA_8822C 0xffff -+#define BIT_MDIO_RDATA_8822C(x) \ -+ (((x) & BIT_MASK_MDIO_RDATA_8822C) << BIT_SHIFT_MDIO_RDATA_8822C) -+#define BITS_MDIO_RDATA_8822C \ -+ (BIT_MASK_MDIO_RDATA_8822C << BIT_SHIFT_MDIO_RDATA_8822C) -+#define BIT_CLEAR_MDIO_RDATA_8822C(x) ((x) & (~BITS_MDIO_RDATA_8822C)) -+#define BIT_GET_MDIO_RDATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_MDIO_RDATA_8822C) & BIT_MASK_MDIO_RDATA_8822C) -+#define BIT_SET_MDIO_RDATA_8822C(x, v) \ -+ (BIT_CLEAR_MDIO_RDATA_8822C(x) | BIT_MDIO_RDATA_8822C(v)) -+ -+#define BIT_SHIFT_MDIO_WDATA_8822C 0 -+#define BIT_MASK_MDIO_WDATA_8822C 0xffff -+#define BIT_MDIO_WDATA_8822C(x) \ -+ (((x) & BIT_MASK_MDIO_WDATA_8822C) << BIT_SHIFT_MDIO_WDATA_8822C) -+#define BITS_MDIO_WDATA_8822C \ -+ (BIT_MASK_MDIO_WDATA_8822C << BIT_SHIFT_MDIO_WDATA_8822C) -+#define BIT_CLEAR_MDIO_WDATA_8822C(x) ((x) & (~BITS_MDIO_WDATA_8822C)) -+#define BIT_GET_MDIO_WDATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_MDIO_WDATA_8822C) & BIT_MASK_MDIO_WDATA_8822C) -+#define BIT_SET_MDIO_WDATA_8822C(x, v) \ -+ (BIT_CLEAR_MDIO_WDATA_8822C(x) | BIT_MDIO_WDATA_8822C(v)) -+ -+/* 2 REG_PCIE_MIX_CFG_8822C */ -+ -+#define BIT_SHIFT_MDIO_PHY_ADDR_8822C 24 -+#define BIT_MASK_MDIO_PHY_ADDR_8822C 0x1f -+#define BIT_MDIO_PHY_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_MDIO_PHY_ADDR_8822C) << BIT_SHIFT_MDIO_PHY_ADDR_8822C) -+#define BITS_MDIO_PHY_ADDR_8822C \ -+ (BIT_MASK_MDIO_PHY_ADDR_8822C << BIT_SHIFT_MDIO_PHY_ADDR_8822C) -+#define BIT_CLEAR_MDIO_PHY_ADDR_8822C(x) ((x) & (~BITS_MDIO_PHY_ADDR_8822C)) -+#define BIT_GET_MDIO_PHY_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_MDIO_PHY_ADDR_8822C) & BIT_MASK_MDIO_PHY_ADDR_8822C) -+#define BIT_SET_MDIO_PHY_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_MDIO_PHY_ADDR_8822C(x) | BIT_MDIO_PHY_ADDR_8822C(v)) -+ -+#define BIT_SHIFT_WATCH_DOG_RECORD_V1_8822C 10 -+#define BIT_MASK_WATCH_DOG_RECORD_V1_8822C 0x3fff -+#define BIT_WATCH_DOG_RECORD_V1_8822C(x) \ -+ (((x) & BIT_MASK_WATCH_DOG_RECORD_V1_8822C) \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8822C) -+#define BITS_WATCH_DOG_RECORD_V1_8822C \ -+ (BIT_MASK_WATCH_DOG_RECORD_V1_8822C \ -+ << BIT_SHIFT_WATCH_DOG_RECORD_V1_8822C) -+#define BIT_CLEAR_WATCH_DOG_RECORD_V1_8822C(x) \ -+ ((x) & (~BITS_WATCH_DOG_RECORD_V1_8822C)) -+#define BIT_GET_WATCH_DOG_RECORD_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_WATCH_DOG_RECORD_V1_8822C) & \ -+ BIT_MASK_WATCH_DOG_RECORD_V1_8822C) -+#define BIT_SET_WATCH_DOG_RECORD_V1_8822C(x, v) \ -+ (BIT_CLEAR_WATCH_DOG_RECORD_V1_8822C(x) | \ -+ BIT_WATCH_DOG_RECORD_V1_8822C(v)) -+ -+#define BIT_R_IO_TIMEOUT_FLAG_V1_8822C BIT(9) -+#define BIT_EN_WATCH_DOG_8822C BIT(8) -+#define BIT_ECRC_EN_V1_8822C BIT(7) -+#define BIT_MDIO_RFLAG_V1_8822C BIT(6) -+#define BIT_MDIO_WFLAG_V1_8822C BIT(5) -+ -+#define BIT_SHIFT_MDIO_REG_ADDR_V1_8822C 0 -+#define BIT_MASK_MDIO_REG_ADDR_V1_8822C 0x1f -+#define BIT_MDIO_REG_ADDR_V1_8822C(x) \ -+ (((x) & BIT_MASK_MDIO_REG_ADDR_V1_8822C) \ -+ << BIT_SHIFT_MDIO_REG_ADDR_V1_8822C) -+#define BITS_MDIO_REG_ADDR_V1_8822C \ -+ (BIT_MASK_MDIO_REG_ADDR_V1_8822C << BIT_SHIFT_MDIO_REG_ADDR_V1_8822C) -+#define BIT_CLEAR_MDIO_REG_ADDR_V1_8822C(x) \ -+ ((x) & (~BITS_MDIO_REG_ADDR_V1_8822C)) -+#define BIT_GET_MDIO_REG_ADDR_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MDIO_REG_ADDR_V1_8822C) & \ -+ BIT_MASK_MDIO_REG_ADDR_V1_8822C) -+#define BIT_SET_MDIO_REG_ADDR_V1_8822C(x, v) \ -+ (BIT_CLEAR_MDIO_REG_ADDR_V1_8822C(x) | BIT_MDIO_REG_ADDR_V1_8822C(v)) -+ -+/* 2 REG_HCI_MIX_CFG_8822C */ -+ -+#define BIT_SHIFT_WATCH_DOG_TIMER_8822C 28 -+#define BIT_MASK_WATCH_DOG_TIMER_8822C 0xf -+#define BIT_WATCH_DOG_TIMER_8822C(x) \ -+ (((x) & BIT_MASK_WATCH_DOG_TIMER_8822C) \ -+ << BIT_SHIFT_WATCH_DOG_TIMER_8822C) -+#define BITS_WATCH_DOG_TIMER_8822C \ -+ (BIT_MASK_WATCH_DOG_TIMER_8822C << BIT_SHIFT_WATCH_DOG_TIMER_8822C) -+#define BIT_CLEAR_WATCH_DOG_TIMER_8822C(x) ((x) & (~BITS_WATCH_DOG_TIMER_8822C)) -+#define BIT_GET_WATCH_DOG_TIMER_8822C(x) \ -+ (((x) >> BIT_SHIFT_WATCH_DOG_TIMER_8822C) & \ -+ BIT_MASK_WATCH_DOG_TIMER_8822C) -+#define BIT_SET_WATCH_DOG_TIMER_8822C(x, v) \ -+ (BIT_CLEAR_WATCH_DOG_TIMER_8822C(x) | BIT_WATCH_DOG_TIMER_8822C(v)) -+ -+#define BIT_EN_ALIGN_MTU_8822C BIT(23) -+ -+#define BIT_SHIFT_LATENCY_CONTROL_8822C 21 -+#define BIT_MASK_LATENCY_CONTROL_8822C 0x3 -+#define BIT_LATENCY_CONTROL_8822C(x) \ -+ (((x) & BIT_MASK_LATENCY_CONTROL_8822C) \ -+ << BIT_SHIFT_LATENCY_CONTROL_8822C) -+#define BITS_LATENCY_CONTROL_8822C \ -+ (BIT_MASK_LATENCY_CONTROL_8822C << BIT_SHIFT_LATENCY_CONTROL_8822C) -+#define BIT_CLEAR_LATENCY_CONTROL_8822C(x) ((x) & (~BITS_LATENCY_CONTROL_8822C)) -+#define BIT_GET_LATENCY_CONTROL_8822C(x) \ -+ (((x) >> BIT_SHIFT_LATENCY_CONTROL_8822C) & \ -+ BIT_MASK_LATENCY_CONTROL_8822C) -+#define BIT_SET_LATENCY_CONTROL_8822C(x, v) \ -+ (BIT_CLEAR_LATENCY_CONTROL_8822C(x) | BIT_LATENCY_CONTROL_8822C(v)) -+ -+#define BIT_HOST_GEN2_SUPPORT_8822C BIT(20) -+ -+#define BIT_SHIFT_TXDMA_ERR_FLAG_V1_8822C 15 -+#define BIT_MASK_TXDMA_ERR_FLAG_V1_8822C 0x1f -+#define BIT_TXDMA_ERR_FLAG_V1_8822C(x) \ -+ (((x) & BIT_MASK_TXDMA_ERR_FLAG_V1_8822C) \ -+ << BIT_SHIFT_TXDMA_ERR_FLAG_V1_8822C) -+#define BITS_TXDMA_ERR_FLAG_V1_8822C \ -+ (BIT_MASK_TXDMA_ERR_FLAG_V1_8822C << BIT_SHIFT_TXDMA_ERR_FLAG_V1_8822C) -+#define BIT_CLEAR_TXDMA_ERR_FLAG_V1_8822C(x) \ -+ ((x) & (~BITS_TXDMA_ERR_FLAG_V1_8822C)) -+#define BIT_GET_TXDMA_ERR_FLAG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXDMA_ERR_FLAG_V1_8822C) & \ -+ BIT_MASK_TXDMA_ERR_FLAG_V1_8822C) -+#define BIT_SET_TXDMA_ERR_FLAG_V1_8822C(x, v) \ -+ (BIT_CLEAR_TXDMA_ERR_FLAG_V1_8822C(x) | BIT_TXDMA_ERR_FLAG_V1_8822C(v)) -+ -+#define BIT_EPHY_RX50_EN_8822C BIT(11) -+ -+#define BIT_SHIFT_MSI_TIMEOUT_ID_V1_8822C 8 -+#define BIT_MASK_MSI_TIMEOUT_ID_V1_8822C 0x7 -+#define BIT_MSI_TIMEOUT_ID_V1_8822C(x) \ -+ (((x) & BIT_MASK_MSI_TIMEOUT_ID_V1_8822C) \ -+ << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8822C) -+#define BITS_MSI_TIMEOUT_ID_V1_8822C \ -+ (BIT_MASK_MSI_TIMEOUT_ID_V1_8822C << BIT_SHIFT_MSI_TIMEOUT_ID_V1_8822C) -+#define BIT_CLEAR_MSI_TIMEOUT_ID_V1_8822C(x) \ -+ ((x) & (~BITS_MSI_TIMEOUT_ID_V1_8822C)) -+#define BIT_GET_MSI_TIMEOUT_ID_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MSI_TIMEOUT_ID_V1_8822C) & \ -+ BIT_MASK_MSI_TIMEOUT_ID_V1_8822C) -+#define BIT_SET_MSI_TIMEOUT_ID_V1_8822C(x, v) \ -+ (BIT_CLEAR_MSI_TIMEOUT_ID_V1_8822C(x) | BIT_MSI_TIMEOUT_ID_V1_8822C(v)) -+ -+#define BIT_RADDR_RD_8822C BIT(7) -+#define BIT_L1OFF_PWR_OFF_EN_8822C BIT(6) -+#define BIT_L0S_LINK_OFF_8822C BIT(4) -+#define BIT_ACT_LINK_OFF_8822C BIT(3) -+#define BIT_EN_SLOW_MAC_TX_8822C BIT(2) -+#define BIT_EN_SLOW_MAC_RX_8822C BIT(1) -+#define BIT_EN_SLOW_MAC_HW_8822C BIT(0) -+ -+/* 2 REG_STC_INT_CS_8822C(PCIE STATE CHANGE INTERRUPT CONTROL AND STATUS) */ -+#define BIT_STC_INT_EN_8822C BIT(31) -+ -+#define BIT_SHIFT_STC_INT_FLAG_8822C 16 -+#define BIT_MASK_STC_INT_FLAG_8822C 0xff -+#define BIT_STC_INT_FLAG_8822C(x) \ -+ (((x) & BIT_MASK_STC_INT_FLAG_8822C) << BIT_SHIFT_STC_INT_FLAG_8822C) -+#define BITS_STC_INT_FLAG_8822C \ -+ (BIT_MASK_STC_INT_FLAG_8822C << BIT_SHIFT_STC_INT_FLAG_8822C) -+#define BIT_CLEAR_STC_INT_FLAG_8822C(x) ((x) & (~BITS_STC_INT_FLAG_8822C)) -+#define BIT_GET_STC_INT_FLAG_8822C(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_FLAG_8822C) & BIT_MASK_STC_INT_FLAG_8822C) -+#define BIT_SET_STC_INT_FLAG_8822C(x, v) \ -+ (BIT_CLEAR_STC_INT_FLAG_8822C(x) | BIT_STC_INT_FLAG_8822C(v)) -+ -+#define BIT_SHIFT_STC_INT_IDX_8822C 8 -+#define BIT_MASK_STC_INT_IDX_8822C 0x7 -+#define BIT_STC_INT_IDX_8822C(x) \ -+ (((x) & BIT_MASK_STC_INT_IDX_8822C) << BIT_SHIFT_STC_INT_IDX_8822C) -+#define BITS_STC_INT_IDX_8822C \ -+ (BIT_MASK_STC_INT_IDX_8822C << BIT_SHIFT_STC_INT_IDX_8822C) -+#define BIT_CLEAR_STC_INT_IDX_8822C(x) ((x) & (~BITS_STC_INT_IDX_8822C)) -+#define BIT_GET_STC_INT_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_IDX_8822C) & BIT_MASK_STC_INT_IDX_8822C) -+#define BIT_SET_STC_INT_IDX_8822C(x, v) \ -+ (BIT_CLEAR_STC_INT_IDX_8822C(x) | BIT_STC_INT_IDX_8822C(v)) -+ -+#define BIT_SHIFT_STC_INT_REALTIME_CS_8822C 0 -+#define BIT_MASK_STC_INT_REALTIME_CS_8822C 0x3f -+#define BIT_STC_INT_REALTIME_CS_8822C(x) \ -+ (((x) & BIT_MASK_STC_INT_REALTIME_CS_8822C) \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8822C) -+#define BITS_STC_INT_REALTIME_CS_8822C \ -+ (BIT_MASK_STC_INT_REALTIME_CS_8822C \ -+ << BIT_SHIFT_STC_INT_REALTIME_CS_8822C) -+#define BIT_CLEAR_STC_INT_REALTIME_CS_8822C(x) \ -+ ((x) & (~BITS_STC_INT_REALTIME_CS_8822C)) -+#define BIT_GET_STC_INT_REALTIME_CS_8822C(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_REALTIME_CS_8822C) & \ -+ BIT_MASK_STC_INT_REALTIME_CS_8822C) -+#define BIT_SET_STC_INT_REALTIME_CS_8822C(x, v) \ -+ (BIT_CLEAR_STC_INT_REALTIME_CS_8822C(x) | \ -+ BIT_STC_INT_REALTIME_CS_8822C(v)) -+ -+#define BIT_STC_INT_GRP_EN_8822C BIT(31) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_LS_8822C 8 -+#define BIT_MASK_STC_INT_EXPECT_LS_8822C 0x3f -+#define BIT_STC_INT_EXPECT_LS_8822C(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_LS_8822C) \ -+ << BIT_SHIFT_STC_INT_EXPECT_LS_8822C) -+#define BITS_STC_INT_EXPECT_LS_8822C \ -+ (BIT_MASK_STC_INT_EXPECT_LS_8822C << BIT_SHIFT_STC_INT_EXPECT_LS_8822C) -+#define BIT_CLEAR_STC_INT_EXPECT_LS_8822C(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_LS_8822C)) -+#define BIT_GET_STC_INT_EXPECT_LS_8822C(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_LS_8822C) & \ -+ BIT_MASK_STC_INT_EXPECT_LS_8822C) -+#define BIT_SET_STC_INT_EXPECT_LS_8822C(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_LS_8822C(x) | BIT_STC_INT_EXPECT_LS_8822C(v)) -+ -+#define BIT_SHIFT_STC_INT_EXPECT_CS_8822C 0 -+#define BIT_MASK_STC_INT_EXPECT_CS_8822C 0x3f -+#define BIT_STC_INT_EXPECT_CS_8822C(x) \ -+ (((x) & BIT_MASK_STC_INT_EXPECT_CS_8822C) \ -+ << BIT_SHIFT_STC_INT_EXPECT_CS_8822C) -+#define BITS_STC_INT_EXPECT_CS_8822C \ -+ (BIT_MASK_STC_INT_EXPECT_CS_8822C << BIT_SHIFT_STC_INT_EXPECT_CS_8822C) -+#define BIT_CLEAR_STC_INT_EXPECT_CS_8822C(x) \ -+ ((x) & (~BITS_STC_INT_EXPECT_CS_8822C)) -+#define BIT_GET_STC_INT_EXPECT_CS_8822C(x) \ -+ (((x) >> BIT_SHIFT_STC_INT_EXPECT_CS_8822C) & \ -+ BIT_MASK_STC_INT_EXPECT_CS_8822C) -+#define BIT_SET_STC_INT_EXPECT_CS_8822C(x, v) \ -+ (BIT_CLEAR_STC_INT_EXPECT_CS_8822C(x) | BIT_STC_INT_EXPECT_CS_8822C(v)) -+ -+/* 2 REG_H2CQ_TXBD_DESA_8822C */ -+ -+#define BIT_SHIFT_H2CQ_TXBD_DESA_8822C 0 -+#define BIT_MASK_H2CQ_TXBD_DESA_8822C 0xffffffffffffffffL -+#define BIT_H2CQ_TXBD_DESA_8822C(x) \ -+ (((x) & BIT_MASK_H2CQ_TXBD_DESA_8822C) \ -+ << BIT_SHIFT_H2CQ_TXBD_DESA_8822C) -+#define BITS_H2CQ_TXBD_DESA_8822C \ -+ (BIT_MASK_H2CQ_TXBD_DESA_8822C << BIT_SHIFT_H2CQ_TXBD_DESA_8822C) -+#define BIT_CLEAR_H2CQ_TXBD_DESA_8822C(x) ((x) & (~BITS_H2CQ_TXBD_DESA_8822C)) -+#define BIT_GET_H2CQ_TXBD_DESA_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_TXBD_DESA_8822C) & \ -+ BIT_MASK_H2CQ_TXBD_DESA_8822C) -+#define BIT_SET_H2CQ_TXBD_DESA_8822C(x, v) \ -+ (BIT_CLEAR_H2CQ_TXBD_DESA_8822C(x) | BIT_H2CQ_TXBD_DESA_8822C(v)) -+ -+/* 2 REG_H2CQ_TXBD_NUM_8822C */ -+#define BIT_PCIE_H2CQ_FLAG_8822C BIT(14) -+ -+#define BIT_SHIFT_H2CQ_DESC_MODE_8822C 12 -+#define BIT_MASK_H2CQ_DESC_MODE_8822C 0x3 -+#define BIT_H2CQ_DESC_MODE_8822C(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_MODE_8822C) \ -+ << BIT_SHIFT_H2CQ_DESC_MODE_8822C) -+#define BITS_H2CQ_DESC_MODE_8822C \ -+ (BIT_MASK_H2CQ_DESC_MODE_8822C << BIT_SHIFT_H2CQ_DESC_MODE_8822C) -+#define BIT_CLEAR_H2CQ_DESC_MODE_8822C(x) ((x) & (~BITS_H2CQ_DESC_MODE_8822C)) -+#define BIT_GET_H2CQ_DESC_MODE_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_MODE_8822C) & \ -+ BIT_MASK_H2CQ_DESC_MODE_8822C) -+#define BIT_SET_H2CQ_DESC_MODE_8822C(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_MODE_8822C(x) | BIT_H2CQ_DESC_MODE_8822C(v)) -+ -+#define BIT_SHIFT_H2CQ_DESC_NUM_8822C 0 -+#define BIT_MASK_H2CQ_DESC_NUM_8822C 0xfff -+#define BIT_H2CQ_DESC_NUM_8822C(x) \ -+ (((x) & BIT_MASK_H2CQ_DESC_NUM_8822C) << BIT_SHIFT_H2CQ_DESC_NUM_8822C) -+#define BITS_H2CQ_DESC_NUM_8822C \ -+ (BIT_MASK_H2CQ_DESC_NUM_8822C << BIT_SHIFT_H2CQ_DESC_NUM_8822C) -+#define BIT_CLEAR_H2CQ_DESC_NUM_8822C(x) ((x) & (~BITS_H2CQ_DESC_NUM_8822C)) -+#define BIT_GET_H2CQ_DESC_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_DESC_NUM_8822C) & BIT_MASK_H2CQ_DESC_NUM_8822C) -+#define BIT_SET_H2CQ_DESC_NUM_8822C(x, v) \ -+ (BIT_CLEAR_H2CQ_DESC_NUM_8822C(x) | BIT_H2CQ_DESC_NUM_8822C(v)) -+ -+/* 2 REG_H2CQ_TXBD_IDX_8822C */ -+ -+#define BIT_SHIFT_H2CQ_HW_IDX_8822C 16 -+#define BIT_MASK_H2CQ_HW_IDX_8822C 0xfff -+#define BIT_H2CQ_HW_IDX_8822C(x) \ -+ (((x) & BIT_MASK_H2CQ_HW_IDX_8822C) << BIT_SHIFT_H2CQ_HW_IDX_8822C) -+#define BITS_H2CQ_HW_IDX_8822C \ -+ (BIT_MASK_H2CQ_HW_IDX_8822C << BIT_SHIFT_H2CQ_HW_IDX_8822C) -+#define BIT_CLEAR_H2CQ_HW_IDX_8822C(x) ((x) & (~BITS_H2CQ_HW_IDX_8822C)) -+#define BIT_GET_H2CQ_HW_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HW_IDX_8822C) & BIT_MASK_H2CQ_HW_IDX_8822C) -+#define BIT_SET_H2CQ_HW_IDX_8822C(x, v) \ -+ (BIT_CLEAR_H2CQ_HW_IDX_8822C(x) | BIT_H2CQ_HW_IDX_8822C(v)) -+ -+#define BIT_SHIFT_H2CQ_HOST_IDX_8822C 0 -+#define BIT_MASK_H2CQ_HOST_IDX_8822C 0xfff -+#define BIT_H2CQ_HOST_IDX_8822C(x) \ -+ (((x) & BIT_MASK_H2CQ_HOST_IDX_8822C) << BIT_SHIFT_H2CQ_HOST_IDX_8822C) -+#define BITS_H2CQ_HOST_IDX_8822C \ -+ (BIT_MASK_H2CQ_HOST_IDX_8822C << BIT_SHIFT_H2CQ_HOST_IDX_8822C) -+#define BIT_CLEAR_H2CQ_HOST_IDX_8822C(x) ((x) & (~BITS_H2CQ_HOST_IDX_8822C)) -+#define BIT_GET_H2CQ_HOST_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_H2CQ_HOST_IDX_8822C) & BIT_MASK_H2CQ_HOST_IDX_8822C) -+#define BIT_SET_H2CQ_HOST_IDX_8822C(x, v) \ -+ (BIT_CLEAR_H2CQ_HOST_IDX_8822C(x) | BIT_H2CQ_HOST_IDX_8822C(v)) -+ -+/* 2 REG_H2CQ_CSR_8822C[31:0] (H2CQ CONTROL AND STATUS) */ -+#define BIT_H2CQ_FULL_8822C BIT(31) -+#define BIT_CLR_H2CQ_HOST_IDX_8822C BIT(16) -+#define BIT_CLR_H2CQ_HW_IDX_8822C BIT(8) -+#define BIT_STOP_H2CQ_8822C BIT(0) -+ -+/* 2 REG_CHANGE_PCIE_SPEED_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_RXDMA_ERR_CNT_8822C 8 -+#define BIT_MASK_RXDMA_ERR_CNT_8822C 0xff -+#define BIT_RXDMA_ERR_CNT_8822C(x) \ -+ (((x) & BIT_MASK_RXDMA_ERR_CNT_8822C) << BIT_SHIFT_RXDMA_ERR_CNT_8822C) -+#define BITS_RXDMA_ERR_CNT_8822C \ -+ (BIT_MASK_RXDMA_ERR_CNT_8822C << BIT_SHIFT_RXDMA_ERR_CNT_8822C) -+#define BIT_CLEAR_RXDMA_ERR_CNT_8822C(x) ((x) & (~BITS_RXDMA_ERR_CNT_8822C)) -+#define BIT_GET_RXDMA_ERR_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXDMA_ERR_CNT_8822C) & BIT_MASK_RXDMA_ERR_CNT_8822C) -+#define BIT_SET_RXDMA_ERR_CNT_8822C(x, v) \ -+ (BIT_CLEAR_RXDMA_ERR_CNT_8822C(x) | BIT_RXDMA_ERR_CNT_8822C(v)) -+ -+#define BIT_TXDMA_ERR_HANDLE_REQ_8822C BIT(7) -+#define BIT_TXDMA_ERROR_PS_8822C BIT(6) -+#define BIT_EN_TXDMA_STUCK_ERR_HANDLE_8822C BIT(5) -+#define BIT_EN_TXDMA_RTN_ERR_HANDLE_8822C BIT(4) -+#define BIT_RXDMA_ERR_HANDLE_REQ_8822C BIT(3) -+#define BIT_RXDMA_ERROR_PS_8822C BIT(2) -+#define BIT_EN_RXDMA_STUCK_ERR_HANDLE_8822C BIT(1) -+#define BIT_EN_RXDMA_RTN_ERR_HANDLE_8822C BIT(0) -+ -+/* 2 REG_DEBUG_STATE1_8822C */ -+ -+#define BIT_SHIFT_DEBUG_STATE1_8822C 0 -+#define BIT_MASK_DEBUG_STATE1_8822C 0xffffffffL -+#define BIT_DEBUG_STATE1_8822C(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE1_8822C) << BIT_SHIFT_DEBUG_STATE1_8822C) -+#define BITS_DEBUG_STATE1_8822C \ -+ (BIT_MASK_DEBUG_STATE1_8822C << BIT_SHIFT_DEBUG_STATE1_8822C) -+#define BIT_CLEAR_DEBUG_STATE1_8822C(x) ((x) & (~BITS_DEBUG_STATE1_8822C)) -+#define BIT_GET_DEBUG_STATE1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE1_8822C) & BIT_MASK_DEBUG_STATE1_8822C) -+#define BIT_SET_DEBUG_STATE1_8822C(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE1_8822C(x) | BIT_DEBUG_STATE1_8822C(v)) -+ -+/* 2 REG_DEBUG_STATE2_8822C */ -+ -+#define BIT_SHIFT_DEBUG_STATE2_8822C 0 -+#define BIT_MASK_DEBUG_STATE2_8822C 0xffffffffL -+#define BIT_DEBUG_STATE2_8822C(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE2_8822C) << BIT_SHIFT_DEBUG_STATE2_8822C) -+#define BITS_DEBUG_STATE2_8822C \ -+ (BIT_MASK_DEBUG_STATE2_8822C << BIT_SHIFT_DEBUG_STATE2_8822C) -+#define BIT_CLEAR_DEBUG_STATE2_8822C(x) ((x) & (~BITS_DEBUG_STATE2_8822C)) -+#define BIT_GET_DEBUG_STATE2_8822C(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE2_8822C) & BIT_MASK_DEBUG_STATE2_8822C) -+#define BIT_SET_DEBUG_STATE2_8822C(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE2_8822C(x) | BIT_DEBUG_STATE2_8822C(v)) -+ -+/* 2 REG_DEBUG_STATE3_8822C */ -+ -+#define BIT_SHIFT_DEBUG_STATE3_8822C 0 -+#define BIT_MASK_DEBUG_STATE3_8822C 0xffffffffL -+#define BIT_DEBUG_STATE3_8822C(x) \ -+ (((x) & BIT_MASK_DEBUG_STATE3_8822C) << BIT_SHIFT_DEBUG_STATE3_8822C) -+#define BITS_DEBUG_STATE3_8822C \ -+ (BIT_MASK_DEBUG_STATE3_8822C << BIT_SHIFT_DEBUG_STATE3_8822C) -+#define BIT_CLEAR_DEBUG_STATE3_8822C(x) ((x) & (~BITS_DEBUG_STATE3_8822C)) -+#define BIT_GET_DEBUG_STATE3_8822C(x) \ -+ (((x) >> BIT_SHIFT_DEBUG_STATE3_8822C) & BIT_MASK_DEBUG_STATE3_8822C) -+#define BIT_SET_DEBUG_STATE3_8822C(x, v) \ -+ (BIT_CLEAR_DEBUG_STATE3_8822C(x) | BIT_DEBUG_STATE3_8822C(v)) -+ -+/* 2 REG_CHNL_DMA_CFG_V1_8822C */ -+#define BIT_TXHCI_EN_V1_8822C BIT(26) -+#define BIT_TXHCI_IDLE_V1_8822C BIT(25) -+#define BIT_DMA_PRI_EN_V1_8822C BIT(24) -+ -+/* 2 REG_PCIE_HISR0_V1_8822C */ -+#define BIT_PSTIMER_2_8822C BIT(31) -+#define BIT_PSTIMER_1_8822C BIT(30) -+#define BIT_PSTIMER_0_8822C BIT(29) -+#define BIT_GTINT4_8822C BIT(28) -+#define BIT_GTINT3_8822C BIT(27) -+#define BIT_TXBCN0ERR_8822C BIT(26) -+#define BIT_TXBCN0OK_8822C BIT(25) -+#define BIT_TSF_BIT32_TOGGLE_8822C BIT(24) -+#define BIT_TXDMA_START_INT_8822C BIT(23) -+#define BIT_TXDMA_STOP_INT_8822C BIT(22) -+#define BIT_HISR7_IND_8822C BIT(21) -+#define BIT_BCNDMAINT0_8822C BIT(20) -+#define BIT_HISR6_IND_8822C BIT(19) -+#define BIT_HISR5_IND_8822C BIT(18) -+#define BIT_HISR4_IND_8822C BIT(17) -+#define BIT_BCNDERR0_8822C BIT(16) -+#define BIT_HSISR_IND_ON_INT_8822C BIT(15) -+#define BIT_HISR3_IND_8822C BIT(14) -+#define BIT_HISR2_IND_8822C BIT(13) -+#define BIT_HISR1_IND_8822C BIT(11) -+#define BIT_C2HCMD_8822C BIT(10) -+#define BIT_CPWM2_8822C BIT(9) -+#define BIT_CPWM_8822C BIT(8) -+#define BIT_TXDMAOK_CHANNEL15_8822C BIT(7) -+#define BIT_TXDMAOK_CHANNEL14_8822C BIT(6) -+#define BIT_TXDMAOK_CHANNEL3_8822C BIT(5) -+#define BIT_TXDMAOK_CHANNEL2_8822C BIT(4) -+#define BIT_TXDMAOK_CHANNEL1_8822C BIT(3) -+#define BIT_TXDMAOK_CHANNEL0_8822C BIT(2) -+#define BIT_RDU_8822C BIT(1) -+#define BIT_RXOK_8822C BIT(0) -+ -+/* 2 REG_PCIE_HISR1_V1_8822C */ -+#define BIT_PRE_TX_ERR_INT_8822C BIT(31) -+#define BIT_TXFIFO_TH_INT_8822C BIT(30) -+#define BIT_BTON_STS_UPDATE_INT_8822C BIT(29) -+#define BIT_BCNDMAINT7_8822C BIT(27) -+#define BIT_BCNDMAINT6_8822C BIT(26) -+#define BIT_BCNDMAINT5_8822C BIT(25) -+#define BIT_BCNDMAINT4_8822C BIT(24) -+#define BIT_BCNDMAINT3_8822C BIT(23) -+#define BIT_BCNDMAINT2_8822C BIT(22) -+#define BIT_BCNDMAINT1_8822C BIT(21) -+#define BIT_BCNDERR7_8822C BIT(20) -+#define BIT_BCNDERR6_8822C BIT(19) -+#define BIT_BCNDERR5_8822C BIT(18) -+#define BIT_BCNDERR4_8822C BIT(17) -+#define BIT_BCNDERR3_8822C BIT(16) -+#define BIT_BCNDERR2_8822C BIT(15) -+#define BIT_BCNDERR1_8822C BIT(14) -+#define BIT_ATIMEND_8822C BIT(12) -+#define BIT_TXERR_INT_8822C BIT(11) -+#define BIT_RXERR_INT_8822C BIT(10) -+#define BIT_TXFOVW_8822C BIT(9) -+#define BIT_FOVW_8822C BIT(8) -+#define BIT_CPU_MGQ_EARLY_INT_8822C BIT(6) -+#define BIT_CPU_MGQ_TXDONE_8822C BIT(5) -+#define BIT_PSTIMER_5_8822C BIT(4) -+#define BIT_PSTIMER_4_8822C BIT(3) -+#define BIT_PSTIMER_3_8822C BIT(2) -+#define BIT_CPUMGQ_TX_TIMER_8822C BIT(1) -+#define BIT_BB_STOPRX_INT_8822C BIT(0) -+ -+/* 2 REG_PCIE_HISR2_V1_8822C */ -+#define BIT_BCNDMAINT_P4_8822C BIT(31) -+#define BIT_BCNDMAINT_P3_8822C BIT(30) -+#define BIT_BCNDMAINT_P2_8822C BIT(29) -+#define BIT_BCNDMAINT_P1_8822C BIT(28) -+#define BIT_SCH_PHY_TXOP_SIFS_INT_8822C BIT(23) -+#define BIT_ATIMEND7_8822C BIT(22) -+#define BIT_ATIMEND6_8822C BIT(21) -+#define BIT_ATIMEND5_8822C BIT(20) -+#define BIT_ATIMEND4_8822C BIT(19) -+#define BIT_ATIMEND3_8822C BIT(18) -+#define BIT_ATIMEND2_8822C BIT(17) -+#define BIT_ATIMEND1_8822C BIT(16) -+#define BIT_TXBCN7OK_8822C BIT(14) -+#define BIT_TXBCN6OK_8822C BIT(13) -+#define BIT_TXBCN5OK_8822C BIT(12) -+#define BIT_TXBCN4OK_8822C BIT(11) -+#define BIT_TXBCN3OK_8822C BIT(10) -+#define BIT_TXBCN2OK_8822C BIT(9) -+#define BIT_TXBCN1OK_8822C BIT(8) -+#define BIT_TXBCN7ERR_8822C BIT(6) -+#define BIT_TXBCN6ERR_8822C BIT(5) -+#define BIT_TXBCN5ERR_8822C BIT(4) -+#define BIT_TXBCN4ERR_8822C BIT(3) -+#define BIT_TXBCN3ERR_8822C BIT(2) -+#define BIT_TXBCN2ERR_8822C BIT(1) -+#define BIT_TXBCN1ERR_8822C BIT(0) -+ -+/* 2 REG_PCIE_HISR3_V1_8822C */ -+#define BIT_GTINT12_8822C BIT(24) -+#define BIT_GTINT11_8822C BIT(23) -+#define BIT_GTINT10_8822C BIT(22) -+#define BIT_GTINT9_8822C BIT(21) -+#define BIT_RX_DESC_BUF_FULL_8822C BIT(20) -+#define BIT_CPHY_LDO_OCP_DET_INT_8822C BIT(19) -+#define BIT_WDT_PLATFORM_INT_8822C BIT(18) -+#define BIT_WDT_CPU_INT_8822C BIT(17) -+#define BIT_SETH2CDOK_8822C BIT(16) -+#define BIT_H2C_CMD_FULL_8822C BIT(15) -+#define BIT_PKT_TRANS_ERR_8822C BIT(14) -+#define BIT_TXSHORTCUT_TXDESUPDATEOK_8822C BIT(13) -+#define BIT_TXSHORTCUT_BKUPDATEOK_8822C BIT(12) -+#define BIT_TXSHORTCUT_BEUPDATEOK_8822C BIT(11) -+#define BIT_TXSHORTCUT_VIUPDATEOK_8822C BIT(10) -+#define BIT_TXSHORTCUT_VOUPDATEOK_8822C BIT(9) -+#define BIT_SEARCH_FAIL_8822C BIT(8) -+#define BIT_PWR_INT_127TO96_8822C BIT(7) -+#define BIT_PWR_INT_95TO64_8822C BIT(6) -+#define BIT_PWR_INT_63TO32_8822C BIT(5) -+#define BIT_PWR_INT_31TO0_8822C BIT(4) -+#define BIT_RX_DMA_STUCK_8822C BIT(3) -+#define BIT_TX_DMA_STUCK_8822C BIT(2) -+#define BIT_DDMA0_LP_INT_8822C BIT(1) -+#define BIT_DDMA0_HP_INT_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_Q0_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q0_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_Q0_V1_8822C 0x7f -+#define BIT_QUEUEMACID_Q0_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q0_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_Q0_V1_8822C) -+#define BITS_QUEUEMACID_Q0_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_Q0_V1_8822C << BIT_SHIFT_QUEUEMACID_Q0_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_Q0_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q0_V1_8822C)) -+#define BIT_GET_QUEUEMACID_Q0_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q0_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_Q0_V1_8822C) -+#define BIT_SET_QUEUEMACID_Q0_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q0_V1_8822C(x) | BIT_QUEUEMACID_Q0_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q0_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_Q0_V1_8822C 0x3 -+#define BIT_QUEUEAC_Q0_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q0_V1_8822C) << BIT_SHIFT_QUEUEAC_Q0_V1_8822C) -+#define BITS_QUEUEAC_Q0_V1_8822C \ -+ (BIT_MASK_QUEUEAC_Q0_V1_8822C << BIT_SHIFT_QUEUEAC_Q0_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_Q0_V1_8822C(x) ((x) & (~BITS_QUEUEAC_Q0_V1_8822C)) -+#define BIT_GET_QUEUEAC_Q0_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q0_V1_8822C) & BIT_MASK_QUEUEAC_Q0_V1_8822C) -+#define BIT_SET_QUEUEAC_Q0_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q0_V1_8822C(x) | BIT_QUEUEAC_Q0_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_Q0_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q0_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_Q0_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_Q0_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q0_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_Q0_V2_8822C) -+#define BITS_TAIL_PKT_Q0_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_Q0_V2_8822C << BIT_SHIFT_TAIL_PKT_Q0_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_Q0_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_Q0_V2_8822C)) -+#define BIT_GET_TAIL_PKT_Q0_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q0_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_Q0_V2_8822C) -+#define BIT_SET_TAIL_PKT_Q0_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q0_V2_8822C(x) | BIT_TAIL_PKT_Q0_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q0_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_Q0_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_Q0_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q0_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_Q0_V1_8822C) -+#define BITS_HEAD_PKT_Q0_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_Q0_V1_8822C << BIT_SHIFT_HEAD_PKT_Q0_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_Q0_V1_8822C(x) ((x) & (~BITS_HEAD_PKT_Q0_V1_8822C)) -+#define BIT_GET_HEAD_PKT_Q0_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q0_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_Q0_V1_8822C) -+#define BIT_SET_HEAD_PKT_Q0_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q0_V1_8822C(x) | BIT_HEAD_PKT_Q0_V1_8822C(v)) -+ -+/* 2 REG_Q1_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q1_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_Q1_V1_8822C 0x7f -+#define BIT_QUEUEMACID_Q1_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q1_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_Q1_V1_8822C) -+#define BITS_QUEUEMACID_Q1_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_Q1_V1_8822C << BIT_SHIFT_QUEUEMACID_Q1_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_Q1_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q1_V1_8822C)) -+#define BIT_GET_QUEUEMACID_Q1_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q1_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_Q1_V1_8822C) -+#define BIT_SET_QUEUEMACID_Q1_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q1_V1_8822C(x) | BIT_QUEUEMACID_Q1_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q1_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_Q1_V1_8822C 0x3 -+#define BIT_QUEUEAC_Q1_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q1_V1_8822C) << BIT_SHIFT_QUEUEAC_Q1_V1_8822C) -+#define BITS_QUEUEAC_Q1_V1_8822C \ -+ (BIT_MASK_QUEUEAC_Q1_V1_8822C << BIT_SHIFT_QUEUEAC_Q1_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_Q1_V1_8822C(x) ((x) & (~BITS_QUEUEAC_Q1_V1_8822C)) -+#define BIT_GET_QUEUEAC_Q1_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q1_V1_8822C) & BIT_MASK_QUEUEAC_Q1_V1_8822C) -+#define BIT_SET_QUEUEAC_Q1_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q1_V1_8822C(x) | BIT_QUEUEAC_Q1_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_Q1_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q1_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_Q1_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_Q1_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q1_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_Q1_V2_8822C) -+#define BITS_TAIL_PKT_Q1_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_Q1_V2_8822C << BIT_SHIFT_TAIL_PKT_Q1_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_Q1_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_Q1_V2_8822C)) -+#define BIT_GET_TAIL_PKT_Q1_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q1_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_Q1_V2_8822C) -+#define BIT_SET_TAIL_PKT_Q1_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q1_V2_8822C(x) | BIT_TAIL_PKT_Q1_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q1_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_Q1_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_Q1_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q1_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_Q1_V1_8822C) -+#define BITS_HEAD_PKT_Q1_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_Q1_V1_8822C << BIT_SHIFT_HEAD_PKT_Q1_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_Q1_V1_8822C(x) ((x) & (~BITS_HEAD_PKT_Q1_V1_8822C)) -+#define BIT_GET_HEAD_PKT_Q1_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q1_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_Q1_V1_8822C) -+#define BIT_SET_HEAD_PKT_Q1_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q1_V1_8822C(x) | BIT_HEAD_PKT_Q1_V1_8822C(v)) -+ -+/* 2 REG_Q2_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q2_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_Q2_V1_8822C 0x7f -+#define BIT_QUEUEMACID_Q2_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q2_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_Q2_V1_8822C) -+#define BITS_QUEUEMACID_Q2_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_Q2_V1_8822C << BIT_SHIFT_QUEUEMACID_Q2_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_Q2_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q2_V1_8822C)) -+#define BIT_GET_QUEUEMACID_Q2_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q2_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_Q2_V1_8822C) -+#define BIT_SET_QUEUEMACID_Q2_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q2_V1_8822C(x) | BIT_QUEUEMACID_Q2_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q2_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_Q2_V1_8822C 0x3 -+#define BIT_QUEUEAC_Q2_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q2_V1_8822C) << BIT_SHIFT_QUEUEAC_Q2_V1_8822C) -+#define BITS_QUEUEAC_Q2_V1_8822C \ -+ (BIT_MASK_QUEUEAC_Q2_V1_8822C << BIT_SHIFT_QUEUEAC_Q2_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_Q2_V1_8822C(x) ((x) & (~BITS_QUEUEAC_Q2_V1_8822C)) -+#define BIT_GET_QUEUEAC_Q2_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q2_V1_8822C) & BIT_MASK_QUEUEAC_Q2_V1_8822C) -+#define BIT_SET_QUEUEAC_Q2_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q2_V1_8822C(x) | BIT_QUEUEAC_Q2_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_Q2_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q2_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_Q2_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_Q2_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q2_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_Q2_V2_8822C) -+#define BITS_TAIL_PKT_Q2_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_Q2_V2_8822C << BIT_SHIFT_TAIL_PKT_Q2_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_Q2_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_Q2_V2_8822C)) -+#define BIT_GET_TAIL_PKT_Q2_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q2_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_Q2_V2_8822C) -+#define BIT_SET_TAIL_PKT_Q2_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q2_V2_8822C(x) | BIT_TAIL_PKT_Q2_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q2_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_Q2_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_Q2_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q2_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_Q2_V1_8822C) -+#define BITS_HEAD_PKT_Q2_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_Q2_V1_8822C << BIT_SHIFT_HEAD_PKT_Q2_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_Q2_V1_8822C(x) ((x) & (~BITS_HEAD_PKT_Q2_V1_8822C)) -+#define BIT_GET_HEAD_PKT_Q2_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q2_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_Q2_V1_8822C) -+#define BIT_SET_HEAD_PKT_Q2_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q2_V1_8822C(x) | BIT_HEAD_PKT_Q2_V1_8822C(v)) -+ -+/* 2 REG_Q3_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q3_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_Q3_V1_8822C 0x7f -+#define BIT_QUEUEMACID_Q3_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q3_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_Q3_V1_8822C) -+#define BITS_QUEUEMACID_Q3_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_Q3_V1_8822C << BIT_SHIFT_QUEUEMACID_Q3_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_Q3_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q3_V1_8822C)) -+#define BIT_GET_QUEUEMACID_Q3_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q3_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_Q3_V1_8822C) -+#define BIT_SET_QUEUEMACID_Q3_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q3_V1_8822C(x) | BIT_QUEUEMACID_Q3_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q3_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_Q3_V1_8822C 0x3 -+#define BIT_QUEUEAC_Q3_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q3_V1_8822C) << BIT_SHIFT_QUEUEAC_Q3_V1_8822C) -+#define BITS_QUEUEAC_Q3_V1_8822C \ -+ (BIT_MASK_QUEUEAC_Q3_V1_8822C << BIT_SHIFT_QUEUEAC_Q3_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_Q3_V1_8822C(x) ((x) & (~BITS_QUEUEAC_Q3_V1_8822C)) -+#define BIT_GET_QUEUEAC_Q3_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q3_V1_8822C) & BIT_MASK_QUEUEAC_Q3_V1_8822C) -+#define BIT_SET_QUEUEAC_Q3_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q3_V1_8822C(x) | BIT_QUEUEAC_Q3_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_Q3_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q3_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_Q3_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_Q3_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q3_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_Q3_V2_8822C) -+#define BITS_TAIL_PKT_Q3_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_Q3_V2_8822C << BIT_SHIFT_TAIL_PKT_Q3_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_Q3_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_Q3_V2_8822C)) -+#define BIT_GET_TAIL_PKT_Q3_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q3_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_Q3_V2_8822C) -+#define BIT_SET_TAIL_PKT_Q3_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q3_V2_8822C(x) | BIT_TAIL_PKT_Q3_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q3_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_Q3_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_Q3_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q3_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_Q3_V1_8822C) -+#define BITS_HEAD_PKT_Q3_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_Q3_V1_8822C << BIT_SHIFT_HEAD_PKT_Q3_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_Q3_V1_8822C(x) ((x) & (~BITS_HEAD_PKT_Q3_V1_8822C)) -+#define BIT_GET_HEAD_PKT_Q3_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q3_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_Q3_V1_8822C) -+#define BIT_SET_HEAD_PKT_Q3_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q3_V1_8822C(x) | BIT_HEAD_PKT_Q3_V1_8822C(v)) -+ -+/* 2 REG_MGQ_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_MGQ_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_MGQ_V1_8822C 0x7f -+#define BIT_QUEUEMACID_MGQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_MGQ_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_MGQ_V1_8822C) -+#define BITS_QUEUEMACID_MGQ_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_MGQ_V1_8822C << BIT_SHIFT_QUEUEMACID_MGQ_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_MGQ_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_MGQ_V1_8822C)) -+#define BIT_GET_QUEUEMACID_MGQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_MGQ_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_MGQ_V1_8822C) -+#define BIT_SET_QUEUEMACID_MGQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_MGQ_V1_8822C(x) | BIT_QUEUEMACID_MGQ_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_MGQ_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_MGQ_V1_8822C 0x3 -+#define BIT_QUEUEAC_MGQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_MGQ_V1_8822C) \ -+ << BIT_SHIFT_QUEUEAC_MGQ_V1_8822C) -+#define BITS_QUEUEAC_MGQ_V1_8822C \ -+ (BIT_MASK_QUEUEAC_MGQ_V1_8822C << BIT_SHIFT_QUEUEAC_MGQ_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_MGQ_V1_8822C(x) ((x) & (~BITS_QUEUEAC_MGQ_V1_8822C)) -+#define BIT_GET_QUEUEAC_MGQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_MGQ_V1_8822C) & \ -+ BIT_MASK_QUEUEAC_MGQ_V1_8822C) -+#define BIT_SET_QUEUEAC_MGQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_MGQ_V1_8822C(x) | BIT_QUEUEAC_MGQ_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_MGQ_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_MGQ_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_MGQ_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_MGQ_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_MGQ_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_MGQ_V2_8822C) -+#define BITS_TAIL_PKT_MGQ_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_MGQ_V2_8822C << BIT_SHIFT_TAIL_PKT_MGQ_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_MGQ_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_MGQ_V2_8822C)) -+#define BIT_GET_TAIL_PKT_MGQ_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_MGQ_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_MGQ_V2_8822C) -+#define BIT_SET_TAIL_PKT_MGQ_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_MGQ_V2_8822C(x) | BIT_TAIL_PKT_MGQ_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_MGQ_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_MGQ_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_MGQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_MGQ_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_MGQ_V1_8822C) -+#define BITS_HEAD_PKT_MGQ_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_MGQ_V1_8822C << BIT_SHIFT_HEAD_PKT_MGQ_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_MGQ_V1_8822C(x) ((x) & (~BITS_HEAD_PKT_MGQ_V1_8822C)) -+#define BIT_GET_HEAD_PKT_MGQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_MGQ_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_MGQ_V1_8822C) -+#define BIT_SET_HEAD_PKT_MGQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_MGQ_V1_8822C(x) | BIT_HEAD_PKT_MGQ_V1_8822C(v)) -+ -+/* 2 REG_HIQ_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_HIQ_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_HIQ_V1_8822C 0x7f -+#define BIT_QUEUEMACID_HIQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_HIQ_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_HIQ_V1_8822C) -+#define BITS_QUEUEMACID_HIQ_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_HIQ_V1_8822C << BIT_SHIFT_QUEUEMACID_HIQ_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_HIQ_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_HIQ_V1_8822C)) -+#define BIT_GET_QUEUEMACID_HIQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_HIQ_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_HIQ_V1_8822C) -+#define BIT_SET_QUEUEMACID_HIQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_HIQ_V1_8822C(x) | BIT_QUEUEMACID_HIQ_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_HIQ_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_HIQ_V1_8822C 0x3 -+#define BIT_QUEUEAC_HIQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_HIQ_V1_8822C) \ -+ << BIT_SHIFT_QUEUEAC_HIQ_V1_8822C) -+#define BITS_QUEUEAC_HIQ_V1_8822C \ -+ (BIT_MASK_QUEUEAC_HIQ_V1_8822C << BIT_SHIFT_QUEUEAC_HIQ_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_HIQ_V1_8822C(x) ((x) & (~BITS_QUEUEAC_HIQ_V1_8822C)) -+#define BIT_GET_QUEUEAC_HIQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_HIQ_V1_8822C) & \ -+ BIT_MASK_QUEUEAC_HIQ_V1_8822C) -+#define BIT_SET_QUEUEAC_HIQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_HIQ_V1_8822C(x) | BIT_QUEUEAC_HIQ_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_HIQ_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_HIQ_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_HIQ_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_HIQ_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_HIQ_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_HIQ_V2_8822C) -+#define BITS_TAIL_PKT_HIQ_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_HIQ_V2_8822C << BIT_SHIFT_TAIL_PKT_HIQ_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_HIQ_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_HIQ_V2_8822C)) -+#define BIT_GET_TAIL_PKT_HIQ_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_HIQ_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_HIQ_V2_8822C) -+#define BIT_SET_TAIL_PKT_HIQ_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_HIQ_V2_8822C(x) | BIT_TAIL_PKT_HIQ_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_HIQ_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_HIQ_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_HIQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_HIQ_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_HIQ_V1_8822C) -+#define BITS_HEAD_PKT_HIQ_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_HIQ_V1_8822C << BIT_SHIFT_HEAD_PKT_HIQ_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_HIQ_V1_8822C(x) ((x) & (~BITS_HEAD_PKT_HIQ_V1_8822C)) -+#define BIT_GET_HEAD_PKT_HIQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_HIQ_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_HIQ_V1_8822C) -+#define BIT_SET_HEAD_PKT_HIQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_HIQ_V1_8822C(x) | BIT_HEAD_PKT_HIQ_V1_8822C(v)) -+ -+/* 2 REG_BCNQ_INFO_8822C */ -+ -+#define BIT_SHIFT_BCNQ_HEAD_PG_V1_8822C 0 -+#define BIT_MASK_BCNQ_HEAD_PG_V1_8822C 0xfff -+#define BIT_BCNQ_HEAD_PG_V1_8822C(x) \ -+ (((x) & BIT_MASK_BCNQ_HEAD_PG_V1_8822C) \ -+ << BIT_SHIFT_BCNQ_HEAD_PG_V1_8822C) -+#define BITS_BCNQ_HEAD_PG_V1_8822C \ -+ (BIT_MASK_BCNQ_HEAD_PG_V1_8822C << BIT_SHIFT_BCNQ_HEAD_PG_V1_8822C) -+#define BIT_CLEAR_BCNQ_HEAD_PG_V1_8822C(x) ((x) & (~BITS_BCNQ_HEAD_PG_V1_8822C)) -+#define BIT_GET_BCNQ_HEAD_PG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_HEAD_PG_V1_8822C) & \ -+ BIT_MASK_BCNQ_HEAD_PG_V1_8822C) -+#define BIT_SET_BCNQ_HEAD_PG_V1_8822C(x, v) \ -+ (BIT_CLEAR_BCNQ_HEAD_PG_V1_8822C(x) | BIT_BCNQ_HEAD_PG_V1_8822C(v)) -+ -+/* 2 REG_TXPKT_EMPTY_8822C */ -+#define BIT_BCNQ_EMPTY_8822C BIT(11) -+#define BIT_HQQ_EMPTY_8822C BIT(10) -+#define BIT_MQQ_EMPTY_8822C BIT(9) -+#define BIT_MGQ_CPU_EMPTY_8822C BIT(8) -+#define BIT_AC7Q_EMPTY_8822C BIT(7) -+#define BIT_AC6Q_EMPTY_8822C BIT(6) -+#define BIT_AC5Q_EMPTY_8822C BIT(5) -+#define BIT_AC4Q_EMPTY_8822C BIT(4) -+#define BIT_AC3Q_EMPTY_8822C BIT(3) -+#define BIT_AC2Q_EMPTY_8822C BIT(2) -+#define BIT_AC1Q_EMPTY_8822C BIT(1) -+#define BIT_AC0Q_EMPTY_8822C BIT(0) -+ -+/* 2 REG_CPU_MGQ_INFO_8822C */ -+#define BIT_BCN1_POLL_8822C BIT(30) -+#define BIT_CPUMGT_POLL_8822C BIT(29) -+#define BIT_BCN_POLL_8822C BIT(28) -+#define BIT_CPUMGQ_FW_NUM_V1_8822C BIT(12) -+ -+#define BIT_SHIFT_FW_FREE_TAIL_V1_8822C 0 -+#define BIT_MASK_FW_FREE_TAIL_V1_8822C 0xfff -+#define BIT_FW_FREE_TAIL_V1_8822C(x) \ -+ (((x) & BIT_MASK_FW_FREE_TAIL_V1_8822C) \ -+ << BIT_SHIFT_FW_FREE_TAIL_V1_8822C) -+#define BITS_FW_FREE_TAIL_V1_8822C \ -+ (BIT_MASK_FW_FREE_TAIL_V1_8822C << BIT_SHIFT_FW_FREE_TAIL_V1_8822C) -+#define BIT_CLEAR_FW_FREE_TAIL_V1_8822C(x) ((x) & (~BITS_FW_FREE_TAIL_V1_8822C)) -+#define BIT_GET_FW_FREE_TAIL_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_FW_FREE_TAIL_V1_8822C) & \ -+ BIT_MASK_FW_FREE_TAIL_V1_8822C) -+#define BIT_SET_FW_FREE_TAIL_V1_8822C(x, v) \ -+ (BIT_CLEAR_FW_FREE_TAIL_V1_8822C(x) | BIT_FW_FREE_TAIL_V1_8822C(v)) -+ -+/* 2 REG_FWHW_TXQ_CTRL_8822C */ -+#define BIT_RTS_LIMIT_IN_OFDM_8822C BIT(23) -+#define BIT_EN_BCNQ_DL_8822C BIT(22) -+#define BIT_EN_RD_RESP_NAV_BK_8822C BIT(21) -+#define BIT_EN_WR_FREE_TAIL_8822C BIT(20) -+#define BIT_NOTXRPT_USERATE_EN_8822C BIT(19) -+#define BIT_DIS_TXFAIL_RPT_8822C BIT(18) -+#define BIT_FTM_TIMEOUT_BYPASS_8822C BIT(16) -+ -+#define BIT_SHIFT_EN_QUEUE_RPT_8822C 8 -+#define BIT_MASK_EN_QUEUE_RPT_8822C 0xff -+#define BIT_EN_QUEUE_RPT_8822C(x) \ -+ (((x) & BIT_MASK_EN_QUEUE_RPT_8822C) << BIT_SHIFT_EN_QUEUE_RPT_8822C) -+#define BITS_EN_QUEUE_RPT_8822C \ -+ (BIT_MASK_EN_QUEUE_RPT_8822C << BIT_SHIFT_EN_QUEUE_RPT_8822C) -+#define BIT_CLEAR_EN_QUEUE_RPT_8822C(x) ((x) & (~BITS_EN_QUEUE_RPT_8822C)) -+#define BIT_GET_EN_QUEUE_RPT_8822C(x) \ -+ (((x) >> BIT_SHIFT_EN_QUEUE_RPT_8822C) & BIT_MASK_EN_QUEUE_RPT_8822C) -+#define BIT_SET_EN_QUEUE_RPT_8822C(x, v) \ -+ (BIT_CLEAR_EN_QUEUE_RPT_8822C(x) | BIT_EN_QUEUE_RPT_8822C(v)) -+ -+#define BIT_EN_RTY_BK_8822C BIT(7) -+#define BIT_EN_USE_INI_RAT_8822C BIT(6) -+#define BIT_EN_RTS_NAV_BK_8822C BIT(5) -+#define BIT_DIS_SSN_CHECK_8822C BIT(4) -+#define BIT_MACID_MATCH_RTS_8822C BIT(3) -+#define BIT_EN_BCN_TRXRPT_V1_8822C BIT(2) -+#define BIT_R_EN_FTMRPT_V1_8822C BIT(1) -+#define BIT_R_BMC_NAV_PROTECT_8822C BIT(0) -+ -+/* 2 REG_DATAFB_SEL_8822C */ -+#define BIT_BROADCAST_RTY_EN_8822C BIT(3) -+#define BIT_EN_RTY_BK_COD_8822C BIT(2) -+ -+#define BIT_SHIFT__R_DATA_FALLBACK_SEL_8822C 0 -+#define BIT_MASK__R_DATA_FALLBACK_SEL_8822C 0x3 -+#define BIT__R_DATA_FALLBACK_SEL_8822C(x) \ -+ (((x) & BIT_MASK__R_DATA_FALLBACK_SEL_8822C) \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL_8822C) -+#define BITS__R_DATA_FALLBACK_SEL_8822C \ -+ (BIT_MASK__R_DATA_FALLBACK_SEL_8822C \ -+ << BIT_SHIFT__R_DATA_FALLBACK_SEL_8822C) -+#define BIT_CLEAR__R_DATA_FALLBACK_SEL_8822C(x) \ -+ ((x) & (~BITS__R_DATA_FALLBACK_SEL_8822C)) -+#define BIT_GET__R_DATA_FALLBACK_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT__R_DATA_FALLBACK_SEL_8822C) & \ -+ BIT_MASK__R_DATA_FALLBACK_SEL_8822C) -+#define BIT_SET__R_DATA_FALLBACK_SEL_8822C(x, v) \ -+ (BIT_CLEAR__R_DATA_FALLBACK_SEL_8822C(x) | \ -+ BIT__R_DATA_FALLBACK_SEL_8822C(v)) -+ -+/* 2 REG_BCNQ_BDNY_V1_8822C */ -+ -+#define BIT_SHIFT_BCNQ_PGBNDY_V1_8822C 0 -+#define BIT_MASK_BCNQ_PGBNDY_V1_8822C 0xfff -+#define BIT_BCNQ_PGBNDY_V1_8822C(x) \ -+ (((x) & BIT_MASK_BCNQ_PGBNDY_V1_8822C) \ -+ << BIT_SHIFT_BCNQ_PGBNDY_V1_8822C) -+#define BITS_BCNQ_PGBNDY_V1_8822C \ -+ (BIT_MASK_BCNQ_PGBNDY_V1_8822C << BIT_SHIFT_BCNQ_PGBNDY_V1_8822C) -+#define BIT_CLEAR_BCNQ_PGBNDY_V1_8822C(x) ((x) & (~BITS_BCNQ_PGBNDY_V1_8822C)) -+#define BIT_GET_BCNQ_PGBNDY_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PGBNDY_V1_8822C) & \ -+ BIT_MASK_BCNQ_PGBNDY_V1_8822C) -+#define BIT_SET_BCNQ_PGBNDY_V1_8822C(x, v) \ -+ (BIT_CLEAR_BCNQ_PGBNDY_V1_8822C(x) | BIT_BCNQ_PGBNDY_V1_8822C(v)) -+ -+/* 2 REG_LIFETIME_EN_8822C */ -+#define BIT_BT_INT_CPU_8822C BIT(7) -+#define BIT_BT_INT_PTA_8822C BIT(6) -+#define BIT_BA_PARSER_EN_8822C BIT(5) -+#define BIT_EN_CTRL_RTYBIT_8822C BIT(4) -+#define BIT_LIFETIME_BK_EN_8822C BIT(3) -+#define BIT_LIFETIME_BE_EN_8822C BIT(2) -+#define BIT_LIFETIME_VI_EN_8822C BIT(1) -+#define BIT_LIFETIME_VO_EN_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_SPEC_SIFS_8822C */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8822C 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_PTCL_8822C 0xff -+#define BIT_SPEC_SIFS_OFDM_PTCL_8822C(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_PTCL_8822C) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8822C) -+#define BITS_SPEC_SIFS_OFDM_PTCL_8822C \ -+ (BIT_MASK_SPEC_SIFS_OFDM_PTCL_8822C \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8822C) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8822C(x) \ -+ ((x) & (~BITS_SPEC_SIFS_OFDM_PTCL_8822C)) -+#define BIT_GET_SPEC_SIFS_OFDM_PTCL_8822C(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_PTCL_8822C) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_PTCL_8822C) -+#define BIT_SET_SPEC_SIFS_OFDM_PTCL_8822C(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_PTCL_8822C(x) | \ -+ BIT_SPEC_SIFS_OFDM_PTCL_8822C(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8822C 0 -+#define BIT_MASK_SPEC_SIFS_CCK_PTCL_8822C 0xff -+#define BIT_SPEC_SIFS_CCK_PTCL_8822C(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_PTCL_8822C) \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8822C) -+#define BITS_SPEC_SIFS_CCK_PTCL_8822C \ -+ (BIT_MASK_SPEC_SIFS_CCK_PTCL_8822C \ -+ << BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8822C) -+#define BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8822C(x) \ -+ ((x) & (~BITS_SPEC_SIFS_CCK_PTCL_8822C)) -+#define BIT_GET_SPEC_SIFS_CCK_PTCL_8822C(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_PTCL_8822C) & \ -+ BIT_MASK_SPEC_SIFS_CCK_PTCL_8822C) -+#define BIT_SET_SPEC_SIFS_CCK_PTCL_8822C(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_PTCL_8822C(x) | \ -+ BIT_SPEC_SIFS_CCK_PTCL_8822C(v)) -+ -+/* 2 REG_RETRY_LIMIT_8822C */ -+ -+#define BIT_SHIFT_SRL_8822C 8 -+#define BIT_MASK_SRL_8822C 0x3f -+#define BIT_SRL_8822C(x) (((x) & BIT_MASK_SRL_8822C) << BIT_SHIFT_SRL_8822C) -+#define BITS_SRL_8822C (BIT_MASK_SRL_8822C << BIT_SHIFT_SRL_8822C) -+#define BIT_CLEAR_SRL_8822C(x) ((x) & (~BITS_SRL_8822C)) -+#define BIT_GET_SRL_8822C(x) (((x) >> BIT_SHIFT_SRL_8822C) & BIT_MASK_SRL_8822C) -+#define BIT_SET_SRL_8822C(x, v) (BIT_CLEAR_SRL_8822C(x) | BIT_SRL_8822C(v)) -+ -+#define BIT_SHIFT_LRL_8822C 0 -+#define BIT_MASK_LRL_8822C 0x3f -+#define BIT_LRL_8822C(x) (((x) & BIT_MASK_LRL_8822C) << BIT_SHIFT_LRL_8822C) -+#define BITS_LRL_8822C (BIT_MASK_LRL_8822C << BIT_SHIFT_LRL_8822C) -+#define BIT_CLEAR_LRL_8822C(x) ((x) & (~BITS_LRL_8822C)) -+#define BIT_GET_LRL_8822C(x) (((x) >> BIT_SHIFT_LRL_8822C) & BIT_MASK_LRL_8822C) -+#define BIT_SET_LRL_8822C(x, v) (BIT_CLEAR_LRL_8822C(x) | BIT_LRL_8822C(v)) -+ -+/* 2 REG_TXBF_CTRL_8822C */ -+#define BIT_R_ENABLE_NDPA_8822C BIT(31) -+#define BIT_USE_NDPA_PARAMETER_8822C BIT(30) -+#define BIT_R_PROP_TXBF_8822C BIT(29) -+#define BIT_R_EN_NDPA_INT_8822C BIT(28) -+#define BIT_R_TXBF1_80M_8822C BIT(27) -+#define BIT_R_TXBF1_40M_8822C BIT(26) -+#define BIT_R_TXBF1_20M_8822C BIT(25) -+ -+#define BIT_SHIFT_R_TXBF1_AID_8822C 16 -+#define BIT_MASK_R_TXBF1_AID_8822C 0x1ff -+#define BIT_R_TXBF1_AID_8822C(x) \ -+ (((x) & BIT_MASK_R_TXBF1_AID_8822C) << BIT_SHIFT_R_TXBF1_AID_8822C) -+#define BITS_R_TXBF1_AID_8822C \ -+ (BIT_MASK_R_TXBF1_AID_8822C << BIT_SHIFT_R_TXBF1_AID_8822C) -+#define BIT_CLEAR_R_TXBF1_AID_8822C(x) ((x) & (~BITS_R_TXBF1_AID_8822C)) -+#define BIT_GET_R_TXBF1_AID_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF1_AID_8822C) & BIT_MASK_R_TXBF1_AID_8822C) -+#define BIT_SET_R_TXBF1_AID_8822C(x, v) \ -+ (BIT_CLEAR_R_TXBF1_AID_8822C(x) | BIT_R_TXBF1_AID_8822C(v)) -+ -+#define BIT_DIS_NDP_BFEN_8822C BIT(15) -+#define BIT_R_TXBCN_NOBLOCK_NDP_8822C BIT(14) -+#define BIT_R_TXBF0_80M_8822C BIT(11) -+#define BIT_R_TXBF0_40M_8822C BIT(10) -+#define BIT_R_TXBF0_20M_8822C BIT(9) -+ -+#define BIT_SHIFT_R_TXBF0_AID_8822C 0 -+#define BIT_MASK_R_TXBF0_AID_8822C 0x1ff -+#define BIT_R_TXBF0_AID_8822C(x) \ -+ (((x) & BIT_MASK_R_TXBF0_AID_8822C) << BIT_SHIFT_R_TXBF0_AID_8822C) -+#define BITS_R_TXBF0_AID_8822C \ -+ (BIT_MASK_R_TXBF0_AID_8822C << BIT_SHIFT_R_TXBF0_AID_8822C) -+#define BIT_CLEAR_R_TXBF0_AID_8822C(x) ((x) & (~BITS_R_TXBF0_AID_8822C)) -+#define BIT_GET_R_TXBF0_AID_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_TXBF0_AID_8822C) & BIT_MASK_R_TXBF0_AID_8822C) -+#define BIT_SET_R_TXBF0_AID_8822C(x, v) \ -+ (BIT_CLEAR_R_TXBF0_AID_8822C(x) | BIT_R_TXBF0_AID_8822C(v)) -+ -+/* 2 REG_DARFRC_8822C */ -+ -+#define BIT_SHIFT_DARF_RC4_8822C 24 -+#define BIT_MASK_DARF_RC4_8822C 0x1f -+#define BIT_DARF_RC4_8822C(x) \ -+ (((x) & BIT_MASK_DARF_RC4_8822C) << BIT_SHIFT_DARF_RC4_8822C) -+#define BITS_DARF_RC4_8822C \ -+ (BIT_MASK_DARF_RC4_8822C << BIT_SHIFT_DARF_RC4_8822C) -+#define BIT_CLEAR_DARF_RC4_8822C(x) ((x) & (~BITS_DARF_RC4_8822C)) -+#define BIT_GET_DARF_RC4_8822C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC4_8822C) & BIT_MASK_DARF_RC4_8822C) -+#define BIT_SET_DARF_RC4_8822C(x, v) \ -+ (BIT_CLEAR_DARF_RC4_8822C(x) | BIT_DARF_RC4_8822C(v)) -+ -+#define BIT_SHIFT_DARF_RC3_8822C 16 -+#define BIT_MASK_DARF_RC3_8822C 0x1f -+#define BIT_DARF_RC3_8822C(x) \ -+ (((x) & BIT_MASK_DARF_RC3_8822C) << BIT_SHIFT_DARF_RC3_8822C) -+#define BITS_DARF_RC3_8822C \ -+ (BIT_MASK_DARF_RC3_8822C << BIT_SHIFT_DARF_RC3_8822C) -+#define BIT_CLEAR_DARF_RC3_8822C(x) ((x) & (~BITS_DARF_RC3_8822C)) -+#define BIT_GET_DARF_RC3_8822C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC3_8822C) & BIT_MASK_DARF_RC3_8822C) -+#define BIT_SET_DARF_RC3_8822C(x, v) \ -+ (BIT_CLEAR_DARF_RC3_8822C(x) | BIT_DARF_RC3_8822C(v)) -+ -+#define BIT_SHIFT_DARF_RC2_8822C 8 -+#define BIT_MASK_DARF_RC2_8822C 0x1f -+#define BIT_DARF_RC2_8822C(x) \ -+ (((x) & BIT_MASK_DARF_RC2_8822C) << BIT_SHIFT_DARF_RC2_8822C) -+#define BITS_DARF_RC2_8822C \ -+ (BIT_MASK_DARF_RC2_8822C << BIT_SHIFT_DARF_RC2_8822C) -+#define BIT_CLEAR_DARF_RC2_8822C(x) ((x) & (~BITS_DARF_RC2_8822C)) -+#define BIT_GET_DARF_RC2_8822C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC2_8822C) & BIT_MASK_DARF_RC2_8822C) -+#define BIT_SET_DARF_RC2_8822C(x, v) \ -+ (BIT_CLEAR_DARF_RC2_8822C(x) | BIT_DARF_RC2_8822C(v)) -+ -+#define BIT_SHIFT_DARF_RC1_8822C 0 -+#define BIT_MASK_DARF_RC1_8822C 0x1f -+#define BIT_DARF_RC1_8822C(x) \ -+ (((x) & BIT_MASK_DARF_RC1_8822C) << BIT_SHIFT_DARF_RC1_8822C) -+#define BITS_DARF_RC1_8822C \ -+ (BIT_MASK_DARF_RC1_8822C << BIT_SHIFT_DARF_RC1_8822C) -+#define BIT_CLEAR_DARF_RC1_8822C(x) ((x) & (~BITS_DARF_RC1_8822C)) -+#define BIT_GET_DARF_RC1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC1_8822C) & BIT_MASK_DARF_RC1_8822C) -+#define BIT_SET_DARF_RC1_8822C(x, v) \ -+ (BIT_CLEAR_DARF_RC1_8822C(x) | BIT_DARF_RC1_8822C(v)) -+ -+/* 2 REG_DARFRCH_8822C */ -+ -+#define BIT_SHIFT_DARF_RC8_V1_8822C 24 -+#define BIT_MASK_DARF_RC8_V1_8822C 0x1f -+#define BIT_DARF_RC8_V1_8822C(x) \ -+ (((x) & BIT_MASK_DARF_RC8_V1_8822C) << BIT_SHIFT_DARF_RC8_V1_8822C) -+#define BITS_DARF_RC8_V1_8822C \ -+ (BIT_MASK_DARF_RC8_V1_8822C << BIT_SHIFT_DARF_RC8_V1_8822C) -+#define BIT_CLEAR_DARF_RC8_V1_8822C(x) ((x) & (~BITS_DARF_RC8_V1_8822C)) -+#define BIT_GET_DARF_RC8_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC8_V1_8822C) & BIT_MASK_DARF_RC8_V1_8822C) -+#define BIT_SET_DARF_RC8_V1_8822C(x, v) \ -+ (BIT_CLEAR_DARF_RC8_V1_8822C(x) | BIT_DARF_RC8_V1_8822C(v)) -+ -+#define BIT_SHIFT_DARF_RC7_V1_8822C 16 -+#define BIT_MASK_DARF_RC7_V1_8822C 0x1f -+#define BIT_DARF_RC7_V1_8822C(x) \ -+ (((x) & BIT_MASK_DARF_RC7_V1_8822C) << BIT_SHIFT_DARF_RC7_V1_8822C) -+#define BITS_DARF_RC7_V1_8822C \ -+ (BIT_MASK_DARF_RC7_V1_8822C << BIT_SHIFT_DARF_RC7_V1_8822C) -+#define BIT_CLEAR_DARF_RC7_V1_8822C(x) ((x) & (~BITS_DARF_RC7_V1_8822C)) -+#define BIT_GET_DARF_RC7_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC7_V1_8822C) & BIT_MASK_DARF_RC7_V1_8822C) -+#define BIT_SET_DARF_RC7_V1_8822C(x, v) \ -+ (BIT_CLEAR_DARF_RC7_V1_8822C(x) | BIT_DARF_RC7_V1_8822C(v)) -+ -+#define BIT_SHIFT_DARF_RC6_V1_8822C 8 -+#define BIT_MASK_DARF_RC6_V1_8822C 0x1f -+#define BIT_DARF_RC6_V1_8822C(x) \ -+ (((x) & BIT_MASK_DARF_RC6_V1_8822C) << BIT_SHIFT_DARF_RC6_V1_8822C) -+#define BITS_DARF_RC6_V1_8822C \ -+ (BIT_MASK_DARF_RC6_V1_8822C << BIT_SHIFT_DARF_RC6_V1_8822C) -+#define BIT_CLEAR_DARF_RC6_V1_8822C(x) ((x) & (~BITS_DARF_RC6_V1_8822C)) -+#define BIT_GET_DARF_RC6_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC6_V1_8822C) & BIT_MASK_DARF_RC6_V1_8822C) -+#define BIT_SET_DARF_RC6_V1_8822C(x, v) \ -+ (BIT_CLEAR_DARF_RC6_V1_8822C(x) | BIT_DARF_RC6_V1_8822C(v)) -+ -+#define BIT_SHIFT_DARF_RC5_V1_8822C 0 -+#define BIT_MASK_DARF_RC5_V1_8822C 0x1f -+#define BIT_DARF_RC5_V1_8822C(x) \ -+ (((x) & BIT_MASK_DARF_RC5_V1_8822C) << BIT_SHIFT_DARF_RC5_V1_8822C) -+#define BITS_DARF_RC5_V1_8822C \ -+ (BIT_MASK_DARF_RC5_V1_8822C << BIT_SHIFT_DARF_RC5_V1_8822C) -+#define BIT_CLEAR_DARF_RC5_V1_8822C(x) ((x) & (~BITS_DARF_RC5_V1_8822C)) -+#define BIT_GET_DARF_RC5_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DARF_RC5_V1_8822C) & BIT_MASK_DARF_RC5_V1_8822C) -+#define BIT_SET_DARF_RC5_V1_8822C(x, v) \ -+ (BIT_CLEAR_DARF_RC5_V1_8822C(x) | BIT_DARF_RC5_V1_8822C(v)) -+ -+/* 2 REG_RARFRC_8822C */ -+ -+#define BIT_SHIFT_RARF_RC4_8822C 24 -+#define BIT_MASK_RARF_RC4_8822C 0x1f -+#define BIT_RARF_RC4_8822C(x) \ -+ (((x) & BIT_MASK_RARF_RC4_8822C) << BIT_SHIFT_RARF_RC4_8822C) -+#define BITS_RARF_RC4_8822C \ -+ (BIT_MASK_RARF_RC4_8822C << BIT_SHIFT_RARF_RC4_8822C) -+#define BIT_CLEAR_RARF_RC4_8822C(x) ((x) & (~BITS_RARF_RC4_8822C)) -+#define BIT_GET_RARF_RC4_8822C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC4_8822C) & BIT_MASK_RARF_RC4_8822C) -+#define BIT_SET_RARF_RC4_8822C(x, v) \ -+ (BIT_CLEAR_RARF_RC4_8822C(x) | BIT_RARF_RC4_8822C(v)) -+ -+#define BIT_SHIFT_RARF_RC3_8822C 16 -+#define BIT_MASK_RARF_RC3_8822C 0x1f -+#define BIT_RARF_RC3_8822C(x) \ -+ (((x) & BIT_MASK_RARF_RC3_8822C) << BIT_SHIFT_RARF_RC3_8822C) -+#define BITS_RARF_RC3_8822C \ -+ (BIT_MASK_RARF_RC3_8822C << BIT_SHIFT_RARF_RC3_8822C) -+#define BIT_CLEAR_RARF_RC3_8822C(x) ((x) & (~BITS_RARF_RC3_8822C)) -+#define BIT_GET_RARF_RC3_8822C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC3_8822C) & BIT_MASK_RARF_RC3_8822C) -+#define BIT_SET_RARF_RC3_8822C(x, v) \ -+ (BIT_CLEAR_RARF_RC3_8822C(x) | BIT_RARF_RC3_8822C(v)) -+ -+#define BIT_SHIFT_RARF_RC2_8822C 8 -+#define BIT_MASK_RARF_RC2_8822C 0x1f -+#define BIT_RARF_RC2_8822C(x) \ -+ (((x) & BIT_MASK_RARF_RC2_8822C) << BIT_SHIFT_RARF_RC2_8822C) -+#define BITS_RARF_RC2_8822C \ -+ (BIT_MASK_RARF_RC2_8822C << BIT_SHIFT_RARF_RC2_8822C) -+#define BIT_CLEAR_RARF_RC2_8822C(x) ((x) & (~BITS_RARF_RC2_8822C)) -+#define BIT_GET_RARF_RC2_8822C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC2_8822C) & BIT_MASK_RARF_RC2_8822C) -+#define BIT_SET_RARF_RC2_8822C(x, v) \ -+ (BIT_CLEAR_RARF_RC2_8822C(x) | BIT_RARF_RC2_8822C(v)) -+ -+#define BIT_SHIFT_RARF_RC1_8822C 0 -+#define BIT_MASK_RARF_RC1_8822C 0x1f -+#define BIT_RARF_RC1_8822C(x) \ -+ (((x) & BIT_MASK_RARF_RC1_8822C) << BIT_SHIFT_RARF_RC1_8822C) -+#define BITS_RARF_RC1_8822C \ -+ (BIT_MASK_RARF_RC1_8822C << BIT_SHIFT_RARF_RC1_8822C) -+#define BIT_CLEAR_RARF_RC1_8822C(x) ((x) & (~BITS_RARF_RC1_8822C)) -+#define BIT_GET_RARF_RC1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC1_8822C) & BIT_MASK_RARF_RC1_8822C) -+#define BIT_SET_RARF_RC1_8822C(x, v) \ -+ (BIT_CLEAR_RARF_RC1_8822C(x) | BIT_RARF_RC1_8822C(v)) -+ -+/* 2 REG_RARFRCH_8822C */ -+ -+#define BIT_SHIFT_RARF_RC8_V1_8822C 24 -+#define BIT_MASK_RARF_RC8_V1_8822C 0x1f -+#define BIT_RARF_RC8_V1_8822C(x) \ -+ (((x) & BIT_MASK_RARF_RC8_V1_8822C) << BIT_SHIFT_RARF_RC8_V1_8822C) -+#define BITS_RARF_RC8_V1_8822C \ -+ (BIT_MASK_RARF_RC8_V1_8822C << BIT_SHIFT_RARF_RC8_V1_8822C) -+#define BIT_CLEAR_RARF_RC8_V1_8822C(x) ((x) & (~BITS_RARF_RC8_V1_8822C)) -+#define BIT_GET_RARF_RC8_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC8_V1_8822C) & BIT_MASK_RARF_RC8_V1_8822C) -+#define BIT_SET_RARF_RC8_V1_8822C(x, v) \ -+ (BIT_CLEAR_RARF_RC8_V1_8822C(x) | BIT_RARF_RC8_V1_8822C(v)) -+ -+#define BIT_SHIFT_RARF_RC7_V1_8822C 16 -+#define BIT_MASK_RARF_RC7_V1_8822C 0x1f -+#define BIT_RARF_RC7_V1_8822C(x) \ -+ (((x) & BIT_MASK_RARF_RC7_V1_8822C) << BIT_SHIFT_RARF_RC7_V1_8822C) -+#define BITS_RARF_RC7_V1_8822C \ -+ (BIT_MASK_RARF_RC7_V1_8822C << BIT_SHIFT_RARF_RC7_V1_8822C) -+#define BIT_CLEAR_RARF_RC7_V1_8822C(x) ((x) & (~BITS_RARF_RC7_V1_8822C)) -+#define BIT_GET_RARF_RC7_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC7_V1_8822C) & BIT_MASK_RARF_RC7_V1_8822C) -+#define BIT_SET_RARF_RC7_V1_8822C(x, v) \ -+ (BIT_CLEAR_RARF_RC7_V1_8822C(x) | BIT_RARF_RC7_V1_8822C(v)) -+ -+#define BIT_SHIFT_RARF_RC6_V1_8822C 8 -+#define BIT_MASK_RARF_RC6_V1_8822C 0x1f -+#define BIT_RARF_RC6_V1_8822C(x) \ -+ (((x) & BIT_MASK_RARF_RC6_V1_8822C) << BIT_SHIFT_RARF_RC6_V1_8822C) -+#define BITS_RARF_RC6_V1_8822C \ -+ (BIT_MASK_RARF_RC6_V1_8822C << BIT_SHIFT_RARF_RC6_V1_8822C) -+#define BIT_CLEAR_RARF_RC6_V1_8822C(x) ((x) & (~BITS_RARF_RC6_V1_8822C)) -+#define BIT_GET_RARF_RC6_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC6_V1_8822C) & BIT_MASK_RARF_RC6_V1_8822C) -+#define BIT_SET_RARF_RC6_V1_8822C(x, v) \ -+ (BIT_CLEAR_RARF_RC6_V1_8822C(x) | BIT_RARF_RC6_V1_8822C(v)) -+ -+#define BIT_SHIFT_RARF_RC5_V1_8822C 0 -+#define BIT_MASK_RARF_RC5_V1_8822C 0x1f -+#define BIT_RARF_RC5_V1_8822C(x) \ -+ (((x) & BIT_MASK_RARF_RC5_V1_8822C) << BIT_SHIFT_RARF_RC5_V1_8822C) -+#define BITS_RARF_RC5_V1_8822C \ -+ (BIT_MASK_RARF_RC5_V1_8822C << BIT_SHIFT_RARF_RC5_V1_8822C) -+#define BIT_CLEAR_RARF_RC5_V1_8822C(x) ((x) & (~BITS_RARF_RC5_V1_8822C)) -+#define BIT_GET_RARF_RC5_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RARF_RC5_V1_8822C) & BIT_MASK_RARF_RC5_V1_8822C) -+#define BIT_SET_RARF_RC5_V1_8822C(x, v) \ -+ (BIT_CLEAR_RARF_RC5_V1_8822C(x) | BIT_RARF_RC5_V1_8822C(v)) -+ -+/* 2 REG_RRSR_8822C */ -+ -+#define BIT_SHIFT_RRSR_RSC_8822C 21 -+#define BIT_MASK_RRSR_RSC_8822C 0x3 -+#define BIT_RRSR_RSC_8822C(x) \ -+ (((x) & BIT_MASK_RRSR_RSC_8822C) << BIT_SHIFT_RRSR_RSC_8822C) -+#define BITS_RRSR_RSC_8822C \ -+ (BIT_MASK_RRSR_RSC_8822C << BIT_SHIFT_RRSR_RSC_8822C) -+#define BIT_CLEAR_RRSR_RSC_8822C(x) ((x) & (~BITS_RRSR_RSC_8822C)) -+#define BIT_GET_RRSR_RSC_8822C(x) \ -+ (((x) >> BIT_SHIFT_RRSR_RSC_8822C) & BIT_MASK_RRSR_RSC_8822C) -+#define BIT_SET_RRSR_RSC_8822C(x, v) \ -+ (BIT_CLEAR_RRSR_RSC_8822C(x) | BIT_RRSR_RSC_8822C(v)) -+ -+#define BIT_SHIFT_RRSC_BITMAP_8822C 0 -+#define BIT_MASK_RRSC_BITMAP_8822C 0xfffff -+#define BIT_RRSC_BITMAP_8822C(x) \ -+ (((x) & BIT_MASK_RRSC_BITMAP_8822C) << BIT_SHIFT_RRSC_BITMAP_8822C) -+#define BITS_RRSC_BITMAP_8822C \ -+ (BIT_MASK_RRSC_BITMAP_8822C << BIT_SHIFT_RRSC_BITMAP_8822C) -+#define BIT_CLEAR_RRSC_BITMAP_8822C(x) ((x) & (~BITS_RRSC_BITMAP_8822C)) -+#define BIT_GET_RRSC_BITMAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_RRSC_BITMAP_8822C) & BIT_MASK_RRSC_BITMAP_8822C) -+#define BIT_SET_RRSC_BITMAP_8822C(x, v) \ -+ (BIT_CLEAR_RRSC_BITMAP_8822C(x) | BIT_RRSC_BITMAP_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_ARFR0_8822C */ -+ -+#define BIT_SHIFT_ARFRL0_8822C 0 -+#define BIT_MASK_ARFRL0_8822C 0xffffffffL -+#define BIT_ARFRL0_8822C(x) \ -+ (((x) & BIT_MASK_ARFRL0_8822C) << BIT_SHIFT_ARFRL0_8822C) -+#define BITS_ARFRL0_8822C (BIT_MASK_ARFRL0_8822C << BIT_SHIFT_ARFRL0_8822C) -+#define BIT_CLEAR_ARFRL0_8822C(x) ((x) & (~BITS_ARFRL0_8822C)) -+#define BIT_GET_ARFRL0_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL0_8822C) & BIT_MASK_ARFRL0_8822C) -+#define BIT_SET_ARFRL0_8822C(x, v) \ -+ (BIT_CLEAR_ARFRL0_8822C(x) | BIT_ARFRL0_8822C(v)) -+ -+/* 2 REG_ARFRH0_8822C */ -+ -+#define BIT_SHIFT_ARFRH0_8822C 0 -+#define BIT_MASK_ARFRH0_8822C 0xffffffffL -+#define BIT_ARFRH0_8822C(x) \ -+ (((x) & BIT_MASK_ARFRH0_8822C) << BIT_SHIFT_ARFRH0_8822C) -+#define BITS_ARFRH0_8822C (BIT_MASK_ARFRH0_8822C << BIT_SHIFT_ARFRH0_8822C) -+#define BIT_CLEAR_ARFRH0_8822C(x) ((x) & (~BITS_ARFRH0_8822C)) -+#define BIT_GET_ARFRH0_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH0_8822C) & BIT_MASK_ARFRH0_8822C) -+#define BIT_SET_ARFRH0_8822C(x, v) \ -+ (BIT_CLEAR_ARFRH0_8822C(x) | BIT_ARFRH0_8822C(v)) -+ -+/* 2 REG_ARFR1_V1_8822C */ -+ -+#define BIT_SHIFT_ARFRL1_8822C 0 -+#define BIT_MASK_ARFRL1_8822C 0xffffffffL -+#define BIT_ARFRL1_8822C(x) \ -+ (((x) & BIT_MASK_ARFRL1_8822C) << BIT_SHIFT_ARFRL1_8822C) -+#define BITS_ARFRL1_8822C (BIT_MASK_ARFRL1_8822C << BIT_SHIFT_ARFRL1_8822C) -+#define BIT_CLEAR_ARFRL1_8822C(x) ((x) & (~BITS_ARFRL1_8822C)) -+#define BIT_GET_ARFRL1_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL1_8822C) & BIT_MASK_ARFRL1_8822C) -+#define BIT_SET_ARFRL1_8822C(x, v) \ -+ (BIT_CLEAR_ARFRL1_8822C(x) | BIT_ARFRL1_8822C(v)) -+ -+/* 2 REG_ARFRH1_V1_8822C */ -+ -+#define BIT_SHIFT_ARFRH1_8822C 0 -+#define BIT_MASK_ARFRH1_8822C 0xffffffffL -+#define BIT_ARFRH1_8822C(x) \ -+ (((x) & BIT_MASK_ARFRH1_8822C) << BIT_SHIFT_ARFRH1_8822C) -+#define BITS_ARFRH1_8822C (BIT_MASK_ARFRH1_8822C << BIT_SHIFT_ARFRH1_8822C) -+#define BIT_CLEAR_ARFRH1_8822C(x) ((x) & (~BITS_ARFRH1_8822C)) -+#define BIT_GET_ARFRH1_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH1_8822C) & BIT_MASK_ARFRH1_8822C) -+#define BIT_SET_ARFRH1_8822C(x, v) \ -+ (BIT_CLEAR_ARFRH1_8822C(x) | BIT_ARFRH1_8822C(v)) -+ -+/* 2 REG_CCK_CHECK_8822C */ -+#define BIT_CHECK_CCK_EN_8822C BIT(7) -+#define BIT_EN_BCN_PKT_REL_8822C BIT(6) -+#define BIT_BCN_PORT_SEL_8822C BIT(5) -+#define BIT_MOREDATA_BYPASS_8822C BIT(4) -+#define BIT_EN_CLR_CMD_REL_BCN_PKT_8822C BIT(3) -+#define BIT_R_EN_SET_MOREDATA_8822C BIT(2) -+#define BIT__R_DIS_CLEAR_MACID_RELEASE_8822C BIT(1) -+#define BIT__R_MACID_RELEASE_EN_8822C BIT(0) -+ -+/* 2 REG_AMPDU_MAX_TIME_V1_8822C */ -+ -+#define BIT_SHIFT_AMPDU_MAX_TIME_8822C 0 -+#define BIT_MASK_AMPDU_MAX_TIME_8822C 0xff -+#define BIT_AMPDU_MAX_TIME_8822C(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_TIME_8822C) \ -+ << BIT_SHIFT_AMPDU_MAX_TIME_8822C) -+#define BITS_AMPDU_MAX_TIME_8822C \ -+ (BIT_MASK_AMPDU_MAX_TIME_8822C << BIT_SHIFT_AMPDU_MAX_TIME_8822C) -+#define BIT_CLEAR_AMPDU_MAX_TIME_8822C(x) ((x) & (~BITS_AMPDU_MAX_TIME_8822C)) -+#define BIT_GET_AMPDU_MAX_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_TIME_8822C) & \ -+ BIT_MASK_AMPDU_MAX_TIME_8822C) -+#define BIT_SET_AMPDU_MAX_TIME_8822C(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_TIME_8822C(x) | BIT_AMPDU_MAX_TIME_8822C(v)) -+ -+/* 2 REG_BCNQ1_BDNY_V1_8822C */ -+ -+#define BIT_SHIFT_BCNQ1_PGBNDY_V1_8822C 0 -+#define BIT_MASK_BCNQ1_PGBNDY_V1_8822C 0xfff -+#define BIT_BCNQ1_PGBNDY_V1_8822C(x) \ -+ (((x) & BIT_MASK_BCNQ1_PGBNDY_V1_8822C) \ -+ << BIT_SHIFT_BCNQ1_PGBNDY_V1_8822C) -+#define BITS_BCNQ1_PGBNDY_V1_8822C \ -+ (BIT_MASK_BCNQ1_PGBNDY_V1_8822C << BIT_SHIFT_BCNQ1_PGBNDY_V1_8822C) -+#define BIT_CLEAR_BCNQ1_PGBNDY_V1_8822C(x) ((x) & (~BITS_BCNQ1_PGBNDY_V1_8822C)) -+#define BIT_GET_BCNQ1_PGBNDY_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ1_PGBNDY_V1_8822C) & \ -+ BIT_MASK_BCNQ1_PGBNDY_V1_8822C) -+#define BIT_SET_BCNQ1_PGBNDY_V1_8822C(x, v) \ -+ (BIT_CLEAR_BCNQ1_PGBNDY_V1_8822C(x) | BIT_BCNQ1_PGBNDY_V1_8822C(v)) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_HT_8822C */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8822C 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_HT_8822C 0xffff -+#define BIT_AMPDU_MAX_LENGTH_HT_8822C(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_HT_8822C) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8822C) -+#define BITS_AMPDU_MAX_LENGTH_HT_8822C \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_HT_8822C \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8822C) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_HT_8822C(x) \ -+ ((x) & (~BITS_AMPDU_MAX_LENGTH_HT_8822C)) -+#define BIT_GET_AMPDU_MAX_LENGTH_HT_8822C(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_HT_8822C) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_HT_8822C) -+#define BIT_SET_AMPDU_MAX_LENGTH_HT_8822C(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_HT_8822C(x) | \ -+ BIT_AMPDU_MAX_LENGTH_HT_8822C(v)) -+ -+/* 2 REG_ACQ_STOP_8822C */ -+#define BIT_AC7Q_STOP_8822C BIT(7) -+#define BIT_AC6Q_STOP_8822C BIT(6) -+#define BIT_AC5Q_STOP_8822C BIT(5) -+#define BIT_AC4Q_STOP_8822C BIT(4) -+#define BIT_AC3Q_STOP_8822C BIT(3) -+#define BIT_AC2Q_STOP_8822C BIT(2) -+#define BIT_AC1Q_STOP_8822C BIT(1) -+#define BIT_AC0Q_STOP_8822C BIT(0) -+ -+/* 2 REG_NDPA_RATE_8822C */ -+ -+#define BIT_SHIFT_R_NDPA_RATE_V1_8822C 0 -+#define BIT_MASK_R_NDPA_RATE_V1_8822C 0xff -+#define BIT_R_NDPA_RATE_V1_8822C(x) \ -+ (((x) & BIT_MASK_R_NDPA_RATE_V1_8822C) \ -+ << BIT_SHIFT_R_NDPA_RATE_V1_8822C) -+#define BITS_R_NDPA_RATE_V1_8822C \ -+ (BIT_MASK_R_NDPA_RATE_V1_8822C << BIT_SHIFT_R_NDPA_RATE_V1_8822C) -+#define BIT_CLEAR_R_NDPA_RATE_V1_8822C(x) ((x) & (~BITS_R_NDPA_RATE_V1_8822C)) -+#define BIT_GET_R_NDPA_RATE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_RATE_V1_8822C) & \ -+ BIT_MASK_R_NDPA_RATE_V1_8822C) -+#define BIT_SET_R_NDPA_RATE_V1_8822C(x, v) \ -+ (BIT_CLEAR_R_NDPA_RATE_V1_8822C(x) | BIT_R_NDPA_RATE_V1_8822C(v)) -+ -+/* 2 REG_TX_HANG_CTRL_8822C */ -+#define BIT_EN_GNT_BT_AWAKE_8822C BIT(3) -+#define BIT_EN_EOF_V1_8822C BIT(2) -+#define BIT_DIS_OQT_BLOCK_8822C BIT(1) -+#define BIT_SEARCH_QUEUE_EN_8822C BIT(0) -+ -+/* 2 REG_NDPA_OPT_CTRL_8822C */ -+#define BIT_R_DIS_MACID_RELEASE_RTY_8822C BIT(5) -+ -+#define BIT_SHIFT_BW_SIGTA_8822C 3 -+#define BIT_MASK_BW_SIGTA_8822C 0x3 -+#define BIT_BW_SIGTA_8822C(x) \ -+ (((x) & BIT_MASK_BW_SIGTA_8822C) << BIT_SHIFT_BW_SIGTA_8822C) -+#define BITS_BW_SIGTA_8822C \ -+ (BIT_MASK_BW_SIGTA_8822C << BIT_SHIFT_BW_SIGTA_8822C) -+#define BIT_CLEAR_BW_SIGTA_8822C(x) ((x) & (~BITS_BW_SIGTA_8822C)) -+#define BIT_GET_BW_SIGTA_8822C(x) \ -+ (((x) >> BIT_SHIFT_BW_SIGTA_8822C) & BIT_MASK_BW_SIGTA_8822C) -+#define BIT_SET_BW_SIGTA_8822C(x, v) \ -+ (BIT_CLEAR_BW_SIGTA_8822C(x) | BIT_BW_SIGTA_8822C(v)) -+ -+#define BIT_EN_BAR_SIGTA_8822C BIT(2) -+ -+#define BIT_SHIFT_R_NDPA_BW_8822C 0 -+#define BIT_MASK_R_NDPA_BW_8822C 0x3 -+#define BIT_R_NDPA_BW_8822C(x) \ -+ (((x) & BIT_MASK_R_NDPA_BW_8822C) << BIT_SHIFT_R_NDPA_BW_8822C) -+#define BITS_R_NDPA_BW_8822C \ -+ (BIT_MASK_R_NDPA_BW_8822C << BIT_SHIFT_R_NDPA_BW_8822C) -+#define BIT_CLEAR_R_NDPA_BW_8822C(x) ((x) & (~BITS_R_NDPA_BW_8822C)) -+#define BIT_GET_R_NDPA_BW_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_NDPA_BW_8822C) & BIT_MASK_R_NDPA_BW_8822C) -+#define BIT_SET_R_NDPA_BW_8822C(x, v) \ -+ (BIT_CLEAR_R_NDPA_BW_8822C(x) | BIT_R_NDPA_BW_8822C(v)) -+ -+/* 2 REG_AMPDU_MAX_LENGTH_VHT_8822C */ -+ -+#define BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1_8822C 0 -+#define BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1_8822C 0xfffff -+#define BIT_AMPDU_MAX_LENGTH_VHT_V1_8822C(x) \ -+ (((x) & BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1_8822C) \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1_8822C) -+#define BITS_AMPDU_MAX_LENGTH_VHT_V1_8822C \ -+ (BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1_8822C \ -+ << BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1_8822C) -+#define BIT_CLEAR_AMPDU_MAX_LENGTH_VHT_V1_8822C(x) \ -+ ((x) & (~BITS_AMPDU_MAX_LENGTH_VHT_V1_8822C)) -+#define BIT_GET_AMPDU_MAX_LENGTH_VHT_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_MAX_LENGTH_VHT_V1_8822C) & \ -+ BIT_MASK_AMPDU_MAX_LENGTH_VHT_V1_8822C) -+#define BIT_SET_AMPDU_MAX_LENGTH_VHT_V1_8822C(x, v) \ -+ (BIT_CLEAR_AMPDU_MAX_LENGTH_VHT_V1_8822C(x) | \ -+ BIT_AMPDU_MAX_LENGTH_VHT_V1_8822C(v)) -+ -+/* 2 REG_RD_RESP_PKT_TH_8822C */ -+ -+#define BIT_SHIFT_RD_RESP_PKT_TH_V1_8822C 0 -+#define BIT_MASK_RD_RESP_PKT_TH_V1_8822C 0x3f -+#define BIT_RD_RESP_PKT_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_RD_RESP_PKT_TH_V1_8822C) \ -+ << BIT_SHIFT_RD_RESP_PKT_TH_V1_8822C) -+#define BITS_RD_RESP_PKT_TH_V1_8822C \ -+ (BIT_MASK_RD_RESP_PKT_TH_V1_8822C << BIT_SHIFT_RD_RESP_PKT_TH_V1_8822C) -+#define BIT_CLEAR_RD_RESP_PKT_TH_V1_8822C(x) \ -+ ((x) & (~BITS_RD_RESP_PKT_TH_V1_8822C)) -+#define BIT_GET_RD_RESP_PKT_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RD_RESP_PKT_TH_V1_8822C) & \ -+ BIT_MASK_RD_RESP_PKT_TH_V1_8822C) -+#define BIT_SET_RD_RESP_PKT_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_RD_RESP_PKT_TH_V1_8822C(x) | BIT_RD_RESP_PKT_TH_V1_8822C(v)) -+ -+/* 2 REG_CMDQ_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_CMDQ_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_CMDQ_V1_8822C 0x7f -+#define BIT_QUEUEMACID_CMDQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_CMDQ_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_CMDQ_V1_8822C) -+#define BITS_QUEUEMACID_CMDQ_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_CMDQ_V1_8822C \ -+ << BIT_SHIFT_QUEUEMACID_CMDQ_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_CMDQ_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_CMDQ_V1_8822C)) -+#define BIT_GET_QUEUEMACID_CMDQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_CMDQ_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_CMDQ_V1_8822C) -+#define BIT_SET_QUEUEMACID_CMDQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_CMDQ_V1_8822C(x) | \ -+ BIT_QUEUEMACID_CMDQ_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_CMDQ_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_CMDQ_V1_8822C 0x3 -+#define BIT_QUEUEAC_CMDQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_CMDQ_V1_8822C) \ -+ << BIT_SHIFT_QUEUEAC_CMDQ_V1_8822C) -+#define BITS_QUEUEAC_CMDQ_V1_8822C \ -+ (BIT_MASK_QUEUEAC_CMDQ_V1_8822C << BIT_SHIFT_QUEUEAC_CMDQ_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_CMDQ_V1_8822C(x) ((x) & (~BITS_QUEUEAC_CMDQ_V1_8822C)) -+#define BIT_GET_QUEUEAC_CMDQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_CMDQ_V1_8822C) & \ -+ BIT_MASK_QUEUEAC_CMDQ_V1_8822C) -+#define BIT_SET_QUEUEAC_CMDQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_CMDQ_V1_8822C(x) | BIT_QUEUEAC_CMDQ_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_CMDQ_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q4_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_Q4_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_Q4_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q4_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_Q4_V2_8822C) -+#define BITS_TAIL_PKT_Q4_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_Q4_V2_8822C << BIT_SHIFT_TAIL_PKT_Q4_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_Q4_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_Q4_V2_8822C)) -+#define BIT_GET_TAIL_PKT_Q4_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q4_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_Q4_V2_8822C) -+#define BIT_SET_TAIL_PKT_Q4_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q4_V2_8822C(x) | BIT_TAIL_PKT_Q4_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_CMDQ_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_CMDQ_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_CMDQ_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_CMDQ_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_CMDQ_V1_8822C) -+#define BITS_HEAD_PKT_CMDQ_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_CMDQ_V1_8822C << BIT_SHIFT_HEAD_PKT_CMDQ_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_CMDQ_V1_8822C(x) \ -+ ((x) & (~BITS_HEAD_PKT_CMDQ_V1_8822C)) -+#define BIT_GET_HEAD_PKT_CMDQ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_CMDQ_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_CMDQ_V1_8822C) -+#define BIT_SET_HEAD_PKT_CMDQ_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_CMDQ_V1_8822C(x) | BIT_HEAD_PKT_CMDQ_V1_8822C(v)) -+ -+/* 2 REG_Q4_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q4_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_Q4_V1_8822C 0x7f -+#define BIT_QUEUEMACID_Q4_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q4_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_Q4_V1_8822C) -+#define BITS_QUEUEMACID_Q4_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_Q4_V1_8822C << BIT_SHIFT_QUEUEMACID_Q4_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_Q4_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q4_V1_8822C)) -+#define BIT_GET_QUEUEMACID_Q4_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q4_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_Q4_V1_8822C) -+#define BIT_SET_QUEUEMACID_Q4_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q4_V1_8822C(x) | BIT_QUEUEMACID_Q4_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q4_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_Q4_V1_8822C 0x3 -+#define BIT_QUEUEAC_Q4_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q4_V1_8822C) << BIT_SHIFT_QUEUEAC_Q4_V1_8822C) -+#define BITS_QUEUEAC_Q4_V1_8822C \ -+ (BIT_MASK_QUEUEAC_Q4_V1_8822C << BIT_SHIFT_QUEUEAC_Q4_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_Q4_V1_8822C(x) ((x) & (~BITS_QUEUEAC_Q4_V1_8822C)) -+#define BIT_GET_QUEUEAC_Q4_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q4_V1_8822C) & BIT_MASK_QUEUEAC_Q4_V1_8822C) -+#define BIT_SET_QUEUEAC_Q4_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q4_V1_8822C(x) | BIT_QUEUEAC_Q4_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_Q4_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q4_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_Q4_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_Q4_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q4_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_Q4_V2_8822C) -+#define BITS_TAIL_PKT_Q4_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_Q4_V2_8822C << BIT_SHIFT_TAIL_PKT_Q4_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_Q4_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_Q4_V2_8822C)) -+#define BIT_GET_TAIL_PKT_Q4_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q4_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_Q4_V2_8822C) -+#define BIT_SET_TAIL_PKT_Q4_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q4_V2_8822C(x) | BIT_TAIL_PKT_Q4_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q4_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_Q4_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_Q4_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q4_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_Q4_V1_8822C) -+#define BITS_HEAD_PKT_Q4_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_Q4_V1_8822C << BIT_SHIFT_HEAD_PKT_Q4_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_Q4_V1_8822C(x) ((x) & (~BITS_HEAD_PKT_Q4_V1_8822C)) -+#define BIT_GET_HEAD_PKT_Q4_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q4_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_Q4_V1_8822C) -+#define BIT_SET_HEAD_PKT_Q4_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q4_V1_8822C(x) | BIT_HEAD_PKT_Q4_V1_8822C(v)) -+ -+/* 2 REG_Q5_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q5_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_Q5_V1_8822C 0x7f -+#define BIT_QUEUEMACID_Q5_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q5_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_Q5_V1_8822C) -+#define BITS_QUEUEMACID_Q5_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_Q5_V1_8822C << BIT_SHIFT_QUEUEMACID_Q5_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_Q5_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q5_V1_8822C)) -+#define BIT_GET_QUEUEMACID_Q5_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q5_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_Q5_V1_8822C) -+#define BIT_SET_QUEUEMACID_Q5_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q5_V1_8822C(x) | BIT_QUEUEMACID_Q5_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q5_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_Q5_V1_8822C 0x3 -+#define BIT_QUEUEAC_Q5_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q5_V1_8822C) << BIT_SHIFT_QUEUEAC_Q5_V1_8822C) -+#define BITS_QUEUEAC_Q5_V1_8822C \ -+ (BIT_MASK_QUEUEAC_Q5_V1_8822C << BIT_SHIFT_QUEUEAC_Q5_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_Q5_V1_8822C(x) ((x) & (~BITS_QUEUEAC_Q5_V1_8822C)) -+#define BIT_GET_QUEUEAC_Q5_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q5_V1_8822C) & BIT_MASK_QUEUEAC_Q5_V1_8822C) -+#define BIT_SET_QUEUEAC_Q5_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q5_V1_8822C(x) | BIT_QUEUEAC_Q5_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_Q5_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q5_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_Q5_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_Q5_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q5_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_Q5_V2_8822C) -+#define BITS_TAIL_PKT_Q5_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_Q5_V2_8822C << BIT_SHIFT_TAIL_PKT_Q5_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_Q5_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_Q5_V2_8822C)) -+#define BIT_GET_TAIL_PKT_Q5_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q5_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_Q5_V2_8822C) -+#define BIT_SET_TAIL_PKT_Q5_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q5_V2_8822C(x) | BIT_TAIL_PKT_Q5_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q5_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_Q5_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_Q5_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q5_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_Q5_V1_8822C) -+#define BITS_HEAD_PKT_Q5_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_Q5_V1_8822C << BIT_SHIFT_HEAD_PKT_Q5_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_Q5_V1_8822C(x) ((x) & (~BITS_HEAD_PKT_Q5_V1_8822C)) -+#define BIT_GET_HEAD_PKT_Q5_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q5_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_Q5_V1_8822C) -+#define BIT_SET_HEAD_PKT_Q5_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q5_V1_8822C(x) | BIT_HEAD_PKT_Q5_V1_8822C(v)) -+ -+/* 2 REG_Q6_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q6_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_Q6_V1_8822C 0x7f -+#define BIT_QUEUEMACID_Q6_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q6_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_Q6_V1_8822C) -+#define BITS_QUEUEMACID_Q6_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_Q6_V1_8822C << BIT_SHIFT_QUEUEMACID_Q6_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_Q6_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q6_V1_8822C)) -+#define BIT_GET_QUEUEMACID_Q6_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q6_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_Q6_V1_8822C) -+#define BIT_SET_QUEUEMACID_Q6_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q6_V1_8822C(x) | BIT_QUEUEMACID_Q6_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q6_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_Q6_V1_8822C 0x3 -+#define BIT_QUEUEAC_Q6_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q6_V1_8822C) << BIT_SHIFT_QUEUEAC_Q6_V1_8822C) -+#define BITS_QUEUEAC_Q6_V1_8822C \ -+ (BIT_MASK_QUEUEAC_Q6_V1_8822C << BIT_SHIFT_QUEUEAC_Q6_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_Q6_V1_8822C(x) ((x) & (~BITS_QUEUEAC_Q6_V1_8822C)) -+#define BIT_GET_QUEUEAC_Q6_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q6_V1_8822C) & BIT_MASK_QUEUEAC_Q6_V1_8822C) -+#define BIT_SET_QUEUEAC_Q6_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q6_V1_8822C(x) | BIT_QUEUEAC_Q6_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_Q6_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q6_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_Q6_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_Q6_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q6_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_Q6_V2_8822C) -+#define BITS_TAIL_PKT_Q6_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_Q6_V2_8822C << BIT_SHIFT_TAIL_PKT_Q6_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_Q6_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_Q6_V2_8822C)) -+#define BIT_GET_TAIL_PKT_Q6_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q6_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_Q6_V2_8822C) -+#define BIT_SET_TAIL_PKT_Q6_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q6_V2_8822C(x) | BIT_TAIL_PKT_Q6_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q6_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_Q6_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_Q6_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q6_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_Q6_V1_8822C) -+#define BITS_HEAD_PKT_Q6_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_Q6_V1_8822C << BIT_SHIFT_HEAD_PKT_Q6_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_Q6_V1_8822C(x) ((x) & (~BITS_HEAD_PKT_Q6_V1_8822C)) -+#define BIT_GET_HEAD_PKT_Q6_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q6_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_Q6_V1_8822C) -+#define BIT_SET_HEAD_PKT_Q6_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q6_V1_8822C(x) | BIT_HEAD_PKT_Q6_V1_8822C(v)) -+ -+/* 2 REG_Q7_INFO_8822C */ -+ -+#define BIT_SHIFT_QUEUEMACID_Q7_V1_8822C 25 -+#define BIT_MASK_QUEUEMACID_Q7_V1_8822C 0x7f -+#define BIT_QUEUEMACID_Q7_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEMACID_Q7_V1_8822C) \ -+ << BIT_SHIFT_QUEUEMACID_Q7_V1_8822C) -+#define BITS_QUEUEMACID_Q7_V1_8822C \ -+ (BIT_MASK_QUEUEMACID_Q7_V1_8822C << BIT_SHIFT_QUEUEMACID_Q7_V1_8822C) -+#define BIT_CLEAR_QUEUEMACID_Q7_V1_8822C(x) \ -+ ((x) & (~BITS_QUEUEMACID_Q7_V1_8822C)) -+#define BIT_GET_QUEUEMACID_Q7_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEMACID_Q7_V1_8822C) & \ -+ BIT_MASK_QUEUEMACID_Q7_V1_8822C) -+#define BIT_SET_QUEUEMACID_Q7_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEMACID_Q7_V1_8822C(x) | BIT_QUEUEMACID_Q7_V1_8822C(v)) -+ -+#define BIT_SHIFT_QUEUEAC_Q7_V1_8822C 23 -+#define BIT_MASK_QUEUEAC_Q7_V1_8822C 0x3 -+#define BIT_QUEUEAC_Q7_V1_8822C(x) \ -+ (((x) & BIT_MASK_QUEUEAC_Q7_V1_8822C) << BIT_SHIFT_QUEUEAC_Q7_V1_8822C) -+#define BITS_QUEUEAC_Q7_V1_8822C \ -+ (BIT_MASK_QUEUEAC_Q7_V1_8822C << BIT_SHIFT_QUEUEAC_Q7_V1_8822C) -+#define BIT_CLEAR_QUEUEAC_Q7_V1_8822C(x) ((x) & (~BITS_QUEUEAC_Q7_V1_8822C)) -+#define BIT_GET_QUEUEAC_Q7_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_QUEUEAC_Q7_V1_8822C) & BIT_MASK_QUEUEAC_Q7_V1_8822C) -+#define BIT_SET_QUEUEAC_Q7_V1_8822C(x, v) \ -+ (BIT_CLEAR_QUEUEAC_Q7_V1_8822C(x) | BIT_QUEUEAC_Q7_V1_8822C(v)) -+ -+#define BIT_TIDEMPTY_Q7_V1_8822C BIT(22) -+ -+#define BIT_SHIFT_TAIL_PKT_Q7_V2_8822C 11 -+#define BIT_MASK_TAIL_PKT_Q7_V2_8822C 0x7ff -+#define BIT_TAIL_PKT_Q7_V2_8822C(x) \ -+ (((x) & BIT_MASK_TAIL_PKT_Q7_V2_8822C) \ -+ << BIT_SHIFT_TAIL_PKT_Q7_V2_8822C) -+#define BITS_TAIL_PKT_Q7_V2_8822C \ -+ (BIT_MASK_TAIL_PKT_Q7_V2_8822C << BIT_SHIFT_TAIL_PKT_Q7_V2_8822C) -+#define BIT_CLEAR_TAIL_PKT_Q7_V2_8822C(x) ((x) & (~BITS_TAIL_PKT_Q7_V2_8822C)) -+#define BIT_GET_TAIL_PKT_Q7_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TAIL_PKT_Q7_V2_8822C) & \ -+ BIT_MASK_TAIL_PKT_Q7_V2_8822C) -+#define BIT_SET_TAIL_PKT_Q7_V2_8822C(x, v) \ -+ (BIT_CLEAR_TAIL_PKT_Q7_V2_8822C(x) | BIT_TAIL_PKT_Q7_V2_8822C(v)) -+ -+#define BIT_SHIFT_HEAD_PKT_Q7_V1_8822C 0 -+#define BIT_MASK_HEAD_PKT_Q7_V1_8822C 0x7ff -+#define BIT_HEAD_PKT_Q7_V1_8822C(x) \ -+ (((x) & BIT_MASK_HEAD_PKT_Q7_V1_8822C) \ -+ << BIT_SHIFT_HEAD_PKT_Q7_V1_8822C) -+#define BITS_HEAD_PKT_Q7_V1_8822C \ -+ (BIT_MASK_HEAD_PKT_Q7_V1_8822C << BIT_SHIFT_HEAD_PKT_Q7_V1_8822C) -+#define BIT_CLEAR_HEAD_PKT_Q7_V1_8822C(x) ((x) & (~BITS_HEAD_PKT_Q7_V1_8822C)) -+#define BIT_GET_HEAD_PKT_Q7_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HEAD_PKT_Q7_V1_8822C) & \ -+ BIT_MASK_HEAD_PKT_Q7_V1_8822C) -+#define BIT_SET_HEAD_PKT_Q7_V1_8822C(x, v) \ -+ (BIT_CLEAR_HEAD_PKT_Q7_V1_8822C(x) | BIT_HEAD_PKT_Q7_V1_8822C(v)) -+ -+/* 2 REG_WMAC_LBK_BUF_HD_V1_8822C */ -+ -+#define BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8822C 0 -+#define BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8822C 0xfff -+#define BIT_WMAC_LBK_BUF_HEAD_V1_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8822C) \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8822C) -+#define BITS_WMAC_LBK_BUF_HEAD_V1_8822C \ -+ (BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8822C \ -+ << BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8822C) -+#define BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8822C(x) \ -+ ((x) & (~BITS_WMAC_LBK_BUF_HEAD_V1_8822C)) -+#define BIT_GET_WMAC_LBK_BUF_HEAD_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_LBK_BUF_HEAD_V1_8822C) & \ -+ BIT_MASK_WMAC_LBK_BUF_HEAD_V1_8822C) -+#define BIT_SET_WMAC_LBK_BUF_HEAD_V1_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_LBK_BUF_HEAD_V1_8822C(x) | \ -+ BIT_WMAC_LBK_BUF_HEAD_V1_8822C(v)) -+ -+/* 2 REG_MGQ_BDNY_V1_8822C */ -+ -+#define BIT_SHIFT_MGQ_PGBNDY_V1_8822C 0 -+#define BIT_MASK_MGQ_PGBNDY_V1_8822C 0xfff -+#define BIT_MGQ_PGBNDY_V1_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_PGBNDY_V1_8822C) << BIT_SHIFT_MGQ_PGBNDY_V1_8822C) -+#define BITS_MGQ_PGBNDY_V1_8822C \ -+ (BIT_MASK_MGQ_PGBNDY_V1_8822C << BIT_SHIFT_MGQ_PGBNDY_V1_8822C) -+#define BIT_CLEAR_MGQ_PGBNDY_V1_8822C(x) ((x) & (~BITS_MGQ_PGBNDY_V1_8822C)) -+#define BIT_GET_MGQ_PGBNDY_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PGBNDY_V1_8822C) & BIT_MASK_MGQ_PGBNDY_V1_8822C) -+#define BIT_SET_MGQ_PGBNDY_V1_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_PGBNDY_V1_8822C(x) | BIT_MGQ_PGBNDY_V1_8822C(v)) -+ -+/* 2 REG_TXRPT_CTRL_8822C */ -+ -+#define BIT_SHIFT_TRXRPT_TIMER_TH_8822C 24 -+#define BIT_MASK_TRXRPT_TIMER_TH_8822C 0xff -+#define BIT_TRXRPT_TIMER_TH_8822C(x) \ -+ (((x) & BIT_MASK_TRXRPT_TIMER_TH_8822C) \ -+ << BIT_SHIFT_TRXRPT_TIMER_TH_8822C) -+#define BITS_TRXRPT_TIMER_TH_8822C \ -+ (BIT_MASK_TRXRPT_TIMER_TH_8822C << BIT_SHIFT_TRXRPT_TIMER_TH_8822C) -+#define BIT_CLEAR_TRXRPT_TIMER_TH_8822C(x) ((x) & (~BITS_TRXRPT_TIMER_TH_8822C)) -+#define BIT_GET_TRXRPT_TIMER_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_TIMER_TH_8822C) & \ -+ BIT_MASK_TRXRPT_TIMER_TH_8822C) -+#define BIT_SET_TRXRPT_TIMER_TH_8822C(x, v) \ -+ (BIT_CLEAR_TRXRPT_TIMER_TH_8822C(x) | BIT_TRXRPT_TIMER_TH_8822C(v)) -+ -+#define BIT_SHIFT_TRXRPT_LEN_TH_8822C 16 -+#define BIT_MASK_TRXRPT_LEN_TH_8822C 0xff -+#define BIT_TRXRPT_LEN_TH_8822C(x) \ -+ (((x) & BIT_MASK_TRXRPT_LEN_TH_8822C) << BIT_SHIFT_TRXRPT_LEN_TH_8822C) -+#define BITS_TRXRPT_LEN_TH_8822C \ -+ (BIT_MASK_TRXRPT_LEN_TH_8822C << BIT_SHIFT_TRXRPT_LEN_TH_8822C) -+#define BIT_CLEAR_TRXRPT_LEN_TH_8822C(x) ((x) & (~BITS_TRXRPT_LEN_TH_8822C)) -+#define BIT_GET_TRXRPT_LEN_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_LEN_TH_8822C) & BIT_MASK_TRXRPT_LEN_TH_8822C) -+#define BIT_SET_TRXRPT_LEN_TH_8822C(x, v) \ -+ (BIT_CLEAR_TRXRPT_LEN_TH_8822C(x) | BIT_TRXRPT_LEN_TH_8822C(v)) -+ -+#define BIT_SHIFT_TRXRPT_READ_PTR_8822C 8 -+#define BIT_MASK_TRXRPT_READ_PTR_8822C 0xff -+#define BIT_TRXRPT_READ_PTR_8822C(x) \ -+ (((x) & BIT_MASK_TRXRPT_READ_PTR_8822C) \ -+ << BIT_SHIFT_TRXRPT_READ_PTR_8822C) -+#define BITS_TRXRPT_READ_PTR_8822C \ -+ (BIT_MASK_TRXRPT_READ_PTR_8822C << BIT_SHIFT_TRXRPT_READ_PTR_8822C) -+#define BIT_CLEAR_TRXRPT_READ_PTR_8822C(x) ((x) & (~BITS_TRXRPT_READ_PTR_8822C)) -+#define BIT_GET_TRXRPT_READ_PTR_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_READ_PTR_8822C) & \ -+ BIT_MASK_TRXRPT_READ_PTR_8822C) -+#define BIT_SET_TRXRPT_READ_PTR_8822C(x, v) \ -+ (BIT_CLEAR_TRXRPT_READ_PTR_8822C(x) | BIT_TRXRPT_READ_PTR_8822C(v)) -+ -+#define BIT_SHIFT_TRXRPT_WRITE_PTR_8822C 0 -+#define BIT_MASK_TRXRPT_WRITE_PTR_8822C 0xff -+#define BIT_TRXRPT_WRITE_PTR_8822C(x) \ -+ (((x) & BIT_MASK_TRXRPT_WRITE_PTR_8822C) \ -+ << BIT_SHIFT_TRXRPT_WRITE_PTR_8822C) -+#define BITS_TRXRPT_WRITE_PTR_8822C \ -+ (BIT_MASK_TRXRPT_WRITE_PTR_8822C << BIT_SHIFT_TRXRPT_WRITE_PTR_8822C) -+#define BIT_CLEAR_TRXRPT_WRITE_PTR_8822C(x) \ -+ ((x) & (~BITS_TRXRPT_WRITE_PTR_8822C)) -+#define BIT_GET_TRXRPT_WRITE_PTR_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRXRPT_WRITE_PTR_8822C) & \ -+ BIT_MASK_TRXRPT_WRITE_PTR_8822C) -+#define BIT_SET_TRXRPT_WRITE_PTR_8822C(x, v) \ -+ (BIT_CLEAR_TRXRPT_WRITE_PTR_8822C(x) | BIT_TRXRPT_WRITE_PTR_8822C(v)) -+ -+/* 2 REG_INIRTS_RATE_SEL_8822C */ -+#define BIT_LEAG_RTS_BW_DUP_8822C BIT(5) -+ -+/* 2 REG_BASIC_CFEND_RATE_8822C */ -+ -+#define BIT_SHIFT_BASIC_CFEND_RATE_8822C 0 -+#define BIT_MASK_BASIC_CFEND_RATE_8822C 0x1f -+#define BIT_BASIC_CFEND_RATE_8822C(x) \ -+ (((x) & BIT_MASK_BASIC_CFEND_RATE_8822C) \ -+ << BIT_SHIFT_BASIC_CFEND_RATE_8822C) -+#define BITS_BASIC_CFEND_RATE_8822C \ -+ (BIT_MASK_BASIC_CFEND_RATE_8822C << BIT_SHIFT_BASIC_CFEND_RATE_8822C) -+#define BIT_CLEAR_BASIC_CFEND_RATE_8822C(x) \ -+ ((x) & (~BITS_BASIC_CFEND_RATE_8822C)) -+#define BIT_GET_BASIC_CFEND_RATE_8822C(x) \ -+ (((x) >> BIT_SHIFT_BASIC_CFEND_RATE_8822C) & \ -+ BIT_MASK_BASIC_CFEND_RATE_8822C) -+#define BIT_SET_BASIC_CFEND_RATE_8822C(x, v) \ -+ (BIT_CLEAR_BASIC_CFEND_RATE_8822C(x) | BIT_BASIC_CFEND_RATE_8822C(v)) -+ -+/* 2 REG_STBC_CFEND_RATE_8822C */ -+ -+#define BIT_SHIFT_STBC_CFEND_RATE_8822C 0 -+#define BIT_MASK_STBC_CFEND_RATE_8822C 0x1f -+#define BIT_STBC_CFEND_RATE_8822C(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_RATE_8822C) \ -+ << BIT_SHIFT_STBC_CFEND_RATE_8822C) -+#define BITS_STBC_CFEND_RATE_8822C \ -+ (BIT_MASK_STBC_CFEND_RATE_8822C << BIT_SHIFT_STBC_CFEND_RATE_8822C) -+#define BIT_CLEAR_STBC_CFEND_RATE_8822C(x) ((x) & (~BITS_STBC_CFEND_RATE_8822C)) -+#define BIT_GET_STBC_CFEND_RATE_8822C(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_RATE_8822C) & \ -+ BIT_MASK_STBC_CFEND_RATE_8822C) -+#define BIT_SET_STBC_CFEND_RATE_8822C(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_RATE_8822C(x) | BIT_STBC_CFEND_RATE_8822C(v)) -+ -+/* 2 REG_DATA_SC_8822C */ -+ -+#define BIT_SHIFT_TXSC_40M_8822C 4 -+#define BIT_MASK_TXSC_40M_8822C 0xf -+#define BIT_TXSC_40M_8822C(x) \ -+ (((x) & BIT_MASK_TXSC_40M_8822C) << BIT_SHIFT_TXSC_40M_8822C) -+#define BITS_TXSC_40M_8822C \ -+ (BIT_MASK_TXSC_40M_8822C << BIT_SHIFT_TXSC_40M_8822C) -+#define BIT_CLEAR_TXSC_40M_8822C(x) ((x) & (~BITS_TXSC_40M_8822C)) -+#define BIT_GET_TXSC_40M_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXSC_40M_8822C) & BIT_MASK_TXSC_40M_8822C) -+#define BIT_SET_TXSC_40M_8822C(x, v) \ -+ (BIT_CLEAR_TXSC_40M_8822C(x) | BIT_TXSC_40M_8822C(v)) -+ -+#define BIT_SHIFT_TXSC_20M_8822C 0 -+#define BIT_MASK_TXSC_20M_8822C 0xf -+#define BIT_TXSC_20M_8822C(x) \ -+ (((x) & BIT_MASK_TXSC_20M_8822C) << BIT_SHIFT_TXSC_20M_8822C) -+#define BITS_TXSC_20M_8822C \ -+ (BIT_MASK_TXSC_20M_8822C << BIT_SHIFT_TXSC_20M_8822C) -+#define BIT_CLEAR_TXSC_20M_8822C(x) ((x) & (~BITS_TXSC_20M_8822C)) -+#define BIT_GET_TXSC_20M_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXSC_20M_8822C) & BIT_MASK_TXSC_20M_8822C) -+#define BIT_SET_TXSC_20M_8822C(x, v) \ -+ (BIT_CLEAR_TXSC_20M_8822C(x) | BIT_TXSC_20M_8822C(v)) -+ -+/* 2 REG_MACID_SLEEP3_8822C */ -+ -+#define BIT_SHIFT_MACID127_96_PKTSLEEP_8822C 0 -+#define BIT_MASK_MACID127_96_PKTSLEEP_8822C 0xffffffffL -+#define BIT_MACID127_96_PKTSLEEP_8822C(x) \ -+ (((x) & BIT_MASK_MACID127_96_PKTSLEEP_8822C) \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP_8822C) -+#define BITS_MACID127_96_PKTSLEEP_8822C \ -+ (BIT_MASK_MACID127_96_PKTSLEEP_8822C \ -+ << BIT_SHIFT_MACID127_96_PKTSLEEP_8822C) -+#define BIT_CLEAR_MACID127_96_PKTSLEEP_8822C(x) \ -+ ((x) & (~BITS_MACID127_96_PKTSLEEP_8822C)) -+#define BIT_GET_MACID127_96_PKTSLEEP_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_PKTSLEEP_8822C) & \ -+ BIT_MASK_MACID127_96_PKTSLEEP_8822C) -+#define BIT_SET_MACID127_96_PKTSLEEP_8822C(x, v) \ -+ (BIT_CLEAR_MACID127_96_PKTSLEEP_8822C(x) | \ -+ BIT_MACID127_96_PKTSLEEP_8822C(v)) -+ -+/* 2 REG_MACID_SLEEP1_8822C */ -+ -+#define BIT_SHIFT_MACID63_32_PKTSLEEP_8822C 0 -+#define BIT_MASK_MACID63_32_PKTSLEEP_8822C 0xffffffffL -+#define BIT_MACID63_32_PKTSLEEP_8822C(x) \ -+ (((x) & BIT_MASK_MACID63_32_PKTSLEEP_8822C) \ -+ << BIT_SHIFT_MACID63_32_PKTSLEEP_8822C) -+#define BITS_MACID63_32_PKTSLEEP_8822C \ -+ (BIT_MASK_MACID63_32_PKTSLEEP_8822C \ -+ << BIT_SHIFT_MACID63_32_PKTSLEEP_8822C) -+#define BIT_CLEAR_MACID63_32_PKTSLEEP_8822C(x) \ -+ ((x) & (~BITS_MACID63_32_PKTSLEEP_8822C)) -+#define BIT_GET_MACID63_32_PKTSLEEP_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_PKTSLEEP_8822C) & \ -+ BIT_MASK_MACID63_32_PKTSLEEP_8822C) -+#define BIT_SET_MACID63_32_PKTSLEEP_8822C(x, v) \ -+ (BIT_CLEAR_MACID63_32_PKTSLEEP_8822C(x) | \ -+ BIT_MACID63_32_PKTSLEEP_8822C(v)) -+ -+/* 2 REG_ARFR2_V1_8822C */ -+ -+#define BIT_SHIFT_ARFRL2_8822C 0 -+#define BIT_MASK_ARFRL2_8822C 0xffffffffL -+#define BIT_ARFRL2_8822C(x) \ -+ (((x) & BIT_MASK_ARFRL2_8822C) << BIT_SHIFT_ARFRL2_8822C) -+#define BITS_ARFRL2_8822C (BIT_MASK_ARFRL2_8822C << BIT_SHIFT_ARFRL2_8822C) -+#define BIT_CLEAR_ARFRL2_8822C(x) ((x) & (~BITS_ARFRL2_8822C)) -+#define BIT_GET_ARFRL2_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL2_8822C) & BIT_MASK_ARFRL2_8822C) -+#define BIT_SET_ARFRL2_8822C(x, v) \ -+ (BIT_CLEAR_ARFRL2_8822C(x) | BIT_ARFRL2_8822C(v)) -+ -+/* 2 REG_ARFRH2_V1_8822C */ -+ -+#define BIT_SHIFT_ARFRH2_8822C 0 -+#define BIT_MASK_ARFRH2_8822C 0xffffffffL -+#define BIT_ARFRH2_8822C(x) \ -+ (((x) & BIT_MASK_ARFRH2_8822C) << BIT_SHIFT_ARFRH2_8822C) -+#define BITS_ARFRH2_8822C (BIT_MASK_ARFRH2_8822C << BIT_SHIFT_ARFRH2_8822C) -+#define BIT_CLEAR_ARFRH2_8822C(x) ((x) & (~BITS_ARFRH2_8822C)) -+#define BIT_GET_ARFRH2_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH2_8822C) & BIT_MASK_ARFRH2_8822C) -+#define BIT_SET_ARFRH2_8822C(x, v) \ -+ (BIT_CLEAR_ARFRH2_8822C(x) | BIT_ARFRH2_8822C(v)) -+ -+/* 2 REG_ARFR3_V1_8822C */ -+ -+#define BIT_SHIFT_ARFRL3_8822C 0 -+#define BIT_MASK_ARFRL3_8822C 0xffffffffL -+#define BIT_ARFRL3_8822C(x) \ -+ (((x) & BIT_MASK_ARFRL3_8822C) << BIT_SHIFT_ARFRL3_8822C) -+#define BITS_ARFRL3_8822C (BIT_MASK_ARFRL3_8822C << BIT_SHIFT_ARFRL3_8822C) -+#define BIT_CLEAR_ARFRL3_8822C(x) ((x) & (~BITS_ARFRL3_8822C)) -+#define BIT_GET_ARFRL3_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL3_8822C) & BIT_MASK_ARFRL3_8822C) -+#define BIT_SET_ARFRL3_8822C(x, v) \ -+ (BIT_CLEAR_ARFRL3_8822C(x) | BIT_ARFRL3_8822C(v)) -+ -+/* 2 REG_ARFRH3_V1_8822C */ -+ -+#define BIT_SHIFT_ARFRH3_8822C 0 -+#define BIT_MASK_ARFRH3_8822C 0xffffffffL -+#define BIT_ARFRH3_8822C(x) \ -+ (((x) & BIT_MASK_ARFRH3_8822C) << BIT_SHIFT_ARFRH3_8822C) -+#define BITS_ARFRH3_8822C (BIT_MASK_ARFRH3_8822C << BIT_SHIFT_ARFRH3_8822C) -+#define BIT_CLEAR_ARFRH3_8822C(x) ((x) & (~BITS_ARFRH3_8822C)) -+#define BIT_GET_ARFRH3_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH3_8822C) & BIT_MASK_ARFRH3_8822C) -+#define BIT_SET_ARFRH3_8822C(x, v) \ -+ (BIT_CLEAR_ARFRH3_8822C(x) | BIT_ARFRH3_8822C(v)) -+ -+/* 2 REG_ARFR4_8822C */ -+ -+#define BIT_SHIFT_ARFRL4_8822C 0 -+#define BIT_MASK_ARFRL4_8822C 0xffffffffL -+#define BIT_ARFRL4_8822C(x) \ -+ (((x) & BIT_MASK_ARFRL4_8822C) << BIT_SHIFT_ARFRL4_8822C) -+#define BITS_ARFRL4_8822C (BIT_MASK_ARFRL4_8822C << BIT_SHIFT_ARFRL4_8822C) -+#define BIT_CLEAR_ARFRL4_8822C(x) ((x) & (~BITS_ARFRL4_8822C)) -+#define BIT_GET_ARFRL4_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL4_8822C) & BIT_MASK_ARFRL4_8822C) -+#define BIT_SET_ARFRL4_8822C(x, v) \ -+ (BIT_CLEAR_ARFRL4_8822C(x) | BIT_ARFRL4_8822C(v)) -+ -+/* 2 REG_ARFRH4_8822C */ -+ -+#define BIT_SHIFT_ARFRH4_8822C 0 -+#define BIT_MASK_ARFRH4_8822C 0xffffffffL -+#define BIT_ARFRH4_8822C(x) \ -+ (((x) & BIT_MASK_ARFRH4_8822C) << BIT_SHIFT_ARFRH4_8822C) -+#define BITS_ARFRH4_8822C (BIT_MASK_ARFRH4_8822C << BIT_SHIFT_ARFRH4_8822C) -+#define BIT_CLEAR_ARFRH4_8822C(x) ((x) & (~BITS_ARFRH4_8822C)) -+#define BIT_GET_ARFRH4_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH4_8822C) & BIT_MASK_ARFRH4_8822C) -+#define BIT_SET_ARFRH4_8822C(x, v) \ -+ (BIT_CLEAR_ARFRH4_8822C(x) | BIT_ARFRH4_8822C(v)) -+ -+/* 2 REG_ARFR5_8822C */ -+ -+#define BIT_SHIFT_ARFRL5_8822C 0 -+#define BIT_MASK_ARFRL5_8822C 0xffffffffL -+#define BIT_ARFRL5_8822C(x) \ -+ (((x) & BIT_MASK_ARFRL5_8822C) << BIT_SHIFT_ARFRL5_8822C) -+#define BITS_ARFRL5_8822C (BIT_MASK_ARFRL5_8822C << BIT_SHIFT_ARFRL5_8822C) -+#define BIT_CLEAR_ARFRL5_8822C(x) ((x) & (~BITS_ARFRL5_8822C)) -+#define BIT_GET_ARFRL5_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRL5_8822C) & BIT_MASK_ARFRL5_8822C) -+#define BIT_SET_ARFRL5_8822C(x, v) \ -+ (BIT_CLEAR_ARFRL5_8822C(x) | BIT_ARFRL5_8822C(v)) -+ -+/* 2 REG_ARFRH5_8822C */ -+ -+#define BIT_SHIFT_ARFRH5_8822C 0 -+#define BIT_MASK_ARFRH5_8822C 0xffffffffL -+#define BIT_ARFRH5_8822C(x) \ -+ (((x) & BIT_MASK_ARFRH5_8822C) << BIT_SHIFT_ARFRH5_8822C) -+#define BITS_ARFRH5_8822C (BIT_MASK_ARFRH5_8822C << BIT_SHIFT_ARFRH5_8822C) -+#define BIT_CLEAR_ARFRH5_8822C(x) ((x) & (~BITS_ARFRH5_8822C)) -+#define BIT_GET_ARFRH5_8822C(x) \ -+ (((x) >> BIT_SHIFT_ARFRH5_8822C) & BIT_MASK_ARFRH5_8822C) -+#define BIT_SET_ARFRH5_8822C(x, v) \ -+ (BIT_CLEAR_ARFRH5_8822C(x) | BIT_ARFRH5_8822C(v)) -+ -+/* 2 REG_TXRPT_START_OFFSET_8822C */ -+ -+#define BIT_SHIFT_MACID_MURATE_OFFSET_8822C 24 -+#define BIT_MASK_MACID_MURATE_OFFSET_8822C 0xff -+#define BIT_MACID_MURATE_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_MACID_MURATE_OFFSET_8822C) \ -+ << BIT_SHIFT_MACID_MURATE_OFFSET_8822C) -+#define BITS_MACID_MURATE_OFFSET_8822C \ -+ (BIT_MASK_MACID_MURATE_OFFSET_8822C \ -+ << BIT_SHIFT_MACID_MURATE_OFFSET_8822C) -+#define BIT_CLEAR_MACID_MURATE_OFFSET_8822C(x) \ -+ ((x) & (~BITS_MACID_MURATE_OFFSET_8822C)) -+#define BIT_GET_MACID_MURATE_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID_MURATE_OFFSET_8822C) & \ -+ BIT_MASK_MACID_MURATE_OFFSET_8822C) -+#define BIT_SET_MACID_MURATE_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_MACID_MURATE_OFFSET_8822C(x) | \ -+ BIT_MACID_MURATE_OFFSET_8822C(v)) -+ -+#define BIT_SHIFT_TXRPT_MISS_COUNT_8822C 17 -+#define BIT_MASK_TXRPT_MISS_COUNT_8822C 0x7 -+#define BIT_TXRPT_MISS_COUNT_8822C(x) \ -+ (((x) & BIT_MASK_TXRPT_MISS_COUNT_8822C) \ -+ << BIT_SHIFT_TXRPT_MISS_COUNT_8822C) -+#define BITS_TXRPT_MISS_COUNT_8822C \ -+ (BIT_MASK_TXRPT_MISS_COUNT_8822C << BIT_SHIFT_TXRPT_MISS_COUNT_8822C) -+#define BIT_CLEAR_TXRPT_MISS_COUNT_8822C(x) \ -+ ((x) & (~BITS_TXRPT_MISS_COUNT_8822C)) -+#define BIT_GET_TXRPT_MISS_COUNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXRPT_MISS_COUNT_8822C) & \ -+ BIT_MASK_TXRPT_MISS_COUNT_8822C) -+#define BIT_SET_TXRPT_MISS_COUNT_8822C(x, v) \ -+ (BIT_CLEAR_TXRPT_MISS_COUNT_8822C(x) | BIT_TXRPT_MISS_COUNT_8822C(v)) -+ -+#define BIT_RPTFIFO_SIZE_OPT_8822C BIT(16) -+ -+#define BIT_SHIFT_MACID_CTRL_OFFSET_8822C 8 -+#define BIT_MASK_MACID_CTRL_OFFSET_8822C 0xff -+#define BIT_MACID_CTRL_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_MACID_CTRL_OFFSET_8822C) \ -+ << BIT_SHIFT_MACID_CTRL_OFFSET_8822C) -+#define BITS_MACID_CTRL_OFFSET_8822C \ -+ (BIT_MASK_MACID_CTRL_OFFSET_8822C << BIT_SHIFT_MACID_CTRL_OFFSET_8822C) -+#define BIT_CLEAR_MACID_CTRL_OFFSET_8822C(x) \ -+ ((x) & (~BITS_MACID_CTRL_OFFSET_8822C)) -+#define BIT_GET_MACID_CTRL_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID_CTRL_OFFSET_8822C) & \ -+ BIT_MASK_MACID_CTRL_OFFSET_8822C) -+#define BIT_SET_MACID_CTRL_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_MACID_CTRL_OFFSET_8822C(x) | BIT_MACID_CTRL_OFFSET_8822C(v)) -+ -+#define BIT_SHIFT_AMPDU_TXRPT_OFFSET_8822C 0 -+#define BIT_MASK_AMPDU_TXRPT_OFFSET_8822C 0xff -+#define BIT_AMPDU_TXRPT_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_AMPDU_TXRPT_OFFSET_8822C) \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_8822C) -+#define BITS_AMPDU_TXRPT_OFFSET_8822C \ -+ (BIT_MASK_AMPDU_TXRPT_OFFSET_8822C \ -+ << BIT_SHIFT_AMPDU_TXRPT_OFFSET_8822C) -+#define BIT_CLEAR_AMPDU_TXRPT_OFFSET_8822C(x) \ -+ ((x) & (~BITS_AMPDU_TXRPT_OFFSET_8822C)) -+#define BIT_GET_AMPDU_TXRPT_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_AMPDU_TXRPT_OFFSET_8822C) & \ -+ BIT_MASK_AMPDU_TXRPT_OFFSET_8822C) -+#define BIT_SET_AMPDU_TXRPT_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_AMPDU_TXRPT_OFFSET_8822C(x) | \ -+ BIT_AMPDU_TXRPT_OFFSET_8822C(v)) -+ -+/* 2 REG_POWER_STAGE1_8822C */ -+#define BIT_PTA_WL_PRI_MASK_CPU_MGQ_8822C BIT(31) -+#define BIT_PTA_WL_PRI_MASK_BCNQ_8822C BIT(30) -+#define BIT_PTA_WL_PRI_MASK_HIQ_8822C BIT(29) -+#define BIT_PTA_WL_PRI_MASK_MGQ_8822C BIT(28) -+#define BIT_PTA_WL_PRI_MASK_BK_8822C BIT(27) -+#define BIT_PTA_WL_PRI_MASK_BE_8822C BIT(26) -+#define BIT_PTA_WL_PRI_MASK_VI_8822C BIT(25) -+#define BIT_PTA_WL_PRI_MASK_VO_8822C BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE1_8822C 0 -+#define BIT_MASK_POWER_STAGE1_8822C 0xffffff -+#define BIT_POWER_STAGE1_8822C(x) \ -+ (((x) & BIT_MASK_POWER_STAGE1_8822C) << BIT_SHIFT_POWER_STAGE1_8822C) -+#define BITS_POWER_STAGE1_8822C \ -+ (BIT_MASK_POWER_STAGE1_8822C << BIT_SHIFT_POWER_STAGE1_8822C) -+#define BIT_CLEAR_POWER_STAGE1_8822C(x) ((x) & (~BITS_POWER_STAGE1_8822C)) -+#define BIT_GET_POWER_STAGE1_8822C(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE1_8822C) & BIT_MASK_POWER_STAGE1_8822C) -+#define BIT_SET_POWER_STAGE1_8822C(x, v) \ -+ (BIT_CLEAR_POWER_STAGE1_8822C(x) | BIT_POWER_STAGE1_8822C(v)) -+ -+/* 2 REG_POWER_STAGE2_8822C */ -+#define BIT__R_CTRL_PKT_POW_ADJ_8822C BIT(24) -+ -+#define BIT_SHIFT_POWER_STAGE2_8822C 0 -+#define BIT_MASK_POWER_STAGE2_8822C 0xffffff -+#define BIT_POWER_STAGE2_8822C(x) \ -+ (((x) & BIT_MASK_POWER_STAGE2_8822C) << BIT_SHIFT_POWER_STAGE2_8822C) -+#define BITS_POWER_STAGE2_8822C \ -+ (BIT_MASK_POWER_STAGE2_8822C << BIT_SHIFT_POWER_STAGE2_8822C) -+#define BIT_CLEAR_POWER_STAGE2_8822C(x) ((x) & (~BITS_POWER_STAGE2_8822C)) -+#define BIT_GET_POWER_STAGE2_8822C(x) \ -+ (((x) >> BIT_SHIFT_POWER_STAGE2_8822C) & BIT_MASK_POWER_STAGE2_8822C) -+#define BIT_SET_POWER_STAGE2_8822C(x, v) \ -+ (BIT_CLEAR_POWER_STAGE2_8822C(x) | BIT_POWER_STAGE2_8822C(v)) -+ -+/* 2 REG_SW_AMPDU_BURST_MODE_CTRL_8822C */ -+ -+#define BIT_SHIFT_PAD_NUM_THRES_8822C 24 -+#define BIT_MASK_PAD_NUM_THRES_8822C 0x3f -+#define BIT_PAD_NUM_THRES_8822C(x) \ -+ (((x) & BIT_MASK_PAD_NUM_THRES_8822C) << BIT_SHIFT_PAD_NUM_THRES_8822C) -+#define BITS_PAD_NUM_THRES_8822C \ -+ (BIT_MASK_PAD_NUM_THRES_8822C << BIT_SHIFT_PAD_NUM_THRES_8822C) -+#define BIT_CLEAR_PAD_NUM_THRES_8822C(x) ((x) & (~BITS_PAD_NUM_THRES_8822C)) -+#define BIT_GET_PAD_NUM_THRES_8822C(x) \ -+ (((x) >> BIT_SHIFT_PAD_NUM_THRES_8822C) & BIT_MASK_PAD_NUM_THRES_8822C) -+#define BIT_SET_PAD_NUM_THRES_8822C(x, v) \ -+ (BIT_CLEAR_PAD_NUM_THRES_8822C(x) | BIT_PAD_NUM_THRES_8822C(v)) -+ -+#define BIT_R_DMA_THIS_QUEUE_BK_8822C BIT(23) -+#define BIT_R_DMA_THIS_QUEUE_BE_8822C BIT(22) -+#define BIT_R_DMA_THIS_QUEUE_VI_8822C BIT(21) -+#define BIT_R_DMA_THIS_QUEUE_VO_8822C BIT(20) -+ -+#define BIT_SHIFT_R_TOTAL_LEN_TH_8822C 8 -+#define BIT_MASK_R_TOTAL_LEN_TH_8822C 0xfff -+#define BIT_R_TOTAL_LEN_TH_8822C(x) \ -+ (((x) & BIT_MASK_R_TOTAL_LEN_TH_8822C) \ -+ << BIT_SHIFT_R_TOTAL_LEN_TH_8822C) -+#define BITS_R_TOTAL_LEN_TH_8822C \ -+ (BIT_MASK_R_TOTAL_LEN_TH_8822C << BIT_SHIFT_R_TOTAL_LEN_TH_8822C) -+#define BIT_CLEAR_R_TOTAL_LEN_TH_8822C(x) ((x) & (~BITS_R_TOTAL_LEN_TH_8822C)) -+#define BIT_GET_R_TOTAL_LEN_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_TOTAL_LEN_TH_8822C) & \ -+ BIT_MASK_R_TOTAL_LEN_TH_8822C) -+#define BIT_SET_R_TOTAL_LEN_TH_8822C(x, v) \ -+ (BIT_CLEAR_R_TOTAL_LEN_TH_8822C(x) | BIT_R_TOTAL_LEN_TH_8822C(v)) -+ -+#define BIT_EN_NEW_EARLY_8822C BIT(7) -+#define BIT_PRE_TX_CMD_8822C BIT(6) -+ -+#define BIT_SHIFT_NUM_SCL_EN_8822C 4 -+#define BIT_MASK_NUM_SCL_EN_8822C 0x3 -+#define BIT_NUM_SCL_EN_8822C(x) \ -+ (((x) & BIT_MASK_NUM_SCL_EN_8822C) << BIT_SHIFT_NUM_SCL_EN_8822C) -+#define BITS_NUM_SCL_EN_8822C \ -+ (BIT_MASK_NUM_SCL_EN_8822C << BIT_SHIFT_NUM_SCL_EN_8822C) -+#define BIT_CLEAR_NUM_SCL_EN_8822C(x) ((x) & (~BITS_NUM_SCL_EN_8822C)) -+#define BIT_GET_NUM_SCL_EN_8822C(x) \ -+ (((x) >> BIT_SHIFT_NUM_SCL_EN_8822C) & BIT_MASK_NUM_SCL_EN_8822C) -+#define BIT_SET_NUM_SCL_EN_8822C(x, v) \ -+ (BIT_CLEAR_NUM_SCL_EN_8822C(x) | BIT_NUM_SCL_EN_8822C(v)) -+ -+#define BIT_BK_EN_8822C BIT(3) -+#define BIT_BE_EN_8822C BIT(2) -+#define BIT_VI_EN_8822C BIT(1) -+#define BIT_VO_EN_8822C BIT(0) -+ -+/* 2 REG_PKT_LIFE_TIME_8822C */ -+ -+#define BIT_SHIFT_PKT_LIFTIME_BEBK_8822C 16 -+#define BIT_MASK_PKT_LIFTIME_BEBK_8822C 0xffff -+#define BIT_PKT_LIFTIME_BEBK_8822C(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_BEBK_8822C) \ -+ << BIT_SHIFT_PKT_LIFTIME_BEBK_8822C) -+#define BITS_PKT_LIFTIME_BEBK_8822C \ -+ (BIT_MASK_PKT_LIFTIME_BEBK_8822C << BIT_SHIFT_PKT_LIFTIME_BEBK_8822C) -+#define BIT_CLEAR_PKT_LIFTIME_BEBK_8822C(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_BEBK_8822C)) -+#define BIT_GET_PKT_LIFTIME_BEBK_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_BEBK_8822C) & \ -+ BIT_MASK_PKT_LIFTIME_BEBK_8822C) -+#define BIT_SET_PKT_LIFTIME_BEBK_8822C(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_BEBK_8822C(x) | BIT_PKT_LIFTIME_BEBK_8822C(v)) -+ -+#define BIT_SHIFT_PKT_LIFTIME_VOVI_8822C 0 -+#define BIT_MASK_PKT_LIFTIME_VOVI_8822C 0xffff -+#define BIT_PKT_LIFTIME_VOVI_8822C(x) \ -+ (((x) & BIT_MASK_PKT_LIFTIME_VOVI_8822C) \ -+ << BIT_SHIFT_PKT_LIFTIME_VOVI_8822C) -+#define BITS_PKT_LIFTIME_VOVI_8822C \ -+ (BIT_MASK_PKT_LIFTIME_VOVI_8822C << BIT_SHIFT_PKT_LIFTIME_VOVI_8822C) -+#define BIT_CLEAR_PKT_LIFTIME_VOVI_8822C(x) \ -+ ((x) & (~BITS_PKT_LIFTIME_VOVI_8822C)) -+#define BIT_GET_PKT_LIFTIME_VOVI_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKT_LIFTIME_VOVI_8822C) & \ -+ BIT_MASK_PKT_LIFTIME_VOVI_8822C) -+#define BIT_SET_PKT_LIFTIME_VOVI_8822C(x, v) \ -+ (BIT_CLEAR_PKT_LIFTIME_VOVI_8822C(x) | BIT_PKT_LIFTIME_VOVI_8822C(v)) -+ -+/* 2 REG_STBC_SETTING_8822C */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_L_8822C 4 -+#define BIT_MASK_CDEND_TXTIME_L_8822C 0xf -+#define BIT_CDEND_TXTIME_L_8822C(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_L_8822C) \ -+ << BIT_SHIFT_CDEND_TXTIME_L_8822C) -+#define BITS_CDEND_TXTIME_L_8822C \ -+ (BIT_MASK_CDEND_TXTIME_L_8822C << BIT_SHIFT_CDEND_TXTIME_L_8822C) -+#define BIT_CLEAR_CDEND_TXTIME_L_8822C(x) ((x) & (~BITS_CDEND_TXTIME_L_8822C)) -+#define BIT_GET_CDEND_TXTIME_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_L_8822C) & \ -+ BIT_MASK_CDEND_TXTIME_L_8822C) -+#define BIT_SET_CDEND_TXTIME_L_8822C(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_L_8822C(x) | BIT_CDEND_TXTIME_L_8822C(v)) -+ -+#define BIT_SHIFT_NESS_8822C 2 -+#define BIT_MASK_NESS_8822C 0x3 -+#define BIT_NESS_8822C(x) (((x) & BIT_MASK_NESS_8822C) << BIT_SHIFT_NESS_8822C) -+#define BITS_NESS_8822C (BIT_MASK_NESS_8822C << BIT_SHIFT_NESS_8822C) -+#define BIT_CLEAR_NESS_8822C(x) ((x) & (~BITS_NESS_8822C)) -+#define BIT_GET_NESS_8822C(x) \ -+ (((x) >> BIT_SHIFT_NESS_8822C) & BIT_MASK_NESS_8822C) -+#define BIT_SET_NESS_8822C(x, v) (BIT_CLEAR_NESS_8822C(x) | BIT_NESS_8822C(v)) -+ -+#define BIT_SHIFT_STBC_CFEND_8822C 0 -+#define BIT_MASK_STBC_CFEND_8822C 0x3 -+#define BIT_STBC_CFEND_8822C(x) \ -+ (((x) & BIT_MASK_STBC_CFEND_8822C) << BIT_SHIFT_STBC_CFEND_8822C) -+#define BITS_STBC_CFEND_8822C \ -+ (BIT_MASK_STBC_CFEND_8822C << BIT_SHIFT_STBC_CFEND_8822C) -+#define BIT_CLEAR_STBC_CFEND_8822C(x) ((x) & (~BITS_STBC_CFEND_8822C)) -+#define BIT_GET_STBC_CFEND_8822C(x) \ -+ (((x) >> BIT_SHIFT_STBC_CFEND_8822C) & BIT_MASK_STBC_CFEND_8822C) -+#define BIT_SET_STBC_CFEND_8822C(x, v) \ -+ (BIT_CLEAR_STBC_CFEND_8822C(x) | BIT_STBC_CFEND_8822C(v)) -+ -+/* 2 REG_STBC_SETTING2_8822C */ -+ -+#define BIT_SHIFT_CDEND_TXTIME_H_8822C 0 -+#define BIT_MASK_CDEND_TXTIME_H_8822C 0x1f -+#define BIT_CDEND_TXTIME_H_8822C(x) \ -+ (((x) & BIT_MASK_CDEND_TXTIME_H_8822C) \ -+ << BIT_SHIFT_CDEND_TXTIME_H_8822C) -+#define BITS_CDEND_TXTIME_H_8822C \ -+ (BIT_MASK_CDEND_TXTIME_H_8822C << BIT_SHIFT_CDEND_TXTIME_H_8822C) -+#define BIT_CLEAR_CDEND_TXTIME_H_8822C(x) ((x) & (~BITS_CDEND_TXTIME_H_8822C)) -+#define BIT_GET_CDEND_TXTIME_H_8822C(x) \ -+ (((x) >> BIT_SHIFT_CDEND_TXTIME_H_8822C) & \ -+ BIT_MASK_CDEND_TXTIME_H_8822C) -+#define BIT_SET_CDEND_TXTIME_H_8822C(x, v) \ -+ (BIT_CLEAR_CDEND_TXTIME_H_8822C(x) | BIT_CDEND_TXTIME_H_8822C(v)) -+ -+/* 2 REG_QUEUE_CTRL_8822C */ -+#define BIT_FORCE_RND_PRI_8822C BIT(6) -+#define BIT_PTA_EDCCA_EN_8822C BIT(5) -+#define BIT_PTA_WL_TX_EN_8822C BIT(4) -+#define BIT_R_USE_DATA_BW_8822C BIT(3) -+#define BIT_TRI_PKT_INT_MODE1_8822C BIT(2) -+#define BIT_TRI_PKT_INT_MODE0_8822C BIT(1) -+#define BIT_ACQ_MODE_SEL_8822C BIT(0) -+ -+/* 2 REG_SINGLE_AMPDU_CTRL_8822C */ -+#define BIT_EN_SINGLE_APMDU_8822C BIT(7) -+ -+#define BIT_SHIFT_SNDTX_MAXTIME_8822C 0 -+#define BIT_MASK_SNDTX_MAXTIME_8822C 0x7f -+#define BIT_SNDTX_MAXTIME_8822C(x) \ -+ (((x) & BIT_MASK_SNDTX_MAXTIME_8822C) << BIT_SHIFT_SNDTX_MAXTIME_8822C) -+#define BITS_SNDTX_MAXTIME_8822C \ -+ (BIT_MASK_SNDTX_MAXTIME_8822C << BIT_SHIFT_SNDTX_MAXTIME_8822C) -+#define BIT_CLEAR_SNDTX_MAXTIME_8822C(x) ((x) & (~BITS_SNDTX_MAXTIME_8822C)) -+#define BIT_GET_SNDTX_MAXTIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_SNDTX_MAXTIME_8822C) & BIT_MASK_SNDTX_MAXTIME_8822C) -+#define BIT_SET_SNDTX_MAXTIME_8822C(x, v) \ -+ (BIT_CLEAR_SNDTX_MAXTIME_8822C(x) | BIT_SNDTX_MAXTIME_8822C(v)) -+ -+/* 2 REG_PROT_MODE_CTRL_8822C */ -+#define BIT_SND_SIFS_TXDATA_8822C BIT(31) -+#define BIT_TX_SND_MATCH_MACID_8822C BIT(30) -+ -+#define BIT_SHIFT_RTS_MAX_AGG_NUM_8822C 24 -+#define BIT_MASK_RTS_MAX_AGG_NUM_8822C 0x3f -+#define BIT_RTS_MAX_AGG_NUM_8822C(x) \ -+ (((x) & BIT_MASK_RTS_MAX_AGG_NUM_8822C) \ -+ << BIT_SHIFT_RTS_MAX_AGG_NUM_8822C) -+#define BITS_RTS_MAX_AGG_NUM_8822C \ -+ (BIT_MASK_RTS_MAX_AGG_NUM_8822C << BIT_SHIFT_RTS_MAX_AGG_NUM_8822C) -+#define BIT_CLEAR_RTS_MAX_AGG_NUM_8822C(x) ((x) & (~BITS_RTS_MAX_AGG_NUM_8822C)) -+#define BIT_GET_RTS_MAX_AGG_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_RTS_MAX_AGG_NUM_8822C) & \ -+ BIT_MASK_RTS_MAX_AGG_NUM_8822C) -+#define BIT_SET_RTS_MAX_AGG_NUM_8822C(x, v) \ -+ (BIT_CLEAR_RTS_MAX_AGG_NUM_8822C(x) | BIT_RTS_MAX_AGG_NUM_8822C(v)) -+ -+#define BIT_SHIFT_MAX_AGG_NUM_8822C 16 -+#define BIT_MASK_MAX_AGG_NUM_8822C 0x3f -+#define BIT_MAX_AGG_NUM_8822C(x) \ -+ (((x) & BIT_MASK_MAX_AGG_NUM_8822C) << BIT_SHIFT_MAX_AGG_NUM_8822C) -+#define BITS_MAX_AGG_NUM_8822C \ -+ (BIT_MASK_MAX_AGG_NUM_8822C << BIT_SHIFT_MAX_AGG_NUM_8822C) -+#define BIT_CLEAR_MAX_AGG_NUM_8822C(x) ((x) & (~BITS_MAX_AGG_NUM_8822C)) -+#define BIT_GET_MAX_AGG_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAX_AGG_NUM_8822C) & BIT_MASK_MAX_AGG_NUM_8822C) -+#define BIT_SET_MAX_AGG_NUM_8822C(x, v) \ -+ (BIT_CLEAR_MAX_AGG_NUM_8822C(x) | BIT_MAX_AGG_NUM_8822C(v)) -+ -+#define BIT_SHIFT_RTS_TXTIME_TH_8822C 8 -+#define BIT_MASK_RTS_TXTIME_TH_8822C 0xff -+#define BIT_RTS_TXTIME_TH_8822C(x) \ -+ (((x) & BIT_MASK_RTS_TXTIME_TH_8822C) << BIT_SHIFT_RTS_TXTIME_TH_8822C) -+#define BITS_RTS_TXTIME_TH_8822C \ -+ (BIT_MASK_RTS_TXTIME_TH_8822C << BIT_SHIFT_RTS_TXTIME_TH_8822C) -+#define BIT_CLEAR_RTS_TXTIME_TH_8822C(x) ((x) & (~BITS_RTS_TXTIME_TH_8822C)) -+#define BIT_GET_RTS_TXTIME_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_RTS_TXTIME_TH_8822C) & BIT_MASK_RTS_TXTIME_TH_8822C) -+#define BIT_SET_RTS_TXTIME_TH_8822C(x, v) \ -+ (BIT_CLEAR_RTS_TXTIME_TH_8822C(x) | BIT_RTS_TXTIME_TH_8822C(v)) -+ -+#define BIT_SHIFT_RTS_LEN_TH_8822C 0 -+#define BIT_MASK_RTS_LEN_TH_8822C 0xff -+#define BIT_RTS_LEN_TH_8822C(x) \ -+ (((x) & BIT_MASK_RTS_LEN_TH_8822C) << BIT_SHIFT_RTS_LEN_TH_8822C) -+#define BITS_RTS_LEN_TH_8822C \ -+ (BIT_MASK_RTS_LEN_TH_8822C << BIT_SHIFT_RTS_LEN_TH_8822C) -+#define BIT_CLEAR_RTS_LEN_TH_8822C(x) ((x) & (~BITS_RTS_LEN_TH_8822C)) -+#define BIT_GET_RTS_LEN_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_RTS_LEN_TH_8822C) & BIT_MASK_RTS_LEN_TH_8822C) -+#define BIT_SET_RTS_LEN_TH_8822C(x, v) \ -+ (BIT_CLEAR_RTS_LEN_TH_8822C(x) | BIT_RTS_LEN_TH_8822C(v)) -+ -+/* 2 REG_BAR_MODE_CTRL_8822C */ -+ -+#define BIT_SHIFT_BAR_RTY_LMT_8822C 16 -+#define BIT_MASK_BAR_RTY_LMT_8822C 0x3 -+#define BIT_BAR_RTY_LMT_8822C(x) \ -+ (((x) & BIT_MASK_BAR_RTY_LMT_8822C) << BIT_SHIFT_BAR_RTY_LMT_8822C) -+#define BITS_BAR_RTY_LMT_8822C \ -+ (BIT_MASK_BAR_RTY_LMT_8822C << BIT_SHIFT_BAR_RTY_LMT_8822C) -+#define BIT_CLEAR_BAR_RTY_LMT_8822C(x) ((x) & (~BITS_BAR_RTY_LMT_8822C)) -+#define BIT_GET_BAR_RTY_LMT_8822C(x) \ -+ (((x) >> BIT_SHIFT_BAR_RTY_LMT_8822C) & BIT_MASK_BAR_RTY_LMT_8822C) -+#define BIT_SET_BAR_RTY_LMT_8822C(x, v) \ -+ (BIT_CLEAR_BAR_RTY_LMT_8822C(x) | BIT_BAR_RTY_LMT_8822C(v)) -+ -+#define BIT_SHIFT_BAR_PKT_TXTIME_TH_8822C 8 -+#define BIT_MASK_BAR_PKT_TXTIME_TH_8822C 0xff -+#define BIT_BAR_PKT_TXTIME_TH_8822C(x) \ -+ (((x) & BIT_MASK_BAR_PKT_TXTIME_TH_8822C) \ -+ << BIT_SHIFT_BAR_PKT_TXTIME_TH_8822C) -+#define BITS_BAR_PKT_TXTIME_TH_8822C \ -+ (BIT_MASK_BAR_PKT_TXTIME_TH_8822C << BIT_SHIFT_BAR_PKT_TXTIME_TH_8822C) -+#define BIT_CLEAR_BAR_PKT_TXTIME_TH_8822C(x) \ -+ ((x) & (~BITS_BAR_PKT_TXTIME_TH_8822C)) -+#define BIT_GET_BAR_PKT_TXTIME_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKT_TXTIME_TH_8822C) & \ -+ BIT_MASK_BAR_PKT_TXTIME_TH_8822C) -+#define BIT_SET_BAR_PKT_TXTIME_TH_8822C(x, v) \ -+ (BIT_CLEAR_BAR_PKT_TXTIME_TH_8822C(x) | BIT_BAR_PKT_TXTIME_TH_8822C(v)) -+ -+#define BIT_BAR_EN_V1_8822C BIT(6) -+ -+#define BIT_SHIFT_BAR_PKTNUM_TH_V1_8822C 0 -+#define BIT_MASK_BAR_PKTNUM_TH_V1_8822C 0x3f -+#define BIT_BAR_PKTNUM_TH_V1_8822C(x) \ -+ (((x) & BIT_MASK_BAR_PKTNUM_TH_V1_8822C) \ -+ << BIT_SHIFT_BAR_PKTNUM_TH_V1_8822C) -+#define BITS_BAR_PKTNUM_TH_V1_8822C \ -+ (BIT_MASK_BAR_PKTNUM_TH_V1_8822C << BIT_SHIFT_BAR_PKTNUM_TH_V1_8822C) -+#define BIT_CLEAR_BAR_PKTNUM_TH_V1_8822C(x) \ -+ ((x) & (~BITS_BAR_PKTNUM_TH_V1_8822C)) -+#define BIT_GET_BAR_PKTNUM_TH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BAR_PKTNUM_TH_V1_8822C) & \ -+ BIT_MASK_BAR_PKTNUM_TH_V1_8822C) -+#define BIT_SET_BAR_PKTNUM_TH_V1_8822C(x, v) \ -+ (BIT_CLEAR_BAR_PKTNUM_TH_V1_8822C(x) | BIT_BAR_PKTNUM_TH_V1_8822C(v)) -+ -+/* 2 REG_RA_TRY_RATE_AGG_LMT_8822C */ -+ -+#define BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8822C 0 -+#define BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8822C 0x3f -+#define BIT_RA_TRY_RATE_AGG_LMT_V1_8822C(x) \ -+ (((x) & BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8822C) \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8822C) -+#define BITS_RA_TRY_RATE_AGG_LMT_V1_8822C \ -+ (BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8822C \ -+ << BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8822C) -+#define BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8822C(x) \ -+ ((x) & (~BITS_RA_TRY_RATE_AGG_LMT_V1_8822C)) -+#define BIT_GET_RA_TRY_RATE_AGG_LMT_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RA_TRY_RATE_AGG_LMT_V1_8822C) & \ -+ BIT_MASK_RA_TRY_RATE_AGG_LMT_V1_8822C) -+#define BIT_SET_RA_TRY_RATE_AGG_LMT_V1_8822C(x, v) \ -+ (BIT_CLEAR_RA_TRY_RATE_AGG_LMT_V1_8822C(x) | \ -+ BIT_RA_TRY_RATE_AGG_LMT_V1_8822C(v)) -+ -+/* 2 REG_MACID_SLEEP2_8822C */ -+ -+#define BIT_SHIFT_MACID95_64PKTSLEEP_8822C 0 -+#define BIT_MASK_MACID95_64PKTSLEEP_8822C 0xffffffffL -+#define BIT_MACID95_64PKTSLEEP_8822C(x) \ -+ (((x) & BIT_MASK_MACID95_64PKTSLEEP_8822C) \ -+ << BIT_SHIFT_MACID95_64PKTSLEEP_8822C) -+#define BITS_MACID95_64PKTSLEEP_8822C \ -+ (BIT_MASK_MACID95_64PKTSLEEP_8822C \ -+ << BIT_SHIFT_MACID95_64PKTSLEEP_8822C) -+#define BIT_CLEAR_MACID95_64PKTSLEEP_8822C(x) \ -+ ((x) & (~BITS_MACID95_64PKTSLEEP_8822C)) -+#define BIT_GET_MACID95_64PKTSLEEP_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64PKTSLEEP_8822C) & \ -+ BIT_MASK_MACID95_64PKTSLEEP_8822C) -+#define BIT_SET_MACID95_64PKTSLEEP_8822C(x, v) \ -+ (BIT_CLEAR_MACID95_64PKTSLEEP_8822C(x) | \ -+ BIT_MACID95_64PKTSLEEP_8822C(v)) -+ -+/* 2 REG_MACID_SLEEP_8822C */ -+ -+#define BIT_SHIFT_MACID31_0_PKTSLEEP_8822C 0 -+#define BIT_MASK_MACID31_0_PKTSLEEP_8822C 0xffffffffL -+#define BIT_MACID31_0_PKTSLEEP_8822C(x) \ -+ (((x) & BIT_MASK_MACID31_0_PKTSLEEP_8822C) \ -+ << BIT_SHIFT_MACID31_0_PKTSLEEP_8822C) -+#define BITS_MACID31_0_PKTSLEEP_8822C \ -+ (BIT_MASK_MACID31_0_PKTSLEEP_8822C \ -+ << BIT_SHIFT_MACID31_0_PKTSLEEP_8822C) -+#define BIT_CLEAR_MACID31_0_PKTSLEEP_8822C(x) \ -+ ((x) & (~BITS_MACID31_0_PKTSLEEP_8822C)) -+#define BIT_GET_MACID31_0_PKTSLEEP_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_PKTSLEEP_8822C) & \ -+ BIT_MASK_MACID31_0_PKTSLEEP_8822C) -+#define BIT_SET_MACID31_0_PKTSLEEP_8822C(x, v) \ -+ (BIT_CLEAR_MACID31_0_PKTSLEEP_8822C(x) | \ -+ BIT_MACID31_0_PKTSLEEP_8822C(v)) -+ -+/* 2 REG_HW_SEQ0_8822C */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ0_8822C 0 -+#define BIT_MASK_HW_SSN_SEQ0_8822C 0xfff -+#define BIT_HW_SSN_SEQ0_8822C(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ0_8822C) << BIT_SHIFT_HW_SSN_SEQ0_8822C) -+#define BITS_HW_SSN_SEQ0_8822C \ -+ (BIT_MASK_HW_SSN_SEQ0_8822C << BIT_SHIFT_HW_SSN_SEQ0_8822C) -+#define BIT_CLEAR_HW_SSN_SEQ0_8822C(x) ((x) & (~BITS_HW_SSN_SEQ0_8822C)) -+#define BIT_GET_HW_SSN_SEQ0_8822C(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ0_8822C) & BIT_MASK_HW_SSN_SEQ0_8822C) -+#define BIT_SET_HW_SSN_SEQ0_8822C(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ0_8822C(x) | BIT_HW_SSN_SEQ0_8822C(v)) -+ -+/* 2 REG_HW_SEQ1_8822C */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ1_8822C 0 -+#define BIT_MASK_HW_SSN_SEQ1_8822C 0xfff -+#define BIT_HW_SSN_SEQ1_8822C(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ1_8822C) << BIT_SHIFT_HW_SSN_SEQ1_8822C) -+#define BITS_HW_SSN_SEQ1_8822C \ -+ (BIT_MASK_HW_SSN_SEQ1_8822C << BIT_SHIFT_HW_SSN_SEQ1_8822C) -+#define BIT_CLEAR_HW_SSN_SEQ1_8822C(x) ((x) & (~BITS_HW_SSN_SEQ1_8822C)) -+#define BIT_GET_HW_SSN_SEQ1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ1_8822C) & BIT_MASK_HW_SSN_SEQ1_8822C) -+#define BIT_SET_HW_SSN_SEQ1_8822C(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ1_8822C(x) | BIT_HW_SSN_SEQ1_8822C(v)) -+ -+/* 2 REG_HW_SEQ2_8822C */ -+ -+#define BIT_SHIFT_HW_SSN_SEQ2_8822C 0 -+#define BIT_MASK_HW_SSN_SEQ2_8822C 0xfff -+#define BIT_HW_SSN_SEQ2_8822C(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ2_8822C) << BIT_SHIFT_HW_SSN_SEQ2_8822C) -+#define BITS_HW_SSN_SEQ2_8822C \ -+ (BIT_MASK_HW_SSN_SEQ2_8822C << BIT_SHIFT_HW_SSN_SEQ2_8822C) -+#define BIT_CLEAR_HW_SSN_SEQ2_8822C(x) ((x) & (~BITS_HW_SSN_SEQ2_8822C)) -+#define BIT_GET_HW_SSN_SEQ2_8822C(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ2_8822C) & BIT_MASK_HW_SSN_SEQ2_8822C) -+#define BIT_SET_HW_SSN_SEQ2_8822C(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ2_8822C(x) | BIT_HW_SSN_SEQ2_8822C(v)) -+ -+/* 2 REG_HW_SEQ3_8822C */ -+ -+#define BIT_SHIFT_CSI_HWSEQ_SEL_8822C 12 -+#define BIT_MASK_CSI_HWSEQ_SEL_8822C 0x3 -+#define BIT_CSI_HWSEQ_SEL_8822C(x) \ -+ (((x) & BIT_MASK_CSI_HWSEQ_SEL_8822C) << BIT_SHIFT_CSI_HWSEQ_SEL_8822C) -+#define BITS_CSI_HWSEQ_SEL_8822C \ -+ (BIT_MASK_CSI_HWSEQ_SEL_8822C << BIT_SHIFT_CSI_HWSEQ_SEL_8822C) -+#define BIT_CLEAR_CSI_HWSEQ_SEL_8822C(x) ((x) & (~BITS_CSI_HWSEQ_SEL_8822C)) -+#define BIT_GET_CSI_HWSEQ_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_CSI_HWSEQ_SEL_8822C) & BIT_MASK_CSI_HWSEQ_SEL_8822C) -+#define BIT_SET_CSI_HWSEQ_SEL_8822C(x, v) \ -+ (BIT_CLEAR_CSI_HWSEQ_SEL_8822C(x) | BIT_CSI_HWSEQ_SEL_8822C(v)) -+ -+#define BIT_SHIFT_HW_SSN_SEQ3_8822C 0 -+#define BIT_MASK_HW_SSN_SEQ3_8822C 0xfff -+#define BIT_HW_SSN_SEQ3_8822C(x) \ -+ (((x) & BIT_MASK_HW_SSN_SEQ3_8822C) << BIT_SHIFT_HW_SSN_SEQ3_8822C) -+#define BITS_HW_SSN_SEQ3_8822C \ -+ (BIT_MASK_HW_SSN_SEQ3_8822C << BIT_SHIFT_HW_SSN_SEQ3_8822C) -+#define BIT_CLEAR_HW_SSN_SEQ3_8822C(x) ((x) & (~BITS_HW_SSN_SEQ3_8822C)) -+#define BIT_GET_HW_SSN_SEQ3_8822C(x) \ -+ (((x) >> BIT_SHIFT_HW_SSN_SEQ3_8822C) & BIT_MASK_HW_SSN_SEQ3_8822C) -+#define BIT_SET_HW_SSN_SEQ3_8822C(x, v) \ -+ (BIT_CLEAR_HW_SSN_SEQ3_8822C(x) | BIT_HW_SSN_SEQ3_8822C(v)) -+ -+/* 2 REG_NULL_PKT_STATUS_V1_8822C */ -+ -+#define BIT_SHIFT_PTCL_TOTAL_PG_V2_8822C 2 -+#define BIT_MASK_PTCL_TOTAL_PG_V2_8822C 0x3fff -+#define BIT_PTCL_TOTAL_PG_V2_8822C(x) \ -+ (((x) & BIT_MASK_PTCL_TOTAL_PG_V2_8822C) \ -+ << BIT_SHIFT_PTCL_TOTAL_PG_V2_8822C) -+#define BITS_PTCL_TOTAL_PG_V2_8822C \ -+ (BIT_MASK_PTCL_TOTAL_PG_V2_8822C << BIT_SHIFT_PTCL_TOTAL_PG_V2_8822C) -+#define BIT_CLEAR_PTCL_TOTAL_PG_V2_8822C(x) \ -+ ((x) & (~BITS_PTCL_TOTAL_PG_V2_8822C)) -+#define BIT_GET_PTCL_TOTAL_PG_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_PTCL_TOTAL_PG_V2_8822C) & \ -+ BIT_MASK_PTCL_TOTAL_PG_V2_8822C) -+#define BIT_SET_PTCL_TOTAL_PG_V2_8822C(x, v) \ -+ (BIT_CLEAR_PTCL_TOTAL_PG_V2_8822C(x) | BIT_PTCL_TOTAL_PG_V2_8822C(v)) -+ -+#define BIT_TX_NULL_1_8822C BIT(1) -+#define BIT_TX_NULL_0_8822C BIT(0) -+ -+/* 2 REG_PTCL_ERR_STATUS_8822C */ -+#define BIT_PTCL_RATE_TABLE_INVALID_8822C BIT(7) -+#define BIT_FTM_T2R_ERROR_8822C BIT(6) -+#define BIT_PTCL_ERR0_8822C BIT(5) -+#define BIT_PTCL_ERR1_8822C BIT(4) -+#define BIT_PTCL_ERR2_8822C BIT(3) -+#define BIT_PTCL_ERR3_8822C BIT(2) -+#define BIT_PTCL_ERR4_8822C BIT(1) -+#define BIT_PTCL_ERR5_8822C BIT(0) -+ -+/* 2 REG_NULL_PKT_STATUS_EXTEND_8822C */ -+#define BIT_CLI3_TX_NULL_1_8822C BIT(7) -+#define BIT_CLI3_TX_NULL_0_8822C BIT(6) -+#define BIT_CLI2_TX_NULL_1_8822C BIT(5) -+#define BIT_CLI2_TX_NULL_0_8822C BIT(4) -+#define BIT_CLI1_TX_NULL_1_8822C BIT(3) -+#define BIT_CLI1_TX_NULL_0_8822C BIT(2) -+#define BIT_CLI0_TX_NULL_1_8822C BIT(1) -+#define BIT_CLI0_TX_NULL_0_8822C BIT(0) -+ -+/* 2 REG_HQMGQ_DROP_8822C */ -+#define BIT_HIQ_DROP_8822C BIT(7) -+#define BIT_MGQ_DROP_8822C BIT(6) -+#define BIT_CLR_HGQ_REQ_BLOCK_8822C BIT(5) -+ -+/* 2 REG_PRECNT_CTRL_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_EN_PRECNT_8822C BIT(11) -+ -+#define BIT_SHIFT_PRECNT_TH_8822C 0 -+#define BIT_MASK_PRECNT_TH_8822C 0x7ff -+#define BIT_PRECNT_TH_8822C(x) \ -+ (((x) & BIT_MASK_PRECNT_TH_8822C) << BIT_SHIFT_PRECNT_TH_8822C) -+#define BITS_PRECNT_TH_8822C \ -+ (BIT_MASK_PRECNT_TH_8822C << BIT_SHIFT_PRECNT_TH_8822C) -+#define BIT_CLEAR_PRECNT_TH_8822C(x) ((x) & (~BITS_PRECNT_TH_8822C)) -+#define BIT_GET_PRECNT_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_PRECNT_TH_8822C) & BIT_MASK_PRECNT_TH_8822C) -+#define BIT_SET_PRECNT_TH_8822C(x, v) \ -+ (BIT_CLEAR_PRECNT_TH_8822C(x) | BIT_PRECNT_TH_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_BT_POLLUTE_PKT_CNT_8822C */ -+ -+#define BIT_SHIFT_BT_POLLUTE_PKT_CNT_8822C 0 -+#define BIT_MASK_BT_POLLUTE_PKT_CNT_8822C 0xffff -+#define BIT_BT_POLLUTE_PKT_CNT_8822C(x) \ -+ (((x) & BIT_MASK_BT_POLLUTE_PKT_CNT_8822C) \ -+ << BIT_SHIFT_BT_POLLUTE_PKT_CNT_8822C) -+#define BITS_BT_POLLUTE_PKT_CNT_8822C \ -+ (BIT_MASK_BT_POLLUTE_PKT_CNT_8822C \ -+ << BIT_SHIFT_BT_POLLUTE_PKT_CNT_8822C) -+#define BIT_CLEAR_BT_POLLUTE_PKT_CNT_8822C(x) \ -+ ((x) & (~BITS_BT_POLLUTE_PKT_CNT_8822C)) -+#define BIT_GET_BT_POLLUTE_PKT_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_POLLUTE_PKT_CNT_8822C) & \ -+ BIT_MASK_BT_POLLUTE_PKT_CNT_8822C) -+#define BIT_SET_BT_POLLUTE_PKT_CNT_8822C(x, v) \ -+ (BIT_CLEAR_BT_POLLUTE_PKT_CNT_8822C(x) | \ -+ BIT_BT_POLLUTE_PKT_CNT_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_PTCL_DBG_8822C */ -+ -+#define BIT_SHIFT_PTCL_DBG_8822C 0 -+#define BIT_MASK_PTCL_DBG_8822C 0xffffffffL -+#define BIT_PTCL_DBG_8822C(x) \ -+ (((x) & BIT_MASK_PTCL_DBG_8822C) << BIT_SHIFT_PTCL_DBG_8822C) -+#define BITS_PTCL_DBG_8822C \ -+ (BIT_MASK_PTCL_DBG_8822C << BIT_SHIFT_PTCL_DBG_8822C) -+#define BIT_CLEAR_PTCL_DBG_8822C(x) ((x) & (~BITS_PTCL_DBG_8822C)) -+#define BIT_GET_PTCL_DBG_8822C(x) \ -+ (((x) >> BIT_SHIFT_PTCL_DBG_8822C) & BIT_MASK_PTCL_DBG_8822C) -+#define BIT_SET_PTCL_DBG_8822C(x, v) \ -+ (BIT_CLEAR_PTCL_DBG_8822C(x) | BIT_PTCL_DBG_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_CPUMGQ_TIMER_CTRL2_8822C */ -+ -+#define BIT_SHIFT_TRI_HEAD_ADDR_8822C 16 -+#define BIT_MASK_TRI_HEAD_ADDR_8822C 0xfff -+#define BIT_TRI_HEAD_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_TRI_HEAD_ADDR_8822C) << BIT_SHIFT_TRI_HEAD_ADDR_8822C) -+#define BITS_TRI_HEAD_ADDR_8822C \ -+ (BIT_MASK_TRI_HEAD_ADDR_8822C << BIT_SHIFT_TRI_HEAD_ADDR_8822C) -+#define BIT_CLEAR_TRI_HEAD_ADDR_8822C(x) ((x) & (~BITS_TRI_HEAD_ADDR_8822C)) -+#define BIT_GET_TRI_HEAD_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRI_HEAD_ADDR_8822C) & BIT_MASK_TRI_HEAD_ADDR_8822C) -+#define BIT_SET_TRI_HEAD_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_TRI_HEAD_ADDR_8822C(x) | BIT_TRI_HEAD_ADDR_8822C(v)) -+ -+#define BIT_DROP_TH_EN_8822C BIT(8) -+ -+#define BIT_SHIFT_DROP_TH_8822C 0 -+#define BIT_MASK_DROP_TH_8822C 0xff -+#define BIT_DROP_TH_8822C(x) \ -+ (((x) & BIT_MASK_DROP_TH_8822C) << BIT_SHIFT_DROP_TH_8822C) -+#define BITS_DROP_TH_8822C (BIT_MASK_DROP_TH_8822C << BIT_SHIFT_DROP_TH_8822C) -+#define BIT_CLEAR_DROP_TH_8822C(x) ((x) & (~BITS_DROP_TH_8822C)) -+#define BIT_GET_DROP_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_DROP_TH_8822C) & BIT_MASK_DROP_TH_8822C) -+#define BIT_SET_DROP_TH_8822C(x, v) \ -+ (BIT_CLEAR_DROP_TH_8822C(x) | BIT_DROP_TH_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_DUMMY_PAGE4_V1_8822C */ -+ -+/* 2 REG_MOREDATA_8822C */ -+#define BIT_MOREDATA_CTRL2_EN_V1_8822C BIT(3) -+#define BIT_MOREDATA_CTRL1_EN_V1_8822C BIT(2) -+#define BIT_PKTIN_MOREDATA_REPLACE_ENABLE_V1_8822C BIT(0) -+ -+/* 2 REG_Q0_Q1_INFO_8822C */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8822C BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8822C 28 -+#define BIT_MASK_GTAB_ID_8822C 0x7 -+#define BIT_GTAB_ID_8822C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8822C) << BIT_SHIFT_GTAB_ID_8822C) -+#define BITS_GTAB_ID_8822C (BIT_MASK_GTAB_ID_8822C << BIT_SHIFT_GTAB_ID_8822C) -+#define BIT_CLEAR_GTAB_ID_8822C(x) ((x) & (~BITS_GTAB_ID_8822C)) -+#define BIT_GET_GTAB_ID_8822C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8822C) & BIT_MASK_GTAB_ID_8822C) -+#define BIT_SET_GTAB_ID_8822C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8822C(x) | BIT_GTAB_ID_8822C(v)) -+ -+#define BIT_SHIFT_AC1_PKT_INFO_8822C 16 -+#define BIT_MASK_AC1_PKT_INFO_8822C 0xfff -+#define BIT_AC1_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_AC1_PKT_INFO_8822C) << BIT_SHIFT_AC1_PKT_INFO_8822C) -+#define BITS_AC1_PKT_INFO_8822C \ -+ (BIT_MASK_AC1_PKT_INFO_8822C << BIT_SHIFT_AC1_PKT_INFO_8822C) -+#define BIT_CLEAR_AC1_PKT_INFO_8822C(x) ((x) & (~BITS_AC1_PKT_INFO_8822C)) -+#define BIT_GET_AC1_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_AC1_PKT_INFO_8822C) & BIT_MASK_AC1_PKT_INFO_8822C) -+#define BIT_SET_AC1_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_AC1_PKT_INFO_8822C(x) | BIT_AC1_PKT_INFO_8822C(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8822C BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8822C 12 -+#define BIT_MASK_GTAB_ID_V1_8822C 0x7 -+#define BIT_GTAB_ID_V1_8822C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8822C) << BIT_SHIFT_GTAB_ID_V1_8822C) -+#define BITS_GTAB_ID_V1_8822C \ -+ (BIT_MASK_GTAB_ID_V1_8822C << BIT_SHIFT_GTAB_ID_V1_8822C) -+#define BIT_CLEAR_GTAB_ID_V1_8822C(x) ((x) & (~BITS_GTAB_ID_V1_8822C)) -+#define BIT_GET_GTAB_ID_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8822C) & BIT_MASK_GTAB_ID_V1_8822C) -+#define BIT_SET_GTAB_ID_V1_8822C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8822C(x) | BIT_GTAB_ID_V1_8822C(v)) -+ -+#define BIT_SHIFT_AC0_PKT_INFO_8822C 0 -+#define BIT_MASK_AC0_PKT_INFO_8822C 0xfff -+#define BIT_AC0_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_AC0_PKT_INFO_8822C) << BIT_SHIFT_AC0_PKT_INFO_8822C) -+#define BITS_AC0_PKT_INFO_8822C \ -+ (BIT_MASK_AC0_PKT_INFO_8822C << BIT_SHIFT_AC0_PKT_INFO_8822C) -+#define BIT_CLEAR_AC0_PKT_INFO_8822C(x) ((x) & (~BITS_AC0_PKT_INFO_8822C)) -+#define BIT_GET_AC0_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_AC0_PKT_INFO_8822C) & BIT_MASK_AC0_PKT_INFO_8822C) -+#define BIT_SET_AC0_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_AC0_PKT_INFO_8822C(x) | BIT_AC0_PKT_INFO_8822C(v)) -+ -+/* 2 REG_Q2_Q3_INFO_8822C */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8822C BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8822C 28 -+#define BIT_MASK_GTAB_ID_8822C 0x7 -+#define BIT_GTAB_ID_8822C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8822C) << BIT_SHIFT_GTAB_ID_8822C) -+#define BITS_GTAB_ID_8822C (BIT_MASK_GTAB_ID_8822C << BIT_SHIFT_GTAB_ID_8822C) -+#define BIT_CLEAR_GTAB_ID_8822C(x) ((x) & (~BITS_GTAB_ID_8822C)) -+#define BIT_GET_GTAB_ID_8822C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8822C) & BIT_MASK_GTAB_ID_8822C) -+#define BIT_SET_GTAB_ID_8822C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8822C(x) | BIT_GTAB_ID_8822C(v)) -+ -+#define BIT_SHIFT_AC3_PKT_INFO_8822C 16 -+#define BIT_MASK_AC3_PKT_INFO_8822C 0xfff -+#define BIT_AC3_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_AC3_PKT_INFO_8822C) << BIT_SHIFT_AC3_PKT_INFO_8822C) -+#define BITS_AC3_PKT_INFO_8822C \ -+ (BIT_MASK_AC3_PKT_INFO_8822C << BIT_SHIFT_AC3_PKT_INFO_8822C) -+#define BIT_CLEAR_AC3_PKT_INFO_8822C(x) ((x) & (~BITS_AC3_PKT_INFO_8822C)) -+#define BIT_GET_AC3_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_AC3_PKT_INFO_8822C) & BIT_MASK_AC3_PKT_INFO_8822C) -+#define BIT_SET_AC3_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_AC3_PKT_INFO_8822C(x) | BIT_AC3_PKT_INFO_8822C(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8822C BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8822C 12 -+#define BIT_MASK_GTAB_ID_V1_8822C 0x7 -+#define BIT_GTAB_ID_V1_8822C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8822C) << BIT_SHIFT_GTAB_ID_V1_8822C) -+#define BITS_GTAB_ID_V1_8822C \ -+ (BIT_MASK_GTAB_ID_V1_8822C << BIT_SHIFT_GTAB_ID_V1_8822C) -+#define BIT_CLEAR_GTAB_ID_V1_8822C(x) ((x) & (~BITS_GTAB_ID_V1_8822C)) -+#define BIT_GET_GTAB_ID_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8822C) & BIT_MASK_GTAB_ID_V1_8822C) -+#define BIT_SET_GTAB_ID_V1_8822C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8822C(x) | BIT_GTAB_ID_V1_8822C(v)) -+ -+#define BIT_SHIFT_AC2_PKT_INFO_8822C 0 -+#define BIT_MASK_AC2_PKT_INFO_8822C 0xfff -+#define BIT_AC2_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_AC2_PKT_INFO_8822C) << BIT_SHIFT_AC2_PKT_INFO_8822C) -+#define BITS_AC2_PKT_INFO_8822C \ -+ (BIT_MASK_AC2_PKT_INFO_8822C << BIT_SHIFT_AC2_PKT_INFO_8822C) -+#define BIT_CLEAR_AC2_PKT_INFO_8822C(x) ((x) & (~BITS_AC2_PKT_INFO_8822C)) -+#define BIT_GET_AC2_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_AC2_PKT_INFO_8822C) & BIT_MASK_AC2_PKT_INFO_8822C) -+#define BIT_SET_AC2_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_AC2_PKT_INFO_8822C(x) | BIT_AC2_PKT_INFO_8822C(v)) -+ -+/* 2 REG_Q4_Q5_INFO_8822C */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8822C BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8822C 28 -+#define BIT_MASK_GTAB_ID_8822C 0x7 -+#define BIT_GTAB_ID_8822C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8822C) << BIT_SHIFT_GTAB_ID_8822C) -+#define BITS_GTAB_ID_8822C (BIT_MASK_GTAB_ID_8822C << BIT_SHIFT_GTAB_ID_8822C) -+#define BIT_CLEAR_GTAB_ID_8822C(x) ((x) & (~BITS_GTAB_ID_8822C)) -+#define BIT_GET_GTAB_ID_8822C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8822C) & BIT_MASK_GTAB_ID_8822C) -+#define BIT_SET_GTAB_ID_8822C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8822C(x) | BIT_GTAB_ID_8822C(v)) -+ -+#define BIT_SHIFT_AC5_PKT_INFO_8822C 16 -+#define BIT_MASK_AC5_PKT_INFO_8822C 0xfff -+#define BIT_AC5_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_AC5_PKT_INFO_8822C) << BIT_SHIFT_AC5_PKT_INFO_8822C) -+#define BITS_AC5_PKT_INFO_8822C \ -+ (BIT_MASK_AC5_PKT_INFO_8822C << BIT_SHIFT_AC5_PKT_INFO_8822C) -+#define BIT_CLEAR_AC5_PKT_INFO_8822C(x) ((x) & (~BITS_AC5_PKT_INFO_8822C)) -+#define BIT_GET_AC5_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_AC5_PKT_INFO_8822C) & BIT_MASK_AC5_PKT_INFO_8822C) -+#define BIT_SET_AC5_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_AC5_PKT_INFO_8822C(x) | BIT_AC5_PKT_INFO_8822C(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8822C BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8822C 12 -+#define BIT_MASK_GTAB_ID_V1_8822C 0x7 -+#define BIT_GTAB_ID_V1_8822C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8822C) << BIT_SHIFT_GTAB_ID_V1_8822C) -+#define BITS_GTAB_ID_V1_8822C \ -+ (BIT_MASK_GTAB_ID_V1_8822C << BIT_SHIFT_GTAB_ID_V1_8822C) -+#define BIT_CLEAR_GTAB_ID_V1_8822C(x) ((x) & (~BITS_GTAB_ID_V1_8822C)) -+#define BIT_GET_GTAB_ID_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8822C) & BIT_MASK_GTAB_ID_V1_8822C) -+#define BIT_SET_GTAB_ID_V1_8822C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8822C(x) | BIT_GTAB_ID_V1_8822C(v)) -+ -+#define BIT_SHIFT_AC4_PKT_INFO_8822C 0 -+#define BIT_MASK_AC4_PKT_INFO_8822C 0xfff -+#define BIT_AC4_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_AC4_PKT_INFO_8822C) << BIT_SHIFT_AC4_PKT_INFO_8822C) -+#define BITS_AC4_PKT_INFO_8822C \ -+ (BIT_MASK_AC4_PKT_INFO_8822C << BIT_SHIFT_AC4_PKT_INFO_8822C) -+#define BIT_CLEAR_AC4_PKT_INFO_8822C(x) ((x) & (~BITS_AC4_PKT_INFO_8822C)) -+#define BIT_GET_AC4_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_AC4_PKT_INFO_8822C) & BIT_MASK_AC4_PKT_INFO_8822C) -+#define BIT_SET_AC4_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_AC4_PKT_INFO_8822C(x) | BIT_AC4_PKT_INFO_8822C(v)) -+ -+/* 2 REG_Q6_Q7_INFO_8822C */ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_8822C BIT(31) -+ -+#define BIT_SHIFT_GTAB_ID_8822C 28 -+#define BIT_MASK_GTAB_ID_8822C 0x7 -+#define BIT_GTAB_ID_8822C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_8822C) << BIT_SHIFT_GTAB_ID_8822C) -+#define BITS_GTAB_ID_8822C (BIT_MASK_GTAB_ID_8822C << BIT_SHIFT_GTAB_ID_8822C) -+#define BIT_CLEAR_GTAB_ID_8822C(x) ((x) & (~BITS_GTAB_ID_8822C)) -+#define BIT_GET_GTAB_ID_8822C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_8822C) & BIT_MASK_GTAB_ID_8822C) -+#define BIT_SET_GTAB_ID_8822C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_8822C(x) | BIT_GTAB_ID_8822C(v)) -+ -+#define BIT_SHIFT_AC7_PKT_INFO_8822C 16 -+#define BIT_MASK_AC7_PKT_INFO_8822C 0xfff -+#define BIT_AC7_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_AC7_PKT_INFO_8822C) << BIT_SHIFT_AC7_PKT_INFO_8822C) -+#define BITS_AC7_PKT_INFO_8822C \ -+ (BIT_MASK_AC7_PKT_INFO_8822C << BIT_SHIFT_AC7_PKT_INFO_8822C) -+#define BIT_CLEAR_AC7_PKT_INFO_8822C(x) ((x) & (~BITS_AC7_PKT_INFO_8822C)) -+#define BIT_GET_AC7_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_AC7_PKT_INFO_8822C) & BIT_MASK_AC7_PKT_INFO_8822C) -+#define BIT_SET_AC7_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_AC7_PKT_INFO_8822C(x) | BIT_AC7_PKT_INFO_8822C(v)) -+ -+#define BIT_QUEUE_MACID_AC_NOT_THE_SAME_V1_8822C BIT(15) -+ -+#define BIT_SHIFT_GTAB_ID_V1_8822C 12 -+#define BIT_MASK_GTAB_ID_V1_8822C 0x7 -+#define BIT_GTAB_ID_V1_8822C(x) \ -+ (((x) & BIT_MASK_GTAB_ID_V1_8822C) << BIT_SHIFT_GTAB_ID_V1_8822C) -+#define BITS_GTAB_ID_V1_8822C \ -+ (BIT_MASK_GTAB_ID_V1_8822C << BIT_SHIFT_GTAB_ID_V1_8822C) -+#define BIT_CLEAR_GTAB_ID_V1_8822C(x) ((x) & (~BITS_GTAB_ID_V1_8822C)) -+#define BIT_GET_GTAB_ID_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_GTAB_ID_V1_8822C) & BIT_MASK_GTAB_ID_V1_8822C) -+#define BIT_SET_GTAB_ID_V1_8822C(x, v) \ -+ (BIT_CLEAR_GTAB_ID_V1_8822C(x) | BIT_GTAB_ID_V1_8822C(v)) -+ -+#define BIT_SHIFT_AC6_PKT_INFO_8822C 0 -+#define BIT_MASK_AC6_PKT_INFO_8822C 0xfff -+#define BIT_AC6_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_AC6_PKT_INFO_8822C) << BIT_SHIFT_AC6_PKT_INFO_8822C) -+#define BITS_AC6_PKT_INFO_8822C \ -+ (BIT_MASK_AC6_PKT_INFO_8822C << BIT_SHIFT_AC6_PKT_INFO_8822C) -+#define BIT_CLEAR_AC6_PKT_INFO_8822C(x) ((x) & (~BITS_AC6_PKT_INFO_8822C)) -+#define BIT_GET_AC6_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_AC6_PKT_INFO_8822C) & BIT_MASK_AC6_PKT_INFO_8822C) -+#define BIT_SET_AC6_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_AC6_PKT_INFO_8822C(x) | BIT_AC6_PKT_INFO_8822C(v)) -+ -+/* 2 REG_MGQ_HIQ_INFO_8822C */ -+ -+#define BIT_SHIFT_HIQ_PKT_INFO_8822C 16 -+#define BIT_MASK_HIQ_PKT_INFO_8822C 0xfff -+#define BIT_HIQ_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_HIQ_PKT_INFO_8822C) << BIT_SHIFT_HIQ_PKT_INFO_8822C) -+#define BITS_HIQ_PKT_INFO_8822C \ -+ (BIT_MASK_HIQ_PKT_INFO_8822C << BIT_SHIFT_HIQ_PKT_INFO_8822C) -+#define BIT_CLEAR_HIQ_PKT_INFO_8822C(x) ((x) & (~BITS_HIQ_PKT_INFO_8822C)) -+#define BIT_GET_HIQ_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_HIQ_PKT_INFO_8822C) & BIT_MASK_HIQ_PKT_INFO_8822C) -+#define BIT_SET_HIQ_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_HIQ_PKT_INFO_8822C(x) | BIT_HIQ_PKT_INFO_8822C(v)) -+ -+#define BIT_SHIFT_MGQ_PKT_INFO_8822C 0 -+#define BIT_MASK_MGQ_PKT_INFO_8822C 0xfff -+#define BIT_MGQ_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_PKT_INFO_8822C) << BIT_SHIFT_MGQ_PKT_INFO_8822C) -+#define BITS_MGQ_PKT_INFO_8822C \ -+ (BIT_MASK_MGQ_PKT_INFO_8822C << BIT_SHIFT_MGQ_PKT_INFO_8822C) -+#define BIT_CLEAR_MGQ_PKT_INFO_8822C(x) ((x) & (~BITS_MGQ_PKT_INFO_8822C)) -+#define BIT_GET_MGQ_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_PKT_INFO_8822C) & BIT_MASK_MGQ_PKT_INFO_8822C) -+#define BIT_SET_MGQ_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_PKT_INFO_8822C(x) | BIT_MGQ_PKT_INFO_8822C(v)) -+ -+/* 2 REG_CMDQ_BCNQ_INFO_8822C */ -+ -+#define BIT_SHIFT_CMDQ_PKT_INFO_8822C 16 -+#define BIT_MASK_CMDQ_PKT_INFO_8822C 0xfff -+#define BIT_CMDQ_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_CMDQ_PKT_INFO_8822C) << BIT_SHIFT_CMDQ_PKT_INFO_8822C) -+#define BITS_CMDQ_PKT_INFO_8822C \ -+ (BIT_MASK_CMDQ_PKT_INFO_8822C << BIT_SHIFT_CMDQ_PKT_INFO_8822C) -+#define BIT_CLEAR_CMDQ_PKT_INFO_8822C(x) ((x) & (~BITS_CMDQ_PKT_INFO_8822C)) -+#define BIT_GET_CMDQ_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_CMDQ_PKT_INFO_8822C) & BIT_MASK_CMDQ_PKT_INFO_8822C) -+#define BIT_SET_CMDQ_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_CMDQ_PKT_INFO_8822C(x) | BIT_CMDQ_PKT_INFO_8822C(v)) -+ -+#define BIT_SHIFT_BCNQ_PKT_INFO_8822C 0 -+#define BIT_MASK_BCNQ_PKT_INFO_8822C 0xfff -+#define BIT_BCNQ_PKT_INFO_8822C(x) \ -+ (((x) & BIT_MASK_BCNQ_PKT_INFO_8822C) << BIT_SHIFT_BCNQ_PKT_INFO_8822C) -+#define BITS_BCNQ_PKT_INFO_8822C \ -+ (BIT_MASK_BCNQ_PKT_INFO_8822C << BIT_SHIFT_BCNQ_PKT_INFO_8822C) -+#define BIT_CLEAR_BCNQ_PKT_INFO_8822C(x) ((x) & (~BITS_BCNQ_PKT_INFO_8822C)) -+#define BIT_GET_BCNQ_PKT_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNQ_PKT_INFO_8822C) & BIT_MASK_BCNQ_PKT_INFO_8822C) -+#define BIT_SET_BCNQ_PKT_INFO_8822C(x, v) \ -+ (BIT_CLEAR_BCNQ_PKT_INFO_8822C(x) | BIT_BCNQ_PKT_INFO_8822C(v)) -+ -+/* 2 REG_LOOPBACK_OPTION_8822C */ -+#define BIT_LOOPACK_FAST_EDCA_EN_8822C BIT(24) -+ -+/* 2 REG_AESIV_SETTING_8822C */ -+ -+#define BIT_SHIFT_AESIV_OFFSET_8822C 0 -+#define BIT_MASK_AESIV_OFFSET_8822C 0xfff -+#define BIT_AESIV_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_AESIV_OFFSET_8822C) << BIT_SHIFT_AESIV_OFFSET_8822C) -+#define BITS_AESIV_OFFSET_8822C \ -+ (BIT_MASK_AESIV_OFFSET_8822C << BIT_SHIFT_AESIV_OFFSET_8822C) -+#define BIT_CLEAR_AESIV_OFFSET_8822C(x) ((x) & (~BITS_AESIV_OFFSET_8822C)) -+#define BIT_GET_AESIV_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_AESIV_OFFSET_8822C) & BIT_MASK_AESIV_OFFSET_8822C) -+#define BIT_SET_AESIV_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_AESIV_OFFSET_8822C(x) | BIT_AESIV_OFFSET_8822C(v)) -+ -+/* 2 REG_BF0_TIME_SETTING_8822C */ -+#define BIT_BF0_TIMER_SET_8822C BIT(31) -+#define BIT_BF0_TIMER_CLR_8822C BIT(30) -+#define BIT_BF0_UPDATE_EN_8822C BIT(29) -+#define BIT_BF0_TIMER_EN_8822C BIT(28) -+ -+#define BIT_SHIFT_BF0_PRETIME_OVER_8822C 16 -+#define BIT_MASK_BF0_PRETIME_OVER_8822C 0xfff -+#define BIT_BF0_PRETIME_OVER_8822C(x) \ -+ (((x) & BIT_MASK_BF0_PRETIME_OVER_8822C) \ -+ << BIT_SHIFT_BF0_PRETIME_OVER_8822C) -+#define BITS_BF0_PRETIME_OVER_8822C \ -+ (BIT_MASK_BF0_PRETIME_OVER_8822C << BIT_SHIFT_BF0_PRETIME_OVER_8822C) -+#define BIT_CLEAR_BF0_PRETIME_OVER_8822C(x) \ -+ ((x) & (~BITS_BF0_PRETIME_OVER_8822C)) -+#define BIT_GET_BF0_PRETIME_OVER_8822C(x) \ -+ (((x) >> BIT_SHIFT_BF0_PRETIME_OVER_8822C) & \ -+ BIT_MASK_BF0_PRETIME_OVER_8822C) -+#define BIT_SET_BF0_PRETIME_OVER_8822C(x, v) \ -+ (BIT_CLEAR_BF0_PRETIME_OVER_8822C(x) | BIT_BF0_PRETIME_OVER_8822C(v)) -+ -+#define BIT_SHIFT_BF0_LIFETIME_8822C 0 -+#define BIT_MASK_BF0_LIFETIME_8822C 0xffff -+#define BIT_BF0_LIFETIME_8822C(x) \ -+ (((x) & BIT_MASK_BF0_LIFETIME_8822C) << BIT_SHIFT_BF0_LIFETIME_8822C) -+#define BITS_BF0_LIFETIME_8822C \ -+ (BIT_MASK_BF0_LIFETIME_8822C << BIT_SHIFT_BF0_LIFETIME_8822C) -+#define BIT_CLEAR_BF0_LIFETIME_8822C(x) ((x) & (~BITS_BF0_LIFETIME_8822C)) -+#define BIT_GET_BF0_LIFETIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_BF0_LIFETIME_8822C) & BIT_MASK_BF0_LIFETIME_8822C) -+#define BIT_SET_BF0_LIFETIME_8822C(x, v) \ -+ (BIT_CLEAR_BF0_LIFETIME_8822C(x) | BIT_BF0_LIFETIME_8822C(v)) -+ -+/* 2 REG_BF1_TIME_SETTING_8822C */ -+#define BIT_BF1_TIMER_SET_8822C BIT(31) -+#define BIT_BF1_TIMER_CLR_8822C BIT(30) -+#define BIT_BF1_UPDATE_EN_8822C BIT(29) -+#define BIT_BF1_TIMER_EN_8822C BIT(28) -+ -+#define BIT_SHIFT_BF1_PRETIME_OVER_8822C 16 -+#define BIT_MASK_BF1_PRETIME_OVER_8822C 0xfff -+#define BIT_BF1_PRETIME_OVER_8822C(x) \ -+ (((x) & BIT_MASK_BF1_PRETIME_OVER_8822C) \ -+ << BIT_SHIFT_BF1_PRETIME_OVER_8822C) -+#define BITS_BF1_PRETIME_OVER_8822C \ -+ (BIT_MASK_BF1_PRETIME_OVER_8822C << BIT_SHIFT_BF1_PRETIME_OVER_8822C) -+#define BIT_CLEAR_BF1_PRETIME_OVER_8822C(x) \ -+ ((x) & (~BITS_BF1_PRETIME_OVER_8822C)) -+#define BIT_GET_BF1_PRETIME_OVER_8822C(x) \ -+ (((x) >> BIT_SHIFT_BF1_PRETIME_OVER_8822C) & \ -+ BIT_MASK_BF1_PRETIME_OVER_8822C) -+#define BIT_SET_BF1_PRETIME_OVER_8822C(x, v) \ -+ (BIT_CLEAR_BF1_PRETIME_OVER_8822C(x) | BIT_BF1_PRETIME_OVER_8822C(v)) -+ -+#define BIT_SHIFT_BF1_LIFETIME_8822C 0 -+#define BIT_MASK_BF1_LIFETIME_8822C 0xffff -+#define BIT_BF1_LIFETIME_8822C(x) \ -+ (((x) & BIT_MASK_BF1_LIFETIME_8822C) << BIT_SHIFT_BF1_LIFETIME_8822C) -+#define BITS_BF1_LIFETIME_8822C \ -+ (BIT_MASK_BF1_LIFETIME_8822C << BIT_SHIFT_BF1_LIFETIME_8822C) -+#define BIT_CLEAR_BF1_LIFETIME_8822C(x) ((x) & (~BITS_BF1_LIFETIME_8822C)) -+#define BIT_GET_BF1_LIFETIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_BF1_LIFETIME_8822C) & BIT_MASK_BF1_LIFETIME_8822C) -+#define BIT_SET_BF1_LIFETIME_8822C(x, v) \ -+ (BIT_CLEAR_BF1_LIFETIME_8822C(x) | BIT_BF1_LIFETIME_8822C(v)) -+ -+/* 2 REG_BF_TIMEOUT_EN_8822C */ -+#define BIT_EN_VHT_LDPC_8822C BIT(9) -+#define BIT_EN_HT_LDPC_8822C BIT(8) -+#define BIT_BF1_TIMEOUT_EN_8822C BIT(1) -+#define BIT_BF0_TIMEOUT_EN_8822C BIT(0) -+ -+/* 2 REG_MACID_RELEASE0_8822C */ -+ -+#define BIT_SHIFT_MACID31_0_RELEASE_8822C 0 -+#define BIT_MASK_MACID31_0_RELEASE_8822C 0xffffffffL -+#define BIT_MACID31_0_RELEASE_8822C(x) \ -+ (((x) & BIT_MASK_MACID31_0_RELEASE_8822C) \ -+ << BIT_SHIFT_MACID31_0_RELEASE_8822C) -+#define BITS_MACID31_0_RELEASE_8822C \ -+ (BIT_MASK_MACID31_0_RELEASE_8822C << BIT_SHIFT_MACID31_0_RELEASE_8822C) -+#define BIT_CLEAR_MACID31_0_RELEASE_8822C(x) \ -+ ((x) & (~BITS_MACID31_0_RELEASE_8822C)) -+#define BIT_GET_MACID31_0_RELEASE_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_RELEASE_8822C) & \ -+ BIT_MASK_MACID31_0_RELEASE_8822C) -+#define BIT_SET_MACID31_0_RELEASE_8822C(x, v) \ -+ (BIT_CLEAR_MACID31_0_RELEASE_8822C(x) | BIT_MACID31_0_RELEASE_8822C(v)) -+ -+/* 2 REG_MACID_RELEASE1_8822C */ -+ -+#define BIT_SHIFT_MACID63_32_RELEASE_8822C 0 -+#define BIT_MASK_MACID63_32_RELEASE_8822C 0xffffffffL -+#define BIT_MACID63_32_RELEASE_8822C(x) \ -+ (((x) & BIT_MASK_MACID63_32_RELEASE_8822C) \ -+ << BIT_SHIFT_MACID63_32_RELEASE_8822C) -+#define BITS_MACID63_32_RELEASE_8822C \ -+ (BIT_MASK_MACID63_32_RELEASE_8822C \ -+ << BIT_SHIFT_MACID63_32_RELEASE_8822C) -+#define BIT_CLEAR_MACID63_32_RELEASE_8822C(x) \ -+ ((x) & (~BITS_MACID63_32_RELEASE_8822C)) -+#define BIT_GET_MACID63_32_RELEASE_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_RELEASE_8822C) & \ -+ BIT_MASK_MACID63_32_RELEASE_8822C) -+#define BIT_SET_MACID63_32_RELEASE_8822C(x, v) \ -+ (BIT_CLEAR_MACID63_32_RELEASE_8822C(x) | \ -+ BIT_MACID63_32_RELEASE_8822C(v)) -+ -+/* 2 REG_MACID_RELEASE2_8822C */ -+ -+#define BIT_SHIFT_MACID95_64_RELEASE_8822C 0 -+#define BIT_MASK_MACID95_64_RELEASE_8822C 0xffffffffL -+#define BIT_MACID95_64_RELEASE_8822C(x) \ -+ (((x) & BIT_MASK_MACID95_64_RELEASE_8822C) \ -+ << BIT_SHIFT_MACID95_64_RELEASE_8822C) -+#define BITS_MACID95_64_RELEASE_8822C \ -+ (BIT_MASK_MACID95_64_RELEASE_8822C \ -+ << BIT_SHIFT_MACID95_64_RELEASE_8822C) -+#define BIT_CLEAR_MACID95_64_RELEASE_8822C(x) \ -+ ((x) & (~BITS_MACID95_64_RELEASE_8822C)) -+#define BIT_GET_MACID95_64_RELEASE_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_RELEASE_8822C) & \ -+ BIT_MASK_MACID95_64_RELEASE_8822C) -+#define BIT_SET_MACID95_64_RELEASE_8822C(x, v) \ -+ (BIT_CLEAR_MACID95_64_RELEASE_8822C(x) | \ -+ BIT_MACID95_64_RELEASE_8822C(v)) -+ -+/* 2 REG_MACID_RELEASE3_8822C */ -+ -+#define BIT_SHIFT_MACID127_96_RELEASE_8822C 0 -+#define BIT_MASK_MACID127_96_RELEASE_8822C 0xffffffffL -+#define BIT_MACID127_96_RELEASE_8822C(x) \ -+ (((x) & BIT_MASK_MACID127_96_RELEASE_8822C) \ -+ << BIT_SHIFT_MACID127_96_RELEASE_8822C) -+#define BITS_MACID127_96_RELEASE_8822C \ -+ (BIT_MASK_MACID127_96_RELEASE_8822C \ -+ << BIT_SHIFT_MACID127_96_RELEASE_8822C) -+#define BIT_CLEAR_MACID127_96_RELEASE_8822C(x) \ -+ ((x) & (~BITS_MACID127_96_RELEASE_8822C)) -+#define BIT_GET_MACID127_96_RELEASE_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_RELEASE_8822C) & \ -+ BIT_MASK_MACID127_96_RELEASE_8822C) -+#define BIT_SET_MACID127_96_RELEASE_8822C(x, v) \ -+ (BIT_CLEAR_MACID127_96_RELEASE_8822C(x) | \ -+ BIT_MACID127_96_RELEASE_8822C(v)) -+ -+/* 2 REG_MACID_RELEASE_SETTING_8822C */ -+#define BIT_MACID_VALUE_8822C BIT(7) -+ -+#define BIT_SHIFT_MACID_OFFSET_8822C 0 -+#define BIT_MASK_MACID_OFFSET_8822C 0x7f -+#define BIT_MACID_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_MACID_OFFSET_8822C) << BIT_SHIFT_MACID_OFFSET_8822C) -+#define BITS_MACID_OFFSET_8822C \ -+ (BIT_MASK_MACID_OFFSET_8822C << BIT_SHIFT_MACID_OFFSET_8822C) -+#define BIT_CLEAR_MACID_OFFSET_8822C(x) ((x) & (~BITS_MACID_OFFSET_8822C)) -+#define BIT_GET_MACID_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID_OFFSET_8822C) & BIT_MASK_MACID_OFFSET_8822C) -+#define BIT_SET_MACID_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_MACID_OFFSET_8822C(x) | BIT_MACID_OFFSET_8822C(v)) -+ -+/* 2 REG_FAST_EDCA_VOVI_SETTING_8822C */ -+ -+#define BIT_SHIFT_VI_FAST_EDCA_TO_8822C 24 -+#define BIT_MASK_VI_FAST_EDCA_TO_8822C 0xff -+#define BIT_VI_FAST_EDCA_TO_8822C(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_TO_8822C) \ -+ << BIT_SHIFT_VI_FAST_EDCA_TO_8822C) -+#define BITS_VI_FAST_EDCA_TO_8822C \ -+ (BIT_MASK_VI_FAST_EDCA_TO_8822C << BIT_SHIFT_VI_FAST_EDCA_TO_8822C) -+#define BIT_CLEAR_VI_FAST_EDCA_TO_8822C(x) ((x) & (~BITS_VI_FAST_EDCA_TO_8822C)) -+#define BIT_GET_VI_FAST_EDCA_TO_8822C(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_TO_8822C) & \ -+ BIT_MASK_VI_FAST_EDCA_TO_8822C) -+#define BIT_SET_VI_FAST_EDCA_TO_8822C(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_TO_8822C(x) | BIT_VI_FAST_EDCA_TO_8822C(v)) -+ -+#define BIT_VI_THRESHOLD_SEL_8822C BIT(23) -+ -+#define BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8822C 16 -+#define BIT_MASK_VI_FAST_EDCA_PKT_TH_8822C 0x7f -+#define BIT_VI_FAST_EDCA_PKT_TH_8822C(x) \ -+ (((x) & BIT_MASK_VI_FAST_EDCA_PKT_TH_8822C) \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8822C) -+#define BITS_VI_FAST_EDCA_PKT_TH_8822C \ -+ (BIT_MASK_VI_FAST_EDCA_PKT_TH_8822C \ -+ << BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8822C) -+#define BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8822C(x) \ -+ ((x) & (~BITS_VI_FAST_EDCA_PKT_TH_8822C)) -+#define BIT_GET_VI_FAST_EDCA_PKT_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_VI_FAST_EDCA_PKT_TH_8822C) & \ -+ BIT_MASK_VI_FAST_EDCA_PKT_TH_8822C) -+#define BIT_SET_VI_FAST_EDCA_PKT_TH_8822C(x, v) \ -+ (BIT_CLEAR_VI_FAST_EDCA_PKT_TH_8822C(x) | \ -+ BIT_VI_FAST_EDCA_PKT_TH_8822C(v)) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_TO_8822C 8 -+#define BIT_MASK_VO_FAST_EDCA_TO_8822C 0xff -+#define BIT_VO_FAST_EDCA_TO_8822C(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_TO_8822C) \ -+ << BIT_SHIFT_VO_FAST_EDCA_TO_8822C) -+#define BITS_VO_FAST_EDCA_TO_8822C \ -+ (BIT_MASK_VO_FAST_EDCA_TO_8822C << BIT_SHIFT_VO_FAST_EDCA_TO_8822C) -+#define BIT_CLEAR_VO_FAST_EDCA_TO_8822C(x) ((x) & (~BITS_VO_FAST_EDCA_TO_8822C)) -+#define BIT_GET_VO_FAST_EDCA_TO_8822C(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_TO_8822C) & \ -+ BIT_MASK_VO_FAST_EDCA_TO_8822C) -+#define BIT_SET_VO_FAST_EDCA_TO_8822C(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_TO_8822C(x) | BIT_VO_FAST_EDCA_TO_8822C(v)) -+ -+#define BIT_VO_THRESHOLD_SEL_8822C BIT(7) -+ -+#define BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8822C 0 -+#define BIT_MASK_VO_FAST_EDCA_PKT_TH_8822C 0x7f -+#define BIT_VO_FAST_EDCA_PKT_TH_8822C(x) \ -+ (((x) & BIT_MASK_VO_FAST_EDCA_PKT_TH_8822C) \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8822C) -+#define BITS_VO_FAST_EDCA_PKT_TH_8822C \ -+ (BIT_MASK_VO_FAST_EDCA_PKT_TH_8822C \ -+ << BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8822C) -+#define BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8822C(x) \ -+ ((x) & (~BITS_VO_FAST_EDCA_PKT_TH_8822C)) -+#define BIT_GET_VO_FAST_EDCA_PKT_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_VO_FAST_EDCA_PKT_TH_8822C) & \ -+ BIT_MASK_VO_FAST_EDCA_PKT_TH_8822C) -+#define BIT_SET_VO_FAST_EDCA_PKT_TH_8822C(x, v) \ -+ (BIT_CLEAR_VO_FAST_EDCA_PKT_TH_8822C(x) | \ -+ BIT_VO_FAST_EDCA_PKT_TH_8822C(v)) -+ -+/* 2 REG_FAST_EDCA_BEBK_SETTING_8822C */ -+ -+#define BIT_SHIFT_BK_FAST_EDCA_TO_8822C 24 -+#define BIT_MASK_BK_FAST_EDCA_TO_8822C 0xff -+#define BIT_BK_FAST_EDCA_TO_8822C(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_TO_8822C) \ -+ << BIT_SHIFT_BK_FAST_EDCA_TO_8822C) -+#define BITS_BK_FAST_EDCA_TO_8822C \ -+ (BIT_MASK_BK_FAST_EDCA_TO_8822C << BIT_SHIFT_BK_FAST_EDCA_TO_8822C) -+#define BIT_CLEAR_BK_FAST_EDCA_TO_8822C(x) ((x) & (~BITS_BK_FAST_EDCA_TO_8822C)) -+#define BIT_GET_BK_FAST_EDCA_TO_8822C(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_TO_8822C) & \ -+ BIT_MASK_BK_FAST_EDCA_TO_8822C) -+#define BIT_SET_BK_FAST_EDCA_TO_8822C(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_TO_8822C(x) | BIT_BK_FAST_EDCA_TO_8822C(v)) -+ -+#define BIT_BK_THRESHOLD_SEL_8822C BIT(23) -+ -+#define BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8822C 16 -+#define BIT_MASK_BK_FAST_EDCA_PKT_TH_8822C 0x7f -+#define BIT_BK_FAST_EDCA_PKT_TH_8822C(x) \ -+ (((x) & BIT_MASK_BK_FAST_EDCA_PKT_TH_8822C) \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8822C) -+#define BITS_BK_FAST_EDCA_PKT_TH_8822C \ -+ (BIT_MASK_BK_FAST_EDCA_PKT_TH_8822C \ -+ << BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8822C) -+#define BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8822C(x) \ -+ ((x) & (~BITS_BK_FAST_EDCA_PKT_TH_8822C)) -+#define BIT_GET_BK_FAST_EDCA_PKT_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_BK_FAST_EDCA_PKT_TH_8822C) & \ -+ BIT_MASK_BK_FAST_EDCA_PKT_TH_8822C) -+#define BIT_SET_BK_FAST_EDCA_PKT_TH_8822C(x, v) \ -+ (BIT_CLEAR_BK_FAST_EDCA_PKT_TH_8822C(x) | \ -+ BIT_BK_FAST_EDCA_PKT_TH_8822C(v)) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_TO_8822C 8 -+#define BIT_MASK_BE_FAST_EDCA_TO_8822C 0xff -+#define BIT_BE_FAST_EDCA_TO_8822C(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_TO_8822C) \ -+ << BIT_SHIFT_BE_FAST_EDCA_TO_8822C) -+#define BITS_BE_FAST_EDCA_TO_8822C \ -+ (BIT_MASK_BE_FAST_EDCA_TO_8822C << BIT_SHIFT_BE_FAST_EDCA_TO_8822C) -+#define BIT_CLEAR_BE_FAST_EDCA_TO_8822C(x) ((x) & (~BITS_BE_FAST_EDCA_TO_8822C)) -+#define BIT_GET_BE_FAST_EDCA_TO_8822C(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_TO_8822C) & \ -+ BIT_MASK_BE_FAST_EDCA_TO_8822C) -+#define BIT_SET_BE_FAST_EDCA_TO_8822C(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_TO_8822C(x) | BIT_BE_FAST_EDCA_TO_8822C(v)) -+ -+#define BIT_BE_THRESHOLD_SEL_8822C BIT(7) -+ -+#define BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8822C 0 -+#define BIT_MASK_BE_FAST_EDCA_PKT_TH_8822C 0x7f -+#define BIT_BE_FAST_EDCA_PKT_TH_8822C(x) \ -+ (((x) & BIT_MASK_BE_FAST_EDCA_PKT_TH_8822C) \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8822C) -+#define BITS_BE_FAST_EDCA_PKT_TH_8822C \ -+ (BIT_MASK_BE_FAST_EDCA_PKT_TH_8822C \ -+ << BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8822C) -+#define BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8822C(x) \ -+ ((x) & (~BITS_BE_FAST_EDCA_PKT_TH_8822C)) -+#define BIT_GET_BE_FAST_EDCA_PKT_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_BE_FAST_EDCA_PKT_TH_8822C) & \ -+ BIT_MASK_BE_FAST_EDCA_PKT_TH_8822C) -+#define BIT_SET_BE_FAST_EDCA_PKT_TH_8822C(x, v) \ -+ (BIT_CLEAR_BE_FAST_EDCA_PKT_TH_8822C(x) | \ -+ BIT_BE_FAST_EDCA_PKT_TH_8822C(v)) -+ -+/* 2 REG_MACID_DROP0_8822C */ -+ -+#define BIT_SHIFT_MACID31_0_DROP_8822C 0 -+#define BIT_MASK_MACID31_0_DROP_8822C 0xffffffffL -+#define BIT_MACID31_0_DROP_8822C(x) \ -+ (((x) & BIT_MASK_MACID31_0_DROP_8822C) \ -+ << BIT_SHIFT_MACID31_0_DROP_8822C) -+#define BITS_MACID31_0_DROP_8822C \ -+ (BIT_MASK_MACID31_0_DROP_8822C << BIT_SHIFT_MACID31_0_DROP_8822C) -+#define BIT_CLEAR_MACID31_0_DROP_8822C(x) ((x) & (~BITS_MACID31_0_DROP_8822C)) -+#define BIT_GET_MACID31_0_DROP_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID31_0_DROP_8822C) & \ -+ BIT_MASK_MACID31_0_DROP_8822C) -+#define BIT_SET_MACID31_0_DROP_8822C(x, v) \ -+ (BIT_CLEAR_MACID31_0_DROP_8822C(x) | BIT_MACID31_0_DROP_8822C(v)) -+ -+/* 2 REG_MACID_DROP1_8822C */ -+ -+#define BIT_SHIFT_MACID63_32_DROP_8822C 0 -+#define BIT_MASK_MACID63_32_DROP_8822C 0xffffffffL -+#define BIT_MACID63_32_DROP_8822C(x) \ -+ (((x) & BIT_MASK_MACID63_32_DROP_8822C) \ -+ << BIT_SHIFT_MACID63_32_DROP_8822C) -+#define BITS_MACID63_32_DROP_8822C \ -+ (BIT_MASK_MACID63_32_DROP_8822C << BIT_SHIFT_MACID63_32_DROP_8822C) -+#define BIT_CLEAR_MACID63_32_DROP_8822C(x) ((x) & (~BITS_MACID63_32_DROP_8822C)) -+#define BIT_GET_MACID63_32_DROP_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID63_32_DROP_8822C) & \ -+ BIT_MASK_MACID63_32_DROP_8822C) -+#define BIT_SET_MACID63_32_DROP_8822C(x, v) \ -+ (BIT_CLEAR_MACID63_32_DROP_8822C(x) | BIT_MACID63_32_DROP_8822C(v)) -+ -+/* 2 REG_MACID_DROP2_8822C */ -+ -+#define BIT_SHIFT_MACID95_64_DROP_8822C 0 -+#define BIT_MASK_MACID95_64_DROP_8822C 0xffffffffL -+#define BIT_MACID95_64_DROP_8822C(x) \ -+ (((x) & BIT_MASK_MACID95_64_DROP_8822C) \ -+ << BIT_SHIFT_MACID95_64_DROP_8822C) -+#define BITS_MACID95_64_DROP_8822C \ -+ (BIT_MASK_MACID95_64_DROP_8822C << BIT_SHIFT_MACID95_64_DROP_8822C) -+#define BIT_CLEAR_MACID95_64_DROP_8822C(x) ((x) & (~BITS_MACID95_64_DROP_8822C)) -+#define BIT_GET_MACID95_64_DROP_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID95_64_DROP_8822C) & \ -+ BIT_MASK_MACID95_64_DROP_8822C) -+#define BIT_SET_MACID95_64_DROP_8822C(x, v) \ -+ (BIT_CLEAR_MACID95_64_DROP_8822C(x) | BIT_MACID95_64_DROP_8822C(v)) -+ -+/* 2 REG_MACID_DROP3_8822C */ -+ -+#define BIT_SHIFT_MACID127_96_DROP_8822C 0 -+#define BIT_MASK_MACID127_96_DROP_8822C 0xffffffffL -+#define BIT_MACID127_96_DROP_8822C(x) \ -+ (((x) & BIT_MASK_MACID127_96_DROP_8822C) \ -+ << BIT_SHIFT_MACID127_96_DROP_8822C) -+#define BITS_MACID127_96_DROP_8822C \ -+ (BIT_MASK_MACID127_96_DROP_8822C << BIT_SHIFT_MACID127_96_DROP_8822C) -+#define BIT_CLEAR_MACID127_96_DROP_8822C(x) \ -+ ((x) & (~BITS_MACID127_96_DROP_8822C)) -+#define BIT_GET_MACID127_96_DROP_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID127_96_DROP_8822C) & \ -+ BIT_MASK_MACID127_96_DROP_8822C) -+#define BIT_SET_MACID127_96_DROP_8822C(x, v) \ -+ (BIT_CLEAR_MACID127_96_DROP_8822C(x) | BIT_MACID127_96_DROP_8822C(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_0_8822C */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8822C 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8822C 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_0_8822C(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8822C) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8822C) -+#define BITS_R_MACID_RELEASE_SUCCESS_0_8822C \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8822C \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8822C) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0_8822C(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_0_8822C)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_0_8822C) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_0_8822C) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_0_8822C(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_0_8822C(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_0_8822C(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_1_8822C */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8822C 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8822C 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_1_8822C(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8822C) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8822C) -+#define BITS_R_MACID_RELEASE_SUCCESS_1_8822C \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8822C \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8822C) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1_8822C(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_1_8822C)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_1_8822C) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_1_8822C) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_1_8822C(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_1_8822C(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_1_8822C(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_2_8822C */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8822C 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8822C 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_2_8822C(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8822C) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8822C) -+#define BITS_R_MACID_RELEASE_SUCCESS_2_8822C \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8822C \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8822C) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2_8822C(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_2_8822C)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_2_8822C) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_2_8822C) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_2_8822C(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_2_8822C(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_2_8822C(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_3_8822C */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8822C 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8822C 0xffffffffL -+#define BIT_R_MACID_RELEASE_SUCCESS_3_8822C(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8822C) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8822C) -+#define BITS_R_MACID_RELEASE_SUCCESS_3_8822C \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8822C \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8822C) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3_8822C(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_3_8822C)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_3_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_3_8822C) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_3_8822C) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_3_8822C(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_3_8822C(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_3_8822C(v)) -+ -+/* 2 REG_MGQ_FIFO_WRITE_POINTER_8822C */ -+#define BIT_MGQ_FIFO_OV_8822C BIT(7) -+#define BIT_MGQ_FIFO_WPTR_ERROR_8822C BIT(6) -+#define BIT_EN_MGQ_FIFO_LIFETIME_8822C BIT(5) -+ -+#define BIT_SHIFT_MGQ_FIFO_WPTR_8822C 0 -+#define BIT_MASK_MGQ_FIFO_WPTR_8822C 0x1f -+#define BIT_MGQ_FIFO_WPTR_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_WPTR_8822C) << BIT_SHIFT_MGQ_FIFO_WPTR_8822C) -+#define BITS_MGQ_FIFO_WPTR_8822C \ -+ (BIT_MASK_MGQ_FIFO_WPTR_8822C << BIT_SHIFT_MGQ_FIFO_WPTR_8822C) -+#define BIT_CLEAR_MGQ_FIFO_WPTR_8822C(x) ((x) & (~BITS_MGQ_FIFO_WPTR_8822C)) -+#define BIT_GET_MGQ_FIFO_WPTR_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_WPTR_8822C) & BIT_MASK_MGQ_FIFO_WPTR_8822C) -+#define BIT_SET_MGQ_FIFO_WPTR_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_WPTR_8822C(x) | BIT_MGQ_FIFO_WPTR_8822C(v)) -+ -+/* 2 REG_MGQ_FIFO_READ_POINTER_8822C */ -+ -+#define BIT_SHIFT_MGQ_FIFO_SIZE_8822C 14 -+#define BIT_MASK_MGQ_FIFO_SIZE_8822C 0x3 -+#define BIT_MGQ_FIFO_SIZE_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_SIZE_8822C) << BIT_SHIFT_MGQ_FIFO_SIZE_8822C) -+#define BITS_MGQ_FIFO_SIZE_8822C \ -+ (BIT_MASK_MGQ_FIFO_SIZE_8822C << BIT_SHIFT_MGQ_FIFO_SIZE_8822C) -+#define BIT_CLEAR_MGQ_FIFO_SIZE_8822C(x) ((x) & (~BITS_MGQ_FIFO_SIZE_8822C)) -+#define BIT_GET_MGQ_FIFO_SIZE_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_SIZE_8822C) & BIT_MASK_MGQ_FIFO_SIZE_8822C) -+#define BIT_SET_MGQ_FIFO_SIZE_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_SIZE_8822C(x) | BIT_MGQ_FIFO_SIZE_8822C(v)) -+ -+#define BIT_MGQ_FIFO_PAUSE_8822C BIT(13) -+ -+#define BIT_SHIFT_MGQ_FIFO_RPTR_8822C 8 -+#define BIT_MASK_MGQ_FIFO_RPTR_8822C 0x1f -+#define BIT_MGQ_FIFO_RPTR_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_RPTR_8822C) << BIT_SHIFT_MGQ_FIFO_RPTR_8822C) -+#define BITS_MGQ_FIFO_RPTR_8822C \ -+ (BIT_MASK_MGQ_FIFO_RPTR_8822C << BIT_SHIFT_MGQ_FIFO_RPTR_8822C) -+#define BIT_CLEAR_MGQ_FIFO_RPTR_8822C(x) ((x) & (~BITS_MGQ_FIFO_RPTR_8822C)) -+#define BIT_GET_MGQ_FIFO_RPTR_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_RPTR_8822C) & BIT_MASK_MGQ_FIFO_RPTR_8822C) -+#define BIT_SET_MGQ_FIFO_RPTR_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_RPTR_8822C(x) | BIT_MGQ_FIFO_RPTR_8822C(v)) -+ -+/* 2 REG_MGQ_FIFO_ENABLE_8822C */ -+#define BIT_MGQ_FIFO_EN_8822C BIT(15) -+ -+#define BIT_SHIFT_MGQ_FIFO_PG_SIZE_8822C 12 -+#define BIT_MASK_MGQ_FIFO_PG_SIZE_8822C 0x7 -+#define BIT_MGQ_FIFO_PG_SIZE_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_PG_SIZE_8822C) \ -+ << BIT_SHIFT_MGQ_FIFO_PG_SIZE_8822C) -+#define BITS_MGQ_FIFO_PG_SIZE_8822C \ -+ (BIT_MASK_MGQ_FIFO_PG_SIZE_8822C << BIT_SHIFT_MGQ_FIFO_PG_SIZE_8822C) -+#define BIT_CLEAR_MGQ_FIFO_PG_SIZE_8822C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_PG_SIZE_8822C)) -+#define BIT_GET_MGQ_FIFO_PG_SIZE_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_PG_SIZE_8822C) & \ -+ BIT_MASK_MGQ_FIFO_PG_SIZE_8822C) -+#define BIT_SET_MGQ_FIFO_PG_SIZE_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_PG_SIZE_8822C(x) | BIT_MGQ_FIFO_PG_SIZE_8822C(v)) -+ -+#define BIT_SHIFT_MGQ_FIFO_START_PG_8822C 0 -+#define BIT_MASK_MGQ_FIFO_START_PG_8822C 0xfff -+#define BIT_MGQ_FIFO_START_PG_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_START_PG_8822C) \ -+ << BIT_SHIFT_MGQ_FIFO_START_PG_8822C) -+#define BITS_MGQ_FIFO_START_PG_8822C \ -+ (BIT_MASK_MGQ_FIFO_START_PG_8822C << BIT_SHIFT_MGQ_FIFO_START_PG_8822C) -+#define BIT_CLEAR_MGQ_FIFO_START_PG_8822C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_START_PG_8822C)) -+#define BIT_GET_MGQ_FIFO_START_PG_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_START_PG_8822C) & \ -+ BIT_MASK_MGQ_FIFO_START_PG_8822C) -+#define BIT_SET_MGQ_FIFO_START_PG_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_START_PG_8822C(x) | BIT_MGQ_FIFO_START_PG_8822C(v)) -+ -+/* 2 REG_MGQ_FIFO_RELEASE_INT_MASK_8822C */ -+ -+#define BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8822C 0 -+#define BIT_MASK_MGQ_FIFO_REL_INT_MASK_8822C 0xffff -+#define BIT_MGQ_FIFO_REL_INT_MASK_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_REL_INT_MASK_8822C) \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8822C) -+#define BITS_MGQ_FIFO_REL_INT_MASK_8822C \ -+ (BIT_MASK_MGQ_FIFO_REL_INT_MASK_8822C \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8822C) -+#define BIT_CLEAR_MGQ_FIFO_REL_INT_MASK_8822C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_REL_INT_MASK_8822C)) -+#define BIT_GET_MGQ_FIFO_REL_INT_MASK_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_REL_INT_MASK_8822C) & \ -+ BIT_MASK_MGQ_FIFO_REL_INT_MASK_8822C) -+#define BIT_SET_MGQ_FIFO_REL_INT_MASK_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_REL_INT_MASK_8822C(x) | \ -+ BIT_MGQ_FIFO_REL_INT_MASK_8822C(v)) -+ -+/* 2 REG_MGQ_FIFO_RELEASE_INT_FLAG_8822C */ -+ -+#define BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8822C 0 -+#define BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8822C 0xffff -+#define BIT_MGQ_FIFO_REL_INT_FLAG_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8822C) \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8822C) -+#define BITS_MGQ_FIFO_REL_INT_FLAG_8822C \ -+ (BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8822C \ -+ << BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8822C) -+#define BIT_CLEAR_MGQ_FIFO_REL_INT_FLAG_8822C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_REL_INT_FLAG_8822C)) -+#define BIT_GET_MGQ_FIFO_REL_INT_FLAG_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_REL_INT_FLAG_8822C) & \ -+ BIT_MASK_MGQ_FIFO_REL_INT_FLAG_8822C) -+#define BIT_SET_MGQ_FIFO_REL_INT_FLAG_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_REL_INT_FLAG_8822C(x) | \ -+ BIT_MGQ_FIFO_REL_INT_FLAG_8822C(v)) -+ -+/* 2 REG_MGQ_FIFO_VALID_MAP_8822C */ -+ -+#define BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8822C 0 -+#define BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8822C 0xffff -+#define BIT_MGQ_FIFO_PKT_VALID_MAP_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8822C) \ -+ << BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8822C) -+#define BITS_MGQ_FIFO_PKT_VALID_MAP_8822C \ -+ (BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8822C \ -+ << BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8822C) -+#define BIT_CLEAR_MGQ_FIFO_PKT_VALID_MAP_8822C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_PKT_VALID_MAP_8822C)) -+#define BIT_GET_MGQ_FIFO_PKT_VALID_MAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_PKT_VALID_MAP_8822C) & \ -+ BIT_MASK_MGQ_FIFO_PKT_VALID_MAP_8822C) -+#define BIT_SET_MGQ_FIFO_PKT_VALID_MAP_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_PKT_VALID_MAP_8822C(x) | \ -+ BIT_MGQ_FIFO_PKT_VALID_MAP_8822C(v)) -+ -+/* 2 REG_MGQ_FIFO_LIFETIME_8822C */ -+ -+#define BIT_SHIFT_MGQ_FIFO_LIFETIME_8822C 0 -+#define BIT_MASK_MGQ_FIFO_LIFETIME_8822C 0xffff -+#define BIT_MGQ_FIFO_LIFETIME_8822C(x) \ -+ (((x) & BIT_MASK_MGQ_FIFO_LIFETIME_8822C) \ -+ << BIT_SHIFT_MGQ_FIFO_LIFETIME_8822C) -+#define BITS_MGQ_FIFO_LIFETIME_8822C \ -+ (BIT_MASK_MGQ_FIFO_LIFETIME_8822C << BIT_SHIFT_MGQ_FIFO_LIFETIME_8822C) -+#define BIT_CLEAR_MGQ_FIFO_LIFETIME_8822C(x) \ -+ ((x) & (~BITS_MGQ_FIFO_LIFETIME_8822C)) -+#define BIT_GET_MGQ_FIFO_LIFETIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_MGQ_FIFO_LIFETIME_8822C) & \ -+ BIT_MASK_MGQ_FIFO_LIFETIME_8822C) -+#define BIT_SET_MGQ_FIFO_LIFETIME_8822C(x, v) \ -+ (BIT_CLEAR_MGQ_FIFO_LIFETIME_8822C(x) | BIT_MGQ_FIFO_LIFETIME_8822C(v)) -+ -+/* 2 REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C */ -+ -+#define BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C 0 -+#define BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C 0x7f -+#define BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C) \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C) -+#define BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C \ -+ (BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C \ -+ << BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C) -+#define BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C(x) \ -+ ((x) & (~BITS_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C)) -+#define BIT_GET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C) & \ -+ BIT_MASK_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C) -+#define BIT_SET_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C(x) | \ -+ BIT_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C(v)) -+ -+/* 2 REG_SHCUT_SETTING_8822C */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE0_8822C */ -+ -+/* 2 REG_SHCUT_LLC_ETH_TYPE1_8822C */ -+ -+/* 2 REG_SHCUT_LLC_OUI0_8822C */ -+ -+/* 2 REG_SHCUT_LLC_OUI1_8822C */ -+ -+/* 2 REG_SHCUT_LLC_OUI2_8822C */ -+ -+/* 2 REG_MU_TX_CTL_8822C */ -+#define BIT_R_MU_P1_WAIT_STATE_EN_8822C BIT(16) -+ -+#define BIT_SHIFT_R_MU_RL_8822C 12 -+#define BIT_MASK_R_MU_RL_8822C 0xf -+#define BIT_R_MU_RL_8822C(x) \ -+ (((x) & BIT_MASK_R_MU_RL_8822C) << BIT_SHIFT_R_MU_RL_8822C) -+#define BITS_R_MU_RL_8822C (BIT_MASK_R_MU_RL_8822C << BIT_SHIFT_R_MU_RL_8822C) -+#define BIT_CLEAR_R_MU_RL_8822C(x) ((x) & (~BITS_R_MU_RL_8822C)) -+#define BIT_GET_R_MU_RL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_RL_8822C) & BIT_MASK_R_MU_RL_8822C) -+#define BIT_SET_R_MU_RL_8822C(x, v) \ -+ (BIT_CLEAR_R_MU_RL_8822C(x) | BIT_R_MU_RL_8822C(v)) -+ -+#define BIT_R_FORCE_P1_RATEDOWN_8822C BIT(11) -+ -+#define BIT_SHIFT_R_MU_TAB_SEL_8822C 8 -+#define BIT_MASK_R_MU_TAB_SEL_8822C 0x7 -+#define BIT_R_MU_TAB_SEL_8822C(x) \ -+ (((x) & BIT_MASK_R_MU_TAB_SEL_8822C) << BIT_SHIFT_R_MU_TAB_SEL_8822C) -+#define BITS_R_MU_TAB_SEL_8822C \ -+ (BIT_MASK_R_MU_TAB_SEL_8822C << BIT_SHIFT_R_MU_TAB_SEL_8822C) -+#define BIT_CLEAR_R_MU_TAB_SEL_8822C(x) ((x) & (~BITS_R_MU_TAB_SEL_8822C)) -+#define BIT_GET_R_MU_TAB_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_TAB_SEL_8822C) & BIT_MASK_R_MU_TAB_SEL_8822C) -+#define BIT_SET_R_MU_TAB_SEL_8822C(x, v) \ -+ (BIT_CLEAR_R_MU_TAB_SEL_8822C(x) | BIT_R_MU_TAB_SEL_8822C(v)) -+ -+#define BIT_R_EN_MU_MIMO_8822C BIT(7) -+#define BIT_R_EN_REVERS_GTAB_8822C BIT(6) -+ -+#define BIT_SHIFT_R_MU_TABLE_VALID_8822C 0 -+#define BIT_MASK_R_MU_TABLE_VALID_8822C 0x3f -+#define BIT_R_MU_TABLE_VALID_8822C(x) \ -+ (((x) & BIT_MASK_R_MU_TABLE_VALID_8822C) \ -+ << BIT_SHIFT_R_MU_TABLE_VALID_8822C) -+#define BITS_R_MU_TABLE_VALID_8822C \ -+ (BIT_MASK_R_MU_TABLE_VALID_8822C << BIT_SHIFT_R_MU_TABLE_VALID_8822C) -+#define BIT_CLEAR_R_MU_TABLE_VALID_8822C(x) \ -+ ((x) & (~BITS_R_MU_TABLE_VALID_8822C)) -+#define BIT_GET_R_MU_TABLE_VALID_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_TABLE_VALID_8822C) & \ -+ BIT_MASK_R_MU_TABLE_VALID_8822C) -+#define BIT_SET_R_MU_TABLE_VALID_8822C(x, v) \ -+ (BIT_CLEAR_R_MU_TABLE_VALID_8822C(x) | BIT_R_MU_TABLE_VALID_8822C(v)) -+ -+/* 2 REG_MU_STA_GID_VLD_8822C */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_VALID_8822C 0 -+#define BIT_MASK_R_MU_STA_GTAB_VALID_8822C 0xffffffffL -+#define BIT_R_MU_STA_GTAB_VALID_8822C(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_VALID_8822C) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8822C) -+#define BITS_R_MU_STA_GTAB_VALID_8822C \ -+ (BIT_MASK_R_MU_STA_GTAB_VALID_8822C \ -+ << BIT_SHIFT_R_MU_STA_GTAB_VALID_8822C) -+#define BIT_CLEAR_R_MU_STA_GTAB_VALID_8822C(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_VALID_8822C)) -+#define BIT_GET_R_MU_STA_GTAB_VALID_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_VALID_8822C) & \ -+ BIT_MASK_R_MU_STA_GTAB_VALID_8822C) -+#define BIT_SET_R_MU_STA_GTAB_VALID_8822C(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_VALID_8822C(x) | \ -+ BIT_R_MU_STA_GTAB_VALID_8822C(v)) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_8822C */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8822C 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_L_8822C 0xffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_L_8822C(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_L_8822C) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8822C) -+#define BITS_R_MU_STA_GTAB_POSITION_L_8822C \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_L_8822C \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8822C) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_L_8822C(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_L_8822C)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_L_8822C) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_L_8822C) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_L_8822C(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_L_8822C(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_L_8822C(v)) -+ -+/* 2 REG_MU_STA_USER_POS_INFO_H_8822C */ -+ -+#define BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8822C 0 -+#define BIT_MASK_R_MU_STA_GTAB_POSITION_H_8822C 0xffffffffL -+#define BIT_R_MU_STA_GTAB_POSITION_H_8822C(x) \ -+ (((x) & BIT_MASK_R_MU_STA_GTAB_POSITION_H_8822C) \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8822C) -+#define BITS_R_MU_STA_GTAB_POSITION_H_8822C \ -+ (BIT_MASK_R_MU_STA_GTAB_POSITION_H_8822C \ -+ << BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8822C) -+#define BIT_CLEAR_R_MU_STA_GTAB_POSITION_H_8822C(x) \ -+ ((x) & (~BITS_R_MU_STA_GTAB_POSITION_H_8822C)) -+#define BIT_GET_R_MU_STA_GTAB_POSITION_H_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MU_STA_GTAB_POSITION_H_8822C) & \ -+ BIT_MASK_R_MU_STA_GTAB_POSITION_H_8822C) -+#define BIT_SET_R_MU_STA_GTAB_POSITION_H_8822C(x, v) \ -+ (BIT_CLEAR_R_MU_STA_GTAB_POSITION_H_8822C(x) | \ -+ BIT_R_MU_STA_GTAB_POSITION_H_8822C(v)) -+ -+/* 2 REG_CHNL_INFO_CTRL_8822C */ -+#define BIT_CHNL_REF_RXNAV_8822C BIT(7) -+#define BIT_CHNL_REF_VBON_8822C BIT(6) -+#define BIT_CHNL_REF_EDCA_8822C BIT(5) -+#define BIT_CHNL_REF_CCA_8822C BIT(4) -+#define BIT_RST_CHNL_BUSY_8822C BIT(3) -+#define BIT_RST_CHNL_IDLE_8822C BIT(2) -+#define BIT_CHNL_INFO_RST_8822C BIT(1) -+#define BIT_ATM_AIRTIME_EN_8822C BIT(0) -+ -+/* 2 REG_CHNL_IDLE_TIME_8822C */ -+ -+#define BIT_SHIFT_CHNL_IDLE_TIME_8822C 0 -+#define BIT_MASK_CHNL_IDLE_TIME_8822C 0xffffffffL -+#define BIT_CHNL_IDLE_TIME_8822C(x) \ -+ (((x) & BIT_MASK_CHNL_IDLE_TIME_8822C) \ -+ << BIT_SHIFT_CHNL_IDLE_TIME_8822C) -+#define BITS_CHNL_IDLE_TIME_8822C \ -+ (BIT_MASK_CHNL_IDLE_TIME_8822C << BIT_SHIFT_CHNL_IDLE_TIME_8822C) -+#define BIT_CLEAR_CHNL_IDLE_TIME_8822C(x) ((x) & (~BITS_CHNL_IDLE_TIME_8822C)) -+#define BIT_GET_CHNL_IDLE_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_CHNL_IDLE_TIME_8822C) & \ -+ BIT_MASK_CHNL_IDLE_TIME_8822C) -+#define BIT_SET_CHNL_IDLE_TIME_8822C(x, v) \ -+ (BIT_CLEAR_CHNL_IDLE_TIME_8822C(x) | BIT_CHNL_IDLE_TIME_8822C(v)) -+ -+/* 2 REG_CHNL_BUSY_TIME_8822C */ -+ -+#define BIT_SHIFT_CHNL_BUSY_TIME_8822C 0 -+#define BIT_MASK_CHNL_BUSY_TIME_8822C 0xffffffffL -+#define BIT_CHNL_BUSY_TIME_8822C(x) \ -+ (((x) & BIT_MASK_CHNL_BUSY_TIME_8822C) \ -+ << BIT_SHIFT_CHNL_BUSY_TIME_8822C) -+#define BITS_CHNL_BUSY_TIME_8822C \ -+ (BIT_MASK_CHNL_BUSY_TIME_8822C << BIT_SHIFT_CHNL_BUSY_TIME_8822C) -+#define BIT_CLEAR_CHNL_BUSY_TIME_8822C(x) ((x) & (~BITS_CHNL_BUSY_TIME_8822C)) -+#define BIT_GET_CHNL_BUSY_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_CHNL_BUSY_TIME_8822C) & \ -+ BIT_MASK_CHNL_BUSY_TIME_8822C) -+#define BIT_SET_CHNL_BUSY_TIME_8822C(x, v) \ -+ (BIT_CLEAR_CHNL_BUSY_TIME_8822C(x) | BIT_CHNL_BUSY_TIME_8822C(v)) -+ -+/* 2 REG_MU_TRX_DBG_CNT_V1_8822C */ -+#define BIT_MU_DNGCNT_RST_8822C BIT(20) -+ -+#define BIT_SHIFT_MU_DNGCNT_SEL_8822C 16 -+#define BIT_MASK_MU_DNGCNT_SEL_8822C 0xf -+#define BIT_MU_DNGCNT_SEL_8822C(x) \ -+ (((x) & BIT_MASK_MU_DNGCNT_SEL_8822C) << BIT_SHIFT_MU_DNGCNT_SEL_8822C) -+#define BITS_MU_DNGCNT_SEL_8822C \ -+ (BIT_MASK_MU_DNGCNT_SEL_8822C << BIT_SHIFT_MU_DNGCNT_SEL_8822C) -+#define BIT_CLEAR_MU_DNGCNT_SEL_8822C(x) ((x) & (~BITS_MU_DNGCNT_SEL_8822C)) -+#define BIT_GET_MU_DNGCNT_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_MU_DNGCNT_SEL_8822C) & BIT_MASK_MU_DNGCNT_SEL_8822C) -+#define BIT_SET_MU_DNGCNT_SEL_8822C(x, v) \ -+ (BIT_CLEAR_MU_DNGCNT_SEL_8822C(x) | BIT_MU_DNGCNT_SEL_8822C(v)) -+ -+#define BIT_SHIFT_MU_DNGCNT_8822C 0 -+#define BIT_MASK_MU_DNGCNT_8822C 0xffff -+#define BIT_MU_DNGCNT_8822C(x) \ -+ (((x) & BIT_MASK_MU_DNGCNT_8822C) << BIT_SHIFT_MU_DNGCNT_8822C) -+#define BITS_MU_DNGCNT_8822C \ -+ (BIT_MASK_MU_DNGCNT_8822C << BIT_SHIFT_MU_DNGCNT_8822C) -+#define BIT_CLEAR_MU_DNGCNT_8822C(x) ((x) & (~BITS_MU_DNGCNT_8822C)) -+#define BIT_GET_MU_DNGCNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_MU_DNGCNT_8822C) & BIT_MASK_MU_DNGCNT_8822C) -+#define BIT_SET_MU_DNGCNT_8822C(x, v) \ -+ (BIT_CLEAR_MU_DNGCNT_8822C(x) | BIT_MU_DNGCNT_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_EDCA_VO_PARAM_8822C */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8822C 16 -+#define BIT_MASK_TXOPLIMIT_8822C 0x7ff -+#define BIT_TXOPLIMIT_8822C(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8822C) << BIT_SHIFT_TXOPLIMIT_8822C) -+#define BITS_TXOPLIMIT_8822C \ -+ (BIT_MASK_TXOPLIMIT_8822C << BIT_SHIFT_TXOPLIMIT_8822C) -+#define BIT_CLEAR_TXOPLIMIT_8822C(x) ((x) & (~BITS_TXOPLIMIT_8822C)) -+#define BIT_GET_TXOPLIMIT_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8822C) & BIT_MASK_TXOPLIMIT_8822C) -+#define BIT_SET_TXOPLIMIT_8822C(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8822C(x) | BIT_TXOPLIMIT_8822C(v)) -+ -+#define BIT_SHIFT_CW_8822C 8 -+#define BIT_MASK_CW_8822C 0xff -+#define BIT_CW_8822C(x) (((x) & BIT_MASK_CW_8822C) << BIT_SHIFT_CW_8822C) -+#define BITS_CW_8822C (BIT_MASK_CW_8822C << BIT_SHIFT_CW_8822C) -+#define BIT_CLEAR_CW_8822C(x) ((x) & (~BITS_CW_8822C)) -+#define BIT_GET_CW_8822C(x) (((x) >> BIT_SHIFT_CW_8822C) & BIT_MASK_CW_8822C) -+#define BIT_SET_CW_8822C(x, v) (BIT_CLEAR_CW_8822C(x) | BIT_CW_8822C(v)) -+ -+#define BIT_SHIFT_AIFS_8822C 0 -+#define BIT_MASK_AIFS_8822C 0xff -+#define BIT_AIFS_8822C(x) (((x) & BIT_MASK_AIFS_8822C) << BIT_SHIFT_AIFS_8822C) -+#define BITS_AIFS_8822C (BIT_MASK_AIFS_8822C << BIT_SHIFT_AIFS_8822C) -+#define BIT_CLEAR_AIFS_8822C(x) ((x) & (~BITS_AIFS_8822C)) -+#define BIT_GET_AIFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8822C) & BIT_MASK_AIFS_8822C) -+#define BIT_SET_AIFS_8822C(x, v) (BIT_CLEAR_AIFS_8822C(x) | BIT_AIFS_8822C(v)) -+ -+/* 2 REG_EDCA_VI_PARAM_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8822C 16 -+#define BIT_MASK_TXOPLIMIT_8822C 0x7ff -+#define BIT_TXOPLIMIT_8822C(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8822C) << BIT_SHIFT_TXOPLIMIT_8822C) -+#define BITS_TXOPLIMIT_8822C \ -+ (BIT_MASK_TXOPLIMIT_8822C << BIT_SHIFT_TXOPLIMIT_8822C) -+#define BIT_CLEAR_TXOPLIMIT_8822C(x) ((x) & (~BITS_TXOPLIMIT_8822C)) -+#define BIT_GET_TXOPLIMIT_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8822C) & BIT_MASK_TXOPLIMIT_8822C) -+#define BIT_SET_TXOPLIMIT_8822C(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8822C(x) | BIT_TXOPLIMIT_8822C(v)) -+ -+#define BIT_SHIFT_CW_8822C 8 -+#define BIT_MASK_CW_8822C 0xff -+#define BIT_CW_8822C(x) (((x) & BIT_MASK_CW_8822C) << BIT_SHIFT_CW_8822C) -+#define BITS_CW_8822C (BIT_MASK_CW_8822C << BIT_SHIFT_CW_8822C) -+#define BIT_CLEAR_CW_8822C(x) ((x) & (~BITS_CW_8822C)) -+#define BIT_GET_CW_8822C(x) (((x) >> BIT_SHIFT_CW_8822C) & BIT_MASK_CW_8822C) -+#define BIT_SET_CW_8822C(x, v) (BIT_CLEAR_CW_8822C(x) | BIT_CW_8822C(v)) -+ -+#define BIT_SHIFT_AIFS_8822C 0 -+#define BIT_MASK_AIFS_8822C 0xff -+#define BIT_AIFS_8822C(x) (((x) & BIT_MASK_AIFS_8822C) << BIT_SHIFT_AIFS_8822C) -+#define BITS_AIFS_8822C (BIT_MASK_AIFS_8822C << BIT_SHIFT_AIFS_8822C) -+#define BIT_CLEAR_AIFS_8822C(x) ((x) & (~BITS_AIFS_8822C)) -+#define BIT_GET_AIFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8822C) & BIT_MASK_AIFS_8822C) -+#define BIT_SET_AIFS_8822C(x, v) (BIT_CLEAR_AIFS_8822C(x) | BIT_AIFS_8822C(v)) -+ -+/* 2 REG_EDCA_BE_PARAM_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8822C 16 -+#define BIT_MASK_TXOPLIMIT_8822C 0x7ff -+#define BIT_TXOPLIMIT_8822C(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8822C) << BIT_SHIFT_TXOPLIMIT_8822C) -+#define BITS_TXOPLIMIT_8822C \ -+ (BIT_MASK_TXOPLIMIT_8822C << BIT_SHIFT_TXOPLIMIT_8822C) -+#define BIT_CLEAR_TXOPLIMIT_8822C(x) ((x) & (~BITS_TXOPLIMIT_8822C)) -+#define BIT_GET_TXOPLIMIT_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8822C) & BIT_MASK_TXOPLIMIT_8822C) -+#define BIT_SET_TXOPLIMIT_8822C(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8822C(x) | BIT_TXOPLIMIT_8822C(v)) -+ -+#define BIT_SHIFT_CW_8822C 8 -+#define BIT_MASK_CW_8822C 0xff -+#define BIT_CW_8822C(x) (((x) & BIT_MASK_CW_8822C) << BIT_SHIFT_CW_8822C) -+#define BITS_CW_8822C (BIT_MASK_CW_8822C << BIT_SHIFT_CW_8822C) -+#define BIT_CLEAR_CW_8822C(x) ((x) & (~BITS_CW_8822C)) -+#define BIT_GET_CW_8822C(x) (((x) >> BIT_SHIFT_CW_8822C) & BIT_MASK_CW_8822C) -+#define BIT_SET_CW_8822C(x, v) (BIT_CLEAR_CW_8822C(x) | BIT_CW_8822C(v)) -+ -+#define BIT_SHIFT_AIFS_8822C 0 -+#define BIT_MASK_AIFS_8822C 0xff -+#define BIT_AIFS_8822C(x) (((x) & BIT_MASK_AIFS_8822C) << BIT_SHIFT_AIFS_8822C) -+#define BITS_AIFS_8822C (BIT_MASK_AIFS_8822C << BIT_SHIFT_AIFS_8822C) -+#define BIT_CLEAR_AIFS_8822C(x) ((x) & (~BITS_AIFS_8822C)) -+#define BIT_GET_AIFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8822C) & BIT_MASK_AIFS_8822C) -+#define BIT_SET_AIFS_8822C(x, v) (BIT_CLEAR_AIFS_8822C(x) | BIT_AIFS_8822C(v)) -+ -+/* 2 REG_EDCA_BK_PARAM_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_TXOPLIMIT_8822C 16 -+#define BIT_MASK_TXOPLIMIT_8822C 0x7ff -+#define BIT_TXOPLIMIT_8822C(x) \ -+ (((x) & BIT_MASK_TXOPLIMIT_8822C) << BIT_SHIFT_TXOPLIMIT_8822C) -+#define BITS_TXOPLIMIT_8822C \ -+ (BIT_MASK_TXOPLIMIT_8822C << BIT_SHIFT_TXOPLIMIT_8822C) -+#define BIT_CLEAR_TXOPLIMIT_8822C(x) ((x) & (~BITS_TXOPLIMIT_8822C)) -+#define BIT_GET_TXOPLIMIT_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXOPLIMIT_8822C) & BIT_MASK_TXOPLIMIT_8822C) -+#define BIT_SET_TXOPLIMIT_8822C(x, v) \ -+ (BIT_CLEAR_TXOPLIMIT_8822C(x) | BIT_TXOPLIMIT_8822C(v)) -+ -+#define BIT_SHIFT_CW_8822C 8 -+#define BIT_MASK_CW_8822C 0xff -+#define BIT_CW_8822C(x) (((x) & BIT_MASK_CW_8822C) << BIT_SHIFT_CW_8822C) -+#define BITS_CW_8822C (BIT_MASK_CW_8822C << BIT_SHIFT_CW_8822C) -+#define BIT_CLEAR_CW_8822C(x) ((x) & (~BITS_CW_8822C)) -+#define BIT_GET_CW_8822C(x) (((x) >> BIT_SHIFT_CW_8822C) & BIT_MASK_CW_8822C) -+#define BIT_SET_CW_8822C(x, v) (BIT_CLEAR_CW_8822C(x) | BIT_CW_8822C(v)) -+ -+#define BIT_SHIFT_AIFS_8822C 0 -+#define BIT_MASK_AIFS_8822C 0xff -+#define BIT_AIFS_8822C(x) (((x) & BIT_MASK_AIFS_8822C) << BIT_SHIFT_AIFS_8822C) -+#define BITS_AIFS_8822C (BIT_MASK_AIFS_8822C << BIT_SHIFT_AIFS_8822C) -+#define BIT_CLEAR_AIFS_8822C(x) ((x) & (~BITS_AIFS_8822C)) -+#define BIT_GET_AIFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8822C) & BIT_MASK_AIFS_8822C) -+#define BIT_SET_AIFS_8822C(x, v) (BIT_CLEAR_AIFS_8822C(x) | BIT_AIFS_8822C(v)) -+ -+/* 2 REG_BCNTCFG_8822C */ -+ -+#define BIT_SHIFT_BCNCW_MAX_8822C 12 -+#define BIT_MASK_BCNCW_MAX_8822C 0xf -+#define BIT_BCNCW_MAX_8822C(x) \ -+ (((x) & BIT_MASK_BCNCW_MAX_8822C) << BIT_SHIFT_BCNCW_MAX_8822C) -+#define BITS_BCNCW_MAX_8822C \ -+ (BIT_MASK_BCNCW_MAX_8822C << BIT_SHIFT_BCNCW_MAX_8822C) -+#define BIT_CLEAR_BCNCW_MAX_8822C(x) ((x) & (~BITS_BCNCW_MAX_8822C)) -+#define BIT_GET_BCNCW_MAX_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MAX_8822C) & BIT_MASK_BCNCW_MAX_8822C) -+#define BIT_SET_BCNCW_MAX_8822C(x, v) \ -+ (BIT_CLEAR_BCNCW_MAX_8822C(x) | BIT_BCNCW_MAX_8822C(v)) -+ -+#define BIT_SHIFT_BCNCW_MIN_8822C 8 -+#define BIT_MASK_BCNCW_MIN_8822C 0xf -+#define BIT_BCNCW_MIN_8822C(x) \ -+ (((x) & BIT_MASK_BCNCW_MIN_8822C) << BIT_SHIFT_BCNCW_MIN_8822C) -+#define BITS_BCNCW_MIN_8822C \ -+ (BIT_MASK_BCNCW_MIN_8822C << BIT_SHIFT_BCNCW_MIN_8822C) -+#define BIT_CLEAR_BCNCW_MIN_8822C(x) ((x) & (~BITS_BCNCW_MIN_8822C)) -+#define BIT_GET_BCNCW_MIN_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNCW_MIN_8822C) & BIT_MASK_BCNCW_MIN_8822C) -+#define BIT_SET_BCNCW_MIN_8822C(x, v) \ -+ (BIT_CLEAR_BCNCW_MIN_8822C(x) | BIT_BCNCW_MIN_8822C(v)) -+ -+#define BIT_SHIFT_BCNIFS_8822C 0 -+#define BIT_MASK_BCNIFS_8822C 0xff -+#define BIT_BCNIFS_8822C(x) \ -+ (((x) & BIT_MASK_BCNIFS_8822C) << BIT_SHIFT_BCNIFS_8822C) -+#define BITS_BCNIFS_8822C (BIT_MASK_BCNIFS_8822C << BIT_SHIFT_BCNIFS_8822C) -+#define BIT_CLEAR_BCNIFS_8822C(x) ((x) & (~BITS_BCNIFS_8822C)) -+#define BIT_GET_BCNIFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNIFS_8822C) & BIT_MASK_BCNIFS_8822C) -+#define BIT_SET_BCNIFS_8822C(x, v) \ -+ (BIT_CLEAR_BCNIFS_8822C(x) | BIT_BCNIFS_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_PIFS_8822C */ -+ -+#define BIT_SHIFT_PIFS_8822C 0 -+#define BIT_MASK_PIFS_8822C 0xff -+#define BIT_PIFS_8822C(x) (((x) & BIT_MASK_PIFS_8822C) << BIT_SHIFT_PIFS_8822C) -+#define BITS_PIFS_8822C (BIT_MASK_PIFS_8822C << BIT_SHIFT_PIFS_8822C) -+#define BIT_CLEAR_PIFS_8822C(x) ((x) & (~BITS_PIFS_8822C)) -+#define BIT_GET_PIFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_PIFS_8822C) & BIT_MASK_PIFS_8822C) -+#define BIT_SET_PIFS_8822C(x, v) (BIT_CLEAR_PIFS_8822C(x) | BIT_PIFS_8822C(v)) -+ -+/* 2 REG_RDG_PIFS_8822C */ -+ -+#define BIT_SHIFT_RDG_PIFS_8822C 0 -+#define BIT_MASK_RDG_PIFS_8822C 0xff -+#define BIT_RDG_PIFS_8822C(x) \ -+ (((x) & BIT_MASK_RDG_PIFS_8822C) << BIT_SHIFT_RDG_PIFS_8822C) -+#define BITS_RDG_PIFS_8822C \ -+ (BIT_MASK_RDG_PIFS_8822C << BIT_SHIFT_RDG_PIFS_8822C) -+#define BIT_CLEAR_RDG_PIFS_8822C(x) ((x) & (~BITS_RDG_PIFS_8822C)) -+#define BIT_GET_RDG_PIFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_RDG_PIFS_8822C) & BIT_MASK_RDG_PIFS_8822C) -+#define BIT_SET_RDG_PIFS_8822C(x, v) \ -+ (BIT_CLEAR_RDG_PIFS_8822C(x) | BIT_RDG_PIFS_8822C(v)) -+ -+/* 2 REG_SIFS_8822C */ -+ -+#define BIT_SHIFT_SIFS_OFDM_TRX_8822C 24 -+#define BIT_MASK_SIFS_OFDM_TRX_8822C 0xff -+#define BIT_SIFS_OFDM_TRX_8822C(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_TRX_8822C) << BIT_SHIFT_SIFS_OFDM_TRX_8822C) -+#define BITS_SIFS_OFDM_TRX_8822C \ -+ (BIT_MASK_SIFS_OFDM_TRX_8822C << BIT_SHIFT_SIFS_OFDM_TRX_8822C) -+#define BIT_CLEAR_SIFS_OFDM_TRX_8822C(x) ((x) & (~BITS_SIFS_OFDM_TRX_8822C)) -+#define BIT_GET_SIFS_OFDM_TRX_8822C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_TRX_8822C) & BIT_MASK_SIFS_OFDM_TRX_8822C) -+#define BIT_SET_SIFS_OFDM_TRX_8822C(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_TRX_8822C(x) | BIT_SIFS_OFDM_TRX_8822C(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_TRX_8822C 16 -+#define BIT_MASK_SIFS_CCK_TRX_8822C 0xff -+#define BIT_SIFS_CCK_TRX_8822C(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_TRX_8822C) << BIT_SHIFT_SIFS_CCK_TRX_8822C) -+#define BITS_SIFS_CCK_TRX_8822C \ -+ (BIT_MASK_SIFS_CCK_TRX_8822C << BIT_SHIFT_SIFS_CCK_TRX_8822C) -+#define BIT_CLEAR_SIFS_CCK_TRX_8822C(x) ((x) & (~BITS_SIFS_CCK_TRX_8822C)) -+#define BIT_GET_SIFS_CCK_TRX_8822C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_TRX_8822C) & BIT_MASK_SIFS_CCK_TRX_8822C) -+#define BIT_SET_SIFS_CCK_TRX_8822C(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_TRX_8822C(x) | BIT_SIFS_CCK_TRX_8822C(v)) -+ -+#define BIT_SHIFT_SIFS_OFDM_CTX_8822C 8 -+#define BIT_MASK_SIFS_OFDM_CTX_8822C 0xff -+#define BIT_SIFS_OFDM_CTX_8822C(x) \ -+ (((x) & BIT_MASK_SIFS_OFDM_CTX_8822C) << BIT_SHIFT_SIFS_OFDM_CTX_8822C) -+#define BITS_SIFS_OFDM_CTX_8822C \ -+ (BIT_MASK_SIFS_OFDM_CTX_8822C << BIT_SHIFT_SIFS_OFDM_CTX_8822C) -+#define BIT_CLEAR_SIFS_OFDM_CTX_8822C(x) ((x) & (~BITS_SIFS_OFDM_CTX_8822C)) -+#define BIT_GET_SIFS_OFDM_CTX_8822C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_OFDM_CTX_8822C) & BIT_MASK_SIFS_OFDM_CTX_8822C) -+#define BIT_SET_SIFS_OFDM_CTX_8822C(x, v) \ -+ (BIT_CLEAR_SIFS_OFDM_CTX_8822C(x) | BIT_SIFS_OFDM_CTX_8822C(v)) -+ -+#define BIT_SHIFT_SIFS_CCK_CTX_8822C 0 -+#define BIT_MASK_SIFS_CCK_CTX_8822C 0xff -+#define BIT_SIFS_CCK_CTX_8822C(x) \ -+ (((x) & BIT_MASK_SIFS_CCK_CTX_8822C) << BIT_SHIFT_SIFS_CCK_CTX_8822C) -+#define BITS_SIFS_CCK_CTX_8822C \ -+ (BIT_MASK_SIFS_CCK_CTX_8822C << BIT_SHIFT_SIFS_CCK_CTX_8822C) -+#define BIT_CLEAR_SIFS_CCK_CTX_8822C(x) ((x) & (~BITS_SIFS_CCK_CTX_8822C)) -+#define BIT_GET_SIFS_CCK_CTX_8822C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_CCK_CTX_8822C) & BIT_MASK_SIFS_CCK_CTX_8822C) -+#define BIT_SET_SIFS_CCK_CTX_8822C(x, v) \ -+ (BIT_CLEAR_SIFS_CCK_CTX_8822C(x) | BIT_SIFS_CCK_CTX_8822C(v)) -+ -+/* 2 REG_TSFTR_SYN_OFFSET_8822C */ -+ -+#define BIT_SHIFT_TSFTR_SNC_OFFSET_8822C 0 -+#define BIT_MASK_TSFTR_SNC_OFFSET_8822C 0xffff -+#define BIT_TSFTR_SNC_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_TSFTR_SNC_OFFSET_8822C) \ -+ << BIT_SHIFT_TSFTR_SNC_OFFSET_8822C) -+#define BITS_TSFTR_SNC_OFFSET_8822C \ -+ (BIT_MASK_TSFTR_SNC_OFFSET_8822C << BIT_SHIFT_TSFTR_SNC_OFFSET_8822C) -+#define BIT_CLEAR_TSFTR_SNC_OFFSET_8822C(x) \ -+ ((x) & (~BITS_TSFTR_SNC_OFFSET_8822C)) -+#define BIT_GET_TSFTR_SNC_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_TSFTR_SNC_OFFSET_8822C) & \ -+ BIT_MASK_TSFTR_SNC_OFFSET_8822C) -+#define BIT_SET_TSFTR_SNC_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_TSFTR_SNC_OFFSET_8822C(x) | BIT_TSFTR_SNC_OFFSET_8822C(v)) -+ -+/* 2 REG_AGGR_BREAK_TIME_8822C */ -+ -+#define BIT_SHIFT_AGGR_BK_TIME_8822C 0 -+#define BIT_MASK_AGGR_BK_TIME_8822C 0xff -+#define BIT_AGGR_BK_TIME_8822C(x) \ -+ (((x) & BIT_MASK_AGGR_BK_TIME_8822C) << BIT_SHIFT_AGGR_BK_TIME_8822C) -+#define BITS_AGGR_BK_TIME_8822C \ -+ (BIT_MASK_AGGR_BK_TIME_8822C << BIT_SHIFT_AGGR_BK_TIME_8822C) -+#define BIT_CLEAR_AGGR_BK_TIME_8822C(x) ((x) & (~BITS_AGGR_BK_TIME_8822C)) -+#define BIT_GET_AGGR_BK_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_AGGR_BK_TIME_8822C) & BIT_MASK_AGGR_BK_TIME_8822C) -+#define BIT_SET_AGGR_BK_TIME_8822C(x, v) \ -+ (BIT_CLEAR_AGGR_BK_TIME_8822C(x) | BIT_AGGR_BK_TIME_8822C(v)) -+ -+/* 2 REG_SLOT_8822C */ -+ -+#define BIT_SHIFT_SLOT_8822C 0 -+#define BIT_MASK_SLOT_8822C 0xff -+#define BIT_SLOT_8822C(x) (((x) & BIT_MASK_SLOT_8822C) << BIT_SHIFT_SLOT_8822C) -+#define BITS_SLOT_8822C (BIT_MASK_SLOT_8822C << BIT_SHIFT_SLOT_8822C) -+#define BIT_CLEAR_SLOT_8822C(x) ((x) & (~BITS_SLOT_8822C)) -+#define BIT_GET_SLOT_8822C(x) \ -+ (((x) >> BIT_SHIFT_SLOT_8822C) & BIT_MASK_SLOT_8822C) -+#define BIT_SET_SLOT_8822C(x, v) (BIT_CLEAR_SLOT_8822C(x) | BIT_SLOT_8822C(v)) -+ -+/* 2 REG_NOA_ON_ERLY_TIME_8822C */ -+ -+#define BIT_SHIFT__NOA_ON_ERLY_TIME_8822C 0 -+#define BIT_MASK__NOA_ON_ERLY_TIME_8822C 0xff -+#define BIT__NOA_ON_ERLY_TIME_8822C(x) \ -+ (((x) & BIT_MASK__NOA_ON_ERLY_TIME_8822C) \ -+ << BIT_SHIFT__NOA_ON_ERLY_TIME_8822C) -+#define BITS__NOA_ON_ERLY_TIME_8822C \ -+ (BIT_MASK__NOA_ON_ERLY_TIME_8822C << BIT_SHIFT__NOA_ON_ERLY_TIME_8822C) -+#define BIT_CLEAR__NOA_ON_ERLY_TIME_8822C(x) \ -+ ((x) & (~BITS__NOA_ON_ERLY_TIME_8822C)) -+#define BIT_GET__NOA_ON_ERLY_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT__NOA_ON_ERLY_TIME_8822C) & \ -+ BIT_MASK__NOA_ON_ERLY_TIME_8822C) -+#define BIT_SET__NOA_ON_ERLY_TIME_8822C(x, v) \ -+ (BIT_CLEAR__NOA_ON_ERLY_TIME_8822C(x) | BIT__NOA_ON_ERLY_TIME_8822C(v)) -+ -+/* 2 REG_NOA_OFF_ERLY_TIME_8822C */ -+ -+#define BIT_SHIFT__NOA_OFF_ERLY_TIME_8822C 0 -+#define BIT_MASK__NOA_OFF_ERLY_TIME_8822C 0xff -+#define BIT__NOA_OFF_ERLY_TIME_8822C(x) \ -+ (((x) & BIT_MASK__NOA_OFF_ERLY_TIME_8822C) \ -+ << BIT_SHIFT__NOA_OFF_ERLY_TIME_8822C) -+#define BITS__NOA_OFF_ERLY_TIME_8822C \ -+ (BIT_MASK__NOA_OFF_ERLY_TIME_8822C \ -+ << BIT_SHIFT__NOA_OFF_ERLY_TIME_8822C) -+#define BIT_CLEAR__NOA_OFF_ERLY_TIME_8822C(x) \ -+ ((x) & (~BITS__NOA_OFF_ERLY_TIME_8822C)) -+#define BIT_GET__NOA_OFF_ERLY_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT__NOA_OFF_ERLY_TIME_8822C) & \ -+ BIT_MASK__NOA_OFF_ERLY_TIME_8822C) -+#define BIT_SET__NOA_OFF_ERLY_TIME_8822C(x, v) \ -+ (BIT_CLEAR__NOA_OFF_ERLY_TIME_8822C(x) | \ -+ BIT__NOA_OFF_ERLY_TIME_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_TX_PTCL_CTRL_8822C */ -+#define BIT_DIS_EDCCA_8822C BIT(15) -+#define BIT_DIS_CCA_8822C BIT(14) -+#define BIT_LSIG_TXOP_TXCMD_NAV_8822C BIT(13) -+#define BIT_SIFS_BK_EN_8822C BIT(12) -+ -+#define BIT_SHIFT_TXQ_NAV_MSK_8822C 8 -+#define BIT_MASK_TXQ_NAV_MSK_8822C 0xf -+#define BIT_TXQ_NAV_MSK_8822C(x) \ -+ (((x) & BIT_MASK_TXQ_NAV_MSK_8822C) << BIT_SHIFT_TXQ_NAV_MSK_8822C) -+#define BITS_TXQ_NAV_MSK_8822C \ -+ (BIT_MASK_TXQ_NAV_MSK_8822C << BIT_SHIFT_TXQ_NAV_MSK_8822C) -+#define BIT_CLEAR_TXQ_NAV_MSK_8822C(x) ((x) & (~BITS_TXQ_NAV_MSK_8822C)) -+#define BIT_GET_TXQ_NAV_MSK_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXQ_NAV_MSK_8822C) & BIT_MASK_TXQ_NAV_MSK_8822C) -+#define BIT_SET_TXQ_NAV_MSK_8822C(x, v) \ -+ (BIT_CLEAR_TXQ_NAV_MSK_8822C(x) | BIT_TXQ_NAV_MSK_8822C(v)) -+ -+#define BIT_DIS_CW_8822C BIT(7) -+#define BIT_NAV_END_TXOP_8822C BIT(6) -+#define BIT_RDG_END_TXOP_8822C BIT(5) -+#define BIT_AC_INBCN_HOLD_8822C BIT(4) -+#define BIT_MGTQ_TXOP_EN_8822C BIT(3) -+#define BIT_MGTQ_RTSMF_EN_8822C BIT(2) -+#define BIT_HIQ_RTSMF_EN_8822C BIT(1) -+#define BIT_BCN_RTSMF_EN_8822C BIT(0) -+ -+/* 2 REG_TXPAUSE_8822C */ -+#define BIT_STOP_BCN_HI_MGT_8822C BIT(7) -+#define BIT_MAC_STOPBCNQ_8822C BIT(6) -+#define BIT_MAC_STOPHIQ_8822C BIT(5) -+#define BIT_MAC_STOPMGQ_8822C BIT(4) -+#define BIT_MAC_STOPBK_8822C BIT(3) -+#define BIT_MAC_STOPBE_8822C BIT(2) -+#define BIT_MAC_STOPVI_8822C BIT(1) -+#define BIT_MAC_STOPVO_8822C BIT(0) -+ -+/* 2 REG_DIS_TXREQ_CLR_8822C */ -+#define BIT_DIS_BT_CCA_8822C BIT(7) -+#define BIT_DIS_TXREQ_CLR_HI_8822C BIT(5) -+#define BIT_DIS_TXREQ_CLR_MGQ_8822C BIT(4) -+#define BIT_DIS_TXREQ_CLR_VO_8822C BIT(3) -+#define BIT_DIS_TXREQ_CLR_VI_8822C BIT(2) -+#define BIT_DIS_TXREQ_CLR_BE_8822C BIT(1) -+#define BIT_DIS_TXREQ_CLR_BK_8822C BIT(0) -+ -+/* 2 REG_RD_CTRL_8822C */ -+#define BIT_EN_CLR_TXREQ_INCCA_8822C BIT(15) -+#define BIT_DIS_TX_OVER_BCNQ_8822C BIT(14) -+#define BIT_EN_BCNERR_INCCCA_8822C BIT(13) -+#define BIT_EDCCA_MSK_CNTDOWN_EN_8822C BIT(11) -+#define BIT_DIS_TXOP_CFE_8822C BIT(10) -+#define BIT_DIS_LSIG_CFE_8822C BIT(9) -+#define BIT_DIS_STBC_CFE_8822C BIT(8) -+#define BIT_BKQ_RD_INIT_EN_8822C BIT(7) -+#define BIT_BEQ_RD_INIT_EN_8822C BIT(6) -+#define BIT_VIQ_RD_INIT_EN_8822C BIT(5) -+#define BIT_VOQ_RD_INIT_EN_8822C BIT(4) -+#define BIT_BKQ_RD_RESP_EN_8822C BIT(3) -+#define BIT_BEQ_RD_RESP_EN_8822C BIT(2) -+#define BIT_VIQ_RD_RESP_EN_8822C BIT(1) -+#define BIT_VOQ_RD_RESP_EN_8822C BIT(0) -+ -+/* 2 REG_MBSSID_CTRL_8822C */ -+#define BIT_MBID_BCNQ7_EN_8822C BIT(7) -+#define BIT_MBID_BCNQ6_EN_8822C BIT(6) -+#define BIT_MBID_BCNQ5_EN_8822C BIT(5) -+#define BIT_MBID_BCNQ4_EN_8822C BIT(4) -+#define BIT_MBID_BCNQ3_EN_8822C BIT(3) -+#define BIT_MBID_BCNQ2_EN_8822C BIT(2) -+#define BIT_MBID_BCNQ1_EN_8822C BIT(1) -+#define BIT_MBID_BCNQ0_EN_8822C BIT(0) -+ -+/* 2 REG_P2PPS_CTRL_8822C */ -+#define BIT_P2P_CTW_ALLSTASLEEP_8822C BIT(7) -+#define BIT_P2P_OFF_DISTX_EN_8822C BIT(6) -+#define BIT_PWR_MGT_EN_8822C BIT(5) -+#define BIT_P2P_NOA1_EN_8822C BIT(2) -+#define BIT_P2P_NOA0_EN_8822C BIT(1) -+ -+/* 2 REG_PKT_LIFETIME_CTRL_8822C */ -+#define BIT_EN_P2P_CTWND1_8822C BIT(23) -+#define BIT_EN_BKF_CLR_TXREQ_8822C BIT(22) -+#define BIT_EN_TSFBIT32_RST_P2P_8822C BIT(21) -+#define BIT_EN_BCN_TX_BTCCA_8822C BIT(20) -+#define BIT_DIS_PKT_TX_ATIM_8822C BIT(19) -+#define BIT_DIS_BCN_DIS_CTN_8822C BIT(18) -+#define BIT_EN_NAVEND_RST_TXOP_8822C BIT(17) -+#define BIT_EN_FILTER_CCA_8822C BIT(16) -+ -+#define BIT_SHIFT_CCA_FILTER_THRS_8822C 8 -+#define BIT_MASK_CCA_FILTER_THRS_8822C 0xff -+#define BIT_CCA_FILTER_THRS_8822C(x) \ -+ (((x) & BIT_MASK_CCA_FILTER_THRS_8822C) \ -+ << BIT_SHIFT_CCA_FILTER_THRS_8822C) -+#define BITS_CCA_FILTER_THRS_8822C \ -+ (BIT_MASK_CCA_FILTER_THRS_8822C << BIT_SHIFT_CCA_FILTER_THRS_8822C) -+#define BIT_CLEAR_CCA_FILTER_THRS_8822C(x) ((x) & (~BITS_CCA_FILTER_THRS_8822C)) -+#define BIT_GET_CCA_FILTER_THRS_8822C(x) \ -+ (((x) >> BIT_SHIFT_CCA_FILTER_THRS_8822C) & \ -+ BIT_MASK_CCA_FILTER_THRS_8822C) -+#define BIT_SET_CCA_FILTER_THRS_8822C(x, v) \ -+ (BIT_CLEAR_CCA_FILTER_THRS_8822C(x) | BIT_CCA_FILTER_THRS_8822C(v)) -+ -+#define BIT_SHIFT_EDCCA_THRS_8822C 0 -+#define BIT_MASK_EDCCA_THRS_8822C 0xff -+#define BIT_EDCCA_THRS_8822C(x) \ -+ (((x) & BIT_MASK_EDCCA_THRS_8822C) << BIT_SHIFT_EDCCA_THRS_8822C) -+#define BITS_EDCCA_THRS_8822C \ -+ (BIT_MASK_EDCCA_THRS_8822C << BIT_SHIFT_EDCCA_THRS_8822C) -+#define BIT_CLEAR_EDCCA_THRS_8822C(x) ((x) & (~BITS_EDCCA_THRS_8822C)) -+#define BIT_GET_EDCCA_THRS_8822C(x) \ -+ (((x) >> BIT_SHIFT_EDCCA_THRS_8822C) & BIT_MASK_EDCCA_THRS_8822C) -+#define BIT_SET_EDCCA_THRS_8822C(x, v) \ -+ (BIT_CLEAR_EDCCA_THRS_8822C(x) | BIT_EDCCA_THRS_8822C(v)) -+ -+/* 2 REG_P2PPS_SPEC_STATE_8822C */ -+#define BIT_SPEC_POWER_STATE_8822C BIT(7) -+#define BIT_SPEC_CTWINDOW_ON_8822C BIT(6) -+#define BIT_SPEC_BEACON_AREA_ON_8822C BIT(5) -+#define BIT_SPEC_CTWIN_EARLY_DISTX_8822C BIT(4) -+#define BIT_SPEC_NOA1_OFF_PERIOD_8822C BIT(3) -+#define BIT_SPEC_FORCE_DOZE1_8822C BIT(2) -+#define BIT_SPEC_NOA0_OFF_PERIOD_8822C BIT(1) -+#define BIT_SPEC_FORCE_DOZE0_8822C BIT(0) -+ -+/* 2 REG_TXOP_LIMIT_CTRL_8822C */ -+ -+#define BIT_SHIFT_TXOP_TBTT_CNT_8822C 24 -+#define BIT_MASK_TXOP_TBTT_CNT_8822C 0xff -+#define BIT_TXOP_TBTT_CNT_8822C(x) \ -+ (((x) & BIT_MASK_TXOP_TBTT_CNT_8822C) << BIT_SHIFT_TXOP_TBTT_CNT_8822C) -+#define BITS_TXOP_TBTT_CNT_8822C \ -+ (BIT_MASK_TXOP_TBTT_CNT_8822C << BIT_SHIFT_TXOP_TBTT_CNT_8822C) -+#define BIT_CLEAR_TXOP_TBTT_CNT_8822C(x) ((x) & (~BITS_TXOP_TBTT_CNT_8822C)) -+#define BIT_GET_TXOP_TBTT_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXOP_TBTT_CNT_8822C) & BIT_MASK_TXOP_TBTT_CNT_8822C) -+#define BIT_SET_TXOP_TBTT_CNT_8822C(x, v) \ -+ (BIT_CLEAR_TXOP_TBTT_CNT_8822C(x) | BIT_TXOP_TBTT_CNT_8822C(v)) -+ -+#define BIT_SHIFT_TXOP_TBTT_CNT_SEL_8822C 20 -+#define BIT_MASK_TXOP_TBTT_CNT_SEL_8822C 0xf -+#define BIT_TXOP_TBTT_CNT_SEL_8822C(x) \ -+ (((x) & BIT_MASK_TXOP_TBTT_CNT_SEL_8822C) \ -+ << BIT_SHIFT_TXOP_TBTT_CNT_SEL_8822C) -+#define BITS_TXOP_TBTT_CNT_SEL_8822C \ -+ (BIT_MASK_TXOP_TBTT_CNT_SEL_8822C << BIT_SHIFT_TXOP_TBTT_CNT_SEL_8822C) -+#define BIT_CLEAR_TXOP_TBTT_CNT_SEL_8822C(x) \ -+ ((x) & (~BITS_TXOP_TBTT_CNT_SEL_8822C)) -+#define BIT_GET_TXOP_TBTT_CNT_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXOP_TBTT_CNT_SEL_8822C) & \ -+ BIT_MASK_TXOP_TBTT_CNT_SEL_8822C) -+#define BIT_SET_TXOP_TBTT_CNT_SEL_8822C(x, v) \ -+ (BIT_CLEAR_TXOP_TBTT_CNT_SEL_8822C(x) | BIT_TXOP_TBTT_CNT_SEL_8822C(v)) -+ -+#define BIT_SHIFT_TXOP_LMT_EN_8822C 16 -+#define BIT_MASK_TXOP_LMT_EN_8822C 0xf -+#define BIT_TXOP_LMT_EN_8822C(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_EN_8822C) << BIT_SHIFT_TXOP_LMT_EN_8822C) -+#define BITS_TXOP_LMT_EN_8822C \ -+ (BIT_MASK_TXOP_LMT_EN_8822C << BIT_SHIFT_TXOP_LMT_EN_8822C) -+#define BIT_CLEAR_TXOP_LMT_EN_8822C(x) ((x) & (~BITS_TXOP_LMT_EN_8822C)) -+#define BIT_GET_TXOP_LMT_EN_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_EN_8822C) & BIT_MASK_TXOP_LMT_EN_8822C) -+#define BIT_SET_TXOP_LMT_EN_8822C(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_EN_8822C(x) | BIT_TXOP_LMT_EN_8822C(v)) -+ -+#define BIT_SHIFT_TXOP_LMT_TX_TIME_8822C 8 -+#define BIT_MASK_TXOP_LMT_TX_TIME_8822C 0xff -+#define BIT_TXOP_LMT_TX_TIME_8822C(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_TX_TIME_8822C) \ -+ << BIT_SHIFT_TXOP_LMT_TX_TIME_8822C) -+#define BITS_TXOP_LMT_TX_TIME_8822C \ -+ (BIT_MASK_TXOP_LMT_TX_TIME_8822C << BIT_SHIFT_TXOP_LMT_TX_TIME_8822C) -+#define BIT_CLEAR_TXOP_LMT_TX_TIME_8822C(x) \ -+ ((x) & (~BITS_TXOP_LMT_TX_TIME_8822C)) -+#define BIT_GET_TXOP_LMT_TX_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_TX_TIME_8822C) & \ -+ BIT_MASK_TXOP_LMT_TX_TIME_8822C) -+#define BIT_SET_TXOP_LMT_TX_TIME_8822C(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_TX_TIME_8822C(x) | BIT_TXOP_LMT_TX_TIME_8822C(v)) -+ -+#define BIT_TXOP_CNT_TRIGGER_RESET_8822C BIT(7) -+ -+#define BIT_SHIFT_TXOP_LMT_PKT_NUM_8822C 0 -+#define BIT_MASK_TXOP_LMT_PKT_NUM_8822C 0x3f -+#define BIT_TXOP_LMT_PKT_NUM_8822C(x) \ -+ (((x) & BIT_MASK_TXOP_LMT_PKT_NUM_8822C) \ -+ << BIT_SHIFT_TXOP_LMT_PKT_NUM_8822C) -+#define BITS_TXOP_LMT_PKT_NUM_8822C \ -+ (BIT_MASK_TXOP_LMT_PKT_NUM_8822C << BIT_SHIFT_TXOP_LMT_PKT_NUM_8822C) -+#define BIT_CLEAR_TXOP_LMT_PKT_NUM_8822C(x) \ -+ ((x) & (~BITS_TXOP_LMT_PKT_NUM_8822C)) -+#define BIT_GET_TXOP_LMT_PKT_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXOP_LMT_PKT_NUM_8822C) & \ -+ BIT_MASK_TXOP_LMT_PKT_NUM_8822C) -+#define BIT_SET_TXOP_LMT_PKT_NUM_8822C(x, v) \ -+ (BIT_CLEAR_TXOP_LMT_PKT_NUM_8822C(x) | BIT_TXOP_LMT_PKT_NUM_8822C(v)) -+ -+/* 2 REG_BAR_TX_CTRL_8822C */ -+ -+/* 2 REG_P2PON_DIS_TXTIME_8822C */ -+ -+#define BIT_SHIFT_P2PON_DIS_TXTIME_8822C 0 -+#define BIT_MASK_P2PON_DIS_TXTIME_8822C 0xff -+#define BIT_P2PON_DIS_TXTIME_8822C(x) \ -+ (((x) & BIT_MASK_P2PON_DIS_TXTIME_8822C) \ -+ << BIT_SHIFT_P2PON_DIS_TXTIME_8822C) -+#define BITS_P2PON_DIS_TXTIME_8822C \ -+ (BIT_MASK_P2PON_DIS_TXTIME_8822C << BIT_SHIFT_P2PON_DIS_TXTIME_8822C) -+#define BIT_CLEAR_P2PON_DIS_TXTIME_8822C(x) \ -+ ((x) & (~BITS_P2PON_DIS_TXTIME_8822C)) -+#define BIT_GET_P2PON_DIS_TXTIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_P2PON_DIS_TXTIME_8822C) & \ -+ BIT_MASK_P2PON_DIS_TXTIME_8822C) -+#define BIT_SET_P2PON_DIS_TXTIME_8822C(x, v) \ -+ (BIT_CLEAR_P2PON_DIS_TXTIME_8822C(x) | BIT_P2PON_DIS_TXTIME_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_CCA_TXEN_CNT_8822C */ -+#define BIT_ENABLE_STOP_UPDATE_NAV_8822C BIT(21) -+#define BIT_ENABLE_GEN_RANDON_SLOT_TX_8822C BIT(20) -+#define BIT_ENABLE_RANDOM_SHIFT_TX_8822C BIT(19) -+#define BIT_ENABLE_EDCA_REF_FUNCTION_8822C BIT(18) -+#define BIT_CCA_TXEN_CNT_SWITCH_8822C BIT(17) -+#define BIT_CCA_TXEN_CNT_EN_8822C BIT(16) -+ -+#define BIT_SHIFT_CCA_TXEN_BIG_CNT_8822C 8 -+#define BIT_MASK_CCA_TXEN_BIG_CNT_8822C 0xff -+#define BIT_CCA_TXEN_BIG_CNT_8822C(x) \ -+ (((x) & BIT_MASK_CCA_TXEN_BIG_CNT_8822C) \ -+ << BIT_SHIFT_CCA_TXEN_BIG_CNT_8822C) -+#define BITS_CCA_TXEN_BIG_CNT_8822C \ -+ (BIT_MASK_CCA_TXEN_BIG_CNT_8822C << BIT_SHIFT_CCA_TXEN_BIG_CNT_8822C) -+#define BIT_CLEAR_CCA_TXEN_BIG_CNT_8822C(x) \ -+ ((x) & (~BITS_CCA_TXEN_BIG_CNT_8822C)) -+#define BIT_GET_CCA_TXEN_BIG_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_CCA_TXEN_BIG_CNT_8822C) & \ -+ BIT_MASK_CCA_TXEN_BIG_CNT_8822C) -+#define BIT_SET_CCA_TXEN_BIG_CNT_8822C(x, v) \ -+ (BIT_CLEAR_CCA_TXEN_BIG_CNT_8822C(x) | BIT_CCA_TXEN_BIG_CNT_8822C(v)) -+ -+#define BIT_SHIFT_CCA_TXEN_SMALL_CNT_8822C 0 -+#define BIT_MASK_CCA_TXEN_SMALL_CNT_8822C 0xff -+#define BIT_CCA_TXEN_SMALL_CNT_8822C(x) \ -+ (((x) & BIT_MASK_CCA_TXEN_SMALL_CNT_8822C) \ -+ << BIT_SHIFT_CCA_TXEN_SMALL_CNT_8822C) -+#define BITS_CCA_TXEN_SMALL_CNT_8822C \ -+ (BIT_MASK_CCA_TXEN_SMALL_CNT_8822C \ -+ << BIT_SHIFT_CCA_TXEN_SMALL_CNT_8822C) -+#define BIT_CLEAR_CCA_TXEN_SMALL_CNT_8822C(x) \ -+ ((x) & (~BITS_CCA_TXEN_SMALL_CNT_8822C)) -+#define BIT_GET_CCA_TXEN_SMALL_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_CCA_TXEN_SMALL_CNT_8822C) & \ -+ BIT_MASK_CCA_TXEN_SMALL_CNT_8822C) -+#define BIT_SET_CCA_TXEN_SMALL_CNT_8822C(x, v) \ -+ (BIT_CLEAR_CCA_TXEN_SMALL_CNT_8822C(x) | \ -+ BIT_CCA_TXEN_SMALL_CNT_8822C(v)) -+ -+/* 2 REG_MAX_INTER_COLLISION_8822C */ -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_BK_8822C 24 -+#define BIT_MASK_MAX_INTER_COLLISION_BK_8822C 0xff -+#define BIT_MAX_INTER_COLLISION_BK_8822C(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_BK_8822C) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BK_8822C) -+#define BITS_MAX_INTER_COLLISION_BK_8822C \ -+ (BIT_MASK_MAX_INTER_COLLISION_BK_8822C \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BK_8822C) -+#define BIT_CLEAR_MAX_INTER_COLLISION_BK_8822C(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_BK_8822C)) -+#define BIT_GET_MAX_INTER_COLLISION_BK_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_BK_8822C) & \ -+ BIT_MASK_MAX_INTER_COLLISION_BK_8822C) -+#define BIT_SET_MAX_INTER_COLLISION_BK_8822C(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_BK_8822C(x) | \ -+ BIT_MAX_INTER_COLLISION_BK_8822C(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_BE_8822C 16 -+#define BIT_MASK_MAX_INTER_COLLISION_BE_8822C 0xff -+#define BIT_MAX_INTER_COLLISION_BE_8822C(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_BE_8822C) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BE_8822C) -+#define BITS_MAX_INTER_COLLISION_BE_8822C \ -+ (BIT_MASK_MAX_INTER_COLLISION_BE_8822C \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_BE_8822C) -+#define BIT_CLEAR_MAX_INTER_COLLISION_BE_8822C(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_BE_8822C)) -+#define BIT_GET_MAX_INTER_COLLISION_BE_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_BE_8822C) & \ -+ BIT_MASK_MAX_INTER_COLLISION_BE_8822C) -+#define BIT_SET_MAX_INTER_COLLISION_BE_8822C(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_BE_8822C(x) | \ -+ BIT_MAX_INTER_COLLISION_BE_8822C(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_VI_8822C 8 -+#define BIT_MASK_MAX_INTER_COLLISION_VI_8822C 0xff -+#define BIT_MAX_INTER_COLLISION_VI_8822C(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_VI_8822C) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VI_8822C) -+#define BITS_MAX_INTER_COLLISION_VI_8822C \ -+ (BIT_MASK_MAX_INTER_COLLISION_VI_8822C \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VI_8822C) -+#define BIT_CLEAR_MAX_INTER_COLLISION_VI_8822C(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_VI_8822C)) -+#define BIT_GET_MAX_INTER_COLLISION_VI_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_VI_8822C) & \ -+ BIT_MASK_MAX_INTER_COLLISION_VI_8822C) -+#define BIT_SET_MAX_INTER_COLLISION_VI_8822C(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_VI_8822C(x) | \ -+ BIT_MAX_INTER_COLLISION_VI_8822C(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_VO_8822C 0 -+#define BIT_MASK_MAX_INTER_COLLISION_VO_8822C 0xff -+#define BIT_MAX_INTER_COLLISION_VO_8822C(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_VO_8822C) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VO_8822C) -+#define BITS_MAX_INTER_COLLISION_VO_8822C \ -+ (BIT_MASK_MAX_INTER_COLLISION_VO_8822C \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_VO_8822C) -+#define BIT_CLEAR_MAX_INTER_COLLISION_VO_8822C(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_VO_8822C)) -+#define BIT_GET_MAX_INTER_COLLISION_VO_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_VO_8822C) & \ -+ BIT_MASK_MAX_INTER_COLLISION_VO_8822C) -+#define BIT_SET_MAX_INTER_COLLISION_VO_8822C(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_VO_8822C(x) | \ -+ BIT_MAX_INTER_COLLISION_VO_8822C(v)) -+ -+/* 2 REG_MAX_INTER_COLLISION_CNT_8822C */ -+#define BIT_MAX_INTER_COLLISION_EN_8822C BIT(16) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8822C 12 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8822C 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_BK_8822C(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8822C) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8822C) -+#define BITS_MAX_INTER_COLLISION_CNT_BK_8822C \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8822C \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8822C) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_BK_8822C(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_BK_8822C)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_BK_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_BK_8822C) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_BK_8822C) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_BK_8822C(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_BK_8822C(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_BK_8822C(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8822C 8 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8822C 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_BE_8822C(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8822C) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8822C) -+#define BITS_MAX_INTER_COLLISION_CNT_BE_8822C \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8822C \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8822C) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_BE_8822C(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_BE_8822C)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_BE_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_BE_8822C) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_BE_8822C) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_BE_8822C(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_BE_8822C(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_BE_8822C(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8822C 4 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8822C 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_VI_8822C(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8822C) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8822C) -+#define BITS_MAX_INTER_COLLISION_CNT_VI_8822C \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8822C \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8822C) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_VI_8822C(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_VI_8822C)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_VI_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_VI_8822C) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_VI_8822C) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_VI_8822C(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_VI_8822C(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_VI_8822C(v)) -+ -+#define BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8822C 0 -+#define BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8822C 0xf -+#define BIT_MAX_INTER_COLLISION_CNT_VO_8822C(x) \ -+ (((x) & BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8822C) \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8822C) -+#define BITS_MAX_INTER_COLLISION_CNT_VO_8822C \ -+ (BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8822C \ -+ << BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8822C) -+#define BIT_CLEAR_MAX_INTER_COLLISION_CNT_VO_8822C(x) \ -+ ((x) & (~BITS_MAX_INTER_COLLISION_CNT_VO_8822C)) -+#define BIT_GET_MAX_INTER_COLLISION_CNT_VO_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAX_INTER_COLLISION_CNT_VO_8822C) & \ -+ BIT_MASK_MAX_INTER_COLLISION_CNT_VO_8822C) -+#define BIT_SET_MAX_INTER_COLLISION_CNT_VO_8822C(x, v) \ -+ (BIT_CLEAR_MAX_INTER_COLLISION_CNT_VO_8822C(x) | \ -+ BIT_MAX_INTER_COLLISION_CNT_VO_8822C(v)) -+ -+/* 2 REG_TBTT_PROHIBIT_8822C */ -+ -+#define BIT_SHIFT_TBTT_HOLD_TIME_AP_8822C 8 -+#define BIT_MASK_TBTT_HOLD_TIME_AP_8822C 0xfff -+#define BIT_TBTT_HOLD_TIME_AP_8822C(x) \ -+ (((x) & BIT_MASK_TBTT_HOLD_TIME_AP_8822C) \ -+ << BIT_SHIFT_TBTT_HOLD_TIME_AP_8822C) -+#define BITS_TBTT_HOLD_TIME_AP_8822C \ -+ (BIT_MASK_TBTT_HOLD_TIME_AP_8822C << BIT_SHIFT_TBTT_HOLD_TIME_AP_8822C) -+#define BIT_CLEAR_TBTT_HOLD_TIME_AP_8822C(x) \ -+ ((x) & (~BITS_TBTT_HOLD_TIME_AP_8822C)) -+#define BIT_GET_TBTT_HOLD_TIME_AP_8822C(x) \ -+ (((x) >> BIT_SHIFT_TBTT_HOLD_TIME_AP_8822C) & \ -+ BIT_MASK_TBTT_HOLD_TIME_AP_8822C) -+#define BIT_SET_TBTT_HOLD_TIME_AP_8822C(x, v) \ -+ (BIT_CLEAR_TBTT_HOLD_TIME_AP_8822C(x) | BIT_TBTT_HOLD_TIME_AP_8822C(v)) -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_SETUP_8822C 0 -+#define BIT_MASK_TBTT_PROHIBIT_SETUP_8822C 0xf -+#define BIT_TBTT_PROHIBIT_SETUP_8822C(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_SETUP_8822C) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8822C) -+#define BITS_TBTT_PROHIBIT_SETUP_8822C \ -+ (BIT_MASK_TBTT_PROHIBIT_SETUP_8822C \ -+ << BIT_SHIFT_TBTT_PROHIBIT_SETUP_8822C) -+#define BIT_CLEAR_TBTT_PROHIBIT_SETUP_8822C(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_SETUP_8822C)) -+#define BIT_GET_TBTT_PROHIBIT_SETUP_8822C(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_SETUP_8822C) & \ -+ BIT_MASK_TBTT_PROHIBIT_SETUP_8822C) -+#define BIT_SET_TBTT_PROHIBIT_SETUP_8822C(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_SETUP_8822C(x) | \ -+ BIT_TBTT_PROHIBIT_SETUP_8822C(v)) -+ -+/* 2 REG_P2PPS_STATE_8822C */ -+#define BIT_POWER_STATE_8822C BIT(7) -+#define BIT_CTWINDOW_ON_8822C BIT(6) -+#define BIT_BEACON_AREA_ON_8822C BIT(5) -+#define BIT_CTWIN_EARLY_DISTX_8822C BIT(4) -+#define BIT_NOA1_OFF_PERIOD_8822C BIT(3) -+#define BIT_FORCE_DOZE1_8822C BIT(2) -+#define BIT_NOA0_OFF_PERIOD_8822C BIT(1) -+#define BIT_FORCE_DOZE0_8822C BIT(0) -+ -+/* 2 REG_RD_NAV_NXT_8822C */ -+ -+#define BIT_SHIFT_RD_NAV_PROT_NXT_8822C 0 -+#define BIT_MASK_RD_NAV_PROT_NXT_8822C 0xffff -+#define BIT_RD_NAV_PROT_NXT_8822C(x) \ -+ (((x) & BIT_MASK_RD_NAV_PROT_NXT_8822C) \ -+ << BIT_SHIFT_RD_NAV_PROT_NXT_8822C) -+#define BITS_RD_NAV_PROT_NXT_8822C \ -+ (BIT_MASK_RD_NAV_PROT_NXT_8822C << BIT_SHIFT_RD_NAV_PROT_NXT_8822C) -+#define BIT_CLEAR_RD_NAV_PROT_NXT_8822C(x) ((x) & (~BITS_RD_NAV_PROT_NXT_8822C)) -+#define BIT_GET_RD_NAV_PROT_NXT_8822C(x) \ -+ (((x) >> BIT_SHIFT_RD_NAV_PROT_NXT_8822C) & \ -+ BIT_MASK_RD_NAV_PROT_NXT_8822C) -+#define BIT_SET_RD_NAV_PROT_NXT_8822C(x, v) \ -+ (BIT_CLEAR_RD_NAV_PROT_NXT_8822C(x) | BIT_RD_NAV_PROT_NXT_8822C(v)) -+ -+/* 2 REG_NAV_PROT_LEN_8822C */ -+ -+#define BIT_SHIFT_NAV_PROT_LEN_8822C 0 -+#define BIT_MASK_NAV_PROT_LEN_8822C 0xffff -+#define BIT_NAV_PROT_LEN_8822C(x) \ -+ (((x) & BIT_MASK_NAV_PROT_LEN_8822C) << BIT_SHIFT_NAV_PROT_LEN_8822C) -+#define BITS_NAV_PROT_LEN_8822C \ -+ (BIT_MASK_NAV_PROT_LEN_8822C << BIT_SHIFT_NAV_PROT_LEN_8822C) -+#define BIT_CLEAR_NAV_PROT_LEN_8822C(x) ((x) & (~BITS_NAV_PROT_LEN_8822C)) -+#define BIT_GET_NAV_PROT_LEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_NAV_PROT_LEN_8822C) & BIT_MASK_NAV_PROT_LEN_8822C) -+#define BIT_SET_NAV_PROT_LEN_8822C(x, v) \ -+ (BIT_CLEAR_NAV_PROT_LEN_8822C(x) | BIT_NAV_PROT_LEN_8822C(v)) -+ -+/* 2 REG_FTM_PTT_8822C */ -+ -+#define BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8822C 22 -+#define BIT_MASK_FTM_PTT_TSF_R2T_SEL_8822C 0x7 -+#define BIT_FTM_PTT_TSF_R2T_SEL_8822C(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_R2T_SEL_8822C) \ -+ << BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8822C) -+#define BITS_FTM_PTT_TSF_R2T_SEL_8822C \ -+ (BIT_MASK_FTM_PTT_TSF_R2T_SEL_8822C \ -+ << BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8822C) -+#define BIT_CLEAR_FTM_PTT_TSF_R2T_SEL_8822C(x) \ -+ ((x) & (~BITS_FTM_PTT_TSF_R2T_SEL_8822C)) -+#define BIT_GET_FTM_PTT_TSF_R2T_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_R2T_SEL_8822C) & \ -+ BIT_MASK_FTM_PTT_TSF_R2T_SEL_8822C) -+#define BIT_SET_FTM_PTT_TSF_R2T_SEL_8822C(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_R2T_SEL_8822C(x) | \ -+ BIT_FTM_PTT_TSF_R2T_SEL_8822C(v)) -+ -+#define BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8822C 19 -+#define BIT_MASK_FTM_PTT_TSF_T2R_SEL_8822C 0x7 -+#define BIT_FTM_PTT_TSF_T2R_SEL_8822C(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_T2R_SEL_8822C) \ -+ << BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8822C) -+#define BITS_FTM_PTT_TSF_T2R_SEL_8822C \ -+ (BIT_MASK_FTM_PTT_TSF_T2R_SEL_8822C \ -+ << BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8822C) -+#define BIT_CLEAR_FTM_PTT_TSF_T2R_SEL_8822C(x) \ -+ ((x) & (~BITS_FTM_PTT_TSF_T2R_SEL_8822C)) -+#define BIT_GET_FTM_PTT_TSF_T2R_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_T2R_SEL_8822C) & \ -+ BIT_MASK_FTM_PTT_TSF_T2R_SEL_8822C) -+#define BIT_SET_FTM_PTT_TSF_T2R_SEL_8822C(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_T2R_SEL_8822C(x) | \ -+ BIT_FTM_PTT_TSF_T2R_SEL_8822C(v)) -+ -+#define BIT_SHIFT_FTM_PTT_TSF_SEL_8822C 16 -+#define BIT_MASK_FTM_PTT_TSF_SEL_8822C 0x7 -+#define BIT_FTM_PTT_TSF_SEL_8822C(x) \ -+ (((x) & BIT_MASK_FTM_PTT_TSF_SEL_8822C) \ -+ << BIT_SHIFT_FTM_PTT_TSF_SEL_8822C) -+#define BITS_FTM_PTT_TSF_SEL_8822C \ -+ (BIT_MASK_FTM_PTT_TSF_SEL_8822C << BIT_SHIFT_FTM_PTT_TSF_SEL_8822C) -+#define BIT_CLEAR_FTM_PTT_TSF_SEL_8822C(x) ((x) & (~BITS_FTM_PTT_TSF_SEL_8822C)) -+#define BIT_GET_FTM_PTT_TSF_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_TSF_SEL_8822C) & \ -+ BIT_MASK_FTM_PTT_TSF_SEL_8822C) -+#define BIT_SET_FTM_PTT_TSF_SEL_8822C(x, v) \ -+ (BIT_CLEAR_FTM_PTT_TSF_SEL_8822C(x) | BIT_FTM_PTT_TSF_SEL_8822C(v)) -+ -+#define BIT_SHIFT_FTM_PTT_VALUE_8822C 0 -+#define BIT_MASK_FTM_PTT_VALUE_8822C 0xffff -+#define BIT_FTM_PTT_VALUE_8822C(x) \ -+ (((x) & BIT_MASK_FTM_PTT_VALUE_8822C) << BIT_SHIFT_FTM_PTT_VALUE_8822C) -+#define BITS_FTM_PTT_VALUE_8822C \ -+ (BIT_MASK_FTM_PTT_VALUE_8822C << BIT_SHIFT_FTM_PTT_VALUE_8822C) -+#define BIT_CLEAR_FTM_PTT_VALUE_8822C(x) ((x) & (~BITS_FTM_PTT_VALUE_8822C)) -+#define BIT_GET_FTM_PTT_VALUE_8822C(x) \ -+ (((x) >> BIT_SHIFT_FTM_PTT_VALUE_8822C) & BIT_MASK_FTM_PTT_VALUE_8822C) -+#define BIT_SET_FTM_PTT_VALUE_8822C(x, v) \ -+ (BIT_CLEAR_FTM_PTT_VALUE_8822C(x) | BIT_FTM_PTT_VALUE_8822C(v)) -+ -+/* 2 REG_FTM_TSF_8822C */ -+ -+#define BIT_SHIFT_FTM_T2_TSF_8822C 16 -+#define BIT_MASK_FTM_T2_TSF_8822C 0xffff -+#define BIT_FTM_T2_TSF_8822C(x) \ -+ (((x) & BIT_MASK_FTM_T2_TSF_8822C) << BIT_SHIFT_FTM_T2_TSF_8822C) -+#define BITS_FTM_T2_TSF_8822C \ -+ (BIT_MASK_FTM_T2_TSF_8822C << BIT_SHIFT_FTM_T2_TSF_8822C) -+#define BIT_CLEAR_FTM_T2_TSF_8822C(x) ((x) & (~BITS_FTM_T2_TSF_8822C)) -+#define BIT_GET_FTM_T2_TSF_8822C(x) \ -+ (((x) >> BIT_SHIFT_FTM_T2_TSF_8822C) & BIT_MASK_FTM_T2_TSF_8822C) -+#define BIT_SET_FTM_T2_TSF_8822C(x, v) \ -+ (BIT_CLEAR_FTM_T2_TSF_8822C(x) | BIT_FTM_T2_TSF_8822C(v)) -+ -+#define BIT_SHIFT_FTM_T1_TSF_8822C 0 -+#define BIT_MASK_FTM_T1_TSF_8822C 0xffff -+#define BIT_FTM_T1_TSF_8822C(x) \ -+ (((x) & BIT_MASK_FTM_T1_TSF_8822C) << BIT_SHIFT_FTM_T1_TSF_8822C) -+#define BITS_FTM_T1_TSF_8822C \ -+ (BIT_MASK_FTM_T1_TSF_8822C << BIT_SHIFT_FTM_T1_TSF_8822C) -+#define BIT_CLEAR_FTM_T1_TSF_8822C(x) ((x) & (~BITS_FTM_T1_TSF_8822C)) -+#define BIT_GET_FTM_T1_TSF_8822C(x) \ -+ (((x) >> BIT_SHIFT_FTM_T1_TSF_8822C) & BIT_MASK_FTM_T1_TSF_8822C) -+#define BIT_SET_FTM_T1_TSF_8822C(x, v) \ -+ (BIT_CLEAR_FTM_T1_TSF_8822C(x) | BIT_FTM_T1_TSF_8822C(v)) -+ -+/* 2 REG_BCN_CTRL_8822C */ -+#define BIT_DIS_RX_BSSID_FIT_8822C BIT(6) -+#define BIT_P0_EN_TXBCN_RPT_8822C BIT(5) -+#define BIT_DIS_TSF_UDT_8822C BIT(4) -+#define BIT_EN_BCN_FUNCTION_8822C BIT(3) -+#define BIT_P0_EN_RXBCN_RPT_8822C BIT(2) -+#define BIT_EN_P2P_CTWINDOW_8822C BIT(1) -+#define BIT_EN_P2P_BCNQ_AREA_8822C BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT0_8822C */ -+#define BIT_CLI0_DIS_RX_BSSID_FIT_8822C BIT(6) -+#define BIT_CLI0_DIS_TSF_UDT_8822C BIT(4) -+#define BIT_CLI0_EN_BCN_FUNCTION_8822C BIT(3) -+#define BIT_CLI0_EN_RXBCN_RPT_8822C BIT(2) -+#define BIT_CLI0_ENP2P_CTWINDOW_8822C BIT(1) -+#define BIT_CLI0_ENP2P_BCNQ_AREA_8822C BIT(0) -+ -+/* 2 REG_MBID_NUM_8822C */ -+#define BIT_EN_PRE_DL_BEACON_8822C BIT(3) -+ -+#define BIT_SHIFT_MBID_BCN_NUM_8822C 0 -+#define BIT_MASK_MBID_BCN_NUM_8822C 0x7 -+#define BIT_MBID_BCN_NUM_8822C(x) \ -+ (((x) & BIT_MASK_MBID_BCN_NUM_8822C) << BIT_SHIFT_MBID_BCN_NUM_8822C) -+#define BITS_MBID_BCN_NUM_8822C \ -+ (BIT_MASK_MBID_BCN_NUM_8822C << BIT_SHIFT_MBID_BCN_NUM_8822C) -+#define BIT_CLEAR_MBID_BCN_NUM_8822C(x) ((x) & (~BITS_MBID_BCN_NUM_8822C)) -+#define BIT_GET_MBID_BCN_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_MBID_BCN_NUM_8822C) & BIT_MASK_MBID_BCN_NUM_8822C) -+#define BIT_SET_MBID_BCN_NUM_8822C(x, v) \ -+ (BIT_CLEAR_MBID_BCN_NUM_8822C(x) | BIT_MBID_BCN_NUM_8822C(v)) -+ -+/* 2 REG_DUAL_TSF_RST_8822C */ -+#define BIT_FREECNT_RST_8822C BIT(5) -+#define BIT_TSFTR_CLI3_RST_8822C BIT(4) -+#define BIT_TSFTR_CLI2_RST_8822C BIT(3) -+#define BIT_TSFTR_CLI1_RST_8822C BIT(2) -+#define BIT_TSFTR_CLI0_RST_8822C BIT(1) -+#define BIT_TSFTR_RST_8822C BIT(0) -+ -+/* 2 REG_MBSSID_BCN_SPACE_8822C */ -+ -+#define BIT_SHIFT_BCN_TIMER_SEL_FWRD_8822C 28 -+#define BIT_MASK_BCN_TIMER_SEL_FWRD_8822C 0x7 -+#define BIT_BCN_TIMER_SEL_FWRD_8822C(x) \ -+ (((x) & BIT_MASK_BCN_TIMER_SEL_FWRD_8822C) \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_8822C) -+#define BITS_BCN_TIMER_SEL_FWRD_8822C \ -+ (BIT_MASK_BCN_TIMER_SEL_FWRD_8822C \ -+ << BIT_SHIFT_BCN_TIMER_SEL_FWRD_8822C) -+#define BIT_CLEAR_BCN_TIMER_SEL_FWRD_8822C(x) \ -+ ((x) & (~BITS_BCN_TIMER_SEL_FWRD_8822C)) -+#define BIT_GET_BCN_TIMER_SEL_FWRD_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCN_TIMER_SEL_FWRD_8822C) & \ -+ BIT_MASK_BCN_TIMER_SEL_FWRD_8822C) -+#define BIT_SET_BCN_TIMER_SEL_FWRD_8822C(x, v) \ -+ (BIT_CLEAR_BCN_TIMER_SEL_FWRD_8822C(x) | \ -+ BIT_BCN_TIMER_SEL_FWRD_8822C(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT0_8822C 16 -+#define BIT_MASK_BCN_SPACE_CLINT0_8822C 0xfff -+#define BIT_BCN_SPACE_CLINT0_8822C(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT0_8822C) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT0_8822C) -+#define BITS_BCN_SPACE_CLINT0_8822C \ -+ (BIT_MASK_BCN_SPACE_CLINT0_8822C << BIT_SHIFT_BCN_SPACE_CLINT0_8822C) -+#define BIT_CLEAR_BCN_SPACE_CLINT0_8822C(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT0_8822C)) -+#define BIT_GET_BCN_SPACE_CLINT0_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT0_8822C) & \ -+ BIT_MASK_BCN_SPACE_CLINT0_8822C) -+#define BIT_SET_BCN_SPACE_CLINT0_8822C(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT0_8822C(x) | BIT_BCN_SPACE_CLINT0_8822C(v)) -+ -+#define BIT_SHIFT_BCN_SPACE0_8822C 0 -+#define BIT_MASK_BCN_SPACE0_8822C 0xffff -+#define BIT_BCN_SPACE0_8822C(x) \ -+ (((x) & BIT_MASK_BCN_SPACE0_8822C) << BIT_SHIFT_BCN_SPACE0_8822C) -+#define BITS_BCN_SPACE0_8822C \ -+ (BIT_MASK_BCN_SPACE0_8822C << BIT_SHIFT_BCN_SPACE0_8822C) -+#define BIT_CLEAR_BCN_SPACE0_8822C(x) ((x) & (~BITS_BCN_SPACE0_8822C)) -+#define BIT_GET_BCN_SPACE0_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE0_8822C) & BIT_MASK_BCN_SPACE0_8822C) -+#define BIT_SET_BCN_SPACE0_8822C(x, v) \ -+ (BIT_CLEAR_BCN_SPACE0_8822C(x) | BIT_BCN_SPACE0_8822C(v)) -+ -+/* 2 REG_DRVERLYINT_8822C */ -+ -+#define BIT_SHIFT_DRVERLYITV_8822C 0 -+#define BIT_MASK_DRVERLYITV_8822C 0xff -+#define BIT_DRVERLYITV_8822C(x) \ -+ (((x) & BIT_MASK_DRVERLYITV_8822C) << BIT_SHIFT_DRVERLYITV_8822C) -+#define BITS_DRVERLYITV_8822C \ -+ (BIT_MASK_DRVERLYITV_8822C << BIT_SHIFT_DRVERLYITV_8822C) -+#define BIT_CLEAR_DRVERLYITV_8822C(x) ((x) & (~BITS_DRVERLYITV_8822C)) -+#define BIT_GET_DRVERLYITV_8822C(x) \ -+ (((x) >> BIT_SHIFT_DRVERLYITV_8822C) & BIT_MASK_DRVERLYITV_8822C) -+#define BIT_SET_DRVERLYITV_8822C(x, v) \ -+ (BIT_CLEAR_DRVERLYITV_8822C(x) | BIT_DRVERLYITV_8822C(v)) -+ -+/* 2 REG_BCNDMATIM_8822C */ -+ -+#define BIT_SHIFT_BCNDMATIM_8822C 0 -+#define BIT_MASK_BCNDMATIM_8822C 0xff -+#define BIT_BCNDMATIM_8822C(x) \ -+ (((x) & BIT_MASK_BCNDMATIM_8822C) << BIT_SHIFT_BCNDMATIM_8822C) -+#define BITS_BCNDMATIM_8822C \ -+ (BIT_MASK_BCNDMATIM_8822C << BIT_SHIFT_BCNDMATIM_8822C) -+#define BIT_CLEAR_BCNDMATIM_8822C(x) ((x) & (~BITS_BCNDMATIM_8822C)) -+#define BIT_GET_BCNDMATIM_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNDMATIM_8822C) & BIT_MASK_BCNDMATIM_8822C) -+#define BIT_SET_BCNDMATIM_8822C(x, v) \ -+ (BIT_CLEAR_BCNDMATIM_8822C(x) | BIT_BCNDMATIM_8822C(v)) -+ -+/* 2 REG_ATIMWND_8822C */ -+ -+#define BIT_SHIFT_ATIMWND0_8822C 0 -+#define BIT_MASK_ATIMWND0_8822C 0xffff -+#define BIT_ATIMWND0_8822C(x) \ -+ (((x) & BIT_MASK_ATIMWND0_8822C) << BIT_SHIFT_ATIMWND0_8822C) -+#define BITS_ATIMWND0_8822C \ -+ (BIT_MASK_ATIMWND0_8822C << BIT_SHIFT_ATIMWND0_8822C) -+#define BIT_CLEAR_ATIMWND0_8822C(x) ((x) & (~BITS_ATIMWND0_8822C)) -+#define BIT_GET_ATIMWND0_8822C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND0_8822C) & BIT_MASK_ATIMWND0_8822C) -+#define BIT_SET_ATIMWND0_8822C(x, v) \ -+ (BIT_CLEAR_ATIMWND0_8822C(x) | BIT_ATIMWND0_8822C(v)) -+ -+/* 2 REG_USTIME_TSF_8822C */ -+ -+#define BIT_SHIFT_USTIME_TSF_V1_8822C 0 -+#define BIT_MASK_USTIME_TSF_V1_8822C 0xff -+#define BIT_USTIME_TSF_V1_8822C(x) \ -+ (((x) & BIT_MASK_USTIME_TSF_V1_8822C) << BIT_SHIFT_USTIME_TSF_V1_8822C) -+#define BITS_USTIME_TSF_V1_8822C \ -+ (BIT_MASK_USTIME_TSF_V1_8822C << BIT_SHIFT_USTIME_TSF_V1_8822C) -+#define BIT_CLEAR_USTIME_TSF_V1_8822C(x) ((x) & (~BITS_USTIME_TSF_V1_8822C)) -+#define BIT_GET_USTIME_TSF_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_USTIME_TSF_V1_8822C) & BIT_MASK_USTIME_TSF_V1_8822C) -+#define BIT_SET_USTIME_TSF_V1_8822C(x, v) \ -+ (BIT_CLEAR_USTIME_TSF_V1_8822C(x) | BIT_USTIME_TSF_V1_8822C(v)) -+ -+/* 2 REG_BCN_MAX_ERR_8822C */ -+ -+#define BIT_SHIFT_BCN_MAX_ERR_8822C 0 -+#define BIT_MASK_BCN_MAX_ERR_8822C 0xff -+#define BIT_BCN_MAX_ERR_8822C(x) \ -+ (((x) & BIT_MASK_BCN_MAX_ERR_8822C) << BIT_SHIFT_BCN_MAX_ERR_8822C) -+#define BITS_BCN_MAX_ERR_8822C \ -+ (BIT_MASK_BCN_MAX_ERR_8822C << BIT_SHIFT_BCN_MAX_ERR_8822C) -+#define BIT_CLEAR_BCN_MAX_ERR_8822C(x) ((x) & (~BITS_BCN_MAX_ERR_8822C)) -+#define BIT_GET_BCN_MAX_ERR_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCN_MAX_ERR_8822C) & BIT_MASK_BCN_MAX_ERR_8822C) -+#define BIT_SET_BCN_MAX_ERR_8822C(x, v) \ -+ (BIT_CLEAR_BCN_MAX_ERR_8822C(x) | BIT_BCN_MAX_ERR_8822C(v)) -+ -+/* 2 REG_RXTSF_OFFSET_CCK_8822C */ -+ -+#define BIT_SHIFT_CCK_RXTSF_OFFSET_8822C 0 -+#define BIT_MASK_CCK_RXTSF_OFFSET_8822C 0xff -+#define BIT_CCK_RXTSF_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_CCK_RXTSF_OFFSET_8822C) \ -+ << BIT_SHIFT_CCK_RXTSF_OFFSET_8822C) -+#define BITS_CCK_RXTSF_OFFSET_8822C \ -+ (BIT_MASK_CCK_RXTSF_OFFSET_8822C << BIT_SHIFT_CCK_RXTSF_OFFSET_8822C) -+#define BIT_CLEAR_CCK_RXTSF_OFFSET_8822C(x) \ -+ ((x) & (~BITS_CCK_RXTSF_OFFSET_8822C)) -+#define BIT_GET_CCK_RXTSF_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_CCK_RXTSF_OFFSET_8822C) & \ -+ BIT_MASK_CCK_RXTSF_OFFSET_8822C) -+#define BIT_SET_CCK_RXTSF_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_CCK_RXTSF_OFFSET_8822C(x) | BIT_CCK_RXTSF_OFFSET_8822C(v)) -+ -+/* 2 REG_RXTSF_OFFSET_OFDM_8822C */ -+ -+#define BIT_SHIFT_OFDM_RXTSF_OFFSET_8822C 0 -+#define BIT_MASK_OFDM_RXTSF_OFFSET_8822C 0xff -+#define BIT_OFDM_RXTSF_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_OFDM_RXTSF_OFFSET_8822C) \ -+ << BIT_SHIFT_OFDM_RXTSF_OFFSET_8822C) -+#define BITS_OFDM_RXTSF_OFFSET_8822C \ -+ (BIT_MASK_OFDM_RXTSF_OFFSET_8822C << BIT_SHIFT_OFDM_RXTSF_OFFSET_8822C) -+#define BIT_CLEAR_OFDM_RXTSF_OFFSET_8822C(x) \ -+ ((x) & (~BITS_OFDM_RXTSF_OFFSET_8822C)) -+#define BIT_GET_OFDM_RXTSF_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_OFDM_RXTSF_OFFSET_8822C) & \ -+ BIT_MASK_OFDM_RXTSF_OFFSET_8822C) -+#define BIT_SET_OFDM_RXTSF_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_OFDM_RXTSF_OFFSET_8822C(x) | BIT_OFDM_RXTSF_OFFSET_8822C(v)) -+ -+/* 2 REG_TSFTR_8822C */ -+ -+#define BIT_SHIFT_TSF_TIMER_V1_8822C 0 -+#define BIT_MASK_TSF_TIMER_V1_8822C 0xffffffffL -+#define BIT_TSF_TIMER_V1_8822C(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_V1_8822C) << BIT_SHIFT_TSF_TIMER_V1_8822C) -+#define BITS_TSF_TIMER_V1_8822C \ -+ (BIT_MASK_TSF_TIMER_V1_8822C << BIT_SHIFT_TSF_TIMER_V1_8822C) -+#define BIT_CLEAR_TSF_TIMER_V1_8822C(x) ((x) & (~BITS_TSF_TIMER_V1_8822C)) -+#define BIT_GET_TSF_TIMER_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_V1_8822C) & BIT_MASK_TSF_TIMER_V1_8822C) -+#define BIT_SET_TSF_TIMER_V1_8822C(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_V1_8822C(x) | BIT_TSF_TIMER_V1_8822C(v)) -+ -+/* 2 REG_TSFTR_1_8822C */ -+ -+#define BIT_SHIFT_TSF_TIMER_V2_8822C 0 -+#define BIT_MASK_TSF_TIMER_V2_8822C 0xffffffffL -+#define BIT_TSF_TIMER_V2_8822C(x) \ -+ (((x) & BIT_MASK_TSF_TIMER_V2_8822C) << BIT_SHIFT_TSF_TIMER_V2_8822C) -+#define BITS_TSF_TIMER_V2_8822C \ -+ (BIT_MASK_TSF_TIMER_V2_8822C << BIT_SHIFT_TSF_TIMER_V2_8822C) -+#define BIT_CLEAR_TSF_TIMER_V2_8822C(x) ((x) & (~BITS_TSF_TIMER_V2_8822C)) -+#define BIT_GET_TSF_TIMER_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_TSF_TIMER_V2_8822C) & BIT_MASK_TSF_TIMER_V2_8822C) -+#define BIT_SET_TSF_TIMER_V2_8822C(x, v) \ -+ (BIT_CLEAR_TSF_TIMER_V2_8822C(x) | BIT_TSF_TIMER_V2_8822C(v)) -+ -+/* 2 REG_FREERUN_CNT_8822C */ -+ -+#define BIT_SHIFT_FREERUN_CNT_V1_8822C 0 -+#define BIT_MASK_FREERUN_CNT_V1_8822C 0xffffffffL -+#define BIT_FREERUN_CNT_V1_8822C(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_V1_8822C) \ -+ << BIT_SHIFT_FREERUN_CNT_V1_8822C) -+#define BITS_FREERUN_CNT_V1_8822C \ -+ (BIT_MASK_FREERUN_CNT_V1_8822C << BIT_SHIFT_FREERUN_CNT_V1_8822C) -+#define BIT_CLEAR_FREERUN_CNT_V1_8822C(x) ((x) & (~BITS_FREERUN_CNT_V1_8822C)) -+#define BIT_GET_FREERUN_CNT_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_V1_8822C) & \ -+ BIT_MASK_FREERUN_CNT_V1_8822C) -+#define BIT_SET_FREERUN_CNT_V1_8822C(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_V1_8822C(x) | BIT_FREERUN_CNT_V1_8822C(v)) -+ -+/* 2 REG_FREERUN_CNT_1_8822C */ -+ -+#define BIT_SHIFT_FREERUN_CNT_V2_8822C 0 -+#define BIT_MASK_FREERUN_CNT_V2_8822C 0xffffffffL -+#define BIT_FREERUN_CNT_V2_8822C(x) \ -+ (((x) & BIT_MASK_FREERUN_CNT_V2_8822C) \ -+ << BIT_SHIFT_FREERUN_CNT_V2_8822C) -+#define BITS_FREERUN_CNT_V2_8822C \ -+ (BIT_MASK_FREERUN_CNT_V2_8822C << BIT_SHIFT_FREERUN_CNT_V2_8822C) -+#define BIT_CLEAR_FREERUN_CNT_V2_8822C(x) ((x) & (~BITS_FREERUN_CNT_V2_8822C)) -+#define BIT_GET_FREERUN_CNT_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_FREERUN_CNT_V2_8822C) & \ -+ BIT_MASK_FREERUN_CNT_V2_8822C) -+#define BIT_SET_FREERUN_CNT_V2_8822C(x, v) \ -+ (BIT_CLEAR_FREERUN_CNT_V2_8822C(x) | BIT_FREERUN_CNT_V2_8822C(v)) -+ -+/* 2 REG_ATIMWND1_V1_8822C */ -+ -+#define BIT_SHIFT_ATIMWND1_V1_8822C 0 -+#define BIT_MASK_ATIMWND1_V1_8822C 0xff -+#define BIT_ATIMWND1_V1_8822C(x) \ -+ (((x) & BIT_MASK_ATIMWND1_V1_8822C) << BIT_SHIFT_ATIMWND1_V1_8822C) -+#define BITS_ATIMWND1_V1_8822C \ -+ (BIT_MASK_ATIMWND1_V1_8822C << BIT_SHIFT_ATIMWND1_V1_8822C) -+#define BIT_CLEAR_ATIMWND1_V1_8822C(x) ((x) & (~BITS_ATIMWND1_V1_8822C)) -+#define BIT_GET_ATIMWND1_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND1_V1_8822C) & BIT_MASK_ATIMWND1_V1_8822C) -+#define BIT_SET_ATIMWND1_V1_8822C(x, v) \ -+ (BIT_CLEAR_ATIMWND1_V1_8822C(x) | BIT_ATIMWND1_V1_8822C(v)) -+ -+/* 2 REG_TBTT_PROHIBIT_INFRA_8822C */ -+ -+#define BIT_SHIFT_TBTT_PROHIBIT_INFRA_8822C 0 -+#define BIT_MASK_TBTT_PROHIBIT_INFRA_8822C 0xff -+#define BIT_TBTT_PROHIBIT_INFRA_8822C(x) \ -+ (((x) & BIT_MASK_TBTT_PROHIBIT_INFRA_8822C) \ -+ << BIT_SHIFT_TBTT_PROHIBIT_INFRA_8822C) -+#define BITS_TBTT_PROHIBIT_INFRA_8822C \ -+ (BIT_MASK_TBTT_PROHIBIT_INFRA_8822C \ -+ << BIT_SHIFT_TBTT_PROHIBIT_INFRA_8822C) -+#define BIT_CLEAR_TBTT_PROHIBIT_INFRA_8822C(x) \ -+ ((x) & (~BITS_TBTT_PROHIBIT_INFRA_8822C)) -+#define BIT_GET_TBTT_PROHIBIT_INFRA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TBTT_PROHIBIT_INFRA_8822C) & \ -+ BIT_MASK_TBTT_PROHIBIT_INFRA_8822C) -+#define BIT_SET_TBTT_PROHIBIT_INFRA_8822C(x, v) \ -+ (BIT_CLEAR_TBTT_PROHIBIT_INFRA_8822C(x) | \ -+ BIT_TBTT_PROHIBIT_INFRA_8822C(v)) -+ -+/* 2 REG_CTWND_8822C */ -+ -+#define BIT_SHIFT_CTWND_8822C 0 -+#define BIT_MASK_CTWND_8822C 0xff -+#define BIT_CTWND_8822C(x) \ -+ (((x) & BIT_MASK_CTWND_8822C) << BIT_SHIFT_CTWND_8822C) -+#define BITS_CTWND_8822C (BIT_MASK_CTWND_8822C << BIT_SHIFT_CTWND_8822C) -+#define BIT_CLEAR_CTWND_8822C(x) ((x) & (~BITS_CTWND_8822C)) -+#define BIT_GET_CTWND_8822C(x) \ -+ (((x) >> BIT_SHIFT_CTWND_8822C) & BIT_MASK_CTWND_8822C) -+#define BIT_SET_CTWND_8822C(x, v) \ -+ (BIT_CLEAR_CTWND_8822C(x) | BIT_CTWND_8822C(v)) -+ -+/* 2 REG_BCNIVLCUNT_8822C */ -+ -+#define BIT_SHIFT_BCNIVLCUNT_8822C 0 -+#define BIT_MASK_BCNIVLCUNT_8822C 0x7f -+#define BIT_BCNIVLCUNT_8822C(x) \ -+ (((x) & BIT_MASK_BCNIVLCUNT_8822C) << BIT_SHIFT_BCNIVLCUNT_8822C) -+#define BITS_BCNIVLCUNT_8822C \ -+ (BIT_MASK_BCNIVLCUNT_8822C << BIT_SHIFT_BCNIVLCUNT_8822C) -+#define BIT_CLEAR_BCNIVLCUNT_8822C(x) ((x) & (~BITS_BCNIVLCUNT_8822C)) -+#define BIT_GET_BCNIVLCUNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNIVLCUNT_8822C) & BIT_MASK_BCNIVLCUNT_8822C) -+#define BIT_SET_BCNIVLCUNT_8822C(x, v) \ -+ (BIT_CLEAR_BCNIVLCUNT_8822C(x) | BIT_BCNIVLCUNT_8822C(v)) -+ -+/* 2 REG_BCNDROPCTRL_8822C */ -+#define BIT_BEACON_DROP_EN_8822C BIT(7) -+ -+#define BIT_SHIFT_BEACON_DROP_IVL_8822C 0 -+#define BIT_MASK_BEACON_DROP_IVL_8822C 0x7f -+#define BIT_BEACON_DROP_IVL_8822C(x) \ -+ (((x) & BIT_MASK_BEACON_DROP_IVL_8822C) \ -+ << BIT_SHIFT_BEACON_DROP_IVL_8822C) -+#define BITS_BEACON_DROP_IVL_8822C \ -+ (BIT_MASK_BEACON_DROP_IVL_8822C << BIT_SHIFT_BEACON_DROP_IVL_8822C) -+#define BIT_CLEAR_BEACON_DROP_IVL_8822C(x) ((x) & (~BITS_BEACON_DROP_IVL_8822C)) -+#define BIT_GET_BEACON_DROP_IVL_8822C(x) \ -+ (((x) >> BIT_SHIFT_BEACON_DROP_IVL_8822C) & \ -+ BIT_MASK_BEACON_DROP_IVL_8822C) -+#define BIT_SET_BEACON_DROP_IVL_8822C(x, v) \ -+ (BIT_CLEAR_BEACON_DROP_IVL_8822C(x) | BIT_BEACON_DROP_IVL_8822C(v)) -+ -+/* 2 REG_HGQ_TIMEOUT_PERIOD_8822C */ -+ -+#define BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8822C 0 -+#define BIT_MASK_HGQ_TIMEOUT_PERIOD_8822C 0xff -+#define BIT_HGQ_TIMEOUT_PERIOD_8822C(x) \ -+ (((x) & BIT_MASK_HGQ_TIMEOUT_PERIOD_8822C) \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8822C) -+#define BITS_HGQ_TIMEOUT_PERIOD_8822C \ -+ (BIT_MASK_HGQ_TIMEOUT_PERIOD_8822C \ -+ << BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8822C) -+#define BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8822C(x) \ -+ ((x) & (~BITS_HGQ_TIMEOUT_PERIOD_8822C)) -+#define BIT_GET_HGQ_TIMEOUT_PERIOD_8822C(x) \ -+ (((x) >> BIT_SHIFT_HGQ_TIMEOUT_PERIOD_8822C) & \ -+ BIT_MASK_HGQ_TIMEOUT_PERIOD_8822C) -+#define BIT_SET_HGQ_TIMEOUT_PERIOD_8822C(x, v) \ -+ (BIT_CLEAR_HGQ_TIMEOUT_PERIOD_8822C(x) | \ -+ BIT_HGQ_TIMEOUT_PERIOD_8822C(v)) -+ -+/* 2 REG_TXCMD_TIMEOUT_PERIOD_8822C */ -+ -+#define BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8822C 0 -+#define BIT_MASK_TXCMD_TIMEOUT_PERIOD_8822C 0xff -+#define BIT_TXCMD_TIMEOUT_PERIOD_8822C(x) \ -+ (((x) & BIT_MASK_TXCMD_TIMEOUT_PERIOD_8822C) \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8822C) -+#define BITS_TXCMD_TIMEOUT_PERIOD_8822C \ -+ (BIT_MASK_TXCMD_TIMEOUT_PERIOD_8822C \ -+ << BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8822C) -+#define BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8822C(x) \ -+ ((x) & (~BITS_TXCMD_TIMEOUT_PERIOD_8822C)) -+#define BIT_GET_TXCMD_TIMEOUT_PERIOD_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_TIMEOUT_PERIOD_8822C) & \ -+ BIT_MASK_TXCMD_TIMEOUT_PERIOD_8822C) -+#define BIT_SET_TXCMD_TIMEOUT_PERIOD_8822C(x, v) \ -+ (BIT_CLEAR_TXCMD_TIMEOUT_PERIOD_8822C(x) | \ -+ BIT_TXCMD_TIMEOUT_PERIOD_8822C(v)) -+ -+/* 2 REG_MISC_CTRL_8822C */ -+#define BIT_DIS_MARK_TSF_US_V2_8822C BIT(7) -+#define BIT_AUTO_SYNC_BY_TBTT_8822C BIT(6) -+#define BIT_DIS_TRX_CAL_BCN_8822C BIT(5) -+#define BIT_DIS_TX_CAL_TBTT_8822C BIT(4) -+#define BIT_EN_FREECNT_8822C BIT(3) -+#define BIT_BCN_AGGRESSION_8822C BIT(2) -+ -+#define BIT_SHIFT_DIS_SECONDARY_CCA_8822C 0 -+#define BIT_MASK_DIS_SECONDARY_CCA_8822C 0x3 -+#define BIT_DIS_SECONDARY_CCA_8822C(x) \ -+ (((x) & BIT_MASK_DIS_SECONDARY_CCA_8822C) \ -+ << BIT_SHIFT_DIS_SECONDARY_CCA_8822C) -+#define BITS_DIS_SECONDARY_CCA_8822C \ -+ (BIT_MASK_DIS_SECONDARY_CCA_8822C << BIT_SHIFT_DIS_SECONDARY_CCA_8822C) -+#define BIT_CLEAR_DIS_SECONDARY_CCA_8822C(x) \ -+ ((x) & (~BITS_DIS_SECONDARY_CCA_8822C)) -+#define BIT_GET_DIS_SECONDARY_CCA_8822C(x) \ -+ (((x) >> BIT_SHIFT_DIS_SECONDARY_CCA_8822C) & \ -+ BIT_MASK_DIS_SECONDARY_CCA_8822C) -+#define BIT_SET_DIS_SECONDARY_CCA_8822C(x, v) \ -+ (BIT_CLEAR_DIS_SECONDARY_CCA_8822C(x) | BIT_DIS_SECONDARY_CCA_8822C(v)) -+ -+/* 2 REG_BCN_CTRL_CLINT1_8822C */ -+#define BIT_CLI1_DIS_RX_BSSID_FIT_8822C BIT(6) -+#define BIT_CLI1_DIS_TSF_UDT_8822C BIT(4) -+#define BIT_CLI1_EN_BCN_FUNCTION_8822C BIT(3) -+#define BIT_CLI1_EN_RXBCN_RPT_8822C BIT(2) -+#define BIT_CLI1_ENP2P_CTWINDOW_8822C BIT(1) -+#define BIT_CLI1_ENP2P_BCNQ_AREA_8822C BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT2_8822C */ -+#define BIT_CLI2_DIS_RX_BSSID_FIT_8822C BIT(6) -+#define BIT_CLI2_DIS_TSF_UDT_8822C BIT(4) -+#define BIT_CLI2_EN_BCN_FUNCTION_8822C BIT(3) -+#define BIT_CLI2_EN_RXBCN_RPT_8822C BIT(2) -+#define BIT_CLI2_ENP2P_CTWINDOW_8822C BIT(1) -+#define BIT_CLI2_ENP2P_BCNQ_AREA_8822C BIT(0) -+ -+/* 2 REG_BCN_CTRL_CLINT3_8822C */ -+#define BIT_CLI3_DIS_RX_BSSID_FIT_8822C BIT(6) -+#define BIT_CLI3_DIS_TSF_UDT_8822C BIT(4) -+#define BIT_CLI3_EN_BCN_FUNCTION_8822C BIT(3) -+#define BIT_CLI3_EN_RXBCN_RPT_8822C BIT(2) -+#define BIT_CLI3_ENP2P_CTWINDOW_8822C BIT(1) -+#define BIT_CLI3_ENP2P_BCNQ_AREA_8822C BIT(0) -+ -+/* 2 REG_EXTEND_CTRL_8822C */ -+#define BIT_EN_TSFBIT32_RST_P2P2_8822C BIT(5) -+#define BIT_EN_TSFBIT32_RST_P2P1_8822C BIT(4) -+ -+#define BIT_SHIFT_PORT_SEL_8822C 0 -+#define BIT_MASK_PORT_SEL_8822C 0x7 -+#define BIT_PORT_SEL_8822C(x) \ -+ (((x) & BIT_MASK_PORT_SEL_8822C) << BIT_SHIFT_PORT_SEL_8822C) -+#define BITS_PORT_SEL_8822C \ -+ (BIT_MASK_PORT_SEL_8822C << BIT_SHIFT_PORT_SEL_8822C) -+#define BIT_CLEAR_PORT_SEL_8822C(x) ((x) & (~BITS_PORT_SEL_8822C)) -+#define BIT_GET_PORT_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_PORT_SEL_8822C) & BIT_MASK_PORT_SEL_8822C) -+#define BIT_SET_PORT_SEL_8822C(x, v) \ -+ (BIT_CLEAR_PORT_SEL_8822C(x) | BIT_PORT_SEL_8822C(v)) -+ -+/* 2 REG_P2PPS1_SPEC_STATE_8822C */ -+#define BIT_P2P1_SPEC_POWER_STATE_8822C BIT(7) -+#define BIT_P2P1_SPEC_CTWINDOW_ON_8822C BIT(6) -+#define BIT_P2P1_SPEC_BCN_AREA_ON_8822C BIT(5) -+#define BIT_P2P1_SPEC_CTWIN_EARLY_DISTX_8822C BIT(4) -+#define BIT_P2P1_SPEC_NOA1_OFF_PERIOD_8822C BIT(3) -+#define BIT_P2P1_SPEC_FORCE_DOZE1_8822C BIT(2) -+#define BIT_P2P1_SPEC_NOA0_OFF_PERIOD_8822C BIT(1) -+#define BIT_P2P1_SPEC_FORCE_DOZE0_8822C BIT(0) -+ -+/* 2 REG_P2PPS1_STATE_8822C */ -+#define BIT_P2P1_POWER_STATE_8822C BIT(7) -+#define BIT_P2P1_CTWINDOW_ON_8822C BIT(6) -+#define BIT_P2P1_BEACON_AREA_ON_8822C BIT(5) -+#define BIT_P2P1_CTWIN_EARLY_DISTX_8822C BIT(4) -+#define BIT_P2P1_NOA1_OFF_PERIOD_8822C BIT(3) -+#define BIT_P2P1_FORCE_DOZE1_8822C BIT(2) -+#define BIT_P2P1_NOA0_OFF_PERIOD_8822C BIT(1) -+#define BIT_P2P1_FORCE_DOZE0_8822C BIT(0) -+ -+/* 2 REG_P2PPS2_SPEC_STATE_8822C */ -+#define BIT_P2P2_SPEC_POWER_STATE_8822C BIT(7) -+#define BIT_P2P2_SPEC_CTWINDOW_ON_8822C BIT(6) -+#define BIT_P2P2_SPEC_BCN_AREA_ON_8822C BIT(5) -+#define BIT_P2P2_SPEC_CTWIN_EARLY_DISTX_8822C BIT(4) -+#define BIT_P2P2_SPEC_NOA1_OFF_PERIOD_8822C BIT(3) -+#define BIT_P2P2_SPEC_FORCE_DOZE1_8822C BIT(2) -+#define BIT_P2P2_SPEC_NOA0_OFF_PERIOD_8822C BIT(1) -+#define BIT_P2P2_SPEC_FORCE_DOZE0_8822C BIT(0) -+ -+/* 2 REG_P2PPS2_STATE_8822C */ -+#define BIT_P2P2_POWER_STATE_8822C BIT(7) -+#define BIT_P2P2_CTWINDOW_ON_8822C BIT(6) -+#define BIT_P2P2_BEACON_AREA_ON_8822C BIT(5) -+#define BIT_P2P2_CTWIN_EARLY_DISTX_8822C BIT(4) -+#define BIT_P2P2_NOA1_OFF_PERIOD_8822C BIT(3) -+#define BIT_P2P2_FORCE_DOZE1_8822C BIT(2) -+#define BIT_P2P2_NOA0_OFF_PERIOD_8822C BIT(1) -+#define BIT_P2P2_FORCE_DOZE0_8822C BIT(0) -+ -+/* 2 REG_PS_TIMER0_8822C */ -+ -+#define BIT_SHIFT_PSTIMER0_INT_8822C 5 -+#define BIT_MASK_PSTIMER0_INT_8822C 0x7ffffff -+#define BIT_PSTIMER0_INT_8822C(x) \ -+ (((x) & BIT_MASK_PSTIMER0_INT_8822C) << BIT_SHIFT_PSTIMER0_INT_8822C) -+#define BITS_PSTIMER0_INT_8822C \ -+ (BIT_MASK_PSTIMER0_INT_8822C << BIT_SHIFT_PSTIMER0_INT_8822C) -+#define BIT_CLEAR_PSTIMER0_INT_8822C(x) ((x) & (~BITS_PSTIMER0_INT_8822C)) -+#define BIT_GET_PSTIMER0_INT_8822C(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER0_INT_8822C) & BIT_MASK_PSTIMER0_INT_8822C) -+#define BIT_SET_PSTIMER0_INT_8822C(x, v) \ -+ (BIT_CLEAR_PSTIMER0_INT_8822C(x) | BIT_PSTIMER0_INT_8822C(v)) -+ -+/* 2 REG_PS_TIMER1_8822C */ -+ -+#define BIT_SHIFT_PSTIMER1_INT_8822C 5 -+#define BIT_MASK_PSTIMER1_INT_8822C 0x7ffffff -+#define BIT_PSTIMER1_INT_8822C(x) \ -+ (((x) & BIT_MASK_PSTIMER1_INT_8822C) << BIT_SHIFT_PSTIMER1_INT_8822C) -+#define BITS_PSTIMER1_INT_8822C \ -+ (BIT_MASK_PSTIMER1_INT_8822C << BIT_SHIFT_PSTIMER1_INT_8822C) -+#define BIT_CLEAR_PSTIMER1_INT_8822C(x) ((x) & (~BITS_PSTIMER1_INT_8822C)) -+#define BIT_GET_PSTIMER1_INT_8822C(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER1_INT_8822C) & BIT_MASK_PSTIMER1_INT_8822C) -+#define BIT_SET_PSTIMER1_INT_8822C(x, v) \ -+ (BIT_CLEAR_PSTIMER1_INT_8822C(x) | BIT_PSTIMER1_INT_8822C(v)) -+ -+/* 2 REG_PS_TIMER2_8822C */ -+ -+#define BIT_SHIFT_PSTIMER2_INT_8822C 5 -+#define BIT_MASK_PSTIMER2_INT_8822C 0x7ffffff -+#define BIT_PSTIMER2_INT_8822C(x) \ -+ (((x) & BIT_MASK_PSTIMER2_INT_8822C) << BIT_SHIFT_PSTIMER2_INT_8822C) -+#define BITS_PSTIMER2_INT_8822C \ -+ (BIT_MASK_PSTIMER2_INT_8822C << BIT_SHIFT_PSTIMER2_INT_8822C) -+#define BIT_CLEAR_PSTIMER2_INT_8822C(x) ((x) & (~BITS_PSTIMER2_INT_8822C)) -+#define BIT_GET_PSTIMER2_INT_8822C(x) \ -+ (((x) >> BIT_SHIFT_PSTIMER2_INT_8822C) & BIT_MASK_PSTIMER2_INT_8822C) -+#define BIT_SET_PSTIMER2_INT_8822C(x, v) \ -+ (BIT_CLEAR_PSTIMER2_INT_8822C(x) | BIT_PSTIMER2_INT_8822C(v)) -+ -+/* 2 REG_TBTT_CTN_AREA_8822C */ -+ -+#define BIT_SHIFT_TBTT_CTN_AREA_8822C 0 -+#define BIT_MASK_TBTT_CTN_AREA_8822C 0xff -+#define BIT_TBTT_CTN_AREA_8822C(x) \ -+ (((x) & BIT_MASK_TBTT_CTN_AREA_8822C) << BIT_SHIFT_TBTT_CTN_AREA_8822C) -+#define BITS_TBTT_CTN_AREA_8822C \ -+ (BIT_MASK_TBTT_CTN_AREA_8822C << BIT_SHIFT_TBTT_CTN_AREA_8822C) -+#define BIT_CLEAR_TBTT_CTN_AREA_8822C(x) ((x) & (~BITS_TBTT_CTN_AREA_8822C)) -+#define BIT_GET_TBTT_CTN_AREA_8822C(x) \ -+ (((x) >> BIT_SHIFT_TBTT_CTN_AREA_8822C) & BIT_MASK_TBTT_CTN_AREA_8822C) -+#define BIT_SET_TBTT_CTN_AREA_8822C(x, v) \ -+ (BIT_CLEAR_TBTT_CTN_AREA_8822C(x) | BIT_TBTT_CTN_AREA_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_FORCE_BCN_IFS_8822C */ -+ -+#define BIT_SHIFT_FORCE_BCN_IFS_8822C 0 -+#define BIT_MASK_FORCE_BCN_IFS_8822C 0xff -+#define BIT_FORCE_BCN_IFS_8822C(x) \ -+ (((x) & BIT_MASK_FORCE_BCN_IFS_8822C) << BIT_SHIFT_FORCE_BCN_IFS_8822C) -+#define BITS_FORCE_BCN_IFS_8822C \ -+ (BIT_MASK_FORCE_BCN_IFS_8822C << BIT_SHIFT_FORCE_BCN_IFS_8822C) -+#define BIT_CLEAR_FORCE_BCN_IFS_8822C(x) ((x) & (~BITS_FORCE_BCN_IFS_8822C)) -+#define BIT_GET_FORCE_BCN_IFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_FORCE_BCN_IFS_8822C) & BIT_MASK_FORCE_BCN_IFS_8822C) -+#define BIT_SET_FORCE_BCN_IFS_8822C(x, v) \ -+ (BIT_CLEAR_FORCE_BCN_IFS_8822C(x) | BIT_FORCE_BCN_IFS_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_TXOP_MIN_8822C */ -+#define BIT_HIQ_NAV_BREAK_EN_8822C BIT(15) -+#define BIT_MGQ_NAV_BREAK_EN_8822C BIT(14) -+ -+#define BIT_SHIFT_TXOP_MIN_8822C 0 -+#define BIT_MASK_TXOP_MIN_8822C 0x3fff -+#define BIT_TXOP_MIN_8822C(x) \ -+ (((x) & BIT_MASK_TXOP_MIN_8822C) << BIT_SHIFT_TXOP_MIN_8822C) -+#define BITS_TXOP_MIN_8822C \ -+ (BIT_MASK_TXOP_MIN_8822C << BIT_SHIFT_TXOP_MIN_8822C) -+#define BIT_CLEAR_TXOP_MIN_8822C(x) ((x) & (~BITS_TXOP_MIN_8822C)) -+#define BIT_GET_TXOP_MIN_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXOP_MIN_8822C) & BIT_MASK_TXOP_MIN_8822C) -+#define BIT_SET_TXOP_MIN_8822C(x, v) \ -+ (BIT_CLEAR_TXOP_MIN_8822C(x) | BIT_TXOP_MIN_8822C(v)) -+ -+/* 2 REG_PRE_BKF_TIME_8822C */ -+ -+#define BIT_SHIFT_PRE_BKF_TIME_8822C 0 -+#define BIT_MASK_PRE_BKF_TIME_8822C 0xff -+#define BIT_PRE_BKF_TIME_8822C(x) \ -+ (((x) & BIT_MASK_PRE_BKF_TIME_8822C) << BIT_SHIFT_PRE_BKF_TIME_8822C) -+#define BITS_PRE_BKF_TIME_8822C \ -+ (BIT_MASK_PRE_BKF_TIME_8822C << BIT_SHIFT_PRE_BKF_TIME_8822C) -+#define BIT_CLEAR_PRE_BKF_TIME_8822C(x) ((x) & (~BITS_PRE_BKF_TIME_8822C)) -+#define BIT_GET_PRE_BKF_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_PRE_BKF_TIME_8822C) & BIT_MASK_PRE_BKF_TIME_8822C) -+#define BIT_SET_PRE_BKF_TIME_8822C(x, v) \ -+ (BIT_CLEAR_PRE_BKF_TIME_8822C(x) | BIT_PRE_BKF_TIME_8822C(v)) -+ -+/* 2 REG_CROSS_TXOP_CTRL_8822C */ -+#define BIT_TXFAIL_BREACK_TXOP_EN_8822C BIT(3) -+#define BIT_DTIM_BYPASS_8822C BIT(2) -+#define BIT_RTS_NAV_TXOP_8822C BIT(1) -+#define BIT_NOT_CROSS_TXOP_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_RX_TBTT_SHIFT_V1_8822C */ -+#define BIT_RX_TBTT_SHIFT_RW_FLAG_V1_8822C BIT(31) -+ -+#define BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1_8822C 16 -+#define BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1_8822C 0xfff -+#define BIT_RX_TBTT_SHIFT_OFFSET_V1_8822C(x) \ -+ (((x) & BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1_8822C) \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1_8822C) -+#define BITS_RX_TBTT_SHIFT_OFFSET_V1_8822C \ -+ (BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1_8822C \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1_8822C) -+#define BIT_CLEAR_RX_TBTT_SHIFT_OFFSET_V1_8822C(x) \ -+ ((x) & (~BITS_RX_TBTT_SHIFT_OFFSET_V1_8822C)) -+#define BIT_GET_RX_TBTT_SHIFT_OFFSET_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_TBTT_SHIFT_OFFSET_V1_8822C) & \ -+ BIT_MASK_RX_TBTT_SHIFT_OFFSET_V1_8822C) -+#define BIT_SET_RX_TBTT_SHIFT_OFFSET_V1_8822C(x, v) \ -+ (BIT_CLEAR_RX_TBTT_SHIFT_OFFSET_V1_8822C(x) | \ -+ BIT_RX_TBTT_SHIFT_OFFSET_V1_8822C(v)) -+ -+#define BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1_8822C 8 -+#define BIT_MASK_RX_TBTT_SHIFT_SEL_V1_8822C 0x7 -+#define BIT_RX_TBTT_SHIFT_SEL_V1_8822C(x) \ -+ (((x) & BIT_MASK_RX_TBTT_SHIFT_SEL_V1_8822C) \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1_8822C) -+#define BITS_RX_TBTT_SHIFT_SEL_V1_8822C \ -+ (BIT_MASK_RX_TBTT_SHIFT_SEL_V1_8822C \ -+ << BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1_8822C) -+#define BIT_CLEAR_RX_TBTT_SHIFT_SEL_V1_8822C(x) \ -+ ((x) & (~BITS_RX_TBTT_SHIFT_SEL_V1_8822C)) -+#define BIT_GET_RX_TBTT_SHIFT_SEL_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_TBTT_SHIFT_SEL_V1_8822C) & \ -+ BIT_MASK_RX_TBTT_SHIFT_SEL_V1_8822C) -+#define BIT_SET_RX_TBTT_SHIFT_SEL_V1_8822C(x, v) \ -+ (BIT_CLEAR_RX_TBTT_SHIFT_SEL_V1_8822C(x) | \ -+ BIT_RX_TBTT_SHIFT_SEL_V1_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_ATIMWND2_8822C */ -+ -+#define BIT_SHIFT_ATIMWND2_8822C 0 -+#define BIT_MASK_ATIMWND2_8822C 0xff -+#define BIT_ATIMWND2_8822C(x) \ -+ (((x) & BIT_MASK_ATIMWND2_8822C) << BIT_SHIFT_ATIMWND2_8822C) -+#define BITS_ATIMWND2_8822C \ -+ (BIT_MASK_ATIMWND2_8822C << BIT_SHIFT_ATIMWND2_8822C) -+#define BIT_CLEAR_ATIMWND2_8822C(x) ((x) & (~BITS_ATIMWND2_8822C)) -+#define BIT_GET_ATIMWND2_8822C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND2_8822C) & BIT_MASK_ATIMWND2_8822C) -+#define BIT_SET_ATIMWND2_8822C(x, v) \ -+ (BIT_CLEAR_ATIMWND2_8822C(x) | BIT_ATIMWND2_8822C(v)) -+ -+/* 2 REG_ATIMWND3_8822C */ -+ -+#define BIT_SHIFT_ATIMWND3_8822C 0 -+#define BIT_MASK_ATIMWND3_8822C 0xff -+#define BIT_ATIMWND3_8822C(x) \ -+ (((x) & BIT_MASK_ATIMWND3_8822C) << BIT_SHIFT_ATIMWND3_8822C) -+#define BITS_ATIMWND3_8822C \ -+ (BIT_MASK_ATIMWND3_8822C << BIT_SHIFT_ATIMWND3_8822C) -+#define BIT_CLEAR_ATIMWND3_8822C(x) ((x) & (~BITS_ATIMWND3_8822C)) -+#define BIT_GET_ATIMWND3_8822C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND3_8822C) & BIT_MASK_ATIMWND3_8822C) -+#define BIT_SET_ATIMWND3_8822C(x, v) \ -+ (BIT_CLEAR_ATIMWND3_8822C(x) | BIT_ATIMWND3_8822C(v)) -+ -+/* 2 REG_ATIMWND4_8822C */ -+ -+#define BIT_SHIFT_ATIMWND4_8822C 0 -+#define BIT_MASK_ATIMWND4_8822C 0xff -+#define BIT_ATIMWND4_8822C(x) \ -+ (((x) & BIT_MASK_ATIMWND4_8822C) << BIT_SHIFT_ATIMWND4_8822C) -+#define BITS_ATIMWND4_8822C \ -+ (BIT_MASK_ATIMWND4_8822C << BIT_SHIFT_ATIMWND4_8822C) -+#define BIT_CLEAR_ATIMWND4_8822C(x) ((x) & (~BITS_ATIMWND4_8822C)) -+#define BIT_GET_ATIMWND4_8822C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND4_8822C) & BIT_MASK_ATIMWND4_8822C) -+#define BIT_SET_ATIMWND4_8822C(x, v) \ -+ (BIT_CLEAR_ATIMWND4_8822C(x) | BIT_ATIMWND4_8822C(v)) -+ -+/* 2 REG_ATIMWND5_8822C */ -+ -+#define BIT_SHIFT_ATIMWND5_8822C 0 -+#define BIT_MASK_ATIMWND5_8822C 0xff -+#define BIT_ATIMWND5_8822C(x) \ -+ (((x) & BIT_MASK_ATIMWND5_8822C) << BIT_SHIFT_ATIMWND5_8822C) -+#define BITS_ATIMWND5_8822C \ -+ (BIT_MASK_ATIMWND5_8822C << BIT_SHIFT_ATIMWND5_8822C) -+#define BIT_CLEAR_ATIMWND5_8822C(x) ((x) & (~BITS_ATIMWND5_8822C)) -+#define BIT_GET_ATIMWND5_8822C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND5_8822C) & BIT_MASK_ATIMWND5_8822C) -+#define BIT_SET_ATIMWND5_8822C(x, v) \ -+ (BIT_CLEAR_ATIMWND5_8822C(x) | BIT_ATIMWND5_8822C(v)) -+ -+/* 2 REG_ATIMWND6_8822C */ -+ -+#define BIT_SHIFT_ATIMWND6_8822C 0 -+#define BIT_MASK_ATIMWND6_8822C 0xff -+#define BIT_ATIMWND6_8822C(x) \ -+ (((x) & BIT_MASK_ATIMWND6_8822C) << BIT_SHIFT_ATIMWND6_8822C) -+#define BITS_ATIMWND6_8822C \ -+ (BIT_MASK_ATIMWND6_8822C << BIT_SHIFT_ATIMWND6_8822C) -+#define BIT_CLEAR_ATIMWND6_8822C(x) ((x) & (~BITS_ATIMWND6_8822C)) -+#define BIT_GET_ATIMWND6_8822C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND6_8822C) & BIT_MASK_ATIMWND6_8822C) -+#define BIT_SET_ATIMWND6_8822C(x, v) \ -+ (BIT_CLEAR_ATIMWND6_8822C(x) | BIT_ATIMWND6_8822C(v)) -+ -+/* 2 REG_ATIMWND7_8822C */ -+ -+#define BIT_SHIFT_ATIMWND7_8822C 0 -+#define BIT_MASK_ATIMWND7_8822C 0xff -+#define BIT_ATIMWND7_8822C(x) \ -+ (((x) & BIT_MASK_ATIMWND7_8822C) << BIT_SHIFT_ATIMWND7_8822C) -+#define BITS_ATIMWND7_8822C \ -+ (BIT_MASK_ATIMWND7_8822C << BIT_SHIFT_ATIMWND7_8822C) -+#define BIT_CLEAR_ATIMWND7_8822C(x) ((x) & (~BITS_ATIMWND7_8822C)) -+#define BIT_GET_ATIMWND7_8822C(x) \ -+ (((x) >> BIT_SHIFT_ATIMWND7_8822C) & BIT_MASK_ATIMWND7_8822C) -+#define BIT_SET_ATIMWND7_8822C(x, v) \ -+ (BIT_CLEAR_ATIMWND7_8822C(x) | BIT_ATIMWND7_8822C(v)) -+ -+/* 2 REG_ATIMUGT_8822C */ -+ -+#define BIT_SHIFT_ATIM_URGENT_8822C 0 -+#define BIT_MASK_ATIM_URGENT_8822C 0xff -+#define BIT_ATIM_URGENT_8822C(x) \ -+ (((x) & BIT_MASK_ATIM_URGENT_8822C) << BIT_SHIFT_ATIM_URGENT_8822C) -+#define BITS_ATIM_URGENT_8822C \ -+ (BIT_MASK_ATIM_URGENT_8822C << BIT_SHIFT_ATIM_URGENT_8822C) -+#define BIT_CLEAR_ATIM_URGENT_8822C(x) ((x) & (~BITS_ATIM_URGENT_8822C)) -+#define BIT_GET_ATIM_URGENT_8822C(x) \ -+ (((x) >> BIT_SHIFT_ATIM_URGENT_8822C) & BIT_MASK_ATIM_URGENT_8822C) -+#define BIT_SET_ATIM_URGENT_8822C(x, v) \ -+ (BIT_CLEAR_ATIM_URGENT_8822C(x) | BIT_ATIM_URGENT_8822C(v)) -+ -+/* 2 REG_HIQ_NO_LMT_EN_8822C */ -+#define BIT_HIQ_NO_LMT_EN_VAP7_8822C BIT(7) -+#define BIT_HIQ_NO_LMT_EN_VAP6_8822C BIT(6) -+#define BIT_HIQ_NO_LMT_EN_VAP5_8822C BIT(5) -+#define BIT_HIQ_NO_LMT_EN_VAP4_8822C BIT(4) -+#define BIT_HIQ_NO_LMT_EN_VAP3_8822C BIT(3) -+#define BIT_HIQ_NO_LMT_EN_VAP2_8822C BIT(2) -+#define BIT_HIQ_NO_LMT_EN_VAP1_8822C BIT(1) -+#define BIT_HIQ_NO_LMT_EN_ROOT_8822C BIT(0) -+ -+/* 2 REG_DTIM_COUNTER_ROOT_8822C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_ROOT_8822C 0 -+#define BIT_MASK_DTIM_COUNT_ROOT_8822C 0xff -+#define BIT_DTIM_COUNT_ROOT_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_ROOT_8822C) \ -+ << BIT_SHIFT_DTIM_COUNT_ROOT_8822C) -+#define BITS_DTIM_COUNT_ROOT_8822C \ -+ (BIT_MASK_DTIM_COUNT_ROOT_8822C << BIT_SHIFT_DTIM_COUNT_ROOT_8822C) -+#define BIT_CLEAR_DTIM_COUNT_ROOT_8822C(x) ((x) & (~BITS_DTIM_COUNT_ROOT_8822C)) -+#define BIT_GET_DTIM_COUNT_ROOT_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_ROOT_8822C) & \ -+ BIT_MASK_DTIM_COUNT_ROOT_8822C) -+#define BIT_SET_DTIM_COUNT_ROOT_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_ROOT_8822C(x) | BIT_DTIM_COUNT_ROOT_8822C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP1_8822C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP1_8822C 0 -+#define BIT_MASK_DTIM_COUNT_VAP1_8822C 0xff -+#define BIT_DTIM_COUNT_VAP1_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP1_8822C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP1_8822C) -+#define BITS_DTIM_COUNT_VAP1_8822C \ -+ (BIT_MASK_DTIM_COUNT_VAP1_8822C << BIT_SHIFT_DTIM_COUNT_VAP1_8822C) -+#define BIT_CLEAR_DTIM_COUNT_VAP1_8822C(x) ((x) & (~BITS_DTIM_COUNT_VAP1_8822C)) -+#define BIT_GET_DTIM_COUNT_VAP1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP1_8822C) & \ -+ BIT_MASK_DTIM_COUNT_VAP1_8822C) -+#define BIT_SET_DTIM_COUNT_VAP1_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP1_8822C(x) | BIT_DTIM_COUNT_VAP1_8822C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP2_8822C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP2_8822C 0 -+#define BIT_MASK_DTIM_COUNT_VAP2_8822C 0xff -+#define BIT_DTIM_COUNT_VAP2_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP2_8822C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP2_8822C) -+#define BITS_DTIM_COUNT_VAP2_8822C \ -+ (BIT_MASK_DTIM_COUNT_VAP2_8822C << BIT_SHIFT_DTIM_COUNT_VAP2_8822C) -+#define BIT_CLEAR_DTIM_COUNT_VAP2_8822C(x) ((x) & (~BITS_DTIM_COUNT_VAP2_8822C)) -+#define BIT_GET_DTIM_COUNT_VAP2_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP2_8822C) & \ -+ BIT_MASK_DTIM_COUNT_VAP2_8822C) -+#define BIT_SET_DTIM_COUNT_VAP2_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP2_8822C(x) | BIT_DTIM_COUNT_VAP2_8822C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP3_8822C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP3_8822C 0 -+#define BIT_MASK_DTIM_COUNT_VAP3_8822C 0xff -+#define BIT_DTIM_COUNT_VAP3_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP3_8822C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP3_8822C) -+#define BITS_DTIM_COUNT_VAP3_8822C \ -+ (BIT_MASK_DTIM_COUNT_VAP3_8822C << BIT_SHIFT_DTIM_COUNT_VAP3_8822C) -+#define BIT_CLEAR_DTIM_COUNT_VAP3_8822C(x) ((x) & (~BITS_DTIM_COUNT_VAP3_8822C)) -+#define BIT_GET_DTIM_COUNT_VAP3_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP3_8822C) & \ -+ BIT_MASK_DTIM_COUNT_VAP3_8822C) -+#define BIT_SET_DTIM_COUNT_VAP3_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP3_8822C(x) | BIT_DTIM_COUNT_VAP3_8822C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP4_8822C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP4_8822C 0 -+#define BIT_MASK_DTIM_COUNT_VAP4_8822C 0xff -+#define BIT_DTIM_COUNT_VAP4_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP4_8822C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP4_8822C) -+#define BITS_DTIM_COUNT_VAP4_8822C \ -+ (BIT_MASK_DTIM_COUNT_VAP4_8822C << BIT_SHIFT_DTIM_COUNT_VAP4_8822C) -+#define BIT_CLEAR_DTIM_COUNT_VAP4_8822C(x) ((x) & (~BITS_DTIM_COUNT_VAP4_8822C)) -+#define BIT_GET_DTIM_COUNT_VAP4_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP4_8822C) & \ -+ BIT_MASK_DTIM_COUNT_VAP4_8822C) -+#define BIT_SET_DTIM_COUNT_VAP4_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP4_8822C(x) | BIT_DTIM_COUNT_VAP4_8822C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP5_8822C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP5_8822C 0 -+#define BIT_MASK_DTIM_COUNT_VAP5_8822C 0xff -+#define BIT_DTIM_COUNT_VAP5_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP5_8822C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP5_8822C) -+#define BITS_DTIM_COUNT_VAP5_8822C \ -+ (BIT_MASK_DTIM_COUNT_VAP5_8822C << BIT_SHIFT_DTIM_COUNT_VAP5_8822C) -+#define BIT_CLEAR_DTIM_COUNT_VAP5_8822C(x) ((x) & (~BITS_DTIM_COUNT_VAP5_8822C)) -+#define BIT_GET_DTIM_COUNT_VAP5_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP5_8822C) & \ -+ BIT_MASK_DTIM_COUNT_VAP5_8822C) -+#define BIT_SET_DTIM_COUNT_VAP5_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP5_8822C(x) | BIT_DTIM_COUNT_VAP5_8822C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP6_8822C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP6_8822C 0 -+#define BIT_MASK_DTIM_COUNT_VAP6_8822C 0xff -+#define BIT_DTIM_COUNT_VAP6_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP6_8822C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP6_8822C) -+#define BITS_DTIM_COUNT_VAP6_8822C \ -+ (BIT_MASK_DTIM_COUNT_VAP6_8822C << BIT_SHIFT_DTIM_COUNT_VAP6_8822C) -+#define BIT_CLEAR_DTIM_COUNT_VAP6_8822C(x) ((x) & (~BITS_DTIM_COUNT_VAP6_8822C)) -+#define BIT_GET_DTIM_COUNT_VAP6_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP6_8822C) & \ -+ BIT_MASK_DTIM_COUNT_VAP6_8822C) -+#define BIT_SET_DTIM_COUNT_VAP6_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP6_8822C(x) | BIT_DTIM_COUNT_VAP6_8822C(v)) -+ -+/* 2 REG_DTIM_COUNTER_VAP7_8822C */ -+ -+#define BIT_SHIFT_DTIM_COUNT_VAP7_8822C 0 -+#define BIT_MASK_DTIM_COUNT_VAP7_8822C 0xff -+#define BIT_DTIM_COUNT_VAP7_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_COUNT_VAP7_8822C) \ -+ << BIT_SHIFT_DTIM_COUNT_VAP7_8822C) -+#define BITS_DTIM_COUNT_VAP7_8822C \ -+ (BIT_MASK_DTIM_COUNT_VAP7_8822C << BIT_SHIFT_DTIM_COUNT_VAP7_8822C) -+#define BIT_CLEAR_DTIM_COUNT_VAP7_8822C(x) ((x) & (~BITS_DTIM_COUNT_VAP7_8822C)) -+#define BIT_GET_DTIM_COUNT_VAP7_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_COUNT_VAP7_8822C) & \ -+ BIT_MASK_DTIM_COUNT_VAP7_8822C) -+#define BIT_SET_DTIM_COUNT_VAP7_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_COUNT_VAP7_8822C(x) | BIT_DTIM_COUNT_VAP7_8822C(v)) -+ -+/* 2 REG_DIS_ATIM_8822C */ -+#define BIT_DIS_ATIM_VAP7_8822C BIT(7) -+#define BIT_DIS_ATIM_VAP6_8822C BIT(6) -+#define BIT_DIS_ATIM_VAP5_8822C BIT(5) -+#define BIT_DIS_ATIM_VAP4_8822C BIT(4) -+#define BIT_DIS_ATIM_VAP3_8822C BIT(3) -+#define BIT_DIS_ATIM_VAP2_8822C BIT(2) -+#define BIT_DIS_ATIM_VAP1_8822C BIT(1) -+#define BIT_DIS_ATIM_ROOT_8822C BIT(0) -+ -+/* 2 REG_EARLY_128US_8822C */ -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER1_8822C 3 -+#define BIT_MASK_TSFT_SEL_TIMER1_8822C 0x7 -+#define BIT_TSFT_SEL_TIMER1_8822C(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER1_8822C) \ -+ << BIT_SHIFT_TSFT_SEL_TIMER1_8822C) -+#define BITS_TSFT_SEL_TIMER1_8822C \ -+ (BIT_MASK_TSFT_SEL_TIMER1_8822C << BIT_SHIFT_TSFT_SEL_TIMER1_8822C) -+#define BIT_CLEAR_TSFT_SEL_TIMER1_8822C(x) ((x) & (~BITS_TSFT_SEL_TIMER1_8822C)) -+#define BIT_GET_TSFT_SEL_TIMER1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER1_8822C) & \ -+ BIT_MASK_TSFT_SEL_TIMER1_8822C) -+#define BIT_SET_TSFT_SEL_TIMER1_8822C(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER1_8822C(x) | BIT_TSFT_SEL_TIMER1_8822C(v)) -+ -+#define BIT_SHIFT_EARLY_128US_8822C 0 -+#define BIT_MASK_EARLY_128US_8822C 0x7 -+#define BIT_EARLY_128US_8822C(x) \ -+ (((x) & BIT_MASK_EARLY_128US_8822C) << BIT_SHIFT_EARLY_128US_8822C) -+#define BITS_EARLY_128US_8822C \ -+ (BIT_MASK_EARLY_128US_8822C << BIT_SHIFT_EARLY_128US_8822C) -+#define BIT_CLEAR_EARLY_128US_8822C(x) ((x) & (~BITS_EARLY_128US_8822C)) -+#define BIT_GET_EARLY_128US_8822C(x) \ -+ (((x) >> BIT_SHIFT_EARLY_128US_8822C) & BIT_MASK_EARLY_128US_8822C) -+#define BIT_SET_EARLY_128US_8822C(x, v) \ -+ (BIT_CLEAR_EARLY_128US_8822C(x) | BIT_EARLY_128US_8822C(v)) -+ -+/* 2 REG_P2PPS1_CTRL_8822C */ -+#define BIT_P2P1_CTW_ALLSTASLEEP_8822C BIT(7) -+#define BIT_P2P1_OFF_DISTX_EN_8822C BIT(6) -+#define BIT_P2P1_PWR_MGT_EN_8822C BIT(5) -+#define BIT_P2P1_NOA1_EN_8822C BIT(2) -+#define BIT_P2P1_NOA0_EN_8822C BIT(1) -+ -+/* 2 REG_P2PPS2_CTRL_8822C */ -+#define BIT_P2P2_CTW_ALLSTASLEEP_8822C BIT(7) -+#define BIT_P2P2_OFF_DISTX_EN_8822C BIT(6) -+#define BIT_P2P2_PWR_MGT_EN_8822C BIT(5) -+#define BIT_P2P2_NOA1_EN_8822C BIT(2) -+#define BIT_P2P2_NOA0_EN_8822C BIT(1) -+ -+/* 2 REG_TIMER0_SRC_SEL_8822C */ -+ -+#define BIT_SHIFT_SYNC_CLI_SEL_8822C 4 -+#define BIT_MASK_SYNC_CLI_SEL_8822C 0x7 -+#define BIT_SYNC_CLI_SEL_8822C(x) \ -+ (((x) & BIT_MASK_SYNC_CLI_SEL_8822C) << BIT_SHIFT_SYNC_CLI_SEL_8822C) -+#define BITS_SYNC_CLI_SEL_8822C \ -+ (BIT_MASK_SYNC_CLI_SEL_8822C << BIT_SHIFT_SYNC_CLI_SEL_8822C) -+#define BIT_CLEAR_SYNC_CLI_SEL_8822C(x) ((x) & (~BITS_SYNC_CLI_SEL_8822C)) -+#define BIT_GET_SYNC_CLI_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_SYNC_CLI_SEL_8822C) & BIT_MASK_SYNC_CLI_SEL_8822C) -+#define BIT_SET_SYNC_CLI_SEL_8822C(x, v) \ -+ (BIT_CLEAR_SYNC_CLI_SEL_8822C(x) | BIT_SYNC_CLI_SEL_8822C(v)) -+ -+#define BIT_SHIFT_TSFT_SEL_TIMER0_8822C 0 -+#define BIT_MASK_TSFT_SEL_TIMER0_8822C 0x7 -+#define BIT_TSFT_SEL_TIMER0_8822C(x) \ -+ (((x) & BIT_MASK_TSFT_SEL_TIMER0_8822C) \ -+ << BIT_SHIFT_TSFT_SEL_TIMER0_8822C) -+#define BITS_TSFT_SEL_TIMER0_8822C \ -+ (BIT_MASK_TSFT_SEL_TIMER0_8822C << BIT_SHIFT_TSFT_SEL_TIMER0_8822C) -+#define BIT_CLEAR_TSFT_SEL_TIMER0_8822C(x) ((x) & (~BITS_TSFT_SEL_TIMER0_8822C)) -+#define BIT_GET_TSFT_SEL_TIMER0_8822C(x) \ -+ (((x) >> BIT_SHIFT_TSFT_SEL_TIMER0_8822C) & \ -+ BIT_MASK_TSFT_SEL_TIMER0_8822C) -+#define BIT_SET_TSFT_SEL_TIMER0_8822C(x, v) \ -+ (BIT_CLEAR_TSFT_SEL_TIMER0_8822C(x) | BIT_TSFT_SEL_TIMER0_8822C(v)) -+ -+/* 2 REG_NOA_UNIT_SEL_8822C */ -+ -+#define BIT_SHIFT_NOA_UNIT2_SEL_8822C 8 -+#define BIT_MASK_NOA_UNIT2_SEL_8822C 0x7 -+#define BIT_NOA_UNIT2_SEL_8822C(x) \ -+ (((x) & BIT_MASK_NOA_UNIT2_SEL_8822C) << BIT_SHIFT_NOA_UNIT2_SEL_8822C) -+#define BITS_NOA_UNIT2_SEL_8822C \ -+ (BIT_MASK_NOA_UNIT2_SEL_8822C << BIT_SHIFT_NOA_UNIT2_SEL_8822C) -+#define BIT_CLEAR_NOA_UNIT2_SEL_8822C(x) ((x) & (~BITS_NOA_UNIT2_SEL_8822C)) -+#define BIT_GET_NOA_UNIT2_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT2_SEL_8822C) & BIT_MASK_NOA_UNIT2_SEL_8822C) -+#define BIT_SET_NOA_UNIT2_SEL_8822C(x, v) \ -+ (BIT_CLEAR_NOA_UNIT2_SEL_8822C(x) | BIT_NOA_UNIT2_SEL_8822C(v)) -+ -+#define BIT_SHIFT_NOA_UNIT1_SEL_8822C 4 -+#define BIT_MASK_NOA_UNIT1_SEL_8822C 0x7 -+#define BIT_NOA_UNIT1_SEL_8822C(x) \ -+ (((x) & BIT_MASK_NOA_UNIT1_SEL_8822C) << BIT_SHIFT_NOA_UNIT1_SEL_8822C) -+#define BITS_NOA_UNIT1_SEL_8822C \ -+ (BIT_MASK_NOA_UNIT1_SEL_8822C << BIT_SHIFT_NOA_UNIT1_SEL_8822C) -+#define BIT_CLEAR_NOA_UNIT1_SEL_8822C(x) ((x) & (~BITS_NOA_UNIT1_SEL_8822C)) -+#define BIT_GET_NOA_UNIT1_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT1_SEL_8822C) & BIT_MASK_NOA_UNIT1_SEL_8822C) -+#define BIT_SET_NOA_UNIT1_SEL_8822C(x, v) \ -+ (BIT_CLEAR_NOA_UNIT1_SEL_8822C(x) | BIT_NOA_UNIT1_SEL_8822C(v)) -+ -+#define BIT_SHIFT_NOA_UNIT0_SEL_8822C 0 -+#define BIT_MASK_NOA_UNIT0_SEL_8822C 0x7 -+#define BIT_NOA_UNIT0_SEL_8822C(x) \ -+ (((x) & BIT_MASK_NOA_UNIT0_SEL_8822C) << BIT_SHIFT_NOA_UNIT0_SEL_8822C) -+#define BITS_NOA_UNIT0_SEL_8822C \ -+ (BIT_MASK_NOA_UNIT0_SEL_8822C << BIT_SHIFT_NOA_UNIT0_SEL_8822C) -+#define BIT_CLEAR_NOA_UNIT0_SEL_8822C(x) ((x) & (~BITS_NOA_UNIT0_SEL_8822C)) -+#define BIT_GET_NOA_UNIT0_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_NOA_UNIT0_SEL_8822C) & BIT_MASK_NOA_UNIT0_SEL_8822C) -+#define BIT_SET_NOA_UNIT0_SEL_8822C(x, v) \ -+ (BIT_CLEAR_NOA_UNIT0_SEL_8822C(x) | BIT_NOA_UNIT0_SEL_8822C(v)) -+ -+/* 2 REG_P2POFF_DIS_TXTIME_8822C */ -+ -+#define BIT_SHIFT_P2POFF_DIS_TXTIME_8822C 0 -+#define BIT_MASK_P2POFF_DIS_TXTIME_8822C 0xff -+#define BIT_P2POFF_DIS_TXTIME_8822C(x) \ -+ (((x) & BIT_MASK_P2POFF_DIS_TXTIME_8822C) \ -+ << BIT_SHIFT_P2POFF_DIS_TXTIME_8822C) -+#define BITS_P2POFF_DIS_TXTIME_8822C \ -+ (BIT_MASK_P2POFF_DIS_TXTIME_8822C << BIT_SHIFT_P2POFF_DIS_TXTIME_8822C) -+#define BIT_CLEAR_P2POFF_DIS_TXTIME_8822C(x) \ -+ ((x) & (~BITS_P2POFF_DIS_TXTIME_8822C)) -+#define BIT_GET_P2POFF_DIS_TXTIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_P2POFF_DIS_TXTIME_8822C) & \ -+ BIT_MASK_P2POFF_DIS_TXTIME_8822C) -+#define BIT_SET_P2POFF_DIS_TXTIME_8822C(x, v) \ -+ (BIT_CLEAR_P2POFF_DIS_TXTIME_8822C(x) | BIT_P2POFF_DIS_TXTIME_8822C(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE2_8822C */ -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT2_8822C 16 -+#define BIT_MASK_BCN_SPACE_CLINT2_8822C 0xfff -+#define BIT_BCN_SPACE_CLINT2_8822C(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT2_8822C) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT2_8822C) -+#define BITS_BCN_SPACE_CLINT2_8822C \ -+ (BIT_MASK_BCN_SPACE_CLINT2_8822C << BIT_SHIFT_BCN_SPACE_CLINT2_8822C) -+#define BIT_CLEAR_BCN_SPACE_CLINT2_8822C(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT2_8822C)) -+#define BIT_GET_BCN_SPACE_CLINT2_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT2_8822C) & \ -+ BIT_MASK_BCN_SPACE_CLINT2_8822C) -+#define BIT_SET_BCN_SPACE_CLINT2_8822C(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT2_8822C(x) | BIT_BCN_SPACE_CLINT2_8822C(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT1_8822C 0 -+#define BIT_MASK_BCN_SPACE_CLINT1_8822C 0xfff -+#define BIT_BCN_SPACE_CLINT1_8822C(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT1_8822C) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT1_8822C) -+#define BITS_BCN_SPACE_CLINT1_8822C \ -+ (BIT_MASK_BCN_SPACE_CLINT1_8822C << BIT_SHIFT_BCN_SPACE_CLINT1_8822C) -+#define BIT_CLEAR_BCN_SPACE_CLINT1_8822C(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT1_8822C)) -+#define BIT_GET_BCN_SPACE_CLINT1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT1_8822C) & \ -+ BIT_MASK_BCN_SPACE_CLINT1_8822C) -+#define BIT_SET_BCN_SPACE_CLINT1_8822C(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT1_8822C(x) | BIT_BCN_SPACE_CLINT1_8822C(v)) -+ -+/* 2 REG_MBSSID_BCN_SPACE3_8822C */ -+ -+#define BIT_SHIFT_SUB_BCN_SPACE_8822C 16 -+#define BIT_MASK_SUB_BCN_SPACE_8822C 0xff -+#define BIT_SUB_BCN_SPACE_8822C(x) \ -+ (((x) & BIT_MASK_SUB_BCN_SPACE_8822C) << BIT_SHIFT_SUB_BCN_SPACE_8822C) -+#define BITS_SUB_BCN_SPACE_8822C \ -+ (BIT_MASK_SUB_BCN_SPACE_8822C << BIT_SHIFT_SUB_BCN_SPACE_8822C) -+#define BIT_CLEAR_SUB_BCN_SPACE_8822C(x) ((x) & (~BITS_SUB_BCN_SPACE_8822C)) -+#define BIT_GET_SUB_BCN_SPACE_8822C(x) \ -+ (((x) >> BIT_SHIFT_SUB_BCN_SPACE_8822C) & BIT_MASK_SUB_BCN_SPACE_8822C) -+#define BIT_SET_SUB_BCN_SPACE_8822C(x, v) \ -+ (BIT_CLEAR_SUB_BCN_SPACE_8822C(x) | BIT_SUB_BCN_SPACE_8822C(v)) -+ -+#define BIT_SHIFT_BCN_SPACE_CLINT3_8822C 0 -+#define BIT_MASK_BCN_SPACE_CLINT3_8822C 0xfff -+#define BIT_BCN_SPACE_CLINT3_8822C(x) \ -+ (((x) & BIT_MASK_BCN_SPACE_CLINT3_8822C) \ -+ << BIT_SHIFT_BCN_SPACE_CLINT3_8822C) -+#define BITS_BCN_SPACE_CLINT3_8822C \ -+ (BIT_MASK_BCN_SPACE_CLINT3_8822C << BIT_SHIFT_BCN_SPACE_CLINT3_8822C) -+#define BIT_CLEAR_BCN_SPACE_CLINT3_8822C(x) \ -+ ((x) & (~BITS_BCN_SPACE_CLINT3_8822C)) -+#define BIT_GET_BCN_SPACE_CLINT3_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCN_SPACE_CLINT3_8822C) & \ -+ BIT_MASK_BCN_SPACE_CLINT3_8822C) -+#define BIT_SET_BCN_SPACE_CLINT3_8822C(x, v) \ -+ (BIT_CLEAR_BCN_SPACE_CLINT3_8822C(x) | BIT_BCN_SPACE_CLINT3_8822C(v)) -+ -+/* 2 REG_ACMHWCTRL_8822C */ -+#define BIT_BEQ_ACM_STATUS_8822C BIT(7) -+#define BIT_VIQ_ACM_STATUS_8822C BIT(6) -+#define BIT_VOQ_ACM_STATUS_8822C BIT(5) -+#define BIT_BEQ_ACM_EN_8822C BIT(3) -+#define BIT_VIQ_ACM_EN_8822C BIT(2) -+#define BIT_VOQ_ACM_EN_8822C BIT(1) -+#define BIT_ACMHWEN_8822C BIT(0) -+ -+/* 2 REG_ACMRSTCTRL_8822C */ -+#define BIT_BE_ACM_RESET_USED_TIME_8822C BIT(2) -+#define BIT_VI_ACM_RESET_USED_TIME_8822C BIT(1) -+#define BIT_VO_ACM_RESET_USED_TIME_8822C BIT(0) -+ -+/* 2 REG_ACMAVG_8822C */ -+ -+#define BIT_SHIFT_AVGPERIOD_8822C 0 -+#define BIT_MASK_AVGPERIOD_8822C 0xffff -+#define BIT_AVGPERIOD_8822C(x) \ -+ (((x) & BIT_MASK_AVGPERIOD_8822C) << BIT_SHIFT_AVGPERIOD_8822C) -+#define BITS_AVGPERIOD_8822C \ -+ (BIT_MASK_AVGPERIOD_8822C << BIT_SHIFT_AVGPERIOD_8822C) -+#define BIT_CLEAR_AVGPERIOD_8822C(x) ((x) & (~BITS_AVGPERIOD_8822C)) -+#define BIT_GET_AVGPERIOD_8822C(x) \ -+ (((x) >> BIT_SHIFT_AVGPERIOD_8822C) & BIT_MASK_AVGPERIOD_8822C) -+#define BIT_SET_AVGPERIOD_8822C(x, v) \ -+ (BIT_CLEAR_AVGPERIOD_8822C(x) | BIT_AVGPERIOD_8822C(v)) -+ -+/* 2 REG_VO_ADMTIME_8822C */ -+ -+#define BIT_SHIFT_VO_ADMITTED_TIME_8822C 0 -+#define BIT_MASK_VO_ADMITTED_TIME_8822C 0xffff -+#define BIT_VO_ADMITTED_TIME_8822C(x) \ -+ (((x) & BIT_MASK_VO_ADMITTED_TIME_8822C) \ -+ << BIT_SHIFT_VO_ADMITTED_TIME_8822C) -+#define BITS_VO_ADMITTED_TIME_8822C \ -+ (BIT_MASK_VO_ADMITTED_TIME_8822C << BIT_SHIFT_VO_ADMITTED_TIME_8822C) -+#define BIT_CLEAR_VO_ADMITTED_TIME_8822C(x) \ -+ ((x) & (~BITS_VO_ADMITTED_TIME_8822C)) -+#define BIT_GET_VO_ADMITTED_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_VO_ADMITTED_TIME_8822C) & \ -+ BIT_MASK_VO_ADMITTED_TIME_8822C) -+#define BIT_SET_VO_ADMITTED_TIME_8822C(x, v) \ -+ (BIT_CLEAR_VO_ADMITTED_TIME_8822C(x) | BIT_VO_ADMITTED_TIME_8822C(v)) -+ -+/* 2 REG_VI_ADMTIME_8822C */ -+ -+#define BIT_SHIFT_VI_ADMITTED_TIME_8822C 0 -+#define BIT_MASK_VI_ADMITTED_TIME_8822C 0xffff -+#define BIT_VI_ADMITTED_TIME_8822C(x) \ -+ (((x) & BIT_MASK_VI_ADMITTED_TIME_8822C) \ -+ << BIT_SHIFT_VI_ADMITTED_TIME_8822C) -+#define BITS_VI_ADMITTED_TIME_8822C \ -+ (BIT_MASK_VI_ADMITTED_TIME_8822C << BIT_SHIFT_VI_ADMITTED_TIME_8822C) -+#define BIT_CLEAR_VI_ADMITTED_TIME_8822C(x) \ -+ ((x) & (~BITS_VI_ADMITTED_TIME_8822C)) -+#define BIT_GET_VI_ADMITTED_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_VI_ADMITTED_TIME_8822C) & \ -+ BIT_MASK_VI_ADMITTED_TIME_8822C) -+#define BIT_SET_VI_ADMITTED_TIME_8822C(x, v) \ -+ (BIT_CLEAR_VI_ADMITTED_TIME_8822C(x) | BIT_VI_ADMITTED_TIME_8822C(v)) -+ -+/* 2 REG_BE_ADMTIME_8822C */ -+ -+#define BIT_SHIFT_BE_ADMITTED_TIME_8822C 0 -+#define BIT_MASK_BE_ADMITTED_TIME_8822C 0xffff -+#define BIT_BE_ADMITTED_TIME_8822C(x) \ -+ (((x) & BIT_MASK_BE_ADMITTED_TIME_8822C) \ -+ << BIT_SHIFT_BE_ADMITTED_TIME_8822C) -+#define BITS_BE_ADMITTED_TIME_8822C \ -+ (BIT_MASK_BE_ADMITTED_TIME_8822C << BIT_SHIFT_BE_ADMITTED_TIME_8822C) -+#define BIT_CLEAR_BE_ADMITTED_TIME_8822C(x) \ -+ ((x) & (~BITS_BE_ADMITTED_TIME_8822C)) -+#define BIT_GET_BE_ADMITTED_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_BE_ADMITTED_TIME_8822C) & \ -+ BIT_MASK_BE_ADMITTED_TIME_8822C) -+#define BIT_SET_BE_ADMITTED_TIME_8822C(x, v) \ -+ (BIT_CLEAR_BE_ADMITTED_TIME_8822C(x) | BIT_BE_ADMITTED_TIME_8822C(v)) -+ -+/* 2 REG_MAC_HEADER_NAV_OFFSET_8822C */ -+ -+#define BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8822C 0 -+#define BIT_MASK_MAC_HEADER_NAV_OFFSET_8822C 0xff -+#define BIT_MAC_HEADER_NAV_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_MAC_HEADER_NAV_OFFSET_8822C) \ -+ << BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8822C) -+#define BITS_MAC_HEADER_NAV_OFFSET_8822C \ -+ (BIT_MASK_MAC_HEADER_NAV_OFFSET_8822C \ -+ << BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8822C) -+#define BIT_CLEAR_MAC_HEADER_NAV_OFFSET_8822C(x) \ -+ ((x) & (~BITS_MAC_HEADER_NAV_OFFSET_8822C)) -+#define BIT_GET_MAC_HEADER_NAV_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAC_HEADER_NAV_OFFSET_8822C) & \ -+ BIT_MASK_MAC_HEADER_NAV_OFFSET_8822C) -+#define BIT_SET_MAC_HEADER_NAV_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_MAC_HEADER_NAV_OFFSET_8822C(x) | \ -+ BIT_MAC_HEADER_NAV_OFFSET_8822C(v)) -+ -+/* 2 REG_DIS_NDPA_NAV_CHECK_8822C */ -+#define BIT_CHG_POWER_BCN_AREA_V1_8822C BIT(1) -+#define BIT_DIS_NDPA_NAV_CHECK_8822C BIT(0) -+ -+/* 2 REG_EDCA_RANDOM_GEN_8822C */ -+ -+#define BIT_SHIFT_RANDOM_GEN_8822C 0 -+#define BIT_MASK_RANDOM_GEN_8822C 0xffffff -+#define BIT_RANDOM_GEN_8822C(x) \ -+ (((x) & BIT_MASK_RANDOM_GEN_8822C) << BIT_SHIFT_RANDOM_GEN_8822C) -+#define BITS_RANDOM_GEN_8822C \ -+ (BIT_MASK_RANDOM_GEN_8822C << BIT_SHIFT_RANDOM_GEN_8822C) -+#define BIT_CLEAR_RANDOM_GEN_8822C(x) ((x) & (~BITS_RANDOM_GEN_8822C)) -+#define BIT_GET_RANDOM_GEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_RANDOM_GEN_8822C) & BIT_MASK_RANDOM_GEN_8822C) -+#define BIT_SET_RANDOM_GEN_8822C(x, v) \ -+ (BIT_CLEAR_RANDOM_GEN_8822C(x) | BIT_RANDOM_GEN_8822C(v)) -+ -+/* 2 REG_TXCMD_NOA_SEL_8822C */ -+ -+#define BIT_SHIFT_NOA_SEL_V2_8822C 4 -+#define BIT_MASK_NOA_SEL_V2_8822C 0x7 -+#define BIT_NOA_SEL_V2_8822C(x) \ -+ (((x) & BIT_MASK_NOA_SEL_V2_8822C) << BIT_SHIFT_NOA_SEL_V2_8822C) -+#define BITS_NOA_SEL_V2_8822C \ -+ (BIT_MASK_NOA_SEL_V2_8822C << BIT_SHIFT_NOA_SEL_V2_8822C) -+#define BIT_CLEAR_NOA_SEL_V2_8822C(x) ((x) & (~BITS_NOA_SEL_V2_8822C)) -+#define BIT_GET_NOA_SEL_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_NOA_SEL_V2_8822C) & BIT_MASK_NOA_SEL_V2_8822C) -+#define BIT_SET_NOA_SEL_V2_8822C(x, v) \ -+ (BIT_CLEAR_NOA_SEL_V2_8822C(x) | BIT_NOA_SEL_V2_8822C(v)) -+ -+#define BIT_SHIFT_TXCMD_SEG_SEL_8822C 0 -+#define BIT_MASK_TXCMD_SEG_SEL_8822C 0xf -+#define BIT_TXCMD_SEG_SEL_8822C(x) \ -+ (((x) & BIT_MASK_TXCMD_SEG_SEL_8822C) << BIT_SHIFT_TXCMD_SEG_SEL_8822C) -+#define BITS_TXCMD_SEG_SEL_8822C \ -+ (BIT_MASK_TXCMD_SEG_SEL_8822C << BIT_SHIFT_TXCMD_SEG_SEL_8822C) -+#define BIT_CLEAR_TXCMD_SEG_SEL_8822C(x) ((x) & (~BITS_TXCMD_SEG_SEL_8822C)) -+#define BIT_GET_TXCMD_SEG_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXCMD_SEG_SEL_8822C) & BIT_MASK_TXCMD_SEG_SEL_8822C) -+#define BIT_SET_TXCMD_SEG_SEL_8822C(x, v) \ -+ (BIT_CLEAR_TXCMD_SEG_SEL_8822C(x) | BIT_TXCMD_SEG_SEL_8822C(v)) -+ -+/* 2 REG_32K_CLK_SEL_8822C */ -+#define BIT_R_BCNERR_CNT_EN_8822C BIT(20) -+ -+#define BIT_SHIFT_R_BCNERR_PORT_SEL_8822C 16 -+#define BIT_MASK_R_BCNERR_PORT_SEL_8822C 0x7 -+#define BIT_R_BCNERR_PORT_SEL_8822C(x) \ -+ (((x) & BIT_MASK_R_BCNERR_PORT_SEL_8822C) \ -+ << BIT_SHIFT_R_BCNERR_PORT_SEL_8822C) -+#define BITS_R_BCNERR_PORT_SEL_8822C \ -+ (BIT_MASK_R_BCNERR_PORT_SEL_8822C << BIT_SHIFT_R_BCNERR_PORT_SEL_8822C) -+#define BIT_CLEAR_R_BCNERR_PORT_SEL_8822C(x) \ -+ ((x) & (~BITS_R_BCNERR_PORT_SEL_8822C)) -+#define BIT_GET_R_BCNERR_PORT_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_BCNERR_PORT_SEL_8822C) & \ -+ BIT_MASK_R_BCNERR_PORT_SEL_8822C) -+#define BIT_SET_R_BCNERR_PORT_SEL_8822C(x, v) \ -+ (BIT_CLEAR_R_BCNERR_PORT_SEL_8822C(x) | BIT_R_BCNERR_PORT_SEL_8822C(v)) -+ -+#define BIT_SHIFT_R_TXPAUSE1_8822C 8 -+#define BIT_MASK_R_TXPAUSE1_8822C 0xff -+#define BIT_R_TXPAUSE1_8822C(x) \ -+ (((x) & BIT_MASK_R_TXPAUSE1_8822C) << BIT_SHIFT_R_TXPAUSE1_8822C) -+#define BITS_R_TXPAUSE1_8822C \ -+ (BIT_MASK_R_TXPAUSE1_8822C << BIT_SHIFT_R_TXPAUSE1_8822C) -+#define BIT_CLEAR_R_TXPAUSE1_8822C(x) ((x) & (~BITS_R_TXPAUSE1_8822C)) -+#define BIT_GET_R_TXPAUSE1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_TXPAUSE1_8822C) & BIT_MASK_R_TXPAUSE1_8822C) -+#define BIT_SET_R_TXPAUSE1_8822C(x, v) \ -+ (BIT_CLEAR_R_TXPAUSE1_8822C(x) | BIT_R_TXPAUSE1_8822C(v)) -+ -+#define BIT_SLEEP_32K_EN_V1_8822C BIT(2) -+ -+#define BIT_SHIFT_BW_CFG_8822C 0 -+#define BIT_MASK_BW_CFG_8822C 0x3 -+#define BIT_BW_CFG_8822C(x) \ -+ (((x) & BIT_MASK_BW_CFG_8822C) << BIT_SHIFT_BW_CFG_8822C) -+#define BITS_BW_CFG_8822C (BIT_MASK_BW_CFG_8822C << BIT_SHIFT_BW_CFG_8822C) -+#define BIT_CLEAR_BW_CFG_8822C(x) ((x) & (~BITS_BW_CFG_8822C)) -+#define BIT_GET_BW_CFG_8822C(x) \ -+ (((x) >> BIT_SHIFT_BW_CFG_8822C) & BIT_MASK_BW_CFG_8822C) -+#define BIT_SET_BW_CFG_8822C(x, v) \ -+ (BIT_CLEAR_BW_CFG_8822C(x) | BIT_BW_CFG_8822C(v)) -+ -+/* 2 REG_EARLYINT_ADJUST_8822C */ -+ -+#define BIT_SHIFT_RXBCN_TIMER_8822C 16 -+#define BIT_MASK_RXBCN_TIMER_8822C 0xffff -+#define BIT_RXBCN_TIMER_8822C(x) \ -+ (((x) & BIT_MASK_RXBCN_TIMER_8822C) << BIT_SHIFT_RXBCN_TIMER_8822C) -+#define BITS_RXBCN_TIMER_8822C \ -+ (BIT_MASK_RXBCN_TIMER_8822C << BIT_SHIFT_RXBCN_TIMER_8822C) -+#define BIT_CLEAR_RXBCN_TIMER_8822C(x) ((x) & (~BITS_RXBCN_TIMER_8822C)) -+#define BIT_GET_RXBCN_TIMER_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXBCN_TIMER_8822C) & BIT_MASK_RXBCN_TIMER_8822C) -+#define BIT_SET_RXBCN_TIMER_8822C(x, v) \ -+ (BIT_CLEAR_RXBCN_TIMER_8822C(x) | BIT_RXBCN_TIMER_8822C(v)) -+ -+#define BIT_SHIFT_R_ERLYINTADJ_8822C 0 -+#define BIT_MASK_R_ERLYINTADJ_8822C 0xffff -+#define BIT_R_ERLYINTADJ_8822C(x) \ -+ (((x) & BIT_MASK_R_ERLYINTADJ_8822C) << BIT_SHIFT_R_ERLYINTADJ_8822C) -+#define BITS_R_ERLYINTADJ_8822C \ -+ (BIT_MASK_R_ERLYINTADJ_8822C << BIT_SHIFT_R_ERLYINTADJ_8822C) -+#define BIT_CLEAR_R_ERLYINTADJ_8822C(x) ((x) & (~BITS_R_ERLYINTADJ_8822C)) -+#define BIT_GET_R_ERLYINTADJ_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_ERLYINTADJ_8822C) & BIT_MASK_R_ERLYINTADJ_8822C) -+#define BIT_SET_R_ERLYINTADJ_8822C(x, v) \ -+ (BIT_CLEAR_R_ERLYINTADJ_8822C(x) | BIT_R_ERLYINTADJ_8822C(v)) -+ -+/* 2 REG_BCNERR_CNT_8822C */ -+ -+#define BIT_SHIFT_BCNERR_CNT_OTHERS_8822C 24 -+#define BIT_MASK_BCNERR_CNT_OTHERS_8822C 0xff -+#define BIT_BCNERR_CNT_OTHERS_8822C(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_OTHERS_8822C) \ -+ << BIT_SHIFT_BCNERR_CNT_OTHERS_8822C) -+#define BITS_BCNERR_CNT_OTHERS_8822C \ -+ (BIT_MASK_BCNERR_CNT_OTHERS_8822C << BIT_SHIFT_BCNERR_CNT_OTHERS_8822C) -+#define BIT_CLEAR_BCNERR_CNT_OTHERS_8822C(x) \ -+ ((x) & (~BITS_BCNERR_CNT_OTHERS_8822C)) -+#define BIT_GET_BCNERR_CNT_OTHERS_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_OTHERS_8822C) & \ -+ BIT_MASK_BCNERR_CNT_OTHERS_8822C) -+#define BIT_SET_BCNERR_CNT_OTHERS_8822C(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_OTHERS_8822C(x) | BIT_BCNERR_CNT_OTHERS_8822C(v)) -+ -+#define BIT_SHIFT_BCNERR_CNT_INVALID_8822C 16 -+#define BIT_MASK_BCNERR_CNT_INVALID_8822C 0xff -+#define BIT_BCNERR_CNT_INVALID_8822C(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_INVALID_8822C) \ -+ << BIT_SHIFT_BCNERR_CNT_INVALID_8822C) -+#define BITS_BCNERR_CNT_INVALID_8822C \ -+ (BIT_MASK_BCNERR_CNT_INVALID_8822C \ -+ << BIT_SHIFT_BCNERR_CNT_INVALID_8822C) -+#define BIT_CLEAR_BCNERR_CNT_INVALID_8822C(x) \ -+ ((x) & (~BITS_BCNERR_CNT_INVALID_8822C)) -+#define BIT_GET_BCNERR_CNT_INVALID_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_INVALID_8822C) & \ -+ BIT_MASK_BCNERR_CNT_INVALID_8822C) -+#define BIT_SET_BCNERR_CNT_INVALID_8822C(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_INVALID_8822C(x) | \ -+ BIT_BCNERR_CNT_INVALID_8822C(v)) -+ -+#define BIT_SHIFT_BCNERR_CNT_MAC_8822C 8 -+#define BIT_MASK_BCNERR_CNT_MAC_8822C 0xff -+#define BIT_BCNERR_CNT_MAC_8822C(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_MAC_8822C) \ -+ << BIT_SHIFT_BCNERR_CNT_MAC_8822C) -+#define BITS_BCNERR_CNT_MAC_8822C \ -+ (BIT_MASK_BCNERR_CNT_MAC_8822C << BIT_SHIFT_BCNERR_CNT_MAC_8822C) -+#define BIT_CLEAR_BCNERR_CNT_MAC_8822C(x) ((x) & (~BITS_BCNERR_CNT_MAC_8822C)) -+#define BIT_GET_BCNERR_CNT_MAC_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_MAC_8822C) & \ -+ BIT_MASK_BCNERR_CNT_MAC_8822C) -+#define BIT_SET_BCNERR_CNT_MAC_8822C(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_MAC_8822C(x) | BIT_BCNERR_CNT_MAC_8822C(v)) -+ -+#define BIT_SHIFT_BCNERR_CNT_CCA_8822C 0 -+#define BIT_MASK_BCNERR_CNT_CCA_8822C 0xff -+#define BIT_BCNERR_CNT_CCA_8822C(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_CCA_8822C) \ -+ << BIT_SHIFT_BCNERR_CNT_CCA_8822C) -+#define BITS_BCNERR_CNT_CCA_8822C \ -+ (BIT_MASK_BCNERR_CNT_CCA_8822C << BIT_SHIFT_BCNERR_CNT_CCA_8822C) -+#define BIT_CLEAR_BCNERR_CNT_CCA_8822C(x) ((x) & (~BITS_BCNERR_CNT_CCA_8822C)) -+#define BIT_GET_BCNERR_CNT_CCA_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_CCA_8822C) & \ -+ BIT_MASK_BCNERR_CNT_CCA_8822C) -+#define BIT_SET_BCNERR_CNT_CCA_8822C(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_CCA_8822C(x) | BIT_BCNERR_CNT_CCA_8822C(v)) -+ -+/* 2 REG_BCNERR_CNT_2_8822C */ -+ -+#define BIT_SHIFT_BCNERR_CNT_EDCCA_8822C 0 -+#define BIT_MASK_BCNERR_CNT_EDCCA_8822C 0xff -+#define BIT_BCNERR_CNT_EDCCA_8822C(x) \ -+ (((x) & BIT_MASK_BCNERR_CNT_EDCCA_8822C) \ -+ << BIT_SHIFT_BCNERR_CNT_EDCCA_8822C) -+#define BITS_BCNERR_CNT_EDCCA_8822C \ -+ (BIT_MASK_BCNERR_CNT_EDCCA_8822C << BIT_SHIFT_BCNERR_CNT_EDCCA_8822C) -+#define BIT_CLEAR_BCNERR_CNT_EDCCA_8822C(x) \ -+ ((x) & (~BITS_BCNERR_CNT_EDCCA_8822C)) -+#define BIT_GET_BCNERR_CNT_EDCCA_8822C(x) \ -+ (((x) >> BIT_SHIFT_BCNERR_CNT_EDCCA_8822C) & \ -+ BIT_MASK_BCNERR_CNT_EDCCA_8822C) -+#define BIT_SET_BCNERR_CNT_EDCCA_8822C(x, v) \ -+ (BIT_CLEAR_BCNERR_CNT_EDCCA_8822C(x) | BIT_BCNERR_CNT_EDCCA_8822C(v)) -+ -+/* 2 REG_NOA_PARAM_8822C */ -+ -+#define BIT_SHIFT_NOA_DURATION_V1_8822C 0 -+#define BIT_MASK_NOA_DURATION_V1_8822C 0xffffffffL -+#define BIT_NOA_DURATION_V1_8822C(x) \ -+ (((x) & BIT_MASK_NOA_DURATION_V1_8822C) \ -+ << BIT_SHIFT_NOA_DURATION_V1_8822C) -+#define BITS_NOA_DURATION_V1_8822C \ -+ (BIT_MASK_NOA_DURATION_V1_8822C << BIT_SHIFT_NOA_DURATION_V1_8822C) -+#define BIT_CLEAR_NOA_DURATION_V1_8822C(x) ((x) & (~BITS_NOA_DURATION_V1_8822C)) -+#define BIT_GET_NOA_DURATION_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_NOA_DURATION_V1_8822C) & \ -+ BIT_MASK_NOA_DURATION_V1_8822C) -+#define BIT_SET_NOA_DURATION_V1_8822C(x, v) \ -+ (BIT_CLEAR_NOA_DURATION_V1_8822C(x) | BIT_NOA_DURATION_V1_8822C(v)) -+ -+/* 2 REG_NOA_PARAM_1_8822C */ -+ -+#define BIT_SHIFT_NOA_INTERVAL_V1_8822C 0 -+#define BIT_MASK_NOA_INTERVAL_V1_8822C 0xffffffffL -+#define BIT_NOA_INTERVAL_V1_8822C(x) \ -+ (((x) & BIT_MASK_NOA_INTERVAL_V1_8822C) \ -+ << BIT_SHIFT_NOA_INTERVAL_V1_8822C) -+#define BITS_NOA_INTERVAL_V1_8822C \ -+ (BIT_MASK_NOA_INTERVAL_V1_8822C << BIT_SHIFT_NOA_INTERVAL_V1_8822C) -+#define BIT_CLEAR_NOA_INTERVAL_V1_8822C(x) ((x) & (~BITS_NOA_INTERVAL_V1_8822C)) -+#define BIT_GET_NOA_INTERVAL_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_NOA_INTERVAL_V1_8822C) & \ -+ BIT_MASK_NOA_INTERVAL_V1_8822C) -+#define BIT_SET_NOA_INTERVAL_V1_8822C(x, v) \ -+ (BIT_CLEAR_NOA_INTERVAL_V1_8822C(x) | BIT_NOA_INTERVAL_V1_8822C(v)) -+ -+/* 2 REG_NOA_PARAM_2_8822C */ -+ -+#define BIT_SHIFT_NOA_START_TIME_V1_8822C 0 -+#define BIT_MASK_NOA_START_TIME_V1_8822C 0xffffffffL -+#define BIT_NOA_START_TIME_V1_8822C(x) \ -+ (((x) & BIT_MASK_NOA_START_TIME_V1_8822C) \ -+ << BIT_SHIFT_NOA_START_TIME_V1_8822C) -+#define BITS_NOA_START_TIME_V1_8822C \ -+ (BIT_MASK_NOA_START_TIME_V1_8822C << BIT_SHIFT_NOA_START_TIME_V1_8822C) -+#define BIT_CLEAR_NOA_START_TIME_V1_8822C(x) \ -+ ((x) & (~BITS_NOA_START_TIME_V1_8822C)) -+#define BIT_GET_NOA_START_TIME_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_NOA_START_TIME_V1_8822C) & \ -+ BIT_MASK_NOA_START_TIME_V1_8822C) -+#define BIT_SET_NOA_START_TIME_V1_8822C(x, v) \ -+ (BIT_CLEAR_NOA_START_TIME_V1_8822C(x) | BIT_NOA_START_TIME_V1_8822C(v)) -+ -+/* 2 REG_NOA_PARAM_3_8822C */ -+ -+#define BIT_SHIFT_NOA_COUNT_V1_8822C 0 -+#define BIT_MASK_NOA_COUNT_V1_8822C 0xffffffffL -+#define BIT_NOA_COUNT_V1_8822C(x) \ -+ (((x) & BIT_MASK_NOA_COUNT_V1_8822C) << BIT_SHIFT_NOA_COUNT_V1_8822C) -+#define BITS_NOA_COUNT_V1_8822C \ -+ (BIT_MASK_NOA_COUNT_V1_8822C << BIT_SHIFT_NOA_COUNT_V1_8822C) -+#define BIT_CLEAR_NOA_COUNT_V1_8822C(x) ((x) & (~BITS_NOA_COUNT_V1_8822C)) -+#define BIT_GET_NOA_COUNT_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_NOA_COUNT_V1_8822C) & BIT_MASK_NOA_COUNT_V1_8822C) -+#define BIT_SET_NOA_COUNT_V1_8822C(x, v) \ -+ (BIT_CLEAR_NOA_COUNT_V1_8822C(x) | BIT_NOA_COUNT_V1_8822C(v)) -+ -+/* 2 REG_P2P_RST_8822C */ -+#define BIT_P2P2_PWR_RST1_8822C BIT(5) -+#define BIT_P2P2_PWR_RST0_8822C BIT(4) -+#define BIT_P2P1_PWR_RST1_8822C BIT(3) -+#define BIT_P2P1_PWR_RST0_8822C BIT(2) -+#define BIT_P2P_PWR_RST1_V1_8822C BIT(1) -+#define BIT_P2P_PWR_RST0_V1_8822C BIT(0) -+ -+/* 2 REG_SCHEDULER_RST_8822C */ -+#define BIT_SYNC_CLI_ONCE_RIGHT_NOW_8822C BIT(2) -+#define BIT_SYNC_CLI_ONCE_BY_TBTT_8822C BIT(1) -+#define BIT_SCHEDULER_RST_V1_8822C BIT(0) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_SCH_DBG_VALUE_8822C */ -+ -+#define BIT_SHIFT_SCH_DBG_VALUE_8822C 0 -+#define BIT_MASK_SCH_DBG_VALUE_8822C 0xffffffffL -+#define BIT_SCH_DBG_VALUE_8822C(x) \ -+ (((x) & BIT_MASK_SCH_DBG_VALUE_8822C) << BIT_SHIFT_SCH_DBG_VALUE_8822C) -+#define BITS_SCH_DBG_VALUE_8822C \ -+ (BIT_MASK_SCH_DBG_VALUE_8822C << BIT_SHIFT_SCH_DBG_VALUE_8822C) -+#define BIT_CLEAR_SCH_DBG_VALUE_8822C(x) ((x) & (~BITS_SCH_DBG_VALUE_8822C)) -+#define BIT_GET_SCH_DBG_VALUE_8822C(x) \ -+ (((x) >> BIT_SHIFT_SCH_DBG_VALUE_8822C) & BIT_MASK_SCH_DBG_VALUE_8822C) -+#define BIT_SET_SCH_DBG_VALUE_8822C(x, v) \ -+ (BIT_CLEAR_SCH_DBG_VALUE_8822C(x) | BIT_SCH_DBG_VALUE_8822C(v)) -+ -+/* 2 REG_SCH_TXCMD_8822C */ -+ -+#define BIT_SHIFT_SCH_TXCMD_8822C 0 -+#define BIT_MASK_SCH_TXCMD_8822C 0xffffffffL -+#define BIT_SCH_TXCMD_8822C(x) \ -+ (((x) & BIT_MASK_SCH_TXCMD_8822C) << BIT_SHIFT_SCH_TXCMD_8822C) -+#define BITS_SCH_TXCMD_8822C \ -+ (BIT_MASK_SCH_TXCMD_8822C << BIT_SHIFT_SCH_TXCMD_8822C) -+#define BIT_CLEAR_SCH_TXCMD_8822C(x) ((x) & (~BITS_SCH_TXCMD_8822C)) -+#define BIT_GET_SCH_TXCMD_8822C(x) \ -+ (((x) >> BIT_SHIFT_SCH_TXCMD_8822C) & BIT_MASK_SCH_TXCMD_8822C) -+#define BIT_SET_SCH_TXCMD_8822C(x, v) \ -+ (BIT_CLEAR_SCH_TXCMD_8822C(x) | BIT_SCH_TXCMD_8822C(v)) -+ -+/* 2 REG_PAGE5_DUMMY_8822C */ -+ -+/* 2 REG_CPUMGQ_TX_TIMER_8822C */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8822C 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_V1_8822C 0xffffffffL -+#define BIT_CPUMGQ_TX_TIMER_V1_8822C(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_V1_8822C) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8822C) -+#define BITS_CPUMGQ_TX_TIMER_V1_8822C \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_V1_8822C \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8822C) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8822C(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_V1_8822C)) -+#define BIT_GET_CPUMGQ_TX_TIMER_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_V1_8822C) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_V1_8822C) -+#define BIT_SET_CPUMGQ_TX_TIMER_V1_8822C(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_V1_8822C(x) | \ -+ BIT_CPUMGQ_TX_TIMER_V1_8822C(v)) -+ -+/* 2 REG_PS_TIMER_A_8822C */ -+ -+#define BIT_SHIFT_PS_TIMER_A_V1_8822C 0 -+#define BIT_MASK_PS_TIMER_A_V1_8822C 0xffffffffL -+#define BIT_PS_TIMER_A_V1_8822C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_V1_8822C) << BIT_SHIFT_PS_TIMER_A_V1_8822C) -+#define BITS_PS_TIMER_A_V1_8822C \ -+ (BIT_MASK_PS_TIMER_A_V1_8822C << BIT_SHIFT_PS_TIMER_A_V1_8822C) -+#define BIT_CLEAR_PS_TIMER_A_V1_8822C(x) ((x) & (~BITS_PS_TIMER_A_V1_8822C)) -+#define BIT_GET_PS_TIMER_A_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_V1_8822C) & BIT_MASK_PS_TIMER_A_V1_8822C) -+#define BIT_SET_PS_TIMER_A_V1_8822C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_V1_8822C(x) | BIT_PS_TIMER_A_V1_8822C(v)) -+ -+/* 2 REG_PS_TIMER_B_8822C */ -+ -+#define BIT_SHIFT_PS_TIMER_B_V1_8822C 0 -+#define BIT_MASK_PS_TIMER_B_V1_8822C 0xffffffffL -+#define BIT_PS_TIMER_B_V1_8822C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_V1_8822C) << BIT_SHIFT_PS_TIMER_B_V1_8822C) -+#define BITS_PS_TIMER_B_V1_8822C \ -+ (BIT_MASK_PS_TIMER_B_V1_8822C << BIT_SHIFT_PS_TIMER_B_V1_8822C) -+#define BIT_CLEAR_PS_TIMER_B_V1_8822C(x) ((x) & (~BITS_PS_TIMER_B_V1_8822C)) -+#define BIT_GET_PS_TIMER_B_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_V1_8822C) & BIT_MASK_PS_TIMER_B_V1_8822C) -+#define BIT_SET_PS_TIMER_B_V1_8822C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_V1_8822C(x) | BIT_PS_TIMER_B_V1_8822C(v)) -+ -+/* 2 REG_PS_TIMER_C_8822C */ -+ -+#define BIT_SHIFT_PS_TIMER_C_V1_8822C 0 -+#define BIT_MASK_PS_TIMER_C_V1_8822C 0xffffffffL -+#define BIT_PS_TIMER_C_V1_8822C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_V1_8822C) << BIT_SHIFT_PS_TIMER_C_V1_8822C) -+#define BITS_PS_TIMER_C_V1_8822C \ -+ (BIT_MASK_PS_TIMER_C_V1_8822C << BIT_SHIFT_PS_TIMER_C_V1_8822C) -+#define BIT_CLEAR_PS_TIMER_C_V1_8822C(x) ((x) & (~BITS_PS_TIMER_C_V1_8822C)) -+#define BIT_GET_PS_TIMER_C_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_V1_8822C) & BIT_MASK_PS_TIMER_C_V1_8822C) -+#define BIT_SET_PS_TIMER_C_V1_8822C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_V1_8822C(x) | BIT_PS_TIMER_C_V1_8822C(v)) -+ -+/* 2 REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL_8822C */ -+#define BIT_CPUMGQ_TIMER_EN_8822C BIT(31) -+#define BIT_CPUMGQ_TX_EN_8822C BIT(28) -+ -+#define BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8822C 24 -+#define BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8822C 0x7 -+#define BIT_CPUMGQ_TIMER_TSF_SEL_8822C(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8822C) \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8822C) -+#define BITS_CPUMGQ_TIMER_TSF_SEL_8822C \ -+ (BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8822C \ -+ << BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8822C) -+#define BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_8822C(x) \ -+ ((x) & (~BITS_CPUMGQ_TIMER_TSF_SEL_8822C)) -+#define BIT_GET_CPUMGQ_TIMER_TSF_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TIMER_TSF_SEL_8822C) & \ -+ BIT_MASK_CPUMGQ_TIMER_TSF_SEL_8822C) -+#define BIT_SET_CPUMGQ_TIMER_TSF_SEL_8822C(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TIMER_TSF_SEL_8822C(x) | \ -+ BIT_CPUMGQ_TIMER_TSF_SEL_8822C(v)) -+ -+#define BIT_PS_TIMER_C_EN_8822C BIT(23) -+ -+#define BIT_SHIFT_PS_TIMER_C_TSF_SEL_8822C 16 -+#define BIT_MASK_PS_TIMER_C_TSF_SEL_8822C 0x7 -+#define BIT_PS_TIMER_C_TSF_SEL_8822C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_TSF_SEL_8822C) \ -+ << BIT_SHIFT_PS_TIMER_C_TSF_SEL_8822C) -+#define BITS_PS_TIMER_C_TSF_SEL_8822C \ -+ (BIT_MASK_PS_TIMER_C_TSF_SEL_8822C \ -+ << BIT_SHIFT_PS_TIMER_C_TSF_SEL_8822C) -+#define BIT_CLEAR_PS_TIMER_C_TSF_SEL_8822C(x) \ -+ ((x) & (~BITS_PS_TIMER_C_TSF_SEL_8822C)) -+#define BIT_GET_PS_TIMER_C_TSF_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_TSF_SEL_8822C) & \ -+ BIT_MASK_PS_TIMER_C_TSF_SEL_8822C) -+#define BIT_SET_PS_TIMER_C_TSF_SEL_8822C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_TSF_SEL_8822C(x) | \ -+ BIT_PS_TIMER_C_TSF_SEL_8822C(v)) -+ -+#define BIT_PS_TIMER_B_EN_8822C BIT(15) -+ -+#define BIT_SHIFT_PS_TIMER_B_TSF_SEL_8822C 8 -+#define BIT_MASK_PS_TIMER_B_TSF_SEL_8822C 0x7 -+#define BIT_PS_TIMER_B_TSF_SEL_8822C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_TSF_SEL_8822C) \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_8822C) -+#define BITS_PS_TIMER_B_TSF_SEL_8822C \ -+ (BIT_MASK_PS_TIMER_B_TSF_SEL_8822C \ -+ << BIT_SHIFT_PS_TIMER_B_TSF_SEL_8822C) -+#define BIT_CLEAR_PS_TIMER_B_TSF_SEL_8822C(x) \ -+ ((x) & (~BITS_PS_TIMER_B_TSF_SEL_8822C)) -+#define BIT_GET_PS_TIMER_B_TSF_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_TSF_SEL_8822C) & \ -+ BIT_MASK_PS_TIMER_B_TSF_SEL_8822C) -+#define BIT_SET_PS_TIMER_B_TSF_SEL_8822C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_TSF_SEL_8822C(x) | \ -+ BIT_PS_TIMER_B_TSF_SEL_8822C(v)) -+ -+#define BIT_PS_TIMER_A_EN_8822C BIT(7) -+ -+#define BIT_SHIFT_PS_TIMER_A_TSF_SEL_8822C 0 -+#define BIT_MASK_PS_TIMER_A_TSF_SEL_8822C 0x7 -+#define BIT_PS_TIMER_A_TSF_SEL_8822C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_TSF_SEL_8822C) \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_8822C) -+#define BITS_PS_TIMER_A_TSF_SEL_8822C \ -+ (BIT_MASK_PS_TIMER_A_TSF_SEL_8822C \ -+ << BIT_SHIFT_PS_TIMER_A_TSF_SEL_8822C) -+#define BIT_CLEAR_PS_TIMER_A_TSF_SEL_8822C(x) \ -+ ((x) & (~BITS_PS_TIMER_A_TSF_SEL_8822C)) -+#define BIT_GET_PS_TIMER_A_TSF_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_TSF_SEL_8822C) & \ -+ BIT_MASK_PS_TIMER_A_TSF_SEL_8822C) -+#define BIT_SET_PS_TIMER_A_TSF_SEL_8822C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_TSF_SEL_8822C(x) | \ -+ BIT_PS_TIMER_A_TSF_SEL_8822C(v)) -+ -+/* 2 REG_CPUMGQ_TX_TIMER_EARLY_8822C */ -+ -+#define BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8822C 0 -+#define BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8822C 0xff -+#define BIT_CPUMGQ_TX_TIMER_EARLY_8822C(x) \ -+ (((x) & BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8822C) \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8822C) -+#define BITS_CPUMGQ_TX_TIMER_EARLY_8822C \ -+ (BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8822C \ -+ << BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8822C) -+#define BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_8822C(x) \ -+ ((x) & (~BITS_CPUMGQ_TX_TIMER_EARLY_8822C)) -+#define BIT_GET_CPUMGQ_TX_TIMER_EARLY_8822C(x) \ -+ (((x) >> BIT_SHIFT_CPUMGQ_TX_TIMER_EARLY_8822C) & \ -+ BIT_MASK_CPUMGQ_TX_TIMER_EARLY_8822C) -+#define BIT_SET_CPUMGQ_TX_TIMER_EARLY_8822C(x, v) \ -+ (BIT_CLEAR_CPUMGQ_TX_TIMER_EARLY_8822C(x) | \ -+ BIT_CPUMGQ_TX_TIMER_EARLY_8822C(v)) -+ -+/* 2 REG_PS_TIMER_A_EARLY_8822C */ -+ -+#define BIT_SHIFT_PS_TIMER_A_EARLY_8822C 0 -+#define BIT_MASK_PS_TIMER_A_EARLY_8822C 0xff -+#define BIT_PS_TIMER_A_EARLY_8822C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_A_EARLY_8822C) \ -+ << BIT_SHIFT_PS_TIMER_A_EARLY_8822C) -+#define BITS_PS_TIMER_A_EARLY_8822C \ -+ (BIT_MASK_PS_TIMER_A_EARLY_8822C << BIT_SHIFT_PS_TIMER_A_EARLY_8822C) -+#define BIT_CLEAR_PS_TIMER_A_EARLY_8822C(x) \ -+ ((x) & (~BITS_PS_TIMER_A_EARLY_8822C)) -+#define BIT_GET_PS_TIMER_A_EARLY_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_A_EARLY_8822C) & \ -+ BIT_MASK_PS_TIMER_A_EARLY_8822C) -+#define BIT_SET_PS_TIMER_A_EARLY_8822C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_A_EARLY_8822C(x) | BIT_PS_TIMER_A_EARLY_8822C(v)) -+ -+/* 2 REG_PS_TIMER_B_EARLY_8822C */ -+ -+#define BIT_SHIFT_PS_TIMER_B_EARLY_8822C 0 -+#define BIT_MASK_PS_TIMER_B_EARLY_8822C 0xff -+#define BIT_PS_TIMER_B_EARLY_8822C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_B_EARLY_8822C) \ -+ << BIT_SHIFT_PS_TIMER_B_EARLY_8822C) -+#define BITS_PS_TIMER_B_EARLY_8822C \ -+ (BIT_MASK_PS_TIMER_B_EARLY_8822C << BIT_SHIFT_PS_TIMER_B_EARLY_8822C) -+#define BIT_CLEAR_PS_TIMER_B_EARLY_8822C(x) \ -+ ((x) & (~BITS_PS_TIMER_B_EARLY_8822C)) -+#define BIT_GET_PS_TIMER_B_EARLY_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_B_EARLY_8822C) & \ -+ BIT_MASK_PS_TIMER_B_EARLY_8822C) -+#define BIT_SET_PS_TIMER_B_EARLY_8822C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_B_EARLY_8822C(x) | BIT_PS_TIMER_B_EARLY_8822C(v)) -+ -+/* 2 REG_PS_TIMER_C_EARLY_8822C */ -+ -+#define BIT_SHIFT_PS_TIMER_C_EARLY_8822C 0 -+#define BIT_MASK_PS_TIMER_C_EARLY_8822C 0xff -+#define BIT_PS_TIMER_C_EARLY_8822C(x) \ -+ (((x) & BIT_MASK_PS_TIMER_C_EARLY_8822C) \ -+ << BIT_SHIFT_PS_TIMER_C_EARLY_8822C) -+#define BITS_PS_TIMER_C_EARLY_8822C \ -+ (BIT_MASK_PS_TIMER_C_EARLY_8822C << BIT_SHIFT_PS_TIMER_C_EARLY_8822C) -+#define BIT_CLEAR_PS_TIMER_C_EARLY_8822C(x) \ -+ ((x) & (~BITS_PS_TIMER_C_EARLY_8822C)) -+#define BIT_GET_PS_TIMER_C_EARLY_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_TIMER_C_EARLY_8822C) & \ -+ BIT_MASK_PS_TIMER_C_EARLY_8822C) -+#define BIT_SET_PS_TIMER_C_EARLY_8822C(x, v) \ -+ (BIT_CLEAR_PS_TIMER_C_EARLY_8822C(x) | BIT_PS_TIMER_C_EARLY_8822C(v)) -+ -+/* 2 REG_CPUMGQ_PARAMETER_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+#define BIT_MAC_STOP_CPUMGQ_8822C BIT(16) -+ -+#define BIT_SHIFT_CW_8822C 8 -+#define BIT_MASK_CW_8822C 0xff -+#define BIT_CW_8822C(x) (((x) & BIT_MASK_CW_8822C) << BIT_SHIFT_CW_8822C) -+#define BITS_CW_8822C (BIT_MASK_CW_8822C << BIT_SHIFT_CW_8822C) -+#define BIT_CLEAR_CW_8822C(x) ((x) & (~BITS_CW_8822C)) -+#define BIT_GET_CW_8822C(x) (((x) >> BIT_SHIFT_CW_8822C) & BIT_MASK_CW_8822C) -+#define BIT_SET_CW_8822C(x, v) (BIT_CLEAR_CW_8822C(x) | BIT_CW_8822C(v)) -+ -+#define BIT_SHIFT_AIFS_8822C 0 -+#define BIT_MASK_AIFS_8822C 0xff -+#define BIT_AIFS_8822C(x) (((x) & BIT_MASK_AIFS_8822C) << BIT_SHIFT_AIFS_8822C) -+#define BITS_AIFS_8822C (BIT_MASK_AIFS_8822C << BIT_SHIFT_AIFS_8822C) -+#define BIT_CLEAR_AIFS_8822C(x) ((x) & (~BITS_AIFS_8822C)) -+#define BIT_GET_AIFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_AIFS_8822C) & BIT_MASK_AIFS_8822C) -+#define BIT_SET_AIFS_8822C(x, v) (BIT_CLEAR_AIFS_8822C(x) | BIT_AIFS_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_TSF_SYNC_ADJ_8822C */ -+ -+#define BIT_SHIFT_R_P0_TSFT_ADJ_VAL_8822C 16 -+#define BIT_MASK_R_P0_TSFT_ADJ_VAL_8822C 0xffff -+#define BIT_R_P0_TSFT_ADJ_VAL_8822C(x) \ -+ (((x) & BIT_MASK_R_P0_TSFT_ADJ_VAL_8822C) \ -+ << BIT_SHIFT_R_P0_TSFT_ADJ_VAL_8822C) -+#define BITS_R_P0_TSFT_ADJ_VAL_8822C \ -+ (BIT_MASK_R_P0_TSFT_ADJ_VAL_8822C << BIT_SHIFT_R_P0_TSFT_ADJ_VAL_8822C) -+#define BIT_CLEAR_R_P0_TSFT_ADJ_VAL_8822C(x) \ -+ ((x) & (~BITS_R_P0_TSFT_ADJ_VAL_8822C)) -+#define BIT_GET_R_P0_TSFT_ADJ_VAL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_P0_TSFT_ADJ_VAL_8822C) & \ -+ BIT_MASK_R_P0_TSFT_ADJ_VAL_8822C) -+#define BIT_SET_R_P0_TSFT_ADJ_VAL_8822C(x, v) \ -+ (BIT_CLEAR_R_P0_TSFT_ADJ_VAL_8822C(x) | BIT_R_P0_TSFT_ADJ_VAL_8822C(v)) -+ -+#define BIT_R_X_COMP_Y_OVER_8822C BIT(8) -+ -+#define BIT_SHIFT_R_X_SYNC_SEL_8822C 3 -+#define BIT_MASK_R_X_SYNC_SEL_8822C 0x7 -+#define BIT_R_X_SYNC_SEL_8822C(x) \ -+ (((x) & BIT_MASK_R_X_SYNC_SEL_8822C) << BIT_SHIFT_R_X_SYNC_SEL_8822C) -+#define BITS_R_X_SYNC_SEL_8822C \ -+ (BIT_MASK_R_X_SYNC_SEL_8822C << BIT_SHIFT_R_X_SYNC_SEL_8822C) -+#define BIT_CLEAR_R_X_SYNC_SEL_8822C(x) ((x) & (~BITS_R_X_SYNC_SEL_8822C)) -+#define BIT_GET_R_X_SYNC_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_X_SYNC_SEL_8822C) & BIT_MASK_R_X_SYNC_SEL_8822C) -+#define BIT_SET_R_X_SYNC_SEL_8822C(x, v) \ -+ (BIT_CLEAR_R_X_SYNC_SEL_8822C(x) | BIT_R_X_SYNC_SEL_8822C(v)) -+ -+#define BIT_SHIFT_R_SYNC_Y_SEL_8822C 0 -+#define BIT_MASK_R_SYNC_Y_SEL_8822C 0x7 -+#define BIT_R_SYNC_Y_SEL_8822C(x) \ -+ (((x) & BIT_MASK_R_SYNC_Y_SEL_8822C) << BIT_SHIFT_R_SYNC_Y_SEL_8822C) -+#define BITS_R_SYNC_Y_SEL_8822C \ -+ (BIT_MASK_R_SYNC_Y_SEL_8822C << BIT_SHIFT_R_SYNC_Y_SEL_8822C) -+#define BIT_CLEAR_R_SYNC_Y_SEL_8822C(x) ((x) & (~BITS_R_SYNC_Y_SEL_8822C)) -+#define BIT_GET_R_SYNC_Y_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_SYNC_Y_SEL_8822C) & BIT_MASK_R_SYNC_Y_SEL_8822C) -+#define BIT_SET_R_SYNC_Y_SEL_8822C(x, v) \ -+ (BIT_CLEAR_R_SYNC_Y_SEL_8822C(x) | BIT_R_SYNC_Y_SEL_8822C(v)) -+ -+/* 2 REG_TSF_ADJ_VLAUE_8822C */ -+ -+#define BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL_8822C 16 -+#define BIT_MASK_R_CLI1_TSFT_ADJ_VAL_8822C 0xffff -+#define BIT_R_CLI1_TSFT_ADJ_VAL_8822C(x) \ -+ (((x) & BIT_MASK_R_CLI1_TSFT_ADJ_VAL_8822C) \ -+ << BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL_8822C) -+#define BITS_R_CLI1_TSFT_ADJ_VAL_8822C \ -+ (BIT_MASK_R_CLI1_TSFT_ADJ_VAL_8822C \ -+ << BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL_8822C) -+#define BIT_CLEAR_R_CLI1_TSFT_ADJ_VAL_8822C(x) \ -+ ((x) & (~BITS_R_CLI1_TSFT_ADJ_VAL_8822C)) -+#define BIT_GET_R_CLI1_TSFT_ADJ_VAL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_CLI1_TSFT_ADJ_VAL_8822C) & \ -+ BIT_MASK_R_CLI1_TSFT_ADJ_VAL_8822C) -+#define BIT_SET_R_CLI1_TSFT_ADJ_VAL_8822C(x, v) \ -+ (BIT_CLEAR_R_CLI1_TSFT_ADJ_VAL_8822C(x) | \ -+ BIT_R_CLI1_TSFT_ADJ_VAL_8822C(v)) -+ -+#define BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL_8822C 0 -+#define BIT_MASK_R_CLI0_TSFT_ADJ_VAL_8822C 0xffff -+#define BIT_R_CLI0_TSFT_ADJ_VAL_8822C(x) \ -+ (((x) & BIT_MASK_R_CLI0_TSFT_ADJ_VAL_8822C) \ -+ << BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL_8822C) -+#define BITS_R_CLI0_TSFT_ADJ_VAL_8822C \ -+ (BIT_MASK_R_CLI0_TSFT_ADJ_VAL_8822C \ -+ << BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL_8822C) -+#define BIT_CLEAR_R_CLI0_TSFT_ADJ_VAL_8822C(x) \ -+ ((x) & (~BITS_R_CLI0_TSFT_ADJ_VAL_8822C)) -+#define BIT_GET_R_CLI0_TSFT_ADJ_VAL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_CLI0_TSFT_ADJ_VAL_8822C) & \ -+ BIT_MASK_R_CLI0_TSFT_ADJ_VAL_8822C) -+#define BIT_SET_R_CLI0_TSFT_ADJ_VAL_8822C(x, v) \ -+ (BIT_CLEAR_R_CLI0_TSFT_ADJ_VAL_8822C(x) | \ -+ BIT_R_CLI0_TSFT_ADJ_VAL_8822C(v)) -+ -+/* 2 REG_TSF_ADJ_VLAUE_2_8822C */ -+ -+#define BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL_8822C 16 -+#define BIT_MASK_R_CLI3_TSFT_ADJ_VAL_8822C 0xffff -+#define BIT_R_CLI3_TSFT_ADJ_VAL_8822C(x) \ -+ (((x) & BIT_MASK_R_CLI3_TSFT_ADJ_VAL_8822C) \ -+ << BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL_8822C) -+#define BITS_R_CLI3_TSFT_ADJ_VAL_8822C \ -+ (BIT_MASK_R_CLI3_TSFT_ADJ_VAL_8822C \ -+ << BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL_8822C) -+#define BIT_CLEAR_R_CLI3_TSFT_ADJ_VAL_8822C(x) \ -+ ((x) & (~BITS_R_CLI3_TSFT_ADJ_VAL_8822C)) -+#define BIT_GET_R_CLI3_TSFT_ADJ_VAL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_CLI3_TSFT_ADJ_VAL_8822C) & \ -+ BIT_MASK_R_CLI3_TSFT_ADJ_VAL_8822C) -+#define BIT_SET_R_CLI3_TSFT_ADJ_VAL_8822C(x, v) \ -+ (BIT_CLEAR_R_CLI3_TSFT_ADJ_VAL_8822C(x) | \ -+ BIT_R_CLI3_TSFT_ADJ_VAL_8822C(v)) -+ -+#define BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL_8822C 0 -+#define BIT_MASK_R_CLI2_TSFT_ADJ_VAL_8822C 0xffff -+#define BIT_R_CLI2_TSFT_ADJ_VAL_8822C(x) \ -+ (((x) & BIT_MASK_R_CLI2_TSFT_ADJ_VAL_8822C) \ -+ << BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL_8822C) -+#define BITS_R_CLI2_TSFT_ADJ_VAL_8822C \ -+ (BIT_MASK_R_CLI2_TSFT_ADJ_VAL_8822C \ -+ << BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL_8822C) -+#define BIT_CLEAR_R_CLI2_TSFT_ADJ_VAL_8822C(x) \ -+ ((x) & (~BITS_R_CLI2_TSFT_ADJ_VAL_8822C)) -+#define BIT_GET_R_CLI2_TSFT_ADJ_VAL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_CLI2_TSFT_ADJ_VAL_8822C) & \ -+ BIT_MASK_R_CLI2_TSFT_ADJ_VAL_8822C) -+#define BIT_SET_R_CLI2_TSFT_ADJ_VAL_8822C(x, v) \ -+ (BIT_CLEAR_R_CLI2_TSFT_ADJ_VAL_8822C(x) | \ -+ BIT_R_CLI2_TSFT_ADJ_VAL_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_P2PPS_HW_AUTO_PAUSE_CTRL_8822C */ -+#define BIT_P2PPS_NOA_STOP_TX_HANG_8822C BIT(31) -+#define BIT_P2PPS_MACID_PAUSE_EN_8822C BIT(11) -+#define BIT_P2PPS__MGQ_PAUSE_8822C BIT(10) -+#define BIT_P2PPS__HIQ_PAUSE_8822C BIT(9) -+#define BIT_P2PPS__BCNQ_PAUSE_8822C BIT(8) -+ -+#define BIT_SHIFT_P2PPS_MACID_PAUSE_8822C 0 -+#define BIT_MASK_P2PPS_MACID_PAUSE_8822C 0xff -+#define BIT_P2PPS_MACID_PAUSE_8822C(x) \ -+ (((x) & BIT_MASK_P2PPS_MACID_PAUSE_8822C) \ -+ << BIT_SHIFT_P2PPS_MACID_PAUSE_8822C) -+#define BITS_P2PPS_MACID_PAUSE_8822C \ -+ (BIT_MASK_P2PPS_MACID_PAUSE_8822C << BIT_SHIFT_P2PPS_MACID_PAUSE_8822C) -+#define BIT_CLEAR_P2PPS_MACID_PAUSE_8822C(x) \ -+ ((x) & (~BITS_P2PPS_MACID_PAUSE_8822C)) -+#define BIT_GET_P2PPS_MACID_PAUSE_8822C(x) \ -+ (((x) >> BIT_SHIFT_P2PPS_MACID_PAUSE_8822C) & \ -+ BIT_MASK_P2PPS_MACID_PAUSE_8822C) -+#define BIT_SET_P2PPS_MACID_PAUSE_8822C(x, v) \ -+ (BIT_CLEAR_P2PPS_MACID_PAUSE_8822C(x) | BIT_P2PPS_MACID_PAUSE_8822C(v)) -+ -+/* 2 REG_P2PPS1_HW_AUTO_PAUSE_CTRL_8822C */ -+#define BIT_P2PPS1_NOA_STOP_TX_HANG_8822C BIT(31) -+#define BIT_P2PPS1_MACID_PAUSE_EN_8822C BIT(11) -+#define BIT_P2PPS1__MGQ_PAUSE_8822C BIT(10) -+#define BIT_P2PPS1__HIQ_PAUSE_8822C BIT(9) -+#define BIT_P2PPS1__BCNQ_PAUSE_8822C BIT(8) -+ -+#define BIT_SHIFT_P2PPS1_MACID_PAUSE_8822C 0 -+#define BIT_MASK_P2PPS1_MACID_PAUSE_8822C 0xff -+#define BIT_P2PPS1_MACID_PAUSE_8822C(x) \ -+ (((x) & BIT_MASK_P2PPS1_MACID_PAUSE_8822C) \ -+ << BIT_SHIFT_P2PPS1_MACID_PAUSE_8822C) -+#define BITS_P2PPS1_MACID_PAUSE_8822C \ -+ (BIT_MASK_P2PPS1_MACID_PAUSE_8822C \ -+ << BIT_SHIFT_P2PPS1_MACID_PAUSE_8822C) -+#define BIT_CLEAR_P2PPS1_MACID_PAUSE_8822C(x) \ -+ ((x) & (~BITS_P2PPS1_MACID_PAUSE_8822C)) -+#define BIT_GET_P2PPS1_MACID_PAUSE_8822C(x) \ -+ (((x) >> BIT_SHIFT_P2PPS1_MACID_PAUSE_8822C) & \ -+ BIT_MASK_P2PPS1_MACID_PAUSE_8822C) -+#define BIT_SET_P2PPS1_MACID_PAUSE_8822C(x, v) \ -+ (BIT_CLEAR_P2PPS1_MACID_PAUSE_8822C(x) | \ -+ BIT_P2PPS1_MACID_PAUSE_8822C(v)) -+ -+/* 2 REG_P2PPS2_HW_AUTO_PAUSE_CTRL_8822C */ -+#define BIT_P2PPS2_NOA_STOP_TX_HANG_8822C BIT(31) -+#define BIT_P2PPS2_MACID_PAUSE_EN_8822C BIT(11) -+#define BIT_P2PPS2__MGQ_PAUSE_8822C BIT(10) -+#define BIT_P2PPS2__HIQ_PAUSE_8822C BIT(9) -+#define BIT_P2PPS2__BCNQ_PAUSE_8822C BIT(8) -+ -+#define BIT_SHIFT_P2PPS2_MACID_PAUSE_8822C 0 -+#define BIT_MASK_P2PPS2_MACID_PAUSE_8822C 0xff -+#define BIT_P2PPS2_MACID_PAUSE_8822C(x) \ -+ (((x) & BIT_MASK_P2PPS2_MACID_PAUSE_8822C) \ -+ << BIT_SHIFT_P2PPS2_MACID_PAUSE_8822C) -+#define BITS_P2PPS2_MACID_PAUSE_8822C \ -+ (BIT_MASK_P2PPS2_MACID_PAUSE_8822C \ -+ << BIT_SHIFT_P2PPS2_MACID_PAUSE_8822C) -+#define BIT_CLEAR_P2PPS2_MACID_PAUSE_8822C(x) \ -+ ((x) & (~BITS_P2PPS2_MACID_PAUSE_8822C)) -+#define BIT_GET_P2PPS2_MACID_PAUSE_8822C(x) \ -+ (((x) >> BIT_SHIFT_P2PPS2_MACID_PAUSE_8822C) & \ -+ BIT_MASK_P2PPS2_MACID_PAUSE_8822C) -+#define BIT_SET_P2PPS2_MACID_PAUSE_8822C(x, v) \ -+ (BIT_CLEAR_P2PPS2_MACID_PAUSE_8822C(x) | \ -+ BIT_P2PPS2_MACID_PAUSE_8822C(v)) -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_SCHEDULER_COUNTER_8822C */ -+ -+#define BIT_SHIFT__SCHEDULER_COUNTER_8822C 16 -+#define BIT_MASK__SCHEDULER_COUNTER_8822C 0xffff -+#define BIT__SCHEDULER_COUNTER_8822C(x) \ -+ (((x) & BIT_MASK__SCHEDULER_COUNTER_8822C) \ -+ << BIT_SHIFT__SCHEDULER_COUNTER_8822C) -+#define BITS__SCHEDULER_COUNTER_8822C \ -+ (BIT_MASK__SCHEDULER_COUNTER_8822C \ -+ << BIT_SHIFT__SCHEDULER_COUNTER_8822C) -+#define BIT_CLEAR__SCHEDULER_COUNTER_8822C(x) \ -+ ((x) & (~BITS__SCHEDULER_COUNTER_8822C)) -+#define BIT_GET__SCHEDULER_COUNTER_8822C(x) \ -+ (((x) >> BIT_SHIFT__SCHEDULER_COUNTER_8822C) & \ -+ BIT_MASK__SCHEDULER_COUNTER_8822C) -+#define BIT_SET__SCHEDULER_COUNTER_8822C(x, v) \ -+ (BIT_CLEAR__SCHEDULER_COUNTER_8822C(x) | \ -+ BIT__SCHEDULER_COUNTER_8822C(v)) -+ -+#define BIT__SCHEDULER_COUNTER_RST_8822C BIT(8) -+ -+#define BIT_SHIFT_SCHEDULER_COUNTER_SEL_8822C 0 -+#define BIT_MASK_SCHEDULER_COUNTER_SEL_8822C 0xff -+#define BIT_SCHEDULER_COUNTER_SEL_8822C(x) \ -+ (((x) & BIT_MASK_SCHEDULER_COUNTER_SEL_8822C) \ -+ << BIT_SHIFT_SCHEDULER_COUNTER_SEL_8822C) -+#define BITS_SCHEDULER_COUNTER_SEL_8822C \ -+ (BIT_MASK_SCHEDULER_COUNTER_SEL_8822C \ -+ << BIT_SHIFT_SCHEDULER_COUNTER_SEL_8822C) -+#define BIT_CLEAR_SCHEDULER_COUNTER_SEL_8822C(x) \ -+ ((x) & (~BITS_SCHEDULER_COUNTER_SEL_8822C)) -+#define BIT_GET_SCHEDULER_COUNTER_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_SCHEDULER_COUNTER_SEL_8822C) & \ -+ BIT_MASK_SCHEDULER_COUNTER_SEL_8822C) -+#define BIT_SET_SCHEDULER_COUNTER_SEL_8822C(x, v) \ -+ (BIT_CLEAR_SCHEDULER_COUNTER_SEL_8822C(x) | \ -+ BIT_SCHEDULER_COUNTER_SEL_8822C(v)) -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_WMAC_CR_8822C (WMAC CR AND APSD CONTROL REGISTER) */ -+#define BIT_IC_MACPHY_M_8822C BIT(0) -+ -+/* 2 REG_WMAC_FWPKT_CR_8822C */ -+#define BIT_FWEN_8822C BIT(7) -+#define BIT_PHYSTS_PKT_CTRL_8822C BIT(6) -+#define BIT_APPHDR_MIDSRCH_FAIL_8822C BIT(4) -+#define BIT_FWPARSING_EN_8822C BIT(3) -+ -+#define BIT_SHIFT_APPEND_MHDR_LEN_8822C 0 -+#define BIT_MASK_APPEND_MHDR_LEN_8822C 0x7 -+#define BIT_APPEND_MHDR_LEN_8822C(x) \ -+ (((x) & BIT_MASK_APPEND_MHDR_LEN_8822C) \ -+ << BIT_SHIFT_APPEND_MHDR_LEN_8822C) -+#define BITS_APPEND_MHDR_LEN_8822C \ -+ (BIT_MASK_APPEND_MHDR_LEN_8822C << BIT_SHIFT_APPEND_MHDR_LEN_8822C) -+#define BIT_CLEAR_APPEND_MHDR_LEN_8822C(x) ((x) & (~BITS_APPEND_MHDR_LEN_8822C)) -+#define BIT_GET_APPEND_MHDR_LEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_APPEND_MHDR_LEN_8822C) & \ -+ BIT_MASK_APPEND_MHDR_LEN_8822C) -+#define BIT_SET_APPEND_MHDR_LEN_8822C(x, v) \ -+ (BIT_CLEAR_APPEND_MHDR_LEN_8822C(x) | BIT_APPEND_MHDR_LEN_8822C(v)) -+ -+/* 2 REG_FW_STS_FILTER_8822C */ -+#define BIT_DATA_FW_STS_FILTER_8822C BIT(2) -+#define BIT_CTRL_FW_STS_FILTER_8822C BIT(1) -+#define BIT_MGNT_FW_STS_FILTER_8822C BIT(0) -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_TCR_8822C (TRANSMISSION CONFIGURATION REGISTER) */ -+#define BIT_WMAC_EN_RTS_ADDR_8822C BIT(31) -+#define BIT_WMAC_DISABLE_CCK_8822C BIT(30) -+#define BIT_WMAC_RAW_LEN_8822C BIT(29) -+#define BIT_WMAC_NOTX_IN_RXNDP_8822C BIT(28) -+#define BIT_WMAC_EN_EOF_8822C BIT(27) -+#define BIT_WMAC_BF_SEL_8822C BIT(26) -+#define BIT_WMAC_ANTMODE_SEL_8822C BIT(25) -+#define BIT_WMAC_TCRPWRMGT_HWCTL_8822C BIT(24) -+#define BIT_WMAC_SMOOTH_VAL_8822C BIT(23) -+#define BIT_WMAC_EN_SCRAM_INC_8822C BIT(22) -+#define BIT_UNDERFLOWEN_CMPLEN_SEL_8822C BIT(21) -+#define BIT_FETCH_MPDU_AFTER_WSEC_RDY_8822C BIT(20) -+#define BIT_WMAC_TCR_EN_20MST_8822C BIT(19) -+#define BIT_WMAC_DIS_SIGTA_8822C BIT(18) -+#define BIT_WMAC_DIS_A2B0_8822C BIT(17) -+#define BIT_WMAC_MSK_SIGBCRC_8822C BIT(16) -+#define BIT_WMAC_TCR_ERRSTEN_3_8822C BIT(15) -+#define BIT_WMAC_TCR_ERRSTEN_2_8822C BIT(14) -+#define BIT_WMAC_TCR_ERRSTEN_1_8822C BIT(13) -+#define BIT_WMAC_TCR_ERRSTEN_0_8822C BIT(12) -+#define BIT_WMAC_TCR_TXSK_PERPKT_8822C BIT(11) -+#define BIT_ICV_8822C BIT(10) -+#define BIT_CFEND_FORMAT_8822C BIT(9) -+#define BIT_CRC_8822C BIT(8) -+#define BIT_WMAC_TCRPWRMGT_HWDATA_EN_8822C BIT(7) -+#define BIT_PWR_ST_8822C BIT(6) -+#define BIT_WMAC_TCR_UPD_TIMIE_8822C BIT(5) -+#define BIT_WMAC_TCR_UPD_HGQMD_8822C BIT(4) -+#define BIT_VHTSIGA1_TXPS_8822C BIT(3) -+#define BIT_PAD_SEL_8822C BIT(2) -+#define BIT_DIS_GCLK_8822C BIT(1) -+#define BIT_WMAC_TCRPWRMGT_HWACT_EN_8822C BIT(0) -+ -+/* 2 REG_RCR_8822C (RECEIVE CONFIGURATION REGISTER) */ -+#define BIT_APP_FCS_8822C BIT(31) -+#define BIT_APP_MIC_8822C BIT(30) -+#define BIT_APP_ICV_8822C BIT(29) -+#define BIT_APP_PHYSTS_8822C BIT(28) -+#define BIT_APP_BASSN_8822C BIT(27) -+#define BIT_VHT_DACK_8822C BIT(26) -+#define BIT_TCPOFLD_EN_8822C BIT(25) -+#define BIT_ENMBID_8822C BIT(24) -+#define BIT_LSIGEN_8822C BIT(23) -+#define BIT_MFBEN_8822C BIT(22) -+#define BIT_DISCHKPPDLLEN_8822C BIT(21) -+#define BIT_PKTCTL_DLEN_8822C BIT(20) -+#define BIT_DISGCLK_8822C BIT(19) -+#define BIT_TIM_PARSER_EN_8822C BIT(18) -+#define BIT_BC_MD_EN_8822C BIT(17) -+#define BIT_UC_MD_EN_8822C BIT(16) -+#define BIT_RXSK_PERPKT_8822C BIT(15) -+#define BIT_HTC_LOC_CTRL_8822C BIT(14) -+#define BIT_ACK_WITH_CBSSID_DATA_OPTION_8822C BIT(13) -+#define BIT_RPFM_CAM_ENABLE_8822C BIT(12) -+#define BIT_TA_BCN_8822C BIT(11) -+#define BIT_DISDECMYPKT_8822C BIT(10) -+#define BIT_AICV_8822C BIT(9) -+#define BIT_ACRC32_8822C BIT(8) -+#define BIT_CBSSID_BCN_8822C BIT(7) -+#define BIT_CBSSID_DATA_8822C BIT(6) -+#define BIT_APWRMGT_8822C BIT(5) -+#define BIT_ADD3_8822C BIT(4) -+#define BIT_AB_8822C BIT(3) -+#define BIT_AM_8822C BIT(2) -+#define BIT_APM_8822C BIT(1) -+#define BIT_AAP_8822C BIT(0) -+ -+/* 2 REG_RX_PKT_LIMIT_8822C (RX PACKET LENGTH LIMIT REGISTER) */ -+ -+#define BIT_SHIFT_RXPKTLMT_8822C 0 -+#define BIT_MASK_RXPKTLMT_8822C 0x3f -+#define BIT_RXPKTLMT_8822C(x) \ -+ (((x) & BIT_MASK_RXPKTLMT_8822C) << BIT_SHIFT_RXPKTLMT_8822C) -+#define BITS_RXPKTLMT_8822C \ -+ (BIT_MASK_RXPKTLMT_8822C << BIT_SHIFT_RXPKTLMT_8822C) -+#define BIT_CLEAR_RXPKTLMT_8822C(x) ((x) & (~BITS_RXPKTLMT_8822C)) -+#define BIT_GET_RXPKTLMT_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXPKTLMT_8822C) & BIT_MASK_RXPKTLMT_8822C) -+#define BIT_SET_RXPKTLMT_8822C(x, v) \ -+ (BIT_CLEAR_RXPKTLMT_8822C(x) | BIT_RXPKTLMT_8822C(v)) -+ -+/* 2 REG_RX_DLK_TIME_8822C (RX DEADLOCK TIME REGISTER) */ -+ -+#define BIT_SHIFT_RX_DLK_TIME_8822C 0 -+#define BIT_MASK_RX_DLK_TIME_8822C 0xff -+#define BIT_RX_DLK_TIME_8822C(x) \ -+ (((x) & BIT_MASK_RX_DLK_TIME_8822C) << BIT_SHIFT_RX_DLK_TIME_8822C) -+#define BITS_RX_DLK_TIME_8822C \ -+ (BIT_MASK_RX_DLK_TIME_8822C << BIT_SHIFT_RX_DLK_TIME_8822C) -+#define BIT_CLEAR_RX_DLK_TIME_8822C(x) ((x) & (~BITS_RX_DLK_TIME_8822C)) -+#define BIT_GET_RX_DLK_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_DLK_TIME_8822C) & BIT_MASK_RX_DLK_TIME_8822C) -+#define BIT_SET_RX_DLK_TIME_8822C(x, v) \ -+ (BIT_CLEAR_RX_DLK_TIME_8822C(x) | BIT_RX_DLK_TIME_8822C(v)) -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RX_DRVINFO_SZ_8822C (RX DRIVER INFO SIZE REGISTER) */ -+#define BIT_PHYSTS_PER_PKT_MODE_8822C BIT(7) -+ -+#define BIT_SHIFT_DRVINFO_SZ_V1_8822C 0 -+#define BIT_MASK_DRVINFO_SZ_V1_8822C 0xf -+#define BIT_DRVINFO_SZ_V1_8822C(x) \ -+ (((x) & BIT_MASK_DRVINFO_SZ_V1_8822C) << BIT_SHIFT_DRVINFO_SZ_V1_8822C) -+#define BITS_DRVINFO_SZ_V1_8822C \ -+ (BIT_MASK_DRVINFO_SZ_V1_8822C << BIT_SHIFT_DRVINFO_SZ_V1_8822C) -+#define BIT_CLEAR_DRVINFO_SZ_V1_8822C(x) ((x) & (~BITS_DRVINFO_SZ_V1_8822C)) -+#define BIT_GET_DRVINFO_SZ_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DRVINFO_SZ_V1_8822C) & BIT_MASK_DRVINFO_SZ_V1_8822C) -+#define BIT_SET_DRVINFO_SZ_V1_8822C(x, v) \ -+ (BIT_CLEAR_DRVINFO_SZ_V1_8822C(x) | BIT_DRVINFO_SZ_V1_8822C(v)) -+ -+/* 2 REG_MACID_8822C (MAC ID REGISTER) */ -+ -+#define BIT_SHIFT_MACID_V1_8822C 0 -+#define BIT_MASK_MACID_V1_8822C 0xffffffffL -+#define BIT_MACID_V1_8822C(x) \ -+ (((x) & BIT_MASK_MACID_V1_8822C) << BIT_SHIFT_MACID_V1_8822C) -+#define BITS_MACID_V1_8822C \ -+ (BIT_MASK_MACID_V1_8822C << BIT_SHIFT_MACID_V1_8822C) -+#define BIT_CLEAR_MACID_V1_8822C(x) ((x) & (~BITS_MACID_V1_8822C)) -+#define BIT_GET_MACID_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID_V1_8822C) & BIT_MASK_MACID_V1_8822C) -+#define BIT_SET_MACID_V1_8822C(x, v) \ -+ (BIT_CLEAR_MACID_V1_8822C(x) | BIT_MACID_V1_8822C(v)) -+ -+/* 2 REG_MACID_H_8822C (MAC ID REGISTER) */ -+ -+#define BIT_SHIFT_MACID_H_V1_8822C 0 -+#define BIT_MASK_MACID_H_V1_8822C 0xffff -+#define BIT_MACID_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_MACID_H_V1_8822C) << BIT_SHIFT_MACID_H_V1_8822C) -+#define BITS_MACID_H_V1_8822C \ -+ (BIT_MASK_MACID_H_V1_8822C << BIT_SHIFT_MACID_H_V1_8822C) -+#define BIT_CLEAR_MACID_H_V1_8822C(x) ((x) & (~BITS_MACID_H_V1_8822C)) -+#define BIT_GET_MACID_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID_H_V1_8822C) & BIT_MASK_MACID_H_V1_8822C) -+#define BIT_SET_MACID_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_MACID_H_V1_8822C(x) | BIT_MACID_H_V1_8822C(v)) -+ -+/* 2 REG_BSSID_8822C (BSSID REGISTER) */ -+ -+#define BIT_SHIFT_BSSID_V1_8822C 0 -+#define BIT_MASK_BSSID_V1_8822C 0xffffffffL -+#define BIT_BSSID_V1_8822C(x) \ -+ (((x) & BIT_MASK_BSSID_V1_8822C) << BIT_SHIFT_BSSID_V1_8822C) -+#define BITS_BSSID_V1_8822C \ -+ (BIT_MASK_BSSID_V1_8822C << BIT_SHIFT_BSSID_V1_8822C) -+#define BIT_CLEAR_BSSID_V1_8822C(x) ((x) & (~BITS_BSSID_V1_8822C)) -+#define BIT_GET_BSSID_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID_V1_8822C) & BIT_MASK_BSSID_V1_8822C) -+#define BIT_SET_BSSID_V1_8822C(x, v) \ -+ (BIT_CLEAR_BSSID_V1_8822C(x) | BIT_BSSID_V1_8822C(v)) -+ -+/* 2 REG_BSSID_H_8822C (BSSID REGISTER) */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+#define BIT_SHIFT_BSSID_H_V1_8822C 0 -+#define BIT_MASK_BSSID_H_V1_8822C 0xffff -+#define BIT_BSSID_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_BSSID_H_V1_8822C) << BIT_SHIFT_BSSID_H_V1_8822C) -+#define BITS_BSSID_H_V1_8822C \ -+ (BIT_MASK_BSSID_H_V1_8822C << BIT_SHIFT_BSSID_H_V1_8822C) -+#define BIT_CLEAR_BSSID_H_V1_8822C(x) ((x) & (~BITS_BSSID_H_V1_8822C)) -+#define BIT_GET_BSSID_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID_H_V1_8822C) & BIT_MASK_BSSID_H_V1_8822C) -+#define BIT_SET_BSSID_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_BSSID_H_V1_8822C(x) | BIT_BSSID_H_V1_8822C(v)) -+ -+/* 2 REG_MAR_8822C (MULTICAST ADDRESS REGISTER) */ -+ -+#define BIT_SHIFT_MAR_V1_8822C 0 -+#define BIT_MASK_MAR_V1_8822C 0xffffffffL -+#define BIT_MAR_V1_8822C(x) \ -+ (((x) & BIT_MASK_MAR_V1_8822C) << BIT_SHIFT_MAR_V1_8822C) -+#define BITS_MAR_V1_8822C (BIT_MASK_MAR_V1_8822C << BIT_SHIFT_MAR_V1_8822C) -+#define BIT_CLEAR_MAR_V1_8822C(x) ((x) & (~BITS_MAR_V1_8822C)) -+#define BIT_GET_MAR_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAR_V1_8822C) & BIT_MASK_MAR_V1_8822C) -+#define BIT_SET_MAR_V1_8822C(x, v) \ -+ (BIT_CLEAR_MAR_V1_8822C(x) | BIT_MAR_V1_8822C(v)) -+ -+/* 2 REG_MAR_H_8822C (MULTICAST ADDRESS REGISTER) */ -+ -+#define BIT_SHIFT_MAR_H_V1_8822C 0 -+#define BIT_MASK_MAR_H_V1_8822C 0xffffffffL -+#define BIT_MAR_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_MAR_H_V1_8822C) << BIT_SHIFT_MAR_H_V1_8822C) -+#define BITS_MAR_H_V1_8822C \ -+ (BIT_MASK_MAR_H_V1_8822C << BIT_SHIFT_MAR_H_V1_8822C) -+#define BIT_CLEAR_MAR_H_V1_8822C(x) ((x) & (~BITS_MAR_H_V1_8822C)) -+#define BIT_GET_MAR_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MAR_H_V1_8822C) & BIT_MASK_MAR_H_V1_8822C) -+#define BIT_SET_MAR_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_MAR_H_V1_8822C(x) | BIT_MAR_H_V1_8822C(v)) -+ -+/* 2 REG_MBIDCAMCFG_1_8822C (MBSSID CAM CONFIGURATION REGISTER) */ -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_L_8822C 0 -+#define BIT_MASK_MBIDCAM_RWDATA_L_8822C 0xffffffffL -+#define BIT_MBIDCAM_RWDATA_L_8822C(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_L_8822C) \ -+ << BIT_SHIFT_MBIDCAM_RWDATA_L_8822C) -+#define BITS_MBIDCAM_RWDATA_L_8822C \ -+ (BIT_MASK_MBIDCAM_RWDATA_L_8822C << BIT_SHIFT_MBIDCAM_RWDATA_L_8822C) -+#define BIT_CLEAR_MBIDCAM_RWDATA_L_8822C(x) \ -+ ((x) & (~BITS_MBIDCAM_RWDATA_L_8822C)) -+#define BIT_GET_MBIDCAM_RWDATA_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_L_8822C) & \ -+ BIT_MASK_MBIDCAM_RWDATA_L_8822C) -+#define BIT_SET_MBIDCAM_RWDATA_L_8822C(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_L_8822C(x) | BIT_MBIDCAM_RWDATA_L_8822C(v)) -+ -+/* 2 REG_MBIDCAMCFG_2_8822C (MBSSID CAM CONFIGURATION REGISTER) */ -+#define BIT_MBIDCAM_POLL_8822C BIT(31) -+#define BIT_MBIDCAM_WT_EN_8822C BIT(30) -+ -+#define BIT_SHIFT_MBIDCAM_ADDR_V1_8822C 24 -+#define BIT_MASK_MBIDCAM_ADDR_V1_8822C 0x3f -+#define BIT_MBIDCAM_ADDR_V1_8822C(x) \ -+ (((x) & BIT_MASK_MBIDCAM_ADDR_V1_8822C) \ -+ << BIT_SHIFT_MBIDCAM_ADDR_V1_8822C) -+#define BITS_MBIDCAM_ADDR_V1_8822C \ -+ (BIT_MASK_MBIDCAM_ADDR_V1_8822C << BIT_SHIFT_MBIDCAM_ADDR_V1_8822C) -+#define BIT_CLEAR_MBIDCAM_ADDR_V1_8822C(x) ((x) & (~BITS_MBIDCAM_ADDR_V1_8822C)) -+#define BIT_GET_MBIDCAM_ADDR_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_ADDR_V1_8822C) & \ -+ BIT_MASK_MBIDCAM_ADDR_V1_8822C) -+#define BIT_SET_MBIDCAM_ADDR_V1_8822C(x, v) \ -+ (BIT_CLEAR_MBIDCAM_ADDR_V1_8822C(x) | BIT_MBIDCAM_ADDR_V1_8822C(v)) -+ -+#define BIT_MBIDCAM_VALID_8822C BIT(23) -+#define BIT_LSIC_TXOP_EN_8822C BIT(17) -+#define BIT_CTS_EN_8822C BIT(16) -+ -+#define BIT_SHIFT_MBIDCAM_RWDATA_H_8822C 0 -+#define BIT_MASK_MBIDCAM_RWDATA_H_8822C 0xffff -+#define BIT_MBIDCAM_RWDATA_H_8822C(x) \ -+ (((x) & BIT_MASK_MBIDCAM_RWDATA_H_8822C) \ -+ << BIT_SHIFT_MBIDCAM_RWDATA_H_8822C) -+#define BITS_MBIDCAM_RWDATA_H_8822C \ -+ (BIT_MASK_MBIDCAM_RWDATA_H_8822C << BIT_SHIFT_MBIDCAM_RWDATA_H_8822C) -+#define BIT_CLEAR_MBIDCAM_RWDATA_H_8822C(x) \ -+ ((x) & (~BITS_MBIDCAM_RWDATA_H_8822C)) -+#define BIT_GET_MBIDCAM_RWDATA_H_8822C(x) \ -+ (((x) >> BIT_SHIFT_MBIDCAM_RWDATA_H_8822C) & \ -+ BIT_MASK_MBIDCAM_RWDATA_H_8822C) -+#define BIT_SET_MBIDCAM_RWDATA_H_8822C(x, v) \ -+ (BIT_CLEAR_MBIDCAM_RWDATA_H_8822C(x) | BIT_MBIDCAM_RWDATA_H_8822C(v)) -+ -+/* 2 REG_WMAC_TCR_TSFT_OFS_8822C */ -+ -+#define BIT_SHIFT_WMAC_TCR_TSFT_OFS_8822C 0 -+#define BIT_MASK_WMAC_TCR_TSFT_OFS_8822C 0xffff -+#define BIT_WMAC_TCR_TSFT_OFS_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_TCR_TSFT_OFS_8822C) \ -+ << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8822C) -+#define BITS_WMAC_TCR_TSFT_OFS_8822C \ -+ (BIT_MASK_WMAC_TCR_TSFT_OFS_8822C << BIT_SHIFT_WMAC_TCR_TSFT_OFS_8822C) -+#define BIT_CLEAR_WMAC_TCR_TSFT_OFS_8822C(x) \ -+ ((x) & (~BITS_WMAC_TCR_TSFT_OFS_8822C)) -+#define BIT_GET_WMAC_TCR_TSFT_OFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TCR_TSFT_OFS_8822C) & \ -+ BIT_MASK_WMAC_TCR_TSFT_OFS_8822C) -+#define BIT_SET_WMAC_TCR_TSFT_OFS_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_TCR_TSFT_OFS_8822C(x) | BIT_WMAC_TCR_TSFT_OFS_8822C(v)) -+ -+/* 2 REG_UDF_THSD_8822C */ -+#define BIT_UDF_THSD_V1_8822C BIT(7) -+ -+#define BIT_SHIFT_UDF_THSD_VALUE_8822C 0 -+#define BIT_MASK_UDF_THSD_VALUE_8822C 0x7f -+#define BIT_UDF_THSD_VALUE_8822C(x) \ -+ (((x) & BIT_MASK_UDF_THSD_VALUE_8822C) \ -+ << BIT_SHIFT_UDF_THSD_VALUE_8822C) -+#define BITS_UDF_THSD_VALUE_8822C \ -+ (BIT_MASK_UDF_THSD_VALUE_8822C << BIT_SHIFT_UDF_THSD_VALUE_8822C) -+#define BIT_CLEAR_UDF_THSD_VALUE_8822C(x) ((x) & (~BITS_UDF_THSD_VALUE_8822C)) -+#define BIT_GET_UDF_THSD_VALUE_8822C(x) \ -+ (((x) >> BIT_SHIFT_UDF_THSD_VALUE_8822C) & \ -+ BIT_MASK_UDF_THSD_VALUE_8822C) -+#define BIT_SET_UDF_THSD_VALUE_8822C(x, v) \ -+ (BIT_CLEAR_UDF_THSD_VALUE_8822C(x) | BIT_UDF_THSD_VALUE_8822C(v)) -+ -+/* 2 REG_ZLD_NUM_8822C */ -+ -+#define BIT_SHIFT_ZLD_NUM_8822C 0 -+#define BIT_MASK_ZLD_NUM_8822C 0xff -+#define BIT_ZLD_NUM_8822C(x) \ -+ (((x) & BIT_MASK_ZLD_NUM_8822C) << BIT_SHIFT_ZLD_NUM_8822C) -+#define BITS_ZLD_NUM_8822C (BIT_MASK_ZLD_NUM_8822C << BIT_SHIFT_ZLD_NUM_8822C) -+#define BIT_CLEAR_ZLD_NUM_8822C(x) ((x) & (~BITS_ZLD_NUM_8822C)) -+#define BIT_GET_ZLD_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_ZLD_NUM_8822C) & BIT_MASK_ZLD_NUM_8822C) -+#define BIT_SET_ZLD_NUM_8822C(x, v) \ -+ (BIT_CLEAR_ZLD_NUM_8822C(x) | BIT_ZLD_NUM_8822C(v)) -+ -+/* 2 REG_STMP_THSD_8822C */ -+ -+#define BIT_SHIFT_STMP_THSD_8822C 0 -+#define BIT_MASK_STMP_THSD_8822C 0xff -+#define BIT_STMP_THSD_8822C(x) \ -+ (((x) & BIT_MASK_STMP_THSD_8822C) << BIT_SHIFT_STMP_THSD_8822C) -+#define BITS_STMP_THSD_8822C \ -+ (BIT_MASK_STMP_THSD_8822C << BIT_SHIFT_STMP_THSD_8822C) -+#define BIT_CLEAR_STMP_THSD_8822C(x) ((x) & (~BITS_STMP_THSD_8822C)) -+#define BIT_GET_STMP_THSD_8822C(x) \ -+ (((x) >> BIT_SHIFT_STMP_THSD_8822C) & BIT_MASK_STMP_THSD_8822C) -+#define BIT_SET_STMP_THSD_8822C(x, v) \ -+ (BIT_CLEAR_STMP_THSD_8822C(x) | BIT_STMP_THSD_8822C(v)) -+ -+/* 2 REG_WMAC_TXTIMEOUT_8822C */ -+ -+#define BIT_SHIFT_WMAC_TXTIMEOUT_8822C 0 -+#define BIT_MASK_WMAC_TXTIMEOUT_8822C 0xff -+#define BIT_WMAC_TXTIMEOUT_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_TXTIMEOUT_8822C) \ -+ << BIT_SHIFT_WMAC_TXTIMEOUT_8822C) -+#define BITS_WMAC_TXTIMEOUT_8822C \ -+ (BIT_MASK_WMAC_TXTIMEOUT_8822C << BIT_SHIFT_WMAC_TXTIMEOUT_8822C) -+#define BIT_CLEAR_WMAC_TXTIMEOUT_8822C(x) ((x) & (~BITS_WMAC_TXTIMEOUT_8822C)) -+#define BIT_GET_WMAC_TXTIMEOUT_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXTIMEOUT_8822C) & \ -+ BIT_MASK_WMAC_TXTIMEOUT_8822C) -+#define BIT_SET_WMAC_TXTIMEOUT_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_TXTIMEOUT_8822C(x) | BIT_WMAC_TXTIMEOUT_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_USTIME_EDCA_8822C (US TIME TUNING FOR EDCA REGISTER) */ -+ -+#define BIT_SHIFT_USTIME_EDCA_8822C 0 -+#define BIT_MASK_USTIME_EDCA_8822C 0xff -+#define BIT_USTIME_EDCA_8822C(x) \ -+ (((x) & BIT_MASK_USTIME_EDCA_8822C) << BIT_SHIFT_USTIME_EDCA_8822C) -+#define BITS_USTIME_EDCA_8822C \ -+ (BIT_MASK_USTIME_EDCA_8822C << BIT_SHIFT_USTIME_EDCA_8822C) -+#define BIT_CLEAR_USTIME_EDCA_8822C(x) ((x) & (~BITS_USTIME_EDCA_8822C)) -+#define BIT_GET_USTIME_EDCA_8822C(x) \ -+ (((x) >> BIT_SHIFT_USTIME_EDCA_8822C) & BIT_MASK_USTIME_EDCA_8822C) -+#define BIT_SET_USTIME_EDCA_8822C(x, v) \ -+ (BIT_CLEAR_USTIME_EDCA_8822C(x) | BIT_USTIME_EDCA_8822C(v)) -+ -+/* 2 REG_ACKTO_CCK_8822C (ACK TIMEOUT REGISTER FOR CCK RATE) */ -+ -+#define BIT_SHIFT_ACKTO_CCK_8822C 0 -+#define BIT_MASK_ACKTO_CCK_8822C 0xff -+#define BIT_ACKTO_CCK_8822C(x) \ -+ (((x) & BIT_MASK_ACKTO_CCK_8822C) << BIT_SHIFT_ACKTO_CCK_8822C) -+#define BITS_ACKTO_CCK_8822C \ -+ (BIT_MASK_ACKTO_CCK_8822C << BIT_SHIFT_ACKTO_CCK_8822C) -+#define BIT_CLEAR_ACKTO_CCK_8822C(x) ((x) & (~BITS_ACKTO_CCK_8822C)) -+#define BIT_GET_ACKTO_CCK_8822C(x) \ -+ (((x) >> BIT_SHIFT_ACKTO_CCK_8822C) & BIT_MASK_ACKTO_CCK_8822C) -+#define BIT_SET_ACKTO_CCK_8822C(x, v) \ -+ (BIT_CLEAR_ACKTO_CCK_8822C(x) | BIT_ACKTO_CCK_8822C(v)) -+ -+/* 2 REG_MAC_SPEC_SIFS_8822C (SPECIFICATION SIFS REGISTER) */ -+ -+#define BIT_SHIFT_SPEC_SIFS_OFDM_8822C 8 -+#define BIT_MASK_SPEC_SIFS_OFDM_8822C 0xff -+#define BIT_SPEC_SIFS_OFDM_8822C(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_OFDM_8822C) \ -+ << BIT_SHIFT_SPEC_SIFS_OFDM_8822C) -+#define BITS_SPEC_SIFS_OFDM_8822C \ -+ (BIT_MASK_SPEC_SIFS_OFDM_8822C << BIT_SHIFT_SPEC_SIFS_OFDM_8822C) -+#define BIT_CLEAR_SPEC_SIFS_OFDM_8822C(x) ((x) & (~BITS_SPEC_SIFS_OFDM_8822C)) -+#define BIT_GET_SPEC_SIFS_OFDM_8822C(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_OFDM_8822C) & \ -+ BIT_MASK_SPEC_SIFS_OFDM_8822C) -+#define BIT_SET_SPEC_SIFS_OFDM_8822C(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_OFDM_8822C(x) | BIT_SPEC_SIFS_OFDM_8822C(v)) -+ -+#define BIT_SHIFT_SPEC_SIFS_CCK_8822C 0 -+#define BIT_MASK_SPEC_SIFS_CCK_8822C 0xff -+#define BIT_SPEC_SIFS_CCK_8822C(x) \ -+ (((x) & BIT_MASK_SPEC_SIFS_CCK_8822C) << BIT_SHIFT_SPEC_SIFS_CCK_8822C) -+#define BITS_SPEC_SIFS_CCK_8822C \ -+ (BIT_MASK_SPEC_SIFS_CCK_8822C << BIT_SHIFT_SPEC_SIFS_CCK_8822C) -+#define BIT_CLEAR_SPEC_SIFS_CCK_8822C(x) ((x) & (~BITS_SPEC_SIFS_CCK_8822C)) -+#define BIT_GET_SPEC_SIFS_CCK_8822C(x) \ -+ (((x) >> BIT_SHIFT_SPEC_SIFS_CCK_8822C) & BIT_MASK_SPEC_SIFS_CCK_8822C) -+#define BIT_SET_SPEC_SIFS_CCK_8822C(x, v) \ -+ (BIT_CLEAR_SPEC_SIFS_CCK_8822C(x) | BIT_SPEC_SIFS_CCK_8822C(v)) -+ -+/* 2 REG_RESP_SIFS_CCK_8822C (RESPONSE SIFS FOR CCK REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_CCK_8822C 8 -+#define BIT_MASK_SIFS_R2T_CCK_8822C 0xff -+#define BIT_SIFS_R2T_CCK_8822C(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_CCK_8822C) << BIT_SHIFT_SIFS_R2T_CCK_8822C) -+#define BITS_SIFS_R2T_CCK_8822C \ -+ (BIT_MASK_SIFS_R2T_CCK_8822C << BIT_SHIFT_SIFS_R2T_CCK_8822C) -+#define BIT_CLEAR_SIFS_R2T_CCK_8822C(x) ((x) & (~BITS_SIFS_R2T_CCK_8822C)) -+#define BIT_GET_SIFS_R2T_CCK_8822C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_CCK_8822C) & BIT_MASK_SIFS_R2T_CCK_8822C) -+#define BIT_SET_SIFS_R2T_CCK_8822C(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_CCK_8822C(x) | BIT_SIFS_R2T_CCK_8822C(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_CCK_8822C 0 -+#define BIT_MASK_SIFS_T2T_CCK_8822C 0xff -+#define BIT_SIFS_T2T_CCK_8822C(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_CCK_8822C) << BIT_SHIFT_SIFS_T2T_CCK_8822C) -+#define BITS_SIFS_T2T_CCK_8822C \ -+ (BIT_MASK_SIFS_T2T_CCK_8822C << BIT_SHIFT_SIFS_T2T_CCK_8822C) -+#define BIT_CLEAR_SIFS_T2T_CCK_8822C(x) ((x) & (~BITS_SIFS_T2T_CCK_8822C)) -+#define BIT_GET_SIFS_T2T_CCK_8822C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_CCK_8822C) & BIT_MASK_SIFS_T2T_CCK_8822C) -+#define BIT_SET_SIFS_T2T_CCK_8822C(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_CCK_8822C(x) | BIT_SIFS_T2T_CCK_8822C(v)) -+ -+/* 2 REG_RESP_SIFS_OFDM_8822C (RESPONSE SIFS FOR OFDM REGISTER) */ -+ -+#define BIT_SHIFT_SIFS_R2T_OFDM_8822C 8 -+#define BIT_MASK_SIFS_R2T_OFDM_8822C 0xff -+#define BIT_SIFS_R2T_OFDM_8822C(x) \ -+ (((x) & BIT_MASK_SIFS_R2T_OFDM_8822C) << BIT_SHIFT_SIFS_R2T_OFDM_8822C) -+#define BITS_SIFS_R2T_OFDM_8822C \ -+ (BIT_MASK_SIFS_R2T_OFDM_8822C << BIT_SHIFT_SIFS_R2T_OFDM_8822C) -+#define BIT_CLEAR_SIFS_R2T_OFDM_8822C(x) ((x) & (~BITS_SIFS_R2T_OFDM_8822C)) -+#define BIT_GET_SIFS_R2T_OFDM_8822C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_R2T_OFDM_8822C) & BIT_MASK_SIFS_R2T_OFDM_8822C) -+#define BIT_SET_SIFS_R2T_OFDM_8822C(x, v) \ -+ (BIT_CLEAR_SIFS_R2T_OFDM_8822C(x) | BIT_SIFS_R2T_OFDM_8822C(v)) -+ -+#define BIT_SHIFT_SIFS_T2T_OFDM_8822C 0 -+#define BIT_MASK_SIFS_T2T_OFDM_8822C 0xff -+#define BIT_SIFS_T2T_OFDM_8822C(x) \ -+ (((x) & BIT_MASK_SIFS_T2T_OFDM_8822C) << BIT_SHIFT_SIFS_T2T_OFDM_8822C) -+#define BITS_SIFS_T2T_OFDM_8822C \ -+ (BIT_MASK_SIFS_T2T_OFDM_8822C << BIT_SHIFT_SIFS_T2T_OFDM_8822C) -+#define BIT_CLEAR_SIFS_T2T_OFDM_8822C(x) ((x) & (~BITS_SIFS_T2T_OFDM_8822C)) -+#define BIT_GET_SIFS_T2T_OFDM_8822C(x) \ -+ (((x) >> BIT_SHIFT_SIFS_T2T_OFDM_8822C) & BIT_MASK_SIFS_T2T_OFDM_8822C) -+#define BIT_SET_SIFS_T2T_OFDM_8822C(x, v) \ -+ (BIT_CLEAR_SIFS_T2T_OFDM_8822C(x) | BIT_SIFS_T2T_OFDM_8822C(v)) -+ -+/* 2 REG_ACKTO_8822C (ACK TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_ACKTO_8822C 0 -+#define BIT_MASK_ACKTO_8822C 0xff -+#define BIT_ACKTO_8822C(x) \ -+ (((x) & BIT_MASK_ACKTO_8822C) << BIT_SHIFT_ACKTO_8822C) -+#define BITS_ACKTO_8822C (BIT_MASK_ACKTO_8822C << BIT_SHIFT_ACKTO_8822C) -+#define BIT_CLEAR_ACKTO_8822C(x) ((x) & (~BITS_ACKTO_8822C)) -+#define BIT_GET_ACKTO_8822C(x) \ -+ (((x) >> BIT_SHIFT_ACKTO_8822C) & BIT_MASK_ACKTO_8822C) -+#define BIT_SET_ACKTO_8822C(x, v) \ -+ (BIT_CLEAR_ACKTO_8822C(x) | BIT_ACKTO_8822C(v)) -+ -+/* 2 REG_CTS2TO_8822C (CTS2 TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_CTS2TO_8822C 0 -+#define BIT_MASK_CTS2TO_8822C 0xff -+#define BIT_CTS2TO_8822C(x) \ -+ (((x) & BIT_MASK_CTS2TO_8822C) << BIT_SHIFT_CTS2TO_8822C) -+#define BITS_CTS2TO_8822C (BIT_MASK_CTS2TO_8822C << BIT_SHIFT_CTS2TO_8822C) -+#define BIT_CLEAR_CTS2TO_8822C(x) ((x) & (~BITS_CTS2TO_8822C)) -+#define BIT_GET_CTS2TO_8822C(x) \ -+ (((x) >> BIT_SHIFT_CTS2TO_8822C) & BIT_MASK_CTS2TO_8822C) -+#define BIT_SET_CTS2TO_8822C(x, v) \ -+ (BIT_CLEAR_CTS2TO_8822C(x) | BIT_CTS2TO_8822C(v)) -+ -+/* 2 REG_EIFS_8822C (EIFS REGISTER) */ -+ -+#define BIT_SHIFT_EIFS_8822C 0 -+#define BIT_MASK_EIFS_8822C 0xffff -+#define BIT_EIFS_8822C(x) (((x) & BIT_MASK_EIFS_8822C) << BIT_SHIFT_EIFS_8822C) -+#define BITS_EIFS_8822C (BIT_MASK_EIFS_8822C << BIT_SHIFT_EIFS_8822C) -+#define BIT_CLEAR_EIFS_8822C(x) ((x) & (~BITS_EIFS_8822C)) -+#define BIT_GET_EIFS_8822C(x) \ -+ (((x) >> BIT_SHIFT_EIFS_8822C) & BIT_MASK_EIFS_8822C) -+#define BIT_SET_EIFS_8822C(x, v) (BIT_CLEAR_EIFS_8822C(x) | BIT_EIFS_8822C(v)) -+ -+/* 2 REG_RPFM_MAP0_8822C */ -+#define BIT_MGT_RPFM15EN_8822C BIT(15) -+#define BIT_MGT_RPFM14EN_8822C BIT(14) -+#define BIT_MGT_RPFM13EN_8822C BIT(13) -+#define BIT_MGT_RPFM12EN_8822C BIT(12) -+#define BIT_MGT_RPFM11EN_8822C BIT(11) -+#define BIT_MGT_RPFM10EN_8822C BIT(10) -+#define BIT_MGT_RPFM9EN_8822C BIT(9) -+#define BIT_MGT_RPFM8EN_8822C BIT(8) -+#define BIT_MGT_RPFM7EN_8822C BIT(7) -+#define BIT_MGT_RPFM6EN_8822C BIT(6) -+#define BIT_MGT_RPFM5EN_8822C BIT(5) -+#define BIT_MGT_RPFM4EN_8822C BIT(4) -+#define BIT_MGT_RPFM3EN_8822C BIT(3) -+#define BIT_MGT_RPFM2EN_8822C BIT(2) -+#define BIT_MGT_RPFM1EN_8822C BIT(1) -+#define BIT_MGT_RPFM0EN_8822C BIT(0) -+ -+/* 2 REG_RPFM_MAP1_V1_8822C */ -+#define BIT_DATA_RPFM15EN_8822C BIT(15) -+#define BIT_DATA_RPFM14EN_8822C BIT(14) -+#define BIT_DATA_RPFM13EN_8822C BIT(13) -+#define BIT_DATA_RPFM12EN_8822C BIT(12) -+#define BIT_DATA_RPFM11EN_8822C BIT(11) -+#define BIT_DATA_RPFM10EN_8822C BIT(10) -+#define BIT_DATA_RPFM9EN_8822C BIT(9) -+#define BIT_DATA_RPFM8EN_8822C BIT(8) -+#define BIT_DATA_RPFM7EN_8822C BIT(7) -+#define BIT_DATA_RPFM6EN_8822C BIT(6) -+#define BIT_DATA_RPFM5EN_8822C BIT(5) -+#define BIT_DATA_RPFM4EN_8822C BIT(4) -+#define BIT_DATA_RPFM3EN_8822C BIT(3) -+#define BIT_DATA_RPFM2EN_8822C BIT(2) -+#define BIT_DATA_RPFM1EN_8822C BIT(1) -+#define BIT_DATA_RPFM0EN_8822C BIT(0) -+ -+/* 2 REG_RPFM_CAM_CMD_8822C (RX PAYLOAD FRAME MASK CAM COMMAND REGISTER) */ -+#define BIT_RPFM_CAM_POLLING_8822C BIT(31) -+#define BIT_RPFM_CAM_CLR_8822C BIT(30) -+#define BIT_RPFM_CAM_WE_8822C BIT(16) -+ -+#define BIT_SHIFT_RPFM_CAM_ADDR_8822C 0 -+#define BIT_MASK_RPFM_CAM_ADDR_8822C 0x7f -+#define BIT_RPFM_CAM_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_RPFM_CAM_ADDR_8822C) << BIT_SHIFT_RPFM_CAM_ADDR_8822C) -+#define BITS_RPFM_CAM_ADDR_8822C \ -+ (BIT_MASK_RPFM_CAM_ADDR_8822C << BIT_SHIFT_RPFM_CAM_ADDR_8822C) -+#define BIT_CLEAR_RPFM_CAM_ADDR_8822C(x) ((x) & (~BITS_RPFM_CAM_ADDR_8822C)) -+#define BIT_GET_RPFM_CAM_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_RPFM_CAM_ADDR_8822C) & BIT_MASK_RPFM_CAM_ADDR_8822C) -+#define BIT_SET_RPFM_CAM_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_RPFM_CAM_ADDR_8822C(x) | BIT_RPFM_CAM_ADDR_8822C(v)) -+ -+/* 2 REG_RPFM_CAM_RWD_8822C (ACK TIMEOUT REGISTER) */ -+ -+#define BIT_SHIFT_RPFM_CAM_RWD_8822C 0 -+#define BIT_MASK_RPFM_CAM_RWD_8822C 0xffffffffL -+#define BIT_RPFM_CAM_RWD_8822C(x) \ -+ (((x) & BIT_MASK_RPFM_CAM_RWD_8822C) << BIT_SHIFT_RPFM_CAM_RWD_8822C) -+#define BITS_RPFM_CAM_RWD_8822C \ -+ (BIT_MASK_RPFM_CAM_RWD_8822C << BIT_SHIFT_RPFM_CAM_RWD_8822C) -+#define BIT_CLEAR_RPFM_CAM_RWD_8822C(x) ((x) & (~BITS_RPFM_CAM_RWD_8822C)) -+#define BIT_GET_RPFM_CAM_RWD_8822C(x) \ -+ (((x) >> BIT_SHIFT_RPFM_CAM_RWD_8822C) & BIT_MASK_RPFM_CAM_RWD_8822C) -+#define BIT_SET_RPFM_CAM_RWD_8822C(x, v) \ -+ (BIT_CLEAR_RPFM_CAM_RWD_8822C(x) | BIT_RPFM_CAM_RWD_8822C(v)) -+ -+/* 2 REG_NAV_CTRL_8822C (NAV CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_NAV_UPPER_8822C 16 -+#define BIT_MASK_NAV_UPPER_8822C 0xff -+#define BIT_NAV_UPPER_8822C(x) \ -+ (((x) & BIT_MASK_NAV_UPPER_8822C) << BIT_SHIFT_NAV_UPPER_8822C) -+#define BITS_NAV_UPPER_8822C \ -+ (BIT_MASK_NAV_UPPER_8822C << BIT_SHIFT_NAV_UPPER_8822C) -+#define BIT_CLEAR_NAV_UPPER_8822C(x) ((x) & (~BITS_NAV_UPPER_8822C)) -+#define BIT_GET_NAV_UPPER_8822C(x) \ -+ (((x) >> BIT_SHIFT_NAV_UPPER_8822C) & BIT_MASK_NAV_UPPER_8822C) -+#define BIT_SET_NAV_UPPER_8822C(x, v) \ -+ (BIT_CLEAR_NAV_UPPER_8822C(x) | BIT_NAV_UPPER_8822C(v)) -+ -+#define BIT_SHIFT_RXMYRTS_NAV_8822C 8 -+#define BIT_MASK_RXMYRTS_NAV_8822C 0xf -+#define BIT_RXMYRTS_NAV_8822C(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_8822C) << BIT_SHIFT_RXMYRTS_NAV_8822C) -+#define BITS_RXMYRTS_NAV_8822C \ -+ (BIT_MASK_RXMYRTS_NAV_8822C << BIT_SHIFT_RXMYRTS_NAV_8822C) -+#define BIT_CLEAR_RXMYRTS_NAV_8822C(x) ((x) & (~BITS_RXMYRTS_NAV_8822C)) -+#define BIT_GET_RXMYRTS_NAV_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_8822C) & BIT_MASK_RXMYRTS_NAV_8822C) -+#define BIT_SET_RXMYRTS_NAV_8822C(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_8822C(x) | BIT_RXMYRTS_NAV_8822C(v)) -+ -+#define BIT_SHIFT_RTSRST_8822C 0 -+#define BIT_MASK_RTSRST_8822C 0xff -+#define BIT_RTSRST_8822C(x) \ -+ (((x) & BIT_MASK_RTSRST_8822C) << BIT_SHIFT_RTSRST_8822C) -+#define BITS_RTSRST_8822C (BIT_MASK_RTSRST_8822C << BIT_SHIFT_RTSRST_8822C) -+#define BIT_CLEAR_RTSRST_8822C(x) ((x) & (~BITS_RTSRST_8822C)) -+#define BIT_GET_RTSRST_8822C(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_8822C) & BIT_MASK_RTSRST_8822C) -+#define BIT_SET_RTSRST_8822C(x, v) \ -+ (BIT_CLEAR_RTSRST_8822C(x) | BIT_RTSRST_8822C(v)) -+ -+/* 2 REG_BACAMCMD_8822C (BLOCK ACK CAM COMMAND REGISTER) */ -+#define BIT_BACAM_POLL_8822C BIT(31) -+#define BIT_BACAM_RST_8822C BIT(17) -+#define BIT_BACAM_RW_8822C BIT(16) -+ -+#define BIT_SHIFT_TXSBM_8822C 14 -+#define BIT_MASK_TXSBM_8822C 0x3 -+#define BIT_TXSBM_8822C(x) \ -+ (((x) & BIT_MASK_TXSBM_8822C) << BIT_SHIFT_TXSBM_8822C) -+#define BITS_TXSBM_8822C (BIT_MASK_TXSBM_8822C << BIT_SHIFT_TXSBM_8822C) -+#define BIT_CLEAR_TXSBM_8822C(x) ((x) & (~BITS_TXSBM_8822C)) -+#define BIT_GET_TXSBM_8822C(x) \ -+ (((x) >> BIT_SHIFT_TXSBM_8822C) & BIT_MASK_TXSBM_8822C) -+#define BIT_SET_TXSBM_8822C(x, v) \ -+ (BIT_CLEAR_TXSBM_8822C(x) | BIT_TXSBM_8822C(v)) -+ -+#define BIT_SHIFT_BACAM_ADDR_8822C 0 -+#define BIT_MASK_BACAM_ADDR_8822C 0x3f -+#define BIT_BACAM_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_BACAM_ADDR_8822C) << BIT_SHIFT_BACAM_ADDR_8822C) -+#define BITS_BACAM_ADDR_8822C \ -+ (BIT_MASK_BACAM_ADDR_8822C << BIT_SHIFT_BACAM_ADDR_8822C) -+#define BIT_CLEAR_BACAM_ADDR_8822C(x) ((x) & (~BITS_BACAM_ADDR_8822C)) -+#define BIT_GET_BACAM_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_BACAM_ADDR_8822C) & BIT_MASK_BACAM_ADDR_8822C) -+#define BIT_SET_BACAM_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_BACAM_ADDR_8822C(x) | BIT_BACAM_ADDR_8822C(v)) -+ -+/* 2 REG_BACAMCONTENT_8822C (BLOCK ACK CAM CONTENT REGISTER) */ -+ -+#define BIT_SHIFT_BA_CONTENT_L_8822C 0 -+#define BIT_MASK_BA_CONTENT_L_8822C 0xffffffffL -+#define BIT_BA_CONTENT_L_8822C(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_L_8822C) << BIT_SHIFT_BA_CONTENT_L_8822C) -+#define BITS_BA_CONTENT_L_8822C \ -+ (BIT_MASK_BA_CONTENT_L_8822C << BIT_SHIFT_BA_CONTENT_L_8822C) -+#define BIT_CLEAR_BA_CONTENT_L_8822C(x) ((x) & (~BITS_BA_CONTENT_L_8822C)) -+#define BIT_GET_BA_CONTENT_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_L_8822C) & BIT_MASK_BA_CONTENT_L_8822C) -+#define BIT_SET_BA_CONTENT_L_8822C(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_L_8822C(x) | BIT_BA_CONTENT_L_8822C(v)) -+ -+/* 2 REG_BACAMCONTENT_H_8822C (BLOCK ACK CAM CONTENT REGISTER) */ -+ -+#define BIT_SHIFT_BA_CONTENT_H_8822C 0 -+#define BIT_MASK_BA_CONTENT_H_8822C 0xffffffffL -+#define BIT_BA_CONTENT_H_8822C(x) \ -+ (((x) & BIT_MASK_BA_CONTENT_H_8822C) << BIT_SHIFT_BA_CONTENT_H_8822C) -+#define BITS_BA_CONTENT_H_8822C \ -+ (BIT_MASK_BA_CONTENT_H_8822C << BIT_SHIFT_BA_CONTENT_H_8822C) -+#define BIT_CLEAR_BA_CONTENT_H_8822C(x) ((x) & (~BITS_BA_CONTENT_H_8822C)) -+#define BIT_GET_BA_CONTENT_H_8822C(x) \ -+ (((x) >> BIT_SHIFT_BA_CONTENT_H_8822C) & BIT_MASK_BA_CONTENT_H_8822C) -+#define BIT_SET_BA_CONTENT_H_8822C(x, v) \ -+ (BIT_CLEAR_BA_CONTENT_H_8822C(x) | BIT_BA_CONTENT_H_8822C(v)) -+ -+/* 2 REG_LBDLY_8822C (LOOPBACK DELAY REGISTER) */ -+ -+#define BIT_SHIFT_LBDLY_8822C 0 -+#define BIT_MASK_LBDLY_8822C 0x1f -+#define BIT_LBDLY_8822C(x) \ -+ (((x) & BIT_MASK_LBDLY_8822C) << BIT_SHIFT_LBDLY_8822C) -+#define BITS_LBDLY_8822C (BIT_MASK_LBDLY_8822C << BIT_SHIFT_LBDLY_8822C) -+#define BIT_CLEAR_LBDLY_8822C(x) ((x) & (~BITS_LBDLY_8822C)) -+#define BIT_GET_LBDLY_8822C(x) \ -+ (((x) >> BIT_SHIFT_LBDLY_8822C) & BIT_MASK_LBDLY_8822C) -+#define BIT_SET_LBDLY_8822C(x, v) \ -+ (BIT_CLEAR_LBDLY_8822C(x) | BIT_LBDLY_8822C(v)) -+ -+/* 2 REG_WMAC_BACAM_RPMEN_8822C */ -+ -+#define BIT_SHIFT_BITMAP_SSNBK_COUNTER_8822C 2 -+#define BIT_MASK_BITMAP_SSNBK_COUNTER_8822C 0x3f -+#define BIT_BITMAP_SSNBK_COUNTER_8822C(x) \ -+ (((x) & BIT_MASK_BITMAP_SSNBK_COUNTER_8822C) \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8822C) -+#define BITS_BITMAP_SSNBK_COUNTER_8822C \ -+ (BIT_MASK_BITMAP_SSNBK_COUNTER_8822C \ -+ << BIT_SHIFT_BITMAP_SSNBK_COUNTER_8822C) -+#define BIT_CLEAR_BITMAP_SSNBK_COUNTER_8822C(x) \ -+ ((x) & (~BITS_BITMAP_SSNBK_COUNTER_8822C)) -+#define BIT_GET_BITMAP_SSNBK_COUNTER_8822C(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_SSNBK_COUNTER_8822C) & \ -+ BIT_MASK_BITMAP_SSNBK_COUNTER_8822C) -+#define BIT_SET_BITMAP_SSNBK_COUNTER_8822C(x, v) \ -+ (BIT_CLEAR_BITMAP_SSNBK_COUNTER_8822C(x) | \ -+ BIT_BITMAP_SSNBK_COUNTER_8822C(v)) -+ -+#define BIT_BITMAP_EN_8822C BIT(1) -+#define BIT_WMAC_BACAM_RPMEN_8822C BIT(0) -+ -+/* 2 REG_TX_RX_8822C STATUS */ -+ -+#define BIT_SHIFT_RXPKT_TYPE_8822C 2 -+#define BIT_MASK_RXPKT_TYPE_8822C 0x3f -+#define BIT_RXPKT_TYPE_8822C(x) \ -+ (((x) & BIT_MASK_RXPKT_TYPE_8822C) << BIT_SHIFT_RXPKT_TYPE_8822C) -+#define BITS_RXPKT_TYPE_8822C \ -+ (BIT_MASK_RXPKT_TYPE_8822C << BIT_SHIFT_RXPKT_TYPE_8822C) -+#define BIT_CLEAR_RXPKT_TYPE_8822C(x) ((x) & (~BITS_RXPKT_TYPE_8822C)) -+#define BIT_GET_RXPKT_TYPE_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXPKT_TYPE_8822C) & BIT_MASK_RXPKT_TYPE_8822C) -+#define BIT_SET_RXPKT_TYPE_8822C(x, v) \ -+ (BIT_CLEAR_RXPKT_TYPE_8822C(x) | BIT_RXPKT_TYPE_8822C(v)) -+ -+#define BIT_TXACT_IND_8822C BIT(1) -+#define BIT_RXACT_IND_8822C BIT(0) -+ -+/* 2 REG_WMAC_BITMAP_CTL_8822C */ -+#define BIT_BITMAP_VO_8822C BIT(7) -+#define BIT_BITMAP_VI_8822C BIT(6) -+#define BIT_BITMAP_BE_8822C BIT(5) -+#define BIT_BITMAP_BK_8822C BIT(4) -+ -+#define BIT_SHIFT_BITMAP_CONDITION_8822C 2 -+#define BIT_MASK_BITMAP_CONDITION_8822C 0x3 -+#define BIT_BITMAP_CONDITION_8822C(x) \ -+ (((x) & BIT_MASK_BITMAP_CONDITION_8822C) \ -+ << BIT_SHIFT_BITMAP_CONDITION_8822C) -+#define BITS_BITMAP_CONDITION_8822C \ -+ (BIT_MASK_BITMAP_CONDITION_8822C << BIT_SHIFT_BITMAP_CONDITION_8822C) -+#define BIT_CLEAR_BITMAP_CONDITION_8822C(x) \ -+ ((x) & (~BITS_BITMAP_CONDITION_8822C)) -+#define BIT_GET_BITMAP_CONDITION_8822C(x) \ -+ (((x) >> BIT_SHIFT_BITMAP_CONDITION_8822C) & \ -+ BIT_MASK_BITMAP_CONDITION_8822C) -+#define BIT_SET_BITMAP_CONDITION_8822C(x, v) \ -+ (BIT_CLEAR_BITMAP_CONDITION_8822C(x) | BIT_BITMAP_CONDITION_8822C(v)) -+ -+#define BIT_BITMAP_SSNBK_COUNTER_CLR_8822C BIT(1) -+#define BIT_BITMAP_FORCE_8822C BIT(0) -+ -+/* 2 REG_RXERR_RPT_8822C (RX ERROR REPORT REGISTER) */ -+ -+#define BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8822C 28 -+#define BIT_MASK_RXERR_RPT_SEL_V1_3_0_8822C 0xf -+#define BIT_RXERR_RPT_SEL_V1_3_0_8822C(x) \ -+ (((x) & BIT_MASK_RXERR_RPT_SEL_V1_3_0_8822C) \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8822C) -+#define BITS_RXERR_RPT_SEL_V1_3_0_8822C \ -+ (BIT_MASK_RXERR_RPT_SEL_V1_3_0_8822C \ -+ << BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8822C) -+#define BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8822C(x) \ -+ ((x) & (~BITS_RXERR_RPT_SEL_V1_3_0_8822C)) -+#define BIT_GET_RXERR_RPT_SEL_V1_3_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXERR_RPT_SEL_V1_3_0_8822C) & \ -+ BIT_MASK_RXERR_RPT_SEL_V1_3_0_8822C) -+#define BIT_SET_RXERR_RPT_SEL_V1_3_0_8822C(x, v) \ -+ (BIT_CLEAR_RXERR_RPT_SEL_V1_3_0_8822C(x) | \ -+ BIT_RXERR_RPT_SEL_V1_3_0_8822C(v)) -+ -+#define BIT_RXERR_RPT_RST_8822C BIT(27) -+#define BIT_RXERR_RPT_SEL_V1_4_8822C BIT(26) -+ -+#define BIT_SHIFT_UD_SELECT_BSSID_2_1_8822C 24 -+#define BIT_MASK_UD_SELECT_BSSID_2_1_8822C 0x3 -+#define BIT_UD_SELECT_BSSID_2_1_8822C(x) \ -+ (((x) & BIT_MASK_UD_SELECT_BSSID_2_1_8822C) \ -+ << BIT_SHIFT_UD_SELECT_BSSID_2_1_8822C) -+#define BITS_UD_SELECT_BSSID_2_1_8822C \ -+ (BIT_MASK_UD_SELECT_BSSID_2_1_8822C \ -+ << BIT_SHIFT_UD_SELECT_BSSID_2_1_8822C) -+#define BIT_CLEAR_UD_SELECT_BSSID_2_1_8822C(x) \ -+ ((x) & (~BITS_UD_SELECT_BSSID_2_1_8822C)) -+#define BIT_GET_UD_SELECT_BSSID_2_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_UD_SELECT_BSSID_2_1_8822C) & \ -+ BIT_MASK_UD_SELECT_BSSID_2_1_8822C) -+#define BIT_SET_UD_SELECT_BSSID_2_1_8822C(x, v) \ -+ (BIT_CLEAR_UD_SELECT_BSSID_2_1_8822C(x) | \ -+ BIT_UD_SELECT_BSSID_2_1_8822C(v)) -+ -+#define BIT_W1S_8822C BIT(23) -+#define BIT_UD_SELECT_BSSID_0_8822C BIT(22) -+ -+#define BIT_SHIFT_UD_SUB_TYPE_8822C 18 -+#define BIT_MASK_UD_SUB_TYPE_8822C 0xf -+#define BIT_UD_SUB_TYPE_8822C(x) \ -+ (((x) & BIT_MASK_UD_SUB_TYPE_8822C) << BIT_SHIFT_UD_SUB_TYPE_8822C) -+#define BITS_UD_SUB_TYPE_8822C \ -+ (BIT_MASK_UD_SUB_TYPE_8822C << BIT_SHIFT_UD_SUB_TYPE_8822C) -+#define BIT_CLEAR_UD_SUB_TYPE_8822C(x) ((x) & (~BITS_UD_SUB_TYPE_8822C)) -+#define BIT_GET_UD_SUB_TYPE_8822C(x) \ -+ (((x) >> BIT_SHIFT_UD_SUB_TYPE_8822C) & BIT_MASK_UD_SUB_TYPE_8822C) -+#define BIT_SET_UD_SUB_TYPE_8822C(x, v) \ -+ (BIT_CLEAR_UD_SUB_TYPE_8822C(x) | BIT_UD_SUB_TYPE_8822C(v)) -+ -+#define BIT_SHIFT_UD_TYPE_8822C 16 -+#define BIT_MASK_UD_TYPE_8822C 0x3 -+#define BIT_UD_TYPE_8822C(x) \ -+ (((x) & BIT_MASK_UD_TYPE_8822C) << BIT_SHIFT_UD_TYPE_8822C) -+#define BITS_UD_TYPE_8822C (BIT_MASK_UD_TYPE_8822C << BIT_SHIFT_UD_TYPE_8822C) -+#define BIT_CLEAR_UD_TYPE_8822C(x) ((x) & (~BITS_UD_TYPE_8822C)) -+#define BIT_GET_UD_TYPE_8822C(x) \ -+ (((x) >> BIT_SHIFT_UD_TYPE_8822C) & BIT_MASK_UD_TYPE_8822C) -+#define BIT_SET_UD_TYPE_8822C(x, v) \ -+ (BIT_CLEAR_UD_TYPE_8822C(x) | BIT_UD_TYPE_8822C(v)) -+ -+#define BIT_SHIFT_RPT_COUNTER_8822C 0 -+#define BIT_MASK_RPT_COUNTER_8822C 0xffff -+#define BIT_RPT_COUNTER_8822C(x) \ -+ (((x) & BIT_MASK_RPT_COUNTER_8822C) << BIT_SHIFT_RPT_COUNTER_8822C) -+#define BITS_RPT_COUNTER_8822C \ -+ (BIT_MASK_RPT_COUNTER_8822C << BIT_SHIFT_RPT_COUNTER_8822C) -+#define BIT_CLEAR_RPT_COUNTER_8822C(x) ((x) & (~BITS_RPT_COUNTER_8822C)) -+#define BIT_GET_RPT_COUNTER_8822C(x) \ -+ (((x) >> BIT_SHIFT_RPT_COUNTER_8822C) & BIT_MASK_RPT_COUNTER_8822C) -+#define BIT_SET_RPT_COUNTER_8822C(x, v) \ -+ (BIT_CLEAR_RPT_COUNTER_8822C(x) | BIT_RPT_COUNTER_8822C(v)) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_8822C (WMAC TX/RX PROTOCOL CONTROL REGISTER) */ -+#define BIT_ACKTO_BLOCK_SCH_EN_8822C BIT(27) -+#define BIT_EIFS_BLOCK_SCH_EN_8822C BIT(26) -+#define BIT_PLCPCHK_RST_EIFS_8822C BIT(25) -+#define BIT_CCA_RST_EIFS_8822C BIT(24) -+#define BIT_DIS_UPD_MYRXPKTNAV_8822C BIT(23) -+#define BIT_EARLY_TXBA_8822C BIT(22) -+ -+#define BIT_SHIFT_RESP_CHNBUSY_8822C 20 -+#define BIT_MASK_RESP_CHNBUSY_8822C 0x3 -+#define BIT_RESP_CHNBUSY_8822C(x) \ -+ (((x) & BIT_MASK_RESP_CHNBUSY_8822C) << BIT_SHIFT_RESP_CHNBUSY_8822C) -+#define BITS_RESP_CHNBUSY_8822C \ -+ (BIT_MASK_RESP_CHNBUSY_8822C << BIT_SHIFT_RESP_CHNBUSY_8822C) -+#define BIT_CLEAR_RESP_CHNBUSY_8822C(x) ((x) & (~BITS_RESP_CHNBUSY_8822C)) -+#define BIT_GET_RESP_CHNBUSY_8822C(x) \ -+ (((x) >> BIT_SHIFT_RESP_CHNBUSY_8822C) & BIT_MASK_RESP_CHNBUSY_8822C) -+#define BIT_SET_RESP_CHNBUSY_8822C(x, v) \ -+ (BIT_CLEAR_RESP_CHNBUSY_8822C(x) | BIT_RESP_CHNBUSY_8822C(v)) -+ -+#define BIT_RESP_DCTS_EN_8822C BIT(19) -+#define BIT_RESP_DCFE_EN_8822C BIT(18) -+#define BIT_RESP_SPLCPEN_8822C BIT(17) -+#define BIT_RESP_SGIEN_8822C BIT(16) -+#define BIT_RESP_LDPC_EN_8822C BIT(15) -+#define BIT_DIS_RESP_ACKINCCA_8822C BIT(14) -+#define BIT_DIS_RESP_CTSINCCA_8822C BIT(13) -+ -+#define BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8822C 10 -+#define BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8822C 0x7 -+#define BIT_R_WMAC_SECOND_CCA_TIMER_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8822C) \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8822C) -+#define BITS_R_WMAC_SECOND_CCA_TIMER_8822C \ -+ (BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8822C \ -+ << BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8822C) -+#define BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_SECOND_CCA_TIMER_8822C)) -+#define BIT_GET_R_WMAC_SECOND_CCA_TIMER_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SECOND_CCA_TIMER_8822C) & \ -+ BIT_MASK_R_WMAC_SECOND_CCA_TIMER_8822C) -+#define BIT_SET_R_WMAC_SECOND_CCA_TIMER_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_SECOND_CCA_TIMER_8822C(x) | \ -+ BIT_R_WMAC_SECOND_CCA_TIMER_8822C(v)) -+ -+#define BIT_SHIFT_RFMOD_8822C 7 -+#define BIT_MASK_RFMOD_8822C 0x3 -+#define BIT_RFMOD_8822C(x) \ -+ (((x) & BIT_MASK_RFMOD_8822C) << BIT_SHIFT_RFMOD_8822C) -+#define BITS_RFMOD_8822C (BIT_MASK_RFMOD_8822C << BIT_SHIFT_RFMOD_8822C) -+#define BIT_CLEAR_RFMOD_8822C(x) ((x) & (~BITS_RFMOD_8822C)) -+#define BIT_GET_RFMOD_8822C(x) \ -+ (((x) >> BIT_SHIFT_RFMOD_8822C) & BIT_MASK_RFMOD_8822C) -+#define BIT_SET_RFMOD_8822C(x, v) \ -+ (BIT_CLEAR_RFMOD_8822C(x) | BIT_RFMOD_8822C(v)) -+ -+#define BIT_SHIFT_RESP_CTS_DYNBW_SEL_8822C 5 -+#define BIT_MASK_RESP_CTS_DYNBW_SEL_8822C 0x3 -+#define BIT_RESP_CTS_DYNBW_SEL_8822C(x) \ -+ (((x) & BIT_MASK_RESP_CTS_DYNBW_SEL_8822C) \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8822C) -+#define BITS_RESP_CTS_DYNBW_SEL_8822C \ -+ (BIT_MASK_RESP_CTS_DYNBW_SEL_8822C \ -+ << BIT_SHIFT_RESP_CTS_DYNBW_SEL_8822C) -+#define BIT_CLEAR_RESP_CTS_DYNBW_SEL_8822C(x) \ -+ ((x) & (~BITS_RESP_CTS_DYNBW_SEL_8822C)) -+#define BIT_GET_RESP_CTS_DYNBW_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_RESP_CTS_DYNBW_SEL_8822C) & \ -+ BIT_MASK_RESP_CTS_DYNBW_SEL_8822C) -+#define BIT_SET_RESP_CTS_DYNBW_SEL_8822C(x, v) \ -+ (BIT_CLEAR_RESP_CTS_DYNBW_SEL_8822C(x) | \ -+ BIT_RESP_CTS_DYNBW_SEL_8822C(v)) -+ -+#define BIT_DLY_TX_WAIT_RXANTSEL_8822C BIT(4) -+#define BIT_TXRESP_BY_RXANTSEL_8822C BIT(3) -+ -+#define BIT_SHIFT_ORIG_DCTS_CHK_8822C 0 -+#define BIT_MASK_ORIG_DCTS_CHK_8822C 0x3 -+#define BIT_ORIG_DCTS_CHK_8822C(x) \ -+ (((x) & BIT_MASK_ORIG_DCTS_CHK_8822C) << BIT_SHIFT_ORIG_DCTS_CHK_8822C) -+#define BITS_ORIG_DCTS_CHK_8822C \ -+ (BIT_MASK_ORIG_DCTS_CHK_8822C << BIT_SHIFT_ORIG_DCTS_CHK_8822C) -+#define BIT_CLEAR_ORIG_DCTS_CHK_8822C(x) ((x) & (~BITS_ORIG_DCTS_CHK_8822C)) -+#define BIT_GET_ORIG_DCTS_CHK_8822C(x) \ -+ (((x) >> BIT_SHIFT_ORIG_DCTS_CHK_8822C) & BIT_MASK_ORIG_DCTS_CHK_8822C) -+#define BIT_SET_ORIG_DCTS_CHK_8822C(x, v) \ -+ (BIT_CLEAR_ORIG_DCTS_CHK_8822C(x) | BIT_ORIG_DCTS_CHK_8822C(v)) -+ -+/* 2 REG_WMAC_TRXPTCL_CTL_H_8822C */ -+ -+#define BIT_SHIFT_ACKBA_TYPSEL_8822C 28 -+#define BIT_MASK_ACKBA_TYPSEL_8822C 0xf -+#define BIT_ACKBA_TYPSEL_8822C(x) \ -+ (((x) & BIT_MASK_ACKBA_TYPSEL_8822C) << BIT_SHIFT_ACKBA_TYPSEL_8822C) -+#define BITS_ACKBA_TYPSEL_8822C \ -+ (BIT_MASK_ACKBA_TYPSEL_8822C << BIT_SHIFT_ACKBA_TYPSEL_8822C) -+#define BIT_CLEAR_ACKBA_TYPSEL_8822C(x) ((x) & (~BITS_ACKBA_TYPSEL_8822C)) -+#define BIT_GET_ACKBA_TYPSEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_TYPSEL_8822C) & BIT_MASK_ACKBA_TYPSEL_8822C) -+#define BIT_SET_ACKBA_TYPSEL_8822C(x, v) \ -+ (BIT_CLEAR_ACKBA_TYPSEL_8822C(x) | BIT_ACKBA_TYPSEL_8822C(v)) -+ -+#define BIT_SHIFT_ACKBA_ACKPCHK_8822C 24 -+#define BIT_MASK_ACKBA_ACKPCHK_8822C 0xf -+#define BIT_ACKBA_ACKPCHK_8822C(x) \ -+ (((x) & BIT_MASK_ACKBA_ACKPCHK_8822C) << BIT_SHIFT_ACKBA_ACKPCHK_8822C) -+#define BITS_ACKBA_ACKPCHK_8822C \ -+ (BIT_MASK_ACKBA_ACKPCHK_8822C << BIT_SHIFT_ACKBA_ACKPCHK_8822C) -+#define BIT_CLEAR_ACKBA_ACKPCHK_8822C(x) ((x) & (~BITS_ACKBA_ACKPCHK_8822C)) -+#define BIT_GET_ACKBA_ACKPCHK_8822C(x) \ -+ (((x) >> BIT_SHIFT_ACKBA_ACKPCHK_8822C) & BIT_MASK_ACKBA_ACKPCHK_8822C) -+#define BIT_SET_ACKBA_ACKPCHK_8822C(x, v) \ -+ (BIT_CLEAR_ACKBA_ACKPCHK_8822C(x) | BIT_ACKBA_ACKPCHK_8822C(v)) -+ -+#define BIT_SHIFT_ACKBAR_TYPESEL_8822C 16 -+#define BIT_MASK_ACKBAR_TYPESEL_8822C 0xff -+#define BIT_ACKBAR_TYPESEL_8822C(x) \ -+ (((x) & BIT_MASK_ACKBAR_TYPESEL_8822C) \ -+ << BIT_SHIFT_ACKBAR_TYPESEL_8822C) -+#define BITS_ACKBAR_TYPESEL_8822C \ -+ (BIT_MASK_ACKBAR_TYPESEL_8822C << BIT_SHIFT_ACKBAR_TYPESEL_8822C) -+#define BIT_CLEAR_ACKBAR_TYPESEL_8822C(x) ((x) & (~BITS_ACKBAR_TYPESEL_8822C)) -+#define BIT_GET_ACKBAR_TYPESEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_TYPESEL_8822C) & \ -+ BIT_MASK_ACKBAR_TYPESEL_8822C) -+#define BIT_SET_ACKBAR_TYPESEL_8822C(x, v) \ -+ (BIT_CLEAR_ACKBAR_TYPESEL_8822C(x) | BIT_ACKBAR_TYPESEL_8822C(v)) -+ -+#define BIT_SHIFT_ACKBAR_ACKPCHK_8822C 12 -+#define BIT_MASK_ACKBAR_ACKPCHK_8822C 0xf -+#define BIT_ACKBAR_ACKPCHK_8822C(x) \ -+ (((x) & BIT_MASK_ACKBAR_ACKPCHK_8822C) \ -+ << BIT_SHIFT_ACKBAR_ACKPCHK_8822C) -+#define BITS_ACKBAR_ACKPCHK_8822C \ -+ (BIT_MASK_ACKBAR_ACKPCHK_8822C << BIT_SHIFT_ACKBAR_ACKPCHK_8822C) -+#define BIT_CLEAR_ACKBAR_ACKPCHK_8822C(x) ((x) & (~BITS_ACKBAR_ACKPCHK_8822C)) -+#define BIT_GET_ACKBAR_ACKPCHK_8822C(x) \ -+ (((x) >> BIT_SHIFT_ACKBAR_ACKPCHK_8822C) & \ -+ BIT_MASK_ACKBAR_ACKPCHK_8822C) -+#define BIT_SET_ACKBAR_ACKPCHK_8822C(x, v) \ -+ (BIT_CLEAR_ACKBAR_ACKPCHK_8822C(x) | BIT_ACKBAR_ACKPCHK_8822C(v)) -+ -+#define BIT_RXBA_IGNOREA2_V1_8822C BIT(10) -+#define BIT_EN_SAVE_ALL_TXOPADDR_V1_8822C BIT(9) -+#define BIT_EN_TXCTS_TO_TXOPOWNER_INRXNAV_V1_8822C BIT(8) -+#define BIT_DIS_TXBA_AMPDUFCSERR_V1_8822C BIT(7) -+#define BIT_DIS_TXBA_RXBARINFULL_V1_8822C BIT(6) -+#define BIT_DIS_TXCFE_INFULL_V1_8822C BIT(5) -+#define BIT_DIS_TXCTS_INFULL_V1_8822C BIT(4) -+#define BIT_EN_TXACKBA_IN_TX_RDG_V1_8822C BIT(3) -+#define BIT_EN_TXACKBA_IN_TXOP_V1_8822C BIT(2) -+#define BIT_EN_TXCTS_IN_RXNAV_V1_8822C BIT(1) -+#define BIT_EN_TXCTS_INTXOP_V1_8822C BIT(0) -+ -+/* 2 REG_CAMCMD_8822C (CAM COMMAND REGISTER) */ -+#define BIT_SECCAM_POLLING_8822C BIT(31) -+#define BIT_SECCAM_CLR_8822C BIT(30) -+#define BIT_SECCAM_WE_8822C BIT(16) -+ -+#define BIT_SHIFT_SECCAM_ADDR_V2_8822C 0 -+#define BIT_MASK_SECCAM_ADDR_V2_8822C 0x3ff -+#define BIT_SECCAM_ADDR_V2_8822C(x) \ -+ (((x) & BIT_MASK_SECCAM_ADDR_V2_8822C) \ -+ << BIT_SHIFT_SECCAM_ADDR_V2_8822C) -+#define BITS_SECCAM_ADDR_V2_8822C \ -+ (BIT_MASK_SECCAM_ADDR_V2_8822C << BIT_SHIFT_SECCAM_ADDR_V2_8822C) -+#define BIT_CLEAR_SECCAM_ADDR_V2_8822C(x) ((x) & (~BITS_SECCAM_ADDR_V2_8822C)) -+#define BIT_GET_SECCAM_ADDR_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_SECCAM_ADDR_V2_8822C) & \ -+ BIT_MASK_SECCAM_ADDR_V2_8822C) -+#define BIT_SET_SECCAM_ADDR_V2_8822C(x, v) \ -+ (BIT_CLEAR_SECCAM_ADDR_V2_8822C(x) | BIT_SECCAM_ADDR_V2_8822C(v)) -+ -+/* 2 REG_CAMWRITE_8822C (CAM WRITE REGISTER) */ -+ -+#define BIT_SHIFT_CAMW_DATA_8822C 0 -+#define BIT_MASK_CAMW_DATA_8822C 0xffffffffL -+#define BIT_CAMW_DATA_8822C(x) \ -+ (((x) & BIT_MASK_CAMW_DATA_8822C) << BIT_SHIFT_CAMW_DATA_8822C) -+#define BITS_CAMW_DATA_8822C \ -+ (BIT_MASK_CAMW_DATA_8822C << BIT_SHIFT_CAMW_DATA_8822C) -+#define BIT_CLEAR_CAMW_DATA_8822C(x) ((x) & (~BITS_CAMW_DATA_8822C)) -+#define BIT_GET_CAMW_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_CAMW_DATA_8822C) & BIT_MASK_CAMW_DATA_8822C) -+#define BIT_SET_CAMW_DATA_8822C(x, v) \ -+ (BIT_CLEAR_CAMW_DATA_8822C(x) | BIT_CAMW_DATA_8822C(v)) -+ -+/* 2 REG_CAMREAD_8822C (CAM READ REGISTER) */ -+ -+#define BIT_SHIFT_CAMR_DATA_8822C 0 -+#define BIT_MASK_CAMR_DATA_8822C 0xffffffffL -+#define BIT_CAMR_DATA_8822C(x) \ -+ (((x) & BIT_MASK_CAMR_DATA_8822C) << BIT_SHIFT_CAMR_DATA_8822C) -+#define BITS_CAMR_DATA_8822C \ -+ (BIT_MASK_CAMR_DATA_8822C << BIT_SHIFT_CAMR_DATA_8822C) -+#define BIT_CLEAR_CAMR_DATA_8822C(x) ((x) & (~BITS_CAMR_DATA_8822C)) -+#define BIT_GET_CAMR_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_CAMR_DATA_8822C) & BIT_MASK_CAMR_DATA_8822C) -+#define BIT_SET_CAMR_DATA_8822C(x, v) \ -+ (BIT_CLEAR_CAMR_DATA_8822C(x) | BIT_CAMR_DATA_8822C(v)) -+ -+/* 2 REG_CAMDBG_8822C (CAM DEBUG REGISTER) */ -+#define BIT_SECCAM_INFO_8822C BIT(31) -+#define BIT_SEC_KEYFOUND_8822C BIT(15) -+ -+#define BIT_SHIFT_CAMDBG_SEC_TYPE_8822C 12 -+#define BIT_MASK_CAMDBG_SEC_TYPE_8822C 0x7 -+#define BIT_CAMDBG_SEC_TYPE_8822C(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_TYPE_8822C) \ -+ << BIT_SHIFT_CAMDBG_SEC_TYPE_8822C) -+#define BITS_CAMDBG_SEC_TYPE_8822C \ -+ (BIT_MASK_CAMDBG_SEC_TYPE_8822C << BIT_SHIFT_CAMDBG_SEC_TYPE_8822C) -+#define BIT_CLEAR_CAMDBG_SEC_TYPE_8822C(x) ((x) & (~BITS_CAMDBG_SEC_TYPE_8822C)) -+#define BIT_GET_CAMDBG_SEC_TYPE_8822C(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_TYPE_8822C) & \ -+ BIT_MASK_CAMDBG_SEC_TYPE_8822C) -+#define BIT_SET_CAMDBG_SEC_TYPE_8822C(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_TYPE_8822C(x) | BIT_CAMDBG_SEC_TYPE_8822C(v)) -+ -+#define BIT_CAMDBG_EXT_SECTYPE_8822C BIT(11) -+ -+#define BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8822C 5 -+#define BIT_MASK_CAMDBG_MIC_KEY_IDX_8822C 0x1f -+#define BIT_CAMDBG_MIC_KEY_IDX_8822C(x) \ -+ (((x) & BIT_MASK_CAMDBG_MIC_KEY_IDX_8822C) \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8822C) -+#define BITS_CAMDBG_MIC_KEY_IDX_8822C \ -+ (BIT_MASK_CAMDBG_MIC_KEY_IDX_8822C \ -+ << BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8822C) -+#define BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8822C(x) \ -+ ((x) & (~BITS_CAMDBG_MIC_KEY_IDX_8822C)) -+#define BIT_GET_CAMDBG_MIC_KEY_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_MIC_KEY_IDX_8822C) & \ -+ BIT_MASK_CAMDBG_MIC_KEY_IDX_8822C) -+#define BIT_SET_CAMDBG_MIC_KEY_IDX_8822C(x, v) \ -+ (BIT_CLEAR_CAMDBG_MIC_KEY_IDX_8822C(x) | \ -+ BIT_CAMDBG_MIC_KEY_IDX_8822C(v)) -+ -+#define BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8822C 0 -+#define BIT_MASK_CAMDBG_SEC_KEY_IDX_8822C 0x1f -+#define BIT_CAMDBG_SEC_KEY_IDX_8822C(x) \ -+ (((x) & BIT_MASK_CAMDBG_SEC_KEY_IDX_8822C) \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8822C) -+#define BITS_CAMDBG_SEC_KEY_IDX_8822C \ -+ (BIT_MASK_CAMDBG_SEC_KEY_IDX_8822C \ -+ << BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8822C) -+#define BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8822C(x) \ -+ ((x) & (~BITS_CAMDBG_SEC_KEY_IDX_8822C)) -+#define BIT_GET_CAMDBG_SEC_KEY_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_CAMDBG_SEC_KEY_IDX_8822C) & \ -+ BIT_MASK_CAMDBG_SEC_KEY_IDX_8822C) -+#define BIT_SET_CAMDBG_SEC_KEY_IDX_8822C(x, v) \ -+ (BIT_CLEAR_CAMDBG_SEC_KEY_IDX_8822C(x) | \ -+ BIT_CAMDBG_SEC_KEY_IDX_8822C(v)) -+ -+/* 2 REG_SECCFG_8822C (SECURITY CONFIGURATION REGISTER) */ -+#define BIT_DIS_GCLK_WAPI_8822C BIT(15) -+#define BIT_DIS_GCLK_AES_8822C BIT(14) -+#define BIT_DIS_GCLK_TKIP_8822C BIT(13) -+#define BIT_AES_SEL_QC_1_8822C BIT(12) -+#define BIT_AES_SEL_QC_0_8822C BIT(11) -+#define BIT_CHK_BMC_8822C BIT(9) -+#define BIT_CHK_KEYID_8822C BIT(8) -+#define BIT_RXBCUSEDK_8822C BIT(7) -+#define BIT_TXBCUSEDK_8822C BIT(6) -+#define BIT_NOSKMC_8822C BIT(5) -+#define BIT_SKBYA2_8822C BIT(4) -+#define BIT_RXDEC_8822C BIT(3) -+#define BIT_TXENC_8822C BIT(2) -+#define BIT_RXUHUSEDK_8822C BIT(1) -+#define BIT_TXUHUSEDK_8822C BIT(0) -+ -+/* 2 REG_RXFILTER_CATEGORY_1_8822C */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_1_8822C 0 -+#define BIT_MASK_RXFILTER_CATEGORY_1_8822C 0xff -+#define BIT_RXFILTER_CATEGORY_1_8822C(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_1_8822C) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8822C) -+#define BITS_RXFILTER_CATEGORY_1_8822C \ -+ (BIT_MASK_RXFILTER_CATEGORY_1_8822C \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_1_8822C) -+#define BIT_CLEAR_RXFILTER_CATEGORY_1_8822C(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_1_8822C)) -+#define BIT_GET_RXFILTER_CATEGORY_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_1_8822C) & \ -+ BIT_MASK_RXFILTER_CATEGORY_1_8822C) -+#define BIT_SET_RXFILTER_CATEGORY_1_8822C(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_1_8822C(x) | \ -+ BIT_RXFILTER_CATEGORY_1_8822C(v)) -+ -+/* 2 REG_RXFILTER_ACTION_1_8822C */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_1_8822C 0 -+#define BIT_MASK_RXFILTER_ACTION_1_8822C 0xff -+#define BIT_RXFILTER_ACTION_1_8822C(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_1_8822C) \ -+ << BIT_SHIFT_RXFILTER_ACTION_1_8822C) -+#define BITS_RXFILTER_ACTION_1_8822C \ -+ (BIT_MASK_RXFILTER_ACTION_1_8822C << BIT_SHIFT_RXFILTER_ACTION_1_8822C) -+#define BIT_CLEAR_RXFILTER_ACTION_1_8822C(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_1_8822C)) -+#define BIT_GET_RXFILTER_ACTION_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_1_8822C) & \ -+ BIT_MASK_RXFILTER_ACTION_1_8822C) -+#define BIT_SET_RXFILTER_ACTION_1_8822C(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_1_8822C(x) | BIT_RXFILTER_ACTION_1_8822C(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_2_8822C */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_2_8822C 0 -+#define BIT_MASK_RXFILTER_CATEGORY_2_8822C 0xff -+#define BIT_RXFILTER_CATEGORY_2_8822C(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_2_8822C) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8822C) -+#define BITS_RXFILTER_CATEGORY_2_8822C \ -+ (BIT_MASK_RXFILTER_CATEGORY_2_8822C \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_2_8822C) -+#define BIT_CLEAR_RXFILTER_CATEGORY_2_8822C(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_2_8822C)) -+#define BIT_GET_RXFILTER_CATEGORY_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_2_8822C) & \ -+ BIT_MASK_RXFILTER_CATEGORY_2_8822C) -+#define BIT_SET_RXFILTER_CATEGORY_2_8822C(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_2_8822C(x) | \ -+ BIT_RXFILTER_CATEGORY_2_8822C(v)) -+ -+/* 2 REG_RXFILTER_ACTION_2_8822C */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_2_8822C 0 -+#define BIT_MASK_RXFILTER_ACTION_2_8822C 0xff -+#define BIT_RXFILTER_ACTION_2_8822C(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_2_8822C) \ -+ << BIT_SHIFT_RXFILTER_ACTION_2_8822C) -+#define BITS_RXFILTER_ACTION_2_8822C \ -+ (BIT_MASK_RXFILTER_ACTION_2_8822C << BIT_SHIFT_RXFILTER_ACTION_2_8822C) -+#define BIT_CLEAR_RXFILTER_ACTION_2_8822C(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_2_8822C)) -+#define BIT_GET_RXFILTER_ACTION_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_2_8822C) & \ -+ BIT_MASK_RXFILTER_ACTION_2_8822C) -+#define BIT_SET_RXFILTER_ACTION_2_8822C(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_2_8822C(x) | BIT_RXFILTER_ACTION_2_8822C(v)) -+ -+/* 2 REG_RXFILTER_CATEGORY_3_8822C */ -+ -+#define BIT_SHIFT_RXFILTER_CATEGORY_3_8822C 0 -+#define BIT_MASK_RXFILTER_CATEGORY_3_8822C 0xff -+#define BIT_RXFILTER_CATEGORY_3_8822C(x) \ -+ (((x) & BIT_MASK_RXFILTER_CATEGORY_3_8822C) \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8822C) -+#define BITS_RXFILTER_CATEGORY_3_8822C \ -+ (BIT_MASK_RXFILTER_CATEGORY_3_8822C \ -+ << BIT_SHIFT_RXFILTER_CATEGORY_3_8822C) -+#define BIT_CLEAR_RXFILTER_CATEGORY_3_8822C(x) \ -+ ((x) & (~BITS_RXFILTER_CATEGORY_3_8822C)) -+#define BIT_GET_RXFILTER_CATEGORY_3_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_CATEGORY_3_8822C) & \ -+ BIT_MASK_RXFILTER_CATEGORY_3_8822C) -+#define BIT_SET_RXFILTER_CATEGORY_3_8822C(x, v) \ -+ (BIT_CLEAR_RXFILTER_CATEGORY_3_8822C(x) | \ -+ BIT_RXFILTER_CATEGORY_3_8822C(v)) -+ -+/* 2 REG_RXFILTER_ACTION_3_8822C */ -+ -+#define BIT_SHIFT_RXFILTER_ACTION_3_8822C 0 -+#define BIT_MASK_RXFILTER_ACTION_3_8822C 0xff -+#define BIT_RXFILTER_ACTION_3_8822C(x) \ -+ (((x) & BIT_MASK_RXFILTER_ACTION_3_8822C) \ -+ << BIT_SHIFT_RXFILTER_ACTION_3_8822C) -+#define BITS_RXFILTER_ACTION_3_8822C \ -+ (BIT_MASK_RXFILTER_ACTION_3_8822C << BIT_SHIFT_RXFILTER_ACTION_3_8822C) -+#define BIT_CLEAR_RXFILTER_ACTION_3_8822C(x) \ -+ ((x) & (~BITS_RXFILTER_ACTION_3_8822C)) -+#define BIT_GET_RXFILTER_ACTION_3_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXFILTER_ACTION_3_8822C) & \ -+ BIT_MASK_RXFILTER_ACTION_3_8822C) -+#define BIT_SET_RXFILTER_ACTION_3_8822C(x, v) \ -+ (BIT_CLEAR_RXFILTER_ACTION_3_8822C(x) | BIT_RXFILTER_ACTION_3_8822C(v)) -+ -+/* 2 REG_RXFLTMAP3_8822C (RX FILTER MAP GROUP 3) */ -+#define BIT_MGTFLT15EN_FW_8822C BIT(15) -+#define BIT_MGTFLT14EN_FW_8822C BIT(14) -+#define BIT_MGTFLT13EN_FW_8822C BIT(13) -+#define BIT_MGTFLT12EN_FW_8822C BIT(12) -+#define BIT_MGTFLT11EN_FW_8822C BIT(11) -+#define BIT_MGTFLT10EN_FW_8822C BIT(10) -+#define BIT_MGTFLT9EN_FW_8822C BIT(9) -+#define BIT_MGTFLT8EN_FW_8822C BIT(8) -+#define BIT_MGTFLT7EN_FW_8822C BIT(7) -+#define BIT_MGTFLT6EN_FW_8822C BIT(6) -+#define BIT_MGTFLT5EN_FW_8822C BIT(5) -+#define BIT_MGTFLT4EN_FW_8822C BIT(4) -+#define BIT_MGTFLT3EN_FW_8822C BIT(3) -+#define BIT_MGTFLT2EN_FW_8822C BIT(2) -+#define BIT_MGTFLT1EN_FW_8822C BIT(1) -+#define BIT_MGTFLT0EN_FW_8822C BIT(0) -+ -+/* 2 REG_RXFLTMAP4_8822C (RX FILTER MAP GROUP 4) */ -+#define BIT_CTRLFLT15EN_FW_8822C BIT(15) -+#define BIT_CTRLFLT14EN_FW_8822C BIT(14) -+#define BIT_CTRLFLT13EN_FW_8822C BIT(13) -+#define BIT_CTRLFLT12EN_FW_8822C BIT(12) -+#define BIT_CTRLFLT11EN_FW_8822C BIT(11) -+#define BIT_CTRLFLT10EN_FW_8822C BIT(10) -+#define BIT_CTRLFLT9EN_FW_8822C BIT(9) -+#define BIT_CTRLFLT8EN_FW_8822C BIT(8) -+#define BIT_CTRLFLT7EN_FW_8822C BIT(7) -+#define BIT_CTRLFLT6EN_FW_8822C BIT(6) -+#define BIT_CTRLFLT5EN_FW_8822C BIT(5) -+#define BIT_CTRLFLT4EN_FW_8822C BIT(4) -+#define BIT_CTRLFLT3EN_FW_8822C BIT(3) -+#define BIT_CTRLFLT2EN_FW_8822C BIT(2) -+#define BIT_CTRLFLT1EN_FW_8822C BIT(1) -+#define BIT_CTRLFLT0EN_FW_8822C BIT(0) -+ -+/* 2 REG_RXFLTMAP5_8822C (RX FILTER MAP GROUP 5) */ -+#define BIT_DATAFLT15EN_FW_8822C BIT(15) -+#define BIT_DATAFLT14EN_FW_8822C BIT(14) -+#define BIT_DATAFLT13EN_FW_8822C BIT(13) -+#define BIT_DATAFLT12EN_FW_8822C BIT(12) -+#define BIT_DATAFLT11EN_FW_8822C BIT(11) -+#define BIT_DATAFLT10EN_FW_8822C BIT(10) -+#define BIT_DATAFLT9EN_FW_8822C BIT(9) -+#define BIT_DATAFLT8EN_FW_8822C BIT(8) -+#define BIT_DATAFLT7EN_FW_8822C BIT(7) -+#define BIT_DATAFLT6EN_FW_8822C BIT(6) -+#define BIT_DATAFLT5EN_FW_8822C BIT(5) -+#define BIT_DATAFLT4EN_FW_8822C BIT(4) -+#define BIT_DATAFLT3EN_FW_8822C BIT(3) -+#define BIT_DATAFLT2EN_FW_8822C BIT(2) -+#define BIT_DATAFLT1EN_FW_8822C BIT(1) -+#define BIT_DATAFLT0EN_FW_8822C BIT(0) -+ -+/* 2 REG_RXFLTMAP6_8822C (RX FILTER MAP GROUP 6) */ -+#define BIT_ACTIONFLT15EN_FW_8822C BIT(15) -+#define BIT_ACTIONFLT14EN_FW_8822C BIT(14) -+#define BIT_ACTIONFLT13EN_FW_8822C BIT(13) -+#define BIT_ACTIONFLT12EN_FW_8822C BIT(12) -+#define BIT_ACTIONFLT11EN_FW_8822C BIT(11) -+#define BIT_ACTIONFLT10EN_FW_8822C BIT(10) -+#define BIT_ACTIONFLT9EN_FW_8822C BIT(9) -+#define BIT_ACTIONFLT8EN_FW_8822C BIT(8) -+#define BIT_ACTIONFLT7EN_FW_8822C BIT(7) -+#define BIT_ACTIONFLT6EN_FW_8822C BIT(6) -+#define BIT_ACTIONFLT5EN_FW_8822C BIT(5) -+#define BIT_ACTIONFLT4EN_FW_8822C BIT(4) -+#define BIT_ACTIONFLT3EN_FW_8822C BIT(3) -+#define BIT_ACTIONFLT2EN_FW_8822C BIT(2) -+#define BIT_ACTIONFLT1EN_FW_8822C BIT(1) -+#define BIT_ACTIONFLT0EN_FW_8822C BIT(0) -+ -+/* 2 REG_WOW_CTRL_8822C (WAKE ON WLAN CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_PSF_BSSIDSEL_B2B1_8822C 6 -+#define BIT_MASK_PSF_BSSIDSEL_B2B1_8822C 0x3 -+#define BIT_PSF_BSSIDSEL_B2B1_8822C(x) \ -+ (((x) & BIT_MASK_PSF_BSSIDSEL_B2B1_8822C) \ -+ << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8822C) -+#define BITS_PSF_BSSIDSEL_B2B1_8822C \ -+ (BIT_MASK_PSF_BSSIDSEL_B2B1_8822C << BIT_SHIFT_PSF_BSSIDSEL_B2B1_8822C) -+#define BIT_CLEAR_PSF_BSSIDSEL_B2B1_8822C(x) \ -+ ((x) & (~BITS_PSF_BSSIDSEL_B2B1_8822C)) -+#define BIT_GET_PSF_BSSIDSEL_B2B1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PSF_BSSIDSEL_B2B1_8822C) & \ -+ BIT_MASK_PSF_BSSIDSEL_B2B1_8822C) -+#define BIT_SET_PSF_BSSIDSEL_B2B1_8822C(x, v) \ -+ (BIT_CLEAR_PSF_BSSIDSEL_B2B1_8822C(x) | BIT_PSF_BSSIDSEL_B2B1_8822C(v)) -+ -+#define BIT_WOWHCI_8822C BIT(5) -+#define BIT_PSF_BSSIDSEL_B0_8822C BIT(4) -+#define BIT_UWF_8822C BIT(3) -+#define BIT_MAGIC_8822C BIT(2) -+#define BIT_WOWEN_8822C BIT(1) -+#define BIT_FORCE_WAKEUP_8822C BIT(0) -+ -+/* 2 REG_NAN_RX_TSF_FILTER_8822C(NAN_RX_TSF_ADDRESS_FILTER) */ -+#define BIT_CHK_TSF_TA_8822C BIT(2) -+#define BIT_CHK_TSF_CBSSID_8822C BIT(1) -+#define BIT_CHK_TSF_EN_8822C BIT(0) -+ -+/* 2 REG_PS_RX_INFO_8822C (POWER SAVE RX INFORMATION REGISTER) */ -+ -+#define BIT_SHIFT_PORTSEL__PS_RX_INFO_8822C 5 -+#define BIT_MASK_PORTSEL__PS_RX_INFO_8822C 0x7 -+#define BIT_PORTSEL__PS_RX_INFO_8822C(x) \ -+ (((x) & BIT_MASK_PORTSEL__PS_RX_INFO_8822C) \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8822C) -+#define BITS_PORTSEL__PS_RX_INFO_8822C \ -+ (BIT_MASK_PORTSEL__PS_RX_INFO_8822C \ -+ << BIT_SHIFT_PORTSEL__PS_RX_INFO_8822C) -+#define BIT_CLEAR_PORTSEL__PS_RX_INFO_8822C(x) \ -+ ((x) & (~BITS_PORTSEL__PS_RX_INFO_8822C)) -+#define BIT_GET_PORTSEL__PS_RX_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_PORTSEL__PS_RX_INFO_8822C) & \ -+ BIT_MASK_PORTSEL__PS_RX_INFO_8822C) -+#define BIT_SET_PORTSEL__PS_RX_INFO_8822C(x, v) \ -+ (BIT_CLEAR_PORTSEL__PS_RX_INFO_8822C(x) | \ -+ BIT_PORTSEL__PS_RX_INFO_8822C(v)) -+ -+#define BIT_RXCTRLIN0_8822C BIT(4) -+#define BIT_RXMGTIN0_8822C BIT(3) -+#define BIT_RXDATAIN2_8822C BIT(2) -+#define BIT_RXDATAIN1_8822C BIT(1) -+#define BIT_RXDATAIN0_8822C BIT(0) -+ -+/* 2 REG_WMMPS_UAPSD_TID_8822C (WMM POWER SAVE UAPSD TID REGISTER) */ -+#define BIT_WMMPS_UAPSD_TID7_8822C BIT(7) -+#define BIT_WMMPS_UAPSD_TID6_8822C BIT(6) -+#define BIT_WMMPS_UAPSD_TID5_8822C BIT(5) -+#define BIT_WMMPS_UAPSD_TID4_8822C BIT(4) -+#define BIT_WMMPS_UAPSD_TID3_8822C BIT(3) -+#define BIT_WMMPS_UAPSD_TID2_8822C BIT(2) -+#define BIT_WMMPS_UAPSD_TID1_8822C BIT(1) -+#define BIT_WMMPS_UAPSD_TID0_8822C BIT(0) -+ -+/* 2 REG_LPNAV_CTRL_8822C (LOW POWER NAV CONTROL REGISTER) */ -+ -+/* 2 REG_WKFMCAM_CMD_8822C (WAKEUP FRAME CAM COMMAND REGISTER) */ -+#define BIT_WKFCAM_POLLING_V1_8822C BIT(31) -+#define BIT_WKFCAM_CLR_V1_8822C BIT(30) -+#define BIT_WKFCAM_WE_8822C BIT(16) -+ -+#define BIT_SHIFT_WKFCAM_ADDR_V2_8822C 8 -+#define BIT_MASK_WKFCAM_ADDR_V2_8822C 0xff -+#define BIT_WKFCAM_ADDR_V2_8822C(x) \ -+ (((x) & BIT_MASK_WKFCAM_ADDR_V2_8822C) \ -+ << BIT_SHIFT_WKFCAM_ADDR_V2_8822C) -+#define BITS_WKFCAM_ADDR_V2_8822C \ -+ (BIT_MASK_WKFCAM_ADDR_V2_8822C << BIT_SHIFT_WKFCAM_ADDR_V2_8822C) -+#define BIT_CLEAR_WKFCAM_ADDR_V2_8822C(x) ((x) & (~BITS_WKFCAM_ADDR_V2_8822C)) -+#define BIT_GET_WKFCAM_ADDR_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_ADDR_V2_8822C) & \ -+ BIT_MASK_WKFCAM_ADDR_V2_8822C) -+#define BIT_SET_WKFCAM_ADDR_V2_8822C(x, v) \ -+ (BIT_CLEAR_WKFCAM_ADDR_V2_8822C(x) | BIT_WKFCAM_ADDR_V2_8822C(v)) -+ -+#define BIT_SHIFT_WKFCAM_CAM_NUM_V1_8822C 0 -+#define BIT_MASK_WKFCAM_CAM_NUM_V1_8822C 0xff -+#define BIT_WKFCAM_CAM_NUM_V1_8822C(x) \ -+ (((x) & BIT_MASK_WKFCAM_CAM_NUM_V1_8822C) \ -+ << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8822C) -+#define BITS_WKFCAM_CAM_NUM_V1_8822C \ -+ (BIT_MASK_WKFCAM_CAM_NUM_V1_8822C << BIT_SHIFT_WKFCAM_CAM_NUM_V1_8822C) -+#define BIT_CLEAR_WKFCAM_CAM_NUM_V1_8822C(x) \ -+ ((x) & (~BITS_WKFCAM_CAM_NUM_V1_8822C)) -+#define BIT_GET_WKFCAM_CAM_NUM_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_WKFCAM_CAM_NUM_V1_8822C) & \ -+ BIT_MASK_WKFCAM_CAM_NUM_V1_8822C) -+#define BIT_SET_WKFCAM_CAM_NUM_V1_8822C(x, v) \ -+ (BIT_CLEAR_WKFCAM_CAM_NUM_V1_8822C(x) | BIT_WKFCAM_CAM_NUM_V1_8822C(v)) -+ -+/* 2 REG_WKFMCAM_RWD_8822C (WAKEUP FRAME READ/WRITE DATA) */ -+ -+#define BIT_SHIFT_WKFMCAM_RWD_8822C 0 -+#define BIT_MASK_WKFMCAM_RWD_8822C 0xffffffffL -+#define BIT_WKFMCAM_RWD_8822C(x) \ -+ (((x) & BIT_MASK_WKFMCAM_RWD_8822C) << BIT_SHIFT_WKFMCAM_RWD_8822C) -+#define BITS_WKFMCAM_RWD_8822C \ -+ (BIT_MASK_WKFMCAM_RWD_8822C << BIT_SHIFT_WKFMCAM_RWD_8822C) -+#define BIT_CLEAR_WKFMCAM_RWD_8822C(x) ((x) & (~BITS_WKFMCAM_RWD_8822C)) -+#define BIT_GET_WKFMCAM_RWD_8822C(x) \ -+ (((x) >> BIT_SHIFT_WKFMCAM_RWD_8822C) & BIT_MASK_WKFMCAM_RWD_8822C) -+#define BIT_SET_WKFMCAM_RWD_8822C(x, v) \ -+ (BIT_CLEAR_WKFMCAM_RWD_8822C(x) | BIT_WKFMCAM_RWD_8822C(v)) -+ -+/* 2 REG_RXFLTMAP0_8822C (RX FILTER MAP GROUP 0) */ -+#define BIT_MGTFLT15EN_8822C BIT(15) -+#define BIT_MGTFLT14EN_8822C BIT(14) -+#define BIT_MGTFLT13EN_8822C BIT(13) -+#define BIT_MGTFLT12EN_8822C BIT(12) -+#define BIT_MGTFLT11EN_8822C BIT(11) -+#define BIT_MGTFLT10EN_8822C BIT(10) -+#define BIT_MGTFLT9EN_8822C BIT(9) -+#define BIT_MGTFLT8EN_8822C BIT(8) -+#define BIT_MGTFLT7EN_8822C BIT(7) -+#define BIT_MGTFLT6EN_8822C BIT(6) -+#define BIT_MGTFLT5EN_8822C BIT(5) -+#define BIT_MGTFLT4EN_8822C BIT(4) -+#define BIT_MGTFLT3EN_8822C BIT(3) -+#define BIT_MGTFLT2EN_8822C BIT(2) -+#define BIT_MGTFLT1EN_8822C BIT(1) -+#define BIT_MGTFLT0EN_8822C BIT(0) -+ -+/* 2 REG_RXFLTMAP1_8822C (RX FILTER MAP GROUP 1) */ -+#define BIT_CTRLFLT15EN_8822C BIT(15) -+#define BIT_CTRLFLT14EN_8822C BIT(14) -+#define BIT_CTRLFLT13EN_8822C BIT(13) -+#define BIT_CTRLFLT12EN_8822C BIT(12) -+#define BIT_CTRLFLT11EN_8822C BIT(11) -+#define BIT_CTRLFLT10EN_8822C BIT(10) -+#define BIT_CTRLFLT9EN_8822C BIT(9) -+#define BIT_CTRLFLT8EN_8822C BIT(8) -+#define BIT_CTRLFLT7EN_8822C BIT(7) -+#define BIT_CTRLFLT6EN_8822C BIT(6) -+#define BIT_CTRLFLT5EN_8822C BIT(5) -+#define BIT_CTRLFLT4EN_8822C BIT(4) -+#define BIT_CTRLFLT3EN_8822C BIT(3) -+#define BIT_CTRLFLT2EN_8822C BIT(2) -+#define BIT_CTRLFLT1EN_8822C BIT(1) -+#define BIT_CTRLFLT0EN_8822C BIT(0) -+ -+/* 2 REG_RXFLTMAP2_8822C (RX FILTER MAP GROUP 2) */ -+#define BIT_DATAFLT15EN_8822C BIT(15) -+#define BIT_DATAFLT14EN_8822C BIT(14) -+#define BIT_DATAFLT13EN_8822C BIT(13) -+#define BIT_DATAFLT12EN_8822C BIT(12) -+#define BIT_DATAFLT11EN_8822C BIT(11) -+#define BIT_DATAFLT10EN_8822C BIT(10) -+#define BIT_DATAFLT9EN_8822C BIT(9) -+#define BIT_DATAFLT8EN_8822C BIT(8) -+#define BIT_DATAFLT7EN_8822C BIT(7) -+#define BIT_DATAFLT6EN_8822C BIT(6) -+#define BIT_DATAFLT5EN_8822C BIT(5) -+#define BIT_DATAFLT4EN_8822C BIT(4) -+#define BIT_DATAFLT3EN_8822C BIT(3) -+#define BIT_DATAFLT2EN_8822C BIT(2) -+#define BIT_DATAFLT1EN_8822C BIT(1) -+#define BIT_DATAFLT0EN_8822C BIT(0) -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_BCN_PSR_RPT_8822C (BEACON PARSER REPORT REGISTER) */ -+ -+#define BIT_SHIFT_DTIM_CNT_8822C 24 -+#define BIT_MASK_DTIM_CNT_8822C 0xff -+#define BIT_DTIM_CNT_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_CNT_8822C) << BIT_SHIFT_DTIM_CNT_8822C) -+#define BITS_DTIM_CNT_8822C \ -+ (BIT_MASK_DTIM_CNT_8822C << BIT_SHIFT_DTIM_CNT_8822C) -+#define BIT_CLEAR_DTIM_CNT_8822C(x) ((x) & (~BITS_DTIM_CNT_8822C)) -+#define BIT_GET_DTIM_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT_8822C) & BIT_MASK_DTIM_CNT_8822C) -+#define BIT_SET_DTIM_CNT_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_CNT_8822C(x) | BIT_DTIM_CNT_8822C(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD_8822C 16 -+#define BIT_MASK_DTIM_PERIOD_8822C 0xff -+#define BIT_DTIM_PERIOD_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD_8822C) << BIT_SHIFT_DTIM_PERIOD_8822C) -+#define BITS_DTIM_PERIOD_8822C \ -+ (BIT_MASK_DTIM_PERIOD_8822C << BIT_SHIFT_DTIM_PERIOD_8822C) -+#define BIT_CLEAR_DTIM_PERIOD_8822C(x) ((x) & (~BITS_DTIM_PERIOD_8822C)) -+#define BIT_GET_DTIM_PERIOD_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD_8822C) & BIT_MASK_DTIM_PERIOD_8822C) -+#define BIT_SET_DTIM_PERIOD_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD_8822C(x) | BIT_DTIM_PERIOD_8822C(v)) -+ -+#define BIT_DTIM_8822C BIT(15) -+#define BIT_TIM_8822C BIT(14) -+#define BIT_RPT_VALID_8822C BIT(13) -+ -+#define BIT_SHIFT_PS_AID_0_8822C 0 -+#define BIT_MASK_PS_AID_0_8822C 0x7ff -+#define BIT_PS_AID_0_8822C(x) \ -+ (((x) & BIT_MASK_PS_AID_0_8822C) << BIT_SHIFT_PS_AID_0_8822C) -+#define BITS_PS_AID_0_8822C \ -+ (BIT_MASK_PS_AID_0_8822C << BIT_SHIFT_PS_AID_0_8822C) -+#define BIT_CLEAR_PS_AID_0_8822C(x) ((x) & (~BITS_PS_AID_0_8822C)) -+#define BIT_GET_PS_AID_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_0_8822C) & BIT_MASK_PS_AID_0_8822C) -+#define BIT_SET_PS_AID_0_8822C(x, v) \ -+ (BIT_CLEAR_PS_AID_0_8822C(x) | BIT_PS_AID_0_8822C(v)) -+ -+/* 2 REG_FLC_RPC_8822C (FW LPS CONDITION -- RX PKT COUNTER) */ -+ -+#define BIT_SHIFT_FLC_RPC_8822C 0 -+#define BIT_MASK_FLC_RPC_8822C 0xff -+#define BIT_FLC_RPC_8822C(x) \ -+ (((x) & BIT_MASK_FLC_RPC_8822C) << BIT_SHIFT_FLC_RPC_8822C) -+#define BITS_FLC_RPC_8822C (BIT_MASK_FLC_RPC_8822C << BIT_SHIFT_FLC_RPC_8822C) -+#define BIT_CLEAR_FLC_RPC_8822C(x) ((x) & (~BITS_FLC_RPC_8822C)) -+#define BIT_GET_FLC_RPC_8822C(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPC_8822C) & BIT_MASK_FLC_RPC_8822C) -+#define BIT_SET_FLC_RPC_8822C(x, v) \ -+ (BIT_CLEAR_FLC_RPC_8822C(x) | BIT_FLC_RPC_8822C(v)) -+ -+/* 2 REG_FLC_RPCT_8822C (FLC_RPC THRESHOLD) */ -+ -+#define BIT_SHIFT_FLC_RPCT_8822C 0 -+#define BIT_MASK_FLC_RPCT_8822C 0xff -+#define BIT_FLC_RPCT_8822C(x) \ -+ (((x) & BIT_MASK_FLC_RPCT_8822C) << BIT_SHIFT_FLC_RPCT_8822C) -+#define BITS_FLC_RPCT_8822C \ -+ (BIT_MASK_FLC_RPCT_8822C << BIT_SHIFT_FLC_RPCT_8822C) -+#define BIT_CLEAR_FLC_RPCT_8822C(x) ((x) & (~BITS_FLC_RPCT_8822C)) -+#define BIT_GET_FLC_RPCT_8822C(x) \ -+ (((x) >> BIT_SHIFT_FLC_RPCT_8822C) & BIT_MASK_FLC_RPCT_8822C) -+#define BIT_SET_FLC_RPCT_8822C(x, v) \ -+ (BIT_CLEAR_FLC_RPCT_8822C(x) | BIT_FLC_RPCT_8822C(v)) -+ -+/* 2 REG_FLC_PTS_8822C (PKT TYPE SELECTION OF FLC_RPC T) */ -+#define BIT_CMF_8822C BIT(2) -+#define BIT_CCF_8822C BIT(1) -+#define BIT_CDF_8822C BIT(0) -+ -+/* 2 REG_FLC_TRPC_8822C (TIMER OF FLC_RPC) */ -+#define BIT_FLC_RPCT_V1_8822C BIT(7) -+#define BIT_MODE_8822C BIT(6) -+ -+#define BIT_SHIFT_TRPCD_8822C 0 -+#define BIT_MASK_TRPCD_8822C 0x3f -+#define BIT_TRPCD_8822C(x) \ -+ (((x) & BIT_MASK_TRPCD_8822C) << BIT_SHIFT_TRPCD_8822C) -+#define BITS_TRPCD_8822C (BIT_MASK_TRPCD_8822C << BIT_SHIFT_TRPCD_8822C) -+#define BIT_CLEAR_TRPCD_8822C(x) ((x) & (~BITS_TRPCD_8822C)) -+#define BIT_GET_TRPCD_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRPCD_8822C) & BIT_MASK_TRPCD_8822C) -+#define BIT_SET_TRPCD_8822C(x, v) \ -+ (BIT_CLEAR_TRPCD_8822C(x) | BIT_TRPCD_8822C(v)) -+ -+/* 2 REG_RXPKTMON_CTRL_8822C */ -+ -+#define BIT_SHIFT_RXBKQPKT_SEQ_8822C 20 -+#define BIT_MASK_RXBKQPKT_SEQ_8822C 0xf -+#define BIT_RXBKQPKT_SEQ_8822C(x) \ -+ (((x) & BIT_MASK_RXBKQPKT_SEQ_8822C) << BIT_SHIFT_RXBKQPKT_SEQ_8822C) -+#define BITS_RXBKQPKT_SEQ_8822C \ -+ (BIT_MASK_RXBKQPKT_SEQ_8822C << BIT_SHIFT_RXBKQPKT_SEQ_8822C) -+#define BIT_CLEAR_RXBKQPKT_SEQ_8822C(x) ((x) & (~BITS_RXBKQPKT_SEQ_8822C)) -+#define BIT_GET_RXBKQPKT_SEQ_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXBKQPKT_SEQ_8822C) & BIT_MASK_RXBKQPKT_SEQ_8822C) -+#define BIT_SET_RXBKQPKT_SEQ_8822C(x, v) \ -+ (BIT_CLEAR_RXBKQPKT_SEQ_8822C(x) | BIT_RXBKQPKT_SEQ_8822C(v)) -+ -+#define BIT_SHIFT_RXBEQPKT_SEQ_8822C 16 -+#define BIT_MASK_RXBEQPKT_SEQ_8822C 0xf -+#define BIT_RXBEQPKT_SEQ_8822C(x) \ -+ (((x) & BIT_MASK_RXBEQPKT_SEQ_8822C) << BIT_SHIFT_RXBEQPKT_SEQ_8822C) -+#define BITS_RXBEQPKT_SEQ_8822C \ -+ (BIT_MASK_RXBEQPKT_SEQ_8822C << BIT_SHIFT_RXBEQPKT_SEQ_8822C) -+#define BIT_CLEAR_RXBEQPKT_SEQ_8822C(x) ((x) & (~BITS_RXBEQPKT_SEQ_8822C)) -+#define BIT_GET_RXBEQPKT_SEQ_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXBEQPKT_SEQ_8822C) & BIT_MASK_RXBEQPKT_SEQ_8822C) -+#define BIT_SET_RXBEQPKT_SEQ_8822C(x, v) \ -+ (BIT_CLEAR_RXBEQPKT_SEQ_8822C(x) | BIT_RXBEQPKT_SEQ_8822C(v)) -+ -+#define BIT_SHIFT_RXVIQPKT_SEQ_8822C 12 -+#define BIT_MASK_RXVIQPKT_SEQ_8822C 0xf -+#define BIT_RXVIQPKT_SEQ_8822C(x) \ -+ (((x) & BIT_MASK_RXVIQPKT_SEQ_8822C) << BIT_SHIFT_RXVIQPKT_SEQ_8822C) -+#define BITS_RXVIQPKT_SEQ_8822C \ -+ (BIT_MASK_RXVIQPKT_SEQ_8822C << BIT_SHIFT_RXVIQPKT_SEQ_8822C) -+#define BIT_CLEAR_RXVIQPKT_SEQ_8822C(x) ((x) & (~BITS_RXVIQPKT_SEQ_8822C)) -+#define BIT_GET_RXVIQPKT_SEQ_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXVIQPKT_SEQ_8822C) & BIT_MASK_RXVIQPKT_SEQ_8822C) -+#define BIT_SET_RXVIQPKT_SEQ_8822C(x, v) \ -+ (BIT_CLEAR_RXVIQPKT_SEQ_8822C(x) | BIT_RXVIQPKT_SEQ_8822C(v)) -+ -+#define BIT_SHIFT_RXVOQPKT_SEQ_8822C 8 -+#define BIT_MASK_RXVOQPKT_SEQ_8822C 0xf -+#define BIT_RXVOQPKT_SEQ_8822C(x) \ -+ (((x) & BIT_MASK_RXVOQPKT_SEQ_8822C) << BIT_SHIFT_RXVOQPKT_SEQ_8822C) -+#define BITS_RXVOQPKT_SEQ_8822C \ -+ (BIT_MASK_RXVOQPKT_SEQ_8822C << BIT_SHIFT_RXVOQPKT_SEQ_8822C) -+#define BIT_CLEAR_RXVOQPKT_SEQ_8822C(x) ((x) & (~BITS_RXVOQPKT_SEQ_8822C)) -+#define BIT_GET_RXVOQPKT_SEQ_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXVOQPKT_SEQ_8822C) & BIT_MASK_RXVOQPKT_SEQ_8822C) -+#define BIT_SET_RXVOQPKT_SEQ_8822C(x, v) \ -+ (BIT_CLEAR_RXVOQPKT_SEQ_8822C(x) | BIT_RXVOQPKT_SEQ_8822C(v)) -+ -+#define BIT_RXBKQPKT_ERR_8822C BIT(7) -+#define BIT_RXBEQPKT_ERR_8822C BIT(6) -+#define BIT_RXVIQPKT_ERR_8822C BIT(5) -+#define BIT_RXVOQPKT_ERR_8822C BIT(4) -+#define BIT_RXDMA_MON_EN_8822C BIT(2) -+#define BIT_RXPKT_MON_RST_8822C BIT(1) -+#define BIT_RXPKT_MON_EN_8822C BIT(0) -+ -+/* 2 REG_STATE_MON_8822C */ -+ -+#define BIT_SHIFT_STATE_SEL_8822C 24 -+#define BIT_MASK_STATE_SEL_8822C 0x1f -+#define BIT_STATE_SEL_8822C(x) \ -+ (((x) & BIT_MASK_STATE_SEL_8822C) << BIT_SHIFT_STATE_SEL_8822C) -+#define BITS_STATE_SEL_8822C \ -+ (BIT_MASK_STATE_SEL_8822C << BIT_SHIFT_STATE_SEL_8822C) -+#define BIT_CLEAR_STATE_SEL_8822C(x) ((x) & (~BITS_STATE_SEL_8822C)) -+#define BIT_GET_STATE_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_STATE_SEL_8822C) & BIT_MASK_STATE_SEL_8822C) -+#define BIT_SET_STATE_SEL_8822C(x, v) \ -+ (BIT_CLEAR_STATE_SEL_8822C(x) | BIT_STATE_SEL_8822C(v)) -+ -+#define BIT_SHIFT_STATE_INFO_8822C 8 -+#define BIT_MASK_STATE_INFO_8822C 0xff -+#define BIT_STATE_INFO_8822C(x) \ -+ (((x) & BIT_MASK_STATE_INFO_8822C) << BIT_SHIFT_STATE_INFO_8822C) -+#define BITS_STATE_INFO_8822C \ -+ (BIT_MASK_STATE_INFO_8822C << BIT_SHIFT_STATE_INFO_8822C) -+#define BIT_CLEAR_STATE_INFO_8822C(x) ((x) & (~BITS_STATE_INFO_8822C)) -+#define BIT_GET_STATE_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_STATE_INFO_8822C) & BIT_MASK_STATE_INFO_8822C) -+#define BIT_SET_STATE_INFO_8822C(x, v) \ -+ (BIT_CLEAR_STATE_INFO_8822C(x) | BIT_STATE_INFO_8822C(v)) -+ -+#define BIT_UPD_NXT_STATE_8822C BIT(7) -+ -+#define BIT_SHIFT_CUR_STATE_8822C 0 -+#define BIT_MASK_CUR_STATE_8822C 0x7f -+#define BIT_CUR_STATE_8822C(x) \ -+ (((x) & BIT_MASK_CUR_STATE_8822C) << BIT_SHIFT_CUR_STATE_8822C) -+#define BITS_CUR_STATE_8822C \ -+ (BIT_MASK_CUR_STATE_8822C << BIT_SHIFT_CUR_STATE_8822C) -+#define BIT_CLEAR_CUR_STATE_8822C(x) ((x) & (~BITS_CUR_STATE_8822C)) -+#define BIT_GET_CUR_STATE_8822C(x) \ -+ (((x) >> BIT_SHIFT_CUR_STATE_8822C) & BIT_MASK_CUR_STATE_8822C) -+#define BIT_SET_CUR_STATE_8822C(x, v) \ -+ (BIT_CLEAR_CUR_STATE_8822C(x) | BIT_CUR_STATE_8822C(v)) -+ -+/* 2 REG_ERROR_MON_8822C */ -+#define BIT_CSIRPT_LEN_BB_MORE_THAN_MAC_8822C BIT(23) -+#define BIT_CSI_CHKSUM_ERROR_8822C BIT(22) -+#define BIT_MACRX_ERR_4_8822C BIT(20) -+#define BIT_MACRX_ERR_3_8822C BIT(19) -+#define BIT_MACRX_ERR_2_8822C BIT(18) -+#define BIT_MACRX_ERR_1_8822C BIT(17) -+#define BIT_MACRX_ERR_0_8822C BIT(16) -+#define BIT_WMAC_PRETX_ERRHDL_EN_8822C BIT(15) -+#define BIT_MACTX_ERR_5_8822C BIT(5) -+#define BIT_MACTX_ERR_4_8822C BIT(4) -+#define BIT_MACTX_ERR_3_8822C BIT(3) -+#define BIT_MACTX_ERR_2_8822C BIT(2) -+#define BIT_MACTX_ERR_1_8822C BIT(1) -+#define BIT_MACTX_ERR_0_8822C BIT(0) -+ -+/* 2 REG_SEARCH_MACID_8822C */ -+#define BIT_EN_TXRPTBUF_CLK_8822C BIT(31) -+ -+#define BIT_SHIFT_INFO_INDEX_OFFSET_8822C 16 -+#define BIT_MASK_INFO_INDEX_OFFSET_8822C 0x1fff -+#define BIT_INFO_INDEX_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_INFO_INDEX_OFFSET_8822C) \ -+ << BIT_SHIFT_INFO_INDEX_OFFSET_8822C) -+#define BITS_INFO_INDEX_OFFSET_8822C \ -+ (BIT_MASK_INFO_INDEX_OFFSET_8822C << BIT_SHIFT_INFO_INDEX_OFFSET_8822C) -+#define BIT_CLEAR_INFO_INDEX_OFFSET_8822C(x) \ -+ ((x) & (~BITS_INFO_INDEX_OFFSET_8822C)) -+#define BIT_GET_INFO_INDEX_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_INFO_INDEX_OFFSET_8822C) & \ -+ BIT_MASK_INFO_INDEX_OFFSET_8822C) -+#define BIT_SET_INFO_INDEX_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_INFO_INDEX_OFFSET_8822C(x) | BIT_INFO_INDEX_OFFSET_8822C(v)) -+ -+#define BIT_WMAC_SRCH_FIFOFULL_8822C BIT(15) -+#define BIT_DIS_INFOSRCH_8822C BIT(14) -+ -+#define BIT_SHIFT_INFO_ADDR_OFFSET_8822C 0 -+#define BIT_MASK_INFO_ADDR_OFFSET_8822C 0x1fff -+#define BIT_INFO_ADDR_OFFSET_8822C(x) \ -+ (((x) & BIT_MASK_INFO_ADDR_OFFSET_8822C) \ -+ << BIT_SHIFT_INFO_ADDR_OFFSET_8822C) -+#define BITS_INFO_ADDR_OFFSET_8822C \ -+ (BIT_MASK_INFO_ADDR_OFFSET_8822C << BIT_SHIFT_INFO_ADDR_OFFSET_8822C) -+#define BIT_CLEAR_INFO_ADDR_OFFSET_8822C(x) \ -+ ((x) & (~BITS_INFO_ADDR_OFFSET_8822C)) -+#define BIT_GET_INFO_ADDR_OFFSET_8822C(x) \ -+ (((x) >> BIT_SHIFT_INFO_ADDR_OFFSET_8822C) & \ -+ BIT_MASK_INFO_ADDR_OFFSET_8822C) -+#define BIT_SET_INFO_ADDR_OFFSET_8822C(x, v) \ -+ (BIT_CLEAR_INFO_ADDR_OFFSET_8822C(x) | BIT_INFO_ADDR_OFFSET_8822C(v)) -+ -+/* 2 REG_BT_COEX_TABLE_8822C (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_COEX_TABLE_1_8822C 0 -+#define BIT_MASK_COEX_TABLE_1_8822C 0xffffffffL -+#define BIT_COEX_TABLE_1_8822C(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_1_8822C) << BIT_SHIFT_COEX_TABLE_1_8822C) -+#define BITS_COEX_TABLE_1_8822C \ -+ (BIT_MASK_COEX_TABLE_1_8822C << BIT_SHIFT_COEX_TABLE_1_8822C) -+#define BIT_CLEAR_COEX_TABLE_1_8822C(x) ((x) & (~BITS_COEX_TABLE_1_8822C)) -+#define BIT_GET_COEX_TABLE_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_1_8822C) & BIT_MASK_COEX_TABLE_1_8822C) -+#define BIT_SET_COEX_TABLE_1_8822C(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_1_8822C(x) | BIT_COEX_TABLE_1_8822C(v)) -+ -+/* 2 REG_BT_COEX_TABLE2_8822C (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_COEX_TABLE_2_8822C 0 -+#define BIT_MASK_COEX_TABLE_2_8822C 0xffffffffL -+#define BIT_COEX_TABLE_2_8822C(x) \ -+ (((x) & BIT_MASK_COEX_TABLE_2_8822C) << BIT_SHIFT_COEX_TABLE_2_8822C) -+#define BITS_COEX_TABLE_2_8822C \ -+ (BIT_MASK_COEX_TABLE_2_8822C << BIT_SHIFT_COEX_TABLE_2_8822C) -+#define BIT_CLEAR_COEX_TABLE_2_8822C(x) ((x) & (~BITS_COEX_TABLE_2_8822C)) -+#define BIT_GET_COEX_TABLE_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_COEX_TABLE_2_8822C) & BIT_MASK_COEX_TABLE_2_8822C) -+#define BIT_SET_COEX_TABLE_2_8822C(x, v) \ -+ (BIT_CLEAR_COEX_TABLE_2_8822C(x) | BIT_COEX_TABLE_2_8822C(v)) -+ -+/* 2 REG_BT_COEX_BREAK_TABLE_8822C (BT-COEXISTENCE CONTROL REGISTER) */ -+ -+#define BIT_SHIFT_BREAK_TABLE_2_8822C 16 -+#define BIT_MASK_BREAK_TABLE_2_8822C 0xffff -+#define BIT_BREAK_TABLE_2_8822C(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_2_8822C) << BIT_SHIFT_BREAK_TABLE_2_8822C) -+#define BITS_BREAK_TABLE_2_8822C \ -+ (BIT_MASK_BREAK_TABLE_2_8822C << BIT_SHIFT_BREAK_TABLE_2_8822C) -+#define BIT_CLEAR_BREAK_TABLE_2_8822C(x) ((x) & (~BITS_BREAK_TABLE_2_8822C)) -+#define BIT_GET_BREAK_TABLE_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_2_8822C) & BIT_MASK_BREAK_TABLE_2_8822C) -+#define BIT_SET_BREAK_TABLE_2_8822C(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_2_8822C(x) | BIT_BREAK_TABLE_2_8822C(v)) -+ -+#define BIT_SHIFT_BREAK_TABLE_1_8822C 0 -+#define BIT_MASK_BREAK_TABLE_1_8822C 0xffff -+#define BIT_BREAK_TABLE_1_8822C(x) \ -+ (((x) & BIT_MASK_BREAK_TABLE_1_8822C) << BIT_SHIFT_BREAK_TABLE_1_8822C) -+#define BITS_BREAK_TABLE_1_8822C \ -+ (BIT_MASK_BREAK_TABLE_1_8822C << BIT_SHIFT_BREAK_TABLE_1_8822C) -+#define BIT_CLEAR_BREAK_TABLE_1_8822C(x) ((x) & (~BITS_BREAK_TABLE_1_8822C)) -+#define BIT_GET_BREAK_TABLE_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BREAK_TABLE_1_8822C) & BIT_MASK_BREAK_TABLE_1_8822C) -+#define BIT_SET_BREAK_TABLE_1_8822C(x, v) \ -+ (BIT_CLEAR_BREAK_TABLE_1_8822C(x) | BIT_BREAK_TABLE_1_8822C(v)) -+ -+/* 2 REG_BT_COEX_TABLE_H_8822C (BT-COEXISTENCE CONTROL REGISTER) */ -+#define BIT_PRI_MASK_RX_RESP_V1_8822C BIT(30) -+#define BIT_PRI_MASK_RXOFDM_V1_8822C BIT(29) -+#define BIT_PRI_MASK_RXCCK_V1_8822C BIT(28) -+ -+#define BIT_SHIFT_PRI_MASK_TXAC_8822C 21 -+#define BIT_MASK_PRI_MASK_TXAC_8822C 0x7f -+#define BIT_PRI_MASK_TXAC_8822C(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TXAC_8822C) << BIT_SHIFT_PRI_MASK_TXAC_8822C) -+#define BITS_PRI_MASK_TXAC_8822C \ -+ (BIT_MASK_PRI_MASK_TXAC_8822C << BIT_SHIFT_PRI_MASK_TXAC_8822C) -+#define BIT_CLEAR_PRI_MASK_TXAC_8822C(x) ((x) & (~BITS_PRI_MASK_TXAC_8822C)) -+#define BIT_GET_PRI_MASK_TXAC_8822C(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TXAC_8822C) & BIT_MASK_PRI_MASK_TXAC_8822C) -+#define BIT_SET_PRI_MASK_TXAC_8822C(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TXAC_8822C(x) | BIT_PRI_MASK_TXAC_8822C(v)) -+ -+#define BIT_SHIFT_PRI_MASK_NAV_8822C 13 -+#define BIT_MASK_PRI_MASK_NAV_8822C 0xff -+#define BIT_PRI_MASK_NAV_8822C(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NAV_8822C) << BIT_SHIFT_PRI_MASK_NAV_8822C) -+#define BITS_PRI_MASK_NAV_8822C \ -+ (BIT_MASK_PRI_MASK_NAV_8822C << BIT_SHIFT_PRI_MASK_NAV_8822C) -+#define BIT_CLEAR_PRI_MASK_NAV_8822C(x) ((x) & (~BITS_PRI_MASK_NAV_8822C)) -+#define BIT_GET_PRI_MASK_NAV_8822C(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NAV_8822C) & BIT_MASK_PRI_MASK_NAV_8822C) -+#define BIT_SET_PRI_MASK_NAV_8822C(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NAV_8822C(x) | BIT_PRI_MASK_NAV_8822C(v)) -+ -+#define BIT_PRI_MASK_CCK_V1_8822C BIT(12) -+#define BIT_PRI_MASK_OFDM_V1_8822C BIT(11) -+#define BIT_PRI_MASK_RTY_V1_8822C BIT(10) -+ -+#define BIT_SHIFT_PRI_MASK_NUM_8822C 6 -+#define BIT_MASK_PRI_MASK_NUM_8822C 0xf -+#define BIT_PRI_MASK_NUM_8822C(x) \ -+ (((x) & BIT_MASK_PRI_MASK_NUM_8822C) << BIT_SHIFT_PRI_MASK_NUM_8822C) -+#define BITS_PRI_MASK_NUM_8822C \ -+ (BIT_MASK_PRI_MASK_NUM_8822C << BIT_SHIFT_PRI_MASK_NUM_8822C) -+#define BIT_CLEAR_PRI_MASK_NUM_8822C(x) ((x) & (~BITS_PRI_MASK_NUM_8822C)) -+#define BIT_GET_PRI_MASK_NUM_8822C(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_NUM_8822C) & BIT_MASK_PRI_MASK_NUM_8822C) -+#define BIT_SET_PRI_MASK_NUM_8822C(x, v) \ -+ (BIT_CLEAR_PRI_MASK_NUM_8822C(x) | BIT_PRI_MASK_NUM_8822C(v)) -+ -+#define BIT_SHIFT_PRI_MASK_TYPE_8822C 2 -+#define BIT_MASK_PRI_MASK_TYPE_8822C 0xf -+#define BIT_PRI_MASK_TYPE_8822C(x) \ -+ (((x) & BIT_MASK_PRI_MASK_TYPE_8822C) << BIT_SHIFT_PRI_MASK_TYPE_8822C) -+#define BITS_PRI_MASK_TYPE_8822C \ -+ (BIT_MASK_PRI_MASK_TYPE_8822C << BIT_SHIFT_PRI_MASK_TYPE_8822C) -+#define BIT_CLEAR_PRI_MASK_TYPE_8822C(x) ((x) & (~BITS_PRI_MASK_TYPE_8822C)) -+#define BIT_GET_PRI_MASK_TYPE_8822C(x) \ -+ (((x) >> BIT_SHIFT_PRI_MASK_TYPE_8822C) & BIT_MASK_PRI_MASK_TYPE_8822C) -+#define BIT_SET_PRI_MASK_TYPE_8822C(x, v) \ -+ (BIT_CLEAR_PRI_MASK_TYPE_8822C(x) | BIT_PRI_MASK_TYPE_8822C(v)) -+ -+#define BIT_OOB_V1_8822C BIT(1) -+#define BIT_ANT_SEL_V1_8822C BIT(0) -+ -+/* 2 REG_RXCMD_0_8822C */ -+#define BIT_RXCMD_EN_8822C BIT(31) -+ -+#define BIT_SHIFT_RXCMD_INFO_8822C 0 -+#define BIT_MASK_RXCMD_INFO_8822C 0x7fffffffL -+#define BIT_RXCMD_INFO_8822C(x) \ -+ (((x) & BIT_MASK_RXCMD_INFO_8822C) << BIT_SHIFT_RXCMD_INFO_8822C) -+#define BITS_RXCMD_INFO_8822C \ -+ (BIT_MASK_RXCMD_INFO_8822C << BIT_SHIFT_RXCMD_INFO_8822C) -+#define BIT_CLEAR_RXCMD_INFO_8822C(x) ((x) & (~BITS_RXCMD_INFO_8822C)) -+#define BIT_GET_RXCMD_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_INFO_8822C) & BIT_MASK_RXCMD_INFO_8822C) -+#define BIT_SET_RXCMD_INFO_8822C(x, v) \ -+ (BIT_CLEAR_RXCMD_INFO_8822C(x) | BIT_RXCMD_INFO_8822C(v)) -+ -+/* 2 REG_RXCMD_1_8822C */ -+ -+#define BIT_SHIFT_RXCMD_PRD_8822C 0 -+#define BIT_MASK_RXCMD_PRD_8822C 0xffff -+#define BIT_RXCMD_PRD_8822C(x) \ -+ (((x) & BIT_MASK_RXCMD_PRD_8822C) << BIT_SHIFT_RXCMD_PRD_8822C) -+#define BITS_RXCMD_PRD_8822C \ -+ (BIT_MASK_RXCMD_PRD_8822C << BIT_SHIFT_RXCMD_PRD_8822C) -+#define BIT_CLEAR_RXCMD_PRD_8822C(x) ((x) & (~BITS_RXCMD_PRD_8822C)) -+#define BIT_GET_RXCMD_PRD_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXCMD_PRD_8822C) & BIT_MASK_RXCMD_PRD_8822C) -+#define BIT_SET_RXCMD_PRD_8822C(x, v) \ -+ (BIT_CLEAR_RXCMD_PRD_8822C(x) | BIT_RXCMD_PRD_8822C(v)) -+ -+/* 2 REG_WMAC_RESP_TXINFO_8822C (RESPONSE TXINFO REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_MFB_8822C 25 -+#define BIT_MASK_WMAC_RESP_MFB_8822C 0x7f -+#define BIT_WMAC_RESP_MFB_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_MFB_8822C) << BIT_SHIFT_WMAC_RESP_MFB_8822C) -+#define BITS_WMAC_RESP_MFB_8822C \ -+ (BIT_MASK_WMAC_RESP_MFB_8822C << BIT_SHIFT_WMAC_RESP_MFB_8822C) -+#define BIT_CLEAR_WMAC_RESP_MFB_8822C(x) ((x) & (~BITS_WMAC_RESP_MFB_8822C)) -+#define BIT_GET_WMAC_RESP_MFB_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_MFB_8822C) & BIT_MASK_WMAC_RESP_MFB_8822C) -+#define BIT_SET_WMAC_RESP_MFB_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_MFB_8822C(x) | BIT_WMAC_RESP_MFB_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_ANTINF_SEL_8822C 23 -+#define BIT_MASK_WMAC_ANTINF_SEL_8822C 0x3 -+#define BIT_WMAC_ANTINF_SEL_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_ANTINF_SEL_8822C) \ -+ << BIT_SHIFT_WMAC_ANTINF_SEL_8822C) -+#define BITS_WMAC_ANTINF_SEL_8822C \ -+ (BIT_MASK_WMAC_ANTINF_SEL_8822C << BIT_SHIFT_WMAC_ANTINF_SEL_8822C) -+#define BIT_CLEAR_WMAC_ANTINF_SEL_8822C(x) ((x) & (~BITS_WMAC_ANTINF_SEL_8822C)) -+#define BIT_GET_WMAC_ANTINF_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTINF_SEL_8822C) & \ -+ BIT_MASK_WMAC_ANTINF_SEL_8822C) -+#define BIT_SET_WMAC_ANTINF_SEL_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_ANTINF_SEL_8822C(x) | BIT_WMAC_ANTINF_SEL_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_ANTSEL_SEL_8822C 21 -+#define BIT_MASK_WMAC_ANTSEL_SEL_8822C 0x3 -+#define BIT_WMAC_ANTSEL_SEL_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_ANTSEL_SEL_8822C) \ -+ << BIT_SHIFT_WMAC_ANTSEL_SEL_8822C) -+#define BITS_WMAC_ANTSEL_SEL_8822C \ -+ (BIT_MASK_WMAC_ANTSEL_SEL_8822C << BIT_SHIFT_WMAC_ANTSEL_SEL_8822C) -+#define BIT_CLEAR_WMAC_ANTSEL_SEL_8822C(x) ((x) & (~BITS_WMAC_ANTSEL_SEL_8822C)) -+#define BIT_GET_WMAC_ANTSEL_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ANTSEL_SEL_8822C) & \ -+ BIT_MASK_WMAC_ANTSEL_SEL_8822C) -+#define BIT_SET_WMAC_ANTSEL_SEL_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_ANTSEL_SEL_8822C(x) | BIT_WMAC_ANTSEL_SEL_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C 18 -+#define BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C 0x3 -+#define BIT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C) \ -+ << BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C) -+#define BITS_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C \ -+ (BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C \ -+ << BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C) -+#define BIT_CLEAR_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C)) -+#define BIT_GET_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C) & \ -+ BIT_MASK_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C) -+#define BIT_SET_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C(x) | \ -+ BIT_WMAC_RESP_TXPOWER_OFFSET_TYPE_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXANT_V1_8822C 6 -+#define BIT_MASK_WMAC_RESP_TXANT_V1_8822C 0xfff -+#define BIT_WMAC_RESP_TXANT_V1_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXANT_V1_8822C) \ -+ << BIT_SHIFT_WMAC_RESP_TXANT_V1_8822C) -+#define BITS_WMAC_RESP_TXANT_V1_8822C \ -+ (BIT_MASK_WMAC_RESP_TXANT_V1_8822C \ -+ << BIT_SHIFT_WMAC_RESP_TXANT_V1_8822C) -+#define BIT_CLEAR_WMAC_RESP_TXANT_V1_8822C(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXANT_V1_8822C)) -+#define BIT_GET_WMAC_RESP_TXANT_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXANT_V1_8822C) & \ -+ BIT_MASK_WMAC_RESP_TXANT_V1_8822C) -+#define BIT_SET_WMAC_RESP_TXANT_V1_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXANT_V1_8822C(x) | \ -+ BIT_WMAC_RESP_TXANT_V1_8822C(v)) -+ -+/* 2 REG_BBPSF_CTRL_8822C */ -+#define BIT_CTL_IDLE_CLR_CSI_RPT_8822C BIT(31) -+#define BIT_WMAC_USE_NDPARATE_8822C BIT(30) -+ -+#define BIT_SHIFT_WMAC_CSI_RATE_8822C 24 -+#define BIT_MASK_WMAC_CSI_RATE_8822C 0x3f -+#define BIT_WMAC_CSI_RATE_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_CSI_RATE_8822C) << BIT_SHIFT_WMAC_CSI_RATE_8822C) -+#define BITS_WMAC_CSI_RATE_8822C \ -+ (BIT_MASK_WMAC_CSI_RATE_8822C << BIT_SHIFT_WMAC_CSI_RATE_8822C) -+#define BIT_CLEAR_WMAC_CSI_RATE_8822C(x) ((x) & (~BITS_WMAC_CSI_RATE_8822C)) -+#define BIT_GET_WMAC_CSI_RATE_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_CSI_RATE_8822C) & BIT_MASK_WMAC_CSI_RATE_8822C) -+#define BIT_SET_WMAC_CSI_RATE_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_CSI_RATE_8822C(x) | BIT_WMAC_CSI_RATE_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_TXRATE_8822C 16 -+#define BIT_MASK_WMAC_RESP_TXRATE_8822C 0xff -+#define BIT_WMAC_RESP_TXRATE_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_TXRATE_8822C) \ -+ << BIT_SHIFT_WMAC_RESP_TXRATE_8822C) -+#define BITS_WMAC_RESP_TXRATE_8822C \ -+ (BIT_MASK_WMAC_RESP_TXRATE_8822C << BIT_SHIFT_WMAC_RESP_TXRATE_8822C) -+#define BIT_CLEAR_WMAC_RESP_TXRATE_8822C(x) \ -+ ((x) & (~BITS_WMAC_RESP_TXRATE_8822C)) -+#define BIT_GET_WMAC_RESP_TXRATE_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_TXRATE_8822C) & \ -+ BIT_MASK_WMAC_RESP_TXRATE_8822C) -+#define BIT_SET_WMAC_RESP_TXRATE_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_TXRATE_8822C(x) | BIT_WMAC_RESP_TXRATE_8822C(v)) -+ -+#define BIT_SHIFT_CSI_RSC_8822C 13 -+#define BIT_MASK_CSI_RSC_8822C 0x3 -+#define BIT_CSI_RSC_8822C(x) \ -+ (((x) & BIT_MASK_CSI_RSC_8822C) << BIT_SHIFT_CSI_RSC_8822C) -+#define BITS_CSI_RSC_8822C (BIT_MASK_CSI_RSC_8822C << BIT_SHIFT_CSI_RSC_8822C) -+#define BIT_CLEAR_CSI_RSC_8822C(x) ((x) & (~BITS_CSI_RSC_8822C)) -+#define BIT_GET_CSI_RSC_8822C(x) \ -+ (((x) >> BIT_SHIFT_CSI_RSC_8822C) & BIT_MASK_CSI_RSC_8822C) -+#define BIT_SET_CSI_RSC_8822C(x, v) \ -+ (BIT_CLEAR_CSI_RSC_8822C(x) | BIT_CSI_RSC_8822C(v)) -+ -+#define BIT_CSI_GID_SEL_8822C BIT(12) -+#define BIT_NDPVLD_PROTECT_RDRDY_DIS_8822C BIT(9) -+#define BIT_RDCSI_EMPTY_APPZERO_8822C BIT(8) -+#define BIT_CSI_RATE_FB_EN_8822C BIT(7) -+#define BIT_RXFIFO_WRPTR_WO_CHKSUM_8822C BIT(6) -+ -+/* 2 REG_P2P_RX_BCN_NOA_8822C (P2P RX BEACON NOA REGISTER) */ -+#define BIT_NOA_PARSER_EN_8822C BIT(15) -+ -+#define BIT_SHIFT_BSSID_SEL_V1_8822C 12 -+#define BIT_MASK_BSSID_SEL_V1_8822C 0x7 -+#define BIT_BSSID_SEL_V1_8822C(x) \ -+ (((x) & BIT_MASK_BSSID_SEL_V1_8822C) << BIT_SHIFT_BSSID_SEL_V1_8822C) -+#define BITS_BSSID_SEL_V1_8822C \ -+ (BIT_MASK_BSSID_SEL_V1_8822C << BIT_SHIFT_BSSID_SEL_V1_8822C) -+#define BIT_CLEAR_BSSID_SEL_V1_8822C(x) ((x) & (~BITS_BSSID_SEL_V1_8822C)) -+#define BIT_GET_BSSID_SEL_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID_SEL_V1_8822C) & BIT_MASK_BSSID_SEL_V1_8822C) -+#define BIT_SET_BSSID_SEL_V1_8822C(x, v) \ -+ (BIT_CLEAR_BSSID_SEL_V1_8822C(x) | BIT_BSSID_SEL_V1_8822C(v)) -+ -+#define BIT_SHIFT_P2P_OUI_TYPE_8822C 0 -+#define BIT_MASK_P2P_OUI_TYPE_8822C 0xff -+#define BIT_P2P_OUI_TYPE_8822C(x) \ -+ (((x) & BIT_MASK_P2P_OUI_TYPE_8822C) << BIT_SHIFT_P2P_OUI_TYPE_8822C) -+#define BITS_P2P_OUI_TYPE_8822C \ -+ (BIT_MASK_P2P_OUI_TYPE_8822C << BIT_SHIFT_P2P_OUI_TYPE_8822C) -+#define BIT_CLEAR_P2P_OUI_TYPE_8822C(x) ((x) & (~BITS_P2P_OUI_TYPE_8822C)) -+#define BIT_GET_P2P_OUI_TYPE_8822C(x) \ -+ (((x) >> BIT_SHIFT_P2P_OUI_TYPE_8822C) & BIT_MASK_P2P_OUI_TYPE_8822C) -+#define BIT_SET_P2P_OUI_TYPE_8822C(x, v) \ -+ (BIT_CLEAR_P2P_OUI_TYPE_8822C(x) | BIT_P2P_OUI_TYPE_8822C(v)) -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_8822C (ASSOCIATED BEAMFORMER0 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8822C 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8822C 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_V1_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8822C) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8822C) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_V1_8822C \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8822C \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8822C) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_V1_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_V1_8822C)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_V1_8822C) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_V1_8822C) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_V1_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_V1_8822C(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_V1_8822C(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER0_INFO_H_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID0_8822C 16 -+#define BIT_MASK_R_WMAC_TXCSI_AID0_8822C 0x1ff -+#define BIT_R_WMAC_TXCSI_AID0_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID0_8822C) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID0_8822C) -+#define BITS_R_WMAC_TXCSI_AID0_8822C \ -+ (BIT_MASK_R_WMAC_TXCSI_AID0_8822C << BIT_SHIFT_R_WMAC_TXCSI_AID0_8822C) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID0_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID0_8822C)) -+#define BIT_GET_R_WMAC_TXCSI_AID0_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID0_8822C) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID0_8822C) -+#define BIT_SET_R_WMAC_TXCSI_AID0_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID0_8822C(x) | BIT_R_WMAC_TXCSI_AID0_8822C(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C) -+#define BITS_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R0_H_V1_8822C(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_8822C (ASSOCIATED BEAMFORMER1 INFO REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8822C 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8822C 0xffffffffL -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_V1_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8822C) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8822C) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_V1_8822C \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8822C \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8822C) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V1_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_V1_8822C)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_V1_8822C) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_V1_8822C) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_V1_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_V1_8822C(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_V1_8822C(v)) -+ -+/* 2 REG_ASSOCIATED_BFMER1_INFO_H_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_TXCSI_AID1_8822C 16 -+#define BIT_MASK_R_WMAC_TXCSI_AID1_8822C 0x1ff -+#define BIT_R_WMAC_TXCSI_AID1_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXCSI_AID1_8822C) \ -+ << BIT_SHIFT_R_WMAC_TXCSI_AID1_8822C) -+#define BITS_R_WMAC_TXCSI_AID1_8822C \ -+ (BIT_MASK_R_WMAC_TXCSI_AID1_8822C << BIT_SHIFT_R_WMAC_TXCSI_AID1_8822C) -+#define BIT_CLEAR_R_WMAC_TXCSI_AID1_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_TXCSI_AID1_8822C)) -+#define BIT_GET_R_WMAC_TXCSI_AID1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXCSI_AID1_8822C) & \ -+ BIT_MASK_R_WMAC_TXCSI_AID1_8822C) -+#define BIT_SET_R_WMAC_TXCSI_AID1_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXCSI_AID1_8822C(x) | BIT_R_WMAC_TXCSI_AID1_8822C(v)) -+ -+#define BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C 0 -+#define BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C 0xffff -+#define BIT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C) \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C) -+#define BITS_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C \ -+ (BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C \ -+ << BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C) -+#define BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C)) -+#define BIT_GET_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C) & \ -+ BIT_MASK_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C) -+#define BIT_SET_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C(x) | \ -+ BIT_R_WMAC_SOUNDING_RXADD_R1_H_V1_8822C(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW20_8822C (TX CSI REPORT PARAMETER REGISTER) */ -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_1_8822C 16 -+#define BIT_MASK_R_WMAC_BFINFO_20M_1_8822C 0xfff -+#define BIT_R_WMAC_BFINFO_20M_1_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_1_8822C) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8822C) -+#define BITS_R_WMAC_BFINFO_20M_1_8822C \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_1_8822C \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_1_8822C) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_1_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_1_8822C)) -+#define BIT_GET_R_WMAC_BFINFO_20M_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_1_8822C) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_1_8822C) -+#define BIT_SET_R_WMAC_BFINFO_20M_1_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_1_8822C(x) | \ -+ BIT_R_WMAC_BFINFO_20M_1_8822C(v)) -+ -+#define BIT_SHIFT_R_WMAC_BFINFO_20M_0_8822C 0 -+#define BIT_MASK_R_WMAC_BFINFO_20M_0_8822C 0xfff -+#define BIT_R_WMAC_BFINFO_20M_0_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_BFINFO_20M_0_8822C) \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8822C) -+#define BITS_R_WMAC_BFINFO_20M_0_8822C \ -+ (BIT_MASK_R_WMAC_BFINFO_20M_0_8822C \ -+ << BIT_SHIFT_R_WMAC_BFINFO_20M_0_8822C) -+#define BIT_CLEAR_R_WMAC_BFINFO_20M_0_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_BFINFO_20M_0_8822C)) -+#define BIT_GET_R_WMAC_BFINFO_20M_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_BFINFO_20M_0_8822C) & \ -+ BIT_MASK_R_WMAC_BFINFO_20M_0_8822C) -+#define BIT_SET_R_WMAC_BFINFO_20M_0_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_BFINFO_20M_0_8822C(x) | \ -+ BIT_R_WMAC_BFINFO_20M_0_8822C(v)) -+ -+/* 2 REG_TX_CSI_RPT_PARAM_BW40_8822C (TX CSI REPORT PARAMETER_BW40 REGISTER) */ -+ -+#define BIT_SHIFT_WMAC_RESP_ANTD_8822C 12 -+#define BIT_MASK_WMAC_RESP_ANTD_8822C 0xf -+#define BIT_WMAC_RESP_ANTD_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTD_8822C) \ -+ << BIT_SHIFT_WMAC_RESP_ANTD_8822C) -+#define BITS_WMAC_RESP_ANTD_8822C \ -+ (BIT_MASK_WMAC_RESP_ANTD_8822C << BIT_SHIFT_WMAC_RESP_ANTD_8822C) -+#define BIT_CLEAR_WMAC_RESP_ANTD_8822C(x) ((x) & (~BITS_WMAC_RESP_ANTD_8822C)) -+#define BIT_GET_WMAC_RESP_ANTD_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTD_8822C) & \ -+ BIT_MASK_WMAC_RESP_ANTD_8822C) -+#define BIT_SET_WMAC_RESP_ANTD_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTD_8822C(x) | BIT_WMAC_RESP_ANTD_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTC_8822C 8 -+#define BIT_MASK_WMAC_RESP_ANTC_8822C 0xf -+#define BIT_WMAC_RESP_ANTC_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTC_8822C) \ -+ << BIT_SHIFT_WMAC_RESP_ANTC_8822C) -+#define BITS_WMAC_RESP_ANTC_8822C \ -+ (BIT_MASK_WMAC_RESP_ANTC_8822C << BIT_SHIFT_WMAC_RESP_ANTC_8822C) -+#define BIT_CLEAR_WMAC_RESP_ANTC_8822C(x) ((x) & (~BITS_WMAC_RESP_ANTC_8822C)) -+#define BIT_GET_WMAC_RESP_ANTC_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTC_8822C) & \ -+ BIT_MASK_WMAC_RESP_ANTC_8822C) -+#define BIT_SET_WMAC_RESP_ANTC_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTC_8822C(x) | BIT_WMAC_RESP_ANTC_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTB_8822C 4 -+#define BIT_MASK_WMAC_RESP_ANTB_8822C 0xf -+#define BIT_WMAC_RESP_ANTB_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTB_8822C) \ -+ << BIT_SHIFT_WMAC_RESP_ANTB_8822C) -+#define BITS_WMAC_RESP_ANTB_8822C \ -+ (BIT_MASK_WMAC_RESP_ANTB_8822C << BIT_SHIFT_WMAC_RESP_ANTB_8822C) -+#define BIT_CLEAR_WMAC_RESP_ANTB_8822C(x) ((x) & (~BITS_WMAC_RESP_ANTB_8822C)) -+#define BIT_GET_WMAC_RESP_ANTB_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTB_8822C) & \ -+ BIT_MASK_WMAC_RESP_ANTB_8822C) -+#define BIT_SET_WMAC_RESP_ANTB_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTB_8822C(x) | BIT_WMAC_RESP_ANTB_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_RESP_ANTA_8822C 0 -+#define BIT_MASK_WMAC_RESP_ANTA_8822C 0xf -+#define BIT_WMAC_RESP_ANTA_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_RESP_ANTA_8822C) \ -+ << BIT_SHIFT_WMAC_RESP_ANTA_8822C) -+#define BITS_WMAC_RESP_ANTA_8822C \ -+ (BIT_MASK_WMAC_RESP_ANTA_8822C << BIT_SHIFT_WMAC_RESP_ANTA_8822C) -+#define BIT_CLEAR_WMAC_RESP_ANTA_8822C(x) ((x) & (~BITS_WMAC_RESP_ANTA_8822C)) -+#define BIT_GET_WMAC_RESP_ANTA_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RESP_ANTA_8822C) & \ -+ BIT_MASK_WMAC_RESP_ANTA_8822C) -+#define BIT_SET_WMAC_RESP_ANTA_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_RESP_ANTA_8822C(x) | BIT_WMAC_RESP_ANTA_8822C(v)) -+ -+/* 2 REG_CSI_PTR_8822C */ -+ -+#define BIT_SHIFT_CSI_RADDR_LATCH_V2_8822C 16 -+#define BIT_MASK_CSI_RADDR_LATCH_V2_8822C 0xffff -+#define BIT_CSI_RADDR_LATCH_V2_8822C(x) \ -+ (((x) & BIT_MASK_CSI_RADDR_LATCH_V2_8822C) \ -+ << BIT_SHIFT_CSI_RADDR_LATCH_V2_8822C) -+#define BITS_CSI_RADDR_LATCH_V2_8822C \ -+ (BIT_MASK_CSI_RADDR_LATCH_V2_8822C \ -+ << BIT_SHIFT_CSI_RADDR_LATCH_V2_8822C) -+#define BIT_CLEAR_CSI_RADDR_LATCH_V2_8822C(x) \ -+ ((x) & (~BITS_CSI_RADDR_LATCH_V2_8822C)) -+#define BIT_GET_CSI_RADDR_LATCH_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_CSI_RADDR_LATCH_V2_8822C) & \ -+ BIT_MASK_CSI_RADDR_LATCH_V2_8822C) -+#define BIT_SET_CSI_RADDR_LATCH_V2_8822C(x, v) \ -+ (BIT_CLEAR_CSI_RADDR_LATCH_V2_8822C(x) | \ -+ BIT_CSI_RADDR_LATCH_V2_8822C(v)) -+ -+#define BIT_SHIFT_CSI_WADDR_LATCH_V2_8822C 0 -+#define BIT_MASK_CSI_WADDR_LATCH_V2_8822C 0xffff -+#define BIT_CSI_WADDR_LATCH_V2_8822C(x) \ -+ (((x) & BIT_MASK_CSI_WADDR_LATCH_V2_8822C) \ -+ << BIT_SHIFT_CSI_WADDR_LATCH_V2_8822C) -+#define BITS_CSI_WADDR_LATCH_V2_8822C \ -+ (BIT_MASK_CSI_WADDR_LATCH_V2_8822C \ -+ << BIT_SHIFT_CSI_WADDR_LATCH_V2_8822C) -+#define BIT_CLEAR_CSI_WADDR_LATCH_V2_8822C(x) \ -+ ((x) & (~BITS_CSI_WADDR_LATCH_V2_8822C)) -+#define BIT_GET_CSI_WADDR_LATCH_V2_8822C(x) \ -+ (((x) >> BIT_SHIFT_CSI_WADDR_LATCH_V2_8822C) & \ -+ BIT_MASK_CSI_WADDR_LATCH_V2_8822C) -+#define BIT_SET_CSI_WADDR_LATCH_V2_8822C(x, v) \ -+ (BIT_CLEAR_CSI_WADDR_LATCH_V2_8822C(x) | \ -+ BIT_CSI_WADDR_LATCH_V2_8822C(v)) -+ -+/* 2 REG_BCN_PSR_RPT2_8822C (BEACON PARSER REPORT REGISTER2) */ -+ -+#define BIT_SHIFT_DTIM_CNT2_8822C 24 -+#define BIT_MASK_DTIM_CNT2_8822C 0xff -+#define BIT_DTIM_CNT2_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_CNT2_8822C) << BIT_SHIFT_DTIM_CNT2_8822C) -+#define BITS_DTIM_CNT2_8822C \ -+ (BIT_MASK_DTIM_CNT2_8822C << BIT_SHIFT_DTIM_CNT2_8822C) -+#define BIT_CLEAR_DTIM_CNT2_8822C(x) ((x) & (~BITS_DTIM_CNT2_8822C)) -+#define BIT_GET_DTIM_CNT2_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT2_8822C) & BIT_MASK_DTIM_CNT2_8822C) -+#define BIT_SET_DTIM_CNT2_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_CNT2_8822C(x) | BIT_DTIM_CNT2_8822C(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD2_8822C 16 -+#define BIT_MASK_DTIM_PERIOD2_8822C 0xff -+#define BIT_DTIM_PERIOD2_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD2_8822C) << BIT_SHIFT_DTIM_PERIOD2_8822C) -+#define BITS_DTIM_PERIOD2_8822C \ -+ (BIT_MASK_DTIM_PERIOD2_8822C << BIT_SHIFT_DTIM_PERIOD2_8822C) -+#define BIT_CLEAR_DTIM_PERIOD2_8822C(x) ((x) & (~BITS_DTIM_PERIOD2_8822C)) -+#define BIT_GET_DTIM_PERIOD2_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD2_8822C) & BIT_MASK_DTIM_PERIOD2_8822C) -+#define BIT_SET_DTIM_PERIOD2_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD2_8822C(x) | BIT_DTIM_PERIOD2_8822C(v)) -+ -+#define BIT_DTIM2_8822C BIT(15) -+#define BIT_TIM2_8822C BIT(14) -+#define BIT_RPT_VALID_8822C BIT(13) -+ -+#define BIT_SHIFT_PS_AID_2_8822C 0 -+#define BIT_MASK_PS_AID_2_8822C 0x7ff -+#define BIT_PS_AID_2_8822C(x) \ -+ (((x) & BIT_MASK_PS_AID_2_8822C) << BIT_SHIFT_PS_AID_2_8822C) -+#define BITS_PS_AID_2_8822C \ -+ (BIT_MASK_PS_AID_2_8822C << BIT_SHIFT_PS_AID_2_8822C) -+#define BIT_CLEAR_PS_AID_2_8822C(x) ((x) & (~BITS_PS_AID_2_8822C)) -+#define BIT_GET_PS_AID_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_2_8822C) & BIT_MASK_PS_AID_2_8822C) -+#define BIT_SET_PS_AID_2_8822C(x, v) \ -+ (BIT_CLEAR_PS_AID_2_8822C(x) | BIT_PS_AID_2_8822C(v)) -+ -+/* 2 REG_BCN_PSR_RPT3_8822C (BEACON PARSER REPORT REGISTER3) */ -+ -+#define BIT_SHIFT_DTIM_CNT3_8822C 24 -+#define BIT_MASK_DTIM_CNT3_8822C 0xff -+#define BIT_DTIM_CNT3_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_CNT3_8822C) << BIT_SHIFT_DTIM_CNT3_8822C) -+#define BITS_DTIM_CNT3_8822C \ -+ (BIT_MASK_DTIM_CNT3_8822C << BIT_SHIFT_DTIM_CNT3_8822C) -+#define BIT_CLEAR_DTIM_CNT3_8822C(x) ((x) & (~BITS_DTIM_CNT3_8822C)) -+#define BIT_GET_DTIM_CNT3_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT3_8822C) & BIT_MASK_DTIM_CNT3_8822C) -+#define BIT_SET_DTIM_CNT3_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_CNT3_8822C(x) | BIT_DTIM_CNT3_8822C(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD3_8822C 16 -+#define BIT_MASK_DTIM_PERIOD3_8822C 0xff -+#define BIT_DTIM_PERIOD3_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD3_8822C) << BIT_SHIFT_DTIM_PERIOD3_8822C) -+#define BITS_DTIM_PERIOD3_8822C \ -+ (BIT_MASK_DTIM_PERIOD3_8822C << BIT_SHIFT_DTIM_PERIOD3_8822C) -+#define BIT_CLEAR_DTIM_PERIOD3_8822C(x) ((x) & (~BITS_DTIM_PERIOD3_8822C)) -+#define BIT_GET_DTIM_PERIOD3_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD3_8822C) & BIT_MASK_DTIM_PERIOD3_8822C) -+#define BIT_SET_DTIM_PERIOD3_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD3_8822C(x) | BIT_DTIM_PERIOD3_8822C(v)) -+ -+#define BIT_DTIM3_8822C BIT(15) -+#define BIT_TIM3_8822C BIT(14) -+#define BIT_RPT_VALID_8822C BIT(13) -+ -+#define BIT_SHIFT_PS_AID_3_8822C 0 -+#define BIT_MASK_PS_AID_3_8822C 0x7ff -+#define BIT_PS_AID_3_8822C(x) \ -+ (((x) & BIT_MASK_PS_AID_3_8822C) << BIT_SHIFT_PS_AID_3_8822C) -+#define BITS_PS_AID_3_8822C \ -+ (BIT_MASK_PS_AID_3_8822C << BIT_SHIFT_PS_AID_3_8822C) -+#define BIT_CLEAR_PS_AID_3_8822C(x) ((x) & (~BITS_PS_AID_3_8822C)) -+#define BIT_GET_PS_AID_3_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_3_8822C) & BIT_MASK_PS_AID_3_8822C) -+#define BIT_SET_PS_AID_3_8822C(x, v) \ -+ (BIT_CLEAR_PS_AID_3_8822C(x) | BIT_PS_AID_3_8822C(v)) -+ -+/* 2 REG_BCN_PSR_RPT4_8822C (BEACON PARSER REPORT REGISTER4) */ -+ -+#define BIT_SHIFT_DTIM_CNT4_8822C 24 -+#define BIT_MASK_DTIM_CNT4_8822C 0xff -+#define BIT_DTIM_CNT4_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_CNT4_8822C) << BIT_SHIFT_DTIM_CNT4_8822C) -+#define BITS_DTIM_CNT4_8822C \ -+ (BIT_MASK_DTIM_CNT4_8822C << BIT_SHIFT_DTIM_CNT4_8822C) -+#define BIT_CLEAR_DTIM_CNT4_8822C(x) ((x) & (~BITS_DTIM_CNT4_8822C)) -+#define BIT_GET_DTIM_CNT4_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT4_8822C) & BIT_MASK_DTIM_CNT4_8822C) -+#define BIT_SET_DTIM_CNT4_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_CNT4_8822C(x) | BIT_DTIM_CNT4_8822C(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD4_8822C 16 -+#define BIT_MASK_DTIM_PERIOD4_8822C 0xff -+#define BIT_DTIM_PERIOD4_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD4_8822C) << BIT_SHIFT_DTIM_PERIOD4_8822C) -+#define BITS_DTIM_PERIOD4_8822C \ -+ (BIT_MASK_DTIM_PERIOD4_8822C << BIT_SHIFT_DTIM_PERIOD4_8822C) -+#define BIT_CLEAR_DTIM_PERIOD4_8822C(x) ((x) & (~BITS_DTIM_PERIOD4_8822C)) -+#define BIT_GET_DTIM_PERIOD4_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD4_8822C) & BIT_MASK_DTIM_PERIOD4_8822C) -+#define BIT_SET_DTIM_PERIOD4_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD4_8822C(x) | BIT_DTIM_PERIOD4_8822C(v)) -+ -+#define BIT_DTIM4_8822C BIT(15) -+#define BIT_TIM4_8822C BIT(14) -+#define BIT_RPT_VALID_8822C BIT(13) -+ -+#define BIT_SHIFT_PS_AID_4_8822C 0 -+#define BIT_MASK_PS_AID_4_8822C 0x7ff -+#define BIT_PS_AID_4_8822C(x) \ -+ (((x) & BIT_MASK_PS_AID_4_8822C) << BIT_SHIFT_PS_AID_4_8822C) -+#define BITS_PS_AID_4_8822C \ -+ (BIT_MASK_PS_AID_4_8822C << BIT_SHIFT_PS_AID_4_8822C) -+#define BIT_CLEAR_PS_AID_4_8822C(x) ((x) & (~BITS_PS_AID_4_8822C)) -+#define BIT_GET_PS_AID_4_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_4_8822C) & BIT_MASK_PS_AID_4_8822C) -+#define BIT_SET_PS_AID_4_8822C(x, v) \ -+ (BIT_CLEAR_PS_AID_4_8822C(x) | BIT_PS_AID_4_8822C(v)) -+ -+/* 2 REG_A1_ADDR_MASK_8822C (A1 ADDR MASK REGISTER) */ -+ -+#define BIT_SHIFT_A1_ADDR_MASK_8822C 0 -+#define BIT_MASK_A1_ADDR_MASK_8822C 0xffffffffL -+#define BIT_A1_ADDR_MASK_8822C(x) \ -+ (((x) & BIT_MASK_A1_ADDR_MASK_8822C) << BIT_SHIFT_A1_ADDR_MASK_8822C) -+#define BITS_A1_ADDR_MASK_8822C \ -+ (BIT_MASK_A1_ADDR_MASK_8822C << BIT_SHIFT_A1_ADDR_MASK_8822C) -+#define BIT_CLEAR_A1_ADDR_MASK_8822C(x) ((x) & (~BITS_A1_ADDR_MASK_8822C)) -+#define BIT_GET_A1_ADDR_MASK_8822C(x) \ -+ (((x) >> BIT_SHIFT_A1_ADDR_MASK_8822C) & BIT_MASK_A1_ADDR_MASK_8822C) -+#define BIT_SET_A1_ADDR_MASK_8822C(x, v) \ -+ (BIT_CLEAR_A1_ADDR_MASK_8822C(x) | BIT_A1_ADDR_MASK_8822C(v)) -+ -+/* 2 REG_RXPSF_CTRL_8822C */ -+#define BIT_RXGCK_FIFOTHR_EN_8822C BIT(28) -+ -+#define BIT_SHIFT_RXGCK_VHT_FIFOTHR_8822C 26 -+#define BIT_MASK_RXGCK_VHT_FIFOTHR_8822C 0x3 -+#define BIT_RXGCK_VHT_FIFOTHR_8822C(x) \ -+ (((x) & BIT_MASK_RXGCK_VHT_FIFOTHR_8822C) \ -+ << BIT_SHIFT_RXGCK_VHT_FIFOTHR_8822C) -+#define BITS_RXGCK_VHT_FIFOTHR_8822C \ -+ (BIT_MASK_RXGCK_VHT_FIFOTHR_8822C << BIT_SHIFT_RXGCK_VHT_FIFOTHR_8822C) -+#define BIT_CLEAR_RXGCK_VHT_FIFOTHR_8822C(x) \ -+ ((x) & (~BITS_RXGCK_VHT_FIFOTHR_8822C)) -+#define BIT_GET_RXGCK_VHT_FIFOTHR_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_VHT_FIFOTHR_8822C) & \ -+ BIT_MASK_RXGCK_VHT_FIFOTHR_8822C) -+#define BIT_SET_RXGCK_VHT_FIFOTHR_8822C(x, v) \ -+ (BIT_CLEAR_RXGCK_VHT_FIFOTHR_8822C(x) | BIT_RXGCK_VHT_FIFOTHR_8822C(v)) -+ -+#define BIT_SHIFT_RXGCK_HT_FIFOTHR_8822C 24 -+#define BIT_MASK_RXGCK_HT_FIFOTHR_8822C 0x3 -+#define BIT_RXGCK_HT_FIFOTHR_8822C(x) \ -+ (((x) & BIT_MASK_RXGCK_HT_FIFOTHR_8822C) \ -+ << BIT_SHIFT_RXGCK_HT_FIFOTHR_8822C) -+#define BITS_RXGCK_HT_FIFOTHR_8822C \ -+ (BIT_MASK_RXGCK_HT_FIFOTHR_8822C << BIT_SHIFT_RXGCK_HT_FIFOTHR_8822C) -+#define BIT_CLEAR_RXGCK_HT_FIFOTHR_8822C(x) \ -+ ((x) & (~BITS_RXGCK_HT_FIFOTHR_8822C)) -+#define BIT_GET_RXGCK_HT_FIFOTHR_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_HT_FIFOTHR_8822C) & \ -+ BIT_MASK_RXGCK_HT_FIFOTHR_8822C) -+#define BIT_SET_RXGCK_HT_FIFOTHR_8822C(x, v) \ -+ (BIT_CLEAR_RXGCK_HT_FIFOTHR_8822C(x) | BIT_RXGCK_HT_FIFOTHR_8822C(v)) -+ -+#define BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8822C 22 -+#define BIT_MASK_RXGCK_OFDM_FIFOTHR_8822C 0x3 -+#define BIT_RXGCK_OFDM_FIFOTHR_8822C(x) \ -+ (((x) & BIT_MASK_RXGCK_OFDM_FIFOTHR_8822C) \ -+ << BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8822C) -+#define BITS_RXGCK_OFDM_FIFOTHR_8822C \ -+ (BIT_MASK_RXGCK_OFDM_FIFOTHR_8822C \ -+ << BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8822C) -+#define BIT_CLEAR_RXGCK_OFDM_FIFOTHR_8822C(x) \ -+ ((x) & (~BITS_RXGCK_OFDM_FIFOTHR_8822C)) -+#define BIT_GET_RXGCK_OFDM_FIFOTHR_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_OFDM_FIFOTHR_8822C) & \ -+ BIT_MASK_RXGCK_OFDM_FIFOTHR_8822C) -+#define BIT_SET_RXGCK_OFDM_FIFOTHR_8822C(x, v) \ -+ (BIT_CLEAR_RXGCK_OFDM_FIFOTHR_8822C(x) | \ -+ BIT_RXGCK_OFDM_FIFOTHR_8822C(v)) -+ -+#define BIT_SHIFT_RXGCK_CCK_FIFOTHR_8822C 20 -+#define BIT_MASK_RXGCK_CCK_FIFOTHR_8822C 0x3 -+#define BIT_RXGCK_CCK_FIFOTHR_8822C(x) \ -+ (((x) & BIT_MASK_RXGCK_CCK_FIFOTHR_8822C) \ -+ << BIT_SHIFT_RXGCK_CCK_FIFOTHR_8822C) -+#define BITS_RXGCK_CCK_FIFOTHR_8822C \ -+ (BIT_MASK_RXGCK_CCK_FIFOTHR_8822C << BIT_SHIFT_RXGCK_CCK_FIFOTHR_8822C) -+#define BIT_CLEAR_RXGCK_CCK_FIFOTHR_8822C(x) \ -+ ((x) & (~BITS_RXGCK_CCK_FIFOTHR_8822C)) -+#define BIT_GET_RXGCK_CCK_FIFOTHR_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_CCK_FIFOTHR_8822C) & \ -+ BIT_MASK_RXGCK_CCK_FIFOTHR_8822C) -+#define BIT_SET_RXGCK_CCK_FIFOTHR_8822C(x, v) \ -+ (BIT_CLEAR_RXGCK_CCK_FIFOTHR_8822C(x) | BIT_RXGCK_CCK_FIFOTHR_8822C(v)) -+ -+#define BIT_SHIFT_RXGCK_ENTRY_DELAY_8822C 17 -+#define BIT_MASK_RXGCK_ENTRY_DELAY_8822C 0x7 -+#define BIT_RXGCK_ENTRY_DELAY_8822C(x) \ -+ (((x) & BIT_MASK_RXGCK_ENTRY_DELAY_8822C) \ -+ << BIT_SHIFT_RXGCK_ENTRY_DELAY_8822C) -+#define BITS_RXGCK_ENTRY_DELAY_8822C \ -+ (BIT_MASK_RXGCK_ENTRY_DELAY_8822C << BIT_SHIFT_RXGCK_ENTRY_DELAY_8822C) -+#define BIT_CLEAR_RXGCK_ENTRY_DELAY_8822C(x) \ -+ ((x) & (~BITS_RXGCK_ENTRY_DELAY_8822C)) -+#define BIT_GET_RXGCK_ENTRY_DELAY_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXGCK_ENTRY_DELAY_8822C) & \ -+ BIT_MASK_RXGCK_ENTRY_DELAY_8822C) -+#define BIT_SET_RXGCK_ENTRY_DELAY_8822C(x, v) \ -+ (BIT_CLEAR_RXGCK_ENTRY_DELAY_8822C(x) | BIT_RXGCK_ENTRY_DELAY_8822C(v)) -+ -+#define BIT_RXGCK_OFDMCCA_EN_8822C BIT(16) -+ -+#define BIT_SHIFT_RXPSF_PKTLENTHR_8822C 13 -+#define BIT_MASK_RXPSF_PKTLENTHR_8822C 0x7 -+#define BIT_RXPSF_PKTLENTHR_8822C(x) \ -+ (((x) & BIT_MASK_RXPSF_PKTLENTHR_8822C) \ -+ << BIT_SHIFT_RXPSF_PKTLENTHR_8822C) -+#define BITS_RXPSF_PKTLENTHR_8822C \ -+ (BIT_MASK_RXPSF_PKTLENTHR_8822C << BIT_SHIFT_RXPSF_PKTLENTHR_8822C) -+#define BIT_CLEAR_RXPSF_PKTLENTHR_8822C(x) ((x) & (~BITS_RXPSF_PKTLENTHR_8822C)) -+#define BIT_GET_RXPSF_PKTLENTHR_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXPSF_PKTLENTHR_8822C) & \ -+ BIT_MASK_RXPSF_PKTLENTHR_8822C) -+#define BIT_SET_RXPSF_PKTLENTHR_8822C(x, v) \ -+ (BIT_CLEAR_RXPSF_PKTLENTHR_8822C(x) | BIT_RXPSF_PKTLENTHR_8822C(v)) -+ -+#define BIT_RXPSF_CTRLEN_8822C BIT(12) -+#define BIT_RXPSF_VHTCHKEN_8822C BIT(11) -+#define BIT_RXPSF_HTCHKEN_8822C BIT(10) -+#define BIT_RXPSF_OFDMCHKEN_8822C BIT(9) -+#define BIT_RXPSF_CCKCHKEN_8822C BIT(8) -+#define BIT_RXPSF_OFDMRST_8822C BIT(7) -+#define BIT_RXPSF_CCKRST_8822C BIT(6) -+#define BIT_RXPSF_MHCHKEN_8822C BIT(5) -+#define BIT_RXPSF_CONT_ERRCHKEN_8822C BIT(4) -+#define BIT_RXPSF_ALL_ERRCHKEN_8822C BIT(3) -+ -+#define BIT_SHIFT_RXPSF_ERRTHR_8822C 0 -+#define BIT_MASK_RXPSF_ERRTHR_8822C 0x7 -+#define BIT_RXPSF_ERRTHR_8822C(x) \ -+ (((x) & BIT_MASK_RXPSF_ERRTHR_8822C) << BIT_SHIFT_RXPSF_ERRTHR_8822C) -+#define BITS_RXPSF_ERRTHR_8822C \ -+ (BIT_MASK_RXPSF_ERRTHR_8822C << BIT_SHIFT_RXPSF_ERRTHR_8822C) -+#define BIT_CLEAR_RXPSF_ERRTHR_8822C(x) ((x) & (~BITS_RXPSF_ERRTHR_8822C)) -+#define BIT_GET_RXPSF_ERRTHR_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXPSF_ERRTHR_8822C) & BIT_MASK_RXPSF_ERRTHR_8822C) -+#define BIT_SET_RXPSF_ERRTHR_8822C(x, v) \ -+ (BIT_CLEAR_RXPSF_ERRTHR_8822C(x) | BIT_RXPSF_ERRTHR_8822C(v)) -+ -+/* 2 REG_RXPSF_TYPE_CTRL_8822C */ -+#define BIT_RXPSF_DATA15EN_8822C BIT(31) -+#define BIT_RXPSF_DATA14EN_8822C BIT(30) -+#define BIT_RXPSF_DATA13EN_8822C BIT(29) -+#define BIT_RXPSF_DATA12EN_8822C BIT(28) -+#define BIT_RXPSF_DATA11EN_8822C BIT(27) -+#define BIT_RXPSF_DATA10EN_8822C BIT(26) -+#define BIT_RXPSF_DATA9EN_8822C BIT(25) -+#define BIT_RXPSF_DATA8EN_8822C BIT(24) -+#define BIT_RXPSF_DATA7EN_8822C BIT(23) -+#define BIT_RXPSF_DATA6EN_8822C BIT(22) -+#define BIT_RXPSF_DATA5EN_8822C BIT(21) -+#define BIT_RXPSF_DATA4EN_8822C BIT(20) -+#define BIT_RXPSF_DATA3EN_8822C BIT(19) -+#define BIT_RXPSF_DATA2EN_8822C BIT(18) -+#define BIT_RXPSF_DATA1EN_8822C BIT(17) -+#define BIT_RXPSF_DATA0EN_8822C BIT(16) -+#define BIT_RXPSF_MGT15EN_8822C BIT(15) -+#define BIT_RXPSF_MGT14EN_8822C BIT(14) -+#define BIT_RXPSF_MGT13EN_8822C BIT(13) -+#define BIT_RXPSF_MGT12EN_8822C BIT(12) -+#define BIT_RXPSF_MGT11EN_8822C BIT(11) -+#define BIT_RXPSF_MGT10EN_8822C BIT(10) -+#define BIT_RXPSF_MGT9EN_8822C BIT(9) -+#define BIT_RXPSF_MGT8EN_8822C BIT(8) -+#define BIT_RXPSF_MGT7EN_8822C BIT(7) -+#define BIT_RXPSF_MGT6EN_8822C BIT(6) -+#define BIT_RXPSF_MGT5EN_8822C BIT(5) -+#define BIT_RXPSF_MGT4EN_8822C BIT(4) -+#define BIT_RXPSF_MGT3EN_8822C BIT(3) -+#define BIT_RXPSF_MGT2EN_8822C BIT(2) -+#define BIT_RXPSF_MGT1EN_8822C BIT(1) -+#define BIT_RXPSF_MGT0EN_8822C BIT(0) -+ -+/* 2 REG_CAM_ACCESS_CTRL_8822C */ -+#define BIT_INDIRECT_ERR_8822C BIT(6) -+#define BIT_DIRECT_ERR_8822C BIT(5) -+#define BIT_DIR_ACCESS_EN_RX_BA_8822C BIT(4) -+#define BIT_DIR_ACCESS_EN_MBSSIDCAM_8822C BIT(3) -+#define BIT_DIR_ACCESS_EN_KEY_8822C BIT(2) -+#define BIT_DIR_ACCESS_EN_WOWLAN_8822C BIT(1) -+#define BIT_DIR_ACCESS_EN_FW_FILTER_8822C BIT(0) -+ -+/* 2 REG_HT_SND_REF_RATE_8822C */ -+ -+#define BIT_SHIFT_WMAC_HT_CSI_RATE_8822C 0 -+#define BIT_MASK_WMAC_HT_CSI_RATE_8822C 0x3f -+#define BIT_WMAC_HT_CSI_RATE_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_HT_CSI_RATE_8822C) \ -+ << BIT_SHIFT_WMAC_HT_CSI_RATE_8822C) -+#define BITS_WMAC_HT_CSI_RATE_8822C \ -+ (BIT_MASK_WMAC_HT_CSI_RATE_8822C << BIT_SHIFT_WMAC_HT_CSI_RATE_8822C) -+#define BIT_CLEAR_WMAC_HT_CSI_RATE_8822C(x) \ -+ ((x) & (~BITS_WMAC_HT_CSI_RATE_8822C)) -+#define BIT_GET_WMAC_HT_CSI_RATE_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_HT_CSI_RATE_8822C) & \ -+ BIT_MASK_WMAC_HT_CSI_RATE_8822C) -+#define BIT_SET_WMAC_HT_CSI_RATE_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_HT_CSI_RATE_8822C(x) | BIT_WMAC_HT_CSI_RATE_8822C(v)) -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_MACID2_8822C (MAC ID2 REGISTER) */ -+ -+#define BIT_SHIFT_MACID2_V1_8822C 0 -+#define BIT_MASK_MACID2_V1_8822C 0xffffffffL -+#define BIT_MACID2_V1_8822C(x) \ -+ (((x) & BIT_MASK_MACID2_V1_8822C) << BIT_SHIFT_MACID2_V1_8822C) -+#define BITS_MACID2_V1_8822C \ -+ (BIT_MASK_MACID2_V1_8822C << BIT_SHIFT_MACID2_V1_8822C) -+#define BIT_CLEAR_MACID2_V1_8822C(x) ((x) & (~BITS_MACID2_V1_8822C)) -+#define BIT_GET_MACID2_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID2_V1_8822C) & BIT_MASK_MACID2_V1_8822C) -+#define BIT_SET_MACID2_V1_8822C(x, v) \ -+ (BIT_CLEAR_MACID2_V1_8822C(x) | BIT_MACID2_V1_8822C(v)) -+ -+/* 2 REG_MACID2_H_8822C (MAC ID2 REGISTER) */ -+ -+#define BIT_SHIFT_MACID2_H_V1_8822C 0 -+#define BIT_MASK_MACID2_H_V1_8822C 0xffff -+#define BIT_MACID2_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_MACID2_H_V1_8822C) << BIT_SHIFT_MACID2_H_V1_8822C) -+#define BITS_MACID2_H_V1_8822C \ -+ (BIT_MASK_MACID2_H_V1_8822C << BIT_SHIFT_MACID2_H_V1_8822C) -+#define BIT_CLEAR_MACID2_H_V1_8822C(x) ((x) & (~BITS_MACID2_H_V1_8822C)) -+#define BIT_GET_MACID2_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID2_H_V1_8822C) & BIT_MASK_MACID2_H_V1_8822C) -+#define BIT_SET_MACID2_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_MACID2_H_V1_8822C(x) | BIT_MACID2_H_V1_8822C(v)) -+ -+/* 2 REG_BSSID2_8822C (BSSID2 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID2_V1_8822C 0 -+#define BIT_MASK_BSSID2_V1_8822C 0xffffffffL -+#define BIT_BSSID2_V1_8822C(x) \ -+ (((x) & BIT_MASK_BSSID2_V1_8822C) << BIT_SHIFT_BSSID2_V1_8822C) -+#define BITS_BSSID2_V1_8822C \ -+ (BIT_MASK_BSSID2_V1_8822C << BIT_SHIFT_BSSID2_V1_8822C) -+#define BIT_CLEAR_BSSID2_V1_8822C(x) ((x) & (~BITS_BSSID2_V1_8822C)) -+#define BIT_GET_BSSID2_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_V1_8822C) & BIT_MASK_BSSID2_V1_8822C) -+#define BIT_SET_BSSID2_V1_8822C(x, v) \ -+ (BIT_CLEAR_BSSID2_V1_8822C(x) | BIT_BSSID2_V1_8822C(v)) -+ -+/* 2 REG_BSSID2_H_8822C (BSSID2 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID2_H_V1_8822C 0 -+#define BIT_MASK_BSSID2_H_V1_8822C 0xffff -+#define BIT_BSSID2_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_BSSID2_H_V1_8822C) << BIT_SHIFT_BSSID2_H_V1_8822C) -+#define BITS_BSSID2_H_V1_8822C \ -+ (BIT_MASK_BSSID2_H_V1_8822C << BIT_SHIFT_BSSID2_H_V1_8822C) -+#define BIT_CLEAR_BSSID2_H_V1_8822C(x) ((x) & (~BITS_BSSID2_H_V1_8822C)) -+#define BIT_GET_BSSID2_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID2_H_V1_8822C) & BIT_MASK_BSSID2_H_V1_8822C) -+#define BIT_SET_BSSID2_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_BSSID2_H_V1_8822C(x) | BIT_BSSID2_H_V1_8822C(v)) -+ -+/* 2 REG_MACID3_8822C (MAC ID3 REGISTER) */ -+ -+#define BIT_SHIFT_MACID3_V1_8822C 0 -+#define BIT_MASK_MACID3_V1_8822C 0xffffffffL -+#define BIT_MACID3_V1_8822C(x) \ -+ (((x) & BIT_MASK_MACID3_V1_8822C) << BIT_SHIFT_MACID3_V1_8822C) -+#define BITS_MACID3_V1_8822C \ -+ (BIT_MASK_MACID3_V1_8822C << BIT_SHIFT_MACID3_V1_8822C) -+#define BIT_CLEAR_MACID3_V1_8822C(x) ((x) & (~BITS_MACID3_V1_8822C)) -+#define BIT_GET_MACID3_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID3_V1_8822C) & BIT_MASK_MACID3_V1_8822C) -+#define BIT_SET_MACID3_V1_8822C(x, v) \ -+ (BIT_CLEAR_MACID3_V1_8822C(x) | BIT_MACID3_V1_8822C(v)) -+ -+/* 2 REG_MACID3_H_8822C (MAC ID3 REGISTER) */ -+ -+#define BIT_SHIFT_MACID3_H_V1_8822C 0 -+#define BIT_MASK_MACID3_H_V1_8822C 0xffff -+#define BIT_MACID3_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_MACID3_H_V1_8822C) << BIT_SHIFT_MACID3_H_V1_8822C) -+#define BITS_MACID3_H_V1_8822C \ -+ (BIT_MASK_MACID3_H_V1_8822C << BIT_SHIFT_MACID3_H_V1_8822C) -+#define BIT_CLEAR_MACID3_H_V1_8822C(x) ((x) & (~BITS_MACID3_H_V1_8822C)) -+#define BIT_GET_MACID3_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID3_H_V1_8822C) & BIT_MASK_MACID3_H_V1_8822C) -+#define BIT_SET_MACID3_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_MACID3_H_V1_8822C(x) | BIT_MACID3_H_V1_8822C(v)) -+ -+/* 2 REG_BSSID3_8822C (BSSID3 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID3_V1_8822C 0 -+#define BIT_MASK_BSSID3_V1_8822C 0xffffffffL -+#define BIT_BSSID3_V1_8822C(x) \ -+ (((x) & BIT_MASK_BSSID3_V1_8822C) << BIT_SHIFT_BSSID3_V1_8822C) -+#define BITS_BSSID3_V1_8822C \ -+ (BIT_MASK_BSSID3_V1_8822C << BIT_SHIFT_BSSID3_V1_8822C) -+#define BIT_CLEAR_BSSID3_V1_8822C(x) ((x) & (~BITS_BSSID3_V1_8822C)) -+#define BIT_GET_BSSID3_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_V1_8822C) & BIT_MASK_BSSID3_V1_8822C) -+#define BIT_SET_BSSID3_V1_8822C(x, v) \ -+ (BIT_CLEAR_BSSID3_V1_8822C(x) | BIT_BSSID3_V1_8822C(v)) -+ -+/* 2 REG_BSSID3_H_8822C (BSSID3 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID3_H_V1_8822C 0 -+#define BIT_MASK_BSSID3_H_V1_8822C 0xffff -+#define BIT_BSSID3_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_BSSID3_H_V1_8822C) << BIT_SHIFT_BSSID3_H_V1_8822C) -+#define BITS_BSSID3_H_V1_8822C \ -+ (BIT_MASK_BSSID3_H_V1_8822C << BIT_SHIFT_BSSID3_H_V1_8822C) -+#define BIT_CLEAR_BSSID3_H_V1_8822C(x) ((x) & (~BITS_BSSID3_H_V1_8822C)) -+#define BIT_GET_BSSID3_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID3_H_V1_8822C) & BIT_MASK_BSSID3_H_V1_8822C) -+#define BIT_SET_BSSID3_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_BSSID3_H_V1_8822C(x) | BIT_BSSID3_H_V1_8822C(v)) -+ -+/* 2 REG_MACID4_8822C (MAC ID4 REGISTER) */ -+ -+#define BIT_SHIFT_MACID4_V1_8822C 0 -+#define BIT_MASK_MACID4_V1_8822C 0xffffffffL -+#define BIT_MACID4_V1_8822C(x) \ -+ (((x) & BIT_MASK_MACID4_V1_8822C) << BIT_SHIFT_MACID4_V1_8822C) -+#define BITS_MACID4_V1_8822C \ -+ (BIT_MASK_MACID4_V1_8822C << BIT_SHIFT_MACID4_V1_8822C) -+#define BIT_CLEAR_MACID4_V1_8822C(x) ((x) & (~BITS_MACID4_V1_8822C)) -+#define BIT_GET_MACID4_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID4_V1_8822C) & BIT_MASK_MACID4_V1_8822C) -+#define BIT_SET_MACID4_V1_8822C(x, v) \ -+ (BIT_CLEAR_MACID4_V1_8822C(x) | BIT_MACID4_V1_8822C(v)) -+ -+/* 2 REG_MACID4_H_8822C (MAC ID4 REGISTER) */ -+ -+#define BIT_SHIFT_MACID4_H_V1_8822C 0 -+#define BIT_MASK_MACID4_H_V1_8822C 0xffff -+#define BIT_MACID4_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_MACID4_H_V1_8822C) << BIT_SHIFT_MACID4_H_V1_8822C) -+#define BITS_MACID4_H_V1_8822C \ -+ (BIT_MASK_MACID4_H_V1_8822C << BIT_SHIFT_MACID4_H_V1_8822C) -+#define BIT_CLEAR_MACID4_H_V1_8822C(x) ((x) & (~BITS_MACID4_H_V1_8822C)) -+#define BIT_GET_MACID4_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID4_H_V1_8822C) & BIT_MASK_MACID4_H_V1_8822C) -+#define BIT_SET_MACID4_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_MACID4_H_V1_8822C(x) | BIT_MACID4_H_V1_8822C(v)) -+ -+/* 2 REG_BSSID4_8822C (BSSID4 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID4_V1_8822C 0 -+#define BIT_MASK_BSSID4_V1_8822C 0xffffffffL -+#define BIT_BSSID4_V1_8822C(x) \ -+ (((x) & BIT_MASK_BSSID4_V1_8822C) << BIT_SHIFT_BSSID4_V1_8822C) -+#define BITS_BSSID4_V1_8822C \ -+ (BIT_MASK_BSSID4_V1_8822C << BIT_SHIFT_BSSID4_V1_8822C) -+#define BIT_CLEAR_BSSID4_V1_8822C(x) ((x) & (~BITS_BSSID4_V1_8822C)) -+#define BIT_GET_BSSID4_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_V1_8822C) & BIT_MASK_BSSID4_V1_8822C) -+#define BIT_SET_BSSID4_V1_8822C(x, v) \ -+ (BIT_CLEAR_BSSID4_V1_8822C(x) | BIT_BSSID4_V1_8822C(v)) -+ -+/* 2 REG_BSSID4_H_8822C (BSSID4 REGISTER) */ -+ -+#define BIT_SHIFT_BSSID4_H_V1_8822C 0 -+#define BIT_MASK_BSSID4_H_V1_8822C 0xffff -+#define BIT_BSSID4_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_BSSID4_H_V1_8822C) << BIT_SHIFT_BSSID4_H_V1_8822C) -+#define BITS_BSSID4_H_V1_8822C \ -+ (BIT_MASK_BSSID4_H_V1_8822C << BIT_SHIFT_BSSID4_H_V1_8822C) -+#define BIT_CLEAR_BSSID4_H_V1_8822C(x) ((x) & (~BITS_BSSID4_H_V1_8822C)) -+#define BIT_GET_BSSID4_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID4_H_V1_8822C) & BIT_MASK_BSSID4_H_V1_8822C) -+#define BIT_SET_BSSID4_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_BSSID4_H_V1_8822C(x) | BIT_BSSID4_H_V1_8822C(v)) -+ -+/* 2 REG_NOA_REPORT_8822C */ -+ -+/* 2 REG_NOA_REPORT_1_8822C */ -+ -+/* 2 REG_NOA_REPORT_2_8822C */ -+ -+/* 2 REG_NOA_REPORT_3_8822C */ -+ -+/* 2 REG_PWRBIT_SETTING_8822C */ -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWCTL_EN_8822C BIT(15) -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWDATA_EN_8822C BIT(14) -+#define BIT_CLI3_WMAC_TCRPWRMGT_HWACT_EN_8822C BIT(13) -+#define BIT_CLI3_PWR_ST_V1_8822C BIT(12) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWCTL_EN_8822C BIT(11) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWDATA_EN_8822C BIT(10) -+#define BIT_CLI2_WMAC_TCRPWRMGT_HWACT_EN_8822C BIT(9) -+#define BIT_CLI2_PWR_ST_V1_8822C BIT(8) -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWCTL_EN_8822C BIT(7) -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWDATA_EN_8822C BIT(6) -+#define BIT_CLI1_WMAC_TCRPWRMGT_HWACT_EN_8822C BIT(5) -+#define BIT_CLI1_PWR_ST_V1_8822C BIT(4) -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWCTL_EN_8822C BIT(3) -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWDATA_EN_8822C BIT(2) -+#define BIT_CLI0_WMAC_TCRPWRMGT_HWACT_EN_8822C BIT(1) -+#define BIT_CLI0_PWR_ST_V1_8822C BIT(0) -+ -+/* 2 REG_GENERAL_OPTION_8822C */ -+#define BIT_WMAC_RXRST_NDP_TIMEOUT_8822C BIT(11) -+#define BIT_WMAC_NDP_STANDBY_WAIT_RXEND_8822C BIT(10) -+#define BIT_DUMMY_FCS_READY_MASK_EN_8822C BIT(9) -+#define BIT_RXFIFO_GNT_CUT_8822C BIT(8) -+#define BIT_DUMMY_RXD_FCS_ERROR_MASK_EN_V1_8822C BIT(7) -+#define BIT_WMAC_EXT_DBG_SEL_V1_8822C BIT(6) -+#define BIT_WMAC_FIX_FIRST_MPDU_WITH_PHYSTS_8822C BIT(5) -+#define BIT_RX_DMA_BYPASS_CHECK_DATABYPASS_CHECK_DATA_8822C BIT(4) -+#define BIT_RX_DMA_BYPASS_CHECK_MGTBIT_RX_DMA_BYPASS_CHECK_MGT_8822C BIT(3) -+#define BIT_TXSERV_FIELD_SEL_8822C BIT(2) -+#define BIT_RXVHT_LEN_SEL_8822C BIT(1) -+#define BIT_RXMIC_PROTECT_EN_8822C BIT(0) -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_CSI_RRSR_8822C */ -+#define BIT_CSI_LDPC_EN_8822C BIT(29) -+#define BIT_CSI_STBC_EN_8822C BIT(28) -+ -+#define BIT_SHIFT_CSI_RRSC_BITMAP_8822C 4 -+#define BIT_MASK_CSI_RRSC_BITMAP_8822C 0xffffff -+#define BIT_CSI_RRSC_BITMAP_8822C(x) \ -+ (((x) & BIT_MASK_CSI_RRSC_BITMAP_8822C) \ -+ << BIT_SHIFT_CSI_RRSC_BITMAP_8822C) -+#define BITS_CSI_RRSC_BITMAP_8822C \ -+ (BIT_MASK_CSI_RRSC_BITMAP_8822C << BIT_SHIFT_CSI_RRSC_BITMAP_8822C) -+#define BIT_CLEAR_CSI_RRSC_BITMAP_8822C(x) ((x) & (~BITS_CSI_RRSC_BITMAP_8822C)) -+#define BIT_GET_CSI_RRSC_BITMAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_CSI_RRSC_BITMAP_8822C) & \ -+ BIT_MASK_CSI_RRSC_BITMAP_8822C) -+#define BIT_SET_CSI_RRSC_BITMAP_8822C(x, v) \ -+ (BIT_CLEAR_CSI_RRSC_BITMAP_8822C(x) | BIT_CSI_RRSC_BITMAP_8822C(v)) -+ -+#define BIT_SHIFT_OFDM_LEN_TH_8822C 0 -+#define BIT_MASK_OFDM_LEN_TH_8822C 0xf -+#define BIT_OFDM_LEN_TH_8822C(x) \ -+ (((x) & BIT_MASK_OFDM_LEN_TH_8822C) << BIT_SHIFT_OFDM_LEN_TH_8822C) -+#define BITS_OFDM_LEN_TH_8822C \ -+ (BIT_MASK_OFDM_LEN_TH_8822C << BIT_SHIFT_OFDM_LEN_TH_8822C) -+#define BIT_CLEAR_OFDM_LEN_TH_8822C(x) ((x) & (~BITS_OFDM_LEN_TH_8822C)) -+#define BIT_GET_OFDM_LEN_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_OFDM_LEN_TH_8822C) & BIT_MASK_OFDM_LEN_TH_8822C) -+#define BIT_SET_OFDM_LEN_TH_8822C(x, v) \ -+ (BIT_CLEAR_OFDM_LEN_TH_8822C(x) | BIT_OFDM_LEN_TH_8822C(v)) -+ -+/* 2 REG_MU_BF_OPTION_8822C */ -+#define BIT_WMAC_RESP_NONSTA1_DIS_8822C BIT(7) -+#define BIT_WMAC_TXMU_ACKPOLICY_EN_8822C BIT(6) -+ -+#define BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8822C 4 -+#define BIT_MASK_WMAC_TXMU_ACKPOLICY_8822C 0x3 -+#define BIT_WMAC_TXMU_ACKPOLICY_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_TXMU_ACKPOLICY_8822C) \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8822C) -+#define BITS_WMAC_TXMU_ACKPOLICY_8822C \ -+ (BIT_MASK_WMAC_TXMU_ACKPOLICY_8822C \ -+ << BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8822C) -+#define BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8822C(x) \ -+ ((x) & (~BITS_WMAC_TXMU_ACKPOLICY_8822C)) -+#define BIT_GET_WMAC_TXMU_ACKPOLICY_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_TXMU_ACKPOLICY_8822C) & \ -+ BIT_MASK_WMAC_TXMU_ACKPOLICY_8822C) -+#define BIT_SET_WMAC_TXMU_ACKPOLICY_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_TXMU_ACKPOLICY_8822C(x) | \ -+ BIT_WMAC_TXMU_ACKPOLICY_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8822C 1 -+#define BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8822C 0x7 -+#define BIT_WMAC_MU_BFEE_PORT_SEL_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8822C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8822C) -+#define BITS_WMAC_MU_BFEE_PORT_SEL_8822C \ -+ (BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8822C \ -+ << BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8822C) -+#define BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8822C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE_PORT_SEL_8822C)) -+#define BIT_GET_WMAC_MU_BFEE_PORT_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE_PORT_SEL_8822C) & \ -+ BIT_MASK_WMAC_MU_BFEE_PORT_SEL_8822C) -+#define BIT_SET_WMAC_MU_BFEE_PORT_SEL_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE_PORT_SEL_8822C(x) | \ -+ BIT_WMAC_MU_BFEE_PORT_SEL_8822C(v)) -+ -+#define BIT_WMAC_MU_BFEE_DIS_8822C BIT(0) -+ -+/* 2 REG_WMAC_PAUSE_BB_CLR_TH_8822C */ -+ -+#define BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8822C 0 -+#define BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8822C 0xff -+#define BIT_WMAC_PAUSE_BB_CLR_TH_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8822C) \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8822C) -+#define BITS_WMAC_PAUSE_BB_CLR_TH_8822C \ -+ (BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8822C \ -+ << BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8822C) -+#define BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8822C(x) \ -+ ((x) & (~BITS_WMAC_PAUSE_BB_CLR_TH_8822C)) -+#define BIT_GET_WMAC_PAUSE_BB_CLR_TH_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PAUSE_BB_CLR_TH_8822C) & \ -+ BIT_MASK_WMAC_PAUSE_BB_CLR_TH_8822C) -+#define BIT_SET_WMAC_PAUSE_BB_CLR_TH_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_PAUSE_BB_CLR_TH_8822C(x) | \ -+ BIT_WMAC_PAUSE_BB_CLR_TH_8822C(v)) -+ -+/* 2 REG__WMAC_MULBK_BUF_8822C */ -+ -+#define BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8822C 0 -+#define BIT_MASK_WMAC_MULBK_PAGE_SIZE_8822C 0xff -+#define BIT_WMAC_MULBK_PAGE_SIZE_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_MULBK_PAGE_SIZE_8822C) \ -+ << BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8822C) -+#define BITS_WMAC_MULBK_PAGE_SIZE_8822C \ -+ (BIT_MASK_WMAC_MULBK_PAGE_SIZE_8822C \ -+ << BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8822C) -+#define BIT_CLEAR_WMAC_MULBK_PAGE_SIZE_8822C(x) \ -+ ((x) & (~BITS_WMAC_MULBK_PAGE_SIZE_8822C)) -+#define BIT_GET_WMAC_MULBK_PAGE_SIZE_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MULBK_PAGE_SIZE_8822C) & \ -+ BIT_MASK_WMAC_MULBK_PAGE_SIZE_8822C) -+#define BIT_SET_WMAC_MULBK_PAGE_SIZE_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_MULBK_PAGE_SIZE_8822C(x) | \ -+ BIT_WMAC_MULBK_PAGE_SIZE_8822C(v)) -+ -+/* 2 REG_WMAC_MU_OPTION_8822C */ -+ -+/* 2 REG_WMAC_MU_BF_CTL_8822C */ -+#define BIT_WMAC_INVLD_BFPRT_CHK_8822C BIT(15) -+#define BIT_WMAC_RETXBFRPTSEQ_UPD_8822C BIT(14) -+ -+#define BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8822C 12 -+#define BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8822C 0x3 -+#define BIT_WMAC_MU_BFRPTSEG_SEL_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8822C) \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8822C) -+#define BITS_WMAC_MU_BFRPTSEG_SEL_8822C \ -+ (BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8822C \ -+ << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8822C) -+#define BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8822C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFRPTSEG_SEL_8822C)) -+#define BIT_GET_WMAC_MU_BFRPTSEG_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8822C) & \ -+ BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8822C) -+#define BIT_SET_WMAC_MU_BFRPTSEG_SEL_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8822C(x) | \ -+ BIT_WMAC_MU_BFRPTSEG_SEL_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_MU_BF_MYAID_8822C 0 -+#define BIT_MASK_WMAC_MU_BF_MYAID_8822C 0xfff -+#define BIT_WMAC_MU_BF_MYAID_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BF_MYAID_8822C) \ -+ << BIT_SHIFT_WMAC_MU_BF_MYAID_8822C) -+#define BITS_WMAC_MU_BF_MYAID_8822C \ -+ (BIT_MASK_WMAC_MU_BF_MYAID_8822C << BIT_SHIFT_WMAC_MU_BF_MYAID_8822C) -+#define BIT_CLEAR_WMAC_MU_BF_MYAID_8822C(x) \ -+ ((x) & (~BITS_WMAC_MU_BF_MYAID_8822C)) -+#define BIT_GET_WMAC_MU_BF_MYAID_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BF_MYAID_8822C) & \ -+ BIT_MASK_WMAC_MU_BF_MYAID_8822C) -+#define BIT_SET_WMAC_MU_BF_MYAID_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BF_MYAID_8822C(x) | BIT_WMAC_MU_BF_MYAID_8822C(v)) -+ -+/* 2 REG_WMAC_MU_BFRPT_PARA_8822C */ -+ -+#define BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8822C 13 -+#define BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8822C 0x7 -+#define BIT_BFRPT_PARA_USERID_SEL_V1_8822C(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8822C) \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8822C) -+#define BITS_BFRPT_PARA_USERID_SEL_V1_8822C \ -+ (BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8822C \ -+ << BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8822C) -+#define BIT_CLEAR_BFRPT_PARA_USERID_SEL_V1_8822C(x) \ -+ ((x) & (~BITS_BFRPT_PARA_USERID_SEL_V1_8822C)) -+#define BIT_GET_BFRPT_PARA_USERID_SEL_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_USERID_SEL_V1_8822C) & \ -+ BIT_MASK_BFRPT_PARA_USERID_SEL_V1_8822C) -+#define BIT_SET_BFRPT_PARA_USERID_SEL_V1_8822C(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_USERID_SEL_V1_8822C(x) | \ -+ BIT_BFRPT_PARA_USERID_SEL_V1_8822C(v)) -+ -+#define BIT_SHIFT_BFRPT_PARA_V1_8822C 0 -+#define BIT_MASK_BFRPT_PARA_V1_8822C 0x1fff -+#define BIT_BFRPT_PARA_V1_8822C(x) \ -+ (((x) & BIT_MASK_BFRPT_PARA_V1_8822C) << BIT_SHIFT_BFRPT_PARA_V1_8822C) -+#define BITS_BFRPT_PARA_V1_8822C \ -+ (BIT_MASK_BFRPT_PARA_V1_8822C << BIT_SHIFT_BFRPT_PARA_V1_8822C) -+#define BIT_CLEAR_BFRPT_PARA_V1_8822C(x) ((x) & (~BITS_BFRPT_PARA_V1_8822C)) -+#define BIT_GET_BFRPT_PARA_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BFRPT_PARA_V1_8822C) & BIT_MASK_BFRPT_PARA_V1_8822C) -+#define BIT_SET_BFRPT_PARA_V1_8822C(x, v) \ -+ (BIT_CLEAR_BFRPT_PARA_V1_8822C(x) | BIT_BFRPT_PARA_V1_8822C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE2_8822C */ -+#define BIT_STATUS_BFEE2_8822C BIT(10) -+#define BIT_WMAC_MU_BFEE2_EN_8822C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE2_AID_8822C 0 -+#define BIT_MASK_WMAC_MU_BFEE2_AID_8822C 0x1ff -+#define BIT_WMAC_MU_BFEE2_AID_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE2_AID_8822C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE2_AID_8822C) -+#define BITS_WMAC_MU_BFEE2_AID_8822C \ -+ (BIT_MASK_WMAC_MU_BFEE2_AID_8822C << BIT_SHIFT_WMAC_MU_BFEE2_AID_8822C) -+#define BIT_CLEAR_WMAC_MU_BFEE2_AID_8822C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE2_AID_8822C)) -+#define BIT_GET_WMAC_MU_BFEE2_AID_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE2_AID_8822C) & \ -+ BIT_MASK_WMAC_MU_BFEE2_AID_8822C) -+#define BIT_SET_WMAC_MU_BFEE2_AID_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE2_AID_8822C(x) | BIT_WMAC_MU_BFEE2_AID_8822C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE3_8822C */ -+#define BIT_STATUS_BFEE3_8822C BIT(10) -+#define BIT_WMAC_MU_BFEE3_EN_8822C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE3_AID_8822C 0 -+#define BIT_MASK_WMAC_MU_BFEE3_AID_8822C 0x1ff -+#define BIT_WMAC_MU_BFEE3_AID_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE3_AID_8822C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE3_AID_8822C) -+#define BITS_WMAC_MU_BFEE3_AID_8822C \ -+ (BIT_MASK_WMAC_MU_BFEE3_AID_8822C << BIT_SHIFT_WMAC_MU_BFEE3_AID_8822C) -+#define BIT_CLEAR_WMAC_MU_BFEE3_AID_8822C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE3_AID_8822C)) -+#define BIT_GET_WMAC_MU_BFEE3_AID_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE3_AID_8822C) & \ -+ BIT_MASK_WMAC_MU_BFEE3_AID_8822C) -+#define BIT_SET_WMAC_MU_BFEE3_AID_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE3_AID_8822C(x) | BIT_WMAC_MU_BFEE3_AID_8822C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE4_8822C */ -+#define BIT_STATUS_BFEE4_8822C BIT(10) -+#define BIT_WMAC_MU_BFEE4_EN_8822C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE4_AID_8822C 0 -+#define BIT_MASK_WMAC_MU_BFEE4_AID_8822C 0x1ff -+#define BIT_WMAC_MU_BFEE4_AID_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE4_AID_8822C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE4_AID_8822C) -+#define BITS_WMAC_MU_BFEE4_AID_8822C \ -+ (BIT_MASK_WMAC_MU_BFEE4_AID_8822C << BIT_SHIFT_WMAC_MU_BFEE4_AID_8822C) -+#define BIT_CLEAR_WMAC_MU_BFEE4_AID_8822C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE4_AID_8822C)) -+#define BIT_GET_WMAC_MU_BFEE4_AID_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE4_AID_8822C) & \ -+ BIT_MASK_WMAC_MU_BFEE4_AID_8822C) -+#define BIT_SET_WMAC_MU_BFEE4_AID_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE4_AID_8822C(x) | BIT_WMAC_MU_BFEE4_AID_8822C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE5_8822C */ -+#define BIT_BIT_STATUS_BFEE5_8822C BIT(10) -+#define BIT_WMAC_MU_BFEE5_EN_8822C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE5_AID_8822C 0 -+#define BIT_MASK_WMAC_MU_BFEE5_AID_8822C 0x1ff -+#define BIT_WMAC_MU_BFEE5_AID_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE5_AID_8822C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE5_AID_8822C) -+#define BITS_WMAC_MU_BFEE5_AID_8822C \ -+ (BIT_MASK_WMAC_MU_BFEE5_AID_8822C << BIT_SHIFT_WMAC_MU_BFEE5_AID_8822C) -+#define BIT_CLEAR_WMAC_MU_BFEE5_AID_8822C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE5_AID_8822C)) -+#define BIT_GET_WMAC_MU_BFEE5_AID_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE5_AID_8822C) & \ -+ BIT_MASK_WMAC_MU_BFEE5_AID_8822C) -+#define BIT_SET_WMAC_MU_BFEE5_AID_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE5_AID_8822C(x) | BIT_WMAC_MU_BFEE5_AID_8822C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE6_8822C */ -+#define BIT_STATUS_BFEE6_8822C BIT(10) -+#define BIT_WMAC_MU_BFEE6_EN_8822C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE6_AID_8822C 0 -+#define BIT_MASK_WMAC_MU_BFEE6_AID_8822C 0x1ff -+#define BIT_WMAC_MU_BFEE6_AID_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE6_AID_8822C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE6_AID_8822C) -+#define BITS_WMAC_MU_BFEE6_AID_8822C \ -+ (BIT_MASK_WMAC_MU_BFEE6_AID_8822C << BIT_SHIFT_WMAC_MU_BFEE6_AID_8822C) -+#define BIT_CLEAR_WMAC_MU_BFEE6_AID_8822C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE6_AID_8822C)) -+#define BIT_GET_WMAC_MU_BFEE6_AID_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE6_AID_8822C) & \ -+ BIT_MASK_WMAC_MU_BFEE6_AID_8822C) -+#define BIT_SET_WMAC_MU_BFEE6_AID_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE6_AID_8822C(x) | BIT_WMAC_MU_BFEE6_AID_8822C(v)) -+ -+/* 2 REG_WMAC_ASSOCIATED_MU_BFMEE7_8822C */ -+#define BIT_STATUS_BFEE7_8822C BIT(10) -+#define BIT_WMAC_MU_BFEE7_EN_8822C BIT(9) -+ -+#define BIT_SHIFT_WMAC_MU_BFEE7_AID_8822C 0 -+#define BIT_MASK_WMAC_MU_BFEE7_AID_8822C 0x1ff -+#define BIT_WMAC_MU_BFEE7_AID_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_MU_BFEE7_AID_8822C) \ -+ << BIT_SHIFT_WMAC_MU_BFEE7_AID_8822C) -+#define BITS_WMAC_MU_BFEE7_AID_8822C \ -+ (BIT_MASK_WMAC_MU_BFEE7_AID_8822C << BIT_SHIFT_WMAC_MU_BFEE7_AID_8822C) -+#define BIT_CLEAR_WMAC_MU_BFEE7_AID_8822C(x) \ -+ ((x) & (~BITS_WMAC_MU_BFEE7_AID_8822C)) -+#define BIT_GET_WMAC_MU_BFEE7_AID_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_MU_BFEE7_AID_8822C) & \ -+ BIT_MASK_WMAC_MU_BFEE7_AID_8822C) -+#define BIT_SET_WMAC_MU_BFEE7_AID_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_MU_BFEE7_AID_8822C(x) | BIT_WMAC_MU_BFEE7_AID_8822C(v)) -+ -+/* 2 REG_WMAC_BB_STOP_RX_COUNTER_8822C */ -+#define BIT_RST_ALL_COUNTER_8822C BIT(31) -+ -+#define BIT_SHIFT_ABORT_RX_VBON_COUNTER_8822C 16 -+#define BIT_MASK_ABORT_RX_VBON_COUNTER_8822C 0xff -+#define BIT_ABORT_RX_VBON_COUNTER_8822C(x) \ -+ (((x) & BIT_MASK_ABORT_RX_VBON_COUNTER_8822C) \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8822C) -+#define BITS_ABORT_RX_VBON_COUNTER_8822C \ -+ (BIT_MASK_ABORT_RX_VBON_COUNTER_8822C \ -+ << BIT_SHIFT_ABORT_RX_VBON_COUNTER_8822C) -+#define BIT_CLEAR_ABORT_RX_VBON_COUNTER_8822C(x) \ -+ ((x) & (~BITS_ABORT_RX_VBON_COUNTER_8822C)) -+#define BIT_GET_ABORT_RX_VBON_COUNTER_8822C(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_VBON_COUNTER_8822C) & \ -+ BIT_MASK_ABORT_RX_VBON_COUNTER_8822C) -+#define BIT_SET_ABORT_RX_VBON_COUNTER_8822C(x, v) \ -+ (BIT_CLEAR_ABORT_RX_VBON_COUNTER_8822C(x) | \ -+ BIT_ABORT_RX_VBON_COUNTER_8822C(v)) -+ -+#define BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8822C 8 -+#define BIT_MASK_ABORT_RX_RDRDY_COUNTER_8822C 0xff -+#define BIT_ABORT_RX_RDRDY_COUNTER_8822C(x) \ -+ (((x) & BIT_MASK_ABORT_RX_RDRDY_COUNTER_8822C) \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8822C) -+#define BITS_ABORT_RX_RDRDY_COUNTER_8822C \ -+ (BIT_MASK_ABORT_RX_RDRDY_COUNTER_8822C \ -+ << BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8822C) -+#define BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8822C(x) \ -+ ((x) & (~BITS_ABORT_RX_RDRDY_COUNTER_8822C)) -+#define BIT_GET_ABORT_RX_RDRDY_COUNTER_8822C(x) \ -+ (((x) >> BIT_SHIFT_ABORT_RX_RDRDY_COUNTER_8822C) & \ -+ BIT_MASK_ABORT_RX_RDRDY_COUNTER_8822C) -+#define BIT_SET_ABORT_RX_RDRDY_COUNTER_8822C(x, v) \ -+ (BIT_CLEAR_ABORT_RX_RDRDY_COUNTER_8822C(x) | \ -+ BIT_ABORT_RX_RDRDY_COUNTER_8822C(v)) -+ -+#define BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8822C 0 -+#define BIT_MASK_VBON_EARLY_FALLING_COUNTER_8822C 0xff -+#define BIT_VBON_EARLY_FALLING_COUNTER_8822C(x) \ -+ (((x) & BIT_MASK_VBON_EARLY_FALLING_COUNTER_8822C) \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8822C) -+#define BITS_VBON_EARLY_FALLING_COUNTER_8822C \ -+ (BIT_MASK_VBON_EARLY_FALLING_COUNTER_8822C \ -+ << BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8822C) -+#define BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8822C(x) \ -+ ((x) & (~BITS_VBON_EARLY_FALLING_COUNTER_8822C)) -+#define BIT_GET_VBON_EARLY_FALLING_COUNTER_8822C(x) \ -+ (((x) >> BIT_SHIFT_VBON_EARLY_FALLING_COUNTER_8822C) & \ -+ BIT_MASK_VBON_EARLY_FALLING_COUNTER_8822C) -+#define BIT_SET_VBON_EARLY_FALLING_COUNTER_8822C(x, v) \ -+ (BIT_CLEAR_VBON_EARLY_FALLING_COUNTER_8822C(x) | \ -+ BIT_VBON_EARLY_FALLING_COUNTER_8822C(v)) -+ -+/* 2 REG_WMAC_PLCP_MONITOR_8822C */ -+#define BIT_WMAC_PLCP_TRX_SEL_8822C BIT(31) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8822C 28 -+#define BIT_MASK_WMAC_PLCP_RDSIG_SEL_8822C 0x7 -+#define BIT_WMAC_PLCP_RDSIG_SEL_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_SEL_8822C) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8822C) -+#define BITS_WMAC_PLCP_RDSIG_SEL_8822C \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_SEL_8822C \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8822C) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8822C(x) \ -+ ((x) & (~BITS_WMAC_PLCP_RDSIG_SEL_8822C)) -+#define BIT_GET_WMAC_PLCP_RDSIG_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_SEL_8822C) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_SEL_8822C) -+#define BIT_SET_WMAC_PLCP_RDSIG_SEL_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_SEL_8822C(x) | \ -+ BIT_WMAC_PLCP_RDSIG_SEL_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_RATE_IDX_8822C 24 -+#define BIT_MASK_WMAC_RATE_IDX_8822C 0xf -+#define BIT_WMAC_RATE_IDX_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_RATE_IDX_8822C) << BIT_SHIFT_WMAC_RATE_IDX_8822C) -+#define BITS_WMAC_RATE_IDX_8822C \ -+ (BIT_MASK_WMAC_RATE_IDX_8822C << BIT_SHIFT_WMAC_RATE_IDX_8822C) -+#define BIT_CLEAR_WMAC_RATE_IDX_8822C(x) ((x) & (~BITS_WMAC_RATE_IDX_8822C)) -+#define BIT_GET_WMAC_RATE_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_RATE_IDX_8822C) & BIT_MASK_WMAC_RATE_IDX_8822C) -+#define BIT_SET_WMAC_RATE_IDX_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_RATE_IDX_8822C(x) | BIT_WMAC_RATE_IDX_8822C(v)) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_8822C 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG_8822C 0xffffff -+#define BIT_WMAC_PLCP_RDSIG_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_8822C) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_8822C) -+#define BITS_WMAC_PLCP_RDSIG_8822C \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_8822C << BIT_SHIFT_WMAC_PLCP_RDSIG_8822C) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_8822C(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_8822C)) -+#define BIT_GET_WMAC_PLCP_RDSIG_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_8822C) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_8822C) -+#define BIT_SET_WMAC_PLCP_RDSIG_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_8822C(x) | BIT_WMAC_PLCP_RDSIG_8822C(v)) -+ -+/* 2 REG_WMAC_PLCP_MONITOR_MUTX_8822C */ -+#define BIT_WMAC_MUTX_IDX_8822C BIT(24) -+ -+#define BIT_SHIFT_WMAC_PLCP_RDSIG_8822C 0 -+#define BIT_MASK_WMAC_PLCP_RDSIG_8822C 0xffffff -+#define BIT_WMAC_PLCP_RDSIG_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_PLCP_RDSIG_8822C) \ -+ << BIT_SHIFT_WMAC_PLCP_RDSIG_8822C) -+#define BITS_WMAC_PLCP_RDSIG_8822C \ -+ (BIT_MASK_WMAC_PLCP_RDSIG_8822C << BIT_SHIFT_WMAC_PLCP_RDSIG_8822C) -+#define BIT_CLEAR_WMAC_PLCP_RDSIG_8822C(x) ((x) & (~BITS_WMAC_PLCP_RDSIG_8822C)) -+#define BIT_GET_WMAC_PLCP_RDSIG_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PLCP_RDSIG_8822C) & \ -+ BIT_MASK_WMAC_PLCP_RDSIG_8822C) -+#define BIT_SET_WMAC_PLCP_RDSIG_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_PLCP_RDSIG_8822C(x) | BIT_WMAC_PLCP_RDSIG_8822C(v)) -+ -+/* 2 REG_WMAC_CSIDMA_CFG_8822C */ -+ -+#define BIT_SHIFT_CSI_SEG_SIZE_8822C 16 -+#define BIT_MASK_CSI_SEG_SIZE_8822C 0xfff -+#define BIT_CSI_SEG_SIZE_8822C(x) \ -+ (((x) & BIT_MASK_CSI_SEG_SIZE_8822C) << BIT_SHIFT_CSI_SEG_SIZE_8822C) -+#define BITS_CSI_SEG_SIZE_8822C \ -+ (BIT_MASK_CSI_SEG_SIZE_8822C << BIT_SHIFT_CSI_SEG_SIZE_8822C) -+#define BIT_CLEAR_CSI_SEG_SIZE_8822C(x) ((x) & (~BITS_CSI_SEG_SIZE_8822C)) -+#define BIT_GET_CSI_SEG_SIZE_8822C(x) \ -+ (((x) >> BIT_SHIFT_CSI_SEG_SIZE_8822C) & BIT_MASK_CSI_SEG_SIZE_8822C) -+#define BIT_SET_CSI_SEG_SIZE_8822C(x, v) \ -+ (BIT_CLEAR_CSI_SEG_SIZE_8822C(x) | BIT_CSI_SEG_SIZE_8822C(v)) -+ -+#define BIT_SHIFT_CSI_START_PAGE_8822C 0 -+#define BIT_MASK_CSI_START_PAGE_8822C 0xfff -+#define BIT_CSI_START_PAGE_8822C(x) \ -+ (((x) & BIT_MASK_CSI_START_PAGE_8822C) \ -+ << BIT_SHIFT_CSI_START_PAGE_8822C) -+#define BITS_CSI_START_PAGE_8822C \ -+ (BIT_MASK_CSI_START_PAGE_8822C << BIT_SHIFT_CSI_START_PAGE_8822C) -+#define BIT_CLEAR_CSI_START_PAGE_8822C(x) ((x) & (~BITS_CSI_START_PAGE_8822C)) -+#define BIT_GET_CSI_START_PAGE_8822C(x) \ -+ (((x) >> BIT_SHIFT_CSI_START_PAGE_8822C) & \ -+ BIT_MASK_CSI_START_PAGE_8822C) -+#define BIT_SET_CSI_START_PAGE_8822C(x, v) \ -+ (BIT_CLEAR_CSI_START_PAGE_8822C(x) | BIT_CSI_START_PAGE_8822C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_8822C (TA0 REGISTER) */ -+ -+#define BIT_SHIFT_TA0_V1_8822C 0 -+#define BIT_MASK_TA0_V1_8822C 0xffffffffL -+#define BIT_TA0_V1_8822C(x) \ -+ (((x) & BIT_MASK_TA0_V1_8822C) << BIT_SHIFT_TA0_V1_8822C) -+#define BITS_TA0_V1_8822C (BIT_MASK_TA0_V1_8822C << BIT_SHIFT_TA0_V1_8822C) -+#define BIT_CLEAR_TA0_V1_8822C(x) ((x) & (~BITS_TA0_V1_8822C)) -+#define BIT_GET_TA0_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TA0_V1_8822C) & BIT_MASK_TA0_V1_8822C) -+#define BIT_SET_TA0_V1_8822C(x, v) \ -+ (BIT_CLEAR_TA0_V1_8822C(x) | BIT_TA0_V1_8822C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_0_H_8822C (TA0 REGISTER) */ -+ -+#define BIT_SHIFT_TA0_H_V1_8822C 0 -+#define BIT_MASK_TA0_H_V1_8822C 0xffff -+#define BIT_TA0_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_TA0_H_V1_8822C) << BIT_SHIFT_TA0_H_V1_8822C) -+#define BITS_TA0_H_V1_8822C \ -+ (BIT_MASK_TA0_H_V1_8822C << BIT_SHIFT_TA0_H_V1_8822C) -+#define BIT_CLEAR_TA0_H_V1_8822C(x) ((x) & (~BITS_TA0_H_V1_8822C)) -+#define BIT_GET_TA0_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TA0_H_V1_8822C) & BIT_MASK_TA0_H_V1_8822C) -+#define BIT_SET_TA0_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_TA0_H_V1_8822C(x) | BIT_TA0_H_V1_8822C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_8822C (TA1 REGISTER) */ -+ -+#define BIT_SHIFT_TA1_V1_8822C 0 -+#define BIT_MASK_TA1_V1_8822C 0xffffffffL -+#define BIT_TA1_V1_8822C(x) \ -+ (((x) & BIT_MASK_TA1_V1_8822C) << BIT_SHIFT_TA1_V1_8822C) -+#define BITS_TA1_V1_8822C (BIT_MASK_TA1_V1_8822C << BIT_SHIFT_TA1_V1_8822C) -+#define BIT_CLEAR_TA1_V1_8822C(x) ((x) & (~BITS_TA1_V1_8822C)) -+#define BIT_GET_TA1_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TA1_V1_8822C) & BIT_MASK_TA1_V1_8822C) -+#define BIT_SET_TA1_V1_8822C(x, v) \ -+ (BIT_CLEAR_TA1_V1_8822C(x) | BIT_TA1_V1_8822C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_1_H_8822C (TA1 REGISTER) */ -+ -+#define BIT_SHIFT_TA1_H_V1_8822C 0 -+#define BIT_MASK_TA1_H_V1_8822C 0xffff -+#define BIT_TA1_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_TA1_H_V1_8822C) << BIT_SHIFT_TA1_H_V1_8822C) -+#define BITS_TA1_H_V1_8822C \ -+ (BIT_MASK_TA1_H_V1_8822C << BIT_SHIFT_TA1_H_V1_8822C) -+#define BIT_CLEAR_TA1_H_V1_8822C(x) ((x) & (~BITS_TA1_H_V1_8822C)) -+#define BIT_GET_TA1_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TA1_H_V1_8822C) & BIT_MASK_TA1_H_V1_8822C) -+#define BIT_SET_TA1_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_TA1_H_V1_8822C(x) | BIT_TA1_H_V1_8822C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_8822C (TA2 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_V1_8822C 0 -+#define BIT_MASK_TA2_V1_8822C 0xffffffffL -+#define BIT_TA2_V1_8822C(x) \ -+ (((x) & BIT_MASK_TA2_V1_8822C) << BIT_SHIFT_TA2_V1_8822C) -+#define BITS_TA2_V1_8822C (BIT_MASK_TA2_V1_8822C << BIT_SHIFT_TA2_V1_8822C) -+#define BIT_CLEAR_TA2_V1_8822C(x) ((x) & (~BITS_TA2_V1_8822C)) -+#define BIT_GET_TA2_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TA2_V1_8822C) & BIT_MASK_TA2_V1_8822C) -+#define BIT_SET_TA2_V1_8822C(x, v) \ -+ (BIT_CLEAR_TA2_V1_8822C(x) | BIT_TA2_V1_8822C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_2_H_8822C (TA2 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_H_V1_8822C 0 -+#define BIT_MASK_TA2_H_V1_8822C 0xffff -+#define BIT_TA2_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_TA2_H_V1_8822C) << BIT_SHIFT_TA2_H_V1_8822C) -+#define BITS_TA2_H_V1_8822C \ -+ (BIT_MASK_TA2_H_V1_8822C << BIT_SHIFT_TA2_H_V1_8822C) -+#define BIT_CLEAR_TA2_H_V1_8822C(x) ((x) & (~BITS_TA2_H_V1_8822C)) -+#define BIT_GET_TA2_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TA2_H_V1_8822C) & BIT_MASK_TA2_H_V1_8822C) -+#define BIT_SET_TA2_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_TA2_H_V1_8822C(x) | BIT_TA2_H_V1_8822C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_8822C (TA3 REGISTER) */ -+ -+#define BIT_SHIFT_TA2_V1_8822C 0 -+#define BIT_MASK_TA2_V1_8822C 0xffffffffL -+#define BIT_TA2_V1_8822C(x) \ -+ (((x) & BIT_MASK_TA2_V1_8822C) << BIT_SHIFT_TA2_V1_8822C) -+#define BITS_TA2_V1_8822C (BIT_MASK_TA2_V1_8822C << BIT_SHIFT_TA2_V1_8822C) -+#define BIT_CLEAR_TA2_V1_8822C(x) ((x) & (~BITS_TA2_V1_8822C)) -+#define BIT_GET_TA2_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TA2_V1_8822C) & BIT_MASK_TA2_V1_8822C) -+#define BIT_SET_TA2_V1_8822C(x, v) \ -+ (BIT_CLEAR_TA2_V1_8822C(x) | BIT_TA2_V1_8822C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_3_H_8822C (TA3 REGISTER) */ -+ -+#define BIT_SHIFT_TA3_H_V1_8822C 0 -+#define BIT_MASK_TA3_H_V1_8822C 0xffff -+#define BIT_TA3_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_TA3_H_V1_8822C) << BIT_SHIFT_TA3_H_V1_8822C) -+#define BITS_TA3_H_V1_8822C \ -+ (BIT_MASK_TA3_H_V1_8822C << BIT_SHIFT_TA3_H_V1_8822C) -+#define BIT_CLEAR_TA3_H_V1_8822C(x) ((x) & (~BITS_TA3_H_V1_8822C)) -+#define BIT_GET_TA3_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TA3_H_V1_8822C) & BIT_MASK_TA3_H_V1_8822C) -+#define BIT_SET_TA3_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_TA3_H_V1_8822C(x) | BIT_TA3_H_V1_8822C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_8822C (TA4 REGISTER) */ -+ -+#define BIT_SHIFT_TA4_V1_8822C 0 -+#define BIT_MASK_TA4_V1_8822C 0xffffffffL -+#define BIT_TA4_V1_8822C(x) \ -+ (((x) & BIT_MASK_TA4_V1_8822C) << BIT_SHIFT_TA4_V1_8822C) -+#define BITS_TA4_V1_8822C (BIT_MASK_TA4_V1_8822C << BIT_SHIFT_TA4_V1_8822C) -+#define BIT_CLEAR_TA4_V1_8822C(x) ((x) & (~BITS_TA4_V1_8822C)) -+#define BIT_GET_TA4_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TA4_V1_8822C) & BIT_MASK_TA4_V1_8822C) -+#define BIT_SET_TA4_V1_8822C(x, v) \ -+ (BIT_CLEAR_TA4_V1_8822C(x) | BIT_TA4_V1_8822C(v)) -+ -+/* 2 REG_TRANSMIT_ADDRSS_4_H_8822C (TA4 REGISTER) */ -+ -+#define BIT_SHIFT_TA4_H_V1_8822C 0 -+#define BIT_MASK_TA4_H_V1_8822C 0xffff -+#define BIT_TA4_H_V1_8822C(x) \ -+ (((x) & BIT_MASK_TA4_H_V1_8822C) << BIT_SHIFT_TA4_H_V1_8822C) -+#define BITS_TA4_H_V1_8822C \ -+ (BIT_MASK_TA4_H_V1_8822C << BIT_SHIFT_TA4_H_V1_8822C) -+#define BIT_CLEAR_TA4_H_V1_8822C(x) ((x) & (~BITS_TA4_H_V1_8822C)) -+#define BIT_GET_TA4_H_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TA4_H_V1_8822C) & BIT_MASK_TA4_H_V1_8822C) -+#define BIT_SET_TA4_H_V1_8822C(x, v) \ -+ (BIT_CLEAR_TA4_H_V1_8822C(x) | BIT_TA4_H_V1_8822C(v)) -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_RSVD_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_MACID1_8822C */ -+ -+#define BIT_SHIFT_MACID1_0_8822C 0 -+#define BIT_MASK_MACID1_0_8822C 0xffffffffL -+#define BIT_MACID1_0_8822C(x) \ -+ (((x) & BIT_MASK_MACID1_0_8822C) << BIT_SHIFT_MACID1_0_8822C) -+#define BITS_MACID1_0_8822C \ -+ (BIT_MASK_MACID1_0_8822C << BIT_SHIFT_MACID1_0_8822C) -+#define BIT_CLEAR_MACID1_0_8822C(x) ((x) & (~BITS_MACID1_0_8822C)) -+#define BIT_GET_MACID1_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID1_0_8822C) & BIT_MASK_MACID1_0_8822C) -+#define BIT_SET_MACID1_0_8822C(x, v) \ -+ (BIT_CLEAR_MACID1_0_8822C(x) | BIT_MACID1_0_8822C(v)) -+ -+/* 2 REG_MACID1_1_8822C */ -+ -+#define BIT_SHIFT_MACID1_1_8822C 0 -+#define BIT_MASK_MACID1_1_8822C 0xffff -+#define BIT_MACID1_1_8822C(x) \ -+ (((x) & BIT_MASK_MACID1_1_8822C) << BIT_SHIFT_MACID1_1_8822C) -+#define BITS_MACID1_1_8822C \ -+ (BIT_MASK_MACID1_1_8822C << BIT_SHIFT_MACID1_1_8822C) -+#define BIT_CLEAR_MACID1_1_8822C(x) ((x) & (~BITS_MACID1_1_8822C)) -+#define BIT_GET_MACID1_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MACID1_1_8822C) & BIT_MASK_MACID1_1_8822C) -+#define BIT_SET_MACID1_1_8822C(x, v) \ -+ (BIT_CLEAR_MACID1_1_8822C(x) | BIT_MACID1_1_8822C(v)) -+ -+/* 2 REG_BSSID1_8822C */ -+ -+#define BIT_SHIFT_BSSID1_0_8822C 0 -+#define BIT_MASK_BSSID1_0_8822C 0xffffffffL -+#define BIT_BSSID1_0_8822C(x) \ -+ (((x) & BIT_MASK_BSSID1_0_8822C) << BIT_SHIFT_BSSID1_0_8822C) -+#define BITS_BSSID1_0_8822C \ -+ (BIT_MASK_BSSID1_0_8822C << BIT_SHIFT_BSSID1_0_8822C) -+#define BIT_CLEAR_BSSID1_0_8822C(x) ((x) & (~BITS_BSSID1_0_8822C)) -+#define BIT_GET_BSSID1_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID1_0_8822C) & BIT_MASK_BSSID1_0_8822C) -+#define BIT_SET_BSSID1_0_8822C(x, v) \ -+ (BIT_CLEAR_BSSID1_0_8822C(x) | BIT_BSSID1_0_8822C(v)) -+ -+/* 2 REG_BSSID1_1_8822C */ -+ -+#define BIT_SHIFT_BSSID1_1_8822C 0 -+#define BIT_MASK_BSSID1_1_8822C 0xffff -+#define BIT_BSSID1_1_8822C(x) \ -+ (((x) & BIT_MASK_BSSID1_1_8822C) << BIT_SHIFT_BSSID1_1_8822C) -+#define BITS_BSSID1_1_8822C \ -+ (BIT_MASK_BSSID1_1_8822C << BIT_SHIFT_BSSID1_1_8822C) -+#define BIT_CLEAR_BSSID1_1_8822C(x) ((x) & (~BITS_BSSID1_1_8822C)) -+#define BIT_GET_BSSID1_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BSSID1_1_8822C) & BIT_MASK_BSSID1_1_8822C) -+#define BIT_SET_BSSID1_1_8822C(x, v) \ -+ (BIT_CLEAR_BSSID1_1_8822C(x) | BIT_BSSID1_1_8822C(v)) -+ -+/* 2 REG_BCN_PSR_RPT1_8822C */ -+ -+#define BIT_SHIFT_DTIM_CNT1_8822C 24 -+#define BIT_MASK_DTIM_CNT1_8822C 0xff -+#define BIT_DTIM_CNT1_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_CNT1_8822C) << BIT_SHIFT_DTIM_CNT1_8822C) -+#define BITS_DTIM_CNT1_8822C \ -+ (BIT_MASK_DTIM_CNT1_8822C << BIT_SHIFT_DTIM_CNT1_8822C) -+#define BIT_CLEAR_DTIM_CNT1_8822C(x) ((x) & (~BITS_DTIM_CNT1_8822C)) -+#define BIT_GET_DTIM_CNT1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_CNT1_8822C) & BIT_MASK_DTIM_CNT1_8822C) -+#define BIT_SET_DTIM_CNT1_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_CNT1_8822C(x) | BIT_DTIM_CNT1_8822C(v)) -+ -+#define BIT_SHIFT_DTIM_PERIOD1_8822C 16 -+#define BIT_MASK_DTIM_PERIOD1_8822C 0xff -+#define BIT_DTIM_PERIOD1_8822C(x) \ -+ (((x) & BIT_MASK_DTIM_PERIOD1_8822C) << BIT_SHIFT_DTIM_PERIOD1_8822C) -+#define BITS_DTIM_PERIOD1_8822C \ -+ (BIT_MASK_DTIM_PERIOD1_8822C << BIT_SHIFT_DTIM_PERIOD1_8822C) -+#define BIT_CLEAR_DTIM_PERIOD1_8822C(x) ((x) & (~BITS_DTIM_PERIOD1_8822C)) -+#define BIT_GET_DTIM_PERIOD1_8822C(x) \ -+ (((x) >> BIT_SHIFT_DTIM_PERIOD1_8822C) & BIT_MASK_DTIM_PERIOD1_8822C) -+#define BIT_SET_DTIM_PERIOD1_8822C(x, v) \ -+ (BIT_CLEAR_DTIM_PERIOD1_8822C(x) | BIT_DTIM_PERIOD1_8822C(v)) -+ -+#define BIT_DTIM1_8822C BIT(15) -+#define BIT_TIM1_8822C BIT(14) -+#define BIT_BCN_VALID_V2_8822C BIT(13) -+ -+#define BIT_SHIFT_PS_AID_1_8822C 0 -+#define BIT_MASK_PS_AID_1_8822C 0x7ff -+#define BIT_PS_AID_1_8822C(x) \ -+ (((x) & BIT_MASK_PS_AID_1_8822C) << BIT_SHIFT_PS_AID_1_8822C) -+#define BITS_PS_AID_1_8822C \ -+ (BIT_MASK_PS_AID_1_8822C << BIT_SHIFT_PS_AID_1_8822C) -+#define BIT_CLEAR_PS_AID_1_8822C(x) ((x) & (~BITS_PS_AID_1_8822C)) -+#define BIT_GET_PS_AID_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PS_AID_1_8822C) & BIT_MASK_PS_AID_1_8822C) -+#define BIT_SET_PS_AID_1_8822C(x, v) \ -+ (BIT_CLEAR_PS_AID_1_8822C(x) | BIT_PS_AID_1_8822C(v)) -+ -+/* 2 REG_ASSOCIATED_BFMEE_SEL_8822C */ -+#define BIT_TXUSER_ID1_8822C BIT(25) -+ -+#define BIT_SHIFT_AID1_8822C 16 -+#define BIT_MASK_AID1_8822C 0x1ff -+#define BIT_AID1_8822C(x) (((x) & BIT_MASK_AID1_8822C) << BIT_SHIFT_AID1_8822C) -+#define BITS_AID1_8822C (BIT_MASK_AID1_8822C << BIT_SHIFT_AID1_8822C) -+#define BIT_CLEAR_AID1_8822C(x) ((x) & (~BITS_AID1_8822C)) -+#define BIT_GET_AID1_8822C(x) \ -+ (((x) >> BIT_SHIFT_AID1_8822C) & BIT_MASK_AID1_8822C) -+#define BIT_SET_AID1_8822C(x, v) (BIT_CLEAR_AID1_8822C(x) | BIT_AID1_8822C(v)) -+ -+#define BIT_TXUSER_ID0_8822C BIT(9) -+ -+#define BIT_SHIFT_AID0_8822C 0 -+#define BIT_MASK_AID0_8822C 0x1ff -+#define BIT_AID0_8822C(x) (((x) & BIT_MASK_AID0_8822C) << BIT_SHIFT_AID0_8822C) -+#define BITS_AID0_8822C (BIT_MASK_AID0_8822C << BIT_SHIFT_AID0_8822C) -+#define BIT_CLEAR_AID0_8822C(x) ((x) & (~BITS_AID0_8822C)) -+#define BIT_GET_AID0_8822C(x) \ -+ (((x) >> BIT_SHIFT_AID0_8822C) & BIT_MASK_AID0_8822C) -+#define BIT_SET_AID0_8822C(x, v) (BIT_CLEAR_AID0_8822C(x) | BIT_AID0_8822C(v)) -+ -+/* 2 REG_SND_PTCL_CTRL_8822C */ -+ -+#define BIT_SHIFT_NDP_RX_STANDBY_TIMER_8822C 24 -+#define BIT_MASK_NDP_RX_STANDBY_TIMER_8822C 0xff -+#define BIT_NDP_RX_STANDBY_TIMER_8822C(x) \ -+ (((x) & BIT_MASK_NDP_RX_STANDBY_TIMER_8822C) \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8822C) -+#define BITS_NDP_RX_STANDBY_TIMER_8822C \ -+ (BIT_MASK_NDP_RX_STANDBY_TIMER_8822C \ -+ << BIT_SHIFT_NDP_RX_STANDBY_TIMER_8822C) -+#define BIT_CLEAR_NDP_RX_STANDBY_TIMER_8822C(x) \ -+ ((x) & (~BITS_NDP_RX_STANDBY_TIMER_8822C)) -+#define BIT_GET_NDP_RX_STANDBY_TIMER_8822C(x) \ -+ (((x) >> BIT_SHIFT_NDP_RX_STANDBY_TIMER_8822C) & \ -+ BIT_MASK_NDP_RX_STANDBY_TIMER_8822C) -+#define BIT_SET_NDP_RX_STANDBY_TIMER_8822C(x, v) \ -+ (BIT_CLEAR_NDP_RX_STANDBY_TIMER_8822C(x) | \ -+ BIT_NDP_RX_STANDBY_TIMER_8822C(v)) -+ -+#define BIT_R_WMAC_CHK_RPTPOLL_A2_DIS_8822C BIT(23) -+#define BIT_R_WMAC_CHK_UCNDPA_A2_DIS_8822C BIT(22) -+ -+#define BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8822C 16 -+#define BIT_MASK_CSI_RPT_OFFSET_HT_V1_8822C 0x3f -+#define BIT_CSI_RPT_OFFSET_HT_V1_8822C(x) \ -+ (((x) & BIT_MASK_CSI_RPT_OFFSET_HT_V1_8822C) \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8822C) -+#define BITS_CSI_RPT_OFFSET_HT_V1_8822C \ -+ (BIT_MASK_CSI_RPT_OFFSET_HT_V1_8822C \ -+ << BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8822C) -+#define BIT_CLEAR_CSI_RPT_OFFSET_HT_V1_8822C(x) \ -+ ((x) & (~BITS_CSI_RPT_OFFSET_HT_V1_8822C)) -+#define BIT_GET_CSI_RPT_OFFSET_HT_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_CSI_RPT_OFFSET_HT_V1_8822C) & \ -+ BIT_MASK_CSI_RPT_OFFSET_HT_V1_8822C) -+#define BIT_SET_CSI_RPT_OFFSET_HT_V1_8822C(x, v) \ -+ (BIT_CLEAR_CSI_RPT_OFFSET_HT_V1_8822C(x) | \ -+ BIT_CSI_RPT_OFFSET_HT_V1_8822C(v)) -+ -+#define BIT_R_WMAC_OFFSET_RPTPOLL_EN_8822C BIT(15) -+#define BIT_R_WMAC_CSI_CHKSUM_DIS_8822C BIT(14) -+ -+#define BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1_8822C 8 -+#define BIT_MASK_R_WMAC_VHT_CATEGORY_V1_8822C 0x3f -+#define BIT_R_WMAC_VHT_CATEGORY_V1_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_VHT_CATEGORY_V1_8822C) \ -+ << BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1_8822C) -+#define BITS_R_WMAC_VHT_CATEGORY_V1_8822C \ -+ (BIT_MASK_R_WMAC_VHT_CATEGORY_V1_8822C \ -+ << BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1_8822C) -+#define BIT_CLEAR_R_WMAC_VHT_CATEGORY_V1_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_VHT_CATEGORY_V1_8822C)) -+#define BIT_GET_R_WMAC_VHT_CATEGORY_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_VHT_CATEGORY_V1_8822C) & \ -+ BIT_MASK_R_WMAC_VHT_CATEGORY_V1_8822C) -+#define BIT_SET_R_WMAC_VHT_CATEGORY_V1_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_VHT_CATEGORY_V1_8822C(x) | \ -+ BIT_R_WMAC_VHT_CATEGORY_V1_8822C(v)) -+ -+#define BIT_R_WMAC_USE_NSTS_8822C BIT(7) -+#define BIT_R_DISABLE_CHECK_VHTSIGB_CRC_8822C BIT(6) -+#define BIT_R_DISABLE_CHECK_VHTSIGA_CRC_8822C BIT(5) -+#define BIT_R_WMAC_BFPARAM_SEL_8822C BIT(4) -+#define BIT_R_WMAC_CSISEQ_SEL_8822C BIT(3) -+#define BIT_R_WMAC_CSI_WITHHTC_EN_8822C BIT(2) -+#define BIT_R_WMAC_HT_NDPA_EN_8822C BIT(1) -+#define BIT_R_WMAC_VHT_NDPA_EN_8822C BIT(0) -+ -+/* 2 REG_RX_CSI_RPT_INFO_8822C */ -+#define BIT_WRITE_ENABLE_8822C BIT(31) -+#define BIT_WMAC_CHECK_SOUNDING_SEQ_8822C BIT(30) -+ -+#define BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8822C 1 -+#define BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8822C 0xffffff -+#define BIT_VHTHT_MIMO_CTRL_FIELD_8822C(x) \ -+ (((x) & BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8822C) \ -+ << BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8822C) -+#define BITS_VHTHT_MIMO_CTRL_FIELD_8822C \ -+ (BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8822C \ -+ << BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8822C) -+#define BIT_CLEAR_VHTHT_MIMO_CTRL_FIELD_8822C(x) \ -+ ((x) & (~BITS_VHTHT_MIMO_CTRL_FIELD_8822C)) -+#define BIT_GET_VHTHT_MIMO_CTRL_FIELD_8822C(x) \ -+ (((x) >> BIT_SHIFT_VHTHT_MIMO_CTRL_FIELD_8822C) & \ -+ BIT_MASK_VHTHT_MIMO_CTRL_FIELD_8822C) -+#define BIT_SET_VHTHT_MIMO_CTRL_FIELD_8822C(x, v) \ -+ (BIT_CLEAR_VHTHT_MIMO_CTRL_FIELD_8822C(x) | \ -+ BIT_VHTHT_MIMO_CTRL_FIELD_8822C(v)) -+ -+#define BIT_CSI_INTERRUPT_STATUS_8822C BIT(0) -+ -+/* 2 REG_NS_ARP_CTRL_8822C */ -+#define BIT_R_WMAC_NSARP_RSPEN_8822C BIT(15) -+#define BIT_R_WMAC_NSARP_RARP_8822C BIT(9) -+#define BIT_R_WMAC_NSARP_RIPV6_8822C BIT(8) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_MODEN_8822C 6 -+#define BIT_MASK_R_WMAC_NSARP_MODEN_8822C 0x3 -+#define BIT_R_WMAC_NSARP_MODEN_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_MODEN_8822C) \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8822C) -+#define BITS_R_WMAC_NSARP_MODEN_8822C \ -+ (BIT_MASK_R_WMAC_NSARP_MODEN_8822C \ -+ << BIT_SHIFT_R_WMAC_NSARP_MODEN_8822C) -+#define BIT_CLEAR_R_WMAC_NSARP_MODEN_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_MODEN_8822C)) -+#define BIT_GET_R_WMAC_NSARP_MODEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_MODEN_8822C) & \ -+ BIT_MASK_R_WMAC_NSARP_MODEN_8822C) -+#define BIT_SET_R_WMAC_NSARP_MODEN_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_MODEN_8822C(x) | \ -+ BIT_R_WMAC_NSARP_MODEN_8822C(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8822C 4 -+#define BIT_MASK_R_WMAC_NSARP_RSPFTP_8822C 0x3 -+#define BIT_R_WMAC_NSARP_RSPFTP_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPFTP_8822C) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8822C) -+#define BITS_R_WMAC_NSARP_RSPFTP_8822C \ -+ (BIT_MASK_R_WMAC_NSARP_RSPFTP_8822C \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8822C) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPFTP_8822C)) -+#define BIT_GET_R_WMAC_NSARP_RSPFTP_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPFTP_8822C) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPFTP_8822C) -+#define BIT_SET_R_WMAC_NSARP_RSPFTP_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPFTP_8822C(x) | \ -+ BIT_R_WMAC_NSARP_RSPFTP_8822C(v)) -+ -+#define BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8822C 0 -+#define BIT_MASK_R_WMAC_NSARP_RSPSEC_8822C 0xf -+#define BIT_R_WMAC_NSARP_RSPSEC_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_NSARP_RSPSEC_8822C) \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8822C) -+#define BITS_R_WMAC_NSARP_RSPSEC_8822C \ -+ (BIT_MASK_R_WMAC_NSARP_RSPSEC_8822C \ -+ << BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8822C) -+#define BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_NSARP_RSPSEC_8822C)) -+#define BIT_GET_R_WMAC_NSARP_RSPSEC_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_NSARP_RSPSEC_8822C) & \ -+ BIT_MASK_R_WMAC_NSARP_RSPSEC_8822C) -+#define BIT_SET_R_WMAC_NSARP_RSPSEC_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_NSARP_RSPSEC_8822C(x) | \ -+ BIT_R_WMAC_NSARP_RSPSEC_8822C(v)) -+ -+/* 2 REG_NS_ARP_INFO_8822C */ -+#define BIT_REQ_IS_MCNS_8822C BIT(23) -+#define BIT_REQ_IS_UCNS_8822C BIT(22) -+#define BIT_REQ_IS_USNS_8822C BIT(21) -+#define BIT_REQ_IS_ARP_8822C BIT(20) -+#define BIT_EXPRSP_MH_WITHQC_8822C BIT(19) -+ -+#define BIT_SHIFT_EXPRSP_SECTYPE_8822C 16 -+#define BIT_MASK_EXPRSP_SECTYPE_8822C 0x7 -+#define BIT_EXPRSP_SECTYPE_8822C(x) \ -+ (((x) & BIT_MASK_EXPRSP_SECTYPE_8822C) \ -+ << BIT_SHIFT_EXPRSP_SECTYPE_8822C) -+#define BITS_EXPRSP_SECTYPE_8822C \ -+ (BIT_MASK_EXPRSP_SECTYPE_8822C << BIT_SHIFT_EXPRSP_SECTYPE_8822C) -+#define BIT_CLEAR_EXPRSP_SECTYPE_8822C(x) ((x) & (~BITS_EXPRSP_SECTYPE_8822C)) -+#define BIT_GET_EXPRSP_SECTYPE_8822C(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_SECTYPE_8822C) & \ -+ BIT_MASK_EXPRSP_SECTYPE_8822C) -+#define BIT_SET_EXPRSP_SECTYPE_8822C(x, v) \ -+ (BIT_CLEAR_EXPRSP_SECTYPE_8822C(x) | BIT_EXPRSP_SECTYPE_8822C(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8822C 8 -+#define BIT_MASK_EXPRSP_CHKSM_7_TO_0_8822C 0xff -+#define BIT_EXPRSP_CHKSM_7_TO_0_8822C(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_7_TO_0_8822C) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8822C) -+#define BITS_EXPRSP_CHKSM_7_TO_0_8822C \ -+ (BIT_MASK_EXPRSP_CHKSM_7_TO_0_8822C \ -+ << BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8822C) -+#define BIT_CLEAR_EXPRSP_CHKSM_7_TO_0_8822C(x) \ -+ ((x) & (~BITS_EXPRSP_CHKSM_7_TO_0_8822C)) -+#define BIT_GET_EXPRSP_CHKSM_7_TO_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_7_TO_0_8822C) & \ -+ BIT_MASK_EXPRSP_CHKSM_7_TO_0_8822C) -+#define BIT_SET_EXPRSP_CHKSM_7_TO_0_8822C(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_7_TO_0_8822C(x) | \ -+ BIT_EXPRSP_CHKSM_7_TO_0_8822C(v)) -+ -+#define BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8822C 0 -+#define BIT_MASK_EXPRSP_CHKSM_15_TO_8_8822C 0xff -+#define BIT_EXPRSP_CHKSM_15_TO_8_8822C(x) \ -+ (((x) & BIT_MASK_EXPRSP_CHKSM_15_TO_8_8822C) \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8822C) -+#define BITS_EXPRSP_CHKSM_15_TO_8_8822C \ -+ (BIT_MASK_EXPRSP_CHKSM_15_TO_8_8822C \ -+ << BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8822C) -+#define BIT_CLEAR_EXPRSP_CHKSM_15_TO_8_8822C(x) \ -+ ((x) & (~BITS_EXPRSP_CHKSM_15_TO_8_8822C)) -+#define BIT_GET_EXPRSP_CHKSM_15_TO_8_8822C(x) \ -+ (((x) >> BIT_SHIFT_EXPRSP_CHKSM_15_TO_8_8822C) & \ -+ BIT_MASK_EXPRSP_CHKSM_15_TO_8_8822C) -+#define BIT_SET_EXPRSP_CHKSM_15_TO_8_8822C(x, v) \ -+ (BIT_CLEAR_EXPRSP_CHKSM_15_TO_8_8822C(x) | \ -+ BIT_EXPRSP_CHKSM_15_TO_8_8822C(v)) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_V1_8822C */ -+ -+#define BIT_SHIFT_WMAC_ARPIP_8822C 0 -+#define BIT_MASK_WMAC_ARPIP_8822C 0xffffffffL -+#define BIT_WMAC_ARPIP_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_ARPIP_8822C) << BIT_SHIFT_WMAC_ARPIP_8822C) -+#define BITS_WMAC_ARPIP_8822C \ -+ (BIT_MASK_WMAC_ARPIP_8822C << BIT_SHIFT_WMAC_ARPIP_8822C) -+#define BIT_CLEAR_WMAC_ARPIP_8822C(x) ((x) & (~BITS_WMAC_ARPIP_8822C)) -+#define BIT_GET_WMAC_ARPIP_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_ARPIP_8822C) & BIT_MASK_WMAC_ARPIP_8822C) -+#define BIT_SET_WMAC_ARPIP_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_ARPIP_8822C(x) | BIT_WMAC_ARPIP_8822C(v)) -+ -+/* 2 REG_BEAMFORMING_INFO_NSARP_8822C */ -+ -+#define BIT_SHIFT_UPD_BFMEE_USERID_8822C 13 -+#define BIT_MASK_UPD_BFMEE_USERID_8822C 0x7 -+#define BIT_UPD_BFMEE_USERID_8822C(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_USERID_8822C) \ -+ << BIT_SHIFT_UPD_BFMEE_USERID_8822C) -+#define BITS_UPD_BFMEE_USERID_8822C \ -+ (BIT_MASK_UPD_BFMEE_USERID_8822C << BIT_SHIFT_UPD_BFMEE_USERID_8822C) -+#define BIT_CLEAR_UPD_BFMEE_USERID_8822C(x) \ -+ ((x) & (~BITS_UPD_BFMEE_USERID_8822C)) -+#define BIT_GET_UPD_BFMEE_USERID_8822C(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_USERID_8822C) & \ -+ BIT_MASK_UPD_BFMEE_USERID_8822C) -+#define BIT_SET_UPD_BFMEE_USERID_8822C(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_USERID_8822C(x) | BIT_UPD_BFMEE_USERID_8822C(v)) -+ -+#define BIT_UPD_BFMEE_FBTP_8822C BIT(12) -+ -+#define BIT_SHIFT_UPD_BFMEE_BW_8822C 0 -+#define BIT_MASK_UPD_BFMEE_BW_8822C 0xfff -+#define BIT_UPD_BFMEE_BW_8822C(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_BW_8822C) << BIT_SHIFT_UPD_BFMEE_BW_8822C) -+#define BITS_UPD_BFMEE_BW_8822C \ -+ (BIT_MASK_UPD_BFMEE_BW_8822C << BIT_SHIFT_UPD_BFMEE_BW_8822C) -+#define BIT_CLEAR_UPD_BFMEE_BW_8822C(x) ((x) & (~BITS_UPD_BFMEE_BW_8822C)) -+#define BIT_GET_UPD_BFMEE_BW_8822C(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_BW_8822C) & BIT_MASK_UPD_BFMEE_BW_8822C) -+#define BIT_SET_UPD_BFMEE_BW_8822C(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_BW_8822C(x) | BIT_UPD_BFMEE_BW_8822C(v)) -+ -+#define BIT_SHIFT_UPD_BFMEE_CB_8822C 8 -+#define BIT_MASK_UPD_BFMEE_CB_8822C 0x3 -+#define BIT_UPD_BFMEE_CB_8822C(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_CB_8822C) << BIT_SHIFT_UPD_BFMEE_CB_8822C) -+#define BITS_UPD_BFMEE_CB_8822C \ -+ (BIT_MASK_UPD_BFMEE_CB_8822C << BIT_SHIFT_UPD_BFMEE_CB_8822C) -+#define BIT_CLEAR_UPD_BFMEE_CB_8822C(x) ((x) & (~BITS_UPD_BFMEE_CB_8822C)) -+#define BIT_GET_UPD_BFMEE_CB_8822C(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_CB_8822C) & BIT_MASK_UPD_BFMEE_CB_8822C) -+#define BIT_SET_UPD_BFMEE_CB_8822C(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_CB_8822C(x) | BIT_UPD_BFMEE_CB_8822C(v)) -+ -+#define BIT_SHIFT_UPD_BFMEE_NG_8822C 6 -+#define BIT_MASK_UPD_BFMEE_NG_8822C 0x3 -+#define BIT_UPD_BFMEE_NG_8822C(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_NG_8822C) << BIT_SHIFT_UPD_BFMEE_NG_8822C) -+#define BITS_UPD_BFMEE_NG_8822C \ -+ (BIT_MASK_UPD_BFMEE_NG_8822C << BIT_SHIFT_UPD_BFMEE_NG_8822C) -+#define BIT_CLEAR_UPD_BFMEE_NG_8822C(x) ((x) & (~BITS_UPD_BFMEE_NG_8822C)) -+#define BIT_GET_UPD_BFMEE_NG_8822C(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_NG_8822C) & BIT_MASK_UPD_BFMEE_NG_8822C) -+#define BIT_SET_UPD_BFMEE_NG_8822C(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_NG_8822C(x) | BIT_UPD_BFMEE_NG_8822C(v)) -+ -+#define BIT_SHIFT_UPD_BFMEE_NR_8822C 3 -+#define BIT_MASK_UPD_BFMEE_NR_8822C 0x7 -+#define BIT_UPD_BFMEE_NR_8822C(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_NR_8822C) << BIT_SHIFT_UPD_BFMEE_NR_8822C) -+#define BITS_UPD_BFMEE_NR_8822C \ -+ (BIT_MASK_UPD_BFMEE_NR_8822C << BIT_SHIFT_UPD_BFMEE_NR_8822C) -+#define BIT_CLEAR_UPD_BFMEE_NR_8822C(x) ((x) & (~BITS_UPD_BFMEE_NR_8822C)) -+#define BIT_GET_UPD_BFMEE_NR_8822C(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_NR_8822C) & BIT_MASK_UPD_BFMEE_NR_8822C) -+#define BIT_SET_UPD_BFMEE_NR_8822C(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_NR_8822C(x) | BIT_UPD_BFMEE_NR_8822C(v)) -+ -+#define BIT_SHIFT_UPD_BFMEE_NC_8822C 0 -+#define BIT_MASK_UPD_BFMEE_NC_8822C 0x7 -+#define BIT_UPD_BFMEE_NC_8822C(x) \ -+ (((x) & BIT_MASK_UPD_BFMEE_NC_8822C) << BIT_SHIFT_UPD_BFMEE_NC_8822C) -+#define BITS_UPD_BFMEE_NC_8822C \ -+ (BIT_MASK_UPD_BFMEE_NC_8822C << BIT_SHIFT_UPD_BFMEE_NC_8822C) -+#define BIT_CLEAR_UPD_BFMEE_NC_8822C(x) ((x) & (~BITS_UPD_BFMEE_NC_8822C)) -+#define BIT_GET_UPD_BFMEE_NC_8822C(x) \ -+ (((x) >> BIT_SHIFT_UPD_BFMEE_NC_8822C) & BIT_MASK_UPD_BFMEE_NC_8822C) -+#define BIT_SET_UPD_BFMEE_NC_8822C(x, v) \ -+ (BIT_CLEAR_UPD_BFMEE_NC_8822C(x) | BIT_UPD_BFMEE_NC_8822C(v)) -+ -+/* 2 REG_IPV6_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8822C 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8822C 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_0_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8822C) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8822C) -+#define BITS_R_WMAC_IPV6_MYIPAD_0_8822C \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8822C \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8822C) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_0_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_0_8822C)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_0_8822C) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_0_8822C) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_0_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_0_8822C(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_0_8822C(v)) -+ -+/* 2 REG_IPV6_1_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8822C 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8822C 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_1_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8822C) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8822C) -+#define BITS_R_WMAC_IPV6_MYIPAD_1_8822C \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8822C \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8822C) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_1_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_1_8822C)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_1_8822C) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_1_8822C) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_1_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_1_8822C(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_1_8822C(v)) -+ -+/* 2 REG_IPV6_2_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8822C 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8822C 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_2_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8822C) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8822C) -+#define BITS_R_WMAC_IPV6_MYIPAD_2_8822C \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8822C \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8822C) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_2_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_2_8822C)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_2_8822C) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_2_8822C) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_2_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_2_8822C(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_2_8822C(v)) -+ -+/* 2 REG_IPV6_3_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8822C 0 -+#define BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8822C 0xffffffffL -+#define BIT_R_WMAC_IPV6_MYIPAD_3_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8822C) \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8822C) -+#define BITS_R_WMAC_IPV6_MYIPAD_3_8822C \ -+ (BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8822C \ -+ << BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8822C) -+#define BIT_CLEAR_R_WMAC_IPV6_MYIPAD_3_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_IPV6_MYIPAD_3_8822C)) -+#define BIT_GET_R_WMAC_IPV6_MYIPAD_3_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_IPV6_MYIPAD_3_8822C) & \ -+ BIT_MASK_R_WMAC_IPV6_MYIPAD_3_8822C) -+#define BIT_SET_R_WMAC_IPV6_MYIPAD_3_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_IPV6_MYIPAD_3_8822C(x) | \ -+ BIT_R_WMAC_IPV6_MYIPAD_3_8822C(v)) -+ -+/* 2 REG_WMAC_RTX_CTX_SUBTYPE_CFG_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8822C 4 -+#define BIT_MASK_R_WMAC_CTX_SUBTYPE_8822C 0xf -+#define BIT_R_WMAC_CTX_SUBTYPE_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_CTX_SUBTYPE_8822C) \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8822C) -+#define BITS_R_WMAC_CTX_SUBTYPE_8822C \ -+ (BIT_MASK_R_WMAC_CTX_SUBTYPE_8822C \ -+ << BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8822C) -+#define BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_CTX_SUBTYPE_8822C)) -+#define BIT_GET_R_WMAC_CTX_SUBTYPE_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_CTX_SUBTYPE_8822C) & \ -+ BIT_MASK_R_WMAC_CTX_SUBTYPE_8822C) -+#define BIT_SET_R_WMAC_CTX_SUBTYPE_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_CTX_SUBTYPE_8822C(x) | \ -+ BIT_R_WMAC_CTX_SUBTYPE_8822C(v)) -+ -+#define BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8822C 0 -+#define BIT_MASK_R_WMAC_RTX_SUBTYPE_8822C 0xf -+#define BIT_R_WMAC_RTX_SUBTYPE_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_RTX_SUBTYPE_8822C) \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8822C) -+#define BITS_R_WMAC_RTX_SUBTYPE_8822C \ -+ (BIT_MASK_R_WMAC_RTX_SUBTYPE_8822C \ -+ << BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8822C) -+#define BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_RTX_SUBTYPE_8822C)) -+#define BIT_GET_R_WMAC_RTX_SUBTYPE_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RTX_SUBTYPE_8822C) & \ -+ BIT_MASK_R_WMAC_RTX_SUBTYPE_8822C) -+#define BIT_SET_R_WMAC_RTX_SUBTYPE_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_RTX_SUBTYPE_8822C(x) | \ -+ BIT_R_WMAC_RTX_SUBTYPE_8822C(v)) -+ -+/* 2 REG_WMAC_SWAES_DIO_B63_B32_8822C */ -+ -+#define BIT_SHIFT_WMAC_SWAES_DIO_B63_B32_8822C 0 -+#define BIT_MASK_WMAC_SWAES_DIO_B63_B32_8822C 0xffffffffL -+#define BIT_WMAC_SWAES_DIO_B63_B32_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_SWAES_DIO_B63_B32_8822C) \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B63_B32_8822C) -+#define BITS_WMAC_SWAES_DIO_B63_B32_8822C \ -+ (BIT_MASK_WMAC_SWAES_DIO_B63_B32_8822C \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B63_B32_8822C) -+#define BIT_CLEAR_WMAC_SWAES_DIO_B63_B32_8822C(x) \ -+ ((x) & (~BITS_WMAC_SWAES_DIO_B63_B32_8822C)) -+#define BIT_GET_WMAC_SWAES_DIO_B63_B32_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SWAES_DIO_B63_B32_8822C) & \ -+ BIT_MASK_WMAC_SWAES_DIO_B63_B32_8822C) -+#define BIT_SET_WMAC_SWAES_DIO_B63_B32_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_SWAES_DIO_B63_B32_8822C(x) | \ -+ BIT_WMAC_SWAES_DIO_B63_B32_8822C(v)) -+ -+/* 2 REG_WMAC_SWAES_DIO_B95_B64_8822C */ -+ -+#define BIT_SHIFT_WMAC_SWAES_DIO_B95_B64_8822C 0 -+#define BIT_MASK_WMAC_SWAES_DIO_B95_B64_8822C 0xffffffffL -+#define BIT_WMAC_SWAES_DIO_B95_B64_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_SWAES_DIO_B95_B64_8822C) \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B95_B64_8822C) -+#define BITS_WMAC_SWAES_DIO_B95_B64_8822C \ -+ (BIT_MASK_WMAC_SWAES_DIO_B95_B64_8822C \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B95_B64_8822C) -+#define BIT_CLEAR_WMAC_SWAES_DIO_B95_B64_8822C(x) \ -+ ((x) & (~BITS_WMAC_SWAES_DIO_B95_B64_8822C)) -+#define BIT_GET_WMAC_SWAES_DIO_B95_B64_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SWAES_DIO_B95_B64_8822C) & \ -+ BIT_MASK_WMAC_SWAES_DIO_B95_B64_8822C) -+#define BIT_SET_WMAC_SWAES_DIO_B95_B64_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_SWAES_DIO_B95_B64_8822C(x) | \ -+ BIT_WMAC_SWAES_DIO_B95_B64_8822C(v)) -+ -+/* 2 REG_WMAC_SWAES_DIO_B127_B96_8822C */ -+ -+#define BIT_SHIFT_WMAC_SWAES_DIO_B127_B96_8822C 0 -+#define BIT_MASK_WMAC_SWAES_DIO_B127_B96_8822C 0xffffffffL -+#define BIT_WMAC_SWAES_DIO_B127_B96_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_SWAES_DIO_B127_B96_8822C) \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B127_B96_8822C) -+#define BITS_WMAC_SWAES_DIO_B127_B96_8822C \ -+ (BIT_MASK_WMAC_SWAES_DIO_B127_B96_8822C \ -+ << BIT_SHIFT_WMAC_SWAES_DIO_B127_B96_8822C) -+#define BIT_CLEAR_WMAC_SWAES_DIO_B127_B96_8822C(x) \ -+ ((x) & (~BITS_WMAC_SWAES_DIO_B127_B96_8822C)) -+#define BIT_GET_WMAC_SWAES_DIO_B127_B96_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SWAES_DIO_B127_B96_8822C) & \ -+ BIT_MASK_WMAC_SWAES_DIO_B127_B96_8822C) -+#define BIT_SET_WMAC_SWAES_DIO_B127_B96_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_SWAES_DIO_B127_B96_8822C(x) | \ -+ BIT_WMAC_SWAES_DIO_B127_B96_8822C(v)) -+ -+/* 2 REG_WMAC_SWAES_CFG_8822C */ -+ -+/* 2 REG_BT_COEX_V2_8822C */ -+#define BIT_GNT_BT_POLARITY_8822C BIT(12) -+#define BIT_GNT_BT_BYPASS_PRIORITY_8822C BIT(8) -+ -+#define BIT_SHIFT_TIMER_8822C 0 -+#define BIT_MASK_TIMER_8822C 0xff -+#define BIT_TIMER_8822C(x) \ -+ (((x) & BIT_MASK_TIMER_8822C) << BIT_SHIFT_TIMER_8822C) -+#define BITS_TIMER_8822C (BIT_MASK_TIMER_8822C << BIT_SHIFT_TIMER_8822C) -+#define BIT_CLEAR_TIMER_8822C(x) ((x) & (~BITS_TIMER_8822C)) -+#define BIT_GET_TIMER_8822C(x) \ -+ (((x) >> BIT_SHIFT_TIMER_8822C) & BIT_MASK_TIMER_8822C) -+#define BIT_SET_TIMER_8822C(x, v) \ -+ (BIT_CLEAR_TIMER_8822C(x) | BIT_TIMER_8822C(v)) -+ -+/* 2 REG_BT_COEX_8822C */ -+#define BIT_R_GNT_BT_RFC_SW_8822C BIT(12) -+#define BIT_R_GNT_BT_RFC_SW_EN_8822C BIT(11) -+#define BIT_R_GNT_BT_BB_SW_8822C BIT(10) -+#define BIT_R_GNT_BT_BB_SW_EN_8822C BIT(9) -+#define BIT_R_BT_CNT_THREN_8822C BIT(8) -+ -+#define BIT_SHIFT_R_BT_CNT_THR_8822C 0 -+#define BIT_MASK_R_BT_CNT_THR_8822C 0xff -+#define BIT_R_BT_CNT_THR_8822C(x) \ -+ (((x) & BIT_MASK_R_BT_CNT_THR_8822C) << BIT_SHIFT_R_BT_CNT_THR_8822C) -+#define BITS_R_BT_CNT_THR_8822C \ -+ (BIT_MASK_R_BT_CNT_THR_8822C << BIT_SHIFT_R_BT_CNT_THR_8822C) -+#define BIT_CLEAR_R_BT_CNT_THR_8822C(x) ((x) & (~BITS_R_BT_CNT_THR_8822C)) -+#define BIT_GET_R_BT_CNT_THR_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CNT_THR_8822C) & BIT_MASK_R_BT_CNT_THR_8822C) -+#define BIT_SET_R_BT_CNT_THR_8822C(x, v) \ -+ (BIT_CLEAR_R_BT_CNT_THR_8822C(x) | BIT_R_BT_CNT_THR_8822C(v)) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_8822C */ -+ -+#define BIT_SHIFT_RXMYRTS_NAV_V1_8822C 8 -+#define BIT_MASK_RXMYRTS_NAV_V1_8822C 0xff -+#define BIT_RXMYRTS_NAV_V1_8822C(x) \ -+ (((x) & BIT_MASK_RXMYRTS_NAV_V1_8822C) \ -+ << BIT_SHIFT_RXMYRTS_NAV_V1_8822C) -+#define BITS_RXMYRTS_NAV_V1_8822C \ -+ (BIT_MASK_RXMYRTS_NAV_V1_8822C << BIT_SHIFT_RXMYRTS_NAV_V1_8822C) -+#define BIT_CLEAR_RXMYRTS_NAV_V1_8822C(x) ((x) & (~BITS_RXMYRTS_NAV_V1_8822C)) -+#define BIT_GET_RXMYRTS_NAV_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RXMYRTS_NAV_V1_8822C) & \ -+ BIT_MASK_RXMYRTS_NAV_V1_8822C) -+#define BIT_SET_RXMYRTS_NAV_V1_8822C(x, v) \ -+ (BIT_CLEAR_RXMYRTS_NAV_V1_8822C(x) | BIT_RXMYRTS_NAV_V1_8822C(v)) -+ -+#define BIT_SHIFT_RTSRST_V1_8822C 0 -+#define BIT_MASK_RTSRST_V1_8822C 0xff -+#define BIT_RTSRST_V1_8822C(x) \ -+ (((x) & BIT_MASK_RTSRST_V1_8822C) << BIT_SHIFT_RTSRST_V1_8822C) -+#define BITS_RTSRST_V1_8822C \ -+ (BIT_MASK_RTSRST_V1_8822C << BIT_SHIFT_RTSRST_V1_8822C) -+#define BIT_CLEAR_RTSRST_V1_8822C(x) ((x) & (~BITS_RTSRST_V1_8822C)) -+#define BIT_GET_RTSRST_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RTSRST_V1_8822C) & BIT_MASK_RTSRST_V1_8822C) -+#define BIT_SET_RTSRST_V1_8822C(x, v) \ -+ (BIT_CLEAR_RTSRST_V1_8822C(x) | BIT_RTSRST_V1_8822C(v)) -+ -+/* 2 REG_WLAN_ACT_MASK_CTRL_1_8822C */ -+#define BIT_WLRX_TER_BY_CTL_1_8822C BIT(11) -+#define BIT_WLRX_TER_BY_AD_1_8822C BIT(10) -+#define BIT_ANT_DIVERSITY_SEL_1_8822C BIT(9) -+#define BIT_ANTSEL_FOR_BT_CTRL_EN_1_8822C BIT(8) -+#define BIT_WLACT_LOW_GNTWL_EN_1_8822C BIT(2) -+#define BIT_WLACT_HIGH_GNTBT_EN_1_8822C BIT(1) -+#define BIT_NAV_UPPER_1_V1_8822C BIT(0) -+ -+/* 2 REG_BT_COEX_ENHANCED_INTR_CTRL_8822C */ -+ -+#define BIT_SHIFT_BT_STAT_DELAY_8822C 12 -+#define BIT_MASK_BT_STAT_DELAY_8822C 0xf -+#define BIT_BT_STAT_DELAY_8822C(x) \ -+ (((x) & BIT_MASK_BT_STAT_DELAY_8822C) << BIT_SHIFT_BT_STAT_DELAY_8822C) -+#define BITS_BT_STAT_DELAY_8822C \ -+ (BIT_MASK_BT_STAT_DELAY_8822C << BIT_SHIFT_BT_STAT_DELAY_8822C) -+#define BIT_CLEAR_BT_STAT_DELAY_8822C(x) ((x) & (~BITS_BT_STAT_DELAY_8822C)) -+#define BIT_GET_BT_STAT_DELAY_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_STAT_DELAY_8822C) & BIT_MASK_BT_STAT_DELAY_8822C) -+#define BIT_SET_BT_STAT_DELAY_8822C(x, v) \ -+ (BIT_CLEAR_BT_STAT_DELAY_8822C(x) | BIT_BT_STAT_DELAY_8822C(v)) -+ -+#define BIT_SHIFT_BT_TRX_INIT_DETECT_8822C 8 -+#define BIT_MASK_BT_TRX_INIT_DETECT_8822C 0xf -+#define BIT_BT_TRX_INIT_DETECT_8822C(x) \ -+ (((x) & BIT_MASK_BT_TRX_INIT_DETECT_8822C) \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8822C) -+#define BITS_BT_TRX_INIT_DETECT_8822C \ -+ (BIT_MASK_BT_TRX_INIT_DETECT_8822C \ -+ << BIT_SHIFT_BT_TRX_INIT_DETECT_8822C) -+#define BIT_CLEAR_BT_TRX_INIT_DETECT_8822C(x) \ -+ ((x) & (~BITS_BT_TRX_INIT_DETECT_8822C)) -+#define BIT_GET_BT_TRX_INIT_DETECT_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_TRX_INIT_DETECT_8822C) & \ -+ BIT_MASK_BT_TRX_INIT_DETECT_8822C) -+#define BIT_SET_BT_TRX_INIT_DETECT_8822C(x, v) \ -+ (BIT_CLEAR_BT_TRX_INIT_DETECT_8822C(x) | \ -+ BIT_BT_TRX_INIT_DETECT_8822C(v)) -+ -+#define BIT_SHIFT_BT_PRI_DETECT_TO_8822C 4 -+#define BIT_MASK_BT_PRI_DETECT_TO_8822C 0xf -+#define BIT_BT_PRI_DETECT_TO_8822C(x) \ -+ (((x) & BIT_MASK_BT_PRI_DETECT_TO_8822C) \ -+ << BIT_SHIFT_BT_PRI_DETECT_TO_8822C) -+#define BITS_BT_PRI_DETECT_TO_8822C \ -+ (BIT_MASK_BT_PRI_DETECT_TO_8822C << BIT_SHIFT_BT_PRI_DETECT_TO_8822C) -+#define BIT_CLEAR_BT_PRI_DETECT_TO_8822C(x) \ -+ ((x) & (~BITS_BT_PRI_DETECT_TO_8822C)) -+#define BIT_GET_BT_PRI_DETECT_TO_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_PRI_DETECT_TO_8822C) & \ -+ BIT_MASK_BT_PRI_DETECT_TO_8822C) -+#define BIT_SET_BT_PRI_DETECT_TO_8822C(x, v) \ -+ (BIT_CLEAR_BT_PRI_DETECT_TO_8822C(x) | BIT_BT_PRI_DETECT_TO_8822C(v)) -+ -+#define BIT_R_GRANTALL_WLMASK_8822C BIT(3) -+#define BIT_STATIS_BT_EN_8822C BIT(2) -+#define BIT_WL_ACT_MASK_ENABLE_8822C BIT(1) -+#define BIT_ENHANCED_BT_8822C BIT(0) -+ -+/* 2 REG_BT_ACT_STATISTICS_8822C */ -+ -+#define BIT_SHIFT_STATIS_BT_HI_RX_8822C 16 -+#define BIT_MASK_STATIS_BT_HI_RX_8822C 0xffff -+#define BIT_STATIS_BT_HI_RX_8822C(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_RX_8822C) \ -+ << BIT_SHIFT_STATIS_BT_HI_RX_8822C) -+#define BITS_STATIS_BT_HI_RX_8822C \ -+ (BIT_MASK_STATIS_BT_HI_RX_8822C << BIT_SHIFT_STATIS_BT_HI_RX_8822C) -+#define BIT_CLEAR_STATIS_BT_HI_RX_8822C(x) ((x) & (~BITS_STATIS_BT_HI_RX_8822C)) -+#define BIT_GET_STATIS_BT_HI_RX_8822C(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_RX_8822C) & \ -+ BIT_MASK_STATIS_BT_HI_RX_8822C) -+#define BIT_SET_STATIS_BT_HI_RX_8822C(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_RX_8822C(x) | BIT_STATIS_BT_HI_RX_8822C(v)) -+ -+#define BIT_SHIFT_STATIS_BT_HI_TX_8822C 0 -+#define BIT_MASK_STATIS_BT_HI_TX_8822C 0xffff -+#define BIT_STATIS_BT_HI_TX_8822C(x) \ -+ (((x) & BIT_MASK_STATIS_BT_HI_TX_8822C) \ -+ << BIT_SHIFT_STATIS_BT_HI_TX_8822C) -+#define BITS_STATIS_BT_HI_TX_8822C \ -+ (BIT_MASK_STATIS_BT_HI_TX_8822C << BIT_SHIFT_STATIS_BT_HI_TX_8822C) -+#define BIT_CLEAR_STATIS_BT_HI_TX_8822C(x) ((x) & (~BITS_STATIS_BT_HI_TX_8822C)) -+#define BIT_GET_STATIS_BT_HI_TX_8822C(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_HI_TX_8822C) & \ -+ BIT_MASK_STATIS_BT_HI_TX_8822C) -+#define BIT_SET_STATIS_BT_HI_TX_8822C(x, v) \ -+ (BIT_CLEAR_STATIS_BT_HI_TX_8822C(x) | BIT_STATIS_BT_HI_TX_8822C(v)) -+ -+/* 2 REG_BT_ACT_STATISTICS_1_8822C */ -+ -+#define BIT_SHIFT_STATIS_BT_LO_RX_1_8822C 16 -+#define BIT_MASK_STATIS_BT_LO_RX_1_8822C 0xffff -+#define BIT_STATIS_BT_LO_RX_1_8822C(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_RX_1_8822C) \ -+ << BIT_SHIFT_STATIS_BT_LO_RX_1_8822C) -+#define BITS_STATIS_BT_LO_RX_1_8822C \ -+ (BIT_MASK_STATIS_BT_LO_RX_1_8822C << BIT_SHIFT_STATIS_BT_LO_RX_1_8822C) -+#define BIT_CLEAR_STATIS_BT_LO_RX_1_8822C(x) \ -+ ((x) & (~BITS_STATIS_BT_LO_RX_1_8822C)) -+#define BIT_GET_STATIS_BT_LO_RX_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_RX_1_8822C) & \ -+ BIT_MASK_STATIS_BT_LO_RX_1_8822C) -+#define BIT_SET_STATIS_BT_LO_RX_1_8822C(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_RX_1_8822C(x) | BIT_STATIS_BT_LO_RX_1_8822C(v)) -+ -+#define BIT_SHIFT_STATIS_BT_LO_TX_1_8822C 0 -+#define BIT_MASK_STATIS_BT_LO_TX_1_8822C 0xffff -+#define BIT_STATIS_BT_LO_TX_1_8822C(x) \ -+ (((x) & BIT_MASK_STATIS_BT_LO_TX_1_8822C) \ -+ << BIT_SHIFT_STATIS_BT_LO_TX_1_8822C) -+#define BITS_STATIS_BT_LO_TX_1_8822C \ -+ (BIT_MASK_STATIS_BT_LO_TX_1_8822C << BIT_SHIFT_STATIS_BT_LO_TX_1_8822C) -+#define BIT_CLEAR_STATIS_BT_LO_TX_1_8822C(x) \ -+ ((x) & (~BITS_STATIS_BT_LO_TX_1_8822C)) -+#define BIT_GET_STATIS_BT_LO_TX_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_STATIS_BT_LO_TX_1_8822C) & \ -+ BIT_MASK_STATIS_BT_LO_TX_1_8822C) -+#define BIT_SET_STATIS_BT_LO_TX_1_8822C(x, v) \ -+ (BIT_CLEAR_STATIS_BT_LO_TX_1_8822C(x) | BIT_STATIS_BT_LO_TX_1_8822C(v)) -+ -+/* 2 REG_BT_STATISTICS_CONTROL_REGISTER_8822C */ -+ -+#define BIT_SHIFT_R_BT_CMD_RPT_8822C 16 -+#define BIT_MASK_R_BT_CMD_RPT_8822C 0xffff -+#define BIT_R_BT_CMD_RPT_8822C(x) \ -+ (((x) & BIT_MASK_R_BT_CMD_RPT_8822C) << BIT_SHIFT_R_BT_CMD_RPT_8822C) -+#define BITS_R_BT_CMD_RPT_8822C \ -+ (BIT_MASK_R_BT_CMD_RPT_8822C << BIT_SHIFT_R_BT_CMD_RPT_8822C) -+#define BIT_CLEAR_R_BT_CMD_RPT_8822C(x) ((x) & (~BITS_R_BT_CMD_RPT_8822C)) -+#define BIT_GET_R_BT_CMD_RPT_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_BT_CMD_RPT_8822C) & BIT_MASK_R_BT_CMD_RPT_8822C) -+#define BIT_SET_R_BT_CMD_RPT_8822C(x, v) \ -+ (BIT_CLEAR_R_BT_CMD_RPT_8822C(x) | BIT_R_BT_CMD_RPT_8822C(v)) -+ -+#define BIT_SHIFT_R_RPT_FROM_BT_8822C 8 -+#define BIT_MASK_R_RPT_FROM_BT_8822C 0xff -+#define BIT_R_RPT_FROM_BT_8822C(x) \ -+ (((x) & BIT_MASK_R_RPT_FROM_BT_8822C) << BIT_SHIFT_R_RPT_FROM_BT_8822C) -+#define BITS_R_RPT_FROM_BT_8822C \ -+ (BIT_MASK_R_RPT_FROM_BT_8822C << BIT_SHIFT_R_RPT_FROM_BT_8822C) -+#define BIT_CLEAR_R_RPT_FROM_BT_8822C(x) ((x) & (~BITS_R_RPT_FROM_BT_8822C)) -+#define BIT_GET_R_RPT_FROM_BT_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_RPT_FROM_BT_8822C) & BIT_MASK_R_RPT_FROM_BT_8822C) -+#define BIT_SET_R_RPT_FROM_BT_8822C(x, v) \ -+ (BIT_CLEAR_R_RPT_FROM_BT_8822C(x) | BIT_R_RPT_FROM_BT_8822C(v)) -+ -+#define BIT_SHIFT_BT_HID_ISR_SET_8822C 6 -+#define BIT_MASK_BT_HID_ISR_SET_8822C 0x3 -+#define BIT_BT_HID_ISR_SET_8822C(x) \ -+ (((x) & BIT_MASK_BT_HID_ISR_SET_8822C) \ -+ << BIT_SHIFT_BT_HID_ISR_SET_8822C) -+#define BITS_BT_HID_ISR_SET_8822C \ -+ (BIT_MASK_BT_HID_ISR_SET_8822C << BIT_SHIFT_BT_HID_ISR_SET_8822C) -+#define BIT_CLEAR_BT_HID_ISR_SET_8822C(x) ((x) & (~BITS_BT_HID_ISR_SET_8822C)) -+#define BIT_GET_BT_HID_ISR_SET_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_HID_ISR_SET_8822C) & \ -+ BIT_MASK_BT_HID_ISR_SET_8822C) -+#define BIT_SET_BT_HID_ISR_SET_8822C(x, v) \ -+ (BIT_CLEAR_BT_HID_ISR_SET_8822C(x) | BIT_BT_HID_ISR_SET_8822C(v)) -+ -+#define BIT_TDMA_BT_START_NOTIFY_8822C BIT(5) -+#define BIT_ENABLE_TDMA_FW_MODE_8822C BIT(4) -+#define BIT_ENABLE_PTA_TDMA_MODE_8822C BIT(3) -+#define BIT_ENABLE_COEXIST_TAB_IN_TDMA_8822C BIT(2) -+#define BIT_GPIO2_GPIO3_EXANGE_OR_NO_BT_CCA_8822C BIT(1) -+#define BIT_RTK_BT_ENABLE_8822C BIT(0) -+ -+/* 2 REG_BT_STATUS_REPORT_REGISTER_8822C */ -+ -+#define BIT_SHIFT_BT_PROFILE_8822C 24 -+#define BIT_MASK_BT_PROFILE_8822C 0xff -+#define BIT_BT_PROFILE_8822C(x) \ -+ (((x) & BIT_MASK_BT_PROFILE_8822C) << BIT_SHIFT_BT_PROFILE_8822C) -+#define BITS_BT_PROFILE_8822C \ -+ (BIT_MASK_BT_PROFILE_8822C << BIT_SHIFT_BT_PROFILE_8822C) -+#define BIT_CLEAR_BT_PROFILE_8822C(x) ((x) & (~BITS_BT_PROFILE_8822C)) -+#define BIT_GET_BT_PROFILE_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_PROFILE_8822C) & BIT_MASK_BT_PROFILE_8822C) -+#define BIT_SET_BT_PROFILE_8822C(x, v) \ -+ (BIT_CLEAR_BT_PROFILE_8822C(x) | BIT_BT_PROFILE_8822C(v)) -+ -+#define BIT_SHIFT_BT_POWER_8822C 16 -+#define BIT_MASK_BT_POWER_8822C 0xff -+#define BIT_BT_POWER_8822C(x) \ -+ (((x) & BIT_MASK_BT_POWER_8822C) << BIT_SHIFT_BT_POWER_8822C) -+#define BITS_BT_POWER_8822C \ -+ (BIT_MASK_BT_POWER_8822C << BIT_SHIFT_BT_POWER_8822C) -+#define BIT_CLEAR_BT_POWER_8822C(x) ((x) & (~BITS_BT_POWER_8822C)) -+#define BIT_GET_BT_POWER_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_POWER_8822C) & BIT_MASK_BT_POWER_8822C) -+#define BIT_SET_BT_POWER_8822C(x, v) \ -+ (BIT_CLEAR_BT_POWER_8822C(x) | BIT_BT_POWER_8822C(v)) -+ -+#define BIT_SHIFT_BT_PREDECT_STATUS_8822C 8 -+#define BIT_MASK_BT_PREDECT_STATUS_8822C 0xff -+#define BIT_BT_PREDECT_STATUS_8822C(x) \ -+ (((x) & BIT_MASK_BT_PREDECT_STATUS_8822C) \ -+ << BIT_SHIFT_BT_PREDECT_STATUS_8822C) -+#define BITS_BT_PREDECT_STATUS_8822C \ -+ (BIT_MASK_BT_PREDECT_STATUS_8822C << BIT_SHIFT_BT_PREDECT_STATUS_8822C) -+#define BIT_CLEAR_BT_PREDECT_STATUS_8822C(x) \ -+ ((x) & (~BITS_BT_PREDECT_STATUS_8822C)) -+#define BIT_GET_BT_PREDECT_STATUS_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_PREDECT_STATUS_8822C) & \ -+ BIT_MASK_BT_PREDECT_STATUS_8822C) -+#define BIT_SET_BT_PREDECT_STATUS_8822C(x, v) \ -+ (BIT_CLEAR_BT_PREDECT_STATUS_8822C(x) | BIT_BT_PREDECT_STATUS_8822C(v)) -+ -+#define BIT_SHIFT_BT_CMD_INFO_8822C 0 -+#define BIT_MASK_BT_CMD_INFO_8822C 0xff -+#define BIT_BT_CMD_INFO_8822C(x) \ -+ (((x) & BIT_MASK_BT_CMD_INFO_8822C) << BIT_SHIFT_BT_CMD_INFO_8822C) -+#define BITS_BT_CMD_INFO_8822C \ -+ (BIT_MASK_BT_CMD_INFO_8822C << BIT_SHIFT_BT_CMD_INFO_8822C) -+#define BIT_CLEAR_BT_CMD_INFO_8822C(x) ((x) & (~BITS_BT_CMD_INFO_8822C)) -+#define BIT_GET_BT_CMD_INFO_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_CMD_INFO_8822C) & BIT_MASK_BT_CMD_INFO_8822C) -+#define BIT_SET_BT_CMD_INFO_8822C(x, v) \ -+ (BIT_CLEAR_BT_CMD_INFO_8822C(x) | BIT_BT_CMD_INFO_8822C(v)) -+ -+/* 2 REG_BT_INTERRUPT_CONTROL_REGISTER_8822C */ -+#define BIT_EN_MAC_NULL_PKT_NOTIFY_8822C BIT(31) -+#define BIT_EN_WLAN_RPT_AND_BT_QUERY_8822C BIT(30) -+#define BIT_EN_BT_STSTUS_RPT_8822C BIT(29) -+#define BIT_EN_BT_POWER_8822C BIT(28) -+#define BIT_EN_BT_CHANNEL_8822C BIT(27) -+#define BIT_EN_BT_SLOT_CHANGE_8822C BIT(26) -+#define BIT_EN_BT_PROFILE_OR_HID_8822C BIT(25) -+#define BIT_WLAN_RPT_NOTIFY_8822C BIT(24) -+ -+#define BIT_SHIFT_WLAN_RPT_DATA_8822C 16 -+#define BIT_MASK_WLAN_RPT_DATA_8822C 0xff -+#define BIT_WLAN_RPT_DATA_8822C(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_DATA_8822C) << BIT_SHIFT_WLAN_RPT_DATA_8822C) -+#define BITS_WLAN_RPT_DATA_8822C \ -+ (BIT_MASK_WLAN_RPT_DATA_8822C << BIT_SHIFT_WLAN_RPT_DATA_8822C) -+#define BIT_CLEAR_WLAN_RPT_DATA_8822C(x) ((x) & (~BITS_WLAN_RPT_DATA_8822C)) -+#define BIT_GET_WLAN_RPT_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_DATA_8822C) & BIT_MASK_WLAN_RPT_DATA_8822C) -+#define BIT_SET_WLAN_RPT_DATA_8822C(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_DATA_8822C(x) | BIT_WLAN_RPT_DATA_8822C(v)) -+ -+#define BIT_SHIFT_CMD_ID_8822C 8 -+#define BIT_MASK_CMD_ID_8822C 0xff -+#define BIT_CMD_ID_8822C(x) \ -+ (((x) & BIT_MASK_CMD_ID_8822C) << BIT_SHIFT_CMD_ID_8822C) -+#define BITS_CMD_ID_8822C (BIT_MASK_CMD_ID_8822C << BIT_SHIFT_CMD_ID_8822C) -+#define BIT_CLEAR_CMD_ID_8822C(x) ((x) & (~BITS_CMD_ID_8822C)) -+#define BIT_GET_CMD_ID_8822C(x) \ -+ (((x) >> BIT_SHIFT_CMD_ID_8822C) & BIT_MASK_CMD_ID_8822C) -+#define BIT_SET_CMD_ID_8822C(x, v) \ -+ (BIT_CLEAR_CMD_ID_8822C(x) | BIT_CMD_ID_8822C(v)) -+ -+#define BIT_SHIFT_BT_DATA_8822C 0 -+#define BIT_MASK_BT_DATA_8822C 0xff -+#define BIT_BT_DATA_8822C(x) \ -+ (((x) & BIT_MASK_BT_DATA_8822C) << BIT_SHIFT_BT_DATA_8822C) -+#define BITS_BT_DATA_8822C (BIT_MASK_BT_DATA_8822C << BIT_SHIFT_BT_DATA_8822C) -+#define BIT_CLEAR_BT_DATA_8822C(x) ((x) & (~BITS_BT_DATA_8822C)) -+#define BIT_GET_BT_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_DATA_8822C) & BIT_MASK_BT_DATA_8822C) -+#define BIT_SET_BT_DATA_8822C(x, v) \ -+ (BIT_CLEAR_BT_DATA_8822C(x) | BIT_BT_DATA_8822C(v)) -+ -+/* 2 REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8822C */ -+ -+#define BIT_SHIFT_WLAN_RPT_TO_8822C 0 -+#define BIT_MASK_WLAN_RPT_TO_8822C 0xff -+#define BIT_WLAN_RPT_TO_8822C(x) \ -+ (((x) & BIT_MASK_WLAN_RPT_TO_8822C) << BIT_SHIFT_WLAN_RPT_TO_8822C) -+#define BITS_WLAN_RPT_TO_8822C \ -+ (BIT_MASK_WLAN_RPT_TO_8822C << BIT_SHIFT_WLAN_RPT_TO_8822C) -+#define BIT_CLEAR_WLAN_RPT_TO_8822C(x) ((x) & (~BITS_WLAN_RPT_TO_8822C)) -+#define BIT_GET_WLAN_RPT_TO_8822C(x) \ -+ (((x) >> BIT_SHIFT_WLAN_RPT_TO_8822C) & BIT_MASK_WLAN_RPT_TO_8822C) -+#define BIT_SET_WLAN_RPT_TO_8822C(x, v) \ -+ (BIT_CLEAR_WLAN_RPT_TO_8822C(x) | BIT_WLAN_RPT_TO_8822C(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8822C */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_0_8822C 1 -+#define BIT_MASK_ISOLATION_CHK_0_8822C 0x7fffff -+#define BIT_ISOLATION_CHK_0_8822C(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_0_8822C) \ -+ << BIT_SHIFT_ISOLATION_CHK_0_8822C) -+#define BITS_ISOLATION_CHK_0_8822C \ -+ (BIT_MASK_ISOLATION_CHK_0_8822C << BIT_SHIFT_ISOLATION_CHK_0_8822C) -+#define BIT_CLEAR_ISOLATION_CHK_0_8822C(x) ((x) & (~BITS_ISOLATION_CHK_0_8822C)) -+#define BIT_GET_ISOLATION_CHK_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_0_8822C) & \ -+ BIT_MASK_ISOLATION_CHK_0_8822C) -+#define BIT_SET_ISOLATION_CHK_0_8822C(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_0_8822C(x) | BIT_ISOLATION_CHK_0_8822C(v)) -+ -+#define BIT_ISOLATION_EN_8822C BIT(0) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_1_8822C */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_1_8822C 0 -+#define BIT_MASK_ISOLATION_CHK_1_8822C 0xffffffffL -+#define BIT_ISOLATION_CHK_1_8822C(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_1_8822C) \ -+ << BIT_SHIFT_ISOLATION_CHK_1_8822C) -+#define BITS_ISOLATION_CHK_1_8822C \ -+ (BIT_MASK_ISOLATION_CHK_1_8822C << BIT_SHIFT_ISOLATION_CHK_1_8822C) -+#define BIT_CLEAR_ISOLATION_CHK_1_8822C(x) ((x) & (~BITS_ISOLATION_CHK_1_8822C)) -+#define BIT_GET_ISOLATION_CHK_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_1_8822C) & \ -+ BIT_MASK_ISOLATION_CHK_1_8822C) -+#define BIT_SET_ISOLATION_CHK_1_8822C(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_1_8822C(x) | BIT_ISOLATION_CHK_1_8822C(v)) -+ -+/* 2 REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_2_8822C */ -+ -+#define BIT_SHIFT_ISOLATION_CHK_2_8822C 0 -+#define BIT_MASK_ISOLATION_CHK_2_8822C 0xffffff -+#define BIT_ISOLATION_CHK_2_8822C(x) \ -+ (((x) & BIT_MASK_ISOLATION_CHK_2_8822C) \ -+ << BIT_SHIFT_ISOLATION_CHK_2_8822C) -+#define BITS_ISOLATION_CHK_2_8822C \ -+ (BIT_MASK_ISOLATION_CHK_2_8822C << BIT_SHIFT_ISOLATION_CHK_2_8822C) -+#define BIT_CLEAR_ISOLATION_CHK_2_8822C(x) ((x) & (~BITS_ISOLATION_CHK_2_8822C)) -+#define BIT_GET_ISOLATION_CHK_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_ISOLATION_CHK_2_8822C) & \ -+ BIT_MASK_ISOLATION_CHK_2_8822C) -+#define BIT_SET_ISOLATION_CHK_2_8822C(x, v) \ -+ (BIT_CLEAR_ISOLATION_CHK_2_8822C(x) | BIT_ISOLATION_CHK_2_8822C(v)) -+ -+/* 2 REG_BT_INTERRUPT_STATUS_REGISTER_8822C */ -+#define BIT_BT_HID_ISR_8822C BIT(7) -+#define BIT_BT_QUERY_ISR_8822C BIT(6) -+#define BIT_MAC_NULL_PKT_NOTIFY_ISR_8822C BIT(5) -+#define BIT_WLAN_RPT_ISR_8822C BIT(4) -+#define BIT_BT_POWER_ISR_8822C BIT(3) -+#define BIT_BT_CHANNEL_ISR_8822C BIT(2) -+#define BIT_BT_SLOT_CHANGE_ISR_8822C BIT(1) -+#define BIT_BT_PROFILE_ISR_8822C BIT(0) -+ -+/* 2 REG_BT_TDMA_TIME_REGISTER_8822C */ -+ -+#define BIT_SHIFT_BT_TIME_8822C 6 -+#define BIT_MASK_BT_TIME_8822C 0x3ffffff -+#define BIT_BT_TIME_8822C(x) \ -+ (((x) & BIT_MASK_BT_TIME_8822C) << BIT_SHIFT_BT_TIME_8822C) -+#define BITS_BT_TIME_8822C (BIT_MASK_BT_TIME_8822C << BIT_SHIFT_BT_TIME_8822C) -+#define BIT_CLEAR_BT_TIME_8822C(x) ((x) & (~BITS_BT_TIME_8822C)) -+#define BIT_GET_BT_TIME_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_TIME_8822C) & BIT_MASK_BT_TIME_8822C) -+#define BIT_SET_BT_TIME_8822C(x, v) \ -+ (BIT_CLEAR_BT_TIME_8822C(x) | BIT_BT_TIME_8822C(v)) -+ -+#define BIT_SHIFT_BT_RPT_SAMPLE_RATE_8822C 0 -+#define BIT_MASK_BT_RPT_SAMPLE_RATE_8822C 0x3f -+#define BIT_BT_RPT_SAMPLE_RATE_8822C(x) \ -+ (((x) & BIT_MASK_BT_RPT_SAMPLE_RATE_8822C) \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8822C) -+#define BITS_BT_RPT_SAMPLE_RATE_8822C \ -+ (BIT_MASK_BT_RPT_SAMPLE_RATE_8822C \ -+ << BIT_SHIFT_BT_RPT_SAMPLE_RATE_8822C) -+#define BIT_CLEAR_BT_RPT_SAMPLE_RATE_8822C(x) \ -+ ((x) & (~BITS_BT_RPT_SAMPLE_RATE_8822C)) -+#define BIT_GET_BT_RPT_SAMPLE_RATE_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_RPT_SAMPLE_RATE_8822C) & \ -+ BIT_MASK_BT_RPT_SAMPLE_RATE_8822C) -+#define BIT_SET_BT_RPT_SAMPLE_RATE_8822C(x, v) \ -+ (BIT_CLEAR_BT_RPT_SAMPLE_RATE_8822C(x) | \ -+ BIT_BT_RPT_SAMPLE_RATE_8822C(v)) -+ -+/* 2 REG_BT_ACT_REGISTER_8822C */ -+ -+#define BIT_SHIFT_BT_EISR_EN_8822C 16 -+#define BIT_MASK_BT_EISR_EN_8822C 0xff -+#define BIT_BT_EISR_EN_8822C(x) \ -+ (((x) & BIT_MASK_BT_EISR_EN_8822C) << BIT_SHIFT_BT_EISR_EN_8822C) -+#define BITS_BT_EISR_EN_8822C \ -+ (BIT_MASK_BT_EISR_EN_8822C << BIT_SHIFT_BT_EISR_EN_8822C) -+#define BIT_CLEAR_BT_EISR_EN_8822C(x) ((x) & (~BITS_BT_EISR_EN_8822C)) -+#define BIT_GET_BT_EISR_EN_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_EISR_EN_8822C) & BIT_MASK_BT_EISR_EN_8822C) -+#define BIT_SET_BT_EISR_EN_8822C(x, v) \ -+ (BIT_CLEAR_BT_EISR_EN_8822C(x) | BIT_BT_EISR_EN_8822C(v)) -+ -+#define BIT_BT_ACT_FALLING_ISR_8822C BIT(10) -+#define BIT_BT_ACT_RISING_ISR_8822C BIT(9) -+#define BIT_TDMA_TO_ISR_8822C BIT(8) -+ -+#define BIT_SHIFT_BT_CH_V1_8822C 0 -+#define BIT_MASK_BT_CH_V1_8822C 0x7f -+#define BIT_BT_CH_V1_8822C(x) \ -+ (((x) & BIT_MASK_BT_CH_V1_8822C) << BIT_SHIFT_BT_CH_V1_8822C) -+#define BITS_BT_CH_V1_8822C \ -+ (BIT_MASK_BT_CH_V1_8822C << BIT_SHIFT_BT_CH_V1_8822C) -+#define BIT_CLEAR_BT_CH_V1_8822C(x) ((x) & (~BITS_BT_CH_V1_8822C)) -+#define BIT_GET_BT_CH_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_CH_V1_8822C) & BIT_MASK_BT_CH_V1_8822C) -+#define BIT_SET_BT_CH_V1_8822C(x, v) \ -+ (BIT_CLEAR_BT_CH_V1_8822C(x) | BIT_BT_CH_V1_8822C(v)) -+ -+/* 2 REG_OBFF_CTRL_BASIC_8822C */ -+#define BIT_OBFF_EN_V1_8822C BIT(31) -+ -+#define BIT_SHIFT_OBFF_STATE_V1_8822C 28 -+#define BIT_MASK_OBFF_STATE_V1_8822C 0x3 -+#define BIT_OBFF_STATE_V1_8822C(x) \ -+ (((x) & BIT_MASK_OBFF_STATE_V1_8822C) << BIT_SHIFT_OBFF_STATE_V1_8822C) -+#define BITS_OBFF_STATE_V1_8822C \ -+ (BIT_MASK_OBFF_STATE_V1_8822C << BIT_SHIFT_OBFF_STATE_V1_8822C) -+#define BIT_CLEAR_OBFF_STATE_V1_8822C(x) ((x) & (~BITS_OBFF_STATE_V1_8822C)) -+#define BIT_GET_OBFF_STATE_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_OBFF_STATE_V1_8822C) & BIT_MASK_OBFF_STATE_V1_8822C) -+#define BIT_SET_OBFF_STATE_V1_8822C(x, v) \ -+ (BIT_CLEAR_OBFF_STATE_V1_8822C(x) | BIT_OBFF_STATE_V1_8822C(v)) -+ -+#define BIT_OBFF_ACT_RXDMA_EN_8822C BIT(27) -+#define BIT_OBFF_BLOCK_INT_EN_8822C BIT(26) -+#define BIT_OBFF_AUTOACT_EN_8822C BIT(25) -+#define BIT_OBFF_AUTOIDLE_EN_8822C BIT(24) -+ -+#define BIT_SHIFT_WAKE_MAX_PLS_8822C 20 -+#define BIT_MASK_WAKE_MAX_PLS_8822C 0x7 -+#define BIT_WAKE_MAX_PLS_8822C(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_PLS_8822C) << BIT_SHIFT_WAKE_MAX_PLS_8822C) -+#define BITS_WAKE_MAX_PLS_8822C \ -+ (BIT_MASK_WAKE_MAX_PLS_8822C << BIT_SHIFT_WAKE_MAX_PLS_8822C) -+#define BIT_CLEAR_WAKE_MAX_PLS_8822C(x) ((x) & (~BITS_WAKE_MAX_PLS_8822C)) -+#define BIT_GET_WAKE_MAX_PLS_8822C(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_PLS_8822C) & BIT_MASK_WAKE_MAX_PLS_8822C) -+#define BIT_SET_WAKE_MAX_PLS_8822C(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_PLS_8822C(x) | BIT_WAKE_MAX_PLS_8822C(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_PLS_8822C 16 -+#define BIT_MASK_WAKE_MIN_PLS_8822C 0x7 -+#define BIT_WAKE_MIN_PLS_8822C(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_PLS_8822C) << BIT_SHIFT_WAKE_MIN_PLS_8822C) -+#define BITS_WAKE_MIN_PLS_8822C \ -+ (BIT_MASK_WAKE_MIN_PLS_8822C << BIT_SHIFT_WAKE_MIN_PLS_8822C) -+#define BIT_CLEAR_WAKE_MIN_PLS_8822C(x) ((x) & (~BITS_WAKE_MIN_PLS_8822C)) -+#define BIT_GET_WAKE_MIN_PLS_8822C(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_PLS_8822C) & BIT_MASK_WAKE_MIN_PLS_8822C) -+#define BIT_SET_WAKE_MIN_PLS_8822C(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_PLS_8822C(x) | BIT_WAKE_MIN_PLS_8822C(v)) -+ -+#define BIT_SHIFT_WAKE_MAX_F2F_8822C 12 -+#define BIT_MASK_WAKE_MAX_F2F_8822C 0x7 -+#define BIT_WAKE_MAX_F2F_8822C(x) \ -+ (((x) & BIT_MASK_WAKE_MAX_F2F_8822C) << BIT_SHIFT_WAKE_MAX_F2F_8822C) -+#define BITS_WAKE_MAX_F2F_8822C \ -+ (BIT_MASK_WAKE_MAX_F2F_8822C << BIT_SHIFT_WAKE_MAX_F2F_8822C) -+#define BIT_CLEAR_WAKE_MAX_F2F_8822C(x) ((x) & (~BITS_WAKE_MAX_F2F_8822C)) -+#define BIT_GET_WAKE_MAX_F2F_8822C(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MAX_F2F_8822C) & BIT_MASK_WAKE_MAX_F2F_8822C) -+#define BIT_SET_WAKE_MAX_F2F_8822C(x, v) \ -+ (BIT_CLEAR_WAKE_MAX_F2F_8822C(x) | BIT_WAKE_MAX_F2F_8822C(v)) -+ -+#define BIT_SHIFT_WAKE_MIN_F2F_8822C 8 -+#define BIT_MASK_WAKE_MIN_F2F_8822C 0x7 -+#define BIT_WAKE_MIN_F2F_8822C(x) \ -+ (((x) & BIT_MASK_WAKE_MIN_F2F_8822C) << BIT_SHIFT_WAKE_MIN_F2F_8822C) -+#define BITS_WAKE_MIN_F2F_8822C \ -+ (BIT_MASK_WAKE_MIN_F2F_8822C << BIT_SHIFT_WAKE_MIN_F2F_8822C) -+#define BIT_CLEAR_WAKE_MIN_F2F_8822C(x) ((x) & (~BITS_WAKE_MIN_F2F_8822C)) -+#define BIT_GET_WAKE_MIN_F2F_8822C(x) \ -+ (((x) >> BIT_SHIFT_WAKE_MIN_F2F_8822C) & BIT_MASK_WAKE_MIN_F2F_8822C) -+#define BIT_SET_WAKE_MIN_F2F_8822C(x, v) \ -+ (BIT_CLEAR_WAKE_MIN_F2F_8822C(x) | BIT_WAKE_MIN_F2F_8822C(v)) -+ -+#define BIT_APP_CPU_ACT_V1_8822C BIT(3) -+#define BIT_APP_OBFF_V1_8822C BIT(2) -+#define BIT_APP_IDLE_V1_8822C BIT(1) -+#define BIT_APP_INIT_V1_8822C BIT(0) -+ -+/* 2 REG_OBFF_CTRL2_TIMER_8822C */ -+ -+#define BIT_SHIFT_RX_HIGH_TIMER_IDX_8822C 24 -+#define BIT_MASK_RX_HIGH_TIMER_IDX_8822C 0x7 -+#define BIT_RX_HIGH_TIMER_IDX_8822C(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TIMER_IDX_8822C) \ -+ << BIT_SHIFT_RX_HIGH_TIMER_IDX_8822C) -+#define BITS_RX_HIGH_TIMER_IDX_8822C \ -+ (BIT_MASK_RX_HIGH_TIMER_IDX_8822C << BIT_SHIFT_RX_HIGH_TIMER_IDX_8822C) -+#define BIT_CLEAR_RX_HIGH_TIMER_IDX_8822C(x) \ -+ ((x) & (~BITS_RX_HIGH_TIMER_IDX_8822C)) -+#define BIT_GET_RX_HIGH_TIMER_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TIMER_IDX_8822C) & \ -+ BIT_MASK_RX_HIGH_TIMER_IDX_8822C) -+#define BIT_SET_RX_HIGH_TIMER_IDX_8822C(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TIMER_IDX_8822C(x) | BIT_RX_HIGH_TIMER_IDX_8822C(v)) -+ -+#define BIT_SHIFT_RX_MED_TIMER_IDX_8822C 16 -+#define BIT_MASK_RX_MED_TIMER_IDX_8822C 0x7 -+#define BIT_RX_MED_TIMER_IDX_8822C(x) \ -+ (((x) & BIT_MASK_RX_MED_TIMER_IDX_8822C) \ -+ << BIT_SHIFT_RX_MED_TIMER_IDX_8822C) -+#define BITS_RX_MED_TIMER_IDX_8822C \ -+ (BIT_MASK_RX_MED_TIMER_IDX_8822C << BIT_SHIFT_RX_MED_TIMER_IDX_8822C) -+#define BIT_CLEAR_RX_MED_TIMER_IDX_8822C(x) \ -+ ((x) & (~BITS_RX_MED_TIMER_IDX_8822C)) -+#define BIT_GET_RX_MED_TIMER_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TIMER_IDX_8822C) & \ -+ BIT_MASK_RX_MED_TIMER_IDX_8822C) -+#define BIT_SET_RX_MED_TIMER_IDX_8822C(x, v) \ -+ (BIT_CLEAR_RX_MED_TIMER_IDX_8822C(x) | BIT_RX_MED_TIMER_IDX_8822C(v)) -+ -+#define BIT_SHIFT_RX_LOW_TIMER_IDX_8822C 8 -+#define BIT_MASK_RX_LOW_TIMER_IDX_8822C 0x7 -+#define BIT_RX_LOW_TIMER_IDX_8822C(x) \ -+ (((x) & BIT_MASK_RX_LOW_TIMER_IDX_8822C) \ -+ << BIT_SHIFT_RX_LOW_TIMER_IDX_8822C) -+#define BITS_RX_LOW_TIMER_IDX_8822C \ -+ (BIT_MASK_RX_LOW_TIMER_IDX_8822C << BIT_SHIFT_RX_LOW_TIMER_IDX_8822C) -+#define BIT_CLEAR_RX_LOW_TIMER_IDX_8822C(x) \ -+ ((x) & (~BITS_RX_LOW_TIMER_IDX_8822C)) -+#define BIT_GET_RX_LOW_TIMER_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TIMER_IDX_8822C) & \ -+ BIT_MASK_RX_LOW_TIMER_IDX_8822C) -+#define BIT_SET_RX_LOW_TIMER_IDX_8822C(x, v) \ -+ (BIT_CLEAR_RX_LOW_TIMER_IDX_8822C(x) | BIT_RX_LOW_TIMER_IDX_8822C(v)) -+ -+#define BIT_SHIFT_OBFF_INT_TIMER_IDX_8822C 0 -+#define BIT_MASK_OBFF_INT_TIMER_IDX_8822C 0x7 -+#define BIT_OBFF_INT_TIMER_IDX_8822C(x) \ -+ (((x) & BIT_MASK_OBFF_INT_TIMER_IDX_8822C) \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8822C) -+#define BITS_OBFF_INT_TIMER_IDX_8822C \ -+ (BIT_MASK_OBFF_INT_TIMER_IDX_8822C \ -+ << BIT_SHIFT_OBFF_INT_TIMER_IDX_8822C) -+#define BIT_CLEAR_OBFF_INT_TIMER_IDX_8822C(x) \ -+ ((x) & (~BITS_OBFF_INT_TIMER_IDX_8822C)) -+#define BIT_GET_OBFF_INT_TIMER_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_OBFF_INT_TIMER_IDX_8822C) & \ -+ BIT_MASK_OBFF_INT_TIMER_IDX_8822C) -+#define BIT_SET_OBFF_INT_TIMER_IDX_8822C(x, v) \ -+ (BIT_CLEAR_OBFF_INT_TIMER_IDX_8822C(x) | \ -+ BIT_OBFF_INT_TIMER_IDX_8822C(v)) -+ -+/* 2 REG_LTR_CTRL_BASIC_8822C */ -+#define BIT_LTR_EN_V1_8822C BIT(31) -+#define BIT_LTR_HW_EN_V1_8822C BIT(30) -+#define BIT_LRT_ACT_CTS_EN_8822C BIT(29) -+#define BIT_LTR_ACT_RXPKT_EN_8822C BIT(28) -+#define BIT_LTR_ACT_RXDMA_EN_8822C BIT(27) -+#define BIT_LTR_IDLE_NO_SNOOP_8822C BIT(26) -+#define BIT_SPDUP_MGTPKT_8822C BIT(25) -+#define BIT_RX_AGG_EN_8822C BIT(24) -+#define BIT_APP_LTR_ACT_8822C BIT(23) -+#define BIT_APP_LTR_IDLE_8822C BIT(22) -+ -+#define BIT_SHIFT_HIGH_RATE_TRIG_SEL_8822C 20 -+#define BIT_MASK_HIGH_RATE_TRIG_SEL_8822C 0x3 -+#define BIT_HIGH_RATE_TRIG_SEL_8822C(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_TRIG_SEL_8822C) \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8822C) -+#define BITS_HIGH_RATE_TRIG_SEL_8822C \ -+ (BIT_MASK_HIGH_RATE_TRIG_SEL_8822C \ -+ << BIT_SHIFT_HIGH_RATE_TRIG_SEL_8822C) -+#define BIT_CLEAR_HIGH_RATE_TRIG_SEL_8822C(x) \ -+ ((x) & (~BITS_HIGH_RATE_TRIG_SEL_8822C)) -+#define BIT_GET_HIGH_RATE_TRIG_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_TRIG_SEL_8822C) & \ -+ BIT_MASK_HIGH_RATE_TRIG_SEL_8822C) -+#define BIT_SET_HIGH_RATE_TRIG_SEL_8822C(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_TRIG_SEL_8822C(x) | \ -+ BIT_HIGH_RATE_TRIG_SEL_8822C(v)) -+ -+#define BIT_SHIFT_MED_RATE_TRIG_SEL_8822C 18 -+#define BIT_MASK_MED_RATE_TRIG_SEL_8822C 0x3 -+#define BIT_MED_RATE_TRIG_SEL_8822C(x) \ -+ (((x) & BIT_MASK_MED_RATE_TRIG_SEL_8822C) \ -+ << BIT_SHIFT_MED_RATE_TRIG_SEL_8822C) -+#define BITS_MED_RATE_TRIG_SEL_8822C \ -+ (BIT_MASK_MED_RATE_TRIG_SEL_8822C << BIT_SHIFT_MED_RATE_TRIG_SEL_8822C) -+#define BIT_CLEAR_MED_RATE_TRIG_SEL_8822C(x) \ -+ ((x) & (~BITS_MED_RATE_TRIG_SEL_8822C)) -+#define BIT_GET_MED_RATE_TRIG_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_MED_RATE_TRIG_SEL_8822C) & \ -+ BIT_MASK_MED_RATE_TRIG_SEL_8822C) -+#define BIT_SET_MED_RATE_TRIG_SEL_8822C(x, v) \ -+ (BIT_CLEAR_MED_RATE_TRIG_SEL_8822C(x) | BIT_MED_RATE_TRIG_SEL_8822C(v)) -+ -+#define BIT_SHIFT_LOW_RATE_TRIG_SEL_8822C 16 -+#define BIT_MASK_LOW_RATE_TRIG_SEL_8822C 0x3 -+#define BIT_LOW_RATE_TRIG_SEL_8822C(x) \ -+ (((x) & BIT_MASK_LOW_RATE_TRIG_SEL_8822C) \ -+ << BIT_SHIFT_LOW_RATE_TRIG_SEL_8822C) -+#define BITS_LOW_RATE_TRIG_SEL_8822C \ -+ (BIT_MASK_LOW_RATE_TRIG_SEL_8822C << BIT_SHIFT_LOW_RATE_TRIG_SEL_8822C) -+#define BIT_CLEAR_LOW_RATE_TRIG_SEL_8822C(x) \ -+ ((x) & (~BITS_LOW_RATE_TRIG_SEL_8822C)) -+#define BIT_GET_LOW_RATE_TRIG_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_TRIG_SEL_8822C) & \ -+ BIT_MASK_LOW_RATE_TRIG_SEL_8822C) -+#define BIT_SET_LOW_RATE_TRIG_SEL_8822C(x, v) \ -+ (BIT_CLEAR_LOW_RATE_TRIG_SEL_8822C(x) | BIT_LOW_RATE_TRIG_SEL_8822C(v)) -+ -+#define BIT_SHIFT_HIGH_RATE_BD_IDX_8822C 8 -+#define BIT_MASK_HIGH_RATE_BD_IDX_8822C 0x7f -+#define BIT_HIGH_RATE_BD_IDX_8822C(x) \ -+ (((x) & BIT_MASK_HIGH_RATE_BD_IDX_8822C) \ -+ << BIT_SHIFT_HIGH_RATE_BD_IDX_8822C) -+#define BITS_HIGH_RATE_BD_IDX_8822C \ -+ (BIT_MASK_HIGH_RATE_BD_IDX_8822C << BIT_SHIFT_HIGH_RATE_BD_IDX_8822C) -+#define BIT_CLEAR_HIGH_RATE_BD_IDX_8822C(x) \ -+ ((x) & (~BITS_HIGH_RATE_BD_IDX_8822C)) -+#define BIT_GET_HIGH_RATE_BD_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_HIGH_RATE_BD_IDX_8822C) & \ -+ BIT_MASK_HIGH_RATE_BD_IDX_8822C) -+#define BIT_SET_HIGH_RATE_BD_IDX_8822C(x, v) \ -+ (BIT_CLEAR_HIGH_RATE_BD_IDX_8822C(x) | BIT_HIGH_RATE_BD_IDX_8822C(v)) -+ -+#define BIT_SHIFT_LOW_RATE_BD_IDX_8822C 0 -+#define BIT_MASK_LOW_RATE_BD_IDX_8822C 0x7f -+#define BIT_LOW_RATE_BD_IDX_8822C(x) \ -+ (((x) & BIT_MASK_LOW_RATE_BD_IDX_8822C) \ -+ << BIT_SHIFT_LOW_RATE_BD_IDX_8822C) -+#define BITS_LOW_RATE_BD_IDX_8822C \ -+ (BIT_MASK_LOW_RATE_BD_IDX_8822C << BIT_SHIFT_LOW_RATE_BD_IDX_8822C) -+#define BIT_CLEAR_LOW_RATE_BD_IDX_8822C(x) ((x) & (~BITS_LOW_RATE_BD_IDX_8822C)) -+#define BIT_GET_LOW_RATE_BD_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_LOW_RATE_BD_IDX_8822C) & \ -+ BIT_MASK_LOW_RATE_BD_IDX_8822C) -+#define BIT_SET_LOW_RATE_BD_IDX_8822C(x, v) \ -+ (BIT_CLEAR_LOW_RATE_BD_IDX_8822C(x) | BIT_LOW_RATE_BD_IDX_8822C(v)) -+ -+/* 2 REG_LTR_CTRL2_TIMER_THRESHOLD_8822C */ -+ -+#define BIT_SHIFT_RX_EMPTY_TIMER_IDX_8822C 24 -+#define BIT_MASK_RX_EMPTY_TIMER_IDX_8822C 0x7 -+#define BIT_RX_EMPTY_TIMER_IDX_8822C(x) \ -+ (((x) & BIT_MASK_RX_EMPTY_TIMER_IDX_8822C) \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8822C) -+#define BITS_RX_EMPTY_TIMER_IDX_8822C \ -+ (BIT_MASK_RX_EMPTY_TIMER_IDX_8822C \ -+ << BIT_SHIFT_RX_EMPTY_TIMER_IDX_8822C) -+#define BIT_CLEAR_RX_EMPTY_TIMER_IDX_8822C(x) \ -+ ((x) & (~BITS_RX_EMPTY_TIMER_IDX_8822C)) -+#define BIT_GET_RX_EMPTY_TIMER_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_EMPTY_TIMER_IDX_8822C) & \ -+ BIT_MASK_RX_EMPTY_TIMER_IDX_8822C) -+#define BIT_SET_RX_EMPTY_TIMER_IDX_8822C(x, v) \ -+ (BIT_CLEAR_RX_EMPTY_TIMER_IDX_8822C(x) | \ -+ BIT_RX_EMPTY_TIMER_IDX_8822C(v)) -+ -+#define BIT_SHIFT_RX_AFULL_TH_IDX_8822C 20 -+#define BIT_MASK_RX_AFULL_TH_IDX_8822C 0x7 -+#define BIT_RX_AFULL_TH_IDX_8822C(x) \ -+ (((x) & BIT_MASK_RX_AFULL_TH_IDX_8822C) \ -+ << BIT_SHIFT_RX_AFULL_TH_IDX_8822C) -+#define BITS_RX_AFULL_TH_IDX_8822C \ -+ (BIT_MASK_RX_AFULL_TH_IDX_8822C << BIT_SHIFT_RX_AFULL_TH_IDX_8822C) -+#define BIT_CLEAR_RX_AFULL_TH_IDX_8822C(x) ((x) & (~BITS_RX_AFULL_TH_IDX_8822C)) -+#define BIT_GET_RX_AFULL_TH_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_AFULL_TH_IDX_8822C) & \ -+ BIT_MASK_RX_AFULL_TH_IDX_8822C) -+#define BIT_SET_RX_AFULL_TH_IDX_8822C(x, v) \ -+ (BIT_CLEAR_RX_AFULL_TH_IDX_8822C(x) | BIT_RX_AFULL_TH_IDX_8822C(v)) -+ -+#define BIT_SHIFT_RX_HIGH_TH_IDX_8822C 16 -+#define BIT_MASK_RX_HIGH_TH_IDX_8822C 0x7 -+#define BIT_RX_HIGH_TH_IDX_8822C(x) \ -+ (((x) & BIT_MASK_RX_HIGH_TH_IDX_8822C) \ -+ << BIT_SHIFT_RX_HIGH_TH_IDX_8822C) -+#define BITS_RX_HIGH_TH_IDX_8822C \ -+ (BIT_MASK_RX_HIGH_TH_IDX_8822C << BIT_SHIFT_RX_HIGH_TH_IDX_8822C) -+#define BIT_CLEAR_RX_HIGH_TH_IDX_8822C(x) ((x) & (~BITS_RX_HIGH_TH_IDX_8822C)) -+#define BIT_GET_RX_HIGH_TH_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_HIGH_TH_IDX_8822C) & \ -+ BIT_MASK_RX_HIGH_TH_IDX_8822C) -+#define BIT_SET_RX_HIGH_TH_IDX_8822C(x, v) \ -+ (BIT_CLEAR_RX_HIGH_TH_IDX_8822C(x) | BIT_RX_HIGH_TH_IDX_8822C(v)) -+ -+#define BIT_SHIFT_RX_MED_TH_IDX_8822C 12 -+#define BIT_MASK_RX_MED_TH_IDX_8822C 0x7 -+#define BIT_RX_MED_TH_IDX_8822C(x) \ -+ (((x) & BIT_MASK_RX_MED_TH_IDX_8822C) << BIT_SHIFT_RX_MED_TH_IDX_8822C) -+#define BITS_RX_MED_TH_IDX_8822C \ -+ (BIT_MASK_RX_MED_TH_IDX_8822C << BIT_SHIFT_RX_MED_TH_IDX_8822C) -+#define BIT_CLEAR_RX_MED_TH_IDX_8822C(x) ((x) & (~BITS_RX_MED_TH_IDX_8822C)) -+#define BIT_GET_RX_MED_TH_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_MED_TH_IDX_8822C) & BIT_MASK_RX_MED_TH_IDX_8822C) -+#define BIT_SET_RX_MED_TH_IDX_8822C(x, v) \ -+ (BIT_CLEAR_RX_MED_TH_IDX_8822C(x) | BIT_RX_MED_TH_IDX_8822C(v)) -+ -+#define BIT_SHIFT_RX_LOW_TH_IDX_8822C 8 -+#define BIT_MASK_RX_LOW_TH_IDX_8822C 0x7 -+#define BIT_RX_LOW_TH_IDX_8822C(x) \ -+ (((x) & BIT_MASK_RX_LOW_TH_IDX_8822C) << BIT_SHIFT_RX_LOW_TH_IDX_8822C) -+#define BITS_RX_LOW_TH_IDX_8822C \ -+ (BIT_MASK_RX_LOW_TH_IDX_8822C << BIT_SHIFT_RX_LOW_TH_IDX_8822C) -+#define BIT_CLEAR_RX_LOW_TH_IDX_8822C(x) ((x) & (~BITS_RX_LOW_TH_IDX_8822C)) -+#define BIT_GET_RX_LOW_TH_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_LOW_TH_IDX_8822C) & BIT_MASK_RX_LOW_TH_IDX_8822C) -+#define BIT_SET_RX_LOW_TH_IDX_8822C(x, v) \ -+ (BIT_CLEAR_RX_LOW_TH_IDX_8822C(x) | BIT_RX_LOW_TH_IDX_8822C(v)) -+ -+#define BIT_SHIFT_LTR_SPACE_IDX_8822C 4 -+#define BIT_MASK_LTR_SPACE_IDX_8822C 0x3 -+#define BIT_LTR_SPACE_IDX_8822C(x) \ -+ (((x) & BIT_MASK_LTR_SPACE_IDX_8822C) << BIT_SHIFT_LTR_SPACE_IDX_8822C) -+#define BITS_LTR_SPACE_IDX_8822C \ -+ (BIT_MASK_LTR_SPACE_IDX_8822C << BIT_SHIFT_LTR_SPACE_IDX_8822C) -+#define BIT_CLEAR_LTR_SPACE_IDX_8822C(x) ((x) & (~BITS_LTR_SPACE_IDX_8822C)) -+#define BIT_GET_LTR_SPACE_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_LTR_SPACE_IDX_8822C) & BIT_MASK_LTR_SPACE_IDX_8822C) -+#define BIT_SET_LTR_SPACE_IDX_8822C(x, v) \ -+ (BIT_CLEAR_LTR_SPACE_IDX_8822C(x) | BIT_LTR_SPACE_IDX_8822C(v)) -+ -+#define BIT_SHIFT_LTR_IDLE_TIMER_IDX_8822C 0 -+#define BIT_MASK_LTR_IDLE_TIMER_IDX_8822C 0x7 -+#define BIT_LTR_IDLE_TIMER_IDX_8822C(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_TIMER_IDX_8822C) \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8822C) -+#define BITS_LTR_IDLE_TIMER_IDX_8822C \ -+ (BIT_MASK_LTR_IDLE_TIMER_IDX_8822C \ -+ << BIT_SHIFT_LTR_IDLE_TIMER_IDX_8822C) -+#define BIT_CLEAR_LTR_IDLE_TIMER_IDX_8822C(x) \ -+ ((x) & (~BITS_LTR_IDLE_TIMER_IDX_8822C)) -+#define BIT_GET_LTR_IDLE_TIMER_IDX_8822C(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_TIMER_IDX_8822C) & \ -+ BIT_MASK_LTR_IDLE_TIMER_IDX_8822C) -+#define BIT_SET_LTR_IDLE_TIMER_IDX_8822C(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_TIMER_IDX_8822C(x) | \ -+ BIT_LTR_IDLE_TIMER_IDX_8822C(v)) -+ -+/* 2 REG_LTR_IDLE_LATENCY_V1_8822C */ -+ -+#define BIT_SHIFT_LTR_IDLE_L_8822C 0 -+#define BIT_MASK_LTR_IDLE_L_8822C 0xffffffffL -+#define BIT_LTR_IDLE_L_8822C(x) \ -+ (((x) & BIT_MASK_LTR_IDLE_L_8822C) << BIT_SHIFT_LTR_IDLE_L_8822C) -+#define BITS_LTR_IDLE_L_8822C \ -+ (BIT_MASK_LTR_IDLE_L_8822C << BIT_SHIFT_LTR_IDLE_L_8822C) -+#define BIT_CLEAR_LTR_IDLE_L_8822C(x) ((x) & (~BITS_LTR_IDLE_L_8822C)) -+#define BIT_GET_LTR_IDLE_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_LTR_IDLE_L_8822C) & BIT_MASK_LTR_IDLE_L_8822C) -+#define BIT_SET_LTR_IDLE_L_8822C(x, v) \ -+ (BIT_CLEAR_LTR_IDLE_L_8822C(x) | BIT_LTR_IDLE_L_8822C(v)) -+ -+/* 2 REG_LTR_ACTIVE_LATENCY_V1_8822C */ -+ -+#define BIT_SHIFT_LTR_ACT_L_8822C 0 -+#define BIT_MASK_LTR_ACT_L_8822C 0xffffffffL -+#define BIT_LTR_ACT_L_8822C(x) \ -+ (((x) & BIT_MASK_LTR_ACT_L_8822C) << BIT_SHIFT_LTR_ACT_L_8822C) -+#define BITS_LTR_ACT_L_8822C \ -+ (BIT_MASK_LTR_ACT_L_8822C << BIT_SHIFT_LTR_ACT_L_8822C) -+#define BIT_CLEAR_LTR_ACT_L_8822C(x) ((x) & (~BITS_LTR_ACT_L_8822C)) -+#define BIT_GET_LTR_ACT_L_8822C(x) \ -+ (((x) >> BIT_SHIFT_LTR_ACT_L_8822C) & BIT_MASK_LTR_ACT_L_8822C) -+#define BIT_SET_LTR_ACT_L_8822C(x, v) \ -+ (BIT_CLEAR_LTR_ACT_L_8822C(x) | BIT_LTR_ACT_L_8822C(v)) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER_8822C */ -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR_0_8822C 0 -+#define BIT_MASK_TRAIN_STA_ADDR_0_8822C 0xffffffffL -+#define BIT_TRAIN_STA_ADDR_0_8822C(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR_0_8822C) \ -+ << BIT_SHIFT_TRAIN_STA_ADDR_0_8822C) -+#define BITS_TRAIN_STA_ADDR_0_8822C \ -+ (BIT_MASK_TRAIN_STA_ADDR_0_8822C << BIT_SHIFT_TRAIN_STA_ADDR_0_8822C) -+#define BIT_CLEAR_TRAIN_STA_ADDR_0_8822C(x) \ -+ ((x) & (~BITS_TRAIN_STA_ADDR_0_8822C)) -+#define BIT_GET_TRAIN_STA_ADDR_0_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR_0_8822C) & \ -+ BIT_MASK_TRAIN_STA_ADDR_0_8822C) -+#define BIT_SET_TRAIN_STA_ADDR_0_8822C(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR_0_8822C(x) | BIT_TRAIN_STA_ADDR_0_8822C(v)) -+ -+/* 2 REG_ANTENNA_TRAINING_CONTROL_REGISTER_1_8822C */ -+#define BIT_ANTTRN_SWITCH_8822C BIT(19) -+#define BIT_APPEND_MACID_IN_RESP_EN_1_8822C BIT(18) -+#define BIT_ADDR2_MATCH_EN_1_8822C BIT(17) -+#define BIT_ANTTRN_EN_1_8822C BIT(16) -+ -+#define BIT_SHIFT_TRAIN_STA_ADDR_1_8822C 0 -+#define BIT_MASK_TRAIN_STA_ADDR_1_8822C 0xffff -+#define BIT_TRAIN_STA_ADDR_1_8822C(x) \ -+ (((x) & BIT_MASK_TRAIN_STA_ADDR_1_8822C) \ -+ << BIT_SHIFT_TRAIN_STA_ADDR_1_8822C) -+#define BITS_TRAIN_STA_ADDR_1_8822C \ -+ (BIT_MASK_TRAIN_STA_ADDR_1_8822C << BIT_SHIFT_TRAIN_STA_ADDR_1_8822C) -+#define BIT_CLEAR_TRAIN_STA_ADDR_1_8822C(x) \ -+ ((x) & (~BITS_TRAIN_STA_ADDR_1_8822C)) -+#define BIT_GET_TRAIN_STA_ADDR_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_TRAIN_STA_ADDR_1_8822C) & \ -+ BIT_MASK_TRAIN_STA_ADDR_1_8822C) -+#define BIT_SET_TRAIN_STA_ADDR_1_8822C(x, v) \ -+ (BIT_CLEAR_TRAIN_STA_ADDR_1_8822C(x) | BIT_TRAIN_STA_ADDR_1_8822C(v)) -+ -+/* 2 REG_WMAC_PKTCNT_RWD_8822C */ -+ -+#define BIT_SHIFT_PKTCNT_BSSIDMAP_8822C 4 -+#define BIT_MASK_PKTCNT_BSSIDMAP_8822C 0xf -+#define BIT_PKTCNT_BSSIDMAP_8822C(x) \ -+ (((x) & BIT_MASK_PKTCNT_BSSIDMAP_8822C) \ -+ << BIT_SHIFT_PKTCNT_BSSIDMAP_8822C) -+#define BITS_PKTCNT_BSSIDMAP_8822C \ -+ (BIT_MASK_PKTCNT_BSSIDMAP_8822C << BIT_SHIFT_PKTCNT_BSSIDMAP_8822C) -+#define BIT_CLEAR_PKTCNT_BSSIDMAP_8822C(x) ((x) & (~BITS_PKTCNT_BSSIDMAP_8822C)) -+#define BIT_GET_PKTCNT_BSSIDMAP_8822C(x) \ -+ (((x) >> BIT_SHIFT_PKTCNT_BSSIDMAP_8822C) & \ -+ BIT_MASK_PKTCNT_BSSIDMAP_8822C) -+#define BIT_SET_PKTCNT_BSSIDMAP_8822C(x, v) \ -+ (BIT_CLEAR_PKTCNT_BSSIDMAP_8822C(x) | BIT_PKTCNT_BSSIDMAP_8822C(v)) -+ -+#define BIT_PKTCNT_CNTRST_8822C BIT(1) -+#define BIT_PKTCNT_CNTEN_8822C BIT(0) -+ -+/* 2 REG_WMAC_PKTCNT_CTRL_8822C */ -+#define BIT_WMAC_PKTCNT_TRST_8822C BIT(9) -+#define BIT_WMAC_PKTCNT_FEN_8822C BIT(8) -+ -+#define BIT_SHIFT_WMAC_PKTCNT_CFGAD_8822C 0 -+#define BIT_MASK_WMAC_PKTCNT_CFGAD_8822C 0xff -+#define BIT_WMAC_PKTCNT_CFGAD_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_PKTCNT_CFGAD_8822C) \ -+ << BIT_SHIFT_WMAC_PKTCNT_CFGAD_8822C) -+#define BITS_WMAC_PKTCNT_CFGAD_8822C \ -+ (BIT_MASK_WMAC_PKTCNT_CFGAD_8822C << BIT_SHIFT_WMAC_PKTCNT_CFGAD_8822C) -+#define BIT_CLEAR_WMAC_PKTCNT_CFGAD_8822C(x) \ -+ ((x) & (~BITS_WMAC_PKTCNT_CFGAD_8822C)) -+#define BIT_GET_WMAC_PKTCNT_CFGAD_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_PKTCNT_CFGAD_8822C) & \ -+ BIT_MASK_WMAC_PKTCNT_CFGAD_8822C) -+#define BIT_SET_WMAC_PKTCNT_CFGAD_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_PKTCNT_CFGAD_8822C(x) | BIT_WMAC_PKTCNT_CFGAD_8822C(v)) -+ -+/* 2 REG_IQ_DUMP_8822C */ -+ -+#define BIT_SHIFT_DUMP_OK_ADDR_8822C 16 -+#define BIT_MASK_DUMP_OK_ADDR_8822C 0xffff -+#define BIT_DUMP_OK_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_DUMP_OK_ADDR_8822C) << BIT_SHIFT_DUMP_OK_ADDR_8822C) -+#define BITS_DUMP_OK_ADDR_8822C \ -+ (BIT_MASK_DUMP_OK_ADDR_8822C << BIT_SHIFT_DUMP_OK_ADDR_8822C) -+#define BIT_CLEAR_DUMP_OK_ADDR_8822C(x) ((x) & (~BITS_DUMP_OK_ADDR_8822C)) -+#define BIT_GET_DUMP_OK_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_DUMP_OK_ADDR_8822C) & BIT_MASK_DUMP_OK_ADDR_8822C) -+#define BIT_SET_DUMP_OK_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_DUMP_OK_ADDR_8822C(x) | BIT_DUMP_OK_ADDR_8822C(v)) -+ -+#define BIT_MACDBG_TRIG_IQDUMP_8822C BIT(15) -+ -+#define BIT_SHIFT_R_TRIG_TIME_SEL_8822C 8 -+#define BIT_MASK_R_TRIG_TIME_SEL_8822C 0x7f -+#define BIT_R_TRIG_TIME_SEL_8822C(x) \ -+ (((x) & BIT_MASK_R_TRIG_TIME_SEL_8822C) \ -+ << BIT_SHIFT_R_TRIG_TIME_SEL_8822C) -+#define BITS_R_TRIG_TIME_SEL_8822C \ -+ (BIT_MASK_R_TRIG_TIME_SEL_8822C << BIT_SHIFT_R_TRIG_TIME_SEL_8822C) -+#define BIT_CLEAR_R_TRIG_TIME_SEL_8822C(x) ((x) & (~BITS_R_TRIG_TIME_SEL_8822C)) -+#define BIT_GET_R_TRIG_TIME_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_TRIG_TIME_SEL_8822C) & \ -+ BIT_MASK_R_TRIG_TIME_SEL_8822C) -+#define BIT_SET_R_TRIG_TIME_SEL_8822C(x, v) \ -+ (BIT_CLEAR_R_TRIG_TIME_SEL_8822C(x) | BIT_R_TRIG_TIME_SEL_8822C(v)) -+ -+#define BIT_SHIFT_R_MAC_TRIG_SEL_8822C 6 -+#define BIT_MASK_R_MAC_TRIG_SEL_8822C 0x3 -+#define BIT_R_MAC_TRIG_SEL_8822C(x) \ -+ (((x) & BIT_MASK_R_MAC_TRIG_SEL_8822C) \ -+ << BIT_SHIFT_R_MAC_TRIG_SEL_8822C) -+#define BITS_R_MAC_TRIG_SEL_8822C \ -+ (BIT_MASK_R_MAC_TRIG_SEL_8822C << BIT_SHIFT_R_MAC_TRIG_SEL_8822C) -+#define BIT_CLEAR_R_MAC_TRIG_SEL_8822C(x) ((x) & (~BITS_R_MAC_TRIG_SEL_8822C)) -+#define BIT_GET_R_MAC_TRIG_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_TRIG_SEL_8822C) & \ -+ BIT_MASK_R_MAC_TRIG_SEL_8822C) -+#define BIT_SET_R_MAC_TRIG_SEL_8822C(x, v) \ -+ (BIT_CLEAR_R_MAC_TRIG_SEL_8822C(x) | BIT_R_MAC_TRIG_SEL_8822C(v)) -+ -+#define BIT_MAC_TRIG_REG_8822C BIT(5) -+ -+#define BIT_SHIFT_R_LEVEL_PULSE_SEL_8822C 3 -+#define BIT_MASK_R_LEVEL_PULSE_SEL_8822C 0x3 -+#define BIT_R_LEVEL_PULSE_SEL_8822C(x) \ -+ (((x) & BIT_MASK_R_LEVEL_PULSE_SEL_8822C) \ -+ << BIT_SHIFT_R_LEVEL_PULSE_SEL_8822C) -+#define BITS_R_LEVEL_PULSE_SEL_8822C \ -+ (BIT_MASK_R_LEVEL_PULSE_SEL_8822C << BIT_SHIFT_R_LEVEL_PULSE_SEL_8822C) -+#define BIT_CLEAR_R_LEVEL_PULSE_SEL_8822C(x) \ -+ ((x) & (~BITS_R_LEVEL_PULSE_SEL_8822C)) -+#define BIT_GET_R_LEVEL_PULSE_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_LEVEL_PULSE_SEL_8822C) & \ -+ BIT_MASK_R_LEVEL_PULSE_SEL_8822C) -+#define BIT_SET_R_LEVEL_PULSE_SEL_8822C(x, v) \ -+ (BIT_CLEAR_R_LEVEL_PULSE_SEL_8822C(x) | BIT_R_LEVEL_PULSE_SEL_8822C(v)) -+ -+#define BIT_EN_LA_MAC_8822C BIT(2) -+#define BIT_R_EN_IQDUMP_8822C BIT(1) -+#define BIT_R_IQDATA_DUMP_8822C BIT(0) -+ -+/* 2 REG_IQ_DUMP_1_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8822C 0 -+#define BIT_MASK_R_WMAC_MASK_LA_MAC_1_8822C 0xffffffffL -+#define BIT_R_WMAC_MASK_LA_MAC_1_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_MASK_LA_MAC_1_8822C) \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8822C) -+#define BITS_R_WMAC_MASK_LA_MAC_1_8822C \ -+ (BIT_MASK_R_WMAC_MASK_LA_MAC_1_8822C \ -+ << BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8822C) -+#define BIT_CLEAR_R_WMAC_MASK_LA_MAC_1_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_MASK_LA_MAC_1_8822C)) -+#define BIT_GET_R_WMAC_MASK_LA_MAC_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MASK_LA_MAC_1_8822C) & \ -+ BIT_MASK_R_WMAC_MASK_LA_MAC_1_8822C) -+#define BIT_SET_R_WMAC_MASK_LA_MAC_1_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_MASK_LA_MAC_1_8822C(x) | \ -+ BIT_R_WMAC_MASK_LA_MAC_1_8822C(v)) -+ -+/* 2 REG_IQ_DUMP_2_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8822C 0 -+#define BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8822C 0xffffffffL -+#define BIT_R_WMAC_MATCH_REF_MAC_2_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8822C) \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8822C) -+#define BITS_R_WMAC_MATCH_REF_MAC_2_8822C \ -+ (BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8822C \ -+ << BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8822C) -+#define BIT_CLEAR_R_WMAC_MATCH_REF_MAC_2_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_MATCH_REF_MAC_2_8822C)) -+#define BIT_GET_R_WMAC_MATCH_REF_MAC_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_MATCH_REF_MAC_2_8822C) & \ -+ BIT_MASK_R_WMAC_MATCH_REF_MAC_2_8822C) -+#define BIT_SET_R_WMAC_MATCH_REF_MAC_2_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_MATCH_REF_MAC_2_8822C(x) | \ -+ BIT_R_WMAC_MATCH_REF_MAC_2_8822C(v)) -+ -+/* 2 REG_WMAC_FTM_CTL_8822C */ -+#define BIT_RXFTM_TXACK_SC_8822C BIT(6) -+#define BIT_RXFTM_TXACK_BW_8822C BIT(5) -+#define BIT_RXFTM_EN_8822C BIT(3) -+#define BIT_RXFTMREQ_BYDRV_8822C BIT(2) -+#define BIT_RXFTMREQ_EN_8822C BIT(1) -+#define BIT_FTM_EN_8822C BIT(0) -+ -+/* 2 REG_WMAC_IQ_MDPK_FUNC_8822C */ -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_8822C */ -+ -+#define BIT_SHIFT_R_OFDM_LEN_V1_8822C 16 -+#define BIT_MASK_R_OFDM_LEN_V1_8822C 0xffff -+#define BIT_R_OFDM_LEN_V1_8822C(x) \ -+ (((x) & BIT_MASK_R_OFDM_LEN_V1_8822C) << BIT_SHIFT_R_OFDM_LEN_V1_8822C) -+#define BITS_R_OFDM_LEN_V1_8822C \ -+ (BIT_MASK_R_OFDM_LEN_V1_8822C << BIT_SHIFT_R_OFDM_LEN_V1_8822C) -+#define BIT_CLEAR_R_OFDM_LEN_V1_8822C(x) ((x) & (~BITS_R_OFDM_LEN_V1_8822C)) -+#define BIT_GET_R_OFDM_LEN_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_OFDM_LEN_V1_8822C) & BIT_MASK_R_OFDM_LEN_V1_8822C) -+#define BIT_SET_R_OFDM_LEN_V1_8822C(x, v) \ -+ (BIT_CLEAR_R_OFDM_LEN_V1_8822C(x) | BIT_R_OFDM_LEN_V1_8822C(v)) -+ -+#define BIT_SHIFT_R_CCK_LEN_8822C 0 -+#define BIT_MASK_R_CCK_LEN_8822C 0xffff -+#define BIT_R_CCK_LEN_8822C(x) \ -+ (((x) & BIT_MASK_R_CCK_LEN_8822C) << BIT_SHIFT_R_CCK_LEN_8822C) -+#define BITS_R_CCK_LEN_8822C \ -+ (BIT_MASK_R_CCK_LEN_8822C << BIT_SHIFT_R_CCK_LEN_8822C) -+#define BIT_CLEAR_R_CCK_LEN_8822C(x) ((x) & (~BITS_R_CCK_LEN_8822C)) -+#define BIT_GET_R_CCK_LEN_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_CCK_LEN_8822C) & BIT_MASK_R_CCK_LEN_8822C) -+#define BIT_SET_R_CCK_LEN_8822C(x, v) \ -+ (BIT_CLEAR_R_CCK_LEN_8822C(x) | BIT_R_CCK_LEN_8822C(v)) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_1_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8822C 24 -+#define BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8822C 0xff -+#define BIT_R_WMAC_RXFIFO_FULL_TH_1_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8822C) \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8822C) -+#define BITS_R_WMAC_RXFIFO_FULL_TH_1_8822C \ -+ (BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8822C \ -+ << BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8822C) -+#define BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_1_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_RXFIFO_FULL_TH_1_8822C)) -+#define BIT_GET_R_WMAC_RXFIFO_FULL_TH_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RXFIFO_FULL_TH_1_8822C) & \ -+ BIT_MASK_R_WMAC_RXFIFO_FULL_TH_1_8822C) -+#define BIT_SET_R_WMAC_RXFIFO_FULL_TH_1_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_RXFIFO_FULL_TH_1_8822C(x) | \ -+ BIT_R_WMAC_RXFIFO_FULL_TH_1_8822C(v)) -+ -+#define BIT_R_WMAC_RX_SYNCFIFO_SYNC_1_8822C BIT(23) -+#define BIT_R_WMAC_RXRST_DLY_1_8822C BIT(22) -+#define BIT_R_WMAC_SRCH_TXRPT_REF_DROP_1_8822C BIT(21) -+#define BIT_R_WMAC_SRCH_TXRPT_UA1_1_8822C BIT(20) -+#define BIT_R_WMAC_SRCH_TXRPT_TYPE_1_8822C BIT(19) -+#define BIT_R_WMAC_NDP_RST_1_8822C BIT(18) -+#define BIT_R_WMAC_POWINT_EN_1_8822C BIT(17) -+#define BIT_R_WMAC_SRCH_TXRPT_PERPKT_1_8822C BIT(16) -+#define BIT_R_WMAC_SRCH_TXRPT_MID_1_8822C BIT(15) -+#define BIT_R_WMAC_PFIN_TOEN_1_8822C BIT(14) -+#define BIT_R_WMAC_FIL_SECERR_1_8822C BIT(13) -+#define BIT_R_WMAC_FIL_CTLPKTLEN_1_8822C BIT(12) -+#define BIT_R_WMAC_FIL_FCTYPE_1_8822C BIT(11) -+#define BIT_R_WMAC_FIL_FCPROVER_1_8822C BIT(10) -+#define BIT_R_WMAC_PHYSTS_SNIF_1_8822C BIT(9) -+#define BIT_R_WMAC_PHYSTS_PLCP_1_8822C BIT(8) -+#define BIT_R_MAC_TCR_VBONF_RD_1_8822C BIT(7) -+#define BIT_R_WMAC_TCR_MPAR_NDP_1_8822C BIT(6) -+#define BIT_R_WMAC_NDP_FILTER_1_8822C BIT(5) -+#define BIT_R_WMAC_RXLEN_SEL_1_8822C BIT(4) -+#define BIT_R_WMAC_RXLEN_SEL1_1_8822C BIT(3) -+#define BIT_R_OFDM_FILTER_1_8822C BIT(2) -+#define BIT_R_WMAC_CHK_OFDM_LEN_1_8822C BIT(1) -+#define BIT_R_WMAC_CHK_CCK_LEN_1_8822C BIT(0) -+ -+/* 2 REG_WMAC_OPTION_FUNCTION_2_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8822C 0 -+#define BIT_MASK_R_WMAC_RX_FIL_LEN_2_8822C 0xffff -+#define BIT_R_WMAC_RX_FIL_LEN_2_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_RX_FIL_LEN_2_8822C) \ -+ << BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8822C) -+#define BITS_R_WMAC_RX_FIL_LEN_2_8822C \ -+ (BIT_MASK_R_WMAC_RX_FIL_LEN_2_8822C \ -+ << BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8822C) -+#define BIT_CLEAR_R_WMAC_RX_FIL_LEN_2_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_RX_FIL_LEN_2_8822C)) -+#define BIT_GET_R_WMAC_RX_FIL_LEN_2_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_RX_FIL_LEN_2_8822C) & \ -+ BIT_MASK_R_WMAC_RX_FIL_LEN_2_8822C) -+#define BIT_SET_R_WMAC_RX_FIL_LEN_2_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_RX_FIL_LEN_2_8822C(x) | \ -+ BIT_R_WMAC_RX_FIL_LEN_2_8822C(v)) -+ -+/* 2 REG_RX_FILTER_FUNCTION_8822C */ -+#define BIT_RXHANG_EN_8822C BIT(15) -+#define BIT_R_WMAC_MHRDDY_LATCH_8822C BIT(14) -+#define BIT_R_WMAC_MHRDDY_CLR_8822C BIT(13) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY1_8822C BIT(12) -+#define BIT_WMAC_DIS_VHT_PLCP_CHK_MU_8822C BIT(11) -+#define BIT_R_CHK_DELIMIT_LEN_8822C BIT(10) -+#define BIT_R_REAPTER_ADDR_MATCH_8822C BIT(9) -+#define BIT_R_RXPKTCTL_FSM_BASED_MPDURDY_8822C BIT(8) -+#define BIT_R_LATCH_MACHRDY_8822C BIT(7) -+#define BIT_R_WMAC_RXFIL_REND_8822C BIT(6) -+#define BIT_R_WMAC_MPDURDY_CLR_8822C BIT(5) -+#define BIT_R_WMAC_CLRRXSEC_8822C BIT(4) -+#define BIT_R_WMAC_RXFIL_RDEL_8822C BIT(3) -+#define BIT_R_WMAC_RXFIL_FCSE_8822C BIT(2) -+#define BIT_R_WMAC_RXFIL_MESH_DEL_8822C BIT(1) -+#define BIT_R_WMAC_RXFIL_MASKM_8822C BIT(0) -+ -+/* 2 REG_NDP_SIG_8822C */ -+ -+#define BIT_SHIFT_R_WMAC_TXNDP_SIGB_8822C 0 -+#define BIT_MASK_R_WMAC_TXNDP_SIGB_8822C 0x1fffff -+#define BIT_R_WMAC_TXNDP_SIGB_8822C(x) \ -+ (((x) & BIT_MASK_R_WMAC_TXNDP_SIGB_8822C) \ -+ << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8822C) -+#define BITS_R_WMAC_TXNDP_SIGB_8822C \ -+ (BIT_MASK_R_WMAC_TXNDP_SIGB_8822C << BIT_SHIFT_R_WMAC_TXNDP_SIGB_8822C) -+#define BIT_CLEAR_R_WMAC_TXNDP_SIGB_8822C(x) \ -+ ((x) & (~BITS_R_WMAC_TXNDP_SIGB_8822C)) -+#define BIT_GET_R_WMAC_TXNDP_SIGB_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_WMAC_TXNDP_SIGB_8822C) & \ -+ BIT_MASK_R_WMAC_TXNDP_SIGB_8822C) -+#define BIT_SET_R_WMAC_TXNDP_SIGB_8822C(x, v) \ -+ (BIT_CLEAR_R_WMAC_TXNDP_SIGB_8822C(x) | BIT_R_WMAC_TXNDP_SIGB_8822C(v)) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_8822C */ -+ -+#define BIT_SHIFT_R_MAC_DBG_SHIFT_8822C 8 -+#define BIT_MASK_R_MAC_DBG_SHIFT_8822C 0x7 -+#define BIT_R_MAC_DBG_SHIFT_8822C(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SHIFT_8822C) \ -+ << BIT_SHIFT_R_MAC_DBG_SHIFT_8822C) -+#define BITS_R_MAC_DBG_SHIFT_8822C \ -+ (BIT_MASK_R_MAC_DBG_SHIFT_8822C << BIT_SHIFT_R_MAC_DBG_SHIFT_8822C) -+#define BIT_CLEAR_R_MAC_DBG_SHIFT_8822C(x) ((x) & (~BITS_R_MAC_DBG_SHIFT_8822C)) -+#define BIT_GET_R_MAC_DBG_SHIFT_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SHIFT_8822C) & \ -+ BIT_MASK_R_MAC_DBG_SHIFT_8822C) -+#define BIT_SET_R_MAC_DBG_SHIFT_8822C(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SHIFT_8822C(x) | BIT_R_MAC_DBG_SHIFT_8822C(v)) -+ -+#define BIT_SHIFT_R_MAC_DBG_SEL_8822C 0 -+#define BIT_MASK_R_MAC_DBG_SEL_8822C 0x3 -+#define BIT_R_MAC_DBG_SEL_8822C(x) \ -+ (((x) & BIT_MASK_R_MAC_DBG_SEL_8822C) << BIT_SHIFT_R_MAC_DBG_SEL_8822C) -+#define BITS_R_MAC_DBG_SEL_8822C \ -+ (BIT_MASK_R_MAC_DBG_SEL_8822C << BIT_SHIFT_R_MAC_DBG_SEL_8822C) -+#define BIT_CLEAR_R_MAC_DBG_SEL_8822C(x) ((x) & (~BITS_R_MAC_DBG_SEL_8822C)) -+#define BIT_GET_R_MAC_DBG_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DBG_SEL_8822C) & BIT_MASK_R_MAC_DBG_SEL_8822C) -+#define BIT_SET_R_MAC_DBG_SEL_8822C(x, v) \ -+ (BIT_CLEAR_R_MAC_DBG_SEL_8822C(x) | BIT_R_MAC_DBG_SEL_8822C(v)) -+ -+/* 2 REG_TXCMD_INFO_FOR_RSP_PKT_1_8822C */ -+ -+#define BIT_SHIFT_R_MAC_DEBUG_1_8822C 0 -+#define BIT_MASK_R_MAC_DEBUG_1_8822C 0xffffffffL -+#define BIT_R_MAC_DEBUG_1_8822C(x) \ -+ (((x) & BIT_MASK_R_MAC_DEBUG_1_8822C) << BIT_SHIFT_R_MAC_DEBUG_1_8822C) -+#define BITS_R_MAC_DEBUG_1_8822C \ -+ (BIT_MASK_R_MAC_DEBUG_1_8822C << BIT_SHIFT_R_MAC_DEBUG_1_8822C) -+#define BIT_CLEAR_R_MAC_DEBUG_1_8822C(x) ((x) & (~BITS_R_MAC_DEBUG_1_8822C)) -+#define BIT_GET_R_MAC_DEBUG_1_8822C(x) \ -+ (((x) >> BIT_SHIFT_R_MAC_DEBUG_1_8822C) & BIT_MASK_R_MAC_DEBUG_1_8822C) -+#define BIT_SET_R_MAC_DEBUG_1_8822C(x, v) \ -+ (BIT_CLEAR_R_MAC_DEBUG_1_8822C(x) | BIT_R_MAC_DEBUG_1_8822C(v)) -+ -+/* 2 REG_WSEC_OPTION_8822C */ -+#define BIT_RXDEC_BM_MGNT_8822C BIT(22) -+#define BIT_TXENC_BM_MGNT_8822C BIT(21) -+#define BIT_RXDEC_UNI_MGNT_8822C BIT(20) -+#define BIT_TXENC_UNI_MGNT_8822C BIT(19) -+#define BIT_WMAC_SEC_MASKIV_8822C BIT(18) -+ -+#define BIT_SHIFT_WMAC_SEC_PN_SEL_8822C 16 -+#define BIT_MASK_WMAC_SEC_PN_SEL_8822C 0x3 -+#define BIT_WMAC_SEC_PN_SEL_8822C(x) \ -+ (((x) & BIT_MASK_WMAC_SEC_PN_SEL_8822C) \ -+ << BIT_SHIFT_WMAC_SEC_PN_SEL_8822C) -+#define BITS_WMAC_SEC_PN_SEL_8822C \ -+ (BIT_MASK_WMAC_SEC_PN_SEL_8822C << BIT_SHIFT_WMAC_SEC_PN_SEL_8822C) -+#define BIT_CLEAR_WMAC_SEC_PN_SEL_8822C(x) ((x) & (~BITS_WMAC_SEC_PN_SEL_8822C)) -+#define BIT_GET_WMAC_SEC_PN_SEL_8822C(x) \ -+ (((x) >> BIT_SHIFT_WMAC_SEC_PN_SEL_8822C) & \ -+ BIT_MASK_WMAC_SEC_PN_SEL_8822C) -+#define BIT_SET_WMAC_SEC_PN_SEL_8822C(x, v) \ -+ (BIT_CLEAR_WMAC_SEC_PN_SEL_8822C(x) | BIT_WMAC_SEC_PN_SEL_8822C(v)) -+ -+#define BIT_SHIFT_BT_TIME_CNT_8822C 0 -+#define BIT_MASK_BT_TIME_CNT_8822C 0xff -+#define BIT_BT_TIME_CNT_8822C(x) \ -+ (((x) & BIT_MASK_BT_TIME_CNT_8822C) << BIT_SHIFT_BT_TIME_CNT_8822C) -+#define BITS_BT_TIME_CNT_8822C \ -+ (BIT_MASK_BT_TIME_CNT_8822C << BIT_SHIFT_BT_TIME_CNT_8822C) -+#define BIT_CLEAR_BT_TIME_CNT_8822C(x) ((x) & (~BITS_BT_TIME_CNT_8822C)) -+#define BIT_GET_BT_TIME_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_BT_TIME_CNT_8822C) & BIT_MASK_BT_TIME_CNT_8822C) -+#define BIT_SET_BT_TIME_CNT_8822C(x, v) \ -+ (BIT_CLEAR_BT_TIME_CNT_8822C(x) | BIT_BT_TIME_CNT_8822C(v)) -+ -+/* 2 REG_RTS_ADDRESS_0_8822C */ -+ -+/* 2 REG_RTS_ADDRESS_0_1_8822C */ -+ -+/* 2 REG_RTS_ADDRESS_1_8822C */ -+ -+/* 2 REG_RTS_ADDRESS_1_1_8822C */ -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8822C */ -+#define BIT_LTECOEX_ACCESS_START_V1_8822C BIT(31) -+#define BIT_LTECOEX_WRITE_MODE_V1_8822C BIT(30) -+#define BIT_LTECOEX_READY_BIT_V1_8822C BIT(29) -+ -+#define BIT_SHIFT_WRITE_BYTE_EN_V1_8822C 16 -+#define BIT_MASK_WRITE_BYTE_EN_V1_8822C 0xf -+#define BIT_WRITE_BYTE_EN_V1_8822C(x) \ -+ (((x) & BIT_MASK_WRITE_BYTE_EN_V1_8822C) \ -+ << BIT_SHIFT_WRITE_BYTE_EN_V1_8822C) -+#define BITS_WRITE_BYTE_EN_V1_8822C \ -+ (BIT_MASK_WRITE_BYTE_EN_V1_8822C << BIT_SHIFT_WRITE_BYTE_EN_V1_8822C) -+#define BIT_CLEAR_WRITE_BYTE_EN_V1_8822C(x) \ -+ ((x) & (~BITS_WRITE_BYTE_EN_V1_8822C)) -+#define BIT_GET_WRITE_BYTE_EN_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_WRITE_BYTE_EN_V1_8822C) & \ -+ BIT_MASK_WRITE_BYTE_EN_V1_8822C) -+#define BIT_SET_WRITE_BYTE_EN_V1_8822C(x, v) \ -+ (BIT_CLEAR_WRITE_BYTE_EN_V1_8822C(x) | BIT_WRITE_BYTE_EN_V1_8822C(v)) -+ -+#define BIT_SHIFT_LTECOEX_REG_ADDR_V1_8822C 0 -+#define BIT_MASK_LTECOEX_REG_ADDR_V1_8822C 0xffff -+#define BIT_LTECOEX_REG_ADDR_V1_8822C(x) \ -+ (((x) & BIT_MASK_LTECOEX_REG_ADDR_V1_8822C) \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8822C) -+#define BITS_LTECOEX_REG_ADDR_V1_8822C \ -+ (BIT_MASK_LTECOEX_REG_ADDR_V1_8822C \ -+ << BIT_SHIFT_LTECOEX_REG_ADDR_V1_8822C) -+#define BIT_CLEAR_LTECOEX_REG_ADDR_V1_8822C(x) \ -+ ((x) & (~BITS_LTECOEX_REG_ADDR_V1_8822C)) -+#define BIT_GET_LTECOEX_REG_ADDR_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_REG_ADDR_V1_8822C) & \ -+ BIT_MASK_LTECOEX_REG_ADDR_V1_8822C) -+#define BIT_SET_LTECOEX_REG_ADDR_V1_8822C(x, v) \ -+ (BIT_CLEAR_LTECOEX_REG_ADDR_V1_8822C(x) | \ -+ BIT_LTECOEX_REG_ADDR_V1_8822C(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8822C */ -+ -+#define BIT_SHIFT_LTECOEX_W_DATA_V1_8822C 0 -+#define BIT_MASK_LTECOEX_W_DATA_V1_8822C 0xffffffffL -+#define BIT_LTECOEX_W_DATA_V1_8822C(x) \ -+ (((x) & BIT_MASK_LTECOEX_W_DATA_V1_8822C) \ -+ << BIT_SHIFT_LTECOEX_W_DATA_V1_8822C) -+#define BITS_LTECOEX_W_DATA_V1_8822C \ -+ (BIT_MASK_LTECOEX_W_DATA_V1_8822C << BIT_SHIFT_LTECOEX_W_DATA_V1_8822C) -+#define BIT_CLEAR_LTECOEX_W_DATA_V1_8822C(x) \ -+ ((x) & (~BITS_LTECOEX_W_DATA_V1_8822C)) -+#define BIT_GET_LTECOEX_W_DATA_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_W_DATA_V1_8822C) & \ -+ BIT_MASK_LTECOEX_W_DATA_V1_8822C) -+#define BIT_SET_LTECOEX_W_DATA_V1_8822C(x, v) \ -+ (BIT_CLEAR_LTECOEX_W_DATA_V1_8822C(x) | BIT_LTECOEX_W_DATA_V1_8822C(v)) -+ -+/* 2 REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8822C */ -+ -+#define BIT_SHIFT_LTECOEX_R_DATA_V1_8822C 0 -+#define BIT_MASK_LTECOEX_R_DATA_V1_8822C 0xffffffffL -+#define BIT_LTECOEX_R_DATA_V1_8822C(x) \ -+ (((x) & BIT_MASK_LTECOEX_R_DATA_V1_8822C) \ -+ << BIT_SHIFT_LTECOEX_R_DATA_V1_8822C) -+#define BITS_LTECOEX_R_DATA_V1_8822C \ -+ (BIT_MASK_LTECOEX_R_DATA_V1_8822C << BIT_SHIFT_LTECOEX_R_DATA_V1_8822C) -+#define BIT_CLEAR_LTECOEX_R_DATA_V1_8822C(x) \ -+ ((x) & (~BITS_LTECOEX_R_DATA_V1_8822C)) -+#define BIT_GET_LTECOEX_R_DATA_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_LTECOEX_R_DATA_V1_8822C) & \ -+ BIT_MASK_LTECOEX_R_DATA_V1_8822C) -+#define BIT_SET_LTECOEX_R_DATA_V1_8822C(x, v) \ -+ (BIT_CLEAR_LTECOEX_R_DATA_V1_8822C(x) | BIT_LTECOEX_R_DATA_V1_8822C(v)) -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_NOT_VALID_8822C */ -+ -+/* 2 REG_SDIO_TX_CTRL_8822C */ -+ -+#define BIT_SHIFT_SDIO_INT_TIMEOUT_8822C 16 -+#define BIT_MASK_SDIO_INT_TIMEOUT_8822C 0xffff -+#define BIT_SDIO_INT_TIMEOUT_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_INT_TIMEOUT_8822C) \ -+ << BIT_SHIFT_SDIO_INT_TIMEOUT_8822C) -+#define BITS_SDIO_INT_TIMEOUT_8822C \ -+ (BIT_MASK_SDIO_INT_TIMEOUT_8822C << BIT_SHIFT_SDIO_INT_TIMEOUT_8822C) -+#define BIT_CLEAR_SDIO_INT_TIMEOUT_8822C(x) \ -+ ((x) & (~BITS_SDIO_INT_TIMEOUT_8822C)) -+#define BIT_GET_SDIO_INT_TIMEOUT_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_INT_TIMEOUT_8822C) & \ -+ BIT_MASK_SDIO_INT_TIMEOUT_8822C) -+#define BIT_SET_SDIO_INT_TIMEOUT_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_INT_TIMEOUT_8822C(x) | BIT_SDIO_INT_TIMEOUT_8822C(v)) -+ -+#define BIT_IO_ERR_STATUS_8822C BIT(15) -+#define BIT_CMD53_W_MIX_8822C BIT(14) -+#define BIT_CMD53_TX_FORMAT_8822C BIT(13) -+#define BIT_CMD53_R_TIMEOUT_MASK_8822C BIT(12) -+ -+#define BIT_SHIFT_CMD53_R_TIMEOUT_UNIT_8822C 10 -+#define BIT_MASK_CMD53_R_TIMEOUT_UNIT_8822C 0x3 -+#define BIT_CMD53_R_TIMEOUT_UNIT_8822C(x) \ -+ (((x) & BIT_MASK_CMD53_R_TIMEOUT_UNIT_8822C) \ -+ << BIT_SHIFT_CMD53_R_TIMEOUT_UNIT_8822C) -+#define BITS_CMD53_R_TIMEOUT_UNIT_8822C \ -+ (BIT_MASK_CMD53_R_TIMEOUT_UNIT_8822C \ -+ << BIT_SHIFT_CMD53_R_TIMEOUT_UNIT_8822C) -+#define BIT_CLEAR_CMD53_R_TIMEOUT_UNIT_8822C(x) \ -+ ((x) & (~BITS_CMD53_R_TIMEOUT_UNIT_8822C)) -+#define BIT_GET_CMD53_R_TIMEOUT_UNIT_8822C(x) \ -+ (((x) >> BIT_SHIFT_CMD53_R_TIMEOUT_UNIT_8822C) & \ -+ BIT_MASK_CMD53_R_TIMEOUT_UNIT_8822C) -+#define BIT_SET_CMD53_R_TIMEOUT_UNIT_8822C(x, v) \ -+ (BIT_CLEAR_CMD53_R_TIMEOUT_UNIT_8822C(x) | \ -+ BIT_CMD53_R_TIMEOUT_UNIT_8822C(v)) -+ -+#define BIT_REPLY_ERRCRC_IN_DATA_8822C BIT(9) -+#define BIT_EN_CMD53_OVERLAP_8822C BIT(8) -+#define BIT_REPLY_ERR_IN_R5_8822C BIT(7) -+#define BIT_R18A_EN_8822C BIT(6) -+#define BIT_SDIO_CMD_FORCE_VLD_8822C BIT(5) -+#define BIT_INIT_CMD_EN_8822C BIT(4) -+#define BIT_RXINT_READ_MASK_DIS_8822C BIT(3) -+#define BIT_EN_RXDMA_MASK_INT_8822C BIT(2) -+#define BIT_EN_MASK_TIMER_8822C BIT(1) -+#define BIT_CMD_ERR_STOP_INT_EN_8822C BIT(0) -+ -+/* 2 REG_SDIO_CMD11_VOL_SWITCH_8822C */ -+ -+#define BIT_SHIFT_CMD11_SEQ_END_DELAY_8822C 4 -+#define BIT_MASK_CMD11_SEQ_END_DELAY_8822C 0xf -+#define BIT_CMD11_SEQ_END_DELAY_8822C(x) \ -+ (((x) & BIT_MASK_CMD11_SEQ_END_DELAY_8822C) \ -+ << BIT_SHIFT_CMD11_SEQ_END_DELAY_8822C) -+#define BITS_CMD11_SEQ_END_DELAY_8822C \ -+ (BIT_MASK_CMD11_SEQ_END_DELAY_8822C \ -+ << BIT_SHIFT_CMD11_SEQ_END_DELAY_8822C) -+#define BIT_CLEAR_CMD11_SEQ_END_DELAY_8822C(x) \ -+ ((x) & (~BITS_CMD11_SEQ_END_DELAY_8822C)) -+#define BIT_GET_CMD11_SEQ_END_DELAY_8822C(x) \ -+ (((x) >> BIT_SHIFT_CMD11_SEQ_END_DELAY_8822C) & \ -+ BIT_MASK_CMD11_SEQ_END_DELAY_8822C) -+#define BIT_SET_CMD11_SEQ_END_DELAY_8822C(x, v) \ -+ (BIT_CLEAR_CMD11_SEQ_END_DELAY_8822C(x) | \ -+ BIT_CMD11_SEQ_END_DELAY_8822C(v)) -+ -+#define BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL_8822C 1 -+#define BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL_8822C 0x7 -+#define BIT_CMD11_SEQ_SAMPLE_INTERVAL_8822C(x) \ -+ (((x) & BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL_8822C) \ -+ << BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL_8822C) -+#define BITS_CMD11_SEQ_SAMPLE_INTERVAL_8822C \ -+ (BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL_8822C \ -+ << BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL_8822C) -+#define BIT_CLEAR_CMD11_SEQ_SAMPLE_INTERVAL_8822C(x) \ -+ ((x) & (~BITS_CMD11_SEQ_SAMPLE_INTERVAL_8822C)) -+#define BIT_GET_CMD11_SEQ_SAMPLE_INTERVAL_8822C(x) \ -+ (((x) >> BIT_SHIFT_CMD11_SEQ_SAMPLE_INTERVAL_8822C) & \ -+ BIT_MASK_CMD11_SEQ_SAMPLE_INTERVAL_8822C) -+#define BIT_SET_CMD11_SEQ_SAMPLE_INTERVAL_8822C(x, v) \ -+ (BIT_CLEAR_CMD11_SEQ_SAMPLE_INTERVAL_8822C(x) | \ -+ BIT_CMD11_SEQ_SAMPLE_INTERVAL_8822C(v)) -+ -+#define BIT_CMD11_SEQ_EN_8822C BIT(0) -+ -+/* 2 REG_SDIO_CTRL_8822C */ -+#define BIT_SIG_OUT_PH_8822C BIT(0) -+ -+/* 2 REG_SDIO_DRIVING_8822C */ -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_D_8822C 12 -+#define BIT_MASK_SDIO_DRV_TYPE_D_8822C 0xf -+#define BIT_SDIO_DRV_TYPE_D_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_D_8822C) \ -+ << BIT_SHIFT_SDIO_DRV_TYPE_D_8822C) -+#define BITS_SDIO_DRV_TYPE_D_8822C \ -+ (BIT_MASK_SDIO_DRV_TYPE_D_8822C << BIT_SHIFT_SDIO_DRV_TYPE_D_8822C) -+#define BIT_CLEAR_SDIO_DRV_TYPE_D_8822C(x) ((x) & (~BITS_SDIO_DRV_TYPE_D_8822C)) -+#define BIT_GET_SDIO_DRV_TYPE_D_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_D_8822C) & \ -+ BIT_MASK_SDIO_DRV_TYPE_D_8822C) -+#define BIT_SET_SDIO_DRV_TYPE_D_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_D_8822C(x) | BIT_SDIO_DRV_TYPE_D_8822C(v)) -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_C_8822C 8 -+#define BIT_MASK_SDIO_DRV_TYPE_C_8822C 0xf -+#define BIT_SDIO_DRV_TYPE_C_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_C_8822C) \ -+ << BIT_SHIFT_SDIO_DRV_TYPE_C_8822C) -+#define BITS_SDIO_DRV_TYPE_C_8822C \ -+ (BIT_MASK_SDIO_DRV_TYPE_C_8822C << BIT_SHIFT_SDIO_DRV_TYPE_C_8822C) -+#define BIT_CLEAR_SDIO_DRV_TYPE_C_8822C(x) ((x) & (~BITS_SDIO_DRV_TYPE_C_8822C)) -+#define BIT_GET_SDIO_DRV_TYPE_C_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_C_8822C) & \ -+ BIT_MASK_SDIO_DRV_TYPE_C_8822C) -+#define BIT_SET_SDIO_DRV_TYPE_C_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_C_8822C(x) | BIT_SDIO_DRV_TYPE_C_8822C(v)) -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_B_8822C 4 -+#define BIT_MASK_SDIO_DRV_TYPE_B_8822C 0xf -+#define BIT_SDIO_DRV_TYPE_B_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_B_8822C) \ -+ << BIT_SHIFT_SDIO_DRV_TYPE_B_8822C) -+#define BITS_SDIO_DRV_TYPE_B_8822C \ -+ (BIT_MASK_SDIO_DRV_TYPE_B_8822C << BIT_SHIFT_SDIO_DRV_TYPE_B_8822C) -+#define BIT_CLEAR_SDIO_DRV_TYPE_B_8822C(x) ((x) & (~BITS_SDIO_DRV_TYPE_B_8822C)) -+#define BIT_GET_SDIO_DRV_TYPE_B_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_B_8822C) & \ -+ BIT_MASK_SDIO_DRV_TYPE_B_8822C) -+#define BIT_SET_SDIO_DRV_TYPE_B_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_B_8822C(x) | BIT_SDIO_DRV_TYPE_B_8822C(v)) -+ -+#define BIT_SHIFT_SDIO_DRV_TYPE_A_8822C 0 -+#define BIT_MASK_SDIO_DRV_TYPE_A_8822C 0xf -+#define BIT_SDIO_DRV_TYPE_A_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_DRV_TYPE_A_8822C) \ -+ << BIT_SHIFT_SDIO_DRV_TYPE_A_8822C) -+#define BITS_SDIO_DRV_TYPE_A_8822C \ -+ (BIT_MASK_SDIO_DRV_TYPE_A_8822C << BIT_SHIFT_SDIO_DRV_TYPE_A_8822C) -+#define BIT_CLEAR_SDIO_DRV_TYPE_A_8822C(x) ((x) & (~BITS_SDIO_DRV_TYPE_A_8822C)) -+#define BIT_GET_SDIO_DRV_TYPE_A_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DRV_TYPE_A_8822C) & \ -+ BIT_MASK_SDIO_DRV_TYPE_A_8822C) -+#define BIT_SET_SDIO_DRV_TYPE_A_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_DRV_TYPE_A_8822C(x) | BIT_SDIO_DRV_TYPE_A_8822C(v)) -+ -+/* 2 REG_SDIO_MONITOR_8822C */ -+ -+#define BIT_SHIFT_SDIO_INT_START_8822C 0 -+#define BIT_MASK_SDIO_INT_START_8822C 0xffffffffL -+#define BIT_SDIO_INT_START_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_INT_START_8822C) \ -+ << BIT_SHIFT_SDIO_INT_START_8822C) -+#define BITS_SDIO_INT_START_8822C \ -+ (BIT_MASK_SDIO_INT_START_8822C << BIT_SHIFT_SDIO_INT_START_8822C) -+#define BIT_CLEAR_SDIO_INT_START_8822C(x) ((x) & (~BITS_SDIO_INT_START_8822C)) -+#define BIT_GET_SDIO_INT_START_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_INT_START_8822C) & \ -+ BIT_MASK_SDIO_INT_START_8822C) -+#define BIT_SET_SDIO_INT_START_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_INT_START_8822C(x) | BIT_SDIO_INT_START_8822C(v)) -+ -+/* 2 REG_SDIO_MONITOR_2_8822C */ -+#define BIT_CMD53_WT_EN_8822C BIT(23) -+ -+#define BIT_SHIFT_SDIO_CLK_MONITOR_8822C 21 -+#define BIT_MASK_SDIO_CLK_MONITOR_8822C 0x3 -+#define BIT_SDIO_CLK_MONITOR_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_CLK_MONITOR_8822C) \ -+ << BIT_SHIFT_SDIO_CLK_MONITOR_8822C) -+#define BITS_SDIO_CLK_MONITOR_8822C \ -+ (BIT_MASK_SDIO_CLK_MONITOR_8822C << BIT_SHIFT_SDIO_CLK_MONITOR_8822C) -+#define BIT_CLEAR_SDIO_CLK_MONITOR_8822C(x) \ -+ ((x) & (~BITS_SDIO_CLK_MONITOR_8822C)) -+#define BIT_GET_SDIO_CLK_MONITOR_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CLK_MONITOR_8822C) & \ -+ BIT_MASK_SDIO_CLK_MONITOR_8822C) -+#define BIT_SET_SDIO_CLK_MONITOR_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_CLK_MONITOR_8822C(x) | BIT_SDIO_CLK_MONITOR_8822C(v)) -+ -+#define BIT_SHIFT_SDIO_CLK_CNT_8822C 0 -+#define BIT_MASK_SDIO_CLK_CNT_8822C 0x1fffff -+#define BIT_SDIO_CLK_CNT_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_CLK_CNT_8822C) << BIT_SHIFT_SDIO_CLK_CNT_8822C) -+#define BITS_SDIO_CLK_CNT_8822C \ -+ (BIT_MASK_SDIO_CLK_CNT_8822C << BIT_SHIFT_SDIO_CLK_CNT_8822C) -+#define BIT_CLEAR_SDIO_CLK_CNT_8822C(x) ((x) & (~BITS_SDIO_CLK_CNT_8822C)) -+#define BIT_GET_SDIO_CLK_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CLK_CNT_8822C) & BIT_MASK_SDIO_CLK_CNT_8822C) -+#define BIT_SET_SDIO_CLK_CNT_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_CLK_CNT_8822C(x) | BIT_SDIO_CLK_CNT_8822C(v)) -+ -+/* 2 REG_SDIO_HIMR_8822C */ -+#define BIT_SDIO_CRCERR_MSK_8822C BIT(31) -+#define BIT_SDIO_HSISR3_IND_MSK_8822C BIT(30) -+#define BIT_SDIO_HSISR2_IND_MSK_8822C BIT(29) -+#define BIT_SDIO_HEISR_IND_MSK_8822C BIT(28) -+#define BIT_SDIO_CTWEND_MSK_8822C BIT(27) -+#define BIT_SDIO_ATIMEND_E_MSK_8822C BIT(26) -+#define BIT_SDIIO_ATIMEND_MSK_8822C BIT(25) -+#define BIT_SDIO_OCPINT_MSK_8822C BIT(24) -+#define BIT_SDIO_PSTIMEOUT_MSK_8822C BIT(23) -+#define BIT_SDIO_GTINT4_MSK_8822C BIT(22) -+#define BIT_SDIO_GTINT3_MSK_8822C BIT(21) -+#define BIT_SDIO_HSISR_IND_MSK_8822C BIT(20) -+#define BIT_SDIO_CPWM2_MSK_8822C BIT(19) -+#define BIT_SDIO_CPWM1_MSK_8822C BIT(18) -+#define BIT_SDIO_C2HCMD_INT_MSK_8822C BIT(17) -+#define BIT_SDIO_BCNERLY_INT_MSK_8822C BIT(16) -+#define BIT_BT_INT_MASK_8822C BIT(8) -+#define BIT_SDIO_TXBCNERR_MSK_8822C BIT(7) -+#define BIT_SDIO_TXBCNOK_MSK_8822C BIT(6) -+#define BIT_SDIO_RXFOVW_MSK_8822C BIT(5) -+#define BIT_SDIO_TXFOVW_MSK_8822C BIT(4) -+#define BIT_SDIO_RXERR_MSK_8822C BIT(3) -+#define BIT_SDIO_TXERR_MSK_8822C BIT(2) -+#define BIT_SDIO_AVAL_MSK_8822C BIT(1) -+#define BIT_RX_REQUEST_MSK_8822C BIT(0) -+ -+/* 2 REG_SDIO_HISR_8822C */ -+#define BIT_SDIO_CRCERR_8822C BIT(31) -+#define BIT_SDIO_HSISR3_IND_8822C BIT(30) -+#define BIT_SDIO_HSISR2_IND_8822C BIT(29) -+#define BIT_SDIO_HEISR_IND_8822C BIT(28) -+#define BIT_SDIO_CTWEND_8822C BIT(27) -+#define BIT_SDIO_ATIMEND_E_8822C BIT(26) -+#define BIT_SDIO_ATIMEND_8822C BIT(25) -+#define BIT_SDIO_OCPINT_8822C BIT(24) -+#define BIT_SDIO_PSTIMEOUT_8822C BIT(23) -+#define BIT_SDIO_GTINT4_8822C BIT(22) -+#define BIT_SDIO_GTINT3_8822C BIT(21) -+#define BIT_SDIO_HSISR_IND_8822C BIT(20) -+#define BIT_SDIO_CPWM2_8822C BIT(19) -+#define BIT_SDIO_CPWM1_8822C BIT(18) -+#define BIT_SDIO_C2HCMD_INT_8822C BIT(17) -+#define BIT_SDIO_BCNERLY_INT_8822C BIT(16) -+#define BIT_BT_INT_8822C BIT(8) -+#define BIT_SDIO_TXBCNERR_8822C BIT(7) -+#define BIT_SDIO_TXBCNOK_8822C BIT(6) -+#define BIT_SDIO_RXFOVW_8822C BIT(5) -+#define BIT_SDIO_TXFOVW_8822C BIT(4) -+#define BIT_SDIO_RXERR_8822C BIT(3) -+#define BIT_SDIO_TXERR_8822C BIT(2) -+#define BIT_SDIO_AVAL_8822C BIT(1) -+#define BIT_RX_REQUEST_8822C BIT(0) -+ -+/* 2 REG_SDIO_RX_REQ_LEN_8822C */ -+ -+#define BIT_SHIFT_RX_REQ_LEN_V1_8822C 0 -+#define BIT_MASK_RX_REQ_LEN_V1_8822C 0x3ffff -+#define BIT_RX_REQ_LEN_V1_8822C(x) \ -+ (((x) & BIT_MASK_RX_REQ_LEN_V1_8822C) << BIT_SHIFT_RX_REQ_LEN_V1_8822C) -+#define BITS_RX_REQ_LEN_V1_8822C \ -+ (BIT_MASK_RX_REQ_LEN_V1_8822C << BIT_SHIFT_RX_REQ_LEN_V1_8822C) -+#define BIT_CLEAR_RX_REQ_LEN_V1_8822C(x) ((x) & (~BITS_RX_REQ_LEN_V1_8822C)) -+#define BIT_GET_RX_REQ_LEN_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_RX_REQ_LEN_V1_8822C) & BIT_MASK_RX_REQ_LEN_V1_8822C) -+#define BIT_SET_RX_REQ_LEN_V1_8822C(x, v) \ -+ (BIT_CLEAR_RX_REQ_LEN_V1_8822C(x) | BIT_RX_REQ_LEN_V1_8822C(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG_SEQ_V1_8822C */ -+ -+#define BIT_SHIFT_FREE_TXPG_SEQ_8822C 0 -+#define BIT_MASK_FREE_TXPG_SEQ_8822C 0xff -+#define BIT_FREE_TXPG_SEQ_8822C(x) \ -+ (((x) & BIT_MASK_FREE_TXPG_SEQ_8822C) << BIT_SHIFT_FREE_TXPG_SEQ_8822C) -+#define BITS_FREE_TXPG_SEQ_8822C \ -+ (BIT_MASK_FREE_TXPG_SEQ_8822C << BIT_SHIFT_FREE_TXPG_SEQ_8822C) -+#define BIT_CLEAR_FREE_TXPG_SEQ_8822C(x) ((x) & (~BITS_FREE_TXPG_SEQ_8822C)) -+#define BIT_GET_FREE_TXPG_SEQ_8822C(x) \ -+ (((x) >> BIT_SHIFT_FREE_TXPG_SEQ_8822C) & BIT_MASK_FREE_TXPG_SEQ_8822C) -+#define BIT_SET_FREE_TXPG_SEQ_8822C(x, v) \ -+ (BIT_CLEAR_FREE_TXPG_SEQ_8822C(x) | BIT_FREE_TXPG_SEQ_8822C(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG_8822C */ -+ -+#define BIT_SHIFT_MID_FREEPG_V1_8822C 16 -+#define BIT_MASK_MID_FREEPG_V1_8822C 0xfff -+#define BIT_MID_FREEPG_V1_8822C(x) \ -+ (((x) & BIT_MASK_MID_FREEPG_V1_8822C) << BIT_SHIFT_MID_FREEPG_V1_8822C) -+#define BITS_MID_FREEPG_V1_8822C \ -+ (BIT_MASK_MID_FREEPG_V1_8822C << BIT_SHIFT_MID_FREEPG_V1_8822C) -+#define BIT_CLEAR_MID_FREEPG_V1_8822C(x) ((x) & (~BITS_MID_FREEPG_V1_8822C)) -+#define BIT_GET_MID_FREEPG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_MID_FREEPG_V1_8822C) & BIT_MASK_MID_FREEPG_V1_8822C) -+#define BIT_SET_MID_FREEPG_V1_8822C(x, v) \ -+ (BIT_CLEAR_MID_FREEPG_V1_8822C(x) | BIT_MID_FREEPG_V1_8822C(v)) -+ -+#define BIT_SHIFT_HIQ_FREEPG_V1_8822C 0 -+#define BIT_MASK_HIQ_FREEPG_V1_8822C 0xfff -+#define BIT_HIQ_FREEPG_V1_8822C(x) \ -+ (((x) & BIT_MASK_HIQ_FREEPG_V1_8822C) << BIT_SHIFT_HIQ_FREEPG_V1_8822C) -+#define BITS_HIQ_FREEPG_V1_8822C \ -+ (BIT_MASK_HIQ_FREEPG_V1_8822C << BIT_SHIFT_HIQ_FREEPG_V1_8822C) -+#define BIT_CLEAR_HIQ_FREEPG_V1_8822C(x) ((x) & (~BITS_HIQ_FREEPG_V1_8822C)) -+#define BIT_GET_HIQ_FREEPG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HIQ_FREEPG_V1_8822C) & BIT_MASK_HIQ_FREEPG_V1_8822C) -+#define BIT_SET_HIQ_FREEPG_V1_8822C(x, v) \ -+ (BIT_CLEAR_HIQ_FREEPG_V1_8822C(x) | BIT_HIQ_FREEPG_V1_8822C(v)) -+ -+/* 2 REG_SDIO_FREE_TXPG2_8822C */ -+ -+#define BIT_SHIFT_PUB_FREEPG_V1_8822C 16 -+#define BIT_MASK_PUB_FREEPG_V1_8822C 0xfff -+#define BIT_PUB_FREEPG_V1_8822C(x) \ -+ (((x) & BIT_MASK_PUB_FREEPG_V1_8822C) << BIT_SHIFT_PUB_FREEPG_V1_8822C) -+#define BITS_PUB_FREEPG_V1_8822C \ -+ (BIT_MASK_PUB_FREEPG_V1_8822C << BIT_SHIFT_PUB_FREEPG_V1_8822C) -+#define BIT_CLEAR_PUB_FREEPG_V1_8822C(x) ((x) & (~BITS_PUB_FREEPG_V1_8822C)) -+#define BIT_GET_PUB_FREEPG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_PUB_FREEPG_V1_8822C) & BIT_MASK_PUB_FREEPG_V1_8822C) -+#define BIT_SET_PUB_FREEPG_V1_8822C(x, v) \ -+ (BIT_CLEAR_PUB_FREEPG_V1_8822C(x) | BIT_PUB_FREEPG_V1_8822C(v)) -+ -+#define BIT_SHIFT_LOW_FREEPG_V1_8822C 0 -+#define BIT_MASK_LOW_FREEPG_V1_8822C 0xfff -+#define BIT_LOW_FREEPG_V1_8822C(x) \ -+ (((x) & BIT_MASK_LOW_FREEPG_V1_8822C) << BIT_SHIFT_LOW_FREEPG_V1_8822C) -+#define BITS_LOW_FREEPG_V1_8822C \ -+ (BIT_MASK_LOW_FREEPG_V1_8822C << BIT_SHIFT_LOW_FREEPG_V1_8822C) -+#define BIT_CLEAR_LOW_FREEPG_V1_8822C(x) ((x) & (~BITS_LOW_FREEPG_V1_8822C)) -+#define BIT_GET_LOW_FREEPG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_LOW_FREEPG_V1_8822C) & BIT_MASK_LOW_FREEPG_V1_8822C) -+#define BIT_SET_LOW_FREEPG_V1_8822C(x, v) \ -+ (BIT_CLEAR_LOW_FREEPG_V1_8822C(x) | BIT_LOW_FREEPG_V1_8822C(v)) -+ -+/* 2 REG_SDIO_OQT_FREE_TXPG_V1_8822C */ -+ -+#define BIT_SHIFT_NOAC_OQT_FREEPG_V1_8822C 24 -+#define BIT_MASK_NOAC_OQT_FREEPG_V1_8822C 0xff -+#define BIT_NOAC_OQT_FREEPG_V1_8822C(x) \ -+ (((x) & BIT_MASK_NOAC_OQT_FREEPG_V1_8822C) \ -+ << BIT_SHIFT_NOAC_OQT_FREEPG_V1_8822C) -+#define BITS_NOAC_OQT_FREEPG_V1_8822C \ -+ (BIT_MASK_NOAC_OQT_FREEPG_V1_8822C \ -+ << BIT_SHIFT_NOAC_OQT_FREEPG_V1_8822C) -+#define BIT_CLEAR_NOAC_OQT_FREEPG_V1_8822C(x) \ -+ ((x) & (~BITS_NOAC_OQT_FREEPG_V1_8822C)) -+#define BIT_GET_NOAC_OQT_FREEPG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_NOAC_OQT_FREEPG_V1_8822C) & \ -+ BIT_MASK_NOAC_OQT_FREEPG_V1_8822C) -+#define BIT_SET_NOAC_OQT_FREEPG_V1_8822C(x, v) \ -+ (BIT_CLEAR_NOAC_OQT_FREEPG_V1_8822C(x) | \ -+ BIT_NOAC_OQT_FREEPG_V1_8822C(v)) -+ -+#define BIT_SHIFT_AC_OQT_FREEPG_V1_8822C 16 -+#define BIT_MASK_AC_OQT_FREEPG_V1_8822C 0xff -+#define BIT_AC_OQT_FREEPG_V1_8822C(x) \ -+ (((x) & BIT_MASK_AC_OQT_FREEPG_V1_8822C) \ -+ << BIT_SHIFT_AC_OQT_FREEPG_V1_8822C) -+#define BITS_AC_OQT_FREEPG_V1_8822C \ -+ (BIT_MASK_AC_OQT_FREEPG_V1_8822C << BIT_SHIFT_AC_OQT_FREEPG_V1_8822C) -+#define BIT_CLEAR_AC_OQT_FREEPG_V1_8822C(x) \ -+ ((x) & (~BITS_AC_OQT_FREEPG_V1_8822C)) -+#define BIT_GET_AC_OQT_FREEPG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_AC_OQT_FREEPG_V1_8822C) & \ -+ BIT_MASK_AC_OQT_FREEPG_V1_8822C) -+#define BIT_SET_AC_OQT_FREEPG_V1_8822C(x, v) \ -+ (BIT_CLEAR_AC_OQT_FREEPG_V1_8822C(x) | BIT_AC_OQT_FREEPG_V1_8822C(v)) -+ -+#define BIT_SHIFT_EXQ_FREEPG_V1_8822C 0 -+#define BIT_MASK_EXQ_FREEPG_V1_8822C 0xfff -+#define BIT_EXQ_FREEPG_V1_8822C(x) \ -+ (((x) & BIT_MASK_EXQ_FREEPG_V1_8822C) << BIT_SHIFT_EXQ_FREEPG_V1_8822C) -+#define BITS_EXQ_FREEPG_V1_8822C \ -+ (BIT_MASK_EXQ_FREEPG_V1_8822C << BIT_SHIFT_EXQ_FREEPG_V1_8822C) -+#define BIT_CLEAR_EXQ_FREEPG_V1_8822C(x) ((x) & (~BITS_EXQ_FREEPG_V1_8822C)) -+#define BIT_GET_EXQ_FREEPG_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_EXQ_FREEPG_V1_8822C) & BIT_MASK_EXQ_FREEPG_V1_8822C) -+#define BIT_SET_EXQ_FREEPG_V1_8822C(x, v) \ -+ (BIT_CLEAR_EXQ_FREEPG_V1_8822C(x) | BIT_EXQ_FREEPG_V1_8822C(v)) -+ -+/* 2 REG_SDIO_TXPKT_EMPTY_8822C */ -+#define BIT_SDIO_BCNQ_EMPTY_8822C BIT(11) -+#define BIT_SDIO_HQQ_EMPTY_8822C BIT(10) -+#define BIT_SDIO_MQQ_EMPTY_8822C BIT(9) -+#define BIT_SDIO_MGQ_CPU_EMPTY_8822C BIT(8) -+#define BIT_SDIO_AC7Q_EMPTY_8822C BIT(7) -+#define BIT_SDIO_AC6Q_EMPTY_8822C BIT(6) -+#define BIT_SDIO_AC5Q_EMPTY_8822C BIT(5) -+#define BIT_SDIO_AC4Q_EMPTY_8822C BIT(4) -+#define BIT_SDIO_AC3Q_EMPTY_8822C BIT(3) -+#define BIT_SDIO_AC2Q_EMPTY_8822C BIT(2) -+#define BIT_SDIO_AC1Q_EMPTY_8822C BIT(1) -+#define BIT_SDIO_AC0Q_EMPTY_8822C BIT(0) -+ -+/* 2 REG_SDIO_HTSFR_INFO_8822C */ -+ -+#define BIT_SHIFT_HTSFR1_8822C 16 -+#define BIT_MASK_HTSFR1_8822C 0xffff -+#define BIT_HTSFR1_8822C(x) \ -+ (((x) & BIT_MASK_HTSFR1_8822C) << BIT_SHIFT_HTSFR1_8822C) -+#define BITS_HTSFR1_8822C (BIT_MASK_HTSFR1_8822C << BIT_SHIFT_HTSFR1_8822C) -+#define BIT_CLEAR_HTSFR1_8822C(x) ((x) & (~BITS_HTSFR1_8822C)) -+#define BIT_GET_HTSFR1_8822C(x) \ -+ (((x) >> BIT_SHIFT_HTSFR1_8822C) & BIT_MASK_HTSFR1_8822C) -+#define BIT_SET_HTSFR1_8822C(x, v) \ -+ (BIT_CLEAR_HTSFR1_8822C(x) | BIT_HTSFR1_8822C(v)) -+ -+#define BIT_SHIFT_HTSFR0_8822C 0 -+#define BIT_MASK_HTSFR0_8822C 0xffff -+#define BIT_HTSFR0_8822C(x) \ -+ (((x) & BIT_MASK_HTSFR0_8822C) << BIT_SHIFT_HTSFR0_8822C) -+#define BITS_HTSFR0_8822C (BIT_MASK_HTSFR0_8822C << BIT_SHIFT_HTSFR0_8822C) -+#define BIT_CLEAR_HTSFR0_8822C(x) ((x) & (~BITS_HTSFR0_8822C)) -+#define BIT_GET_HTSFR0_8822C(x) \ -+ (((x) >> BIT_SHIFT_HTSFR0_8822C) & BIT_MASK_HTSFR0_8822C) -+#define BIT_SET_HTSFR0_8822C(x, v) \ -+ (BIT_CLEAR_HTSFR0_8822C(x) | BIT_HTSFR0_8822C(v)) -+ -+/* 2 REG_SDIO_HCPWM1_V2_8822C */ -+#define BIT_TOGGLE_8822C BIT(7) -+#define BIT_CUR_PS_8822C BIT(0) -+ -+/* 2 REG_SDIO_HCPWM2_V2_8822C */ -+ -+/* 2 REG_SDIO_INDIRECT_REG_CFG_8822C */ -+#define BIT_INDIRECT_REG_RDY_8822C BIT(20) -+#define BIT_INDIRECT_REG_R_8822C BIT(19) -+#define BIT_INDIRECT_REG_W_8822C BIT(18) -+ -+#define BIT_SHIFT_INDIRECT_REG_SIZE_8822C 16 -+#define BIT_MASK_INDIRECT_REG_SIZE_8822C 0x3 -+#define BIT_INDIRECT_REG_SIZE_8822C(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_SIZE_8822C) \ -+ << BIT_SHIFT_INDIRECT_REG_SIZE_8822C) -+#define BITS_INDIRECT_REG_SIZE_8822C \ -+ (BIT_MASK_INDIRECT_REG_SIZE_8822C << BIT_SHIFT_INDIRECT_REG_SIZE_8822C) -+#define BIT_CLEAR_INDIRECT_REG_SIZE_8822C(x) \ -+ ((x) & (~BITS_INDIRECT_REG_SIZE_8822C)) -+#define BIT_GET_INDIRECT_REG_SIZE_8822C(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_SIZE_8822C) & \ -+ BIT_MASK_INDIRECT_REG_SIZE_8822C) -+#define BIT_SET_INDIRECT_REG_SIZE_8822C(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_SIZE_8822C(x) | BIT_INDIRECT_REG_SIZE_8822C(v)) -+ -+#define BIT_SHIFT_INDIRECT_REG_ADDR_8822C 0 -+#define BIT_MASK_INDIRECT_REG_ADDR_8822C 0xffff -+#define BIT_INDIRECT_REG_ADDR_8822C(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_ADDR_8822C) \ -+ << BIT_SHIFT_INDIRECT_REG_ADDR_8822C) -+#define BITS_INDIRECT_REG_ADDR_8822C \ -+ (BIT_MASK_INDIRECT_REG_ADDR_8822C << BIT_SHIFT_INDIRECT_REG_ADDR_8822C) -+#define BIT_CLEAR_INDIRECT_REG_ADDR_8822C(x) \ -+ ((x) & (~BITS_INDIRECT_REG_ADDR_8822C)) -+#define BIT_GET_INDIRECT_REG_ADDR_8822C(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_ADDR_8822C) & \ -+ BIT_MASK_INDIRECT_REG_ADDR_8822C) -+#define BIT_SET_INDIRECT_REG_ADDR_8822C(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_ADDR_8822C(x) | BIT_INDIRECT_REG_ADDR_8822C(v)) -+ -+/* 2 REG_SDIO_INDIRECT_REG_DATA_8822C */ -+ -+#define BIT_SHIFT_INDIRECT_REG_DATA_8822C 0 -+#define BIT_MASK_INDIRECT_REG_DATA_8822C 0xffffffffL -+#define BIT_INDIRECT_REG_DATA_8822C(x) \ -+ (((x) & BIT_MASK_INDIRECT_REG_DATA_8822C) \ -+ << BIT_SHIFT_INDIRECT_REG_DATA_8822C) -+#define BITS_INDIRECT_REG_DATA_8822C \ -+ (BIT_MASK_INDIRECT_REG_DATA_8822C << BIT_SHIFT_INDIRECT_REG_DATA_8822C) -+#define BIT_CLEAR_INDIRECT_REG_DATA_8822C(x) \ -+ ((x) & (~BITS_INDIRECT_REG_DATA_8822C)) -+#define BIT_GET_INDIRECT_REG_DATA_8822C(x) \ -+ (((x) >> BIT_SHIFT_INDIRECT_REG_DATA_8822C) & \ -+ BIT_MASK_INDIRECT_REG_DATA_8822C) -+#define BIT_SET_INDIRECT_REG_DATA_8822C(x, v) \ -+ (BIT_CLEAR_INDIRECT_REG_DATA_8822C(x) | BIT_INDIRECT_REG_DATA_8822C(v)) -+ -+/* 2 REG_SDIO_H2C_8822C */ -+ -+#define BIT_SHIFT_SDIO_H2C_MSG_8822C 0 -+#define BIT_MASK_SDIO_H2C_MSG_8822C 0xffffffffL -+#define BIT_SDIO_H2C_MSG_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_H2C_MSG_8822C) << BIT_SHIFT_SDIO_H2C_MSG_8822C) -+#define BITS_SDIO_H2C_MSG_8822C \ -+ (BIT_MASK_SDIO_H2C_MSG_8822C << BIT_SHIFT_SDIO_H2C_MSG_8822C) -+#define BIT_CLEAR_SDIO_H2C_MSG_8822C(x) ((x) & (~BITS_SDIO_H2C_MSG_8822C)) -+#define BIT_GET_SDIO_H2C_MSG_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_H2C_MSG_8822C) & BIT_MASK_SDIO_H2C_MSG_8822C) -+#define BIT_SET_SDIO_H2C_MSG_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_H2C_MSG_8822C(x) | BIT_SDIO_H2C_MSG_8822C(v)) -+ -+/* 2 REG_SDIO_C2H_8822C */ -+ -+#define BIT_SHIFT_SDIO_C2H_MSG_8822C 0 -+#define BIT_MASK_SDIO_C2H_MSG_8822C 0xffffffffL -+#define BIT_SDIO_C2H_MSG_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_C2H_MSG_8822C) << BIT_SHIFT_SDIO_C2H_MSG_8822C) -+#define BITS_SDIO_C2H_MSG_8822C \ -+ (BIT_MASK_SDIO_C2H_MSG_8822C << BIT_SHIFT_SDIO_C2H_MSG_8822C) -+#define BIT_CLEAR_SDIO_C2H_MSG_8822C(x) ((x) & (~BITS_SDIO_C2H_MSG_8822C)) -+#define BIT_GET_SDIO_C2H_MSG_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_C2H_MSG_8822C) & BIT_MASK_SDIO_C2H_MSG_8822C) -+#define BIT_SET_SDIO_C2H_MSG_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_C2H_MSG_8822C(x) | BIT_SDIO_C2H_MSG_8822C(v)) -+ -+/* 2 REG_SDIO_HRPWM1_8822C */ -+#define BIT_TOGGLE_8822C BIT(7) -+#define BIT_ACK_8822C BIT(6) -+#define BIT_REQ_PS_8822C BIT(0) -+ -+/* 2 REG_SDIO_HRPWM2_8822C */ -+ -+/* 2 REG_SDIO_HPS_CLKR_8822C */ -+ -+/* 2 REG_SDIO_BUS_CTRL_8822C */ -+#define BIT_INT_MASK_DIS_8822C BIT(4) -+#define BIT_PAD_CLK_XHGE_EN_8822C BIT(3) -+#define BIT_INTER_CLK_EN_8822C BIT(2) -+#define BIT_EN_RPT_TXCRC_8822C BIT(1) -+#define BIT_DIS_RXDMA_STS_8822C BIT(0) -+ -+/* 2 REG_SDIO_HSUS_CTRL_8822C */ -+#define BIT_INTR_CTRL_8822C BIT(4) -+#define BIT_SDIO_VOLTAGE_8822C BIT(3) -+#define BIT_BYPASS_INIT_8822C BIT(2) -+#define BIT_HCI_RESUME_RDY_8822C BIT(1) -+#define BIT_HCI_SUS_REQ_8822C BIT(0) -+ -+/* 2 REG_SDIO_RESPONSE_TIMER_8822C */ -+ -+#define BIT_SHIFT_CMDIN_2RESP_TIMER_8822C 0 -+#define BIT_MASK_CMDIN_2RESP_TIMER_8822C 0xffff -+#define BIT_CMDIN_2RESP_TIMER_8822C(x) \ -+ (((x) & BIT_MASK_CMDIN_2RESP_TIMER_8822C) \ -+ << BIT_SHIFT_CMDIN_2RESP_TIMER_8822C) -+#define BITS_CMDIN_2RESP_TIMER_8822C \ -+ (BIT_MASK_CMDIN_2RESP_TIMER_8822C << BIT_SHIFT_CMDIN_2RESP_TIMER_8822C) -+#define BIT_CLEAR_CMDIN_2RESP_TIMER_8822C(x) \ -+ ((x) & (~BITS_CMDIN_2RESP_TIMER_8822C)) -+#define BIT_GET_CMDIN_2RESP_TIMER_8822C(x) \ -+ (((x) >> BIT_SHIFT_CMDIN_2RESP_TIMER_8822C) & \ -+ BIT_MASK_CMDIN_2RESP_TIMER_8822C) -+#define BIT_SET_CMDIN_2RESP_TIMER_8822C(x, v) \ -+ (BIT_CLEAR_CMDIN_2RESP_TIMER_8822C(x) | BIT_CMDIN_2RESP_TIMER_8822C(v)) -+ -+/* 2 REG_SDIO_CMD_CRC_8822C */ -+ -+#define BIT_SHIFT_SDIO_CMD_CRC_V1_8822C 0 -+#define BIT_MASK_SDIO_CMD_CRC_V1_8822C 0xff -+#define BIT_SDIO_CMD_CRC_V1_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_CRC_V1_8822C) \ -+ << BIT_SHIFT_SDIO_CMD_CRC_V1_8822C) -+#define BITS_SDIO_CMD_CRC_V1_8822C \ -+ (BIT_MASK_SDIO_CMD_CRC_V1_8822C << BIT_SHIFT_SDIO_CMD_CRC_V1_8822C) -+#define BIT_CLEAR_SDIO_CMD_CRC_V1_8822C(x) ((x) & (~BITS_SDIO_CMD_CRC_V1_8822C)) -+#define BIT_GET_SDIO_CMD_CRC_V1_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_CRC_V1_8822C) & \ -+ BIT_MASK_SDIO_CMD_CRC_V1_8822C) -+#define BIT_SET_SDIO_CMD_CRC_V1_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_CRC_V1_8822C(x) | BIT_SDIO_CMD_CRC_V1_8822C(v)) -+ -+/* 2 REG_SDIO_HSISR_8822C */ -+#define BIT_DRV_WLAN_INT_CLR_8822C BIT(1) -+#define BIT_DRV_WLAN_INT_8822C BIT(0) -+ -+/* 2 REG_SDIO_HSIMR_8822C */ -+#define BIT_HISR_MASK_8822C BIT(0) -+ -+/* 2 REG_SDIO_DIOERR_RPT_8822C */ -+#define BIT_SDIO_PAGE_ERR_8822C BIT(0) -+ -+/* 2 REG_SDIO_CMD_ERRCNT_8822C */ -+ -+#define BIT_SHIFT_CMD_CRC_ERR_CNT_8822C 0 -+#define BIT_MASK_CMD_CRC_ERR_CNT_8822C 0xff -+#define BIT_CMD_CRC_ERR_CNT_8822C(x) \ -+ (((x) & BIT_MASK_CMD_CRC_ERR_CNT_8822C) \ -+ << BIT_SHIFT_CMD_CRC_ERR_CNT_8822C) -+#define BITS_CMD_CRC_ERR_CNT_8822C \ -+ (BIT_MASK_CMD_CRC_ERR_CNT_8822C << BIT_SHIFT_CMD_CRC_ERR_CNT_8822C) -+#define BIT_CLEAR_CMD_CRC_ERR_CNT_8822C(x) ((x) & (~BITS_CMD_CRC_ERR_CNT_8822C)) -+#define BIT_GET_CMD_CRC_ERR_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_CMD_CRC_ERR_CNT_8822C) & \ -+ BIT_MASK_CMD_CRC_ERR_CNT_8822C) -+#define BIT_SET_CMD_CRC_ERR_CNT_8822C(x, v) \ -+ (BIT_CLEAR_CMD_CRC_ERR_CNT_8822C(x) | BIT_CMD_CRC_ERR_CNT_8822C(v)) -+ -+/* 2 REG_SDIO_DATA_ERRCNT_8822C */ -+ -+#define BIT_SHIFT_DATA_CRC_ERR_CNT_8822C 0 -+#define BIT_MASK_DATA_CRC_ERR_CNT_8822C 0xff -+#define BIT_DATA_CRC_ERR_CNT_8822C(x) \ -+ (((x) & BIT_MASK_DATA_CRC_ERR_CNT_8822C) \ -+ << BIT_SHIFT_DATA_CRC_ERR_CNT_8822C) -+#define BITS_DATA_CRC_ERR_CNT_8822C \ -+ (BIT_MASK_DATA_CRC_ERR_CNT_8822C << BIT_SHIFT_DATA_CRC_ERR_CNT_8822C) -+#define BIT_CLEAR_DATA_CRC_ERR_CNT_8822C(x) \ -+ ((x) & (~BITS_DATA_CRC_ERR_CNT_8822C)) -+#define BIT_GET_DATA_CRC_ERR_CNT_8822C(x) \ -+ (((x) >> BIT_SHIFT_DATA_CRC_ERR_CNT_8822C) & \ -+ BIT_MASK_DATA_CRC_ERR_CNT_8822C) -+#define BIT_SET_DATA_CRC_ERR_CNT_8822C(x, v) \ -+ (BIT_CLEAR_DATA_CRC_ERR_CNT_8822C(x) | BIT_DATA_CRC_ERR_CNT_8822C(v)) -+ -+/* 2 REG_SDIO_CMD_ERR_CONTENT_8822C */ -+ -+#define BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8822C 0 -+#define BIT_MASK_SDIO_CMD_ERR_CONTENT_8822C 0xffffffffffL -+#define BIT_SDIO_CMD_ERR_CONTENT_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_CMD_ERR_CONTENT_8822C) \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8822C) -+#define BITS_SDIO_CMD_ERR_CONTENT_8822C \ -+ (BIT_MASK_SDIO_CMD_ERR_CONTENT_8822C \ -+ << BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8822C) -+#define BIT_CLEAR_SDIO_CMD_ERR_CONTENT_8822C(x) \ -+ ((x) & (~BITS_SDIO_CMD_ERR_CONTENT_8822C)) -+#define BIT_GET_SDIO_CMD_ERR_CONTENT_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_CMD_ERR_CONTENT_8822C) & \ -+ BIT_MASK_SDIO_CMD_ERR_CONTENT_8822C) -+#define BIT_SET_SDIO_CMD_ERR_CONTENT_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_CMD_ERR_CONTENT_8822C(x) | \ -+ BIT_SDIO_CMD_ERR_CONTENT_8822C(v)) -+ -+/* 2 REG_SDIO_CRC_ERR_IDX_8822C */ -+#define BIT_D3_CRC_ERR_8822C BIT(4) -+#define BIT_D2_CRC_ERR_8822C BIT(3) -+#define BIT_D1_CRC_ERR_8822C BIT(2) -+#define BIT_D0_CRC_ERR_8822C BIT(1) -+#define BIT_CMD_CRC_ERR_8822C BIT(0) -+ -+/* 2 REG_SDIO_DATA_CRC_8822C */ -+ -+#define BIT_SHIFT_SDIO_DATA_CRC_8822C 0 -+#define BIT_MASK_SDIO_DATA_CRC_8822C 0xffff -+#define BIT_SDIO_DATA_CRC_8822C(x) \ -+ (((x) & BIT_MASK_SDIO_DATA_CRC_8822C) << BIT_SHIFT_SDIO_DATA_CRC_8822C) -+#define BITS_SDIO_DATA_CRC_8822C \ -+ (BIT_MASK_SDIO_DATA_CRC_8822C << BIT_SHIFT_SDIO_DATA_CRC_8822C) -+#define BIT_CLEAR_SDIO_DATA_CRC_8822C(x) ((x) & (~BITS_SDIO_DATA_CRC_8822C)) -+#define BIT_GET_SDIO_DATA_CRC_8822C(x) \ -+ (((x) >> BIT_SHIFT_SDIO_DATA_CRC_8822C) & BIT_MASK_SDIO_DATA_CRC_8822C) -+#define BIT_SET_SDIO_DATA_CRC_8822C(x, v) \ -+ (BIT_CLEAR_SDIO_DATA_CRC_8822C(x) | BIT_SDIO_DATA_CRC_8822C(v)) -+ -+/* 2 REG_SDIO_TRANS_FIFO_STATUS_8822C */ -+#define BIT_TRANS_FIFO_UNDERFLOW_8822C BIT(1) -+#define BIT_TRANS_FIFO_OVERFLOW_8822C BIT(0) -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_dbg.c b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_dbg.c -new file mode 100644 -index 000000000..b79c31176 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_dbg.c -@@ -0,0 +1,132 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2018 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "halmac_dbg.h" -+#if HALMAC_DBG_MONITOR_IO -+static u8 -+monitor_reg_read_8(struct halmac_adapter *adapter, u32 offset, -+ const char *func, const u32 line); -+static u16 -+monitor_reg_read_16(struct halmac_adapter *adapter, u32 offset, -+ const char *func, const u32 line); -+static u32 -+monitor_reg_read_32(struct halmac_adapter *adapter, u32 offset, -+ const char *func, const u32 line); -+static enum halmac_ret_status -+monitor_reg_sdio_cmd53_read_n(struct halmac_adapter *adapter, -+ u32 offset, u32 size, u8 *value, -+ const char *func, const u32 line); -+static enum halmac_ret_status -+monitor_reg_write_8(struct halmac_adapter *adapter, u32 offset, -+ u8 value, const char *func, const u32 line); -+static enum halmac_ret_status -+monitor_reg_write_16(struct halmac_adapter *adapter, u32 offset, -+ u16 value, const char *func, const u32 line); -+static enum halmac_ret_status -+monitor_reg_write_32(struct halmac_adapter *adapter, u32 offset, -+ u32 value, const char *func, const u32 line); -+ -+enum halmac_ret_status -+mount_api_dbg(struct halmac_adapter *adapter) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ api->halmac_mon_reg_read_8 = monitor_reg_read_8; -+ api->halmac_mon_reg_read_16 = monitor_reg_read_16; -+ api->halmac_mon_reg_read_32 = monitor_reg_read_32; -+ api->halmac_mon_reg_sdio_cmd53_read_n = monitor_reg_sdio_cmd53_read_n; -+ api->halmac_mon_reg_write_8 = monitor_reg_write_8; -+ api->halmac_mon_reg_write_16 = monitor_reg_write_16; -+ api->halmac_mon_reg_write_32 = monitor_reg_write_32; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+u8 -+monitor_reg_read_8(struct halmac_adapter *adapter, u32 offset, -+ const char *func, const u32 line) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u8 val; -+ -+ val = api->halmac_reg_read_8(adapter, offset); -+ PLTFM_MONITOR_READ(offset, 1, val, func, line); -+ return val; -+} -+ -+u16 -+monitor_reg_read_16(struct halmac_adapter *adapter, u32 offset, -+ const char *func, const u32 line) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u16 val; -+ -+ val = api->halmac_reg_read_16(adapter, offset); -+ PLTFM_MONITOR_READ(offset, 2, val, func, line); -+ return val; -+} -+ -+u32 -+monitor_reg_read_32(struct halmac_adapter *adapter, u32 offset, -+ const char *func, const u32 line) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ u32 val; -+ -+ val = api->halmac_reg_read_32(adapter, offset); -+ PLTFM_MONITOR_READ(offset, 4, val, func, line); -+ return val; -+} -+ -+enum halmac_ret_status -+monitor_reg_sdio_cmd53_read_n(struct halmac_adapter *adapter, -+ u32 offset, u32 size, u8 *value, -+ const char *func, const u32 line) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MONITOR_READ(offset, size, 0, func, line); -+ return api->halmac_reg_sdio_cmd53_read_n(adapter, offset, size, value); -+} -+ -+enum halmac_ret_status -+monitor_reg_write_8(struct halmac_adapter *adapter, u32 offset, -+ u8 value, const char *func, const u32 line) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MONITOR_WRITE(offset, 1, value, func, line); -+ return api->halmac_reg_write_8(adapter, offset, value); -+} -+ -+enum halmac_ret_status -+monitor_reg_write_16(struct halmac_adapter *adapter, u32 offset, -+ u16 value, const char *func, const u32 line) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MONITOR_WRITE(offset, 2, value, func, line); -+ return api->halmac_reg_write_16(adapter, offset, value); -+} -+ -+enum halmac_ret_status -+monitor_reg_write_32(struct halmac_adapter *adapter, u32 offset, -+ u32 value, const char *func, const u32 line) -+{ -+ struct halmac_api *api = (struct halmac_api *)adapter->halmac_api; -+ -+ PLTFM_MONITOR_WRITE(offset, 4, value, func, line); -+ return api->halmac_reg_write_32(adapter, offset, value); -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_dbg.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_dbg.h -new file mode 100644 -index 000000000..bf500edc6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_dbg.h -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2018 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_DBG_H_ -+#define _HALMAC_DBG_H_ -+ -+#include "halmac_api.h" -+ -+#if HALMAC_DBG_MONITOR_IO -+enum halmac_ret_status -+mount_api_dbg(struct halmac_adapter *adapter); -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_info.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_info.h -new file mode 100644 -index 000000000..eea181e88 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_info.h -@@ -0,0 +1,154 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_FW_INFO_H_ -+#define _HALMAC_FW_INFO_H_ -+ -+#define H2C_FORMAT_VERSION 15 -+ -+/* FW bin information */ -+#define WLAN_FW_HDR_SIZE 64 -+#define WLAN_FW_HDR_CHKSUM_SIZE 8 -+ -+#define WLAN_FW_HDR_VERSION 4 -+#define WLAN_FW_HDR_SUBVERSION 6 -+#define WLAN_FW_HDR_SUBINDEX 7 -+#define WLAN_FW_HDR_MONTH 16 -+#define WLAN_FW_HDR_DATE 17 -+#define WLAN_FW_HDR_HOUR 18 -+#define WLAN_FW_HDR_MIN 19 -+#define WLAN_FW_HDR_YEAR 20 -+#define WLAN_FW_HDR_MEM_USAGE 24 -+#define WLAN_FW_HDR_H2C_FMT_VER 28 -+#define WLAN_FW_HDR_DMEM_ADDR 32 -+#define WLAN_FW_HDR_DMEM_SIZE 36 -+#define WLAN_FW_HDR_IMEM_SIZE 48 -+#define WLAN_FW_HDR_EMEM_SIZE 52 -+#define WLAN_FW_HDR_EMEM_ADDR 56 -+#define WLAN_FW_HDR_IMEM_ADDR 60 -+ -+#define H2C_ACK_HDR_CONTENT_LENGTH 8 -+#define CFG_PARAMETER_ACK_CONTENT_LENGTH 16 -+#define CH_SWITCH_ACK_CONTENT_LENGTH 16 -+#define SCAN_STATUS_RPT_CONTENT_LENGTH 4 -+#define SCAN_STATUS_RPT_CONTENT_LENGTH_V2 12 -+#define SCAN_CH_NOTIFY_CONTENT_LENGTH 12 -+#define C2H_DBG_HDR_LEN 4 -+#define C2H_DBG_CONTENT_MAX_LENGTH 228 -+#define C2H_DBG_CONTENT_SEQ_OFFSET 1 -+ -+/* Rename from FW SysHalCom_Debug_RAM.h */ -+#define FW_REG_H2CPKT_DONE_SEQ 0x1C8 -+#define FW_REG_WOW_REASON 0x1C7 -+ -+enum halmac_data_type { -+ HALMAC_DATA_TYPE_MAC_REG = 0x00, -+ HALMAC_DATA_TYPE_BB_REG = 0x01, -+ HALMAC_DATA_TYPE_RADIO_A = 0x02, -+ HALMAC_DATA_TYPE_RADIO_B = 0x03, -+ HALMAC_DATA_TYPE_RADIO_C = 0x04, -+ HALMAC_DATA_TYPE_RADIO_D = 0x05, -+ -+ HALMAC_DATA_TYPE_DRV_DEFINE_0 = 0x80, -+ HALMAC_DATA_TYPE_DRV_DEFINE_1 = 0x81, -+ HALMAC_DATA_TYPE_DRV_DEFINE_2 = 0x82, -+ HALMAC_DATA_TYPE_DRV_DEFINE_3 = 0x83, -+ HALMAC_DATA_TYPE_UNDEFINE = 0x7FFFFFFF, -+}; -+ -+enum halmac_packet_id { -+ HALMAC_PACKET_PROBE_REQ = 0x00, -+ HALMAC_PACKET_SYNC_BCN = 0x01, -+ HALMAC_PACKET_DISCOVERY_BCN = 0x02, -+ HALMAC_PACKET_PROBE_REQ_NLO = 0xF0, -+ HALMAC_PACKET_SYNC_BCN_NLO = 0xF1, -+ HALMAC_PACKET_DISCOVERY_BCN_NLO = 0xF2, -+ HALMAC_PACKET_UNDEFINE = 0x7FFFFFFF, -+}; -+ -+enum halmac_cs_action_id { -+ HALMAC_CS_ACTION_NONE = 0x00, -+ HALMAC_CS_ACTIVE_SCAN = 0x01, -+ HALMAC_CS_NAN_NONMASTER_DW = 0x02, -+ HALMAC_CS_NAN_NONMASTER_NONDW = 0x03, -+ HALMAC_CS_NAN_MASTER_NONDW = 0x04, -+ HALMAC_CS_NAN_MASTER_DW = 0x05, -+ HALMAC_CS_ACTION_UNDEFINE = 0x7FFFFFFF, -+}; -+ -+enum halmac_cs_extra_action_id { -+ HALMAC_CS_EXTRA_ACTION_NONE = 0x00, -+ HALMAC_CS_EXTRA_UPDATE_PROBE = 0x01, -+ HALMAC_CS_EXTRA_UPDATE_BEACON = 0x02, -+ HALMAC_CS_EXTRA_ACTION_SCAN = 0x03, -+ HALMAC_CS_EXTRA_ACTION_UNDEFINE = 0x7FFFFFFF, -+}; -+ -+enum halmac_h2c_return_code { -+ HALMAC_H2C_RETURN_SUCCESS = 0x00, -+ HALMAC_H2C_RETURN_CFG_ERR_LEN = 0x01, -+ HALMAC_H2C_RETURN_CFG_ERR_CMD = 0x02, -+ HALMAC_H2C_RETURN_EFUSE_ERR_DUMP = 0x03, -+ HALMAC_H2C_RETURN_DATAPACK_ERR_FULL = 0x04, -+ HALMAC_H2C_RETURN_DATAPACK_ERR_ID = 0x05, -+ HALMAC_H2C_RETURN_RUN_ERR_EMPTY = 0x06, -+ HALMAC_H2C_RETURN_RUN_ERR_LEN = 0x07, -+ HALMAC_H2C_RETURN_RUN_ERR_CMD = 0x08, -+ HALMAC_H2C_RETURN_RUN_ERR_ID = 0x09, -+ HALMAC_H2C_RETURN_PACKET_ERR_FULL = 0x0A, -+ HALMAC_H2C_RETURN_PACKET_ERR_ID = 0x0B, -+ HALMAC_H2C_RETURN_SCAN_ERR_FULL = 0x0C, -+ HALMAC_H2C_RETURN_SCAN_ERR_PHYDM = 0x0D, -+ HALMAC_H2C_RETURN_ORIG_ERR_ID = 0x0E, -+ HALMAC_H2C_RETURN_SCAN_PKT_FULL = 0x0F, -+ HALMAC_H2C_RETURN_SCAN_PKT_BUF_BUSY = 0x10, -+ HALMAC_H2C_RETURN_SCAN_PKT_IDX_REUSE = 0x11, -+ HALMAC_H2C_RETURN_EFUSE_BUF_BUSY = 0x12, -+ HALMAC_H2C_RETURN_UNDEFINE = 0x7FFFFFFF, -+}; -+ -+enum halmac_scan_report_code { -+ HALMAC_SCAN_REPORT_DONE = 0x00, -+ HALMAC_SCAN_REPORT_ERR_PHYDM = 0x01, -+ HALMAC_SCAN_REPORT_ERR_ID = 0x02, -+ HALMAC_SCAN_REPORT_ERR_TX = 0x03, -+ HALMAC_SCAN_REPORT_UNDEFINE = 0x7FFFFFFF, -+}; -+ -+enum halmac_scan_notify_id { -+ HALMAC_SCAN_NOTIFY_ID_PRESWITCH = 0x00, -+ HALMAC_SCAN_NOTIFY_ID_POSTSWITCH = 0x01, -+ HALMAC_SCAN_NOTIFY_ID_PROBE_PRETX = 0x02, -+ HALMAC_SCAN_NOTIFY_ID_PROBE_POSTTX = 0x03, -+ HALMAC_SCAN_NOTIFY_ID_ACTION_PRETX = 0x04, -+ HALMAC_SCAN_NOTIFY_ID_ACTION_POSTTX = 0x05, -+ HALMAC_SCAN_NOTIFY_ID_DWELLEXT = 0x06, -+ HALMAC_SCAN_NOTIFY_ID_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_scan_notify_status { -+ HALMAC_SCAN_NOTIFY_STATUS_NONE = 0x00, -+ HALMAC_SCAN_NOTIFY_STATUS_PHYDM_OK = 0x01, -+ HALMAC_SCAN_NOTIFY_STATUS_PHYDM_ERR = 0x02, -+ HALMAC_SCAN_NOTIFY_STATUS_NO_PROBE = 0x03, -+ HALMAC_SCAN_NOTIFY_STATUS_TX_PROBE_OK = 0x04, -+ HALMAC_SCAN_NOTIFY_STATUS_TX_PROBE_FAIL = 0x05, -+ HALMAC_SCAN_NOTIFY_STATUS_INVALID_ACTION_IDX = 0x06, -+ HALMAC_SCAN_NOTIFY_STATUS_TX_ACTION_OK = 0x07, -+ HALMAC_SCAN_NOTIFY_STATUS_TX_ACTION_FAIL = 0x08, -+ HALMAC_SCAN_NOTIFY_STATUS_UNDEFINE = 0x7F, -+}; -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_c2h_ap.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_c2h_ap.h -new file mode 100644 -index 000000000..26d21b460 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_c2h_ap.h -@@ -0,0 +1,772 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_FWOFFLOADC2HFORMAT_H2C_C2H_AP_H_ -+#define _HAL_FWOFFLOADC2HFORMAT_H2C_C2H_AP_H_ -+#define C2H_SUB_CMD_ID_C2H_DBG 0X00 -+#define C2H_SUB_CMD_ID_BT_COEX_INFO 0X02 -+#define C2H_SUB_CMD_ID_SCAN_STATUS_RPT 0X03 -+#define C2H_SUB_CMD_ID_H2C_ACK_HDR 0X01 -+#define C2H_SUB_CMD_ID_CFG_PARAM_ACK 0X01 -+#define C2H_SUB_CMD_ID_CH_SWITCH_ACK 0X01 -+#define C2H_SUB_CMD_ID_BT_COEX_ACK 0X01 -+#define C2H_SUB_CMD_ID_DUMP_PHYSICAL_EFUSE_ACK 0X01 -+#define C2H_SUB_CMD_ID_UPDATE_PKT_ACK 0X01 -+#define C2H_SUB_CMD_ID_SEND_SCAN_PKT_ACK 0X01 -+#define C2H_SUB_CMD_ID_DROP_SCAN_PKT_ACK 0X01 -+#define C2H_SUB_CMD_ID_UPDATE_DATAPACK_ACK 0X01 -+#define C2H_SUB_CMD_ID_RUN_DATAPACK_ACK 0X01 -+#define C2H_SUB_CMD_ID_IQK_ACK 0X01 -+#define C2H_SUB_CMD_ID_PWR_TRK_ACK 0X01 -+#define C2H_SUB_CMD_ID_PSD_ACK 0X01 -+#define C2H_SUB_CMD_ID_FW_MEM_DUMP_ACK 0X01 -+#define C2H_SUB_CMD_ID_ACT_SCHEDULE_REQ_ACK 0X1 -+#define C2H_SUB_CMD_ID_NAN_FUNC_CTRL_ACK 0X1 -+#define C2H_SUB_CMD_ID_DPK_ACK 0X1 -+#define C2H_SUB_CMD_ID_PSD_DATA 0X04 -+#define C2H_SUB_CMD_ID_EFUSE_DATA 0X05 -+#define C2H_SUB_CMD_ID_IQK_DATA 0X06 -+#define C2H_SUB_CMD_ID_C2H_PKT_FTM_DBG 0X07 -+#define C2H_SUB_CMD_ID_C2H_PKT_FTM_2_DBG 0X08 -+#define C2H_SUB_CMD_ID_C2H_PKT_FTM_3_DBG 0X09 -+#define C2H_SUB_CMD_ID_C2H_PKT_FTM_4_DBG 0X0A -+#define C2H_SUB_CMD_ID_FTMACKRPT_HDL_DBG 0X0B -+#define C2H_SUB_CMD_ID_FTMC2H_RPT 0X0C -+#define C2H_SUB_CMD_ID_DRVFTMC2H_RPT 0X0D -+#define C2H_SUB_CMD_ID_C2H_PKT_FTM_5_DBG 0X0E -+#define C2H_SUB_CMD_ID_CCX_RPT 0X0F -+#define C2H_SUB_CMD_ID_C2H_PKT_NAN_RPT 0X10 -+#define C2H_SUB_CMD_ID_C2H_PKT_ATM_RPT 0X11 -+#define C2H_SUB_CMD_ID_C2H_PKT_SCC_CSA_RPT 0X1A -+#define C2H_SUB_CMD_ID_C2H_PKT_FW_STATUS_NOTIFY 0X1B -+#define C2H_SUB_CMD_ID_C2H_PKT_FTMSESSION_END 0X1C -+#define C2H_SUB_CMD_ID_C2H_PKT_DETECT_THERMAL 0X1D -+#define C2H_SUB_CMD_ID_FW_DBG_MSG 0XFF -+#define C2H_SUB_CMD_ID_FW_SNDING_ACK 0X01 -+#define C2H_SUB_CMD_ID_FW_FWCTRL_RPT 0X1F -+#define C2H_SUB_CMD_ID_H2C_LOOPBACK_ACK 0X20 -+#define C2H_SUB_CMD_ID_FWCMD_LOOPBACK_ACK 0X21 -+#define C2H_SUB_CMD_ID_SCAN_CH_NOTIFY 0X22 -+#define C2H_SUB_CMD_ID_FW_TBTT_RPT 0X23 -+#define C2H_SUB_CMD_ID_BCN_OFFLOAD 0X24 -+#define C2H_SUB_CMD_ID_DPK_DATA 0X25 -+#define H2C_SUB_CMD_ID_CFG_PARAM_ACK SUB_CMD_ID_CFG_PARAM -+#define H2C_SUB_CMD_ID_CH_SWITCH_ACK SUB_CMD_ID_CH_SWITCH -+#define H2C_SUB_CMD_ID_BT_COEX_ACK SUB_CMD_ID_BT_COEX -+#define H2C_SUB_CMD_ID_DUMP_PHYSICAL_EFUSE_ACK SUB_CMD_ID_DUMP_PHYSICAL_EFUSE -+#define H2C_SUB_CMD_ID_UPDATE_PKT_ACK SUB_CMD_ID_UPDATE_PKT -+#define H2C_SUB_CMD_ID_SEND_SCAN_PKT_ACK SUB_CMD_ID_SEND_SCAN_PKT -+#define H2C_SUB_CMD_ID_DROP_SCAN_PKT_ACK SUB_CMD_ID_DROP_SCAN_PKT -+#define H2C_SUB_CMD_ID_UPDATE_DATAPACK_ACK SUB_CMD_ID_UPDATE_DATAPACK -+#define H2C_SUB_CMD_ID_RUN_DATAPACK_ACK SUB_CMD_ID_RUN_DATAPACK -+#define H2C_SUB_CMD_ID_IQK_ACK SUB_CMD_ID_IQK -+#define H2C_SUB_CMD_ID_PWR_TRK_ACK SUB_CMD_ID_PWR_TRK -+#define H2C_SUB_CMD_ID_PSD_ACK SUB_CMD_ID_PSD -+#define H2C_SUB_CMD_ID_FW_MEM_DUMP_ACK SUB_CMD_ID_FW_MEM_DUMP -+#define H2C_SUB_CMD_ID_ACT_SCHEDULE_REQ_ACK SUB_CMD_ID_ACT_SCHEDULE_REQ -+#define H2C_SUB_CMD_ID_NAN_FUNC_CTRL_ACK SUB_CMD_ID_NAN_FUNC_CTRL -+#define H2C_SUB_CMD_ID_DPK_ACK SUB_CMD_ID_DPK -+#define H2C_SUB_CMD_ID_CCX_RPT SUB_CMD_ID_CCX_RPT -+#define H2C_SUB_CMD_ID_FW_DBG_MSG SUB_CMD_ID_FW_DBG_MSG -+#define H2C_SUB_CMD_ID_FW_SNDING_ACK SUB_CMD_ID_FW_SNDING -+#define H2C_SUB_CMD_ID_FW_FWCTRL_RPT SUB_CMD_ID_FW_FWCTRL_RPT -+#define H2C_SUB_CMD_ID_H2C_LOOPBACK_ACK SUB_CMD_ID_H2C_LOOPBACK -+#define H2C_SUB_CMD_ID_FWCMD_LOOPBACK_ACK SUB_CMD_ID_FWCMD_LOOPBACK -+#define H2C_CMD_ID_CFG_PARAM_ACK 0XFF -+#define H2C_CMD_ID_CH_SWITCH_ACK 0XFF -+#define H2C_CMD_ID_BT_COEX_ACK 0XFF -+#define H2C_CMD_ID_DUMP_PHYSICAL_EFUSE_ACK 0XFF -+#define H2C_CMD_ID_UPDATE_PKT_ACK 0XFF -+#define H2C_CMD_ID_SEND_SCAN_PKT_ACK 0XFF -+#define H2C_CMD_ID_DROP_SCAN_PKT_ACK 0XFF -+#define H2C_CMD_ID_UPDATE_DATAPACK_ACK 0XFF -+#define H2C_CMD_ID_RUN_DATAPACK_ACK 0XFF -+#define H2C_CMD_ID_IQK_ACK 0XFF -+#define H2C_CMD_ID_PWR_TRK_ACK 0XFF -+#define H2C_CMD_ID_PSD_ACK 0XFF -+#define H2C_CMD_ID_FW_MEM_DUMP_ACK 0XFF -+#define H2C_CMD_ID_ACT_SCHEDULE_REQ_ACK 0XFF -+#define H2C_CMD_ID_NAN_FUNC_CTRL_ACK 0XFF -+#define H2C_CMD_ID_DPK_ACK 0XFF -+#define H2C_CMD_ID_CCX_RPT 0XFF -+#define H2C_CMD_ID_FW_DBG_MSG 0XFF -+#define H2C_CMD_ID_FW_SNDING_ACK 0XFF -+#define H2C_CMD_ID_FW_FWCTRL_RPT 0XFF -+#define H2C_CMD_ID_H2C_LOOPBACK_ACK 0XFF -+#define H2C_CMD_ID_FWCMD_LOOPBACK_ACK 0XFF -+#define C2H_HDR_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_HDR_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_HDR_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_HDR_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_HDR_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_HDR_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_HDR_GET_C2H_SUB_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 16, 8) -+#define C2H_HDR_SET_C2H_SUB_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_HDR_SET_C2H_SUB_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_HDR_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 24, 8) -+#define C2H_HDR_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_HDR_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_DBG_GET_DBG_MSG(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define C2H_DBG_SET_DBG_MSG(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_DBG_SET_DBG_MSG_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define BT_COEX_INFO_GET_DATA_START(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define BT_COEX_INFO_SET_DATA_START(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define BT_COEX_INFO_SET_DATA_START_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define SCAN_STATUS_RPT_GET_H2C_RETURN_CODE(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define SCAN_STATUS_RPT_SET_H2C_RETURN_CODE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define SCAN_STATUS_RPT_SET_H2C_RETURN_CODE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define SCAN_STATUS_RPT_GET_H2C_SEQ(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 16, 16) -+#define SCAN_STATUS_RPT_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define SCAN_STATUS_RPT_SET_H2C_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define SCAN_STATUS_RPT_GET_TSF_0(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 0, 8) -+#define SCAN_STATUS_RPT_SET_TSF_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define SCAN_STATUS_RPT_SET_TSF_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_1(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 8, 8) -+#define SCAN_STATUS_RPT_SET_TSF_1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define SCAN_STATUS_RPT_SET_TSF_1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_2(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 16, 8) -+#define SCAN_STATUS_RPT_SET_TSF_2(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define SCAN_STATUS_RPT_SET_TSF_2_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_3(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 24, 8) -+#define SCAN_STATUS_RPT_SET_TSF_3(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 24, 8, value) -+#define SCAN_STATUS_RPT_SET_TSF_3_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 24, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_4(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 0, 8) -+#define SCAN_STATUS_RPT_SET_TSF_4(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 0, 8, value) -+#define SCAN_STATUS_RPT_SET_TSF_4_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 0, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_5(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 8, 8) -+#define SCAN_STATUS_RPT_SET_TSF_5(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 8, 8, value) -+#define SCAN_STATUS_RPT_SET_TSF_5_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 8, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_6(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 16, 8) -+#define SCAN_STATUS_RPT_SET_TSF_6(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 16, 8, value) -+#define SCAN_STATUS_RPT_SET_TSF_6_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 16, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_7(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 24, 8) -+#define SCAN_STATUS_RPT_SET_TSF_7(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 24, 8, value) -+#define SCAN_STATUS_RPT_SET_TSF_7_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 24, 8, value) -+#define H2C_ACK_HDR_GET_H2C_RETURN_CODE(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define H2C_ACK_HDR_SET_H2C_RETURN_CODE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define H2C_ACK_HDR_SET_H2C_RETURN_CODE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define H2C_ACK_HDR_GET_H2C_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define H2C_ACK_HDR_SET_H2C_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define H2C_ACK_HDR_SET_H2C_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define H2C_ACK_HDR_GET_H2C_SUB_CMD_ID(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 16, 16) -+#define H2C_ACK_HDR_SET_H2C_SUB_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define H2C_ACK_HDR_SET_H2C_SUB_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define H2C_ACK_HDR_GET_H2C_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 0, 16) -+#define H2C_ACK_HDR_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 0, 16, value) -+#define H2C_ACK_HDR_SET_H2C_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 0, 16, value) -+#define CFG_PARAM_ACK_GET_OFFSET_ACCUMULATION(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0XC, 0, 32) -+#define CFG_PARAM_ACK_SET_OFFSET_ACCUMULATION(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 0, 32, value) -+#define CFG_PARAM_ACK_SET_OFFSET_ACCUMULATION_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 0, 32, value) -+#define CFG_PARAM_ACK_GET_VALUE_ACCUMULATION(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X10, 0, 32) -+#define CFG_PARAM_ACK_SET_VALUE_ACCUMULATION(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X10, 0, 32, value) -+#define CFG_PARAM_ACK_SET_VALUE_ACCUMULATION_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X10, 0, 32, value) -+#define CH_SWITCH_ACK_GET_TSF_0(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 0, 8) -+#define CH_SWITCH_ACK_SET_TSF_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 0, 8, value) -+#define CH_SWITCH_ACK_SET_TSF_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 0, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_1(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 8, 8) -+#define CH_SWITCH_ACK_SET_TSF_1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 8, 8, value) -+#define CH_SWITCH_ACK_SET_TSF_1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 8, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_2(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define CH_SWITCH_ACK_SET_TSF_2(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define CH_SWITCH_ACK_SET_TSF_2_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_3(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define CH_SWITCH_ACK_SET_TSF_3(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define CH_SWITCH_ACK_SET_TSF_3_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_4(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X10, 0, 8) -+#define CH_SWITCH_ACK_SET_TSF_4(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X10, 0, 8, value) -+#define CH_SWITCH_ACK_SET_TSF_4_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X10, 0, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_5(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X10, 8, 8) -+#define CH_SWITCH_ACK_SET_TSF_5(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X10, 8, 8, value) -+#define CH_SWITCH_ACK_SET_TSF_5_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X10, 8, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_6(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X10, 16, 8) -+#define CH_SWITCH_ACK_SET_TSF_6(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X10, 16, 8, value) -+#define CH_SWITCH_ACK_SET_TSF_6_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X10, 16, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_7(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X10, 24, 8) -+#define CH_SWITCH_ACK_SET_TSF_7(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X10, 24, 8, value) -+#define CH_SWITCH_ACK_SET_TSF_7_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X10, 24, 8, value) -+#define BT_COEX_ACK_GET_DATA_START(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 0, 8) -+#define BT_COEX_ACK_SET_DATA_START(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 0, 8, value) -+#define BT_COEX_ACK_SET_DATA_START_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 0, 8, value) -+#define PSD_DATA_GET_SEGMENT_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 7) -+#define PSD_DATA_SET_SEGMENT_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 7, value) -+#define PSD_DATA_SET_SEGMENT_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 7, value) -+#define PSD_DATA_GET_END_SEGMENT(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 7, 1) -+#define PSD_DATA_SET_END_SEGMENT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 7, 1, value) -+#define PSD_DATA_SET_END_SEGMENT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 7, 1, value) -+#define PSD_DATA_GET_SEGMENT_SIZE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define PSD_DATA_SET_SEGMENT_SIZE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define PSD_DATA_SET_SEGMENT_SIZE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define PSD_DATA_GET_TOTAL_SIZE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 16, 16) -+#define PSD_DATA_SET_TOTAL_SIZE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define PSD_DATA_SET_TOTAL_SIZE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define PSD_DATA_GET_H2C_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 0, 16) -+#define PSD_DATA_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 0, 16, value) -+#define PSD_DATA_SET_H2C_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 0, 16, value) -+#define PSD_DATA_GET_DATA_START(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 16, 8) -+#define PSD_DATA_SET_DATA_START(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define PSD_DATA_SET_DATA_START_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define EFUSE_DATA_GET_SEGMENT_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 7) -+#define EFUSE_DATA_SET_SEGMENT_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 7, value) -+#define EFUSE_DATA_SET_SEGMENT_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 7, value) -+#define EFUSE_DATA_GET_END_SEGMENT(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 7, 1) -+#define EFUSE_DATA_SET_END_SEGMENT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 7, 1, value) -+#define EFUSE_DATA_SET_END_SEGMENT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 7, 1, value) -+#define EFUSE_DATA_GET_SEGMENT_SIZE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define EFUSE_DATA_SET_SEGMENT_SIZE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define EFUSE_DATA_SET_SEGMENT_SIZE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define EFUSE_DATA_GET_TOTAL_SIZE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 16, 16) -+#define EFUSE_DATA_SET_TOTAL_SIZE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define EFUSE_DATA_SET_TOTAL_SIZE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define EFUSE_DATA_GET_H2C_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 0, 16) -+#define EFUSE_DATA_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 0, 16, value) -+#define EFUSE_DATA_SET_H2C_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 0, 16, value) -+#define EFUSE_DATA_GET_DATA_START(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 16, 8) -+#define EFUSE_DATA_SET_DATA_START(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define EFUSE_DATA_SET_DATA_START_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define IQK_DATA_GET_SEGMENT_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 7) -+#define IQK_DATA_SET_SEGMENT_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 7, value) -+#define IQK_DATA_SET_SEGMENT_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 7, value) -+#define IQK_DATA_GET_END_SEGMENT(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 7, 1) -+#define IQK_DATA_SET_END_SEGMENT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 7, 1, value) -+#define IQK_DATA_SET_END_SEGMENT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 7, 1, value) -+#define IQK_DATA_GET_SEGMENT_SIZE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define IQK_DATA_SET_SEGMENT_SIZE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define IQK_DATA_SET_SEGMENT_SIZE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define IQK_DATA_GET_TOTAL_SIZE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 16, 16) -+#define IQK_DATA_SET_TOTAL_SIZE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define IQK_DATA_SET_TOTAL_SIZE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define IQK_DATA_GET_H2C_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 0, 16) -+#define IQK_DATA_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 0, 16, value) -+#define IQK_DATA_SET_H2C_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 0, 16, value) -+#define IQK_DATA_GET_DATA_START(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 16, 8) -+#define IQK_DATA_SET_DATA_START(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define IQK_DATA_SET_DATA_START_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define CCX_RPT_GET_POLLUTED(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X4, 0, 1) -+#define CCX_RPT_SET_POLLUTED(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X4, 0, 1, value) -+#define CCX_RPT_SET_POLLUTED_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X4, 0, 1, value) -+#define CCX_RPT_GET_RPT_SEL(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X4, 5, 3) -+#define CCX_RPT_SET_RPT_SEL(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X4, 5, 3, value) -+#define CCX_RPT_SET_RPT_SEL_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X4, 5, 3, value) -+#define CCX_RPT_GET_QSEL(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X4, 8, 5) -+#define CCX_RPT_SET_QSEL(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X4, 8, 5, value) -+#define CCX_RPT_SET_QSEL_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X4, 8, 5, value) -+#define CCX_RPT_GET_MISSED_RPT_NUM(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X4, 13, 3) -+#define CCX_RPT_SET_MISSED_RPT_NUM(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X4, 13, 3, value) -+#define CCX_RPT_SET_MISSED_RPT_NUM_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X4, 13, 3, value) -+#define CCX_RPT_GET_MACID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X4, 16, 7) -+#define CCX_RPT_SET_MACID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X4, 16, 7, value) -+#define CCX_RPT_SET_MACID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X4, 16, 7, value) -+#define CCX_RPT_GET_INITIAL_DATA_RATE(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X4, 24, 7) -+#define CCX_RPT_SET_INITIAL_DATA_RATE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X4, 24, 7, value) -+#define CCX_RPT_SET_INITIAL_DATA_RATE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X4, 24, 7, value) -+#define CCX_RPT_GET_INITIAL_SGI(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X4, 31, 1) -+#define CCX_RPT_SET_INITIAL_SGI(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X4, 31, 1, value) -+#define CCX_RPT_SET_INITIAL_SGI_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X4, 31, 1, value) -+#define CCX_RPT_GET_QUEUE_TIME(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 0, 16) -+#define CCX_RPT_SET_QUEUE_TIME(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 0, 16, value) -+#define CCX_RPT_SET_QUEUE_TIME_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 0, 16, value) -+#define CCX_RPT_GET_SW_DEFINE_BYTE0(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 16, 8) -+#define CCX_RPT_SET_SW_DEFINE_BYTE0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define CCX_RPT_SET_SW_DEFINE_BYTE0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define CCX_RPT_GET_RTS_RETRY_COUNT(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 24, 4) -+#define CCX_RPT_SET_RTS_RETRY_COUNT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 24, 4, value) -+#define CCX_RPT_SET_RTS_RETRY_COUNT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 24, 4, value) -+#define CCX_RPT_GET_BMC(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 29, 1) -+#define CCX_RPT_SET_BMC(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 29, 1, value) -+#define CCX_RPT_SET_BMC_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 29, 1, value) -+#define CCX_RPT_GET_TX_STATE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X8, 30, 2) -+#define CCX_RPT_SET_TX_STATE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 30, 2, value) -+#define CCX_RPT_SET_TX_STATE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 30, 2, value) -+#define CCX_RPT_GET_DATA_RETRY_COUNT(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 0, 6) -+#define CCX_RPT_SET_DATA_RETRY_COUNT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 0, 6, value) -+#define CCX_RPT_SET_DATA_RETRY_COUNT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 0, 6, value) -+#define CCX_RPT_GET_FINAL_DATA_RATE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 8, 7) -+#define CCX_RPT_SET_FINAL_DATA_RATE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 8, 7, value) -+#define CCX_RPT_SET_FINAL_DATA_RATE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 8, 7, value) -+#define CCX_RPT_GET_FINAL_SGI(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 15, 1) -+#define CCX_RPT_SET_FINAL_SGI(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 15, 1, value) -+#define CCX_RPT_SET_FINAL_SGI_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 15, 1, value) -+#define CCX_RPT_GET_RF_CH_NUM(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 16, 10) -+#define CCX_RPT_SET_RF_CH_NUM(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 16, 10, value) -+#define CCX_RPT_SET_RF_CH_NUM_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 16, 10, value) -+#define CCX_RPT_GET_SC(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 26, 4) -+#define CCX_RPT_SET_SC(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 26, 4, value) -+#define CCX_RPT_SET_SC_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 26, 4, value) -+#define CCX_RPT_GET_BW(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0XC, 30, 2) -+#define CCX_RPT_SET_BW(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0XC, 30, 2, value) -+#define CCX_RPT_SET_BW_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0XC, 30, 2, value) -+#define C2H_PKT_FW_STATUS_NOTIFY_GET_STATUS_CODE(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 0, 32) -+#define C2H_PKT_FW_STATUS_NOTIFY_SET_STATUS_CODE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 32, value) -+#define C2H_PKT_FW_STATUS_NOTIFY_SET_STATUS_CODE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 32, value) -+#define C2H_PKT_DETECT_THERMAL_GET_THERMAL_VALUE(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 0, 32) -+#define C2H_PKT_DETECT_THERMAL_SET_THERMAL_VALUE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 32, value) -+#define C2H_PKT_DETECT_THERMAL_SET_THERMAL_VALUE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 32, value) -+#define FW_DBG_MSG_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define FW_DBG_MSG_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define FW_DBG_MSG_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define FW_DBG_MSG_GET_C2H_SUB_CMD_ID(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 16, 8) -+#define FW_DBG_MSG_SET_C2H_SUB_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define FW_DBG_MSG_SET_C2H_SUB_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define FW_DBG_MSG_GET_FULL(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 24, 1) -+#define FW_DBG_MSG_SET_FULL(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 24, 1, value) -+#define FW_DBG_MSG_SET_FULL_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 24, 1, value) -+#define FW_DBG_MSG_GET_OWN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 31, 1) -+#define FW_DBG_MSG_SET_OWN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 31, 1, value) -+#define FW_DBG_MSG_SET_OWN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 31, 1, value) -+#define FW_FWCTRL_RPT_GET_EVT_TYPE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define FW_FWCTRL_RPT_SET_EVT_TYPE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define FW_FWCTRL_RPT_SET_EVT_TYPE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define FW_FWCTRL_RPT_GET_LENGTH(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define FW_FWCTRL_RPT_SET_LENGTH(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define FW_FWCTRL_RPT_SET_LENGTH_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define FW_FWCTRL_RPT_GET_SEQ_NUM(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 16, 8) -+#define FW_FWCTRL_RPT_SET_SEQ_NUM(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define FW_FWCTRL_RPT_SET_SEQ_NUM_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define FW_FWCTRL_RPT_GET_IS_ACK(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 24, 1) -+#define FW_FWCTRL_RPT_SET_IS_ACK(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 24, 1, value) -+#define FW_FWCTRL_RPT_SET_IS_ACK_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 24, 1, value) -+#define FW_FWCTRL_RPT_GET_MORE_CONTENT(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 25, 1) -+#define FW_FWCTRL_RPT_SET_MORE_CONTENT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 25, 1, value) -+#define FW_FWCTRL_RPT_SET_MORE_CONTENT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 25, 1, value) -+#define FW_FWCTRL_RPT_GET_CONTENT_IDX(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 26, 6) -+#define FW_FWCTRL_RPT_SET_CONTENT_IDX(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 26, 6, value) -+#define FW_FWCTRL_RPT_SET_CONTENT_IDX_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 26, 6, value) -+#define FW_FWCTRL_RPT_GET_CLASS_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define FW_FWCTRL_RPT_SET_CLASS_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define FW_FWCTRL_RPT_SET_CLASS_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define FW_FWCTRL_RPT_GET_CONTENT(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 16, 16) -+#define FW_FWCTRL_RPT_SET_CONTENT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define FW_FWCTRL_RPT_SET_CONTENT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_0(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_2(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 16, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_2(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_2_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_3(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 24, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_3(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_3_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_4(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X8, 0, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_4(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 0, 8, value) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_4_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 0, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_5(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X8, 8, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_5(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 8, 8, value) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_5_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 8, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_6(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X8, 16, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_6(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_6_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_7(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X8, 24, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_7(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 24, 8, value) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_7_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 24, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_0(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_2(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 16, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_2(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_2_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_3(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 24, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_3(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_3_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_4(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X8, 0, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_4(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 0, 8, value) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_4_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 0, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_5(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X8, 8, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_5(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 8, 8, value) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_5_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 8, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_6(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X8, 16, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_6(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_6_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 16, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_7(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X8, 24, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_7(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X8, 24, 8, value) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_7_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X8, 24, 8, value) -+#define SCAN_CH_NOTIFY_GET_CH_NUM(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define SCAN_CH_NOTIFY_SET_CH_NUM(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define SCAN_CH_NOTIFY_SET_CH_NUM_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define SCAN_CH_NOTIFY_GET_NOTIFY_ID(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define SCAN_CH_NOTIFY_SET_NOTIFY_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define SCAN_CH_NOTIFY_SET_NOTIFY_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define SCAN_CH_NOTIFY_GET_STATUS(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 16, 8) -+#define SCAN_CH_NOTIFY_SET_STATUS(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define SCAN_CH_NOTIFY_SET_STATUS_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_0(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 0, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define SCAN_CH_NOTIFY_SET_TSF_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_1(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 8, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define SCAN_CH_NOTIFY_SET_TSF_1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_2(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 16, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_2(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define SCAN_CH_NOTIFY_SET_TSF_2_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_3(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 24, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_3(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 24, 8, value) -+#define SCAN_CH_NOTIFY_SET_TSF_3_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 24, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_4(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 0, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_4(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 0, 8, value) -+#define SCAN_CH_NOTIFY_SET_TSF_4_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 0, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_5(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 8, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_5(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 8, 8, value) -+#define SCAN_CH_NOTIFY_SET_TSF_5_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 8, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_6(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_6(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define SCAN_CH_NOTIFY_SET_TSF_6_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_7(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_7(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define SCAN_CH_NOTIFY_SET_TSF_7_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define FW_TBTT_RPT_GET_PORT_NUMBER(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define FW_TBTT_RPT_SET_PORT_NUMBER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define FW_TBTT_RPT_SET_PORT_NUMBER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define BCN_OFFLOAD_GET_SUPPORT_VER(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define BCN_OFFLOAD_SET_SUPPORT_VER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define BCN_OFFLOAD_SET_SUPPORT_VER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define BCN_OFFLOAD_GET_STATUS(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define BCN_OFFLOAD_SET_STATUS(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define BCN_OFFLOAD_SET_STATUS_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define DPK_DATA_GET_SEGMENT_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 7) -+#define DPK_DATA_SET_SEGMENT_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 7, value) -+#define DPK_DATA_SET_SEGMENT_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 7, value) -+#define DPK_DATA_GET_END_SEGMENT(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 7, 1) -+#define DPK_DATA_SET_END_SEGMENT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 7, 1, value) -+#define DPK_DATA_SET_END_SEGMENT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 7, 1, value) -+#define DPK_DATA_GET_SEGMENT_SIZE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define DPK_DATA_SET_SEGMENT_SIZE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define DPK_DATA_SET_SEGMENT_SIZE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define DPK_DATA_GET_TOTAL_SIZE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 16, 16) -+#define DPK_DATA_SET_TOTAL_SIZE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define DPK_DATA_SET_TOTAL_SIZE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 16, value) -+#define DPK_DATA_GET_H2C_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 0, 16) -+#define DPK_DATA_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 0, 16, value) -+#define DPK_DATA_SET_H2C_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 0, 16, value) -+#define DPK_DATA_GET_PATH0_OK(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 16, 8) -+#define DPK_DATA_SET_PATH0_OK(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define DPK_DATA_SET_PATH0_OK_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define DPK_DATA_GET_PATH1_OK(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 24, 8) -+#define DPK_DATA_SET_PATH1_OK(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 24, 8, value) -+#define DPK_DATA_SET_PATH1_OK_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 24, 8, value) -+#define DPK_DATA_GET_THERM0_S0(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 0, 8) -+#define DPK_DATA_SET_THERM0_S0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 0, 8, value) -+#define DPK_DATA_SET_THERM0_S0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 0, 8, value) -+#define DPK_DATA_GET_THERM0_S1(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 8, 8) -+#define DPK_DATA_SET_THERM0_S1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 8, 8, value) -+#define DPK_DATA_SET_THERM0_S1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 8, 8, value) -+#define DPK_DATA_GET_THERM1_S0(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define DPK_DATA_SET_THERM1_S0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define DPK_DATA_SET_THERM1_S0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define DPK_DATA_GET_THERM1_S1(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define DPK_DATA_SET_THERM1_S1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define DPK_DATA_SET_THERM1_S1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define DPK_DATA_GET_THERM_DELTA0_S0(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X10, 0, 8) -+#define DPK_DATA_SET_THERM_DELTA0_S0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X10, 0, 8, value) -+#define DPK_DATA_SET_THERM_DELTA0_S0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X10, 0, 8, value) -+#define DPK_DATA_GET_THERM_DELTA0_S1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X10, 8, 8) -+#define DPK_DATA_SET_THERM_DELTA0_S1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X10, 8, 8, value) -+#define DPK_DATA_SET_THERM_DELTA0_S1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X10, 8, 8, value) -+#define DPK_DATA_GET_THERM_DELTA1_S0(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X10, 16, 8) -+#define DPK_DATA_SET_THERM_DELTA1_S0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X10, 16, 8, value) -+#define DPK_DATA_SET_THERM_DELTA1_S0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X10, 16, 8, value) -+#define DPK_DATA_GET_THERM_DELTA1_S1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X10, 24, 8) -+#define DPK_DATA_SET_THERM_DELTA1_S1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X10, 24, 8, value) -+#define DPK_DATA_SET_THERM_DELTA1_S1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X10, 24, 8, value) -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_c2h_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_c2h_nic.h -new file mode 100644 -index 000000000..0b4aeadb9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_c2h_nic.h -@@ -0,0 +1,559 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_FWOFFLOADC2HFORMAT_H2C_C2H_NIC_H_ -+#define _HAL_FWOFFLOADC2HFORMAT_H2C_C2H_NIC_H_ -+#define C2H_SUB_CMD_ID_C2H_DBG 0X00 -+#define C2H_SUB_CMD_ID_BT_COEX_INFO 0X02 -+#define C2H_SUB_CMD_ID_SCAN_STATUS_RPT 0X03 -+#define C2H_SUB_CMD_ID_H2C_ACK_HDR 0X01 -+#define C2H_SUB_CMD_ID_CFG_PARAM_ACK 0X01 -+#define C2H_SUB_CMD_ID_CH_SWITCH_ACK 0X01 -+#define C2H_SUB_CMD_ID_BT_COEX_ACK 0X01 -+#define C2H_SUB_CMD_ID_DUMP_PHYSICAL_EFUSE_ACK 0X01 -+#define C2H_SUB_CMD_ID_UPDATE_PKT_ACK 0X01 -+#define C2H_SUB_CMD_ID_SEND_SCAN_PKT_ACK 0X01 -+#define C2H_SUB_CMD_ID_DROP_SCAN_PKT_ACK 0X01 -+#define C2H_SUB_CMD_ID_UPDATE_DATAPACK_ACK 0X01 -+#define C2H_SUB_CMD_ID_RUN_DATAPACK_ACK 0X01 -+#define C2H_SUB_CMD_ID_IQK_ACK 0X01 -+#define C2H_SUB_CMD_ID_PWR_TRK_ACK 0X01 -+#define C2H_SUB_CMD_ID_PSD_ACK 0X01 -+#define C2H_SUB_CMD_ID_FW_MEM_DUMP_ACK 0X01 -+#define C2H_SUB_CMD_ID_ACT_SCHEDULE_REQ_ACK 0X1 -+#define C2H_SUB_CMD_ID_NAN_FUNC_CTRL_ACK 0X1 -+#define C2H_SUB_CMD_ID_DPK_ACK 0X1 -+#define C2H_SUB_CMD_ID_PSD_DATA 0X04 -+#define C2H_SUB_CMD_ID_EFUSE_DATA 0X05 -+#define C2H_SUB_CMD_ID_IQK_DATA 0X06 -+#define C2H_SUB_CMD_ID_C2H_PKT_FTM_DBG 0X07 -+#define C2H_SUB_CMD_ID_C2H_PKT_FTM_2_DBG 0X08 -+#define C2H_SUB_CMD_ID_C2H_PKT_FTM_3_DBG 0X09 -+#define C2H_SUB_CMD_ID_C2H_PKT_FTM_4_DBG 0X0A -+#define C2H_SUB_CMD_ID_FTMACKRPT_HDL_DBG 0X0B -+#define C2H_SUB_CMD_ID_FTMC2H_RPT 0X0C -+#define C2H_SUB_CMD_ID_DRVFTMC2H_RPT 0X0D -+#define C2H_SUB_CMD_ID_C2H_PKT_FTM_5_DBG 0X0E -+#define C2H_SUB_CMD_ID_CCX_RPT 0X0F -+#define C2H_SUB_CMD_ID_C2H_PKT_NAN_RPT 0X10 -+#define C2H_SUB_CMD_ID_C2H_PKT_ATM_RPT 0X11 -+#define C2H_SUB_CMD_ID_C2H_PKT_SCC_CSA_RPT 0X1A -+#define C2H_SUB_CMD_ID_C2H_PKT_FW_STATUS_NOTIFY 0X1B -+#define C2H_SUB_CMD_ID_C2H_PKT_FTMSESSION_END 0X1C -+#define C2H_SUB_CMD_ID_C2H_PKT_DETECT_THERMAL 0X1D -+#define C2H_SUB_CMD_ID_FW_DBG_MSG 0XFF -+#define C2H_SUB_CMD_ID_FW_SNDING_ACK 0X01 -+#define C2H_SUB_CMD_ID_FW_FWCTRL_RPT 0X1F -+#define C2H_SUB_CMD_ID_H2C_LOOPBACK_ACK 0X20 -+#define C2H_SUB_CMD_ID_FWCMD_LOOPBACK_ACK 0X21 -+#define C2H_SUB_CMD_ID_SCAN_CH_NOTIFY 0X22 -+#define C2H_SUB_CMD_ID_FW_TBTT_RPT 0X23 -+#define C2H_SUB_CMD_ID_BCN_OFFLOAD 0X24 -+#define C2H_SUB_CMD_ID_DPK_DATA 0X25 -+#define H2C_SUB_CMD_ID_CFG_PARAM_ACK SUB_CMD_ID_CFG_PARAM -+#define H2C_SUB_CMD_ID_CH_SWITCH_ACK SUB_CMD_ID_CH_SWITCH -+#define H2C_SUB_CMD_ID_BT_COEX_ACK SUB_CMD_ID_BT_COEX -+#define H2C_SUB_CMD_ID_DUMP_PHYSICAL_EFUSE_ACK SUB_CMD_ID_DUMP_PHYSICAL_EFUSE -+#define H2C_SUB_CMD_ID_UPDATE_PKT_ACK SUB_CMD_ID_UPDATE_PKT -+#define H2C_SUB_CMD_ID_SEND_SCAN_PKT_ACK SUB_CMD_ID_SEND_SCAN_PKT -+#define H2C_SUB_CMD_ID_DROP_SCAN_PKT_ACK SUB_CMD_ID_DROP_SCAN_PKT -+#define H2C_SUB_CMD_ID_UPDATE_DATAPACK_ACK SUB_CMD_ID_UPDATE_DATAPACK -+#define H2C_SUB_CMD_ID_RUN_DATAPACK_ACK SUB_CMD_ID_RUN_DATAPACK -+#define H2C_SUB_CMD_ID_IQK_ACK SUB_CMD_ID_IQK -+#define H2C_SUB_CMD_ID_PWR_TRK_ACK SUB_CMD_ID_PWR_TRK -+#define H2C_SUB_CMD_ID_PSD_ACK SUB_CMD_ID_PSD -+#define H2C_SUB_CMD_ID_FW_MEM_DUMP_ACK SUB_CMD_ID_FW_MEM_DUMP -+#define H2C_SUB_CMD_ID_ACT_SCHEDULE_REQ_ACK SUB_CMD_ID_ACT_SCHEDULE_REQ -+#define H2C_SUB_CMD_ID_NAN_FUNC_CTRL_ACK SUB_CMD_ID_NAN_FUNC_CTRL -+#define H2C_SUB_CMD_ID_DPK_ACK SUB_CMD_ID_DPK -+#define H2C_SUB_CMD_ID_CCX_RPT SUB_CMD_ID_CCX_RPT -+#define H2C_SUB_CMD_ID_FW_DBG_MSG SUB_CMD_ID_FW_DBG_MSG -+#define H2C_SUB_CMD_ID_FW_SNDING_ACK SUB_CMD_ID_FW_SNDING -+#define H2C_SUB_CMD_ID_FW_FWCTRL_RPT SUB_CMD_ID_FW_FWCTRL_RPT -+#define H2C_SUB_CMD_ID_H2C_LOOPBACK_ACK SUB_CMD_ID_H2C_LOOPBACK -+#define H2C_SUB_CMD_ID_FWCMD_LOOPBACK_ACK SUB_CMD_ID_FWCMD_LOOPBACK -+#define H2C_CMD_ID_CFG_PARAM_ACK 0XFF -+#define H2C_CMD_ID_CH_SWITCH_ACK 0XFF -+#define H2C_CMD_ID_BT_COEX_ACK 0XFF -+#define H2C_CMD_ID_DUMP_PHYSICAL_EFUSE_ACK 0XFF -+#define H2C_CMD_ID_UPDATE_PKT_ACK 0XFF -+#define H2C_CMD_ID_SEND_SCAN_PKT_ACK 0XFF -+#define H2C_CMD_ID_DROP_SCAN_PKT_ACK 0XFF -+#define H2C_CMD_ID_UPDATE_DATAPACK_ACK 0XFF -+#define H2C_CMD_ID_RUN_DATAPACK_ACK 0XFF -+#define H2C_CMD_ID_IQK_ACK 0XFF -+#define H2C_CMD_ID_PWR_TRK_ACK 0XFF -+#define H2C_CMD_ID_PSD_ACK 0XFF -+#define H2C_CMD_ID_FW_MEM_DUMP_ACK 0XFF -+#define H2C_CMD_ID_ACT_SCHEDULE_REQ_ACK 0XFF -+#define H2C_CMD_ID_NAN_FUNC_CTRL_ACK 0XFF -+#define H2C_CMD_ID_DPK_ACK 0XFF -+#define H2C_CMD_ID_CCX_RPT 0XFF -+#define H2C_CMD_ID_FW_DBG_MSG 0XFF -+#define H2C_CMD_ID_FW_SNDING_ACK 0XFF -+#define H2C_CMD_ID_FW_FWCTRL_RPT 0XFF -+#define H2C_CMD_ID_H2C_LOOPBACK_ACK 0XFF -+#define H2C_CMD_ID_FWCMD_LOOPBACK_ACK 0XFF -+#define C2H_HDR_GET_CMD_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_HDR_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_HDR_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_HDR_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_HDR_GET_C2H_SUB_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 8) -+#define C2H_HDR_SET_C2H_SUB_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_HDR_GET_LEN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 24, 8) -+#define C2H_HDR_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_DBG_GET_DBG_MSG(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define C2H_DBG_SET_DBG_MSG(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define BT_COEX_INFO_GET_DATA_START(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define BT_COEX_INFO_SET_DATA_START(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define SCAN_STATUS_RPT_GET_H2C_RETURN_CODE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define SCAN_STATUS_RPT_SET_H2C_RETURN_CODE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define SCAN_STATUS_RPT_GET_H2C_SEQ(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 16) -+#define SCAN_STATUS_RPT_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 16, value) -+#define SCAN_STATUS_RPT_GET_TSF_0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 0, 8) -+#define SCAN_STATUS_RPT_SET_TSF_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 0, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 8, 8) -+#define SCAN_STATUS_RPT_SET_TSF_1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 8, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_2(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 16, 8) -+#define SCAN_STATUS_RPT_SET_TSF_2(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 16, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_3(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 24, 8) -+#define SCAN_STATUS_RPT_SET_TSF_3(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 24, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_4(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 0, 8) -+#define SCAN_STATUS_RPT_SET_TSF_4(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 0, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_5(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 8, 8) -+#define SCAN_STATUS_RPT_SET_TSF_5(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 8, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_6(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 16, 8) -+#define SCAN_STATUS_RPT_SET_TSF_6(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 16, 8, value) -+#define SCAN_STATUS_RPT_GET_TSF_7(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 24, 8) -+#define SCAN_STATUS_RPT_SET_TSF_7(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 24, 8, value) -+#define H2C_ACK_HDR_GET_H2C_RETURN_CODE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define H2C_ACK_HDR_SET_H2C_RETURN_CODE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define H2C_ACK_HDR_GET_H2C_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define H2C_ACK_HDR_SET_H2C_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define H2C_ACK_HDR_GET_H2C_SUB_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 16) -+#define H2C_ACK_HDR_SET_H2C_SUB_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 16, value) -+#define H2C_ACK_HDR_GET_H2C_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 0, 16) -+#define H2C_ACK_HDR_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 0, 16, value) -+#define CFG_PARAM_ACK_GET_OFFSET_ACCUMULATION(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 0, 32) -+#define CFG_PARAM_ACK_SET_OFFSET_ACCUMULATION(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 0, 32, value) -+#define CFG_PARAM_ACK_GET_VALUE_ACCUMULATION(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X10, 0, 32) -+#define CFG_PARAM_ACK_SET_VALUE_ACCUMULATION(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X10, 0, 32, value) -+#define CH_SWITCH_ACK_GET_TSF_0(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 0, 8) -+#define CH_SWITCH_ACK_SET_TSF_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 0, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_1(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 8, 8) -+#define CH_SWITCH_ACK_SET_TSF_1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 8, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_2(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define CH_SWITCH_ACK_SET_TSF_2(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_3(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define CH_SWITCH_ACK_SET_TSF_3(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_4(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X10, 0, 8) -+#define CH_SWITCH_ACK_SET_TSF_4(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X10, 0, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_5(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X10, 8, 8) -+#define CH_SWITCH_ACK_SET_TSF_5(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X10, 8, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_6(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X10, 16, 8) -+#define CH_SWITCH_ACK_SET_TSF_6(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X10, 16, 8, value) -+#define CH_SWITCH_ACK_GET_TSF_7(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X10, 24, 8) -+#define CH_SWITCH_ACK_SET_TSF_7(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X10, 24, 8, value) -+#define BT_COEX_ACK_GET_DATA_START(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 0, 8) -+#define BT_COEX_ACK_SET_DATA_START(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 0, 8, value) -+#define PSD_DATA_GET_SEGMENT_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 7) -+#define PSD_DATA_SET_SEGMENT_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 7, value) -+#define PSD_DATA_GET_END_SEGMENT(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 7, 1) -+#define PSD_DATA_SET_END_SEGMENT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 7, 1, value) -+#define PSD_DATA_GET_SEGMENT_SIZE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define PSD_DATA_SET_SEGMENT_SIZE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define PSD_DATA_GET_TOTAL_SIZE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 16) -+#define PSD_DATA_SET_TOTAL_SIZE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 16, value) -+#define PSD_DATA_GET_H2C_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 0, 16) -+#define PSD_DATA_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 0, 16, value) -+#define PSD_DATA_GET_DATA_START(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 16, 8) -+#define PSD_DATA_SET_DATA_START(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 16, 8, value) -+#define EFUSE_DATA_GET_SEGMENT_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 7) -+#define EFUSE_DATA_SET_SEGMENT_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 7, value) -+#define EFUSE_DATA_GET_END_SEGMENT(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 7, 1) -+#define EFUSE_DATA_SET_END_SEGMENT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 7, 1, value) -+#define EFUSE_DATA_GET_SEGMENT_SIZE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define EFUSE_DATA_SET_SEGMENT_SIZE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define EFUSE_DATA_GET_TOTAL_SIZE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 16) -+#define EFUSE_DATA_SET_TOTAL_SIZE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 16, value) -+#define EFUSE_DATA_GET_H2C_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 0, 16) -+#define EFUSE_DATA_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 0, 16, value) -+#define EFUSE_DATA_GET_DATA_START(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 16, 8) -+#define EFUSE_DATA_SET_DATA_START(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 16, 8, value) -+#define IQK_DATA_GET_SEGMENT_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 7) -+#define IQK_DATA_SET_SEGMENT_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 7, value) -+#define IQK_DATA_GET_END_SEGMENT(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 7, 1) -+#define IQK_DATA_SET_END_SEGMENT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 7, 1, value) -+#define IQK_DATA_GET_SEGMENT_SIZE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define IQK_DATA_SET_SEGMENT_SIZE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define IQK_DATA_GET_TOTAL_SIZE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 16) -+#define IQK_DATA_SET_TOTAL_SIZE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 16, value) -+#define IQK_DATA_GET_H2C_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 0, 16) -+#define IQK_DATA_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 0, 16, value) -+#define IQK_DATA_GET_DATA_START(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 16, 8) -+#define IQK_DATA_SET_DATA_START(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 16, 8, value) -+#define CCX_RPT_GET_POLLUTED(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X4, 0, 1) -+#define CCX_RPT_SET_POLLUTED(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X4, 0, 1, value) -+#define CCX_RPT_GET_RPT_SEL(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X4, 5, 3) -+#define CCX_RPT_SET_RPT_SEL(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X4, 5, 3, value) -+#define CCX_RPT_GET_QSEL(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X4, 8, 5) -+#define CCX_RPT_SET_QSEL(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X4, 8, 5, value) -+#define CCX_RPT_GET_MISSED_RPT_NUM(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X4, 13, 3) -+#define CCX_RPT_SET_MISSED_RPT_NUM(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X4, 13, 3, value) -+#define CCX_RPT_GET_MACID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X4, 16, 7) -+#define CCX_RPT_SET_MACID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X4, 16, 7, value) -+#define CCX_RPT_GET_INITIAL_DATA_RATE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X4, 24, 7) -+#define CCX_RPT_SET_INITIAL_DATA_RATE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X4, 24, 7, value) -+#define CCX_RPT_GET_INITIAL_SGI(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X4, 31, 1) -+#define CCX_RPT_SET_INITIAL_SGI(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X4, 31, 1, value) -+#define CCX_RPT_GET_QUEUE_TIME(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 0, 16) -+#define CCX_RPT_SET_QUEUE_TIME(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 0, 16, value) -+#define CCX_RPT_GET_SW_DEFINE_BYTE0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 16, 8) -+#define CCX_RPT_SET_SW_DEFINE_BYTE0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 16, 8, value) -+#define CCX_RPT_GET_RTS_RETRY_COUNT(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 24, 4) -+#define CCX_RPT_SET_RTS_RETRY_COUNT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 24, 4, value) -+#define CCX_RPT_GET_BMC(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 29, 1) -+#define CCX_RPT_SET_BMC(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 29, 1, value) -+#define CCX_RPT_GET_TX_STATE(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 30, 2) -+#define CCX_RPT_SET_TX_STATE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 30, 2, value) -+#define CCX_RPT_GET_DATA_RETRY_COUNT(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 0, 6) -+#define CCX_RPT_SET_DATA_RETRY_COUNT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 0, 6, value) -+#define CCX_RPT_GET_FINAL_DATA_RATE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 8, 7) -+#define CCX_RPT_SET_FINAL_DATA_RATE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 8, 7, value) -+#define CCX_RPT_GET_FINAL_SGI(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 15, 1) -+#define CCX_RPT_SET_FINAL_SGI(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 15, 1, value) -+#define CCX_RPT_GET_RF_CH_NUM(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 16, 10) -+#define CCX_RPT_SET_RF_CH_NUM(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 16, 10, value) -+#define CCX_RPT_GET_SC(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 26, 4) -+#define CCX_RPT_SET_SC(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 26, 4, value) -+#define CCX_RPT_GET_BW(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0XC, 30, 2) -+#define CCX_RPT_SET_BW(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0XC, 30, 2, value) -+#define C2H_PKT_FW_STATUS_NOTIFY_GET_STATUS_CODE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 32) -+#define C2H_PKT_FW_STATUS_NOTIFY_SET_STATUS_CODE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 32, value) -+#define C2H_PKT_DETECT_THERMAL_GET_THERMAL_VALUE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 32) -+#define C2H_PKT_DETECT_THERMAL_SET_THERMAL_VALUE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 32, value) -+#define FW_DBG_MSG_GET_CMD_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define FW_DBG_MSG_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define FW_DBG_MSG_GET_C2H_SUB_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 8) -+#define FW_DBG_MSG_SET_C2H_SUB_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 8, value) -+#define FW_DBG_MSG_GET_FULL(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 24, 1) -+#define FW_DBG_MSG_SET_FULL(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 24, 1, value) -+#define FW_DBG_MSG_GET_OWN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 31, 1) -+#define FW_DBG_MSG_SET_OWN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 31, 1, value) -+#define FW_FWCTRL_RPT_GET_EVT_TYPE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define FW_FWCTRL_RPT_SET_EVT_TYPE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define FW_FWCTRL_RPT_GET_LENGTH(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define FW_FWCTRL_RPT_SET_LENGTH(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define FW_FWCTRL_RPT_GET_SEQ_NUM(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 8) -+#define FW_FWCTRL_RPT_SET_SEQ_NUM(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 8, value) -+#define FW_FWCTRL_RPT_GET_IS_ACK(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 24, 1) -+#define FW_FWCTRL_RPT_SET_IS_ACK(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 24, 1, value) -+#define FW_FWCTRL_RPT_GET_MORE_CONTENT(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 25, 1) -+#define FW_FWCTRL_RPT_SET_MORE_CONTENT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 25, 1, value) -+#define FW_FWCTRL_RPT_GET_CONTENT_IDX(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 26, 6) -+#define FW_FWCTRL_RPT_SET_CONTENT_IDX(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 26, 6, value) -+#define FW_FWCTRL_RPT_GET_CLASS_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define FW_FWCTRL_RPT_SET_CLASS_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define FW_FWCTRL_RPT_GET_CONTENT(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 16) -+#define FW_FWCTRL_RPT_SET_CONTENT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 16, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_2(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_2(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_3(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 24, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_3(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 24, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_4(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 0, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_4(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 0, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_5(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 8, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_5(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 8, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_6(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 16, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_6(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 16, 8, value) -+#define H2C_LOOPBACK_ACK_GET_H2C_BYTE_7(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 24, 8) -+#define H2C_LOOPBACK_ACK_SET_H2C_BYTE_7(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 24, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_2(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_2(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_3(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 24, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_3(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 24, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_4(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 0, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_4(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 0, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_5(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 8, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_5(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 8, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_6(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 16, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_6(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 16, 8, value) -+#define FWCMD_LOOPBACK_ACK_GET_H2C_BYTE_7(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X8, 24, 8) -+#define FWCMD_LOOPBACK_ACK_SET_H2C_BYTE_7(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X8, 24, 8, value) -+#define SCAN_CH_NOTIFY_GET_CH_NUM(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define SCAN_CH_NOTIFY_SET_CH_NUM(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define SCAN_CH_NOTIFY_GET_NOTIFY_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define SCAN_CH_NOTIFY_SET_NOTIFY_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define SCAN_CH_NOTIFY_GET_STATUS(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 8) -+#define SCAN_CH_NOTIFY_SET_STATUS(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_0(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 0, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 0, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_1(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 8, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 8, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_2(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 16, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_2(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 16, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_3(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 24, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_3(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 24, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_4(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 0, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_4(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 0, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_5(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 8, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_5(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 8, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_6(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_6(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define SCAN_CH_NOTIFY_GET_TSF_7(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define SCAN_CH_NOTIFY_SET_TSF_7(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define FW_TBTT_RPT_GET_PORT_NUMBER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define FW_TBTT_RPT_SET_PORT_NUMBER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define BCN_OFFLOAD_GET_SUPPORT_VER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define BCN_OFFLOAD_SET_SUPPORT_VER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define BCN_OFFLOAD_GET_STATUS(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define BCN_OFFLOAD_SET_STATUS(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define DPK_DATA_GET_SEGMENT_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 7) -+#define DPK_DATA_SET_SEGMENT_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 7, value) -+#define DPK_DATA_GET_END_SEGMENT(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 7, 1) -+#define DPK_DATA_SET_END_SEGMENT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 7, 1, value) -+#define DPK_DATA_GET_SEGMENT_SIZE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define DPK_DATA_SET_SEGMENT_SIZE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define DPK_DATA_GET_TOTAL_SIZE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 16) -+#define DPK_DATA_SET_TOTAL_SIZE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 16, value) -+#define DPK_DATA_GET_H2C_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 0, 16) -+#define DPK_DATA_SET_H2C_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 0, 16, value) -+#define DPK_DATA_GET_PATH0_OK(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 16, 8) -+#define DPK_DATA_SET_PATH0_OK(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 16, 8, value) -+#define DPK_DATA_GET_PATH1_OK(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 24, 8) -+#define DPK_DATA_SET_PATH1_OK(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 24, 8, value) -+#define DPK_DATA_GET_THERM0_S0(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 0, 8) -+#define DPK_DATA_SET_THERM0_S0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 0, 8, value) -+#define DPK_DATA_GET_THERM0_S1(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 8, 8) -+#define DPK_DATA_SET_THERM0_S1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 8, 8, value) -+#define DPK_DATA_GET_THERM1_S0(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define DPK_DATA_SET_THERM1_S0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define DPK_DATA_GET_THERM1_S1(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define DPK_DATA_SET_THERM1_S1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define DPK_DATA_GET_THERM_DELTA0_S0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X10, 0, 8) -+#define DPK_DATA_SET_THERM_DELTA0_S0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X10, 0, 8, value) -+#define DPK_DATA_GET_THERM_DELTA0_S1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X10, 8, 8) -+#define DPK_DATA_SET_THERM_DELTA0_S1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X10, 8, 8, value) -+#define DPK_DATA_GET_THERM_DELTA1_S0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X10, 16, 8) -+#define DPK_DATA_SET_THERM_DELTA1_S0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X10, 16, 8, value) -+#define DPK_DATA_GET_THERM_DELTA1_S1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X10, 24, 8) -+#define DPK_DATA_SET_THERM_DELTA1_S1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X10, 24, 8, value) -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_h2c_ap.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_h2c_ap.h -new file mode 100644 -index 000000000..81afe3f5b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_h2c_ap.h -@@ -0,0 +1,1218 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_FWOFFLOADH2CFORMAT_H2C_C2H_AP_H_ -+#define _HAL_FWOFFLOADH2CFORMAT_H2C_C2H_AP_H_ -+#define CMD_ID_FW_OFFLOAD_H2C 0XFF -+#define CMD_ID_FW_ACCESS_TEST 0XFF -+#define CMD_ID_CH_SWITCH 0XFF -+#define CMD_ID_DUMP_PHYSICAL_EFUSE 0XFF -+#define CMD_ID_UPDATE_BEACON_PARSING_INFO 0XFF -+#define CMD_ID_CFG_PARAM 0XFF -+#define CMD_ID_UPDATE_DATAPACK 0XFF -+#define CMD_ID_RUN_DATAPACK 0XFF -+#define CMD_ID_DOWNLOAD_FLASH 0XFF -+#define CMD_ID_UPDATE_PKT 0XFF -+#define CMD_ID_GENERAL_INFO 0XFF -+#define CMD_ID_IQK 0XFF -+#define CMD_ID_PWR_TRK 0XFF -+#define CMD_ID_PSD 0XFF -+#define CMD_ID_PHYDM_INFO 0XFF -+#define CMD_ID_FW_SNDING 0XFF -+#define CMD_ID_FW_FWCTRL 0XFF -+#define CMD_ID_H2C_LOOPBACK 0XFF -+#define CMD_ID_FWCMD_LOOPBACK 0XFF -+#define CMD_ID_SEND_SCAN_PKT 0XFF -+#define CMD_ID_BCN_OFFLOAD 0XFF -+#define CMD_ID_DROP_SCAN_PKT 0XFF -+#define CMD_ID_P2PPS 0XFF -+#define CMD_ID_BT_COEX 0XFF -+#define CMD_ID_ACT_SCHEDULE_REQ 0XFF -+#define CMD_ID_NAN_CTRL 0XFF -+#define CMD_ID_NAN_CHANNEL_PLAN_0 0XFF -+#define CMD_ID_NAN_CHANNEL_PLAN_1 0XFF -+#define CMD_ID_NAN_FUNC_CTRL 0XFF -+#define CMD_ID_DPK 0XFF -+#define CATEGORY_H2C_CMD_HEADER 0X00 -+#define CATEGORY_FW_OFFLOAD_H2C 0X01 -+#define CATEGORY_FW_ACCESS_TEST 0X01 -+#define CATEGORY_CH_SWITCH 0X01 -+#define CATEGORY_DUMP_PHYSICAL_EFUSE 0X01 -+#define CATEGORY_UPDATE_BEACON_PARSING_INFO 0X01 -+#define CATEGORY_CFG_PARAM 0X01 -+#define CATEGORY_UPDATE_DATAPACK 0X01 -+#define CATEGORY_RUN_DATAPACK 0X01 -+#define CATEGORY_DOWNLOAD_FLASH 0X01 -+#define CATEGORY_UPDATE_PKT 0X01 -+#define CATEGORY_GENERAL_INFO 0X01 -+#define CATEGORY_IQK 0X01 -+#define CATEGORY_PWR_TRK 0X01 -+#define CATEGORY_PSD 0X01 -+#define CATEGORY_PHYDM_INFO 0X01 -+#define CATEGORY_FW_SNDING 0X01 -+#define CATEGORY_FW_FWCTRL 0X01 -+#define CATEGORY_H2C_LOOPBACK 0X01 -+#define CATEGORY_FWCMD_LOOPBACK 0X01 -+#define CATEGORY_SEND_SCAN_PKT 0X01 -+#define CATEGORY_BCN_OFFLOAD 0X01 -+#define CATEGORY_DROP_SCAN_PKT 0X01 -+#define CATEGORY_P2PPS 0X01 -+#define CATEGORY_BT_COEX 0X01 -+#define CATEGORY_ACT_SCHEDULE_REQ 0X01 -+#define CATEGORY_NAN_CTRL 0X01 -+#define CATEGORY_NAN_CHANNEL_PLAN_0 0X01 -+#define CATEGORY_NAN_CHANNEL_PLAN_1 0X01 -+#define CATEGORY_NAN_FUNC_CTRL 0X01 -+#define CATEGORY_DPK 0X01 -+#define SUB_CMD_ID_FW_ACCESS_TEST 0X00 -+#define SUB_CMD_ID_CH_SWITCH 0X02 -+#define SUB_CMD_ID_DUMP_PHYSICAL_EFUSE 0X03 -+#define SUB_CMD_ID_UPDATE_BEACON_PARSING_INFO 0X05 -+#define SUB_CMD_ID_CFG_PARAM 0X08 -+#define SUB_CMD_ID_UPDATE_DATAPACK 0X09 -+#define SUB_CMD_ID_RUN_DATAPACK 0X0A -+#define SUB_CMD_ID_DOWNLOAD_FLASH 0X0B -+#define SUB_CMD_ID_UPDATE_PKT 0X0C -+#define SUB_CMD_ID_GENERAL_INFO 0X0D -+#define SUB_CMD_ID_IQK 0X0E -+#define SUB_CMD_ID_PWR_TRK 0X0F -+#define SUB_CMD_ID_PSD 0X10 -+#define SUB_CMD_ID_PHYDM_INFO 0X11 -+#define SUB_CMD_ID_FW_SNDING 0X12 -+#define SUB_CMD_ID_FW_FWCTRL 0X13 -+#define SUB_CMD_ID_H2C_LOOPBACK 0X14 -+#define SUB_CMD_ID_FWCMD_LOOPBACK 0X15 -+#define SUB_CMD_ID_SEND_SCAN_PKT 0X16 -+#define SUB_CMD_ID_BCN_OFFLOAD 0X17 -+#define SUB_CMD_ID_DROP_SCAN_PKT 0X18 -+#define SUB_CMD_ID_P2PPS 0X24 -+#define SUB_CMD_ID_BT_COEX 0X60 -+#define SUB_CMD_ID_ACT_SCHEDULE_REQ 0X70 -+#define SUB_CMD_ID_NAN_CTRL 0XB2 -+#define SUB_CMD_ID_NAN_CHANNEL_PLAN_0 0XB4 -+#define SUB_CMD_ID_NAN_CHANNEL_PLAN_1 0XB5 -+#define SUB_CMD_ID_NAN_FUNC_CTRL 0XB6 -+#define SUB_CMD_ID_DPK 0XB7 -+#define H2C_CMD_HEADER_GET_CATEGORY(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 7) -+#define H2C_CMD_HEADER_SET_CATEGORY(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 7, value) -+#define H2C_CMD_HEADER_SET_CATEGORY_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 7, value) -+#define H2C_CMD_HEADER_GET_ACK(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 7, 1) -+#define H2C_CMD_HEADER_SET_ACK(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 7, 1, value) -+#define H2C_CMD_HEADER_SET_ACK_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 7, 1, value) -+#define H2C_CMD_HEADER_GET_TOTAL_LEN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 16) -+#define H2C_CMD_HEADER_SET_TOTAL_LEN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 16, value) -+#define H2C_CMD_HEADER_SET_TOTAL_LEN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 16, value) -+#define H2C_CMD_HEADER_GET_SEQ_NUM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 16, 16) -+#define H2C_CMD_HEADER_SET_SEQ_NUM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 16, 16, value) -+#define H2C_CMD_HEADER_SET_SEQ_NUM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 16, 16, value) -+#define FW_OFFLOAD_H2C_GET_CATEGORY(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 7) -+#define FW_OFFLOAD_H2C_SET_CATEGORY(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 7, value) -+#define FW_OFFLOAD_H2C_SET_CATEGORY_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 7, value) -+#define FW_OFFLOAD_H2C_GET_ACK(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 7, 1) -+#define FW_OFFLOAD_H2C_SET_ACK(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 7, 1, value) -+#define FW_OFFLOAD_H2C_SET_ACK_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 7, 1, value) -+#define FW_OFFLOAD_H2C_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define FW_OFFLOAD_H2C_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define FW_OFFLOAD_H2C_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define FW_OFFLOAD_H2C_GET_SUB_CMD_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 16) -+#define FW_OFFLOAD_H2C_SET_SUB_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 16, value) -+#define FW_OFFLOAD_H2C_SET_SUB_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 16, value) -+#define FW_OFFLOAD_H2C_GET_TOTAL_LEN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 16) -+#define FW_OFFLOAD_H2C_SET_TOTAL_LEN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 16, value) -+#define FW_OFFLOAD_H2C_SET_TOTAL_LEN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 16, value) -+#define FW_OFFLOAD_H2C_GET_SEQ_NUM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 16, 16) -+#define FW_OFFLOAD_H2C_SET_SEQ_NUM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 16, 16, value) -+#define FW_OFFLOAD_H2C_SET_SEQ_NUM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 16, 16, value) -+#define FW_ACCESS_TEST_GET_ACCESS_TXFF(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 0, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_TXFF(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_TXFF_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_RXFF(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 1, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_RXFF(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_RXFF_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_FWFF(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 2, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_FWFF(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_FWFF_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PHYFF(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 3, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PHYFF(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 3, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_PHYFF_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 3, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_RPT_BUF(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 4, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_RPT_BUF(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 4, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_RPT_BUF_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 4, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_CAM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 5, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_CAM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 5, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_CAM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 5, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_WOW_CAM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 6, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_WOW_CAM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 6, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_WOW_CAM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 6, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_RX_CAM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 7, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_RX_CAM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 7, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_RX_CAM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 7, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_BA_CAM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 8, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_BA_CAM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_BA_CAM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_MBSSID_CAM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 9, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_MBSSID_CAM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 9, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_MBSSID_CAM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 9, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE0(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 16, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE0(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE0_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE1(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 17, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 17, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 17, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE2(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 18, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 18, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 18, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE3(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 19, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE3(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 19, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE3_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 19, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE4(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 20, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE4(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 20, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE4_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 20, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE5(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 21, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE5(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 21, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE5_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 21, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE6(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 22, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE6(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 22, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE6_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 22, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE7(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 23, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE7(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 23, 1, value) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE7_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 23, 1, value) -+#define CH_SWITCH_GET_START(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 1) -+#define CH_SWITCH_SET_START(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define CH_SWITCH_SET_START_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define CH_SWITCH_GET_DEST_CH_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 1, 1) -+#define CH_SWITCH_SET_DEST_CH_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define CH_SWITCH_SET_DEST_CH_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define CH_SWITCH_GET_ABSOLUTE_TIME(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 2, 1) -+#define CH_SWITCH_SET_ABSOLUTE_TIME(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define CH_SWITCH_SET_ABSOLUTE_TIME_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define CH_SWITCH_GET_PERIODIC_OPT(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 3, 2) -+#define CH_SWITCH_SET_PERIODIC_OPT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 3, 2, value) -+#define CH_SWITCH_SET_PERIODIC_OPT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 3, 2, value) -+#define CH_SWITCH_GET_SCAN_MODE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 5, 1) -+#define CH_SWITCH_SET_SCAN_MODE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 5, 1, value) -+#define CH_SWITCH_SET_SCAN_MODE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 5, 1, value) -+#define CH_SWITCH_GET_INFO_LOC(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define CH_SWITCH_SET_INFO_LOC(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define CH_SWITCH_SET_INFO_LOC_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define CH_SWITCH_GET_CH_NUM(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define CH_SWITCH_SET_CH_NUM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define CH_SWITCH_SET_CH_NUM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define CH_SWITCH_GET_PRI_CH_IDX(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 24, 4) -+#define CH_SWITCH_SET_PRI_CH_IDX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 4, value) -+#define CH_SWITCH_SET_PRI_CH_IDX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 4, value) -+#define CH_SWITCH_GET_DEST_BW(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 28, 4) -+#define CH_SWITCH_SET_DEST_BW(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 28, 4, value) -+#define CH_SWITCH_SET_DEST_BW_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 28, 4, value) -+#define CH_SWITCH_GET_DEST_CH(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 8) -+#define CH_SWITCH_SET_DEST_CH(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define CH_SWITCH_SET_DEST_CH_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define CH_SWITCH_GET_NORMAL_PERIOD(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 8, 6) -+#define CH_SWITCH_SET_NORMAL_PERIOD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 8, 6, value) -+#define CH_SWITCH_SET_NORMAL_PERIOD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 8, 6, value) -+#define CH_SWITCH_GET_NORMAL_PERIOD_SEL(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 14, 2) -+#define CH_SWITCH_SET_NORMAL_PERIOD_SEL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 14, 2, value) -+#define CH_SWITCH_SET_NORMAL_PERIOD_SEL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 14, 2, value) -+#define CH_SWITCH_GET_SLOW_PERIOD(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 16, 6) -+#define CH_SWITCH_SET_SLOW_PERIOD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 16, 6, value) -+#define CH_SWITCH_SET_SLOW_PERIOD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 16, 6, value) -+#define CH_SWITCH_GET_SLOW_PERIOD_SEL(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 22, 2) -+#define CH_SWITCH_SET_SLOW_PERIOD_SEL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 22, 2, value) -+#define CH_SWITCH_SET_SLOW_PERIOD_SEL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 22, 2, value) -+#define CH_SWITCH_GET_NORMAL_CYCLE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 24, 8) -+#define CH_SWITCH_SET_NORMAL_CYCLE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 24, 8, value) -+#define CH_SWITCH_SET_NORMAL_CYCLE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 24, 8, value) -+#define CH_SWITCH_GET_TSF_HIGH(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X10, 0, 32) -+#define CH_SWITCH_SET_TSF_HIGH(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 0, 32, value) -+#define CH_SWITCH_SET_TSF_HIGH_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 0, 32, value) -+#define CH_SWITCH_GET_TSF_LOW(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X14, 0, 32) -+#define CH_SWITCH_SET_TSF_LOW(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 0, 32, value) -+#define CH_SWITCH_SET_TSF_LOW_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 0, 32, value) -+#define CH_SWITCH_GET_INFO_SIZE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X18, 0, 16) -+#define CH_SWITCH_SET_INFO_SIZE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 0, 16, value) -+#define CH_SWITCH_SET_INFO_SIZE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 0, 16, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_FUNC_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 0, 1) -+#define UPDATE_BEACON_PARSING_INFO_SET_FUNC_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define UPDATE_BEACON_PARSING_INFO_SET_FUNC_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_SIZE_TH(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 8, 4) -+#define UPDATE_BEACON_PARSING_INFO_SET_SIZE_TH(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 4, value) -+#define UPDATE_BEACON_PARSING_INFO_SET_SIZE_TH_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 4, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_TIMEOUT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 12, 4) -+#define UPDATE_BEACON_PARSING_INFO_SET_TIMEOUT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 12, 4, value) -+#define UPDATE_BEACON_PARSING_INFO_SET_TIMEOUT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 12, 4, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_IE_ID_BMP_0(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 32) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_0(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_0_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_IE_ID_BMP_1(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 0, 32) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_IE_ID_BMP_2(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X14, 0, 32) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_IE_ID_BMP_3(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X18, 0, 32) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_3(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_3_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_IE_ID_BMP_4(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X1C, 0, 32) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_4(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X1C, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_4_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X1C, 0, 32, value) -+#define CFG_PARAM_GET_NUM(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 16) -+#define CFG_PARAM_SET_NUM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 16, value) -+#define CFG_PARAM_SET_NUM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 16, value) -+#define CFG_PARAM_GET_INIT_CASE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 16, 1) -+#define CFG_PARAM_SET_INIT_CASE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 1, value) -+#define CFG_PARAM_SET_INIT_CASE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 1, value) -+#define CFG_PARAM_GET_LOC(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 24, 8) -+#define CFG_PARAM_SET_LOC(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define CFG_PARAM_SET_LOC_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define UPDATE_DATAPACK_GET_SIZE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 16) -+#define UPDATE_DATAPACK_SET_SIZE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 16, value) -+#define UPDATE_DATAPACK_SET_SIZE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 16, value) -+#define UPDATE_DATAPACK_GET_DATAPACK_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define UPDATE_DATAPACK_SET_DATAPACK_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define UPDATE_DATAPACK_SET_DATAPACK_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define UPDATE_DATAPACK_GET_DATAPACK_LOC(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 24, 8) -+#define UPDATE_DATAPACK_SET_DATAPACK_LOC(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define UPDATE_DATAPACK_SET_DATAPACK_LOC_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define UPDATE_DATAPACK_GET_DATAPACK_SEGMENT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 8) -+#define UPDATE_DATAPACK_SET_DATAPACK_SEGMENT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define UPDATE_DATAPACK_SET_DATAPACK_SEGMENT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define UPDATE_DATAPACK_GET_END_SEGMENT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 8, 1) -+#define UPDATE_DATAPACK_SET_END_SEGMENT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 8, 1, value) -+#define UPDATE_DATAPACK_SET_END_SEGMENT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 8, 1, value) -+#define RUN_DATAPACK_GET_DATAPACK_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 0, 8) -+#define RUN_DATAPACK_SET_DATAPACK_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define RUN_DATAPACK_SET_DATAPACK_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define DOWNLOAD_FLASH_GET_SPI_CMD(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 8) -+#define DOWNLOAD_FLASH_SET_SPI_CMD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define DOWNLOAD_FLASH_SET_SPI_CMD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define DOWNLOAD_FLASH_GET_LOCATION(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 8, 16) -+#define DOWNLOAD_FLASH_SET_LOCATION(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 16, value) -+#define DOWNLOAD_FLASH_SET_LOCATION_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 16, value) -+#define DOWNLOAD_FLASH_GET_SIZE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 32) -+#define DOWNLOAD_FLASH_SET_SIZE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 32, value) -+#define DOWNLOAD_FLASH_SET_SIZE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 32, value) -+#define DOWNLOAD_FLASH_GET_START_ADDR(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 0, 32) -+#define DOWNLOAD_FLASH_SET_START_ADDR(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 0, 32, value) -+#define DOWNLOAD_FLASH_SET_START_ADDR_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 0, 32, value) -+#define UPDATE_PKT_GET_SIZE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 16) -+#define UPDATE_PKT_SET_SIZE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 16, value) -+#define UPDATE_PKT_SET_SIZE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 16, value) -+#define UPDATE_PKT_GET_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define UPDATE_PKT_SET_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define UPDATE_PKT_SET_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define UPDATE_PKT_GET_LOC(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 24, 8) -+#define UPDATE_PKT_SET_LOC(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define UPDATE_PKT_SET_LOC_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define GENERAL_INFO_GET_FW_TX_BOUNDARY(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define GENERAL_INFO_SET_FW_TX_BOUNDARY(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define GENERAL_INFO_SET_FW_TX_BOUNDARY_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define IQK_GET_CLEAR(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 1) -+#define IQK_SET_CLEAR(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define IQK_SET_CLEAR_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define IQK_GET_SEGMENT_IQK(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 1, 1) -+#define IQK_SET_SEGMENT_IQK(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define IQK_SET_SEGMENT_IQK_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define PWR_TRK_GET_ENABLE_A(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 1) -+#define PWR_TRK_SET_ENABLE_A(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define PWR_TRK_SET_ENABLE_A_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define PWR_TRK_GET_ENABLE_B(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 1, 1) -+#define PWR_TRK_SET_ENABLE_B(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define PWR_TRK_SET_ENABLE_B_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define PWR_TRK_GET_ENABLE_C(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 2, 1) -+#define PWR_TRK_SET_ENABLE_C(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define PWR_TRK_SET_ENABLE_C_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define PWR_TRK_GET_ENABLE_D(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 3, 1) -+#define PWR_TRK_SET_ENABLE_D(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 3, 1, value) -+#define PWR_TRK_SET_ENABLE_D_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 3, 1, value) -+#define PWR_TRK_GET_TYPE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 4, 3) -+#define PWR_TRK_SET_TYPE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 4, 3, value) -+#define PWR_TRK_SET_TYPE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 4, 3, value) -+#define PWR_TRK_GET_BBSWING_INDEX(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define PWR_TRK_SET_BBSWING_INDEX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define PWR_TRK_SET_BBSWING_INDEX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define PWR_TRK_GET_TX_PWR_INDEX_A(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 8) -+#define PWR_TRK_SET_TX_PWR_INDEX_A(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define PWR_TRK_SET_TX_PWR_INDEX_A_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define PWR_TRK_GET_OFFSET_VALUE_A(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 8, 8) -+#define PWR_TRK_SET_OFFSET_VALUE_A(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 8, 8, value) -+#define PWR_TRK_SET_OFFSET_VALUE_A_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 8, 8, value) -+#define PWR_TRK_GET_TSSI_VALUE_A(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 16, 8) -+#define PWR_TRK_SET_TSSI_VALUE_A(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 16, 8, value) -+#define PWR_TRK_SET_TSSI_VALUE_A_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 16, 8, value) -+#define PWR_TRK_GET_TX_PWR_INDEX_B(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X10, 0, 8) -+#define PWR_TRK_SET_TX_PWR_INDEX_B(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 0, 8, value) -+#define PWR_TRK_SET_TX_PWR_INDEX_B_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 0, 8, value) -+#define PWR_TRK_GET_OFFSET_VALUE_B(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X10, 8, 8) -+#define PWR_TRK_SET_OFFSET_VALUE_B(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 8, 8, value) -+#define PWR_TRK_SET_OFFSET_VALUE_B_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 8, 8, value) -+#define PWR_TRK_GET_TSSI_VALUE_B(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X10, 16, 8) -+#define PWR_TRK_SET_TSSI_VALUE_B(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 16, 8, value) -+#define PWR_TRK_SET_TSSI_VALUE_B_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 16, 8, value) -+#define PWR_TRK_GET_TX_PWR_INDEX_C(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X14, 0, 8) -+#define PWR_TRK_SET_TX_PWR_INDEX_C(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 0, 8, value) -+#define PWR_TRK_SET_TX_PWR_INDEX_C_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 0, 8, value) -+#define PWR_TRK_GET_OFFSET_VALUE_C(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X14, 8, 8) -+#define PWR_TRK_SET_OFFSET_VALUE_C(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 8, 8, value) -+#define PWR_TRK_SET_OFFSET_VALUE_C_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 8, 8, value) -+#define PWR_TRK_GET_TSSI_VALUE_C(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X14, 16, 8) -+#define PWR_TRK_SET_TSSI_VALUE_C(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 16, 8, value) -+#define PWR_TRK_SET_TSSI_VALUE_C_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 16, 8, value) -+#define PWR_TRK_GET_TX_PWR_INDEX_D(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X18, 0, 8) -+#define PWR_TRK_SET_TX_PWR_INDEX_D(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 0, 8, value) -+#define PWR_TRK_SET_TX_PWR_INDEX_D_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 0, 8, value) -+#define PWR_TRK_GET_OFFSET_VALUE_D(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X18, 8, 8) -+#define PWR_TRK_SET_OFFSET_VALUE_D(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 8, 8, value) -+#define PWR_TRK_SET_OFFSET_VALUE_D_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 8, 8, value) -+#define PWR_TRK_GET_TSSI_VALUE_D(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X18, 16, 8) -+#define PWR_TRK_SET_TSSI_VALUE_D(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 16, 8, value) -+#define PWR_TRK_SET_TSSI_VALUE_D_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 16, 8, value) -+#define PSD_GET_START_PSD(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 16) -+#define PSD_SET_START_PSD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 16, value) -+#define PSD_SET_START_PSD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 16, value) -+#define PSD_GET_END_PSD(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 16, 16) -+#define PSD_SET_END_PSD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 16, value) -+#define PSD_SET_END_PSD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 16, value) -+#define PHYDM_INFO_GET_REF_TYPE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 8) -+#define PHYDM_INFO_SET_REF_TYPE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define PHYDM_INFO_SET_REF_TYPE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define PHYDM_INFO_GET_RF_TYPE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define PHYDM_INFO_SET_RF_TYPE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define PHYDM_INFO_SET_RF_TYPE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define PHYDM_INFO_GET_CUT_VER(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define PHYDM_INFO_SET_CUT_VER(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define PHYDM_INFO_SET_CUT_VER_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define PHYDM_INFO_GET_RX_ANT_STATUS(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 24, 4) -+#define PHYDM_INFO_SET_RX_ANT_STATUS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 4, value) -+#define PHYDM_INFO_SET_RX_ANT_STATUS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 4, value) -+#define PHYDM_INFO_GET_TX_ANT_STATUS(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 28, 4) -+#define PHYDM_INFO_SET_TX_ANT_STATUS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 28, 4, value) -+#define PHYDM_INFO_SET_TX_ANT_STATUS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 28, 4, value) -+#define PHYDM_INFO_GET_EXT_PA(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0XC, 0, 8) -+#define PHYDM_INFO_SET_EXT_PA(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0XC, 0, 8, value) -+#define PHYDM_INFO_SET_EXT_PA_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0XC, 0, 8, value) -+#define PHYDM_INFO_GET_PACKAGE_TYPE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0XC, 8, 8) -+#define PHYDM_INFO_SET_PACKAGE_TYPE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0XC, 8, 8, value) -+#define PHYDM_INFO_SET_PACKAGE_TYPE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0XC, 8, 8, value) -+#define PHYDM_INFO_GET_MP_MODE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0XC, 16, 1) -+#define PHYDM_INFO_SET_MP_MODE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0XC, 16, 1, value) -+#define PHYDM_INFO_SET_MP_MODE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0XC, 16, 1, value) -+#define FW_SNDING_GET_SU0(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 1) -+#define FW_SNDING_SET_SU0(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define FW_SNDING_SET_SU0_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define FW_SNDING_GET_SU1(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 1, 1) -+#define FW_SNDING_SET_SU1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define FW_SNDING_SET_SU1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define FW_SNDING_GET_MU(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 2, 1) -+#define FW_SNDING_SET_MU(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define FW_SNDING_SET_MU_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define FW_SNDING_GET_PERIOD(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define FW_SNDING_SET_PERIOD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define FW_SNDING_SET_PERIOD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define FW_SNDING_GET_NDPA0_HEAD_PG(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define FW_SNDING_SET_NDPA0_HEAD_PG(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define FW_SNDING_SET_NDPA0_HEAD_PG_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define FW_SNDING_GET_NDPA1_HEAD_PG(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 24, 8) -+#define FW_SNDING_SET_NDPA1_HEAD_PG(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define FW_SNDING_SET_NDPA1_HEAD_PG_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define FW_SNDING_GET_MU_NDPA_HEAD_PG(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0XC, 0, 8) -+#define FW_SNDING_SET_MU_NDPA_HEAD_PG(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0XC, 0, 8, value) -+#define FW_SNDING_SET_MU_NDPA_HEAD_PG_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0XC, 0, 8, value) -+#define FW_SNDING_GET_RPT0_HEAD_PG(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0XC, 8, 8) -+#define FW_SNDING_SET_RPT0_HEAD_PG(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0XC, 8, 8, value) -+#define FW_SNDING_SET_RPT0_HEAD_PG_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0XC, 8, 8, value) -+#define FW_SNDING_GET_RPT1_HEAD_PG(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0XC, 16, 8) -+#define FW_SNDING_SET_RPT1_HEAD_PG(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0XC, 16, 8, value) -+#define FW_SNDING_SET_RPT1_HEAD_PG_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0XC, 16, 8, value) -+#define FW_SNDING_GET_RPT2_HEAD_PG(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0XC, 24, 8) -+#define FW_SNDING_SET_RPT2_HEAD_PG(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0XC, 24, 8, value) -+#define FW_SNDING_SET_RPT2_HEAD_PG_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0XC, 24, 8, value) -+#define FW_FWCTRL_GET_SEQ_NUM(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 8) -+#define FW_FWCTRL_SET_SEQ_NUM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define FW_FWCTRL_SET_SEQ_NUM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define FW_FWCTRL_GET_MORE_CONTENT(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 8, 1) -+#define FW_FWCTRL_SET_MORE_CONTENT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 1, value) -+#define FW_FWCTRL_SET_MORE_CONTENT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 1, value) -+#define FW_FWCTRL_GET_CONTENT_IDX(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 9, 7) -+#define FW_FWCTRL_SET_CONTENT_IDX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 9, 7, value) -+#define FW_FWCTRL_SET_CONTENT_IDX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 9, 7, value) -+#define FW_FWCTRL_GET_CLASS_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define FW_FWCTRL_SET_CLASS_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define FW_FWCTRL_SET_CLASS_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define FW_FWCTRL_GET_LENGTH(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 24, 8) -+#define FW_FWCTRL_SET_LENGTH(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define FW_FWCTRL_SET_LENGTH_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define FW_FWCTRL_GET_CONTENT(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 32) -+#define FW_FWCTRL_SET_CONTENT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 32, value) -+#define FW_FWCTRL_SET_CONTENT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 32, value) -+#define SEND_SCAN_PKT_GET_SIZE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 16) -+#define SEND_SCAN_PKT_SET_SIZE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 16, value) -+#define SEND_SCAN_PKT_SET_SIZE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 16, value) -+#define SEND_SCAN_PKT_GET_INDEX(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define SEND_SCAN_PKT_SET_INDEX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define SEND_SCAN_PKT_SET_INDEX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define SEND_SCAN_PKT_GET_LOC(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 24, 8) -+#define SEND_SCAN_PKT_SET_LOC(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define SEND_SCAN_PKT_SET_LOC_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define BCN_OFFLOAD_GET_REQUEST_VERSION(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 0, 1) -+#define BCN_OFFLOAD_SET_REQUEST_VERSION(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define BCN_OFFLOAD_SET_REQUEST_VERSION_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define BCN_OFFLOAD_GET_ENABLE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 1, 1) -+#define BCN_OFFLOAD_SET_ENABLE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define BCN_OFFLOAD_SET_ENABLE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define BCN_OFFLOAD_GET_MORE_RULE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 2, 1) -+#define BCN_OFFLOAD_SET_MORE_RULE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define BCN_OFFLOAD_SET_MORE_RULE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define BCN_OFFLOAD_GET_C2H_PERIODIC_REPORT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 3, 1) -+#define BCN_OFFLOAD_SET_C2H_PERIODIC_REPORT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 3, 1, value) -+#define BCN_OFFLOAD_SET_C2H_PERIODIC_REPORT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 3, 1, value) -+#define BCN_OFFLOAD_GET_REPORT_PERIOD(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define BCN_OFFLOAD_SET_REPORT_PERIOD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define BCN_OFFLOAD_SET_REPORT_PERIOD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define BCN_OFFLOAD_GET_RULE_LENGTH(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define BCN_OFFLOAD_SET_RULE_LENGTH(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define BCN_OFFLOAD_SET_RULE_LENGTH_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define BCN_OFFLOAD_GET_RULE_CONTENT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 8) -+#define BCN_OFFLOAD_SET_RULE_CONTENT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define BCN_OFFLOAD_SET_RULE_CONTENT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define DROP_SCAN_PKT_GET_DROP_ALL(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 1) -+#define DROP_SCAN_PKT_SET_DROP_ALL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define DROP_SCAN_PKT_SET_DROP_ALL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define DROP_SCAN_PKT_GET_DROP_SINGLE(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 1, 1) -+#define DROP_SCAN_PKT_SET_DROP_SINGLE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define DROP_SCAN_PKT_SET_DROP_SINGLE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define DROP_SCAN_PKT_GET_DROP_IDX(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define DROP_SCAN_PKT_SET_DROP_IDX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define DROP_SCAN_PKT_SET_DROP_IDX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define P2PPS_GET_OFFLOAD_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 1) -+#define P2PPS_SET_OFFLOAD_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define P2PPS_SET_OFFLOAD_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 1, value) -+#define P2PPS_GET_ROLE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 1, 1) -+#define P2PPS_SET_ROLE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define P2PPS_SET_ROLE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 1, 1, value) -+#define P2PPS_GET_CTWINDOW_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 2, 1) -+#define P2PPS_SET_CTWINDOW_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define P2PPS_SET_CTWINDOW_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define P2PPS_GET_NOA_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 3, 1) -+#define P2PPS_SET_NOA_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 3, 1, value) -+#define P2PPS_SET_NOA_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 3, 1, value) -+#define P2PPS_GET_NOA_SEL(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 4, 1) -+#define P2PPS_SET_NOA_SEL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 4, 1, value) -+#define P2PPS_SET_NOA_SEL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 4, 1, value) -+#define P2PPS_GET_ALLSTASLEEP(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 5, 1) -+#define P2PPS_SET_ALLSTASLEEP(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 5, 1, value) -+#define P2PPS_SET_ALLSTASLEEP_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 5, 1, value) -+#define P2PPS_GET_DISCOVERY(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 6, 1) -+#define P2PPS_SET_DISCOVERY(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 6, 1, value) -+#define P2PPS_SET_DISCOVERY_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 6, 1, value) -+#define P2PPS_GET_DISABLE_CLOSERF(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 7, 1) -+#define P2PPS_SET_DISABLE_CLOSERF(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 7, 1, value) -+#define P2PPS_SET_DISABLE_CLOSERF_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 7, 1, value) -+#define P2PPS_GET_P2P_PORT_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define P2PPS_SET_P2P_PORT_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define P2PPS_SET_P2P_PORT_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define P2PPS_GET_P2P_GROUP(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define P2PPS_SET_P2P_GROUP(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define P2PPS_SET_P2P_GROUP_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define P2PPS_GET_P2P_MACID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 24, 8) -+#define P2PPS_SET_P2P_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define P2PPS_SET_P2P_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define P2PPS_GET_CTWINDOW_LENGTH(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 8) -+#define P2PPS_SET_CTWINDOW_LENGTH(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define P2PPS_SET_CTWINDOW_LENGTH_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define P2PPS_GET_NOA_DURATION_PARA(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 0, 32) -+#define P2PPS_SET_NOA_DURATION_PARA(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 0, 32, value) -+#define P2PPS_SET_NOA_DURATION_PARA_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 0, 32, value) -+#define P2PPS_GET_NOA_INTERVAL_PARA(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X14, 0, 32) -+#define P2PPS_SET_NOA_INTERVAL_PARA(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 0, 32, value) -+#define P2PPS_SET_NOA_INTERVAL_PARA_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 0, 32, value) -+#define P2PPS_GET_NOA_START_TIME_PARA(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X18, 0, 32) -+#define P2PPS_SET_NOA_START_TIME_PARA(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 0, 32, value) -+#define P2PPS_SET_NOA_START_TIME_PARA_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 0, 32, value) -+#define P2PPS_GET_NOA_COUNT_PARA(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X1C, 0, 32) -+#define P2PPS_SET_NOA_COUNT_PARA(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X1C, 0, 32, value) -+#define P2PPS_SET_NOA_COUNT_PARA_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X1C, 0, 32, value) -+#define BT_COEX_GET_DATA_START(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 8) -+#define BT_COEX_SET_DATA_START(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define BT_COEX_SET_DATA_START_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define ACT_SCHEDULE_REQ_GET_MODULE_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 0, 8) -+#define ACT_SCHEDULE_REQ_SET_MODULE_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define ACT_SCHEDULE_REQ_SET_MODULE_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define ACT_SCHEDULE_REQ_GET_PRIORITY(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define ACT_SCHEDULE_REQ_SET_PRIORITY(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define ACT_SCHEDULE_REQ_SET_PRIORITY_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define ACT_SCHEDULE_REQ_GET_RSVD1(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 16, 16) -+#define ACT_SCHEDULE_REQ_SET_RSVD1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 16, value) -+#define ACT_SCHEDULE_REQ_SET_RSVD1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 16, value) -+#define ACT_SCHEDULE_REQ_GET_START_TIME(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0XC, 0, 32) -+#define ACT_SCHEDULE_REQ_SET_START_TIME(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0XC, 0, 32, value) -+#define ACT_SCHEDULE_REQ_SET_START_TIME_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0XC, 0, 32, value) -+#define ACT_SCHEDULE_REQ_GET_DURATION(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 0, 32) -+#define ACT_SCHEDULE_REQ_SET_DURATION(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 0, 32, value) -+#define ACT_SCHEDULE_REQ_SET_DURATION_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 0, 32, value) -+#define ACT_SCHEDULE_REQ_GET_PERIOD(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X14, 0, 32) -+#define ACT_SCHEDULE_REQ_SET_PERIOD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 0, 32, value) -+#define ACT_SCHEDULE_REQ_SET_PERIOD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 0, 32, value) -+#define ACT_SCHEDULE_REQ_GET_TSF_IDX(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X18, 0, 8) -+#define ACT_SCHEDULE_REQ_SET_TSF_IDX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 0, 8, value) -+#define ACT_SCHEDULE_REQ_SET_TSF_IDX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 0, 8, value) -+#define ACT_SCHEDULE_REQ_GET_CHANNEL(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X18, 8, 8) -+#define ACT_SCHEDULE_REQ_SET_CHANNEL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 8, 8, value) -+#define ACT_SCHEDULE_REQ_SET_CHANNEL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 8, 8, value) -+#define ACT_SCHEDULE_REQ_GET_BW(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X18, 16, 8) -+#define ACT_SCHEDULE_REQ_SET_BW(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 16, 8, value) -+#define ACT_SCHEDULE_REQ_SET_BW_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 16, 8, value) -+#define ACT_SCHEDULE_REQ_GET_PRIMART_CH_IDX(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X18, 24, 9) -+#define ACT_SCHEDULE_REQ_SET_PRIMART_CH_IDX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 24, 9, value) -+#define ACT_SCHEDULE_REQ_SET_PRIMART_CH_IDX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 24, 9, value) -+#define NAN_CTRL_GET_NAN_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 2) -+#define NAN_CTRL_SET_NAN_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 2, value) -+#define NAN_CTRL_SET_NAN_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 2, value) -+#define NAN_CTRL_GET_WARMUP_TIMER_FLAG(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 2, 1) -+#define NAN_CTRL_SET_WARMUP_TIMER_FLAG(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define NAN_CTRL_SET_WARMUP_TIMER_FLAG_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 2, 1, value) -+#define NAN_CTRL_GET_SUPPORT_BAND(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 8, 2) -+#define NAN_CTRL_SET_SUPPORT_BAND(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 2, value) -+#define NAN_CTRL_SET_SUPPORT_BAND_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 2, value) -+#define NAN_CTRL_GET_DISABLE_2G_DISC_BCN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 10, 1) -+#define NAN_CTRL_SET_DISABLE_2G_DISC_BCN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 10, 1, value) -+#define NAN_CTRL_SET_DISABLE_2G_DISC_BCN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 10, 1, value) -+#define NAN_CTRL_GET_DISABLE_5G_DISC_BCN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 11, 1) -+#define NAN_CTRL_SET_DISABLE_5G_DISC_BCN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 11, 1, value) -+#define NAN_CTRL_SET_DISABLE_5G_DISC_BCN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 11, 1, value) -+#define NAN_CTRL_GET_BCN_RSVD_PAGE_OFFSET(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define NAN_CTRL_SET_BCN_RSVD_PAGE_OFFSET(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define NAN_CTRL_SET_BCN_RSVD_PAGE_OFFSET_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define NAN_CTRL_GET_CHANNEL_2G(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 24, 8) -+#define NAN_CTRL_SET_CHANNEL_2G(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define NAN_CTRL_SET_CHANNEL_2G_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define NAN_CTRL_GET_CHANNEL_5G(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 8) -+#define NAN_CTRL_SET_CHANNEL_5G(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define NAN_CTRL_SET_CHANNEL_5G_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define NAN_CTRL_GET_MASTERPREFERENCE_VALUE(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 8, 8) -+#define NAN_CTRL_SET_MASTERPREFERENCE_VALUE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 8, 8, value) -+#define NAN_CTRL_SET_MASTERPREFERENCE_VALUE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 8, 8, value) -+#define NAN_CTRL_GET_RANDOMFACTOR_VALUE(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 16, 8) -+#define NAN_CTRL_SET_RANDOMFACTOR_VALUE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 16, 8, value) -+#define NAN_CTRL_SET_RANDOMFACTOR_VALUE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 16, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_CHANNEL_NUMBER_0(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 0, 8) -+#define NAN_CHANNEL_PLAN_0_SET_CHANNEL_NUMBER_0(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define NAN_CHANNEL_PLAN_0_SET_CHANNEL_NUMBER_0_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_UNPAUSE_MACID_0(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define NAN_CHANNEL_PLAN_0_SET_UNPAUSE_MACID_0(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define NAN_CHANNEL_PLAN_0_SET_UNPAUSE_MACID_0_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_START_TIME_SLOT_0(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 16) -+#define NAN_CHANNEL_PLAN_0_SET_START_TIME_SLOT_0(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_0_SET_START_TIME_SLOT_0_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_0_GET_DURATION_0(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 16, 16) -+#define NAN_CHANNEL_PLAN_0_SET_DURATION_0(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 16, 16, value) -+#define NAN_CHANNEL_PLAN_0_SET_DURATION_0_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 16, 16, value) -+#define NAN_CHANNEL_PLAN_0_GET_CHANNEL_NUMBER_1(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 0, 8) -+#define NAN_CHANNEL_PLAN_0_SET_CHANNEL_NUMBER_1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 0, 8, value) -+#define NAN_CHANNEL_PLAN_0_SET_CHANNEL_NUMBER_1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 0, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_UNPAUSE_MACID_1(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 8, 8) -+#define NAN_CHANNEL_PLAN_0_SET_UNPAUSE_MACID_1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 8, 8, value) -+#define NAN_CHANNEL_PLAN_0_SET_UNPAUSE_MACID_1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 8, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_START_TIME_SLOT_1(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X14, 0, 16) -+#define NAN_CHANNEL_PLAN_0_SET_START_TIME_SLOT_1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 0, 16, value) -+#define NAN_CHANNEL_PLAN_0_SET_START_TIME_SLOT_1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 0, 16, value) -+#define NAN_CHANNEL_PLAN_0_GET_DURATION_1(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X14, 16, 16) -+#define NAN_CHANNEL_PLAN_0_SET_DURATION_1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 16, 16, value) -+#define NAN_CHANNEL_PLAN_0_SET_DURATION_1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 16, 16, value) -+#define NAN_CHANNEL_PLAN_0_GET_CHANNEL_NUMBER_2(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X18, 0, 8) -+#define NAN_CHANNEL_PLAN_0_SET_CHANNEL_NUMBER_2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 0, 8, value) -+#define NAN_CHANNEL_PLAN_0_SET_CHANNEL_NUMBER_2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 0, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_UNPAUSE_MACID_2(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X18, 8, 8) -+#define NAN_CHANNEL_PLAN_0_SET_UNPAUSE_MACID_2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 8, 8, value) -+#define NAN_CHANNEL_PLAN_0_SET_UNPAUSE_MACID_2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 8, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_START_TIME_SLOT_2(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X1C, 0, 16) -+#define NAN_CHANNEL_PLAN_0_SET_START_TIME_SLOT_2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X1C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_0_SET_START_TIME_SLOT_2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X1C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_0_GET_DURATION_2(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X1C, 16, 16) -+#define NAN_CHANNEL_PLAN_0_SET_DURATION_2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X1C, 16, 16, value) -+#define NAN_CHANNEL_PLAN_0_SET_DURATION_2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X1C, 16, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_CHANNEL_NUMBER_3(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 0, 8) -+#define NAN_CHANNEL_PLAN_1_SET_CHANNEL_NUMBER_3(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define NAN_CHANNEL_PLAN_1_SET_CHANNEL_NUMBER_3_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_UNPAUSE_MACID_3(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define NAN_CHANNEL_PLAN_1_SET_UNPAUSE_MACID_3(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define NAN_CHANNEL_PLAN_1_SET_UNPAUSE_MACID_3_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_START_TIME_SLOT_3(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 16) -+#define NAN_CHANNEL_PLAN_1_SET_START_TIME_SLOT_3(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_1_SET_START_TIME_SLOT_3_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_DURATION_3(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X0C, 16, 16) -+#define NAN_CHANNEL_PLAN_1_SET_DURATION_3(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 16, 16, value) -+#define NAN_CHANNEL_PLAN_1_SET_DURATION_3_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 16, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_CHANNEL_NUMBER_4(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 0, 8) -+#define NAN_CHANNEL_PLAN_1_SET_CHANNEL_NUMBER_4(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 0, 8, value) -+#define NAN_CHANNEL_PLAN_1_SET_CHANNEL_NUMBER_4_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 0, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_UNPAUSE_MACID_4(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 8, 8) -+#define NAN_CHANNEL_PLAN_1_SET_UNPAUSE_MACID_4(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 8, 8, value) -+#define NAN_CHANNEL_PLAN_1_SET_UNPAUSE_MACID_4_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 8, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_START_TIME_SLOT_4(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X14, 0, 16) -+#define NAN_CHANNEL_PLAN_1_SET_START_TIME_SLOT_4(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 0, 16, value) -+#define NAN_CHANNEL_PLAN_1_SET_START_TIME_SLOT_4_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 0, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_DURATION_4(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X14, 16, 16) -+#define NAN_CHANNEL_PLAN_1_SET_DURATION_4(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X14, 16, 16, value) -+#define NAN_CHANNEL_PLAN_1_SET_DURATION_4_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X14, 16, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_CHANNEL_NUMBER_5(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X18, 0, 8) -+#define NAN_CHANNEL_PLAN_1_SET_CHANNEL_NUMBER_5(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 0, 8, value) -+#define NAN_CHANNEL_PLAN_1_SET_CHANNEL_NUMBER_5_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 0, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_UNPAUSE_MACID_5(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X18, 8, 8) -+#define NAN_CHANNEL_PLAN_1_SET_UNPAUSE_MACID_5(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X18, 8, 8, value) -+#define NAN_CHANNEL_PLAN_1_SET_UNPAUSE_MACID_5_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X18, 8, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_START_TIME_SLOT_5(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X1C, 0, 16) -+#define NAN_CHANNEL_PLAN_1_SET_START_TIME_SLOT_5(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X1C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_1_SET_START_TIME_SLOT_5_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X1C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_DURATION_5(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X1C, 16, 16) -+#define NAN_CHANNEL_PLAN_1_SET_DURATION_5(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X1C, 16, 16, value) -+#define NAN_CHANNEL_PLAN_1_SET_DURATION_5_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X1C, 16, 16, value) -+#define NAN_FUNC_CTRL_GET_PORT_IDX(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 0, 8) -+#define NAN_FUNC_CTRL_SET_PORT_IDX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define NAN_FUNC_CTRL_SET_PORT_IDX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 0, 8, value) -+#define NAN_FUNC_CTRL_GET_MAC_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X08, 8, 8) -+#define NAN_FUNC_CTRL_SET_MAC_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define NAN_FUNC_CTRL_SET_MAC_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 8, 8, value) -+#define NAN_FUNC_CTRL_GET_MASTER_PREF(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 16, 8) -+#define NAN_FUNC_CTRL_SET_MASTER_PREF(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define NAN_FUNC_CTRL_SET_MASTER_PREF_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 16, 8, value) -+#define NAN_FUNC_CTRL_GET_RANDOM_FACTOR(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X08, 24, 8) -+#define NAN_FUNC_CTRL_SET_RANDOM_FACTOR(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define NAN_FUNC_CTRL_SET_RANDOM_FACTOR_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X08, 24, 8, value) -+#define NAN_FUNC_CTRL_GET_OP_CH_24G(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 0, 8) -+#define NAN_FUNC_CTRL_SET_OP_CH_24G(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define NAN_FUNC_CTRL_SET_OP_CH_24G_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 0, 8, value) -+#define NAN_FUNC_CTRL_GET_OP_CH_5G(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 8, 8) -+#define NAN_FUNC_CTRL_SET_OP_CH_5G(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 8, 8, value) -+#define NAN_FUNC_CTRL_SET_OP_CH_5G_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 8, 8, value) -+#define NAN_FUNC_CTRL_GET_OPTIONS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X0C, 16, 16) -+#define NAN_FUNC_CTRL_SET_OPTIONS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X0C, 16, 16, value) -+#define NAN_FUNC_CTRL_SET_OPTIONS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X0C, 16, 16, value) -+#define NAN_FUNC_CTRL_GET_SYNC_BCN_RSVD_OFFSET(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 0, 8) -+#define NAN_FUNC_CTRL_SET_SYNC_BCN_RSVD_OFFSET(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 0, 8, value) -+#define NAN_FUNC_CTRL_SET_SYNC_BCN_RSVD_OFFSET_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 0, 8, value) -+#define NAN_FUNC_CTRL_GET_DISC_BCN_RSVD_OFFSET(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 8, 8) -+#define NAN_FUNC_CTRL_SET_DISC_BCN_RSVD_OFFSET(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 8, 8, value) -+#define NAN_FUNC_CTRL_SET_DISC_BCN_RSVD_OFFSET_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 8, 8, value) -+#define NAN_FUNC_CTRL_GET_DW_SCHDL_PRIORITY(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 16, 8) -+#define NAN_FUNC_CTRL_SET_DW_SCHDL_PRIORITY(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 16, 8, value) -+#define NAN_FUNC_CTRL_SET_DW_SCHDL_PRIORITY_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 16, 8, value) -+#define NAN_FUNC_CTRL_GET_TIME_INDICATE_PERIOD(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X10, 24, 8) -+#define NAN_FUNC_CTRL_SET_TIME_INDICATE_PERIOD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X10, 24, 8, value) -+#define NAN_FUNC_CTRL_SET_TIME_INDICATE_PERIOD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X10, 24, 8, value) -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_h2c_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_h2c_nic.h -new file mode 100644 -index 000000000..4cbc19f41 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_fw_offload_h2c_nic.h -@@ -0,0 +1,855 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_FWOFFLOADH2CFORMAT_H2C_C2H_NIC_H_ -+#define _HAL_FWOFFLOADH2CFORMAT_H2C_C2H_NIC_H_ -+#define CMD_ID_FW_OFFLOAD_H2C 0XFF -+#define CMD_ID_FW_ACCESS_TEST 0XFF -+#define CMD_ID_CH_SWITCH 0XFF -+#define CMD_ID_DUMP_PHYSICAL_EFUSE 0XFF -+#define CMD_ID_UPDATE_BEACON_PARSING_INFO 0XFF -+#define CMD_ID_CFG_PARAM 0XFF -+#define CMD_ID_UPDATE_DATAPACK 0XFF -+#define CMD_ID_RUN_DATAPACK 0XFF -+#define CMD_ID_DOWNLOAD_FLASH 0XFF -+#define CMD_ID_UPDATE_PKT 0XFF -+#define CMD_ID_GENERAL_INFO 0XFF -+#define CMD_ID_IQK 0XFF -+#define CMD_ID_PWR_TRK 0XFF -+#define CMD_ID_PSD 0XFF -+#define CMD_ID_PHYDM_INFO 0XFF -+#define CMD_ID_FW_SNDING 0XFF -+#define CMD_ID_FW_FWCTRL 0XFF -+#define CMD_ID_H2C_LOOPBACK 0XFF -+#define CMD_ID_FWCMD_LOOPBACK 0XFF -+#define CMD_ID_SEND_SCAN_PKT 0XFF -+#define CMD_ID_BCN_OFFLOAD 0XFF -+#define CMD_ID_DROP_SCAN_PKT 0XFF -+#define CMD_ID_P2PPS 0XFF -+#define CMD_ID_BT_COEX 0XFF -+#define CMD_ID_ACT_SCHEDULE_REQ 0XFF -+#define CMD_ID_NAN_CTRL 0XFF -+#define CMD_ID_NAN_CHANNEL_PLAN_0 0XFF -+#define CMD_ID_NAN_CHANNEL_PLAN_1 0XFF -+#define CMD_ID_NAN_FUNC_CTRL 0XFF -+#define CMD_ID_DPK 0XFF -+#define CATEGORY_H2C_CMD_HEADER 0X00 -+#define CATEGORY_FW_OFFLOAD_H2C 0X01 -+#define CATEGORY_FW_ACCESS_TEST 0X01 -+#define CATEGORY_CH_SWITCH 0X01 -+#define CATEGORY_DUMP_PHYSICAL_EFUSE 0X01 -+#define CATEGORY_UPDATE_BEACON_PARSING_INFO 0X01 -+#define CATEGORY_CFG_PARAM 0X01 -+#define CATEGORY_UPDATE_DATAPACK 0X01 -+#define CATEGORY_RUN_DATAPACK 0X01 -+#define CATEGORY_DOWNLOAD_FLASH 0X01 -+#define CATEGORY_UPDATE_PKT 0X01 -+#define CATEGORY_GENERAL_INFO 0X01 -+#define CATEGORY_IQK 0X01 -+#define CATEGORY_PWR_TRK 0X01 -+#define CATEGORY_PSD 0X01 -+#define CATEGORY_PHYDM_INFO 0X01 -+#define CATEGORY_FW_SNDING 0X01 -+#define CATEGORY_FW_FWCTRL 0X01 -+#define CATEGORY_H2C_LOOPBACK 0X01 -+#define CATEGORY_FWCMD_LOOPBACK 0X01 -+#define CATEGORY_SEND_SCAN_PKT 0X01 -+#define CATEGORY_BCN_OFFLOAD 0X01 -+#define CATEGORY_DROP_SCAN_PKT 0X01 -+#define CATEGORY_P2PPS 0X01 -+#define CATEGORY_BT_COEX 0X01 -+#define CATEGORY_ACT_SCHEDULE_REQ 0X01 -+#define CATEGORY_NAN_CTRL 0X01 -+#define CATEGORY_NAN_CHANNEL_PLAN_0 0X01 -+#define CATEGORY_NAN_CHANNEL_PLAN_1 0X01 -+#define CATEGORY_NAN_FUNC_CTRL 0X01 -+#define CATEGORY_DPK 0X01 -+#define SUB_CMD_ID_FW_ACCESS_TEST 0X00 -+#define SUB_CMD_ID_CH_SWITCH 0X02 -+#define SUB_CMD_ID_DUMP_PHYSICAL_EFUSE 0X03 -+#define SUB_CMD_ID_UPDATE_BEACON_PARSING_INFO 0X05 -+#define SUB_CMD_ID_CFG_PARAM 0X08 -+#define SUB_CMD_ID_UPDATE_DATAPACK 0X09 -+#define SUB_CMD_ID_RUN_DATAPACK 0X0A -+#define SUB_CMD_ID_DOWNLOAD_FLASH 0X0B -+#define SUB_CMD_ID_UPDATE_PKT 0X0C -+#define SUB_CMD_ID_GENERAL_INFO 0X0D -+#define SUB_CMD_ID_IQK 0X0E -+#define SUB_CMD_ID_PWR_TRK 0X0F -+#define SUB_CMD_ID_PSD 0X10 -+#define SUB_CMD_ID_PHYDM_INFO 0X11 -+#define SUB_CMD_ID_FW_SNDING 0X12 -+#define SUB_CMD_ID_FW_FWCTRL 0X13 -+#define SUB_CMD_ID_H2C_LOOPBACK 0X14 -+#define SUB_CMD_ID_FWCMD_LOOPBACK 0X15 -+#define SUB_CMD_ID_SEND_SCAN_PKT 0X16 -+#define SUB_CMD_ID_BCN_OFFLOAD 0X17 -+#define SUB_CMD_ID_DROP_SCAN_PKT 0X18 -+#define SUB_CMD_ID_P2PPS 0X24 -+#define SUB_CMD_ID_BT_COEX 0X60 -+#define SUB_CMD_ID_ACT_SCHEDULE_REQ 0X70 -+#define SUB_CMD_ID_NAN_CTRL 0XB2 -+#define SUB_CMD_ID_NAN_CHANNEL_PLAN_0 0XB4 -+#define SUB_CMD_ID_NAN_CHANNEL_PLAN_1 0XB5 -+#define SUB_CMD_ID_NAN_FUNC_CTRL 0XB6 -+#define SUB_CMD_ID_DPK 0XB7 -+#define H2C_CMD_HEADER_GET_CATEGORY(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 7) -+#define H2C_CMD_HEADER_SET_CATEGORY(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 7, value) -+#define H2C_CMD_HEADER_GET_ACK(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 7, 1) -+#define H2C_CMD_HEADER_SET_ACK(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 7, 1, value) -+#define H2C_CMD_HEADER_GET_TOTAL_LEN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 16) -+#define H2C_CMD_HEADER_SET_TOTAL_LEN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 16, value) -+#define H2C_CMD_HEADER_GET_SEQ_NUM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 16, 16) -+#define H2C_CMD_HEADER_SET_SEQ_NUM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 16, 16, value) -+#define FW_OFFLOAD_H2C_GET_CATEGORY(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 7) -+#define FW_OFFLOAD_H2C_SET_CATEGORY(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 7, value) -+#define FW_OFFLOAD_H2C_GET_ACK(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 7, 1) -+#define FW_OFFLOAD_H2C_SET_ACK(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 7, 1, value) -+#define FW_OFFLOAD_H2C_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define FW_OFFLOAD_H2C_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define FW_OFFLOAD_H2C_GET_SUB_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 16) -+#define FW_OFFLOAD_H2C_SET_SUB_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 16, value) -+#define FW_OFFLOAD_H2C_GET_TOTAL_LEN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 16) -+#define FW_OFFLOAD_H2C_SET_TOTAL_LEN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 16, value) -+#define FW_OFFLOAD_H2C_GET_SEQ_NUM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 16, 16) -+#define FW_OFFLOAD_H2C_SET_SEQ_NUM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 16, 16, value) -+#define FW_ACCESS_TEST_GET_ACCESS_TXFF(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_TXFF(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_RXFF(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 1, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_RXFF(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 1, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_FWFF(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 2, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_FWFF(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 2, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PHYFF(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 3, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PHYFF(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 3, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_RPT_BUF(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 4, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_RPT_BUF(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 4, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_CAM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 5, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_CAM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 5, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_WOW_CAM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 6, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_WOW_CAM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 6, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_RX_CAM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 7, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_RX_CAM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 7, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_BA_CAM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_BA_CAM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_MBSSID_CAM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 9, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_MBSSID_CAM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 9, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE0(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE0(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 17, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 17, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE2(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 18, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 18, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE3(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 19, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE3(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 19, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE4(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 20, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE4(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 20, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE5(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 21, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE5(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 21, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE6(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 22, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE6(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 22, 1, value) -+#define FW_ACCESS_TEST_GET_ACCESS_PAGE7(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 23, 1) -+#define FW_ACCESS_TEST_SET_ACCESS_PAGE7(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 23, 1, value) -+#define CH_SWITCH_GET_START(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 1) -+#define CH_SWITCH_SET_START(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 1, value) -+#define CH_SWITCH_GET_DEST_CH_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 1, 1) -+#define CH_SWITCH_SET_DEST_CH_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 1, 1, value) -+#define CH_SWITCH_GET_ABSOLUTE_TIME(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 2, 1) -+#define CH_SWITCH_SET_ABSOLUTE_TIME(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 2, 1, value) -+#define CH_SWITCH_GET_PERIODIC_OPT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 3, 2) -+#define CH_SWITCH_SET_PERIODIC_OPT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 3, 2, value) -+#define CH_SWITCH_GET_SCAN_MODE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 5, 1) -+#define CH_SWITCH_SET_SCAN_MODE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 5, 1, value) -+#define CH_SWITCH_GET_INFO_LOC(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define CH_SWITCH_SET_INFO_LOC(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define CH_SWITCH_GET_CH_NUM(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define CH_SWITCH_SET_CH_NUM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define CH_SWITCH_GET_PRI_CH_IDX(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 4) -+#define CH_SWITCH_SET_PRI_CH_IDX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 4, value) -+#define CH_SWITCH_GET_DEST_BW(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 28, 4) -+#define CH_SWITCH_SET_DEST_BW(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 28, 4, value) -+#define CH_SWITCH_GET_DEST_CH(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 8) -+#define CH_SWITCH_SET_DEST_CH(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 8, value) -+#define CH_SWITCH_GET_NORMAL_PERIOD(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 8, 6) -+#define CH_SWITCH_SET_NORMAL_PERIOD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 8, 6, value) -+#define CH_SWITCH_GET_NORMAL_PERIOD_SEL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 14, 2) -+#define CH_SWITCH_SET_NORMAL_PERIOD_SEL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 14, 2, value) -+#define CH_SWITCH_GET_SLOW_PERIOD(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 16, 6) -+#define CH_SWITCH_SET_SLOW_PERIOD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 16, 6, value) -+#define CH_SWITCH_GET_SLOW_PERIOD_SEL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 22, 2) -+#define CH_SWITCH_SET_SLOW_PERIOD_SEL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 22, 2, value) -+#define CH_SWITCH_GET_NORMAL_CYCLE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 24, 8) -+#define CH_SWITCH_SET_NORMAL_CYCLE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 24, 8, value) -+#define CH_SWITCH_GET_TSF_HIGH(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 0, 32) -+#define CH_SWITCH_SET_TSF_HIGH(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 0, 32, value) -+#define CH_SWITCH_GET_TSF_LOW(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 0, 32) -+#define CH_SWITCH_SET_TSF_LOW(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 0, 32, value) -+#define CH_SWITCH_GET_INFO_SIZE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 0, 16) -+#define CH_SWITCH_SET_INFO_SIZE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 0, 16, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_FUNC_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 1) -+#define UPDATE_BEACON_PARSING_INFO_SET_FUNC_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 1, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_SIZE_TH(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 4) -+#define UPDATE_BEACON_PARSING_INFO_SET_SIZE_TH(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 4, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_TIMEOUT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 12, 4) -+#define UPDATE_BEACON_PARSING_INFO_SET_TIMEOUT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 12, 4, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_IE_ID_BMP_0(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 32) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_0(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_IE_ID_BMP_1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 0, 32) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_IE_ID_BMP_2(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 0, 32) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_IE_ID_BMP_3(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 0, 32) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_3(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 0, 32, value) -+#define UPDATE_BEACON_PARSING_INFO_GET_IE_ID_BMP_4(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X1C, 0, 32) -+#define UPDATE_BEACON_PARSING_INFO_SET_IE_ID_BMP_4(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X1C, 0, 32, value) -+#define CFG_PARAM_GET_NUM(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 16) -+#define CFG_PARAM_SET_NUM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 16, value) -+#define CFG_PARAM_GET_INIT_CASE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 1) -+#define CFG_PARAM_SET_INIT_CASE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 1, value) -+#define CFG_PARAM_GET_LOC(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 8) -+#define CFG_PARAM_SET_LOC(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 8, value) -+#define UPDATE_DATAPACK_GET_SIZE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 16) -+#define UPDATE_DATAPACK_SET_SIZE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 16, value) -+#define UPDATE_DATAPACK_GET_DATAPACK_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define UPDATE_DATAPACK_SET_DATAPACK_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define UPDATE_DATAPACK_GET_DATAPACK_LOC(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 8) -+#define UPDATE_DATAPACK_SET_DATAPACK_LOC(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 8, value) -+#define UPDATE_DATAPACK_GET_DATAPACK_SEGMENT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 8) -+#define UPDATE_DATAPACK_SET_DATAPACK_SEGMENT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 8, value) -+#define UPDATE_DATAPACK_GET_END_SEGMENT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 8, 1) -+#define UPDATE_DATAPACK_SET_END_SEGMENT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 8, 1, value) -+#define RUN_DATAPACK_GET_DATAPACK_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 8) -+#define RUN_DATAPACK_SET_DATAPACK_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 8, value) -+#define DOWNLOAD_FLASH_GET_SPI_CMD(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 8) -+#define DOWNLOAD_FLASH_SET_SPI_CMD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 8, value) -+#define DOWNLOAD_FLASH_GET_LOCATION(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 16) -+#define DOWNLOAD_FLASH_SET_LOCATION(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 16, value) -+#define DOWNLOAD_FLASH_GET_SIZE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 32) -+#define DOWNLOAD_FLASH_SET_SIZE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 32, value) -+#define DOWNLOAD_FLASH_GET_START_ADDR(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 0, 32) -+#define DOWNLOAD_FLASH_SET_START_ADDR(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 0, 32, value) -+#define UPDATE_PKT_GET_SIZE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 16) -+#define UPDATE_PKT_SET_SIZE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 16, value) -+#define UPDATE_PKT_GET_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define UPDATE_PKT_SET_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define UPDATE_PKT_GET_LOC(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 8) -+#define UPDATE_PKT_SET_LOC(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 8, value) -+#define GENERAL_INFO_GET_FW_TX_BOUNDARY(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define GENERAL_INFO_SET_FW_TX_BOUNDARY(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define IQK_GET_CLEAR(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 1) -+#define IQK_SET_CLEAR(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 1, value) -+#define IQK_GET_SEGMENT_IQK(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 1, 1) -+#define IQK_SET_SEGMENT_IQK(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 1, 1, value) -+#define PWR_TRK_GET_ENABLE_A(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 1) -+#define PWR_TRK_SET_ENABLE_A(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 1, value) -+#define PWR_TRK_GET_ENABLE_B(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 1, 1) -+#define PWR_TRK_SET_ENABLE_B(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 1, 1, value) -+#define PWR_TRK_GET_ENABLE_C(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 2, 1) -+#define PWR_TRK_SET_ENABLE_C(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 2, 1, value) -+#define PWR_TRK_GET_ENABLE_D(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 3, 1) -+#define PWR_TRK_SET_ENABLE_D(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 3, 1, value) -+#define PWR_TRK_GET_TYPE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 4, 3) -+#define PWR_TRK_SET_TYPE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 4, 3, value) -+#define PWR_TRK_GET_BBSWING_INDEX(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define PWR_TRK_SET_BBSWING_INDEX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define PWR_TRK_GET_TX_PWR_INDEX_A(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 8) -+#define PWR_TRK_SET_TX_PWR_INDEX_A(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 8, value) -+#define PWR_TRK_GET_OFFSET_VALUE_A(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 8, 8) -+#define PWR_TRK_SET_OFFSET_VALUE_A(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 8, 8, value) -+#define PWR_TRK_GET_TSSI_VALUE_A(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 16, 8) -+#define PWR_TRK_SET_TSSI_VALUE_A(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 16, 8, value) -+#define PWR_TRK_GET_TX_PWR_INDEX_B(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 0, 8) -+#define PWR_TRK_SET_TX_PWR_INDEX_B(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 0, 8, value) -+#define PWR_TRK_GET_OFFSET_VALUE_B(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 8, 8) -+#define PWR_TRK_SET_OFFSET_VALUE_B(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 8, 8, value) -+#define PWR_TRK_GET_TSSI_VALUE_B(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 16, 8) -+#define PWR_TRK_SET_TSSI_VALUE_B(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 16, 8, value) -+#define PWR_TRK_GET_TX_PWR_INDEX_C(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 0, 8) -+#define PWR_TRK_SET_TX_PWR_INDEX_C(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 0, 8, value) -+#define PWR_TRK_GET_OFFSET_VALUE_C(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 8, 8) -+#define PWR_TRK_SET_OFFSET_VALUE_C(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 8, 8, value) -+#define PWR_TRK_GET_TSSI_VALUE_C(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 16, 8) -+#define PWR_TRK_SET_TSSI_VALUE_C(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 16, 8, value) -+#define PWR_TRK_GET_TX_PWR_INDEX_D(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 0, 8) -+#define PWR_TRK_SET_TX_PWR_INDEX_D(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 0, 8, value) -+#define PWR_TRK_GET_OFFSET_VALUE_D(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 8, 8) -+#define PWR_TRK_SET_OFFSET_VALUE_D(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 8, 8, value) -+#define PWR_TRK_GET_TSSI_VALUE_D(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 16, 8) -+#define PWR_TRK_SET_TSSI_VALUE_D(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 16, 8, value) -+#define PSD_GET_START_PSD(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 16) -+#define PSD_SET_START_PSD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 16, value) -+#define PSD_GET_END_PSD(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 16) -+#define PSD_SET_END_PSD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 16, value) -+#define PHYDM_INFO_GET_REF_TYPE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 8) -+#define PHYDM_INFO_SET_REF_TYPE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 8, value) -+#define PHYDM_INFO_GET_RF_TYPE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define PHYDM_INFO_SET_RF_TYPE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define PHYDM_INFO_GET_CUT_VER(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define PHYDM_INFO_SET_CUT_VER(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define PHYDM_INFO_GET_RX_ANT_STATUS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 4) -+#define PHYDM_INFO_SET_RX_ANT_STATUS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 4, value) -+#define PHYDM_INFO_GET_TX_ANT_STATUS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 28, 4) -+#define PHYDM_INFO_SET_TX_ANT_STATUS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 28, 4, value) -+#define PHYDM_INFO_GET_EXT_PA(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0XC, 0, 8) -+#define PHYDM_INFO_SET_EXT_PA(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0XC, 0, 8, value) -+#define PHYDM_INFO_GET_PACKAGE_TYPE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0XC, 8, 8) -+#define PHYDM_INFO_SET_PACKAGE_TYPE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0XC, 8, 8, value) -+#define PHYDM_INFO_GET_MP_MODE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0XC, 16, 1) -+#define PHYDM_INFO_SET_MP_MODE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0XC, 16, 1, value) -+#define FW_SNDING_GET_SU0(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 1) -+#define FW_SNDING_SET_SU0(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 1, value) -+#define FW_SNDING_GET_SU1(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 1, 1) -+#define FW_SNDING_SET_SU1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 1, 1, value) -+#define FW_SNDING_GET_MU(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 2, 1) -+#define FW_SNDING_SET_MU(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 2, 1, value) -+#define FW_SNDING_GET_PERIOD(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define FW_SNDING_SET_PERIOD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define FW_SNDING_GET_NDPA0_HEAD_PG(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define FW_SNDING_SET_NDPA0_HEAD_PG(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define FW_SNDING_GET_NDPA1_HEAD_PG(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 8) -+#define FW_SNDING_SET_NDPA1_HEAD_PG(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 8, value) -+#define FW_SNDING_GET_MU_NDPA_HEAD_PG(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0XC, 0, 8) -+#define FW_SNDING_SET_MU_NDPA_HEAD_PG(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0XC, 0, 8, value) -+#define FW_SNDING_GET_RPT0_HEAD_PG(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0XC, 8, 8) -+#define FW_SNDING_SET_RPT0_HEAD_PG(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0XC, 8, 8, value) -+#define FW_SNDING_GET_RPT1_HEAD_PG(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0XC, 16, 8) -+#define FW_SNDING_SET_RPT1_HEAD_PG(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0XC, 16, 8, value) -+#define FW_SNDING_GET_RPT2_HEAD_PG(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0XC, 24, 8) -+#define FW_SNDING_SET_RPT2_HEAD_PG(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0XC, 24, 8, value) -+#define FW_FWCTRL_GET_SEQ_NUM(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 8) -+#define FW_FWCTRL_SET_SEQ_NUM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 8, value) -+#define FW_FWCTRL_GET_MORE_CONTENT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 1) -+#define FW_FWCTRL_SET_MORE_CONTENT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 1, value) -+#define FW_FWCTRL_GET_CONTENT_IDX(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 9, 7) -+#define FW_FWCTRL_SET_CONTENT_IDX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 9, 7, value) -+#define FW_FWCTRL_GET_CLASS_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define FW_FWCTRL_SET_CLASS_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define FW_FWCTRL_GET_LENGTH(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 8) -+#define FW_FWCTRL_SET_LENGTH(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 8, value) -+#define FW_FWCTRL_GET_CONTENT(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 32) -+#define FW_FWCTRL_SET_CONTENT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 32, value) -+#define SEND_SCAN_PKT_GET_SIZE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 16) -+#define SEND_SCAN_PKT_SET_SIZE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 16, value) -+#define SEND_SCAN_PKT_GET_INDEX(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define SEND_SCAN_PKT_SET_INDEX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define SEND_SCAN_PKT_GET_LOC(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 8) -+#define SEND_SCAN_PKT_SET_LOC(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 8, value) -+#define BCN_OFFLOAD_GET_REQUEST_VERSION(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 1) -+#define BCN_OFFLOAD_SET_REQUEST_VERSION(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 1, value) -+#define BCN_OFFLOAD_GET_ENABLE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 1, 1) -+#define BCN_OFFLOAD_SET_ENABLE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 1, 1, value) -+#define BCN_OFFLOAD_GET_MORE_RULE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 2, 1) -+#define BCN_OFFLOAD_SET_MORE_RULE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 2, 1, value) -+#define BCN_OFFLOAD_GET_C2H_PERIODIC_REPORT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 3, 1) -+#define BCN_OFFLOAD_SET_C2H_PERIODIC_REPORT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 3, 1, value) -+#define BCN_OFFLOAD_GET_REPORT_PERIOD(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define BCN_OFFLOAD_SET_REPORT_PERIOD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define BCN_OFFLOAD_GET_RULE_LENGTH(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define BCN_OFFLOAD_SET_RULE_LENGTH(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define BCN_OFFLOAD_GET_RULE_CONTENT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 8) -+#define BCN_OFFLOAD_SET_RULE_CONTENT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 8, value) -+#define DROP_SCAN_PKT_GET_DROP_ALL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 1) -+#define DROP_SCAN_PKT_SET_DROP_ALL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 1, value) -+#define DROP_SCAN_PKT_GET_DROP_SINGLE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 1, 1) -+#define DROP_SCAN_PKT_SET_DROP_SINGLE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 1, 1, value) -+#define DROP_SCAN_PKT_GET_DROP_IDX(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define DROP_SCAN_PKT_SET_DROP_IDX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define P2PPS_GET_OFFLOAD_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 1) -+#define P2PPS_SET_OFFLOAD_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 1, value) -+#define P2PPS_GET_ROLE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 1, 1) -+#define P2PPS_SET_ROLE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 1, 1, value) -+#define P2PPS_GET_CTWINDOW_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 2, 1) -+#define P2PPS_SET_CTWINDOW_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 2, 1, value) -+#define P2PPS_GET_NOA_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 3, 1) -+#define P2PPS_SET_NOA_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 3, 1, value) -+#define P2PPS_GET_NOA_SEL(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 4, 1) -+#define P2PPS_SET_NOA_SEL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 4, 1, value) -+#define P2PPS_GET_ALLSTASLEEP(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 5, 1) -+#define P2PPS_SET_ALLSTASLEEP(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 5, 1, value) -+#define P2PPS_GET_DISCOVERY(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 6, 1) -+#define P2PPS_SET_DISCOVERY(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 6, 1, value) -+#define P2PPS_GET_DISABLE_CLOSERF(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 7, 1) -+#define P2PPS_SET_DISABLE_CLOSERF(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 7, 1, value) -+#define P2PPS_GET_P2P_PORT_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define P2PPS_SET_P2P_PORT_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define P2PPS_GET_P2P_GROUP(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define P2PPS_SET_P2P_GROUP(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define P2PPS_GET_P2P_MACID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 8) -+#define P2PPS_SET_P2P_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 8, value) -+#define P2PPS_GET_CTWINDOW_LENGTH(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 8) -+#define P2PPS_SET_CTWINDOW_LENGTH(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 8, value) -+#define P2PPS_GET_NOA_DURATION_PARA(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 0, 32) -+#define P2PPS_SET_NOA_DURATION_PARA(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 0, 32, value) -+#define P2PPS_GET_NOA_INTERVAL_PARA(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 0, 32) -+#define P2PPS_SET_NOA_INTERVAL_PARA(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 0, 32, value) -+#define P2PPS_GET_NOA_START_TIME_PARA(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 0, 32) -+#define P2PPS_SET_NOA_START_TIME_PARA(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 0, 32, value) -+#define P2PPS_GET_NOA_COUNT_PARA(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X1C, 0, 32) -+#define P2PPS_SET_NOA_COUNT_PARA(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X1C, 0, 32, value) -+#define BT_COEX_GET_DATA_START(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 8) -+#define BT_COEX_SET_DATA_START(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 8, value) -+#define ACT_SCHEDULE_REQ_GET_MODULE_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 8) -+#define ACT_SCHEDULE_REQ_SET_MODULE_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 8, value) -+#define ACT_SCHEDULE_REQ_GET_PRIORITY(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define ACT_SCHEDULE_REQ_SET_PRIORITY(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define ACT_SCHEDULE_REQ_GET_RSVD1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 16) -+#define ACT_SCHEDULE_REQ_SET_RSVD1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 16, value) -+#define ACT_SCHEDULE_REQ_GET_START_TIME(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0XC, 0, 32) -+#define ACT_SCHEDULE_REQ_SET_START_TIME(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0XC, 0, 32, value) -+#define ACT_SCHEDULE_REQ_GET_DURATION(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 0, 32) -+#define ACT_SCHEDULE_REQ_SET_DURATION(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 0, 32, value) -+#define ACT_SCHEDULE_REQ_GET_PERIOD(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 0, 32) -+#define ACT_SCHEDULE_REQ_SET_PERIOD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 0, 32, value) -+#define ACT_SCHEDULE_REQ_GET_TSF_IDX(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 0, 8) -+#define ACT_SCHEDULE_REQ_SET_TSF_IDX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 0, 8, value) -+#define ACT_SCHEDULE_REQ_GET_CHANNEL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 8, 8) -+#define ACT_SCHEDULE_REQ_SET_CHANNEL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 8, 8, value) -+#define ACT_SCHEDULE_REQ_GET_BW(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 16, 8) -+#define ACT_SCHEDULE_REQ_SET_BW(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 16, 8, value) -+#define ACT_SCHEDULE_REQ_GET_PRIMART_CH_IDX(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 24, 9) -+#define ACT_SCHEDULE_REQ_SET_PRIMART_CH_IDX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 24, 9, value) -+#define NAN_CTRL_GET_NAN_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 2) -+#define NAN_CTRL_SET_NAN_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 2, value) -+#define NAN_CTRL_GET_WARMUP_TIMER_FLAG(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 2, 1) -+#define NAN_CTRL_SET_WARMUP_TIMER_FLAG(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 2, 1, value) -+#define NAN_CTRL_GET_SUPPORT_BAND(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 2) -+#define NAN_CTRL_SET_SUPPORT_BAND(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 2, value) -+#define NAN_CTRL_GET_DISABLE_2G_DISC_BCN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 10, 1) -+#define NAN_CTRL_SET_DISABLE_2G_DISC_BCN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 10, 1, value) -+#define NAN_CTRL_GET_DISABLE_5G_DISC_BCN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 11, 1) -+#define NAN_CTRL_SET_DISABLE_5G_DISC_BCN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 11, 1, value) -+#define NAN_CTRL_GET_BCN_RSVD_PAGE_OFFSET(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define NAN_CTRL_SET_BCN_RSVD_PAGE_OFFSET(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define NAN_CTRL_GET_CHANNEL_2G(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 8) -+#define NAN_CTRL_SET_CHANNEL_2G(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 8, value) -+#define NAN_CTRL_GET_CHANNEL_5G(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 8) -+#define NAN_CTRL_SET_CHANNEL_5G(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 8, value) -+#define NAN_CTRL_GET_MASTERPREFERENCE_VALUE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 8, 8) -+#define NAN_CTRL_SET_MASTERPREFERENCE_VALUE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 8, 8, value) -+#define NAN_CTRL_GET_RANDOMFACTOR_VALUE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 16, 8) -+#define NAN_CTRL_SET_RANDOMFACTOR_VALUE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 16, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_CHANNEL_NUMBER_0(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 8) -+#define NAN_CHANNEL_PLAN_0_SET_CHANNEL_NUMBER_0(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_UNPAUSE_MACID_0(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define NAN_CHANNEL_PLAN_0_SET_UNPAUSE_MACID_0(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_START_TIME_SLOT_0(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 16) -+#define NAN_CHANNEL_PLAN_0_SET_START_TIME_SLOT_0(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_0_GET_DURATION_0(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 16, 16) -+#define NAN_CHANNEL_PLAN_0_SET_DURATION_0(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 16, 16, value) -+#define NAN_CHANNEL_PLAN_0_GET_CHANNEL_NUMBER_1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 0, 8) -+#define NAN_CHANNEL_PLAN_0_SET_CHANNEL_NUMBER_1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 0, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_UNPAUSE_MACID_1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 8, 8) -+#define NAN_CHANNEL_PLAN_0_SET_UNPAUSE_MACID_1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 8, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_START_TIME_SLOT_1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 0, 16) -+#define NAN_CHANNEL_PLAN_0_SET_START_TIME_SLOT_1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 0, 16, value) -+#define NAN_CHANNEL_PLAN_0_GET_DURATION_1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 16, 16) -+#define NAN_CHANNEL_PLAN_0_SET_DURATION_1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 16, 16, value) -+#define NAN_CHANNEL_PLAN_0_GET_CHANNEL_NUMBER_2(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 0, 8) -+#define NAN_CHANNEL_PLAN_0_SET_CHANNEL_NUMBER_2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 0, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_UNPAUSE_MACID_2(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 8, 8) -+#define NAN_CHANNEL_PLAN_0_SET_UNPAUSE_MACID_2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 8, 8, value) -+#define NAN_CHANNEL_PLAN_0_GET_START_TIME_SLOT_2(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X1C, 0, 16) -+#define NAN_CHANNEL_PLAN_0_SET_START_TIME_SLOT_2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X1C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_0_GET_DURATION_2(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X1C, 16, 16) -+#define NAN_CHANNEL_PLAN_0_SET_DURATION_2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X1C, 16, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_CHANNEL_NUMBER_3(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 8) -+#define NAN_CHANNEL_PLAN_1_SET_CHANNEL_NUMBER_3(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_UNPAUSE_MACID_3(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define NAN_CHANNEL_PLAN_1_SET_UNPAUSE_MACID_3(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_START_TIME_SLOT_3(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 16) -+#define NAN_CHANNEL_PLAN_1_SET_START_TIME_SLOT_3(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_DURATION_3(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 16, 16) -+#define NAN_CHANNEL_PLAN_1_SET_DURATION_3(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 16, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_CHANNEL_NUMBER_4(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 0, 8) -+#define NAN_CHANNEL_PLAN_1_SET_CHANNEL_NUMBER_4(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 0, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_UNPAUSE_MACID_4(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 8, 8) -+#define NAN_CHANNEL_PLAN_1_SET_UNPAUSE_MACID_4(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 8, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_START_TIME_SLOT_4(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 0, 16) -+#define NAN_CHANNEL_PLAN_1_SET_START_TIME_SLOT_4(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 0, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_DURATION_4(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X14, 16, 16) -+#define NAN_CHANNEL_PLAN_1_SET_DURATION_4(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X14, 16, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_CHANNEL_NUMBER_5(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 0, 8) -+#define NAN_CHANNEL_PLAN_1_SET_CHANNEL_NUMBER_5(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 0, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_UNPAUSE_MACID_5(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X18, 8, 8) -+#define NAN_CHANNEL_PLAN_1_SET_UNPAUSE_MACID_5(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X18, 8, 8, value) -+#define NAN_CHANNEL_PLAN_1_GET_START_TIME_SLOT_5(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X1C, 0, 16) -+#define NAN_CHANNEL_PLAN_1_SET_START_TIME_SLOT_5(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X1C, 0, 16, value) -+#define NAN_CHANNEL_PLAN_1_GET_DURATION_5(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X1C, 16, 16) -+#define NAN_CHANNEL_PLAN_1_SET_DURATION_5(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X1C, 16, 16, value) -+#define NAN_FUNC_CTRL_GET_PORT_IDX(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 0, 8) -+#define NAN_FUNC_CTRL_SET_PORT_IDX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 0, 8, value) -+#define NAN_FUNC_CTRL_GET_MAC_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 8, 8) -+#define NAN_FUNC_CTRL_SET_MAC_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 8, 8, value) -+#define NAN_FUNC_CTRL_GET_MASTER_PREF(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 16, 8) -+#define NAN_FUNC_CTRL_SET_MASTER_PREF(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 16, 8, value) -+#define NAN_FUNC_CTRL_GET_RANDOM_FACTOR(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X08, 24, 8) -+#define NAN_FUNC_CTRL_SET_RANDOM_FACTOR(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X08, 24, 8, value) -+#define NAN_FUNC_CTRL_GET_OP_CH_24G(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 0, 8) -+#define NAN_FUNC_CTRL_SET_OP_CH_24G(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 0, 8, value) -+#define NAN_FUNC_CTRL_GET_OP_CH_5G(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 8, 8) -+#define NAN_FUNC_CTRL_SET_OP_CH_5G(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 8, 8, value) -+#define NAN_FUNC_CTRL_GET_OPTIONS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X0C, 16, 16) -+#define NAN_FUNC_CTRL_SET_OPTIONS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X0C, 16, 16, value) -+#define NAN_FUNC_CTRL_GET_SYNC_BCN_RSVD_OFFSET(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 0, 8) -+#define NAN_FUNC_CTRL_SET_SYNC_BCN_RSVD_OFFSET(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 0, 8, value) -+#define NAN_FUNC_CTRL_GET_DISC_BCN_RSVD_OFFSET(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 8, 8) -+#define NAN_FUNC_CTRL_SET_DISC_BCN_RSVD_OFFSET(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 8, 8, value) -+#define NAN_FUNC_CTRL_GET_DW_SCHDL_PRIORITY(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 16, 8) -+#define NAN_FUNC_CTRL_SET_DW_SCHDL_PRIORITY(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 16, 8, value) -+#define NAN_FUNC_CTRL_GET_TIME_INDICATE_PERIOD(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X10, 24, 8) -+#define NAN_FUNC_CTRL_SET_TIME_INDICATE_PERIOD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X10, 24, 8, value) -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_gpio_cmd.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_gpio_cmd.h -new file mode 100644 -index 000000000..40efa5773 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_gpio_cmd.h -@@ -0,0 +1,108 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 HALMAC_GPIO_CMD -+#define HALMAC_GPIO_CMD -+ -+#include "halmac_2_platform.h" -+ -+/* GPIO ID */ -+#define HALMAC_GPIO0 0 -+#define HALMAC_GPIO1 1 -+#define HALMAC_GPIO2 2 -+#define HALMAC_GPIO3 3 -+#define HALMAC_GPIO4 4 -+#define HALMAC_GPIO5 5 -+#define HALMAC_GPIO6 6 -+#define HALMAC_GPIO7 7 -+#define HALMAC_GPIO8 8 -+#define HALMAC_GPIO9 9 -+#define HALMAC_GPIO10 10 -+#define HALMAC_GPIO11 11 -+#define HALMAC_GPIO12 12 -+#define HALMAC_GPIO13 13 -+#define HALMAC_GPIO14 14 -+#define HALMAC_GPIO15 15 -+#define HALMAC_GPIO_NUM 16 -+ -+/* GPIO type */ -+#define HALMAC_GPIO_IN 0 -+#define HALMAC_GPIO_OUT 1 -+#define HALMAC_GPIO_IN_OUT 2 -+ -+/* Function name */ -+#define HALMAC_WL_HWPDN 0 -+#define HALMAC_BT_HWPDN 1 -+#define HALMAC_BT_GPIO 2 -+#define HALMAC_WL_HW_EXTWOL 3 -+#define HALMAC_BT_HW_EXTWOL 4 -+#define HALMAC_BT_SFLASH 5 -+#define HALMAC_WL_SFLASH 6 -+#define HALMAC_WL_LED 7 -+#define HALMAC_SDIO_INT 8 -+#define HALMAC_UART0 9 -+#define HALMAC_EEPROM 10 -+#define HALMAC_JTAG 11 -+#define HALMAC_LTE_COEX_UART 12 -+#define HALMAC_3W_LTE_WL_GPIO 13 -+#define HALMAC_GPIO2_3_WL_CTRL_EN 14 -+#define HALMAC_GPIO13_14_WL_CTRL_EN 15 -+#define HALMAC_DBG_GNT_WL_BT 16 -+#define HALMAC_BT_3DDLS_A 17 -+#define HALMAC_BT_3DDLS_B 18 -+#define HALMAC_BT_PTA 19 -+#define HALMAC_WL_PTA 20 -+#define HALMAC_WL_UART 21 -+#define HALMAC_WLMAC_DBG 22 -+#define HALMAC_WLPHY_DBG 23 -+#define HALMAC_BT_DBG 24 -+#define HALMAC_WLPHY_RFE_CTRL2GPIO 25 -+#define HALMAC_EXT_XTAL 26 -+#define HALMAC_SW_IO 27 -+#define HALMAC_BT_SDIO_INT 28 -+#define HALMAC_BT_JTAG 29 -+#define HALMAC_WL_JTAG 30 -+#define HALMAC_BT_RF 31 -+#define HALMAC_WLPHY_RFE_CTRL2GPIO_2 32 -+#define HALMAC_MAILBOX_3W 33 -+#define HALMAC_MAILBOX_1W 34 -+#define HALMAC_SW_DPDT_SEL 35 -+#define HALMAC_BT_DPDT_SEL 36 -+#define HALMAC_WL_DPDT_SEL 37 -+#define HALMAC_BT_PAPE_SEL 38 -+#define HALMAC_SW_PAPE_SEL 39 -+#define HALMAC_WL_PAPE_SEL 40 -+#define HALMAC_SW_LNAON_SET 41 -+#define HALMAC_BT_LNAON_SEL 42 -+#define HALMAC_WL_LNAON_SEL 43 -+#define HALMAC_SWR_CTRL_EN 44 -+#define HALMAC_UART_BRIDGE 45 -+#define HALMAC_BT_I2C 46 -+#define HALMAC_BTCOEX_CMD 47 -+#define HALMAC_BT_UART_INTF 48 -+#define HALMAC_DATA_CPU_JTAG 49 -+#define HALMAC_DATA_CPU_SFLASH 50 -+#define HALMAC_DATA_CPU_UART 51 -+ -+struct halmac_gpio_pimux_list { -+ u16 func; -+ u8 id; -+ u8 type; -+ u16 offset; -+ u8 msk; -+ u8 value; -+}; -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_h2c_extra_info_ap.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_h2c_extra_info_ap.h -new file mode 100644 -index 000000000..dc45b1fc7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_h2c_extra_info_ap.h -@@ -0,0 +1,236 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_H2CEXTRAINFO_H2C_C2H_AP_H_ -+#define _HAL_H2CEXTRAINFO_H2C_C2H_AP_H_ -+ -+/* H2C extra info (rsvd page) usage, unit : page (128byte)*/ -+/* dlfw : not include txdesc size*/ -+/* update pkt : not include txdesc size*/ -+/* cfg param : not include txdesc size*/ -+/* scan info : not include txdesc size*/ -+/* dl flash : not include txdesc size*/ -+#define DLFW_RSVDPG_SIZE 2048 -+#define UPDATE_PKT_RSVDPG_SIZE 2048 -+#define CFG_PARAM_RSVDPG_SIZE 2048 -+#define SCAN_INFO_RSVDPG_SIZE 256 -+#define DL_FLASH_RSVDPG_SIZE 2048 -+/* su0 snding pkt : include txdesc size */ -+#define SU0_SNDING_PKT_OFFSET 0 -+#define SU0_SNDING_PKT_RSVDPG_SIZE 128 -+ -+#define PARAM_INFO_GET_LEN(extra_info) GET_C2H_FIELD(extra_info + 0X00, 0, 8) -+#define PARAM_INFO_SET_LEN(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 0, 8, value) -+#define PARAM_INFO_SET_LEN_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 0, 8, value) -+#define PARAM_INFO_GET_IO_CMD(extra_info) GET_C2H_FIELD(extra_info + 0X00, 8, 7) -+#define PARAM_INFO_SET_IO_CMD(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 8, 7, value) -+#define PARAM_INFO_SET_IO_CMD_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 8, 7, value) -+#define PARAM_INFO_GET_MSK_EN(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 15, 1) -+#define PARAM_INFO_SET_MSK_EN(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 15, 1, value) -+#define PARAM_INFO_SET_MSK_EN_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 15, 1, value) -+#define PARAM_INFO_GET_LLT_PG_BNDY(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 16, 8) -+#define PARAM_INFO_SET_LLT_PG_BNDY(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_SET_LLT_PG_BNDY_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_GET_EFUSE_RSVDPAGE_LOC(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 16, 8) -+#define PARAM_INFO_SET_EFUSE_RSVDPAGE_LOC(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_SET_EFUSE_RSVDPAGE_LOC_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_GET_EFUSE_PATCH_EN(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 16, 8) -+#define PARAM_INFO_SET_EFUSE_PATCH_EN(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_SET_EFUSE_PATCH_EN_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_GET_RF_ADDR(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 16, 8) -+#define PARAM_INFO_SET_RF_ADDR(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_SET_RF_ADDR_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_GET_IO_ADDR(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 16, 16) -+#define PARAM_INFO_SET_IO_ADDR(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 16, 16, value) -+#define PARAM_INFO_SET_IO_ADDR_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 16, 16, value) -+#define PARAM_INFO_GET_DELAY_VAL(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 16, 16) -+#define PARAM_INFO_SET_DELAY_VAL(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 16, 16, value) -+#define PARAM_INFO_SET_DELAY_VAL_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 16, 16, value) -+#define PARAM_INFO_GET_RF_PATH(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 24, 8) -+#define PARAM_INFO_SET_RF_PATH(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 24, 8, value) -+#define PARAM_INFO_SET_RF_PATH_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 24, 8, value) -+#define PARAM_INFO_GET_DATA(extra_info) GET_C2H_FIELD(extra_info + 0X04, 0, 32) -+#define PARAM_INFO_SET_DATA(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X04, 0, 32, value) -+#define PARAM_INFO_SET_DATA_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X04, 0, 32, value) -+#define PARAM_INFO_GET_MASK(extra_info) GET_C2H_FIELD(extra_info + 0X08, 0, 32) -+#define PARAM_INFO_SET_MASK(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X08, 0, 32, value) -+#define PARAM_INFO_SET_MASK_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X08, 0, 32, value) -+#define CH_INFO_GET_CH(extra_info) GET_C2H_FIELD(extra_info + 0X00, 0, 8) -+#define CH_INFO_SET_CH(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 0, 8, value) -+#define CH_INFO_SET_CH_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 0, 8, value) -+#define CH_INFO_GET_PRI_CH_IDX(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 8, 4) -+#define CH_INFO_SET_PRI_CH_IDX(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 8, 4, value) -+#define CH_INFO_SET_PRI_CH_IDX_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 8, 4, value) -+#define CH_INFO_GET_BW(extra_info) GET_C2H_FIELD(extra_info + 0X00, 12, 4) -+#define CH_INFO_SET_BW(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 12, 4, value) -+#define CH_INFO_SET_BW_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 12, 4, value) -+#define CH_INFO_GET_TIMEOUT(extra_info) GET_C2H_FIELD(extra_info + 0X00, 16, 8) -+#define CH_INFO_SET_TIMEOUT(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 16, 8, value) -+#define CH_INFO_SET_TIMEOUT_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 16, 8, value) -+#define CH_INFO_GET_ACTION_ID(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 24, 7) -+#define CH_INFO_SET_ACTION_ID(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 24, 7, value) -+#define CH_INFO_SET_ACTION_ID_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 24, 7, value) -+#define CH_INFO_GET_EXTRA_INFO(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 31, 1) -+#define CH_INFO_SET_EXTRA_INFO(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 31, 1, value) -+#define CH_INFO_SET_EXTRA_INFO_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 31, 1, value) -+#define CH_EXTRA_INFO_GET_ID(extra_info) GET_C2H_FIELD(extra_info + 0X00, 0, 7) -+#define CH_EXTRA_INFO_SET_ID(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 0, 7, value) -+#define CH_EXTRA_INFO_SET_ID_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 0, 7, value) -+#define CH_EXTRA_INFO_GET_INFO(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 7, 1) -+#define CH_EXTRA_INFO_SET_INFO(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 7, 1, value) -+#define CH_EXTRA_INFO_SET_INFO_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 7, 1, value) -+#define CH_EXTRA_INFO_GET_SIZE(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 8, 8) -+#define CH_EXTRA_INFO_SET_SIZE(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 8, 8, value) -+#define CH_EXTRA_INFO_SET_SIZE_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 8, 8, value) -+#define CH_EXTRA_INFO_GET_DATA(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 16, 1) -+#define CH_EXTRA_INFO_SET_DATA(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 16, 1, value) -+#define CH_EXTRA_INFO_SET_DATA_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 16, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_BYTEDATA_L(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 0, 16) -+#define HIOE_INSTRUCTION_INFO_SET_BYTEDATA_L(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 0, 16, value) -+#define HIOE_INSTRUCTION_INFO_SET_BYTEDATA_L_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 0, 16, value) -+#define HIOE_INSTRUCTION_INFO_GET_BITDATA(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 0, 16) -+#define HIOE_INSTRUCTION_INFO_SET_BITDATA(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 0, 16, value) -+#define HIOE_INSTRUCTION_INFO_SET_BITDATA_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 0, 16, value) -+#define HIOE_INSTRUCTION_INFO_GET_BYTEDATA_H(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 16, 16) -+#define HIOE_INSTRUCTION_INFO_SET_BYTEDATA_H(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 16, 16, value) -+#define HIOE_INSTRUCTION_INFO_SET_BYTEDATA_H_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 16, 16, value) -+#define HIOE_INSTRUCTION_INFO_GET_BITMASK(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X00, 16, 16) -+#define HIOE_INSTRUCTION_INFO_SET_BITMASK(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X00, 16, 16, value) -+#define HIOE_INSTRUCTION_INFO_SET_BITMASK_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X00, 16, 16, value) -+#define HIOE_INSTRUCTION_INFO_GET_REG_ADDR(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X04, 0, 22) -+#define HIOE_INSTRUCTION_INFO_SET_REG_ADDR(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X04, 0, 22, value) -+#define HIOE_INSTRUCTION_INFO_SET_REG_ADDR_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X04, 0, 22, value) -+#define HIOE_INSTRUCTION_INFO_GET_DELAY_VALUE(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X04, 0, 22) -+#define HIOE_INSTRUCTION_INFO_SET_DELAY_VALUE(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X04, 0, 22, value) -+#define HIOE_INSTRUCTION_INFO_SET_DELAY_VALUE_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X04, 0, 22, value) -+#define HIOE_INSTRUCTION_INFO_GET_MODE_SELECT(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X04, 22, 1) -+#define HIOE_INSTRUCTION_INFO_SET_MODE_SELECT(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X04, 22, 1, value) -+#define HIOE_INSTRUCTION_INFO_SET_MODE_SELECT_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X04, 22, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_IO_DELAY(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X04, 23, 1) -+#define HIOE_INSTRUCTION_INFO_SET_IO_DELAY(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X04, 23, 1, value) -+#define HIOE_INSTRUCTION_INFO_SET_IO_DELAY_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X04, 23, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_BYTEMASK(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X04, 24, 4) -+#define HIOE_INSTRUCTION_INFO_SET_BYTEMASK(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X04, 24, 4, value) -+#define HIOE_INSTRUCTION_INFO_SET_BYTEMASK_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X04, 24, 4, value) -+#define HIOE_INSTRUCTION_INFO_GET_RD_EN(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X04, 28, 1) -+#define HIOE_INSTRUCTION_INFO_SET_RD_EN(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X04, 28, 1, value) -+#define HIOE_INSTRUCTION_INFO_SET_RD_EN_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X04, 28, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_WR_EN(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X04, 29, 1) -+#define HIOE_INSTRUCTION_INFO_SET_WR_EN(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X04, 29, 1, value) -+#define HIOE_INSTRUCTION_INFO_SET_WR_EN_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X04, 29, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_RAW_R(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X04, 30, 1) -+#define HIOE_INSTRUCTION_INFO_SET_RAW_R(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X04, 30, 1, value) -+#define HIOE_INSTRUCTION_INFO_SET_RAW_R_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X04, 30, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_RAW(extra_info) \ -+ GET_C2H_FIELD(extra_info + 0X04, 31, 1) -+#define HIOE_INSTRUCTION_INFO_SET_RAW(extra_info, value) \ -+ SET_C2H_FIELD_CLR(extra_info + 0X04, 31, 1, value) -+#define HIOE_INSTRUCTION_INFO_SET_RAW_NO_CLR(extra_info, value) \ -+ SET_C2H_FIELD_NO_CLR(extra_info + 0X04, 31, 1, value) -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_h2c_extra_info_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_h2c_extra_info_nic.h -new file mode 100644 -index 000000000..2f5d5152f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_h2c_extra_info_nic.h -@@ -0,0 +1,171 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_H2CEXTRAINFO_H2C_C2H_NIC_H_ -+#define _HAL_H2CEXTRAINFO_H2C_C2H_NIC_H_ -+ -+/* H2C extra info (rsvd page) usage, unit : page (128byte)*/ -+/* dlfw : not include txdesc size*/ -+/* update pkt : not include txdesc size*/ -+/* cfg param : not include txdesc size*/ -+/* scan info : not include txdesc size*/ -+/* dl flash : not include txdesc size*/ -+#define DLFW_RSVDPG_SIZE 2048 -+#define UPDATE_PKT_RSVDPG_SIZE 2048 -+#define CFG_PARAM_RSVDPG_SIZE 2048 -+#define SCAN_INFO_RSVDPG_SIZE 256 -+#define DL_FLASH_RSVDPG_SIZE 2048 -+/* su0 snding pkt : include txdesc size */ -+#define SU0_SNDING_PKT_OFFSET 0 -+#define SU0_SNDING_PKT_RSVDPG_SIZE 128 -+ -+#define PARAM_INFO_GET_LEN(extra_info) LE_BITS_TO_4BYTE(extra_info + 0X00, 0, 8) -+#define PARAM_INFO_SET_LEN(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 0, 8, value) -+#define PARAM_INFO_GET_IO_CMD(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 8, 7) -+#define PARAM_INFO_SET_IO_CMD(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 8, 7, value) -+#define PARAM_INFO_GET_MSK_EN(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 15, 1) -+#define PARAM_INFO_SET_MSK_EN(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 15, 1, value) -+#define PARAM_INFO_GET_LLT_PG_BNDY(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 16, 8) -+#define PARAM_INFO_SET_LLT_PG_BNDY(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_GET_EFUSE_RSVDPAGE_LOC(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 16, 8) -+#define PARAM_INFO_SET_EFUSE_RSVDPAGE_LOC(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_GET_EFUSE_PATCH_EN(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 16, 8) -+#define PARAM_INFO_SET_EFUSE_PATCH_EN(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_GET_RF_ADDR(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 16, 8) -+#define PARAM_INFO_SET_RF_ADDR(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 16, 8, value) -+#define PARAM_INFO_GET_IO_ADDR(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 16, 16) -+#define PARAM_INFO_SET_IO_ADDR(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 16, 16, value) -+#define PARAM_INFO_GET_DELAY_VAL(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 16, 16) -+#define PARAM_INFO_SET_DELAY_VAL(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 16, 16, value) -+#define PARAM_INFO_GET_RF_PATH(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 24, 8) -+#define PARAM_INFO_SET_RF_PATH(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 24, 8, value) -+#define PARAM_INFO_GET_DATA(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X04, 0, 32) -+#define PARAM_INFO_SET_DATA(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X04, 0, 32, value) -+#define PARAM_INFO_GET_MASK(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X08, 0, 32) -+#define PARAM_INFO_SET_MASK(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X08, 0, 32, value) -+#define CH_INFO_GET_CH(extra_info) LE_BITS_TO_4BYTE(extra_info + 0X00, 0, 8) -+#define CH_INFO_SET_CH(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 0, 8, value) -+#define CH_INFO_GET_PRI_CH_IDX(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 8, 4) -+#define CH_INFO_SET_PRI_CH_IDX(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 8, 4, value) -+#define CH_INFO_GET_BW(extra_info) LE_BITS_TO_4BYTE(extra_info + 0X00, 12, 4) -+#define CH_INFO_SET_BW(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 12, 4, value) -+#define CH_INFO_GET_TIMEOUT(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 16, 8) -+#define CH_INFO_SET_TIMEOUT(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 16, 8, value) -+#define CH_INFO_GET_ACTION_ID(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 24, 7) -+#define CH_INFO_SET_ACTION_ID(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 24, 7, value) -+#define CH_INFO_GET_EXTRA_INFO(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 31, 1) -+#define CH_INFO_SET_EXTRA_INFO(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 31, 1, value) -+#define CH_EXTRA_INFO_GET_ID(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 0, 7) -+#define CH_EXTRA_INFO_SET_ID(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 0, 7, value) -+#define CH_EXTRA_INFO_GET_INFO(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 7, 1) -+#define CH_EXTRA_INFO_SET_INFO(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 7, 1, value) -+#define CH_EXTRA_INFO_GET_SIZE(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 8, 8) -+#define CH_EXTRA_INFO_SET_SIZE(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 8, 8, value) -+#define CH_EXTRA_INFO_GET_DATA(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 16, 1) -+#define CH_EXTRA_INFO_SET_DATA(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 16, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_BYTEDATA_L(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 0, 16) -+#define HIOE_INSTRUCTION_INFO_SET_BYTEDATA_L(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 0, 16, value) -+#define HIOE_INSTRUCTION_INFO_GET_BITDATA(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 0, 16) -+#define HIOE_INSTRUCTION_INFO_SET_BITDATA(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 0, 16, value) -+#define HIOE_INSTRUCTION_INFO_GET_BYTEDATA_H(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 16, 16) -+#define HIOE_INSTRUCTION_INFO_SET_BYTEDATA_H(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 16, 16, value) -+#define HIOE_INSTRUCTION_INFO_GET_BITMASK(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X00, 16, 16) -+#define HIOE_INSTRUCTION_INFO_SET_BITMASK(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X00, 16, 16, value) -+#define HIOE_INSTRUCTION_INFO_GET_REG_ADDR(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X04, 0, 22) -+#define HIOE_INSTRUCTION_INFO_SET_REG_ADDR(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X04, 0, 22, value) -+#define HIOE_INSTRUCTION_INFO_GET_DELAY_VALUE(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X04, 0, 22) -+#define HIOE_INSTRUCTION_INFO_SET_DELAY_VALUE(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X04, 0, 22, value) -+#define HIOE_INSTRUCTION_INFO_GET_MODE_SELECT(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X04, 22, 1) -+#define HIOE_INSTRUCTION_INFO_SET_MODE_SELECT(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X04, 22, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_IO_DELAY(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X04, 23, 1) -+#define HIOE_INSTRUCTION_INFO_SET_IO_DELAY(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X04, 23, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_BYTEMASK(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X04, 24, 4) -+#define HIOE_INSTRUCTION_INFO_SET_BYTEMASK(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X04, 24, 4, value) -+#define HIOE_INSTRUCTION_INFO_GET_RD_EN(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X04, 28, 1) -+#define HIOE_INSTRUCTION_INFO_SET_RD_EN(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X04, 28, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_WR_EN(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X04, 29, 1) -+#define HIOE_INSTRUCTION_INFO_SET_WR_EN(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X04, 29, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_RAW_R(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X04, 30, 1) -+#define HIOE_INSTRUCTION_INFO_SET_RAW_R(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X04, 30, 1, value) -+#define HIOE_INSTRUCTION_INFO_GET_RAW(extra_info) \ -+ LE_BITS_TO_4BYTE(extra_info + 0X04, 31, 1) -+#define HIOE_INSTRUCTION_INFO_SET_RAW(extra_info, value) \ -+ SET_BITS_TO_LE_4BYTE(extra_info + 0X04, 31, 1, value) -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_hw_cfg.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_hw_cfg.h -new file mode 100644 -index 000000000..24e262202 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_hw_cfg.h -@@ -0,0 +1,207 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2018 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALMAC__HW_CFG_H__ -+#define __HALMAC__HW_CFG_H__ -+ -+#include /* CONFIG_[IC], CONFIG_[INTF]_HCI */ -+ -+#ifdef CONFIG_RTL8723A -+#define HALMAC_8723A_SUPPORT 1 -+#else -+#define HALMAC_8723A_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8188E -+#define HALMAC_8188E_SUPPORT 1 -+#else -+#define HALMAC_8188E_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8821A -+#define HALMAC_8821A_SUPPORT 1 -+#else -+#define HALMAC_8821A_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8723B -+#define HALMAC_8723B_SUPPORT 1 -+#else -+#define HALMAC_8723B_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8812A -+#define HALMAC_8812A_SUPPORT 1 -+#else -+#define HALMAC_8812A_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8192E -+#define HALMAC_8192E_SUPPORT 1 -+#else -+#define HALMAC_8192E_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8881A -+#define HALMAC_8881A_SUPPORT 1 -+#else -+#define HALMAC_8881A_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8821B -+#define HALMAC_8821B_SUPPORT 1 -+#else -+#define HALMAC_8821B_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8814A -+#define HALMAC_8814A_SUPPORT 1 -+#else -+#define HALMAC_8814A_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8881A -+#define HALMAC_8881A_SUPPORT 1 -+#else -+#define HALMAC_8881A_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8703B -+#define HALMAC_8703B_SUPPORT 1 -+#else -+#define HALMAC_8703B_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8723D -+#define HALMAC_8723D_SUPPORT 1 -+#else -+#define HALMAC_8723D_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8188F -+#define HALMAC_8188F_SUPPORT 1 -+#else -+#define HALMAC_8188F_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8821BMP -+#define HALMAC_8821BMP_SUPPORT 1 -+#else -+#define HALMAC_8821BMP_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8814AMP -+#define HALMAC_8814AMP_SUPPORT 1 -+#else -+#define HALMAC_8814AMP_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8195A -+#define HALMAC_8195A_SUPPORT 1 -+#else -+#define HALMAC_8195A_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8821B -+#define HALMAC_8821B_SUPPORT 1 -+#else -+#define HALMAC_8821B_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8196F -+#define HALMAC_8196F_SUPPORT 1 -+#else -+#define HALMAC_8196F_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8197F -+#define HALMAC_8197F_SUPPORT 1 -+#else -+#define HALMAC_8197F_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8198F -+#define HALMAC_8198F_SUPPORT 1 -+#else -+#define HALMAC_8198F_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8192F -+#define HALMAC_8192F_SUPPORT 1 -+#else -+#define HALMAC_8192F_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8197G -+#define HALMAC_8197G_SUPPORT 1 -+#else -+#define HALMAC_8197G_SUPPORT 0 -+#endif -+ -+ -+ -+/* Halmac support IC version */ -+ -+#ifdef CONFIG_RTL8814B -+#define HALMAC_8814B_SUPPORT 1 -+#else -+#define HALMAC_8814B_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8821C -+#define HALMAC_8821C_SUPPORT 1 -+#else -+#define HALMAC_8821C_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8822B -+#define HALMAC_8822B_SUPPORT 1 -+#else -+#define HALMAC_8822B_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8822C -+#define HALMAC_8822C_SUPPORT 1 -+#else -+#define HALMAC_8822C_SUPPORT 0 -+#endif -+ -+#ifdef CONFIG_RTL8812F -+#define HALMAC_8812F_SUPPORT 1 -+#else -+#define HALMAC_8812F_SUPPORT 0 -+#endif -+ -+ -+/* Interface support */ -+#ifdef CONFIG_SDIO_HCI -+#define HALMAC_SDIO_SUPPORT 1 -+#else -+#define HALMAC_SDIO_SUPPORT 0 -+#endif -+#ifdef CONFIG_USB_HCI -+#define HALMAC_USB_SUPPORT 1 -+#else -+#define HALMAC_USB_SUPPORT 0 -+#endif -+#ifdef CONFIG_PCI_HCI -+#define HALMAC_PCIE_SUPPORT 1 -+#else -+#define HALMAC_PCIE_SUPPORT 0 -+#endif -+ -+#endif /* __HALMAC__HW_CFG_H__ */ -+ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_intf_phy_cmd.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_intf_phy_cmd.h -new file mode 100644 -index 000000000..be8f626a8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_intf_phy_cmd.h -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 HALMAC_INTF_PHY_CMD -+#define HALMAC_INTF_PHY_CMD -+ -+/* Cut mask */ -+enum halmac_intf_phy_cut { -+ HALMAC_INTF_PHY_CUT_TESTCHIP = BIT(0), -+ HALMAC_INTF_PHY_CUT_A = BIT(1), -+ HALMAC_INTF_PHY_CUT_B = BIT(2), -+ HALMAC_INTF_PHY_CUT_C = BIT(3), -+ HALMAC_INTF_PHY_CUT_D = BIT(4), -+ HALMAC_INTF_PHY_CUT_E = BIT(5), -+ HALMAC_INTF_PHY_CUT_F = BIT(6), -+ HALMAC_INTF_PHY_CUT_G = BIT(7), -+ HALMAC_INTF_PHY_CUT_ALL = 0x7FFF, -+}; -+ -+/* IP selection */ -+enum halmac_ip_sel { -+ HALMAC_IP_INTF_PHY = 0, -+ HALMAC_IP_SEL_MAC = 1, -+ HALMAC_IP_PCIE_DBI = 2, -+ HALMAC_IP_SEL_UNDEFINE = 0x7FFF, -+}; -+ -+/* Platform mask */ -+enum halmac_intf_phy_platform { -+ HALMAC_INTF_PHY_PLATFORM_ALL = BIT(0), -+ HALMAC_INTF_PHY_PLATFORM_ASUS = BIT(1), -+ HALMAC_INTF_PHY_PLATFORM_LENOVO_V540 = BIT(2), -+ HALMAC_INTF_PHY_PLATFORM_DHC = BIT(3), -+ HALMAC_INTF_PHY_PLATFORM_FOR_ALL = 0x7FFF, -+}; -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_c2h_ap.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_c2h_ap.h -new file mode 100644 -index 000000000..f770299eb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_c2h_ap.h -@@ -0,0 +1,685 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ORIGINALC2HFORMAT_H2C_C2H_AP_H_ -+#define _HAL_ORIGINALC2HFORMAT_H2C_C2H_AP_H_ -+#define CMD_ID_C2H 0X00 -+#define CMD_ID_DBG 0X00 -+#define CMD_ID_C2H_LB 0X01 -+#define CMD_ID_C2H_SND_TXBF 0X02 -+#define CMD_ID_C2H_CCX_RPT 0X03 -+#define CMD_ID_C2H_AP_REQ_TXRPT 0X04 -+#define CMD_ID_C2H_INITIAL_RATE_COLLECTION 0X05 -+#define CMD_ID_C2H_RA_RPT 0X0C -+#define CMD_ID_C2H_SPECIAL_STATISTICS 0X0D -+#define CMD_ID_C2H_RA_PARA_RPT 0X0E -+#define CMD_ID_C2H_CUR_CHANNEL 0X10 -+#define CMD_ID_C2H_GPIO_WAKEUP 0X14 -+#define CMD_ID_C2H_DROPID_RPT 0X2D -+#define CMD_ID_C2H_LPS_STATUS_RPT 0X32 -+#define C2H_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define DBG_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define DBG_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define DBG_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define DBG_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define DBG_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define DBG_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define DBG_GET_DBG_STR1(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 16, 8) -+#define DBG_SET_DBG_STR1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define DBG_SET_DBG_STR1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define DBG_GET_DBG_STR2(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 24, 8) -+#define DBG_SET_DBG_STR2(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define DBG_SET_DBG_STR2_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define DBG_GET_DBG_STR3(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define DBG_SET_DBG_STR3(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define DBG_SET_DBG_STR3_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define DBG_GET_DBG_STR4(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define DBG_SET_DBG_STR4(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define DBG_SET_DBG_STR4_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define DBG_GET_DBG_STR5(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 16, 8) -+#define DBG_SET_DBG_STR5(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define DBG_SET_DBG_STR5_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define DBG_GET_DBG_STR6(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 24, 8) -+#define DBG_SET_DBG_STR6(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define DBG_SET_DBG_STR6_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define DBG_GET_DBG_STR7(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 0, 8) -+#define DBG_SET_DBG_STR7(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define DBG_SET_DBG_STR7_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define DBG_GET_DBG_STR8(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 8, 8) -+#define DBG_SET_DBG_STR8(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define DBG_SET_DBG_STR8_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define DBG_GET_DBG_STR9(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 16, 8) -+#define DBG_SET_DBG_STR9(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define DBG_SET_DBG_STR9_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define DBG_GET_DBG_STR10(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 24, 8) -+#define DBG_SET_DBG_STR10(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 24, 8, value) -+#define DBG_SET_DBG_STR10_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 24, 8, value) -+#define DBG_GET_DBG_STR11(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 0, 8) -+#define DBG_SET_DBG_STR11(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 0, 8, value) -+#define DBG_SET_DBG_STR11_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 0, 8, value) -+#define DBG_GET_DBG_STR12(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 8, 8) -+#define DBG_SET_DBG_STR12(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 8, 8, value) -+#define DBG_SET_DBG_STR12_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 8, 8, value) -+#define DBG_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define DBG_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define DBG_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define DBG_GET_TRIGGER(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define DBG_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define DBG_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_LB_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_LB_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_LB_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_LB_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_LB_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_LB_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_LB_GET_PAYLOAD1(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 16, 16) -+#define C2H_LB_SET_PAYLOAD1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 16, value) -+#define C2H_LB_SET_PAYLOAD1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 16, value) -+#define C2H_LB_GET_PAYLOAD2(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 32) -+#define C2H_LB_SET_PAYLOAD2(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 32, value) -+#define C2H_LB_SET_PAYLOAD2_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 32, value) -+#define C2H_LB_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_LB_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_LB_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_LB_GET_TRIGGER(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_LB_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_LB_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_SND_TXBF_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_SND_TXBF_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_SND_TXBF_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_SND_TXBF_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_SND_TXBF_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_SND_TXBF_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_SND_TXBF_GET_SND_RESULT(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 16, 1) -+#define C2H_SND_TXBF_SET_SND_RESULT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 1, value) -+#define C2H_SND_TXBF_SET_SND_RESULT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 1, value) -+#define C2H_SND_TXBF_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_SND_TXBF_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_SND_TXBF_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_SND_TXBF_GET_TRIGGER(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_SND_TXBF_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_SND_TXBF_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_CCX_RPT_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_CCX_RPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_CCX_RPT_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_CCX_RPT_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_CCX_RPT_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_CCX_RPT_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_CCX_RPT_GET_QSEL(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 16, 5) -+#define C2H_CCX_RPT_SET_QSEL(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 5, value) -+#define C2H_CCX_RPT_SET_QSEL_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 5, value) -+#define C2H_CCX_RPT_GET_BMC(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 21, 1) -+#define C2H_CCX_RPT_SET_BMC(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 21, 1, value) -+#define C2H_CCX_RPT_SET_BMC_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 21, 1, value) -+#define C2H_CCX_RPT_GET_LIFE_TIME_OVER(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 22, 1) -+#define C2H_CCX_RPT_SET_LIFE_TIME_OVER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 22, 1, value) -+#define C2H_CCX_RPT_SET_LIFE_TIME_OVER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 22, 1, value) -+#define C2H_CCX_RPT_GET_RETRY_OVER(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 23, 1) -+#define C2H_CCX_RPT_SET_RETRY_OVER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 23, 1, value) -+#define C2H_CCX_RPT_SET_RETRY_OVER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 23, 1, value) -+#define C2H_CCX_RPT_GET_MACID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 24, 8) -+#define C2H_CCX_RPT_SET_MACID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_CCX_RPT_SET_MACID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_CCX_RPT_GET_DATA_RETRY_CNT(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 0, 6) -+#define C2H_CCX_RPT_SET_DATA_RETRY_CNT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 6, value) -+#define C2H_CCX_RPT_SET_DATA_RETRY_CNT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 6, value) -+#define C2H_CCX_RPT_GET_QUEUE7_0(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define C2H_CCX_RPT_SET_QUEUE7_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_CCX_RPT_SET_QUEUE7_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_CCX_RPT_GET_QUEUE15_8(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 16, 8) -+#define C2H_CCX_RPT_SET_QUEUE15_8(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_CCX_RPT_SET_QUEUE15_8_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_CCX_RPT_GET_FINAL_DATA_RATE(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 24, 8) -+#define C2H_CCX_RPT_SET_FINAL_DATA_RATE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_CCX_RPT_SET_FINAL_DATA_RATE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_CCX_RPT_GET_SW_DEFINE_0(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 0, 8) -+#define C2H_CCX_RPT_SET_SW_DEFINE_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_CCX_RPT_SET_SW_DEFINE_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_CCX_RPT_GET_SW_DEFINE_1(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X08, 8, 4) -+#define C2H_CCX_RPT_SET_SW_DEFINE_1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 8, 4, value) -+#define C2H_CCX_RPT_SET_SW_DEFINE_1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 8, 4, value) -+#define C2H_CCX_RPT_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_CCX_RPT_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_CCX_RPT_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_CCX_RPT_GET_TRIGGER(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_CCX_RPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_CCX_RPT_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_AP_REQ_TXRPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_AP_REQ_TXRPT_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_STA1_MACID(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 16, 8) -+#define C2H_AP_REQ_TXRPT_SET_STA1_MACID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_STA1_MACID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_OK1_0(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 24, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK1_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK1_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_OK1_1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK1_1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK1_1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_FAIL1_0(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL1_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL1_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_FAIL1_1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 16, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL1_1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL1_1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_INITIAL_RATE1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 24, 8) -+#define C2H_AP_REQ_TXRPT_SET_INITIAL_RATE1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_INITIAL_RATE1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_STA2_MACID(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X08, 0, 8) -+#define C2H_AP_REQ_TXRPT_SET_STA2_MACID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_STA2_MACID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_OK2_0(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X08, 8, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK2_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK2_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_OK2_1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X08, 16, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK2_1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK2_1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_FAIL2_0(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X08, 24, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL2_0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL2_0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_FAIL2_1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 0, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL2_1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL2_1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_INITIAL_RATE2(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 8, 8) -+#define C2H_AP_REQ_TXRPT_SET_INITIAL_RATE2(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_INITIAL_RATE2_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_AP_REQ_TXRPT_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TRIGGER(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_AP_REQ_TXRPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_CMD_ID(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_SEQ(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_TRYING_BITMAP(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 16, 7) -+#define C2H_INITIAL_RATE_COLLECTION_SET_TRYING_BITMAP(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 7, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_TRYING_BITMAP_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 7, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 24, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE2(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE2(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE2_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE3(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE3(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE3_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE4(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 16, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE4(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE4_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE5(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 24, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE5(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE5_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE6(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X08, 0, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE6(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE6_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE7(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X08, 8, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE7(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE7_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_LEN(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_TRIGGER(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_RA_RPT_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_RA_RPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_RA_RPT_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_RA_RPT_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_RA_RPT_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_RA_RPT_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_RA_RPT_GET_RATE(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 16, 8) -+#define C2H_RA_RPT_SET_RATE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_RA_RPT_SET_RATE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_RA_RPT_GET_MACID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 24, 8) -+#define C2H_RA_RPT_SET_MACID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_RA_RPT_SET_MACID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_RA_RPT_GET_USE_LDPC(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 1) -+#define C2H_RA_RPT_SET_USE_LDPC(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 1, value) -+#define C2H_RA_RPT_SET_USE_LDPC_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 1, value) -+#define C2H_RA_RPT_GET_USE_TXBF(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 1, 1) -+#define C2H_RA_RPT_SET_USE_TXBF(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 1, 1, value) -+#define C2H_RA_RPT_SET_USE_TXBF_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 1, 1, value) -+#define C2H_RA_RPT_GET_COLLISION_STATE(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define C2H_RA_RPT_SET_COLLISION_STATE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_RA_RPT_SET_COLLISION_STATE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_RA_RPT_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_RA_RPT_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_RA_RPT_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_RA_RPT_GET_TRIGGER(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_RA_RPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_RA_RPT_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_CMD_ID(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_SPECIAL_STATISTICS_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_SEQ(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_SPECIAL_STATISTICS_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_STATISTICS_IDX(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 16, 8) -+#define C2H_SPECIAL_STATISTICS_SET_STATISTICS_IDX(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_STATISTICS_IDX_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA0(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 24, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA0(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_DATA0_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA1(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA1(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_DATA1_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA2(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 8, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA2(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_DATA2_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA3(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 16, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA3(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_DATA3_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA4(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X04, 24, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA4(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_DATA4_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA5(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X08, 0, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA5(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_DATA5_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA6(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X08, 8, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA6(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_DATA6_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 8, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA7(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X08, 16, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA7(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_DATA7_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X08, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_LEN(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_SPECIAL_STATISTICS_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_TRIGGER(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_SPECIAL_STATISTICS_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_SPECIAL_STATISTICS_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_RA_PARA_RPT_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_RA_PARA_RPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_RA_PARA_RPT_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_RA_PARA_RPT_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_RA_PARA_RPT_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_RA_PARA_RPT_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_RA_PARA_RPT_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_RA_PARA_RPT_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_RA_PARA_RPT_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_RA_PARA_RPT_GET_TRIGGER(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_RA_PARA_RPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_RA_PARA_RPT_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_CUR_CHANNEL_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_CUR_CHANNEL_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_CUR_CHANNEL_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_CUR_CHANNEL_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_CUR_CHANNEL_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_CUR_CHANNEL_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_CUR_CHANNEL_GET_CHANNEL_NUM(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 16, 8) -+#define C2H_CUR_CHANNEL_SET_CHANNEL_NUM(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_CUR_CHANNEL_SET_CHANNEL_NUM_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_CUR_CHANNEL_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_CUR_CHANNEL_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_CUR_CHANNEL_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_CUR_CHANNEL_GET_TRIGGER(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_CUR_CHANNEL_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_CUR_CHANNEL_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_GPIO_WAKEUP_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_GPIO_WAKEUP_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_GPIO_WAKEUP_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_GPIO_WAKEUP_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_GPIO_WAKEUP_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_GPIO_WAKEUP_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_GPIO_WAKEUP_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_GPIO_WAKEUP_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_GPIO_WAKEUP_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_GPIO_WAKEUP_GET_TRIGGER(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_GPIO_WAKEUP_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_GPIO_WAKEUP_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_DROPID_RPT_GET_CMD_ID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_DROPID_RPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_DROPID_RPT_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_DROPID_RPT_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_DROPID_RPT_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_DROPID_RPT_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_DROPID_RPT_GET_DROPIDBIT(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 16, 4) -+#define C2H_DROPID_RPT_SET_DROPIDBIT(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 4, value) -+#define C2H_DROPID_RPT_SET_DROPIDBIT_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 4, value) -+#define C2H_DROPID_RPT_GET_CURDROPID(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 20, 2) -+#define C2H_DROPID_RPT_SET_CURDROPID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 20, 2, value) -+#define C2H_DROPID_RPT_SET_CURDROPID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 20, 2, value) -+#define C2H_DROPID_RPT_GET_MACID(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X04, 0, 8) -+#define C2H_DROPID_RPT_SET_MACID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_DROPID_RPT_SET_MACID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_DROPID_RPT_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_DROPID_RPT_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_DROPID_RPT_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_DROPID_RPT_GET_TRIGGER(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_DROPID_RPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_DROPID_RPT_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_CMD_ID(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 0, 8) -+#define C2H_LPS_STATUS_RPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_LPS_STATUS_RPT_SET_CMD_ID_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_SEQ(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X00, 8, 8) -+#define C2H_LPS_STATUS_RPT_SET_SEQ(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_LPS_STATUS_RPT_SET_SEQ_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_ACTION(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 16, 8) -+#define C2H_LPS_STATUS_RPT_SET_ACTION(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_LPS_STATUS_RPT_SET_ACTION_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_STATUSCODE(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X00, 24, 8) -+#define C2H_LPS_STATUS_RPT_SET_STATUSCODE(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_LPS_STATUS_RPT_SET_STATUSCODE_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_LEN(c2h_pkt) GET_C2H_FIELD(c2h_pkt + 0X0C, 16, 8) -+#define C2H_LPS_STATUS_RPT_SET_LEN(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_LPS_STATUS_RPT_SET_LEN_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_TRIGGER(c2h_pkt) \ -+ GET_C2H_FIELD(c2h_pkt + 0X0C, 24, 8) -+#define C2H_LPS_STATUS_RPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_C2H_FIELD_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_LPS_STATUS_RPT_SET_TRIGGER_NO_CLR(c2h_pkt, value) \ -+ SET_C2H_FIELD_NO_CLR(c2h_pkt + 0X0C, 24, 8, value) -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_c2h_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_c2h_nic.h -new file mode 100644 -index 000000000..85c6da421 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_c2h_nic.h -@@ -0,0 +1,459 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ORIGINALC2HFORMAT_H2C_C2H_NIC_H_ -+#define _HAL_ORIGINALC2HFORMAT_H2C_C2H_NIC_H_ -+#define CMD_ID_C2H 0X00 -+#define CMD_ID_DBG 0X00 -+#define CMD_ID_C2H_LB 0X01 -+#define CMD_ID_C2H_SND_TXBF 0X02 -+#define CMD_ID_C2H_CCX_RPT 0X03 -+#define CMD_ID_C2H_AP_REQ_TXRPT 0X04 -+#define CMD_ID_C2H_INITIAL_RATE_COLLECTION 0X05 -+#define CMD_ID_C2H_RA_RPT 0X0C -+#define CMD_ID_C2H_SPECIAL_STATISTICS 0X0D -+#define CMD_ID_C2H_RA_PARA_RPT 0X0E -+#define CMD_ID_C2H_CUR_CHANNEL 0X10 -+#define CMD_ID_C2H_GPIO_WAKEUP 0X14 -+#define CMD_ID_C2H_DROPID_RPT 0X2D -+#define CMD_ID_C2H_LPS_STATUS_RPT 0X32 -+#define C2H_GET_CMD_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define DBG_GET_CMD_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define DBG_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define DBG_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define DBG_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define DBG_GET_DBG_STR1(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 8) -+#define DBG_SET_DBG_STR1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 8, value) -+#define DBG_GET_DBG_STR2(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 24, 8) -+#define DBG_SET_DBG_STR2(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 24, 8, value) -+#define DBG_GET_DBG_STR3(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define DBG_SET_DBG_STR3(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define DBG_GET_DBG_STR4(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define DBG_SET_DBG_STR4(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define DBG_GET_DBG_STR5(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 8) -+#define DBG_SET_DBG_STR5(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 8, value) -+#define DBG_GET_DBG_STR6(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 24, 8) -+#define DBG_SET_DBG_STR6(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 24, 8, value) -+#define DBG_GET_DBG_STR7(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 0, 8) -+#define DBG_SET_DBG_STR7(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 0, 8, value) -+#define DBG_GET_DBG_STR8(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 8, 8) -+#define DBG_SET_DBG_STR8(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 8, 8, value) -+#define DBG_GET_DBG_STR9(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 16, 8) -+#define DBG_SET_DBG_STR9(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 16, 8, value) -+#define DBG_GET_DBG_STR10(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 24, 8) -+#define DBG_SET_DBG_STR10(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 24, 8, value) -+#define DBG_GET_DBG_STR11(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 0, 8) -+#define DBG_SET_DBG_STR11(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 0, 8, value) -+#define DBG_GET_DBG_STR12(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 8, 8) -+#define DBG_SET_DBG_STR12(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 8, 8, value) -+#define DBG_GET_LEN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define DBG_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define DBG_GET_TRIGGER(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define DBG_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_LB_GET_CMD_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_LB_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_LB_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_LB_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_LB_GET_PAYLOAD1(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 16) -+#define C2H_LB_SET_PAYLOAD1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 16, value) -+#define C2H_LB_GET_PAYLOAD2(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 32) -+#define C2H_LB_SET_PAYLOAD2(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 32, value) -+#define C2H_LB_GET_LEN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_LB_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_LB_GET_TRIGGER(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_LB_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_SND_TXBF_GET_CMD_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_SND_TXBF_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_SND_TXBF_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_SND_TXBF_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_SND_TXBF_GET_SND_RESULT(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 1) -+#define C2H_SND_TXBF_SET_SND_RESULT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 1, value) -+#define C2H_SND_TXBF_GET_LEN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_SND_TXBF_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_SND_TXBF_GET_TRIGGER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_SND_TXBF_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_CCX_RPT_GET_CMD_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_CCX_RPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_CCX_RPT_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_CCX_RPT_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_CCX_RPT_GET_QSEL(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 5) -+#define C2H_CCX_RPT_SET_QSEL(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 5, value) -+#define C2H_CCX_RPT_GET_BMC(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 21, 1) -+#define C2H_CCX_RPT_SET_BMC(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 21, 1, value) -+#define C2H_CCX_RPT_GET_LIFE_TIME_OVER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 22, 1) -+#define C2H_CCX_RPT_SET_LIFE_TIME_OVER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 22, 1, value) -+#define C2H_CCX_RPT_GET_RETRY_OVER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 23, 1) -+#define C2H_CCX_RPT_SET_RETRY_OVER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 23, 1, value) -+#define C2H_CCX_RPT_GET_MACID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 24, 8) -+#define C2H_CCX_RPT_SET_MACID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_CCX_RPT_GET_DATA_RETRY_CNT(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 6) -+#define C2H_CCX_RPT_SET_DATA_RETRY_CNT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 6, value) -+#define C2H_CCX_RPT_GET_QUEUE7_0(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define C2H_CCX_RPT_SET_QUEUE7_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_CCX_RPT_GET_QUEUE15_8(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 8) -+#define C2H_CCX_RPT_SET_QUEUE15_8(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_CCX_RPT_GET_FINAL_DATA_RATE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 24, 8) -+#define C2H_CCX_RPT_SET_FINAL_DATA_RATE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_CCX_RPT_GET_SW_DEFINE_0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 0, 8) -+#define C2H_CCX_RPT_SET_SW_DEFINE_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_CCX_RPT_GET_SW_DEFINE_1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 8, 4) -+#define C2H_CCX_RPT_SET_SW_DEFINE_1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 8, 4, value) -+#define C2H_CCX_RPT_GET_LEN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_CCX_RPT_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_CCX_RPT_GET_TRIGGER(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_CCX_RPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_AP_REQ_TXRPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_AP_REQ_TXRPT_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_STA1_MACID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 8) -+#define C2H_AP_REQ_TXRPT_SET_STA1_MACID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_OK1_0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 24, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK1_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_OK1_1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK1_1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_FAIL1_0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL1_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_FAIL1_1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL1_1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_INITIAL_RATE1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 24, 8) -+#define C2H_AP_REQ_TXRPT_SET_INITIAL_RATE1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_STA2_MACID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 0, 8) -+#define C2H_AP_REQ_TXRPT_SET_STA2_MACID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_OK2_0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 8, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK2_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_OK2_1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 16, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_OK2_1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_FAIL2_0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 24, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL2_0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 24, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TX_FAIL2_1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 0, 8) -+#define C2H_AP_REQ_TXRPT_SET_TX_FAIL2_1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 0, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_INITIAL_RATE2(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 8, 8) -+#define C2H_AP_REQ_TXRPT_SET_INITIAL_RATE2(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 8, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_LEN(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_AP_REQ_TXRPT_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_AP_REQ_TXRPT_GET_TRIGGER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_AP_REQ_TXRPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_SEQ(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_TRYING_BITMAP(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 7) -+#define C2H_INITIAL_RATE_COLLECTION_SET_TRYING_BITMAP(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 7, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 24, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE2(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE2(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE3(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE3(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE4(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE4(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE5(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 24, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE5(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE6(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 0, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE6(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_INITIAL_RATE7(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 8, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_INITIAL_RATE7(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 8, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_LEN(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_INITIAL_RATE_COLLECTION_GET_TRIGGER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_INITIAL_RATE_COLLECTION_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_RA_RPT_GET_CMD_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_RA_RPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_RA_RPT_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_RA_RPT_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_RA_RPT_GET_RATE(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 8) -+#define C2H_RA_RPT_SET_RATE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_RA_RPT_GET_MACID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 24, 8) -+#define C2H_RA_RPT_SET_MACID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_RA_RPT_GET_USE_LDPC(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 1) -+#define C2H_RA_RPT_SET_USE_LDPC(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 1, value) -+#define C2H_RA_RPT_GET_USE_TXBF(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 1, 1) -+#define C2H_RA_RPT_SET_USE_TXBF(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 1, 1, value) -+#define C2H_RA_RPT_GET_COLLISION_STATE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define C2H_RA_RPT_SET_COLLISION_STATE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_RA_RPT_GET_LEN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_RA_RPT_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_RA_RPT_GET_TRIGGER(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_RA_RPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_SPECIAL_STATISTICS_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_SEQ(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_SPECIAL_STATISTICS_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_STATISTICS_IDX(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 8) -+#define C2H_SPECIAL_STATISTICS_SET_STATISTICS_IDX(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA0(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 24, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA0(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA1(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA1(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA2(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 8, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA2(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 8, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA3(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 16, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA3(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA4(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 24, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA4(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 24, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA5(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 0, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA5(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 0, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA6(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 8, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA6(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 8, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_DATA7(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X08, 16, 8) -+#define C2H_SPECIAL_STATISTICS_SET_DATA7(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X08, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_LEN(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_SPECIAL_STATISTICS_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_SPECIAL_STATISTICS_GET_TRIGGER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_SPECIAL_STATISTICS_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_RA_PARA_RPT_GET_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_RA_PARA_RPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_RA_PARA_RPT_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_RA_PARA_RPT_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_RA_PARA_RPT_GET_LEN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_RA_PARA_RPT_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_RA_PARA_RPT_GET_TRIGGER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_RA_PARA_RPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_CUR_CHANNEL_GET_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_CUR_CHANNEL_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_CUR_CHANNEL_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_CUR_CHANNEL_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_CUR_CHANNEL_GET_CHANNEL_NUM(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 8) -+#define C2H_CUR_CHANNEL_SET_CHANNEL_NUM(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_CUR_CHANNEL_GET_LEN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_CUR_CHANNEL_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_CUR_CHANNEL_GET_TRIGGER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_CUR_CHANNEL_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_GPIO_WAKEUP_GET_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_GPIO_WAKEUP_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_GPIO_WAKEUP_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_GPIO_WAKEUP_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_GPIO_WAKEUP_GET_LEN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_GPIO_WAKEUP_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_GPIO_WAKEUP_GET_TRIGGER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_GPIO_WAKEUP_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_DROPID_RPT_GET_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_DROPID_RPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_DROPID_RPT_GET_SEQ(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_DROPID_RPT_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_DROPID_RPT_GET_DROPIDBIT(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 4) -+#define C2H_DROPID_RPT_SET_DROPIDBIT(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 4, value) -+#define C2H_DROPID_RPT_GET_CURDROPID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 20, 2) -+#define C2H_DROPID_RPT_SET_CURDROPID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 20, 2, value) -+#define C2H_DROPID_RPT_GET_MACID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+#define C2H_DROPID_RPT_SET_MACID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X04, 0, 8, value) -+#define C2H_DROPID_RPT_GET_LEN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_DROPID_RPT_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_DROPID_RPT_GET_TRIGGER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_DROPID_RPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_CMD_ID(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 0, 8) -+#define C2H_LPS_STATUS_RPT_SET_CMD_ID(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 0, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_SEQ(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 8, 8) -+#define C2H_LPS_STATUS_RPT_SET_SEQ(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 8, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_ACTION(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 16, 8) -+#define C2H_LPS_STATUS_RPT_SET_ACTION(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 16, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_STATUSCODE(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X00, 24, 8) -+#define C2H_LPS_STATUS_RPT_SET_STATUSCODE(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X00, 24, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_LEN(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 16, 8) -+#define C2H_LPS_STATUS_RPT_SET_LEN(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 16, 8, value) -+#define C2H_LPS_STATUS_RPT_GET_TRIGGER(c2h_pkt) \ -+ LE_BITS_TO_4BYTE(c2h_pkt + 0X0C, 24, 8) -+#define C2H_LPS_STATUS_RPT_SET_TRIGGER(c2h_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(c2h_pkt + 0X0C, 24, 8, value) -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_h2c_ap.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_h2c_ap.h -new file mode 100644 -index 000000000..1d1a4ac1a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_h2c_ap.h -@@ -0,0 +1,1655 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ORIGINALH2CFORMAT_H2C_C2H_AP_H_ -+#define _HAL_ORIGINALH2CFORMAT_H2C_C2H_AP_H_ -+#define CMD_ID_ORIGINAL_H2C 0X00 -+#define CMD_ID_H2C2H_LB 0X0 -+#define CMD_ID_D0_SCAN_OFFLOAD_CTRL 0X06 -+#define CMD_ID_RSVD_PAGE 0X0 -+#define CMD_ID_MEDIA_STATUS_RPT 0X01 -+#define CMD_ID_KEEP_ALIVE 0X03 -+#define CMD_ID_DISCONNECT_DECISION 0X04 -+#define CMD_ID_AP_OFFLOAD 0X08 -+#define CMD_ID_BCN_RSVDPAGE 0X09 -+#define CMD_ID_PROBE_RSP_RSVDPAGE 0X0A -+#define CMD_ID_SINGLE_CHANNELSWITCH 0X1C -+#define CMD_ID_SINGLE_CHANNELSWITCH_V2 0X1D -+#define CMD_ID_SET_PWR_MODE 0X00 -+#define CMD_ID_PS_TUNING_PARA 0X01 -+#define CMD_ID_PS_TUNING_PARA_II 0X02 -+#define CMD_ID_PS_LPS_PARA 0X03 -+#define CMD_ID_P2P_PS_OFFLOAD 0X04 -+#define CMD_ID_PS_SCAN_EN 0X05 -+#define CMD_ID_SAP_PS 0X06 -+#define CMD_ID_INACTIVE_PS 0X07 -+#define CMD_ID_MACID_CFG 0X00 -+#define CMD_ID_TXBF 0X01 -+#define CMD_ID_RSSI_SETTING 0X02 -+#define CMD_ID_AP_REQ_TXRPT 0X03 -+#define CMD_ID_INIT_RATE_COLLECTION 0X04 -+#define CMD_ID_IQK_OFFLOAD 0X05 -+#define CMD_ID_MACID_CFG_3SS 0X06 -+#define CMD_ID_RA_PARA_ADJUST 0X07 -+#define CMD_ID_REQ_TXRPT_ACQ 0X12 -+#define CMD_ID_WWLAN 0X00 -+#define CMD_ID_REMOTE_WAKE_CTRL 0X01 -+#define CMD_ID_AOAC_GLOBAL_INFO 0X02 -+#define CMD_ID_AOAC_RSVD_PAGE 0X03 -+#define CMD_ID_AOAC_RSVD_PAGE2 0X04 -+#define CMD_ID_D0_SCAN_OFFLOAD_INFO 0X05 -+#define CMD_ID_CHANNEL_SWITCH_OFFLOAD 0X07 -+#define CMD_ID_AOAC_RSVD_PAGE3 0X08 -+#define CMD_ID_DBG_MSG_CTRL 0X1E -+#define CLASS_ORIGINAL_H2C 0X00 -+#define CLASS_H2C2H_LB 0X07 -+#define CLASS_D0_SCAN_OFFLOAD_CTRL 0X04 -+#define CLASS_RSVD_PAGE 0X0 -+#define CLASS_MEDIA_STATUS_RPT 0X0 -+#define CLASS_KEEP_ALIVE 0X0 -+#define CLASS_DISCONNECT_DECISION 0X0 -+#define CLASS_AP_OFFLOAD 0X0 -+#define CLASS_BCN_RSVDPAGE 0X0 -+#define CLASS_PROBE_RSP_RSVDPAGE 0X0 -+#define CLASS_SINGLE_CHANNELSWITCH 0X0 -+#define CLASS_SINGLE_CHANNELSWITCH_V2 0X0 -+#define CLASS_SET_PWR_MODE 0X01 -+#define CLASS_PS_TUNING_PARA 0X01 -+#define CLASS_PS_TUNING_PARA_II 0X01 -+#define CLASS_PS_LPS_PARA 0X01 -+#define CLASS_P2P_PS_OFFLOAD 0X01 -+#define CLASS_PS_SCAN_EN 0X1 -+#define CLASS_SAP_PS 0X1 -+#define CLASS_INACTIVE_PS 0X1 -+#define CLASS_MACID_CFG 0X2 -+#define CLASS_TXBF 0X2 -+#define CLASS_RSSI_SETTING 0X2 -+#define CLASS_AP_REQ_TXRPT 0X2 -+#define CLASS_INIT_RATE_COLLECTION 0X2 -+#define CLASS_IQK_OFFLOAD 0X2 -+#define CLASS_MACID_CFG_3SS 0X2 -+#define CLASS_RA_PARA_ADJUST 0X02 -+#define CLASS_REQ_TXRPT_ACQ 0X02 -+#define CLASS_WWLAN 0X4 -+#define CLASS_REMOTE_WAKE_CTRL 0X4 -+#define CLASS_AOAC_GLOBAL_INFO 0X04 -+#define CLASS_AOAC_RSVD_PAGE 0X04 -+#define CLASS_AOAC_RSVD_PAGE2 0X04 -+#define CLASS_D0_SCAN_OFFLOAD_INFO 0X04 -+#define CLASS_CHANNEL_SWITCH_OFFLOAD 0X04 -+#define CLASS_AOAC_RSVD_PAGE3 0X04 -+#define CLASS_DBG_MSG_CTRL 0X07 -+#define ORIGINAL_H2C_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define ORIGINAL_H2C_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define ORIGINAL_H2C_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define ORIGINAL_H2C_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define ORIGINAL_H2C_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define ORIGINAL_H2C_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define H2C2H_LB_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define H2C2H_LB_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define H2C2H_LB_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define H2C2H_LB_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define H2C2H_LB_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define H2C2H_LB_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define H2C2H_LB_GET_SEQ(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define H2C2H_LB_SET_SEQ(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define H2C2H_LB_SET_SEQ_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define H2C2H_LB_GET_PAYLOAD1(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 16) -+#define H2C2H_LB_SET_PAYLOAD1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 16, value) -+#define H2C2H_LB_SET_PAYLOAD1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 16, value) -+#define H2C2H_LB_GET_PAYLOAD2(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 0, 32) -+#define H2C2H_LB_SET_PAYLOAD2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 32, value) -+#define H2C2H_LB_SET_PAYLOAD2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 32, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_CMD_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define D0_SCAN_OFFLOAD_CTRL_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define D0_SCAN_OFFLOAD_CTRL_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_CLASS(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define D0_SCAN_OFFLOAD_CTRL_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define D0_SCAN_OFFLOAD_CTRL_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_D0_SCAN_FUN_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define D0_SCAN_OFFLOAD_CTRL_SET_D0_SCAN_FUN_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_SET_D0_SCAN_FUN_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_RTD3FUN_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 9, 1) -+#define D0_SCAN_OFFLOAD_CTRL_SET_RTD3FUN_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_SET_RTD3FUN_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_U3_SCAN_FUN_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 10, 1) -+#define D0_SCAN_OFFLOAD_CTRL_SET_U3_SCAN_FUN_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_SET_U3_SCAN_FUN_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_NLO_FUN_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 11, 1) -+#define D0_SCAN_OFFLOAD_CTRL_SET_NLO_FUN_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_SET_NLO_FUN_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_IPS_DEPENDENT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 12, 1) -+#define D0_SCAN_OFFLOAD_CTRL_SET_IPS_DEPENDENT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 12, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_SET_IPS_DEPENDENT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 12, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_LOC_PROBE_PACKET(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 17) -+#define D0_SCAN_OFFLOAD_CTRL_SET_LOC_PROBE_PACKET(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 17, value) -+#define D0_SCAN_OFFLOAD_CTRL_SET_LOC_PROBE_PACKET_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 17, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_LOC_SCAN_INFO(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define D0_SCAN_OFFLOAD_CTRL_SET_LOC_SCAN_INFO(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define D0_SCAN_OFFLOAD_CTRL_SET_LOC_SCAN_INFO_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_LOC_SSID_INFO(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define D0_SCAN_OFFLOAD_CTRL_SET_LOC_SSID_INFO(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define D0_SCAN_OFFLOAD_CTRL_SET_LOC_SSID_INFO_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define RSVD_PAGE_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define RSVD_PAGE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define RSVD_PAGE_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define RSVD_PAGE_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define RSVD_PAGE_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define RSVD_PAGE_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define RSVD_PAGE_GET_LOC_PROBE_RSP(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define RSVD_PAGE_SET_LOC_PROBE_RSP(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define RSVD_PAGE_SET_LOC_PROBE_RSP_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define RSVD_PAGE_GET_LOC_PS_POLL(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define RSVD_PAGE_SET_LOC_PS_POLL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define RSVD_PAGE_SET_LOC_PS_POLL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define RSVD_PAGE_GET_LOC_NULL_DATA(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define RSVD_PAGE_SET_LOC_NULL_DATA(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define RSVD_PAGE_SET_LOC_NULL_DATA_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define RSVD_PAGE_GET_LOC_QOS_NULL(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define RSVD_PAGE_SET_LOC_QOS_NULL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define RSVD_PAGE_SET_LOC_QOS_NULL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define RSVD_PAGE_GET_LOC_BT_QOS_NULL(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define RSVD_PAGE_SET_LOC_BT_QOS_NULL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define RSVD_PAGE_SET_LOC_BT_QOS_NULL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define RSVD_PAGE_GET_LOC_CTS2SELF(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 16, 8) -+#define RSVD_PAGE_SET_LOC_CTS2SELF(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define RSVD_PAGE_SET_LOC_CTS2SELF_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define RSVD_PAGE_GET_LOC_LTECOEX_QOSNULL(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 24, 8) -+#define RSVD_PAGE_SET_LOC_LTECOEX_QOSNULL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define RSVD_PAGE_SET_LOC_LTECOEX_QOSNULL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define MEDIA_STATUS_RPT_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define MEDIA_STATUS_RPT_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define MEDIA_STATUS_RPT_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define MEDIA_STATUS_RPT_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define MEDIA_STATUS_RPT_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define MEDIA_STATUS_RPT_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define MEDIA_STATUS_RPT_GET_OP_MODE(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define MEDIA_STATUS_RPT_SET_OP_MODE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define MEDIA_STATUS_RPT_SET_OP_MODE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define MEDIA_STATUS_RPT_GET_MACID_IN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 9, 1) -+#define MEDIA_STATUS_RPT_SET_MACID_IN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define MEDIA_STATUS_RPT_SET_MACID_IN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define MEDIA_STATUS_RPT_GET_MACID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define MEDIA_STATUS_RPT_SET_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define MEDIA_STATUS_RPT_SET_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define MEDIA_STATUS_RPT_GET_MACID_END(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define MEDIA_STATUS_RPT_SET_MACID_END(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define MEDIA_STATUS_RPT_SET_MACID_END_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define KEEP_ALIVE_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define KEEP_ALIVE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define KEEP_ALIVE_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define KEEP_ALIVE_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define KEEP_ALIVE_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define KEEP_ALIVE_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define KEEP_ALIVE_GET_ENABLE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define KEEP_ALIVE_SET_ENABLE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define KEEP_ALIVE_SET_ENABLE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define KEEP_ALIVE_GET_ADOPT_USER_SETTING(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 9, 1) -+#define KEEP_ALIVE_SET_ADOPT_USER_SETTING(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define KEEP_ALIVE_SET_ADOPT_USER_SETTING_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define KEEP_ALIVE_GET_PKT_TYPE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 10, 1) -+#define KEEP_ALIVE_SET_PKT_TYPE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define KEEP_ALIVE_SET_PKT_TYPE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define KEEP_ALIVE_GET_KEEP_ALIVE_CHECK_PERIOD(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define KEEP_ALIVE_SET_KEEP_ALIVE_CHECK_PERIOD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define KEEP_ALIVE_SET_KEEP_ALIVE_CHECK_PERIOD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define DISCONNECT_DECISION_GET_CMD_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define DISCONNECT_DECISION_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define DISCONNECT_DECISION_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define DISCONNECT_DECISION_GET_CLASS(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define DISCONNECT_DECISION_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define DISCONNECT_DECISION_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define DISCONNECT_DECISION_GET_ENABLE(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define DISCONNECT_DECISION_SET_ENABLE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define DISCONNECT_DECISION_SET_ENABLE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define DISCONNECT_DECISION_GET_ADOPT_USER_SETTING(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 9, 1) -+#define DISCONNECT_DECISION_SET_ADOPT_USER_SETTING(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define DISCONNECT_DECISION_SET_ADOPT_USER_SETTING_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define DISCONNECT_DECISION_GET_TRY_OK_BCN_FAIL_COUNT_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 10, 1) -+#define DISCONNECT_DECISION_SET_TRY_OK_BCN_FAIL_COUNT_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define DISCONNECT_DECISION_SET_TRY_OK_BCN_FAIL_COUNT_EN_NO_CLR(h2c_pkt, \ -+ value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define DISCONNECT_DECISION_GET_DISCONNECT_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 11, 1) -+#define DISCONNECT_DECISION_SET_DISCONNECT_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define DISCONNECT_DECISION_SET_DISCONNECT_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define DISCONNECT_DECISION_GET_DISCON_DECISION_CHECK_PERIOD(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define DISCONNECT_DECISION_SET_DISCON_DECISION_CHECK_PERIOD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define DISCONNECT_DECISION_SET_DISCON_DECISION_CHECK_PERIOD_NO_CLR(h2c_pkt, \ -+ value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define DISCONNECT_DECISION_GET_TRY_PKT_NUM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define DISCONNECT_DECISION_SET_TRY_PKT_NUM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define DISCONNECT_DECISION_SET_TRY_PKT_NUM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define DISCONNECT_DECISION_GET_TRY_OK_BCN_FAIL_COUNT_LIMIT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define DISCONNECT_DECISION_SET_TRY_OK_BCN_FAIL_COUNT_LIMIT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define DISCONNECT_DECISION_SET_TRY_OK_BCN_FAIL_COUNT_LIMIT_NO_CLR(h2c_pkt, \ -+ value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define AP_OFFLOAD_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define AP_OFFLOAD_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AP_OFFLOAD_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AP_OFFLOAD_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define AP_OFFLOAD_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AP_OFFLOAD_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AP_OFFLOAD_GET_ON(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define AP_OFFLOAD_SET_ON(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define AP_OFFLOAD_SET_ON_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define AP_OFFLOAD_GET_CFG_MIFI_PLATFORM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 9, 1) -+#define AP_OFFLOAD_SET_CFG_MIFI_PLATFORM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define AP_OFFLOAD_SET_CFG_MIFI_PLATFORM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define AP_OFFLOAD_GET_LINKED(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 10, 1) -+#define AP_OFFLOAD_SET_LINKED(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define AP_OFFLOAD_SET_LINKED_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define AP_OFFLOAD_GET_EN_AUTO_WAKE(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 11, 1) -+#define AP_OFFLOAD_SET_EN_AUTO_WAKE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define AP_OFFLOAD_SET_EN_AUTO_WAKE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define AP_OFFLOAD_GET_WAKE_FLAG(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 12, 1) -+#define AP_OFFLOAD_SET_WAKE_FLAG(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 12, 1, value) -+#define AP_OFFLOAD_SET_WAKE_FLAG_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 12, 1, value) -+#define AP_OFFLOAD_GET_HIDDEN_ROOT(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 1) -+#define AP_OFFLOAD_SET_HIDDEN_ROOT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 1, value) -+#define AP_OFFLOAD_SET_HIDDEN_ROOT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 1, value) -+#define AP_OFFLOAD_GET_HIDDEN_VAP1(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 17, 1) -+#define AP_OFFLOAD_SET_HIDDEN_VAP1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 17, 1, value) -+#define AP_OFFLOAD_SET_HIDDEN_VAP1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 17, 1, value) -+#define AP_OFFLOAD_GET_HIDDEN_VAP2(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 18, 1) -+#define AP_OFFLOAD_SET_HIDDEN_VAP2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 18, 1, value) -+#define AP_OFFLOAD_SET_HIDDEN_VAP2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 18, 1, value) -+#define AP_OFFLOAD_GET_HIDDEN_VAP3(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 19, 1) -+#define AP_OFFLOAD_SET_HIDDEN_VAP3(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 19, 1, value) -+#define AP_OFFLOAD_SET_HIDDEN_VAP3_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 19, 1, value) -+#define AP_OFFLOAD_GET_HIDDEN_VAP4(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 20, 1) -+#define AP_OFFLOAD_SET_HIDDEN_VAP4(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 20, 1, value) -+#define AP_OFFLOAD_SET_HIDDEN_VAP4_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 20, 1, value) -+#define AP_OFFLOAD_GET_DENYANY_ROOT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 1) -+#define AP_OFFLOAD_SET_DENYANY_ROOT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 1, value) -+#define AP_OFFLOAD_SET_DENYANY_ROOT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 1, value) -+#define AP_OFFLOAD_GET_DENYANY_VAP1(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 25, 1) -+#define AP_OFFLOAD_SET_DENYANY_VAP1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 25, 1, value) -+#define AP_OFFLOAD_SET_DENYANY_VAP1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 25, 1, value) -+#define AP_OFFLOAD_GET_DENYANY_VAP2(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 26, 1) -+#define AP_OFFLOAD_SET_DENYANY_VAP2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 26, 1, value) -+#define AP_OFFLOAD_SET_DENYANY_VAP2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 26, 1, value) -+#define AP_OFFLOAD_GET_DENYANY_VAP3(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 27, 1) -+#define AP_OFFLOAD_SET_DENYANY_VAP3(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 27, 1, value) -+#define AP_OFFLOAD_SET_DENYANY_VAP3_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 27, 1, value) -+#define AP_OFFLOAD_GET_DENYANY_VAP4(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 28, 1) -+#define AP_OFFLOAD_SET_DENYANY_VAP4(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 28, 1, value) -+#define AP_OFFLOAD_SET_DENYANY_VAP4_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 28, 1, value) -+#define AP_OFFLOAD_GET_WAIT_TBTT_CNT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define AP_OFFLOAD_SET_WAIT_TBTT_CNT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define AP_OFFLOAD_SET_WAIT_TBTT_CNT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define AP_OFFLOAD_GET_WAKE_TIMEOUT(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define AP_OFFLOAD_SET_WAKE_TIMEOUT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define AP_OFFLOAD_SET_WAKE_TIMEOUT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define AP_OFFLOAD_GET_LEN_IV_PAIR(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 16, 8) -+#define AP_OFFLOAD_SET_LEN_IV_PAIR(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define AP_OFFLOAD_SET_LEN_IV_PAIR_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define AP_OFFLOAD_GET_LEN_IV_GRP(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 24, 8) -+#define AP_OFFLOAD_SET_LEN_IV_GRP(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define AP_OFFLOAD_SET_LEN_IV_GRP_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define BCN_RSVDPAGE_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define BCN_RSVDPAGE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define BCN_RSVDPAGE_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define BCN_RSVDPAGE_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define BCN_RSVDPAGE_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define BCN_RSVDPAGE_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define BCN_RSVDPAGE_GET_LOC_ROOT(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define BCN_RSVDPAGE_SET_LOC_ROOT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define BCN_RSVDPAGE_SET_LOC_ROOT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define BCN_RSVDPAGE_GET_LOC_VAP1(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define BCN_RSVDPAGE_SET_LOC_VAP1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define BCN_RSVDPAGE_SET_LOC_VAP1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define BCN_RSVDPAGE_GET_LOC_VAP2(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define BCN_RSVDPAGE_SET_LOC_VAP2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define BCN_RSVDPAGE_SET_LOC_VAP2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define BCN_RSVDPAGE_GET_LOC_VAP3(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define BCN_RSVDPAGE_SET_LOC_VAP3(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define BCN_RSVDPAGE_SET_LOC_VAP3_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define BCN_RSVDPAGE_GET_LOC_VAP4(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define BCN_RSVDPAGE_SET_LOC_VAP4(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define BCN_RSVDPAGE_SET_LOC_VAP4_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define PROBE_RSP_RSVDPAGE_GET_CMD_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define PROBE_RSP_RSVDPAGE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define PROBE_RSP_RSVDPAGE_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define PROBE_RSP_RSVDPAGE_GET_CLASS(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define PROBE_RSP_RSVDPAGE_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define PROBE_RSP_RSVDPAGE_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define PROBE_RSP_RSVDPAGE_GET_LOC_ROOT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_ROOT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_ROOT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define PROBE_RSP_RSVDPAGE_GET_LOC_VAP1(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define PROBE_RSP_RSVDPAGE_GET_LOC_VAP2(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP2(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP2_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define PROBE_RSP_RSVDPAGE_GET_LOC_VAP3(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP3(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP3_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define PROBE_RSP_RSVDPAGE_GET_LOC_VAP4(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP4(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP4_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define SINGLE_CHANNELSWITCH_GET_CMD_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define SINGLE_CHANNELSWITCH_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define SINGLE_CHANNELSWITCH_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define SINGLE_CHANNELSWITCH_GET_CLASS(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define SINGLE_CHANNELSWITCH_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define SINGLE_CHANNELSWITCH_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define SINGLE_CHANNELSWITCH_GET_CHANNEL_NUM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define SINGLE_CHANNELSWITCH_SET_CHANNEL_NUM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define SINGLE_CHANNELSWITCH_SET_CHANNEL_NUM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define SINGLE_CHANNELSWITCH_GET_BW(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 2) -+#define SINGLE_CHANNELSWITCH_SET_BW(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 2, value) -+#define SINGLE_CHANNELSWITCH_SET_BW_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 2, value) -+#define SINGLE_CHANNELSWITCH_GET_BW40SC(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 18, 3) -+#define SINGLE_CHANNELSWITCH_SET_BW40SC(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 18, 3, value) -+#define SINGLE_CHANNELSWITCH_SET_BW40SC_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 18, 3, value) -+#define SINGLE_CHANNELSWITCH_GET_BW80SC(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 21, 3) -+#define SINGLE_CHANNELSWITCH_SET_BW80SC(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 21, 3, value) -+#define SINGLE_CHANNELSWITCH_SET_BW80SC_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 21, 3, value) -+#define SINGLE_CHANNELSWITCH_GET_RFE_TYPE(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 4) -+#define SINGLE_CHANNELSWITCH_SET_RFE_TYPE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 4, value) -+#define SINGLE_CHANNELSWITCH_SET_RFE_TYPE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 4, value) -+#define SINGLE_CHANNELSWITCH_V2_GET_CMD_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define SINGLE_CHANNELSWITCH_V2_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define SINGLE_CHANNELSWITCH_V2_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define SINGLE_CHANNELSWITCH_V2_GET_CLASS(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define SINGLE_CHANNELSWITCH_V2_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define SINGLE_CHANNELSWITCH_V2_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define SINGLE_CHANNELSWITCH_V2_GET_CENTRAL_CH(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define SINGLE_CHANNELSWITCH_V2_SET_CENTRAL_CH(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define SINGLE_CHANNELSWITCH_V2_SET_CENTRAL_CH_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define SINGLE_CHANNELSWITCH_V2_GET_PRIMARY_CH_IDX(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 4) -+#define SINGLE_CHANNELSWITCH_V2_SET_PRIMARY_CH_IDX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 4, value) -+#define SINGLE_CHANNELSWITCH_V2_SET_PRIMARY_CH_IDX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 4, value) -+#define SINGLE_CHANNELSWITCH_V2_GET_BW(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 20, 4) -+#define SINGLE_CHANNELSWITCH_V2_SET_BW(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 20, 4, value) -+#define SINGLE_CHANNELSWITCH_V2_SET_BW_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 20, 4, value) -+#define SET_PWR_MODE_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define SET_PWR_MODE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define SET_PWR_MODE_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define SET_PWR_MODE_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define SET_PWR_MODE_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define SET_PWR_MODE_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define SET_PWR_MODE_GET_MODE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 7) -+#define SET_PWR_MODE_SET_MODE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 7, value) -+#define SET_PWR_MODE_SET_MODE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 7, value) -+#define SET_PWR_MODE_GET_CLK_REQUEST(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 15, 1) -+#define SET_PWR_MODE_SET_CLK_REQUEST(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 15, 1, value) -+#define SET_PWR_MODE_SET_CLK_REQUEST_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 15, 1, value) -+#define SET_PWR_MODE_GET_RLBM(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 4) -+#define SET_PWR_MODE_SET_RLBM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 4, value) -+#define SET_PWR_MODE_SET_RLBM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 4, value) -+#define SET_PWR_MODE_GET_SMART_PS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 20, 4) -+#define SET_PWR_MODE_SET_SMART_PS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 20, 4, value) -+#define SET_PWR_MODE_SET_SMART_PS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 20, 4, value) -+#define SET_PWR_MODE_GET_AWAKE_INTERVAL(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define SET_PWR_MODE_SET_AWAKE_INTERVAL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define SET_PWR_MODE_SET_AWAKE_INTERVAL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define SET_PWR_MODE_GET_B_ALL_QUEUE_UAPSD(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 1) -+#define SET_PWR_MODE_SET_B_ALL_QUEUE_UAPSD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 1, value) -+#define SET_PWR_MODE_SET_B_ALL_QUEUE_UAPSD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 1, value) -+#define SET_PWR_MODE_GET_BCN_EARLY_RPT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 2, 1) -+#define SET_PWR_MODE_SET_BCN_EARLY_RPT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 2, 1, value) -+#define SET_PWR_MODE_SET_BCN_EARLY_RPT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 2, 1, value) -+#define SET_PWR_MODE_GET_PORT_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 5, 3) -+#define SET_PWR_MODE_SET_PORT_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 5, 3, value) -+#define SET_PWR_MODE_SET_PORT_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 5, 3, value) -+#define SET_PWR_MODE_GET_PWR_STATE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define SET_PWR_MODE_SET_PWR_STATE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define SET_PWR_MODE_SET_PWR_STATE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define SET_PWR_MODE_GET_RSVD_NOUSED(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 16, 8) -+#define SET_PWR_MODE_SET_RSVD_NOUSED(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define SET_PWR_MODE_SET_RSVD_NOUSED_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define SET_PWR_MODE_GET_BCN_RECEIVING_TIME(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 24, 5) -+#define SET_PWR_MODE_SET_BCN_RECEIVING_TIME(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 24, 5, value) -+#define SET_PWR_MODE_SET_BCN_RECEIVING_TIME_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 24, 5, value) -+#define SET_PWR_MODE_GET_BCN_LISTEN_INTERVAL(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 29, 2) -+#define SET_PWR_MODE_SET_BCN_LISTEN_INTERVAL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 29, 2, value) -+#define SET_PWR_MODE_SET_BCN_LISTEN_INTERVAL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 29, 2, value) -+#define SET_PWR_MODE_GET_ADOPT_BCN_RECEIVING_TIME(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 31, 1) -+#define SET_PWR_MODE_SET_ADOPT_BCN_RECEIVING_TIME(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 31, 1, value) -+#define SET_PWR_MODE_SET_ADOPT_BCN_RECEIVING_TIME_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 31, 1, value) -+#define PS_TUNING_PARA_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define PS_TUNING_PARA_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define PS_TUNING_PARA_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define PS_TUNING_PARA_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define PS_TUNING_PARA_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define PS_TUNING_PARA_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define PS_TUNING_PARA_GET_BCN_TO_LIMIT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 7) -+#define PS_TUNING_PARA_SET_BCN_TO_LIMIT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 7, value) -+#define PS_TUNING_PARA_SET_BCN_TO_LIMIT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 7, value) -+#define PS_TUNING_PARA_GET_DTIM_TIME_OUT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 15, 1) -+#define PS_TUNING_PARA_SET_DTIM_TIME_OUT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 15, 1, value) -+#define PS_TUNING_PARA_SET_DTIM_TIME_OUT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 15, 1, value) -+#define PS_TUNING_PARA_GET_PS_TIME_OUT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 4) -+#define PS_TUNING_PARA_SET_PS_TIME_OUT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 4, value) -+#define PS_TUNING_PARA_SET_PS_TIME_OUT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 4, value) -+#define PS_TUNING_PARA_GET_ADOPT(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define PS_TUNING_PARA_SET_ADOPT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define PS_TUNING_PARA_SET_ADOPT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define PS_TUNING_PARA_II_GET_CMD_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define PS_TUNING_PARA_II_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define PS_TUNING_PARA_II_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define PS_TUNING_PARA_II_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define PS_TUNING_PARA_II_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define PS_TUNING_PARA_II_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define PS_TUNING_PARA_II_GET_BCN_TO_PERIOD(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 7) -+#define PS_TUNING_PARA_II_SET_BCN_TO_PERIOD(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 7, value) -+#define PS_TUNING_PARA_II_SET_BCN_TO_PERIOD_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 7, value) -+#define PS_TUNING_PARA_II_GET_ADOPT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 15, 1) -+#define PS_TUNING_PARA_II_SET_ADOPT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 15, 1, value) -+#define PS_TUNING_PARA_II_SET_ADOPT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 15, 1, value) -+#define PS_TUNING_PARA_II_GET_DRV_EARLY_IVL(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define PS_TUNING_PARA_II_SET_DRV_EARLY_IVL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define PS_TUNING_PARA_II_SET_DRV_EARLY_IVL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define PS_LPS_PARA_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define PS_LPS_PARA_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define PS_LPS_PARA_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define PS_LPS_PARA_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define PS_LPS_PARA_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define PS_LPS_PARA_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define PS_LPS_PARA_GET_LPS_CONTROL(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define PS_LPS_PARA_SET_LPS_CONTROL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define PS_LPS_PARA_SET_LPS_CONTROL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define P2P_PS_OFFLOAD_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define P2P_PS_OFFLOAD_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define P2P_PS_OFFLOAD_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define P2P_PS_OFFLOAD_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define P2P_PS_OFFLOAD_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define P2P_PS_OFFLOAD_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define P2P_PS_OFFLOAD_GET_OFFLOAD_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define P2P_PS_OFFLOAD_SET_OFFLOAD_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define P2P_PS_OFFLOAD_SET_OFFLOAD_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define P2P_PS_OFFLOAD_GET_ROLE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 9, 1) -+#define P2P_PS_OFFLOAD_SET_ROLE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define P2P_PS_OFFLOAD_SET_ROLE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define P2P_PS_OFFLOAD_GET_CTWINDOW_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 10, 1) -+#define P2P_PS_OFFLOAD_SET_CTWINDOW_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define P2P_PS_OFFLOAD_SET_CTWINDOW_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define P2P_PS_OFFLOAD_GET_NOA0_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 11, 1) -+#define P2P_PS_OFFLOAD_SET_NOA0_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define P2P_PS_OFFLOAD_SET_NOA0_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define P2P_PS_OFFLOAD_GET_NOA1_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 12, 1) -+#define P2P_PS_OFFLOAD_SET_NOA1_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 12, 1, value) -+#define P2P_PS_OFFLOAD_SET_NOA1_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 12, 1, value) -+#define P2P_PS_OFFLOAD_GET_ALL_STA_SLEEP(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 13, 1) -+#define P2P_PS_OFFLOAD_SET_ALL_STA_SLEEP(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 13, 1, value) -+#define P2P_PS_OFFLOAD_SET_ALL_STA_SLEEP_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 13, 1, value) -+#define P2P_PS_OFFLOAD_GET_DISCOVERY(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 14, 1) -+#define P2P_PS_OFFLOAD_SET_DISCOVERY(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 14, 1, value) -+#define P2P_PS_OFFLOAD_SET_DISCOVERY_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 14, 1, value) -+#define PS_SCAN_EN_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define PS_SCAN_EN_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define PS_SCAN_EN_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define PS_SCAN_EN_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define PS_SCAN_EN_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define PS_SCAN_EN_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define PS_SCAN_EN_GET_ENABLE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define PS_SCAN_EN_SET_ENABLE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define PS_SCAN_EN_SET_ENABLE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define SAP_PS_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define SAP_PS_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define SAP_PS_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define SAP_PS_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define SAP_PS_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define SAP_PS_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define SAP_PS_GET_ENABLE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define SAP_PS_SET_ENABLE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define SAP_PS_SET_ENABLE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define SAP_PS_GET_EN_PS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 9, 1) -+#define SAP_PS_SET_EN_PS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define SAP_PS_SET_EN_PS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define SAP_PS_GET_EN_LP_RX(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 10, 1) -+#define SAP_PS_SET_EN_LP_RX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define SAP_PS_SET_EN_LP_RX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define SAP_PS_GET_MANUAL_32K(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 11, 1) -+#define SAP_PS_SET_MANUAL_32K(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define SAP_PS_SET_MANUAL_32K_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define SAP_PS_GET_DURATION(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define SAP_PS_SET_DURATION(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define SAP_PS_SET_DURATION_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define INACTIVE_PS_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define INACTIVE_PS_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define INACTIVE_PS_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define INACTIVE_PS_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define INACTIVE_PS_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define INACTIVE_PS_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define INACTIVE_PS_GET_ENABLE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define INACTIVE_PS_SET_ENABLE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define INACTIVE_PS_SET_ENABLE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define INACTIVE_PS_GET_IGNORE_PS_CONDITION(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 9, 1) -+#define INACTIVE_PS_SET_IGNORE_PS_CONDITION(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define INACTIVE_PS_SET_IGNORE_PS_CONDITION_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define INACTIVE_PS_GET_FREQUENCY(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define INACTIVE_PS_SET_FREQUENCY(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define INACTIVE_PS_SET_FREQUENCY_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define INACTIVE_PS_GET_DURATION(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define INACTIVE_PS_SET_DURATION(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define INACTIVE_PS_SET_DURATION_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define MACID_CFG_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define MACID_CFG_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define MACID_CFG_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define MACID_CFG_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define MACID_CFG_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define MACID_CFG_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define MACID_CFG_GET_MAC_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define MACID_CFG_SET_MAC_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define MACID_CFG_SET_MAC_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define MACID_CFG_GET_RATE_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 5) -+#define MACID_CFG_SET_RATE_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 5, value) -+#define MACID_CFG_SET_RATE_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 5, value) -+#define MACID_CFG_GET_INIT_RATE_LV(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 21, 2) -+#define MACID_CFG_SET_INIT_RATE_LV(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 21, 2, value) -+#define MACID_CFG_SET_INIT_RATE_LV_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 21, 2, value) -+#define MACID_CFG_GET_SGI(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 23, 1) -+#define MACID_CFG_SET_SGI(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 23, 1, value) -+#define MACID_CFG_SET_SGI_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 23, 1, value) -+#define MACID_CFG_GET_BW(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 24, 2) -+#define MACID_CFG_SET_BW(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 2, value) -+#define MACID_CFG_SET_BW_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 2, value) -+#define MACID_CFG_GET_LDPC_CAP(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 26, 1) -+#define MACID_CFG_SET_LDPC_CAP(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 26, 1, value) -+#define MACID_CFG_SET_LDPC_CAP_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 26, 1, value) -+#define MACID_CFG_GET_NO_UPDATE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 27, 1) -+#define MACID_CFG_SET_NO_UPDATE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 27, 1, value) -+#define MACID_CFG_SET_NO_UPDATE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 27, 1, value) -+#define MACID_CFG_GET_WHT_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 28, 2) -+#define MACID_CFG_SET_WHT_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 28, 2, value) -+#define MACID_CFG_SET_WHT_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 28, 2, value) -+#define MACID_CFG_GET_DISPT(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 30, 1) -+#define MACID_CFG_SET_DISPT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 30, 1, value) -+#define MACID_CFG_SET_DISPT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 30, 1, value) -+#define MACID_CFG_GET_DISRA(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 31, 1) -+#define MACID_CFG_SET_DISRA(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 31, 1, value) -+#define MACID_CFG_SET_DISRA_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 31, 1, value) -+#define MACID_CFG_GET_RATE_MASK7_0(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define MACID_CFG_SET_RATE_MASK7_0(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define MACID_CFG_SET_RATE_MASK7_0_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define MACID_CFG_GET_RATE_MASK15_8(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define MACID_CFG_SET_RATE_MASK15_8(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define MACID_CFG_SET_RATE_MASK15_8_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define MACID_CFG_GET_RATE_MASK23_16(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 16, 8) -+#define MACID_CFG_SET_RATE_MASK23_16(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define MACID_CFG_SET_RATE_MASK23_16_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define MACID_CFG_GET_RATE_MASK31_24(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 24, 8) -+#define MACID_CFG_SET_RATE_MASK31_24(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define MACID_CFG_SET_RATE_MASK31_24_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define TXBF_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define TXBF_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define TXBF_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define TXBF_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define TXBF_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define TXBF_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define TXBF_GET_NDPA0_HEAD_PAGE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define TXBF_SET_NDPA0_HEAD_PAGE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define TXBF_SET_NDPA0_HEAD_PAGE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define TXBF_GET_NDPA1_HEAD_PAGE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define TXBF_SET_NDPA1_HEAD_PAGE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define TXBF_SET_NDPA1_HEAD_PAGE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define TXBF_GET_PERIOD_0(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define TXBF_SET_PERIOD_0(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define TXBF_SET_PERIOD_0_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define RSSI_SETTING_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define RSSI_SETTING_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define RSSI_SETTING_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define RSSI_SETTING_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define RSSI_SETTING_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define RSSI_SETTING_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define RSSI_SETTING_GET_MAC_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define RSSI_SETTING_SET_MAC_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define RSSI_SETTING_SET_MAC_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define RSSI_SETTING_GET_RSSI(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 24, 7) -+#define RSSI_SETTING_SET_RSSI(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 7, value) -+#define RSSI_SETTING_SET_RSSI_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 7, value) -+#define RSSI_SETTING_GET_RA_INFO(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define RSSI_SETTING_SET_RA_INFO(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define RSSI_SETTING_SET_RA_INFO_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define AP_REQ_TXRPT_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define AP_REQ_TXRPT_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AP_REQ_TXRPT_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AP_REQ_TXRPT_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define AP_REQ_TXRPT_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AP_REQ_TXRPT_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AP_REQ_TXRPT_GET_STA1_MACID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define AP_REQ_TXRPT_SET_STA1_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define AP_REQ_TXRPT_SET_STA1_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define AP_REQ_TXRPT_GET_STA2_MACID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define AP_REQ_TXRPT_SET_STA2_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define AP_REQ_TXRPT_SET_STA2_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define AP_REQ_TXRPT_GET_RTY_OK_TOTAL(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 1) -+#define AP_REQ_TXRPT_SET_RTY_OK_TOTAL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 1, value) -+#define AP_REQ_TXRPT_SET_RTY_OK_TOTAL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 1, value) -+#define AP_REQ_TXRPT_GET_RTY_CNT_MACID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 25, 1) -+#define AP_REQ_TXRPT_SET_RTY_CNT_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 25, 1, value) -+#define AP_REQ_TXRPT_SET_RTY_CNT_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 25, 1, value) -+#define INIT_RATE_COLLECTION_GET_CMD_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define INIT_RATE_COLLECTION_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define INIT_RATE_COLLECTION_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define INIT_RATE_COLLECTION_GET_CLASS(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define INIT_RATE_COLLECTION_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define INIT_RATE_COLLECTION_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define INIT_RATE_COLLECTION_GET_STA1_MACID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define INIT_RATE_COLLECTION_SET_STA1_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define INIT_RATE_COLLECTION_SET_STA1_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA2_MACID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define INIT_RATE_COLLECTION_SET_STA2_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define INIT_RATE_COLLECTION_SET_STA2_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA3_MACID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define INIT_RATE_COLLECTION_SET_STA3_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define INIT_RATE_COLLECTION_SET_STA3_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA4_MACID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define INIT_RATE_COLLECTION_SET_STA4_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define INIT_RATE_COLLECTION_SET_STA4_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA5_MACID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define INIT_RATE_COLLECTION_SET_STA5_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define INIT_RATE_COLLECTION_SET_STA5_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA6_MACID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 16, 8) -+#define INIT_RATE_COLLECTION_SET_STA6_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define INIT_RATE_COLLECTION_SET_STA6_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA7_MACID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 24, 8) -+#define INIT_RATE_COLLECTION_SET_STA7_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define INIT_RATE_COLLECTION_SET_STA7_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define IQK_OFFLOAD_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define IQK_OFFLOAD_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define IQK_OFFLOAD_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define IQK_OFFLOAD_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define IQK_OFFLOAD_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define IQK_OFFLOAD_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define IQK_OFFLOAD_GET_CHANNEL(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define IQK_OFFLOAD_SET_CHANNEL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define IQK_OFFLOAD_SET_CHANNEL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define IQK_OFFLOAD_GET_BWBAND(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define IQK_OFFLOAD_SET_BWBAND(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define IQK_OFFLOAD_SET_BWBAND_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define IQK_OFFLOAD_GET_EXTPALNA(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define IQK_OFFLOAD_SET_EXTPALNA(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define IQK_OFFLOAD_SET_EXTPALNA_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define MACID_CFG_3SS_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define MACID_CFG_3SS_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define MACID_CFG_3SS_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define MACID_CFG_3SS_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define MACID_CFG_3SS_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define MACID_CFG_3SS_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define MACID_CFG_3SS_GET_MACID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define MACID_CFG_3SS_SET_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define MACID_CFG_3SS_SET_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define MACID_CFG_3SS_GET_RATE_MASK_39_32(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define MACID_CFG_3SS_SET_RATE_MASK_39_32(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define MACID_CFG_3SS_SET_RATE_MASK_39_32_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define MACID_CFG_3SS_GET_RATE_MASK_47_40(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define MACID_CFG_3SS_SET_RATE_MASK_47_40(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define MACID_CFG_3SS_SET_RATE_MASK_47_40_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define RA_PARA_ADJUST_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define RA_PARA_ADJUST_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define RA_PARA_ADJUST_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define RA_PARA_ADJUST_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define RA_PARA_ADJUST_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define RA_PARA_ADJUST_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define RA_PARA_ADJUST_GET_MAC_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define RA_PARA_ADJUST_SET_MAC_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define RA_PARA_ADJUST_SET_MAC_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define RA_PARA_ADJUST_GET_PARAMETER_INDEX(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define RA_PARA_ADJUST_SET_PARAMETER_INDEX(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define RA_PARA_ADJUST_SET_PARAMETER_INDEX_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define RA_PARA_ADJUST_GET_RATE_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define RA_PARA_ADJUST_SET_RATE_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define RA_PARA_ADJUST_SET_RATE_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define RA_PARA_ADJUST_GET_VALUE_BYTE0(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define RA_PARA_ADJUST_SET_VALUE_BYTE0(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define RA_PARA_ADJUST_SET_VALUE_BYTE0_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define RA_PARA_ADJUST_GET_VALUE_BYTE1(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define RA_PARA_ADJUST_SET_VALUE_BYTE1(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define RA_PARA_ADJUST_SET_VALUE_BYTE1_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define RA_PARA_ADJUST_GET_ASK_FW_FOR_FW_PARA(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 16, 8) -+#define RA_PARA_ADJUST_SET_ASK_FW_FOR_FW_PARA(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define RA_PARA_ADJUST_SET_ASK_FW_FOR_FW_PARA_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define REQ_TXRPT_ACQ_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define REQ_TXRPT_ACQ_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define REQ_TXRPT_ACQ_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define REQ_TXRPT_ACQ_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define REQ_TXRPT_ACQ_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define REQ_TXRPT_ACQ_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define REQ_TXRPT_ACQ_GET_STA1_MACID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define REQ_TXRPT_ACQ_SET_STA1_MACID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define REQ_TXRPT_ACQ_SET_STA1_MACID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define REQ_TXRPT_ACQ_GET_PASS_DROP_SEL(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define REQ_TXRPT_ACQ_SET_PASS_DROP_SEL(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define REQ_TXRPT_ACQ_SET_PASS_DROP_SEL_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define WWLAN_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define WWLAN_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define WWLAN_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define WWLAN_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define WWLAN_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define WWLAN_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define WWLAN_GET_FUNC_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define WWLAN_SET_FUNC_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define WWLAN_SET_FUNC_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define WWLAN_GET_PATTERM_MAT_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 9, 1) -+#define WWLAN_SET_PATTERM_MAT_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define WWLAN_SET_PATTERM_MAT_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define WWLAN_GET_MAGIC_PKT_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 10, 1) -+#define WWLAN_SET_MAGIC_PKT_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define WWLAN_SET_MAGIC_PKT_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define WWLAN_GET_UNICAST_WAKEUP_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 11, 1) -+#define WWLAN_SET_UNICAST_WAKEUP_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define WWLAN_SET_UNICAST_WAKEUP_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define WWLAN_GET_ALL_PKT_DROP(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 12, 1) -+#define WWLAN_SET_ALL_PKT_DROP(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 12, 1, value) -+#define WWLAN_SET_ALL_PKT_DROP_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 12, 1, value) -+#define WWLAN_GET_GPIO_ACTIVE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 13, 1) -+#define WWLAN_SET_GPIO_ACTIVE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 13, 1, value) -+#define WWLAN_SET_GPIO_ACTIVE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 13, 1, value) -+#define WWLAN_GET_REKEY_WAKEUP_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 14, 1) -+#define WWLAN_SET_REKEY_WAKEUP_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 14, 1, value) -+#define WWLAN_SET_REKEY_WAKEUP_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 14, 1, value) -+#define WWLAN_GET_DEAUTH_WAKEUP_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 15, 1) -+#define WWLAN_SET_DEAUTH_WAKEUP_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 15, 1, value) -+#define WWLAN_SET_DEAUTH_WAKEUP_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 15, 1, value) -+#define WWLAN_GET_GPIO_NUM(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 16, 7) -+#define WWLAN_SET_GPIO_NUM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 7, value) -+#define WWLAN_SET_GPIO_NUM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 7, value) -+#define WWLAN_GET_DATAPIN_WAKEUP_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 23, 1) -+#define WWLAN_SET_DATAPIN_WAKEUP_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 23, 1, value) -+#define WWLAN_SET_DATAPIN_WAKEUP_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 23, 1, value) -+#define WWLAN_GET_GPIO_DURATION(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define WWLAN_SET_GPIO_DURATION(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define WWLAN_SET_GPIO_DURATION_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define WWLAN_GET_GPIO_PLUS_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 0, 1) -+#define WWLAN_SET_GPIO_PLUS_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 1, value) -+#define WWLAN_SET_GPIO_PLUS_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 1, value) -+#define WWLAN_GET_GPIO_PULSE_COUNT(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 1, 7) -+#define WWLAN_SET_GPIO_PULSE_COUNT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 1, 7, value) -+#define WWLAN_SET_GPIO_PULSE_COUNT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 1, 7, value) -+#define WWLAN_GET_DISABLE_UPHY(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 8, 1) -+#define WWLAN_SET_DISABLE_UPHY(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 1, value) -+#define WWLAN_SET_DISABLE_UPHY_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 1, value) -+#define WWLAN_GET_HST2DEV_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 9, 1) -+#define WWLAN_SET_HST2DEV_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 9, 1, value) -+#define WWLAN_SET_HST2DEV_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 9, 1, value) -+#define WWLAN_GET_GPIO_DURATION_MS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X04, 10, 1) -+#define WWLAN_SET_GPIO_DURATION_MS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 10, 1, value) -+#define WWLAN_SET_GPIO_DURATION_MS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 10, 1, value) -+#define REMOTE_WAKE_CTRL_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define REMOTE_WAKE_CTRL_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define REMOTE_WAKE_CTRL_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define REMOTE_WAKE_CTRL_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define REMOTE_WAKE_CTRL_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define REMOTE_WAKE_CTRL_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define REMOTE_WAKE_CTRL_GET_REMOTE_WAKE_CTRL_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define REMOTE_WAKE_CTRL_SET_REMOTE_WAKE_CTRL_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define REMOTE_WAKE_CTRL_SET_REMOTE_WAKE_CTRL_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define REMOTE_WAKE_CTRL_GET_ARP_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 9, 1) -+#define REMOTE_WAKE_CTRL_SET_ARP_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define REMOTE_WAKE_CTRL_SET_ARP_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 9, 1, value) -+#define REMOTE_WAKE_CTRL_GET_NDP_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 10, 1) -+#define REMOTE_WAKE_CTRL_SET_NDP_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define REMOTE_WAKE_CTRL_SET_NDP_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 10, 1, value) -+#define REMOTE_WAKE_CTRL_GET_GTK_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 11, 1) -+#define REMOTE_WAKE_CTRL_SET_GTK_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define REMOTE_WAKE_CTRL_SET_GTK_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 11, 1, value) -+#define REMOTE_WAKE_CTRL_GET_NLO_OFFLOAD_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 12, 1) -+#define REMOTE_WAKE_CTRL_SET_NLO_OFFLOAD_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 12, 1, value) -+#define REMOTE_WAKE_CTRL_SET_NLO_OFFLOAD_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 12, 1, value) -+#define REMOTE_WAKE_CTRL_GET_REAL_WOW_V1_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 13, 1) -+#define REMOTE_WAKE_CTRL_SET_REAL_WOW_V1_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 13, 1, value) -+#define REMOTE_WAKE_CTRL_SET_REAL_WOW_V1_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 13, 1, value) -+#define REMOTE_WAKE_CTRL_GET_REAL_WOW_V2_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 14, 1) -+#define REMOTE_WAKE_CTRL_SET_REAL_WOW_V2_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 14, 1, value) -+#define REMOTE_WAKE_CTRL_SET_REAL_WOW_V2_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 14, 1, value) -+#define REMOTE_WAKE_CTRL_GET_FW_UNICAST(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 15, 1) -+#define REMOTE_WAKE_CTRL_SET_FW_UNICAST(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 15, 1, value) -+#define REMOTE_WAKE_CTRL_SET_FW_UNICAST_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 15, 1, value) -+#define REMOTE_WAKE_CTRL_GET_P2P_OFFLOAD_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 1) -+#define REMOTE_WAKE_CTRL_SET_P2P_OFFLOAD_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 1, value) -+#define REMOTE_WAKE_CTRL_SET_P2P_OFFLOAD_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 1, value) -+#define REMOTE_WAKE_CTRL_GET_RUNTIME_PM_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 17, 1) -+#define REMOTE_WAKE_CTRL_SET_RUNTIME_PM_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 17, 1, value) -+#define REMOTE_WAKE_CTRL_SET_RUNTIME_PM_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 17, 1, value) -+#define REMOTE_WAKE_CTRL_GET_NET_BIOS_DROP_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 18, 1) -+#define REMOTE_WAKE_CTRL_SET_NET_BIOS_DROP_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 18, 1, value) -+#define REMOTE_WAKE_CTRL_SET_NET_BIOS_DROP_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 18, 1, value) -+#define REMOTE_WAKE_CTRL_GET_ARP_ACTION(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 1) -+#define REMOTE_WAKE_CTRL_SET_ARP_ACTION(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 1, value) -+#define REMOTE_WAKE_CTRL_SET_ARP_ACTION_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 1, value) -+#define REMOTE_WAKE_CTRL_GET_TIM_PARSER_EN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 26, 1) -+#define REMOTE_WAKE_CTRL_SET_TIM_PARSER_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 26, 1, value) -+#define REMOTE_WAKE_CTRL_SET_TIM_PARSER_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 26, 1, value) -+#define REMOTE_WAKE_CTRL_GET_FW_PARSING_UNTIL_WAKEUP(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 28, 1) -+#define REMOTE_WAKE_CTRL_SET_FW_PARSING_UNTIL_WAKEUP(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 28, 1, value) -+#define REMOTE_WAKE_CTRL_SET_FW_PARSING_UNTIL_WAKEUP_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 28, 1, value) -+#define REMOTE_WAKE_CTRL_GET_FW_PARSING_AFTER_WAKEUP(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 29, 1) -+#define REMOTE_WAKE_CTRL_SET_FW_PARSING_AFTER_WAKEUP(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 29, 1, value) -+#define REMOTE_WAKE_CTRL_SET_FW_PARSING_AFTER_WAKEUP_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 29, 1, value) -+#define AOAC_GLOBAL_INFO_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define AOAC_GLOBAL_INFO_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_GLOBAL_INFO_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_GLOBAL_INFO_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define AOAC_GLOBAL_INFO_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_GLOBAL_INFO_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_GLOBAL_INFO_GET_PAIR_WISE_ENC_ALG(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define AOAC_GLOBAL_INFO_SET_PAIR_WISE_ENC_ALG(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_GLOBAL_INFO_SET_PAIR_WISE_ENC_ALG_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_GLOBAL_INFO_GET_GROUP_ENC_ALG(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define AOAC_GLOBAL_INFO_SET_GROUP_ENC_ALG(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define AOAC_GLOBAL_INFO_SET_GROUP_ENC_ALG_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define AOAC_RSVD_PAGE_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define AOAC_RSVD_PAGE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_RSVD_PAGE_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_RSVD_PAGE_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define AOAC_RSVD_PAGE_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_RSVD_PAGE_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_RSVD_PAGE_GET_LOC_REMOTE_CTRL_INFO(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_REMOTE_CTRL_INFO(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_RSVD_PAGE_SET_LOC_REMOTE_CTRL_INFO_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_ARP_RESPONSE(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_ARP_RESPONSE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define AOAC_RSVD_PAGE_SET_LOC_ARP_RESPONSE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_NEIGHBOR_ADVERTISEMENT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_NEIGHBOR_ADVERTISEMENT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define AOAC_RSVD_PAGE_SET_LOC_NEIGHBOR_ADVERTISEMENT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_GTK_RSP(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_GTK_RSP(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define AOAC_RSVD_PAGE_SET_LOC_GTK_RSP_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_GTK_INFO(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_GTK_INFO(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define AOAC_RSVD_PAGE_SET_LOC_GTK_INFO_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_GTK_EXT_MEM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 16, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_GTK_EXT_MEM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define AOAC_RSVD_PAGE_SET_LOC_GTK_EXT_MEM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_NDP_INFO(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 24, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_NDP_INFO(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define AOAC_RSVD_PAGE_SET_LOC_NDP_INFO_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define AOAC_RSVD_PAGE2_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define AOAC_RSVD_PAGE2_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_RSVD_PAGE2_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_RSVD_PAGE2_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define AOAC_RSVD_PAGE2_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_RSVD_PAGE2_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_ROUTER_SOLICATION(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_ROUTER_SOLICATION(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_RSVD_PAGE2_SET_LOC_ROUTER_SOLICATION_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_BUBBLE_PACKET(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_BUBBLE_PACKET(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define AOAC_RSVD_PAGE2_SET_LOC_BUBBLE_PACKET_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_TEREDO_INFO(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_TEREDO_INFO(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define AOAC_RSVD_PAGE2_SET_LOC_TEREDO_INFO_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_REALWOW_INFO(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 0, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_REALWOW_INFO(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define AOAC_RSVD_PAGE2_SET_LOC_REALWOW_INFO_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 0, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_KEEP_ALIVE_PKT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 8, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_KEEP_ALIVE_PKT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define AOAC_RSVD_PAGE2_SET_LOC_KEEP_ALIVE_PKT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 8, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_ACK_PATTERN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 16, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_ACK_PATTERN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define AOAC_RSVD_PAGE2_SET_LOC_ACK_PATTERN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 16, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_WAKEUP_PATTERN(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X04, 24, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_WAKEUP_PATTERN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define AOAC_RSVD_PAGE2_SET_LOC_WAKEUP_PATTERN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X04, 24, 8, value) -+#define D0_SCAN_OFFLOAD_INFO_GET_CMD_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define D0_SCAN_OFFLOAD_INFO_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define D0_SCAN_OFFLOAD_INFO_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define D0_SCAN_OFFLOAD_INFO_GET_CLASS(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define D0_SCAN_OFFLOAD_INFO_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define D0_SCAN_OFFLOAD_INFO_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define D0_SCAN_OFFLOAD_INFO_GET_LOC_CHANNEL_INFO(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define D0_SCAN_OFFLOAD_INFO_SET_LOC_CHANNEL_INFO(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define D0_SCAN_OFFLOAD_INFO_SET_LOC_CHANNEL_INFO_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define CHANNEL_SWITCH_OFFLOAD_GET_CMD_ID(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define CHANNEL_SWITCH_OFFLOAD_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define CHANNEL_SWITCH_OFFLOAD_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define CHANNEL_SWITCH_OFFLOAD_GET_CLASS(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define CHANNEL_SWITCH_OFFLOAD_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define CHANNEL_SWITCH_OFFLOAD_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define CHANNEL_SWITCH_OFFLOAD_GET_CHANNEL_NUM(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define CHANNEL_SWITCH_OFFLOAD_SET_CHANNEL_NUM(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define CHANNEL_SWITCH_OFFLOAD_SET_CHANNEL_NUM_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define CHANNEL_SWITCH_OFFLOAD_GET_EN_RFE(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define CHANNEL_SWITCH_OFFLOAD_SET_EN_RFE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define CHANNEL_SWITCH_OFFLOAD_SET_EN_RFE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define CHANNEL_SWITCH_OFFLOAD_GET_RFE_TYPE(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 24, 8) -+#define CHANNEL_SWITCH_OFFLOAD_SET_RFE_TYPE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define CHANNEL_SWITCH_OFFLOAD_SET_RFE_TYPE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 24, 8, value) -+#define AOAC_RSVD_PAGE3_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define AOAC_RSVD_PAGE3_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_RSVD_PAGE3_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_RSVD_PAGE3_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define AOAC_RSVD_PAGE3_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_RSVD_PAGE3_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_RSVD_PAGE3_GET_LOC_NLO_INFO(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 8, 8) -+#define AOAC_RSVD_PAGE3_SET_LOC_NLO_INFO(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_RSVD_PAGE3_SET_LOC_NLO_INFO_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_RSVD_PAGE3_GET_LOC_AOAC_REPORT(h2c_pkt) \ -+ GET_H2C_FIELD(h2c_pkt + 0X00, 16, 8) -+#define AOAC_RSVD_PAGE3_SET_LOC_AOAC_REPORT(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define AOAC_RSVD_PAGE3_SET_LOC_AOAC_REPORT_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 16, 8, value) -+#define DBG_MSG_CTRL_GET_CMD_ID(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 0, 5) -+#define DBG_MSG_CTRL_SET_CMD_ID(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define DBG_MSG_CTRL_SET_CMD_ID_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 0, 5, value) -+#define DBG_MSG_CTRL_GET_CLASS(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 5, 3) -+#define DBG_MSG_CTRL_SET_CLASS(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define DBG_MSG_CTRL_SET_CLASS_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 5, 3, value) -+#define DBG_MSG_CTRL_GET_FUN_EN(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 8, 1) -+#define DBG_MSG_CTRL_SET_FUN_EN(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define DBG_MSG_CTRL_SET_FUN_EN_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 8, 1, value) -+#define DBG_MSG_CTRL_GET_MODE(h2c_pkt) GET_H2C_FIELD(h2c_pkt + 0X00, 12, 4) -+#define DBG_MSG_CTRL_SET_MODE(h2c_pkt, value) \ -+ SET_H2C_FIELD_CLR(h2c_pkt + 0X00, 12, 4, value) -+#define DBG_MSG_CTRL_SET_MODE_NO_CLR(h2c_pkt, value) \ -+ SET_H2C_FIELD_NO_CLR(h2c_pkt + 0X00, 12, 4, value) -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_h2c_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_h2c_nic.h -new file mode 100644 -index 000000000..999599fb7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_original_h2c_nic.h -@@ -0,0 +1,1139 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ORIGINALH2CFORMAT_H2C_C2H_NIC_H_ -+#define _HAL_ORIGINALH2CFORMAT_H2C_C2H_NIC_H_ -+#define CMD_ID_ORIGINAL_H2C 0X00 -+#define CMD_ID_H2C2H_LB 0X0 -+#define CMD_ID_D0_SCAN_OFFLOAD_CTRL 0X06 -+#define CMD_ID_RSVD_PAGE 0X0 -+#define CMD_ID_MEDIA_STATUS_RPT 0X01 -+#define CMD_ID_KEEP_ALIVE 0X03 -+#define CMD_ID_DISCONNECT_DECISION 0X04 -+#define CMD_ID_AP_OFFLOAD 0X08 -+#define CMD_ID_BCN_RSVDPAGE 0X09 -+#define CMD_ID_PROBE_RSP_RSVDPAGE 0X0A -+#define CMD_ID_SINGLE_CHANNELSWITCH 0X1C -+#define CMD_ID_SINGLE_CHANNELSWITCH_V2 0X1D -+#define CMD_ID_SET_PWR_MODE 0X00 -+#define CMD_ID_PS_TUNING_PARA 0X01 -+#define CMD_ID_PS_TUNING_PARA_II 0X02 -+#define CMD_ID_PS_LPS_PARA 0X03 -+#define CMD_ID_P2P_PS_OFFLOAD 0X04 -+#define CMD_ID_PS_SCAN_EN 0X05 -+#define CMD_ID_SAP_PS 0X06 -+#define CMD_ID_INACTIVE_PS 0X07 -+#define CMD_ID_MACID_CFG 0X00 -+#define CMD_ID_TXBF 0X01 -+#define CMD_ID_RSSI_SETTING 0X02 -+#define CMD_ID_AP_REQ_TXRPT 0X03 -+#define CMD_ID_INIT_RATE_COLLECTION 0X04 -+#define CMD_ID_IQK_OFFLOAD 0X05 -+#define CMD_ID_MACID_CFG_3SS 0X06 -+#define CMD_ID_RA_PARA_ADJUST 0X07 -+#define CMD_ID_REQ_TXRPT_ACQ 0X12 -+#define CMD_ID_WWLAN 0X00 -+#define CMD_ID_REMOTE_WAKE_CTRL 0X01 -+#define CMD_ID_AOAC_GLOBAL_INFO 0X02 -+#define CMD_ID_AOAC_RSVD_PAGE 0X03 -+#define CMD_ID_AOAC_RSVD_PAGE2 0X04 -+#define CMD_ID_D0_SCAN_OFFLOAD_INFO 0X05 -+#define CMD_ID_CHANNEL_SWITCH_OFFLOAD 0X07 -+#define CMD_ID_AOAC_RSVD_PAGE3 0X08 -+#define CMD_ID_DBG_MSG_CTRL 0X1E -+#define CLASS_ORIGINAL_H2C 0X00 -+#define CLASS_H2C2H_LB 0X07 -+#define CLASS_D0_SCAN_OFFLOAD_CTRL 0X04 -+#define CLASS_RSVD_PAGE 0X0 -+#define CLASS_MEDIA_STATUS_RPT 0X0 -+#define CLASS_KEEP_ALIVE 0X0 -+#define CLASS_DISCONNECT_DECISION 0X0 -+#define CLASS_AP_OFFLOAD 0X0 -+#define CLASS_BCN_RSVDPAGE 0X0 -+#define CLASS_PROBE_RSP_RSVDPAGE 0X0 -+#define CLASS_SINGLE_CHANNELSWITCH 0X0 -+#define CLASS_SINGLE_CHANNELSWITCH_V2 0X0 -+#define CLASS_SET_PWR_MODE 0X01 -+#define CLASS_PS_TUNING_PARA 0X01 -+#define CLASS_PS_TUNING_PARA_II 0X01 -+#define CLASS_PS_LPS_PARA 0X01 -+#define CLASS_P2P_PS_OFFLOAD 0X01 -+#define CLASS_PS_SCAN_EN 0X1 -+#define CLASS_SAP_PS 0X1 -+#define CLASS_INACTIVE_PS 0X1 -+#define CLASS_MACID_CFG 0X2 -+#define CLASS_TXBF 0X2 -+#define CLASS_RSSI_SETTING 0X2 -+#define CLASS_AP_REQ_TXRPT 0X2 -+#define CLASS_INIT_RATE_COLLECTION 0X2 -+#define CLASS_IQK_OFFLOAD 0X2 -+#define CLASS_MACID_CFG_3SS 0X2 -+#define CLASS_RA_PARA_ADJUST 0X02 -+#define CLASS_REQ_TXRPT_ACQ 0X02 -+#define CLASS_WWLAN 0X4 -+#define CLASS_REMOTE_WAKE_CTRL 0X4 -+#define CLASS_AOAC_GLOBAL_INFO 0X04 -+#define CLASS_AOAC_RSVD_PAGE 0X04 -+#define CLASS_AOAC_RSVD_PAGE2 0X04 -+#define CLASS_D0_SCAN_OFFLOAD_INFO 0X04 -+#define CLASS_CHANNEL_SWITCH_OFFLOAD 0X04 -+#define CLASS_AOAC_RSVD_PAGE3 0X04 -+#define CLASS_DBG_MSG_CTRL 0X07 -+#define ORIGINAL_H2C_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define ORIGINAL_H2C_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define ORIGINAL_H2C_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define ORIGINAL_H2C_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define H2C2H_LB_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define H2C2H_LB_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define H2C2H_LB_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define H2C2H_LB_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define H2C2H_LB_GET_SEQ(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define H2C2H_LB_SET_SEQ(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define H2C2H_LB_GET_PAYLOAD1(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 16) -+#define H2C2H_LB_SET_PAYLOAD1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 16, value) -+#define H2C2H_LB_GET_PAYLOAD2(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 32) -+#define H2C2H_LB_SET_PAYLOAD2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 32, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define D0_SCAN_OFFLOAD_CTRL_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define D0_SCAN_OFFLOAD_CTRL_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_D0_SCAN_FUN_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define D0_SCAN_OFFLOAD_CTRL_SET_D0_SCAN_FUN_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_RTD3FUN_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 9, 1) -+#define D0_SCAN_OFFLOAD_CTRL_SET_RTD3FUN_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 9, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_U3_SCAN_FUN_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 10, 1) -+#define D0_SCAN_OFFLOAD_CTRL_SET_U3_SCAN_FUN_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 10, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_NLO_FUN_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 11, 1) -+#define D0_SCAN_OFFLOAD_CTRL_SET_NLO_FUN_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 11, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_IPS_DEPENDENT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 12, 1) -+#define D0_SCAN_OFFLOAD_CTRL_SET_IPS_DEPENDENT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 12, 1, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_LOC_PROBE_PACKET(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 17) -+#define D0_SCAN_OFFLOAD_CTRL_SET_LOC_PROBE_PACKET(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 17, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_LOC_SCAN_INFO(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define D0_SCAN_OFFLOAD_CTRL_SET_LOC_SCAN_INFO(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define D0_SCAN_OFFLOAD_CTRL_GET_LOC_SSID_INFO(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define D0_SCAN_OFFLOAD_CTRL_SET_LOC_SSID_INFO(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define RSVD_PAGE_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define RSVD_PAGE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define RSVD_PAGE_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define RSVD_PAGE_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define RSVD_PAGE_GET_LOC_PROBE_RSP(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define RSVD_PAGE_SET_LOC_PROBE_RSP(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define RSVD_PAGE_GET_LOC_PS_POLL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define RSVD_PAGE_SET_LOC_PS_POLL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define RSVD_PAGE_GET_LOC_NULL_DATA(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define RSVD_PAGE_SET_LOC_NULL_DATA(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define RSVD_PAGE_GET_LOC_QOS_NULL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define RSVD_PAGE_SET_LOC_QOS_NULL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define RSVD_PAGE_GET_LOC_BT_QOS_NULL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define RSVD_PAGE_SET_LOC_BT_QOS_NULL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define RSVD_PAGE_GET_LOC_CTS2SELF(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 16, 8) -+#define RSVD_PAGE_SET_LOC_CTS2SELF(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 16, 8, value) -+#define RSVD_PAGE_GET_LOC_LTECOEX_QOSNULL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 24, 8) -+#define RSVD_PAGE_SET_LOC_LTECOEX_QOSNULL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 24, 8, value) -+#define MEDIA_STATUS_RPT_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define MEDIA_STATUS_RPT_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define MEDIA_STATUS_RPT_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define MEDIA_STATUS_RPT_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define MEDIA_STATUS_RPT_GET_OP_MODE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define MEDIA_STATUS_RPT_SET_OP_MODE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define MEDIA_STATUS_RPT_GET_MACID_IN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 9, 1) -+#define MEDIA_STATUS_RPT_SET_MACID_IN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 9, 1, value) -+#define MEDIA_STATUS_RPT_GET_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define MEDIA_STATUS_RPT_SET_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define MEDIA_STATUS_RPT_GET_MACID_END(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define MEDIA_STATUS_RPT_SET_MACID_END(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define KEEP_ALIVE_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define KEEP_ALIVE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define KEEP_ALIVE_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define KEEP_ALIVE_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define KEEP_ALIVE_GET_ENABLE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define KEEP_ALIVE_SET_ENABLE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define KEEP_ALIVE_GET_ADOPT_USER_SETTING(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 9, 1) -+#define KEEP_ALIVE_SET_ADOPT_USER_SETTING(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 9, 1, value) -+#define KEEP_ALIVE_GET_PKT_TYPE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 10, 1) -+#define KEEP_ALIVE_SET_PKT_TYPE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 10, 1, value) -+#define KEEP_ALIVE_GET_KEEP_ALIVE_CHECK_PERIOD(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define KEEP_ALIVE_SET_KEEP_ALIVE_CHECK_PERIOD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define DISCONNECT_DECISION_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define DISCONNECT_DECISION_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define DISCONNECT_DECISION_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define DISCONNECT_DECISION_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define DISCONNECT_DECISION_GET_ENABLE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define DISCONNECT_DECISION_SET_ENABLE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define DISCONNECT_DECISION_GET_ADOPT_USER_SETTING(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 9, 1) -+#define DISCONNECT_DECISION_SET_ADOPT_USER_SETTING(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 9, 1, value) -+#define DISCONNECT_DECISION_GET_TRY_OK_BCN_FAIL_COUNT_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 10, 1) -+#define DISCONNECT_DECISION_SET_TRY_OK_BCN_FAIL_COUNT_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 10, 1, value) -+#define DISCONNECT_DECISION_GET_DISCONNECT_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 11, 1) -+#define DISCONNECT_DECISION_SET_DISCONNECT_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 11, 1, value) -+#define DISCONNECT_DECISION_GET_DISCON_DECISION_CHECK_PERIOD(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define DISCONNECT_DECISION_SET_DISCON_DECISION_CHECK_PERIOD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define DISCONNECT_DECISION_GET_TRY_PKT_NUM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define DISCONNECT_DECISION_SET_TRY_PKT_NUM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define DISCONNECT_DECISION_GET_TRY_OK_BCN_FAIL_COUNT_LIMIT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define DISCONNECT_DECISION_SET_TRY_OK_BCN_FAIL_COUNT_LIMIT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define AP_OFFLOAD_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define AP_OFFLOAD_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define AP_OFFLOAD_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define AP_OFFLOAD_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define AP_OFFLOAD_GET_ON(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define AP_OFFLOAD_SET_ON(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define AP_OFFLOAD_GET_CFG_MIFI_PLATFORM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 9, 1) -+#define AP_OFFLOAD_SET_CFG_MIFI_PLATFORM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 9, 1, value) -+#define AP_OFFLOAD_GET_LINKED(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 10, 1) -+#define AP_OFFLOAD_SET_LINKED(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 10, 1, value) -+#define AP_OFFLOAD_GET_EN_AUTO_WAKE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 11, 1) -+#define AP_OFFLOAD_SET_EN_AUTO_WAKE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 11, 1, value) -+#define AP_OFFLOAD_GET_WAKE_FLAG(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 12, 1) -+#define AP_OFFLOAD_SET_WAKE_FLAG(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 12, 1, value) -+#define AP_OFFLOAD_GET_HIDDEN_ROOT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 1) -+#define AP_OFFLOAD_SET_HIDDEN_ROOT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 1, value) -+#define AP_OFFLOAD_GET_HIDDEN_VAP1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 17, 1) -+#define AP_OFFLOAD_SET_HIDDEN_VAP1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 17, 1, value) -+#define AP_OFFLOAD_GET_HIDDEN_VAP2(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 18, 1) -+#define AP_OFFLOAD_SET_HIDDEN_VAP2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 18, 1, value) -+#define AP_OFFLOAD_GET_HIDDEN_VAP3(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 19, 1) -+#define AP_OFFLOAD_SET_HIDDEN_VAP3(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 19, 1, value) -+#define AP_OFFLOAD_GET_HIDDEN_VAP4(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 20, 1) -+#define AP_OFFLOAD_SET_HIDDEN_VAP4(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 20, 1, value) -+#define AP_OFFLOAD_GET_DENYANY_ROOT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 1) -+#define AP_OFFLOAD_SET_DENYANY_ROOT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 1, value) -+#define AP_OFFLOAD_GET_DENYANY_VAP1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 25, 1) -+#define AP_OFFLOAD_SET_DENYANY_VAP1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 25, 1, value) -+#define AP_OFFLOAD_GET_DENYANY_VAP2(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 26, 1) -+#define AP_OFFLOAD_SET_DENYANY_VAP2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 26, 1, value) -+#define AP_OFFLOAD_GET_DENYANY_VAP3(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 27, 1) -+#define AP_OFFLOAD_SET_DENYANY_VAP3(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 27, 1, value) -+#define AP_OFFLOAD_GET_DENYANY_VAP4(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 28, 1) -+#define AP_OFFLOAD_SET_DENYANY_VAP4(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 28, 1, value) -+#define AP_OFFLOAD_GET_WAIT_TBTT_CNT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define AP_OFFLOAD_SET_WAIT_TBTT_CNT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define AP_OFFLOAD_GET_WAKE_TIMEOUT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define AP_OFFLOAD_SET_WAKE_TIMEOUT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define AP_OFFLOAD_GET_LEN_IV_PAIR(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 16, 8) -+#define AP_OFFLOAD_SET_LEN_IV_PAIR(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 16, 8, value) -+#define AP_OFFLOAD_GET_LEN_IV_GRP(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 24, 8) -+#define AP_OFFLOAD_SET_LEN_IV_GRP(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 24, 8, value) -+#define BCN_RSVDPAGE_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define BCN_RSVDPAGE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define BCN_RSVDPAGE_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define BCN_RSVDPAGE_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define BCN_RSVDPAGE_GET_LOC_ROOT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define BCN_RSVDPAGE_SET_LOC_ROOT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define BCN_RSVDPAGE_GET_LOC_VAP1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define BCN_RSVDPAGE_SET_LOC_VAP1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define BCN_RSVDPAGE_GET_LOC_VAP2(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define BCN_RSVDPAGE_SET_LOC_VAP2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define BCN_RSVDPAGE_GET_LOC_VAP3(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define BCN_RSVDPAGE_SET_LOC_VAP3(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define BCN_RSVDPAGE_GET_LOC_VAP4(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define BCN_RSVDPAGE_SET_LOC_VAP4(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define PROBE_RSP_RSVDPAGE_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define PROBE_RSP_RSVDPAGE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define PROBE_RSP_RSVDPAGE_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define PROBE_RSP_RSVDPAGE_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define PROBE_RSP_RSVDPAGE_GET_LOC_ROOT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_ROOT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define PROBE_RSP_RSVDPAGE_GET_LOC_VAP1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define PROBE_RSP_RSVDPAGE_GET_LOC_VAP2(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP2(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define PROBE_RSP_RSVDPAGE_GET_LOC_VAP3(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP3(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define PROBE_RSP_RSVDPAGE_GET_LOC_VAP4(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define PROBE_RSP_RSVDPAGE_SET_LOC_VAP4(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define SINGLE_CHANNELSWITCH_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define SINGLE_CHANNELSWITCH_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define SINGLE_CHANNELSWITCH_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define SINGLE_CHANNELSWITCH_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define SINGLE_CHANNELSWITCH_GET_CHANNEL_NUM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define SINGLE_CHANNELSWITCH_SET_CHANNEL_NUM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define SINGLE_CHANNELSWITCH_GET_BW(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 2) -+#define SINGLE_CHANNELSWITCH_SET_BW(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 2, value) -+#define SINGLE_CHANNELSWITCH_GET_BW40SC(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 18, 3) -+#define SINGLE_CHANNELSWITCH_SET_BW40SC(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 18, 3, value) -+#define SINGLE_CHANNELSWITCH_GET_BW80SC(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 21, 3) -+#define SINGLE_CHANNELSWITCH_SET_BW80SC(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 21, 3, value) -+#define SINGLE_CHANNELSWITCH_GET_RFE_TYPE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 4) -+#define SINGLE_CHANNELSWITCH_SET_RFE_TYPE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 4, value) -+#define SINGLE_CHANNELSWITCH_V2_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define SINGLE_CHANNELSWITCH_V2_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define SINGLE_CHANNELSWITCH_V2_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define SINGLE_CHANNELSWITCH_V2_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define SINGLE_CHANNELSWITCH_V2_GET_CENTRAL_CH(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define SINGLE_CHANNELSWITCH_V2_SET_CENTRAL_CH(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define SINGLE_CHANNELSWITCH_V2_GET_PRIMARY_CH_IDX(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 4) -+#define SINGLE_CHANNELSWITCH_V2_SET_PRIMARY_CH_IDX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 4, value) -+#define SINGLE_CHANNELSWITCH_V2_GET_BW(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 20, 4) -+#define SINGLE_CHANNELSWITCH_V2_SET_BW(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 20, 4, value) -+#define SET_PWR_MODE_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define SET_PWR_MODE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define SET_PWR_MODE_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define SET_PWR_MODE_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define SET_PWR_MODE_GET_MODE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 7) -+#define SET_PWR_MODE_SET_MODE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 7, value) -+#define SET_PWR_MODE_GET_CLK_REQUEST(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 15, 1) -+#define SET_PWR_MODE_SET_CLK_REQUEST(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 15, 1, value) -+#define SET_PWR_MODE_GET_RLBM(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 4) -+#define SET_PWR_MODE_SET_RLBM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 4, value) -+#define SET_PWR_MODE_GET_SMART_PS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 20, 4) -+#define SET_PWR_MODE_SET_SMART_PS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 20, 4, value) -+#define SET_PWR_MODE_GET_AWAKE_INTERVAL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define SET_PWR_MODE_SET_AWAKE_INTERVAL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define SET_PWR_MODE_GET_B_ALL_QUEUE_UAPSD(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 1) -+#define SET_PWR_MODE_SET_B_ALL_QUEUE_UAPSD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 1, value) -+#define SET_PWR_MODE_GET_BCN_EARLY_RPT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 2, 1) -+#define SET_PWR_MODE_SET_BCN_EARLY_RPT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 2, 1, value) -+#define SET_PWR_MODE_GET_PORT_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 5, 3) -+#define SET_PWR_MODE_SET_PORT_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 5, 3, value) -+#define SET_PWR_MODE_GET_PWR_STATE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define SET_PWR_MODE_SET_PWR_STATE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define SET_PWR_MODE_GET_RSVD_NOUSED(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 16, 8) -+#define SET_PWR_MODE_SET_RSVD_NOUSED(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 16, 8, value) -+#define SET_PWR_MODE_GET_BCN_RECEIVING_TIME(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 24, 5) -+#define SET_PWR_MODE_SET_BCN_RECEIVING_TIME(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 24, 5, value) -+#define SET_PWR_MODE_GET_BCN_LISTEN_INTERVAL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 29, 2) -+#define SET_PWR_MODE_SET_BCN_LISTEN_INTERVAL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 29, 2, value) -+#define SET_PWR_MODE_GET_ADOPT_BCN_RECEIVING_TIME(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 31, 1) -+#define SET_PWR_MODE_SET_ADOPT_BCN_RECEIVING_TIME(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 31, 1, value) -+#define PS_TUNING_PARA_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define PS_TUNING_PARA_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define PS_TUNING_PARA_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define PS_TUNING_PARA_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define PS_TUNING_PARA_GET_BCN_TO_LIMIT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 7) -+#define PS_TUNING_PARA_SET_BCN_TO_LIMIT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 7, value) -+#define PS_TUNING_PARA_GET_DTIM_TIME_OUT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 15, 1) -+#define PS_TUNING_PARA_SET_DTIM_TIME_OUT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 15, 1, value) -+#define PS_TUNING_PARA_GET_PS_TIME_OUT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 4) -+#define PS_TUNING_PARA_SET_PS_TIME_OUT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 4, value) -+#define PS_TUNING_PARA_GET_ADOPT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define PS_TUNING_PARA_SET_ADOPT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define PS_TUNING_PARA_II_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define PS_TUNING_PARA_II_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define PS_TUNING_PARA_II_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define PS_TUNING_PARA_II_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define PS_TUNING_PARA_II_GET_BCN_TO_PERIOD(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 7) -+#define PS_TUNING_PARA_II_SET_BCN_TO_PERIOD(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 7, value) -+#define PS_TUNING_PARA_II_GET_ADOPT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 15, 1) -+#define PS_TUNING_PARA_II_SET_ADOPT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 15, 1, value) -+#define PS_TUNING_PARA_II_GET_DRV_EARLY_IVL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define PS_TUNING_PARA_II_SET_DRV_EARLY_IVL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define PS_LPS_PARA_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define PS_LPS_PARA_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define PS_LPS_PARA_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define PS_LPS_PARA_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define PS_LPS_PARA_GET_LPS_CONTROL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define PS_LPS_PARA_SET_LPS_CONTROL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define P2P_PS_OFFLOAD_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define P2P_PS_OFFLOAD_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define P2P_PS_OFFLOAD_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define P2P_PS_OFFLOAD_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define P2P_PS_OFFLOAD_GET_OFFLOAD_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define P2P_PS_OFFLOAD_SET_OFFLOAD_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define P2P_PS_OFFLOAD_GET_ROLE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 9, 1) -+#define P2P_PS_OFFLOAD_SET_ROLE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 9, 1, value) -+#define P2P_PS_OFFLOAD_GET_CTWINDOW_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 10, 1) -+#define P2P_PS_OFFLOAD_SET_CTWINDOW_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 10, 1, value) -+#define P2P_PS_OFFLOAD_GET_NOA0_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 11, 1) -+#define P2P_PS_OFFLOAD_SET_NOA0_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 11, 1, value) -+#define P2P_PS_OFFLOAD_GET_NOA1_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 12, 1) -+#define P2P_PS_OFFLOAD_SET_NOA1_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 12, 1, value) -+#define P2P_PS_OFFLOAD_GET_ALL_STA_SLEEP(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 13, 1) -+#define P2P_PS_OFFLOAD_SET_ALL_STA_SLEEP(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 13, 1, value) -+#define P2P_PS_OFFLOAD_GET_DISCOVERY(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 14, 1) -+#define P2P_PS_OFFLOAD_SET_DISCOVERY(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 14, 1, value) -+#define PS_SCAN_EN_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define PS_SCAN_EN_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define PS_SCAN_EN_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define PS_SCAN_EN_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define PS_SCAN_EN_GET_ENABLE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define PS_SCAN_EN_SET_ENABLE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define SAP_PS_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define SAP_PS_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define SAP_PS_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define SAP_PS_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define SAP_PS_GET_ENABLE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define SAP_PS_SET_ENABLE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define SAP_PS_GET_EN_PS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 9, 1) -+#define SAP_PS_SET_EN_PS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 9, 1, value) -+#define SAP_PS_GET_EN_LP_RX(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 10, 1) -+#define SAP_PS_SET_EN_LP_RX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 10, 1, value) -+#define SAP_PS_GET_MANUAL_32K(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 11, 1) -+#define SAP_PS_SET_MANUAL_32K(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 11, 1, value) -+#define SAP_PS_GET_DURATION(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define SAP_PS_SET_DURATION(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define INACTIVE_PS_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define INACTIVE_PS_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define INACTIVE_PS_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define INACTIVE_PS_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define INACTIVE_PS_GET_ENABLE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define INACTIVE_PS_SET_ENABLE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define INACTIVE_PS_GET_IGNORE_PS_CONDITION(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 9, 1) -+#define INACTIVE_PS_SET_IGNORE_PS_CONDITION(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 9, 1, value) -+#define INACTIVE_PS_GET_FREQUENCY(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define INACTIVE_PS_SET_FREQUENCY(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define INACTIVE_PS_GET_DURATION(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define INACTIVE_PS_SET_DURATION(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define MACID_CFG_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define MACID_CFG_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define MACID_CFG_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define MACID_CFG_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define MACID_CFG_GET_MAC_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define MACID_CFG_SET_MAC_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define MACID_CFG_GET_RATE_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 5) -+#define MACID_CFG_SET_RATE_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 5, value) -+#define MACID_CFG_GET_INIT_RATE_LV(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 21, 2) -+#define MACID_CFG_SET_INIT_RATE_LV(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 21, 2, value) -+#define MACID_CFG_GET_SGI(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 23, 1) -+#define MACID_CFG_SET_SGI(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 23, 1, value) -+#define MACID_CFG_GET_BW(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 2) -+#define MACID_CFG_SET_BW(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 2, value) -+#define MACID_CFG_GET_LDPC_CAP(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 26, 1) -+#define MACID_CFG_SET_LDPC_CAP(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 26, 1, value) -+#define MACID_CFG_GET_NO_UPDATE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 27, 1) -+#define MACID_CFG_SET_NO_UPDATE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 27, 1, value) -+#define MACID_CFG_GET_WHT_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 28, 2) -+#define MACID_CFG_SET_WHT_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 28, 2, value) -+#define MACID_CFG_GET_DISPT(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 30, 1) -+#define MACID_CFG_SET_DISPT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 30, 1, value) -+#define MACID_CFG_GET_DISRA(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 31, 1) -+#define MACID_CFG_SET_DISRA(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 31, 1, value) -+#define MACID_CFG_GET_RATE_MASK7_0(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define MACID_CFG_SET_RATE_MASK7_0(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define MACID_CFG_GET_RATE_MASK15_8(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define MACID_CFG_SET_RATE_MASK15_8(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define MACID_CFG_GET_RATE_MASK23_16(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 16, 8) -+#define MACID_CFG_SET_RATE_MASK23_16(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 16, 8, value) -+#define MACID_CFG_GET_RATE_MASK31_24(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 24, 8) -+#define MACID_CFG_SET_RATE_MASK31_24(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 24, 8, value) -+#define TXBF_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define TXBF_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define TXBF_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define TXBF_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define TXBF_GET_NDPA0_HEAD_PAGE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define TXBF_SET_NDPA0_HEAD_PAGE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define TXBF_GET_NDPA1_HEAD_PAGE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define TXBF_SET_NDPA1_HEAD_PAGE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define TXBF_GET_PERIOD_0(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define TXBF_SET_PERIOD_0(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define RSSI_SETTING_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define RSSI_SETTING_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define RSSI_SETTING_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define RSSI_SETTING_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define RSSI_SETTING_GET_MAC_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define RSSI_SETTING_SET_MAC_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define RSSI_SETTING_GET_RSSI(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 7) -+#define RSSI_SETTING_SET_RSSI(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 7, value) -+#define RSSI_SETTING_GET_RA_INFO(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define RSSI_SETTING_SET_RA_INFO(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define AP_REQ_TXRPT_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define AP_REQ_TXRPT_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define AP_REQ_TXRPT_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define AP_REQ_TXRPT_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define AP_REQ_TXRPT_GET_STA1_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define AP_REQ_TXRPT_SET_STA1_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define AP_REQ_TXRPT_GET_STA2_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define AP_REQ_TXRPT_SET_STA2_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define AP_REQ_TXRPT_GET_RTY_OK_TOTAL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 1) -+#define AP_REQ_TXRPT_SET_RTY_OK_TOTAL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 1, value) -+#define AP_REQ_TXRPT_GET_RTY_CNT_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 25, 1) -+#define AP_REQ_TXRPT_SET_RTY_CNT_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 25, 1, value) -+#define INIT_RATE_COLLECTION_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define INIT_RATE_COLLECTION_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define INIT_RATE_COLLECTION_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define INIT_RATE_COLLECTION_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define INIT_RATE_COLLECTION_GET_STA1_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define INIT_RATE_COLLECTION_SET_STA1_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA2_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define INIT_RATE_COLLECTION_SET_STA2_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA3_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define INIT_RATE_COLLECTION_SET_STA3_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA4_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define INIT_RATE_COLLECTION_SET_STA4_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA5_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define INIT_RATE_COLLECTION_SET_STA5_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA6_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 16, 8) -+#define INIT_RATE_COLLECTION_SET_STA6_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 16, 8, value) -+#define INIT_RATE_COLLECTION_GET_STA7_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 24, 8) -+#define INIT_RATE_COLLECTION_SET_STA7_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 24, 8, value) -+#define IQK_OFFLOAD_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define IQK_OFFLOAD_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define IQK_OFFLOAD_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define IQK_OFFLOAD_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define IQK_OFFLOAD_GET_CHANNEL(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define IQK_OFFLOAD_SET_CHANNEL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define IQK_OFFLOAD_GET_BWBAND(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define IQK_OFFLOAD_SET_BWBAND(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define IQK_OFFLOAD_GET_EXTPALNA(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define IQK_OFFLOAD_SET_EXTPALNA(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define MACID_CFG_3SS_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define MACID_CFG_3SS_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define MACID_CFG_3SS_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define MACID_CFG_3SS_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define MACID_CFG_3SS_GET_MACID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define MACID_CFG_3SS_SET_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define MACID_CFG_3SS_GET_RATE_MASK_39_32(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define MACID_CFG_3SS_SET_RATE_MASK_39_32(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define MACID_CFG_3SS_GET_RATE_MASK_47_40(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define MACID_CFG_3SS_SET_RATE_MASK_47_40(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define RA_PARA_ADJUST_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define RA_PARA_ADJUST_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define RA_PARA_ADJUST_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define RA_PARA_ADJUST_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define RA_PARA_ADJUST_GET_MAC_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define RA_PARA_ADJUST_SET_MAC_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define RA_PARA_ADJUST_GET_PARAMETER_INDEX(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define RA_PARA_ADJUST_SET_PARAMETER_INDEX(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define RA_PARA_ADJUST_GET_RATE_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define RA_PARA_ADJUST_SET_RATE_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define RA_PARA_ADJUST_GET_VALUE_BYTE0(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define RA_PARA_ADJUST_SET_VALUE_BYTE0(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define RA_PARA_ADJUST_GET_VALUE_BYTE1(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define RA_PARA_ADJUST_SET_VALUE_BYTE1(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define RA_PARA_ADJUST_GET_ASK_FW_FOR_FW_PARA(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 16, 8) -+#define RA_PARA_ADJUST_SET_ASK_FW_FOR_FW_PARA(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 16, 8, value) -+#define REQ_TXRPT_ACQ_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define REQ_TXRPT_ACQ_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define REQ_TXRPT_ACQ_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define REQ_TXRPT_ACQ_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define REQ_TXRPT_ACQ_GET_STA1_MACID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define REQ_TXRPT_ACQ_SET_STA1_MACID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define REQ_TXRPT_ACQ_GET_PASS_DROP_SEL(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define REQ_TXRPT_ACQ_SET_PASS_DROP_SEL(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define WWLAN_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define WWLAN_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define WWLAN_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define WWLAN_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define WWLAN_GET_FUNC_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define WWLAN_SET_FUNC_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define WWLAN_GET_PATTERM_MAT_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 9, 1) -+#define WWLAN_SET_PATTERM_MAT_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 9, 1, value) -+#define WWLAN_GET_MAGIC_PKT_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 10, 1) -+#define WWLAN_SET_MAGIC_PKT_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 10, 1, value) -+#define WWLAN_GET_UNICAST_WAKEUP_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 11, 1) -+#define WWLAN_SET_UNICAST_WAKEUP_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 11, 1, value) -+#define WWLAN_GET_ALL_PKT_DROP(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 12, 1) -+#define WWLAN_SET_ALL_PKT_DROP(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 12, 1, value) -+#define WWLAN_GET_GPIO_ACTIVE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 13, 1) -+#define WWLAN_SET_GPIO_ACTIVE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 13, 1, value) -+#define WWLAN_GET_REKEY_WAKEUP_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 14, 1) -+#define WWLAN_SET_REKEY_WAKEUP_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 14, 1, value) -+#define WWLAN_GET_DEAUTH_WAKEUP_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 15, 1) -+#define WWLAN_SET_DEAUTH_WAKEUP_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 15, 1, value) -+#define WWLAN_GET_GPIO_NUM(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 7) -+#define WWLAN_SET_GPIO_NUM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 7, value) -+#define WWLAN_GET_DATAPIN_WAKEUP_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 23, 1) -+#define WWLAN_SET_DATAPIN_WAKEUP_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 23, 1, value) -+#define WWLAN_GET_GPIO_DURATION(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define WWLAN_SET_GPIO_DURATION(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define WWLAN_GET_GPIO_PLUS_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 1) -+#define WWLAN_SET_GPIO_PLUS_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 1, value) -+#define WWLAN_GET_GPIO_PULSE_COUNT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 1, 7) -+#define WWLAN_SET_GPIO_PULSE_COUNT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 1, 7, value) -+#define WWLAN_GET_DISABLE_UPHY(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 1) -+#define WWLAN_SET_DISABLE_UPHY(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 1, value) -+#define WWLAN_GET_HST2DEV_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 9, 1) -+#define WWLAN_SET_HST2DEV_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 9, 1, value) -+#define WWLAN_GET_GPIO_DURATION_MS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 10, 1) -+#define WWLAN_SET_GPIO_DURATION_MS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 10, 1, value) -+#define REMOTE_WAKE_CTRL_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define REMOTE_WAKE_CTRL_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define REMOTE_WAKE_CTRL_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define REMOTE_WAKE_CTRL_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define REMOTE_WAKE_CTRL_GET_REMOTE_WAKE_CTRL_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define REMOTE_WAKE_CTRL_SET_REMOTE_WAKE_CTRL_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define REMOTE_WAKE_CTRL_GET_ARP_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 9, 1) -+#define REMOTE_WAKE_CTRL_SET_ARP_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 9, 1, value) -+#define REMOTE_WAKE_CTRL_GET_NDP_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 10, 1) -+#define REMOTE_WAKE_CTRL_SET_NDP_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 10, 1, value) -+#define REMOTE_WAKE_CTRL_GET_GTK_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 11, 1) -+#define REMOTE_WAKE_CTRL_SET_GTK_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 11, 1, value) -+#define REMOTE_WAKE_CTRL_GET_NLO_OFFLOAD_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 12, 1) -+#define REMOTE_WAKE_CTRL_SET_NLO_OFFLOAD_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 12, 1, value) -+#define REMOTE_WAKE_CTRL_GET_REAL_WOW_V1_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 13, 1) -+#define REMOTE_WAKE_CTRL_SET_REAL_WOW_V1_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 13, 1, value) -+#define REMOTE_WAKE_CTRL_GET_REAL_WOW_V2_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 14, 1) -+#define REMOTE_WAKE_CTRL_SET_REAL_WOW_V2_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 14, 1, value) -+#define REMOTE_WAKE_CTRL_GET_FW_UNICAST(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 15, 1) -+#define REMOTE_WAKE_CTRL_SET_FW_UNICAST(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 15, 1, value) -+#define REMOTE_WAKE_CTRL_GET_P2P_OFFLOAD_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 1) -+#define REMOTE_WAKE_CTRL_SET_P2P_OFFLOAD_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 1, value) -+#define REMOTE_WAKE_CTRL_GET_RUNTIME_PM_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 17, 1) -+#define REMOTE_WAKE_CTRL_SET_RUNTIME_PM_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 17, 1, value) -+#define REMOTE_WAKE_CTRL_GET_NET_BIOS_DROP_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 18, 1) -+#define REMOTE_WAKE_CTRL_SET_NET_BIOS_DROP_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 18, 1, value) -+#define REMOTE_WAKE_CTRL_GET_ARP_ACTION(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 1) -+#define REMOTE_WAKE_CTRL_SET_ARP_ACTION(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 1, value) -+#define REMOTE_WAKE_CTRL_GET_TIM_PARSER_EN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 26, 1) -+#define REMOTE_WAKE_CTRL_SET_TIM_PARSER_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 26, 1, value) -+#define REMOTE_WAKE_CTRL_GET_FW_PARSING_UNTIL_WAKEUP(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 28, 1) -+#define REMOTE_WAKE_CTRL_SET_FW_PARSING_UNTIL_WAKEUP(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 28, 1, value) -+#define REMOTE_WAKE_CTRL_GET_FW_PARSING_AFTER_WAKEUP(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 29, 1) -+#define REMOTE_WAKE_CTRL_SET_FW_PARSING_AFTER_WAKEUP(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 29, 1, value) -+#define AOAC_GLOBAL_INFO_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define AOAC_GLOBAL_INFO_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_GLOBAL_INFO_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define AOAC_GLOBAL_INFO_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_GLOBAL_INFO_GET_PAIR_WISE_ENC_ALG(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define AOAC_GLOBAL_INFO_SET_PAIR_WISE_ENC_ALG(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_GLOBAL_INFO_GET_GROUP_ENC_ALG(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define AOAC_GLOBAL_INFO_SET_GROUP_ENC_ALG(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define AOAC_RSVD_PAGE_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define AOAC_RSVD_PAGE_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_RSVD_PAGE_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define AOAC_RSVD_PAGE_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_RSVD_PAGE_GET_LOC_REMOTE_CTRL_INFO(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_REMOTE_CTRL_INFO(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_ARP_RESPONSE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_ARP_RESPONSE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_NEIGHBOR_ADVERTISEMENT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_NEIGHBOR_ADVERTISEMENT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_GTK_RSP(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_GTK_RSP(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_GTK_INFO(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_GTK_INFO(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_GTK_EXT_MEM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 16, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_GTK_EXT_MEM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 16, 8, value) -+#define AOAC_RSVD_PAGE_GET_LOC_NDP_INFO(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 24, 8) -+#define AOAC_RSVD_PAGE_SET_LOC_NDP_INFO(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 24, 8, value) -+#define AOAC_RSVD_PAGE2_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define AOAC_RSVD_PAGE2_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_RSVD_PAGE2_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define AOAC_RSVD_PAGE2_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_ROUTER_SOLICATION(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_ROUTER_SOLICATION(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_BUBBLE_PACKET(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_BUBBLE_PACKET(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_TEREDO_INFO(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_TEREDO_INFO(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_REALWOW_INFO(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 0, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_REALWOW_INFO(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 0, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_KEEP_ALIVE_PKT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 8, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_KEEP_ALIVE_PKT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 8, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_ACK_PATTERN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 16, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_ACK_PATTERN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 16, 8, value) -+#define AOAC_RSVD_PAGE2_GET_LOC_WAKEUP_PATTERN(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X04, 24, 8) -+#define AOAC_RSVD_PAGE2_SET_LOC_WAKEUP_PATTERN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 24, 8, value) -+#define D0_SCAN_OFFLOAD_INFO_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define D0_SCAN_OFFLOAD_INFO_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define D0_SCAN_OFFLOAD_INFO_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define D0_SCAN_OFFLOAD_INFO_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define D0_SCAN_OFFLOAD_INFO_GET_LOC_CHANNEL_INFO(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define D0_SCAN_OFFLOAD_INFO_SET_LOC_CHANNEL_INFO(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define CHANNEL_SWITCH_OFFLOAD_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define CHANNEL_SWITCH_OFFLOAD_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define CHANNEL_SWITCH_OFFLOAD_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define CHANNEL_SWITCH_OFFLOAD_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define CHANNEL_SWITCH_OFFLOAD_GET_CHANNEL_NUM(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define CHANNEL_SWITCH_OFFLOAD_SET_CHANNEL_NUM(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define CHANNEL_SWITCH_OFFLOAD_GET_EN_RFE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define CHANNEL_SWITCH_OFFLOAD_SET_EN_RFE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define CHANNEL_SWITCH_OFFLOAD_GET_RFE_TYPE(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 24, 8) -+#define CHANNEL_SWITCH_OFFLOAD_SET_RFE_TYPE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 24, 8, value) -+#define AOAC_RSVD_PAGE3_GET_CMD_ID(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define AOAC_RSVD_PAGE3_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define AOAC_RSVD_PAGE3_GET_CLASS(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define AOAC_RSVD_PAGE3_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define AOAC_RSVD_PAGE3_GET_LOC_NLO_INFO(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 8) -+#define AOAC_RSVD_PAGE3_SET_LOC_NLO_INFO(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 8, value) -+#define AOAC_RSVD_PAGE3_GET_LOC_AOAC_REPORT(h2c_pkt) \ -+ LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 16, 8) -+#define AOAC_RSVD_PAGE3_SET_LOC_AOAC_REPORT(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 16, 8, value) -+#define DBG_MSG_CTRL_GET_CMD_ID(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 0, 5) -+#define DBG_MSG_CTRL_SET_CMD_ID(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 0, 5, value) -+#define DBG_MSG_CTRL_GET_CLASS(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 5, 3) -+#define DBG_MSG_CTRL_SET_CLASS(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 5, 3, value) -+#define DBG_MSG_CTRL_GET_FUN_EN(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 8, 1) -+#define DBG_MSG_CTRL_SET_FUN_EN(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 8, 1, value) -+#define DBG_MSG_CTRL_GET_MODE(h2c_pkt) LE_BITS_TO_4BYTE(h2c_pkt + 0X00, 12, 4) -+#define DBG_MSG_CTRL_SET_MODE(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X00, 12, 4, value) -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_pcie_reg.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_pcie_reg.h -new file mode 100644 -index 000000000..1dda7dbaf ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_pcie_reg.h -@@ -0,0 +1,60 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALMAC_PCIE_REG_H__ -+#define __HALMAC_PCIE_REG_H__ -+ -+/* PCIE PHY register */ -+#define RAC_CTRL_PPR 0x00 -+#define RAC_SET_PPR 0x20 -+#define RAC_TRG_PPR 0x21 -+#define RAC_CTRL_PPR_V1 0x30 -+#define RAC_SET_PPR_V1 0x31 -+ -+/* PCIE CFG register */ -+#define PCIE_L1SS_CTRL 0x718 -+#define PCIE_L1_CTRL 0x719 -+#define PCIE_ASPM_CTRL 0x70F -+#define PCIE_CLK_CTRL 0x725 -+#define PCIE_L1SS_CAP 0x160 -+#define PCIE_L1SS_SUP 0x164 -+#define PCIE_L1SS_STS 0x168 -+ -+/* PCIE CFG bit */ -+#define PCIE_BIT_WAKE BIT(2) -+#define PCIE_BIT_L1 BIT(3) -+#define PCIE_BIT_CLK BIT(4) -+#define PCIE_BIT_L0S BIT(7) -+#define PCIE_BIT_L1SS BIT(5) -+#define PCIE_BIT_L1SSSUP BIT(4) -+ -+/* PCIE ASPM mask*/ -+#define SHFT_L1DLY 3 -+#define SHFT_L0SDLY 0 -+#define PCIE_ASPMDLY_MASK 0x07 -+#define PCIE_L1SS_MASK 0x0F -+ -+/* PCIE Capability */ -+#define PCIE_L1SS_ID 0x001E -+ -+/* PCIE MAC register */ -+#define LINK_CTRL2_REG_OFFSET 0xA0 -+#define GEN2_CTRL_OFFSET 0x80C -+#define LINK_STATUS_REG_OFFSET 0x82 -+ -+#define PCIE_GEN1_SPEED 0x01 -+#define PCIE_GEN2_SPEED 0x02 -+ -+#endif/* __HALMAC_PCIE_REG_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_pwr_seq_cmd.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_pwr_seq_cmd.h -new file mode 100644 -index 000000000..c71d11082 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_pwr_seq_cmd.h -@@ -0,0 +1,98 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 HALMAC_POWER_SEQUENCE_CMD -+#define HALMAC_POWER_SEQUENCE_CMD -+ -+#include "halmac_2_platform.h" -+ -+#define HALMAC_PWR_POLLING_CNT 20000 -+ -+/* The value of cmd : 4 bits */ -+ -+/* 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 HALMAC_PWR_CMD_READ 0x00 -+/* 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 HALMAC_PWR_CMD_WRITE 0x01 -+/* 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 HALMAC_PWR_CMD_POLLING 0x02 -+/* offset: the value to delay -+ * msk: N/A -+ * value: the unit of delay, 0: us, 1: ms -+ */ -+#define HALMAC_PWR_CMD_DELAY 0x03 -+/* offset: N/A -+ * msk: N/A -+ * value: N/A -+ */ -+#define HALMAC_PWR_CMD_END 0x04 -+ -+/* The value of base : 4 bits */ -+ -+/* define the base address of each block */ -+#define HALMAC_PWR_ADDR_MAC 0x00 -+#define HALMAC_PWR_ADDR_USB 0x01 -+#define HALMAC_PWR_ADDR_PCIE 0x02 -+#define HALMAC_PWR_ADDR_SDIO 0x03 -+ -+/* The value of interface_msk : 4 bits */ -+#define HALMAC_PWR_INTF_SDIO_MSK BIT(0) -+#define HALMAC_PWR_INTF_USB_MSK BIT(1) -+#define HALMAC_PWR_INTF_PCI_MSK BIT(2) -+#define HALMAC_PWR_INTF_ALL_MSK (BIT(0) | BIT(1) | BIT(2) | BIT(3)) -+ -+/* The value of cut_msk : 8 bits */ -+#define HALMAC_PWR_CUT_TESTCHIP_MSK BIT(0) -+#define HALMAC_PWR_CUT_A_MSK BIT(1) -+#define HALMAC_PWR_CUT_B_MSK BIT(2) -+#define HALMAC_PWR_CUT_C_MSK BIT(3) -+#define HALMAC_PWR_CUT_D_MSK BIT(4) -+#define HALMAC_PWR_CUT_E_MSK BIT(5) -+#define HALMAC_PWR_CUT_F_MSK BIT(6) -+#define HALMAC_PWR_CUT_G_MSK BIT(7) -+#define HALMAC_PWR_CUT_ALL_MSK 0xFF -+ -+enum halmac_pwrseq_cmd_delay_unit { -+ HALMAC_PWR_DELAY_US, -+ HALMAC_PWR_DELAY_MS, -+}; -+ -+struct halmac_wlan_pwr_cfg { -+ u16 offset; -+ u8 cut_msk; -+ u8 interface_msk; -+ u8 base:4; -+ u8 cmd:4; -+ u8 msk; -+ u8 value; -+}; -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg2.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg2.h -new file mode 100644 -index 000000000..be4b847de ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg2.h -@@ -0,0 +1,8563 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALMAC_COM_REG_H__ -+#define __HALMAC_COM_REG_H__ -+ -+#include "halmac_hw_cfg.h" -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SYS_ISO_CTRL 0x0000 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_TX_CTRL 0x10250000 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SYS_FUNC_EN 0x0002 -+#define REG_SYS_PW_CTRL 0x0004 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_CMD11_VOL_SWITCH 0x10250004 -+#define REG_SDIO_CTRL 0x10250005 -+#define REG_SDIO_DRIVING 0x10250006 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SYS_CLK_CTRL 0x0008 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_MONITOR 0x10250008 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SYS_EEPROM_CTRL 0x000A -+#define REG_EE_VPD 0x000C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_MONITOR_2 0x1025000C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SYS_SWR_CTRL1 0x0010 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+#define REG_SDIO_CTRL_2 0x10250010 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SYS_SWR_CTRL2 0x0014 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_HIMR 0x10250014 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SYS_SWR_CTRL3 0x0018 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_HISR 0x10250018 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RSV_CTRL 0x001C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_RX_REQ_LEN 0x1025001C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RF_CTRL 0x001F -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_RF0_CTRL 0x001F -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_FREE_TXPG_SEQ_V1 0x1025001F -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_AFE_LDO_CTRL 0x0020 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_FREE_TXPG 0x10250020 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_AFE_CTRL1 0x0024 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_FREE_TXPG2 0x10250024 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_AFE_CTRL2 0x0028 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_OQT_FREE_TXPG_V1 0x10250028 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ANAPARSW_POW_MAC 0x0028 -+#define REG_ANAPARLDO_POW_MAC 0x0029 -+#define REG_ANAPAR_POW_MAC 0x002A -+#define REG_ANAPAR_POW_XTAL 0x002B -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_AFE_CTRL3 0x002C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ANAPARLDO_MAC 0x002C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_TXPKT_EMPTY 0x1025002C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_EFUSE_CTRL 0x0030 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_HTSFR_INFO 0x10250030 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_LDO_EFUSE_CTRL 0x0034 -+#define REG_PWR_OPTION_CTRL 0x0038 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_HCPWM1_V2 0x10250038 -+#define REG_SDIO_HCPWM2_V2 0x1025003A -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_CAL_TIMER 0x003C -+#define REG_ACLK_MON 0x003E -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_GPIO_MUXCFG_2 0x003F -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_GPIO_MUXCFG 0x0040 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_INDIRECT_REG_CFG 0x10250040 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_GPIO_PIN_CTRL 0x0044 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_INDIRECT_REG_DATA 0x10250044 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_GPIO_INTM 0x0048 -+#define REG_LED_CFG 0x004C -+#define REG_FSIMR 0x0050 -+#define REG_FSISR 0x0054 -+#define REG_HSIMR 0x0058 -+#define REG_HSISR 0x005C -+#define REG_GPIO_EXT_CTRL 0x0060 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_H2C 0x10250060 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_PAD_CTRL1 0x0064 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_C2H 0x10250064 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_WL_BT_PWR_CTRL 0x0068 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_SDM_DEBUG 0x006C -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define REG_GSSR 0x006C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_SYS_SDIO_CTRL 0x0070 -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define REG_SYS_CLKR 0x0070 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_HCI_OPT_CTRL 0x0074 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_AFE_CTRL4 0x0078 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_HCI_BG_CTRL 0x0078 -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define REG_AFE_XTAL_CTRL_EXT 0x0078 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_HCI_LDO_CTRL 0x007A -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_LDO_SWR_CTRL 0x007C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_8051FW_CTRL 0x0080 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MCUFW_CTRL 0x0080 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_HRPWM1 0x10250080 -+#define REG_SDIO_HRPWM2 0x10250082 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_MCU_TST_CFG 0x0084 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_HPS_CLKR 0x10250084 -+#define REG_SDIO_BUS_CTRL 0x10250085 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_HSUS_CTRL 0x10250086 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_HMEBOX_E0_E1 0x0088 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_RESPONSE_TIMER 0x10250088 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_CMD_CRC 0x1025008A -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_HMEBOX_E2_E3 0x008C -+#define REG_WLLPS_CTRL 0x0090 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_HSISR 0x10250090 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_HSIMR 0x10250091 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_AFE_CTRL5 0x0094 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_GPIO_DEBOUNCE_CTRL 0x0098 -+#define REG_RPWM2 0x009C -+#define REG_SYSON_FSM_MON 0x00A0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_AFE_CTRL6 0x00A4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_PMC_DBG_CTRL1 0x00A8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_AFE_CTRL7 0x00AC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_HIMR0 0x00B0 -+#define REG_HISR0 0x00B4 -+#define REG_HIMR1 0x00B8 -+#define REG_HISR1 0x00BC -+#define REG_DBG_PORT_SEL 0x00C0 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_DIOERR_RPT 0x102500C0 -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_SDIO_ERR_RPT 0x102500C0 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_CMD_ERRCNT 0x102500C2 -+#define REG_SDIO_DATA_ERRCNT 0x102500C3 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_PAD_CTRL2 0x00C4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_CMD_ERR_CONTENT 0x102500C4 -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define REG_MEM_RMC 0x00C8 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_CRC_ERR_IDX 0x102500C9 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_DATA_CRC 0x102500CA -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_SDIO_DATA_REPLY_TIME 0x102500CB -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_PMC_DBG_CTRL2 0x00CC -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SDIO_TRANS_FIFO_STATUS 0x102500CC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BIST_CTRL 0x00D0 -+#define REG_BIST_RPT 0x00D4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_MEM_CTRL 0x00D8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_AFE_CTRL8 0x00DC -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define REG_WLAN_DBG 0x00DC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_SYN_RFC_CTRL 0x00DC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_USB_SIE_INTF 0x00E0 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_SYS_PINMUX 0x00E0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_PCIE_MIO_INTF 0x00E4 -+#define REG_PCIE_MIO_INTD 0x00E8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_WLRF1 0x00EC -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define REG_HPON_FSM 0x00EC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SYS_CFG1 0x00F0 -+#define REG_SYS_STATUS1 0x00F4 -+#define REG_SYS_STATUS2 0x00F8 -+#define REG_SYS_CFG2 0x00FC -+#define REG_CR 0x0100 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PG_SIZE 0x0104 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_PKT_BUFF_ACCESS_CTRL 0x0106 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TSF_CLK_STATE 0x0108 -+#define REG_TXDMA_PQ_MAP 0x010C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TRXFF_BNDY 0x0114 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RXFF_BNDY_V1 0x0114 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_PTA_I2C_MBOX 0x0118 -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+#define REG_FF_STATUS 0x0118 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RXFF_PTR 0x011C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RXFF_BNDY 0x011C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_FEIMR 0x0120 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_FE1IMR 0x0120 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_FEISR 0x0124 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_FE1ISR 0x0124 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_CPWM 0x012C -+#define REG_FWIMR 0x0130 -+#define REG_FWISR 0x0134 -+#define REG_FTIMR 0x0138 -+#define REG_FTISR 0x013C -+#define REG_PKTBUF_DBG_CTRL 0x0140 -+#define REG_PKTBUF_DBG_DATA_L 0x0144 -+#define REG_PKTBUF_DBG_DATA_H 0x0148 -+#define REG_CPWM2 0x014C -+#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_TC5_CTRL 0x0168 -+#define REG_TC6_CTRL 0x016C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MBIST_FAIL 0x0170 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_MBIST_DRF_FAIL 0x0170 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MBIST_START_PAUSE 0x0174 -+#define REG_MBIST_DONE 0x0178 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MBIST_ROM_CRC_DATA 0x017C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_MBIST_NRML_FAIL 0x017C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_MBIST_FAIL_NRML 0x017C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MBIST_READ_BIST_RPT 0x017C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_AES_DECRPT_DATA 0x0180 -+#define REG_AES_DECRPT_CFG 0x0184 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_MBIST_READ_BIST_RPT_V1 0x0188 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_HIOE_CTRL 0x0188 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+#define REG_MACCLKFRQ 0x018C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_HIOE_CFG_FILE 0x018C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TMETER 0x0190 -+#define REG_OSC_32K_CTRL 0x0194 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_32K_CAL_REG1 0x0198 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_32K_CAL_REG0 0x0198 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_C2HEVT 0x01A0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_C2HEVT_1 0x01A4 -+#define REG_C2HEVT_2 0x01A8 -+#define REG_C2HEVT_3 0x01AC -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_MISC_CTRL_V1 0x01B0 -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+#define REG_TC7_CTRL 0x01B0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_RXDESC_BUFF_RPTR 0x01B0 -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT) -+ -+#define REG_TC8_CTRL 0x01B4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_RXDESC_BUFF_WPTR 0x01B4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SW_DEFINED_PAGE1 0x01B8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SW_DEFINED_PAGE2 0x01BC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_MCUTST_I 0x01C0 -+#define REG_MCUTST_II 0x01C4 -+#define REG_FMETHR 0x01C8 -+#define REG_HMETFR 0x01CC -+#define REG_HMEBOX0 0x01D0 -+#define REG_HMEBOX1 0x01D4 -+#define REG_HMEBOX2 0x01D8 -+#define REG_HMEBOX3 0x01DC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_LLT_INIT 0x01E0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_LLT_IND_ACCESS 0x01E0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_RXDESC_BUFF_BNDY 0x01E0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_GENTST 0x01E4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_LLT_INIT_ADDR 0x01E4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_BB_ACCESS_CTRL 0x01E8 -+#define REG_BB_ACCESS_DATA 0x01EC -+#define REG_HMEBOX_E0 0x01F0 -+#define REG_HMEBOX_E1 0x01F4 -+#define REG_HMEBOX_E2 0x01F8 -+#define REG_HMEBOX_E3 0x01FC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_RQPN_CTRL_HLPQ 0x0200 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FIFOPAGE_CTRL_1 0x0200 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BCN_CTRL_0 0x0200 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_FIFOPAGE_INFO 0x0204 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FIFOPAGE_CTRL_2 0x0204 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BCN_CTRL_1 0x0204 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_DWBCN0_CTRL 0x0208 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_AUTO_LLT_V1 0x0208 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TXDMA_OFFSET_CHK 0x020C -+#define REG_TXDMA_STATUS 0x0210 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_RQPN_NPQ 0x0214 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_TX_DMA_DBG 0x0214 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TQPNT1 0x0218 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_DMA_RQPN_INFO_PUB 0x0218 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TQPNT2 0x021C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_RQPN_CTRL_2_V1 0x021C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TDE_DEBUG 0x0220 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TQPNT3 0x0220 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BCN_CTRL_2 0x0220 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_AUTO_LLT 0x0224 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TQPNT4 0x0224 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_DWBCN1_CTRL 0x0228 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RQPN_CTRL_1 0x0228 -+#define REG_RQPN_CTRL_2 0x022C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RQPN_EXQ1_EXQ2 0x0230 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FIFOPAGE_INFO_1 0x0230 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TXPKTNUM_0 0x0230 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TQPNT3_V1 0x0234 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FIFOPAGE_INFO_2 0x0234 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TXPKTNUM_1 0x0234 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FIFOPAGE_INFO_3 0x0238 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TXPKTNUM_2 0x0238 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FIFOPAGE_INFO_4 0x023C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TXPKTNUM_3 0x023C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FIFOPAGE_INFO_5 0x0240 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TX_AGG_ALIGN 0x0240 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_H2C_HEAD 0x0244 -+#define REG_H2C_TAIL 0x0248 -+#define REG_H2C_READ_ADDR 0x024C -+#define REG_H2C_WR_ADDR 0x0250 -+#define REG_H2C_INFO 0x0254 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_FIFOPAGE_CTRL_5 0x0258 -+#define REG_FIFOPAGE_CTRL_3 0x025C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_TQPNT5 0x0260 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_DMA_OQT_0 0x0260 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_TQPNT6 0x0264 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_DMA_OQT_1 0x0264 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_FIFOPAGE_INFO_6 0x0268 -+#define REG_FIFOPAGE_INFO_7 0x026C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PGSUB_CNT 0x026C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_FIFOPAGE_CTRL_4 0x0270 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PGSUB_H 0x0270 -+#define REG_PGSUB_N 0x0274 -+#define REG_PGSUB_L 0x0278 -+#define REG_PGSUB_E 0x027C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RXDMA_AGG_PG_TH 0x0280 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_RXPKT_NUM 0x0284 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_RXDMA_CTRL 0x0284 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RXDMA_STATUS 0x0288 -+#define REG_RXDMA_DPR 0x028C -+#define REG_RXDMA_MODE 0x0290 -+#define REG_C2H_PKT 0x0294 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_FWFF_C2H 0x0298 -+#define REG_FWFF_CTRL 0x029C -+#define REG_FWFF_PKT_INFO 0x02A0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_FC2H_INFO 0x02A4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_FWFF_PKT_INFO2 0x02A4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RXPKTNUM 0x02B0 -+#define REG_RXPKTNUM_TH 0x02B4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_FW_UPD_RXDES_RDPTR 0x02B8 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FW_MSG1 0x02E0 -+#define REG_FW_MSG2 0x02E4 -+#define REG_FW_MSG3 0x02E8 -+#define REG_FW_MSG4 0x02EC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PCIE_CTRL 0x0300 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_HCI_CTRL 0x0300 -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+#define REG_LX_CTRL1 0x0300 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_INT_MIG 0x0304 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH_CTRL 0x0304 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BCNQ_TXBD_DESA 0x0308 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HIQ_CTRL 0x0308 -+#define REG_INT_MIG_V1 0x030C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MGQ_TXBD_DESA 0x0310 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0MGQ_TXBD_DESA_L 0x0310 -+#define REG_P0MGQ_TXBD_DESA_H 0x0314 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_VOQ_TXBD_DESA 0x0318 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH0_TXBD_DESA_L 0x0318 -+#define REG_ACH0_TXBD_DESA_H 0x031C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_VIQ_TXBD_DESA 0x0320 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH1_TXBD_DESA_L 0x0320 -+#define REG_ACH1_TXBD_DESA_H 0x0324 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BEQ_TXBD_DESA 0x0328 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH2_TXBD_DESA_L 0x0328 -+#define REG_ACH2_TXBD_DESA_H 0x032C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BKQ_TXBD_DESA 0x0330 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH3_TXBD_DESA_L 0x0330 -+#define REG_ACH3_TXBD_DESA_H 0x0334 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_RXQ_RXBD_DESA 0x0338 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0RXQ_RXBD_DESA_L 0x0338 -+#define REG_P0RXQ_RXBD_DESA_H 0x033C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI0Q_TXBD_DESA 0x0340 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0BCNQ_TXBD_DESA_L 0x0340 -+#define REG_P0BCNQ_TXBD_DESA_H 0x0344 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI1Q_TXBD_DESA 0x0348 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_FWCMDQ_TXBD_DESA_L 0x0348 -+#define REG_FWCMDQ_TXBD_DESA_H 0x034C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI2Q_TXBD_DESA 0x0350 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PCIE_HRPWM1_HCPWM1_DCPU 0x0354 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI3Q_TXBD_DESA 0x0358 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0_MPRT_BCNQ_TXBD_DESA_L 0x0358 -+#define REG_P0_MPRT_BCNQ_TXBD_DESA_H 0x035C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI4Q_TXBD_DESA 0x0360 -+#define REG_HI5Q_TXBD_DESA 0x0368 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0_MPRT_BCNQ_TXRXBD_NUM 0x036C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI6Q_TXBD_DESA 0x0370 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BD_RWPTR_CLR2 0x0370 -+#define REG_BD_RWPTR_CLR3 0x0374 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI7Q_TXBD_DESA 0x0378 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0MGQ_RXQ_TXRXBD_NUM 0x0378 -+#define REG_CHNL_DMA_CFG 0x037C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MGQ_TXBD_NUM 0x0380 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_FWCMDQ_TXBD_NUM 0x0380 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_RX_RXBD_NUM 0x0382 -+#define REG_VOQ_TXBD_NUM 0x0384 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH0_ACH1_TXBD_NUM 0x0384 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_VIQ_TXBD_NUM 0x0386 -+#define REG_BEQ_TXBD_NUM 0x0388 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH2_ACH3_TXBD_NUM 0x0388 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BKQ_TXBD_NUM 0x038A -+#define REG_HI0Q_TXBD_NUM 0x038C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI0Q_HI1Q_TXBD_NUM 0x038C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI1Q_TXBD_NUM 0x038E -+#define REG_HI2Q_TXBD_NUM 0x0390 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI2Q_HI3Q_TXBD_NUM 0x0390 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI3Q_TXBD_NUM 0x0392 -+#define REG_HI4Q_TXBD_NUM 0x0394 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI4Q_HI5Q_TXBD_NUM 0x0394 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI5Q_TXBD_NUM 0x0396 -+#define REG_HI6Q_TXBD_NUM 0x0398 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI6Q_HI7Q_TXBD_NUM 0x0398 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI7Q_TXBD_NUM 0x039A -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TSFTIMER_HCI 0x039C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BD_RWPTR_CLR 0x039C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BD_RWPTR_CLR1 0x039C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_VOQ_TXBD_IDX 0x03A0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH0_TXBD_IDX 0x03A0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_VIQ_TXBD_IDX 0x03A4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH1_TXBD_IDX 0x03A4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BEQ_TXBD_IDX 0x03A8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH2_TXBD_IDX 0x03A8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BKQ_TXBD_IDX 0x03AC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH3_TXBD_IDX 0x03AC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MGQ_TXBD_IDX 0x03B0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0MGQ_TXBD_IDX 0x03B0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_RXQ_RXBD_IDX 0x03B4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0RXQ_RXBD_IDX 0x03B4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI0Q_TXBD_IDX 0x03B8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI0Q_TXBD_IDX 0x03B8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI1Q_TXBD_IDX 0x03BC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI1Q_TXBD_IDX 0x03BC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI2Q_TXBD_IDX 0x03C0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI2Q_TXBD_IDX 0x03C0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI3Q_TXBD_IDX 0x03C4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI3Q_TXBD_IDX 0x03C4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI4Q_TXBD_IDX 0x03C8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI4Q_TXBD_IDX 0x03C8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI5Q_TXBD_IDX 0x03CC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI5Q_TXBD_IDX 0x03CC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI6Q_TXBD_IDX 0x03D0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI6Q_TXBD_IDX 0x03D0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HI7Q_TXBD_IDX 0x03D4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI7Q_TXBD_IDX 0x03D4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_DBG_SEL_V1 0x03D8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_DBGSEL_PCIE_HRPWM1_HCPWM1_V1 0x03D8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_PCIE_HRPWM1_V1 0x03D9 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_HCI_HRPWM1_V1 0x03D9 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_PCIE_HCPWM1_V1 0x03DA -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_HCI_HCPWM1_V1 0x03DA -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PCIE_CTRL2 0x03DB -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_HCI_CTRL2 0x03DB -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+#define REG_LX_CTRL2 0x03DB -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_PCIE_HRPWM2_V1 0x03DC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_HCI_HRPWM2_V1 0x03DC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PCIE_HRPWM2_HCPWM2_V1 0x03DC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_PCIE_HCPWM2_V1 0x03DE -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_HCI_HCPWM2_V1 0x03DE -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_PCIE_H2C_MSG_V1 0x03E0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_HCI_H2C_MSG_V1 0x03E0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_PCIE_C2H_MSG_V1 0x03E4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_HCI_C2H_MSG_V1 0x03E4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_DBI_WDATA_V1 0x03E8 -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+#define REG_LX_DMA_ISR 0x03E8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_DBI_RDATA_V1 0x03EC -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+#define REG_LX_DMA_IMR 0x03EC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_DBI_FLAG_V1 0x03F0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_STUCK_FLAG_V1 0x03F0 -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+#define REG_LX_DMA_DBG 0x03F0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MDIO_V1 0x03F4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT) -+ -+#define REG_MDIO2_V1 0x03F8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PCIE_MIX_CFG 0x03F8 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_WDT_CFG 0x03F8 -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+#define REG_BUS_MIX_CFG 0x03F8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_HCI_MIX_CFG 0x03FC -+ -+#endif -+ -+#if (HALMAC_8881A_SUPPORT) -+ -+#define REG_BUS_MIX_CFG1 0x03FC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_Q0_INFO 0x0400 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+#define REG_QUEUELIST_INFO0 0x0400 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_QUEUE_INFO1 0x0400 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_Q1_INFO 0x0404 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+#define REG_QUEUELIST_INFO1 0x0404 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_QUEUE_INFO2 0x0404 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_Q2_INFO 0x0408 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_QUEUE_INFO3 0x0408 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_QUEUELIST_INFO2 0x0408 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_Q3_INFO 0x040C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_QINFO_INDEX 0x040C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_QUEUELIST_INFO3 0x040C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MGQ_INFO 0x0410 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_QUEUE_EMPTY 0x0410 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_QUEUELIST_INFO_EMPTY 0x0410 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HIQ_INFO 0x0414 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_QUEUELIST_INFO2_V1 0x0414 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_ACQ_STOP_V1 0x0414 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_QUEUELIST_ACQ_EN 0x0414 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BCNQ_INFO 0x0418 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TXPKT_EMPTY_V1 0x0418 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BCNQ_BDNY_V2 0x0418 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TXPKT_EMPTY 0x041A -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_CPU_MGQ_INFO 0x041C -+#define REG_FWHW_TXQ_CTRL 0x0420 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HWSEQ_CTRL 0x0423 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_DATAFB_SEL 0x0423 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BCNQ_BDNY 0x0424 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BCNQ_BDNY_V1 0x0424 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TXBDNY 0x0424 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MGQ_BDNY 0x0425 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_LIFETIME_EN 0x0426 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_FW_FREE_TAIL 0x0427 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SPEC_SIFS 0x0428 -+#define REG_RETRY_LIMIT 0x042A -+#define REG_TXBF_CTRL 0x042C -+#define REG_DARFRC 0x0430 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_DARFRCH 0x0434 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RARFRC 0x0438 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RARFRCH 0x043C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RRSR 0x0440 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_RRSR_H 0x0443 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_ARFR0 0x0444 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ARFRH0 0x0448 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_ARFR1_V1 0x044C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_ARFR1 0x044C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_REG_ARFR_WT0 0x044C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_ARFRH1 0x0450 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_ARFRH1_V1 0x0450 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_REG_ARFR_WT1 0x0450 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_CCK_CHECK 0x0454 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_AMPDU_BURST_CTRL 0x0455 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_BCNQ2_HEAD 0x0455 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_AMPDU_MAX_TIME_V1 0x0455 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_AMPDU_MAX_TIME 0x0456 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BCNQ1_BDNY_V1 0x0456 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TAB_SEL 0x0456 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BCNQ1_BDNY 0x0457 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BCN_INVALID_CTRL 0x0457 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_AMPDU_MAX_LENGTH 0x0458 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_AMPDU_MAX_LENGTH_HT 0x0458 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_ACQ_STOP 0x045C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_WMAC_LBK_BUF_HD 0x045D -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_NDPA_RATE 0x045D -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TX_HANG_CTRL 0x045E -+#define REG_NDPA_OPT_CTRL 0x045F -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_FAST_EDCA_CTRL 0x0460 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_AMPDU_MAX_LENGTH_VHT 0x0460 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RD_RESP_PKT_TH 0x0463 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_CMDQ_INFO 0x0464 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_NEW_EDCA_CTRL_V1 0x0464 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_Q4_INFO 0x0468 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACQ_STOP_V2 0x0468 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_Q5_INFO 0x046C -+#define REG_Q6_INFO 0x0470 -+#define REG_Q7_INFO 0x0474 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_LBK_BUF_HD_V1 0x0478 -+#define REG_MGQ_BDNY_V1 0x047A -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TXRPT_CTRL 0x047C -+#define REG_INIRTS_RATE_SEL 0x0480 -+#define REG_BASIC_CFEND_RATE 0x0481 -+#define REG_STBC_CFEND_RATE 0x0482 -+#define REG_DATA_SC 0x0483 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MACID_SLEEP3 0x0484 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MOREDATA_V1 0x0484 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_MACID_SLEEP4 0x0485 -+#define REG_MACID_SLEEP5 0x0487 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_DATA_SC1 0x0487 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MACID_SLEEP1 0x0488 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_ARFR2_V1 0x048C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_ARFR2 0x048C -+#define REG_ARFRH2 0x0490 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_ARFRH2_V1 0x0490 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_ARFR3_V1 0x0494 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_ARFR3 0x0494 -+#define REG_ARFRH3 0x0498 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_ARFRH3_V1 0x0498 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_ARFR4 0x049C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ARFRH4 0x04A0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_ARFR5 0x04A4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ARFRH5 0x04A8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TXRPT_START_OFFSET 0x04AC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TRYING_CNT_TH 0x04B0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TRY_CNT_IDX 0x04B0 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+#define REG_RRSR_CTS 0x04B0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_POWER_STAGE1 0x04B4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_POWER_STAGE2 0x04B8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SW_AMPDU_BURST_MODE_CTRL 0x04BC -+#define REG_PKT_LIFE_TIME 0x04C0 -+#define REG_STBC_SETTING 0x04C4 -+#define REG_STBC_SETTING2 0x04C5 -+#define REG_QUEUE_CTRL 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL 0x04C7 -+#define REG_PROT_MODE_CTRL 0x04C8 -+#define REG_BAR_MODE_CTRL 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT 0x04CF -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MACID_SLEEP2 0x04D0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MACID_SLEEP_CTRL 0x04D0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MACID_SLEEP 0x04D4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MACID_SLEEP_INFO 0x04D4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_HW_SEQ0 0x04D8 -+#define REG_HW_SEQ1 0x04DA -+#define REG_HW_SEQ2 0x04DC -+#define REG_HW_SEQ3 0x04DE -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define REG_CSI_SEQ 0x04DE -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_NULL_PKT_STATUS 0x04E0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_NULL_PKT_STATUS_V1 0x04E0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_PTCL_ERR_STATUS 0x04E2 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+#define REG_PTCL_ERR_STATUS_V1 0x04E2 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_PTCL_PKT_NUM 0x04E3 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_NULL_PKT_STATUS_EXTEND 0x04E3 -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define REG_TRXRPT_MISS_CNT 0x04E3 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_HQMGQ_DROP 0x04E4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_VIDEO_ENHANCEMENT_FUN 0x04E4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_NULL_PKT_STATUS_V2 0x04E4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_PRECNT_CTRL 0x04E5 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_NULL_PKT_STATUS_EXTEND_V1 0x04E7 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_BT_POLLUTE_PKTCNT_V1 0x04E8 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_POLLUTE_PKT_CNT 0x04E8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_DROP_PKT_NUM 0x04EC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PTCL_DBG 0x04EC -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_DROP_NUM 0x04EC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PTCL_DBG_V1 0x04EC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_PTCL_TX_RPT 0x04F0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TX_RPT_INFO_L32 0x04F0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_TXOP_EXTRA_CTRL 0x04F0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BT_POLLUTE_PKTCNT 0x04F0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TX_RPT_INFO_H32 0x04F4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_CPUMGQ_TIMER_CTRL2 0x04F4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PTCL_DBG_OUT 0x04F8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_DUMMY_PAGE4 0x04FC -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_DUMMY_PAGE4_V1 0x04FC -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+#define REG_DUMMY_PAGE4_1 0x04FE -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_MOREDATA 0x04FE -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#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 0x0514 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TSFTR_SYN_OFFSET 0x0518 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_FORCE_BCN_IFS_V1 0x0518 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_AGGR_BREAK_TIME 0x051A -+#define REG_SLOT 0x051B -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_NOA_ON_ERLY_TIME 0x051C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_EDCA_CPUMGQ_PARAM 0x051C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_NOA_OFF_ERLY_TIME 0x051D -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_CPUMGQ_PAUSE 0x051E -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_PS_TIMER_CTRL 0x051F -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TX_PTCL_CTRL 0x0520 -+#define REG_TXPAUSE 0x0522 -+#define REG_DIS_TXREQ_CLR 0x0523 -+#define REG_RD_CTRL 0x0524 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MBSSID_CTRL 0x0526 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_P2PPS_CTRL 0x0527 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_PKT_LIFETIME_CTRL 0x0528 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_P2PPS_SPEC_STATE 0x052B -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_P2PPS0_SPEC_STATE 0x052B -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_PS_TIMER_A_V2 0x052C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_TBTT_AREA_BLK_4AC 0x052C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_TXOP_LIMIT_CTRL 0x052C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BAR_TX_CTRL 0x0530 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_P2PON_DIS_TXTIME 0x0531 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_PS_TIMER_B_V2 0x0534 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_EDCA_REF_CTRL 0x0534 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_CCA_TXEN_CNT 0x0534 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_QUEUE_INCOL_THR 0x0538 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MAX_INTER_COLLISION 0x0538 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_QUEUE_INCOL_EN 0x053C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MAX_INTER_COLLISION_CNT 0x053C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TBTT_PROHIBIT 0x0540 -+#define REG_P2PPS_STATE 0x0543 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RD_NAV_NXT 0x0544 -+#define REG_NAV_PROT_LEN 0x0546 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_FTM_SETTING 0x0548 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_FTM_CTRL 0x0548 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FTM_PTT 0x0548 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT) -+ -+#define REG_FTM_TSF_CNT 0x054C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FTM_TSF 0x054C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BCN_CTRL 0x0550 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BCN_CTRL1 0x0551 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BCN_CTRL_CLINT0 0x0551 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MBID_NUM 0x0552 -+#define REG_DUAL_TSF_RST 0x0553 -+#define REG_MBSSID_BCN_SPACE 0x0554 -+#define REG_DRVERLYINT 0x0558 -+#define REG_BCNDMATIM 0x0559 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_ATIMWND 0x055A -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_USTIME_TSF 0x055C -+#define REG_BCN_MAX_ERR 0x055D -+#define REG_RXTSF_OFFSET_CCK 0x055E -+#define REG_RXTSF_OFFSET_OFDM 0x055F -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TSFTR 0x0560 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TSFTR0_L 0x0560 -+#define REG_TSFTR0_H 0x0564 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_TSFTR_1 0x0564 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TSFTR1 0x0568 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TSFTR1_L 0x0568 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FREERUN_CNT 0x0568 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TSFTR1_H 0x056C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_FREERUN_CNT_1 0x056C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_ATIMWND1 0x0570 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_ATIMWND1_V1 0x0570 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TBTT_PROHIBIT_INFRA 0x0571 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_CTWND 0x0572 -+#define REG_BCNIVLCUNT 0x0573 -+#define REG_BCNDROPCTRL 0x0574 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_HGQ_TIMEOUT_PERIOD 0x0575 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TXCMD_TIMEOUT_PERIOD 0x0576 -+#define REG_MISC_CTRL 0x0577 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TSFTR2_L 0x0578 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BCN_CTRL_CLINT1 0x0578 -+#define REG_BCN_CTRL_CLINT2 0x0579 -+#define REG_BCN_CTRL_CLINT3 0x057A -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_EXTEND_CTRL 0x057B -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TSFTR2_H 0x057C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_P2PPS1_SPEC_STATE 0x057C -+#define REG_P2PPS1_STATE 0x057D -+#define REG_P2PPS2_SPEC_STATE 0x057E -+#define REG_P2PPS2_STATE 0x057F -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_PS_TIMER 0x0580 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_PS_TIMER0 0x0580 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TIMER0 0x0584 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_PS_TIMER1 0x0584 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TIMER1 0x0588 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_PS_TIMER2 0x0588 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TBTT_CTN_AREA 0x058C -+#define REG_FORCE_BCN_IFS 0x058E -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_DRVERLYINT_V1 0x058F -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TXOP_MIN 0x0590 -+#define REG_PRE_BKF_TIME 0x0592 -+#define REG_CROSS_TXOP_CTRL 0x0593 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_FREERUN_CNT_L 0x0594 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_TBTT_INT_SHIFT_CLI0 0x0594 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_TBTT_INT_SHIFT_CLI 0x0594 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_TBTT_INT_SHIFT_CLI1 0x0595 -+#define REG_TBTT_INT_SHIFT_CLI2 0x0596 -+#define REG_TBTT_INT_SHIFT_CLI3 0x0597 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_FREERUN_CNT_H 0x0598 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_TBTT_INT_SHIFT_ENABLE 0x0598 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RX_TBTT_SHIFT_V1 0x0598 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_ATIMWND2 0x05A0 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_ATIMWND_GROUP1 0x05A0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_ATIMWND3 0x05A1 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_ATIMWND_GROUP2 0x05A1 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_ATIMWND4 0x05A2 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_ATIMWND_GROUP3 0x05A2 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_ATIMWND5 0x05A3 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_ATIMWND_GROUP4 0x05A3 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_ATIMWND6 0x05A4 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_DTIM_COUNT_GROUP1 0x05A4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_ATIMWND7 0x05A5 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_DTIM_COUNT_GROUP2 0x05A5 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_ATIMUGT 0x05A6 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_DTIM_COUNT_GROUP3 0x05A6 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_HIQ_NO_LMT_EN 0x05A7 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_DTIM_COUNT_GROUP4 0x05A7 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_DTIM_COUNTER_ROOT 0x05A8 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_HIQ_NO_LMT_EN_V2 0x05A8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_DTIM_COUNTER_VAP1 0x05A9 -+#define REG_DTIM_COUNTER_VAP2 0x05AA -+#define REG_DTIM_COUNTER_VAP3 0x05AB -+#define REG_DTIM_COUNTER_VAP4 0x05AC -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_MBID_BCNQ_EN 0x05AC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_DTIM_COUNTER_VAP5 0x05AD -+#define REG_DTIM_COUNTER_VAP6 0x05AE -+#define REG_DTIM_COUNTER_VAP7 0x05AF -+#define REG_DIS_ATIM 0x05B0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_EARLY_128US 0x05B1 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TBTT_HOLD_PREDICT_P1 0x05B2 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_P2PPS1_CTRL 0x05B2 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_MULTI_BCN_CS 0x05B3 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_P2PPS2_CTRL 0x05B3 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TSFT_SHIFT 0x05B4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TIMER0_SRC_SEL 0x05B4 -+#define REG_NOA_UNIT_SEL 0x05B5 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_P2POFF_DIS_TXTIME 0x05B7 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MBSSID_BCN_SPACE2 0x05B8 -+#define REG_MBSSID_BCN_SPACE3 0x05BC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_ACMHWCTRL 0x05C0 -+#define REG_ACMRSTCTRL 0x05C1 -+#define REG_ACMAVG 0x05C2 -+#define REG_VO_ADMTIME 0x05C4 -+#define REG_VI_ADMTIME 0x05C6 -+#define REG_BE_ADMTIME 0x05C8 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MAC_HEADER_NAV_OFFSET 0x05CA -+#define REG_DIS_NDPA_NAV_CHECK 0x05CB -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_EDCA_RANDOM_GEN 0x05CC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TXCMD_NOA_SEL 0x05CF -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TXCMD_SEL 0x05CF -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_DRVERLYINT2 0x05D0 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_BCNERR_CFG 0x05D0 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_32K_CLK_SEL 0x05D0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_NAN_SETTING 0x05D4 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_BCN_ELY_ADJ 0x05D4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_EARLYINT_ADJUST 0x05D4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_NAN_BCNSPACE 0x05D8 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_BCNERR_CNT1 0x05D8 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BCNERR_CNT 0x05D8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_NAN_SETTING1 0x05DC -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_BCNERR_CNT2 0x05DC -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BCNERR_CNT_2 0x05DC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_NOA_PARAM 0x05E0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_NOA_PARAM_1 0x05E4 -+#define REG_NOA_PARAM_2 0x05E8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MU_DBG_INFO 0x05E8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_NOA_PARAM_3 0x05EC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MU_DBG_INFO_1 0x05EC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_NOA_SUBIE 0x05ED -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_P2P_RST 0x05F0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_SCH_DBG_SEL 0x05F0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SCHEDULER_RST 0x05F1 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MU_DBG_ERR_FLAG 0x05F2 -+#define REG_TX_ERR_RECOVERY_RST 0x05F3 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_SCH_DBG 0x05F4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SCH_DBG_VALUE 0x05F4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SCH_TXCMD 0x05F8 -+#define REG_PAGE5_DUMMY 0x05FC -+#define REG_WMAC_CR 0x0600 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_FWPKT_CR 0x0601 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_FW_STS_FILTER 0x0602 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_WMAC_BWOPMODE 0x0603 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_BWOPMODE 0x0603 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TCR 0x0604 -+#define REG_RCR 0x0608 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_RX_PKT_LIMIT 0x060C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RXPKT_LIMIT 0x060C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RX_DLK_TIME 0x060D -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_SDIO_RXINT_LEN_TH 0x1025060E -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RX_DRVINFO_SZ 0x060F -+#define REG_MACID 0x0610 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID_H 0x0614 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_BSSID 0x0618 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BSSID_H 0x061C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_MAR 0x0620 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MAR_H 0x0624 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MBIDCAMCFG_1 0x0628 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MBIDCAMCFG_2 0x062C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_MBIDCAM_CFG 0x062C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_WMAC_DEBUG_SEL 0x062C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MCU_TEST_1 0x0630 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_TCR_TSFT_OFS 0x0630 -+#define REG_UDF_THSD 0x0632 -+#define REG_ZLD_NUM 0x0633 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_MCU_TEST_2 0x0634 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_STMP_THSD 0x0634 -+#define REG_WMAC_TXTIMEOUT 0x0635 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_MCU_TEST_2_V1 0x0636 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_USTIME_EDCA 0x0638 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ACKTO_CCK 0x0639 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_MAC_SPEC_SIFS 0x063A -+#define REG_RESP_SIFS_CCK 0x063C -+#define REG_RESP_SIFS_OFDM 0x063E -+#define REG_ACKTO 0x0640 -+#define REG_CTS2TO 0x0641 -+#define REG_EIFS 0x0642 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RPFM_MAP0 0x0644 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_RPFM_MAP1 0x0646 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_RPFM_MAP1_V1 0x0646 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RPFM_CAM_CMD 0x0648 -+#define REG_RPFM_CAM_RWD 0x064C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_NAV_CTRL 0x0650 -+#define REG_BACAMCMD 0x0654 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BACAMCONTENT 0x0658 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_BACAM_WD 0x0658 -+#define REG_BACAM_WD_H 0x065C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BACAMCONTENT_H 0x065C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_LBDLY 0x0660 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_LBK_DLY 0x0660 -+#define REG_BITMAP_CMD 0x0661 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_BACAM_RPMEN 0x0661 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_TX_RX 0x0662 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_BITMAP_CTL 0x0663 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RXERR_RPT 0x0664 -+#define REG_WMAC_TRXPTCL_CTL 0x0668 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_TRXPTCL_CTL_H 0x066C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_CAMCMD 0x0670 -+#define REG_CAMWRITE 0x0674 -+#define REG_CAMREAD 0x0678 -+#define REG_CAMDBG 0x067C -+#define REG_SECCFG 0x0680 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RXFILTER_CATEGORY_1 0x0682 -+#define REG_RXFILTER_ACTION_1 0x0683 -+#define REG_RXFILTER_CATEGORY_2 0x0684 -+#define REG_RXFILTER_ACTION_2 0x0685 -+#define REG_RXFILTER_CATEGORY_3 0x0686 -+#define REG_RXFILTER_ACTION_3 0x0687 -+#define REG_RXFLTMAP3 0x0688 -+#define REG_RXFLTMAP4 0x068A -+#define REG_RXFLTMAP5 0x068C -+#define REG_RXFLTMAP6 0x068E -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_WOW_CTRL 0x0690 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_NAN_RX_TSF_FILTER 0x0691 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_PS_RX_INFO 0x0692 -+#define REG_WMMPS_UAPSD_TID 0x0693 -+#define REG_LPNAV_CTRL 0x0694 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_WKFMCAM_NUM 0x0698 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WKFMCAM_CMD 0x0698 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WKFMCAM_RWD 0x069C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_RXFLTMAP0 0x06A0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RXFLTER0 0x06A0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_RXFLTMAP1 0x06A2 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RXFLTER1 0x06A2 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_RXFLTMAP 0x06A4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RXFLTER2 0x06A4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RXFLTMAP2 0x06A4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_BCN_PSR_RPT 0x06A8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_FLC_RPC 0x06AC -+#define REG_FLC_RPCT 0x06AD -+#define REG_FLC_PTS 0x06AE -+#define REG_FLC_TRPC 0x06AF -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RXPKTMON_CTRL 0x06B0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_STATE_MON 0x06B4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_ERROR_EVT_CTL 0x06B8 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ERROR_MON 0x06B8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RESPINFO 0x06BC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SEARCH_MACID 0x06BC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BT_COEX_TABLE 0x06C0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_BT_COEX_TABLE_V1 0x06C0 -+#define REG_BT_COEX_TABLE2_V1 0x06C4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_COEX_TABLE2 0x06C4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_COEX_BREAK_TABLE 0x06C8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_BT_COEX_TABLE_H_V1 0x06CC -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_COEX_TABLE_H 0x06CC -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RXCMD_0 0x06D0 -+#define REG_RXCMD_1 0x06D4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_WMAC_RESP_TXINFO 0x06D8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_RESP_TXINFO_CFG 0x06D8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BBPSF_CTRL 0x06DC -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_RESP_TXINFO_RATE 0x06DE -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_P2P_RX_BCN_NOA 0x06E0 -+#define REG_ASSOCIATED_BFMER0_INFO 0x06E4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_SOUNDING_CFG1 0x06E8 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_ASSOCIATED_BFMER0_INFO_H 0x06E8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_ASSOCIATED_BFMER1_INFO 0x06EC -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_SOUNDING_CFG2 0x06EC -+#define REG_SOUNDING_CFG3 0x06F0 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_ASSOCIATED_BFMER1_INFO_H 0x06F0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TX_CSI_RPT_PARAM_BW20 0x06F4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_SOUNDING_CFG0 0x06F4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TX_CSI_RPT_PARAM_BW40 0x06F8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define REG_ANTCD_INFO 0x06F8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_TX_CSI_RPT_PARAM_BW80 0x06FC -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_CSI_PTR 0x06FC -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_CSI_RRSR_V1 0x06FC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_MACID1 0x0700 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID1_1 0x0704 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BSSID1 0x0708 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PCIE_CFG_FORCE_LINK_L 0x0709 -+#define REG_PCIE_CFG_FORCE_LINK_H 0x070A -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BSSID1_1 0x070C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PCIE_CFG_DEFAULT_ACK_FREQUENCY 0x070C -+#define REG_PCIE_CFG_CX_NFTS 0x070D -+#define REG_PCIE_CFG_DEFAULT_ENTR_LATENCY 0x070F -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_BCN_PSR_RPT1 0x0710 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PCIE_CFG_L1_MISC_SEL 0x0711 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_ASSOCIATED_BFMEE_SEL 0x0714 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_ASSOCIATED_BFMEE_SEL_1 0x0714 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_SND_PTCL_CTRL 0x0718 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PCIE_CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF 0x0718 -+#define REG_PCIE_CFG_FORCE_CLKREQ_N_PAD 0x0719 -+#define REG_PCIE_CFG_TIMER_MODIFIER_FOR_ACK_NAK_LATENCY 0x071A -+#define REG_PCIE_CFG_TIMER_MODIFIER_FOR_FLOW_CONTROL_WATCHDOG 0x071B -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_RX_CSI_RPT_INFO 0x071C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PCIE_CFG_SKP_INTERVAL_VALUE_L 0x071C -+#define REG_PCIE_CFG_SKP_INTERVAL_VALUE_H 0x071D -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RX_CSI_RPT_INFO_H 0x071F -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_NS_ARP_CTRL 0x0720 -+#define REG_NS_ARP_INFO 0x0724 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PCIE_CFG_L1_UNIT_SEL 0x0724 -+#define REG_PCIE_CFG_MIN_CLKREQ_SEL 0x0725 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_NS_ARP_IPADDR 0x0728 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_PWR_INT_CTRL 0x0728 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BEAMFORMING_INFO_NSARP_V1 0x0728 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_WRITE_RX_CSI_RPT_INFO 0x072C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RX_CSI_RPT_INFO_V1 0x072C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BEAMFORMING_INFO_NSARP 0x072C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_NS_ARP_IPV6_MYADDR 0x0730 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_POWER_MGT_0_V1 0x0730 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_IPV6 0x0730 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_POWER_MGT_1_V1 0x0734 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_IPV6_1 0x0734 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_POWER_MGT_2_V1 0x0738 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_IPV6_2 0x0738 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_POWER_MGT_3_V1 0x073C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_IPV6_3 0x073C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_PLCP_HEADER 0x0740 -+#define REG_TXDRXDMONITOR 0x0744 -+#define REG_TXDRXDMONITOR_CTL 0x0748 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_RTX_CTX_SUBTYPE_CFG 0x0750 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_WMAC_SWAES_RD0_V1 0x0754 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_SWAES_DIO_B63_B32 0x0754 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_WMAC_SWAES_RD1_V1 0x0758 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_SWAES_DIO_B95_B64 0x0758 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_WMAC_SWAES_RD3_V1 0x075C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_SWAES_DIO_B127_B96 0x075C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_SWAES_CFG 0x0760 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_COEX_V2 0x0762 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_BT_COEX 0x0764 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_WLAN_ACT_MSK_CTRL 0x0768 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WLAN_ACT_MASK_CTRL 0x0768 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WLAN_ACT_MASK_CTRL_1 0x076C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BT_STATISTICS_CTRL 0x076E -+#define REG_BT_COEX_ENH_INTF_CTRL 0x076E -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_COEX_ENHANCED_INTR_CTRL 0x076E -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8881A_SUPPORT) -+ -+#define REG_BT_ACT_STATISTICS 0x0770 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_ACT_STATISTICS_1 0x0774 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BT_STATISTICS_OTH_CTRL 0x0778 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_STATISTICS_CONTROL_REGISTER 0x0778 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BT_CMD_ID 0x077C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_STATUS_REPORT_REGISTER 0x077C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BT__STATUS_RPT 0x077D -+#define REG_BT_DATA 0x0780 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_INTERRUPT_CONTROL_REGISTER 0x0780 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_WLAN_RPT_ 0x0781 -+#define REG_BT_ISR_CTRL 0x0783 -+#define REG_WLAN_RPT_TO_CTR 0x0784 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER 0x0784 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BT_ISOLATION_TABLE 0x0785 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER 0x0785 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_1 0x0788 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_2 0x078C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BT_ISR_STA 0x078F -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_INTERRUPT_STATUS_REGISTER 0x078F -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_TDMA_TIME_AND_RPT_SAM_SET 0x0790 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_TDMA_TIME_REGISTER 0x0790 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BT_CH_INFO 0x0794 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BT_ACT_REGISTER 0x0794 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_BT_STATIC_INFO_EXT 0x0795 -+#define REG_LTR_IDLE_LATENCY 0x0798 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_LTR_IDLE_LATENCY_V2 0x0798 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_OBFF_CTRL_BASIC 0x0798 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_LTR_ACTIVE_LATENCY 0x079C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_LTR_ACTIVE_LATENCY_V2 0x079C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_OBFF_CTRL2_TIMER 0x079C -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_OBFF_CTRL 0x07A0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_LTR_CTRL_BASIC 0x07A0 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_LTR_CTRL 0x07A4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_LTR_CTRL2_TIMER_THRESHOLD 0x07A4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_LTR_CTRL2 0x07A8 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_LTR_IDLE_LATENCY_V1 0x07A8 -+#define REG_LTR_ACTIVE_LATENCY_V1 0x07AC -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_ANTTRN_CTRL 0x07B0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_ANTTRN_CTR_V1 0x07B0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ANTENNA_TRAINING_CONTROL_REGISTER 0x07B0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_SMART_ANT_CONDITION 0x07B0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_ANTTRN_CTR 0x07B4 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_ANTENNA_TRAINING_CONTROL_REGISTER_1 0x07B4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_SMART_ANT_CTRL 0x07B4 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_WMAC_PKTCNT_RWD 0x07B8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_CONTROL_FRAME_REPORT 0x07B8 -+ -+#endif -+ -+#if (HALMAC_8192E_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8881A_SUPPORT) -+ -+#define REG_WMAC_PKTCNT_CTRL 0x07BC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_CONTROL_FRAME_CNT_CTRL 0x07BC -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL 0x07C0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_IQ_DUMP 0x07C0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA 0x07C4 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_IQ_DUMP_1 0x07C4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA 0x07C8 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_IQ_DUMP_2 0x07C8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_FTM_CTL 0x07CC -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_IQ_MDPK_FUNC 0x07CE -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_IQ_DUMP_EXT 0x07CF -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT) -+ -+#define REG_OFDM_CCK_LEN_MASK 0x07D0 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_OPTION_FUNCTION 0x07D0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_FA_FILTER1 0x07D4 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_OPTION_FUNCTION_1 0x07D4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_FA_FILTER2 0x07D8 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_OPTION_FUNCTION_2 0x07D8 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RX_FILTER_FUNCTION 0x07DA -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_NAN_FUN 0x07DC -+#define REG_NAN_CTL 0x07E0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_NDP_SIG 0x07E0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RX_NAN_ADDR_FILTER 0x07E4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_TXCMD_INFO_FOR_RSP_PKT 0x07E4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_NAN_ADDR 0x07E8 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TXCMD_INFO_FOR_RSP_PKT_1 0x07E8 -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+#define REG_SEC_OPT 0x07E8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_RXA1_MASK 0x07EC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_SEC_OPT_V2 0x07EC -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WSEC_OPTION 0x07EC -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_DUMP_FUNC 0x07F0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RTS_ADDRESS_0 0x07F0 -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+#define REG_RTS_ADDR0 0x07F0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_MASK_LA_MAC 0x07F4 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RTS_ADDRESS_0_1 0x07F4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_MATCH_REF_MAC 0x07F8 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RTS_ADDRESS_1 0x07F8 -+ -+#endif -+ -+#if (HALMAC_8814AMP_SUPPORT) -+ -+#define REG_RTS_ADDR1 0x07F8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_LA_DUMP_FUNC_EXT 0x07FC -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RTS_ADDRESS_1_1 0x07FC -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+#define REG__RPFM_MAP1 0x07FE -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SYS_CFG3 0x1000 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ANAPARSW_MAC_0 0x1010 -+#define REG_ANAPARSW_MAC_1 0x1014 -+#define REG_ANAPAR_MAC_0 0x1018 -+#define REG_ANAPAR_MAC_1 0x101C -+#define REG_ANAPAR_MAC_2 0x1020 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ANAPAR_MAC_3 0x1024 -+#define REG_ANAPAR_MAC_4 0x1028 -+#define REG_ANAPAR_MAC_5 0x102C -+#define REG_ANAPAR_MAC_6 0x1030 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_SYS_CFG4 0x1034 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ANAPAR_MAC_7 0x1034 -+#define REG_ANAPAR_MAC_8 0x1038 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ANAPAR_XTAL_0 0x1040 -+#define REG_ANAPAR_XTAL_1 0x1044 -+#define REG_ANAPAR_XTAL_2 0x1048 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ANAPAR_XTAL_3 0x104C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ANAPAR_XTAL_AAC 0x104C -+#define REG_ANAPAR_XTAL_R_ONLY 0x1050 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ANAPAR_XTAL_AACK_0 0x1054 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_CPHY_LDO 0x1054 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ANAPAR_XTAL_AACK_1 0x1058 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_CPHY_BG 0x1058 -+#define REG_HIMR_4 0x1060 -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+#define REG_XTAL_AAC_OUTPUT 0x1060 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_ANAPAR_XTAL_MODE_DECODER 0x1064 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HISR_4 0x1064 -+#define REG_HIMR_5 0x1068 -+#define REG_HISR_5 0x106C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SYS_CFG5 0x1070 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+#define REG_REGU_32K_1 0x1078 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HIMR_6 0x1078 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+#define REG_REGU_32K_2 0x107C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HISR_6 0x107C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_CPU_DMEM_CON 0x1080 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BOOT_REASON 0x1088 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HIMR4 0x1090 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_DATA_CPU_CTL0 0x1090 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HISR4 0x1094 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_DATA_CPU_CTL1 0x1094 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HIMR5 0x1098 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TXDMA_STOP_HIMR 0x1098 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HISR5 0x109C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TXDMA_STOP_HISR 0x109C -+#define REG_TXDMA_START_HIMR 0x10A0 -+#define REG_TXDMA_START_HISR 0x10A4 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_NFC_PAD_CTRL 0x10A8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_NFCPAD_CTRL 0x10A8 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_HIMR2 0x10B0 -+#define REG_HISR2 0x10B4 -+#define REG_HIMR3 0x10B8 -+#define REG_HISR3 0x10BC -+#define REG_SW_MDIO 0x10C0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_SW_FLUSH 0x10C4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_DBG_GPIO_BMUX 0x10C8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HIMR_7 0x10C8 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_FPGA_TAG 0x10CC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HISR_7 0x10CC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_WL_DSS_CTRL0 0x10D0 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_H2C_PKT_READADDR 0x10D0 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_WL_DSS_STATUS0 0x10D4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_H2C_PKT_WRITEADDR 0x10D4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_WL_DSS_CTRL1 0x10D8 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MEM_PWR_CRTL 0x10D8 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_WL_DSS_STATUS1 0x10DC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_FW_DRV_HANDSHAKE 0x10DC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_FW_DBG0 0x10E0 -+#define REG_FW_DBG1 0x10E4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_FW_DBG2 0x10E8 -+#define REG_FW_DBG3 0x10EC -+#define REG_FW_DBG4 0x10F0 -+#define REG_FW_DBG5 0x10F4 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FW_DBG6 0x10F8 -+#define REG_FW_DBG7 0x10FC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_CR_EXT 0x1100 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TC9_CTRL 0x1104 -+#define REG_TC10_CTRL 0x1108 -+#define REG_TC11_CTRL 0x110C -+#define REG_TC12_CTRL 0x1110 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_FWFF 0x1114 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_RXFF_PTR_V1 0x1118 -+#define REG_RXFF_WTR_V1 0x111C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_FE2IMR 0x1120 -+#define REG_FE2ISR 0x1124 -+#define REG_FE3IMR 0x1128 -+#define REG_FE3ISR 0x112C -+#define REG_FE4IMR 0x1130 -+#define REG_FE4ISR 0x1134 -+#define REG_FT1IMR 0x1138 -+#define REG_FT1ISR 0x113C -+#define REG_SPWR0 0x1140 -+#define REG_SPWR1 0x1144 -+#define REG_SPWR2 0x1148 -+#define REG_SPWR3 0x114C -+#define REG_POWSEQ 0x1150 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TC7_CTRL_V1 0x1158 -+#define REG_TC8_CTRL_V1 0x115C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_RXBCN_TBTT_INTERVAL_PORT0TO3 0x1160 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_RX_BCN_TBTT_ITVL0 0x1160 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_RXBCN_TBTT_INTERVAL_PORT4 0x1164 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_RX_BCN_TBTT_ITVL1 0x1164 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+#define REG_FWIMR1 0x1168 -+#define REG_FWISR1 0x116C -+#define REG_FWIMR2 0x1170 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_IO_WRAP_ERR_FLAG 0x1170 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+#define REG_FWISR2 0x1174 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_FWIMR3 0x1178 -+#define REG_FWISR3 0x117C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_SPEED_SENSOR 0x1180 -+#define REG_SPEED_SENSOR1 0x1184 -+#define REG_SPEED_SENSOR2 0x1188 -+#define REG_SPEED_SENSOR3 0x118C -+#define REG_SPEED_SENSOR4 0x1190 -+#define REG_SPEED_SENSOR5 0x1194 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_RXPKTBUF_1_MAX_ADDR 0x1198 -+#define REG_RXFWBUF_1_MAX_ADDR 0x119C -+#define REG_IO_WRAP_ERR_FLAG_V1 0x11A0 -+#define REG_RXPKTBUF_1_READ 0x11A4 -+#define REG_RXPKTBUF_1_WRITE 0x11A8 -+#define REG_BUFF_DBGUG 0x11AC -+#define REG_RFE_CTRL_PAD_E2 0x11B0 -+#define REG_RFE_CTRL_PAD_SR 0x11B4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+#define REG_EXT_QUEUE_REG 0x11C0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_H2C_PRIORITY_SEL 0x11C0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+#define REG_COUNTER_CONTROL 0x11C4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_COUNTER_CTRL 0x11C4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+#define REG_COUNTER_TH 0x11C8 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_COUNTER_THRESHOLD 0x11C8 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_COUNTER_SET 0x11CC -+#define REG_COUNTER_OVERFLOW 0x11D0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+#define REG_TDE_LEN_TH 0x11D4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_TXDMA_LEN_THRESHOLD 0x11D4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+#define REG_RDE_LEN_TH 0x11D8 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_RXDMA_LEN_THRESHOLD 0x11D8 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT) -+ -+#define REG_PCIE_EXEC_TIME 0x11DC -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_PCIE_EXEC_TIME_THRESHOLD 0x11DC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_FT2IMR 0x11E0 -+#define REG_FT2ISR 0x11E4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_MSG2 0x11F0 -+#define REG_MSG3 0x11F4 -+#define REG_MSG4 0x11F8 -+#define REG_MSG5 0x11FC -+#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 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_REG_DDMA_CH5CTRL 0x1258 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_DDMA_CH5CTRL 0x1258 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_DDMA_INT_MSK 0x12E0 -+#define REG_DDMA_CHSTATUS 0x12E8 -+#define REG_DDMA_CHKSUM 0x12F0 -+#define REG_DDMA_MONITOR 0x12FC -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_STC_INT_CS 0x1300 -+#define REG_ST_INT_CFG 0x1304 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH4_ACH5_TXBD_NUM 0x130C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_CMU_DLY_CTRL 0x1310 -+#define REG_CMU_DLY_CFG 0x1314 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_FWCMDQ_TXBD_IDX 0x1318 -+#define REG_P0HI8Q_TXBD_IDX 0x131C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_H2CQ_TXBD_DESA 0x1320 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_H2CQ_TXBD_DESA_L 0x1320 -+#define REG_H2CQ_TXBD_DESA_H 0x1324 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_H2CQ_TXBD_NUM 0x1328 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_H2CQ_TXBD_IDX 0x132C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_H2CQ_CSR 0x1330 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI9Q_TXBD_IDX 0x1334 -+#define REG_P0HI10Q_TXBD_IDX 0x1338 -+#define REG_P0HI11Q_TXBD_IDX 0x133C -+#define REG_P0HI12Q_TXBD_IDX 0x1340 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_CPL_BUFFER_MONITOR 0x1344 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI13Q_TXBD_IDX 0x1344 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_PTM_LOCAL_CLOCK 0x1348 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI14Q_TXBD_IDX 0x1348 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_PTM_LOCAL_CLOCK_H 0x134C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_P0HI15Q_TXBD_IDX 0x134C -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_TSFT_PTM_DIFF 0x1350 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_AXI_EXCEPT_CS 0x1350 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_CHANGE_PCIE_SPEED 0x1350 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_PTM_CTRL_STATUS 0x1354 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_AXI_EXCEPT_TIME 0x1354 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_DEBUG_STATE1 0x1354 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_QUEUE_HEADER_CUR_REMAIN 0x1358 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI8Q_TXBD_IDX 0x1358 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_DEBUG_STATE2 0x1358 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_QUEUE_HEADER_MIN_REMAIN 0x135C -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI9Q_TXBD_IDX 0x135C -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_DEBUG_STATE3 0x135C -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI10Q_TXBD_IDX 0x1360 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH5_TXBD_DESA_L 0x1360 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI11Q_TXBD_IDX 0x1364 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH5_TXBD_DESA_H 0x1364 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI12Q_TXBD_IDX 0x1368 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH6_TXBD_DESA_L 0x1368 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI13Q_TXBD_IDX 0x136C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH6_TXBD_DESA_H 0x136C -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI14Q_TXBD_IDX 0x1370 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH7_TXBD_DESA_L 0x1370 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI15Q_TXBD_IDX 0x1374 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH7_TXBD_DESA_H 0x1374 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI8Q_TXBD_DESA 0x1378 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH8_TXBD_DESA_L 0x1378 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_CHNL_DMA_CFG_V1 0x137C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH8_TXBD_DESA_H 0x137C -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI9Q_TXBD_DESA 0x1380 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH9_TXBD_DESA_L 0x1380 -+#define REG_ACH9_TXBD_DESA_H 0x1384 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI10Q_TXBD_DESA 0x1388 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH10_TXBD_DESA_L 0x1388 -+#define REG_ACH10_TXBD_DESA_H 0x138C -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI11Q_TXBD_DESA 0x1390 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH11_TXBD_DESA_L 0x1390 -+#define REG_ACH11_TXBD_DESA_H 0x1394 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI12Q_TXBD_DESA 0x1398 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH12_TXBD_DESA_L 0x1398 -+#define REG_ACH12_TXBD_DESA_H 0x139C -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI13Q_TXBD_DESA 0x13A0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH13_TXBD_DESA_L 0x13A0 -+#define REG_ACH13_TXBD_DESA_H 0x13A4 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI14Q_TXBD_DESA 0x13A8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HI0Q_TXBD_DESA_L 0x13A8 -+#define REG_HI0Q_TXBD_DESA_H 0x13AC -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI15Q_TXBD_DESA 0x13B0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HI1Q_TXBD_DESA_L 0x13B0 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PCIE_HISR0_V1 0x13B4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HI1Q_TXBD_DESA_H 0x13B4 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI8Q_TXBD_NUM 0x13B8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HI2Q_TXBD_DESA_L 0x13B8 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI9Q_TXBD_NUM 0x13BA -+#define REG_HI10Q_TXBD_NUM 0x13BC -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PCIE_HISR1_V1 0x13BC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HI2Q_TXBD_DESA_H 0x13BC -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI11Q_TXBD_NUM 0x13BE -+#define REG_HI12Q_TXBD_NUM 0x13C0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HI3Q_TXBD_DESA_L 0x13C0 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI13Q_TXBD_NUM 0x13C2 -+#define REG_HI14Q_TXBD_NUM 0x13C4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HI3Q_TXBD_DESA_H 0x13C4 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_HI15Q_TXBD_NUM 0x13C6 -+#define REG_HIQ_DMA_STOP 0x13C8 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HI4Q_TXBD_DESA_L 0x13C8 -+#define REG_HI4Q_TXBD_DESA_H 0x13CC -+#define REG_HI5Q_TXBD_DESA_L 0x13D0 -+#define REG_HI5Q_TXBD_DESA_H 0x13D4 -+#define REG_HI6Q_TXBD_DESA_L 0x13D8 -+#define REG_HI6Q_TXBD_DESA_H 0x13DC -+#define REG_HI7Q_TXBD_DESA_L 0x13E0 -+#define REG_HI7Q_TXBD_DESA_H 0x13E4 -+#define REG_ACH8_ACH9_TXBD_NUM 0x13E8 -+#define REG_ACH10_ACH11_TXBD_NUM 0x13EC -+#define REG_ACH12_ACH13_TXBD_NUM 0x13F0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_OLD_DEHANG 0x13F4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_ACH4_TXBD_DESA_L 0x13F8 -+#define REG_ACH4_TXBD_DESA_H 0x13FC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_Q0_Q1_INFO 0x1400 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_ARFR6 0x1400 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MU_OFFSET 0x1400 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_Q2_Q3_INFO 0x1404 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_ARFRH6 0x1404 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_Q4_Q5_INFO 0x1408 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_ARFR7 0x1408 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_Q6_Q7_INFO 0x140C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_ARFRH7 0x140C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_MGQ_HIQ_INFO 0x1410 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_ARFR8 0x1410 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || \ -+ HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_CMDQ_BCNQ_INFO 0x1414 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_ARFRH8 0x1414 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_USEREG_SETTING 0x1420 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_LOOPBACK_OPTION 0x1420 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_AESIV_SETTING 0x1424 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BF0_TIME_SETTING 0x1428 -+#define REG_BF1_TIME_SETTING 0x142C -+#define REG_BF_TIMEOUT_EN 0x1430 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID_RELEASE0 0x1434 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MACID_RELEASE_INFO 0x1434 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID_RELEASE1 0x1438 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MACID_RELEASE_SUCCESS_INFO 0x1438 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID_RELEASE2 0x143C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MACID_RELEASE_CTRL 0x143C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID_RELEASE3 0x1440 -+#define REG_MACID_RELEASE_SETTING 0x1444 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_FAST_EDCA_VOVI_SETTING 0x1448 -+#define REG_FAST_EDCA_BEBK_SETTING 0x144C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID_DROP0 0x1450 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MACID_DROP_INFO 0x1450 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID_DROP1 0x1454 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MACID_DROP_CTRL 0x1454 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID_DROP2 0x1458 -+#define REG_MACID_DROP3 0x145C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_R_MACID_RELEASE_SUCCESS_0 0x1460 -+#define REG_R_MACID_RELEASE_SUCCESS_1 0x1464 -+#define REG_R_MACID_RELEASE_SUCCESS_2 0x1468 -+#define REG_R_MACID_RELEASE_SUCCESS_3 0x146C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_MGG_FIFO_CRTL 0x1470 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MGQ_FIFO_WRITE_POINTER 0x1470 -+#define REG_MGQ_FIFO_READ_POINTER 0x1472 -+#define REG_MGQ_FIFO_ENABLE 0x1472 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_MGG_FIFO_INT 0x1474 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MGQ_FIFO_RELEASE_INT_MASK 0x1474 -+#define REG_MGQ_FIFO_RELEASE_INT_FLAG 0x1476 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_MGG_FIFO_LIFETIME 0x1478 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MGQ_FIFO_VALID_MAP 0x1478 -+#define REG_MGQ_FIFO_LIFETIME 0x147A -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET 0x147C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SHCUT_SETTING 0x1480 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PKT_TRANS 0x1480 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814AMP_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SHCUT_LLC_ETH_TYPE0 0x1484 -+#define REG_SHCUT_LLC_ETH_TYPE1 0x1488 -+#define REG_SHCUT_LLC_OUI0 0x148C -+#define REG_SHCUT_LLC_OUI1 0x1490 -+#define REG_SHCUT_LLC_OUI2 0x1494 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_SHCUT_LLC_OUI3 0x1498 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_FWCMDQ_CTRL 0x14A0 -+#define REG_FWCMDQ_PAGE 0x14A4 -+#define REG_FWCMDQ_INFO 0x14A8 -+#define REG_FWCMDQ_HOLD_PKTNUM 0x14AC -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MU_TX_CTL 0x14C0 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_MU_TX_CTRL 0x14C0 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MU_STA_GID_VLD 0x14C4 -+#define REG_MU_STA_USER_POS_INFO 0x14C8 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MU_STA_USER_POS_INFO_H 0x14CC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_CHNL_INFO_CTRL 0x14D0 -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_MU_TRX_DBG_CNT 0x14D0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_CHNL_IDLE_TIME 0x14D4 -+#define REG_CHNL_BUSY_TIME 0x14D8 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MU_TRX_DBG_CNT_V1 0x14DC -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_NEW_EDCA_CTRL 0x14F0 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+#define REG_SU_DURATION 0x14F0 -+#define REG_MU_DURATION 0x14F2 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+#define REG_SWPS_CTRL 0x14F4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+#define REG_HW_NDPA_RTY_LIMIT 0x14F4 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+#define REG_SWPS_PKT_TH 0x14F6 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+#define REG_SWPS_TIME_TH 0x14F8 -+#define REG_MACID_SWPS_EN 0x14FC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_CPUMGQ_TX_TIMER 0x1500 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PORT_CTRL_SEL 0x1500 -+#define REG_PORT_CTRL_CFG 0x1501 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_PS_TIMER_A 0x1504 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TBTT_PROHIBIT_CFG 0x1504 -+#define REG_DRVERLYINT_CFG 0x1507 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_PS_TIMER_B 0x1508 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BCNDMATIM_CFG 0x1508 -+#define REG_CTWND_CFG 0x1509 -+#define REG_BCNIVLCUNT_CFG 0x150A -+#define REG_EARLY_128US_CFG 0x150B -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_PS_TIMER_C 0x150C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TSFTR_SYNC_OFFSET_CFG 0x150C -+#define REG_TSFTR_SYNC_CTRL_CFG 0x150F -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL 0x1510 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BCN_SPACE_CFG 0x1510 -+#define REG_EARLY_INT_ADJUST_CFG 0x1512 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_CPUMGQ_TX_TIMER_EARLY 0x1514 -+#define REG_PS_TIMER_A_EARLY 0x1515 -+#define REG_PS_TIMER_B_EARLY 0x1516 -+#define REG_PS_TIMER_C_EARLY 0x1517 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_CPUMGQ_PARAMETER 0x1518 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_SW_TBTT_TSF_INFO 0x151C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_TSF_SYN_CTRL0 0x1520 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TSF_SYNC_ADJ 0x1520 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TSFTR_LOW 0x1520 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_TSF_SYN_CTRL1 0x1521 -+#define REG_TSF_SYN_OFFSET0 0x1522 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_TSF_SYN_OFFSET1 0x1524 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TSF_ADJ_VLAUE 0x1524 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TSFTR_HIGH 0x1524 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define REG_TSF_SYN_OFFSET2 0x1528 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TSF_ADJ_VLAUE_2 0x1528 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BCN_ERR_CNT_MAC 0x1528 -+#define REG_BCN_ERR_CNT_EDCCA 0x1529 -+#define REG_BCN_ERR_CNT_CCA 0x152A -+#define REG_BCN_ERR_CNT_INVALID 0x152B -+#define REG_BCN_ERR_CNT_OTHERS 0x152C -+#define REG_RX_BCN_TIMER 0x152D -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_TSF_SYN_COMPARE_VALUE_L 0x1530 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_TSF_SYN_COMPARE_VALUE 0x1530 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TBTT_CTN_AREA_V1 0x1530 -+#define REG_BCN_MAX_ERR_V1 0x1531 -+#define REG_RXTSF_OFFSET_CCK_V1 0x1532 -+#define REG_RXTSF_OFFSET_OFDM_V1 0x1533 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+#define REG_TSF_SYN_COMPARE_VALUE_H 0x1534 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_SUB_BCN_SPACE 0x1534 -+#define REG_MBID_NUM_V1 0x1535 -+#define REG_MBSSID_CTRL_V1 0x1536 -+#define REG_USTIME_TSF_V1 0x1538 -+#define REG_BW_CFG 0x1539 -+#define REG_ATIMWND_CFG 0x153A -+#define REG_DTIM_COUNTER_CFG 0x153B -+#define REG_ATIM_DTIM_CTRL_SEL 0x153C -+#define REG_ATIMUGT_V1 0x153D -+#define REG_BCNDROPCTRL_V1 0x153E -+#define REG_DIS_ATIM_V1 0x1540 -+#define REG_HIQ_NO_LMT_EN_V1 0x1544 -+#define REG_P2PPS_CTRL_V1 0x1548 -+#define REG_P2PPS_SPEC_STATE_V1 0x154A -+#define REG_P2PPS_STATE_V1 0x154B -+#define REG_P2PPS1_CTRL_V1 0x154C -+#define REG_P2PPS1_SPEC_STATE_V1 0x154E -+#define REG_P2PPS1_STATE_V1 0x154F -+#define REG_P2PPS2_CTRL_V1 0x1550 -+#define REG_P2PPS2_SPEC_STATE_V1 0x1552 -+#define REG_P2PPS2_STATE_V1 0x1553 -+#define REG_P2PON_DIS_TXTIME_V1 0x1554 -+#define REG_P2POFF_DIS_TXTIME_V1 0x1555 -+#define REG_CHG_POWER_BCN_AREA 0x1556 -+#define REG_NOA_SEL 0x1557 -+#define REG_NOA_PARAM_V1 0x1558 -+#define REG_NOA_PARAM_1_V1 0x155C -+#define REG_NOA_PARAM_2_V1 0x1560 -+#define REG_NOA_PARAM_3_V1 0x1564 -+#define REG_NOA_ON_ERLY_TIME_V1 0x1568 -+#define REG_NOA_OFF_ERLY_TIME_V1 0x1569 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_P2PPS_HW_AUTO_PAUSE_CTRL 0x156C -+#define REG_P2PPS1_HW_AUTO_PAUSE_CTRL 0x1570 -+#define REG_P2PPS2_HW_AUTO_PAUSE_CTRL 0x1574 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_RX_TBTT_SHIFT 0x1578 -+#define REG_FREERUN_CNT_LOW 0x1580 -+#define REG_FREERUN_CNT_HIGH 0x1584 -+#define REG_CPUMGQ_TX_TIMER_V1 0x1588 -+#define REG_PS_TIMER_0 0x158C -+#define REG_PS_TIMER_1 0x1590 -+#define REG_PS_TIMER_2 0x1594 -+#define REG_PS_TIMER_3 0x1598 -+#define REG_PS_TIMER_4 0x159C -+#define REG_PS_TIMER_5 0x15A0 -+#define REG_PS_TIMER_01_CTRL 0x15A4 -+#define REG_PS_TIMER_23_CTRL 0x15A8 -+#define REG_PS_TIMER_45_CTRL 0x15AC -+#define REG_CPUMGQ_FREERUN_TIMER_CTRL 0x15B0 -+#define REG_CPUMGQ_PROHIBIT 0x15B4 -+#define REG_TIMER_COMPARE 0x15C0 -+#define REG_TIMER_COMPARE_VALUE_LOW 0x15C4 -+#define REG_TIMER_COMPARE_VALUE_HIGH 0x15C8 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_SCHEDULER_COUNTER 0x15D0 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BCN_PSR_RPT2 0x1600 -+#define REG_BCN_PSR_RPT3 0x1604 -+#define REG_BCN_PSR_RPT4 0x1608 -+#define REG_A1_ADDR_MASK 0x160C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_RXPSF_CTRL 0x1610 -+#define REG_RXPSF_TYPE_CTRL 0x1614 -+#define REG_CAM_ACCESS_CTRL 0x1618 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_HT_SND_REF_RATE 0x161C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_CUT_AMSDU_CTRL 0x161C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID2 0x1620 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID2_H 0x1624 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BSSID2 0x1628 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BSSID2_H 0x162C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID3 0x1630 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID3_H 0x1634 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BSSID3 0x1638 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BSSID3_H 0x163C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID4 0x1640 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MACID4_H 0x1644 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814A_SUPPORT || HALMAC_8814AMP_SUPPORT || \ -+ HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_BSSID4 0x1648 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_BSSID4_H 0x164C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_NOA_REPORT 0x1650 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_NOA_REPORT_1 0x1654 -+#define REG_NOA_REPORT_2 0x1658 -+#define REG_NOA_REPORT_3 0x165C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PWRBIT_SETTING 0x1660 -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+#define REG_MACRX_HANG_TIMER_CONTROL 0x1661 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_GENERAL_OPTION 0x1664 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define REG_RXAI_CTRL 0x1668 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_FWPHYFF_RCR 0x1668 -+#define REG_ADDRCAM_WRITE_CONTENT 0x166C -+#define REG_ADDRCAM_READ_CONTENT 0x1670 -+#define REG_ADDRCAM_CFG 0x1674 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_CSI_RRSR 0x1678 -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+#define REG_WMAC_CSI_FRAME_RRSR_SETTING 0x1678 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822B_SUPPORT) -+ -+#define REG_WMAC_MU_BF_OPTION 0x167C -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_MU_BF_OPTION 0x167C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_PAUSE_BB_CLR_TH 0x167D -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT) -+ -+#define REG_WMAC_MU_ARB 0x167E -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG__WMAC_MULBK_BUF 0x167E -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_WMAC_MULBK_BUF 0x167E -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_MU_OPTION 0x167F -+#define REG_WMAC_MU_BF_CTL 0x1680 -+#define REG_WMAC_MU_BFRPT_PARA 0x1682 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE2 0x1684 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE3 0x1686 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE4 0x1688 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE5 0x168A -+#define REG_WMAC_ASSOCIATED_MU_BFMEE6 0x168C -+#define REG_WMAC_ASSOCIATED_MU_BFMEE7 0x168E -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_BB_STOP_RX_COUNTER 0x1690 -+#define REG_WMAC_PLCP_MONITOR 0x1694 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_PLCP_MONITOR_MUTX 0x1698 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_WMAC_DEBUG_PORT 0x1698 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WMAC_CSIDMA_CFG 0x169C -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TRANSMIT_ADDRSS_0 0x16A0 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TRANSMIT_ADDRSS_0_H 0x16A4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TRANSMIT_ADDRSS_1 0x16A8 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TRANSMIT_ADDRSS_1_H 0x16AC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TRANSMIT_ADDRSS_2 0x16B0 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TRANSMIT_ADDRSS_2_H 0x16B4 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TRANSMIT_ADDRSS_3 0x16B8 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TRANSMIT_ADDRSS_3_H 0x16BC -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TRANSMIT_ADDRSS_4 0x16C0 -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_TRANSMIT_ADDRSS_4_H 0x16C4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+#define REG_SND_AID12 0x16D0 -+#define REG_SND_PKT_INFO 0x16D2 -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822B_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1 0x1700 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1 0x1704 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1 0x1708 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_BIST_RSTN0 0x2100 -+#define REG_BIST_RSTN2 0x2108 -+#define REG_BIST_MODE_NRML0 0x2110 -+#define REG_BIST_MODE_NRML1 0x2114 -+#define REG_BIST_MODE_NRML2 0x2118 -+#define REG_BIST_MODE_NRML3 0x211C -+#define REG_BIST_DONE_NRML_MAC 0x2150 -+#define REG_BIST_DONE_NRML1 0x2158 -+#define REG_BIST_DONE_DRF_MAC 0x2160 -+#define REG_BIST_DONE_DRF 0x2164 -+#define REG_BIST_DONE_DRF1 0x2168 -+#define REG_BIST_FAIL_NRML_MAC 0x2170 -+#define REG_BIST_FAIL_NRML 0x2174 -+#define REG_BIST_FAIL_NRML1 0x2178 -+#define REG_BIST_FAIL_NRML_MAC_V1 0x2180 -+#define REG_BIST_FAIL_NRML_V1 0x2184 -+#define REG_BIST_FAIL_NRML1_V1 0x2188 -+#define REG_BIST_MISR_DATAOUT 0x2190 -+#define REG_BIST_MISR_DATAOUT1 0x2194 -+#define REG_BIST_MISR_DATAOUT_CPU 0x2198 -+#define REG_BIST_MISR_DATAOUT_CPU1 0x219C -+#define REG_BIST_MISR_DATAOUT_CPU2 0x21A0 -+#define REG_BIST_MISR_DATOUT_CPU3 0x21A4 -+#define REG_DMA_RQPN_INFO_0 0x2200 -+#define REG_DMA_RQPN_INFO_1 0x2204 -+#define REG_DMA_RQPN_INFO_2 0x2208 -+#define REG_DMA_RQPN_INFO_3 0x220C -+#define REG_DMA_RQPN_INFO_4 0x2210 -+#define REG_DMA_RQPN_INFO_5 0x2214 -+#define REG_DMA_RQPN_INFO_6 0x2218 -+#define REG_DMA_RQPN_INFO_7 0x221C -+#define REG_DMA_RQPN_INFO_8 0x2220 -+#define REG_DMA_RQPN_INFO_9 0x2224 -+#define REG_DMA_RQPN_INFO_10 0x2228 -+#define REG_DMA_RQPN_INFO_11 0x222C -+#define REG_DMA_RQPN_INFO_12 0x2230 -+#define REG_DMA_RQPN_INFO_13 0x2234 -+#define REG_DMA_RQPN_INFO_14 0x2238 -+#define REG_DMA_RQPN_INFO_15 0x223C -+#define REG_DMA_RQPN_INFO_16 0x2240 -+#define REG_HWAMSDU_CTL1 0x2250 -+#define REG_HWAMSDU_CTL2 0x2254 -+#define REG_HI8Q_TXBD_DESA_L 0x2300 -+#define REG_HI8Q_TXBD_DESA_H 0x2304 -+#define REG_HI9Q_TXBD_DESA_L 0x2308 -+#define REG_HI9Q_TXBD_DESA_H 0x230C -+#define REG_HI10Q_TXBD_DESA_L 0x2310 -+#define REG_HI10Q_TXBD_DESA_H 0x2314 -+#define REG_HI11Q_TXBD_DESA_L 0x2318 -+#define REG_HI11Q_TXBD_DESA_H 0x231C -+#define REG_HI12Q_TXBD_DESA_L 0x2320 -+#define REG_HI12Q_TXBD_DESA_H 0x2324 -+#define REG_HI13Q_TXBD_DESA_L 0x2328 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_H2CQ_TXBD_IDX_V1 0x232C -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_HI13Q_TXBD_DESA_H 0x232C -+#define REG_HI14Q_TXBD_DESA_L 0x2330 -+#define REG_HI14Q_TXBD_DESA_H 0x2334 -+#define REG_HI15Q_TXBD_DESA_L 0x2338 -+#define REG_HI15Q_TXBD_DESA_H 0x233C -+#define REG_HI16Q_TXBD_DESA_L 0x2340 -+#define REG_HI16Q_TXBD_DESA_H 0x2344 -+#define REG_HI17Q_TXBD_DESA_L 0x2348 -+#define REG_HI17Q_TXBD_DESA_H 0x234C -+#define REG_HI18Q_TXBD_DESA_L 0x2350 -+#define REG_HI18Q_TXBD_DESA_H 0x2354 -+#define REG_HI19Q_TXBD_DESA_L 0x2358 -+#define REG_HI19Q_TXBD_DESA_H 0x235C -+#define REG_BD_RWPTR_CLR6 0x2364 -+#define REG_P0HI16Q_TXBD_IDX 0x2370 -+#define REG_P0HI17Q_TXBD_IDX 0x2374 -+#define REG_P0HI18Q_TXBD_IDX 0x2378 -+#define REG_P0HI19Q_TXBD_IDX 0x237C -+#define REG_P0HI16Q_HI17Q_TXBD_NUM 0x2380 -+#define REG_P0HI18Q_HI19Q_TXBD_NUM 0x2384 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PCIE_HISR2_V1 0x23B4 -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PCIE_HISR0 0x23B4 -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define REG_PCIE_HISR3_V1 0x23BC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_PCIE_HISR1 0x23BC -+#define REG_P0HI8Q_HI9Q_TXBD_NUM 0x23C0 -+#define REG_P0HI10Q_HI11Q_TXBD_NUM 0x23C4 -+#define REG_P0HI12Q_HI13Q_TXBD_NUM 0x23C8 -+#define REG_P0HI14Q_HI15Q_TXBD_NUM 0x23CC -+#define REG_ACH6_ACH7_TXBD_NUM 0x23F0 -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define REG_BF0_TIME_SETTING_V1 0x2428 -+#define REG_BF1_TIME_SETTING_V1 0x242C -+#define REG_BF_TIMEOUT_EN_V1 0x2430 -+#define REG_MACID_RELEASE0_V1 0x2434 -+#define REG_MACID_RELEASE1_V1 0x2438 -+#define REG_MACID_RELEASE2_V1 0x243C -+#define REG_MACID_RELEASE3_V1 0x2440 -+#define REG_MACID_RELEASE_SETTING_V1 0x2444 -+#define REG_FAST_EDCA_VOVI_SETTING_V1 0x2448 -+#define REG_FAST_EDCA_BEBK_SETTING_V1 0x244C -+#define REG_R_MACID_RELEASE_SUCCESS_0_V1 0x2460 -+#define REG_R_MACID_RELEASE_SUCCESS_1_V1 0x2464 -+#define REG_R_MACID_RELEASE_SUCCESS_2_V1 0x2468 -+#define REG_R_MACID_RELEASE_SUCCESS_3_V1 0x246C -+#define REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_V1 0x247C -+#define REG_NAN_INFO0 0x2480 -+#define REG_NAN_INFO1 0x2484 -+#define REG_NAN_INFO2 0x2488 -+#define REG_NAN_INFO3 0x248C -+#define REG_NAN_INFO4 0x2490 -+#define REG_NAN_INFO5 0x2494 -+#define REG_NAN_INFO6 0x2498 -+#define REG_NAN_INFO7 0x249C -+#define REG_NAN_INFO8 0x24A0 -+#define REG_NAN_INFO9 0x24A4 -+#define REG_CHNL_INFO_CTRL_V1 0x24D0 -+#define REG_CHNL_IDLE_TIME_V1 0x24D4 -+#define REG_CHNL_BUSY_TIME_V1 0x24D8 -+#define REG_SWPS_CTRL_V1 0x24F4 -+#define REG_SWPS_PKT_TH_V1 0x24F6 -+#define REG_SWPS_TIME_TH_V1 0x24F8 -+#define REG_MACID_SWPS_EN_V1 0x24FC -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define REG_TXPAGE_INT_CTRL_0 0x3200 -+#define REG_TXPAGE_INT_CTRL_1 0x3204 -+#define REG_TXPAGE_INT_CTRL_2 0x3208 -+#define REG_TXPAGE_INT_CTRL_3 0x320C -+#define REG_TXPAGE_INT_CTRL_4 0x3210 -+#define REG_TXPAGE_INT_CTRL_5 0x3214 -+#define REG_TXPAGE_INT_CTRL_6 0x3218 -+#define REG_TXPAGE_INT_CTRL_7 0x321C -+#define REG_TXPAGE_INT_CTRL_8 0x3220 -+#define REG_TXPAGE_INT_CTRL_9 0x3224 -+#define REG_TXPAGE_INT_CTRL_10 0x3228 -+#define REG_TXPAGE_INT_CTRL_11 0x322C -+#define REG_TXPAGE_INT_CTRL_12 0x3230 -+#define REG_TXPAGE_INT_CTRL_13 0x3234 -+#define REG_TXPAGE_INT_CTRL_14 0x3238 -+#define REG_TXPAGE_INT_CTRL_15 0x323C -+#define REG_TXPAGE_INT_CTRL_16 0x3240 -+#define REG_ACH4_TXBD_IDX 0x3340 -+#define REG_ACH5_TXBD_IDX 0x3344 -+#define REG_ACH6_TXBD_IDX 0x3348 -+#define REG_ACH7_TXBD_IDX 0x334C -+#define REG_ACH8_TXBD_IDX 0x3350 -+#define REG_ACH9_TXBD_IDX 0x3354 -+#define REG_ACH10_TXBD_IDX 0x3358 -+#define REG_ACH11_TXBD_IDX 0x335C -+#define REG_ACH12_TXBD_IDX 0x3360 -+#define REG_ACH13_TXBD_IDX 0x3364 -+#define REG_AC_CHANNEL0_WEIGHT 0x3368 -+#define REG_AC_CHANNEL1_WEIGHT 0x3369 -+#define REG_AC_CHANNEL2_WEIGHT 0x336A -+#define REG_AC_CHANNEL3_WEIGHT 0x336B -+#define REG_AC_CHANNEL4_WEIGHT 0x336C -+#define REG_AC_CHANNEL5_WEIGHT 0x336D -+#define REG_AC_CHANNEL6_WEIGHT 0x336E -+#define REG_AC_CHANNEL7_WEIGHT 0x336F -+#define REG_AC_CHANNEL8_WEIGHT 0x3370 -+#define REG_AC_CHANNEL9_WEIGHT 0x3371 -+#define REG_AC_CHANNEL10_WEIGHT 0x3372 -+#define REG_AC_CHANNEL11_WEIGHT 0x3373 -+#define REG_AC_CHANNEL12_WEIGHT 0x3374 -+#define REG_AC_CHANNEL13_WEIGHT 0x3375 -+#define REG_PCIE_HISR2 0x33B4 -+#define REG_PCIE_HISR3 0x33BC -+ -+#endif -+ -+/* ----------------------------------------------------- */ -+/* */ -+/* 0xFB00h ~ 0xFCFFh TX/RX packet buffer affress */ -+/* */ -+/* ----------------------------------------------------- */ -+#define REG_RXPKTBUF_STARTADDR 0xFB00 -+#define REG_TXPKTBUF_STARTADDR 0xFC00 -+ -+/* ----------------------------------------------------- */ -+/* */ -+/* 0xFD00h ~ 0xFDFFh 8051 CPU Local REG */ -+/* */ -+/* ----------------------------------------------------- */ -+#define REG_SYS_CTRL 0xFD00 -+#define REG_PONSTS_RPT1 0xFD01 -+#define REG_PONSTS_RPT2 0xFD02 -+#define REG_PONSTS_RPT3 0xFD03 -+#define REG_PONSTS_RPT4 0xFD04 /* 0x84 */ -+#define REG_PONSTS_RPT5 0xFD05 /* 0x85 */ -+#define REG_8051ERRFLAG 0xFD08 -+#define REG_8051ERRFLAG_MASK 0xFD09 -+#define REG_TXADDRH 0xFD10 /* Tx Packet High Address */ -+#define REG_RXADDRH 0xFD11 /* Rx Packet High Address */ -+#define REG_TXADDRH_EXT 0xFD12 -+ -+#define REG_U3_STATE 0xFD48 -+ -+/* for MAILBOX */ -+#define REG_OUTDATA0 0xFD50 -+#define REG_OUTDATA1 0xFD54 -+#define REG_OUTRDY 0xFD58 /* bit[0] : OutReady, bit[1] : OutEmptyIntEn */ -+ -+#define REG_INDATA0 0xFD60 -+#define REG_INDATA1 0xFD64 -+#define REG_INRDY 0xFD68 /* bit[0] : InReady, bit[1] : InRdyIntEn */ -+ -+/* MCU ERROR debug REG */ -+#define REG_MCUERR_PCLSB 0xFD90 /* PC[7:0] */ -+#define REG_MCUERR_PCMSB 0xFD91 /* PC[15:8] */ -+#define REG_MCUERR_ACC 0xFD92 -+#define REG_MCUERR_B 0xFD93 -+#define REG_MCUERR_DPTRLSB 0xFD94 /* DPTR[7:0] */ -+#define REG_MCUERR_DPTRMSB 0xFD95 /* DPTR[15:8] */ -+#define REG_MCUERR_SP 0xFD96 /* SP[7:0] */ -+#define REG_MCUERR_IE 0xFD97 /* IE[7:0] */ -+#define REG_MCUERR_EIE 0xFD98 /* EIE[7:0] */ -+#define REG_VERA_SIM 0xFD9F -+/* 0xFD99~0xFD9F are reserved.. */ -+ -+/* ----------------------------------------------------- */ -+/* */ -+/* 0xFE00h ~ 0xFEFFh USB Configuration */ -+/* */ -+/* ----------------------------------------------------- */ -+ -+/* RTS5101 USB Register Definition */ -+#define REG_USB_SETUP_DEC_INT 0xFE00 -+#define REG_USB_DMACTL 0xFE01 -+#define REG_USB_IRQSTAT0 0xFE02 -+#define REG_USB_IRQSTAT1 0xFE03 -+#define REG_USB_IRQEN0 0xFE04 -+#define REG_USB_IRQEN1 0xFE05 -+#define REG_USB_AUTOPTRL 0xFE06 -+#define REG_USB_AUTOPTRH 0xFE07 -+#define REG_USB_AUTODAT 0xFE08 -+ -+#define REG_USB_SCRATCH0 0xFE09 -+#define REG_USB_SCRATCH1 0xFE0A -+#define REG_USB_SEEPROM 0xFE0B -+#define REG_USB_GPIO0 0xFE0C -+#define REG_USB_GPIO0DIR 0xFE0D -+#define REG_USB_CLKSEL 0xFE0E -+#define REG_USB_BOOTCTL 0xFE0F -+ -+#define REG_USB_USBCTL 0xFE10 -+#define REG_USB_USBSTAT 0xFE11 -+#define REG_USB_DEVADDR 0xFE12 -+#define REG_USB_USBTEST 0xFE13 -+#define REG_USB_FNUM0 0xFE14 -+#define REG_USB_FNUM1 0xFE15 -+ -+#define REG_USB_EP_IDX 0xFE20 -+#define REG_USB_EP_CFG 0xFE21 -+#define REG_USB_EP_CTL 0xFE22 -+#define REG_USB_EP_STAT 0xFE23 -+#define REG_USB_EP_IRQ 0xFE24 -+#define REG_USB_EP_IRQEN 0xFE25 -+#define REG_USB_EP_MAXPKT0 0xFE26 -+#define REG_USB_EP_MAXPKT1 0xFE27 -+#define REG_USB_EP_DAT 0xFE28 -+#define REG_USB_EP_BC0 0xFE29 -+#define REG_USB_EP_BC1 0xFE2A -+#define REG_USB_EP_TC0 0xFE2B -+#define REG_USB_EP_TC1 0xFE2C -+#define REG_USB_EP_TC2 0xFE2D -+#define REG_USB_EP_CTL2 0xFE2E -+ -+#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_VID 0xFE60 -+#define REG_USB_PID 0xFE62 -+#define REG_USB_OPT 0xFE64 -+#define REG_USB_CONFIG 0xFE65 -+ -+#define REG_USB_PHY_PARA1 0xFE68 -+#define REG_USB_PHY_PARA2 0xFE69 -+#define REG_USB_PHY_PARA3 0xFE6A -+#define REG_USB_PHY_PARA4 0xFE6B -+#define REG_USB_OPT2 0xFE6C -+#define REG_USB_MAC_ADDR 0xFE70 -+#define REG_USB_MANUFACTURE_SETTING 0xFE80 -+#define REG_USB_PRODUCT_STRING 0xFEA0 -+#define REG_USB_SERIAL_NUMBER_STRING 0xFED0 -+ -+#define REG_USB_ALTERNATE_SETTING 0xFE4F -+#define REG_USB_INT_BINTERVAL 0xFE6E -+#define REG_USB_GPS_EP_CONFIG 0xFE6D -+ -+#endif /* __HALMAC_COM_REG_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8197f.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8197f.h -new file mode 100644 -index 000000000..dd1985b05 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8197f.h -@@ -0,0 +1,703 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_REG_8197F_H -+#define __INC_HALMAC_REG_8197F_H -+ -+#define REG_SYS_ISO_CTRL_8197F 0x0000 -+#define REG_SYS_FUNC_EN_8197F 0x0002 -+#define REG_SYS_PW_CTRL_8197F 0x0004 -+#define REG_SYS_CLK_CTRL_8197F 0x0008 -+#define REG_SYS_EEPROM_CTRL_8197F 0x000A -+#define REG_EE_VPD_8197F 0x000C -+#define REG_SYS_SWR_CTRL1_8197F 0x0010 -+#define REG_SYS_SWR_CTRL2_8197F 0x0014 -+#define REG_SYS_SWR_CTRL3_8197F 0x0018 -+#define REG_RSV_CTRL_8197F 0x001C -+#define REG_RF0_CTRL_8197F 0x001F -+#define REG_AFE_LDO_CTRL_8197F 0x0020 -+#define REG_AFE_CTRL1_8197F 0x0024 -+#define REG_AFE_CTRL2_8197F 0x0028 -+#define REG_AFE_CTRL3_8197F 0x002C -+#define REG_EFUSE_CTRL_8197F 0x0030 -+#define REG_LDO_EFUSE_CTRL_8197F 0x0034 -+#define REG_PWR_OPTION_CTRL_8197F 0x0038 -+#define REG_CAL_TIMER_8197F 0x003C -+#define REG_ACLK_MON_8197F 0x003E -+#define REG_GPIO_MUXCFG_8197F 0x0040 -+#define REG_GPIO_PIN_CTRL_8197F 0x0044 -+#define REG_GPIO_INTM_8197F 0x0048 -+#define REG_LED_CFG_8197F 0x004C -+#define REG_FSIMR_8197F 0x0050 -+#define REG_FSISR_8197F 0x0054 -+#define REG_HSIMR_8197F 0x0058 -+#define REG_HSISR_8197F 0x005C -+#define REG_GPIO_EXT_CTRL_8197F 0x0060 -+#define REG_PAD_CTRL1_8197F 0x0064 -+#define REG_WL_BT_PWR_CTRL_8197F 0x0068 -+#define REG_SDM_DEBUG_8197F 0x006C -+#define REG_SYS_SDIO_CTRL_8197F 0x0070 -+#define REG_HCI_OPT_CTRL_8197F 0x0074 -+#define REG_AFE_CTRL4_8197F 0x0078 -+#define REG_LDO_SWR_CTRL_8197F 0x007C -+#define REG_MCUFW_CTRL_8197F 0x0080 -+#define REG_MCU_TST_CFG_8197F 0x0084 -+#define REG_HMEBOX_E0_E1_8197F 0x0088 -+#define REG_HMEBOX_E2_E3_8197F 0x008C -+#define REG_WLLPS_CTRL_8197F 0x0090 -+#define REG_AFE_CTRL5_8197F 0x0094 -+#define REG_GPIO_DEBOUNCE_CTRL_8197F 0x0098 -+#define REG_RPWM2_8197F 0x009C -+#define REG_SYSON_FSM_MON_8197F 0x00A0 -+#define REG_AFE_CTRL6_8197F 0x00A4 -+#define REG_PMC_DBG_CTRL1_8197F 0x00A8 -+#define REG_AFE_CTRL7_8197F 0x00AC -+#define REG_HIMR0_8197F 0x00B0 -+#define REG_HISR0_8197F 0x00B4 -+#define REG_HIMR1_8197F 0x00B8 -+#define REG_HISR1_8197F 0x00BC -+#define REG_DBG_PORT_SEL_8197F 0x00C0 -+#define REG_PAD_CTRL2_8197F 0x00C4 -+#define REG_PMC_DBG_CTRL2_8197F 0x00CC -+#define REG_BIST_CTRL_8197F 0x00D0 -+#define REG_BIST_RPT_8197F 0x00D4 -+#define REG_MEM_CTRL_8197F 0x00D8 -+#define REG_AFE_CTRL8_8197F 0x00DC -+#define REG_USB_SIE_INTF_8197F 0x00E0 -+#define REG_PCIE_MIO_INTF_8197F 0x00E4 -+#define REG_PCIE_MIO_INTD_8197F 0x00E8 -+#define REG_WLRF1_8197F 0x00EC -+#define REG_SYS_CFG1_8197F 0x00F0 -+#define REG_SYS_STATUS1_8197F 0x00F4 -+#define REG_SYS_STATUS2_8197F 0x00F8 -+#define REG_SYS_CFG2_8197F 0x00FC -+#define REG_SYS_CFG3_8197F 0x1000 -+#define REG_SYS_CFG4_8197F 0x1034 -+#define REG_CPU_DMEM_CON_8197F 0x1080 -+#define REG_HIMR2_8197F 0x10B0 -+#define REG_HISR2_8197F 0x10B4 -+#define REG_HIMR3_8197F 0x10B8 -+#define REG_HISR3_8197F 0x10BC -+#define REG_SW_MDIO_8197F 0x10C0 -+#define REG_SW_FLUSH_8197F 0x10C4 -+#define REG_DBG_GPIO_BMUX_8197F 0x10C8 -+#define REG_FPGA_TAG_8197F 0x10CC -+#define REG_WL_DSS_CTRL0_8197F 0x10D0 -+#define REG_WL_DSS_CTRL1_8197F 0x10D8 -+#define REG_WL_DSS_STATUS1_8197F 0x10DC -+#define REG_FW_DBG0_8197F 0x10E0 -+#define REG_FW_DBG1_8197F 0x10E4 -+#define REG_FW_DBG2_8197F 0x10E8 -+#define REG_FW_DBG3_8197F 0x10EC -+#define REG_FW_DBG4_8197F 0x10F0 -+#define REG_FW_DBG5_8197F 0x10F4 -+#define REG_FW_DBG6_8197F 0x10F8 -+#define REG_FW_DBG7_8197F 0x10FC -+#define REG_CR_8197F 0x0100 -+#define REG_TSF_CLK_STATE_8197F 0x0108 -+#define REG_TXDMA_PQ_MAP_8197F 0x010C -+#define REG_TRXFF_BNDY_8197F 0x0114 -+#define REG_PTA_I2C_MBOX_8197F 0x0118 -+#define REG_RXFF_BNDY_8197F 0x011C -+#define REG_FE1IMR_8197F 0x0120 -+#define REG_FE1ISR_8197F 0x0124 -+#define REG_CPWM_8197F 0x012C -+#define REG_FWIMR_8197F 0x0130 -+#define REG_FWISR_8197F 0x0134 -+#define REG_FTIMR_8197F 0x0138 -+#define REG_FTISR_8197F 0x013C -+#define REG_PKTBUF_DBG_CTRL_8197F 0x0140 -+#define REG_PKTBUF_DBG_DATA_L_8197F 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8197F 0x0148 -+#define REG_CPWM2_8197F 0x014C -+#define REG_TC0_CTRL_8197F 0x0150 -+#define REG_TC1_CTRL_8197F 0x0154 -+#define REG_TC2_CTRL_8197F 0x0158 -+#define REG_TC3_CTRL_8197F 0x015C -+#define REG_TC4_CTRL_8197F 0x0160 -+#define REG_TCUNIT_BASE_8197F 0x0164 -+#define REG_TC5_CTRL_8197F 0x0168 -+#define REG_TC6_CTRL_8197F 0x016C -+#define REG_MBIST_FAIL_8197F 0x0170 -+#define REG_MBIST_START_PAUSE_8197F 0x0174 -+#define REG_MBIST_DONE_8197F 0x0178 -+#define REG_MBIST_FAIL_NRML_8197F 0x017C -+#define REG_AES_DECRPT_DATA_8197F 0x0180 -+#define REG_AES_DECRPT_CFG_8197F 0x0184 -+#define REG_MACCLKFRQ_8197F 0x018C -+#define REG_TMETER_8197F 0x0190 -+#define REG_OSC_32K_CTRL_8197F 0x0194 -+#define REG_32K_CAL_REG1_8197F 0x0198 -+#define REG_C2HEVT_8197F 0x01A0 -+#define REG_SW_DEFINED_PAGE1_8197F 0x01B8 -+#define REG_MCUTST_I_8197F 0x01C0 -+#define REG_MCUTST_II_8197F 0x01C4 -+#define REG_FMETHR_8197F 0x01C8 -+#define REG_HMETFR_8197F 0x01CC -+#define REG_HMEBOX0_8197F 0x01D0 -+#define REG_HMEBOX1_8197F 0x01D4 -+#define REG_HMEBOX2_8197F 0x01D8 -+#define REG_HMEBOX3_8197F 0x01DC -+#define REG_LLT_INIT_8197F 0x01E0 -+#define REG_LLT_INIT_ADDR_8197F 0x01E4 -+#define REG_BB_ACCESS_CTRL_8197F 0x01E8 -+#define REG_BB_ACCESS_DATA_8197F 0x01EC -+#define REG_HMEBOX_E0_8197F 0x01F0 -+#define REG_HMEBOX_E1_8197F 0x01F4 -+#define REG_HMEBOX_E2_8197F 0x01F8 -+#define REG_HMEBOX_E3_8197F 0x01FC -+#define REG_CR_EXT_8197F 0x1100 -+#define REG_FWFF_8197F 0x1114 -+#define REG_RXFF_PTR_V1_8197F 0x1118 -+#define REG_RXFF_WTR_V1_8197F 0x111C -+#define REG_FE2IMR_8197F 0x1120 -+#define REG_FE2ISR_8197F 0x1124 -+#define REG_FE3IMR_8197F 0x1128 -+#define REG_FE3ISR_8197F 0x112C -+#define REG_FE4IMR_8197F 0x1130 -+#define REG_FE4ISR_8197F 0x1134 -+#define REG_FT1IMR_8197F 0x1138 -+#define REG_FT1ISR_8197F 0x113C -+#define REG_SPWR0_8197F 0x1140 -+#define REG_SPWR1_8197F 0x1144 -+#define REG_SPWR2_8197F 0x1148 -+#define REG_SPWR3_8197F 0x114C -+#define REG_POWSEQ_8197F 0x1150 -+#define REG_TC7_CTRL_V1_8197F 0x1158 -+#define REG_TC8_CTRL_V1_8197F 0x115C -+#define REG_RXBCN_TBTT_INTERVAL_PORT0TO3_8197F 0x1160 -+#define REG_RXBCN_TBTT_INTERVAL_PORT4_8197F 0x1164 -+#define REG_EXT_QUEUE_REG_8197F 0x11C0 -+#define REG_COUNTER_CONTROL_8197F 0x11C4 -+#define REG_COUNTER_TH_8197F 0x11C8 -+#define REG_COUNTER_SET_8197F 0x11CC -+#define REG_COUNTER_OVERFLOW_8197F 0x11D0 -+#define REG_TDE_LEN_TH_8197F 0x11D4 -+#define REG_RDE_LEN_TH_8197F 0x11D8 -+#define REG_PCIE_EXEC_TIME_8197F 0x11DC -+#define REG_FT2IMR_8197F 0x11E0 -+#define REG_FT2ISR_8197F 0x11E4 -+#define REG_MSG2_8197F 0x11F0 -+#define REG_MSG3_8197F 0x11F4 -+#define REG_MSG4_8197F 0x11F8 -+#define REG_MSG5_8197F 0x11FC -+#define REG_FIFOPAGE_CTRL_1_8197F 0x0200 -+#define REG_FIFOPAGE_CTRL_2_8197F 0x0204 -+#define REG_AUTO_LLT_V1_8197F 0x0208 -+#define REG_TXDMA_OFFSET_CHK_8197F 0x020C -+#define REG_TXDMA_STATUS_8197F 0x0210 -+#define REG_TX_DMA_DBG_8197F 0x0214 -+#define REG_TQPNT1_8197F 0x0218 -+#define REG_TQPNT2_8197F 0x021C -+#define REG_TQPNT3_8197F 0x0220 -+#define REG_TQPNT4_8197F 0x0224 -+#define REG_RQPN_CTRL_1_8197F 0x0228 -+#define REG_RQPN_CTRL_2_8197F 0x022C -+#define REG_FIFOPAGE_INFO_1_8197F 0x0230 -+#define REG_FIFOPAGE_INFO_2_8197F 0x0234 -+#define REG_FIFOPAGE_INFO_3_8197F 0x0238 -+#define REG_FIFOPAGE_INFO_4_8197F 0x023C -+#define REG_FIFOPAGE_INFO_5_8197F 0x0240 -+#define REG_H2C_HEAD_8197F 0x0244 -+#define REG_H2C_TAIL_8197F 0x0248 -+#define REG_H2C_READ_ADDR_8197F 0x024C -+#define REG_H2C_WR_ADDR_8197F 0x0250 -+#define REG_H2C_INFO_8197F 0x0254 -+#define REG_RXDMA_AGG_PG_TH_8197F 0x0280 -+#define REG_RXPKT_NUM_8197F 0x0284 -+#define REG_RXDMA_STATUS_8197F 0x0288 -+#define REG_RXDMA_DPR_8197F 0x028C -+#define REG_RXDMA_MODE_8197F 0x0290 -+#define REG_C2H_PKT_8197F 0x0294 -+#define REG_FWFF_C2H_8197F 0x0298 -+#define REG_FWFF_CTRL_8197F 0x029C -+#define REG_FWFF_PKT_INFO_8197F 0x02A0 -+#define REG_FC2H_INFO_8197F 0x02A4 -+#define REG_DDMA_CH0SA_8197F 0x1200 -+#define REG_DDMA_CH0DA_8197F 0x1204 -+#define REG_DDMA_CH0CTRL_8197F 0x1208 -+#define REG_DDMA_CH1SA_8197F 0x1210 -+#define REG_DDMA_CH1DA_8197F 0x1214 -+#define REG_DDMA_CH1CTRL_8197F 0x1218 -+#define REG_DDMA_CH2SA_8197F 0x1220 -+#define REG_DDMA_CH2DA_8197F 0x1224 -+#define REG_DDMA_CH2CTRL_8197F 0x1228 -+#define REG_DDMA_CH3SA_8197F 0x1230 -+#define REG_DDMA_CH3DA_8197F 0x1234 -+#define REG_DDMA_CH3CTRL_8197F 0x1238 -+#define REG_DDMA_CH4SA_8197F 0x1240 -+#define REG_DDMA_CH4DA_8197F 0x1244 -+#define REG_DDMA_CH4CTRL_8197F 0x1248 -+#define REG_DDMA_CH5SA_8197F 0x1250 -+#define REG_DDMA_CH5DA_8197F 0x1254 -+#define REG_REG_DDMA_CH5CTRL_8197F 0x1258 -+#define REG_DDMA_INT_MSK_8197F 0x12E0 -+#define REG_DDMA_CHSTATUS_8197F 0x12E8 -+#define REG_DDMA_CHKSUM_8197F 0x12F0 -+#define REG_DDMA_MONITOR_8197F 0x12FC -+#define REG_HCI_CTRL_8197F 0x0300 -+#define REG_INT_MIG_8197F 0x0304 -+#define REG_BCNQ_TXBD_DESA_8197F 0x0308 -+#define REG_MGQ_TXBD_DESA_8197F 0x0310 -+#define REG_VOQ_TXBD_DESA_8197F 0x0318 -+#define REG_VIQ_TXBD_DESA_8197F 0x0320 -+#define REG_BEQ_TXBD_DESA_8197F 0x0328 -+#define REG_BKQ_TXBD_DESA_8197F 0x0330 -+#define REG_RXQ_RXBD_DESA_8197F 0x0338 -+#define REG_HI0Q_TXBD_DESA_8197F 0x0340 -+#define REG_HI1Q_TXBD_DESA_8197F 0x0348 -+#define REG_HI2Q_TXBD_DESA_8197F 0x0350 -+#define REG_HI3Q_TXBD_DESA_8197F 0x0358 -+#define REG_HI4Q_TXBD_DESA_8197F 0x0360 -+#define REG_HI5Q_TXBD_DESA_8197F 0x0368 -+#define REG_HI6Q_TXBD_DESA_8197F 0x0370 -+#define REG_HI7Q_TXBD_DESA_8197F 0x0378 -+#define REG_MGQ_TXBD_NUM_8197F 0x0380 -+#define REG_RX_RXBD_NUM_8197F 0x0382 -+#define REG_VOQ_TXBD_NUM_8197F 0x0384 -+#define REG_VIQ_TXBD_NUM_8197F 0x0386 -+#define REG_BEQ_TXBD_NUM_8197F 0x0388 -+#define REG_BKQ_TXBD_NUM_8197F 0x038A -+#define REG_HI0Q_TXBD_NUM_8197F 0x038C -+#define REG_HI1Q_TXBD_NUM_8197F 0x038E -+#define REG_HI2Q_TXBD_NUM_8197F 0x0390 -+#define REG_HI3Q_TXBD_NUM_8197F 0x0392 -+#define REG_HI4Q_TXBD_NUM_8197F 0x0394 -+#define REG_HI5Q_TXBD_NUM_8197F 0x0396 -+#define REG_HI6Q_TXBD_NUM_8197F 0x0398 -+#define REG_HI7Q_TXBD_NUM_8197F 0x039A -+#define REG_TSFTIMER_HCI_8197F 0x039C -+#define REG_BD_RWPTR_CLR_8197F 0x039C -+#define REG_VOQ_TXBD_IDX_8197F 0x03A0 -+#define REG_VIQ_TXBD_IDX_8197F 0x03A4 -+#define REG_BEQ_TXBD_IDX_8197F 0x03A8 -+#define REG_BKQ_TXBD_IDX_8197F 0x03AC -+#define REG_MGQ_TXBD_IDX_8197F 0x03B0 -+#define REG_RXQ_RXBD_IDX_8197F 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8197F 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8197F 0x03BC -+#define REG_HI2Q_TXBD_IDX_8197F 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8197F 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8197F 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8197F 0x03CC -+#define REG_HI6Q_TXBD_IDX_8197F 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8197F 0x03D4 -+#define REG_DBG_SEL_V1_8197F 0x03D8 -+#define REG_HCI_HRPWM1_V1_8197F 0x03D9 -+#define REG_HCI_HCPWM1_V1_8197F 0x03DA -+#define REG_HCI_CTRL2_8197F 0x03DB -+#define REG_HCI_HRPWM2_V1_8197F 0x03DC -+#define REG_HCI_HCPWM2_V1_8197F 0x03DE -+#define REG_HCI_H2C_MSG_V1_8197F 0x03E0 -+#define REG_HCI_C2H_MSG_V1_8197F 0x03E4 -+#define REG_DBI_WDATA_V1_8197F 0x03E8 -+#define REG_DBI_RDATA_V1_8197F 0x03EC -+#define REG_STUCK_FLAG_V1_8197F 0x03F0 -+#define REG_MDIO_V1_8197F 0x03F4 -+#define REG_WDT_CFG_8197F 0x03F8 -+#define REG_HCI_MIX_CFG_8197F 0x03FC -+#define REG_STC_INT_CS_8197F 0x1300 -+#define REG_ST_INT_CFG_8197F 0x1304 -+#define REG_CMU_DLY_CTRL_8197F 0x1310 -+#define REG_CMU_DLY_CFG_8197F 0x1314 -+#define REG_H2CQ_TXBD_DESA_8197F 0x1320 -+#define REG_H2CQ_TXBD_NUM_8197F 0x1328 -+#define REG_H2CQ_TXBD_IDX_8197F 0x132C -+#define REG_H2CQ_CSR_8197F 0x1330 -+#define REG_AXI_EXCEPT_CS_8197F 0x1350 -+#define REG_AXI_EXCEPT_TIME_8197F 0x1354 -+#define REG_Q0_INFO_8197F 0x0400 -+#define REG_Q1_INFO_8197F 0x0404 -+#define REG_Q2_INFO_8197F 0x0408 -+#define REG_Q3_INFO_8197F 0x040C -+#define REG_MGQ_INFO_8197F 0x0410 -+#define REG_HIQ_INFO_8197F 0x0414 -+#define REG_BCNQ_INFO_8197F 0x0418 -+#define REG_TXPKT_EMPTY_8197F 0x041A -+#define REG_CPU_MGQ_INFO_8197F 0x041C -+#define REG_FWHW_TXQ_CTRL_8197F 0x0420 -+#define REG_BCNQ_BDNY_V1_8197F 0x0424 -+#define REG_LIFETIME_EN_8197F 0x0426 -+#define REG_SPEC_SIFS_8197F 0x0428 -+#define REG_RETRY_LIMIT_8197F 0x042A -+#define REG_TXBF_CTRL_8197F 0x042C -+#define REG_DARFRC_8197F 0x0430 -+#define REG_RARFRC_8197F 0x0438 -+#define REG_RRSR_8197F 0x0440 -+#define REG_ARFR0_8197F 0x0444 -+#define REG_ARFR1_V1_8197F 0x044C -+#define REG_CCK_CHECK_8197F 0x0454 -+#define REG_AMPDU_MAX_TIME_V1_8197F 0x0455 -+#define REG_BCNQ1_BDNY_V1_8197F 0x0456 -+#define REG_AMPDU_MAX_LENGTH_8197F 0x0458 -+#define REG_ACQ_STOP_8197F 0x045C -+#define REG_NDPA_RATE_8197F 0x045D -+#define REG_TX_HANG_CTRL_8197F 0x045E -+#define REG_NDPA_OPT_CTRL_8197F 0x045F -+#define REG_RD_RESP_PKT_TH_8197F 0x0463 -+#define REG_CMDQ_INFO_8197F 0x0464 -+#define REG_Q4_INFO_8197F 0x0468 -+#define REG_Q5_INFO_8197F 0x046C -+#define REG_Q6_INFO_8197F 0x0470 -+#define REG_Q7_INFO_8197F 0x0474 -+#define REG_WMAC_LBK_BUF_HD_V1_8197F 0x0478 -+#define REG_MGQ_BDNY_V1_8197F 0x047A -+#define REG_TXRPT_CTRL_8197F 0x047C -+#define REG_INIRTS_RATE_SEL_8197F 0x0480 -+#define REG_BASIC_CFEND_RATE_8197F 0x0481 -+#define REG_STBC_CFEND_RATE_8197F 0x0482 -+#define REG_DATA_SC_8197F 0x0483 -+#define REG_MACID_SLEEP3_8197F 0x0484 -+#define REG_MACID_SLEEP1_8197F 0x0488 -+#define REG_ARFR2_V1_8197F 0x048C -+#define REG_ARFR3_V1_8197F 0x0494 -+#define REG_ARFR4_8197F 0x049C -+#define REG_ARFR5_8197F 0x04A4 -+#define REG_TXRPT_START_OFFSET_8197F 0x04AC -+#define REG_POWER_STAGE1_8197F 0x04B4 -+#define REG_POWER_STAGE2_8197F 0x04B8 -+#define REG_SW_AMPDU_BURST_MODE_CTRL_8197F 0x04BC -+#define REG_PKT_LIFE_TIME_8197F 0x04C0 -+#define REG_STBC_SETTING_8197F 0x04C4 -+#define REG_STBC_SETTING2_8197F 0x04C5 -+#define REG_QUEUE_CTRL_8197F 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL_8197F 0x04C7 -+#define REG_PROT_MODE_CTRL_8197F 0x04C8 -+#define REG_BAR_MODE_CTRL_8197F 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8197F 0x04CF -+#define REG_MACID_SLEEP2_8197F 0x04D0 -+#define REG_MACID_SLEEP_8197F 0x04D4 -+#define REG_HW_SEQ0_8197F 0x04D8 -+#define REG_HW_SEQ1_8197F 0x04DA -+#define REG_HW_SEQ2_8197F 0x04DC -+#define REG_HW_SEQ3_8197F 0x04DE -+#define REG_NULL_PKT_STATUS_V1_8197F 0x04E0 -+#define REG_PTCL_ERR_STATUS_8197F 0x04E2 -+#define REG_NULL_PKT_STATUS_EXTEND_8197F 0x04E3 -+#define REG_VIDEO_ENHANCEMENT_FUN_8197F 0x04E4 -+#define REG_BT_POLLUTE_PKT_CNT_8197F 0x04E8 -+#define REG_PTCL_DBG_8197F 0x04EC -+#define REG_TXOP_EXTRA_CTRL_8197F 0x04F0 -+#define REG_CPUMGQ_TIMER_CTRL2_8197F 0x04F4 -+#define REG_DUMMY_PAGE4_8197F 0x04FC -+#define REG_Q0_Q1_INFO_8197F 0x1400 -+#define REG_Q2_Q3_INFO_8197F 0x1404 -+#define REG_Q4_Q5_INFO_8197F 0x1408 -+#define REG_Q6_Q7_INFO_8197F 0x140C -+#define REG_MGQ_HIQ_INFO_8197F 0x1410 -+#define REG_CMDQ_BCNQ_INFO_8197F 0x1414 -+#define REG_USEREG_SETTING_8197F 0x1420 -+#define REG_AESIV_SETTING_8197F 0x1424 -+#define REG_BF0_TIME_SETTING_8197F 0x1428 -+#define REG_BF1_TIME_SETTING_8197F 0x142C -+#define REG_BF_TIMEOUT_EN_8197F 0x1430 -+#define REG_MACID_RELEASE0_8197F 0x1434 -+#define REG_MACID_RELEASE1_8197F 0x1438 -+#define REG_MACID_RELEASE2_8197F 0x143C -+#define REG_MACID_RELEASE3_8197F 0x1440 -+#define REG_MACID_RELEASE_SETTING_8197F 0x1444 -+#define REG_FAST_EDCA_VOVI_SETTING_8197F 0x1448 -+#define REG_FAST_EDCA_BEBK_SETTING_8197F 0x144C -+#define REG_MACID_DROP0_8197F 0x1450 -+#define REG_MACID_DROP1_8197F 0x1454 -+#define REG_MACID_DROP2_8197F 0x1458 -+#define REG_MACID_DROP3_8197F 0x145C -+#define REG_R_MACID_RELEASE_SUCCESS_0_8197F 0x1460 -+#define REG_R_MACID_RELEASE_SUCCESS_1_8197F 0x1464 -+#define REG_R_MACID_RELEASE_SUCCESS_2_8197F 0x1468 -+#define REG_R_MACID_RELEASE_SUCCESS_3_8197F 0x146C -+#define REG_MGG_FIFO_CRTL_8197F 0x1470 -+#define REG_MGG_FIFO_INT_8197F 0x1474 -+#define REG_MGG_FIFO_LIFETIME_8197F 0x1478 -+#define REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8197F 0x147C -+#define REG_SHCUT_SETTING_8197F 0x1480 -+#define REG_SHCUT_LLC_ETH_TYPE0_8197F 0x1484 -+#define REG_SHCUT_LLC_ETH_TYPE1_8197F 0x1488 -+#define REG_SHCUT_LLC_OUI0_8197F 0x148C -+#define REG_SHCUT_LLC_OUI1_8197F 0x1490 -+#define REG_SHCUT_LLC_OUI2_8197F 0x1494 -+#define REG_SHCUT_LLC_OUI3_8197F 0x1498 -+#define REG_CHNL_INFO_CTRL_8197F 0x14D0 -+#define REG_CHNL_IDLE_TIME_8197F 0x14D4 -+#define REG_CHNL_BUSY_TIME_8197F 0x14D8 -+#define REG_EDCA_VO_PARAM_8197F 0x0500 -+#define REG_EDCA_VI_PARAM_8197F 0x0504 -+#define REG_EDCA_BE_PARAM_8197F 0x0508 -+#define REG_EDCA_BK_PARAM_8197F 0x050C -+#define REG_BCNTCFG_8197F 0x0510 -+#define REG_PIFS_8197F 0x0512 -+#define REG_RDG_PIFS_8197F 0x0513 -+#define REG_SIFS_8197F 0x0514 -+#define REG_TSFTR_SYN_OFFSET_8197F 0x0518 -+#define REG_AGGR_BREAK_TIME_8197F 0x051A -+#define REG_SLOT_8197F 0x051B -+#define REG_TX_PTCL_CTRL_8197F 0x0520 -+#define REG_TXPAUSE_8197F 0x0522 -+#define REG_DIS_TXREQ_CLR_8197F 0x0523 -+#define REG_RD_CTRL_8197F 0x0524 -+#define REG_MBSSID_CTRL_8197F 0x0526 -+#define REG_P2PPS_CTRL_8197F 0x0527 -+#define REG_PKT_LIFETIME_CTRL_8197F 0x0528 -+#define REG_P2PPS_SPEC_STATE_8197F 0x052B -+#define REG_QUEUE_INCOL_THR_8197F 0x0538 -+#define REG_QUEUE_INCOL_EN_8197F 0x053C -+#define REG_TBTT_PROHIBIT_8197F 0x0540 -+#define REG_P2PPS_STATE_8197F 0x0543 -+#define REG_RD_NAV_NXT_8197F 0x0544 -+#define REG_NAV_PROT_LEN_8197F 0x0546 -+#define REG_FTM_CTRL_8197F 0x0548 -+#define REG_FTM_TSF_CNT_8197F 0x054C -+#define REG_BCN_CTRL_8197F 0x0550 -+#define REG_BCN_CTRL_CLINT0_8197F 0x0551 -+#define REG_MBID_NUM_8197F 0x0552 -+#define REG_DUAL_TSF_RST_8197F 0x0553 -+#define REG_MBSSID_BCN_SPACE_8197F 0x0554 -+#define REG_DRVERLYINT_8197F 0x0558 -+#define REG_BCNDMATIM_8197F 0x0559 -+#define REG_ATIMWND_8197F 0x055A -+#define REG_USTIME_TSF_8197F 0x055C -+#define REG_BCN_MAX_ERR_8197F 0x055D -+#define REG_RXTSF_OFFSET_CCK_8197F 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8197F 0x055F -+#define REG_TSFTR_8197F 0x0560 -+#define REG_FREERUN_CNT_8197F 0x0568 -+#define REG_ATIMWND1_8197F 0x0570 -+#define REG_TBTT_PROHIBIT_INFRA_8197F 0x0571 -+#define REG_CTWND_8197F 0x0572 -+#define REG_BCNIVLCUNT_8197F 0x0573 -+#define REG_BCNDROPCTRL_8197F 0x0574 -+#define REG_HGQ_TIMEOUT_PERIOD_8197F 0x0575 -+#define REG_TXCMD_TIMEOUT_PERIOD_8197F 0x0576 -+#define REG_MISC_CTRL_8197F 0x0577 -+#define REG_BCN_CTRL_CLINT1_8197F 0x0578 -+#define REG_BCN_CTRL_CLINT2_8197F 0x0579 -+#define REG_BCN_CTRL_CLINT3_8197F 0x057A -+#define REG_EXTEND_CTRL_8197F 0x057B -+#define REG_P2PPS1_SPEC_STATE_8197F 0x057C -+#define REG_P2PPS1_STATE_8197F 0x057D -+#define REG_P2PPS2_SPEC_STATE_8197F 0x057E -+#define REG_P2PPS2_STATE_8197F 0x057F -+#define REG_PS_TIMER0_8197F 0x0580 -+#define REG_PS_TIMER1_8197F 0x0584 -+#define REG_PS_TIMER2_8197F 0x0588 -+#define REG_TBTT_CTN_AREA_8197F 0x058C -+#define REG_FORCE_BCN_IFS_8197F 0x058E -+#define REG_TXOP_MIN_8197F 0x0590 -+#define REG_PRE_BKF_TIME_8197F 0x0592 -+#define REG_CROSS_TXOP_CTRL_8197F 0x0593 -+#define REG_TBTT_INT_SHIFT_CLI0_8197F 0x0594 -+#define REG_TBTT_INT_SHIFT_CLI1_8197F 0x0595 -+#define REG_TBTT_INT_SHIFT_CLI2_8197F 0x0596 -+#define REG_TBTT_INT_SHIFT_CLI3_8197F 0x0597 -+#define REG_TBTT_INT_SHIFT_ENABLE_8197F 0x0598 -+#define REG_ATIMWND2_8197F 0x05A0 -+#define REG_ATIMWND3_8197F 0x05A1 -+#define REG_ATIMWND4_8197F 0x05A2 -+#define REG_ATIMWND5_8197F 0x05A3 -+#define REG_ATIMWND6_8197F 0x05A4 -+#define REG_ATIMWND7_8197F 0x05A5 -+#define REG_ATIMUGT_8197F 0x05A6 -+#define REG_HIQ_NO_LMT_EN_8197F 0x05A7 -+#define REG_DTIM_COUNTER_ROOT_8197F 0x05A8 -+#define REG_DTIM_COUNTER_VAP1_8197F 0x05A9 -+#define REG_DTIM_COUNTER_VAP2_8197F 0x05AA -+#define REG_DTIM_COUNTER_VAP3_8197F 0x05AB -+#define REG_DTIM_COUNTER_VAP4_8197F 0x05AC -+#define REG_DTIM_COUNTER_VAP5_8197F 0x05AD -+#define REG_DTIM_COUNTER_VAP6_8197F 0x05AE -+#define REG_DTIM_COUNTER_VAP7_8197F 0x05AF -+#define REG_DIS_ATIM_8197F 0x05B0 -+#define REG_EARLY_128US_8197F 0x05B1 -+#define REG_P2PPS1_CTRL_8197F 0x05B2 -+#define REG_P2PPS2_CTRL_8197F 0x05B3 -+#define REG_TIMER0_SRC_SEL_8197F 0x05B4 -+#define REG_NOA_UNIT_SEL_8197F 0x05B5 -+#define REG_P2POFF_DIS_TXTIME_8197F 0x05B7 -+#define REG_MBSSID_BCN_SPACE2_8197F 0x05B8 -+#define REG_MBSSID_BCN_SPACE3_8197F 0x05BC -+#define REG_ACMHWCTRL_8197F 0x05C0 -+#define REG_ACMRSTCTRL_8197F 0x05C1 -+#define REG_ACMAVG_8197F 0x05C2 -+#define REG_VO_ADMTIME_8197F 0x05C4 -+#define REG_VI_ADMTIME_8197F 0x05C6 -+#define REG_BE_ADMTIME_8197F 0x05C8 -+#define REG_EDCA_RANDOM_GEN_8197F 0x05CC -+#define REG_TXCMD_NOA_SEL_8197F 0x05CF -+#define REG_NOA_PARAM_8197F 0x05E0 -+#define REG_P2P_RST_8197F 0x05F0 -+#define REG_SCHEDULER_RST_8197F 0x05F1 -+#define REG_SCH_TXCMD_8197F 0x05F8 -+#define REG_PAGE5_DUMMY_8197F 0x05FC -+#define REG_CPUMGQ_TX_TIMER_8197F 0x1500 -+#define REG_PS_TIMER_A_8197F 0x1504 -+#define REG_PS_TIMER_B_8197F 0x1508 -+#define REG_PS_TIMER_C_8197F 0x150C -+#define REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL_8197F 0x1510 -+#define REG_CPUMGQ_TX_TIMER_EARLY_8197F 0x1514 -+#define REG_PS_TIMER_A_EARLY_8197F 0x1515 -+#define REG_PS_TIMER_B_EARLY_8197F 0x1516 -+#define REG_PS_TIMER_C_EARLY_8197F 0x1517 -+#define REG_WMAC_CR_8197F 0x0600 -+#define REG_WMAC_FWPKT_CR_8197F 0x0601 -+#define REG_BWOPMODE_8197F 0x0603 -+#define REG_TCR_8197F 0x0604 -+#define REG_RCR_8197F 0x0608 -+#define REG_RX_PKT_LIMIT_8197F 0x060C -+#define REG_RX_DLK_TIME_8197F 0x060D -+#define REG_RX_DRVINFO_SZ_8197F 0x060F -+#define REG_MACID_8197F 0x0610 -+#define REG_BSSID_8197F 0x0618 -+#define REG_MAR_8197F 0x0620 -+#define REG_MBIDCAMCFG_1_8197F 0x0628 -+#define REG_MBIDCAMCFG_2_8197F 0x062C -+#define REG_WMAC_TCR_TSFT_OFS_8197F 0x0630 -+#define REG_UDF_THSD_8197F 0x0632 -+#define REG_ZLD_NUM_8197F 0x0633 -+#define REG_STMP_THSD_8197F 0x0634 -+#define REG_WMAC_TXTIMEOUT_8197F 0x0635 -+#define REG_MCU_TEST_2_V1_8197F 0x0636 -+#define REG_USTIME_EDCA_8197F 0x0638 -+#define REG_MAC_SPEC_SIFS_8197F 0x063A -+#define REG_RESP_SIFS_CCK_8197F 0x063C -+#define REG_RESP_SIFS_OFDM_8197F 0x063E -+#define REG_ACKTO_8197F 0x0640 -+#define REG_CTS2TO_8197F 0x0641 -+#define REG_EIFS_8197F 0x0642 -+#define REG_NAV_CTRL_8197F 0x0650 -+#define REG_BACAMCMD_8197F 0x0654 -+#define REG_BACAMCONTENT_8197F 0x0658 -+#define REG_LBDLY_8197F 0x0660 -+#define REG_WMAC_BACAM_RPMEN_8197F 0x0661 -+#define REG_WMAC_BITMAP_CTL_8197F 0x0663 -+#define REG_RXERR_RPT_8197F 0x0664 -+#define REG_WMAC_TRXPTCL_CTL_8197F 0x0668 -+#define REG_CAMCMD_8197F 0x0670 -+#define REG_CAMWRITE_8197F 0x0674 -+#define REG_CAMREAD_8197F 0x0678 -+#define REG_CAMDBG_8197F 0x067C -+#define REG_SECCFG_8197F 0x0680 -+#define REG_RXFILTER_CATEGORY_1_8197F 0x0682 -+#define REG_RXFILTER_ACTION_1_8197F 0x0683 -+#define REG_RXFILTER_CATEGORY_2_8197F 0x0684 -+#define REG_RXFILTER_ACTION_2_8197F 0x0685 -+#define REG_RXFILTER_CATEGORY_3_8197F 0x0686 -+#define REG_RXFILTER_ACTION_3_8197F 0x0687 -+#define REG_RXFLTMAP3_8197F 0x0688 -+#define REG_RXFLTMAP4_8197F 0x068A -+#define REG_RXFLTMAP5_8197F 0x068C -+#define REG_RXFLTMAP6_8197F 0x068E -+#define REG_WOW_CTRL_8197F 0x0690 -+#define REG_PS_RX_INFO_8197F 0x0692 -+#define REG_WMMPS_UAPSD_TID_8197F 0x0693 -+#define REG_LPNAV_CTRL_8197F 0x0694 -+#define REG_WKFMCAM_CMD_8197F 0x0698 -+#define REG_WKFMCAM_RWD_8197F 0x069C -+#define REG_RXFLTMAP0_8197F 0x06A0 -+#define REG_RXFLTMAP1_8197F 0x06A2 -+#define REG_RXFLTMAP_8197F 0x06A4 -+#define REG_BCN_PSR_RPT_8197F 0x06A8 -+#define REG_RXPKTMON_CTRL_8197F 0x06B0 -+#define REG_STATE_MON_8197F 0x06B4 -+#define REG_ERROR_MON_8197F 0x06B8 -+#define REG_SEARCH_MACID_8197F 0x06BC -+#define REG_BT_COEX_TABLE_8197F 0x06C0 -+#define REG_RXCMD_0_8197F 0x06D0 -+#define REG_RXCMD_1_8197F 0x06D4 -+#define REG_WMAC_RESP_TXINFO_8197F 0x06D8 -+#define REG_BBPSF_CTRL_8197F 0x06DC -+#define REG_P2P_RX_BCN_NOA_8197F 0x06E0 -+#define REG_ASSOCIATED_BFMER0_INFO_8197F 0x06E4 -+#define REG_ASSOCIATED_BFMER1_INFO_8197F 0x06EC -+#define REG_TX_CSI_RPT_PARAM_BW20_8197F 0x06F4 -+#define REG_TX_CSI_RPT_PARAM_BW40_8197F 0x06F8 -+#define REG_TX_CSI_RPT_PARAM_BW80_8197F 0x06FC -+#define REG_BCN_PSR_RPT2_8197F 0x1600 -+#define REG_BCN_PSR_RPT3_8197F 0x1604 -+#define REG_BCN_PSR_RPT4_8197F 0x1608 -+#define REG_A1_ADDR_MASK_8197F 0x160C -+#define REG_MACID2_8197F 0x1620 -+#define REG_BSSID2_8197F 0x1628 -+#define REG_MACID3_8197F 0x1630 -+#define REG_BSSID3_8197F 0x1638 -+#define REG_MACID4_8197F 0x1640 -+#define REG_BSSID4_8197F 0x1648 -+#define REG_NOA_REPORT_8197F 0x1650 -+#define REG_PWRBIT_SETTING_8197F 0x1660 -+#define REG_WMAC_MU_BF_OPTION_8197F 0x167C -+#define REG_WMAC_PAUSE_BB_CLR_TH_8197F 0x167D -+#define REG_WMAC_MU_ARB_8197F 0x167E -+#define REG_WMAC_MU_OPTION_8197F 0x167F -+#define REG_WMAC_MU_BF_CTL_8197F 0x1680 -+#define REG_WMAC_MU_BFRPT_PARA_8197F 0x1682 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE2_8197F 0x1684 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE3_8197F 0x1686 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE4_8197F 0x1688 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE5_8197F 0x168A -+#define REG_WMAC_ASSOCIATED_MU_BFMEE6_8197F 0x168C -+#define REG_WMAC_ASSOCIATED_MU_BFMEE7_8197F 0x168E -+#define REG_TRANSMIT_ADDRSS_0_8197F 0x16A0 -+#define REG_TRANSMIT_ADDRSS_1_8197F 0x16A8 -+#define REG_TRANSMIT_ADDRSS_2_8197F 0x16B0 -+#define REG_TRANSMIT_ADDRSS_3_8197F 0x16B8 -+#define REG_TRANSMIT_ADDRSS_4_8197F 0x16C0 -+#define REG_MACID1_8197F 0x0700 -+#define REG_BSSID1_8197F 0x0708 -+#define REG_BCN_PSR_RPT1_8197F 0x0710 -+#define REG_ASSOCIATED_BFMEE_SEL_8197F 0x0714 -+#define REG_SND_PTCL_CTRL_8197F 0x0718 -+#define REG_RX_CSI_RPT_INFO_8197F 0x071C -+#define REG_NS_ARP_CTRL_8197F 0x0720 -+#define REG_NS_ARP_INFO_8197F 0x0724 -+#define REG_BEAMFORMING_INFO_NSARP_V1_8197F 0x0728 -+#define REG_BEAMFORMING_INFO_NSARP_8197F 0x072C -+#define REG_WMAC_RTX_CTX_SUBTYPE_CFG_8197F 0x0750 -+#define REG_WMAC_SWAES_CFG_8197F 0x0760 -+#define REG_BT_COEX_V2_8197F 0x0762 -+#define REG_BT_COEX_8197F 0x0764 -+#define REG_WLAN_ACT_MASK_CTRL_8197F 0x0768 -+#define REG_BT_COEX_ENHANCED_INTR_CTRL_8197F 0x076E -+#define REG_BT_ACT_STATISTICS_8197F 0x0770 -+#define REG_BT_STATISTICS_CONTROL_REGISTER_8197F 0x0778 -+#define REG_BT_STATUS_REPORT_REGISTER_8197F 0x077C -+#define REG_BT_INTERRUPT_CONTROL_REGISTER_8197F 0x0780 -+#define REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8197F 0x0784 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8197F 0x0785 -+#define REG_BT_INTERRUPT_STATUS_REGISTER_8197F 0x078F -+#define REG_BT_TDMA_TIME_REGISTER_8197F 0x0790 -+#define REG_BT_ACT_REGISTER_8197F 0x0794 -+#define REG_OBFF_CTRL_BASIC_8197F 0x0798 -+#define REG_OBFF_CTRL2_TIMER_8197F 0x079C -+#define REG_LTR_CTRL_BASIC_8197F 0x07A0 -+#define REG_LTR_CTRL2_TIMER_THRESHOLD_8197F 0x07A4 -+#define REG_LTR_IDLE_LATENCY_V1_8197F 0x07A8 -+#define REG_LTR_ACTIVE_LATENCY_V1_8197F 0x07AC -+#define REG_ANTENNA_TRAINING_CONTROL_REGISTER_8197F 0x07B0 -+#define REG_WMAC_PKTCNT_RWD_8197F 0x07B8 -+#define REG_WMAC_PKTCNT_CTRL_8197F 0x07BC -+#define REG_IQ_DUMP_8197F 0x07C0 -+#define REG_WMAC_FTM_CTL_8197F 0x07CC -+#define REG_IQ_DUMP_EXT_8197F 0x07CF -+#define REG_OFDM_CCK_LEN_MASK_8197F 0x07D0 -+#define REG_RX_FILTER_FUNCTION_8197F 0x07DA -+#define REG_NDP_SIG_8197F 0x07E0 -+#define REG_TXCMD_INFO_FOR_RSP_PKT_8197F 0x07E4 -+#define REG_SEC_OPT_V2_8197F 0x07EC -+#define REG_RTS_ADDRESS_0_8197F 0x07F0 -+#define REG_RTS_ADDRESS_1_8197F 0x07F8 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8197F 0x1700 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8197F 0x1704 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8197F 0x1708 -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8812f.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8812f.h -new file mode 100644 -index 000000000..5edc4b211 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8812f.h -@@ -0,0 +1,886 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2018 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_REG_8812F_H -+#define __INC_HALMAC_REG_8812F_H -+ -+#define REG_SYS_ISO_CTRL_8812F 0x0000 -+#define REG_SYS_FUNC_EN_8812F 0x0002 -+#define REG_SYS_PW_CTRL_8812F 0x0004 -+#define REG_SYS_CLK_CTRL_8812F 0x0008 -+#define REG_SYS_EEPROM_CTRL_8812F 0x000A -+#define REG_EE_VPD_8812F 0x000C -+#define REG_SYS_SWR_CTRL1_8812F 0x0010 -+#define REG_SYS_SWR_CTRL2_8812F 0x0014 -+#define REG_SYS_SWR_CTRL3_8812F 0x0018 -+#define REG_RSV_CTRL_8812F 0x001C -+#define REG_RF_CTRL_8812F 0x001F -+#define REG_AFE_LDO_CTRL_8812F 0x0020 -+#define REG_AFE_CTRL1_8812F 0x0024 -+#define REG_ANAPARSW_POW_MAC_8812F 0x0028 -+#define REG_ANAPARLDO_POW_MAC_8812F 0x0029 -+#define REG_ANAPAR_POW_MAC_8812F 0x002A -+#define REG_ANAPAR_POW_XTAL_8812F 0x002B -+#define REG_ANAPARLDO_MAC_8812F 0x002C -+#define REG_EFUSE_CTRL_8812F 0x0030 -+#define REG_LDO_EFUSE_CTRL_8812F 0x0034 -+#define REG_PWR_OPTION_CTRL_8812F 0x0038 -+#define REG_CAL_TIMER_8812F 0x003C -+#define REG_ACLK_MON_8812F 0x003E -+#define REG_GPIO_MUXCFG_2_8812F 0x003F -+#define REG_GPIO_MUXCFG_8812F 0x0040 -+#define REG_GPIO_PIN_CTRL_8812F 0x0044 -+#define REG_GPIO_INTM_8812F 0x0048 -+#define REG_LED_CFG_8812F 0x004C -+#define REG_FSIMR_8812F 0x0050 -+#define REG_FSISR_8812F 0x0054 -+#define REG_HSIMR_8812F 0x0058 -+#define REG_HSISR_8812F 0x005C -+#define REG_GPIO_EXT_CTRL_8812F 0x0060 -+#define REG_PAD_CTRL1_8812F 0x0064 -+#define REG_WL_BT_PWR_CTRL_8812F 0x0068 -+#define REG_SDM_DEBUG_8812F 0x006C -+#define REG_SYS_SDIO_CTRL_8812F 0x0070 -+#define REG_HCI_OPT_CTRL_8812F 0x0074 -+#define REG_HCI_BG_CTRL_8812F 0x0078 -+#define REG_HCI_LDO_CTRL_8812F 0x007A -+#define REG_LDO_SWR_CTRL_8812F 0x007C -+#define REG_MCUFW_CTRL_8812F 0x0080 -+#define REG_MCU_TST_CFG_8812F 0x0084 -+#define REG_HMEBOX_E0_E1_8812F 0x0088 -+#define REG_HMEBOX_E2_E3_8812F 0x008C -+#define REG_WLLPS_CTRL_8812F 0x0090 -+#define REG_GPIO_DEBOUNCE_CTRL_8812F 0x0098 -+#define REG_RPWM2_8812F 0x009C -+#define REG_SYSON_FSM_MON_8812F 0x00A0 -+#define REG_PMC_DBG_CTRL1_8812F 0x00A8 -+#define REG_HIMR0_8812F 0x00B0 -+#define REG_HISR0_8812F 0x00B4 -+#define REG_HIMR1_8812F 0x00B8 -+#define REG_HISR1_8812F 0x00BC -+#define REG_DBG_PORT_SEL_8812F 0x00C0 -+#define REG_PAD_CTRL2_8812F 0x00C4 -+#define REG_PMC_DBG_CTRL2_8812F 0x00CC -+#define REG_BIST_CTRL_8812F 0x00D0 -+#define REG_BIST_RPT_8812F 0x00D4 -+#define REG_MEM_CTRL_8812F 0x00D8 -+#define REG_USB_SIE_INTF_8812F 0x00E0 -+#define REG_PCIE_MIO_INTF_8812F 0x00E4 -+#define REG_PCIE_MIO_INTD_8812F 0x00E8 -+#define REG_WLRF1_8812F 0x00EC -+#define REG_SYS_CFG1_8812F 0x00F0 -+#define REG_SYS_STATUS1_8812F 0x00F4 -+#define REG_SYS_STATUS2_8812F 0x00F8 -+#define REG_SYS_CFG2_8812F 0x00FC -+#define REG_SYS_CFG3_8812F 0x1000 -+#define REG_ANAPARSW_MAC_0_8812F 0x1010 -+#define REG_ANAPARSW_MAC_1_8812F 0x1014 -+#define REG_ANAPAR_MAC_0_8812F 0x1018 -+#define REG_ANAPAR_MAC_1_8812F 0x101C -+#define REG_ANAPAR_MAC_2_8812F 0x1020 -+#define REG_ANAPAR_XTAL_0_8812F 0x1040 -+#define REG_ANAPAR_XTAL_1_8812F 0x1044 -+#define REG_ANAPAR_XTAL_2_8812F 0x1048 -+#define REG_ANAPAR_XTAL_3_8812F 0x104C -+#define REG_ANAPAR_XTAL_AACK_0_8812F 0x1054 -+#define REG_ANAPAR_XTAL_AACK_1_8812F 0x1058 -+#define REG_ANAPAR_XTAL_MODE_DECODER_8812F 0x1064 -+#define REG_SYS_CFG5_8812F 0x1070 -+#define REG_REGU_32K_1_8812F 0x1078 -+#define REG_REGU_32K_2_8812F 0x107C -+#define REG_CPU_DMEM_CON_8812F 0x1080 -+#define REG_BOOT_REASON_8812F 0x1088 -+#define REG_HIMR2_8812F 0x10B0 -+#define REG_HISR2_8812F 0x10B4 -+#define REG_HIMR3_8812F 0x10B8 -+#define REG_HISR3_8812F 0x10BC -+#define REG_SW_MDIO_8812F 0x10C0 -+#define REG_H2C_PKT_READADDR_8812F 0x10D0 -+#define REG_H2C_PKT_WRITEADDR_8812F 0x10D4 -+#define REG_MEM_PWR_CRTL_8812F 0x10D8 -+#define REG_FW_DBG6_8812F 0x10F8 -+#define REG_FW_DBG7_8812F 0x10FC -+#define REG_CR_8812F 0x0100 -+#define REG_PG_SIZE_8812F 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL_8812F 0x0106 -+#define REG_TSF_CLK_STATE_8812F 0x0108 -+#define REG_TXDMA_PQ_MAP_8812F 0x010C -+#define REG_TRXFF_BNDY_8812F 0x0114 -+#define REG_PTA_I2C_MBOX_8812F 0x0118 -+#define REG_RXFF_BNDY_8812F 0x011C -+#define REG_FE1IMR_8812F 0x0120 -+#define REG_FE1ISR_8812F 0x0124 -+#define REG_CPWM_8812F 0x012C -+#define REG_FWIMR_8812F 0x0130 -+#define REG_FWISR_8812F 0x0134 -+#define REG_FTIMR_8812F 0x0138 -+#define REG_FTISR_8812F 0x013C -+#define REG_PKTBUF_DBG_CTRL_8812F 0x0140 -+#define REG_PKTBUF_DBG_DATA_L_8812F 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8812F 0x0148 -+#define REG_CPWM2_8812F 0x014C -+#define REG_TC0_CTRL_8812F 0x0150 -+#define REG_TC1_CTRL_8812F 0x0154 -+#define REG_TC2_CTRL_8812F 0x0158 -+#define REG_TC3_CTRL_8812F 0x015C -+#define REG_TC4_CTRL_8812F 0x0160 -+#define REG_TCUNIT_BASE_8812F 0x0164 -+#define REG_TC5_CTRL_8812F 0x0168 -+#define REG_TC6_CTRL_8812F 0x016C -+#define REG_MBIST_DRF_FAIL_8812F 0x0170 -+#define REG_MBIST_START_PAUSE_8812F 0x0174 -+#define REG_MBIST_DONE_8812F 0x0178 -+#define REG_MBIST_READ_BIST_RPT_8812F 0x017C -+#define REG_AES_DECRPT_DATA_8812F 0x0180 -+#define REG_AES_DECRPT_CFG_8812F 0x0184 -+#define REG_HIOE_CTRL_8812F 0x0188 -+#define REG_HIOE_CFG_FILE_8812F 0x018C -+#define REG_TMETER_8812F 0x0190 -+#define REG_OSC_32K_CTRL_8812F 0x0194 -+#define REG_32K_CAL_REG1_8812F 0x0198 -+#define REG_C2HEVT_8812F 0x01A0 -+#define REG_C2HEVT_1_8812F 0x01A4 -+#define REG_C2HEVT_2_8812F 0x01A8 -+#define REG_C2HEVT_3_8812F 0x01AC -+#define REG_SW_DEFINED_PAGE1_8812F 0x01B8 -+#define REG_SW_DEFINED_PAGE2_8812F 0x01BC -+#define REG_MCUTST_I_8812F 0x01C0 -+#define REG_MCUTST_II_8812F 0x01C4 -+#define REG_FMETHR_8812F 0x01C8 -+#define REG_HMETFR_8812F 0x01CC -+#define REG_HMEBOX0_8812F 0x01D0 -+#define REG_HMEBOX1_8812F 0x01D4 -+#define REG_HMEBOX2_8812F 0x01D8 -+#define REG_HMEBOX3_8812F 0x01DC -+#define REG_BB_ACCESS_CTRL_8812F 0x01E8 -+#define REG_BB_ACCESS_DATA_8812F 0x01EC -+#define REG_HMEBOX_E0_8812F 0x01F0 -+#define REG_HMEBOX_E1_8812F 0x01F4 -+#define REG_HMEBOX_E2_8812F 0x01F8 -+#define REG_HMEBOX_E3_8812F 0x01FC -+#define REG_CR_EXT_8812F 0x1100 -+#define REG_FWFF_8812F 0x1114 -+#define REG_RXFF_PTR_V1_8812F 0x1118 -+#define REG_RXFF_WTR_V1_8812F 0x111C -+#define REG_FE2IMR_8812F 0x1120 -+#define REG_FE2ISR_8812F 0x1124 -+#define REG_FE3IMR_8812F 0x1128 -+#define REG_FE3ISR_8812F 0x112C -+#define REG_FE4IMR_8812F 0x1130 -+#define REG_FE4ISR_8812F 0x1134 -+#define REG_FT1IMR_8812F 0x1138 -+#define REG_FT1ISR_8812F 0x113C -+#define REG_SPWR0_8812F 0x1140 -+#define REG_SPWR1_8812F 0x1144 -+#define REG_SPWR2_8812F 0x1148 -+#define REG_SPWR3_8812F 0x114C -+#define REG_POWSEQ_8812F 0x1150 -+#define REG_TC7_CTRL_V1_8812F 0x1158 -+#define REG_TC8_CTRL_V1_8812F 0x115C -+#define REG_RX_BCN_TBTT_ITVL0_8812F 0x1160 -+#define REG_RX_BCN_TBTT_ITVL1_8812F 0x1164 -+#define REG_IO_WRAP_ERR_FLAG_8812F 0x1170 -+#define REG_SPEED_SENSOR_8812F 0x1180 -+#define REG_SPEED_SENSOR1_8812F 0x1184 -+#define REG_SPEED_SENSOR2_8812F 0x1188 -+#define REG_SPEED_SENSOR3_8812F 0x118C -+#define REG_SPEED_SENSOR4_8812F 0x1190 -+#define REG_SPEED_SENSOR5_8812F 0x1194 -+#define REG_COUNTER_CTRL_8812F 0x11C4 -+#define REG_COUNTER_THRESHOLD_8812F 0x11C8 -+#define REG_COUNTER_SET_8812F 0x11CC -+#define REG_COUNTER_OVERFLOW_8812F 0x11D0 -+#define REG_TXDMA_LEN_THRESHOLD_8812F 0x11D4 -+#define REG_RXDMA_LEN_THRESHOLD_8812F 0x11D8 -+#define REG_PCIE_EXEC_TIME_THRESHOLD_8812F 0x11DC -+#define REG_FT2IMR_8812F 0x11E0 -+#define REG_FT2ISR_8812F 0x11E4 -+#define REG_MSG2_8812F 0x11F0 -+#define REG_MSG3_8812F 0x11F4 -+#define REG_MSG4_8812F 0x11F8 -+#define REG_MSG5_8812F 0x11FC -+#define REG_FIFOPAGE_CTRL_1_8812F 0x0200 -+#define REG_FIFOPAGE_CTRL_2_8812F 0x0204 -+#define REG_AUTO_LLT_V1_8812F 0x0208 -+#define REG_TXDMA_OFFSET_CHK_8812F 0x020C -+#define REG_TXDMA_STATUS_8812F 0x0210 -+#define REG_TX_DMA_DBG_8812F 0x0214 -+#define REG_TQPNT1_8812F 0x0218 -+#define REG_TQPNT2_8812F 0x021C -+#define REG_TQPNT3_8812F 0x0220 -+#define REG_TQPNT4_8812F 0x0224 -+#define REG_RQPN_CTRL_1_8812F 0x0228 -+#define REG_RQPN_CTRL_2_8812F 0x022C -+#define REG_FIFOPAGE_INFO_1_8812F 0x0230 -+#define REG_FIFOPAGE_INFO_2_8812F 0x0234 -+#define REG_FIFOPAGE_INFO_3_8812F 0x0238 -+#define REG_FIFOPAGE_INFO_4_8812F 0x023C -+#define REG_FIFOPAGE_INFO_5_8812F 0x0240 -+#define REG_H2C_HEAD_8812F 0x0244 -+#define REG_H2C_TAIL_8812F 0x0248 -+#define REG_H2C_READ_ADDR_8812F 0x024C -+#define REG_H2C_WR_ADDR_8812F 0x0250 -+#define REG_H2C_INFO_8812F 0x0254 -+#define REG_PGSUB_CNT_8812F 0x026C -+#define REG_PGSUB_H_8812F 0x0270 -+#define REG_PGSUB_N_8812F 0x0274 -+#define REG_PGSUB_L_8812F 0x0278 -+#define REG_PGSUB_E_8812F 0x027C -+#define REG_RXDMA_AGG_PG_TH_8812F 0x0280 -+#define REG_RXPKT_NUM_8812F 0x0284 -+#define REG_RXDMA_STATUS_8812F 0x0288 -+#define REG_RXDMA_DPR_8812F 0x028C -+#define REG_RXDMA_MODE_8812F 0x0290 -+#define REG_C2H_PKT_8812F 0x0294 -+#define REG_FWFF_C2H_8812F 0x0298 -+#define REG_FWFF_CTRL_8812F 0x029C -+#define REG_FWFF_PKT_INFO_8812F 0x02A0 -+#define REG_RXPKTNUM_8812F 0x02B0 -+#define REG_RXPKTNUM_TH_8812F 0x02B4 -+#define REG_FW_MSG1_8812F 0x02E0 -+#define REG_FW_MSG2_8812F 0x02E4 -+#define REG_FW_MSG3_8812F 0x02E8 -+#define REG_FW_MSG4_8812F 0x02EC -+#define REG_DDMA_CH0SA_8812F 0x1200 -+#define REG_DDMA_CH0DA_8812F 0x1204 -+#define REG_DDMA_CH0CTRL_8812F 0x1208 -+#define REG_DDMA_CH1SA_8812F 0x1210 -+#define REG_DDMA_CH1DA_8812F 0x1214 -+#define REG_DDMA_CH1CTRL_8812F 0x1218 -+#define REG_DDMA_CH2SA_8812F 0x1220 -+#define REG_DDMA_CH2DA_8812F 0x1224 -+#define REG_DDMA_CH2CTRL_8812F 0x1228 -+#define REG_DDMA_CH3SA_8812F 0x1230 -+#define REG_DDMA_CH3DA_8812F 0x1234 -+#define REG_DDMA_CH3CTRL_8812F 0x1238 -+#define REG_DDMA_CH4SA_8812F 0x1240 -+#define REG_DDMA_CH4DA_8812F 0x1244 -+#define REG_DDMA_CH4CTRL_8812F 0x1248 -+#define REG_DDMA_CH5SA_8812F 0x1250 -+#define REG_DDMA_CH5DA_8812F 0x1254 -+#define REG_DDMA_CH5CTRL_8812F 0x1258 -+#define REG_DDMA_INT_MSK_8812F 0x12E0 -+#define REG_DDMA_CHSTATUS_8812F 0x12E8 -+#define REG_DDMA_CHKSUM_8812F 0x12F0 -+#define REG_DDMA_MONITOR_8812F 0x12FC -+#define REG_PCIE_CTRL_8812F 0x0300 -+#define REG_INT_MIG_8812F 0x0304 -+#define REG_BCNQ_TXBD_DESA_8812F 0x0308 -+#define REG_MGQ_TXBD_DESA_8812F 0x0310 -+#define REG_VOQ_TXBD_DESA_8812F 0x0318 -+#define REG_VIQ_TXBD_DESA_8812F 0x0320 -+#define REG_BEQ_TXBD_DESA_8812F 0x0328 -+#define REG_BKQ_TXBD_DESA_8812F 0x0330 -+#define REG_RXQ_RXBD_DESA_8812F 0x0338 -+#define REG_HI0Q_TXBD_DESA_8812F 0x0340 -+#define REG_HI1Q_TXBD_DESA_8812F 0x0348 -+#define REG_HI2Q_TXBD_DESA_8812F 0x0350 -+#define REG_HI3Q_TXBD_DESA_8812F 0x0358 -+#define REG_HI4Q_TXBD_DESA_8812F 0x0360 -+#define REG_HI5Q_TXBD_DESA_8812F 0x0368 -+#define REG_HI6Q_TXBD_DESA_8812F 0x0370 -+#define REG_HI7Q_TXBD_DESA_8812F 0x0378 -+#define REG_MGQ_TXBD_NUM_8812F 0x0380 -+#define REG_RX_RXBD_NUM_8812F 0x0382 -+#define REG_VOQ_TXBD_NUM_8812F 0x0384 -+#define REG_VIQ_TXBD_NUM_8812F 0x0386 -+#define REG_BEQ_TXBD_NUM_8812F 0x0388 -+#define REG_BKQ_TXBD_NUM_8812F 0x038A -+#define REG_HI0Q_TXBD_NUM_8812F 0x038C -+#define REG_HI1Q_TXBD_NUM_8812F 0x038E -+#define REG_HI2Q_TXBD_NUM_8812F 0x0390 -+#define REG_HI3Q_TXBD_NUM_8812F 0x0392 -+#define REG_HI4Q_TXBD_NUM_8812F 0x0394 -+#define REG_HI5Q_TXBD_NUM_8812F 0x0396 -+#define REG_HI6Q_TXBD_NUM_8812F 0x0398 -+#define REG_HI7Q_TXBD_NUM_8812F 0x039A -+#define REG_TSFTIMER_HCI_8812F 0x039C -+#define REG_BD_RWPTR_CLR_8812F 0x039C -+#define REG_VOQ_TXBD_IDX_8812F 0x03A0 -+#define REG_VIQ_TXBD_IDX_8812F 0x03A4 -+#define REG_BEQ_TXBD_IDX_8812F 0x03A8 -+#define REG_BKQ_TXBD_IDX_8812F 0x03AC -+#define REG_MGQ_TXBD_IDX_8812F 0x03B0 -+#define REG_RXQ_RXBD_IDX_8812F 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8812F 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8812F 0x03BC -+#define REG_HI2Q_TXBD_IDX_8812F 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8812F 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8812F 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8812F 0x03CC -+#define REG_HI6Q_TXBD_IDX_8812F 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8812F 0x03D4 -+#define REG_DBG_SEL_V1_8812F 0x03D8 -+#define REG_PCIE_HRPWM1_V1_8812F 0x03D9 -+#define REG_PCIE_HCPWM1_V1_8812F 0x03DA -+#define REG_PCIE_CTRL2_8812F 0x03DB -+#define REG_PCIE_HRPWM2_V1_8812F 0x03DC -+#define REG_PCIE_HCPWM2_V1_8812F 0x03DE -+#define REG_PCIE_H2C_MSG_V1_8812F 0x03E0 -+#define REG_PCIE_C2H_MSG_V1_8812F 0x03E4 -+#define REG_DBI_WDATA_V1_8812F 0x03E8 -+#define REG_DBI_RDATA_V1_8812F 0x03EC -+#define REG_DBI_FLAG_V1_8812F 0x03F0 -+#define REG_MDIO_V1_8812F 0x03F4 -+#define REG_PCIE_MIX_CFG_8812F 0x03F8 -+#define REG_HCI_MIX_CFG_8812F 0x03FC -+#define REG_STC_INT_CS_8812F 0x1300 -+#define REG_ST_INT_CFG_8812F 0x1304 -+#define REG_H2CQ_TXBD_DESA_8812F 0x1320 -+#define REG_H2CQ_TXBD_NUM_8812F 0x1328 -+#define REG_H2CQ_TXBD_IDX_8812F 0x132C -+#define REG_H2CQ_CSR_8812F 0x1330 -+#define REG_CHANGE_PCIE_SPEED_8812F 0x1350 -+#define REG_DEBUG_STATE1_8812F 0x1354 -+#define REG_DEBUG_STATE2_8812F 0x1358 -+#define REG_DEBUG_STATE3_8812F 0x135C -+#define REG_CHNL_DMA_CFG_V1_8812F 0x137C -+#define REG_PCIE_HISR0_V1_8812F 0x13B4 -+#define REG_PCIE_HISR1_V1_8812F 0x13BC -+#define REG_PCIE_HISR2_V1_8812F 0x23B4 -+#define REG_PCIE_HISR3_V1_8812F 0x23BC -+#define REG_Q0_INFO_8812F 0x0400 -+#define REG_Q1_INFO_8812F 0x0404 -+#define REG_Q2_INFO_8812F 0x0408 -+#define REG_Q3_INFO_8812F 0x040C -+#define REG_MGQ_INFO_8812F 0x0410 -+#define REG_HIQ_INFO_8812F 0x0414 -+#define REG_BCNQ_INFO_8812F 0x0418 -+#define REG_TXPKT_EMPTY_8812F 0x041A -+#define REG_CPU_MGQ_INFO_8812F 0x041C -+#define REG_FWHW_TXQ_CTRL_8812F 0x0420 -+#define REG_DATAFB_SEL_8812F 0x0423 -+#define REG_BCNQ_BDNY_V1_8812F 0x0424 -+#define REG_LIFETIME_EN_8812F 0x0426 -+#define REG_SPEC_SIFS_8812F 0x0428 -+#define REG_RETRY_LIMIT_8812F 0x042A -+#define REG_TXBF_CTRL_8812F 0x042C -+#define REG_DARFRC_8812F 0x0430 -+#define REG_DARFRCH_8812F 0x0434 -+#define REG_RARFRC_8812F 0x0438 -+#define REG_RARFRCH_8812F 0x043C -+#define REG_RRSR_8812F 0x0440 -+#define REG_ARFR0_8812F 0x0444 -+#define REG_ARFRH0_8812F 0x0448 -+#define REG_ARFR1_V1_8812F 0x044C -+#define REG_ARFRH1_V1_8812F 0x0450 -+#define REG_CCK_CHECK_8812F 0x0454 -+#define REG_AMPDU_MAX_TIME_V1_8812F 0x0455 -+#define REG_BCNQ1_BDNY_V1_8812F 0x0456 -+#define REG_AMPDU_MAX_LENGTH_HT_8812F 0x0458 -+#define REG_ACQ_STOP_8812F 0x045C -+#define REG_NDPA_RATE_8812F 0x045D -+#define REG_TX_HANG_CTRL_8812F 0x045E -+#define REG_NDPA_OPT_CTRL_8812F 0x045F -+#define REG_AMPDU_MAX_LENGTH_VHT_8812F 0x0460 -+#define REG_RD_RESP_PKT_TH_8812F 0x0463 -+#define REG_CMDQ_INFO_8812F 0x0464 -+#define REG_Q4_INFO_8812F 0x0468 -+#define REG_Q5_INFO_8812F 0x046C -+#define REG_Q6_INFO_8812F 0x0470 -+#define REG_Q7_INFO_8812F 0x0474 -+#define REG_WMAC_LBK_BUF_HD_V1_8812F 0x0478 -+#define REG_MGQ_BDNY_V1_8812F 0x047A -+#define REG_TXRPT_CTRL_8812F 0x047C -+#define REG_INIRTS_RATE_SEL_8812F 0x0480 -+#define REG_BASIC_CFEND_RATE_8812F 0x0481 -+#define REG_STBC_CFEND_RATE_8812F 0x0482 -+#define REG_DATA_SC_8812F 0x0483 -+#define REG_MACID_SLEEP3_8812F 0x0484 -+#define REG_MACID_SLEEP1_8812F 0x0488 -+#define REG_ARFR2_V1_8812F 0x048C -+#define REG_ARFRH2_V1_8812F 0x0490 -+#define REG_ARFR3_V1_8812F 0x0494 -+#define REG_ARFRH3_V1_8812F 0x0498 -+#define REG_ARFR4_8812F 0x049C -+#define REG_ARFRH4_8812F 0x04A0 -+#define REG_ARFR5_8812F 0x04A4 -+#define REG_ARFRH5_8812F 0x04A8 -+#define REG_TXRPT_START_OFFSET_8812F 0x04AC -+#define REG_RRSR_CTS_8812F 0x04B0 -+#define REG_POWER_STAGE1_8812F 0x04B4 -+#define REG_POWER_STAGE2_8812F 0x04B8 -+#define REG_SW_AMPDU_BURST_MODE_CTRL_8812F 0x04BC -+#define REG_PKT_LIFE_TIME_8812F 0x04C0 -+#define REG_STBC_SETTING_8812F 0x04C4 -+#define REG_STBC_SETTING2_8812F 0x04C5 -+#define REG_QUEUE_CTRL_8812F 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL_8812F 0x04C7 -+#define REG_PROT_MODE_CTRL_8812F 0x04C8 -+#define REG_BAR_MODE_CTRL_8812F 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8812F 0x04CF -+#define REG_MACID_SLEEP2_8812F 0x04D0 -+#define REG_MACID_SLEEP_8812F 0x04D4 -+#define REG_HW_SEQ0_8812F 0x04D8 -+#define REG_HW_SEQ1_8812F 0x04DA -+#define REG_HW_SEQ2_8812F 0x04DC -+#define REG_HW_SEQ3_8812F 0x04DE -+#define REG_NULL_PKT_STATUS_V1_8812F 0x04E0 -+#define REG_PTCL_ERR_STATUS_8812F 0x04E2 -+#define REG_NULL_PKT_STATUS_EXTEND_8812F 0x04E3 -+#define REG_HQMGQ_DROP_8812F 0x04E4 -+#define REG_PRECNT_CTRL_8812F 0x04E5 -+#define REG_BT_POLLUTE_PKT_CNT_8812F 0x04E8 -+#define REG_PTCL_DBG_8812F 0x04EC -+#define REG_CPUMGQ_TIMER_CTRL2_8812F 0x04F4 -+#define REG_DUMMY_PAGE4_V1_8812F 0x04FC -+#define REG_MOREDATA_8812F 0x04FE -+#define REG_Q0_Q1_INFO_8812F 0x1400 -+#define REG_Q2_Q3_INFO_8812F 0x1404 -+#define REG_Q4_Q5_INFO_8812F 0x1408 -+#define REG_Q6_Q7_INFO_8812F 0x140C -+#define REG_MGQ_HIQ_INFO_8812F 0x1410 -+#define REG_CMDQ_BCNQ_INFO_8812F 0x1414 -+#define REG_LOOPBACK_OPTION_8812F 0x1420 -+#define REG_AESIV_SETTING_8812F 0x1424 -+#define REG_BF0_TIME_SETTING_8812F 0x1428 -+#define REG_BF1_TIME_SETTING_8812F 0x142C -+#define REG_BF_TIMEOUT_EN_8812F 0x1430 -+#define REG_MACID_RELEASE0_8812F 0x1434 -+#define REG_MACID_RELEASE1_8812F 0x1438 -+#define REG_MACID_RELEASE2_8812F 0x143C -+#define REG_MACID_RELEASE3_8812F 0x1440 -+#define REG_MACID_RELEASE_SETTING_8812F 0x1444 -+#define REG_FAST_EDCA_VOVI_SETTING_8812F 0x1448 -+#define REG_FAST_EDCA_BEBK_SETTING_8812F 0x144C -+#define REG_MACID_DROP0_8812F 0x1450 -+#define REG_MACID_DROP1_8812F 0x1454 -+#define REG_MACID_DROP2_8812F 0x1458 -+#define REG_MACID_DROP3_8812F 0x145C -+#define REG_R_MACID_RELEASE_SUCCESS_0_8812F 0x1460 -+#define REG_R_MACID_RELEASE_SUCCESS_1_8812F 0x1464 -+#define REG_R_MACID_RELEASE_SUCCESS_2_8812F 0x1468 -+#define REG_R_MACID_RELEASE_SUCCESS_3_8812F 0x146C -+#define REG_MGQ_FIFO_WRITE_POINTER_8812F 0x1470 -+#define REG_MGQ_FIFO_READ_POINTER_8812F 0x1472 -+#define REG_MGQ_FIFO_ENABLE_8812F 0x1472 -+#define REG_MGQ_FIFO_RELEASE_INT_MASK_8812F 0x1474 -+#define REG_MGQ_FIFO_RELEASE_INT_FLAG_8812F 0x1476 -+#define REG_MGQ_FIFO_VALID_MAP_8812F 0x1478 -+#define REG_MGQ_FIFO_LIFETIME_8812F 0x147A -+#define REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8812F 0x147C -+#define REG_SHCUT_SETTING_8812F 0x1480 -+#define REG_SHCUT_LLC_ETH_TYPE0_8812F 0x1484 -+#define REG_SHCUT_LLC_ETH_TYPE1_8812F 0x1488 -+#define REG_SHCUT_LLC_OUI0_8812F 0x148C -+#define REG_SHCUT_LLC_OUI1_8812F 0x1490 -+#define REG_SHCUT_LLC_OUI2_8812F 0x1494 -+#define REG_MU_TX_CTL_8812F 0x14C0 -+#define REG_MU_STA_GID_VLD_8812F 0x14C4 -+#define REG_MU_STA_USER_POS_INFO_8812F 0x14C8 -+#define REG_MU_STA_USER_POS_INFO_H_8812F 0x14CC -+#define REG_CHNL_INFO_CTRL_8812F 0x14D0 -+#define REG_CHNL_IDLE_TIME_8812F 0x14D4 -+#define REG_CHNL_BUSY_TIME_8812F 0x14D8 -+#define REG_MU_TRX_DBG_CNT_V1_8812F 0x14DC -+#define REG_SU_DURATION_8812F 0x14F0 -+#define REG_MU_DURATION_8812F 0x14F2 -+#define REG_HW_NDPA_RTY_LIMIT_8812F 0x14F4 -+#define REG_EDCA_VO_PARAM_8812F 0x0500 -+#define REG_EDCA_VI_PARAM_8812F 0x0504 -+#define REG_EDCA_BE_PARAM_8812F 0x0508 -+#define REG_EDCA_BK_PARAM_8812F 0x050C -+#define REG_BCNTCFG_8812F 0x0510 -+#define REG_PIFS_8812F 0x0512 -+#define REG_RDG_PIFS_8812F 0x0513 -+#define REG_SIFS_8812F 0x0514 -+#define REG_TSFTR_SYN_OFFSET_8812F 0x0518 -+#define REG_AGGR_BREAK_TIME_8812F 0x051A -+#define REG_SLOT_8812F 0x051B -+#define REG_NOA_ON_ERLY_TIME_8812F 0x051C -+#define REG_NOA_OFF_ERLY_TIME_8812F 0x051D -+#define REG_TX_PTCL_CTRL_8812F 0x0520 -+#define REG_TXPAUSE_8812F 0x0522 -+#define REG_DIS_TXREQ_CLR_8812F 0x0523 -+#define REG_RD_CTRL_8812F 0x0524 -+#define REG_MBSSID_CTRL_8812F 0x0526 -+#define REG_P2PPS_CTRL_8812F 0x0527 -+#define REG_PKT_LIFETIME_CTRL_8812F 0x0528 -+#define REG_P2PPS_SPEC_STATE_8812F 0x052B -+#define REG_TXOP_LIMIT_CTRL_8812F 0x052C -+#define REG_BAR_TX_CTRL_8812F 0x0530 -+#define REG_P2PON_DIS_TXTIME_8812F 0x0531 -+#define REG_CCA_TXEN_CNT_8812F 0x0534 -+#define REG_MAX_INTER_COLLISION_8812F 0x0538 -+#define REG_MAX_INTER_COLLISION_CNT_8812F 0x053C -+#define REG_TBTT_PROHIBIT_8812F 0x0540 -+#define REG_P2PPS_STATE_8812F 0x0543 -+#define REG_RD_NAV_NXT_8812F 0x0544 -+#define REG_NAV_PROT_LEN_8812F 0x0546 -+#define REG_FTM_PTT_8812F 0x0548 -+#define REG_FTM_TSF_8812F 0x054C -+#define REG_BCN_CTRL_8812F 0x0550 -+#define REG_BCN_CTRL_CLINT0_8812F 0x0551 -+#define REG_MBID_NUM_8812F 0x0552 -+#define REG_DUAL_TSF_RST_8812F 0x0553 -+#define REG_MBSSID_BCN_SPACE_8812F 0x0554 -+#define REG_DRVERLYINT_8812F 0x0558 -+#define REG_BCNDMATIM_8812F 0x0559 -+#define REG_ATIMWND_8812F 0x055A -+#define REG_USTIME_TSF_8812F 0x055C -+#define REG_BCN_MAX_ERR_8812F 0x055D -+#define REG_RXTSF_OFFSET_CCK_8812F 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8812F 0x055F -+#define REG_TSFTR_8812F 0x0560 -+#define REG_TSFTR_1_8812F 0x0564 -+#define REG_FREERUN_CNT_8812F 0x0568 -+#define REG_FREERUN_CNT_1_8812F 0x056C -+#define REG_ATIMWND1_V1_8812F 0x0570 -+#define REG_TBTT_PROHIBIT_INFRA_8812F 0x0571 -+#define REG_CTWND_8812F 0x0572 -+#define REG_BCNIVLCUNT_8812F 0x0573 -+#define REG_BCNDROPCTRL_8812F 0x0574 -+#define REG_HGQ_TIMEOUT_PERIOD_8812F 0x0575 -+#define REG_TXCMD_TIMEOUT_PERIOD_8812F 0x0576 -+#define REG_MISC_CTRL_8812F 0x0577 -+#define REG_BCN_CTRL_CLINT1_8812F 0x0578 -+#define REG_BCN_CTRL_CLINT2_8812F 0x0579 -+#define REG_BCN_CTRL_CLINT3_8812F 0x057A -+#define REG_EXTEND_CTRL_8812F 0x057B -+#define REG_P2PPS1_SPEC_STATE_8812F 0x057C -+#define REG_P2PPS1_STATE_8812F 0x057D -+#define REG_P2PPS2_SPEC_STATE_8812F 0x057E -+#define REG_P2PPS2_STATE_8812F 0x057F -+#define REG_PS_TIMER0_8812F 0x0580 -+#define REG_PS_TIMER1_8812F 0x0584 -+#define REG_PS_TIMER2_8812F 0x0588 -+#define REG_TBTT_CTN_AREA_8812F 0x058C -+#define REG_FORCE_BCN_IFS_8812F 0x058E -+#define REG_TXOP_MIN_8812F 0x0590 -+#define REG_PRE_BKF_TIME_8812F 0x0592 -+#define REG_CROSS_TXOP_CTRL_8812F 0x0593 -+#define REG_RX_TBTT_SHIFT_V1_8812F 0x0598 -+#define REG_ATIMWND2_8812F 0x05A0 -+#define REG_ATIMWND3_8812F 0x05A1 -+#define REG_ATIMWND4_8812F 0x05A2 -+#define REG_ATIMWND5_8812F 0x05A3 -+#define REG_ATIMWND6_8812F 0x05A4 -+#define REG_ATIMWND7_8812F 0x05A5 -+#define REG_ATIMUGT_8812F 0x05A6 -+#define REG_HIQ_NO_LMT_EN_8812F 0x05A7 -+#define REG_DTIM_COUNTER_ROOT_8812F 0x05A8 -+#define REG_DTIM_COUNTER_VAP1_8812F 0x05A9 -+#define REG_DTIM_COUNTER_VAP2_8812F 0x05AA -+#define REG_DTIM_COUNTER_VAP3_8812F 0x05AB -+#define REG_DTIM_COUNTER_VAP4_8812F 0x05AC -+#define REG_DTIM_COUNTER_VAP5_8812F 0x05AD -+#define REG_DTIM_COUNTER_VAP6_8812F 0x05AE -+#define REG_DTIM_COUNTER_VAP7_8812F 0x05AF -+#define REG_DIS_ATIM_8812F 0x05B0 -+#define REG_EARLY_128US_8812F 0x05B1 -+#define REG_P2PPS1_CTRL_8812F 0x05B2 -+#define REG_P2PPS2_CTRL_8812F 0x05B3 -+#define REG_TIMER0_SRC_SEL_8812F 0x05B4 -+#define REG_NOA_UNIT_SEL_8812F 0x05B5 -+#define REG_P2POFF_DIS_TXTIME_8812F 0x05B7 -+#define REG_MBSSID_BCN_SPACE2_8812F 0x05B8 -+#define REG_MBSSID_BCN_SPACE3_8812F 0x05BC -+#define REG_ACMHWCTRL_8812F 0x05C0 -+#define REG_ACMRSTCTRL_8812F 0x05C1 -+#define REG_ACMAVG_8812F 0x05C2 -+#define REG_VO_ADMTIME_8812F 0x05C4 -+#define REG_VI_ADMTIME_8812F 0x05C6 -+#define REG_BE_ADMTIME_8812F 0x05C8 -+#define REG_MAC_HEADER_NAV_OFFSET_8812F 0x05CA -+#define REG_DIS_NDPA_NAV_CHECK_8812F 0x05CB -+#define REG_EDCA_RANDOM_GEN_8812F 0x05CC -+#define REG_TXCMD_NOA_SEL_8812F 0x05CF -+#define REG_32K_CLK_SEL_8812F 0x05D0 -+#define REG_EARLYINT_ADJUST_8812F 0x05D4 -+#define REG_BCNERR_CNT_8812F 0x05D8 -+#define REG_BCNERR_CNT_2_8812F 0x05DC -+#define REG_NOA_PARAM_8812F 0x05E0 -+#define REG_NOA_PARAM_1_8812F 0x05E4 -+#define REG_NOA_PARAM_2_8812F 0x05E8 -+#define REG_NOA_PARAM_3_8812F 0x05EC -+#define REG_P2P_RST_8812F 0x05F0 -+#define REG_SCHEDULER_RST_8812F 0x05F1 -+#define REG_SCH_DBG_VALUE_8812F 0x05F4 -+#define REG_SCH_TXCMD_8812F 0x05F8 -+#define REG_PAGE5_DUMMY_8812F 0x05FC -+#define REG_CPUMGQ_TX_TIMER_8812F 0x1500 -+#define REG_PS_TIMER_A_8812F 0x1504 -+#define REG_PS_TIMER_B_8812F 0x1508 -+#define REG_PS_TIMER_C_8812F 0x150C -+#define REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL_8812F 0x1510 -+#define REG_CPUMGQ_TX_TIMER_EARLY_8812F 0x1514 -+#define REG_PS_TIMER_A_EARLY_8812F 0x1515 -+#define REG_PS_TIMER_B_EARLY_8812F 0x1516 -+#define REG_PS_TIMER_C_EARLY_8812F 0x1517 -+#define REG_CPUMGQ_PARAMETER_8812F 0x1518 -+#define REG_TSF_SYNC_ADJ_8812F 0x1520 -+#define REG_TSF_ADJ_VLAUE_8812F 0x1524 -+#define REG_TSF_ADJ_VLAUE_2_8812F 0x1528 -+#define REG_P2PPS_HW_AUTO_PAUSE_CTRL_8812F 0x156C -+#define REG_P2PPS1_HW_AUTO_PAUSE_CTRL_8812F 0x1570 -+#define REG_P2PPS2_HW_AUTO_PAUSE_CTRL_8812F 0x1574 -+#define REG_WMAC_CR_8812F 0x0600 -+#define REG_WMAC_FWPKT_CR_8812F 0x0601 -+#define REG_FW_STS_FILTER_8812F 0x0602 -+#define REG_TCR_8812F 0x0604 -+#define REG_RCR_8812F 0x0608 -+#define REG_RX_PKT_LIMIT_8812F 0x060C -+#define REG_RX_DLK_TIME_8812F 0x060D -+#define REG_RX_DRVINFO_SZ_8812F 0x060F -+#define REG_MACID_8812F 0x0610 -+#define REG_MACID_H_8812F 0x0614 -+#define REG_BSSID_8812F 0x0618 -+#define REG_BSSID_H_8812F 0x061C -+#define REG_MAR_8812F 0x0620 -+#define REG_MAR_H_8812F 0x0624 -+#define REG_MBIDCAMCFG_1_8812F 0x0628 -+#define REG_MBIDCAMCFG_2_8812F 0x062C -+#define REG_WMAC_TCR_TSFT_OFS_8812F 0x0630 -+#define REG_UDF_THSD_8812F 0x0632 -+#define REG_ZLD_NUM_8812F 0x0633 -+#define REG_STMP_THSD_8812F 0x0634 -+#define REG_WMAC_TXTIMEOUT_8812F 0x0635 -+#define REG_USTIME_EDCA_8812F 0x0638 -+#define REG_ACKTO_CCK_8812F 0x0639 -+#define REG_MAC_SPEC_SIFS_8812F 0x063A -+#define REG_RESP_SIFS_CCK_8812F 0x063C -+#define REG_RESP_SIFS_OFDM_8812F 0x063E -+#define REG_ACKTO_8812F 0x0640 -+#define REG_CTS2TO_8812F 0x0641 -+#define REG_EIFS_8812F 0x0642 -+#define REG_RPFM_MAP0_8812F 0x0644 -+#define REG_RPFM_MAP1_V1_8812F 0x0646 -+#define REG_RPFM_CAM_CMD_8812F 0x0648 -+#define REG_RPFM_CAM_RWD_8812F 0x064C -+#define REG_NAV_CTRL_8812F 0x0650 -+#define REG_BACAMCMD_8812F 0x0654 -+#define REG_BACAMCONTENT_8812F 0x0658 -+#define REG_BACAMCONTENT_H_8812F 0x065C -+#define REG_LBDLY_8812F 0x0660 -+#define REG_WMAC_BACAM_RPMEN_8812F 0x0661 -+#define REG_TX_RX_8812F 0x0662 -+#define REG_WMAC_BITMAP_CTL_8812F 0x0663 -+#define REG_RXERR_RPT_8812F 0x0664 -+#define REG_WMAC_TRXPTCL_CTL_8812F 0x0668 -+#define REG_WMAC_TRXPTCL_CTL_H_8812F 0x066C -+#define REG_CAMCMD_8812F 0x0670 -+#define REG_CAMWRITE_8812F 0x0674 -+#define REG_CAMREAD_8812F 0x0678 -+#define REG_CAMDBG_8812F 0x067C -+#define REG_SECCFG_8812F 0x0680 -+#define REG_RXFILTER_CATEGORY_1_8812F 0x0682 -+#define REG_RXFILTER_ACTION_1_8812F 0x0683 -+#define REG_RXFILTER_CATEGORY_2_8812F 0x0684 -+#define REG_RXFILTER_ACTION_2_8812F 0x0685 -+#define REG_RXFILTER_CATEGORY_3_8812F 0x0686 -+#define REG_RXFILTER_ACTION_3_8812F 0x0687 -+#define REG_RXFLTMAP3_8812F 0x0688 -+#define REG_RXFLTMAP4_8812F 0x068A -+#define REG_RXFLTMAP5_8812F 0x068C -+#define REG_RXFLTMAP6_8812F 0x068E -+#define REG_WOW_CTRL_8812F 0x0690 -+#define REG_NAN_RX_TSF_FILTER_8812F 0x0691 -+#define REG_PS_RX_INFO_8812F 0x0692 -+#define REG_WMMPS_UAPSD_TID_8812F 0x0693 -+#define REG_LPNAV_CTRL_8812F 0x0694 -+#define REG_WKFMCAM_CMD_8812F 0x0698 -+#define REG_WKFMCAM_RWD_8812F 0x069C -+#define REG_RXFLTMAP0_8812F 0x06A0 -+#define REG_RXFLTMAP1_8812F 0x06A2 -+#define REG_RXFLTMAP2_8812F 0x06A4 -+#define REG_BCN_PSR_RPT_8812F 0x06A8 -+#define REG_FLC_RPC_8812F 0x06AC -+#define REG_FLC_RPCT_8812F 0x06AD -+#define REG_FLC_PTS_8812F 0x06AE -+#define REG_FLC_TRPC_8812F 0x06AF -+#define REG_RXPKTMON_CTRL_8812F 0x06B0 -+#define REG_STATE_MON_8812F 0x06B4 -+#define REG_ERROR_MON_8812F 0x06B8 -+#define REG_SEARCH_MACID_8812F 0x06BC -+#define REG_BT_COEX_TABLE_8812F 0x06C0 -+#define REG_BT_COEX_TABLE2_8812F 0x06C4 -+#define REG_BT_COEX_BREAK_TABLE_8812F 0x06C8 -+#define REG_BT_COEX_TABLE_H_8812F 0x06CC -+#define REG_RXCMD_0_8812F 0x06D0 -+#define REG_RXCMD_1_8812F 0x06D4 -+#define REG_WMAC_RESP_TXINFO_8812F 0x06D8 -+#define REG_BBPSF_CTRL_8812F 0x06DC -+#define REG_P2P_RX_BCN_NOA_8812F 0x06E0 -+#define REG_ASSOCIATED_BFMER0_INFO_8812F 0x06E4 -+#define REG_ASSOCIATED_BFMER0_INFO_H_8812F 0x06E8 -+#define REG_ASSOCIATED_BFMER1_INFO_8812F 0x06EC -+#define REG_ASSOCIATED_BFMER1_INFO_H_8812F 0x06F0 -+#define REG_TX_CSI_RPT_PARAM_BW20_8812F 0x06F4 -+#define REG_TX_CSI_RPT_PARAM_BW40_8812F 0x06F8 -+#define REG_CSI_PTR_8812F 0x06FC -+#define REG_BCN_PSR_RPT2_8812F 0x1600 -+#define REG_BCN_PSR_RPT3_8812F 0x1604 -+#define REG_BCN_PSR_RPT4_8812F 0x1608 -+#define REG_A1_ADDR_MASK_8812F 0x160C -+#define REG_RXPSF_CTRL_8812F 0x1610 -+#define REG_RXPSF_TYPE_CTRL_8812F 0x1614 -+#define REG_CAM_ACCESS_CTRL_8812F 0x1618 -+#define REG_HT_SND_REF_RATE_8812F 0x161C -+#define REG_MACID2_8812F 0x1620 -+#define REG_MACID2_H_8812F 0x1624 -+#define REG_BSSID2_8812F 0x1628 -+#define REG_BSSID2_H_8812F 0x162C -+#define REG_MACID3_8812F 0x1630 -+#define REG_MACID3_H_8812F 0x1634 -+#define REG_BSSID3_8812F 0x1638 -+#define REG_BSSID3_H_8812F 0x163C -+#define REG_MACID4_8812F 0x1640 -+#define REG_MACID4_H_8812F 0x1644 -+#define REG_BSSID4_8812F 0x1648 -+#define REG_BSSID4_H_8812F 0x164C -+#define REG_NOA_REPORT_8812F 0x1650 -+#define REG_NOA_REPORT_1_8812F 0x1654 -+#define REG_NOA_REPORT_2_8812F 0x1658 -+#define REG_NOA_REPORT_3_8812F 0x165C -+#define REG_PWRBIT_SETTING_8812F 0x1660 -+#define REG_GENERAL_OPTION_8812F 0x1664 -+#define REG_RXAI_CTRL_8812F 0x1668 -+#define REG_CSI_RRSR_8812F 0x1678 -+#define REG_MU_BF_OPTION_8812F 0x167C -+#define REG_WMAC_PAUSE_BB_CLR_TH_8812F 0x167D -+#define REG__WMAC_MULBK_BUF_8812F 0x167E -+#define REG_WMAC_MU_OPTION_8812F 0x167F -+#define REG_WMAC_MU_BF_CTL_8812F 0x1680 -+#define REG_WMAC_MU_BFRPT_PARA_8812F 0x1682 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE2_8812F 0x1684 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE3_8812F 0x1686 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE4_8812F 0x1688 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE5_8812F 0x168A -+#define REG_WMAC_ASSOCIATED_MU_BFMEE6_8812F 0x168C -+#define REG_WMAC_ASSOCIATED_MU_BFMEE7_8812F 0x168E -+#define REG_WMAC_BB_STOP_RX_COUNTER_8812F 0x1690 -+#define REG_WMAC_PLCP_MONITOR_8812F 0x1694 -+#define REG_WMAC_PLCP_MONITOR_MUTX_8812F 0x1698 -+#define REG_WMAC_CSIDMA_CFG_8812F 0x169C -+#define REG_TRANSMIT_ADDRSS_0_8812F 0x16A0 -+#define REG_TRANSMIT_ADDRSS_0_H_8812F 0x16A4 -+#define REG_TRANSMIT_ADDRSS_1_8812F 0x16A8 -+#define REG_TRANSMIT_ADDRSS_1_H_8812F 0x16AC -+#define REG_TRANSMIT_ADDRSS_2_8812F 0x16B0 -+#define REG_TRANSMIT_ADDRSS_2_H_8812F 0x16B4 -+#define REG_TRANSMIT_ADDRSS_3_8812F 0x16B8 -+#define REG_TRANSMIT_ADDRSS_3_H_8812F 0x16BC -+#define REG_TRANSMIT_ADDRSS_4_8812F 0x16C0 -+#define REG_TRANSMIT_ADDRSS_4_H_8812F 0x16C4 -+#define REG_SND_AID12_8812F 0x16D0 -+#define REG_SND_PKT_INFO_8812F 0x16D2 -+#define REG_MACID1_8812F 0x0700 -+#define REG_MACID1_1_8812F 0x0704 -+#define REG_BSSID1_8812F 0x0708 -+#define REG_BSSID1_1_8812F 0x070C -+#define REG_BCN_PSR_RPT1_8812F 0x0710 -+#define REG_ASSOCIATED_BFMEE_SEL_8812F 0x0714 -+#define REG_SND_PTCL_CTRL_8812F 0x0718 -+#define REG_RX_CSI_RPT_INFO_8812F 0x071C -+#define REG_NS_ARP_CTRL_8812F 0x0720 -+#define REG_NS_ARP_INFO_8812F 0x0724 -+#define REG_BEAMFORMING_INFO_NSARP_V1_8812F 0x0728 -+#define REG_BEAMFORMING_INFO_NSARP_8812F 0x072C -+#define REG_IPV6_8812F 0x0730 -+#define REG_IPV6_1_8812F 0x0734 -+#define REG_IPV6_2_8812F 0x0738 -+#define REG_IPV6_3_8812F 0x073C -+#define REG_WMAC_RTX_CTX_SUBTYPE_CFG_8812F 0x0750 -+#define REG_WMAC_SWAES_DIO_B63_B32_8812F 0x0754 -+#define REG_WMAC_SWAES_DIO_B95_B64_8812F 0x0758 -+#define REG_WMAC_SWAES_DIO_B127_B96_8812F 0x075C -+#define REG_WMAC_SWAES_CFG_8812F 0x0760 -+#define REG_BT_COEX_V2_8812F 0x0762 -+#define REG_BT_COEX_8812F 0x0764 -+#define REG_WLAN_ACT_MASK_CTRL_8812F 0x0768 -+#define REG_WLAN_ACT_MASK_CTRL_1_8812F 0x076C -+#define REG_BT_COEX_ENHANCED_INTR_CTRL_8812F 0x076E -+#define REG_BT_ACT_STATISTICS_8812F 0x0770 -+#define REG_BT_ACT_STATISTICS_1_8812F 0x0774 -+#define REG_BT_STATISTICS_CONTROL_REGISTER_8812F 0x0778 -+#define REG_BT_STATUS_REPORT_REGISTER_8812F 0x077C -+#define REG_BT_INTERRUPT_CONTROL_REGISTER_8812F 0x0780 -+#define REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8812F 0x0784 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8812F 0x0785 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_1_8812F 0x0788 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_2_8812F 0x078C -+#define REG_BT_INTERRUPT_STATUS_REGISTER_8812F 0x078F -+#define REG_BT_TDMA_TIME_REGISTER_8812F 0x0790 -+#define REG_BT_ACT_REGISTER_8812F 0x0794 -+#define REG_OBFF_CTRL_BASIC_8812F 0x0798 -+#define REG_OBFF_CTRL2_TIMER_8812F 0x079C -+#define REG_LTR_CTRL_BASIC_8812F 0x07A0 -+#define REG_LTR_CTRL2_TIMER_THRESHOLD_8812F 0x07A4 -+#define REG_LTR_IDLE_LATENCY_V1_8812F 0x07A8 -+#define REG_LTR_ACTIVE_LATENCY_V1_8812F 0x07AC -+#define REG_ANTENNA_TRAINING_CONTROL_REGISTER_8812F 0x07B0 -+#define REG_ANTENNA_TRAINING_CONTROL_REGISTER_1_8812F 0x07B4 -+#define REG_WMAC_PKTCNT_RWD_8812F 0x07B8 -+#define REG_WMAC_PKTCNT_CTRL_8812F 0x07BC -+#define REG_IQ_DUMP_8812F 0x07C0 -+#define REG_IQ_DUMP_1_8812F 0x07C4 -+#define REG_IQ_DUMP_2_8812F 0x07C8 -+#define REG_WMAC_FTM_CTL_8812F 0x07CC -+#define REG_WMAC_IQ_MDPK_FUNC_8812F 0x07CE -+#define REG_WMAC_OPTION_FUNCTION_8812F 0x07D0 -+#define REG_WMAC_OPTION_FUNCTION_1_8812F 0x07D4 -+#define REG_WMAC_OPTION_FUNCTION_2_8812F 0x07D8 -+#define REG_RX_FILTER_FUNCTION_8812F 0x07DA -+#define REG_NDP_SIG_8812F 0x07E0 -+#define REG_TXCMD_INFO_FOR_RSP_PKT_8812F 0x07E4 -+#define REG_TXCMD_INFO_FOR_RSP_PKT_1_8812F 0x07E8 -+#define REG_WSEC_OPTION_8812F 0x07EC -+#define REG_RTS_ADDRESS_0_8812F 0x07F0 -+#define REG_RTS_ADDRESS_0_1_8812F 0x07F4 -+#define REG_RTS_ADDRESS_1_8812F 0x07F8 -+#define REG_RTS_ADDRESS_1_1_8812F 0x07FC -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8812F 0x1700 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8812F 0x1704 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8812F 0x1708 -+#define REG_SDIO_TX_CTRL_8812F 0x10250000 -+#define REG_SDIO_CMD11_VOL_SWITCH_8812F 0x10250004 -+#define REG_SDIO_CTRL_8812F 0x10250005 -+#define REG_SDIO_DRIVING_8812F 0x10250006 -+#define REG_SDIO_MONITOR_8812F 0x10250008 -+#define REG_SDIO_MONITOR_2_8812F 0x1025000C -+#define REG_SDIO_CTRL_2_8812F 0x10250010 -+#define REG_SDIO_HIMR_8812F 0x10250014 -+#define REG_SDIO_HISR_8812F 0x10250018 -+#define REG_SDIO_RX_REQ_LEN_8812F 0x1025001C -+#define REG_SDIO_FREE_TXPG_SEQ_V1_8812F 0x1025001F -+#define REG_SDIO_FREE_TXPG_8812F 0x10250020 -+#define REG_SDIO_FREE_TXPG2_8812F 0x10250024 -+#define REG_SDIO_OQT_FREE_TXPG_V1_8812F 0x10250028 -+#define REG_SDIO_TXPKT_EMPTY_8812F 0x1025002C -+#define REG_SDIO_HTSFR_INFO_8812F 0x10250030 -+#define REG_SDIO_HCPWM1_V2_8812F 0x10250038 -+#define REG_SDIO_HCPWM2_V2_8812F 0x1025003A -+#define REG_SDIO_INDIRECT_REG_CFG_8812F 0x10250040 -+#define REG_SDIO_INDIRECT_REG_DATA_8812F 0x10250044 -+#define REG_SDIO_H2C_8812F 0x10250060 -+#define REG_SDIO_C2H_8812F 0x10250064 -+#define REG_SDIO_HRPWM1_8812F 0x10250080 -+#define REG_SDIO_HRPWM2_8812F 0x10250082 -+#define REG_SDIO_HPS_CLKR_8812F 0x10250084 -+#define REG_SDIO_BUS_CTRL_8812F 0x10250085 -+#define REG_SDIO_HSUS_CTRL_8812F 0x10250086 -+#define REG_SDIO_RESPONSE_TIMER_8812F 0x10250088 -+#define REG_SDIO_CMD_CRC_8812F 0x1025008A -+#define REG_SDIO_HSISR_8812F 0x10250090 -+#define REG_SDIO_HSIMR_8812F 0x10250091 -+#define REG_SDIO_DIOERR_RPT_8812F 0x102500C0 -+#define REG_SDIO_CMD_ERRCNT_8812F 0x102500C2 -+#define REG_SDIO_DATA_ERRCNT_8812F 0x102500C3 -+#define REG_SDIO_CMD_ERR_CONTENT_8812F 0x102500C4 -+#define REG_SDIO_CRC_ERR_IDX_8812F 0x102500C9 -+#define REG_SDIO_DATA_CRC_8812F 0x102500CA -+#define REG_SDIO_TRANS_FIFO_STATUS_8812F 0x102500CC -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8814b.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8814b.h -new file mode 100644 -index 000000000..9b0ac744e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8814b.h -@@ -0,0 +1,1058 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_REG_8814B_H -+#define __INC_HALMAC_REG_8814B_H -+ -+#define REG_SYS_ISO_CTRL_8814B 0x0000 -+#define REG_SYS_FUNC_EN_8814B 0x0002 -+#define REG_SYS_PW_CTRL_8814B 0x0004 -+#define REG_SYS_CLK_CTRL_8814B 0x0008 -+#define REG_SYS_EEPROM_CTRL_8814B 0x000A -+#define REG_EE_VPD_8814B 0x000C -+#define REG_SYS_SWR_CTRL1_8814B 0x0010 -+#define REG_SYS_SWR_CTRL2_8814B 0x0014 -+#define REG_SYS_SWR_CTRL3_8814B 0x0018 -+#define REG_RSV_CTRL_8814B 0x001C -+#define REG_RF_CTRL_8814B 0x001F -+#define REG_AFE_LDO_CTRL_8814B 0x0020 -+#define REG_AFE_CTRL1_8814B 0x0024 -+#define REG_ANAPARSW_POW_MAC_8814B 0x0028 -+#define REG_ANAPARLDO_POW_MAC_8814B 0x0029 -+#define REG_ANAPAR_POW_MAC_8814B 0x002A -+#define REG_ANAPAR_POW_XTAL_8814B 0x002B -+#define REG_ANAPARLDO_MAC_8814B 0x002C -+#define REG_EFUSE_CTRL_8814B 0x0030 -+#define REG_LDO_EFUSE_CTRL_8814B 0x0034 -+#define REG_PWR_OPTION_CTRL_8814B 0x0038 -+#define REG_CAL_TIMER_8814B 0x003C -+#define REG_ACLK_MON_8814B 0x003E -+#define REG_GPIO_MUXCFG_8814B 0x0040 -+#define REG_GPIO_PIN_CTRL_8814B 0x0044 -+#define REG_GPIO_INTM_8814B 0x0048 -+#define REG_LED_CFG_8814B 0x004C -+#define REG_FSIMR_8814B 0x0050 -+#define REG_FSISR_8814B 0x0054 -+#define REG_HSIMR_8814B 0x0058 -+#define REG_HSISR_8814B 0x005C -+#define REG_GPIO_EXT_CTRL_8814B 0x0060 -+#define REG_PAD_CTRL1_8814B 0x0064 -+#define REG_WL_BT_PWR_CTRL_8814B 0x0068 -+#define REG_SDM_DEBUG_8814B 0x006C -+#define REG_SYS_SDIO_CTRL_8814B 0x0070 -+#define REG_HCI_OPT_CTRL_8814B 0x0074 -+#define REG_AFE_CTRL4_8814B 0x0078 -+#define REG_LDO_SWR_CTRL_8814B 0x007C -+#define REG_MCUFW_CTRL_8814B 0x0080 -+#define REG_MCU_TST_CFG_8814B 0x0084 -+#define REG_HMEBOX_E0_E1_8814B 0x0088 -+#define REG_HMEBOX_E2_E3_8814B 0x008C -+#define REG_WLLPS_CTRL_8814B 0x0090 -+#define REG_AFE_CTRL5_8814B 0x0094 -+#define REG_GPIO_DEBOUNCE_CTRL_8814B 0x0098 -+#define REG_RPWM2_8814B 0x009C -+#define REG_SYSON_FSM_MON_8814B 0x00A0 -+#define REG_AFE_CTRL6_8814B 0x00A4 -+#define REG_PMC_DBG_CTRL1_8814B 0x00A8 -+#define REG_AFE_CTRL7_8814B 0x00AC -+#define REG_HIMR0_8814B 0x00B0 -+#define REG_HISR0_8814B 0x00B4 -+#define REG_HIMR1_8814B 0x00B8 -+#define REG_HISR1_8814B 0x00BC -+#define REG_DBG_PORT_SEL_8814B 0x00C0 -+#define REG_PAD_CTRL2_8814B 0x00C4 -+#define REG_PMC_DBG_CTRL2_8814B 0x00CC -+#define REG_MEM_CTRL_8814B 0x00D8 -+#define REG_SYN_RFC_CTRL_8814B 0x00DC -+#define REG_USB_SIE_INTF_8814B 0x00E0 -+#define REG_PCIE_MIO_INTF_8814B 0x00E4 -+#define REG_PCIE_MIO_INTD_8814B 0x00E8 -+#define REG_WLRF1_8814B 0x00EC -+#define REG_SYS_CFG1_8814B 0x00F0 -+#define REG_SYS_STATUS1_8814B 0x00F4 -+#define REG_SYS_STATUS2_8814B 0x00F8 -+#define REG_SYS_CFG2_8814B 0x00FC -+#define REG_ANAPARSW_MAC_0_8814B 0x1010 -+#define REG_ANAPARSW_MAC_1_8814B 0x1014 -+#define REG_ANAPAR_MAC_0_8814B 0x1018 -+#define REG_ANAPAR_MAC_1_8814B 0x101C -+#define REG_ANAPAR_MAC_2_8814B 0x1020 -+#define REG_ANAPAR_MAC_3_8814B 0x1024 -+#define REG_ANAPAR_MAC_4_8814B 0x1028 -+#define REG_ANAPAR_MAC_5_8814B 0x102C -+#define REG_ANAPAR_MAC_6_8814B 0x1030 -+#define REG_ANAPAR_MAC_7_8814B 0x1034 -+#define REG_ANAPAR_MAC_8_8814B 0x1038 -+#define REG_ANAPAR_XTAL_0_8814B 0x1040 -+#define REG_ANAPAR_XTAL_1_8814B 0x1044 -+#define REG_ANAPAR_XTAL_2_8814B 0x1048 -+#define REG_ANAPAR_XTAL_AAC_8814B 0x104C -+#define REG_ANAPAR_XTAL_R_ONLY_8814B 0x1050 -+#define REG_CPHY_LDO_8814B 0x1054 -+#define REG_CPHY_BG_8814B 0x1058 -+#define REG_HIMR_4_8814B 0x1060 -+#define REG_HISR_4_8814B 0x1064 -+#define REG_HIMR_5_8814B 0x1068 -+#define REG_HISR_5_8814B 0x106C -+#define REG_SYS_CFG5_8814B 0x1070 -+#define REG_HIMR_6_8814B 0x1078 -+#define REG_HISR_6_8814B 0x107C -+#define REG_CPU_DMEM_CON_8814B 0x1080 -+#define REG_BOOT_REASON_8814B 0x1088 -+#define REG_DATA_CPU_CTL0_8814B 0x1090 -+#define REG_DATA_CPU_CTL1_8814B 0x1094 -+#define REG_TXDMA_STOP_HIMR_8814B 0x1098 -+#define REG_TXDMA_STOP_HISR_8814B 0x109C -+#define REG_TXDMA_START_HIMR_8814B 0x10A0 -+#define REG_TXDMA_START_HISR_8814B 0x10A4 -+#define REG_NFCPAD_CTRL_8814B 0x10A8 -+#define REG_HIMR2_8814B 0x10B0 -+#define REG_HISR2_8814B 0x10B4 -+#define REG_HIMR3_8814B 0x10B8 -+#define REG_HISR3_8814B 0x10BC -+#define REG_SW_MDIO_8814B 0x10C0 -+#define REG_HIMR_7_8814B 0x10C8 -+#define REG_HISR_7_8814B 0x10CC -+#define REG_H2C_PKT_READADDR_8814B 0x10D0 -+#define REG_H2C_PKT_WRITEADDR_8814B 0x10D4 -+#define REG_MEM_PWR_CRTL_8814B 0x10D8 -+#define REG_FW_DRV_HANDSHAKE_8814B 0x10DC -+#define REG_FW_DBG0_8814B 0x10E0 -+#define REG_FW_DBG1_8814B 0x10E4 -+#define REG_FW_DBG2_8814B 0x10E8 -+#define REG_FW_DBG3_8814B 0x10EC -+#define REG_FW_DBG4_8814B 0x10F0 -+#define REG_FW_DBG5_8814B 0x10F4 -+#define REG_FW_DBG6_8814B 0x10F8 -+#define REG_FW_DBG7_8814B 0x10FC -+#define REG_CR_8814B 0x0100 -+#define REG_PG_SIZE_8814B 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL_8814B 0x0106 -+#define REG_TSF_CLK_STATE_8814B 0x0108 -+#define REG_TXDMA_PQ_MAP_8814B 0x010C -+#define REG_TRXFF_BNDY_8814B 0x0114 -+#define REG_PTA_I2C_MBOX_8814B 0x0118 -+#define REG_RXFF_BNDY_8814B 0x011C -+#define REG_FE1IMR_8814B 0x0120 -+#define REG_FE1ISR_8814B 0x0124 -+#define REG_CPWM_8814B 0x012C -+#define REG_FWIMR_8814B 0x0130 -+#define REG_FWISR_8814B 0x0134 -+#define REG_FTIMR_8814B 0x0138 -+#define REG_FTISR_8814B 0x013C -+#define REG_PKTBUF_DBG_CTRL_8814B 0x0140 -+#define REG_PKTBUF_DBG_DATA_L_8814B 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8814B 0x0148 -+#define REG_CPWM2_8814B 0x014C -+#define REG_TC0_CTRL_8814B 0x0150 -+#define REG_TC1_CTRL_8814B 0x0154 -+#define REG_TC2_CTRL_8814B 0x0158 -+#define REG_TC3_CTRL_8814B 0x015C -+#define REG_TC4_CTRL_8814B 0x0160 -+#define REG_TCUNIT_BASE_8814B 0x0164 -+#define REG_TC5_CTRL_8814B 0x0168 -+#define REG_TC6_CTRL_8814B 0x016C -+#define REG_AES_DECRPT_DATA_8814B 0x0180 -+#define REG_AES_DECRPT_CFG_8814B 0x0184 -+#define REG_HIOE_CTRL_8814B 0x0188 -+#define REG_HIOE_CFG_FILE_8814B 0x018C -+#define REG_TMETER_8814B 0x0190 -+#define REG_OSC_32K_CTRL_8814B 0x0194 -+#define REG_32K_CAL_REG1_8814B 0x0198 -+#define REG_C2HEVT_8814B 0x01A0 -+#define REG_C2HEVT_1_8814B 0x01A4 -+#define REG_C2HEVT_2_8814B 0x01A8 -+#define REG_C2HEVT_3_8814B 0x01AC -+#define REG_RXDESC_BUFF_RPTR_8814B 0x01B0 -+#define REG_RXDESC_BUFF_WPTR_8814B 0x01B4 -+#define REG_SW_DEFINED_PAGE1_8814B 0x01B8 -+#define REG_SW_DEFINED_PAGE2_8814B 0x01BC -+#define REG_MCUTST_I_8814B 0x01C0 -+#define REG_MCUTST_II_8814B 0x01C4 -+#define REG_FMETHR_8814B 0x01C8 -+#define REG_HMETFR_8814B 0x01CC -+#define REG_HMEBOX0_8814B 0x01D0 -+#define REG_HMEBOX1_8814B 0x01D4 -+#define REG_HMEBOX2_8814B 0x01D8 -+#define REG_HMEBOX3_8814B 0x01DC -+#define REG_RXDESC_BUFF_BNDY_8814B 0x01E0 -+#define REG_BB_ACCESS_CTRL_8814B 0x01E8 -+#define REG_BB_ACCESS_DATA_8814B 0x01EC -+#define REG_HMEBOX_E0_8814B 0x01F0 -+#define REG_HMEBOX_E1_8814B 0x01F4 -+#define REG_HMEBOX_E2_8814B 0x01F8 -+#define REG_HMEBOX_E3_8814B 0x01FC -+#define REG_CR_EXT_8814B 0x1100 -+#define REG_TC9_CTRL_8814B 0x1104 -+#define REG_TC10_CTRL_8814B 0x1108 -+#define REG_TC11_CTRL_8814B 0x110C -+#define REG_TC12_CTRL_8814B 0x1110 -+#define REG_FWFF_8814B 0x1114 -+#define REG_RXFF_PTR_V1_8814B 0x1118 -+#define REG_RXFF_WTR_V1_8814B 0x111C -+#define REG_FE2IMR_8814B 0x1120 -+#define REG_FE2ISR_8814B 0x1124 -+#define REG_FE3IMR_8814B 0x1128 -+#define REG_FE3ISR_8814B 0x112C -+#define REG_FE4IMR_8814B 0x1130 -+#define REG_FE4ISR_8814B 0x1134 -+#define REG_FT1IMR_8814B 0x1138 -+#define REG_FT1ISR_8814B 0x113C -+#define REG_SPWR0_8814B 0x1140 -+#define REG_SPWR1_8814B 0x1144 -+#define REG_SPWR2_8814B 0x1148 -+#define REG_SPWR3_8814B 0x114C -+#define REG_POWSEQ_8814B 0x1150 -+#define REG_TC7_CTRL_V1_8814B 0x1158 -+#define REG_TC8_CTRL_V1_8814B 0x115C -+#define REG_RX_BCN_TBTT_ITVL0_8814B 0x1160 -+#define REG_RX_BCN_TBTT_ITVL1_8814B 0x1164 -+#define REG_FWIMR1_8814B 0x1168 -+#define REG_FWISR1_8814B 0x116C -+#define REG_FWIMR2_8814B 0x1170 -+#define REG_FWISR2_8814B 0x1174 -+#define REG_FWIMR3_8814B 0x1178 -+#define REG_FWISR3_8814B 0x117C -+#define REG_SPEED_SENSOR_8814B 0x1180 -+#define REG_SPEED_SENSOR1_8814B 0x1184 -+#define REG_SPEED_SENSOR2_8814B 0x1188 -+#define REG_SPEED_SENSOR3_8814B 0x118C -+#define REG_SPEED_SENSOR4_8814B 0x1190 -+#define REG_SPEED_SENSOR5_8814B 0x1194 -+#define REG_RXPKTBUF_1_MAX_ADDR_8814B 0x1198 -+#define REG_RXFWBUF_1_MAX_ADDR_8814B 0x119C -+#define REG_IO_WRAP_ERR_FLAG_V1_8814B 0x11A0 -+#define REG_RXPKTBUF_1_READ_8814B 0x11A4 -+#define REG_RXPKTBUF_1_WRITE_8814B 0x11A8 -+#define REG_BUFF_DBGUG_8814B 0x11AC -+#define REG_RFE_CTRL_PAD_E2_8814B 0x11B0 -+#define REG_RFE_CTRL_PAD_SR_8814B 0x11B4 -+#define REG_H2C_PRIORITY_SEL_8814B 0x11C0 -+#define REG_COUNTER_CTRL_8814B 0x11C4 -+#define REG_COUNTER_THRESHOLD_8814B 0x11C8 -+#define REG_COUNTER_SET_8814B 0x11CC -+#define REG_COUNTER_OVERFLOW_8814B 0x11D0 -+#define REG_TXDMA_LEN_THRESHOLD_8814B 0x11D4 -+#define REG_RXDMA_LEN_THRESHOLD_8814B 0x11D8 -+#define REG_PCIE_EXEC_TIME_THRESHOLD_8814B 0x11DC -+#define REG_FT2IMR_8814B 0x11E0 -+#define REG_FT2ISR_8814B 0x11E4 -+#define REG_MSG2_8814B 0x11F0 -+#define REG_MSG3_8814B 0x11F4 -+#define REG_MSG4_8814B 0x11F8 -+#define REG_MSG5_8814B 0x11FC -+#define REG_BIST_RSTN0_8814B 0x2100 -+#define REG_BIST_RSTN2_8814B 0x2108 -+#define REG_BIST_MODE_NRML0_8814B 0x2110 -+#define REG_BIST_MODE_NRML1_8814B 0x2114 -+#define REG_BIST_MODE_NRML2_8814B 0x2118 -+#define REG_BIST_MODE_NRML3_8814B 0x211C -+#define REG_BIST_DONE_NRML_MAC_8814B 0x2150 -+#define REG_BIST_DONE_NRML1_8814B 0x2158 -+#define REG_BIST_DONE_DRF_MAC_8814B 0x2160 -+#define REG_BIST_DONE_DRF_8814B 0x2164 -+#define REG_BIST_DONE_DRF1_8814B 0x2168 -+#define REG_BIST_FAIL_NRML_MAC_8814B 0x2170 -+#define REG_BIST_FAIL_NRML_8814B 0x2174 -+#define REG_BIST_FAIL_NRML1_8814B 0x2178 -+#define REG_BIST_FAIL_NRML_MAC_V1_8814B 0x2180 -+#define REG_BIST_FAIL_NRML_V1_8814B 0x2184 -+#define REG_BIST_FAIL_NRML1_V1_8814B 0x2188 -+#define REG_BIST_MISR_DATAOUT_8814B 0x2190 -+#define REG_BIST_MISR_DATAOUT1_8814B 0x2194 -+#define REG_BIST_MISR_DATAOUT_CPU_8814B 0x2198 -+#define REG_BIST_MISR_DATAOUT_CPU1_8814B 0x219C -+#define REG_BIST_MISR_DATAOUT_CPU2_8814B 0x21A0 -+#define REG_BIST_MISR_DATOUT_CPU3_8814B 0x21A4 -+#define REG_BCN_CTRL_0_8814B 0x0200 -+#define REG_BCN_CTRL_1_8814B 0x0204 -+#define REG_AUTO_LLT_V1_8814B 0x0208 -+#define REG_TXDMA_OFFSET_CHK_8814B 0x020C -+#define REG_TXDMA_STATUS_8814B 0x0210 -+#define REG_TX_DMA_DBG_8814B 0x0214 -+#define REG_DMA_RQPN_INFO_PUB_8814B 0x0218 -+#define REG_RQPN_CTRL_2_V1_8814B 0x021C -+#define REG_BCN_CTRL_2_8814B 0x0220 -+#define REG_TXPKTNUM_0_8814B 0x0230 -+#define REG_TXPKTNUM_1_8814B 0x0234 -+#define REG_TXPKTNUM_2_8814B 0x0238 -+#define REG_TXPKTNUM_3_8814B 0x023C -+#define REG_TX_AGG_ALIGN_8814B 0x0240 -+#define REG_H2C_HEAD_8814B 0x0244 -+#define REG_H2C_TAIL_8814B 0x0248 -+#define REG_H2C_READ_ADDR_8814B 0x024C -+#define REG_H2C_WR_ADDR_8814B 0x0250 -+#define REG_H2C_INFO_8814B 0x0254 -+#define REG_DMA_OQT_0_8814B 0x0260 -+#define REG_DMA_OQT_1_8814B 0x0264 -+#define REG_RXDMA_AGG_PG_TH_8814B 0x0280 -+#define REG_RXDMA_CTRL_8814B 0x0284 -+#define REG_RXDMA_STATUS_8814B 0x0288 -+#define REG_RXDMA_DPR_8814B 0x028C -+#define REG_RXDMA_MODE_8814B 0x0290 -+#define REG_C2H_PKT_8814B 0x0294 -+#define REG_FWFF_C2H_8814B 0x0298 -+#define REG_FWFF_CTRL_8814B 0x029C -+#define REG_FWFF_PKT_INFO_8814B 0x02A0 -+#define REG_FWFF_PKT_INFO2_8814B 0x02A4 -+#define REG_RXPKTNUM_8814B 0x02B0 -+#define REG_RXPKTNUM_TH_8814B 0x02B4 -+#define REG_FW_UPD_RXDES_RDPTR_8814B 0x02B8 -+#define REG_DDMA_CH0SA_8814B 0x1200 -+#define REG_DDMA_CH0DA_8814B 0x1204 -+#define REG_DDMA_CH0CTRL_8814B 0x1208 -+#define REG_DDMA_CH1SA_8814B 0x1210 -+#define REG_DDMA_CH1DA_8814B 0x1214 -+#define REG_DDMA_CH1CTRL_8814B 0x1218 -+#define REG_DDMA_CH2SA_8814B 0x1220 -+#define REG_DDMA_CH2DA_8814B 0x1224 -+#define REG_DDMA_CH2CTRL_8814B 0x1228 -+#define REG_DDMA_CH3SA_8814B 0x1230 -+#define REG_DDMA_CH3DA_8814B 0x1234 -+#define REG_DDMA_CH3CTRL_8814B 0x1238 -+#define REG_DDMA_CH4SA_8814B 0x1240 -+#define REG_DDMA_CH4DA_8814B 0x1244 -+#define REG_DDMA_CH4CTRL_8814B 0x1248 -+#define REG_DDMA_CH5SA_8814B 0x1250 -+#define REG_DDMA_CH5DA_8814B 0x1254 -+#define REG_DDMA_CH5CTRL_8814B 0x1258 -+#define REG_DDMA_INT_MSK_8814B 0x12E0 -+#define REG_DDMA_CHSTATUS_8814B 0x12E8 -+#define REG_DDMA_CHKSUM_8814B 0x12F0 -+#define REG_DDMA_MONITOR_8814B 0x12FC -+#define REG_DMA_RQPN_INFO_0_8814B 0x2200 -+#define REG_DMA_RQPN_INFO_1_8814B 0x2204 -+#define REG_DMA_RQPN_INFO_2_8814B 0x2208 -+#define REG_DMA_RQPN_INFO_3_8814B 0x220C -+#define REG_DMA_RQPN_INFO_4_8814B 0x2210 -+#define REG_DMA_RQPN_INFO_5_8814B 0x2214 -+#define REG_DMA_RQPN_INFO_6_8814B 0x2218 -+#define REG_DMA_RQPN_INFO_7_8814B 0x221C -+#define REG_DMA_RQPN_INFO_8_8814B 0x2220 -+#define REG_DMA_RQPN_INFO_9_8814B 0x2224 -+#define REG_DMA_RQPN_INFO_10_8814B 0x2228 -+#define REG_DMA_RQPN_INFO_11_8814B 0x222C -+#define REG_DMA_RQPN_INFO_12_8814B 0x2230 -+#define REG_DMA_RQPN_INFO_13_8814B 0x2234 -+#define REG_DMA_RQPN_INFO_14_8814B 0x2238 -+#define REG_DMA_RQPN_INFO_15_8814B 0x223C -+#define REG_DMA_RQPN_INFO_16_8814B 0x2240 -+#define REG_HWAMSDU_CTL1_8814B 0x2250 -+#define REG_HWAMSDU_CTL2_8814B 0x2254 -+#define REG_TXPAGE_INT_CTRL_0_8814B 0x3200 -+#define REG_TXPAGE_INT_CTRL_1_8814B 0x3204 -+#define REG_TXPAGE_INT_CTRL_2_8814B 0x3208 -+#define REG_TXPAGE_INT_CTRL_3_8814B 0x320C -+#define REG_TXPAGE_INT_CTRL_4_8814B 0x3210 -+#define REG_TXPAGE_INT_CTRL_5_8814B 0x3214 -+#define REG_TXPAGE_INT_CTRL_6_8814B 0x3218 -+#define REG_TXPAGE_INT_CTRL_7_8814B 0x321C -+#define REG_TXPAGE_INT_CTRL_8_8814B 0x3220 -+#define REG_TXPAGE_INT_CTRL_9_8814B 0x3224 -+#define REG_TXPAGE_INT_CTRL_10_8814B 0x3228 -+#define REG_TXPAGE_INT_CTRL_11_8814B 0x322C -+#define REG_TXPAGE_INT_CTRL_12_8814B 0x3230 -+#define REG_TXPAGE_INT_CTRL_13_8814B 0x3234 -+#define REG_TXPAGE_INT_CTRL_14_8814B 0x3238 -+#define REG_TXPAGE_INT_CTRL_15_8814B 0x323C -+#define REG_TXPAGE_INT_CTRL_16_8814B 0x3240 -+#define REG_PCIE_CTRL_8814B 0x0300 -+#define REG_ACH_CTRL_8814B 0x0304 -+#define REG_HIQ_CTRL_8814B 0x0308 -+#define REG_INT_MIG_V1_8814B 0x030C -+#define REG_P0MGQ_TXBD_DESA_L_8814B 0x0310 -+#define REG_P0MGQ_TXBD_DESA_H_8814B 0x0314 -+#define REG_ACH0_TXBD_DESA_L_8814B 0x0318 -+#define REG_ACH0_TXBD_DESA_H_8814B 0x031C -+#define REG_ACH1_TXBD_DESA_L_8814B 0x0320 -+#define REG_ACH1_TXBD_DESA_H_8814B 0x0324 -+#define REG_ACH2_TXBD_DESA_L_8814B 0x0328 -+#define REG_ACH2_TXBD_DESA_H_8814B 0x032C -+#define REG_ACH3_TXBD_DESA_L_8814B 0x0330 -+#define REG_ACH3_TXBD_DESA_H_8814B 0x0334 -+#define REG_P0RXQ_RXBD_DESA_L_8814B 0x0338 -+#define REG_P0RXQ_RXBD_DESA_H_8814B 0x033C -+#define REG_P0BCNQ_TXBD_DESA_L_8814B 0x0340 -+#define REG_P0BCNQ_TXBD_DESA_H_8814B 0x0344 -+#define REG_FWCMDQ_TXBD_DESA_L_8814B 0x0348 -+#define REG_FWCMDQ_TXBD_DESA_H_8814B 0x034C -+#define REG_PCIE_HRPWM1_HCPWM1_DCPU_8814B 0x0354 -+#define REG_P0_MPRT_BCNQ_TXBD_DESA_L_8814B 0x0358 -+#define REG_P0_MPRT_BCNQ_TXBD_DESA_H_8814B 0x035C -+#define REG_P0_MPRT_BCNQ_TXRXBD_NUM_8814B 0x036C -+#define REG_BD_RWPTR_CLR2_8814B 0x0370 -+#define REG_BD_RWPTR_CLR3_8814B 0x0374 -+#define REG_P0MGQ_RXQ_TXRXBD_NUM_8814B 0x0378 -+#define REG_CHNL_DMA_CFG_8814B 0x037C -+#define REG_FWCMDQ_TXBD_NUM_8814B 0x0380 -+#define REG_ACH0_ACH1_TXBD_NUM_8814B 0x0384 -+#define REG_ACH2_ACH3_TXBD_NUM_8814B 0x0388 -+#define REG_P0HI0Q_HI1Q_TXBD_NUM_8814B 0x038C -+#define REG_P0HI2Q_HI3Q_TXBD_NUM_8814B 0x0390 -+#define REG_P0HI4Q_HI5Q_TXBD_NUM_8814B 0x0394 -+#define REG_P0HI6Q_HI7Q_TXBD_NUM_8814B 0x0398 -+#define REG_BD_RWPTR_CLR1_8814B 0x039C -+#define REG_TSFTIMER_HCI_8814B 0x039C -+#define REG_ACH0_TXBD_IDX_8814B 0x03A0 -+#define REG_ACH1_TXBD_IDX_8814B 0x03A4 -+#define REG_ACH2_TXBD_IDX_8814B 0x03A8 -+#define REG_ACH3_TXBD_IDX_8814B 0x03AC -+#define REG_P0MGQ_TXBD_IDX_8814B 0x03B0 -+#define REG_P0RXQ_RXBD_IDX_8814B 0x03B4 -+#define REG_P0HI0Q_TXBD_IDX_8814B 0x03B8 -+#define REG_P0HI1Q_TXBD_IDX_8814B 0x03BC -+#define REG_P0HI2Q_TXBD_IDX_8814B 0x03C0 -+#define REG_P0HI3Q_TXBD_IDX_8814B 0x03C4 -+#define REG_P0HI4Q_TXBD_IDX_8814B 0x03C8 -+#define REG_P0HI5Q_TXBD_IDX_8814B 0x03CC -+#define REG_P0HI6Q_TXBD_IDX_8814B 0x03D0 -+#define REG_P0HI7Q_TXBD_IDX_8814B 0x03D4 -+#define REG_DBGSEL_PCIE_HRPWM1_HCPWM1_V1_8814B 0x03D8 -+#define REG_PCIE_HRPWM2_HCPWM2_V1_8814B 0x03DC -+#define REG_PCIE_H2C_MSG_V1_8814B 0x03E0 -+#define REG_PCIE_C2H_MSG_V1_8814B 0x03E4 -+#define REG_DBI_WDATA_V1_8814B 0x03E8 -+#define REG_DBI_RDATA_V1_8814B 0x03EC -+#define REG_DBI_FLAG_V1_8814B 0x03F0 -+#define REG_MDIO_V1_8814B 0x03F4 -+#define REG_PCIE_MIX_CFG_8814B 0x03F8 -+#define REG_HCI_MIX_CFG_8814B 0x03FC -+#define REG_STC_INT_CS_8814B 0x1300 -+#define REG_ST_INT_CFG_8814B 0x1304 -+#define REG_ACH4_ACH5_TXBD_NUM_8814B 0x130C -+#define REG_FWCMDQ_TXBD_IDX_8814B 0x1318 -+#define REG_P0HI8Q_TXBD_IDX_8814B 0x131C -+#define REG_H2CQ_TXBD_DESA_L_8814B 0x1320 -+#define REG_H2CQ_TXBD_DESA_H_8814B 0x1324 -+#define REG_H2CQ_TXBD_NUM_8814B 0x1328 -+#define REG_H2CQ_TXBD_IDX_8814B 0x132C -+#define REG_H2CQ_CSR_8814B 0x1330 -+#define REG_P0HI9Q_TXBD_IDX_8814B 0x1334 -+#define REG_P0HI10Q_TXBD_IDX_8814B 0x1338 -+#define REG_P0HI11Q_TXBD_IDX_8814B 0x133C -+#define REG_P0HI12Q_TXBD_IDX_8814B 0x1340 -+#define REG_P0HI13Q_TXBD_IDX_8814B 0x1344 -+#define REG_P0HI14Q_TXBD_IDX_8814B 0x1348 -+#define REG_P0HI15Q_TXBD_IDX_8814B 0x134C -+#define REG_CHANGE_PCIE_SPEED_8814B 0x1350 -+#define REG_DEBUG_STATE1_8814B 0x1354 -+#define REG_DEBUG_STATE2_8814B 0x1358 -+#define REG_DEBUG_STATE3_8814B 0x135C -+#define REG_ACH5_TXBD_DESA_L_8814B 0x1360 -+#define REG_ACH5_TXBD_DESA_H_8814B 0x1364 -+#define REG_ACH6_TXBD_DESA_L_8814B 0x1368 -+#define REG_ACH6_TXBD_DESA_H_8814B 0x136C -+#define REG_ACH7_TXBD_DESA_L_8814B 0x1370 -+#define REG_ACH7_TXBD_DESA_H_8814B 0x1374 -+#define REG_ACH8_TXBD_DESA_L_8814B 0x1378 -+#define REG_ACH8_TXBD_DESA_H_8814B 0x137C -+#define REG_ACH9_TXBD_DESA_L_8814B 0x1380 -+#define REG_ACH9_TXBD_DESA_H_8814B 0x1384 -+#define REG_ACH10_TXBD_DESA_L_8814B 0x1388 -+#define REG_ACH10_TXBD_DESA_H_8814B 0x138C -+#define REG_ACH11_TXBD_DESA_L_8814B 0x1390 -+#define REG_ACH11_TXBD_DESA_H_8814B 0x1394 -+#define REG_ACH12_TXBD_DESA_L_8814B 0x1398 -+#define REG_ACH12_TXBD_DESA_H_8814B 0x139C -+#define REG_ACH13_TXBD_DESA_L_8814B 0x13A0 -+#define REG_ACH13_TXBD_DESA_H_8814B 0x13A4 -+#define REG_HI0Q_TXBD_DESA_L_8814B 0x13A8 -+#define REG_HI0Q_TXBD_DESA_H_8814B 0x13AC -+#define REG_HI1Q_TXBD_DESA_L_8814B 0x13B0 -+#define REG_HI1Q_TXBD_DESA_H_8814B 0x13B4 -+#define REG_HI2Q_TXBD_DESA_L_8814B 0x13B8 -+#define REG_HI2Q_TXBD_DESA_H_8814B 0x13BC -+#define REG_HI3Q_TXBD_DESA_L_8814B 0x13C0 -+#define REG_HI3Q_TXBD_DESA_H_8814B 0x13C4 -+#define REG_HI4Q_TXBD_DESA_L_8814B 0x13C8 -+#define REG_HI4Q_TXBD_DESA_H_8814B 0x13CC -+#define REG_HI5Q_TXBD_DESA_L_8814B 0x13D0 -+#define REG_HI5Q_TXBD_DESA_H_8814B 0x13D4 -+#define REG_HI6Q_TXBD_DESA_L_8814B 0x13D8 -+#define REG_HI6Q_TXBD_DESA_H_8814B 0x13DC -+#define REG_HI7Q_TXBD_DESA_L_8814B 0x13E0 -+#define REG_HI7Q_TXBD_DESA_H_8814B 0x13E4 -+#define REG_ACH8_ACH9_TXBD_NUM_8814B 0x13E8 -+#define REG_ACH10_ACH11_TXBD_NUM_8814B 0x13EC -+#define REG_ACH12_ACH13_TXBD_NUM_8814B 0x13F0 -+#define REG_OLD_DEHANG_8814B 0x13F4 -+#define REG_ACH4_TXBD_DESA_L_8814B 0x13F8 -+#define REG_ACH4_TXBD_DESA_H_8814B 0x13FC -+#define REG_HI8Q_TXBD_DESA_L_8814B 0x2300 -+#define REG_HI8Q_TXBD_DESA_H_8814B 0x2304 -+#define REG_HI9Q_TXBD_DESA_L_8814B 0x2308 -+#define REG_HI9Q_TXBD_DESA_H_8814B 0x230C -+#define REG_HI10Q_TXBD_DESA_L_8814B 0x2310 -+#define REG_HI10Q_TXBD_DESA_H_8814B 0x2314 -+#define REG_HI11Q_TXBD_DESA_L_8814B 0x2318 -+#define REG_HI11Q_TXBD_DESA_H_8814B 0x231C -+#define REG_HI12Q_TXBD_DESA_L_8814B 0x2320 -+#define REG_HI12Q_TXBD_DESA_H_8814B 0x2324 -+#define REG_HI13Q_TXBD_DESA_L_8814B 0x2328 -+#define REG_HI13Q_TXBD_DESA_H_8814B 0x232C -+#define REG_HI14Q_TXBD_DESA_L_8814B 0x2330 -+#define REG_HI14Q_TXBD_DESA_H_8814B 0x2334 -+#define REG_HI15Q_TXBD_DESA_L_8814B 0x2338 -+#define REG_HI15Q_TXBD_DESA_H_8814B 0x233C -+#define REG_HI16Q_TXBD_DESA_L_8814B 0x2340 -+#define REG_HI16Q_TXBD_DESA_H_8814B 0x2344 -+#define REG_HI17Q_TXBD_DESA_L_8814B 0x2348 -+#define REG_HI17Q_TXBD_DESA_H_8814B 0x234C -+#define REG_HI18Q_TXBD_DESA_L_8814B 0x2350 -+#define REG_HI18Q_TXBD_DESA_H_8814B 0x2354 -+#define REG_HI19Q_TXBD_DESA_L_8814B 0x2358 -+#define REG_HI19Q_TXBD_DESA_H_8814B 0x235C -+#define REG_BD_RWPTR_CLR6_8814B 0x2364 -+#define REG_P0HI16Q_TXBD_IDX_8814B 0x2370 -+#define REG_P0HI17Q_TXBD_IDX_8814B 0x2374 -+#define REG_P0HI18Q_TXBD_IDX_8814B 0x2378 -+#define REG_P0HI19Q_TXBD_IDX_8814B 0x237C -+#define REG_P0HI16Q_HI17Q_TXBD_NUM_8814B 0x2380 -+#define REG_P0HI18Q_HI19Q_TXBD_NUM_8814B 0x2384 -+#define REG_PCIE_HISR0_8814B 0x23B4 -+#define REG_PCIE_HISR1_8814B 0x23BC -+#define REG_P0HI8Q_HI9Q_TXBD_NUM_8814B 0x23C0 -+#define REG_P0HI10Q_HI11Q_TXBD_NUM_8814B 0x23C4 -+#define REG_P0HI12Q_HI13Q_TXBD_NUM_8814B 0x23C8 -+#define REG_P0HI14Q_HI15Q_TXBD_NUM_8814B 0x23CC -+#define REG_ACH6_ACH7_TXBD_NUM_8814B 0x23F0 -+#define REG_ACH4_TXBD_IDX_8814B 0x3340 -+#define REG_ACH5_TXBD_IDX_8814B 0x3344 -+#define REG_ACH6_TXBD_IDX_8814B 0x3348 -+#define REG_ACH7_TXBD_IDX_8814B 0x334C -+#define REG_ACH8_TXBD_IDX_8814B 0x3350 -+#define REG_ACH9_TXBD_IDX_8814B 0x3354 -+#define REG_ACH10_TXBD_IDX_8814B 0x3358 -+#define REG_ACH11_TXBD_IDX_8814B 0x335C -+#define REG_ACH12_TXBD_IDX_8814B 0x3360 -+#define REG_ACH13_TXBD_IDX_8814B 0x3364 -+#define REG_AC_CHANNEL0_WEIGHT_8814B 0x3368 -+#define REG_AC_CHANNEL1_WEIGHT_8814B 0x3369 -+#define REG_AC_CHANNEL2_WEIGHT_8814B 0x336A -+#define REG_AC_CHANNEL3_WEIGHT_8814B 0x336B -+#define REG_AC_CHANNEL4_WEIGHT_8814B 0x336C -+#define REG_AC_CHANNEL5_WEIGHT_8814B 0x336D -+#define REG_AC_CHANNEL6_WEIGHT_8814B 0x336E -+#define REG_AC_CHANNEL7_WEIGHT_8814B 0x336F -+#define REG_AC_CHANNEL8_WEIGHT_8814B 0x3370 -+#define REG_AC_CHANNEL9_WEIGHT_8814B 0x3371 -+#define REG_AC_CHANNEL10_WEIGHT_8814B 0x3372 -+#define REG_AC_CHANNEL11_WEIGHT_8814B 0x3373 -+#define REG_AC_CHANNEL12_WEIGHT_8814B 0x3374 -+#define REG_AC_CHANNEL13_WEIGHT_8814B 0x3375 -+#define REG_PCIE_HISR2_8814B 0x33B4 -+#define REG_PCIE_HISR3_8814B 0x33BC -+#define REG_QUEUELIST_INFO0_8814B 0x0400 -+#define REG_QUEUELIST_INFO1_8814B 0x0404 -+#define REG_QUEUELIST_INFO2_8814B 0x0408 -+#define REG_QUEUELIST_INFO3_8814B 0x040C -+#define REG_QUEUELIST_INFO_EMPTY_8814B 0x0410 -+#define REG_QUEUELIST_ACQ_EN_8814B 0x0414 -+#define REG_BCNQ_BDNY_V2_8814B 0x0418 -+#define REG_CPU_MGQ_INFO_8814B 0x041C -+#define REG_FWHW_TXQ_CTRL_8814B 0x0420 -+#define REG_DATAFB_SEL_8814B 0x0423 -+#define REG_TXBDNY_8814B 0x0424 -+#define REG_LIFETIME_EN_8814B 0x0426 -+#define REG_SPEC_SIFS_8814B 0x0428 -+#define REG_RETRY_LIMIT_8814B 0x042A -+#define REG_TXBF_CTRL_8814B 0x042C -+#define REG_DARFRC_8814B 0x0430 -+#define REG_DARFRCH_8814B 0x0434 -+#define REG_RARFRC_8814B 0x0438 -+#define REG_RARFRCH_8814B 0x043C -+#define REG_RRSR_8814B 0x0440 -+#define REG_ARFR0_8814B 0x0444 -+#define REG_ARFRH0_8814B 0x0448 -+#define REG_REG_ARFR_WT0_8814B 0x044C -+#define REG_REG_ARFR_WT1_8814B 0x0450 -+#define REG_CCK_CHECK_8814B 0x0454 -+#define REG_AMPDU_MAX_TIME_V1_8814B 0x0455 -+#define REG_TAB_SEL_8814B 0x0456 -+#define REG_BCN_INVALID_CTRL_8814B 0x0457 -+#define REG_AMPDU_MAX_LENGTH_HT_8814B 0x0458 -+#define REG_NDPA_RATE_8814B 0x045D -+#define REG_TX_HANG_CTRL_8814B 0x045E -+#define REG_NDPA_OPT_CTRL_8814B 0x045F -+#define REG_AMPDU_MAX_LENGTH_VHT_8814B 0x0460 -+#define REG_RD_RESP_PKT_TH_8814B 0x0463 -+#define REG_NEW_EDCA_CTRL_V1_8814B 0x0464 -+#define REG_ACQ_STOP_V2_8814B 0x0468 -+#define REG_WMAC_LBK_BUF_HD_V1_8814B 0x0478 -+#define REG_MGQ_BDNY_V1_8814B 0x047A -+#define REG_TXRPT_CTRL_8814B 0x047C -+#define REG_INIRTS_RATE_SEL_8814B 0x0480 -+#define REG_BASIC_CFEND_RATE_8814B 0x0481 -+#define REG_STBC_CFEND_RATE_8814B 0x0482 -+#define REG_DATA_SC_8814B 0x0483 -+#define REG_MOREDATA_V1_8814B 0x0484 -+#define REG_DATA_SC1_8814B 0x0487 -+#define REG_TXRPT_START_OFFSET_8814B 0x04AC -+#define REG_POWER_STAGE1_8814B 0x04B4 -+#define REG_POWER_STAGE2_8814B 0x04B8 -+#define REG_SW_AMPDU_BURST_MODE_CTRL_8814B 0x04BC -+#define REG_PKT_LIFE_TIME_8814B 0x04C0 -+#define REG_STBC_SETTING_8814B 0x04C4 -+#define REG_STBC_SETTING2_8814B 0x04C5 -+#define REG_QUEUE_CTRL_8814B 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL_8814B 0x04C7 -+#define REG_PROT_MODE_CTRL_8814B 0x04C8 -+#define REG_BAR_MODE_CTRL_8814B 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8814B 0x04CF -+#define REG_MACID_SLEEP_CTRL_8814B 0x04D0 -+#define REG_MACID_SLEEP_INFO_8814B 0x04D4 -+#define REG_HW_SEQ0_8814B 0x04D8 -+#define REG_HW_SEQ1_8814B 0x04DA -+#define REG_HW_SEQ2_8814B 0x04DC -+#define REG_HW_SEQ3_8814B 0x04DE -+#define REG_PTCL_ERR_STATUS_V1_8814B 0x04E2 -+#define REG_NULL_PKT_STATUS_V2_8814B 0x04E4 -+#define REG_PRECNT_CTRL_8814B 0x04E5 -+#define REG_NULL_PKT_STATUS_EXTEND_V1_8814B 0x04E7 -+#define REG_PTCL_DBG_V1_8814B 0x04EC -+#define REG_BT_POLLUTE_PKTCNT_8814B 0x04F0 -+#define REG_CPUMGQ_TIMER_CTRL2_8814B 0x04F4 -+#define REG_PTCL_DBG_OUT_8814B 0x04F8 -+#define REG_DUMMY_PAGE4_V1_8814B 0x04FC -+#define REG_DUMMY_PAGE4_1_8814B 0x04FE -+#define REG_MU_OFFSET_8814B 0x1400 -+#define REG_BF0_TIME_SETTING_8814B 0x1428 -+#define REG_BF1_TIME_SETTING_8814B 0x142C -+#define REG_BF_TIMEOUT_EN_8814B 0x1430 -+#define REG_MACID_RELEASE_INFO_8814B 0x1434 -+#define REG_MACID_RELEASE_SUCCESS_INFO_8814B 0x1438 -+#define REG_MACID_RELEASE_CTRL_8814B 0x143C -+#define REG_FAST_EDCA_VOVI_SETTING_8814B 0x1448 -+#define REG_FAST_EDCA_BEBK_SETTING_8814B 0x144C -+#define REG_MACID_DROP_INFO_8814B 0x1450 -+#define REG_MACID_DROP_CTRL_8814B 0x1454 -+#define REG_MGQ_FIFO_WRITE_POINTER_8814B 0x1470 -+#define REG_MGQ_FIFO_READ_POINTER_8814B 0x1472 -+#define REG_MGQ_FIFO_ENABLE_8814B 0x1472 -+#define REG_MGQ_FIFO_RELEASE_INT_MASK_8814B 0x1474 -+#define REG_MGQ_FIFO_RELEASE_INT_FLAG_8814B 0x1476 -+#define REG_MGQ_FIFO_VALID_MAP_8814B 0x1478 -+#define REG_MGQ_FIFO_LIFETIME_8814B 0x147A -+#define REG_PKT_TRANS_8814B 0x1480 -+#define REG_SHCUT_LLC_ETH_TYPE0_8814B 0x1484 -+#define REG_SHCUT_LLC_ETH_TYPE1_8814B 0x1488 -+#define REG_SHCUT_LLC_OUI0_8814B 0x148C -+#define REG_SHCUT_LLC_OUI1_8814B 0x1490 -+#define REG_SHCUT_LLC_OUI2_8814B 0x1494 -+#define REG_FWCMDQ_CTRL_8814B 0x14A0 -+#define REG_FWCMDQ_PAGE_8814B 0x14A4 -+#define REG_FWCMDQ_INFO_8814B 0x14A8 -+#define REG_FWCMDQ_HOLD_PKTNUM_8814B 0x14AC -+#define REG_MU_TX_CTRL_8814B 0x14C0 -+#define REG_MU_STA_GID_VLD_8814B 0x14C4 -+#define REG_MU_STA_USER_POS_INFO_8814B 0x14C8 -+#define REG_MU_STA_USER_POS_INFO_H_8814B 0x14CC -+#define REG_CHNL_INFO_CTRL_8814B 0x14D0 -+#define REG_CHNL_IDLE_TIME_8814B 0x14D4 -+#define REG_CHNL_BUSY_TIME_8814B 0x14D8 -+#define REG_MU_TRX_DBG_CNT_V1_8814B 0x14DC -+#define REG_SWPS_CTRL_8814B 0x14F4 -+#define REG_SWPS_PKT_TH_8814B 0x14F6 -+#define REG_SWPS_TIME_TH_8814B 0x14F8 -+#define REG_MACID_SWPS_EN_8814B 0x14FC -+#define REG_EDCA_VO_PARAM_8814B 0x0500 -+#define REG_EDCA_VI_PARAM_8814B 0x0504 -+#define REG_EDCA_BE_PARAM_8814B 0x0508 -+#define REG_EDCA_BK_PARAM_8814B 0x050C -+#define REG_BCNTCFG_8814B 0x0510 -+#define REG_PIFS_8814B 0x0512 -+#define REG_RDG_PIFS_8814B 0x0513 -+#define REG_SIFS_8814B 0x0514 -+#define REG_FORCE_BCN_IFS_V1_8814B 0x0518 -+#define REG_AGGR_BREAK_TIME_8814B 0x051A -+#define REG_SLOT_8814B 0x051B -+#define REG_EDCA_CPUMGQ_PARAM_8814B 0x051C -+#define REG_CPUMGQ_PAUSE_8814B 0x051E -+#define REG_TX_PTCL_CTRL_8814B 0x0520 -+#define REG_TXPAUSE_8814B 0x0522 -+#define REG_DIS_TXREQ_CLR_8814B 0x0523 -+#define REG_RD_CTRL_8814B 0x0524 -+#define REG_PKT_LIFETIME_CTRL_8814B 0x0528 -+#define REG_TXOP_LIMIT_CTRL_8814B 0x052C -+#define REG_CCA_TXEN_CNT_8814B 0x0534 -+#define REG_MAX_INTER_COLLISION_8814B 0x0538 -+#define REG_MAX_INTER_COLLISION_CNT_8814B 0x053C -+#define REG_RD_NAV_NXT_8814B 0x0544 -+#define REG_NAV_PROT_LEN_8814B 0x0546 -+#define REG_FTM_PTT_8814B 0x0548 -+#define REG_FTM_TSF_8814B 0x054C -+#define REG_HGQ_TIMEOUT_PERIOD_8814B 0x0575 -+#define REG_TXCMD_TIMEOUT_PERIOD_8814B 0x0576 -+#define REG_MISC_CTRL_8814B 0x0577 -+#define REG_TXOP_MIN_8814B 0x0590 -+#define REG_PRE_BKF_TIME_8814B 0x0592 -+#define REG_CROSS_TXOP_CTRL_8814B 0x0593 -+#define REG_ACMHWCTRL_8814B 0x05C0 -+#define REG_ACMRSTCTRL_8814B 0x05C1 -+#define REG_ACMAVG_8814B 0x05C2 -+#define REG_VO_ADMTIME_8814B 0x05C4 -+#define REG_VI_ADMTIME_8814B 0x05C6 -+#define REG_BE_ADMTIME_8814B 0x05C8 -+#define REG_MAC_HEADER_NAV_OFFSET_8814B 0x05CA -+#define REG_DIS_NDPA_NAV_CHECK_8814B 0x05CB -+#define REG_EDCA_RANDOM_GEN_8814B 0x05CC -+#define REG_TXCMD_SEL_8814B 0x05CF -+#define REG_MU_DBG_INFO_8814B 0x05E8 -+#define REG_MU_DBG_INFO_1_8814B 0x05EC -+#define REG_SCH_DBG_SEL_8814B 0x05F0 -+#define REG_SCHEDULER_RST_8814B 0x05F1 -+#define REG_MU_DBG_ERR_FLAG_8814B 0x05F2 -+#define REG_TX_ERR_RECOVERY_RST_8814B 0x05F3 -+#define REG_SCH_DBG_VALUE_8814B 0x05F4 -+#define REG_SCH_TXCMD_8814B 0x05F8 -+#define REG_PAGE5_DUMMY_8814B 0x05FC -+#define REG_PORT_CTRL_SEL_8814B 0x1500 -+#define REG_PORT_CTRL_CFG_8814B 0x1501 -+#define REG_TBTT_PROHIBIT_CFG_8814B 0x1504 -+#define REG_DRVERLYINT_CFG_8814B 0x1507 -+#define REG_BCNDMATIM_CFG_8814B 0x1508 -+#define REG_CTWND_CFG_8814B 0x1509 -+#define REG_BCNIVLCUNT_CFG_8814B 0x150A -+#define REG_EARLY_128US_CFG_8814B 0x150B -+#define REG_TSFTR_SYNC_OFFSET_CFG_8814B 0x150C -+#define REG_TSFTR_SYNC_CTRL_CFG_8814B 0x150F -+#define REG_BCN_SPACE_CFG_8814B 0x1510 -+#define REG_EARLY_INT_ADJUST_CFG_8814B 0x1512 -+#define REG_SW_TBTT_TSF_INFO_8814B 0x151C -+#define REG_TSFTR_LOW_8814B 0x1520 -+#define REG_TSFTR_HIGH_8814B 0x1524 -+#define REG_BCN_ERR_CNT_MAC_8814B 0x1528 -+#define REG_BCN_ERR_CNT_EDCCA_8814B 0x1529 -+#define REG_BCN_ERR_CNT_CCA_8814B 0x152A -+#define REG_BCN_ERR_CNT_INVALID_8814B 0x152B -+#define REG_BCN_ERR_CNT_OTHERS_8814B 0x152C -+#define REG_RX_BCN_TIMER_8814B 0x152D -+#define REG_TBTT_CTN_AREA_V1_8814B 0x1530 -+#define REG_BCN_MAX_ERR_V1_8814B 0x1531 -+#define REG_RXTSF_OFFSET_CCK_V1_8814B 0x1532 -+#define REG_RXTSF_OFFSET_OFDM_V1_8814B 0x1533 -+#define REG_SUB_BCN_SPACE_8814B 0x1534 -+#define REG_MBID_NUM_V1_8814B 0x1535 -+#define REG_MBSSID_CTRL_V1_8814B 0x1536 -+#define REG_USTIME_TSF_V1_8814B 0x1538 -+#define REG_BW_CFG_8814B 0x1539 -+#define REG_ATIMWND_CFG_8814B 0x153A -+#define REG_DTIM_COUNTER_CFG_8814B 0x153B -+#define REG_ATIM_DTIM_CTRL_SEL_8814B 0x153C -+#define REG_ATIMUGT_V1_8814B 0x153D -+#define REG_BCNDROPCTRL_V1_8814B 0x153E -+#define REG_DIS_ATIM_V1_8814B 0x1540 -+#define REG_HIQ_NO_LMT_EN_V1_8814B 0x1544 -+#define REG_P2PPS_CTRL_V1_8814B 0x1548 -+#define REG_P2PPS_SPEC_STATE_V1_8814B 0x154A -+#define REG_P2PPS_STATE_V1_8814B 0x154B -+#define REG_P2PPS1_CTRL_V1_8814B 0x154C -+#define REG_P2PPS1_SPEC_STATE_V1_8814B 0x154E -+#define REG_P2PPS1_STATE_V1_8814B 0x154F -+#define REG_P2PPS2_CTRL_V1_8814B 0x1550 -+#define REG_P2PPS2_SPEC_STATE_V1_8814B 0x1552 -+#define REG_P2PPS2_STATE_V1_8814B 0x1553 -+#define REG_P2PON_DIS_TXTIME_V1_8814B 0x1554 -+#define REG_P2POFF_DIS_TXTIME_V1_8814B 0x1555 -+#define REG_CHG_POWER_BCN_AREA_8814B 0x1556 -+#define REG_NOA_SEL_8814B 0x1557 -+#define REG_NOA_PARAM_V1_8814B 0x1558 -+#define REG_NOA_PARAM_1_V1_8814B 0x155C -+#define REG_NOA_PARAM_2_V1_8814B 0x1560 -+#define REG_NOA_PARAM_3_V1_8814B 0x1564 -+#define REG_NOA_ON_ERLY_TIME_V1_8814B 0x1568 -+#define REG_NOA_OFF_ERLY_TIME_V1_8814B 0x1569 -+#define REG_P2PPS_HW_AUTO_PAUSE_CTRL_8814B 0x156C -+#define REG_P2PPS1_HW_AUTO_PAUSE_CTRL_8814B 0x1570 -+#define REG_P2PPS2_HW_AUTO_PAUSE_CTRL_8814B 0x1574 -+#define REG_RX_TBTT_SHIFT_8814B 0x1578 -+#define REG_FREERUN_CNT_LOW_8814B 0x1580 -+#define REG_FREERUN_CNT_HIGH_8814B 0x1584 -+#define REG_CPUMGQ_TX_TIMER_V1_8814B 0x1588 -+#define REG_PS_TIMER_0_8814B 0x158C -+#define REG_PS_TIMER_1_8814B 0x1590 -+#define REG_PS_TIMER_2_8814B 0x1594 -+#define REG_PS_TIMER_3_8814B 0x1598 -+#define REG_PS_TIMER_4_8814B 0x159C -+#define REG_PS_TIMER_5_8814B 0x15A0 -+#define REG_PS_TIMER_01_CTRL_8814B 0x15A4 -+#define REG_PS_TIMER_23_CTRL_8814B 0x15A8 -+#define REG_PS_TIMER_45_CTRL_8814B 0x15AC -+#define REG_CPUMGQ_FREERUN_TIMER_CTRL_8814B 0x15B0 -+#define REG_CPUMGQ_PROHIBIT_8814B 0x15B4 -+#define REG_TIMER_COMPARE_8814B 0x15C0 -+#define REG_TIMER_COMPARE_VALUE_LOW_8814B 0x15C4 -+#define REG_TIMER_COMPARE_VALUE_HIGH_8814B 0x15C8 -+#define REG_SCHEDULER_COUNTER_8814B 0x15D0 -+#define REG_WMAC_CR_8814B 0x0600 -+#define REG_WMAC_FWPKT_CR_8814B 0x0601 -+#define REG_FW_STS_FILTER_8814B 0x0602 -+#define REG_TCR_8814B 0x0604 -+#define REG_RCR_8814B 0x0608 -+#define REG_RX_PKT_LIMIT_8814B 0x060C -+#define REG_RX_DLK_TIME_8814B 0x060D -+#define REG_RX_DRVINFO_SZ_8814B 0x060F -+#define REG_MACID_8814B 0x0610 -+#define REG_MACID_H_8814B 0x0614 -+#define REG_BSSID_8814B 0x0618 -+#define REG_BSSID_H_8814B 0x061C -+#define REG_MAR_8814B 0x0620 -+#define REG_MAR_H_8814B 0x0624 -+#define REG_WMAC_DEBUG_SEL_8814B 0x062C -+#define REG_WMAC_TCR_TSFT_OFS_8814B 0x0630 -+#define REG_UDF_THSD_8814B 0x0632 -+#define REG_ZLD_NUM_8814B 0x0633 -+#define REG_STMP_THSD_8814B 0x0634 -+#define REG_WMAC_TXTIMEOUT_8814B 0x0635 -+#define REG_MCU_TEST_2_V1_8814B 0x0636 -+#define REG_USTIME_EDCA_8814B 0x0638 -+#define REG_ACKTO_CCK_8814B 0x0639 -+#define REG_MAC_SPEC_SIFS_8814B 0x063A -+#define REG_RESP_SIFS_CCK_8814B 0x063C -+#define REG_RESP_SIFS_OFDM_8814B 0x063E -+#define REG_ACKTO_8814B 0x0640 -+#define REG_CTS2TO_8814B 0x0641 -+#define REG_EIFS_8814B 0x0642 -+#define REG_RPFM_MAP0_8814B 0x0644 -+#define REG_RPFM_MAP1_V1_8814B 0x0646 -+#define REG_RPFM_CAM_CMD_8814B 0x0648 -+#define REG_RPFM_CAM_RWD_8814B 0x064C -+#define REG_NAV_CTRL_8814B 0x0650 -+#define REG_BACAMCMD_8814B 0x0654 -+#define REG_BACAMCONTENT_8814B 0x0658 -+#define REG_BACAMCONTENT_H_8814B 0x065C -+#define REG_LBDLY_8814B 0x0660 -+#define REG_WMAC_BACAM_RPMEN_8814B 0x0661 -+#define REG_TX_RX_8814B 0x0662 -+#define REG_WMAC_BITMAP_CTL_8814B 0x0663 -+#define REG_RXERR_RPT_8814B 0x0664 -+#define REG_WMAC_TRXPTCL_CTL_8814B 0x0668 -+#define REG_WMAC_TRXPTCL_CTL_H_8814B 0x066C -+#define REG_CAMCMD_8814B 0x0670 -+#define REG_CAMWRITE_8814B 0x0674 -+#define REG_CAMREAD_8814B 0x0678 -+#define REG_CAMDBG_8814B 0x067C -+#define REG_SECCFG_8814B 0x0680 -+#define REG_RXFILTER_CATEGORY_1_8814B 0x0682 -+#define REG_RXFILTER_ACTION_1_8814B 0x0683 -+#define REG_RXFILTER_CATEGORY_2_8814B 0x0684 -+#define REG_RXFILTER_ACTION_2_8814B 0x0685 -+#define REG_RXFILTER_CATEGORY_3_8814B 0x0686 -+#define REG_RXFILTER_ACTION_3_8814B 0x0687 -+#define REG_RXFLTMAP3_8814B 0x0688 -+#define REG_RXFLTMAP4_8814B 0x068A -+#define REG_RXFLTMAP5_8814B 0x068C -+#define REG_RXFLTMAP6_8814B 0x068E -+#define REG_WOW_CTRL_8814B 0x0690 -+#define REG_NAN_RX_TSF_FILTER_8814B 0x0691 -+#define REG_PS_RX_INFO_8814B 0x0692 -+#define REG_WMMPS_UAPSD_TID_8814B 0x0693 -+#define REG_LPNAV_CTRL_8814B 0x0694 -+#define REG_WKFMCAM_CMD_8814B 0x0698 -+#define REG_WKFMCAM_RWD_8814B 0x069C -+#define REG_RXFLTMAP0_8814B 0x06A0 -+#define REG_RXFLTMAP1_8814B 0x06A2 -+#define REG_RXFLTMAP2_8814B 0x06A4 -+#define REG_BCN_PSR_RPT_8814B 0x06A8 -+#define REG_FLC_RPC_8814B 0x06AC -+#define REG_FLC_RPCT_8814B 0x06AD -+#define REG_FLC_PTS_8814B 0x06AE -+#define REG_FLC_TRPC_8814B 0x06AF -+#define REG_RXPKTMON_CTRL_8814B 0x06B0 -+#define REG_STATE_MON_8814B 0x06B4 -+#define REG_ERROR_MON_8814B 0x06B8 -+#define REG_SEARCH_MACID_8814B 0x06BC -+#define REG_BT_COEX_TABLE_8814B 0x06C0 -+#define REG_BT_COEX_TABLE2_8814B 0x06C4 -+#define REG_BT_COEX_BREAK_TABLE_8814B 0x06C8 -+#define REG_BT_COEX_TABLE_H_8814B 0x06CC -+#define REG_RXCMD_0_8814B 0x06D0 -+#define REG_RXCMD_1_8814B 0x06D4 -+#define REG_WMAC_RESP_TXINFO_8814B 0x06D8 -+#define REG_BBPSF_CTRL_8814B 0x06DC -+#define REG_P2P_RX_BCN_NOA_8814B 0x06E0 -+#define REG_ASSOCIATED_BFMER0_INFO_8814B 0x06E4 -+#define REG_ASSOCIATED_BFMER0_INFO_H_8814B 0x06E8 -+#define REG_ASSOCIATED_BFMER1_INFO_8814B 0x06EC -+#define REG_ASSOCIATED_BFMER1_INFO_H_8814B 0x06F0 -+#define REG_TX_CSI_RPT_PARAM_BW20_8814B 0x06F4 -+#define REG_TX_CSI_RPT_PARAM_BW40_8814B 0x06F8 -+#define REG_BCN_PSR_RPT2_8814B 0x1600 -+#define REG_BCN_PSR_RPT3_8814B 0x1604 -+#define REG_BCN_PSR_RPT4_8814B 0x1608 -+#define REG_A1_ADDR_MASK_8814B 0x160C -+#define REG_RXPSF_CTRL_8814B 0x1610 -+#define REG_RXPSF_TYPE_CTRL_8814B 0x1614 -+#define REG_CAM_ACCESS_CTRL_8814B 0x1618 -+#define REG_CUT_AMSDU_CTRL_8814B 0x161C -+#define REG_MACID2_8814B 0x1620 -+#define REG_MACID2_H_8814B 0x1624 -+#define REG_BSSID2_8814B 0x1628 -+#define REG_BSSID2_H_8814B 0x162C -+#define REG_MACID3_8814B 0x1630 -+#define REG_MACID3_H_8814B 0x1634 -+#define REG_BSSID3_8814B 0x1638 -+#define REG_BSSID3_H_8814B 0x163C -+#define REG_MACID4_8814B 0x1640 -+#define REG_MACID4_H_8814B 0x1644 -+#define REG_BSSID4_8814B 0x1648 -+#define REG_BSSID4_H_8814B 0x164C -+#define REG_NOA_REPORT_8814B 0x1650 -+#define REG_NOA_REPORT_1_8814B 0x1654 -+#define REG_NOA_REPORT_2_8814B 0x1658 -+#define REG_NOA_REPORT_3_8814B 0x165C -+#define REG_PWRBIT_SETTING_8814B 0x1660 -+#define REG_GENERAL_OPTION_8814B 0x1664 -+#define REG_FWPHYFF_RCR_8814B 0x1668 -+#define REG_ADDRCAM_WRITE_CONTENT_8814B 0x166C -+#define REG_ADDRCAM_READ_CONTENT_8814B 0x1670 -+#define REG_ADDRCAM_CFG_8814B 0x1674 -+#define REG_CSI_RRSR_8814B 0x1678 -+#define REG_MU_BF_OPTION_8814B 0x167C -+#define REG_WMAC_PAUSE_BB_CLR_TH_8814B 0x167D -+#define REG_WMAC_MULBK_BUF_8814B 0x167E -+#define REG_WMAC_MU_OPTION_8814B 0x167F -+#define REG_WMAC_MU_BF_CTL_8814B 0x1680 -+#define REG_WMAC_MU_BFRPT_PARA_8814B 0x1682 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE2_8814B 0x1684 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE3_8814B 0x1686 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE4_8814B 0x1688 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE5_8814B 0x168A -+#define REG_WMAC_ASSOCIATED_MU_BFMEE6_8814B 0x168C -+#define REG_WMAC_ASSOCIATED_MU_BFMEE7_8814B 0x168E -+#define REG_WMAC_BB_STOP_RX_COUNTER_8814B 0x1690 -+#define REG_WMAC_PLCP_MONITOR_8814B 0x1694 -+#define REG_WMAC_DEBUG_PORT_8814B 0x1698 -+#define REG_TRANSMIT_ADDRSS_0_8814B 0x16A0 -+#define REG_TRANSMIT_ADDRSS_0_H_8814B 0x16A4 -+#define REG_TRANSMIT_ADDRSS_1_8814B 0x16A8 -+#define REG_TRANSMIT_ADDRSS_1_H_8814B 0x16AC -+#define REG_TRANSMIT_ADDRSS_2_8814B 0x16B0 -+#define REG_TRANSMIT_ADDRSS_2_H_8814B 0x16B4 -+#define REG_TRANSMIT_ADDRSS_3_8814B 0x16B8 -+#define REG_TRANSMIT_ADDRSS_3_H_8814B 0x16BC -+#define REG_TRANSMIT_ADDRSS_4_8814B 0x16C0 -+#define REG_TRANSMIT_ADDRSS_4_H_8814B 0x16C4 -+#define REG_MACID1_8814B 0x0700 -+#define REG_MACID1_1_8814B 0x0704 -+#define REG_BSSID1_8814B 0x0708 -+#define REG_BSSID1_1_8814B 0x070C -+#define REG_BCN_PSR_RPT1_8814B 0x0710 -+#define REG_ASSOCIATED_BFMEE_SEL_8814B 0x0714 -+#define REG_SND_PTCL_CTRL_8814B 0x0718 -+#define REG_RX_CSI_RPT_INFO_8814B 0x071C -+#define REG_NS_ARP_CTRL_8814B 0x0720 -+#define REG_NS_ARP_INFO_8814B 0x0724 -+#define REG_BEAMFORMING_INFO_NSARP_V1_8814B 0x0728 -+#define REG_BEAMFORMING_INFO_NSARP_8814B 0x072C -+#define REG_IPV6_8814B 0x0730 -+#define REG_IPV6_1_8814B 0x0734 -+#define REG_IPV6_2_8814B 0x0738 -+#define REG_IPV6_3_8814B 0x073C -+#define REG_WMAC_RTX_CTX_SUBTYPE_CFG_8814B 0x0750 -+#define REG_WMAC_SWAES_CFG_8814B 0x0760 -+#define REG_BT_COEX_V2_8814B 0x0762 -+#define REG_BT_COEX_8814B 0x0764 -+#define REG_WLAN_ACT_MASK_CTRL_8814B 0x0768 -+#define REG_WLAN_ACT_MASK_CTRL_1_8814B 0x076C -+#define REG_BT_COEX_ENHANCED_INTR_CTRL_8814B 0x076E -+#define REG_BT_ACT_STATISTICS_8814B 0x0770 -+#define REG_BT_ACT_STATISTICS_1_8814B 0x0774 -+#define REG_BT_STATISTICS_CONTROL_REGISTER_8814B 0x0778 -+#define REG_BT_STATUS_REPORT_REGISTER_8814B 0x077C -+#define REG_BT_INTERRUPT_CONTROL_REGISTER_8814B 0x0780 -+#define REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8814B 0x0784 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8814B 0x0785 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_1_8814B 0x0788 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_2_8814B 0x078C -+#define REG_BT_INTERRUPT_STATUS_REGISTER_8814B 0x078F -+#define REG_BT_TDMA_TIME_REGISTER_8814B 0x0790 -+#define REG_BT_ACT_REGISTER_8814B 0x0794 -+#define REG_OBFF_CTRL_BASIC_8814B 0x0798 -+#define REG_OBFF_CTRL2_TIMER_8814B 0x079C -+#define REG_LTR_CTRL_BASIC_8814B 0x07A0 -+#define REG_LTR_CTRL2_TIMER_THRESHOLD_8814B 0x07A4 -+#define REG_LTR_IDLE_LATENCY_V1_8814B 0x07A8 -+#define REG_LTR_ACTIVE_LATENCY_V1_8814B 0x07AC -+#define REG_SMART_ANT_CONDITION_8814B 0x07B0 -+#define REG_SMART_ANT_CTRL_8814B 0x07B4 -+#define REG_CONTROL_FRAME_REPORT_8814B 0x07B8 -+#define REG_CONTROL_FRAME_CNT_CTRL_8814B 0x07BC -+#define REG_IQ_DUMP_8814B 0x07C0 -+#define REG_IQ_DUMP_1_8814B 0x07C4 -+#define REG_IQ_DUMP_2_8814B 0x07C8 -+#define REG_WMAC_FTM_CTL_8814B 0x07CC -+#define REG_WMAC_IQ_MDPK_FUNC_8814B 0x07CE -+#define REG_WMAC_OPTION_FUNCTION_8814B 0x07D0 -+#define REG_WMAC_OPTION_FUNCTION_1_8814B 0x07D4 -+#define REG_WMAC_OPTION_FUNCTION_2_8814B 0x07D8 -+#define REG_RX_FILTER_FUNCTION_8814B 0x07DA -+#define REG_NDP_SIG_8814B 0x07E0 -+#define REG_TXCMD_INFO_FOR_RSP_PKT_8814B 0x07E4 -+#define REG_TXCMD_INFO_FOR_RSP_PKT_1_8814B 0x07E8 -+#define REG_WSEC_OPTION_8814B 0x07EC -+#define REG_RTS_ADDRESS_0_8814B 0x07F0 -+#define REG_RTS_ADDRESS_0_1_8814B 0x07F4 -+#define REG_RTS_ADDRESS_1_8814B 0x07F8 -+#define REG_RTS_ADDRESS_1_1_8814B 0x07FC -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8814B 0x1700 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8814B 0x1704 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8814B 0x1708 -+#define REG_PCIE_CFG_FORCE_LINK_L_8814B 0x0709 -+#define REG_PCIE_CFG_FORCE_LINK_H_8814B 0x070A -+#define REG_PCIE_CFG_DEFAULT_ACK_FREQUENCY_8814B 0x070C -+#define REG_PCIE_CFG_CX_NFTS_8814B 0x070D -+#define REG_PCIE_CFG_DEFAULT_ENTR_LATENCY_8814B 0x070F -+#define REG_PCIE_CFG_L1_MISC_SEL_8814B 0x0711 -+#define REG_PCIE_CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF_8814B 0x0718 -+#define REG_PCIE_CFG_FORCE_CLKREQ_N_PAD_8814B 0x0719 -+#define REG_PCIE_CFG_TIMER_MODIFIER_FOR_ACK_NAK_LATENCY_8814B 0x071A -+#define REG_PCIE_CFG_TIMER_MODIFIER_FOR_FLOW_CONTROL_WATCHDOG_8814B 0x071B -+#define REG_PCIE_CFG_SKP_INTERVAL_VALUE_L_8814B 0x071C -+#define REG_PCIE_CFG_SKP_INTERVAL_VALUE_H_8814B 0x071D -+#define REG_PCIE_CFG_L1_UNIT_SEL_8814B 0x0724 -+#define REG_PCIE_CFG_MIN_CLKREQ_SEL_8814B 0x0725 -+#define REG_SDIO_TX_CTRL_8814B 0x10250000 -+#define REG_SDIO_HIMR_8814B 0x10250014 -+#define REG_SDIO_HISR_8814B 0x10250018 -+#define REG_SDIO_RX_REQ_LEN_8814B 0x1025001C -+#define REG_SDIO_FREE_TXPG_SEQ_V1_8814B 0x1025001F -+#define REG_SDIO_FREE_TXPG_8814B 0x10250020 -+#define REG_SDIO_FREE_TXPG2_8814B 0x10250024 -+#define REG_SDIO_OQT_FREE_TXPG_V1_8814B 0x10250028 -+#define REG_SDIO_HTSFR_INFO_8814B 0x10250030 -+#define REG_SDIO_HCPWM1_V2_8814B 0x10250038 -+#define REG_SDIO_HCPWM2_V2_8814B 0x1025003A -+#define REG_SDIO_INDIRECT_REG_CFG_8814B 0x10250040 -+#define REG_SDIO_INDIRECT_REG_DATA_8814B 0x10250044 -+#define REG_SDIO_H2C_8814B 0x10250060 -+#define REG_SDIO_C2H_8814B 0x10250064 -+#define REG_SDIO_HRPWM1_8814B 0x10250080 -+#define REG_SDIO_HRPWM2_8814B 0x10250082 -+#define REG_SDIO_HPS_CLKR_8814B 0x10250084 -+#define REG_SDIO_BUS_CTRL_8814B 0x10250085 -+#define REG_SDIO_HSUS_CTRL_8814B 0x10250086 -+#define REG_SDIO_RESPONSE_TIMER_8814B 0x10250088 -+#define REG_SDIO_CMD_CRC_8814B 0x1025008A -+#define REG_SDIO_HSISR_8814B 0x10250090 -+#define REG_SDIO_ERR_RPT_8814B 0x102500C0 -+#define REG_SDIO_CMD_ERRCNT_8814B 0x102500C2 -+#define REG_SDIO_DATA_ERRCNT_8814B 0x102500C3 -+#define REG_SDIO_CMD_ERR_CONTENT_8814B 0x102500C4 -+#define REG_SDIO_CRC_ERR_IDX_8814B 0x102500C9 -+#define REG_SDIO_DATA_CRC_8814B 0x102500CA -+#define REG_SDIO_DATA_REPLY_TIME_8814B 0x102500CB -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8821c.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8821c.h -new file mode 100644 -index 000000000..2bb3eae55 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8821c.h -@@ -0,0 +1,803 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_REG_8821C_H -+#define __INC_HALMAC_REG_8821C_H -+ -+#define REG_SYS_ISO_CTRL_8821C 0x0000 -+#define REG_SYS_FUNC_EN_8821C 0x0002 -+#define REG_SYS_PW_CTRL_8821C 0x0004 -+#define REG_SYS_CLK_CTRL_8821C 0x0008 -+#define REG_SYS_EEPROM_CTRL_8821C 0x000A -+#define REG_EE_VPD_8821C 0x000C -+#define REG_SYS_SWR_CTRL1_8821C 0x0010 -+#define REG_SYS_SWR_CTRL2_8821C 0x0014 -+#define REG_SYS_SWR_CTRL3_8821C 0x0018 -+#define REG_RSV_CTRL_8821C 0x001C -+#define REG_RF_CTRL_8821C 0x001F -+#define REG_AFE_LDO_CTRL_8821C 0x0020 -+#define REG_AFE_CTRL1_8821C 0x0024 -+#define REG_AFE_CTRL2_8821C 0x0028 -+#define REG_AFE_CTRL3_8821C 0x002C -+#define REG_EFUSE_CTRL_8821C 0x0030 -+#define REG_LDO_EFUSE_CTRL_8821C 0x0034 -+#define REG_PWR_OPTION_CTRL_8821C 0x0038 -+#define REG_CAL_TIMER_8821C 0x003C -+#define REG_ACLK_MON_8821C 0x003E -+#define REG_GPIO_MUXCFG_8821C 0x0040 -+#define REG_GPIO_PIN_CTRL_8821C 0x0044 -+#define REG_GPIO_INTM_8821C 0x0048 -+#define REG_LED_CFG_8821C 0x004C -+#define REG_FSIMR_8821C 0x0050 -+#define REG_FSISR_8821C 0x0054 -+#define REG_HSIMR_8821C 0x0058 -+#define REG_HSISR_8821C 0x005C -+#define REG_GPIO_EXT_CTRL_8821C 0x0060 -+#define REG_PAD_CTRL1_8821C 0x0064 -+#define REG_WL_BT_PWR_CTRL_8821C 0x0068 -+#define REG_SDM_DEBUG_8821C 0x006C -+#define REG_SYS_SDIO_CTRL_8821C 0x0070 -+#define REG_HCI_OPT_CTRL_8821C 0x0074 -+#define REG_AFE_CTRL4_8821C 0x0078 -+#define REG_LDO_SWR_CTRL_8821C 0x007C -+#define REG_MCUFW_CTRL_8821C 0x0080 -+#define REG_MCU_TST_CFG_8821C 0x0084 -+#define REG_HMEBOX_E0_E1_8821C 0x0088 -+#define REG_HMEBOX_E2_E3_8821C 0x008C -+#define REG_WLLPS_CTRL_8821C 0x0090 -+#define REG_AFE_CTRL5_8821C 0x0094 -+#define REG_GPIO_DEBOUNCE_CTRL_8821C 0x0098 -+#define REG_RPWM2_8821C 0x009C -+#define REG_SYSON_FSM_MON_8821C 0x00A0 -+#define REG_AFE_CTRL6_8821C 0x00A4 -+#define REG_PMC_DBG_CTRL1_8821C 0x00A8 -+#define REG_AFE_CTRL7_8821C 0x00AC -+#define REG_HIMR0_8821C 0x00B0 -+#define REG_HISR0_8821C 0x00B4 -+#define REG_HIMR1_8821C 0x00B8 -+#define REG_HISR1_8821C 0x00BC -+#define REG_DBG_PORT_SEL_8821C 0x00C0 -+#define REG_PAD_CTRL2_8821C 0x00C4 -+#define REG_PMC_DBG_CTRL2_8821C 0x00CC -+#define REG_BIST_CTRL_8821C 0x00D0 -+#define REG_BIST_RPT_8821C 0x00D4 -+#define REG_MEM_CTRL_8821C 0x00D8 -+#define REG_AFE_CTRL8_8821C 0x00DC -+#define REG_USB_SIE_INTF_8821C 0x00E0 -+#define REG_PCIE_MIO_INTF_8821C 0x00E4 -+#define REG_PCIE_MIO_INTD_8821C 0x00E8 -+#define REG_WLRF1_8821C 0x00EC -+#define REG_SYS_CFG1_8821C 0x00F0 -+#define REG_SYS_STATUS1_8821C 0x00F4 -+#define REG_SYS_STATUS2_8821C 0x00F8 -+#define REG_SYS_CFG2_8821C 0x00FC -+#define REG_SYS_CFG3_8821C 0x1000 -+#define REG_SYS_CFG5_8821C 0x1070 -+#define REG_CPU_DMEM_CON_8821C 0x1080 -+#define REG_BOOT_REASON_8821C 0x1088 -+#define REG_NFCPAD_CTRL_8821C 0x10A8 -+#define REG_HIMR2_8821C 0x10B0 -+#define REG_HISR2_8821C 0x10B4 -+#define REG_HIMR3_8821C 0x10B8 -+#define REG_HISR3_8821C 0x10BC -+#define REG_SW_MDIO_8821C 0x10C0 -+#define REG_H2C_PKT_READADDR_8821C 0x10D0 -+#define REG_H2C_PKT_WRITEADDR_8821C 0x10D4 -+#define REG_MEM_PWR_CRTL_8821C 0x10D8 -+#define REG_FW_DBG6_8821C 0x10F8 -+#define REG_FW_DBG7_8821C 0x10FC -+#define REG_CR_8821C 0x0100 -+#define REG_PG_SIZE_8821C 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL_8821C 0x0106 -+#define REG_TSF_CLK_STATE_8821C 0x0108 -+#define REG_TXDMA_PQ_MAP_8821C 0x010C -+#define REG_TRXFF_BNDY_8821C 0x0114 -+#define REG_PTA_I2C_MBOX_8821C 0x0118 -+#define REG_RXFF_BNDY_8821C 0x011C -+#define REG_FE1IMR_8821C 0x0120 -+#define REG_FE1ISR_8821C 0x0124 -+#define REG_CPWM_8821C 0x012C -+#define REG_FWIMR_8821C 0x0130 -+#define REG_FWISR_8821C 0x0134 -+#define REG_FTIMR_8821C 0x0138 -+#define REG_FTISR_8821C 0x013C -+#define REG_PKTBUF_DBG_CTRL_8821C 0x0140 -+#define REG_PKTBUF_DBG_DATA_L_8821C 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8821C 0x0148 -+#define REG_CPWM2_8821C 0x014C -+#define REG_TC0_CTRL_8821C 0x0150 -+#define REG_TC1_CTRL_8821C 0x0154 -+#define REG_TC2_CTRL_8821C 0x0158 -+#define REG_TC3_CTRL_8821C 0x015C -+#define REG_TC4_CTRL_8821C 0x0160 -+#define REG_TCUNIT_BASE_8821C 0x0164 -+#define REG_TC5_CTRL_8821C 0x0168 -+#define REG_TC6_CTRL_8821C 0x016C -+#define REG_MBIST_DRF_FAIL_8821C 0x0170 -+#define REG_MBIST_START_PAUSE_8821C 0x0174 -+#define REG_MBIST_DONE_8821C 0x0178 -+#define REG_MBIST_READ_BIST_RPT_8821C 0x017C -+#define REG_AES_DECRPT_DATA_8821C 0x0180 -+#define REG_AES_DECRPT_CFG_8821C 0x0184 -+#define REG_TMETER_8821C 0x0190 -+#define REG_OSC_32K_CTRL_8821C 0x0194 -+#define REG_32K_CAL_REG1_8821C 0x0198 -+#define REG_C2HEVT_8821C 0x01A0 -+#define REG_C2HEVT_1_8821C 0x01A4 -+#define REG_C2HEVT_2_8821C 0x01A8 -+#define REG_C2HEVT_3_8821C 0x01AC -+#define REG_SW_DEFINED_PAGE1_8821C 0x01B8 -+#define REG_SW_DEFINED_PAGE2_8821C 0x01BC -+#define REG_MCUTST_I_8821C 0x01C0 -+#define REG_MCUTST_II_8821C 0x01C4 -+#define REG_FMETHR_8821C 0x01C8 -+#define REG_HMETFR_8821C 0x01CC -+#define REG_HMEBOX0_8821C 0x01D0 -+#define REG_HMEBOX1_8821C 0x01D4 -+#define REG_HMEBOX2_8821C 0x01D8 -+#define REG_HMEBOX3_8821C 0x01DC -+#define REG_BB_ACCESS_CTRL_8821C 0x01E8 -+#define REG_BB_ACCESS_DATA_8821C 0x01EC -+#define REG_HMEBOX_E0_8821C 0x01F0 -+#define REG_HMEBOX_E1_8821C 0x01F4 -+#define REG_HMEBOX_E2_8821C 0x01F8 -+#define REG_HMEBOX_E3_8821C 0x01FC -+#define REG_CR_EXT_8821C 0x1100 -+#define REG_FWFF_8821C 0x1114 -+#define REG_RXFF_PTR_V1_8821C 0x1118 -+#define REG_RXFF_WTR_V1_8821C 0x111C -+#define REG_FE2IMR_8821C 0x1120 -+#define REG_FE2ISR_8821C 0x1124 -+#define REG_FE3IMR_8821C 0x1128 -+#define REG_FE3ISR_8821C 0x112C -+#define REG_FE4IMR_8821C 0x1130 -+#define REG_FE4ISR_8821C 0x1134 -+#define REG_FT1IMR_8821C 0x1138 -+#define REG_FT1ISR_8821C 0x113C -+#define REG_SPWR0_8821C 0x1140 -+#define REG_SPWR1_8821C 0x1144 -+#define REG_SPWR2_8821C 0x1148 -+#define REG_SPWR3_8821C 0x114C -+#define REG_POWSEQ_8821C 0x1150 -+#define REG_TC7_CTRL_V1_8821C 0x1158 -+#define REG_TC8_CTRL_V1_8821C 0x115C -+#define REG_RX_BCN_TBTT_ITVL0_8821C 0x1160 -+#define REG_RX_BCN_TBTT_ITVL1_8821C 0x1164 -+#define REG_IO_WRAP_ERR_FLAG_8821C 0x1170 -+#define REG_SPEED_SENSOR_8821C 0x1180 -+#define REG_SPEED_SENSOR1_8821C 0x1184 -+#define REG_SPEED_SENSOR2_8821C 0x1188 -+#define REG_SPEED_SENSOR3_8821C 0x118C -+#define REG_SPEED_SENSOR4_8821C 0x1190 -+#define REG_SPEED_SENSOR5_8821C 0x1194 -+#define REG_COUNTER_CTRL_8821C 0x11C4 -+#define REG_COUNTER_THRESHOLD_8821C 0x11C8 -+#define REG_COUNTER_SET_8821C 0x11CC -+#define REG_COUNTER_OVERFLOW_8821C 0x11D0 -+#define REG_TXDMA_LEN_THRESHOLD_8821C 0x11D4 -+#define REG_RXDMA_LEN_THRESHOLD_8821C 0x11D8 -+#define REG_PCIE_EXEC_TIME_THRESHOLD_8821C 0x11DC -+#define REG_FT2IMR_8821C 0x11E0 -+#define REG_FT2ISR_8821C 0x11E4 -+#define REG_MSG2_8821C 0x11F0 -+#define REG_MSG3_8821C 0x11F4 -+#define REG_MSG4_8821C 0x11F8 -+#define REG_MSG5_8821C 0x11FC -+#define REG_FIFOPAGE_CTRL_1_8821C 0x0200 -+#define REG_FIFOPAGE_CTRL_2_8821C 0x0204 -+#define REG_AUTO_LLT_V1_8821C 0x0208 -+#define REG_TXDMA_OFFSET_CHK_8821C 0x020C -+#define REG_TXDMA_STATUS_8821C 0x0210 -+#define REG_TX_DMA_DBG_8821C 0x0214 -+#define REG_TQPNT1_8821C 0x0218 -+#define REG_TQPNT2_8821C 0x021C -+#define REG_TQPNT3_8821C 0x0220 -+#define REG_TQPNT4_8821C 0x0224 -+#define REG_RQPN_CTRL_1_8821C 0x0228 -+#define REG_RQPN_CTRL_2_8821C 0x022C -+#define REG_FIFOPAGE_INFO_1_8821C 0x0230 -+#define REG_FIFOPAGE_INFO_2_8821C 0x0234 -+#define REG_FIFOPAGE_INFO_3_8821C 0x0238 -+#define REG_FIFOPAGE_INFO_4_8821C 0x023C -+#define REG_FIFOPAGE_INFO_5_8821C 0x0240 -+#define REG_H2C_HEAD_8821C 0x0244 -+#define REG_H2C_TAIL_8821C 0x0248 -+#define REG_H2C_READ_ADDR_8821C 0x024C -+#define REG_H2C_WR_ADDR_8821C 0x0250 -+#define REG_H2C_INFO_8821C 0x0254 -+#define REG_RXDMA_AGG_PG_TH_8821C 0x0280 -+#define REG_RXPKT_NUM_8821C 0x0284 -+#define REG_RXDMA_STATUS_8821C 0x0288 -+#define REG_RXDMA_DPR_8821C 0x028C -+#define REG_RXDMA_MODE_8821C 0x0290 -+#define REG_C2H_PKT_8821C 0x0294 -+#define REG_FWFF_C2H_8821C 0x0298 -+#define REG_FWFF_CTRL_8821C 0x029C -+#define REG_FWFF_PKT_INFO_8821C 0x02A0 -+#define REG_DDMA_CH0SA_8821C 0x1200 -+#define REG_DDMA_CH0DA_8821C 0x1204 -+#define REG_DDMA_CH0CTRL_8821C 0x1208 -+#define REG_DDMA_CH1SA_8821C 0x1210 -+#define REG_DDMA_CH1DA_8821C 0x1214 -+#define REG_DDMA_CH1CTRL_8821C 0x1218 -+#define REG_DDMA_CH2SA_8821C 0x1220 -+#define REG_DDMA_CH2DA_8821C 0x1224 -+#define REG_DDMA_CH2CTRL_8821C 0x1228 -+#define REG_DDMA_CH3SA_8821C 0x1230 -+#define REG_DDMA_CH3DA_8821C 0x1234 -+#define REG_DDMA_CH3CTRL_8821C 0x1238 -+#define REG_DDMA_CH4SA_8821C 0x1240 -+#define REG_DDMA_CH4DA_8821C 0x1244 -+#define REG_DDMA_CH4CTRL_8821C 0x1248 -+#define REG_DDMA_CH5SA_8821C 0x1250 -+#define REG_DDMA_CH5DA_8821C 0x1254 -+#define REG_DDMA_CH5CTRL_8821C 0x1258 -+#define REG_DDMA_INT_MSK_8821C 0x12E0 -+#define REG_DDMA_CHSTATUS_8821C 0x12E8 -+#define REG_DDMA_CHKSUM_8821C 0x12F0 -+#define REG_DDMA_MONITOR_8821C 0x12FC -+#define REG_PCIE_CTRL_8821C 0x0300 -+#define REG_INT_MIG_8821C 0x0304 -+#define REG_BCNQ_TXBD_DESA_8821C 0x0308 -+#define REG_MGQ_TXBD_DESA_8821C 0x0310 -+#define REG_VOQ_TXBD_DESA_8821C 0x0318 -+#define REG_VIQ_TXBD_DESA_8821C 0x0320 -+#define REG_BEQ_TXBD_DESA_8821C 0x0328 -+#define REG_BKQ_TXBD_DESA_8821C 0x0330 -+#define REG_RXQ_RXBD_DESA_8821C 0x0338 -+#define REG_HI0Q_TXBD_DESA_8821C 0x0340 -+#define REG_HI1Q_TXBD_DESA_8821C 0x0348 -+#define REG_HI2Q_TXBD_DESA_8821C 0x0350 -+#define REG_HI3Q_TXBD_DESA_8821C 0x0358 -+#define REG_HI4Q_TXBD_DESA_8821C 0x0360 -+#define REG_HI5Q_TXBD_DESA_8821C 0x0368 -+#define REG_HI6Q_TXBD_DESA_8821C 0x0370 -+#define REG_HI7Q_TXBD_DESA_8821C 0x0378 -+#define REG_MGQ_TXBD_NUM_8821C 0x0380 -+#define REG_RX_RXBD_NUM_8821C 0x0382 -+#define REG_VOQ_TXBD_NUM_8821C 0x0384 -+#define REG_VIQ_TXBD_NUM_8821C 0x0386 -+#define REG_BEQ_TXBD_NUM_8821C 0x0388 -+#define REG_BKQ_TXBD_NUM_8821C 0x038A -+#define REG_HI0Q_TXBD_NUM_8821C 0x038C -+#define REG_HI1Q_TXBD_NUM_8821C 0x038E -+#define REG_HI2Q_TXBD_NUM_8821C 0x0390 -+#define REG_HI3Q_TXBD_NUM_8821C 0x0392 -+#define REG_HI4Q_TXBD_NUM_8821C 0x0394 -+#define REG_HI5Q_TXBD_NUM_8821C 0x0396 -+#define REG_HI6Q_TXBD_NUM_8821C 0x0398 -+#define REG_HI7Q_TXBD_NUM_8821C 0x039A -+#define REG_TSFTIMER_HCI_8821C 0x039C -+#define REG_BD_RWPTR_CLR_8821C 0x039C -+#define REG_VOQ_TXBD_IDX_8821C 0x03A0 -+#define REG_VIQ_TXBD_IDX_8821C 0x03A4 -+#define REG_BEQ_TXBD_IDX_8821C 0x03A8 -+#define REG_BKQ_TXBD_IDX_8821C 0x03AC -+#define REG_MGQ_TXBD_IDX_8821C 0x03B0 -+#define REG_RXQ_RXBD_IDX_8821C 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8821C 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8821C 0x03BC -+#define REG_HI2Q_TXBD_IDX_8821C 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8821C 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8821C 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8821C 0x03CC -+#define REG_HI6Q_TXBD_IDX_8821C 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8821C 0x03D4 -+#define REG_DBG_SEL_V1_8821C 0x03D8 -+#define REG_PCIE_HRPWM1_V1_8821C 0x03D9 -+#define REG_PCIE_HCPWM1_V1_8821C 0x03DA -+#define REG_PCIE_CTRL2_8821C 0x03DB -+#define REG_PCIE_HRPWM2_V1_8821C 0x03DC -+#define REG_PCIE_HCPWM2_V1_8821C 0x03DE -+#define REG_PCIE_H2C_MSG_V1_8821C 0x03E0 -+#define REG_PCIE_C2H_MSG_V1_8821C 0x03E4 -+#define REG_DBI_WDATA_V1_8821C 0x03E8 -+#define REG_DBI_RDATA_V1_8821C 0x03EC -+#define REG_DBI_FLAG_V1_8821C 0x03F0 -+#define REG_MDIO_V1_8821C 0x03F4 -+#define REG_PCIE_MIX_CFG_8821C 0x03F8 -+#define REG_HCI_MIX_CFG_8821C 0x03FC -+#define REG_STC_INT_CS_8821C 0x1300 -+#define REG_ST_INT_CFG_8821C 0x1304 -+#define REG_CMU_DLY_CTRL_8821C 0x1310 -+#define REG_CMU_DLY_CFG_8821C 0x1314 -+#define REG_H2CQ_TXBD_DESA_8821C 0x1320 -+#define REG_H2CQ_TXBD_NUM_8821C 0x1328 -+#define REG_H2CQ_TXBD_IDX_8821C 0x132C -+#define REG_H2CQ_CSR_8821C 0x1330 -+#define REG_Q0_INFO_8821C 0x0400 -+#define REG_Q1_INFO_8821C 0x0404 -+#define REG_Q2_INFO_8821C 0x0408 -+#define REG_Q3_INFO_8821C 0x040C -+#define REG_MGQ_INFO_8821C 0x0410 -+#define REG_HIQ_INFO_8821C 0x0414 -+#define REG_BCNQ_INFO_8821C 0x0418 -+#define REG_TXPKT_EMPTY_8821C 0x041A -+#define REG_CPU_MGQ_INFO_8821C 0x041C -+#define REG_FWHW_TXQ_CTRL_8821C 0x0420 -+#define REG_DATAFB_SEL_8821C 0x0423 -+#define REG_BCNQ_BDNY_V1_8821C 0x0424 -+#define REG_LIFETIME_EN_8821C 0x0426 -+#define REG_SPEC_SIFS_8821C 0x0428 -+#define REG_RETRY_LIMIT_8821C 0x042A -+#define REG_TXBF_CTRL_8821C 0x042C -+#define REG_DARFRC_8821C 0x0430 -+#define REG_DARFRCH_8821C 0x0434 -+#define REG_RARFRC_8821C 0x0438 -+#define REG_RARFRCH_8821C 0x043C -+#define REG_RRSR_8821C 0x0440 -+#define REG_ARFR0_8821C 0x0444 -+#define REG_ARFRH0_8821C 0x0448 -+#define REG_ARFR1_V1_8821C 0x044C -+#define REG_ARFRH1_V1_8821C 0x0450 -+#define REG_CCK_CHECK_8821C 0x0454 -+#define REG_AMPDU_MAX_TIME_V1_8821C 0x0455 -+#define REG_BCNQ1_BDNY_V1_8821C 0x0456 -+#define REG_AMPDU_MAX_LENGTH_8821C 0x0458 -+#define REG_ACQ_STOP_8821C 0x045C -+#define REG_NDPA_RATE_8821C 0x045D -+#define REG_TX_HANG_CTRL_8821C 0x045E -+#define REG_NDPA_OPT_CTRL_8821C 0x045F -+#define REG_RD_RESP_PKT_TH_8821C 0x0463 -+#define REG_CMDQ_INFO_8821C 0x0464 -+#define REG_Q4_INFO_8821C 0x0468 -+#define REG_Q5_INFO_8821C 0x046C -+#define REG_Q6_INFO_8821C 0x0470 -+#define REG_Q7_INFO_8821C 0x0474 -+#define REG_WMAC_LBK_BUF_HD_V1_8821C 0x0478 -+#define REG_MGQ_BDNY_V1_8821C 0x047A -+#define REG_TXRPT_CTRL_8821C 0x047C -+#define REG_INIRTS_RATE_SEL_8821C 0x0480 -+#define REG_BASIC_CFEND_RATE_8821C 0x0481 -+#define REG_STBC_CFEND_RATE_8821C 0x0482 -+#define REG_DATA_SC_8821C 0x0483 -+#define REG_MACID_SLEEP3_8821C 0x0484 -+#define REG_MACID_SLEEP1_8821C 0x0488 -+#define REG_ARFR2_V1_8821C 0x048C -+#define REG_ARFRH2_V1_8821C 0x0490 -+#define REG_ARFR3_V1_8821C 0x0494 -+#define REG_ARFRH3_V1_8821C 0x0498 -+#define REG_ARFR4_8821C 0x049C -+#define REG_ARFRH4_8821C 0x04A0 -+#define REG_ARFR5_8821C 0x04A4 -+#define REG_ARFRH5_8821C 0x04A8 -+#define REG_TXRPT_START_OFFSET_8821C 0x04AC -+#define REG_POWER_STAGE1_8821C 0x04B4 -+#define REG_POWER_STAGE2_8821C 0x04B8 -+#define REG_SW_AMPDU_BURST_MODE_CTRL_8821C 0x04BC -+#define REG_PKT_LIFE_TIME_8821C 0x04C0 -+#define REG_STBC_SETTING_8821C 0x04C4 -+#define REG_STBC_SETTING2_8821C 0x04C5 -+#define REG_QUEUE_CTRL_8821C 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL_8821C 0x04C7 -+#define REG_PROT_MODE_CTRL_8821C 0x04C8 -+#define REG_BAR_MODE_CTRL_8821C 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8821C 0x04CF -+#define REG_MACID_SLEEP2_8821C 0x04D0 -+#define REG_MACID_SLEEP_8821C 0x04D4 -+#define REG_HW_SEQ0_8821C 0x04D8 -+#define REG_HW_SEQ1_8821C 0x04DA -+#define REG_HW_SEQ2_8821C 0x04DC -+#define REG_HW_SEQ3_8821C 0x04DE -+#define REG_NULL_PKT_STATUS_V1_8821C 0x04E0 -+#define REG_PTCL_ERR_STATUS_8821C 0x04E2 -+#define REG_NULL_PKT_STATUS_EXTEND_8821C 0x04E3 -+#define REG_VIDEO_ENHANCEMENT_FUN_8821C 0x04E4 -+#define REG_PRECNT_CTRL_8821C 0x04E5 -+#define REG_BT_POLLUTE_PKT_CNT_8821C 0x04E8 -+#define REG_PTCL_DBG_8821C 0x04EC -+#define REG_CPUMGQ_TIMER_CTRL2_8821C 0x04F4 -+#define REG_DUMMY_PAGE4_V1_8821C 0x04FC -+#define REG_MOREDATA_8821C 0x04FE -+#define REG_Q0_Q1_INFO_8821C 0x1400 -+#define REG_Q2_Q3_INFO_8821C 0x1404 -+#define REG_Q4_Q5_INFO_8821C 0x1408 -+#define REG_Q6_Q7_INFO_8821C 0x140C -+#define REG_MGQ_HIQ_INFO_8821C 0x1410 -+#define REG_CMDQ_BCNQ_INFO_8821C 0x1414 -+#define REG_USEREG_SETTING_8821C 0x1420 -+#define REG_AESIV_SETTING_8821C 0x1424 -+#define REG_BF0_TIME_SETTING_8821C 0x1428 -+#define REG_BF1_TIME_SETTING_8821C 0x142C -+#define REG_BF_TIMEOUT_EN_8821C 0x1430 -+#define REG_MACID_RELEASE0_8821C 0x1434 -+#define REG_MACID_RELEASE1_8821C 0x1438 -+#define REG_MACID_RELEASE2_8821C 0x143C -+#define REG_MACID_RELEASE3_8821C 0x1440 -+#define REG_MACID_RELEASE_SETTING_8821C 0x1444 -+#define REG_FAST_EDCA_VOVI_SETTING_8821C 0x1448 -+#define REG_FAST_EDCA_BEBK_SETTING_8821C 0x144C -+#define REG_MACID_DROP0_8821C 0x1450 -+#define REG_MACID_DROP1_8821C 0x1454 -+#define REG_MACID_DROP2_8821C 0x1458 -+#define REG_MACID_DROP3_8821C 0x145C -+#define REG_R_MACID_RELEASE_SUCCESS_0_8821C 0x1460 -+#define REG_R_MACID_RELEASE_SUCCESS_1_8821C 0x1464 -+#define REG_R_MACID_RELEASE_SUCCESS_2_8821C 0x1468 -+#define REG_R_MACID_RELEASE_SUCCESS_3_8821C 0x146C -+#define REG_MGQ_FIFO_WRITE_POINTER_8821C 0x1470 -+#define REG_MGQ_FIFO_READ_POINTER_8821C 0x1472 -+#define REG_MGQ_FIFO_ENABLE_8821C 0x1472 -+#define REG_MGQ_FIFO_RELEASE_INT_MASK_8821C 0x1474 -+#define REG_MGQ_FIFO_RELEASE_INT_FLAG_8821C 0x1476 -+#define REG_MGQ_FIFO_VALID_MAP_8821C 0x1478 -+#define REG_MGQ_FIFO_LIFETIME_8821C 0x147A -+#define REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8821C 0x147C -+#define REG_SHCUT_SETTING_8821C 0x1480 -+#define REG_SHCUT_LLC_ETH_TYPE0_8821C 0x1484 -+#define REG_SHCUT_LLC_ETH_TYPE1_8821C 0x1488 -+#define REG_SHCUT_LLC_OUI0_8821C 0x148C -+#define REG_SHCUT_LLC_OUI1_8821C 0x1490 -+#define REG_SHCUT_LLC_OUI2_8821C 0x1494 -+#define REG_MU_TX_CTL_8821C 0x14C0 -+#define REG_MU_STA_GID_VLD_8821C 0x14C4 -+#define REG_MU_STA_USER_POS_INFO_8821C 0x14C8 -+#define REG_MU_STA_USER_POS_INFO_H_8821C 0x14CC -+#define REG_MU_TRX_DBG_CNT_8821C 0x14D0 -+#define REG_EDCA_VO_PARAM_8821C 0x0500 -+#define REG_EDCA_VI_PARAM_8821C 0x0504 -+#define REG_EDCA_BE_PARAM_8821C 0x0508 -+#define REG_EDCA_BK_PARAM_8821C 0x050C -+#define REG_BCNTCFG_8821C 0x0510 -+#define REG_PIFS_8821C 0x0512 -+#define REG_RDG_PIFS_8821C 0x0513 -+#define REG_SIFS_8821C 0x0514 -+#define REG_TSFTR_SYN_OFFSET_8821C 0x0518 -+#define REG_AGGR_BREAK_TIME_8821C 0x051A -+#define REG_SLOT_8821C 0x051B -+#define REG_NOA_ON_ERLY_TIME_8821C 0x051C -+#define REG_NOA_OFF_ERLY_TIME_8821C 0x051D -+#define REG_TX_PTCL_CTRL_8821C 0x0520 -+#define REG_TXPAUSE_8821C 0x0522 -+#define REG_DIS_TXREQ_CLR_8821C 0x0523 -+#define REG_RD_CTRL_8821C 0x0524 -+#define REG_MBSSID_CTRL_8821C 0x0526 -+#define REG_P2PPS_CTRL_8821C 0x0527 -+#define REG_PKT_LIFETIME_CTRL_8821C 0x0528 -+#define REG_P2PPS_SPEC_STATE_8821C 0x052B -+#define REG_BAR_TX_CTRL_8821C 0x0530 -+#define REG_P2PON_DIS_TXTIME_8821C 0x0531 -+#define REG_TBTT_PROHIBIT_8821C 0x0540 -+#define REG_P2PPS_STATE_8821C 0x0543 -+#define REG_RD_NAV_NXT_8821C 0x0544 -+#define REG_NAV_PROT_LEN_8821C 0x0546 -+#define REG_BCN_CTRL_8821C 0x0550 -+#define REG_BCN_CTRL_CLINT0_8821C 0x0551 -+#define REG_MBID_NUM_8821C 0x0552 -+#define REG_DUAL_TSF_RST_8821C 0x0553 -+#define REG_MBSSID_BCN_SPACE_8821C 0x0554 -+#define REG_DRVERLYINT_8821C 0x0558 -+#define REG_BCNDMATIM_8821C 0x0559 -+#define REG_ATIMWND_8821C 0x055A -+#define REG_USTIME_TSF_8821C 0x055C -+#define REG_BCN_MAX_ERR_8821C 0x055D -+#define REG_RXTSF_OFFSET_CCK_8821C 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8821C 0x055F -+#define REG_TSFTR_8821C 0x0560 -+#define REG_TSFTR_1_8821C 0x0564 -+#define REG_FREERUN_CNT_8821C 0x0568 -+#define REG_FREERUN_CNT_1_8821C 0x056C -+#define REG_ATIMWND1_V1_8821C 0x0570 -+#define REG_TBTT_PROHIBIT_INFRA_8821C 0x0571 -+#define REG_CTWND_8821C 0x0572 -+#define REG_BCNIVLCUNT_8821C 0x0573 -+#define REG_BCNDROPCTRL_8821C 0x0574 -+#define REG_HGQ_TIMEOUT_PERIOD_8821C 0x0575 -+#define REG_TXCMD_TIMEOUT_PERIOD_8821C 0x0576 -+#define REG_MISC_CTRL_8821C 0x0577 -+#define REG_BCN_CTRL_CLINT1_8821C 0x0578 -+#define REG_BCN_CTRL_CLINT2_8821C 0x0579 -+#define REG_BCN_CTRL_CLINT3_8821C 0x057A -+#define REG_EXTEND_CTRL_8821C 0x057B -+#define REG_P2PPS1_SPEC_STATE_8821C 0x057C -+#define REG_P2PPS1_STATE_8821C 0x057D -+#define REG_P2PPS2_SPEC_STATE_8821C 0x057E -+#define REG_P2PPS2_STATE_8821C 0x057F -+#define REG_PS_TIMER0_8821C 0x0580 -+#define REG_PS_TIMER1_8821C 0x0584 -+#define REG_PS_TIMER2_8821C 0x0588 -+#define REG_TBTT_CTN_AREA_8821C 0x058C -+#define REG_FORCE_BCN_IFS_8821C 0x058E -+#define REG_TXOP_MIN_8821C 0x0590 -+#define REG_PRE_BKF_TIME_8821C 0x0592 -+#define REG_CROSS_TXOP_CTRL_8821C 0x0593 -+#define REG_ATIMWND2_8821C 0x05A0 -+#define REG_ATIMWND3_8821C 0x05A1 -+#define REG_ATIMWND4_8821C 0x05A2 -+#define REG_ATIMWND5_8821C 0x05A3 -+#define REG_ATIMWND6_8821C 0x05A4 -+#define REG_ATIMWND7_8821C 0x05A5 -+#define REG_ATIMUGT_8821C 0x05A6 -+#define REG_HIQ_NO_LMT_EN_8821C 0x05A7 -+#define REG_DTIM_COUNTER_ROOT_8821C 0x05A8 -+#define REG_DTIM_COUNTER_VAP1_8821C 0x05A9 -+#define REG_DTIM_COUNTER_VAP2_8821C 0x05AA -+#define REG_DTIM_COUNTER_VAP3_8821C 0x05AB -+#define REG_DTIM_COUNTER_VAP4_8821C 0x05AC -+#define REG_DTIM_COUNTER_VAP5_8821C 0x05AD -+#define REG_DTIM_COUNTER_VAP6_8821C 0x05AE -+#define REG_DTIM_COUNTER_VAP7_8821C 0x05AF -+#define REG_DIS_ATIM_8821C 0x05B0 -+#define REG_EARLY_128US_8821C 0x05B1 -+#define REG_P2PPS1_CTRL_8821C 0x05B2 -+#define REG_P2PPS2_CTRL_8821C 0x05B3 -+#define REG_TIMER0_SRC_SEL_8821C 0x05B4 -+#define REG_NOA_UNIT_SEL_8821C 0x05B5 -+#define REG_P2POFF_DIS_TXTIME_8821C 0x05B7 -+#define REG_MBSSID_BCN_SPACE2_8821C 0x05B8 -+#define REG_MBSSID_BCN_SPACE3_8821C 0x05BC -+#define REG_ACMHWCTRL_8821C 0x05C0 -+#define REG_ACMRSTCTRL_8821C 0x05C1 -+#define REG_ACMAVG_8821C 0x05C2 -+#define REG_VO_ADMTIME_8821C 0x05C4 -+#define REG_VI_ADMTIME_8821C 0x05C6 -+#define REG_BE_ADMTIME_8821C 0x05C8 -+#define REG_EDCA_RANDOM_GEN_8821C 0x05CC -+#define REG_TXCMD_NOA_SEL_8821C 0x05CF -+#define REG_NOA_PARAM_8821C 0x05E0 -+#define REG_NOA_PARAM_1_8821C 0x05E4 -+#define REG_NOA_PARAM_2_8821C 0x05E8 -+#define REG_NOA_PARAM_3_8821C 0x05EC -+#define REG_P2P_RST_8821C 0x05F0 -+#define REG_SCHEDULER_RST_8821C 0x05F1 -+#define REG_SCH_TXCMD_8821C 0x05F8 -+#define REG_PAGE5_DUMMY_8821C 0x05FC -+#define REG_CPUMGQ_TX_TIMER_8821C 0x1500 -+#define REG_PS_TIMER_A_8821C 0x1504 -+#define REG_PS_TIMER_B_8821C 0x1508 -+#define REG_PS_TIMER_C_8821C 0x150C -+#define REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL_8821C 0x1510 -+#define REG_CPUMGQ_TX_TIMER_EARLY_8821C 0x1514 -+#define REG_PS_TIMER_A_EARLY_8821C 0x1515 -+#define REG_PS_TIMER_B_EARLY_8821C 0x1516 -+#define REG_PS_TIMER_C_EARLY_8821C 0x1517 -+#define REG_CPUMGQ_PARAMETER_8821C 0x1518 -+#define REG_WMAC_CR_8821C 0x0600 -+#define REG_WMAC_FWPKT_CR_8821C 0x0601 -+#define REG_FW_STS_FILTER_8821C 0x0602 -+#define REG_TCR_8821C 0x0604 -+#define REG_RCR_8821C 0x0608 -+#define REG_RX_PKT_LIMIT_8821C 0x060C -+#define REG_RX_DLK_TIME_8821C 0x060D -+#define REG_RX_DRVINFO_SZ_8821C 0x060F -+#define REG_MACID_8821C 0x0610 -+#define REG_MACID_H_8821C 0x0614 -+#define REG_BSSID_8821C 0x0618 -+#define REG_BSSID_H_8821C 0x061C -+#define REG_MAR_8821C 0x0620 -+#define REG_MAR_H_8821C 0x0624 -+#define REG_MBIDCAMCFG_1_8821C 0x0628 -+#define REG_MBIDCAMCFG_2_8821C 0x062C -+#define REG_WMAC_TCR_TSFT_OFS_8821C 0x0630 -+#define REG_UDF_THSD_8821C 0x0632 -+#define REG_ZLD_NUM_8821C 0x0633 -+#define REG_STMP_THSD_8821C 0x0634 -+#define REG_WMAC_TXTIMEOUT_8821C 0x0635 -+#define REG_MCU_TEST_2_V1_8821C 0x0636 -+#define REG_USTIME_EDCA_8821C 0x0638 -+#define REG_ACKTO_CCK_8821C 0x0639 -+#define REG_MAC_SPEC_SIFS_8821C 0x063A -+#define REG_RESP_SIFS_CCK_8821C 0x063C -+#define REG_RESP_SIFS_OFDM_8821C 0x063E -+#define REG_ACKTO_8821C 0x0640 -+#define REG_CTS2TO_8821C 0x0641 -+#define REG_EIFS_8821C 0x0642 -+#define REG_RPFM_MAP0_8821C 0x0644 -+#define REG_RPFM_MAP1_V1_8821C 0x0646 -+#define REG_RPFM_CAM_CMD_8821C 0x0648 -+#define REG_RPFM_CAM_RWD_8821C 0x064C -+#define REG_NAV_CTRL_8821C 0x0650 -+#define REG_BACAMCMD_8821C 0x0654 -+#define REG_BACAMCONTENT_8821C 0x0658 -+#define REG_BACAMCONTENT_H_8821C 0x065C -+#define REG_LBDLY_8821C 0x0660 -+#define REG_WMAC_BACAM_RPMEN_8821C 0x0661 -+#define REG_TX_RX_8821C 0x0662 -+#define REG_WMAC_BITMAP_CTL_8821C 0x0663 -+#define REG_RXERR_RPT_8821C 0x0664 -+#define REG_WMAC_TRXPTCL_CTL_8821C 0x0668 -+#define REG_WMAC_TRXPTCL_CTL_H_8821C 0x066C -+#define REG_CAMCMD_8821C 0x0670 -+#define REG_CAMWRITE_8821C 0x0674 -+#define REG_CAMREAD_8821C 0x0678 -+#define REG_CAMDBG_8821C 0x067C -+#define REG_SECCFG_8821C 0x0680 -+#define REG_RXFILTER_CATEGORY_1_8821C 0x0682 -+#define REG_RXFILTER_ACTION_1_8821C 0x0683 -+#define REG_RXFILTER_CATEGORY_2_8821C 0x0684 -+#define REG_RXFILTER_ACTION_2_8821C 0x0685 -+#define REG_RXFILTER_CATEGORY_3_8821C 0x0686 -+#define REG_RXFILTER_ACTION_3_8821C 0x0687 -+#define REG_RXFLTMAP3_8821C 0x0688 -+#define REG_RXFLTMAP4_8821C 0x068A -+#define REG_RXFLTMAP5_8821C 0x068C -+#define REG_RXFLTMAP6_8821C 0x068E -+#define REG_WOW_CTRL_8821C 0x0690 -+#define REG_NAN_RX_TSF_FILTER_8821C 0x0691 -+#define REG_PS_RX_INFO_8821C 0x0692 -+#define REG_WMMPS_UAPSD_TID_8821C 0x0693 -+#define REG_LPNAV_CTRL_8821C 0x0694 -+#define REG_WKFMCAM_CMD_8821C 0x0698 -+#define REG_WKFMCAM_RWD_8821C 0x069C -+#define REG_RXFLTMAP0_8821C 0x06A0 -+#define REG_RXFLTMAP1_8821C 0x06A2 -+#define REG_RXFLTMAP2_8821C 0x06A4 -+#define REG_BCN_PSR_RPT_8821C 0x06A8 -+#define REG_FLC_RPC_8821C 0x06AC -+#define REG_FLC_RPCT_8821C 0x06AD -+#define REG_FLC_PTS_8821C 0x06AE -+#define REG_FLC_TRPC_8821C 0x06AF -+#define REG_RXPKTMON_CTRL_8821C 0x06B0 -+#define REG_STATE_MON_8821C 0x06B4 -+#define REG_ERROR_MON_8821C 0x06B8 -+#define REG_SEARCH_MACID_8821C 0x06BC -+#define REG_BT_COEX_TABLE_8821C 0x06C0 -+#define REG_BT_COEX_TABLE2_8821C 0x06C4 -+#define REG_BT_COEX_BREAK_TABLE_8821C 0x06C8 -+#define REG_BT_COEX_TABLE_H_8821C 0x06CC -+#define REG_RXCMD_0_8821C 0x06D0 -+#define REG_RXCMD_1_8821C 0x06D4 -+#define REG_WMAC_RESP_TXINFO_8821C 0x06D8 -+#define REG_BBPSF_CTRL_8821C 0x06DC -+#define REG_P2P_RX_BCN_NOA_8821C 0x06E0 -+#define REG_ASSOCIATED_BFMER0_INFO_8821C 0x06E4 -+#define REG_ASSOCIATED_BFMER0_INFO_H_8821C 0x06E8 -+#define REG_ASSOCIATED_BFMER1_INFO_8821C 0x06EC -+#define REG_ASSOCIATED_BFMER1_INFO_H_8821C 0x06F0 -+#define REG_TX_CSI_RPT_PARAM_BW20_8821C 0x06F4 -+#define REG_TX_CSI_RPT_PARAM_BW40_8821C 0x06F8 -+#define REG_BCN_PSR_RPT2_8821C 0x1600 -+#define REG_BCN_PSR_RPT3_8821C 0x1604 -+#define REG_BCN_PSR_RPT4_8821C 0x1608 -+#define REG_A1_ADDR_MASK_8821C 0x160C -+#define REG_MACID2_8821C 0x1620 -+#define REG_MACID2_H_8821C 0x1624 -+#define REG_BSSID2_8821C 0x1628 -+#define REG_BSSID2_H_8821C 0x162C -+#define REG_MACID3_8821C 0x1630 -+#define REG_MACID3_H_8821C 0x1634 -+#define REG_BSSID3_8821C 0x1638 -+#define REG_BSSID3_H_8821C 0x163C -+#define REG_MACID4_8821C 0x1640 -+#define REG_MACID4_H_8821C 0x1644 -+#define REG_BSSID4_8821C 0x1648 -+#define REG_BSSID4_H_8821C 0x164C -+#define REG_NOA_REPORT_8821C 0x1650 -+#define REG_NOA_REPORT_1_8821C 0x1654 -+#define REG_NOA_REPORT_2_8821C 0x1658 -+#define REG_NOA_REPORT_3_8821C 0x165C -+#define REG_PWRBIT_SETTING_8821C 0x1660 -+#define REG_MU_BF_OPTION_8821C 0x167C -+#define REG_WMAC_PAUSE_BB_CLR_TH_8821C 0x167D -+#define REG_WMAC_MU_ARB_8821C 0x167E -+#define REG_WMAC_MU_OPTION_8821C 0x167F -+#define REG_WMAC_MU_BF_CTL_8821C 0x1680 -+#define REG_WMAC_MU_BFRPT_PARA_8821C 0x1682 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE2_8821C 0x1684 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE3_8821C 0x1686 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE4_8821C 0x1688 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE5_8821C 0x168A -+#define REG_WMAC_ASSOCIATED_MU_BFMEE6_8821C 0x168C -+#define REG_WMAC_ASSOCIATED_MU_BFMEE7_8821C 0x168E -+#define REG_WMAC_BB_STOP_RX_COUNTER_8821C 0x1690 -+#define REG_WMAC_PLCP_MONITOR_8821C 0x1694 -+#define REG_WMAC_PLCP_MONITOR_MUTX_8821C 0x1698 -+#define REG_TRANSMIT_ADDRSS_0_8821C 0x16A0 -+#define REG_TRANSMIT_ADDRSS_0_H_8821C 0x16A4 -+#define REG_TRANSMIT_ADDRSS_1_8821C 0x16A8 -+#define REG_TRANSMIT_ADDRSS_1_H_8821C 0x16AC -+#define REG_TRANSMIT_ADDRSS_2_8821C 0x16B0 -+#define REG_TRANSMIT_ADDRSS_2_H_8821C 0x16B4 -+#define REG_TRANSMIT_ADDRSS_3_8821C 0x16B8 -+#define REG_TRANSMIT_ADDRSS_3_H_8821C 0x16BC -+#define REG_TRANSMIT_ADDRSS_4_8821C 0x16C0 -+#define REG_TRANSMIT_ADDRSS_4_H_8821C 0x16C4 -+#define REG_MACID1_8821C 0x0700 -+#define REG_MACID1_1_8821C 0x0704 -+#define REG_BSSID1_8821C 0x0708 -+#define REG_BSSID1_1_8821C 0x070C -+#define REG_BCN_PSR_RPT1_8821C 0x0710 -+#define REG_ASSOCIATED_BFMEE_SEL_8821C 0x0714 -+#define REG_SND_PTCL_CTRL_8821C 0x0718 -+#define REG_RX_CSI_RPT_INFO_8821C 0x071C -+#define REG_NS_ARP_CTRL_8821C 0x0720 -+#define REG_NS_ARP_INFO_8821C 0x0724 -+#define REG_BEAMFORMING_INFO_NSARP_V1_8821C 0x0728 -+#define REG_BEAMFORMING_INFO_NSARP_8821C 0x072C -+#define REG_IPV6_8821C 0x0730 -+#define REG_IPV6_1_8821C 0x0734 -+#define REG_IPV6_2_8821C 0x0738 -+#define REG_IPV6_3_8821C 0x073C -+#define REG_WMAC_RTX_CTX_SUBTYPE_CFG_8821C 0x0750 -+#define REG_WMAC_SWAES_CFG_8821C 0x0760 -+#define REG_BT_COEX_V2_8821C 0x0762 -+#define REG_BT_COEX_8821C 0x0764 -+#define REG_WLAN_ACT_MASK_CTRL_8821C 0x0768 -+#define REG_WLAN_ACT_MASK_CTRL_1_8821C 0x076C -+#define REG_BT_COEX_ENHANCED_INTR_CTRL_8821C 0x076E -+#define REG_BT_ACT_STATISTICS_8821C 0x0770 -+#define REG_BT_ACT_STATISTICS_1_8821C 0x0774 -+#define REG_BT_STATISTICS_CONTROL_REGISTER_8821C 0x0778 -+#define REG_BT_STATUS_REPORT_REGISTER_8821C 0x077C -+#define REG_BT_INTERRUPT_CONTROL_REGISTER_8821C 0x0780 -+#define REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8821C 0x0784 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8821C 0x0785 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_1_8821C 0x0788 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_2_8821C 0x078C -+#define REG_BT_INTERRUPT_STATUS_REGISTER_8821C 0x078F -+#define REG_BT_TDMA_TIME_REGISTER_8821C 0x0790 -+#define REG_BT_ACT_REGISTER_8821C 0x0794 -+#define REG_OBFF_CTRL_BASIC_8821C 0x0798 -+#define REG_OBFF_CTRL2_TIMER_8821C 0x079C -+#define REG_LTR_CTRL_BASIC_8821C 0x07A0 -+#define REG_LTR_CTRL2_TIMER_THRESHOLD_8821C 0x07A4 -+#define REG_LTR_IDLE_LATENCY_V1_8821C 0x07A8 -+#define REG_LTR_ACTIVE_LATENCY_V1_8821C 0x07AC -+#define REG_ANTENNA_TRAINING_CONTROL_REGISTER_8821C 0x07B0 -+#define REG_ANTENNA_TRAINING_CONTROL_REGISTER_1_8821C 0x07B4 -+#define REG_WMAC_PKTCNT_RWD_8821C 0x07B8 -+#define REG_WMAC_PKTCNT_CTRL_8821C 0x07BC -+#define REG_IQ_DUMP_8821C 0x07C0 -+#define REG_IQ_DUMP_1_8821C 0x07C4 -+#define REG_IQ_DUMP_2_8821C 0x07C8 -+#define REG_WMAC_FTM_CTL_8821C 0x07CC -+#define REG_WMAC_IQ_MDPK_FUNC_8821C 0x07CE -+#define REG_WMAC_OPTION_FUNCTION_8821C 0x07D0 -+#define REG_WMAC_OPTION_FUNCTION_1_8821C 0x07D4 -+#define REG_WMAC_OPTION_FUNCTION_2_8821C 0x07D8 -+#define REG_RX_FILTER_FUNCTION_8821C 0x07DA -+#define REG_NDP_SIG_8821C 0x07E0 -+#define REG_TXCMD_INFO_FOR_RSP_PKT_8821C 0x07E4 -+#define REG_TXCMD_INFO_FOR_RSP_PKT_1_8821C 0x07E8 -+#define REG_WSEC_OPTION_8821C 0x07EC -+#define REG_RTS_ADDRESS_0_8821C 0x07F0 -+#define REG_RTS_ADDRESS_0_1_8821C 0x07F4 -+#define REG_RTS_ADDRESS_1_8821C 0x07F8 -+#define REG_RTS_ADDRESS_1_1_8821C 0x07FC -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8821C 0x1700 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8821C 0x1704 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8821C 0x1708 -+#define REG_SDIO_TX_CTRL_8821C 0x10250000 -+#define REG_SDIO_HIMR_8821C 0x10250014 -+#define REG_SDIO_HISR_8821C 0x10250018 -+#define REG_SDIO_RX_REQ_LEN_8821C 0x1025001C -+#define REG_SDIO_FREE_TXPG_SEQ_V1_8821C 0x1025001F -+#define REG_SDIO_FREE_TXPG_8821C 0x10250020 -+#define REG_SDIO_FREE_TXPG2_8821C 0x10250024 -+#define REG_SDIO_OQT_FREE_TXPG_V1_8821C 0x10250028 -+#define REG_SDIO_HTSFR_INFO_8821C 0x10250030 -+#define REG_SDIO_HCPWM1_V2_8821C 0x10250038 -+#define REG_SDIO_HCPWM2_V2_8821C 0x1025003A -+#define REG_SDIO_INDIRECT_REG_CFG_8821C 0x10250040 -+#define REG_SDIO_INDIRECT_REG_DATA_8821C 0x10250044 -+#define REG_SDIO_H2C_8821C 0x10250060 -+#define REG_SDIO_C2H_8821C 0x10250064 -+#define REG_SDIO_HRPWM1_8821C 0x10250080 -+#define REG_SDIO_HRPWM2_8821C 0x10250082 -+#define REG_SDIO_HPS_CLKR_8821C 0x10250084 -+#define REG_SDIO_BUS_CTRL_8821C 0x10250085 -+#define REG_SDIO_HSUS_CTRL_8821C 0x10250086 -+#define REG_SDIO_RESPONSE_TIMER_8821C 0x10250088 -+#define REG_SDIO_CMD_CRC_8821C 0x1025008A -+#define REG_SDIO_HSISR_8821C 0x10250090 -+#define REG_SDIO_ERR_RPT_8821C 0x102500C0 -+#define REG_SDIO_CMD_ERRCNT_8821C 0x102500C2 -+#define REG_SDIO_DATA_ERRCNT_8821C 0x102500C3 -+#define REG_SDIO_CMD_ERR_CONTENT_8821C 0x102500C4 -+#define REG_SDIO_CRC_ERR_IDX_8821C 0x102500C9 -+#define REG_SDIO_DATA_CRC_8821C 0x102500CA -+#define REG_SDIO_DATA_REPLY_TIME_8821C 0x102500CB -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8822b.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8822b.h -new file mode 100644 -index 000000000..4aea8ffb2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8822b.h -@@ -0,0 +1,734 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_REG_8822B_H -+#define __INC_HALMAC_REG_8822B_H -+ -+#define REG_SYS_ISO_CTRL_8822B 0x0000 -+#define REG_SYS_FUNC_EN_8822B 0x0002 -+#define REG_SYS_PW_CTRL_8822B 0x0004 -+#define REG_SYS_CLK_CTRL_8822B 0x0008 -+#define REG_SYS_EEPROM_CTRL_8822B 0x000A -+#define REG_EE_VPD_8822B 0x000C -+#define REG_SYS_SWR_CTRL1_8822B 0x0010 -+#define REG_SYS_SWR_CTRL2_8822B 0x0014 -+#define REG_SYS_SWR_CTRL3_8822B 0x0018 -+#define REG_RSV_CTRL_8822B 0x001C -+#define REG_RF_CTRL_8822B 0x001F -+#define REG_AFE_LDO_CTRL_8822B 0x0020 -+#define REG_AFE_CTRL1_8822B 0x0024 -+#define REG_AFE_CTRL2_8822B 0x0028 -+#define REG_AFE_CTRL3_8822B 0x002C -+#define REG_EFUSE_CTRL_8822B 0x0030 -+#define REG_LDO_EFUSE_CTRL_8822B 0x0034 -+#define REG_PWR_OPTION_CTRL_8822B 0x0038 -+#define REG_CAL_TIMER_8822B 0x003C -+#define REG_ACLK_MON_8822B 0x003E -+#define REG_GPIO_MUXCFG_8822B 0x0040 -+#define REG_GPIO_PIN_CTRL_8822B 0x0044 -+#define REG_GPIO_INTM_8822B 0x0048 -+#define REG_LED_CFG_8822B 0x004C -+#define REG_FSIMR_8822B 0x0050 -+#define REG_FSISR_8822B 0x0054 -+#define REG_HSIMR_8822B 0x0058 -+#define REG_HSISR_8822B 0x005C -+#define REG_GPIO_EXT_CTRL_8822B 0x0060 -+#define REG_PAD_CTRL1_8822B 0x0064 -+#define REG_WL_BT_PWR_CTRL_8822B 0x0068 -+#define REG_SDM_DEBUG_8822B 0x006C -+#define REG_SYS_SDIO_CTRL_8822B 0x0070 -+#define REG_HCI_OPT_CTRL_8822B 0x0074 -+#define REG_AFE_CTRL4_8822B 0x0078 -+#define REG_LDO_SWR_CTRL_8822B 0x007C -+#define REG_MCUFW_CTRL_8822B 0x0080 -+#define REG_MCU_TST_CFG_8822B 0x0084 -+#define REG_HMEBOX_E0_E1_8822B 0x0088 -+#define REG_HMEBOX_E2_E3_8822B 0x008C -+#define REG_WLLPS_CTRL_8822B 0x0090 -+#define REG_AFE_CTRL5_8822B 0x0094 -+#define REG_GPIO_DEBOUNCE_CTRL_8822B 0x0098 -+#define REG_RPWM2_8822B 0x009C -+#define REG_SYSON_FSM_MON_8822B 0x00A0 -+#define REG_AFE_CTRL6_8822B 0x00A4 -+#define REG_PMC_DBG_CTRL1_8822B 0x00A8 -+#define REG_AFE_CTRL7_8822B 0x00AC -+#define REG_HIMR0_8822B 0x00B0 -+#define REG_HISR0_8822B 0x00B4 -+#define REG_HIMR1_8822B 0x00B8 -+#define REG_HISR1_8822B 0x00BC -+#define REG_DBG_PORT_SEL_8822B 0x00C0 -+#define REG_PAD_CTRL2_8822B 0x00C4 -+#define REG_PMC_DBG_CTRL2_8822B 0x00CC -+#define REG_BIST_CTRL_8822B 0x00D0 -+#define REG_BIST_RPT_8822B 0x00D4 -+#define REG_MEM_CTRL_8822B 0x00D8 -+#define REG_AFE_CTRL8_8822B 0x00DC -+#define REG_USB_SIE_INTF_8822B 0x00E0 -+#define REG_PCIE_MIO_INTF_8822B 0x00E4 -+#define REG_PCIE_MIO_INTD_8822B 0x00E8 -+#define REG_WLRF1_8822B 0x00EC -+#define REG_SYS_CFG1_8822B 0x00F0 -+#define REG_SYS_STATUS1_8822B 0x00F4 -+#define REG_SYS_STATUS2_8822B 0x00F8 -+#define REG_SYS_CFG2_8822B 0x00FC -+#define REG_SYS_CFG3_8822B 0x1000 -+#define REG_SYS_CFG4_8822B 0x1034 -+#define REG_SYS_CFG5_8822B 0x1070 -+#define REG_CPU_DMEM_CON_8822B 0x1080 -+#define REG_BOOT_REASON_8822B 0x1088 -+#define REG_NFCPAD_CTRL_8822B 0x10A8 -+#define REG_HIMR2_8822B 0x10B0 -+#define REG_HISR2_8822B 0x10B4 -+#define REG_HIMR3_8822B 0x10B8 -+#define REG_HISR3_8822B 0x10BC -+#define REG_SW_MDIO_8822B 0x10C0 -+#define REG_SW_FLUSH_8822B 0x10C4 -+#define REG_H2C_PKT_READADDR_8822B 0x10D0 -+#define REG_H2C_PKT_WRITEADDR_8822B 0x10D4 -+#define REG_MEM_PWR_CRTL_8822B 0x10D8 -+#define REG_FW_DBG0_8822B 0x10E0 -+#define REG_FW_DBG1_8822B 0x10E4 -+#define REG_FW_DBG2_8822B 0x10E8 -+#define REG_FW_DBG3_8822B 0x10EC -+#define REG_FW_DBG4_8822B 0x10F0 -+#define REG_FW_DBG5_8822B 0x10F4 -+#define REG_FW_DBG6_8822B 0x10F8 -+#define REG_FW_DBG7_8822B 0x10FC -+#define REG_CR_8822B 0x0100 -+#define REG_TSF_CLK_STATE_8822B 0x0108 -+#define REG_TXDMA_PQ_MAP_8822B 0x010C -+#define REG_TRXFF_BNDY_8822B 0x0114 -+#define REG_PTA_I2C_MBOX_8822B 0x0118 -+#define REG_RXFF_BNDY_8822B 0x011C -+#define REG_FE1IMR_8822B 0x0120 -+#define REG_FE1ISR_8822B 0x0124 -+#define REG_CPWM_8822B 0x012C -+#define REG_FWIMR_8822B 0x0130 -+#define REG_FWISR_8822B 0x0134 -+#define REG_FTIMR_8822B 0x0138 -+#define REG_FTISR_8822B 0x013C -+#define REG_PKTBUF_DBG_CTRL_8822B 0x0140 -+#define REG_PKTBUF_DBG_DATA_L_8822B 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8822B 0x0148 -+#define REG_CPWM2_8822B 0x014C -+#define REG_TC0_CTRL_8822B 0x0150 -+#define REG_TC1_CTRL_8822B 0x0154 -+#define REG_TC2_CTRL_8822B 0x0158 -+#define REG_TC3_CTRL_8822B 0x015C -+#define REG_TC4_CTRL_8822B 0x0160 -+#define REG_TCUNIT_BASE_8822B 0x0164 -+#define REG_TC5_CTRL_8822B 0x0168 -+#define REG_TC6_CTRL_8822B 0x016C -+#define REG_MBIST_FAIL_8822B 0x0170 -+#define REG_MBIST_START_PAUSE_8822B 0x0174 -+#define REG_MBIST_DONE_8822B 0x0178 -+#define REG_MBIST_FAIL_NRML_8822B 0x017C -+#define REG_AES_DECRPT_DATA_8822B 0x0180 -+#define REG_AES_DECRPT_CFG_8822B 0x0184 -+#define REG_TMETER_8822B 0x0190 -+#define REG_OSC_32K_CTRL_8822B 0x0194 -+#define REG_32K_CAL_REG1_8822B 0x0198 -+#define REG_C2HEVT_8822B 0x01A0 -+#define REG_C2HEVT_1_8822B 0x01A4 -+#define REG_C2HEVT_2_8822B 0x01A8 -+#define REG_C2HEVT_3_8822B 0x01AC -+#define REG_SW_DEFINED_PAGE1_8822B 0x01B8 -+#define REG_MCUTST_I_8822B 0x01C0 -+#define REG_MCUTST_II_8822B 0x01C4 -+#define REG_FMETHR_8822B 0x01C8 -+#define REG_HMETFR_8822B 0x01CC -+#define REG_HMEBOX0_8822B 0x01D0 -+#define REG_HMEBOX1_8822B 0x01D4 -+#define REG_HMEBOX2_8822B 0x01D8 -+#define REG_HMEBOX3_8822B 0x01DC -+#define REG_LLT_INIT_8822B 0x01E0 -+#define REG_LLT_INIT_ADDR_8822B 0x01E4 -+#define REG_BB_ACCESS_CTRL_8822B 0x01E8 -+#define REG_BB_ACCESS_DATA_8822B 0x01EC -+#define REG_HMEBOX_E0_8822B 0x01F0 -+#define REG_HMEBOX_E1_8822B 0x01F4 -+#define REG_HMEBOX_E2_8822B 0x01F8 -+#define REG_HMEBOX_E3_8822B 0x01FC -+#define REG_CR_EXT_8822B 0x1100 -+#define REG_FWFF_8822B 0x1114 -+#define REG_RXFF_PTR_V1_8822B 0x1118 -+#define REG_RXFF_WTR_V1_8822B 0x111C -+#define REG_FE2IMR_8822B 0x1120 -+#define REG_FE2ISR_8822B 0x1124 -+#define REG_FE3IMR_8822B 0x1128 -+#define REG_FE3ISR_8822B 0x112C -+#define REG_FE4IMR_8822B 0x1130 -+#define REG_FE4ISR_8822B 0x1134 -+#define REG_FT1IMR_8822B 0x1138 -+#define REG_FT1ISR_8822B 0x113C -+#define REG_SPWR0_8822B 0x1140 -+#define REG_SPWR1_8822B 0x1144 -+#define REG_SPWR2_8822B 0x1148 -+#define REG_SPWR3_8822B 0x114C -+#define REG_POWSEQ_8822B 0x1150 -+#define REG_TC7_CTRL_V1_8822B 0x1158 -+#define REG_TC8_CTRL_V1_8822B 0x115C -+#define REG_FT2IMR_8822B 0x11E0 -+#define REG_FT2ISR_8822B 0x11E4 -+#define REG_MSG2_8822B 0x11F0 -+#define REG_MSG3_8822B 0x11F4 -+#define REG_MSG4_8822B 0x11F8 -+#define REG_MSG5_8822B 0x11FC -+#define REG_FIFOPAGE_CTRL_1_8822B 0x0200 -+#define REG_FIFOPAGE_CTRL_2_8822B 0x0204 -+#define REG_AUTO_LLT_V1_8822B 0x0208 -+#define REG_TXDMA_OFFSET_CHK_8822B 0x020C -+#define REG_TXDMA_STATUS_8822B 0x0210 -+#define REG_TX_DMA_DBG_8822B 0x0214 -+#define REG_TQPNT1_8822B 0x0218 -+#define REG_TQPNT2_8822B 0x021C -+#define REG_TQPNT3_8822B 0x0220 -+#define REG_TQPNT4_8822B 0x0224 -+#define REG_RQPN_CTRL_1_8822B 0x0228 -+#define REG_RQPN_CTRL_2_8822B 0x022C -+#define REG_FIFOPAGE_INFO_1_8822B 0x0230 -+#define REG_FIFOPAGE_INFO_2_8822B 0x0234 -+#define REG_FIFOPAGE_INFO_3_8822B 0x0238 -+#define REG_FIFOPAGE_INFO_4_8822B 0x023C -+#define REG_FIFOPAGE_INFO_5_8822B 0x0240 -+#define REG_H2C_HEAD_8822B 0x0244 -+#define REG_H2C_TAIL_8822B 0x0248 -+#define REG_H2C_READ_ADDR_8822B 0x024C -+#define REG_H2C_WR_ADDR_8822B 0x0250 -+#define REG_H2C_INFO_8822B 0x0254 -+#define REG_RXDMA_AGG_PG_TH_8822B 0x0280 -+#define REG_RXPKT_NUM_8822B 0x0284 -+#define REG_RXDMA_STATUS_8822B 0x0288 -+#define REG_RXDMA_DPR_8822B 0x028C -+#define REG_RXDMA_MODE_8822B 0x0290 -+#define REG_C2H_PKT_8822B 0x0294 -+#define REG_FWFF_C2H_8822B 0x0298 -+#define REG_FWFF_CTRL_8822B 0x029C -+#define REG_FWFF_PKT_INFO_8822B 0x02A0 -+#define REG_DDMA_CH0SA_8822B 0x1200 -+#define REG_DDMA_CH0DA_8822B 0x1204 -+#define REG_DDMA_CH0CTRL_8822B 0x1208 -+#define REG_DDMA_CH1SA_8822B 0x1210 -+#define REG_DDMA_CH1DA_8822B 0x1214 -+#define REG_DDMA_CH1CTRL_8822B 0x1218 -+#define REG_DDMA_CH2SA_8822B 0x1220 -+#define REG_DDMA_CH2DA_8822B 0x1224 -+#define REG_DDMA_CH2CTRL_8822B 0x1228 -+#define REG_DDMA_CH3SA_8822B 0x1230 -+#define REG_DDMA_CH3DA_8822B 0x1234 -+#define REG_DDMA_CH3CTRL_8822B 0x1238 -+#define REG_DDMA_CH4SA_8822B 0x1240 -+#define REG_DDMA_CH4DA_8822B 0x1244 -+#define REG_DDMA_CH4CTRL_8822B 0x1248 -+#define REG_DDMA_CH5SA_8822B 0x1250 -+#define REG_DDMA_CH5DA_8822B 0x1254 -+#define REG_REG_DDMA_CH5CTRL_8822B 0x1258 -+#define REG_DDMA_INT_MSK_8822B 0x12E0 -+#define REG_DDMA_CHSTATUS_8822B 0x12E8 -+#define REG_DDMA_CHKSUM_8822B 0x12F0 -+#define REG_DDMA_MONITOR_8822B 0x12FC -+#define REG_PCIE_CTRL_8822B 0x0300 -+#define REG_INT_MIG_8822B 0x0304 -+#define REG_BCNQ_TXBD_DESA_8822B 0x0308 -+#define REG_MGQ_TXBD_DESA_8822B 0x0310 -+#define REG_VOQ_TXBD_DESA_8822B 0x0318 -+#define REG_VIQ_TXBD_DESA_8822B 0x0320 -+#define REG_BEQ_TXBD_DESA_8822B 0x0328 -+#define REG_BKQ_TXBD_DESA_8822B 0x0330 -+#define REG_RXQ_RXBD_DESA_8822B 0x0338 -+#define REG_HI0Q_TXBD_DESA_8822B 0x0340 -+#define REG_HI1Q_TXBD_DESA_8822B 0x0348 -+#define REG_HI2Q_TXBD_DESA_8822B 0x0350 -+#define REG_HI3Q_TXBD_DESA_8822B 0x0358 -+#define REG_HI4Q_TXBD_DESA_8822B 0x0360 -+#define REG_HI5Q_TXBD_DESA_8822B 0x0368 -+#define REG_HI6Q_TXBD_DESA_8822B 0x0370 -+#define REG_HI7Q_TXBD_DESA_8822B 0x0378 -+#define REG_MGQ_TXBD_NUM_8822B 0x0380 -+#define REG_RX_RXBD_NUM_8822B 0x0382 -+#define REG_VOQ_TXBD_NUM_8822B 0x0384 -+#define REG_VIQ_TXBD_NUM_8822B 0x0386 -+#define REG_BEQ_TXBD_NUM_8822B 0x0388 -+#define REG_BKQ_TXBD_NUM_8822B 0x038A -+#define REG_HI0Q_TXBD_NUM_8822B 0x038C -+#define REG_HI1Q_TXBD_NUM_8822B 0x038E -+#define REG_HI2Q_TXBD_NUM_8822B 0x0390 -+#define REG_HI3Q_TXBD_NUM_8822B 0x0392 -+#define REG_HI4Q_TXBD_NUM_8822B 0x0394 -+#define REG_HI5Q_TXBD_NUM_8822B 0x0396 -+#define REG_HI6Q_TXBD_NUM_8822B 0x0398 -+#define REG_HI7Q_TXBD_NUM_8822B 0x039A -+#define REG_TSFTIMER_HCI_8822B 0x039C -+#define REG_BD_RWPTR_CLR_8822B 0x039C -+#define REG_VOQ_TXBD_IDX_8822B 0x03A0 -+#define REG_VIQ_TXBD_IDX_8822B 0x03A4 -+#define REG_BEQ_TXBD_IDX_8822B 0x03A8 -+#define REG_BKQ_TXBD_IDX_8822B 0x03AC -+#define REG_MGQ_TXBD_IDX_8822B 0x03B0 -+#define REG_RXQ_RXBD_IDX_8822B 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8822B 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8822B 0x03BC -+#define REG_HI2Q_TXBD_IDX_8822B 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8822B 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8822B 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8822B 0x03CC -+#define REG_HI6Q_TXBD_IDX_8822B 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8822B 0x03D4 -+#define REG_DBG_SEL_V1_8822B 0x03D8 -+#define REG_PCIE_HRPWM1_V1_8822B 0x03D9 -+#define REG_PCIE_HCPWM1_V1_8822B 0x03DA -+#define REG_PCIE_CTRL2_8822B 0x03DB -+#define REG_PCIE_HRPWM2_V1_8822B 0x03DC -+#define REG_PCIE_HCPWM2_V1_8822B 0x03DE -+#define REG_PCIE_H2C_MSG_V1_8822B 0x03E0 -+#define REG_PCIE_C2H_MSG_V1_8822B 0x03E4 -+#define REG_DBI_WDATA_V1_8822B 0x03E8 -+#define REG_DBI_RDATA_V1_8822B 0x03EC -+#define REG_DBI_FLAG_V1_8822B 0x03F0 -+#define REG_MDIO_V1_8822B 0x03F4 -+#define REG_PCIE_MIX_CFG_8822B 0x03F8 -+#define REG_HCI_MIX_CFG_8822B 0x03FC -+#define REG_STC_INT_CS_8822B 0x1300 -+#define REG_ST_INT_CFG_8822B 0x1304 -+#define REG_CMU_DLY_CTRL_8822B 0x1310 -+#define REG_CMU_DLY_CFG_8822B 0x1314 -+#define REG_H2CQ_TXBD_DESA_8822B 0x1320 -+#define REG_H2CQ_TXBD_NUM_8822B 0x1328 -+#define REG_H2CQ_TXBD_IDX_8822B 0x132C -+#define REG_H2CQ_CSR_8822B 0x1330 -+#define REG_CHANGE_PCIE_SPEED_8822B 0x1350 -+#define REG_OLD_DEHANG_8822B 0x13F4 -+#define REG_Q0_INFO_8822B 0x0400 -+#define REG_Q1_INFO_8822B 0x0404 -+#define REG_Q2_INFO_8822B 0x0408 -+#define REG_Q3_INFO_8822B 0x040C -+#define REG_MGQ_INFO_8822B 0x0410 -+#define REG_HIQ_INFO_8822B 0x0414 -+#define REG_BCNQ_INFO_8822B 0x0418 -+#define REG_TXPKT_EMPTY_8822B 0x041A -+#define REG_CPU_MGQ_INFO_8822B 0x041C -+#define REG_FWHW_TXQ_CTRL_8822B 0x0420 -+#define REG_DATAFB_SEL_8822B 0x0423 -+#define REG_BCNQ_BDNY_V1_8822B 0x0424 -+#define REG_LIFETIME_EN_8822B 0x0426 -+#define REG_SPEC_SIFS_8822B 0x0428 -+#define REG_RETRY_LIMIT_8822B 0x042A -+#define REG_TXBF_CTRL_8822B 0x042C -+#define REG_DARFRC_8822B 0x0430 -+#define REG_RARFRC_8822B 0x0438 -+#define REG_RRSR_8822B 0x0440 -+#define REG_ARFR0_8822B 0x0444 -+#define REG_ARFR1_V1_8822B 0x044C -+#define REG_CCK_CHECK_8822B 0x0454 -+#define REG_AMPDU_MAX_TIME_V1_8822B 0x0455 -+#define REG_BCNQ1_BDNY_V1_8822B 0x0456 -+#define REG_AMPDU_MAX_LENGTH_8822B 0x0458 -+#define REG_ACQ_STOP_8822B 0x045C -+#define REG_NDPA_RATE_8822B 0x045D -+#define REG_TX_HANG_CTRL_8822B 0x045E -+#define REG_NDPA_OPT_CTRL_8822B 0x045F -+#define REG_RD_RESP_PKT_TH_8822B 0x0463 -+#define REG_CMDQ_INFO_8822B 0x0464 -+#define REG_Q4_INFO_8822B 0x0468 -+#define REG_Q5_INFO_8822B 0x046C -+#define REG_Q6_INFO_8822B 0x0470 -+#define REG_Q7_INFO_8822B 0x0474 -+#define REG_WMAC_LBK_BUF_HD_V1_8822B 0x0478 -+#define REG_MGQ_BDNY_V1_8822B 0x047A -+#define REG_TXRPT_CTRL_8822B 0x047C -+#define REG_INIRTS_RATE_SEL_8822B 0x0480 -+#define REG_BASIC_CFEND_RATE_8822B 0x0481 -+#define REG_STBC_CFEND_RATE_8822B 0x0482 -+#define REG_DATA_SC_8822B 0x0483 -+#define REG_MACID_SLEEP3_8822B 0x0484 -+#define REG_MACID_SLEEP1_8822B 0x0488 -+#define REG_ARFR2_V1_8822B 0x048C -+#define REG_ARFR3_V1_8822B 0x0494 -+#define REG_ARFR4_8822B 0x049C -+#define REG_ARFR5_8822B 0x04A4 -+#define REG_TXRPT_START_OFFSET_8822B 0x04AC -+#define REG_POWER_STAGE1_8822B 0x04B4 -+#define REG_POWER_STAGE2_8822B 0x04B8 -+#define REG_SW_AMPDU_BURST_MODE_CTRL_8822B 0x04BC -+#define REG_PKT_LIFE_TIME_8822B 0x04C0 -+#define REG_STBC_SETTING_8822B 0x04C4 -+#define REG_STBC_SETTING2_8822B 0x04C5 -+#define REG_QUEUE_CTRL_8822B 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL_8822B 0x04C7 -+#define REG_PROT_MODE_CTRL_8822B 0x04C8 -+#define REG_BAR_MODE_CTRL_8822B 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8822B 0x04CF -+#define REG_MACID_SLEEP2_8822B 0x04D0 -+#define REG_MACID_SLEEP_8822B 0x04D4 -+#define REG_HW_SEQ0_8822B 0x04D8 -+#define REG_HW_SEQ1_8822B 0x04DA -+#define REG_HW_SEQ2_8822B 0x04DC -+#define REG_HW_SEQ3_8822B 0x04DE -+#define REG_NULL_PKT_STATUS_V1_8822B 0x04E0 -+#define REG_PTCL_ERR_STATUS_8822B 0x04E2 -+#define REG_NULL_PKT_STATUS_EXTEND_8822B 0x04E3 -+#define REG_VIDEO_ENHANCEMENT_FUN_8822B 0x04E4 -+#define REG_BT_POLLUTE_PKT_CNT_8822B 0x04E8 -+#define REG_PTCL_DBG_8822B 0x04EC -+#define REG_CPUMGQ_TIMER_CTRL2_8822B 0x04F4 -+#define REG_DUMMY_PAGE4_V1_8822B 0x04FC -+#define REG_MOREDATA_8822B 0x04FE -+#define REG_Q0_Q1_INFO_8822B 0x1400 -+#define REG_Q2_Q3_INFO_8822B 0x1404 -+#define REG_Q4_Q5_INFO_8822B 0x1408 -+#define REG_Q6_Q7_INFO_8822B 0x140C -+#define REG_MGQ_HIQ_INFO_8822B 0x1410 -+#define REG_CMDQ_BCNQ_INFO_8822B 0x1414 -+#define REG_USEREG_SETTING_8822B 0x1420 -+#define REG_AESIV_SETTING_8822B 0x1424 -+#define REG_BF0_TIME_SETTING_8822B 0x1428 -+#define REG_BF1_TIME_SETTING_8822B 0x142C -+#define REG_BF_TIMEOUT_EN_8822B 0x1430 -+#define REG_MACID_RELEASE0_8822B 0x1434 -+#define REG_MACID_RELEASE1_8822B 0x1438 -+#define REG_MACID_RELEASE2_8822B 0x143C -+#define REG_MACID_RELEASE3_8822B 0x1440 -+#define REG_MACID_RELEASE_SETTING_8822B 0x1444 -+#define REG_FAST_EDCA_VOVI_SETTING_8822B 0x1448 -+#define REG_FAST_EDCA_BEBK_SETTING_8822B 0x144C -+#define REG_MACID_DROP0_8822B 0x1450 -+#define REG_MACID_DROP1_8822B 0x1454 -+#define REG_MACID_DROP2_8822B 0x1458 -+#define REG_MACID_DROP3_8822B 0x145C -+#define REG_R_MACID_RELEASE_SUCCESS_0_8822B 0x1460 -+#define REG_R_MACID_RELEASE_SUCCESS_1_8822B 0x1464 -+#define REG_R_MACID_RELEASE_SUCCESS_2_8822B 0x1468 -+#define REG_R_MACID_RELEASE_SUCCESS_3_8822B 0x146C -+#define REG_MGG_FIFO_CRTL_8822B 0x1470 -+#define REG_MGG_FIFO_INT_8822B 0x1474 -+#define REG_MGG_FIFO_LIFETIME_8822B 0x1478 -+#define REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822B 0x147C -+#define REG_SHCUT_SETTING_8822B 0x1480 -+#define REG_SHCUT_LLC_ETH_TYPE0_8822B 0x1484 -+#define REG_SHCUT_LLC_ETH_TYPE1_8822B 0x1488 -+#define REG_SHCUT_LLC_OUI0_8822B 0x148C -+#define REG_SHCUT_LLC_OUI1_8822B 0x1490 -+#define REG_SHCUT_LLC_OUI2_8822B 0x1494 -+#define REG_SHCUT_LLC_OUI3_8822B 0x1498 -+#define REG_MU_TX_CTL_8822B 0x14C0 -+#define REG_MU_TX_CTL_8822B 0x14C0 -+#define REG_MU_STA_GID_VLD_8822B 0x14C4 -+#define REG_MU_STA_GID_VLD_8822B 0x14C4 -+#define REG_MU_STA_USER_POS_INFO_8822B 0x14C8 -+#define REG_MU_STA_USER_POS_INFO_8822B 0x14C8 -+#define REG_MU_TRX_DBG_CNT_8822B 0x14D0 -+#define REG_MU_TRX_DBG_CNT_8822B 0x14D0 -+#define REG_EDCA_VO_PARAM_8822B 0x0500 -+#define REG_EDCA_VI_PARAM_8822B 0x0504 -+#define REG_EDCA_BE_PARAM_8822B 0x0508 -+#define REG_EDCA_BK_PARAM_8822B 0x050C -+#define REG_BCNTCFG_8822B 0x0510 -+#define REG_PIFS_8822B 0x0512 -+#define REG_RDG_PIFS_8822B 0x0513 -+#define REG_SIFS_8822B 0x0514 -+#define REG_TSFTR_SYN_OFFSET_8822B 0x0518 -+#define REG_AGGR_BREAK_TIME_8822B 0x051A -+#define REG_SLOT_8822B 0x051B -+#define REG_TX_PTCL_CTRL_8822B 0x0520 -+#define REG_TXPAUSE_8822B 0x0522 -+#define REG_DIS_TXREQ_CLR_8822B 0x0523 -+#define REG_RD_CTRL_8822B 0x0524 -+#define REG_MBSSID_CTRL_8822B 0x0526 -+#define REG_P2PPS_CTRL_8822B 0x0527 -+#define REG_PKT_LIFETIME_CTRL_8822B 0x0528 -+#define REG_P2PPS_SPEC_STATE_8822B 0x052B -+#define REG_TXOP_LIMIT_CTRL_8822B 0x052C -+#define REG_BAR_TX_CTRL_8822B 0x0530 -+#define REG_P2PON_DIS_TXTIME_8822B 0x0531 -+#define REG_QUEUE_INCOL_THR_8822B 0x0538 -+#define REG_QUEUE_INCOL_EN_8822B 0x053C -+#define REG_TBTT_PROHIBIT_8822B 0x0540 -+#define REG_P2PPS_STATE_8822B 0x0543 -+#define REG_RD_NAV_NXT_8822B 0x0544 -+#define REG_NAV_PROT_LEN_8822B 0x0546 -+#define REG_BCN_CTRL_8822B 0x0550 -+#define REG_BCN_CTRL_CLINT0_8822B 0x0551 -+#define REG_MBID_NUM_8822B 0x0552 -+#define REG_DUAL_TSF_RST_8822B 0x0553 -+#define REG_MBSSID_BCN_SPACE_8822B 0x0554 -+#define REG_DRVERLYINT_8822B 0x0558 -+#define REG_BCNDMATIM_8822B 0x0559 -+#define REG_ATIMWND_8822B 0x055A -+#define REG_USTIME_TSF_8822B 0x055C -+#define REG_BCN_MAX_ERR_8822B 0x055D -+#define REG_RXTSF_OFFSET_CCK_8822B 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8822B 0x055F -+#define REG_TSFTR_8822B 0x0560 -+#define REG_FREERUN_CNT_8822B 0x0568 -+#define REG_ATIMWND1_V1_8822B 0x0570 -+#define REG_TBTT_PROHIBIT_INFRA_8822B 0x0571 -+#define REG_CTWND_8822B 0x0572 -+#define REG_BCNIVLCUNT_8822B 0x0573 -+#define REG_BCNDROPCTRL_8822B 0x0574 -+#define REG_HGQ_TIMEOUT_PERIOD_8822B 0x0575 -+#define REG_TXCMD_TIMEOUT_PERIOD_8822B 0x0576 -+#define REG_MISC_CTRL_8822B 0x0577 -+#define REG_BCN_CTRL_CLINT1_8822B 0x0578 -+#define REG_BCN_CTRL_CLINT2_8822B 0x0579 -+#define REG_BCN_CTRL_CLINT3_8822B 0x057A -+#define REG_EXTEND_CTRL_8822B 0x057B -+#define REG_P2PPS1_SPEC_STATE_8822B 0x057C -+#define REG_P2PPS1_STATE_8822B 0x057D -+#define REG_P2PPS2_SPEC_STATE_8822B 0x057E -+#define REG_P2PPS2_STATE_8822B 0x057F -+#define REG_PS_TIMER0_8822B 0x0580 -+#define REG_PS_TIMER1_8822B 0x0584 -+#define REG_PS_TIMER2_8822B 0x0588 -+#define REG_TBTT_CTN_AREA_8822B 0x058C -+#define REG_FORCE_BCN_IFS_8822B 0x058E -+#define REG_TXOP_MIN_8822B 0x0590 -+#define REG_PRE_BKF_TIME_8822B 0x0592 -+#define REG_CROSS_TXOP_CTRL_8822B 0x0593 -+#define REG_ATIMWND2_8822B 0x05A0 -+#define REG_ATIMWND3_8822B 0x05A1 -+#define REG_ATIMWND4_8822B 0x05A2 -+#define REG_ATIMWND5_8822B 0x05A3 -+#define REG_ATIMWND6_8822B 0x05A4 -+#define REG_ATIMWND7_8822B 0x05A5 -+#define REG_ATIMUGT_8822B 0x05A6 -+#define REG_HIQ_NO_LMT_EN_8822B 0x05A7 -+#define REG_DTIM_COUNTER_ROOT_8822B 0x05A8 -+#define REG_DTIM_COUNTER_VAP1_8822B 0x05A9 -+#define REG_DTIM_COUNTER_VAP2_8822B 0x05AA -+#define REG_DTIM_COUNTER_VAP3_8822B 0x05AB -+#define REG_DTIM_COUNTER_VAP4_8822B 0x05AC -+#define REG_DTIM_COUNTER_VAP5_8822B 0x05AD -+#define REG_DTIM_COUNTER_VAP6_8822B 0x05AE -+#define REG_DTIM_COUNTER_VAP7_8822B 0x05AF -+#define REG_DIS_ATIM_8822B 0x05B0 -+#define REG_EARLY_128US_8822B 0x05B1 -+#define REG_P2PPS1_CTRL_8822B 0x05B2 -+#define REG_P2PPS2_CTRL_8822B 0x05B3 -+#define REG_TIMER0_SRC_SEL_8822B 0x05B4 -+#define REG_NOA_UNIT_SEL_8822B 0x05B5 -+#define REG_P2POFF_DIS_TXTIME_8822B 0x05B7 -+#define REG_MBSSID_BCN_SPACE2_8822B 0x05B8 -+#define REG_MBSSID_BCN_SPACE3_8822B 0x05BC -+#define REG_ACMHWCTRL_8822B 0x05C0 -+#define REG_ACMRSTCTRL_8822B 0x05C1 -+#define REG_ACMAVG_8822B 0x05C2 -+#define REG_VO_ADMTIME_8822B 0x05C4 -+#define REG_VI_ADMTIME_8822B 0x05C6 -+#define REG_BE_ADMTIME_8822B 0x05C8 -+#define REG_EDCA_RANDOM_GEN_8822B 0x05CC -+#define REG_TXCMD_NOA_SEL_8822B 0x05CF -+#define REG_NOA_PARAM_8822B 0x05E0 -+#define REG_P2P_RST_8822B 0x05F0 -+#define REG_SCHEDULER_RST_8822B 0x05F1 -+#define REG_SCH_TXCMD_8822B 0x05F8 -+#define REG_PAGE5_DUMMY_8822B 0x05FC -+#define REG_CPUMGQ_TX_TIMER_8822B 0x1500 -+#define REG_PS_TIMER_A_8822B 0x1504 -+#define REG_PS_TIMER_B_8822B 0x1508 -+#define REG_PS_TIMER_C_8822B 0x150C -+#define REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL_8822B 0x1510 -+#define REG_CPUMGQ_TX_TIMER_EARLY_8822B 0x1514 -+#define REG_PS_TIMER_A_EARLY_8822B 0x1515 -+#define REG_PS_TIMER_B_EARLY_8822B 0x1516 -+#define REG_PS_TIMER_C_EARLY_8822B 0x1517 -+#define REG_CPUMGQ_PARAMETER_8822B 0x1518 -+#define REG_WMAC_CR_8822B 0x0600 -+#define REG_WMAC_FWPKT_CR_8822B 0x0601 -+#define REG_BWOPMODE_8822B 0x0603 -+#define REG_TCR_8822B 0x0604 -+#define REG_RCR_8822B 0x0608 -+#define REG_RX_PKT_LIMIT_8822B 0x060C -+#define REG_RX_DLK_TIME_8822B 0x060D -+#define REG_RX_DRVINFO_SZ_8822B 0x060F -+#define REG_MACID_8822B 0x0610 -+#define REG_BSSID_8822B 0x0618 -+#define REG_MAR_8822B 0x0620 -+#define REG_MBIDCAMCFG_1_8822B 0x0628 -+#define REG_MBIDCAMCFG_2_8822B 0x062C -+#define REG_WMAC_TCR_TSFT_OFS_8822B 0x0630 -+#define REG_UDF_THSD_8822B 0x0632 -+#define REG_ZLD_NUM_8822B 0x0633 -+#define REG_STMP_THSD_8822B 0x0634 -+#define REG_WMAC_TXTIMEOUT_8822B 0x0635 -+#define REG_MCU_TEST_2_V1_8822B 0x0636 -+#define REG_USTIME_EDCA_8822B 0x0638 -+#define REG_MAC_SPEC_SIFS_8822B 0x063A -+#define REG_RESP_SIFS_CCK_8822B 0x063C -+#define REG_RESP_SIFS_OFDM_8822B 0x063E -+#define REG_ACKTO_8822B 0x0640 -+#define REG_CTS2TO_8822B 0x0641 -+#define REG_EIFS_8822B 0x0642 -+#define REG_NAV_CTRL_8822B 0x0650 -+#define REG_BACAMCMD_8822B 0x0654 -+#define REG_BACAMCONTENT_8822B 0x0658 -+#define REG_LBDLY_8822B 0x0660 -+#define REG_WMAC_BACAM_RPMEN_8822B 0x0661 -+#define REG_TX_RX_8822B 0x0662 -+#define REG_WMAC_BITMAP_CTL_8822B 0x0663 -+#define REG_RXERR_RPT_8822B 0x0664 -+#define REG_WMAC_TRXPTCL_CTL_8822B 0x0668 -+#define REG_CAMCMD_8822B 0x0670 -+#define REG_CAMWRITE_8822B 0x0674 -+#define REG_CAMREAD_8822B 0x0678 -+#define REG_CAMDBG_8822B 0x067C -+#define REG_SECCFG_8822B 0x0680 -+#define REG_RXFILTER_CATEGORY_1_8822B 0x0682 -+#define REG_RXFILTER_ACTION_1_8822B 0x0683 -+#define REG_RXFILTER_CATEGORY_2_8822B 0x0684 -+#define REG_RXFILTER_ACTION_2_8822B 0x0685 -+#define REG_RXFILTER_CATEGORY_3_8822B 0x0686 -+#define REG_RXFILTER_ACTION_3_8822B 0x0687 -+#define REG_RXFLTMAP3_8822B 0x0688 -+#define REG_RXFLTMAP4_8822B 0x068A -+#define REG_RXFLTMAP5_8822B 0x068C -+#define REG_RXFLTMAP6_8822B 0x068E -+#define REG_WOW_CTRL_8822B 0x0690 -+#define REG_NAN_RX_TSF_FILTER_8822B 0x0691 -+#define REG_PS_RX_INFO_8822B 0x0692 -+#define REG_WMMPS_UAPSD_TID_8822B 0x0693 -+#define REG_LPNAV_CTRL_8822B 0x0694 -+#define REG_WKFMCAM_CMD_8822B 0x0698 -+#define REG_WKFMCAM_RWD_8822B 0x069C -+#define REG_RXFLTMAP0_8822B 0x06A0 -+#define REG_RXFLTMAP1_8822B 0x06A2 -+#define REG_RXFLTMAP2_8822B 0x06A4 -+#define REG_BCN_PSR_RPT_8822B 0x06A8 -+#define REG_FLC_RPC_8822B 0x06AC -+#define REG_FLC_RPCT_8822B 0x06AD -+#define REG_FLC_PTS_8822B 0x06AE -+#define REG_FLC_TRPC_8822B 0x06AF -+#define REG_RXPKTMON_CTRL_8822B 0x06B0 -+#define REG_STATE_MON_8822B 0x06B4 -+#define REG_ERROR_MON_8822B 0x06B8 -+#define REG_SEARCH_MACID_8822B 0x06BC -+#define REG_BT_COEX_TABLE_8822B 0x06C0 -+#define REG_RXCMD_0_8822B 0x06D0 -+#define REG_RXCMD_1_8822B 0x06D4 -+#define REG_WMAC_RESP_TXINFO_8822B 0x06D8 -+#define REG_BBPSF_CTRL_8822B 0x06DC -+#define REG_P2P_RX_BCN_NOA_8822B 0x06E0 -+#define REG_ASSOCIATED_BFMER0_INFO_8822B 0x06E4 -+#define REG_ASSOCIATED_BFMER1_INFO_8822B 0x06EC -+#define REG_TX_CSI_RPT_PARAM_BW20_8822B 0x06F4 -+#define REG_TX_CSI_RPT_PARAM_BW40_8822B 0x06F8 -+#define REG_TX_CSI_RPT_PARAM_BW80_8822B 0x06FC -+#define REG_BCN_PSR_RPT2_8822B 0x1600 -+#define REG_BCN_PSR_RPT3_8822B 0x1604 -+#define REG_BCN_PSR_RPT4_8822B 0x1608 -+#define REG_A1_ADDR_MASK_8822B 0x160C -+#define REG_MACID2_8822B 0x1620 -+#define REG_BSSID2_8822B 0x1628 -+#define REG_MACID3_8822B 0x1630 -+#define REG_BSSID3_8822B 0x1638 -+#define REG_MACID4_8822B 0x1640 -+#define REG_BSSID4_8822B 0x1648 -+#define REG_NOA_REPORT_8822B 0x1650 -+#define REG_PWRBIT_SETTING_8822B 0x1660 -+#define REG_MACRX_HANG_TIMER_CONTROL_8822B 0x1661 -+#define REG_WMAC_MU_BF_OPTION_8822B 0x167C -+#define REG_WMAC_MU_ARB_8822B 0x167E -+#define REG_WMAC_MU_OPTION_8822B 0x167F -+#define REG_WMAC_MU_BF_CTL_8822B 0x1680 -+#define REG_WMAC_MU_BFRPT_PARA_8822B 0x1682 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE2_8822B 0x1684 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE3_8822B 0x1686 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE4_8822B 0x1688 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE5_8822B 0x168A -+#define REG_WMAC_ASSOCIATED_MU_BFMEE6_8822B 0x168C -+#define REG_WMAC_ASSOCIATED_MU_BFMEE7_8822B 0x168E -+#define REG_TRANSMIT_ADDRSS_0_8822B 0x16A0 -+#define REG_TRANSMIT_ADDRSS_1_8822B 0x16A8 -+#define REG_TRANSMIT_ADDRSS_2_8822B 0x16B0 -+#define REG_TRANSMIT_ADDRSS_3_8822B 0x16B8 -+#define REG_TRANSMIT_ADDRSS_4_8822B 0x16C0 -+#define REG_MACID1_8822B 0x0700 -+#define REG_BSSID1_8822B 0x0708 -+#define REG_BCN_PSR_RPT1_8822B 0x0710 -+#define REG_ASSOCIATED_BFMEE_SEL_8822B 0x0714 -+#define REG_SND_PTCL_CTRL_8822B 0x0718 -+#define REG_RX_CSI_RPT_INFO_8822B 0x071C -+#define REG_NS_ARP_CTRL_8822B 0x0720 -+#define REG_NS_ARP_INFO_8822B 0x0724 -+#define REG_BEAMFORMING_INFO_NSARP_V1_8822B 0x0728 -+#define REG_BEAMFORMING_INFO_NSARP_8822B 0x072C -+#define REG_WMAC_RTX_CTX_SUBTYPE_CFG_8822B 0x0750 -+#define REG_WMAC_SWAES_CFG_8822B 0x0760 -+#define REG_BT_COEX_V2_8822B 0x0762 -+#define REG_BT_COEX_8822B 0x0764 -+#define REG_WLAN_ACT_MASK_CTRL_8822B 0x0768 -+#define REG_BT_COEX_ENHANCED_INTR_CTRL_8822B 0x076E -+#define REG_BT_ACT_STATISTICS_8822B 0x0770 -+#define REG_BT_STATISTICS_CONTROL_REGISTER_8822B 0x0778 -+#define REG_BT_STATUS_REPORT_REGISTER_8822B 0x077C -+#define REG_BT_INTERRUPT_CONTROL_REGISTER_8822B 0x0780 -+#define REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8822B 0x0784 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8822B 0x0785 -+#define REG_BT_INTERRUPT_STATUS_REGISTER_8822B 0x078F -+#define REG_BT_TDMA_TIME_REGISTER_8822B 0x0790 -+#define REG_BT_ACT_REGISTER_8822B 0x0794 -+#define REG_OBFF_CTRL_BASIC_8822B 0x0798 -+#define REG_OBFF_CTRL2_TIMER_8822B 0x079C -+#define REG_LTR_CTRL_BASIC_8822B 0x07A0 -+#define REG_LTR_CTRL2_TIMER_THRESHOLD_8822B 0x07A4 -+#define REG_LTR_IDLE_LATENCY_V1_8822B 0x07A8 -+#define REG_LTR_ACTIVE_LATENCY_V1_8822B 0x07AC -+#define REG_ANTENNA_TRAINING_CONTROL_REGISTER_8822B 0x07B0 -+#define REG_WMAC_PKTCNT_RWD_8822B 0x07B8 -+#define REG_WMAC_PKTCNT_CTRL_8822B 0x07BC -+#define REG_IQ_DUMP_8822B 0x07C0 -+#define REG_WMAC_FTM_CTL_8822B 0x07CC -+#define REG_WMAC_IQ_MDPK_FUNC_8822B 0x07CE -+#define REG_WMAC_OPTION_FUNCTION_8822B 0x07D0 -+#define REG_RX_FILTER_FUNCTION_8822B 0x07DA -+#define REG_NDP_SIG_8822B 0x07E0 -+#define REG_TXCMD_INFO_FOR_RSP_PKT_8822B 0x07E4 -+#define REG_RTS_ADDRESS_0_8822B 0x07F0 -+#define REG_RTS_ADDRESS_1_8822B 0x07F8 -+#define REG__RPFM_MAP1_8822B 0x07FE -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8822B 0x1700 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8822B 0x1704 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8822B 0x1708 -+#define REG_SDIO_TX_CTRL_8822B 0x10250000 -+#define REG_SDIO_HIMR_8822B 0x10250014 -+#define REG_SDIO_HISR_8822B 0x10250018 -+#define REG_SDIO_RX_REQ_LEN_8822B 0x1025001C -+#define REG_SDIO_FREE_TXPG_SEQ_V1_8822B 0x1025001F -+#define REG_SDIO_FREE_TXPG_8822B 0x10250020 -+#define REG_SDIO_FREE_TXPG2_8822B 0x10250024 -+#define REG_SDIO_OQT_FREE_TXPG_V1_8822B 0x10250028 -+#define REG_SDIO_HTSFR_INFO_8822B 0x10250030 -+#define REG_SDIO_HCPWM1_V2_8822B 0x10250038 -+#define REG_SDIO_HCPWM2_V2_8822B 0x1025003A -+#define REG_SDIO_INDIRECT_REG_CFG_8822B 0x10250040 -+#define REG_SDIO_INDIRECT_REG_DATA_8822B 0x10250044 -+#define REG_SDIO_H2C_8822B 0x10250060 -+#define REG_SDIO_C2H_8822B 0x10250064 -+#define REG_SDIO_HRPWM1_8822B 0x10250080 -+#define REG_SDIO_HRPWM2_8822B 0x10250082 -+#define REG_SDIO_HPS_CLKR_8822B 0x10250084 -+#define REG_SDIO_BUS_CTRL_8822B 0x10250085 -+#define REG_SDIO_HSUS_CTRL_8822B 0x10250086 -+#define REG_SDIO_RESPONSE_TIMER_8822B 0x10250088 -+#define REG_SDIO_CMD_CRC_8822B 0x1025008A -+#define REG_SDIO_HSISR_8822B 0x10250090 -+#define REG_SDIO_ERR_RPT_8822B 0x102500C0 -+#define REG_SDIO_CMD_ERRCNT_8822B 0x102500C2 -+#define REG_SDIO_DATA_ERRCNT_8822B 0x102500C3 -+#define REG_SDIO_CMD_ERR_CONTENT_8822B 0x102500C4 -+#define REG_SDIO_CRC_ERR_IDX_8822B 0x102500C9 -+#define REG_SDIO_DATA_CRC_8822B 0x102500CA -+#define REG_SDIO_DATA_REPLY_TIME_8822B 0x102500CB -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8822c.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8822c.h -new file mode 100644 -index 000000000..96c8a5216 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_reg_8822c.h -@@ -0,0 +1,878 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HALMAC_REG_8822C_H -+#define __INC_HALMAC_REG_8822C_H -+ -+#define REG_SYS_ISO_CTRL_8822C 0x0000 -+#define REG_SYS_FUNC_EN_8822C 0x0002 -+#define REG_SYS_PW_CTRL_8822C 0x0004 -+#define REG_SYS_CLK_CTRL_8822C 0x0008 -+#define REG_SYS_EEPROM_CTRL_8822C 0x000A -+#define REG_EE_VPD_8822C 0x000C -+#define REG_SYS_SWR_CTRL1_8822C 0x0010 -+#define REG_SYS_SWR_CTRL2_8822C 0x0014 -+#define REG_SYS_SWR_CTRL3_8822C 0x0018 -+#define REG_RSV_CTRL_8822C 0x001C -+#define REG_RF_CTRL_8822C 0x001F -+#define REG_AFE_LDO_CTRL_8822C 0x0020 -+#define REG_AFE_CTRL1_8822C 0x0024 -+#define REG_ANAPARSW_POW_MAC_8822C 0x0028 -+#define REG_ANAPARLDO_POW_MAC_8822C 0x0029 -+#define REG_ANAPAR_POW_MAC_8822C 0x002A -+#define REG_ANAPAR_POW_XTAL_8822C 0x002B -+#define REG_ANAPARLDO_MAC_8822C 0x002C -+#define REG_EFUSE_CTRL_8822C 0x0030 -+#define REG_LDO_EFUSE_CTRL_8822C 0x0034 -+#define REG_PWR_OPTION_CTRL_8822C 0x0038 -+#define REG_CAL_TIMER_8822C 0x003C -+#define REG_ACLK_MON_8822C 0x003E -+#define REG_GPIO_MUXCFG_2_8822C 0x003F -+#define REG_GPIO_MUXCFG_8822C 0x0040 -+#define REG_GPIO_PIN_CTRL_8822C 0x0044 -+#define REG_GPIO_INTM_8822C 0x0048 -+#define REG_LED_CFG_8822C 0x004C -+#define REG_FSIMR_8822C 0x0050 -+#define REG_FSISR_8822C 0x0054 -+#define REG_HSIMR_8822C 0x0058 -+#define REG_HSISR_8822C 0x005C -+#define REG_GPIO_EXT_CTRL_8822C 0x0060 -+#define REG_PAD_CTRL1_8822C 0x0064 -+#define REG_WL_BT_PWR_CTRL_8822C 0x0068 -+#define REG_SDM_DEBUG_8822C 0x006C -+#define REG_SYS_SDIO_CTRL_8822C 0x0070 -+#define REG_HCI_OPT_CTRL_8822C 0x0074 -+#define REG_HCI_BG_CTRL_8822C 0x0078 -+#define REG_HCI_LDO_CTRL_8822C 0x007A -+#define REG_LDO_SWR_CTRL_8822C 0x007C -+#define REG_MCUFW_CTRL_8822C 0x0080 -+#define REG_MCU_TST_CFG_8822C 0x0084 -+#define REG_HMEBOX_E0_E1_8822C 0x0088 -+#define REG_HMEBOX_E2_E3_8822C 0x008C -+#define REG_WLLPS_CTRL_8822C 0x0090 -+#define REG_GPIO_DEBOUNCE_CTRL_8822C 0x0098 -+#define REG_RPWM2_8822C 0x009C -+#define REG_SYSON_FSM_MON_8822C 0x00A0 -+#define REG_PMC_DBG_CTRL1_8822C 0x00A8 -+#define REG_HIMR0_8822C 0x00B0 -+#define REG_HISR0_8822C 0x00B4 -+#define REG_HIMR1_8822C 0x00B8 -+#define REG_HISR1_8822C 0x00BC -+#define REG_DBG_PORT_SEL_8822C 0x00C0 -+#define REG_PAD_CTRL2_8822C 0x00C4 -+#define REG_PMC_DBG_CTRL2_8822C 0x00CC -+#define REG_BIST_CTRL_8822C 0x00D0 -+#define REG_BIST_RPT_8822C 0x00D4 -+#define REG_MEM_CTRL_8822C 0x00D8 -+#define REG_USB_SIE_INTF_8822C 0x00E0 -+#define REG_PCIE_MIO_INTF_8822C 0x00E4 -+#define REG_PCIE_MIO_INTD_8822C 0x00E8 -+#define REG_WLRF1_8822C 0x00EC -+#define REG_SYS_CFG1_8822C 0x00F0 -+#define REG_SYS_STATUS1_8822C 0x00F4 -+#define REG_SYS_STATUS2_8822C 0x00F8 -+#define REG_SYS_CFG2_8822C 0x00FC -+#define REG_SYS_CFG3_8822C 0x1000 -+#define REG_ANAPARSW_MAC_0_8822C 0x1010 -+#define REG_ANAPARSW_MAC_1_8822C 0x1014 -+#define REG_ANAPAR_MAC_0_8822C 0x1018 -+#define REG_ANAPAR_MAC_1_8822C 0x101C -+#define REG_ANAPAR_MAC_2_8822C 0x1020 -+#define REG_ANAPAR_XTAL_0_8822C 0x1040 -+#define REG_ANAPAR_XTAL_1_8822C 0x1044 -+#define REG_ANAPAR_XTAL_2_8822C 0x1048 -+#define REG_ANAPAR_XTAL_3_8822C 0x104C -+#define REG_ANAPAR_XTAL_AACK_0_8822C 0x1054 -+#define REG_ANAPAR_XTAL_AACK_1_8822C 0x1058 -+#define REG_XTAL_AAC_OUTPUT_8822C 0x1060 -+#define REG_ANAPAR_XTAL_MODE_DECODER_8822C 0x1064 -+#define REG_SYS_CFG5_8822C 0x1070 -+#define REG_CPU_DMEM_CON_8822C 0x1080 -+#define REG_BOOT_REASON_8822C 0x1088 -+#define REG_HIMR2_8822C 0x10B0 -+#define REG_HISR2_8822C 0x10B4 -+#define REG_HIMR3_8822C 0x10B8 -+#define REG_HISR3_8822C 0x10BC -+#define REG_SW_MDIO_8822C 0x10C0 -+#define REG_H2C_PKT_READADDR_8822C 0x10D0 -+#define REG_H2C_PKT_WRITEADDR_8822C 0x10D4 -+#define REG_MEM_PWR_CRTL_8822C 0x10D8 -+#define REG_FW_DBG6_8822C 0x10F8 -+#define REG_FW_DBG7_8822C 0x10FC -+#define REG_CR_8822C 0x0100 -+#define REG_PG_SIZE_8822C 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL_8822C 0x0106 -+#define REG_TSF_CLK_STATE_8822C 0x0108 -+#define REG_TXDMA_PQ_MAP_8822C 0x010C -+#define REG_TRXFF_BNDY_8822C 0x0114 -+#define REG_PTA_I2C_MBOX_8822C 0x0118 -+#define REG_RXFF_BNDY_8822C 0x011C -+#define REG_FE1IMR_8822C 0x0120 -+#define REG_FE1ISR_8822C 0x0124 -+#define REG_CPWM_8822C 0x012C -+#define REG_FWIMR_8822C 0x0130 -+#define REG_FWISR_8822C 0x0134 -+#define REG_FTIMR_8822C 0x0138 -+#define REG_FTISR_8822C 0x013C -+#define REG_PKTBUF_DBG_CTRL_8822C 0x0140 -+#define REG_PKTBUF_DBG_DATA_L_8822C 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8822C 0x0148 -+#define REG_CPWM2_8822C 0x014C -+#define REG_TC0_CTRL_8822C 0x0150 -+#define REG_TC1_CTRL_8822C 0x0154 -+#define REG_TC2_CTRL_8822C 0x0158 -+#define REG_TC3_CTRL_8822C 0x015C -+#define REG_TC4_CTRL_8822C 0x0160 -+#define REG_TCUNIT_BASE_8822C 0x0164 -+#define REG_TC5_CTRL_8822C 0x0168 -+#define REG_TC6_CTRL_8822C 0x016C -+#define REG_MBIST_DRF_FAIL_8822C 0x0170 -+#define REG_MBIST_START_PAUSE_8822C 0x0174 -+#define REG_MBIST_DONE_8822C 0x0178 -+#define REG_MBIST_READ_BIST_RPT_8822C 0x017C -+#define REG_AES_DECRPT_DATA_8822C 0x0180 -+#define REG_AES_DECRPT_CFG_8822C 0x0184 -+#define REG_HIOE_CTRL_8822C 0x0188 -+#define REG_HIOE_CFG_FILE_8822C 0x018C -+#define REG_TMETER_8822C 0x0190 -+#define REG_OSC_32K_CTRL_8822C 0x0194 -+#define REG_32K_CAL_REG1_8822C 0x0198 -+#define REG_C2HEVT_8822C 0x01A0 -+#define REG_C2HEVT_1_8822C 0x01A4 -+#define REG_C2HEVT_2_8822C 0x01A8 -+#define REG_C2HEVT_3_8822C 0x01AC -+#define REG_SW_DEFINED_PAGE1_8822C 0x01B8 -+#define REG_SW_DEFINED_PAGE2_8822C 0x01BC -+#define REG_MCUTST_I_8822C 0x01C0 -+#define REG_MCUTST_II_8822C 0x01C4 -+#define REG_FMETHR_8822C 0x01C8 -+#define REG_HMETFR_8822C 0x01CC -+#define REG_HMEBOX0_8822C 0x01D0 -+#define REG_HMEBOX1_8822C 0x01D4 -+#define REG_HMEBOX2_8822C 0x01D8 -+#define REG_HMEBOX3_8822C 0x01DC -+#define REG_BB_ACCESS_CTRL_8822C 0x01E8 -+#define REG_BB_ACCESS_DATA_8822C 0x01EC -+#define REG_HMEBOX_E0_8822C 0x01F0 -+#define REG_HMEBOX_E1_8822C 0x01F4 -+#define REG_HMEBOX_E2_8822C 0x01F8 -+#define REG_HMEBOX_E3_8822C 0x01FC -+#define REG_CR_EXT_8822C 0x1100 -+#define REG_FWFF_8822C 0x1114 -+#define REG_RXFF_PTR_V1_8822C 0x1118 -+#define REG_RXFF_WTR_V1_8822C 0x111C -+#define REG_FE2IMR_8822C 0x1120 -+#define REG_FE2ISR_8822C 0x1124 -+#define REG_FE3IMR_8822C 0x1128 -+#define REG_FE3ISR_8822C 0x112C -+#define REG_FE4IMR_8822C 0x1130 -+#define REG_FE4ISR_8822C 0x1134 -+#define REG_FT1IMR_8822C 0x1138 -+#define REG_FT1ISR_8822C 0x113C -+#define REG_SPWR0_8822C 0x1140 -+#define REG_SPWR1_8822C 0x1144 -+#define REG_SPWR2_8822C 0x1148 -+#define REG_SPWR3_8822C 0x114C -+#define REG_POWSEQ_8822C 0x1150 -+#define REG_TC7_CTRL_V1_8822C 0x1158 -+#define REG_TC8_CTRL_V1_8822C 0x115C -+#define REG_RX_BCN_TBTT_ITVL0_8822C 0x1160 -+#define REG_RX_BCN_TBTT_ITVL1_8822C 0x1164 -+#define REG_IO_WRAP_ERR_FLAG_8822C 0x1170 -+#define REG_SPEED_SENSOR_8822C 0x1180 -+#define REG_SPEED_SENSOR1_8822C 0x1184 -+#define REG_SPEED_SENSOR2_8822C 0x1188 -+#define REG_SPEED_SENSOR3_8822C 0x118C -+#define REG_SPEED_SENSOR4_8822C 0x1190 -+#define REG_SPEED_SENSOR5_8822C 0x1194 -+#define REG_COUNTER_CTRL_8822C 0x11C4 -+#define REG_COUNTER_THRESHOLD_8822C 0x11C8 -+#define REG_COUNTER_SET_8822C 0x11CC -+#define REG_COUNTER_OVERFLOW_8822C 0x11D0 -+#define REG_TXDMA_LEN_THRESHOLD_8822C 0x11D4 -+#define REG_RXDMA_LEN_THRESHOLD_8822C 0x11D8 -+#define REG_PCIE_EXEC_TIME_THRESHOLD_8822C 0x11DC -+#define REG_FT2IMR_8822C 0x11E0 -+#define REG_FT2ISR_8822C 0x11E4 -+#define REG_MSG2_8822C 0x11F0 -+#define REG_MSG3_8822C 0x11F4 -+#define REG_MSG4_8822C 0x11F8 -+#define REG_MSG5_8822C 0x11FC -+#define REG_FIFOPAGE_CTRL_1_8822C 0x0200 -+#define REG_FIFOPAGE_CTRL_2_8822C 0x0204 -+#define REG_AUTO_LLT_V1_8822C 0x0208 -+#define REG_TXDMA_OFFSET_CHK_8822C 0x020C -+#define REG_TXDMA_STATUS_8822C 0x0210 -+#define REG_TX_DMA_DBG_8822C 0x0214 -+#define REG_TQPNT1_8822C 0x0218 -+#define REG_TQPNT2_8822C 0x021C -+#define REG_TQPNT3_8822C 0x0220 -+#define REG_TQPNT4_8822C 0x0224 -+#define REG_RQPN_CTRL_1_8822C 0x0228 -+#define REG_RQPN_CTRL_2_8822C 0x022C -+#define REG_FIFOPAGE_INFO_1_8822C 0x0230 -+#define REG_FIFOPAGE_INFO_2_8822C 0x0234 -+#define REG_FIFOPAGE_INFO_3_8822C 0x0238 -+#define REG_FIFOPAGE_INFO_4_8822C 0x023C -+#define REG_FIFOPAGE_INFO_5_8822C 0x0240 -+#define REG_H2C_HEAD_8822C 0x0244 -+#define REG_H2C_TAIL_8822C 0x0248 -+#define REG_H2C_READ_ADDR_8822C 0x024C -+#define REG_H2C_WR_ADDR_8822C 0x0250 -+#define REG_H2C_INFO_8822C 0x0254 -+#define REG_PGSUB_CNT_8822C 0x026C -+#define REG_PGSUB_H_8822C 0x0270 -+#define REG_PGSUB_N_8822C 0x0274 -+#define REG_PGSUB_L_8822C 0x0278 -+#define REG_PGSUB_E_8822C 0x027C -+#define REG_RXDMA_AGG_PG_TH_8822C 0x0280 -+#define REG_RXPKT_NUM_8822C 0x0284 -+#define REG_RXDMA_STATUS_8822C 0x0288 -+#define REG_RXDMA_DPR_8822C 0x028C -+#define REG_RXDMA_MODE_8822C 0x0290 -+#define REG_C2H_PKT_8822C 0x0294 -+#define REG_FWFF_C2H_8822C 0x0298 -+#define REG_FWFF_CTRL_8822C 0x029C -+#define REG_FWFF_PKT_INFO_8822C 0x02A0 -+#define REG_RXPKTNUM_8822C 0x02B0 -+#define REG_RXPKTNUM_TH_8822C 0x02B4 -+#define REG_FW_MSG1_8822C 0x02E0 -+#define REG_FW_MSG2_8822C 0x02E4 -+#define REG_FW_MSG3_8822C 0x02E8 -+#define REG_FW_MSG4_8822C 0x02EC -+#define REG_DDMA_CH0SA_8822C 0x1200 -+#define REG_DDMA_CH0DA_8822C 0x1204 -+#define REG_DDMA_CH0CTRL_8822C 0x1208 -+#define REG_DDMA_CH1SA_8822C 0x1210 -+#define REG_DDMA_CH1DA_8822C 0x1214 -+#define REG_DDMA_CH1CTRL_8822C 0x1218 -+#define REG_DDMA_CH2SA_8822C 0x1220 -+#define REG_DDMA_CH2DA_8822C 0x1224 -+#define REG_DDMA_CH2CTRL_8822C 0x1228 -+#define REG_DDMA_CH3SA_8822C 0x1230 -+#define REG_DDMA_CH3DA_8822C 0x1234 -+#define REG_DDMA_CH3CTRL_8822C 0x1238 -+#define REG_DDMA_CH4SA_8822C 0x1240 -+#define REG_DDMA_CH4DA_8822C 0x1244 -+#define REG_DDMA_CH4CTRL_8822C 0x1248 -+#define REG_DDMA_CH5SA_8822C 0x1250 -+#define REG_DDMA_CH5DA_8822C 0x1254 -+#define REG_DDMA_CH5CTRL_8822C 0x1258 -+#define REG_DDMA_INT_MSK_8822C 0x12E0 -+#define REG_DDMA_CHSTATUS_8822C 0x12E8 -+#define REG_DDMA_CHKSUM_8822C 0x12F0 -+#define REG_DDMA_MONITOR_8822C 0x12FC -+#define REG_PCIE_CTRL_8822C 0x0300 -+#define REG_INT_MIG_8822C 0x0304 -+#define REG_BCNQ_TXBD_DESA_8822C 0x0308 -+#define REG_MGQ_TXBD_DESA_8822C 0x0310 -+#define REG_VOQ_TXBD_DESA_8822C 0x0318 -+#define REG_VIQ_TXBD_DESA_8822C 0x0320 -+#define REG_BEQ_TXBD_DESA_8822C 0x0328 -+#define REG_BKQ_TXBD_DESA_8822C 0x0330 -+#define REG_RXQ_RXBD_DESA_8822C 0x0338 -+#define REG_HI0Q_TXBD_DESA_8822C 0x0340 -+#define REG_HI1Q_TXBD_DESA_8822C 0x0348 -+#define REG_HI2Q_TXBD_DESA_8822C 0x0350 -+#define REG_HI3Q_TXBD_DESA_8822C 0x0358 -+#define REG_HI4Q_TXBD_DESA_8822C 0x0360 -+#define REG_HI5Q_TXBD_DESA_8822C 0x0368 -+#define REG_HI6Q_TXBD_DESA_8822C 0x0370 -+#define REG_HI7Q_TXBD_DESA_8822C 0x0378 -+#define REG_MGQ_TXBD_NUM_8822C 0x0380 -+#define REG_RX_RXBD_NUM_8822C 0x0382 -+#define REG_VOQ_TXBD_NUM_8822C 0x0384 -+#define REG_VIQ_TXBD_NUM_8822C 0x0386 -+#define REG_BEQ_TXBD_NUM_8822C 0x0388 -+#define REG_BKQ_TXBD_NUM_8822C 0x038A -+#define REG_HI0Q_TXBD_NUM_8822C 0x038C -+#define REG_HI1Q_TXBD_NUM_8822C 0x038E -+#define REG_HI2Q_TXBD_NUM_8822C 0x0390 -+#define REG_HI3Q_TXBD_NUM_8822C 0x0392 -+#define REG_HI4Q_TXBD_NUM_8822C 0x0394 -+#define REG_HI5Q_TXBD_NUM_8822C 0x0396 -+#define REG_HI6Q_TXBD_NUM_8822C 0x0398 -+#define REG_HI7Q_TXBD_NUM_8822C 0x039A -+#define REG_TSFTIMER_HCI_8822C 0x039C -+#define REG_BD_RWPTR_CLR_8822C 0x039C -+#define REG_VOQ_TXBD_IDX_8822C 0x03A0 -+#define REG_VIQ_TXBD_IDX_8822C 0x03A4 -+#define REG_BEQ_TXBD_IDX_8822C 0x03A8 -+#define REG_BKQ_TXBD_IDX_8822C 0x03AC -+#define REG_MGQ_TXBD_IDX_8822C 0x03B0 -+#define REG_RXQ_RXBD_IDX_8822C 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8822C 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8822C 0x03BC -+#define REG_HI2Q_TXBD_IDX_8822C 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8822C 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8822C 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8822C 0x03CC -+#define REG_HI6Q_TXBD_IDX_8822C 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8822C 0x03D4 -+#define REG_DBG_SEL_V1_8822C 0x03D8 -+#define REG_PCIE_HRPWM1_V1_8822C 0x03D9 -+#define REG_PCIE_HCPWM1_V1_8822C 0x03DA -+#define REG_PCIE_CTRL2_8822C 0x03DB -+#define REG_PCIE_HRPWM2_V1_8822C 0x03DC -+#define REG_PCIE_HCPWM2_V1_8822C 0x03DE -+#define REG_PCIE_H2C_MSG_V1_8822C 0x03E0 -+#define REG_PCIE_C2H_MSG_V1_8822C 0x03E4 -+#define REG_DBI_WDATA_V1_8822C 0x03E8 -+#define REG_DBI_RDATA_V1_8822C 0x03EC -+#define REG_DBI_FLAG_V1_8822C 0x03F0 -+#define REG_MDIO_V1_8822C 0x03F4 -+#define REG_PCIE_MIX_CFG_8822C 0x03F8 -+#define REG_HCI_MIX_CFG_8822C 0x03FC -+#define REG_STC_INT_CS_8822C 0x1300 -+#define REG_ST_INT_CFG_8822C 0x1304 -+#define REG_H2CQ_TXBD_DESA_8822C 0x1320 -+#define REG_H2CQ_TXBD_NUM_8822C 0x1328 -+#define REG_H2CQ_TXBD_IDX_8822C 0x132C -+#define REG_H2CQ_CSR_8822C 0x1330 -+#define REG_CHANGE_PCIE_SPEED_8822C 0x1350 -+#define REG_DEBUG_STATE1_8822C 0x1354 -+#define REG_DEBUG_STATE2_8822C 0x1358 -+#define REG_DEBUG_STATE3_8822C 0x135C -+#define REG_CHNL_DMA_CFG_V1_8822C 0x137C -+#define REG_PCIE_HISR0_V1_8822C 0x13B4 -+#define REG_PCIE_HISR1_V1_8822C 0x13BC -+#define REG_PCIE_HISR2_V1_8822C 0x23B4 -+#define REG_PCIE_HISR3_V1_8822C 0x23BC -+#define REG_Q0_INFO_8822C 0x0400 -+#define REG_Q1_INFO_8822C 0x0404 -+#define REG_Q2_INFO_8822C 0x0408 -+#define REG_Q3_INFO_8822C 0x040C -+#define REG_MGQ_INFO_8822C 0x0410 -+#define REG_HIQ_INFO_8822C 0x0414 -+#define REG_BCNQ_INFO_8822C 0x0418 -+#define REG_TXPKT_EMPTY_8822C 0x041A -+#define REG_CPU_MGQ_INFO_8822C 0x041C -+#define REG_FWHW_TXQ_CTRL_8822C 0x0420 -+#define REG_DATAFB_SEL_8822C 0x0423 -+#define REG_BCNQ_BDNY_V1_8822C 0x0424 -+#define REG_LIFETIME_EN_8822C 0x0426 -+#define REG_SPEC_SIFS_8822C 0x0428 -+#define REG_RETRY_LIMIT_8822C 0x042A -+#define REG_TXBF_CTRL_8822C 0x042C -+#define REG_DARFRC_8822C 0x0430 -+#define REG_DARFRCH_8822C 0x0434 -+#define REG_RARFRC_8822C 0x0438 -+#define REG_RARFRCH_8822C 0x043C -+#define REG_RRSR_8822C 0x0440 -+#define REG_ARFR0_8822C 0x0444 -+#define REG_ARFRH0_8822C 0x0448 -+#define REG_ARFR1_V1_8822C 0x044C -+#define REG_ARFRH1_V1_8822C 0x0450 -+#define REG_CCK_CHECK_8822C 0x0454 -+#define REG_AMPDU_MAX_TIME_V1_8822C 0x0455 -+#define REG_BCNQ1_BDNY_V1_8822C 0x0456 -+#define REG_AMPDU_MAX_LENGTH_HT_8822C 0x0458 -+#define REG_ACQ_STOP_8822C 0x045C -+#define REG_NDPA_RATE_8822C 0x045D -+#define REG_TX_HANG_CTRL_8822C 0x045E -+#define REG_NDPA_OPT_CTRL_8822C 0x045F -+#define REG_AMPDU_MAX_LENGTH_VHT_8822C 0x0460 -+#define REG_RD_RESP_PKT_TH_8822C 0x0463 -+#define REG_CMDQ_INFO_8822C 0x0464 -+#define REG_Q4_INFO_8822C 0x0468 -+#define REG_Q5_INFO_8822C 0x046C -+#define REG_Q6_INFO_8822C 0x0470 -+#define REG_Q7_INFO_8822C 0x0474 -+#define REG_WMAC_LBK_BUF_HD_V1_8822C 0x0478 -+#define REG_MGQ_BDNY_V1_8822C 0x047A -+#define REG_TXRPT_CTRL_8822C 0x047C -+#define REG_INIRTS_RATE_SEL_8822C 0x0480 -+#define REG_BASIC_CFEND_RATE_8822C 0x0481 -+#define REG_STBC_CFEND_RATE_8822C 0x0482 -+#define REG_DATA_SC_8822C 0x0483 -+#define REG_MACID_SLEEP3_8822C 0x0484 -+#define REG_MACID_SLEEP1_8822C 0x0488 -+#define REG_ARFR2_V1_8822C 0x048C -+#define REG_ARFRH2_V1_8822C 0x0490 -+#define REG_ARFR3_V1_8822C 0x0494 -+#define REG_ARFRH3_V1_8822C 0x0498 -+#define REG_ARFR4_8822C 0x049C -+#define REG_ARFRH4_8822C 0x04A0 -+#define REG_ARFR5_8822C 0x04A4 -+#define REG_ARFRH5_8822C 0x04A8 -+#define REG_TXRPT_START_OFFSET_8822C 0x04AC -+#define REG_POWER_STAGE1_8822C 0x04B4 -+#define REG_POWER_STAGE2_8822C 0x04B8 -+#define REG_SW_AMPDU_BURST_MODE_CTRL_8822C 0x04BC -+#define REG_PKT_LIFE_TIME_8822C 0x04C0 -+#define REG_STBC_SETTING_8822C 0x04C4 -+#define REG_STBC_SETTING2_8822C 0x04C5 -+#define REG_QUEUE_CTRL_8822C 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL_8822C 0x04C7 -+#define REG_PROT_MODE_CTRL_8822C 0x04C8 -+#define REG_BAR_MODE_CTRL_8822C 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8822C 0x04CF -+#define REG_MACID_SLEEP2_8822C 0x04D0 -+#define REG_MACID_SLEEP_8822C 0x04D4 -+#define REG_HW_SEQ0_8822C 0x04D8 -+#define REG_HW_SEQ1_8822C 0x04DA -+#define REG_HW_SEQ2_8822C 0x04DC -+#define REG_HW_SEQ3_8822C 0x04DE -+#define REG_NULL_PKT_STATUS_V1_8822C 0x04E0 -+#define REG_PTCL_ERR_STATUS_8822C 0x04E2 -+#define REG_NULL_PKT_STATUS_EXTEND_8822C 0x04E3 -+#define REG_HQMGQ_DROP_8822C 0x04E4 -+#define REG_PRECNT_CTRL_8822C 0x04E5 -+#define REG_BT_POLLUTE_PKT_CNT_8822C 0x04E8 -+#define REG_PTCL_DBG_8822C 0x04EC -+#define REG_CPUMGQ_TIMER_CTRL2_8822C 0x04F4 -+#define REG_DUMMY_PAGE4_V1_8822C 0x04FC -+#define REG_MOREDATA_8822C 0x04FE -+#define REG_Q0_Q1_INFO_8822C 0x1400 -+#define REG_Q2_Q3_INFO_8822C 0x1404 -+#define REG_Q4_Q5_INFO_8822C 0x1408 -+#define REG_Q6_Q7_INFO_8822C 0x140C -+#define REG_MGQ_HIQ_INFO_8822C 0x1410 -+#define REG_CMDQ_BCNQ_INFO_8822C 0x1414 -+#define REG_LOOPBACK_OPTION_8822C 0x1420 -+#define REG_AESIV_SETTING_8822C 0x1424 -+#define REG_BF0_TIME_SETTING_8822C 0x1428 -+#define REG_BF1_TIME_SETTING_8822C 0x142C -+#define REG_BF_TIMEOUT_EN_8822C 0x1430 -+#define REG_MACID_RELEASE0_8822C 0x1434 -+#define REG_MACID_RELEASE1_8822C 0x1438 -+#define REG_MACID_RELEASE2_8822C 0x143C -+#define REG_MACID_RELEASE3_8822C 0x1440 -+#define REG_MACID_RELEASE_SETTING_8822C 0x1444 -+#define REG_FAST_EDCA_VOVI_SETTING_8822C 0x1448 -+#define REG_FAST_EDCA_BEBK_SETTING_8822C 0x144C -+#define REG_MACID_DROP0_8822C 0x1450 -+#define REG_MACID_DROP1_8822C 0x1454 -+#define REG_MACID_DROP2_8822C 0x1458 -+#define REG_MACID_DROP3_8822C 0x145C -+#define REG_R_MACID_RELEASE_SUCCESS_0_8822C 0x1460 -+#define REG_R_MACID_RELEASE_SUCCESS_1_8822C 0x1464 -+#define REG_R_MACID_RELEASE_SUCCESS_2_8822C 0x1468 -+#define REG_R_MACID_RELEASE_SUCCESS_3_8822C 0x146C -+#define REG_MGQ_FIFO_WRITE_POINTER_8822C 0x1470 -+#define REG_MGQ_FIFO_READ_POINTER_8822C 0x1472 -+#define REG_MGQ_FIFO_ENABLE_8822C 0x1472 -+#define REG_MGQ_FIFO_RELEASE_INT_MASK_8822C 0x1474 -+#define REG_MGQ_FIFO_RELEASE_INT_FLAG_8822C 0x1476 -+#define REG_MGQ_FIFO_VALID_MAP_8822C 0x1478 -+#define REG_MGQ_FIFO_LIFETIME_8822C 0x147A -+#define REG_R_MACID_RELEASE_SUCCESS_CLEAR_OFFSET_8822C 0x147C -+#define REG_SHCUT_SETTING_8822C 0x1480 -+#define REG_SHCUT_LLC_ETH_TYPE0_8822C 0x1484 -+#define REG_SHCUT_LLC_ETH_TYPE1_8822C 0x1488 -+#define REG_SHCUT_LLC_OUI0_8822C 0x148C -+#define REG_SHCUT_LLC_OUI1_8822C 0x1490 -+#define REG_SHCUT_LLC_OUI2_8822C 0x1494 -+#define REG_MU_TX_CTL_8822C 0x14C0 -+#define REG_MU_STA_GID_VLD_8822C 0x14C4 -+#define REG_MU_STA_USER_POS_INFO_8822C 0x14C8 -+#define REG_MU_STA_USER_POS_INFO_H_8822C 0x14CC -+#define REG_CHNL_INFO_CTRL_8822C 0x14D0 -+#define REG_CHNL_IDLE_TIME_8822C 0x14D4 -+#define REG_CHNL_BUSY_TIME_8822C 0x14D8 -+#define REG_MU_TRX_DBG_CNT_V1_8822C 0x14DC -+#define REG_EDCA_VO_PARAM_8822C 0x0500 -+#define REG_EDCA_VI_PARAM_8822C 0x0504 -+#define REG_EDCA_BE_PARAM_8822C 0x0508 -+#define REG_EDCA_BK_PARAM_8822C 0x050C -+#define REG_BCNTCFG_8822C 0x0510 -+#define REG_PIFS_8822C 0x0512 -+#define REG_RDG_PIFS_8822C 0x0513 -+#define REG_SIFS_8822C 0x0514 -+#define REG_TSFTR_SYN_OFFSET_8822C 0x0518 -+#define REG_AGGR_BREAK_TIME_8822C 0x051A -+#define REG_SLOT_8822C 0x051B -+#define REG_NOA_ON_ERLY_TIME_8822C 0x051C -+#define REG_NOA_OFF_ERLY_TIME_8822C 0x051D -+#define REG_TX_PTCL_CTRL_8822C 0x0520 -+#define REG_TXPAUSE_8822C 0x0522 -+#define REG_DIS_TXREQ_CLR_8822C 0x0523 -+#define REG_RD_CTRL_8822C 0x0524 -+#define REG_MBSSID_CTRL_8822C 0x0526 -+#define REG_P2PPS_CTRL_8822C 0x0527 -+#define REG_PKT_LIFETIME_CTRL_8822C 0x0528 -+#define REG_P2PPS_SPEC_STATE_8822C 0x052B -+#define REG_TXOP_LIMIT_CTRL_8822C 0x052C -+#define REG_BAR_TX_CTRL_8822C 0x0530 -+#define REG_P2PON_DIS_TXTIME_8822C 0x0531 -+#define REG_CCA_TXEN_CNT_8822C 0x0534 -+#define REG_MAX_INTER_COLLISION_8822C 0x0538 -+#define REG_MAX_INTER_COLLISION_CNT_8822C 0x053C -+#define REG_TBTT_PROHIBIT_8822C 0x0540 -+#define REG_P2PPS_STATE_8822C 0x0543 -+#define REG_RD_NAV_NXT_8822C 0x0544 -+#define REG_NAV_PROT_LEN_8822C 0x0546 -+#define REG_FTM_PTT_8822C 0x0548 -+#define REG_FTM_TSF_8822C 0x054C -+#define REG_BCN_CTRL_8822C 0x0550 -+#define REG_BCN_CTRL_CLINT0_8822C 0x0551 -+#define REG_MBID_NUM_8822C 0x0552 -+#define REG_DUAL_TSF_RST_8822C 0x0553 -+#define REG_MBSSID_BCN_SPACE_8822C 0x0554 -+#define REG_DRVERLYINT_8822C 0x0558 -+#define REG_BCNDMATIM_8822C 0x0559 -+#define REG_ATIMWND_8822C 0x055A -+#define REG_USTIME_TSF_8822C 0x055C -+#define REG_BCN_MAX_ERR_8822C 0x055D -+#define REG_RXTSF_OFFSET_CCK_8822C 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8822C 0x055F -+#define REG_TSFTR_8822C 0x0560 -+#define REG_TSFTR_1_8822C 0x0564 -+#define REG_FREERUN_CNT_8822C 0x0568 -+#define REG_FREERUN_CNT_1_8822C 0x056C -+#define REG_ATIMWND1_V1_8822C 0x0570 -+#define REG_TBTT_PROHIBIT_INFRA_8822C 0x0571 -+#define REG_CTWND_8822C 0x0572 -+#define REG_BCNIVLCUNT_8822C 0x0573 -+#define REG_BCNDROPCTRL_8822C 0x0574 -+#define REG_HGQ_TIMEOUT_PERIOD_8822C 0x0575 -+#define REG_TXCMD_TIMEOUT_PERIOD_8822C 0x0576 -+#define REG_MISC_CTRL_8822C 0x0577 -+#define REG_BCN_CTRL_CLINT1_8822C 0x0578 -+#define REG_BCN_CTRL_CLINT2_8822C 0x0579 -+#define REG_BCN_CTRL_CLINT3_8822C 0x057A -+#define REG_EXTEND_CTRL_8822C 0x057B -+#define REG_P2PPS1_SPEC_STATE_8822C 0x057C -+#define REG_P2PPS1_STATE_8822C 0x057D -+#define REG_P2PPS2_SPEC_STATE_8822C 0x057E -+#define REG_P2PPS2_STATE_8822C 0x057F -+#define REG_PS_TIMER0_8822C 0x0580 -+#define REG_PS_TIMER1_8822C 0x0584 -+#define REG_PS_TIMER2_8822C 0x0588 -+#define REG_TBTT_CTN_AREA_8822C 0x058C -+#define REG_FORCE_BCN_IFS_8822C 0x058E -+#define REG_TXOP_MIN_8822C 0x0590 -+#define REG_PRE_BKF_TIME_8822C 0x0592 -+#define REG_CROSS_TXOP_CTRL_8822C 0x0593 -+#define REG_RX_TBTT_SHIFT_V1_8822C 0x0598 -+#define REG_ATIMWND2_8822C 0x05A0 -+#define REG_ATIMWND3_8822C 0x05A1 -+#define REG_ATIMWND4_8822C 0x05A2 -+#define REG_ATIMWND5_8822C 0x05A3 -+#define REG_ATIMWND6_8822C 0x05A4 -+#define REG_ATIMWND7_8822C 0x05A5 -+#define REG_ATIMUGT_8822C 0x05A6 -+#define REG_HIQ_NO_LMT_EN_8822C 0x05A7 -+#define REG_DTIM_COUNTER_ROOT_8822C 0x05A8 -+#define REG_DTIM_COUNTER_VAP1_8822C 0x05A9 -+#define REG_DTIM_COUNTER_VAP2_8822C 0x05AA -+#define REG_DTIM_COUNTER_VAP3_8822C 0x05AB -+#define REG_DTIM_COUNTER_VAP4_8822C 0x05AC -+#define REG_DTIM_COUNTER_VAP5_8822C 0x05AD -+#define REG_DTIM_COUNTER_VAP6_8822C 0x05AE -+#define REG_DTIM_COUNTER_VAP7_8822C 0x05AF -+#define REG_DIS_ATIM_8822C 0x05B0 -+#define REG_EARLY_128US_8822C 0x05B1 -+#define REG_P2PPS1_CTRL_8822C 0x05B2 -+#define REG_P2PPS2_CTRL_8822C 0x05B3 -+#define REG_TIMER0_SRC_SEL_8822C 0x05B4 -+#define REG_NOA_UNIT_SEL_8822C 0x05B5 -+#define REG_P2POFF_DIS_TXTIME_8822C 0x05B7 -+#define REG_MBSSID_BCN_SPACE2_8822C 0x05B8 -+#define REG_MBSSID_BCN_SPACE3_8822C 0x05BC -+#define REG_ACMHWCTRL_8822C 0x05C0 -+#define REG_ACMRSTCTRL_8822C 0x05C1 -+#define REG_ACMAVG_8822C 0x05C2 -+#define REG_VO_ADMTIME_8822C 0x05C4 -+#define REG_VI_ADMTIME_8822C 0x05C6 -+#define REG_BE_ADMTIME_8822C 0x05C8 -+#define REG_MAC_HEADER_NAV_OFFSET_8822C 0x05CA -+#define REG_DIS_NDPA_NAV_CHECK_8822C 0x05CB -+#define REG_EDCA_RANDOM_GEN_8822C 0x05CC -+#define REG_TXCMD_NOA_SEL_8822C 0x05CF -+#define REG_32K_CLK_SEL_8822C 0x05D0 -+#define REG_EARLYINT_ADJUST_8822C 0x05D4 -+#define REG_BCNERR_CNT_8822C 0x05D8 -+#define REG_BCNERR_CNT_2_8822C 0x05DC -+#define REG_NOA_PARAM_8822C 0x05E0 -+#define REG_NOA_PARAM_1_8822C 0x05E4 -+#define REG_NOA_PARAM_2_8822C 0x05E8 -+#define REG_NOA_PARAM_3_8822C 0x05EC -+#define REG_P2P_RST_8822C 0x05F0 -+#define REG_SCHEDULER_RST_8822C 0x05F1 -+#define REG_SCH_DBG_VALUE_8822C 0x05F4 -+#define REG_SCH_TXCMD_8822C 0x05F8 -+#define REG_PAGE5_DUMMY_8822C 0x05FC -+#define REG_CPUMGQ_TX_TIMER_8822C 0x1500 -+#define REG_PS_TIMER_A_8822C 0x1504 -+#define REG_PS_TIMER_B_8822C 0x1508 -+#define REG_PS_TIMER_C_8822C 0x150C -+#define REG_PS_TIMER_ABC_CPUMGQ_TIMER_CRTL_8822C 0x1510 -+#define REG_CPUMGQ_TX_TIMER_EARLY_8822C 0x1514 -+#define REG_PS_TIMER_A_EARLY_8822C 0x1515 -+#define REG_PS_TIMER_B_EARLY_8822C 0x1516 -+#define REG_PS_TIMER_C_EARLY_8822C 0x1517 -+#define REG_CPUMGQ_PARAMETER_8822C 0x1518 -+#define REG_TSF_SYNC_ADJ_8822C 0x1520 -+#define REG_TSF_ADJ_VLAUE_8822C 0x1524 -+#define REG_TSF_ADJ_VLAUE_2_8822C 0x1528 -+#define REG_P2PPS_HW_AUTO_PAUSE_CTRL_8822C 0x156C -+#define REG_P2PPS1_HW_AUTO_PAUSE_CTRL_8822C 0x1570 -+#define REG_P2PPS2_HW_AUTO_PAUSE_CTRL_8822C 0x1574 -+#define REG_SCHEDULER_COUNTER_8822C 0x15D0 -+#define REG_WMAC_CR_8822C 0x0600 -+#define REG_WMAC_FWPKT_CR_8822C 0x0601 -+#define REG_FW_STS_FILTER_8822C 0x0602 -+#define REG_TCR_8822C 0x0604 -+#define REG_RCR_8822C 0x0608 -+#define REG_RX_PKT_LIMIT_8822C 0x060C -+#define REG_RX_DLK_TIME_8822C 0x060D -+#define REG_RX_DRVINFO_SZ_8822C 0x060F -+#define REG_MACID_8822C 0x0610 -+#define REG_MACID_H_8822C 0x0614 -+#define REG_BSSID_8822C 0x0618 -+#define REG_BSSID_H_8822C 0x061C -+#define REG_MAR_8822C 0x0620 -+#define REG_MAR_H_8822C 0x0624 -+#define REG_MBIDCAMCFG_1_8822C 0x0628 -+#define REG_MBIDCAMCFG_2_8822C 0x062C -+#define REG_WMAC_TCR_TSFT_OFS_8822C 0x0630 -+#define REG_UDF_THSD_8822C 0x0632 -+#define REG_ZLD_NUM_8822C 0x0633 -+#define REG_STMP_THSD_8822C 0x0634 -+#define REG_WMAC_TXTIMEOUT_8822C 0x0635 -+#define REG_USTIME_EDCA_8822C 0x0638 -+#define REG_ACKTO_CCK_8822C 0x0639 -+#define REG_MAC_SPEC_SIFS_8822C 0x063A -+#define REG_RESP_SIFS_CCK_8822C 0x063C -+#define REG_RESP_SIFS_OFDM_8822C 0x063E -+#define REG_ACKTO_8822C 0x0640 -+#define REG_CTS2TO_8822C 0x0641 -+#define REG_EIFS_8822C 0x0642 -+#define REG_RPFM_MAP0_8822C 0x0644 -+#define REG_RPFM_MAP1_V1_8822C 0x0646 -+#define REG_RPFM_CAM_CMD_8822C 0x0648 -+#define REG_RPFM_CAM_RWD_8822C 0x064C -+#define REG_NAV_CTRL_8822C 0x0650 -+#define REG_BACAMCMD_8822C 0x0654 -+#define REG_BACAMCONTENT_8822C 0x0658 -+#define REG_BACAMCONTENT_H_8822C 0x065C -+#define REG_LBDLY_8822C 0x0660 -+#define REG_WMAC_BACAM_RPMEN_8822C 0x0661 -+#define REG_TX_RX_8822C 0x0662 -+#define REG_WMAC_BITMAP_CTL_8822C 0x0663 -+#define REG_RXERR_RPT_8822C 0x0664 -+#define REG_WMAC_TRXPTCL_CTL_8822C 0x0668 -+#define REG_WMAC_TRXPTCL_CTL_H_8822C 0x066C -+#define REG_CAMCMD_8822C 0x0670 -+#define REG_CAMWRITE_8822C 0x0674 -+#define REG_CAMREAD_8822C 0x0678 -+#define REG_CAMDBG_8822C 0x067C -+#define REG_SECCFG_8822C 0x0680 -+#define REG_RXFILTER_CATEGORY_1_8822C 0x0682 -+#define REG_RXFILTER_ACTION_1_8822C 0x0683 -+#define REG_RXFILTER_CATEGORY_2_8822C 0x0684 -+#define REG_RXFILTER_ACTION_2_8822C 0x0685 -+#define REG_RXFILTER_CATEGORY_3_8822C 0x0686 -+#define REG_RXFILTER_ACTION_3_8822C 0x0687 -+#define REG_RXFLTMAP3_8822C 0x0688 -+#define REG_RXFLTMAP4_8822C 0x068A -+#define REG_RXFLTMAP5_8822C 0x068C -+#define REG_RXFLTMAP6_8822C 0x068E -+#define REG_WOW_CTRL_8822C 0x0690 -+#define REG_NAN_RX_TSF_FILTER_8822C 0x0691 -+#define REG_PS_RX_INFO_8822C 0x0692 -+#define REG_WMMPS_UAPSD_TID_8822C 0x0693 -+#define REG_LPNAV_CTRL_8822C 0x0694 -+#define REG_WKFMCAM_CMD_8822C 0x0698 -+#define REG_WKFMCAM_RWD_8822C 0x069C -+#define REG_RXFLTMAP0_8822C 0x06A0 -+#define REG_RXFLTMAP1_8822C 0x06A2 -+#define REG_RXFLTMAP2_8822C 0x06A4 -+#define REG_BCN_PSR_RPT_8822C 0x06A8 -+#define REG_FLC_RPC_8822C 0x06AC -+#define REG_FLC_RPCT_8822C 0x06AD -+#define REG_FLC_PTS_8822C 0x06AE -+#define REG_FLC_TRPC_8822C 0x06AF -+#define REG_RXPKTMON_CTRL_8822C 0x06B0 -+#define REG_STATE_MON_8822C 0x06B4 -+#define REG_ERROR_MON_8822C 0x06B8 -+#define REG_SEARCH_MACID_8822C 0x06BC -+#define REG_BT_COEX_TABLE_8822C 0x06C0 -+#define REG_BT_COEX_TABLE2_8822C 0x06C4 -+#define REG_BT_COEX_BREAK_TABLE_8822C 0x06C8 -+#define REG_BT_COEX_TABLE_H_8822C 0x06CC -+#define REG_RXCMD_0_8822C 0x06D0 -+#define REG_RXCMD_1_8822C 0x06D4 -+#define REG_WMAC_RESP_TXINFO_8822C 0x06D8 -+#define REG_BBPSF_CTRL_8822C 0x06DC -+#define REG_P2P_RX_BCN_NOA_8822C 0x06E0 -+#define REG_ASSOCIATED_BFMER0_INFO_8822C 0x06E4 -+#define REG_ASSOCIATED_BFMER0_INFO_H_8822C 0x06E8 -+#define REG_ASSOCIATED_BFMER1_INFO_8822C 0x06EC -+#define REG_ASSOCIATED_BFMER1_INFO_H_8822C 0x06F0 -+#define REG_TX_CSI_RPT_PARAM_BW20_8822C 0x06F4 -+#define REG_TX_CSI_RPT_PARAM_BW40_8822C 0x06F8 -+#define REG_CSI_PTR_8822C 0x06FC -+#define REG_BCN_PSR_RPT2_8822C 0x1600 -+#define REG_BCN_PSR_RPT3_8822C 0x1604 -+#define REG_BCN_PSR_RPT4_8822C 0x1608 -+#define REG_A1_ADDR_MASK_8822C 0x160C -+#define REG_RXPSF_CTRL_8822C 0x1610 -+#define REG_RXPSF_TYPE_CTRL_8822C 0x1614 -+#define REG_CAM_ACCESS_CTRL_8822C 0x1618 -+#define REG_HT_SND_REF_RATE_8822C 0x161C -+#define REG_MACID2_8822C 0x1620 -+#define REG_MACID2_H_8822C 0x1624 -+#define REG_BSSID2_8822C 0x1628 -+#define REG_BSSID2_H_8822C 0x162C -+#define REG_MACID3_8822C 0x1630 -+#define REG_MACID3_H_8822C 0x1634 -+#define REG_BSSID3_8822C 0x1638 -+#define REG_BSSID3_H_8822C 0x163C -+#define REG_MACID4_8822C 0x1640 -+#define REG_MACID4_H_8822C 0x1644 -+#define REG_BSSID4_8822C 0x1648 -+#define REG_BSSID4_H_8822C 0x164C -+#define REG_NOA_REPORT_8822C 0x1650 -+#define REG_NOA_REPORT_1_8822C 0x1654 -+#define REG_NOA_REPORT_2_8822C 0x1658 -+#define REG_NOA_REPORT_3_8822C 0x165C -+#define REG_PWRBIT_SETTING_8822C 0x1660 -+#define REG_GENERAL_OPTION_8822C 0x1664 -+#define REG_CSI_RRSR_8822C 0x1678 -+#define REG_MU_BF_OPTION_8822C 0x167C -+#define REG_WMAC_PAUSE_BB_CLR_TH_8822C 0x167D -+#define REG__WMAC_MULBK_BUF_8822C 0x167E -+#define REG_WMAC_MU_OPTION_8822C 0x167F -+#define REG_WMAC_MU_BF_CTL_8822C 0x1680 -+#define REG_WMAC_MU_BFRPT_PARA_8822C 0x1682 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE2_8822C 0x1684 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE3_8822C 0x1686 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE4_8822C 0x1688 -+#define REG_WMAC_ASSOCIATED_MU_BFMEE5_8822C 0x168A -+#define REG_WMAC_ASSOCIATED_MU_BFMEE6_8822C 0x168C -+#define REG_WMAC_ASSOCIATED_MU_BFMEE7_8822C 0x168E -+#define REG_WMAC_BB_STOP_RX_COUNTER_8822C 0x1690 -+#define REG_WMAC_PLCP_MONITOR_8822C 0x1694 -+#define REG_WMAC_PLCP_MONITOR_MUTX_8822C 0x1698 -+#define REG_WMAC_CSIDMA_CFG_8822C 0x169C -+#define REG_TRANSMIT_ADDRSS_0_8822C 0x16A0 -+#define REG_TRANSMIT_ADDRSS_0_H_8822C 0x16A4 -+#define REG_TRANSMIT_ADDRSS_1_8822C 0x16A8 -+#define REG_TRANSMIT_ADDRSS_1_H_8822C 0x16AC -+#define REG_TRANSMIT_ADDRSS_2_8822C 0x16B0 -+#define REG_TRANSMIT_ADDRSS_2_H_8822C 0x16B4 -+#define REG_TRANSMIT_ADDRSS_3_8822C 0x16B8 -+#define REG_TRANSMIT_ADDRSS_3_H_8822C 0x16BC -+#define REG_TRANSMIT_ADDRSS_4_8822C 0x16C0 -+#define REG_TRANSMIT_ADDRSS_4_H_8822C 0x16C4 -+#define REG_MACID1_8822C 0x0700 -+#define REG_MACID1_1_8822C 0x0704 -+#define REG_BSSID1_8822C 0x0708 -+#define REG_BSSID1_1_8822C 0x070C -+#define REG_BCN_PSR_RPT1_8822C 0x0710 -+#define REG_ASSOCIATED_BFMEE_SEL_8822C 0x0714 -+#define REG_SND_PTCL_CTRL_8822C 0x0718 -+#define REG_RX_CSI_RPT_INFO_8822C 0x071C -+#define REG_NS_ARP_CTRL_8822C 0x0720 -+#define REG_NS_ARP_INFO_8822C 0x0724 -+#define REG_BEAMFORMING_INFO_NSARP_V1_8822C 0x0728 -+#define REG_BEAMFORMING_INFO_NSARP_8822C 0x072C -+#define REG_IPV6_8822C 0x0730 -+#define REG_IPV6_1_8822C 0x0734 -+#define REG_IPV6_2_8822C 0x0738 -+#define REG_IPV6_3_8822C 0x073C -+#define REG_WMAC_RTX_CTX_SUBTYPE_CFG_8822C 0x0750 -+#define REG_WMAC_SWAES_DIO_B63_B32_8822C 0x0754 -+#define REG_WMAC_SWAES_DIO_B95_B64_8822C 0x0758 -+#define REG_WMAC_SWAES_DIO_B127_B96_8822C 0x075C -+#define REG_WMAC_SWAES_CFG_8822C 0x0760 -+#define REG_BT_COEX_V2_8822C 0x0762 -+#define REG_BT_COEX_8822C 0x0764 -+#define REG_WLAN_ACT_MASK_CTRL_8822C 0x0768 -+#define REG_WLAN_ACT_MASK_CTRL_1_8822C 0x076C -+#define REG_BT_COEX_ENHANCED_INTR_CTRL_8822C 0x076E -+#define REG_BT_ACT_STATISTICS_8822C 0x0770 -+#define REG_BT_ACT_STATISTICS_1_8822C 0x0774 -+#define REG_BT_STATISTICS_CONTROL_REGISTER_8822C 0x0778 -+#define REG_BT_STATUS_REPORT_REGISTER_8822C 0x077C -+#define REG_BT_INTERRUPT_CONTROL_REGISTER_8822C 0x0780 -+#define REG_WLAN_REPORT_TIME_OUT_CONTROL_REGISTER_8822C 0x0784 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_8822C 0x0785 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_1_8822C 0x0788 -+#define REG_BT_ISOLATION_TABLE_REGISTER_REGISTER_2_8822C 0x078C -+#define REG_BT_INTERRUPT_STATUS_REGISTER_8822C 0x078F -+#define REG_BT_TDMA_TIME_REGISTER_8822C 0x0790 -+#define REG_BT_ACT_REGISTER_8822C 0x0794 -+#define REG_OBFF_CTRL_BASIC_8822C 0x0798 -+#define REG_OBFF_CTRL2_TIMER_8822C 0x079C -+#define REG_LTR_CTRL_BASIC_8822C 0x07A0 -+#define REG_LTR_CTRL2_TIMER_THRESHOLD_8822C 0x07A4 -+#define REG_LTR_IDLE_LATENCY_V1_8822C 0x07A8 -+#define REG_LTR_ACTIVE_LATENCY_V1_8822C 0x07AC -+#define REG_ANTENNA_TRAINING_CONTROL_REGISTER_8822C 0x07B0 -+#define REG_ANTENNA_TRAINING_CONTROL_REGISTER_1_8822C 0x07B4 -+#define REG_WMAC_PKTCNT_RWD_8822C 0x07B8 -+#define REG_WMAC_PKTCNT_CTRL_8822C 0x07BC -+#define REG_IQ_DUMP_8822C 0x07C0 -+#define REG_IQ_DUMP_1_8822C 0x07C4 -+#define REG_IQ_DUMP_2_8822C 0x07C8 -+#define REG_WMAC_FTM_CTL_8822C 0x07CC -+#define REG_WMAC_IQ_MDPK_FUNC_8822C 0x07CE -+#define REG_WMAC_OPTION_FUNCTION_8822C 0x07D0 -+#define REG_WMAC_OPTION_FUNCTION_1_8822C 0x07D4 -+#define REG_WMAC_OPTION_FUNCTION_2_8822C 0x07D8 -+#define REG_RX_FILTER_FUNCTION_8822C 0x07DA -+#define REG_NDP_SIG_8822C 0x07E0 -+#define REG_TXCMD_INFO_FOR_RSP_PKT_8822C 0x07E4 -+#define REG_TXCMD_INFO_FOR_RSP_PKT_1_8822C 0x07E8 -+#define REG_WSEC_OPTION_8822C 0x07EC -+#define REG_RTS_ADDRESS_0_8822C 0x07F0 -+#define REG_RTS_ADDRESS_0_1_8822C 0x07F4 -+#define REG_RTS_ADDRESS_1_8822C 0x07F8 -+#define REG_RTS_ADDRESS_1_1_8822C 0x07FC -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1_8822C 0x1700 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1_8822C 0x1704 -+#define REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1_8822C 0x1708 -+#define REG_SDIO_TX_CTRL_8822C 0x10250000 -+#define REG_SDIO_CMD11_VOL_SWITCH_8822C 0x10250004 -+#define REG_SDIO_CTRL_8822C 0x10250005 -+#define REG_SDIO_DRIVING_8822C 0x10250006 -+#define REG_SDIO_MONITOR_8822C 0x10250008 -+#define REG_SDIO_MONITOR_2_8822C 0x1025000C -+#define REG_SDIO_HIMR_8822C 0x10250014 -+#define REG_SDIO_HISR_8822C 0x10250018 -+#define REG_SDIO_RX_REQ_LEN_8822C 0x1025001C -+#define REG_SDIO_FREE_TXPG_SEQ_V1_8822C 0x1025001F -+#define REG_SDIO_FREE_TXPG_8822C 0x10250020 -+#define REG_SDIO_FREE_TXPG2_8822C 0x10250024 -+#define REG_SDIO_OQT_FREE_TXPG_V1_8822C 0x10250028 -+#define REG_SDIO_TXPKT_EMPTY_8822C 0x1025002C -+#define REG_SDIO_HTSFR_INFO_8822C 0x10250030 -+#define REG_SDIO_HCPWM1_V2_8822C 0x10250038 -+#define REG_SDIO_HCPWM2_V2_8822C 0x1025003A -+#define REG_SDIO_INDIRECT_REG_CFG_8822C 0x10250040 -+#define REG_SDIO_INDIRECT_REG_DATA_8822C 0x10250044 -+#define REG_SDIO_H2C_8822C 0x10250060 -+#define REG_SDIO_C2H_8822C 0x10250064 -+#define REG_SDIO_HRPWM1_8822C 0x10250080 -+#define REG_SDIO_HRPWM2_8822C 0x10250082 -+#define REG_SDIO_HPS_CLKR_8822C 0x10250084 -+#define REG_SDIO_BUS_CTRL_8822C 0x10250085 -+#define REG_SDIO_HSUS_CTRL_8822C 0x10250086 -+#define REG_SDIO_RESPONSE_TIMER_8822C 0x10250088 -+#define REG_SDIO_CMD_CRC_8822C 0x1025008A -+#define REG_SDIO_HSISR_8822C 0x10250090 -+#define REG_SDIO_HSIMR_8822C 0x10250091 -+#define REG_SDIO_DIOERR_RPT_8822C 0x102500C0 -+#define REG_SDIO_CMD_ERRCNT_8822C 0x102500C2 -+#define REG_SDIO_DATA_ERRCNT_8822C 0x102500C3 -+#define REG_SDIO_CMD_ERR_CONTENT_8822C 0x102500C4 -+#define REG_SDIO_CRC_ERR_IDX_8822C 0x102500C9 -+#define REG_SDIO_DATA_CRC_8822C 0x102500CA -+#define REG_SDIO_TRANS_FIFO_STATUS_8822C 0x102500CC -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_bd_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_bd_nic.h -new file mode 100644 -index 000000000..741f9ecc4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_bd_nic.h -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_RX_BD_NIC_H_ -+#define _HALMAC_RX_BD_NIC_H_ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT ||\ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/*TXBD_DW0*/ -+ -+#define GET_RX_BD_RXFAIL(rxbd) LE_BITS_TO_4BYTE(rxbd + 0x00, 31, 1) -+#define GET_RX_BD_TOTALRXPKTSIZE(rxbd) LE_BITS_TO_4BYTE(rxbd + 0x00, 16, 13) -+#define GET_RX_BD_RXTAG(rxbd) LE_BITS_TO_4BYTE(rxbd + 0x00, 16, 13) -+#define GET_RX_BD_FS(rxbd) LE_BITS_TO_4BYTE(rxbd + 0x00, 15, 1) -+#define GET_RX_BD_LS(rxbd) LE_BITS_TO_4BYTE(rxbd + 0x00, 14, 1) -+#define GET_RX_BD_RXBUFFSIZE(rxbd) LE_BITS_TO_4BYTE(rxbd + 0x00, 0, 14) -+ -+/*TXBD_DW1*/ -+ -+#define GET_RX_BD_PHYSICAL_ADDR_LOW(rxbd) LE_BITS_TO_4BYTE(rxbd + 0x04, 0, 32) -+ -+/*TXBD_DW2*/ -+ -+#define GET_RX_BD_PHYSICAL_ADDR_HIGH(rxbd) LE_BITS_TO_4BYTE(rxbd + 0x08, 0, 32) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_desc_ap.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_desc_ap.h -new file mode 100644 -index 000000000..312d5b835 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_desc_ap.h -@@ -0,0 +1,690 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_RX_DESC_AP_H_ -+#define _HALMAC_RX_DESC_AP_H_ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0x1, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PHYPKTIDC(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0x1, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_EVT_PKT(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0x1, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_SWDEC(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0x1, \ -+ 27) -+#define GET_RX_DESC_PHYST(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0x1, \ -+ 26) -+#define GET_RX_DESC_SHIFT(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0x3, \ -+ 24) -+#define GET_RX_DESC_QOS(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0x1, \ -+ 23) -+#define GET_RX_DESC_SECURITY(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0x7, \ -+ 20) -+#define GET_RX_DESC_DRV_INFO_SIZE(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0xf, \ -+ 16) -+#define GET_RX_DESC_ICV_ERR(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0x1, \ -+ 15) -+#define GET_RX_DESC_CRC32(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, 0x1, \ -+ 14) -+#define GET_RX_DESC_PKT_LEN(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword0, \ -+ 0x3fff, 0) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 31) -+#define GET_RX_DESC_MC(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_TY_PE(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x3, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_TYPE(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x3, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_MF(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 27) -+#define GET_RX_DESC_MD(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 26) -+#define GET_RX_DESC_PWR(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 25) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PAM(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_A1_MATCH(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_CHK_VLD(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 23) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_TCP_CHKSUM_VLD(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 23) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 22) -+#define GET_RX_DESC_RX_IPV(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 21) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_CHKERR(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 20) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_TCP_CHKSUM_ERR(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 20) -+#define GET_RX_DESC_PHY_PKT_IDC(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 17) -+#define GET_RX_DESC_FW_FIFO_FULL(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PAGGR(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 15) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_AMPDU(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 15) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RXID_MATCH(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 14) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_RXCMD_IDC(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 14) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_AMSDU(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_MACID_VLD(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x1, \ -+ 12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_TID(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0xf, 8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_MACID(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword1, 0x7f, \ -+ 0) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x1, \ -+ 31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_AMSDU_CUT(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x1, \ -+ 31) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PPDU_CNT(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x3, \ -+ 29) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_C2H(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x1, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define GET_RX_DESC_HWRSVD_V1(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x7, \ -+ 25) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_HWRSVD(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0xf, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8192F_SUPPORT) -+ -+#define GET_RX_DESC_RXMAGPKT(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x1, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_WLANHD_IV_LEN(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x3f, \ -+ 18) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_LAST_MSDU(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x1, \ -+ 17) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_STATISTICS(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x1, \ -+ 17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_IS_QOS(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x1, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_EXT_SEC_TYPE(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0x1, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_FRAG(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, 0xf, \ -+ 12) -+#define GET_RX_DESC_SEQ(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword2, \ -+ 0xfff, 0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1, \ -+ 31) -+#define GET_RX_DESC_UNICAST_WAKE(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PATTERN_MATCH(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1, \ -+ 29) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_PATTERN_WAKE(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1, \ -+ 29) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RXPAYLOAD_MATCH(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1, \ -+ 28) -+#define GET_RX_DESC_RXPAYLOAD_ID(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0xf, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_DMA_AGG_NUM(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0xff, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_BSSID_FIT_1_0(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x3, \ -+ 12) -+#define GET_RX_DESC_EOSP(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1, \ -+ 11) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_BSSID_FIT(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1f, \ -+ 11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_HTC(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1, \ -+ 10) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_AMPDU_END_PKT(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1, 9) -+#define GET_RX_DESC_ADDRESS_CAM_VLD(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1, 8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_BSSID_FIT_4_2(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x7, 7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_EOSP_V1(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x1, 7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_RATE(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword3, 0x7f, \ -+ 0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1f, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_ADDRESS_CAM(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0xff, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define GET_RX_DESC_A1_FIT_A1(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x7f, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_MACID_VLD_V1(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1, \ -+ 23) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_MACID_RPT_BUFF(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x7f, \ -+ 17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_PRE_NDP_VLD(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define GET_RX_DESC_SWPS_RPT_V1(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_MACID_V1(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0xff, \ -+ 15) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define GET_RX_DESC_FC_POWER_V1(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1, \ -+ 15) -+#define GET_RX_DESC_TXRPTMID_CTL_MASK_V1(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1, \ -+ 14) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_SCRAMBLER(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x7f, \ -+ 9) -+#define GET_RX_DESC_RX_EOF(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1, 8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define GET_RX_DESC_SNIF_INFO(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x3f, \ -+ 8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define GET_RX_DESC_FC_POWER(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1, 7) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define GET_RX_DESC_TXRPTMID_CTL_MASK(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1, 6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define GET_RX_DESC_SWPS_RPT(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1, 5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PATTERN_IDX(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0xff, \ -+ 0) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define GET_RX_DESC_PATTERN_IDX_V1(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1f, \ -+ 0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_PATTERN_IDX_V2(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword4, 0x1f, \ -+ 0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword5, \ -+ 0xffffffff, 0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_FREERUN_CNT(rxdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_rx_desc *)rxdesc)->dword5, \ -+ 0xffffffff, 0) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_desc_chip.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_desc_chip.h -new file mode 100644 -index 000000000..15ac23e99 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_desc_chip.h -@@ -0,0 +1,862 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_RX_DESC_CHIP_H_ -+#define _HALMAC_RX_DESC_CHIP_H_ -+#if (HALMAC_8814A_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR_8814A(rxdesc) GET_RX_DESC_EOR(rxdesc) -+#define GET_RX_DESC_PHYPKTIDC_8814A(rxdesc) GET_RX_DESC_PHYPKTIDC(rxdesc) -+#define GET_RX_DESC_SWDEC_8814A(rxdesc) GET_RX_DESC_SWDEC(rxdesc) -+#define GET_RX_DESC_PHYST_8814A(rxdesc) GET_RX_DESC_PHYST(rxdesc) -+#define GET_RX_DESC_SHIFT_8814A(rxdesc) GET_RX_DESC_SHIFT(rxdesc) -+#define GET_RX_DESC_QOS_8814A(rxdesc) GET_RX_DESC_QOS(rxdesc) -+#define GET_RX_DESC_SECURITY_8814A(rxdesc) GET_RX_DESC_SECURITY(rxdesc) -+#define GET_RX_DESC_DRV_INFO_SIZE_8814A(rxdesc) \ -+ GET_RX_DESC_DRV_INFO_SIZE(rxdesc) -+#define GET_RX_DESC_ICV_ERR_8814A(rxdesc) GET_RX_DESC_ICV_ERR(rxdesc) -+#define GET_RX_DESC_CRC32_8814A(rxdesc) GET_RX_DESC_CRC32(rxdesc) -+#define GET_RX_DESC_PKT_LEN_8814A(rxdesc) GET_RX_DESC_PKT_LEN(rxdesc) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC_8814A(rxdesc) GET_RX_DESC_BC(rxdesc) -+#define GET_RX_DESC_MC_8814A(rxdesc) GET_RX_DESC_MC(rxdesc) -+#define GET_RX_DESC_TY_PE_8814A(rxdesc) GET_RX_DESC_TY_PE(rxdesc) -+#define GET_RX_DESC_MF_8814A(rxdesc) GET_RX_DESC_MF(rxdesc) -+#define GET_RX_DESC_MD_8814A(rxdesc) GET_RX_DESC_MD(rxdesc) -+#define GET_RX_DESC_PWR_8814A(rxdesc) GET_RX_DESC_PWR(rxdesc) -+#define GET_RX_DESC_PAM_8814A(rxdesc) GET_RX_DESC_PAM(rxdesc) -+#define GET_RX_DESC_CHK_VLD_8814A(rxdesc) GET_RX_DESC_CHK_VLD(rxdesc) -+#define GET_RX_DESC_RX_IS_TCP_UDP_8814A(rxdesc) \ -+ GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) -+#define GET_RX_DESC_RX_IPV_8814A(rxdesc) GET_RX_DESC_RX_IPV(rxdesc) -+#define GET_RX_DESC_CHKERR_8814A(rxdesc) GET_RX_DESC_CHKERR(rxdesc) -+#define GET_RX_DESC_PAGGR_8814A(rxdesc) GET_RX_DESC_PAGGR(rxdesc) -+#define GET_RX_DESC_RXID_MATCH_8814A(rxdesc) GET_RX_DESC_RXID_MATCH(rxdesc) -+#define GET_RX_DESC_AMSDU_8814A(rxdesc) GET_RX_DESC_AMSDU(rxdesc) -+#define GET_RX_DESC_MACID_VLD_8814A(rxdesc) GET_RX_DESC_MACID_VLD(rxdesc) -+#define GET_RX_DESC_TID_8814A(rxdesc) GET_RX_DESC_TID(rxdesc) -+#define GET_RX_DESC_MACID_8814A(rxdesc) GET_RX_DESC_MACID(rxdesc) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK_8814A(rxdesc) GET_RX_DESC_FCS_OK(rxdesc) -+#define GET_RX_DESC_C2H_8814A(rxdesc) GET_RX_DESC_C2H(rxdesc) -+#define GET_RX_DESC_HWRSVD_8814A(rxdesc) GET_RX_DESC_HWRSVD(rxdesc) -+#define GET_RX_DESC_WLANHD_IV_LEN_8814A(rxdesc) \ -+ GET_RX_DESC_WLANHD_IV_LEN(rxdesc) -+#define GET_RX_DESC_RX_IS_QOS_8814A(rxdesc) GET_RX_DESC_RX_IS_QOS(rxdesc) -+#define GET_RX_DESC_FRAG_8814A(rxdesc) GET_RX_DESC_FRAG(rxdesc) -+#define GET_RX_DESC_SEQ_8814A(rxdesc) GET_RX_DESC_SEQ(rxdesc) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE_8814A(rxdesc) GET_RX_DESC_MAGIC_WAKE(rxdesc) -+#define GET_RX_DESC_UNICAST_WAKE_8814A(rxdesc) GET_RX_DESC_UNICAST_WAKE(rxdesc) -+#define GET_RX_DESC_PATTERN_MATCH_8814A(rxdesc) \ -+ GET_RX_DESC_PATTERN_MATCH(rxdesc) -+#define GET_RX_DESC_DMA_AGG_NUM_8814A(rxdesc) GET_RX_DESC_DMA_AGG_NUM(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_1_0_8814A(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_1_0(rxdesc) -+#define GET_RX_DESC_EOSP_8814A(rxdesc) GET_RX_DESC_EOSP(rxdesc) -+#define GET_RX_DESC_HTC_8814A(rxdesc) GET_RX_DESC_HTC(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_4_2_8814A(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_4_2(rxdesc) -+#define GET_RX_DESC_RX_RATE_8814A(rxdesc) GET_RX_DESC_RX_RATE(rxdesc) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT_8814A(rxdesc) GET_RX_DESC_A1_FIT(rxdesc) -+#define GET_RX_DESC_MACID_RPT_BUFF_8814A(rxdesc) \ -+ GET_RX_DESC_MACID_RPT_BUFF(rxdesc) -+#define GET_RX_DESC_RX_PRE_NDP_VLD_8814A(rxdesc) \ -+ GET_RX_DESC_RX_PRE_NDP_VLD(rxdesc) -+#define GET_RX_DESC_RX_SCRAMBLER_8814A(rxdesc) GET_RX_DESC_RX_SCRAMBLER(rxdesc) -+#define GET_RX_DESC_RX_EOF_8814A(rxdesc) GET_RX_DESC_RX_EOF(rxdesc) -+#define GET_RX_DESC_PATTERN_IDX_8814A(rxdesc) GET_RX_DESC_PATTERN_IDX(rxdesc) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL_8814A(rxdesc) GET_RX_DESC_TSFL(rxdesc) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR_8822B(rxdesc) GET_RX_DESC_EOR(rxdesc) -+#define GET_RX_DESC_PHYPKTIDC_8822B(rxdesc) GET_RX_DESC_PHYPKTIDC(rxdesc) -+#define GET_RX_DESC_SWDEC_8822B(rxdesc) GET_RX_DESC_SWDEC(rxdesc) -+#define GET_RX_DESC_PHYST_8822B(rxdesc) GET_RX_DESC_PHYST(rxdesc) -+#define GET_RX_DESC_SHIFT_8822B(rxdesc) GET_RX_DESC_SHIFT(rxdesc) -+#define GET_RX_DESC_QOS_8822B(rxdesc) GET_RX_DESC_QOS(rxdesc) -+#define GET_RX_DESC_SECURITY_8822B(rxdesc) GET_RX_DESC_SECURITY(rxdesc) -+#define GET_RX_DESC_DRV_INFO_SIZE_8822B(rxdesc) \ -+ GET_RX_DESC_DRV_INFO_SIZE(rxdesc) -+#define GET_RX_DESC_ICV_ERR_8822B(rxdesc) GET_RX_DESC_ICV_ERR(rxdesc) -+#define GET_RX_DESC_CRC32_8822B(rxdesc) GET_RX_DESC_CRC32(rxdesc) -+#define GET_RX_DESC_PKT_LEN_8822B(rxdesc) GET_RX_DESC_PKT_LEN(rxdesc) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC_8822B(rxdesc) GET_RX_DESC_BC(rxdesc) -+#define GET_RX_DESC_MC_8822B(rxdesc) GET_RX_DESC_MC(rxdesc) -+#define GET_RX_DESC_TY_PE_8822B(rxdesc) GET_RX_DESC_TY_PE(rxdesc) -+#define GET_RX_DESC_MF_8822B(rxdesc) GET_RX_DESC_MF(rxdesc) -+#define GET_RX_DESC_MD_8822B(rxdesc) GET_RX_DESC_MD(rxdesc) -+#define GET_RX_DESC_PWR_8822B(rxdesc) GET_RX_DESC_PWR(rxdesc) -+#define GET_RX_DESC_PAM_8822B(rxdesc) GET_RX_DESC_PAM(rxdesc) -+#define GET_RX_DESC_CHK_VLD_8822B(rxdesc) GET_RX_DESC_CHK_VLD(rxdesc) -+#define GET_RX_DESC_RX_IS_TCP_UDP_8822B(rxdesc) \ -+ GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) -+#define GET_RX_DESC_RX_IPV_8822B(rxdesc) GET_RX_DESC_RX_IPV(rxdesc) -+#define GET_RX_DESC_CHKERR_8822B(rxdesc) GET_RX_DESC_CHKERR(rxdesc) -+#define GET_RX_DESC_PAGGR_8822B(rxdesc) GET_RX_DESC_PAGGR(rxdesc) -+#define GET_RX_DESC_RXID_MATCH_8822B(rxdesc) GET_RX_DESC_RXID_MATCH(rxdesc) -+#define GET_RX_DESC_AMSDU_8822B(rxdesc) GET_RX_DESC_AMSDU(rxdesc) -+#define GET_RX_DESC_MACID_VLD_8822B(rxdesc) GET_RX_DESC_MACID_VLD(rxdesc) -+#define GET_RX_DESC_TID_8822B(rxdesc) GET_RX_DESC_TID(rxdesc) -+#define GET_RX_DESC_MACID_8822B(rxdesc) GET_RX_DESC_MACID(rxdesc) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK_8822B(rxdesc) GET_RX_DESC_FCS_OK(rxdesc) -+#define GET_RX_DESC_PPDU_CNT_8822B(rxdesc) GET_RX_DESC_PPDU_CNT(rxdesc) -+#define GET_RX_DESC_C2H_8822B(rxdesc) GET_RX_DESC_C2H(rxdesc) -+#define GET_RX_DESC_HWRSVD_8822B(rxdesc) GET_RX_DESC_HWRSVD(rxdesc) -+#define GET_RX_DESC_WLANHD_IV_LEN_8822B(rxdesc) \ -+ GET_RX_DESC_WLANHD_IV_LEN(rxdesc) -+#define GET_RX_DESC_RX_IS_QOS_8822B(rxdesc) GET_RX_DESC_RX_IS_QOS(rxdesc) -+#define GET_RX_DESC_FRAG_8822B(rxdesc) GET_RX_DESC_FRAG(rxdesc) -+#define GET_RX_DESC_SEQ_8822B(rxdesc) GET_RX_DESC_SEQ(rxdesc) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE_8822B(rxdesc) GET_RX_DESC_MAGIC_WAKE(rxdesc) -+#define GET_RX_DESC_UNICAST_WAKE_8822B(rxdesc) GET_RX_DESC_UNICAST_WAKE(rxdesc) -+#define GET_RX_DESC_PATTERN_MATCH_8822B(rxdesc) \ -+ GET_RX_DESC_PATTERN_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_MATCH_8822B(rxdesc) \ -+ GET_RX_DESC_RXPAYLOAD_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_ID_8822B(rxdesc) GET_RX_DESC_RXPAYLOAD_ID(rxdesc) -+#define GET_RX_DESC_DMA_AGG_NUM_8822B(rxdesc) GET_RX_DESC_DMA_AGG_NUM(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_1_0_8822B(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_1_0(rxdesc) -+#define GET_RX_DESC_EOSP_8822B(rxdesc) GET_RX_DESC_EOSP(rxdesc) -+#define GET_RX_DESC_HTC_8822B(rxdesc) GET_RX_DESC_HTC(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_4_2_8822B(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_4_2(rxdesc) -+#define GET_RX_DESC_RX_RATE_8822B(rxdesc) GET_RX_DESC_RX_RATE(rxdesc) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT_8822B(rxdesc) GET_RX_DESC_A1_FIT(rxdesc) -+#define GET_RX_DESC_MACID_RPT_BUFF_8822B(rxdesc) \ -+ GET_RX_DESC_MACID_RPT_BUFF(rxdesc) -+#define GET_RX_DESC_RX_PRE_NDP_VLD_8822B(rxdesc) \ -+ GET_RX_DESC_RX_PRE_NDP_VLD(rxdesc) -+#define GET_RX_DESC_RX_SCRAMBLER_8822B(rxdesc) GET_RX_DESC_RX_SCRAMBLER(rxdesc) -+#define GET_RX_DESC_RX_EOF_8822B(rxdesc) GET_RX_DESC_RX_EOF(rxdesc) -+#define GET_RX_DESC_PATTERN_IDX_8822B(rxdesc) GET_RX_DESC_PATTERN_IDX(rxdesc) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL_8822B(rxdesc) GET_RX_DESC_TSFL(rxdesc) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR_8197F(rxdesc) GET_RX_DESC_EOR(rxdesc) -+#define GET_RX_DESC_PHYPKTIDC_8197F(rxdesc) GET_RX_DESC_PHYPKTIDC(rxdesc) -+#define GET_RX_DESC_SWDEC_8197F(rxdesc) GET_RX_DESC_SWDEC(rxdesc) -+#define GET_RX_DESC_PHYST_8197F(rxdesc) GET_RX_DESC_PHYST(rxdesc) -+#define GET_RX_DESC_SHIFT_8197F(rxdesc) GET_RX_DESC_SHIFT(rxdesc) -+#define GET_RX_DESC_QOS_8197F(rxdesc) GET_RX_DESC_QOS(rxdesc) -+#define GET_RX_DESC_SECURITY_8197F(rxdesc) GET_RX_DESC_SECURITY(rxdesc) -+#define GET_RX_DESC_DRV_INFO_SIZE_8197F(rxdesc) \ -+ GET_RX_DESC_DRV_INFO_SIZE(rxdesc) -+#define GET_RX_DESC_ICV_ERR_8197F(rxdesc) GET_RX_DESC_ICV_ERR(rxdesc) -+#define GET_RX_DESC_CRC32_8197F(rxdesc) GET_RX_DESC_CRC32(rxdesc) -+#define GET_RX_DESC_PKT_LEN_8197F(rxdesc) GET_RX_DESC_PKT_LEN(rxdesc) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC_8197F(rxdesc) GET_RX_DESC_BC(rxdesc) -+#define GET_RX_DESC_MC_8197F(rxdesc) GET_RX_DESC_MC(rxdesc) -+#define GET_RX_DESC_TY_PE_8197F(rxdesc) GET_RX_DESC_TY_PE(rxdesc) -+#define GET_RX_DESC_MF_8197F(rxdesc) GET_RX_DESC_MF(rxdesc) -+#define GET_RX_DESC_MD_8197F(rxdesc) GET_RX_DESC_MD(rxdesc) -+#define GET_RX_DESC_PWR_8197F(rxdesc) GET_RX_DESC_PWR(rxdesc) -+#define GET_RX_DESC_PAM_8197F(rxdesc) GET_RX_DESC_PAM(rxdesc) -+#define GET_RX_DESC_CHK_VLD_8197F(rxdesc) GET_RX_DESC_CHK_VLD(rxdesc) -+#define GET_RX_DESC_RX_IS_TCP_UDP_8197F(rxdesc) \ -+ GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) -+#define GET_RX_DESC_RX_IPV_8197F(rxdesc) GET_RX_DESC_RX_IPV(rxdesc) -+#define GET_RX_DESC_CHKERR_8197F(rxdesc) GET_RX_DESC_CHKERR(rxdesc) -+#define GET_RX_DESC_PAGGR_8197F(rxdesc) GET_RX_DESC_PAGGR(rxdesc) -+#define GET_RX_DESC_RXID_MATCH_8197F(rxdesc) GET_RX_DESC_RXID_MATCH(rxdesc) -+#define GET_RX_DESC_AMSDU_8197F(rxdesc) GET_RX_DESC_AMSDU(rxdesc) -+#define GET_RX_DESC_MACID_VLD_8197F(rxdesc) GET_RX_DESC_MACID_VLD(rxdesc) -+#define GET_RX_DESC_TID_8197F(rxdesc) GET_RX_DESC_TID(rxdesc) -+#define GET_RX_DESC_MACID_8197F(rxdesc) GET_RX_DESC_MACID(rxdesc) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK_8197F(rxdesc) GET_RX_DESC_FCS_OK(rxdesc) -+#define GET_RX_DESC_C2H_8197F(rxdesc) GET_RX_DESC_C2H(rxdesc) -+#define GET_RX_DESC_HWRSVD_8197F(rxdesc) GET_RX_DESC_HWRSVD(rxdesc) -+#define GET_RX_DESC_WLANHD_IV_LEN_8197F(rxdesc) \ -+ GET_RX_DESC_WLANHD_IV_LEN(rxdesc) -+#define GET_RX_DESC_RX_IS_QOS_8197F(rxdesc) GET_RX_DESC_RX_IS_QOS(rxdesc) -+#define GET_RX_DESC_FRAG_8197F(rxdesc) GET_RX_DESC_FRAG(rxdesc) -+#define GET_RX_DESC_SEQ_8197F(rxdesc) GET_RX_DESC_SEQ(rxdesc) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE_8197F(rxdesc) GET_RX_DESC_MAGIC_WAKE(rxdesc) -+#define GET_RX_DESC_UNICAST_WAKE_8197F(rxdesc) GET_RX_DESC_UNICAST_WAKE(rxdesc) -+#define GET_RX_DESC_PATTERN_MATCH_8197F(rxdesc) \ -+ GET_RX_DESC_PATTERN_MATCH(rxdesc) -+#define GET_RX_DESC_DMA_AGG_NUM_8197F(rxdesc) GET_RX_DESC_DMA_AGG_NUM(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_1_0_8197F(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_1_0(rxdesc) -+#define GET_RX_DESC_EOSP_8197F(rxdesc) GET_RX_DESC_EOSP(rxdesc) -+#define GET_RX_DESC_HTC_8197F(rxdesc) GET_RX_DESC_HTC(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_4_2_8197F(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_4_2(rxdesc) -+#define GET_RX_DESC_RX_RATE_8197F(rxdesc) GET_RX_DESC_RX_RATE(rxdesc) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT_8197F(rxdesc) GET_RX_DESC_A1_FIT(rxdesc) -+#define GET_RX_DESC_MACID_RPT_BUFF_8197F(rxdesc) \ -+ GET_RX_DESC_MACID_RPT_BUFF(rxdesc) -+#define GET_RX_DESC_RX_PRE_NDP_VLD_8197F(rxdesc) \ -+ GET_RX_DESC_RX_PRE_NDP_VLD(rxdesc) -+#define GET_RX_DESC_RX_SCRAMBLER_8197F(rxdesc) GET_RX_DESC_RX_SCRAMBLER(rxdesc) -+#define GET_RX_DESC_RX_EOF_8197F(rxdesc) GET_RX_DESC_RX_EOF(rxdesc) -+#define GET_RX_DESC_FC_POWER_8197F(rxdesc) GET_RX_DESC_FC_POWER(rxdesc) -+#define GET_RX_DESC_PATTERN_IDX_8197F(rxdesc) GET_RX_DESC_PATTERN_IDX_V1(rxdesc) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL_8197F(rxdesc) GET_RX_DESC_TSFL(rxdesc) -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR_8821C(rxdesc) GET_RX_DESC_EOR(rxdesc) -+#define GET_RX_DESC_PHYPKTIDC_8821C(rxdesc) GET_RX_DESC_PHYPKTIDC(rxdesc) -+#define GET_RX_DESC_SWDEC_8821C(rxdesc) GET_RX_DESC_SWDEC(rxdesc) -+#define GET_RX_DESC_PHYST_8821C(rxdesc) GET_RX_DESC_PHYST(rxdesc) -+#define GET_RX_DESC_SHIFT_8821C(rxdesc) GET_RX_DESC_SHIFT(rxdesc) -+#define GET_RX_DESC_QOS_8821C(rxdesc) GET_RX_DESC_QOS(rxdesc) -+#define GET_RX_DESC_SECURITY_8821C(rxdesc) GET_RX_DESC_SECURITY(rxdesc) -+#define GET_RX_DESC_DRV_INFO_SIZE_8821C(rxdesc) \ -+ GET_RX_DESC_DRV_INFO_SIZE(rxdesc) -+#define GET_RX_DESC_ICV_ERR_8821C(rxdesc) GET_RX_DESC_ICV_ERR(rxdesc) -+#define GET_RX_DESC_CRC32_8821C(rxdesc) GET_RX_DESC_CRC32(rxdesc) -+#define GET_RX_DESC_PKT_LEN_8821C(rxdesc) GET_RX_DESC_PKT_LEN(rxdesc) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC_8821C(rxdesc) GET_RX_DESC_BC(rxdesc) -+#define GET_RX_DESC_MC_8821C(rxdesc) GET_RX_DESC_MC(rxdesc) -+#define GET_RX_DESC_TY_PE_8821C(rxdesc) GET_RX_DESC_TY_PE(rxdesc) -+#define GET_RX_DESC_MF_8821C(rxdesc) GET_RX_DESC_MF(rxdesc) -+#define GET_RX_DESC_MD_8821C(rxdesc) GET_RX_DESC_MD(rxdesc) -+#define GET_RX_DESC_PWR_8821C(rxdesc) GET_RX_DESC_PWR(rxdesc) -+#define GET_RX_DESC_PAM_8821C(rxdesc) GET_RX_DESC_PAM(rxdesc) -+#define GET_RX_DESC_CHK_VLD_8821C(rxdesc) GET_RX_DESC_CHK_VLD(rxdesc) -+#define GET_RX_DESC_RX_IS_TCP_UDP_8821C(rxdesc) \ -+ GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) -+#define GET_RX_DESC_RX_IPV_8821C(rxdesc) GET_RX_DESC_RX_IPV(rxdesc) -+#define GET_RX_DESC_CHKERR_8821C(rxdesc) GET_RX_DESC_CHKERR(rxdesc) -+#define GET_RX_DESC_PAGGR_8821C(rxdesc) GET_RX_DESC_PAGGR(rxdesc) -+#define GET_RX_DESC_RXID_MATCH_8821C(rxdesc) GET_RX_DESC_RXID_MATCH(rxdesc) -+#define GET_RX_DESC_AMSDU_8821C(rxdesc) GET_RX_DESC_AMSDU(rxdesc) -+#define GET_RX_DESC_MACID_VLD_8821C(rxdesc) GET_RX_DESC_MACID_VLD(rxdesc) -+#define GET_RX_DESC_TID_8821C(rxdesc) GET_RX_DESC_TID(rxdesc) -+#define GET_RX_DESC_MACID_8821C(rxdesc) GET_RX_DESC_MACID(rxdesc) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK_8821C(rxdesc) GET_RX_DESC_FCS_OK(rxdesc) -+#define GET_RX_DESC_PPDU_CNT_8821C(rxdesc) GET_RX_DESC_PPDU_CNT(rxdesc) -+#define GET_RX_DESC_C2H_8821C(rxdesc) GET_RX_DESC_C2H(rxdesc) -+#define GET_RX_DESC_HWRSVD_8821C(rxdesc) GET_RX_DESC_HWRSVD(rxdesc) -+#define GET_RX_DESC_WLANHD_IV_LEN_8821C(rxdesc) \ -+ GET_RX_DESC_WLANHD_IV_LEN(rxdesc) -+#define GET_RX_DESC_RX_IS_QOS_8821C(rxdesc) GET_RX_DESC_RX_IS_QOS(rxdesc) -+#define GET_RX_DESC_FRAG_8821C(rxdesc) GET_RX_DESC_FRAG(rxdesc) -+#define GET_RX_DESC_SEQ_8821C(rxdesc) GET_RX_DESC_SEQ(rxdesc) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE_8821C(rxdesc) GET_RX_DESC_MAGIC_WAKE(rxdesc) -+#define GET_RX_DESC_UNICAST_WAKE_8821C(rxdesc) GET_RX_DESC_UNICAST_WAKE(rxdesc) -+#define GET_RX_DESC_PATTERN_MATCH_8821C(rxdesc) \ -+ GET_RX_DESC_PATTERN_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_MATCH_8821C(rxdesc) \ -+ GET_RX_DESC_RXPAYLOAD_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_ID_8821C(rxdesc) GET_RX_DESC_RXPAYLOAD_ID(rxdesc) -+#define GET_RX_DESC_DMA_AGG_NUM_8821C(rxdesc) GET_RX_DESC_DMA_AGG_NUM(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_1_0_8821C(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_1_0(rxdesc) -+#define GET_RX_DESC_EOSP_8821C(rxdesc) GET_RX_DESC_EOSP(rxdesc) -+#define GET_RX_DESC_HTC_8821C(rxdesc) GET_RX_DESC_HTC(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_4_2_8821C(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_4_2(rxdesc) -+#define GET_RX_DESC_RX_RATE_8821C(rxdesc) GET_RX_DESC_RX_RATE(rxdesc) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT_8821C(rxdesc) GET_RX_DESC_A1_FIT(rxdesc) -+#define GET_RX_DESC_MACID_RPT_BUFF_8821C(rxdesc) \ -+ GET_RX_DESC_MACID_RPT_BUFF(rxdesc) -+#define GET_RX_DESC_RX_PRE_NDP_VLD_8821C(rxdesc) \ -+ GET_RX_DESC_RX_PRE_NDP_VLD(rxdesc) -+#define GET_RX_DESC_RX_SCRAMBLER_8821C(rxdesc) GET_RX_DESC_RX_SCRAMBLER(rxdesc) -+#define GET_RX_DESC_RX_EOF_8821C(rxdesc) GET_RX_DESC_RX_EOF(rxdesc) -+#define GET_RX_DESC_PATTERN_IDX_8821C(rxdesc) GET_RX_DESC_PATTERN_IDX(rxdesc) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL_8821C(rxdesc) GET_RX_DESC_TSFL(rxdesc) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EVT_PKT_8814B(rxdesc) GET_RX_DESC_EVT_PKT(rxdesc) -+#define GET_RX_DESC_SWDEC_8814B(rxdesc) GET_RX_DESC_SWDEC(rxdesc) -+#define GET_RX_DESC_PHYST_8814B(rxdesc) GET_RX_DESC_PHYST(rxdesc) -+#define GET_RX_DESC_SHIFT_8814B(rxdesc) GET_RX_DESC_SHIFT(rxdesc) -+#define GET_RX_DESC_QOS_8814B(rxdesc) GET_RX_DESC_QOS(rxdesc) -+#define GET_RX_DESC_SECURITY_8814B(rxdesc) GET_RX_DESC_SECURITY(rxdesc) -+#define GET_RX_DESC_DRV_INFO_SIZE_8814B(rxdesc) \ -+ GET_RX_DESC_DRV_INFO_SIZE(rxdesc) -+#define GET_RX_DESC_ICV_ERR_8814B(rxdesc) GET_RX_DESC_ICV_ERR(rxdesc) -+#define GET_RX_DESC_CRC32_8814B(rxdesc) GET_RX_DESC_CRC32(rxdesc) -+#define GET_RX_DESC_PKT_LEN_8814B(rxdesc) GET_RX_DESC_PKT_LEN(rxdesc) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC_8814B(rxdesc) GET_RX_DESC_BC(rxdesc) -+#define GET_RX_DESC_MC_8814B(rxdesc) GET_RX_DESC_MC(rxdesc) -+#define GET_RX_DESC_TYPE_8814B(rxdesc) GET_RX_DESC_TYPE(rxdesc) -+#define GET_RX_DESC_MF_8814B(rxdesc) GET_RX_DESC_MF(rxdesc) -+#define GET_RX_DESC_MD_8814B(rxdesc) GET_RX_DESC_MD(rxdesc) -+#define GET_RX_DESC_PWR_8814B(rxdesc) GET_RX_DESC_PWR(rxdesc) -+#define GET_RX_DESC_A1_MATCH_8814B(rxdesc) GET_RX_DESC_A1_MATCH(rxdesc) -+#define GET_RX_DESC_TCP_CHKSUM_VLD_8814B(rxdesc) \ -+ GET_RX_DESC_TCP_CHKSUM_VLD(rxdesc) -+#define GET_RX_DESC_RX_IS_TCP_UDP_8814B(rxdesc) \ -+ GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) -+#define GET_RX_DESC_RX_IPV_8814B(rxdesc) GET_RX_DESC_RX_IPV(rxdesc) -+#define GET_RX_DESC_TCP_CHKSUM_ERR_8814B(rxdesc) \ -+ GET_RX_DESC_TCP_CHKSUM_ERR(rxdesc) -+#define GET_RX_DESC_PHY_PKT_IDC_8814B(rxdesc) GET_RX_DESC_PHY_PKT_IDC(rxdesc) -+#define GET_RX_DESC_FW_FIFO_FULL_8814B(rxdesc) GET_RX_DESC_FW_FIFO_FULL(rxdesc) -+#define GET_RX_DESC_AMPDU_8814B(rxdesc) GET_RX_DESC_AMPDU(rxdesc) -+#define GET_RX_DESC_RXCMD_IDC_8814B(rxdesc) GET_RX_DESC_RXCMD_IDC(rxdesc) -+#define GET_RX_DESC_AMSDU_8814B(rxdesc) GET_RX_DESC_AMSDU(rxdesc) -+#define GET_RX_DESC_TID_8814B(rxdesc) GET_RX_DESC_TID(rxdesc) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_AMSDU_CUT_8814B(rxdesc) GET_RX_DESC_AMSDU_CUT(rxdesc) -+#define GET_RX_DESC_PPDU_CNT_8814B(rxdesc) GET_RX_DESC_PPDU_CNT(rxdesc) -+#define GET_RX_DESC_C2H_8814B(rxdesc) GET_RX_DESC_C2H(rxdesc) -+#define GET_RX_DESC_WLANHD_IV_LEN_8814B(rxdesc) \ -+ GET_RX_DESC_WLANHD_IV_LEN(rxdesc) -+#define GET_RX_DESC_LAST_MSDU_8814B(rxdesc) GET_RX_DESC_LAST_MSDU(rxdesc) -+#define GET_RX_DESC_EXT_SEC_TYPE_8814B(rxdesc) GET_RX_DESC_EXT_SEC_TYPE(rxdesc) -+#define GET_RX_DESC_FRAG_8814B(rxdesc) GET_RX_DESC_FRAG(rxdesc) -+#define GET_RX_DESC_SEQ_8814B(rxdesc) GET_RX_DESC_SEQ(rxdesc) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE_8814B(rxdesc) GET_RX_DESC_MAGIC_WAKE(rxdesc) -+#define GET_RX_DESC_UNICAST_WAKE_8814B(rxdesc) GET_RX_DESC_UNICAST_WAKE(rxdesc) -+#define GET_RX_DESC_PATTERN_WAKE_8814B(rxdesc) GET_RX_DESC_PATTERN_WAKE(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_MATCH_8814B(rxdesc) \ -+ GET_RX_DESC_RXPAYLOAD_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_ID_8814B(rxdesc) GET_RX_DESC_RXPAYLOAD_ID(rxdesc) -+#define GET_RX_DESC_DMA_AGG_NUM_8814B(rxdesc) GET_RX_DESC_DMA_AGG_NUM(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_8814B(rxdesc) GET_RX_DESC_BSSID_FIT(rxdesc) -+#define GET_RX_DESC_HTC_8814B(rxdesc) GET_RX_DESC_HTC(rxdesc) -+#define GET_RX_DESC_AMPDU_END_PKT_8814B(rxdesc) \ -+ GET_RX_DESC_AMPDU_END_PKT(rxdesc) -+#define GET_RX_DESC_ADDRESS_CAM_VLD_8814B(rxdesc) \ -+ GET_RX_DESC_ADDRESS_CAM_VLD(rxdesc) -+#define GET_RX_DESC_EOSP_8814B(rxdesc) GET_RX_DESC_EOSP_V1(rxdesc) -+#define GET_RX_DESC_RX_RATE_8814B(rxdesc) GET_RX_DESC_RX_RATE(rxdesc) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_ADDRESS_CAM_8814B(rxdesc) GET_RX_DESC_ADDRESS_CAM(rxdesc) -+#define GET_RX_DESC_MACID_VLD_8814B(rxdesc) GET_RX_DESC_MACID_VLD_V1(rxdesc) -+#define GET_RX_DESC_MACID_8814B(rxdesc) GET_RX_DESC_MACID_V1(rxdesc) -+#define GET_RX_DESC_SWPS_RPT_8814B(rxdesc) GET_RX_DESC_SWPS_RPT(rxdesc) -+#define GET_RX_DESC_PATTERN_IDX_8814B(rxdesc) GET_RX_DESC_PATTERN_IDX_V2(rxdesc) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_FREERUN_CNT_8814B(rxdesc) GET_RX_DESC_FREERUN_CNT(rxdesc) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR_8198F(rxdesc) GET_RX_DESC_EOR(rxdesc) -+#define GET_RX_DESC_PHYPKTIDC_8198F(rxdesc) GET_RX_DESC_PHYPKTIDC(rxdesc) -+#define GET_RX_DESC_SWDEC_8198F(rxdesc) GET_RX_DESC_SWDEC(rxdesc) -+#define GET_RX_DESC_PHYST_8198F(rxdesc) GET_RX_DESC_PHYST(rxdesc) -+#define GET_RX_DESC_SHIFT_8198F(rxdesc) GET_RX_DESC_SHIFT(rxdesc) -+#define GET_RX_DESC_QOS_8198F(rxdesc) GET_RX_DESC_QOS(rxdesc) -+#define GET_RX_DESC_SECURITY_8198F(rxdesc) GET_RX_DESC_SECURITY(rxdesc) -+#define GET_RX_DESC_DRV_INFO_SIZE_8198F(rxdesc) \ -+ GET_RX_DESC_DRV_INFO_SIZE(rxdesc) -+#define GET_RX_DESC_ICV_ERR_8198F(rxdesc) GET_RX_DESC_ICV_ERR(rxdesc) -+#define GET_RX_DESC_CRC32_8198F(rxdesc) GET_RX_DESC_CRC32(rxdesc) -+#define GET_RX_DESC_PKT_LEN_8198F(rxdesc) GET_RX_DESC_PKT_LEN(rxdesc) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC_8198F(rxdesc) GET_RX_DESC_BC(rxdesc) -+#define GET_RX_DESC_MC_8198F(rxdesc) GET_RX_DESC_MC(rxdesc) -+#define GET_RX_DESC_TY_PE_8198F(rxdesc) GET_RX_DESC_TY_PE(rxdesc) -+#define GET_RX_DESC_MF_8198F(rxdesc) GET_RX_DESC_MF(rxdesc) -+#define GET_RX_DESC_MD_8198F(rxdesc) GET_RX_DESC_MD(rxdesc) -+#define GET_RX_DESC_PWR_8198F(rxdesc) GET_RX_DESC_PWR(rxdesc) -+#define GET_RX_DESC_PAM_8198F(rxdesc) GET_RX_DESC_PAM(rxdesc) -+#define GET_RX_DESC_CHK_VLD_8198F(rxdesc) GET_RX_DESC_CHK_VLD(rxdesc) -+#define GET_RX_DESC_RX_IS_TCP_UDP_8198F(rxdesc) \ -+ GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) -+#define GET_RX_DESC_RX_IPV_8198F(rxdesc) GET_RX_DESC_RX_IPV(rxdesc) -+#define GET_RX_DESC_CHKERR_8198F(rxdesc) GET_RX_DESC_CHKERR(rxdesc) -+#define GET_RX_DESC_PAGGR_8198F(rxdesc) GET_RX_DESC_PAGGR(rxdesc) -+#define GET_RX_DESC_RXID_MATCH_8198F(rxdesc) GET_RX_DESC_RXID_MATCH(rxdesc) -+#define GET_RX_DESC_AMSDU_8198F(rxdesc) GET_RX_DESC_AMSDU(rxdesc) -+#define GET_RX_DESC_MACID_VLD_8198F(rxdesc) GET_RX_DESC_MACID_VLD(rxdesc) -+#define GET_RX_DESC_TID_8198F(rxdesc) GET_RX_DESC_TID(rxdesc) -+#define GET_RX_DESC_MACID_8198F(rxdesc) GET_RX_DESC_MACID(rxdesc) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK_8198F(rxdesc) GET_RX_DESC_FCS_OK(rxdesc) -+#define GET_RX_DESC_PPDU_CNT_8198F(rxdesc) GET_RX_DESC_PPDU_CNT(rxdesc) -+#define GET_RX_DESC_C2H_8198F(rxdesc) GET_RX_DESC_C2H(rxdesc) -+#define GET_RX_DESC_HWRSVD_8198F(rxdesc) GET_RX_DESC_HWRSVD_V1(rxdesc) -+#define GET_RX_DESC_RXMAGPKT_8198F(rxdesc) GET_RX_DESC_RXMAGPKT(rxdesc) -+#define GET_RX_DESC_WLANHD_IV_LEN_8198F(rxdesc) \ -+ GET_RX_DESC_WLANHD_IV_LEN(rxdesc) -+#define GET_RX_DESC_RX_IS_QOS_8198F(rxdesc) GET_RX_DESC_RX_IS_QOS(rxdesc) -+#define GET_RX_DESC_FRAG_8198F(rxdesc) GET_RX_DESC_FRAG(rxdesc) -+#define GET_RX_DESC_SEQ_8198F(rxdesc) GET_RX_DESC_SEQ(rxdesc) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE_8198F(rxdesc) GET_RX_DESC_MAGIC_WAKE(rxdesc) -+#define GET_RX_DESC_UNICAST_WAKE_8198F(rxdesc) GET_RX_DESC_UNICAST_WAKE(rxdesc) -+#define GET_RX_DESC_PATTERN_MATCH_8198F(rxdesc) \ -+ GET_RX_DESC_PATTERN_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_MATCH_8198F(rxdesc) \ -+ GET_RX_DESC_RXPAYLOAD_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_ID_8198F(rxdesc) GET_RX_DESC_RXPAYLOAD_ID(rxdesc) -+#define GET_RX_DESC_DMA_AGG_NUM_8198F(rxdesc) GET_RX_DESC_DMA_AGG_NUM(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_1_0_8198F(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_1_0(rxdesc) -+#define GET_RX_DESC_EOSP_8198F(rxdesc) GET_RX_DESC_EOSP(rxdesc) -+#define GET_RX_DESC_HTC_8198F(rxdesc) GET_RX_DESC_HTC(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_4_2_8198F(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_4_2(rxdesc) -+#define GET_RX_DESC_RX_RATE_8198F(rxdesc) GET_RX_DESC_RX_RATE(rxdesc) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT_A1_8198F(rxdesc) GET_RX_DESC_A1_FIT_A1(rxdesc) -+#define GET_RX_DESC_MACID_RPT_BUFF_8198F(rxdesc) \ -+ GET_RX_DESC_MACID_RPT_BUFF(rxdesc) -+#define GET_RX_DESC_RX_PRE_NDP_VLD_8198F(rxdesc) \ -+ GET_RX_DESC_RX_PRE_NDP_VLD(rxdesc) -+#define GET_RX_DESC_RX_SCRAMBLER_8198F(rxdesc) GET_RX_DESC_RX_SCRAMBLER(rxdesc) -+#define GET_RX_DESC_RX_EOF_8198F(rxdesc) GET_RX_DESC_RX_EOF(rxdesc) -+#define GET_RX_DESC_FC_POWER_8198F(rxdesc) GET_RX_DESC_FC_POWER(rxdesc) -+#define GET_RX_DESC_TXRPTMID_CTL_MASK_8198F(rxdesc) \ -+ GET_RX_DESC_TXRPTMID_CTL_MASK(rxdesc) -+#define GET_RX_DESC_SWPS_RPT_8198F(rxdesc) GET_RX_DESC_SWPS_RPT(rxdesc) -+#define GET_RX_DESC_PATTERN_IDX_8198F(rxdesc) GET_RX_DESC_PATTERN_IDX_V1(rxdesc) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL_8198F(rxdesc) GET_RX_DESC_TSFL(rxdesc) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR_8822C(rxdesc) GET_RX_DESC_EOR(rxdesc) -+#define GET_RX_DESC_PHYPKTIDC_8822C(rxdesc) GET_RX_DESC_PHYPKTIDC(rxdesc) -+#define GET_RX_DESC_SWDEC_8822C(rxdesc) GET_RX_DESC_SWDEC(rxdesc) -+#define GET_RX_DESC_PHYST_8822C(rxdesc) GET_RX_DESC_PHYST(rxdesc) -+#define GET_RX_DESC_SHIFT_8822C(rxdesc) GET_RX_DESC_SHIFT(rxdesc) -+#define GET_RX_DESC_QOS_8822C(rxdesc) GET_RX_DESC_QOS(rxdesc) -+#define GET_RX_DESC_SECURITY_8822C(rxdesc) GET_RX_DESC_SECURITY(rxdesc) -+#define GET_RX_DESC_DRV_INFO_SIZE_8822C(rxdesc) \ -+ GET_RX_DESC_DRV_INFO_SIZE(rxdesc) -+#define GET_RX_DESC_ICV_ERR_8822C(rxdesc) GET_RX_DESC_ICV_ERR(rxdesc) -+#define GET_RX_DESC_CRC32_8822C(rxdesc) GET_RX_DESC_CRC32(rxdesc) -+#define GET_RX_DESC_PKT_LEN_8822C(rxdesc) GET_RX_DESC_PKT_LEN(rxdesc) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC_8822C(rxdesc) GET_RX_DESC_BC(rxdesc) -+#define GET_RX_DESC_MC_8822C(rxdesc) GET_RX_DESC_MC(rxdesc) -+#define GET_RX_DESC_TY_PE_8822C(rxdesc) GET_RX_DESC_TY_PE(rxdesc) -+#define GET_RX_DESC_MF_8822C(rxdesc) GET_RX_DESC_MF(rxdesc) -+#define GET_RX_DESC_MD_8822C(rxdesc) GET_RX_DESC_MD(rxdesc) -+#define GET_RX_DESC_PWR_8822C(rxdesc) GET_RX_DESC_PWR(rxdesc) -+#define GET_RX_DESC_PAM_8822C(rxdesc) GET_RX_DESC_PAM(rxdesc) -+#define GET_RX_DESC_CHK_VLD_8822C(rxdesc) GET_RX_DESC_CHK_VLD(rxdesc) -+#define GET_RX_DESC_RX_IS_TCP_UDP_8822C(rxdesc) \ -+ GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) -+#define GET_RX_DESC_RX_IPV_8822C(rxdesc) GET_RX_DESC_RX_IPV(rxdesc) -+#define GET_RX_DESC_CHKERR_8822C(rxdesc) GET_RX_DESC_CHKERR(rxdesc) -+#define GET_RX_DESC_PAGGR_8822C(rxdesc) GET_RX_DESC_PAGGR(rxdesc) -+#define GET_RX_DESC_RXID_MATCH_8822C(rxdesc) GET_RX_DESC_RXID_MATCH(rxdesc) -+#define GET_RX_DESC_AMSDU_8822C(rxdesc) GET_RX_DESC_AMSDU(rxdesc) -+#define GET_RX_DESC_MACID_VLD_8822C(rxdesc) GET_RX_DESC_MACID_VLD(rxdesc) -+#define GET_RX_DESC_TID_8822C(rxdesc) GET_RX_DESC_TID(rxdesc) -+#define GET_RX_DESC_MACID_8822C(rxdesc) GET_RX_DESC_MACID(rxdesc) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK_8822C(rxdesc) GET_RX_DESC_FCS_OK(rxdesc) -+#define GET_RX_DESC_PPDU_CNT_8822C(rxdesc) GET_RX_DESC_PPDU_CNT(rxdesc) -+#define GET_RX_DESC_C2H_8822C(rxdesc) GET_RX_DESC_C2H(rxdesc) -+#define GET_RX_DESC_HWRSVD_8822C(rxdesc) GET_RX_DESC_HWRSVD(rxdesc) -+#define GET_RX_DESC_WLANHD_IV_LEN_8822C(rxdesc) \ -+ GET_RX_DESC_WLANHD_IV_LEN(rxdesc) -+#define GET_RX_DESC_RX_STATISTICS_8822C(rxdesc) \ -+ GET_RX_DESC_RX_STATISTICS(rxdesc) -+#define GET_RX_DESC_RX_IS_QOS_8822C(rxdesc) GET_RX_DESC_RX_IS_QOS(rxdesc) -+#define GET_RX_DESC_FRAG_8822C(rxdesc) GET_RX_DESC_FRAG(rxdesc) -+#define GET_RX_DESC_SEQ_8822C(rxdesc) GET_RX_DESC_SEQ(rxdesc) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE_8822C(rxdesc) GET_RX_DESC_MAGIC_WAKE(rxdesc) -+#define GET_RX_DESC_UNICAST_WAKE_8822C(rxdesc) GET_RX_DESC_UNICAST_WAKE(rxdesc) -+#define GET_RX_DESC_PATTERN_MATCH_8822C(rxdesc) \ -+ GET_RX_DESC_PATTERN_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_MATCH_8822C(rxdesc) \ -+ GET_RX_DESC_RXPAYLOAD_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_ID_8822C(rxdesc) GET_RX_DESC_RXPAYLOAD_ID(rxdesc) -+#define GET_RX_DESC_DMA_AGG_NUM_8822C(rxdesc) GET_RX_DESC_DMA_AGG_NUM(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_1_0_8822C(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_1_0(rxdesc) -+#define GET_RX_DESC_EOSP_8822C(rxdesc) GET_RX_DESC_EOSP(rxdesc) -+#define GET_RX_DESC_HTC_8822C(rxdesc) GET_RX_DESC_HTC(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_4_2_8822C(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_4_2(rxdesc) -+#define GET_RX_DESC_RX_RATE_8822C(rxdesc) GET_RX_DESC_RX_RATE(rxdesc) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT_8822C(rxdesc) GET_RX_DESC_A1_FIT(rxdesc) -+#define GET_RX_DESC_MACID_RPT_BUFF_8822C(rxdesc) \ -+ GET_RX_DESC_MACID_RPT_BUFF(rxdesc) -+#define GET_RX_DESC_RX_PRE_NDP_VLD_8822C(rxdesc) \ -+ GET_RX_DESC_RX_PRE_NDP_VLD(rxdesc) -+#define GET_RX_DESC_RX_SCRAMBLER_8822C(rxdesc) GET_RX_DESC_RX_SCRAMBLER(rxdesc) -+#define GET_RX_DESC_RX_EOF_8822C(rxdesc) GET_RX_DESC_RX_EOF(rxdesc) -+#define GET_RX_DESC_PATTERN_IDX_8822C(rxdesc) GET_RX_DESC_PATTERN_IDX(rxdesc) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL_8822C(rxdesc) GET_RX_DESC_TSFL(rxdesc) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR_8192F(rxdesc) GET_RX_DESC_EOR(rxdesc) -+#define GET_RX_DESC_SWDEC_8192F(rxdesc) GET_RX_DESC_SWDEC(rxdesc) -+#define GET_RX_DESC_PHYST_8192F(rxdesc) GET_RX_DESC_PHYST(rxdesc) -+#define GET_RX_DESC_SHIFT_8192F(rxdesc) GET_RX_DESC_SHIFT(rxdesc) -+#define GET_RX_DESC_QOS_8192F(rxdesc) GET_RX_DESC_QOS(rxdesc) -+#define GET_RX_DESC_SECURITY_8192F(rxdesc) GET_RX_DESC_SECURITY(rxdesc) -+#define GET_RX_DESC_DRV_INFO_SIZE_8192F(rxdesc) \ -+ GET_RX_DESC_DRV_INFO_SIZE(rxdesc) -+#define GET_RX_DESC_ICV_ERR_8192F(rxdesc) GET_RX_DESC_ICV_ERR(rxdesc) -+#define GET_RX_DESC_CRC32_8192F(rxdesc) GET_RX_DESC_CRC32(rxdesc) -+#define GET_RX_DESC_PKT_LEN_8192F(rxdesc) GET_RX_DESC_PKT_LEN(rxdesc) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC_8192F(rxdesc) GET_RX_DESC_BC(rxdesc) -+#define GET_RX_DESC_MC_8192F(rxdesc) GET_RX_DESC_MC(rxdesc) -+#define GET_RX_DESC_TY_PE_8192F(rxdesc) GET_RX_DESC_TY_PE(rxdesc) -+#define GET_RX_DESC_MF_8192F(rxdesc) GET_RX_DESC_MF(rxdesc) -+#define GET_RX_DESC_MD_8192F(rxdesc) GET_RX_DESC_MD(rxdesc) -+#define GET_RX_DESC_PWR_8192F(rxdesc) GET_RX_DESC_PWR(rxdesc) -+#define GET_RX_DESC_PAM_8192F(rxdesc) GET_RX_DESC_PAM(rxdesc) -+#define GET_RX_DESC_CHK_VLD_8192F(rxdesc) GET_RX_DESC_CHK_VLD(rxdesc) -+#define GET_RX_DESC_RX_IS_TCP_UDP_8192F(rxdesc) \ -+ GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) -+#define GET_RX_DESC_RX_IPV_8192F(rxdesc) GET_RX_DESC_RX_IPV(rxdesc) -+#define GET_RX_DESC_CHKERR_8192F(rxdesc) GET_RX_DESC_CHKERR(rxdesc) -+#define GET_RX_DESC_PAGGR_8192F(rxdesc) GET_RX_DESC_PAGGR(rxdesc) -+#define GET_RX_DESC_RXID_MATCH_8192F(rxdesc) GET_RX_DESC_RXID_MATCH(rxdesc) -+#define GET_RX_DESC_AMSDU_8192F(rxdesc) GET_RX_DESC_AMSDU(rxdesc) -+#define GET_RX_DESC_MACID_VLD_8192F(rxdesc) GET_RX_DESC_MACID_VLD(rxdesc) -+#define GET_RX_DESC_TID_8192F(rxdesc) GET_RX_DESC_TID(rxdesc) -+#define GET_RX_DESC_MACID_8192F(rxdesc) GET_RX_DESC_MACID(rxdesc) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK_8192F(rxdesc) GET_RX_DESC_FCS_OK(rxdesc) -+#define GET_RX_DESC_PPDU_CNT_8192F(rxdesc) GET_RX_DESC_PPDU_CNT(rxdesc) -+#define GET_RX_DESC_C2H_8192F(rxdesc) GET_RX_DESC_C2H(rxdesc) -+#define GET_RX_DESC_HWRSVD_8192F(rxdesc) GET_RX_DESC_HWRSVD_V1(rxdesc) -+#define GET_RX_DESC_RXMAGPKT_8192F(rxdesc) GET_RX_DESC_RXMAGPKT(rxdesc) -+#define GET_RX_DESC_WLANHD_IV_LEN_8192F(rxdesc) \ -+ GET_RX_DESC_WLANHD_IV_LEN(rxdesc) -+#define GET_RX_DESC_RX_IS_QOS_8192F(rxdesc) GET_RX_DESC_RX_IS_QOS(rxdesc) -+#define GET_RX_DESC_FRAG_8192F(rxdesc) GET_RX_DESC_FRAG(rxdesc) -+#define GET_RX_DESC_SEQ_8192F(rxdesc) GET_RX_DESC_SEQ(rxdesc) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE_8192F(rxdesc) GET_RX_DESC_MAGIC_WAKE(rxdesc) -+#define GET_RX_DESC_UNICAST_WAKE_8192F(rxdesc) GET_RX_DESC_UNICAST_WAKE(rxdesc) -+#define GET_RX_DESC_PATTERN_MATCH_8192F(rxdesc) \ -+ GET_RX_DESC_PATTERN_MATCH(rxdesc) -+#define GET_RX_DESC_DMA_AGG_NUM_8192F(rxdesc) GET_RX_DESC_DMA_AGG_NUM(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_1_0_8192F(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_1_0(rxdesc) -+#define GET_RX_DESC_EOSP_8192F(rxdesc) GET_RX_DESC_EOSP(rxdesc) -+#define GET_RX_DESC_HTC_8192F(rxdesc) GET_RX_DESC_HTC(rxdesc) -+#define GET_RX_DESC_RX_RATE_8192F(rxdesc) GET_RX_DESC_RX_RATE(rxdesc) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT_8192F(rxdesc) GET_RX_DESC_A1_FIT(rxdesc) -+#define GET_RX_DESC_MACID_RPT_BUFF_8192F(rxdesc) \ -+ GET_RX_DESC_MACID_RPT_BUFF(rxdesc) -+#define GET_RX_DESC_SWPS_RPT_8192F(rxdesc) GET_RX_DESC_SWPS_RPT_V1(rxdesc) -+#define GET_RX_DESC_FC_POWER_8192F(rxdesc) GET_RX_DESC_FC_POWER_V1(rxdesc) -+#define GET_RX_DESC_TXRPTMID_CTL_MASK_8192F(rxdesc) \ -+ GET_RX_DESC_TXRPTMID_CTL_MASK_V1(rxdesc) -+#define GET_RX_DESC_SNIF_INFO_8192F(rxdesc) GET_RX_DESC_SNIF_INFO(rxdesc) -+#define GET_RX_DESC_PATTERN_IDX_8192F(rxdesc) GET_RX_DESC_PATTERN_IDX(rxdesc) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL_8192F(rxdesc) GET_RX_DESC_TSFL(rxdesc) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR_8197G(rxdesc) GET_RX_DESC_EOR(rxdesc) -+#define GET_RX_DESC_PHYPKTIDC_8197G(rxdesc) GET_RX_DESC_PHYPKTIDC(rxdesc) -+#define GET_RX_DESC_SWDEC_8197G(rxdesc) GET_RX_DESC_SWDEC(rxdesc) -+#define GET_RX_DESC_PHYST_8197G(rxdesc) GET_RX_DESC_PHYST(rxdesc) -+#define GET_RX_DESC_SHIFT_8197G(rxdesc) GET_RX_DESC_SHIFT(rxdesc) -+#define GET_RX_DESC_QOS_8197G(rxdesc) GET_RX_DESC_QOS(rxdesc) -+#define GET_RX_DESC_SECURITY_8197G(rxdesc) GET_RX_DESC_SECURITY(rxdesc) -+#define GET_RX_DESC_DRV_INFO_SIZE_8197G(rxdesc) \ -+ GET_RX_DESC_DRV_INFO_SIZE(rxdesc) -+#define GET_RX_DESC_ICV_ERR_8197G(rxdesc) GET_RX_DESC_ICV_ERR(rxdesc) -+#define GET_RX_DESC_CRC32_8197G(rxdesc) GET_RX_DESC_CRC32(rxdesc) -+#define GET_RX_DESC_PKT_LEN_8197G(rxdesc) GET_RX_DESC_PKT_LEN(rxdesc) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC_8197G(rxdesc) GET_RX_DESC_BC(rxdesc) -+#define GET_RX_DESC_MC_8197G(rxdesc) GET_RX_DESC_MC(rxdesc) -+#define GET_RX_DESC_TY_PE_8197G(rxdesc) GET_RX_DESC_TY_PE(rxdesc) -+#define GET_RX_DESC_MF_8197G(rxdesc) GET_RX_DESC_MF(rxdesc) -+#define GET_RX_DESC_MD_8197G(rxdesc) GET_RX_DESC_MD(rxdesc) -+#define GET_RX_DESC_PWR_8197G(rxdesc) GET_RX_DESC_PWR(rxdesc) -+#define GET_RX_DESC_PAM_8197G(rxdesc) GET_RX_DESC_PAM(rxdesc) -+#define GET_RX_DESC_CHK_VLD_8197G(rxdesc) GET_RX_DESC_CHK_VLD(rxdesc) -+#define GET_RX_DESC_RX_IS_TCP_UDP_8197G(rxdesc) \ -+ GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) -+#define GET_RX_DESC_RX_IPV_8197G(rxdesc) GET_RX_DESC_RX_IPV(rxdesc) -+#define GET_RX_DESC_CHKERR_8197G(rxdesc) GET_RX_DESC_CHKERR(rxdesc) -+#define GET_RX_DESC_PAGGR_8197G(rxdesc) GET_RX_DESC_PAGGR(rxdesc) -+#define GET_RX_DESC_RXID_MATCH_8197G(rxdesc) GET_RX_DESC_RXID_MATCH(rxdesc) -+#define GET_RX_DESC_AMSDU_8197G(rxdesc) GET_RX_DESC_AMSDU(rxdesc) -+#define GET_RX_DESC_MACID_VLD_8197G(rxdesc) GET_RX_DESC_MACID_VLD(rxdesc) -+#define GET_RX_DESC_TID_8197G(rxdesc) GET_RX_DESC_TID(rxdesc) -+#define GET_RX_DESC_MACID_8197G(rxdesc) GET_RX_DESC_MACID(rxdesc) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK_8197G(rxdesc) GET_RX_DESC_FCS_OK(rxdesc) -+#define GET_RX_DESC_PPDU_CNT_8197G(rxdesc) GET_RX_DESC_PPDU_CNT(rxdesc) -+#define GET_RX_DESC_C2H_8197G(rxdesc) GET_RX_DESC_C2H(rxdesc) -+#define GET_RX_DESC_HWRSVD_8197G(rxdesc) GET_RX_DESC_HWRSVD_V1(rxdesc) -+#define GET_RX_DESC_WLANHD_IV_LEN_8197G(rxdesc) \ -+ GET_RX_DESC_WLANHD_IV_LEN(rxdesc) -+#define GET_RX_DESC_RX_STATISTICS_8197G(rxdesc) \ -+ GET_RX_DESC_RX_STATISTICS(rxdesc) -+#define GET_RX_DESC_RX_IS_QOS_8197G(rxdesc) GET_RX_DESC_RX_IS_QOS(rxdesc) -+#define GET_RX_DESC_FRAG_8197G(rxdesc) GET_RX_DESC_FRAG(rxdesc) -+#define GET_RX_DESC_SEQ_8197G(rxdesc) GET_RX_DESC_SEQ(rxdesc) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_DMA_AGG_NUM_8197G(rxdesc) GET_RX_DESC_DMA_AGG_NUM(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_1_0_8197G(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_1_0(rxdesc) -+#define GET_RX_DESC_EOSP_8197G(rxdesc) GET_RX_DESC_EOSP(rxdesc) -+#define GET_RX_DESC_HTC_8197G(rxdesc) GET_RX_DESC_HTC(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_4_2_8197G(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_4_2(rxdesc) -+#define GET_RX_DESC_RX_RATE_8197G(rxdesc) GET_RX_DESC_RX_RATE(rxdesc) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT_A1_8197G(rxdesc) GET_RX_DESC_A1_FIT_A1(rxdesc) -+#define GET_RX_DESC_MACID_RPT_BUFF_8197G(rxdesc) \ -+ GET_RX_DESC_MACID_RPT_BUFF(rxdesc) -+#define GET_RX_DESC_RX_PRE_NDP_VLD_8197G(rxdesc) \ -+ GET_RX_DESC_RX_PRE_NDP_VLD(rxdesc) -+#define GET_RX_DESC_RX_SCRAMBLER_8197G(rxdesc) GET_RX_DESC_RX_SCRAMBLER(rxdesc) -+#define GET_RX_DESC_RX_EOF_8197G(rxdesc) GET_RX_DESC_RX_EOF(rxdesc) -+#define GET_RX_DESC_FC_POWER_8197G(rxdesc) GET_RX_DESC_FC_POWER(rxdesc) -+#define GET_RX_DESC_TXRPTMID_CTL_MASK_8197G(rxdesc) \ -+ GET_RX_DESC_TXRPTMID_CTL_MASK(rxdesc) -+#define GET_RX_DESC_SWPS_RPT_8197G(rxdesc) GET_RX_DESC_SWPS_RPT(rxdesc) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL_8197G(rxdesc) GET_RX_DESC_TSFL(rxdesc) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR_8812F(rxdesc) GET_RX_DESC_EOR(rxdesc) -+#define GET_RX_DESC_PHYPKTIDC_8812F(rxdesc) GET_RX_DESC_PHYPKTIDC(rxdesc) -+#define GET_RX_DESC_SWDEC_8812F(rxdesc) GET_RX_DESC_SWDEC(rxdesc) -+#define GET_RX_DESC_PHYST_8812F(rxdesc) GET_RX_DESC_PHYST(rxdesc) -+#define GET_RX_DESC_SHIFT_8812F(rxdesc) GET_RX_DESC_SHIFT(rxdesc) -+#define GET_RX_DESC_QOS_8812F(rxdesc) GET_RX_DESC_QOS(rxdesc) -+#define GET_RX_DESC_SECURITY_8812F(rxdesc) GET_RX_DESC_SECURITY(rxdesc) -+#define GET_RX_DESC_DRV_INFO_SIZE_8812F(rxdesc) \ -+ GET_RX_DESC_DRV_INFO_SIZE(rxdesc) -+#define GET_RX_DESC_ICV_ERR_8812F(rxdesc) GET_RX_DESC_ICV_ERR(rxdesc) -+#define GET_RX_DESC_CRC32_8812F(rxdesc) GET_RX_DESC_CRC32(rxdesc) -+#define GET_RX_DESC_PKT_LEN_8812F(rxdesc) GET_RX_DESC_PKT_LEN(rxdesc) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC_8812F(rxdesc) GET_RX_DESC_BC(rxdesc) -+#define GET_RX_DESC_MC_8812F(rxdesc) GET_RX_DESC_MC(rxdesc) -+#define GET_RX_DESC_TY_PE_8812F(rxdesc) GET_RX_DESC_TY_PE(rxdesc) -+#define GET_RX_DESC_MF_8812F(rxdesc) GET_RX_DESC_MF(rxdesc) -+#define GET_RX_DESC_MD_8812F(rxdesc) GET_RX_DESC_MD(rxdesc) -+#define GET_RX_DESC_PWR_8812F(rxdesc) GET_RX_DESC_PWR(rxdesc) -+#define GET_RX_DESC_PAM_8812F(rxdesc) GET_RX_DESC_PAM(rxdesc) -+#define GET_RX_DESC_CHK_VLD_8812F(rxdesc) GET_RX_DESC_CHK_VLD(rxdesc) -+#define GET_RX_DESC_RX_IS_TCP_UDP_8812F(rxdesc) \ -+ GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) -+#define GET_RX_DESC_RX_IPV_8812F(rxdesc) GET_RX_DESC_RX_IPV(rxdesc) -+#define GET_RX_DESC_CHKERR_8812F(rxdesc) GET_RX_DESC_CHKERR(rxdesc) -+#define GET_RX_DESC_PAGGR_8812F(rxdesc) GET_RX_DESC_PAGGR(rxdesc) -+#define GET_RX_DESC_RXID_MATCH_8812F(rxdesc) GET_RX_DESC_RXID_MATCH(rxdesc) -+#define GET_RX_DESC_AMSDU_8812F(rxdesc) GET_RX_DESC_AMSDU(rxdesc) -+#define GET_RX_DESC_MACID_VLD_8812F(rxdesc) GET_RX_DESC_MACID_VLD(rxdesc) -+#define GET_RX_DESC_TID_8812F(rxdesc) GET_RX_DESC_TID(rxdesc) -+#define GET_RX_DESC_MACID_8812F(rxdesc) GET_RX_DESC_MACID(rxdesc) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK_8812F(rxdesc) GET_RX_DESC_FCS_OK(rxdesc) -+#define GET_RX_DESC_PPDU_CNT_8812F(rxdesc) GET_RX_DESC_PPDU_CNT(rxdesc) -+#define GET_RX_DESC_C2H_8812F(rxdesc) GET_RX_DESC_C2H(rxdesc) -+#define GET_RX_DESC_HWRSVD_8812F(rxdesc) GET_RX_DESC_HWRSVD(rxdesc) -+#define GET_RX_DESC_WLANHD_IV_LEN_8812F(rxdesc) \ -+ GET_RX_DESC_WLANHD_IV_LEN(rxdesc) -+#define GET_RX_DESC_RX_STATISTICS_8812F(rxdesc) \ -+ GET_RX_DESC_RX_STATISTICS(rxdesc) -+#define GET_RX_DESC_RX_IS_QOS_8812F(rxdesc) GET_RX_DESC_RX_IS_QOS(rxdesc) -+#define GET_RX_DESC_FRAG_8812F(rxdesc) GET_RX_DESC_FRAG(rxdesc) -+#define GET_RX_DESC_SEQ_8812F(rxdesc) GET_RX_DESC_SEQ(rxdesc) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE_8812F(rxdesc) GET_RX_DESC_MAGIC_WAKE(rxdesc) -+#define GET_RX_DESC_UNICAST_WAKE_8812F(rxdesc) GET_RX_DESC_UNICAST_WAKE(rxdesc) -+#define GET_RX_DESC_PATTERN_MATCH_8812F(rxdesc) \ -+ GET_RX_DESC_PATTERN_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_MATCH_8812F(rxdesc) \ -+ GET_RX_DESC_RXPAYLOAD_MATCH(rxdesc) -+#define GET_RX_DESC_RXPAYLOAD_ID_8812F(rxdesc) GET_RX_DESC_RXPAYLOAD_ID(rxdesc) -+#define GET_RX_DESC_DMA_AGG_NUM_8812F(rxdesc) GET_RX_DESC_DMA_AGG_NUM(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_1_0_8812F(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_1_0(rxdesc) -+#define GET_RX_DESC_EOSP_8812F(rxdesc) GET_RX_DESC_EOSP(rxdesc) -+#define GET_RX_DESC_HTC_8812F(rxdesc) GET_RX_DESC_HTC(rxdesc) -+#define GET_RX_DESC_BSSID_FIT_4_2_8812F(rxdesc) \ -+ GET_RX_DESC_BSSID_FIT_4_2(rxdesc) -+#define GET_RX_DESC_RX_RATE_8812F(rxdesc) GET_RX_DESC_RX_RATE(rxdesc) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT_8812F(rxdesc) GET_RX_DESC_A1_FIT(rxdesc) -+#define GET_RX_DESC_MACID_RPT_BUFF_8812F(rxdesc) \ -+ GET_RX_DESC_MACID_RPT_BUFF(rxdesc) -+#define GET_RX_DESC_RX_PRE_NDP_VLD_8812F(rxdesc) \ -+ GET_RX_DESC_RX_PRE_NDP_VLD(rxdesc) -+#define GET_RX_DESC_RX_SCRAMBLER_8812F(rxdesc) GET_RX_DESC_RX_SCRAMBLER(rxdesc) -+#define GET_RX_DESC_RX_EOF_8812F(rxdesc) GET_RX_DESC_RX_EOF(rxdesc) -+#define GET_RX_DESC_PATTERN_IDX_8812F(rxdesc) GET_RX_DESC_PATTERN_IDX(rxdesc) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL_8812F(rxdesc) GET_RX_DESC_TSFL(rxdesc) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_desc_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_desc_nic.h -new file mode 100644 -index 000000000..6ee7a773a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_rx_desc_nic.h -@@ -0,0 +1,531 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_RX_DESC_NIC_H_ -+#define _HALMAC_RX_DESC_NIC_H_ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/*RXDESC_WORD0*/ -+ -+#define GET_RX_DESC_EOR(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 30, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PHYPKTIDC(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 28, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_EVT_PKT(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 28, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_SWDEC(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 27, 1) -+#define GET_RX_DESC_PHYST(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 26, 1) -+#define GET_RX_DESC_SHIFT(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 24, 2) -+#define GET_RX_DESC_QOS(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 23, 1) -+#define GET_RX_DESC_SECURITY(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 20, 3) -+#define GET_RX_DESC_DRV_INFO_SIZE(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 16, 4) -+#define GET_RX_DESC_ICV_ERR(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 15, 1) -+#define GET_RX_DESC_CRC32(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 14, 1) -+#define GET_RX_DESC_PKT_LEN(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x00, 0, 14) -+ -+/*RXDESC_WORD1*/ -+ -+#define GET_RX_DESC_BC(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 31, 1) -+#define GET_RX_DESC_MC(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 30, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_TY_PE(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 28, 2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_TYPE(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 28, 2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_MF(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 27, 1) -+#define GET_RX_DESC_MD(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 26, 1) -+#define GET_RX_DESC_PWR(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 25, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PAM(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 24, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_A1_MATCH(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 24, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_CHK_VLD(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 23, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_TCP_CHKSUM_VLD(rxdesc) \ -+ LE_BITS_TO_4BYTE(rxdesc + 0x04, 23, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_IS_TCP_UDP(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 22, 1) -+#define GET_RX_DESC_RX_IPV(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 21, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_CHKERR(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 20, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_TCP_CHKSUM_ERR(rxdesc) \ -+ LE_BITS_TO_4BYTE(rxdesc + 0x04, 20, 1) -+#define GET_RX_DESC_PHY_PKT_IDC(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 17, 1) -+#define GET_RX_DESC_FW_FIFO_FULL(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 16, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PAGGR(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 15, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_AMPDU(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 15, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RXID_MATCH(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 14, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_RXCMD_IDC(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 14, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_AMSDU(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 13, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_MACID_VLD(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 12, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_TID(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 8, 4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_MACID(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x04, 0, 7) -+ -+/*RXDESC_WORD2*/ -+ -+#define GET_RX_DESC_FCS_OK(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 31, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_AMSDU_CUT(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 31, 1) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PPDU_CNT(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 29, 2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_C2H(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 28, 1) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define GET_RX_DESC_HWRSVD_V1(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 25, 3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_HWRSVD(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 24, 4) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8192F_SUPPORT) -+ -+#define GET_RX_DESC_RXMAGPKT(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 24, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_WLANHD_IV_LEN(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 18, 6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_LAST_MSDU(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 17, 1) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_STATISTICS(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 17, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_IS_QOS(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 16, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_EXT_SEC_TYPE(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 16, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_FRAG(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 12, 4) -+#define GET_RX_DESC_SEQ(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x08, 0, 12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/*RXDESC_WORD3*/ -+ -+#define GET_RX_DESC_MAGIC_WAKE(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 31, 1) -+#define GET_RX_DESC_UNICAST_WAKE(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 30, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PATTERN_MATCH(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 29, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_PATTERN_WAKE(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 29, 1) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RXPAYLOAD_MATCH(rxdesc) \ -+ LE_BITS_TO_4BYTE(rxdesc + 0x0C, 28, 1) -+#define GET_RX_DESC_RXPAYLOAD_ID(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 24, 4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_DMA_AGG_NUM(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 16, 8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_BSSID_FIT_1_0(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 12, 2) -+#define GET_RX_DESC_EOSP(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 11, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_BSSID_FIT(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 11, 5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_HTC(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 10, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_AMPDU_END_PKT(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 9, 1) -+#define GET_RX_DESC_ADDRESS_CAM_VLD(rxdesc) \ -+ LE_BITS_TO_4BYTE(rxdesc + 0x0C, 8, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_BSSID_FIT_4_2(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 7, 3) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_EOSP_V1(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 7, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_RATE(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x0C, 0, 7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+/*RXDESC_WORD4*/ -+ -+#define GET_RX_DESC_A1_FIT(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 24, 5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_ADDRESS_CAM(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 24, 8) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define GET_RX_DESC_A1_FIT_A1(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 24, 7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_MACID_VLD_V1(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 23, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_MACID_RPT_BUFF(rxdesc) \ -+ LE_BITS_TO_4BYTE(rxdesc + 0x10, 17, 7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_PRE_NDP_VLD(rxdesc) \ -+ LE_BITS_TO_4BYTE(rxdesc + 0x10, 16, 1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define GET_RX_DESC_SWPS_RPT_V1(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 16, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_MACID_V1(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 15, 8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define GET_RX_DESC_FC_POWER_V1(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 15, 1) -+#define GET_RX_DESC_TXRPTMID_CTL_MASK_V1(rxdesc) \ -+ LE_BITS_TO_4BYTE(rxdesc + 0x10, 14, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_RX_SCRAMBLER(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 9, 7) -+#define GET_RX_DESC_RX_EOF(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 8, 1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define GET_RX_DESC_SNIF_INFO(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 8, 6) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define GET_RX_DESC_FC_POWER(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 7, 1) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define GET_RX_DESC_TXRPTMID_CTL_MASK(rxdesc) \ -+ LE_BITS_TO_4BYTE(rxdesc + 0x10, 6, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define GET_RX_DESC_SWPS_RPT(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 5, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define GET_RX_DESC_PATTERN_IDX(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 0, 8) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT) -+ -+#define GET_RX_DESC_PATTERN_IDX_V1(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 0, 5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_PATTERN_IDX_V2(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x10, 0, 5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/*RXDESC_WORD5*/ -+ -+#define GET_RX_DESC_TSFL(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x14, 0, 32) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define GET_RX_DESC_FREERUN_CNT(rxdesc) LE_BITS_TO_4BYTE(rxdesc + 0x14, 0, 32) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_sdio_reg.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_sdio_reg.h -new file mode 100644 -index 000000000..a00e5e9dd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_sdio_reg.h -@@ -0,0 +1,55 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALMAC_SDIO_REG_H__ -+#define __HALMAC_SDIO_REG_H__ -+ -+/* SDIO CMD address mapping */ -+ -+#define HALMAC_SDIO_4BYTE_LEN_MASK 0x1FFF -+#define HALMAC_SDIO_LOCAL_MSK 0x0FFF -+#define HALMAC_WLAN_MAC_REG_MSK 0xFFFF -+#define HALMAC_WLAN_IOREG_MSK 0xFFFF -+ -+/* Sdio Address for SDIO Local Reg, TRX FIFO, MAC Reg */ -+enum halmac_sdio_cmd_addr { -+ HALMAC_SDIO_CMD_ADDR_SDIO_REG = 0, -+ HALMAC_SDIO_CMD_ADDR_MAC_REG = 8, -+ HALMAC_SDIO_CMD_ADDR_TXFF_HIGH = 4, -+ HALMAC_SDIO_CMD_ADDR_TXFF_LOW = 6, -+ HALMAC_SDIO_CMD_ADDR_TXFF_NORMAL = 5, -+ HALMAC_SDIO_CMD_ADDR_TXFF_EXTRA = 7, -+ HALMAC_SDIO_CMD_ADDR_RXFF = 7, -+}; -+ -+/* IO Bus domain address mapping */ -+#define SDIO_LOCAL_OFFSET 0x10250000 -+#define WLAN_IOREG_OFFSET 0x10260000 -+#define FW_FIFO_OFFSET 0x10270000 -+#define TX_HIQ_OFFSET 0x10310000 -+#define TX_MIQ_OFFSET 0x10320000 -+#define TX_LOQ_OFFSET 0x10330000 -+#define TX_EXQ_OFFSET 0x10350000 -+#define RX_RXOFF_OFFSET 0x10340000 -+ -+/* Get TX WLAN FIFO information in CMD53 addr */ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT) -+#define GET_WLAN_TXFF_DEVICE_ID(cmd53_addr) \ -+ LE_BITS_TO_4BYTE((u32 *)cmd53_addr, 13, 4) -+#define GET_WLAN_TXFF_PKT_SIZE(cmd53_addr) \ -+ (LE_BITS_TO_4BYTE((u32 *)cmd53_addr, 0, 13) << 2) -+#endif -+ -+#endif/* __HALMAC_SDIO_REG_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_state_machine.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_state_machine.h -new file mode 100644 -index 000000000..0cea54966 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_state_machine.h -@@ -0,0 +1,182 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_STATE_MACHINE_H_ -+#define _HALMAC_STATE_MACHINE_H_ -+ -+enum halmac_dlfw_state { -+ HALMAC_DLFW_NONE = 0, -+ HALMAC_DLFW_DONE = 1, -+ HALMAC_GEN_INFO_SENT = 2, -+ -+ /* Data CPU firmware download framework */ -+ HALMAC_DLFW_INIT = 0x11, -+ HALMAC_DLFW_START = 0x12, -+ HALMAC_DLFW_CONF_READY = 0x13, -+ HALMAC_DLFW_CPU_READY = 0x14, -+ HALMAC_DLFW_MEM_READY = 0x15, -+ HALMAC_DLFW_SW_READY = 0x16, -+ HALMAC_DLFW_OFLD_READY = 0x17, -+ -+ HALMAC_DLFW_UNDEFINED = 0x7F, -+}; -+ -+enum halmac_gpio_cfg_state { -+ HALMAC_GPIO_CFG_STATE_IDLE = 0, -+ HALMAC_GPIO_CFG_STATE_BUSY = 1, -+ HALMAC_GPIO_CFG_STATE_UNDEFINED = 0x7F, -+}; -+ -+enum halmac_rsvd_pg_state { -+ HALMAC_RSVD_PG_STATE_IDLE = 0, -+ HALMAC_RSVD_PG_STATE_BUSY = 1, -+ HALMAC_RSVD_PG_STATE_UNDEFINED = 0x7F, -+}; -+ -+enum halmac_api_state { -+ HALMAC_API_STATE_INIT = 0, -+ HALMAC_API_STATE_HALT = 1, -+ HALMAC_API_STATE_UNDEFINED = 0x7F, -+}; -+ -+enum halmac_cmd_construct_state { -+ HALMAC_CMD_CNSTR_IDLE = 0, -+ HALMAC_CMD_CNSTR_BUSY = 1, -+ HALMAC_CMD_CNSTR_H2C_SENT = 2, -+ HALMAC_CMD_CNSTR_CNSTR = 3, -+ HALMAC_CMD_CNSTR_BUF_CLR = 4, -+ HALMAC_CMD_CNSTR_UNDEFINED = 0x7F, -+}; -+ -+enum halmac_cmd_process_status { -+ HALMAC_CMD_PROCESS_IDLE = 0x01, /* Init status */ -+ HALMAC_CMD_PROCESS_SENDING = 0x02, /* Wait ack */ -+ HALMAC_CMD_PROCESS_RCVD = 0x03, /* Rcvd ack */ -+ HALMAC_CMD_PROCESS_DONE = 0x04, /* Event done */ -+ HALMAC_CMD_PROCESS_ERROR = 0x05, /* Return code error */ -+ HALMAC_CMD_PROCESS_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_mac_power { -+ HALMAC_MAC_POWER_OFF = 0x0, -+ HALMAC_MAC_POWER_ON = 0x1, -+ HALMAC_MAC_POWER_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_wlcpu_mode { -+ HALMAC_WLCPU_ACTIVE = 0x0, -+ HALMAC_WLCPU_ENTER_SLEEP = 0x1, -+ HALMAC_WLCPU_SLEEP = 0x2, -+ HALMAC_WLCPU_UNDEFINE = 0x7F, -+}; -+ -+struct halmac_efuse_state { -+ enum halmac_cmd_construct_state cmd_cnstr_state; -+ enum halmac_cmd_process_status proc_status; -+ u8 fw_rc; -+ u16 seq_num; -+}; -+ -+struct halmac_cfg_param_state { -+ enum halmac_cmd_construct_state cmd_cnstr_state; -+ enum halmac_cmd_process_status proc_status; -+ u8 fw_rc; -+ u16 seq_num; -+}; -+ -+struct halmac_scan_state { -+ enum halmac_cmd_construct_state cmd_cnstr_state; -+ enum halmac_cmd_process_status proc_status; -+ u8 fw_rc; -+ u16 seq_num; -+}; -+ -+struct halmac_update_pkt_state { -+ enum halmac_cmd_process_status proc_status; -+ u8 fw_rc; -+ u16 seq_num; -+ u8 used_page; -+}; -+ -+struct halmac_scan_pkt_state { -+ enum halmac_cmd_process_status proc_status; -+ u8 fw_rc; -+ u16 seq_num; -+}; -+ -+struct halmac_drop_pkt_state { -+ enum halmac_cmd_process_status proc_status; -+ u8 fw_rc; -+ u16 seq_num; -+}; -+ -+struct halmac_iqk_state { -+ enum halmac_cmd_process_status proc_status; -+ u8 fw_rc; -+ u16 seq_num; -+}; -+ -+struct halmac_dpk_state { -+ enum halmac_cmd_process_status proc_status; -+ u16 data_size; -+ u16 seg_size; -+ u8 *data; -+ u8 fw_rc; -+ u16 seq_num; -+}; -+ -+struct halmac_pwr_tracking_state { -+ enum halmac_cmd_process_status proc_status; -+ u8 fw_rc; -+ u16 seq_num; -+}; -+ -+struct halmac_psd_state { -+ enum halmac_cmd_process_status proc_status; -+ u16 data_size; -+ u16 seg_size; -+ u8 *data; -+ u8 fw_rc; -+ u16 seq_num; -+}; -+ -+struct halmac_fw_snding_state { -+ enum halmac_cmd_construct_state cmd_cnstr_state; -+ enum halmac_cmd_process_status proc_status; -+ u8 fw_rc; -+ u16 seq_num; -+}; -+ -+struct halmac_state { -+ struct halmac_efuse_state efuse_state; -+ struct halmac_cfg_param_state cfg_param_state; -+ struct halmac_scan_state scan_state; -+ struct halmac_update_pkt_state update_pkt_state; -+ struct halmac_scan_pkt_state scan_pkt_state; -+ struct halmac_drop_pkt_state drop_pkt_state; -+ struct halmac_iqk_state iqk_state; -+ struct halmac_dpk_state dpk_state; -+ struct halmac_pwr_tracking_state pwr_trk_state; -+ struct halmac_psd_state psd_state; -+ struct halmac_fw_snding_state fw_snding_state; -+ enum halmac_api_state api_state; -+ enum halmac_mac_power mac_pwr; -+ enum halmac_dlfw_state dlfw_state; -+ enum halmac_wlcpu_mode wlcpu_mode; -+ enum halmac_gpio_cfg_state gpio_cfg_state; -+ enum halmac_rsvd_pg_state rsvd_pg_state; -+}; -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_bd_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_bd_nic.h -new file mode 100644 -index 000000000..394441e63 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_bd_nic.h -@@ -0,0 +1,111 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TX_BD_NIC_H_ -+#define _HALMAC_TX_BD_NIC_H_ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT ||\ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT || HALMAC_8814B_SUPPORT) -+ -+/*TXBD_DW0*/ -+ -+#define SET_TX_BD_OWN(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x00, 31, 1, value) -+#define GET_TX_BD_OWN(txbd) LE_BITS_TO_4BYTE(txbd + 0x00, 31, 1) -+#define SET_TX_BD_PSB(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x00, 16, 8, value) -+#define GET_TX_BD_PSB(txbd) LE_BITS_TO_4BYTE(txbd + 0x00, 16, 8) -+#define SET_TX_BD_TX_BUFF_SIZE0(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x00, 0, 16, value) -+#define GET_TX_BD_TX_BUFF_SIZE0(txbd) LE_BITS_TO_4BYTE(txbd + 0x00, 0, 16) -+ -+/*TXBD_DW1*/ -+ -+#define SET_TX_BD_PHYSICAL_ADDR0_LOW(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x04, 0, 32, value) -+#define GET_TX_BD_PHYSICAL_ADDR0_LOW(txbd) LE_BITS_TO_4BYTE(txbd + 0x04, 0, 32) -+ -+/*TXBD_DW2*/ -+ -+#define SET_TX_BD_PHYSICAL_ADDR0_HIGH(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x08, 0, 32, value) -+#define GET_TX_BD_PHYSICAL_ADDR0_HIGH(txbd) LE_BITS_TO_4BYTE(txbd + 0x08, 0, 32) -+ -+/*TXBD_DW4*/ -+ -+#define SET_TX_BD_A1(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x10, 31, 1, value) -+#define GET_TX_BD_A1(txbd) LE_BITS_TO_4BYTE(txbd + 0x10, 31, 1) -+#define SET_TX_BD_TX_BUFF_SIZE1(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x10, 0, 16, value) -+#define GET_TX_BD_TX_BUFF_SIZE1(txbd) LE_BITS_TO_4BYTE(txbd + 0x10, 0, 16) -+ -+/*TXBD_DW5*/ -+ -+#define SET_TX_BD_PHYSICAL_ADDR1_LOW(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x14, 0, 32, value) -+#define GET_TX_BD_PHYSICAL_ADDR1_LOW(txbd) LE_BITS_TO_4BYTE(txbd + 0x14, 0, 32) -+ -+/*TXBD_DW6*/ -+ -+#define SET_TX_BD_PHYSICAL_ADDR1_HIGH(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x18, 0, 32, value) -+#define GET_TX_BD_PHYSICAL_ADDR1_HIGH(txbd) LE_BITS_TO_4BYTE(txbd + 0x18, 0, 32) -+ -+/*TXBD_DW8*/ -+ -+#define SET_TX_BD_A2(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x20, 31, 1, value) -+#define GET_TX_BD_A2(txbd) LE_BITS_TO_4BYTE(txbd + 0x20, 31, 1) -+#define SET_TX_BD_TX_BUFF_SIZE2(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x20, 0, 16, value) -+#define GET_TX_BD_TX_BUFF_SIZE2(txbd) LE_BITS_TO_4BYTE(txbd + 0x20, 0, 16) -+ -+/*TXBD_DW9*/ -+ -+#define SET_TX_BD_PHYSICAL_ADDR2_LOW(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x24, 0, 32, value) -+#define GET_TX_BD_PHYSICAL_ADDR2_LOW(txbd) LE_BITS_TO_4BYTE(txbd + 0x24, 0, 32) -+ -+/*TXBD_DW10*/ -+ -+#define SET_TX_BD_PHYSICAL_ADDR2_HIGH(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x28, 0, 32, value) -+#define GET_TX_BD_PHYSICAL_ADDR2_HIGH(txbd) LE_BITS_TO_4BYTE(txbd + 0x28, 0, 32) -+ -+/*TXBD_DW12*/ -+ -+#define SET_TX_BD_A3(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x30, 31, 1, value) -+#define GET_TX_BD_A3(txbd) LE_BITS_TO_4BYTE(txbd + 0x30, 31, 1) -+#define SET_TX_BD_TX_BUFF_SIZE3(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x30, 0, 16, value) -+#define GET_TX_BD_TX_BUFF_SIZE3(txbd) LE_BITS_TO_4BYTE(txbd + 0x30, 0, 16) -+ -+/*TXBD_DW13*/ -+ -+#define SET_TX_BD_PHYSICAL_ADDR3_LOW(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x34, 0, 32, value) -+#define GET_TX_BD_PHYSICAL_ADDR3_LOW(txbd) LE_BITS_TO_4BYTE(txbd + 0x34, 0, 32) -+ -+/*TXBD_DW14*/ -+ -+#define SET_TX_BD_PHYSICAL_ADDR3_HIGH(txbd, value) \ -+ SET_BITS_TO_LE_4BYTE(txbd + 0x38, 0, 32, value) -+#define GET_TX_BD_PHYSICAL_ADDR3_HIGH(txbd) LE_BITS_TO_4BYTE(txbd + 0x38, 0, 32) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ap.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ap.h -new file mode 100644 -index 000000000..de9d418d1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ap.h -@@ -0,0 +1,2241 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TX_DESC_AP_H_ -+#define _HALMAC_TX_DESC_AP_H_ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_DISQSELSEQ(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_DISQSELSEQ_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 31) -+#define GET_TX_DESC_DISQSELSEQ(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_IE_END_BODY(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_IE_END_BODY_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 31) -+#define GET_TX_DESC_IE_END_BODY(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 31) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_GF(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_GF_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 30) -+#define GET_TX_DESC_GF(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_AGG_EN_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_AGG_EN_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 30) -+#define GET_TX_DESC_AGG_EN_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_NO_ACM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 29) -+#define SET_TX_DESC_NO_ACM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 29) -+#define GET_TX_DESC_NO_ACM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 29) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_BK_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 29) -+#define SET_TX_DESC_BK_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 29) -+#define GET_TX_DESC_BK_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 29) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 28) -+#define SET_TX_DESC_BCNPKT_TSF_CTRL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 28) -+#define GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 27) -+#define SET_TX_DESC_AMSDU_PAD_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 27) -+#define GET_TX_DESC_AMSDU_PAD_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 27) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_LS(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 26) -+#define SET_TX_DESC_LS_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 26) -+#define GET_TX_DESC_LS(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_HTC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 25) -+#define SET_TX_DESC_HTC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 25) -+#define GET_TX_DESC_HTC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 25) -+#define SET_TX_DESC_BMC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 24) -+#define SET_TX_DESC_BMC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 24) -+#define GET_TX_DESC_BMC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_PKT_OFFSET_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1f, 24) -+#define SET_TX_DESC_PKT_OFFSET_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1f, 24) -+#define GET_TX_DESC_PKT_OFFSET_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1f, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_OFFSET(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0xff, 16) -+#define SET_TX_DESC_OFFSET_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0xff, 16) -+#define GET_TX_DESC_OFFSET(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0xff, \ -+ 16) -+#define SET_TX_DESC_TXPKTSIZE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0xffff, 0) -+#define SET_TX_DESC_TXPKTSIZE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0xffff, 0) -+#define GET_TX_DESC_TXPKTSIZE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ 0xffff, 0) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_HW_AES_IV_V2(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_HW_AES_IV_V2_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 31) -+#define GET_TX_DESC_HW_AES_IV_V2(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_AMSDU(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_AMSDU_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 30) -+#define GET_TX_DESC_AMSDU(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_FTM_EN_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_FTM_EN_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 30) -+#define GET_TX_DESC_FTM_EN_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_KEYID_SEL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_KEYID_SEL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 30) -+#define GET_TX_DESC_KEYID_SEL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_MOREDATA(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 29) -+#define SET_TX_DESC_MOREDATA_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 29) -+#define GET_TX_DESC_MOREDATA(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 29) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_HW_AES_IV_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 29) -+#define SET_TX_DESC_HW_AES_IV_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 29) -+#define GET_TX_DESC_HW_AES_IV_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 29) -+#define SET_TX_DESC_MHR_CP(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 25) -+#define SET_TX_DESC_MHR_CP_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 25) -+#define GET_TX_DESC_MHR_CP(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 25) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_PKT_OFFSET(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1f, 24) -+#define SET_TX_DESC_PKT_OFFSET_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1f, 24) -+#define GET_TX_DESC_PKT_OFFSET(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1f, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_SMH_EN_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 24) -+#define SET_TX_DESC_SMH_EN_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 24) -+#define GET_TX_DESC_SMH_EN_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SEC_TYPE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x3, 22) -+#define SET_TX_DESC_SEC_TYPE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x3, 22) -+#define GET_TX_DESC_SEC_TYPE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x3, \ -+ 22) -+#define SET_TX_DESC_EN_DESC_ID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 21) -+#define SET_TX_DESC_EN_DESC_ID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 21) -+#define GET_TX_DESC_EN_DESC_ID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 21) -+#define SET_TX_DESC_RATE_ID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1f, 16) -+#define SET_TX_DESC_RATE_ID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1f, 16) -+#define GET_TX_DESC_RATE_ID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1f, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_SMH_CAM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0xff, 16) -+#define SET_TX_DESC_SMH_CAM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0xff, 16) -+#define GET_TX_DESC_SMH_CAM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0xff, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_PIFS(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 15) -+#define SET_TX_DESC_PIFS_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 15) -+#define GET_TX_DESC_PIFS(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 15) -+#define SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 14) -+#define SET_TX_DESC_LSIG_TXOP_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 14) -+#define GET_TX_DESC_LSIG_TXOP_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 14) -+#define SET_TX_DESC_RD_NAV_EXT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 13) -+#define SET_TX_DESC_RD_NAV_EXT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 13) -+#define GET_TX_DESC_RD_NAV_EXT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 13) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_EXT_EDCA(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 13) -+#define SET_TX_DESC_EXT_EDCA_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 13) -+#define GET_TX_DESC_EXT_EDCA(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_QSEL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1f, 8) -+#define SET_TX_DESC_QSEL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1f, 8) -+#define GET_TX_DESC_QSEL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1f, \ -+ 8) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SPECIAL_CW(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 7) -+#define SET_TX_DESC_SPECIAL_CW_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 7) -+#define GET_TX_DESC_SPECIAL_CW(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, 7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_MACID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x7f, 0) -+#define SET_TX_DESC_MACID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x7f, 0) -+#define GET_TX_DESC_MACID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x7f, \ -+ 0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_MACID_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x7f, 0) -+#define SET_TX_DESC_MACID_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x7f, 0) -+#define GET_TX_DESC_MACID_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x7f, \ -+ 0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_HW_AES_IV(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_HW_AES_IV_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 31) -+#define GET_TX_DESC_HW_AES_IV(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 31) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_CHK_EN_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_CHK_EN_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 31) -+#define GET_TX_DESC_CHK_EN_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 31) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_FTM_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_FTM_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 30) -+#define GET_TX_DESC_FTM_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANTCEL_D_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0xf, 28) -+#define SET_TX_DESC_ANTCEL_D_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0xf, 28) -+#define GET_TX_DESC_ANTCEL_D_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0xf, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_DMA_PRI(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 27) -+#define SET_TX_DESC_DMA_PRI_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 27) -+#define GET_TX_DESC_DMA_PRI(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 27) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_G_ID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x3f, 24) -+#define SET_TX_DESC_G_ID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x3f, 24) -+#define GET_TX_DESC_G_ID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x3f, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_MAX_AMSDU_MODE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x7, 24) -+#define SET_TX_DESC_MAX_AMSDU_MODE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x7, 24) -+#define GET_TX_DESC_MAX_AMSDU_MODE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x7, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_C_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0xf, 24) -+#define SET_TX_DESC_ANTSEL_C_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0xf, 24) -+#define GET_TX_DESC_ANTSEL_C_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0xf, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_BT_NULL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 23) -+#define SET_TX_DESC_BT_NULL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 23) -+#define GET_TX_DESC_BT_NULL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 23) -+#define SET_TX_DESC_AMPDU_DENSITY(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x7, 20) -+#define SET_TX_DESC_AMPDU_DENSITY_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x7, 20) -+#define GET_TX_DESC_AMPDU_DENSITY(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x7, \ -+ 20) -+#define SET_TX_DESC_SPE_RPT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 19) -+#define SET_TX_DESC_SPE_RPT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 19) -+#define GET_TX_DESC_SPE_RPT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 19) -+#define SET_TX_DESC_RAW(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 18) -+#define SET_TX_DESC_RAW_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 18) -+#define GET_TX_DESC_RAW(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 18) -+#define SET_TX_DESC_MOREFRAG(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 17) -+#define SET_TX_DESC_MOREFRAG_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 17) -+#define GET_TX_DESC_MOREFRAG(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 17) -+#define SET_TX_DESC_BK(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 16) -+#define SET_TX_DESC_BK_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 16) -+#define GET_TX_DESC_BK(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0xff, 16) -+#define SET_TX_DESC_DMA_TXAGG_NUM_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0xff, 16) -+#define GET_TX_DESC_DMA_TXAGG_NUM_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0xff, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_NULL_1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 15) -+#define SET_TX_DESC_NULL_1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 15) -+#define GET_TX_DESC_NULL_1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 15) -+#define SET_TX_DESC_NULL_0(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 14) -+#define SET_TX_DESC_NULL_0_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 14) -+#define GET_TX_DESC_NULL_0(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 14) -+#define SET_TX_DESC_RDG_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 13) -+#define SET_TX_DESC_RDG_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 13) -+#define GET_TX_DESC_RDG_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 13) -+#define SET_TX_DESC_AGG_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 12) -+#define SET_TX_DESC_AGG_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 12) -+#define GET_TX_DESC_AGG_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 12) -+#define SET_TX_DESC_CCA_RTS(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x3, 10) -+#define SET_TX_DESC_CCA_RTS_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x3, 10) -+#define GET_TX_DESC_CCA_RTS(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x3, \ -+ 10) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_TRI_FRAME(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 9) -+#define SET_TX_DESC_TRI_FRAME_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 9) -+#define GET_TX_DESC_TRI_FRAME(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, 9) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_P_AID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1ff, 0) -+#define SET_TX_DESC_P_AID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1ff, 0) -+#define GET_TX_DESC_P_AID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ 0x1ff, 0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_TXDESC_CHECKSUM_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0xffff, 0) -+#define SET_TX_DESC_TXDESC_CHECKSUM_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0xffff, 0) -+#define GET_TX_DESC_TXDESC_CHECKSUM_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ 0xffff, 0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0xff, 24) -+#define SET_TX_DESC_AMPDU_MAX_TIME_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0xff, 24) -+#define GET_TX_DESC_AMPDU_MAX_TIME(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0xff, \ -+ 24) -+#define SET_TX_DESC_NDPA(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x3, 22) -+#define SET_TX_DESC_NDPA_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x3, 22) -+#define GET_TX_DESC_NDPA(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x3, \ -+ 22) -+#define SET_TX_DESC_MAX_AGG_NUM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1f, 17) -+#define SET_TX_DESC_MAX_AGG_NUM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1f, 17) -+#define GET_TX_DESC_MAX_AGG_NUM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1f, \ -+ 17) -+#define SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 16) -+#define SET_TX_DESC_USE_MAX_TIME_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 16) -+#define GET_TX_DESC_USE_MAX_TIME_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_OFFLOAD_SIZE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x7fff, 16) -+#define SET_TX_DESC_OFFLOAD_SIZE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x7fff, 16) -+#define GET_TX_DESC_OFFLOAD_SIZE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ 0x7fff, 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_NAVUSEHDR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 15) -+#define SET_TX_DESC_NAVUSEHDR_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 15) -+#define GET_TX_DESC_NAVUSEHDR(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, \ -+ 15) -+#define SET_TX_DESC_CHK_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 14) -+#define SET_TX_DESC_CHK_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 14) -+#define GET_TX_DESC_CHK_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, \ -+ 14) -+#define SET_TX_DESC_HW_RTS_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 13) -+#define SET_TX_DESC_HW_RTS_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 13) -+#define GET_TX_DESC_HW_RTS_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, \ -+ 13) -+#define SET_TX_DESC_RTSEN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 12) -+#define SET_TX_DESC_RTSEN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 12) -+#define GET_TX_DESC_RTSEN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, \ -+ 12) -+#define SET_TX_DESC_CTS2SELF(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 11) -+#define SET_TX_DESC_CTS2SELF_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 11) -+#define GET_TX_DESC_CTS2SELF(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, \ -+ 11) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_CHANNEL_DMA(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1f, 11) -+#define SET_TX_DESC_CHANNEL_DMA_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1f, 11) -+#define GET_TX_DESC_CHANNEL_DMA(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1f, \ -+ 11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_DISDATAFB(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 10) -+#define SET_TX_DESC_DISDATAFB_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 10) -+#define GET_TX_DESC_DISDATAFB(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, \ -+ 10) -+#define SET_TX_DESC_DISRTSFB(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 9) -+#define SET_TX_DESC_DISRTSFB_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 9) -+#define GET_TX_DESC_DISRTSFB(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, 9) -+#define SET_TX_DESC_USE_RATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 8) -+#define SET_TX_DESC_USE_RATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 8) -+#define GET_TX_DESC_USE_RATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, 8) -+#define SET_TX_DESC_HW_SSN_SEL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x3, 6) -+#define SET_TX_DESC_HW_SSN_SEL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x3, 6) -+#define GET_TX_DESC_HW_SSN_SEL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x3, 6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_IE_CNT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x7, 6) -+#define SET_TX_DESC_IE_CNT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x7, 6) -+#define GET_TX_DESC_IE_CNT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x7, 6) -+#define SET_TX_DESC_IE_CNT_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 5) -+#define SET_TX_DESC_IE_CNT_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 5) -+#define GET_TX_DESC_IE_CNT_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, 5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_WHEADER_LEN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1f, 0) -+#define SET_TX_DESC_WHEADER_LEN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1f, 0) -+#define GET_TX_DESC_WHEADER_LEN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1f, \ -+ 0) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_WHEADER_LEN_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1f, 0) -+#define SET_TX_DESC_WHEADER_LEN_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1f, 0) -+#define GET_TX_DESC_WHEADER_LEN_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1f, \ -+ 0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x3, 30) -+#define SET_TX_DESC_PCTS_MASK_IDX_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x3, 30) -+#define GET_TX_DESC_PCTS_MASK_IDX(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x3, \ -+ 30) -+#define SET_TX_DESC_PCTS_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x1, 29) -+#define SET_TX_DESC_PCTS_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x1, 29) -+#define GET_TX_DESC_PCTS_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x1, \ -+ 29) -+#define SET_TX_DESC_RTSRATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x1f, 24) -+#define SET_TX_DESC_RTSRATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x1f, 24) -+#define GET_TX_DESC_RTSRATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x1f, \ -+ 24) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x3f, 18) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x3f, 18) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x3f, \ -+ 18) -+#define SET_TX_DESC_RTY_LMT_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x1, 17) -+#define SET_TX_DESC_RTY_LMT_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x1, 17) -+#define GET_TX_DESC_RTY_LMT_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x1, \ -+ 17) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0xf, 13) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0xf, 13) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0xf, \ -+ 13) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x1f, 8) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x1f, 8) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x1f, \ -+ 8) -+#define SET_TX_DESC_TRY_RATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x1, 7) -+#define SET_TX_DESC_TRY_RATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x1, 7) -+#define GET_TX_DESC_TRY_RATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x1, 7) -+#define SET_TX_DESC_DATARATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x7f, 0) -+#define SET_TX_DESC_DATARATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x7f, 0) -+#define GET_TX_DESC_DATARATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x7f, \ -+ 0) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_POLLUTED_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 31) -+#define GET_TX_DESC_POLLUTED(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 31) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_EN_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_ANTSEL_EN_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 30) -+#define GET_TX_DESC_ANTSEL_EN_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_TXPWR_OFSET(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x7, 28) -+#define SET_TX_DESC_TXPWR_OFSET_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x7, 28) -+#define GET_TX_DESC_TXPWR_OFSET(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x7, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_TXPWR_OFSET_TYPE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x3, 28) -+#define SET_TX_DESC_TXPWR_OFSET_TYPE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x3, 28) -+#define GET_TX_DESC_TXPWR_OFSET_TYPE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x3, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_TXPWR_OFSET_TYPE_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x7, 28) -+#define SET_TX_DESC_TXPWR_OFSET_TYPE_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x7, 28) -+#define GET_TX_DESC_TXPWR_OFSET_TYPE_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x7, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_TX_ANT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0xf, 24) -+#define SET_TX_DESC_TX_ANT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0xf, 24) -+#define GET_TX_DESC_TX_ANT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0xf, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_DROP_ID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x3, 24) -+#define SET_TX_DESC_DROP_ID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x3, 24) -+#define GET_TX_DESC_DROP_ID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x3, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_DROP_ID_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x3, 22) -+#define SET_TX_DESC_DROP_ID_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x3, 22) -+#define GET_TX_DESC_DROP_ID_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x3, \ -+ 22) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_PORT_ID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x7, 21) -+#define SET_TX_DESC_PORT_ID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x7, 21) -+#define GET_TX_DESC_PORT_ID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x7, \ -+ 21) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_PORT_ID_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 21) -+#define SET_TX_DESC_PORT_ID_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 21) -+#define GET_TX_DESC_PORT_ID_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 21) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_MULTIPLE_PORT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x7, 18) -+#define SET_TX_DESC_MULTIPLE_PORT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x7, 18) -+#define GET_TX_DESC_MULTIPLE_PORT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x7, \ -+ 18) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SIGNALING_TAPKT_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 17) -+#define SET_TX_DESC_SIGNALING_TAPKT_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 17) -+#define GET_TX_DESC_SIGNALING_TAPKT_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 17) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_RTS_SC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0xf, 13) -+#define SET_TX_DESC_RTS_SC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0xf, 13) -+#define GET_TX_DESC_RTS_SC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0xf, \ -+ 13) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0xf, 13) -+#define SET_TX_DESC_SIGNALING_TA_PKT_SC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0xf, 13) -+#define GET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0xf, \ -+ 13) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_RTS_SHORT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 12) -+#define SET_TX_DESC_RTS_SHORT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 12) -+#define GET_TX_DESC_RTS_SHORT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 12) -+#define SET_TX_DESC_VCS_STBC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x3, 10) -+#define SET_TX_DESC_VCS_STBC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x3, 10) -+#define GET_TX_DESC_VCS_STBC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x3, \ -+ 10) -+#define SET_TX_DESC_DATA_STBC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x3, 8) -+#define SET_TX_DESC_DATA_STBC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x3, 8) -+#define GET_TX_DESC_DATA_STBC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x3, 8) -+#define SET_TX_DESC_DATA_LDPC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 7) -+#define SET_TX_DESC_DATA_LDPC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 7) -+#define GET_TX_DESC_DATA_LDPC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, 7) -+#define SET_TX_DESC_DATA_BW(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x3, 5) -+#define SET_TX_DESC_DATA_BW_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x3, 5) -+#define GET_TX_DESC_DATA_BW(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x3, 5) -+#define SET_TX_DESC_DATA_SHORT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 4) -+#define SET_TX_DESC_DATA_SHORT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 4) -+#define GET_TX_DESC_DATA_SHORT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, 4) -+#define SET_TX_DESC_DATA_SC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0xf, 0) -+#define SET_TX_DESC_DATA_SC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0xf, 0) -+#define GET_TX_DESC_DATA_SC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0xf, 0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANTSEL_D(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 30) -+#define SET_TX_DESC_ANTSEL_D_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 30) -+#define GET_TX_DESC_ANTSEL_D(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPD_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 30) -+#define SET_TX_DESC_ANT_MAPD_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 30) -+#define GET_TX_DESC_ANT_MAPD_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPC_V2(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 30) -+#define SET_TX_DESC_ANT_MAPC_V2_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 30) -+#define GET_TX_DESC_ANT_MAPC_V2(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 30) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPD(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 28) -+#define SET_TX_DESC_ANT_MAPD_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 28) -+#define GET_TX_DESC_ANT_MAPD(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPC_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 28) -+#define SET_TX_DESC_ANT_MAPC_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 28) -+#define GET_TX_DESC_ANT_MAPC_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPB_V2(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 28) -+#define SET_TX_DESC_ANT_MAPB_V2_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 28) -+#define GET_TX_DESC_ANT_MAPB_V2(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 28) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 26) -+#define SET_TX_DESC_ANT_MAPC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 26) -+#define GET_TX_DESC_ANT_MAPC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 26) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPB_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 26) -+#define SET_TX_DESC_ANT_MAPB_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 26) -+#define GET_TX_DESC_ANT_MAPB_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 26) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPA_V2(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 26) -+#define SET_TX_DESC_ANT_MAPA_V2_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 26) -+#define GET_TX_DESC_ANT_MAPA_V2(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 26) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPB(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 24) -+#define SET_TX_DESC_ANT_MAPB_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 24) -+#define GET_TX_DESC_ANT_MAPB(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPA_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 24) -+#define SET_TX_DESC_ANT_MAPA_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 24) -+#define GET_TX_DESC_ANT_MAPA_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_D_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 24) -+#define SET_TX_DESC_ANTSEL_D_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 24) -+#define GET_TX_DESC_ANTSEL_D_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPA(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 22) -+#define SET_TX_DESC_ANT_MAPA_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 22) -+#define GET_TX_DESC_ANT_MAPA(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 22) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_C_V2(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 22) -+#define SET_TX_DESC_ANTSEL_C_V2_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 22) -+#define GET_TX_DESC_ANTSEL_C_V2(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 22) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_C(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 20) -+#define SET_TX_DESC_ANTSEL_C_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 20) -+#define GET_TX_DESC_ANTSEL_C(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 20) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_B_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0xf, 20) -+#define SET_TX_DESC_ANTSEL_B_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0xf, 20) -+#define GET_TX_DESC_ANTSEL_B_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0xf, \ -+ 20) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_B_V2(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x7, 19) -+#define SET_TX_DESC_ANTSEL_B_V2_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x7, 19) -+#define GET_TX_DESC_ANTSEL_B_V2(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x7, \ -+ 19) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_B(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 18) -+#define SET_TX_DESC_ANTSEL_B_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 18) -+#define GET_TX_DESC_ANTSEL_B(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 18) -+#define SET_TX_DESC_ANTSEL_A(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 16) -+#define SET_TX_DESC_ANTSEL_A_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 16) -+#define GET_TX_DESC_ANTSEL_A(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_A_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0xf, 16) -+#define SET_TX_DESC_ANTSEL_A_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0xf, 16) -+#define GET_TX_DESC_ANTSEL_A_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0xf, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_A_V2(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x7, 16) -+#define SET_TX_DESC_ANTSEL_A_V2_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x7, 16) -+#define GET_TX_DESC_ANTSEL_A_V2(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x7, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_MBSSID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0xf, 12) -+#define SET_TX_DESC_MBSSID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0xf, 12) -+#define GET_TX_DESC_MBSSID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0xf, \ -+ 12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_SW_DEFINE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0xfff, 0) -+#define SET_TX_DESC_SW_DEFINE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0xfff, 0) -+#define GET_TX_DESC_SW_DEFINE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ 0xfff, 0) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SWPS_SEQ(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0xfff, 0) -+#define SET_TX_DESC_SWPS_SEQ_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0xfff, 0) -+#define GET_TX_DESC_SWPS_SEQ(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ 0xfff, 0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0xff, 24) -+#define SET_TX_DESC_DMA_TXAGG_NUM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0xff, 24) -+#define GET_TX_DESC_DMA_TXAGG_NUM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0xff, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_FINAL_DATA_RATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0xff, 24) -+#define SET_TX_DESC_FINAL_DATA_RATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0xff, 24) -+#define GET_TX_DESC_FINAL_DATA_RATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0xff, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPD_V2(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0x3, 22) -+#define SET_TX_DESC_ANT_MAPD_V2_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0x3, 22) -+#define GET_TX_DESC_ANT_MAPD_V2(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0x3, \ -+ 22) -+#define SET_TX_DESC_ANTSEL_EN_V2(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0x1, 21) -+#define SET_TX_DESC_ANTSEL_EN_V2_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0x1, 21) -+#define GET_TX_DESC_ANTSEL_EN_V2(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0x1, \ -+ 21) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_NTX_MAP(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0xf, 20) -+#define SET_TX_DESC_NTX_MAP_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0xf, 20) -+#define GET_TX_DESC_NTX_MAP(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0xf, \ -+ 20) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0x1, 19) -+#define SET_TX_DESC_ANTSEL_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0x1, 19) -+#define GET_TX_DESC_ANTSEL_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0x1, \ -+ 19) -+#define SET_TX_DESC_MBSSID_EX(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0x7, 16) -+#define SET_TX_DESC_MBSSID_EX_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0x7, 16) -+#define GET_TX_DESC_MBSSID_EX(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0x7, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_MBSSID_EX_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0x1, 16) -+#define SET_TX_DESC_MBSSID_EX_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0x1, 16) -+#define GET_TX_DESC_MBSSID_EX_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0x1, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0xffff, 0) -+#define SET_TX_DESC_TX_BUFF_SIZE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0xffff, 0) -+#define GET_TX_DESC_TX_BUFF_SIZE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ 0xffff, 0) -+#define SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0xffff, 0) -+#define SET_TX_DESC_TXDESC_CHECKSUM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0xffff, 0) -+#define GET_TX_DESC_TXDESC_CHECKSUM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ 0xffff, 0) -+#define SET_TX_DESC_TIMESTAMP(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0xffff, 0) -+#define SET_TX_DESC_TIMESTAMP_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0xffff, 0) -+#define GET_TX_DESC_TIMESTAMP(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ 0xffff, 0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TXWIFI_CP(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_TXWIFI_CP_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 31) -+#define GET_TX_DESC_TXWIFI_CP(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, \ -+ 31) -+#define SET_TX_DESC_MAC_CP(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_MAC_CP_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 30) -+#define GET_TX_DESC_MAC_CP(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, \ -+ 30) -+#define SET_TX_DESC_STW_PKTRE_DIS(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 29) -+#define SET_TX_DESC_STW_PKTRE_DIS_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 29) -+#define GET_TX_DESC_STW_PKTRE_DIS(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, \ -+ 29) -+#define SET_TX_DESC_STW_RB_DIS(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 28) -+#define SET_TX_DESC_STW_RB_DIS_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 28) -+#define GET_TX_DESC_STW_RB_DIS(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, \ -+ 28) -+#define SET_TX_DESC_STW_RATE_DIS(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 27) -+#define SET_TX_DESC_STW_RATE_DIS_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 27) -+#define GET_TX_DESC_STW_RATE_DIS(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, \ -+ 27) -+#define SET_TX_DESC_STW_ANT_DIS(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 26) -+#define SET_TX_DESC_STW_ANT_DIS_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 26) -+#define GET_TX_DESC_STW_ANT_DIS(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, \ -+ 26) -+#define SET_TX_DESC_STW_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 25) -+#define SET_TX_DESC_STW_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 25) -+#define GET_TX_DESC_STW_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, \ -+ 25) -+#define SET_TX_DESC_SMH_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 24) -+#define SET_TX_DESC_SMH_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 24) -+#define GET_TX_DESC_SMH_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_TAILPAGE_L(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0xff, 24) -+#define SET_TX_DESC_TAILPAGE_L_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0xff, 24) -+#define GET_TX_DESC_TAILPAGE_L(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0xff, \ -+ 24) -+#define SET_TX_DESC_SDIO_DMASEQ(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0xff, 16) -+#define SET_TX_DESC_SDIO_DMASEQ_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0xff, 16) -+#define GET_TX_DESC_SDIO_DMASEQ(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0xff, \ -+ 16) -+#define SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0xff, 16) -+#define SET_TX_DESC_NEXTHEADPAGE_L_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0xff, 16) -+#define GET_TX_DESC_NEXTHEADPAGE_L(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0xff, \ -+ 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_EN_HWSEQ(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 15) -+#define SET_TX_DESC_EN_HWSEQ_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 15) -+#define GET_TX_DESC_EN_HWSEQ(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, \ -+ 15) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define SET_TX_DESC_EN_HWEXSEQ(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 14) -+#define SET_TX_DESC_EN_HWEXSEQ_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 14) -+#define GET_TX_DESC_EN_HWEXSEQ(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, \ -+ 14) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_EN_HWSEQ_MODE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x3, 14) -+#define SET_TX_DESC_EN_HWSEQ_MODE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x3, 14) -+#define GET_TX_DESC_EN_HWSEQ_MODE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x3, \ -+ 14) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_DATA_RC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x3f, 8) -+#define SET_TX_DESC_DATA_RC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x3f, 8) -+#define GET_TX_DESC_DATA_RC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x3f, \ -+ 8) -+#define SET_TX_DESC_BAR_RTY_TH(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x3, 6) -+#define SET_TX_DESC_BAR_RTY_TH_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x3, 6) -+#define GET_TX_DESC_BAR_RTY_TH(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x3, 6) -+#define SET_TX_DESC_RTS_RC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x3f, 0) -+#define SET_TX_DESC_RTS_RC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x3f, 0) -+#define GET_TX_DESC_RTS_RC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x3f, \ -+ 0) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_TAILPAGE_H(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0xf, 28) -+#define SET_TX_DESC_TAILPAGE_H_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0xf, 28) -+#define GET_TX_DESC_TAILPAGE_H(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0xf, \ -+ 28) -+#define SET_TX_DESC_NEXTHEADPAGE_H(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0xf, 24) -+#define SET_TX_DESC_NEXTHEADPAGE_H_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0xf, 24) -+#define GET_TX_DESC_NEXTHEADPAGE_H(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0xf, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_FINAL_DATA_RATE_V1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0xff, 24) -+#define SET_TX_DESC_FINAL_DATA_RATE_V1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0xff, 24) -+#define GET_TX_DESC_FINAL_DATA_RATE_V1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0xff, \ -+ 24) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SW_SEQ(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0xfff, 12) -+#define SET_TX_DESC_SW_SEQ_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0xfff, 12) -+#define GET_TX_DESC_SW_SEQ(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ 0xfff, 12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_TXBF_PATH(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 11) -+#define SET_TX_DESC_TXBF_PATH_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 11) -+#define GET_TX_DESC_TXBF_PATH(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, \ -+ 11) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_PADDING_LEN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x7ff, 0) -+#define SET_TX_DESC_PADDING_LEN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x7ff, 0) -+#define GET_TX_DESC_PADDING_LEN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ 0x7ff, 0) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0xff, 0) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0xff, 0) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0xff, \ -+ 0) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/*WORD10*/ -+ -+#define SET_TX_DESC_HT_DATA_SND(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_HT_DATA_SND_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 31) -+#define GET_TX_DESC_HT_DATA_SND(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 31) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SHCUT_CAM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x3f, 16) -+#define SET_TX_DESC_SHCUT_CAM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x3f, 16) -+#define GET_TX_DESC_SHCUT_CAM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ 0x3f, 16) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_MU_DATARATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0xff, 8) -+#define SET_TX_DESC_MU_DATARATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0xff, 8) -+#define GET_TX_DESC_MU_DATARATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ 0xff, 8) -+#define SET_TX_DESC_MU_RC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0xf, 4) -+#define SET_TX_DESC_MU_RC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0xf, 4) -+#define GET_TX_DESC_MU_RC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0xf, \ -+ 4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_NDPA_RATE_SEL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 3) -+#define SET_TX_DESC_NDPA_RATE_SEL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 3) -+#define GET_TX_DESC_NDPA_RATE_SEL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 3) -+#define SET_TX_DESC_HW_NDPA_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 2) -+#define SET_TX_DESC_HW_NDPA_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 2) -+#define GET_TX_DESC_HW_NDPA_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 2) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SND_PKT_SEL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x3, 0) -+#define SET_TX_DESC_SND_PKT_SEL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x3, 0) -+#define GET_TX_DESC_SND_PKT_SEL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x3, \ -+ 0) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_buffer_ap.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_buffer_ap.h -new file mode 100644 -index 000000000..a45b023b3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_buffer_ap.h -@@ -0,0 +1,1078 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TX_DESC_BUFFER_AP_H_ -+#define _HALMAC_TX_DESC_BUFFER_AP_H_ -+#if (HALMAC_8814B_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_BUFFER_RDG_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_BUFFER_RDG_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 31) -+#define GET_TX_DESC_BUFFER_RDG_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 31) -+#define SET_TX_DESC_BUFFER_BCNPKT_TSF_CTRL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_BUFFER_BCNPKT_TSF_CTRL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 30) -+#define GET_TX_DESC_BUFFER_BCNPKT_TSF_CTRL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 30) -+#define SET_TX_DESC_BUFFER_AGG_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1, 29) -+#define SET_TX_DESC_BUFFER_AGG_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1, 29) -+#define GET_TX_DESC_BUFFER_AGG_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1, \ -+ 29) -+#define SET_TX_DESC_BUFFER_PKT_OFFSET(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0x1f, 24) -+#define SET_TX_DESC_BUFFER_PKT_OFFSET_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0x1f, 24) -+#define GET_TX_DESC_BUFFER_PKT_OFFSET(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0x1f, \ -+ 24) -+#define SET_TX_DESC_BUFFER_OFFSET(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0xff, 16) -+#define SET_TX_DESC_BUFFER_OFFSET_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0xff, 16) -+#define GET_TX_DESC_BUFFER_OFFSET(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, 0xff, \ -+ 16) -+#define SET_TX_DESC_BUFFER_TXPKTSIZE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ value, 0xffff, 0) -+#define SET_TX_DESC_BUFFER_TXPKTSIZE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword0, value, 0xffff, 0) -+#define GET_TX_DESC_BUFFER_TXPKTSIZE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword0, \ -+ 0xffff, 0) -+ -+/*TXDESC_WORD1*/ -+ -+#define SET_TX_DESC_BUFFER_USERATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_BUFFER_USERATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 31) -+#define GET_TX_DESC_BUFFER_USERATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 31) -+#define SET_TX_DESC_BUFFER_AMSDU(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_BUFFER_AMSDU_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 30) -+#define GET_TX_DESC_BUFFER_AMSDU(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 30) -+#define SET_TX_DESC_BUFFER_EN_HWSEQ(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 29) -+#define SET_TX_DESC_BUFFER_EN_HWSEQ_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 29) -+#define GET_TX_DESC_BUFFER_EN_HWSEQ(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 29) -+#define SET_TX_DESC_BUFFER_EN_HWEXSEQ(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 28) -+#define SET_TX_DESC_BUFFER_EN_HWEXSEQ_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 28) -+#define GET_TX_DESC_BUFFER_EN_HWEXSEQ(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 28) -+#define SET_TX_DESC_BUFFER_SW_SEQ(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0xfff, 16) -+#define SET_TX_DESC_BUFFER_SW_SEQ_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0xfff, 16) -+#define GET_TX_DESC_BUFFER_SW_SEQ(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ 0xfff, 16) -+#define SET_TX_DESC_BUFFER_DROP_ID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x3, 14) -+#define SET_TX_DESC_BUFFER_DROP_ID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x3, 14) -+#define GET_TX_DESC_BUFFER_DROP_ID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x3, \ -+ 14) -+#define SET_TX_DESC_BUFFER_MOREDATA(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1, 13) -+#define SET_TX_DESC_BUFFER_MOREDATA_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1, 13) -+#define GET_TX_DESC_BUFFER_MOREDATA(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1, \ -+ 13) -+#define SET_TX_DESC_BUFFER_QSEL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0x1f, 8) -+#define SET_TX_DESC_BUFFER_QSEL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0x1f, 8) -+#define GET_TX_DESC_BUFFER_QSEL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0x1f, \ -+ 8) -+#define SET_TX_DESC_BUFFER_MACID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword1, \ -+ value, 0xff, 0) -+#define SET_TX_DESC_BUFFER_MACID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword1, value, 0xff, 0) -+#define GET_TX_DESC_BUFFER_MACID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword1, 0xff, \ -+ 0) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_BUFFER_CHK_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_BUFFER_CHK_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 31) -+#define GET_TX_DESC_BUFFER_CHK_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 31) -+#define SET_TX_DESC_BUFFER_DISQSELSEQ(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_BUFFER_DISQSELSEQ_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 30) -+#define GET_TX_DESC_BUFFER_DISQSELSEQ(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 30) -+#define SET_TX_DESC_BUFFER_SND_PKT_SEL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x3, 28) -+#define SET_TX_DESC_BUFFER_SND_PKT_SEL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x3, 28) -+#define GET_TX_DESC_BUFFER_SND_PKT_SEL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x3, \ -+ 28) -+#define SET_TX_DESC_BUFFER_DMA_PRI(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x1, 27) -+#define SET_TX_DESC_BUFFER_DMA_PRI_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x1, 27) -+#define GET_TX_DESC_BUFFER_DMA_PRI(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x1, \ -+ 27) -+#define SET_TX_DESC_BUFFER_MAX_AMSDU_MODE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0x7, 24) -+#define SET_TX_DESC_BUFFER_MAX_AMSDU_MODE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0x7, 24) -+#define GET_TX_DESC_BUFFER_MAX_AMSDU_MODE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0x7, \ -+ 24) -+#define SET_TX_DESC_BUFFER_DMA_TXAGG_NUM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0xff, 16) -+#define SET_TX_DESC_BUFFER_DMA_TXAGG_NUM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0xff, 16) -+#define GET_TX_DESC_BUFFER_DMA_TXAGG_NUM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, 0xff, \ -+ 16) -+#define SET_TX_DESC_BUFFER_TXDESC_CHECKSUM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ value, 0xffff, 0) -+#define SET_TX_DESC_BUFFER_TXDESC_CHECKSUM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword2, value, 0xffff, 0) -+#define GET_TX_DESC_BUFFER_TXDESC_CHECKSUM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword2, \ -+ 0xffff, 0) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_BUFFER_OFFLOAD_SIZE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x7fff, 16) -+#define SET_TX_DESC_BUFFER_OFFLOAD_SIZE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x7fff, 16) -+#define GET_TX_DESC_BUFFER_OFFLOAD_SIZE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ 0x7fff, 16) -+#define SET_TX_DESC_BUFFER_CHANNEL_DMA(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1f, 11) -+#define SET_TX_DESC_BUFFER_CHANNEL_DMA_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1f, 11) -+#define GET_TX_DESC_BUFFER_CHANNEL_DMA(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1f, \ -+ 11) -+#define SET_TX_DESC_BUFFER_MBSSID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0xf, 7) -+#define SET_TX_DESC_BUFFER_MBSSID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0xf, 7) -+#define GET_TX_DESC_BUFFER_MBSSID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0xf, 7) -+#define SET_TX_DESC_BUFFER_BK(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1, 6) -+#define SET_TX_DESC_BUFFER_BK_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1, 6) -+#define GET_TX_DESC_BUFFER_BK(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1, 6) -+#define SET_TX_DESC_BUFFER_WHEADER_LEN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword3, \ -+ value, 0x1f, 0) -+#define SET_TX_DESC_BUFFER_WHEADER_LEN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword3, value, 0x1f, 0) -+#define GET_TX_DESC_BUFFER_WHEADER_LEN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword3, 0x1f, \ -+ 0) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_BUFFER_TRY_RATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x1, 26) -+#define SET_TX_DESC_BUFFER_TRY_RATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x1, 26) -+#define GET_TX_DESC_BUFFER_TRY_RATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x1, \ -+ 26) -+#define SET_TX_DESC_BUFFER_DATA_BW(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x3, 24) -+#define SET_TX_DESC_BUFFER_DATA_BW_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x3, 24) -+#define GET_TX_DESC_BUFFER_DATA_BW(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x3, \ -+ 24) -+#define SET_TX_DESC_BUFFER_DATA_SHORT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x1, 23) -+#define SET_TX_DESC_BUFFER_DATA_SHORT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x1, 23) -+#define GET_TX_DESC_BUFFER_DATA_SHORT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x1, \ -+ 23) -+#define SET_TX_DESC_BUFFER_DATARATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x7f, 16) -+#define SET_TX_DESC_BUFFER_DATARATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x7f, 16) -+#define GET_TX_DESC_BUFFER_DATARATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x7f, \ -+ 16) -+#define SET_TX_DESC_BUFFER_TXBF_PATH(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x1, 11) -+#define SET_TX_DESC_BUFFER_TXBF_PATH_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x1, 11) -+#define GET_TX_DESC_BUFFER_TXBF_PATH(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, 0x1, \ -+ 11) -+#define SET_TX_DESC_BUFFER_GROUP_BIT_IE_OFFSET(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ value, 0x7ff, 0) -+#define SET_TX_DESC_BUFFER_GROUP_BIT_IE_OFFSET_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword4, value, 0x7ff, 0) -+#define GET_TX_DESC_BUFFER_GROUP_BIT_IE_OFFSET(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword4, \ -+ 0x7ff, 0) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_BUFFER_RTY_LMT_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 31) -+#define SET_TX_DESC_BUFFER_RTY_LMT_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 31) -+#define GET_TX_DESC_BUFFER_RTY_LMT_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 31) -+#define SET_TX_DESC_BUFFER_HW_RTS_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 30) -+#define SET_TX_DESC_BUFFER_HW_RTS_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 30) -+#define GET_TX_DESC_BUFFER_HW_RTS_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 30) -+#define SET_TX_DESC_BUFFER_RTS_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 29) -+#define SET_TX_DESC_BUFFER_RTS_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 29) -+#define GET_TX_DESC_BUFFER_RTS_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 29) -+#define SET_TX_DESC_BUFFER_CTS2SELF(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 28) -+#define SET_TX_DESC_BUFFER_CTS2SELF_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 28) -+#define GET_TX_DESC_BUFFER_CTS2SELF(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 28) -+#define SET_TX_DESC_BUFFER_TAILPAGE_H(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0xf, 24) -+#define SET_TX_DESC_BUFFER_TAILPAGE_H_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0xf, 24) -+#define GET_TX_DESC_BUFFER_TAILPAGE_H(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0xf, \ -+ 24) -+#define SET_TX_DESC_BUFFER_TAILPAGE_L(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0xff, 16) -+#define SET_TX_DESC_BUFFER_TAILPAGE_L_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0xff, 16) -+#define GET_TX_DESC_BUFFER_TAILPAGE_L(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0xff, \ -+ 16) -+#define SET_TX_DESC_BUFFER_NAVUSEHDR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 15) -+#define SET_TX_DESC_BUFFER_NAVUSEHDR_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 15) -+#define GET_TX_DESC_BUFFER_NAVUSEHDR(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 15) -+#define SET_TX_DESC_BUFFER_BMC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 14) -+#define SET_TX_DESC_BUFFER_BMC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 14) -+#define GET_TX_DESC_BUFFER_BMC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, \ -+ 14) -+#define SET_TX_DESC_BUFFER_RTS_DATA_RTY_LMT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x3f, 8) -+#define SET_TX_DESC_BUFFER_RTS_DATA_RTY_LMT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x3f, 8) -+#define GET_TX_DESC_BUFFER_RTS_DATA_RTY_LMT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x3f, \ -+ 8) -+#define SET_TX_DESC_BUFFER_HW_AES_IV(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 7) -+#define SET_TX_DESC_BUFFER_HW_AES_IV_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 7) -+#define GET_TX_DESC_BUFFER_HW_AES_IV(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, 7) -+#define SET_TX_DESC_BUFFER_BT_NULL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 3) -+#define SET_TX_DESC_BUFFER_BT_NULL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 3) -+#define GET_TX_DESC_BUFFER_BT_NULL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, 3) -+#define SET_TX_DESC_BUFFER_EN_DESC_ID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x1, 2) -+#define SET_TX_DESC_BUFFER_EN_DESC_ID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x1, 2) -+#define GET_TX_DESC_BUFFER_EN_DESC_ID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x1, 2) -+#define SET_TX_DESC_BUFFER_SECTYPE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword5, \ -+ value, 0x3, 0) -+#define SET_TX_DESC_BUFFER_SECTYPE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword5, value, 0x3, 0) -+#define GET_TX_DESC_BUFFER_SECTYPE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword5, 0x3, 0) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_BUFFER_MULTIPLE_PORT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x7, 29) -+#define SET_TX_DESC_BUFFER_MULTIPLE_PORT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x7, 29) -+#define GET_TX_DESC_BUFFER_MULTIPLE_PORT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x7, \ -+ 29) -+#define SET_TX_DESC_BUFFER_POLLUTED(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x1, 28) -+#define SET_TX_DESC_BUFFER_POLLUTED_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x1, 28) -+#define GET_TX_DESC_BUFFER_POLLUTED(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x1, \ -+ 28) -+#define SET_TX_DESC_BUFFER_NULL_1(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x1, 27) -+#define SET_TX_DESC_BUFFER_NULL_1_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x1, 27) -+#define GET_TX_DESC_BUFFER_NULL_1(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x1, \ -+ 27) -+#define SET_TX_DESC_BUFFER_NULL_0(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x1, 26) -+#define SET_TX_DESC_BUFFER_NULL_0_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x1, 26) -+#define GET_TX_DESC_BUFFER_NULL_0(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x1, \ -+ 26) -+#define SET_TX_DESC_BUFFER_TRI_FRAME(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x1, 25) -+#define SET_TX_DESC_BUFFER_TRI_FRAME_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x1, 25) -+#define GET_TX_DESC_BUFFER_TRI_FRAME(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x1, \ -+ 25) -+#define SET_TX_DESC_BUFFER_SPE_RPT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x1, 24) -+#define SET_TX_DESC_BUFFER_SPE_RPT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x1, 24) -+#define GET_TX_DESC_BUFFER_SPE_RPT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x1, \ -+ 24) -+#define SET_TX_DESC_BUFFER_FTM_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x1, 23) -+#define SET_TX_DESC_BUFFER_FTM_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x1, 23) -+#define GET_TX_DESC_BUFFER_FTM_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x1, \ -+ 23) -+#define SET_TX_DESC_BUFFER_MU_DATARATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x7f, 16) -+#define SET_TX_DESC_BUFFER_MU_DATARATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x7f, 16) -+#define GET_TX_DESC_BUFFER_MU_DATARATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x7f, \ -+ 16) -+#define SET_TX_DESC_BUFFER_CCA_RTS(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 14) -+#define SET_TX_DESC_BUFFER_CCA_RTS_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 14) -+#define GET_TX_DESC_BUFFER_CCA_RTS(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 14) -+#define SET_TX_DESC_BUFFER_NDPA(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 12) -+#define SET_TX_DESC_BUFFER_NDPA_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 12) -+#define GET_TX_DESC_BUFFER_NDPA(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, \ -+ 12) -+#define SET_TX_DESC_BUFFER_TXPWR_OFSET_TYPE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x3, 9) -+#define SET_TX_DESC_BUFFER_TXPWR_OFSET_TYPE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x3, 9) -+#define GET_TX_DESC_BUFFER_TXPWR_OFSET_TYPE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, 0x3, 9) -+#define SET_TX_DESC_BUFFER_P_AID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ value, 0x1ff, 0) -+#define SET_TX_DESC_BUFFER_P_AID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword6, value, 0x1ff, 0) -+#define GET_TX_DESC_BUFFER_P_AID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword6, \ -+ 0x1ff, 0) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_BUFFER_SW_DEFINE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0xfff, 16) -+#define SET_TX_DESC_BUFFER_SW_DEFINE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0xfff, 16) -+#define GET_TX_DESC_BUFFER_SW_DEFINE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ 0xfff, 16) -+#define SET_TX_DESC_BUFFER_CTRL_CNT_VALID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0x1, 9) -+#define SET_TX_DESC_BUFFER_CTRL_CNT_VALID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0x1, 9) -+#define GET_TX_DESC_BUFFER_CTRL_CNT_VALID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0x1, 9) -+#define SET_TX_DESC_BUFFER_CTRL_CNT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0xf, 5) -+#define SET_TX_DESC_BUFFER_CTRL_CNT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0xf, 5) -+#define GET_TX_DESC_BUFFER_CTRL_CNT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0xf, 5) -+#define SET_TX_DESC_BUFFER_DATA_RTY_LOWEST_RATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword7, \ -+ value, 0x1f, 0) -+#define SET_TX_DESC_BUFFER_DATA_RTY_LOWEST_RATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword7, value, 0x1f, 0) -+#define GET_TX_DESC_BUFFER_DATA_RTY_LOWEST_RATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword7, 0x1f, \ -+ 0) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_BUFFER_PATH_MAPA(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x3, 30) -+#define SET_TX_DESC_BUFFER_PATH_MAPA_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x3, 30) -+#define GET_TX_DESC_BUFFER_PATH_MAPA(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x3, \ -+ 30) -+#define SET_TX_DESC_BUFFER_PATH_MAPB(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x3, 28) -+#define SET_TX_DESC_BUFFER_PATH_MAPB_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x3, 28) -+#define GET_TX_DESC_BUFFER_PATH_MAPB(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x3, \ -+ 28) -+#define SET_TX_DESC_BUFFER_PATH_MAPC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x3, 26) -+#define SET_TX_DESC_BUFFER_PATH_MAPC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x3, 26) -+#define GET_TX_DESC_BUFFER_PATH_MAPC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x3, \ -+ 26) -+#define SET_TX_DESC_BUFFER_PATH_MAPD(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x3, 24) -+#define SET_TX_DESC_BUFFER_PATH_MAPD_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x3, 24) -+#define GET_TX_DESC_BUFFER_PATH_MAPD(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x3, \ -+ 24) -+#define SET_TX_DESC_BUFFER_ANTSEL_A(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0xf, 20) -+#define SET_TX_DESC_BUFFER_ANTSEL_A_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0xf, 20) -+#define GET_TX_DESC_BUFFER_ANTSEL_A(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0xf, \ -+ 20) -+#define SET_TX_DESC_BUFFER_ANTSEL_B(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0xf, 16) -+#define SET_TX_DESC_BUFFER_ANTSEL_B_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0xf, 16) -+#define GET_TX_DESC_BUFFER_ANTSEL_B(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0xf, \ -+ 16) -+#define SET_TX_DESC_BUFFER_ANTSEL_C(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0xf, 12) -+#define SET_TX_DESC_BUFFER_ANTSEL_C_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0xf, 12) -+#define GET_TX_DESC_BUFFER_ANTSEL_C(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0xf, \ -+ 12) -+#define SET_TX_DESC_BUFFER_ANTSEL_D(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0xf, 8) -+#define SET_TX_DESC_BUFFER_ANTSEL_D_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0xf, 8) -+#define GET_TX_DESC_BUFFER_ANTSEL_D(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0xf, 8) -+#define SET_TX_DESC_BUFFER_NTX_PATH_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0xf, 4) -+#define SET_TX_DESC_BUFFER_NTX_PATH_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0xf, 4) -+#define GET_TX_DESC_BUFFER_NTX_PATH_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0xf, 4) -+#define SET_TX_DESC_BUFFER_ANTLSEL_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x1, 3) -+#define SET_TX_DESC_BUFFER_ANTLSEL_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x1, 3) -+#define GET_TX_DESC_BUFFER_ANTLSEL_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x1, 3) -+#define SET_TX_DESC_BUFFER_AMPDU_DENSITY(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword8, \ -+ value, 0x7, 0) -+#define SET_TX_DESC_BUFFER_AMPDU_DENSITY_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword8, value, 0x7, 0) -+#define GET_TX_DESC_BUFFER_AMPDU_DENSITY(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword8, 0x7, 0) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_BUFFER_VCS_STBC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x3, 30) -+#define SET_TX_DESC_BUFFER_VCS_STBC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x3, 30) -+#define GET_TX_DESC_BUFFER_VCS_STBC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x3, \ -+ 30) -+#define SET_TX_DESC_BUFFER_DATA_STBC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x3, 28) -+#define SET_TX_DESC_BUFFER_DATA_STBC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x3, 28) -+#define GET_TX_DESC_BUFFER_DATA_STBC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x3, \ -+ 28) -+#define SET_TX_DESC_BUFFER_RTS_RTY_LOWEST_RATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0xf, 24) -+#define SET_TX_DESC_BUFFER_RTS_RTY_LOWEST_RATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0xf, 24) -+#define GET_TX_DESC_BUFFER_RTS_RTY_LOWEST_RATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0xf, \ -+ 24) -+#define SET_TX_DESC_BUFFER_SIGNALING_TA_PKT_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 23) -+#define SET_TX_DESC_BUFFER_SIGNALING_TA_PKT_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 23) -+#define GET_TX_DESC_BUFFER_SIGNALING_TA_PKT_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, \ -+ 23) -+#define SET_TX_DESC_BUFFER_MHR_CP(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 22) -+#define SET_TX_DESC_BUFFER_MHR_CP_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 22) -+#define GET_TX_DESC_BUFFER_MHR_CP(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, \ -+ 22) -+#define SET_TX_DESC_BUFFER_SMH_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 21) -+#define SET_TX_DESC_BUFFER_SMH_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 21) -+#define GET_TX_DESC_BUFFER_SMH_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, \ -+ 21) -+#define SET_TX_DESC_BUFFER_RTSRATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1f, 16) -+#define SET_TX_DESC_BUFFER_RTSRATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1f, 16) -+#define GET_TX_DESC_BUFFER_RTSRATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1f, \ -+ 16) -+#define SET_TX_DESC_BUFFER_SMH_CAM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0xff, 8) -+#define SET_TX_DESC_BUFFER_SMH_CAM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0xff, 8) -+#define GET_TX_DESC_BUFFER_SMH_CAM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0xff, \ -+ 8) -+#define SET_TX_DESC_BUFFER_ARFR_TABLE_SEL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 7) -+#define SET_TX_DESC_BUFFER_ARFR_TABLE_SEL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 7) -+#define GET_TX_DESC_BUFFER_ARFR_TABLE_SEL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, 7) -+#define SET_TX_DESC_BUFFER_ARFR_HT_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 6) -+#define SET_TX_DESC_BUFFER_ARFR_HT_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 6) -+#define GET_TX_DESC_BUFFER_ARFR_HT_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, 6) -+#define SET_TX_DESC_BUFFER_ARFR_OFDM_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 5) -+#define SET_TX_DESC_BUFFER_ARFR_OFDM_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 5) -+#define GET_TX_DESC_BUFFER_ARFR_OFDM_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, 5) -+#define SET_TX_DESC_BUFFER_ARFR_CCK_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 4) -+#define SET_TX_DESC_BUFFER_ARFR_CCK_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 4) -+#define GET_TX_DESC_BUFFER_ARFR_CCK_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, 4) -+#define SET_TX_DESC_BUFFER_RTS_SHORT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 3) -+#define SET_TX_DESC_BUFFER_RTS_SHORT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 3) -+#define GET_TX_DESC_BUFFER_RTS_SHORT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, 3) -+#define SET_TX_DESC_BUFFER_DISDATAFB(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 2) -+#define SET_TX_DESC_BUFFER_DISDATAFB_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 2) -+#define GET_TX_DESC_BUFFER_DISDATAFB(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, 2) -+#define SET_TX_DESC_BUFFER_DISRTSFB(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 1) -+#define SET_TX_DESC_BUFFER_DISRTSFB_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 1) -+#define GET_TX_DESC_BUFFER_DISRTSFB(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, 1) -+#define SET_TX_DESC_BUFFER_EXT_EDCA(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword9, \ -+ value, 0x1, 0) -+#define SET_TX_DESC_BUFFER_EXT_EDCA_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword9, value, 0x1, 0) -+#define GET_TX_DESC_BUFFER_EXT_EDCA(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword9, 0x1, 0) -+ -+/*TXDESC_WORD10*/ -+ -+#define SET_TX_DESC_BUFFER_AMPDU_MAX_TIME(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0xff, 24) -+#define SET_TX_DESC_BUFFER_AMPDU_MAX_TIME_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0xff, 24) -+#define GET_TX_DESC_BUFFER_AMPDU_MAX_TIME(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ 0xff, 24) -+#define SET_TX_DESC_BUFFER_SPECIAL_CW(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 23) -+#define SET_TX_DESC_BUFFER_SPECIAL_CW_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 23) -+#define GET_TX_DESC_BUFFER_SPECIAL_CW(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 23) -+#define SET_TX_DESC_BUFFER_RDG_NAV_EXT(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 22) -+#define SET_TX_DESC_BUFFER_RDG_NAV_EXT_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 22) -+#define GET_TX_DESC_BUFFER_RDG_NAV_EXT(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 22) -+#define SET_TX_DESC_BUFFER_RAW(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 21) -+#define SET_TX_DESC_BUFFER_RAW_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 21) -+#define GET_TX_DESC_BUFFER_RAW(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 21) -+#define SET_TX_DESC_BUFFER_MAX_AGG_NUM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1f, 16) -+#define SET_TX_DESC_BUFFER_MAX_AGG_NUM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1f, 16) -+#define GET_TX_DESC_BUFFER_MAX_AGG_NUM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ 0x1f, 16) -+#define SET_TX_DESC_BUFFER_FINAL_DATA_RATE(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0xff, 8) -+#define SET_TX_DESC_BUFFER_FINAL_DATA_RATE_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0xff, 8) -+#define GET_TX_DESC_BUFFER_FINAL_DATA_RATE(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ 0xff, 8) -+#define SET_TX_DESC_BUFFER_GF(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 7) -+#define SET_TX_DESC_BUFFER_GF_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 7) -+#define GET_TX_DESC_BUFFER_GF(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 7) -+#define SET_TX_DESC_BUFFER_MOREFRAG(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 6) -+#define SET_TX_DESC_BUFFER_MOREFRAG_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 6) -+#define GET_TX_DESC_BUFFER_MOREFRAG(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 6) -+#define SET_TX_DESC_BUFFER_NOACM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 5) -+#define SET_TX_DESC_BUFFER_NOACM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 5) -+#define GET_TX_DESC_BUFFER_NOACM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 5) -+#define SET_TX_DESC_BUFFER_HTC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 4) -+#define SET_TX_DESC_BUFFER_HTC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 4) -+#define GET_TX_DESC_BUFFER_HTC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 4) -+#define SET_TX_DESC_BUFFER_TX_PKT_AFTER_PIFS(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 3) -+#define SET_TX_DESC_BUFFER_TX_PKT_AFTER_PIFS_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 3) -+#define GET_TX_DESC_BUFFER_TX_PKT_AFTER_PIFS(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 3) -+#define SET_TX_DESC_BUFFER_USE_MAX_TIME_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x1, 2) -+#define SET_TX_DESC_BUFFER_USE_MAX_TIME_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x1, 2) -+#define GET_TX_DESC_BUFFER_USE_MAX_TIME_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x1, \ -+ 2) -+#define SET_TX_DESC_BUFFER_HW_SSN_SEL(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword10, \ -+ value, 0x3, 0) -+#define SET_TX_DESC_BUFFER_HW_SSN_SEL_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword10, value, 0x3, 0) -+#define GET_TX_DESC_BUFFER_HW_SSN_SEL(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword10, 0x3, \ -+ 0) -+ -+/*TXDESC_WORD11*/ -+ -+#define SET_TX_DESC_BUFFER_ADDR_CAM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword11, \ -+ value, 0xff, 24) -+#define SET_TX_DESC_BUFFER_ADDR_CAM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword11, value, 0xff, 24) -+#define GET_TX_DESC_BUFFER_ADDR_CAM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword11, \ -+ 0xff, 24) -+#define SET_TX_DESC_BUFFER_SND_TARGET(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword11, \ -+ value, 0xff, 16) -+#define SET_TX_DESC_BUFFER_SND_TARGET_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword11, value, 0xff, 16) -+#define GET_TX_DESC_BUFFER_SND_TARGET(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword11, \ -+ 0xff, 16) -+#define SET_TX_DESC_BUFFER_DATA_LDPC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword11, \ -+ value, 0x1, 15) -+#define SET_TX_DESC_BUFFER_DATA_LDPC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword11, value, 0x1, 15) -+#define GET_TX_DESC_BUFFER_DATA_LDPC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword11, 0x1, \ -+ 15) -+#define SET_TX_DESC_BUFFER_LSIG_TXOP_EN(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword11, \ -+ value, 0x1, 14) -+#define SET_TX_DESC_BUFFER_LSIG_TXOP_EN_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword11, value, 0x1, 14) -+#define GET_TX_DESC_BUFFER_LSIG_TXOP_EN(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword11, 0x1, \ -+ 14) -+#define SET_TX_DESC_BUFFER_G_ID(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword11, \ -+ value, 0x3f, 8) -+#define SET_TX_DESC_BUFFER_G_ID_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword11, value, 0x3f, 8) -+#define GET_TX_DESC_BUFFER_G_ID(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword11, \ -+ 0x3f, 8) -+#define SET_TX_DESC_BUFFER_SIGNALING_TA_PKT_SC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword11, \ -+ value, 0xf, 4) -+#define SET_TX_DESC_BUFFER_SIGNALING_TA_PKT_SC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword11, value, 0xf, 4) -+#define GET_TX_DESC_BUFFER_SIGNALING_TA_PKT_SC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword11, 0xf, \ -+ 4) -+#define SET_TX_DESC_BUFFER_DATA_SC(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword11, \ -+ value, 0xf, 0) -+#define SET_TX_DESC_BUFFER_DATA_SC_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword11, value, 0xf, 0) -+#define GET_TX_DESC_BUFFER_DATA_SC(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword11, 0xf, \ -+ 0) -+ -+/*TXDESC_WORD12*/ -+ -+#define SET_TX_DESC_BUFFER_LEN1_L(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword12, \ -+ value, 0x7f, 17) -+#define SET_TX_DESC_BUFFER_LEN1_L_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword12, value, 0x7f, 17) -+#define GET_TX_DESC_BUFFER_LEN1_L(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword12, \ -+ 0x7f, 17) -+#define SET_TX_DESC_BUFFER_LEN0(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword12, \ -+ value, 0x1fff, 4) -+#define SET_TX_DESC_BUFFER_LEN0_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword12, value, 0x1fff, 4) -+#define GET_TX_DESC_BUFFER_LEN0(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword12, \ -+ 0x1fff, 4) -+#define SET_TX_DESC_BUFFER_PKT_NUM(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword12, \ -+ value, 0xf, 0) -+#define SET_TX_DESC_BUFFER_PKT_NUM_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword12, value, 0xf, 0) -+#define GET_TX_DESC_BUFFER_PKT_NUM(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword12, 0xf, \ -+ 0) -+ -+/*TXDESC_WORD13*/ -+ -+#define SET_TX_DESC_BUFFER_LEN3(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword13, \ -+ value, 0x1fff, 19) -+#define SET_TX_DESC_BUFFER_LEN3_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword13, value, 0x1fff, 19) -+#define GET_TX_DESC_BUFFER_LEN3(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword13, \ -+ 0x1fff, 19) -+#define SET_TX_DESC_BUFFER_LEN2(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword13, \ -+ value, 0x1fff, 6) -+#define SET_TX_DESC_BUFFER_LEN2_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword13, value, 0x1fff, 6) -+#define GET_TX_DESC_BUFFER_LEN2(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword13, \ -+ 0x1fff, 6) -+#define SET_TX_DESC_BUFFER_LEN1_H(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_CLR(((struct halmac_tx_desc *)txdesc)->dword13, \ -+ value, 0x3f, 0) -+#define SET_TX_DESC_BUFFER_LEN1_H_NO_CLR(txdesc, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc)->dword13, value, 0x3f, 0) -+#define GET_TX_DESC_BUFFER_LEN1_H(txdesc) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc)->dword13, \ -+ 0x3f, 0) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_buffer_chip.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_buffer_chip.h -new file mode 100644 -index 000000000..283563afc ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_buffer_chip.h -@@ -0,0 +1,509 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TX_DESC_BUFFER_CHIP_H_ -+#define _HALMAC_TX_DESC_BUFFER_CHIP_H_ -+#if (HALMAC_8814B_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_BUFFER_RDG_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_RDG_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_RDG_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_RDG_EN(txdesc) -+#define SET_TX_DESC_BUFFER_BCNPKT_TSF_CTRL_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_BCNPKT_TSF_CTRL(txdesc, value) -+#define GET_TX_DESC_BUFFER_BCNPKT_TSF_CTRL_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_BCNPKT_TSF_CTRL(txdesc) -+#define SET_TX_DESC_BUFFER_AGG_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_AGG_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_AGG_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_AGG_EN(txdesc) -+#define SET_TX_DESC_BUFFER_PKT_OFFSET_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_PKT_OFFSET(txdesc, value) -+#define GET_TX_DESC_BUFFER_PKT_OFFSET_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_PKT_OFFSET(txdesc) -+#define SET_TX_DESC_BUFFER_OFFSET_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_OFFSET(txdesc, value) -+#define GET_TX_DESC_BUFFER_OFFSET_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_OFFSET(txdesc) -+#define SET_TX_DESC_BUFFER_TXPKTSIZE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_BUFFER_TXPKTSIZE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_TXPKTSIZE(txdesc) -+ -+/*TXDESC_WORD1*/ -+ -+#define SET_TX_DESC_BUFFER_USERATE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_USERATE(txdesc, value) -+#define GET_TX_DESC_BUFFER_USERATE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_USERATE(txdesc) -+#define SET_TX_DESC_BUFFER_AMSDU_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_AMSDU(txdesc, value) -+#define GET_TX_DESC_BUFFER_AMSDU_8814B(txdesc) GET_TX_DESC_BUFFER_AMSDU(txdesc) -+#define SET_TX_DESC_BUFFER_EN_HWSEQ_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_EN_HWSEQ(txdesc, value) -+#define GET_TX_DESC_BUFFER_EN_HWSEQ_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_EN_HWSEQ(txdesc) -+#define SET_TX_DESC_BUFFER_EN_HWEXSEQ_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_EN_HWEXSEQ(txdesc, value) -+#define GET_TX_DESC_BUFFER_EN_HWEXSEQ_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_EN_HWEXSEQ(txdesc) -+#define SET_TX_DESC_BUFFER_SW_SEQ_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SW_SEQ(txdesc, value) -+#define GET_TX_DESC_BUFFER_SW_SEQ_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SW_SEQ(txdesc) -+#define SET_TX_DESC_BUFFER_DROP_ID_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DROP_ID(txdesc, value) -+#define GET_TX_DESC_BUFFER_DROP_ID_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DROP_ID(txdesc) -+#define SET_TX_DESC_BUFFER_MOREDATA_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_MOREDATA(txdesc, value) -+#define GET_TX_DESC_BUFFER_MOREDATA_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_MOREDATA(txdesc) -+#define SET_TX_DESC_BUFFER_QSEL_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_QSEL(txdesc, value) -+#define GET_TX_DESC_BUFFER_QSEL_8814B(txdesc) GET_TX_DESC_BUFFER_QSEL(txdesc) -+#define SET_TX_DESC_BUFFER_MACID_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_MACID(txdesc, value) -+#define GET_TX_DESC_BUFFER_MACID_8814B(txdesc) GET_TX_DESC_BUFFER_MACID(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_BUFFER_CHK_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_CHK_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_CHK_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_CHK_EN(txdesc) -+#define SET_TX_DESC_BUFFER_DISQSELSEQ_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DISQSELSEQ(txdesc, value) -+#define GET_TX_DESC_BUFFER_DISQSELSEQ_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DISQSELSEQ(txdesc) -+#define SET_TX_DESC_BUFFER_SND_PKT_SEL_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SND_PKT_SEL(txdesc, value) -+#define GET_TX_DESC_BUFFER_SND_PKT_SEL_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SND_PKT_SEL(txdesc) -+#define SET_TX_DESC_BUFFER_DMA_PRI_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DMA_PRI(txdesc, value) -+#define GET_TX_DESC_BUFFER_DMA_PRI_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DMA_PRI(txdesc) -+#define SET_TX_DESC_BUFFER_MAX_AMSDU_MODE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_MAX_AMSDU_MODE(txdesc, value) -+#define GET_TX_DESC_BUFFER_MAX_AMSDU_MODE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_MAX_AMSDU_MODE(txdesc) -+#define SET_TX_DESC_BUFFER_DMA_TXAGG_NUM_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DMA_TXAGG_NUM(txdesc, value) -+#define GET_TX_DESC_BUFFER_DMA_TXAGG_NUM_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DMA_TXAGG_NUM(txdesc) -+#define SET_TX_DESC_BUFFER_TXDESC_CHECKSUM_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_TXDESC_CHECKSUM(txdesc, value) -+#define GET_TX_DESC_BUFFER_TXDESC_CHECKSUM_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_TXDESC_CHECKSUM(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_BUFFER_OFFLOAD_SIZE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_OFFLOAD_SIZE(txdesc, value) -+#define GET_TX_DESC_BUFFER_OFFLOAD_SIZE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_OFFLOAD_SIZE(txdesc) -+#define SET_TX_DESC_BUFFER_CHANNEL_DMA_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_CHANNEL_DMA(txdesc, value) -+#define GET_TX_DESC_BUFFER_CHANNEL_DMA_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_CHANNEL_DMA(txdesc) -+#define SET_TX_DESC_BUFFER_MBSSID_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_MBSSID(txdesc, value) -+#define GET_TX_DESC_BUFFER_MBSSID_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_MBSSID(txdesc) -+#define SET_TX_DESC_BUFFER_BK_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_BK(txdesc, value) -+#define GET_TX_DESC_BUFFER_BK_8814B(txdesc) GET_TX_DESC_BUFFER_BK(txdesc) -+#define SET_TX_DESC_BUFFER_WHEADER_LEN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_WHEADER_LEN(txdesc, value) -+#define GET_TX_DESC_BUFFER_WHEADER_LEN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_WHEADER_LEN(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_BUFFER_TRY_RATE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_TRY_RATE(txdesc, value) -+#define GET_TX_DESC_BUFFER_TRY_RATE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_TRY_RATE(txdesc) -+#define SET_TX_DESC_BUFFER_DATA_BW_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DATA_BW(txdesc, value) -+#define GET_TX_DESC_BUFFER_DATA_BW_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DATA_BW(txdesc) -+#define SET_TX_DESC_BUFFER_DATA_SHORT_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DATA_SHORT(txdesc, value) -+#define GET_TX_DESC_BUFFER_DATA_SHORT_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DATA_SHORT(txdesc) -+#define SET_TX_DESC_BUFFER_DATARATE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DATARATE(txdesc, value) -+#define GET_TX_DESC_BUFFER_DATARATE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DATARATE(txdesc) -+#define SET_TX_DESC_BUFFER_TXBF_PATH_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_TXBF_PATH(txdesc, value) -+#define GET_TX_DESC_BUFFER_TXBF_PATH_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_TXBF_PATH(txdesc) -+#define SET_TX_DESC_BUFFER_GROUP_BIT_IE_OFFSET_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_GROUP_BIT_IE_OFFSET(txdesc, value) -+#define GET_TX_DESC_BUFFER_GROUP_BIT_IE_OFFSET_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_GROUP_BIT_IE_OFFSET(txdesc) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_BUFFER_RTY_LMT_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_RTY_LMT_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_RTY_LMT_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_RTY_LMT_EN(txdesc) -+#define SET_TX_DESC_BUFFER_HW_RTS_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_HW_RTS_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_HW_RTS_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_HW_RTS_EN(txdesc) -+#define SET_TX_DESC_BUFFER_RTS_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_RTS_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_RTS_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_RTS_EN(txdesc) -+#define SET_TX_DESC_BUFFER_CTS2SELF_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_CTS2SELF(txdesc, value) -+#define GET_TX_DESC_BUFFER_CTS2SELF_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_CTS2SELF(txdesc) -+#define SET_TX_DESC_BUFFER_TAILPAGE_H_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_TAILPAGE_H(txdesc, value) -+#define GET_TX_DESC_BUFFER_TAILPAGE_H_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_TAILPAGE_H(txdesc) -+#define SET_TX_DESC_BUFFER_TAILPAGE_L_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_TAILPAGE_L(txdesc, value) -+#define GET_TX_DESC_BUFFER_TAILPAGE_L_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_TAILPAGE_L(txdesc) -+#define SET_TX_DESC_BUFFER_NAVUSEHDR_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_NAVUSEHDR(txdesc, value) -+#define GET_TX_DESC_BUFFER_NAVUSEHDR_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_NAVUSEHDR(txdesc) -+#define SET_TX_DESC_BUFFER_BMC_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_BMC(txdesc, value) -+#define GET_TX_DESC_BUFFER_BMC_8814B(txdesc) GET_TX_DESC_BUFFER_BMC(txdesc) -+#define SET_TX_DESC_BUFFER_RTS_DATA_RTY_LMT_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_RTS_DATA_RTY_LMT(txdesc, value) -+#define GET_TX_DESC_BUFFER_RTS_DATA_RTY_LMT_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_RTS_DATA_RTY_LMT(txdesc) -+#define SET_TX_DESC_BUFFER_HW_AES_IV_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_HW_AES_IV(txdesc, value) -+#define GET_TX_DESC_BUFFER_HW_AES_IV_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_HW_AES_IV(txdesc) -+#define SET_TX_DESC_BUFFER_BT_NULL_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_BT_NULL(txdesc, value) -+#define GET_TX_DESC_BUFFER_BT_NULL_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_BT_NULL(txdesc) -+#define SET_TX_DESC_BUFFER_EN_DESC_ID_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_EN_DESC_ID(txdesc, value) -+#define GET_TX_DESC_BUFFER_EN_DESC_ID_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_EN_DESC_ID(txdesc) -+#define SET_TX_DESC_BUFFER_SECTYPE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SECTYPE(txdesc, value) -+#define GET_TX_DESC_BUFFER_SECTYPE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SECTYPE(txdesc) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_BUFFER_MULTIPLE_PORT_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_MULTIPLE_PORT(txdesc, value) -+#define GET_TX_DESC_BUFFER_MULTIPLE_PORT_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_MULTIPLE_PORT(txdesc) -+#define SET_TX_DESC_BUFFER_POLLUTED_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_POLLUTED(txdesc, value) -+#define GET_TX_DESC_BUFFER_POLLUTED_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_POLLUTED(txdesc) -+#define SET_TX_DESC_BUFFER_NULL_1_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_NULL_1(txdesc, value) -+#define GET_TX_DESC_BUFFER_NULL_1_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_NULL_1(txdesc) -+#define SET_TX_DESC_BUFFER_NULL_0_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_NULL_0(txdesc, value) -+#define GET_TX_DESC_BUFFER_NULL_0_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_NULL_0(txdesc) -+#define SET_TX_DESC_BUFFER_TRI_FRAME_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_TRI_FRAME(txdesc, value) -+#define GET_TX_DESC_BUFFER_TRI_FRAME_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_TRI_FRAME(txdesc) -+#define SET_TX_DESC_BUFFER_SPE_RPT_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SPE_RPT(txdesc, value) -+#define GET_TX_DESC_BUFFER_SPE_RPT_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SPE_RPT(txdesc) -+#define SET_TX_DESC_BUFFER_FTM_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_FTM_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_FTM_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_FTM_EN(txdesc) -+#define SET_TX_DESC_BUFFER_MU_DATARATE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_MU_DATARATE(txdesc, value) -+#define GET_TX_DESC_BUFFER_MU_DATARATE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_MU_DATARATE(txdesc) -+#define SET_TX_DESC_BUFFER_CCA_RTS_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_CCA_RTS(txdesc, value) -+#define GET_TX_DESC_BUFFER_CCA_RTS_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_CCA_RTS(txdesc) -+#define SET_TX_DESC_BUFFER_NDPA_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_NDPA(txdesc, value) -+#define GET_TX_DESC_BUFFER_NDPA_8814B(txdesc) GET_TX_DESC_BUFFER_NDPA(txdesc) -+#define SET_TX_DESC_BUFFER_TXPWR_OFSET_TYPE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_TXPWR_OFSET_TYPE(txdesc, value) -+#define GET_TX_DESC_BUFFER_TXPWR_OFSET_TYPE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_TXPWR_OFSET_TYPE(txdesc) -+#define SET_TX_DESC_BUFFER_P_AID_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_P_AID(txdesc, value) -+#define GET_TX_DESC_BUFFER_P_AID_8814B(txdesc) GET_TX_DESC_BUFFER_P_AID(txdesc) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_BUFFER_SW_DEFINE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SW_DEFINE(txdesc, value) -+#define GET_TX_DESC_BUFFER_SW_DEFINE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SW_DEFINE(txdesc) -+#define SET_TX_DESC_BUFFER_CTRL_CNT_VALID_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_CTRL_CNT_VALID(txdesc, value) -+#define GET_TX_DESC_BUFFER_CTRL_CNT_VALID_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_CTRL_CNT_VALID(txdesc) -+#define SET_TX_DESC_BUFFER_CTRL_CNT_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_CTRL_CNT(txdesc, value) -+#define GET_TX_DESC_BUFFER_CTRL_CNT_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_CTRL_CNT(txdesc) -+#define SET_TX_DESC_BUFFER_DATA_RTY_LOWEST_RATE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DATA_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_BUFFER_DATA_RTY_LOWEST_RATE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DATA_RTY_LOWEST_RATE(txdesc) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_BUFFER_PATH_MAPA_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_PATH_MAPA(txdesc, value) -+#define GET_TX_DESC_BUFFER_PATH_MAPA_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_PATH_MAPA(txdesc) -+#define SET_TX_DESC_BUFFER_PATH_MAPB_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_PATH_MAPB(txdesc, value) -+#define GET_TX_DESC_BUFFER_PATH_MAPB_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_PATH_MAPB(txdesc) -+#define SET_TX_DESC_BUFFER_PATH_MAPC_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_PATH_MAPC(txdesc, value) -+#define GET_TX_DESC_BUFFER_PATH_MAPC_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_PATH_MAPC(txdesc) -+#define SET_TX_DESC_BUFFER_PATH_MAPD_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_PATH_MAPD(txdesc, value) -+#define GET_TX_DESC_BUFFER_PATH_MAPD_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_PATH_MAPD(txdesc) -+#define SET_TX_DESC_BUFFER_ANTSEL_A_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_ANTSEL_A(txdesc, value) -+#define GET_TX_DESC_BUFFER_ANTSEL_A_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_ANTSEL_A(txdesc) -+#define SET_TX_DESC_BUFFER_ANTSEL_B_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_ANTSEL_B(txdesc, value) -+#define GET_TX_DESC_BUFFER_ANTSEL_B_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_ANTSEL_B(txdesc) -+#define SET_TX_DESC_BUFFER_ANTSEL_C_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_ANTSEL_C(txdesc, value) -+#define GET_TX_DESC_BUFFER_ANTSEL_C_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_ANTSEL_C(txdesc) -+#define SET_TX_DESC_BUFFER_ANTSEL_D_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_ANTSEL_D(txdesc, value) -+#define GET_TX_DESC_BUFFER_ANTSEL_D_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_ANTSEL_D(txdesc) -+#define SET_TX_DESC_BUFFER_NTX_PATH_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_NTX_PATH_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_NTX_PATH_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_NTX_PATH_EN(txdesc) -+#define SET_TX_DESC_BUFFER_ANTLSEL_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_ANTLSEL_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_ANTLSEL_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_ANTLSEL_EN(txdesc) -+#define SET_TX_DESC_BUFFER_AMPDU_DENSITY_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_AMPDU_DENSITY(txdesc, value) -+#define GET_TX_DESC_BUFFER_AMPDU_DENSITY_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_AMPDU_DENSITY(txdesc) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_BUFFER_VCS_STBC_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_VCS_STBC(txdesc, value) -+#define GET_TX_DESC_BUFFER_VCS_STBC_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_VCS_STBC(txdesc) -+#define SET_TX_DESC_BUFFER_DATA_STBC_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DATA_STBC(txdesc, value) -+#define GET_TX_DESC_BUFFER_DATA_STBC_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DATA_STBC(txdesc) -+#define SET_TX_DESC_BUFFER_RTS_RTY_LOWEST_RATE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_RTS_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_BUFFER_RTS_RTY_LOWEST_RATE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_RTS_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_BUFFER_SIGNALING_TA_PKT_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SIGNALING_TA_PKT_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_SIGNALING_TA_PKT_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SIGNALING_TA_PKT_EN(txdesc) -+#define SET_TX_DESC_BUFFER_MHR_CP_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_MHR_CP(txdesc, value) -+#define GET_TX_DESC_BUFFER_MHR_CP_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_MHR_CP(txdesc) -+#define SET_TX_DESC_BUFFER_SMH_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SMH_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_SMH_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SMH_EN(txdesc) -+#define SET_TX_DESC_BUFFER_RTSRATE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_RTSRATE(txdesc, value) -+#define GET_TX_DESC_BUFFER_RTSRATE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_RTSRATE(txdesc) -+#define SET_TX_DESC_BUFFER_SMH_CAM_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SMH_CAM(txdesc, value) -+#define GET_TX_DESC_BUFFER_SMH_CAM_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SMH_CAM(txdesc) -+#define SET_TX_DESC_BUFFER_ARFR_TABLE_SEL_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_ARFR_TABLE_SEL(txdesc, value) -+#define GET_TX_DESC_BUFFER_ARFR_TABLE_SEL_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_ARFR_TABLE_SEL(txdesc) -+#define SET_TX_DESC_BUFFER_ARFR_HT_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_ARFR_HT_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_ARFR_HT_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_ARFR_HT_EN(txdesc) -+#define SET_TX_DESC_BUFFER_ARFR_OFDM_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_ARFR_OFDM_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_ARFR_OFDM_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_ARFR_OFDM_EN(txdesc) -+#define SET_TX_DESC_BUFFER_ARFR_CCK_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_ARFR_CCK_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_ARFR_CCK_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_ARFR_CCK_EN(txdesc) -+#define SET_TX_DESC_BUFFER_RTS_SHORT_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_RTS_SHORT(txdesc, value) -+#define GET_TX_DESC_BUFFER_RTS_SHORT_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_RTS_SHORT(txdesc) -+#define SET_TX_DESC_BUFFER_DISDATAFB_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DISDATAFB(txdesc, value) -+#define GET_TX_DESC_BUFFER_DISDATAFB_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DISDATAFB(txdesc) -+#define SET_TX_DESC_BUFFER_DISRTSFB_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DISRTSFB(txdesc, value) -+#define GET_TX_DESC_BUFFER_DISRTSFB_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DISRTSFB(txdesc) -+#define SET_TX_DESC_BUFFER_EXT_EDCA_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_EXT_EDCA(txdesc, value) -+#define GET_TX_DESC_BUFFER_EXT_EDCA_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_EXT_EDCA(txdesc) -+ -+/*TXDESC_WORD10*/ -+ -+#define SET_TX_DESC_BUFFER_AMPDU_MAX_TIME_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_AMPDU_MAX_TIME(txdesc, value) -+#define GET_TX_DESC_BUFFER_AMPDU_MAX_TIME_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_AMPDU_MAX_TIME(txdesc) -+#define SET_TX_DESC_BUFFER_SPECIAL_CW_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SPECIAL_CW(txdesc, value) -+#define GET_TX_DESC_BUFFER_SPECIAL_CW_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SPECIAL_CW(txdesc) -+#define SET_TX_DESC_BUFFER_RDG_NAV_EXT_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_RDG_NAV_EXT(txdesc, value) -+#define GET_TX_DESC_BUFFER_RDG_NAV_EXT_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_RDG_NAV_EXT(txdesc) -+#define SET_TX_DESC_BUFFER_RAW_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_RAW(txdesc, value) -+#define GET_TX_DESC_BUFFER_RAW_8814B(txdesc) GET_TX_DESC_BUFFER_RAW(txdesc) -+#define SET_TX_DESC_BUFFER_MAX_AGG_NUM_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_MAX_AGG_NUM(txdesc, value) -+#define GET_TX_DESC_BUFFER_MAX_AGG_NUM_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_MAX_AGG_NUM(txdesc) -+#define SET_TX_DESC_BUFFER_FINAL_DATA_RATE_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_FINAL_DATA_RATE(txdesc, value) -+#define GET_TX_DESC_BUFFER_FINAL_DATA_RATE_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_FINAL_DATA_RATE(txdesc) -+#define SET_TX_DESC_BUFFER_GF_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_GF(txdesc, value) -+#define GET_TX_DESC_BUFFER_GF_8814B(txdesc) GET_TX_DESC_BUFFER_GF(txdesc) -+#define SET_TX_DESC_BUFFER_MOREFRAG_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_MOREFRAG(txdesc, value) -+#define GET_TX_DESC_BUFFER_MOREFRAG_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_MOREFRAG(txdesc) -+#define SET_TX_DESC_BUFFER_NOACM_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_NOACM(txdesc, value) -+#define GET_TX_DESC_BUFFER_NOACM_8814B(txdesc) GET_TX_DESC_BUFFER_NOACM(txdesc) -+#define SET_TX_DESC_BUFFER_HTC_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_HTC(txdesc, value) -+#define GET_TX_DESC_BUFFER_HTC_8814B(txdesc) GET_TX_DESC_BUFFER_HTC(txdesc) -+#define SET_TX_DESC_BUFFER_TX_PKT_AFTER_PIFS_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_TX_PKT_AFTER_PIFS(txdesc, value) -+#define GET_TX_DESC_BUFFER_TX_PKT_AFTER_PIFS_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_TX_PKT_AFTER_PIFS(txdesc) -+#define SET_TX_DESC_BUFFER_USE_MAX_TIME_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_USE_MAX_TIME_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_USE_MAX_TIME_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_USE_MAX_TIME_EN(txdesc) -+#define SET_TX_DESC_BUFFER_HW_SSN_SEL_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_HW_SSN_SEL(txdesc, value) -+#define GET_TX_DESC_BUFFER_HW_SSN_SEL_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_HW_SSN_SEL(txdesc) -+ -+/*TXDESC_WORD11*/ -+ -+#define SET_TX_DESC_BUFFER_ADDR_CAM_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_ADDR_CAM(txdesc, value) -+#define GET_TX_DESC_BUFFER_ADDR_CAM_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_ADDR_CAM(txdesc) -+#define SET_TX_DESC_BUFFER_SND_TARGET_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SND_TARGET(txdesc, value) -+#define GET_TX_DESC_BUFFER_SND_TARGET_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SND_TARGET(txdesc) -+#define SET_TX_DESC_BUFFER_DATA_LDPC_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DATA_LDPC(txdesc, value) -+#define GET_TX_DESC_BUFFER_DATA_LDPC_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DATA_LDPC(txdesc) -+#define SET_TX_DESC_BUFFER_LSIG_TXOP_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_LSIG_TXOP_EN(txdesc, value) -+#define GET_TX_DESC_BUFFER_LSIG_TXOP_EN_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_LSIG_TXOP_EN(txdesc) -+#define SET_TX_DESC_BUFFER_G_ID_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_G_ID(txdesc, value) -+#define GET_TX_DESC_BUFFER_G_ID_8814B(txdesc) GET_TX_DESC_BUFFER_G_ID(txdesc) -+#define SET_TX_DESC_BUFFER_SIGNALING_TA_PKT_SC_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_SIGNALING_TA_PKT_SC(txdesc, value) -+#define GET_TX_DESC_BUFFER_SIGNALING_TA_PKT_SC_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_SIGNALING_TA_PKT_SC(txdesc) -+#define SET_TX_DESC_BUFFER_DATA_SC_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_DATA_SC(txdesc, value) -+#define GET_TX_DESC_BUFFER_DATA_SC_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_DATA_SC(txdesc) -+ -+/*TXDESC_WORD12*/ -+ -+#define SET_TX_DESC_BUFFER_LEN1_L_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_LEN1_L(txdesc, value) -+#define GET_TX_DESC_BUFFER_LEN1_L_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_LEN1_L(txdesc) -+#define SET_TX_DESC_BUFFER_LEN0_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_LEN0(txdesc, value) -+#define GET_TX_DESC_BUFFER_LEN0_8814B(txdesc) GET_TX_DESC_BUFFER_LEN0(txdesc) -+#define SET_TX_DESC_BUFFER_PKT_NUM_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_PKT_NUM(txdesc, value) -+#define GET_TX_DESC_BUFFER_PKT_NUM_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_PKT_NUM(txdesc) -+ -+/*TXDESC_WORD13*/ -+ -+#define SET_TX_DESC_BUFFER_LEN3_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_LEN3(txdesc, value) -+#define GET_TX_DESC_BUFFER_LEN3_8814B(txdesc) GET_TX_DESC_BUFFER_LEN3(txdesc) -+#define SET_TX_DESC_BUFFER_LEN2_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_LEN2(txdesc, value) -+#define GET_TX_DESC_BUFFER_LEN2_8814B(txdesc) GET_TX_DESC_BUFFER_LEN2(txdesc) -+#define SET_TX_DESC_BUFFER_LEN1_H_8814B(txdesc, value) \ -+ SET_TX_DESC_BUFFER_LEN1_H(txdesc, value) -+#define GET_TX_DESC_BUFFER_LEN1_H_8814B(txdesc) \ -+ GET_TX_DESC_BUFFER_LEN1_H(txdesc) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_buffer_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_buffer_nic.h -new file mode 100644 -index 000000000..327fa3e7a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_buffer_nic.h -@@ -0,0 +1,491 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TX_DESC_BUFFER_NIC_H_ -+#define _HALMAC_TX_DESC_BUFFER_NIC_H_ -+#if (HALMAC_8814B_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_BUFFER_RDG_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 31, 1, value) -+#define GET_TX_DESC_BUFFER_RDG_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 31, 1) -+#define SET_TX_DESC_BUFFER_BCNPKT_TSF_CTRL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 30, 1, value) -+#define GET_TX_DESC_BUFFER_BCNPKT_TSF_CTRL(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x00, 30, 1) -+#define SET_TX_DESC_BUFFER_AGG_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 29, 1, value) -+#define GET_TX_DESC_BUFFER_AGG_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 29, 1) -+#define SET_TX_DESC_BUFFER_PKT_OFFSET(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 24, 5, value) -+#define GET_TX_DESC_BUFFER_PKT_OFFSET(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x00, 24, 5) -+#define SET_TX_DESC_BUFFER_OFFSET(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 16, 8, value) -+#define GET_TX_DESC_BUFFER_OFFSET(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 16, 8) -+#define SET_TX_DESC_BUFFER_TXPKTSIZE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 0, 16, value) -+#define GET_TX_DESC_BUFFER_TXPKTSIZE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x00, 0, 16) -+ -+/*TXDESC_WORD1*/ -+ -+#define SET_TX_DESC_BUFFER_USERATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 31, 1, value) -+#define GET_TX_DESC_BUFFER_USERATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x04, 31, 1) -+#define SET_TX_DESC_BUFFER_AMSDU(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 30, 1, value) -+#define GET_TX_DESC_BUFFER_AMSDU(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 30, 1) -+#define SET_TX_DESC_BUFFER_EN_HWSEQ(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 29, 1, value) -+#define GET_TX_DESC_BUFFER_EN_HWSEQ(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x04, 29, 1) -+#define SET_TX_DESC_BUFFER_EN_HWEXSEQ(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 28, 1, value) -+#define GET_TX_DESC_BUFFER_EN_HWEXSEQ(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x04, 28, 1) -+#define SET_TX_DESC_BUFFER_SW_SEQ(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 16, 12, value) -+#define GET_TX_DESC_BUFFER_SW_SEQ(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x04, 16, 12) -+#define SET_TX_DESC_BUFFER_DROP_ID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 14, 2, value) -+#define GET_TX_DESC_BUFFER_DROP_ID(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x04, 14, 2) -+#define SET_TX_DESC_BUFFER_MOREDATA(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 13, 1, value) -+#define GET_TX_DESC_BUFFER_MOREDATA(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x04, 13, 1) -+#define SET_TX_DESC_BUFFER_QSEL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 8, 5, value) -+#define GET_TX_DESC_BUFFER_QSEL(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 8, 5) -+#define SET_TX_DESC_BUFFER_MACID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 0, 8, value) -+#define GET_TX_DESC_BUFFER_MACID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 0, 8) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_BUFFER_CHK_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 31, 1, value) -+#define GET_TX_DESC_BUFFER_CHK_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 31, 1) -+#define SET_TX_DESC_BUFFER_DISQSELSEQ(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 30, 1, value) -+#define GET_TX_DESC_BUFFER_DISQSELSEQ(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x08, 30, 1) -+#define SET_TX_DESC_BUFFER_SND_PKT_SEL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 28, 2, value) -+#define GET_TX_DESC_BUFFER_SND_PKT_SEL(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x08, 28, 2) -+#define SET_TX_DESC_BUFFER_DMA_PRI(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 27, 1, value) -+#define GET_TX_DESC_BUFFER_DMA_PRI(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x08, 27, 1) -+#define SET_TX_DESC_BUFFER_MAX_AMSDU_MODE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 24, 3, value) -+#define GET_TX_DESC_BUFFER_MAX_AMSDU_MODE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x08, 24, 3) -+#define SET_TX_DESC_BUFFER_DMA_TXAGG_NUM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 16, 8, value) -+#define GET_TX_DESC_BUFFER_DMA_TXAGG_NUM(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x08, 16, 8) -+#define SET_TX_DESC_BUFFER_TXDESC_CHECKSUM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 0, 16, value) -+#define GET_TX_DESC_BUFFER_TXDESC_CHECKSUM(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x08, 0, 16) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_BUFFER_OFFLOAD_SIZE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 16, 15, value) -+#define GET_TX_DESC_BUFFER_OFFLOAD_SIZE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x0C, 16, 15) -+#define SET_TX_DESC_BUFFER_CHANNEL_DMA(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 11, 5, value) -+#define GET_TX_DESC_BUFFER_CHANNEL_DMA(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x0C, 11, 5) -+#define SET_TX_DESC_BUFFER_MBSSID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 7, 4, value) -+#define GET_TX_DESC_BUFFER_MBSSID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 7, 4) -+#define SET_TX_DESC_BUFFER_BK(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 6, 1, value) -+#define GET_TX_DESC_BUFFER_BK(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 6, 1) -+#define SET_TX_DESC_BUFFER_WHEADER_LEN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 0, 5, value) -+#define GET_TX_DESC_BUFFER_WHEADER_LEN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x0C, 0, 5) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_BUFFER_TRY_RATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 26, 1, value) -+#define GET_TX_DESC_BUFFER_TRY_RATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x10, 26, 1) -+#define SET_TX_DESC_BUFFER_DATA_BW(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 24, 2, value) -+#define GET_TX_DESC_BUFFER_DATA_BW(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x10, 24, 2) -+#define SET_TX_DESC_BUFFER_DATA_SHORT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 23, 1, value) -+#define GET_TX_DESC_BUFFER_DATA_SHORT(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x10, 23, 1) -+#define SET_TX_DESC_BUFFER_DATARATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 16, 7, value) -+#define GET_TX_DESC_BUFFER_DATARATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x10, 16, 7) -+#define SET_TX_DESC_BUFFER_TXBF_PATH(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 11, 1, value) -+#define GET_TX_DESC_BUFFER_TXBF_PATH(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x10, 11, 1) -+#define SET_TX_DESC_BUFFER_GROUP_BIT_IE_OFFSET(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 0, 11, value) -+#define GET_TX_DESC_BUFFER_GROUP_BIT_IE_OFFSET(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x10, 0, 11) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_BUFFER_RTY_LMT_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 31, 1, value) -+#define GET_TX_DESC_BUFFER_RTY_LMT_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 31, 1) -+#define SET_TX_DESC_BUFFER_HW_RTS_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 30, 1, value) -+#define GET_TX_DESC_BUFFER_HW_RTS_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 30, 1) -+#define SET_TX_DESC_BUFFER_RTS_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 29, 1, value) -+#define GET_TX_DESC_BUFFER_RTS_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 29, 1) -+#define SET_TX_DESC_BUFFER_CTS2SELF(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 28, 1, value) -+#define GET_TX_DESC_BUFFER_CTS2SELF(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 28, 1) -+#define SET_TX_DESC_BUFFER_TAILPAGE_H(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 24, 4, value) -+#define GET_TX_DESC_BUFFER_TAILPAGE_H(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 24, 4) -+#define SET_TX_DESC_BUFFER_TAILPAGE_L(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 16, 8, value) -+#define GET_TX_DESC_BUFFER_TAILPAGE_L(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 16, 8) -+#define SET_TX_DESC_BUFFER_NAVUSEHDR(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 15, 1, value) -+#define GET_TX_DESC_BUFFER_NAVUSEHDR(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 15, 1) -+#define SET_TX_DESC_BUFFER_BMC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 14, 1, value) -+#define GET_TX_DESC_BUFFER_BMC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 14, 1) -+#define SET_TX_DESC_BUFFER_RTS_DATA_RTY_LMT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 8, 6, value) -+#define GET_TX_DESC_BUFFER_RTS_DATA_RTY_LMT(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 8, 6) -+#define SET_TX_DESC_BUFFER_HW_AES_IV(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 7, 1, value) -+#define GET_TX_DESC_BUFFER_HW_AES_IV(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 7, 1) -+#define SET_TX_DESC_BUFFER_BT_NULL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 3, 1, value) -+#define GET_TX_DESC_BUFFER_BT_NULL(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 3, 1) -+#define SET_TX_DESC_BUFFER_EN_DESC_ID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 2, 1, value) -+#define GET_TX_DESC_BUFFER_EN_DESC_ID(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 2, 1) -+#define SET_TX_DESC_BUFFER_SECTYPE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 0, 2, value) -+#define GET_TX_DESC_BUFFER_SECTYPE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 0, 2) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_BUFFER_MULTIPLE_PORT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 29, 3, value) -+#define GET_TX_DESC_BUFFER_MULTIPLE_PORT(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x18, 29, 3) -+#define SET_TX_DESC_BUFFER_POLLUTED(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 28, 1, value) -+#define GET_TX_DESC_BUFFER_POLLUTED(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x18, 28, 1) -+#define SET_TX_DESC_BUFFER_NULL_1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 27, 1, value) -+#define GET_TX_DESC_BUFFER_NULL_1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 27, 1) -+#define SET_TX_DESC_BUFFER_NULL_0(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 26, 1, value) -+#define GET_TX_DESC_BUFFER_NULL_0(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 26, 1) -+#define SET_TX_DESC_BUFFER_TRI_FRAME(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 25, 1, value) -+#define GET_TX_DESC_BUFFER_TRI_FRAME(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x18, 25, 1) -+#define SET_TX_DESC_BUFFER_SPE_RPT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 24, 1, value) -+#define GET_TX_DESC_BUFFER_SPE_RPT(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x18, 24, 1) -+#define SET_TX_DESC_BUFFER_FTM_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 23, 1, value) -+#define GET_TX_DESC_BUFFER_FTM_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 23, 1) -+#define SET_TX_DESC_BUFFER_MU_DATARATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 16, 7, value) -+#define GET_TX_DESC_BUFFER_MU_DATARATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x18, 16, 7) -+#define SET_TX_DESC_BUFFER_CCA_RTS(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 14, 2, value) -+#define GET_TX_DESC_BUFFER_CCA_RTS(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x18, 14, 2) -+#define SET_TX_DESC_BUFFER_NDPA(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 12, 2, value) -+#define GET_TX_DESC_BUFFER_NDPA(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 12, 2) -+#define SET_TX_DESC_BUFFER_TXPWR_OFSET_TYPE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 9, 2, value) -+#define GET_TX_DESC_BUFFER_TXPWR_OFSET_TYPE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x18, 9, 2) -+#define SET_TX_DESC_BUFFER_P_AID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 0, 9, value) -+#define GET_TX_DESC_BUFFER_P_AID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 0, 9) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_BUFFER_SW_DEFINE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 16, 12, value) -+#define GET_TX_DESC_BUFFER_SW_DEFINE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x1C, 16, 12) -+#define SET_TX_DESC_BUFFER_CTRL_CNT_VALID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 9, 1, value) -+#define GET_TX_DESC_BUFFER_CTRL_CNT_VALID(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x1C, 9, 1) -+#define SET_TX_DESC_BUFFER_CTRL_CNT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 5, 4, value) -+#define GET_TX_DESC_BUFFER_CTRL_CNT(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x1C, 5, 4) -+#define SET_TX_DESC_BUFFER_DATA_RTY_LOWEST_RATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 0, 5, value) -+#define GET_TX_DESC_BUFFER_DATA_RTY_LOWEST_RATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x1C, 0, 5) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_BUFFER_PATH_MAPA(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 30, 2, value) -+#define GET_TX_DESC_BUFFER_PATH_MAPA(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 30, 2) -+#define SET_TX_DESC_BUFFER_PATH_MAPB(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 28, 2, value) -+#define GET_TX_DESC_BUFFER_PATH_MAPB(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 28, 2) -+#define SET_TX_DESC_BUFFER_PATH_MAPC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 26, 2, value) -+#define GET_TX_DESC_BUFFER_PATH_MAPC(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 26, 2) -+#define SET_TX_DESC_BUFFER_PATH_MAPD(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 24, 2, value) -+#define GET_TX_DESC_BUFFER_PATH_MAPD(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 24, 2) -+#define SET_TX_DESC_BUFFER_ANTSEL_A(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 20, 4, value) -+#define GET_TX_DESC_BUFFER_ANTSEL_A(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 20, 4) -+#define SET_TX_DESC_BUFFER_ANTSEL_B(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 16, 4, value) -+#define GET_TX_DESC_BUFFER_ANTSEL_B(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 16, 4) -+#define SET_TX_DESC_BUFFER_ANTSEL_C(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 12, 4, value) -+#define GET_TX_DESC_BUFFER_ANTSEL_C(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 12, 4) -+#define SET_TX_DESC_BUFFER_ANTSEL_D(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 8, 4, value) -+#define GET_TX_DESC_BUFFER_ANTSEL_D(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 8, 4) -+#define SET_TX_DESC_BUFFER_NTX_PATH_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 4, 4, value) -+#define GET_TX_DESC_BUFFER_NTX_PATH_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 4, 4) -+#define SET_TX_DESC_BUFFER_ANTLSEL_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 3, 1, value) -+#define GET_TX_DESC_BUFFER_ANTLSEL_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 3, 1) -+#define SET_TX_DESC_BUFFER_AMPDU_DENSITY(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 0, 3, value) -+#define GET_TX_DESC_BUFFER_AMPDU_DENSITY(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 0, 3) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_BUFFER_VCS_STBC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 30, 2, value) -+#define GET_TX_DESC_BUFFER_VCS_STBC(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 30, 2) -+#define SET_TX_DESC_BUFFER_DATA_STBC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 28, 2, value) -+#define GET_TX_DESC_BUFFER_DATA_STBC(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 28, 2) -+#define SET_TX_DESC_BUFFER_RTS_RTY_LOWEST_RATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 24, 4, value) -+#define GET_TX_DESC_BUFFER_RTS_RTY_LOWEST_RATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 24, 4) -+#define SET_TX_DESC_BUFFER_SIGNALING_TA_PKT_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 23, 1, value) -+#define GET_TX_DESC_BUFFER_SIGNALING_TA_PKT_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 23, 1) -+#define SET_TX_DESC_BUFFER_MHR_CP(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 22, 1, value) -+#define GET_TX_DESC_BUFFER_MHR_CP(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x24, 22, 1) -+#define SET_TX_DESC_BUFFER_SMH_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 21, 1, value) -+#define GET_TX_DESC_BUFFER_SMH_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x24, 21, 1) -+#define SET_TX_DESC_BUFFER_RTSRATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 16, 5, value) -+#define GET_TX_DESC_BUFFER_RTSRATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 16, 5) -+#define SET_TX_DESC_BUFFER_SMH_CAM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 8, 8, value) -+#define GET_TX_DESC_BUFFER_SMH_CAM(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x24, 8, 8) -+#define SET_TX_DESC_BUFFER_ARFR_TABLE_SEL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 7, 1, value) -+#define GET_TX_DESC_BUFFER_ARFR_TABLE_SEL(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 7, 1) -+#define SET_TX_DESC_BUFFER_ARFR_HT_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 6, 1, value) -+#define GET_TX_DESC_BUFFER_ARFR_HT_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 6, 1) -+#define SET_TX_DESC_BUFFER_ARFR_OFDM_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 5, 1, value) -+#define GET_TX_DESC_BUFFER_ARFR_OFDM_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 5, 1) -+#define SET_TX_DESC_BUFFER_ARFR_CCK_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 4, 1, value) -+#define GET_TX_DESC_BUFFER_ARFR_CCK_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 4, 1) -+#define SET_TX_DESC_BUFFER_RTS_SHORT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 3, 1, value) -+#define GET_TX_DESC_BUFFER_RTS_SHORT(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 3, 1) -+#define SET_TX_DESC_BUFFER_DISDATAFB(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 2, 1, value) -+#define GET_TX_DESC_BUFFER_DISDATAFB(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 2, 1) -+#define SET_TX_DESC_BUFFER_DISRTSFB(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 1, 1, value) -+#define GET_TX_DESC_BUFFER_DISRTSFB(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 1, 1) -+#define SET_TX_DESC_BUFFER_EXT_EDCA(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 0, 1, value) -+#define GET_TX_DESC_BUFFER_EXT_EDCA(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 0, 1) -+ -+/*TXDESC_WORD10*/ -+ -+#define SET_TX_DESC_BUFFER_AMPDU_MAX_TIME(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 24, 8, value) -+#define GET_TX_DESC_BUFFER_AMPDU_MAX_TIME(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x28, 24, 8) -+#define SET_TX_DESC_BUFFER_SPECIAL_CW(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 23, 1, value) -+#define GET_TX_DESC_BUFFER_SPECIAL_CW(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x28, 23, 1) -+#define SET_TX_DESC_BUFFER_RDG_NAV_EXT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 22, 1, value) -+#define GET_TX_DESC_BUFFER_RDG_NAV_EXT(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x28, 22, 1) -+#define SET_TX_DESC_BUFFER_RAW(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 21, 1, value) -+#define GET_TX_DESC_BUFFER_RAW(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 21, 1) -+#define SET_TX_DESC_BUFFER_MAX_AGG_NUM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 16, 5, value) -+#define GET_TX_DESC_BUFFER_MAX_AGG_NUM(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x28, 16, 5) -+#define SET_TX_DESC_BUFFER_FINAL_DATA_RATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 8, 8, value) -+#define GET_TX_DESC_BUFFER_FINAL_DATA_RATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x28, 8, 8) -+#define SET_TX_DESC_BUFFER_GF(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 7, 1, value) -+#define GET_TX_DESC_BUFFER_GF(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 7, 1) -+#define SET_TX_DESC_BUFFER_MOREFRAG(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 6, 1, value) -+#define GET_TX_DESC_BUFFER_MOREFRAG(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x28, 6, 1) -+#define SET_TX_DESC_BUFFER_NOACM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 5, 1, value) -+#define GET_TX_DESC_BUFFER_NOACM(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 5, 1) -+#define SET_TX_DESC_BUFFER_HTC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 4, 1, value) -+#define GET_TX_DESC_BUFFER_HTC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 4, 1) -+#define SET_TX_DESC_BUFFER_TX_PKT_AFTER_PIFS(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 3, 1, value) -+#define GET_TX_DESC_BUFFER_TX_PKT_AFTER_PIFS(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x28, 3, 1) -+#define SET_TX_DESC_BUFFER_USE_MAX_TIME_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 2, 1, value) -+#define GET_TX_DESC_BUFFER_USE_MAX_TIME_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x28, 2, 1) -+#define SET_TX_DESC_BUFFER_HW_SSN_SEL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 0, 2, value) -+#define GET_TX_DESC_BUFFER_HW_SSN_SEL(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x28, 0, 2) -+ -+/*TXDESC_WORD11*/ -+ -+#define SET_TX_DESC_BUFFER_ADDR_CAM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x2C, 24, 8, value) -+#define GET_TX_DESC_BUFFER_ADDR_CAM(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x2C, 24, 8) -+#define SET_TX_DESC_BUFFER_SND_TARGET(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x2C, 16, 8, value) -+#define GET_TX_DESC_BUFFER_SND_TARGET(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x2C, 16, 8) -+#define SET_TX_DESC_BUFFER_DATA_LDPC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x2C, 15, 1, value) -+#define GET_TX_DESC_BUFFER_DATA_LDPC(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x2C, 15, 1) -+#define SET_TX_DESC_BUFFER_LSIG_TXOP_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x2C, 14, 1, value) -+#define GET_TX_DESC_BUFFER_LSIG_TXOP_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x2C, 14, 1) -+#define SET_TX_DESC_BUFFER_G_ID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x2C, 8, 6, value) -+#define GET_TX_DESC_BUFFER_G_ID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x2C, 8, 6) -+#define SET_TX_DESC_BUFFER_SIGNALING_TA_PKT_SC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x2C, 4, 4, value) -+#define GET_TX_DESC_BUFFER_SIGNALING_TA_PKT_SC(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x2C, 4, 4) -+#define SET_TX_DESC_BUFFER_DATA_SC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x2C, 0, 4, value) -+#define GET_TX_DESC_BUFFER_DATA_SC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x2C, 0, 4) -+ -+/*TXDESC_WORD12*/ -+ -+#define SET_TX_DESC_BUFFER_LEN1_L(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x30, 17, 7, value) -+#define GET_TX_DESC_BUFFER_LEN1_L(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x30, 17, 7) -+#define SET_TX_DESC_BUFFER_LEN0(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x30, 4, 13, value) -+#define GET_TX_DESC_BUFFER_LEN0(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x30, 4, 13) -+#define SET_TX_DESC_BUFFER_PKT_NUM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x30, 0, 4, value) -+#define GET_TX_DESC_BUFFER_PKT_NUM(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x30, 0, 4) -+ -+/*TXDESC_WORD13*/ -+ -+#define SET_TX_DESC_BUFFER_LEN3(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x34, 19, 13, value) -+#define GET_TX_DESC_BUFFER_LEN3(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x34, 19, 13) -+#define SET_TX_DESC_BUFFER_LEN2(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x34, 6, 13, value) -+#define GET_TX_DESC_BUFFER_LEN2(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x34, 6, 13) -+#define SET_TX_DESC_BUFFER_LEN1_H(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x34, 0, 6, value) -+#define GET_TX_DESC_BUFFER_LEN1_H(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x34, 0, 6) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_chip.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_chip.h -new file mode 100644 -index 000000000..1d0963b7d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_chip.h -@@ -0,0 +1,3493 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TX_DESC_CHIP_H_ -+#define _HALMAC_TX_DESC_CHIP_H_ -+#if (HALMAC_8814A_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_DISQSELSEQ_8814A(txdesc, value) \ -+ SET_TX_DESC_DISQSELSEQ(txdesc, value) -+#define GET_TX_DESC_DISQSELSEQ_8814A(txdesc) GET_TX_DESC_DISQSELSEQ(txdesc) -+#define SET_TX_DESC_GF_8814A(txdesc, value) SET_TX_DESC_GF(txdesc, value) -+#define GET_TX_DESC_GF_8814A(txdesc) GET_TX_DESC_GF(txdesc) -+#define SET_TX_DESC_NO_ACM_8814A(txdesc, value) \ -+ SET_TX_DESC_NO_ACM(txdesc, value) -+#define GET_TX_DESC_NO_ACM_8814A(txdesc) GET_TX_DESC_NO_ACM(txdesc) -+#define SET_TX_DESC_AMSDU_PAD_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) -+#define GET_TX_DESC_AMSDU_PAD_EN_8814A(txdesc) GET_TX_DESC_AMSDU_PAD_EN(txdesc) -+#define SET_TX_DESC_LS_8814A(txdesc, value) SET_TX_DESC_LS(txdesc, value) -+#define GET_TX_DESC_LS_8814A(txdesc) GET_TX_DESC_LS(txdesc) -+#define SET_TX_DESC_HTC_8814A(txdesc, value) SET_TX_DESC_HTC(txdesc, value) -+#define GET_TX_DESC_HTC_8814A(txdesc) GET_TX_DESC_HTC(txdesc) -+#define SET_TX_DESC_BMC_8814A(txdesc, value) SET_TX_DESC_BMC(txdesc, value) -+#define GET_TX_DESC_BMC_8814A(txdesc) GET_TX_DESC_BMC(txdesc) -+#define SET_TX_DESC_OFFSET_8814A(txdesc, value) \ -+ SET_TX_DESC_OFFSET(txdesc, value) -+#define GET_TX_DESC_OFFSET_8814A(txdesc) GET_TX_DESC_OFFSET(txdesc) -+#define SET_TX_DESC_TXPKTSIZE_8814A(txdesc, value) \ -+ SET_TX_DESC_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_TXPKTSIZE_8814A(txdesc) GET_TX_DESC_TXPKTSIZE(txdesc) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_MOREDATA_8814A(txdesc, value) \ -+ SET_TX_DESC_MOREDATA(txdesc, value) -+#define GET_TX_DESC_MOREDATA_8814A(txdesc) GET_TX_DESC_MOREDATA(txdesc) -+#define SET_TX_DESC_PKT_OFFSET_8814A(txdesc, value) \ -+ SET_TX_DESC_PKT_OFFSET(txdesc, value) -+#define GET_TX_DESC_PKT_OFFSET_8814A(txdesc) GET_TX_DESC_PKT_OFFSET(txdesc) -+#define SET_TX_DESC_SEC_TYPE_8814A(txdesc, value) \ -+ SET_TX_DESC_SEC_TYPE(txdesc, value) -+#define GET_TX_DESC_SEC_TYPE_8814A(txdesc) GET_TX_DESC_SEC_TYPE(txdesc) -+#define SET_TX_DESC_EN_DESC_ID_8814A(txdesc, value) \ -+ SET_TX_DESC_EN_DESC_ID(txdesc, value) -+#define GET_TX_DESC_EN_DESC_ID_8814A(txdesc) GET_TX_DESC_EN_DESC_ID(txdesc) -+#define SET_TX_DESC_RATE_ID_8814A(txdesc, value) \ -+ SET_TX_DESC_RATE_ID(txdesc, value) -+#define GET_TX_DESC_RATE_ID_8814A(txdesc) GET_TX_DESC_RATE_ID(txdesc) -+#define SET_TX_DESC_PIFS_8814A(txdesc, value) SET_TX_DESC_PIFS(txdesc, value) -+#define GET_TX_DESC_PIFS_8814A(txdesc) GET_TX_DESC_PIFS(txdesc) -+#define SET_TX_DESC_LSIG_TXOP_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) -+#define GET_TX_DESC_LSIG_TXOP_EN_8814A(txdesc) GET_TX_DESC_LSIG_TXOP_EN(txdesc) -+#define SET_TX_DESC_RD_NAV_EXT_8814A(txdesc, value) \ -+ SET_TX_DESC_RD_NAV_EXT(txdesc, value) -+#define GET_TX_DESC_RD_NAV_EXT_8814A(txdesc) GET_TX_DESC_RD_NAV_EXT(txdesc) -+#define SET_TX_DESC_QSEL_8814A(txdesc, value) SET_TX_DESC_QSEL(txdesc, value) -+#define GET_TX_DESC_QSEL_8814A(txdesc) GET_TX_DESC_QSEL(txdesc) -+#define SET_TX_DESC_MACID_8814A(txdesc, value) SET_TX_DESC_MACID(txdesc, value) -+#define GET_TX_DESC_MACID_8814A(txdesc) GET_TX_DESC_MACID(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_HW_AES_IV_8814A(txdesc, value) \ -+ SET_TX_DESC_HW_AES_IV(txdesc, value) -+#define GET_TX_DESC_HW_AES_IV_8814A(txdesc) GET_TX_DESC_HW_AES_IV(txdesc) -+#define SET_TX_DESC_G_ID_8814A(txdesc, value) SET_TX_DESC_G_ID(txdesc, value) -+#define GET_TX_DESC_G_ID_8814A(txdesc) GET_TX_DESC_G_ID(txdesc) -+#define SET_TX_DESC_BT_NULL_8814A(txdesc, value) \ -+ SET_TX_DESC_BT_NULL(txdesc, value) -+#define GET_TX_DESC_BT_NULL_8814A(txdesc) GET_TX_DESC_BT_NULL(txdesc) -+#define SET_TX_DESC_AMPDU_DENSITY_8814A(txdesc, value) \ -+ SET_TX_DESC_AMPDU_DENSITY(txdesc, value) -+#define GET_TX_DESC_AMPDU_DENSITY_8814A(txdesc) \ -+ GET_TX_DESC_AMPDU_DENSITY(txdesc) -+#define SET_TX_DESC_SPE_RPT_8814A(txdesc, value) \ -+ SET_TX_DESC_SPE_RPT(txdesc, value) -+#define GET_TX_DESC_SPE_RPT_8814A(txdesc) GET_TX_DESC_SPE_RPT(txdesc) -+#define SET_TX_DESC_RAW_8814A(txdesc, value) SET_TX_DESC_RAW(txdesc, value) -+#define GET_TX_DESC_RAW_8814A(txdesc) GET_TX_DESC_RAW(txdesc) -+#define SET_TX_DESC_MOREFRAG_8814A(txdesc, value) \ -+ SET_TX_DESC_MOREFRAG(txdesc, value) -+#define GET_TX_DESC_MOREFRAG_8814A(txdesc) GET_TX_DESC_MOREFRAG(txdesc) -+#define SET_TX_DESC_BK_8814A(txdesc, value) SET_TX_DESC_BK(txdesc, value) -+#define GET_TX_DESC_BK_8814A(txdesc) GET_TX_DESC_BK(txdesc) -+#define SET_TX_DESC_NULL_1_8814A(txdesc, value) \ -+ SET_TX_DESC_NULL_1(txdesc, value) -+#define GET_TX_DESC_NULL_1_8814A(txdesc) GET_TX_DESC_NULL_1(txdesc) -+#define SET_TX_DESC_NULL_0_8814A(txdesc, value) \ -+ SET_TX_DESC_NULL_0(txdesc, value) -+#define GET_TX_DESC_NULL_0_8814A(txdesc) GET_TX_DESC_NULL_0(txdesc) -+#define SET_TX_DESC_RDG_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_RDG_EN(txdesc, value) -+#define GET_TX_DESC_RDG_EN_8814A(txdesc) GET_TX_DESC_RDG_EN(txdesc) -+#define SET_TX_DESC_AGG_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_AGG_EN(txdesc, value) -+#define GET_TX_DESC_AGG_EN_8814A(txdesc) GET_TX_DESC_AGG_EN(txdesc) -+#define SET_TX_DESC_CCA_RTS_8814A(txdesc, value) \ -+ SET_TX_DESC_CCA_RTS(txdesc, value) -+#define GET_TX_DESC_CCA_RTS_8814A(txdesc) GET_TX_DESC_CCA_RTS(txdesc) -+#define SET_TX_DESC_P_AID_8814A(txdesc, value) SET_TX_DESC_P_AID(txdesc, value) -+#define GET_TX_DESC_P_AID_8814A(txdesc) GET_TX_DESC_P_AID(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME_8814A(txdesc, value) \ -+ SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) -+#define GET_TX_DESC_AMPDU_MAX_TIME_8814A(txdesc) \ -+ GET_TX_DESC_AMPDU_MAX_TIME(txdesc) -+#define SET_TX_DESC_NDPA_8814A(txdesc, value) SET_TX_DESC_NDPA(txdesc, value) -+#define GET_TX_DESC_NDPA_8814A(txdesc) GET_TX_DESC_NDPA(txdesc) -+#define SET_TX_DESC_MAX_AGG_NUM_8814A(txdesc, value) \ -+ SET_TX_DESC_MAX_AGG_NUM(txdesc, value) -+#define GET_TX_DESC_MAX_AGG_NUM_8814A(txdesc) GET_TX_DESC_MAX_AGG_NUM(txdesc) -+#define SET_TX_DESC_USE_MAX_TIME_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) -+#define GET_TX_DESC_USE_MAX_TIME_EN_8814A(txdesc) \ -+ GET_TX_DESC_USE_MAX_TIME_EN(txdesc) -+#define SET_TX_DESC_NAVUSEHDR_8814A(txdesc, value) \ -+ SET_TX_DESC_NAVUSEHDR(txdesc, value) -+#define GET_TX_DESC_NAVUSEHDR_8814A(txdesc) GET_TX_DESC_NAVUSEHDR(txdesc) -+#define SET_TX_DESC_CHK_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_CHK_EN(txdesc, value) -+#define GET_TX_DESC_CHK_EN_8814A(txdesc) GET_TX_DESC_CHK_EN(txdesc) -+#define SET_TX_DESC_HW_RTS_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_HW_RTS_EN(txdesc, value) -+#define GET_TX_DESC_HW_RTS_EN_8814A(txdesc) GET_TX_DESC_HW_RTS_EN(txdesc) -+#define SET_TX_DESC_RTSEN_8814A(txdesc, value) SET_TX_DESC_RTSEN(txdesc, value) -+#define GET_TX_DESC_RTSEN_8814A(txdesc) GET_TX_DESC_RTSEN(txdesc) -+#define SET_TX_DESC_CTS2SELF_8814A(txdesc, value) \ -+ SET_TX_DESC_CTS2SELF(txdesc, value) -+#define GET_TX_DESC_CTS2SELF_8814A(txdesc) GET_TX_DESC_CTS2SELF(txdesc) -+#define SET_TX_DESC_DISDATAFB_8814A(txdesc, value) \ -+ SET_TX_DESC_DISDATAFB(txdesc, value) -+#define GET_TX_DESC_DISDATAFB_8814A(txdesc) GET_TX_DESC_DISDATAFB(txdesc) -+#define SET_TX_DESC_DISRTSFB_8814A(txdesc, value) \ -+ SET_TX_DESC_DISRTSFB(txdesc, value) -+#define GET_TX_DESC_DISRTSFB_8814A(txdesc) GET_TX_DESC_DISRTSFB(txdesc) -+#define SET_TX_DESC_USE_RATE_8814A(txdesc, value) \ -+ SET_TX_DESC_USE_RATE(txdesc, value) -+#define GET_TX_DESC_USE_RATE_8814A(txdesc) GET_TX_DESC_USE_RATE(txdesc) -+#define SET_TX_DESC_HW_SSN_SEL_8814A(txdesc, value) \ -+ SET_TX_DESC_HW_SSN_SEL(txdesc, value) -+#define GET_TX_DESC_HW_SSN_SEL_8814A(txdesc) GET_TX_DESC_HW_SSN_SEL(txdesc) -+#define SET_TX_DESC_WHEADER_LEN_8814A(txdesc, value) \ -+ SET_TX_DESC_WHEADER_LEN(txdesc, value) -+#define GET_TX_DESC_WHEADER_LEN_8814A(txdesc) GET_TX_DESC_WHEADER_LEN(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX_8814A(txdesc, value) \ -+ SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) -+#define GET_TX_DESC_PCTS_MASK_IDX_8814A(txdesc) \ -+ GET_TX_DESC_PCTS_MASK_IDX(txdesc) -+#define SET_TX_DESC_PCTS_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_PCTS_EN(txdesc, value) -+#define GET_TX_DESC_PCTS_EN_8814A(txdesc) GET_TX_DESC_PCTS_EN(txdesc) -+#define SET_TX_DESC_RTSRATE_8814A(txdesc, value) \ -+ SET_TX_DESC_RTSRATE(txdesc, value) -+#define GET_TX_DESC_RTSRATE_8814A(txdesc) GET_TX_DESC_RTSRATE(txdesc) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT_8814A(txdesc, value) \ -+ SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT_8814A(txdesc) \ -+ GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) -+#define SET_TX_DESC_RTY_LMT_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_RTY_LMT_EN(txdesc, value) -+#define GET_TX_DESC_RTY_LMT_EN_8814A(txdesc) GET_TX_DESC_RTY_LMT_EN(txdesc) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE_8814A(txdesc, value) \ -+ SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE_8814A(txdesc) \ -+ GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE_8814A(txdesc, value) \ -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE_8814A(txdesc) \ -+ GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_TRY_RATE_8814A(txdesc, value) \ -+ SET_TX_DESC_TRY_RATE(txdesc, value) -+#define GET_TX_DESC_TRY_RATE_8814A(txdesc) GET_TX_DESC_TRY_RATE(txdesc) -+#define SET_TX_DESC_DATARATE_8814A(txdesc, value) \ -+ SET_TX_DESC_DATARATE(txdesc, value) -+#define GET_TX_DESC_DATARATE_8814A(txdesc) GET_TX_DESC_DATARATE(txdesc) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED_8814A(txdesc, value) \ -+ SET_TX_DESC_POLLUTED(txdesc, value) -+#define GET_TX_DESC_POLLUTED_8814A(txdesc) GET_TX_DESC_POLLUTED(txdesc) -+#define SET_TX_DESC_TXPWR_OFSET_8814A(txdesc, value) \ -+ SET_TX_DESC_TXPWR_OFSET(txdesc, value) -+#define GET_TX_DESC_TXPWR_OFSET_8814A(txdesc) GET_TX_DESC_TXPWR_OFSET(txdesc) -+#define SET_TX_DESC_TX_ANT_8814A(txdesc, value) \ -+ SET_TX_DESC_TX_ANT(txdesc, value) -+#define GET_TX_DESC_TX_ANT_8814A(txdesc) GET_TX_DESC_TX_ANT(txdesc) -+#define SET_TX_DESC_PORT_ID_8814A(txdesc, value) \ -+ SET_TX_DESC_PORT_ID(txdesc, value) -+#define GET_TX_DESC_PORT_ID_8814A(txdesc) GET_TX_DESC_PORT_ID(txdesc) -+#define SET_TX_DESC_SIGNALING_TAPKT_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TAPKT_EN(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TAPKT_EN_8814A(txdesc) \ -+ GET_TX_DESC_SIGNALING_TAPKT_EN(txdesc) -+#define SET_TX_DESC_RTS_SC_8814A(txdesc, value) \ -+ SET_TX_DESC_RTS_SC(txdesc, value) -+#define GET_TX_DESC_RTS_SC_8814A(txdesc) GET_TX_DESC_RTS_SC(txdesc) -+#define SET_TX_DESC_RTS_SHORT_8814A(txdesc, value) \ -+ SET_TX_DESC_RTS_SHORT(txdesc, value) -+#define GET_TX_DESC_RTS_SHORT_8814A(txdesc) GET_TX_DESC_RTS_SHORT(txdesc) -+#define SET_TX_DESC_VCS_STBC_8814A(txdesc, value) \ -+ SET_TX_DESC_VCS_STBC(txdesc, value) -+#define GET_TX_DESC_VCS_STBC_8814A(txdesc) GET_TX_DESC_VCS_STBC(txdesc) -+#define SET_TX_DESC_DATA_STBC_8814A(txdesc, value) \ -+ SET_TX_DESC_DATA_STBC(txdesc, value) -+#define GET_TX_DESC_DATA_STBC_8814A(txdesc) GET_TX_DESC_DATA_STBC(txdesc) -+#define SET_TX_DESC_DATA_LDPC_8814A(txdesc, value) \ -+ SET_TX_DESC_DATA_LDPC(txdesc, value) -+#define GET_TX_DESC_DATA_LDPC_8814A(txdesc) GET_TX_DESC_DATA_LDPC(txdesc) -+#define SET_TX_DESC_DATA_BW_8814A(txdesc, value) \ -+ SET_TX_DESC_DATA_BW(txdesc, value) -+#define GET_TX_DESC_DATA_BW_8814A(txdesc) GET_TX_DESC_DATA_BW(txdesc) -+#define SET_TX_DESC_DATA_SHORT_8814A(txdesc, value) \ -+ SET_TX_DESC_DATA_SHORT(txdesc, value) -+#define GET_TX_DESC_DATA_SHORT_8814A(txdesc) GET_TX_DESC_DATA_SHORT(txdesc) -+#define SET_TX_DESC_DATA_SC_8814A(txdesc, value) \ -+ SET_TX_DESC_DATA_SC(txdesc, value) -+#define GET_TX_DESC_DATA_SC_8814A(txdesc) GET_TX_DESC_DATA_SC(txdesc) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANTSEL_D_8814A(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_D(txdesc, value) -+#define GET_TX_DESC_ANTSEL_D_8814A(txdesc) GET_TX_DESC_ANTSEL_D(txdesc) -+#define SET_TX_DESC_ANT_MAPD_8814A(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPD(txdesc, value) -+#define GET_TX_DESC_ANT_MAPD_8814A(txdesc) GET_TX_DESC_ANT_MAPD(txdesc) -+#define SET_TX_DESC_ANT_MAPC_8814A(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPC(txdesc, value) -+#define GET_TX_DESC_ANT_MAPC_8814A(txdesc) GET_TX_DESC_ANT_MAPC(txdesc) -+#define SET_TX_DESC_ANT_MAPB_8814A(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPB(txdesc, value) -+#define GET_TX_DESC_ANT_MAPB_8814A(txdesc) GET_TX_DESC_ANT_MAPB(txdesc) -+#define SET_TX_DESC_ANT_MAPA_8814A(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPA(txdesc, value) -+#define GET_TX_DESC_ANT_MAPA_8814A(txdesc) GET_TX_DESC_ANT_MAPA(txdesc) -+#define SET_TX_DESC_ANTSEL_C_8814A(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_C(txdesc, value) -+#define GET_TX_DESC_ANTSEL_C_8814A(txdesc) GET_TX_DESC_ANTSEL_C(txdesc) -+#define SET_TX_DESC_ANTSEL_B_8814A(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_B(txdesc, value) -+#define GET_TX_DESC_ANTSEL_B_8814A(txdesc) GET_TX_DESC_ANTSEL_B(txdesc) -+#define SET_TX_DESC_ANTSEL_A_8814A(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_A(txdesc, value) -+#define GET_TX_DESC_ANTSEL_A_8814A(txdesc) GET_TX_DESC_ANTSEL_A(txdesc) -+#define SET_TX_DESC_MBSSID_8814A(txdesc, value) \ -+ SET_TX_DESC_MBSSID(txdesc, value) -+#define GET_TX_DESC_MBSSID_8814A(txdesc) GET_TX_DESC_MBSSID(txdesc) -+#define SET_TX_DESC_SW_DEFINE_8814A(txdesc, value) \ -+ SET_TX_DESC_SW_DEFINE(txdesc, value) -+#define GET_TX_DESC_SW_DEFINE_8814A(txdesc) GET_TX_DESC_SW_DEFINE(txdesc) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_8814A(txdesc, value) \ -+ SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_8814A(txdesc) \ -+ GET_TX_DESC_DMA_TXAGG_NUM(txdesc) -+#define SET_TX_DESC_FINAL_DATA_RATE_8814A(txdesc, value) \ -+ SET_TX_DESC_FINAL_DATA_RATE(txdesc, value) -+#define GET_TX_DESC_FINAL_DATA_RATE_8814A(txdesc) \ -+ GET_TX_DESC_FINAL_DATA_RATE(txdesc) -+#define SET_TX_DESC_NTX_MAP_8814A(txdesc, value) \ -+ SET_TX_DESC_NTX_MAP(txdesc, value) -+#define GET_TX_DESC_NTX_MAP_8814A(txdesc) GET_TX_DESC_NTX_MAP(txdesc) -+#define SET_TX_DESC_TX_BUFF_SIZE_8814A(txdesc, value) \ -+ SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) -+#define GET_TX_DESC_TX_BUFF_SIZE_8814A(txdesc) GET_TX_DESC_TX_BUFF_SIZE(txdesc) -+#define SET_TX_DESC_TXDESC_CHECKSUM_8814A(txdesc, value) \ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_8814A(txdesc) \ -+ GET_TX_DESC_TXDESC_CHECKSUM(txdesc) -+#define SET_TX_DESC_TIMESTAMP_8814A(txdesc, value) \ -+ SET_TX_DESC_TIMESTAMP(txdesc, value) -+#define GET_TX_DESC_TIMESTAMP_8814A(txdesc) GET_TX_DESC_TIMESTAMP(txdesc) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TXWIFI_CP_8814A(txdesc, value) \ -+ SET_TX_DESC_TXWIFI_CP(txdesc, value) -+#define GET_TX_DESC_TXWIFI_CP_8814A(txdesc) GET_TX_DESC_TXWIFI_CP(txdesc) -+#define SET_TX_DESC_MAC_CP_8814A(txdesc, value) \ -+ SET_TX_DESC_MAC_CP(txdesc, value) -+#define GET_TX_DESC_MAC_CP_8814A(txdesc) GET_TX_DESC_MAC_CP(txdesc) -+#define SET_TX_DESC_STW_PKTRE_DIS_8814A(txdesc, value) \ -+ SET_TX_DESC_STW_PKTRE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_PKTRE_DIS_8814A(txdesc) \ -+ GET_TX_DESC_STW_PKTRE_DIS(txdesc) -+#define SET_TX_DESC_STW_RB_DIS_8814A(txdesc, value) \ -+ SET_TX_DESC_STW_RB_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RB_DIS_8814A(txdesc) GET_TX_DESC_STW_RB_DIS(txdesc) -+#define SET_TX_DESC_STW_RATE_DIS_8814A(txdesc, value) \ -+ SET_TX_DESC_STW_RATE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RATE_DIS_8814A(txdesc) GET_TX_DESC_STW_RATE_DIS(txdesc) -+#define SET_TX_DESC_STW_ANT_DIS_8814A(txdesc, value) \ -+ SET_TX_DESC_STW_ANT_DIS(txdesc, value) -+#define GET_TX_DESC_STW_ANT_DIS_8814A(txdesc) GET_TX_DESC_STW_ANT_DIS(txdesc) -+#define SET_TX_DESC_STW_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_STW_EN(txdesc, value) -+#define GET_TX_DESC_STW_EN_8814A(txdesc) GET_TX_DESC_STW_EN(txdesc) -+#define SET_TX_DESC_SMH_EN_8814A(txdesc, value) \ -+ SET_TX_DESC_SMH_EN(txdesc, value) -+#define GET_TX_DESC_SMH_EN_8814A(txdesc) GET_TX_DESC_SMH_EN(txdesc) -+#define SET_TX_DESC_TAILPAGE_L_8814A(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_L(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_L_8814A(txdesc) GET_TX_DESC_TAILPAGE_L(txdesc) -+#define SET_TX_DESC_SDIO_DMASEQ_8814A(txdesc, value) \ -+ SET_TX_DESC_SDIO_DMASEQ(txdesc, value) -+#define GET_TX_DESC_SDIO_DMASEQ_8814A(txdesc) GET_TX_DESC_SDIO_DMASEQ(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_L_8814A(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_L_8814A(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_L(txdesc) -+#define SET_TX_DESC_EN_HWSEQ_8814A(txdesc, value) \ -+ SET_TX_DESC_EN_HWSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWSEQ_8814A(txdesc) GET_TX_DESC_EN_HWSEQ(txdesc) -+#define SET_TX_DESC_EN_HWEXSEQ_8814A(txdesc, value) \ -+ SET_TX_DESC_EN_HWEXSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWEXSEQ_8814A(txdesc) GET_TX_DESC_EN_HWEXSEQ(txdesc) -+#define SET_TX_DESC_DATA_RC_8814A(txdesc, value) \ -+ SET_TX_DESC_DATA_RC(txdesc, value) -+#define GET_TX_DESC_DATA_RC_8814A(txdesc) GET_TX_DESC_DATA_RC(txdesc) -+#define SET_TX_DESC_BAR_RTY_TH_8814A(txdesc, value) \ -+ SET_TX_DESC_BAR_RTY_TH(txdesc, value) -+#define GET_TX_DESC_BAR_RTY_TH_8814A(txdesc) GET_TX_DESC_BAR_RTY_TH(txdesc) -+#define SET_TX_DESC_RTS_RC_8814A(txdesc, value) \ -+ SET_TX_DESC_RTS_RC(txdesc, value) -+#define GET_TX_DESC_RTS_RC_8814A(txdesc) GET_TX_DESC_RTS_RC(txdesc) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_TAILPAGE_H_8814A(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_H(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_H_8814A(txdesc) GET_TX_DESC_TAILPAGE_H(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_H_8814A(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_H(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_H_8814A(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_H(txdesc) -+#define SET_TX_DESC_SW_SEQ_8814A(txdesc, value) \ -+ SET_TX_DESC_SW_SEQ(txdesc, value) -+#define GET_TX_DESC_SW_SEQ_8814A(txdesc) GET_TX_DESC_SW_SEQ(txdesc) -+#define SET_TX_DESC_TXBF_PATH_8814A(txdesc, value) \ -+ SET_TX_DESC_TXBF_PATH(txdesc, value) -+#define GET_TX_DESC_TXBF_PATH_8814A(txdesc) GET_TX_DESC_TXBF_PATH(txdesc) -+#define SET_TX_DESC_PADDING_LEN_8814A(txdesc, value) \ -+ SET_TX_DESC_PADDING_LEN(txdesc, value) -+#define GET_TX_DESC_PADDING_LEN_8814A(txdesc) GET_TX_DESC_PADDING_LEN(txdesc) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET_8814A(txdesc, value) \ -+ SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET_8814A(txdesc) \ -+ GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) -+ -+/*WORD10*/ -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_DISQSELSEQ_8822B(txdesc, value) \ -+ SET_TX_DESC_DISQSELSEQ(txdesc, value) -+#define GET_TX_DESC_DISQSELSEQ_8822B(txdesc) GET_TX_DESC_DISQSELSEQ(txdesc) -+#define SET_TX_DESC_GF_8822B(txdesc, value) SET_TX_DESC_GF(txdesc, value) -+#define GET_TX_DESC_GF_8822B(txdesc) GET_TX_DESC_GF(txdesc) -+#define SET_TX_DESC_NO_ACM_8822B(txdesc, value) \ -+ SET_TX_DESC_NO_ACM(txdesc, value) -+#define GET_TX_DESC_NO_ACM_8822B(txdesc) GET_TX_DESC_NO_ACM(txdesc) -+#define SET_TX_DESC_BCNPKT_TSF_CTRL_8822B(txdesc, value) \ -+ SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc, value) -+#define GET_TX_DESC_BCNPKT_TSF_CTRL_8822B(txdesc) \ -+ GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc) -+#define SET_TX_DESC_AMSDU_PAD_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) -+#define GET_TX_DESC_AMSDU_PAD_EN_8822B(txdesc) GET_TX_DESC_AMSDU_PAD_EN(txdesc) -+#define SET_TX_DESC_LS_8822B(txdesc, value) SET_TX_DESC_LS(txdesc, value) -+#define GET_TX_DESC_LS_8822B(txdesc) GET_TX_DESC_LS(txdesc) -+#define SET_TX_DESC_HTC_8822B(txdesc, value) SET_TX_DESC_HTC(txdesc, value) -+#define GET_TX_DESC_HTC_8822B(txdesc) GET_TX_DESC_HTC(txdesc) -+#define SET_TX_DESC_BMC_8822B(txdesc, value) SET_TX_DESC_BMC(txdesc, value) -+#define GET_TX_DESC_BMC_8822B(txdesc) GET_TX_DESC_BMC(txdesc) -+#define SET_TX_DESC_OFFSET_8822B(txdesc, value) \ -+ SET_TX_DESC_OFFSET(txdesc, value) -+#define GET_TX_DESC_OFFSET_8822B(txdesc) GET_TX_DESC_OFFSET(txdesc) -+#define SET_TX_DESC_TXPKTSIZE_8822B(txdesc, value) \ -+ SET_TX_DESC_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_TXPKTSIZE_8822B(txdesc) GET_TX_DESC_TXPKTSIZE(txdesc) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_MOREDATA_8822B(txdesc, value) \ -+ SET_TX_DESC_MOREDATA(txdesc, value) -+#define GET_TX_DESC_MOREDATA_8822B(txdesc) GET_TX_DESC_MOREDATA(txdesc) -+#define SET_TX_DESC_PKT_OFFSET_8822B(txdesc, value) \ -+ SET_TX_DESC_PKT_OFFSET(txdesc, value) -+#define GET_TX_DESC_PKT_OFFSET_8822B(txdesc) GET_TX_DESC_PKT_OFFSET(txdesc) -+#define SET_TX_DESC_SEC_TYPE_8822B(txdesc, value) \ -+ SET_TX_DESC_SEC_TYPE(txdesc, value) -+#define GET_TX_DESC_SEC_TYPE_8822B(txdesc) GET_TX_DESC_SEC_TYPE(txdesc) -+#define SET_TX_DESC_EN_DESC_ID_8822B(txdesc, value) \ -+ SET_TX_DESC_EN_DESC_ID(txdesc, value) -+#define GET_TX_DESC_EN_DESC_ID_8822B(txdesc) GET_TX_DESC_EN_DESC_ID(txdesc) -+#define SET_TX_DESC_RATE_ID_8822B(txdesc, value) \ -+ SET_TX_DESC_RATE_ID(txdesc, value) -+#define GET_TX_DESC_RATE_ID_8822B(txdesc) GET_TX_DESC_RATE_ID(txdesc) -+#define SET_TX_DESC_PIFS_8822B(txdesc, value) SET_TX_DESC_PIFS(txdesc, value) -+#define GET_TX_DESC_PIFS_8822B(txdesc) GET_TX_DESC_PIFS(txdesc) -+#define SET_TX_DESC_LSIG_TXOP_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) -+#define GET_TX_DESC_LSIG_TXOP_EN_8822B(txdesc) GET_TX_DESC_LSIG_TXOP_EN(txdesc) -+#define SET_TX_DESC_RD_NAV_EXT_8822B(txdesc, value) \ -+ SET_TX_DESC_RD_NAV_EXT(txdesc, value) -+#define GET_TX_DESC_RD_NAV_EXT_8822B(txdesc) GET_TX_DESC_RD_NAV_EXT(txdesc) -+#define SET_TX_DESC_QSEL_8822B(txdesc, value) SET_TX_DESC_QSEL(txdesc, value) -+#define GET_TX_DESC_QSEL_8822B(txdesc) GET_TX_DESC_QSEL(txdesc) -+#define SET_TX_DESC_MACID_8822B(txdesc, value) SET_TX_DESC_MACID(txdesc, value) -+#define GET_TX_DESC_MACID_8822B(txdesc) GET_TX_DESC_MACID(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_HW_AES_IV_8822B(txdesc, value) \ -+ SET_TX_DESC_HW_AES_IV(txdesc, value) -+#define GET_TX_DESC_HW_AES_IV_8822B(txdesc) GET_TX_DESC_HW_AES_IV(txdesc) -+#define SET_TX_DESC_FTM_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_FTM_EN(txdesc, value) -+#define GET_TX_DESC_FTM_EN_8822B(txdesc) GET_TX_DESC_FTM_EN(txdesc) -+#define SET_TX_DESC_G_ID_8822B(txdesc, value) SET_TX_DESC_G_ID(txdesc, value) -+#define GET_TX_DESC_G_ID_8822B(txdesc) GET_TX_DESC_G_ID(txdesc) -+#define SET_TX_DESC_BT_NULL_8822B(txdesc, value) \ -+ SET_TX_DESC_BT_NULL(txdesc, value) -+#define GET_TX_DESC_BT_NULL_8822B(txdesc) GET_TX_DESC_BT_NULL(txdesc) -+#define SET_TX_DESC_AMPDU_DENSITY_8822B(txdesc, value) \ -+ SET_TX_DESC_AMPDU_DENSITY(txdesc, value) -+#define GET_TX_DESC_AMPDU_DENSITY_8822B(txdesc) \ -+ GET_TX_DESC_AMPDU_DENSITY(txdesc) -+#define SET_TX_DESC_SPE_RPT_8822B(txdesc, value) \ -+ SET_TX_DESC_SPE_RPT(txdesc, value) -+#define GET_TX_DESC_SPE_RPT_8822B(txdesc) GET_TX_DESC_SPE_RPT(txdesc) -+#define SET_TX_DESC_RAW_8822B(txdesc, value) SET_TX_DESC_RAW(txdesc, value) -+#define GET_TX_DESC_RAW_8822B(txdesc) GET_TX_DESC_RAW(txdesc) -+#define SET_TX_DESC_MOREFRAG_8822B(txdesc, value) \ -+ SET_TX_DESC_MOREFRAG(txdesc, value) -+#define GET_TX_DESC_MOREFRAG_8822B(txdesc) GET_TX_DESC_MOREFRAG(txdesc) -+#define SET_TX_DESC_BK_8822B(txdesc, value) SET_TX_DESC_BK(txdesc, value) -+#define GET_TX_DESC_BK_8822B(txdesc) GET_TX_DESC_BK(txdesc) -+#define SET_TX_DESC_NULL_1_8822B(txdesc, value) \ -+ SET_TX_DESC_NULL_1(txdesc, value) -+#define GET_TX_DESC_NULL_1_8822B(txdesc) GET_TX_DESC_NULL_1(txdesc) -+#define SET_TX_DESC_NULL_0_8822B(txdesc, value) \ -+ SET_TX_DESC_NULL_0(txdesc, value) -+#define GET_TX_DESC_NULL_0_8822B(txdesc) GET_TX_DESC_NULL_0(txdesc) -+#define SET_TX_DESC_RDG_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_RDG_EN(txdesc, value) -+#define GET_TX_DESC_RDG_EN_8822B(txdesc) GET_TX_DESC_RDG_EN(txdesc) -+#define SET_TX_DESC_AGG_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_AGG_EN(txdesc, value) -+#define GET_TX_DESC_AGG_EN_8822B(txdesc) GET_TX_DESC_AGG_EN(txdesc) -+#define SET_TX_DESC_CCA_RTS_8822B(txdesc, value) \ -+ SET_TX_DESC_CCA_RTS(txdesc, value) -+#define GET_TX_DESC_CCA_RTS_8822B(txdesc) GET_TX_DESC_CCA_RTS(txdesc) -+#define SET_TX_DESC_TRI_FRAME_8822B(txdesc, value) \ -+ SET_TX_DESC_TRI_FRAME(txdesc, value) -+#define GET_TX_DESC_TRI_FRAME_8822B(txdesc) GET_TX_DESC_TRI_FRAME(txdesc) -+#define SET_TX_DESC_P_AID_8822B(txdesc, value) SET_TX_DESC_P_AID(txdesc, value) -+#define GET_TX_DESC_P_AID_8822B(txdesc) GET_TX_DESC_P_AID(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME_8822B(txdesc, value) \ -+ SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) -+#define GET_TX_DESC_AMPDU_MAX_TIME_8822B(txdesc) \ -+ GET_TX_DESC_AMPDU_MAX_TIME(txdesc) -+#define SET_TX_DESC_NDPA_8822B(txdesc, value) SET_TX_DESC_NDPA(txdesc, value) -+#define GET_TX_DESC_NDPA_8822B(txdesc) GET_TX_DESC_NDPA(txdesc) -+#define SET_TX_DESC_MAX_AGG_NUM_8822B(txdesc, value) \ -+ SET_TX_DESC_MAX_AGG_NUM(txdesc, value) -+#define GET_TX_DESC_MAX_AGG_NUM_8822B(txdesc) GET_TX_DESC_MAX_AGG_NUM(txdesc) -+#define SET_TX_DESC_USE_MAX_TIME_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) -+#define GET_TX_DESC_USE_MAX_TIME_EN_8822B(txdesc) \ -+ GET_TX_DESC_USE_MAX_TIME_EN(txdesc) -+#define SET_TX_DESC_NAVUSEHDR_8822B(txdesc, value) \ -+ SET_TX_DESC_NAVUSEHDR(txdesc, value) -+#define GET_TX_DESC_NAVUSEHDR_8822B(txdesc) GET_TX_DESC_NAVUSEHDR(txdesc) -+#define SET_TX_DESC_CHK_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_CHK_EN(txdesc, value) -+#define GET_TX_DESC_CHK_EN_8822B(txdesc) GET_TX_DESC_CHK_EN(txdesc) -+#define SET_TX_DESC_HW_RTS_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_HW_RTS_EN(txdesc, value) -+#define GET_TX_DESC_HW_RTS_EN_8822B(txdesc) GET_TX_DESC_HW_RTS_EN(txdesc) -+#define SET_TX_DESC_RTSEN_8822B(txdesc, value) SET_TX_DESC_RTSEN(txdesc, value) -+#define GET_TX_DESC_RTSEN_8822B(txdesc) GET_TX_DESC_RTSEN(txdesc) -+#define SET_TX_DESC_CTS2SELF_8822B(txdesc, value) \ -+ SET_TX_DESC_CTS2SELF(txdesc, value) -+#define GET_TX_DESC_CTS2SELF_8822B(txdesc) GET_TX_DESC_CTS2SELF(txdesc) -+#define SET_TX_DESC_DISDATAFB_8822B(txdesc, value) \ -+ SET_TX_DESC_DISDATAFB(txdesc, value) -+#define GET_TX_DESC_DISDATAFB_8822B(txdesc) GET_TX_DESC_DISDATAFB(txdesc) -+#define SET_TX_DESC_DISRTSFB_8822B(txdesc, value) \ -+ SET_TX_DESC_DISRTSFB(txdesc, value) -+#define GET_TX_DESC_DISRTSFB_8822B(txdesc) GET_TX_DESC_DISRTSFB(txdesc) -+#define SET_TX_DESC_USE_RATE_8822B(txdesc, value) \ -+ SET_TX_DESC_USE_RATE(txdesc, value) -+#define GET_TX_DESC_USE_RATE_8822B(txdesc) GET_TX_DESC_USE_RATE(txdesc) -+#define SET_TX_DESC_HW_SSN_SEL_8822B(txdesc, value) \ -+ SET_TX_DESC_HW_SSN_SEL(txdesc, value) -+#define GET_TX_DESC_HW_SSN_SEL_8822B(txdesc) GET_TX_DESC_HW_SSN_SEL(txdesc) -+#define SET_TX_DESC_WHEADER_LEN_8822B(txdesc, value) \ -+ SET_TX_DESC_WHEADER_LEN(txdesc, value) -+#define GET_TX_DESC_WHEADER_LEN_8822B(txdesc) GET_TX_DESC_WHEADER_LEN(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX_8822B(txdesc, value) \ -+ SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) -+#define GET_TX_DESC_PCTS_MASK_IDX_8822B(txdesc) \ -+ GET_TX_DESC_PCTS_MASK_IDX(txdesc) -+#define SET_TX_DESC_PCTS_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_PCTS_EN(txdesc, value) -+#define GET_TX_DESC_PCTS_EN_8822B(txdesc) GET_TX_DESC_PCTS_EN(txdesc) -+#define SET_TX_DESC_RTSRATE_8822B(txdesc, value) \ -+ SET_TX_DESC_RTSRATE(txdesc, value) -+#define GET_TX_DESC_RTSRATE_8822B(txdesc) GET_TX_DESC_RTSRATE(txdesc) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT_8822B(txdesc, value) \ -+ SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT_8822B(txdesc) \ -+ GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) -+#define SET_TX_DESC_RTY_LMT_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_RTY_LMT_EN(txdesc, value) -+#define GET_TX_DESC_RTY_LMT_EN_8822B(txdesc) GET_TX_DESC_RTY_LMT_EN(txdesc) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE_8822B(txdesc, value) \ -+ SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE_8822B(txdesc) \ -+ GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE_8822B(txdesc, value) \ -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE_8822B(txdesc) \ -+ GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_TRY_RATE_8822B(txdesc, value) \ -+ SET_TX_DESC_TRY_RATE(txdesc, value) -+#define GET_TX_DESC_TRY_RATE_8822B(txdesc) GET_TX_DESC_TRY_RATE(txdesc) -+#define SET_TX_DESC_DATARATE_8822B(txdesc, value) \ -+ SET_TX_DESC_DATARATE(txdesc, value) -+#define GET_TX_DESC_DATARATE_8822B(txdesc) GET_TX_DESC_DATARATE(txdesc) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED_8822B(txdesc, value) \ -+ SET_TX_DESC_POLLUTED(txdesc, value) -+#define GET_TX_DESC_POLLUTED_8822B(txdesc) GET_TX_DESC_POLLUTED(txdesc) -+#define SET_TX_DESC_TXPWR_OFSET_8822B(txdesc, value) \ -+ SET_TX_DESC_TXPWR_OFSET(txdesc, value) -+#define GET_TX_DESC_TXPWR_OFSET_8822B(txdesc) GET_TX_DESC_TXPWR_OFSET(txdesc) -+#define SET_TX_DESC_TX_ANT_8822B(txdesc, value) \ -+ SET_TX_DESC_TX_ANT(txdesc, value) -+#define GET_TX_DESC_TX_ANT_8822B(txdesc) GET_TX_DESC_TX_ANT(txdesc) -+#define SET_TX_DESC_PORT_ID_8822B(txdesc, value) \ -+ SET_TX_DESC_PORT_ID(txdesc, value) -+#define GET_TX_DESC_PORT_ID_8822B(txdesc) GET_TX_DESC_PORT_ID(txdesc) -+#define SET_TX_DESC_MULTIPLE_PORT_8822B(txdesc, value) \ -+ SET_TX_DESC_MULTIPLE_PORT(txdesc, value) -+#define GET_TX_DESC_MULTIPLE_PORT_8822B(txdesc) \ -+ GET_TX_DESC_MULTIPLE_PORT(txdesc) -+#define SET_TX_DESC_SIGNALING_TAPKT_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TAPKT_EN(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TAPKT_EN_8822B(txdesc) \ -+ GET_TX_DESC_SIGNALING_TAPKT_EN(txdesc) -+#define SET_TX_DESC_SIGNALING_TA_PKT_SC_8822B(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TA_PKT_SC_8822B(txdesc) \ -+ GET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc) -+#define SET_TX_DESC_RTS_SHORT_8822B(txdesc, value) \ -+ SET_TX_DESC_RTS_SHORT(txdesc, value) -+#define GET_TX_DESC_RTS_SHORT_8822B(txdesc) GET_TX_DESC_RTS_SHORT(txdesc) -+#define SET_TX_DESC_VCS_STBC_8822B(txdesc, value) \ -+ SET_TX_DESC_VCS_STBC(txdesc, value) -+#define GET_TX_DESC_VCS_STBC_8822B(txdesc) GET_TX_DESC_VCS_STBC(txdesc) -+#define SET_TX_DESC_DATA_STBC_8822B(txdesc, value) \ -+ SET_TX_DESC_DATA_STBC(txdesc, value) -+#define GET_TX_DESC_DATA_STBC_8822B(txdesc) GET_TX_DESC_DATA_STBC(txdesc) -+#define SET_TX_DESC_DATA_LDPC_8822B(txdesc, value) \ -+ SET_TX_DESC_DATA_LDPC(txdesc, value) -+#define GET_TX_DESC_DATA_LDPC_8822B(txdesc) GET_TX_DESC_DATA_LDPC(txdesc) -+#define SET_TX_DESC_DATA_BW_8822B(txdesc, value) \ -+ SET_TX_DESC_DATA_BW(txdesc, value) -+#define GET_TX_DESC_DATA_BW_8822B(txdesc) GET_TX_DESC_DATA_BW(txdesc) -+#define SET_TX_DESC_DATA_SHORT_8822B(txdesc, value) \ -+ SET_TX_DESC_DATA_SHORT(txdesc, value) -+#define GET_TX_DESC_DATA_SHORT_8822B(txdesc) GET_TX_DESC_DATA_SHORT(txdesc) -+#define SET_TX_DESC_DATA_SC_8822B(txdesc, value) \ -+ SET_TX_DESC_DATA_SC(txdesc, value) -+#define GET_TX_DESC_DATA_SC_8822B(txdesc) GET_TX_DESC_DATA_SC(txdesc) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANTSEL_D_8822B(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_D(txdesc, value) -+#define GET_TX_DESC_ANTSEL_D_8822B(txdesc) GET_TX_DESC_ANTSEL_D(txdesc) -+#define SET_TX_DESC_ANT_MAPD_8822B(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPD(txdesc, value) -+#define GET_TX_DESC_ANT_MAPD_8822B(txdesc) GET_TX_DESC_ANT_MAPD(txdesc) -+#define SET_TX_DESC_ANT_MAPC_8822B(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPC(txdesc, value) -+#define GET_TX_DESC_ANT_MAPC_8822B(txdesc) GET_TX_DESC_ANT_MAPC(txdesc) -+#define SET_TX_DESC_ANT_MAPB_8822B(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPB(txdesc, value) -+#define GET_TX_DESC_ANT_MAPB_8822B(txdesc) GET_TX_DESC_ANT_MAPB(txdesc) -+#define SET_TX_DESC_ANT_MAPA_8822B(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPA(txdesc, value) -+#define GET_TX_DESC_ANT_MAPA_8822B(txdesc) GET_TX_DESC_ANT_MAPA(txdesc) -+#define SET_TX_DESC_ANTSEL_C_8822B(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_C(txdesc, value) -+#define GET_TX_DESC_ANTSEL_C_8822B(txdesc) GET_TX_DESC_ANTSEL_C(txdesc) -+#define SET_TX_DESC_ANTSEL_B_8822B(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_B(txdesc, value) -+#define GET_TX_DESC_ANTSEL_B_8822B(txdesc) GET_TX_DESC_ANTSEL_B(txdesc) -+#define SET_TX_DESC_ANTSEL_A_8822B(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_A(txdesc, value) -+#define GET_TX_DESC_ANTSEL_A_8822B(txdesc) GET_TX_DESC_ANTSEL_A(txdesc) -+#define SET_TX_DESC_MBSSID_8822B(txdesc, value) \ -+ SET_TX_DESC_MBSSID(txdesc, value) -+#define GET_TX_DESC_MBSSID_8822B(txdesc) GET_TX_DESC_MBSSID(txdesc) -+#define SET_TX_DESC_SW_DEFINE_8822B(txdesc, value) \ -+ SET_TX_DESC_SW_DEFINE(txdesc, value) -+#define GET_TX_DESC_SW_DEFINE_8822B(txdesc) GET_TX_DESC_SW_DEFINE(txdesc) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_8822B(txdesc, value) \ -+ SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_8822B(txdesc) \ -+ GET_TX_DESC_DMA_TXAGG_NUM(txdesc) -+#define SET_TX_DESC_FINAL_DATA_RATE_8822B(txdesc, value) \ -+ SET_TX_DESC_FINAL_DATA_RATE(txdesc, value) -+#define GET_TX_DESC_FINAL_DATA_RATE_8822B(txdesc) \ -+ GET_TX_DESC_FINAL_DATA_RATE(txdesc) -+#define SET_TX_DESC_NTX_MAP_8822B(txdesc, value) \ -+ SET_TX_DESC_NTX_MAP(txdesc, value) -+#define GET_TX_DESC_NTX_MAP_8822B(txdesc) GET_TX_DESC_NTX_MAP(txdesc) -+#define SET_TX_DESC_TX_BUFF_SIZE_8822B(txdesc, value) \ -+ SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) -+#define GET_TX_DESC_TX_BUFF_SIZE_8822B(txdesc) GET_TX_DESC_TX_BUFF_SIZE(txdesc) -+#define SET_TX_DESC_TXDESC_CHECKSUM_8822B(txdesc, value) \ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_8822B(txdesc) \ -+ GET_TX_DESC_TXDESC_CHECKSUM(txdesc) -+#define SET_TX_DESC_TIMESTAMP_8822B(txdesc, value) \ -+ SET_TX_DESC_TIMESTAMP(txdesc, value) -+#define GET_TX_DESC_TIMESTAMP_8822B(txdesc) GET_TX_DESC_TIMESTAMP(txdesc) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TXWIFI_CP_8822B(txdesc, value) \ -+ SET_TX_DESC_TXWIFI_CP(txdesc, value) -+#define GET_TX_DESC_TXWIFI_CP_8822B(txdesc) GET_TX_DESC_TXWIFI_CP(txdesc) -+#define SET_TX_DESC_MAC_CP_8822B(txdesc, value) \ -+ SET_TX_DESC_MAC_CP(txdesc, value) -+#define GET_TX_DESC_MAC_CP_8822B(txdesc) GET_TX_DESC_MAC_CP(txdesc) -+#define SET_TX_DESC_STW_PKTRE_DIS_8822B(txdesc, value) \ -+ SET_TX_DESC_STW_PKTRE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_PKTRE_DIS_8822B(txdesc) \ -+ GET_TX_DESC_STW_PKTRE_DIS(txdesc) -+#define SET_TX_DESC_STW_RB_DIS_8822B(txdesc, value) \ -+ SET_TX_DESC_STW_RB_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RB_DIS_8822B(txdesc) GET_TX_DESC_STW_RB_DIS(txdesc) -+#define SET_TX_DESC_STW_RATE_DIS_8822B(txdesc, value) \ -+ SET_TX_DESC_STW_RATE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RATE_DIS_8822B(txdesc) GET_TX_DESC_STW_RATE_DIS(txdesc) -+#define SET_TX_DESC_STW_ANT_DIS_8822B(txdesc, value) \ -+ SET_TX_DESC_STW_ANT_DIS(txdesc, value) -+#define GET_TX_DESC_STW_ANT_DIS_8822B(txdesc) GET_TX_DESC_STW_ANT_DIS(txdesc) -+#define SET_TX_DESC_STW_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_STW_EN(txdesc, value) -+#define GET_TX_DESC_STW_EN_8822B(txdesc) GET_TX_DESC_STW_EN(txdesc) -+#define SET_TX_DESC_SMH_EN_8822B(txdesc, value) \ -+ SET_TX_DESC_SMH_EN(txdesc, value) -+#define GET_TX_DESC_SMH_EN_8822B(txdesc) GET_TX_DESC_SMH_EN(txdesc) -+#define SET_TX_DESC_TAILPAGE_L_8822B(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_L(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_L_8822B(txdesc) GET_TX_DESC_TAILPAGE_L(txdesc) -+#define SET_TX_DESC_SDIO_DMASEQ_8822B(txdesc, value) \ -+ SET_TX_DESC_SDIO_DMASEQ(txdesc, value) -+#define GET_TX_DESC_SDIO_DMASEQ_8822B(txdesc) GET_TX_DESC_SDIO_DMASEQ(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_L_8822B(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_L_8822B(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_L(txdesc) -+#define SET_TX_DESC_EN_HWSEQ_8822B(txdesc, value) \ -+ SET_TX_DESC_EN_HWSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWSEQ_8822B(txdesc) GET_TX_DESC_EN_HWSEQ(txdesc) -+#define SET_TX_DESC_EN_HWEXSEQ_8822B(txdesc, value) \ -+ SET_TX_DESC_EN_HWEXSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWEXSEQ_8822B(txdesc) GET_TX_DESC_EN_HWEXSEQ(txdesc) -+#define SET_TX_DESC_DATA_RC_8822B(txdesc, value) \ -+ SET_TX_DESC_DATA_RC(txdesc, value) -+#define GET_TX_DESC_DATA_RC_8822B(txdesc) GET_TX_DESC_DATA_RC(txdesc) -+#define SET_TX_DESC_BAR_RTY_TH_8822B(txdesc, value) \ -+ SET_TX_DESC_BAR_RTY_TH(txdesc, value) -+#define GET_TX_DESC_BAR_RTY_TH_8822B(txdesc) GET_TX_DESC_BAR_RTY_TH(txdesc) -+#define SET_TX_DESC_RTS_RC_8822B(txdesc, value) \ -+ SET_TX_DESC_RTS_RC(txdesc, value) -+#define GET_TX_DESC_RTS_RC_8822B(txdesc) GET_TX_DESC_RTS_RC(txdesc) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_TAILPAGE_H_8822B(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_H(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_H_8822B(txdesc) GET_TX_DESC_TAILPAGE_H(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_H_8822B(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_H(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_H_8822B(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_H(txdesc) -+#define SET_TX_DESC_SW_SEQ_8822B(txdesc, value) \ -+ SET_TX_DESC_SW_SEQ(txdesc, value) -+#define GET_TX_DESC_SW_SEQ_8822B(txdesc) GET_TX_DESC_SW_SEQ(txdesc) -+#define SET_TX_DESC_TXBF_PATH_8822B(txdesc, value) \ -+ SET_TX_DESC_TXBF_PATH(txdesc, value) -+#define GET_TX_DESC_TXBF_PATH_8822B(txdesc) GET_TX_DESC_TXBF_PATH(txdesc) -+#define SET_TX_DESC_PADDING_LEN_8822B(txdesc, value) \ -+ SET_TX_DESC_PADDING_LEN(txdesc, value) -+#define GET_TX_DESC_PADDING_LEN_8822B(txdesc) GET_TX_DESC_PADDING_LEN(txdesc) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET_8822B(txdesc, value) \ -+ SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET_8822B(txdesc) \ -+ GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) -+ -+/*WORD10*/ -+ -+#define SET_TX_DESC_MU_DATARATE_8822B(txdesc, value) \ -+ SET_TX_DESC_MU_DATARATE(txdesc, value) -+#define GET_TX_DESC_MU_DATARATE_8822B(txdesc) GET_TX_DESC_MU_DATARATE(txdesc) -+#define SET_TX_DESC_MU_RC_8822B(txdesc, value) SET_TX_DESC_MU_RC(txdesc, value) -+#define GET_TX_DESC_MU_RC_8822B(txdesc) GET_TX_DESC_MU_RC(txdesc) -+#define SET_TX_DESC_SND_PKT_SEL_8822B(txdesc, value) \ -+ SET_TX_DESC_SND_PKT_SEL(txdesc, value) -+#define GET_TX_DESC_SND_PKT_SEL_8822B(txdesc) GET_TX_DESC_SND_PKT_SEL(txdesc) -+ -+#endif -+ -+#if (HALMAC_8197F_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_DISQSELSEQ_8197F(txdesc, value) \ -+ SET_TX_DESC_DISQSELSEQ(txdesc, value) -+#define GET_TX_DESC_DISQSELSEQ_8197F(txdesc) GET_TX_DESC_DISQSELSEQ(txdesc) -+#define SET_TX_DESC_GF_8197F(txdesc, value) SET_TX_DESC_GF(txdesc, value) -+#define GET_TX_DESC_GF_8197F(txdesc) GET_TX_DESC_GF(txdesc) -+#define SET_TX_DESC_NO_ACM_8197F(txdesc, value) \ -+ SET_TX_DESC_NO_ACM(txdesc, value) -+#define GET_TX_DESC_NO_ACM_8197F(txdesc) GET_TX_DESC_NO_ACM(txdesc) -+#define SET_TX_DESC_BCNPKT_TSF_CTRL_8197F(txdesc, value) \ -+ SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc, value) -+#define GET_TX_DESC_BCNPKT_TSF_CTRL_8197F(txdesc) \ -+ GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc) -+#define SET_TX_DESC_AMSDU_PAD_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) -+#define GET_TX_DESC_AMSDU_PAD_EN_8197F(txdesc) GET_TX_DESC_AMSDU_PAD_EN(txdesc) -+#define SET_TX_DESC_LS_8197F(txdesc, value) SET_TX_DESC_LS(txdesc, value) -+#define GET_TX_DESC_LS_8197F(txdesc) GET_TX_DESC_LS(txdesc) -+#define SET_TX_DESC_HTC_8197F(txdesc, value) SET_TX_DESC_HTC(txdesc, value) -+#define GET_TX_DESC_HTC_8197F(txdesc) GET_TX_DESC_HTC(txdesc) -+#define SET_TX_DESC_BMC_8197F(txdesc, value) SET_TX_DESC_BMC(txdesc, value) -+#define GET_TX_DESC_BMC_8197F(txdesc) GET_TX_DESC_BMC(txdesc) -+#define SET_TX_DESC_OFFSET_8197F(txdesc, value) \ -+ SET_TX_DESC_OFFSET(txdesc, value) -+#define GET_TX_DESC_OFFSET_8197F(txdesc) GET_TX_DESC_OFFSET(txdesc) -+#define SET_TX_DESC_TXPKTSIZE_8197F(txdesc, value) \ -+ SET_TX_DESC_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_TXPKTSIZE_8197F(txdesc) GET_TX_DESC_TXPKTSIZE(txdesc) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_MOREDATA_8197F(txdesc, value) \ -+ SET_TX_DESC_MOREDATA(txdesc, value) -+#define GET_TX_DESC_MOREDATA_8197F(txdesc) GET_TX_DESC_MOREDATA(txdesc) -+#define SET_TX_DESC_PKT_OFFSET_8197F(txdesc, value) \ -+ SET_TX_DESC_PKT_OFFSET(txdesc, value) -+#define GET_TX_DESC_PKT_OFFSET_8197F(txdesc) GET_TX_DESC_PKT_OFFSET(txdesc) -+#define SET_TX_DESC_SEC_TYPE_8197F(txdesc, value) \ -+ SET_TX_DESC_SEC_TYPE(txdesc, value) -+#define GET_TX_DESC_SEC_TYPE_8197F(txdesc) GET_TX_DESC_SEC_TYPE(txdesc) -+#define SET_TX_DESC_EN_DESC_ID_8197F(txdesc, value) \ -+ SET_TX_DESC_EN_DESC_ID(txdesc, value) -+#define GET_TX_DESC_EN_DESC_ID_8197F(txdesc) GET_TX_DESC_EN_DESC_ID(txdesc) -+#define SET_TX_DESC_RATE_ID_8197F(txdesc, value) \ -+ SET_TX_DESC_RATE_ID(txdesc, value) -+#define GET_TX_DESC_RATE_ID_8197F(txdesc) GET_TX_DESC_RATE_ID(txdesc) -+#define SET_TX_DESC_PIFS_8197F(txdesc, value) SET_TX_DESC_PIFS(txdesc, value) -+#define GET_TX_DESC_PIFS_8197F(txdesc) GET_TX_DESC_PIFS(txdesc) -+#define SET_TX_DESC_LSIG_TXOP_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) -+#define GET_TX_DESC_LSIG_TXOP_EN_8197F(txdesc) GET_TX_DESC_LSIG_TXOP_EN(txdesc) -+#define SET_TX_DESC_RD_NAV_EXT_8197F(txdesc, value) \ -+ SET_TX_DESC_RD_NAV_EXT(txdesc, value) -+#define GET_TX_DESC_RD_NAV_EXT_8197F(txdesc) GET_TX_DESC_RD_NAV_EXT(txdesc) -+#define SET_TX_DESC_QSEL_8197F(txdesc, value) SET_TX_DESC_QSEL(txdesc, value) -+#define GET_TX_DESC_QSEL_8197F(txdesc) GET_TX_DESC_QSEL(txdesc) -+#define SET_TX_DESC_MACID_8197F(txdesc, value) SET_TX_DESC_MACID(txdesc, value) -+#define GET_TX_DESC_MACID_8197F(txdesc) GET_TX_DESC_MACID(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_HW_AES_IV_8197F(txdesc, value) \ -+ SET_TX_DESC_HW_AES_IV(txdesc, value) -+#define GET_TX_DESC_HW_AES_IV_8197F(txdesc) GET_TX_DESC_HW_AES_IV(txdesc) -+#define SET_TX_DESC_FTM_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_FTM_EN(txdesc, value) -+#define GET_TX_DESC_FTM_EN_8197F(txdesc) GET_TX_DESC_FTM_EN(txdesc) -+#define SET_TX_DESC_G_ID_8197F(txdesc, value) SET_TX_DESC_G_ID(txdesc, value) -+#define GET_TX_DESC_G_ID_8197F(txdesc) GET_TX_DESC_G_ID(txdesc) -+#define SET_TX_DESC_BT_NULL_8197F(txdesc, value) \ -+ SET_TX_DESC_BT_NULL(txdesc, value) -+#define GET_TX_DESC_BT_NULL_8197F(txdesc) GET_TX_DESC_BT_NULL(txdesc) -+#define SET_TX_DESC_AMPDU_DENSITY_8197F(txdesc, value) \ -+ SET_TX_DESC_AMPDU_DENSITY(txdesc, value) -+#define GET_TX_DESC_AMPDU_DENSITY_8197F(txdesc) \ -+ GET_TX_DESC_AMPDU_DENSITY(txdesc) -+#define SET_TX_DESC_SPE_RPT_8197F(txdesc, value) \ -+ SET_TX_DESC_SPE_RPT(txdesc, value) -+#define GET_TX_DESC_SPE_RPT_8197F(txdesc) GET_TX_DESC_SPE_RPT(txdesc) -+#define SET_TX_DESC_RAW_8197F(txdesc, value) SET_TX_DESC_RAW(txdesc, value) -+#define GET_TX_DESC_RAW_8197F(txdesc) GET_TX_DESC_RAW(txdesc) -+#define SET_TX_DESC_MOREFRAG_8197F(txdesc, value) \ -+ SET_TX_DESC_MOREFRAG(txdesc, value) -+#define GET_TX_DESC_MOREFRAG_8197F(txdesc) GET_TX_DESC_MOREFRAG(txdesc) -+#define SET_TX_DESC_BK_8197F(txdesc, value) SET_TX_DESC_BK(txdesc, value) -+#define GET_TX_DESC_BK_8197F(txdesc) GET_TX_DESC_BK(txdesc) -+#define SET_TX_DESC_NULL_1_8197F(txdesc, value) \ -+ SET_TX_DESC_NULL_1(txdesc, value) -+#define GET_TX_DESC_NULL_1_8197F(txdesc) GET_TX_DESC_NULL_1(txdesc) -+#define SET_TX_DESC_NULL_0_8197F(txdesc, value) \ -+ SET_TX_DESC_NULL_0(txdesc, value) -+#define GET_TX_DESC_NULL_0_8197F(txdesc) GET_TX_DESC_NULL_0(txdesc) -+#define SET_TX_DESC_RDG_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_RDG_EN(txdesc, value) -+#define GET_TX_DESC_RDG_EN_8197F(txdesc) GET_TX_DESC_RDG_EN(txdesc) -+#define SET_TX_DESC_AGG_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_AGG_EN(txdesc, value) -+#define GET_TX_DESC_AGG_EN_8197F(txdesc) GET_TX_DESC_AGG_EN(txdesc) -+#define SET_TX_DESC_CCA_RTS_8197F(txdesc, value) \ -+ SET_TX_DESC_CCA_RTS(txdesc, value) -+#define GET_TX_DESC_CCA_RTS_8197F(txdesc) GET_TX_DESC_CCA_RTS(txdesc) -+#define SET_TX_DESC_TRI_FRAME_8197F(txdesc, value) \ -+ SET_TX_DESC_TRI_FRAME(txdesc, value) -+#define GET_TX_DESC_TRI_FRAME_8197F(txdesc) GET_TX_DESC_TRI_FRAME(txdesc) -+#define SET_TX_DESC_P_AID_8197F(txdesc, value) SET_TX_DESC_P_AID(txdesc, value) -+#define GET_TX_DESC_P_AID_8197F(txdesc) GET_TX_DESC_P_AID(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME_8197F(txdesc, value) \ -+ SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) -+#define GET_TX_DESC_AMPDU_MAX_TIME_8197F(txdesc) \ -+ GET_TX_DESC_AMPDU_MAX_TIME(txdesc) -+#define SET_TX_DESC_NDPA_8197F(txdesc, value) SET_TX_DESC_NDPA(txdesc, value) -+#define GET_TX_DESC_NDPA_8197F(txdesc) GET_TX_DESC_NDPA(txdesc) -+#define SET_TX_DESC_MAX_AGG_NUM_8197F(txdesc, value) \ -+ SET_TX_DESC_MAX_AGG_NUM(txdesc, value) -+#define GET_TX_DESC_MAX_AGG_NUM_8197F(txdesc) GET_TX_DESC_MAX_AGG_NUM(txdesc) -+#define SET_TX_DESC_USE_MAX_TIME_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) -+#define GET_TX_DESC_USE_MAX_TIME_EN_8197F(txdesc) \ -+ GET_TX_DESC_USE_MAX_TIME_EN(txdesc) -+#define SET_TX_DESC_NAVUSEHDR_8197F(txdesc, value) \ -+ SET_TX_DESC_NAVUSEHDR(txdesc, value) -+#define GET_TX_DESC_NAVUSEHDR_8197F(txdesc) GET_TX_DESC_NAVUSEHDR(txdesc) -+#define SET_TX_DESC_CHK_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_CHK_EN(txdesc, value) -+#define GET_TX_DESC_CHK_EN_8197F(txdesc) GET_TX_DESC_CHK_EN(txdesc) -+#define SET_TX_DESC_HW_RTS_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_HW_RTS_EN(txdesc, value) -+#define GET_TX_DESC_HW_RTS_EN_8197F(txdesc) GET_TX_DESC_HW_RTS_EN(txdesc) -+#define SET_TX_DESC_RTSEN_8197F(txdesc, value) SET_TX_DESC_RTSEN(txdesc, value) -+#define GET_TX_DESC_RTSEN_8197F(txdesc) GET_TX_DESC_RTSEN(txdesc) -+#define SET_TX_DESC_CTS2SELF_8197F(txdesc, value) \ -+ SET_TX_DESC_CTS2SELF(txdesc, value) -+#define GET_TX_DESC_CTS2SELF_8197F(txdesc) GET_TX_DESC_CTS2SELF(txdesc) -+#define SET_TX_DESC_DISDATAFB_8197F(txdesc, value) \ -+ SET_TX_DESC_DISDATAFB(txdesc, value) -+#define GET_TX_DESC_DISDATAFB_8197F(txdesc) GET_TX_DESC_DISDATAFB(txdesc) -+#define SET_TX_DESC_DISRTSFB_8197F(txdesc, value) \ -+ SET_TX_DESC_DISRTSFB(txdesc, value) -+#define GET_TX_DESC_DISRTSFB_8197F(txdesc) GET_TX_DESC_DISRTSFB(txdesc) -+#define SET_TX_DESC_USE_RATE_8197F(txdesc, value) \ -+ SET_TX_DESC_USE_RATE(txdesc, value) -+#define GET_TX_DESC_USE_RATE_8197F(txdesc) GET_TX_DESC_USE_RATE(txdesc) -+#define SET_TX_DESC_HW_SSN_SEL_8197F(txdesc, value) \ -+ SET_TX_DESC_HW_SSN_SEL(txdesc, value) -+#define GET_TX_DESC_HW_SSN_SEL_8197F(txdesc) GET_TX_DESC_HW_SSN_SEL(txdesc) -+#define SET_TX_DESC_WHEADER_LEN_8197F(txdesc, value) \ -+ SET_TX_DESC_WHEADER_LEN(txdesc, value) -+#define GET_TX_DESC_WHEADER_LEN_8197F(txdesc) GET_TX_DESC_WHEADER_LEN(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX_8197F(txdesc, value) \ -+ SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) -+#define GET_TX_DESC_PCTS_MASK_IDX_8197F(txdesc) \ -+ GET_TX_DESC_PCTS_MASK_IDX(txdesc) -+#define SET_TX_DESC_PCTS_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_PCTS_EN(txdesc, value) -+#define GET_TX_DESC_PCTS_EN_8197F(txdesc) GET_TX_DESC_PCTS_EN(txdesc) -+#define SET_TX_DESC_RTSRATE_8197F(txdesc, value) \ -+ SET_TX_DESC_RTSRATE(txdesc, value) -+#define GET_TX_DESC_RTSRATE_8197F(txdesc) GET_TX_DESC_RTSRATE(txdesc) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT_8197F(txdesc, value) \ -+ SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT_8197F(txdesc) \ -+ GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) -+#define SET_TX_DESC_RTY_LMT_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_RTY_LMT_EN(txdesc, value) -+#define GET_TX_DESC_RTY_LMT_EN_8197F(txdesc) GET_TX_DESC_RTY_LMT_EN(txdesc) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE_8197F(txdesc, value) \ -+ SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE_8197F(txdesc) \ -+ GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE_8197F(txdesc, value) \ -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE_8197F(txdesc) \ -+ GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_TRY_RATE_8197F(txdesc, value) \ -+ SET_TX_DESC_TRY_RATE(txdesc, value) -+#define GET_TX_DESC_TRY_RATE_8197F(txdesc) GET_TX_DESC_TRY_RATE(txdesc) -+#define SET_TX_DESC_DATARATE_8197F(txdesc, value) \ -+ SET_TX_DESC_DATARATE(txdesc, value) -+#define GET_TX_DESC_DATARATE_8197F(txdesc) GET_TX_DESC_DATARATE(txdesc) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED_8197F(txdesc, value) \ -+ SET_TX_DESC_POLLUTED(txdesc, value) -+#define GET_TX_DESC_POLLUTED_8197F(txdesc) GET_TX_DESC_POLLUTED(txdesc) -+#define SET_TX_DESC_TXPWR_OFSET_8197F(txdesc, value) \ -+ SET_TX_DESC_TXPWR_OFSET(txdesc, value) -+#define GET_TX_DESC_TXPWR_OFSET_8197F(txdesc) GET_TX_DESC_TXPWR_OFSET(txdesc) -+#define SET_TX_DESC_TX_ANT_8197F(txdesc, value) \ -+ SET_TX_DESC_TX_ANT(txdesc, value) -+#define GET_TX_DESC_TX_ANT_8197F(txdesc) GET_TX_DESC_TX_ANT(txdesc) -+#define SET_TX_DESC_PORT_ID_8197F(txdesc, value) \ -+ SET_TX_DESC_PORT_ID(txdesc, value) -+#define GET_TX_DESC_PORT_ID_8197F(txdesc) GET_TX_DESC_PORT_ID(txdesc) -+#define SET_TX_DESC_MULTIPLE_PORT_8197F(txdesc, value) \ -+ SET_TX_DESC_MULTIPLE_PORT(txdesc, value) -+#define GET_TX_DESC_MULTIPLE_PORT_8197F(txdesc) \ -+ GET_TX_DESC_MULTIPLE_PORT(txdesc) -+#define SET_TX_DESC_SIGNALING_TAPKT_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TAPKT_EN(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TAPKT_EN_8197F(txdesc) \ -+ GET_TX_DESC_SIGNALING_TAPKT_EN(txdesc) -+#define SET_TX_DESC_RTS_SC_8197F(txdesc, value) \ -+ SET_TX_DESC_RTS_SC(txdesc, value) -+#define GET_TX_DESC_RTS_SC_8197F(txdesc) GET_TX_DESC_RTS_SC(txdesc) -+#define SET_TX_DESC_RTS_SHORT_8197F(txdesc, value) \ -+ SET_TX_DESC_RTS_SHORT(txdesc, value) -+#define GET_TX_DESC_RTS_SHORT_8197F(txdesc) GET_TX_DESC_RTS_SHORT(txdesc) -+#define SET_TX_DESC_VCS_STBC_8197F(txdesc, value) \ -+ SET_TX_DESC_VCS_STBC(txdesc, value) -+#define GET_TX_DESC_VCS_STBC_8197F(txdesc) GET_TX_DESC_VCS_STBC(txdesc) -+#define SET_TX_DESC_DATA_STBC_8197F(txdesc, value) \ -+ SET_TX_DESC_DATA_STBC(txdesc, value) -+#define GET_TX_DESC_DATA_STBC_8197F(txdesc) GET_TX_DESC_DATA_STBC(txdesc) -+#define SET_TX_DESC_DATA_LDPC_8197F(txdesc, value) \ -+ SET_TX_DESC_DATA_LDPC(txdesc, value) -+#define GET_TX_DESC_DATA_LDPC_8197F(txdesc) GET_TX_DESC_DATA_LDPC(txdesc) -+#define SET_TX_DESC_DATA_BW_8197F(txdesc, value) \ -+ SET_TX_DESC_DATA_BW(txdesc, value) -+#define GET_TX_DESC_DATA_BW_8197F(txdesc) GET_TX_DESC_DATA_BW(txdesc) -+#define SET_TX_DESC_DATA_SHORT_8197F(txdesc, value) \ -+ SET_TX_DESC_DATA_SHORT(txdesc, value) -+#define GET_TX_DESC_DATA_SHORT_8197F(txdesc) GET_TX_DESC_DATA_SHORT(txdesc) -+#define SET_TX_DESC_DATA_SC_8197F(txdesc, value) \ -+ SET_TX_DESC_DATA_SC(txdesc, value) -+#define GET_TX_DESC_DATA_SC_8197F(txdesc) GET_TX_DESC_DATA_SC(txdesc) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANTSEL_D_8197F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_D(txdesc, value) -+#define GET_TX_DESC_ANTSEL_D_8197F(txdesc) GET_TX_DESC_ANTSEL_D(txdesc) -+#define SET_TX_DESC_ANT_MAPD_8197F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPD(txdesc, value) -+#define GET_TX_DESC_ANT_MAPD_8197F(txdesc) GET_TX_DESC_ANT_MAPD(txdesc) -+#define SET_TX_DESC_ANT_MAPC_8197F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPC(txdesc, value) -+#define GET_TX_DESC_ANT_MAPC_8197F(txdesc) GET_TX_DESC_ANT_MAPC(txdesc) -+#define SET_TX_DESC_ANT_MAPB_8197F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPB(txdesc, value) -+#define GET_TX_DESC_ANT_MAPB_8197F(txdesc) GET_TX_DESC_ANT_MAPB(txdesc) -+#define SET_TX_DESC_ANT_MAPA_8197F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPA(txdesc, value) -+#define GET_TX_DESC_ANT_MAPA_8197F(txdesc) GET_TX_DESC_ANT_MAPA(txdesc) -+#define SET_TX_DESC_ANTSEL_C_8197F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_C(txdesc, value) -+#define GET_TX_DESC_ANTSEL_C_8197F(txdesc) GET_TX_DESC_ANTSEL_C(txdesc) -+#define SET_TX_DESC_ANTSEL_B_8197F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_B(txdesc, value) -+#define GET_TX_DESC_ANTSEL_B_8197F(txdesc) GET_TX_DESC_ANTSEL_B(txdesc) -+#define SET_TX_DESC_ANTSEL_A_8197F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_A(txdesc, value) -+#define GET_TX_DESC_ANTSEL_A_8197F(txdesc) GET_TX_DESC_ANTSEL_A(txdesc) -+#define SET_TX_DESC_MBSSID_8197F(txdesc, value) \ -+ SET_TX_DESC_MBSSID(txdesc, value) -+#define GET_TX_DESC_MBSSID_8197F(txdesc) GET_TX_DESC_MBSSID(txdesc) -+#define SET_TX_DESC_SW_DEFINE_8197F(txdesc, value) \ -+ SET_TX_DESC_SW_DEFINE(txdesc, value) -+#define GET_TX_DESC_SW_DEFINE_8197F(txdesc) GET_TX_DESC_SW_DEFINE(txdesc) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_8197F(txdesc, value) \ -+ SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_8197F(txdesc) \ -+ GET_TX_DESC_DMA_TXAGG_NUM(txdesc) -+#define SET_TX_DESC_FINAL_DATA_RATE_8197F(txdesc, value) \ -+ SET_TX_DESC_FINAL_DATA_RATE(txdesc, value) -+#define GET_TX_DESC_FINAL_DATA_RATE_8197F(txdesc) \ -+ GET_TX_DESC_FINAL_DATA_RATE(txdesc) -+#define SET_TX_DESC_NTX_MAP_8197F(txdesc, value) \ -+ SET_TX_DESC_NTX_MAP(txdesc, value) -+#define GET_TX_DESC_NTX_MAP_8197F(txdesc) GET_TX_DESC_NTX_MAP(txdesc) -+#define SET_TX_DESC_TX_BUFF_SIZE_8197F(txdesc, value) \ -+ SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) -+#define GET_TX_DESC_TX_BUFF_SIZE_8197F(txdesc) GET_TX_DESC_TX_BUFF_SIZE(txdesc) -+#define SET_TX_DESC_TXDESC_CHECKSUM_8197F(txdesc, value) \ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_8197F(txdesc) \ -+ GET_TX_DESC_TXDESC_CHECKSUM(txdesc) -+#define SET_TX_DESC_TIMESTAMP_8197F(txdesc, value) \ -+ SET_TX_DESC_TIMESTAMP(txdesc, value) -+#define GET_TX_DESC_TIMESTAMP_8197F(txdesc) GET_TX_DESC_TIMESTAMP(txdesc) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TXWIFI_CP_8197F(txdesc, value) \ -+ SET_TX_DESC_TXWIFI_CP(txdesc, value) -+#define GET_TX_DESC_TXWIFI_CP_8197F(txdesc) GET_TX_DESC_TXWIFI_CP(txdesc) -+#define SET_TX_DESC_MAC_CP_8197F(txdesc, value) \ -+ SET_TX_DESC_MAC_CP(txdesc, value) -+#define GET_TX_DESC_MAC_CP_8197F(txdesc) GET_TX_DESC_MAC_CP(txdesc) -+#define SET_TX_DESC_STW_PKTRE_DIS_8197F(txdesc, value) \ -+ SET_TX_DESC_STW_PKTRE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_PKTRE_DIS_8197F(txdesc) \ -+ GET_TX_DESC_STW_PKTRE_DIS(txdesc) -+#define SET_TX_DESC_STW_RB_DIS_8197F(txdesc, value) \ -+ SET_TX_DESC_STW_RB_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RB_DIS_8197F(txdesc) GET_TX_DESC_STW_RB_DIS(txdesc) -+#define SET_TX_DESC_STW_RATE_DIS_8197F(txdesc, value) \ -+ SET_TX_DESC_STW_RATE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RATE_DIS_8197F(txdesc) GET_TX_DESC_STW_RATE_DIS(txdesc) -+#define SET_TX_DESC_STW_ANT_DIS_8197F(txdesc, value) \ -+ SET_TX_DESC_STW_ANT_DIS(txdesc, value) -+#define GET_TX_DESC_STW_ANT_DIS_8197F(txdesc) GET_TX_DESC_STW_ANT_DIS(txdesc) -+#define SET_TX_DESC_STW_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_STW_EN(txdesc, value) -+#define GET_TX_DESC_STW_EN_8197F(txdesc) GET_TX_DESC_STW_EN(txdesc) -+#define SET_TX_DESC_SMH_EN_8197F(txdesc, value) \ -+ SET_TX_DESC_SMH_EN(txdesc, value) -+#define GET_TX_DESC_SMH_EN_8197F(txdesc) GET_TX_DESC_SMH_EN(txdesc) -+#define SET_TX_DESC_TAILPAGE_L_8197F(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_L(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_L_8197F(txdesc) GET_TX_DESC_TAILPAGE_L(txdesc) -+#define SET_TX_DESC_SDIO_DMASEQ_8197F(txdesc, value) \ -+ SET_TX_DESC_SDIO_DMASEQ(txdesc, value) -+#define GET_TX_DESC_SDIO_DMASEQ_8197F(txdesc) GET_TX_DESC_SDIO_DMASEQ(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_L_8197F(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_L_8197F(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_L(txdesc) -+#define SET_TX_DESC_EN_HWSEQ_8197F(txdesc, value) \ -+ SET_TX_DESC_EN_HWSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWSEQ_8197F(txdesc) GET_TX_DESC_EN_HWSEQ(txdesc) -+#define SET_TX_DESC_EN_HWEXSEQ_8197F(txdesc, value) \ -+ SET_TX_DESC_EN_HWEXSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWEXSEQ_8197F(txdesc) GET_TX_DESC_EN_HWEXSEQ(txdesc) -+#define SET_TX_DESC_DATA_RC_8197F(txdesc, value) \ -+ SET_TX_DESC_DATA_RC(txdesc, value) -+#define GET_TX_DESC_DATA_RC_8197F(txdesc) GET_TX_DESC_DATA_RC(txdesc) -+#define SET_TX_DESC_BAR_RTY_TH_8197F(txdesc, value) \ -+ SET_TX_DESC_BAR_RTY_TH(txdesc, value) -+#define GET_TX_DESC_BAR_RTY_TH_8197F(txdesc) GET_TX_DESC_BAR_RTY_TH(txdesc) -+#define SET_TX_DESC_RTS_RC_8197F(txdesc, value) \ -+ SET_TX_DESC_RTS_RC(txdesc, value) -+#define GET_TX_DESC_RTS_RC_8197F(txdesc) GET_TX_DESC_RTS_RC(txdesc) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_TAILPAGE_H_8197F(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_H(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_H_8197F(txdesc) GET_TX_DESC_TAILPAGE_H(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_H_8197F(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_H(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_H_8197F(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_H(txdesc) -+#define SET_TX_DESC_SW_SEQ_8197F(txdesc, value) \ -+ SET_TX_DESC_SW_SEQ(txdesc, value) -+#define GET_TX_DESC_SW_SEQ_8197F(txdesc) GET_TX_DESC_SW_SEQ(txdesc) -+#define SET_TX_DESC_TXBF_PATH_8197F(txdesc, value) \ -+ SET_TX_DESC_TXBF_PATH(txdesc, value) -+#define GET_TX_DESC_TXBF_PATH_8197F(txdesc) GET_TX_DESC_TXBF_PATH(txdesc) -+#define SET_TX_DESC_PADDING_LEN_8197F(txdesc, value) \ -+ SET_TX_DESC_PADDING_LEN(txdesc, value) -+#define GET_TX_DESC_PADDING_LEN_8197F(txdesc) GET_TX_DESC_PADDING_LEN(txdesc) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET_8197F(txdesc, value) \ -+ SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET_8197F(txdesc) \ -+ GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) -+ -+/*WORD10*/ -+ -+#endif -+ -+#if (HALMAC_8821C_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_DISQSELSEQ_8821C(txdesc, value) \ -+ SET_TX_DESC_DISQSELSEQ(txdesc, value) -+#define GET_TX_DESC_DISQSELSEQ_8821C(txdesc) GET_TX_DESC_DISQSELSEQ(txdesc) -+#define SET_TX_DESC_GF_8821C(txdesc, value) SET_TX_DESC_GF(txdesc, value) -+#define GET_TX_DESC_GF_8821C(txdesc) GET_TX_DESC_GF(txdesc) -+#define SET_TX_DESC_NO_ACM_8821C(txdesc, value) \ -+ SET_TX_DESC_NO_ACM(txdesc, value) -+#define GET_TX_DESC_NO_ACM_8821C(txdesc) GET_TX_DESC_NO_ACM(txdesc) -+#define SET_TX_DESC_BCNPKT_TSF_CTRL_8821C(txdesc, value) \ -+ SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc, value) -+#define GET_TX_DESC_BCNPKT_TSF_CTRL_8821C(txdesc) \ -+ GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc) -+#define SET_TX_DESC_AMSDU_PAD_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) -+#define GET_TX_DESC_AMSDU_PAD_EN_8821C(txdesc) GET_TX_DESC_AMSDU_PAD_EN(txdesc) -+#define SET_TX_DESC_LS_8821C(txdesc, value) SET_TX_DESC_LS(txdesc, value) -+#define GET_TX_DESC_LS_8821C(txdesc) GET_TX_DESC_LS(txdesc) -+#define SET_TX_DESC_HTC_8821C(txdesc, value) SET_TX_DESC_HTC(txdesc, value) -+#define GET_TX_DESC_HTC_8821C(txdesc) GET_TX_DESC_HTC(txdesc) -+#define SET_TX_DESC_BMC_8821C(txdesc, value) SET_TX_DESC_BMC(txdesc, value) -+#define GET_TX_DESC_BMC_8821C(txdesc) GET_TX_DESC_BMC(txdesc) -+#define SET_TX_DESC_OFFSET_8821C(txdesc, value) \ -+ SET_TX_DESC_OFFSET(txdesc, value) -+#define GET_TX_DESC_OFFSET_8821C(txdesc) GET_TX_DESC_OFFSET(txdesc) -+#define SET_TX_DESC_TXPKTSIZE_8821C(txdesc, value) \ -+ SET_TX_DESC_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_TXPKTSIZE_8821C(txdesc) GET_TX_DESC_TXPKTSIZE(txdesc) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_MOREDATA_8821C(txdesc, value) \ -+ SET_TX_DESC_MOREDATA(txdesc, value) -+#define GET_TX_DESC_MOREDATA_8821C(txdesc) GET_TX_DESC_MOREDATA(txdesc) -+#define SET_TX_DESC_PKT_OFFSET_8821C(txdesc, value) \ -+ SET_TX_DESC_PKT_OFFSET(txdesc, value) -+#define GET_TX_DESC_PKT_OFFSET_8821C(txdesc) GET_TX_DESC_PKT_OFFSET(txdesc) -+#define SET_TX_DESC_SEC_TYPE_8821C(txdesc, value) \ -+ SET_TX_DESC_SEC_TYPE(txdesc, value) -+#define GET_TX_DESC_SEC_TYPE_8821C(txdesc) GET_TX_DESC_SEC_TYPE(txdesc) -+#define SET_TX_DESC_EN_DESC_ID_8821C(txdesc, value) \ -+ SET_TX_DESC_EN_DESC_ID(txdesc, value) -+#define GET_TX_DESC_EN_DESC_ID_8821C(txdesc) GET_TX_DESC_EN_DESC_ID(txdesc) -+#define SET_TX_DESC_RATE_ID_8821C(txdesc, value) \ -+ SET_TX_DESC_RATE_ID(txdesc, value) -+#define GET_TX_DESC_RATE_ID_8821C(txdesc) GET_TX_DESC_RATE_ID(txdesc) -+#define SET_TX_DESC_PIFS_8821C(txdesc, value) SET_TX_DESC_PIFS(txdesc, value) -+#define GET_TX_DESC_PIFS_8821C(txdesc) GET_TX_DESC_PIFS(txdesc) -+#define SET_TX_DESC_LSIG_TXOP_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) -+#define GET_TX_DESC_LSIG_TXOP_EN_8821C(txdesc) GET_TX_DESC_LSIG_TXOP_EN(txdesc) -+#define SET_TX_DESC_RD_NAV_EXT_8821C(txdesc, value) \ -+ SET_TX_DESC_RD_NAV_EXT(txdesc, value) -+#define GET_TX_DESC_RD_NAV_EXT_8821C(txdesc) GET_TX_DESC_RD_NAV_EXT(txdesc) -+#define SET_TX_DESC_QSEL_8821C(txdesc, value) SET_TX_DESC_QSEL(txdesc, value) -+#define GET_TX_DESC_QSEL_8821C(txdesc) GET_TX_DESC_QSEL(txdesc) -+#define SET_TX_DESC_MACID_8821C(txdesc, value) SET_TX_DESC_MACID(txdesc, value) -+#define GET_TX_DESC_MACID_8821C(txdesc) GET_TX_DESC_MACID(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_HW_AES_IV_8821C(txdesc, value) \ -+ SET_TX_DESC_HW_AES_IV(txdesc, value) -+#define GET_TX_DESC_HW_AES_IV_8821C(txdesc) GET_TX_DESC_HW_AES_IV(txdesc) -+#define SET_TX_DESC_FTM_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_FTM_EN(txdesc, value) -+#define GET_TX_DESC_FTM_EN_8821C(txdesc) GET_TX_DESC_FTM_EN(txdesc) -+#define SET_TX_DESC_G_ID_8821C(txdesc, value) SET_TX_DESC_G_ID(txdesc, value) -+#define GET_TX_DESC_G_ID_8821C(txdesc) GET_TX_DESC_G_ID(txdesc) -+#define SET_TX_DESC_BT_NULL_8821C(txdesc, value) \ -+ SET_TX_DESC_BT_NULL(txdesc, value) -+#define GET_TX_DESC_BT_NULL_8821C(txdesc) GET_TX_DESC_BT_NULL(txdesc) -+#define SET_TX_DESC_AMPDU_DENSITY_8821C(txdesc, value) \ -+ SET_TX_DESC_AMPDU_DENSITY(txdesc, value) -+#define GET_TX_DESC_AMPDU_DENSITY_8821C(txdesc) \ -+ GET_TX_DESC_AMPDU_DENSITY(txdesc) -+#define SET_TX_DESC_SPE_RPT_8821C(txdesc, value) \ -+ SET_TX_DESC_SPE_RPT(txdesc, value) -+#define GET_TX_DESC_SPE_RPT_8821C(txdesc) GET_TX_DESC_SPE_RPT(txdesc) -+#define SET_TX_DESC_RAW_8821C(txdesc, value) SET_TX_DESC_RAW(txdesc, value) -+#define GET_TX_DESC_RAW_8821C(txdesc) GET_TX_DESC_RAW(txdesc) -+#define SET_TX_DESC_MOREFRAG_8821C(txdesc, value) \ -+ SET_TX_DESC_MOREFRAG(txdesc, value) -+#define GET_TX_DESC_MOREFRAG_8821C(txdesc) GET_TX_DESC_MOREFRAG(txdesc) -+#define SET_TX_DESC_BK_8821C(txdesc, value) SET_TX_DESC_BK(txdesc, value) -+#define GET_TX_DESC_BK_8821C(txdesc) GET_TX_DESC_BK(txdesc) -+#define SET_TX_DESC_NULL_1_8821C(txdesc, value) \ -+ SET_TX_DESC_NULL_1(txdesc, value) -+#define GET_TX_DESC_NULL_1_8821C(txdesc) GET_TX_DESC_NULL_1(txdesc) -+#define SET_TX_DESC_NULL_0_8821C(txdesc, value) \ -+ SET_TX_DESC_NULL_0(txdesc, value) -+#define GET_TX_DESC_NULL_0_8821C(txdesc) GET_TX_DESC_NULL_0(txdesc) -+#define SET_TX_DESC_RDG_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_RDG_EN(txdesc, value) -+#define GET_TX_DESC_RDG_EN_8821C(txdesc) GET_TX_DESC_RDG_EN(txdesc) -+#define SET_TX_DESC_AGG_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_AGG_EN(txdesc, value) -+#define GET_TX_DESC_AGG_EN_8821C(txdesc) GET_TX_DESC_AGG_EN(txdesc) -+#define SET_TX_DESC_CCA_RTS_8821C(txdesc, value) \ -+ SET_TX_DESC_CCA_RTS(txdesc, value) -+#define GET_TX_DESC_CCA_RTS_8821C(txdesc) GET_TX_DESC_CCA_RTS(txdesc) -+#define SET_TX_DESC_TRI_FRAME_8821C(txdesc, value) \ -+ SET_TX_DESC_TRI_FRAME(txdesc, value) -+#define GET_TX_DESC_TRI_FRAME_8821C(txdesc) GET_TX_DESC_TRI_FRAME(txdesc) -+#define SET_TX_DESC_P_AID_8821C(txdesc, value) SET_TX_DESC_P_AID(txdesc, value) -+#define GET_TX_DESC_P_AID_8821C(txdesc) GET_TX_DESC_P_AID(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME_8821C(txdesc, value) \ -+ SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) -+#define GET_TX_DESC_AMPDU_MAX_TIME_8821C(txdesc) \ -+ GET_TX_DESC_AMPDU_MAX_TIME(txdesc) -+#define SET_TX_DESC_NDPA_8821C(txdesc, value) SET_TX_DESC_NDPA(txdesc, value) -+#define GET_TX_DESC_NDPA_8821C(txdesc) GET_TX_DESC_NDPA(txdesc) -+#define SET_TX_DESC_MAX_AGG_NUM_8821C(txdesc, value) \ -+ SET_TX_DESC_MAX_AGG_NUM(txdesc, value) -+#define GET_TX_DESC_MAX_AGG_NUM_8821C(txdesc) GET_TX_DESC_MAX_AGG_NUM(txdesc) -+#define SET_TX_DESC_USE_MAX_TIME_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) -+#define GET_TX_DESC_USE_MAX_TIME_EN_8821C(txdesc) \ -+ GET_TX_DESC_USE_MAX_TIME_EN(txdesc) -+#define SET_TX_DESC_NAVUSEHDR_8821C(txdesc, value) \ -+ SET_TX_DESC_NAVUSEHDR(txdesc, value) -+#define GET_TX_DESC_NAVUSEHDR_8821C(txdesc) GET_TX_DESC_NAVUSEHDR(txdesc) -+#define SET_TX_DESC_CHK_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_CHK_EN(txdesc, value) -+#define GET_TX_DESC_CHK_EN_8821C(txdesc) GET_TX_DESC_CHK_EN(txdesc) -+#define SET_TX_DESC_HW_RTS_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_HW_RTS_EN(txdesc, value) -+#define GET_TX_DESC_HW_RTS_EN_8821C(txdesc) GET_TX_DESC_HW_RTS_EN(txdesc) -+#define SET_TX_DESC_RTSEN_8821C(txdesc, value) SET_TX_DESC_RTSEN(txdesc, value) -+#define GET_TX_DESC_RTSEN_8821C(txdesc) GET_TX_DESC_RTSEN(txdesc) -+#define SET_TX_DESC_CTS2SELF_8821C(txdesc, value) \ -+ SET_TX_DESC_CTS2SELF(txdesc, value) -+#define GET_TX_DESC_CTS2SELF_8821C(txdesc) GET_TX_DESC_CTS2SELF(txdesc) -+#define SET_TX_DESC_DISDATAFB_8821C(txdesc, value) \ -+ SET_TX_DESC_DISDATAFB(txdesc, value) -+#define GET_TX_DESC_DISDATAFB_8821C(txdesc) GET_TX_DESC_DISDATAFB(txdesc) -+#define SET_TX_DESC_DISRTSFB_8821C(txdesc, value) \ -+ SET_TX_DESC_DISRTSFB(txdesc, value) -+#define GET_TX_DESC_DISRTSFB_8821C(txdesc) GET_TX_DESC_DISRTSFB(txdesc) -+#define SET_TX_DESC_USE_RATE_8821C(txdesc, value) \ -+ SET_TX_DESC_USE_RATE(txdesc, value) -+#define GET_TX_DESC_USE_RATE_8821C(txdesc) GET_TX_DESC_USE_RATE(txdesc) -+#define SET_TX_DESC_HW_SSN_SEL_8821C(txdesc, value) \ -+ SET_TX_DESC_HW_SSN_SEL(txdesc, value) -+#define GET_TX_DESC_HW_SSN_SEL_8821C(txdesc) GET_TX_DESC_HW_SSN_SEL(txdesc) -+#define SET_TX_DESC_WHEADER_LEN_8821C(txdesc, value) \ -+ SET_TX_DESC_WHEADER_LEN(txdesc, value) -+#define GET_TX_DESC_WHEADER_LEN_8821C(txdesc) GET_TX_DESC_WHEADER_LEN(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX_8821C(txdesc, value) \ -+ SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) -+#define GET_TX_DESC_PCTS_MASK_IDX_8821C(txdesc) \ -+ GET_TX_DESC_PCTS_MASK_IDX(txdesc) -+#define SET_TX_DESC_PCTS_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_PCTS_EN(txdesc, value) -+#define GET_TX_DESC_PCTS_EN_8821C(txdesc) GET_TX_DESC_PCTS_EN(txdesc) -+#define SET_TX_DESC_RTSRATE_8821C(txdesc, value) \ -+ SET_TX_DESC_RTSRATE(txdesc, value) -+#define GET_TX_DESC_RTSRATE_8821C(txdesc) GET_TX_DESC_RTSRATE(txdesc) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT_8821C(txdesc, value) \ -+ SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT_8821C(txdesc) \ -+ GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) -+#define SET_TX_DESC_RTY_LMT_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_RTY_LMT_EN(txdesc, value) -+#define GET_TX_DESC_RTY_LMT_EN_8821C(txdesc) GET_TX_DESC_RTY_LMT_EN(txdesc) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE_8821C(txdesc, value) \ -+ SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE_8821C(txdesc) \ -+ GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE_8821C(txdesc, value) \ -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE_8821C(txdesc) \ -+ GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_TRY_RATE_8821C(txdesc, value) \ -+ SET_TX_DESC_TRY_RATE(txdesc, value) -+#define GET_TX_DESC_TRY_RATE_8821C(txdesc) GET_TX_DESC_TRY_RATE(txdesc) -+#define SET_TX_DESC_DATARATE_8821C(txdesc, value) \ -+ SET_TX_DESC_DATARATE(txdesc, value) -+#define GET_TX_DESC_DATARATE_8821C(txdesc) GET_TX_DESC_DATARATE(txdesc) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED_8821C(txdesc, value) \ -+ SET_TX_DESC_POLLUTED(txdesc, value) -+#define GET_TX_DESC_POLLUTED_8821C(txdesc) GET_TX_DESC_POLLUTED(txdesc) -+#define SET_TX_DESC_TXPWR_OFSET_8821C(txdesc, value) \ -+ SET_TX_DESC_TXPWR_OFSET(txdesc, value) -+#define GET_TX_DESC_TXPWR_OFSET_8821C(txdesc) GET_TX_DESC_TXPWR_OFSET(txdesc) -+#define SET_TX_DESC_TX_ANT_8821C(txdesc, value) \ -+ SET_TX_DESC_TX_ANT(txdesc, value) -+#define GET_TX_DESC_TX_ANT_8821C(txdesc) GET_TX_DESC_TX_ANT(txdesc) -+#define SET_TX_DESC_PORT_ID_8821C(txdesc, value) \ -+ SET_TX_DESC_PORT_ID(txdesc, value) -+#define GET_TX_DESC_PORT_ID_8821C(txdesc) GET_TX_DESC_PORT_ID(txdesc) -+#define SET_TX_DESC_MULTIPLE_PORT_8821C(txdesc, value) \ -+ SET_TX_DESC_MULTIPLE_PORT(txdesc, value) -+#define GET_TX_DESC_MULTIPLE_PORT_8821C(txdesc) \ -+ GET_TX_DESC_MULTIPLE_PORT(txdesc) -+#define SET_TX_DESC_SIGNALING_TAPKT_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TAPKT_EN(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TAPKT_EN_8821C(txdesc) \ -+ GET_TX_DESC_SIGNALING_TAPKT_EN(txdesc) -+#define SET_TX_DESC_SIGNALING_TA_PKT_SC_8821C(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TA_PKT_SC_8821C(txdesc) \ -+ GET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc) -+#define SET_TX_DESC_RTS_SHORT_8821C(txdesc, value) \ -+ SET_TX_DESC_RTS_SHORT(txdesc, value) -+#define GET_TX_DESC_RTS_SHORT_8821C(txdesc) GET_TX_DESC_RTS_SHORT(txdesc) -+#define SET_TX_DESC_VCS_STBC_8821C(txdesc, value) \ -+ SET_TX_DESC_VCS_STBC(txdesc, value) -+#define GET_TX_DESC_VCS_STBC_8821C(txdesc) GET_TX_DESC_VCS_STBC(txdesc) -+#define SET_TX_DESC_DATA_STBC_8821C(txdesc, value) \ -+ SET_TX_DESC_DATA_STBC(txdesc, value) -+#define GET_TX_DESC_DATA_STBC_8821C(txdesc) GET_TX_DESC_DATA_STBC(txdesc) -+#define SET_TX_DESC_DATA_LDPC_8821C(txdesc, value) \ -+ SET_TX_DESC_DATA_LDPC(txdesc, value) -+#define GET_TX_DESC_DATA_LDPC_8821C(txdesc) GET_TX_DESC_DATA_LDPC(txdesc) -+#define SET_TX_DESC_DATA_BW_8821C(txdesc, value) \ -+ SET_TX_DESC_DATA_BW(txdesc, value) -+#define GET_TX_DESC_DATA_BW_8821C(txdesc) GET_TX_DESC_DATA_BW(txdesc) -+#define SET_TX_DESC_DATA_SHORT_8821C(txdesc, value) \ -+ SET_TX_DESC_DATA_SHORT(txdesc, value) -+#define GET_TX_DESC_DATA_SHORT_8821C(txdesc) GET_TX_DESC_DATA_SHORT(txdesc) -+#define SET_TX_DESC_DATA_SC_8821C(txdesc, value) \ -+ SET_TX_DESC_DATA_SC(txdesc, value) -+#define GET_TX_DESC_DATA_SC_8821C(txdesc) GET_TX_DESC_DATA_SC(txdesc) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANTSEL_D_8821C(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_D(txdesc, value) -+#define GET_TX_DESC_ANTSEL_D_8821C(txdesc) GET_TX_DESC_ANTSEL_D(txdesc) -+#define SET_TX_DESC_ANT_MAPD_8821C(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPD(txdesc, value) -+#define GET_TX_DESC_ANT_MAPD_8821C(txdesc) GET_TX_DESC_ANT_MAPD(txdesc) -+#define SET_TX_DESC_ANT_MAPC_8821C(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPC(txdesc, value) -+#define GET_TX_DESC_ANT_MAPC_8821C(txdesc) GET_TX_DESC_ANT_MAPC(txdesc) -+#define SET_TX_DESC_ANT_MAPB_8821C(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPB(txdesc, value) -+#define GET_TX_DESC_ANT_MAPB_8821C(txdesc) GET_TX_DESC_ANT_MAPB(txdesc) -+#define SET_TX_DESC_ANT_MAPA_8821C(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPA(txdesc, value) -+#define GET_TX_DESC_ANT_MAPA_8821C(txdesc) GET_TX_DESC_ANT_MAPA(txdesc) -+#define SET_TX_DESC_ANTSEL_C_8821C(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_C(txdesc, value) -+#define GET_TX_DESC_ANTSEL_C_8821C(txdesc) GET_TX_DESC_ANTSEL_C(txdesc) -+#define SET_TX_DESC_ANTSEL_B_8821C(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_B(txdesc, value) -+#define GET_TX_DESC_ANTSEL_B_8821C(txdesc) GET_TX_DESC_ANTSEL_B(txdesc) -+#define SET_TX_DESC_ANTSEL_A_8821C(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_A(txdesc, value) -+#define GET_TX_DESC_ANTSEL_A_8821C(txdesc) GET_TX_DESC_ANTSEL_A(txdesc) -+#define SET_TX_DESC_MBSSID_8821C(txdesc, value) \ -+ SET_TX_DESC_MBSSID(txdesc, value) -+#define GET_TX_DESC_MBSSID_8821C(txdesc) GET_TX_DESC_MBSSID(txdesc) -+#define SET_TX_DESC_SW_DEFINE_8821C(txdesc, value) \ -+ SET_TX_DESC_SW_DEFINE(txdesc, value) -+#define GET_TX_DESC_SW_DEFINE_8821C(txdesc) GET_TX_DESC_SW_DEFINE(txdesc) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_8821C(txdesc, value) \ -+ SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_8821C(txdesc) \ -+ GET_TX_DESC_DMA_TXAGG_NUM(txdesc) -+#define SET_TX_DESC_FINAL_DATA_RATE_8821C(txdesc, value) \ -+ SET_TX_DESC_FINAL_DATA_RATE(txdesc, value) -+#define GET_TX_DESC_FINAL_DATA_RATE_8821C(txdesc) \ -+ GET_TX_DESC_FINAL_DATA_RATE(txdesc) -+#define SET_TX_DESC_NTX_MAP_8821C(txdesc, value) \ -+ SET_TX_DESC_NTX_MAP(txdesc, value) -+#define GET_TX_DESC_NTX_MAP_8821C(txdesc) GET_TX_DESC_NTX_MAP(txdesc) -+#define SET_TX_DESC_TX_BUFF_SIZE_8821C(txdesc, value) \ -+ SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) -+#define GET_TX_DESC_TX_BUFF_SIZE_8821C(txdesc) GET_TX_DESC_TX_BUFF_SIZE(txdesc) -+#define SET_TX_DESC_TXDESC_CHECKSUM_8821C(txdesc, value) \ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_8821C(txdesc) \ -+ GET_TX_DESC_TXDESC_CHECKSUM(txdesc) -+#define SET_TX_DESC_TIMESTAMP_8821C(txdesc, value) \ -+ SET_TX_DESC_TIMESTAMP(txdesc, value) -+#define GET_TX_DESC_TIMESTAMP_8821C(txdesc) GET_TX_DESC_TIMESTAMP(txdesc) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TXWIFI_CP_8821C(txdesc, value) \ -+ SET_TX_DESC_TXWIFI_CP(txdesc, value) -+#define GET_TX_DESC_TXWIFI_CP_8821C(txdesc) GET_TX_DESC_TXWIFI_CP(txdesc) -+#define SET_TX_DESC_MAC_CP_8821C(txdesc, value) \ -+ SET_TX_DESC_MAC_CP(txdesc, value) -+#define GET_TX_DESC_MAC_CP_8821C(txdesc) GET_TX_DESC_MAC_CP(txdesc) -+#define SET_TX_DESC_STW_PKTRE_DIS_8821C(txdesc, value) \ -+ SET_TX_DESC_STW_PKTRE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_PKTRE_DIS_8821C(txdesc) \ -+ GET_TX_DESC_STW_PKTRE_DIS(txdesc) -+#define SET_TX_DESC_STW_RB_DIS_8821C(txdesc, value) \ -+ SET_TX_DESC_STW_RB_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RB_DIS_8821C(txdesc) GET_TX_DESC_STW_RB_DIS(txdesc) -+#define SET_TX_DESC_STW_RATE_DIS_8821C(txdesc, value) \ -+ SET_TX_DESC_STW_RATE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RATE_DIS_8821C(txdesc) GET_TX_DESC_STW_RATE_DIS(txdesc) -+#define SET_TX_DESC_STW_ANT_DIS_8821C(txdesc, value) \ -+ SET_TX_DESC_STW_ANT_DIS(txdesc, value) -+#define GET_TX_DESC_STW_ANT_DIS_8821C(txdesc) GET_TX_DESC_STW_ANT_DIS(txdesc) -+#define SET_TX_DESC_STW_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_STW_EN(txdesc, value) -+#define GET_TX_DESC_STW_EN_8821C(txdesc) GET_TX_DESC_STW_EN(txdesc) -+#define SET_TX_DESC_SMH_EN_8821C(txdesc, value) \ -+ SET_TX_DESC_SMH_EN(txdesc, value) -+#define GET_TX_DESC_SMH_EN_8821C(txdesc) GET_TX_DESC_SMH_EN(txdesc) -+#define SET_TX_DESC_TAILPAGE_L_8821C(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_L(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_L_8821C(txdesc) GET_TX_DESC_TAILPAGE_L(txdesc) -+#define SET_TX_DESC_SDIO_DMASEQ_8821C(txdesc, value) \ -+ SET_TX_DESC_SDIO_DMASEQ(txdesc, value) -+#define GET_TX_DESC_SDIO_DMASEQ_8821C(txdesc) GET_TX_DESC_SDIO_DMASEQ(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_L_8821C(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_L_8821C(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_L(txdesc) -+#define SET_TX_DESC_EN_HWSEQ_8821C(txdesc, value) \ -+ SET_TX_DESC_EN_HWSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWSEQ_8821C(txdesc) GET_TX_DESC_EN_HWSEQ(txdesc) -+#define SET_TX_DESC_EN_HWEXSEQ_8821C(txdesc, value) \ -+ SET_TX_DESC_EN_HWEXSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWEXSEQ_8821C(txdesc) GET_TX_DESC_EN_HWEXSEQ(txdesc) -+#define SET_TX_DESC_DATA_RC_8821C(txdesc, value) \ -+ SET_TX_DESC_DATA_RC(txdesc, value) -+#define GET_TX_DESC_DATA_RC_8821C(txdesc) GET_TX_DESC_DATA_RC(txdesc) -+#define SET_TX_DESC_BAR_RTY_TH_8821C(txdesc, value) \ -+ SET_TX_DESC_BAR_RTY_TH(txdesc, value) -+#define GET_TX_DESC_BAR_RTY_TH_8821C(txdesc) GET_TX_DESC_BAR_RTY_TH(txdesc) -+#define SET_TX_DESC_RTS_RC_8821C(txdesc, value) \ -+ SET_TX_DESC_RTS_RC(txdesc, value) -+#define GET_TX_DESC_RTS_RC_8821C(txdesc) GET_TX_DESC_RTS_RC(txdesc) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_TAILPAGE_H_8821C(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_H(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_H_8821C(txdesc) GET_TX_DESC_TAILPAGE_H(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_H_8821C(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_H(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_H_8821C(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_H(txdesc) -+#define SET_TX_DESC_SW_SEQ_8821C(txdesc, value) \ -+ SET_TX_DESC_SW_SEQ(txdesc, value) -+#define GET_TX_DESC_SW_SEQ_8821C(txdesc) GET_TX_DESC_SW_SEQ(txdesc) -+#define SET_TX_DESC_TXBF_PATH_8821C(txdesc, value) \ -+ SET_TX_DESC_TXBF_PATH(txdesc, value) -+#define GET_TX_DESC_TXBF_PATH_8821C(txdesc) GET_TX_DESC_TXBF_PATH(txdesc) -+#define SET_TX_DESC_PADDING_LEN_8821C(txdesc, value) \ -+ SET_TX_DESC_PADDING_LEN(txdesc, value) -+#define GET_TX_DESC_PADDING_LEN_8821C(txdesc) GET_TX_DESC_PADDING_LEN(txdesc) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET_8821C(txdesc, value) \ -+ SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET_8821C(txdesc) \ -+ GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) -+ -+/*WORD10*/ -+ -+#define SET_TX_DESC_MU_DATARATE_8821C(txdesc, value) \ -+ SET_TX_DESC_MU_DATARATE(txdesc, value) -+#define GET_TX_DESC_MU_DATARATE_8821C(txdesc) GET_TX_DESC_MU_DATARATE(txdesc) -+#define SET_TX_DESC_MU_RC_8821C(txdesc, value) SET_TX_DESC_MU_RC(txdesc, value) -+#define GET_TX_DESC_MU_RC_8821C(txdesc) GET_TX_DESC_MU_RC(txdesc) -+#define SET_TX_DESC_SND_PKT_SEL_8821C(txdesc, value) \ -+ SET_TX_DESC_SND_PKT_SEL(txdesc, value) -+#define GET_TX_DESC_SND_PKT_SEL_8821C(txdesc) GET_TX_DESC_SND_PKT_SEL(txdesc) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_IE_END_BODY_8814B(txdesc, value) \ -+ SET_TX_DESC_IE_END_BODY(txdesc, value) -+#define GET_TX_DESC_IE_END_BODY_8814B(txdesc) GET_TX_DESC_IE_END_BODY(txdesc) -+#define SET_TX_DESC_AGG_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_AGG_EN_V1(txdesc, value) -+#define GET_TX_DESC_AGG_EN_8814B(txdesc) GET_TX_DESC_AGG_EN_V1(txdesc) -+#define SET_TX_DESC_BK_8814B(txdesc, value) SET_TX_DESC_BK_V1(txdesc, value) -+#define GET_TX_DESC_BK_8814B(txdesc) GET_TX_DESC_BK_V1(txdesc) -+#define SET_TX_DESC_PKT_OFFSET_8814B(txdesc, value) \ -+ SET_TX_DESC_PKT_OFFSET_V1(txdesc, value) -+#define GET_TX_DESC_PKT_OFFSET_8814B(txdesc) GET_TX_DESC_PKT_OFFSET_V1(txdesc) -+#define SET_TX_DESC_OFFSET_8814B(txdesc, value) \ -+ SET_TX_DESC_OFFSET(txdesc, value) -+#define GET_TX_DESC_OFFSET_8814B(txdesc) GET_TX_DESC_OFFSET(txdesc) -+#define SET_TX_DESC_TXPKTSIZE_8814B(txdesc, value) \ -+ SET_TX_DESC_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_TXPKTSIZE_8814B(txdesc) GET_TX_DESC_TXPKTSIZE(txdesc) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_AMSDU_8814B(txdesc, value) SET_TX_DESC_AMSDU(txdesc, value) -+#define GET_TX_DESC_AMSDU_8814B(txdesc) GET_TX_DESC_AMSDU(txdesc) -+#define SET_TX_DESC_HW_AES_IV_8814B(txdesc, value) \ -+ SET_TX_DESC_HW_AES_IV_V1(txdesc, value) -+#define GET_TX_DESC_HW_AES_IV_8814B(txdesc) GET_TX_DESC_HW_AES_IV_V1(txdesc) -+#define SET_TX_DESC_MHR_CP_8814B(txdesc, value) \ -+ SET_TX_DESC_MHR_CP(txdesc, value) -+#define GET_TX_DESC_MHR_CP_8814B(txdesc) GET_TX_DESC_MHR_CP(txdesc) -+#define SET_TX_DESC_SMH_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_SMH_EN_V1(txdesc, value) -+#define GET_TX_DESC_SMH_EN_8814B(txdesc) GET_TX_DESC_SMH_EN_V1(txdesc) -+#define SET_TX_DESC_SMH_CAM_8814B(txdesc, value) \ -+ SET_TX_DESC_SMH_CAM(txdesc, value) -+#define GET_TX_DESC_SMH_CAM_8814B(txdesc) GET_TX_DESC_SMH_CAM(txdesc) -+#define SET_TX_DESC_EXT_EDCA_8814B(txdesc, value) \ -+ SET_TX_DESC_EXT_EDCA(txdesc, value) -+#define GET_TX_DESC_EXT_EDCA_8814B(txdesc) GET_TX_DESC_EXT_EDCA(txdesc) -+#define SET_TX_DESC_QSEL_8814B(txdesc, value) SET_TX_DESC_QSEL(txdesc, value) -+#define GET_TX_DESC_QSEL_8814B(txdesc) GET_TX_DESC_QSEL(txdesc) -+#define SET_TX_DESC_MACID_8814B(txdesc, value) \ -+ SET_TX_DESC_MACID_V1(txdesc, value) -+#define GET_TX_DESC_MACID_8814B(txdesc) GET_TX_DESC_MACID_V1(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_CHK_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_CHK_EN_V1(txdesc, value) -+#define GET_TX_DESC_CHK_EN_8814B(txdesc) GET_TX_DESC_CHK_EN_V1(txdesc) -+#define SET_TX_DESC_DMA_PRI_8814B(txdesc, value) \ -+ SET_TX_DESC_DMA_PRI(txdesc, value) -+#define GET_TX_DESC_DMA_PRI_8814B(txdesc) GET_TX_DESC_DMA_PRI(txdesc) -+#define SET_TX_DESC_MAX_AMSDU_MODE_8814B(txdesc, value) \ -+ SET_TX_DESC_MAX_AMSDU_MODE(txdesc, value) -+#define GET_TX_DESC_MAX_AMSDU_MODE_8814B(txdesc) \ -+ GET_TX_DESC_MAX_AMSDU_MODE(txdesc) -+#define SET_TX_DESC_DMA_TXAGG_NUM_8814B(txdesc, value) \ -+ SET_TX_DESC_DMA_TXAGG_NUM_V1(txdesc, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_8814B(txdesc) \ -+ GET_TX_DESC_DMA_TXAGG_NUM_V1(txdesc) -+#define SET_TX_DESC_TXDESC_CHECKSUM_8814B(txdesc, value) \ -+ SET_TX_DESC_TXDESC_CHECKSUM_V1(txdesc, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_8814B(txdesc) \ -+ GET_TX_DESC_TXDESC_CHECKSUM_V1(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_OFFLOAD_SIZE_8814B(txdesc, value) \ -+ SET_TX_DESC_OFFLOAD_SIZE(txdesc, value) -+#define GET_TX_DESC_OFFLOAD_SIZE_8814B(txdesc) GET_TX_DESC_OFFLOAD_SIZE(txdesc) -+#define SET_TX_DESC_CHANNEL_DMA_8814B(txdesc, value) \ -+ SET_TX_DESC_CHANNEL_DMA(txdesc, value) -+#define GET_TX_DESC_CHANNEL_DMA_8814B(txdesc) GET_TX_DESC_CHANNEL_DMA(txdesc) -+#define SET_TX_DESC_IE_CNT_8814B(txdesc, value) \ -+ SET_TX_DESC_IE_CNT(txdesc, value) -+#define GET_TX_DESC_IE_CNT_8814B(txdesc) GET_TX_DESC_IE_CNT(txdesc) -+#define SET_TX_DESC_IE_CNT_EN_8814B(txdesc, value) \ -+ SET_TX_DESC_IE_CNT_EN(txdesc, value) -+#define GET_TX_DESC_IE_CNT_EN_8814B(txdesc) GET_TX_DESC_IE_CNT_EN(txdesc) -+#define SET_TX_DESC_WHEADER_LEN_8814B(txdesc, value) \ -+ SET_TX_DESC_WHEADER_LEN_V1(txdesc, value) -+#define GET_TX_DESC_WHEADER_LEN_8814B(txdesc) GET_TX_DESC_WHEADER_LEN_V1(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+/*TXDESC_WORD5*/ -+ -+/*TXDESC_WORD6*/ -+ -+/*TXDESC_WORD7*/ -+ -+/*TXDESC_WORD8*/ -+ -+/*TXDESC_WORD9*/ -+ -+/*WORD10*/ -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_DISQSELSEQ_8198F(txdesc, value) \ -+ SET_TX_DESC_DISQSELSEQ(txdesc, value) -+#define GET_TX_DESC_DISQSELSEQ_8198F(txdesc) GET_TX_DESC_DISQSELSEQ(txdesc) -+#define SET_TX_DESC_GF_8198F(txdesc, value) SET_TX_DESC_GF(txdesc, value) -+#define GET_TX_DESC_GF_8198F(txdesc) GET_TX_DESC_GF(txdesc) -+#define SET_TX_DESC_NO_ACM_8198F(txdesc, value) \ -+ SET_TX_DESC_NO_ACM(txdesc, value) -+#define GET_TX_DESC_NO_ACM_8198F(txdesc) GET_TX_DESC_NO_ACM(txdesc) -+#define SET_TX_DESC_BCNPKT_TSF_CTRL_8198F(txdesc, value) \ -+ SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc, value) -+#define GET_TX_DESC_BCNPKT_TSF_CTRL_8198F(txdesc) \ -+ GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc) -+#define SET_TX_DESC_AMSDU_PAD_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) -+#define GET_TX_DESC_AMSDU_PAD_EN_8198F(txdesc) GET_TX_DESC_AMSDU_PAD_EN(txdesc) -+#define SET_TX_DESC_LS_8198F(txdesc, value) SET_TX_DESC_LS(txdesc, value) -+#define GET_TX_DESC_LS_8198F(txdesc) GET_TX_DESC_LS(txdesc) -+#define SET_TX_DESC_HTC_8198F(txdesc, value) SET_TX_DESC_HTC(txdesc, value) -+#define GET_TX_DESC_HTC_8198F(txdesc) GET_TX_DESC_HTC(txdesc) -+#define SET_TX_DESC_BMC_8198F(txdesc, value) SET_TX_DESC_BMC(txdesc, value) -+#define GET_TX_DESC_BMC_8198F(txdesc) GET_TX_DESC_BMC(txdesc) -+#define SET_TX_DESC_OFFSET_8198F(txdesc, value) \ -+ SET_TX_DESC_OFFSET(txdesc, value) -+#define GET_TX_DESC_OFFSET_8198F(txdesc) GET_TX_DESC_OFFSET(txdesc) -+#define SET_TX_DESC_TXPKTSIZE_8198F(txdesc, value) \ -+ SET_TX_DESC_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_TXPKTSIZE_8198F(txdesc) GET_TX_DESC_TXPKTSIZE(txdesc) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_HW_AES_IV_8198F(txdesc, value) \ -+ SET_TX_DESC_HW_AES_IV_V2(txdesc, value) -+#define GET_TX_DESC_HW_AES_IV_8198F(txdesc) GET_TX_DESC_HW_AES_IV_V2(txdesc) -+#define SET_TX_DESC_FTM_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_FTM_EN_V1(txdesc, value) -+#define GET_TX_DESC_FTM_EN_8198F(txdesc) GET_TX_DESC_FTM_EN_V1(txdesc) -+#define SET_TX_DESC_MOREDATA_8198F(txdesc, value) \ -+ SET_TX_DESC_MOREDATA(txdesc, value) -+#define GET_TX_DESC_MOREDATA_8198F(txdesc) GET_TX_DESC_MOREDATA(txdesc) -+#define SET_TX_DESC_PKT_OFFSET_8198F(txdesc, value) \ -+ SET_TX_DESC_PKT_OFFSET(txdesc, value) -+#define GET_TX_DESC_PKT_OFFSET_8198F(txdesc) GET_TX_DESC_PKT_OFFSET(txdesc) -+#define SET_TX_DESC_SEC_TYPE_8198F(txdesc, value) \ -+ SET_TX_DESC_SEC_TYPE(txdesc, value) -+#define GET_TX_DESC_SEC_TYPE_8198F(txdesc) GET_TX_DESC_SEC_TYPE(txdesc) -+#define SET_TX_DESC_EN_DESC_ID_8198F(txdesc, value) \ -+ SET_TX_DESC_EN_DESC_ID(txdesc, value) -+#define GET_TX_DESC_EN_DESC_ID_8198F(txdesc) GET_TX_DESC_EN_DESC_ID(txdesc) -+#define SET_TX_DESC_RATE_ID_8198F(txdesc, value) \ -+ SET_TX_DESC_RATE_ID(txdesc, value) -+#define GET_TX_DESC_RATE_ID_8198F(txdesc) GET_TX_DESC_RATE_ID(txdesc) -+#define SET_TX_DESC_PIFS_8198F(txdesc, value) SET_TX_DESC_PIFS(txdesc, value) -+#define GET_TX_DESC_PIFS_8198F(txdesc) GET_TX_DESC_PIFS(txdesc) -+#define SET_TX_DESC_LSIG_TXOP_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) -+#define GET_TX_DESC_LSIG_TXOP_EN_8198F(txdesc) GET_TX_DESC_LSIG_TXOP_EN(txdesc) -+#define SET_TX_DESC_RD_NAV_EXT_8198F(txdesc, value) \ -+ SET_TX_DESC_RD_NAV_EXT(txdesc, value) -+#define GET_TX_DESC_RD_NAV_EXT_8198F(txdesc) GET_TX_DESC_RD_NAV_EXT(txdesc) -+#define SET_TX_DESC_QSEL_8198F(txdesc, value) SET_TX_DESC_QSEL(txdesc, value) -+#define GET_TX_DESC_QSEL_8198F(txdesc) GET_TX_DESC_QSEL(txdesc) -+#define SET_TX_DESC_SPECIAL_CW_8198F(txdesc, value) \ -+ SET_TX_DESC_SPECIAL_CW(txdesc, value) -+#define GET_TX_DESC_SPECIAL_CW_8198F(txdesc) GET_TX_DESC_SPECIAL_CW(txdesc) -+#define SET_TX_DESC_MACID_8198F(txdesc, value) SET_TX_DESC_MACID(txdesc, value) -+#define GET_TX_DESC_MACID_8198F(txdesc) GET_TX_DESC_MACID(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_ANTCEL_D_8198F(txdesc, value) \ -+ SET_TX_DESC_ANTCEL_D_V1(txdesc, value) -+#define GET_TX_DESC_ANTCEL_D_8198F(txdesc) GET_TX_DESC_ANTCEL_D_V1(txdesc) -+#define SET_TX_DESC_ANTSEL_C_8198F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_C_V1(txdesc, value) -+#define GET_TX_DESC_ANTSEL_C_8198F(txdesc) GET_TX_DESC_ANTSEL_C_V1(txdesc) -+#define SET_TX_DESC_BT_NULL_8198F(txdesc, value) \ -+ SET_TX_DESC_BT_NULL(txdesc, value) -+#define GET_TX_DESC_BT_NULL_8198F(txdesc) GET_TX_DESC_BT_NULL(txdesc) -+#define SET_TX_DESC_AMPDU_DENSITY_8198F(txdesc, value) \ -+ SET_TX_DESC_AMPDU_DENSITY(txdesc, value) -+#define GET_TX_DESC_AMPDU_DENSITY_8198F(txdesc) \ -+ GET_TX_DESC_AMPDU_DENSITY(txdesc) -+#define SET_TX_DESC_SPE_RPT_8198F(txdesc, value) \ -+ SET_TX_DESC_SPE_RPT(txdesc, value) -+#define GET_TX_DESC_SPE_RPT_8198F(txdesc) GET_TX_DESC_SPE_RPT(txdesc) -+#define SET_TX_DESC_RAW_8198F(txdesc, value) SET_TX_DESC_RAW(txdesc, value) -+#define GET_TX_DESC_RAW_8198F(txdesc) GET_TX_DESC_RAW(txdesc) -+#define SET_TX_DESC_MOREFRAG_8198F(txdesc, value) \ -+ SET_TX_DESC_MOREFRAG(txdesc, value) -+#define GET_TX_DESC_MOREFRAG_8198F(txdesc) GET_TX_DESC_MOREFRAG(txdesc) -+#define SET_TX_DESC_BK_8198F(txdesc, value) SET_TX_DESC_BK(txdesc, value) -+#define GET_TX_DESC_BK_8198F(txdesc) GET_TX_DESC_BK(txdesc) -+#define SET_TX_DESC_NULL_1_8198F(txdesc, value) \ -+ SET_TX_DESC_NULL_1(txdesc, value) -+#define GET_TX_DESC_NULL_1_8198F(txdesc) GET_TX_DESC_NULL_1(txdesc) -+#define SET_TX_DESC_NULL_0_8198F(txdesc, value) \ -+ SET_TX_DESC_NULL_0(txdesc, value) -+#define GET_TX_DESC_NULL_0_8198F(txdesc) GET_TX_DESC_NULL_0(txdesc) -+#define SET_TX_DESC_RDG_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_RDG_EN(txdesc, value) -+#define GET_TX_DESC_RDG_EN_8198F(txdesc) GET_TX_DESC_RDG_EN(txdesc) -+#define SET_TX_DESC_AGG_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_AGG_EN(txdesc, value) -+#define GET_TX_DESC_AGG_EN_8198F(txdesc) GET_TX_DESC_AGG_EN(txdesc) -+#define SET_TX_DESC_CCA_RTS_8198F(txdesc, value) \ -+ SET_TX_DESC_CCA_RTS(txdesc, value) -+#define GET_TX_DESC_CCA_RTS_8198F(txdesc) GET_TX_DESC_CCA_RTS(txdesc) -+#define SET_TX_DESC_TRI_FRAME_8198F(txdesc, value) \ -+ SET_TX_DESC_TRI_FRAME(txdesc, value) -+#define GET_TX_DESC_TRI_FRAME_8198F(txdesc) GET_TX_DESC_TRI_FRAME(txdesc) -+#define SET_TX_DESC_P_AID_8198F(txdesc, value) SET_TX_DESC_P_AID(txdesc, value) -+#define GET_TX_DESC_P_AID_8198F(txdesc) GET_TX_DESC_P_AID(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME_8198F(txdesc, value) \ -+ SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) -+#define GET_TX_DESC_AMPDU_MAX_TIME_8198F(txdesc) \ -+ GET_TX_DESC_AMPDU_MAX_TIME(txdesc) -+#define SET_TX_DESC_NDPA_8198F(txdesc, value) SET_TX_DESC_NDPA(txdesc, value) -+#define GET_TX_DESC_NDPA_8198F(txdesc) GET_TX_DESC_NDPA(txdesc) -+#define SET_TX_DESC_MAX_AGG_NUM_8198F(txdesc, value) \ -+ SET_TX_DESC_MAX_AGG_NUM(txdesc, value) -+#define GET_TX_DESC_MAX_AGG_NUM_8198F(txdesc) GET_TX_DESC_MAX_AGG_NUM(txdesc) -+#define SET_TX_DESC_USE_MAX_TIME_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) -+#define GET_TX_DESC_USE_MAX_TIME_EN_8198F(txdesc) \ -+ GET_TX_DESC_USE_MAX_TIME_EN(txdesc) -+#define SET_TX_DESC_NAVUSEHDR_8198F(txdesc, value) \ -+ SET_TX_DESC_NAVUSEHDR(txdesc, value) -+#define GET_TX_DESC_NAVUSEHDR_8198F(txdesc) GET_TX_DESC_NAVUSEHDR(txdesc) -+#define SET_TX_DESC_CHK_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_CHK_EN(txdesc, value) -+#define GET_TX_DESC_CHK_EN_8198F(txdesc) GET_TX_DESC_CHK_EN(txdesc) -+#define SET_TX_DESC_HW_RTS_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_HW_RTS_EN(txdesc, value) -+#define GET_TX_DESC_HW_RTS_EN_8198F(txdesc) GET_TX_DESC_HW_RTS_EN(txdesc) -+#define SET_TX_DESC_RTSEN_8198F(txdesc, value) SET_TX_DESC_RTSEN(txdesc, value) -+#define GET_TX_DESC_RTSEN_8198F(txdesc) GET_TX_DESC_RTSEN(txdesc) -+#define SET_TX_DESC_CTS2SELF_8198F(txdesc, value) \ -+ SET_TX_DESC_CTS2SELF(txdesc, value) -+#define GET_TX_DESC_CTS2SELF_8198F(txdesc) GET_TX_DESC_CTS2SELF(txdesc) -+#define SET_TX_DESC_DISDATAFB_8198F(txdesc, value) \ -+ SET_TX_DESC_DISDATAFB(txdesc, value) -+#define GET_TX_DESC_DISDATAFB_8198F(txdesc) GET_TX_DESC_DISDATAFB(txdesc) -+#define SET_TX_DESC_DISRTSFB_8198F(txdesc, value) \ -+ SET_TX_DESC_DISRTSFB(txdesc, value) -+#define GET_TX_DESC_DISRTSFB_8198F(txdesc) GET_TX_DESC_DISRTSFB(txdesc) -+#define SET_TX_DESC_USE_RATE_8198F(txdesc, value) \ -+ SET_TX_DESC_USE_RATE(txdesc, value) -+#define GET_TX_DESC_USE_RATE_8198F(txdesc) GET_TX_DESC_USE_RATE(txdesc) -+#define SET_TX_DESC_HW_SSN_SEL_8198F(txdesc, value) \ -+ SET_TX_DESC_HW_SSN_SEL(txdesc, value) -+#define GET_TX_DESC_HW_SSN_SEL_8198F(txdesc) GET_TX_DESC_HW_SSN_SEL(txdesc) -+#define SET_TX_DESC_WHEADER_LEN_8198F(txdesc, value) \ -+ SET_TX_DESC_WHEADER_LEN(txdesc, value) -+#define GET_TX_DESC_WHEADER_LEN_8198F(txdesc) GET_TX_DESC_WHEADER_LEN(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX_8198F(txdesc, value) \ -+ SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) -+#define GET_TX_DESC_PCTS_MASK_IDX_8198F(txdesc) \ -+ GET_TX_DESC_PCTS_MASK_IDX(txdesc) -+#define SET_TX_DESC_PCTS_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_PCTS_EN(txdesc, value) -+#define GET_TX_DESC_PCTS_EN_8198F(txdesc) GET_TX_DESC_PCTS_EN(txdesc) -+#define SET_TX_DESC_RTSRATE_8198F(txdesc, value) \ -+ SET_TX_DESC_RTSRATE(txdesc, value) -+#define GET_TX_DESC_RTSRATE_8198F(txdesc) GET_TX_DESC_RTSRATE(txdesc) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT_8198F(txdesc, value) \ -+ SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT_8198F(txdesc) \ -+ GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) -+#define SET_TX_DESC_RTY_LMT_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_RTY_LMT_EN(txdesc, value) -+#define GET_TX_DESC_RTY_LMT_EN_8198F(txdesc) GET_TX_DESC_RTY_LMT_EN(txdesc) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE_8198F(txdesc, value) \ -+ SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE_8198F(txdesc) \ -+ GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE_8198F(txdesc, value) \ -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE_8198F(txdesc) \ -+ GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_TRY_RATE_8198F(txdesc, value) \ -+ SET_TX_DESC_TRY_RATE(txdesc, value) -+#define GET_TX_DESC_TRY_RATE_8198F(txdesc) GET_TX_DESC_TRY_RATE(txdesc) -+#define SET_TX_DESC_DATARATE_8198F(txdesc, value) \ -+ SET_TX_DESC_DATARATE(txdesc, value) -+#define GET_TX_DESC_DATARATE_8198F(txdesc) GET_TX_DESC_DATARATE(txdesc) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED_8198F(txdesc, value) \ -+ SET_TX_DESC_POLLUTED(txdesc, value) -+#define GET_TX_DESC_POLLUTED_8198F(txdesc) GET_TX_DESC_POLLUTED(txdesc) -+#define SET_TX_DESC_TXPWR_OFSET_8198F(txdesc, value) \ -+ SET_TX_DESC_TXPWR_OFSET(txdesc, value) -+#define GET_TX_DESC_TXPWR_OFSET_8198F(txdesc) GET_TX_DESC_TXPWR_OFSET(txdesc) -+#define SET_TX_DESC_DROP_ID_8198F(txdesc, value) \ -+ SET_TX_DESC_DROP_ID(txdesc, value) -+#define GET_TX_DESC_DROP_ID_8198F(txdesc) GET_TX_DESC_DROP_ID(txdesc) -+#define SET_TX_DESC_PORT_ID_8198F(txdesc, value) \ -+ SET_TX_DESC_PORT_ID(txdesc, value) -+#define GET_TX_DESC_PORT_ID_8198F(txdesc) GET_TX_DESC_PORT_ID(txdesc) -+#define SET_TX_DESC_MULTIPLE_PORT_8198F(txdesc, value) \ -+ SET_TX_DESC_MULTIPLE_PORT(txdesc, value) -+#define GET_TX_DESC_MULTIPLE_PORT_8198F(txdesc) \ -+ GET_TX_DESC_MULTIPLE_PORT(txdesc) -+#define SET_TX_DESC_SIGNALING_TAPKT_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TAPKT_EN(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TAPKT_EN_8198F(txdesc) \ -+ GET_TX_DESC_SIGNALING_TAPKT_EN(txdesc) -+#define SET_TX_DESC_RTS_SC_8198F(txdesc, value) \ -+ SET_TX_DESC_RTS_SC(txdesc, value) -+#define GET_TX_DESC_RTS_SC_8198F(txdesc) GET_TX_DESC_RTS_SC(txdesc) -+#define SET_TX_DESC_RTS_SHORT_8198F(txdesc, value) \ -+ SET_TX_DESC_RTS_SHORT(txdesc, value) -+#define GET_TX_DESC_RTS_SHORT_8198F(txdesc) GET_TX_DESC_RTS_SHORT(txdesc) -+#define SET_TX_DESC_VCS_STBC_8198F(txdesc, value) \ -+ SET_TX_DESC_VCS_STBC(txdesc, value) -+#define GET_TX_DESC_VCS_STBC_8198F(txdesc) GET_TX_DESC_VCS_STBC(txdesc) -+#define SET_TX_DESC_DATA_STBC_8198F(txdesc, value) \ -+ SET_TX_DESC_DATA_STBC(txdesc, value) -+#define GET_TX_DESC_DATA_STBC_8198F(txdesc) GET_TX_DESC_DATA_STBC(txdesc) -+#define SET_TX_DESC_DATA_LDPC_8198F(txdesc, value) \ -+ SET_TX_DESC_DATA_LDPC(txdesc, value) -+#define GET_TX_DESC_DATA_LDPC_8198F(txdesc) GET_TX_DESC_DATA_LDPC(txdesc) -+#define SET_TX_DESC_DATA_BW_8198F(txdesc, value) \ -+ SET_TX_DESC_DATA_BW(txdesc, value) -+#define GET_TX_DESC_DATA_BW_8198F(txdesc) GET_TX_DESC_DATA_BW(txdesc) -+#define SET_TX_DESC_DATA_SHORT_8198F(txdesc, value) \ -+ SET_TX_DESC_DATA_SHORT(txdesc, value) -+#define GET_TX_DESC_DATA_SHORT_8198F(txdesc) GET_TX_DESC_DATA_SHORT(txdesc) -+#define SET_TX_DESC_DATA_SC_8198F(txdesc, value) \ -+ SET_TX_DESC_DATA_SC(txdesc, value) -+#define GET_TX_DESC_DATA_SC_8198F(txdesc) GET_TX_DESC_DATA_SC(txdesc) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANT_MAPD_8198F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPD_V1(txdesc, value) -+#define GET_TX_DESC_ANT_MAPD_8198F(txdesc) GET_TX_DESC_ANT_MAPD_V1(txdesc) -+#define SET_TX_DESC_ANT_MAPC_8198F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPC_V1(txdesc, value) -+#define GET_TX_DESC_ANT_MAPC_8198F(txdesc) GET_TX_DESC_ANT_MAPC_V1(txdesc) -+#define SET_TX_DESC_ANT_MAPB_8198F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPB_V1(txdesc, value) -+#define GET_TX_DESC_ANT_MAPB_8198F(txdesc) GET_TX_DESC_ANT_MAPB_V1(txdesc) -+#define SET_TX_DESC_ANT_MAPA_8198F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPA_V1(txdesc, value) -+#define GET_TX_DESC_ANT_MAPA_8198F(txdesc) GET_TX_DESC_ANT_MAPA_V1(txdesc) -+#define SET_TX_DESC_ANTSEL_B_8198F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_B_V1(txdesc, value) -+#define GET_TX_DESC_ANTSEL_B_8198F(txdesc) GET_TX_DESC_ANTSEL_B_V1(txdesc) -+#define SET_TX_DESC_ANTSEL_A_8198F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_A_V1(txdesc, value) -+#define GET_TX_DESC_ANTSEL_A_8198F(txdesc) GET_TX_DESC_ANTSEL_A_V1(txdesc) -+#define SET_TX_DESC_MBSSID_8198F(txdesc, value) \ -+ SET_TX_DESC_MBSSID(txdesc, value) -+#define GET_TX_DESC_MBSSID_8198F(txdesc) GET_TX_DESC_MBSSID(txdesc) -+#define SET_TX_DESC_SWPS_SEQ_8198F(txdesc, value) \ -+ SET_TX_DESC_SWPS_SEQ(txdesc, value) -+#define GET_TX_DESC_SWPS_SEQ_8198F(txdesc) GET_TX_DESC_SWPS_SEQ(txdesc) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_8198F(txdesc, value) \ -+ SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_8198F(txdesc) \ -+ GET_TX_DESC_DMA_TXAGG_NUM(txdesc) -+#define SET_TX_DESC_FINAL_DATA_RATE_8198F(txdesc, value) \ -+ SET_TX_DESC_FINAL_DATA_RATE(txdesc, value) -+#define GET_TX_DESC_FINAL_DATA_RATE_8198F(txdesc) \ -+ GET_TX_DESC_FINAL_DATA_RATE(txdesc) -+#define SET_TX_DESC_NTX_MAP_8198F(txdesc, value) \ -+ SET_TX_DESC_NTX_MAP(txdesc, value) -+#define GET_TX_DESC_NTX_MAP_8198F(txdesc) GET_TX_DESC_NTX_MAP(txdesc) -+#define SET_TX_DESC_ANTSEL_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_EN(txdesc, value) -+#define GET_TX_DESC_ANTSEL_EN_8198F(txdesc) GET_TX_DESC_ANTSEL_EN(txdesc) -+#define SET_TX_DESC_MBSSID_EX_8198F(txdesc, value) \ -+ SET_TX_DESC_MBSSID_EX(txdesc, value) -+#define GET_TX_DESC_MBSSID_EX_8198F(txdesc) GET_TX_DESC_MBSSID_EX(txdesc) -+#define SET_TX_DESC_TX_BUFF_SIZE_8198F(txdesc, value) \ -+ SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) -+#define GET_TX_DESC_TX_BUFF_SIZE_8198F(txdesc) GET_TX_DESC_TX_BUFF_SIZE(txdesc) -+#define SET_TX_DESC_TXDESC_CHECKSUM_8198F(txdesc, value) \ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_8198F(txdesc) \ -+ GET_TX_DESC_TXDESC_CHECKSUM(txdesc) -+#define SET_TX_DESC_TIMESTAMP_8198F(txdesc, value) \ -+ SET_TX_DESC_TIMESTAMP(txdesc, value) -+#define GET_TX_DESC_TIMESTAMP_8198F(txdesc) GET_TX_DESC_TIMESTAMP(txdesc) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TXWIFI_CP_8198F(txdesc, value) \ -+ SET_TX_DESC_TXWIFI_CP(txdesc, value) -+#define GET_TX_DESC_TXWIFI_CP_8198F(txdesc) GET_TX_DESC_TXWIFI_CP(txdesc) -+#define SET_TX_DESC_MAC_CP_8198F(txdesc, value) \ -+ SET_TX_DESC_MAC_CP(txdesc, value) -+#define GET_TX_DESC_MAC_CP_8198F(txdesc) GET_TX_DESC_MAC_CP(txdesc) -+#define SET_TX_DESC_STW_PKTRE_DIS_8198F(txdesc, value) \ -+ SET_TX_DESC_STW_PKTRE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_PKTRE_DIS_8198F(txdesc) \ -+ GET_TX_DESC_STW_PKTRE_DIS(txdesc) -+#define SET_TX_DESC_STW_RB_DIS_8198F(txdesc, value) \ -+ SET_TX_DESC_STW_RB_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RB_DIS_8198F(txdesc) GET_TX_DESC_STW_RB_DIS(txdesc) -+#define SET_TX_DESC_STW_RATE_DIS_8198F(txdesc, value) \ -+ SET_TX_DESC_STW_RATE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RATE_DIS_8198F(txdesc) GET_TX_DESC_STW_RATE_DIS(txdesc) -+#define SET_TX_DESC_STW_ANT_DIS_8198F(txdesc, value) \ -+ SET_TX_DESC_STW_ANT_DIS(txdesc, value) -+#define GET_TX_DESC_STW_ANT_DIS_8198F(txdesc) GET_TX_DESC_STW_ANT_DIS(txdesc) -+#define SET_TX_DESC_STW_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_STW_EN(txdesc, value) -+#define GET_TX_DESC_STW_EN_8198F(txdesc) GET_TX_DESC_STW_EN(txdesc) -+#define SET_TX_DESC_SMH_EN_8198F(txdesc, value) \ -+ SET_TX_DESC_SMH_EN(txdesc, value) -+#define GET_TX_DESC_SMH_EN_8198F(txdesc) GET_TX_DESC_SMH_EN(txdesc) -+#define SET_TX_DESC_TAILPAGE_L_8198F(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_L(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_L_8198F(txdesc) GET_TX_DESC_TAILPAGE_L(txdesc) -+#define SET_TX_DESC_SDIO_DMASEQ_8198F(txdesc, value) \ -+ SET_TX_DESC_SDIO_DMASEQ(txdesc, value) -+#define GET_TX_DESC_SDIO_DMASEQ_8198F(txdesc) GET_TX_DESC_SDIO_DMASEQ(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_L_8198F(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_L_8198F(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_L(txdesc) -+#define SET_TX_DESC_EN_HWSEQ_8198F(txdesc, value) \ -+ SET_TX_DESC_EN_HWSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWSEQ_8198F(txdesc) GET_TX_DESC_EN_HWSEQ(txdesc) -+#define SET_TX_DESC_EN_HWEXSEQ_8198F(txdesc, value) \ -+ SET_TX_DESC_EN_HWEXSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWEXSEQ_8198F(txdesc) GET_TX_DESC_EN_HWEXSEQ(txdesc) -+#define SET_TX_DESC_DATA_RC_8198F(txdesc, value) \ -+ SET_TX_DESC_DATA_RC(txdesc, value) -+#define GET_TX_DESC_DATA_RC_8198F(txdesc) GET_TX_DESC_DATA_RC(txdesc) -+#define SET_TX_DESC_BAR_RTY_TH_8198F(txdesc, value) \ -+ SET_TX_DESC_BAR_RTY_TH(txdesc, value) -+#define GET_TX_DESC_BAR_RTY_TH_8198F(txdesc) GET_TX_DESC_BAR_RTY_TH(txdesc) -+#define SET_TX_DESC_RTS_RC_8198F(txdesc, value) \ -+ SET_TX_DESC_RTS_RC(txdesc, value) -+#define GET_TX_DESC_RTS_RC_8198F(txdesc) GET_TX_DESC_RTS_RC(txdesc) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_TAILPAGE_H_8198F(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_H(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_H_8198F(txdesc) GET_TX_DESC_TAILPAGE_H(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_H_8198F(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_H(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_H_8198F(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_H(txdesc) -+#define SET_TX_DESC_SW_SEQ_8198F(txdesc, value) \ -+ SET_TX_DESC_SW_SEQ(txdesc, value) -+#define GET_TX_DESC_SW_SEQ_8198F(txdesc) GET_TX_DESC_SW_SEQ(txdesc) -+#define SET_TX_DESC_TXBF_PATH_8198F(txdesc, value) \ -+ SET_TX_DESC_TXBF_PATH(txdesc, value) -+#define GET_TX_DESC_TXBF_PATH_8198F(txdesc) GET_TX_DESC_TXBF_PATH(txdesc) -+#define SET_TX_DESC_PADDING_LEN_8198F(txdesc, value) \ -+ SET_TX_DESC_PADDING_LEN(txdesc, value) -+#define GET_TX_DESC_PADDING_LEN_8198F(txdesc) GET_TX_DESC_PADDING_LEN(txdesc) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET_8198F(txdesc, value) \ -+ SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET_8198F(txdesc) \ -+ GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) -+ -+/*WORD10*/ -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_DISQSELSEQ_8822C(txdesc, value) \ -+ SET_TX_DESC_DISQSELSEQ(txdesc, value) -+#define GET_TX_DESC_DISQSELSEQ_8822C(txdesc) GET_TX_DESC_DISQSELSEQ(txdesc) -+#define SET_TX_DESC_GF_8822C(txdesc, value) SET_TX_DESC_GF(txdesc, value) -+#define GET_TX_DESC_GF_8822C(txdesc) GET_TX_DESC_GF(txdesc) -+#define SET_TX_DESC_NO_ACM_8822C(txdesc, value) \ -+ SET_TX_DESC_NO_ACM(txdesc, value) -+#define GET_TX_DESC_NO_ACM_8822C(txdesc) GET_TX_DESC_NO_ACM(txdesc) -+#define SET_TX_DESC_BCNPKT_TSF_CTRL_8822C(txdesc, value) \ -+ SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc, value) -+#define GET_TX_DESC_BCNPKT_TSF_CTRL_8822C(txdesc) \ -+ GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc) -+#define SET_TX_DESC_AMSDU_PAD_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) -+#define GET_TX_DESC_AMSDU_PAD_EN_8822C(txdesc) GET_TX_DESC_AMSDU_PAD_EN(txdesc) -+#define SET_TX_DESC_LS_8822C(txdesc, value) SET_TX_DESC_LS(txdesc, value) -+#define GET_TX_DESC_LS_8822C(txdesc) GET_TX_DESC_LS(txdesc) -+#define SET_TX_DESC_HTC_8822C(txdesc, value) SET_TX_DESC_HTC(txdesc, value) -+#define GET_TX_DESC_HTC_8822C(txdesc) GET_TX_DESC_HTC(txdesc) -+#define SET_TX_DESC_BMC_8822C(txdesc, value) SET_TX_DESC_BMC(txdesc, value) -+#define GET_TX_DESC_BMC_8822C(txdesc) GET_TX_DESC_BMC(txdesc) -+#define SET_TX_DESC_OFFSET_8822C(txdesc, value) \ -+ SET_TX_DESC_OFFSET(txdesc, value) -+#define GET_TX_DESC_OFFSET_8822C(txdesc) GET_TX_DESC_OFFSET(txdesc) -+#define SET_TX_DESC_TXPKTSIZE_8822C(txdesc, value) \ -+ SET_TX_DESC_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_TXPKTSIZE_8822C(txdesc) GET_TX_DESC_TXPKTSIZE(txdesc) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_MOREDATA_8822C(txdesc, value) \ -+ SET_TX_DESC_MOREDATA(txdesc, value) -+#define GET_TX_DESC_MOREDATA_8822C(txdesc) GET_TX_DESC_MOREDATA(txdesc) -+#define SET_TX_DESC_PKT_OFFSET_8822C(txdesc, value) \ -+ SET_TX_DESC_PKT_OFFSET(txdesc, value) -+#define GET_TX_DESC_PKT_OFFSET_8822C(txdesc) GET_TX_DESC_PKT_OFFSET(txdesc) -+#define SET_TX_DESC_SEC_TYPE_8822C(txdesc, value) \ -+ SET_TX_DESC_SEC_TYPE(txdesc, value) -+#define GET_TX_DESC_SEC_TYPE_8822C(txdesc) GET_TX_DESC_SEC_TYPE(txdesc) -+#define SET_TX_DESC_EN_DESC_ID_8822C(txdesc, value) \ -+ SET_TX_DESC_EN_DESC_ID(txdesc, value) -+#define GET_TX_DESC_EN_DESC_ID_8822C(txdesc) GET_TX_DESC_EN_DESC_ID(txdesc) -+#define SET_TX_DESC_RATE_ID_8822C(txdesc, value) \ -+ SET_TX_DESC_RATE_ID(txdesc, value) -+#define GET_TX_DESC_RATE_ID_8822C(txdesc) GET_TX_DESC_RATE_ID(txdesc) -+#define SET_TX_DESC_PIFS_8822C(txdesc, value) SET_TX_DESC_PIFS(txdesc, value) -+#define GET_TX_DESC_PIFS_8822C(txdesc) GET_TX_DESC_PIFS(txdesc) -+#define SET_TX_DESC_LSIG_TXOP_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) -+#define GET_TX_DESC_LSIG_TXOP_EN_8822C(txdesc) GET_TX_DESC_LSIG_TXOP_EN(txdesc) -+#define SET_TX_DESC_RD_NAV_EXT_8822C(txdesc, value) \ -+ SET_TX_DESC_RD_NAV_EXT(txdesc, value) -+#define GET_TX_DESC_RD_NAV_EXT_8822C(txdesc) GET_TX_DESC_RD_NAV_EXT(txdesc) -+#define SET_TX_DESC_QSEL_8822C(txdesc, value) SET_TX_DESC_QSEL(txdesc, value) -+#define GET_TX_DESC_QSEL_8822C(txdesc) GET_TX_DESC_QSEL(txdesc) -+#define SET_TX_DESC_MACID_8822C(txdesc, value) SET_TX_DESC_MACID(txdesc, value) -+#define GET_TX_DESC_MACID_8822C(txdesc) GET_TX_DESC_MACID(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_HW_AES_IV_8822C(txdesc, value) \ -+ SET_TX_DESC_HW_AES_IV(txdesc, value) -+#define GET_TX_DESC_HW_AES_IV_8822C(txdesc) GET_TX_DESC_HW_AES_IV(txdesc) -+#define SET_TX_DESC_FTM_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_FTM_EN(txdesc, value) -+#define GET_TX_DESC_FTM_EN_8822C(txdesc) GET_TX_DESC_FTM_EN(txdesc) -+#define SET_TX_DESC_G_ID_8822C(txdesc, value) SET_TX_DESC_G_ID(txdesc, value) -+#define GET_TX_DESC_G_ID_8822C(txdesc) GET_TX_DESC_G_ID(txdesc) -+#define SET_TX_DESC_BT_NULL_8822C(txdesc, value) \ -+ SET_TX_DESC_BT_NULL(txdesc, value) -+#define GET_TX_DESC_BT_NULL_8822C(txdesc) GET_TX_DESC_BT_NULL(txdesc) -+#define SET_TX_DESC_AMPDU_DENSITY_8822C(txdesc, value) \ -+ SET_TX_DESC_AMPDU_DENSITY(txdesc, value) -+#define GET_TX_DESC_AMPDU_DENSITY_8822C(txdesc) \ -+ GET_TX_DESC_AMPDU_DENSITY(txdesc) -+#define SET_TX_DESC_SPE_RPT_8822C(txdesc, value) \ -+ SET_TX_DESC_SPE_RPT(txdesc, value) -+#define GET_TX_DESC_SPE_RPT_8822C(txdesc) GET_TX_DESC_SPE_RPT(txdesc) -+#define SET_TX_DESC_RAW_8822C(txdesc, value) SET_TX_DESC_RAW(txdesc, value) -+#define GET_TX_DESC_RAW_8822C(txdesc) GET_TX_DESC_RAW(txdesc) -+#define SET_TX_DESC_MOREFRAG_8822C(txdesc, value) \ -+ SET_TX_DESC_MOREFRAG(txdesc, value) -+#define GET_TX_DESC_MOREFRAG_8822C(txdesc) GET_TX_DESC_MOREFRAG(txdesc) -+#define SET_TX_DESC_BK_8822C(txdesc, value) SET_TX_DESC_BK(txdesc, value) -+#define GET_TX_DESC_BK_8822C(txdesc) GET_TX_DESC_BK(txdesc) -+#define SET_TX_DESC_NULL_1_8822C(txdesc, value) \ -+ SET_TX_DESC_NULL_1(txdesc, value) -+#define GET_TX_DESC_NULL_1_8822C(txdesc) GET_TX_DESC_NULL_1(txdesc) -+#define SET_TX_DESC_NULL_0_8822C(txdesc, value) \ -+ SET_TX_DESC_NULL_0(txdesc, value) -+#define GET_TX_DESC_NULL_0_8822C(txdesc) GET_TX_DESC_NULL_0(txdesc) -+#define SET_TX_DESC_RDG_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_RDG_EN(txdesc, value) -+#define GET_TX_DESC_RDG_EN_8822C(txdesc) GET_TX_DESC_RDG_EN(txdesc) -+#define SET_TX_DESC_AGG_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_AGG_EN(txdesc, value) -+#define GET_TX_DESC_AGG_EN_8822C(txdesc) GET_TX_DESC_AGG_EN(txdesc) -+#define SET_TX_DESC_CCA_RTS_8822C(txdesc, value) \ -+ SET_TX_DESC_CCA_RTS(txdesc, value) -+#define GET_TX_DESC_CCA_RTS_8822C(txdesc) GET_TX_DESC_CCA_RTS(txdesc) -+#define SET_TX_DESC_TRI_FRAME_8822C(txdesc, value) \ -+ SET_TX_DESC_TRI_FRAME(txdesc, value) -+#define GET_TX_DESC_TRI_FRAME_8822C(txdesc) GET_TX_DESC_TRI_FRAME(txdesc) -+#define SET_TX_DESC_P_AID_8822C(txdesc, value) SET_TX_DESC_P_AID(txdesc, value) -+#define GET_TX_DESC_P_AID_8822C(txdesc) GET_TX_DESC_P_AID(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME_8822C(txdesc, value) \ -+ SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) -+#define GET_TX_DESC_AMPDU_MAX_TIME_8822C(txdesc) \ -+ GET_TX_DESC_AMPDU_MAX_TIME(txdesc) -+#define SET_TX_DESC_NDPA_8822C(txdesc, value) SET_TX_DESC_NDPA(txdesc, value) -+#define GET_TX_DESC_NDPA_8822C(txdesc) GET_TX_DESC_NDPA(txdesc) -+#define SET_TX_DESC_MAX_AGG_NUM_8822C(txdesc, value) \ -+ SET_TX_DESC_MAX_AGG_NUM(txdesc, value) -+#define GET_TX_DESC_MAX_AGG_NUM_8822C(txdesc) GET_TX_DESC_MAX_AGG_NUM(txdesc) -+#define SET_TX_DESC_USE_MAX_TIME_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) -+#define GET_TX_DESC_USE_MAX_TIME_EN_8822C(txdesc) \ -+ GET_TX_DESC_USE_MAX_TIME_EN(txdesc) -+#define SET_TX_DESC_NAVUSEHDR_8822C(txdesc, value) \ -+ SET_TX_DESC_NAVUSEHDR(txdesc, value) -+#define GET_TX_DESC_NAVUSEHDR_8822C(txdesc) GET_TX_DESC_NAVUSEHDR(txdesc) -+#define SET_TX_DESC_CHK_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_CHK_EN(txdesc, value) -+#define GET_TX_DESC_CHK_EN_8822C(txdesc) GET_TX_DESC_CHK_EN(txdesc) -+#define SET_TX_DESC_HW_RTS_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_HW_RTS_EN(txdesc, value) -+#define GET_TX_DESC_HW_RTS_EN_8822C(txdesc) GET_TX_DESC_HW_RTS_EN(txdesc) -+#define SET_TX_DESC_RTSEN_8822C(txdesc, value) SET_TX_DESC_RTSEN(txdesc, value) -+#define GET_TX_DESC_RTSEN_8822C(txdesc) GET_TX_DESC_RTSEN(txdesc) -+#define SET_TX_DESC_CTS2SELF_8822C(txdesc, value) \ -+ SET_TX_DESC_CTS2SELF(txdesc, value) -+#define GET_TX_DESC_CTS2SELF_8822C(txdesc) GET_TX_DESC_CTS2SELF(txdesc) -+#define SET_TX_DESC_DISDATAFB_8822C(txdesc, value) \ -+ SET_TX_DESC_DISDATAFB(txdesc, value) -+#define GET_TX_DESC_DISDATAFB_8822C(txdesc) GET_TX_DESC_DISDATAFB(txdesc) -+#define SET_TX_DESC_DISRTSFB_8822C(txdesc, value) \ -+ SET_TX_DESC_DISRTSFB(txdesc, value) -+#define GET_TX_DESC_DISRTSFB_8822C(txdesc) GET_TX_DESC_DISRTSFB(txdesc) -+#define SET_TX_DESC_USE_RATE_8822C(txdesc, value) \ -+ SET_TX_DESC_USE_RATE(txdesc, value) -+#define GET_TX_DESC_USE_RATE_8822C(txdesc) GET_TX_DESC_USE_RATE(txdesc) -+#define SET_TX_DESC_HW_SSN_SEL_8822C(txdesc, value) \ -+ SET_TX_DESC_HW_SSN_SEL(txdesc, value) -+#define GET_TX_DESC_HW_SSN_SEL_8822C(txdesc) GET_TX_DESC_HW_SSN_SEL(txdesc) -+#define SET_TX_DESC_WHEADER_LEN_8822C(txdesc, value) \ -+ SET_TX_DESC_WHEADER_LEN(txdesc, value) -+#define GET_TX_DESC_WHEADER_LEN_8822C(txdesc) GET_TX_DESC_WHEADER_LEN(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX_8822C(txdesc, value) \ -+ SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) -+#define GET_TX_DESC_PCTS_MASK_IDX_8822C(txdesc) \ -+ GET_TX_DESC_PCTS_MASK_IDX(txdesc) -+#define SET_TX_DESC_PCTS_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_PCTS_EN(txdesc, value) -+#define GET_TX_DESC_PCTS_EN_8822C(txdesc) GET_TX_DESC_PCTS_EN(txdesc) -+#define SET_TX_DESC_RTSRATE_8822C(txdesc, value) \ -+ SET_TX_DESC_RTSRATE(txdesc, value) -+#define GET_TX_DESC_RTSRATE_8822C(txdesc) GET_TX_DESC_RTSRATE(txdesc) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT_8822C(txdesc, value) \ -+ SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT_8822C(txdesc) \ -+ GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) -+#define SET_TX_DESC_RTY_LMT_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_RTY_LMT_EN(txdesc, value) -+#define GET_TX_DESC_RTY_LMT_EN_8822C(txdesc) GET_TX_DESC_RTY_LMT_EN(txdesc) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE_8822C(txdesc, value) \ -+ SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE_8822C(txdesc) \ -+ GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE_8822C(txdesc, value) \ -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE_8822C(txdesc) \ -+ GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_TRY_RATE_8822C(txdesc, value) \ -+ SET_TX_DESC_TRY_RATE(txdesc, value) -+#define GET_TX_DESC_TRY_RATE_8822C(txdesc) GET_TX_DESC_TRY_RATE(txdesc) -+#define SET_TX_DESC_DATARATE_8822C(txdesc, value) \ -+ SET_TX_DESC_DATARATE(txdesc, value) -+#define GET_TX_DESC_DATARATE_8822C(txdesc) GET_TX_DESC_DATARATE(txdesc) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED_8822C(txdesc, value) \ -+ SET_TX_DESC_POLLUTED(txdesc, value) -+#define GET_TX_DESC_POLLUTED_8822C(txdesc) GET_TX_DESC_POLLUTED(txdesc) -+#define SET_TX_DESC_ANTSEL_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_EN_V1(txdesc, value) -+#define GET_TX_DESC_ANTSEL_EN_8822C(txdesc) GET_TX_DESC_ANTSEL_EN_V1(txdesc) -+#define SET_TX_DESC_TXPWR_OFSET_TYPE_8822C(txdesc, value) \ -+ SET_TX_DESC_TXPWR_OFSET_TYPE(txdesc, value) -+#define GET_TX_DESC_TXPWR_OFSET_TYPE_8822C(txdesc) \ -+ GET_TX_DESC_TXPWR_OFSET_TYPE(txdesc) -+#define SET_TX_DESC_TX_ANT_8822C(txdesc, value) \ -+ SET_TX_DESC_TX_ANT(txdesc, value) -+#define GET_TX_DESC_TX_ANT_8822C(txdesc) GET_TX_DESC_TX_ANT(txdesc) -+#define SET_TX_DESC_PORT_ID_8822C(txdesc, value) \ -+ SET_TX_DESC_PORT_ID(txdesc, value) -+#define GET_TX_DESC_PORT_ID_8822C(txdesc) GET_TX_DESC_PORT_ID(txdesc) -+#define SET_TX_DESC_MULTIPLE_PORT_8822C(txdesc, value) \ -+ SET_TX_DESC_MULTIPLE_PORT(txdesc, value) -+#define GET_TX_DESC_MULTIPLE_PORT_8822C(txdesc) \ -+ GET_TX_DESC_MULTIPLE_PORT(txdesc) -+#define SET_TX_DESC_SIGNALING_TAPKT_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TAPKT_EN(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TAPKT_EN_8822C(txdesc) \ -+ GET_TX_DESC_SIGNALING_TAPKT_EN(txdesc) -+#define SET_TX_DESC_SIGNALING_TA_PKT_SC_8822C(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TA_PKT_SC_8822C(txdesc) \ -+ GET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc) -+#define SET_TX_DESC_RTS_SHORT_8822C(txdesc, value) \ -+ SET_TX_DESC_RTS_SHORT(txdesc, value) -+#define GET_TX_DESC_RTS_SHORT_8822C(txdesc) GET_TX_DESC_RTS_SHORT(txdesc) -+#define SET_TX_DESC_VCS_STBC_8822C(txdesc, value) \ -+ SET_TX_DESC_VCS_STBC(txdesc, value) -+#define GET_TX_DESC_VCS_STBC_8822C(txdesc) GET_TX_DESC_VCS_STBC(txdesc) -+#define SET_TX_DESC_DATA_STBC_8822C(txdesc, value) \ -+ SET_TX_DESC_DATA_STBC(txdesc, value) -+#define GET_TX_DESC_DATA_STBC_8822C(txdesc) GET_TX_DESC_DATA_STBC(txdesc) -+#define SET_TX_DESC_DATA_LDPC_8822C(txdesc, value) \ -+ SET_TX_DESC_DATA_LDPC(txdesc, value) -+#define GET_TX_DESC_DATA_LDPC_8822C(txdesc) GET_TX_DESC_DATA_LDPC(txdesc) -+#define SET_TX_DESC_DATA_BW_8822C(txdesc, value) \ -+ SET_TX_DESC_DATA_BW(txdesc, value) -+#define GET_TX_DESC_DATA_BW_8822C(txdesc) GET_TX_DESC_DATA_BW(txdesc) -+#define SET_TX_DESC_DATA_SHORT_8822C(txdesc, value) \ -+ SET_TX_DESC_DATA_SHORT(txdesc, value) -+#define GET_TX_DESC_DATA_SHORT_8822C(txdesc) GET_TX_DESC_DATA_SHORT(txdesc) -+#define SET_TX_DESC_DATA_SC_8822C(txdesc, value) \ -+ SET_TX_DESC_DATA_SC(txdesc, value) -+#define GET_TX_DESC_DATA_SC_8822C(txdesc) GET_TX_DESC_DATA_SC(txdesc) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANTSEL_D_8822C(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_D(txdesc, value) -+#define GET_TX_DESC_ANTSEL_D_8822C(txdesc) GET_TX_DESC_ANTSEL_D(txdesc) -+#define SET_TX_DESC_ANT_MAPD_8822C(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPD(txdesc, value) -+#define GET_TX_DESC_ANT_MAPD_8822C(txdesc) GET_TX_DESC_ANT_MAPD(txdesc) -+#define SET_TX_DESC_ANT_MAPC_8822C(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPC(txdesc, value) -+#define GET_TX_DESC_ANT_MAPC_8822C(txdesc) GET_TX_DESC_ANT_MAPC(txdesc) -+#define SET_TX_DESC_ANT_MAPB_8822C(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPB(txdesc, value) -+#define GET_TX_DESC_ANT_MAPB_8822C(txdesc) GET_TX_DESC_ANT_MAPB(txdesc) -+#define SET_TX_DESC_ANT_MAPA_8822C(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPA(txdesc, value) -+#define GET_TX_DESC_ANT_MAPA_8822C(txdesc) GET_TX_DESC_ANT_MAPA(txdesc) -+#define SET_TX_DESC_ANTSEL_C_8822C(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_C(txdesc, value) -+#define GET_TX_DESC_ANTSEL_C_8822C(txdesc) GET_TX_DESC_ANTSEL_C(txdesc) -+#define SET_TX_DESC_ANTSEL_B_8822C(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_B(txdesc, value) -+#define GET_TX_DESC_ANTSEL_B_8822C(txdesc) GET_TX_DESC_ANTSEL_B(txdesc) -+#define SET_TX_DESC_ANTSEL_A_8822C(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_A(txdesc, value) -+#define GET_TX_DESC_ANTSEL_A_8822C(txdesc) GET_TX_DESC_ANTSEL_A(txdesc) -+#define SET_TX_DESC_MBSSID_8822C(txdesc, value) \ -+ SET_TX_DESC_MBSSID(txdesc, value) -+#define GET_TX_DESC_MBSSID_8822C(txdesc) GET_TX_DESC_MBSSID(txdesc) -+#define SET_TX_DESC_SW_DEFINE_8822C(txdesc, value) \ -+ SET_TX_DESC_SW_DEFINE(txdesc, value) -+#define GET_TX_DESC_SW_DEFINE_8822C(txdesc) GET_TX_DESC_SW_DEFINE(txdesc) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_8822C(txdesc, value) \ -+ SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_8822C(txdesc) \ -+ GET_TX_DESC_DMA_TXAGG_NUM(txdesc) -+#define SET_TX_DESC_FINAL_DATA_RATE_8822C(txdesc, value) \ -+ SET_TX_DESC_FINAL_DATA_RATE(txdesc, value) -+#define GET_TX_DESC_FINAL_DATA_RATE_8822C(txdesc) \ -+ GET_TX_DESC_FINAL_DATA_RATE(txdesc) -+#define SET_TX_DESC_NTX_MAP_8822C(txdesc, value) \ -+ SET_TX_DESC_NTX_MAP(txdesc, value) -+#define GET_TX_DESC_NTX_MAP_8822C(txdesc) GET_TX_DESC_NTX_MAP(txdesc) -+#define SET_TX_DESC_TX_BUFF_SIZE_8822C(txdesc, value) \ -+ SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) -+#define GET_TX_DESC_TX_BUFF_SIZE_8822C(txdesc) GET_TX_DESC_TX_BUFF_SIZE(txdesc) -+#define SET_TX_DESC_TXDESC_CHECKSUM_8822C(txdesc, value) \ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_8822C(txdesc) \ -+ GET_TX_DESC_TXDESC_CHECKSUM(txdesc) -+#define SET_TX_DESC_TIMESTAMP_8822C(txdesc, value) \ -+ SET_TX_DESC_TIMESTAMP(txdesc, value) -+#define GET_TX_DESC_TIMESTAMP_8822C(txdesc) GET_TX_DESC_TIMESTAMP(txdesc) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TXWIFI_CP_8822C(txdesc, value) \ -+ SET_TX_DESC_TXWIFI_CP(txdesc, value) -+#define GET_TX_DESC_TXWIFI_CP_8822C(txdesc) GET_TX_DESC_TXWIFI_CP(txdesc) -+#define SET_TX_DESC_MAC_CP_8822C(txdesc, value) \ -+ SET_TX_DESC_MAC_CP(txdesc, value) -+#define GET_TX_DESC_MAC_CP_8822C(txdesc) GET_TX_DESC_MAC_CP(txdesc) -+#define SET_TX_DESC_STW_PKTRE_DIS_8822C(txdesc, value) \ -+ SET_TX_DESC_STW_PKTRE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_PKTRE_DIS_8822C(txdesc) \ -+ GET_TX_DESC_STW_PKTRE_DIS(txdesc) -+#define SET_TX_DESC_STW_RB_DIS_8822C(txdesc, value) \ -+ SET_TX_DESC_STW_RB_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RB_DIS_8822C(txdesc) GET_TX_DESC_STW_RB_DIS(txdesc) -+#define SET_TX_DESC_STW_RATE_DIS_8822C(txdesc, value) \ -+ SET_TX_DESC_STW_RATE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RATE_DIS_8822C(txdesc) GET_TX_DESC_STW_RATE_DIS(txdesc) -+#define SET_TX_DESC_STW_ANT_DIS_8822C(txdesc, value) \ -+ SET_TX_DESC_STW_ANT_DIS(txdesc, value) -+#define GET_TX_DESC_STW_ANT_DIS_8822C(txdesc) GET_TX_DESC_STW_ANT_DIS(txdesc) -+#define SET_TX_DESC_STW_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_STW_EN(txdesc, value) -+#define GET_TX_DESC_STW_EN_8822C(txdesc) GET_TX_DESC_STW_EN(txdesc) -+#define SET_TX_DESC_SMH_EN_8822C(txdesc, value) \ -+ SET_TX_DESC_SMH_EN(txdesc, value) -+#define GET_TX_DESC_SMH_EN_8822C(txdesc) GET_TX_DESC_SMH_EN(txdesc) -+#define SET_TX_DESC_TAILPAGE_L_8822C(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_L(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_L_8822C(txdesc) GET_TX_DESC_TAILPAGE_L(txdesc) -+#define SET_TX_DESC_SDIO_DMASEQ_8822C(txdesc, value) \ -+ SET_TX_DESC_SDIO_DMASEQ(txdesc, value) -+#define GET_TX_DESC_SDIO_DMASEQ_8822C(txdesc) GET_TX_DESC_SDIO_DMASEQ(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_L_8822C(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_L_8822C(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_L(txdesc) -+#define SET_TX_DESC_EN_HWSEQ_8822C(txdesc, value) \ -+ SET_TX_DESC_EN_HWSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWSEQ_8822C(txdesc) GET_TX_DESC_EN_HWSEQ(txdesc) -+#define SET_TX_DESC_EN_HWEXSEQ_8822C(txdesc, value) \ -+ SET_TX_DESC_EN_HWEXSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWEXSEQ_8822C(txdesc) GET_TX_DESC_EN_HWEXSEQ(txdesc) -+#define SET_TX_DESC_DATA_RC_8822C(txdesc, value) \ -+ SET_TX_DESC_DATA_RC(txdesc, value) -+#define GET_TX_DESC_DATA_RC_8822C(txdesc) GET_TX_DESC_DATA_RC(txdesc) -+#define SET_TX_DESC_BAR_RTY_TH_8822C(txdesc, value) \ -+ SET_TX_DESC_BAR_RTY_TH(txdesc, value) -+#define GET_TX_DESC_BAR_RTY_TH_8822C(txdesc) GET_TX_DESC_BAR_RTY_TH(txdesc) -+#define SET_TX_DESC_RTS_RC_8822C(txdesc, value) \ -+ SET_TX_DESC_RTS_RC(txdesc, value) -+#define GET_TX_DESC_RTS_RC_8822C(txdesc) GET_TX_DESC_RTS_RC(txdesc) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_TAILPAGE_H_8822C(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_H(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_H_8822C(txdesc) GET_TX_DESC_TAILPAGE_H(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_H_8822C(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_H(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_H_8822C(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_H(txdesc) -+#define SET_TX_DESC_SW_SEQ_8822C(txdesc, value) \ -+ SET_TX_DESC_SW_SEQ(txdesc, value) -+#define GET_TX_DESC_SW_SEQ_8822C(txdesc) GET_TX_DESC_SW_SEQ(txdesc) -+#define SET_TX_DESC_TXBF_PATH_8822C(txdesc, value) \ -+ SET_TX_DESC_TXBF_PATH(txdesc, value) -+#define GET_TX_DESC_TXBF_PATH_8822C(txdesc) GET_TX_DESC_TXBF_PATH(txdesc) -+#define SET_TX_DESC_PADDING_LEN_8822C(txdesc, value) \ -+ SET_TX_DESC_PADDING_LEN(txdesc, value) -+#define GET_TX_DESC_PADDING_LEN_8822C(txdesc) GET_TX_DESC_PADDING_LEN(txdesc) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET_8822C(txdesc, value) \ -+ SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET_8822C(txdesc) \ -+ GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) -+ -+/*WORD10*/ -+ -+#define SET_TX_DESC_MU_DATARATE_8822C(txdesc, value) \ -+ SET_TX_DESC_MU_DATARATE(txdesc, value) -+#define GET_TX_DESC_MU_DATARATE_8822C(txdesc) GET_TX_DESC_MU_DATARATE(txdesc) -+#define SET_TX_DESC_MU_RC_8822C(txdesc, value) SET_TX_DESC_MU_RC(txdesc, value) -+#define GET_TX_DESC_MU_RC_8822C(txdesc) GET_TX_DESC_MU_RC(txdesc) -+#define SET_TX_DESC_SND_PKT_SEL_8822C(txdesc, value) \ -+ SET_TX_DESC_SND_PKT_SEL(txdesc, value) -+#define GET_TX_DESC_SND_PKT_SEL_8822C(txdesc) GET_TX_DESC_SND_PKT_SEL(txdesc) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_GF_8192F(txdesc, value) SET_TX_DESC_GF(txdesc, value) -+#define GET_TX_DESC_GF_8192F(txdesc) GET_TX_DESC_GF(txdesc) -+#define SET_TX_DESC_NO_ACM_8192F(txdesc, value) \ -+ SET_TX_DESC_NO_ACM(txdesc, value) -+#define GET_TX_DESC_NO_ACM_8192F(txdesc) GET_TX_DESC_NO_ACM(txdesc) -+#define SET_TX_DESC_AMSDU_PAD_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) -+#define GET_TX_DESC_AMSDU_PAD_EN_8192F(txdesc) GET_TX_DESC_AMSDU_PAD_EN(txdesc) -+#define SET_TX_DESC_HTC_8192F(txdesc, value) SET_TX_DESC_HTC(txdesc, value) -+#define GET_TX_DESC_HTC_8192F(txdesc) GET_TX_DESC_HTC(txdesc) -+#define SET_TX_DESC_BMC_8192F(txdesc, value) SET_TX_DESC_BMC(txdesc, value) -+#define GET_TX_DESC_BMC_8192F(txdesc) GET_TX_DESC_BMC(txdesc) -+#define SET_TX_DESC_OFFSET_8192F(txdesc, value) \ -+ SET_TX_DESC_OFFSET(txdesc, value) -+#define GET_TX_DESC_OFFSET_8192F(txdesc) GET_TX_DESC_OFFSET(txdesc) -+#define SET_TX_DESC_TXPKTSIZE_8192F(txdesc, value) \ -+ SET_TX_DESC_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_TXPKTSIZE_8192F(txdesc) GET_TX_DESC_TXPKTSIZE(txdesc) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_KEYID_SEL_8192F(txdesc, value) \ -+ SET_TX_DESC_KEYID_SEL(txdesc, value) -+#define GET_TX_DESC_KEYID_SEL_8192F(txdesc) GET_TX_DESC_KEYID_SEL(txdesc) -+#define SET_TX_DESC_MOREDATA_8192F(txdesc, value) \ -+ SET_TX_DESC_MOREDATA(txdesc, value) -+#define GET_TX_DESC_MOREDATA_8192F(txdesc) GET_TX_DESC_MOREDATA(txdesc) -+#define SET_TX_DESC_PKT_OFFSET_8192F(txdesc, value) \ -+ SET_TX_DESC_PKT_OFFSET(txdesc, value) -+#define GET_TX_DESC_PKT_OFFSET_8192F(txdesc) GET_TX_DESC_PKT_OFFSET(txdesc) -+#define SET_TX_DESC_SEC_TYPE_8192F(txdesc, value) \ -+ SET_TX_DESC_SEC_TYPE(txdesc, value) -+#define GET_TX_DESC_SEC_TYPE_8192F(txdesc) GET_TX_DESC_SEC_TYPE(txdesc) -+#define SET_TX_DESC_EN_DESC_ID_8192F(txdesc, value) \ -+ SET_TX_DESC_EN_DESC_ID(txdesc, value) -+#define GET_TX_DESC_EN_DESC_ID_8192F(txdesc) GET_TX_DESC_EN_DESC_ID(txdesc) -+#define SET_TX_DESC_RATE_ID_8192F(txdesc, value) \ -+ SET_TX_DESC_RATE_ID(txdesc, value) -+#define GET_TX_DESC_RATE_ID_8192F(txdesc) GET_TX_DESC_RATE_ID(txdesc) -+#define SET_TX_DESC_PIFS_8192F(txdesc, value) SET_TX_DESC_PIFS(txdesc, value) -+#define GET_TX_DESC_PIFS_8192F(txdesc) GET_TX_DESC_PIFS(txdesc) -+#define SET_TX_DESC_LSIG_TXOP_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) -+#define GET_TX_DESC_LSIG_TXOP_EN_8192F(txdesc) GET_TX_DESC_LSIG_TXOP_EN(txdesc) -+#define SET_TX_DESC_RD_NAV_EXT_8192F(txdesc, value) \ -+ SET_TX_DESC_RD_NAV_EXT(txdesc, value) -+#define GET_TX_DESC_RD_NAV_EXT_8192F(txdesc) GET_TX_DESC_RD_NAV_EXT(txdesc) -+#define SET_TX_DESC_QSEL_8192F(txdesc, value) SET_TX_DESC_QSEL(txdesc, value) -+#define GET_TX_DESC_QSEL_8192F(txdesc) GET_TX_DESC_QSEL(txdesc) -+#define SET_TX_DESC_MACID_8192F(txdesc, value) SET_TX_DESC_MACID(txdesc, value) -+#define GET_TX_DESC_MACID_8192F(txdesc) GET_TX_DESC_MACID(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_FTM_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_FTM_EN(txdesc, value) -+#define GET_TX_DESC_FTM_EN_8192F(txdesc) GET_TX_DESC_FTM_EN(txdesc) -+#define SET_TX_DESC_G_ID_8192F(txdesc, value) SET_TX_DESC_G_ID(txdesc, value) -+#define GET_TX_DESC_G_ID_8192F(txdesc) GET_TX_DESC_G_ID(txdesc) -+#define SET_TX_DESC_BT_NULL_8192F(txdesc, value) \ -+ SET_TX_DESC_BT_NULL(txdesc, value) -+#define GET_TX_DESC_BT_NULL_8192F(txdesc) GET_TX_DESC_BT_NULL(txdesc) -+#define SET_TX_DESC_AMPDU_DENSITY_8192F(txdesc, value) \ -+ SET_TX_DESC_AMPDU_DENSITY(txdesc, value) -+#define GET_TX_DESC_AMPDU_DENSITY_8192F(txdesc) \ -+ GET_TX_DESC_AMPDU_DENSITY(txdesc) -+#define SET_TX_DESC_SPE_RPT_8192F(txdesc, value) \ -+ SET_TX_DESC_SPE_RPT(txdesc, value) -+#define GET_TX_DESC_SPE_RPT_8192F(txdesc) GET_TX_DESC_SPE_RPT(txdesc) -+#define SET_TX_DESC_RAW_8192F(txdesc, value) SET_TX_DESC_RAW(txdesc, value) -+#define GET_TX_DESC_RAW_8192F(txdesc) GET_TX_DESC_RAW(txdesc) -+#define SET_TX_DESC_MOREFRAG_8192F(txdesc, value) \ -+ SET_TX_DESC_MOREFRAG(txdesc, value) -+#define GET_TX_DESC_MOREFRAG_8192F(txdesc) GET_TX_DESC_MOREFRAG(txdesc) -+#define SET_TX_DESC_BK_8192F(txdesc, value) SET_TX_DESC_BK(txdesc, value) -+#define GET_TX_DESC_BK_8192F(txdesc) GET_TX_DESC_BK(txdesc) -+#define SET_TX_DESC_NULL_1_8192F(txdesc, value) \ -+ SET_TX_DESC_NULL_1(txdesc, value) -+#define GET_TX_DESC_NULL_1_8192F(txdesc) GET_TX_DESC_NULL_1(txdesc) -+#define SET_TX_DESC_NULL_0_8192F(txdesc, value) \ -+ SET_TX_DESC_NULL_0(txdesc, value) -+#define GET_TX_DESC_NULL_0_8192F(txdesc) GET_TX_DESC_NULL_0(txdesc) -+#define SET_TX_DESC_RDG_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_RDG_EN(txdesc, value) -+#define GET_TX_DESC_RDG_EN_8192F(txdesc) GET_TX_DESC_RDG_EN(txdesc) -+#define SET_TX_DESC_AGG_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_AGG_EN(txdesc, value) -+#define GET_TX_DESC_AGG_EN_8192F(txdesc) GET_TX_DESC_AGG_EN(txdesc) -+#define SET_TX_DESC_CCA_RTS_8192F(txdesc, value) \ -+ SET_TX_DESC_CCA_RTS(txdesc, value) -+#define GET_TX_DESC_CCA_RTS_8192F(txdesc) GET_TX_DESC_CCA_RTS(txdesc) -+#define SET_TX_DESC_TRI_FRAME_8192F(txdesc, value) \ -+ SET_TX_DESC_TRI_FRAME(txdesc, value) -+#define GET_TX_DESC_TRI_FRAME_8192F(txdesc) GET_TX_DESC_TRI_FRAME(txdesc) -+#define SET_TX_DESC_P_AID_8192F(txdesc, value) SET_TX_DESC_P_AID(txdesc, value) -+#define GET_TX_DESC_P_AID_8192F(txdesc) GET_TX_DESC_P_AID(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME_8192F(txdesc, value) \ -+ SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) -+#define GET_TX_DESC_AMPDU_MAX_TIME_8192F(txdesc) \ -+ GET_TX_DESC_AMPDU_MAX_TIME(txdesc) -+#define SET_TX_DESC_NDPA_8192F(txdesc, value) SET_TX_DESC_NDPA(txdesc, value) -+#define GET_TX_DESC_NDPA_8192F(txdesc) GET_TX_DESC_NDPA(txdesc) -+#define SET_TX_DESC_MAX_AGG_NUM_8192F(txdesc, value) \ -+ SET_TX_DESC_MAX_AGG_NUM(txdesc, value) -+#define GET_TX_DESC_MAX_AGG_NUM_8192F(txdesc) GET_TX_DESC_MAX_AGG_NUM(txdesc) -+#define SET_TX_DESC_USE_MAX_TIME_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) -+#define GET_TX_DESC_USE_MAX_TIME_EN_8192F(txdesc) \ -+ GET_TX_DESC_USE_MAX_TIME_EN(txdesc) -+#define SET_TX_DESC_NAVUSEHDR_8192F(txdesc, value) \ -+ SET_TX_DESC_NAVUSEHDR(txdesc, value) -+#define GET_TX_DESC_NAVUSEHDR_8192F(txdesc) GET_TX_DESC_NAVUSEHDR(txdesc) -+#define SET_TX_DESC_CHK_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_CHK_EN(txdesc, value) -+#define GET_TX_DESC_CHK_EN_8192F(txdesc) GET_TX_DESC_CHK_EN(txdesc) -+#define SET_TX_DESC_HW_RTS_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_HW_RTS_EN(txdesc, value) -+#define GET_TX_DESC_HW_RTS_EN_8192F(txdesc) GET_TX_DESC_HW_RTS_EN(txdesc) -+#define SET_TX_DESC_RTSEN_8192F(txdesc, value) SET_TX_DESC_RTSEN(txdesc, value) -+#define GET_TX_DESC_RTSEN_8192F(txdesc) GET_TX_DESC_RTSEN(txdesc) -+#define SET_TX_DESC_CTS2SELF_8192F(txdesc, value) \ -+ SET_TX_DESC_CTS2SELF(txdesc, value) -+#define GET_TX_DESC_CTS2SELF_8192F(txdesc) GET_TX_DESC_CTS2SELF(txdesc) -+#define SET_TX_DESC_DISDATAFB_8192F(txdesc, value) \ -+ SET_TX_DESC_DISDATAFB(txdesc, value) -+#define GET_TX_DESC_DISDATAFB_8192F(txdesc) GET_TX_DESC_DISDATAFB(txdesc) -+#define SET_TX_DESC_DISRTSFB_8192F(txdesc, value) \ -+ SET_TX_DESC_DISRTSFB(txdesc, value) -+#define GET_TX_DESC_DISRTSFB_8192F(txdesc) GET_TX_DESC_DISRTSFB(txdesc) -+#define SET_TX_DESC_USE_RATE_8192F(txdesc, value) \ -+ SET_TX_DESC_USE_RATE(txdesc, value) -+#define GET_TX_DESC_USE_RATE_8192F(txdesc) GET_TX_DESC_USE_RATE(txdesc) -+#define SET_TX_DESC_HW_SSN_SEL_8192F(txdesc, value) \ -+ SET_TX_DESC_HW_SSN_SEL(txdesc, value) -+#define GET_TX_DESC_HW_SSN_SEL_8192F(txdesc) GET_TX_DESC_HW_SSN_SEL(txdesc) -+#define SET_TX_DESC_WHEADER_LEN_8192F(txdesc, value) \ -+ SET_TX_DESC_WHEADER_LEN(txdesc, value) -+#define GET_TX_DESC_WHEADER_LEN_8192F(txdesc) GET_TX_DESC_WHEADER_LEN(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX_8192F(txdesc, value) \ -+ SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) -+#define GET_TX_DESC_PCTS_MASK_IDX_8192F(txdesc) \ -+ GET_TX_DESC_PCTS_MASK_IDX(txdesc) -+#define SET_TX_DESC_PCTS_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_PCTS_EN(txdesc, value) -+#define GET_TX_DESC_PCTS_EN_8192F(txdesc) GET_TX_DESC_PCTS_EN(txdesc) -+#define SET_TX_DESC_RTSRATE_8192F(txdesc, value) \ -+ SET_TX_DESC_RTSRATE(txdesc, value) -+#define GET_TX_DESC_RTSRATE_8192F(txdesc) GET_TX_DESC_RTSRATE(txdesc) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT_8192F(txdesc, value) \ -+ SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT_8192F(txdesc) \ -+ GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) -+#define SET_TX_DESC_RTY_LMT_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_RTY_LMT_EN(txdesc, value) -+#define GET_TX_DESC_RTY_LMT_EN_8192F(txdesc) GET_TX_DESC_RTY_LMT_EN(txdesc) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE_8192F(txdesc, value) \ -+ SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE_8192F(txdesc) \ -+ GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE_8192F(txdesc, value) \ -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE_8192F(txdesc) \ -+ GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_TRY_RATE_8192F(txdesc, value) \ -+ SET_TX_DESC_TRY_RATE(txdesc, value) -+#define GET_TX_DESC_TRY_RATE_8192F(txdesc) GET_TX_DESC_TRY_RATE(txdesc) -+#define SET_TX_DESC_DATARATE_8192F(txdesc, value) \ -+ SET_TX_DESC_DATARATE(txdesc, value) -+#define GET_TX_DESC_DATARATE_8192F(txdesc) GET_TX_DESC_DATARATE(txdesc) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED_8192F(txdesc, value) \ -+ SET_TX_DESC_POLLUTED(txdesc, value) -+#define GET_TX_DESC_POLLUTED_8192F(txdesc) GET_TX_DESC_POLLUTED(txdesc) -+#define SET_TX_DESC_TXPWR_OFSET_TYPE_8192F(txdesc, value) \ -+ SET_TX_DESC_TXPWR_OFSET_TYPE_V1(txdesc, value) -+#define GET_TX_DESC_TXPWR_OFSET_TYPE_8192F(txdesc) \ -+ GET_TX_DESC_TXPWR_OFSET_TYPE_V1(txdesc) -+#define SET_TX_DESC_TX_ANT_8192F(txdesc, value) \ -+ SET_TX_DESC_TX_ANT(txdesc, value) -+#define GET_TX_DESC_TX_ANT_8192F(txdesc) GET_TX_DESC_TX_ANT(txdesc) -+#define SET_TX_DESC_DROP_ID_8192F(txdesc, value) \ -+ SET_TX_DESC_DROP_ID_V1(txdesc, value) -+#define GET_TX_DESC_DROP_ID_8192F(txdesc) GET_TX_DESC_DROP_ID_V1(txdesc) -+#define SET_TX_DESC_PORT_ID_8192F(txdesc, value) \ -+ SET_TX_DESC_PORT_ID_V1(txdesc, value) -+#define GET_TX_DESC_PORT_ID_8192F(txdesc) GET_TX_DESC_PORT_ID_V1(txdesc) -+#define SET_TX_DESC_RTS_SC_8192F(txdesc, value) \ -+ SET_TX_DESC_RTS_SC(txdesc, value) -+#define GET_TX_DESC_RTS_SC_8192F(txdesc) GET_TX_DESC_RTS_SC(txdesc) -+#define SET_TX_DESC_RTS_SHORT_8192F(txdesc, value) \ -+ SET_TX_DESC_RTS_SHORT(txdesc, value) -+#define GET_TX_DESC_RTS_SHORT_8192F(txdesc) GET_TX_DESC_RTS_SHORT(txdesc) -+#define SET_TX_DESC_VCS_STBC_8192F(txdesc, value) \ -+ SET_TX_DESC_VCS_STBC(txdesc, value) -+#define GET_TX_DESC_VCS_STBC_8192F(txdesc) GET_TX_DESC_VCS_STBC(txdesc) -+#define SET_TX_DESC_DATA_STBC_8192F(txdesc, value) \ -+ SET_TX_DESC_DATA_STBC(txdesc, value) -+#define GET_TX_DESC_DATA_STBC_8192F(txdesc) GET_TX_DESC_DATA_STBC(txdesc) -+#define SET_TX_DESC_DATA_LDPC_8192F(txdesc, value) \ -+ SET_TX_DESC_DATA_LDPC(txdesc, value) -+#define GET_TX_DESC_DATA_LDPC_8192F(txdesc) GET_TX_DESC_DATA_LDPC(txdesc) -+#define SET_TX_DESC_DATA_BW_8192F(txdesc, value) \ -+ SET_TX_DESC_DATA_BW(txdesc, value) -+#define GET_TX_DESC_DATA_BW_8192F(txdesc) GET_TX_DESC_DATA_BW(txdesc) -+#define SET_TX_DESC_DATA_SHORT_8192F(txdesc, value) \ -+ SET_TX_DESC_DATA_SHORT(txdesc, value) -+#define GET_TX_DESC_DATA_SHORT_8192F(txdesc) GET_TX_DESC_DATA_SHORT(txdesc) -+#define SET_TX_DESC_DATA_SC_8192F(txdesc, value) \ -+ SET_TX_DESC_DATA_SC(txdesc, value) -+#define GET_TX_DESC_DATA_SC_8192F(txdesc) GET_TX_DESC_DATA_SC(txdesc) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANT_MAPC_8192F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPC_V2(txdesc, value) -+#define GET_TX_DESC_ANT_MAPC_8192F(txdesc) GET_TX_DESC_ANT_MAPC_V2(txdesc) -+#define SET_TX_DESC_ANT_MAPB_8192F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPB_V2(txdesc, value) -+#define GET_TX_DESC_ANT_MAPB_8192F(txdesc) GET_TX_DESC_ANT_MAPB_V2(txdesc) -+#define SET_TX_DESC_ANT_MAPA_8192F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPA_V2(txdesc, value) -+#define GET_TX_DESC_ANT_MAPA_8192F(txdesc) GET_TX_DESC_ANT_MAPA_V2(txdesc) -+#define SET_TX_DESC_ANTSEL_D_8192F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_D_V1(txdesc, value) -+#define GET_TX_DESC_ANTSEL_D_8192F(txdesc) GET_TX_DESC_ANTSEL_D_V1(txdesc) -+#define SET_TX_DESC_ANTSEL_C_8192F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_C_V2(txdesc, value) -+#define GET_TX_DESC_ANTSEL_C_8192F(txdesc) GET_TX_DESC_ANTSEL_C_V2(txdesc) -+#define SET_TX_DESC_ANTSEL_B_8192F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_B_V2(txdesc, value) -+#define GET_TX_DESC_ANTSEL_B_8192F(txdesc) GET_TX_DESC_ANTSEL_B_V2(txdesc) -+#define SET_TX_DESC_ANTSEL_A_8192F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_A_V2(txdesc, value) -+#define GET_TX_DESC_ANTSEL_A_8192F(txdesc) GET_TX_DESC_ANTSEL_A_V2(txdesc) -+#define SET_TX_DESC_MBSSID_8192F(txdesc, value) \ -+ SET_TX_DESC_MBSSID(txdesc, value) -+#define GET_TX_DESC_MBSSID_8192F(txdesc) GET_TX_DESC_MBSSID(txdesc) -+#define SET_TX_DESC_SWPS_SEQ_8192F(txdesc, value) \ -+ SET_TX_DESC_SWPS_SEQ(txdesc, value) -+#define GET_TX_DESC_SWPS_SEQ_8192F(txdesc) GET_TX_DESC_SWPS_SEQ(txdesc) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_8192F(txdesc, value) \ -+ SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_8192F(txdesc) \ -+ GET_TX_DESC_DMA_TXAGG_NUM(txdesc) -+#define SET_TX_DESC_ANT_MAPD_8192F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPD_V2(txdesc, value) -+#define GET_TX_DESC_ANT_MAPD_8192F(txdesc) GET_TX_DESC_ANT_MAPD_V2(txdesc) -+#define SET_TX_DESC_ANTSEL_EN_8192F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_EN_V2(txdesc, value) -+#define GET_TX_DESC_ANTSEL_EN_8192F(txdesc) GET_TX_DESC_ANTSEL_EN_V2(txdesc) -+#define SET_TX_DESC_MBSSID_EX_8192F(txdesc, value) \ -+ SET_TX_DESC_MBSSID_EX_V1(txdesc, value) -+#define GET_TX_DESC_MBSSID_EX_8192F(txdesc) GET_TX_DESC_MBSSID_EX_V1(txdesc) -+#define SET_TX_DESC_TX_BUFF_SIZE_8192F(txdesc, value) \ -+ SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) -+#define GET_TX_DESC_TX_BUFF_SIZE_8192F(txdesc) GET_TX_DESC_TX_BUFF_SIZE(txdesc) -+#define SET_TX_DESC_TXDESC_CHECKSUM_8192F(txdesc, value) \ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_8192F(txdesc) \ -+ GET_TX_DESC_TXDESC_CHECKSUM(txdesc) -+#define SET_TX_DESC_TIMESTAMP_8192F(txdesc, value) \ -+ SET_TX_DESC_TIMESTAMP(txdesc, value) -+#define GET_TX_DESC_TIMESTAMP_8192F(txdesc) GET_TX_DESC_TIMESTAMP(txdesc) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TAILPAGE_L_8192F(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_L(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_L_8192F(txdesc) GET_TX_DESC_TAILPAGE_L(txdesc) -+#define SET_TX_DESC_SDIO_DMASEQ_8192F(txdesc, value) \ -+ SET_TX_DESC_SDIO_DMASEQ(txdesc, value) -+#define GET_TX_DESC_SDIO_DMASEQ_8192F(txdesc) GET_TX_DESC_SDIO_DMASEQ(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_L_8192F(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_L_8192F(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_L(txdesc) -+#define SET_TX_DESC_EN_HWSEQ_8192F(txdesc, value) \ -+ SET_TX_DESC_EN_HWSEQ(txdesc, value) -+#define GET_TX_DESC_EN_HWSEQ_8192F(txdesc) GET_TX_DESC_EN_HWSEQ(txdesc) -+#define SET_TX_DESC_DATA_RC_8192F(txdesc, value) \ -+ SET_TX_DESC_DATA_RC(txdesc, value) -+#define GET_TX_DESC_DATA_RC_8192F(txdesc) GET_TX_DESC_DATA_RC(txdesc) -+#define SET_TX_DESC_BAR_RTY_TH_8192F(txdesc, value) \ -+ SET_TX_DESC_BAR_RTY_TH(txdesc, value) -+#define GET_TX_DESC_BAR_RTY_TH_8192F(txdesc) GET_TX_DESC_BAR_RTY_TH(txdesc) -+#define SET_TX_DESC_RTS_RC_8192F(txdesc, value) \ -+ SET_TX_DESC_RTS_RC(txdesc, value) -+#define GET_TX_DESC_RTS_RC_8192F(txdesc) GET_TX_DESC_RTS_RC(txdesc) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_FINAL_DATA_RATE_8192F(txdesc, value) \ -+ SET_TX_DESC_FINAL_DATA_RATE_V1(txdesc, value) -+#define GET_TX_DESC_FINAL_DATA_RATE_8192F(txdesc) \ -+ GET_TX_DESC_FINAL_DATA_RATE_V1(txdesc) -+#define SET_TX_DESC_SW_SEQ_8192F(txdesc, value) \ -+ SET_TX_DESC_SW_SEQ(txdesc, value) -+#define GET_TX_DESC_SW_SEQ_8192F(txdesc) GET_TX_DESC_SW_SEQ(txdesc) -+#define SET_TX_DESC_PADDING_LEN_8192F(txdesc, value) \ -+ SET_TX_DESC_PADDING_LEN(txdesc, value) -+#define GET_TX_DESC_PADDING_LEN_8192F(txdesc) GET_TX_DESC_PADDING_LEN(txdesc) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET_8192F(txdesc, value) \ -+ SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET_8192F(txdesc) \ -+ GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) -+ -+/*WORD10*/ -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_DISQSELSEQ_8812F(txdesc, value) \ -+ SET_TX_DESC_DISQSELSEQ(txdesc, value) -+#define GET_TX_DESC_DISQSELSEQ_8812F(txdesc) GET_TX_DESC_DISQSELSEQ(txdesc) -+#define SET_TX_DESC_GF_8812F(txdesc, value) SET_TX_DESC_GF(txdesc, value) -+#define GET_TX_DESC_GF_8812F(txdesc) GET_TX_DESC_GF(txdesc) -+#define SET_TX_DESC_NO_ACM_8812F(txdesc, value) \ -+ SET_TX_DESC_NO_ACM(txdesc, value) -+#define GET_TX_DESC_NO_ACM_8812F(txdesc) GET_TX_DESC_NO_ACM(txdesc) -+#define SET_TX_DESC_BCNPKT_TSF_CTRL_8812F(txdesc, value) \ -+ SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc, value) -+#define GET_TX_DESC_BCNPKT_TSF_CTRL_8812F(txdesc) \ -+ GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc) -+#define SET_TX_DESC_AMSDU_PAD_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) -+#define GET_TX_DESC_AMSDU_PAD_EN_8812F(txdesc) GET_TX_DESC_AMSDU_PAD_EN(txdesc) -+#define SET_TX_DESC_LS_8812F(txdesc, value) SET_TX_DESC_LS(txdesc, value) -+#define GET_TX_DESC_LS_8812F(txdesc) GET_TX_DESC_LS(txdesc) -+#define SET_TX_DESC_HTC_8812F(txdesc, value) SET_TX_DESC_HTC(txdesc, value) -+#define GET_TX_DESC_HTC_8812F(txdesc) GET_TX_DESC_HTC(txdesc) -+#define SET_TX_DESC_BMC_8812F(txdesc, value) SET_TX_DESC_BMC(txdesc, value) -+#define GET_TX_DESC_BMC_8812F(txdesc) GET_TX_DESC_BMC(txdesc) -+#define SET_TX_DESC_OFFSET_8812F(txdesc, value) \ -+ SET_TX_DESC_OFFSET(txdesc, value) -+#define GET_TX_DESC_OFFSET_8812F(txdesc) GET_TX_DESC_OFFSET(txdesc) -+#define SET_TX_DESC_TXPKTSIZE_8812F(txdesc, value) \ -+ SET_TX_DESC_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_TXPKTSIZE_8812F(txdesc) GET_TX_DESC_TXPKTSIZE(txdesc) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_MOREDATA_8812F(txdesc, value) \ -+ SET_TX_DESC_MOREDATA(txdesc, value) -+#define GET_TX_DESC_MOREDATA_8812F(txdesc) GET_TX_DESC_MOREDATA(txdesc) -+#define SET_TX_DESC_PKT_OFFSET_8812F(txdesc, value) \ -+ SET_TX_DESC_PKT_OFFSET(txdesc, value) -+#define GET_TX_DESC_PKT_OFFSET_8812F(txdesc) GET_TX_DESC_PKT_OFFSET(txdesc) -+#define SET_TX_DESC_SEC_TYPE_8812F(txdesc, value) \ -+ SET_TX_DESC_SEC_TYPE(txdesc, value) -+#define GET_TX_DESC_SEC_TYPE_8812F(txdesc) GET_TX_DESC_SEC_TYPE(txdesc) -+#define SET_TX_DESC_EN_DESC_ID_8812F(txdesc, value) \ -+ SET_TX_DESC_EN_DESC_ID(txdesc, value) -+#define GET_TX_DESC_EN_DESC_ID_8812F(txdesc) GET_TX_DESC_EN_DESC_ID(txdesc) -+#define SET_TX_DESC_RATE_ID_8812F(txdesc, value) \ -+ SET_TX_DESC_RATE_ID(txdesc, value) -+#define GET_TX_DESC_RATE_ID_8812F(txdesc) GET_TX_DESC_RATE_ID(txdesc) -+#define SET_TX_DESC_PIFS_8812F(txdesc, value) SET_TX_DESC_PIFS(txdesc, value) -+#define GET_TX_DESC_PIFS_8812F(txdesc) GET_TX_DESC_PIFS(txdesc) -+#define SET_TX_DESC_LSIG_TXOP_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) -+#define GET_TX_DESC_LSIG_TXOP_EN_8812F(txdesc) GET_TX_DESC_LSIG_TXOP_EN(txdesc) -+#define SET_TX_DESC_RD_NAV_EXT_8812F(txdesc, value) \ -+ SET_TX_DESC_RD_NAV_EXT(txdesc, value) -+#define GET_TX_DESC_RD_NAV_EXT_8812F(txdesc) GET_TX_DESC_RD_NAV_EXT(txdesc) -+#define SET_TX_DESC_QSEL_8812F(txdesc, value) SET_TX_DESC_QSEL(txdesc, value) -+#define GET_TX_DESC_QSEL_8812F(txdesc) GET_TX_DESC_QSEL(txdesc) -+#define SET_TX_DESC_MACID_8812F(txdesc, value) SET_TX_DESC_MACID(txdesc, value) -+#define GET_TX_DESC_MACID_8812F(txdesc) GET_TX_DESC_MACID(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_HW_AES_IV_8812F(txdesc, value) \ -+ SET_TX_DESC_HW_AES_IV(txdesc, value) -+#define GET_TX_DESC_HW_AES_IV_8812F(txdesc) GET_TX_DESC_HW_AES_IV(txdesc) -+#define SET_TX_DESC_FTM_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_FTM_EN(txdesc, value) -+#define GET_TX_DESC_FTM_EN_8812F(txdesc) GET_TX_DESC_FTM_EN(txdesc) -+#define SET_TX_DESC_G_ID_8812F(txdesc, value) SET_TX_DESC_G_ID(txdesc, value) -+#define GET_TX_DESC_G_ID_8812F(txdesc) GET_TX_DESC_G_ID(txdesc) -+#define SET_TX_DESC_BT_NULL_8812F(txdesc, value) \ -+ SET_TX_DESC_BT_NULL(txdesc, value) -+#define GET_TX_DESC_BT_NULL_8812F(txdesc) GET_TX_DESC_BT_NULL(txdesc) -+#define SET_TX_DESC_AMPDU_DENSITY_8812F(txdesc, value) \ -+ SET_TX_DESC_AMPDU_DENSITY(txdesc, value) -+#define GET_TX_DESC_AMPDU_DENSITY_8812F(txdesc) \ -+ GET_TX_DESC_AMPDU_DENSITY(txdesc) -+#define SET_TX_DESC_SPE_RPT_8812F(txdesc, value) \ -+ SET_TX_DESC_SPE_RPT(txdesc, value) -+#define GET_TX_DESC_SPE_RPT_8812F(txdesc) GET_TX_DESC_SPE_RPT(txdesc) -+#define SET_TX_DESC_RAW_8812F(txdesc, value) SET_TX_DESC_RAW(txdesc, value) -+#define GET_TX_DESC_RAW_8812F(txdesc) GET_TX_DESC_RAW(txdesc) -+#define SET_TX_DESC_MOREFRAG_8812F(txdesc, value) \ -+ SET_TX_DESC_MOREFRAG(txdesc, value) -+#define GET_TX_DESC_MOREFRAG_8812F(txdesc) GET_TX_DESC_MOREFRAG(txdesc) -+#define SET_TX_DESC_BK_8812F(txdesc, value) SET_TX_DESC_BK(txdesc, value) -+#define GET_TX_DESC_BK_8812F(txdesc) GET_TX_DESC_BK(txdesc) -+#define SET_TX_DESC_NULL_1_8812F(txdesc, value) \ -+ SET_TX_DESC_NULL_1(txdesc, value) -+#define GET_TX_DESC_NULL_1_8812F(txdesc) GET_TX_DESC_NULL_1(txdesc) -+#define SET_TX_DESC_NULL_0_8812F(txdesc, value) \ -+ SET_TX_DESC_NULL_0(txdesc, value) -+#define GET_TX_DESC_NULL_0_8812F(txdesc) GET_TX_DESC_NULL_0(txdesc) -+#define SET_TX_DESC_RDG_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_RDG_EN(txdesc, value) -+#define GET_TX_DESC_RDG_EN_8812F(txdesc) GET_TX_DESC_RDG_EN(txdesc) -+#define SET_TX_DESC_AGG_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_AGG_EN(txdesc, value) -+#define GET_TX_DESC_AGG_EN_8812F(txdesc) GET_TX_DESC_AGG_EN(txdesc) -+#define SET_TX_DESC_CCA_RTS_8812F(txdesc, value) \ -+ SET_TX_DESC_CCA_RTS(txdesc, value) -+#define GET_TX_DESC_CCA_RTS_8812F(txdesc) GET_TX_DESC_CCA_RTS(txdesc) -+#define SET_TX_DESC_TRI_FRAME_8812F(txdesc, value) \ -+ SET_TX_DESC_TRI_FRAME(txdesc, value) -+#define GET_TX_DESC_TRI_FRAME_8812F(txdesc) GET_TX_DESC_TRI_FRAME(txdesc) -+#define SET_TX_DESC_P_AID_8812F(txdesc, value) SET_TX_DESC_P_AID(txdesc, value) -+#define GET_TX_DESC_P_AID_8812F(txdesc) GET_TX_DESC_P_AID(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME_8812F(txdesc, value) \ -+ SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) -+#define GET_TX_DESC_AMPDU_MAX_TIME_8812F(txdesc) \ -+ GET_TX_DESC_AMPDU_MAX_TIME(txdesc) -+#define SET_TX_DESC_NDPA_8812F(txdesc, value) SET_TX_DESC_NDPA(txdesc, value) -+#define GET_TX_DESC_NDPA_8812F(txdesc) GET_TX_DESC_NDPA(txdesc) -+#define SET_TX_DESC_MAX_AGG_NUM_8812F(txdesc, value) \ -+ SET_TX_DESC_MAX_AGG_NUM(txdesc, value) -+#define GET_TX_DESC_MAX_AGG_NUM_8812F(txdesc) GET_TX_DESC_MAX_AGG_NUM(txdesc) -+#define SET_TX_DESC_USE_MAX_TIME_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) -+#define GET_TX_DESC_USE_MAX_TIME_EN_8812F(txdesc) \ -+ GET_TX_DESC_USE_MAX_TIME_EN(txdesc) -+#define SET_TX_DESC_NAVUSEHDR_8812F(txdesc, value) \ -+ SET_TX_DESC_NAVUSEHDR(txdesc, value) -+#define GET_TX_DESC_NAVUSEHDR_8812F(txdesc) GET_TX_DESC_NAVUSEHDR(txdesc) -+#define SET_TX_DESC_CHK_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_CHK_EN(txdesc, value) -+#define GET_TX_DESC_CHK_EN_8812F(txdesc) GET_TX_DESC_CHK_EN(txdesc) -+#define SET_TX_DESC_HW_RTS_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_HW_RTS_EN(txdesc, value) -+#define GET_TX_DESC_HW_RTS_EN_8812F(txdesc) GET_TX_DESC_HW_RTS_EN(txdesc) -+#define SET_TX_DESC_RTSEN_8812F(txdesc, value) SET_TX_DESC_RTSEN(txdesc, value) -+#define GET_TX_DESC_RTSEN_8812F(txdesc) GET_TX_DESC_RTSEN(txdesc) -+#define SET_TX_DESC_CTS2SELF_8812F(txdesc, value) \ -+ SET_TX_DESC_CTS2SELF(txdesc, value) -+#define GET_TX_DESC_CTS2SELF_8812F(txdesc) GET_TX_DESC_CTS2SELF(txdesc) -+#define SET_TX_DESC_DISDATAFB_8812F(txdesc, value) \ -+ SET_TX_DESC_DISDATAFB(txdesc, value) -+#define GET_TX_DESC_DISDATAFB_8812F(txdesc) GET_TX_DESC_DISDATAFB(txdesc) -+#define SET_TX_DESC_DISRTSFB_8812F(txdesc, value) \ -+ SET_TX_DESC_DISRTSFB(txdesc, value) -+#define GET_TX_DESC_DISRTSFB_8812F(txdesc) GET_TX_DESC_DISRTSFB(txdesc) -+#define SET_TX_DESC_USE_RATE_8812F(txdesc, value) \ -+ SET_TX_DESC_USE_RATE(txdesc, value) -+#define GET_TX_DESC_USE_RATE_8812F(txdesc) GET_TX_DESC_USE_RATE(txdesc) -+#define SET_TX_DESC_HW_SSN_SEL_8812F(txdesc, value) \ -+ SET_TX_DESC_HW_SSN_SEL(txdesc, value) -+#define GET_TX_DESC_HW_SSN_SEL_8812F(txdesc) GET_TX_DESC_HW_SSN_SEL(txdesc) -+#define SET_TX_DESC_WHEADER_LEN_8812F(txdesc, value) \ -+ SET_TX_DESC_WHEADER_LEN(txdesc, value) -+#define GET_TX_DESC_WHEADER_LEN_8812F(txdesc) GET_TX_DESC_WHEADER_LEN(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX_8812F(txdesc, value) \ -+ SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) -+#define GET_TX_DESC_PCTS_MASK_IDX_8812F(txdesc) \ -+ GET_TX_DESC_PCTS_MASK_IDX(txdesc) -+#define SET_TX_DESC_PCTS_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_PCTS_EN(txdesc, value) -+#define GET_TX_DESC_PCTS_EN_8812F(txdesc) GET_TX_DESC_PCTS_EN(txdesc) -+#define SET_TX_DESC_RTSRATE_8812F(txdesc, value) \ -+ SET_TX_DESC_RTSRATE(txdesc, value) -+#define GET_TX_DESC_RTSRATE_8812F(txdesc) GET_TX_DESC_RTSRATE(txdesc) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT_8812F(txdesc, value) \ -+ SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT_8812F(txdesc) \ -+ GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) -+#define SET_TX_DESC_RTY_LMT_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_RTY_LMT_EN(txdesc, value) -+#define GET_TX_DESC_RTY_LMT_EN_8812F(txdesc) GET_TX_DESC_RTY_LMT_EN(txdesc) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE_8812F(txdesc, value) \ -+ SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE_8812F(txdesc) \ -+ GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE_8812F(txdesc, value) \ -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE_8812F(txdesc) \ -+ GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_TRY_RATE_8812F(txdesc, value) \ -+ SET_TX_DESC_TRY_RATE(txdesc, value) -+#define GET_TX_DESC_TRY_RATE_8812F(txdesc) GET_TX_DESC_TRY_RATE(txdesc) -+#define SET_TX_DESC_DATARATE_8812F(txdesc, value) \ -+ SET_TX_DESC_DATARATE(txdesc, value) -+#define GET_TX_DESC_DATARATE_8812F(txdesc) GET_TX_DESC_DATARATE(txdesc) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED_8812F(txdesc, value) \ -+ SET_TX_DESC_POLLUTED(txdesc, value) -+#define GET_TX_DESC_POLLUTED_8812F(txdesc) GET_TX_DESC_POLLUTED(txdesc) -+#define SET_TX_DESC_ANTSEL_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_EN_V1(txdesc, value) -+#define GET_TX_DESC_ANTSEL_EN_8812F(txdesc) GET_TX_DESC_ANTSEL_EN_V1(txdesc) -+#define SET_TX_DESC_TXPWR_OFSET_TYPE_8812F(txdesc, value) \ -+ SET_TX_DESC_TXPWR_OFSET_TYPE(txdesc, value) -+#define GET_TX_DESC_TXPWR_OFSET_TYPE_8812F(txdesc) \ -+ GET_TX_DESC_TXPWR_OFSET_TYPE(txdesc) -+#define SET_TX_DESC_TX_ANT_8812F(txdesc, value) \ -+ SET_TX_DESC_TX_ANT(txdesc, value) -+#define GET_TX_DESC_TX_ANT_8812F(txdesc) GET_TX_DESC_TX_ANT(txdesc) -+#define SET_TX_DESC_PORT_ID_8812F(txdesc, value) \ -+ SET_TX_DESC_PORT_ID(txdesc, value) -+#define GET_TX_DESC_PORT_ID_8812F(txdesc) GET_TX_DESC_PORT_ID(txdesc) -+#define SET_TX_DESC_MULTIPLE_PORT_8812F(txdesc, value) \ -+ SET_TX_DESC_MULTIPLE_PORT(txdesc, value) -+#define GET_TX_DESC_MULTIPLE_PORT_8812F(txdesc) \ -+ GET_TX_DESC_MULTIPLE_PORT(txdesc) -+#define SET_TX_DESC_SIGNALING_TAPKT_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TAPKT_EN(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TAPKT_EN_8812F(txdesc) \ -+ GET_TX_DESC_SIGNALING_TAPKT_EN(txdesc) -+#define SET_TX_DESC_SIGNALING_TA_PKT_SC_8812F(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TA_PKT_SC_8812F(txdesc) \ -+ GET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc) -+#define SET_TX_DESC_RTS_SHORT_8812F(txdesc, value) \ -+ SET_TX_DESC_RTS_SHORT(txdesc, value) -+#define GET_TX_DESC_RTS_SHORT_8812F(txdesc) GET_TX_DESC_RTS_SHORT(txdesc) -+#define SET_TX_DESC_VCS_STBC_8812F(txdesc, value) \ -+ SET_TX_DESC_VCS_STBC(txdesc, value) -+#define GET_TX_DESC_VCS_STBC_8812F(txdesc) GET_TX_DESC_VCS_STBC(txdesc) -+#define SET_TX_DESC_DATA_STBC_8812F(txdesc, value) \ -+ SET_TX_DESC_DATA_STBC(txdesc, value) -+#define GET_TX_DESC_DATA_STBC_8812F(txdesc) GET_TX_DESC_DATA_STBC(txdesc) -+#define SET_TX_DESC_DATA_LDPC_8812F(txdesc, value) \ -+ SET_TX_DESC_DATA_LDPC(txdesc, value) -+#define GET_TX_DESC_DATA_LDPC_8812F(txdesc) GET_TX_DESC_DATA_LDPC(txdesc) -+#define SET_TX_DESC_DATA_BW_8812F(txdesc, value) \ -+ SET_TX_DESC_DATA_BW(txdesc, value) -+#define GET_TX_DESC_DATA_BW_8812F(txdesc) GET_TX_DESC_DATA_BW(txdesc) -+#define SET_TX_DESC_DATA_SHORT_8812F(txdesc, value) \ -+ SET_TX_DESC_DATA_SHORT(txdesc, value) -+#define GET_TX_DESC_DATA_SHORT_8812F(txdesc) GET_TX_DESC_DATA_SHORT(txdesc) -+#define SET_TX_DESC_DATA_SC_8812F(txdesc, value) \ -+ SET_TX_DESC_DATA_SC(txdesc, value) -+#define GET_TX_DESC_DATA_SC_8812F(txdesc) GET_TX_DESC_DATA_SC(txdesc) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANTSEL_D_8812F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_D(txdesc, value) -+#define GET_TX_DESC_ANTSEL_D_8812F(txdesc) GET_TX_DESC_ANTSEL_D(txdesc) -+#define SET_TX_DESC_ANT_MAPD_8812F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPD(txdesc, value) -+#define GET_TX_DESC_ANT_MAPD_8812F(txdesc) GET_TX_DESC_ANT_MAPD(txdesc) -+#define SET_TX_DESC_ANT_MAPC_8812F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPC(txdesc, value) -+#define GET_TX_DESC_ANT_MAPC_8812F(txdesc) GET_TX_DESC_ANT_MAPC(txdesc) -+#define SET_TX_DESC_ANT_MAPB_8812F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPB(txdesc, value) -+#define GET_TX_DESC_ANT_MAPB_8812F(txdesc) GET_TX_DESC_ANT_MAPB(txdesc) -+#define SET_TX_DESC_ANT_MAPA_8812F(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPA(txdesc, value) -+#define GET_TX_DESC_ANT_MAPA_8812F(txdesc) GET_TX_DESC_ANT_MAPA(txdesc) -+#define SET_TX_DESC_ANTSEL_C_8812F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_C(txdesc, value) -+#define GET_TX_DESC_ANTSEL_C_8812F(txdesc) GET_TX_DESC_ANTSEL_C(txdesc) -+#define SET_TX_DESC_ANTSEL_B_8812F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_B(txdesc, value) -+#define GET_TX_DESC_ANTSEL_B_8812F(txdesc) GET_TX_DESC_ANTSEL_B(txdesc) -+#define SET_TX_DESC_ANTSEL_A_8812F(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_A(txdesc, value) -+#define GET_TX_DESC_ANTSEL_A_8812F(txdesc) GET_TX_DESC_ANTSEL_A(txdesc) -+#define SET_TX_DESC_MBSSID_8812F(txdesc, value) \ -+ SET_TX_DESC_MBSSID(txdesc, value) -+#define GET_TX_DESC_MBSSID_8812F(txdesc) GET_TX_DESC_MBSSID(txdesc) -+#define SET_TX_DESC_SW_DEFINE_8812F(txdesc, value) \ -+ SET_TX_DESC_SW_DEFINE(txdesc, value) -+#define GET_TX_DESC_SW_DEFINE_8812F(txdesc) GET_TX_DESC_SW_DEFINE(txdesc) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_8812F(txdesc, value) \ -+ SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_8812F(txdesc) \ -+ GET_TX_DESC_DMA_TXAGG_NUM(txdesc) -+#define SET_TX_DESC_FINAL_DATA_RATE_8812F(txdesc, value) \ -+ SET_TX_DESC_FINAL_DATA_RATE(txdesc, value) -+#define GET_TX_DESC_FINAL_DATA_RATE_8812F(txdesc) \ -+ GET_TX_DESC_FINAL_DATA_RATE(txdesc) -+#define SET_TX_DESC_NTX_MAP_8812F(txdesc, value) \ -+ SET_TX_DESC_NTX_MAP(txdesc, value) -+#define GET_TX_DESC_NTX_MAP_8812F(txdesc) GET_TX_DESC_NTX_MAP(txdesc) -+#define SET_TX_DESC_TX_BUFF_SIZE_8812F(txdesc, value) \ -+ SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) -+#define GET_TX_DESC_TX_BUFF_SIZE_8812F(txdesc) GET_TX_DESC_TX_BUFF_SIZE(txdesc) -+#define SET_TX_DESC_TXDESC_CHECKSUM_8812F(txdesc, value) \ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_8812F(txdesc) \ -+ GET_TX_DESC_TXDESC_CHECKSUM(txdesc) -+#define SET_TX_DESC_TIMESTAMP_8812F(txdesc, value) \ -+ SET_TX_DESC_TIMESTAMP(txdesc, value) -+#define GET_TX_DESC_TIMESTAMP_8812F(txdesc) GET_TX_DESC_TIMESTAMP(txdesc) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TXWIFI_CP_8812F(txdesc, value) \ -+ SET_TX_DESC_TXWIFI_CP(txdesc, value) -+#define GET_TX_DESC_TXWIFI_CP_8812F(txdesc) GET_TX_DESC_TXWIFI_CP(txdesc) -+#define SET_TX_DESC_MAC_CP_8812F(txdesc, value) \ -+ SET_TX_DESC_MAC_CP(txdesc, value) -+#define GET_TX_DESC_MAC_CP_8812F(txdesc) GET_TX_DESC_MAC_CP(txdesc) -+#define SET_TX_DESC_STW_PKTRE_DIS_8812F(txdesc, value) \ -+ SET_TX_DESC_STW_PKTRE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_PKTRE_DIS_8812F(txdesc) \ -+ GET_TX_DESC_STW_PKTRE_DIS(txdesc) -+#define SET_TX_DESC_STW_RB_DIS_8812F(txdesc, value) \ -+ SET_TX_DESC_STW_RB_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RB_DIS_8812F(txdesc) GET_TX_DESC_STW_RB_DIS(txdesc) -+#define SET_TX_DESC_STW_RATE_DIS_8812F(txdesc, value) \ -+ SET_TX_DESC_STW_RATE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RATE_DIS_8812F(txdesc) GET_TX_DESC_STW_RATE_DIS(txdesc) -+#define SET_TX_DESC_STW_ANT_DIS_8812F(txdesc, value) \ -+ SET_TX_DESC_STW_ANT_DIS(txdesc, value) -+#define GET_TX_DESC_STW_ANT_DIS_8812F(txdesc) GET_TX_DESC_STW_ANT_DIS(txdesc) -+#define SET_TX_DESC_STW_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_STW_EN(txdesc, value) -+#define GET_TX_DESC_STW_EN_8812F(txdesc) GET_TX_DESC_STW_EN(txdesc) -+#define SET_TX_DESC_SMH_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_SMH_EN(txdesc, value) -+#define GET_TX_DESC_SMH_EN_8812F(txdesc) GET_TX_DESC_SMH_EN(txdesc) -+#define SET_TX_DESC_TAILPAGE_L_8812F(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_L(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_L_8812F(txdesc) GET_TX_DESC_TAILPAGE_L(txdesc) -+#define SET_TX_DESC_SDIO_DMASEQ_8812F(txdesc, value) \ -+ SET_TX_DESC_SDIO_DMASEQ(txdesc, value) -+#define GET_TX_DESC_SDIO_DMASEQ_8812F(txdesc) GET_TX_DESC_SDIO_DMASEQ(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_L_8812F(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_L_8812F(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_L(txdesc) -+#define SET_TX_DESC_EN_HWSEQ_MODE_8812F(txdesc, value) \ -+ SET_TX_DESC_EN_HWSEQ_MODE(txdesc, value) -+#define GET_TX_DESC_EN_HWSEQ_MODE_8812F(txdesc) \ -+ GET_TX_DESC_EN_HWSEQ_MODE(txdesc) -+#define SET_TX_DESC_DATA_RC_8812F(txdesc, value) \ -+ SET_TX_DESC_DATA_RC(txdesc, value) -+#define GET_TX_DESC_DATA_RC_8812F(txdesc) GET_TX_DESC_DATA_RC(txdesc) -+#define SET_TX_DESC_BAR_RTY_TH_8812F(txdesc, value) \ -+ SET_TX_DESC_BAR_RTY_TH(txdesc, value) -+#define GET_TX_DESC_BAR_RTY_TH_8812F(txdesc) GET_TX_DESC_BAR_RTY_TH(txdesc) -+#define SET_TX_DESC_RTS_RC_8812F(txdesc, value) \ -+ SET_TX_DESC_RTS_RC(txdesc, value) -+#define GET_TX_DESC_RTS_RC_8812F(txdesc) GET_TX_DESC_RTS_RC(txdesc) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_TAILPAGE_H_8812F(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_H(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_H_8812F(txdesc) GET_TX_DESC_TAILPAGE_H(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_H_8812F(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_H(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_H_8812F(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_H(txdesc) -+#define SET_TX_DESC_SW_SEQ_8812F(txdesc, value) \ -+ SET_TX_DESC_SW_SEQ(txdesc, value) -+#define GET_TX_DESC_SW_SEQ_8812F(txdesc) GET_TX_DESC_SW_SEQ(txdesc) -+#define SET_TX_DESC_TXBF_PATH_8812F(txdesc, value) \ -+ SET_TX_DESC_TXBF_PATH(txdesc, value) -+#define GET_TX_DESC_TXBF_PATH_8812F(txdesc) GET_TX_DESC_TXBF_PATH(txdesc) -+#define SET_TX_DESC_PADDING_LEN_8812F(txdesc, value) \ -+ SET_TX_DESC_PADDING_LEN(txdesc, value) -+#define GET_TX_DESC_PADDING_LEN_8812F(txdesc) GET_TX_DESC_PADDING_LEN(txdesc) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET_8812F(txdesc, value) \ -+ SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET_8812F(txdesc) \ -+ GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) -+ -+/*WORD10*/ -+ -+#define SET_TX_DESC_HT_DATA_SND_8812F(txdesc, value) \ -+ SET_TX_DESC_HT_DATA_SND(txdesc, value) -+#define GET_TX_DESC_HT_DATA_SND_8812F(txdesc) GET_TX_DESC_HT_DATA_SND(txdesc) -+#define SET_TX_DESC_SHCUT_CAM_8812F(txdesc, value) \ -+ SET_TX_DESC_SHCUT_CAM(txdesc, value) -+#define GET_TX_DESC_SHCUT_CAM_8812F(txdesc) GET_TX_DESC_SHCUT_CAM(txdesc) -+#define SET_TX_DESC_MU_DATARATE_8812F(txdesc, value) \ -+ SET_TX_DESC_MU_DATARATE(txdesc, value) -+#define GET_TX_DESC_MU_DATARATE_8812F(txdesc) GET_TX_DESC_MU_DATARATE(txdesc) -+#define SET_TX_DESC_MU_RC_8812F(txdesc, value) SET_TX_DESC_MU_RC(txdesc, value) -+#define GET_TX_DESC_MU_RC_8812F(txdesc) GET_TX_DESC_MU_RC(txdesc) -+#define SET_TX_DESC_NDPA_RATE_SEL_8812F(txdesc, value) \ -+ SET_TX_DESC_NDPA_RATE_SEL(txdesc, value) -+#define GET_TX_DESC_NDPA_RATE_SEL_8812F(txdesc) \ -+ GET_TX_DESC_NDPA_RATE_SEL(txdesc) -+#define SET_TX_DESC_HW_NDPA_EN_8812F(txdesc, value) \ -+ SET_TX_DESC_HW_NDPA_EN(txdesc, value) -+#define GET_TX_DESC_HW_NDPA_EN_8812F(txdesc) GET_TX_DESC_HW_NDPA_EN(txdesc) -+#define SET_TX_DESC_SND_PKT_SEL_8812F(txdesc, value) \ -+ SET_TX_DESC_SND_PKT_SEL(txdesc, value) -+#define GET_TX_DESC_SND_PKT_SEL_8812F(txdesc) GET_TX_DESC_SND_PKT_SEL(txdesc) -+ -+#endif -+ -+#if (HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_DISQSELSEQ_8197G(txdesc, value) \ -+ SET_TX_DESC_DISQSELSEQ(txdesc, value) -+#define GET_TX_DESC_DISQSELSEQ_8197G(txdesc) GET_TX_DESC_DISQSELSEQ(txdesc) -+#define SET_TX_DESC_GF_8197G(txdesc, value) SET_TX_DESC_GF(txdesc, value) -+#define GET_TX_DESC_GF_8197G(txdesc) GET_TX_DESC_GF(txdesc) -+#define SET_TX_DESC_NO_ACM_8197G(txdesc, value) \ -+ SET_TX_DESC_NO_ACM(txdesc, value) -+#define GET_TX_DESC_NO_ACM_8197G(txdesc) GET_TX_DESC_NO_ACM(txdesc) -+#define SET_TX_DESC_BCNPKT_TSF_CTRL_8197G(txdesc, value) \ -+ SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc, value) -+#define GET_TX_DESC_BCNPKT_TSF_CTRL_8197G(txdesc) \ -+ GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc) -+#define SET_TX_DESC_AMSDU_PAD_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) -+#define GET_TX_DESC_AMSDU_PAD_EN_8197G(txdesc) GET_TX_DESC_AMSDU_PAD_EN(txdesc) -+#define SET_TX_DESC_LS_8197G(txdesc, value) SET_TX_DESC_LS(txdesc, value) -+#define GET_TX_DESC_LS_8197G(txdesc) GET_TX_DESC_LS(txdesc) -+#define SET_TX_DESC_HTC_8197G(txdesc, value) SET_TX_DESC_HTC(txdesc, value) -+#define GET_TX_DESC_HTC_8197G(txdesc) GET_TX_DESC_HTC(txdesc) -+#define SET_TX_DESC_BMC_8197G(txdesc, value) SET_TX_DESC_BMC(txdesc, value) -+#define GET_TX_DESC_BMC_8197G(txdesc) GET_TX_DESC_BMC(txdesc) -+#define SET_TX_DESC_OFFSET_8197G(txdesc, value) \ -+ SET_TX_DESC_OFFSET(txdesc, value) -+#define GET_TX_DESC_OFFSET_8197G(txdesc) GET_TX_DESC_OFFSET(txdesc) -+#define SET_TX_DESC_TXPKTSIZE_8197G(txdesc, value) \ -+ SET_TX_DESC_TXPKTSIZE(txdesc, value) -+#define GET_TX_DESC_TXPKTSIZE_8197G(txdesc) GET_TX_DESC_TXPKTSIZE(txdesc) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_HW_AES_IV_8197G(txdesc, value) \ -+ SET_TX_DESC_HW_AES_IV_V2(txdesc, value) -+#define GET_TX_DESC_HW_AES_IV_8197G(txdesc) GET_TX_DESC_HW_AES_IV_V2(txdesc) -+#define SET_TX_DESC_FTM_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_FTM_EN_V1(txdesc, value) -+#define GET_TX_DESC_FTM_EN_8197G(txdesc) GET_TX_DESC_FTM_EN_V1(txdesc) -+#define SET_TX_DESC_MOREDATA_8197G(txdesc, value) \ -+ SET_TX_DESC_MOREDATA(txdesc, value) -+#define GET_TX_DESC_MOREDATA_8197G(txdesc) GET_TX_DESC_MOREDATA(txdesc) -+#define SET_TX_DESC_PKT_OFFSET_8197G(txdesc, value) \ -+ SET_TX_DESC_PKT_OFFSET(txdesc, value) -+#define GET_TX_DESC_PKT_OFFSET_8197G(txdesc) GET_TX_DESC_PKT_OFFSET(txdesc) -+#define SET_TX_DESC_SEC_TYPE_8197G(txdesc, value) \ -+ SET_TX_DESC_SEC_TYPE(txdesc, value) -+#define GET_TX_DESC_SEC_TYPE_8197G(txdesc) GET_TX_DESC_SEC_TYPE(txdesc) -+#define SET_TX_DESC_EN_DESC_ID_8197G(txdesc, value) \ -+ SET_TX_DESC_EN_DESC_ID(txdesc, value) -+#define GET_TX_DESC_EN_DESC_ID_8197G(txdesc) GET_TX_DESC_EN_DESC_ID(txdesc) -+#define SET_TX_DESC_RATE_ID_8197G(txdesc, value) \ -+ SET_TX_DESC_RATE_ID(txdesc, value) -+#define GET_TX_DESC_RATE_ID_8197G(txdesc) GET_TX_DESC_RATE_ID(txdesc) -+#define SET_TX_DESC_PIFS_8197G(txdesc, value) SET_TX_DESC_PIFS(txdesc, value) -+#define GET_TX_DESC_PIFS_8197G(txdesc) GET_TX_DESC_PIFS(txdesc) -+#define SET_TX_DESC_LSIG_TXOP_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) -+#define GET_TX_DESC_LSIG_TXOP_EN_8197G(txdesc) GET_TX_DESC_LSIG_TXOP_EN(txdesc) -+#define SET_TX_DESC_RD_NAV_EXT_8197G(txdesc, value) \ -+ SET_TX_DESC_RD_NAV_EXT(txdesc, value) -+#define GET_TX_DESC_RD_NAV_EXT_8197G(txdesc) GET_TX_DESC_RD_NAV_EXT(txdesc) -+#define SET_TX_DESC_QSEL_8197G(txdesc, value) SET_TX_DESC_QSEL(txdesc, value) -+#define GET_TX_DESC_QSEL_8197G(txdesc) GET_TX_DESC_QSEL(txdesc) -+#define SET_TX_DESC_SPECIAL_CW_8197G(txdesc, value) \ -+ SET_TX_DESC_SPECIAL_CW(txdesc, value) -+#define GET_TX_DESC_SPECIAL_CW_8197G(txdesc) GET_TX_DESC_SPECIAL_CW(txdesc) -+#define SET_TX_DESC_MACID_8197G(txdesc, value) SET_TX_DESC_MACID(txdesc, value) -+#define GET_TX_DESC_MACID_8197G(txdesc) GET_TX_DESC_MACID(txdesc) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_ANTCEL_D_8197G(txdesc, value) \ -+ SET_TX_DESC_ANTCEL_D_V1(txdesc, value) -+#define GET_TX_DESC_ANTCEL_D_8197G(txdesc) GET_TX_DESC_ANTCEL_D_V1(txdesc) -+#define SET_TX_DESC_ANTSEL_C_8197G(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_C_V1(txdesc, value) -+#define GET_TX_DESC_ANTSEL_C_8197G(txdesc) GET_TX_DESC_ANTSEL_C_V1(txdesc) -+#define SET_TX_DESC_BT_NULL_8197G(txdesc, value) \ -+ SET_TX_DESC_BT_NULL(txdesc, value) -+#define GET_TX_DESC_BT_NULL_8197G(txdesc) GET_TX_DESC_BT_NULL(txdesc) -+#define SET_TX_DESC_AMPDU_DENSITY_8197G(txdesc, value) \ -+ SET_TX_DESC_AMPDU_DENSITY(txdesc, value) -+#define GET_TX_DESC_AMPDU_DENSITY_8197G(txdesc) \ -+ GET_TX_DESC_AMPDU_DENSITY(txdesc) -+#define SET_TX_DESC_SPE_RPT_8197G(txdesc, value) \ -+ SET_TX_DESC_SPE_RPT(txdesc, value) -+#define GET_TX_DESC_SPE_RPT_8197G(txdesc) GET_TX_DESC_SPE_RPT(txdesc) -+#define SET_TX_DESC_RAW_8197G(txdesc, value) SET_TX_DESC_RAW(txdesc, value) -+#define GET_TX_DESC_RAW_8197G(txdesc) GET_TX_DESC_RAW(txdesc) -+#define SET_TX_DESC_MOREFRAG_8197G(txdesc, value) \ -+ SET_TX_DESC_MOREFRAG(txdesc, value) -+#define GET_TX_DESC_MOREFRAG_8197G(txdesc) GET_TX_DESC_MOREFRAG(txdesc) -+#define SET_TX_DESC_BK_8197G(txdesc, value) SET_TX_DESC_BK(txdesc, value) -+#define GET_TX_DESC_BK_8197G(txdesc) GET_TX_DESC_BK(txdesc) -+#define SET_TX_DESC_NULL_1_8197G(txdesc, value) \ -+ SET_TX_DESC_NULL_1(txdesc, value) -+#define GET_TX_DESC_NULL_1_8197G(txdesc) GET_TX_DESC_NULL_1(txdesc) -+#define SET_TX_DESC_NULL_0_8197G(txdesc, value) \ -+ SET_TX_DESC_NULL_0(txdesc, value) -+#define GET_TX_DESC_NULL_0_8197G(txdesc) GET_TX_DESC_NULL_0(txdesc) -+#define SET_TX_DESC_RDG_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_RDG_EN(txdesc, value) -+#define GET_TX_DESC_RDG_EN_8197G(txdesc) GET_TX_DESC_RDG_EN(txdesc) -+#define SET_TX_DESC_AGG_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_AGG_EN(txdesc, value) -+#define GET_TX_DESC_AGG_EN_8197G(txdesc) GET_TX_DESC_AGG_EN(txdesc) -+#define SET_TX_DESC_CCA_RTS_8197G(txdesc, value) \ -+ SET_TX_DESC_CCA_RTS(txdesc, value) -+#define GET_TX_DESC_CCA_RTS_8197G(txdesc) GET_TX_DESC_CCA_RTS(txdesc) -+#define SET_TX_DESC_TRI_FRAME_8197G(txdesc, value) \ -+ SET_TX_DESC_TRI_FRAME(txdesc, value) -+#define GET_TX_DESC_TRI_FRAME_8197G(txdesc) GET_TX_DESC_TRI_FRAME(txdesc) -+#define SET_TX_DESC_P_AID_8197G(txdesc, value) SET_TX_DESC_P_AID(txdesc, value) -+#define GET_TX_DESC_P_AID_8197G(txdesc) GET_TX_DESC_P_AID(txdesc) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME_8197G(txdesc, value) \ -+ SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) -+#define GET_TX_DESC_AMPDU_MAX_TIME_8197G(txdesc) \ -+ GET_TX_DESC_AMPDU_MAX_TIME(txdesc) -+#define SET_TX_DESC_NDPA_8197G(txdesc, value) SET_TX_DESC_NDPA(txdesc, value) -+#define GET_TX_DESC_NDPA_8197G(txdesc) GET_TX_DESC_NDPA(txdesc) -+#define SET_TX_DESC_MAX_AGG_NUM_8197G(txdesc, value) \ -+ SET_TX_DESC_MAX_AGG_NUM(txdesc, value) -+#define GET_TX_DESC_MAX_AGG_NUM_8197G(txdesc) GET_TX_DESC_MAX_AGG_NUM(txdesc) -+#define SET_TX_DESC_USE_MAX_TIME_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) -+#define GET_TX_DESC_USE_MAX_TIME_EN_8197G(txdesc) \ -+ GET_TX_DESC_USE_MAX_TIME_EN(txdesc) -+#define SET_TX_DESC_NAVUSEHDR_8197G(txdesc, value) \ -+ SET_TX_DESC_NAVUSEHDR(txdesc, value) -+#define GET_TX_DESC_NAVUSEHDR_8197G(txdesc) GET_TX_DESC_NAVUSEHDR(txdesc) -+#define SET_TX_DESC_CHK_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_CHK_EN(txdesc, value) -+#define GET_TX_DESC_CHK_EN_8197G(txdesc) GET_TX_DESC_CHK_EN(txdesc) -+#define SET_TX_DESC_HW_RTS_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_HW_RTS_EN(txdesc, value) -+#define GET_TX_DESC_HW_RTS_EN_8197G(txdesc) GET_TX_DESC_HW_RTS_EN(txdesc) -+#define SET_TX_DESC_RTSEN_8197G(txdesc, value) SET_TX_DESC_RTSEN(txdesc, value) -+#define GET_TX_DESC_RTSEN_8197G(txdesc) GET_TX_DESC_RTSEN(txdesc) -+#define SET_TX_DESC_CTS2SELF_8197G(txdesc, value) \ -+ SET_TX_DESC_CTS2SELF(txdesc, value) -+#define GET_TX_DESC_CTS2SELF_8197G(txdesc) GET_TX_DESC_CTS2SELF(txdesc) -+#define SET_TX_DESC_DISDATAFB_8197G(txdesc, value) \ -+ SET_TX_DESC_DISDATAFB(txdesc, value) -+#define GET_TX_DESC_DISDATAFB_8197G(txdesc) GET_TX_DESC_DISDATAFB(txdesc) -+#define SET_TX_DESC_DISRTSFB_8197G(txdesc, value) \ -+ SET_TX_DESC_DISRTSFB(txdesc, value) -+#define GET_TX_DESC_DISRTSFB_8197G(txdesc) GET_TX_DESC_DISRTSFB(txdesc) -+#define SET_TX_DESC_USE_RATE_8197G(txdesc, value) \ -+ SET_TX_DESC_USE_RATE(txdesc, value) -+#define GET_TX_DESC_USE_RATE_8197G(txdesc) GET_TX_DESC_USE_RATE(txdesc) -+#define SET_TX_DESC_HW_SSN_SEL_8197G(txdesc, value) \ -+ SET_TX_DESC_HW_SSN_SEL(txdesc, value) -+#define GET_TX_DESC_HW_SSN_SEL_8197G(txdesc) GET_TX_DESC_HW_SSN_SEL(txdesc) -+#define SET_TX_DESC_WHEADER_LEN_8197G(txdesc, value) \ -+ SET_TX_DESC_WHEADER_LEN(txdesc, value) -+#define GET_TX_DESC_WHEADER_LEN_8197G(txdesc) GET_TX_DESC_WHEADER_LEN(txdesc) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX_8197G(txdesc, value) \ -+ SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) -+#define GET_TX_DESC_PCTS_MASK_IDX_8197G(txdesc) \ -+ GET_TX_DESC_PCTS_MASK_IDX(txdesc) -+#define SET_TX_DESC_PCTS_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_PCTS_EN(txdesc, value) -+#define GET_TX_DESC_PCTS_EN_8197G(txdesc) GET_TX_DESC_PCTS_EN(txdesc) -+#define SET_TX_DESC_RTSRATE_8197G(txdesc, value) \ -+ SET_TX_DESC_RTSRATE(txdesc, value) -+#define GET_TX_DESC_RTSRATE_8197G(txdesc) GET_TX_DESC_RTSRATE(txdesc) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT_8197G(txdesc, value) \ -+ SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT_8197G(txdesc) \ -+ GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) -+#define SET_TX_DESC_RTY_LMT_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_RTY_LMT_EN(txdesc, value) -+#define GET_TX_DESC_RTY_LMT_EN_8197G(txdesc) GET_TX_DESC_RTY_LMT_EN(txdesc) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE_8197G(txdesc, value) \ -+ SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE_8197G(txdesc) \ -+ GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE_8197G(txdesc, value) \ -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE_8197G(txdesc) \ -+ GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) -+#define SET_TX_DESC_TRY_RATE_8197G(txdesc, value) \ -+ SET_TX_DESC_TRY_RATE(txdesc, value) -+#define GET_TX_DESC_TRY_RATE_8197G(txdesc) GET_TX_DESC_TRY_RATE(txdesc) -+#define SET_TX_DESC_DATARATE_8197G(txdesc, value) \ -+ SET_TX_DESC_DATARATE(txdesc, value) -+#define GET_TX_DESC_DATARATE_8197G(txdesc) GET_TX_DESC_DATARATE(txdesc) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED_8197G(txdesc, value) \ -+ SET_TX_DESC_POLLUTED(txdesc, value) -+#define GET_TX_DESC_POLLUTED_8197G(txdesc) GET_TX_DESC_POLLUTED(txdesc) -+#define SET_TX_DESC_TXPWR_OFSET_8197G(txdesc, value) \ -+ SET_TX_DESC_TXPWR_OFSET(txdesc, value) -+#define GET_TX_DESC_TXPWR_OFSET_8197G(txdesc) GET_TX_DESC_TXPWR_OFSET(txdesc) -+#define SET_TX_DESC_DROP_ID_8197G(txdesc, value) \ -+ SET_TX_DESC_DROP_ID(txdesc, value) -+#define GET_TX_DESC_DROP_ID_8197G(txdesc) GET_TX_DESC_DROP_ID(txdesc) -+#define SET_TX_DESC_PORT_ID_8197G(txdesc, value) \ -+ SET_TX_DESC_PORT_ID(txdesc, value) -+#define GET_TX_DESC_PORT_ID_8197G(txdesc) GET_TX_DESC_PORT_ID(txdesc) -+#define SET_TX_DESC_MULTIPLE_PORT_8197G(txdesc, value) \ -+ SET_TX_DESC_MULTIPLE_PORT(txdesc, value) -+#define GET_TX_DESC_MULTIPLE_PORT_8197G(txdesc) \ -+ GET_TX_DESC_MULTIPLE_PORT(txdesc) -+#define SET_TX_DESC_SIGNALING_TAPKT_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_SIGNALING_TAPKT_EN(txdesc, value) -+#define GET_TX_DESC_SIGNALING_TAPKT_EN_8197G(txdesc) \ -+ GET_TX_DESC_SIGNALING_TAPKT_EN(txdesc) -+#define SET_TX_DESC_RTS_SC_8197G(txdesc, value) \ -+ SET_TX_DESC_RTS_SC(txdesc, value) -+#define GET_TX_DESC_RTS_SC_8197G(txdesc) GET_TX_DESC_RTS_SC(txdesc) -+#define SET_TX_DESC_RTS_SHORT_8197G(txdesc, value) \ -+ SET_TX_DESC_RTS_SHORT(txdesc, value) -+#define GET_TX_DESC_RTS_SHORT_8197G(txdesc) GET_TX_DESC_RTS_SHORT(txdesc) -+#define SET_TX_DESC_VCS_STBC_8197G(txdesc, value) \ -+ SET_TX_DESC_VCS_STBC(txdesc, value) -+#define GET_TX_DESC_VCS_STBC_8197G(txdesc) GET_TX_DESC_VCS_STBC(txdesc) -+#define SET_TX_DESC_DATA_STBC_8197G(txdesc, value) \ -+ SET_TX_DESC_DATA_STBC(txdesc, value) -+#define GET_TX_DESC_DATA_STBC_8197G(txdesc) GET_TX_DESC_DATA_STBC(txdesc) -+#define SET_TX_DESC_DATA_LDPC_8197G(txdesc, value) \ -+ SET_TX_DESC_DATA_LDPC(txdesc, value) -+#define GET_TX_DESC_DATA_LDPC_8197G(txdesc) GET_TX_DESC_DATA_LDPC(txdesc) -+#define SET_TX_DESC_DATA_BW_8197G(txdesc, value) \ -+ SET_TX_DESC_DATA_BW(txdesc, value) -+#define GET_TX_DESC_DATA_BW_8197G(txdesc) GET_TX_DESC_DATA_BW(txdesc) -+#define SET_TX_DESC_DATA_SHORT_8197G(txdesc, value) \ -+ SET_TX_DESC_DATA_SHORT(txdesc, value) -+#define GET_TX_DESC_DATA_SHORT_8197G(txdesc) GET_TX_DESC_DATA_SHORT(txdesc) -+#define SET_TX_DESC_DATA_SC_8197G(txdesc, value) \ -+ SET_TX_DESC_DATA_SC(txdesc, value) -+#define GET_TX_DESC_DATA_SC_8197G(txdesc) GET_TX_DESC_DATA_SC(txdesc) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANT_MAPD_8197G(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPD_V1(txdesc, value) -+#define GET_TX_DESC_ANT_MAPD_8197G(txdesc) GET_TX_DESC_ANT_MAPD_V1(txdesc) -+#define SET_TX_DESC_ANT_MAPC_8197G(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPC_V1(txdesc, value) -+#define GET_TX_DESC_ANT_MAPC_8197G(txdesc) GET_TX_DESC_ANT_MAPC_V1(txdesc) -+#define SET_TX_DESC_ANT_MAPB_8197G(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPB_V1(txdesc, value) -+#define GET_TX_DESC_ANT_MAPB_8197G(txdesc) GET_TX_DESC_ANT_MAPB_V1(txdesc) -+#define SET_TX_DESC_ANT_MAPA_8197G(txdesc, value) \ -+ SET_TX_DESC_ANT_MAPA_V1(txdesc, value) -+#define GET_TX_DESC_ANT_MAPA_8197G(txdesc) GET_TX_DESC_ANT_MAPA_V1(txdesc) -+#define SET_TX_DESC_ANTSEL_B_8197G(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_B_V1(txdesc, value) -+#define GET_TX_DESC_ANTSEL_B_8197G(txdesc) GET_TX_DESC_ANTSEL_B_V1(txdesc) -+#define SET_TX_DESC_ANTSEL_A_8197G(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_A_V1(txdesc, value) -+#define GET_TX_DESC_ANTSEL_A_8197G(txdesc) GET_TX_DESC_ANTSEL_A_V1(txdesc) -+#define SET_TX_DESC_MBSSID_8197G(txdesc, value) \ -+ SET_TX_DESC_MBSSID(txdesc, value) -+#define GET_TX_DESC_MBSSID_8197G(txdesc) GET_TX_DESC_MBSSID(txdesc) -+#define SET_TX_DESC_SWPS_SEQ_8197G(txdesc, value) \ -+ SET_TX_DESC_SWPS_SEQ(txdesc, value) -+#define GET_TX_DESC_SWPS_SEQ_8197G(txdesc) GET_TX_DESC_SWPS_SEQ(txdesc) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_8197G(txdesc, value) \ -+ SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_8197G(txdesc) \ -+ GET_TX_DESC_DMA_TXAGG_NUM(txdesc) -+#define SET_TX_DESC_FINAL_DATA_RATE_8197G(txdesc, value) \ -+ SET_TX_DESC_FINAL_DATA_RATE(txdesc, value) -+#define GET_TX_DESC_FINAL_DATA_RATE_8197G(txdesc) \ -+ GET_TX_DESC_FINAL_DATA_RATE(txdesc) -+#define SET_TX_DESC_NTX_MAP_8197G(txdesc, value) \ -+ SET_TX_DESC_NTX_MAP(txdesc, value) -+#define GET_TX_DESC_NTX_MAP_8197G(txdesc) GET_TX_DESC_NTX_MAP(txdesc) -+#define SET_TX_DESC_ANTSEL_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_ANTSEL_EN(txdesc, value) -+#define GET_TX_DESC_ANTSEL_EN_8197G(txdesc) GET_TX_DESC_ANTSEL_EN(txdesc) -+#define SET_TX_DESC_MBSSID_EX_8197G(txdesc, value) \ -+ SET_TX_DESC_MBSSID_EX(txdesc, value) -+#define GET_TX_DESC_MBSSID_EX_8197G(txdesc) GET_TX_DESC_MBSSID_EX(txdesc) -+#define SET_TX_DESC_TX_BUFF_SIZE_8197G(txdesc, value) \ -+ SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) -+#define GET_TX_DESC_TX_BUFF_SIZE_8197G(txdesc) GET_TX_DESC_TX_BUFF_SIZE(txdesc) -+#define SET_TX_DESC_TXDESC_CHECKSUM_8197G(txdesc, value) \ -+ SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_8197G(txdesc) \ -+ GET_TX_DESC_TXDESC_CHECKSUM(txdesc) -+#define SET_TX_DESC_TIMESTAMP_8197G(txdesc, value) \ -+ SET_TX_DESC_TIMESTAMP(txdesc, value) -+#define GET_TX_DESC_TIMESTAMP_8197G(txdesc) GET_TX_DESC_TIMESTAMP(txdesc) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TXWIFI_CP_8197G(txdesc, value) \ -+ SET_TX_DESC_TXWIFI_CP(txdesc, value) -+#define GET_TX_DESC_TXWIFI_CP_8197G(txdesc) GET_TX_DESC_TXWIFI_CP(txdesc) -+#define SET_TX_DESC_MAC_CP_8197G(txdesc, value) \ -+ SET_TX_DESC_MAC_CP(txdesc, value) -+#define GET_TX_DESC_MAC_CP_8197G(txdesc) GET_TX_DESC_MAC_CP(txdesc) -+#define SET_TX_DESC_STW_PKTRE_DIS_8197G(txdesc, value) \ -+ SET_TX_DESC_STW_PKTRE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_PKTRE_DIS_8197G(txdesc) \ -+ GET_TX_DESC_STW_PKTRE_DIS(txdesc) -+#define SET_TX_DESC_STW_RB_DIS_8197G(txdesc, value) \ -+ SET_TX_DESC_STW_RB_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RB_DIS_8197G(txdesc) GET_TX_DESC_STW_RB_DIS(txdesc) -+#define SET_TX_DESC_STW_RATE_DIS_8197G(txdesc, value) \ -+ SET_TX_DESC_STW_RATE_DIS(txdesc, value) -+#define GET_TX_DESC_STW_RATE_DIS_8197G(txdesc) GET_TX_DESC_STW_RATE_DIS(txdesc) -+#define SET_TX_DESC_STW_ANT_DIS_8197G(txdesc, value) \ -+ SET_TX_DESC_STW_ANT_DIS(txdesc, value) -+#define GET_TX_DESC_STW_ANT_DIS_8197G(txdesc) GET_TX_DESC_STW_ANT_DIS(txdesc) -+#define SET_TX_DESC_STW_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_STW_EN(txdesc, value) -+#define GET_TX_DESC_STW_EN_8197G(txdesc) GET_TX_DESC_STW_EN(txdesc) -+#define SET_TX_DESC_SMH_EN_8197G(txdesc, value) \ -+ SET_TX_DESC_SMH_EN(txdesc, value) -+#define GET_TX_DESC_SMH_EN_8197G(txdesc) GET_TX_DESC_SMH_EN(txdesc) -+#define SET_TX_DESC_TAILPAGE_L_8197G(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_L(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_L_8197G(txdesc) GET_TX_DESC_TAILPAGE_L(txdesc) -+#define SET_TX_DESC_SDIO_DMASEQ_8197G(txdesc, value) \ -+ SET_TX_DESC_SDIO_DMASEQ(txdesc, value) -+#define GET_TX_DESC_SDIO_DMASEQ_8197G(txdesc) GET_TX_DESC_SDIO_DMASEQ(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_L_8197G(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_L_8197G(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_L(txdesc) -+#define SET_TX_DESC_EN_HWSEQ_MODE_8197G(txdesc, value) \ -+ SET_TX_DESC_EN_HWSEQ_MODE(txdesc, value) -+#define GET_TX_DESC_EN_HWSEQ_MODE_8197G(txdesc) \ -+ GET_TX_DESC_EN_HWSEQ_MODE(txdesc) -+#define SET_TX_DESC_DATA_RC_8197G(txdesc, value) \ -+ SET_TX_DESC_DATA_RC(txdesc, value) -+#define GET_TX_DESC_DATA_RC_8197G(txdesc) GET_TX_DESC_DATA_RC(txdesc) -+#define SET_TX_DESC_BAR_RTY_TH_8197G(txdesc, value) \ -+ SET_TX_DESC_BAR_RTY_TH(txdesc, value) -+#define GET_TX_DESC_BAR_RTY_TH_8197G(txdesc) GET_TX_DESC_BAR_RTY_TH(txdesc) -+#define SET_TX_DESC_RTS_RC_8197G(txdesc, value) \ -+ SET_TX_DESC_RTS_RC(txdesc, value) -+#define GET_TX_DESC_RTS_RC_8197G(txdesc) GET_TX_DESC_RTS_RC(txdesc) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_TAILPAGE_H_8197G(txdesc, value) \ -+ SET_TX_DESC_TAILPAGE_H(txdesc, value) -+#define GET_TX_DESC_TAILPAGE_H_8197G(txdesc) GET_TX_DESC_TAILPAGE_H(txdesc) -+#define SET_TX_DESC_NEXTHEADPAGE_H_8197G(txdesc, value) \ -+ SET_TX_DESC_NEXTHEADPAGE_H(txdesc, value) -+#define GET_TX_DESC_NEXTHEADPAGE_H_8197G(txdesc) \ -+ GET_TX_DESC_NEXTHEADPAGE_H(txdesc) -+#define SET_TX_DESC_SW_SEQ_8197G(txdesc, value) \ -+ SET_TX_DESC_SW_SEQ(txdesc, value) -+#define GET_TX_DESC_SW_SEQ_8197G(txdesc) GET_TX_DESC_SW_SEQ(txdesc) -+#define SET_TX_DESC_TXBF_PATH_8197G(txdesc, value) \ -+ SET_TX_DESC_TXBF_PATH(txdesc, value) -+#define GET_TX_DESC_TXBF_PATH_8197G(txdesc) GET_TX_DESC_TXBF_PATH(txdesc) -+#define SET_TX_DESC_PADDING_LEN_8197G(txdesc, value) \ -+ SET_TX_DESC_PADDING_LEN(txdesc, value) -+#define GET_TX_DESC_PADDING_LEN_8197G(txdesc) GET_TX_DESC_PADDING_LEN(txdesc) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET_8197G(txdesc, value) \ -+ SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET_8197G(txdesc) \ -+ GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) -+ -+/*WORD10*/ -+ -+#define SET_TX_DESC_SHCUT_CAM_8197G(txdesc, value) \ -+ SET_TX_DESC_SHCUT_CAM(txdesc, value) -+#define GET_TX_DESC_SHCUT_CAM_8197G(txdesc) GET_TX_DESC_SHCUT_CAM(txdesc) -+#define SET_TX_DESC_SND_PKT_SEL_8197G(txdesc, value) \ -+ SET_TX_DESC_SND_PKT_SEL(txdesc, value) -+#define GET_TX_DESC_SND_PKT_SEL_8197G(txdesc) GET_TX_DESC_SND_PKT_SEL(txdesc) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ie_ap.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ie_ap.h -new file mode 100644 -index 000000000..752479308 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ie_ap.h -@@ -0,0 +1,1005 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TX_DESC_IE_AP_H_ -+#define _HALMAC_TX_DESC_IE_AP_H_ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define IE0_GET_TX_DESC_IE_END(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 31) -+#define IE0_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE0_SET_TX_DESC_IE_END_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE0_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 30) -+#define IE0_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE0_SET_TX_DESC_IE_UP_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE0_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xf, 24) -+#define IE0_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE0_SET_TX_DESC_IE_NUM_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE0_GET_TX_DESC_ARFR_TABLE_SEL(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 19) -+#define IE0_SET_TX_DESC_ARFR_TABLE_SEL(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 19) -+#define IE0_SET_TX_DESC_ARFR_TABLE_SEL_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 19) -+#define IE0_GET_TX_DESC_ARFR_HT_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 18) -+#define IE0_SET_TX_DESC_ARFR_HT_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 18) -+#define IE0_SET_TX_DESC_ARFR_HT_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 18) -+#define IE0_GET_TX_DESC_ARFR_OFDM_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 17) -+#define IE0_SET_TX_DESC_ARFR_OFDM_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 17) -+#define IE0_SET_TX_DESC_ARFR_OFDM_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 17) -+#define IE0_GET_TX_DESC_ARFR_CCK_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 16) -+#define IE0_SET_TX_DESC_ARFR_CCK_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 16) -+#define IE0_SET_TX_DESC_ARFR_CCK_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 16) -+#define IE0_GET_TX_DESC_HW_RTS_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 9) -+#define IE0_SET_TX_DESC_HW_RTS_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 9) -+#define IE0_SET_TX_DESC_HW_RTS_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 9) -+#define IE0_GET_TX_DESC_RTS_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 8) -+#define IE0_SET_TX_DESC_RTS_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 8) -+#define IE0_SET_TX_DESC_RTS_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 8) -+#define IE0_GET_TX_DESC_CTS2SELF(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 7) -+#define IE0_SET_TX_DESC_CTS2SELF(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 7) -+#define IE0_SET_TX_DESC_CTS2SELF_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 7) -+#define IE0_GET_TX_DESC_RTY_LMT_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 6) -+#define IE0_SET_TX_DESC_RTY_LMT_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 6) -+#define IE0_SET_TX_DESC_RTY_LMT_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 6) -+#define IE0_GET_TX_DESC_RTS_SHORT(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 5) -+#define IE0_SET_TX_DESC_RTS_SHORT(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 5) -+#define IE0_SET_TX_DESC_RTS_SHORT_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 5) -+#define IE0_GET_TX_DESC_DISDATAFB(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 4) -+#define IE0_SET_TX_DESC_DISDATAFB(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 4) -+#define IE0_SET_TX_DESC_DISDATAFB_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 4) -+#define IE0_GET_TX_DESC_DISRTSFB(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 3) -+#define IE0_SET_TX_DESC_DISRTSFB(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 3) -+#define IE0_SET_TX_DESC_DISRTSFB_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 3) -+#define IE0_GET_TX_DESC_DATA_SHORT(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 2) -+#define IE0_SET_TX_DESC_DATA_SHORT(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 2) -+#define IE0_SET_TX_DESC_DATA_SHORT_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 2) -+#define IE0_GET_TX_DESC_TRY_RATE(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 1) -+#define IE0_SET_TX_DESC_TRY_RATE(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 1) -+#define IE0_SET_TX_DESC_TRY_RATE_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 1) -+#define IE0_GET_TX_DESC_USERATE(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 0) -+#define IE0_SET_TX_DESC_USERATE(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 0) -+#define IE0_SET_TX_DESC_USERATE_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 0) -+#define IE0_GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xf, 27) -+#define IE0_SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 27) -+#define IE0_SET_TX_DESC_RTS_RTY_LOWEST_RATE_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 27) -+#define IE0_GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x1f, 22) -+#define IE0_SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1f, 22) -+#define IE0_SET_TX_DESC_DATA_RTY_LOWEST_RATE_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1f, 22) -+#define IE0_GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3f, 16) -+#define IE0_SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3f, 16) -+#define IE0_SET_TX_DESC_RTS_DATA_RTY_LMT_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3f, 16) -+#define IE0_GET_TX_DESC_DATA_BW(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3, 12) -+#define IE0_SET_TX_DESC_DATA_BW(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 12) -+#define IE0_SET_TX_DESC_DATA_BW_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 12) -+#define IE0_GET_TX_DESC_RTSRATE(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xf, 7) -+#define IE0_SET_TX_DESC_RTSRATE(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 7) -+#define IE0_SET_TX_DESC_RTSRATE_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 7) -+#define IE0_GET_TX_DESC_DATARATE(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x7f, 0) -+#define IE0_SET_TX_DESC_DATARATE(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x7f, 0) -+#define IE0_SET_TX_DESC_DATARATE_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x7f, 0) -+#define IE1_GET_TX_DESC_IE_END(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 31) -+#define IE1_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE1_SET_TX_DESC_IE_END_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE1_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 30) -+#define IE1_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE1_SET_TX_DESC_IE_UP_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE1_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xf, 24) -+#define IE1_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE1_SET_TX_DESC_IE_NUM_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE1_GET_TX_DESC_AMPDU_DENSITY(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x7, 21) -+#define IE1_SET_TX_DESC_AMPDU_DENSITY(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x7, 21) -+#define IE1_SET_TX_DESC_AMPDU_DENSITY_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x7, 21) -+#define IE1_GET_TX_DESC_MAX_AGG_NUM(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1f, 16) -+#define IE1_SET_TX_DESC_MAX_AGG_NUM(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1f, 16) -+#define IE1_SET_TX_DESC_MAX_AGG_NUM_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1f, 16) -+#define IE1_GET_TX_DESC_SECTYPE(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x3, 14) -+#define IE1_SET_TX_DESC_SECTYPE(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x3, 14) -+#define IE1_SET_TX_DESC_SECTYPE_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x3, 14) -+#define IE1_GET_TX_DESC_MOREFRAG(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 13) -+#define IE1_SET_TX_DESC_MOREFRAG(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 13) -+#define IE1_SET_TX_DESC_MOREFRAG_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 13) -+#define IE1_GET_TX_DESC_NOACM(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 12) -+#define IE1_SET_TX_DESC_NOACM(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 12) -+#define IE1_SET_TX_DESC_NOACM_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 12) -+#define IE1_GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 11) -+#define IE1_SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 11) -+#define IE1_SET_TX_DESC_BCNPKT_TSF_CTRL_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 11) -+#define IE1_GET_TX_DESC_NAVUSEHDR(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 10) -+#define IE1_SET_TX_DESC_NAVUSEHDR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 10) -+#define IE1_SET_TX_DESC_NAVUSEHDR_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 10) -+#define IE1_GET_TX_DESC_HTC(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 9) -+#define IE1_SET_TX_DESC_HTC(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 9) -+#define IE1_SET_TX_DESC_HTC_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 9) -+#define IE1_GET_TX_DESC_BMC(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 8) -+#define IE1_SET_TX_DESC_BMC(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 8) -+#define IE1_SET_TX_DESC_BMC_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 8) -+#define IE1_GET_TX_DESC_TX_PKT_AFTER_PIFS(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 7) -+#define IE1_SET_TX_DESC_TX_PKT_AFTER_PIFS(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 7) -+#define IE1_SET_TX_DESC_TX_PKT_AFTER_PIFS_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 7) -+#define IE1_GET_TX_DESC_USE_MAX_TIME_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 6) -+#define IE1_SET_TX_DESC_USE_MAX_TIME_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 6) -+#define IE1_SET_TX_DESC_USE_MAX_TIME_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 6) -+#define IE1_GET_TX_DESC_HW_SSN_SEL(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x3, 4) -+#define IE1_SET_TX_DESC_HW_SSN_SEL(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x3, 4) -+#define IE1_SET_TX_DESC_HW_SSN_SEL_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x3, 4) -+#define IE1_GET_TX_DESC_DISQSELSEQ(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 3) -+#define IE1_SET_TX_DESC_DISQSELSEQ(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 3) -+#define IE1_SET_TX_DESC_DISQSELSEQ_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 3) -+#define IE1_GET_TX_DESC_EN_HWSEQ(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 2) -+#define IE1_SET_TX_DESC_EN_HWSEQ(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 2) -+#define IE1_SET_TX_DESC_EN_HWSEQ_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 2) -+#define IE1_GET_TX_DESC_EN_HWEXSEQ(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 1) -+#define IE1_SET_TX_DESC_EN_HWEXSEQ(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 1) -+#define IE1_SET_TX_DESC_EN_HWEXSEQ_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 1) -+#define IE1_GET_TX_DESC_EN_DESC_ID(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 0) -+#define IE1_SET_TX_DESC_EN_DESC_ID(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 0) -+#define IE1_SET_TX_DESC_EN_DESC_ID_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 0) -+#define IE1_GET_TX_DESC_AMPDU_MAX_TIME(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xff, 24) -+#define IE1_SET_TX_DESC_AMPDU_MAX_TIME(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xff, 24) -+#define IE1_SET_TX_DESC_AMPDU_MAX_TIME_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xff, 24) -+#define IE1_GET_TX_DESC_P_AID(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x1ff, 15) -+#define IE1_SET_TX_DESC_P_AID(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1ff, \ -+ 15) -+#define IE1_SET_TX_DESC_P_AID_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1ff, \ -+ 15) -+#define IE1_GET_TX_DESC_MOREDATA(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x1, 14) -+#define IE1_SET_TX_DESC_MOREDATA(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1, 14) -+#define IE1_SET_TX_DESC_MOREDATA_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1, 14) -+#define IE1_GET_TX_DESC_SW_SEQ(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xfff, 0) -+#define IE1_SET_TX_DESC_SW_SEQ(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xfff, 0) -+#define IE1_SET_TX_DESC_SW_SEQ_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xfff, 0) -+#define IE2_GET_TX_DESC_IE_END(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 31) -+#define IE2_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE2_SET_TX_DESC_IE_END_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE2_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 30) -+#define IE2_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE2_SET_TX_DESC_IE_UP_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE2_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xf, 24) -+#define IE2_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE2_SET_TX_DESC_IE_NUM_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE2_GET_TX_DESC_ADDR_CAM(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xff, 16) -+#define IE2_SET_TX_DESC_ADDR_CAM(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xff, 16) -+#define IE2_SET_TX_DESC_ADDR_CAM_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xff, 16) -+#define IE2_GET_TX_DESC_MULTIPLE_PORT(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x7, 12) -+#define IE2_SET_TX_DESC_MULTIPLE_PORT(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x7, 12) -+#define IE2_SET_TX_DESC_MULTIPLE_PORT_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x7, 12) -+#define IE2_GET_TX_DESC_RAW(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 11) -+#define IE2_SET_TX_DESC_RAW(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 11) -+#define IE2_SET_TX_DESC_RAW_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 11) -+#define IE2_GET_TX_DESC_RDG_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 10) -+#define IE2_SET_TX_DESC_RDG_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 10) -+#define IE2_SET_TX_DESC_RDG_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 10) -+#define IE2_GET_TX_DESC_SPECIAL_CW(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 7) -+#define IE2_SET_TX_DESC_SPECIAL_CW(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 7) -+#define IE2_SET_TX_DESC_SPECIAL_CW_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 7) -+#define IE2_GET_TX_DESC_POLLUTED(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 6) -+#define IE2_SET_TX_DESC_POLLUTED(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 6) -+#define IE2_SET_TX_DESC_POLLUTED_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 6) -+#define IE2_GET_TX_DESC_BT_NULL(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 5) -+#define IE2_SET_TX_DESC_BT_NULL(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 5) -+#define IE2_SET_TX_DESC_BT_NULL_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 5) -+#define IE2_GET_TX_DESC_NULL_1(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 4) -+#define IE2_SET_TX_DESC_NULL_1(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 4) -+#define IE2_SET_TX_DESC_NULL_1_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 4) -+#define IE2_GET_TX_DESC_NULL_0(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 3) -+#define IE2_SET_TX_DESC_NULL_0(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 3) -+#define IE2_SET_TX_DESC_NULL_0_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 3) -+#define IE2_GET_TX_DESC_TRI_FRAME(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 2) -+#define IE2_SET_TX_DESC_TRI_FRAME(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 2) -+#define IE2_SET_TX_DESC_TRI_FRAME_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 2) -+#define IE2_GET_TX_DESC_SPE_RPT(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 1) -+#define IE2_SET_TX_DESC_SPE_RPT(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 1) -+#define IE2_SET_TX_DESC_SPE_RPT_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 1) -+#define IE2_GET_TX_DESC_FTM_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 0) -+#define IE2_SET_TX_DESC_FTM_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 0) -+#define IE2_SET_TX_DESC_FTM_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 0) -+#define IE2_GET_TX_DESC_MBSSID(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xf, 27) -+#define IE2_SET_TX_DESC_MBSSID(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 27) -+#define IE2_SET_TX_DESC_MBSSID_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 27) -+#define IE2_GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x7ff, 16) -+#define IE2_SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x7ff, \ -+ 16) -+#define IE2_SET_TX_DESC_GROUP_BIT_IE_OFFSET_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x7ff, \ -+ 16) -+#define IE2_GET_TX_DESC_RDG_NAV_EXT(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x1, 15) -+#define IE2_SET_TX_DESC_RDG_NAV_EXT(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1, 15) -+#define IE2_SET_TX_DESC_RDG_NAV_EXT_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1, 15) -+#define IE2_GET_TX_DESC_DROP_ID(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3, 12) -+#define IE2_SET_TX_DESC_DROP_ID(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 12) -+#define IE2_SET_TX_DESC_DROP_ID_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 12) -+#define IE2_GET_TX_DESC_SW_DEFINE(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xfff, 0) -+#define IE2_SET_TX_DESC_SW_DEFINE(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xfff, 0) -+#define IE2_SET_TX_DESC_SW_DEFINE_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xfff, 0) -+#define IE3_GET_TX_DESC_IE_END(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 31) -+#define IE3_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE3_SET_TX_DESC_IE_END_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE3_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 30) -+#define IE3_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE3_SET_TX_DESC_IE_UP_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE3_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xf, 24) -+#define IE3_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE3_SET_TX_DESC_IE_NUM_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE3_GET_TX_DESC_DATA_SC(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xf, 20) -+#define IE3_SET_TX_DESC_DATA_SC(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 20) -+#define IE3_SET_TX_DESC_DATA_SC_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 20) -+#define IE3_GET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xf, 16) -+#define IE3_SET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 16) -+#define IE3_SET_TX_DESC_SIGNALING_TA_PKT_SC_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 16) -+#define IE3_GET_TX_DESC_CTRL_CNT(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xf, 8) -+#define IE3_SET_TX_DESC_CTRL_CNT(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 8) -+#define IE3_SET_TX_DESC_CTRL_CNT_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 8) -+#define IE3_GET_TX_DESC_CTRL_CNT_VALID(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 1) -+#define IE3_SET_TX_DESC_CTRL_CNT_VALID(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 1) -+#define IE3_SET_TX_DESC_CTRL_CNT_VALID_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 1) -+#define IE3_GET_TX_DESC_SIGNALING_TA_PKT_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 0) -+#define IE3_SET_TX_DESC_SIGNALING_TA_PKT_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 0) -+#define IE3_SET_TX_DESC_SIGNALING_TA_PKT_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 0) -+#define IE3_GET_TX_DESC_G_ID(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3f, 24) -+#define IE3_SET_TX_DESC_G_ID(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3f, 24) -+#define IE3_SET_TX_DESC_G_ID_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3f, 24) -+#define IE3_GET_TX_DESC_SND_TARGET(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xff, 16) -+#define IE3_SET_TX_DESC_SND_TARGET(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xff, 16) -+#define IE3_SET_TX_DESC_SND_TARGET_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xff, 16) -+#define IE3_GET_TX_DESC_CCA_RTS(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3, 11) -+#define IE3_SET_TX_DESC_CCA_RTS(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 11) -+#define IE3_SET_TX_DESC_CCA_RTS_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 11) -+#define IE3_GET_TX_DESC_SND_PKT_SEL(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3, 9) -+#define IE3_SET_TX_DESC_SND_PKT_SEL(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 9) -+#define IE3_SET_TX_DESC_SND_PKT_SEL_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 9) -+#define IE3_GET_TX_DESC_NDPA(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3, 7) -+#define IE3_SET_TX_DESC_NDPA(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 7) -+#define IE3_SET_TX_DESC_NDPA_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 7) -+#define IE3_GET_TX_DESC_MU_DATARATE(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x7f, 0) -+#define IE3_SET_TX_DESC_MU_DATARATE(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x7f, 0) -+#define IE3_SET_TX_DESC_MU_DATARATE_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x7f, 0) -+#define IE4_GET_TX_DESC_IE_END(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 31) -+#define IE4_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE4_SET_TX_DESC_IE_END_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE4_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 30) -+#define IE4_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE4_SET_TX_DESC_IE_UP_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE4_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xf, 24) -+#define IE4_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE4_SET_TX_DESC_IE_NUM_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE4_GET_TX_DESC_VCS_STBC(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x3, 10) -+#define IE4_SET_TX_DESC_VCS_STBC(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x3, 10) -+#define IE4_SET_TX_DESC_VCS_STBC_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x3, 10) -+#define IE4_GET_TX_DESC_DATA_STBC(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x3, 8) -+#define IE4_SET_TX_DESC_DATA_STBC(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x3, 8) -+#define IE4_SET_TX_DESC_DATA_STBC_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x3, 8) -+#define IE4_GET_TX_DESC_DATA_LDPC(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 2) -+#define IE4_SET_TX_DESC_DATA_LDPC(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 2) -+#define IE4_SET_TX_DESC_DATA_LDPC_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 2) -+#define IE4_GET_TX_DESC_GF(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 1) -+#define IE4_SET_TX_DESC_GF(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 1) -+#define IE4_SET_TX_DESC_GF_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 1) -+#define IE4_GET_TX_DESC_LSIG_TXOP_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 0) -+#define IE4_SET_TX_DESC_LSIG_TXOP_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 0) -+#define IE4_SET_TX_DESC_LSIG_TXOP_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 0) -+#define IE4_GET_TX_DESC_PATH_MAPA(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3, 30) -+#define IE4_SET_TX_DESC_PATH_MAPA(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 30) -+#define IE4_SET_TX_DESC_PATH_MAPA_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 30) -+#define IE4_GET_TX_DESC_PATH_MAPB(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3, 28) -+#define IE4_SET_TX_DESC_PATH_MAPB(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 28) -+#define IE4_SET_TX_DESC_PATH_MAPB_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 28) -+#define IE4_GET_TX_DESC_PATH_MAPC(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3, 26) -+#define IE4_SET_TX_DESC_PATH_MAPC(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 26) -+#define IE4_SET_TX_DESC_PATH_MAPC_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 26) -+#define IE4_GET_TX_DESC_PATH_MAPD(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3, 24) -+#define IE4_SET_TX_DESC_PATH_MAPD(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 24) -+#define IE4_SET_TX_DESC_PATH_MAPD_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 24) -+#define IE4_GET_TX_DESC_ANTSEL_A(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xf, 20) -+#define IE4_SET_TX_DESC_ANTSEL_A(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 20) -+#define IE4_SET_TX_DESC_ANTSEL_A_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 20) -+#define IE4_GET_TX_DESC_ANTSEL_B(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xf, 16) -+#define IE4_SET_TX_DESC_ANTSEL_B(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 16) -+#define IE4_SET_TX_DESC_ANTSEL_B_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 16) -+#define IE4_GET_TX_DESC_ANTSEL_C(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xf, 12) -+#define IE4_SET_TX_DESC_ANTSEL_C(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 12) -+#define IE4_SET_TX_DESC_ANTSEL_C_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 12) -+#define IE4_GET_TX_DESC_ANTSEL_D(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xf, 8) -+#define IE4_SET_TX_DESC_ANTSEL_D(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 8) -+#define IE4_SET_TX_DESC_ANTSEL_D_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 8) -+#define IE4_GET_TX_DESC_NTX_PATH_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0xf, 4) -+#define IE4_SET_TX_DESC_NTX_PATH_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 4) -+#define IE4_SET_TX_DESC_NTX_PATH_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0xf, 4) -+#define IE4_GET_TX_DESC_ANTLSEL_EN(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x1, 3) -+#define IE4_SET_TX_DESC_ANTLSEL_EN(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1, 3) -+#define IE4_SET_TX_DESC_ANTLSEL_EN_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1, 3) -+#define IE4_GET_TX_DESC_TXPWR_OFSET_TYPE(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3, 0) -+#define IE4_SET_TX_DESC_TXPWR_OFSET_TYPE(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 0) -+#define IE4_SET_TX_DESC_TXPWR_OFSET_TYPE_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3, 0) -+#define IE5_GET_TX_DESC_IE_END(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 31) -+#define IE5_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE5_SET_TX_DESC_IE_END_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 31) -+#define IE5_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1, 30) -+#define IE5_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE5_SET_TX_DESC_IE_UP_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1, 30) -+#define IE5_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xf, 24) -+#define IE5_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE5_SET_TX_DESC_IE_NUM_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 24) -+#define IE5_GET_TX_DESC_LEN1_L(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x7f, 17) -+#define IE5_SET_TX_DESC_LEN1_L(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x7f, 17) -+#define IE5_SET_TX_DESC_LEN1_L_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x7f, 17) -+#define IE5_GET_TX_DESC_LEN0(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0x1fff, 4) -+#define IE5_SET_TX_DESC_LEN0(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1fff, \ -+ 4) -+#define IE5_SET_TX_DESC_LEN0_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0x1fff, \ -+ 4) -+#define IE5_GET_TX_DESC_PKT_NUM(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword0, \ -+ 0xf, 0) -+#define IE5_SET_TX_DESC_PKT_NUM(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 0) -+#define IE5_SET_TX_DESC_PKT_NUM_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword0, value, 0xf, 0) -+#define IE5_GET_TX_DESC_LEN3(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x1fff, 19) -+#define IE5_SET_TX_DESC_LEN3(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1fff, \ -+ 19) -+#define IE5_SET_TX_DESC_LEN3_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1fff, \ -+ 19) -+#define IE5_GET_TX_DESC_LEN2(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x1fff, 6) -+#define IE5_SET_TX_DESC_LEN2(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1fff, \ -+ 6) -+#define IE5_SET_TX_DESC_LEN2_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x1fff, \ -+ 6) -+#define IE5_GET_TX_DESC_LEN1_H(txdesc_ie) \ -+ HALMAC_GET_DESC_FIELD(((struct halmac_tx_desc *)txdesc_ie)->dword1, \ -+ 0x3f, 0) -+#define IE5_SET_TX_DESC_LEN1_H(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3f, 0) -+#define IE5_SET_TX_DESC_LEN1_H_NO_CLR(txdesc_ie, value) \ -+ HALMAC_SET_DESC_FIELD_NO_CLR( \ -+ ((struct halmac_tx_desc *)txdesc_ie)->dword1, value, 0x3f, 0) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ie_chip.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ie_chip.h -new file mode 100644 -index 000000000..a35f6da4e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ie_chip.h -@@ -0,0 +1,438 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TX_DESC_IE_CHIP_H_ -+#define _HALMAC_TX_DESC_IE_CHIP_H_ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define IE0_GET_TX_DESC_IE_END_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_IE_END(txdesc_ie) -+#define IE0_SET_TX_DESC_IE_END_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_IE_END(txdesc_ie, value) -+#define IE0_GET_TX_DESC_IE_UP_8814B(txdesc_ie) IE0_GET_TX_DESC_IE_UP(txdesc_ie) -+#define IE0_SET_TX_DESC_IE_UP_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_IE_UP(txdesc_ie, value) -+#define IE0_GET_TX_DESC_IE_NUM_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_IE_NUM(txdesc_ie) -+#define IE0_SET_TX_DESC_IE_NUM_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_IE_NUM(txdesc_ie, value) -+#define IE0_GET_TX_DESC_ARFR_TABLE_SEL_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_ARFR_TABLE_SEL(txdesc_ie) -+#define IE0_SET_TX_DESC_ARFR_TABLE_SEL_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_ARFR_TABLE_SEL(txdesc_ie, value) -+#define IE0_GET_TX_DESC_ARFR_HT_EN_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_ARFR_HT_EN(txdesc_ie) -+#define IE0_SET_TX_DESC_ARFR_HT_EN_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_ARFR_HT_EN(txdesc_ie, value) -+#define IE0_GET_TX_DESC_ARFR_OFDM_EN_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_ARFR_OFDM_EN(txdesc_ie) -+#define IE0_SET_TX_DESC_ARFR_OFDM_EN_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_ARFR_OFDM_EN(txdesc_ie, value) -+#define IE0_GET_TX_DESC_ARFR_CCK_EN_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_ARFR_CCK_EN(txdesc_ie) -+#define IE0_SET_TX_DESC_ARFR_CCK_EN_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_ARFR_CCK_EN(txdesc_ie, value) -+#define IE0_GET_TX_DESC_HW_RTS_EN_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_HW_RTS_EN(txdesc_ie) -+#define IE0_SET_TX_DESC_HW_RTS_EN_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_HW_RTS_EN(txdesc_ie, value) -+#define IE0_GET_TX_DESC_RTS_EN_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_RTS_EN(txdesc_ie) -+#define IE0_SET_TX_DESC_RTS_EN_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_RTS_EN(txdesc_ie, value) -+#define IE0_GET_TX_DESC_CTS2SELF_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_CTS2SELF(txdesc_ie) -+#define IE0_SET_TX_DESC_CTS2SELF_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_CTS2SELF(txdesc_ie, value) -+#define IE0_GET_TX_DESC_RTY_LMT_EN_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_RTY_LMT_EN(txdesc_ie) -+#define IE0_SET_TX_DESC_RTY_LMT_EN_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_RTY_LMT_EN(txdesc_ie, value) -+#define IE0_GET_TX_DESC_RTS_SHORT_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_RTS_SHORT(txdesc_ie) -+#define IE0_SET_TX_DESC_RTS_SHORT_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_RTS_SHORT(txdesc_ie, value) -+#define IE0_GET_TX_DESC_DISDATAFB_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_DISDATAFB(txdesc_ie) -+#define IE0_SET_TX_DESC_DISDATAFB_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_DISDATAFB(txdesc_ie, value) -+#define IE0_GET_TX_DESC_DISRTSFB_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_DISRTSFB(txdesc_ie) -+#define IE0_SET_TX_DESC_DISRTSFB_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_DISRTSFB(txdesc_ie, value) -+#define IE0_GET_TX_DESC_DATA_SHORT_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_DATA_SHORT(txdesc_ie) -+#define IE0_SET_TX_DESC_DATA_SHORT_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_DATA_SHORT(txdesc_ie, value) -+#define IE0_GET_TX_DESC_TRY_RATE_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_TRY_RATE(txdesc_ie) -+#define IE0_SET_TX_DESC_TRY_RATE_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_TRY_RATE(txdesc_ie, value) -+#define IE0_GET_TX_DESC_USERATE_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_USERATE(txdesc_ie) -+#define IE0_SET_TX_DESC_USERATE_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_USERATE(txdesc_ie, value) -+#define IE0_GET_TX_DESC_RTS_RTY_LOWEST_RATE_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc_ie) -+#define IE0_SET_TX_DESC_RTS_RTY_LOWEST_RATE_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc_ie, value) -+#define IE0_GET_TX_DESC_DATA_RTY_LOWEST_RATE_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc_ie) -+#define IE0_SET_TX_DESC_DATA_RTY_LOWEST_RATE_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc_ie, value) -+#define IE0_GET_TX_DESC_RTS_DATA_RTY_LMT_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc_ie) -+#define IE0_SET_TX_DESC_RTS_DATA_RTY_LMT_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc_ie, value) -+#define IE0_GET_TX_DESC_DATA_BW_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_DATA_BW(txdesc_ie) -+#define IE0_SET_TX_DESC_DATA_BW_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_DATA_BW(txdesc_ie, value) -+#define IE0_GET_TX_DESC_RTSRATE_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_RTSRATE(txdesc_ie) -+#define IE0_SET_TX_DESC_RTSRATE_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_RTSRATE(txdesc_ie, value) -+#define IE0_GET_TX_DESC_DATARATE_8814B(txdesc_ie) \ -+ IE0_GET_TX_DESC_DATARATE(txdesc_ie) -+#define IE0_SET_TX_DESC_DATARATE_8814B(txdesc_ie, value) \ -+ IE0_SET_TX_DESC_DATARATE(txdesc_ie, value) -+#define IE1_GET_TX_DESC_IE_END_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_IE_END(txdesc_ie) -+#define IE1_SET_TX_DESC_IE_END_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_IE_END(txdesc_ie, value) -+#define IE1_GET_TX_DESC_IE_UP_8814B(txdesc_ie) IE1_GET_TX_DESC_IE_UP(txdesc_ie) -+#define IE1_SET_TX_DESC_IE_UP_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_IE_UP(txdesc_ie, value) -+#define IE1_GET_TX_DESC_IE_NUM_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_IE_NUM(txdesc_ie) -+#define IE1_SET_TX_DESC_IE_NUM_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_IE_NUM(txdesc_ie, value) -+#define IE1_GET_TX_DESC_AMPDU_DENSITY_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_AMPDU_DENSITY(txdesc_ie) -+#define IE1_SET_TX_DESC_AMPDU_DENSITY_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_AMPDU_DENSITY(txdesc_ie, value) -+#define IE1_GET_TX_DESC_MAX_AGG_NUM_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_MAX_AGG_NUM(txdesc_ie) -+#define IE1_SET_TX_DESC_MAX_AGG_NUM_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_MAX_AGG_NUM(txdesc_ie, value) -+#define IE1_GET_TX_DESC_SECTYPE_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_SECTYPE(txdesc_ie) -+#define IE1_SET_TX_DESC_SECTYPE_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_SECTYPE(txdesc_ie, value) -+#define IE1_GET_TX_DESC_MOREFRAG_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_MOREFRAG(txdesc_ie) -+#define IE1_SET_TX_DESC_MOREFRAG_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_MOREFRAG(txdesc_ie, value) -+#define IE1_GET_TX_DESC_NOACM_8814B(txdesc_ie) IE1_GET_TX_DESC_NOACM(txdesc_ie) -+#define IE1_SET_TX_DESC_NOACM_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_NOACM(txdesc_ie, value) -+#define IE1_GET_TX_DESC_BCNPKT_TSF_CTRL_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc_ie) -+#define IE1_SET_TX_DESC_BCNPKT_TSF_CTRL_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc_ie, value) -+#define IE1_GET_TX_DESC_NAVUSEHDR_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_NAVUSEHDR(txdesc_ie) -+#define IE1_SET_TX_DESC_NAVUSEHDR_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_NAVUSEHDR(txdesc_ie, value) -+#define IE1_GET_TX_DESC_HTC_8814B(txdesc_ie) IE1_GET_TX_DESC_HTC(txdesc_ie) -+#define IE1_SET_TX_DESC_HTC_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_HTC(txdesc_ie, value) -+#define IE1_GET_TX_DESC_BMC_8814B(txdesc_ie) IE1_GET_TX_DESC_BMC(txdesc_ie) -+#define IE1_SET_TX_DESC_BMC_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_BMC(txdesc_ie, value) -+#define IE1_GET_TX_DESC_TX_PKT_AFTER_PIFS_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_TX_PKT_AFTER_PIFS(txdesc_ie) -+#define IE1_SET_TX_DESC_TX_PKT_AFTER_PIFS_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_TX_PKT_AFTER_PIFS(txdesc_ie, value) -+#define IE1_GET_TX_DESC_USE_MAX_TIME_EN_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_USE_MAX_TIME_EN(txdesc_ie) -+#define IE1_SET_TX_DESC_USE_MAX_TIME_EN_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_USE_MAX_TIME_EN(txdesc_ie, value) -+#define IE1_GET_TX_DESC_HW_SSN_SEL_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_HW_SSN_SEL(txdesc_ie) -+#define IE1_SET_TX_DESC_HW_SSN_SEL_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_HW_SSN_SEL(txdesc_ie, value) -+#define IE1_GET_TX_DESC_DISQSELSEQ_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_DISQSELSEQ(txdesc_ie) -+#define IE1_SET_TX_DESC_DISQSELSEQ_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_DISQSELSEQ(txdesc_ie, value) -+#define IE1_GET_TX_DESC_EN_HWSEQ_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_EN_HWSEQ(txdesc_ie) -+#define IE1_SET_TX_DESC_EN_HWSEQ_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_EN_HWSEQ(txdesc_ie, value) -+#define IE1_GET_TX_DESC_EN_HWEXSEQ_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_EN_HWEXSEQ(txdesc_ie) -+#define IE1_SET_TX_DESC_EN_HWEXSEQ_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_EN_HWEXSEQ(txdesc_ie, value) -+#define IE1_GET_TX_DESC_EN_DESC_ID_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_EN_DESC_ID(txdesc_ie) -+#define IE1_SET_TX_DESC_EN_DESC_ID_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_EN_DESC_ID(txdesc_ie, value) -+#define IE1_GET_TX_DESC_AMPDU_MAX_TIME_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_AMPDU_MAX_TIME(txdesc_ie) -+#define IE1_SET_TX_DESC_AMPDU_MAX_TIME_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_AMPDU_MAX_TIME(txdesc_ie, value) -+#define IE1_GET_TX_DESC_P_AID_8814B(txdesc_ie) IE1_GET_TX_DESC_P_AID(txdesc_ie) -+#define IE1_SET_TX_DESC_P_AID_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_P_AID(txdesc_ie, value) -+#define IE1_GET_TX_DESC_MOREDATA_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_MOREDATA(txdesc_ie) -+#define IE1_SET_TX_DESC_MOREDATA_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_MOREDATA(txdesc_ie, value) -+#define IE1_GET_TX_DESC_SW_SEQ_8814B(txdesc_ie) \ -+ IE1_GET_TX_DESC_SW_SEQ(txdesc_ie) -+#define IE1_SET_TX_DESC_SW_SEQ_8814B(txdesc_ie, value) \ -+ IE1_SET_TX_DESC_SW_SEQ(txdesc_ie, value) -+#define IE2_GET_TX_DESC_IE_END_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_IE_END(txdesc_ie) -+#define IE2_SET_TX_DESC_IE_END_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_IE_END(txdesc_ie, value) -+#define IE2_GET_TX_DESC_IE_UP_8814B(txdesc_ie) IE2_GET_TX_DESC_IE_UP(txdesc_ie) -+#define IE2_SET_TX_DESC_IE_UP_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_IE_UP(txdesc_ie, value) -+#define IE2_GET_TX_DESC_IE_NUM_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_IE_NUM(txdesc_ie) -+#define IE2_SET_TX_DESC_IE_NUM_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_IE_NUM(txdesc_ie, value) -+#define IE2_GET_TX_DESC_ADDR_CAM_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_ADDR_CAM(txdesc_ie) -+#define IE2_SET_TX_DESC_ADDR_CAM_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_ADDR_CAM(txdesc_ie, value) -+#define IE2_GET_TX_DESC_MULTIPLE_PORT_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_MULTIPLE_PORT(txdesc_ie) -+#define IE2_SET_TX_DESC_MULTIPLE_PORT_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_MULTIPLE_PORT(txdesc_ie, value) -+#define IE2_GET_TX_DESC_RAW_8814B(txdesc_ie) IE2_GET_TX_DESC_RAW(txdesc_ie) -+#define IE2_SET_TX_DESC_RAW_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_RAW(txdesc_ie, value) -+#define IE2_GET_TX_DESC_RDG_EN_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_RDG_EN(txdesc_ie) -+#define IE2_SET_TX_DESC_RDG_EN_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_RDG_EN(txdesc_ie, value) -+#define IE2_GET_TX_DESC_SPECIAL_CW_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_SPECIAL_CW(txdesc_ie) -+#define IE2_SET_TX_DESC_SPECIAL_CW_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_SPECIAL_CW(txdesc_ie, value) -+#define IE2_GET_TX_DESC_POLLUTED_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_POLLUTED(txdesc_ie) -+#define IE2_SET_TX_DESC_POLLUTED_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_POLLUTED(txdesc_ie, value) -+#define IE2_GET_TX_DESC_BT_NULL_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_BT_NULL(txdesc_ie) -+#define IE2_SET_TX_DESC_BT_NULL_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_BT_NULL(txdesc_ie, value) -+#define IE2_GET_TX_DESC_NULL_1_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_NULL_1(txdesc_ie) -+#define IE2_SET_TX_DESC_NULL_1_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_NULL_1(txdesc_ie, value) -+#define IE2_GET_TX_DESC_NULL_0_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_NULL_0(txdesc_ie) -+#define IE2_SET_TX_DESC_NULL_0_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_NULL_0(txdesc_ie, value) -+#define IE2_GET_TX_DESC_TRI_FRAME_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_TRI_FRAME(txdesc_ie) -+#define IE2_SET_TX_DESC_TRI_FRAME_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_TRI_FRAME(txdesc_ie, value) -+#define IE2_GET_TX_DESC_SPE_RPT_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_SPE_RPT(txdesc_ie) -+#define IE2_SET_TX_DESC_SPE_RPT_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_SPE_RPT(txdesc_ie, value) -+#define IE2_GET_TX_DESC_FTM_EN_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_FTM_EN(txdesc_ie) -+#define IE2_SET_TX_DESC_FTM_EN_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_FTM_EN(txdesc_ie, value) -+#define IE2_GET_TX_DESC_MBSSID_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_MBSSID(txdesc_ie) -+#define IE2_SET_TX_DESC_MBSSID_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_MBSSID(txdesc_ie, value) -+#define IE2_GET_TX_DESC_GROUP_BIT_IE_OFFSET_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc_ie) -+#define IE2_SET_TX_DESC_GROUP_BIT_IE_OFFSET_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc_ie, value) -+#define IE2_GET_TX_DESC_RDG_NAV_EXT_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_RDG_NAV_EXT(txdesc_ie) -+#define IE2_SET_TX_DESC_RDG_NAV_EXT_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_RDG_NAV_EXT(txdesc_ie, value) -+#define IE2_GET_TX_DESC_DROP_ID_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_DROP_ID(txdesc_ie) -+#define IE2_SET_TX_DESC_DROP_ID_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_DROP_ID(txdesc_ie, value) -+#define IE2_GET_TX_DESC_SW_DEFINE_8814B(txdesc_ie) \ -+ IE2_GET_TX_DESC_SW_DEFINE(txdesc_ie) -+#define IE2_SET_TX_DESC_SW_DEFINE_8814B(txdesc_ie, value) \ -+ IE2_SET_TX_DESC_SW_DEFINE(txdesc_ie, value) -+#define IE3_GET_TX_DESC_IE_END_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_IE_END(txdesc_ie) -+#define IE3_SET_TX_DESC_IE_END_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_IE_END(txdesc_ie, value) -+#define IE3_GET_TX_DESC_IE_UP_8814B(txdesc_ie) IE3_GET_TX_DESC_IE_UP(txdesc_ie) -+#define IE3_SET_TX_DESC_IE_UP_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_IE_UP(txdesc_ie, value) -+#define IE3_GET_TX_DESC_IE_NUM_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_IE_NUM(txdesc_ie) -+#define IE3_SET_TX_DESC_IE_NUM_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_IE_NUM(txdesc_ie, value) -+#define IE3_GET_TX_DESC_DATA_SC_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_DATA_SC(txdesc_ie) -+#define IE3_SET_TX_DESC_DATA_SC_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_DATA_SC(txdesc_ie, value) -+#define IE3_GET_TX_DESC_SIGNALING_TA_PKT_SC_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc_ie) -+#define IE3_SET_TX_DESC_SIGNALING_TA_PKT_SC_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc_ie, value) -+#define IE3_GET_TX_DESC_CTRL_CNT_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_CTRL_CNT(txdesc_ie) -+#define IE3_SET_TX_DESC_CTRL_CNT_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_CTRL_CNT(txdesc_ie, value) -+#define IE3_GET_TX_DESC_CTRL_CNT_VALID_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_CTRL_CNT_VALID(txdesc_ie) -+#define IE3_SET_TX_DESC_CTRL_CNT_VALID_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_CTRL_CNT_VALID(txdesc_ie, value) -+#define IE3_GET_TX_DESC_SIGNALING_TA_PKT_EN_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_SIGNALING_TA_PKT_EN(txdesc_ie) -+#define IE3_SET_TX_DESC_SIGNALING_TA_PKT_EN_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_SIGNALING_TA_PKT_EN(txdesc_ie, value) -+#define IE3_GET_TX_DESC_G_ID_8814B(txdesc_ie) IE3_GET_TX_DESC_G_ID(txdesc_ie) -+#define IE3_SET_TX_DESC_G_ID_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_G_ID(txdesc_ie, value) -+#define IE3_GET_TX_DESC_SND_TARGET_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_SND_TARGET(txdesc_ie) -+#define IE3_SET_TX_DESC_SND_TARGET_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_SND_TARGET(txdesc_ie, value) -+#define IE3_GET_TX_DESC_CCA_RTS_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_CCA_RTS(txdesc_ie) -+#define IE3_SET_TX_DESC_CCA_RTS_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_CCA_RTS(txdesc_ie, value) -+#define IE3_GET_TX_DESC_SND_PKT_SEL_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_SND_PKT_SEL(txdesc_ie) -+#define IE3_SET_TX_DESC_SND_PKT_SEL_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_SND_PKT_SEL(txdesc_ie, value) -+#define IE3_GET_TX_DESC_NDPA_8814B(txdesc_ie) IE3_GET_TX_DESC_NDPA(txdesc_ie) -+#define IE3_SET_TX_DESC_NDPA_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_NDPA(txdesc_ie, value) -+#define IE3_GET_TX_DESC_MU_DATARATE_8814B(txdesc_ie) \ -+ IE3_GET_TX_DESC_MU_DATARATE(txdesc_ie) -+#define IE3_SET_TX_DESC_MU_DATARATE_8814B(txdesc_ie, value) \ -+ IE3_SET_TX_DESC_MU_DATARATE(txdesc_ie, value) -+#define IE4_GET_TX_DESC_IE_END_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_IE_END(txdesc_ie) -+#define IE4_SET_TX_DESC_IE_END_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_IE_END(txdesc_ie, value) -+#define IE4_GET_TX_DESC_IE_UP_8814B(txdesc_ie) IE4_GET_TX_DESC_IE_UP(txdesc_ie) -+#define IE4_SET_TX_DESC_IE_UP_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_IE_UP(txdesc_ie, value) -+#define IE4_GET_TX_DESC_IE_NUM_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_IE_NUM(txdesc_ie) -+#define IE4_SET_TX_DESC_IE_NUM_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_IE_NUM(txdesc_ie, value) -+#define IE4_GET_TX_DESC_VCS_STBC_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_VCS_STBC(txdesc_ie) -+#define IE4_SET_TX_DESC_VCS_STBC_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_VCS_STBC(txdesc_ie, value) -+#define IE4_GET_TX_DESC_DATA_STBC_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_DATA_STBC(txdesc_ie) -+#define IE4_SET_TX_DESC_DATA_STBC_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_DATA_STBC(txdesc_ie, value) -+#define IE4_GET_TX_DESC_DATA_LDPC_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_DATA_LDPC(txdesc_ie) -+#define IE4_SET_TX_DESC_DATA_LDPC_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_DATA_LDPC(txdesc_ie, value) -+#define IE4_GET_TX_DESC_GF_8814B(txdesc_ie) IE4_GET_TX_DESC_GF(txdesc_ie) -+#define IE4_SET_TX_DESC_GF_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_GF(txdesc_ie, value) -+#define IE4_GET_TX_DESC_LSIG_TXOP_EN_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_LSIG_TXOP_EN(txdesc_ie) -+#define IE4_SET_TX_DESC_LSIG_TXOP_EN_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_LSIG_TXOP_EN(txdesc_ie, value) -+#define IE4_GET_TX_DESC_PATH_MAPA_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_PATH_MAPA(txdesc_ie) -+#define IE4_SET_TX_DESC_PATH_MAPA_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_PATH_MAPA(txdesc_ie, value) -+#define IE4_GET_TX_DESC_PATH_MAPB_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_PATH_MAPB(txdesc_ie) -+#define IE4_SET_TX_DESC_PATH_MAPB_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_PATH_MAPB(txdesc_ie, value) -+#define IE4_GET_TX_DESC_PATH_MAPC_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_PATH_MAPC(txdesc_ie) -+#define IE4_SET_TX_DESC_PATH_MAPC_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_PATH_MAPC(txdesc_ie, value) -+#define IE4_GET_TX_DESC_PATH_MAPD_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_PATH_MAPD(txdesc_ie) -+#define IE4_SET_TX_DESC_PATH_MAPD_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_PATH_MAPD(txdesc_ie, value) -+#define IE4_GET_TX_DESC_ANTSEL_A_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_ANTSEL_A(txdesc_ie) -+#define IE4_SET_TX_DESC_ANTSEL_A_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_ANTSEL_A(txdesc_ie, value) -+#define IE4_GET_TX_DESC_ANTSEL_B_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_ANTSEL_B(txdesc_ie) -+#define IE4_SET_TX_DESC_ANTSEL_B_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_ANTSEL_B(txdesc_ie, value) -+#define IE4_GET_TX_DESC_ANTSEL_C_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_ANTSEL_C(txdesc_ie) -+#define IE4_SET_TX_DESC_ANTSEL_C_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_ANTSEL_C(txdesc_ie, value) -+#define IE4_GET_TX_DESC_ANTSEL_D_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_ANTSEL_D(txdesc_ie) -+#define IE4_SET_TX_DESC_ANTSEL_D_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_ANTSEL_D(txdesc_ie, value) -+#define IE4_GET_TX_DESC_NTX_PATH_EN_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_NTX_PATH_EN(txdesc_ie) -+#define IE4_SET_TX_DESC_NTX_PATH_EN_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_NTX_PATH_EN(txdesc_ie, value) -+#define IE4_GET_TX_DESC_ANTLSEL_EN_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_ANTLSEL_EN(txdesc_ie) -+#define IE4_SET_TX_DESC_ANTLSEL_EN_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_ANTLSEL_EN(txdesc_ie, value) -+#define IE4_GET_TX_DESC_TXPWR_OFSET_TYPE_8814B(txdesc_ie) \ -+ IE4_GET_TX_DESC_TXPWR_OFSET_TYPE(txdesc_ie) -+#define IE4_SET_TX_DESC_TXPWR_OFSET_TYPE_8814B(txdesc_ie, value) \ -+ IE4_SET_TX_DESC_TXPWR_OFSET_TYPE(txdesc_ie, value) -+#define IE5_GET_TX_DESC_IE_END_8814B(txdesc_ie) \ -+ IE5_GET_TX_DESC_IE_END(txdesc_ie) -+#define IE5_SET_TX_DESC_IE_END_8814B(txdesc_ie, value) \ -+ IE5_SET_TX_DESC_IE_END(txdesc_ie, value) -+#define IE5_GET_TX_DESC_IE_UP_8814B(txdesc_ie) IE5_GET_TX_DESC_IE_UP(txdesc_ie) -+#define IE5_SET_TX_DESC_IE_UP_8814B(txdesc_ie, value) \ -+ IE5_SET_TX_DESC_IE_UP(txdesc_ie, value) -+#define IE5_GET_TX_DESC_IE_NUM_8814B(txdesc_ie) \ -+ IE5_GET_TX_DESC_IE_NUM(txdesc_ie) -+#define IE5_SET_TX_DESC_IE_NUM_8814B(txdesc_ie, value) \ -+ IE5_SET_TX_DESC_IE_NUM(txdesc_ie, value) -+#define IE5_GET_TX_DESC_LEN1_L_8814B(txdesc_ie) \ -+ IE5_GET_TX_DESC_LEN1_L(txdesc_ie) -+#define IE5_SET_TX_DESC_LEN1_L_8814B(txdesc_ie, value) \ -+ IE5_SET_TX_DESC_LEN1_L(txdesc_ie, value) -+#define IE5_GET_TX_DESC_LEN0_8814B(txdesc_ie) IE5_GET_TX_DESC_LEN0(txdesc_ie) -+#define IE5_SET_TX_DESC_LEN0_8814B(txdesc_ie, value) \ -+ IE5_SET_TX_DESC_LEN0(txdesc_ie, value) -+#define IE5_GET_TX_DESC_PKT_NUM_8814B(txdesc_ie) \ -+ IE5_GET_TX_DESC_PKT_NUM(txdesc_ie) -+#define IE5_SET_TX_DESC_PKT_NUM_8814B(txdesc_ie, value) \ -+ IE5_SET_TX_DESC_PKT_NUM(txdesc_ie, value) -+#define IE5_GET_TX_DESC_LEN3_8814B(txdesc_ie) IE5_GET_TX_DESC_LEN3(txdesc_ie) -+#define IE5_SET_TX_DESC_LEN3_8814B(txdesc_ie, value) \ -+ IE5_SET_TX_DESC_LEN3(txdesc_ie, value) -+#define IE5_GET_TX_DESC_LEN2_8814B(txdesc_ie) IE5_GET_TX_DESC_LEN2(txdesc_ie) -+#define IE5_SET_TX_DESC_LEN2_8814B(txdesc_ie, value) \ -+ IE5_SET_TX_DESC_LEN2(txdesc_ie, value) -+#define IE5_GET_TX_DESC_LEN1_H_8814B(txdesc_ie) \ -+ IE5_GET_TX_DESC_LEN1_H(txdesc_ie) -+#define IE5_SET_TX_DESC_LEN1_H_8814B(txdesc_ie, value) \ -+ IE5_SET_TX_DESC_LEN1_H(txdesc_ie, value) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ie_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ie_nic.h -new file mode 100644 -index 000000000..b39535b15 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_ie_nic.h -@@ -0,0 +1,450 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TX_DESC_IE_NIC_H_ -+#define _HALMAC_TX_DESC_IE_NIC_H_ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define IE0_GET_TX_DESC_IE_END(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 31, 1) -+#define IE0_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 31, 1, value) -+#define IE0_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 30, 1) -+#define IE0_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 30, 1, value) -+#define IE0_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 24, 4) -+#define IE0_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 24, 4, value) -+#define IE0_GET_TX_DESC_ARFR_TABLE_SEL(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 19, 1) -+#define IE0_SET_TX_DESC_ARFR_TABLE_SEL(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 19, 1, value) -+#define IE0_GET_TX_DESC_ARFR_HT_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 18, 1) -+#define IE0_SET_TX_DESC_ARFR_HT_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 18, 1, value) -+#define IE0_GET_TX_DESC_ARFR_OFDM_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 17, 1) -+#define IE0_SET_TX_DESC_ARFR_OFDM_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 17, 1, value) -+#define IE0_GET_TX_DESC_ARFR_CCK_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 16, 1) -+#define IE0_SET_TX_DESC_ARFR_CCK_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 16, 1, value) -+#define IE0_GET_TX_DESC_HW_RTS_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 9, 1) -+#define IE0_SET_TX_DESC_HW_RTS_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 9, 1, value) -+#define IE0_GET_TX_DESC_RTS_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 8, 1) -+#define IE0_SET_TX_DESC_RTS_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 8, 1, value) -+#define IE0_GET_TX_DESC_CTS2SELF(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 7, 1) -+#define IE0_SET_TX_DESC_CTS2SELF(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 7, 1, value) -+#define IE0_GET_TX_DESC_RTY_LMT_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 6, 1) -+#define IE0_SET_TX_DESC_RTY_LMT_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 6, 1, value) -+#define IE0_GET_TX_DESC_RTS_SHORT(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 5, 1) -+#define IE0_SET_TX_DESC_RTS_SHORT(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 5, 1, value) -+#define IE0_GET_TX_DESC_DISDATAFB(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 4, 1) -+#define IE0_SET_TX_DESC_DISDATAFB(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 4, 1, value) -+#define IE0_GET_TX_DESC_DISRTSFB(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 3, 1) -+#define IE0_SET_TX_DESC_DISRTSFB(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 3, 1, value) -+#define IE0_GET_TX_DESC_DATA_SHORT(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 2, 1) -+#define IE0_SET_TX_DESC_DATA_SHORT(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 2, 1, value) -+#define IE0_GET_TX_DESC_TRY_RATE(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 1, 1) -+#define IE0_SET_TX_DESC_TRY_RATE(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 1, 1, value) -+#define IE0_GET_TX_DESC_USERATE(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 0, 1) -+#define IE0_SET_TX_DESC_USERATE(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 0, 1, value) -+#define IE0_GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 27, 4) -+#define IE0_SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 27, 4, value) -+#define IE0_GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 22, 5) -+#define IE0_SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 22, 5, value) -+#define IE0_GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 16, 6) -+#define IE0_SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 16, 6, value) -+#define IE0_GET_TX_DESC_DATA_BW(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 12, 2) -+#define IE0_SET_TX_DESC_DATA_BW(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 12, 2, value) -+#define IE0_GET_TX_DESC_RTSRATE(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 7, 4) -+#define IE0_SET_TX_DESC_RTSRATE(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 7, 4, value) -+#define IE0_GET_TX_DESC_DATARATE(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 0, 7) -+#define IE0_SET_TX_DESC_DATARATE(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 0, 7, value) -+#define IE1_GET_TX_DESC_IE_END(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 31, 1) -+#define IE1_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 31, 1, value) -+#define IE1_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 30, 1) -+#define IE1_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 30, 1, value) -+#define IE1_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 24, 4) -+#define IE1_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 24, 4, value) -+#define IE1_GET_TX_DESC_AMPDU_DENSITY(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 21, 3) -+#define IE1_SET_TX_DESC_AMPDU_DENSITY(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 21, 3, value) -+#define IE1_GET_TX_DESC_MAX_AGG_NUM(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 16, 5) -+#define IE1_SET_TX_DESC_MAX_AGG_NUM(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 16, 5, value) -+#define IE1_GET_TX_DESC_SECTYPE(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 14, 2) -+#define IE1_SET_TX_DESC_SECTYPE(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 14, 2, value) -+#define IE1_GET_TX_DESC_MOREFRAG(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 13, 1) -+#define IE1_SET_TX_DESC_MOREFRAG(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 13, 1, value) -+#define IE1_GET_TX_DESC_NOACM(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 12, 1) -+#define IE1_SET_TX_DESC_NOACM(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 12, 1, value) -+#define IE1_GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 11, 1) -+#define IE1_SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 11, 1, value) -+#define IE1_GET_TX_DESC_NAVUSEHDR(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 10, 1) -+#define IE1_SET_TX_DESC_NAVUSEHDR(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 10, 1, value) -+#define IE1_GET_TX_DESC_HTC(txdesc_ie) LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 9, 1) -+#define IE1_SET_TX_DESC_HTC(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 9, 1, value) -+#define IE1_GET_TX_DESC_BMC(txdesc_ie) LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 8, 1) -+#define IE1_SET_TX_DESC_BMC(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 8, 1, value) -+#define IE1_GET_TX_DESC_TX_PKT_AFTER_PIFS(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 7, 1) -+#define IE1_SET_TX_DESC_TX_PKT_AFTER_PIFS(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 7, 1, value) -+#define IE1_GET_TX_DESC_USE_MAX_TIME_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 6, 1) -+#define IE1_SET_TX_DESC_USE_MAX_TIME_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 6, 1, value) -+#define IE1_GET_TX_DESC_HW_SSN_SEL(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 4, 2) -+#define IE1_SET_TX_DESC_HW_SSN_SEL(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 4, 2, value) -+#define IE1_GET_TX_DESC_DISQSELSEQ(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 3, 1) -+#define IE1_SET_TX_DESC_DISQSELSEQ(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 3, 1, value) -+#define IE1_GET_TX_DESC_EN_HWSEQ(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 2, 1) -+#define IE1_SET_TX_DESC_EN_HWSEQ(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 2, 1, value) -+#define IE1_GET_TX_DESC_EN_HWEXSEQ(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 1, 1) -+#define IE1_SET_TX_DESC_EN_HWEXSEQ(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 1, 1, value) -+#define IE1_GET_TX_DESC_EN_DESC_ID(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 0, 1) -+#define IE1_SET_TX_DESC_EN_DESC_ID(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 0, 1, value) -+#define IE1_GET_TX_DESC_AMPDU_MAX_TIME(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 24, 8) -+#define IE1_SET_TX_DESC_AMPDU_MAX_TIME(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 24, 8, value) -+#define IE1_GET_TX_DESC_P_AID(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 15, 9) -+#define IE1_SET_TX_DESC_P_AID(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 15, 9, value) -+#define IE1_GET_TX_DESC_MOREDATA(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 14, 1) -+#define IE1_SET_TX_DESC_MOREDATA(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 14, 1, value) -+#define IE1_GET_TX_DESC_SW_SEQ(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 0, 12) -+#define IE1_SET_TX_DESC_SW_SEQ(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 0, 12, value) -+#define IE2_GET_TX_DESC_IE_END(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 31, 1) -+#define IE2_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 31, 1, value) -+#define IE2_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 30, 1) -+#define IE2_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 30, 1, value) -+#define IE2_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 24, 4) -+#define IE2_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 24, 4, value) -+#define IE2_GET_TX_DESC_ADDR_CAM(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 16, 8) -+#define IE2_SET_TX_DESC_ADDR_CAM(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 16, 8, value) -+#define IE2_GET_TX_DESC_MULTIPLE_PORT(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 12, 3) -+#define IE2_SET_TX_DESC_MULTIPLE_PORT(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 12, 3, value) -+#define IE2_GET_TX_DESC_RAW(txdesc_ie) LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 11, 1) -+#define IE2_SET_TX_DESC_RAW(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 11, 1, value) -+#define IE2_GET_TX_DESC_RDG_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 10, 1) -+#define IE2_SET_TX_DESC_RDG_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 10, 1, value) -+#define IE2_GET_TX_DESC_SPECIAL_CW(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 7, 1) -+#define IE2_SET_TX_DESC_SPECIAL_CW(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 7, 1, value) -+#define IE2_GET_TX_DESC_POLLUTED(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 6, 1) -+#define IE2_SET_TX_DESC_POLLUTED(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 6, 1, value) -+#define IE2_GET_TX_DESC_BT_NULL(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 5, 1) -+#define IE2_SET_TX_DESC_BT_NULL(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 5, 1, value) -+#define IE2_GET_TX_DESC_NULL_1(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 4, 1) -+#define IE2_SET_TX_DESC_NULL_1(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 4, 1, value) -+#define IE2_GET_TX_DESC_NULL_0(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 3, 1) -+#define IE2_SET_TX_DESC_NULL_0(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 3, 1, value) -+#define IE2_GET_TX_DESC_TRI_FRAME(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 2, 1) -+#define IE2_SET_TX_DESC_TRI_FRAME(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 2, 1, value) -+#define IE2_GET_TX_DESC_SPE_RPT(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 1, 1) -+#define IE2_SET_TX_DESC_SPE_RPT(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 1, 1, value) -+#define IE2_GET_TX_DESC_FTM_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 0, 1) -+#define IE2_SET_TX_DESC_FTM_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 0, 1, value) -+#define IE2_GET_TX_DESC_MBSSID(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 27, 4) -+#define IE2_SET_TX_DESC_MBSSID(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 27, 4, value) -+#define IE2_GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 16, 11) -+#define IE2_SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 16, 11, value) -+#define IE2_GET_TX_DESC_RDG_NAV_EXT(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 15, 1) -+#define IE2_SET_TX_DESC_RDG_NAV_EXT(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 15, 1, value) -+#define IE2_GET_TX_DESC_DROP_ID(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 12, 2) -+#define IE2_SET_TX_DESC_DROP_ID(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 12, 2, value) -+#define IE2_GET_TX_DESC_SW_DEFINE(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 0, 12) -+#define IE2_SET_TX_DESC_SW_DEFINE(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 0, 12, value) -+#define IE3_GET_TX_DESC_IE_END(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 31, 1) -+#define IE3_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 31, 1, value) -+#define IE3_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 30, 1) -+#define IE3_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 30, 1, value) -+#define IE3_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 24, 4) -+#define IE3_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 24, 4, value) -+#define IE3_GET_TX_DESC_DATA_SC(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 20, 4) -+#define IE3_SET_TX_DESC_DATA_SC(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 20, 4, value) -+#define IE3_GET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 16, 4) -+#define IE3_SET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 16, 4, value) -+#define IE3_GET_TX_DESC_CTRL_CNT(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 8, 4) -+#define IE3_SET_TX_DESC_CTRL_CNT(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 8, 4, value) -+#define IE3_GET_TX_DESC_CTRL_CNT_VALID(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 1, 1) -+#define IE3_SET_TX_DESC_CTRL_CNT_VALID(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 1, 1, value) -+#define IE3_GET_TX_DESC_SIGNALING_TA_PKT_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 0, 1) -+#define IE3_SET_TX_DESC_SIGNALING_TA_PKT_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 0, 1, value) -+#define IE3_GET_TX_DESC_G_ID(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 24, 6) -+#define IE3_SET_TX_DESC_G_ID(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 24, 6, value) -+#define IE3_GET_TX_DESC_SND_TARGET(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 16, 8) -+#define IE3_SET_TX_DESC_SND_TARGET(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 16, 8, value) -+#define IE3_GET_TX_DESC_CCA_RTS(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 11, 2) -+#define IE3_SET_TX_DESC_CCA_RTS(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 11, 2, value) -+#define IE3_GET_TX_DESC_SND_PKT_SEL(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 9, 2) -+#define IE3_SET_TX_DESC_SND_PKT_SEL(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 9, 2, value) -+#define IE3_GET_TX_DESC_NDPA(txdesc_ie) LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 7, 2) -+#define IE3_SET_TX_DESC_NDPA(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 7, 2, value) -+#define IE3_GET_TX_DESC_MU_DATARATE(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 0, 7) -+#define IE3_SET_TX_DESC_MU_DATARATE(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 0, 7, value) -+#define IE4_GET_TX_DESC_IE_END(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 31, 1) -+#define IE4_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 31, 1, value) -+#define IE4_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 30, 1) -+#define IE4_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 30, 1, value) -+#define IE4_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 24, 4) -+#define IE4_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 24, 4, value) -+#define IE4_GET_TX_DESC_VCS_STBC(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 10, 2) -+#define IE4_SET_TX_DESC_VCS_STBC(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 10, 2, value) -+#define IE4_GET_TX_DESC_DATA_STBC(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 8, 2) -+#define IE4_SET_TX_DESC_DATA_STBC(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 8, 2, value) -+#define IE4_GET_TX_DESC_DATA_LDPC(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 2, 1) -+#define IE4_SET_TX_DESC_DATA_LDPC(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 2, 1, value) -+#define IE4_GET_TX_DESC_GF(txdesc_ie) LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 1, 1) -+#define IE4_SET_TX_DESC_GF(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 1, 1, value) -+#define IE4_GET_TX_DESC_LSIG_TXOP_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 0, 1) -+#define IE4_SET_TX_DESC_LSIG_TXOP_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 0, 1, value) -+#define IE4_GET_TX_DESC_PATH_MAPA(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 30, 2) -+#define IE4_SET_TX_DESC_PATH_MAPA(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 30, 2, value) -+#define IE4_GET_TX_DESC_PATH_MAPB(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 28, 2) -+#define IE4_SET_TX_DESC_PATH_MAPB(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 28, 2, value) -+#define IE4_GET_TX_DESC_PATH_MAPC(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 26, 2) -+#define IE4_SET_TX_DESC_PATH_MAPC(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 26, 2, value) -+#define IE4_GET_TX_DESC_PATH_MAPD(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 24, 2) -+#define IE4_SET_TX_DESC_PATH_MAPD(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 24, 2, value) -+#define IE4_GET_TX_DESC_ANTSEL_A(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 20, 4) -+#define IE4_SET_TX_DESC_ANTSEL_A(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 20, 4, value) -+#define IE4_GET_TX_DESC_ANTSEL_B(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 16, 4) -+#define IE4_SET_TX_DESC_ANTSEL_B(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 16, 4, value) -+#define IE4_GET_TX_DESC_ANTSEL_C(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 12, 4) -+#define IE4_SET_TX_DESC_ANTSEL_C(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 12, 4, value) -+#define IE4_GET_TX_DESC_ANTSEL_D(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 8, 4) -+#define IE4_SET_TX_DESC_ANTSEL_D(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 8, 4, value) -+#define IE4_GET_TX_DESC_NTX_PATH_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 4, 4) -+#define IE4_SET_TX_DESC_NTX_PATH_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 4, 4, value) -+#define IE4_GET_TX_DESC_ANTLSEL_EN(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 3, 1) -+#define IE4_SET_TX_DESC_ANTLSEL_EN(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 3, 1, value) -+#define IE4_GET_TX_DESC_TXPWR_OFSET_TYPE(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 0, 2) -+#define IE4_SET_TX_DESC_TXPWR_OFSET_TYPE(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 0, 2, value) -+#define IE5_GET_TX_DESC_IE_END(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 31, 1) -+#define IE5_SET_TX_DESC_IE_END(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 31, 1, value) -+#define IE5_GET_TX_DESC_IE_UP(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 30, 1) -+#define IE5_SET_TX_DESC_IE_UP(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 30, 1, value) -+#define IE5_GET_TX_DESC_IE_NUM(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 24, 4) -+#define IE5_SET_TX_DESC_IE_NUM(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 24, 4, value) -+#define IE5_GET_TX_DESC_LEN1_L(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 17, 7) -+#define IE5_SET_TX_DESC_LEN1_L(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 17, 7, value) -+#define IE5_GET_TX_DESC_LEN0(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 4, 13) -+#define IE5_SET_TX_DESC_LEN0(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 4, 13, value) -+#define IE5_GET_TX_DESC_PKT_NUM(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x00, 0, 4) -+#define IE5_SET_TX_DESC_PKT_NUM(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x00, 0, 4, value) -+#define IE5_GET_TX_DESC_LEN3(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 19, 13) -+#define IE5_SET_TX_DESC_LEN3(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 19, 13, value) -+#define IE5_GET_TX_DESC_LEN2(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 6, 13) -+#define IE5_SET_TX_DESC_LEN2(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 6, 13, value) -+#define IE5_GET_TX_DESC_LEN1_H(txdesc_ie) \ -+ LE_BITS_TO_4BYTE(txdesc_ie + 0x04, 0, 6) -+#define IE5_SET_TX_DESC_LEN1_H(txdesc_ie, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc_ie + 0x04, 0, 6, value) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_nic.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_nic.h -new file mode 100644 -index 000000000..a1f6eab0a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_tx_desc_nic.h -@@ -0,0 +1,1236 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TX_DESC_NIC_H_ -+#define _HALMAC_TX_DESC_NIC_H_ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD0*/ -+ -+#define SET_TX_DESC_DISQSELSEQ(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 31, 1, value) -+#define GET_TX_DESC_DISQSELSEQ(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 31, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_IE_END_BODY(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 31, 1, value) -+#define GET_TX_DESC_IE_END_BODY(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 31, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_GF(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 30, 1, value) -+#define GET_TX_DESC_GF(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 30, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_AGG_EN_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 30, 1, value) -+#define GET_TX_DESC_AGG_EN_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 30, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_NO_ACM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 29, 1, value) -+#define GET_TX_DESC_NO_ACM(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 29, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_BK_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 29, 1, value) -+#define GET_TX_DESC_BK_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 29, 1) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_BCNPKT_TSF_CTRL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 28, 1, value) -+#define GET_TX_DESC_BCNPKT_TSF_CTRL(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x00, 28, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_AMSDU_PAD_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 27, 1, value) -+#define GET_TX_DESC_AMSDU_PAD_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 27, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_LS(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 26, 1, value) -+#define GET_TX_DESC_LS(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 26, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_HTC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 25, 1, value) -+#define GET_TX_DESC_HTC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 25, 1) -+#define SET_TX_DESC_BMC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 24, 1, value) -+#define GET_TX_DESC_BMC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 24, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_PKT_OFFSET_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 24, 5, value) -+#define GET_TX_DESC_PKT_OFFSET_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 24, 5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_OFFSET(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 16, 8, value) -+#define GET_TX_DESC_OFFSET(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 16, 8) -+#define SET_TX_DESC_TXPKTSIZE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x00, 0, 16, value) -+#define GET_TX_DESC_TXPKTSIZE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x00, 0, 16) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*WORD1*/ -+ -+#define SET_TX_DESC_HW_AES_IV_V2(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 31, 1, value) -+#define GET_TX_DESC_HW_AES_IV_V2(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 31, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_AMSDU(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 30, 1, value) -+#define GET_TX_DESC_AMSDU(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 30, 1) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_FTM_EN_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 30, 1, value) -+#define GET_TX_DESC_FTM_EN_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 30, 1) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_KEYID_SEL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 30, 1, value) -+#define GET_TX_DESC_KEYID_SEL(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 30, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_MOREDATA(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 29, 1, value) -+#define GET_TX_DESC_MOREDATA(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 29, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_HW_AES_IV_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 29, 1, value) -+#define GET_TX_DESC_HW_AES_IV_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 29, 1) -+#define SET_TX_DESC_MHR_CP(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 25, 1, value) -+#define GET_TX_DESC_MHR_CP(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 25, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_PKT_OFFSET(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 24, 5, value) -+#define GET_TX_DESC_PKT_OFFSET(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 24, 5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_SMH_EN_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 24, 1, value) -+#define GET_TX_DESC_SMH_EN_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 24, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SEC_TYPE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 22, 2, value) -+#define GET_TX_DESC_SEC_TYPE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 22, 2) -+#define SET_TX_DESC_EN_DESC_ID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 21, 1, value) -+#define GET_TX_DESC_EN_DESC_ID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 21, 1) -+#define SET_TX_DESC_RATE_ID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 16, 5, value) -+#define GET_TX_DESC_RATE_ID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 16, 5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_SMH_CAM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 16, 8, value) -+#define GET_TX_DESC_SMH_CAM(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 16, 8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_PIFS(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 15, 1, value) -+#define GET_TX_DESC_PIFS(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 15, 1) -+#define SET_TX_DESC_LSIG_TXOP_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 14, 1, value) -+#define GET_TX_DESC_LSIG_TXOP_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 14, 1) -+#define SET_TX_DESC_RD_NAV_EXT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 13, 1, value) -+#define GET_TX_DESC_RD_NAV_EXT(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 13, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_EXT_EDCA(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 13, 1, value) -+#define GET_TX_DESC_EXT_EDCA(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 13, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8814B_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_QSEL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 8, 5, value) -+#define GET_TX_DESC_QSEL(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 8, 5) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SPECIAL_CW(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 7, 1, value) -+#define GET_TX_DESC_SPECIAL_CW(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 7, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_MACID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 0, 7, value) -+#define GET_TX_DESC_MACID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 0, 7) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_MACID_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x04, 0, 7, value) -+#define GET_TX_DESC_MACID_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x04, 0, 7) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/*TXDESC_WORD2*/ -+ -+#define SET_TX_DESC_HW_AES_IV(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 31, 1, value) -+#define GET_TX_DESC_HW_AES_IV(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 31, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_CHK_EN_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 31, 1, value) -+#define GET_TX_DESC_CHK_EN_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 31, 1) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_FTM_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 30, 1, value) -+#define GET_TX_DESC_FTM_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 30, 1) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANTCEL_D_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 28, 4, value) -+#define GET_TX_DESC_ANTCEL_D_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 28, 4) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_DMA_PRI(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 27, 1, value) -+#define GET_TX_DESC_DMA_PRI(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 27, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_G_ID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 24, 6, value) -+#define GET_TX_DESC_G_ID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 24, 6) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_MAX_AMSDU_MODE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 24, 3, value) -+#define GET_TX_DESC_MAX_AMSDU_MODE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x08, 24, 3) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_C_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 24, 4, value) -+#define GET_TX_DESC_ANTSEL_C_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 24, 4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_BT_NULL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 23, 1, value) -+#define GET_TX_DESC_BT_NULL(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 23, 1) -+#define SET_TX_DESC_AMPDU_DENSITY(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 20, 3, value) -+#define GET_TX_DESC_AMPDU_DENSITY(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 20, 3) -+#define SET_TX_DESC_SPE_RPT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 19, 1, value) -+#define GET_TX_DESC_SPE_RPT(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 19, 1) -+#define SET_TX_DESC_RAW(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 18, 1, value) -+#define GET_TX_DESC_RAW(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 18, 1) -+#define SET_TX_DESC_MOREFRAG(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 17, 1, value) -+#define GET_TX_DESC_MOREFRAG(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 17, 1) -+#define SET_TX_DESC_BK(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 16, 1, value) -+#define GET_TX_DESC_BK(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 16, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 16, 8, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM_V1(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x08, 16, 8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_NULL_1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 15, 1, value) -+#define GET_TX_DESC_NULL_1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 15, 1) -+#define SET_TX_DESC_NULL_0(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 14, 1, value) -+#define GET_TX_DESC_NULL_0(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 14, 1) -+#define SET_TX_DESC_RDG_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 13, 1, value) -+#define GET_TX_DESC_RDG_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 13, 1) -+#define SET_TX_DESC_AGG_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 12, 1, value) -+#define GET_TX_DESC_AGG_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 12, 1) -+#define SET_TX_DESC_CCA_RTS(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 10, 2, value) -+#define GET_TX_DESC_CCA_RTS(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 10, 2) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_TRI_FRAME(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 9, 1, value) -+#define GET_TX_DESC_TRI_FRAME(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 9, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_P_AID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 0, 9, value) -+#define GET_TX_DESC_P_AID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x08, 0, 9) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_TXDESC_CHECKSUM_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x08, 0, 16, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM_V1(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x08, 0, 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD3*/ -+ -+#define SET_TX_DESC_AMPDU_MAX_TIME(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 24, 8, value) -+#define GET_TX_DESC_AMPDU_MAX_TIME(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x0C, 24, 8) -+#define SET_TX_DESC_NDPA(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 22, 2, value) -+#define GET_TX_DESC_NDPA(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 22, 2) -+#define SET_TX_DESC_MAX_AGG_NUM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 17, 5, value) -+#define GET_TX_DESC_MAX_AGG_NUM(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 17, 5) -+#define SET_TX_DESC_USE_MAX_TIME_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 16, 1, value) -+#define GET_TX_DESC_USE_MAX_TIME_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x0C, 16, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_OFFLOAD_SIZE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 16, 15, value) -+#define GET_TX_DESC_OFFLOAD_SIZE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 16, 15) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_NAVUSEHDR(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 15, 1, value) -+#define GET_TX_DESC_NAVUSEHDR(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 15, 1) -+#define SET_TX_DESC_CHK_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 14, 1, value) -+#define GET_TX_DESC_CHK_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 14, 1) -+#define SET_TX_DESC_HW_RTS_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 13, 1, value) -+#define GET_TX_DESC_HW_RTS_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 13, 1) -+#define SET_TX_DESC_RTSEN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 12, 1, value) -+#define GET_TX_DESC_RTSEN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 12, 1) -+#define SET_TX_DESC_CTS2SELF(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 11, 1, value) -+#define GET_TX_DESC_CTS2SELF(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 11, 1) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_CHANNEL_DMA(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 11, 5, value) -+#define GET_TX_DESC_CHANNEL_DMA(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 11, 5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_DISDATAFB(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 10, 1, value) -+#define GET_TX_DESC_DISDATAFB(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 10, 1) -+#define SET_TX_DESC_DISRTSFB(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 9, 1, value) -+#define GET_TX_DESC_DISRTSFB(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 9, 1) -+#define SET_TX_DESC_USE_RATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 8, 1, value) -+#define GET_TX_DESC_USE_RATE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 8, 1) -+#define SET_TX_DESC_HW_SSN_SEL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 6, 2, value) -+#define GET_TX_DESC_HW_SSN_SEL(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 6, 2) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_IE_CNT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 6, 3, value) -+#define GET_TX_DESC_IE_CNT(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 6, 3) -+#define SET_TX_DESC_IE_CNT_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 5, 1, value) -+#define GET_TX_DESC_IE_CNT_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 5, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_WHEADER_LEN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 0, 5, value) -+#define GET_TX_DESC_WHEADER_LEN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 0, 5) -+ -+#endif -+ -+#if (HALMAC_8814B_SUPPORT) -+ -+#define SET_TX_DESC_WHEADER_LEN_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x0C, 0, 5, value) -+#define GET_TX_DESC_WHEADER_LEN_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x0C, 0, 5) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD4*/ -+ -+#define SET_TX_DESC_PCTS_MASK_IDX(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 30, 2, value) -+#define GET_TX_DESC_PCTS_MASK_IDX(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x10, 30, 2) -+#define SET_TX_DESC_PCTS_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 29, 1, value) -+#define GET_TX_DESC_PCTS_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x10, 29, 1) -+#define SET_TX_DESC_RTSRATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 24, 5, value) -+#define GET_TX_DESC_RTSRATE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x10, 24, 5) -+#define SET_TX_DESC_RTS_DATA_RTY_LMT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 18, 6, value) -+#define GET_TX_DESC_RTS_DATA_RTY_LMT(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x10, 18, 6) -+#define SET_TX_DESC_RTY_LMT_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 17, 1, value) -+#define GET_TX_DESC_RTY_LMT_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x10, 17, 1) -+#define SET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 13, 4, value) -+#define GET_TX_DESC_RTS_RTY_LOWEST_RATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x10, 13, 4) -+#define SET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 8, 5, value) -+#define GET_TX_DESC_DATA_RTY_LOWEST_RATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x10, 8, 5) -+#define SET_TX_DESC_TRY_RATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 7, 1, value) -+#define GET_TX_DESC_TRY_RATE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x10, 7, 1) -+#define SET_TX_DESC_DATARATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x10, 0, 7, value) -+#define GET_TX_DESC_DATARATE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x10, 0, 7) -+ -+/*TXDESC_WORD5*/ -+ -+#define SET_TX_DESC_POLLUTED(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 31, 1, value) -+#define GET_TX_DESC_POLLUTED(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 31, 1) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_EN_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 30, 1, value) -+#define GET_TX_DESC_ANTSEL_EN_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 30, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_TXPWR_OFSET(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 28, 3, value) -+#define GET_TX_DESC_TXPWR_OFSET(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 28, 3) -+ -+#endif -+ -+#if (HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_TXPWR_OFSET_TYPE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 28, 2, value) -+#define GET_TX_DESC_TXPWR_OFSET_TYPE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 28, 2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_TXPWR_OFSET_TYPE_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 28, 3, value) -+#define GET_TX_DESC_TXPWR_OFSET_TYPE_V1(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 28, 3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8192F_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_TX_ANT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 24, 4, value) -+#define GET_TX_DESC_TX_ANT(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 24, 4) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_DROP_ID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 24, 2, value) -+#define GET_TX_DESC_DROP_ID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 24, 2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_DROP_ID_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 22, 2, value) -+#define GET_TX_DESC_DROP_ID_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 22, 2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_PORT_ID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 21, 3, value) -+#define GET_TX_DESC_PORT_ID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 21, 3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_PORT_ID_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 21, 1, value) -+#define GET_TX_DESC_PORT_ID_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 21, 1) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8821C_SUPPORT || \ -+ HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT || \ -+ HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_MULTIPLE_PORT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 18, 3, value) -+#define GET_TX_DESC_MULTIPLE_PORT(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 18, 3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SIGNALING_TAPKT_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 17, 1, value) -+#define GET_TX_DESC_SIGNALING_TAPKT_EN(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 17, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8197F_SUPPORT || HALMAC_8198F_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_RTS_SC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 13, 4, value) -+#define GET_TX_DESC_RTS_SC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 13, 4) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 13, 4, value) -+#define GET_TX_DESC_SIGNALING_TA_PKT_SC(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x14, 13, 4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_RTS_SHORT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 12, 1, value) -+#define GET_TX_DESC_RTS_SHORT(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 12, 1) -+#define SET_TX_DESC_VCS_STBC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 10, 2, value) -+#define GET_TX_DESC_VCS_STBC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 10, 2) -+#define SET_TX_DESC_DATA_STBC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 8, 2, value) -+#define GET_TX_DESC_DATA_STBC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 8, 2) -+#define SET_TX_DESC_DATA_LDPC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 7, 1, value) -+#define GET_TX_DESC_DATA_LDPC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 7, 1) -+#define SET_TX_DESC_DATA_BW(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 5, 2, value) -+#define GET_TX_DESC_DATA_BW(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 5, 2) -+#define SET_TX_DESC_DATA_SHORT(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 4, 1, value) -+#define GET_TX_DESC_DATA_SHORT(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 4, 1) -+#define SET_TX_DESC_DATA_SC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x14, 0, 4, value) -+#define GET_TX_DESC_DATA_SC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x14, 0, 4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+/*TXDESC_WORD6*/ -+ -+#define SET_TX_DESC_ANTSEL_D(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 30, 2, value) -+#define GET_TX_DESC_ANTSEL_D(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 30, 2) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPD_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 30, 2, value) -+#define GET_TX_DESC_ANT_MAPD_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 30, 2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPC_V2(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 30, 2, value) -+#define GET_TX_DESC_ANT_MAPC_V2(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 30, 2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPD(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 28, 2, value) -+#define GET_TX_DESC_ANT_MAPD(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 28, 2) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPC_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 28, 2, value) -+#define GET_TX_DESC_ANT_MAPC_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 28, 2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPB_V2(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 28, 2, value) -+#define GET_TX_DESC_ANT_MAPB_V2(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 28, 2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 26, 2, value) -+#define GET_TX_DESC_ANT_MAPC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 26, 2) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPB_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 26, 2, value) -+#define GET_TX_DESC_ANT_MAPB_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 26, 2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPA_V2(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 26, 2, value) -+#define GET_TX_DESC_ANT_MAPA_V2(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 26, 2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPB(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 24, 2, value) -+#define GET_TX_DESC_ANT_MAPB(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 24, 2) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPA_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 24, 2, value) -+#define GET_TX_DESC_ANT_MAPA_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 24, 2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_D_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 24, 2, value) -+#define GET_TX_DESC_ANTSEL_D_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 24, 2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPA(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 22, 2, value) -+#define GET_TX_DESC_ANT_MAPA(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 22, 2) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_C_V2(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 22, 2, value) -+#define GET_TX_DESC_ANTSEL_C_V2(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 22, 2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_C(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 20, 2, value) -+#define GET_TX_DESC_ANTSEL_C(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 20, 2) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_B_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 20, 4, value) -+#define GET_TX_DESC_ANTSEL_B_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 20, 4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_B_V2(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 19, 3, value) -+#define GET_TX_DESC_ANTSEL_B_V2(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 19, 3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_B(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 18, 2, value) -+#define GET_TX_DESC_ANTSEL_B(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 18, 2) -+#define SET_TX_DESC_ANTSEL_A(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 16, 2, value) -+#define GET_TX_DESC_ANTSEL_A(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 16, 2) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_A_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 16, 4, value) -+#define GET_TX_DESC_ANTSEL_A_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 16, 4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_A_V2(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 16, 3, value) -+#define GET_TX_DESC_ANTSEL_A_V2(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 16, 3) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_MBSSID(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 12, 4, value) -+#define GET_TX_DESC_MBSSID(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 12, 4) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_SW_DEFINE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 0, 12, value) -+#define GET_TX_DESC_SW_DEFINE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 0, 12) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8192F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SWPS_SEQ(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x18, 0, 12, value) -+#define GET_TX_DESC_SWPS_SEQ(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x18, 0, 12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD7*/ -+ -+#define SET_TX_DESC_DMA_TXAGG_NUM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 24, 8, value) -+#define GET_TX_DESC_DMA_TXAGG_NUM(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x1C, 24, 8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_FINAL_DATA_RATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 24, 8, value) -+#define GET_TX_DESC_FINAL_DATA_RATE(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x1C, 24, 8) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_ANT_MAPD_V2(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 22, 2, value) -+#define GET_TX_DESC_ANT_MAPD_V2(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x1C, 22, 2) -+#define SET_TX_DESC_ANTSEL_EN_V2(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 21, 1, value) -+#define GET_TX_DESC_ANTSEL_EN_V2(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x1C, 21, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_NTX_MAP(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 20, 4, value) -+#define GET_TX_DESC_NTX_MAP(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x1C, 20, 4) -+ -+#endif -+ -+#if (HALMAC_8198F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_ANTSEL_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 19, 1, value) -+#define GET_TX_DESC_ANTSEL_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x1C, 19, 1) -+#define SET_TX_DESC_MBSSID_EX(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 16, 3, value) -+#define GET_TX_DESC_MBSSID_EX(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x1C, 16, 3) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_MBSSID_EX_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 16, 1, value) -+#define GET_TX_DESC_MBSSID_EX_V1(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x1C, 16, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_TX_BUFF_SIZE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 0, 16, value) -+#define GET_TX_DESC_TX_BUFF_SIZE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x1C, 0, 16) -+#define SET_TX_DESC_TXDESC_CHECKSUM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 0, 16, value) -+#define GET_TX_DESC_TXDESC_CHECKSUM(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x1C, 0, 16) -+#define SET_TX_DESC_TIMESTAMP(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x1C, 0, 16, value) -+#define GET_TX_DESC_TIMESTAMP(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x1C, 0, 16) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD8*/ -+ -+#define SET_TX_DESC_TXWIFI_CP(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 31, 1, value) -+#define GET_TX_DESC_TXWIFI_CP(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 31, 1) -+#define SET_TX_DESC_MAC_CP(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 30, 1, value) -+#define GET_TX_DESC_MAC_CP(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 30, 1) -+#define SET_TX_DESC_STW_PKTRE_DIS(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 29, 1, value) -+#define GET_TX_DESC_STW_PKTRE_DIS(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 29, 1) -+#define SET_TX_DESC_STW_RB_DIS(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 28, 1, value) -+#define GET_TX_DESC_STW_RB_DIS(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 28, 1) -+#define SET_TX_DESC_STW_RATE_DIS(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 27, 1, value) -+#define GET_TX_DESC_STW_RATE_DIS(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 27, 1) -+#define SET_TX_DESC_STW_ANT_DIS(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 26, 1, value) -+#define GET_TX_DESC_STW_ANT_DIS(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 26, 1) -+#define SET_TX_DESC_STW_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 25, 1, value) -+#define GET_TX_DESC_STW_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 25, 1) -+#define SET_TX_DESC_SMH_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 24, 1, value) -+#define GET_TX_DESC_SMH_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 24, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_TAILPAGE_L(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 24, 8, value) -+#define GET_TX_DESC_TAILPAGE_L(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 24, 8) -+#define SET_TX_DESC_SDIO_DMASEQ(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 16, 8, value) -+#define GET_TX_DESC_SDIO_DMASEQ(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 16, 8) -+#define SET_TX_DESC_NEXTHEADPAGE_L(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 16, 8, value) -+#define GET_TX_DESC_NEXTHEADPAGE_L(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x20, 16, 8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_EN_HWSEQ(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 15, 1, value) -+#define GET_TX_DESC_EN_HWSEQ(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 15, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT) -+ -+#define SET_TX_DESC_EN_HWEXSEQ(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 14, 1, value) -+#define GET_TX_DESC_EN_HWEXSEQ(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 14, 1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_EN_HWSEQ_MODE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 14, 2, value) -+#define GET_TX_DESC_EN_HWSEQ_MODE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 14, 2) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_DATA_RC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 8, 6, value) -+#define GET_TX_DESC_DATA_RC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 8, 6) -+#define SET_TX_DESC_BAR_RTY_TH(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 6, 2, value) -+#define GET_TX_DESC_BAR_RTY_TH(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 6, 2) -+#define SET_TX_DESC_RTS_RC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x20, 0, 6, value) -+#define GET_TX_DESC_RTS_RC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x20, 0, 6) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+/*TXDESC_WORD9*/ -+ -+#define SET_TX_DESC_TAILPAGE_H(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 28, 4, value) -+#define GET_TX_DESC_TAILPAGE_H(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x24, 28, 4) -+#define SET_TX_DESC_NEXTHEADPAGE_H(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 24, 4, value) -+#define GET_TX_DESC_NEXTHEADPAGE_H(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 24, 4) -+ -+#endif -+ -+#if (HALMAC_8192F_SUPPORT) -+ -+#define SET_TX_DESC_FINAL_DATA_RATE_V1(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 24, 8, value) -+#define GET_TX_DESC_FINAL_DATA_RATE_V1(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 24, 8) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SW_SEQ(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 12, 12, value) -+#define GET_TX_DESC_SW_SEQ(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x24, 12, 12) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_TXBF_PATH(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 11, 1, value) -+#define GET_TX_DESC_TXBF_PATH(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x24, 11, 1) -+ -+#endif -+ -+#if (HALMAC_8814A_SUPPORT || HALMAC_8822B_SUPPORT || HALMAC_8197F_SUPPORT || \ -+ HALMAC_8821C_SUPPORT || HALMAC_8198F_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8192F_SUPPORT || HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_PADDING_LEN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 0, 11, value) -+#define GET_TX_DESC_PADDING_LEN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x24, 0, 11) -+#define SET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x24, 0, 8, value) -+#define GET_TX_DESC_GROUP_BIT_IE_OFFSET(txdesc) \ -+ LE_BITS_TO_4BYTE(txdesc + 0x24, 0, 8) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+/*WORD10*/ -+ -+#define SET_TX_DESC_HT_DATA_SND(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 31, 1, value) -+#define GET_TX_DESC_HT_DATA_SND(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 31, 1) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SHCUT_CAM(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 16, 6, value) -+#define GET_TX_DESC_SHCUT_CAM(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 16, 6) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_MU_DATARATE(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 8, 8, value) -+#define GET_TX_DESC_MU_DATARATE(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 8, 8) -+#define SET_TX_DESC_MU_RC(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 4, 4, value) -+#define GET_TX_DESC_MU_RC(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 4, 4) -+ -+#endif -+ -+#if (HALMAC_8812F_SUPPORT) -+ -+#define SET_TX_DESC_NDPA_RATE_SEL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 3, 1, value) -+#define GET_TX_DESC_NDPA_RATE_SEL(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 3, 1) -+#define SET_TX_DESC_HW_NDPA_EN(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 2, 1, value) -+#define GET_TX_DESC_HW_NDPA_EN(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 2, 1) -+ -+#endif -+ -+#if (HALMAC_8822B_SUPPORT || HALMAC_8821C_SUPPORT || HALMAC_8822C_SUPPORT || \ -+ HALMAC_8812F_SUPPORT || HALMAC_8197G_SUPPORT) -+ -+#define SET_TX_DESC_SND_PKT_SEL(txdesc, value) \ -+ SET_BITS_TO_LE_4BYTE(txdesc + 0x28, 0, 2, value) -+#define GET_TX_DESC_SND_PKT_SEL(txdesc) LE_BITS_TO_4BYTE(txdesc + 0x28, 0, 2) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_type.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_type.h -new file mode 100644 -index 000000000..e0950a454 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_type.h -@@ -0,0 +1,2675 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _HALMAC_TYPE_H_ -+#define _HALMAC_TYPE_H_ -+ -+#include "halmac_2_platform.h" -+#include "halmac_hw_cfg.h" -+#include "halmac_fw_info.h" -+#include "halmac_intf_phy_cmd.h" -+#include "halmac_state_machine.h" -+ -+#define IN -+#define OUT -+#define INOUT -+ -+#define HALMAC_BCN_IE_BMP_SIZE 24 /* ID0~ID191, 192/8=24 */ -+ -+#ifndef HALMAC_RX_FIFO_EXPANDING_MODE_PKT_SIZE -+#define HALMAC_RX_FIFO_EXPANDING_MODE_PKT_SIZE 80 -+#endif -+ -+#ifndef HALMAC_MSG_LEVEL_TRACE -+#define HALMAC_MSG_LEVEL_TRACE 3 -+#endif -+ -+#ifndef HALMAC_MSG_LEVEL_WARNING -+#define HALMAC_MSG_LEVEL_WARNING 2 -+#endif -+ -+#ifndef HALMAC_MSG_LEVEL_ERR -+#define HALMAC_MSG_LEVEL_ERR 1 -+#endif -+ -+#ifndef HALMAC_MSG_LEVEL_NO_LOG -+#define HALMAC_MSG_LEVEL_NO_LOG 0 -+#endif -+ -+#ifndef HALMAC_SDIO_SUPPORT -+#define HALMAC_SDIO_SUPPORT 1 -+#endif -+ -+#ifndef HALMAC_USB_SUPPORT -+#define HALMAC_USB_SUPPORT 1 -+#endif -+ -+#ifndef HALMAC_PCIE_SUPPORT -+#define HALMAC_PCIE_SUPPORT 1 -+#endif -+ -+#ifndef HALMAC_MSG_LEVEL -+#define HALMAC_MSG_LEVEL HALMAC_MSG_LEVEL_TRACE -+#endif -+ -+#ifndef HALMAC_DBG_MONITOR_IO -+#define HALMAC_DBG_MONITOR_IO 0 -+#endif -+ -+/* platform api */ -+#define PLTFM_SDIO_CMD52_R(offset) \ -+ adapter->pltfm_api->SDIO_CMD52_READ(adapter->drv_adapter, offset) -+#define PLTFM_SDIO_CMD53_R8(offset) \ -+ adapter->pltfm_api->SDIO_CMD53_READ_8(adapter->drv_adapter, offset) -+#define PLTFM_SDIO_CMD53_R16(offset) \ -+ adapter->pltfm_api->SDIO_CMD53_READ_16(adapter->drv_adapter, offset) -+#define PLTFM_SDIO_CMD53_R32(offset) \ -+ adapter->pltfm_api->SDIO_CMD53_READ_32(adapter->drv_adapter, offset) -+#define PLTFM_SDIO_CMD53_RN(offset, size, data) \ -+ adapter->pltfm_api->SDIO_CMD53_READ_N(adapter->drv_adapter, offset, \ -+ size, data) -+#define PLTFM_SDIO_CMD52_W(offset, val) \ -+ adapter->pltfm_api->SDIO_CMD52_WRITE(adapter->drv_adapter, offset, val) -+#define PLTFM_SDIO_CMD53_W8(offset, val) \ -+ adapter->pltfm_api->SDIO_CMD53_WRITE_8(adapter->drv_adapter, offset, \ -+ val) -+#define PLTFM_SDIO_CMD53_W16(offset, val) \ -+ adapter->pltfm_api->SDIO_CMD53_WRITE_16(adapter->drv_adapter, offset, \ -+ val) -+#define PLTFM_SDIO_CMD53_W32(offset, val) \ -+ adapter->pltfm_api->SDIO_CMD53_WRITE_32(adapter->drv_adapter, offset, \ -+ val) -+#define PLTFM_SDIO_CMD52_CIA_R(offset) \ -+ adapter->pltfm_api->SDIO_CMD52_CIA_READ(adapter->drv_adapter, offset) -+ -+#define PLTFM_REG_R8(offset) \ -+ adapter->pltfm_api->REG_READ_8(adapter->drv_adapter, offset) -+#define PLTFM_REG_R16(offset) \ -+ adapter->pltfm_api->REG_READ_16(adapter->drv_adapter, offset) -+#define PLTFM_REG_R32(offset) \ -+ adapter->pltfm_api->REG_READ_32(adapter->drv_adapter, offset) -+#define PLTFM_REG_W8(offset, val) \ -+ adapter->pltfm_api->REG_WRITE_8(adapter->drv_adapter, offset, val) -+#define PLTFM_REG_W16(offset, val) \ -+ adapter->pltfm_api->REG_WRITE_16(adapter->drv_adapter, offset, val) -+#define PLTFM_REG_W32(offset, val) \ -+ adapter->pltfm_api->REG_WRITE_32(adapter->drv_adapter, offset, val) -+ -+#define PLTFM_SEND_RSVD_PAGE(buf, size) \ -+ adapter->pltfm_api->SEND_RSVD_PAGE(adapter->drv_adapter, buf, size) -+#define PLTFM_SEND_H2C_PKT(buf, size) \ -+ adapter->pltfm_api->SEND_H2C_PKT(adapter->drv_adapter, buf, size) -+ -+#define PLTFM_FREE(buf, size) \ -+ adapter->pltfm_api->RTL_FREE(adapter->drv_adapter, buf, size) -+#define PLTFM_MALLOC(size) \ -+ adapter->pltfm_api->RTL_MALLOC(adapter->drv_adapter, size) -+#define PLTFM_MEMCPY(dest, src, size) \ -+ adapter->pltfm_api->RTL_MEMCPY(adapter->drv_adapter, dest, src, size) -+#define PLTFM_MEMSET(addr, value, size) \ -+ adapter->pltfm_api->RTL_MEMSET(adapter->drv_adapter, addr, value, size) -+#define PLTFM_DELAY_US(us) \ -+ adapter->pltfm_api->RTL_DELAY_US(adapter->drv_adapter, us) -+ -+#define PLTFM_MUTEX_INIT(mutex) \ -+ adapter->pltfm_api->MUTEX_INIT(adapter->drv_adapter, mutex) -+#define PLTFM_MUTEX_DEINIT(mutex) \ -+ adapter->pltfm_api->MUTEX_DEINIT(adapter->drv_adapter, mutex) -+#define PLTFM_MUTEX_LOCK(mutex) \ -+ adapter->pltfm_api->MUTEX_LOCK(adapter->drv_adapter, mutex) -+#define PLTFM_MUTEX_UNLOCK(mutex) \ -+ adapter->pltfm_api->MUTEX_UNLOCK(adapter->drv_adapter, mutex) -+ -+#define PLTFM_EVENT_SIG(feature_id, proc_status, buf, size) \ -+ adapter->pltfm_api->EVENT_INDICATION(adapter->drv_adapter, feature_id, \ -+ proc_status, buf, size) -+ -+#if HALMAC_PLATFORM_WINDOWS -+#define PLTFM_MSG_PRINT adapter->pltfm_api->MSG_PRINT -+#endif -+ -+#define PLTFM_MSG_ALWAYS(...) \ -+ adapter->pltfm_api->MSG_PRINT(adapter->drv_adapter, HALMAC_MSG_INIT, \ -+ HALMAC_DBG_ALWAYS, __VA_ARGS__) -+ -+#if HALMAC_DBG_MSG_ENABLE -+ -+/* Enable debug msg depends on HALMAC_MSG_LEVEL */ -+#if (HALMAC_MSG_LEVEL >= HALMAC_MSG_LEVEL_ERR) -+#define PLTFM_MSG_ERR(...) \ -+ adapter->pltfm_api->MSG_PRINT(adapter->drv_adapter, HALMAC_MSG_INIT, \ -+ HALMAC_DBG_ERR, __VA_ARGS__) -+#else -+#define PLTFM_MSG_ERR(...) do {} while (0) -+#endif -+ -+#if (HALMAC_MSG_LEVEL >= HALMAC_MSG_LEVEL_WARNING) -+#define PLTFM_MSG_WARN(...) \ -+ adapter->pltfm_api->MSG_PRINT(adapter->drv_adapter, HALMAC_MSG_INIT, \ -+ HALMAC_DBG_WARN, __VA_ARGS__) -+#else -+#define PLTFM_MSG_WARN(...) do {} while (0) -+#endif -+ -+#if (HALMAC_MSG_LEVEL >= HALMAC_MSG_LEVEL_TRACE) -+#define PLTFM_MSG_TRACE(...) \ -+ adapter->pltfm_api->MSG_PRINT(adapter->drv_adapter, HALMAC_MSG_INIT, \ -+ HALMAC_DBG_TRACE, __VA_ARGS__) -+#else -+#define PLTFM_MSG_TRACE(...) do {} while (0) -+#endif -+ -+#else -+ -+/* Disable debug msg */ -+#define PLTFM_MSG_ERR(...) do {} while (0) -+#define PLTFM_MSG_WARN(...) do {} while (0) -+#define PLTFM_MSG_TRACE(...) do {} while (0) -+ -+#endif -+ -+#if HALMAC_DBG_MONITOR_IO -+#define PLTFM_MONITOR_READ(offset, byte, val, __func, __line) \ -+ adapter->pltfm_api->READ_MONITOR(adapter->drv_adapter, offset, byte, \ -+ val, __func, __line) -+#define PLTFM_MONITOR_WRITE(offset, byte, val, __func, __line) \ -+ adapter->pltfm_api->WRITE_MONITOR(adapter->drv_adapter, offset, byte, \ -+ val, __func, __line) -+ -+#define HALMAC_REG_R8(offset) \ -+ api->halmac_mon_reg_read_8(adapter, offset, __func__, __LINE__) -+#define HALMAC_REG_R16(offset) \ -+ api->halmac_mon_reg_read_16(adapter, offset, __func__, __LINE__) -+#define HALMAC_REG_R32(offset) \ -+ api->halmac_mon_reg_read_32(adapter, offset, __func__, __LINE__) -+#define HALMAC_REG_W8(offset, val) \ -+ api->halmac_mon_reg_write_8(adapter, offset, val, \ -+ __func__, __LINE__) -+#define HALMAC_REG_W16(offset, val) \ -+ api->halmac_mon_reg_write_16(adapter, offset, val, \ -+ __func__, __LINE__) -+#define HALMAC_REG_W32(offset, val) \ -+ api->halmac_mon_reg_write_32(adapter, offset, val, \ -+ __func__, __LINE__) -+#define HALMAC_REG_SDIO_RN(offset, size, data) \ -+ api->halmac_mon_reg_sdio_cmd53_read_n(adapter, offset, size, data, \ -+ __func__, __LINE__) -+ -+#else -+#define HALMAC_REG_R8(offset) api->halmac_reg_read_8(adapter, offset) -+#define HALMAC_REG_R16(offset) api->halmac_reg_read_16(adapter, offset) -+#define HALMAC_REG_R32(offset) api->halmac_reg_read_32(adapter, offset) -+#define HALMAC_REG_W8(offset, val) api->halmac_reg_write_8(adapter, offset, val) -+#define HALMAC_REG_W16(offset, val) \ -+ api->halmac_reg_write_16(adapter, offset, val) -+#define HALMAC_REG_W32(offset, val) \ -+ api->halmac_reg_write_32(adapter, offset, val) -+#define HALMAC_REG_SDIO_RN(offset, size, data) \ -+ api->halmac_reg_sdio_cmd53_read_n(adapter, offset, size, data) -+#endif -+ -+#define HALMAC_REG_W8_CLR(offset, mask) \ -+ do { \ -+ u32 __offset = (u32)offset; \ -+ HALMAC_REG_W8(__offset, HALMAC_REG_R8(__offset) & ~(mask)); \ -+ } while (0) -+#define HALMAC_REG_W16_CLR(offset, mask) \ -+ do { \ -+ u32 __offset = (u32)offset; \ -+ HALMAC_REG_W16(__offset, HALMAC_REG_R16(__offset) & ~(mask)); \ -+ } while (0) -+#define HALMAC_REG_W32_CLR(offset, mask) \ -+ do { \ -+ u32 __offset = (u32)offset; \ -+ HALMAC_REG_W32(__offset, HALMAC_REG_R32(__offset) & ~(mask)); \ -+ } while (0) -+ -+#define HALMAC_REG_W8_SET(offset, mask) \ -+ do { \ -+ u32 __offset = (u32)offset; \ -+ HALMAC_REG_W8(__offset, HALMAC_REG_R8(__offset) | mask); \ -+ } while (0) -+#define HALMAC_REG_W16_SET(offset, mask) \ -+ do { \ -+ u32 __offset = (u32)offset; \ -+ HALMAC_REG_W16(__offset, HALMAC_REG_R16(__offset) | mask); \ -+ } while (0) -+#define HALMAC_REG_W32_SET(offset, mask) \ -+ do { \ -+ u32 __offset = (u32)offset; \ -+ HALMAC_REG_W32(__offset, HALMAC_REG_R32(__offset) | mask); \ -+ } while (0) -+ -+/* Swap Little-endian <-> Big-endia*/ -+#define SWAP32(x) \ -+ ((u32)((((u32)(x) & (u32)0x000000ff) << 24) | \ -+ (((u32)(x) & (u32)0x0000ff00) << 8) | \ -+ (((u32)(x) & (u32)0x00ff0000) >> 8) | \ -+ (((u32)(x) & (u32)0xff000000) >> 24))) -+ -+#define SWAP16(x) \ -+ ((u16)((((u16)(x) & (u16)0x00ff) << 8) | \ -+ (((u16)(x) & (u16)0xff00) >> 8))) -+ -+/*1->Little endian 0->Big endian*/ -+#if HALMAC_SYSTEM_ENDIAN -+#ifndef rtk_le16_to_cpu -+#define rtk_cpu_to_le32(x) ((u32)(x)) -+#define rtk_le32_to_cpu(x) ((u32)(x)) -+#define rtk_cpu_to_le16(x) ((u16)(x)) -+#define rtk_le16_to_cpu(x) ((u16)(x)) -+#define rtk_cpu_to_be32(x) SWAP32((x)) -+#define rtk_be32_to_cpu(x) SWAP32((x)) -+#define rtk_cpu_to_be16(x) SWAP16((x)) -+#define rtk_be16_to_cpu(x) SWAP16((x)) -+#endif -+#else -+#ifndef rtk_le16_to_cpu -+#define rtk_cpu_to_le32(x) SWAP32((x)) -+#define rtk_le32_to_cpu(x) SWAP32((x)) -+#define rtk_cpu_to_le16(x) SWAP16((x)) -+#define rtk_le16_to_cpu(x) SWAP16((x)) -+#define rtk_cpu_to_be32(x) ((u32)(x)) -+#define rtk_be32_to_cpu(x) ((u32)(x)) -+#define rtk_cpu_to_be16(x) ((u16)(x)) -+#define rtk_be16_to_cpu(x) ((u16)(x)) -+#endif -+#endif -+ -+#define HALMAC_ALIGN(x, a) HALMAC_ALIGN_MASK(x, (a) - 1) -+#define HALMAC_ALIGN_MASK(x, mask) (((x) + (mask)) & ~(mask)) -+ -+/* #if !HALMAC_PLATFORM_WINDOWS */ -+#if !((HALMAC_PLATFORM_WINDOWS == 1) && (HALMAC_PLATFORM_TESTPROGRAM == 0)) -+ -+/* Byte Swapping routine */ -+#ifndef EF1BYTE -+#define EF1BYTE (u8) -+#endif -+ -+#ifndef EF2BYTE -+#define EF2BYTE rtk_le16_to_cpu -+#endif -+ -+#ifndef EF4BYTE -+#define EF4BYTE rtk_le32_to_cpu -+#endif -+ -+/* 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 -+ */ -+#ifndef BIT_LEN_MASK_32 -+#define BIT_LEN_MASK_32(__bitlen) (0xFFFFFFFF >> (32 - (__bitlen))) -+#endif -+ -+/* Example: -+ * BIT_OFFSET_LEN_MASK_32(0, 2) => 0x00000003 -+ * BIT_OFFSET_LEN_MASK_32(16, 2) => 0x00030000 -+ */ -+#ifndef BIT_OFFSET_LEN_MASK_32 -+#define BIT_OFFSET_LEN_MASK_32(__bitoffset, __bitlen) \ -+ (BIT_LEN_MASK_32(__bitlen) << (__bitoffset)) -+#endif -+ -+/* Return 4-byte value in host byte ordering from -+ * 4-byte pointer in litten-endian system -+ */ -+#ifndef LE_P4BYTE_TO_HOST_4BYTE -+#define LE_P4BYTE_TO_HOST_4BYTE(__start) (EF4BYTE(*((u32 *)(__start)))) -+#endif -+ -+/* Translate subfield (continuous bits in little-endian) of -+ * 4-byte value in litten byte to 4-byte value in host byte ordering -+ */ -+#ifndef LE_BITS_TO_4BYTE -+#define LE_BITS_TO_4BYTE(__start, __bitoffset, __bitlen) \ -+ ((LE_P4BYTE_TO_HOST_4BYTE(__start) >> (__bitoffset)) & \ -+ BIT_LEN_MASK_32(__bitlen)) -+#endif -+ -+/* 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 -+ */ -+#ifndef LE_BITS_CLEARED_TO_4BYTE -+#define LE_BITS_CLEARED_TO_4BYTE(__start, __bitoffset, __bitlen) \ -+ (LE_P4BYTE_TO_HOST_4BYTE(__start) & \ -+ (~BIT_OFFSET_LEN_MASK_32(__bitoffset, __bitlen))) -+#endif -+ -+/* Set subfield of little-endian 4-byte value to specified value */ -+#ifndef SET_BITS_TO_LE_4BYTE -+#define SET_BITS_TO_LE_4BYTE(__start, __bitoffset, __bitlen, __value) \ -+ do { \ -+ *((u32 *)(__start)) = \ -+ EF4BYTE( \ -+ LE_BITS_CLEARED_TO_4BYTE(__start, __bitoffset, __bitlen) | \ -+ ((((u32)__value) & BIT_LEN_MASK_32(__bitlen)) << (__bitoffset))\ -+ ); \ -+ } while (0) -+#endif -+ -+#ifndef HALMAC_BIT_OFFSET_VAL_MASK_32 -+#define HALMAC_BIT_OFFSET_VAL_MASK_32(__bitval, __bitoffset) \ -+ (__bitval << (__bitoffset)) -+#endif -+ -+#ifndef SET_MEM_OP -+#define SET_MEM_OP(dw, value32, mask, shift) \ -+ (((dw) & ~((mask) << (shift))) | (((value32) & (mask)) << (shift))) -+#endif -+ -+#ifndef HALMAC_SET_DESC_FIELD_CLR -+#define HALMAC_SET_DESC_FIELD_CLR(dw, value32, mask, shift) \ -+ (dw = (rtk_cpu_to_le32( \ -+ SET_MEM_OP(rtk_cpu_to_le32(dw), value32, mask, shift)))) -+#endif -+ -+#ifndef HALMAC_SET_DESC_FIELD_NO_CLR -+#define HALMAC_SET_DESC_FIELD_NO_CLR(dw, value32, mask, shift) \ -+ (dw |= (rtk_cpu_to_le32(((value32) & (mask)) << (shift)))) -+#endif -+ -+#ifndef HALMAC_GET_DESC_FIELD -+#define HALMAC_GET_DESC_FIELD(dw, mask, shift) \ -+ ((rtk_le32_to_cpu(dw) >> (shift)) & (mask)) -+#endif -+ -+#define HALMAC_SET_BD_FIELD_CLR HALMAC_SET_DESC_FIELD_CLR -+#define HALMAC_SET_BD_FIELD_NO_CLR HALMAC_SET_DESC_FIELD_NO_CLR -+#define HALMAC_GET_BD_FIELD HALMAC_GET_DESC_FIELD -+ -+#ifndef GET_H2C_FIELD -+#define GET_H2C_FIELD LE_BITS_TO_4BYTE -+#endif -+ -+#ifndef SET_H2C_FIELD_CLR -+#define SET_H2C_FIELD_CLR SET_BITS_TO_LE_4BYTE -+#endif -+ -+#ifndef SET_H2C_FIELD_NO_CLR -+#define SET_H2C_FIELD_NO_CLR SET_BITS_TO_LE_4BYTE -+#endif -+ -+#ifndef GET_C2H_FIELD -+#define GET_C2H_FIELD LE_BITS_TO_4BYTE -+#endif -+ -+#ifndef SET_C2H_FIELD_CLR -+#define SET_C2H_FIELD_CLR SET_BITS_TO_LE_4BYTE -+#endif -+ -+#ifndef SET_C2H_FIELD_NO_CLR -+#define SET_C2H_FIELD_NO_CLR SET_BITS_TO_LE_4BYTE -+#endif -+ -+#endif /* #if !HALMAC_PLATFORM_WINDOWS */ -+ -+#ifndef BIT -+#define BIT(x) (1 << (x)) -+#endif -+ -+#ifndef ARRAY_SIZE -+#define ARRAY_SIZE(arr) (sizeof(arr) / sizeof((arr)[0])) -+#endif -+ -+/* HALMAC API return status*/ -+enum halmac_ret_status { -+ HALMAC_RET_SUCCESS = 0x00, -+ HALMAC_RET_NOT_SUPPORT = 0x01, -+ HALMAC_RET_SUCCESS_ENQUEUE = 0x01, /*Don't use this return code!!*/ -+ HALMAC_RET_PLATFORM_API_NULL = 0x02, -+ HALMAC_RET_EFUSE_SIZE_INCORRECT = 0x03, -+ HALMAC_RET_MALLOC_FAIL = 0x04, -+ HALMAC_RET_ADAPTER_INVALID = 0x05, -+ HALMAC_RET_ITF_INCORRECT = 0x06, -+ HALMAC_RET_DLFW_FAIL = 0x07, -+ HALMAC_RET_PORT_NOT_SUPPORT = 0x08, -+ HALMAC_RET_TXAGG_OVERFLOW = 0x09, -+ HALMAC_RET_INIT_LLT_FAIL = 0x0A, -+ HALMAC_RET_POWER_STATE_INVALID = 0x0B, -+ HALMAC_RET_H2C_ACK_NOT_RECEIVED = 0x0C, -+ HALMAC_RET_DL_RSVD_PAGE_FAIL = 0x0D, -+ HALMAC_RET_EFUSE_R_FAIL = 0x0E, -+ HALMAC_RET_EFUSE_W_FAIL = 0x0F, -+ HALMAC_RET_H2C_SW_RES_FAIL = 0x10, -+ HALMAC_RET_SEND_H2C_FAIL = 0x11, -+ HALMAC_RET_PARA_NOT_SUPPORT = 0x12, -+ HALMAC_RET_PLATFORM_API_INCORRECT = 0x13, -+ HALMAC_RET_ENDIAN_ERR = 0x14, -+ HALMAC_RET_FW_SIZE_ERR = 0x15, -+ HALMAC_RET_TRX_MODE_NOT_SUPPORT = 0x16, -+ HALMAC_RET_FAIL = 0x17, -+ HALMAC_RET_CHANGE_PS_FAIL = 0x18, -+ HALMAC_RET_CFG_PARA_FAIL = 0x19, -+ HALMAC_RET_UPDATE_PROBE_FAIL = 0x1A, -+ HALMAC_RET_SCAN_FAIL = 0x1B, -+ HALMAC_RET_STOP_SCAN_FAIL = 0x1C, -+ HALMAC_RET_BCN_PARSER_CMD_FAIL = 0x1D, -+ HALMAC_RET_POWER_ON_FAIL = 0x1E, -+ HALMAC_RET_POWER_OFF_FAIL = 0x1F, -+ HALMAC_RET_RX_AGG_MODE_FAIL = 0x20, -+ HALMAC_RET_DATA_BUF_NULL = 0x21, -+ HALMAC_RET_DATA_SIZE_INCORRECT = 0x22, -+ HALMAC_RET_QSEL_INCORRECT = 0x23, -+ HALMAC_RET_DMA_MAP_INCORRECT = 0x24, -+ HALMAC_RET_SEND_ORIGINAL_H2C_FAIL = 0x25, -+ HALMAC_RET_DDMA_FAIL = 0x26, -+ HALMAC_RET_FW_CHECKSUM_FAIL = 0x27, -+ HALMAC_RET_PWRSEQ_POLLING_FAIL = 0x28, -+ HALMAC_RET_PWRSEQ_CMD_INCORRECT = 0x29, -+ HALMAC_RET_WRITE_DATA_FAIL = 0x2A, -+ HALMAC_RET_DUMP_FIFOSIZE_INCORRECT = 0x2B, -+ HALMAC_RET_NULL_POINTER = 0x2C, -+ HALMAC_RET_PROBE_NOT_FOUND = 0x2D, -+ HALMAC_RET_FW_NO_MEMORY = 0x2E, -+ HALMAC_RET_H2C_STATUS_ERR = 0x2F, -+ HALMAC_RET_GET_H2C_SPACE_ERR = 0x30, -+ HALMAC_RET_H2C_SPACE_FULL = 0x31, -+ HALMAC_RET_DATAPACK_NO_FOUND = 0x32, -+ HALMAC_RET_CANNOT_FIND_H2C_RESOURCE = 0x33, -+ HALMAC_RET_TX_DMA_ERR = 0x34, -+ HALMAC_RET_RX_DMA_ERR = 0x35, -+ HALMAC_RET_CHIP_NOT_SUPPORT = 0x36, -+ HALMAC_RET_FREE_SPACE_NOT_ENOUGH = 0x37, -+ HALMAC_RET_CH_SW_SEQ_WRONG = 0x38, -+ HALMAC_RET_CH_SW_NO_BUF = 0x39, -+ HALMAC_RET_SW_CASE_NOT_SUPPORT = 0x3A, -+ HALMAC_RET_CONVERT_SDIO_OFFSET_FAIL = 0x3B, -+ HALMAC_RET_INVALID_SOUNDING_SETTING = 0x3C, -+ HALMAC_RET_GEN_INFO_NOT_SENT = 0x3D, -+ HALMAC_RET_STATE_INCORRECT = 0x3E, -+ HALMAC_RET_H2C_BUSY = 0x3F, -+ HALMAC_RET_INVALID_FEATURE_ID = 0x40, -+ HALMAC_RET_BUFFER_TOO_SMALL = 0x41, -+ HALMAC_RET_ZERO_LEN_RSVD_PACKET = 0x42, -+ HALMAC_RET_BUSY_STATE = 0x43, -+ HALMAC_RET_ERROR_STATE = 0x44, -+ HALMAC_RET_API_INVALID = 0x45, -+ HALMAC_RET_POLLING_BCN_VALID_FAIL = 0x46, -+ HALMAC_RET_SDIO_LEAVE_SUSPEND_FAIL = 0x47, -+ HALMAC_RET_EEPROM_PARSING_FAIL = 0x48, -+ HALMAC_RET_EFUSE_NOT_ENOUGH = 0x49, -+ HALMAC_RET_WRONG_ARGUMENT = 0x4A, -+ HALMAC_RET_C2H_NOT_HANDLED = 0x4C, -+ HALMAC_RET_PARA_SENDING = 0x4D, -+ HALMAC_RET_CFG_DLFW_SIZE_FAIL = 0x4E, -+ HALMAC_RET_CFG_TXFIFO_PAGE_FAIL = 0x4F, -+ HALMAC_RET_SWITCH_CASE_ERROR = 0x50, -+ HALMAC_RET_EFUSE_BANK_INCORRECT = 0x51, -+ HALMAC_RET_SWITCH_EFUSE_BANK_FAIL = 0x52, -+ HALMAC_RET_USB_MODE_UNCHANGE = 0x53, -+ HALMAC_RET_NO_DLFW = 0x54, -+ HALMAC_RET_USB2_3_SWITCH_UNSUPPORT = 0x55, -+ HALMAC_RET_BIP_NO_SUPPORT = 0x56, -+ HALMAC_RET_ENTRY_INDEX_ERROR = 0x57, -+ HALMAC_RET_ENTRY_KEY_ID_ERROR = 0x58, -+ HALMAC_RET_DRV_DL_ERR = 0x59, -+ HALMAC_RET_OQT_NOT_ENOUGH = 0x5A, -+ HALMAC_RET_PWR_UNCHANGE = 0x5B, -+ HALMAC_RET_WRONG_INTF = 0x5C, -+ HALMAC_RET_POLLING_HIOE_REQ_FAIL = 0x5E, -+ HALMAC_RET_HIOE_CHKSUM_FAIL = 0x5F, -+ HALMAC_RET_HIOE_ERR = 0x60, -+ HALMAC_RET_FW_NO_SUPPORT = 0x60, -+ HALMAC_RET_TXFIFO_NO_EMPTY = 0x61, -+ HALMAC_RET_SDIO_CLOCK_ERR = 0x62, -+ HALMAC_RET_GET_PINMUX_ERR = 0x63, -+ HALMAC_RET_PINMUX_USED = 0x64, -+ HALMAC_RET_WRONG_GPIO = 0x65, -+ HALMAC_RET_LTECOEX_READY_FAIL = 0x66, -+ HALMAC_RET_IDMEM_CHKSUM_FAIL = 0x67, -+ HALMAC_RET_ILLEGAL_KEY_FAIL = 0x68, -+ HALMAC_RET_FW_READY_CHK_FAIL = 0x69, -+ HALMAC_RET_RSVD_PG_OVERFLOW_FAIL = 0x70, -+ HALMAC_RET_THRESHOLD_FAIL = 0x71, -+ HALMAC_RET_SDIO_MIX_MODE = 0x72, -+ HALMAC_RET_TXDESC_SET_FAIL = 0x73, -+ HALMAC_RET_WLHDR_FAIL = 0x74, -+ HALMAC_RET_WLAN_MODE_FAIL = 0x75, -+ HALMAC_RET_SDIO_SEQ_FAIL = 0x72, -+ HALMAC_RET_INIT_XTAL_AAC_FAIL = 0x76, -+ HALMAC_RET_PINMUX_NOT_SUPPORT = 0x77, -+ HALMAC_RET_FWFF_NO_EMPTY = 0x78, -+ HALMAC_RET_ADR_NOT_ALIGN = 0x79, -+}; -+ -+enum halmac_chip_id { -+ HALMAC_CHIP_ID_8822B = 0, -+ HALMAC_CHIP_ID_8821C = 1, -+ HALMAC_CHIP_ID_8814B = 2, -+ HALMAC_CHIP_ID_8197F = 3, -+ HALMAC_CHIP_ID_8822C = 4, -+ HALMAC_CHIP_ID_8812F = 5, -+ HALMAC_CHIP_ID_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_chip_ver { -+ HALMAC_CHIP_VER_A_CUT = 0x00, -+ HALMAC_CHIP_VER_B_CUT = 0x01, -+ HALMAC_CHIP_VER_C_CUT = 0x02, -+ HALMAC_CHIP_VER_D_CUT = 0x03, -+ HALMAC_CHIP_VER_E_CUT = 0x04, -+ HALMAC_CHIP_VER_F_CUT = 0x05, -+ HALMAC_CHIP_VER_G_CUT = 0x06, -+ HALMAC_CHIP_VER_H_CUT = 0x07, -+ HALMAC_CHIP_VER_I_CUT = 0x08, -+ HALMAC_CHIP_VER_J_CUT = 0x09, -+ HALMAC_CHIP_VER_K_CUT = 0x0A, -+ HALMAC_CHIP_VER_L_CUT = 0x0B, -+ HALMAC_CHIP_VER_M_CUT = 0x0C, -+ HALMAC_CHIP_VER_TEST = 0xFF, -+ HALMAC_CHIP_VER_UNDEFINE = 0x7FFF, -+}; -+ -+enum halmac_network_type_select { -+ HALMAC_NETWORK_NO_LINK = 0, -+ HALMAC_NETWORK_ADHOC = 1, -+ HALMAC_NETWORK_INFRASTRUCTURE = 2, -+ HALMAC_NETWORK_AP = 3, -+ HALMAC_NETWORK_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_transfer_mode_select { -+ HALMAC_TRNSFER_NORMAL = 0x0, -+ HALMAC_TRNSFER_LOOPBACK_DIRECT = 0xB, -+ HALMAC_TRNSFER_LOOPBACK_DELAY = 0x3, -+ HALMAC_TRNSFER_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_dma_mapping { -+ HALMAC_DMA_MAPPING_EXTRA = 0, -+ HALMAC_DMA_MAPPING_LOW = 1, -+ HALMAC_DMA_MAPPING_NORMAL = 2, -+ HALMAC_DMA_MAPPING_HIGH = 3, -+ HALMAC_DMA_MAPPING_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_io_size { -+ HALMAC_IO_BYTE = 0x0, -+ HALMAC_IO_WORD = 0x1, -+ HALMAC_IO_DWORD = 0x2, -+ HALMAC_IO_UNDEFINE = 0x7F, -+}; -+ -+#define HALMAC_MAP2_HQ HALMAC_DMA_MAPPING_HIGH -+#define HALMAC_MAP2_NQ HALMAC_DMA_MAPPING_NORMAL -+#define HALMAC_MAP2_LQ HALMAC_DMA_MAPPING_LOW -+#define HALMAC_MAP2_EXQ HALMAC_DMA_MAPPING_EXTRA -+#define HALMAC_MAP2_UNDEF HALMAC_DMA_MAPPING_UNDEFINE -+ -+enum halmac_txdesc_queue_tid { -+ HALMAC_TXDESC_QSEL_TID0 = 0, -+ HALMAC_TXDESC_QSEL_TID1 = 1, -+ HALMAC_TXDESC_QSEL_TID2 = 2, -+ HALMAC_TXDESC_QSEL_TID3 = 3, -+ HALMAC_TXDESC_QSEL_TID4 = 4, -+ HALMAC_TXDESC_QSEL_TID5 = 5, -+ HALMAC_TXDESC_QSEL_TID6 = 6, -+ HALMAC_TXDESC_QSEL_TID7 = 7, -+ HALMAC_TXDESC_QSEL_TID8 = 8, -+ HALMAC_TXDESC_QSEL_TID9 = 9, -+ HALMAC_TXDESC_QSEL_TIDA = 10, -+ HALMAC_TXDESC_QSEL_TIDB = 11, -+ HALMAC_TXDESC_QSEL_TIDC = 12, -+ HALMAC_TXDESC_QSEL_TIDD = 13, -+ HALMAC_TXDESC_QSEL_TIDE = 14, -+ HALMAC_TXDESC_QSEL_TIDF = 15, -+ -+ HALMAC_TXDESC_QSEL_BEACON = 0x10, -+ HALMAC_TXDESC_QSEL_HIGH = 0x11, -+ HALMAC_TXDESC_QSEL_MGT = 0x12, -+ HALMAC_TXDESC_QSEL_H2C_CMD = 0x13, -+ HALMAC_TXDESC_QSEL_FWCMD = 0x14, -+ -+ HALMAC_TXDESC_QSEL_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_pq_map_id { -+ HALMAC_PQ_MAP_VO = 0x0, -+ HALMAC_PQ_MAP_VI = 0x1, -+ HALMAC_PQ_MAP_BE = 0x2, -+ HALMAC_PQ_MAP_BK = 0x3, -+ HALMAC_PQ_MAP_MG = 0x4, -+ HALMAC_PQ_MAP_HI = 0x5, -+ HALMAC_PQ_MAP_NUM = 0x6, -+ HALMAC_PQ_MAP_UNDEF = 0x7F, -+}; -+ -+enum halmac_qsel { -+ HALMAC_QSEL_VO = HALMAC_TXDESC_QSEL_TID6, -+ HALMAC_QSEL_VI = HALMAC_TXDESC_QSEL_TID4, -+ HALMAC_QSEL_BE = HALMAC_TXDESC_QSEL_TID0, -+ HALMAC_QSEL_BK = HALMAC_TXDESC_QSEL_TID1, -+ HALMAC_QSEL_VO_V2 = HALMAC_TXDESC_QSEL_TID7, -+ HALMAC_QSEL_VI_V2 = HALMAC_TXDESC_QSEL_TID5, -+ HALMAC_QSEL_BE_V2 = HALMAC_TXDESC_QSEL_TID3, -+ HALMAC_QSEL_BK_V2 = HALMAC_TXDESC_QSEL_TID2, -+ HALMAC_QSEL_TID8 = HALMAC_TXDESC_QSEL_TID8, -+ HALMAC_QSEL_TID9 = HALMAC_TXDESC_QSEL_TID9, -+ HALMAC_QSEL_TIDA = HALMAC_TXDESC_QSEL_TIDA, -+ HALMAC_QSEL_TIDB = HALMAC_TXDESC_QSEL_TIDB, -+ HALMAC_QSEL_TIDC = HALMAC_TXDESC_QSEL_TIDC, -+ HALMAC_QSEL_TIDD = HALMAC_TXDESC_QSEL_TIDD, -+ HALMAC_QSEL_TIDE = HALMAC_TXDESC_QSEL_TIDE, -+ HALMAC_QSEL_TIDF = HALMAC_TXDESC_QSEL_TIDF, -+ HALMAC_QSEL_BCN = HALMAC_TXDESC_QSEL_BEACON, -+ HALMAC_QSEL_HIGH = HALMAC_TXDESC_QSEL_HIGH, -+ HALMAC_QSEL_MGNT = HALMAC_TXDESC_QSEL_MGT, -+ HALMAC_QSEL_CMD = HALMAC_TXDESC_QSEL_H2C_CMD, -+ HALMAC_QSEL_FWCMD = HALMAC_TXDESC_QSEL_FWCMD, -+ HALMAC_QSEL_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_acq_id { -+ HALMAC_ACQ_ID_VO = 0, -+ HALMAC_ACQ_ID_VI = 1, -+ HALMAC_ACQ_ID_BE = 2, -+ HALMAC_ACQ_ID_BK = 3, -+ HALMAC_ACQ_ID_MAX = 0x7F, -+}; -+ -+enum halmac_txdesc_dma_ch { -+ HALMAC_TXDESC_DMA_CH0 = 0, -+ HALMAC_TXDESC_DMA_CH1 = 1, -+ HALMAC_TXDESC_DMA_CH2 = 2, -+ HALMAC_TXDESC_DMA_CH3 = 3, -+ HALMAC_TXDESC_DMA_CH4 = 4, -+ HALMAC_TXDESC_DMA_CH5 = 5, -+ HALMAC_TXDESC_DMA_CH6 = 6, -+ HALMAC_TXDESC_DMA_CH7 = 7, -+ HALMAC_TXDESC_DMA_CH8 = 8, -+ HALMAC_TXDESC_DMA_CH9 = 9, -+ HALMAC_TXDESC_DMA_CH10 = 10, -+ HALMAC_TXDESC_DMA_CH11 = 11, -+ HALMAC_TXDESC_DMA_CH12 = 12, -+ HALMAC_TXDESC_DMA_CH13 = 13, -+ HALMAC_TXDESC_DMA_CH14 = 14, -+ HALMAC_TXDESC_DMA_CH15 = 15, -+ HALMAC_TXDESC_DMA_CH16 = 16, -+ HALMAC_TXDESC_DMA_CH17 = 17, -+ HALMAC_TXDESC_DMA_CH18 = 18, -+ HALMAC_TXDESC_DMA_CH19 = 19, -+ HALMAC_TXDESC_DMA_CH20 = 20, -+ HALMAC_TXDESC_DMA_CHMAX, -+ HALMAC_TXDESC_DMA_CHUNDEFINE = 0x7F, -+}; -+ -+enum halmac_dma_ch { -+ HALMAC_DMA_CH_0 = HALMAC_TXDESC_DMA_CH0, -+ HALMAC_DMA_CH_1 = HALMAC_TXDESC_DMA_CH1, -+ HALMAC_DMA_CH_2 = HALMAC_TXDESC_DMA_CH2, -+ HALMAC_DMA_CH_3 = HALMAC_TXDESC_DMA_CH3, -+ HALMAC_DMA_CH_4 = HALMAC_TXDESC_DMA_CH4, -+ HALMAC_DMA_CH_5 = HALMAC_TXDESC_DMA_CH5, -+ HALMAC_DMA_CH_6 = HALMAC_TXDESC_DMA_CH6, -+ HALMAC_DMA_CH_7 = HALMAC_TXDESC_DMA_CH7, -+ HALMAC_DMA_CH_8 = HALMAC_TXDESC_DMA_CH8, -+ HALMAC_DMA_CH_9 = HALMAC_TXDESC_DMA_CH9, -+ HALMAC_DMA_CH_10 = HALMAC_TXDESC_DMA_CH10, -+ HALMAC_DMA_CH_11 = HALMAC_TXDESC_DMA_CH11, -+ HALMAC_DMA_CH_S0 = HALMAC_TXDESC_DMA_CH12, -+ HALMAC_DMA_CH_S1 = HALMAC_TXDESC_DMA_CH13, -+ HALMAC_DMA_CH_MGQ = HALMAC_TXDESC_DMA_CH14, -+ HALMAC_DMA_CH_HIGH = HALMAC_TXDESC_DMA_CH15, -+ HALMAC_DMA_CH_FWCMD = HALMAC_TXDESC_DMA_CH16, -+ HALMAC_DMA_CH_MGQ_BAND1 = HALMAC_TXDESC_DMA_CH17, -+ HALMAC_DMA_CH_HIGH_BAND1 = HALMAC_TXDESC_DMA_CH18, -+ HALMAC_DMA_CH_BCN = HALMAC_TXDESC_DMA_CH19, -+ HALMAC_DMA_CH_H2C = HALMAC_TXDESC_DMA_CH20, -+ HALMAC_DMA_CH_MAX = HALMAC_TXDESC_DMA_CHMAX, -+ HALMAC_DMA_CH_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_interface { -+ HALMAC_INTERFACE_PCIE = 0x0, -+ HALMAC_INTERFACE_USB = 0x1, -+ HALMAC_INTERFACE_SDIO = 0x2, -+ HALMAC_INTERFACE_AXI = 0x3, -+ HALMAC_INTERFACE_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_rx_agg_mode { -+ HALMAC_RX_AGG_MODE_NONE = 0x0, -+ HALMAC_RX_AGG_MODE_DMA = 0x1, -+ HALMAC_RX_AGG_MODE_USB = 0x2, -+ HALMAC_RX_AGG_MODE_UNDEFINE = 0x7F, -+}; -+ -+struct halmac_rxagg_th { -+ u8 drv_define; -+ u8 timeout; -+ u8 size; -+ u8 size_limit_en; -+}; -+ -+struct halmac_rxagg_cfg { -+ enum halmac_rx_agg_mode mode; -+ struct halmac_rxagg_th threshold; -+}; -+ -+struct halmac_api_registry { -+ u8 rx_exp_en:1; -+ u8 la_mode_en:1; -+ u8 cfg_drv_rsvd_pg_en:1; -+ u8 sdio_cmd53_4byte_en:1; -+ u8 rsvd:4; -+}; -+ -+enum halmac_watcher_sel { -+ HALMAC_WATCHER_SDIO_RN_FOOL_PROOFING = 0x0, -+ HALMAC_WATCHER_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_trx_mode { -+ HALMAC_TRX_MODE_NORMAL = 0x0, -+ HALMAC_TRX_MODE_TRXSHARE = 0x1, -+ HALMAC_TRX_MODE_WMM = 0x2, -+ HALMAC_TRX_MODE_P2P = 0x3, -+ HALMAC_TRX_MODE_LOOPBACK = 0x4, -+ HALMAC_TRX_MODE_DELAY_LOOPBACK = 0x5, -+ HALMAC_TRX_MODE_MAX = 0x6, -+ HALMAC_TRX_MODE_WMM_LINUX = 0x7E, -+ HALMAC_TRX_MODE_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_wireless_mode { -+ HALMAC_WIRELESS_MODE_B = 0x0, -+ HALMAC_WIRELESS_MODE_G = 0x1, -+ HALMAC_WIRELESS_MODE_N = 0x2, -+ HALMAC_WIRELESS_MODE_AC = 0x3, -+ HALMAC_WIRELESS_MODE_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_bw { -+ HALMAC_BW_20 = 0x00, -+ HALMAC_BW_40 = 0x01, -+ HALMAC_BW_80 = 0x02, -+ HALMAC_BW_160 = 0x03, -+ HALMAC_BW_5 = 0x04, -+ HALMAC_BW_10 = 0x05, -+ HALMAC_BW_MAX = 0x06, -+ HALMAC_BW_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_efuse_read_cfg { -+ HALMAC_EFUSE_R_AUTO = 0x00, -+ HALMAC_EFUSE_R_DRV = 0x01, -+ HALMAC_EFUSE_R_FW = 0x02, -+ HALMAC_EFUSE_R_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_dlfw_mem { -+ HALMAC_DLFW_MEM_EMEM = 0x00, -+ HALMAC_DLFW_MEM_EMEM_RSVD_PG = 0x01, -+ HALMAC_DLFW_MEM_UNDEFINE = 0x7F, -+}; -+ -+struct halmac_tx_desc { -+ u32 dword0; -+ u32 dword1; -+ u32 dword2; -+ u32 dword3; -+ u32 dword4; -+ u32 dword5; -+ u32 dword6; -+ u32 dword7; -+ u32 dword8; -+ u32 dword9; -+ u32 dword10; -+ u32 dword11; -+}; -+ -+struct halmac_rx_desc { -+ u32 dword0; -+ u32 dword1; -+ u32 dword2; -+ u32 dword3; -+ u32 dword4; -+ u32 dword5; -+}; -+ -+struct halmac_bcn_ie_info { -+ u8 func_en; -+ u8 size_th; -+ u8 timeout; -+ u8 ie_bmp[HALMAC_BCN_IE_BMP_SIZE]; -+}; -+ -+enum halmac_parameter_cmd { -+ /* HALMAC_PARAMETER_CMD_LLT = 0x1, */ -+ /* HALMAC_PARAMETER_CMD_R_EFUSE = 0x2, */ -+ /* HALMAC_PARAMETER_CMD_EFUSE_PATCH = 0x3, */ -+ HALMAC_PARAMETER_CMD_MAC_W8 = 0x4, -+ HALMAC_PARAMETER_CMD_MAC_W16 = 0x5, -+ HALMAC_PARAMETER_CMD_MAC_W32 = 0x6, -+ HALMAC_PARAMETER_CMD_RF_W = 0x7, -+ HALMAC_PARAMETER_CMD_BB_W8 = 0x8, -+ HALMAC_PARAMETER_CMD_BB_W16 = 0x9, -+ HALMAC_PARAMETER_CMD_BB_W32 = 0XA, -+ HALMAC_PARAMETER_CMD_DELAY_US = 0X10, -+ HALMAC_PARAMETER_CMD_DELAY_MS = 0X11, -+ HALMAC_PARAMETER_CMD_END = 0XFF, -+}; -+ -+union halmac_parameter_content { -+ struct _MAC_REG_W { -+ u32 value; -+ u32 msk; -+ u16 offset; -+ u8 msk_en; -+ } MAC_REG_W; -+ struct _BB_REG_W { -+ u32 value; -+ u32 msk; -+ u16 offset; -+ u8 msk_en; -+ } BB_REG_W; -+ struct _RF_REG_W { -+ u32 value; -+ u32 msk; -+ u8 offset; -+ u8 msk_en; -+ u8 rf_path; -+ } RF_REG_W; -+ struct _DELAY_TIME { -+ u32 rsvd1; -+ u32 rsvd2; -+ u16 delay_time; -+ u8 rsvd3; -+ } DELAY_TIME; -+}; -+ -+struct halmac_phy_parameter_info { -+ enum halmac_parameter_cmd cmd_id; -+ union halmac_parameter_content content; -+}; -+ -+struct halmac_pg_efuse_info { -+ u8 *efuse_map; -+ u32 efuse_map_size; -+ u8 *efuse_mask; -+ u32 efuse_mask_size; -+}; -+ -+struct halmac_cfg_param_info { -+ u32 buf_size; -+ u8 *buf; -+ u8 *buf_wptr; -+ u32 num; -+ u32 avl_buf_size; -+ u32 offset_accum; -+ u32 value_accum; -+ enum halmac_data_type data_type; -+ u8 full_fifo_mode; -+}; -+ -+struct halmac_hw_cfg_info { -+ u32 efuse_size; -+ u32 eeprom_size; -+ u32 bt_efuse_size; -+ u32 tx_fifo_size; -+ u32 rx_fifo_size; -+ u32 rx_desc_fifo_size; -+ u32 page_size; -+ u16 tx_align_size; -+ u8 txdesc_size; -+ u8 rxdesc_size; -+ u8 cam_entry_num; -+ u8 chk_security_keyid; -+ u8 txdesc_ie_max_num; -+ u8 txdesc_body_size; -+ u8 ac_oqt_size; -+ u8 non_ac_oqt_size; -+ u8 acq_num; -+ u8 trx_mode; -+ u8 usb_txagg_num; -+ u32 prtct_efuse_size; -+}; -+ -+struct halmac_sdio_free_space { -+ u16 hiq_pg_num; -+ u16 miq_pg_num; -+ u16 lowq_pg_num; -+ u16 pubq_pg_num; -+ u16 exq_pg_num; -+ u8 ac_oqt_num; -+ u8 non_ac_oqt_num; -+ u8 ac_empty; -+ u8 *macid_map; -+ u32 macid_map_size; -+}; -+ -+enum hal_fifo_sel { -+ HAL_FIFO_SEL_TX, -+ HAL_FIFO_SEL_RX, -+ HAL_FIFO_SEL_RSVD_PAGE, -+ HAL_FIFO_SEL_REPORT, -+ HAL_FIFO_SEL_LLT, -+ HAL_FIFO_SEL_RXBUF_FW, -+ HAL_FIFO_SEL_RXBUF_PHY, -+ HAL_FIFO_SEL_RXDESC, -+ HAL_BUF_SECURITY_CAM, -+ HAL_BUF_WOW_CAM, -+ HAL_BUF_RX_FILTER_CAM, -+ HAL_BUF_BA_CAM, -+ HAL_BUF_MBSSID_CAM -+}; -+ -+enum halmac_drv_info { -+ /* No information is appended in rx_pkt */ -+ HALMAC_DRV_INFO_NONE, -+ /* PHY status is appended after rx_desc */ -+ HALMAC_DRV_INFO_PHY_STATUS, -+ /* PHY status and sniffer info are appended after rx_desc */ -+ HALMAC_DRV_INFO_PHY_SNIFFER, -+ /* PHY status and plcp header are appended after rx_desc */ -+ HALMAC_DRV_INFO_PHY_PLCP, -+ HALMAC_DRV_INFO_UNDEFINE, -+}; -+ -+enum halmac_pri_ch_idx { -+ HALMAC_CH_IDX_UNDEFINE = 0, -+ HALMAC_CH_IDX_1 = 1, -+ HALMAC_CH_IDX_2 = 2, -+ HALMAC_CH_IDX_3 = 3, -+ HALMAC_CH_IDX_4 = 4, -+ HALMAC_CH_IDX_MAX = 5, -+}; -+ -+struct halmac_ch_info { -+ enum halmac_cs_action_id action_id; -+ enum halmac_bw bw; -+ enum halmac_pri_ch_idx pri_ch_idx; -+ u8 channel; -+ u8 timeout; -+ u8 extra_info; -+}; -+ -+struct halmac_ch_extra_info { -+ u8 extra_info; -+ enum halmac_cs_extra_action_id extra_action_id; -+ u8 extra_info_size; -+ u8 *extra_info_data; -+}; -+ -+enum halmac_cs_periodic_option { -+ HALMAC_CS_PERIODIC_NONE, -+ HALMAC_CS_PERIODIC_NORMAL, -+ HALMAC_CS_PERIODIC_2_PHASE, -+ HALMAC_CS_PERIODIC_SEAMLESS, -+}; -+ -+struct halmac_ch_switch_option { -+ enum halmac_bw dest_bw; -+ enum halmac_cs_periodic_option periodic_option; -+ enum halmac_pri_ch_idx dest_pri_ch_idx; -+ /* u32 tsf_high; */ -+ u32 tsf_low; -+ u8 switch_en; -+ u8 dest_ch_en; -+ u8 absolute_time_en; -+ u8 dest_ch; -+ u8 scan_mode_en; -+ u8 normal_period; -+ u8 normal_period_sel; -+ u8 normal_cycle; -+ u8 phase_2_period; -+ u8 phase_2_period_sel; -+ u8 nlo_en; -+}; -+ -+struct halmac_drop_pkt_option { -+ u8 drop_all:1; -+ u8 drop_single:1; -+ u8 rsvd:6; -+ u8 drop_index; -+}; -+ -+struct halmac_p2pps { -+ u8 offload_en:1; -+ u8 role:1; -+ u8 ctwindow_en:1; -+ u8 noa_en:1; -+ u8 noa_sel:1; -+ u8 all_sta_sleep:1; -+ u8 discovery:1; -+ u8 disable_close_rf:1; -+ u8 p2p_port_id; -+ u8 p2p_group; -+ u8 p2p_macid; -+ u8 ctwindow_length; -+ u8 rsvd3; -+ u8 rsvd4; -+ u8 rsvd5; -+ u32 noa_duration_para; -+ u32 noa_interval_para; -+ u32 noa_start_time_para; -+ u32 noa_count_para; -+}; -+ -+struct halmac_fw_build_time { -+ u16 year; -+ u8 month; -+ u8 date; -+ u8 hour; -+ u8 min; -+}; -+ -+struct halmac_fw_version { -+ u16 version; -+ u8 sub_version; -+ u8 sub_index; -+ u16 h2c_version; -+ struct halmac_fw_build_time build_time; -+}; -+ -+enum halmac_rf_type { -+ HALMAC_RF_1T2R = 0, -+ HALMAC_RF_2T4R = 1, -+ HALMAC_RF_2T2R = 2, -+ HALMAC_RF_2T3R = 3, -+ HALMAC_RF_1T1R = 4, -+ HALMAC_RF_2T2R_GREEN = 5, -+ HALMAC_RF_3T3R = 6, -+ HALMAC_RF_3T4R = 7, -+ HALMAC_RF_4T4R = 8, -+ HALMAC_RF_MAX_TYPE = 0xF, -+}; -+ -+struct halmac_general_info { -+ u8 rfe_type; -+ enum halmac_rf_type rf_type; -+ u8 tx_ant_status; -+ u8 rx_ant_status; -+ u8 ext_pa; -+ u8 package_type; -+ u8 mp_mode; -+}; -+ -+struct halmac_pwr_tracking_para { -+ u8 enable; -+ u8 tx_pwr_index; -+ u8 pwr_tracking_offset_value; -+ u8 tssi_value; -+}; -+ -+struct halmac_pwr_tracking_option { -+ u8 type; -+ u8 bbswing_index; -+ /* pathA, pathB, pathC, pathD */ -+ struct halmac_pwr_tracking_para pwr_tracking_para[4]; -+}; -+ -+struct halmac_fast_edca_cfg { -+ enum halmac_acq_id acq_id; -+ u8 queue_to; /* unit : 32us*/ -+}; -+ -+struct halmac_txfifo_lifetime_cfg { -+ u8 enable; -+ u32 lifetime; -+}; -+ -+enum halmac_data_rate { -+ HALMAC_CCK1, -+ HALMAC_CCK2, -+ HALMAC_CCK5_5, -+ HALMAC_CCK11, -+ HALMAC_OFDM6, -+ HALMAC_OFDM9, -+ HALMAC_OFDM12, -+ HALMAC_OFDM18, -+ HALMAC_OFDM24, -+ HALMAC_OFDM36, -+ HALMAC_OFDM48, -+ HALMAC_OFDM54, -+ HALMAC_MCS0, -+ HALMAC_MCS1, -+ HALMAC_MCS2, -+ HALMAC_MCS3, -+ HALMAC_MCS4, -+ HALMAC_MCS5, -+ HALMAC_MCS6, -+ HALMAC_MCS7, -+ HALMAC_MCS8, -+ HALMAC_MCS9, -+ HALMAC_MCS10, -+ HALMAC_MCS11, -+ HALMAC_MCS12, -+ HALMAC_MCS13, -+ HALMAC_MCS14, -+ HALMAC_MCS15, -+ HALMAC_MCS16, -+ HALMAC_MCS17, -+ HALMAC_MCS18, -+ HALMAC_MCS19, -+ HALMAC_MCS20, -+ HALMAC_MCS21, -+ HALMAC_MCS22, -+ HALMAC_MCS23, -+ HALMAC_MCS24, -+ HALMAC_MCS25, -+ HALMAC_MCS26, -+ HALMAC_MCS27, -+ HALMAC_MCS28, -+ HALMAC_MCS29, -+ HALMAC_MCS30, -+ HALMAC_MCS31, -+ HALMAC_VHT_NSS1_MCS0, -+ HALMAC_VHT_NSS1_MCS1, -+ HALMAC_VHT_NSS1_MCS2, -+ HALMAC_VHT_NSS1_MCS3, -+ HALMAC_VHT_NSS1_MCS4, -+ HALMAC_VHT_NSS1_MCS5, -+ HALMAC_VHT_NSS1_MCS6, -+ HALMAC_VHT_NSS1_MCS7, -+ HALMAC_VHT_NSS1_MCS8, -+ HALMAC_VHT_NSS1_MCS9, -+ HALMAC_VHT_NSS2_MCS0, -+ HALMAC_VHT_NSS2_MCS1, -+ HALMAC_VHT_NSS2_MCS2, -+ HALMAC_VHT_NSS2_MCS3, -+ HALMAC_VHT_NSS2_MCS4, -+ HALMAC_VHT_NSS2_MCS5, -+ HALMAC_VHT_NSS2_MCS6, -+ HALMAC_VHT_NSS2_MCS7, -+ HALMAC_VHT_NSS2_MCS8, -+ HALMAC_VHT_NSS2_MCS9, -+ HALMAC_VHT_NSS3_MCS0, -+ HALMAC_VHT_NSS3_MCS1, -+ HALMAC_VHT_NSS3_MCS2, -+ HALMAC_VHT_NSS3_MCS3, -+ HALMAC_VHT_NSS3_MCS4, -+ HALMAC_VHT_NSS3_MCS5, -+ HALMAC_VHT_NSS3_MCS6, -+ HALMAC_VHT_NSS3_MCS7, -+ HALMAC_VHT_NSS3_MCS8, -+ HALMAC_VHT_NSS3_MCS9, -+ HALMAC_VHT_NSS4_MCS0, -+ HALMAC_VHT_NSS4_MCS1, -+ HALMAC_VHT_NSS4_MCS2, -+ HALMAC_VHT_NSS4_MCS3, -+ HALMAC_VHT_NSS4_MCS4, -+ HALMAC_VHT_NSS4_MCS5, -+ HALMAC_VHT_NSS4_MCS6, -+ HALMAC_VHT_NSS4_MCS7, -+ HALMAC_VHT_NSS4_MCS8, -+ HALMAC_VHT_NSS4_MCS9, -+ /*FPGA only*/ -+ HALMAC_VHT_NSS5_MCS0, -+ HALMAC_VHT_NSS6_MCS0, -+ HALMAC_VHT_NSS7_MCS0, -+ HALMAC_VHT_NSS8_MCS0 -+}; -+ -+enum halmac_rf_path { -+ HALMAC_RF_PATH_A, -+ HALMAC_RF_PATH_B, -+ HALMAC_RF_PATH_C, -+ HALMAC_RF_PATH_D, -+ HALMAC_RF_SYN_0, -+ HALMAC_RF_SYN_1 -+}; -+ -+enum hal_security_type { -+ HAL_SECURITY_TYPE_NONE = 0, -+ HAL_SECURITY_TYPE_WEP40 = 1, -+ HAL_SECURITY_TYPE_WEP104 = 2, -+ HAL_SECURITY_TYPE_TKIP = 3, -+ HAL_SECURITY_TYPE_AES128 = 4, -+ HAL_SECURITY_TYPE_WAPI = 5, -+ HAL_SECURITY_TYPE_AES256 = 6, -+ HAL_SECURITY_TYPE_GCMP128 = 7, -+ HAL_SECURITY_TYPE_GCMP256 = 8, -+ HAL_SECURITY_TYPE_GCMSMS4 = 9, -+ HAL_SECURITY_TYPE_BIP = 10, -+ HAL_SECURITY_TYPE_UNDEFINE = 0x7F, -+}; -+ -+enum hal_intf_phy { -+ HAL_INTF_PHY_USB2 = 0, -+ HAL_INTF_PHY_USB3 = 1, -+ HAL_INTF_PHY_PCIE_GEN1 = 2, -+ HAL_INTF_PHY_PCIE_GEN2 = 3, -+ HAL_INTF_PHY_UNDEFINE = 0x7F, -+}; -+ -+struct halmac_cut_amsdu_cfg { -+ u8 cut_amsdu_en; -+ u8 chk_len_en; -+ u8 chk_len_def_val; -+ u8 chk_len_l_th; -+ u16 chk_len_h_th; -+}; -+ -+enum halmac_dbg_msg_info { -+ HALMAC_DBG_ALWAYS, -+ HALMAC_DBG_ERR, -+ HALMAC_DBG_WARN, -+ HALMAC_DBG_TRACE, -+}; -+ -+enum halmac_dbg_msg_type { -+ HALMAC_MSG_INIT, -+ HALMAC_MSG_EFUSE, -+ HALMAC_MSG_FW, -+ HALMAC_MSG_H2C, -+ HALMAC_MSG_PWR, -+ HALMAC_MSG_SND, -+ HALMAC_MSG_COMMON, -+ HALMAC_MSG_DBI, -+ HALMAC_MSG_MDIO, -+ HALMAC_MSG_USB, -+}; -+ -+enum halmac_feature_id { -+ HALMAC_FEATURE_CFG_PARA, /* Support */ -+ HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE, /* Support */ -+ HALMAC_FEATURE_DUMP_LOGICAL_EFUSE, /* Support */ -+ HALMAC_FEATURE_DUMP_LOGICAL_EFUSE_MASK, /* Support */ -+ HALMAC_FEATURE_UPDATE_PACKET, /* Support */ -+ HALMAC_FEATURE_SEND_SCAN_PACKET, /* Support */ -+ HALMAC_FEATURE_DROP_SCAN_PACKET, /* Support */ -+ HALMAC_FEATURE_UPDATE_DATAPACK, -+ HALMAC_FEATURE_RUN_DATAPACK, -+ HALMAC_FEATURE_CHANNEL_SWITCH, /* Support */ -+ HALMAC_FEATURE_IQK, /* Support */ -+ HALMAC_FEATURE_POWER_TRACKING, /* Support */ -+ HALMAC_FEATURE_PSD, /* Support */ -+ HALMAC_FEATURE_FW_SNDING, /* Support */ -+ HALMAC_FEATURE_DPK, /* Support */ -+ HALMAC_FEATURE_ALL, /* Support, only for reset */ -+}; -+ -+enum halmac_drv_rsvd_pg_num { -+ HALMAC_RSVD_PG_NUM8, /* 1K */ -+ HALMAC_RSVD_PG_NUM16, /* 2K */ -+ HALMAC_RSVD_PG_NUM24, /* 3K */ -+ HALMAC_RSVD_PG_NUM32, /* 4K */ -+ HALMAC_RSVD_PG_NUM64, /* 8K */ -+ HALMAC_RSVD_PG_NUM128, /* 16K */ -+ HALMAC_RSVD_PG_NUM256, /* 32K */ -+}; -+ -+enum halmac_pcie_cfg { -+ HALMAC_PCIE_GEN1, -+ HALMAC_PCIE_GEN2, -+ HALMAC_PCIE_CFG_UNDEFINE, -+}; -+ -+enum halmac_portid { -+ HALMAC_PORTID0 = 0, -+ HALMAC_PORTID1 = 1, -+ HALMAC_PORTID2 = 2, -+ HALMAC_PORTID3 = 3, -+ HALMAC_PORTID4 = 4, -+ HALMAC_PORTID_NUM = 5, -+}; -+ -+struct halmac_bcn_ctrl { -+ u8 dis_rx_bssid_fit; -+ u8 en_txbcn_rpt; -+ u8 dis_tsf_udt; -+ u8 en_bcn; -+ u8 en_rxbcn_rpt; -+ u8 en_p2p_ctwin; -+ u8 en_p2p_bcn_area; -+}; -+ -+/* User only can use Address[6]*/ -+/* Address[0] is lowest, Address[5] is highest */ -+union halmac_wlan_addr { -+ u8 addr[6]; -+ struct { -+ union { -+ __le32 low; -+ u8 low_byte[4]; -+ }; -+ union { -+ __le16 high; -+ u8 high_byte[2]; -+ }; -+ } addr_l_h; -+}; -+ -+struct halmac_platform_api { -+ /* R/W register */ -+ u8 (*SDIO_CMD52_READ)(void *drv_adapter, u32 offset); -+ u8 (*SDIO_CMD53_READ_8)(void *drv_adapter, u32 offset); -+ u16 (*SDIO_CMD53_READ_16)(void *drv_adapter, u32 offset); -+ u32 (*SDIO_CMD53_READ_32)(void *drv_adapter, u32 offset); -+ u8 (*SDIO_CMD53_READ_N)(void *drv_adapter, u32 offset, u32 size, -+ u8 *data); -+ void (*SDIO_CMD52_WRITE)(void *drv_adapter, u32 offset, u8 value); -+ void (*SDIO_CMD53_WRITE_8)(void *drv_adapter, u32 offset, u8 value); -+ void (*SDIO_CMD53_WRITE_16)(void *drv_adapter, u32 offset, u16 value); -+ void (*SDIO_CMD53_WRITE_32)(void *drv_adapter, u32 offset, u32 value); -+ u8 (*REG_READ_8)(void *drv_adapter, u32 offset); -+ u16 (*REG_READ_16)(void *drv_adapter, u32 offset); -+ u32 (*REG_READ_32)(void *drv_adapter, u32 offset); -+ void (*REG_WRITE_8)(void *drv_adapter, u32 offset, u8 value); -+ void (*REG_WRITE_16)(void *drv_adapter, u32 offset, u16 value); -+ void (*REG_WRITE_32)(void *drv_adapter, u32 offset, u32 value); -+ u8 (*SDIO_CMD52_CIA_READ)(void *drv_adapter, u32 offset); -+ -+ /* send pBuf to reserved page, the tx_desc is not included in pBuf */ -+ /* driver need to fill tx_desc with qsel = bcn */ -+ u8 (*SEND_RSVD_PAGE)(void *drv_adapter, u8 *buf, u32 size); -+ /* send pBuf to h2c queue, the tx_desc is not included in pBuf */ -+ /* driver need to fill tx_desc with qsel = h2c */ -+ u8 (*SEND_H2C_PKT)(void *drv_adapter, u8 *buf, u32 size); -+ -+ u8 (*RTL_FREE)(void *drv_adapter, void *buf, u32 size); -+ void* (*RTL_MALLOC)(void *drv_adapter, u32 size); -+ u8 (*RTL_MEMCPY)(void *drv_adapter, void *dest, void *src, u32 size); -+ u8 (*RTL_MEMSET)(void *drv_adapter, void *addr, u8 value, u32 size); -+ void (*RTL_DELAY_US)(void *drv_adapter, u32 us); -+ -+ u8 (*MUTEX_INIT)(void *drv_adapter, HALMAC_MUTEX *mutex); -+ u8 (*MUTEX_DEINIT)(void *drv_adapter, HALMAC_MUTEX *mutex); -+ u8 (*MUTEX_LOCK)(void *drv_adapter, HALMAC_MUTEX *mutex); -+ u8 (*MUTEX_UNLOCK)(void *drv_adapter, HALMAC_MUTEX *mutex); -+ -+ u8 (*MSG_PRINT)(void *drv_adapter, u32 msg_type, u8 msg_level, -+ s8 *fmt, ...); -+ u8 (*BUFF_PRINT)(void *drv_adapter, u32 msg_type, u8 msg_level, s8 *buf, -+ u32 size); -+ -+ u8 (*EVENT_INDICATION)(void *drv_adapter, -+ enum halmac_feature_id feature_id, -+ enum halmac_cmd_process_status process_status, -+ u8 *buf, u32 size); -+#if HALMAC_DBG_MONITOR_IO -+ void (*READ_MONITOR)(void *drv_adapter, u32 offset, u32 byte, u32 val, -+ const char *caller, const u32 line); -+ void (*WRITE_MONITOR)(void *drv_adapter, u32 offset, u32 byte, u32 val, -+ const char *caller, const u32 line); -+#endif -+#if HALMAC_PLATFORM_TESTPROGRAM -+ struct halmisc_platform_api *halmisc_pltfm_api; -+#endif -+}; -+ -+enum halmac_snd_role { -+ HAL_BFER = 0, -+ HAL_BFEE = 1, -+}; -+ -+enum halmac_csi_seg_len { -+ HAL_CSI_SEG_4K = 0, -+ HAL_CSI_SEG_8K = 1, -+ HAL_CSI_SEG_11K = 2, -+}; -+ -+struct halmac_cfg_mumimo_para { -+ enum halmac_snd_role role; -+ u8 sounding_sts[6]; -+ u16 grouping_bitmap; -+ u8 mu_tx_en; -+ u32 given_gid_tab[2]; -+ u32 given_user_pos[4]; -+}; -+ -+struct halmac_su_bfer_init_para { -+ u8 userid; -+ u16 paid; -+ u16 csi_para; -+ union halmac_wlan_addr bfer_address; -+}; -+ -+struct halmac_mu_bfee_init_para { -+ u8 userid; -+ u16 paid; -+ u32 user_position_l; /*for gid 0~15*/ -+ u32 user_position_h; /*for gid 16~31*/ -+ u32 user_position_l_1; /*for gid 32~47*/ -+ u32 user_position_h_1; /*for gid 48~63*/ -+}; -+ -+struct halmac_mu_bfer_init_para { -+ u16 paid; -+ u16 csi_para; -+ u16 my_aid; -+ enum halmac_csi_seg_len csi_length_sel; -+ union halmac_wlan_addr bfer_address; -+}; -+ -+struct halmac_ch_sw_info { -+ u8 *buf; -+ u8 *buf_wptr; -+ u8 scan_mode; -+ u8 extra_info_en; -+ u32 buf_size; -+ u32 avl_buf_size; -+ u32 total_size; -+ u32 ch_num; -+}; -+ -+struct halmac_ch_sw_extra_scan { -+ u8 dwell_ext_val:7; -+ u8 dwell_ext_en:1; -+ u8 dwell_ext_c2h:1; -+ u8 post_tx_c2h:1; -+ u8 pre_tx_c2h:1; -+ u8 post_switch_c2h:1; -+ u8 pre_switch_c2h:1; -+ u8 rsvd0:2; -+ u8 wait_probrsp:1; -+ u8 txid:7; -+ u8 rsvd1:1; -+}; -+ -+struct halmac_scan_rpt_info { -+ u8 *buf; -+ u8 *buf_wptr; -+ u32 buf_size; -+ u32 avl_buf_size; -+ u32 total_size; -+ u32 ack_tsf_low; -+ u32 ack_tsf_high; -+ u32 rpt_tsf_low; -+ u32 rpt_tsf_high; -+}; -+ -+struct halmac_event_trigger { -+ u32 phy_efuse_map : 1; -+ u32 log_efuse_map : 1; -+ u32 log_efuse_mask : 1; -+ u32 rsvd1 : 27; -+}; -+ -+struct halmac_h2c_header_info { -+ u16 sub_cmd_id; -+ u16 content_size; -+ u8 ack; -+}; -+ -+struct halmac_ver { -+ u8 major_ver; -+ u8 prototype_ver; -+ u8 minor_ver; -+}; -+ -+enum halmac_api_id { -+ /*stuff, need to be the 1st*/ -+ HALMAC_API_STUFF = 0x0, -+ /*stuff, need to be the 1st*/ -+ HALMAC_API_MAC_POWER_SWITCH = 0x1, -+ HALMAC_API_DOWNLOAD_FIRMWARE = 0x2, -+ HALMAC_API_CFG_MAC_ADDR = 0x3, -+ HALMAC_API_CFG_BSSID = 0x4, -+ HALMAC_API_CFG_MULTICAST_ADDR = 0x5, -+ HALMAC_API_PRE_INIT_SYSTEM_CFG = 0x6, -+ HALMAC_API_INIT_SYSTEM_CFG = 0x7, -+ HALMAC_API_INIT_TRX_CFG = 0x8, -+ HALMAC_API_CFG_RX_AGGREGATION = 0x9, -+ HALMAC_API_INIT_PROTOCOL_CFG = 0xA, -+ HALMAC_API_INIT_EDCA_CFG = 0xB, -+ HALMAC_API_CFG_OPERATION_MODE = 0xC, -+ HALMAC_API_CFG_CH_BW = 0xD, -+ HALMAC_API_CFG_BW = 0xE, -+ HALMAC_API_INIT_WMAC_CFG = 0xF, -+ HALMAC_API_INIT_MAC_CFG = 0x10, -+ HALMAC_API_INIT_SDIO_CFG = 0x11, -+ HALMAC_API_INIT_USB_CFG = 0x12, -+ HALMAC_API_INIT_PCIE_CFG = 0x13, -+ HALMAC_API_INIT_INTERFACE_CFG = 0x14, -+ HALMAC_API_DEINIT_SDIO_CFG = 0x15, -+ HALMAC_API_DEINIT_USB_CFG = 0x16, -+ HALMAC_API_DEINIT_PCIE_CFG = 0x17, -+ HALMAC_API_DEINIT_INTERFACE_CFG = 0x18, -+ HALMAC_API_GET_EFUSE_SIZE = 0x19, -+ HALMAC_API_DUMP_EFUSE_MAP = 0x1A, -+ HALMAC_API_GET_LOGICAL_EFUSE_SIZE = 0x1D, -+ HALMAC_API_DUMP_LOGICAL_EFUSE_MAP = 0x1E, -+ HALMAC_API_WRITE_LOGICAL_EFUSE = 0x1F, -+ HALMAC_API_READ_LOGICAL_EFUSE = 0x20, -+ HALMAC_API_PG_EFUSE_BY_MAP = 0x21, -+ HALMAC_API_GET_C2H_INFO = 0x22, -+ HALMAC_API_CFG_FWLPS_OPTION = 0x23, -+ HALMAC_API_CFG_FWIPS_OPTION = 0x24, -+ HALMAC_API_ENTER_WOWLAN = 0x25, -+ HALMAC_API_LEAVE_WOWLAN = 0x26, -+ HALMAC_API_ENTER_PS = 0x27, -+ HALMAC_API_LEAVE_PS = 0x28, -+ HALMAC_API_H2C_LB = 0x29, -+ HALMAC_API_DEBUG = 0x2A, -+ HALMAC_API_CFG_PARAMETER = 0x2B, -+ HALMAC_API_UPDATE_PACKET = 0x2C, -+ HALMAC_API_BCN_IE_FILTER = 0x2D, -+ HALMAC_API_REG_READ_8 = 0x2E, -+ HALMAC_API_REG_WRITE_8 = 0x2F, -+ HALMAC_API_REG_READ_16 = 0x30, -+ HALMAC_API_REG_WRITE_16 = 0x31, -+ HALMAC_API_REG_READ_32 = 0x32, -+ HALMAC_API_REG_WRITE_32 = 0x33, -+ HALMAC_API_TX_ALLOWED_SDIO = 0x34, -+ HALMAC_API_SET_BULKOUT_NUM = 0x35, -+ HALMAC_API_GET_SDIO_TX_ADDR = 0x36, -+ HALMAC_API_GET_USB_BULKOUT_ID = 0x37, -+ HALMAC_API_TIMER_2S = 0x38, -+ HALMAC_API_FILL_TXDESC_CHECKSUM = 0x39, -+ HALMAC_API_SEND_ORIGINAL_H2C = 0x3A, -+ HALMAC_API_UPDATE_DATAPACK = 0x3B, -+ HALMAC_API_RUN_DATAPACK = 0x3C, -+ HALMAC_API_CFG_DRV_INFO = 0x3D, -+ HALMAC_API_SEND_BT_COEX = 0x3E, -+ HALMAC_API_VERIFY_PLATFORM_API = 0x3F, -+ HALMAC_API_GET_FIFO_SIZE = 0x40, -+ HALMAC_API_DUMP_FIFO = 0x41, -+ HALMAC_API_CFG_TXBF = 0x42, -+ HALMAC_API_CFG_MUMIMO = 0x43, -+ HALMAC_API_CFG_SOUNDING = 0x44, -+ HALMAC_API_DEL_SOUNDING = 0x45, -+ HALMAC_API_SU_BFER_ENTRY_INIT = 0x46, -+ HALMAC_API_SU_BFEE_ENTRY_INIT = 0x47, -+ HALMAC_API_MU_BFER_ENTRY_INIT = 0x48, -+ HALMAC_API_MU_BFEE_ENTRY_INIT = 0x49, -+ HALMAC_API_SU_BFER_ENTRY_DEL = 0x4A, -+ HALMAC_API_SU_BFEE_ENTRY_DEL = 0x4B, -+ HALMAC_API_MU_BFER_ENTRY_DEL = 0x4C, -+ HALMAC_API_MU_BFEE_ENTRY_DEL = 0x4D, -+ HALMAC_API_ADD_CH_INFO = 0x4E, -+ HALMAC_API_ADD_EXTRA_CH_INFO = 0x4F, -+ HALMAC_API_CTRL_CH_SWITCH = 0x50, -+ HALMAC_API_CLEAR_CH_INFO = 0x51, -+ HALMAC_API_SEND_GENERAL_INFO = 0x52, -+ HALMAC_API_START_IQK = 0x53, -+ HALMAC_API_CTRL_PWR_TRACKING = 0x54, -+ HALMAC_API_PSD = 0x55, -+ HALMAC_API_CFG_TX_AGG_ALIGN = 0x56, -+ HALMAC_API_QUERY_STATE = 0x57, -+ HALMAC_API_RESET_FEATURE = 0x58, -+ HALMAC_API_CHECK_FW_STATUS = 0x59, -+ HALMAC_API_DUMP_FW_DMEM = 0x5A, -+ HALMAC_API_CFG_MAX_DL_SIZE = 0x5B, -+ HALMAC_API_INIT_OBJ = 0x5C, -+ HALMAC_API_DEINIT_OBJ = 0x5D, -+ HALMAC_API_CFG_LA_MODE = 0x5E, -+ HALMAC_API_GET_HW_VALUE = 0x5F, -+ HALMAC_API_SET_HW_VALUE = 0x60, -+ HALMAC_API_CFG_DRV_RSVD_PG_NUM = 0x61, -+ HALMAC_API_WRITE_EFUSE_BT = 0x63, -+ HALMAC_API_DUMP_EFUSE_MAP_BT = 0x64, -+ HALMAC_API_DL_DRV_RSVD_PG = 0x65, -+ HALMAC_API_PCIE_SWITCH = 0x66, -+ HALMAC_API_PHY_CFG = 0x67, -+ HALMAC_API_CFG_RX_FIFO_EXPANDING_MODE = 0x68, -+ HALMAC_API_CFG_CSI_RATE = 0x69, -+ HALMAC_API_P2PPS = 0x6A, -+ HALMAC_API_CFG_TX_ADDR = 0x6B, -+ HALMAC_API_CFG_NET_TYPE = 0x6C, -+ HALMAC_API_CFG_TSF_RESET = 0x6D, -+ HALMAC_API_CFG_BCN_SPACE = 0x6E, -+ HALMAC_API_CFG_BCN_CTRL = 0x6F, -+ HALMAC_API_CFG_SIDEBAND_INT = 0x70, -+ HALMAC_API_REGISTER_API = 0x71, -+ HALMAC_API_FREE_DOWNLOAD_FIRMWARE = 0x72, -+ HALMAC_API_GET_FW_VERSION = 0x73, -+ HALMAC_API_GET_EFUSE_AVAL_SIZE = 0x74, -+ HALMAC_API_CHK_TXDESC = 0x75, -+ HALMAC_API_SDIO_CMD53_4BYTE = 0x76, -+ HALMAC_API_CFG_TRANS_ADDR = 0x77, -+ HALMAC_API_INTF_INTEGRA_TUNING = 0x78, -+ HALMAC_API_TXFIFO_IS_EMPTY = 0x79, -+ HALMAC_API_DOWNLOAD_FLASH = 0x7A, -+ HALMAC_API_READ_FLASH = 0x7B, -+ HALMAC_API_ERASE_FLASH = 0x7C, -+ HALMAC_API_CHECK_FLASH = 0x7D, -+ HALMAC_API_SDIO_HW_INFO = 0x80, -+ HALMAC_API_READ_EFUSE_BT = 0x81, -+ HALMAC_API_CFG_EFUSE_AUTO_CHECK = 0x82, -+ HALMAC_API_CFG_PINMUX_GET_FUNC = 0x83, -+ HALMAC_API_CFG_PINMUX_SET_FUNC = 0x84, -+ HALMAC_API_CFG_PINMUX_FREE_FUNC = 0x85, -+ HALMAC_API_CFG_PINMUX_WL_LED_MODE = 0x86, -+ HALMAC_API_CFG_PINMUX_WL_LED_SW_CTRL = 0x87, -+ HALMAC_API_CFG_PINMUX_SDIO_INT_POLARITY = 0x88, -+ HALMAC_API_CFG_PINMUX_GPIO_MODE = 0x89, -+ HALMAC_API_CFG_PINMUX_GPIO_OUTPUT = 0x90, -+ HALMAC_API_REG_READ_INDIRECT_32 = 0x91, -+ HALMAC_API_REG_SDIO_CMD53_READ_N = 0x92, -+ HALMAC_API_PINMUX_PIN_STATUS = 0x94, -+ HALMAC_API_OFLD_FUNC_CFG = 0x95, -+ HALMAC_API_MASK_LOGICAL_EFUSE = 0x96, -+ HALMAC_API_RX_CUT_AMSDU_CFG = 0x97, -+ HALMAC_API_FW_SNDING = 0x98, -+ HALMAC_API_ENTER_CPU_SLEEP_MODE = 0x99, -+ HALMAC_API_GET_CPU_MODE = 0x9A, -+ HALMAC_API_DRV_FWCTRL = 0x9B, -+ HALMAC_API_EN_REF_AUTOK = 0x9C, -+ HALMAC_API_RESET_WIFI_FW = 0x9D, -+ HALMAC_API_CFGSPC_SET_PCIE = 0x9E, -+ HALMAC_API_GET_WATCHER = 0x9F, -+ HALMAC_API_DUMP_LOGICAL_EFUSE_MASK = 0xA0, -+ HALMAC_API_WRITE_LOGICAL_EFUSE_WORD = 0xA1, -+ HALMAC_API_READ_WIFI_PHY_EFUSE = 0xA2, -+ HALMAC_API_WRITE_WIFI_PHY_EFUSE = 0xA3, -+ HALMAC_API_START_DPK = 0xA4, -+ HALMAC_API_MAX -+}; -+ -+enum halmac_la_mode { -+ HALMAC_LA_MODE_DISABLE = 0, -+ HALMAC_LA_MODE_PARTIAL = 1, -+ HALMAC_LA_MODE_FULL = 2, -+ HALMAC_LA_MODE_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_rx_fifo_expanding_mode { -+ HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE = 0, -+ HALMAC_RX_FIFO_EXPANDING_MODE_1_BLOCK = 1, -+ HALMAC_RX_FIFO_EXPANDING_MODE_2_BLOCK = 2, -+ HALMAC_RX_FIFO_EXPANDING_MODE_3_BLOCK = 3, -+ HALMAC_RX_FIFO_EXPANDING_MODE_4_BLOCK = 4, -+ HALMAC_RX_FIFO_EXPANDING_MODE_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_sdio_cmd53_4byte_mode { -+ HALMAC_SDIO_CMD53_4BYTE_MODE_DISABLE = 0, -+ HALMAC_SDIO_CMD53_4BYTE_MODE_RW = 1, -+ HALMAC_SDIO_CMD53_4BYTE_MODE_R = 2, -+ HALMAC_SDIO_CMD53_4BYTE_MODE_W = 3, -+ HALMAC_SDIO_CMD53_4BYTE_MODE_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_usb_mode { -+ HALMAC_USB_MODE_U2 = 1, -+ HALMAC_USB_MODE_U3 = 2, -+}; -+ -+enum halmac_sdio_tx_format { -+ HALMAC_SDIO_AGG_MODE = 1, -+ HALMAC_SDIO_DUMMY_BLOCK_MODE = 2, -+ HALMAC_SDIO_DUMMY_AUTO_MODE = 3, -+}; -+ -+enum halmac_sdio_clk_monitor { -+ HALMAC_MONITOR_5US = 1, -+ HALMAC_MONITOR_50US = 2, -+ HALMAC_MONITOR_9MS = 3, -+}; -+ -+enum halmac_hw_id { -+ /* Get HW value */ -+ HALMAC_HW_RQPN_MAPPING = 0x00, -+ HALMAC_HW_EFUSE_SIZE = 0x01, -+ HALMAC_HW_EEPROM_SIZE = 0x02, -+ HALMAC_HW_BT_BANK_EFUSE_SIZE = 0x03, -+ HALMAC_HW_BT_BANK1_EFUSE_SIZE = 0x04, -+ HALMAC_HW_BT_BANK2_EFUSE_SIZE = 0x05, -+ HALMAC_HW_TXFIFO_SIZE = 0x06, -+ HALMAC_HW_RXFIFO_SIZE = 0x07, -+ HALMAC_HW_RSVD_PG_BNDY = 0x08, -+ HALMAC_HW_CAM_ENTRY_NUM = 0x09, -+ HALMAC_HW_IC_VERSION = 0x0A, -+ HALMAC_HW_PAGE_SIZE = 0x0B, -+ HALMAC_HW_TX_AGG_ALIGN_SIZE = 0x0C, -+ HALMAC_HW_RX_AGG_ALIGN_SIZE = 0x0D, -+ HALMAC_HW_DRV_INFO_SIZE = 0x0E, -+ HALMAC_HW_TXFF_ALLOCATION = 0x0F, -+ HALMAC_HW_RSVD_EFUSE_SIZE = 0x10, -+ HALMAC_HW_FW_HDR_SIZE = 0x11, -+ HALMAC_HW_TX_DESC_SIZE = 0x12, -+ HALMAC_HW_RX_DESC_SIZE = 0x13, -+ HALMAC_HW_FW_MAX_SIZE = 0x14, -+ HALMAC_HW_ORI_H2C_SIZE = 0x15, -+ HALMAC_HW_RSVD_DRV_PGNUM = 0x16, -+ HALMAC_HW_TX_PAGE_SIZE = 0x17, -+ HALMAC_HW_USB_TXAGG_DESC_NUM = 0x18, -+ HALMAC_HW_WLAN_EFUSE_AVAILABLE_SIZE = 0x19, -+ HALMAC_HW_AC_OQT_SIZE = 0x1C, -+ HALMAC_HW_NON_AC_OQT_SIZE = 0x1D, -+ HALMAC_HW_AC_QUEUE_NUM = 0x1E, -+ HALMAC_HW_RQPN_CH_MAPPING = 0x1F, -+ HALMAC_HW_PWR_STATE = 0x20, -+ HALMAC_HW_SDIO_INT_LAT = 0x21, -+ HALMAC_HW_SDIO_CLK_CNT = 0x22, -+ /* Set HW value */ -+ HALMAC_HW_USB_MODE = 0x60, -+ HALMAC_HW_SEQ_EN = 0x61, -+ HALMAC_HW_BANDWIDTH = 0x62, -+ HALMAC_HW_CHANNEL = 0x63, -+ HALMAC_HW_PRI_CHANNEL_IDX = 0x64, -+ HALMAC_HW_EN_BB_RF = 0x65, -+ HALMAC_HW_SDIO_TX_PAGE_THRESHOLD = 0x66, -+ HALMAC_HW_AMPDU_CONFIG = 0x67, -+ HALMAC_HW_RX_SHIFT = 0x68, -+ HALMAC_HW_TXDESC_CHECKSUM = 0x69, -+ HALMAC_HW_RX_CLK_GATE = 0x6A, -+ HALMAC_HW_RXGCK_FIFO = 0x6B, -+ HALMAC_HW_RX_IGNORE = 0x6C, -+ HALMAC_HW_SDIO_TX_FORMAT = 0x6D, -+ HALMAC_HW_FAST_EDCA = 0x6E, -+ HALMAC_HW_LDO25_EN = 0x6F, -+ HALMAC_HW_PCIE_REF_AUTOK = 0x70, -+ HALMAC_HW_RTS_FULL_BW = 0x71, -+ HALMAC_HW_FREE_CNT_EN = 0x72, -+ HALMAC_HW_SDIO_WT_EN = 0x73, -+ HALMAC_HW_SDIO_CLK_MONITOR = 0x74, -+ HALMAC_HW_TXFIFO_LIFETIME = 0x75, -+ HALMAC_HW_ID_UNDEFINE = 0x7F, -+}; -+ -+enum halmac_efuse_bank { -+ HALMAC_EFUSE_BANK_WIFI = 0, -+ HALMAC_EFUSE_BANK_BT = 1, -+ HALMAC_EFUSE_BANK_BT_1 = 2, -+ HALMAC_EFUSE_BANK_BT_2 = 3, -+ HALMAC_EFUSE_BANK_MAX, -+ HALMAC_EFUSE_BANK_UNDEFINE = 0X7F, -+}; -+ -+enum halmac_sdio_spec_ver { -+ HALMAC_SDIO_SPEC_VER_2_00 = 0, -+ HALMAC_SDIO_SPEC_VER_3_00 = 1, -+ HALMAC_SDIO_SPEC_VER_UNDEFINE = 0X7F, -+}; -+ -+enum halmac_gpio_func { -+ HALMAC_GPIO_FUNC_WL_LED = 0, -+ HALMAC_GPIO_FUNC_SDIO_INT = 1, -+ HALMAC_GPIO_FUNC_SW_IO_0 = 2, -+ HALMAC_GPIO_FUNC_SW_IO_1 = 3, -+ HALMAC_GPIO_FUNC_SW_IO_2 = 4, -+ HALMAC_GPIO_FUNC_SW_IO_3 = 5, -+ HALMAC_GPIO_FUNC_SW_IO_4 = 6, -+ HALMAC_GPIO_FUNC_SW_IO_5 = 7, -+ HALMAC_GPIO_FUNC_SW_IO_6 = 8, -+ HALMAC_GPIO_FUNC_SW_IO_7 = 9, -+ HALMAC_GPIO_FUNC_SW_IO_8 = 10, -+ HALMAC_GPIO_FUNC_SW_IO_9 = 11, -+ HALMAC_GPIO_FUNC_SW_IO_10 = 12, -+ HALMAC_GPIO_FUNC_SW_IO_11 = 13, -+ HALMAC_GPIO_FUNC_SW_IO_12 = 14, -+ HALMAC_GPIO_FUNC_SW_IO_13 = 15, -+ HALMAC_GPIO_FUNC_SW_IO_14 = 16, -+ HALMAC_GPIO_FUNC_SW_IO_15 = 17, -+ HALMAC_GPIO_FUNC_BT_HOST_WAKE1 = 18, -+ HALMAC_GPIO_FUNC_BT_DEV_WAKE1 = 19, -+ HALMAC_GPIO_FUNC_S0_PAPE = 20, -+ HALMAC_GPIO_FUNC_S1_PAPE = 21, -+ HALMAC_GPIO_FUNC_S0_TRSW = 22, -+ HALMAC_GPIO_FUNC_S1_TRSW = 23, -+ HALMAC_GPIO_FUNC_S0_TRSWB = 24, -+ HALMAC_GPIO_FUNC_S1_TRSWB = 25, -+ HALMAC_GPIO_FUNC_ANTSW = 26, -+ HALMAC_GPIO_FUNC_ANTSWB = 27, -+ HALMAC_GPIO_FUNC_UNDEFINE = 0X7F, -+}; -+ -+enum halmac_wlled_mode { -+ HALMAC_WLLED_MODE_TRX = 0, -+ HALMAC_WLLED_MODE_TX = 1, -+ HALMAC_WLLED_MODE_RX = 2, -+ HALMAC_WLLED_MODE_SW_CTRL = 3, -+ HALMAC_WLLED_MODE_UNDEFINE = 0X7F, -+}; -+ -+enum halmac_psf_fcs_chk_thr { -+ HALMAC_PSF_FCS_CHK_THR_4 = 1, -+ HALMAC_PSF_FCS_CHK_THR_8 = 2, -+ HALMAC_PSF_FCS_CHK_THR_12 = 3, -+ HALMAC_PSF_FCS_CHK_THR_16 = 4, -+ HALMAC_PSF_FCS_CHK_THR_20 = 5, -+ HALMAC_PSF_FCS_CHK_THR_24 = 6, -+ HALMAC_PSF_FCS_CHK_THR_28 = 7, -+}; -+ -+enum halmac_func_ctrl { -+ HALMAC_DISABLE = 0, -+ HALMAC_ENABLE = 1, -+ HALMAC_DEFAULT = 0xFE, -+ HALMAC_IGNORE = 0xFF -+}; -+ -+enum halmac_pcie_clkdly { -+ HALMAC_CLKDLY_0 = 0, -+ HALMAC_CLKDLY_5US = 1, -+ HALMAC_CLKDLY_6US = 2, -+ HALMAC_CLKDLY_11US = 3, -+ HALMAC_CLKDLY_15US = 4, -+ HALMAC_CLKDLY_19US = 5, -+ HALMAC_CLKDLY_25US = 6, -+ HALMAC_CLKDLY_30US = 7, -+ HALMAC_CLKDLY_38US = 8, -+ HALMAC_CLKDLY_50US = 9, -+ HALMAC_CLKDLY_64US = 10, -+ HALMAC_CLKDLY_100US = 11, -+ HALMAC_CLKDLY_128US = 12, -+ HALMAC_CLKDLY_150US = 13, -+ HALMAC_CLKDLY_192US = 14, -+ HALMAC_CLKDLY_200US = 15, -+ HALMAC_CLKDLY_R_ERR = 0xFD, -+ HALMAC_CLKDLY_DEF = 0xFE, -+ HALMAC_CLKDLY_IGNORE = 0xFF -+}; -+ -+enum halmac_pcie_l1dly { -+ HALMAC_L1DLY_16US = 0, -+ HALMAC_L1DLY_32US = 1, -+ HALMAC_L1DLY_64US = 2, -+ HALMAC_L1DLY_INFI = 3, -+ HALMAC_L1DLY_R_ERR = 0xFD, -+ HALMAC_L1DLY_DEF = 0xFE, -+ HALMAC_L1DLY_IGNORE = 0xFF -+}; -+ -+enum halmac_pcie_l0sdly { -+ HALMAC_L0SDLY_1US = 0, -+ HALMAC_L0SDLY_3US = 1, -+ HALMAC_L0SDLY_5US = 2, -+ HALMAC_L0SDLY_7US = 3, -+ HALMAC_L0SDLY_R_ERR = 0xFD, -+ HALMAC_L0SDLY_DEF = 0xFE, -+ HALMAC_L0SDLY_IGNORE = 0xFF -+}; -+ -+struct halmac_pcie_cfgspc_param { -+ u8 write; -+ u8 read; -+ enum halmac_func_ctrl l0s_ctrl; -+ enum halmac_func_ctrl l1_ctrl; -+ enum halmac_func_ctrl l1ss_ctrl; -+ enum halmac_func_ctrl wake_ctrl; -+ enum halmac_func_ctrl crq_ctrl; -+ enum halmac_pcie_clkdly clkdly_ctrl; -+ enum halmac_pcie_l0sdly l0sdly_ctrl; -+ enum halmac_pcie_l1dly l1dly_ctrl; -+}; -+ -+struct halmac_txff_allocation { -+ u16 tx_fifo_pg_num; -+ u16 rsvd_pg_num; -+ u16 rsvd_drv_pg_num; -+ u16 acq_pg_num; -+ u16 high_queue_pg_num; -+ u16 low_queue_pg_num; -+ u16 normal_queue_pg_num; -+ u16 extra_queue_pg_num; -+ u16 pub_queue_pg_num; -+ u16 rsvd_boundary; -+ u16 rsvd_drv_addr; -+ u16 rsvd_h2c_info_addr; -+ u16 rsvd_h2c_sta_info_addr; -+ u16 rsvd_h2cq_addr; -+ u16 rsvd_cpu_instr_addr; -+ u16 rsvd_fw_txbuf_addr; -+ u16 rsvd_csibuf_addr; -+ enum halmac_la_mode la_mode; -+ enum halmac_rx_fifo_expanding_mode rx_fifo_exp_mode; -+}; -+ -+struct halmac_rqpn_map { -+ enum halmac_dma_mapping dma_map_vo; -+ enum halmac_dma_mapping dma_map_vi; -+ enum halmac_dma_mapping dma_map_be; -+ enum halmac_dma_mapping dma_map_bk; -+ enum halmac_dma_mapping dma_map_mg; -+ enum halmac_dma_mapping dma_map_hi; -+}; -+ -+struct halmac_rqpn_ch_map { -+ enum halmac_dma_ch dma_map_vo; -+ enum halmac_dma_ch dma_map_vi; -+ enum halmac_dma_ch dma_map_be; -+ enum halmac_dma_ch dma_map_bk; -+ enum halmac_dma_ch dma_map_mg; -+ enum halmac_dma_ch dma_map_hi; -+}; -+ -+struct halmac_security_setting { -+ u8 tx_encryption; -+ u8 rx_decryption; -+ u8 bip_enable; -+ u8 compare_keyid; -+}; -+ -+struct halmac_cam_entry_info { -+ enum hal_security_type security_type; -+ u32 key[4]; -+ u32 key_ext[4]; -+ u8 mac_address[6]; -+ u8 unicast; -+ u8 key_id; -+ u8 valid; -+}; -+ -+struct halmac_cam_entry_format { -+ u16 key_id : 2; -+ u16 type : 3; -+ u16 mic : 1; -+ u16 grp : 1; -+ u16 spp_mode : 1; -+ u16 rpt_md : 1; -+ u16 ext_sectype : 1; -+ u16 mgnt : 1; -+ u16 rsvd1 : 4; -+ u16 valid : 1; -+ u8 mac_address[6]; -+ u32 key[4]; -+ u32 rsvd[2]; -+}; -+ -+struct halmac_tx_page_threshold_info { -+ u32 threshold; -+ enum halmac_dma_mapping dma_queue_sel; -+ u8 enable; -+}; -+ -+struct halmac_ampdu_config { -+ u8 max_agg_num; -+ u8 max_len_en; -+ u32 ht_max_len; -+ u32 vht_max_len; -+}; -+ -+struct halmac_rqpn { -+ enum halmac_trx_mode mode; -+ enum halmac_dma_mapping dma_map_vo; -+ enum halmac_dma_mapping dma_map_vi; -+ enum halmac_dma_mapping dma_map_be; -+ enum halmac_dma_mapping dma_map_bk; -+ enum halmac_dma_mapping dma_map_mg; -+ enum halmac_dma_mapping dma_map_hi; -+}; -+ -+struct halmac_ch_mapping { -+ enum halmac_trx_mode mode; -+ enum halmac_dma_ch dma_map_vo; -+ enum halmac_dma_ch dma_map_vi; -+ enum halmac_dma_ch dma_map_be; -+ enum halmac_dma_ch dma_map_bk; -+ enum halmac_dma_ch dma_map_mg; -+ enum halmac_dma_ch dma_map_hi; -+}; -+ -+struct halmac_pg_num { -+ enum halmac_trx_mode mode; -+ u16 hq_num; -+ u16 nq_num; -+ u16 lq_num; -+ u16 exq_num; -+ u16 gap_num;/*used for loopback mode*/ -+}; -+ -+struct halmac_ch_pg_num { -+ enum halmac_trx_mode mode; -+ u16 ch_num[HALMAC_TXDESC_DMA_CH16 + 1]; -+ u16 gap_num; -+}; -+ -+struct halmac_intf_phy_para { -+ u16 offset; -+ u16 value; -+ u16 ip_sel; -+ u16 cut; -+ u16 plaform; -+}; -+ -+struct halmac_iqk_para { -+ u8 clear; -+ u8 segment_iqk; -+}; -+ -+struct halmac_txdesc_ie_param { -+ u8 *start_offset; -+ u8 *end_offset; -+ u8 *ie_offset; -+ u8 *ie_exist; -+}; -+ -+struct halmac_sdio_hw_info { -+ enum halmac_sdio_spec_ver spec_ver; -+ u32 clock_speed; -+ u8 io_hi_speed_flag; /* Halmac internal use */ -+ enum halmac_sdio_tx_format tx_addr_format; -+ u16 block_size; -+ u8 tx_seq; -+ u8 io_indir_flag; /* Halmac internal use */ -+ u8 io_warn_flag; /* SW */ -+}; -+ -+struct halmac_edca_para { -+ u8 aifs; -+ u8 cw; -+ u16 txop_limit; -+}; -+ -+struct halmac_mac_rx_ignore_cfg { -+ u8 hdr_chk_en; -+ u8 fcs_chk_en; -+ u8 cck_rst_en; -+ enum halmac_psf_fcs_chk_thr fcs_chk_thr; -+}; -+ -+struct halmac_rx_ignore_info { -+ u8 hdr_chk_mask; -+ u8 fcs_chk_mask; -+ u8 hdr_chk_en; -+ u8 fcs_chk_en; -+ u8 cck_rst_en; -+ enum halmac_psf_fcs_chk_thr fcs_chk_thr; -+}; -+ -+struct halmac_get_watcher { -+ u32 sdio_rn_not_align; -+}; -+ -+struct halmac_watcher { -+ struct halmac_get_watcher get_watcher; -+}; -+ -+struct halmac_pinmux_info { -+ /* byte0 */ -+ u8 wl_led:1; -+ u8 sdio_int:1; -+ u8 bt_host_wake:1; -+ u8 bt_dev_wake:1; -+ u8 rsvd1:4; -+ /* byte1 */ -+ u8 sw_io_0:1; -+ u8 sw_io_1:1; -+ u8 sw_io_2:1; -+ u8 sw_io_3:1; -+ u8 sw_io_4:1; -+ u8 sw_io_5:1; -+ u8 sw_io_6:1; -+ u8 sw_io_7:1; -+ /* byte2 */ -+ u8 sw_io_8:1; -+ u8 sw_io_9:1; -+ u8 sw_io_10:1; -+ u8 sw_io_11:1; -+ u8 sw_io_12:1; -+ u8 sw_io_13:1; -+ u8 sw_io_14:1; -+ u8 sw_io_15:1; -+ /* byte3 */ -+ u8 s0_trsw:1; -+ u8 s1_trsw:1; -+ u8 s0_pape:1; -+ u8 s1_pape:1; -+ u8 s0_trswb:1; -+ u8 s1_trswb:1; -+ u8 antswb:1; -+ u8 antsw:1; -+}; -+ -+struct halmac_ofld_func_info { -+ u32 halmac_malloc_max_sz; -+ u32 rsvd_pg_drv_buf_max_sz; -+}; -+ -+struct halmac_pltfm_cfg_info { -+ u32 malloc_size; -+ u32 rsvd_pg_size; -+}; -+ -+struct halmac_su_snding_info { -+ u8 su0_en; -+ u8 *su0_ndpa_pkt; -+ u32 su0_pkt_sz; -+}; -+ -+struct halmac_mu_snding_info { -+ u8 tmp; -+}; -+ -+struct halmac_h2c_info { -+ u32 buf_fs; -+ u32 buf_size; -+ u8 seq_num; -+}; -+ -+struct halmac_adapter { -+ enum halmac_dma_mapping pq_map[HALMAC_PQ_MAP_NUM]; -+ enum halmac_dma_ch ch_map[HALMAC_PQ_MAP_NUM]; -+ HALMAC_MUTEX h2c_seq_mutex; /* protect h2c seq num */ -+ HALMAC_MUTEX efuse_mutex; /*protect adapter efuse map */ -+ HALMAC_MUTEX sdio_indir_mutex; /*protect sdio indirect access */ -+ struct halmac_cfg_param_info cfg_param_info; -+ struct halmac_ch_sw_info ch_sw_info; -+ struct halmac_scan_rpt_info scan_rpt_info; -+ struct halmac_event_trigger evnt; -+ struct halmac_hw_cfg_info hw_cfg_info; -+ struct halmac_sdio_free_space sdio_fs; -+ struct halmac_api_registry api_registry; -+ struct halmac_pinmux_info pinmux_info; -+ struct halmac_pltfm_cfg_info pltfm_info; -+ struct halmac_h2c_info h2c_info; -+ void *drv_adapter; -+ u8 *efuse_map; -+ void *halmac_api; -+ struct halmac_platform_api *pltfm_api; -+ u32 efuse_end; -+ u32 dlfw_pkt_size; -+ enum halmac_chip_id chip_id; -+ enum halmac_chip_ver chip_ver; -+ struct halmac_fw_version fw_ver; -+ struct halmac_state halmac_state; -+ enum halmac_interface intf; -+ enum halmac_trx_mode trx_mode; -+ struct halmac_txff_allocation txff_alloc; -+ u8 efuse_map_valid; -+ u8 efuse_seg_size; -+ u8 rpwm; -+ u8 bulkout_num; -+ u8 drv_info_size; -+ enum halmac_sdio_cmd53_4byte_mode sdio_cmd53_4byte; -+ struct halmac_sdio_hw_info sdio_hw_info; -+ u8 tx_desc_transfer; -+ u8 tx_desc_checksum; -+ u8 efuse_auto_check_en; -+ u8 pcie_refautok_en; -+ u8 pwr_off_flow_flag; -+ u8 nlo_flag; -+ struct halmac_rx_ignore_info rx_ignore_info; -+ struct halmac_watcher watcher; -+#if HALMAC_PLATFORM_TESTPROGRAM -+ struct halmisc_adapter *halmisc_adapter; -+#endif -+}; -+ -+struct halmac_api { -+ enum halmac_ret_status -+ (*halmac_register_api)(struct halmac_adapter *adapter, -+ struct halmac_api_registry *registry); -+ enum halmac_ret_status -+ (*halmac_mac_power_switch)(struct halmac_adapter *adapter, -+ enum halmac_mac_power pwr); -+ enum halmac_ret_status -+ (*halmac_download_firmware)(struct halmac_adapter *adapter, u8 *fw_bin, -+ u32 size); -+ enum halmac_ret_status -+ (*halmac_free_download_firmware)(struct halmac_adapter *adapter, -+ enum halmac_dlfw_mem mem_sel, -+ u8 *fw_bin, u32 size); -+ enum halmac_ret_status -+ (*halmac_reset_wifi_fw)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_get_fw_version)(struct halmac_adapter *adapter, -+ struct halmac_fw_version *ver); -+ enum halmac_ret_status -+ (*halmac_cfg_mac_addr)(struct halmac_adapter *adapter, -+ u8 port, union halmac_wlan_addr *addr); -+ enum halmac_ret_status -+ (*halmac_cfg_bssid)(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr); -+ enum halmac_ret_status -+ (*halmac_cfg_multicast_addr)(struct halmac_adapter *adapter, -+ union halmac_wlan_addr *addr); -+ enum halmac_ret_status -+ (*halmac_pre_init_system_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_init_system_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_init_trx_cfg)(struct halmac_adapter *adapter, -+ enum halmac_trx_mode mode); -+ enum halmac_ret_status -+ (*halmac_init_h2c)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_cfg_rx_aggregation)(struct halmac_adapter *adapter, -+ struct halmac_rxagg_cfg *cfg); -+ enum halmac_ret_status -+ (*halmac_init_protocol_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_init_edca_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_cfg_operation_mode)(struct halmac_adapter *adapter, -+ enum halmac_wireless_mode mode); -+ enum halmac_ret_status -+ (*halmac_cfg_ch_bw)(struct halmac_adapter *adapter, u8 ch, -+ enum halmac_pri_ch_idx idx, enum halmac_bw bw); -+ enum halmac_ret_status -+ (*halmac_cfg_bw)(struct halmac_adapter *adapter, enum halmac_bw bw); -+ enum halmac_ret_status -+ (*halmac_init_wmac_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_init_mac_cfg)(struct halmac_adapter *adapter, -+ enum halmac_trx_mode mode); -+ enum halmac_ret_status -+ (*halmac_init_interface_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_deinit_interface_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_init_sdio_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_init_usb_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_init_pcie_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_deinit_sdio_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_deinit_usb_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_deinit_pcie_cfg)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_get_efuse_size)(struct halmac_adapter *adapter, u32 *size); -+ enum halmac_ret_status -+ (*halmac_get_efuse_available_size)(struct halmac_adapter *adapter, -+ u32 *size); -+ enum halmac_ret_status -+ (*halmac_dump_efuse_map)(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg); -+ enum halmac_ret_status -+ (*halmac_dump_efuse_map_bt)(struct halmac_adapter *adapter, -+ enum halmac_efuse_bank bank, u32 size, -+ u8 *map); -+ enum halmac_ret_status -+ (*halmac_write_efuse_bt)(struct halmac_adapter *adapter, u32 offset, -+ u8 value, enum halmac_efuse_bank bank); -+ enum halmac_ret_status -+ (*halmac_read_efuse_bt)(struct halmac_adapter *adapter, u32 offset, -+ u8 *value, enum halmac_efuse_bank bank); -+ enum halmac_ret_status -+ (*halmac_cfg_efuse_auto_check)(struct halmac_adapter *adapter, -+ u8 enable); -+ enum halmac_ret_status -+ (*halmac_get_logical_efuse_size)(struct halmac_adapter *adapter, -+ u32 *size); -+ enum halmac_ret_status -+ (*halmac_dump_logical_efuse_map)(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg); -+ enum halmac_ret_status -+ (*halmac_dump_logical_efuse_mask)(struct halmac_adapter *adapter, -+ enum halmac_efuse_read_cfg cfg); -+ enum halmac_ret_status -+ (*halmac_write_logical_efuse)(struct halmac_adapter *adapter, -+ u32 offset, u8 value); -+ enum halmac_ret_status -+ (*halmac_write_logical_efuse_word)(struct halmac_adapter *adapter, -+ u32 offset, u16 value); -+ enum halmac_ret_status -+ (*halmac_read_logical_efuse)(struct halmac_adapter *adapter, u32 offset, -+ u8 *value); -+ enum halmac_ret_status -+ (*halmac_pg_efuse_by_map)(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info, -+ enum halmac_efuse_read_cfg cfg); -+ enum halmac_ret_status -+ (*halmac_mask_logical_efuse)(struct halmac_adapter *adapter, -+ struct halmac_pg_efuse_info *info); -+ enum halmac_ret_status -+ (*halmac_get_c2h_info)(struct halmac_adapter *adapter, u8 *buf, -+ u32 size); -+ enum halmac_ret_status -+ (*halmac_h2c_lb)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_debug)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_cfg_parameter)(struct halmac_adapter *adapter, -+ struct halmac_phy_parameter_info *info, -+ u8 full_fifo); -+ enum halmac_ret_status -+ (*halmac_update_packet)(struct halmac_adapter *adapter, -+ enum halmac_packet_id pkt_id, u8 *pkt, -+ u32 size); -+ enum halmac_ret_status -+ (*halmac_bcn_ie_filter)(struct halmac_adapter *adapter, -+ struct halmac_bcn_ie_info *info); -+ u8 -+ (*halmac_reg_read_8)(struct halmac_adapter *adapter, u32 offset); -+ enum halmac_ret_status -+ (*halmac_reg_write_8)(struct halmac_adapter *adapter, u32 offset, -+ u8 value); -+ u16 -+ (*halmac_reg_read_16)(struct halmac_adapter *adapter, u32 offset); -+ enum halmac_ret_status -+ (*halmac_reg_write_16)(struct halmac_adapter *adapter, u32 offset, -+ u16 value); -+ u32 -+ (*halmac_reg_read_32)(struct halmac_adapter *adapter, u32 offset); -+ enum halmac_ret_status -+ (*halmac_reg_write_32)(struct halmac_adapter *adapter, u32 offset, -+ u32 value); -+ u32 -+ (*halmac_reg_read_indirect_32)(struct halmac_adapter *adapter, -+ u32 offset); -+ enum halmac_ret_status -+ (*halmac_reg_sdio_cmd53_read_n)(struct halmac_adapter *adapter, -+ u32 offset, u32 size, u8 *value); -+ enum halmac_ret_status -+ (*halmac_tx_allowed_sdio)(struct halmac_adapter *adapter, u8 *buf, -+ u32 size); -+ enum halmac_ret_status -+ (*halmac_set_bulkout_num)(struct halmac_adapter *adapter, u8 num); -+ enum halmac_ret_status -+ (*halmac_get_sdio_tx_addr)(struct halmac_adapter *adapter, u8 *buf, -+ u32 size, u32 *cmd53_addr); -+ enum halmac_ret_status -+ (*halmac_get_usb_bulkout_id)(struct halmac_adapter *adapter, u8 *buf, -+ u32 size, u8 *id); -+ enum halmac_ret_status -+ (*halmac_fill_txdesc_checksum)(struct halmac_adapter *adapter, -+ u8 *txdesc); -+ enum halmac_ret_status -+ (*halmac_update_datapack)(struct halmac_adapter *adapter, -+ enum halmac_data_type data_type, -+ struct halmac_phy_parameter_info *info); -+ enum halmac_ret_status -+ (*halmac_run_datapack)(struct halmac_adapter *adapter, -+ enum halmac_data_type data_type); -+ enum halmac_ret_status -+ (*halmac_cfg_drv_info)(struct halmac_adapter *adapter, -+ enum halmac_drv_info drv_info); -+ enum halmac_ret_status -+ (*halmac_send_bt_coex)(struct halmac_adapter *adapter, u8 *buf, -+ u32 size, u8 ack); -+ enum halmac_ret_status -+ (*halmac_verify_platform_api)(struct halmac_adapter *adapter); -+ u32 -+ (*halmac_get_fifo_size)(struct halmac_adapter *adapter, -+ enum hal_fifo_sel sel); -+ enum halmac_ret_status -+ (*halmac_dump_fifo)(struct halmac_adapter *adapter, -+ enum hal_fifo_sel sel, u32 start_addr, u32 size, -+ u8 *data); -+ enum halmac_ret_status -+ (*halmac_cfg_txbf)(struct halmac_adapter *adapter, u8 userid, -+ enum halmac_bw bw, u8 txbf_en); -+ enum halmac_ret_status -+ (*halmac_cfg_mumimo)(struct halmac_adapter *adapter, -+ struct halmac_cfg_mumimo_para *param); -+ enum halmac_ret_status -+ (*halmac_cfg_sounding)(struct halmac_adapter *adapter, -+ enum halmac_snd_role role, -+ enum halmac_data_rate rate); -+ enum halmac_ret_status -+ (*halmac_del_sounding)(struct halmac_adapter *adapter, -+ enum halmac_snd_role role); -+ enum halmac_ret_status -+ (*halmac_su_bfer_entry_init)(struct halmac_adapter *adapter, -+ struct halmac_su_bfer_init_para *param); -+ enum halmac_ret_status -+ (*halmac_su_bfee_entry_init)(struct halmac_adapter *adapter, u8 userid, -+ u16 paid); -+ enum halmac_ret_status -+ (*halmac_mu_bfer_entry_init)(struct halmac_adapter *adapter, -+ struct halmac_mu_bfer_init_para *param); -+ enum halmac_ret_status -+ (*halmac_mu_bfee_entry_init)(struct halmac_adapter *adapter, -+ struct halmac_mu_bfee_init_para *param); -+ enum halmac_ret_status -+ (*halmac_su_bfer_entry_del)(struct halmac_adapter *adapter, u8 userid); -+ enum halmac_ret_status -+ (*halmac_su_bfee_entry_del)(struct halmac_adapter *adapter, u8 userid); -+ enum halmac_ret_status -+ (*halmac_mu_bfer_entry_del)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_mu_bfee_entry_del)(struct halmac_adapter *adapter, u8 userid); -+ enum halmac_ret_status -+ (*halmac_add_ch_info)(struct halmac_adapter *adapter, -+ struct halmac_ch_info *info); -+ enum halmac_ret_status -+ (*halmac_add_extra_ch_info)(struct halmac_adapter *adapter, -+ struct halmac_ch_extra_info *info); -+ enum halmac_ret_status -+ (*halmac_ctrl_ch_switch)(struct halmac_adapter *adapter, -+ struct halmac_ch_switch_option *opt); -+ enum halmac_ret_status -+ (*halmac_send_scan_packet)(struct halmac_adapter *adapter, u8 index, -+ u8 *pkt, u32 size); -+ enum halmac_ret_status -+ (*halmac_drop_scan_packet)(struct halmac_adapter *adapter, -+ struct halmac_drop_pkt_option *opt); -+ enum halmac_ret_status -+ (*halmac_p2pps)(struct halmac_adapter *adapter, -+ struct halmac_p2pps *info); -+ enum halmac_ret_status -+ (*halmac_clear_ch_info)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_send_general_info)(struct halmac_adapter *adapter, -+ struct halmac_general_info *info); -+ enum halmac_ret_status -+ (*halmac_start_iqk)(struct halmac_adapter *adapter, -+ struct halmac_iqk_para *param); -+ enum halmac_ret_status -+ (*halmac_start_dpk)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_ctrl_pwr_tracking)(struct halmac_adapter *adapter, -+ struct halmac_pwr_tracking_option *opt); -+ enum halmac_ret_status -+ (*halmac_psd)(struct halmac_adapter *adapter, u16 start_psd, -+ u16 end_psd); -+ enum halmac_ret_status -+ (*halmac_cfg_tx_agg_align)(struct halmac_adapter *adapter, u8 enable, -+ u16 align_size); -+ enum halmac_ret_status -+ (*halmac_query_status)(struct halmac_adapter *adapter, -+ enum halmac_feature_id feature_id, -+ enum halmac_cmd_process_status *proc_status, -+ u8 *data, u32 *size); -+ enum halmac_ret_status -+ (*halmac_reset_feature)(struct halmac_adapter *adapter, -+ enum halmac_feature_id feature_id); -+ enum halmac_ret_status -+ (*halmac_check_fw_status)(struct halmac_adapter *adapter, -+ u8 *fw_status); -+ enum halmac_ret_status -+ (*halmac_dump_fw_dmem)(struct halmac_adapter *adapter, u8 *dmem, -+ u32 *size); -+ enum halmac_ret_status -+ (*halmac_cfg_max_dl_size)(struct halmac_adapter *adapter, u32 size); -+ enum halmac_ret_status -+ (*halmac_cfg_la_mode)(struct halmac_adapter *adapter, -+ enum halmac_la_mode mode); -+ enum halmac_ret_status -+ (*halmac_cfg_rxff_expand_mode)(struct halmac_adapter *adapter, -+ enum halmac_rx_fifo_expanding_mode mode); -+ enum halmac_ret_status -+ (*halmac_config_security)(struct halmac_adapter *adapter, -+ struct halmac_security_setting *setting); -+ u8 -+ (*halmac_get_used_cam_entry_num)(struct halmac_adapter *adapter, -+ enum hal_security_type sec_type); -+ enum halmac_ret_status -+ (*halmac_write_cam)(struct halmac_adapter *adapter, u32 idx, -+ struct halmac_cam_entry_info *info); -+ enum halmac_ret_status -+ (*halmac_read_cam_entry)(struct halmac_adapter *adapter, u32 idx, -+ struct halmac_cam_entry_format *content); -+ enum halmac_ret_status -+ (*halmac_clear_cam_entry)(struct halmac_adapter *adapter, u32 idx); -+ enum halmac_ret_status -+ (*halmac_get_hw_value)(struct halmac_adapter *adapter, -+ enum halmac_hw_id hw_id, void *value); -+ enum halmac_ret_status -+ (*halmac_set_hw_value)(struct halmac_adapter *adapter, -+ enum halmac_hw_id hw_id, void *value); -+ enum halmac_ret_status -+ (*halmac_cfg_drv_rsvd_pg_num)(struct halmac_adapter *adapter, -+ enum halmac_drv_rsvd_pg_num pg_num); -+ enum halmac_ret_status -+ (*halmac_get_chip_version)(struct halmac_adapter *adapter, -+ struct halmac_ver *ver); -+ enum halmac_ret_status -+ (*halmac_chk_txdesc)(struct halmac_adapter *adapter, u8 *buf, u32 size); -+ enum halmac_ret_status -+ (*halmac_dl_drv_rsvd_page)(struct halmac_adapter *adapter, u8 pg_offset, -+ u8 *buf, u32 size); -+ enum halmac_ret_status -+ (*halmac_pcie_switch)(struct halmac_adapter *adapter, -+ enum halmac_pcie_cfg cfg); -+ enum halmac_ret_status -+ (*halmac_phy_cfg)(struct halmac_adapter *adapter, -+ enum halmac_intf_phy_platform pltfm); -+ enum halmac_ret_status -+ (*halmac_cfg_csi_rate)(struct halmac_adapter *adapter, u8 rssi, -+ u8 cur_rate, u8 fixrate_en, u8 *new_rate, -+ u8 *bmp_ofdm54); -+#if HALMAC_SDIO_SUPPORT -+ enum halmac_ret_status -+ (*halmac_sdio_cmd53_4byte)(struct halmac_adapter *adapter, -+ enum halmac_sdio_cmd53_4byte_mode mode); -+ enum halmac_ret_status -+ (*halmac_sdio_hw_info)(struct halmac_adapter *adapter, -+ struct halmac_sdio_hw_info *info); -+#endif -+ enum halmac_ret_status -+ (*halmac_cfg_transmitter_addr)(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr); -+ enum halmac_ret_status -+ (*halmac_cfg_net_type)(struct halmac_adapter *adapter, u8 port, -+ enum halmac_network_type_select net_type); -+ enum halmac_ret_status -+ (*halmac_cfg_tsf_rst)(struct halmac_adapter *adapter, u8 port); -+ enum halmac_ret_status -+ (*halmac_cfg_bcn_space)(struct halmac_adapter *adapter, u8 port, -+ u32 bcn_space); -+ enum halmac_ret_status -+ (*halmac_rw_bcn_ctrl)(struct halmac_adapter *adapter, u8 port, -+ u8 write_en, struct halmac_bcn_ctrl *ctrl); -+ enum halmac_ret_status -+ (*halmac_interface_integration_tuning)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_txfifo_is_empty)(struct halmac_adapter *adapter, u32 chk_num); -+ enum halmac_ret_status -+ (*halmac_download_flash)(struct halmac_adapter *adapter, u8 *fw_bin, -+ u32 size, u32 rom_addr); -+ enum halmac_ret_status -+ (*halmac_read_flash)(struct halmac_adapter *adapter, u32 addr, -+ u32 length, u8 *data); -+ enum halmac_ret_status -+ (*halmac_erase_flash)(struct halmac_adapter *adapter, u8 erase_cmd, -+ u32 addr); -+ enum halmac_ret_status -+ (*halmac_check_flash)(struct halmac_adapter *adapter, u8 *fw_bin, -+ u32 size, u32 addr); -+ enum halmac_ret_status -+ (*halmac_cfg_edca_para)(struct halmac_adapter *adapter, -+ enum halmac_acq_id acq_id, -+ struct halmac_edca_para *param); -+ enum halmac_ret_status -+ (*halmac_pinmux_get_func)(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func, u8 *enable); -+ enum halmac_ret_status -+ (*halmac_pinmux_set_func)(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func); -+ enum halmac_ret_status -+ (*halmac_pinmux_free_func)(struct halmac_adapter *adapter, -+ enum halmac_gpio_func gpio_func); -+ enum halmac_ret_status -+ (*halmac_pinmux_wl_led_mode)(struct halmac_adapter *adapter, -+ enum halmac_wlled_mode mode); -+ void -+ (*halmac_pinmux_wl_led_sw_ctrl)(struct halmac_adapter *adapter, u8 on); -+ void -+ (*halmac_pinmux_sdio_int_polarity)(struct halmac_adapter *adapter, -+ u8 low_active); -+ enum halmac_ret_status -+ (*halmac_pinmux_gpio_mode)(struct halmac_adapter *adapter, u8 gpio_id, -+ u8 output); -+ enum halmac_ret_status -+ (*halmac_pinmux_gpio_output)(struct halmac_adapter *adapter, u8 gpio_id, -+ u8 high); -+ enum halmac_ret_status -+ (*halmac_pinmux_pin_status)(struct halmac_adapter *adapter, u8 pin_id, -+ u8 *high); -+ enum halmac_ret_status -+ (*halmac_ofld_func_cfg)(struct halmac_adapter *adapter, -+ struct halmac_ofld_func_info *info); -+ enum halmac_ret_status -+ (*halmac_rx_cut_amsdu_cfg)(struct halmac_adapter *adapter, -+ struct halmac_cut_amsdu_cfg *cfg); -+ enum halmac_ret_status -+ (*halmac_fw_snding)(struct halmac_adapter *adapter, -+ struct halmac_su_snding_info *su_info, -+ struct halmac_mu_snding_info *mu_info, u8 period); -+ enum halmac_ret_status -+ (*halmac_get_mac_addr)(struct halmac_adapter *adapter, u8 port, -+ union halmac_wlan_addr *addr); -+ enum halmac_ret_status -+ (*halmac_init_low_pwr)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_enter_cpu_sleep_mode)(struct halmac_adapter *adapter); -+ enum halmac_ret_status -+ (*halmac_get_cpu_mode)(struct halmac_adapter *adapter, -+ enum halmac_wlcpu_mode *mode); -+ enum halmac_ret_status -+ (*halmac_drv_fwctrl)(struct halmac_adapter *adapter, u8 *payload, -+ u32 size, u8 ack); -+ enum halmac_ret_status -+ (*halmac_read_efuse)(struct halmac_adapter *adapter, u32 offset, -+ u8 *value); -+ enum halmac_ret_status -+ (*halmac_write_efuse)(struct halmac_adapter *adapter, u32 offset, -+ u8 value); -+ enum halmac_ret_status -+ (*halmac_write_wifi_phy_efuse)(struct halmac_adapter *adapter, -+ u32 offset, u8 value); -+ enum halmac_ret_status -+ (*halmac_read_wifi_phy_efuse)(struct halmac_adapter *adapter, -+ u32 offset, u32 size, u8 *value); -+#if HALMAC_PCIE_SUPPORT -+ enum halmac_ret_status -+ (*halmac_cfgspc_set_pcie)(struct halmac_adapter *adapter, -+ struct halmac_pcie_cfgspc_param *param); -+#endif -+ enum halmac_ret_status -+ (*halmac_en_ref_autok_pcie)(struct halmac_adapter *adapter, u8 en); -+ enum halmac_ret_status -+ (*halmac_get_watcher)(struct halmac_adapter *adapter, -+ enum halmac_watcher_sel sel, void *vlue); -+ enum halmac_ret_status -+ (*halmac_cfg_rf_pinmux)(struct halmac_adapter *adapter, -+ u8 value); -+#if HALMAC_DBG_MONITOR_IO -+ u8 -+ (*halmac_mon_reg_read_8)(struct halmac_adapter *adapter, u32 offset, -+ const char *func, const u32 line); -+ u16 -+ (*halmac_mon_reg_read_16)(struct halmac_adapter *adapter, u32 offset, -+ const char *func, const u32 line); -+ u32 -+ (*halmac_mon_reg_read_32)(struct halmac_adapter *adapter, u32 offset, -+ const char *func, const u32 line); -+ enum halmac_ret_status -+ (*halmac_mon_reg_sdio_cmd53_read_n)(struct halmac_adapter *adapter, -+ u32 offset, u32 size, u8 *value, -+ const char *func, const u32 line); -+ enum halmac_ret_status -+ (*halmac_mon_reg_write_8)(struct halmac_adapter *adapter, u32 offset, -+ u8 value, const char *func, const u32 line); -+ enum halmac_ret_status -+ (*halmac_mon_reg_write_16)(struct halmac_adapter *adapter, u32 offset, -+ u16 value, const char *func, const u32 line); -+ enum halmac_ret_status -+ (*halmac_mon_reg_write_32)(struct halmac_adapter *adapter, u32 offset, -+ u32 value, const char *func, const u32 line); -+#endif -+#if HALMAC_PLATFORM_TESTPROGRAM -+ struct halmisc_api *halmisc_api; -+#endif -+}; -+ -+#define HALMAC_GET_API(halmac_adapter) \ -+ ((struct halmac_api *)halmac_adapter->halmac_api) -+ -+static HALMAC_INLINE enum halmac_ret_status -+halmac_fw_validate(struct halmac_adapter *adapter) -+{ -+ if (adapter->halmac_state.dlfw_state != HALMAC_DLFW_DONE && -+ adapter->halmac_state.dlfw_state != HALMAC_GEN_INFO_SENT) -+ return HALMAC_RET_NO_DLFW; -+ -+ return HALMAC_RET_SUCCESS; -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_usb_reg.h b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_usb_reg.h -new file mode 100644 -index 000000000..dd7a0162c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/halmac/halmac_usb_reg.h -@@ -0,0 +1,21 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2019 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALMAC_USB_REG_H__ -+#define __HALMAC_USB_REG_H__ -+ -+#define USB_REG_PAGE 0xF4 -+ -+#endif/* __HALMAC_USB_REG_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/led/hal_led.c b/drivers/net/wireless/rtl8821cs/hal/led/hal_led.c -new file mode 100644 -index 000000000..2a753f9c6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/led/hal_led.c -@@ -0,0 +1,254 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#ifdef CONFIG_RTW_LED -+void dump_led_config(void *sel, _adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct led_priv *ledpriv = adapter_to_led(adapter); -+ int i; -+ -+ RTW_PRINT_SEL(sel, "strategy:%u\n", ledpriv->LedStrategy); -+#ifdef CONFIG_RTW_SW_LED -+ RTW_PRINT_SEL(sel, "bRegUseLed:%u\n", ledpriv->bRegUseLed); -+ RTW_PRINT_SEL(sel, "iface_en_mask:0x%02X\n", ledpriv->iface_en_mask); -+ for (i = 0; i < dvobj->iface_nums; i++) -+ RTW_PRINT_SEL(sel, "ctl_en_mask[%d]:0x%08X\n", i, ledpriv->ctl_en_mask[i]); -+#endif -+} -+ -+void rtw_led_set_strategy(_adapter *adapter, u8 strategy) -+{ -+ struct led_priv *ledpriv = adapter_to_led(adapter); -+ _adapter *pri_adapter = GET_PRIMARY_ADAPTER(adapter); -+ -+#ifndef CONFIG_RTW_SW_LED -+ if (IS_SW_LED_STRATEGY(strategy)) { -+ RTW_WARN("CONFIG_RTW_SW_LED is not defined\n"); -+ return; -+ } -+#endif -+ -+#ifdef CONFIG_RTW_SW_LED -+ if (!ledpriv->bRegUseLed) -+ return; -+#endif -+ -+ if (ledpriv->LedStrategy == strategy) -+ return; -+ -+ if (IS_HW_LED_STRATEGY(strategy) || IS_HW_LED_STRATEGY(ledpriv->LedStrategy)) { -+ RTW_WARN("switching on/off HW_LED strategy is not supported\n"); -+ return; -+ } -+ -+ ledpriv->LedStrategy = strategy; -+ -+#ifdef CONFIG_RTW_SW_LED -+ rtw_hal_sw_led_deinit(pri_adapter); -+#endif -+ -+ rtw_led_control(pri_adapter, LED_CTL_POWER_OFF); -+} -+ -+#ifdef CONFIG_RTW_SW_LED -+#if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY -+void rtw_sw_led_blink_uc_trx_only(LED_DATA *led) -+{ -+ _adapter *adapter = led->padapter; -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ if (led->BlinkingLedState == RTW_LED_ON) -+ SwLedOn(adapter, led); -+ else -+ SwLedOff(adapter, led); -+ -+ switch (led->CurrLedState) { -+ case RTW_LED_ON: -+ SwLedOn(adapter, led); -+ break; -+ -+ case RTW_LED_OFF: -+ SwLedOff(adapter, led); -+ break; -+ -+ case LED_BLINK_TXRX: -+ led->BlinkTimes--; -+ if (led->BlinkTimes == 0) -+ bStopBlinking = _TRUE; -+ -+ if (adapter_to_pwrctl(adapter)->rf_pwrstate != rf_on -+ && adapter_to_pwrctl(adapter)->rfoff_reason > RF_CHANGE_BY_PS -+ ) { -+ SwLedOff(adapter, led); -+ led->bLedBlinkInProgress = _FALSE; -+ } else { -+ if (led->bLedOn) -+ led->BlinkingLedState = RTW_LED_OFF; -+ else -+ led->BlinkingLedState = RTW_LED_ON; -+ -+ if (bStopBlinking) { -+ led->CurrLedState = RTW_LED_OFF; -+ led->bLedBlinkInProgress = _FALSE; -+ } -+ _set_timer(&(led->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+void rtw_sw_led_ctl_mode_uc_trx_only(_adapter *adapter, LED_CTL_MODE ctl) -+{ -+ struct led_priv *ledpriv = adapter_to_led(adapter); -+ LED_DATA *led = &(ledpriv->SwLed0); -+ LED_DATA *led1 = &(ledpriv->SwLed1); -+ LED_DATA *led2 = &(ledpriv->SwLed2); -+ -+ switch (ctl) { -+ case LED_CTL_UC_TX: -+ case LED_CTL_UC_RX: -+ if (led->bLedBlinkInProgress == _FALSE) { -+ led->bLedBlinkInProgress = _TRUE; -+ led->CurrLedState = LED_BLINK_TXRX; -+ led->BlinkTimes = 2; -+ if (led->bLedOn) -+ led->BlinkingLedState = RTW_LED_OFF; -+ else -+ led->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(led->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ led->CurrLedState = RTW_LED_OFF; -+ led->BlinkingLedState = RTW_LED_OFF; -+ -+ if (led->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(led->BlinkTimer)); -+ led->bLedBlinkInProgress = _FALSE; -+ } -+ -+ SwLedOff(adapter, led); -+ SwLedOff(adapter, led1); -+ SwLedOff(adapter, led2); -+ break; -+ -+ default: -+ break; -+ } -+} -+#endif /* CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY */ -+ -+void rtw_led_control(_adapter *adapter, LED_CTL_MODE ctl) -+{ -+ struct led_priv *ledpriv = adapter_to_led(adapter); -+ -+ if (ledpriv->LedControlHandler) { -+ #if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY -+ if (ledpriv->LedStrategy != SW_LED_MODE_UC_TRX_ONLY) { -+ if (ctl == LED_CTL_UC_TX || ctl == LED_CTL_BMC_TX) { -+ if (ledpriv->ctl_en_mask[adapter->iface_id] & BIT(LED_CTL_TX)) -+ ctl = LED_CTL_TX; /* transform specific TX ctl to general TX ctl */ -+ } else if (ctl == LED_CTL_UC_RX || ctl == LED_CTL_BMC_RX) { -+ if (ledpriv->ctl_en_mask[adapter->iface_id] & BIT(LED_CTL_RX)) -+ ctl = LED_CTL_RX; /* transform specific RX ctl to general RX ctl */ -+ } -+ } -+ #endif -+ -+ if ((ledpriv->iface_en_mask & BIT(adapter->iface_id)) -+ && (ledpriv->ctl_en_mask[adapter->iface_id] & BIT(ctl))) -+ ledpriv->LedControlHandler(adapter, ctl); -+ } -+} -+ -+void rtw_led_tx_control(_adapter *adapter, const u8 *da) -+{ -+#if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY -+ if (IS_MCAST(da)) -+ rtw_led_control(adapter, LED_CTL_BMC_TX); -+ else -+ rtw_led_control(adapter, LED_CTL_UC_TX); -+#else -+ rtw_led_control(adapter, LED_CTL_TX); -+#endif -+} -+ -+void rtw_led_rx_control(_adapter *adapter, const u8 *da) -+{ -+#if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY -+ if (IS_MCAST(da)) -+ rtw_led_control(adapter, LED_CTL_BMC_RX); -+ else -+ rtw_led_control(adapter, LED_CTL_UC_RX); -+#else -+ rtw_led_control(adapter, LED_CTL_RX); -+#endif -+} -+ -+void rtw_led_set_iface_en(_adapter *adapter, u8 en) -+{ -+ struct led_priv *ledpriv = adapter_to_led(adapter); -+ -+ if (en) -+ ledpriv->iface_en_mask |= BIT(adapter->iface_id); -+ else -+ ledpriv->iface_en_mask &= ~BIT(adapter->iface_id); -+} -+ -+void rtw_led_set_iface_en_mask(_adapter *adapter, u8 mask) -+{ -+ struct led_priv *ledpriv = adapter_to_led(adapter); -+ -+ ledpriv->iface_en_mask = mask; -+} -+ -+void rtw_led_set_ctl_en_mask(_adapter *adapter, u32 ctl_mask) -+{ -+ struct led_priv *ledpriv = adapter_to_led(adapter); -+ -+#if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY -+ if (ctl_mask & BIT(LED_CTL_TX)) -+ ctl_mask |= BIT(LED_CTL_UC_TX) | BIT(LED_CTL_BMC_TX); -+ if (ctl_mask & BIT(LED_CTL_RX)) -+ ctl_mask |= BIT(LED_CTL_UC_RX) | BIT(LED_CTL_BMC_RX); -+#endif -+ -+ ledpriv->ctl_en_mask[adapter->iface_id] = ctl_mask; -+} -+ -+void rtw_led_set_ctl_en_mask_primary(_adapter *adapter) -+{ -+ rtw_led_set_ctl_en_mask(adapter, 0xFFFFFFFF); -+} -+ -+void rtw_led_set_ctl_en_mask_virtual(_adapter *adapter) -+{ -+ rtw_led_set_ctl_en_mask(adapter -+ , BIT(LED_CTL_POWER_ON) | BIT(LED_CTL_POWER_OFF) -+ | BIT(LED_CTL_TX) | BIT(LED_CTL_RX) -+ ); -+} -+#endif /* CONFIG_RTW_SW_LED */ -+ -+#endif /* CONFIG_RTW_LED */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/led/hal_sdio_led.c b/drivers/net/wireless/rtl8821cs/hal/led/hal_sdio_led.c -new file mode 100644 -index 000000000..506d17d7b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/led/hal_sdio_led.c -@@ -0,0 +1,2014 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#ifdef CONFIG_RTW_SW_LED -+ -+/* -+ * Description: -+ * Implementation of LED blinking behavior. -+ * It toggle off LED and schedule corresponding timer if necessary. -+ * */ -+void -+SwLedBlink( -+ PLED_SDIO 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); -+ } else { -+ SwLedOff(padapter, pLed); -+ } -+ -+ /* 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, WIFI_ASOC_STATE) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ bStopBlinking = _TRUE; -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) && -+ (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, WIFI_ASOC_STATE) == _TRUE) && (pLed->bLedOn == _FALSE)) -+ SwLedOn(padapter, pLed); -+ else if ((check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _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: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); -+ break; -+ -+ default: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ break; -+ } -+ } -+} -+ -+void -+SwLedBlink1( -+ PLED_SDIO pLed -+) -+{ -+ _adapter *padapter = pLed->padapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ PLED_SDIO pLed1 = &(ledpriv->SwLed1); -+ u8 bStopBlinking = _FALSE; -+ -+ 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); -+ } else { -+ SwLedOff(padapter, pLed); -+ } -+ -+ -+ if (pHalData->CustomerID == RT_CID_DEFAULT) { -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ if (!pLed1->bSWLedCtrl) { -+ SwLedOn(padapter, pLed1); -+ pLed1->bSWLedCtrl = _TRUE; -+ } else if (!pLed1->bLedOn) -+ SwLedOn(padapter, pLed1); -+ } else { -+ if (!pLed1->bSWLedCtrl) { -+ SwLedOff(padapter, pLed1); -+ pLed1->bSWLedCtrl = _TRUE; -+ } else if (pLed1->bLedOn) -+ 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_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, WIFI_ASOC_STATE) == _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); -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _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); -+ } -+ 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, WIFI_ASOC_STATE) == _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); -+ } else if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _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); -+ } -+ 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); -+ } -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+void -+SwLedBlink2( -+ PLED_SDIO 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); -+ } else { -+ SwLedOff(padapter, pLed); -+ } -+ -+ 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, WIFI_ASOC_STATE) == _TRUE) { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(padapter, pLed); -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _FALSE) { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ SwLedOff(padapter, pLed); -+ } -+ 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, WIFI_ASOC_STATE) == _TRUE) { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(padapter, pLed); -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _FALSE) { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ SwLedOff(padapter, pLed); -+ } -+ 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_SDIO 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); -+ } else { -+ if (pLed->CurrLedState != LED_BLINK_WPS_STOP) -+ SwLedOff(padapter, pLed); -+ } -+ -+ 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, WIFI_ASOC_STATE) == _TRUE) { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if (!pLed->bLedOn) -+ SwLedOn(padapter, pLed); -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _FALSE) { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if (pLed->bLedOn) -+ SwLedOff(padapter, pLed); -+ -+ } -+ 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, WIFI_ASOC_STATE) == _TRUE) { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ if (!pLed->bLedOn) -+ SwLedOn(padapter, pLed); -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _FALSE) { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if (pLed->bLedOn) -+ SwLedOff(padapter, pLed); -+ -+ -+ } -+ 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); -+ } -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ } -+ break; -+ -+ -+ default: -+ break; -+ } -+ -+} -+ -+ -+void -+SwLedBlink4( -+ PLED_SDIO pLed -+) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ PLED_SDIO pLed1 = &(ledpriv->SwLed1); -+ u8 bStopBlinking = _FALSE; -+ -+ /* Change LED according to BlinkingLedState specified. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) { -+ SwLedOn(padapter, pLed); -+ } else { -+ SwLedOff(padapter, pLed); -+ } -+ -+ 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; -+ -+ default: -+ break; -+ } -+ -+ -+ -+} -+ -+void -+SwLedBlink5( -+ PLED_SDIO 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); -+ } else { -+ SwLedOff(padapter, pLed); -+ } -+ -+ 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; -+ } -+ -+ -+ -+} -+ -+void -+SwLedBlink6( -+ PLED_SDIO 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); -+ } else { -+ SwLedOff(padapter, pLed); -+ } -+ -+} -+ -+/* -+ * Description: -+ * Handler function of LED Blinking. -+ * We dispatch acture LED blink action according to LedStrategy. -+ * */ -+void BlinkHandler(PLED_SDIO pLed) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ -+ /* RTW_INFO("%s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); */ -+ 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; -+ } -+ -+ switch (ledpriv->LedStrategy) { -+ #if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY -+ case SW_LED_MODE_UC_TRX_ONLY: -+ rtw_sw_led_blink_uc_trx_only(pLed); -+ break; -+ #endif -+ -+ 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; -+ -+ default: -+ /* SwLedBlink(pLed); */ -+ break; -+ } -+} -+ -+/* -+ * Description: -+ * Callback function of LED BlinkTimer, -+ * it just schedules to corresponding BlinkWorkItem/led_blink_hdl -+ * */ -+void BlinkTimerCallback(void *data) -+{ -+ PLED_SDIO pLed = (PLED_SDIO)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_RTW_LED_HANDLED_BY_CMD_THREAD -+ rtw_led_blink_cmd(padapter, 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_SDIO pLed = container_of(work, LED_SDIO, BlinkWorkItem); -+ BlinkHandler(pLed); -+} -+ -+static void -+SwLedControlMode0( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ PLED_SDIO 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; -+ } -+ -+ -+} -+ -+/* ALPHA, added by chiyoko, 20090106 */ -+static void -+SwLedControlMode1( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ PLED_SDIO pLed = &(ledpriv->SwLed0); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ 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), LED_BLINK_NO_LINK_INTERVAL_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, WIFI_ASOC_STATE) == _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; -+ _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), LED_BLINK_NO_LINK_INTERVAL_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; -+ -+ } -+ -+} -+ -+/* Arcadyan/Sitecom , added by chiyoko, 20090216 */ -+static void -+SwLedControlMode2( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_SDIO 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, WIFI_ASOC_STATE) == _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); -+ } -+ 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); -+ 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; -+ -+ } -+ -+} -+ -+/* COREGA, added by chiyoko, 20090316 */ -+static void -+SwLedControlMode3( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_SDIO 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, WIFI_ASOC_STATE) == _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; -+ -+ } -+ -+} -+ -+ -+/* Edimax-Belkin, added by chiyoko, 20090413 */ -+static void -+SwLedControlMode4( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_SDIO pLed = &(ledpriv->SwLed0); -+ PLED_SDIO 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, WIFI_ASOC_STATE) == _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; -+ -+ default: -+ break; -+ -+ } -+ -+} -+ -+ -+ -+/* Sercomm-Belkin, added by chiyoko, 20090415 */ -+static void -+SwLedControlMode5( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PLED_SDIO 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, WIFI_ASOC_STATE) == _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; -+ -+ } -+ -+} -+ -+/* WNC-Corega, added by chiyoko, 20090902 */ -+static void -+SwLedControlMode6( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_SDIO 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; -+ } -+ -+} -+ -+void -+LedControlSDIO( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = adapter_to_led(padapter); -+ -+#if (MP_DRIVER == 1) -+ if (padapter->registrypriv.mp_mode == 1) -+ return; -+#endif -+ -+ 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; -+ } -+ -+ if (ledpriv->bRegUseLed == _FALSE) -+ return; -+ -+ /* if(priv->bInHctTest) */ -+ /* return; */ -+ -+ 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) { -+ #if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY -+ case SW_LED_MODE_UC_TRX_ONLY: -+ rtw_sw_led_ctl_mode_uc_trx_only(padapter, LedAction); -+ break; -+ #endif -+ -+ 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; -+ -+ default: -+ break; -+ } -+ -+} -+ -+/* -+ * Description: -+ * Reset status of LED_871x object. -+ * */ -+void ResetLedStatus(PLED_SDIO 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->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_SDIO pLed, -+ LED_PIN LedPin -+) -+{ -+ pLed->padapter = padapter; -+ pLed->LedPin = LedPin; -+ -+ ResetLedStatus(pLed); -+ -+ rtw_init_timer(&(pLed->BlinkTimer), padapter, BlinkTimerCallback, pLed); -+ -+ _init_workitem(&(pLed->BlinkWorkItem), BlinkWorkItemCallback, pLed); -+} -+ -+ -+/* -+ * Description: -+ * DeInitialize an LED_871x object. -+ * */ -+void -+DeInitLed( -+ PLED_SDIO pLed -+) -+{ -+ _cancel_workitem_sync(&(pLed->BlinkWorkItem)); -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ ResetLedStatus(pLed); -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/ap_makefile.mk b/drivers/net/wireless/rtl8821cs/hal/phydm/ap_makefile.mk -new file mode 100644 -index 000000000..980bc8510 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/ap_makefile.mk -@@ -0,0 +1,248 @@ -+ -+_PHYDM_FILES :=\ -+ phydm/phydm.o \ -+ phydm/phydm_dig.o\ -+ phydm/phydm_antdiv.o\ -+ phydm/phydm_soml.o\ -+ phydm/phydm_smt_ant.o\ -+ phydm/phydm_pathdiv.o\ -+ phydm/phydm_rainfo.o\ -+ phydm/phydm_dynamictxpower.o\ -+ phydm/phydm_adaptivity.o\ -+ phydm/phydm_debug.o\ -+ phydm/phydm_interface.o\ -+ phydm/phydm_phystatus.o\ -+ phydm/phydm_hwconfig.o\ -+ phydm/phydm_dfs.o\ -+ phydm/phydm_cfotracking.o\ -+ phydm/phydm_adc_sampling.o\ -+ phydm/phydm_ccx.o\ -+ phydm/phydm_primary_cca.o\ -+ phydm/phydm_cck_pd.o\ -+ phydm/phydm_rssi_monitor.o\ -+ phydm/phydm_auto_dbg.o\ -+ phydm/phydm_math_lib.o\ -+ phydm/phydm_noisemonitor.o\ -+ phydm/phydm_api.o\ -+ phydm/phydm_pow_train.o\ -+ phydm/phydm_lna_sat.o\ -+ phydm/phydm_pmac_tx_setting.o\ -+ phydm/phydm_mp.o\ -+ phydm/phydm_cck_rx_pathdiv.o\ -+ phydm/phydm_direct_bf.o\ -+ phydm/txbf/phydm_hal_txbf_api.o\ -+ EdcaTurboCheck.o\ -+ phydm/halrf/halrf.o\ -+ phydm/halrf/halrf_debug.o\ -+ phydm/halrf/halphyrf_ap.o\ -+ phydm/halrf/halrf_powertracking_ap.o\ -+ phydm/halrf/halrf_powertracking.o\ -+ phydm/halrf/halrf_kfree.o\ -+ phydm/halrf/halrf_psd.o -+ -+ifeq ($(CONFIG_RTL_88E_SUPPORT),y) -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8188e/halhwimg8188e_bb.o\ -+ phydm/rtl8188e/halhwimg8188e_mac.o\ -+ phydm/rtl8188e/halhwimg8188e_rf.o\ -+ phydm/rtl8188e/phydm_regconfig8188e.o\ -+ phydm/rtl8188e/hal8188erateadaptive.o\ -+ phydm/rtl8188e/phydm_rtl8188e.o\ -+ phydm/halrf/rtl8188e/halrf_8188e_ap.o -+ endif -+endif -+ -+ifeq ($(CONFIG_RTL_8812_SUPPORT),y) -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += ./phydm/halrf/rtl8812a/halrf_8812a_ap.o -+ endif -+ _PHYDM_FILES += phydm/rtl8812a/phydm_rtl8812a.o -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8881A),y) -+ _PHYDM_FILES += phydm/halrf/rtl8821a/halrf_iqk_8821a_ap.o -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8192EE),y) -+ _PHYDM_FILES += \ -+ phydm/halrf/rtl8192e/halrf_8192e_ap.o\ -+ phydm/rtl8192e/phydm_rtl8192e.o -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8814AE),y) -+ rtl8192cd-objs += phydm/halrf/rtl8814a/halrf_8814a_ap.o -+ rtl8192cd-objs += phydm/halrf/rtl8814a/halrf_iqk_8814a.o -+ rtl8192cd-objs += phydm/halrf/rtl8814a/halhwimg8814a_rf.o -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ rtl8192cd-objs += \ -+ phydm/rtl8814a/halhwimg8814a_bb.o\ -+ phydm/rtl8814a/halhwimg8814a_mac.o\ -+ phydm/rtl8814a/phydm_regconfig8814a.o\ -+ phydm/rtl8814a/phydm_rtl8814a.o -+ endif -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8822BE),y) -+ _PHYDM_FILES += phydm/halrf/rtl8822b/halrf_8822b.o -+ _PHYDM_FILES += phydm/halrf/rtl8822b/halrf_iqk_8822b.o -+ _PHYDM_FILES += phydm/halrf/rtl8822b/halhwimg8822b_rf.o -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8822b/halhwimg8822b_bb.o\ -+ phydm/rtl8822b/halhwimg8822b_mac.o\ -+ phydm/rtl8822b/phydm_regconfig8822b.o\ -+ phydm/rtl8822b/phydm_hal_api8822b.o\ -+ phydm/rtl8822b/phydm_rtl8822b.o -+ endif -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8822CE),y) -+ _PHYDM_FILES += phydm/halrf/rtl8822c/halrf_8822c.o -+ _PHYDM_FILES += phydm/halrf/rtl8822c/halrf_iqk_8822c.o -+ _PHYDM_FILES += phydm/halrf/rtl8822c/halrf_dpk_8822c.o -+ _PHYDM_FILES += phydm/halrf/rtl8822c/halrf_rfk_init_8822c.o -+ _PHYDM_FILES += phydm/halrf/rtl8822c/halhwimg8822c_rf.o -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8822c/halhwimg8822c_bb.o\ -+ phydm/rtl8822c/phydm_regconfig8822c.o\ -+ phydm/rtl8822c/phydm_hal_api8822c.o -+ endif -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8812FE),y) -+ _PHYDM_FILES += phydm/halrf/rtl8812f/halrf_8812f.o -+ _PHYDM_FILES += phydm/halrf/rtl8812f/halrf_iqk_8812f.o -+ _PHYDM_FILES += phydm/halrf/rtl8812f/halrf_dpk_8812f.o -+ _PHYDM_FILES += phydm/halrf/rtl8812f/halrf_tssi_8812f.o -+ _PHYDM_FILES += phydm/halrf/rtl8812f/halrf_rfk_init_8812f.o -+ _PHYDM_FILES += phydm/halrf/rtl8812f/halhwimg8812f_rf.o -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8812f/halhwimg8812f_bb.o\ -+ phydm/rtl8812f/phydm_regconfig8812f.o\ -+ phydm/rtl8812f/phydm_hal_api8812f.o\ -+ phydm/rtl8812f/phydm_rtl8812f.o -+ endif -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8821CE),y) -+ _PHYDM_FILES += phydm/halrf/rtl8821c/halrf_8821c.o -+ _PHYDM_FILES += phydm/halrf/rtl8821c/halrf_iqk_8821c.o -+ _PHYDM_FILES += phydm/halrf/rtl8821c/halhwimg8821c_rf.o -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8821c/halhwimg8821c_bb.o\ -+ phydm/rtl8821c/halhwimg8821c_mac.o\ -+ phydm/rtl8821c/phydm_regconfig8821c.o\ -+ phydm/rtl8821c/phydm_hal_api8821c.o\ -+ phydm/rtl8821c/phydm_rtl8821c.o -+ endif -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8197F),y) -+ _PHYDM_FILES += phydm/halrf/rtl8197f/halrf_8197f.o -+ _PHYDM_FILES += phydm/halrf/rtl8197f/halrf_iqk_8197f.o -+ _PHYDM_FILES += phydm/halrf/rtl8197f/halrf_dpk_8197f.o -+ _PHYDM_FILES += phydm/halrf/rtl8197f/halhwimg8197f_rf.o -+ _PHYDM_FILES += efuse_97f/efuse.o -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8197f/halhwimg8197f_bb.o\ -+ phydm/rtl8197f/halhwimg8197f_mac.o\ -+ phydm/rtl8197f/phydm_hal_api8197f.o\ -+ phydm/rtl8197f/phydm_regconfig8197f.o\ -+ phydm/rtl8197f/phydm_rtl8197f.o -+ endif -+endif -+ -+ -+ifeq ($(CONFIG_WLAN_HAL_8192FE),y) -+ _PHYDM_FILES += phydm/halrf/rtl8192f/halrf_8192f.o -+ _PHYDM_FILES += phydm/halrf/rtl8192f/halrf_dpk_8192f.o -+ _PHYDM_FILES += phydm/halrf/rtl8192f/halhwimg8192f_rf.o -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8192f/halhwimg8192f_bb.o\ -+ phydm/rtl8192f/halhwimg8192f_mac.o\ -+ phydm/rtl8192f/phydm_hal_api8192f.o\ -+ phydm/rtl8192f/phydm_regconfig8192f.o\ -+ phydm/rtl8192f/phydm_rtl8192f.o -+ endif -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8198F),y) -+ _PHYDM_FILES += phydm/halrf/rtl8198f/halrf_8198f.o -+ _PHYDM_FILES += phydm/halrf/rtl8198f/halrf_iqk_8198f.o -+ _PHYDM_FILES += phydm/halrf/rtl8198f/halrf_dpk_8198f.o -+ _PHYDM_FILES += phydm/halrf/rtl8198f/halrf_rfk_init_8198f.o -+ _PHYDM_FILES += phydm/halrf/rtl8198f/halhwimg8198f_rf.o -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8198f/phydm_hal_api8198f.o\ -+ phydm/rtl8198f/halhwimg8198f_bb.o\ -+ phydm/rtl8198f/halhwimg8198f_mac.o\ -+ phydm/rtl8198f/phydm_regconfig8198f.o \ -+ phydm/halrf/rtl8198f/halrf_8198f.o -+ endif -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8814BE),y) -+ _PHYDM_FILES += phydm/halrf/rtl8814b/halrf_8814b.o -+ _PHYDM_FILES += phydm/halrf/rtl8814b/halrf_iqk_8814b.o -+ _PHYDM_FILES += phydm/halrf/rtl8814b/halrf_dpk_8814b.o -+ _PHYDM_FILES += phydm/halrf/rtl8814b/halrf_txgapk_8814b.o -+ _PHYDM_FILES += phydm/halrf/rtl8814b/halrf_rfk_init_8814b.o -+ _PHYDM_FILES += phydm/halrf/rtl8814b/halhwimg8814b_rf.o -+ ifeq ($(CONFIG_WLAN_HAL_8814CR),y) -+ _PHYDM_FILES += phydm/halrf/rtl8814c/halrf_8814c.o -+ _PHYDM_FILES += phydm/halrf/rtl8814c/halrf_iqk_8814c.o -+ _PHYDM_FILES += phydm/halrf/rtl8814c/halrf_dpk_8814c.o -+ _PHYDM_FILES += phydm/halrf/rtl8814c/halrf_txgapk_8814c.o -+ _PHYDM_FILES += phydm/halrf/rtl8814c/halrf_rfk_init_8814c.o -+ _PHYDM_FILES += phydm/halrf/rtl8814c/halhwimg8814c_rf.o -+ endif -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8814b/phydm_hal_api8814b.o\ -+ phydm/rtl8814b/halhwimg8814b_bb.o\ -+ phydm/rtl8814c/halhwimg8814c_bb.o\ -+ phydm/rtl8814b/phydm_regconfig8814b.o \ -+ phydm/rtl8814b/phydm_extraagc8814b.o \ -+ phydm/rtl8814c/phydm_extraagc8814c.o \ -+ phydm/halrf/rtl8814b/halrf_8814b.o \ -+ phydm/halrf/rtl8814c/halrf_8814c.o -+ endif -+endif -+ -+ifeq ($(CONFIG_WLAN_HAL_8197G),y) -+ _PHYDM_FILES += phydm/halrf/rtl8197g/halrf_8197g.o -+ _PHYDM_FILES += phydm/halrf/rtl8197g/halrf_iqk_8197g.o -+ _PHYDM_FILES += phydm/halrf/rtl8197g/halrf_dpk_8197g.o -+ _PHYDM_FILES += phydm/halrf/rtl8197g/halrf_tssi_8197g.o -+ _PHYDM_FILES += phydm/halrf/rtl8197g/halrf_rfk_init_8197g.o -+ _PHYDM_FILES += phydm/halrf/rtl8197g/halhwimg8197g_rf.o -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8197g/phydm_hal_api8197g.o\ -+ phydm/rtl8197g/halhwimg8197g_bb.o\ -+ phydm/rtl8197g/halhwimg8197g_mac.o\ -+ phydm/rtl8197g/phydm_regconfig8197g.o \ -+ phydm/rtl8197g/phydm_rtl8197g.o \ -+ phydm/halrf/rtl8197g/halrf_8197g.o -+ endif -+endif -+ifeq ($(CONFIG_WLAN_HAL_8723FE),y) -+ _PHYDM_FILES += phydm/halrf/rtl8723f/halrf_8723f.o -+ _PHYDM_FILES += phydm/halrf/rtl8723f/halrf_iqk_8723f.o -+ _PHYDM_FILES += phydm/halrf/rtl8723f/halrf_dpk_8723f.o -+ _PHYDM_FILES += phydm/halrf/rtl8723f/halrf_rfk_init_8723f.o -+ _PHYDM_FILES += phydm/halrf/rtl8723f/halhwimg8723f_rf.o -+ ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) -+ _PHYDM_FILES += \ -+ phydm/rtl8723f/halhwimg8723f_bb.o\ -+ phydm/rtl8723f/phydm_regconfig8723f.o\ -+ phydm/rtl8723f/phydm_hal_api8723f.o -+ endif -+endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halhwimg.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halhwimg.h -new file mode 100644 -index 000000000..6d658b393 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halhwimg.h -@@ -0,0 +1,137 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+#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 --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ap.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ap.c -new file mode 100644 -index 000000000..0cafd6978 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ap.c -@@ -0,0 +1,1682 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "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, _delta_thermal) \ -+ do {\ -+ for (_offset = 0; _offset < _size; _offset++) { \ -+ \ -+ if (_delta_thermal < thermal_threshold[_direction][_offset]) { \ -+ \ -+ if (_offset != 0)\ -+ _offset--;\ -+ break;\ -+ } \ -+ } \ -+ if (_offset >= _size)\ -+ _offset = _size-1;\ -+ } while (0) -+ -+void odm_clear_txpowertracking_state( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ u8 i; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "===>%s\n", __func__); -+ -+ for (i = 0; i < MAX_RF_PATH; i++) { -+ cali_info->absolute_ofdm_swing_idx[i] = 0; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "cali_info->absolute_ofdm_swing_idx[%d]=%d\n", -+ i, cali_info->absolute_ofdm_swing_idx[i]); -+ } -+ -+ dm->rf_calibrate_info.thermal_value = 0; -+ dm->rf_calibrate_info.thermal_value_lck = 0; -+ dm->rf_calibrate_info.thermal_value_iqk = 0; -+} -+ -+void configure_txpower_track( -+ void *dm_void, -+ struct txpwrtrack_cfg *config -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if RTL8812A_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /* if (IS_HARDWARE_TYPE_8812(dm->adapter)) */ -+ if (dm->support_ic_type == ODM_RTL8812) -+ configure_txpower_track_8812a(config); -+ /* else */ -+#endif -+#endif -+ -+#if RTL8814A_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8814A) -+ configure_txpower_track_8814a(config); -+#endif -+ -+ -+#if RTL8188E_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8188E) -+ configure_txpower_track_8188e(config); -+#endif -+ -+#if RTL8197F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8197F) -+ configure_txpower_track_8197f(config); -+#endif -+ -+#if RTL8822B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8822B) -+ configure_txpower_track_8822b(config); -+#endif -+ -+#if RTL8192F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8192F) -+ configure_txpower_track_8192f(config); -+#endif -+ -+#if RTL8198F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8198F) -+ configure_txpower_track_8198f(config); -+#endif -+ -+#if RTL8814B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8814B) -+ configure_txpower_track_8814b(config); -+#endif -+ -+#if RTL8812F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8812F) -+ configure_txpower_track_8812f(config); -+#endif -+ -+#if RTL8197G_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8197G) -+ configure_txpower_track_8197g(config); -+#endif -+ -+#if RTL8814C_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8814C) -+ configure_txpower_track_8814c(config); -+#endif -+ -+ -+} -+ -+#if (RTL8192E_SUPPORT == 1) -+void -+odm_txpowertracking_callback_thermal_meter_92e( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 thermal_value = 0, delta, delta_IQK, delta_LCK, channel, is_decrease, rf_mimo_mode; -+ u8 thermal_value_avg_count = 0; -+ u8 OFDM_min_index = 10; /* OFDM BB Swing should be less than +2.5dB, which is required by Arthur */ -+ s8 OFDM_index[2], index ; -+ u32 thermal_value_avg = 0, reg0x18; -+ u32 i = 0, j = 0, rf; -+ s32 value32, CCK_index = 0, ele_A, ele_D, ele_C, X, Y; -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ rf_mimo_mode = dm->rf_type; -+ /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK,"%s:%d rf_mimo_mode:%d\n", __FUNCTION__, __LINE__, rf_mimo_mode); */ -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == false) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+ thermal_value = (unsigned char)odm_get_rf_reg(dm, RF_PATH_A, ODM_RF_T_METER_92E, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther); -+ -+ -+ switch (rf_mimo_mode) { -+ case RF_1T1R: -+ rf = 1; -+ break; -+ case RF_2T2R: -+ rf = 2; -+ break; -+ default: -+ rf = 2; -+ break; -+ } -+ -+ /* Query OFDM path A default setting Bit[31:21] */ -+ ele_D = phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKOFDM_D); -+ for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { -+ if (ele_D == (ofdm_swing_table_92e[i] >> 22)) { -+ OFDM_index[0] = (unsigned char)i; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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 == RF_2T2R) { -+ ele_D = phy_query_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKOFDM_D); -+ for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { -+ if (ele_D == (ofdm_swing_table_92e[i] >> 22)) { -+ OFDM_index[1] = (unsigned char)i; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "PathB 0xC88[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[1]); -+ break; -+ } -+ } -+ } -+ -+ /* calculate average thermal meter */ -+ { -+ priv->pshare->thermal_value_avg_88xx[priv->pshare->thermal_value_avg_index_88xx] = thermal_value; -+ priv->pshare->thermal_value_avg_index_88xx++; -+ if (priv->pshare->thermal_value_avg_index_88xx == AVG_THERMAL_NUM_88XX) -+ priv->pshare->thermal_value_avg_index_88xx = 0; -+ -+ for (i = 0; i < AVG_THERMAL_NUM_88XX; i++) { -+ if (priv->pshare->thermal_value_avg_88xx[i]) { -+ thermal_value_avg += priv->pshare->thermal_value_avg_88xx[i]; -+ thermal_value_avg_count++; -+ } -+ } -+ -+ if (thermal_value_avg_count) { -+ thermal_value = (unsigned char)(thermal_value_avg / thermal_value_avg_count); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "AVG Thermal Meter = 0x%x\n", thermal_value); -+ } -+ } -+ -+ /* Initialize */ -+ if (!priv->pshare->thermal_value) { -+ priv->pshare->thermal_value = priv->pmib->dot11RFEntry.ther; -+ priv->pshare->thermal_value_iqk = thermal_value; -+ priv->pshare->thermal_value_lck = thermal_value; -+ } -+ -+ if (thermal_value != priv->pshare->thermal_value) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** START POWER TRACKING ********\n"); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther); -+ -+ delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther); -+ delta_IQK = RTL_ABS(thermal_value, priv->pshare->thermal_value_iqk); -+ delta_LCK = RTL_ABS(thermal_value, priv->pshare->thermal_value_lck); -+ is_decrease = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 1 : 0); -+ -+#ifdef _TRACKING_TABLE_FILE -+ if (priv->pshare->rf_ft_var.pwr_track_file) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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 */ -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "ofdm_swing_table_92e[(unsigned int)OFDM_index[0]] = %x\n", ofdm_swing_table_92e[(unsigned int)OFDM_index[0]]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "ofdm_swing_table_92e[(unsigned int)OFDM_index[1]] = %x\n", ofdm_swing_table_92e[(unsigned int)OFDM_index[1]]); -+ -+ /* Adujst OFDM Ant_A according to IQK result */ -+ ele_D = (ofdm_swing_table_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_set_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, value32); -+ -+ value32 = (ele_C & 0x000003C0) >> 6; -+ phy_set_bb_reg(priv, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, value32); -+ -+ value32 = ((X * ele_D) >> 7) & 0x01; -+ phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), value32); -+ } else { -+ phy_set_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_92e[(unsigned int)OFDM_index[0]]); -+ phy_set_bb_reg(priv, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, 0x00); -+ phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), 0x00); -+ } -+ -+ set_CCK_swing_index(priv, CCK_index); -+ -+ if (rf == 2) { -+ ele_D = (ofdm_swing_table_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_set_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, value32); -+ -+ value32 = (ele_C & 0x000003C0) >> 6; -+ phy_set_bb_reg(priv, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, value32); -+ -+ value32 = ((X * ele_D) >> 7) & 0x01; -+ phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), value32); -+ } else { -+ phy_set_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_92e[(unsigned int)OFDM_index[1]]); -+ phy_set_bb_reg(priv, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, 0x00); -+ phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), 0x00); -+ } -+ -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0xc80 = 0x%x\n", phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD)); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0xc88 = 0x%x\n", phy_query_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD)); -+ -+ if ((delta_IQK > 3) && (!iqk_info->rfk_forbidden)) { -+ priv->pshare->thermal_value_iqk = thermal_value; -+#ifdef MP_TEST -+#endif if (!(*(dm->mp_mode) && (OPMODE & (WIFI_MP_CTX_BACKGROUND | WIFI_MP_CTX_PACKET)))) -+ -+ halrf_iqk_trigger(dm, false); -+ } -+ -+ if ((delta_LCK > 8) && (!iqk_info->rfk_forbidden)) { -+ RTL_W8(0x522, 0xff); -+ reg0x18 = phy_query_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, 1); -+ phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 1); -+ phy_set_rf_reg(priv, RF_PATH_A, 0x18, BIT(15), 1); -+ delay_ms(1); -+ phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 0); -+ phy_set_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, reg0x18); -+ RTL_W8(0x522, 0x0); -+ priv->pshare->thermal_value_lck = thermal_value; -+ } -+ } -+ -+ /* update thermal meter value */ -+ priv->pshare->thermal_value = thermal_value; -+ for (i = 0 ; i < rf ; i++) -+ priv->pshare->OFDM_index[i] = OFDM_index[i]; -+ priv->pshare->CCK_index = CCK_index; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n", __FUNCTION__); -+} -+#endif -+ -+#if (RTL8814B_SUPPORT == 1 || RTL8812F_SUPPORT == 1 || RTL8822C_SUPPORT == 1 || RTL8197G_SUPPORT == 1 || RTL8814C_SUPPORT == 1) -+void -+odm_txpowertracking_callback_thermal_meter_jaguar_series4(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ struct rtl8192cd_priv *priv = dm->priv; -+ struct txpwrtrack_cfg c; -+ -+ if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) -+ return; -+ -+ u8 thermal_value[MAX_RF_PATH] = {0}, delta[MAX_RF_PATH] = {0}; -+ u8 delta_swing_table_idx_tup[DELTA_SWINGIDX_SIZE] = {0}; -+ u8 delta_swing_table_idx_tdown[DELTA_SWINGIDX_SIZE] = {0}; -+ u8 delta_LCK = 0, delta_IQK = 0, i = 0, j = 0, p; -+ u8 thermal_value_avg_count[MAX_RF_PATH] = {0}; -+ u32 thermal_value_avg[MAX_RF_PATH] = {0}; -+ s8 thermal_value_temp[MAX_RF_PATH] = {0}; -+ -+ u8 *pwrtrk_tab_up_a = NULL; -+ u8 *pwrtrk_tab_down_a = NULL; -+ u8 *pwrtrk_tab_up_b = NULL; -+ u8 *pwrtrk_tab_down_b = NULL; -+ u8 *pwrtrk_tab_up_c = NULL; -+ u8 *pwrtrk_tab_down_c = NULL; -+ u8 *pwrtrk_tab_up_d = NULL; -+ u8 *pwrtrk_tab_down_d = NULL; -+ u8 tracking_method = MIX_MODE; -+ -+ configure_txpower_track(dm, &c); -+ -+ (*c.get_delta_swing_table)(dm, -+ (u8 **)&pwrtrk_tab_up_a, (u8 **)&pwrtrk_tab_down_a, -+ (u8 **)&pwrtrk_tab_up_b, (u8 **)&pwrtrk_tab_down_b); -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ (*c.get_delta_swing_table8814only)(dm, -+ (u8 **)&pwrtrk_tab_up_c, (u8 **)&pwrtrk_tab_down_c, -+ (u8 **)&pwrtrk_tab_up_d, (u8 **)&pwrtrk_tab_down_d); -+ } -+ -+ cali_info->txpowertracking_callback_cnt++; -+ cali_info->is_txpowertracking_init = true; -+ -+ /* Initialize */ -+ if (!dm->rf_calibrate_info.thermal_value) -+ dm->rf_calibrate_info.thermal_value = -+ priv->pmib->dot11RFEntry.thermal[RF_PATH_A]; -+ -+ if (!dm->rf_calibrate_info.thermal_value_lck) -+ dm->rf_calibrate_info.thermal_value_lck = -+ priv->pmib->dot11RFEntry.thermal[RF_PATH_A]; -+ -+ if (!dm->rf_calibrate_info.thermal_value_iqk) -+ dm->rf_calibrate_info.thermal_value_iqk = -+ priv->pmib->dot11RFEntry.thermal[RF_PATH_A]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "===>odm_txpowertracking_callback_thermal_meter\n cali_info->bb_swing_idx_cck_base: %d, cali_info->bb_swing_idx_ofdm_base[A]: %d, cali_info->default_ofdm_index: %d\n", -+ cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base_path[RF_PATH_A], cali_info->default_ofdm_index); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->txpowertrack_control=%d\n", cali_info->txpowertrack_control); -+ -+ for (i = 0; i < c.rf_path_count; i++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "PGthermal[%d]=0x%x(%d)\n", i, -+ priv->pmib->dot11RFEntry.thermal[i], -+ priv->pmib->dot11RFEntry.thermal[i]); -+ -+ if (priv->pmib->dot11RFEntry.thermal[i] == 0xff || -+ priv->pmib->dot11RFEntry.thermal[i] == 0x0) -+ return; -+ } -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F)) { -+ for (i = 0; i < c.rf_path_count; i++) -+ thermal_value[i] = (u8)odm_get_rf_reg(dm, i, c.thermal_reg_addr, 0x7e); /* 0x42: RF Reg[6:1] Thermal Trim*/ -+ } else if (dm->support_ic_type == ODM_RTL8197G) { -+ for (i = 0; i < c.rf_path_count; i++) -+ thermal_value[i] = (u8)odm_get_rf_reg(dm, i, RF_0xf6, 0x7E000); -+ } else { -+ for (i = 0; i < c.rf_path_count; i++) { -+ thermal_value[i] = (u8)odm_get_rf_reg(dm, i, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ thermal_value_temp[i] = (s8)thermal_value[i] + phydm_get_multi_thermal_offset(dm, i); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "thermal_value_temp[%d](%d) = thermal_value[%d](%d) + multi_thermal_trim(%d)\n", i, thermal_value_temp[i], i, thermal_value[i], phydm_get_multi_thermal_offset(dm, i)); -+ } else { -+ thermal_value_temp[i] = (s8)thermal_value[i] + phydm_get_thermal_offset(dm); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "thermal_value_temp[%d](%d) = thermal_value[%d](%d) + thermal_trim(%d)\n", i, thermal_value_temp[i], i, thermal_value[i], phydm_get_thermal_offset(dm)); -+ } -+ -+ if (thermal_value_temp[i] > 63) -+ thermal_value[i] = 63; -+ else if (thermal_value_temp[i] < 0) -+ thermal_value[i] = 0; -+ else -+ thermal_value[i] = thermal_value_temp[i]; -+ } -+ } -+ -+ for (j = 0; j < c.rf_path_count; j++) { -+ cali_info->thermal_value_avg_path[j][cali_info->thermal_value_avg_index_path[j]] = thermal_value[j]; -+ cali_info->thermal_value_avg_index_path[j]++; -+ if (cali_info->thermal_value_avg_index_path[j] == c.average_thermal_num) /*Average times = c.average_thermal_num*/ -+ cali_info->thermal_value_avg_index_path[j] = 0; -+ -+ -+ for (i = 0; i < c.average_thermal_num; i++) { -+ if (cali_info->thermal_value_avg_path[j][i]) { -+ thermal_value_avg[j] += cali_info->thermal_value_avg_path[j][i]; -+ thermal_value_avg_count[j]++; -+ } -+ } -+ -+ if (thermal_value_avg_count[j]) { /* Calculate Average thermal_value after average enough times */ -+ thermal_value[j] = (u8)(thermal_value_avg[j] / thermal_value_avg_count[j]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "PGthermal[%d] = 0x%x(%d), AVG Thermal Meter = 0x%x(%d)\n", j, -+ priv->pmib->dot11RFEntry.thermal[j], -+ priv->pmib->dot11RFEntry.thermal[j], -+ thermal_value[j], -+ thermal_value[j]); -+ } -+ /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ -+ -+ /* "delta" here is used to determine whether thermal value changes or not. */ -+ delta[j] = RTL_ABS(thermal_value[j], priv->pmib->dot11RFEntry.thermal[j]); -+ delta_LCK = RTL_ABS(thermal_value[RF_PATH_A], dm->rf_calibrate_info.thermal_value_lck); -+ delta_IQK = RTL_ABS(thermal_value[RF_PATH_A], dm->rf_calibrate_info.thermal_value_iqk); -+ } -+ -+ /*4 6. If necessary, do LCK.*/ -+ for (i = 0; i < c.rf_path_count; i++) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", i, delta[i], delta_LCK, delta_IQK); -+ -+ /* Wait sacn to do LCK by RF Jenyu*/ -+ if( (*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { -+ /* Delta temperature is equal to or larger than 20 centigrade.*/ -+ if (delta_LCK >= c.threshold_iqk) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); -+ cali_info->thermal_value_lck = thermal_value[RF_PATH_A]; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ if ((!(dm->support_ic_type & ODM_RTL8814A)) && (!(dm->support_ic_type & ODM_RTL8822B))) { -+ if (c.phy_lc_calibrate) -+ (*c.phy_lc_calibrate)(dm); -+ } else -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do not do LCK\n"); -+ } -+ } -+ -+ /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ -+#ifdef _TRACKING_TABLE_FILE -+ for (i = 0; i < c.rf_path_count; i++) { -+ if (i == RF_PATH_B) { -+ odm_move_memory(dm, delta_swing_table_idx_tup, pwrtrk_tab_up_b, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, pwrtrk_tab_down_b, DELTA_SWINGIDX_SIZE); -+ } else if (i == RF_PATH_C) { -+ odm_move_memory(dm, delta_swing_table_idx_tup, pwrtrk_tab_up_c, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, pwrtrk_tab_down_c, DELTA_SWINGIDX_SIZE); -+ } else if (i == RF_PATH_D) { -+ odm_move_memory(dm, delta_swing_table_idx_tup, pwrtrk_tab_up_d, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, pwrtrk_tab_down_d, DELTA_SWINGIDX_SIZE); -+ } else { -+ odm_move_memory(dm, delta_swing_table_idx_tup, pwrtrk_tab_up_a, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, pwrtrk_tab_down_a, DELTA_SWINGIDX_SIZE); -+ } -+ -+ cali_info->delta_power_index_last_path[i] = cali_info->delta_power_index_path[i]; /*recording poer index offset*/ -+ delta[i] = thermal_value[i] > priv->pmib->dot11RFEntry.thermal[i] ? (thermal_value[i] - priv->pmib->dot11RFEntry.thermal[i]) : (priv->pmib->dot11RFEntry.thermal[i] - thermal_value[i]); -+ -+ if (delta[i] >= TXPWR_TRACK_TABLE_SIZE) -+ delta[i] = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ if (thermal_value[i] > priv->pmib->dot11RFEntry.thermal[i]) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tup[delta[i]], i); -+ -+ cali_info->delta_power_index_path[i] = delta_swing_table_idx_tup[delta[i]]; -+ cali_info->absolute_ofdm_swing_idx[i] = delta_swing_table_idx_tup[delta[i]]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tdown[delta[i]], i); -+ cali_info->delta_power_index_path[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; -+ cali_info->absolute_ofdm_swing_idx[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); -+ } -+ } -+ -+#endif -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ if (cali_info->delta_power_index_path[p] == cali_info->delta_power_index_last_path[p]) /*If Thermal value changes but lookup table value still the same*/ -+ cali_info->power_index_offset_path[p] = 0; -+ else -+ cali_info->power_index_offset_path[p] = cali_info->delta_power_index_path[p] - cali_info->delta_power_index_last_path[p]; /*Power index diff between 2 times Power Tracking*/ -+ } -+ -+#if 0 -+ if (dm->support_ic_type == ODM_RTL8814B) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, 0); -+ } -+#else -+ if (*dm->mp_mode == 1) { -+ if (cali_info->txpowertrack_control == 1) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ tracking_method = MIX_MODE; -+ } else if (cali_info->txpowertrack_control == 3) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking TSSI_MODE**********\n"); -+ tracking_method = TSSI_MODE; -+ } -+ } else { -+ if (dm->priv->pmib->dot11RFEntry.tssi_enable == 0) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ tracking_method = MIX_MODE; -+ } else if (dm->priv->pmib->dot11RFEntry.tssi_enable == 1) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking TSSI_MODE**********\n"); -+ tracking_method = TSSI_MODE; -+ } -+ } -+ -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8814B | ODM_RTL8197G | ODM_RTL8814C)) -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, tracking_method, p, 0); -+ -+#endif -+ /* Wait sacn to do IQK by RF Jenyu*/ -+ if ((*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden) && (dm->is_linked || *dm->mp_mode)) { -+ /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ -+ if (delta_IQK >= c.threshold_iqk) { -+ cali_info->thermal_value_iqk = thermal_value[RF_PATH_A]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); -+ -+ /*if (!cali_info->is_iqk_in_progress)*/ -+ /* (*c.do_iqk)(dm, delta_IQK, thermal_value[RF_PATH_A], 8);*/ -+ /*RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do IQK\n");*/ -+ -+ if (dm->support_ic_type == ODM_RTL8814C) { -+ if ( (!cali_info->is_iqk_in_progress) && (!cali_info->is_lck_in_progress) ) -+ (*c.do_tssi_dck)(dm, true); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do TSSI DCK\n"); -+ } -+ -+ } -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===%s\n", __func__); -+ -+ cali_info->tx_powercount = 0; -+} -+#endif -+ -+#if (RTL8197F_SUPPORT == 1 || RTL8192F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 ||\ -+ RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1) -+void -+odm_txpowertracking_callback_thermal_meter_jaguar_series3( -+ void *dm_void -+) -+{ -+#if 1 -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 thermal_value = 0, delta, delta_LCK, delta_IQK, channel, is_increase; -+ u8 thermal_value_avg_count = 0, p = 0, i = 0; -+ u32 thermal_value_avg = 0; -+ struct rtl8192cd_priv *priv = dm->priv; -+ struct txpwrtrack_cfg c; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ /*The following tables decide the final index of OFDM/CCK swing table.*/ -+ u8 *pwrtrk_tab_up_a = NULL, *pwrtrk_tab_down_a = NULL; -+ u8 *pwrtrk_tab_up_b = NULL, *pwrtrk_tab_down_b = NULL; -+ u8 *pwrtrk_tab_up_cck_a = NULL, *pwrtrk_tab_down_cck_a = NULL; -+ u8 *pwrtrk_tab_up_cck_b = NULL, *pwrtrk_tab_down_cck_b = NULL; -+ /*for 8814 add by Yu Chen*/ -+ u8 *pwrtrk_tab_up_c = NULL, *pwrtrk_tab_down_c = NULL; -+ u8 *pwrtrk_tab_up_d = NULL, *pwrtrk_tab_down_d = NULL; -+ u8 *pwrtrk_tab_up_cck_c = NULL, *pwrtrk_tab_down_cck_c = NULL; -+ u8 *pwrtrk_tab_up_cck_d = NULL, *pwrtrk_tab_down_cck_d = NULL; -+ s8 thermal_value_temp = 0; -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == false) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+ configure_txpower_track(dm, &c); -+ -+ (*c.get_delta_all_swing_table)(dm, -+ (u8 **)&pwrtrk_tab_up_a, (u8 **)&pwrtrk_tab_down_a, -+ (u8 **)&pwrtrk_tab_up_b, (u8 **)&pwrtrk_tab_down_b, -+ (u8 **)&pwrtrk_tab_up_cck_a, (u8 **)&pwrtrk_tab_down_cck_a, -+ (u8 **)&pwrtrk_tab_up_cck_b, (u8 **)&pwrtrk_tab_down_cck_b); -+ -+ if (GET_CHIP_VER(priv) == VERSION_8198F) { -+ (*c.get_delta_all_swing_table_ex)(dm, -+ (u8 **)&pwrtrk_tab_up_c, (u8 **)&pwrtrk_tab_down_c, -+ (u8 **)&pwrtrk_tab_up_d, (u8 **)&pwrtrk_tab_down_d, -+ (u8 **)&pwrtrk_tab_up_cck_c, (u8 **)&pwrtrk_tab_down_cck_c, -+ (u8 **)&pwrtrk_tab_up_cck_d, (u8 **)&pwrtrk_tab_down_cck_d); -+ } -+ /*0x42: RF Reg[15:10] 88E*/ -+ thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); -+#ifdef THER_TRIM -+ if (GET_CHIP_VER(priv) == VERSION_8197F) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"orig thermal_value=%d, ther_trim_val=%d\n", thermal_value, priv->pshare->rf_ft_var.ther_trim_val); -+ -+ thermal_value += priv->pshare->rf_ft_var.ther_trim_val; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"after thermal trim, thermal_value=%d\n", thermal_value); -+ } -+ -+ if (GET_CHIP_VER(priv) == VERSION_8198F) { -+ thermal_value_temp = thermal_value + phydm_get_thermal_offset(dm); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "thermal_value_temp(%d) = ther_value(%d) + ther_trim_ther(%d)\n", -+ thermal_value_temp, thermal_value, phydm_get_thermal_offset(dm)); -+ -+ if (thermal_value_temp > 63) -+ thermal_value = 63; -+ else if (thermal_value_temp < 0) -+ thermal_value = 0; -+ else -+ thermal_value = thermal_value_temp; -+ } -+#endif -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\n\n\nCurrent Thermal = 0x%x(%d) EEPROMthermalmeter 0x%x(%d)\n" -+ , thermal_value, thermal_value, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther); -+ -+ /* Initialize */ -+ if (!dm->rf_calibrate_info.thermal_value) -+ dm->rf_calibrate_info.thermal_value = priv->pmib->dot11RFEntry.ther; -+ -+ if (!dm->rf_calibrate_info.thermal_value_lck) -+ dm->rf_calibrate_info.thermal_value_lck = priv->pmib->dot11RFEntry.ther; -+ -+ if (!dm->rf_calibrate_info.thermal_value_iqk) -+ dm->rf_calibrate_info.thermal_value_iqk = priv->pmib->dot11RFEntry.ther; -+ -+ /* calculate average thermal meter */ -+ dm->rf_calibrate_info.thermal_value_avg[dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; -+ dm->rf_calibrate_info.thermal_value_avg_index++; -+ -+ if (dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/ -+ dm->rf_calibrate_info.thermal_value_avg_index = 0; -+ -+ for (i = 0; i < c.average_thermal_num; i++) { -+ if (dm->rf_calibrate_info.thermal_value_avg[i]) { -+ thermal_value_avg += dm->rf_calibrate_info.thermal_value_avg[i]; -+ thermal_value_avg_count++; -+ } -+ } -+ -+ if (thermal_value_avg_count) {/*Calculate Average thermal_value after average enough times*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"thermal_value_avg=0x%x(%d) thermal_value_avg_count = %d\n" -+ , thermal_value_avg, thermal_value_avg, thermal_value_avg_count); -+ -+ thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"AVG Thermal Meter = 0x%X(%d), EEPROMthermalmeter = 0x%X(%d)\n", thermal_value, thermal_value, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther); -+ } -+ -+ /*4 Calculate delta, delta_LCK, delta_IQK.*/ -+ delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther); -+ delta_LCK = RTL_ABS(thermal_value, dm->rf_calibrate_info.thermal_value_lck); -+ delta_IQK = RTL_ABS(thermal_value, dm->rf_calibrate_info.thermal_value_iqk); -+ is_increase = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 0 : 1); -+ -+ if (delta > 29) { /* power track table index(thermal diff.) upper bound*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta(%d) > 29, set delta to 29\n", delta); -+ delta = 29; -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK); -+ -+ /*4 if necessary, do LCK.*/ -+ if ((delta_LCK >= c.threshold_iqk) && (!iqk_info->rfk_forbidden)) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); -+ dm->rf_calibrate_info.thermal_value_lck = thermal_value; -+#if (RTL8822B_SUPPORT != 1) -+ if (!(dm->support_ic_type & ODM_RTL8822B)) { -+ if (c.phy_lc_calibrate) -+ (*c.phy_lc_calibrate)(dm); -+ } -+#endif -+ } -+ -+ if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ -+ return; -+ -+ /*4 Do Power Tracking*/ -+ -+ if (thermal_value != dm->rf_calibrate_info.thermal_value) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******** START POWER TRACKING ********\n"); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"Readback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", -+ thermal_value, dm->rf_calibrate_info.thermal_value, 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 = RF_PATH_A; p < c.rf_path_count; p++) { -+ switch (p) { -+ case RF_PATH_B: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_b[%d] = %d pwrtrk_tab_up_cck_b[%d] = %d\n", delta, pwrtrk_tab_up_b[delta], delta, pwrtrk_tab_up_cck_b[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_b[delta]; -+ cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_b[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_B] = %d pRF->absolute_cck_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); -+ break; -+ -+ case RF_PATH_C: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_c[%d] = %d pwrtrk_tab_up_cck_c[%d] = %d\n", delta, pwrtrk_tab_up_c[delta], delta, pwrtrk_tab_up_cck_c[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_c[delta]; -+ cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_c[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_C] = %d pRF->absolute_cck_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); -+ break; -+ -+ case RF_PATH_D: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_d[%d] = %d pwrtrk_tab_up_cck_d[%d] = %d\n", delta, pwrtrk_tab_up_d[delta], delta, pwrtrk_tab_up_cck_d[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_d[delta]; -+ cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_d[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_D] = %d pRF->absolute_cck_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); -+ break; -+ default: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_a[%d] = %d pwrtrk_tab_up_cck_a[%d] = %d\n", delta, pwrtrk_tab_up_a[delta], delta, pwrtrk_tab_up_cck_a[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_a[delta]; -+ cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_a[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_A] = %d pRF->absolute_cck_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); -+ break; -+ } -+ } -+ } else { /* thermal is lower than base*/ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ switch (p) { -+ case RF_PATH_B: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_b[%d] = %d pwrtrk_tab_down_cck_b[%d] = %d\n", delta, pwrtrk_tab_down_b[delta], delta, pwrtrk_tab_down_cck_b[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_b[delta]; -+ cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_b[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_B] = %d pRF->absolute_cck_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); -+ break; -+ -+ case RF_PATH_C: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_c[%d] = %d pwrtrk_tab_down_cck_c[%d] = %d\n", delta, pwrtrk_tab_down_c[delta], delta, pwrtrk_tab_down_cck_c[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_c[delta]; -+ cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_c[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_C] = %d pRF->absolute_cck_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); -+ break; -+ -+ case RF_PATH_D: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_d[%d] = %d pwrtrk_tab_down_cck_d[%d] = %d\n", delta, pwrtrk_tab_down_d[delta], delta, pwrtrk_tab_down_cck_d[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_d[delta]; -+ cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_d[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_D] = %d pRF->absolute_cck_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); -+ break; -+ -+ default: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_a[%d] = %d pwrtrk_tab_down_cck_a[%d] = %d\n", delta, pwrtrk_tab_down_a[delta], delta, pwrtrk_tab_down_cck_a[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_a[delta]; -+ cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_a[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_A] = %d pRF->absolute_cck_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); -+ break; -+ } -+ } -+ } -+ -+ if (is_increase) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> increse power --->\n"); -+ if (GET_CHIP_VER(priv) == VERSION_8197F) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8192F) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8822B) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8821C) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8198F) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8192F) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> decrese power --->\n"); -+ if (GET_CHIP_VER(priv) == VERSION_8197F) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8192F) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8822B) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8821C) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8198F) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8192F) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } -+ } -+ } -+#endif -+ -+ if (GET_CHIP_VER(priv) != VERSION_8198F) { -+ if ((delta_IQK >= c.threshold_iqk) && (!iqk_info->rfk_forbidden) && dm->is_linked) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); -+ dm->rf_calibrate_info.thermal_value_iqk = thermal_value; -+ if (!(dm->support_ic_type & ODM_RTL8197F)) { -+ if (c.do_iqk) -+ (*c.do_iqk)(dm, false, thermal_value, 0); -+ } -+ } -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n\n", __func__); -+ /*update thermal meter value*/ -+ dm->rf_calibrate_info.thermal_value = thermal_value; -+ -+ } -+ -+#endif -+} -+#endif -+ -+/*#if (RTL8814A_SUPPORT == 1)*/ -+#if (RTL8814A_SUPPORT == 1) -+ -+void -+odm_txpowertracking_callback_thermal_meter_jaguar_series2( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 thermal_value = 0, delta, delta_LCK, delta_IQK, channel, is_increase; -+ u8 thermal_value_avg_count = 0, p = 0, i = 0; -+ u32 thermal_value_avg = 0, reg0x18; -+ u32 bb_swing_reg[4] = {REG_A_TX_SCALE_JAGUAR, REG_B_TX_SCALE_JAGUAR, REG_C_TX_SCALE_JAGUAR2, REG_D_TX_SCALE_JAGUAR2}; -+ s32 ele_D; -+ u32 bb_swing_idx; -+ struct rtl8192cd_priv *priv = dm->priv; -+ struct txpwrtrack_cfg c; -+ boolean is_tssi_enable = false; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */ -+ u8 *delta_swing_table_idx_tup_a = NULL, *delta_swing_table_idx_tdown_a = NULL; -+ u8 *delta_swing_table_idx_tup_b = NULL, *delta_swing_table_idx_tdown_b = NULL; -+ /* for 8814 add by Yu Chen */ -+ u8 *delta_swing_table_idx_tup_c = NULL, *delta_swing_table_idx_tdown_c = NULL; -+ u8 *delta_swing_table_idx_tup_d = NULL, *delta_swing_table_idx_tdown_d = NULL; -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == false) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+ configure_txpower_track(dm, &c); -+ cali_info->default_ofdm_index = priv->pshare->OFDM_index0[RF_PATH_A]; -+ -+ (*c.get_delta_swing_table)(dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a, -+ (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b); -+ -+ if (dm->support_ic_type & ODM_RTL8814A) /* for 8814 path C & D */ -+ (*c.get_delta_swing_table8814only)(dm, (u8 **)&delta_swing_table_idx_tup_c, (u8 **)&delta_swing_table_idx_tdown_c, -+ (u8 **)&delta_swing_table_idx_tup_d, (u8 **)&delta_swing_table_idx_tdown_d); -+ -+ thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\nReadback Thermal Meter = 0x%x, pre thermal meter 0x%x, EEPROMthermalmeter 0x%x\n", thermal_value, dm->rf_calibrate_info.thermal_value, priv->pmib->dot11RFEntry.ther); -+ -+ /* Initialize */ -+ if (!dm->rf_calibrate_info.thermal_value) -+ dm->rf_calibrate_info.thermal_value = priv->pmib->dot11RFEntry.ther; -+ -+ if (!dm->rf_calibrate_info.thermal_value_lck) -+ dm->rf_calibrate_info.thermal_value_lck = priv->pmib->dot11RFEntry.ther; -+ -+ if (!dm->rf_calibrate_info.thermal_value_iqk) -+ dm->rf_calibrate_info.thermal_value_iqk = priv->pmib->dot11RFEntry.ther; -+ -+ is_tssi_enable = (boolean)odm_get_rf_reg(dm, RF_PATH_A, REG_RF_TX_GAIN_OFFSET, BIT(7)); /* check TSSI enable */ -+ -+ /* 4 Query OFDM BB swing default setting Bit[31:21] */ -+ for (p = RF_PATH_A ; p < c.rf_path_count ; p++) { -+ ele_D = odm_get_bb_reg(dm, bb_swing_reg[p], 0xffe00000); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"0x%x:0x%x ([31:21] = 0x%x)\n", bb_swing_reg[p], odm_get_bb_reg(dm, bb_swing_reg[p], MASKDWORD), ele_D); -+ -+ for (bb_swing_idx = 0; bb_swing_idx < TXSCALE_TABLE_SIZE; bb_swing_idx++) {/* 4 */ -+ if (ele_D == tx_scaling_table_jaguar[bb_swing_idx]) { -+ dm->rf_calibrate_info.OFDM_index[p] = (u8)bb_swing_idx; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"OFDM_index[%d]=%d\n", p, dm->rf_calibrate_info.OFDM_index[p]); -+ break; -+ } -+ } -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "kfree_offset[%d]=%d\n", p, cali_info->kfree_offset[p]); -+ -+ } -+ -+ /* calculate average thermal meter */ -+ dm->rf_calibrate_info.thermal_value_avg[dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; -+ dm->rf_calibrate_info.thermal_value_avg_index++; -+ if (dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) /* Average times = c.average_thermal_num */ -+ dm->rf_calibrate_info.thermal_value_avg_index = 0; -+ -+ for (i = 0; i < c.average_thermal_num; i++) { -+ if (dm->rf_calibrate_info.thermal_value_avg[i]) { -+ thermal_value_avg += dm->rf_calibrate_info.thermal_value_avg[i]; -+ thermal_value_avg_count++; -+ } -+ } -+ -+ if (thermal_value_avg_count) { /* Calculate Average thermal_value after average enough times */ -+ thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"AVG Thermal Meter = 0x%X, EEPROMthermalmeter = 0x%X\n", thermal_value, priv->pmib->dot11RFEntry.ther); -+ } -+ -+ /* 4 Calculate delta, delta_LCK, delta_IQK. */ -+ delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther); -+ delta_LCK = RTL_ABS(thermal_value, dm->rf_calibrate_info.thermal_value_lck); -+ delta_IQK = RTL_ABS(thermal_value, dm->rf_calibrate_info.thermal_value_iqk); -+ is_increase = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 0 : 1); -+ -+ /* 4 if necessary, do LCK. */ -+ if (!(dm->support_ic_type & ODM_RTL8821)) { -+ if ((delta_LCK > c.threshold_iqk) && (!iqk_info->rfk_forbidden)) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); -+ dm->rf_calibrate_info.thermal_value_lck = thermal_value; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+#if (RTL8814A_SUPPORT != 1) -+ if (!(dm->support_ic_type & ODM_RTL8814A)) { -+ if (c.phy_lc_calibrate) -+ (*c.phy_lc_calibrate)(dm); -+ } -+#endif -+ } -+ } -+ -+ if ((delta_IQK > c.threshold_iqk) && (!iqk_info->rfk_forbidden)) { -+ panic_printk("%s(%d)\n", __FUNCTION__, __LINE__); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); -+ dm->rf_calibrate_info.thermal_value_iqk = thermal_value; -+ if (c.do_iqk) -+ (*c.do_iqk)(dm, true, 0, 0); -+ } -+ -+ if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ -+ return; -+ -+ /* 4 Do Power Tracking */ -+ -+ if (is_tssi_enable == true) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter PURE TSSI MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, TSSI_MODE, p, 0); -+ } else if (thermal_value != dm->rf_calibrate_info.thermal_value) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\n******** START POWER TRACKING ********\n"); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, dm->rf_calibrate_info.thermal_value, 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 = RF_PATH_A; p < c.rf_path_count; p++) { -+ switch (p) { -+ case RF_PATH_B: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_b[delta]; /* Record delta swing for mix mode power tracking */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_C: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_c[%d] = %d\n", delta, delta_swing_table_idx_tup_c[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_c[delta]; /* Record delta swing for mix mode power tracking */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_D: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_d[%d] = %d\n", delta, delta_swing_table_idx_tup_d[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_d[delta]; /* Record delta swing for mix mode power tracking */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ default: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_a[delta]; /* Record delta swing for mix mode power tracking */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ } -+ } -+ } else { /* thermal is lower than base */ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ switch (p) { -+ case RF_PATH_B: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; /* Record delta swing for mix mode power tracking */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_C: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_c[%d] = %d\n", delta, delta_swing_table_idx_tdown_c[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_c[delta]; /* Record delta swing for mix mode power tracking */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_D: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_d[%d] = %d\n", delta, delta_swing_table_idx_tdown_d[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_d[delta]; /* Record delta swing for mix mode power tracking */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ default: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta]); -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; /* Record delta swing for mix mode power tracking */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ } -+ } -+ } -+ -+ if (is_increase) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> increse power --->\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> decrese power --->\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } -+ } -+#endif -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n", __FUNCTION__); -+ /* update thermal meter value */ -+ dm->rf_calibrate_info.thermal_value = thermal_value; -+ -+ } -+} -+#endif -+ -+#if (RTL8812A_SUPPORT == 1 || RTL8881A_SUPPORT == 1) -+void -+odm_txpowertracking_callback_thermal_meter_jaguar_series( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ unsigned char thermal_value = 0, delta, delta_LCK, channel, is_decrease; -+ unsigned char thermal_value_avg_count = 0; -+ unsigned int thermal_value_avg = 0, reg0x18; -+ unsigned int bb_swing_reg[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; -+ struct rtl8192cd_priv *priv = dm->priv; -+ unsigned char OFDM_min_index = 7; /* OFDM BB Swing should be less than +2.5dB, which is required by Arthur and Mimic */ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == false) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+#if RTL8881A_SUPPORT -+ if (dm->support_ic_type == 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 && (*dm->band_type == ODM_BAND_2_4G)) -+ OFDM_min_index = 6; /* intPA - upper bond set to +3 dB (base: -2 dB)ot11RFEntry.phy_band_select == PHY_BAND_2G)) */ -+ else -+ OFDM_min_index = 10; /* OFDM BB Swing should be less than +1dB, which is required by Arthur and Mimic */ -+ } -+#endif -+ -+ -+ thermal_value = (unsigned char)phy_query_rf_reg(priv, RF_PATH_A, 0x42, 0xfc00, 1); /* 0x42: RF Reg[15:10] 88E */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, 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_query_bb_reg(priv, bb_swing_reg[rf_path], 0xffe00000); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0x%x:0x%x ([31:21] = 0x%x)\n", bb_swing_reg[rf_path], phy_query_bb_reg(priv, bb_swing_reg[rf_path], MASKDWORD), ele_D); -+ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {/* 4 */ -+ if (ele_D == ofdm_swing_table_8812[i]) { -+ OFDM_index[rf_path] = (unsigned char)i; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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_query_bb_reg(priv, 0xc1c, 0xffe00000); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0xc1c:0x%x ([31:21] = 0x%x)\n", phy_query_bb_reg(priv, 0xc1c, MASKDWORD), ele_D); -+ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {/* 4 */ -+ if (ele_D == ofdm_swing_table_8812[i]) { -+ OFDM_index[0] = (unsigned char)i; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "OFDM_index[0]=%d\n", OFDM_index[0]); -+ break; -+ } -+ } -+ /* Query OFDM path B default setting */ -+ if (rf == 2) { -+ ele_D = phy_query_bb_reg(priv, 0xe1c, 0xffe00000); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0xe1c:0x%x ([32:21] = 0x%x)\n", phy_query_bb_reg(priv, 0xe1c, MASKDWORD), ele_D); -+ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) { -+ if (ele_D == ofdm_swing_table_8812[i]) { -+ OFDM_index[1] = (unsigned char)i; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "OFDM_index[1]=%d\n", OFDM_index[1]); -+ break; -+ } -+ } -+ } -+#endif -+ /* Initialize */ -+ if (!priv->pshare->thermal_value) { -+ priv->pshare->thermal_value = priv->pmib->dot11RFEntry.ther; -+ priv->pshare->thermal_value_lck = thermal_value; -+ } -+ -+ /* calculate average thermal meter */ -+ { -+ priv->pshare->thermal_value_avg_8812[priv->pshare->thermal_value_avg_index_8812] = thermal_value; -+ priv->pshare->thermal_value_avg_index_8812++; -+ if (priv->pshare->thermal_value_avg_index_8812 == AVG_THERMAL_NUM_8812) -+ priv->pshare->thermal_value_avg_index_8812 = 0; -+ -+ for (i = 0; i < AVG_THERMAL_NUM_8812; i++) { -+ if (priv->pshare->thermal_value_avg_8812[i]) { -+ thermal_value_avg += priv->pshare->thermal_value_avg_8812[i]; -+ thermal_value_avg_count++; -+ } -+ } -+ -+ if (thermal_value_avg_count) { -+ thermal_value = (unsigned char)(thermal_value_avg / thermal_value_avg_count); -+ /* printk("AVG Thermal Meter = 0x%x\n", thermal_value); */ -+ } -+ } -+ -+ -+ /* 4 If necessary, do power tracking */ -+ -+ if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ -+ return; -+ -+ if (thermal_value != priv->pshare->thermal_value) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** START POWER TRACKING ********\n"); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther); -+ delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther); -+ delta_LCK = RTL_ABS(thermal_value, priv->pshare->thermal_value_lck); -+ is_decrease = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 1 : 0); -+ /* if (*dm->band_type == ODM_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++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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 (dm->support_ic_type == ODM_RTL8881A) { -+ if (priv->pshare->rf_ft_var.pwrtrk_tx_agc_enable) { -+ if (priv->pshare->add_tx_agc) { /* tx_agc has been added */ -+ add_tx_power88xx_ac(priv, 0); -+ priv->pshare->add_tx_agc = 0; -+ priv->pshare->add_tx_agc_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 (dm->support_ic_type == ODM_RTL8881A) { -+ if (priv->pshare->rf_ft_var.pwrtrk_tx_agc_enable) { -+ if (OFDM_index[i] < OFDM_min_index) { -+ priv->pshare->add_tx_agc_index = (OFDM_min_index - OFDM_index[i]) / 2; /* Calculate Remnant tx_agc value, 2 index for 1 tx_agc */ -+ add_tx_power88xx_ac(priv, priv->pshare->add_tx_agc_index); -+ priv->pshare->add_tx_agc = 1; /* add_tx_agc Flag = 1 */ -+ OFDM_index[i] = OFDM_min_index; -+ } else { -+ if (priv->pshare->add_tx_agc) { /* tx_agc been added */ -+ priv->pshare->add_tx_agc = 0; -+ priv->pshare->add_tx_agc_index = 0; -+ add_tx_power88xx_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 -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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_set_bb_reg(priv, bb_swing_reg[rf_path], 0xffe00000, ofdm_swing_table_8812[(unsigned int)OFDM_index[rf_path]]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Readback 0x%x[31:21] = 0x%x, OFDM_index:%d\n", bb_swing_reg[rf_path], phy_query_bb_reg(priv, bb_swing_reg[rf_path], 0xffe00000), OFDM_index[rf_path]); -+ } -+ -+ } -+ if ((delta_LCK > 8) && (!iqk_info->rfk_forbidden)) { -+ RTL_W8(0x522, 0xff); -+ reg0x18 = phy_query_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, 1); -+ phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 1); -+ phy_set_rf_reg(priv, RF_PATH_A, 0x18, BIT(15), 1); -+ delay_ms(200); /* frequency deviation */ -+ phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 0); -+ phy_set_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, reg0x18); -+#ifdef CONFIG_RTL_8812_SUPPORT -+ if (GET_CHIP_VER(priv) == VERSION_8812E) -+ update_bbrf_val8812(priv, priv->pmib->dot11RFEntry.dot11channel); -+#endif -+ RTL_W8(0x522, 0x0); -+ priv->pshare->thermal_value_lck = thermal_value; -+ } -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n", __FUNCTION__); -+ -+ /* update thermal meter value */ -+ priv->pshare->thermal_value = thermal_value; -+ for (rf_path = 0; rf_path < max_rf_path; rf_path++) -+ priv->pshare->OFDM_index[rf_path] = OFDM_index[rf_path]; -+ } -+} -+ -+#endif -+ -+ -+void -+odm_txpowertracking_callback_thermal_meter( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ -+#if (RTL8814B_SUPPORT == 1 || RTL8812F_SUPPORT == 1 || RTL8822C_SUPPORT == 1 || RTL8197G_SUPPORT == 1 || RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8812F | ODM_RTL8822C | ODM_RTL8197G | ODM_RTL8814C)) { -+ odm_txpowertracking_callback_thermal_meter_jaguar_series4(dm); -+ return; -+ } -+#endif -+#if (RTL8197F_SUPPORT == 1 ||RTL8192F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197F || dm->support_ic_type == ODM_RTL8192F || dm->support_ic_type == ODM_RTL8822B -+ || dm->support_ic_type == ODM_RTL8821C || dm->support_ic_type == ODM_RTL8198F) { -+ odm_txpowertracking_callback_thermal_meter_jaguar_series3(dm); -+ return; -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) /*use this function to do power tracking after 8814 by YuChen*/ -+ if (dm->support_ic_type & ODM_RTL8814A) { -+ odm_txpowertracking_callback_thermal_meter_jaguar_series2(dm); -+ return; -+ } -+#endif -+#if (RTL8881A_SUPPORT || RTL8812A_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8812 || dm->support_ic_type & ODM_RTL8881A) { -+ odm_txpowertracking_callback_thermal_meter_jaguar_series(dm); -+ return; -+ } -+#endif -+ -+#if (RTL8192E_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8192E) { -+ odm_txpowertracking_callback_thermal_meter_92e(dm); -+ return; -+ } -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ /* PMGNT_INFO mgnt_info = &adapter->mgnt_info; */ -+#endif -+ -+ -+ u8 thermal_value = 0, delta, delta_LCK, delta_IQK, offset; -+ u8 thermal_value_avg_count = 0; -+ u32 thermal_value_avg = 0; -+ /* s32 ele_A=0, ele_D, TempCCk, X, value32; -+ * s32 Y, ele_C=0; -+ * s8 OFDM_index[2], CCK_index=0, OFDM_index_old[2]={0,0}, CCK_index_old=0, index; -+ * s8 deltaPowerIndex = 0; */ -+ u32 i = 0;/* , j = 0; */ -+ boolean is2T = false; -+ /* bool bInteralPA = false; */ -+ -+ u8 OFDM_max_index = 34, rf = (is2T) ? 2 : 1; /* OFDM BB Swing should be less than +3.0dB, which is required by Arthur */ -+ u8 indexforchannel = 0;/*get_right_chnl_place_for_iqk(hal_data->current_channel)*/ -+ enum _POWER_DEC_INC { POWER_DEC, POWER_INC }; -+ -+ struct txpwrtrack_cfg c; -+ -+ -+ /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */ -+ s8 delta_swing_table_idx[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} -+ }; -+ u8 thermal_threshold[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) -+ struct rtl8192cd_priv *priv = dm->priv; -+#endif -+ -+ /* 4 2. Initilization ( 7 steps in total ) */ -+ -+ configure_txpower_track(dm, &c); -+ -+ dm->rf_calibrate_info.txpowertracking_callback_cnt++; /* cosa add for debug */ -+ dm->rf_calibrate_info.is_txpowertracking_init = true; -+ -+#if (MP_DRIVER == 1) -+ dm->rf_calibrate_info.txpowertrack_control = hal_data->txpowertrack_control; /* We should keep updating the control variable according to HalData. -+ * rf_calibrate_info.rega24 will be initialized when ODM HW configuring, but MP configures with para files. */ -+ dm->rf_calibrate_info.rega24 = 0x090e1317; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(MP_TEST) -+ if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) { -+ if (dm->priv->pshare->mp_txpwr_tracking == false) -+ return; -+ } -+#endif -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "===>odm_txpowertracking_callback_thermal_meter_8188e, dm->bb_swing_idx_cck_base: %d, dm->bb_swing_idx_ofdm_base: %d\n", cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base); -+ /* -+ if (!dm->rf_calibrate_info.tm_trigger) { -+ odm_set_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, BIT(17) | BIT(16), 0x3); -+ dm->rf_calibrate_info.tm_trigger = 1; -+ return; -+ } -+ */ -+ thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (!thermal_value || !dm->rf_calibrate_info.txpowertrack_control) -+#else -+ if (!dm->rf_calibrate_info.txpowertrack_control) -+#endif -+ return; -+ -+ /* 4 3. Initialize ThermalValues of rf_calibrate_info */ -+ -+ if (!dm->rf_calibrate_info.thermal_value) { -+ dm->rf_calibrate_info.thermal_value_lck = thermal_value; -+ dm->rf_calibrate_info.thermal_value_iqk = thermal_value; -+ } -+ -+ if (dm->rf_calibrate_info.is_reloadtxpowerindex) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "reload ofdm index for band switch\n"); -+ -+ /* 4 4. Calculate average thermal meter */ -+ -+ dm->rf_calibrate_info.thermal_value_avg[dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; -+ dm->rf_calibrate_info.thermal_value_avg_index++; -+ if (dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) -+ dm->rf_calibrate_info.thermal_value_avg_index = 0; -+ -+ for (i = 0; i < c.average_thermal_num; i++) { -+ if (dm->rf_calibrate_info.thermal_value_avg[i]) { -+ thermal_value_avg += dm->rf_calibrate_info.thermal_value_avg[i]; -+ thermal_value_avg_count++; -+ } -+ } -+ -+ if (thermal_value_avg_count) { -+ /* Give the new thermo value a weighting */ -+ thermal_value_avg += (thermal_value * 4); -+ -+ thermal_value = (u8)(thermal_value_avg / (thermal_value_avg_count + 4)); -+ cali_info->thermal_value_delta = thermal_value - priv->pmib->dot11RFEntry.ther; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "AVG Thermal Meter = 0x%x\n", thermal_value); -+ } -+ -+ /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ -+ -+ delta = (thermal_value > dm->rf_calibrate_info.thermal_value) ? (thermal_value - dm->rf_calibrate_info.thermal_value) : (dm->rf_calibrate_info.thermal_value - thermal_value); -+ delta_LCK = (thermal_value > dm->rf_calibrate_info.thermal_value_lck) ? (thermal_value - dm->rf_calibrate_info.thermal_value_lck) : (dm->rf_calibrate_info.thermal_value_lck - thermal_value); -+ delta_IQK = (thermal_value > dm->rf_calibrate_info.thermal_value_iqk) ? (thermal_value - dm->rf_calibrate_info.thermal_value_iqk) : (dm->rf_calibrate_info.thermal_value_iqk - thermal_value); -+ -+ /* 4 6. If necessary, do LCK. */ -+ if (!(dm->support_ic_type & ODM_RTL8821)) { -+ /*if((delta_LCK > hal_data->delta_lck) && (hal_data->delta_lck != 0))*/ -+ if ((delta_LCK >= c.threshold_iqk) && (!iqk_info->rfk_forbidden)) { -+ /*Delta temperature is equal to or larger than 20 centigrade.*/ -+ dm->rf_calibrate_info.thermal_value_lck = thermal_value; -+ (*c.phy_lc_calibrate)(dm); -+ } -+ } -+ -+ /* 3 7. If necessary, move the index of swing table to adjust Tx power. */ -+ -+ if (delta > 0 && dm->rf_calibrate_info.txpowertrack_control) { -+ -+ delta = (thermal_value > dm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - dm->priv->pmib->dot11RFEntry.ther) : (dm->priv->pmib->dot11RFEntry.ther - thermal_value); -+ -+ /* 4 7.1 The Final Power index = BaseIndex + power_index_offset */ -+ -+ if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) { -+ CALCULATE_SWINGTALBE_OFFSET(offset, POWER_INC, index_mapping_NUM_88E, delta); -+ dm->rf_calibrate_info.delta_power_index_last = dm->rf_calibrate_info.delta_power_index; -+ dm->rf_calibrate_info.delta_power_index = delta_swing_table_idx[POWER_INC][offset]; -+ -+ } else { -+ -+ CALCULATE_SWINGTALBE_OFFSET(offset, POWER_DEC, index_mapping_NUM_88E, delta); -+ dm->rf_calibrate_info.delta_power_index_last = dm->rf_calibrate_info.delta_power_index; -+ dm->rf_calibrate_info.delta_power_index = (-1) * delta_swing_table_idx[POWER_DEC][offset]; -+ } -+ -+ if (dm->rf_calibrate_info.delta_power_index == dm->rf_calibrate_info.delta_power_index_last) -+ dm->rf_calibrate_info.power_index_offset = 0; -+ else -+ dm->rf_calibrate_info.power_index_offset = dm->rf_calibrate_info.delta_power_index - dm->rf_calibrate_info.delta_power_index_last; -+ -+ for (i = 0; i < rf; i++) -+ dm->rf_calibrate_info.OFDM_index[i] = cali_info->bb_swing_idx_ofdm_base + dm->rf_calibrate_info.power_index_offset; -+ dm->rf_calibrate_info.CCK_index = cali_info->bb_swing_idx_cck_base + dm->rf_calibrate_info.power_index_offset; -+ -+ cali_info->bb_swing_idx_cck = dm->rf_calibrate_info.CCK_index; -+ cali_info->bb_swing_idx_ofdm[RF_PATH_A] = dm->rf_calibrate_info.OFDM_index[RF_PATH_A]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_cck, cali_info->bb_swing_idx_cck_base, dm->rf_calibrate_info.power_index_offset); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "The 'OFDM' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_ofdm[RF_PATH_A], cali_info->bb_swing_idx_ofdm_base, dm->rf_calibrate_info.power_index_offset); -+ -+ /* 4 7.1 Handle boundary conditions of index. */ -+ -+ -+ for (i = 0; i < rf; i++) { -+ if (dm->rf_calibrate_info.OFDM_index[i] > OFDM_max_index) -+ dm->rf_calibrate_info.OFDM_index[i] = OFDM_max_index; -+ else if (dm->rf_calibrate_info.OFDM_index[i] < 0) -+ dm->rf_calibrate_info.OFDM_index[i] = 0; -+ } -+ -+ if (dm->rf_calibrate_info.CCK_index > c.swing_table_size_cck - 1) -+ dm->rf_calibrate_info.CCK_index = c.swing_table_size_cck - 1; -+ else if (dm->rf_calibrate_info.CCK_index < 0) -+ dm->rf_calibrate_info.CCK_index = 0; -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"The thermal meter is unchanged or TxPowerTracking OFF: thermal_value: %d, dm->rf_calibrate_info.thermal_value: %d)\n", thermal_value, dm->rf_calibrate_info.thermal_value); -+ dm->rf_calibrate_info.power_index_offset = 0; -+ } -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", dm->rf_calibrate_info.CCK_index, cali_info->bb_swing_idx_cck_base); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index: %d\n", dm->rf_calibrate_info.OFDM_index[RF_PATH_A], cali_info->bb_swing_idx_ofdm_base); -+ -+ if (dm->rf_calibrate_info.power_index_offset != 0 && dm->rf_calibrate_info.txpowertrack_control) { -+ /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ -+ -+ dm->rf_calibrate_info.is_tx_power_changed = 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 (thermal_value > dm->rf_calibrate_info.thermal_value) { -+ /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK, */ -+ /* "Temperature Increasing: delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", */ -+ /* dm->rf_calibrate_info.power_index_offset, delta, thermal_value, hal_data->eeprom_thermal_meter, dm->rf_calibrate_info.thermal_value); */ -+ } else if (thermal_value < dm->rf_calibrate_info.thermal_value) { /* Low temperature */ -+ /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK, */ -+ /* "Temperature Decreasing: delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", */ -+ /* dm->rf_calibrate_info.power_index_offset, delta, thermal_value, hal_data->eeprom_thermal_meter, dm->rf_calibrate_info.thermal_value); */ -+ } -+ if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) -+ { -+ /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK,"Temperature(%d) hugher than PG value(%d), increases the power by tx_agc\n", thermal_value, hal_data->eeprom_thermal_meter); */ -+ (*c.odm_tx_pwr_track_set_pwr)(dm, TXAGC, 0, 0); -+ } else { -+ /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK,"Temperature(%d) lower than PG value(%d), increases the power by tx_agc\n", thermal_value, hal_data->eeprom_thermal_meter); */ -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, RF_PATH_A, indexforchannel); -+ if (is2T) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, RF_PATH_B, indexforchannel); -+ } -+ -+ cali_info->bb_swing_idx_cck_base = cali_info->bb_swing_idx_cck; -+ cali_info->bb_swing_idx_ofdm_base = cali_info->bb_swing_idx_ofdm[RF_PATH_A]; -+ dm->rf_calibrate_info.thermal_value = thermal_value; -+ -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===dm_TXPowerTrackingCallback_ThermalMeter_8188E\n"); -+ -+ dm->rf_calibrate_info.tx_powercount = 0; -+} -+ -+/* 3============================================================ -+ * 3 IQ Calibration -+ * 3============================================================ */ -+ -+void -+odm_reset_iqk_result( -+ void *dm_void -+) -+{ -+ return; -+} -+#if 1/* !(DM_ODM_SUPPORT_TYPE & ODM_AP) */ -+u8 odm_get_right_chnl_place_for_iqk(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; -+ -+} -+#endif -+ -+void -+odm_iq_calibrate( -+ struct dm_struct *dm -+) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if ((dm->is_linked) && (!iqk_info->rfk_forbidden)) { -+ if ((*dm->channel != dm->pre_channel) && (!*dm->is_scan_in_process)) { -+ dm->pre_channel = *dm->channel; -+ dm->linked_interval = 0; -+ } -+ -+ if (dm->linked_interval < 3) -+ dm->linked_interval++; -+ -+ if (dm->linked_interval == 2) -+ halrf_iqk_trigger(dm, false); -+ } else -+ dm->linked_interval = 0; -+ -+} -+ -+void phydm_rf_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ odm_txpowertracking_init(dm); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814A) -+ phy_iq_calibrate_8814a_init(dm); -+#endif -+#endif -+ -+} -+ -+void phydm_rf_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_txpowertracking_check(dm); -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ odm_iq_calibrate(dm); -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ap.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ap.h -new file mode 100644 -index 000000000..8cc2797bc ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ap.h -@@ -0,0 +1,170 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALPHYRF_H__ -+#define __HALPHYRF_H__ -+ -+#include "halrf/halrf_powertracking_ap.h" -+#include "halrf/halrf_kfree.h" -+ -+#if (RTL8814A_SUPPORT == 1) -+ #include "halrf/rtl8814a/halrf_iqk_8814a.h" -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+ #include "halrf/rtl8822b/halrf_iqk_8822b.h" -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ #include "halrf/rtl8821c/halrf_iqk_8821c.h" -+#endif -+ -+#if (RTL8195B_SUPPORT == 1) -+// #include "halrf/rtl8195b/halrf.h" -+ #include "halrf/rtl8195b/halrf_iqk_8195b.h" -+ #include "halrf/rtl8195b/halrf_txgapk_8195b.h" -+ #include "halrf/rtl8195b/halrf_dpk_8195b.h" -+#endif -+ -+#if (RTL8198F_SUPPORT == 1) -+ #include "halrf/rtl8198f/halrf_iqk_8198f.h" -+ #include "halrf/rtl8198f/halrf_dpk_8198f.h" -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ #include "halrf/rtl8812f/halrf_iqk_8812f.h" -+ #include "halrf/rtl8812f/halrf_dpk_8812f.h" -+ #include "halrf/rtl8812f/halrf_tssi_8812f.h" -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ #include "halrf/rtl8814b/halrf_iqk_8814b.h" -+ #include "halrf/rtl8814b/halrf_dpk_8814b.h" -+ #include "halrf/rtl8814b/halrf_txgapk_8814b.h" -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ #include "halrf/rtl8197g/halrf_iqk_8197g.h" -+ #include "halrf/rtl8197g/halrf_dpk_8197g.h" -+ #include "halrf/rtl8197g/halrf_tssi_8197g.h" -+#endif -+ -+enum pwrtrack_method { -+ BBSWING, -+ TXAGC, -+ MIX_MODE, -+ TSSI_MODE, -+ MIX_2G_TSSI_5G_MODE, -+ MIX_5G_TSSI_2G_MODE, -+ CLEAN_MODE -+}; -+ -+typedef void (*func_set_pwr)(void *, enum pwrtrack_method, u8, u8); -+typedef void(*func_iqk)(void *, u8, u8, u8); -+typedef void (*func_lck)(void *); -+typedef void (*func_tssi_dck)(void *, u8); -+/* refine by YuChen for 8814A */ -+typedef void (*func_swing)(void *, u8 **, u8 **, u8 **, u8 **); -+typedef void (*func_swing8814only)(void *, u8 **, u8 **, u8 **, u8 **); -+typedef void (*func_all_swing)(void *, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **); -+typedef void (*func_all_swing_ex)(void *, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **); -+ -+struct txpwrtrack_cfg { -+ u8 swing_table_size_cck; -+ u8 swing_table_size_ofdm; -+ u8 threshold_iqk; -+ u8 threshold_dpk; -+ u8 average_thermal_num; -+ u8 rf_path_count; -+ u32 thermal_reg_addr; -+ func_set_pwr odm_tx_pwr_track_set_pwr; -+ func_iqk do_iqk; -+ func_lck phy_lc_calibrate; -+ func_tssi_dck do_tssi_dck; -+ func_swing get_delta_swing_table; -+ func_swing8814only get_delta_swing_table8814only; -+ func_all_swing get_delta_all_swing_table; -+ func_all_swing_ex get_delta_all_swing_table_ex; -+}; -+ -+void -+odm_clear_txpowertracking_state( -+ void *dm_void -+); -+ -+void -+configure_txpower_track( -+ void *dm_void, -+ struct txpwrtrack_cfg *config -+); -+ -+ -+void -+odm_txpowertracking_callback_thermal_meter( -+ void *dm_void -+); -+ -+#if (RTL8192E_SUPPORT == 1) -+void -+odm_txpowertracking_callback_thermal_meter_92e( -+ void *dm_void -+); -+#endif -+ -+#if (RTL8814A_SUPPORT == 1) -+void -+odm_txpowertracking_callback_thermal_meter_jaguar_series2( -+ void *dm_void -+); -+ -+#elif ODM_IC_11AC_SERIES_SUPPORT -+void -+odm_txpowertracking_callback_thermal_meter_jaguar_series( -+ void *dm_void -+); -+ -+#elif (RTL8197F_SUPPORT == 1 || RTL8192F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 ||\ -+ RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1) -+void -+odm_txpowertracking_callback_thermal_meter_jaguar_series3( -+ void *dm_void -+); -+ -+#elif (RTL8814B_SUPPORT == 1 || RTL8812F_SUPPORT == 1 || RTL8822C_SUPPORT == 1 || RTL8197G_SUPPORT == 1) -+void -+odm_txpowertracking_callback_thermal_meter_jaguar_series4( -+ void *dm_void -+); -+ -+#endif -+ -+#define IS_CCK_RATE(_rate) (ODM_MGN_1M == _rate || _rate == ODM_MGN_2M || _rate == ODM_MGN_5_5M || _rate == ODM_MGN_11M) -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+ -+void -+odm_reset_iqk_result( -+ void *dm_void -+); -+u8 -+odm_get_right_chnl_place_for_iqk( -+ u8 chnl -+); -+ -+void phydm_rf_init(void *dm_void); -+void phydm_rf_watchdog(void *dm_void); -+ -+#endif /*#ifndef __HALPHYRF_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ce.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ce.c -new file mode 100644 -index 000000000..6ba960600 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ce.c -@@ -0,0 +1,1180 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _delta_thermal)\ -+ do { \ -+ u32 __offset = (u32)_offset; \ -+ u32 __size = (u32)_size; \ -+ for (__offset = 0; __offset < __size; __offset++) { \ -+ if (_delta_thermal < \ -+ thermal_threshold[_direction][__offset]) { \ -+ if (__offset != 0) \ -+ __offset--; \ -+ break; \ -+ } \ -+ } \ -+ if (__offset >= __size) \ -+ __offset = __size - 1; \ -+ } while (0) -+ -+void configure_txpower_track(void *dm_void, struct txpwrtrack_cfg *config) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if RTL8192E_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8192E) -+ configure_txpower_track_8192e(config); -+#endif -+#if RTL8821A_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8821) -+ configure_txpower_track_8821a(config); -+#endif -+#if RTL8812A_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8812) -+ configure_txpower_track_8812a(config); -+#endif -+#if RTL8188E_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8188E) -+ configure_txpower_track_8188e(config); -+#endif -+ -+#if RTL8723B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8723B) -+ configure_txpower_track_8723b(config); -+#endif -+ -+#if RTL8814A_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8814A) -+ configure_txpower_track_8814a(config); -+#endif -+ -+#if RTL8703B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8703B) -+ configure_txpower_track_8703b(config); -+#endif -+ -+#if RTL8188F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8188F) -+ configure_txpower_track_8188f(config); -+#endif -+#if RTL8723D_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8723D) -+ configure_txpower_track_8723d(config); -+#endif -+/*@ JJ ADD 20161014 */ -+#if RTL8710B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8710B) -+ configure_txpower_track_8710b(config); -+#endif -+#if RTL8822B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8822B) -+ configure_txpower_track_8822b(config); -+#endif -+#if RTL8821C_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8821C) -+ configure_txpower_track_8821c(config); -+#endif -+ -+#if RTL8192F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8192F) -+ configure_txpower_track_8192f(config); -+#endif -+ -+#if RTL8822C_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8822C) -+ configure_txpower_track_8822c(config); -+#endif -+ -+#if RTL8814B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8814B) -+ configure_txpower_track_8814b(config); -+#endif -+ -+#if RTL8723F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8723F) -+ configure_txpower_track_8723f(config); -+#endif -+ -+} -+ -+/*@ ********************************************************************** -+ * <20121113, Kordan> This function should be called when tx_agc 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_clear_txpowertracking_state(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u8 p = 0; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ -+ cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; -+ cali_info->bb_swing_idx_cck = cali_info->default_cck_index; -+ dm->rf_calibrate_info.CCK_index = 0; -+ -+ for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { -+ cali_info->bb_swing_idx_ofdm_base[p] -+ = cali_info->default_ofdm_index; -+ cali_info->bb_swing_idx_ofdm[p] = cali_info->default_ofdm_index; -+ cali_info->OFDM_index[p] = cali_info->default_ofdm_index; -+ -+ cali_info->power_index_offset[p] = 0; -+ cali_info->delta_power_index[p] = 0; -+ cali_info->delta_power_index_last[p] = 0; -+ -+ /* Initial Mix mode power tracking*/ -+ cali_info->absolute_ofdm_swing_idx[p] = 0; -+ cali_info->remnant_ofdm_swing_idx[p] = 0; -+ cali_info->kfree_offset[p] = 0; -+ } -+ /* Initial Mix mode power tracking*/ -+ cali_info->modify_tx_agc_flag_path_a = false; -+ cali_info->modify_tx_agc_flag_path_b = false; -+ cali_info->modify_tx_agc_flag_path_c = false; -+ cali_info->modify_tx_agc_flag_path_d = false; -+ cali_info->remnant_cck_swing_idx = 0; -+ cali_info->thermal_value = rf->eeprom_thermal; -+ cali_info->modify_tx_agc_value_cck = 0; -+ cali_info->modify_tx_agc_value_ofdm = 0; -+} -+ -+void odm_get_tracking_table(void *dm_void, u8 thermal_value, u8 delta) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct txpwrtrack_cfg c = {0}; -+ -+ u8 p; -+ /* 4 1. TWO tables decide the final index of OFDM/CCK swing table. */ -+ u8 *pwrtrk_tab_up_a = NULL; -+ u8 *pwrtrk_tab_down_a = NULL; -+ u8 *pwrtrk_tab_up_b = NULL; -+ u8 *pwrtrk_tab_down_b = NULL; -+ /*for 8814 add by Yu Chen*/ -+ u8 *pwrtrk_tab_up_c = NULL; -+ u8 *pwrtrk_tab_down_c = NULL; -+ u8 *pwrtrk_tab_up_d = NULL; -+ u8 *pwrtrk_tab_down_d = NULL; -+ /*for Xtal Offset by James.Tung*/ -+ s8 *xtal_tab_up = NULL; -+ s8 *xtal_tab_down = NULL; -+ -+ configure_txpower_track(dm, &c); -+ -+ (*c.get_delta_swing_table)(dm, -+ (u8 **)&pwrtrk_tab_up_a, -+ (u8 **)&pwrtrk_tab_down_a, -+ (u8 **)&pwrtrk_tab_up_b, -+ (u8 **)&pwrtrk_tab_down_b); -+ -+ if (dm->support_ic_type & ODM_RTL8814A) /*for 8814 path C & D*/ -+ (*c.get_delta_swing_table8814only)(dm, -+ (u8 **)&pwrtrk_tab_up_c, -+ (u8 **)&pwrtrk_tab_down_c, -+ (u8 **)&pwrtrk_tab_up_d, -+ (u8 **)&pwrtrk_tab_down_d); -+ /*for Xtal Offset*/ -+ if (dm->support_ic_type & -+ (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | ODM_RTL8192F)) -+ (*c.get_delta_swing_xtal_table)(dm, -+ (s8 **)&xtal_tab_up, -+ (s8 **)&xtal_tab_down); -+ -+ if (thermal_value > rf->eeprom_thermal) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ /*recording power index offset*/ -+ cali_info->delta_power_index_last[p] = -+ cali_info->delta_power_index[p]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher******\n"); -+ switch (p) { -+ case RF_PATH_B: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "pwrtrk_tab_up_b[%d] = %d\n", delta, -+ pwrtrk_tab_up_b[delta]); -+ -+ cali_info->delta_power_index[p] = -+ pwrtrk_tab_up_b[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -+ pwrtrk_tab_up_b[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "absolute_ofdm_swing_idx[PATH_B] = %d\n", -+ cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_C: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "pwrtrk_tab_up_c[%d] = %d\n", delta, -+ pwrtrk_tab_up_c[delta]); -+ -+ cali_info->delta_power_index[p] = -+ pwrtrk_tab_up_c[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -+ pwrtrk_tab_up_c[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "absolute_ofdm_swing_idx[PATH_C] = %d\n", -+ cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_D: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "pwrtrk_tab_up_d[%d] = %d\n", delta, -+ pwrtrk_tab_up_d[delta]); -+ -+ cali_info->delta_power_index[p] = -+ pwrtrk_tab_up_d[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -+ pwrtrk_tab_up_d[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "absolute_ofdm_swing_idx[PATH_D] = %d\n", -+ cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ default: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "pwrtrk_tab_up_a[%d] = %d\n", delta, -+ pwrtrk_tab_up_a[delta]); -+ -+ cali_info->delta_power_index[p] = -+ pwrtrk_tab_up_a[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -+ pwrtrk_tab_up_a[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "absolute_ofdm_swing_idx[PATH_A] = %d\n", -+ cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ } -+ } -+ /* @JJ ADD 20161014 */ -+ /*Save xtal_offset from Xtal table*/ -+ if (dm->support_ic_type & -+ (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | -+ ODM_RTL8192F)) { -+ /*recording last Xtal offset*/ -+ cali_info->xtal_offset_last = cali_info->xtal_offset; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[Xtal] xtal_tab_up[%d] = %d\n", -+ delta, xtal_tab_up[delta]); -+ cali_info->xtal_offset = xtal_tab_up[delta]; -+ if (cali_info->xtal_offset_last != xtal_tab_up[delta]) -+ cali_info->xtal_offset_eanble = 1; -+ } -+ } else { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ /*recording power index offset*/ -+ cali_info->delta_power_index_last[p] = -+ cali_info->delta_power_index[p]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower******\n"); -+ switch (p) { -+ case RF_PATH_B: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "pwrtrk_tab_down_b[%d] = %d\n", delta, -+ pwrtrk_tab_down_b[delta]); -+ cali_info->delta_power_index[p] = -+ -1 * pwrtrk_tab_down_b[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -+ -1 * pwrtrk_tab_down_b[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "absolute_ofdm_swing_idx[PATH_B] = %d\n", -+ cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_C: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "pwrtrk_tab_down_c[%d] = %d\n", delta, -+ pwrtrk_tab_down_c[delta]); -+ cali_info->delta_power_index[p] = -+ -1 * pwrtrk_tab_down_c[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -+ -1 * pwrtrk_tab_down_c[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "absolute_ofdm_swing_idx[PATH_C] = %d\n", -+ cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_D: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "pwrtrk_tab_down_d[%d] = %d\n", delta, -+ pwrtrk_tab_down_d[delta]); -+ cali_info->delta_power_index[p] = -+ -1 * pwrtrk_tab_down_d[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -+ -1 * pwrtrk_tab_down_d[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "absolute_ofdm_swing_idx[PATH_D] = %d\n", -+ cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ default: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "pwrtrk_tab_down_a[%d] = %d\n", delta, -+ pwrtrk_tab_down_a[delta]); -+ cali_info->delta_power_index[p] = -+ -1 * pwrtrk_tab_down_a[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -+ -1 * pwrtrk_tab_down_a[delta]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "absolute_ofdm_swing_idx[PATH_A] = %d\n", -+ cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ } -+ } -+ /* @JJ ADD 20161014 */ -+ if (dm->support_ic_type & -+ (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | -+ ODM_RTL8192F)) { -+ /*recording last Xtal offset*/ -+ cali_info->xtal_offset_last = cali_info->xtal_offset; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[Xtal] xtal_tab_down[%d] = %d\n", delta, -+ xtal_tab_down[delta]); -+ /*Save xtal_offset from Xtal table*/ -+ cali_info->xtal_offset = xtal_tab_down[delta]; -+ if (cali_info->xtal_offset_last != xtal_tab_down[delta]) -+ cali_info->xtal_offset_eanble = 1; -+ } -+ } -+} -+ -+void odm_pwrtrk_method(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 p, idxforchnl = 0; -+ -+ struct txpwrtrack_cfg c = {0}; -+ -+ configure_txpower_track(dm, &c); -+ -+ if (dm->support_ic_type & -+ (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8821 | ODM_RTL8812 | -+ ODM_RTL8723B | ODM_RTL8814A | ODM_RTL8703B | ODM_RTL8188F | -+ ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8710B | -+ ODM_RTL8192F)) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "***Enter PwrTrk MIX_MODE***\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else if (dm->support_ic_type & ODM_RTL8723D) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "***Enter PwrTrk MIX_MODE***\n"); -+ p = (u8)odm_get_bb_reg(dm, R_0x948, 0x00000080); -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ /*if open ant_div 0x948=140,do 2 path pwr_track*/ -+ if (odm_get_bb_reg(dm, R_0x948, 0x00000040)) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, 1, 0); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "***Enter PwrTrk BBSWING_MODE***\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr) -+ (dm, BBSWING, p, idxforchnl); -+ } -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+void odm_txpowertracking_callback_thermal_meter(struct dm_struct *dm) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+void odm_txpowertracking_callback_thermal_meter(void *dm_void) -+#else -+void odm_txpowertracking_callback_thermal_meter(void *adapter) -+#endif -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#endif -+ -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ u8 thermal_value = 0, delta, delta_lck, delta_iqk, p = 0, i = 0; -+ u8 thermal_value_avg_count = 0; -+ u32 thermal_value_avg = 0, regc80, regcd0, regcd4, regab4; -+ -+ /* OFDM BB Swing should be less than +3.0dB, required by Arthur */ -+#if 0 -+ u8 OFDM_min_index = 0; -+#endif -+#if 0 -+ /* get_right_chnl_place_for_iqk(hal_data->current_channel) */ -+#endif -+ u8 power_tracking_type = rf->pwt_type; -+ s8 thermal_value_temp = 0; -+ -+ struct txpwrtrack_cfg c = {0}; -+ -+ /* @4 2. Initialization ( 7 steps in total ) */ -+ -+ configure_txpower_track(dm, &c); -+ -+ cali_info->txpowertracking_callback_cnt++; -+ cali_info->is_txpowertracking_init = true; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "\n\n\n===>%s bbsw_idx_cck_base=%d\n", -+ __func__, cali_info->bb_swing_idx_cck_base); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "bbsw_idx_ofdm_base[A]=%d default_ofdm_idx=%d\n", -+ cali_info->bb_swing_idx_ofdm_base[RF_PATH_A], -+ cali_info->default_ofdm_index); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->txpowertrack_control=%d, rf->eeprom_thermal %d\n", -+ cali_info->txpowertrack_control, rf->eeprom_thermal); -+ -+ /* 0x42: RF Reg[15:10] 88E */ -+ thermal_value = -+ (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); -+ -+ thermal_value_temp = thermal_value + phydm_get_thermal_offset(dm); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "thermal_value_temp(%d) = ther_value(%d) + pwr_trim_ther(%d)\n", -+ thermal_value_temp, thermal_value, -+ phydm_get_thermal_offset(dm)); -+ -+ if (thermal_value_temp > 63) -+ thermal_value = 63; -+ else if (thermal_value_temp < 0) -+ thermal_value = 0; -+ else -+ thermal_value = thermal_value_temp; -+ -+ /*@add log by zhao he, check c80/c94/c14/ca0 value*/ -+ if (dm->support_ic_type & -+ (ODM_RTL8723D | ODM_RTL8710B)) { -+ regc80 = odm_get_bb_reg(dm, R_0xc80, MASKDWORD); -+ regcd0 = odm_get_bb_reg(dm, R_0xcd0, MASKDWORD); -+ regcd4 = odm_get_bb_reg(dm, R_0xcd4, MASKDWORD); -+ regab4 = odm_get_bb_reg(dm, R_0xab4, 0x000007FF); -+ RF_DBG(dm, DBG_RF_IQK, -+ "0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", -+ regc80, regcd0, regcd4, regab4); -+ } -+ -+ if (!cali_info->txpowertrack_control) -+ return; -+ -+ if (rf->eeprom_thermal == 0xff) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "no pg, hal_data->eeprom_thermal_meter = 0x%x\n", -+ rf->eeprom_thermal); -+ return; -+ } -+ -+ /*@4 3. Initialize ThermalValues of rf_calibrate_info*/ -+ -+ if (cali_info->is_reloadtxpowerindex) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "reload ofdm index for band switch\n"); -+ -+ /*@4 4. Calculate average thermal meter*/ -+ -+ cali_info->thermal_value_avg[cali_info->thermal_value_avg_index] -+ = thermal_value; -+ -+ cali_info->thermal_value_avg_index++; -+ /*Average times = c.average_thermal_num*/ -+ if (cali_info->thermal_value_avg_index == c.average_thermal_num) -+ cali_info->thermal_value_avg_index = 0; -+ -+ for (i = 0; i < c.average_thermal_num; i++) { -+ if (cali_info->thermal_value_avg[i]) { -+ thermal_value_avg += cali_info->thermal_value_avg[i]; -+ thermal_value_avg_count++; -+ } -+ } -+ -+ /* Calculate Average thermal_value after average enough times */ -+ if (thermal_value_avg_count) { -+ thermal_value = -+ (u8)(thermal_value_avg / thermal_value_avg_count); -+ cali_info->thermal_value_delta -+ = thermal_value - rf->eeprom_thermal; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "AVG Thermal Meter = 0x%X, EFUSE Thermal base = 0x%X\n", -+ thermal_value, rf->eeprom_thermal); -+ } -+ -+ /* @4 5. Calculate delta, delta_lck, delta_iqk. */ -+ /* "delta" here is used to determine thermal value changes or not. */ -+ if (thermal_value > cali_info->thermal_value) -+ delta = thermal_value - cali_info->thermal_value; -+ else -+ delta = cali_info->thermal_value - thermal_value; -+ -+ if (thermal_value > cali_info->thermal_value_lck) -+ delta_lck = thermal_value - cali_info->thermal_value_lck; -+ else -+ delta_lck = cali_info->thermal_value_lck - thermal_value; -+ -+ if (thermal_value > cali_info->thermal_value_iqk) -+ delta_iqk = thermal_value - cali_info->thermal_value_iqk; -+ else -+ delta_iqk = cali_info->thermal_value_iqk - thermal_value; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "(delta, delta_lck, delta_iqk) = (%d, %d, %d)\n", delta, -+ delta_lck, delta_iqk); -+ -+ /*@4 6. If necessary, do LCK.*/ -+ /* Wait sacn to do LCK by RF Jenyu*/ -+ if (!(*dm->is_scan_in_process) && !iqk_info->rfk_forbidden) { -+ /* Delta temperature is equal to or larger than 20 centigrade.*/ -+ if (delta_lck >= c.threshold_iqk) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_lck(%d) >= threshold_iqk(%d)\n", -+ delta_lck, c.threshold_iqk); -+ cali_info->thermal_value_lck = thermal_value; -+ -+ /*Use RTLCK, close power tracking driver LCK*/ -+ /*8821 don't do LCK*/ -+ if (!(dm->support_ic_type & -+ (ODM_RTL8821 | ODM_RTL8814A | ODM_RTL8822B)) && -+ c.phy_lc_calibrate) { -+ (*c.phy_lc_calibrate)(dm); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "do pwrtrk lck\n"); -+ } -+ } -+ } -+ -+ /*@3 7. If necessary, move the index of swing table to adjust Tx power.*/ -+ /* "delta" here is used to record the absolute value of difference. */ -+ if (delta > 0 && cali_info->txpowertrack_control) { -+ if (thermal_value > rf->eeprom_thermal) -+ delta = thermal_value - rf->eeprom_thermal; -+ else -+ delta = rf->eeprom_thermal - thermal_value; -+ -+ if (delta >= TXPWR_TRACK_TABLE_SIZE) -+ delta = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ odm_get_tracking_table(dm, thermal_value, delta); -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "\n[path-%d] Calculate pwr_idx_offset\n", p); -+ -+ /*If Thermal value changes but table value is the same*/ -+ if (cali_info->delta_power_index[p] == -+ cali_info->delta_power_index_last[p]) -+ cali_info->power_index_offset[p] = 0; -+ else -+ cali_info->power_index_offset[p] = -+ cali_info->delta_power_index[p] - -+ cali_info->delta_power_index_last[p]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "path-%d pwridx_diff%d=pwr_idx%d - last_idx%d\n", -+ p, cali_info->power_index_offset[p], -+ cali_info->delta_power_index[p], -+ cali_info->delta_power_index_last[p]); -+#if 0 -+ -+ cali_info->OFDM_index[p] = cali_info->bb_swing_idx_ofdm_base[p] + cali_info->power_index_offset[p]; -+ cali_info->CCK_index = cali_info->bb_swing_idx_cck_base + cali_info->power_index_offset[p]; -+ -+ cali_info->bb_swing_idx_cck = cali_info->CCK_index; -+ cali_info->bb_swing_idx_ofdm[p] = cali_info->OFDM_index[p]; -+ -+ /*************Print BB Swing base and index Offset*************/ -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", -+ cali_info->bb_swing_idx_cck, -+ cali_info->bb_swing_idx_cck_base, -+ cali_info->power_index_offset[p]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "The 'OFDM' final index(%d) = BaseIndex[%d](%d) + power_index_offset(%d)\n", -+ cali_info->bb_swing_idx_ofdm[p], p, -+ cali_info->bb_swing_idx_ofdm_base[p], -+ cali_info->power_index_offset[p]); -+ -+ /*4 7.1 Handle boundary conditions of index.*/ -+ -+ if (cali_info->OFDM_index[p] > c.swing_table_size_ofdm - 1) -+ cali_info->OFDM_index[p] = c.swing_table_size_ofdm - 1; -+ else if (cali_info->OFDM_index[p] <= OFDM_min_index) -+ cali_info->OFDM_index[p] = OFDM_min_index; -+#endif -+ } -+#if 0 -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "\n\n========================================================================================================\n"); -+ -+ if (cali_info->CCK_index > c.swing_table_size_cck - 1) -+ cali_info->CCK_index = c.swing_table_size_cck - 1; -+ else if (cali_info->CCK_index <= 0) -+ cali_info->CCK_index = 0; -+#endif -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Thermal is unchanged thermal=%d last_thermal=%d\n", -+ thermal_value, -+ cali_info->thermal_value); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ cali_info->power_index_offset[p] = 0; -+ } -+ -+#if 0 -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", -+ cali_info->CCK_index, -+ cali_info->bb_swing_idx_cck_base); /*Print Swing base & current*/ -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index[%d]: %d\n", -+ cali_info->OFDM_index[p], p, -+ cali_info->bb_swing_idx_ofdm_base[p]); -+ } -+#endif -+ -+ if ((dm->support_ic_type & ODM_RTL8814A)) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "power_tracking_type=%d\n", -+ power_tracking_type); -+ -+ if (power_tracking_type == 0) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "***Enter PwrTrk MIX_MODE***\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr) -+ (dm, MIX_MODE, p, 0); -+ } else if (power_tracking_type == 1) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "***Enter PwrTrk MIX(2G) TSSI(5G) MODE***\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr) -+ (dm, MIX_2G_TSSI_5G_MODE, p, 0); -+ } else if (power_tracking_type == 2) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "***Enter PwrTrk MIX(5G) TSSI(2G)MODE***\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr) -+ (dm, MIX_5G_TSSI_2G_MODE, p, 0); -+ } else if (power_tracking_type == 3) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "***Enter PwrTrk TSSI MODE***\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr) -+ (dm, TSSI_MODE, p, 0); -+ } -+ } else if ((cali_info->power_index_offset[RF_PATH_A] != 0 || -+ cali_info->power_index_offset[RF_PATH_B] != 0 || -+ cali_info->power_index_offset[RF_PATH_C] != 0 || -+ cali_info->power_index_offset[RF_PATH_D] != 0)) { -+#if 0 -+ /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ -+ /*Always true after Tx Power is adjusted by power tracking.*/ -+ -+ cali_info->is_tx_power_changed = true; -+ /* 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 (thermal_value > cali_info->thermal_value) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature Increasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, cali_info->power_index_offset[p], -+ delta, thermal_value, rf->eeprom_thermal, -+ cali_info->thermal_value); -+ } -+ } else if (thermal_value < cali_info->thermal_value) { /*Low temperature*/ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature Decreasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, cali_info->power_index_offset[p], -+ delta, thermal_value, rf->eeprom_thermal, -+ cali_info->thermal_value); -+ } -+ } -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (thermal_value > rf->eeprom_thermal) { -+#else -+ if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) higher than PG value(%d)\n", -+ thermal_value, rf->eeprom_thermal); -+ -+ odm_pwrtrk_method(dm); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) lower than PG value(%d)\n", -+ thermal_value, rf->eeprom_thermal); -+ -+ odm_pwrtrk_method(dm); -+ } -+ -+#if 0 -+ /*Record last time Power Tracking result as base.*/ -+ cali_info->bb_swing_idx_cck_base = cali_info->bb_swing_idx_cck; -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ cali_info->bb_swing_idx_ofdm_base[p] = cali_info->bb_swing_idx_ofdm[p]; -+#endif -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->thermal_value = %d thermal_value= %d\n", -+ cali_info->thermal_value, thermal_value); -+ } -+ /*Record last Power Tracking Thermal value*/ -+ cali_info->thermal_value = thermal_value; -+ -+ if (dm->support_ic_type & -+ (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8192F | ODM_RTL8710B)) { -+ if (cali_info->xtal_offset_eanble != 0 && -+ cali_info->txpowertrack_control && -+ rf->eeprom_thermal != 0xff) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "**********Enter Xtal Tracking**********\n"); -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (thermal_value > rf->eeprom_thermal) { -+#else -+ if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) higher than PG (%d)\n", -+ thermal_value, rf->eeprom_thermal); -+ (*c.odm_txxtaltrack_set_xtal)(dm); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) lower than PG (%d)\n", -+ thermal_value, rf->eeprom_thermal); -+ (*c.odm_txxtaltrack_set_xtal)(dm); -+ } -+ } -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "**********End Xtal Tracking**********\n"); -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ /* Wait sacn to do IQK by RF Jenyu*/ -+ if (!(*dm->is_scan_in_process) && !iqk_info->rfk_forbidden && -+ !cali_info->is_iqk_in_progress && dm->is_linked) { -+ if (!(dm->support_ic_type & ODM_RTL8723B)) { -+ /*Delta temperature is equal or larger than 20 Celsius*/ -+ /*When threshold is 8*/ -+ if (delta_iqk >= c.threshold_iqk) { -+ cali_info->thermal_value_iqk = thermal_value; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_iqk(%d) >= threshold_iqk(%d)\n", -+ delta_iqk, c.threshold_iqk); -+ (*c.do_iqk)(dm, delta_iqk, thermal_value, 8); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "do pwrtrk iqk\n"); -+ } -+ } -+ } -+ -+#if 0 -+ if (cali_info->dpk_thermal[RF_PATH_A] != 0) { -+ if (diff_DPK[RF_PATH_A] >= c.threshold_dpk) { -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_A] / c.threshold_dpk)); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[RF_PATH_A] <= -1 * c.threshold_dpk)) { -+ s32 value = 0x20 + (diff_DPK[RF_PATH_A] / c.threshold_dpk); -+ -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } else { -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } -+ } -+ if (cali_info->dpk_thermal[RF_PATH_B] != 0) { -+ if (diff_DPK[RF_PATH_B] >= c.threshold_dpk) { -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_B] / c.threshold_dpk)); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[RF_PATH_B] <= -1 * c.threshold_dpk)) { -+ s32 value = 0x20 + (diff_DPK[RF_PATH_B] / c.threshold_dpk); -+ -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } else { -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } -+ } -+#endif -+ -+#endif -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===%s\n", __func__); -+ -+ cali_info->tx_powercount = 0; -+} -+ -+#if (RTL8822C_SUPPORT == 1 || RTL8814B_SUPPORT == 1 || RTL8723F_SUPPORT == 1) -+void -+odm_txpowertracking_new_callback_thermal_meter(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ u8 thermal_value[MAX_RF_PATH] = {0}, delta[MAX_RF_PATH] = {0}; -+ u8 delta_swing_table_idx_tup[DELTA_SWINGIDX_SIZE] = {0}; -+ u8 delta_swing_table_idx_tdown[DELTA_SWINGIDX_SIZE] = {0}; -+ u8 delta_LCK = 0, delta_IQK = 0, i = 0, j = 0, p; -+ u8 thermal_value_avg_count[MAX_RF_PATH] = {0}; -+ u32 thermal_value_avg[MAX_RF_PATH] = {0}; -+ s8 thermal_value_temp[MAX_RF_PATH] = {0}; -+ u8 tracking_method = MIX_MODE; -+ -+ struct txpwrtrack_cfg c; -+ -+ u8 *delta_swing_table_idx_tup_a = NULL; -+ u8 *delta_swing_table_idx_tdown_a = NULL; -+ u8 *delta_swing_table_idx_tup_b = NULL; -+ u8 *delta_swing_table_idx_tdown_b = NULL; -+ u8 *delta_swing_table_idx_tup_c = NULL; -+ u8 *delta_swing_table_idx_tdown_c = NULL; -+ u8 *delta_swing_table_idx_tup_d = NULL; -+ u8 *delta_swing_table_idx_tdown_d = NULL; -+ -+ configure_txpower_track(dm, &c); -+ -+ (*c.get_delta_swing_table)(dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a, -+ (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b); -+ -+ if (dm->support_ic_type == ODM_RTL8814B) { -+ (*c.get_delta_swing_table)(dm, (u8 **)&delta_swing_table_idx_tup_c, (u8 **)&delta_swing_table_idx_tdown_c, -+ (u8 **)&delta_swing_table_idx_tup_d, (u8 **)&delta_swing_table_idx_tdown_d); -+ } -+ -+ cali_info->txpowertracking_callback_cnt++; -+ cali_info->is_txpowertracking_init = true; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "===>odm_txpowertracking_callback_thermal_meter\n cali_info->bb_swing_idx_cck_base: %d, cali_info->bb_swing_idx_ofdm_base[A]: %d, cali_info->default_ofdm_index: %d\n", -+ cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base[RF_PATH_A], cali_info->default_ofdm_index); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->txpowertrack_control=%d, tssi->thermal[RF_PATH_A]=%d tssi->thermal[RF_PATH_B]=%d\n", -+ cali_info->txpowertrack_control, tssi->thermal[RF_PATH_A], tssi->thermal[RF_PATH_B]); -+ -+ if (dm->support_ic_type == ODM_RTL8822C) { -+ for (i = 0; i < c.rf_path_count; i++) -+ thermal_value[i] = (u8)odm_get_rf_reg(dm, i, c.thermal_reg_addr, 0x7e); /* 0x42: RF Reg[6:1] Thermal Trim*/ -+ } else { -+ for (i = 0; i < c.rf_path_count; i++) { -+ thermal_value[i] = (u8)odm_get_rf_reg(dm, i, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ -+ -+ if (dm->support_ic_type == ODM_RTL8814B) { -+ thermal_value_temp[i] = (s8)thermal_value[i] + phydm_get_multi_thermal_offset(dm, i); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "thermal_value_temp[%d](%d) = thermal_value[%d](%d) + multi_thermal_trim(%d)\n", i, thermal_value_temp[i], i, thermal_value[i], phydm_get_multi_thermal_offset(dm, i)); -+ } else { -+ thermal_value_temp[i] = (s8)thermal_value[i] + phydm_get_thermal_offset(dm); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "thermal_value_temp[%d](%d) = thermal_value[%d](%d) + thermal_trim(%d)\n", i, thermal_value_temp[i], i, thermal_value[i], phydm_get_thermal_offset(dm)); -+ } -+ -+ if (thermal_value_temp[i] > 63) -+ thermal_value[i] = 63; -+ else if (thermal_value_temp[i] < 0) -+ thermal_value[i] = 0; -+ else -+ thermal_value[i] = thermal_value_temp[i]; -+ } -+ } -+ -+ if ((tssi->thermal[RF_PATH_A] == 0xff || tssi->thermal[RF_PATH_B] == 0xff) && -+ cali_info->txpowertrack_control != 3) { -+ for (i = 0; i < c.rf_path_count; i++) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no pg, tssi->thermal[%d] = 0x%x\n", -+ i, tssi->thermal[i]); -+ return; -+ } -+ -+ for (j = 0; j < c.rf_path_count; j++) { -+ cali_info->thermal_value_avg_path[j][cali_info->thermal_value_avg_index_path[j]] = thermal_value[j]; -+ cali_info->thermal_value_avg_index_path[j]++; -+ if (cali_info->thermal_value_avg_index_path[j] == c.average_thermal_num) /*Average times = c.average_thermal_num*/ -+ cali_info->thermal_value_avg_index_path[j] = 0; -+ -+ -+ for (i = 0; i < c.average_thermal_num; i++) { -+ if (cali_info->thermal_value_avg_path[j][i]) { -+ thermal_value_avg[j] += cali_info->thermal_value_avg_path[j][i]; -+ thermal_value_avg_count[j]++; -+ } -+ } -+ -+ if (thermal_value_avg_count[j]) { /* Calculate Average thermal_value after average enough times */ -+ thermal_value[j] = (u8)(thermal_value_avg[j] / thermal_value_avg_count[j]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "AVG Thermal Meter = 0x%X, tssi->thermal[%d] = 0x%x\n", -+ thermal_value[j], j, tssi->thermal[j]); -+ } -+ /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ -+ -+ /* "delta" here is used to determine whether thermal value changes or not. */ -+ delta[j] = (thermal_value[j] > cali_info->thermal_value_path[j]) ? (thermal_value[j] - cali_info->thermal_value_path[j]) : (cali_info->thermal_value_path[j] - thermal_value[j]); -+ delta_LCK = (thermal_value[0] > cali_info->thermal_value_lck) ? (thermal_value[0] - cali_info->thermal_value_lck) : (cali_info->thermal_value_lck - thermal_value[0]); -+ delta_IQK = (thermal_value[0] > cali_info->thermal_value_iqk) ? (thermal_value[0] - cali_info->thermal_value_iqk) : (cali_info->thermal_value_iqk - thermal_value[0]); -+ } -+ -+ /*4 6. If necessary, do LCK.*/ -+ -+ for (i = 0; i < c.rf_path_count; i++) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", i, delta[i], delta_LCK, delta_IQK); -+ -+ /* Wait sacn to do LCK by RF Jenyu*/ -+ if( (*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { -+ /* Delta temperature is equal to or larger than 20 centigrade.*/ -+ if (delta_LCK >= c.threshold_iqk) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); -+ cali_info->thermal_value_lck = thermal_value[RF_PATH_A]; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ if ((!(dm->support_ic_type & ODM_RTL8814A)) && (!(dm->support_ic_type & ODM_RTL8822B))) { -+ if (c.phy_lc_calibrate) -+ (*c.phy_lc_calibrate)(dm); -+ } else -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do not do LCK\n"); -+ } -+ } -+ -+ /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ -+ for (i = 0; i < c.rf_path_count; i++) { -+ if (i == RF_PATH_B) { -+ odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_b, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_b, DELTA_SWINGIDX_SIZE); -+ } else if (i == RF_PATH_C) { -+ odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_c, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_c, DELTA_SWINGIDX_SIZE); -+ } else if (i == RF_PATH_D) { -+ odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_d, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_d, DELTA_SWINGIDX_SIZE); -+ } else { -+ odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_a, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_a, DELTA_SWINGIDX_SIZE); -+ } -+ -+ cali_info->delta_power_index_last[i] = cali_info->delta_power_index[i]; /*recording poer index offset*/ -+ delta[i] = thermal_value[i] > tssi->thermal[i] ? (thermal_value[i] - tssi->thermal[i]) : (tssi->thermal[i] - thermal_value[i]); -+ -+ if (delta[i] >= TXPWR_TRACK_TABLE_SIZE) -+ delta[i] = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ if (thermal_value[i] > tssi->thermal[i]) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tup[delta[i]], i); -+ -+ cali_info->delta_power_index[i] = delta_swing_table_idx_tup[delta[i]]; -+ cali_info->absolute_ofdm_swing_idx[i] = delta_swing_table_idx_tup[delta[i]]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tdown[delta[i]], i); -+ cali_info->delta_power_index[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; -+ cali_info->absolute_ofdm_swing_idx[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); -+ } -+ } -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ if (cali_info->delta_power_index[p] == cali_info->delta_power_index_last[p]) /*If Thermal value changes but lookup table value still the same*/ -+ cali_info->power_index_offset[p] = 0; -+ else -+ cali_info->power_index_offset[p] = cali_info->delta_power_index[p] - cali_info->delta_power_index_last[p]; /*Power index diff between 2 times Power Tracking*/ -+ } -+ -+#if 0 -+ if (dm->support_ic_type == ODM_RTL8822C) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, 0); -+ } -+#endif -+ if (*dm->mp_mode == 1) { -+ if (cali_info->txpowertrack_control == 1) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ tracking_method = MIX_MODE; -+ } else if (cali_info->txpowertrack_control == 3) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking TSSI_MODE**********\n"); -+ tracking_method = TSSI_MODE; -+ } -+ } else { -+ if (rf->power_track_type >= 0 && rf->power_track_type <= 3) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ tracking_method = MIX_MODE; -+ } else if (rf->power_track_type >= 4 && rf->power_track_type <= 7) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking TSSI_MODE**********\n"); -+ tracking_method = TSSI_MODE; -+ } -+ } -+ -+ if (dm->support_ic_type == ODM_RTL8822C || dm->support_ic_type == ODM_RTL8814B) -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, tracking_method, p, 0); -+ -+ /* Wait sacn to do IQK by RF Jenyu*/ -+ if ((*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden) && (dm->is_linked || *dm->mp_mode)) { -+ /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ -+ if (delta_IQK >= c.threshold_iqk) { -+ cali_info->thermal_value_iqk = thermal_value[RF_PATH_A]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); -+ /*if (!cali_info->is_iqk_in_progress)*/ -+ /* (*c.do_iqk)(dm, delta_IQK, thermal_value[RF_PATH_A], 8);*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do IQK\n"); -+ -+ /*if (!cali_info->is_iqk_in_progress)*/ -+ /* (*c.do_tssi_dck)(dm, true);*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do TSSI DCK\n"); -+ } -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===%s\n", __func__); -+ -+ cali_info->tx_powercount = 0; -+} -+#endif -+ -+/*@3============================================================ -+ * 3 IQ Calibration -+ * 3============================================================ -+ */ -+ -+void odm_reset_iqk_result(void *dm_void) -+{ -+} -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+u8 odm_get_right_chnl_place_for_iqk(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; -+} -+#endif -+ -+void odm_iq_calibrate(struct dm_struct *dm) -+{ -+ void *adapter = dm->adapter; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*dm->is_fcs_mode_enable) -+ return; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ if (IS_HARDWARE_TYPE_8812AU(adapter)) -+ return; -+#endif -+ -+ if (dm->is_linked && !iqk_info->rfk_forbidden) { -+ if ((*dm->channel != dm->pre_channel) && -+ (!*dm->is_scan_in_process)) { -+ dm->pre_channel = *dm->channel; -+ dm->linked_interval = 0; -+ } -+ -+ if (dm->linked_interval < 3) -+ dm->linked_interval++; -+ -+ if (dm->linked_interval == 2) -+ halrf_iqk_trigger(dm, false); -+ } else { -+ dm->linked_interval = 0; -+ } -+} -+ -+void phydm_rf_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_txpowertracking_init(dm); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ odm_clear_txpowertracking_state(dm); -+#endif -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814A) -+ phy_iq_calibrate_8814a_init(dm); -+#endif -+#endif -+} -+ -+void phydm_rf_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ odm_txpowertracking_check(dm); -+#if 0 -+/*if (dm->support_ic_type & ODM_IC_11AC_SERIES)*/ -+/*odm_iq_calibrate(dm);*/ -+#endif -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ce.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ce.h -new file mode 100644 -index 000000000..dcded1e0a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_ce.h -@@ -0,0 +1,123 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALPHYRF_H__ -+#define __HALPHYRF_H__ -+ -+#include "halrf/halrf_kfree.h" -+#if (RTL8814A_SUPPORT == 1) -+#include "halrf/rtl8814a/halrf_iqk_8814a.h" -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+#include "halrf/rtl8822b/halrf_iqk_8822b.h" -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+#include "halrf/rtl8821c/halrf_iqk_8821c.h" -+#endif -+ -+#if (RTL8195B_SUPPORT == 1) -+/* #include "halrf/rtl8195b/halrf.h" */ -+#include "halrf/rtl8195b/halrf_iqk_8195b.h" -+#include "halrf/rtl8195b/halrf_txgapk_8195b.h" -+#include "halrf/rtl8195b/halrf_dpk_8195b.h" -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ #include "halrf/rtl8814b/halrf_iqk_8814b.h" -+ #include "halrf/rtl8814b/halrf_dpk_8814b.h" -+ #include "halrf/rtl8814b/halrf_txgapk_8814b.h" -+#endif -+ -+#include "halrf/halrf_powertracking_ce.h" -+ -+enum spur_cal_method { -+ PLL_RESET, -+ AFE_PHASE_SEL -+}; -+ -+enum pwrtrack_method { -+ BBSWING, -+ TXAGC, -+ MIX_MODE, -+ TSSI_MODE, -+ MIX_2G_TSSI_5G_MODE, -+ MIX_5G_TSSI_2G_MODE, -+ CLEAN_MODE -+}; -+ -+typedef void (*func_set_pwr)(void *, enum pwrtrack_method, u8, u8); -+typedef void (*func_iqk)(void *, u8, u8, u8); -+typedef void (*func_lck)(void *); -+typedef void (*func_tssi_dck)(void *, u8); -+typedef void (*func_swing)(void *, u8 **, u8 **, u8 **, u8 **); -+typedef void (*func_swing8814only)(void *, u8 **, u8 **, u8 **, u8 **); -+typedef void (*func_swing_xtal)(void *, s8 **, s8 **); -+typedef void (*func_set_xtal)(void *); -+ -+struct txpwrtrack_cfg { -+ u8 swing_table_size_cck; -+ u8 swing_table_size_ofdm; -+ u8 threshold_iqk; -+ u8 threshold_dpk; -+ u8 average_thermal_num; -+ u8 rf_path_count; -+ u32 thermal_reg_addr; -+ func_set_pwr odm_tx_pwr_track_set_pwr; -+ func_iqk do_iqk; -+ func_lck phy_lc_calibrate; -+ func_tssi_dck do_tssi_dck; -+ func_swing get_delta_swing_table; -+ func_swing8814only get_delta_swing_table8814only; -+ func_swing_xtal get_delta_swing_xtal_table; -+ func_set_xtal odm_txxtaltrack_set_xtal; -+}; -+ -+void configure_txpower_track(void *dm_void, struct txpwrtrack_cfg *config); -+ -+void odm_clear_txpowertracking_state(void *dm_void); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+void odm_txpowertracking_callback_thermal_meter(void *dm_void); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+void odm_txpowertracking_callback_thermal_meter(void *dm); -+#else -+void odm_txpowertracking_callback_thermal_meter(void *adapter); -+#endif -+ -+#if (RTL8822C_SUPPORT == 1 || RTL8814B_SUPPORT == 1) -+void odm_txpowertracking_new_callback_thermal_meter(void *dm_void); -+#endif -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+void odm_reset_iqk_result(void *dm_void); -+u8 odm_get_right_chnl_place_for_iqk(u8 chnl); -+ -+void phydm_rf_init(void *dm_void); -+void phydm_rf_watchdog(void *dm_void); -+ -+#endif /*__HALPHYRF_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_iot.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_iot.c -new file mode 100644 -index 000000000..b87d5e971 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_iot.c -@@ -0,0 +1,663 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _delta_thermal) \ -+ do {\ -+ for (_offset = 0; _offset < _size; _offset++) { \ -+ if (_delta_thermal < thermal_threshold[_direction][_offset]) { \ -+ if (_offset != 0)\ -+ _offset--;\ -+ break;\ -+ } \ -+ } \ -+ if (_offset >= _size)\ -+ _offset = _size-1;\ -+ } while (0) -+ -+void configure_txpower_track( -+ void *dm_void, -+ struct txpwrtrack_cfg *config -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if RTL8195B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8195B) -+ configure_txpower_track_8195b(config); -+#endif -+#if RTL8710C_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8710C) -+ configure_txpower_track_8710c(config); -+#endif -+#if RTL8721D_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8721D) -+ configure_txpower_track_8721d(config); -+#endif -+ -+} -+ -+/* ********************************************************************** -+ * <20121113, Kordan> This function should be called when tx_agc 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_clear_txpowertracking_state( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u8 p = 0; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ -+ cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; -+ cali_info->bb_swing_idx_cck = cali_info->default_cck_index; -+ dm->rf_calibrate_info.CCK_index = 0; -+ -+ for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { -+ cali_info->bb_swing_idx_ofdm_base[p] = cali_info->default_ofdm_index; -+ cali_info->bb_swing_idx_ofdm[p] = cali_info->default_ofdm_index; -+ cali_info->OFDM_index[p] = cali_info->default_ofdm_index; -+ -+ cali_info->power_index_offset[p] = 0; -+ cali_info->delta_power_index[p] = 0; -+ cali_info->delta_power_index_last[p] = 0; -+ -+ cali_info->absolute_ofdm_swing_idx[p] = 0; -+ cali_info->remnant_ofdm_swing_idx[p] = 0; -+ cali_info->kfree_offset[p] = 0; -+ } -+ -+ cali_info->modify_tx_agc_flag_path_a = false; -+ cali_info->modify_tx_agc_flag_path_b = false; -+ cali_info->modify_tx_agc_flag_path_c = false; -+ cali_info->modify_tx_agc_flag_path_d = false; -+ cali_info->remnant_cck_swing_idx = 0; -+ cali_info->thermal_value = rf->eeprom_thermal; -+ cali_info->modify_tx_agc_value_cck = 0; -+ cali_info->modify_tx_agc_value_ofdm = 0; -+} -+ -+void -+odm_txpowertracking_callback_thermal_meter( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ u8 thermal_value = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; -+ u8 thermal_value_avg_count = 0; -+ u32 thermal_value_avg = 0, regc80, regcd0, regcd4, regab4; -+ -+ u8 OFDM_min_index = 0; /* OFDM BB Swing should be less than +3.0dB, which is required by Arthur */ -+ u8 indexforchannel = 0; /* get_right_chnl_place_for_iqk(hal_data->current_channel) */ -+ u8 power_tracking_type = rf->pwt_type; -+ u8 xtal_offset_eanble = 0; -+ s8 thermal_value_temp = 0; -+ u8 xtal_track_efuse = 0; -+ -+ struct txpwrtrack_cfg c = {0}; -+ -+ /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */ -+ u8 *delta_swing_table_idx_tup_a = NULL; -+ u8 *delta_swing_table_idx_tdown_a = NULL; -+ u8 *delta_swing_table_idx_tup_b = NULL; -+ u8 *delta_swing_table_idx_tdown_b = NULL; -+#if (RTL8721D_SUPPORT == 1) -+ u8 *delta_swing_table_idx_tup_a_cck = NULL; -+ u8 *delta_swing_table_idx_tdown_a_cck = NULL; -+ u8 *delta_swing_table_idx_tup_b_cck = NULL; -+ u8 *delta_swing_table_idx_tdown_b_cck = NULL; -+#endif -+ /*for Xtal Offset by James.Tung*/ -+ s8 *delta_swing_table_xtal_up = NULL; -+ s8 *delta_swing_table_xtal_down = NULL; -+ -+ /* 4 2. Initialization ( 7 steps in total ) */ -+ indexforchannel = odm_get_right_chnl_place_for_iqk(*dm->channel); -+ configure_txpower_track(dm, &c); -+#if (RTL8721D_SUPPORT == 1) -+ (*c.get_delta_swing_table)(dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a, -+ (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b, -+ (u8 **)&delta_swing_table_idx_tup_a_cck, (u8 **)&delta_swing_table_idx_tdown_a_cck, -+ (u8 **)&delta_swing_table_idx_tup_b_cck, (u8 **)&delta_swing_table_idx_tdown_b_cck); -+#else -+ (*c.get_delta_swing_table)(dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a, -+ (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b); -+#endif -+ -+ /*for Xtal Offset*/ -+ odm_efuse_one_byte_read(dm, 0xf7, &xtal_track_efuse, false); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Read efuse 0xf7=0x%x\n", xtal_track_efuse); -+ xtal_track_efuse = xtal_track_efuse & 0x3; -+ if (dm->support_ic_type == ODM_RTL8195B || -+ dm->support_ic_type == ODM_RTL8721D || -+ (dm->support_ic_type == ODM_RTL8710C && xtal_track_efuse == 0x2)) -+ (*c.get_delta_swing_xtal_table)(dm, -+ (s8 **)&delta_swing_table_xtal_up, -+ (s8 **)&delta_swing_table_xtal_down); -+ -+ cali_info->txpowertracking_callback_cnt++; /*cosa add for debug*/ -+ cali_info->is_txpowertracking_init = true; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "===>odm_txpowertracking_callback_thermal_meter\n cali_info->bb_swing_idx_cck_base: %d, cali_info->bb_swing_idx_ofdm_base[A]: %d, cali_info->default_ofdm_index: %d\n", -+ cali_info->bb_swing_idx_cck_base, -+ cali_info->bb_swing_idx_ofdm_base[RF_PATH_A], -+ cali_info->default_ofdm_index); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->txpowertrack_control = %d, hal_data->eeprom_thermal_meter %d\n", -+ cali_info->txpowertrack_control, rf->eeprom_thermal); -+ -+ if (dm->support_ic_type == ODM_RTL8721D -+ || dm->support_ic_type == ODM_RTL8710C) -+ thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, -+ c.thermal_reg_addr, 0x7e0); -+ /* 0x42: RF Reg[10:5] 8721D */ -+ else -+ thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, -+ c.thermal_reg_addr, 0xfc00); -+ /* 0x42: RF Reg[15:10] 88E */ -+ -+ thermal_value_temp = thermal_value + phydm_get_thermal_offset(dm); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "thermal_value_temp(%d) = thermal_value(%d) + power_trim_thermal(%d)\n", thermal_value_temp, thermal_value, phydm_get_thermal_offset(dm)); -+ -+ if (thermal_value_temp > 63) -+ thermal_value = 63; -+ else if (thermal_value_temp < 0) -+ thermal_value = 0; -+ else -+ thermal_value = thermal_value_temp; -+ -+ if (!cali_info->txpowertrack_control) -+ return; -+ -+ if (rf->eeprom_thermal == 0xff) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no pg, hal_data->eeprom_thermal_meter = 0x%x\n", rf->eeprom_thermal); -+ return; -+ } -+#if 0 -+ /*4 3. Initialize ThermalValues of rf_calibrate_info*/ -+ //if (cali_info->is_reloadtxpowerindex) -+ // RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "reload ofdm index for band switch\n"); -+#endif -+ /*4 4. Calculate average thermal meter*/ -+ -+ cali_info->thermal_value_avg[cali_info->thermal_value_avg_index] = thermal_value; -+ cali_info->thermal_value_avg_index++; -+ if (cali_info->thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/ -+ cali_info->thermal_value_avg_index = 0; -+ -+ for (i = 0; i < c.average_thermal_num; i++) { -+ if (cali_info->thermal_value_avg[i]) { -+ thermal_value_avg += cali_info->thermal_value_avg[i]; -+ thermal_value_avg_count++; -+ } -+ } -+ -+ if (thermal_value_avg_count) { /* Calculate Average thermal_value after average enough times */ -+ thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count); -+ cali_info->thermal_value_delta = thermal_value - rf->eeprom_thermal; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "AVG Thermal Meter = 0x%X, EFUSE Thermal base = 0x%X\n", thermal_value, rf->eeprom_thermal); -+ } -+ -+ /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ -+ /* "delta" here is used to determine whether thermal value changes or not. */ -+ delta = (thermal_value > cali_info->thermal_value) ? (thermal_value - cali_info->thermal_value) : (cali_info->thermal_value - thermal_value); -+ delta_LCK = (thermal_value > cali_info->thermal_value_lck) ? (thermal_value - cali_info->thermal_value_lck) : (cali_info->thermal_value_lck - thermal_value); -+ delta_IQK = (thermal_value > cali_info->thermal_value_iqk) ? (thermal_value - cali_info->thermal_value_iqk) : (cali_info->thermal_value_iqk - thermal_value); -+ -+ /*4 6. If necessary, do LCK.*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK); -+ -+ /* Wait sacn to do LCK by RF Jenyu*/ -+ if ((!*dm->is_scan_in_process) && !iqk_info->rfk_forbidden && -+ (!*dm->is_tdma)) { -+ /* Delta temperature is equal to or larger than 20 centigrade.*/ -+ if (delta_LCK >= c.threshold_iqk) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); -+ cali_info->thermal_value_lck = thermal_value; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ (*c.phy_lc_calibrate)(dm); -+ } -+ } -+ -+ /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ -+ if (delta > 0 && cali_info->txpowertrack_control) { -+ /* "delta" here is used to record the absolute value of difference. */ -+ delta = thermal_value > rf->eeprom_thermal ? (thermal_value - rf->eeprom_thermal) : (rf->eeprom_thermal - thermal_value); -+ -+ if (delta >= TXPWR_TRACK_TABLE_SIZE) -+ delta = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ /*4 7.1 The Final Power index = BaseIndex + power_index_offset*/ -+ if (thermal_value > rf->eeprom_thermal) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ cali_info->delta_power_index_last[p] = cali_info->delta_power_index[p]; /*recording poer index offset*/ -+ switch (p) { -+ case RF_PATH_B: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta]); -+#if (RTL8721D_SUPPORT == 1) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup_b_cck[%d] = %d\n", delta, delta_swing_table_idx_tup_b_cck[delta]); -+ -+ cali_info->absolute_cck_swing_idx[p] = delta_swing_table_idx_tup_b_cck[delta]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_cck_swing_idx[RF_PATH_B] = %d\n", -+ cali_info->absolute_cck_swing_idx[p]); -+#endif -+ cali_info->delta_power_index[p] = -+ delta_swing_table_idx_tup_b -+ [delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -+ delta_swing_table_idx_tup_b -+ [delta]; -+ /*Record delta swing for mix mode*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ default: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta]); -+#if (RTL8721D_SUPPORT == 1) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup_a_cck[%d] = %d\n", delta, delta_swing_table_idx_tup_a_cck[delta]); -+ -+ cali_info->absolute_cck_swing_idx[p] = delta_swing_table_idx_tup_a_cck[delta]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_cck_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_cck_swing_idx[p]); -+#endif -+ cali_info->delta_power_index[p] = delta_swing_table_idx_tup_a[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -+ delta_swing_table_idx_tup_a[delta]; -+ /*Record delta swing*/ -+ /*for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ } -+ } -+ /* JJ ADD 20161014 */ -+ if (dm->support_ic_type == ODM_RTL8195B || -+ dm->support_ic_type == ODM_RTL8721D || -+ (dm->support_ic_type == ODM_RTL8710C && xtal_track_efuse == 0x2)) { -+ /*Save xtal_offset from Xtal table*/ -+ cali_info->xtal_offset_last = cali_info->xtal_offset; /*recording last Xtal offset*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[Xtal] delta_swing_table_xtal_up[%d] = %d\n", delta, delta_swing_table_xtal_up[delta]); -+ cali_info->xtal_offset = delta_swing_table_xtal_up[delta]; -+ xtal_offset_eanble = (cali_info->xtal_offset_last != cali_info->xtal_offset); -+ } -+ -+ } else { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ cali_info->delta_power_index_last[p] = cali_info->delta_power_index[p]; /*recording poer index offset*/ -+ -+ switch (p) { -+ case RF_PATH_B: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta]); -+#if (RTL8721D_SUPPORT == 1) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown_b_cck[%d] = %d\n", delta, delta_swing_table_idx_tdown_b_cck[delta]); -+ -+ cali_info->absolute_cck_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b_cck[delta]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_cck_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_cck_swing_idx[p]); -+#endif -+ cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_b[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ default: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta]); -+#if (RTL8721D_SUPPORT == 1) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown_a_cck[%d] = %d\n", delta, delta_swing_table_idx_tdown_a_cck[delta]); -+ -+ cali_info->absolute_cck_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a_cck[delta]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_cck_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_cck_swing_idx[p]); -+#endif -+ cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_a[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ } -+ } -+ /* JJ ADD 20161014 */ -+ -+ if (dm->support_ic_type == ODM_RTL8195B || -+ dm->support_ic_type == ODM_RTL8721D || -+ (dm->support_ic_type == ODM_RTL8710C && xtal_track_efuse == 0x2)) { -+ /*Save xtal_offset from Xtal table*/ -+ cali_info->xtal_offset_last = cali_info->xtal_offset; /*recording last Xtal offset*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[Xtal] delta_swing_table_xtal_down[%d] = %d\n", delta, delta_swing_table_xtal_down[delta]); -+ cali_info->xtal_offset = delta_swing_table_xtal_down[delta]; -+ xtal_offset_eanble = (cali_info->xtal_offset_last != cali_info->xtal_offset); -+ } -+ } -+#if 0 -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "\n\n=========================== [path-%d] Calculating power_index_offset===========================\n", p); -+ -+ if (cali_info->delta_power_index[p] == cali_info->delta_power_index_last[p]) /*If Thermal value changes but lookup table value still the same*/ -+ cali_info->power_index_offset[p] = 0; -+ else -+ cali_info->power_index_offset[p] = cali_info->delta_power_index[p] - cali_info->delta_power_index_last[p]; /*Power index diff between 2 times Power Tracking*/ -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[path-%d] power_index_offset(%d) = delta_power_index(%d) - delta_power_index_last(%d)\n", p, cali_info->power_index_offset[p], cali_info->delta_power_index[p], cali_info->delta_power_index_last[p]); -+ -+ cali_info->OFDM_index[p] = cali_info->bb_swing_idx_ofdm_base[p] + cali_info->power_index_offset[p]; -+ cali_info->CCK_index = cali_info->bb_swing_idx_cck_base + cali_info->power_index_offset[p]; -+ -+ cali_info->bb_swing_idx_cck = cali_info->CCK_index; -+ cali_info->bb_swing_idx_ofdm[p] = cali_info->OFDM_index[p]; -+ -+ /*************Print BB Swing base and index Offset*************/ -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_cck, cali_info->bb_swing_idx_cck_base, cali_info->power_index_offset[p]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "The 'OFDM' final index(%d) = BaseIndex[%d](%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_ofdm[p], p, cali_info->bb_swing_idx_ofdm_base[p], cali_info->power_index_offset[p]); -+ -+ /*4 7.1 Handle boundary conditions of index.*/ -+ -+ if (cali_info->OFDM_index[p] > c.swing_table_size_ofdm - 1) -+ cali_info->OFDM_index[p] = c.swing_table_size_ofdm - 1; -+ else if (cali_info->OFDM_index[p] <= OFDM_min_index) -+ cali_info->OFDM_index[p] = OFDM_min_index; -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "\n\n========================================================================================================\n"); -+ -+ if (cali_info->CCK_index > c.swing_table_size_cck - 1) -+ cali_info->CCK_index = c.swing_table_size_cck - 1; -+ else if (cali_info->CCK_index <= 0) -+ cali_info->CCK_index = 0; -+#endif -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "The thermal meter is unchanged or TxPowerTracking OFF(%d): thermal_value: %d, cali_info->thermal_value: %d\n", -+ cali_info->txpowertrack_control, thermal_value, cali_info->thermal_value); -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ cali_info->power_index_offset[p] = 0; -+ } -+#if 0 -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", -+ cali_info->CCK_index, cali_info->bb_swing_idx_cck_base); /*Print Swing base & current*/ -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index[%d]: %d\n", -+ cali_info->OFDM_index[p], p, cali_info->bb_swing_idx_ofdm_base[p]); -+ } -+#endif -+ -+#if (RTL8721D_SUPPORT == 1) -+ if (thermal_value != cali_info->thermal_value) { -+ if (thermal_value > rf->eeprom_thermal) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) higher than PG value(%d)\n", -+ thermal_value, rf->eeprom_thermal); -+ else if (thermal_value < rf->eeprom_thermal) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) lower than PG value(%d)\n", -+ thermal_value, rf->eeprom_thermal); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "**********Enter POWER Tracking MIX_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ -+ /*Record last time Power Tracking result as base.*/ -+ cali_info->bb_swing_idx_cck_base = cali_info->bb_swing_idx_cck; -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ cali_info->bb_swing_idx_ofdm_base[p] = -+ cali_info->bb_swing_idx_ofdm[p]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->thermal_value = %d thermal_value= %d\n", -+ cali_info->thermal_value, thermal_value); -+ /*Record last Power Tracking Thermal value*/ -+ cali_info->thermal_value = thermal_value; -+ } -+ -+#else -+ if (thermal_value > rf->eeprom_thermal) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) higher than PG value(%d)\n", thermal_value, rf->eeprom_thermal); -+ -+ if (dm->support_ic_type == ODM_RTL8188E || -+ dm->support_ic_type == ODM_RTL8192E || -+ dm->support_ic_type == ODM_RTL8821 || -+ dm->support_ic_type == ODM_RTL8812 || -+ dm->support_ic_type == ODM_RTL8723B || -+ dm->support_ic_type == ODM_RTL8814A || -+ dm->support_ic_type == ODM_RTL8703B || -+ dm->support_ic_type == ODM_RTL8188F || -+ dm->support_ic_type == ODM_RTL8822B || -+ dm->support_ic_type == ODM_RTL8723D || -+ dm->support_ic_type == ODM_RTL8821C || -+ dm->support_ic_type == ODM_RTL8710B || -+ dm->support_ic_type == ODM_RTL8192F || -+ dm->support_ic_type == ODM_RTL8195B || -+ dm->support_ic_type == ODM_RTL8710C){ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, indexforchannel); -+ } -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) lower than PG value(%d)\n", thermal_value, rf->eeprom_thermal); -+ -+ if (dm->support_ic_type == ODM_RTL8188E || -+ dm->support_ic_type == ODM_RTL8192E || -+ dm->support_ic_type == ODM_RTL8821 || -+ dm->support_ic_type == ODM_RTL8812 || -+ dm->support_ic_type == ODM_RTL8723B || -+ dm->support_ic_type == ODM_RTL8814A || -+ dm->support_ic_type == ODM_RTL8703B || -+ dm->support_ic_type == ODM_RTL8188F || -+ dm->support_ic_type == ODM_RTL8822B || -+ dm->support_ic_type == ODM_RTL8723D || -+ dm->support_ic_type == ODM_RTL8821C || -+ dm->support_ic_type == ODM_RTL8710B || -+ dm->support_ic_type == ODM_RTL8192F || -+ dm->support_ic_type == ODM_RTL8195B || -+ dm->support_ic_type == ODM_RTL8710C) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, indexforchannel); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, indexforchannel); -+ } -+ -+ cali_info->bb_swing_idx_cck_base = cali_info->bb_swing_idx_cck; /*Record last time Power Tracking result as base.*/ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ cali_info->bb_swing_idx_ofdm_base[p] = cali_info->bb_swing_idx_ofdm[p]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->thermal_value = %d thermal_value= %d\n", cali_info->thermal_value, thermal_value); -+ -+ cali_info->thermal_value = thermal_value; /*Record last Power Tracking Thermal value*/ -+ } -+#endif -+ /* JJ ADD 20161014 */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->xtal_offset_last=%d cali_info->xtal_offset=%d\n", -+ cali_info->xtal_offset_last, cali_info->xtal_offset); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "xtal_offset_eanble=%d cali_info->txpowertrack_control=%d rf->eeprom_thermal=%d xtal_track_efuse=%d\n", -+ xtal_offset_eanble, cali_info->txpowertrack_control, rf->eeprom_thermal, xtal_track_efuse); -+ -+ if (dm->support_ic_type == ODM_RTL8195B || -+ dm->support_ic_type == ODM_RTL8721D || -+ (dm->support_ic_type == ODM_RTL8710C && xtal_track_efuse == 0x2)) { -+ if (xtal_offset_eanble != 0 && cali_info->txpowertrack_control && (rf->eeprom_thermal != 0xff)) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter Xtal Tracking**********\n"); -+ -+ if (thermal_value > rf->eeprom_thermal) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) higher than PG value(%d)\n", thermal_value, rf->eeprom_thermal); -+ (*c.odm_txxtaltrack_set_xtal)(dm); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) lower than PG value(%d)\n", thermal_value, rf->eeprom_thermal); -+ (*c.odm_txxtaltrack_set_xtal)(dm); -+ } -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********End Xtal Tracking**********\n"); -+ } -+ } -+#if (!RTL8721D_SUPPORT) -+ /* Wait sacn to do IQK by RF Jenyu*/ -+ if ((!*dm->is_scan_in_process) && (!iqk_info->rfk_forbidden) && (dm->is_linked || *dm->mp_mode)) { -+ /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ -+ if (delta_IQK >= c.threshold_iqk) { -+ cali_info->thermal_value_iqk = thermal_value; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); -+ if (!cali_info->is_iqk_in_progress) -+ (*c.do_iqk)(dm, delta_IQK, thermal_value, 8); -+ } -+ } -+#endif -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===odm_txpowertracking_callback_thermal_meter\n"); -+ -+ cali_info->tx_powercount = 0; -+} -+ -+/* 3============================================================ -+ * 3 IQ Calibration -+ * 3============================================================ -+ */ -+ -+void -+odm_reset_iqk_result( -+ void *dm_void -+) -+{ -+ return; -+} -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+u8 odm_get_right_chnl_place_for_iqk(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; -+} -+#endif -+ -+void -+odm_rf_calibrate(struct dm_struct *dm) -+{ -+#if (RTL8721D_SUPPORT == 1) -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if (dm->is_linked && !iqk_info->rfk_forbidden) { -+ if ((*dm->channel != dm->pre_channel) && -+ (!*dm->is_scan_in_process)) { -+ dm->pre_channel = *dm->channel; -+ dm->linked_interval = 0; -+ } -+ -+ if (dm->linked_interval < 3) -+ dm->linked_interval++; -+ -+ if (dm->linked_interval == 2) -+ halrf_rf_k_connect_trigger(dm, 0, SEGMENT_FREE); -+ } else { -+ dm->linked_interval = 0; -+ } -+#endif -+} -+ -+void phydm_rf_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_txpowertracking_init(dm); -+ -+ odm_clear_txpowertracking_state(dm); -+} -+ -+void phydm_rf_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_txpowertracking_check(dm); -+#if (RTL8721D_SUPPORT == 1) -+ odm_rf_calibrate(dm); -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_iot.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_iot.h -new file mode 100644 -index 000000000..8d4395a1f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_iot.h -@@ -0,0 +1,137 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALPHYRF_H__ -+#define __HALPHYRF_H__ -+ -+#include "halrf/halrf_kfree.h" -+ -+#if (RTL8821C_SUPPORT == 1) -+ #include "halrf/rtl8821c/halrf_iqk_8821c.h" -+#endif -+ -+#if (RTL8195B_SUPPORT == 1) -+// #include "halrf/rtl8195b/halrf.h" -+ #include "halrf/rtl8195b/halrf_iqk_8195b.h" -+ #include "halrf/rtl8195b/halrf_txgapk_8195b.h" -+ #include "halrf/rtl8195b/halrf_dpk_8195b.h" -+#endif -+ -+#if (RTL8710C_SUPPORT == 1) -+// #include "halrf/rtl8710c/halrf.h" -+ #include "halrf/rtl8710c/halrf_iqk_8710c.h" -+// #include "halrf/rtl8710c/halrf_txgapk_8710c.h" -+// #include "halrf/rtl8710c/halrf_dpk_8710c.h" -+#endif -+ -+#include "halrf/halrf_powertracking_iot.h" -+ -+ -+enum spur_cal_method { -+ PLL_RESET, -+ AFE_PHASE_SEL -+}; -+ -+enum pwrtrack_method { -+ BBSWING, -+ TXAGC, -+ MIX_MODE, -+ TSSI_MODE, -+ MIX_2G_TSSI_5G_MODE, -+ MIX_5G_TSSI_2G_MODE, -+ CLEAN_MODE -+}; -+ -+typedef void (*func_set_pwr)(void *, enum pwrtrack_method, u8, u8); -+typedef void(*func_iqk)(void *, u8, u8, u8); -+typedef void (*func_lck)(void *); -+#if (RTL8721D_SUPPORT == 1) -+ typedef void (*func_swing)(void *, u8 **, u8 **, u8 **, u8 **, -+ u8 **, u8 **, u8 **, u8 **); -+#else -+ typedef void (*func_swing)(void *, u8 **, u8 **, u8 **, u8 **); -+#endif -+typedef void (*func_swing8814only)(void *, u8 **, u8 **, u8 **, u8 **); -+typedef void(*func_swing_xtal)(void *, s8 **, s8 **); -+typedef void(*func_set_xtal)(void *); -+ -+struct txpwrtrack_cfg { -+ u8 swing_table_size_cck; -+ u8 swing_table_size_ofdm; -+ u8 threshold_iqk; -+ u8 threshold_dpk; -+ u8 average_thermal_num; -+ u8 rf_path_count; -+ u32 thermal_reg_addr; -+ func_set_pwr odm_tx_pwr_track_set_pwr; -+ func_iqk do_iqk; -+ func_lck phy_lc_calibrate; -+ func_swing get_delta_swing_table; -+ func_swing8814only get_delta_swing_table8814only; -+ func_swing_xtal get_delta_swing_xtal_table; -+ func_set_xtal odm_txxtaltrack_set_xtal; -+}; -+ -+void -+configure_txpower_track( -+ void *dm_void, -+ struct txpwrtrack_cfg *config -+); -+ -+ -+void -+odm_clear_txpowertracking_state( -+ void *dm_void -+); -+ -+void -+odm_txpowertracking_callback_thermal_meter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ void *dm_void -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ void *dm -+#else -+ void *adapter -+#endif -+); -+ -+ -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+ -+void -+odm_reset_iqk_result( -+ void *dm_void -+); -+u8 -+odm_get_right_chnl_place_for_iqk( -+ u8 chnl -+); -+ -+void phydm_rf_init(void *dm_void); -+void phydm_rf_watchdog(void *dm_void); -+ -+#endif /*#ifndef __HALPHYRF_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_win.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_win.c -new file mode 100644 -index 000000000..3f7778f99 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_win.c -@@ -0,0 +1,1119 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "phydm_precomp.h" -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _delta_thermal) \ -+ do {\ -+ for (_offset = 0; _offset < _size; _offset++) { \ -+ \ -+ if (_delta_thermal < thermal_threshold[_direction][_offset]) { \ -+ \ -+ if (_offset != 0)\ -+ _offset--;\ -+ break;\ -+ } \ -+ } \ -+ if (_offset >= _size)\ -+ _offset = _size-1;\ -+ } while (0) -+ -+void configure_txpower_track( -+ struct dm_struct *dm, -+ struct txpwrtrack_cfg *config -+) -+{ -+#if RTL8192E_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8192E) -+ configure_txpower_track_8192e(config); -+#endif -+#if RTL8821A_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8821) -+ configure_txpower_track_8821a(config); -+#endif -+#if RTL8812A_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8812) -+ configure_txpower_track_8812a(config); -+#endif -+#if RTL8188E_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8188E) -+ configure_txpower_track_8188e(config); -+#endif -+ -+#if RTL8188F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8188F) -+ configure_txpower_track_8188f(config); -+#endif -+ -+#if RTL8723B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8723B) -+ configure_txpower_track_8723b(config); -+#endif -+ -+#if RTL8814A_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8814A) -+ configure_txpower_track_8814a(config); -+#endif -+ -+#if RTL8703B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8703B) -+ configure_txpower_track_8703b(config); -+#endif -+ -+#if RTL8822B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8822B) -+ configure_txpower_track_8822b(config); -+#endif -+ -+#if RTL8723D_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8723D) -+ configure_txpower_track_8723d(config); -+#endif -+ -+/* JJ ADD 20161014 */ -+#if RTL8710B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8710B) -+ configure_txpower_track_8710b(config); -+#endif -+ -+#if RTL8821C_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8821C) -+ configure_txpower_track_8821c(config); -+#endif -+ -+#if RTL8192F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8192F) -+ configure_txpower_track_8192f(config); -+#endif -+ -+#if RTL8822C_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8822C) -+ configure_txpower_track_8822c(config); -+#endif -+ -+#if RTL8814B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8814B) -+ configure_txpower_track_8814b(config); -+#endif -+ -+#if RTL8723F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8723F) -+ configure_txpower_track_8723f(config); -+#endif -+ -+#if RTL8814C_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8814C) -+ configure_txpower_track_8814c(config); -+#endif -+ -+ -+} -+ -+/* ********************************************************************** -+ * <20121113, Kordan> This function should be called when tx_agc 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_clear_txpowertracking_state( -+ struct dm_struct *dm -+) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA((PADAPTER)(dm->adapter)); -+ u8 p = 0; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ -+ cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; -+ cali_info->bb_swing_idx_cck = cali_info->default_cck_index; -+ cali_info->CCK_index = 0; -+ -+ for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { -+ cali_info->bb_swing_idx_ofdm_base[p] = cali_info->default_ofdm_index; -+ cali_info->bb_swing_idx_ofdm[p] = cali_info->default_ofdm_index; -+ cali_info->OFDM_index[p] = cali_info->default_ofdm_index; -+ -+ cali_info->power_index_offset[p] = 0; -+ cali_info->delta_power_index[p] = 0; -+ cali_info->delta_power_index_last[p] = 0; -+ -+ cali_info->absolute_ofdm_swing_idx[p] = 0; /* Initial Mix mode power tracking*/ -+ cali_info->remnant_ofdm_swing_idx[p] = 0; -+ cali_info->kfree_offset[p] = 0; -+ } -+ -+ cali_info->modify_tx_agc_flag_path_a = false; /*Initial at Modify Tx Scaling mode*/ -+ cali_info->modify_tx_agc_flag_path_b = false; /*Initial at Modify Tx Scaling mode*/ -+ cali_info->modify_tx_agc_flag_path_c = false; /*Initial at Modify Tx Scaling mode*/ -+ cali_info->modify_tx_agc_flag_path_d = false; /*Initial at Modify Tx Scaling mode*/ -+ cali_info->remnant_cck_swing_idx = 0; -+ cali_info->thermal_value = hal_data->eeprom_thermal_meter; -+ -+ cali_info->modify_tx_agc_value_cck = 0; /* modify by Mingzhi.Guo */ -+ cali_info->modify_tx_agc_value_ofdm = 0; /* modify by Mingzhi.Guo */ -+ -+} -+ -+void -+odm_txpowertracking_callback_thermal_meter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ struct dm_struct *dm -+#else -+ void *adapter -+#endif -+) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ struct dm_struct *dm = &hal_data->odmpriv; -+#endif -+#endif -+ -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ u8 thermal_value = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; -+ s8 diff_DPK[4] = {0}; -+ u8 thermal_value_avg_count = 0; -+ u32 thermal_value_avg = 0, regc80, regcd0, regcd4, regab4, regc88, rege14, reg848,reg838, reg86c; -+ -+ u8 OFDM_min_index = 0; /* OFDM BB Swing should be less than +3.0dB, which is required by Arthur */ -+ u8 indexforchannel = 0; /* get_right_chnl_place_for_iqk(hal_data->current_channel) */ -+ u8 power_tracking_type = hal_data->RfPowerTrackingType; -+ u8 xtal_offset_eanble = 0; -+ s8 thermal_value_temp = 0; -+ -+ struct txpwrtrack_cfg c; -+ -+ /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */ -+ u8 *delta_swing_table_idx_tup_a = NULL; -+ u8 *delta_swing_table_idx_tdown_a = NULL; -+ u8 *delta_swing_table_idx_tup_b = NULL; -+ u8 *delta_swing_table_idx_tdown_b = NULL; -+ /*for 8814 add by Yu Chen*/ -+ u8 *delta_swing_table_idx_tup_c = NULL; -+ u8 *delta_swing_table_idx_tdown_c = NULL; -+ u8 *delta_swing_table_idx_tup_d = NULL; -+ u8 *delta_swing_table_idx_tdown_d = NULL; -+ /*for Xtal Offset by James.Tung*/ -+ s8 *delta_swing_table_xtal_up = NULL; -+ s8 *delta_swing_table_xtal_down = NULL; -+ -+ /* 4 2. Initilization ( 7 steps in total ) */ -+ -+ configure_txpower_track(dm, &c); -+ -+ (*c.get_delta_swing_table)(dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a, -+ (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b); -+ -+ if (dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8814B)) /*for 8814 path C & D*/ -+ (*c.get_delta_swing_table8814only)(dm, (u8 **)&delta_swing_table_idx_tup_c, (u8 **)&delta_swing_table_idx_tdown_c, -+ (u8 **)&delta_swing_table_idx_tup_d, (u8 **)&delta_swing_table_idx_tdown_d); -+ /* JJ ADD 20161014 */ -+ if (dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | ODM_RTL8192F)) /*for Xtal Offset*/ -+ (*c.get_delta_swing_xtal_table)(dm, (s8 **)&delta_swing_table_xtal_up, (s8 **)&delta_swing_table_xtal_down); -+ -+ -+ cali_info->txpowertracking_callback_cnt++; /*cosa add for debug*/ -+ cali_info->is_txpowertracking_init = true; -+ -+ /*cali_info->txpowertrack_control = hal_data->txpowertrack_control; -+ We should keep updating the control variable according to HalData. -+ rf_calibrate_info.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) -+#ifndef RTL8723F_SUPPORT -+ cali_info->rega24 = 0x090e1317; -+#endif -+#endif -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ if (*(dm->mp_mode) == true) -+ cali_info->rega24 = 0x090e1317; -+#endif -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "===>odm_txpowertracking_callback_thermal_meter\n cali_info->bb_swing_idx_cck_base: %d, cali_info->bb_swing_idx_ofdm_base[A]: %d, cali_info->default_ofdm_index: %d\n", -+ cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base[RF_PATH_A], cali_info->default_ofdm_index); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->txpowertrack_control=%d, hal_data->eeprom_thermal_meter %d\n", cali_info->txpowertrack_control, hal_data->eeprom_thermal_meter); -+ thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ -+ -+ thermal_value_temp = thermal_value + phydm_get_thermal_offset(dm); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "thermal_value_temp(%d) = thermal_value(%d) + power_time_thermal(%d)\n", thermal_value_temp, thermal_value, phydm_get_thermal_offset(dm)); -+ -+ if (thermal_value_temp > 63) -+ thermal_value = 63; -+ else if (thermal_value_temp < 0) -+ thermal_value = 0; -+ else -+ thermal_value = thermal_value_temp; -+ -+ /*add log by zhao he, check c80/c94/c14/ca0 value*/ -+ if (dm->support_ic_type == ODM_RTL8723D) { -+ regc80 = odm_get_bb_reg(dm, R_0xc80, MASKDWORD); -+ regcd0 = odm_get_bb_reg(dm, R_0xcd0, MASKDWORD); -+ regcd4 = odm_get_bb_reg(dm, R_0xcd4, MASKDWORD); -+ regab4 = odm_get_bb_reg(dm, R_0xab4, 0x000007FF); -+ RF_DBG(dm, DBG_RF_IQK, "0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", regc80, regcd0, regcd4, regab4); -+ } -+ -+ /* JJ ADD 20161014 */ -+ if (dm->support_ic_type == ODM_RTL8710B) { -+ regc80 = odm_get_bb_reg(dm, R_0xc80, MASKDWORD); -+ regcd0 = odm_get_bb_reg(dm, R_0xcd0, MASKDWORD); -+ regcd4 = odm_get_bb_reg(dm, R_0xcd4, MASKDWORD); -+ regab4 = odm_get_bb_reg(dm, R_0xab4, 0x000007FF); -+ RF_DBG(dm, DBG_RF_IQK, "0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", regc80, regcd0, regcd4, regab4); -+ } -+ /* Winnita add 20171205 */ -+ if (dm->support_ic_type == ODM_RTL8192F) { -+ regc80 = odm_get_bb_reg(dm, R_0xc80, MASKDWORD); -+ regc88 = odm_get_bb_reg(dm, R_0xc88, MASKDWORD); -+ regab4 = odm_get_bb_reg(dm, R_0xab4, MASKDWORD); -+ rege14 = odm_get_bb_reg(dm, R_0xe14, MASKDWORD); -+ reg848 = odm_get_bb_reg(dm, R_0x848, MASKDWORD); -+ reg838 = odm_get_bb_reg(dm, R_0x838, MASKDWORD); -+ reg86c = odm_get_bb_reg(dm, R_0x86c, MASKDWORD); -+ RF_DBG(dm, DBG_RF_IQK, "0xc80 = 0x%x 0xc88 = 0x%x 0xab4 = 0x%x 0xe14 = 0x%x\n", regc80, regc88, regab4, rege14); -+ RF_DBG(dm, DBG_RF_IQK, "0x848 = 0x%x 0x838 = 0x%x 0x86c = 0x%x\n", reg848, reg838, reg86c); -+ } -+ -+ if (!cali_info->txpowertrack_control) -+ return; -+ -+ if (hal_data->eeprom_thermal_meter == 0xff) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no pg, hal_data->eeprom_thermal_meter = 0x%x\n", hal_data->eeprom_thermal_meter); -+ return; -+ } -+ -+ /*4 3. Initialize ThermalValues of rf_calibrate_info*/ -+ -+ if (cali_info->is_reloadtxpowerindex) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "reload ofdm index for band switch\n"); -+ -+ /*4 4. Calculate average thermal meter*/ -+ -+ cali_info->thermal_value_avg[cali_info->thermal_value_avg_index] = thermal_value; -+ cali_info->thermal_value_avg_index++; -+ if (cali_info->thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/ -+ cali_info->thermal_value_avg_index = 0; -+ -+ for (i = 0; i < c.average_thermal_num; i++) { -+ if (cali_info->thermal_value_avg[i]) { -+ thermal_value_avg += cali_info->thermal_value_avg[i]; -+ thermal_value_avg_count++; -+ } -+ } -+ -+ if (thermal_value_avg_count) { /* Calculate Average thermal_value after average enough times */ -+ thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count); -+ cali_info->thermal_value_delta = thermal_value - hal_data->eeprom_thermal_meter; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "AVG Thermal Meter = 0x%X, EFUSE Thermal base = 0x%X\n", thermal_value, hal_data->eeprom_thermal_meter); -+ } -+ -+ /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ -+ -+ /* "delta" here is used to determine whether thermal value changes or not. */ -+ delta = (thermal_value > cali_info->thermal_value) ? (thermal_value - cali_info->thermal_value) : (cali_info->thermal_value - thermal_value); -+ delta_LCK = (thermal_value > cali_info->thermal_value_lck) ? (thermal_value - cali_info->thermal_value_lck) : (cali_info->thermal_value_lck - thermal_value); -+ delta_IQK = (thermal_value > cali_info->thermal_value_iqk) ? (thermal_value - cali_info->thermal_value_iqk) : (cali_info->thermal_value_iqk - thermal_value); -+ -+ if (cali_info->thermal_value_iqk == 0xff) { /*no PG, use thermal value for IQK*/ -+ cali_info->thermal_value_iqk = thermal_value; -+ delta_IQK = (thermal_value > cali_info->thermal_value_iqk) ? (thermal_value - cali_info->thermal_value_iqk) : (cali_info->thermal_value_iqk - thermal_value); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no PG, use thermal_value for IQK\n"); -+ } -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ diff_DPK[p] = (s8)thermal_value - (s8)cali_info->dpk_thermal[p]; -+ -+ /*4 6. If necessary, do LCK.*/ -+ -+ if (!(dm->support_ic_type & ODM_RTL8821)) { /*no PG, do LCK at initial status*/ -+ if (cali_info->thermal_value_lck == 0xff) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no PG, do LCK\n"); -+ cali_info->thermal_value_lck = thermal_value; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ if ((!(dm->support_ic_type & ODM_RTL8814A)) && (!(dm->support_ic_type & ODM_RTL8822B))) { -+ if (c.phy_lc_calibrate) -+ (*c.phy_lc_calibrate)(dm); -+ } -+ -+ delta_LCK = (thermal_value > cali_info->thermal_value_lck) ? (thermal_value - cali_info->thermal_value_lck) : (cali_info->thermal_value_lck - thermal_value); -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK); -+ -+ /* Wait sacn to do LCK by RF Jenyu*/ -+ if( (*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { -+ /* Delta temperature is equal to or larger than 20 centigrade.*/ -+ if (delta_LCK >= c.threshold_iqk) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); -+ cali_info->thermal_value_lck = thermal_value; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ if ((!(dm->support_ic_type & ODM_RTL8814A)) && (!(dm->support_ic_type & ODM_RTL8822B))) { -+ if (c.phy_lc_calibrate) -+ (*c.phy_lc_calibrate)(dm); -+ } -+ } -+ } -+ } -+ -+ /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ -+ -+ if (delta > 0 && cali_info->txpowertrack_control) { -+ /* "delta" here is used to record the absolute value of differrence. */ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ delta = thermal_value > hal_data->eeprom_thermal_meter ? (thermal_value - hal_data->eeprom_thermal_meter) : (hal_data->eeprom_thermal_meter - thermal_value); -+#else -+ delta = (thermal_value > dm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - dm->priv->pmib->dot11RFEntry.ther) : (dm->priv->pmib->dot11RFEntry.ther - thermal_value); -+#endif -+ if (delta >= TXPWR_TRACK_TABLE_SIZE) -+ delta = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ /*4 7.1 The Final Power index = BaseIndex + power_index_offset*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ if (thermal_value > hal_data->eeprom_thermal_meter) { -+#else -+ if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ cali_info->delta_power_index_last[p] = cali_info->delta_power_index[p]; /*recording poer index offset*/ -+ switch (p) { -+ case RF_PATH_B: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta]); -+ -+ cali_info->delta_power_index[p] = delta_swing_table_idx_tup_b[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_b[delta]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_C: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup_c[%d] = %d\n", delta, delta_swing_table_idx_tup_c[delta]); -+ -+ cali_info->delta_power_index[p] = delta_swing_table_idx_tup_c[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_c[delta]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_D: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup_d[%d] = %d\n", delta, delta_swing_table_idx_tup_d[delta]); -+ -+ cali_info->delta_power_index[p] = delta_swing_table_idx_tup_d[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_d[delta]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ default: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta]); -+ -+ cali_info->delta_power_index[p] = delta_swing_table_idx_tup_a[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_a[delta]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ } -+ } -+ /* JJ ADD 20161014 */ -+ if (dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | ODM_RTL8192F)) { -+ /*Save xtal_offset from Xtal table*/ -+ cali_info->xtal_offset_last = cali_info->xtal_offset; /*recording last Xtal offset*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[Xtal] delta_swing_table_xtal_up[%d] = %d\n", delta, delta_swing_table_xtal_up[delta]); -+ cali_info->xtal_offset = delta_swing_table_xtal_up[delta]; -+ -+ if (cali_info->xtal_offset_last == cali_info->xtal_offset) -+ xtal_offset_eanble = 0; -+ else -+ xtal_offset_eanble = 1; -+ } -+ -+ } else { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ cali_info->delta_power_index_last[p] = cali_info->delta_power_index[p]; /*recording poer index offset*/ -+ -+ switch (p) { -+ case RF_PATH_B: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta]); -+ cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_b[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_C: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown_c[%d] = %d\n", delta, delta_swing_table_idx_tdown_c[delta]); -+ cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_c[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_c[delta]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ case RF_PATH_D: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown_d[%d] = %d\n", delta, delta_swing_table_idx_tdown_d[delta]); -+ cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_d[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_d[delta]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ -+ default: -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta]); -+ cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_a[delta]; -+ cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); -+ break; -+ } -+ } -+ /* JJ ADD 20161014 */ -+ if (dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | ODM_RTL8192F)) { -+ /*Save xtal_offset from Xtal table*/ -+ cali_info->xtal_offset_last = cali_info->xtal_offset; /*recording last Xtal offset*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[Xtal] delta_swing_table_xtal_down[%d] = %d\n", delta, delta_swing_table_xtal_down[delta]); -+ cali_info->xtal_offset = delta_swing_table_xtal_down[delta]; -+ -+ if (cali_info->xtal_offset_last == cali_info->xtal_offset) -+ xtal_offset_eanble = 0; -+ else -+ xtal_offset_eanble = 1; -+ } -+ -+ } -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "\n\n=========================== [path-%d] Calculating power_index_offset===========================\n", p); -+ -+ if (cali_info->delta_power_index[p] == cali_info->delta_power_index_last[p]) /*If Thermal value changes but lookup table value still the same*/ -+ cali_info->power_index_offset[p] = 0; -+ else -+ cali_info->power_index_offset[p] = cali_info->delta_power_index[p] - cali_info->delta_power_index_last[p]; /*Power index diff between 2 times Power Tracking*/ -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[path-%d] power_index_offset(%d) = delta_power_index(%d) - delta_power_index_last(%d)\n", p, cali_info->power_index_offset[p], cali_info->delta_power_index[p], cali_info->delta_power_index_last[p]); -+ -+ cali_info->OFDM_index[p] = cali_info->bb_swing_idx_ofdm_base[p] + cali_info->power_index_offset[p]; -+ cali_info->CCK_index = cali_info->bb_swing_idx_cck_base + cali_info->power_index_offset[p]; -+ -+ cali_info->bb_swing_idx_cck = cali_info->CCK_index; -+ cali_info->bb_swing_idx_ofdm[p] = cali_info->OFDM_index[p]; -+ -+ /*************Print BB Swing base and index Offset*************/ -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_cck, cali_info->bb_swing_idx_cck_base, cali_info->power_index_offset[p]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "The 'OFDM' final index(%d) = BaseIndex[%d](%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_ofdm[p], p, cali_info->bb_swing_idx_ofdm_base[p], cali_info->power_index_offset[p]); -+ -+ /*4 7.1 Handle boundary conditions of index.*/ -+ -+ if (cali_info->OFDM_index[p] > c.swing_table_size_ofdm - 1) -+ cali_info->OFDM_index[p] = c.swing_table_size_ofdm - 1; -+ else if (cali_info->OFDM_index[p] <= OFDM_min_index) -+ cali_info->OFDM_index[p] = OFDM_min_index; -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "\n\n========================================================================================================\n"); -+ -+ if (cali_info->CCK_index > c.swing_table_size_cck - 1) -+ cali_info->CCK_index = c.swing_table_size_cck - 1; -+ else if (cali_info->CCK_index <= 0) -+ cali_info->CCK_index = 0; -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "The thermal meter is unchanged or TxPowerTracking OFF(%d): thermal_value: %d, cali_info->thermal_value: %d\n", -+ cali_info->txpowertrack_control, thermal_value, cali_info->thermal_value); -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ cali_info->power_index_offset[p] = 0; -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", -+ cali_info->CCK_index, cali_info->bb_swing_idx_cck_base); /*Print Swing base & current*/ -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index[%d]: %d\n", -+ cali_info->OFDM_index[p], p, cali_info->bb_swing_idx_ofdm_base[p]); -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8814B) -+ power_tracking_type = TSSI_MODE; -+ -+ if (dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8814B)) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "power_tracking_type=%d\n", power_tracking_type); -+ -+ if (power_tracking_type == 0) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else if (power_tracking_type == 1) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX(2G) TSSI(5G) MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_2G_TSSI_5G_MODE, p, 0); -+ } else if (power_tracking_type == 2) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX(5G) TSSI(2G)MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_5G_TSSI_2G_MODE, p, 0); -+ } else if (power_tracking_type == 3) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking TSSI MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, TSSI_MODE, p, 0); -+ } -+ cali_info->thermal_value = thermal_value; /*Record last Power Tracking Thermal value*/ -+ -+ } else if ((cali_info->power_index_offset[RF_PATH_A] != 0 || -+ cali_info->power_index_offset[RF_PATH_B] != 0 || -+ cali_info->power_index_offset[RF_PATH_C] != 0 || -+ cali_info->power_index_offset[RF_PATH_D] != 0) && -+ cali_info->txpowertrack_control && (hal_data->eeprom_thermal_meter != 0xff)) { -+ /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ -+ -+ cali_info->is_tx_power_changed = 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 (thermal_value > cali_info->thermal_value) { -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature Increasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, cali_info->power_index_offset[p], delta, thermal_value, hal_data->eeprom_thermal_meter, cali_info->thermal_value); -+ } -+ } else if (thermal_value < cali_info->thermal_value) { /*Low temperature*/ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature Decreasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, cali_info->power_index_offset[p], delta, thermal_value, hal_data->eeprom_thermal_meter, cali_info->thermal_value); -+ } -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (thermal_value > hal_data->eeprom_thermal_meter) -+#else -+ if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) -+#endif -+ { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) higher than PG value(%d)\n", thermal_value, hal_data->eeprom_thermal_meter); -+ -+ if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8192E || dm->support_ic_type == ODM_RTL8821 || -+ dm->support_ic_type == ODM_RTL8812 || dm->support_ic_type == ODM_RTL8723B || dm->support_ic_type == ODM_RTL8814A || -+ dm->support_ic_type == ODM_RTL8703B || dm->support_ic_type == ODM_RTL8188F || dm->support_ic_type == ODM_RTL8822B || -+ dm->support_ic_type == ODM_RTL8723D || dm->support_ic_type == ODM_RTL8821C || dm->support_ic_type == ODM_RTL8710B || -+ dm->support_ic_type == ODM_RTL8192F) { -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, indexforchannel); -+ } -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) lower than PG value(%d)\n", thermal_value, hal_data->eeprom_thermal_meter); -+ -+ if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8192E || dm->support_ic_type == ODM_RTL8821 || -+ dm->support_ic_type == ODM_RTL8812 || dm->support_ic_type == ODM_RTL8723B || dm->support_ic_type == ODM_RTL8814A || -+ dm->support_ic_type == ODM_RTL8703B || dm->support_ic_type == ODM_RTL8188F || dm->support_ic_type == ODM_RTL8822B || -+ dm->support_ic_type == ODM_RTL8723D || dm->support_ic_type == ODM_RTL8821C || dm->support_ic_type == ODM_RTL8710B || -+ dm->support_ic_type == ODM_RTL8192F) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, indexforchannel); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, indexforchannel); -+ } -+ -+ } -+ -+ cali_info->bb_swing_idx_cck_base = cali_info->bb_swing_idx_cck; /*Record last time Power Tracking result as base.*/ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ cali_info->bb_swing_idx_ofdm_base[p] = cali_info->bb_swing_idx_ofdm[p]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->thermal_value = %d thermal_value= %d\n", cali_info->thermal_value, thermal_value); -+ -+ cali_info->thermal_value = thermal_value; /*Record last Power Tracking Thermal value*/ -+ -+ } -+ -+ -+ if (dm->support_ic_type == ODM_RTL8703B || dm->support_ic_type == ODM_RTL8723D || -+ dm->support_ic_type == ODM_RTL8192F || dm->support_ic_type == ODM_RTL8710B) {/* JJ ADD 20161014 */ -+ -+ if (xtal_offset_eanble != 0 && cali_info->txpowertrack_control && (hal_data->eeprom_thermal_meter != 0xff)) { -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter Xtal Tracking**********\n"); -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (thermal_value > hal_data->eeprom_thermal_meter) { -+#else -+ if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) higher than PG value(%d)\n", thermal_value, hal_data->eeprom_thermal_meter); -+ (*c.odm_txxtaltrack_set_xtal)(dm); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Temperature(%d) lower than PG value(%d)\n", thermal_value, hal_data->eeprom_thermal_meter); -+ (*c.odm_txxtaltrack_set_xtal)(dm); -+ } -+ } -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********End Xtal Tracking**********\n"); -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ /* Wait sacn to do IQK by RF Jenyu*/ -+ if ((*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden) && dm->is_linked) { -+ 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) { -+ cali_info->thermal_value_iqk = thermal_value; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); -+ if (!cali_info->is_iqk_in_progress) -+ (*c.do_iqk)(dm, delta_IQK, thermal_value, 8); -+ } -+ } -+ } -+ if (cali_info->dpk_thermal[RF_PATH_A] != 0) { -+ if (diff_DPK[RF_PATH_A] >= c.threshold_dpk) { -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_A] / c.threshold_dpk)); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[RF_PATH_A] <= -1 * c.threshold_dpk)) { -+ s32 value = 0x20 + (diff_DPK[RF_PATH_A] / c.threshold_dpk); -+ -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } else { -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } -+ } -+ if (cali_info->dpk_thermal[RF_PATH_B] != 0) { -+ if (diff_DPK[RF_PATH_B] >= c.threshold_dpk) { -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_B] / c.threshold_dpk)); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[RF_PATH_B] <= -1 * c.threshold_dpk)) { -+ s32 value = 0x20 + (diff_DPK[RF_PATH_B] / c.threshold_dpk); -+ -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } else { -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); -+ odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); -+ } -+ } -+ -+#endif -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===odm_txpowertracking_callback_thermal_meter\n"); -+ -+ cali_info->tx_powercount = 0; -+} -+ -+#if (RTL8822C_SUPPORT == 1 || RTL8814B_SUPPORT == 1 || RTL8723F_SUPPORT == 1 || RTL8814C_SUPPORT == 1) -+void -+odm_txpowertracking_new_callback_thermal_meter(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ u8 thermal_value[MAX_RF_PATH] = {0}, delta[MAX_RF_PATH] = {0}; -+ u8 delta_swing_table_idx_tup[DELTA_SWINGIDX_SIZE] = {0}; -+ u8 delta_swing_table_idx_tdown[DELTA_SWINGIDX_SIZE] = {0}; -+ u8 delta_LCK = 0, delta_IQK = 0, i = 0, j = 0, p; -+ u8 thermal_value_avg_count[MAX_RF_PATH] = {0}; -+ u32 thermal_value_avg[MAX_RF_PATH] = {0}; -+ s8 thermal_value_temp[MAX_RF_PATH] = {0}; -+ u8 tracking_method = MIX_MODE; -+ -+ struct txpwrtrack_cfg c; -+ -+ u8 *delta_swing_table_idx_tup_a = NULL; -+ u8 *delta_swing_table_idx_tdown_a = NULL; -+ u8 *delta_swing_table_idx_tup_b = NULL; -+ u8 *delta_swing_table_idx_tdown_b = NULL; -+ u8 *delta_swing_table_idx_tup_c = NULL; -+ u8 *delta_swing_table_idx_tdown_c = NULL; -+ u8 *delta_swing_table_idx_tup_d = NULL; -+ u8 *delta_swing_table_idx_tdown_d = NULL; -+ -+ configure_txpower_track(dm, &c); -+ -+ (*c.get_delta_swing_table)(dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a, -+ (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b); -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ (*c.get_delta_swing_table)(dm, (u8 **)&delta_swing_table_idx_tup_c, (u8 **)&delta_swing_table_idx_tdown_c, -+ (u8 **)&delta_swing_table_idx_tup_d, (u8 **)&delta_swing_table_idx_tdown_d); -+ } -+ -+ cali_info->txpowertracking_callback_cnt++; -+ cali_info->is_txpowertracking_init = true; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "===>odm_txpowertracking_callback_thermal_meter\n cali_info->bb_swing_idx_cck_base: %d, cali_info->bb_swing_idx_ofdm_base[A]: %d, cali_info->default_ofdm_index: %d\n", -+ cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base[RF_PATH_A], cali_info->default_ofdm_index); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "cali_info->txpowertrack_control=%d, tssi->thermal[RF_PATH_A]=%d tssi->thermal[RF_PATH_B]=%d\n", -+ cali_info->txpowertrack_control, tssi->thermal[RF_PATH_A], tssi->thermal[RF_PATH_B]); -+ -+ if (dm->support_ic_type == ODM_RTL8822C) { -+ for (i = 0; i < c.rf_path_count; i++) -+ thermal_value[i] = (u8)odm_get_rf_reg(dm, i, c.thermal_reg_addr, 0x7e); /* 0x42: RF Reg[6:1] Thermal Trim*/ -+ } else { -+ for (i = 0; i < c.rf_path_count; i++) { -+ thermal_value[i] = (u8)odm_get_rf_reg(dm, i, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ thermal_value_temp[i] = (s8)thermal_value[i] + phydm_get_multi_thermal_offset(dm, i); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "thermal_value_temp[%d](%d) = thermal_value[%d](%d) + multi_thermal_trim(%d)\n", i, thermal_value_temp[i], i, thermal_value[i], phydm_get_multi_thermal_offset(dm, i)); -+ } else { -+ thermal_value_temp[i] = (s8)thermal_value[i] + phydm_get_thermal_offset(dm); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "thermal_value_temp[%d](%d) = thermal_value[%d](%d) + thermal_trim(%d)\n", i, thermal_value_temp[i], i, thermal_value[i], phydm_get_thermal_offset(dm)); -+ } -+ -+ if (thermal_value_temp[i] > 63) -+ thermal_value[i] = 63; -+ else if (thermal_value_temp[i] < 0) -+ thermal_value[i] = 0; -+ else -+ thermal_value[i] = thermal_value_temp[i]; -+ } -+ } -+ -+ if ((tssi->thermal[RF_PATH_A] == 0xff || tssi->thermal[RF_PATH_B] == 0xff)) { -+ for (i = 0; i < c.rf_path_count; i++) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no pg, tssi->thermal[%d] = 0x%x\n", -+ i, tssi->thermal[i]); -+ return; -+ } -+ -+ for (j = 0; j < c.rf_path_count; j++) { -+ cali_info->thermal_value_avg_path[j][cali_info->thermal_value_avg_index_path[j]] = thermal_value[j]; -+ cali_info->thermal_value_avg_index_path[j]++; -+ if (cali_info->thermal_value_avg_index_path[j] == c.average_thermal_num) /*Average times = c.average_thermal_num*/ -+ cali_info->thermal_value_avg_index_path[j] = 0; -+ -+ -+ for (i = 0; i < c.average_thermal_num; i++) { -+ if (cali_info->thermal_value_avg_path[j][i]) { -+ thermal_value_avg[j] += cali_info->thermal_value_avg_path[j][i]; -+ thermal_value_avg_count[j]++; -+ } -+ } -+ -+ if (thermal_value_avg_count[j]) { /* Calculate Average thermal_value after average enough times */ -+ thermal_value[j] = (u8)(thermal_value_avg[j] / thermal_value_avg_count[j]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "AVG Thermal Meter = 0x%X, tssi->thermal[%d] = 0x%x\n", -+ thermal_value[j], j, tssi->thermal[j]); -+ } -+ /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ -+ -+ /* "delta" here is used to determine whether thermal value changes or not. */ -+ delta[j] = (thermal_value[j] > cali_info->thermal_value_path[j]) ? (thermal_value[j] - cali_info->thermal_value_path[j]) : (cali_info->thermal_value_path[j] - thermal_value[j]); -+ delta_LCK = (thermal_value[0] > cali_info->thermal_value_lck) ? (thermal_value[0] - cali_info->thermal_value_lck) : (cali_info->thermal_value_lck - thermal_value[0]); -+ delta_IQK = (thermal_value[0] > cali_info->thermal_value_iqk) ? (thermal_value[0] - cali_info->thermal_value_iqk) : (cali_info->thermal_value_iqk - thermal_value[0]); -+ } -+ -+ /*4 6. If necessary, do LCK.*/ -+ -+ for (i = 0; i < c.rf_path_count; i++) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", i, delta[i], delta_LCK, delta_IQK); -+ -+ /* Wait sacn to do LCK by RF Jenyu*/ -+ if( (*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { -+ /* Delta temperature is equal to or larger than 20 centigrade.*/ -+ if (delta_LCK >= c.threshold_iqk) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); -+ cali_info->thermal_value_lck = thermal_value[RF_PATH_A]; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ if ((!(dm->support_ic_type & ODM_RTL8814A)) && -+ (!(dm->support_ic_type & ODM_RTL8822B)) && -+ (!(dm->support_ic_type & ODM_RTL8723F))) { -+ if (c.phy_lc_calibrate) -+ (*c.phy_lc_calibrate)(dm); -+ } else -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do not do LCK\n"); -+ } -+ } -+ -+ /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ -+ for (i = 0; i < c.rf_path_count; i++) { -+ if (i == RF_PATH_B) { -+ odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_b, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_b, DELTA_SWINGIDX_SIZE); -+ } else if (i == RF_PATH_C) { -+ odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_c, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_c, DELTA_SWINGIDX_SIZE); -+ } else if (i == RF_PATH_D) { -+ odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_d, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_d, DELTA_SWINGIDX_SIZE); -+ } else { -+ odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_a, DELTA_SWINGIDX_SIZE); -+ odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_a, DELTA_SWINGIDX_SIZE); -+ } -+ -+ cali_info->delta_power_index_last[i] = cali_info->delta_power_index[i]; /*recording poer index offset*/ -+ delta[i] = thermal_value[i] > tssi->thermal[i] ? (thermal_value[i] - tssi->thermal[i]) : (tssi->thermal[i] - thermal_value[i]); -+ -+ if (delta[i] >= TXPWR_TRACK_TABLE_SIZE) -+ delta[i] = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ if (thermal_value[i] > tssi->thermal[i]) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tup[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tup[delta[i]], i); -+ -+ cali_info->delta_power_index[i] = delta_swing_table_idx_tup[delta[i]]; -+ cali_info->absolute_ofdm_swing_idx[i] = delta_swing_table_idx_tup[delta[i]]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is higher and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "delta_swing_table_idx_tdown[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tdown[delta[i]], i); -+ cali_info->delta_power_index[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; -+ cali_info->absolute_ofdm_swing_idx[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; /*Record delta swing for mix mode power tracking*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "******Temp is lower and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); -+ } -+ } -+ -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) { -+ if (cali_info->delta_power_index[p] == cali_info->delta_power_index_last[p]) /*If Thermal value changes but lookup table value still the same*/ -+ cali_info->power_index_offset[p] = 0; -+ else -+ cali_info->power_index_offset[p] = cali_info->delta_power_index[p] - cali_info->delta_power_index_last[p]; /*Power index diff between 2 times Power Tracking*/ -+ } -+ -+#if 0 -+ if (dm->support_ic_type == ODM_RTL8822C) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); -+ } else { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, 0); -+ } -+#endif -+ if (*dm->mp_mode == 1) { -+ if (cali_info->txpowertrack_control == 1) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ tracking_method = MIX_MODE; -+ } else if (cali_info->txpowertrack_control == 3) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking TSSI_MODE**********\n"); -+ tracking_method = TSSI_MODE; -+ } -+ } else { -+ if (rf->power_track_type >= 0 && rf->power_track_type <= 3) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); -+ tracking_method = MIX_MODE; -+ } else if (rf->power_track_type >= 4 && rf->power_track_type <= 7) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking TSSI_MODE**********\n"); -+ tracking_method = TSSI_MODE; -+ } -+ } -+ -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | ODM_RTL8814C)) -+ for (p = RF_PATH_A; p < c.rf_path_count; p++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, tracking_method, p, 0); -+ -+ /* Wait sacn to do IQK by RF Jenyu*/ -+ if ((*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden) && (dm->is_linked || *dm->mp_mode)) { -+ /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ -+ if (delta_IQK >= c.threshold_iqk) { -+ cali_info->thermal_value_iqk = thermal_value[RF_PATH_A]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); -+ /*if (!cali_info->is_iqk_in_progress)*/ -+ /* (*c.do_iqk)(dm, delta_IQK, thermal_value[RF_PATH_A], 8);*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do IQK\n"); -+ -+ /*if (!cali_info->is_iqk_in_progress)*/ -+ /* (*c.do_tssi_dck)(dm, true);*/ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do TSSI DCK\n"); -+ } -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===%s\n", __func__); -+ -+ cali_info->tx_powercount = 0; -+} -+#endif -+ -+/* 3============================================================ -+ * 3 IQ Calibration -+ * 3============================================================ */ -+ -+void -+odm_reset_iqk_result( -+ struct dm_struct *dm -+) -+{ -+ return; -+} -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+u8 odm_get_right_chnl_place_for_iqk(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; -+ -+} -+#endif -+ -+void -+odm_iq_calibrate( -+ struct dm_struct *dm -+) -+{ -+ void *adapter = dm->adapter; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ RF_DBG(dm, DBG_RF_IQK, "=>%s\n",__FUNCTION__); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*dm->is_fcs_mode_enable) -+ return; -+#endif -+ if (dm->is_linked) { -+ RF_DBG(dm, DBG_RF_IQK, -+ "interval=%d ch=%d prech=%d scan=%s rfk_f =%s\n", -+ dm->linked_interval, *dm->channel, dm->pre_channel, -+ *dm->is_scan_in_process == TRUE ? "TRUE":"FALSE", -+ iqk_info->rfk_forbidden == TRUE ? "TRUE":"FALSE"); -+ -+ if (iqk_info->rfk_forbidden) { -+ RF_DBG(dm, DBG_RF_IQK, "return by rfk_forbidden\n"); -+ return; -+ } -+ -+ if (*dm->is_scan_in_process) { -+ RF_DBG(dm, DBG_RF_IQK, "return by is_scan_in_process\n"); -+ return; -+ } -+ -+ if (*dm->channel != dm->pre_channel) { -+ dm->pre_channel = *dm->channel; -+ dm->linked_interval = 0; -+ } -+ -+ if (dm->linked_interval < 3) -+ dm->linked_interval++; -+ -+ if (dm->linked_interval == 2) -+ PHY_IQCalibrate(adapter, false); -+ } else { -+ dm->linked_interval = 0; -+ RF_DBG(dm, DBG_RF_IQK, "is_linked =%s, interval =%d\n", -+ dm->is_linked == TRUE ? "TRUE":"FALSE", -+ dm->linked_interval); -+ } -+} -+ -+void phydm_rf_init(struct dm_struct *dm) -+{ -+ -+ odm_txpowertracking_init(dm); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ odm_clear_txpowertracking_state(dm); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814A) -+ phy_iq_calibrate_8814a_init(dm); -+#endif -+#endif -+ -+} -+ -+void phydm_rf_watchdog(struct dm_struct *dm) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ FunctionIn(COMP_MLME); -+ -+ if (*dm->mp_mode == 1) { -+#if (MP_DRIVER == 1) -+ odm_txpowertracking_check(dm); -+#endif -+ } else { -+ odm_txpowertracking_check(dm); -+ -+ if (dm->support_ic_type & (ODM_IC_11AC_SERIES | ODM_IC_JGR3_SERIES)) -+ odm_iq_calibrate(dm); -+ } -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_win.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_win.h -new file mode 100644 -index 000000000..0d5fc97a5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halphyrf_win.h -@@ -0,0 +1,132 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALPHYRF_H__ -+#define __HALPHYRF_H__ -+ -+#if (RTL8814A_SUPPORT == 1) -+ #include "halrf/rtl8814a/halrf_iqk_8814a.h" -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+ #include "halrf/rtl8822b/halrf_iqk_8822b.h" -+ #include "../mac/Halmac_type.h" -+#endif -+#include "halrf/halrf_powertracking_win.h" -+#include "halrf/halrf_kfree.h" -+#include "halrf/halrf_txgapcal.h" -+#if (RTL8821C_SUPPORT == 1) -+ #include "halrf/rtl8821c/halrf_iqk_8821c.h" -+#endif -+ -+#if (RTL8195B_SUPPORT == 1) -+// #include "halrf/rtl8195b/halrf.h" -+ #include "halrf/rtl8195b/halrf_iqk_8195b.h" -+ #include "halrf/rtl8195b/halrf_txgapk_8195b.h" -+ #include "halrf/rtl8195b/halrf_dpk_8195b.h" -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ #include "halrf/rtl8814b/halrf_iqk_8814b.h" -+ #include "halrf/rtl8814b/halrf_txgapk_8814b.h" -+#endif -+ -+enum spur_cal_method { -+ PLL_RESET, -+ AFE_PHASE_SEL -+}; -+ -+enum pwrtrack_method { -+ BBSWING, -+ TXAGC, -+ MIX_MODE, -+ TSSI_MODE, -+ MIX_2G_TSSI_5G_MODE, -+ MIX_5G_TSSI_2G_MODE, -+ CLEAN_MODE -+}; -+ -+typedef void(*func_set_pwr)(void *, enum pwrtrack_method, u8, u8); -+typedef void(*func_iqk)(void *, u8, u8, u8); -+typedef void(*func_lck)(void *); -+typedef void(*func_tssi_dck)(void *, u8); -+typedef void(*func_swing)(void *, u8 **, u8 **, u8 **, u8 **); -+typedef void(*func_swing8814only)(void *, u8 **, u8 **, u8 **, u8 **); -+typedef void (*func_swing_xtal)(void *, s8 **, s8 **); -+typedef void (*func_set_xtal)(void *); -+typedef void(*func_all_swing)(void *, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **); -+ -+struct txpwrtrack_cfg { -+ u8 swing_table_size_cck; -+ u8 swing_table_size_ofdm; -+ u8 threshold_iqk; -+ u8 threshold_dpk; -+ u8 average_thermal_num; -+ u8 rf_path_count; -+ u32 thermal_reg_addr; -+ func_set_pwr odm_tx_pwr_track_set_pwr; -+ func_iqk do_iqk; -+ func_lck phy_lc_calibrate; -+ func_tssi_dck do_tssi_dck; -+ func_swing get_delta_swing_table; -+ func_swing8814only get_delta_swing_table8814only; -+ func_swing_xtal get_delta_swing_xtal_table; -+ func_set_xtal odm_txxtaltrack_set_xtal; -+ func_all_swing get_delta_all_swing_table; -+}; -+ -+void -+configure_txpower_track( -+ struct dm_struct *dm, -+ struct txpwrtrack_cfg *config -+); -+ -+ -+void -+odm_clear_txpowertracking_state( -+ struct dm_struct *dm -+); -+ -+void -+odm_txpowertracking_callback_thermal_meter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ struct dm_struct *dm -+#else -+ void *adapter -+#endif -+); -+ -+#if (RTL8822C_SUPPORT == 1 || RTL8814B_SUPPORT == 1 || RTL8814C_SUPPORT == 1) -+void -+odm_txpowertracking_new_callback_thermal_meter(void *dm_void); -+#endif -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+ -+void -+odm_reset_iqk_result( -+ struct dm_struct *dm -+); -+u8 -+odm_get_right_chnl_place_for_iqk( -+ u8 chnl -+); -+ -+void odm_iq_calibrate(struct dm_struct *dm); -+void phydm_rf_init(struct dm_struct *dm); -+void phydm_rf_watchdog(struct dm_struct *dm); -+ -+#endif /*#ifndef __HALPHYRF_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf.c -new file mode 100644 -index 000000000..61db264b1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf.c -@@ -0,0 +1,4977 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ * ************************************************************ -+ */ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 ||\ -+ RTL8195B_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ -+ RTL8812F_SUPPORT == 1 || RTL8710C_SUPPORT == 1 ||\ -+ RTL8197G_SUPPORT == 1 || RTL8814C_SUPPORT == 1 ) -+ -+void _iqk_check_if_reload(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ iqk_info->is_reload = (boolean)odm_get_bb_reg(dm, R_0x1bf0, BIT(16)); -+} -+ -+void _iqk_page_switch(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type == ODM_RTL8821C) -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ else -+ odm_write_4byte(dm, 0x1b00, 0xf800000a); -+} -+ -+u32 halrf_psd_log2base(u32 val) -+{ -+ u8 j; -+ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; -+ u32 result, val_fractiond_b = 0; -+ u32 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; -+ -+ 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; -+} -+#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ -+ RTL8814C_SUPPORT == 1) -+void halrf_iqk_xym_enable(struct dm_struct *dm, u8 xym_enable) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if (xym_enable == 0) -+ iqk_info->xym_read = false; -+ else -+ iqk_info->xym_read = true; -+ -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]%-20s %s\n", "xym_read = ", -+ (iqk_info->xym_read ? "true" : "false")); -+} -+ -+/*xym_type => 0: rx_sym; 1: tx_xym; 2:gs1_xym; 3:gs2_sym; 4: rxk1_xym*/ -+void halrf_iqk_xym_read(void *dm_void, u8 path, u8 xym_type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 i, start, num; -+ u32 tmp1, tmp2; -+ -+ if (!iqk_info->xym_read) -+ return; -+ -+ if (*dm->band_width == 0) { -+ start = 3; -+ num = 4; -+ } else if (*dm->band_width == 1) { -+ start = 2; -+ num = 6; -+ } else { -+ start = 0; -+ num = 10; -+ } -+ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ tmp1 = odm_read_4byte(dm, 0x1b1c); -+ odm_write_4byte(dm, 0x1b1c, 0xa2193c32); -+ -+ odm_write_4byte(dm, 0x1b00, 0xf800000a); -+ tmp2 = odm_read_4byte(dm, 0x1b1c); -+ odm_write_4byte(dm, 0x1b1c, 0xa2193c32); -+ -+ for (path = 0; path < 2; path++) { -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ switch (xym_type) { -+ case 0: -+ for (i = 0; i < num; i++) { -+ odm_write_4byte(dm, 0x1b14, 0xe6 + start + i); -+ odm_write_4byte(dm, 0x1b14, 0x0); -+ iqk_info->rx_xym[path][i] = -+ odm_read_4byte(dm, 0x1b38); -+ } -+ break; -+ case 1: -+ for (i = 0; i < num; i++) { -+ odm_write_4byte(dm, 0x1b14, 0xe6 + start + i); -+ odm_write_4byte(dm, 0x1b14, 0x0); -+ iqk_info->tx_xym[path][i] = -+ odm_read_4byte(dm, 0x1b38); -+ } -+ break; -+ case 2: -+ for (i = 0; i < 6; i++) { -+ odm_write_4byte(dm, 0x1b14, 0xe0 + i); -+ odm_write_4byte(dm, 0x1b14, 0x0); -+ iqk_info->gs1_xym[path][i] = -+ odm_read_4byte(dm, 0x1b38); -+ } -+ break; -+ case 3: -+ for (i = 0; i < 6; i++) { -+ odm_write_4byte(dm, 0x1b14, 0xe0 + i); -+ odm_write_4byte(dm, 0x1b14, 0x0); -+ iqk_info->gs2_xym[path][i] = -+ odm_read_4byte(dm, 0x1b38); -+ } -+ break; -+ case 4: -+ for (i = 0; i < 6; i++) { -+ odm_write_4byte(dm, 0x1b14, 0xe0 + i); -+ odm_write_4byte(dm, 0x1b14, 0x0); -+ iqk_info->rxk1_xym[path][i] = -+ odm_read_4byte(dm, 0x1b38); -+ } -+ break; -+ } -+ odm_write_4byte(dm, 0x1b38, 0x20000000); -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ odm_write_4byte(dm, 0x1b1c, tmp1); -+ odm_write_4byte(dm, 0x1b00, 0xf800000a); -+ odm_write_4byte(dm, 0x1b1c, tmp2); -+ _iqk_page_switch(dm); -+ } -+} -+ -+/*xym_type => 0: rx_sym; 1: tx_xym; 2:gs1_xym; 3:gs2_sym; 4: rxk1_xym*/ -+void halrf_iqk_xym_show(struct dm_struct *dm, u8 xym_type) -+{ -+ u8 num, path, path_num, i; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if (dm->rf_type == RF_1T1R) -+ path_num = 0x1; -+ else if (dm->rf_type == RF_2T2R) -+ path_num = 0x2; -+ else -+ path_num = 0x4; -+ -+ if (*dm->band_width == CHANNEL_WIDTH_20) -+ num = 4; -+ else if (*dm->band_width == CHANNEL_WIDTH_40) -+ num = 6; -+ else -+ num = 10; -+ -+ for (path = 0; path < path_num; path++) { -+ switch (xym_type) { -+ case 0: -+ for (i = 0; i < num; i++) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]%-20s %-2d: 0x%x\n", -+ (path == 0) ? "PATH A RX-XYM " : -+ "PATH B RX-XYM", i, -+ iqk_info->rx_xym[path][i]); -+ break; -+ case 1: -+ for (i = 0; i < num; i++) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]%-20s %-2d: 0x%x\n", -+ (path == 0) ? "PATH A TX-XYM " : -+ "PATH B TX-XYM", i, -+ iqk_info->tx_xym[path][i]); -+ break; -+ case 2: -+ for (i = 0; i < 6; i++) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]%-20s %-2d: 0x%x\n", -+ (path == 0) ? "PATH A GS1-XYM " : -+ "PATH B GS1-XYM", i, -+ iqk_info->gs1_xym[path][i]); -+ break; -+ case 3: -+ for (i = 0; i < 6; i++) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]%-20s %-2d: 0x%x\n", -+ (path == 0) ? "PATH A GS2-XYM " : -+ "PATH B GS2-XYM", i, -+ iqk_info->gs2_xym[path][i]); -+ break; -+ case 4: -+ for (i = 0; i < 6; i++) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]%-20s %-2d: 0x%x\n", -+ (path == 0) ? "PATH A RXK1-XYM " : -+ "PATH B RXK1-XYM", i, -+ iqk_info->rxk1_xym[path][i]); -+ break; -+ } -+ } -+} -+ -+void halrf_iqk_xym_dump(void *dm_void) -+{ -+ u32 tmp1, tmp2; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ tmp1 = odm_read_4byte(dm, 0x1b1c); -+ odm_write_4byte(dm, 0x1b00, 0xf800000a); -+ tmp2 = odm_read_4byte(dm, 0x1b1c); -+#if 0 -+ /*halrf_iqk_xym_read(dm, xym_type);*/ -+#endif -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ odm_write_4byte(dm, 0x1b1c, tmp1); -+ odm_write_4byte(dm, 0x1b00, 0xf800000a); -+ odm_write_4byte(dm, 0x1b1c, tmp2); -+ _iqk_page_switch(dm); -+} -+#endif -+void halrf_iqk_info_dump(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 rf_path, j, reload_iqk = 0; -+ u32 tmp; -+ /*two channel, PATH, TX/RX, 0:pass 1 :fail*/ -+ boolean iqk_result[2][NUM][2]; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if (!(dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C))) -+ return; -+ -+ /* IQK INFO */ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s\n", -+ "% IQK Info %"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s\n", -+ (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "FW-IQK" : -+ "Driver-IQK"); -+ -+ reload_iqk = (u8)odm_get_bb_reg(dm, R_0x1bf0, BIT(16)); -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", -+ "reload", (reload_iqk) ? "True" : "False"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", -+ "rfk_forbidden", (iqk_info->rfk_forbidden) ? "True" : "False"); -+#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || \ -+ RTL8821C_SUPPORT == 1 || RTL8195B_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1||\ -+ RTL8814C_SUPPORT == 1 ) -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", -+ "segment_iqk", (iqk_info->segment_iqk) ? "True" : "False"); -+#endif -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s:%d %d\n", -+ "iqk count / fail count", dm->n_iqk_cnt, dm->n_iqk_fail_cnt); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %d\n", -+ "channel", *dm->channel); -+ -+ if (*dm->band_width == CHANNEL_WIDTH_20) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-20s: %s\n", "bandwidth", "BW_20"); -+ else if (*dm->band_width == CHANNEL_WIDTH_40) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-20s: %s\n", "bandwidth", "BW_40"); -+ else if (*dm->band_width == CHANNEL_WIDTH_80) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-20s: %s\n", "bandwidth", "BW_80"); -+ else if (*dm->band_width == CHANNEL_WIDTH_160) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-20s: %s\n", "bandwidth", "BW_160"); -+ else if (*dm->band_width == CHANNEL_WIDTH_80_80) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-20s: %s\n", "bandwidth", "BW_80_80"); -+ else -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-20s: %s\n", "bandwidth", "BW_UNKNOWN"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-20s: %llu %s\n", "progressing_time", -+ dm->rf_calibrate_info.iqk_total_progressing_time, "(ms)"); -+ -+ tmp = odm_read_4byte(dm, 0x1bf0); -+ for (rf_path = RF_PATH_A; rf_path <= RF_PATH_B; rf_path++) -+ for (j = 0; j < 2; j++) -+ iqk_result[0][rf_path][j] = (boolean) -+ (tmp & (BIT(rf_path + (j * 4)) >> (rf_path + (j * 4)))); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-20s: 0x%08x\n", "Reg0x1bf0", tmp); -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", -+ "PATH_A-Tx result", -+ (iqk_result[0][RF_PATH_A][0]) ? "Fail" : "Pass"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", -+ "PATH_A-Rx result", -+ (iqk_result[0][RF_PATH_A][1]) ? "Fail" : "Pass"); -+#if (RTL8822B_SUPPORT == 1) -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", -+ "PATH_B-Tx result", -+ (iqk_result[0][RF_PATH_B][0]) ? "Fail" : "Pass"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", -+ "PATH_B-Rx result", -+ (iqk_result[0][RF_PATH_B][1]) ? "Fail" : "Pass"); -+#endif -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void halrf_get_fw_version(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ rf->fw_ver = (dm->fw_version << 16) | dm->fw_sub_version; -+} -+ -+void halrf_iqk_dbg(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rf_path, j; -+ u32 tmp; -+ /*two channel, PATH, TX/RX, 0:pass 1 :fail*/ -+ boolean iqk_result[2][NUM][2]; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ /* IQK INFO */ -+ RF_DBG(dm, DBG_RF_IQK, "%-20s\n", "====== IQK Info ======"); -+ -+ RF_DBG(dm, DBG_RF_IQK, "%-20s\n", -+ (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "FW-IQK" : -+ "Driver-IQK"); -+ -+ if (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) { -+ halrf_get_fw_version(dm); -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: 0x%x\n", "FW_VER", rf->fw_ver); -+ } else { -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "IQK_VER", HALRF_IQK_VER); -+ } -+ -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "reload", -+ (iqk_info->is_reload) ? "True" : "False"); -+ -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %d %d\n", "iqk count / fail count", -+ dm->n_iqk_cnt, dm->n_iqk_fail_cnt); -+ -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %d\n", "channel", *dm->channel); -+ -+ if (*dm->band_width == CHANNEL_WIDTH_20) -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", "BW_20"); -+ else if (*dm->band_width == CHANNEL_WIDTH_40) -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", "BW_40"); -+ else if (*dm->band_width == CHANNEL_WIDTH_80) -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", "BW_80"); -+ else if (*dm->band_width == CHANNEL_WIDTH_160) -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", "BW_160"); -+ else if (*dm->band_width == CHANNEL_WIDTH_80_80) -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", "BW_80_80"); -+ else -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", -+ "BW_UNKNOWN"); -+#if 0 -+/* -+ * RF_DBG(dm, DBG_RF_IQK, "%-20s: %llu %s\n", -+ * "progressing_time", -+ * dm->rf_calibrate_info.iqk_total_progressing_time, "(ms)"); -+ */ -+#endif -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "rfk_forbidden", -+ (iqk_info->rfk_forbidden) ? "True" : "False"); -+#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || \ -+ RTL8821C_SUPPORT == 1 || RTL8195B_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1||\ -+ RTL8814C_SUPPORT == 1) -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "segment_iqk", -+ (iqk_info->segment_iqk) ? "True" : "False"); -+#endif -+ -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %llu %s\n", "progressing_time", -+ dm->rf_calibrate_info.iqk_progressing_time, "(ms)"); -+ -+ tmp = odm_read_4byte(dm, 0x1bf0); -+ for (rf_path = RF_PATH_A; rf_path <= RF_PATH_B; rf_path++) -+ for (j = 0; j < 2; j++) -+ iqk_result[0][rf_path][j] = (boolean) -+ (tmp & (BIT(rf_path + (j * 4)) >> (rf_path + (j * 4)))); -+ -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: 0x%08x\n", "Reg0x1bf0", tmp); -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: 0x%08x\n", "Reg0x1be8", -+ odm_read_4byte(dm, 0x1be8)); -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "PATH_A-Tx result", -+ (iqk_result[0][RF_PATH_A][0]) ? "Fail" : "Pass"); -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "PATH_A-Rx result", -+ (iqk_result[0][RF_PATH_A][1]) ? "Fail" : "Pass"); -+#if (RTL8822B_SUPPORT == 1) -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "PATH_B-Tx result", -+ (iqk_result[0][RF_PATH_B][0]) ? "Fail" : "Pass"); -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "PATH_B-Rx result", -+ (iqk_result[0][RF_PATH_B][1]) ? "Fail" : "Pass"); -+#endif -+} -+ -+void halrf_lck_dbg(struct dm_struct *dm) -+{ -+ RF_DBG(dm, DBG_RF_IQK, "%-20s\n", "====== LCK Info ======"); -+#if 0 -+ /*RF_DBG(dm, DBG_RF_IQK, "%-20s\n", -+ * (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "LCK" : "RTK")); -+ */ -+#endif -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: %llu %s\n", "progressing_time", -+ dm->rf_calibrate_info.lck_progressing_time, "(ms)"); -+} -+void phydm_get_iqk_cfir(void *dm_void, u8 idx, u8 path, boolean debug) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ phy_get_iqk_cfir_8822b(dm, idx, path, debug); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ phy_get_iqk_cfir_8822c(dm, idx, path, debug); -+ break; -+#endif -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ phy_get_iqk_cfir_8814b(dm, idx, path, debug); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ phy_get_iqk_cfir_8814c(dm, idx, path, debug); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+ -+void halrf_iqk_dbg_cfir_backup(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 path, idx, i; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ phy_iqk_dbg_cfir_backup_8822b(dm); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ phy_iqk_dbg_cfir_backup_8822c(dm); -+ break; -+#endif -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ phy_iqk_dbg_cfir_backup_8814b(dm); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ phy_iqk_dbg_cfir_backup_8814c(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ -+} -+ -+void halrf_iqk_dbg_cfir_backup_update(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk = &dm->IQK_info; -+ u8 i, path, idx; -+ u32 bmask13_12 = BIT(13) | BIT(12); -+ u32 bmask20_16 = BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16); -+ u32 data; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ phy_iqk_dbg_cfir_backup_update_8822b(dm); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ phy_iqk_dbg_cfir_backup_update_8822c(dm); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ phy_iqk_dbg_cfir_backup_update_8814c(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void halrf_iqk_dbg_cfir_reload(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk = &dm->IQK_info; -+ u8 i, path, idx; -+ u32 bmask13_12 = BIT(13) | BIT(12); -+ u32 bmask20_16 = BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16); -+ u32 data; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ phy_iqk_dbg_cfir_reload_8822b(dm); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ phy_iqk_dbg_cfir_reload_8822c(dm); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ phy_iqk_dbg_cfir_reload_8814c(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void halrf_iqk_dbg_cfir_write(void *dm_void, u8 type, u32 path, u32 idx, -+ u32 i, u32 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ phy_iqk_dbg_cfir_write_8822b(dm, type, path, idx, i, data); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ phy_iqk_dbg_cfir_write_8822c(dm, type, path, idx, i, data); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ phy_iqk_dbg_cfir_write_8814c(dm, type, path, idx, i, data); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void halrf_iqk_dbg_cfir_backup_show(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 path, idx, i; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ phy_iqk_dbg_cfir_backup_8822b(dm); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ phy_iqk_dbg_cfir_backup_8822c(dm); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ phy_iqk_dbg_cfir_backup_8814c(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void halrf_do_imr_test(void *dm_void, u8 flag_imr_test) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (flag_imr_test != 0x0) -+ switch (dm->support_ic_type) { -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ do_imr_test_8822b(dm); -+ break; -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ case ODM_RTL8821C: -+ do_imr_test_8821c(dm); -+ break; -+#endif -+ default: -+ break; -+ } -+} -+ -+#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8814C_SUPPORT == 1) -+void halrf_iqk_debug(void *dm_void, u32 *const dm_value, u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if 0 -+ /*dm_value[0]=0x0: backup from SRAM & show*/ -+ /*dm_value[0]=0x1: write backup CFIR to SRAM*/ -+ /*dm_value[0]=0x2: reload default CFIR to SRAM*/ -+ /*dm_value[0]=0x3: show backup*/ -+ /*dm_value[0]=0x10: write backup CFIR real part*/ -+ /*--> dm_value[1]:path, dm_value[2]:tx/rx, dm_value[3]:index, dm_value[4]:data*/ -+ /*dm_value[0]=0x11: write backup CFIR imag*/ -+ /*--> dm_value[1]:path, dm_value[2]:tx/rx, dm_value[3]:index, dm_value[4]:data*/ -+ /*dm_value[0]=0x20 :xym_read enable*/ -+ /*--> dm_value[1]:0:disable, 1:enable*/ -+ /*if dm_value[0]=0x20 = enable, */ -+ /*0x1:show rx_sym; 0x2: tx_xym; 0x3:gs1_xym; 0x4:gs2_sym; 0x5:rxk1_xym*/ -+#endif -+ if (dm_value[0] == 0x0) -+ halrf_iqk_dbg_cfir_backup(dm); -+ else if (dm_value[0] == 0x1) -+ halrf_iqk_dbg_cfir_backup_update(dm); -+ else if (dm_value[0] == 0x2) -+ halrf_iqk_dbg_cfir_reload(dm); -+ else if (dm_value[0] == 0x3) -+ halrf_iqk_dbg_cfir_backup_show(dm); -+ else if (dm_value[0] == 0x10) -+ halrf_iqk_dbg_cfir_write(dm, 0, dm_value[1], dm_value[2], -+ dm_value[3], dm_value[4]); -+ else if (dm_value[0] == 0x11) -+ halrf_iqk_dbg_cfir_write(dm, 1, dm_value[1], dm_value[2], -+ dm_value[3], dm_value[4]); -+ else if (dm_value[0] == 0x20) -+ halrf_iqk_xym_enable(dm, (u8)dm_value[1]); -+ else if (dm_value[0] == 0x21) -+ halrf_iqk_xym_show(dm, (u8)dm_value[1]); -+ else if (dm_value[0] == 0x30) -+ halrf_do_imr_test(dm, (u8)dm_value[1]); -+} -+#endif -+ -+void halrf_iqk_hwtx_check(void *dm_void, boolean is_check) -+{ -+#if 0 -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u32 tmp_b04; -+ -+ if (is_check) { -+ iqk_info->is_hwtx = (boolean)odm_get_bb_reg(dm, R_0xb00, BIT(8)); -+ } else { -+ if (iqk_info->is_hwtx) { -+ tmp_b04 = odm_read_4byte(dm, 0xb04); -+ odm_set_bb_reg(dm, R_0xb04, BIT(3) | BIT(2), 0x0); -+ odm_write_4byte(dm, 0xb04, tmp_b04); -+ } -+ } -+#endif -+} -+#endif -+ -+u8 halrf_match_iqk_version(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ u32 iqk_version = 0; -+ char temp[10] = {0}; -+ -+ odm_move_memory(dm, temp, HALRF_IQK_VER, sizeof(temp)); -+ PHYDM_SSCANF(temp + 2, DCMD_HEX, &iqk_version); -+ -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ if (iqk_version >= 0x24 && (odm_get_hw_img_version(dm) >= 72)) -+ return 1; -+ else if ((iqk_version <= 0x23) && -+ (odm_get_hw_img_version(dm) <= 71)) -+ return 1; -+ else -+ return 0; -+ } -+ -+ if (dm->support_ic_type == ODM_RTL8821C) { -+ if (iqk_version >= 0x18 && (odm_get_hw_img_version(dm) >= 37)) -+ return 1; -+ else -+ return 0; -+ } -+ -+ return 1; -+} -+ -+void halrf_rf_lna_setting(void *dm_void, enum halrf_lna_set type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8188E_SUPPORT == 1) -+ case ODM_RTL8188E: -+ halrf_rf_lna_setting_8188e(dm, type); -+ break; -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ case ODM_RTL8192E: -+ halrf_rf_lna_setting_8192e(dm, type); -+ break; -+#endif -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ halrf_rf_lna_setting_8192f(dm, type); -+ break; -+#endif -+ -+#if (RTL8723B_SUPPORT == 1) -+ case ODM_RTL8723B: -+ halrf_rf_lna_setting_8723b(dm, type); -+ break; -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ case ODM_RTL8812: -+ halrf_rf_lna_setting_8812a(dm, type); -+ break; -+#endif -+#if ((RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1)) -+ case ODM_RTL8881A: -+ case ODM_RTL8821: -+ halrf_rf_lna_setting_8821a(dm, type); -+ break; -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ halrf_rf_lna_setting_8822b(dm_void, type); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ halrf_rf_lna_setting_8822c(dm_void, type); -+ break; -+#endif -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ halrf_rf_lna_setting_8812f(dm_void, type); -+ break; -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ case ODM_RTL8821C: -+ halrf_rf_lna_setting_8821c(dm_void, type); -+ break; -+#endif -+#if (RTL8710C_SUPPORT == 1) -+ case ODM_RTL8710C: -+ halrf_rf_lna_setting_8710c(dm_void, type); -+ break; -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ halrf_rf_lna_setting_8721d(dm, type); -+ break; -+#endif -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void halrf_support_ability_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u32 dm_value[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i; -+ -+ for (i = 0; i < 5; i++) -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 2], DCMD_DECIMAL, &dm_value[i]); -+ -+ if (dm_value[0] == 100) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n[RF Supportability]\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "00. (( %s ))Power Tracking\n", -+ ((rf->rf_supportability & HAL_RF_TX_PWR_TRACK) ? -+ ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "01. (( %s ))IQK\n", -+ ((rf->rf_supportability & HAL_RF_IQK) ? ("V") : -+ ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "02. (( %s ))LCK\n", -+ ((rf->rf_supportability & HAL_RF_LCK) ? ("V") : -+ ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "03. (( %s ))DPK\n", -+ ((rf->rf_supportability & HAL_RF_DPK) ? ("V") : -+ ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "04. (( %s ))HAL_RF_TXGAPK\n", -+ ((rf->rf_supportability & HAL_RF_TXGAPK) ? ("V") : -+ ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "05. (( %s ))HAL_RF_DACK\n", -+ ((rf->rf_supportability & HAL_RF_DACK) ? ("V") : -+ ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "06. (( %s ))DPK_TRACK\n", -+ ((rf->rf_supportability & HAL_RF_DPK_TRACK) ? ("V") : -+ ("."))); -+#ifdef CONFIG_2G_BAND_SHIFT -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "07. (( %s ))HAL_2GBAND_SHIFT\n", -+ ((rf->rf_supportability & HAL_2GBAND_SHIFT) ? ("V") : -+ ("."))); -+#endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "08. (( %s ))HAL_RF_RXDCK\n", -+ ((rf->rf_supportability & HAL_RF_RXDCK) ? ("V") : -+ ("."))); -+ -+ } else { -+ if (dm_value[1] == 1) /* enable */ -+ rf->rf_supportability |= BIT(dm_value[0]); -+ else if (dm_value[1] == 2) /* disable */ -+ rf->rf_supportability &= ~(BIT(dm_value[0])); -+ else -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Warning!!!] 1:enable, 2:disable\n"); -+ } -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\nCurr-RF_supportability = 0x%x\n\n", rf->rf_supportability); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#ifdef CONFIG_2G_BAND_SHIFT -+void halrf_support_band_shift_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ //u32 band_value[2] = {00}; -+ u32 dm_value[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i; -+ -+#if (RTL8192F_SUPPORT == 1) -+ for (i = 0; i < 7; i++) -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 2], DCMD_DECIMAL, &dm_value[i]); -+ -+ if (!(rf->rf_supportability & HAL_2GBAND_SHIFT)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\nCurr-RF_supportability[07. (( . ))HAL_2GBAND_SHIFT]\nNo RF Band Shift,default: 2.4G!\n"); -+ } else { -+ if (dm_value[0] == 01) { -+ rf->rf_shift_band = HAL_RF_2P3; -+ halrf_lck_trigger(dm); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n[rf_shift_band] = %d\nRF Band Shift to 2.3G!\n", -+ rf->rf_shift_band); -+ } else if (dm_value[0] == 02) { -+ rf->rf_shift_band = HAL_RF_2P5; -+ halrf_lck_trigger(dm); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n[rf_shift_band] = %d\nRF Band Shift to 2.5G!\n", -+ rf->rf_shift_band); -+ } else { -+ rf->rf_shift_band = HAL_RF_2P4; -+ halrf_lck_trigger(dm); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n[rf_shift_band] = %d\nNo RF Band Shift,default: 2.4G!\n", -+ rf->rf_shift_band); -+ } -+ } -+ *_used = used; -+ *_out_len = out_len; -+#endif -+} -+#endif -+ -+void halrf_cmn_info_init(void *dm_void, enum halrf_cmninfo_init cmn_info, -+ u32 value) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ switch (cmn_info) { -+ case HALRF_CMNINFO_EEPROM_THERMAL_VALUE: -+ rf->eeprom_thermal = (u8)value; -+ break; -+ case HALRF_CMNINFO_PWT_TYPE: -+ rf->pwt_type = (u8)value; -+ break; -+ case HALRF_CMNINFO_MP_POWER_TRACKING_TYPE: -+ rf->mp_pwt_type = (u8)value; -+ break; -+ default: -+ break; -+ } -+} -+ -+void halrf_cmn_info_hook(void *dm_void, enum halrf_cmninfo_hook cmn_info, -+ void *value) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ switch (cmn_info) { -+ case HALRF_CMNINFO_CON_TX: -+ rf->is_con_tx = (boolean *)value; -+ break; -+ case HALRF_CMNINFO_SINGLE_TONE: -+ rf->is_single_tone = (boolean *)value; -+ break; -+ case HALRF_CMNINFO_CARRIER_SUPPRESSION: -+ rf->is_carrier_suppresion = (boolean *)value; -+ break; -+ case HALRF_CMNINFO_MP_RATE_INDEX: -+ rf->mp_rate_index = (u8 *)value; -+ break; -+ case HALRF_CMNINFO_MANUAL_RF_SUPPORTABILITY: -+ rf->manual_rf_supportability = (u32 *)value; -+ break; -+ default: -+ /*do nothing*/ -+ break; -+ } -+} -+ -+void halrf_cmn_info_set(void *dm_void, u32 cmn_info, u64 value) -+{ -+ /* This init variable may be changed in run time. */ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ switch (cmn_info) { -+ case HALRF_CMNINFO_ABILITY: -+ rf->rf_supportability = (u32)value; -+ break; -+ -+ case HALRF_CMNINFO_DPK_EN: -+ rf->dpk_en = (u8)value; -+ break; -+ case HALRF_CMNINFO_RFK_FORBIDDEN: -+ dm->IQK_info.rfk_forbidden = (boolean)value; -+ break; -+#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || \ -+ RTL8821C_SUPPORT == 1 || RTL8195B_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1||\ -+ RTL8814C_SUPPORT == 1 ) -+ case HALRF_CMNINFO_IQK_SEGMENT: -+ dm->IQK_info.segment_iqk = (boolean)value; -+ break; -+#endif -+ case HALRF_CMNINFO_RATE_INDEX: -+ rf->p_rate_index = (u32)value; -+ break; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ case HALRF_CMNINFO_MP_PSD_POINT: -+ rf->halrf_psd_data.point = (u32)value; -+ break; -+ case HALRF_CMNINFO_MP_PSD_START_POINT: -+ rf->halrf_psd_data.start_point = (u32)value; -+ break; -+ case HALRF_CMNINFO_MP_PSD_STOP_POINT: -+ rf->halrf_psd_data.stop_point = (u32)value; -+ break; -+ case HALRF_CMNINFO_MP_PSD_AVERAGE: -+ rf->halrf_psd_data.average = (u32)value; -+ break; -+#endif -+ case HALRF_CMNINFO_POWER_TRACK_CONTROL: -+ cali_info->txpowertrack_control = (u8)value; -+ break; -+ default: -+ /* do nothing */ -+ break; -+ } -+} -+ -+u64 halrf_cmn_info_get(void *dm_void, u32 cmn_info) -+{ -+ /* This init variable may be changed in run time. */ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u64 return_value = 0; -+ -+ switch (cmn_info) { -+ case HALRF_CMNINFO_ABILITY: -+ return_value = (u32)rf->rf_supportability; -+ break; -+ case HALRF_CMNINFO_RFK_FORBIDDEN: -+ return_value = dm->IQK_info.rfk_forbidden; -+ break; -+#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || \ -+ RTL8821C_SUPPORT == 1 || RTL8195B_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1||\ -+ RTL8814C_SUPPORT == 1) -+ case HALRF_CMNINFO_IQK_SEGMENT: -+ return_value = dm->IQK_info.segment_iqk; -+ break; -+ case HALRF_CMNINFO_IQK_TIMES: -+ return_value = dm->IQK_info.iqk_times; -+ break; -+#endif -+ default: -+ /* do nothing */ -+ break; -+ } -+ -+ return return_value; -+} -+ -+void halrf_supportability_init_mp(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ switch (dm->support_ic_type) { -+ case ODM_RTL8814B: -+#if (RTL8814B_SUPPORT == 1) -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_DACK | -+ /*HAL_RF_TXGAPK |*/ -+ HAL_RF_DPK_TRACK | -+ 0; -+#endif -+ break; -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ /*@HAL_RF_DPK |*/ -+ 0; -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_DACK | -+ HAL_RF_DPK_TRACK | -+ HAL_RF_RXDCK | -+ HAL_RF_TXGAPK | -+ 0; -+ break; -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ case ODM_RTL8821C: -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ /*@HAL_RF_DPK |*/ -+ /*@HAL_RF_TXGAPK |*/ -+ 0; -+ break; -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ /*HAL_RF_TXGAPK |*/ -+ HAL_RF_DPK_TRACK | -+ 0; -+ break; -+#endif -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_DACK | -+ HAL_RF_DPK_TRACK | -+ 0; -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ /*@HAL_RF_TXGAPK |*/ -+ 0; -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ /*@HAL_RF_TXGAPK |*/ -+#ifdef CONFIG_2G_BAND_SHIFT -+ /*@HAL_2GBAND_SHIFT |*/ -+#endif -+ 0; -+ break; -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ /*@HAL_RF_TXGAPK |*/ -+ 0; -+ break; -+#endif -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ /*HAL_RF_LCK |*/ -+ HAL_RF_DPK | -+ /*@HAL_RF_TXGAPK |*/ -+ HAL_RF_DPK_TRACK | -+ 0; -+ break; -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_DPK_TRACK | -+ /*@HAL_RF_TXGAPK |*/ -+ 0; -+ break; -+#endif -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_TXGAPK | -+ HAL_RF_DPK_TRACK | -+ 0; -+ break; -+#endif -+ case ODM_RTL8814C: -+#if (RTL8814C_SUPPORT == 1) -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_DACK | -+ HAL_RF_TXGAPK | -+ HAL_RF_DPK_TRACK | -+ 0; -+#endif -+ break; -+ -+ default: -+ rf->rf_supportability = -+ /*HAL_RF_TX_PWR_TRACK |*/ -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ /*@HAL_RF_DPK |*/ -+ /*@HAL_RF_TXGAPK |*/ -+ 0; -+ break; -+ } -+ -+ RF_DBG(dm, DBG_RF_INIT, -+ "IC = ((0x%x)), RF_Supportability Init MP = ((0x%x))\n", -+ dm->support_ic_type, rf->rf_supportability); -+} -+ -+void halrf_supportability_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ switch (dm->support_ic_type) { -+ case ODM_RTL8814B: -+#if (RTL8814B_SUPPORT == 1) -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_DACK | -+ HAL_RF_DPK_TRACK | -+ 0; -+#endif -+ break; -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ /*@HAL_RF_DPK |*/ -+ 0; -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_DACK | -+ HAL_RF_DPK_TRACK | -+ HAL_RF_RXDCK | -+ HAL_RF_TXGAPK | -+ 0; -+ break; -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ case ODM_RTL8821C: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ /*@HAL_RF_DPK |*/ -+ /*@HAL_RF_TXGAPK |*/ -+ 0; -+ break; -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ /*HAL_RF_TXGAPK |*/ -+ HAL_RF_DPK_TRACK | -+ 0; -+ break; -+#endif -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_DACK | -+ HAL_RF_DPK_TRACK | -+ 0; -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ /*@HAL_RF_TXGAPK |*/ -+ 0; -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ /*@HAL_RF_TXGAPK |*/ -+#ifdef CONFIG_2G_BAND_SHIFT -+ /*@HAL_2GBAND_SHIFT |*/ -+#endif -+ 0; -+ break; -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ /*@HAL_RF_TXGAPK |*/ -+ 0; -+ break; -+#endif -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ /*HAL_RF_LCK |*/ -+ HAL_RF_DPK | -+ /*@HAL_RF_TXGAPK |*/ -+ HAL_RF_DPK_TRACK | -+#ifdef CONFIG_2G_BAND_SHIFT -+ HAL_2GBAND_SHIFT | -+#endif -+ 0; -+ break; -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_DPK_TRACK | -+ /*@HAL_RF_TXGAPK |*/ -+ 0; -+ break; -+#endif -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_TXGAPK | -+ HAL_RF_DPK_TRACK | -+ 0; -+ break; -+#endif -+ case ODM_RTL8814C: -+#if (RTL8814C_SUPPORT == 1) -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ HAL_RF_DPK | -+ HAL_RF_DACK | -+ HAL_RF_DPK_TRACK | -+ HAL_RF_TXGAPK | -+ 0; -+#endif -+ break; -+ -+ default: -+ rf->rf_supportability = -+ HAL_RF_TX_PWR_TRACK | -+ HAL_RF_IQK | -+ HAL_RF_LCK | -+ /*@HAL_RF_DPK |*/ -+ 0; -+ break; -+ } -+ -+ RF_DBG(dm, DBG_RF_INIT, -+ "IC = ((0x%x)), RF_Supportability Init = ((0x%x))\n", -+ dm->support_ic_type, rf->rf_supportability); -+} -+ -+void halrf_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+#if 0 -+ /*RF_DBG(dm, DBG_RF_TMP, "%s\n", __func__);*/ -+#endif -+ if (rf->is_dpk_in_progress || dm->rf_calibrate_info.is_iqk_in_progress || -+ rf->is_tssi_in_progress) -+ return; -+ -+ if (!(dm->support_ic_type & ODM_RTL8723F)) -+ phydm_rf_watchdog(dm); -+ -+ halrf_dpk_track(dm); -+#if (RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8723F){ -+ halrf_xtal_thermal_track(dm); -+ halrf_powertracking_thermal(dm); -+ } -+#endif -+} -+ -+#if 0 -+void -+halrf_iqk_init( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ break; -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ _iq_calibrate_8822b_init(dm); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ _iq_calibrate_8822c_init(dm); -+ break; -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ case ODM_RTL8821C: -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+#endif -+ -+void halrf_rfk_power_save(void *dm_void, boolean is_power_save) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ halrf_rfk_power_save_8822c(dm, is_power_save); -+ break; -+#endif -+ -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ halrf_rfk_power_save_8723f(dm, is_power_save); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+ -+ -+void halrf_reload_iqk(void *dm_void, boolean reset) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 i, ch; -+ u32 tmp; -+ u32 bit_mask_20_16 = BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16); -+ -+ halrf_rfk_power_save(dm, false); -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ iqk_reload_iqk_8822c(dm, reset); -+ break; -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ iqk_reload_iqk_8195b(dm, reset); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ iqk_reload_iqk_8814c(dm, reset); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ halrf_rfk_power_save(dm, true); -+} -+ -+void halrf_rfk_handshake(void *dm_void, boolean is_before_k) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!dm->mp_mode) -+ return; -+ -+ if (*dm->mp_mode) -+ return; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ halrf_rfk_handshake_8822c(dm, is_before_k); -+ break; -+#endif -+#if (RTL8710C_SUPPORT == 1) -+ case ODM_RTL8710C: -+ halrf_rfk_handshake_8710c(dm, is_before_k); -+ break; -+#endif -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ halrf_rfk_handshake_8723f(dm, is_before_k); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void halrf_bbreset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ -+ switch (dm->support_ic_type) { -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ phydm_bb_reset_8814b(dm); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ phydm_bb_reset_8814c(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void halrf_rf_k_connect_trigger(void *dm_void, boolean is_recovery, -+ enum halrf_k_segment_time seg_time) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (!dm->mp_mode) -+ return; -+ -+ if (dm->mp_mode && rf->is_con_tx && rf->is_single_tone && -+ rf->is_carrier_suppresion) { -+ if (*dm->mp_mode & -+ (*rf->is_con_tx || *rf->is_single_tone || -+ *rf->is_carrier_suppresion)) -+ return; -+ } -+#if (RTL8723F_SUPPORT == 1) -+ if(dm->support_ic_type == ODM_RTL8723F) -+ halrf_dis_cca_8723f(dm, true); -+#endif -+ /*[TX GAP K]*/ -+ halrf_txgapk_trigger(dm); -+ -+ /*[LOK, IQK]*/ -+ halrf_segment_iqk_trigger(dm, true, seg_time); -+ -+ /*[TSSI Trk]*/ -+ halrf_tssi_trigger(dm); -+ /*[DPK]*/ -+#if 1 -+ if(dpk_info->is_dpk_by_channel == true) -+ halrf_dpk_trigger(dm); -+ else -+ halrf_dpk_reload(dm); -+#endif -+ //ADDA restore to MP_UI setting; -+ config_halrf_path_adda_setting_trigger(dm); -+ -+ halrf_spur_compensation(dm); -+ -+ halrf_bbreset(dm); -+#if (RTL8723F_SUPPORT == 1) -+ if(dm->support_ic_type == ODM_RTL8723F) -+ halrf_dis_cca_8723f(dm, false); -+#endif -+} -+ -+void config_halrf_path_adda_setting_trigger(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ config_phydm_path_adda_setting_8814b(dm); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ config_phydm_path_adda_setting_8814c(dm); -+#endif -+ -+ -+} -+ -+void halrf_dack_restore(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (!(rf->rf_supportability & HAL_RF_DACK)) -+ return; -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ halrf_dack_restore_8822c(dm); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ //halrf_dack_restore_8814c(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+void halrf_dack_trigger(void *dm_void, boolean force) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ u64 start_time; -+ -+ if (!(rf->rf_supportability & HAL_RF_DACK)) -+ return; -+ -+ start_time = odm_get_current_time(dm); -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ halrf_dac_cal_8822c(dm, force); -+ break; -+#endif -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ halrf_dac_cal_8812f(dm); -+ break; -+#endif -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ halrf_dac_cal_8814b(dm); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ halrf_dac_cal_8814c(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ rf->dpk_progressing_time = odm_get_progressing_time(dm, start_time); -+ RF_DBG(dm, DBG_RF_DACK, "[DACK]DACK progressing_time = %lld ms\n", -+ rf->dpk_progressing_time); -+} -+ -+ -+void halrf_dack_dbg(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ u64 start_time; -+ -+ if (!(rf->rf_supportability & HAL_RF_DACK)) -+ return; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ halrf_dack_dbg_8822c(dm); -+ break; -+#endif -+ default: -+ break; -+ } -+} -+ -+ -+void halrf_segment_iqk_trigger(void *dm_void, boolean clear, -+ boolean segment_iqk) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u64 start_time; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ if (odm_check_power_status(dm) == false) -+ return; -+#endif -+ -+ if (!dm->mp_mode) -+ return; -+ -+ if (dm->mp_mode && rf->is_con_tx && rf->is_single_tone && -+ rf->is_carrier_suppresion) { -+ if (*dm->mp_mode & -+ (*rf->is_con_tx || *rf->is_single_tone || -+ *rf->is_carrier_suppresion)) -+ return; -+ } -+ -+ if (!(rf->rf_supportability & HAL_RF_IQK)) -+ return; -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ if (iqk_info->rfk_forbidden) -+ return; -+ -+ rf->rfk_type = RF01_IQK; -+ halrf_rfk_handshake(dm, true); -+ -+ if (!dm->rf_calibrate_info.is_iqk_in_progress) { -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ dm->rf_calibrate_info.is_iqk_in_progress = true; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ start_time = odm_get_current_time(dm); -+ dm->IQK_info.segment_iqk = segment_iqk; -+ -+ halrf_rfk_power_save(dm, false); -+ switch (dm->support_ic_type) { -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ phy_iq_calibrate_8822b(dm, clear, segment_iqk); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ phy_iq_calibrate_8822c(dm, clear, segment_iqk); -+ break; -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ case ODM_RTL8821C: -+ phy_iq_calibrate_8821c(dm, clear, segment_iqk); -+ break; -+#endif -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ phy_iq_calibrate_8814b(dm, clear, segment_iqk); -+ break; -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ phy_iq_calibrate_8195b(dm, clear, segment_iqk); -+ break; -+#endif -+#if (RTL8710C_SUPPORT == 1) -+ case ODM_RTL8710C: -+ phy_iq_calibrate_8710c(dm, clear, segment_iqk); -+ break; -+#endif -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ phy_iq_calibrate_8198f(dm, clear, segment_iqk); -+ break; -+#endif -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ phy_iq_calibrate_8812f(dm, clear, segment_iqk); -+ break; -+#endif -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ phy_iq_calibrate_8197g(dm, clear, segment_iqk); -+ break; -+#endif -+#if (RTL8188E_SUPPORT == 1) -+ case ODM_RTL8188E: -+ phy_iq_calibrate_8188e(dm, false); -+ break; -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ case ODM_RTL8188F: -+ phy_iq_calibrate_8188f(dm, false); -+ break; -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ case ODM_RTL8192E: -+ phy_iq_calibrate_8192e(dm, false); -+ break; -+#endif -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ phy_iq_calibrate_8197f(dm, false); -+ break; -+#endif -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ phy_iq_calibrate_8192f(dm, false); -+ break; -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ case ODM_RTL8703B: -+ phy_iq_calibrate_8703b(dm, false); -+ break; -+#endif -+#if (RTL8710B_SUPPORT == 1) -+ case ODM_RTL8710B: -+ phy_iq_calibrate_8710b(dm, false); -+ break; -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ case ODM_RTL8723B: -+ phy_iq_calibrate_8723b(dm, false); -+ break; -+#endif -+#if (RTL8723D_SUPPORT == 1) -+ case ODM_RTL8723D: -+ phy_iq_calibrate_8723d(dm, false); -+ break; -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ phy_iq_calibrate_8721d(dm, false); -+ break; -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ case ODM_RTL8812: -+ phy_iq_calibrate_8812a(dm, false); -+ break; -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ case ODM_RTL8821: -+ phy_iq_calibrate_8821a(dm, false); -+ break; -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ case ODM_RTL8814A: -+ phy_iq_calibrate_8814a(dm, false); -+ break; -+#endif -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ phy_iq_calibrate_8723f(dm, false); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ phy_iq_calibrate_8814c(dm, clear, segment_iqk); -+ break; -+#endif -+ -+ -+ default: -+ break; -+ } -+ -+ halrf_rfk_power_save(dm, true); -+ dm->rf_calibrate_info.iqk_progressing_time = -+ odm_get_progressing_time(dm, start_time); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]IQK progressing_time = %lld ms\n", -+ dm->rf_calibrate_info.iqk_progressing_time); -+ -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ dm->rf_calibrate_info.is_iqk_in_progress = false; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ -+ halrf_rfk_handshake(dm, false); -+ } else { -+ RF_DBG(dm, DBG_RF_IQK, -+ "== Return the IQK CMD, because RFKs in Progress ==\n"); -+ } -+} -+ -+ -+void halrf_iqk_trigger(void *dm_void, boolean is_recovery) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u64 start_time; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ if (odm_check_power_status(dm) == false) -+ return; -+#endif -+ -+ if (!dm->mp_mode) -+ return; -+ -+ if (dm->mp_mode && rf->is_con_tx && rf->is_single_tone && -+ rf->is_carrier_suppresion) { -+ if (*dm->mp_mode & -+ (*rf->is_con_tx || *rf->is_single_tone || -+ *rf->is_carrier_suppresion)) -+ return; -+ } -+ -+ if (!(rf->rf_supportability & HAL_RF_IQK)) -+ return; -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+ if (iqk_info->rfk_forbidden) -+ return; -+ -+ rf->rfk_type = RF01_IQK; -+ halrf_rfk_handshake(dm, true); -+ -+ if (!dm->rf_calibrate_info.is_iqk_in_progress) { -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ dm->rf_calibrate_info.is_iqk_in_progress = true; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ start_time = odm_get_current_time(dm); -+ halrf_rfk_power_save(dm, false); -+ switch (dm->support_ic_type) { -+#if (RTL8188E_SUPPORT == 1) -+ case ODM_RTL8188E: -+ phy_iq_calibrate_8188e(dm, is_recovery); -+ break; -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ case ODM_RTL8188F: -+ phy_iq_calibrate_8188f(dm, is_recovery); -+ break; -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ case ODM_RTL8192E: -+ phy_iq_calibrate_8192e(dm, is_recovery); -+ break; -+#endif -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ phy_iq_calibrate_8197f(dm, is_recovery); -+ break; -+#endif -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ phy_iq_calibrate_8192f(dm, is_recovery); -+ break; -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ case ODM_RTL8703B: -+ phy_iq_calibrate_8703b(dm, is_recovery); -+ break; -+#endif -+#if (RTL8710B_SUPPORT == 1) -+ case ODM_RTL8710B: -+ phy_iq_calibrate_8710b(dm, is_recovery); -+ break; -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ case ODM_RTL8723B: -+ phy_iq_calibrate_8723b(dm, is_recovery); -+ break; -+#endif -+#if (RTL8723D_SUPPORT == 1) -+ case ODM_RTL8723D: -+ phy_iq_calibrate_8723d(dm, is_recovery); -+ break; -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ phy_iq_calibrate_8721d(dm, is_recovery); -+ break; -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ case ODM_RTL8812: -+ phy_iq_calibrate_8812a(dm, is_recovery); -+ break; -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ case ODM_RTL8821: -+ phy_iq_calibrate_8821a(dm, is_recovery); -+ break; -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ case ODM_RTL8814A: -+ phy_iq_calibrate_8814a(dm, is_recovery); -+ break; -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ phy_iq_calibrate_8822b(dm, false, false); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ phy_iq_calibrate_8822c(dm, false, false); -+ break; -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ case ODM_RTL8821C: -+ phy_iq_calibrate_8821c(dm, false, false); -+ break; -+#endif -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ phy_iq_calibrate_8814b(dm, false, false); -+ break; -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ phy_iq_calibrate_8195b(dm, false, false); -+ break; -+#endif -+#if (RTL8710C_SUPPORT == 1) -+ case ODM_RTL8710C: -+ phy_iq_calibrate_8710c(dm, false, false); -+ break; -+#endif -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ phy_iq_calibrate_8198f(dm, false, false); -+ break; -+#endif -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ phy_iq_calibrate_8812f(dm, false, false); -+ break; -+#endif -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ phy_iq_calibrate_8197g(dm, false, false); -+ break; -+#endif -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ phy_iq_calibrate_8723f(dm, is_recovery); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ phy_iq_calibrate_8814c(dm, false, false); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ -+ halrf_rfk_power_save(dm, true); -+ rf->iqk_progressing_time = odm_get_progressing_time(dm, start_time); -+ RF_DBG(dm, DBG_RF_LCK, "[IQK]Trigger IQK progressing_time = %lld ms\n", -+ rf->iqk_progressing_time); -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ dm->rf_calibrate_info.is_iqk_in_progress = false; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ -+ halrf_rfk_handshake(dm, false); -+ } else { -+ RF_DBG(dm, DBG_RF_IQK, -+ "== Return the IQK CMD, because RFKs in Progress ==\n"); -+ } -+} -+ -+void halrf_lck_trigger(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u64 start_time; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ if (odm_check_power_status(dm) == false) -+ return; -+#endif -+ -+ if (!dm->mp_mode) -+ return; -+ -+ if (dm->mp_mode && rf->is_con_tx && rf->is_single_tone && -+ rf->is_carrier_suppresion) { -+ if (*dm->mp_mode & -+ (*rf->is_con_tx || *rf->is_single_tone || -+ *rf->is_carrier_suppresion)) -+ return; -+ } -+ -+ if (!(rf->rf_supportability & HAL_RF_LCK)) -+ return; -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ if (iqk_info->rfk_forbidden) -+ return; -+ while (*dm->is_scan_in_process) { -+ RF_DBG(dm, DBG_RF_LCK, "[LCK]scan is in process, bypass LCK\n"); -+ return; -+ } -+ -+ if (!dm->rf_calibrate_info.is_lck_in_progress) { -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ dm->rf_calibrate_info.is_lck_in_progress = true; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ start_time = odm_get_current_time(dm); -+ switch (dm->support_ic_type) { -+#if (RTL8188E_SUPPORT == 1) -+ case ODM_RTL8188E: -+ phy_lc_calibrate_8188e(dm); -+ break; -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ case ODM_RTL8188F: -+ phy_lc_calibrate_8188f(dm); -+ break; -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ case ODM_RTL8192E: -+ phy_lc_calibrate_8192e(dm); -+ break; -+#endif -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ phy_lc_calibrate_8197f(dm); -+ break; -+#endif -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ phy_lc_calibrate_8192f(dm); -+ break; -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ case ODM_RTL8703B: -+ phy_lc_calibrate_8703b(dm); -+ break; -+#endif -+#if (RTL8710B_SUPPORT == 1) -+ case ODM_RTL8710B: -+ phy_lc_calibrate_8710b(dm); -+ break; -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ phy_lc_calibrate_8721d(dm); -+ break; -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ case ODM_RTL8723B: -+ phy_lc_calibrate_8723b(dm); -+ break; -+#endif -+#if (RTL8723D_SUPPORT == 1) -+ case ODM_RTL8723D: -+ phy_lc_calibrate_8723d(dm); -+ break; -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ case ODM_RTL8812: -+ phy_lc_calibrate_8812a(dm); -+ break; -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ case ODM_RTL8821: -+ phy_lc_calibrate_8821a(dm); -+ break; -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ case ODM_RTL8814A: -+ phy_lc_calibrate_8814a(dm); -+ break; -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+ phy_lc_calibrate_8822b(dm); -+ break; -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ phy_lc_calibrate_8822c(dm); -+ break; -+#endif -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ phy_lc_calibrate_8812f(dm); -+ break; -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ case ODM_RTL8821C: -+ phy_lc_calibrate_8821c(dm); -+ break; -+#endif -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ phy_lc_calibrate_8814b(dm); -+ break; -+#endif -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ phy_lc_calibrate_8197g(dm); -+ break; -+#endif -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ phy_lc_calibrate_8198f(dm); -+ break; -+#endif -+#if (RTL8710C_SUPPORT == 1) -+ case ODM_RTL8710C: -+ phy_lc_calibrate_8710c(dm); -+ break; -+#endif -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ phy_lc_calibrate_8723f(dm); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ phy_lc_calibrate_8814c(dm); -+ break; -+#endif -+ -+ -+ default: -+ break; -+ } -+ dm->rf_calibrate_info.lck_progressing_time = -+ odm_get_progressing_time(dm, start_time); -+ RF_DBG(dm, DBG_RF_LCK, "[LCK]LCK progressing_time = %lld ms\n", -+ dm->rf_calibrate_info.lck_progressing_time); -+#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) -+ halrf_lck_dbg(dm); -+#endif -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ dm->rf_calibrate_info.is_lck_in_progress = false; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ } else { -+ RF_DBG(dm, DBG_RF_LCK, -+ "[LCK]= Return the LCK CMD, because RFK is in Progress =\n"); -+ } -+} -+ -+void halrf_aac_check(struct dm_struct *dm) -+{ -+ switch (dm->support_ic_type) { -+#if (RTL8821C_SUPPORT == 1) -+ case ODM_RTL8821C: -+#if 0 -+ aac_check_8821c(dm); -+#endif -+ break; -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ case ODM_RTL8822B: -+#if 1 -+ aac_check_8822b(dm); -+#endif -+ break; -+#endif -+ default: -+ break; -+ } -+} -+ -+void halrf_rxdck(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (!(rf->rf_supportability & HAL_RF_RXDCK)) -+ return; -+ -+ switch (dm->support_ic_type) { -+ case ODM_RTL8822C: -+#if (RTL8822C_SUPPORT == 1) -+ halrf_rxdck_8822c(dm); -+ break; -+#endif -+ default: -+ break; -+ } -+} -+ -+void halrf_x2k_check(struct dm_struct *dm) -+{ -+ -+ switch (dm->support_ic_type) { -+ case ODM_RTL8821C: -+#if (RTL8821C_SUPPORT == 1) -+#endif -+ break; -+ case ODM_RTL8822C: -+#if (RTL8822C_SUPPORT == 1) -+ phy_x2_check_8822c(dm); -+ break; -+#endif -+ case ODM_RTL8812F: -+#if (RTL8812F_SUPPORT == 1) -+ phy_x2_check_8812f(dm); -+ break; -+#endif -+ case ODM_RTL8723F: -+#if (RTL8723F_SUPPORT == 1) -+ phy_x2_check_8723f(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void halrf_set_rfsupportability(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (!dm->mp_mode) -+ return; -+ -+ if (rf->manual_rf_supportability && -+ *rf->manual_rf_supportability != 0xffffffff) { -+ rf->rf_supportability = *rf->manual_rf_supportability; -+ } else if (*dm->mp_mode) { -+ halrf_supportability_init_mp(dm); -+ } else { -+ halrf_supportability_init(dm); -+ } -+} -+ -+void halrf_rfe_definition(struct dm_struct *dm) -+{ -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ switch (dm->support_ic_type) { -+ case ODM_RTL8822C: -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->rfe_type == 21 || dm->rfe_type == 22) { -+ rf->ext_pa_5g = 1; -+ rf->ext_lna_5g = 1; -+ } -+ break; -+#endif -+ default: -+ break; -+ } -+} -+ -+void halrf_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ RF_DBG(dm, DBG_RF_INIT, "HALRF_Init\n"); -+ rf->aac_checked = false; -+ halrf_init_debug_setting(dm); -+ halrf_set_rfsupportability(dm); -+ halrf_rfe_definition(dm); -+#if 1 -+ /*Init all RF funciton*/ -+ halrf_aac_check(dm); -+ halrf_dack_trigger(dm, false); -+ halrf_x2k_check(dm); -+#endif -+ -+ /*power trim, thrmal trim, pa bias*/ -+ phydm_config_new_kfree(dm); -+ -+ /*TSSI Init*/ -+ halrf_tssi_dck(dm, true); -+ halrf_tssi_get_efuse(dm); -+ halrf_tssi_set_de(dm); -+#if (RTL8723F_SUPPORT == 1) -+ halrf_do_tssi(dm); -+ halrf_rx_port_ctl_8723f(dm); -+#endif -+ -+ /*TX Gap K*/ -+ halrf_txgapk_write_gain_table(dm); -+} -+ -+void halrf_dpk_trigger(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ u64 start_time; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ if (odm_check_power_status(dm) == false) -+ return; -+#endif -+ -+ if (!dm->mp_mode) -+ return; -+ -+ if (dm->mp_mode && rf->is_con_tx && rf->is_single_tone && -+ rf->is_carrier_suppresion) { -+ if (*dm->mp_mode & -+ (*rf->is_con_tx || *rf->is_single_tone || -+ *rf->is_carrier_suppresion)) -+ return; -+ } -+ -+ if (!(rf->rf_supportability & HAL_RF_DPK)) -+ return; -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+ if (iqk_info->rfk_forbidden) -+ return; -+ -+ rf->rfk_type = RF03_DPK; -+ halrf_rfk_handshake(dm, true); -+ -+ if (!rf->is_dpk_in_progress) { -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ rf->is_dpk_in_progress = true; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ start_time = odm_get_current_time(dm); -+ halrf_rfk_power_save(dm, false); -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ do_dpk_8822c(dm); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ do_dpk_8814c(dm); -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ do_dpk_8197f(dm); -+ break; -+#endif -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ do_dpk_8192f(dm); -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ do_dpk_8198f(dm); -+ break; -+#endif -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ do_dpk_8812f(dm); -+ break; -+#endif -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ do_dpk_8197g(dm); -+ break; -+#endif -+ -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ do_dpk_8814b(dm); -+ break; -+#endif -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ do_dpk_8723f(dm); -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ do_dpk_8195b(dm); -+ break; -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ do_dpk_8721d(dm); -+ break; -+#endif -+ -+#endif -+ default: -+ break; -+ } -+ halrf_rfk_power_save(dm, true); -+ rf->dpk_progressing_time = odm_get_progressing_time(dm, start_time); -+ RF_DBG(dm, DBG_RF_DPK, "[DPK]DPK progressing_time = %lld ms\n", -+ rf->dpk_progressing_time); -+ -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ rf->is_dpk_in_progress = false; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ -+ halrf_rfk_handshake(dm, false); -+ } else { -+ RF_DBG(dm, DBG_RF_DPK, -+ "== Return the DPK CMD, because RFKs in Progress ==\n"); -+ } -+} -+ -+void halrf_set_dpkbychannel(void *dm_void, boolean dpk_by_ch) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ -+ switch (dm->support_ic_type) { -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ dpk_set_dpkbychannel_8814b(dm, dpk_by_ch); -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ dpk_set_dpkbychannel_8195b(dm,dpk_by_ch); -+ break; -+#endif -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ dpk_set_dpkbychannel_8814c(dm, dpk_by_ch); -+ break; -+#endif -+ -+ default: -+ if (dpk_by_ch) -+ dpk_info->is_dpk_by_channel = 1; -+ else -+ dpk_info->is_dpk_by_channel = 0; -+ break; -+ } -+ -+} -+ -+void halrf_set_dpkenable(void *dm_void, boolean is_dpk_enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ -+ switch (dm->support_ic_type) { -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ dpk_set_is_dpk_enable_8814b(dm, is_dpk_enable); -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ dpk_set_is_dpk_enable_8195b(dm, is_dpk_enable); -+ break; -+#endif -+ -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ dpk_set_is_dpk_enable_8721d(dm, is_dpk_enable); -+ break; -+#endif -+ -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ dpk_set_is_dpk_enable_8814c(dm, is_dpk_enable); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ -+} -+boolean halrf_get_dpkbychannel(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ boolean is_dpk_by_channel = true; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ is_dpk_by_channel = dpk_get_dpkbychannel_8814b(dm); -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ is_dpk_by_channel = dpk_get_dpkbychannel_8195b(dm); -+ break; -+#endif -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ is_dpk_by_channel = dpk_get_dpkbychannel_8814c(dm); -+ break; -+#endif -+ -+ -+ default: -+ break; -+ } -+ return is_dpk_by_channel; -+ -+} -+ -+ -+boolean halrf_get_dpkenable(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ boolean is_dpk_enable = true; -+ -+ -+ switch (dm->support_ic_type) { -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ is_dpk_enable = dpk_get_is_dpk_enable_8814b(dm); -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ is_dpk_enable = dpk_get_is_dpk_enable_8195b(dm); -+ break; -+#endif -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ is_dpk_enable = dpk_get_is_dpk_enable_8814c(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ return is_dpk_enable; -+ -+} -+ -+u8 halrf_dpk_result_check(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ -+ u8 result = 0; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ if (dpk_info->dpk_path_ok == 0x3) -+ result = 1; -+ else -+ result = 0; -+ break; -+#endif -+ -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ if (dpk_info->dpk_path_ok == 0x1) -+ result = 1; -+ else -+ result = 0; -+ break; -+#endif -+ -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ if (dpk_info->dpk_path_ok == 0x1) -+ result = 1; -+ else -+ result = 0; -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ if (dpk_info->dpk_path_ok == 0x3) -+ result = 1; -+ else -+ result = 0; -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ if (dpk_info->dpk_path_ok == 0x3) -+ result = 1; -+ else -+ result = 0; -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ if (dpk_info->dpk_path_ok == 0xf) -+ result = 1; -+ else -+ result = 0; -+ break; -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ if (dpk_info->dpk_path_ok == 0xf) -+ result = 1; -+ else -+ result = 0; -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ if (dpk_info->dpk_path_ok == 0xf) -+ result = 1; -+ else -+ result = 0; -+ break; -+#endif -+ -+ -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ if (dpk_info->dpk_path_ok == 0x3) -+ result = 1; -+ else -+ result = 0; -+ break; -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ if (dpk_info->dpk_path_ok == 0x3) -+ result = 1; -+ else -+ result = 0; -+ break; -+#endif -+ -+#endif -+ default: -+ break; -+ } -+ return result; -+} -+ -+void halrf_dpk_sram_read(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ u8 path, group; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ dpk_coef_read_8822c(dm); -+ break; -+#endif -+ -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ dpk_sram_read_8195b(dm); -+ break; -+#endif -+ -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ dpk_sram_read_8721d(dm); -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ dpk_sram_read_8197f(dm); -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ dpk_sram_read_8192f(dm); -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ dpk_sram_read_8198f(dm); -+ break; -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ dpk_sram_read_8814b(dm); -+ break; -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ dpk_coef_read_8812f(dm); -+ break; -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ dpk_sram_read_8197g(dm); -+ break; -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ dpk_sram_read_8814c(dm); -+ break; -+#endif -+ -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void halrf_dpk_enable_disable(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (!(rf->rf_supportability & HAL_RF_DPK)) -+ return; -+ -+ if (!rf->is_dpk_in_progress) { -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ rf->is_dpk_in_progress = true; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ dpk_enable_disable_8822c(dm); -+ break; -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ dpk_enable_disable_8195b(dm); -+ break; -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ phy_dpk_enable_disable_8721d(dm); -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ phy_dpk_enable_disable_8197f(dm); -+ break; -+#endif -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ phy_dpk_enable_disable_8192f(dm); -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ dpk_enable_disable_8198f(dm); -+ break; -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ dpk_enable_disable_8814b(dm); -+ break; -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ dpk_enable_disable_8812f(dm); -+ break; -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ dpk_enable_disable_8197g(dm); -+ break; -+#endif -+ -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ dpk_enable_disable_8723f(dm); -+ break; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ dpk_enable_disable_8814c(dm); -+ break; -+#endif -+ -+#endif -+ default: -+ break; -+ } -+ -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ rf->is_dpk_in_progress = false; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ } else { -+ RF_DBG(dm, DBG_RF_DPK, -+ "== Return the DPK CMD, because RFKs in Progress ==\n"); -+ } -+} -+ -+void halrf_dpk_track(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (rf->is_dpk_in_progress || dm->rf_calibrate_info.is_iqk_in_progress || -+ dm->is_psd_in_process || (dpk_info->dpk_path_ok == 0) || -+ !(rf->rf_supportability & HAL_RF_DPK_TRACK) || rf->is_tssi_in_progress -+ || rf->is_txgapk_in_progress) -+ return; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*dm->is_fcs_mode_enable) -+ return; -+#endif -+ -+ switch (dm->support_ic_type) { -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ dpk_track_8814b(dm); -+ break; -+#endif -+ -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ dpk_track_8822c(dm); -+ break; -+#endif -+ -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ dpk_track_8195b(dm); -+ break; -+#endif -+ -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ phy_dpk_track_8721d(dm); -+ break; -+#endif -+ -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ dpk_track_8723f(dm); -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ phy_dpk_track_8197f(dm); -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ phy_dpk_track_8192f(dm); -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ dpk_track_8198f(dm); -+ break; -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ dpk_track_8812f(dm); -+ break; -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ dpk_track_8197g(dm); -+ break; -+#endif -+ -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ dpk_track_8814c(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void halrf_set_dpk_track(void *dm_void, u8 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ -+ if (enable) -+ rf->rf_supportability = rf->rf_supportability | HAL_RF_DPK_TRACK; -+ else -+ rf->rf_supportability = rf->rf_supportability & ~HAL_RF_DPK_TRACK; -+} -+ -+void halrf_dpk_reload(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ if (dpk_info->dpk_path_ok > 0) -+ dpk_reload_8195b(dm); -+ break; -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ if (dpk_info->dpk_path_ok > 0) -+ dpk_reload_8721d(dm); -+ break; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#if (RTL8197F_SUPPORT == 1) -+ case ODM_RTL8197F: -+ if (dpk_info->dpk_path_ok > 0) -+ dpk_reload_8197f(dm); -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ case ODM_RTL8192F: -+ if (dpk_info->dpk_path_ok > 0) -+ dpk_reload_8192f(dm); -+ -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT == 1) -+ case ODM_RTL8198F: -+ if (dpk_info->dpk_path_ok > 0) -+ dpk_reload_8198f(dm); -+ break; -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ if (dpk_info->dpk_path_ok > 0) -+ dpk_reload_8814b(dm); -+ break; -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ if (dpk_info->dpk_path_ok > 0) -+ dpk_reload_8814c(dm); -+ break; -+#endif -+ -+ -+#endif -+ default: -+ break; -+ } -+} -+ -+void halrf_dpk_switch(void *dm_void, u8 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (enable) { -+ rf->rf_supportability = rf->rf_supportability | HAL_RF_DPK; -+ dpk_info->is_dpk_enable = true; -+ halrf_dpk_enable_disable(dm); -+ halrf_dpk_trigger(dm); -+ halrf_set_dpk_track(dm, 1); -+ } else { -+ halrf_set_dpk_track(dm, 0); -+ dpk_info->is_dpk_enable = false; -+ halrf_dpk_enable_disable(dm); -+ rf->rf_supportability = rf->rf_supportability & ~HAL_RF_DPK; -+ } -+} -+ -+void _halrf_dpk_info_by_chip(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ dpk_info_by_8822c(dm, &used, output, &out_len); -+ break; -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ case ODM_RTL8812F: -+ dpk_info_by_8812f(dm, &used, output, &out_len); -+ break; -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ case ODM_RTL8197G: -+ dpk_info_by_8197g(dm, &used, output, &out_len); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void _halrf_display_dpk_info(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ char *ic_name = NULL; -+ u8 path; -+ -+ switch (dm->support_ic_type) { -+ -+#if (RTL8822C_SUPPORT) -+ case ODM_RTL8822C: -+ ic_name = "8822C"; -+ break; -+#endif -+ -+#if (RTL8814B_SUPPORT) -+ case ODM_RTL8814B: -+ ic_name = "8814B"; -+ break; -+#endif -+ -+#if (RTL8812F_SUPPORT) -+ case ODM_RTL8812F: -+ ic_name = "8812F"; -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT) -+ case ODM_RTL8198F: -+ ic_name = "8198F"; -+ break; -+#endif -+ -+#if (RTL8197F_SUPPORT) -+ case ODM_RTL8197F: -+ ic_name = "8197F"; -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ case ODM_RTL8192F: -+ ic_name = "8192F"; -+ break; -+#endif -+ -+#if (RTL8197G_SUPPORT) -+ case ODM_RTL8197G: -+ ic_name = "8197G"; -+ break; -+#endif -+ -+#if (RTL8710B_SUPPORT) -+ case ODM_RTL8721D: -+ ic_name = "8721D"; -+ break; -+#endif -+ -+#if (RTL8195B_SUPPORT) -+ case ODM_RTL8195B: -+ ic_name = "8195B"; -+ break; -+#endif -+#if (RTL8814C_SUPPORT) -+ case ODM_RTL8814C: -+ ic_name = "8814C"; -+ break; -+#endif -+ default: -+ break; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n===============[ DPK info %s ]===============\n", ic_name); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %s %s\n", -+ "DPK type", (dm->fw_offload_ability & PHYDM_RF_DPK_OFFLOAD) ? "FW" : "Driver", -+ (dpk_info->is_dpk_by_channel) ? "(By channel)" : "(By group)"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %d (%d)\n", -+ "FW Ver (Sub Ver)", dm->fw_version, dm->fw_sub_version); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %s\n", -+ "DPK Ver", HALRF_DPK_VER); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %s\n", -+ "RFK init ver", HALRF_RFK_INIT_VER); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %d / %d (RFE type:%d)\n", -+ "Ext_PA 2G / 5G", dm->ext_pa, dm->ext_pa_5g, dm->rfe_type); -+ -+ if ((dpk_info->dpk_ch == 0) && (dpk_info->thermal_dpk[0] == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, "\n %-25s\n", -+ "No DPK had been done before!!!"); -+ return; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %d / %d / %d\n", -+ "DPK Cal / OK / Reload", dpk_info->dpk_cal_cnt, dpk_info->dpk_ok_cnt, -+ dpk_info->dpk_reload_cnt); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %s\n", -+ "RFK H2C timeout", (rf->is_rfk_h2c_timeout) ? "Yes" : "No"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %s\n", -+ "DPD Reload", (dpk_info->dpk_status & BIT(0)) ? "Yes" : "No"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %s\n", -+ "DPD status", dpk_info->is_dpk_enable ? "Enable" : "Disable"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %s\n", -+ "DPD track status", (rf->rf_supportability & HAL_RF_DPK_TRACK) ? "Enable" : "Disable"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %s / %s / %d / %s\n", -+ "TSSI / Band / CH / BW", dpk_info->is_tssi_mode == 1 ? "On" : "Off", -+ dpk_info->dpk_band == 0 ? "2G" : "5G", dpk_info->dpk_ch, -+ dpk_info->dpk_bw == 3 ? "20M" : (dpk_info->dpk_bw == 2 ? "40M" : "80M")); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %s / %s / %s / %s\n", -+ "DPK result (path)", dpk_info->dpk_path_ok & BIT(0) ? "OK" : "Fail", -+ (dm->support_ic_type & ODM_IC_2SS) ? ((dpk_info->dpk_path_ok & BIT(1)) >> 1 ? "OK" : "Fail") : "NA", -+ (dm->support_ic_type & ODM_IC_3SS) ? ((dpk_info->dpk_path_ok & BIT(2)) >> 2 ? "OK" : "Fail") : "NA", -+ (dm->support_ic_type & ODM_IC_4SS) ? ((dpk_info->dpk_path_ok & BIT(3)) >> 3 ? "OK" : "Fail") : "NA"); -+#if 0 -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = %d / %d / %d / %d\n", -+ "DPK thermal (path)", dpk_info->thermal_dpk[0], dpk_info->thermal_dpk[1], -+ dpk_info->thermal_dpk[2], dpk_info->thermal_dpk[3]); -+#endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = ", -+ "DPK thermal (path)"); -+ for (path = 0; path < KPATH; path++) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ path == (KPATH - 1) ? "%d\n" : "%d / ", -+ dpk_info->thermal_dpk[path]); -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = 0x%x\n", -+ "DPK bkup GNT control", dpk_info->gnt_control); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-25s = 0x%x\n", -+ "DPK bkup GNT value", dpk_info->gnt_value); -+ -+ _halrf_dpk_info_by_chip(dm, &used, output, &out_len); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void halrf_dpk_debug_cmd(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ -+ char *cmd[5] = {"-h", "on", "off", "info", "switch"}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i; -+ -+ if ((strcmp(input[2], cmd[4]) != 0)) { -+ if (!(rf->rf_supportability & HAL_RF_DPK)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DPK is Unsupported!!!\n"); -+ return; -+ } -+ } -+ -+ if ((strcmp(input[2], cmd[0]) == 0)) { -+ for (i = 1; i < 4; i++) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %s\n", cmd[i]); -+ } -+ } else if ((strcmp(input[2], cmd[1]) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DPK is Enabled!!\n"); -+ dpk_info->is_dpk_enable = true; -+ halrf_dpk_enable_disable(dm); -+ } else if ((strcmp(input[2], cmd[2]) == 0)){ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DPK is Disabled!!\n"); -+ dpk_info->is_dpk_enable = false; -+ halrf_dpk_enable_disable(dm); -+ } else if ((strcmp(input[2], cmd[3]) == 0)) -+ _halrf_display_dpk_info(dm, &used, output, &out_len); -+ else if ((strcmp(input[2], cmd[4]) == 0) && (strcmp(input[3], cmd[1]) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DPK Switch on!!\n"); -+ halrf_dpk_switch(dm, 1); -+ } else if ((strcmp(input[2], cmd[4]) == 0) && (strcmp(input[3], cmd[2]) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DPK Switch off!!\n"); -+ halrf_dpk_switch(dm, 0); -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DPK Trigger start!!\n"); -+ halrf_dpk_trigger(dm); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DPK Trigger finish!!\n"); -+ } -+} -+ -+void halrf_dpk_c2h_report_transfer(void *dm_void, boolean is_ok, u8 *buf, u8 buf_size) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ -+ if (!(rf->rf_supportability & HAL_RF_DPK)) -+ return; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ dpk_c2h_report_transfer_8822c(dm, is_ok, buf, buf_size); -+ break; -+#endif -+ default: -+ break; -+ } -+} -+ -+void halrf_dpk_info_rsvd_page(void *dm_void, u8 *buf, u32 *buf_size) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct dm_dpk_info *dpk_info = &dm->dpk_info; -+ -+ if (!(rf->rf_supportability & HAL_RF_DPK) || rf->is_dpk_in_progress) -+ return; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ dpk_info_rsvd_page_8822c(dm, buf, buf_size); -+ break; -+#endif -+ default: -+ break; -+ } -+} -+ -+void halrf_iqk_info_rsvd_page(void *dm_void, u8 *buf, u32 *buf_size) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (!(rf->rf_supportability & HAL_RF_IQK)) -+ return; -+ -+ if (dm->rf_calibrate_info.is_iqk_in_progress) -+ return; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ iqk_info_rsvd_page_8822c(dm, buf, buf_size); -+ break; -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ iqk_info_rsvd_page_8195b(dm, buf, buf_size); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+enum hal_status -+halrf_config_rfk_with_header_file(void *dm_void, u32 config_type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ enum hal_status result = HAL_STATUS_SUCCESS; -+#if 0 -+#if (RTL8822B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ if (config_type == CONFIG_BB_RF_CAL_INIT) -+ odm_read_and_config_mp_8822b_cal_init(dm); -+ } -+#endif -+#endif -+#if (RTL8197G_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197G) { -+ if (config_type == CONFIG_BB_RF_CAL_INIT) -+ odm_read_and_config_mp_8197g_cal_init(dm); -+ } -+#endif -+#if (RTL8198F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8198F) { -+ if (config_type == CONFIG_BB_RF_CAL_INIT) -+ odm_read_and_config_mp_8198f_cal_init(dm); -+ } -+#endif -+#if (RTL8812F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8812F) { -+ if (config_type == CONFIG_BB_RF_CAL_INIT) -+ odm_read_and_config_mp_8812f_cal_init(dm); -+ } -+#endif -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822C) { -+ if (config_type == CONFIG_BB_RF_CAL_INIT) -+ odm_read_and_config_mp_8822c_cal_init(dm); -+ } -+#endif -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814B) { -+ if (config_type == CONFIG_BB_RF_CAL_INIT) -+ odm_read_and_config_mp_8814b_cal_init(dm); -+ } -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195B) { -+ if (config_type == CONFIG_BB_RF_CAL_INIT) -+ odm_read_and_config_mp_8195b_cal_init(dm); -+ } -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8721D) { -+ if (config_type == CONFIG_BB_RF_CAL_INIT) -+ odm_read_and_config_mp_8721d_cal_init(dm); -+ } -+#endif -+#if (RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8723F) { -+ if (config_type == CONFIG_BB_RF_CAL_INIT) -+ odm_read_and_config_mp_8723f_cal_init(dm); -+ } -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814C) { -+ if (config_type == CONFIG_BB_RF_CAL_INIT) -+ odm_read_and_config_mp_8814c_cal_init(dm); -+ } -+#endif -+ -+ -+#if 1 -+ if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { -+ result = phydm_set_reg_by_fw(dm, PHYDM_HALMAC_CMD_END, 0, 0, 0, (enum rf_path)0, 0); -+ RF_DBG(dm, DBG_RF_IQK,"phy param offload end!result = %d", result); -+ } -+#endif -+ return result; -+} -+ -+void halrf_txgapk_trigger(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u64 start_time = 0x0; -+ -+ if (!(rf->rf_supportability & HAL_RF_TXGAPK)) -+ return; -+ -+ rf->rfk_type = RF04_TXGAPK; -+ halrf_rfk_handshake(dm, true); -+ -+ start_time = odm_get_current_time(dm); -+ rf->is_txgapk_in_progress = true; -+ halrf_rfk_power_save(dm, false); -+ -+ switch (dm->support_ic_type) { -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+#if (RTL8195B_SUPPORT == 1) -+ case ODM_RTL8195B: -+ /*phy_txgap_calibrate_8195b(dm, false);*/ -+ break; -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ case ODM_RTL8721D: -+ /*phy_txgap_calibrate_8721d(dm, false);*/ -+ break; -+#endif -+ -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ case ODM_RTL8814B: -+ /*phy_txgap_calibrate_8814b(dm, false);*/ -+ break; -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+ case ODM_RTL8814C: -+ halrf_txgapk_8814c(dm); -+ break; -+#endif -+ -+ -+#if (RTL8822C_SUPPORT == 1) -+ case ODM_RTL8822C: -+ halrf_txgapk_8822c(dm); -+ break; -+#endif -+ -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ halrf_txgapk_8723f(dm); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ halrf_rfk_power_save(dm, true); -+ rf->is_txgapk_in_progress = false; -+ -+ halrf_rfk_handshake(dm, false); -+ -+ rf->dpk_progressing_time = -+ odm_get_progressing_time(dm_void, start_time); -+ RF_DBG(dm, DBG_RF_TXGAPK, "[TGGC]TXGAPK progressing_time = %lld ms\n", -+ rf->dpk_progressing_time); -+} -+ -+void halrf_spur_compensation(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8723F_SUPPORT == 1) -+ case ODM_RTL8723F: -+ halrf_rfk_power_save(dm, false); -+ halrf_spur_compensation_8723f(dm); -+ halrf_rfk_power_save(dm, true); -+ break; -+#endif -+ default: -+ break; -+ } -+} -+ -+void halrf_tssi_get_efuse(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ halrf_tssi_get_efuse_8822c(dm); -+ halrf_get_efuse_thermal_pwrtype_8822c(dm); -+ } -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8812F) { -+ halrf_tssi_get_efuse_8812f(dm); -+ } -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) { -+ halrf_tssi_get_efuse_8814b(dm); -+ halrf_get_efuse_thermal_pwrtype_8814b(dm); -+ } -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8197G) { -+ halrf_tssi_get_efuse_8197g(dm); -+ } -+#endif -+ -+#if (RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ halrf_tssi_get_efuse_8723f(dm); -+ } -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) { -+ halrf_tssi_get_efuse_8814c(dm); -+ halrf_get_efuse_thermal_pwrtype_8814c(dm); -+ } -+#endif -+ -+} -+ -+void halrf_do_rxbb_dck(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814B) -+ halrf_do_rxbb_dck_8814b(dm); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814C) -+ halrf_do_rxbb_dck_8814c(dm); -+#endif -+ -+ -+} -+ -+void halrf_do_tssi(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822C) -+ halrf_do_tssi_8822c(dm); -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8812F) -+ halrf_do_tssi_8812f(dm); -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197G) -+ halrf_do_tssi_8197g(dm); -+#endif -+ -+#if (RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8723F) { -+ halrf_rfk_power_save(dm, false); -+ halrf_do_tssi_8723f(dm); -+ halrf_rfk_power_save(dm, true); -+ } -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814C) -+ halrf_tssi_trigger_bit_reset_8814c(dm); -+#endif -+ -+} -+ -+u8 halrf_do_tssi_by_manual(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ return halrf_do_tssi_8814b(dm, path); -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ return halrf_do_tssi_8814c(dm, path); -+#endif -+ -+ return 0; -+} -+ -+void halrf_set_tssi_enable(void *dm_void, boolean enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ -+ if (enable == 1) { -+ rf->power_track_type = 4; -+ odm_set_bb_reg(dm, R_0x1e7c, 0x40000000, 0x1); -+ } else { -+ rf->power_track_type = 0; -+ odm_set_bb_reg(dm, R_0x1e7c, 0x40000000, 0x0); -+ } -+} -+ -+ -+void halrf_do_thermal(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ halrf_do_thermal_8822c(dm); -+#endif -+} -+ -+ -+ -+u32 halrf_set_tssi_value(void *dm_void, u32 tssi_value) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ return halrf_set_tssi_value_8822c(dm, tssi_value); -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ return halrf_set_tssi_value_8814b(dm, tssi_value); -+#endif -+#if (RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8723F) -+ return halrf_tssi_set_de_8723f(dm, tssi_value); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ return halrf_set_tssi_value_8814c(dm, tssi_value); -+#endif -+ -+ return 0; -+} -+ -+void halrf_set_tssi_power(void *dm_void, s8 power) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ /*halrf_set_tssi_poewr_8822c(dm, power);*/ -+#endif -+} -+ -+void halrf_tssi_set_de_for_tx_verify(void *dm_void, u32 tssi_de, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ halrf_tssi_set_de_for_tx_verify_8822c(dm, tssi_de, path); -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ halrf_tssi_set_de_for_tx_verify_8814b(dm, tssi_de, path); -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8812F) -+ halrf_tssi_set_de_for_tx_verify_8812f(dm, tssi_de, path); -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8197G) -+ halrf_tssi_set_de_for_tx_verify_8197g(dm, tssi_de, path); -+#endif -+ -+#if (RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8723F) -+ halrf_tssi_set_de_for_tx_verify_8723f(dm, tssi_de, path); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ halrf_tssi_set_de_for_tx_verify_8814c(dm, tssi_de, path); -+#endif -+ -+} -+ -+u32 halrf_tssi_turn_target_power(void *dm_void, s16 power_offset, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 pout = 0; -+ -+ if (dm->mp_mode) { -+ if (*dm->mp_mode) { -+#if (RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8723F) -+ pout = halrf_tssi_set_powerbyrate_pout_8723f(dm, power_offset, path); -+#endif -+ } -+ } -+ return pout; -+} -+ -+void halrf_tssi_set_power_offset(void *dm_void, s16 power_offset, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8723F) -+ _halrf_tssi_set_powerlevel_8723f(dm, power_offset, path); -+#endif -+ -+} -+ -+u32 halrf_query_tssi_value(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ return halrf_query_tssi_value_8822c(dm); -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ return halrf_query_tssi_value_8814b(dm); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ return halrf_query_tssi_value_8814c(dm); -+#endif -+ -+ return 0; -+} -+ -+void halrf_tssi_cck(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ /*halrf_tssi_cck_8822c(dm);*/ -+ if (dm->support_ic_type & ODM_RTL8822C) -+ halrf_thermal_cck_8822c(dm); -+#endif -+ -+} -+ -+void halrf_thermal_cck(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ halrf_thermal_cck_8822c(dm); -+#endif -+ -+} -+ -+void halrf_tssi_set_de(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ halrf_tssi_set_de_8814b(dm); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ halrf_tssi_set_de_8814c(dm); -+#endif -+ -+} -+ -+void halrf_tssi_dck(void *dm_void, u8 direct_do) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ halrf_rfk_handshake(dm, true); -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if (dm->rfe_type == 1 || dm->rfe_type == 4 || dm->rfe_type == 5) -+ return; -+#else -+ if (dm->rfe_type == 1 || dm->rfe_type == 6) -+ return; -+#endif -+ halrf_tssi_dck_8814b(dm, direct_do); -+ } -+#endif -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ halrf_tssi_dck_8822c(dm); -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8812F) -+ halrf_tssi_dck_8812f(dm); -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197G) -+ halrf_tssi_dck_8197g(dm); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if (dm->rfe_type == 1 || dm->rfe_type == 4 || dm->rfe_type == 5) -+ return; -+#else -+ if (dm->rfe_type == 1 || dm->rfe_type == 6) -+ return; -+#endif -+ halrf_tssi_dck_8814c(dm, direct_do); -+ } -+#endif -+ -+ -+ halrf_rfk_handshake(dm, false); -+ -+} -+ -+void halrf_calculate_tssi_codeword(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ halrf_calculate_tssi_codeword_8814b(dm, RF_PATH_A); -+#endif -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ halrf_calculate_tssi_codeword_8822c(dm); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ halrf_calculate_tssi_codeword_8814c(dm, RF_PATH_A); -+#endif -+ -+} -+ -+void halrf_set_tssi_codeword(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ halrf_set_tssi_codeword_8814b(dm, tssi->tssi_codeword); -+#endif -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ halrf_set_tssi_codeword_8822c(dm, tssi->tssi_codeword); -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ halrf_set_tssi_codeword_8814c(dm, tssi->tssi_codeword); -+#endif -+ -+} -+ -+u8 halrf_get_tssi_codeword_for_txindex(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return 80; -+#else -+ return 60; -+#endif -+ } -+#endif -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ return 64; -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8812F) -+ return 100; -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8197G) -+ return 100; -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return 80; -+#else -+ return 60; -+#endif -+ } -+#endif -+ return 60; -+} -+ -+void halrf_tssi_clean_de( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8812F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8812F) -+ halrf_tssi_clean_de_8812f(dm); -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ halrf_tssi_clean_de_8814b(dm); -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8197G) -+ halrf_tssi_clean_de_8197g(dm); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ halrf_tssi_clean_de_8814c(dm); -+#endif -+} -+ -+u32 halrf_tssi_trigger_de(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8812F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8812F) -+ return halrf_tssi_trigger_de_8812f(dm, path); -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ return halrf_tssi_trigger_de_8814b(dm, path); -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8197G) -+ return halrf_tssi_trigger_de_8197g(dm, path); -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ return halrf_tssi_trigger_de_8814c(dm, path); -+#endif -+ return 0; -+} -+ -+u32 halrf_tssi_get_de(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ return halrf_tssi_get_de_8822c(dm, path); -+#endif -+ -+#if (RTL8812F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8812F) -+ return halrf_tssi_get_de_8812f(dm, path); -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ return halrf_tssi_get_de_8814b(dm, path); -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8197G) -+ return halrf_tssi_get_de_8197g(dm, path); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ return halrf_tssi_get_de_8814c(dm, path); -+#endif -+ return 0; -+} -+ -+u32 halrf_get_online_tssi_de(void *dm_void, u8 path, s32 pout) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8723F) -+ return halrf_get_online_tssi_de_8723f(dm, path, pout); -+#endif -+ return 0; -+} -+ -+void halrf_tssi_trigger(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ if (*dm->mp_mode == 1) { -+ if (cali_info->txpowertrack_control == 0 || -+ cali_info->txpowertrack_control == 1) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[TSSI]======>%s MP Mode UI chose thermal tracking. return !!!\n", __func__); -+ return; -+ } -+ } else { -+ if (rf->power_track_type >= 0 && rf->power_track_type <= 3) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[TSSI]======>%s Normal Mode efues is thermal tracking. return !!!\n", __func__); -+ return; -+ } -+ } -+#endif -+ -+ halrf_calculate_tssi_codeword(dm); -+ halrf_set_tssi_codeword(dm); -+ halrf_tssi_dck(dm, false); -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ halrf_tssi_get_efuse(dm); -+#endif -+ halrf_tssi_set_de(dm); -+ halrf_do_tssi(dm); -+} -+ -+void halrf_txgapk_write_gain_table(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ halrf_txgapk_save_all_tx_gain_table_8822c(dm); -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ halrf_txgapk_save_all_tx_gain_table_8814c(dm); -+#endif -+ -+} -+ -+void halrf_txgapk_reload_tx_gain(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8822C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ halrf_txgapk_reload_tx_gain_8822c(dm); -+#endif -+/* -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ halrf_txgapk_reload_tx_gain_8814c(dm); -+#endif -+*/ -+} -+ -+void halrf_txgap_enable_disable(void *dm_void, u8 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ -+ if (enable) { -+ rf->rf_supportability = rf->rf_supportability | HAL_RF_TXGAPK; -+ halrf_txgapk_trigger(dm); -+ } else { -+ rf->rf_supportability = rf->rf_supportability & ~HAL_RF_TXGAPK; -+ halrf_txgapk_reload_tx_gain(dm); -+ } -+} -+ -+#if (RTL8723F_SUPPORT == 1) -+s8 _halrf_get_power_offset_by_thermal_8723f(void *dm_void, u8 path, s8 thermal_detla) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ u8 channel = *dm->channel; -+ u8 tx_rate = phydm_get_tx_rate(dm); -+ s8 power_offset = 0; -+ u8 i = 0; -+ u8 thermal_up_a[DELTA_SWINGIDX_SIZE] = {0}, thermal_down_a[DELTA_SWINGIDX_SIZE] = {0}; -+ u8 thermal_up_b[DELTA_SWINGIDX_SIZE] = {0}, thermal_down_b[DELTA_SWINGIDX_SIZE] = {0}; -+ u8 txagc_offset_2g_cck_a_p[] = { -+ 0, 0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 4, 5, 5, 5, -+ 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6}; -+ u8 txagc_offset_2g_cck_a_n[] = { -+ 0, 0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 4, 5, 5, 5, -+ 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6}; -+ u8 txagc_offset_2g_cck_b_p[] = { -+ 0, 0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 4, 5, 5, -+ 5, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6}; -+ u8 txagc_offset_2g_cck_b_n[] = { -+ 0, 0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 4, 5, -+ 5, 5, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6}; -+ u8 txagc_offset_2ga_p[] = { -+ 0, 0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, -+ 6, 6, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+ u8 txagc_offset_2ga_n[] = { -+ 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, -+ 5, 5, 5, 5, 5, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6}; -+ u8 txagc_offset_2gb_p[] = { -+ 0, 0, 1, 1, 2, 2, 2, 3, 3, 3, 3, 4, 4, 4, 5, -+ 5, 6, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+ u8 txagc_offset_2gb_n[] = { -+ 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, -+ 5, 5, 5, 5, 5, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6}; -+ u8 txagc_offset_5ga_n[][30] = { -+ {0, 0, 2, 2, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, -+ 6, 7, 7, 7, 7, 7, 8, 8, 8, 8, 8, 8, 8}, -+ {0, 0, 2, 2, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, -+ 6, 7, 7, 7, 7, 7, 8, 8, 8, 8, 8, 8, 8}, -+ {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, -+ 6, 7, 7, 7, 7, 7, 8, 8, 8, 8, 8, 8, 8}, -+ }; -+ u8 txagc_offset_5ga_p[][30] = { -+ {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 6, 6, 6, 6, 8, -+ 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8}, -+ {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 6, 6, 6, 6, 8, -+ 8, 8, 9, 9, 9, 9, 9, 9, 9, 9, 9, 9, 9}, -+ {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 6, 6, 6, 6, 7, 7, 8, -+ 8, 8, 9, 9, 9, 9, 9, 9, 9, 9, 9, 9, 9}, -+ }; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"[RF][TSSI] ======>%s\n", __func__); -+ -+ if (channel >= 1 && channel <= 14) { -+ if (IS_CCK_RATE(tx_rate)) { -+ odm_move_memory(dm, thermal_up_a, txagc_offset_2g_cck_a_p, sizeof(thermal_up_a)); -+ odm_move_memory(dm, thermal_down_a, txagc_offset_2g_cck_a_n, sizeof(thermal_down_a)); -+ odm_move_memory(dm, thermal_up_b, txagc_offset_2g_cck_b_p, sizeof(thermal_up_b)); -+ odm_move_memory(dm, thermal_down_b, txagc_offset_2g_cck_b_n, sizeof(thermal_down_b)); -+ } else { -+ odm_move_memory(dm, thermal_up_a, txagc_offset_2ga_p, sizeof(thermal_up_a)); -+ odm_move_memory(dm, thermal_down_a, txagc_offset_2ga_n, sizeof(thermal_down_a)); -+ odm_move_memory(dm, thermal_up_b, txagc_offset_2gb_p, sizeof(thermal_up_b)); -+ odm_move_memory(dm, thermal_down_b, txagc_offset_2gb_n, sizeof(thermal_down_b)); -+ } -+ } -+ -+ if (channel >= 36 && channel <= 64) { -+ odm_move_memory(dm, thermal_up_a, txagc_offset_5ga_p[0], sizeof(thermal_up_a)); -+ odm_move_memory(dm, thermal_down_a, txagc_offset_5ga_n[0], sizeof(thermal_down_a)); -+ } else if (channel >= 100 && channel <= 144) { -+ odm_move_memory(dm, thermal_up_a, txagc_offset_5ga_p[1], sizeof(thermal_up_a)); -+ odm_move_memory(dm, thermal_down_a, txagc_offset_5ga_n[1], sizeof(thermal_down_a)); -+ } else if (channel >= 149 && channel <= 177) { -+ odm_move_memory(dm, thermal_up_a, txagc_offset_5ga_p[2], sizeof(thermal_up_a)); -+ odm_move_memory(dm, thermal_down_a, txagc_offset_5ga_n[2], sizeof(thermal_down_a)); -+ } -+ -+ if(thermal_detla < 0) { -+ if (thermal_detla < -29) -+ i = 29; -+ else -+ i = (u8)(-1 * thermal_detla); -+ -+ if (path ==0 ) -+ power_offset = thermal_down_a[i]; -+ else -+ power_offset = thermal_down_b[i]; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"[RF][TSSI] Temp is lower\n"); -+ } else { -+ if (thermal_detla >= 30) -+ i = 29; -+ else -+ i = thermal_detla; -+ -+ if (path ==0 ) -+ power_offset = thermal_up_a[i]; -+ else -+ power_offset = thermal_up_b[i]; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"[RF][TSSI] Temp is higher\n"); -+ } -+ -+ return power_offset; -+} -+ -+void halrf_powertracking_thermal(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ s8 thermal_value = 0, thermal_detla = 0; -+ s8 power_offset0 = 0, power_offset1 = 0; -+ u8 thermal_base = 0, temp[2] = {0}; -+ u8 path; -+ u8 rate = phydm_get_tx_rate(dm); -+ //RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"[RF][TSSI] ======>%s\n", __func__); -+ -+ if(rf->is_tssi_in_progress == 1) -+ return; -+ if (*dm->mp_mode == 1) { -+ if (cali_info->txpowertrack_control <= 2) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"[RF][TSSI] return!! txpowertrack_control = %d\n", -+ cali_info->txpowertrack_control); -+ return; -+ } -+ } else { -+ if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][TSSI] ===>is_txpowertracking is false, return!!\n"); -+ return; -+ } -+ } -+ -+ if (odm_get_bb_reg(dm, R_0x4318, BIT30) == 1){ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"[RF][TSSI] return!! txpowertrack_control = %d, 0x4318 = 0x%x\n", -+ cali_info->txpowertrack_control,odm_get_bb_reg(dm, R_0x4318, MASKDWORD)); -+ return; -+ } -+ path = (u8)odm_get_bb_reg(dm, 0x1884, BIT(20)); -+ thermal_base = tssi->thermal_cal; -+ thermal_value = (s8)odm_get_rf_reg(dm, 0, RF_0x42, 0x7E);/*path0*/ -+ thermal_detla = (s8)(thermal_value - thermal_base); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "[RF][TSSI] thermal_value = 0x%x, thermal_base = 0x%x\n", -+ thermal_value, thermal_base); -+ power_offset0 = _halrf_get_power_offset_by_thermal_8723f(dm, 0, thermal_detla); -+ power_offset1 = _halrf_get_power_offset_by_thermal_8723f(dm, 1, thermal_detla); -+ -+ if (rate == ODM_MGN_1M || rate == ODM_MGN_2M || rate == ODM_MGN_5_5M || rate == ODM_MGN_11M){ -+ temp[0] = tssi->txagc_offset_thermaltrack[0] -0x18 + 4*(power_offset0);/*s0*/ -+ temp[1] = tssi->txagc_offset_thermaltrack[1] - 0x8 + 4*(power_offset1);/*s1*/ -+ } else { -+ temp[0] = tssi->txagc_offset_thermaltrack[0] + 4*(power_offset0); -+ temp[1] = tssi->txagc_offset_thermaltrack[1] + 4*(power_offset1); -+ } -+ /*S0:in the same index,cck_pwr-ofdm_pwr=7dB*/ -+ odm_set_bb_reg(dm, R_0x4388, MASKBYTE0, temp[0]);/*s0*/ -+ /*S1:in the same index,cck_pwr-ofdm_pwr=5dB*/ -+ odm_set_bb_reg(dm, R_0x4388, MASKBYTE2, temp[1]);/*s1*/ -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "[RF][TSSI] current_Path = %d, tx_rate = 0x%x\n", path, rate); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "[RF][TSSI] txagc_offset = 0x%x\n", -+ tssi->txagc_offset_thermaltrack[path]); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][TSSI] thermal_detla = %d, thermal_offset_s0 = 0x%x, thermal_offset_s1 = 0x%x\n", -+ thermal_detla, power_offset0, power_offset1); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"[RF][TSSI] 0x4388 = 0x%x\n", -+ odm_get_bb_reg(dm, R_0x4388, MASKDWORD)); -+ -+ -+} -+void halrf_xtal_thermal_track(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ s8 *delta_swing_table_xtal_up = NULL; -+ u8 xtal_offset_eanble = 0, i =0; -+ s8 thermal_value = 0, thermal_detla = 0; -+ u8 thermal_base = 0; -+ s8 xtal_table_up[DELTA_SWINGIDX_SIZE] = {0}; -+ s8 xtal_table_down[DELTA_SWINGIDX_SIZE] = {0}; -+ s32 reg_val = 0, crystal_cap = 0; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][xtal] ======>%s\n", __func__); -+ -+ if ( dm->support_ic_type == ODM_RTL8723F) { -+ if (rf->is_dpk_in_progress || dm->rf_calibrate_info.is_iqk_in_progress || -+ dm->is_psd_in_process || rf->is_tssi_in_progress || -+ !(rf->rf_supportability & HAL_RF_DPK_TRACK) || -+ rf->is_txgapk_in_progress) -+ return; -+ -+ if(tssi->thermal[0] == 0xff) { -+ //RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "[RF][xtal] thermal 0xFF, return!\n"); -+ return; -+ } else { -+ thermal_base = tssi->thermal[0]; -+ //RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "[RF][xtal] thermal_base = 0x%x\n", thermal_base); -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "[RF][xtal] thermal_base = 0x%x\n", thermal_base); -+ -+ thermal_value = (s8)odm_get_rf_reg(dm, RF_PATH_A, RF_0x42, 0x7E); /* 0x42: RF Reg[6:1]*/ -+ -+ thermal_detla = (s8)(thermal_value - thermal_base); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "[RF][xtal] cali_info->xtal_offset = 0x%x\n", cali_info->xtal_offset); -+ -+ cali_info->xtal_offset_last = cali_info->xtal_offset; -+ /* -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][Xtal] cali_info->delta_swing_table_xtal_p = %d\n", cali_info->delta_swing_table_xtal_p[2]); -+ */ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][Xtal] thermal_value = 0x%x, thermal_detla = 0x%x, xtal_offset_last = 0x%x\n", -+ thermal_value, thermal_detla, cali_info->xtal_offset_last); -+ odm_move_memory(dm, xtal_table_up, cali_info->delta_swing_table_xtal_p, sizeof(xtal_table_up));//(void *) -+ odm_move_memory(dm, xtal_table_down, cali_info->delta_swing_table_xtal_n, sizeof(xtal_table_down)); -+ /* -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][Xtal] xtal_table_up[1] = %d\n", xtal_table_up[1]);*/ -+ if(thermal_detla < 0) { -+ -+ if (thermal_detla < -29) -+ i = 29; -+ else -+ i = (u8)(-1 * thermal_detla); -+ cali_info->xtal_offset = xtal_table_down[i]; -+ } else { -+ -+ if (thermal_detla >= 30) -+ i = 29; -+ else -+ i = thermal_detla; -+ -+ cali_info->xtal_offset = xtal_table_up[i]; -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][Xtal] xtal_offset = %d\n", cali_info->xtal_offset); -+ if (cali_info->xtal_offset_last == cali_info->xtal_offset) -+ xtal_offset_eanble = 0; -+ else -+ xtal_offset_eanble = 1; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][Xtal] xtal_offset_eanble = %d\n", xtal_offset_eanble); -+ if (xtal_offset_eanble != 0) { -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter Xtal Tracking**********\n"); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][Xtal] R_0x103c[16:10] = 0x%x\n", odm_get_mac_reg(dm, R_0x103c, 0x0001FC00)); -+ -+ crystal_cap = dm->dm_cfo_track.crystal_cap_default & 0x7F; -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][Xtal] DEFAULT crystal_cap = 0x%x\n", crystal_cap); -+ reg_val = crystal_cap + cali_info->xtal_offset; -+ if (reg_val > 0x7F) -+ reg_val = 0x7F; -+ else if (reg_val < 0) -+ reg_val = 0x0; -+ -+ //reg_val = (u32)(odm_get_mac_reg(dm, R_0x103c, 0x0001FC00) + cali_info->xtal_offset); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][Xtal] reg_val = 0x%x\n", reg_val); -+ /* write 0x103c[23:17] = 0x103c[16:10] = crystal_cap */ -+ crystal_cap = reg_val | (reg_val << 7); -+ odm_set_mac_reg(dm, R_0x103c, 0x00FFFC00, crystal_cap); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][Xtal] R_0x103c[16:10] = 0x%x\n", odm_get_mac_reg(dm, R_0x103c, 0x0001FC00)); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][Xtal] R_0x103c[23:17] = 0x%x\n", odm_get_mac_reg(dm, R_0x103c, 0x00FE0000)); -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********End Xtal Tracking**********\n"); -+ } -+ //odm_set_rf_reg(dm, RF_PATH_A, RF_0x42, 0x30000, 0x3); -+ //delay -+ } -+ /*RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "[RF][xtal] <======%s\n", __func__);*/ -+} -+#endif -+ -+void _halrf_dump_subpage(void *dm_void, u32 *_used, char *output, u32 *_out_len, u8 page) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 addr; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n===============[ Subpage_%d start]===============\n", page); -+ -+ RF_DBG(dm, DBG_RF_RFK, " ===============[ Subpage_%d start]===============\n", page); -+ -+ odm_set_bb_reg(dm, R_0x1b00, BIT(2) | BIT(1), page); -+ -+ for (addr = 0x1b00; addr < 0x1c00; addr += 0x10) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " 0x%x : 0x%08x 0x%08x 0x%08x 0x%08x\n", addr, -+ odm_get_bb_reg(dm, addr, MASKDWORD), -+ odm_get_bb_reg(dm, addr + 0x4, MASKDWORD), -+ odm_get_bb_reg(dm, addr + 0x8, MASKDWORD), -+ odm_get_bb_reg(dm, addr + 0xc, MASKDWORD)); -+ RF_DBG(dm, DBG_RF_RFK, " 0x%x : 0x%08x 0x%08x 0x%08x 0x%08x\n", addr, -+ odm_get_bb_reg(dm, addr, MASKDWORD), -+ odm_get_bb_reg(dm, addr + 0x4, MASKDWORD), -+ odm_get_bb_reg(dm, addr + 0x8, MASKDWORD), -+ odm_get_bb_reg(dm, addr + 0xc, MASKDWORD)); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void halrf_dump_rfk_reg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 reg_1b00, supportability; -+ u8 page; -+ -+ if (!(dm->support_ic_type & (ODM_IC_11AC_SERIES | ODM_IC_JGR3_SERIES))) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "CMD is Unsupported due to IC type!!!\n"); -+ RF_DBG(dm, DBG_RF_RFK, "[RFK] CMD is Unsupported due to IC type!!!\n"); -+ return; -+ } else if (rf->is_dpk_in_progress || dm->rf_calibrate_info.is_iqk_in_progress || -+ dm->is_psd_in_process || rf->is_tssi_in_progress || rf->is_txgapk_in_progress) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Bypass CMD due to RFK is doing!!!\n"); -+ RF_DBG(dm, DBG_RF_RFK, "[RFK] Bypass CMD due to RFK is doing!!!\n"); -+ return; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*dm->is_fcs_mode_enable) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Bypass CMD due to FCS mode!!!\n"); -+ RF_DBG(dm, DBG_RF_RFK, "[RFK] Bypass CMD due to FCS mode!!!\n"); -+ return; -+ } -+#endif -+ supportability = rf->rf_supportability; -+ -+ /*to avoid DPK track interruption*/ -+ rf->rf_supportability = rf->rf_supportability & ~HAL_RF_DPK_TRACK; -+ -+ reg_1b00 = odm_get_bb_reg(dm, R_0x1b00, MASKDWORD); -+ -+ if (input[2]) -+ PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[0]); -+ -+ if ((strcmp(input[2], help) == 0)) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "dump subpage {0:Page0, 1:Page1, 2:Page2, 3:Page3, 4:all}\n"); -+ else if (var1[0] > 4) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Wrong subpage number!!\n"); -+ else if (var1[0] == 4) { -+ for (page = 0; page < 4; page++) -+ _halrf_dump_subpage(dm, &used, output, &out_len, page); -+ } else -+ _halrf_dump_subpage(dm, &used, output, &out_len, (u8)var1[0]); -+ -+ odm_set_bb_reg(dm, R_0x1b00, MASKDWORD, reg_1b00); -+ -+ rf->rf_supportability = supportability; -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+/*Golbal function*/ -+void halrf_reload_bp(void *dm_void, u32 *bp_reg, u32 *bp, u32 num) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 i; -+ -+ for (i = 0; i < num; i++) -+ odm_write_4byte(dm, bp_reg[i], bp[i]); -+} -+ -+void halrf_reload_bprf(void *dm_void, u32 *bp_reg, u32 bp[][4], u32 num, -+ u8 ss) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 i, path; -+ -+ for (i = 0; i < num; i++) { -+ for (path = 0; path < ss; path++) -+ odm_set_rf_reg(dm, (enum rf_path)path, bp_reg[i], -+ MASK20BITS, bp[i][path]); -+ } -+} -+ -+void halrf_bp(void *dm_void, u32 *bp_reg, u32 *bp, u32 num) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 i; -+ -+ for (i = 0; i < num; i++) -+ bp[i] = odm_read_4byte(dm, bp_reg[i]); -+} -+ -+void halrf_bprf(void *dm_void, u32 *bp_reg, u32 bp[][4], u32 num, u8 ss) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 i, path; -+ -+ for (i = 0; i < num; i++) { -+ for (path = 0; path < ss; path++) { -+ bp[i][path] = -+ odm_get_rf_reg(dm, (enum rf_path)path, -+ bp_reg[i], MASK20BITS); -+ } -+ } -+} -+ -+void halrf_swap(void *dm_void, u32 *v1, u32 *v2) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 temp; -+ -+ temp = *v1; -+ *v1 = *v2; -+ *v2 = temp; -+} -+ -+void halrf_bubble(void *dm_void, u32 *v1, u32 *v2) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 temp; -+ -+ if (*v1 >= 0x200 && *v2 >= 0x200) { -+ if (*v1 > *v2) -+ halrf_swap(dm, v1, v2); -+ } else if (*v1 < 0x200 && *v2 < 0x200) { -+ if (*v1 > *v2) -+ halrf_swap(dm, v1, v2); -+ } else if (*v1 < 0x200 && *v2 >= 0x200) { -+ halrf_swap(dm, v1, v2); -+ } -+} -+ -+void halrf_b_sort(void *dm_void, u32 *iv, u32 *qv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 temp; -+ u32 i, j; -+ -+ RF_DBG(dm, DBG_RF_DACK, "[DACK]bubble!!!!!!!!!!!!"); -+ for (i = 0; i < SN - 1; i++) { -+ for (j = 0; j < (SN - 1 - i) ; j++) { -+ halrf_bubble(dm, &iv[j], &iv[j + 1]); -+ halrf_bubble(dm, &qv[j], &qv[j + 1]); -+ } -+ } -+} -+ -+void halrf_minmax_compare(void *dm_void, u32 value, u32 *min, -+ u32 *max) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (value >= 0x200) { -+ if (*min >= 0x200) { -+ if (*min > value) -+ *min = value; -+ } else { -+ *min = value; -+ } -+ if (*max >= 0x200) { -+ if (*max < value) -+ *max = value; -+ } -+ } else { -+ if (*min < 0x200) { -+ if (*min > value) -+ *min = value; -+ } -+ -+ if (*max >= 0x200) { -+ *max = value; -+ } else { -+ if (*max < value) -+ *max = value; -+ } -+ } -+} -+ -+u32 halrf_delta(void *dm_void, u32 v1, u32 v2) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (v1 >= 0x200 && v2 >= 0x200) { -+ if (v1 > v2) -+ return v1 - v2; -+ else -+ return v2 - v1; -+ } else if (v1 >= 0x200 && v2 < 0x200) { -+ return v2 + (0x400 - v1); -+ } else if (v1 < 0x200 && v2 >= 0x200) { -+ return v1 + (0x400 - v2); -+ } -+ -+ if (v1 > v2) -+ return v1 - v2; -+ else -+ return v2 - v1; -+} -+ -+boolean halrf_compare(void *dm_void, u32 value) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ boolean fail = false; -+ -+ if (value >= 0x200 && (0x400 - value) > 0x64) -+ fail = true; -+ else if (value < 0x200 && value > 0x64) -+ fail = true; -+ -+ if (fail) -+ RF_DBG(dm, DBG_RF_DACK, "[DACK]overflow!!!!!!!!!!!!!!!"); -+ return fail; -+} -+ -+void halrf_mode(void *dm_void, u32 *i_value, u32 *q_value) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 iv[SN], qv[SN], im[SN], qm[SN], temp, temp1, temp2; -+ u32 p, m, t; -+ u32 i_max = 0, q_max = 0, i_min = 0x0, q_min = 0x0, c = 0x0; -+ u32 i_delta, q_delta; -+ u8 i, j, ii = 0, qi = 0; -+ boolean fail = false; -+ -+ ODM_delay_ms(10); -+ for (i = 0; i < SN; i++) { -+ im[i] = 0; -+ qm[i] = 0; -+ } -+ i = 0; -+ c = 0; -+ while (i < SN && c < 1000) { -+ c++; -+ temp = odm_get_bb_reg(dm, 0x2dbc, 0x3fffff); -+ iv[i] = (temp & 0x3ff000) >> 12; -+ qv[i] = temp & 0x3ff; -+ -+ fail = false; -+ if (halrf_compare(dm, iv[i])) -+ fail = true; -+ if (halrf_compare(dm, qv[i])) -+ fail = true; -+ if (!fail) -+ i++; -+ } -+ c = 0; -+ do { -+ c++; -+ i_min = iv[0]; -+ i_max = iv[0]; -+ q_min = qv[0]; -+ q_max = qv[0]; -+ for (i = 0; i < SN; i++) { -+ halrf_minmax_compare(dm, iv[i], &i_min, &i_max); -+ halrf_minmax_compare(dm, qv[i], &q_min, &q_max); -+ } -+ RF_DBG(dm, DBG_RF_DACK, "[DACK]i_min=0x%x, i_max=0x%x", -+ i_min, i_max); -+ RF_DBG(dm, DBG_RF_DACK, "[DACK]q_min=0x%x, q_max=0x%x", -+ q_min, q_max); -+ if (i_max < 0x200 && i_min < 0x200) -+ i_delta = i_max - i_min; -+ else if (i_max >= 0x200 && i_min >= 0x200) -+ i_delta = i_max - i_min; -+ else -+ i_delta = i_max + (0x400 - i_min); -+ -+ if (q_max < 0x200 && q_min < 0x200) -+ q_delta = q_max - q_min; -+ else if (q_max >= 0x200 && q_min >= 0x200) -+ q_delta = q_max - q_min; -+ else -+ q_delta = q_max + (0x400 - q_min); -+ RF_DBG(dm, DBG_RF_DACK, "[DACK]i_delta=0x%x, q_delta=0x%x", -+ i_delta, q_delta); -+ halrf_b_sort(dm, iv, qv); -+ if (i_delta > 5 || q_delta > 5) { -+ temp = odm_get_bb_reg(dm, 0x2dbc, 0x3fffff); -+ iv[0] = (temp & 0x3ff000) >> 12; -+ qv[0] = temp & 0x3ff; -+ temp = odm_get_bb_reg(dm, 0x2dbc, 0x3fffff); -+ iv[SN - 1] = (temp & 0x3ff000) >> 12; -+ qv[SN - 1] = temp & 0x3ff; -+ } else { -+ break; -+ } -+ } while (c < 100); -+#if 1 -+#if 0 -+ for (i = 0; i < SN; i++) -+ RF_DBG(dm, DBG_RF_DACK, "[DACK]iv[%d] = 0x%x\n", i, iv[i]); -+ for (i = 0; i < SN; i++) -+ RF_DBG(dm, DBG_RF_DACK, "[DACK]qv[%d] = 0x%x\n", i, qv[i]); -+#endif -+ /*i*/ -+ m = 0; -+ p = 0; -+ for (i = 10; i < SN - 10; i++) { -+ if (iv[i] > 0x200) -+ m = (0x400 - iv[i]) + m; -+ else -+ p = iv[i] + p; -+ } -+ -+ if (p > m) { -+ t = p - m; -+ t = t / (SN - 20); -+ } else { -+ t = m - p; -+ t = t / (SN - 20); -+ if (t != 0x0) -+ t = 0x400 - t; -+ } -+ *i_value = t; -+ /*q*/ -+ m = 0; -+ p = 0; -+ for (i = 10; i < SN - 10; i++) { -+ if (qv[i] > 0x200) -+ m = (0x400 - qv[i]) + m; -+ else -+ p = qv[i] + p; -+ } -+ if (p > m) { -+ t = p - m; -+ t = t / (SN - 20); -+ } else { -+ t = m - p; -+ t = t / (SN - 20); -+ if (t != 0x0) -+ t = 0x400 - t; -+ } -+ *q_value = t; -+#endif -+} -+void halrf_delay_10us(u16 v1) -+{ -+ u16 i = 0; -+ -+ for (i = 0; i < v1; i++) -+ ODM_delay_us(10); -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf.h -new file mode 100644 -index 000000000..36caa945b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf.h -@@ -0,0 +1,842 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALRF_H__ -+#define __HALRF_H__ -+ -+/*@============================================================*/ -+/*@include files*/ -+/*@============================================================*/ -+#include "halrf/halrf_psd.h" -+#if (RTL8822B_SUPPORT == 1) -+#include "halrf/rtl8822b/halrf_rfk_init_8822b.h" -+#endif -+#if (RTL8822C_SUPPORT == 1) -+#include "halrf/rtl8822c/halrf_rfk_init_8822c.h" -+#include "halrf/rtl8822c/halrf_iqk_8822c.h" -+#include "halrf/rtl8822c/halrf_tssi_8822c.h" -+#include "halrf/rtl8822c/halrf_dpk_8822c.h" -+#include "halrf/rtl8822c/halrf_txgapk_8822c.h" -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+#if (RTL8197G_SUPPORT == 1) -+#include "halrf/rtl8197g/halrf_rfk_init_8197g.h" -+#endif -+#if (RTL8198F_SUPPORT == 1) -+#include "halrf/rtl8198f/halrf_rfk_init_8198f.h" -+#endif -+#if (RTL8812F_SUPPORT == 1) -+#include "halrf/rtl8812f/halrf_rfk_init_8812f.h" -+#endif -+ -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+#include "halrf/rtl8814b/halrf_rfk_init_8814b.h" -+#include "halrf/rtl8814b/halrf_iqk_8814b.h" -+#include "halrf/rtl8814b/halrf_dpk_8814b.h" -+#include "halrf/rtl8814b/halrf_txgapk_8814b.h" -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+#include "halrf/rtl8814c/halrf_rfk_init_8814c.h" -+#include "halrf/rtl8814c/halrf_iqk_8814c.h" -+#include "halrf/rtl8814c/halrf_dpk_8814c.h" -+#include "halrf/rtl8814c/halrf_txgapk_8814c.h" -+#endif -+ -+ -+/*@============================================================*/ -+/*@Definition */ -+/*@============================================================*/ -+/*IQK version*/ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+#define IQK_VER_8188E "0x14" -+#define IQK_VER_8192E "0x01" -+#define IQK_VER_8192F "0x01" -+#define IQK_VER_8723B "0x1e" -+#define IQK_VER_8812A "0x02" -+#define IQK_VER_8821A "0x02" -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+#define IQK_VER_8188E "0x01" -+#define IQK_VER_8192E "0x01" -+#define IQK_VER_8192F "0x01" -+#define IQK_VER_8723B "0x1f" -+#define IQK_VER_8812A "0x01" -+#define IQK_VER_8821A "0x01" -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#define IQK_VER_8188E "0x01" -+#define IQK_VER_8192E "0x01" -+#define IQK_VER_8192F "0x01" -+#define IQK_VER_8723B "0x1e" -+#define IQK_VER_8812A "0x01" -+#define IQK_VER_8821A "0x01" -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+#define IQK_VER_8188E "0x01" -+#define IQK_VER_8192E "0x01" -+#define IQK_VER_8192F "0x01" -+#define IQK_VER_8723B "0x1e" -+#define IQK_VER_8812A "0x01" -+#define IQK_VER_8821A "0x01" -+#endif -+#define IQK_VER_8814A "0x0f" -+#define IQK_VER_8188F "0x01" -+#define IQK_VER_8197F "0x1d" -+#define IQK_VER_8703B "0x05" -+#define IQK_VER_8710B "0x01" -+#define IQK_VER_8723D "0x02" -+#define IQK_VER_8822B "0x32" -+#define IQK_VER_8822C "0x14" -+#define IQK_VER_8821C "0x23" -+#define IQK_VER_8198F "0x0b" -+#define IQK_VER_8814B "0x15" -+#define IQK_VER_8812F "0x0c" -+#define IQK_VER_8710C "0x0a" -+#define IQK_VER_8197G "0x03" -+#define IQK_VER_8723F "0x00" -+#define IQK_VER_8814C "0x00" -+ -+/*LCK version*/ -+#define LCK_VER_8188E "0x02" -+#define LCK_VER_8192E "0x02" -+#define LCK_VER_8192F "0x01" -+#define LCK_VER_8723B "0x02" -+#define LCK_VER_8812A "0x01" -+#define LCK_VER_8821A "0x01" -+#define LCK_VER_8814A "0x01" -+#define LCK_VER_8188F "0x01" -+#define LCK_VER_8197F "0x01" -+#define LCK_VER_8703B "0x01" -+#define LCK_VER_8710B "0x01" -+#define LCK_VER_8723D "0x01" -+#define LCK_VER_8822B "0x02" -+#define LCK_VER_8822C "0x00" -+#define LCK_VER_8821C "0x03" -+#define LCK_VER_8814B "0x02" -+#define LCK_VER_8195B "0x02" -+#define LCK_VER_8710C "0x02" -+#define LCK_VER_8197G "0x01" -+#define LCK_VER_8198F "0x01" -+#define LCK_VER_8814C "0x00" -+ -+/*power tracking version*/ -+#define PWRTRK_VER_8188E "0x01" -+#define PWRTRK_VER_8192E "0x01" -+#define PWRTRK_VER_8192F "0x01" -+#define PWRTRK_VER_8723B "0x01" -+#define PWRTRK_VER_8812A "0x01" -+#define PWRTRK_VER_8821A "0x01" -+#define PWRTRK_VER_8814A "0x01" -+#define PWRTRK_VER_8188F "0x01" -+#define PWRTRK_VER_8197F "0x01" -+#define PWRTRK_VER_8703B "0x01" -+#define PWRTRK_VER_8710B "0x01" -+#define PWRTRK_VER_8723D "0x01" -+#define PWRTRK_VER_8822B "0x01" -+#define PWRTRK_VER_8822C "0x00" -+#define PWRTRK_VER_8821C "0x01" -+#define PWRTRK_VER_8814B "0x00" -+#define PWRTRK_VER_8197G "0x00" -+#define PWRTRK_VER_8814C "0x00" -+ -+/*DPK version*/ -+#define DPK_VER_8188E "NONE" -+#define DPK_VER_8192E "NONE" -+#define DPK_VER_8723B "NONE" -+#define DPK_VER_8812A "NONE" -+#define DPK_VER_8821A "NONE" -+#define DPK_VER_8814A "NONE" -+#define DPK_VER_8188F "NONE" -+#define DPK_VER_8197F "0x08" -+#define DPK_VER_8703B "NONE" -+#define DPK_VER_8710B "NONE" -+#define DPK_VER_8723D "NONE" -+#define DPK_VER_8822B "NONE" -+#define DPK_VER_8822C "0x20" -+#define DPK_VER_8821C "NONE" -+#define DPK_VER_8192F "0x13" -+#define DPK_VER_8198F "0x0e" -+#define DPK_VER_8814B "0x0f" -+#define DPK_VER_8195B "0x0c" -+#define DPK_VER_8812F "0x0a" -+#define DPK_VER_8197G "0x09" -+#define DPK_VER_8814C "0x01" -+ -+/*RFK_INIT version*/ -+#define RFK_INIT_VER_8822B "0x8" -+#define RFK_INIT_VER_8822C "0x8" -+#define RFK_INIT_VER_8195B "0x1" -+#define RFK_INIT_VER_8198F "0x8" -+#define RFK_INIT_VER_8814B "0xa" -+#define RFK_INIT_VER_8812F "0x4" -+#define RFK_INIT_VER_8197G "0x4" -+#define RFK_INIT_VER_8814C "0x0" -+ -+/*DACK version*/ -+#define DACK_VER_8822C "0xa" -+#define DACK_VER_8814B "0x4" -+#define DACK_VER_8814C "0x0" -+ -+/*TXGAPK version*/ -+#define TXGAPK_VER_8814B "0x1" -+#define TXGAPK_VER_8195B "0x2" -+ -+/*Kfree tracking version*/ -+#define KFREE_VER_8188E \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8192E \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8192F \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8723B \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8812A \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8821A \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8814A \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8188F \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8197F \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8703B \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8710B \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8723D \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8822B \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8822C \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8821C \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8814B \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+#define KFREE_VER_8197G \ -+ (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" -+ -+#define TSSI_VER_8812F "0x1" -+#define TSSI_VER_8822C "0x1" -+#define TSSI_VER_8821C "0x1" -+#define TSSI_VER_8814B "0x1" -+#define TSSI_VER_8197G "0x1" -+#define TSSI_VER_8723F "0x1" -+ -+/*PA Bias Calibration version*/ -+#define PABIASK_VER_8188E \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8192E \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8192F \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8723B \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8812A \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8821A \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8814A \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8188F \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8197F \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8703B \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8710B \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8723D \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8822B \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8822C \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8821C \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8814B \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+#define PABIASK_VER_8197G \ -+ (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" -+ -+#define HALRF_IQK_VER \ -+ (dm->support_ic_type == ODM_RTL8188E) ? IQK_VER_8188E : \ -+ (dm->support_ic_type == ODM_RTL8192E) ? IQK_VER_8192E : \ -+ (dm->support_ic_type == ODM_RTL8192F) ? IQK_VER_8192F : \ -+ (dm->support_ic_type == ODM_RTL8723B) ? IQK_VER_8723B : \ -+ (dm->support_ic_type == ODM_RTL8812) ? IQK_VER_8812A : \ -+ (dm->support_ic_type == ODM_RTL8821) ? IQK_VER_8821A : \ -+ (dm->support_ic_type == ODM_RTL8814A) ? IQK_VER_8814A : \ -+ (dm->support_ic_type == ODM_RTL8188F) ? IQK_VER_8188F : \ -+ (dm->support_ic_type == ODM_RTL8197F) ? IQK_VER_8197F : \ -+ (dm->support_ic_type == ODM_RTL8703B) ? IQK_VER_8703B : \ -+ (dm->support_ic_type == ODM_RTL8710B) ? IQK_VER_8710B : \ -+ (dm->support_ic_type == ODM_RTL8723D) ? IQK_VER_8723D : \ -+ (dm->support_ic_type == ODM_RTL8822B) ? IQK_VER_8822B : \ -+ (dm->support_ic_type == ODM_RTL8822C) ? IQK_VER_8822C : \ -+ (dm->support_ic_type == ODM_RTL8821C) ? IQK_VER_8821C : \ -+ (dm->support_ic_type == ODM_RTL8814B) ? IQK_VER_8814B : \ -+ (dm->support_ic_type == ODM_RTL8710C) ? IQK_VER_8710C : \ -+ (dm->support_ic_type == ODM_RTL8723F) ? IQK_VER_8723F : \ -+ (dm->support_ic_type == ODM_RTL8197G) ? IQK_VER_8197G : "unknown" -+ -+#define HALRF_LCK_VER \ -+ (dm->support_ic_type == ODM_RTL8188E) ? LCK_VER_8188E : \ -+ (dm->support_ic_type == ODM_RTL8192E) ? LCK_VER_8192E : \ -+ (dm->support_ic_type == ODM_RTL8192F) ? LCK_VER_8192F : \ -+ (dm->support_ic_type == ODM_RTL8723B) ? LCK_VER_8723B : \ -+ (dm->support_ic_type == ODM_RTL8812) ? LCK_VER_8812A : \ -+ (dm->support_ic_type == ODM_RTL8821) ? LCK_VER_8821A : \ -+ (dm->support_ic_type == ODM_RTL8814A) ? LCK_VER_8814A : \ -+ (dm->support_ic_type == ODM_RTL8188F) ? LCK_VER_8188F : \ -+ (dm->support_ic_type == ODM_RTL8197F) ? LCK_VER_8197F : \ -+ (dm->support_ic_type == ODM_RTL8703B) ? LCK_VER_8703B : \ -+ (dm->support_ic_type == ODM_RTL8710B) ? LCK_VER_8710B : \ -+ (dm->support_ic_type == ODM_RTL8723D) ? LCK_VER_8723D : \ -+ (dm->support_ic_type == ODM_RTL8822B) ? LCK_VER_8822B : \ -+ (dm->support_ic_type == ODM_RTL8822C) ? LCK_VER_8822C : \ -+ (dm->support_ic_type == ODM_RTL8821C) ? LCK_VER_8821C : \ -+ (dm->support_ic_type == ODM_RTL8814B) ? LCK_VER_8814B : \ -+ (dm->support_ic_type == ODM_RTL8710C) ? LCK_VER_8710C : \ -+ (dm->support_ic_type == ODM_RTL8710C) ? LCK_VER_8710C : "unknown" -+#define HALRF_POWRTRACKING_VER \ -+ (dm->support_ic_type == ODM_RTL8188E) ? PWRTRK_VER_8188E : \ -+ (dm->support_ic_type == ODM_RTL8192E) ? PWRTRK_VER_8192E : \ -+ (dm->support_ic_type == ODM_RTL8192F) ? PWRTRK_VER_8192F : \ -+ (dm->support_ic_type == ODM_RTL8723B) ? PWRTRK_VER_8723B : \ -+ (dm->support_ic_type == ODM_RTL8812) ? PWRTRK_VER_8812A : \ -+ (dm->support_ic_type == ODM_RTL8821) ? PWRTRK_VER_8821A : \ -+ (dm->support_ic_type == ODM_RTL8814A) ? PWRTRK_VER_8814A : \ -+ (dm->support_ic_type == ODM_RTL8188F) ? PWRTRK_VER_8188F : \ -+ (dm->support_ic_type == ODM_RTL8197F) ? PWRTRK_VER_8197F : \ -+ (dm->support_ic_type == ODM_RTL8703B) ? PWRTRK_VER_8703B : \ -+ (dm->support_ic_type == ODM_RTL8710B) ? PWRTRK_VER_8710B : \ -+ (dm->support_ic_type == ODM_RTL8723D) ? PWRTRK_VER_8723D : \ -+ (dm->support_ic_type == ODM_RTL8822B) ? PWRTRK_VER_8822B : \ -+ (dm->support_ic_type == ODM_RTL8822C) ? PWRTRK_VER_8822C : \ -+ (dm->support_ic_type == ODM_RTL8821C) ? PWRTRK_VER_8821C : \ -+ (dm->support_ic_type == ODM_RTL8197G) ? PWRTRK_VER_8197G : "unknown" -+ -+#define HALRF_DPK_VER \ -+ (dm->support_ic_type == ODM_RTL8188E) ? DPK_VER_8188E : \ -+ (dm->support_ic_type == ODM_RTL8192E) ? DPK_VER_8192E : \ -+ (dm->support_ic_type == ODM_RTL8192F) ? DPK_VER_8192F : \ -+ (dm->support_ic_type == ODM_RTL8723B) ? DPK_VER_8723B : \ -+ (dm->support_ic_type == ODM_RTL8812) ? DPK_VER_8812A : \ -+ (dm->support_ic_type == ODM_RTL8821) ? DPK_VER_8821A : \ -+ (dm->support_ic_type == ODM_RTL8814A) ? DPK_VER_8814A : \ -+ (dm->support_ic_type == ODM_RTL8188F) ? DPK_VER_8188F : \ -+ (dm->support_ic_type == ODM_RTL8197F) ? DPK_VER_8197F : \ -+ (dm->support_ic_type == ODM_RTL8198F) ? DPK_VER_8198F : \ -+ (dm->support_ic_type == ODM_RTL8703B) ? DPK_VER_8703B : \ -+ (dm->support_ic_type == ODM_RTL8710B) ? DPK_VER_8710B : \ -+ (dm->support_ic_type == ODM_RTL8723D) ? DPK_VER_8723D : \ -+ (dm->support_ic_type == ODM_RTL8822B) ? DPK_VER_8822B : \ -+ (dm->support_ic_type == ODM_RTL8822C) ? DPK_VER_8822C : \ -+ (dm->support_ic_type == ODM_RTL8812F) ? DPK_VER_8812F : \ -+ (dm->support_ic_type == ODM_RTL8821C) ? DPK_VER_8821C : \ -+ (dm->support_ic_type == ODM_RTL8814B) ? DPK_VER_8814B : \ -+ (dm->support_ic_type == ODM_RTL8197G) ? DPK_VER_8197G : "unknown" -+ -+#define HALRF_KFREE_VER \ -+ (dm->support_ic_type == ODM_RTL8188E) ? KFREE_VER_8188E : \ -+ (dm->support_ic_type == ODM_RTL8192E) ? KFREE_VER_8192E : \ -+ (dm->support_ic_type == ODM_RTL8192F) ? KFREE_VER_8192F : \ -+ (dm->support_ic_type == ODM_RTL8723B) ? KFREE_VER_8723B : \ -+ (dm->support_ic_type == ODM_RTL8812) ? KFREE_VER_8812A : \ -+ (dm->support_ic_type == ODM_RTL8821) ? KFREE_VER_8821A : \ -+ (dm->support_ic_type == ODM_RTL8814A) ? KFREE_VER_8814A : \ -+ (dm->support_ic_type == ODM_RTL8188F) ? KFREE_VER_8188F : \ -+ (dm->support_ic_type == ODM_RTL8197F) ? KFREE_VER_8197F : \ -+ (dm->support_ic_type == ODM_RTL8703B) ? KFREE_VER_8703B : \ -+ (dm->support_ic_type == ODM_RTL8710B) ? KFREE_VER_8710B : \ -+ (dm->support_ic_type == ODM_RTL8723D) ? KFREE_VER_8723D : \ -+ (dm->support_ic_type == ODM_RTL8822B) ? KFREE_VER_8822B : \ -+ (dm->support_ic_type == ODM_RTL8822C) ? KFREE_VER_8822C : \ -+ (dm->support_ic_type == ODM_RTL8821C) ? KFREE_VER_8821C : \ -+ (dm->support_ic_type == ODM_RTL8814B) ? KFREE_VER_8814B : \ -+ (dm->support_ic_type == ODM_RTL8197G) ? KFREE_VER_8197G : "unknown" -+ -+#define HALRF_TSSI_VER \ -+ (dm->support_ic_type == ODM_RTL8812F) ? TSSI_VER_8812F : \ -+ (dm->support_ic_type == ODM_RTL8822C) ? TSSI_VER_8822C : \ -+ (dm->support_ic_type == ODM_RTL8821C) ? TSSI_VER_8821C : \ -+ (dm->support_ic_type == ODM_RTL8814B) ? TSSI_VER_8814B : \ -+ (dm->support_ic_type == ODM_RTL8197G) ? TSSI_VER_8197G : \ -+ (dm->support_ic_type == ODM_RTL8723F) ? TSSI_VER_8723F : "unknown" -+ -+#define HALRF_PABIASK_VER \ -+ (dm->support_ic_type == ODM_RTL8188E) ? PABIASK_VER_8188E : \ -+ (dm->support_ic_type == ODM_RTL8192E) ? PABIASK_VER_8192E : \ -+ (dm->support_ic_type == ODM_RTL8192F) ? PABIASK_VER_8192F : \ -+ (dm->support_ic_type == ODM_RTL8723B) ? PABIASK_VER_8723B : \ -+ (dm->support_ic_type == ODM_RTL8812) ? PABIASK_VER_8812A : \ -+ (dm->support_ic_type == ODM_RTL8821) ? PABIASK_VER_8821A : \ -+ (dm->support_ic_type == ODM_RTL8814A) ? PABIASK_VER_8814A : \ -+ (dm->support_ic_type == ODM_RTL8188F) ? PABIASK_VER_8188F : \ -+ (dm->support_ic_type == ODM_RTL8197F) ? PABIASK_VER_8197F : \ -+ (dm->support_ic_type == ODM_RTL8703B) ? PABIASK_VER_8703B : \ -+ (dm->support_ic_type == ODM_RTL8710B) ? PABIASK_VER_8710B : \ -+ (dm->support_ic_type == ODM_RTL8723D) ? PABIASK_VER_8723D : \ -+ (dm->support_ic_type == ODM_RTL8822B) ? PABIASK_VER_8822B : \ -+ (dm->support_ic_type == ODM_RTL8822C) ? PABIASK_VER_8822C : \ -+ (dm->support_ic_type == ODM_RTL8821C) ? PABIASK_VER_8821C : \ -+ (dm->support_ic_type == ODM_RTL8814B) ? PABIASK_VER_8814B : \ -+ (dm->support_ic_type == ODM_RTL8197G) ? PABIASK_VER_8197G : "unknown" -+ -+#define HALRF_RFK_INIT_VER \ -+ (dm->support_ic_type == ODM_RTL8822B) ? RFK_INIT_VER_8822B : \ -+ (dm->support_ic_type == ODM_RTL8822C) ? RFK_INIT_VER_8822C : \ -+ (dm->support_ic_type == ODM_RTL8812F) ? RFK_INIT_VER_8812F : \ -+ (dm->support_ic_type == ODM_RTL8198F) ? RFK_INIT_VER_8198F : \ -+ (dm->support_ic_type == ODM_RTL8814B) ? RFK_INIT_VER_8814B : \ -+ (dm->support_ic_type == ODM_RTL8197G) ? RFK_INIT_VER_8197G : "unknown" -+ -+#define HALRF_DACK_VER \ -+ (dm->support_ic_type == ODM_RTL8822C) ? DACK_VER_8822C : \ -+ (dm->support_ic_type == ODM_RTL8814B) ? DACK_VER_8814B : "unknown" -+ -+#define IQK_THRESHOLD 8 -+#define DPK_THRESHOLD 4 -+#define HALRF_ABS(a,b) ((a>b) ? (a-b) : (b-a)) -+#define SN 100 -+ -+#define CCK_TSSI_NUM 6 -+#define OFDM_2G_TSSI_NUM 5 -+#define OFDM_5G_TSSI_NUM 14 -+ -+ -+ -+/*@===========================================================*/ -+/*AGC RX High Power mode*/ -+/*@===========================================================*/ -+#define lna_low_gain_1 0x64 -+#define lna_low_gain_2 0x5A -+#define lna_low_gain_3 0x58 -+ -+/*@============================================================*/ -+/*@ enumeration */ -+/*@============================================================*/ -+ -+enum halrf_func_idx { /*F_XXX = PHYDM XXX function*/ -+ RF00_PWR_TRK = 0, /*Pow_trk, TSSI_trk*/ -+ RF01_IQK = 1, /*LOK, IQK*/ -+ RF02_LCK = 2, -+ RF03_DPK = 3, -+ RF04_TXGAPK = 4, -+ RF05_DACK = 5, -+ RF06_DPK_TRK = 6, -+ RF07_2GBAND_SHIFT = 7, -+ RF08_RXDCK = 8, -+ RF09_RFK = 9 -+}; -+ -+enum halrf_ability { -+ HAL_RF_TX_PWR_TRACK = BIT(RF00_PWR_TRK), -+ HAL_RF_IQK = BIT(RF01_IQK), -+ HAL_RF_LCK = BIT(RF02_LCK), -+ HAL_RF_DPK = BIT(RF03_DPK), -+ HAL_RF_TXGAPK = BIT(RF04_TXGAPK), -+ HAL_RF_DACK = BIT(RF05_DACK), -+ HAL_RF_DPK_TRACK = BIT(RF06_DPK_TRK), -+ HAL_2GBAND_SHIFT = BIT(RF07_2GBAND_SHIFT), -+ HAL_RF_RXDCK = BIT(RF08_RXDCK) -+}; -+ -+enum halrf_shift_band { -+ HAL_RF_2P4 = 0, -+ HAL_RF_2P3 = 1, -+ HAL_RF_2P5 = 2 -+}; -+ -+enum halrf_dbg_comp { -+ DBG_RF_TX_PWR_TRACK = BIT(RF00_PWR_TRK), -+ DBG_RF_IQK = BIT(RF01_IQK), -+ DBG_RF_LCK = BIT(RF02_LCK), -+ DBG_RF_DPK = BIT(RF03_DPK), -+ DBG_RF_TXGAPK = BIT(RF04_TXGAPK), -+ DBG_RF_DACK = BIT(RF05_DACK), -+ DBG_RF_DPK_TRACK = BIT(RF06_DPK_TRK), -+ DBG_RF_RFK = BIT(RF09_RFK), -+ DBG_RF_MP = BIT(29), -+ DBG_RF_TMP = BIT(30), -+ DBG_RF_INIT = BIT(31) -+}; -+ -+enum halrf_cmninfo_init { -+ HALRF_CMNINFO_ABILITY = 0, -+ HALRF_CMNINFO_DPK_EN = 1, -+ HALRF_CMNINFO_EEPROM_THERMAL_VALUE, -+ HALRF_CMNINFO_RFK_FORBIDDEN, -+ HALRF_CMNINFO_IQK_SEGMENT, -+ HALRF_CMNINFO_RATE_INDEX, -+ HALRF_CMNINFO_PWT_TYPE, -+ HALRF_CMNINFO_MP_PSD_POINT, -+ HALRF_CMNINFO_MP_PSD_START_POINT, -+ HALRF_CMNINFO_MP_PSD_STOP_POINT, -+ HALRF_CMNINFO_MP_PSD_AVERAGE, -+ HALRF_CMNINFO_IQK_TIMES, -+ HALRF_CMNINFO_MP_POWER_TRACKING_TYPE, -+ HALRF_CMNINFO_POWER_TRACK_CONTROL -+}; -+ -+enum halrf_cmninfo_hook { -+ HALRF_CMNINFO_CON_TX, -+ HALRF_CMNINFO_SINGLE_TONE, -+ HALRF_CMNINFO_CARRIER_SUPPRESSION, -+ HALRF_CMNINFO_MP_RATE_INDEX, -+ HALRF_CMNINFO_MANUAL_RF_SUPPORTABILITY -+}; -+ -+enum halrf_lna_set { -+ HALRF_LNA_DISABLE = 0, -+ HALRF_LNA_ENABLE = 1, -+}; -+ -+enum halrf_k_segment_time { -+ SEGMENT_FREE = 0, -+ SEGMENT_10MS = 10, /*10ms*/ -+ SEGMENT_30MS = 30, /*30ms*/ -+ SEGMENT_50MS = 50, /*50ms*/ -+}; -+ -+#define POWER_INDEX_DIFF 4 -+#define TSSI_TXAGC_DIFF 2 -+ -+#define TSSI_CODE_NUM 84 -+ -+#define TSSI_SLOPE_2G 8 -+#define TSSI_SLOPE_5G 5 -+ -+#define TSSI_EFUSE_NUM 25 -+#define TSSI_EFUSE_KFREE_NUM 4 -+#define TSSI_DE_DIFF_EFUSE_NUM 10 -+ -+struct _halrf_tssi_data { -+ s32 cck_offset_patha; -+ s32 cck_offset_pathb; -+ s32 tssi_trk_txagc_offset[PHYDM_MAX_RF_PATH]; -+ s32 delta_tssi_txagc_offset[PHYDM_MAX_RF_PATH]; -+ s16 txagc_codeword[TSSI_CODE_NUM]; -+ u16 tssi_codeword[TSSI_CODE_NUM]; -+ s8 tssi_efuse[PHYDM_MAX_RF_PATH][TSSI_EFUSE_NUM]; -+ s8 tssi_de_diff_efuse[PHYDM_MAX_RF_PATH][TSSI_DE_DIFF_EFUSE_NUM]; -+ s8 tssi_kfree_efuse[PHYDM_MAX_RF_PATH][TSSI_EFUSE_KFREE_NUM]; -+ u8 thermal[PHYDM_MAX_RF_PATH]; -+ u32 index[PHYDM_MAX_RF_PATH][14]; -+ u8 do_tssi; -+ u8 get_thermal; -+ u8 tssi_finish_bit[PHYDM_MAX_RF_PATH]; -+ u8 thermal_trigger; -+ s8 tssi_de; -+#if (RTL8723F_SUPPORT == 1) -+ s8 txagc_offset_thermaltrack[MAX_PATH_NUM_8723F]; -+ u8 thermal_cal; -+#endif -+}; -+ -+struct _halrf_txgapk_info { -+ u32 txgapk_rf3f_bp[5][12][PHYDM_MAX_RF_PATH]; /* band(2Gcck/2GOFDM/5GL/5GM/5GH)/idx/path */ -+ boolean txgapk_bp_done; -+ s8 offset[12][PHYDM_MAX_RF_PATH]; -+ s8 fianl_offset[12][PHYDM_MAX_RF_PATH]; -+ u8 read_txgain; -+}; -+ -+ -+/*@============================================================*/ -+/*@ structure */ -+/*@============================================================*/ -+ -+struct _hal_rf_ { -+ /*hook*/ -+ u8 *test1; -+ -+ /*update*/ -+ u32 rf_supportability; -+ u8 rf_shift_band; -+ /*u32 halrf_tssi_data;*/ -+ -+ u8 eeprom_thermal; -+ u8 dpk_en; /*Enable Function DPK OFF/ON = 0/1*/ -+ boolean dpk_done; -+ u64 dpk_progressing_time; -+ u64 iqk_progressing_time; -+ u32 fw_ver; -+ -+ boolean *is_con_tx; -+ boolean *is_single_tone; -+ boolean *is_carrier_suppresion; -+ boolean is_dpk_in_progress; -+ boolean is_tssi_in_progress; -+ boolean is_bt_iqk_timeout; -+ boolean is_rfk_h2c_timeout; -+ boolean aac_checked; -+ boolean is_txgapk_in_progress; -+ -+ u8 *mp_rate_index; -+ u32 *manual_rf_supportability; -+ u32 p_rate_index; -+ u8 pwt_type; -+ u32 rf_dbg_comp; -+ u8 rfk_type; -+ u32 gnt_control; -+ -+ u8 ext_lna; /*@with 2G external LNA NO/Yes = 0/1*/ -+ u8 ext_lna_5g; /*@with 5G external LNA NO/Yes = 0/1*/ -+ u8 ext_pa; /*@with 2G external PNA NO/Yes = 0/1*/ -+ u8 ext_pa_5g; /*@with 5G external PNA NO/Yes = 0/1*/ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ struct _halrf_psd_data halrf_psd_data; -+ struct _halrf_tssi_data halrf_tssi_data; -+#endif -+ struct _halrf_txgapk_info halrf_txgapk_info; -+ u8 power_track_type; -+ u8 mp_pwt_type; -+ u8 pre_band_type; -+}; -+ -+/*@============================================================*/ -+/*@ function prototype */ -+/*@============================================================*/ -+ -+#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 ||\ -+ RTL8195B_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ -+ RTL8812F_SUPPORT == 1 || RTL8710C_SUPPORT == 1 ||\ -+ RTL8197G_SUPPORT == 1) -+void halrf_iqk_info_dump(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len); -+ -+void halrf_iqk_hwtx_check(void *dm_void, boolean is_check); -+#endif -+ -+u8 halrf_match_iqk_version(void *dm_void); -+ -+void halrf_support_ability_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#ifdef CONFIG_2G_BAND_SHIFT -+void halrf_support_band_shift_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#endif -+void halrf_cmn_info_init(void *dm_void, enum halrf_cmninfo_init cmn_info, -+ u32 value); -+ -+void halrf_cmn_info_hook(void *dm_void, enum halrf_cmninfo_hook cmn_info, -+ void *value); -+ -+void halrf_cmn_info_set(void *dm_void, u32 cmn_info, u64 value); -+ -+u64 halrf_cmn_info_get(void *dm_void, u32 cmn_info); -+ -+void halrf_watchdog(void *dm_void); -+ -+void halrf_supportability_init(void *dm_void); -+ -+void halrf_init(void *dm_void); -+ -+void halrf_iqk_trigger(void *dm_void, boolean is_recovery); -+ -+void halrf_rfk_handshake(void *dm_void, boolean is_before_k); -+ -+void halrf_rf_k_connect_trigger(void *dm_void, boolean is_recovery, -+ enum halrf_k_segment_time seg_time); -+ -+void halrf_segment_iqk_trigger(void *dm_void, boolean clear, -+ boolean segment_iqk); -+ -+void halrf_lck_trigger(void *dm_void); -+ -+void halrf_iqk_debug(void *dm_void, u32 *const dm_value, u32 *_used, -+ char *output, u32 *_out_len); -+ -+void phydm_get_iqk_cfir(void *dm_void, u8 idx, u8 path, boolean debug); -+ -+void halrf_iqk_xym_read(void *dm_void, u8 path, u8 xym_type); -+ -+void halrf_rf_lna_setting(void *dm_void, enum halrf_lna_set type); -+ -+void halrf_do_imr_test(void *dm_void, u8 data); -+ -+u32 halrf_psd_log2base(u32 val); -+ -+void halrf_dpk_trigger(void *dm_void); -+ -+void halrf_txgapk_trigger(void *dm_void); -+ -+u8 halrf_dpk_result_check(void *dm_void); -+ -+void halrf_dpk_sram_read(void *dm_void); -+ -+void halrf_dpk_enable_disable(void *dm_void); -+ -+void halrf_dpk_track(void *dm_void); -+ -+void halrf_dpk_reload(void *dm_void); -+ -+void halrf_dpk_switch(void *dm_void, u8 enable); -+ -+void halrf_dpk_debug_cmd(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void halrf_dpk_c2h_report_transfer(void *dm_void, boolean is_ok, u8 *buf, u8 buf_size); -+ -+void halrf_dpk_info_rsvd_page(void *dm_void, u8 *buf, u32 *buf_size); -+ -+/*Global function*/ -+ -+void halrf_reload_bp(void *dm_void, u32 *bp_reg, u32 *bp, u32 num); -+ -+void halrf_reload_bprf(void *dm_void, u32 *bp_reg, u32 bp[][4], u32 num, -+ u8 ss); -+ -+void halrf_bp(void *dm_void, u32 *bp_reg, u32 *bp, u32 num); -+ -+void halrf_bprf(void *dm_void, u32 *bp_reg, u32 bp[][4], u32 num, u8 ss); -+ -+void halrf_mode(void *dm_void, u32 *i_value, u32 *q_value); -+ -+boolean halrf_compare(void *dm_void, u32 value); -+ -+u32 halrf_delta(void *dm_void, u32 v1, u32 v2); -+ -+void halrf_minmax_compare(void *dm_void, u32 value, u32 *min, u32 *max); -+ -+void halrf_b_sort(void *dm_void, u32 *iv, u32 *qv); -+ -+void halrf_bubble(void *dm_void, u32 *v1, u32 *v2); -+ -+void halrf_swap(void *dm_void, u32 *v1, u32 *v2); -+ -+enum hal_status -+halrf_config_rfk_with_header_file(void *dm_void, u32 config_type); -+ -+#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 ||\ -+ RTL8195B_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ -+ RTL8812F_SUPPORT == 1 || RTL8710C_SUPPORT == 1 ||\ -+ RTL8197G_SUPPORT == 1) -+void halrf_iqk_dbg(void *dm_void); -+#endif -+ -+void halrf_tssi_get_efuse(void *dm_void); -+ -+void halrf_do_tssi(void *dm_void); -+ -+u8 halrf_do_tssi_by_manual(void *dm_void, u8 path); -+ -+ -+void halrf_set_tssi_enable(void *dm_void, boolean enable); -+ -+void halrf_do_thermal(void *dm_void); -+ -+u32 halrf_set_tssi_value(void *dm_void, u32 tssi_value); -+ -+void halrf_set_tssi_power(void *dm_void, s8 power); -+ -+void halrf_tssi_set_de_for_tx_verify(void *dm_void, u32 tssi_de, u8 path); -+ -+u32 halrf_query_tssi_value(void *dm_void); -+ -+void halrf_tssi_cck(void *dm_void); -+ -+void halrf_thermal_cck(void *dm_void); -+ -+void halrf_tssi_set_de(void *dm_void); -+ -+void halrf_tssi_dck(void *dm_void, u8 direct_do); -+ -+void halrf_calculate_tssi_codeword(void *dm_void); -+ -+void halrf_set_tssi_codeword(void *dm_void); -+ -+u8 halrf_get_tssi_codeword_for_txindex(void *dm_void); -+ -+void halrf_tssi_clean_de(void *dm_void); -+ -+u32 halrf_tssi_trigger_de(void *dm_void, u8 path); -+ -+u32 halrf_tssi_get_de(void *dm_void, u8 path); -+ -+u32 halrf_get_online_tssi_de(void *dm_void, u8 path, s32 pout); -+ -+void halrf_tssi_trigger(void *dm_void); -+ -+void halrf_spur_compensation(void *dm_void); -+ -+void halrf_txgapk_write_gain_table(void *dm_void); -+ -+void halrf_txgapk_reload_tx_gain(void *dm_void); -+ -+void halrf_txgap_enable_disable(void *dm_void, u8 enable); -+ -+void halrf_set_dpk_track(void *dm_void, u8 enable); -+ -+void halrf_set_dpkbychannel(void *dm_void, boolean dpk_by_ch); -+ -+void halrf_set_dpkenable(void *dm_void, boolean is_dpk_enable); -+ -+boolean halrf_get_dpkbychannel(void *dm_void); -+ -+boolean halrf_get_dpkenable(void *dm_void); -+ -+void _iqk_check_if_reload(void *dm_void); -+ -+void halrf_do_rxbb_dck(void *dm_void); -+ -+void config_halrf_path_adda_setting_trigger(void *dm_void); -+ -+void halrf_reload_iqk(void *dm_void, boolean reset); -+ -+void halrf_dack_dbg(void *dm_void); -+ -+void halrf_dack_trigger(void *dm_void, boolean force); -+ -+void halrf_dack_restore(void *dm_void); -+ -+void halrf_iqk_info_rsvd_page(void *dm_void, u8 *buf, u32 *buf_size); -+ -+void halrf_set_rfsupportability(void *dm_void); -+ -+void halrf_rxdck(void *dm_void); -+ -+void halrf_delay_10us(u16 v1); -+ -+void halrf_dump_rfk_reg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void halrf_xtal_thermal_track(void *dm_void); -+ -+void halrf_powertracking_thermal(void *dm_void); -+ -+u32 halrf_tssi_turn_target_power(void *dm_void, s16 power_offset, u8 path); -+ -+void halrf_tssi_set_power_offset(void *dm_void, s16 power_offset, u8 path); -+ -+void halrf_rfk_power_save(void *dm_void, boolean is_power_save); -+ -+#endif /*__HALRF_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_debug.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_debug.c -new file mode 100644 -index 000000000..3f2d142b6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_debug.c -@@ -0,0 +1,395 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ * ************************************************************ -+ */ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+void halrf_basic_profile(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 rf_release_ver = 0; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8814A_SUPPORT) -+ case ODM_RTL8814A: -+ rf_release_ver = RF_RELEASE_VERSION_8814A; -+ break; -+#endif -+ -+#if (RTL8821C_SUPPORT) -+ case ODM_RTL8821C: -+ rf_release_ver = RF_RELEASE_VERSION_8821C; -+ break; -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ case ODM_RTL8822B: -+ rf_release_ver = RF_RELEASE_VERSION_8822B; -+ break; -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ case ODM_RTL8822C: -+ rf_release_ver = RF_RELEASE_VERSION_8822C; -+ break; -+#endif -+ -+#if (RTL8814B_SUPPORT) -+ case ODM_RTL8814B: -+ rf_release_ver = RF_RELEASE_VERSION_8814B; -+ break; -+#endif -+ -+#if (RTL8812F_SUPPORT) -+ case ODM_RTL8812F: -+ rf_release_ver = RF_RELEASE_VERSION_8812F; -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT) -+ case ODM_RTL8198F: -+ rf_release_ver = RF_RELEASE_VERSION_8198F; -+ break; -+#endif -+ -+#if (RTL8197F_SUPPORT) -+ case ODM_RTL8197F: -+ rf_release_ver = RF_RELEASE_VERSION_8197F; -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ case ODM_RTL8192F: -+ rf_release_ver = RF_RELEASE_VERSION_8192F; -+ break; -+#endif -+ -+#if (RTL8710B_SUPPORT) -+ case ODM_RTL8710B: -+ rf_release_ver = RF_RELEASE_VERSION_8710B; -+ break; -+#endif -+ -+#if (RTL8195B_SUPPORT) -+ case ODM_RTL8195B: -+ rf_release_ver = RF_RELEASE_VERSION_8195B; -+ break; -+#endif -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %d\n", -+ "RF Para Release Ver", rf_release_ver); -+ -+ /* HAL RF version List */ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-35s\n", -+ "% HAL RF version %"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "Power Tracking", HALRF_POWRTRACKING_VER); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-35s: %s %s\n", "IQK", -+ (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "FW" : -+ HALRF_IQK_VER, -+ (halrf_match_iqk_version(dm_void)) ? "(match)" : "(mismatch)"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "LCK", HALRF_LCK_VER); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "DPK", HALRF_DPK_VER); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "TSSI", HALRF_TSSI_VER); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "KFREE", HALRF_KFREE_VER); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "TX 2G Current Calibration", HALRF_PABIASK_VER); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "RFK Init. Parameter", HALRF_RFK_INIT_VER); -+ -+ *_used = used; -+ *_out_len = out_len; -+#endif -+} -+ -+void halrf_debug_trace(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u32 one = 1; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 rf_var[10] = {0}; -+ u8 i; -+ -+ for (i = 0; i < 5; i++) -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 2], DCMD_DECIMAL, &rf_var[i]); -+ -+ if (rf_var[0] == 100) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n[DBG MSG] RF Selection\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "00. (( %s ))TX_PWR_TRACK\n", -+ ((rf->rf_dbg_comp & DBG_RF_TX_PWR_TRACK) ? ("V") : -+ ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "01. (( %s ))IQK\n", -+ ((rf->rf_dbg_comp & DBG_RF_IQK) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "02. (( %s ))LCK\n", -+ ((rf->rf_dbg_comp & DBG_RF_LCK) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "03. (( %s ))DPK\n", -+ ((rf->rf_dbg_comp & DBG_RF_DPK) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "04. (( %s ))TXGAPK\n", -+ ((rf->rf_dbg_comp & DBG_RF_TXGAPK) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "06. (( %s ))DPK_TRACK\n", -+ ((rf->rf_dbg_comp & DBG_RF_DPK_TRACK) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "29. (( %s ))MP\n", -+ ((rf->rf_dbg_comp & DBG_RF_MP) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "30. (( %s ))TMP\n", -+ ((rf->rf_dbg_comp & DBG_RF_TMP) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "31. (( %s ))INIT\n", -+ ((rf->rf_dbg_comp & DBG_RF_INIT) ? ("V") : ("."))); -+ -+ } else if (rf_var[0] == 101) { -+ rf->rf_dbg_comp = 0; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Disable all DBG COMP\n"); -+ } else { -+ if (rf_var[1] == 1) /*enable*/ -+ rf->rf_dbg_comp |= (one << rf_var[0]); -+ else if (rf_var[1] == 2) /*disable*/ -+ rf->rf_dbg_comp &= ~(one << rf_var[0]); -+ } -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\nCurr-RF_Dbg_Comp = 0x%x\n", rf->rf_dbg_comp); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void halrf_dack_debug_cmd(void *dm_void, char input[][16]) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u32 dm_value[10] = {0}; -+ u8 i; -+ -+ for (i = 0; i < 7; i++) -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 2], DCMD_DECIMAL, &dm_value[i]); -+ -+ if (dm_value[0] == 1) -+ halrf_dack_trigger(dm, true); -+ else -+ halrf_dack_trigger(dm, false); -+} -+ -+struct halrf_command { -+ char name[16]; -+ u8 id; -+}; -+ -+enum halrf_CMD_ID { -+ HALRF_HELP, -+ HALRF_SUPPORTABILITY, -+ HALRF_DBG_COMP, -+ HALRF_PROFILE, -+ HALRF_IQK_INFO, -+ HALRF_IQK, -+ HALRF_IQK_DEBUG, -+ HALRF_DPK, -+ HALRF_DACK, -+ HALRF_DACK_DEBUG, -+ HALRF_DUMP_RFK_REG, -+#ifdef CONFIG_2G_BAND_SHIFT -+ HAL_BAND_SHIFT, -+#endif -+}; -+ -+struct halrf_command halrf_cmd_ary[] = { -+ {"-h", HALRF_HELP}, -+ {"ability", HALRF_SUPPORTABILITY}, -+ {"dbg", HALRF_DBG_COMP}, -+ {"profile", HALRF_PROFILE}, -+ {"iqk_info", HALRF_IQK_INFO}, -+ {"iqk", HALRF_IQK}, -+ {"iqk_dbg", HALRF_IQK_DEBUG}, -+ {"dpk", HALRF_DPK}, -+ {"dack", HALRF_DACK}, -+ {"dack_dbg", HALRF_DACK_DEBUG}, -+ {"dump_rfk_reg", HALRF_DUMP_RFK_REG}, -+#ifdef CONFIG_2G_BAND_SHIFT -+ {"band_shift", HAL_BAND_SHIFT}, -+#endif -+}; -+ -+void halrf_cmd_parser(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len, u32 input_num) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+ u8 id = 0; -+ u32 rf_var[10] = {0}; -+ u32 i, input_idx = 0; -+ u32 halrf_ary_size = -+ sizeof(halrf_cmd_ary) / sizeof(struct halrf_command); -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ /* Parsing Cmd ID */ -+ for (i = 0; i < halrf_ary_size; i++) { -+ if (strcmp(halrf_cmd_ary[i].name, input[1]) == 0) { -+ id = halrf_cmd_ary[i].id; -+ break; -+ } -+ } -+ -+ if (i == halrf_ary_size) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "RF Cmd not found\n"); -+ return; -+ } -+ -+ switch (id) { -+ case HALRF_HELP: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "RF cmd ==>\n"); -+ -+ for (i = 0; i < halrf_ary_size - 1; i++) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-5d: %s\n", i, halrf_cmd_ary[i + 1].name); -+ } -+ break; -+ case HALRF_SUPPORTABILITY: -+ halrf_support_ability_debug(dm, &input[0], &used, output, -+ &out_len); -+ break; -+#ifdef CONFIG_2G_BAND_SHIFT -+ case HAL_BAND_SHIFT: -+ halrf_support_band_shift_debug(dm, &input[0], &used, output, -+ &out_len); -+ break; -+#endif -+ case HALRF_DBG_COMP: -+ halrf_debug_trace(dm, &input[0], &used, output, &out_len); -+ break; -+ case HALRF_PROFILE: -+ halrf_basic_profile(dm, &used, output, &out_len); -+ break; -+ case HALRF_IQK_INFO: -+#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) -+ halrf_iqk_info_dump(dm, &used, output, &out_len); -+#endif -+ break; -+ case HALRF_IQK: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "TRX IQK Trigger\n"); -+ halrf_iqk_trigger(dm, false); -+#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) -+ halrf_iqk_info_dump(dm, &used, output, &out_len); -+#endif -+ break; -+ case HALRF_IQK_DEBUG: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "IQK DEBUG!!!!!\n"); -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 2], DCMD_HEX, -+ &rf_var[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 || RTL8822C_SUPPORT == 1 || RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8822C | ODM_RTL8814B)) -+ halrf_iqk_debug(dm, (u32 *)rf_var, &used, -+ output, &out_len); -+#endif -+ } -+ break; -+ case HALRF_DPK: -+ halrf_dpk_debug_cmd(dm, input, &used, output, &out_len); -+ break; -+ case HALRF_DACK: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DACK Trigger\n"); -+ halrf_dack_debug_cmd(dm, &input[0]); -+ break; -+ case HALRF_DACK_DEBUG: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DACK DEBUG\n"); -+ halrf_dack_dbg(dm); -+ break; -+ case HALRF_DUMP_RFK_REG: -+ halrf_dump_rfk_reg(dm, input, &used, output, &out_len); -+ break; -+ default: -+ break; -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+#endif -+} -+ -+void halrf_init_debug_setting(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ rf->rf_dbg_comp = -+ -+ DBG_RF_RFK | -+#if DBG -+#if 1 -+ /*DBG_RF_TX_PWR_TRACK | */ -+ /*DBG_RF_IQK | */ -+ /*DBG_RF_LCK | */ -+ /*DBG_RF_DPK | */ -+ /*DBG_RF_TXGAPK | */ -+ /*DBG_RF_DACK | */ -+ /*DBG_RF_DPK_TRACK | */ -+ /*DBG_RF_MP | */ -+ /*DBG_RF_TMP | */ -+ /*DBG_RF_INIT | */ -+#endif -+#endif -+ 0; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_debug.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_debug.h -new file mode 100644 -index 000000000..c13f3c567 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_debug.h -@@ -0,0 +1,140 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALRF_DEBUG_H__ -+#define __HALRF_DEBUG_H__ -+ -+/*@============================================================*/ -+/*@include files*/ -+/*@============================================================*/ -+ -+/*@============================================================*/ -+/*@Definition */ -+/*@============================================================*/ -+ -+#if DBG -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#define RF_DBG(dm, comp, fmt, args...) \ -+ do { \ -+ if ((comp) & dm->rf_table.rf_dbg_comp) { \ -+ pr_debug("[RF] "); \ -+ RT_PRINTK(fmt, ##args); \ -+ } \ -+ } while (0) -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+static __inline void RF_DBG(PDM_ODM_T dm, int comp, char *fmt, ...) -+{ -+ RT_STATUS rt_status; -+ va_list args; -+ char buf[PRINT_MAX_SIZE] = {0}; -+ -+ if ((comp & dm->rf_table.rf_dbg_comp) == 0) -+ return; -+ -+ if (fmt == NULL) -+ return; -+ -+ va_start(args, fmt); -+ rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, PRINT_MAX_SIZE, fmt, args); -+ va_end(args); -+ -+ if (rt_status != RT_STATUS_SUCCESS) { -+ DbgPrint("Failed (%d) to print message to buffer\n", rt_status); -+ return; -+ } -+ -+ DbgPrint("[RF] %s", buf); -+} -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ -+#define RF_DBG(dm, comp, fmt, args...) \ -+ do { \ -+ if ((comp) & dm->rf_table.rf_dbg_comp) { \ -+ RT_DEBUG(COMP_PHYDM, DBG_DMESG, "[RF] " fmt, ##args); \ -+ } \ -+ } while (0) -+ -+#else -+#define RF_DBG(dm, comp, fmt, args...) \ -+ do { \ -+ struct dm_struct *__dm = dm; \ -+ if ((comp) & __dm->rf_table.rf_dbg_comp) { \ -+ RT_TRACE(((struct rtl_priv *)__dm->adapter), \ -+ COMP_PHYDM, DBG_DMESG, "[RF] " fmt, ##args); \ -+ } \ -+ } while (0) -+#endif -+ -+#else /*#if DBG*/ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+static __inline void RF_DBG(struct dm_struct *dm, int comp, char *fmt, ...) -+{ -+#if 0 -+ RT_STATUS rt_status; -+ va_list args; -+ char buf[128] = {0};/*PRINT_MAX_SIZE*/ -+ -+ if ((comp & dm->rf_table.rf_dbg_comp) == 0) -+ return; -+ -+ if (NULL != fmt) { -+ va_start(args, fmt); -+ rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, sizeof(buf), fmt, args); -+ va_end(args); -+ if (rt_status == RT_STATUS_SUCCESS) { -+ halrf_rt_trace(buf); -+ } -+ } -+#endif -+} -+#else -+#define RF_DBG(dm, comp, fmt, args...) -+#endif -+ -+#endif /*#if DBG*/ -+ -+/*@============================================================*/ -+/*@ enumeration */ -+/*@============================================================*/ -+ -+/*@============================================================*/ -+/*@ structure */ -+/*@============================================================*/ -+ -+/*@============================================================*/ -+/*@ function prototype */ -+/*@============================================================*/ -+ -+void halrf_cmd_parser(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len, u32 input_num); -+ -+void halrf_init_debug_setting(void *dm_void); -+ -+#endif /*__HALRF_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_dpk.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_dpk.h -new file mode 100644 -index 000000000..f51ff6f6e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_dpk.h -@@ -0,0 +1,195 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALRF_DPK_H__ -+#define __HALRF_DPK_H__ -+ -+/*@--------------------------Define Parameters-------------------------------*/ -+#define GAIN_LOSS 1 -+#define DO_DPK 2 -+#define DPK_ON 3 -+#define GAIN_LOSS_PULSE 4 -+#define DPK_PAS 5 -+#define DPK_LMS 6 -+#define DPK_LOK 4 -+#define DPK_TXK 5 -+#define DAGC 4 -+#define LOSS_CHK 0 -+#define GAIN_CHK 1 -+#define PAS_READ 2 -+#define AVG_THERMAL_NUM 8 -+#define AVG_THERMAL_NUM_DPK 8 -+#define THERMAL_DPK_AVG_NUM 4 -+ -+/*define RF path numer*/ -+#if (RTL8198F_SUPPORT == 1 || RTL8814B_SUPPORT == 1|| RTL8814C_SUPPORT == 1) -+#define KPATH 4 -+#elif (RTL8192F_SUPPORT == 1 || RTL8197F_SUPPORT == 1 ||RTL8197G_SUPPORT == 1 ||\ -+ RTL8822C_SUPPORT == 1 || RTL8812F_SUPPORT == 1 || RTL8723F_SUPPORT == 1) -+#define KPATH 2 -+#else -+#define KPATH 1 -+#endif -+ -+#if (RTL8814B_SUPPORT == 1 || RTL8721D_SUPPORT == 1) -+#define GROUP_5G 6 -+#elif (RTL8195B_SUPPORT == 1) -+#define GROUP_5G 13 -+#endif -+ -+/*@---------------------------End Define Parameters---------------------------*/ -+ -+struct dm_dpk_info { -+ -+ boolean is_dpk_enable; -+ boolean is_dpk_pwr_on; -+ boolean is_dpk_by_channel; -+ boolean is_tssi_mode; -+ u8 dpk_status; /*bit[0]:reload;bit[1]:cal;bit[2]:cal_ok*/ -+ u16 dpk_path_ok; -+ /*@BIT(15)~BIT(12) : 5G reserved, BIT(11)~BIT(8) 5G_S3~5G_S0*/ -+ /*@BIT(7)~BIT(4) : 2G reserved, BIT(3)~BIT(0) 2G_S3~2G_S0*/ -+ u8 thermal_dpk[KPATH]; /*path*/ -+ u8 thermal_dpk_avg[KPATH][AVG_THERMAL_NUM_DPK]; /*path*/ -+ u8 pre_pwsf[KPATH]; -+ u8 thermal_dpk_avg_index; -+ u32 gnt_control; -+ u32 gnt_value; -+ u8 dpk_ch; -+ u8 dpk_band; -+ u8 dpk_bw; -+ u32 dpk_rf18[2]; -+ u32 dpk_cal_cnt; -+ u32 dpk_ok_cnt; -+ u32 dpk_reload_cnt; -+ -+#if (RTL8822C_SUPPORT == 1 || RTL8812F_SUPPORT == 1 || RTL8197G_SUPPORT == 1) -+ u16 dc_i[2]; /*MDPD DC I path*/ -+ u16 dc_q[2]; /*MDPD DC Q path*/ -+ u8 corr_val[2]; /*Corr value path*/ -+ u8 corr_idx[2]; /*Corr index path*/ -+#endif -+ -+#if (RTL8822C_SUPPORT == 1 || RTL8812F_SUPPORT == 1) -+ u8 result[2]; /*path*/ -+ u8 dpk_txagc[2]; /*path*/ -+ u32 coef[2][20]; /*path/MDPD coefficient*/ -+ u16 dpk_gs[2]; /*MDPD coef gs*/ -+ u8 thermal_dpk_delta[2]; /*path*/ -+#endif -+ -+#if (RTL8198F_SUPPORT == 1 || RTL8192F_SUPPORT == 1 || RTL8197F_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8197G_SUPPORT == 1) -+ /*2G DPK data*/ -+ u8 dpk_result[KPATH][3]; /*path/group*/ -+ u8 pwsf_2g[KPATH][3]; /*path/group*/ -+ u32 lut_2g_even[KPATH][3][64]; /*path/group/LUT data*/ -+ u32 lut_2g_odd[KPATH][3][64]; /*path/group/LUT data*/ -+ s16 tmp_pas_i[32]; /*PAScan I data*/ -+ s16 tmp_pas_q[32]; /*PAScan Q data*/ -+#endif -+ -+#if (RTL8814B_SUPPORT == 1) -+ /*5G DPK data*/ -+ u8 dpk_5g_result[KPATH][GROUP_5G]; /*path/group*/ -+ u8 pwsf_5g[KPATH][GROUP_5G]; /*path/group*/ -+ u32 lut_5g[KPATH][GROUP_5G][64]; /*path/group/LUT data*/ -+ u32 lut_2g[KPATH][3][64]; /*path/group/LUT data*/ -+ u8 rxbb[4]; /*path/group*/ -+ u8 txbb[4]; /*path/group*/ -+ u8 tx_gain; -+#endif -+ -+#if (RTL8814C_SUPPORT == 1) -+ u8 thr_pwsf[KPATH]; -+#endif -+ -+ -+#if (RTL8195B_SUPPORT == 1) -+ u8 dpk_txagc; -+ /*2G DPK data*/ -+ u8 dpk_2g_result[KPATH][3]; /*path/group*/ -+ u8 pwsf_2g[KPATH][3]; /*path/group*/ -+ u32 lut_2g_even[KPATH][3][16]; /*path/group/LUT data*/ -+ u32 lut_2g_odd[KPATH][3][16]; /*path/group/LUT data*/ -+ /*5G DPK data*/ -+ u8 dpk_5g_result[KPATH][GROUP_5G]; /*path/group*/ -+ u8 pwsf_5g[KPATH][GROUP_5G]; /*path/group*/ -+ u32 lut_5g_even[KPATH][GROUP_5G][16]; /*path/group/LUT data*/ -+ u32 lut_5g_odd[KPATH][GROUP_5G][16]; /*path/group/LUT data*/ -+#endif -+ -+#if (RTL8721D_SUPPORT == 1) -+ s16 tmp_pas_i[32]; /*PAScan I data*/ -+ s16 tmp_pas_q[32]; /*PAScan Q data*/ -+ u8 dpk_txagc; /*path*/ -+#if (DPK_BY_GROUP_K_8721D) -+ /*2G DPK data*/ -+ u8 dpk_2g_result[1][3]; /*path/group*/ -+ u8 pwsf_2g[1][3]; /*path/group*/ -+ u32 lut_2g_even[1][3][16]; /*path/group/LUT data*/ -+ u32 lut_2g_odd[1][3][16]; /*path/group/LUT data*/ -+ /*5G DPK data*/ -+ u8 dpk_5g_result[1][6]; /*path/group*/ -+ u8 pwsf_5g[1][6]; /*path/group*/ -+ u32 lut_5g_even[1][6][16]; /*path/group/LUT data*/ -+ u32 lut_5g_odd[1][6][16]; /*path/group/LUT data*/ -+#else -+ u8 dpk_2g_result[1][1]; /*path/group*/ -+ u8 pwsf_2g[1][1]; /*path/group*/ -+ u32 lut_2g_even[1][1][16]; /*path/group/LUT data*/ -+ u32 lut_2g_odd[1][1][16]; /*path/group/LUT data*/ -+ u8 dpk_5g_result[1][1]; /*path/group*/ -+ u8 pwsf_5g[1][1]; /*path/group*/ -+ u32 lut_5g_even[1][1][16]; /*path/group/LUT data*/ -+ u32 lut_5g_odd[1][1][16]; /*path/group/LUT data*/ -+#endif -+#endif -+ -+#if(RTL8723F_SUPPORT == 1) -+ u8 one_shot_cnt; -+ u8 dpk_current_path; -+ u8 thermal_init[KPATH]; -+ u8 dpk_delta_thermal[KPATH]; /*path*/ -+ s8 last_offset[KPATH]; /*path*/ -+ u8 txagc[KPATH]; /*path*/ -+ u8 tssi_txagc[KPATH][2]; /*path/0:txagc_rf,1:tssi_offset*/ -+ u16 digital_bbgain[KPATH]; /*path*/ -+ u16 pwsf[KPATH]; /*path*/ -+ -+#endif -+}; -+ -+#if (RTL8822C_SUPPORT == 1) -+struct dm_dpk_c2h_report { -+ u8 result[2]; /*ch0_result/ch1_result*/ -+ u8 therm[2][2]; /*therm0_s0/therm0_s1/therm1_s0/therm1_s1*/ -+ u8 therm_delta[2][2]; /*therm_delta0_s0/therm_delta0_s1/therm_delta1_s0/therm_delta1_s1*/ -+ u32 dpk_rf18[2]; /*dpk_ch0/dpk_ch1*/ -+ u8 dpk_status; /*dpk_status*/ -+}; -+#endif -+ -+#endif /*__HALRF_DPK_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_features.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_features.h -new file mode 100644 -index 000000000..da97614be ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_features.h -@@ -0,0 +1,43 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALRF_FEATURES_H__ -+#define __HALRF_FEATURES_H__ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+#define CONFIG_HALRF_POWERTRACKING 1 -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+#define CONFIG_HALRF_POWERTRACKING 1 -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+#define CONFIG_HALRF_POWERTRACKING 1 -+ -+#endif -+ -+#endif /*#ifndef __HALRF_FEATURES_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_iqk.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_iqk.h -new file mode 100644 -index 000000000..0c7fe30f3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_iqk.h -@@ -0,0 +1,159 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALRF_IQK_H__ -+#define __HALRF_IQK_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 kcount_limit_80m 2 -+#define kcount_limit_others 4 -+#define rxiqk_gs_limit 6 -+#define TXWBIQK_EN 1 -+#define RXWBIQK_EN 1 -+#if (RTL8814A_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT ||RTL8814C_SUPPORT == 1) -+#define NUM 4 -+#elif (RTL8822B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ -+ RTL8812F_SUPPORT == 1 || RTL8197G_SUPPORT == 1 ||\ -+ RTL8723F_SUPPORT == 1) -+#define NUM 2 -+#else -+#define NUM 1 -+#endif -+ -+/*@-----------------------End Define Parameters-----------------------*/ -+ -+struct dm_dack_info { -+ boolean dack_en; -+ u16 msbk_d[2][2][15]; -+ u8 dck_d[2][2][2]; -+ u16 biask_d[2][2]; -+}; -+ -+struct dm_iqk_info { -+ boolean lok_fail[NUM]; -+ boolean iqk_fail[2][NUM]; -+ u32 iqc_matrix[2][NUM]; -+ u8 iqk_times; -+ u32 rf_reg18; -+ u32 rf_reg08; -+ u32 lna_idx; -+ u8 iqk_step; -+ u8 rxiqk_step; -+ u8 tmp1bcc; -+ u8 txgain; -+ u32 txgain56; -+ u8 kcount; -+ u8 rfk_ing; /*bit0:IQKing, bit1:LCKing, bit2:DPKing*/ -+ boolean rfk_forbidden; -+ u8 rxbb; -+ u32 rf_reg58; -+ boolean segment_iqk; -+ boolean is_tssi_mode; -+ u8 iqk_band; -+ u8 iqk_ch; -+ u8 iqk_bw; -+#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 ||\ -+ RTL8195B_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ -+ RTL8812F_SUPPORT == 1 || RTL8197G_SUPPORT == 1 ||\ -+ RTL8710C_SUPPORT == 1 || RTL8723F_SUPPORT == 1 ||\ -+ RTL8814C_SUPPORT == 1) -+ u32 iqk_channel[2]; -+ boolean iqk_fail_report[2][NUM][2]; /*channel/path/TRX(TX:0, RX:1) */ -+ /*channel / path / TRX(TX:0, RX:1) / CFIR_real*/ -+ /*channel index = 2 is just for debug*/ -+#if (RTL8814B_SUPPORT == 1||RTL8814C_SUPPORT == 1) -+ u16 iqk_cfir_real[3][NUM][2][19]; -+ u16 iqk_cfir_imag[3][NUM][2][19]; -+ u32 rx_cfir_real[2][NUM][17]; -+ u32 rx_cfir_imag[2][NUM][17]; -+ u32 rx_cfir[2][NUM]; -+#elif (RTL8812F_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ) -+ u16 iqk_cfir_real[3][2][2][17]; -+ /*channel / path / TRX(TX:0, RX:1) / CFIR_imag*/ -+ /*channel index = 2 is just for debug*/ -+ u16 iqk_cfir_imag[3][2][2][17]; -+ u32 rx_cfir_real[2][2][17]; -+ u32 rx_cfir_imag[2][2][17]; -+ u32 rx_cfir[2][2]; -+ /*times/path*/ -+#elif (RTL8195B_SUPPORT == 1) -+ u32 iqk_cfir_real[3][NUM][2][9]; -+ u32 iqk_cfir_imag[3][NUM][2][9]; -+ /*channel / path / TRX(TX:0, RX:1) / CFIR_imag*/ -+ /*channel index = 2 is just for debug*/ -+#else -+ u32 iqk_cfir_real[3][NUM][2][8]; -+ /*channel / path / TRX(TX:0, RX:1) / CFIR_imag*/ -+ /*channel index = 2 is just for debug*/ -+ u32 iqk_cfir_imag[3][NUM][2][8]; -+#endif -+ -+ u8 retry_count[2][NUM][3]; /* channel / path / (TXK:0, RXK1:1, RXK2:2) */ -+ u8 gs_retry_count[2][NUM][2]; /* channel / path / (GSRXK1:0, GSRXK2:1) */ -+ /* channel / path 0:SRXK1 fail, 1:RXK1 fail 2:RXK2 fail */ -+ u8 rxiqk_fail_code[2][NUM]; -+ u32 lok_idac[2][NUM]; /*channel / path*/ -+ u16 rxiqk_agc[2][NUM]; /*channel / path*/ -+ u32 bypass_iqk[2][NUM]; /*channel / 0xc94/0xe94*/ -+ u32 txgap_result[8]; /*txagpK result */ -+ u32 tmp_gntwl; -+ boolean is_btg; -+ boolean isbnd; -+ boolean is_reload; -+ boolean is_hwtx; -+ boolean xym_read; -+ boolean trximr_enable; -+#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1) -+ u32 rx_xym[2][10]; -+ u32 tx_xym[2][10]; -+ u32 gs1_xym[2][6]; -+ u32 gs2_xym[2][6]; -+ u32 rxk1_xym[2][6]; -+ u32 nbtxk_1b38[2]; -+ u32 nbrxk_1b3c[2]; -+#endif -+#if (RTL8710C_SUPPORT == 1 || RTL8197G_SUPPORT == 1 ) -+ u32 txxy[2][2]; -+ u32 rxxy[2][2]; -+#endif -+#if (RTL8723F_SUPPORT == 1) -+ u32 txxy[2][2]; -+ u32 rxxy[2][2][2]; -+#endif -+ -+#endif -+}; -+ -+#endif /*__HALRF_IQK_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_kfree.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_kfree.c -new file mode 100644 -index 000000000..66a9a7077 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_kfree.c -@@ -0,0 +1,4018 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@============================================================*/ -+/*@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_set_kfree_to_rf_8814a(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ boolean is_odd; -+ u32 tx_gain_bitmask = (BIT(17) | BIT(16) | BIT(15)); -+ -+ if ((data % 2) != 0) { /*odd->positive*/ -+ data = data - 1; -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), 1); -+ is_odd = true; -+ } else { /*even->negative*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), 0); -+ is_odd = false; -+ } -+ RF_DBG(dm, DBG_RF_MP, "phy_ConfigKFree8814A(): RF_0x55[19]= %d\n", -+ is_odd); -+ switch (data) { -+ case 0: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 0); -+ cali_info->kfree_offset[e_rf_path] = 0; -+ break; -+ case 2: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 0); -+ cali_info->kfree_offset[e_rf_path] = 0; -+ break; -+ case 4: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 1); -+ cali_info->kfree_offset[e_rf_path] = 1; -+ break; -+ case 6: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 1); -+ cali_info->kfree_offset[e_rf_path] = 1; -+ break; -+ case 8: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 2); -+ cali_info->kfree_offset[e_rf_path] = 2; -+ break; -+ case 10: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 2); -+ cali_info->kfree_offset[e_rf_path] = 2; -+ break; -+ case 12: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 3); -+ cali_info->kfree_offset[e_rf_path] = 3; -+ break; -+ case 14: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 3); -+ cali_info->kfree_offset[e_rf_path] = 3; -+ break; -+ case 16: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 4); -+ cali_info->kfree_offset[e_rf_path] = 4; -+ break; -+ case 18: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 4); -+ cali_info->kfree_offset[e_rf_path] = 4; -+ break; -+ case 20: -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 5); -+ cali_info->kfree_offset[e_rf_path] = 5; -+ break; -+ -+ default: -+ break; -+ } -+ -+ if (!is_odd) { -+ /*that means Kfree offset is negative, we need to record it.*/ -+ cali_info->kfree_offset[e_rf_path] = -+ (-1) * cali_info->kfree_offset[e_rf_path]; -+ RF_DBG(dm, DBG_RF_MP, -+ "phy_ConfigKFree8814A(): kfree_offset = %d\n", -+ cali_info->kfree_offset[e_rf_path]); -+ } else { -+ RF_DBG(dm, DBG_RF_MP, -+ "phy_ConfigKFree8814A(): kfree_offset = %d\n", -+ cali_info->kfree_offset[e_rf_path]); -+ } -+} -+ -+void phydm_get_thermal_trim_offset_8821c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0xff; -+ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_OFFSET_21C, &pg_therm, false); -+ -+ if (pg_therm != 0xff) { -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->thermal = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->thermal = (pg_therm >> 1); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8821c thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8821c thermal:%d\n", -+ power_trim_info->thermal); -+} -+ -+void phydm_get_power_trim_offset_8821c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_power = 0xff, i; -+ -+ odm_efuse_one_byte_read(dm, PPG_2G_TXAB_21C, &pg_power, false); -+ -+ if (pg_power != 0xff) { -+ power_trim_info->bb_gain[0][0] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_21C, &pg_power, false); -+ power_trim_info->bb_gain[1][0] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_21C, &pg_power, false); -+ power_trim_info->bb_gain[2][0] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_21C, &pg_power, false); -+ power_trim_info->bb_gain[3][0] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_21C, &pg_power, false); -+ power_trim_info->bb_gain[4][0] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_21C, &pg_power, false); -+ power_trim_info->bb_gain[5][0] = pg_power; -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | -+ KFREE_FLAG_ON_2G | KFREE_FLAG_ON_5G; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8821c power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8821c pwr_trim->bb_gain[%d][0]=0x%X\n", -+ i, power_trim_info->bb_gain[i][0]); -+ } -+} -+ -+void phydm_set_kfree_to_rf_8821c(void *dm_void, u8 e_rf_path, boolean wlg_btg, -+ u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 wlg, btg; -+ u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)); -+ u32 s_gain_bmask = (BIT(19) | BIT(18) | BIT(17) | -+ BIT(16) | BIT(15) | BIT(14)); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(5), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(6), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x65, BIT(6), 1); -+ -+ if (wlg_btg) { -+ wlg = data & 0xf; -+ btg = (data & 0xf0) >> 4; -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (wlg & BIT(0))); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, (wlg >> 1)); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x65, BIT(19), (btg & BIT(0))); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x65, gain_bmask, (btg >> 1)); -+ } else { -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), data & BIT(0)); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, -+ ((data & 0x1f) >> 1)); -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8821c 0x55[19:14]=0x%X 0x65[19:14]=0x%X\n", -+ odm_get_rf_reg(dm, e_rf_path, RF_0x55, s_gain_bmask), -+ odm_get_rf_reg(dm, e_rf_path, RF_0x65, s_gain_bmask)); -+} -+ -+void phydm_clear_kfree_to_rf_8821c(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)); -+ u32 s_gain_bmask = (BIT(19) | BIT(18) | BIT(17) | -+ BIT(16) | BIT(15) | BIT(14)); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(5), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(6), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x65, BIT(6), 1); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, (data >> 1)); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x65, BIT(19), (data & BIT(0))); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x65, gain_bmask, (data >> 1)); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(5), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(6), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x65, BIT(6), 0); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8821c 0x55[19:14]=0x%X 0x65[19:14]=0x%X\n", -+ odm_get_rf_reg(dm, e_rf_path, RF_0x55, s_gain_bmask), -+ odm_get_rf_reg(dm, e_rf_path, RF_0x65, s_gain_bmask)); -+} -+ -+void phydm_get_thermal_trim_offset_8822b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0xff; -+ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_OFFSET_22B, &pg_therm, false); -+ -+ if (pg_therm != 0xff) { -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->thermal = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->thermal = (pg_therm >> 1); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822b thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822b thermal:%d\n", -+ power_trim_info->thermal); -+} -+ -+void phydm_get_power_trim_offset_8822b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_power = 0xff, i, j; -+ -+ odm_efuse_one_byte_read(dm, PPG_2G_TXAB_22B, &pg_power, false); -+ -+ if (pg_power != 0xff) { -+ /*Path A*/ -+ odm_efuse_one_byte_read(dm, PPG_2G_TXAB_22B, &pg_power, false); -+ power_trim_info->bb_gain[0][0] = (pg_power & 0xf); -+ -+ /*Path B*/ -+ odm_efuse_one_byte_read(dm, PPG_2G_TXAB_22B, &pg_power, false); -+ power_trim_info->bb_gain[0][1] = ((pg_power & 0xf0) >> 4); -+ -+ power_trim_info->flag |= KFREE_FLAG_ON_2G; -+ power_trim_info->flag |= KFREE_FLAG_ON; -+ } -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22B, &pg_power, false); -+ -+ if (pg_power != 0xff) { -+ /*Path A*/ -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22B, &pg_power, false); -+ power_trim_info->bb_gain[1][0] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_22B, &pg_power, false); -+ power_trim_info->bb_gain[2][0] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_22B, &pg_power, false); -+ power_trim_info->bb_gain[3][0] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_22B, &pg_power, false); -+ power_trim_info->bb_gain[4][0] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_22B, &pg_power, false); -+ power_trim_info->bb_gain[5][0] = pg_power; -+ -+ /*Path B*/ -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_22B, &pg_power, false); -+ power_trim_info->bb_gain[1][1] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXB_22B, &pg_power, false); -+ power_trim_info->bb_gain[2][1] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXB_22B, &pg_power, false); -+ power_trim_info->bb_gain[3][1] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXB_22B, &pg_power, false); -+ power_trim_info->bb_gain[4][1] = pg_power; -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXB_22B, &pg_power, false); -+ power_trim_info->bb_gain[5][1] = pg_power; -+ -+ power_trim_info->flag |= KFREE_FLAG_ON_5G; -+ power_trim_info->flag |= KFREE_FLAG_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822b power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (!(power_trim_info->flag & KFREE_FLAG_ON)) -+ return; -+ -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < 2; j++) -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8822b PwrTrim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+} -+ -+void phydm_set_pa_bias_to_rf_8822b(void *dm_void, u8 e_rf_path, s8 tx_pa_bias) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 rf_reg_51 = 0, rf_reg_52 = 0, rf_reg_3f = 0; -+ u32 tx_pa_bias_bmask = (BIT(12) | BIT(11) | BIT(10) | BIT(9)); -+ -+ rf_reg_51 = odm_get_rf_reg(dm, e_rf_path, RF_0x51, RFREGOFFSETMASK); -+ rf_reg_52 = odm_get_rf_reg(dm, e_rf_path, RF_0x52, RFREGOFFSETMASK); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8822b 2g rf(0x51)=0x%X rf(0x52)=0x%X path=%d\n", -+ rf_reg_51, rf_reg_52, e_rf_path); -+ -+#if 0 -+ /*rf3f => rf52[19:17] = rf3f[2:0] rf52[16:15] = rf3f[4:3] rf52[3:0] = rf3f[8:5]*/ -+ /*rf3f => rf51[6:3] = rf3f[12:9] rf52[13] = rf3f[13]*/ -+#endif -+ rf_reg_3f = ((rf_reg_52 & 0xe0000) >> 17) | -+ (((rf_reg_52 & 0x18000) >> 15) << 3) | -+ ((rf_reg_52 & 0xf) << 5) | -+ (((rf_reg_51 & 0x78) >> 3) << 9) | -+ (((rf_reg_52 & 0x2000) >> 13) << 13); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8822b 2g original pa_bias=%d rf_reg_3f=0x%X path=%d\n", -+ tx_pa_bias, rf_reg_3f, e_rf_path); -+ -+ tx_pa_bias = (s8)((rf_reg_3f & tx_pa_bias_bmask) >> 9) + tx_pa_bias; -+ -+ if (tx_pa_bias < 0) -+ tx_pa_bias = 0; -+ else if (tx_pa_bias > 7) -+ tx_pa_bias = 7; -+ -+ rf_reg_3f = ((rf_reg_3f & 0xfe1ff) | (tx_pa_bias << 9)); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8822b 2g 0x%X 0x%X pa_bias=%d rfreg_3f=0x%X path=%d\n", -+ PPG_PABIAS_2GA_22B, PPG_PABIAS_2GB_22B, -+ tx_pa_bias, rf_reg_3f, e_rf_path); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(10), 0x1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, BIT(0), 0x1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, BIT(1), 0x1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, (BIT(1) | BIT(0)), 0x3); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); -+ odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(10), 0x0); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8822b 2g tx pa bias rf_0x3f(0x%X) path=%d\n", -+ odm_get_rf_reg(dm, e_rf_path, RF_0x3f, -+ (BIT(12) | BIT(11) | BIT(10) | BIT(9))), -+ e_rf_path); -+} -+ -+void phydm_get_pa_bias_offset_8822b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_pa_bias = 0xff, e_rf_path = 0; -+ s8 tx_pa_bias[2] = {0}; -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_22B, &pg_pa_bias, false); -+ -+ if (pg_pa_bias != 0xff) { -+ /*paht a*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_22B, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ if ((pg_pa_bias & BIT(0)) == 0) -+ tx_pa_bias[0] = (-1 * (pg_pa_bias >> 1)); -+ else -+ tx_pa_bias[0] = (pg_pa_bias >> 1); -+ -+ /*paht b*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GB_22B, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ if ((pg_pa_bias & BIT(0)) == 0) -+ tx_pa_bias[1] = (-1 * (pg_pa_bias >> 1)); -+ else -+ tx_pa_bias[1] = (pg_pa_bias >> 1); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8822b 2g PathA_pa_bias:%d PathB_pa_bias:%d\n", -+ tx_pa_bias[0], tx_pa_bias[1]); -+ -+ for (e_rf_path = RF_PATH_A; e_rf_path < 2; e_rf_path++) -+ phydm_set_pa_bias_to_rf_8822b(dm, e_rf_path, -+ tx_pa_bias[e_rf_path]); -+ -+ power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822b 2g tx pa bias no pg\n"); -+ } -+} -+ -+void phydm_set_kfree_to_rf_8822b(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(4), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x65, MASKLWORD, 0x9000); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 1); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, -+ ((data & 0x1f) >> 1)); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822b 0x55[19:14]=0x%X path=%d\n", -+ odm_get_rf_reg(dm, e_rf_path, RF_0x55, -+ (BIT(19) | BIT(18) | BIT(17) | BIT(16) | -+ BIT(15) | BIT(14))), e_rf_path); -+} -+ -+void phydm_clear_kfree_to_rf_8822b(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(4), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x65, MASKLWORD, 0x9000); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 1); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, -+ ((data & 0x1f) >> 1)); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(4), 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x65, MASKLWORD, 0x9000); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(7), 0); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8822b clear power trim 0x55[19:14]=0x%X path=%d\n", -+ odm_get_rf_reg(dm, e_rf_path, RF_0x55, -+ (BIT(19) | BIT(18) | BIT(17) | BIT(16) | -+ BIT(15) | BIT(14))), e_rf_path); -+} -+ -+void phydm_get_thermal_trim_offset_8710b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0xff; -+ -+ odm_efuse_one_byte_read(dm, 0x0EF, &pg_therm, false); -+ -+ if (pg_therm != 0xff) { -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->thermal = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->thermal = (pg_therm >> 1); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8710b thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8710b thermal:%d\n", -+ power_trim_info->thermal); -+} -+ -+void phydm_get_power_trim_offset_8710b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_power = 0xff; -+ -+ odm_efuse_one_byte_read(dm, 0xEE, &pg_power, false); -+ -+ if (pg_power != 0xff) { -+ /*Path A*/ -+ odm_efuse_one_byte_read(dm, 0xEE, &pg_power, false); -+ power_trim_info->bb_gain[0][0] = (pg_power & 0xf); -+ -+ power_trim_info->flag |= KFREE_FLAG_ON_2G; -+ power_trim_info->flag |= KFREE_FLAG_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8710b power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8710b power_trim_data->bb_gain[0][0]=0x%X\n", -+ power_trim_info->bb_gain[0][0]); -+} -+ -+void phydm_set_kfree_to_rf_8710b(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15)); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, ((data & 0xf) >> 1)); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8710b 0x55[19:14]=0x%X path=%d\n", -+ odm_get_rf_reg(dm, e_rf_path, RF_0x55, -+ (BIT(19) | BIT(18) | BIT(17) | BIT(16) | -+ BIT(15) | BIT(14))), e_rf_path); -+} -+ -+void phydm_clear_kfree_to_rf_8710b(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, -+ ((data & 0x1f) >> 1)); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8710b clear power trim 0x55[19:14]=0x%X path=%d\n", -+ odm_get_rf_reg(dm, e_rf_path, RF_0x55, -+ (BIT(19) | BIT(18) | BIT(17) | BIT(16) | -+ BIT(15) | BIT(14))), e_rf_path); -+} -+ -+void phydm_get_thermal_trim_offset_8192f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0xff; -+ -+ odm_efuse_one_byte_read(dm, 0x1EF, &pg_therm, false); -+ -+ if (pg_therm != 0xff) { -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->thermal = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->thermal = (pg_therm >> 1); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8192f thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8192f thermal:%d\n", -+ power_trim_info->thermal); -+} -+ -+void phydm_get_power_trim_offset_8192f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_power1 = 0xff, pg_power2 = 0xff, pg_power3 = 0xff, i, j; -+ -+ odm_efuse_one_byte_read(dm, 0x1EE, &pg_power1, false); /*CH4-9*/ -+ -+ if (pg_power1 != 0xff) { -+ /*Path A*/ -+ odm_efuse_one_byte_read(dm, 0x1EE, &pg_power1, false); -+ power_trim_info->bb_gain[1][0] = (pg_power1 & 0xf); -+ /*Path B*/ -+ odm_efuse_one_byte_read(dm, 0x1EE, &pg_power1, false); -+ power_trim_info->bb_gain[1][1] = ((pg_power1 & 0xf0) >> 4); -+ -+ power_trim_info->flag |= KFREE_FLAG_ON_2G; -+ power_trim_info->flag |= KFREE_FLAG_ON; -+ } -+ -+ odm_efuse_one_byte_read(dm, 0x1EC, &pg_power2, false); /*CH1-3*/ -+ -+ if (pg_power2 != 0xff) { -+ /*Path A*/ -+ odm_efuse_one_byte_read(dm, 0x1EC, &pg_power2, false); -+ power_trim_info->bb_gain[0][0] = (pg_power2 & 0xf); -+ /*Path B*/ -+ odm_efuse_one_byte_read(dm, 0x1EC, &pg_power2, false); -+ power_trim_info->bb_gain[0][1] = ((pg_power2 & 0xf0) >> 4); -+ -+ power_trim_info->flag |= KFREE_FLAG_ON_2G; -+ power_trim_info->flag |= KFREE_FLAG_ON; -+ } else { -+ power_trim_info->bb_gain[0][0] = (pg_power1 & 0xf); -+ power_trim_info->bb_gain[0][1] = ((pg_power1 & 0xf0) >> 4); -+ } -+ -+ odm_efuse_one_byte_read(dm, 0x1EA, &pg_power3, false); /*CH10-14*/ -+ -+ if (pg_power3 != 0xff) { -+ /*Path A*/ -+ odm_efuse_one_byte_read(dm, 0x1EA, &pg_power3, false); -+ power_trim_info->bb_gain[2][0] = (pg_power3 & 0xf); -+ /*Path B*/ -+ odm_efuse_one_byte_read(dm, 0x1EA, &pg_power3, false); -+ power_trim_info->bb_gain[2][1] = ((pg_power3 & 0xf0) >> 4); -+ -+ power_trim_info->flag |= KFREE_FLAG_ON_2G; -+ power_trim_info->flag |= KFREE_FLAG_ON; -+ } else { -+ power_trim_info->bb_gain[2][0] = (pg_power1 & 0xf); -+ power_trim_info->bb_gain[2][1] = ((pg_power1 & 0xf0) >> 4); -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8192F power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (!(power_trim_info->flag & KFREE_FLAG_ON)) -+ return; -+ -+ for (i = 0; i < KFREE_CH_NUM; i++) { -+ for (j = 0; j < 2; j++) -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8192F PwrTrim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+} -+ -+void phydm_set_kfree_to_rf_8192f(void *dm_void, u8 e_rf_path, u8 channel_idx, -+ u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /*power_trim based on 55[19:14]*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 1); -+ /*enable 55[14] for 0.5db step*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xf5, BIT(18), 1); -+ /*enter power_trim debug mode*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 1); -+ /*write enable*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 1); -+ -+ if (e_rf_path == 0) { -+ if (channel_idx == 0) { -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 0); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 1); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ -+ } else if (channel_idx == 1) { -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 2); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 3); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ } else if (channel_idx == 2) { -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 4); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 5); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ } -+ } else if (e_rf_path == 1) { -+ if (channel_idx == 0) { -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 0); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 1); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ } else if (channel_idx == 1) { -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 2); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 3); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ } else if (channel_idx == 2) { -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 4); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 5); -+ odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); -+ } -+ } -+ -+ /*leave power_trim debug mode*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 0); -+ /*write disable*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 0); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8192F 0x55[19:14]=0x%X path=%d channel=%d\n", -+ odm_get_rf_reg(dm, e_rf_path, RF_0x55, -+ (BIT(19) | BIT(18) | BIT(17) | BIT(16) | -+ BIT(15) | BIT(14))), e_rf_path, channel_idx); -+} -+ -+#if 0 -+/* -+void phydm_clear_kfree_to_rf_8192f(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)), ((data & 0x1f) >> 1)); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8192F clear power trim 0x55[19:14]=0x%X path=%d\n", -+ odm_get_rf_reg(dm, e_rf_path, RF_0x55, (BIT(19) | BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14))), -+ e_rf_path -+ ); -+} -+*/ -+#endif -+ -+void phydm_get_thermal_trim_offset_8198f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0; -+ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_OFFSET_98F, &pg_therm, false); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f efuse thermal trim 0x%X=0x%X\n", -+ PPG_THERMAL_OFFSET_98F, pg_therm); -+ -+ if (pg_therm != 0) { -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->thermal = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->thermal = (pg_therm >> 1); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f thermal:%d\n", -+ power_trim_info->thermal); -+} -+ -+void phydm_get_power_trim_offset_8198f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i, j; -+ u8 power_trim[6] = {0}; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_98F, &power_trim[0], false); -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXCD_98F, &power_trim[1], false); -+ odm_efuse_one_byte_read(dm, PPG_2GM_TXAB_98F, &power_trim[2], false); -+ odm_efuse_one_byte_read(dm, PPG_2GM_TXCD_98F, &power_trim[3], false); -+ odm_efuse_one_byte_read(dm, PPG_2GH_TXAB_98F, &power_trim[4], false); -+ odm_efuse_one_byte_read(dm, PPG_2GH_TXCD_98F, &power_trim[5], false); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f efuse Power Trim 0x%X=0x%X 0x%X=0x%X 0x%X=0x%X 0x%X=0x%X 0x%X=0x%X 0x%X=0x%X\n", -+ PPG_2GL_TXAB_98F, power_trim[0], -+ PPG_2GL_TXCD_98F, power_trim[1], -+ PPG_2GM_TXAB_98F, power_trim[2], -+ PPG_2GM_TXCD_98F, power_trim[3], -+ PPG_2GH_TXAB_98F, power_trim[4], -+ PPG_2GH_TXCD_98F, power_trim[5] -+ ); -+ -+ j = 0; -+ for (i = 0; i < 6; i++) { -+ if (power_trim[i] == 0x0) -+ j++; -+ } -+ -+ if (j == 6) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f Power Trim no pg\n"); -+ } else { -+ power_trim_info->bb_gain[0][0] = power_trim[0] & 0xf; -+ power_trim_info->bb_gain[0][1] = (power_trim[0] & 0xf0) >> 4; -+ -+ power_trim_info->bb_gain[0][2] = power_trim[1] & 0xf; -+ power_trim_info->bb_gain[0][3] = (power_trim[1] & 0xf0) >> 4; -+ -+ power_trim_info->bb_gain[1][0] = power_trim[2] & 0xf; -+ power_trim_info->bb_gain[1][1] = (power_trim[2] & 0xf0) >> 4; -+ -+ power_trim_info->bb_gain[1][2] = power_trim[3] & 0xf; -+ power_trim_info->bb_gain[1][3] = (power_trim[3] & 0xf0) >> 4; -+ -+ power_trim_info->bb_gain[2][0] = power_trim[4] & 0xf; -+ power_trim_info->bb_gain[2][1] = (power_trim[4] & 0xf0) >> 4; -+ -+ power_trim_info->bb_gain[2][2] = power_trim[5] & 0xf; -+ power_trim_info->bb_gain[2][3] = (power_trim[5] & 0xf0) >> 4; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | KFREE_FLAG_ON_2G; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < MAX_RF_PATH; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8198f pwr_trim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+ } -+ } -+} -+ -+void phydm_get_pa_bias_offset_8198f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i, j; -+ u8 pa_bias[2] = {0}; -+ u8 tx_pa_bias[4] = {0}; -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GAB_98F, &pa_bias[0], false); -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GCD_98F, &pa_bias[1], false); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f efuse Tx PA Bias 0x%X=0x%X 0x%X=0x%X\n", -+ PPG_PABIAS_2GAB_98F, pa_bias[0], PPG_PABIAS_2GCD_98F, pa_bias[1]); -+ -+ j = 0; -+ for (i = 0; i < 2; i++) { -+ if (pa_bias[i] == 0x0) -+ j++; -+ } -+ -+ if (j == 2) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f Tx PA Bias no pg\n"); -+ } else { -+ /*paht ab*/ -+ tx_pa_bias[0] = pa_bias[0] & 0xf; -+ tx_pa_bias[1] = ((pa_bias[0] & 0xf0) >> 4); -+ -+ /*paht cd*/ -+ tx_pa_bias[2] = pa_bias[1] & 0xf; -+ tx_pa_bias[3] = ((pa_bias[1] & 0xf0) >> 4); -+ -+ for (i = RF_PATH_A; i < 4; i++) { -+ if ((tx_pa_bias[i] & 0x1) == 1) -+ tx_pa_bias[i] = tx_pa_bias[i] & 0xe; -+ else -+ tx_pa_bias[i] = tx_pa_bias[i] | 0x1; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8198f PathA_pa_bias:0x%x PathB_pa_bias:0x%x\n", -+ tx_pa_bias[0], tx_pa_bias[1]); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8198f PathC_pa_bias:0x%x PathD_pa_bias:0x%x\n", -+ tx_pa_bias[2], tx_pa_bias[3]); -+ -+ for (i = RF_PATH_A; i < 4; i++) -+ odm_set_rf_reg(dm, i, 0x60, 0x0000f000, tx_pa_bias[i]); -+ -+ power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; -+ } -+} -+ -+void phydm_get_set_lna_offset_8198f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i, j; -+ u8 lna_trim[4] = {0}; -+ u8 cg[4] = {0}, cs[4] = {0}; -+ u32 rf_reg; -+ -+ odm_efuse_one_byte_read(dm, PPG_LNA_2GA_98F, &lna_trim[0], false); -+ odm_efuse_one_byte_read(dm, PPG_LNA_2GB_98F, &lna_trim[1], false); -+ odm_efuse_one_byte_read(dm, PPG_LNA_2GC_98F, &lna_trim[2], false); -+ odm_efuse_one_byte_read(dm, PPG_LNA_2GD_98F, &lna_trim[3], false); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f efuse LNA Trim 0x%X=0x%X 0x%X=0x%X 0x%X=0x%X 0x%X=0x%X\n", -+ PPG_LNA_2GA_98F, lna_trim[0], -+ PPG_LNA_2GB_98F, lna_trim[1], -+ PPG_LNA_2GC_98F, lna_trim[2], -+ PPG_LNA_2GD_98F, lna_trim[3] -+ ); -+ -+ j = 0; -+ for (i = 0; i < 4; i++) { -+ if (lna_trim[i] == 0x0) -+ j++; -+ } -+ -+ if (j == 4) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f LNA no pg\n"); -+ } else { -+ -+ for (i = 0; i < 4; i++) { -+ cg[i] = (lna_trim[i] & 0xc) >> 2; -+ cs[i] = lna_trim[i] & 0x3; -+ } -+ -+ for (i = RF_PATH_A; i <= RF_PATH_D; i++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8198f lna cg[%d]=0x%x cs[%d]=0x%x\n", -+ i, cg[i], i, cs[i]); -+ odm_set_rf_reg(dm, i, 0xdf, RFREGOFFSETMASK, 0x2); -+ -+ if (cg[i] == 0x3) { -+ rf_reg = odm_get_rf_reg(dm, i, 0x86, (BIT(19) | BIT(18))); -+ rf_reg = rf_reg + 1; -+ if (rf_reg >= 0x3) -+ rf_reg = 0x3; -+ odm_set_rf_reg(dm, i, 0x86, (BIT(19) | BIT(18)), rf_reg); -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8198f lna CG set rf 0x86 [19:18]=0x%x path=%d\n", rf_reg, i); -+ } -+ if (cs[i] == 0x3) { -+ rf_reg = odm_get_rf_reg(dm, i, 0x86, (BIT(17) | BIT(16))); -+ rf_reg = rf_reg + 1; -+ if (rf_reg >= 0x3) -+ rf_reg = 0x3; -+ odm_set_rf_reg(dm, i, 0x86, (BIT(17) | BIT(16)), rf_reg); -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8198f lna CS set rf 0x86 [17:16]=0x%x path=%d\n", rf_reg, i); -+ } -+ } -+ -+ power_trim_info->lna_flag |= LNA_FLAG_ON; -+ } -+} -+ -+ -+void phydm_set_kfree_to_rf_8198f(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ u32 i; -+ s8 pwr_offset[3]; -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s:Set kfree to rf 0x33\n", __func__); -+ -+ /*power_trim based on 55[19:14]*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 1); -+ /*enable 55[14] for 0.5db step*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xf5, BIT(18), 1); -+ /*enter power_trim debug mode*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 0); -+ /*write enable*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 1); -+ -+ for (i =0; i < 3; i++) -+ pwr_offset[i] = power_trim_info->bb_gain[i][e_rf_path]; -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[0]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[0]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 2); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[1]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 3); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[1]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 4); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[2]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 5); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[2]); -+ -+ /*leave power_trim debug mode*/ -+ /*odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 0);*/ -+ /*write disable*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 0); -+ -+} -+ -+void phydm_clear_kfree_to_rf_8198f(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if 0 -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s:Clear kfree to rf 0x55\n", __func__); -+ -+ /*power_trim based on 55[19:14]*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 1); -+ /*enable 55[14] for 0.5db step*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xf5, BIT(18), 1); -+ /*enter power_trim debug mode*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 0); -+ /*write enable*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 1); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 2); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 3); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 4); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 5); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); -+ -+ /*leave power_trim debug mode*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 0); -+ /*enable 55[14] for 0.5db step*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xf5, BIT(18), 0); -+ /*write disable*/ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 0); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 1); -+ /*odm_set_rf_reg(dm, e_rf_path, RF_0xf5, BIT(18), 0);*/ -+ -+#endif -+ -+} -+ -+void phydm_get_set_thermal_trim_offset_8822c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0xff, thermal[2] = {0}; -+ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_A_OFFSET_22C, &pg_therm, false); -+ -+ if (pg_therm != 0xff) { -+ /*s0*/ -+ pg_therm = pg_therm & 0x1f; -+ -+ thermal[RF_PATH_A] = -+ ((pg_therm & 0x1) << 3) | ((pg_therm >> 1) & 0x7); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x43, 0x000f0000, thermal[RF_PATH_A]); -+ -+ /*s1*/ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_B_OFFSET_22C, &pg_therm, false); -+ -+ pg_therm = pg_therm & 0x1f; -+ -+ thermal[RF_PATH_B] = ((pg_therm & 0x1) << 3) | ((pg_therm >> 1) & 0x7); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x43, 0x000f0000, thermal[RF_PATH_B]); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822c thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822c thermalA:%d thermalB:%d\n", -+ thermal[RF_PATH_A], -+ thermal[RF_PATH_B]); -+} -+ -+void phydm_set_power_trim_offset_8822c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ u8 e_rf_path; -+ -+ for (e_rf_path = RF_PATH_A; e_rf_path < 2; e_rf_path++) -+ { -+ odm_set_rf_reg(dm, e_rf_path, RF_0xee, BIT(19), 1); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[0][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[1][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x2); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[2][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x3); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[2][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x4); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[3][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x5); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[4][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x6); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[5][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x7); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[6][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x8); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x9); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[3][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xa); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[4][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xb); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[5][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xc); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[6][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xd); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xe); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][e_rf_path]); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xee, BIT(19), 0); -+ } -+} -+ -+void phydm_get_set_power_trim_offset_8822c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_power = 0xff, i, j; -+ u8 pg_power1, pg_power2 , pg_power3, pg_power4, pg_power5; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_22C, &pg_power1, false); -+ odm_efuse_one_byte_read(dm, PPG_2GM_TXAB_22C, &pg_power2, false); -+ odm_efuse_one_byte_read(dm, PPG_2GH_TXAB_22C, &pg_power3, false); -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22C, &pg_power4, false); -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_22C, &pg_power5, false); -+ -+ if (pg_power1 != 0xff || pg_power2 != 0xff || pg_power3 != 0xff || -+ pg_power4 != 0xff || pg_power5 != 0xff) { -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[0][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[0][1] = (pg_power & 0xf0) >> 4; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GM_TXAB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[1][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[1][1] = (pg_power & 0xf0) >> 4; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GH_TXAB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[2][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[2][1] = (pg_power & 0xf0) >> 4; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[3][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[3][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[4][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[4][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[5][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[5][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[6][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[6][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[7][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[7][1] = pg_power & 0x1f; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | -+ KFREE_FLAG_ON_2G | -+ KFREE_FLAG_ON_5G; -+ -+ phydm_set_power_trim_offset_8822c(dm); -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822c power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < 2; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8822c pwr_trim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+ } -+ } -+} -+ -+void phydm_get_tssi_trim_offset_8822c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i, j; -+ u8 pg_power[16] = {0}; -+ -+ odm_efuse_one_byte_read(dm, TSSI_2GM_TXA_22C, &pg_power[0], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GM_TXB_22C, &pg_power[1], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GH_TXA_22C, &pg_power[2], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GH_TXB_22C, &pg_power[3], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL1_TXA_22C, &pg_power[4], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL1_TXB_22C, &pg_power[5], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL2_TXA_22C, &pg_power[6], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL2_TXB_22C, &pg_power[7], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM1_TXA_22C, &pg_power[8], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM1_TXB_22C, &pg_power[9], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM2_TXA_22C, &pg_power[10], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM2_TXB_22C, &pg_power[11], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH1_TXA_22C, &pg_power[12], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH1_TXB_22C, &pg_power[13], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH2_TXA_22C, &pg_power[14], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH2_TXB_22C, &pg_power[15], false); -+ -+ j = 0; -+ for (i = 0; i < 16; i++) { -+ if (pg_power[i] == 0xff) -+ j++; -+ } -+ -+ if (j == 16) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822c tssi trim no PG\n"); -+ } else { -+ power_trim_info->tssi_trim[0][0] = (s8)pg_power[0]; -+ power_trim_info->tssi_trim[0][1] = (s8)pg_power[1]; -+ power_trim_info->tssi_trim[1][0] = (s8)pg_power[0]; -+ power_trim_info->tssi_trim[1][1] = (s8)pg_power[1]; -+ power_trim_info->tssi_trim[2][0] = (s8)pg_power[2]; -+ power_trim_info->tssi_trim[2][1] = (s8)pg_power[3]; -+ power_trim_info->tssi_trim[3][0] = (s8)pg_power[4]; -+ power_trim_info->tssi_trim[3][1] = (s8)pg_power[5]; -+ power_trim_info->tssi_trim[4][0] = (s8)pg_power[6]; -+ power_trim_info->tssi_trim[4][1] = (s8)pg_power[7]; -+ power_trim_info->tssi_trim[5][0] = (s8)pg_power[8]; -+ power_trim_info->tssi_trim[5][1] = (s8)pg_power[9]; -+ power_trim_info->tssi_trim[6][0] = (s8)pg_power[10]; -+ power_trim_info->tssi_trim[6][1] = (s8)pg_power[11]; -+ power_trim_info->tssi_trim[7][0] = (s8)pg_power[12]; -+ power_trim_info->tssi_trim[7][1] = (s8)pg_power[13]; -+ power_trim_info->tssi_trim[8][0] = (s8)pg_power[14]; -+ power_trim_info->tssi_trim[8][1] = (s8)pg_power[15]; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | TSSI_TRIM_FLAG_ON; -+ -+ if (power_trim_info->flag & TSSI_TRIM_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < 2; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8822c tssi_trim[%d][%d]=0x%X\n", -+ i, j, power_trim_info->tssi_trim[i][j]); -+ } -+ } -+ } -+ } -+} -+ -+s8 phydm_get_tssi_trim_de_8822c(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 channel = *dm->channel, group = 0; -+ -+ if (channel >= 1 && channel <= 3) -+ group = 0; -+ else if (channel >= 4 && channel <= 9) -+ group = 1; -+ else if (channel >= 10 && channel <= 14) -+ group = 2; -+ else if (channel >= 36 && channel <= 50) -+ group = 3; -+ else if (channel >= 52 && channel <= 64) -+ group = 4; -+ else if (channel >= 100 && channel <= 118) -+ group = 5; -+ else if (channel >= 120 && channel <= 144) -+ group = 6; -+ else if (channel >= 149 && channel <= 165) -+ group = 7; -+ else if (channel >= 167 && channel <= 177) -+ group = 8; -+ else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] Channel(%d) is not exist in Group\n", -+ channel); -+ return 0; -+ } -+ -+ return power_trim_info->tssi_trim[group][path]; -+} -+ -+ -+ -+void phydm_get_set_pa_bias_offset_8822c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_pa_bias = 0xff; -+ -+ RF_DBG(dm, DBG_RF_MP, "======>%s\n", __func__); -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_22C, &pg_pa_bias, false); -+ -+ if (pg_pa_bias != 0xff) { -+ /*2G s0*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_22C, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 2G s0 pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x0000f000, pg_pa_bias); -+ -+ /*2G s1*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GB_22C, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 2G s1 pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, 0x60, 0x0000f000, pg_pa_bias); -+ -+ /*5G s0*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GA_22C, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 5G s0 pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x000f0000, pg_pa_bias); -+ -+ /*5G s1*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GB_22C, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 5G s1 pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, 0x60, 0x000f0000, pg_pa_bias); -+ -+ power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822c tx pa bias no pg\n"); -+ } -+ -+} -+ -+void phydm_get_set_thermal_trim_offset_8812f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0xff, thermal[2] = {0}; -+ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_A_OFFSET_22C, &pg_therm, false); -+ -+ if (pg_therm != 0xff && pg_therm != 0x0) { -+ /*s0*/ -+ pg_therm = pg_therm & 0x1f; -+ -+ thermal[RF_PATH_A] = -+ ((pg_therm & 0x1) << 3) | ((pg_therm >> 1) & 0x7); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x43, 0x000f0000, thermal[RF_PATH_A]); -+ -+ /*s1*/ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_B_OFFSET_22C, &pg_therm, false); -+ -+ pg_therm = pg_therm & 0x1f; -+ -+ thermal[RF_PATH_B] = ((pg_therm & 0x1) << 3) | ((pg_therm >> 1) & 0x7); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x43, 0x000f0000, thermal[RF_PATH_B]); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8812f thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8812f thermalA:%d thermalB:%d\n", -+ thermal[RF_PATH_A], -+ thermal[RF_PATH_B]); -+} -+ -+void phydm_set_power_trim_offset_8812f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ u8 e_rf_path; -+ -+ for (e_rf_path = RF_PATH_A; e_rf_path < 2; e_rf_path++) -+ { -+ odm_set_rf_reg(dm, e_rf_path, RF_0xee, BIT(19), 1); -+ -+#if 0 -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[0][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[1][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x2); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[2][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x3); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[2][e_rf_path]); -+#endif -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x4); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[3][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x5); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[4][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x6); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[5][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x7); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[6][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x8); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x9); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[3][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xa); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[4][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xb); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[5][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xc); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[6][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xd); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xe); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][e_rf_path]); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xee, BIT(19), 0); -+ } -+} -+ -+void phydm_get_set_power_trim_offset_8812f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_power = 0xff, i, j; -+ u8 pg_power1 = 0, pg_power2 = 0, pg_power3 = 0; -+ u8 pg_power4 = 0, pg_power5 = 0; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22C, &pg_power1, false); -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_22C, &pg_power2, false); -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_22C, &pg_power3, false); -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXB_22C, &pg_power4, false); -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_22C, &pg_power5, false); -+ -+ if ((pg_power1 != 0xff || pg_power2 != 0xff || pg_power3 != 0xff || -+ pg_power4 != 0xff || pg_power5 != 0xff) && -+ (pg_power1 != 0x0 || pg_power2 != 0x0 || pg_power3 != 0x0 || -+ pg_power4 != 0x0 || pg_power5 != 0x0)) { -+#if 0 -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[0][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[0][1] = (pg_power & 0xf0) >> 4; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GM_TXAB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[1][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[1][1] = (pg_power & 0xf0) >> 4; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GH_TXAB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[2][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[2][1] = (pg_power & 0xf0) >> 4; -+#endif -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[3][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[3][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[4][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[4][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[5][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[5][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[6][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[6][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[7][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[7][1] = pg_power & 0x1f; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | KFREE_FLAG_ON_5G; -+ -+ phydm_set_power_trim_offset_8812f(dm); -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8812f power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < 2; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8812f pwr_trim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+ } -+ } -+} -+ -+void phydm_get_tssi_trim_offset_8812f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i, j ; -+ u8 pg_power[16] = {0}; -+ -+#if 0 -+ odm_efuse_one_byte_read(dm, TSSI_2GM_TXA_22C, &pg_power[0], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GM_TXB_22C, &pg_power[1], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GH_TXA_22C, &pg_power[2], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GH_TXB_22C, &pg_power[3], false); -+#endif -+ odm_efuse_one_byte_read(dm, TSSI_5GL1_TXA_22C, &pg_power[4], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL1_TXB_22C, &pg_power[5], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL2_TXA_22C, &pg_power[6], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL2_TXB_22C, &pg_power[7], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM1_TXA_22C, &pg_power[8], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM1_TXB_22C, &pg_power[9], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM2_TXA_22C, &pg_power[10], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM2_TXB_22C, &pg_power[11], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH1_TXA_22C, &pg_power[12], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH1_TXB_22C, &pg_power[13], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH2_TXA_22C, &pg_power[14], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH2_TXB_22C, &pg_power[15], false); -+ -+ j = 0; -+ for (i = 4; i < 16; i++) { -+ if (pg_power[i] == 0xff || pg_power[i] == 0x0) -+ j++; -+ } -+ -+ if (j == 12) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8812f tssi trim no PG\n"); -+ } else { -+#if 0 -+ power_trim_info->tssi_trim[0][0] = (s8)pg_power[0]; -+ power_trim_info->tssi_trim[0][1] = (s8)pg_power[1]; -+ power_trim_info->tssi_trim[1][0] = (s8)pg_power[0]; -+ power_trim_info->tssi_trim[1][1] = (s8)pg_power[1]; -+ power_trim_info->tssi_trim[2][0] = (s8)pg_power[2]; -+ power_trim_info->tssi_trim[2][1] = (s8)pg_power[3]; -+#endif -+ power_trim_info->tssi_trim[3][0] = (s8)pg_power[4]; -+ power_trim_info->tssi_trim[3][1] = (s8)pg_power[5]; -+ power_trim_info->tssi_trim[4][0] = (s8)pg_power[6]; -+ power_trim_info->tssi_trim[4][1] = (s8)pg_power[7]; -+ power_trim_info->tssi_trim[5][0] = (s8)pg_power[8]; -+ power_trim_info->tssi_trim[5][1] = (s8)pg_power[9]; -+ power_trim_info->tssi_trim[6][0] = (s8)pg_power[10]; -+ power_trim_info->tssi_trim[6][1] = (s8)pg_power[11]; -+ power_trim_info->tssi_trim[7][0] = (s8)pg_power[12]; -+ power_trim_info->tssi_trim[7][1] = (s8)pg_power[13]; -+ power_trim_info->tssi_trim[8][0] = (s8)pg_power[14]; -+ power_trim_info->tssi_trim[8][1] = (s8)pg_power[15]; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | TSSI_TRIM_FLAG_ON; -+ -+ if (power_trim_info->flag & TSSI_TRIM_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < 2; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8812f tssi_trim[%d][%d]=0x%X\n", -+ i, j, power_trim_info->tssi_trim[i][j]); -+ } -+ } -+ } -+ } -+} -+ -+s8 phydm_get_tssi_trim_de_8812f(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 channel = *dm->channel, group = 0; -+ -+ if (channel >= 1 && channel <= 3) -+ group = 0; -+ else if (channel >= 4 && channel <= 9) -+ group = 1; -+ else if (channel >= 10 && channel <= 14) -+ group = 2; -+ else if (channel >= 36 && channel <= 50) -+ group = 3; -+ else if (channel >= 52 && channel <= 64) -+ group = 4; -+ else if (channel >= 100 && channel <= 118) -+ group = 5; -+ else if (channel >= 120 && channel <= 144) -+ group = 6; -+ else if (channel >= 149 && channel <= 165) -+ group = 7; -+ else if (channel >= 167 && channel <= 177) -+ group = 8; -+ else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] Channel(%d) is not exist in Group\n", -+ channel); -+ return 0; -+ } -+ -+ return power_trim_info->tssi_trim[group][path]; -+} -+ -+void phydm_get_set_pa_bias_offset_8812f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_pa_bias = 0xff; -+ -+ RF_DBG(dm, DBG_RF_MP, "======>%s\n", __func__); -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GA_22C, &pg_pa_bias, false); -+ -+ if (pg_pa_bias != 0xff && pg_pa_bias != 0x0) { -+#if 0 -+ /*2G s0*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_22C, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 2G s0 pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x0000f000, pg_pa_bias); -+ -+ /*2G s1*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GB_22C, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 2G s1 pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, 0x60, 0x0000f000, pg_pa_bias); -+#endif -+ -+ /*5G s0*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GA_22C, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 5G s0 pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x000f0000, pg_pa_bias); -+ -+ /*5G s1*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GB_22C, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 5G s1 pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, 0x60, 0x000f0000, pg_pa_bias); -+ -+ power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8812f tx pa bias no pg\n"); -+ } -+ -+} -+ -+void phydm_get_thermal_trim_offset_8195b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0xff; -+ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_OFFSET_95B, &pg_therm, false); -+ -+ if (pg_therm != 0xff) { -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->thermal = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->thermal = (pg_therm >> 1); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8195b thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8195b thermal:%d\n", -+ power_trim_info->thermal); -+} -+ -+void phydm_set_power_trim_rf_8195b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s:Set kfree to rf 0x33\n", __func__); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xee, BIT(19), 1); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON_2G) { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x0); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[0][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x1); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[1][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x2); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[2][RF_PATH_A]); -+ } -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON_5G) { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x4); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[3][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x5); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[4][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x6); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[5][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x7); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[6][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x8); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[7][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0xe); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[7][RF_PATH_A]); -+ } -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xee, BIT(19), 0); -+ } -+ -+} -+ -+void phydm_get_set_power_trim_offset_8195b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_power = 0xff, i, j; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXA_95B, &pg_power, false); -+ -+ if (pg_power != 0xff) { -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXA_95B, &pg_power, false); -+ power_trim_info->bb_gain[0][0] = pg_power & 0xf; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GM_TXA_95B, &pg_power, false); -+ power_trim_info->bb_gain[1][0] = pg_power & 0xf; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GH_TXA_95B, &pg_power, false); -+ power_trim_info->bb_gain[2][0] = pg_power & 0xf; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | KFREE_FLAG_ON_2G; -+ } -+ -+ pg_power = 0xff; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_95B, &pg_power, false); -+ -+ if (pg_power != 0xff) { -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_95B, &pg_power, false); -+ power_trim_info->bb_gain[3][0] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_95B, &pg_power, false); -+ power_trim_info->bb_gain[4][0] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_95B, &pg_power, false); -+ power_trim_info->bb_gain[5][0] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_95B, &pg_power, false); -+ power_trim_info->bb_gain[6][0] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_95B, &pg_power, false); -+ power_trim_info->bb_gain[7][0] = pg_power & 0x1f; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | KFREE_FLAG_ON_5G; -+ } -+ -+ phydm_set_power_trim_rf_8195b(dm); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8195b power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < 1; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8195b pwr_trim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+ } -+ } -+} -+ -+void phydm_get_set_pa_bias_offset_8195b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_pa_bias = 0xff; -+ -+ RF_DBG(dm, DBG_RF_MP, "======>%s\n", __func__); -+ -+ /*2G*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_95B, &pg_pa_bias, false); -+ -+ if (pg_pa_bias != 0xff) { -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_95B, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 2G pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x0000f000, pg_pa_bias); -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8195b 2G tx pa bias no pg\n"); -+ } -+ -+ /*5G*/ -+ pg_pa_bias = 0xff; -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GA_95B, &pg_pa_bias, false); -+ -+ if (pg_pa_bias != 0xff) { -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GA_95B, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 5G pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x000f0000, pg_pa_bias); -+ -+ power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8195b 5G tx pa bias no pg\n"); -+ } -+} -+ -+void phydm_get_thermal_trim_offset_8721d(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0xff; -+ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_OFFSET_8721D, &pg_therm, false); -+ -+ if (pg_therm != 0xff) { -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->thermal = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->thermal = (pg_therm >> 1); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8721d thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8721d thermal:%d\n", -+ power_trim_info->thermal); -+} -+ -+void phydm_set_power_trim_rf_8721d(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] %s:Set kfree to rf 0x33\n", __func__); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xee, BIT(19), 1); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x0); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[0][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x1); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[1][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x2); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[2][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x3); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[2][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x4); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[3][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x5); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[4][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x6); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[5][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x7); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[6][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x8); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x0000003f, -+ power_trim_info->bb_gain[7][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x9); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[3][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0xa); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[4][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0xb); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[5][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0xc); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[6][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0xd); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0xe); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][RF_PATH_A]); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xee, BIT(19), 0); -+} -+ -+void phydm_get_set_power_trim_offset_8721d(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_power = 0xff, i, j; -+ u8 pg_power1, pg_power2, pg_power3, pg_power4, pg_power5, pg_power6; -+ -+ odm_efuse_one_byte_read(dm, PPG_2G_TXA_8721D, &pg_power1, false); -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_8721D, &pg_power2, false); -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_8721D, &pg_power3, false); -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_8721D, &pg_power4, false); -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_8721D, &pg_power5, false); -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_8721D, &pg_power6, false); -+ -+ if (pg_power1 != 0xff || pg_power2 != 0xff || pg_power3 != 0xff || -+ pg_power4 != 0xff || pg_power5 != 0xff || pg_power6 != 0xff) { -+ odm_efuse_one_byte_read(dm, PPG_2G_TXA_8721D, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[0][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[1][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[2][0] = pg_power & 0xf; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_8721D, -+ &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[3][0] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_8721D, -+ &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[4][0] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_8721D, -+ &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[5][0] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_8721D, -+ &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[6][0] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_8721D, -+ &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[7][0] = pg_power & 0x1f; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | -+ KFREE_FLAG_ON_2G | -+ KFREE_FLAG_ON_5G; -+ -+ phydm_set_power_trim_rf_8721d(dm); -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8721d power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < 1; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8721d pwr_trim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+ } -+ } -+} -+ -+void phydm_get_set_pa_bias_offset_8721d(void *dm_void) -+{ -+#if 0 -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_pa_bias = 0xff; -+ -+ RF_DBG(dm, DBG_RF_MP, "======>%s\n", __func__); -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_95B, &pg_pa_bias, false); -+ -+ if (pg_pa_bias != 0xff) { -+ /*2G*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_95B, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 2G pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x0000f000, pg_pa_bias); -+ -+ /*5G*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GA_95B, -+ &pg_pa_bias, false); -+ pg_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 5G pa_bias=0x%x\n", pg_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x000f0000, pg_pa_bias); -+ -+ power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8721d tx pa bias no pg\n"); -+ } -+#endif -+} -+ -+void phydm_get_thermal_trim_offset_8197g(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0xff, i; -+ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_A_OFFSET_97G, &pg_therm, false); -+ -+ if (pg_therm != 0x0) { -+ for (i = 0; i < 2; i++) { -+ if (i == 0) -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_A_OFFSET_97G, &pg_therm, false); -+ else if (i == 1) -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_B_OFFSET_97G, &pg_therm, false); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g Efuse thermal S%d:0x%x\n", i, pg_therm); -+ -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->multi_thermal[i] = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->multi_thermal[i] = (pg_therm >> 1); -+ } -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ for (i = 0; i < 2; i++) { -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g thermal S%d:%d\n", -+ i ,power_trim_info->multi_thermal[i]); -+ } -+} -+ -+void phydm_set_power_trim_offset_8197g(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ u8 e_rf_path; -+ -+ for (e_rf_path = RF_PATH_A; e_rf_path < 2; e_rf_path++) -+ { -+ odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 1); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x1c000, 0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, -+ power_trim_info->bb_gain[0][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x1c000, 1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, -+ power_trim_info->bb_gain[0][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x1c000, 2); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, -+ power_trim_info->bb_gain[1][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x1c000, 3); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, -+ power_trim_info->bb_gain[1][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x1c000, 4); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, -+ power_trim_info->bb_gain[2][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x1c000, 5); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, -+ power_trim_info->bb_gain[2][e_rf_path]); -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 0); -+ } -+ -+} -+ -+void phydm_get_set_power_trim_offset_8197g(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_power = 0, i, j; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_97G, &pg_power, false); -+ -+ if (pg_power != 0) { -+ power_trim_info->bb_gain[0][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[0][1] = (pg_power & 0xf0) >> 4; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GM_TXAB_97G, &pg_power, false); -+ power_trim_info->bb_gain[1][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[1][1] = (pg_power & 0xf0) >> 4; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GH_TXAB_97G, &pg_power, false); -+ power_trim_info->bb_gain[2][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[2][1] = (pg_power & 0xf0) >> 4; -+ -+ phydm_set_power_trim_offset_8197g(dm); -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | KFREE_FLAG_ON_2G; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < MAX_RF_PATH; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8197g pwr_trim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+ } -+ } -+} -+ -+void phydm_get_tssi_trim_offset_8197g(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i, j; -+ u8 pg_power[4] = {0}; -+ -+ odm_efuse_one_byte_read(dm, TSSI_2GL_TXA_97G, &pg_power[0], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GL_TXB_97G, &pg_power[1], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GH_TXA_97G, &pg_power[2], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GH_TXB_97G, &pg_power[3], false); -+ -+ j = 0; -+ for (i = 0; i < 4; i++) { -+ if (pg_power[i] == 0x0) -+ j++; -+ } -+ -+ if (j == 4) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g tssi trim no PG\n"); -+ } else { -+ power_trim_info->tssi_trim[0][0] = (s8)pg_power[0]; -+ power_trim_info->tssi_trim[0][1] = (s8)pg_power[1]; -+ power_trim_info->tssi_trim[1][0] = (s8)pg_power[0]; -+ power_trim_info->tssi_trim[1][1] = (s8)pg_power[1]; -+ power_trim_info->tssi_trim[2][0] = (s8)pg_power[2]; -+ power_trim_info->tssi_trim[2][1] = (s8)pg_power[3]; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | TSSI_TRIM_FLAG_ON; -+ -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < MAX_PATH_NUM_8197G; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8197g tssi_trim[%d][%d]=0x%X\n", -+ i, j, power_trim_info->tssi_trim[i][j]); -+ } -+ } -+ } -+} -+ -+s8 phydm_get_tssi_trim_de_8197g(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 channel = *dm->channel, group = 0; -+ -+ if (channel >= 1 && channel <= 3) -+ group = 0; -+ else if (channel >= 4 && channel <= 9) -+ group = 1; -+ else if (channel >= 10 && channel <= 14) -+ group = 2; -+ else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] Channel(%d) is not exist in Group\n", -+ channel); -+ return 0; -+ } -+ -+ return power_trim_info->tssi_trim[group][path]; -+} -+ -+void phydm_get_set_pa_bias_offset_8197g(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_pa_bias = 0xff, i; -+ u8 tx_pa_bias[4] = {0}; -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GAB_97G, &pg_pa_bias, false); -+ -+ if (pg_pa_bias != 0x0) { -+ /*paht ab*/ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GAB_97G, -+ &pg_pa_bias, false); -+ tx_pa_bias[0] = pg_pa_bias & 0xf; -+ tx_pa_bias[1] = ((pg_pa_bias & 0xf0) >> 4); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8197g PathA_pa_bias:0x%x PathB_pa_bias:0x%x\n", -+ tx_pa_bias[0], tx_pa_bias[1]); -+ -+ for (i = RF_PATH_A; i < 2; i++) -+ odm_set_rf_reg(dm, i, 0x60, 0x0000f000, tx_pa_bias[i]); -+ -+ power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g tx pa bias no pg\n"); -+ } -+} -+ -+void phydm_get_set_lna_offset_8197g(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_lna[2] = {0}, i, pg_lna_tmp = 0; -+ u32 lna_trim_addr[2] = {0x1884, 0x4184}; -+ -+ odm_efuse_one_byte_read(dm, PPG_LNA_2GA_97G, &pg_lna_tmp, false); -+ -+ if (pg_lna_tmp != 0) { -+ odm_efuse_one_byte_read(dm, PPG_LNA_2GA_97G, -+ &pg_lna[RF_PATH_A], false); -+ power_trim_info->lna_trim[RF_PATH_A] = (s8)pg_lna[RF_PATH_A]; -+ -+ odm_efuse_one_byte_read(dm, PPG_LNA_2GB_97G, -+ &pg_lna[RF_PATH_B], false); -+ power_trim_info->lna_trim[RF_PATH_B] = (s8)pg_lna[RF_PATH_B]; -+ -+ for (i = RF_PATH_A; i < 2; i++) { -+ if (odm_get_bb_reg(dm, lna_trim_addr[i], 0x00c00000) == 0x2) { -+ odm_set_rf_reg(dm, i, 0x88, 0x00000f00, (pg_lna[i] & 0xf)); -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g lna trim CG 0x%x path=%d\n", (pg_lna[i] & 0xf), i); -+ } else if (odm_get_bb_reg(dm, lna_trim_addr[i], 0x00c00000) == 0x3) { -+ odm_set_rf_reg(dm, i, 0x88, 0x00000f00, ((pg_lna[i] & 0xf0) >> 4)); -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g lna trim CS 0x%x path=%d\n", ((pg_lna[i] & 0xf0) >> 4), i); -+ } -+ } -+ -+ power_trim_info->lna_flag |= LNA_FLAG_ON; -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g lna trim no pg\n"); -+ } -+} -+ -+void phydm_set_lna_trim_offset_8197g(void *dm_void, u8 path, u8 cg_cs, u8 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *trim = &dm->power_trim_data; -+ -+ u8 i; -+ -+ if (enable == 0) { -+ for (i = RF_PATH_A; i < 2; i++) { -+ odm_set_rf_reg(dm, i, 0x88, 0x00000f00, 0x0); -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g diversity lna trim disable\n"); -+ } -+ return; -+ } -+ -+ /*cg*/ -+ if (cg_cs == 0) { -+ odm_set_rf_reg(dm, path, 0x88, 0x00000f00, (trim->lna_trim[path] & 0xf)); -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g diversity lna trim CG 0x%x path=%d\n", -+ (trim->lna_trim[path] & 0xf), path); -+ } else if (cg_cs == 1) { /*cs*/ -+ odm_set_rf_reg(dm, path, 0x88, 0x00000f00, ((trim->lna_trim[path] & 0xf0) >> 4)); -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8197g diversity lna trim CS 0x%x path=%d\n", -+ ((trim->lna_trim[path] & 0xf0) >> 4), path); -+ } -+} -+ -+ -+void phydm_get_thermal_trim_offset_8710c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0; -+ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_OFFSET_10C, &pg_therm, false); -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8710c Efuse thermal:0x%x\n", pg_therm); -+ -+ if (pg_therm != 0xff) { -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->thermal = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->thermal = (pg_therm >> 1); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8710c thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8710c thermal:%d\n", -+ power_trim_info->thermal); -+} -+ -+void phydm_set_power_trim_offset_8710c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(18), 1); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x3f, -+ power_trim_info->bb_gain[0][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 1); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x3f, -+ power_trim_info->bb_gain[1][RF_PATH_A]); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 2); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0x3f, -+ power_trim_info->bb_gain[2][RF_PATH_A]); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(18), 0); -+} -+ -+void phydm_get_set_power_trim_offset_8710c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_power = 0, i, j; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GL_TX_10C, &pg_power, false); -+ -+ if (pg_power != 0xff) { -+ power_trim_info->bb_gain[0][RF_PATH_A] = pg_power & 0xf; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GM_TX_10C, &pg_power, false); -+ power_trim_info->bb_gain[1][RF_PATH_A] = pg_power & 0xf; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GH_TX_10C, &pg_power, false); -+ power_trim_info->bb_gain[2][RF_PATH_A] = pg_power & 0xf; -+ -+ phydm_set_power_trim_offset_8710c(dm); -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | KFREE_FLAG_ON_2G; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8710c power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < MAX_RF_PATH; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8710c pwr_trim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+ } -+ } -+} -+ -+void phydm_get_set_pa_bias_offset_8710c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_pa_bias = 0xff; -+ u8 tx_pa_bias = 0; -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_10C, &pg_pa_bias, false); -+ -+ if (pg_pa_bias != 0xff) { -+ tx_pa_bias = pg_pa_bias & 0xf; -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8710c PathA_pa_bias:0x%x\n", tx_pa_bias); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x0000f000, tx_pa_bias); -+ -+ power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8710c tx pa bias no pg\n"); -+ } -+} -+ -+void phydm_set_power_trim_offset_8814b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ u8 e_rf_path; -+ -+ for (e_rf_path = RF_PATH_A; e_rf_path < MAX_PATH_NUM_8814B; e_rf_path++) -+ { -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ odm_set_rf_reg(dm, e_rf_path, RF_0xee, BIT(19), 1); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON_2G) { -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x0); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[0][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x1); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[0][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x2); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[0][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x3); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[0][e_rf_path]); -+ } -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON_5G) { -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x4); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[3][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x5); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[4][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x6); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[5][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x7); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[6][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x8); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x9); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[3][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xa); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[4][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xb); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[5][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xc); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[6][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xd); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][e_rf_path]); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xe); -+ odm_set_rf_reg(dm, e_rf_path, RF_0x30, RFREGOFFSETMASK, -+ power_trim_info->bb_gain[7][e_rf_path]); -+ } -+ -+ odm_set_rf_reg(dm, e_rf_path, RF_0xee, BIT(19), 0); -+ } -+ } -+} -+ -+void phydm_get_set_power_trim_offset_8814b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i, j; -+ u8 pg_power1, pg_power2; -+ u8 pg_power_2g[2] = {0}, pg_power_5g[20] = {0}; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_14B, &pg_power_2g[0], false); -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXCD_14B, &pg_power_2g[1], false); -+ -+ j = 0; -+ for (i = 0; i < 2; i++) { -+ if (pg_power_2g[i] == 0xff) -+ j++; -+ } -+ -+ if (j == 2) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b 2G power trim no PG\n"); -+ } else { -+ power_trim_info->bb_gain[0][RF_PATH_A] = pg_power_2g[0] & 0xf; -+ power_trim_info->bb_gain[0][RF_PATH_B] = (pg_power_2g[0] & 0xf0) >> 4; -+ -+ power_trim_info->bb_gain[0][RF_PATH_C] = pg_power_2g[1] & 0xf; -+ power_trim_info->bb_gain[0][RF_PATH_D] = (pg_power_2g[1] & 0xf0) >> 4; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | KFREE_FLAG_ON_2G; -+ } -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_14B, &pg_power_5g[0], false); -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_14B, &pg_power_5g[1], false); -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXC_14B, &pg_power_5g[2], false); -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXD_14B, &pg_power_5g[3], false); -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_14B, &pg_power_5g[4], false); -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXB_14B, &pg_power_5g[5], false); -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXC_14B, &pg_power_5g[6], false); -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXD_14B, &pg_power_5g[7], false); -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_14B, &pg_power_5g[8], false); -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXB_14B, &pg_power_5g[9], false); -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXC_14B, &pg_power_5g[10], false); -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXD_14B, &pg_power_5g[11], false); -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_14B, &pg_power_5g[12], false); -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXB_14B, &pg_power_5g[13], false); -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXC_14B, &pg_power_5g[14], false); -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXD_14B, &pg_power_5g[15], false); -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_14B, &pg_power_5g[16], false); -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXB_14B, &pg_power_5g[17], false); -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXC_14B, &pg_power_5g[18], false); -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXD_14B, &pg_power_5g[19], false); -+ -+ j = 0; -+ for (i = 0; i < 20; i++) { -+ if (pg_power_5g[i] == 0xff) -+ j++; -+ } -+ -+ if (j == 20) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b 5G power trim no PG\n"); -+ } else { -+ power_trim_info->bb_gain[3][RF_PATH_A] = pg_power_5g[0] & 0x1f; -+ power_trim_info->bb_gain[3][RF_PATH_B] = pg_power_5g[1] & 0x1f; -+ power_trim_info->bb_gain[3][RF_PATH_C] = pg_power_5g[2] & 0x1f; -+ power_trim_info->bb_gain[3][RF_PATH_D] = pg_power_5g[3] & 0x1f; -+ -+ power_trim_info->bb_gain[4][RF_PATH_A] = pg_power_5g[4] & 0x1f; -+ power_trim_info->bb_gain[4][RF_PATH_B] = pg_power_5g[5] & 0x1f; -+ power_trim_info->bb_gain[4][RF_PATH_C] = pg_power_5g[6] & 0x1f; -+ power_trim_info->bb_gain[4][RF_PATH_D] = pg_power_5g[7] & 0x1f; -+ -+ power_trim_info->bb_gain[5][RF_PATH_A] = pg_power_5g[8] & 0x1f; -+ power_trim_info->bb_gain[5][RF_PATH_B] = pg_power_5g[9] & 0x1f; -+ power_trim_info->bb_gain[5][RF_PATH_C] = pg_power_5g[10] & 0x1f; -+ power_trim_info->bb_gain[5][RF_PATH_D] = pg_power_5g[11] & 0x1f; -+ -+ power_trim_info->bb_gain[6][RF_PATH_A] = pg_power_5g[12] & 0x1f; -+ power_trim_info->bb_gain[6][RF_PATH_B] = pg_power_5g[13] & 0x1f; -+ power_trim_info->bb_gain[6][RF_PATH_C] = pg_power_5g[14] & 0x1f; -+ power_trim_info->bb_gain[6][RF_PATH_D] = pg_power_5g[15] & 0x1f; -+ -+ power_trim_info->bb_gain[7][RF_PATH_A] = pg_power_5g[16] & 0x1f; -+ power_trim_info->bb_gain[7][RF_PATH_B] = pg_power_5g[17] & 0x1f; -+ power_trim_info->bb_gain[7][RF_PATH_C] = pg_power_5g[18] & 0x1f; -+ power_trim_info->bb_gain[7][RF_PATH_D] = pg_power_5g[19] & 0x1f; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | KFREE_FLAG_ON_5G; -+ -+ } -+ -+ phydm_set_power_trim_offset_8814b(dm); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < MAX_PATH_NUM_8814B; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b pwr_trim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+ } -+ } -+} -+ -+void phydm_get_tssi_trim_offset_8814b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i, j; -+ u8 tssi_trim_2g[8] = {0}, tssi_trim_5g[24] = {0}; -+ -+ odm_efuse_one_byte_read(dm, TSSI_2GM_TXA_14B, &tssi_trim_2g[0], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GM_TXB_14B, &tssi_trim_2g[1], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GM_TXC_14B, &tssi_trim_2g[2], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GM_TXD_14B, &tssi_trim_2g[3], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GH_TXA_14B, &tssi_trim_2g[4], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GH_TXB_14B, &tssi_trim_2g[5], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GH_TXC_14B, &tssi_trim_2g[6], false); -+ odm_efuse_one_byte_read(dm, TSSI_2GH_TXD_14B, &tssi_trim_2g[7], false); -+ -+ j = 0; -+ for (i = 0; i < 8; i++) { -+ if (tssi_trim_2g[i] == 0xff) -+ j++; -+ } -+ -+ if (j == 8) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b 2g tssi trim no PG\n"); -+ } else { -+ power_trim_info->tssi_trim[0][RF_PATH_A] = (s8)tssi_trim_2g[0]; -+ power_trim_info->tssi_trim[0][RF_PATH_B] = (s8)tssi_trim_2g[1]; -+ power_trim_info->tssi_trim[0][RF_PATH_C] = (s8)tssi_trim_2g[2]; -+ power_trim_info->tssi_trim[0][RF_PATH_D] = (s8)tssi_trim_2g[3]; -+ power_trim_info->tssi_trim[1][RF_PATH_A] = (s8)tssi_trim_2g[0]; -+ power_trim_info->tssi_trim[1][RF_PATH_B] = (s8)tssi_trim_2g[1]; -+ power_trim_info->tssi_trim[1][RF_PATH_C] = (s8)tssi_trim_2g[2]; -+ power_trim_info->tssi_trim[1][RF_PATH_D] = (s8)tssi_trim_2g[3]; -+ power_trim_info->tssi_trim[2][RF_PATH_A] = (s8)tssi_trim_2g[4]; -+ power_trim_info->tssi_trim[2][RF_PATH_B] = (s8)tssi_trim_2g[5]; -+ power_trim_info->tssi_trim[2][RF_PATH_C] = (s8)tssi_trim_2g[6]; -+ power_trim_info->tssi_trim[2][RF_PATH_D] = (s8)tssi_trim_2g[7]; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | TSSI_TRIM_FLAG_ON | KFREE_FLAG_ON_2G; -+ -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < MAX_PATH_NUM_8814B; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 2g tssi_trim[%d][%d]=0x%X\n", -+ i, j, power_trim_info->tssi_trim[i][j]); -+ } -+ } -+ } -+ -+ odm_efuse_one_byte_read(dm, TSSI_5GL1_TXA_14B, &tssi_trim_5g[0], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL1_TXB_14B, &tssi_trim_5g[1], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL1_TXC_14B, &tssi_trim_5g[2], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL1_TXD_14B, &tssi_trim_5g[3], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL2_TXA_14B, &tssi_trim_5g[4], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL2_TXB_14B, &tssi_trim_5g[5], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL2_TXC_14B, &tssi_trim_5g[6], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GL2_TXD_14B, &tssi_trim_5g[7], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM1_TXA_14B, &tssi_trim_5g[8], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM1_TXB_14B, &tssi_trim_5g[9], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM1_TXC_14B, &tssi_trim_5g[10], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM1_TXD_14B, &tssi_trim_5g[11], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM2_TXA_14B, &tssi_trim_5g[12], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM2_TXB_14B, &tssi_trim_5g[13], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM2_TXC_14B, &tssi_trim_5g[14], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GM2_TXD_14B, &tssi_trim_5g[15], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH1_TXA_14B, &tssi_trim_5g[16], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH1_TXB_14B, &tssi_trim_5g[17], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH1_TXC_14B, &tssi_trim_5g[18], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH1_TXD_14B, &tssi_trim_5g[19], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH2_TXA_14B, &tssi_trim_5g[20], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH2_TXB_14B, &tssi_trim_5g[21], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH2_TXC_14B, &tssi_trim_5g[22], false); -+ odm_efuse_one_byte_read(dm, TSSI_5GH2_TXD_14B, &tssi_trim_5g[23], false); -+ -+ j = 0; -+ for (i = 0; i < 24; i++) { -+ if (tssi_trim_5g[i] == 0xff) -+ j++; -+ } -+ -+ if (j == 24) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b 5g tssi trim no PG\n"); -+ } else { -+ power_trim_info->tssi_trim[3][RF_PATH_A] = (s8)tssi_trim_5g[0]; -+ power_trim_info->tssi_trim[3][RF_PATH_B] = (s8)tssi_trim_5g[1]; -+ power_trim_info->tssi_trim[3][RF_PATH_C] = (s8)tssi_trim_5g[2]; -+ power_trim_info->tssi_trim[3][RF_PATH_D] = (s8)tssi_trim_5g[3]; -+ power_trim_info->tssi_trim[4][RF_PATH_A] = (s8)tssi_trim_5g[4]; -+ power_trim_info->tssi_trim[4][RF_PATH_B] = (s8)tssi_trim_5g[5]; -+ power_trim_info->tssi_trim[4][RF_PATH_C] = (s8)tssi_trim_5g[6]; -+ power_trim_info->tssi_trim[4][RF_PATH_D] = (s8)tssi_trim_5g[7]; -+ power_trim_info->tssi_trim[5][RF_PATH_A] = (s8)tssi_trim_5g[8]; -+ power_trim_info->tssi_trim[5][RF_PATH_B] = (s8)tssi_trim_5g[9]; -+ power_trim_info->tssi_trim[5][RF_PATH_C] = (s8)tssi_trim_5g[10]; -+ power_trim_info->tssi_trim[5][RF_PATH_D] = (s8)tssi_trim_5g[11]; -+ power_trim_info->tssi_trim[6][RF_PATH_A] = (s8)tssi_trim_5g[12]; -+ power_trim_info->tssi_trim[6][RF_PATH_B] = (s8)tssi_trim_5g[13]; -+ power_trim_info->tssi_trim[6][RF_PATH_C] = (s8)tssi_trim_5g[14]; -+ power_trim_info->tssi_trim[6][RF_PATH_D] = (s8)tssi_trim_5g[15]; -+ power_trim_info->tssi_trim[7][RF_PATH_A] = (s8)tssi_trim_5g[16]; -+ power_trim_info->tssi_trim[7][RF_PATH_B] = (s8)tssi_trim_5g[17]; -+ power_trim_info->tssi_trim[7][RF_PATH_C] = (s8)tssi_trim_5g[18]; -+ power_trim_info->tssi_trim[7][RF_PATH_D] = (s8)tssi_trim_5g[19]; -+ power_trim_info->tssi_trim[8][RF_PATH_A] = (s8)tssi_trim_5g[20]; -+ power_trim_info->tssi_trim[8][RF_PATH_B] = (s8)tssi_trim_5g[21]; -+ power_trim_info->tssi_trim[8][RF_PATH_C] = (s8)tssi_trim_5g[22]; -+ power_trim_info->tssi_trim[8][RF_PATH_D] = (s8)tssi_trim_5g[23]; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | TSSI_TRIM_FLAG_ON | KFREE_FLAG_ON_5G; -+ -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < MAX_PATH_NUM_8814B; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 5g tssi_trim[%d][%d]=0x%X\n", -+ i, j, power_trim_info->tssi_trim[i][j]); -+ } -+ } -+ } -+} -+ -+s8 phydm_get_tssi_trim_de_8814b(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 channel = *dm->channel, group = 0; -+ -+ if (channel >= 1 && channel <= 3) -+ group = 0; -+ else if (channel >= 4 && channel <= 9) -+ group = 1; -+ else if (channel >= 10 && channel <= 14) -+ group = 2; -+ else if (channel >= 36 && channel <= 50) -+ group = 3; -+ else if (channel >= 52 && channel <= 64) -+ group = 4; -+ else if (channel >= 100 && channel <= 118) -+ group = 5; -+ else if (channel >= 120 && channel <= 144) -+ group = 6; -+ else if (channel >= 149 && channel <= 165) -+ group = 7; -+ else if (channel >= 167 && channel <= 177) -+ group = 8; -+ else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] Channel(%d) is not exist in Group\n", -+ channel); -+ return 0; -+ } -+ -+ return power_trim_info->tssi_trim[group][path]; -+} -+ -+void phydm_set_pabias_bandedge_2g_rf_8814b(void *dm_void) -+{ -+#if 0 -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u32 rf_reg_51 = 0, rf_reg_52 = 0, rf_reg_53 = 0, rf_reg_3f = 0; -+ u8 i, j; -+ s32 pa_bias_tmp, bandedge_tmp, reg_tmp; -+ -+#if 0 -+ /*2.4G bias*/ -+ /*rf3f == rf53*/ -+#endif -+ for (i = 0; i < MAX_PATH_NUM_8814B; i++) { -+ rf_reg_51 = odm_get_rf_reg(dm, i, RF_0x51, RFREGOFFSETMASK); -+ rf_reg_52 = odm_get_rf_reg(dm, i, RF_0x52, RFREGOFFSETMASK); -+ rf_reg_53 = odm_get_rf_reg(dm, i, RF_0x53, RFREGOFFSETMASK); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 2g rf(0x51)=0x%X rf(0x52)=0x%X rf(0x53)=0x%X path=%d\n", -+ rf_reg_51, rf_reg_52, rf_reg_53, i); -+ -+ /*2.4G bias*/ -+ rf_reg_3f = rf_reg_53; -+ pa_bias_tmp = rf_reg_3f & 0xf; -+ -+ reg_tmp = pa_bias_tmp + power_trim_info->pa_bias_trim[0][i]; -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 2g pa bias reg_tmp(%d) = pa_bias_tmp(%d) + power_trim_info->pa_bias_trim[0][%d](%d)\n", -+ reg_tmp, pa_bias_tmp, i, power_trim_info->pa_bias_trim[0][i]); -+ -+#if 0 -+ if (reg_tmp < 0) { -+ reg_tmp = 0; -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 2g pa bias reg_tmp < 0. Set 0 path=%d\n", i); -+ } else if (reg_tmp > 7) { -+ reg_tmp = 7; -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 2g pa bias reg_tmp > 7. Set 7 path=%d\n", i); -+ } -+#endif -+ -+ rf_reg_3f = ((rf_reg_3f & 0xffff0) | reg_tmp); -+ rf_reg_3f = ((rf_reg_3f & 0x0ffff) | 0x10000); -+ -+ odm_set_rf_reg(dm, i, RF_0xef, BIT(10), 0x1); -+ for (j = 0; j <= 0xf; j++) { -+ odm_set_rf_reg(dm, i, RF_0x30, RFREGOFFSETMASK, (j << 16)); -+ odm_set_rf_reg(dm, i, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 2G pa bias write RF_0x30=0x%05x RF_0x3f=0x%x path=%d\n", -+ (j << 16), rf_reg_3f, i); -+ } -+ odm_set_rf_reg(dm, i, RF_0xef, BIT(10), 0x0); -+ -+#if 0 -+ /*2.4G bandedge*/ -+ /*rf3f =>*/ -+ /*rf51[3:1] = rf3f[17:15]*/ -+ /*rf52[2:0] = rf3f[14:12]*/ -+ /*rf52[18] = rf3f[11]*/ -+ /*rf51[6:4] = rf3f[10:8]*/ -+ /*rf51[11:8] = rf3f[7:4]*/ -+ /*rf51[16:13] = rf3f[3:0]*/ -+#endif -+ /*2.4G bandedge*/ -+ rf_reg_3f = (((rf_reg_51 & 0xe) >> 1) << 15) | -+ ((rf_reg_52 & 0x7) << 12) | -+ (((rf_reg_52 & 0x40000) >> 18) << 11) | -+ (((rf_reg_51 & 0x70) >> 4) << 8) | -+ (((rf_reg_51 & 0xf00) >> 8) << 4) | -+ ((rf_reg_51 & 0x1e000) >> 13); -+ -+ bandedge_tmp = rf_reg_3f & 0xf; -+ -+ reg_tmp = bandedge_tmp + power_trim_info->pa_bias_trim[0][i]; -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 2g bandedge reg_tmp(%d) = bandedge_tmp(%d) + power_trim_info->pa_bias_trim[0][%d](%d)\n", -+ reg_tmp, bandedge_tmp, i, power_trim_info->pa_bias_trim[0][i]); -+ -+#if 0 -+ if (reg_tmp < 0) { -+ reg_tmp = 0; -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 2g bandedge reg_tmp < 0. Set 0 path=%d\n", i); -+ } else if (reg_tmp > 7) { -+ reg_tmp = 7; -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 2g bandedge reg_tmp > 7. Set 7 path=%d\n", i); -+ } -+#endif -+ -+ rf_reg_3f = ((rf_reg_3f & 0xffff0) | reg_tmp); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 2G bandedge RF_0x30=0x%05X RF_0x3f=0x%x path=%d\n", -+ 0x00001, rf_reg_3f, i); -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 2G bandedge RF_0x30=0x%05X RF_0x3f=0x%x path=%d\n", -+ 0x0000b, rf_reg_3f, i); -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 2G bandedge RF_0x30=0x%05X RF_0x3f=0x%x path=%d\n", -+ 0x00023, rf_reg_3f, i); -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 2G bandedge RF_0x30=0x%05X RF_0x3f=0x%x path=%d\n", -+ 0x00029, rf_reg_3f, i); -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 2G bandedge RF_0x30=0x%05X RF_0x3f=0x%x path=%d\n", -+ 0x0002a, rf_reg_3f, i); -+ -+ odm_set_rf_reg(dm, i, RF_0xef, BIT(8), 0x1); -+ odm_set_rf_reg(dm, i, RF_0x33, RFREGOFFSETMASK, 0x00001); -+ odm_set_rf_reg(dm, i, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); -+ odm_set_rf_reg(dm, i, RF_0x33, RFREGOFFSETMASK, 0x0000b); -+ odm_set_rf_reg(dm, i, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); -+ odm_set_rf_reg(dm, i, RF_0x33, RFREGOFFSETMASK, 0x00023); -+ odm_set_rf_reg(dm, i, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); -+ odm_set_rf_reg(dm, i, RF_0x33, RFREGOFFSETMASK, 0x00029); -+ odm_set_rf_reg(dm, i, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); -+ odm_set_rf_reg(dm, i, RF_0x33, RFREGOFFSETMASK, 0x0002a); -+ odm_set_rf_reg(dm, i, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); -+ odm_set_rf_reg(dm, i, RF_0xef, BIT(8), 0x0); -+ -+ } -+#endif -+} -+ -+void phydm_set_pabias_bandedge_5g_rf_8814b(void *dm_void) -+{ -+#if 0 -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u32 rf_reg_18[MAX_PATH_NUM_8814B] = {0}, -+ rf_reg_61[15][MAX_PATH_NUM_8814B] = {0}, -+ rf_reg_62[3][MAX_PATH_NUM_8814B] = {0}; -+ u8 i, j; -+ u32 bandedge[15][MAX_PATH_NUM_8814B] = {0}, -+ pa_bias[3][MAX_PATH_NUM_8814B] = {0}; -+ -+ s32 pa_bias_tmp, reg_tmp; -+ -+ -+ for (i = 0; i < MAX_PATH_NUM_8814B; i++) { -+ rf_reg_18[i] = odm_get_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK); -+ -+ for (j = 0; j < 3; j++) { -+ if (j == 0) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x10d24); -+ else if (j == 1) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x30d64); -+ else if (j == 2) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x50da9); -+ -+ rf_reg_62[j][i] = odm_get_rf_reg(dm, i, 0x62, RFREGOFFSETMASK); -+ -+#if 0 -+ /*5G bias*/ -+ /*rf62[19:16] == rf30[11:8]*/ -+ /*rf62[15:12] == rf30[7:4]*/ -+ /*rf62[11:8] == rf3030[3:0]*/ -+#endif -+ pa_bias[j][i] = (((rf_reg_62[j][i] & 0xf0000) >> 16) << 8) | -+ (((rf_reg_62[j][i] & 0xf000) >> 12) << 4) | -+ ((rf_reg_62[j][i] & 0xf00) >> 8); -+ } -+ -+ for (j = 0; j < 15; j++) { -+ if (j == 0) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x10d24);/*ch36*/ -+ else if (j == 1) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x11926);/*ch38*/ -+ else if (j == 2) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x1252a);/*ch42*/ -+ else if (j == 3) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x1253a);/*ch58*/ -+ else if (j == 4) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x1193e);/*ch62*/ -+ else if (j == 5) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x10d40);/*ch64*/ -+ else if (j == 6) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x30d64);/*ch100*/ -+ else if (j == 7) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x31966);/*ch102*/ -+ else if (j == 8) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x3256a);/*ch106*/ -+ else if (j == 9) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x3257a);/*ch122*/ -+ else if (j == 10) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x31986);/*ch134*/ -+ else if (j == 11) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x30d8c);/*ch140*/ -+ else if (j == 12) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x50d95);/*ch149*/ -+ else if (j == 13) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x51997);/*ch151*/ -+ else if (j == 14) -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, 0x5259b);/*ch155*/ -+ -+ -+ rf_reg_61[j][i] = odm_get_rf_reg(dm, i, RF_0x61, RFREGOFFSETMASK); -+#if 0 -+ /*5G bandedge*/ -+ /*rf61[11:8] == rf30[11:8]*/ -+ /*rf61[7:4] == rf30[7:4]*/ -+ /*rf61[3:0] == rf3030[3:0]*/ -+#endif -+ bandedge[j][i] = rf_reg_61[j][i] & 0xfff; -+ } -+ -+ odm_set_rf_reg(dm, i, RF_0x18, RFREGOFFSETMASK, rf_reg_18[i]); -+ } -+ -+ for (i = 0; i < MAX_PATH_NUM_8814B; i++) { -+ for (j = 0; j < 3; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] pa_bias[%d][%d]=0x%x\n", j, i, pa_bias[j][i]); -+ } -+ } -+ -+ for (i = 0; i < MAX_PATH_NUM_8814B; i++) { -+ for (j = 0; j < 15; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] bandedge[%d][%d]=0x%x\n", j, i, bandedge[j][i]); -+ } -+ } -+ -+ /*5G bias*/ -+ for (i = 0; i < MAX_PATH_NUM_8814B; i++) { -+ odm_set_rf_reg(dm, i, RF_0xee, BIT(8), 0x1); -+ for (j = 0; j <= 0xb; j++) { -+ -+ if (j >= 0 && j <= 3) -+ pa_bias_tmp = pa_bias[0][i] & 0xf; -+ else if (j >= 4 && j <= 0x7) -+ pa_bias_tmp = pa_bias[1][i] & 0xf; -+ else if (j >= 0x8 && j <= 0xb) -+ pa_bias_tmp = pa_bias[2][i] & 0xf; -+ -+ reg_tmp = pa_bias_tmp + power_trim_info->pa_bias_trim[1][i]; -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 5g pa bias reg_tmp(%d) = pa_bias_tmp(%d) + power_trim_info->pa_bias_trim[1][%d](%d)\n", -+ reg_tmp, pa_bias_tmp, i, power_trim_info->pa_bias_trim[1][i]); -+#if 0 -+ if (reg_tmp < 0) { -+ reg_tmp = 0; -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 5g pa bias reg_tmp < 0. Set 0 path=%d\n", i); -+ } else if (reg_tmp > 7) { -+ reg_tmp = 7; -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 5g pa bias reg_tmp > 7. Set 7 path=%d\n", i); -+ } -+#endif -+ if (j >= 0 && j <= 3) -+ reg_tmp = ((pa_bias[0][i] & 0xffff0) | reg_tmp | (j << 12)); -+ else if (j >= 4 && j <= 0x7) -+ reg_tmp = ((pa_bias[1][i] & 0xffff0) | reg_tmp | (j << 12)); -+ else if (j >= 0x8 && j <= 0xb) -+ reg_tmp = ((pa_bias[2][i] & 0xffff0) | reg_tmp | (j << 12)); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b write RF_0x30=0x%05x path=%d\n", -+ reg_tmp, i); -+ -+ odm_set_rf_reg(dm, i, RF_0x30, RFREGOFFSETMASK, reg_tmp); -+ } -+ odm_set_rf_reg(dm, i, RF_0xee, BIT(8), 0x0); -+ } -+ -+ /*5G bandedge*/ -+ for (i = 0; i < MAX_PATH_NUM_8814B; i++) { -+ odm_set_rf_reg(dm, i, RF_0xee, BIT(9), 0x1); -+ for (j = 0; j <= 0xe; j++) { -+ reg_tmp = bandedge[j][i] + power_trim_info->pa_bias_trim[1][i]; -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b 5g bandedge reg_tmp(%d)(0x%X) = bandedge_org(%d) + power_trim_info->pa_bias_trim[1][%d](%d)\n", -+ reg_tmp, reg_tmp, bandedge[j][i], i, power_trim_info->pa_bias_trim[1][i]); -+#if 0 -+ if (reg_tmp < 0) { -+ reg_tmp = 0; -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 5g bandedge reg_tmp < 0. Set 0 path=%d\n", i); -+ } else if (reg_tmp > 7) { -+ reg_tmp = 7; -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 5g bandedge reg_tmp > 7. Set 7 path=%d\n", i); -+ } -+#endif -+ -+ reg_tmp = ((bandedge[j][i] & 0xffff0) | reg_tmp | (j << 12)); -+ -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8814b write RF_0x30=0x%05x path=%d\n", -+ reg_tmp, i); -+ -+ odm_set_rf_reg(dm, i, RF_0x30, RFREGOFFSETMASK, reg_tmp); -+ } -+ odm_set_rf_reg(dm, i, RF_0xee, BIT(9), 0x0); -+ } -+ -+#endif -+} -+ -+ -+void phydm_get_pa_bias_offset_8814b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i, j, k; -+ u8 tssi_pa_bias_2g[2] = {0}, tssi_pa_bias_5g[2] = {0}; -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GAC_14B, &tssi_pa_bias_2g[0], false); -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GBD_14B, &tssi_pa_bias_2g[1], false); -+ -+ j = 0; -+ for (i = 0; i < 2; i++) { -+ if (tssi_pa_bias_2g[i] == 0xff) -+ j++; -+ } -+ -+ if (j == 2) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b 2g PA Bias K no PG\n"); -+ } else { -+ power_trim_info->pa_bias_trim[0][RF_PATH_A] = tssi_pa_bias_2g[0] & 0xf; -+ power_trim_info->pa_bias_trim[0][RF_PATH_C] = (tssi_pa_bias_2g[0] & 0xf0) >> 4; -+ power_trim_info->pa_bias_trim[0][RF_PATH_B] = tssi_pa_bias_2g[1] & 0xf; -+ power_trim_info->pa_bias_trim[0][RF_PATH_D] = (tssi_pa_bias_2g[1] & 0xf0) >> 4; -+ -+ for (k = 0; k < MAX_PATH_NUM_8814B; k++) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b 2g PA Bias K efuse:0x%x path=%d\n", -+ power_trim_info->pa_bias_trim[0][k], k); -+ odm_set_rf_reg(dm, k, 0x60, 0x0000f000, power_trim_info->pa_bias_trim[0][k]); -+ } -+ -+#if 0 -+ for (k = 0; k < MAX_PATH_NUM_8814B; k++) { -+ if ((power_trim_info->pa_bias_trim[0][k] & BIT(0)) == 0) -+ power_trim_info->pa_bias_trim[0][k] = (-1 * (power_trim_info->pa_bias_trim[0][k] >> 1)); -+ else -+ power_trim_info->pa_bias_trim[0][k] = (power_trim_info->pa_bias_trim[0][k] >> 1); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b 2g PA Bias K power_trim_info->pa_bias_trim[0][%d]=0x%x\n", -+ k, power_trim_info->pa_bias_trim[0][k]); -+ } -+ -+ phydm_set_pabias_bandedge_2g_rf_8814b(dm); -+#endif -+ } -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GAC_14B, &tssi_pa_bias_5g[0], false); -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GBD_14B, &tssi_pa_bias_5g[1], false); -+ -+ j = 0; -+ for (i = 0; i < 2; i++) { -+ if (tssi_pa_bias_5g[i] == 0xff) -+ j++; -+ } -+ -+ if (j == 2) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b 5g PA Bias K no PG\n"); -+ } else { -+ power_trim_info->pa_bias_trim[1][RF_PATH_A] = tssi_pa_bias_5g[0] & 0xf; -+ power_trim_info->pa_bias_trim[1][RF_PATH_C] = (tssi_pa_bias_5g[0] & 0xf0) >> 4; -+ power_trim_info->pa_bias_trim[1][RF_PATH_B] = tssi_pa_bias_5g[1] & 0xf; -+ power_trim_info->pa_bias_trim[1][RF_PATH_D] = (tssi_pa_bias_5g[1] & 0xf0) >> 4; -+ -+ for (k = 0; k < MAX_PATH_NUM_8814B; k++) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b 5g PA Bias K efuse:0x%x path=%d\n", -+ power_trim_info->pa_bias_trim[1][k], k); -+ -+ odm_set_rf_reg(dm, k, 0x60, 0x000f0000, power_trim_info->pa_bias_trim[1][k]); -+ } -+#if 0 -+ for (k = 0; k < MAX_PATH_NUM_8814B; k++) { -+ if ((power_trim_info->pa_bias_trim[1][k] & BIT(0)) == 0) -+ power_trim_info->pa_bias_trim[1][k] = (-1 * (power_trim_info->pa_bias_trim[1][k] >> 1)); -+ else -+ power_trim_info->pa_bias_trim[1][k] = (power_trim_info->pa_bias_trim[1][k] >> 1); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b 5g PA Bias K power_trim_info->pa_bias_trim[1][%d]=0x%x\n", -+ k, power_trim_info->pa_bias_trim[1][k]); -+ } -+ -+ phydm_set_pabias_bandedge_5g_rf_8814b(dm); -+#endif -+ } -+ -+ -+} -+ -+void phydm_get_thermal_trim_offset_8814b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 pg_therm = 0xff, i; -+ -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_A_OFFSET_14B, &pg_therm, false); -+ -+ if (pg_therm != 0xff) { -+ for (i = 0; i < MAX_PATH_NUM_8814B; i++) { -+ if (i == 0) -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_A_OFFSET_14B, &pg_therm, false); -+ else if (i == 1) -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_B_OFFSET_14B, &pg_therm, false); -+ else if (i == 2) -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_C_OFFSET_14B, &pg_therm, false); -+ else if (i == 3) -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_D_OFFSET_14B, &pg_therm, false); -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b Efuse thermal S%d:0x%x\n", i, pg_therm); -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->multi_thermal[i] = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->multi_thermal[i] = (pg_therm >> 1); -+ } -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ for (i = 0; i < MAX_RF_PATH; i++) { -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8814b thermal S%d:%d\n", -+ i ,power_trim_info->multi_thermal[i]); -+ } -+} -+ -+void phydm_get_thermal_trim_offset_8723f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ u8 pg_therm = 0xff; -+ -+#if 1 -+ odm_efuse_one_byte_read(dm, PPG_THERMAL_OFFSET_8723F, &pg_therm, false); -+ -+ if (pg_therm != 0xff) { -+ pg_therm = pg_therm & 0x1f; -+ if ((pg_therm & BIT(0)) == 0) -+ power_trim_info->thermal = (-1 * (pg_therm >> 1)); -+ else -+ power_trim_info->thermal = (pg_therm >> 1); -+ -+ power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; -+ } -+ /*if (pg_therm != 0xff) { -+ pg_therm = pg_therm & 0x1f; -+ thermal[RF_PATH_A] =((pg_therm & 0x1) << 3) | ((pg_therm >> 1) & 0x7); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x43, 0x000f0000, thermal[RF_PATH_A]); -+ }*/ -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8723F thermal trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8723F thermal:%d\n", -+ power_trim_info->thermal); -+#endif -+} -+ -+void phydm_get_set_power_trim_offset_8723f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ u8 pg_power = 0xff, i, j; -+ u8 pg_power1, pg_power2 , pg_power3, pg_power4, pg_power5; -+#if 0 -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_22C, &pg_power1, false); -+ odm_efuse_one_byte_read(dm, PPG_2GM_TXAB_22C, &pg_power2, false); -+ odm_efuse_one_byte_read(dm, PPG_2GH_TXAB_22C, &pg_power3, false); -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22C, &pg_power4, false); -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_22C, &pg_power5, false); -+ -+ if (pg_power1 != 0xff || pg_power2 != 0xff || pg_power3 != 0xff || -+ pg_power4 != 0xff || pg_power5 != 0xff) { -+ odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[0][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[0][1] = (pg_power & 0xf0) >> 4; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GM_TXAB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[1][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[1][1] = (pg_power & 0xf0) >> 4; -+ -+ odm_efuse_one_byte_read(dm, PPG_2GH_TXAB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[2][0] = pg_power & 0xf; -+ power_trim_info->bb_gain[2][1] = (pg_power & 0xf0) >> 4; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[3][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[3][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[4][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GL2_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[4][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[5][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GM1_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[5][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[6][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GM2_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[6][1] = pg_power & 0x1f; -+ -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[7][0] = pg_power & 0x1f; -+ odm_efuse_one_byte_read(dm, PPG_5GH1_TXB_22C, &pg_power, false); -+ if (pg_power == 0xff) -+ pg_power = 0; -+ power_trim_info->bb_gain[7][1] = pg_power & 0x1f; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | KFREE_FLAG_ON | -+ KFREE_FLAG_ON_2G | -+ KFREE_FLAG_ON_5G; -+ -+ phydm_set_power_trim_offset_8822c(dm); -+ } -+ -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8822c power trim flag:0x%02x\n", -+ power_trim_info->flag); -+ -+ if (power_trim_info->flag & KFREE_FLAG_ON) { -+ for (i = 0; i < KFREE_BAND_NUM; i++) { -+ for (j = 0; j < 2; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8822c pwr_trim->bb_gain[%d][%d]=0x%X\n", -+ i, j, power_trim_info->bb_gain[i][j]); -+ } -+ } -+ } -+#endif -+} -+ -+void phydm_get_tssi_trim_offset_8723f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ u8 i, j, k; -+ u8 pg_power[16] = {0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff}; -+#if 1 -+ odm_efuse_one_byte_read(dm, PPG_S0_CH3_TSSIDE_8723F, &pg_power[0], false); -+ odm_efuse_one_byte_read(dm, PPG_S1_CH3_TSSIDE_8723F, &pg_power[1], false); -+ odm_efuse_one_byte_read(dm, PPG_S0_CH11_TSSIDE_8723F, &pg_power[2], false); -+ odm_efuse_one_byte_read(dm, PPG_S1_CH11_TSSIDE_8723F, &pg_power[3], false); -+ odm_efuse_one_byte_read(dm, PPG_S0_CH42_TSSIDE_8723F, &pg_power[4], false); -+ odm_efuse_one_byte_read(dm, PPG_S0_CH58_TSSIDE_8723F, &pg_power[6], false); -+ odm_efuse_one_byte_read(dm, PPG_S0_CH110_TSSIDE_8723F, &pg_power[8], false); -+ odm_efuse_one_byte_read(dm, PPG_S0_CH134_TSSIDE_8723F, &pg_power[10], false); -+ odm_efuse_one_byte_read(dm, PPG_S0_CH159_TSSIDE_8723F, &pg_power[12], false); -+ odm_efuse_one_byte_read(dm, PPG_S0_CH171_TSSIDE_8723F, &pg_power[14], false); -+ -+ j = 0; -+ for (i = 0; i < 16; i++) { -+ if ((pg_power[i] & 0xff) == 0xff) -+ j++; -+ } -+ -+ if (j == 16) { -+ for (i = 0; i < 9; i++) -+ for(k = 0; i < 2; i++) -+ power_trim_info->tssi_trim[i][k] = 0; -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8723F tssi trim no PG\n"); -+ } else { -+ power_trim_info->tssi_trim[0][0] = (s8)pg_power[0]; -+ power_trim_info->tssi_trim[0][1] = (s8)pg_power[1]; -+ power_trim_info->tssi_trim[1][0] = (s8)pg_power[2]; -+ power_trim_info->tssi_trim[1][1] = (s8)pg_power[3]; -+ power_trim_info->tssi_trim[2][0] = (s8)pg_power[4]; -+ power_trim_info->tssi_trim[2][1] = 0; -+ power_trim_info->tssi_trim[3][0] = (s8)pg_power[6]; -+ power_trim_info->tssi_trim[3][1] = 0; -+ power_trim_info->tssi_trim[4][0] = (s8)pg_power[8]; -+ power_trim_info->tssi_trim[4][1] = 0; -+ power_trim_info->tssi_trim[5][0] = (s8)pg_power[10]; -+ power_trim_info->tssi_trim[5][1] = 0; -+ power_trim_info->tssi_trim[6][0] = (s8)pg_power[12]; -+ power_trim_info->tssi_trim[6][1] = 0; -+ power_trim_info->tssi_trim[7][0] = (s8)pg_power[14]; -+ power_trim_info->tssi_trim[7][1] = 0; -+ -+ power_trim_info->flag = -+ power_trim_info->flag | TSSI_TRIM_FLAG_ON; -+ -+ if (power_trim_info->flag & TSSI_TRIM_FLAG_ON) { -+ for (i = 0; i < 8; i++) { //KFREE_BAND_NUM -+ for (j = 0; j < 2; j++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8723F tssi_trim[%d][%d]=0x%X\n", -+ i, j, power_trim_info->tssi_trim[i][j]); -+ } -+ } -+ } -+ } -+#endif -+} -+ -+s8 phydm_get_tssi_trim_de_8723f(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ u8 channel = *dm->channel, group = 0; -+ -+ if (channel >= 1 && channel <= 7) { -+ group = 0; -+ } else if (channel >= 8 && channel <= 14) { -+ group = 1; -+ } else if (channel >= 36 && channel <= 50) { -+ group = 2; -+ } else if (channel >= 52 && channel <= 64) { -+ group = 3; -+ } else if (channel >= 100 && channel <= 128) { -+ group = 4; -+ } else if (channel >= 129 && channel <= 144) { -+ group = 5; -+ } else if (channel >= 149 && channel <= 163) { -+ group = 6; -+ } else if (channel >= 164 && channel <= 177) { -+ group = 7; -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] Channel(%d) is not exist in Group\n", channel); -+ return 0; -+ } -+ -+ return power_trim_info->tssi_trim[group][path]; -+} -+ -+void phydm_get_set_pa_bias_offset_8723f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i; -+ u8 ppa_bias_2g[2] = {0}, ppa_bias_5g = 0; -+ -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_8723F, &ppa_bias_2g[0], false); -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_2GB_8723F, &ppa_bias_2g[1], false); -+ odm_efuse_one_byte_read(dm, PPG_PABIAS_5GA_8723F, &ppa_bias_5g, false); -+ -+ if (ppa_bias_2g[0] == 0xff && ppa_bias_2g[1] == 0xff) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8723f 2g PA Bias K no PG\n"); -+ } else { -+ for (i = 0; i < MAX_PATH_NUM_8723F; i++) { -+ power_trim_info->pa_bias_trim[0][i] = ppa_bias_2g[i] & 0xf; -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8723f S%d 2g PA Bias K efuse:0x%x\n", -+ i, power_trim_info->pa_bias_trim[0][i]); -+ odm_set_rf_reg(dm, i, RF_0x60, 0x0f000, power_trim_info->pa_bias_trim[0][i]); -+ } -+ power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; -+ } -+ -+ if (ppa_bias_5g == 0xff) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8723f 5g PA Bias K no PG\n"); -+ } else { -+ power_trim_info->pa_bias_trim[1][RF_PATH_A] = ppa_bias_5g & 0xf; -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8723f 5g PA Bias K efuse:0x%x\n", -+ power_trim_info->pa_bias_trim[1][RF_PATH_A]); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x60, 0xf0000, power_trim_info->pa_bias_trim[1][0]); -+ power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; -+ } -+} -+ -+void phydm_get_set_lna_offset_8723f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ u8 i; -+ u8 pg_lna_2g[2] = {0}, pg_lna_5g = 0; -+ -+ odm_efuse_one_byte_read(dm, PPG_LNA_2GA_8723F, &pg_lna_2g[0], false); -+ odm_efuse_one_byte_read(dm, PPG_LNA_2GB_8723F, &pg_lna_2g[1], false); -+ odm_efuse_one_byte_read(dm, PPG_LNA_5GA_8723F, &pg_lna_5g, false); -+ -+ if (pg_lna_2g[0] == 0xff && pg_lna_2g[1] == 0xff) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8723f 2g LNA Bias K no PG\n"); -+ } else { -+ for (i = 0; i < MAX_PATH_NUM_8723F; i++) { -+ power_trim_info->lna_trim[i] = pg_lna_2g[i] & 0x3f; -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] 8723f S%d 2g LNA Bias K efuse:0x%x\n", -+ i, power_trim_info->lna_trim[i]); -+ odm_set_rf_reg(dm, i, RF_0x88, 0x003f0, power_trim_info->lna_trim[i]); -+ } -+ power_trim_info->lna_flag |= LNA_FLAG_ON; -+ } -+ -+ if (pg_lna_5g == 0xff) { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8723f 5g LNA Bias K no PG\n"); -+ } else { -+ power_trim_info->lna_trim[2] = pg_lna_5g & 0x3f; -+ RF_DBG(dm, DBG_RF_MP, "[kfree] 8723f 5g LNA Bias K efuse:0x%x\n", -+ power_trim_info->lna_trim[2]); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x8b, 0x03f00, power_trim_info->lna_trim[2]); -+ power_trim_info->lna_flag |= LNA_FLAG_ON; -+ } -+} -+ -+s8 phydm_get_tssi_trim_de(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_RTL8822C) -+ return phydm_get_tssi_trim_de_8822c(dm, path); -+ else if (dm->support_ic_type & ODM_RTL8812F) -+ return phydm_get_tssi_trim_de_8812f(dm, path); -+ else if (dm->support_ic_type & ODM_RTL8197G) -+ return phydm_get_tssi_trim_de_8197g(dm, path); -+ else if (dm->support_ic_type & ODM_RTL8814B) -+ return phydm_get_tssi_trim_de_8814b(dm, path); -+ else if (dm->support_ic_type & ODM_RTL8723F) -+ return phydm_get_tssi_trim_de_8723f(dm, path); -+ else -+ return 0; -+} -+ -+void phydm_do_new_kfree(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ phydm_get_set_thermal_trim_offset_8822c(dm); -+ phydm_get_set_power_trim_offset_8822c(dm); -+ phydm_get_set_pa_bias_offset_8822c(dm); -+ phydm_get_tssi_trim_offset_8822c(dm); -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8812F) { -+ phydm_get_set_thermal_trim_offset_8812f(dm); -+ phydm_get_set_power_trim_offset_8812f(dm); -+ phydm_get_set_pa_bias_offset_8812f(dm); -+ phydm_get_tssi_trim_offset_8812f(dm); -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8195B) { -+ phydm_get_thermal_trim_offset_8195b(dm); -+ phydm_get_set_power_trim_offset_8195b(dm); -+ phydm_get_set_pa_bias_offset_8195b(dm); -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8721D) { -+ phydm_get_thermal_trim_offset_8721d(dm); -+ phydm_get_set_power_trim_offset_8721d(dm); -+ /*phydm_get_set_pa_bias_offset_8721d(dm);*/ -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8198F) { -+ phydm_get_pa_bias_offset_8198f(dm); -+ phydm_get_set_lna_offset_8198f(dm); -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8197G) { -+ phydm_get_thermal_trim_offset_8197g(dm); -+ phydm_get_set_power_trim_offset_8197g(dm); -+ phydm_get_set_pa_bias_offset_8197g(dm); -+ phydm_get_tssi_trim_offset_8197g(dm); -+ phydm_get_set_lna_offset_8197g(dm); -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8710C) { -+ phydm_get_thermal_trim_offset_8710c(dm); -+ phydm_get_set_power_trim_offset_8710c(dm); -+ phydm_get_set_pa_bias_offset_8710c(dm); -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8814B) { -+ phydm_get_thermal_trim_offset_8814b(dm); -+ phydm_get_set_power_trim_offset_8814b(dm); -+ phydm_get_pa_bias_offset_8814b(dm); -+ phydm_get_tssi_trim_offset_8814b(dm); -+ } -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ phydm_get_thermal_trim_offset_8723f(dm); -+ phydm_get_set_power_trim_offset_8723f(dm); -+ phydm_get_set_pa_bias_offset_8723f(dm); -+ phydm_get_set_lna_offset_8723f(dm); -+ phydm_get_tssi_trim_offset_8723f(dm); -+ } -+} -+ -+void phydm_set_kfree_to_rf(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_RTL8814A) -+ phydm_set_kfree_to_rf_8814a(dm, e_rf_path, data); -+ -+ if ((dm->support_ic_type & ODM_RTL8821C) && -+ (*dm->band_type == ODM_BAND_2_4G)) -+ phydm_set_kfree_to_rf_8821c(dm, e_rf_path, true, data); -+ else if (dm->support_ic_type & ODM_RTL8821C) -+ phydm_set_kfree_to_rf_8821c(dm, e_rf_path, false, data); -+ -+ if (dm->support_ic_type & ODM_RTL8822B) -+ phydm_set_kfree_to_rf_8822b(dm, e_rf_path, data); -+ -+ if (dm->support_ic_type & ODM_RTL8710B) -+ phydm_set_kfree_to_rf_8710b(dm, e_rf_path, data); -+ -+ if (dm->support_ic_type & ODM_RTL8198F) -+ phydm_set_kfree_to_rf_8198f(dm, e_rf_path, data); -+} -+ -+void phydm_clear_kfree_to_rf(void *dm_void, u8 e_rf_path, u8 data) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_RTL8822B) -+ phydm_clear_kfree_to_rf_8822b(dm, e_rf_path, 1); -+ -+ if (dm->support_ic_type & ODM_RTL8821C) -+ phydm_clear_kfree_to_rf_8821c(dm, e_rf_path, 1); -+ -+ if (dm->support_ic_type & ODM_RTL8198F) -+ phydm_clear_kfree_to_rf_8198f(dm, e_rf_path, 0); -+} -+ -+void phydm_get_thermal_trim_offset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ PEFUSE_HAL pEfuseHal = &hal_data->EfuseHal; -+ u1Byte eFuseContent[DCMD_EFUSE_MAX_SECTION_NUM * EFUSE_MAX_WORD_UNIT * 2]; -+ -+ if (HAL_MAC_Dump_EFUSE(&GET_HAL_MAC_INFO((PADAPTER)adapter), EFUSE_WIFI, eFuseContent, pEfuseHal->PhysicalLen_WiFi, HAL_MAC_EFUSE_PHYSICAL, HAL_MAC_EFUSE_PARSE_DRV) != RT_STATUS_SUCCESS) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] dump efuse fail !!!\n"); -+#endif -+ -+ if (dm->support_ic_type & ODM_RTL8821C) -+ phydm_get_thermal_trim_offset_8821c(dm_void); -+ else if (dm->support_ic_type & ODM_RTL8822B) -+ phydm_get_thermal_trim_offset_8822b(dm_void); -+ else if (dm->support_ic_type & ODM_RTL8710B) -+ phydm_get_thermal_trim_offset_8710b(dm_void); -+ else if (dm->support_ic_type & ODM_RTL8192F) -+ phydm_get_thermal_trim_offset_8192f(dm_void); -+ else if (dm->support_ic_type & ODM_RTL8198F) -+ phydm_get_thermal_trim_offset_8198f(dm_void); -+} -+ -+void phydm_get_power_trim_offset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if 0 //(DM_ODM_SUPPORT_TYPE & ODM_WIN) // 2017 MH DM Should use the same code.s -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ PEFUSE_HAL pEfuseHal = &hal_data->EfuseHal; -+ u1Byte eFuseContent[DCMD_EFUSE_MAX_SECTION_NUM * EFUSE_MAX_WORD_UNIT * 2]; -+ -+ if (HAL_MAC_Dump_EFUSE(&GET_HAL_MAC_INFO(adapter), EFUSE_WIFI, eFuseContent, pEfuseHal->PhysicalLen_WiFi, HAL_MAC_EFUSE_PHYSICAL, HAL_MAC_EFUSE_PARSE_DRV) != RT_STATUS_SUCCESS) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] dump efuse fail !!!\n"); -+#endif -+ -+ if (dm->support_ic_type & ODM_RTL8821C) -+ phydm_get_power_trim_offset_8821c(dm_void); -+ else if (dm->support_ic_type & ODM_RTL8822B) -+ phydm_get_power_trim_offset_8822b(dm_void); -+ else if (dm->support_ic_type & ODM_RTL8710B) -+ phydm_get_power_trim_offset_8710b(dm_void); -+ else if (dm->support_ic_type & ODM_RTL8192F) -+ phydm_get_power_trim_offset_8192f(dm_void); -+ else if (dm->support_ic_type & ODM_RTL8198F) -+ phydm_get_power_trim_offset_8198f(dm_void); -+} -+ -+void phydm_get_pa_bias_offset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ PEFUSE_HAL pEfuseHal = &hal_data->EfuseHal; -+ u1Byte eFuseContent[DCMD_EFUSE_MAX_SECTION_NUM * EFUSE_MAX_WORD_UNIT * 2]; -+ -+ if (HAL_MAC_Dump_EFUSE(&GET_HAL_MAC_INFO((PADAPTER)adapter), EFUSE_WIFI, eFuseContent, pEfuseHal->PhysicalLen_WiFi, HAL_MAC_EFUSE_PHYSICAL, HAL_MAC_EFUSE_PARSE_DRV) != RT_STATUS_SUCCESS) -+ RF_DBG(dm, DBG_RF_MP, "[kfree] dump efuse fail !!!\n"); -+#endif -+ -+ if (dm->support_ic_type & ODM_RTL8822B) -+ phydm_get_pa_bias_offset_8822b(dm_void); -+} -+ -+s8 phydm_get_thermal_offset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ return power_trim_info->thermal; -+ else -+ return 0; -+} -+ -+s8 phydm_get_multi_thermal_offset(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; -+ -+ if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) -+ return power_trim_info->multi_thermal[path]; -+ else -+ return 0; -+} -+ -+void phydm_do_kfree(void *dm_void, u8 channel_to_sw) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_power_trim_data *pwrtrim = &dm->power_trim_data; -+ u8 channel_idx = 0, rfpath = 0, max_path = 0, kfree_band_num = 0; -+ u8 i, j; -+ s8 bb_gain; -+ -+ if (dm->support_ic_type & ODM_RTL8814A) -+ max_path = 4; /*0~3*/ -+ else if (dm->support_ic_type & -+ (ODM_RTL8812 | ODM_RTL8822B | ODM_RTL8192F)) { -+ max_path = 2; /*0~1*/ -+ kfree_band_num = KFREE_BAND_NUM; -+ } else if (dm->support_ic_type & ODM_RTL8821C) { -+ max_path = 1; -+ kfree_band_num = KFREE_BAND_NUM; -+ } else if (dm->support_ic_type & ODM_RTL8710B) { -+ max_path = 1; -+ kfree_band_num = 1; -+ } else if (dm->support_ic_type & ODM_RTL8198F) { -+ max_path = 4; -+ kfree_band_num = 3; -+ } -+ -+ if (dm->support_ic_type & -+ (ODM_RTL8192F | ODM_RTL8822B | ODM_RTL8821C | -+ ODM_RTL8814A | ODM_RTL8710B)) { -+ for (i = 0; i < kfree_band_num; i++) { -+ for (j = 0; j < max_path; j++) -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] PwrTrim->gain[%d][%d]=0x%X\n", -+ i, j, pwrtrim->bb_gain[i][j]); -+ } -+ } -+ if (*dm->band_type == ODM_BAND_2_4G && -+ pwrtrim->flag & KFREE_FLAG_ON_2G) { -+ if (!(dm->support_ic_type & ODM_RTL8192F)) { -+ if (channel_to_sw >= 1 && channel_to_sw <= 14) -+ channel_idx = PHYDM_2G; -+ for (rfpath = RF_PATH_A; rfpath < max_path; rfpath++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s:chnl=%d PATH=%d gain:0x%X\n", -+ __func__, channel_to_sw, rfpath, -+ pwrtrim->bb_gain[channel_idx][rfpath]); -+ bb_gain = pwrtrim->bb_gain[channel_idx][rfpath]; -+ phydm_set_kfree_to_rf(dm, rfpath, bb_gain); -+ } -+ } else if (dm->support_ic_type & ODM_RTL8192F) { -+ if (channel_to_sw >= 1 && channel_to_sw <= 3) -+ channel_idx = 0; -+ if (channel_to_sw >= 4 && channel_to_sw <= 9) -+ channel_idx = 1; -+ if (channel_to_sw >= 10 && channel_to_sw <= 14) -+ channel_idx = 2; -+ for (rfpath = RF_PATH_A; rfpath < max_path; rfpath++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s:chnl=%d PATH=%d gain:0x%X\n", -+ __func__, channel_to_sw, rfpath, -+ pwrtrim->bb_gain[channel_idx][rfpath]); -+ bb_gain = pwrtrim->bb_gain[channel_idx][rfpath]; -+ phydm_set_kfree_to_rf_8192f(dm, rfpath, -+ channel_idx, -+ bb_gain); -+ } -+ } -+ } else if (*dm->band_type == ODM_BAND_5G && -+ pwrtrim->flag & KFREE_FLAG_ON_5G) { -+ if (channel_to_sw >= 36 && channel_to_sw <= 48) -+ channel_idx = PHYDM_5GLB1; -+ if (channel_to_sw >= 52 && channel_to_sw <= 64) -+ channel_idx = PHYDM_5GLB2; -+ if (channel_to_sw >= 100 && channel_to_sw <= 120) -+ channel_idx = PHYDM_5GMB1; -+ if (channel_to_sw >= 122 && channel_to_sw <= 144) -+ channel_idx = PHYDM_5GMB2; -+ if (channel_to_sw >= 149 && channel_to_sw <= 177) -+ channel_idx = PHYDM_5GHB; -+ -+ for (rfpath = RF_PATH_A; rfpath < max_path; rfpath++) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s: channel=%d PATH=%d bb_gain:0x%X\n", -+ __func__, channel_to_sw, rfpath, -+ pwrtrim->bb_gain[channel_idx][rfpath]); -+ bb_gain = pwrtrim->bb_gain[channel_idx][rfpath]; -+ phydm_set_kfree_to_rf(dm, rfpath, bb_gain); -+ } -+ } else { -+ RF_DBG(dm, DBG_RF_MP, "[kfree] Set default Register\n"); -+ if (!(dm->support_ic_type & ODM_RTL8192F)) { -+ for (rfpath = RF_PATH_A; rfpath < max_path; rfpath++) { -+ bb_gain = pwrtrim->bb_gain[channel_idx][rfpath]; -+ phydm_clear_kfree_to_rf(dm, rfpath, bb_gain); -+ } -+ } -+#if 0 -+ /*else if(dm->support_ic_type & ODM_RTL8192F){ -+ if (channel_to_sw >= 1 && channel_to_sw <= 3) -+ channel_idx = 0; -+ if (channel_to_sw >= 4 && channel_to_sw <= 9) -+ channel_idx = 1; -+ if (channel_to_sw >= 9 && channel_to_sw <= 14) -+ channel_idx = 2; -+ for (rfpath = RF_PATH_A; rfpath < max_path; rfpath++) -+ phydm_clear_kfree_to_rf_8192f(dm, rfpath, pwrtrim->bb_gain[channel_idx][rfpath]); -+ }*/ -+#endif -+ } -+} -+ -+void phydm_config_new_kfree(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ -+ if (cali_info->reg_rf_kfree_enable == 2) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s: reg_rf_kfree_enable == 2, Disable\n", -+ __func__); -+ return; -+ } else if (cali_info->reg_rf_kfree_enable == 1 || -+ cali_info->reg_rf_kfree_enable == 0) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s: reg_rf_kfree_enable == true\n", __func__); -+ -+ phydm_do_new_kfree(dm); -+ } -+} -+ -+void phydm_config_kfree(void *dm_void, u8 channel_to_sw) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ struct odm_power_trim_data *pwrtrim = &dm->power_trim_data; -+ -+ RF_DBG(dm, DBG_RF_MP, "===>[kfree] phy_ConfigKFree()\n"); -+ -+ if (cali_info->reg_rf_kfree_enable == 2) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s: reg_rf_kfree_enable == 2, Disable\n", -+ __func__); -+ return; -+ } else if (cali_info->reg_rf_kfree_enable == 1 || -+ cali_info->reg_rf_kfree_enable == 0) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s: reg_rf_kfree_enable == true\n", __func__); -+ /*Make sure the targetval is defined*/ -+ if (!(pwrtrim->flag & KFREE_FLAG_ON)) { -+ RF_DBG(dm, DBG_RF_MP, -+ "[kfree] %s: efuse is 0xff, KFree not work\n", -+ __func__); -+ return; -+ } -+#if 0 -+ /*if kfree_table[0] == 0xff, means no Kfree*/ -+#endif -+ phydm_do_kfree(dm, channel_to_sw); -+ } -+ RF_DBG(dm, DBG_RF_MP, "<===[kfree] phy_ConfigKFree()\n"); -+} -+ -+void phydm_set_lna_trim_offset (void *dm_void, u8 path, u8 cg_cs, u8 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_RTL8197G) -+ phydm_set_lna_trim_offset_8197g(dm, path, cg_cs, enable); -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_kfree.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_kfree.h -new file mode 100644 -index 000000000..0446c4b6f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_kfree.h -@@ -0,0 +1,316 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALRF_KFREE_H__ -+#define __HALRF_KFREE_H__ -+ -+#define KFREE_VERSION "1.0" -+ -+#define KFREE_BAND_NUM 9 -+#define KFREE_CH_NUM 3 -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_AP)) -+ -+#define BB_GAIN_NUM 6 -+ -+#endif -+ -+#define KFREE_FLAG_ON BIT(0) -+#define KFREE_FLAG_THERMAL_K_ON BIT(1) -+ -+#define KFREE_FLAG_ON_2G BIT(2) -+#define KFREE_FLAG_ON_5G BIT(3) -+ -+#define PA_BIAS_FLAG_ON BIT(4) -+ -+#define TSSI_TRIM_FLAG_ON BIT(5) -+ -+#define LNA_FLAG_ON BIT(6) -+ -+ -+#define PPG_THERMAL_OFFSET_98F 0x50 -+#define PPG_2GM_TXAB_98F 0x51 -+#define PPG_2GM_TXCD_98F 0x52 -+#define PPG_2GL_TXAB_98F 0x53 -+#define PPG_2GL_TXCD_98F 0x54 -+#define PPG_2GH_TXAB_98F 0x55 -+#define PPG_2GH_TXCD_98F 0x56 -+ -+#define PPG_PABIAS_2GAB_98F 0x57 -+#define PPG_PABIAS_2GCD_98F 0x58 -+ -+#define PPG_LNA_2GA_98F 0x59 -+#define PPG_LNA_2GB_98F 0x5a -+#define PPG_LNA_2GC_98F 0x5b -+#define PPG_LNA_2GD_98F 0x5c -+ -+#define PPG_THERMAL_OFFSET_21C 0x1EF -+#define PPG_2G_TXAB_21C 0x1EE -+#define PPG_5GL1_TXA_21C 0x1EC -+#define PPG_5GL2_TXA_21C 0x1E8 -+#define PPG_5GM1_TXA_21C 0x1E4 -+#define PPG_5GM2_TXA_21C 0x1E0 -+#define PPG_5GH1_TXA_21C 0x1DC -+ -+#define PPG_THERMAL_OFFSET_22B 0x3EF -+#define PPG_2G_TXAB_22B 0x3EE -+#define PPG_2G_TXCD_22B 0x3ED -+#define PPG_5GL1_TXA_22B 0x3EC -+#define PPG_5GL1_TXB_22B 0x3EB -+#define PPG_5GL1_TXC_22B 0x3EA -+#define PPG_5GL1_TXD_22B 0x3E9 -+#define PPG_5GL2_TXA_22B 0x3E8 -+#define PPG_5GL2_TXB_22B 0x3E7 -+#define PPG_5GL2_TXC_22B 0x3E6 -+#define PPG_5GL2_TXD_22B 0x3E5 -+#define PPG_5GM1_TXA_22B 0x3E4 -+#define PPG_5GM1_TXB_22B 0x3E3 -+#define PPG_5GM1_TXC_22B 0x3E2 -+#define PPG_5GM1_TXD_22B 0x3E1 -+#define PPG_5GM2_TXA_22B 0x3E0 -+#define PPG_5GM2_TXB_22B 0x3DF -+#define PPG_5GM2_TXC_22B 0x3DE -+#define PPG_5GM2_TXD_22B 0x3DD -+#define PPG_5GH1_TXA_22B 0x3DC -+#define PPG_5GH1_TXB_22B 0x3DB -+#define PPG_5GH1_TXC_22B 0x3DA -+#define PPG_5GH1_TXD_22B 0x3D9 -+ -+#define PPG_PABIAS_2GA_22B 0x3D5 -+#define PPG_PABIAS_2GB_22B 0x3D6 -+ -+#define PPG_THERMAL_A_OFFSET_22C 0x1ef -+#define PPG_THERMAL_B_OFFSET_22C 0x1b0 -+#define PPG_2GL_TXAB_22C 0x1d4 -+#define PPG_2GM_TXAB_22C 0x1ee -+#define PPG_2GH_TXAB_22C 0x1d2 -+#define PPG_5GL1_TXA_22C 0x1ec -+#define PPG_5GL1_TXB_22C 0x1eb -+#define PPG_5GL2_TXA_22C 0x1e8 -+#define PPG_5GL2_TXB_22C 0x1e7 -+#define PPG_5GM1_TXA_22C 0x1e4 -+#define PPG_5GM1_TXB_22C 0x1e3 -+#define PPG_5GM2_TXA_22C 0x1e0 -+#define PPG_5GM2_TXB_22C 0x1df -+#define PPG_5GH1_TXA_22C 0x1dc -+#define PPG_5GH1_TXB_22C 0x1db -+ -+#define PPG_PABIAS_2GA_22C 0x1d6 -+#define PPG_PABIAS_2GB_22C 0x1d5 -+#define PPG_PABIAS_5GA_22C 0x1d8 -+#define PPG_PABIAS_5GB_22C 0x1d7 -+ -+#define TSSI_2GM_TXA_22C 0x1c0 -+#define TSSI_2GM_TXB_22C 0x1bf -+#define TSSI_2GH_TXA_22C 0x1be -+#define TSSI_2GH_TXB_22C 0x1bd -+#define TSSI_5GL1_TXA_22C 0x1bc -+#define TSSI_5GL1_TXB_22C 0x1bb -+#define TSSI_5GL2_TXA_22C 0x1ba -+#define TSSI_5GL2_TXB_22C 0x1b9 -+#define TSSI_5GM1_TXA_22C 0x1b8 -+#define TSSI_5GM1_TXB_22C 0x1b7 -+#define TSSI_5GM2_TXA_22C 0x1b6 -+#define TSSI_5GM2_TXB_22C 0x1b5 -+#define TSSI_5GH1_TXA_22C 0x1b4 -+#define TSSI_5GH1_TXB_22C 0x1b3 -+#define TSSI_5GH2_TXA_22C 0x1b2 -+#define TSSI_5GH2_TXB_22C 0x1b1 -+ -+/*8195B*/ -+#define PPG_THERMAL_OFFSET_95B 0x1ef -+#define PPG_2GL_TXA_95B 0x1d4 -+#define PPG_2GM_TXA_95B 0x1ee -+#define PPG_2GH_TXA_95B 0x1d2 -+#define PPG_5GL1_TXA_95B 0x1ec -+#define PPG_5GL2_TXA_95B 0x1e8 -+#define PPG_5GM1_TXA_95B 0x1e4 -+#define PPG_5GM2_TXA_95B 0x1e0 -+#define PPG_5GH1_TXA_95B 0x1dc -+ -+#define PPG_PABIAS_2GA_95B 0x1d6 -+#define PPG_PABIAS_5GA_95B 0x1d8 -+ -+/*8721D*/ -+/*#define KFREE_BAND_NUM_8721D 6*/ -+#define PPG_THERMAL_OFFSET_8721D 0x1EF -+#define PPG_2G_TXA_8721D 0x1EE -+#define PPG_5GL1_TXA_8721D 0x1ED -+#define PPG_5GL2_TXA_8721D 0x1EC -+#define PPG_5GM1_TXA_8721D 0x1EB -+#define PPG_5GM2_TXA_8721D 0x1EA -+#define PPG_5GH1_TXA_8721D 0x1E9 -+ -+/*8723F*/ -+/*#define KFREE_BAND_NUM_8723F*/ -+#define PPG_THERMAL_OFFSET_8723F 0x1EF -+#define PPG_S0_CH3_TSSIDE_8723F 0x1DD -+#define PPG_S1_CH3_TSSIDE_8723F 0x1DC -+#define PPG_S0_CH11_TSSIDE_8723F 0x1DB -+#define PPG_S1_CH11_TSSIDE_8723F 0x1DA -+#define PPG_S0_CH42_TSSIDE_8723F 0x1D9 -+#define PPG_S0_CH58_TSSIDE_8723F 0x1D8 -+#define PPG_S0_CH110_TSSIDE_8723F 0x1D7 -+#define PPG_S0_CH134_TSSIDE_8723F 0x1D6 -+#define PPG_S0_CH159_TSSIDE_8723F 0x1D5 -+#define PPG_S0_CH171_TSSIDE_8723F 0x1D4 -+#define PPG_PABIAS_5GA_8723F 0x1E8 -+#define PPG_PABIAS_2GA_8723F 0x1E7 -+#define PPG_PABIAS_2GB_8723F 0x1E6 -+#define PPG_LNA_2GA_8723F 0x1E3 -+#define PPG_LNA_2GB_8723F 0x1E2 -+#define PPG_LNA_5GA_8723F 0x1E1 -+ -+/*8197G*/ -+#define PPG_THERMAL_A_OFFSET_97G 0x50 -+#define PPG_THERMAL_B_OFFSET_97G 0x27 -+#define PPG_2GM_TXAB_97G 0x51 -+#define PPG_2GL_TXAB_97G 0x53 -+#define PPG_2GH_TXAB_97G 0x55 -+#define TSSI_2GL_TXA_97G 0x1c -+#define TSSI_2GL_TXB_97G 0x1d -+#define TSSI_2GH_TXA_97G 0x1e -+#define TSSI_2GH_TXB_97G 0x1f -+#define PPG_PABIAS_2GAB_97G 0x57 -+#define PPG_LNA_2GA_97G 0x21 -+#define PPG_LNA_2GB_97G 0x22 -+ -+/*8710C Ameba Z2*/ -+#define PPG_THERMAL_OFFSET_10C 0x1EF -+#define PPG_2GL_TX_10C 0x1D4 -+#define PPG_2GM_TX_10C 0x1EE -+#define PPG_2GH_TX_10C 0x1D2 -+#define PPG_PABIAS_10C 0x1D6 -+#define PPG_LNA_10C 0x1D0 -+ -+/*8814B*/ -+#define PPG_2GL_TXAB_14B 0x3ee -+#define PPG_2GL_TXCD_14B 0x3ed -+#define PPG_5GL1_TXA_14B 0x3ec -+#define PPG_5GL1_TXB_14B 0x3eb -+#define PPG_5GL1_TXC_14B 0x3ea -+#define PPG_5GL1_TXD_14B 0x3e9 -+#define PPG_5GL2_TXA_14B 0x3e8 -+#define PPG_5GL2_TXB_14B 0x3e7 -+#define PPG_5GL2_TXC_14B 0x3e6 -+#define PPG_5GL2_TXD_14B 0x3e5 -+#define PPG_5GM1_TXA_14B 0x3e4 -+#define PPG_5GM1_TXB_14B 0x3e3 -+#define PPG_5GM1_TXC_14B 0x3e2 -+#define PPG_5GM1_TXD_14B 0x3e1 -+#define PPG_5GM2_TXA_14B 0x3e0 -+#define PPG_5GM2_TXB_14B 0x3df -+#define PPG_5GM2_TXC_14B 0x3de -+#define PPG_5GM2_TXD_14B 0x3dd -+#define PPG_5GH1_TXA_14B 0x3dc -+#define PPG_5GH1_TXB_14B 0x3db -+#define PPG_5GH1_TXC_14B 0x3da -+#define PPG_5GH1_TXD_14B 0x3d9 -+#define PPG_PABIAS_5GAC_14B 0x3d8 -+#define PPG_PABIAS_5GBD_14B 0x3d7 -+#define PPG_PABIAS_2GAC_14B 0x3d6 -+#define PPG_PABIAS_2GBD_14B 0x3d5 -+ -+#define PPG_THERMAL_A_OFFSET_14B 0x3D4 -+#define PPG_THERMAL_B_OFFSET_14B 0x3D3 -+#define PPG_THERMAL_C_OFFSET_14B 0x3D2 -+#define PPG_THERMAL_D_OFFSET_14B 0x3D1 -+ -+#define TSSI_2GM_TXA_14B 0x3c0 -+#define TSSI_2GM_TXB_14B 0x3bf -+#define TSSI_2GM_TXC_14B 0x3be -+#define TSSI_2GM_TXD_14B 0x3bd -+#define TSSI_2GH_TXA_14B 0x3bc -+#define TSSI_2GH_TXB_14B 0x3bb -+#define TSSI_2GH_TXC_14B 0x3ba -+#define TSSI_2GH_TXD_14B 0x3b9 -+#define TSSI_5GL1_TXA_14B 0x3b8 -+#define TSSI_5GL1_TXB_14B 0x3b7 -+#define TSSI_5GL1_TXC_14B 0x3b6 -+#define TSSI_5GL1_TXD_14B 0x3b5 -+#define TSSI_5GL2_TXA_14B 0x3b4 -+#define TSSI_5GL2_TXB_14B 0x3b3 -+#define TSSI_5GL2_TXC_14B 0x3b2 -+#define TSSI_5GL2_TXD_14B 0x3b1 -+#define TSSI_5GM1_TXA_14B 0x3b0 -+#define TSSI_5GM1_TXB_14B 0x3af -+#define TSSI_5GM1_TXC_14B 0x3ae -+#define TSSI_5GM1_TXD_14B 0x3ad -+#define TSSI_5GM2_TXA_14B 0x3ac -+#define TSSI_5GM2_TXB_14B 0x3ab -+#define TSSI_5GM2_TXC_14B 0x3aa -+#define TSSI_5GM2_TXD_14B 0x3a9 -+#define TSSI_5GH1_TXA_14B 0x3a8 -+#define TSSI_5GH1_TXB_14B 0x3a7 -+#define TSSI_5GH1_TXC_14B 0x3a6 -+#define TSSI_5GH1_TXD_14B 0x3a5 -+#define TSSI_5GH2_TXA_14B 0x3a4 -+#define TSSI_5GH2_TXB_14B 0x3a3 -+#define TSSI_5GH2_TXC_14B 0x3a2 -+#define TSSI_5GH2_TXD_14B 0x3a1 -+ -+ -+struct odm_power_trim_data { -+ u8 flag; -+ u8 pa_bias_flag; -+ u8 lna_flag; -+ s8 bb_gain[KFREE_BAND_NUM][MAX_RF_PATH]; -+ s8 tssi_trim[KFREE_BAND_NUM][MAX_RF_PATH]; -+ s8 pa_bias_trim[KFREE_BAND_NUM][MAX_RF_PATH]; -+ s8 lna_trim[MAX_RF_PATH]; -+ s8 thermal; -+ s8 multi_thermal[MAX_RF_PATH]; -+}; -+ -+enum phydm_kfree_channeltosw { -+ PHYDM_2G = 0, -+ PHYDM_5GLB1 = 1, -+ PHYDM_5GLB2 = 2, -+ PHYDM_5GMB1 = 3, -+ PHYDM_5GMB2 = 4, -+ PHYDM_5GHB = 5, -+}; -+ -+void phydm_get_thermal_trim_offset(void *dm_void); -+ -+void phydm_get_power_trim_offset(void *dm_void); -+ -+void phydm_get_pa_bias_offset(void *dm_void); -+ -+s8 phydm_get_thermal_offset(void *dm_void); -+ -+s8 phydm_get_multi_thermal_offset(void *dm_void, u8 path); -+ -+void phydm_clear_kfree_to_rf(void *dm_void, u8 e_rf_path, u8 data); -+ -+void phydm_config_new_kfree(void *dm_void); -+ -+s8 phydm_get_tssi_trim_de(void *dm_void, u8 path); -+ -+void phydm_config_kfree(void *dm_void, u8 channel_to_sw); -+ -+void phydm_set_lna_trim_offset (void *dm_void, u8 path, u8 cg_cs, u8 enable); -+ -+#endif /*__HALRF_KFREE_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking.c -new file mode 100644 -index 000000000..3ccbf7484 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking.c -@@ -0,0 +1,192 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ * ************************************************************ -+ */ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+boolean -+odm_check_power_status(void *dm_void) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ PADAPTER *adapter = dm->adapter; -+ -+ RT_RF_POWER_STATE rt_state; -+ MGNT_INFO *mgnt_info = &((PADAPTER)adapter)->MgntInfo; -+ -+ /* 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. */ -+ if (mgnt_info->init_adpt_in_progress == true) { -+ RF_DBG(dm, DBG_RF_INIT, -+ "check_pow_status Return true, due to initadapter\n"); -+ return true; -+ } -+ -+ /* -+ * 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. -+ */ -+ ((PADAPTER)adapter)->HalFunc.GetHwRegHandler((PADAPTER)adapter, HW_VAR_RF_STATE, (u8 *)(&rt_state)); -+ if (((PADAPTER)adapter)->bDriverStopped || ((PADAPTER)adapter)->bDriverIsGoingToPnpSetPowerSleep || rt_state == eRfOff) { -+ RF_DBG(dm, DBG_RF_INIT, -+ "check_pow_status Return false, due to %d/%d/%d\n", -+ ((PADAPTER)adapter)->bDriverStopped, -+ ((PADAPTER)adapter)->bDriverIsGoingToPnpSetPowerSleep, -+ rt_state); -+ return false; -+ } -+#endif -+ return true; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+void halrf_update_pwr_track(void *dm_void, u8 rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ u8 path_idx = 0; -+#endif -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Pwr Track Get rate=0x%x\n", rate); -+ -+ dm->tx_rate = rate; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+#if USE_WORKITEM -+ odm_schedule_work_item(&dm->ra_rpt_workitem); -+#else -+ if (dm->support_ic_type == ODM_RTL8821) { -+#if (RTL8821A_SUPPORT == 1) -+ odm_tx_pwr_track_set_pwr8821a(dm, MIX_MODE, RF_PATH_A, 0); -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8812) { -+ for (path_idx = RF_PATH_A; path_idx < MAX_PATH_NUM_8812A; path_idx++) { -+#if (RTL8812A_SUPPORT == 1) -+ odm_tx_pwr_track_set_pwr8812a(dm, MIX_MODE, path_idx, 0); -+#endif -+ } -+ } else if (dm->support_ic_type == ODM_RTL8723B) { -+#if (RTL8723B_SUPPORT == 1) -+ odm_tx_pwr_track_set_pwr_8723b(dm, MIX_MODE, RF_PATH_A, 0); -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8192E) { -+ for (path_idx = RF_PATH_A; path_idx < MAX_PATH_NUM_8192E; path_idx++) { -+#if (RTL8192E_SUPPORT == 1) -+ odm_tx_pwr_track_set_pwr92_e(dm, MIX_MODE, path_idx, 0); -+#endif -+ } -+ } else if (dm->support_ic_type == ODM_RTL8188E) { -+#if (RTL8188E_SUPPORT == 1) -+ odm_tx_pwr_track_set_pwr88_e(dm, MIX_MODE, RF_PATH_A, 0); -+#endif -+ } -+#endif -+#else -+ odm_schedule_work_item(&dm->ra_rpt_workitem); -+#endif -+#endif -+} -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void halrf_update_init_rate_work_item_callback( -+ void *context) -+{ -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ u8 p = 0; -+ -+ if (dm->support_ic_type == ODM_RTL8821) { -+#if (RTL8821A_SUPPORT == 1) -+ odm_tx_pwr_track_set_pwr8821a(dm, MIX_MODE, RF_PATH_A, 0); -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8812) { -+#if (RTL8812A_SUPPORT == 1) -+ /*Don't know how to include &c*/ -+ for (p = RF_PATH_A; p < MAX_PATH_NUM_8812A; p++) -+ odm_tx_pwr_track_set_pwr8812a(dm, MIX_MODE, p, 0); -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8723B) { -+#if (RTL8723B_SUPPORT == 1) -+ odm_tx_pwr_track_set_pwr_8723b(dm, MIX_MODE, RF_PATH_A, 0); -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8192E) { -+#if (RTL8192E_SUPPORT == 1) -+ /*Don't know how to include &c*/ -+ for (p = RF_PATH_A; p < MAX_PATH_NUM_8192E; p++) -+ odm_tx_pwr_track_set_pwr92_e(dm, MIX_MODE, p, 0); -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8188E) { -+#if (RTL8188E_SUPPORT == 1) -+ odm_tx_pwr_track_set_pwr88_e(dm, MIX_MODE, RF_PATH_A, 0); -+#endif -+ } -+} -+#endif -+ -+void halrf_set_pwr_track(void *dm_void, u8 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ struct txpwrtrack_cfg c; -+ u8 i; -+ -+ configure_txpower_track(dm, &c); -+ if (enable) { -+ rf->rf_supportability = rf->rf_supportability | HAL_RF_TX_PWR_TRACK; -+ -+ if (dm->support_ic_type != ODM_RTL8723F) { -+ if (cali_info->txpowertrack_control == 1 || cali_info->txpowertrack_control == 3) -+ halrf_do_tssi(dm); -+ } -+ -+ halrf_tssi_get_efuse(dm); -+ halrf_do_tssi(dm); -+ -+ } else { -+ rf->rf_supportability = rf->rf_supportability & ~HAL_RF_TX_PWR_TRACK; -+ odm_clear_txpowertracking_state(dm); -+ halrf_do_tssi(dm); -+ halrf_calculate_tssi_codeword(dm); -+ halrf_set_tssi_codeword(dm); -+ -+ for (i = 0; i < c.rf_path_count; i++) -+ (*c.odm_tx_pwr_track_set_pwr)(dm, CLEAN_MODE, i, 0); -+ -+ } -+ -+ if (cali_info->txpowertrack_control == 2 || -+ cali_info->txpowertrack_control == 3 || -+ cali_info->txpowertrack_control == 4 || -+ cali_info->txpowertrack_control == 5) -+ halrf_txgapk_reload_tx_gain(dm); -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking.h -new file mode 100644 -index 000000000..c81f25225 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking.h -@@ -0,0 +1,43 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALRF_POWER_TRACKING_H__ -+#define __HALRF_POWER_TRACKING_H__ -+ -+boolean -+odm_check_power_status(void *dm_void); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+void halrf_update_pwr_track(void *dm_void, u8 rate); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void halrf_update_init_rate_work_item_callback( -+ void *context); -+#endif -+ -+void halrf_set_pwr_track(void *dm_void, u8 enable); -+ -+#endif /*#ifndef __HALRF_POWERTRACKING_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ap.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ap.c -new file mode 100644 -index 000000000..aaadf8878 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ap.c -@@ -0,0 +1,1316 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if !defined(_OUTSRC_COEXIST) -+/* ************************************************************ -+ * Global var -+ * ************************************************************ */ -+ -+ -+u32 ofdm_swing_table_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 */ -+}; -+ -+u8 cck_swing_table_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 */ -+}; -+ -+ -+u8 cck_swing_table_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 */ -+}; -+ -+u32 ofdm_swing_table[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 */ -+}; -+ -+ -+u8 cck_swing_table_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 */ -+}; -+ -+ -+u8 cck_swing_table_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 */ -+}; -+ -+u8 cck_swing_table_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 */ -+}; -+ -+ -+u8 cck_swing_table_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 */ -+}; -+ -+ -+u8 cck_swing_table_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*/ -+}; -+ -+/* Winnita ADD 20171113 PathA 0xAB4[10:0],PathB 0xAB4[21:11]*/ -+u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F] = { -+ 0x0CD, /*0 , -20dB*/ -+ 0x0D9, -+ 0x0E6, -+ 0x0F3, -+ 0x102, -+ 0x111, -+ 0x121, -+ 0x132, -+ 0x144, -+ 0x158, -+ 0x16C, -+ 0x182, -+ 0x198, -+ 0x1B1, -+ 0x1CA, -+ 0x1E5, -+ 0x202, -+ 0x221, -+ 0x241, -+ 0x263, /*19*/ -+ 0x287, /*20*/ -+ 0x2AE, /*21*/ -+ 0x2D6, /*22*/ -+ 0x301, /*23*/ -+ 0x32F, /*24*/ -+ 0x35F, /*25*/ -+ 0x392, /*26*/ -+ 0x3C9, /*27*/ -+ 0x402, /*28*/ -+ 0x43F, /*29*/ -+ 0x47F, /*30*/ -+ 0x4C3, /*31*/ -+ 0x50C, /*32*/ -+ 0x558, /*33*/ -+ 0x5A9, /*34*/ -+ 0x5FF, /*35*/ -+ 0x65A, /*36*/ -+ 0x6BA, -+ 0x720, -+ 0x78C, -+ 0x7FF, -+}; -+ -+ -+#if 0 -+u32 ofdm_swing_table_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 -+}; -+u8 cck_swing_table_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} -+}; -+u8 cck_swing_table_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 -+#endif -+ -+ -+u8 delta_swing_table_idx_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 -+ }; -+u8 delta_swing_table_idx_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 -+u32 ofdm_swing_table_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 -+}; -+u8 cck_swing_table_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} -+}; -+u8 cck_swing_table_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 ||\ -+ RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8814C_SUPPORT == 1) -+u32 tx_scaling_table_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) -+u32 ofdm_swing_table_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 -+ -+u32 cck_swing_table_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, -+}; -+/* JJ ADD 20161014 */ -+u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B] = { -+ 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_txpowertracking_init( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if (!(dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | -+ ODM_RTL8814B | ODM_RTL8814C | ODM_IC_11N_SERIES))) -+ return; -+#endif -+ -+ odm_txpowertracking_thermal_meter_init(dm); -+} -+ -+ -+u8 -+get_swing_index( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0, bb_swing_mask = 0; -+ u32 bb_swing = 0; -+ u32 swing_table_size = 0; -+ u32 *swing_table = 0; -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8197F) { -+ bb_swing = phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKOFDM_D); -+ swing_table = ofdm_swing_table_new; -+ swing_table_size = OFDM_TABLE_SIZE_92D; -+ bb_swing_mask = 22; -+ } -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8192F) { -+ bb_swing = phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKOFDM_D); -+ swing_table = ofdm_swing_table_new; -+ swing_table_size = OFDM_TABLE_SIZE_92D; -+ bb_swing_mask = 22; -+ } -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8822B) { -+ bb_swing = phy_query_bb_reg(priv, REG_A_TX_SCALE_JAGUAR, 0xFFE00000); -+ swing_table = tx_scaling_table_jaguar; -+ swing_table_size = TXSCALE_TABLE_SIZE; -+ bb_swing_mask = 0; -+ } -+#endif -+ -+ for (i = 0; i < swing_table_size - 1; i++) { -+ u32 table_value = swing_table[i] >> bb_swing_mask; -+ -+ if (bb_swing == table_value) -+ break; -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "bb_swing=0x%x bbswing_index=%d\n", bb_swing, i); -+ -+ -+ return i; -+} -+ -+u8 get_cck_swing_index(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ u8 i = 0; -+ u32 bb_cck_swing; -+ -+#if (RTL8192F_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8192F) { -+ bb_cck_swing = odm_get_bb_reg(dm, R_0xab4, 0x7ff); -+ -+ for (i = 0; i < CCK_TABLE_SIZE; i++) { -+ if (bb_cck_swing == cck_swing_table_ch1_ch14_8192f[i]) -+ break; -+ } -+ } -+#endif -+ -+ return i; -+} -+ -+s8 -+get_txagc_default_index( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ s8 tmp; -+ -+#if (RTL8814B_SUPPORT == 1 || RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ tmp = (s8)(odm_get_bb_reg(dm, R_0x18a0, 0x7f) & 0xff); -+ if (tmp & BIT(6)) -+ tmp = tmp | 0x80; -+ return tmp; -+ } else -+ return 0; -+#endif -+} -+ -+void -+odm_txpowertracking_thermal_meter_init( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ struct rtl8192cd_priv *priv = dm->priv; -+ u8 p; -+ u8 default_swing_index; -+ u8 default_cckswing_idx; -+ u8 i; -+#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8192F_SUPPORT == 1) -+ if ((GET_CHIP_VER(priv) == VERSION_8197F) || (GET_CHIP_VER(priv) == VERSION_8822B) ||(GET_CHIP_VER(priv) == VERSION_8192F)) -+ default_swing_index = get_swing_index(dm); -+ if (GET_CHIP_VER(priv) == VERSION_8192F) -+ default_cckswing_idx = get_cck_swing_index(dm); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = dm->adapter; -+ PMGNT_INFO mgnt_info = &adapter->MgntInfo; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ -+ mgnt_info->is_txpowertracking = true; -+ hal_data->tx_powercount = 0; -+ hal_data->is_txpowertracking_init = false; -+ -+ if (*(dm->mp_mode) == false) -+ hal_data->txpowertrack_control = true; -+ RF_DBG(dm, COMP_POWER_TRACKING, "mgnt_info->is_txpowertracking = %d\n", mgnt_info->is_txpowertracking); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#ifdef CONFIG_RTL8188E -+ { -+ dm->rf_calibrate_info.is_txpowertracking = true; -+ dm->rf_calibrate_info.tx_powercount = 0; -+ dm->rf_calibrate_info.is_txpowertracking_init = false; -+ -+ if (*(dm->mp_mode) == false) -+ dm->rf_calibrate_info.txpowertrack_control = true; -+ -+ MSG_8192C("dm txpowertrack_control = %d\n", dm->rf_calibrate_info.txpowertrack_control); -+ } -+#else -+ { -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_priv *pdmpriv = &hal_data->dmpriv; -+ -+ pdmpriv->is_txpowertracking = true; -+ pdmpriv->tx_powercount = 0; -+ pdmpriv->is_txpowertracking_init = false; -+ -+ if (*(dm->mp_mode) == false) /* for mp driver, turn off txpwrtracking as default */ -+ pdmpriv->txpowertrack_control = true; -+ -+ MSG_8192C("pdmpriv->txpowertrack_control = %d\n", pdmpriv->txpowertrack_control); -+ -+ } -+#endif/* endif (CONFIG_RTL8188E==1) */ -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#ifdef RTL8188E_SUPPORT -+ { -+ dm->rf_calibrate_info.is_txpowertracking = true; -+ dm->rf_calibrate_info.tx_powercount = 0; -+ dm->rf_calibrate_info.is_txpowertracking_init = false; -+ dm->rf_calibrate_info.txpowertrack_control = true; -+ dm->rf_calibrate_info.tm_trigger = 0; -+ } -+#endif -+#endif -+ -+ dm->rf_calibrate_info.txpowertrack_control = true; -+ dm->rf_calibrate_info.delta_power_index = 0; -+ dm->rf_calibrate_info.delta_power_index_last = 0; -+ dm->rf_calibrate_info.power_index_offset = 0; -+ dm->rf_calibrate_info.thermal_value = 0; -+ cali_info->default_ofdm_index = 28; -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8197F) { -+ cali_info->default_ofdm_index = (default_swing_index >= (OFDM_TABLE_SIZE_92D - 1)) ? 30 : default_swing_index; -+ cali_info->default_cck_index = 28; -+ } -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8192F) { -+ cali_info->default_ofdm_index = (default_swing_index >= (OFDM_TABLE_SIZE_92D - 1)) ? 30 : default_swing_index; -+ cali_info->default_cck_index = (default_cckswing_idx >= (CCK_TABLE_SIZE_8192F - 1)) ? 28 : default_cckswing_idx; -+ } -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8822B) { -+ cali_info->default_ofdm_index = (default_swing_index >= (TXSCALE_TABLE_SIZE - 1)) ? 24 : default_swing_index; -+ cali_info->default_cck_index = 20; -+ } -+#endif -+ -+ -+#if RTL8188E_SUPPORT -+ if (GET_CHIP_VER(priv) == VERSION_8188E) { -+ cali_info->default_cck_index = 20; /* -6 dB */ -+ } -+#endif -+ -+#if RTL8192E_SUPPORT -+ if (GET_CHIP_VER(priv) == VERSION_8192E) { -+ cali_info->default_cck_index = 8; /* -12 dB */ -+ } -+#endif -+ -+#if (RTL8814B_SUPPORT == 1 || RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ cali_info->default_txagc_index = get_txagc_default_index(dm); -+ -+ for (i = 0; i < MAX_PATH_NUM_8814B; i++) -+ tssi->tssi_trk_txagc_offset[i] = -+ cali_info->default_txagc_index; -+ } -+#endif -+ -+ cali_info->bb_swing_idx_ofdm_base = cali_info->default_ofdm_index; -+ cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; -+ dm->rf_calibrate_info.CCK_index = cali_info->default_cck_index; -+ -+ for (p = 0; p < MAX_RF_PATH; p++) { -+ dm->rf_calibrate_info.OFDM_index[p] = cali_info->default_ofdm_index; -+ cali_info->bb_swing_idx_ofdm[p] = cali_info->default_ofdm_index; -+ cali_info->kfree_offset[p] = 0; /* for 8814 kfree*/ -+ } -+ cali_info->bb_swing_idx_cck = cali_info->default_cck_index; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "cali_info->default_ofdm_index=%d cali_info->default_cck_index=%d\n", cali_info->default_ofdm_index, cali_info->default_cck_index); -+ -+ cali_info->tm_trigger = 0; -+} -+ -+ -+void -+odm_txpowertracking_check( -+ void *dm_void -+) -+{ -+ /* */ -+ /* For AP/ADSL use struct rtl8192cd_priv* */ -+ /* For CE/NIC use struct void* */ -+ /* */ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ -+ if (!(rf->rf_supportability & HAL_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 (dm->support_platform) { -+ case ODM_WIN: -+ odm_txpowertracking_check_mp(dm); -+ break; -+ -+ case ODM_CE: -+ odm_txpowertracking_check_ce(dm); -+ break; -+ -+ case ODM_AP: -+ odm_txpowertracking_check_ap(dm); -+ break; -+ } -+ -+} -+ -+void -+odm_txpowertracking_check_ce( -+ void *dm_void -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ -+#if (RTL8188E_SUPPORT == 1) -+ -+ /* if(!mgnt_info->is_txpowertracking || (!pdmpriv->txpowertrack_control && pdmpriv->is_ap_kdone)) */ -+ -+ if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) -+ return; -+ -+ if (!dm->rf_calibrate_info.tm_trigger) { /* at least delay 1 sec */ -+ /* hal_data->TxPowerCheckCnt++; */ /* cosa add for debug */ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); -+ /* DBG_8192C("Trigger 92C Thermal Meter!!\n"); */ -+ -+ dm->rf_calibrate_info.tm_trigger = 1; -+ return; -+ -+ } else { -+ /* DBG_8192C("Schedule TxPowerTracking direct call!!\n"); */ -+ odm_txpowertracking_callback_thermal_meter_8188e(adapter); -+ dm->rf_calibrate_info.tm_trigger = 0; -+ } -+#endif -+ -+#endif -+} -+ -+void -+odm_txpowertracking_check_mp( -+ void *dm_void -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ -+ if (odm_check_power_status(adapter) == false) -+ return; -+ -+ if (!adapter->is_slave_of_dmsp || adapter->dual_mac_smart_concurrent == false) -+ odm_txpowertracking_thermal_meter_check(adapter); -+#endif -+ -+} -+ -+ -+void -+odm_txpowertracking_check_ap( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ -+#if ((RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8192F_SUPPORT == 1) || (RTL8198F_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8812F_SUPPORT == 1) || (RTL8197G_SUPPORT == 1) || (RTL8814C_SUPPORT == 1)) -+ if (!dm->rf_calibrate_info.tm_trigger) { -+ if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A | ODM_RTL8197F | ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8192F | ODM_RTL8198F)) { -+ odm_set_rf_reg(dm, RF_PATH_A, 0x42, (BIT(17) | BIT(16)), 0x3); -+ } else if (dm->support_ic_type & ODM_RTL8812F) { -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x00); -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x00); -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); -+ } else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ odm_set_rf_reg(dm, RF_PATH_A, 0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_B, 0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_C, 0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_D, 0x42, BIT(17), 0x1); -+ } else if (dm->support_ic_type & ODM_RTL8197G) { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x42, BIT(17), 0x0); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x42, BIT(17), 0x1); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x42, BIT(17), 0x0); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x42, BIT(17), 0x1); -+ } -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ ODM_delay_us(300); -+ odm_txpowertracking_callback_thermal_meter(dm); -+ tssi->thermal_trigger = 1; -+ } -+ -+ dm->rf_calibrate_info.tm_trigger = 1; -+ } else { -+ odm_txpowertracking_callback_thermal_meter(dm); -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ tssi->thermal_trigger = 0; -+ dm->rf_calibrate_info.tm_trigger = 0; -+ } -+#endif -+ -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ap.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ap.h -new file mode 100644 -index 000000000..098e28450 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ap.h -@@ -0,0 +1,407 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALRF_POWERTRACKING_H__ -+#define __HALRF_POWERTRACKING_H__ -+ -+#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 -+/* JJ ADD 20161014 */ -+#define CCK_TABLE_SIZE_8710B 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 AVG_THERMAL_NUM 8 -+#define AVG_THERMAL_NUM_DPK 8 -+#define THERMAL_DPK_AVG_NUM 4 -+ -+#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 CCK_TABLE_SIZE_8192F 41 -+ -+ -+ -+ /* #define OFDM_TABLE_SIZE_92E 54 */ -+ /* #define CCK_TABLE_SIZE_92E 54 */ -+ extern u32 ofdm_swing_table[OFDM_TABLE_SIZE_92D]; -+ extern u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8]; -+ extern u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8]; -+ -+ -+ extern u32 ofdm_swing_table_new[OFDM_TABLE_SIZE_92D]; -+ extern u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8]; -+ extern u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8]; -+ extern u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16]; -+ extern u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16]; -+ extern u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16]; -+ extern u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F]; -+ -+#endif -+ -+#define ODM_OFDM_TABLE_SIZE 37 -+#define ODM_CCK_TABLE_SIZE 33 -+#define TXPWR_TRACK_TABLE_SIZE 30 -+/* <20140613, YuChen> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. */ -+extern u8 delta_swing_table_idx_2ga_p_default[DELTA_SWINGIDX_SIZE]; -+extern u8 delta_swing_table_idx_2ga_n_default[DELTA_SWINGIDX_SIZE]; -+ -+static u8 delta_swing_table_idx_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 u8 delta_swing_table_idx_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 u32 ofdm_swing_table_92e[OFDM_TABLE_SIZE_92E]; -+ * extern u8 cck_swing_table_ch1_ch13_92e[CCK_TABLE_SIZE_92E][8]; -+ * extern u8 cck_swing_table_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 u32 ofdm_swing_table_92e[OFDM_TABLE_SIZE_92E]; -+ extern u8 cck_swing_table_ch1_ch13_92e[CCK_TABLE_SIZE_92E][8]; -+ extern u8 cck_swing_table_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 ||\ -+ RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1) -+ extern u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE]; -+ #elif(ODM_IC_11AC_SERIES_SUPPORT) -+ extern unsigned int ofdm_swing_table_8812[OFDM_TABLE_SIZE_8812]; -+#endif -+ -+extern u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D]; -+/* JJ ADD 20161014 */ -+extern u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B]; -+ -+#define dm_check_txpowertracking odm_txpowertracking_check -+ -+struct iqk_matrix_regs_setting { -+ boolean is_iqk_done; -+ s32 value[1][iqk_matrix_reg_num]; -+}; -+ -+struct dm_rf_calibration_struct { -+ /* for tx power tracking */ -+ -+ u32 rega24; /* for TempCCK */ -+ s32 rege94; -+ s32 rege9c; -+ s32 regeb4; -+ s32 regebc; -+ -+ /* u8 is_txpowertracking; */ -+ u8 tx_powercount; -+ boolean is_txpowertracking_init; -+ boolean is_txpowertracking; -+ u8 txpowertrack_control; /* for mp mode, turn off txpwrtracking as default */ -+ u8 tm_trigger; -+ u8 internal_pa_5g[2]; /* pathA / pathB */ -+ -+ u8 thermal_meter[2]; /* thermal_meter, index 0 for RFIC0, and 1 for RFIC1 */ -+ u8 thermal_value; -+ u8 thermal_value_path[MAX_RF_PATH]; -+ u8 thermal_value_lck; -+ u8 thermal_value_iqk; -+ s8 thermal_value_delta; /* delta of thermal_value and efuse thermal */ -+ u8 thermal_value_avg[AVG_THERMAL_NUM]; -+ u8 thermal_value_avg_path[MAX_RF_PATH][AVG_THERMAL_NUM]; -+ u8 thermal_value_avg_index; -+ u8 thermal_value_avg_index_path[MAX_RF_PATH]; -+ s8 power_index_offset_path[MAX_RF_PATH]; -+ -+ u8 thermal_value_rx_gain; -+ u8 thermal_value_crystal; -+ u8 thermal_value_dpk_store; -+ u8 thermal_value_dpk_track; -+ boolean txpowertracking_in_progress; -+ -+ -+ boolean is_reloadtxpowerindex; -+ u8 is_rf_pi_enable; -+ u32 txpowertracking_callback_cnt; /* cosa add for debug */ -+ -+ u8 is_cck_in_ch14; -+ u8 CCK_index; -+ u8 OFDM_index[MAX_RF_PATH]; -+ s8 power_index_offset; -+ s8 delta_power_index; -+ s8 delta_power_index_path[MAX_RF_PATH]; -+ s8 delta_power_index_last; -+ s8 delta_power_index_last_path[MAX_RF_PATH]; -+ boolean is_tx_power_changed; -+ -+ struct iqk_matrix_regs_setting iqk_matrix_reg_setting[IQK_MATRIX_SETTINGS_NUM]; -+ u8 delta_lck; -+ u8 delta_swing_table_idx_2g_cck_a_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_a_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_b_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_b_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_c_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_c_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_d_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_d_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gb_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gb_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gc_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gc_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gd_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gd_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5ga_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5ga_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gb_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gb_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gc_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gc_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gd_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gd_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_a[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_b[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_c[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_d[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2ga[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gb[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gc[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gd[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5ga[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gb[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gc[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gd[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ s8 delta_swing_table_xtal_p[DELTA_SWINGIDX_SIZE]; -+ s8 delta_swing_table_xtal_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_p_8188e[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_n_8188e[DELTA_SWINGIDX_SIZE]; -+ -+ u8 bb_swing_idx_ofdm[MAX_RF_PATH]; -+ u8 bb_swing_idx_ofdm_current; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ u8 bb_swing_idx_ofdm_base[MAX_RF_PATH]; -+#else -+ u8 bb_swing_idx_ofdm_base; -+ u8 bb_swing_idx_ofdm_base_path[MAX_RF_PATH]; -+#endif -+ boolean bb_swing_flag_ofdm; -+ u8 bb_swing_idx_cck; -+ u8 bb_swing_idx_cck_current; -+ u8 bb_swing_idx_cck_base; -+ u8 default_ofdm_index; -+ u8 default_cck_index; -+ s8 default_txagc_index; -+ boolean bb_swing_flag_cck; -+ -+ s8 absolute_ofdm_swing_idx[MAX_RF_PATH]; -+ s8 remnant_ofdm_swing_idx[MAX_RF_PATH]; -+ s8 absolute_cck_swing_idx[MAX_RF_PATH]; -+ s8 remnant_cck_swing_idx; -+ s8 modify_tx_agc_value; /*Remnat compensate value at tx_agc */ -+ boolean modify_tx_agc_flag_path_a; -+ boolean modify_tx_agc_flag_path_b; -+ boolean modify_tx_agc_flag_path_c; -+ boolean modify_tx_agc_flag_path_d; -+ boolean modify_tx_agc_flag_path_a_cck; -+ boolean modify_tx_agc_flag_path_b_cck; -+ -+ s8 kfree_offset[MAX_RF_PATH]; -+ -+ /* -------------------------------------------------------------------- */ -+ -+ /* for IQK */ -+ u32 regc04; -+ u32 reg874; -+ u32 regc08; -+ u32 regb68; -+ u32 regb6c; -+ u32 reg870; -+ u32 reg860; -+ u32 reg864; -+ -+ boolean is_iqk_initialized; -+ boolean is_lck_in_progress; -+ boolean is_antenna_detected; -+ boolean is_need_iqk; -+ boolean is_iqk_in_progress; -+ boolean is_iqk_pa_off; -+ u8 delta_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]; -+ u32 tx_iqc_8723b[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u32 rx_iqc_8723b[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ u32 tx_iqc_8703b[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u32 rx_iqc_8703b[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ -+ u64 iqk_start_time; -+ u64 iqk_total_progressing_time; -+ u64 iqk_progressing_time; -+ u64 lck_progressing_time; -+ u32 lok_result; -+ u8 iqk_step; -+ u8 kcount; -+ u8 retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ -+ boolean is_mp_mode; -+ -+ /* for APK */ -+ u32 ap_koutput[2][2]; /* path A/B; output1_1a/output1_2a */ -+ u8 is_ap_kdone; -+ u8 is_apk_thermal_meter_ignore; -+ u8 is_dp_done; -+#if 0 /*move below members to halrf_dpk.h*/ -+ u8 is_dp_path_aok; -+ u8 is_dp_path_bok; -+ u8 is_dp_path_cok; -+ u8 is_dp_path_dok; -+ u8 dp_path_a_result[3]; -+ u8 dp_path_b_result[3]; -+ u8 dp_path_c_result[3]; -+ u8 dp_path_d_result[3]; -+ boolean is_dpk_enable; -+ u32 txrate[11]; -+ u8 pwsf_2g_a[3]; -+ u8 pwsf_2g_b[3]; -+ u8 pwsf_2g_c[3]; -+ u8 pwsf_2g_d[3]; -+ u32 lut_2g_even_a[3][64]; -+ u32 lut_2g_odd_a[3][64]; -+ u32 lut_2g_even_b[3][64]; -+ u32 lut_2g_odd_b[3][64]; -+ u32 lut_2g_even_c[3][64]; -+ u32 lut_2g_odd_c[3][64]; -+ u32 lut_2g_even_d[3][64]; -+ u32 lut_2g_odd_d[3][64]; -+ u1Byte is_5g_pdk_a_ok; -+ u1Byte is_5g_pdk_b_ok; -+ u1Byte is_5g_pdk_c_ok; -+ u1Byte is_5g_pdk_d_ok; -+ u1Byte pwsf_5g_a[9]; -+ u1Byte pwsf_5g_b[9]; -+ u1Byte pwsf_5g_c[9]; -+ u1Byte pwsf_5g_d[9]; -+ u4Byte lut_5g_even_a[9][16]; -+ u4Byte lut_5g_odd_a[9][16]; -+ u4Byte lut_5g_even_b[9][16]; -+ u4Byte lut_5g_odd_b[9][16]; -+ u4Byte lut_5g_even_c[9][16]; -+ u4Byte lut_5g_odd_c[9][16]; -+ u4Byte lut_5g_even_d[9][16]; -+ u4Byte lut_5g_odd_d[9][16]; -+ u8 thermal_value_dpk; -+ u8 thermal_value_dpk_avg[AVG_THERMAL_NUM_DPK]; -+ u8 thermal_value_dpk_avg_index; -+#endif -+ s8 modify_tx_agc_value_ofdm; -+ s8 modify_tx_agc_value_cck; -+ -+ /*Add by Yuchen for Kfree Phydm*/ -+ u8 reg_rf_kfree_enable; /*for registry*/ -+ u8 rf_kfree_enable; /*for efuse enable check*/ -+ u32 tx_lok[2]; -+}; -+ -+void -+odm_txpowertracking_check_ap( -+ void *dm_void -+); -+ -+void -+odm_txpowertracking_check( -+ void *dm_void -+); -+ -+ -+void -+odm_txpowertracking_thermal_meter_init( -+ void *dm_void -+); -+ -+void -+odm_txpowertracking_init( -+ void *dm_void -+); -+ -+void -+odm_txpowertracking_check_mp( -+ void *dm_void -+); -+ -+ -+void -+odm_txpowertracking_check_ce( -+ void *dm_void -+); -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+void -+odm_txpowertracking_callback_thermal_meter92c( -+ void *adapter -+); -+ -+void -+odm_txpowertracking_callback_rx_gain_thermal_meter92d( -+ void *adapter -+); -+ -+void -+odm_txpowertracking_callback_thermal_meter92d( -+ void *adapter -+); -+ -+void -+odm_txpowertracking_direct_call92c( -+ void *adapter -+); -+ -+void -+odm_txpowertracking_thermal_meter_check( -+ void *adapter -+); -+ -+#endif -+ -+ -+ -+#endif /*#ifndef __HALRF_POWER_TRACKING_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ce.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ce.c -new file mode 100644 -index 000000000..4fd3de0ea ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ce.c -@@ -0,0 +1,969 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@=========================================================== -+ * include files -+ *============================================================ -+ */ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+/*@************************************************************ -+ * Global var -+ * ************************************************************ -+ */ -+ -+u32 ofdm_swing_table[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 cck_swing_table_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.0 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 cck_swing_table_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.0 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 ofdm_swing_table_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 cck_swing_table_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*/ -+}; -+ -+u8 cck_swing_table_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*/ -+}; -+ -+u8 cck_swing_table_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*/ -+}; -+ -+u8 cck_swing_table_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 cck_swing_table_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 cck_swing_table_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, -+}; -+ -+/*@JJ ADD 20161014 */ -+u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B] = { -+ 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, -+}; -+ -+/*@Winnita ADD 20171116 PathA 0xAB4[10:0],PathB 0xAB4[21:11]*/ -+u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F] = { -+ 0x0CD, /*0 , -20dB*/ -+ 0x0D9, -+ 0x0E6, -+ 0x0F3, -+ 0x102, -+ 0x111, -+ 0x121, -+ 0x132, -+ 0x144, -+ 0x158, -+ 0x16C, -+ 0x182, -+ 0x198, -+ 0x1B1, -+ 0x1CA, -+ 0x1E5, -+ 0x202, -+ 0x221, -+ 0x241, -+ 0x263, /*19*/ -+ 0x287, /*20*/ -+ 0x2AE, /*21*/ -+ 0x2D6, /*22*/ -+ 0x301, /*23*/ -+ 0x32F, /*24*/ -+ 0x35F, /*25*/ -+ 0x392, /*26*/ -+ 0x3C9, /*27*/ -+ 0x402, /*28*/ -+ 0x43F, /*29*/ -+ 0x47F, /*30*/ -+ 0x4C3, /*31*/ -+ 0x50C, /*32*/ -+ 0x558, /*33*/ -+ 0x5A9, /*34*/ -+ 0x5FF, /*35*/ -+ 0x65A, /*36*/ -+ 0x6BA, -+ 0x720, -+ 0x78C, -+ 0x7FF, -+}; -+ -+u32 tx_scaling_table_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 */ -+}; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -+#else -+u8 delta_swing_table_idx_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}; -+u8 delta_swing_table_idx_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}; -+#endif -+ -+void odm_txpowertracking_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_txpowertracking_thermal_meter_init(dm); -+} -+ -+u8 get_swing_index(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+#endif -+ u8 i = 0; -+ u32 bb_swing, table_value; -+ -+ if (dm->support_ic_type & -+ (ODM_RTL8188E | ODM_RTL8723B | ODM_RTL8192E | -+ ODM_RTL8188F | ODM_RTL8703B | ODM_RTL8723D | -+ ODM_RTL8710B)) { -+ -+ bb_swing = odm_get_bb_reg(dm, R_0xc80, 0xFFC00000); -+ -+ for (i = 0; i < OFDM_TABLE_SIZE; i++) { -+ table_value = ofdm_swing_table_new[i]; -+ -+ if (table_value >= 0x100000) -+ table_value >>= 22; -+ if (bb_swing == table_value) -+ break; -+ } -+ } else { -+#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+ bb_swing = -+ phy_get_tx_bb_swing_8812a(adapter, -+ hal_data->current_band_type, -+ RF_PATH_A); -+#else -+ bb_swing = odm_get_bb_reg(dm, R_0xc1c, 0xFFE00000); -+#endif -+ for (i = 0; i < TXSCALE_TABLE_SIZE; i++) { -+ table_value = tx_scaling_table_jaguar[i]; -+ -+ if (bb_swing == table_value) -+ break; -+ } -+ } -+ -+ return i; -+} -+ -+u8 get_cck_swing_index(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ u8 i = 0; -+ u32 bb_cck_swing; -+ -+ if (dm->support_ic_type & -+ (ODM_RTL8188E | ODM_RTL8723B | ODM_RTL8192E)) { -+ bb_cck_swing = odm_read_1byte(dm, 0xa22); -+ -+ for (i = 0; i < CCK_TABLE_SIZE; i++) { -+ if (bb_cck_swing == cck_swing_table_ch1_ch13_new[i][0]) -+ break; -+ } -+ } else if (dm->support_ic_type & ODM_RTL8703B) { -+ bb_cck_swing = odm_read_1byte(dm, 0xa22); -+ -+ for (i = 0; i < CCK_TABLE_SIZE_88F; i++) { -+ if (bb_cck_swing == cck_swing_table_ch1_ch14_88f[i][0]) -+ break; -+ } -+ } -+ -+ return i; -+} -+ -+s8 -+get_txagc_default_index( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ s8 tmp; -+ -+ if (dm->support_ic_type == ODM_RTL8814B) { -+ tmp = (s8)(odm_get_bb_reg(dm, R_0x18a0, 0x7f) & 0xff); -+ if (tmp & BIT(6)) -+ tmp = tmp | 0x80; -+ return tmp; -+ } else -+ return 0; -+} -+ -+void odm_txpowertracking_thermal_meter_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ -+ u8 swing_idx = get_swing_index(dm); -+ u8 cckswing_idx = get_cck_swing_index(dm); -+ u8 p = 0; -+ -+ cali_info->is_txpowertracking = true; -+ cali_info->tx_powercount = 0; -+ cali_info->is_txpowertracking_init = false; -+ -+ if (!(*dm->mp_mode)) -+ cali_info->txpowertrack_control = true; -+ else -+ cali_info->txpowertrack_control = false; -+ -+ if (!(*dm->mp_mode)) -+ cali_info->txpowertrack_control = true; -+ -+ RF_DBG(dm, DBG_RF_IQK, "dm txpowertrack_control = %d\n", -+ cali_info->txpowertrack_control); -+#if 0 -+ /* dm->rf_calibrate_info.txpowertrack_control = true; */ -+#endif -+ cali_info->thermal_value = rf->eeprom_thermal; -+ cali_info->thermal_value_iqk = rf->eeprom_thermal; -+ cali_info->thermal_value_lck = rf->eeprom_thermal; -+ -+#if (RTL8822C_SUPPORT == 1 || RTL8814B_SUPPORT == 1 || RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822C || -+ dm->support_ic_type == ODM_RTL8723F) { -+ cali_info->thermal_value_path[RF_PATH_A] = tssi->thermal[RF_PATH_A]; -+ cali_info->thermal_value_path[RF_PATH_B] = tssi->thermal[RF_PATH_B]; -+ cali_info->thermal_value_iqk = tssi->thermal[RF_PATH_A]; -+ cali_info->thermal_value_lck = tssi->thermal[RF_PATH_A]; -+ } -+ -+ if (dm->support_ic_type == ODM_RTL8814B) { -+ cali_info->thermal_value_path[RF_PATH_A] = tssi->thermal[RF_PATH_A]; -+ cali_info->thermal_value_path[RF_PATH_B] = tssi->thermal[RF_PATH_B]; -+ cali_info->thermal_value_path[RF_PATH_C] = tssi->thermal[RF_PATH_C]; -+ cali_info->thermal_value_path[RF_PATH_D] = tssi->thermal[RF_PATH_D]; -+ cali_info->thermal_value_iqk = tssi->thermal[RF_PATH_A]; -+ cali_info->thermal_value_lck = tssi->thermal[RF_PATH_A]; -+ } -+#endif -+ -+ if (!cali_info->default_bb_swing_index_flag) { -+ if (dm->support_ic_type & -+ (ODM_RTL8188E | ODM_RTL8723B | ODM_RTL8192E | -+ ODM_RTL8703B | ODM_RTL8821)) { -+ if (swing_idx >= OFDM_TABLE_SIZE) -+ cali_info->default_ofdm_index = 30; -+ else -+ cali_info->default_ofdm_index = swing_idx; -+ -+ if (cckswing_idx >= CCK_TABLE_SIZE) -+ cali_info->default_cck_index = 20; -+ else -+ cali_info->default_cck_index = cckswing_idx; -+ /*@add by Mingzhi.Guo 2015-03-23*/ -+ } else if (dm->support_ic_type == ODM_RTL8188F) { -+ cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ -+ cali_info->default_cck_index = 20; /*CCK:-6dB*/ -+ /*@add by zhaohe 2015-10-27*/ -+ } else if (dm->support_ic_type == ODM_RTL8723D) { -+ cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ -+ cali_info->default_cck_index = 28; /*CCK: -6dB*/ -+ /*@JJ ADD 20161014 */ -+ } else if (dm->support_ic_type == ODM_RTL8710B) { -+ cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ -+ cali_info->default_cck_index = 28; /*CCK: -6dB*/ -+ } else if (dm->support_ic_type == ODM_RTL8192F) { -+ cali_info->default_ofdm_index = 30;/*OFDM: 0dB*/ -+ cali_info->default_cck_index = 28; /*CCK: -6dB*/ -+ } else { -+ if (swing_idx >= TXSCALE_TABLE_SIZE) -+ cali_info->default_ofdm_index = 24; -+ else -+ cali_info->default_ofdm_index = swing_idx; -+ -+ cali_info->default_txagc_index = get_txagc_default_index(dm); -+ -+ cali_info->default_cck_index = 24; -+ } -+ cali_info->default_bb_swing_index_flag = true; -+ } -+ -+ cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; -+ cali_info->CCK_index = cali_info->default_cck_index; -+ -+ for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { -+ cali_info->bb_swing_idx_ofdm_base[p] = -+ cali_info->default_ofdm_index; -+ cali_info->OFDM_index[p] = cali_info->default_ofdm_index; -+ cali_info->delta_power_index[p] = 0; -+ cali_info->delta_power_index_last[p] = 0; -+ cali_info->power_index_offset[p] = 0; -+ } -+ cali_info->modify_tx_agc_value_ofdm = 0; -+ cali_info->modify_tx_agc_value_cck = 0; -+ cali_info->tm_trigger = 0; -+} -+ -+void odm_txpowertracking_check(void *dm_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. -+ */ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ switch (dm->support_platform) { -+ case ODM_WIN: -+ odm_txpowertracking_check_mp(dm); -+ break; -+ -+ case ODM_CE: -+ odm_txpowertracking_check_ce(dm); -+ break; -+ -+ case ODM_AP: -+ odm_txpowertracking_check_ap(dm); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+void odm_txpowertracking_check_ce(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) -+ return; -+#if (RTL8723F_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ /*RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "[RF][TSSI] Pwrtrack return!\n");*/ -+ return; -+ } -+#endif -+ -+ if ((rf->power_track_type & 0xf0) >> 4 != 0) { -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ /*halrf_tssi_cck(dm);*/ -+ /*halrf_thermal_cck(dm);*/ -+ return; -+ } -+ } -+ -+ if (!dm->rf_calibrate_info.tm_trigger) { -+ if (dm->support_ic_type & -+ (ODM_RTL8188E | ODM_RTL8188F | ODM_RTL8192E | -+ ODM_RTL8723B | ODM_RTL8812 | ODM_RTL8821 | -+ ODM_RTL8814A | ODM_RTL8703B | ODM_RTL8723D | -+ ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8710B | -+ ODM_RTL8192F)) -+ odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_NEW, -+ (BIT(17) | BIT(16)), 0x03); -+ else if (dm->support_ic_type & ODM_RTL8822C) { -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x00); -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x00); -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); -+ } else if (dm->support_ic_type & ODM_RTL8814B) { -+ odm_set_rf_reg(dm, RF_PATH_A, 0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_B, 0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_C, 0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_D, 0x42, BIT(17), 0x1); -+ } else -+ odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_OLD, -+ RFREGOFFSETMASK, 0x60); -+ -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814B) { -+ ODM_delay_us(300); -+ odm_txpowertracking_new_callback_thermal_meter(dm); -+ tssi->thermal_trigger = 1; -+ } -+#endif -+ dm->rf_calibrate_info.tm_trigger = 1; -+ return; -+ } -+ -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B)) { -+#if (RTL8822C_SUPPORT == 1 || RTL8814B_SUPPORT == 1) -+ odm_txpowertracking_new_callback_thermal_meter(dm); -+ if (dm->support_ic_type & ODM_RTL8814B) -+ tssi->thermal_trigger = 0; -+#endif -+ } else -+ odm_txpowertracking_callback_thermal_meter(dm); -+ dm->rf_calibrate_info.tm_trigger = 0; -+#endif -+} -+ -+void -+odm_txpowertracking_direct_ce(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+ if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) -+ return; -+ if (dm->support_ic_type & ODM_RTL8723F) { -+#if (RTL8723F_SUPPORT == 1) -+ /*RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "[RF]===>%s 8723F TSSI, return!\n", __func__);*/ -+ return; -+#endif -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ /*halrf_tssi_cck(dm);*/ -+ /*halrf_thermal_cck(dm);*/ -+ return; -+ } -+ -+ if (dm->support_ic_type & -+ (ODM_RTL8188E | ODM_RTL8188F | ODM_RTL8192E | -+ ODM_RTL8723B | ODM_RTL8812 | ODM_RTL8821 | -+ ODM_RTL8814A | ODM_RTL8703B | ODM_RTL8723D | -+ ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8710B | -+ ODM_RTL8192F | ODM_RTL8814B)) -+ odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_NEW, (BIT(17) | BIT(16)), 0x03); -+ else if (dm->support_ic_type & ODM_RTL8822C) { -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x00); -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x00); -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); -+ } else -+ odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_OLD, RFREGOFFSETMASK, 0x60); -+ -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B)) { -+#if (RTL8822C_SUPPORT == 1 || RTL8814B_SUPPORT == 1) -+ odm_txpowertracking_new_callback_thermal_meter(dm); -+#endif -+ } else -+ odm_txpowertracking_callback_thermal_meter(dm); -+#endif -+ -+} -+ -+ -+void odm_txpowertracking_check_mp(void *dm_void) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ -+ if (odm_check_power_status(adapter) == false) { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, -+ ("check_pow_status, return false\n")); -+ return; -+ } -+ -+ odm_txpowertracking_thermal_meter_check(adapter); -+#endif -+} -+ -+void odm_txpowertracking_check_ap(void *dm_void) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ return; -+ -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ce.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ce.h -new file mode 100644 -index 000000000..3fec1abf7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_ce.h -@@ -0,0 +1,331 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALRF_POWERTRACKING_H__ -+#define __HALRF_POWERTRACKING_H__ -+ -+#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 -+/*@JJ ADD 20161014 */ -+#define CCK_TABLE_SIZE_8710B 41 -+#define CCK_TABLE_SIZE_8192F 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 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 -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -+#else -+/* Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G */ -+#define IQK_MATRIX_SETTINGS_NUM (14 + 24 + 21) -+#endif -+ -+extern u32 ofdm_swing_table[OFDM_TABLE_SIZE]; -+extern u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8]; -+extern u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8]; -+ -+extern u32 ofdm_swing_table_new[OFDM_TABLE_SIZE]; -+extern u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8]; -+extern u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8]; -+extern u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16]; -+extern u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16]; -+extern u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16]; -+extern u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D]; -+/*@JJ ADD 20161014 */ -+extern u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B]; -+extern u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F]; -+ -+extern u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE]; -+ -+/*@<20121018, Kordan> In case fail to read TxPowerTrack.txt */ -+/* we use the table of 88E as the default table. */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -+#else -+extern u8 delta_swing_table_idx_2ga_p_8188e[]; -+extern u8 delta_swing_table_idx_2ga_n_8188e[]; -+#endif -+ -+#define dm_check_txpowertracking odm_txpowertracking_check -+ -+struct iqk_matrix_regs_setting { -+ boolean is_iqk_done; -+ s32 value[3][iqk_matrix_reg_num]; -+ boolean is_bw_iqk_result_saved[3]; -+}; -+ -+struct dm_rf_calibration_struct { -+ /* for tx power tracking */ -+ -+ u32 rega24; /* for TempCCK */ -+ s32 rege94; -+ s32 rege9c; -+ s32 regeb4; -+ s32 regebc; -+ -+ u8 tx_powercount; -+ boolean is_txpowertracking_init; -+ boolean is_txpowertracking; -+ /* for mp mode, turn off txpwrtracking as default */ -+ u8 txpowertrack_control; -+ u8 tm_trigger; -+ u8 internal_pa_5g[2]; /* pathA / pathB */ -+ -+ /* thermal_meter, index 0 for RFIC0, and 1 for RFIC1 */ -+ u8 thermal_meter[2]; -+ u8 thermal_value; -+ u8 thermal_value_path[MAX_RF_PATH]; -+ u8 thermal_value_lck; -+ u8 thermal_value_iqk; -+ s8 thermal_value_delta; /* delta of thermal_value and efuse thermal */ -+ u8 thermal_value_dpk; -+ u8 thermal_value_avg[AVG_THERMAL_NUM]; -+ u8 thermal_value_avg_path[MAX_RF_PATH][AVG_THERMAL_NUM]; -+ u8 thermal_value_avg_index; -+ u8 thermal_value_avg_index_path[MAX_RF_PATH]; -+ u8 thermal_value_rx_gain; -+ u8 thermal_value_crystal; -+ u8 thermal_value_dpk_store; -+ u8 thermal_value_dpk_track; -+ boolean txpowertracking_in_progress; -+ -+ boolean is_reloadtxpowerindex; -+ u8 is_rf_pi_enable; -+ u32 txpowertracking_callback_cnt; /* cosa add for debug */ -+ -+ /*@---------------------- Tx power Tracking ---------------------- */ -+ u8 is_cck_in_ch14; -+ u8 CCK_index; -+ u8 OFDM_index[MAX_RF_PATH]; -+ s8 power_index_offset[MAX_RF_PATH]; -+ s8 delta_power_index[MAX_RF_PATH]; -+ s8 delta_power_index_last[MAX_RF_PATH]; -+ boolean is_tx_power_changed; -+ s8 xtal_offset; -+ s8 xtal_offset_last; -+ u8 xtal_offset_eanble; -+ -+ struct iqk_matrix_regs_setting -+ iqk_matrix_reg_setting[IQK_MATRIX_SETTINGS_NUM]; -+ u8 delta_lck; -+ s8 bb_swing_diff_2g, bb_swing_diff_5g; /* Unit: dB */ -+ u8 delta_swing_table_idx_2g_cck_a_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_a_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_b_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_b_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_c_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_c_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_d_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_d_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gb_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gb_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gc_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gc_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gd_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gd_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5ga_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5ga_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gb_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gb_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gc_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gc_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gd_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gd_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_a[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_b[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_c[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_d[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2ga[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gb[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gc[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gd[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5ga[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gb[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gc[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gd[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ s8 delta_swing_table_xtal_p[DELTA_SWINGIDX_SIZE]; -+ s8 delta_swing_table_xtal_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_p_8188e[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_n_8188e[DELTA_SWINGIDX_SIZE]; -+ -+ u8 bb_swing_idx_ofdm[MAX_RF_PATH]; -+ u8 bb_swing_idx_ofdm_current; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ u8 bb_swing_idx_ofdm_base[MAX_RF_PATH]; -+#else -+ u8 bb_swing_idx_ofdm_base; -+#endif -+ boolean default_bb_swing_index_flag; -+ boolean bb_swing_flag_ofdm; -+ u8 bb_swing_idx_cck; -+ u8 bb_swing_idx_cck_current; -+ u8 bb_swing_idx_cck_base; -+ u8 default_ofdm_index; -+ u8 default_cck_index; -+ s8 default_txagc_index; -+ boolean bb_swing_flag_cck; -+ -+ s8 absolute_ofdm_swing_idx[MAX_RF_PATH]; -+ s8 remnant_ofdm_swing_idx[MAX_RF_PATH]; -+ s8 absolute_cck_swing_idx[MAX_RF_PATH]; -+ s8 remnant_cck_swing_idx; -+ s8 modify_tx_agc_value; /*Remnat compensate value at tx_agc */ -+ boolean modify_tx_agc_flag_path_a; -+ boolean modify_tx_agc_flag_path_b; -+ boolean modify_tx_agc_flag_path_c; -+ boolean modify_tx_agc_flag_path_d; -+ boolean modify_tx_agc_flag_path_a_cck; -+ boolean modify_tx_agc_flag_path_b_cck; -+ -+ s8 kfree_offset[MAX_RF_PATH]; -+ -+ /*@----------------------------------------------------------------- */ -+ -+ /* for IQK */ -+ u32 regc04; -+ u32 reg874; -+ u32 regc08; -+ u32 regb68; -+ u32 regb6c; -+ u32 reg870; -+ u32 reg860; -+ u32 reg864; -+ -+ boolean is_iqk_initialized; -+ boolean is_lck_in_progress; -+ boolean is_antenna_detected; -+ boolean is_need_iqk; -+ boolean is_iqk_in_progress; -+ boolean is_iqk_pa_off; -+ u8 delta_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]; -+ /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u32 tx_iqc_8723b[2][3][2]; -+ /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ u32 rx_iqc_8723b[2][2][2]; -+ /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u32 tx_iqc_8703b[3][2]; -+ /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ u32 rx_iqc_8703b[2][2]; -+ /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u32 tx_iqc_8723d[2][3][2]; -+ /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ u32 rx_iqc_8723d[2][2][2]; -+ /* JJ ADD 20161014 */ -+ /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u32 tx_iqc_8710b[2][3][2]; -+ /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ u32 rx_iqc_8710b[2][2][2]; -+ -+ u8 iqk_step; -+ u8 kcount; -+ u8 retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ -+ boolean is_mp_mode; -+ -+ /*@ IQK time measurement */ -+ u64 iqk_start_time; -+ u64 iqk_progressing_time; -+ u64 iqk_total_progressing_time; -+ u64 lck_progressing_time; -+ -+ u32 lok_result; -+ -+ /* for APK */ -+ u32 ap_koutput[2][2]; /* path A/B; output1_1a/output1_2a */ -+ u8 is_ap_kdone; -+ u8 is_apk_thermal_meter_ignore; -+ -+ /* DPK */ -+ boolean is_dpk_fail; -+ u8 is_dp_done; -+ u8 is_dp_path_aok; -+ u8 is_dp_path_bok; -+ -+ u32 tx_lok[2]; -+ u32 dpk_tx_agc; -+ s32 dpk_gain; -+ u32 dpk_thermal[4]; -+ s8 modify_tx_agc_value_ofdm; -+ s8 modify_tx_agc_value_cck; -+ -+ /*@Add by Yuchen for Kfree Phydm*/ -+ u8 reg_rf_kfree_enable; /*for registry*/ -+ u8 rf_kfree_enable; /*for efuse enable check*/ -+}; -+ -+void odm_txpowertracking_check(void *dm_void); -+ -+void odm_txpowertracking_init(void *dm_void); -+ -+void odm_txpowertracking_check_ap(void *dm_void); -+ -+void odm_txpowertracking_thermal_meter_init(void *dm_void); -+ -+void odm_txpowertracking_init(void *dm_void); -+ -+void odm_txpowertracking_check_mp(void *dm_void); -+ -+void odm_txpowertracking_check_ce(void *dm_void); -+ -+void odm_txpowertracking_direct_ce(void *dm_void); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+void odm_txpowertracking_callback_thermal_meter92c( -+ void *adapter); -+ -+void odm_txpowertracking_callback_rx_gain_thermal_meter92d( -+ void *adapter); -+ -+void odm_txpowertracking_callback_thermal_meter92d( -+ void *adapter); -+ -+void odm_txpowertracking_direct_call92c( -+ void *adapter); -+ -+void odm_txpowertracking_thermal_meter_check( -+ void *adapter); -+ -+#endif -+ -+#endif /*__HALRF_POWER_TRACKING_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_iot.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_iot.c -new file mode 100644 -index 000000000..494fdec37 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_iot.c -@@ -0,0 +1,1004 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*============================================================ */ -+/* include files */ -+/*============================================================ */ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+/* ************************************************************ -+ * Global var -+ * ************************************************************ -+ */ -+ -+const u32 ofdm_swing_table[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*/ -+}; -+ -+const u8 cck_swing_table_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*/ -+}; -+ -+const u8 cck_swing_table_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*/ -+}; -+ -+const u32 ofdm_swing_table_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*/ -+}; -+ -+const u8 cck_swing_table_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*/ -+}; -+ -+const u8 cck_swing_table_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*/ -+}; -+ -+const u8 cck_swing_table_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*/ -+}; -+ -+const u8 cck_swing_table_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*/ -+}; -+ -+const u8 cck_swing_table_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 */ -+}; -+ -+const u32 cck_swing_table_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, -+}; -+ -+/* JJ ADD 20161014 */ -+const u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B] = { -+ 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, -+}; -+ -+/* Winnita ADD 20171116 PathA 0xAB4[10:0],PathB 0xAB4[21:11]*/ -+const u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F] = { -+ 0x0CD, /*0 , -20dB*/ -+ 0x0D9, -+ 0x0E6, -+ 0x0F3, -+ 0x102, -+ 0x111, -+ 0x121, -+ 0x132, -+ 0x144, -+ 0x158, -+ 0x16C, -+ 0x182, -+ 0x198, -+ 0x1B1, -+ 0x1CA, -+ 0x1E5, -+ 0x202, -+ 0x221, -+ 0x241, -+ 0x263, /*19*/ -+ 0x287, /*20*/ -+ 0x2AE, /*21*/ -+ 0x2D6, /*22*/ -+ 0x301, /*23*/ -+ 0x32F, /*24*/ -+ 0x35F, /*25*/ -+ 0x392, /*26*/ -+ 0x3C9, /*27*/ -+ 0x402, /*28*/ -+ 0x43F, /*29*/ -+ 0x47F, /*30*/ -+ 0x4C3, /*31*/ -+ 0x50C, /*32*/ -+ 0x558, /*33*/ -+ 0x5A9, /*34*/ -+ 0x5FF, /*35*/ -+ 0x65A, /*36*/ -+ 0x6BA, -+ 0x720, -+ 0x78C, -+ 0x7FF, -+}; -+ -+/* Winnita ADD 201805 PathA 0xAB4[10:0]*/ -+const u32 cck_swing_table_ch1_ch14_8721d[CCK_TABLE_SIZE_8721D] = { -+ 0x0CD, /*0 , -20dB*/ -+ 0x0D9, -+ 0x0E6, -+ 0x0F3, -+ 0x102, -+ 0x111, -+ 0x121, -+ 0x132, -+ 0x144, -+ 0x158, -+ 0x16C, -+ 0x182, -+ 0x198, -+ 0x1B1, -+ 0x1CA, -+ 0x1E5, -+ 0x202, -+ 0x221, -+ 0x241, -+ 0x263, /*19*/ -+ 0x287, /*20*/ -+ 0x2AE, /*21*/ -+ 0x2D6, /*22*/ -+ 0x301, /*23*/ -+ 0x32F, /*24*/ -+ 0x35F, /*25*/ -+ 0x392, /*26*/ -+ 0x3C9, /*27*/ -+ 0x402, /*28*/ -+ 0x43F, /*29*/ -+ 0x47F, /*30*/ -+ 0x4C3, /*31*/ -+ 0x50C, /*32*/ -+ 0x558, /*33*/ -+ 0x5A9, /*34*/ -+ 0x5FF, /*35*/ -+ 0x65A, /*36*/ -+ 0x6BA, -+ 0x720, -+ 0x78C, -+ 0x7FF, -+}; -+ -+const u32 cck_swing_table_ch1_ch14_8710c[CCK_TABLE_SIZE_8710C] = { -+ 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, -+}; -+ -+const u32 cck_swing_table_03db_ch1_ch14_8710c[CCK_03DB_TABLE_SIZE_8710C] = { -+ 0x143, /*0 , -4dB*/ -+ 0x14C, /*1 , -3.75dB*/ -+ 0x156, /*2 , -3.5dB*/ -+ 0x160, -+ 0x16A, -+ 0x175, -+ 0x17F, -+ 0x18B, -+ 0x196, -+ 0x1A2, -+ 0x1AE, -+ 0x1BB, -+ 0x1C8, -+ 0x1D5, -+ 0x1E3, -+ 0x1F1, -+ 0x200, -+ 0x20F, -+ 0x21E, -+ 0x22F, -+ 0x23F, -+ 0x250, -+ 0x261, -+ 0x273, -+ 0x285, -+ 0x298, -+ 0x2AB, -+ 0x2BF, -+ 0x2D6, -+ 0x2E9, -+ 0x2FF, -+ 0x315, -+ 0x32C, -+ 0x344, -+ 0x35C, -+ 0x375, -+ 0x390, -+ 0x3AA, -+ 0x3C5, -+ 0x3E1, -+ 0x402, /*40 , +6dB default*/ -+ 0x41C, -+ 0x43B, -+ 0x45A, -+ 0x47C, -+ 0x49C, -+ 0x4BF, -+ 0x4E2, -+ 0x510, -+ 0x52C, -+ 0x553, -+ 0x57B, -+ 0x5A5, -+ 0x5CE, -+ 0x5F9, -+ 0x626, -+ 0x655, -+ 0x683, -+ 0x6B5, -+ 0x6E6, -+ 0x71E, -+ 0x74E, -+ 0x786, -+ 0x7BD, -+ 0x7F9, -+ 0x832, -+ 0x871, -+ 0x8AF, -+ 0x8F2, -+ 0x932, -+ 0x977, -+ 0x9BE, -+ 0xA0E, -+ 0xA52, -+ 0xAA1, -+ 0xAEE, -+ 0xB54, -+ 0xB95, -+ 0xBEB, -+ 0xC43, -+ 0xCA3 /*80 , +16dB*/ -+}; -+ -+const u32 ofdm_swing_table_03DB_8710c[OFDM_03DB_TABLE_SIZE_8710C] = { -+ 0xE4, /*0 , -7dB*/ -+ 0xEB, /*1 , -6.75dB*/ -+ 0xF2, /*2 , -6.5dB*/ -+ 0xF9, -+ 0x100, -+ 0x108, -+ 0x110, -+ 0x118, -+ 0x11F, -+ 0x128, -+ 0x131, -+ 0x13A, -+ 0x143, -+ 0x14C, -+ 0x156, -+ 0x160, -+ 0x16A, -+ 0x175, -+ 0x180, -+ 0x18B, -+ 0x196, -+ 0x1A2, -+ 0x1AE, -+ 0x1BB, -+ 0x1C8, -+ 0x1D5, -+ 0x1E3, -+ 0x1F1, -+ 0x200, -+ 0x20F, -+ 0x21F, -+ 0x22F, -+ 0x23F, -+ 0x250, -+ 0x261, -+ 0x273, -+ 0x286, -+ 0x298, -+ 0x2AB, -+ 0x2BF, -+ 0x2D6, /*40 , +3dB default*/ -+ 0x2E9, -+ 0x2FF, -+ 0x315, -+ 0x32C, -+ 0x344, -+ 0x35C, -+ 0x375, -+ 0x390, -+ 0x3AA, -+ 0x3C5, -+ 0x3E1, -+ 0x3FF, -+ 0x41C, -+ 0x43B, -+ 0x45A, -+ 0x47B, -+ 0x49C, -+ 0x4BF, -+ 0x4E2, -+ 0x507, -+ 0x52C, -+ 0x553, -+ 0x57B, -+ 0x5A4, -+ 0x5CE, -+ 0x5F9, -+ 0x626, -+ 0x654, -+ 0x683, -+ 0x6B4, -+ 0x6E6, -+ 0x71B, -+ 0x74E, -+ 0x785, -+ 0x7BD, -+ 0x7F7, -+ 0x832, -+ 0x870, -+ 0x8AF, -+ 0x8F0 /*80 , +13dB*/ -+}; -+ -+ -+ -+const u32 tx_scaling_table_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 */ -+}; -+ -+void -+odm_txpowertracking_init( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_txpowertracking_thermal_meter_init(dm); -+} -+ -+u8 -+get_swing_index( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ u8 i = 0; -+ u32 bb_swing; -+ u32 swing_table_size; -+ u32 *swing_table; -+ u32 table_value; -+ -+#if (RTL8710C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8710C) { -+ bb_swing = odm_get_bb_reg(dm, R_0xcc8, 0x000007ff); -+ -+ for (i = 0; i < OFDM_03DB_TABLE_SIZE_8710C; i++) { -+ if (bb_swing == ofdm_swing_table_03DB_8710c[i]) -+ break; -+ } -+ } -+#elif (RTL8195B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195B) { -+ bb_swing = odm_get_bb_reg(dm, R_0xc1c, 0xFFE00000); -+ swing_table = (u32*)tx_scaling_table_jaguar; -+ swing_table_size = TXSCALE_TABLE_SIZE; -+ -+ for (i = 0; i < swing_table_size; i++) { -+ table_value = swing_table[i]; -+ -+ table_value = table_value; -+ if (bb_swing == table_value) -+ break; -+ } -+ } -+#endif -+ return i; -+} -+ -+u8 -+get_cck_swing_index( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ u8 i = 0; -+ u32 bb_cck_swing; -+ -+#if (RTL8188E_SUPPORT == 1 || RTL8723B_SUPPORT == 1 || RTL8192E_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8723B || -+ dm->support_ic_type == ODM_RTL8192E) { -+ bb_cck_swing = odm_read_1byte(dm, 0xa22); -+ -+ for (i = 0; i < CCK_TABLE_SIZE; i++) { -+ if (bb_cck_swing == cck_swing_table_ch1_ch13_new[i][0]) -+ break; -+ } -+ } -+#elif (RTL8703B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8703B) { -+ bb_cck_swing = odm_read_1byte(dm, 0xa22); -+ -+ for (i = 0; i < CCK_TABLE_SIZE_88F; i++) { -+ if (bb_cck_swing == cck_swing_table_ch1_ch14_88f[i][0]) -+ break; -+ } -+ } -+#elif (RTL8710C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8710C) { -+ bb_cck_swing = odm_get_bb_reg(dm, R_0xab4, 0x7ff); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "bb_cck_swing = 0x%x\n", bb_cck_swing); -+ -+ for (i = 0; i < CCK_03DB_TABLE_SIZE_8710C; i++) { -+ if (bb_cck_swing == cck_swing_table_03db_ch1_ch14_8710c[i]) -+ break; -+ } -+ } -+#endif -+ -+ return i; -+} -+ -+s8 -+get_txagc_default_index( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ s8 tmp; -+ -+ if (dm->support_ic_type == ODM_RTL8814B) { -+ tmp = (s8)(odm_get_bb_reg(dm, R_0x18a0, 0x7f) & 0xff); -+ if (tmp & BIT(6)) -+ tmp = tmp | 0x80; -+ return tmp; -+ } else -+ return 0; -+} -+ -+void -+odm_txpowertracking_thermal_meter_init( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 default_swing_index; -+ u8 p = 0; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (!(*dm->mp_mode)) -+ cali_info->txpowertrack_control = true; -+ else -+ cali_info->txpowertrack_control = false; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "dm txpowertrack_control = %d\n", cali_info->txpowertrack_control); -+ -+ /* dm->rf_calibrate_info.txpowertrack_control = true; */ -+ cali_info->thermal_value = rf->eeprom_thermal; -+ cali_info->thermal_value_iqk = rf->eeprom_thermal; -+ cali_info->thermal_value_lck = rf->eeprom_thermal; -+ -+ if (!cali_info->default_bb_swing_index_flag) { -+ if (dm->support_ic_type == ODM_RTL8195B) { -+ default_swing_index = get_swing_index(dm); -+ cali_info->default_ofdm_index = (default_swing_index >= TXSCALE_TABLE_SIZE) ? 24 : default_swing_index; -+ cali_info->default_cck_index = 24; -+ } else if (dm->support_ic_type == ODM_RTL8721D) { -+ cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ -+ cali_info->default_cck_index = 28; /*CCK: -6dB*/ -+ } else if (dm->support_ic_type == ODM_RTL8710C) { -+ cali_info->default_ofdm_index = get_swing_index(dm); -+ cali_info->default_cck_index = get_cck_swing_index(dm); -+ } -+ cali_info->default_bb_swing_index_flag = true; -+ } -+ -+ cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; -+ cali_info->CCK_index = cali_info->default_cck_index; -+ -+ for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { -+ cali_info->bb_swing_idx_ofdm_base[p] = cali_info->default_ofdm_index; -+ cali_info->OFDM_index[p] = cali_info->default_ofdm_index; -+ cali_info->delta_power_index[p] = 0; -+ cali_info->delta_power_index_last[p] = 0; -+ cali_info->power_index_offset[p] = 0; -+ } -+ cali_info->modify_tx_agc_value_ofdm = 0; -+ cali_info->modify_tx_agc_value_cck = 0; -+ cali_info->tm_trigger = 0; -+} -+ -+void -+odm_txpowertracking_check( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_txpowertracking_check_iot(dm); -+} -+ -+void -+odm_txpowertracking_check_iot( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) -+ return; -+ -+ if (!dm->rf_calibrate_info.tm_trigger) { -+ if (dm->support_ic_type == ODM_RTL8195B) -+ odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_NEW, (BIT(17) | BIT(16)), 0x03); -+ else if (dm->support_ic_type == ODM_RTL8721D || -+ dm->support_ic_type == ODM_RTL8710C) -+ odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_NEW, -+ (BIT(12) | BIT(11)), 0x03); -+ -+ dm->rf_calibrate_info.tm_trigger = 1; -+ return; -+ } -+ odm_txpowertracking_callback_thermal_meter(dm); -+ dm->rf_calibrate_info.tm_trigger = 0; -+} -+ -+void -+odm_txpowertracking_check_mp( -+ void *dm_void -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ -+ if (odm_check_power_status(adapter) == false) { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("check_pow_status, return false\n")); -+ return; -+ } -+ -+ odm_txpowertracking_thermal_meter_check(adapter); -+#endif -+} -+ -+void -+odm_txpowertracking_check_ap( -+ void *dm_void -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ return; -+ -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_iot.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_iot.h -new file mode 100644 -index 000000000..082e248c2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_iot.h -@@ -0,0 +1,374 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALRF_POWERTRACKING_H__ -+#define __HALRF_POWERTRACKING_H__ -+ -+#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 -+/* JJ ADD 20161014 */ -+#define CCK_TABLE_SIZE_8710B 41 -+#define CCK_TABLE_SIZE_8192F 41 -+#define CCK_TABLE_SIZE_8721D 41 -+#define CCK_TABLE_SIZE_8710C 41 -+#define CCK_03DB_TABLE_SIZE_8710C 81 -+#define OFDM_03DB_TABLE_SIZE_8710C 81 -+ -+ -+#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 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 -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -+#else -+#define IQK_MATRIX_SETTINGS_NUM (14+24+21) /* Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G */ -+#endif -+ -+extern const u32 ofdm_swing_table[OFDM_TABLE_SIZE]; -+extern const u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8]; -+extern const u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8]; -+ -+extern const u32 ofdm_swing_table_new[OFDM_TABLE_SIZE]; -+extern const u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8]; -+extern const u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8]; -+extern const u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16]; -+extern const u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16]; -+extern const u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16]; -+extern const u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D]; -+/* JJ ADD 20161014 */ -+extern const u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B]; -+extern const u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F]; -+extern const u32 cck_swing_table_ch1_ch14_8721d[CCK_TABLE_SIZE_8721D]; -+extern const u32 cck_swing_table_ch1_ch14_8710c[CCK_TABLE_SIZE_8710C]; -+extern const u32 cck_swing_table_03db_ch1_ch14_8710c[CCK_03DB_TABLE_SIZE_8710C]; -+extern const u32 ofdm_swing_table_03DB_8710c[OFDM_03DB_TABLE_SIZE_8710C]; -+ -+extern const u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE]; -+ -+/* <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -+#else -+static u8 delta_swing_table_idx_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 u8 delta_swing_table_idx_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}; -+#endif -+ -+void -+odm_txpowertracking_init( -+ void *dm_void -+); -+ -+#define dm_check_txpowertracking odm_txpowertracking_check -+ -+struct iqk_matrix_regs_setting { -+ boolean is_iqk_done; -+ s32 value[1][iqk_matrix_reg_num]; -+ boolean is_bw_iqk_result_saved[3]; -+}; -+ -+struct dm_rf_calibration_struct { -+ /* for tx power tracking */ -+ -+ u32 rega24; /* for TempCCK */ -+ s32 rege94; -+ s32 rege9c; -+ s32 regeb4; -+ s32 regebc; -+ -+ u8 tx_powercount; -+ boolean is_txpowertracking_init; -+ boolean is_txpowertracking; -+ u8 txpowertrack_control; /* for mp mode, turn off txpwrtracking as default */ -+ u8 tm_trigger; -+ u8 internal_pa_5g[2]; /* pathA / pathB */ -+ -+ u8 thermal_meter[2]; /* thermal_meter, index 0 for RFIC0, and 1 for RFIC1 */ -+ u8 thermal_value; -+ u8 thermal_value_lck; -+ u8 thermal_value_iqk; -+ s8 thermal_value_delta; /* delta of thermal_value and efuse thermal */ -+ u8 thermal_value_dpk; -+ u8 thermal_value_avg[AVG_THERMAL_NUM]; -+ u8 thermal_value_avg_index; -+ u8 thermal_value_rx_gain; -+ u8 thermal_value_crystal; -+ u8 thermal_value_dpk_store; -+ u8 thermal_value_dpk_track; -+ boolean txpowertracking_in_progress; -+ -+ boolean is_reloadtxpowerindex; -+ u8 is_rf_pi_enable; -+ u32 txpowertracking_callback_cnt; /* cosa add for debug */ -+ -+ -+ /* ------------------------- Tx power Tracking ------------------------- */ -+ u8 is_cck_in_ch14; -+ u8 CCK_index; -+ u8 OFDM_index[MAX_RF_PATH]; -+ s8 power_index_offset[MAX_RF_PATH]; -+ s8 delta_power_index[MAX_RF_PATH]; -+ s8 delta_power_index_last[MAX_RF_PATH]; -+ boolean is_tx_power_changed; -+ s8 xtal_offset; -+ s8 xtal_offset_last; -+ -+#if (RTL8710B_SUPPORT == 1) -+ struct iqk_matrix_regs_setting iqk_matrix_reg_setting[IQK_MATRIX_SETTINGS_NUM]; -+#elif (RTL8721D_SUPPORT == 1) -+ struct iqk_matrix_regs_setting iqk_matrix_reg_setting[1]; -+#endif -+ u8 delta_lck; -+ s8 bb_swing_diff_2g, bb_swing_diff_5g; /* Unit: dB */ -+ u8 delta_swing_table_idx_2g_cck_a_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_a_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_b_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_b_n[DELTA_SWINGIDX_SIZE]; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ u8 delta_swing_table_idx_2g_cck_c_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_c_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_d_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_d_n[DELTA_SWINGIDX_SIZE]; -+#endif -+ u8 delta_swing_table_idx_2ga_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gb_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gb_n[DELTA_SWINGIDX_SIZE]; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ u8 delta_swing_table_idx_2gc_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gc_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gd_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gd_n[DELTA_SWINGIDX_SIZE]; -+#endif -+ -+#if (RTL8195B_SUPPORT == 1 || RTL8721D_SUPPORT == 1) -+ u8 delta_swing_table_idx_5ga_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5ga_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gb_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gb_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ u8 delta_swing_table_idx_5gc_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gc_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gd_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gd_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+#endif -+#if !(DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ u8 delta_swing_tssi_table_2g_cck_a[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_b[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_c[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_d[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2ga[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gb[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gc[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gd[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5ga[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gb[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gc[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gd[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+#endif -+ s8 delta_swing_table_xtal_p[DELTA_SWINGIDX_SIZE]; -+ s8 delta_swing_table_xtal_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_p_8188e[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_n_8188e[DELTA_SWINGIDX_SIZE]; -+ -+ u8 bb_swing_idx_ofdm[MAX_RF_PATH]; -+ u8 bb_swing_idx_ofdm_current; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) -+ u8 bb_swing_idx_ofdm_base[MAX_RF_PATH]; -+#else -+ u8 bb_swing_idx_ofdm_base; -+#endif -+ boolean default_bb_swing_index_flag; -+ boolean bb_swing_flag_ofdm; -+ u8 bb_swing_idx_cck; -+ u8 bb_swing_idx_cck_current; -+ u8 bb_swing_idx_cck_base; -+ u8 default_ofdm_index; -+ u8 default_cck_index; -+ s8 default_txagc_index; -+ boolean bb_swing_flag_cck; -+ -+ s8 absolute_ofdm_swing_idx[MAX_RF_PATH]; -+ s8 remnant_ofdm_swing_idx[MAX_RF_PATH]; -+ s8 absolute_cck_swing_idx[MAX_RF_PATH]; -+ s8 remnant_cck_swing_idx; -+ s8 modify_tx_agc_value; /*Remnat compensate value at tx_agc */ -+ boolean modify_tx_agc_flag_path_a; -+ boolean modify_tx_agc_flag_path_b; -+ boolean modify_tx_agc_flag_path_c; -+ boolean modify_tx_agc_flag_path_d; -+ boolean modify_tx_agc_flag_path_a_cck; -+ boolean modify_tx_agc_flag_path_b_cck; -+ -+ s8 kfree_offset[MAX_RF_PATH]; -+ -+ /* -------------------------------------------------------------------- */ -+ -+ /* for IQK */ -+ u32 regc04; -+ u32 reg874; -+ u32 regc08; -+ u32 regb68; -+ u32 regb6c; -+ u32 reg870; -+ u32 reg860; -+ u32 reg864; -+ -+ boolean is_iqk_initialized; -+ boolean is_lck_in_progress; -+ boolean is_antenna_detected; -+ boolean is_need_iqk; -+ boolean is_iqk_in_progress; -+ boolean is_iqk_pa_off; -+ u8 delta_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]; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ u32 tx_iqc_8723b[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u32 rx_iqc_8723b[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ u32 tx_iqc_8703b[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u32 rx_iqc_8703b[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ u32 tx_iqc_8723d[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u32 rx_iqc_8723d[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+#endif -+ /* JJ ADD 20161014 */ -+ u32 tx_iqc_8710b[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u32 rx_iqc_8710b[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ -+ u8 iqk_step; -+ u8 kcount; -+ u8 retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ -+ boolean is_mp_mode; -+ -+ -+ -+ /* IQK time measurement */ -+ u32 iqk_start_time; -+ u32 iqk_progressing_time; -+ u32 iqk_total_progressing_time; -+ u32 lck_progressing_time; -+ -+ u32 lok_result; -+ -+ /* for APK */ -+ u32 ap_koutput[2][2]; /* path A/B; output1_1a/output1_2a */ -+ u8 is_ap_kdone; -+ u8 is_apk_thermal_meter_ignore; -+ -+ /* DPK */ -+ boolean is_dpk_fail; -+ u8 is_dp_done; -+ u8 is_dp_path_aok; -+ u8 is_dp_path_bok; -+ -+ u32 tx_lok[2]; -+ u32 dpk_tx_agc; -+ s32 dpk_gain; -+ u32 dpk_thermal[4]; -+ s8 modify_tx_agc_value_ofdm; -+ s8 modify_tx_agc_value_cck; -+ -+ /*Add by Yuchen for Kfree Phydm*/ -+ u8 reg_rf_kfree_enable; /*for registry*/ -+ u8 rf_kfree_enable; /*for efuse enable check*/ -+ -+}; -+ -+ -+void -+odm_txpowertracking_check( -+ void *dm_void -+); -+ -+void -+odm_txpowertracking_check_ap( -+ void *dm_void -+); -+ -+void -+odm_txpowertracking_thermal_meter_init( -+ void *dm_void -+); -+ -+ -+void -+odm_txpowertracking_check_mp( -+ void *dm_void -+); -+ -+ -+void -+odm_txpowertracking_check_iot( -+ void *dm_void -+); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+void -+odm_txpowertracking_callback_thermal_meter92c( -+ void *adapter -+); -+ -+void -+odm_txpowertracking_callback_rx_gain_thermal_meter92d( -+ void *adapter -+); -+ -+void -+odm_txpowertracking_callback_thermal_meter92d( -+ void *adapter -+); -+ -+void -+odm_txpowertracking_direct_call92c( -+ void *adapter -+); -+ -+void -+odm_txpowertracking_thermal_meter_check( -+ void *adapter -+); -+ -+#endif -+ -+#endif /*#ifndef __HALRF_POWER_TRACKING_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_win.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_win.c -new file mode 100644 -index 000000000..90d2a913e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_win.c -@@ -0,0 +1,936 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+/* ************************************************************ -+ * Global var -+ * ************************************************************ */ -+ -+u32 ofdm_swing_table[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 cck_swing_table_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 cck_swing_table_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 ofdm_swing_table_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 cck_swing_table_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*/ -+}; -+ -+ -+u8 cck_swing_table_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*/ -+}; -+ -+ -+u8 cck_swing_table_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*/ -+}; -+ -+ -+u8 cck_swing_table_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 cck_swing_table_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 cck_swing_table_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, -+}; -+/* JJ ADD 20161014 */ -+u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B] = { -+ 0x0CD, /*0 , -20dB*/ -+ 0x0D9, -+ 0x0E6, -+ 0x0F3, -+ 0x102, -+ 0x111, -+ 0x121, -+ 0x132, -+ 0x144, -+ 0x158, -+ 0x16C, -+ 0x182, -+ 0x198, -+ 0x1B1, -+ 0x1CA, -+ 0x1E5, -+ 0x202, -+ 0x221, -+ 0x241, -+ 0x263, /*19*/ -+ 0x287, /*20*/ -+ 0x2AE, /*21*/ -+ 0x2D6, /*22*/ -+ 0x301, /*23*/ -+ 0x32F, /*24*/ -+ 0x35F, /*25*/ -+ 0x392, /*26*/ -+ 0x3C9, /*27*/ -+ 0x402, /*28*/ -+ 0x43F, /*29*/ -+ 0x47F, /*30*/ -+ 0x4C3, /*31*/ -+ 0x50C, /*32*/ -+ 0x558, /*33*/ -+ 0x5A9, /*34*/ -+ 0x5FF, /*35*/ -+ 0x65A, /*36*/ -+ 0x6BA, -+ 0x720, -+ 0x78C, -+ 0x7FF, -+}; -+ -+/* Winnita ADD 20170828 PathA 0xAB4[10:0],PathB 0xAB4[21:11]*/ -+u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F] = { -+ 0x0CD, /*0 , -20dB*/ -+ 0x0D9, -+ 0x0E6, -+ 0x0F3, -+ 0x102, -+ 0x111, -+ 0x121, -+ 0x132, -+ 0x144, -+ 0x158, -+ 0x16C, -+ 0x182, -+ 0x198, -+ 0x1B1, -+ 0x1CA, -+ 0x1E5, -+ 0x202, -+ 0x221, -+ 0x241, -+ 0x263, /*19*/ -+ 0x287, /*20*/ -+ 0x2AE, /*21*/ -+ 0x2D6, /*22*/ -+ 0x301, /*23*/ -+ 0x32F, /*24*/ -+ 0x35F, /*25*/ -+ 0x392, /*26*/ -+ 0x3C9, /*27*/ -+ 0x402, /*28*/ -+ 0x43F, /*29*/ -+ 0x47F, /*30*/ -+ 0x4C3, /*31*/ -+ 0x50C, /*32*/ -+ 0x558, /*33*/ -+ 0x5A9, /*34*/ -+ 0x5FF, /*35*/ -+ 0x65A, /*36*/ -+ 0x6BA, -+ 0x720, -+ 0x78C, -+ 0x7FF, -+}; -+ -+u32 tx_scaling_table_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 */ -+}; -+ -+void -+odm_txpowertracking_init( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if (!(dm->support_ic_type & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) -+ return; -+#endif -+ -+ odm_txpowertracking_thermal_meter_init(dm); -+} -+ -+u8 -+get_swing_index( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ u8 i = 0; -+ u32 bb_swing, table_value; -+ -+ if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8723B || -+ dm->support_ic_type == ODM_RTL8192E || dm->support_ic_type == ODM_RTL8188F || -+ dm->support_ic_type == ODM_RTL8703B || dm->support_ic_type == ODM_RTL8723D || -+ dm->support_ic_type == ODM_RTL8192F || dm->support_ic_type == ODM_RTL8710B) { -+ bb_swing = odm_get_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0xFFC00000); -+ -+ for (i = 0; i < OFDM_TABLE_SIZE; i++) { -+ table_value = ofdm_swing_table_new[i]; -+ -+ if (table_value >= 0x100000) -+ table_value >>= 22; -+ if (bb_swing == table_value) -+ break; -+ } -+ } else { -+ bb_swing = PHY_GetTxBBSwing_8812A(adapter, hal_data->CurrentBandType, RF_PATH_A); -+ -+ for (i = 0; i < TXSCALE_TABLE_SIZE; i++) { -+ table_value = tx_scaling_table_jaguar[i]; -+ -+ if (bb_swing == table_value) -+ break; -+ } -+ } -+ -+ return i; -+} -+ -+u8 -+get_cck_swing_index( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ u8 i = 0; -+ u32 bb_cck_swing; -+ -+ if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8723B || -+ dm->support_ic_type == ODM_RTL8192E) { -+ bb_cck_swing = odm_read_1byte(dm, 0xa22); -+ -+ for (i = 0; i < CCK_TABLE_SIZE; i++) { -+ if (bb_cck_swing == cck_swing_table_ch1_ch13_new[i][0]) -+ break; -+ } -+ } else if (dm->support_ic_type == ODM_RTL8703B) { -+ bb_cck_swing = odm_read_1byte(dm, 0xa22); -+ -+ for (i = 0; i < CCK_TABLE_SIZE_88F; i++) { -+ if (bb_cck_swing == cck_swing_table_ch1_ch14_88f[i][0]) -+ break; -+ } -+ } -+ -+ return i; -+} -+ -+s8 -+get_txagc_default_index( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ s8 tmp; -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)){ -+ tmp = (s8)(odm_get_bb_reg(dm, R_0x18a0, 0x7f) & 0xff); -+ if (tmp & BIT(6)) -+ tmp = tmp | 0x80; -+ return tmp; -+ } else -+ return 0; -+} -+ -+void -+odm_txpowertracking_thermal_meter_init( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 default_swing_index = get_swing_index(dm); -+ u8 default_cck_swing_index = get_cck_swing_index(dm); -+ struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); -+ struct _hal_rf_ *rf = &dm->rf_table; -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ u8 p = 0; -+ -+ if (*(dm->mp_mode) == false) -+ cali_info->txpowertrack_control = true; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#ifdef CONFIG_RTL8188E -+ { -+ cali_info->is_txpowertracking = true; -+ cali_info->tx_powercount = 0; -+ cali_info->is_txpowertracking_init = false; -+ -+ if (*(dm->mp_mode) == false) -+ cali_info->txpowertrack_control = true; -+ -+ MSG_8192C("dm txpowertrack_control = %d\n", cali_info->txpowertrack_control); -+ } -+#else -+ { -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_priv *pdmpriv = &hal_data->dmpriv; -+ -+ pdmpriv->is_txpowertracking = true; -+ pdmpriv->tx_powercount = 0; -+ pdmpriv->is_txpowertracking_init = false; -+ -+ if (*(dm->mp_mode) == false) -+ pdmpriv->txpowertrack_control = true; -+ -+ MSG_8192C("pdmpriv->txpowertrack_control = %d\n", pdmpriv->txpowertrack_control); -+ -+ } -+#endif -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#ifdef RTL8188E_SUPPORT -+ { -+ cali_info->is_txpowertracking = true; -+ cali_info->tx_powercount = 0; -+ cali_info->is_txpowertracking_init = false; -+ cali_info->txpowertrack_control = true; -+ } -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if (MP_DRIVER == 1) -+ cali_info->txpowertrack_control = false; -+#else -+ cali_info->txpowertrack_control = true; -+#endif -+#else -+ cali_info->txpowertrack_control = true; -+#endif -+ -+ cali_info->thermal_value = hal_data->eeprom_thermal_meter; -+ cali_info->thermal_value_iqk = hal_data->eeprom_thermal_meter; -+ cali_info->thermal_value_lck = hal_data->eeprom_thermal_meter; -+ -+#if (RTL8822C_SUPPORT == 1 || RTL8814B_SUPPORT == 1 || RTL8723F_SUPPORT == 1 || RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822C || -+ dm->support_ic_type == ODM_RTL8723F) { -+ cali_info->thermal_value_path[RF_PATH_A] = tssi->thermal[RF_PATH_A]; -+ cali_info->thermal_value_path[RF_PATH_B] = tssi->thermal[RF_PATH_B]; -+ cali_info->thermal_value_iqk = tssi->thermal[RF_PATH_A]; -+ cali_info->thermal_value_lck = tssi->thermal[RF_PATH_A]; -+ } -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ cali_info->thermal_value_path[RF_PATH_A] = tssi->thermal[RF_PATH_A]; -+ cali_info->thermal_value_path[RF_PATH_B] = tssi->thermal[RF_PATH_B]; -+ cali_info->thermal_value_path[RF_PATH_C] = tssi->thermal[RF_PATH_C]; -+ cali_info->thermal_value_path[RF_PATH_D] = tssi->thermal[RF_PATH_D]; -+ cali_info->thermal_value_iqk = tssi->thermal[RF_PATH_A]; -+ cali_info->thermal_value_lck = tssi->thermal[RF_PATH_A]; -+ } -+#endif -+ -+ if (cali_info->default_bb_swing_index_flag != true) { -+ /*The index of "0 dB" in SwingTable.*/ -+ if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8723B || -+ dm->support_ic_type == ODM_RTL8192E || dm->support_ic_type == ODM_RTL8703B) { -+ cali_info->default_ofdm_index = (default_swing_index >= OFDM_TABLE_SIZE) ? 30 : default_swing_index; -+ cali_info->default_cck_index = (default_cck_swing_index >= CCK_TABLE_SIZE) ? 20 : default_cck_swing_index; -+ } else if (dm->support_ic_type == ODM_RTL8188F) { /*add by Mingzhi.Guo 2015-03-23*/ -+ cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ -+ cali_info->default_cck_index = 20; /*CCK:-6dB*/ -+ } else if (dm->support_ic_type == ODM_RTL8723D) { /*add by zhaohe 2015-10-27*/ -+ cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ -+ cali_info->default_cck_index = 28; /*CCK: -6dB*/ -+ /* JJ ADD 20161014 */ -+ } else if (dm->support_ic_type == ODM_RTL8710B) { -+ cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ -+ cali_info->default_cck_index = 28; /*CCK: -6dB*/ -+ /*Winnita add 20170828*/ -+ } else if (dm->support_ic_type == ODM_RTL8192F) { -+ cali_info->default_ofdm_index = 30; /*OFDM: 0dB*/ -+ cali_info->default_cck_index = 28; /*CCK: -6dB*/ -+ } else { -+ cali_info->default_ofdm_index = (default_swing_index >= TXSCALE_TABLE_SIZE) ? 24 : default_swing_index; -+ cali_info->default_cck_index = 24; -+ cali_info->default_txagc_index = get_txagc_default_index(dm); -+ } -+ cali_info->default_bb_swing_index_flag = true; -+ } -+ -+ cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; -+ cali_info->CCK_index = cali_info->default_cck_index; -+ -+ for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { -+ cali_info->bb_swing_idx_ofdm_base[p] = cali_info->default_ofdm_index; -+ cali_info->OFDM_index[p] = cali_info->default_ofdm_index; -+ cali_info->delta_power_index[p] = 0; -+ cali_info->delta_power_index_last[p] = 0; -+ cali_info->power_index_offset[p] = 0; -+ cali_info->kfree_offset[p] = 0; -+ } -+ cali_info->modify_tx_agc_value_ofdm = 0; -+ cali_info->modify_tx_agc_value_cck = 0; -+ cali_info->tm_trigger = 0; -+} -+ -+ -+void -+odm_txpowertracking_check( -+ void *dm_void -+) -+{ -+ -+#if 0 -+ /* 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. */ -+#endif -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ switch (dm->support_platform) { -+ case ODM_WIN: -+ odm_txpowertracking_check_mp(dm); -+ break; -+ -+ case ODM_CE: -+ odm_txpowertracking_check_ce(dm); -+ break; -+ -+ case ODM_AP: -+ odm_txpowertracking_check_ap(dm); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+void -+odm_txpowertracking_check_ce( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ void *adapter = dm->adapter; -+#if ((RTL8188F_SUPPORT == 1)) -+ rtl8192c_odm_check_txpowertracking(adapter); -+#endif -+ -+#if (RTL8188E_SUPPORT == 1) -+ -+ if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) -+ return; -+ -+ if (!cali_info->tm_trigger) { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); -+ /*DBG_8192C("Trigger 92C Thermal Meter!!\n");*/ -+ -+ cali_info->tm_trigger = 1; -+ return; -+ -+ } else { -+ /*DBG_8192C("Schedule TxPowerTracking direct call!!\n");*/ -+ odm_txpowertracking_callback_thermal_meter_8188e(adapter); -+ cali_info->tm_trigger = 0; -+ } -+#endif -+#endif -+} -+ -+void -+odm_txpowertracking_check_mp( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = dm->adapter; -+ -+ if (*dm->is_fcs_mode_enable) -+ return; -+ -+ if (odm_check_power_status(dm) == false) { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("check_pow_status return false\n")); -+ return; -+ } -+ -+ if (IS_HARDWARE_TYPE_8821B(adapter)) /* TODO: Don't Do PowerTracking*/ -+ return; -+ -+ odm_txpowertracking_thermal_meter_check(adapter); -+ -+ -+#endif -+ -+} -+ -+ -+void -+odm_txpowertracking_check_ap( -+ void *dm_void -+) -+{ -+ return; -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+void -+odm_txpowertracking_direct_call( -+ void *adapter -+) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+#if (RTL8723F_SUPPORT == 1) -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "[RF]===>%s 8723F TSSI, return!\n", __func__); -+ return; -+#endif -+ } -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | ODM_RTL8814C)) { -+#if (RTL8822C_SUPPORT == 1 || RTL8814B_SUPPORT == 1 || RTL8814C_SUPPORT == 1) -+ odm_txpowertracking_new_callback_thermal_meter(dm); -+#endif -+ } else -+ odm_txpowertracking_callback_thermal_meter(adapter); -+} -+ -+void -+odm_txpowertracking_thermal_meter_check( -+ void *adapter -+) -+{ -+ static u8 tm_trigger = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &(pHalData->DM_OutSrc); -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; -+ -+ if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, -+ ("===>odm_txpowertracking_thermal_meter_check(),mgnt_info->is_txpowertracking 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_8192F(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) || IS_HARDWARE_TYPE_8710B(adapter) -+ )/* JJ ADD 20161014 */ -+ PHY_SetRFReg(adapter, RF_PATH_A, RF_T_METER_88E, BIT(17) | BIT(16), 0x03); -+ else if (IS_HARDWARE_TYPE_8822C(adapter)) { -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x00); -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); -+ -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x00); -+ odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); -+ } else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ odm_set_rf_reg(dm, RF_PATH_A, 0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_B, 0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_C, 0x42, BIT(17), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_D, 0x42, BIT(17), 0x1); -+ } else if (IS_HARDWARE_TYPE_8723F(adapter)) { -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(16), 0x01); -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(16), 0x00); -+ odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(16), 0x01); -+ } -+ else -+ PHY_SetRFReg(adapter, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ ODM_delay_us(300); -+ odm_txpowertracking_direct_call(adapter); -+ tssi->thermal_trigger = 1; -+ } -+ -+ 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_txpowertracking_direct_call(adapter); -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ tssi->thermal_trigger = 0; -+ -+ tm_trigger = 0; -+ } -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_win.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_win.h -new file mode 100644 -index 000000000..f84d440da ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_powertracking_win.h -@@ -0,0 +1,306 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALRF_POWERTRACKING_H__ -+#define __HALRF_POWERTRACKING_H__ -+ -+#define DPK_DELTA_MAPPING_NUM 13 -+#define index_mapping_HP_NUM 15 -+#define TXSCALE_TABLE_SIZE 37 -+#define OFDM_TABLE_SIZE 43 -+#define CCK_TABLE_SIZE 33 -+#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 -+/* JJ ADD 20161014 */ -+#define CCK_TABLE_SIZE_8710B 41 -+#define CCK_TABLE_SIZE_8192F 41 -+ -+ -+#define dm_check_txpowertracking odm_txpowertracking_check -+ -+#define IQK_MATRIX_SETTINGS_NUM (14+24+21) /* Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G */ -+#define AVG_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 u32 ofdm_swing_table[OFDM_TABLE_SIZE]; -+extern u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8]; -+extern u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8]; -+ -+extern u32 ofdm_swing_table_new[OFDM_TABLE_SIZE]; -+extern u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8]; -+extern u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8]; -+extern u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16]; -+extern u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16]; -+extern u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16]; -+extern u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D]; -+/* JJ ADD 20161014 */ -+extern u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B]; -+extern u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F]; -+ -+extern u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE]; -+ -+/* <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. */ -+static u8 delta_swing_table_idx_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 u8 delta_swing_table_idx_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_txpowertracking_check( -+ void *dm_void -+); -+ -+void -+odm_txpowertracking_check_ap( -+ void *dm_void -+); -+ -+void -+odm_txpowertracking_thermal_meter_init( -+ void *dm_void -+); -+ -+void -+odm_txpowertracking_init( -+ void *dm_void -+); -+ -+void -+odm_txpowertracking_check_mp( -+ void *dm_void -+); -+ -+ -+void -+odm_txpowertracking_check_ce( -+ void *dm_void -+); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+ -+void -+odm_txpowertracking_thermal_meter_check( -+ void *adapter -+); -+ -+#endif -+ -+struct iqk_matrix_regs_setting { -+ boolean is_iqk_done; -+ s32 value[3][iqk_matrix_reg_num]; -+ boolean is_bw_iqk_result_saved[3]; -+}; -+ -+struct dm_rf_calibration_struct { -+ /* for tx power tracking */ -+ -+ u32 rega24; /* for TempCCK */ -+ s32 rege94; -+ s32 rege9c; -+ s32 regeb4; -+ s32 regebc; -+ /* u8 is_txpowertracking; */ -+ u8 tx_powercount; -+ boolean is_txpowertracking_init; -+ boolean is_txpowertracking; -+ u8 txpowertrack_control; /* for mp mode, turn off txpwrtracking as default */ -+ u8 tm_trigger; -+ u8 internal_pa_5g[2]; /* pathA / pathB */ -+ -+ u8 thermal_meter[2]; /* thermal_meter, index 0 for RFIC0, and 1 for RFIC1 */ -+ u8 thermal_value; -+ u8 thermal_value_path[MAX_RF_PATH]; -+ u8 thermal_value_lck; -+ u8 thermal_value_iqk; -+ u8 thermal_value_dpk; -+ s8 thermal_value_delta; /* delta of thermal_value and efuse thermal */ -+ u8 thermal_value_avg[AVG_THERMAL_NUM]; -+ u8 thermal_value_avg_path[MAX_RF_PATH][AVG_THERMAL_NUM]; -+ u8 thermal_value_avg_index; -+ u8 thermal_value_avg_index_path[MAX_RF_PATH]; -+ u8 thermal_value_rx_gain; -+ -+ -+ boolean is_reloadtxpowerindex; -+ u8 is_rf_pi_enable; -+ u32 txpowertracking_callback_cnt; /* cosa add for debug */ -+ -+ -+ /* ------------------------- Tx power Tracking ------------------------- */ -+ u8 is_cck_in_ch14; -+ u8 CCK_index; -+ u8 OFDM_index[MAX_RF_PATH]; -+ s8 power_index_offset[MAX_RF_PATH]; -+ s8 delta_power_index[MAX_RF_PATH]; -+ s8 delta_power_index_last[MAX_RF_PATH]; -+ boolean is_tx_power_changed; -+ s8 xtal_offset; -+ s8 xtal_offset_last; -+ -+ struct iqk_matrix_regs_setting iqk_matrix_reg_setting[IQK_MATRIX_SETTINGS_NUM]; -+ u8 delta_lck; -+ s8 bb_swing_diff_2g, bb_swing_diff_5g; /* Unit: dB */ -+ u8 delta_swing_table_idx_2g_cck_a_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_a_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_b_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_b_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_c_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_c_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_d_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2g_cck_d_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gb_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gb_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gc_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gc_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gd_p[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2gd_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5ga_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5ga_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gb_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gb_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gc_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gc_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gd_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_5gd_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_a[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_b[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_c[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2g_cck_d[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2ga[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gb[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gc[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_2gd[DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5ga[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gb[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gc[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u8 delta_swing_tssi_table_5gd[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ s8 delta_swing_table_xtal_p[DELTA_SWINGIDX_SIZE]; -+ s8 delta_swing_table_xtal_n[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_p_8188e[DELTA_SWINGIDX_SIZE]; -+ u8 delta_swing_table_idx_2ga_n_8188e[DELTA_SWINGIDX_SIZE]; -+ -+ u8 bb_swing_idx_ofdm[MAX_RF_PATH]; -+ u8 bb_swing_idx_ofdm_current; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ u8 bb_swing_idx_ofdm_base[MAX_RF_PATH]; -+#else -+ u8 bb_swing_idx_ofdm_base; -+#endif -+ boolean default_bb_swing_index_flag; -+ boolean bb_swing_flag_ofdm; -+ u8 bb_swing_idx_cck; -+ u8 bb_swing_idx_cck_current; -+ u8 bb_swing_idx_cck_base; -+ u8 default_ofdm_index; -+ u8 default_cck_index; -+ s8 default_txagc_index; -+ boolean bb_swing_flag_cck; -+ -+ s8 absolute_ofdm_swing_idx[MAX_RF_PATH]; -+ s8 remnant_ofdm_swing_idx[MAX_RF_PATH]; -+ s8 absolute_cck_swing_idx[MAX_RF_PATH]; -+ s8 remnant_cck_swing_idx; -+ s8 modify_tx_agc_value; /*Remnat compensate value at tx_agc */ -+ boolean modify_tx_agc_flag_path_a; -+ boolean modify_tx_agc_flag_path_b; -+ boolean modify_tx_agc_flag_path_c; -+ boolean modify_tx_agc_flag_path_d; -+ boolean modify_tx_agc_flag_path_a_cck; -+ boolean modify_tx_agc_flag_path_b_cck; -+ -+ s8 kfree_offset[MAX_RF_PATH]; -+ -+ /* -------------------------------------------------------------------- */ -+ -+ /* for IQK */ -+ u32 regc04; -+ u32 reg874; -+ u32 regc08; -+ u32 regb68; -+ u32 regb6c; -+ u32 reg870; -+ u32 reg860; -+ u32 reg864; -+ -+ boolean is_iqk_initialized; -+ boolean is_lck_in_progress; -+ boolean is_antenna_detected; -+ boolean is_need_iqk; -+ boolean is_iqk_in_progress; -+ boolean is_iqk_pa_off; -+ u8 delta_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]; -+ u32 tx_iqc_8723b[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u32 rx_iqc_8723b[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ u32 tx_iqc_8703b[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u32 rx_iqc_8703b[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ u32 tx_iqc_8723d[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u32 rx_iqc_8723d[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ /* JJ ADD 20161014 */ -+ u32 tx_iqc_8710b[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u32 rx_iqc_8710b[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ -+ u64 iqk_start_time; -+ u64 iqk_total_progressing_time; -+ u64 iqk_progressing_time; -+ u64 lck_progressing_time; -+ u32 lok_result; -+ u8 iqk_step; -+ u8 kcount; -+ u8 retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ -+ boolean is_mp_mode; -+ -+ /* for APK */ -+ u32 ap_koutput[2][2]; /* path A/B; output1_1a/output1_2a */ -+ u8 is_ap_kdone; -+ u8 is_apk_thermal_meter_ignore; -+ -+ /* DPK */ -+ boolean is_dpk_fail; -+ u8 is_dp_done; -+ u8 is_dp_path_aok; -+ u8 is_dp_path_bok; -+ -+ u32 tx_lok[2]; -+ u32 dpk_tx_agc; -+ s32 dpk_gain; -+ u32 dpk_thermal[4]; -+ -+ s8 modify_tx_agc_value_ofdm; -+ s8 modify_tx_agc_value_cck; -+ -+ /*Add by Yuchen for Kfree Phydm*/ -+ u8 reg_rf_kfree_enable; /*for registry*/ -+ u8 rf_kfree_enable; /*for efuse enable check*/ -+}; -+ -+ -+ -+ -+#endif /*#ifndef __HALRF_POWER_TRACKING_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_psd.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_psd.c -new file mode 100644 -index 000000000..16fe9b96b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_psd.c -@@ -0,0 +1,682 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+u64 _sqrt(u64 x) -+{ -+ u64 i = 0; -+ u64 j = (x >> 1) + 1; -+ -+ while (i <= j) { -+ u64 mid = (i + j) >> 1; -+ -+ u64 sq = mid * mid; -+ -+ if (sq == x) -+ return mid; -+ else if (sq < x) -+ i = mid + 1; -+ else -+ j = mid - 1; -+ } -+ -+ return j; -+} -+ -+u32 halrf_get_psd_data( -+ struct dm_struct *dm, -+ u32 point) -+{ -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ struct _halrf_psd_data *psd = &(rf->halrf_psd_data); -+ u32 psd_val = 0, psd_reg, psd_report, psd_point, psd_start, i, delay_time = 0; -+ -+#if (DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) { -+ if (psd->average == 0) -+ delay_time = 100; -+ else -+ delay_time = 0; -+ } -+#endif -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ if (dm->support_interface == ODM_ITRF_PCIE) { -+ if (psd->average == 0) -+ delay_time = 1000; -+ else -+ delay_time = 100; -+ } -+#endif -+ -+ if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) { -+ psd_reg = R_0x910; -+ psd_report = R_0xf44; -+ } else { -+ psd_reg = R_0x808; -+ psd_report = R_0x8b4; -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8710B) { -+ psd_point = 0xeffffc00; -+ psd_start = 0x10000000; -+ } else { -+ psd_point = 0xffbffc00; -+ psd_start = 0x00400000; -+ } -+ -+ psd_val = odm_get_bb_reg(dm, psd_reg, MASKDWORD); -+ -+ psd_val &= psd_point; -+ psd_val |= point; -+ -+ odm_set_bb_reg(dm, psd_reg, MASKDWORD, psd_val); -+ -+ psd_val |= psd_start; -+ -+ odm_set_bb_reg(dm, psd_reg, MASKDWORD, psd_val); -+ -+ for (i = 0; i < delay_time; i++) -+ ODM_delay_us(1); -+ -+ psd_val = odm_get_bb_reg(dm, psd_report, MASKDWORD); -+ -+ if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8710B)) { -+ psd_val &= MASKL3BYTES; -+ psd_val = psd_val / 32; -+ } else { -+ psd_val &= MASKLWORD; -+ } -+ -+ return psd_val; -+} -+ -+void halrf_psd( -+ struct dm_struct *dm, -+ u32 point, -+ u32 start_point, -+ u32 stop_point, -+ u32 average) -+{ -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ struct _halrf_psd_data *psd = &(rf->halrf_psd_data); -+ -+ u32 i = 0, j = 0, k = 0; -+ u32 psd_reg, avg_org, point_temp, average_tmp, mode; -+ u64 data_tatal = 0, data_temp[64] = {0}; -+ -+ psd->buf_size = 256; -+ -+ mode = average >> 16; -+ -+ if (mode == 2) -+ average_tmp = 1; -+ else -+ average_tmp = average & 0xffff; -+ -+ if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) -+ psd_reg = R_0x910; -+ else -+ psd_reg = R_0x808; -+ -+#if 0 -+ dbg_print("[PSD]point=%d, start_point=%d, stop_point=%d, average=%d, average_tmp=%d, buf_size=%d\n", -+ point, start_point, stop_point, average, average_tmp, psd->buf_size); -+#endif -+ -+ for (i = 0; i < psd->buf_size; i++) -+ psd->psd_data[i] = 0; -+ -+ if (dm->support_ic_type & ODM_RTL8710B) -+ avg_org = odm_get_bb_reg(dm, psd_reg, 0x30000); -+ else -+ avg_org = odm_get_bb_reg(dm, psd_reg, 0x3000); -+ -+ if (mode == 1) { -+ if (dm->support_ic_type & ODM_RTL8710B) -+ odm_set_bb_reg(dm, psd_reg, 0x30000, 0x1); -+ else -+ odm_set_bb_reg(dm, psd_reg, 0x3000, 0x1); -+ } -+ -+#if 0 -+ if (avg_temp == 0) -+ avg = 1; -+ else if (avg_temp == 1) -+ avg = 8; -+ else if (avg_temp == 2) -+ avg = 16; -+ else if (avg_temp == 3) -+ avg = 32; -+#endif -+ -+ i = start_point; -+ while (i < stop_point) { -+ data_tatal = 0; -+ -+ if (i >= point) -+ point_temp = i - point; -+ else -+ point_temp = i; -+ -+ for (k = 0; k < average_tmp; k++) { -+ data_temp[k] = halrf_get_psd_data(dm, point_temp); -+ data_tatal = data_tatal + (data_temp[k] * data_temp[k]); -+ -+#if 0 -+ if ((k % 20) == 0) -+ dbg_print("\n "); -+ -+ dbg_print("0x%x ", data_temp[k]); -+#endif -+ } -+#if 0 -+ /*dbg_print("\n");*/ -+#endif -+ -+ data_tatal = phydm_division64((data_tatal * 100), average_tmp); -+ psd->psd_data[j] = (u32)_sqrt(data_tatal); -+ -+ i++; -+ j++; -+ } -+ -+#if 0 -+ for (i = 0; i < psd->buf_size; i++) { -+ if ((i % 20) == 0) -+ dbg_print("\n "); -+ -+ dbg_print("0x%x ", psd->psd_data[i]); -+ } -+ dbg_print("\n\n"); -+#endif -+ -+ if (dm->support_ic_type & ODM_RTL8710B) -+ odm_set_bb_reg(dm, psd_reg, 0x30000, avg_org); -+ else -+ odm_set_bb_reg(dm, psd_reg, 0x3000, avg_org); -+} -+ -+void backup_bb_register(struct dm_struct *dm, u32 *bb_backup, u32 *backup_bb_reg, u32 counter) -+{ -+ u32 i ; -+ -+ for (i = 0; i < counter; i++) -+ bb_backup[i] = odm_get_bb_reg(dm, backup_bb_reg[i], MASKDWORD); -+} -+ -+void restore_bb_register(struct dm_struct *dm, u32 *bb_backup, u32 *backup_bb_reg, u32 counter) -+{ -+ u32 i ; -+ -+ for (i = 0; i < counter; i++) -+ odm_set_bb_reg(dm, backup_bb_reg[i], MASKDWORD, bb_backup[i]); -+} -+ -+ -+ -+void _halrf_psd_iqk_init(struct dm_struct *dm) -+{ -+ odm_set_bb_reg(dm, 0x1b04, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, 0x1b08, MASKDWORD, 0x80); -+ odm_set_bb_reg(dm, 0x1b0c, 0xc00, 0x3); -+ odm_set_bb_reg(dm, 0x1b14, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, 0x1b18, BIT(0), 0x1); -+ -+ if (dm->support_ic_type & ODM_RTL8197G) -+ odm_set_bb_reg(dm, 0x1b20, MASKDWORD, 0x00040008); -+ if (dm->support_ic_type & ODM_RTL8198F) -+ odm_set_bb_reg(dm, 0x1b20, MASKDWORD, 0x00000000); -+ -+ if (dm->support_ic_type & (ODM_RTL8197G | ODM_RTL8198F)) { -+ odm_set_bb_reg(dm, 0x1b24, MASKDWORD, 0x00030000); -+ odm_set_bb_reg(dm, 0x1b28, MASKDWORD, 0x00000000); -+ odm_set_bb_reg(dm, 0x1b2c, MASKDWORD, 0x00180018); -+ odm_set_bb_reg(dm, 0x1b30, MASKDWORD, 0x20000000); -+ /*odm_set_bb_reg(dm, 0x1b38, MASKDWORD, 0x20000000);*/ -+ /*odm_set_bb_reg(dm, 0x1b3c, MASKDWORD, 0x20000000);*/ -+ } -+ -+ odm_set_bb_reg(dm, 0x1b1c, 0xfff, 0xd21); -+ odm_set_bb_reg(dm, 0x1b1c, 0xfff00000, 0x821); -+ odm_set_bb_reg(dm, 0x1b28, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, 0x1bcc, 0x3f, 0x3f); -+} -+ -+void _halrf_iqk_psd_init_8723f(void *dm_void, boolean onoff) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 s; -+ -+ s = (u8)odm_get_bb_reg(dm, 0x1884, BIT(20)); -+ -+ if (onoff) { -+ /*01_8723F_AFE_ON_BB_settings.txt*/ -+ odm_set_bb_reg(dm, 0x1c38, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, R_0x1830, BIT(30), 0x0); -+ odm_set_bb_reg(dm, R_0x1860, 0xF0000000, 0xf); -+ odm_set_bb_reg(dm, R_0x1860, 0x0FFFF000, 0x0041); -+ odm_set_bb_reg(dm, 0x09f0, 0x0000FFFF, 0xbbbb); -+ odm_set_bb_reg(dm, 0x1d40, BIT(3), 0x1); -+ odm_set_bb_reg(dm, 0x1d40, 0x00000007, 0x3); -+ odm_set_bb_reg(dm, 0x09b4, 0x00000700, 0x3); -+ odm_set_bb_reg(dm, 0x09b4, 0x00003800, 0x3); -+ odm_set_bb_reg(dm, 0x09b4, 0x0001C000, 0x3); -+ odm_set_bb_reg(dm, 0x09b4, 0x000E0000, 0x3); -+ odm_set_bb_reg(dm, R_0x1c20, BIT(5), 0x1); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0x0); -+ odm_set_bb_reg(dm, R_0x1e28, 0x0000000F, 0x1); -+ odm_set_bb_reg(dm, R_0x824, 0x000F0000, 0x1); -+ odm_set_bb_reg(dm, R_0x1cd0, 0xF0000000, 0x7); -+ odm_set_bb_reg(dm, R_0x2a24, BIT(13), 0x1); -+ odm_set_bb_reg(dm, R_0x1c68, BIT(24), 0x1); -+ odm_set_bb_reg(dm, R_0x1864, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0x180c, BIT(27), 0x1); -+ odm_set_bb_reg(dm, R_0x180c, BIT(30), 0x1); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(17), 0x1); -+ odm_set_bb_reg(dm, R_0x1880, BIT(21), 0x0); -+ odm_set_bb_reg(dm, R_0x1c38, MASKDWORD, 0xffffffff); -+ /*02_IQK_Preset.txt*/ -+ //odm_set_rf_reg(dm, RF_PATH_A, 0x05, BIT(0), 0x0); -+ //odm_set_rf_reg(dm, RF_PATH_B, 0x05, BIT(0), 0x0); -+ odm_set_bb_reg(dm, R_0x1b08, MASKDWORD, 0x00000080); -+ //odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0x00000002); -+ //switch path 10 od 0x1b38 0x1/0x3 [1:0] -+ if (s == 0) -+ odm_set_bb_reg(dm, R_0x1b00, MASKDWORD, 0x00000008); -+ else -+ odm_set_bb_reg(dm, R_0x1b00, MASKDWORD, 0x0000000a); -+ -+ odm_set_bb_reg(dm, R_0x1b18, MASKDWORD, 0x40010101); -+ odm_set_bb_reg(dm, R_0x1b14, MASKDWORD, 0x40010100); -+ //odm_set_bb_reg(dm, R_0x1b1c, MASKDWORD, 0xA2103C00); -+ odm_set_bb_reg(dm, R_0x1b0c, 0x00000C00, 0x2); -+ odm_set_bb_reg(dm, R_0x1bcc, 0x0000003F, 0x3f); -+ //DbgPrint("[PSD][8723F]iqkpsd init!\n"); -+ } else { -+ /*10_IQK_Reg_PSD_Restore.txt*/ -+ //odm_set_bb_reg(dm, R_0x1b1c, MASKDWORD, 0xA2103C00); -+ odm_set_bb_reg(dm, R_0x1b08, MASKDWORD, 0x00000000); -+ odm_set_bb_reg(dm, R_0x1b38, BIT(0), 0x0); -+ odm_set_bb_reg(dm, R_0x1bcc, 0x0000003F, 0x0); -+ //odm_set_rf_reg(dm, RF_PATH_A, 0x05, BIT(0), 0x1); -+ //odm_set_rf_reg(dm, RF_PATH_B, 0x05, BIT(0), 0x1); -+ /*11_8723F_restore_AFE_BB_settings.txt*/ -+ odm_set_bb_reg(dm, 0x1c38, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, R_0x1830, BIT(30), 0x1); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0x2a24, BIT(13), 0x0); -+ odm_set_bb_reg(dm, R_0x1c68, BIT(24), 0x0); -+ odm_set_bb_reg(dm, R_0x1864, BIT(31), 0x0); -+ odm_set_bb_reg(dm, R_0x180c, BIT(27), 0x0); -+ odm_set_bb_reg(dm, R_0x180c, BIT(30), 0x0); -+ odm_set_bb_reg(dm, R_0x1880, BIT(21), 0x0); -+ odm_set_bb_reg(dm, R_0x1c38, MASKDWORD, 0xffa1005e); -+ //DbgPrint("[PSD][8723F]iqkpsd resotre!\n"); -+ } -+} -+ -+void _halrf_psd_iqk_init_8814c(struct dm_struct *dm) -+{ -+ odm_set_bb_reg(dm, 0x1b04, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, 0x1b08, MASKDWORD, 0x80); -+ odm_set_bb_reg(dm, 0x1b0c, 0xc00, 0x3); -+ odm_set_bb_reg(dm, 0x1b14, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, 0x1b18, BIT(0), 0x1); -+ odm_set_bb_reg(dm, 0x1b28, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, 0x1b30, MASKDWORD, 0x40000000); -+ odm_set_bb_reg(dm, 0x1bcc, 0x3f, 0x3f); -+} -+ -+ -+u64 halrf_get_iqk_psd_data(void *dm_void, u32 point) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ struct _halrf_psd_data *psd = &(rf->halrf_psd_data); -+ u64 psd_val, psd_val1, psd_val2; -+ u32 psd_point, i, delay_time = 0; -+ -+#if (DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) { -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8723F | ODM_RTL8814C)) -+ delay_time = 1000; -+ else -+ delay_time = 0; -+ } -+#endif -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ if (dm->support_interface == ODM_ITRF_PCIE) { -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814C)) -+ delay_time = 1000; -+ else -+ delay_time = 150; -+ } -+#endif -+ psd_point = odm_get_bb_reg(dm, R_0x1b2c, MASKDWORD); -+ -+ psd_point &= 0xF000FFFF; -+ -+ point &= 0xFFF; -+ -+ psd_point = psd_point | (point << 16); -+ -+ odm_set_bb_reg(dm, R_0x1b2c, MASKDWORD, psd_point); -+ -+ odm_set_bb_reg(dm, R_0x1b34, BIT(0), 0x1); -+ -+ odm_set_bb_reg(dm, R_0x1b34, BIT(0), 0x0); -+ -+ for (i = 0; i < delay_time; i++) -+ ODM_delay_us(1); -+ -+ if (dm->support_ic_type & (ODM_RTL8197G | ODM_RTL8198F)) { -+ if (dm->support_ic_type & ODM_RTL8197G) -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x001a0001); -+ else -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x00250001); -+ -+ psd_val1 = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); -+ -+ psd_val1 = (psd_val1 & 0x001f0000) >> 16; -+ -+ if (dm->support_ic_type & ODM_RTL8197G) -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x001b0001); -+ else -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x002e0001); -+ -+ psd_val2 = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); -+ -+ psd_val = (psd_val1 << 27) + (psd_val2 >> 5); -+ } else if (dm->support_ic_type & ODM_RTL8723F) { -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x00210001); -+ psd_val1 = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); -+ psd_val1 = (psd_val1 & 0x00FF0000) >> 16; -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x00220001); -+ psd_val2 = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); -+ //psd_val = (psd_val1 << 27) + (psd_val2 >> 5); -+ psd_val = (psd_val1 << 32) + psd_val2; -+ } else { -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x00250001); -+ -+ psd_val1 = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); -+ -+ psd_val1 = (psd_val1 & 0x07FF0000) >> 16; -+ -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x002e0001); -+ -+ psd_val2 = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); -+ -+ psd_val = (psd_val1 << 21) + (psd_val2 >> 11); -+ } -+ -+ return psd_val; -+} -+ -+void halrf_iqk_psd( -+ struct dm_struct *dm, -+ u32 point, -+ u32 start_point, -+ u32 stop_point, -+ u32 average) -+{ -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ struct _halrf_psd_data *psd = &(rf->halrf_psd_data); -+ -+ u32 i = 0, j = 0, k = 0; -+ u32 psd_reg, avg_org, point_temp, average_tmp = 32, mode, reg_tmp = 5; -+ u64 data_tatal = 0, data_temp[64] = {0}; -+ s32 s_point_tmp; -+ -+ psd->buf_size = 256; -+ -+ mode = average >> 16; -+ -+ if (mode == 2) { -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8723F | ODM_RTL8814C)) -+ average_tmp = 1; //HW average -+ else { -+ reg_tmp = odm_get_bb_reg(dm, R_0x1b1c, 0x000e0000); -+ if (reg_tmp == 0) -+ average_tmp = 1; -+ else if (reg_tmp == 3) -+ average_tmp = 8; -+ else if (reg_tmp == 4) -+ average_tmp = 16; -+ else if (reg_tmp == 5) -+ average_tmp = 32; -+ odm_set_bb_reg(dm, R_0x1b1c, 0x000e0000, 0x0); -+ } -+ } else { -+ reg_tmp = odm_get_bb_reg(dm, R_0x1b1c, 0x000e0000); -+ if (reg_tmp == 0) -+ average_tmp = 1; -+ else if (reg_tmp == 3) -+ average_tmp = 8; -+ else if (reg_tmp == 4) -+ average_tmp = 16; -+ else if (reg_tmp == 5) -+ average_tmp = 32; -+ if (!(dm->support_ic_type & ODM_RTL8723F)) -+ odm_set_bb_reg(dm, R_0x1b1c, 0x000e0000, 0x0); -+ } -+ -+#if 0 -+ DbgPrint("[PSD]point=%d, start_point=%d, stop_point=%d, average=0x%x, average_tmp=%d, buf_size=%d, mode=%d\n", -+ point, start_point, stop_point, average, average_tmp, psd->buf_size, mode); -+#endif -+ -+ for (i = 0; i < psd->buf_size; i++) -+ psd->psd_data[i] = 0; -+ -+ i = start_point; -+ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ while (i < stop_point) { -+ data_tatal = 0; -+ -+ if (i >= point) -+ point_temp = i - point; -+ else -+ point_temp = i + 0xB00; -+ //-640:0xD80,640:0x280,0x280+0xB00 =0xD80 -+ //point_temp = i + 0xC00; -+ //-512:0xE00,512:0x200,0x200+0xC00 = 0xE00 -+ -+ data_temp[k] = halrf_get_iqk_psd_data(dm, point_temp); -+ data_tatal = data_temp[k]; -+ psd->psd_data[j] = (u32)data_tatal; -+ i++; -+ j++; -+ } -+ } else { -+ while (i < stop_point) { -+ data_tatal = 0; -+ -+ if (i >= point) -+ point_temp = i - point; -+ else -+ { -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ { -+ s_point_tmp = i - point - 1; -+ point_temp = s_point_tmp & 0xfff; -+ } -+ else -+ point_temp = i; -+ } -+ -+ for (k = 0; k < average_tmp; k++) { -+ data_temp[k] = halrf_get_iqk_psd_data(dm, point_temp); -+ /*data_tatal = data_tatal + (data_temp[k] * data_temp[k]);*/ -+ data_tatal = data_tatal + data_temp[k]; -+ -+#if 0 -+ if ((k % 20) == 0) -+ DbgPrint("\n "); -+ -+ DbgPrint("0x%x ", data_temp[k]); -+#endif -+ } -+ -+ data_tatal = phydm_division64((data_tatal * 10), average_tmp); -+ psd->psd_data[j] = (u32)data_tatal; -+ -+ i++; -+ j++; -+ } -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8198F | ODM_RTL8197G)) -+ odm_set_bb_reg(dm, R_0x1b1c, 0x000e0000, reg_tmp); -+ } -+ -+#if 0 -+ DbgPrint("\n [iqk psd]psd result:\n"); -+ -+ for (i = 0; i < psd->buf_size; i++) { -+ if ((i % 20) == 0) -+ DbgPrint("\n "); -+ -+ DbgPrint("0x%x ", psd->psd_data[i]); -+ } -+ DbgPrint("\n\n"); -+#endif -+} -+ -+ -+u32 -+halrf_psd_init( -+ void *dm_void) -+{ -+ enum rt_status ret_status = RT_STATUS_SUCCESS; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ struct _halrf_psd_data *psd = &(rf->halrf_psd_data); -+ -+ u32 bb_backup[18]; -+ u32 backup_bb_addr[18] = {0}; -+ u32 bk_counter = 18; -+ -+ u32 backup_bb_reg[12] = {0x1b04, 0x1b08, 0x1b0c, 0x1b14, 0x1b18, -+ 0x1b1c, 0x1b28, 0x1bcc, 0x1b2c, 0x1b34, -+ 0x1bd4, 0x1bfc}; -+ -+ u32 backup_bb_reg_8723f[11] = {0x09f0, 0x09b4, 0x1c38, 0x1860, 0x1cd0, -+ 0x824, 0x2a24, 0x1d40, 0x1c20, 0x1880, -+ 0x180c}; -+ -+ u32 backup_bb_reg_8814c[18] = {0x1e24, 0x1cd0, 0x1b08, 0x1d58, 0x1834, -+ 0x4134, 0x5234, 0x5334, 0x180c, 0x410c, -+ 0x520c, 0x530c, 0x186c, 0x416c, 0x526c, -+ 0x536c, 0x1a00, 0x1c38}; -+ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ odm_move_memory(dm, backup_bb_addr, backup_bb_reg_8723f, -+ sizeof(backup_bb_addr)); -+ bk_counter = 11; -+ } else if (dm->support_ic_type & ODM_RTL8814C) { -+ odm_move_memory(dm, backup_bb_addr, backup_bb_reg_8814c, -+ sizeof(backup_bb_addr)); -+ bk_counter = 18; -+ } else { -+ odm_move_memory(dm, backup_bb_addr, backup_bb_reg, -+ sizeof(backup_bb_addr)); -+ bk_counter = 12; -+ } -+ -+ if (psd->psd_progress) { -+ ret_status = RT_STATUS_PENDING; -+ } else { -+ psd->psd_progress = 1; -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ backup_bb_register(dm, bb_backup, backup_bb_addr, bk_counter); -+ _halrf_iqk_psd_init_8723f(dm, true); -+ halrf_iqk_psd(dm, psd->point, psd->start_point, psd->stop_point, psd->average); -+ _halrf_iqk_psd_init_8723f(dm, false); -+ restore_bb_register(dm, bb_backup, backup_bb_addr, bk_counter); -+ } else if (dm->support_ic_type & ODM_RTL8814C) { -+ backup_bb_register(dm, bb_backup, backup_bb_addr, bk_counter); -+ _halrf_psd_iqk_init_8814c(dm); -+ halrf_iqk_psd(dm, psd->point, psd->start_point, psd->stop_point, psd->average); -+ restore_bb_register(dm, bb_backup, backup_bb_addr, bk_counter); -+ } else if (dm->support_ic_type & -+ (ODM_RTL8822C | ODM_RTL8814B | ODM_RTL8198F | ODM_RTL8197G)) { -+ backup_bb_register(dm, bb_backup, backup_bb_addr, bk_counter); -+ _halrf_psd_iqk_init(dm); -+ halrf_iqk_psd(dm, psd->point, psd->start_point, psd->stop_point, psd->average); -+ restore_bb_register(dm, bb_backup, backup_bb_addr, bk_counter); -+ } else -+ halrf_psd(dm, psd->point, psd->start_point, psd->stop_point, psd->average); -+ psd->psd_progress = 0; -+ } -+ return ret_status; -+} -+ -+u32 -+halrf_psd_query( -+ void *dm_void, -+ u32 *outbuf, -+ u32 buf_size) -+{ -+ enum rt_status ret_status = RT_STATUS_SUCCESS; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ struct _halrf_psd_data *psd = &(rf->halrf_psd_data); -+ -+ if (psd->psd_progress) -+ ret_status = RT_STATUS_PENDING; -+ else -+ odm_move_memory(dm, outbuf, psd->psd_data, -+ sizeof(u32) * psd->buf_size); -+ -+ return ret_status; -+} -+ -+u32 -+halrf_psd_init_query( -+ void *dm_void, -+ u32 *outbuf, -+ u32 point, -+ u32 start_point, -+ u32 stop_point, -+ u32 average, -+ u32 buf_size) -+{ -+ enum rt_status ret_status = RT_STATUS_SUCCESS; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &(dm->rf_table); -+ struct _halrf_psd_data *psd = &(rf->halrf_psd_data); -+ -+ psd->point = point; -+ psd->start_point = start_point; -+ psd->stop_point = stop_point; -+ psd->average = average; -+ -+ if (psd->psd_progress) { -+ ret_status = RT_STATUS_PENDING; -+ } else { -+ psd->psd_progress = 1; -+ halrf_psd(dm, psd->point, psd->start_point, psd->stop_point, psd->average); -+ odm_move_memory(dm, outbuf, psd->psd_data, 0x400); -+ psd->psd_progress = 0; -+ } -+ -+ return ret_status; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_psd.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_psd.h -new file mode 100644 -index 000000000..d714a5623 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_psd.h -@@ -0,0 +1,60 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALRF_PSD_H__ -+#define __HALRF_PSD_H__ -+ -+ -+struct _halrf_psd_data { -+ u32 point; -+ u32 start_point; -+ u32 stop_point; -+ u32 average; -+ u32 buf_size; -+ u32 psd_data[256]; -+ u32 psd_progress; -+}; -+ -+u32 -+halrf_psd_init( -+ void *dm_void); -+ -+void -+_halrf_iqk_psd_init_8723f( -+ void *dm_void, -+ boolean onoff); -+ -+u64 -+halrf_get_iqk_psd_data( -+ void *dm_void, -+ u32 point); -+ -+u32 -+halrf_psd_query( -+ void *dm_void, -+ u32 *outbuf, -+ u32 buf_size); -+ -+u32 -+halrf_psd_init_query( -+ void *dm_void, -+ u32 *outbuf, -+ u32 point, -+ u32 start_point, -+ u32 stop_point, -+ u32 average, -+ u32 buf_size); -+ -+#endif /*#__HALRF_PSD_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_txgapcal.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_txgapcal.c -new file mode 100644 -index 000000000..0cc44974b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_txgapcal.c -@@ -0,0 +1,300 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+void odm_bub_sort(u32 *data, u32 n) -+{ -+ int i, j, temp, sp; -+ -+ for (i = n - 1; i >= 0; i--) { -+ sp = 1; -+ for (j = 0; j < i; j++) { -+ if (data[j] < data[j + 1]) { -+ temp = data[j]; -+ data[j] = data[j + 1]; -+ data[j + 1] = temp; -+ sp = 0; -+ } -+ } -+ if (sp == 1) -+ break; -+ } -+} -+ -+#if (RTL8197F_SUPPORT == 1) -+ -+u4Byte -+odm_tx_gain_gap_psd_8197f( -+ void *dm_void, -+ u1Byte rf_path, -+ u4Byte rf56) -+{ -+ PDM_ODM_T dm = (PDM_ODM_T)dm_void; -+ -+ u1Byte i, j; -+ u4Byte psd_vaule[5], psd_avg_time = 5, psd_vaule_temp; -+ -+ u4Byte iqk_ctl_addr[2][6] = {{0xe30, 0xe34, 0xe50, 0xe54, 0xe38, 0xe3c}, -+ {0xe50, 0xe54, 0xe30, 0xe34, 0xe58, 0xe5c}}; -+ -+ u4Byte psd_finish_bit[2] = {0x04000000, 0x20000000}; -+ u4Byte psd_fail_bit[2] = {0x08000000, 0x40000000}; -+ -+ u4Byte psd_cntl_value[2][2] = {{0x38008c1c, 0x10008c1c}, -+ {0x38008c2c, 0x10008c2c}}; -+ -+ u4Byte psd_report_addr[2] = {0xea0, 0xec0}; -+ -+ odm_set_rf_reg(dm, rf_path, RF_0xdf, bRFRegOffsetMask, 0x00e02); -+ -+ ODM_delay_us(100); -+ -+ odm_set_bb_reg(dm, R_0xe28, 0xffffffff, 0x0); -+ -+ odm_set_rf_reg(dm, rf_path, RF_0x56, 0xfff, rf56); -+ while (rf56 != (odm_get_rf_reg(dm, rf_path, RF_0x56, 0xfff))) -+ odm_set_rf_reg(dm, rf_path, RF_0x56, 0xfff, rf56); -+ -+ odm_set_bb_reg(dm, R_0xd94, 0xffffffff, 0x44FFBB44); -+ odm_set_bb_reg(dm, R_0xe70, 0xffffffff, 0x00400040); -+ odm_set_bb_reg(dm, R_0xc04, 0xffffffff, 0x6f005403); -+ odm_set_bb_reg(dm, R_0xc08, 0xffffffff, 0x000804e4); -+ odm_set_bb_reg(dm, R_0x874, 0xffffffff, 0x04203400); -+ odm_set_bb_reg(dm, R_0xe28, 0xffffffff, 0x80800000); -+ -+ odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][0], 0xffffffff, psd_cntl_value[rf_path][0]); -+ odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][1], 0xffffffff, psd_cntl_value[rf_path][1]); -+ odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][2], 0xffffffff, psd_cntl_value[rf_path][0]); -+ odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][3], 0xffffffff, psd_cntl_value[rf_path][0]); -+ odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][4], 0xffffffff, 0x8215001F); -+ odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][5], 0xffffffff, 0x2805001F); -+ -+ odm_set_bb_reg(dm, R_0xe40, 0xffffffff, 0x81007C00); -+ odm_set_bb_reg(dm, R_0xe44, 0xffffffff, 0x81004800); -+ odm_set_bb_reg(dm, R_0xe4c, 0xffffffff, 0x0046a8d0); -+ -+ for (i = 0; i < psd_avg_time; i++) { -+ for (j = 0; j < 1000; j++) { -+ odm_set_bb_reg(dm, R_0xe48, 0xffffffff, 0xfa005800); -+ odm_set_bb_reg(dm, R_0xe48, 0xffffffff, 0xf8005800); -+ -+ while (!odm_get_bb_reg(dm, R_0xeac, psd_finish_bit[rf_path])) -+ ; /*wait finish bit*/ -+ -+ if (!odm_get_bb_reg(dm, R_0xeac, psd_fail_bit[rf_path])) { /*check fail bit*/ -+ -+ psd_vaule[i] = odm_get_bb_reg(dm, psd_report_addr[rf_path], 0xffffffff); -+ -+ if (psd_vaule[i] > 0xffff) -+ break; -+ } -+ } -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TGGC] rf0=0x%x rf56=0x%x rf56_reg=0x%x time=%d psd_vaule=0x%x\n", -+ odm_get_rf_reg(dm, rf_path, RF_0x0, 0xff), rf56, -+ odm_get_rf_reg(dm, rf_path, RF_0x56, 0xfff), j, -+ psd_vaule[i]); -+ } -+ -+ odm_bub_sort(psd_vaule, psd_avg_time); -+ -+ psd_vaule_temp = psd_vaule[(UINT)(psd_avg_time / 2)]; -+ -+ odm_set_bb_reg(dm, R_0xd94, 0xffffffff, 0x44BBBB44); -+ odm_set_bb_reg(dm, R_0xe70, 0xffffffff, 0x80408040); -+ odm_set_bb_reg(dm, R_0xc04, 0xffffffff, 0x6f005433); -+ odm_set_bb_reg(dm, R_0xc08, 0xffffffff, 0x000004e4); -+ odm_set_bb_reg(dm, R_0x874, 0xffffffff, 0x04003400); -+ odm_set_bb_reg(dm, R_0xe28, 0xffffffff, 0x00000000); -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TGGC] rf0=0x%x rf56=0x%x rf56_reg=0x%x psd_vaule_temp=0x%x\n", -+ odm_get_rf_reg(dm, rf_path, RF_0x0, 0xff), rf56, -+ odm_get_rf_reg(dm, rf_path, RF_0x56, 0xfff), psd_vaule_temp); -+ -+ odm_set_rf_reg(dm, rf_path, RF_0xdf, bRFRegOffsetMask, 0x00602); -+ -+ return psd_vaule_temp; -+} -+ -+void odm_tx_gain_gap_calibration_8197f( -+ void *dm_void) -+{ -+ PDM_ODM_T dm = (PDM_ODM_T)dm_void; -+ -+ u1Byte rf_path, rf0_idx, rf0_idx_current, rf0_idx_next, i, delta_gain_retry = 3; -+ -+ s1Byte delta_gain_gap_pre, delta_gain_gap[2][11]; -+ u4Byte rf56_current, rf56_next, psd_value_current, psd_value_next; -+ u4Byte psd_gap, rf56_current_temp[2][11]; -+ s4Byte rf33[2][11]; -+ -+ memset(rf33, 0x0, sizeof(rf33)); -+ -+ for (rf_path = RF_PATH_A; rf_path <= RF_PATH_B; rf_path++) { -+ if (rf_path == RF_PATH_A) -+ odm_set_bb_reg(dm, R_0x88c, (BIT(21) | BIT(20)), 0x3); /*disable 3-wire*/ -+ else if (rf_path == RF_PATH_B) -+ odm_set_bb_reg(dm, R_0x88c, (BIT(23) | BIT(22)), 0x3); /*disable 3-wire*/ -+ -+ ODM_delay_us(100); -+ -+ for (rf0_idx = 1; rf0_idx <= 10; rf0_idx++) { -+ rf0_idx_current = 3 * (rf0_idx - 1) + 1; -+ odm_set_rf_reg(dm, rf_path, RF_0x0, 0xff, rf0_idx_current); -+ ODM_delay_us(100); -+ rf56_current_temp[rf_path][rf0_idx] = odm_get_rf_reg(dm, rf_path, RF_0x56, 0xfff); -+ rf56_current = rf56_current_temp[rf_path][rf0_idx]; -+ -+ rf0_idx_next = 3 * rf0_idx + 1; -+ odm_set_rf_reg(dm, rf_path, RF_0x0, 0xff, rf0_idx_next); -+ ODM_delay_us(100); -+ rf56_next = odm_get_rf_reg(dm, rf_path, RF_0x56, 0xfff); -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TGGC] rf56_current[%d][%d]=0x%x rf56_next[%d][%d]=0x%x\n", -+ rf_path, rf0_idx, rf56_current, rf_path, rf0_idx, -+ rf56_next); -+ -+ if ((rf56_current >> 5) == (rf56_next >> 5)) { -+ delta_gain_gap[rf_path][rf0_idx] = 0; -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TGGC] rf56_current[11:5] == rf56_next[%d][%d][11:5]=0x%x delta_gain_gap[%d][%d]=%d\n", -+ rf_path, rf0_idx, (rf56_next >> 5), -+ rf_path, rf0_idx, -+ delta_gain_gap[rf_path][rf0_idx]); -+ -+ continue; -+ } -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TGGC] rf56_current[%d][%d][11:5]=0x%x != rf56_next[%d][%d][11:5]=0x%x\n", -+ rf_path, rf0_idx, (rf56_current >> 5), rf_path, -+ rf0_idx, (rf56_next >> 5)); -+ -+ for (i = 0; i < delta_gain_retry; i++) { -+ psd_value_current = odm_tx_gain_gap_psd_8197f(dm, rf_path, rf56_current); -+ -+ psd_value_next = odm_tx_gain_gap_psd_8197f(dm, rf_path, rf56_next - 2); -+ -+ psd_gap = psd_value_next / (psd_value_current / 1000); -+ -+#if 0 -+ if (psd_gap > 1413) -+ delta_gain_gap[rf_path][rf0_idx] = 1; -+ else if (psd_gap > 1122) -+ delta_gain_gap[rf_path][rf0_idx] = 0; -+ else -+ delta_gain_gap[rf_path][rf0_idx] = -1; -+#endif -+ -+ if (psd_gap > 1445) -+ delta_gain_gap[rf_path][rf0_idx] = 1; -+ else if (psd_gap > 1096) -+ delta_gain_gap[rf_path][rf0_idx] = 0; -+ else -+ delta_gain_gap[rf_path][rf0_idx] = -1; -+ -+ if (i == 0) -+ delta_gain_gap_pre = delta_gain_gap[rf_path][rf0_idx]; -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TGGC] psd_value_current=0x%x psd_value_next=0x%x psd_value_next/psd_value_current=%d delta_gain_gap[%d][%d]=%d\n", -+ psd_value_current, psd_value_next, -+ psd_gap, rf_path, rf0_idx, -+ delta_gain_gap[rf_path][rf0_idx]); -+ -+ if (i == 0 && delta_gain_gap[rf_path][rf0_idx] == 0) -+ break; -+ -+ if (delta_gain_gap_pre != delta_gain_gap[rf_path][rf0_idx]) { -+ delta_gain_gap[rf_path][rf0_idx] = 0; -+ -+ RF_DBG(dm, DBG_RF_IQK, "[TGGC] delta_gain_gap_pre(%d) != delta_gain_gap[%d][%d](%d) time=%d\n", -+ delta_gain_gap_pre, rf_path, rf0_idx, delta_gain_gap[rf_path][rf0_idx], i); -+ -+ break; -+ } -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TGGC] delta_gain_gap_pre(%d) == delta_gain_gap[%d][%d](%d) time=%d\n", -+ delta_gain_gap_pre, rf_path, rf0_idx, -+ delta_gain_gap[rf_path][rf0_idx], i); -+ } -+ } -+ -+ if (rf_path == RF_PATH_A) -+ odm_set_bb_reg(dm, R_0x88c, (BIT(21) | BIT(20)), 0x0); /*enable 3-wire*/ -+ else if (rf_path == RF_PATH_B) -+ odm_set_bb_reg(dm, R_0x88c, (BIT(23) | BIT(22)), 0x0); /*enable 3-wire*/ -+ -+ ODM_delay_us(100); -+ } -+ -+#if 0 -+ /*odm_set_bb_reg(dm, R_0x88c, (BIT(23) | BIT(22) | BIT(21) | BIT(20)), 0x0);*/ /*enable 3-wire*/ -+#endif -+ -+ for (rf_path = RF_PATH_A; rf_path <= RF_PATH_B; rf_path++) { -+ odm_set_rf_reg(dm, rf_path, RF_0xef, bRFRegOffsetMask, 0x00100); -+ -+ for (rf0_idx = 1; rf0_idx <= 10; rf0_idx++) { -+ rf33[rf_path][rf0_idx] = rf33[rf_path][rf0_idx] + (rf56_current_temp[rf_path][rf0_idx] & 0x1f); -+ -+ for (i = rf0_idx; i <= 10; i++) -+ rf33[rf_path][rf0_idx] = rf33[rf_path][rf0_idx] + delta_gain_gap[rf_path][i]; -+ -+ if (rf33[rf_path][rf0_idx] >= 0x1d) -+ rf33[rf_path][rf0_idx] = 0x1d; -+ else if (rf33[rf_path][rf0_idx] <= 0x2) -+ rf33[rf_path][rf0_idx] = 0x2; -+ -+ rf33[rf_path][rf0_idx] = rf33[rf_path][rf0_idx] + ((rf0_idx - 1) * 0x4000) + (rf56_current_temp[rf_path][rf0_idx] & 0xfffe0); -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TGGC] rf56[%d][%d]=0x%05x rf33[%d][%d]=0x%05x\n", -+ rf_path, rf0_idx, -+ rf56_current_temp[rf_path][rf0_idx], rf_path, -+ rf0_idx, rf33[rf_path][rf0_idx]); -+ -+ odm_set_rf_reg(dm, rf_path, RF_0x33, bRFRegOffsetMask, rf33[rf_path][rf0_idx]); -+ } -+ -+ odm_set_rf_reg(dm, rf_path, RF_0xef, bRFRegOffsetMask, 0x00000); -+ } -+} -+#endif -+ -+void odm_tx_gain_gap_calibration(void *dm_void) -+{ -+ PDM_ODM_T dm = (PDM_ODM_T)dm_void; -+#if (RTL8197F_SUPPORT == 1) -+ if (dm->SupportICType & ODM_RTL8197F) -+ odm_tx_gain_gap_calibration_8197f(dm_void); -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_txgapcal.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_txgapcal.h -new file mode 100644 -index 000000000..09651cbee ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/halrf_txgapcal.h -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALRF_TXGAPCAL_H__ -+#define __HALRF_TXGAPCAL_H__ -+ -+void odm_tx_gain_gap_calibration(void *dm_void); -+ -+#endif /*__HALRF_TXGAPCAL_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halhwimg8821c_rf.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halhwimg8821c_rf.c -new file mode 100644 -index 000000000..9e90f911c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halhwimg8821c_rf.c -@@ -0,0 +1,7721 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*Image2HeaderVersion: R3 1.5.10.1*/ -+#include "mp_precomp.h" -+ -+#define ODM_WIN 0x08 -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if RT_PLATFORM == PLATFORM_MACOSX -+#include "phydm_precomp.h" -+#else -+#include "../phydm_precomp.h" -+#endif -+#else -+#include "../../phydm_precomp.h" -+#endif -+ -+#define D_S_SIZE DELTA_SWINGIDX_SIZE -+#define D_ST_SIZE DELTA_SWINTSSI_SIZE -+ -+#if (RTL8821C_SUPPORT == 1) -+static boolean -+check_positive(struct dm_struct *dm, -+ const u32 condition1, -+ const u32 condition2, -+ const u32 condition3, -+ const u32 condition4 -+) -+{ -+ u32 cond1 = condition1, cond2 = condition2, -+ cond3 = condition3, cond4 = condition4; -+ -+ u8 cut_version_for_para = -+ (dm->cut_version == ODM_CUT_A) ? 15 : dm->cut_version; -+ -+ u8 pkg_type_for_para = -+ (dm->package_type == 0) ? 15 : dm->package_type; -+ -+ u32 driver1 = cut_version_for_para << 24 | -+ (dm->support_interface & 0xF0) << 16 | -+ dm->support_platform << 16 | -+ pkg_type_for_para << 12 | -+ (dm->support_interface & 0x0F) << 8 | -+ dm->rfe_type; -+ -+ u32 driver2 = (dm->type_glna & 0xFF) << 0 | -+ (dm->type_gpa & 0xFF) << 8 | -+ (dm->type_alna & 0xFF) << 16 | -+ (dm->type_apa & 0xFF) << 24; -+ -+ u32 driver3 = 0; -+ -+ u32 driver4 = (dm->type_glna & 0xFF00) >> 8 | -+ (dm->type_gpa & 0xFF00) | -+ (dm->type_alna & 0xFF00) << 8 | -+ (dm->type_apa & 0xFF00) << 16; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "===> %s (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", -+ __func__, cond1, cond2, cond3, cond4); -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "===> %s (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", -+ __func__, driver1, driver2, driver3, driver4); -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ " (Platform, Interface) = (0x%X, 0x%X)\n", -+ dm->support_platform, dm->support_interface); -+ PHYDM_DBG(dm, ODM_COMP_INIT, " (RFE, Package) = (0x%X, 0x%X)\n", -+ dm->rfe_type, dm->package_type); -+ -+ /*============== value Defined Check ===============*/ -+ /*cut version [27:24] need to do value check*/ -+ if (((cond1 & 0x0F000000) != 0) && -+ ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return false; -+ -+ /*pkg type [15:12] need to do value check*/ -+ if (((cond1 & 0x0000F000) != 0) && -+ ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return false; -+ -+ /*interface [11:8] need to do value check*/ -+ if (((cond1 & 0x00000F00) != 0) && -+ ((cond1 & 0x00000F00) != (driver1 & 0x00000F00))) -+ return false; -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x000000FF; -+ driver1 &= 0x000000FF; -+ -+ if (cond1 == driver1) -+ return true; -+ else -+ return false; -+} -+ -+ -+/****************************************************************************** -+ * radioa.TXT -+ ******************************************************************************/ -+ -+const u32 array_mp_8821c_radioa[] = { -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x000, 0x00010000, -+ 0x018, 0x00010D24, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x000, 0x00010000, -+ 0x018, 0x00010D24, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x000, 0x00010000, -+ 0x018, 0x00010D24, -+ 0xA0000000, 0x00000000, -+ 0x000, 0x00010000, -+ 0x018, 0x00010D24, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000002, -+ 0x03E, 0x0000003F, -+ 0x03F, 0x000C0F4E, -+ 0x033, 0x00000001, -+ 0x03E, 0x00000034, -+ 0x03F, 0x0004080E, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000002, -+ 0x03E, 0x0000003F, -+ 0x03F, 0x000C0F4E, -+ 0x033, 0x00000001, -+ 0x03E, 0x00000034, -+ 0x03F, 0x0004080E, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000002, -+ 0x03E, 0x0000003F, -+ 0x03F, 0x000C0F4E, -+ 0x033, 0x00000001, -+ 0x03E, 0x00000034, -+ 0x03F, 0x0004080E, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000002, -+ 0x03E, 0x0000003F, -+ 0x03F, 0x000C0F4E, -+ 0x033, 0x00000001, -+ 0x03E, 0x00000034, -+ 0x03F, 0x0004080E, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00002000, -+ 0x033, 0x00000000, -+ 0x03F, 0x000005DF, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00002000, -+ 0x033, 0x00000000, -+ 0x03F, 0x000005DF, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00002000, -+ 0x033, 0x00000000, -+ 0x03F, 0x000005DF, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00002000, -+ 0x033, 0x00000000, -+ 0x03F, 0x000005DF, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000400, -+ 0x033, 0x00000000, -+ 0x03F, 0x000005DF, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000400, -+ 0x033, 0x00000000, -+ 0x03F, 0x000005DF, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000400, -+ 0x033, 0x00000000, -+ 0x03F, 0x000005DF, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00000400, -+ 0x033, 0x00000000, -+ 0x03F, 0x000005DF, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B0, 0x000FF0F8, -+ 0x0B1, 0x0007DBE4, -+ 0x0B2, 0x000225D1, -+ 0x0B3, 0x000FC760, -+ 0x0B4, 0x00099DD0, -+ 0x0B5, 0x000400FC, -+ 0x0B6, 0x000187F0, -+ 0x0B7, 0x00030018, -+ 0x0B8, 0x00080800, -+ 0x0B9, 0x00000000, -+ 0x0BA, 0x00008000, -+ 0x0BB, 0x00000004, -+ 0x0BC, 0x00040000, -+ 0x0BD, 0x00000000, -+ 0x0BE, 0x00000000, -+ 0x0BF, 0x00000000, -+ 0x0C0, 0x00000000, -+ 0x0C1, 0x00000000, -+ 0x0C2, 0x00000000, -+ 0x0C3, 0x00000000, -+ 0x0C4, 0x00002402, -+ 0x0C5, 0x00000009, -+ 0x0C6, 0x00040299, -+ 0x0C7, 0x00055555, -+ 0x0C8, 0x0000C16C, -+ 0x0C9, 0x0001C140, -+ 0x0CA, 0x00000000, -+ 0x0CB, 0x00000000, -+ 0x0CC, 0x00000000, -+ 0x0CD, 0x00000000, -+ 0x0CE, 0x00090C00, -+ 0x0CF, 0x0006D200, -+ 0x0DF, 0x00000009, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B0, 0x000FF0F8, -+ 0x0B1, 0x0007DBE4, -+ 0x0B2, 0x000225D1, -+ 0x0B3, 0x000FC760, -+ 0x0B4, 0x00099DD0, -+ 0x0B5, 0x000400FC, -+ 0x0B6, 0x000187F0, -+ 0x0B7, 0x00030018, -+ 0x0B8, 0x00080800, -+ 0x0B9, 0x00000000, -+ 0x0BA, 0x00008000, -+ 0x0BB, 0x00000004, -+ 0x0BC, 0x00040000, -+ 0x0BD, 0x00000000, -+ 0x0BE, 0x00000000, -+ 0x0BF, 0x00000000, -+ 0x0C0, 0x00000000, -+ 0x0C1, 0x00000000, -+ 0x0C2, 0x00000000, -+ 0x0C3, 0x00000000, -+ 0x0C4, 0x00002402, -+ 0x0C5, 0x00000009, -+ 0x0C6, 0x00040299, -+ 0x0C7, 0x00055555, -+ 0x0C8, 0x0000C16C, -+ 0x0C9, 0x0001C140, -+ 0x0CA, 0x00000000, -+ 0x0CB, 0x00000000, -+ 0x0CC, 0x00000000, -+ 0x0CD, 0x00000000, -+ 0x0CE, 0x00090C00, -+ 0x0CF, 0x0006D200, -+ 0x0DF, 0x00000009, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B0, 0x000FF0F8, -+ 0x0B1, 0x0007DBE4, -+ 0x0B2, 0x000225D1, -+ 0x0B3, 0x000FC760, -+ 0x0B4, 0x00099DD0, -+ 0x0B5, 0x000400FC, -+ 0x0B6, 0x000187F0, -+ 0x0B7, 0x00030018, -+ 0x0B8, 0x00080800, -+ 0x0B9, 0x00000000, -+ 0x0BA, 0x00008000, -+ 0x0BB, 0x00000004, -+ 0x0BC, 0x00040000, -+ 0x0BD, 0x00000000, -+ 0x0BE, 0x00000000, -+ 0x0BF, 0x00000000, -+ 0x0C0, 0x00000000, -+ 0x0C1, 0x00000000, -+ 0x0C2, 0x00000000, -+ 0x0C3, 0x00000000, -+ 0x0C4, 0x00002402, -+ 0x0C5, 0x00000009, -+ 0x0C6, 0x00040299, -+ 0x0C7, 0x00055555, -+ 0x0C8, 0x0000C16C, -+ 0x0C9, 0x0001C140, -+ 0x0CA, 0x00000000, -+ 0x0CB, 0x00000000, -+ 0x0CC, 0x00000000, -+ 0x0CD, 0x00000000, -+ 0x0CE, 0x00090C00, -+ 0x0CF, 0x0006D200, -+ 0x0DF, 0x00000009, -+ 0xA0000000, 0x00000000, -+ 0x0B0, 0x000FF0F8, -+ 0x0B1, 0x0007DBE4, -+ 0x0B2, 0x000225D1, -+ 0x0B3, 0x000FC760, -+ 0x0B4, 0x00099DD0, -+ 0x0B5, 0x000400FC, -+ 0x0B6, 0x000187F0, -+ 0x0B7, 0x00030018, -+ 0x0B8, 0x00080800, -+ 0x0B9, 0x00000000, -+ 0x0BA, 0x00008000, -+ 0x0BB, 0x00000004, -+ 0x0BC, 0x00040000, -+ 0x0BD, 0x00000000, -+ 0x0BE, 0x00000000, -+ 0x0BF, 0x00000000, -+ 0x0C0, 0x00000000, -+ 0x0C1, 0x00000000, -+ 0x0C2, 0x00000000, -+ 0x0C3, 0x00000000, -+ 0x0C4, 0x00002402, -+ 0x0C5, 0x00000009, -+ 0x0C6, 0x00040299, -+ 0x0C7, 0x00055555, -+ 0x0C8, 0x0000C16C, -+ 0x0C9, 0x0001C140, -+ 0x0CA, 0x00000000, -+ 0x0CB, 0x00000000, -+ 0x0CC, 0x00000000, -+ 0x0CD, 0x00000000, -+ 0x0CE, 0x00090C00, -+ 0x0CF, 0x0006D200, -+ 0x0DF, 0x00000009, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00010000, -+ 0x033, 0x00000058, -+ 0x03F, 0x0000001C, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00010000, -+ 0x033, 0x00000058, -+ 0x03F, 0x0000001C, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00010000, -+ 0x033, 0x00000058, -+ 0x03F, 0x0000001C, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00010000, -+ 0x033, 0x00000058, -+ 0x03F, 0x0000001C, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00010524, -+ 0x081, 0x0000FCC1, -+ 0x089, 0x00000004, -+ 0x08A, 0x0008A186, -+ 0x08B, 0x0006FFFC, -+ 0x08C, 0x000312C7, -+ 0x08D, 0x00020888, -+ 0x08E, 0x00064140, -+ 0x08F, 0x000A8010, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00010524, -+ 0x081, 0x0000FCC1, -+ 0x089, 0x00000004, -+ 0x08A, 0x0008A186, -+ 0x08B, 0x0006FFFC, -+ 0x08C, 0x000312C7, -+ 0x08D, 0x00020888, -+ 0x08E, 0x00064140, -+ 0x08F, 0x000A8010, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00010524, -+ 0x081, 0x0000FCC1, -+ 0x089, 0x00000004, -+ 0x08A, 0x0008A186, -+ 0x08B, 0x0007060C, -+ 0x08C, 0x000312C7, -+ 0x08D, 0x00020888, -+ 0x08E, 0x00064140, -+ 0x08F, 0x000A8010, -+ 0xA0000000, 0x00000000, -+ 0x018, 0x00010524, -+ 0x081, 0x0000FCC1, -+ 0x089, 0x00000004, -+ 0x08A, 0x0008A186, -+ 0x08B, 0x0007060C, -+ 0x08C, 0x000312C7, -+ 0x08D, 0x00020888, -+ 0x08E, 0x00064140, -+ 0x08F, 0x000A8010, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000020, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000020, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DD, 0x00000020, -+ 0xA0000000, 0x00000000, -+ 0x0DD, 0x00000020, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00020000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000006, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000005, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000004, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000003, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000002, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000001, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000000, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000006, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000005, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000004, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000003, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000002, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000001, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000000, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000006, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000005, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000004, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000003, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000002, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000001, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000000, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0xA0000000, 0x00000000, -+ 0x033, 0x00000007, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000006, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000005, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000004, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000003, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000002, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000001, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000000, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000D, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000009, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000008, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000D, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000009, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000008, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000D, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000009, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000008, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0xA0000000, 0x00000000, -+ 0x033, 0x0000000F, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000E, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000D, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000C, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000B, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x0000000A, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000009, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000008, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000016, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000015, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000014, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000013, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000012, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000011, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000010, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000016, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000015, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000014, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000013, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000012, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000011, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000010, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000016, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000015, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000014, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000013, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000012, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000011, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000010, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x033, 0x00000017, -+ 0x03E, 0x00038000, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000016, -+ 0x03E, 0x00038080, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000015, -+ 0x03E, 0x000380C8, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000014, -+ 0x03E, 0x00038190, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000013, -+ 0x03E, 0x00038998, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000012, -+ 0x03E, 0x00039840, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000011, -+ 0x03E, 0x000398C4, -+ 0x03F, 0x000C3186, -+ 0x033, 0x00000010, -+ 0x03E, 0x00039930, -+ 0x03F, 0x000C3186, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00004000, -+ 0x033, 0x00000000, -+ 0x03F, 0x0000000F, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000000A, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000005, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00004000, -+ 0x033, 0x00000000, -+ 0x03F, 0x0000000F, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000000A, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000005, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00004000, -+ 0x033, 0x00000000, -+ 0x03F, 0x0000000F, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000000A, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000005, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00004000, -+ 0x033, 0x00000000, -+ 0x03F, 0x0000000F, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000000A, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000005, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00000401, -+ 0x084, 0x00001209, -+ 0x086, 0x000001A0, -+ 0x087, 0x000E8180, -+ 0x088, 0x00006020, -+ 0x0DF, 0x00008009, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00000401, -+ 0x084, 0x00001209, -+ 0x086, 0x000001A0, -+ 0x087, 0x000E8180, -+ 0x088, 0x00006020, -+ 0x0DF, 0x00008009, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00000401, -+ 0x084, 0x00001209, -+ 0x086, 0x000001A0, -+ 0x087, 0x000E8180, -+ 0x088, 0x00006020, -+ 0x0DF, 0x00008009, -+ 0xA0000000, 0x00000000, -+ 0x018, 0x00000401, -+ 0x084, 0x00001209, -+ 0x086, 0x000001A0, -+ 0x087, 0x000E8180, -+ 0x088, 0x00006020, -+ 0x0DF, 0x00008009, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00008000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x0000003C, -+ 0x033, 0x0000000E, -+ 0x03F, 0x00000038, -+ 0x033, 0x0000000D, -+ 0x03F, 0x00000030, -+ 0x033, 0x0000000C, -+ 0x03F, 0x00000028, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000020, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00000018, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000010, -+ 0x033, 0x00000008, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000007, -+ 0x03F, 0x0000003C, -+ 0x033, 0x00000006, -+ 0x03F, 0x00000038, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000030, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000028, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000020, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000018, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000010, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000008, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00008000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x0000003C, -+ 0x033, 0x0000000E, -+ 0x03F, 0x00000038, -+ 0x033, 0x0000000D, -+ 0x03F, 0x00000030, -+ 0x033, 0x0000000C, -+ 0x03F, 0x00000028, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000020, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00000018, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000010, -+ 0x033, 0x00000008, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000007, -+ 0x03F, 0x0000003C, -+ 0x033, 0x00000006, -+ 0x03F, 0x00000038, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000030, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000028, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000020, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000018, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000010, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000008, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00008000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x0000003C, -+ 0x033, 0x0000000E, -+ 0x03F, 0x00000038, -+ 0x033, 0x0000000D, -+ 0x03F, 0x00000030, -+ 0x033, 0x0000000C, -+ 0x03F, 0x00000028, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000020, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00000018, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000010, -+ 0x033, 0x00000008, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000007, -+ 0x03F, 0x0000003C, -+ 0x033, 0x00000006, -+ 0x03F, 0x00000038, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000030, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000028, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000020, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000018, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000010, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000008, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00008000, -+ 0x033, 0x0000000F, -+ 0x03F, 0x0000003C, -+ 0x033, 0x0000000E, -+ 0x03F, 0x00000038, -+ 0x033, 0x0000000D, -+ 0x03F, 0x00000030, -+ 0x033, 0x0000000C, -+ 0x03F, 0x00000028, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00000020, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00000018, -+ 0x033, 0x00000009, -+ 0x03F, 0x00000010, -+ 0x033, 0x00000008, -+ 0x03F, 0x00000008, -+ 0x033, 0x00000007, -+ 0x03F, 0x0000003C, -+ 0x033, 0x00000006, -+ 0x03F, 0x00000038, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000030, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000028, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000020, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000018, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000010, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000008, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000002, -+ 0x033, 0x0000001E, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000001C, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000E, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000C, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00000002, -+ 0x033, 0x00000008, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000036, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000006, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000006, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000002, -+ 0x033, 0x0000001E, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000001C, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000E, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000C, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00000002, -+ 0x033, 0x00000008, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000036, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000006, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000006, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00000002, -+ 0x033, 0x0000001E, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000001C, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000E, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000C, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00000002, -+ 0x033, 0x00000008, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000036, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000006, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000006, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00000002, -+ 0x033, 0x0000001E, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000001C, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000E, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000C, -+ 0x03F, 0x00000000, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00000002, -+ 0x033, 0x00000008, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000036, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000037, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000034, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000006, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000006, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000006, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0A0, 0x000F0005, -+ 0x0A1, 0x0006C000, -+ 0x0A2, 0x0000161B, -+ 0x0A3, 0x000B9CBD, -+ 0x0AF, 0x00070000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0A0, 0x000F0005, -+ 0x0A1, 0x0006C000, -+ 0x0A2, 0x0000161B, -+ 0x0A3, 0x000B9CBD, -+ 0x0AF, 0x00070000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0A0, 0x000F0005, -+ 0x0A1, 0x0006C000, -+ 0x0A2, 0x0000161B, -+ 0x0A3, 0x000B9CBD, -+ 0x0AF, 0x00070000, -+ 0xA0000000, 0x00000000, -+ 0x0A0, 0x000F0005, -+ 0x0A1, 0x0006C000, -+ 0x0A2, 0x0000161B, -+ 0x0A3, 0x000B9CBD, -+ 0x0AF, 0x00070000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DE, 0x00000200, -+ 0x0EE, 0x00000100, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000043, -+ 0x033, 0x00000006, -+ 0x03F, 0x0000007A, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000041, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000079, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000043, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000007A, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000041, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000079, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DE, 0x00000200, -+ 0x0EE, 0x00000100, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000043, -+ 0x033, 0x00000006, -+ 0x03F, 0x0000007A, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000041, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000079, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000043, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000007A, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000041, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000079, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0DE, 0x00000200, -+ 0x0EE, 0x00000100, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000043, -+ 0x033, 0x00000006, -+ 0x03F, 0x0000007A, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000041, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000079, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000043, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000007A, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000041, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000079, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0DE, 0x00000200, -+ 0x0EE, 0x00000100, -+ 0x033, 0x00000007, -+ 0x03F, 0x00000043, -+ 0x033, 0x00000006, -+ 0x03F, 0x0000007A, -+ 0x033, 0x00000005, -+ 0x03F, 0x00000041, -+ 0x033, 0x00000004, -+ 0x03F, 0x00000079, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000043, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000007A, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000041, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000079, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B8, 0x00080A00, -+ 0x0B0, 0x000FF0FA, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B8, 0x00080A00, -+ 0x0B0, 0x000FF0FA, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B8, 0x00080A00, -+ 0x0B0, 0x000FF0FA, -+ 0xA0000000, 0x00000000, -+ 0x0B8, 0x00080A00, -+ 0x0B0, 0x000FF0FA, -+ 0xB0000000, 0x00000000, -+ 0xFFE, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0CA, 0x00080000, -+ 0x0C9, 0x0001C141, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0CA, 0x00080000, -+ 0x0C9, 0x0001C141, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0CA, 0x00080000, -+ 0x0C9, 0x0001C141, -+ 0xA0000000, 0x00000000, -+ 0x0CA, 0x00080000, -+ 0x0C9, 0x0001C141, -+ 0xB0000000, 0x00000000, -+ 0xFFE, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B0, 0x000FF0F8, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B0, 0x000FF0F8, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0B0, 0x000FF0F8, -+ 0xA0000000, 0x00000000, -+ 0x0B0, 0x000FF0F8, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00018D24, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00018D24, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00018D24, -+ 0xA0000000, 0x00000000, -+ 0x018, 0x00018D24, -+ 0xB0000000, 0x00000000, -+ 0xFFE, 0x00000000, -+ 0xFFE, 0x00000000, -+ 0xFFE, 0x00000000, -+ 0xFFE, 0x00000000, -+ 0xFFE, 0x00000000, -+ 0xFFE, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00010D24, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00010D24, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x018, 0x00010D24, -+ 0xA0000000, 0x00000000, -+ 0x018, 0x00010D24, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x01B, 0x00003A40, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x01B, 0x00003A40, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x01B, 0x00003A40, -+ 0xA0000000, 0x00000000, -+ 0x01B, 0x00003A40, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x0004D3A3, -+ 0x062, 0x0000D303, -+ 0x063, 0x00000002, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x0004D3A3, -+ 0x062, 0x0000D303, -+ 0x063, 0x00000002, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x061, 0x0004D3A1, -+ 0x062, 0x0000D3A3, -+ 0x063, 0x00000002, -+ 0xA0000000, 0x00000000, -+ 0x061, 0x0004D3A1, -+ 0x062, 0x0000D3A3, -+ 0x063, 0x00000002, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000200, -+ 0x030, 0x00000000, -+ 0x03F, 0x00033303, -+ 0x030, 0x00001000, -+ 0x03F, 0x00033303, -+ 0x030, 0x00002000, -+ 0x03F, 0x00033303, -+ 0x030, 0x00003000, -+ 0x03F, 0x00033303, -+ 0x030, 0x00004000, -+ 0x03F, 0x00033303, -+ 0x030, 0x00005000, -+ 0x03F, 0x00033303, -+ 0x030, 0x00006000, -+ 0x03F, 0x00033303, -+ 0x030, 0x00007000, -+ 0x03F, 0x00033303, -+ 0x030, 0x00008000, -+ 0x03F, 0x00033303, -+ 0x030, 0x00009000, -+ 0x03F, 0x00033303, -+ 0x030, 0x0000A000, -+ 0x03F, 0x00033303, -+ 0x030, 0x0000B000, -+ 0x03F, 0x00033303, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000200, -+ 0x030, 0x00000000, -+ 0x03F, 0x000333A3, -+ 0x030, 0x00001000, -+ 0x03F, 0x000333A3, -+ 0x030, 0x00002000, -+ 0x03F, 0x000333A3, -+ 0x030, 0x00003000, -+ 0x03F, 0x000333A3, -+ 0x030, 0x00004000, -+ 0x03F, 0x000313A3, -+ 0x030, 0x00005000, -+ 0x03F, 0x000313A3, -+ 0x030, 0x00006000, -+ 0x03F, 0x000313A3, -+ 0x030, 0x00007000, -+ 0x03F, 0x000313A3, -+ 0x030, 0x00008000, -+ 0x03F, 0x000333A3, -+ 0x030, 0x00009000, -+ 0x03F, 0x000333A3, -+ 0x030, 0x0000A000, -+ 0x03F, 0x000333A3, -+ 0x030, 0x0000B000, -+ 0x03F, 0x000333A3, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000200, -+ 0x030, 0x00000000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00001000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00002000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00003000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00004000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00005000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00006000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00007000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00008000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00009000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x0000A000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x0000B000, -+ 0x03F, 0x000335A3, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00000200, -+ 0x030, 0x00000000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00001000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00002000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00003000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00004000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00005000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00006000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00007000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00008000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x00009000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x0000A000, -+ 0x03F, 0x000335A3, -+ 0x030, 0x0000B000, -+ 0x03F, 0x000335A3, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000080, -+ 0x033, 0x00000000, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000001, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000002, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000003, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000004, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000005, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000006, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000007, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000008, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000009, -+ 0x03F, 0x00033303, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00033303, -+ 0x033, 0x0000000B, -+ 0x03F, 0x00033303, -+ 0x033, 0x0000000C, -+ 0x03F, 0x00033303, -+ 0x033, 0x0000000D, -+ 0x03F, 0x00033303, -+ 0x033, 0x0000000E, -+ 0x03F, 0x00033303, -+ 0x033, 0x0000000F, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000010, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000011, -+ 0x03F, 0x00033303, -+ 0x033, 0x00000012, -+ 0x03F, 0x00033303, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000080, -+ 0x033, 0x00000000, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000001, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000002, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000003, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000004, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000005, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000006, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000007, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000008, -+ 0x03F, 0x000313A3, -+ 0x033, 0x00000009, -+ 0x03F, 0x000313A3, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000313A3, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000313A3, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000313A3, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000333A3, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000333A3, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000010, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000011, -+ 0x03F, 0x000333A3, -+ 0x033, 0x00000012, -+ 0x03F, 0x000333A3, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000080, -+ 0x033, 0x00000000, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000001, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000002, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000003, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000004, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000005, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000006, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000007, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000008, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000009, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000010, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000011, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000012, -+ 0x03F, 0x000335A3, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00000080, -+ 0x033, 0x00000000, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000001, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000002, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000003, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000004, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000005, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000006, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000007, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000008, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000009, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000A, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000B, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000C, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000D, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000E, -+ 0x03F, 0x000335A3, -+ 0x033, 0x0000000F, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000010, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000011, -+ 0x03F, 0x000335A3, -+ 0x033, 0x00000012, -+ 0x03F, 0x000335A3, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000040, -+ 0x030, 0x00000644, -+ 0x030, 0x00001135, -+ 0x030, 0x00002133, -+ 0x030, 0x00004000, -+ 0x030, 0x00005000, -+ 0x030, 0x00006000, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000040, -+ 0x030, 0x00000644, -+ 0x030, 0x00001412, -+ 0x030, 0x00002202, -+ 0x030, 0x00004000, -+ 0x030, 0x00005000, -+ 0x030, 0x00006000, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000040, -+ 0x030, 0x00000640, -+ 0x030, 0x00001512, -+ 0x030, 0x00002202, -+ 0x030, 0x00004000, -+ 0x030, 0x00005000, -+ 0x030, 0x00006000, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00000040, -+ 0x030, 0x00000640, -+ 0x030, 0x00001512, -+ 0x030, 0x00002202, -+ 0x030, 0x00004000, -+ 0x030, 0x00005000, -+ 0x030, 0x00006000, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000800, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000800, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000800, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00000800, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000001, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000004, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000007, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000024, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000027, -+ 0x033, 0x00000025, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000026, -+ 0x03F, 0x0000002D, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000030, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000033, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000036, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000039, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000E42, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000E45, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000E65, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000E68, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000EE4, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000EE7, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000EEA, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000EED, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000EF0, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000EF3, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000EF6, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000E42, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000E45, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000E48, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000E68, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000E6B, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000EAA, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000EEA, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000EED, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000EF0, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000EF3, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000EF6, -+ 0xA0000000, 0x00000000, -+ 0x033, 0x00000020, -+ 0x03F, 0x00000E42, -+ 0x033, 0x00000021, -+ 0x03F, 0x00000E45, -+ 0x033, 0x00000022, -+ 0x03F, 0x00000E65, -+ 0x033, 0x00000023, -+ 0x03F, 0x00000E68, -+ 0x033, 0x00000024, -+ 0x03F, 0x00000EE4, -+ 0x033, 0x00000025, -+ 0x03F, 0x00000EE7, -+ 0x033, 0x00000026, -+ 0x03F, 0x00000EEA, -+ 0x033, 0x00000027, -+ 0x03F, 0x00000EED, -+ 0x033, 0x00000028, -+ 0x03F, 0x00000EF0, -+ 0x033, 0x00000029, -+ 0x03F, 0x00000EF3, -+ 0x033, 0x0000002A, -+ 0x03F, 0x00000EF6, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000001, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000004, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000007, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000024, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000027, -+ 0x033, 0x00000065, -+ 0x03F, 0x0000002A, -+ 0x033, 0x00000066, -+ 0x03F, 0x0000002D, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000030, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000033, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000036, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000039, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000E42, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000E45, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000E65, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000E68, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000EE5, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000EE8, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000EEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000EEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000EF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000EF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000EF7, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000E09, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000E43, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000E46, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000E49, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000E88, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000E8B, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000ECB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000ECE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000EF0, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000EF3, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000EF6, -+ 0xA0000000, 0x00000000, -+ 0x033, 0x00000060, -+ 0x03F, 0x00000E42, -+ 0x033, 0x00000061, -+ 0x03F, 0x00000E45, -+ 0x033, 0x00000062, -+ 0x03F, 0x00000E65, -+ 0x033, 0x00000063, -+ 0x03F, 0x00000E68, -+ 0x033, 0x00000064, -+ 0x03F, 0x00000EE5, -+ 0x033, 0x00000065, -+ 0x03F, 0x00000EE8, -+ 0x033, 0x00000066, -+ 0x03F, 0x00000EEB, -+ 0x033, 0x00000067, -+ 0x03F, 0x00000EEE, -+ 0x033, 0x00000068, -+ 0x03F, 0x00000EF1, -+ 0x033, 0x00000069, -+ 0x03F, 0x00000EF4, -+ 0x033, 0x0000006A, -+ 0x03F, 0x00000EF7, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x000000A0, -+ 0x03F, 0x00000001, -+ 0x033, 0x000000A1, -+ 0x03F, 0x00000004, -+ 0x033, 0x000000A2, -+ 0x03F, 0x00000007, -+ 0x033, 0x000000A3, -+ 0x03F, 0x00000025, -+ 0x033, 0x000000A4, -+ 0x03F, 0x00000028, -+ 0x033, 0x000000A5, -+ 0x03F, 0x0000002B, -+ 0x033, 0x000000A6, -+ 0x03F, 0x0000002E, -+ 0x033, 0x000000A7, -+ 0x03F, 0x00000031, -+ 0x033, 0x000000A8, -+ 0x03F, 0x00000034, -+ 0x033, 0x000000A9, -+ 0x03F, 0x00000037, -+ 0x033, 0x000000AA, -+ 0x03F, 0x0000003A, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x000000A0, -+ 0x03F, 0x00000E09, -+ 0x033, 0x000000A1, -+ 0x03F, 0x00000E43, -+ 0x033, 0x000000A2, -+ 0x03F, 0x00000E64, -+ 0x033, 0x000000A3, -+ 0x03F, 0x00000E67, -+ 0x033, 0x000000A4, -+ 0x03F, 0x00000EE4, -+ 0x033, 0x000000A5, -+ 0x03F, 0x00000EE7, -+ 0x033, 0x000000A6, -+ 0x03F, 0x00000EEA, -+ 0x033, 0x000000A7, -+ 0x03F, 0x00000EED, -+ 0x033, 0x000000A8, -+ 0x03F, 0x00000EF0, -+ 0x033, 0x000000A9, -+ 0x03F, 0x00000EF3, -+ 0x033, 0x000000AA, -+ 0x03F, 0x00000EF6, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x033, 0x000000A0, -+ 0x03F, 0x00000E08, -+ 0x033, 0x000000A1, -+ 0x03F, 0x00000E42, -+ 0x033, 0x000000A2, -+ 0x03F, 0x00000E45, -+ 0x033, 0x000000A3, -+ 0x03F, 0x00000E48, -+ 0x033, 0x000000A4, -+ 0x03F, 0x00000EA5, -+ 0x033, 0x000000A5, -+ 0x03F, 0x00000EA8, -+ 0x033, 0x000000A6, -+ 0x03F, 0x00000ECA, -+ 0x033, 0x000000A7, -+ 0x03F, 0x00000ECD, -+ 0x033, 0x000000A8, -+ 0x03F, 0x00000EEF, -+ 0x033, 0x000000A9, -+ 0x03F, 0x00000EF2, -+ 0x033, 0x000000AA, -+ 0x03F, 0x00000EF5, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x033, 0x000000A0, -+ 0x03F, 0x00000E09, -+ 0x033, 0x000000A1, -+ 0x03F, 0x00000E43, -+ 0x033, 0x000000A2, -+ 0x03F, 0x00000E64, -+ 0x033, 0x000000A3, -+ 0x03F, 0x00000E67, -+ 0x033, 0x000000A4, -+ 0x03F, 0x00000EE4, -+ 0x033, 0x000000A5, -+ 0x03F, 0x00000EE7, -+ 0x033, 0x000000A6, -+ 0x03F, 0x00000EEA, -+ 0x033, 0x000000A7, -+ 0x03F, 0x00000EED, -+ 0x033, 0x000000A8, -+ 0x03F, 0x00000EF0, -+ 0x033, 0x000000A9, -+ 0x03F, 0x00000EF3, -+ 0x033, 0x000000AA, -+ 0x03F, 0x00000EF6, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000400, -+ 0x033, 0x00000000, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000001, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000002, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000003, -+ 0x03F, 0x00086A00, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000400, -+ 0x033, 0x00000000, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000001, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000002, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000003, -+ 0x03F, 0x00086A00, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000400, -+ 0x033, 0x00000000, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000001, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000002, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000003, -+ 0x03F, 0x00086A00, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00000400, -+ 0x033, 0x00000000, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000001, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000002, -+ 0x03F, 0x0006AC00, -+ 0x033, 0x00000003, -+ 0x03F, 0x00086A00, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000040, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000040, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000040, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000040, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000040, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00040000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000001, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000002, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000003, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000004, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000005, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000006, -+ 0x03F, 0x00084A40, -+ 0x033, 0x00000007, -+ 0x03F, 0x00084A40, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00040000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000001, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000002, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000003, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000004, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000005, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000006, -+ 0x03F, 0x00084A40, -+ 0x033, 0x00000007, -+ 0x03F, 0x00084A40, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00040000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000001, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000002, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000003, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000004, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000005, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000006, -+ 0x03F, 0x00084A40, -+ 0x033, 0x00000007, -+ 0x03F, 0x00084A40, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00040000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000001, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000002, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000003, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000004, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000005, -+ 0x03F, 0x00086A40, -+ 0x033, 0x00000006, -+ 0x03F, 0x00084A40, -+ 0x033, 0x00000007, -+ 0x03F, 0x00084A40, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x051, 0x000801A8, -+ 0x052, 0x000972E3, -+ 0x053, 0x00008069, -+ 0x054, 0x00030032, -+ 0x055, 0x00082003, -+ 0x056, 0x00051CCB, -+ 0x057, 0x0000CFC2, -+ 0x058, 0x00000010, -+ 0x059, 0x00030000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x051, 0x000801A8, -+ 0x052, 0x000972E3, -+ 0x053, 0x00008069, -+ 0x054, 0x00030032, -+ 0x055, 0x00082003, -+ 0x056, 0x00051CCB, -+ 0x057, 0x0000CFC2, -+ 0x058, 0x00000010, -+ 0x059, 0x00030000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x051, 0x000801A8, -+ 0x052, 0x000972E3, -+ 0x053, 0x00008069, -+ 0x054, 0x00030032, -+ 0x055, 0x00082003, -+ 0x056, 0x00051CCB, -+ 0x057, 0x0000CFC2, -+ 0x058, 0x00000010, -+ 0x059, 0x00030000, -+ 0xA0000000, 0x00000000, -+ 0x051, 0x000801A8, -+ 0x052, 0x000972E3, -+ 0x053, 0x00008069, -+ 0x054, 0x00030032, -+ 0x055, 0x00082003, -+ 0x056, 0x00051CCB, -+ 0x057, 0x0000CFC2, -+ 0x058, 0x00000010, -+ 0x059, 0x00030000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000800, -+ 0x033, 0x00000000, -+ 0x03F, 0x00051429, -+ 0x033, 0x00000001, -+ 0x03F, 0x00051449, -+ 0x033, 0x00000002, -+ 0x03F, 0x0005144C, -+ 0x033, 0x00000003, -+ 0x03F, 0x00051C66, -+ 0x033, 0x00000004, -+ 0x03F, 0x00051C69, -+ 0x033, 0x00000005, -+ 0x03F, 0x00051C6C, -+ 0x033, 0x00000006, -+ 0x03F, 0x00051CE8, -+ 0x033, 0x00000007, -+ 0x03F, 0x00051CEB, -+ 0x033, 0x00000008, -+ 0x03F, 0x00051CEE, -+ 0x033, 0x00000009, -+ 0x03F, 0x00051CF1, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00051CF4, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000800, -+ 0x033, 0x00000000, -+ 0x03F, 0x00051429, -+ 0x033, 0x00000001, -+ 0x03F, 0x00051449, -+ 0x033, 0x00000002, -+ 0x03F, 0x0005144C, -+ 0x033, 0x00000003, -+ 0x03F, 0x00051C66, -+ 0x033, 0x00000004, -+ 0x03F, 0x00051C69, -+ 0x033, 0x00000005, -+ 0x03F, 0x00051C6C, -+ 0x033, 0x00000006, -+ 0x03F, 0x00051CE8, -+ 0x033, 0x00000007, -+ 0x03F, 0x00051CEB, -+ 0x033, 0x00000008, -+ 0x03F, 0x00051CEE, -+ 0x033, 0x00000009, -+ 0x03F, 0x00051CF1, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00051CF4, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000800, -+ 0x033, 0x00000000, -+ 0x03F, 0x00051427, -+ 0x033, 0x00000001, -+ 0x03F, 0x00051446, -+ 0x033, 0x00000002, -+ 0x03F, 0x00051449, -+ 0x033, 0x00000003, -+ 0x03F, 0x0005144C, -+ 0x033, 0x00000004, -+ 0x03F, 0x00051C67, -+ 0x033, 0x00000005, -+ 0x03F, 0x00051C6A, -+ 0x033, 0x00000006, -+ 0x03F, 0x00051C8B, -+ 0x033, 0x00000007, -+ 0x03F, 0x00051CE9, -+ 0x033, 0x00000008, -+ 0x03F, 0x00051CEC, -+ 0x033, 0x00000009, -+ 0x03F, 0x00051CEF, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00051CF2, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00000800, -+ 0x033, 0x00000000, -+ 0x03F, 0x00051427, -+ 0x033, 0x00000001, -+ 0x03F, 0x00051446, -+ 0x033, 0x00000002, -+ 0x03F, 0x00051449, -+ 0x033, 0x00000003, -+ 0x03F, 0x0005144C, -+ 0x033, 0x00000004, -+ 0x03F, 0x00051C67, -+ 0x033, 0x00000005, -+ 0x03F, 0x00051C6A, -+ 0x033, 0x00000006, -+ 0x03F, 0x00051C8B, -+ 0x033, 0x00000007, -+ 0x03F, 0x00051CE9, -+ 0x033, 0x00000008, -+ 0x03F, 0x00051CEC, -+ 0x033, 0x00000009, -+ 0x03F, 0x00051CEF, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00051CF2, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00004000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000001, -+ 0x03F, 0x00086E00, -+ 0x033, 0x00000002, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000003, -+ 0x03F, 0x00048400, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00004000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000001, -+ 0x03F, 0x00086E00, -+ 0x033, 0x00000002, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000003, -+ 0x03F, 0x00048400, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00004000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000001, -+ 0x03F, 0x00086E00, -+ 0x033, 0x00000002, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000003, -+ 0x03F, 0x00048400, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00004000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000001, -+ 0x03F, 0x00086E00, -+ 0x033, 0x00000002, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000003, -+ 0x03F, 0x00048400, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00002000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000000, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00002000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000000, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00002000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000000, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00002000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000001, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000002, -+ 0x03F, 0x00000000, -+ 0x033, 0x00000003, -+ 0x03F, 0x00000000, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00080000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000001, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000002, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000003, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000004, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000005, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000006, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000007, -+ 0x03F, 0x00048400, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00080000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000001, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000002, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000003, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000004, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000005, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000006, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000007, -+ 0x03F, 0x00048400, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00080000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000001, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000002, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000003, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000004, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000005, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000006, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000007, -+ 0x03F, 0x00048400, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00080000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000001, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000002, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000003, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000004, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000005, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000006, -+ 0x03F, 0x00048400, -+ 0x033, 0x00000007, -+ 0x03F, 0x00048400, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x070, 0x00008000, -+ 0x075, 0x000027DA, -+ 0x076, 0x00006997, -+ 0x077, 0x00070418, -+ 0x078, 0x000BB000, -+ 0x07D, 0x00007600, -+ 0x07F, 0x00000000, -+ 0x06A, 0x000F4C00, -+ 0x065, 0x00082030, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x070, 0x00008000, -+ 0x075, 0x000027DA, -+ 0x076, 0x00006997, -+ 0x077, 0x00070418, -+ 0x078, 0x000BB000, -+ 0x07D, 0x00007600, -+ 0x07F, 0x00000000, -+ 0x06A, 0x000F4C00, -+ 0x065, 0x00082030, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x070, 0x00008000, -+ 0x075, 0x000027DA, -+ 0x076, 0x00006997, -+ 0x077, 0x00070418, -+ 0x078, 0x000BB000, -+ 0x07D, 0x00007600, -+ 0x07F, 0x00000000, -+ 0x06A, 0x000F4C00, -+ 0x065, 0x00082030, -+ 0xA0000000, 0x00000000, -+ 0x070, 0x00008000, -+ 0x075, 0x000027DA, -+ 0x076, 0x00006997, -+ 0x077, 0x00070418, -+ 0x078, 0x000BB000, -+ 0x07D, 0x00007600, -+ 0x07F, 0x00000000, -+ 0x06A, 0x000F4C00, -+ 0x065, 0x00082030, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00008000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00051427, -+ 0x033, 0x00000001, -+ 0x03F, 0x00051446, -+ 0x033, 0x00000002, -+ 0x03F, 0x00051449, -+ 0x033, 0x00000003, -+ 0x03F, 0x0005144C, -+ 0x033, 0x00000004, -+ 0x03F, 0x00051C69, -+ 0x033, 0x00000005, -+ 0x03F, 0x00051C6C, -+ 0x033, 0x00000006, -+ 0x03F, 0x00051C8D, -+ 0x033, 0x00000007, -+ 0x03F, 0x00051CEB, -+ 0x033, 0x00000008, -+ 0x03F, 0x00051CEE, -+ 0x033, 0x00000009, -+ 0x03F, 0x00051CF1, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00051CF4, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00008000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00051427, -+ 0x033, 0x00000001, -+ 0x03F, 0x00051446, -+ 0x033, 0x00000002, -+ 0x03F, 0x00051449, -+ 0x033, 0x00000003, -+ 0x03F, 0x0005144C, -+ 0x033, 0x00000004, -+ 0x03F, 0x00051C69, -+ 0x033, 0x00000005, -+ 0x03F, 0x00051C6C, -+ 0x033, 0x00000006, -+ 0x03F, 0x00051C8D, -+ 0x033, 0x00000007, -+ 0x03F, 0x00051CEB, -+ 0x033, 0x00000008, -+ 0x03F, 0x00051CEE, -+ 0x033, 0x00000009, -+ 0x03F, 0x00051CF1, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00051CF4, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00008000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00051427, -+ 0x033, 0x00000001, -+ 0x03F, 0x00051446, -+ 0x033, 0x00000002, -+ 0x03F, 0x00051449, -+ 0x033, 0x00000003, -+ 0x03F, 0x0005144C, -+ 0x033, 0x00000004, -+ 0x03F, 0x00051C69, -+ 0x033, 0x00000005, -+ 0x03F, 0x00051C6C, -+ 0x033, 0x00000006, -+ 0x03F, 0x00051C8D, -+ 0x033, 0x00000007, -+ 0x03F, 0x00051CEB, -+ 0x033, 0x00000008, -+ 0x03F, 0x00051CEE, -+ 0x033, 0x00000009, -+ 0x03F, 0x00051CF1, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00051CF4, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00008000, -+ 0x033, 0x00000000, -+ 0x03F, 0x00051427, -+ 0x033, 0x00000001, -+ 0x03F, 0x00051446, -+ 0x033, 0x00000002, -+ 0x03F, 0x00051449, -+ 0x033, 0x00000003, -+ 0x03F, 0x0005144C, -+ 0x033, 0x00000004, -+ 0x03F, 0x00051C69, -+ 0x033, 0x00000005, -+ 0x03F, 0x00051C6C, -+ 0x033, 0x00000006, -+ 0x03F, 0x00051C8D, -+ 0x033, 0x00000007, -+ 0x03F, 0x00051CEB, -+ 0x033, 0x00000008, -+ 0x03F, 0x00051CEE, -+ 0x033, 0x00000009, -+ 0x03F, 0x00051CF1, -+ 0x033, 0x0000000A, -+ 0x03F, 0x00051CF4, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000010, -+ 0x033, 0x00000000, -+ 0x008, 0x0009C060, -+ 0x033, 0x00000001, -+ 0x008, 0x0009C060, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000010, -+ 0x033, 0x00000000, -+ 0x008, 0x0009C060, -+ 0x033, 0x00000001, -+ 0x008, 0x0009C060, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00000010, -+ 0x033, 0x00000000, -+ 0x008, 0x0009C060, -+ 0x033, 0x00000001, -+ 0x008, 0x0009C060, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00000010, -+ 0x033, 0x00000000, -+ 0x008, 0x0009C060, -+ 0x033, 0x00000001, -+ 0x008, 0x0009C060, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000024, -+ 0x03E, 0x0000003F, -+ 0x03F, 0x00060FDE, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000024, -+ 0x03E, 0x0000003F, -+ 0x03F, 0x00060FDE, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000024, -+ 0x03E, 0x0000003F, -+ 0x03F, 0x00060FDE, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000024, -+ 0x03E, 0x0000003F, -+ 0x03F, 0x00060FDE, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000037, -+ 0x03F, 0x0007EFCE, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000037, -+ 0x03F, 0x0007EFCE, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000037, -+ 0x03F, 0x0007EFCE, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000025, -+ 0x03E, 0x00000037, -+ 0x03F, 0x0007EFCE, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000037, -+ 0x03F, 0x0005EFCE, -+ 0x0EF, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000037, -+ 0x03F, 0x0005EFCE, -+ 0x0EF, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000037, -+ 0x03F, 0x0005EFCE, -+ 0x0EF, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000026, -+ 0x03E, 0x00000037, -+ 0x03F, 0x0005EFCE, -+ 0x0EF, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000004, -+ 0x03F, 0x00001EC1, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000004, -+ 0x03F, 0x00001EC1, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000004, -+ 0x03F, 0x00001EC1, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000004, -+ 0x03F, 0x00001EC1, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000005, -+ 0x03F, 0x00001ECF, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000005, -+ 0x03F, 0x00001ECF, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000005, -+ 0x03F, 0x00001ECF, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000005, -+ 0x03F, 0x00001ECF, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000006, -+ 0x03F, 0x00001F9D, -+ 0x0EE, 0x00000000, -+ 0x90001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000006, -+ 0x03F, 0x00001F9D, -+ 0x0EE, 0x00000000, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000006, -+ 0x03F, 0x00001F9D, -+ 0x0EE, 0x00000000, -+ 0xA0000000, 0x00000000, -+ 0x0EE, 0x00001000, -+ 0x033, 0x00000006, -+ 0x03F, 0x00001F9D, -+ 0x0EE, 0x00000000, -+ 0xB0000000, 0x00000000, -+ -+}; -+ -+void -+odm_read_and_config_mp_8821c_radioa(struct dm_struct *dm) -+{ -+ u32 i = 0; -+ u8 c_cond; -+ boolean is_matched = true, is_skipped = false; -+ u32 array_len = -+ sizeof(array_mp_8821c_radioa) / sizeof(u32); -+ u32 *array = (u32 *)array_mp_8821c_radioa; -+ -+ u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ u32 a1 = 0, a2 = 0, a3 = 0, a4 = 0; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+ while ((i + 1) < array_len) { -+ v1 = array[i]; -+ v2 = array[i + 1]; -+ -+ if (v1 & (BIT(31) | BIT(30))) {/*positive & negative condition*/ -+ if (v1 & BIT(31)) {/* positive condition*/ -+ c_cond = -+ (u8)((v1 & (BIT(29) | BIT(28))) >> 28); -+ if (c_cond == COND_ENDIF) {/*end*/ -+ is_matched = true; -+ is_skipped = false; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ENDIF\n"); -+ } else if (c_cond == COND_ELSE) { /*else*/ -+ is_matched = is_skipped ? false : true; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ELSE\n"); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "IF or ELSE IF\n"); -+ } -+ } else if (v1 & BIT(30)) { /*negative condition*/ -+ if (!is_skipped) { -+ a1 = pre_v1; a2 = pre_v2; -+ a3 = v1; a4 = v2; -+ if (check_positive(dm, -+ a1, a2, a3, a4)) { -+ is_matched = true; -+ is_skipped = true; -+ } else { -+ is_matched = false; -+ is_skipped = false; -+ } -+ } else { -+ is_matched = false; -+ } -+ } -+ } else { -+ if (is_matched) -+ odm_config_rf_radio_a_8821c(dm, v1, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u32 -+odm_get_version_mp_8821c_radioa(void) -+{ -+ return 64; -+} -+ -+/****************************************************************************** -+ * txpowertrack.TXT -+ ******************************************************************************/ -+ -+#ifdef CONFIG_8821C -+const u8 delta_swingidx_mp_5gb_n_txpwrtrk_8821c[][D_S_SIZE] = { -+ {0, 1, 1, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 8, 8, -+ 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 1, 2, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 8, 8, -+ 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, -+ 9, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}, -+}; -+ -+const u8 delta_swingidx_mp_5gb_p_txpwrtrk_8821c[][D_S_SIZE] = { -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, -+ 8, 9, 9, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 5, 6, 7, 7, 8, 8, 9, -+ 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 1, 2, 3, 3, 3, 4, 4, 4, 5, 6, 6, 7, 7, 8, -+ 8, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+}; -+ -+const u8 delta_swingidx_mp_5ga_n_txpwrtrk_8821c[][D_S_SIZE] = { -+ {0, 1, 1, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 8, 8, -+ 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 1, 2, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 8, 8, -+ 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, -+ 9, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}, -+}; -+ -+const u8 delta_swingidx_mp_5ga_p_txpwrtrk_8821c[][D_S_SIZE] = { -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, -+ 8, 9, 9, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 5, 6, 7, 7, 8, 8, 9, -+ 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 1, 2, 3, 3, 3, 4, 4, 4, 5, 6, 6, 7, 7, 8, -+ 8, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+}; -+ -+const u8 delta_swingidx_mp_2gb_n_txpwrtrk_8821c[] = { -+ 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 3, 4, 4, -+ 4, 4, 5, 5, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9}; -+const u8 delta_swingidx_mp_2gb_p_txpwrtrk_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 4, 4, 5, 5, -+ 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9}; -+const u8 delta_swingidx_mp_2ga_n_txpwrtrk_8821c[] = { -+ 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 3, 4, 4, -+ 4, 4, 5, 5, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9}; -+const u8 delta_swingidx_mp_2ga_p_txpwrtrk_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 4, 4, 5, 5, -+ 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_b_n_txpwrtrk_8821c[] = { -+ 0, 0, 1, 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3, 4, 4, -+ 4, 5, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_b_p_txpwrtrk_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, -+ 5, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_a_n_txpwrtrk_8821c[] = { -+ 0, 0, 1, 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3, 4, 4, -+ 4, 5, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_a_p_txpwrtrk_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, -+ 5, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9, 9, 9}; -+#endif -+ -+void -+odm_read_and_config_mp_8821c_txpowertrack(struct dm_struct *dm) -+{ -+#ifdef CONFIG_8821C -+ -+struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ -+PHYDM_DBG(dm, ODM_COMP_INIT, "===> ODM_ReadAndConfig_MP_mp_8821c\n"); -+ -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_p, -+ (void *)delta_swingidx_mp_2ga_p_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_n, -+ (void *)delta_swingidx_mp_2ga_n_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_p, -+ (void *)delta_swingidx_mp_2gb_p_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_n, -+ (void *)delta_swingidx_mp_2gb_n_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE); -+ -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_p, -+ (void *)delta_swingidx_mp_2g_cck_a_p_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_n, -+ (void *)delta_swingidx_mp_2g_cck_a_n_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_p, -+ (void *)delta_swingidx_mp_2g_cck_b_p_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_n, -+ (void *)delta_swingidx_mp_2g_cck_b_n_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE); -+ -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_p, -+ (void *)delta_swingidx_mp_5ga_p_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_n, -+ (void *)delta_swingidx_mp_5ga_n_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_p, -+ (void *)delta_swingidx_mp_5gb_p_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_n, -+ (void *)delta_swingidx_mp_5gb_n_txpwrtrk_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+#endif -+} -+ -+/****************************************************************************** -+ * txpowertrack_type0x20.TXT -+ ******************************************************************************/ -+ -+#ifdef CONFIG_8821C_TYPE0X20 -+const u8 delta_swingidx_mp_5gb_n_txpwrtrk_type0x20_8821c[][D_S_SIZE] = { -+ {0, 1, 1, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 8, 8, -+ 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 1, 2, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 8, 8, -+ 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, -+ 9, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}, -+}; -+ -+const u8 delta_swingidx_mp_5gb_p_txpwrtrk_type0x20_8821c[][D_S_SIZE] = { -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, -+ 8, 9, 9, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 5, 6, 7, 7, 8, 8, 9, -+ 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 1, 2, 3, 3, 3, 4, 4, 4, 5, 6, 6, 7, 7, 8, -+ 8, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+}; -+ -+const u8 delta_swingidx_mp_5ga_n_txpwrtrk_type0x20_8821c[][D_S_SIZE] = { -+ {0, 0, 1, 1, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 8, 8, -+ 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12}, -+ {0, 0, 1, 1, 2, 2, 3, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, -+ 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 2, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, -+ 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+}; -+ -+const u8 delta_swingidx_mp_5ga_p_txpwrtrk_type0x20_8821c[][D_S_SIZE] = { -+ {0, 1, 2, 2, 2, 3, 3, 4, 5, 5, 5, 6, 6, 7, 8, 8, 8, -+ 9, 9, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 2, 2, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, -+ 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 1, 2, 3, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 8, -+ 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+}; -+ -+const u8 delta_swingidx_mp_2gb_n_txpwrtrk_type0x20_8821c[] = { -+ 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 3, 4, 4, -+ 4, 4, 5, 5, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9}; -+const u8 delta_swingidx_mp_2gb_p_txpwrtrk_type0x20_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 4, 4, 5, 5, -+ 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9}; -+const u8 delta_swingidx_mp_2ga_n_txpwrtrk_type0x20_8821c[] = { -+ 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 3, 4, 4, -+ 4, 4, 5, 5, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9}; -+const u8 delta_swingidx_mp_2ga_p_txpwrtrk_type0x20_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 4, 4, 5, 5, -+ 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_b_n_txpwrtrk_type0x20_8821c[] = { -+ 0, 0, 1, 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3, 4, 4, -+ 4, 5, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_b_p_txpwrtrk_type0x20_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, -+ 5, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_a_n_txpwrtrk_type0x20_8821c[] = { -+ 0, 0, 1, 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3, 4, 4, -+ 4, 5, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_a_p_txpwrtrk_type0x20_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, -+ 5, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9, 9, 9}; -+#endif -+ -+void -+odm_read_and_config_mp_8821c_txpowertrack_type0x20(struct dm_struct *dm) -+{ -+#ifdef CONFIG_8821C_TYPE0X20 -+ -+struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ -+PHYDM_DBG(dm, ODM_COMP_INIT, "===> ODM_ReadAndConfig_MP_mp_8821c\n"); -+ -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_p, -+ (void *)delta_swingidx_mp_2ga_p_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_n, -+ (void *)delta_swingidx_mp_2ga_n_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_p, -+ (void *)delta_swingidx_mp_2gb_p_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_n, -+ (void *)delta_swingidx_mp_2gb_n_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE); -+ -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_p, -+ (void *)delta_swingidx_mp_2g_cck_a_p_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_n, -+ (void *)delta_swingidx_mp_2g_cck_a_n_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_p, -+ (void *)delta_swingidx_mp_2g_cck_b_p_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_n, -+ (void *)delta_swingidx_mp_2g_cck_b_n_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE); -+ -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_p, -+ (void *)delta_swingidx_mp_5ga_p_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_n, -+ (void *)delta_swingidx_mp_5ga_n_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_p, -+ (void *)delta_swingidx_mp_5gb_p_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_n, -+ (void *)delta_swingidx_mp_5gb_n_txpwrtrk_type0x20_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+#endif -+} -+ -+/****************************************************************************** -+ * txpowertrack_type0x28.TXT -+ ******************************************************************************/ -+ -+#ifdef CONFIG_8821C_TYPE0X28 -+const u8 delta_swingidx_mp_5gb_n_txpwrtrk_type0x28_8821c[][D_S_SIZE] = { -+ {0, 1, 1, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 8, 8, -+ 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 1, 2, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 8, 8, -+ 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, -+ 9, 9, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12}, -+}; -+ -+const u8 delta_swingidx_mp_5gb_p_txpwrtrk_type0x28_8821c[][D_S_SIZE] = { -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, -+ 8, 9, 9, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 5, 6, 7, 7, 8, 8, 9, -+ 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12, 12}, -+ {0, 1, 1, 1, 2, 3, 3, 3, 4, 4, 4, 5, 6, 6, 7, 7, 8, -+ 8, 9, 10, 10, 11, 11, 12, 12, 12, 12, 12, 12, 12}, -+}; -+ -+const u8 delta_swingidx_mp_5ga_n_txpwrtrk_type0x28_8821c[][D_S_SIZE] = { -+ {0, 1, 3, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 10, 11, 12, 12, -+ 12, 14, 15, 15, 16, 16, 17, 18, 18, 18, 18, 18, 18}, -+ {0, 1, 2, 3, 4, 4, 5, 7, 7, 8, 8, 9, 10, 10, 11, 12, 12, -+ 13, 14, 14, 15, 16, 16, 17, 18, 18, 18, 18, 18, 18}, -+ {0, 1, 2, 3, 4, 6, 6, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, -+ 13, 14, 14, 15, 16, 16, 17, 18, 18, 18, 18, 18, 18}, -+}; -+ -+const u8 delta_swingidx_mp_5ga_p_txpwrtrk_type0x28_8821c[][D_S_SIZE] = { -+ {0, 1, 2, 3, 3, 3, 4, 5, 7, 7, 8, 8, 9, 9, 10, 11, 12, -+ 12, 13, 14, 15, 16, 16, 17, 17, 17, 17, 17, 17, 17}, -+ {0, 1, 2, 3, 3, 4, 4, 5, 6, 7, 8, 9, 10, 10, 11, 13, 13, -+ 14, 15, 15, 16, 16, 17, 17, 17, 17, 17, 17, 17, 17}, -+ {0, 1, 2, 2, 3, 4, 4, 5, 6, 7, 7, 8, 8, 9, 10, 10, 11, -+ 12, 13, 14, 14, 14, 14, 15, 16, 16, 16, 16, 16, 16}, -+}; -+ -+const u8 delta_swingidx_mp_2gb_n_txpwrtrk_type0x28_8821c[] = { -+ 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 3, 4, 4, -+ 4, 4, 5, 5, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9}; -+const u8 delta_swingidx_mp_2gb_p_txpwrtrk_type0x28_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 4, 4, 5, 5, -+ 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9}; -+const u8 delta_swingidx_mp_2ga_n_txpwrtrk_type0x28_8821c[] = { -+ 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 3, 4, 4, -+ 4, 4, 5, 5, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9}; -+const u8 delta_swingidx_mp_2ga_p_txpwrtrk_type0x28_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 4, 4, 5, 5, -+ 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_b_n_txpwrtrk_type0x28_8821c[] = { -+ 0, 0, 1, 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3, 4, 4, -+ 4, 5, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_b_p_txpwrtrk_type0x28_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, -+ 5, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_a_n_txpwrtrk_type0x28_8821c[] = { -+ 0, 0, 1, 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3, 4, 4, -+ 4, 5, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 9}; -+const u8 delta_swingidx_mp_2g_cck_a_p_txpwrtrk_type0x28_8821c[] = { -+ 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, -+ 5, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9, 9, 9}; -+#endif -+ -+void -+odm_read_and_config_mp_8821c_txpowertrack_type0x28(struct dm_struct *dm) -+{ -+#ifdef CONFIG_8821C_TYPE0X28 -+ -+struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ -+PHYDM_DBG(dm, ODM_COMP_INIT, "===> ODM_ReadAndConfig_MP_mp_8821c\n"); -+ -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_p, -+ (void *)delta_swingidx_mp_2ga_p_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_n, -+ (void *)delta_swingidx_mp_2ga_n_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_p, -+ (void *)delta_swingidx_mp_2gb_p_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_n, -+ (void *)delta_swingidx_mp_2gb_n_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE); -+ -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_p, -+ (void *)delta_swingidx_mp_2g_cck_a_p_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_n, -+ (void *)delta_swingidx_mp_2g_cck_a_n_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_p, -+ (void *)delta_swingidx_mp_2g_cck_b_p_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_n, -+ (void *)delta_swingidx_mp_2g_cck_b_n_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE); -+ -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_p, -+ (void *)delta_swingidx_mp_5ga_p_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_n, -+ (void *)delta_swingidx_mp_5ga_n_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_p, -+ (void *)delta_swingidx_mp_5gb_p_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_n, -+ (void *)delta_swingidx_mp_5gb_n_txpwrtrk_type0x28_8821c, -+ DELTA_SWINGIDX_SIZE * 3); -+#endif -+} -+ -+/****************************************************************************** -+ * txpwr_lmt.TXT -+ ******************************************************************************/ -+ -+#ifdef CONFIG_8821C -+const struct txpwr_lmt_t_8821c array_mp_8821c_txpwr_lmt[] = { -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 16}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 31}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 7}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 29}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 29}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 29}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 22}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 21}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 21}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 21}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 29}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 29}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 29}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 28}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 25}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 28}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32} -+}; -+#endif -+ -+void -+odm_read_and_config_mp_8821c_txpwr_lmt(struct dm_struct *dm) -+{ -+#ifdef CONFIG_8821C -+ -+ int i = 0; -+ const struct txpwr_lmt_t_8821c *array = (const struct txpwr_lmt_t_8821c *)array_mp_8821c_txpwr_lmt; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+#define array_len sizeof(array_mp_8821c_txpwr_lmt)/sizeof(struct txpwr_lmt_t_8821c) -+ for (i = 0; i < array_len; i++) { -+ u8 regulation = array[i].reg; -+ u8 band = array[i].band; -+ u8 bandwidth = array[i].bw; -+ u8 rate = array[i].rs; -+ u8 rf_path = array[i].ntx; -+ u8 chnl = array[i].ch; -+ s8 val = array[i].val; -+ -+ odm_config_bb_txpwr_lmt_8821c_ex(dm, regulation, band, bandwidth, -+ rate, rf_path, chnl, val); -+ } -+ -+#endif -+} -+ -+/****************************************************************************** -+ * txpwr_lmt_fccsar.TXT -+ ******************************************************************************/ -+ -+#ifdef CONFIG_8821C_FCCSAR -+const struct txpwr_lmt_t_8821c array_mp_8821c_txpwr_lmt_fccsar[] = { -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 16}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 7}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 29}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 29}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 24}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 22}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 21}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 21}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 21}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 29}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 29}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 28}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 25}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 28}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32} -+}; -+#endif -+ -+void -+odm_read_and_config_mp_8821c_txpwr_lmt_fccsar(struct dm_struct *dm) -+{ -+#ifdef CONFIG_8821C_FCCSAR -+ -+ int i = 0; -+ const struct txpwr_lmt_t_8821c *array = (const struct txpwr_lmt_t_8821c *)array_mp_8821c_txpwr_lmt_fccsar; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+#define array_len sizeof(array_mp_8821c_txpwr_lmt)/sizeof(struct txpwr_lmt_t_8821c) -+ for (i = 0; i < array_len; i++) { -+ u8 regulation = array[i].reg; -+ u8 band = array[i].band; -+ u8 bandwidth = array[i].bw; -+ u8 rate = array[i].rs; -+ u8 rf_path = array[i].ntx; -+ u8 chnl = array[i].ch; -+ s8 val = array[i].val; -+ -+ odm_config_bb_txpwr_lmt_8821c_ex(dm, regulation, band, bandwidth, -+ rate, rf_path, chnl, val); -+ } -+ -+#endif -+} -+ -+/****************************************************************************** -+ * txpwr_lmt_icsar.TXT -+ ******************************************************************************/ -+ -+#ifdef CONFIG_8821C_ICSAR -+const struct txpwr_lmt_t_8821c array_mp_8821c_txpwr_lmt_icsar[] = { -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 16}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 31}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 7}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 29}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 29}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 24}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 22}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 21}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 21}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 21}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 29}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 29}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 28}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 25}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 28}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32} -+}; -+#endif -+ -+void -+odm_read_and_config_mp_8821c_txpwr_lmt_icsar(struct dm_struct *dm) -+{ -+#ifdef CONFIG_8821C_ICSAR -+ -+ int i = 0; -+ const struct txpwr_lmt_t_8821c *array = (const struct txpwr_lmt_t_8821c *)array_mp_8821c_txpwr_lmt_icsar; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+#define array_len sizeof(array_mp_8821c_txpwr_lmt)/sizeof(struct txpwr_lmt_t_8821c) -+ for (i = 0; i < array_len; i++) { -+ u8 regulation = array[i].reg; -+ u8 band = array[i].band; -+ u8 bandwidth = array[i].bw; -+ u8 rate = array[i].rs; -+ u8 rf_path = array[i].ntx; -+ u8 chnl = array[i].ch; -+ s8 val = array[i].val; -+ -+ odm_config_bb_txpwr_lmt_8821c_ex(dm, regulation, band, bandwidth, -+ rate, rf_path, chnl, val); -+ } -+ -+#endif -+} -+ -+/****************************************************************************** -+ * txpwr_lmt_lowpower.TXT -+ ******************************************************************************/ -+ -+#ifdef CONFIG_8821C_LOWPOWER -+const struct txpwr_lmt_t_8821c array_mp_8821c_txpwr_lmt_lowpower[] = { -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 29}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 29}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 31}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 4, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 5, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 6, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 7, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 8, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 11, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 22}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 22}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 12, 24}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 13}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 13}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_CCK, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 29}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 29}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 2, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 10, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 22}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 22}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 12, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 14}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 14}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 13, 16}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 29}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 29}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 31}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 34}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 25}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 25}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 22}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 22}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 34}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 34}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 12}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 1, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 2, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 24}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 24}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 3, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 25}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 25}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 4, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 26}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 26}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 5, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 6, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 24}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 24}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 7, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 24}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 24}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 8, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 23}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 23}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 9, 26}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 21}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 21}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 10, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 16}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 16}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 30}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 11, 20}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 12, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 13, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_2_4G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 14, 63}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 36, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 16}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 29}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 29}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 140, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 144, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_OFDM, PW_LMT_PH_1T, 165, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 36, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 40, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 29}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 44, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 48, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 7}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 52, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 56, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 60, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 64, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 100, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 104, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 108, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 112, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 116, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 120, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 124, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 128, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 132, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 136, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 140, 29}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 144, 27}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 149, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 153, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 157, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 161, 33}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 33}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_20M, PW_LMT_RS_HT, PW_LMT_PH_1T, 165, 30}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 21}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 21}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 38, 22}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 46, 31}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 22}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 54, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 21}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 21}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 62, 23}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 18}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 18}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 31}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 102, 21}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 110, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 118, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 126, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 31}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 31}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 134, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 29}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 29}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 142, 29}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 151, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_40M, PW_LMT_RS_HT, PW_LMT_PH_1T, 159, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 28}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 25}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 42, 19}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 19}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 28}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 19}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 28}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 58, 22}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 30}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 106, 18}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 63}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 26}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 122, 32}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 28}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 28}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 32}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 63}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 138, 28}, -+ {PW_LMT_REGU_FCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_ETSI, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, -63}, -+ {PW_LMT_REGU_MKK, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 63}, -+ {PW_LMT_REGU_IC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_KCC, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 27}, -+ {PW_LMT_REGU_ACMA, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_CHILE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32}, -+ {PW_LMT_REGU_UKRAINE, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 27}, -+ {PW_LMT_REGU_MEXICO, PW_LMT_BAND_5G, PW_LMT_BW_80M, PW_LMT_RS_VHT, PW_LMT_PH_1T, 155, 32} -+}; -+#endif -+ -+void -+odm_read_and_config_mp_8821c_txpwr_lmt_lowpower(struct dm_struct *dm) -+{ -+#ifdef CONFIG_8821C_LOWPOWER -+ -+ int i = 0; -+ const struct txpwr_lmt_t_8821c *array = (const struct txpwr_lmt_t_8821c *)array_mp_8821c_txpwr_lmt_lowpower; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+#define array_len sizeof(array_mp_8821c_txpwr_lmt)/sizeof(struct txpwr_lmt_t_8821c) -+ for (i = 0; i < array_len; i++) { -+ u8 regulation = array[i].reg; -+ u8 band = array[i].band; -+ u8 bandwidth = array[i].bw; -+ u8 rate = array[i].rs; -+ u8 rf_path = array[i].ntx; -+ u8 chnl = array[i].ch; -+ s8 val = array[i].val; -+ -+ odm_config_bb_txpwr_lmt_8821c_ex(dm, regulation, band, bandwidth, -+ rate, rf_path, chnl, val); -+ } -+ -+#endif -+} -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halhwimg8821c_rf.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halhwimg8821c_rf.h -new file mode 100644 -index 000000000..8e0de25cb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halhwimg8821c_rf.h -@@ -0,0 +1,155 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*Image2HeaderVersion: R3 1.5.10.1*/ -+#if (RTL8821C_SUPPORT == 1) -+#ifndef __INC_MP_RF_HW_IMG_8821C_H -+#define __INC_MP_RF_HW_IMG_8821C_H -+ -+/* Please add following compiler flags definition (#define CONFIG_XXX_DRV_DIS) -+ * into driver source code to reduce code size if necessary. -+ * #define CONFIG_8821C_DRV_DIS -+ * #define CONFIG_8821C_TYPE0X20_DRV_DIS -+ * #define CONFIG_8821C_TYPE0X28_DRV_DIS -+ * #define CONFIG_8821C_FCCSAR_DRV_DIS -+ * #define CONFIG_8821C_ICSAR_DRV_DIS -+ * #define CONFIG_8821C_LOWPOWER_DRV_DIS -+ */ -+ -+#define CONFIG_8821C -+#ifdef CONFIG_8821C_DRV_DIS -+ #undef CONFIG_8821C -+#endif -+ -+#define CONFIG_8821C_TYPE0X20 -+#ifdef CONFIG_8821C_TYPE0X20_DRV_DIS -+ #undef CONFIG_8821C_TYPE0X20 -+#endif -+ -+#define CONFIG_8821C_TYPE0X28 -+#ifdef CONFIG_8821C_TYPE0X28_DRV_DIS -+ #undef CONFIG_8821C_TYPE0X28 -+#endif -+ -+#define CONFIG_8821C_FCCSAR -+#ifdef CONFIG_8821C_FCCSAR_DRV_DIS -+ #undef CONFIG_8821C_FCCSAR -+#endif -+ -+#define CONFIG_8821C_ICSAR -+#ifdef CONFIG_8821C_ICSAR_DRV_DIS -+ #undef CONFIG_8821C_ICSAR -+#endif -+ -+#define CONFIG_8821C_LOWPOWER -+#ifdef CONFIG_8821C_LOWPOWER_DRV_DIS -+ #undef CONFIG_8821C_LOWPOWER -+#endif -+ -+struct txpwr_lmt_t_8821c { -+ u8 reg; -+ u8 band:1; -+ u8 bw:3; -+ u8 rs:2; -+ u8 ntx:2; -+ u8 ch; -+ s8 val; -+}; -+ -+/****************************************************************************** -+ * radioa.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_radioa(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_radioa(void); -+ -+/****************************************************************************** -+ * txpowertrack.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_txpowertrack(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_txpowertrack(void); -+ -+/****************************************************************************** -+ * txpowertrack_type0x20.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_txpowertrack_type0x20(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_txpowertrack_type0x20(void); -+ -+/****************************************************************************** -+ * txpowertrack_type0x28.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_txpowertrack_type0x28(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_txpowertrack_type0x28(void); -+ -+/****************************************************************************** -+ * txpwr_lmt.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_txpwr_lmt(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_txpwr_lmt(void); -+ -+/****************************************************************************** -+ * txpwr_lmt_fccsar.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_txpwr_lmt_fccsar(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_txpwr_lmt_fccsar(void); -+ -+/****************************************************************************** -+ * txpwr_lmt_icsar.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_txpwr_lmt_icsar(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_txpwr_lmt_icsar(void); -+ -+/****************************************************************************** -+ * txpwr_lmt_lowpower.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_txpwr_lmt_lowpower(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_txpwr_lmt_lowpower(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_8821c.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_8821c.c -new file mode 100644 -index 000000000..af4448201 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_8821c.c -@@ -0,0 +1,480 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if RT_PLATFORM == PLATFORM_MACOSX -+#include "phydm_precomp.h" -+#else -+#include "../phydm_precomp.h" -+#endif -+#else -+#include "../../phydm_precomp.h" -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+void halrf_rf_lna_setting_8821c(struct dm_struct *dm_void, -+ enum halrf_lna_set type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 path = 0x0; -+ -+ if (type == HALRF_LNA_DISABLE) { -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xef, BIT(19), 0x1); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x33, RFREGOFFSETMASK, 0x00003); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3e, RFREGOFFSETMASK, 0x00064); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3f, RFREGOFFSETMASK, 0x0afce); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xef, BIT(19), 0x0); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xee, BIT(12), 0x1); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x33, RFREGOFFSETMASK, 0x00003); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3e, RFREGOFFSETMASK, 0x00064); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3f, RFREGOFFSETMASK, 0x0280d); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xee, BIT(12), 0x0); -+ } else if (type == HALRF_LNA_ENABLE) { -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xef, BIT(19), 0x1); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x33, RFREGOFFSETMASK, 0x00003); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3e, RFREGOFFSETMASK, 0x00064); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3f, RFREGOFFSETMASK, 0x1afce); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xef, BIT(19), 0x0); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xee, BIT(12), 0x1); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x33, RFREGOFFSETMASK, 0x00003); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3e, RFREGOFFSETMASK, 0x00064); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3f, RFREGOFFSETMASK, 0x0281d); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xee, BIT(12), 0x0); -+ } -+} -+ -+boolean -+get_mix_mode_tx_agc_bbs_wing_offset_8821c(void *dm_void, -+ enum pwrtrack_method method, -+ u8 rf_path, -+ u8 tx_power_index_offest_upper_bound, -+ s8 tx_power_index_offest_lower_bound) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ -+ u8 bb_swing_upper_bound = cali_info->default_ofdm_index + 10; -+ u8 bb_swing_lower_bound = 0; -+ -+ s8 tx_agc_index = 0; -+ u8 tx_bb_swing_index = cali_info->default_ofdm_index; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "Path_%d pRF->absolute_ofdm_swing_idx[rf_path]=%d, tx_power_index_offest_upper_bound=%d, tx_power_index_offest_lower_bound=%d\n", -+ rf_path, cali_info->absolute_ofdm_swing_idx[rf_path], -+ tx_power_index_offest_upper_bound, -+ tx_power_index_offest_lower_bound); -+ -+ if (tx_power_index_offest_upper_bound > 0XF) -+ tx_power_index_offest_upper_bound = 0XF; -+ -+ if (tx_power_index_offest_lower_bound < -15) -+ tx_power_index_offest_lower_bound = -15; -+ -+ if (cali_info->absolute_ofdm_swing_idx[rf_path] >= 0 && cali_info->absolute_ofdm_swing_idx[rf_path] <= tx_power_index_offest_upper_bound) { -+ tx_agc_index = cali_info->absolute_ofdm_swing_idx[rf_path]; -+ tx_bb_swing_index = cali_info->default_ofdm_index; -+ } else if (cali_info->absolute_ofdm_swing_idx[rf_path] >= 0 && (cali_info->absolute_ofdm_swing_idx[rf_path] > tx_power_index_offest_upper_bound)) { -+ tx_agc_index = tx_power_index_offest_upper_bound; -+ cali_info->remnant_ofdm_swing_idx[rf_path] = cali_info->absolute_ofdm_swing_idx[rf_path] - tx_power_index_offest_upper_bound; -+ tx_bb_swing_index = cali_info->default_ofdm_index + cali_info->remnant_ofdm_swing_idx[rf_path]; -+ -+ if (tx_bb_swing_index > bb_swing_upper_bound) -+ tx_bb_swing_index = bb_swing_upper_bound; -+ } else if (cali_info->absolute_ofdm_swing_idx[rf_path] < 0 && (cali_info->absolute_ofdm_swing_idx[rf_path] >= tx_power_index_offest_lower_bound)) { -+ tx_agc_index = cali_info->absolute_ofdm_swing_idx[rf_path]; -+ tx_bb_swing_index = cali_info->default_ofdm_index; -+ } else if (cali_info->absolute_ofdm_swing_idx[rf_path] < 0 && (cali_info->absolute_ofdm_swing_idx[rf_path] < tx_power_index_offest_lower_bound)) { -+ tx_agc_index = tx_power_index_offest_lower_bound; -+ cali_info->remnant_ofdm_swing_idx[rf_path] = cali_info->absolute_ofdm_swing_idx[rf_path] - tx_power_index_offest_lower_bound; -+ -+ if (cali_info->default_ofdm_index > (cali_info->remnant_ofdm_swing_idx[rf_path] * (-1))) -+ tx_bb_swing_index = cali_info->default_ofdm_index + cali_info->remnant_ofdm_swing_idx[rf_path]; -+ else -+ tx_bb_swing_index = bb_swing_lower_bound; -+ } -+ -+ cali_info->absolute_ofdm_swing_idx[rf_path] = tx_agc_index; -+ cali_info->bb_swing_idx_ofdm[rf_path] = tx_bb_swing_index; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "MixMode Offset Path_%d pRF->absolute_ofdm_swing_idx[rf_path]=%d pRF->bb_swing_idx_ofdm[rf_path]=%d TxPwrIdxOffestUpper=%d TxPwrIdxOffestLower=%d\n", -+ rf_path, cali_info->absolute_ofdm_swing_idx[rf_path], -+ cali_info->bb_swing_idx_ofdm[rf_path], -+ tx_power_index_offest_upper_bound, -+ tx_power_index_offest_lower_bound); -+ -+ return true; -+} -+ -+void odm_tx_pwr_track_set_pwr8821c(void *dm_void, enum pwrtrack_method method, -+ u8 rf_path, u8 channel_mapped_index) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ struct _ADAPTER *adapter = dm->adapter; -+ u8 channel = *dm->channel; -+ u8 band_width = *dm->band_width; -+#endif -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u8 tx_power_index_offest_upper_bound = 0; -+ s8 tx_power_index_offest_lower_bound = 0; -+ u8 tx_power_index = 0; -+ u8 tx_rate = 0xFF; -+ -+ if (*dm->mp_mode) { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if (MP_DRIVER == 1) -+ PMPT_CONTEXT p_mpt_ctx = &adapter->MptCtx; -+ -+ tx_rate = MptToMgntRate(p_mpt_ctx->MptRateIndex); -+#endif -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+#ifdef CONFIG_MP_INCLUDED -+ PMPT_CONTEXT p_mpt_ctx = &(adapter->mppriv.mpt_ctx); -+ -+ tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); -+#endif -+#endif -+#endif -+ } else { -+ u16 rate = *dm->forced_data_rate; -+ -+ if (!rate) { /*auto rate*/ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ tx_rate = ((PADAPTER)adapter)->HalFunc.GetHwRateFromMRateHandler(dm->tx_rate); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ tx_rate = dm->tx_rate; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ if (dm->number_linked_client != 0) -+ tx_rate = hw_rate_to_m_rate(dm->tx_rate); -+ else -+ tx_rate = rf->p_rate_index; -+#endif -+ } else { /*force rate*/ -+ tx_rate = (u8)rate; -+ } -+ } -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Call:%s tx_rate=0x%X\n", __func__, -+ tx_rate); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "pRF->default_ofdm_index=%d pRF->default_cck_index=%d\n", -+ cali_info->default_ofdm_index, cali_info->default_cck_index); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "pRF->absolute_ofdm_swing_idx=%d pRF->remnant_ofdm_swing_idx=%d pRF->absolute_cck_swing_idx=%d pRF->remnant_cck_swing_idx=%d rf_path=%d\n", -+ cali_info->absolute_ofdm_swing_idx[rf_path], -+ cali_info->remnant_ofdm_swing_idx[rf_path], -+ cali_info->absolute_cck_swing_idx[rf_path], -+ cali_info->remnant_cck_swing_idx, rf_path); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ tx_power_index = odm_get_tx_power_index(dm, (enum rf_path)rf_path, tx_rate, band_width, channel); -+#else -+ tx_power_index = config_phydm_read_txagc_8821c(dm, rf_path, 0x04); /*0x04(TX_AGC_OFDM_6M)*/ -+#endif -+ -+ if (tx_power_index >= 63) -+ tx_power_index = 63; -+ -+ tx_power_index_offest_upper_bound = 63 - tx_power_index; -+ -+ tx_power_index_offest_lower_bound = 0 - tx_power_index; -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "tx_power_index=%d tx_power_index_offest_upper_bound=%d tx_power_index_offest_lower_bound=%d rf_path=%d\n", -+ tx_power_index, tx_power_index_offest_upper_bound, -+ tx_power_index_offest_lower_bound, rf_path); -+ -+ if (method == BBSWING) { /*use for mp driver clean power tracking status*/ -+ switch (rf_path) { -+ case RF_PATH_A: -+ odm_set_bb_reg(dm, R_0xc94, (BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1)), ((cali_info->absolute_ofdm_swing_idx[rf_path]) & 0x3f)); -+ odm_set_bb_reg(dm, REG_A_TX_SCALE_JAGUAR, 0xFFE00000, tx_scaling_table_jaguar[cali_info->bb_swing_idx_ofdm[rf_path]]); -+ break; -+ -+ default: -+ break; -+ } -+ -+ } else if (method == MIX_MODE) { -+ switch (rf_path) { -+ case RF_PATH_A: -+ get_mix_mode_tx_agc_bbs_wing_offset_8821c(dm, method, rf_path, tx_power_index_offest_upper_bound, tx_power_index_offest_lower_bound); -+ odm_set_bb_reg(dm, R_0xc94, (BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1)), ((cali_info->absolute_ofdm_swing_idx[rf_path]) & 0x3f)); -+ odm_set_bb_reg(dm, REG_A_TX_SCALE_JAGUAR, 0xFFE00000, tx_scaling_table_jaguar[cali_info->bb_swing_idx_ofdm[rf_path]]); -+ -+ RF_DBG(dm, DBG_RF_TX_PWR_TRACK, -+ "TXAGC(0xC94)=0x%x BBSwing(0xc1c)=0x%x BBSwingIndex=%d rf_path=%d\n", -+ odm_get_bb_reg(dm, R_0xc94, -+ (BIT(6) | BIT(5) | BIT(4) | -+ BIT(3) | BIT(2) | BIT(1))), -+ odm_get_bb_reg(dm, R_0xc1c, 0xFFE00000), -+ cali_info->bb_swing_idx_ofdm[rf_path], rf_path); -+ break; -+ -+ default: -+ break; -+ } -+ } -+} -+ -+void get_delta_swing_table_8821c(void *dm_void, -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ u8 **temperature_up_a, u8 **temperature_down_a, -+ u8 **temperature_up_b, u8 **temperature_down_b, -+ u8 **temperature_up_cck_a, -+ u8 **temperature_down_cck_a, -+ u8 **temperature_up_cck_b, -+ u8 **temperature_down_cck_b -+#else -+ u8 **temperature_up_a, u8 **temperature_down_a, -+ u8 **temperature_up_b, -+ u8 **temperature_down_b -+#endif -+ ) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ u8 channel = *(dm->channel); -+#else -+ u8 channel = *dm->channel; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ *temperature_up_cck_a = cali_info->delta_swing_table_idx_2g_cck_a_p; -+ *temperature_down_cck_a = cali_info->delta_swing_table_idx_2g_cck_a_n; -+ *temperature_up_cck_b = cali_info->delta_swing_table_idx_2g_cck_b_p; -+ *temperature_down_cck_b = cali_info->delta_swing_table_idx_2g_cck_b_n; -+#endif -+ -+ *temperature_up_a = cali_info->delta_swing_table_idx_2ga_p; -+ *temperature_down_a = cali_info->delta_swing_table_idx_2ga_n; -+ *temperature_up_b = cali_info->delta_swing_table_idx_2gb_p; -+ *temperature_down_b = cali_info->delta_swing_table_idx_2gb_n; -+ -+ if (channel >= 36 && channel <= 64) { -+ *temperature_up_a = cali_info->delta_swing_table_idx_5ga_p[0]; -+ *temperature_down_a = cali_info->delta_swing_table_idx_5ga_n[0]; -+ *temperature_up_b = cali_info->delta_swing_table_idx_5gb_p[0]; -+ *temperature_down_b = cali_info->delta_swing_table_idx_5gb_n[0]; -+ } else if (channel >= 100 && channel <= 144) { -+ *temperature_up_a = cali_info->delta_swing_table_idx_5ga_p[1]; -+ *temperature_down_a = cali_info->delta_swing_table_idx_5ga_n[1]; -+ *temperature_up_b = cali_info->delta_swing_table_idx_5gb_p[1]; -+ *temperature_down_b = cali_info->delta_swing_table_idx_5gb_n[1]; -+ } else if (channel >= 149 && channel <= 177) { -+ *temperature_up_a = cali_info->delta_swing_table_idx_5ga_p[2]; -+ *temperature_down_a = cali_info->delta_swing_table_idx_5ga_n[2]; -+ *temperature_up_b = cali_info->delta_swing_table_idx_5gb_p[2]; -+ *temperature_down_b = cali_info->delta_swing_table_idx_5gb_n[2]; -+ } -+} -+ -+void aac_check_8821c(struct dm_struct *dm) -+{ -+ struct _hal_rf_ *rf = &dm->rf_table; -+ u32 temp; -+ -+ if (!rf->aac_checked) { -+ RF_DBG(dm, DBG_RF_LCK, "[LCK]AAC check for 8821c\n"); -+ temp = odm_get_rf_reg(dm, RF_PATH_A, 0xc9, 0xf8); -+ if (temp < 4 || temp > 7) { -+ odm_set_rf_reg(dm, RF_PATH_A, 0xca, BIT(19), 0x0); -+ odm_set_rf_reg(dm, RF_PATH_A, 0xb2, 0x7c000, 0x6); -+ } -+ rf->aac_checked = true; -+ } -+} -+ -+void _phy_aac_calibrate_8821c(struct dm_struct *dm) -+{ -+#if 0 -+ u32 cnt = 0; -+ -+ RF_DBG(dm, DBG_RF_LCK, "[AACK]AACK start!!!!!!!\n"); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xb8, RFREGOFFSETMASK, 0x80a00); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xb0, RFREGOFFSETMASK, 0xff0fa); -+ ODM_delay_ms(10); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xca, RFREGOFFSETMASK, 0x80000); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xc9, RFREGOFFSETMASK, 0x1c141); -+ for (cnt = 0; cnt < 100; cnt++) { -+ ODM_delay_ms(1); -+ if (odm_get_rf_reg(dm, RF_PATH_A, RF_0xca, 0x1000) != 0x1) -+ break; -+ } -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xb0, RFREGOFFSETMASK, 0xff0f8); -+ -+ RF_DBG(dm, DBG_RF_IQK, "[AACK]AACK end!!!!!!!\n"); -+#endif -+} -+ -+boolean phy_lck_done_8821c(struct dm_struct *dm) -+{ -+ boolean lck_ok = false; -+ -+ if (odm_get_rf_reg(dm, RF_PATH_A, 0xc6, BIT(19)) == 0x0) -+ lck_ok = true; -+ return lck_ok; -+} -+ -+void _phy_lc_calibrate_8821c(struct dm_struct *dm) -+{ -+#if 0 -+ aac_check_8821c(dm); -+ RF_DBG(dm, DBG_RF_LCK, "[LCK]real-time LCK!!!!!!!\n"); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xcc, RFREGOFFSETMASK, 0x2018); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xc4, RFREGOFFSETMASK, 0x8f602); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xcc, RFREGOFFSETMASK, 0x201c); -+#endif -+#if 1 -+ u32 lc_cal = 0, cnt = 0, tmp0xc00; -+ /*RF to standby mode*/ -+ tmp0xc00 = odm_read_4byte(dm, 0xc00); -+ odm_write_4byte(dm, 0xc00, 0x4); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x0, RFREGOFFSETMASK, 0x10000); -+ -+ _phy_aac_calibrate_8821c(dm); -+ -+ /*backup RF0x18*/ -+ lc_cal = odm_get_rf_reg(dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK); -+ /*Start LCK*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, lc_cal | 0x08000); -+ ODM_delay_ms(50); -+ -+ for (cnt = 0; cnt < 100; cnt++) { -+ if (odm_get_rf_reg(dm, RF_PATH_A, RF_CHNLBW, 0x8000) != 0x1) -+ break; -+ ODM_delay_ms(10); -+ } -+ -+ /*Recover channel number*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, lc_cal); -+ /**restore*/ -+ odm_write_4byte(dm, 0xc00, tmp0xc00); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x0, RFREGOFFSETMASK, 0x3ffff); -+ RF_DBG(dm, DBG_RF_IQK, "[LCK]LCK end!!!!!!!\n"); -+#endif -+} -+ -+/*LCK:0x3*/ -+/*1. full LCK*/ -+void phy_lc_calibrate_8821c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ _phy_lc_calibrate_8821c(dm); -+} -+ -+void configure_txpower_track_8821c(struct txpwrtrack_cfg *config) -+{ -+ config->swing_table_size_cck = TXSCALE_TABLE_SIZE; -+ config->swing_table_size_ofdm = TXSCALE_TABLE_SIZE; -+ config->threshold_iqk = IQK_THRESHOLD; -+ config->threshold_dpk = DPK_THRESHOLD; -+ config->average_thermal_num = AVG_THERMAL_NUM_8821C; -+ config->rf_path_count = MAX_PATH_NUM_8821C; -+ config->thermal_reg_addr = RF_T_METER_8821C; -+ -+ config->odm_tx_pwr_track_set_pwr = odm_tx_pwr_track_set_pwr8821c; -+ config->do_iqk = do_iqk_8821c; -+ config->phy_lc_calibrate = halrf_lck_trigger; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ config->get_delta_all_swing_table = get_delta_swing_table_8821c; -+#else -+ config->get_delta_swing_table = get_delta_swing_table_8821c; -+#endif -+} -+ -+#if ((DM_ODM_SUPPORT_TYPE & ODM_AP) || (DM_ODM_SUPPORT_TYPE == ODM_CE)) -+void phy_set_rf_path_switch_8821c(struct dm_struct *dm, -+#else -+void phy_set_rf_path_switch_8821c(void *adapter, -+#endif -+ boolean is_main) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#endif -+#endif -+ u8 ant_num = 0; /*0: ANT_1, 1: ANT_2*/ -+ -+ if (is_main) -+ ant_num = SWITCH_TO_ANT1; /*Main = ANT_1*/ -+ else -+ ant_num = SWITCH_TO_ANT2; /*Aux = ANT_2*/ -+ -+ config_phydm_set_ant_path(dm, dm->current_rf_set_8821c, ant_num); -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+boolean _phy_query_rf_path_switch_8821c(struct dm_struct *dm -+#else -+boolean _phy_query_rf_path_switch_8821c(void *adapter -+#endif -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ struct dm_struct *dm = &hal_data->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#endif -+#endif -+ u8 ant_num = 0; /*0: ANT_1, 1: ANT_2*/ -+ -+ ODM_delay_ms(300); -+ -+ ant_num = query_phydm_current_ant_num_8821c(dm); -+ -+ if (ant_num == SWITCH_TO_ANT1) -+ return true; /*Main = ANT_1*/ -+ else -+ return false; /*Aux = ANT_2*/ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+boolean phy_query_rf_path_switch_8821c(struct dm_struct *dm -+#else -+boolean phy_query_rf_path_switch_8821c(void *adapter -+#endif -+ ) -+{ -+#if DISABLE_BB_RF -+ return true; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ return _phy_query_rf_path_switch_8821c(dm); -+#else -+ return _phy_query_rf_path_switch_8821c(adapter); -+#endif -+} -+ -+#endif /* (RTL8821C_SUPPORT == 0)*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_8821c.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_8821c.h -new file mode 100644 -index 000000000..921795992 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_8821c.h -@@ -0,0 +1,60 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALRF_8821C_H__ -+#define __HALRF_8821C_H__ -+ -+#define AVG_THERMAL_NUM_8821C 4 -+#define RF_T_METER_8821C 0x42 -+ -+void configure_txpower_track_8821c(struct txpwrtrack_cfg *config); -+ -+void odm_tx_pwr_track_set_pwr8821c(void *dm_void, enum pwrtrack_method method, -+ u8 rf_path, u8 channel_mapped_index); -+ -+void get_delta_swing_table_8821c(void *dm_void, -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ u8 **temperature_up_a, u8 **temperature_down_a, -+ u8 **temperature_up_b, u8 **temperature_down_b, -+ u8 **temperature_up_cck_a, -+ u8 **temperature_down_cck_a, -+ u8 **temperature_up_cck_b, -+ u8 **temperature_down_cck_b -+#else -+ u8 **temperature_up_a, u8 **temperature_down_a, -+ u8 **temperature_up_b, -+ u8 **temperature_down_b -+#endif -+ ); -+ -+void phy_lc_calibrate_8821c(void *dm_void); -+ -+void halrf_rf_lna_setting_8821c(struct dm_struct *dm, enum halrf_lna_set type); -+ -+#if ((DM_ODM_SUPPORT_TYPE & ODM_AP) || (DM_ODM_SUPPORT_TYPE == ODM_CE)) -+void phy_set_rf_path_switch_8821c(struct dm_struct *dm, -+#else -+void phy_set_rf_path_switch_8821c(void *adapter, -+#endif -+ boolean is_main); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+boolean phy_query_rf_path_switch_8821c(struct dm_struct *dm -+#else -+boolean phy_query_rf_path_switch_8821c(void *adapter -+#endif -+ ); -+ -+#endif /*#ifndef __HALRF_8821C_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_iqk_8821c.c b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_iqk_8821c.c -new file mode 100644 -index 000000000..15879c69f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_iqk_8821c.c -@@ -0,0 +1,3776 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if RT_PLATFORM == PLATFORM_MACOSX -+#include "phydm_precomp.h" -+#else -+#include "../phydm_precomp.h" -+#endif -+#else -+#include "../../phydm_precomp.h" -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+/*---------------------------Define Local Constant---------------------------*/ -+ -+static u32 dpk_result[DPK_BACKUP_REG_NUM_8821C]; -+static boolean txgap_done[3] = {false, false, false}; -+static boolean overflowflag; -+#define dpk_forcein_sram4 1 -+#define txgap_ref_index 0x0 -+#define txgap_k_number 0x7 -+ -+/*---------------------------Define Local Constant---------------------------*/ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+void do_iqk_8821c(void *dm_void, u8 delta_thermal_index, u8 thermal_value, -+ u8 threshold) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ dm->rf_calibrate_info.thermal_value_iqk = thermal_value; -+ halrf_segment_iqk_trigger(dm, true, iqk_info->segment_iqk); -+} -+#else -+/*Originally config->do_iqk is hooked phy_iq_calibrate_8821c, but do_iqk_8821c and phy_iq_calibrate_8821c have different arguments*/ -+void do_iqk_8821c(void *dm_void, u8 delta_thermal_index, u8 thermal_value, -+ u8 threshold) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ /*boolean is_recovery = (boolean) delta_thermal_index;*/ -+ halrf_segment_iqk_trigger(dm, true, iqk_info->segment_iqk); -+} -+#endif -+void do_dpk_8821c(void *dm_void, u8 delta_thermal_index, u8 thermal_value, -+ u8 threshold) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ /*boolean is_recovery = (boolean) delta_thermal_index;*/ -+ phy_dp_calibrate_8821c(dm, true); -+} -+ -+boolean -+_iqk_check_nctl_done_8821c(struct dm_struct *dm, u8 path, u32 IQK_CMD) -+{ -+ /*this function is only used after the version of nctl8.0*/ -+ boolean notready = true; -+ boolean fail = true; -+ u32 delay_count = 0x0; -+ -+ while (notready) { -+ if ((IQK_CMD & 0x00000f00) >> 8 == 0xc) { -+ if (odm_get_rf_reg(dm, path, RF_0x08, RFREGOFFSETMASK) == 0x1a3b5) -+ notready = false; -+ else -+ notready = true; -+ } else { -+ if (odm_get_rf_reg(dm, path, RF_0x08, RFREGOFFSETMASK) == 0x12345) -+ notready = false; -+ else -+ notready = true; -+ } -+ if (notready) { -+ /*ODM_sleep_ms(1);*/ -+ ODM_delay_us(10); -+ delay_count++; -+ } else { -+ fail = (boolean)odm_get_bb_reg(dm, R_0x1b08, BIT(26)); -+ if (fail) { -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK](1)IQK_CMD =0x%x, Fail, 0x1b08=0x%x, RF08=0x%x, 1b00=0x%x,fail=0x%x, notready=0x%x!!!\n", -+ IQK_CMD, odm_read_4byte(dm, 0x1b08), -+ odm_get_rf_reg(dm, path, RF_0x08, -+ RFREGOFFSETMASK), -+ odm_read_4byte(dm, 0x1b00), fail, -+ notready); -+ } -+ break; -+ } -+ if (delay_count >= 50000) { -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]S%d IQK timeout!!!\n", -+ path); -+ break; -+ } -+ } -+ odm_set_rf_reg(dm, path, RF_0x8, RFREGOFFSETMASK, 0x0); -+ -+ if (!fail) { -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]IQK_CMD =0x%x, delay_count =0x%x RF0x08=0x%x, 0x1b08=0x%x,RF0xef=0x%x,RF0xdf=0x%x, !!!\n", -+ IQK_CMD, delay_count, -+ odm_get_rf_reg(dm, path, RF_0x8, RFREGOFFSETMASK), -+ odm_read_4byte(dm, 0x1b08), -+ odm_get_rf_reg(dm, path, RF_0xef, RFREGOFFSETMASK), -+ odm_get_rf_reg(dm, path, RF_0xdf, RFREGOFFSETMASK)); -+ } else { -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK](2)IQK_CMD =0x%x, Fail, 0x1b08=0x%x, RF08=0x%x!!!\n", -+ IQK_CMD, odm_read_4byte(dm, 0x1b08), -+ odm_get_rf_reg(dm, path, RF_0x08, RFREGOFFSETMASK)); -+ } -+ return fail; -+} -+ -+void phydm_get_read_counter_8821c(struct dm_struct *dm) -+{ -+ u32 counter = 0x0; -+ -+ while (1) { -+ if ((odm_get_rf_reg(dm, RF_PATH_A, RF_0x8, RFREGOFFSETMASK) == 0xabcde) || counter > 300) -+ break; -+ counter++; -+ /*ODM_sleep_ms(1);*/ -+ ODM_delay_us(10); -+ }; -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x8, RFREGOFFSETMASK, 0x0); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]counter = %d\n", counter); -+} -+ -+void _iqk_check_coex_status(struct dm_struct *dm, boolean beforeK) -+{ -+ u8 u1b_tmp; -+ u16 count = 0; -+ u8 h2c_parameter; -+ -+ h2c_parameter = 1; -+ -+ if (beforeK) { -+ u1b_tmp = odm_read_1byte(dm, 0x49c); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]check 0x49c[0] = 0x%x before h2c 0x6d\n", u1b_tmp); -+ -+ /*check if BT IQK */ -+ u1b_tmp = odm_read_1byte(dm, 0x49c); -+ while ((u1b_tmp & BIT(1)) && (count < 100)) { -+ /*ODM_sleep_ms(10);*/ -+ ODM_delay_us(10); -+ u1b_tmp = odm_read_1byte(dm, 0x49c); -+ count++; -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]check 0x49c[1]=0x%x, count = %d\n", -+ u1b_tmp, count); -+ } -+#if 1 -+ odm_fill_h2c_cmd(dm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); -+ -+ u1b_tmp = odm_read_1byte(dm, 0x49c); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]check 0x49c[0] = 0x%x after h2c 0x6d\n", u1b_tmp); -+ -+ u1b_tmp = odm_read_1byte(dm, 0x49c); -+ /*check if WL IQK available form WL FW */ -+ while ((!(u1b_tmp & BIT(0))) && (count < 100)) { -+#if 0 -+ /*ODM_sleep_ms(10);*/ -+#endif -+ ODM_delay_us(10); -+ u1b_tmp = odm_read_1byte(dm, 0x49c); -+ count++; -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]check 0x49c[1]=0x%x, count = %d\n", -+ u1b_tmp, count); -+ } -+ -+ if (count >= 10000) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]Polling 0x49c to 1 for WiFi calibration H2C cmd FAIL! count(%d)\n", -+ count); -+#endif -+ -+ } else { -+ odm_set_bb_reg(dm, R_0x49c, BIT(0), 0x0); -+ } -+} -+ -+u32 _iqk_indirect_read_reg(struct dm_struct *dm, u16 reg_addr) -+{ -+ u32 j = 0; -+ -+ /*wait for ready bit before access 0x1700*/ -+ odm_write_4byte(dm, 0x1700, 0x800f0000 | reg_addr); -+ -+ do { -+ j++; -+ } while (((odm_read_1byte(dm, 0x1703) & BIT(5)) == 0) && (j < 30000)); -+ -+ return odm_read_4byte(dm, 0x1708); /*get read data*/ -+} -+ -+void _iqk_indirect_write_reg(struct dm_struct *dm, u16 reg_addr, u32 bit_mask, -+ u32 reg_value) -+{ -+ u32 val, i = 0, j = 0, bitpos = 0; -+ -+ if (bit_mask == 0x0) -+ return; -+ if (bit_mask == 0xffffffff) { -+ odm_write_4byte(dm, 0x1704, reg_value); /*put write data*/ -+ -+ /*wait for ready bit before access 0x1700*/ -+ do { -+ j++; -+ } while (((odm_read_1byte(dm, 0x1703) & BIT(5)) == 0) && (j < 30000)); -+ -+ odm_write_4byte(dm, 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 = _iqk_indirect_read_reg(dm, reg_addr); -+ val = (val & (~bit_mask)) | (reg_value << bitpos); -+ -+ odm_write_4byte(dm, 0x1704, val); /*put write data*/ -+ -+ /*wait for ready bit before access 0x1700*/ -+ do { -+ j++; -+ } while (((odm_read_1byte(dm, 0x1703) & BIT(5)) == 0) && (j < 30000)); -+ -+ odm_write_4byte(dm, 0x1700, 0xc00f0000 | reg_addr); -+ } -+} -+ -+void _iqk_set_gnt_wl_high(struct dm_struct *dm) -+{ -+ u32 val = 0; -+ u8 state = 0x1, sw_control = 0x1; -+ -+ /*GNT_WL = 1*/ -+ val = (sw_control) ? ((state << 1) | 0x1) : 0; -+ _iqk_indirect_write_reg(dm, 0x38, 0x3000, val); /*0x38[13:12]*/ -+ _iqk_indirect_write_reg(dm, 0x38, 0x0300, val); /*0x38[9:8]*/ -+} -+ -+void _iqk_set_gnt_bt_low(struct dm_struct *dm) -+{ -+ u32 val = 0; -+ u8 state = 0x0, sw_control = 0x1; -+ -+ /*GNT_BT = 0*/ -+ val = (sw_control) ? ((state << 1) | 0x1) : 0; -+ _iqk_indirect_write_reg(dm, 0x38, 0xc000, val); /*0x38[15:14]*/ -+ _iqk_indirect_write_reg(dm, 0x38, 0x0c00, val); /*0x38[11:10]*/ -+} -+ -+void _iqk_set_gnt_wl_gnt_bt(struct dm_struct *dm, boolean beforeK) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if (beforeK) { -+ _iqk_set_gnt_wl_high(dm); -+ _iqk_set_gnt_bt_low(dm); -+ } else { -+ _iqk_indirect_write_reg(dm, 0x38, MASKDWORD, iqk_info->tmp_gntwl); -+ } -+} -+ -+void _iqk_fail_count_8821c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 i; -+ -+ dm->n_iqk_cnt++; -+ if (odm_get_rf_reg(dm, RF_PATH_A, RF_0x1bf0, BIT(16)) == 1) -+ iqk_info->is_reload = true; -+ else -+ iqk_info->is_reload = false; -+ -+ if (!iqk_info->is_reload) { -+ for (i = 0; i < 8; i++) { -+ if (odm_get_bb_reg(dm, R_0x1bf0, BIT(i)) == 1) -+ dm->n_iqk_fail_cnt++; -+ } -+ } -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]All/Fail = %d %d\n", dm->n_iqk_cnt, -+ dm->n_iqk_fail_cnt); -+} -+ -+void _iqk_fill_iqk_report_8821c(void *dm_void, u8 channel) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u32 tmp1 = 0x0, tmp2 = 0x0, tmp3 = 0x0; -+ u8 i; -+ -+ for (i = 0; i < SS_8821C; i++) { -+ tmp1 = tmp1 + ((iqk_info->iqk_fail_report[channel][i][TX_IQK] & 0x1) << i); -+ tmp2 = tmp2 + ((iqk_info->iqk_fail_report[channel][i][RX_IQK] & 0x1) << (i + 4)); -+ tmp3 = tmp3 + ((iqk_info->rxiqk_fail_code[channel][i] & 0x3) << (i * 2 + 8)); -+ } -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ odm_set_bb_reg(dm, R_0x1bf0, 0x00ffffff, tmp1 | tmp2 | tmp3); -+ -+ for (i = 0; i < SS_8821C; i++) -+ odm_write_4byte(dm, 0x1be8 + (i * 4), (iqk_info->rxiqk_agc[channel][(i * 2) + 1] << 16) | iqk_info->rxiqk_agc[channel][i * 2]); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK] 0x1be8 = %x\n", -+ odm_read_4byte(dm, 0x1be8)); -+} -+ -+void _iqk_iqk_fail_report_8821c(struct dm_struct *dm) -+{ -+ u32 tmp1bf0 = 0x0; -+ u8 i; -+ -+ tmp1bf0 = odm_read_4byte(dm, 0x1bf0); -+ -+ for (i = 0; i < 4; i++) { -+ if (tmp1bf0 & (0x1 << i)) -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ RF_DBG(dm, DBG_RF_IQK, "[IQK] please check S%d TXIQK\n", -+ i); -+#else -+ panic_printk("[IQK] please check S%d TXIQK\n", i); -+#endif -+ if (tmp1bf0 & (0x1 << (i + 12))) -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ RF_DBG(dm, DBG_RF_IQK, "[IQK] please check S%d RXIQK\n", -+ i); -+#else -+ panic_printk("[IQK] please check S%d RXIQK\n", i); -+#endif -+ } -+} -+ -+void _iqk_backup_mac_bb_8821c(struct dm_struct *dm, u32 *MAC_backup, -+ u32 *BB_backup, u32 *backup_mac_reg, -+ u32 *backup_bb_reg, u8 num_backup_bb_reg) -+{ -+ u32 i; -+ -+ for (i = 0; i < MAC_REG_NUM_8821C; i++) -+ MAC_backup[i] = odm_read_4byte(dm, backup_mac_reg[i]); -+ -+ for (i = 0; i < num_backup_bb_reg; i++) -+ BB_backup[i] = odm_read_4byte(dm, backup_bb_reg[i]); -+#if 0 -+ /* RF_DBG(dm, DBG_RF_IQK, "[IQK]BackupMacBB Success!!!!\n"); */ -+#endif -+} -+ -+void _iqk_backup_rf_8821c(struct dm_struct *dm, u32 RF_backup[][SS_8821C], -+ u32 *backup_rf_reg) -+{ -+ u32 i, j; -+ -+ for (i = 0; i < RF_REG_NUM_8821C; i++) -+ for (j = 0; j < SS_8821C; j++) -+ RF_backup[i][j] = odm_get_rf_reg(dm, (u8)j, backup_rf_reg[i], RFREGOFFSETMASK); -+#if 0 -+ /* RF_DBG(dm, DBG_RF_IQK, "[IQK]BackupRF Success!!!!\n"); */ -+#endif -+} -+ -+void _iqk_agc_bnd_int_8821c(struct dm_struct *dm) -+{ -+ /*initialize RX AGC bnd, it must do after bbreset*/ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ odm_write_4byte(dm, 0x1b00, 0xf80a7008); -+ odm_write_4byte(dm, 0x1b00, 0xf8015008); -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+#if 0 -+ /*RF_DBG(dm, DBG_RF_IQK, "[IQK]init. rx agc bnd\n");*/ -+#endif -+} -+ -+void _iqk_bb_reset_8821c(struct dm_struct *dm) -+{ -+ boolean cca_ing = false; -+ u32 count = 0; -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x0, RFREGOFFSETMASK, 0x10000); -+ odm_set_bb_reg(dm, R_0x8f8, -+ BIT(27) | BIT26 | BIT25 | BIT24 | BIT23 | BIT22 | BIT21 | BIT20, 0x0); -+ -+ while (1) { -+ odm_write_4byte(dm, 0x8fc, 0x0); -+ odm_set_bb_reg(dm, R_0x198c, 0x7, 0x7); -+ cca_ing = (boolean)odm_get_bb_reg(dm, R_0xfa0, BIT(3)); -+ -+ if (count > 30) -+ cca_ing = false; -+ -+ if (cca_ing) { -+ ODM_sleep_ms(1); -+ count++; -+ } else { -+ odm_write_1byte(dm, 0x808, 0x0); /*RX ant off*/ -+ odm_set_bb_reg(dm, R_0xa04, BIT(27) | BIT26 | BIT25 | BIT24, 0x0); /*CCK RX path off*/ -+ -+ /*BBreset*/ -+ odm_set_bb_reg(dm, R_0x0, BIT(16), 0x0); -+ odm_set_bb_reg(dm, R_0x0, BIT(16), 0x1); -+ -+ if (odm_get_bb_reg(dm, R_0x660, BIT(16))) -+ odm_write_4byte(dm, 0x6b4, 0x89000006); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]BBreset!!!!\n"); -+ break; -+ } -+ } -+} -+ -+void _iqk_afe_setting_8821c(struct dm_struct *dm, boolean do_iqk) -+{ -+ if (do_iqk) { -+ /*IQK AFE setting RX_WAIT_CCA mode */ -+ odm_write_4byte(dm, 0xc60, 0x50000000); -+ odm_write_4byte(dm, 0xc60, 0x700F0040); -+ -+ /*AFE setting*/ -+ odm_write_4byte(dm, 0xc58, 0xd8000402); -+ odm_write_4byte(dm, 0xc5c, 0xd1000120); -+ odm_write_4byte(dm, 0xc6c, 0x00000a15); -+ _iqk_bb_reset_8821c(dm); -+#if 0 -+ /* RF_DBG(dm, DBG_RF_IQK, "[IQK]AFE setting for IQK mode!!!!\n"); */ -+#endif -+ } else { -+ /*IQK AFE setting RX_WAIT_CCA mode */ -+ odm_write_4byte(dm, 0xc60, 0x50000000); -+ odm_write_4byte(dm, 0xc60, 0x700B8040); -+ -+ /*AFE setting*/ -+ odm_write_4byte(dm, 0xc58, 0xd8020402); -+ odm_write_4byte(dm, 0xc5c, 0xde000120); -+ odm_write_4byte(dm, 0xc6c, 0x0000122a); -+#if 0 -+ /* RF_DBG(dm, DBG_RF_IQK, "[IQK]AFE setting for Normal mode!!!!\n"); */ -+#endif -+ } -+ /*0x9a4[31]=0: Select da clock*/ -+ odm_set_bb_reg(dm, R_0x9a4, BIT(31), 0x0); -+} -+ -+void _iqk_restore_mac_bb_8821c(struct dm_struct *dm, u32 *MAC_backup, -+ u32 *BB_backup, u32 *backup_mac_reg, -+ u32 *backup_bb_reg, u8 num_backup_bb_reg) -+{ -+ u32 i; -+ -+ for (i = 0; i < MAC_REG_NUM_8821C; i++) -+ odm_write_4byte(dm, backup_mac_reg[i], MAC_backup[i]); -+ for (i = 0; i < num_backup_bb_reg; i++) -+ odm_write_4byte(dm, backup_bb_reg[i], BB_backup[i]); -+#if 0 -+ /* RF_DBG(dm, DBG_RF_IQK, "[IQK]RestoreMacBB Success!!!!\n"); */ -+#endif -+} -+ -+void _iqk_restore_rf_8821c(struct dm_struct *dm, u32 *backup_rf_reg, -+ u32 RF_backup[][SS_8821C]) -+{ -+ u32 i; -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREGOFFSETMASK, 0x0); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xee, RFREGOFFSETMASK, 0x0); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, RF_backup[0][RF_PATH_A] & (~BIT(4))); -+#if 0 -+ /*odm_set_rf_reg(dm, RF_PATH_A, RF_0xde, RFREGOFFSETMASK, RF_backup[1][RF_PATH_A]|BIT(4));*/ -+#endif -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xde, RFREGOFFSETMASK, RF_backup[1][RF_PATH_A] & (~BIT(4))); -+ -+ for (i = 2; i < (RF_REG_NUM_8821C - 1); i++) -+ odm_set_rf_reg(dm, RF_PATH_A, backup_rf_reg[i], RFREGOFFSETMASK, RF_backup[i][RF_PATH_A]); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x1, RFREGOFFSETMASK, (RF_backup[4][RF_PATH_A] & (~BIT(0)))); -+#if 0 -+ /*RF_DBG(dm, DBG_RF_IQK, "[IQK]RestoreRF Success!!!!\n"); */ -+#endif -+} -+ -+void _iqk_backup_iqk_8821c(struct dm_struct *dm, u8 step, u8 path) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 i, j, k; -+#if 0 -+ /*u16 iqk_apply[2] = {0xc94, 0xe94};*/ -+#endif -+ -+ switch (step) { -+ case 0: -+ iqk_info->iqk_channel[1] = iqk_info->iqk_channel[0]; -+ for (i = 0; i < SS_8821C; i++) { -+ iqk_info->lok_idac[1][i] = iqk_info->lok_idac[0][i]; -+ iqk_info->rxiqk_agc[1][i] = iqk_info->rxiqk_agc[0][i]; -+ iqk_info->bypass_iqk[1][i] = iqk_info->bypass_iqk[0][i]; -+ iqk_info->rxiqk_fail_code[1][i] = iqk_info->rxiqk_fail_code[0][i]; -+ for (j = 0; j < 2; j++) { -+ iqk_info->iqk_fail_report[1][i][j] = iqk_info->iqk_fail_report[0][i][j]; -+ for (k = 0; k < 8; k++) { -+ iqk_info->iqk_cfir_real[1][i][j][k] = iqk_info->iqk_cfir_real[0][i][j][k]; -+ iqk_info->iqk_cfir_imag[1][i][j][k] = iqk_info->iqk_cfir_imag[0][i][j][k]; -+ } -+ } -+ } -+ for (i = 0; i < SS_8821C; i++) { -+ iqk_info->rxiqk_fail_code[0][i] = 0x0; -+ iqk_info->rxiqk_agc[0][i] = 0x0; -+ for (j = 0; j < 2; j++) { -+ iqk_info->iqk_fail_report[0][i][j] = true; -+ iqk_info->gs_retry_count[0][i][j] = 0x0; -+ } -+ for (j = 0; j < 3; j++) -+ iqk_info->retry_count[0][i][j] = 0x0; -+ } -+ /*backup channel*/ -+ iqk_info->iqk_channel[0] = iqk_info->rf_reg18; -+ break; -+ case 1: /*LOK backup*/ -+ iqk_info->lok_idac[0][path] = odm_get_rf_reg(dm, (enum rf_path)path, RF_0x58, RFREGOFFSETMASK); -+ break; -+ case 2: /*TXIQK backup*/ -+ case 3: /*RXIQK backup*/ -+ phydm_get_iqk_cfir(dm, (step - 2), path, false); -+ break; -+ } -+} -+ -+void _iqk_reload_iqk_setting_8821c(struct dm_struct *dm, u8 channel, -+ u8 reload_idx -+ /*1: reload TX, 2: reload TX, RX*/) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 i, path, idx; -+ u16 iqk_apply[2] = {0xc94, 0xe94}; -+ -+ for (path = 0; path < SS_8821C; path++) { -+#if 0 -+ if (reload_idx == 2) { -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xdf, BIT(4), 0x1); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x58, RFREGOFFSETMASK, iqk_info->lok_idac[channel][path]); -+ } -+#endif -+ for (idx = 0; idx < reload_idx; idx++) { -+ odm_set_bb_reg(dm, R_0x1b00, MASKDWORD, 0xf8000008 | path << 1); -+ odm_set_bb_reg(dm, R_0x1b2c, MASKDWORD, 0x7); -+ odm_set_bb_reg(dm, R_0x1b38, MASKDWORD, 0x20000000); -+ odm_set_bb_reg(dm, R_0x1b3c, MASKDWORD, 0x20000000); -+ odm_set_bb_reg(dm, R_0x1bcc, MASKDWORD, 0x00000000); -+ if (idx == 0) -+ odm_set_bb_reg(dm, R_0x1b0c, BIT(13) | BIT(12), 0x3); -+ else -+ odm_set_bb_reg(dm, R_0x1b0c, BIT(13) | BIT(12), 0x1); -+ odm_set_bb_reg(dm, R_0x1bd4, BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16), 0x10); -+ for (i = 0; i < 8; i++) { -+ odm_write_4byte(dm, 0x1bd8, ((0xc0000000 >> idx) + 0x3) + (i * 4) + (iqk_info->iqk_cfir_real[channel][path][idx][i] << 9)); -+ odm_write_4byte(dm, 0x1bd8, ((0xc0000000 >> idx) + 0x1) + (i * 4) + (iqk_info->iqk_cfir_imag[channel][path][idx][i] << 9)); -+ } -+ if (idx == 0) -+ odm_set_bb_reg(dm, iqk_apply[path], BIT(0), !(iqk_info->iqk_fail_report[channel][path][idx])); -+ else -+ odm_set_bb_reg(dm, iqk_apply[path], BIT(10), !(iqk_info->iqk_fail_report[channel][path][idx])); -+ } -+ odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, R_0x1b0c, BIT(13) | BIT(12), 0x0); -+ } -+} -+ -+boolean -+_iqk_reload_iqk_8821c(struct dm_struct *dm, boolean reset) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 i; -+ iqk_info->is_reload = false; -+ odm_set_bb_reg(dm, R_0x1bf0, BIT(16), 0x0); /*clear the reload flag*/ -+ -+ if (reset) { -+ for (i = 0; i < SS_8821C; i++) -+ iqk_info->iqk_channel[i] = 0x0; -+ } else { -+ iqk_info->rf_reg18 = odm_get_rf_reg(dm, RF_PATH_A, RF_0x18, RFREGOFFSETMASK); -+ -+ for (i = 0; i < SS_8821C; i++) { -+ if (iqk_info->rf_reg18 == iqk_info->iqk_channel[i]) { -+ _iqk_reload_iqk_setting_8821c(dm, i, 2); -+ _iqk_fill_iqk_report_8821c(dm, i); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]reload IQK result before!!!!\n"); -+ odm_set_bb_reg(dm, R_0x1bf0, BIT(16), 0x1); -+ iqk_info->is_reload = true; -+ } -+ } -+ } -+ -+ return iqk_info->is_reload; -+} -+ -+void _iqk_rfe_setting_8821c(struct dm_struct *dm, boolean ext_pa_on) -+{ -+ if (ext_pa_on) { -+ /*RFE setting*/ -+ odm_write_4byte(dm, 0xcb0, 0x77777777); -+ odm_write_4byte(dm, 0xcb4, 0x00007777); -+ odm_write_4byte(dm, 0xcbc, 0x0000083B); -+#if 0 -+ /*odm_write_4byte(dm, 0x1990, 0x00000c30);*/ -+#endif -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]external PA on!!!!\n"); -+ } else { -+ /*RFE setting*/ -+ odm_write_4byte(dm, 0xcb0, 0x77171117); -+ odm_write_4byte(dm, 0xcb4, 0x00001177); -+ odm_write_4byte(dm, 0xcbc, 0x00000404); -+#if 0 -+ /*odm_write_4byte(dm, 0x1990, 0x00000c30);*/ -+#endif -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]external PA off!!!!\n"); -+ } -+} -+ -+void _iqk_rfsetting_8821c(struct dm_struct *dm) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ u8 path; -+ u32 tmp; -+ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ odm_write_4byte(dm, 0x1bb8, 0x00000000); -+ -+ for (path = 0; path < SS_8821C; path++) { -+ /*0xdf:B11 = 1,B4 = 0, B1 = 1*/ -+ tmp = odm_get_rf_reg(dm, (enum rf_path)path, RF_0xdf, RFREGOFFSETMASK); -+ tmp = (tmp & (~BIT(4))) | BIT(1) | BIT(11); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xdf, RFREGOFFSETMASK, tmp); -+ -+ if (iqk_info->is_btg) { -+ tmp = odm_get_rf_reg(dm, RF_PATH_A, RF_0xde, RFREGOFFSETMASK); -+ tmp = (tmp & (~BIT(4))) | BIT(15); -+#if 0 -+ /*tmp = tmp|BIT(4)|BIT(15); //manual LOK value for A-cut*/ -+#endif -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xde, RFREGOFFSETMASK, tmp); -+ } -+ -+ if (!iqk_info->is_btg) { -+ /*WLAN_AG*/ -+ /*TX IQK mode init*/ -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xef, RFREGOFFSETMASK, 0x80000); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x33, RFREGOFFSETMASK, 0x00024); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3e, RFREGOFFSETMASK, 0x0003f); -+#if 0 -+ /*odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3f, RFREGOFFSETMASK, 0x60fde);*/ -+#endif -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3f, RFREGOFFSETMASK, 0xe0fde); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xef, RFREGOFFSETMASK, 0x00000); -+ if (*dm->band_type == ODM_BAND_5G) { -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xef, BIT(19), 0x1); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x33, RFREGOFFSETMASK, 0x00026); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3e, RFREGOFFSETMASK, 0x00037); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3f, RFREGOFFSETMASK, 0xdefce); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xef, BIT(19), 0x0); -+ } else { -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xef, BIT(19), 0x1); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x33, RFREGOFFSETMASK, 0x00026); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3e, RFREGOFFSETMASK, 0x00037); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3f, RFREGOFFSETMASK, 0x5efce); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xef, BIT(19), 0x0); -+ } -+ } else { -+ /*WLAN_BTG*/ -+ /*TX IQK mode init*/ -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xee, RFREGOFFSETMASK, 0x01000); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x33, RFREGOFFSETMASK, 0x00004); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0x3f, RFREGOFFSETMASK, 0x01ec1); -+ odm_set_rf_reg(dm, (enum rf_path)path, RF_0xee, RFREGOFFSETMASK, 0x00000); -+ } -+ } -+} -+ -+void _iqk_configure_macbb_8821c(struct dm_struct *dm) -+{ -+ /*MACBB register setting*/ -+ odm_write_1byte(dm, 0x522, 0x7f); -+ odm_set_bb_reg(dm, R_0x1518, BIT(16), 0x1); -+ odm_set_bb_reg(dm, R_0x550, BIT(11) | BIT(3), 0x0); -+ odm_set_bb_reg(dm, R_0x90c, BIT(15), 0x1); /*0x90c[15]=1: dac_buf reset selection*/ -+ -+ /*0xc94[0]=1, 0xe94[0]=1: Let tx from IQK*/ -+ odm_set_bb_reg(dm, R_0xc94, BIT(0), 0x1); -+ odm_set_bb_reg(dm, R_0xc94, (BIT(11) | BIT(10)), 0x1); -+ /* 3-wire off*/ -+ odm_write_4byte(dm, 0xc00, 0x00000004); -+ /*disable PMAC*/ -+ odm_set_bb_reg(dm, R_0xb00, BIT(8), 0x0); -+#if 0 -+ /* RF_DBG(dm, DBG_RF_IQK, "[IQK]Set MACBB setting for IQK!!!!\n");*/ -+#endif -+ /*disable CCK block*/ -+ odm_set_bb_reg(dm, R_0x808, BIT(28), 0x0); -+ /*disable OFDM CCA*/ -+ odm_set_bb_reg(dm, R_0x838, BIT(3) | BIT(2) | BIT(1), 0x7); -+ -+} -+ -+void _iqk_lok_setting_8821c(struct dm_struct *dm, u8 path, u8 pad_index) -+{ -+ u32 LOK0x56_2G = 0x50ef3; -+ u32 LOK0x56_5G = 0x50ee8; -+ u32 LOK0x33 = 0; -+ u32 LOK0x78 = 0xbcbba; -+ u32 tmp = 0; -+ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ LOK0x33 = pad_index; -+ /*add delay of MAC send packet*/ -+ -+ if (*dm->mp_mode) -+ odm_set_bb_reg(dm, R_0x810, BIT(7) | BIT(6) | BIT(5) | BIT(4), 0x8); -+ -+ if (iqk_info->is_btg) { -+ tmp = (LOK0x78 & 0x1c000) >> 14; -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ odm_write_4byte(dm, 0x1bcc, 0x1b); -+ odm_write_1byte(dm, 0x1b23, 0x00); -+ odm_write_1byte(dm, 0x1b2b, 0x80); -+ /*0x78[11:0] = IDAC value*/ -+ LOK0x78 = LOK0x78 & (0xe3fff | ((u32)pad_index << 14)); -+ odm_set_rf_reg(dm, path, RF_0x78, RFREGOFFSETMASK, LOK0x78); -+ odm_set_rf_reg(dm, path, RF_0x5c, RFREGOFFSETMASK, 0x05320); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xac018); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xee, BIT(4), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, BIT(3), 0x0); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK] In the BTG\n"); -+ } else { -+ /*tmp = (LOK0x56 & 0xe0) >> 5;*/ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ odm_write_4byte(dm, 0x1bcc, 0x9); -+ odm_write_1byte(dm, 0x1b23, 0x00); -+ -+ switch (*dm->band_type) { -+ case ODM_BAND_2_4G: -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ LOK0x56_2G = LOK0x56_2G & (0xfff1f | ((u32)pad_index << 5)); -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, LOK0x56_2G); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xadc18); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(4), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, BIT(3), 0x0); -+ break; -+ case ODM_BAND_5G: -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ LOK0x56_5G = LOK0x56_5G & (0xfff1f | ((u32)pad_index << 5)); -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, LOK0x56_5G); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xadc18); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(4), 0x1); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, BIT(3), 0x1); -+ break; -+ } -+ } -+ /*for IDAC LUT by PAD idx*/ -+ odm_set_rf_reg(dm, path, RF_0x33, BIT(2) | BIT(1) | BIT(0), LOK0x33); -+#if 0 -+ /* RF_DBG(dm, DBG_RF_IQK, "[IQK]Set LOK setting!!!!\n");*/ -+#endif -+} -+ -+void _iqk_txk_setting_8821c(struct dm_struct *dm, u8 path) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if (iqk_info->is_btg) { -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ odm_write_4byte(dm, 0x1bcc, 0x1b); -+ odm_write_4byte(dm, 0x1b20, 0x00840008); -+ -+ /*0x78[11:0] = IDAC value*/ -+ odm_set_rf_reg(dm, path, RF_0x78, RFREGOFFSETMASK, 0xbcbba); -+ odm_set_rf_reg(dm, path, RF_0x5c, RFREGOFFSETMASK, 0x04320); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xac018); -+ odm_write_1byte(dm, 0x1b2b, 0x80); -+ } else { -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ odm_write_4byte(dm, 0x1bcc, 0x9); -+ odm_write_4byte(dm, 0x1b20, 0x01440008); -+ -+ switch (*dm->band_type) { -+ case ODM_BAND_2_4G: -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x50EF3); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xadc18); -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ break; -+ case ODM_BAND_5G: -+#if 0 -+ /*odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x50EF0);*/ -+ /*odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x50Ec8);*/ -+#endif -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x5004e); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa9c18); -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ break; -+ } -+ } -+#if 0 -+ /* RF_DBG(dm, DBG_RF_IQK, "[IQK]Set TXK setting!!!!\n");*/ -+#endif -+} -+ -+void _iqk_rxk1setting_8821c(struct dm_struct *dm, u8 path) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if (iqk_info->is_btg) { -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ odm_write_1byte(dm, 0x1b2b, 0x80); -+ odm_write_4byte(dm, 0x1bcc, 0x09); -+ odm_write_4byte(dm, 0x1b20, 0x01450008); -+ odm_write_4byte(dm, 0x1b24, 0x01460c88); -+ -+ /*0x78[11:0] = IDAC value*/ -+ odm_set_rf_reg(dm, path, RF_0x78, RFREGOFFSETMASK, 0x8cbba); -+ odm_set_rf_reg(dm, path, RF_0x5c, RFREGOFFSETMASK, 0x00320); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa8018); -+ } else { -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ switch (*dm->band_type) { -+ case ODM_BAND_2_4G: -+ odm_write_1byte(dm, 0x1bcc, 0x12); -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ odm_write_4byte(dm, 0x1b20, 0x01450008); -+ odm_write_4byte(dm, 0x1b24, 0x01461068); -+ -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x510f3); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa9c00); -+ break; -+ case ODM_BAND_5G: -+ odm_write_1byte(dm, 0x1bcc, 0x9); -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ odm_write_4byte(dm, 0x1b20, 0x00450008); -+ odm_write_4byte(dm, 0x1b24, 0x00461468); -+ -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x510f3); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa9c00); -+ break; -+ } -+ } -+#if 0 -+ /*RF_DBG(dm, DBG_RF_IQK, "[IQK]Set RXK setting!!!!\n");*/ -+#endif -+} -+ -+static u8 btg_lna[5] = {0x0, 0x4, 0x8, 0xc, 0xf}; -+static u8 wlg_lna[5] = {0x0, 0x1, 0x2, 0x3, 0x5}; -+static u8 wla_lna[5] = {0x0, 0x1, 0x3, 0x4, 0x5}; -+ -+void _iqk_rxk2setting_8821c(struct dm_struct *dm, u8 path, boolean is_gs) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if (iqk_info->is_btg) { -+ if (is_gs) { -+ iqk_info->tmp1bcc = 0x1b; -+ iqk_info->lna_idx = 2; -+ } -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ odm_write_1byte(dm, 0x1b2b, 0x80); -+ odm_write_4byte(dm, 0x1bcc, iqk_info->tmp1bcc); -+ odm_write_4byte(dm, 0x1b20, 0x01450008); -+ odm_write_4byte(dm, 0x1b24, (0x01460048 | (btg_lna[iqk_info->lna_idx] << 10))); -+ /*0x78[11:0] = IDAC value*/ -+ odm_set_rf_reg(dm, path, RF_0x78, RFREGOFFSETMASK, 0x8cbba); -+ odm_set_rf_reg(dm, path, RF_0x5c, RFREGOFFSETMASK, 0x00320); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa8018); -+ } else { -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ switch (*dm->band_type) { -+ case ODM_BAND_2_4G: -+ if (is_gs) { -+ iqk_info->tmp1bcc = 0x12; -+ iqk_info->lna_idx = 2; -+ } -+ odm_write_1byte(dm, 0x1bcc, iqk_info->tmp1bcc); -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ odm_write_4byte(dm, 0x1b20, 0x01450008); -+ odm_write_4byte(dm, 0x1b24, (0x01460048 | (wlg_lna[iqk_info->lna_idx] << 10))); -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x510f3); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa9c00); -+ break; -+ case ODM_BAND_5G: -+ if (is_gs) { -+ /*iqk_info->tmp1bcc = 0x12;*/ -+ iqk_info->tmp1bcc = 0x09; -+ iqk_info->lna_idx = 2; -+ } -+ odm_write_1byte(dm, 0x1bcc, iqk_info->tmp1bcc); -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ odm_write_4byte(dm, 0x1b20, 0x00450008); -+ odm_write_4byte(dm, 0x1b24, (0x01460048 | (wla_lna[iqk_info->lna_idx] << 10))); -+#if 0 -+ /*odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x51000);*/ -+#endif -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x51060); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa9c00); -+ break; -+ } -+ } -+#if 0 -+ /* RF_DBG(dm, DBG_RF_IQK, "[IQK]Set RXK setting!!!!\n");*/ -+#endif -+} -+ -+boolean -+_iqk_check_cal_8821c(struct dm_struct *dm, u32 IQK_CMD) -+{ -+ boolean notready = true, fail = true; -+ u32 delay_count = 0x0; -+ -+ while (notready) { -+ if (odm_read_4byte(dm, 0x1b00) == (IQK_CMD & 0xffffff0f)) { -+ fail = (boolean)odm_get_bb_reg(dm, R_0x1b08, BIT(26)); -+ notready = false; -+ } else { -+#if 0 -+ /*ODM_sleep_ms(1);*/ -+#endif -+ ODM_delay_us(10); -+ delay_count++; -+ } -+ -+ if (delay_count >= 50000) { -+ fail = true; -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]IQK timeout!!!\n"); -+ break; -+ } -+ } -+#if 0 -+ /* -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]delay count = 0x%x!!!\n", delay_count); -+*/ -+#endif -+ return fail; -+} -+ -+boolean -+_iqk_rx_iqk_gain_search_fail_8821c(struct dm_struct *dm, u8 path, u8 step) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ boolean fail = true; -+ u32 IQK_CMD = 0x0, rf_reg0, tmp, rxbb; -+ u8 IQMUX[4] = {0x9, 0x12, 0x1b, 0x24}, *plna; -+ u8 idx; -+ /*u8 lna_setting[5];*/ -+ -+ if (iqk_info->is_btg) -+ plna = btg_lna; -+ else if (*dm->band_type == ODM_BAND_2_4G) -+ plna = wlg_lna; -+ else -+ plna = wla_lna; -+ -+ for (idx = 0; idx < 4; idx++) -+ if (iqk_info->tmp1bcc == IQMUX[idx]) -+ break; -+ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ odm_write_4byte(dm, 0x1bcc, iqk_info->tmp1bcc); -+ -+ if (step == RXIQK1) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]============ S%d RXIQK GainSearch ============\n", -+ iqk_info->is_btg); -+ -+ if (step == RXIQK1) -+ IQK_CMD = 0xf8000208 | (1 << (path + 4)); -+ else -+ IQK_CMD = 0xf8000308 | (1 << (path + 4)); -+ -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]S%d GS%d_Trigger = 0x%x\n", path, step, -+ IQK_CMD); -+ -+ _iqk_set_gnt_wl_gnt_bt(dm, true); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD + 0x1); -+#if 0 -+ /*ODM_sleep_ms(GS_delay_8821C);*/ -+#endif -+ fail = _iqk_check_cal_8821c(dm, IQK_CMD); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]check 0x49c = %x\n", -+ odm_read_1byte(dm, 0x49c)); -+ _iqk_set_gnt_wl_gnt_bt(dm, false); -+ -+ if (step == RXIQK2) { -+ rf_reg0 = odm_get_rf_reg(dm, (enum rf_path)path, RF_0x0, RFREGOFFSETMASK); -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]S%d ==> RF0x0 = 0x%x, tmp1bcc = 0x%x, idx = %d, 0x1b3c = 0x%x\n", -+ path, rf_reg0, iqk_info->tmp1bcc, idx, -+ odm_read_4byte(dm, 0x1b3c)); -+ tmp = (rf_reg0 & 0x1fe0) >> 5; -+ rxbb = tmp & 0x1f; -+#if 1 -+ -+ if (rxbb == 0x1) { -+ if (idx != 3) -+ idx++; -+ else if (iqk_info->lna_idx != 0x0) -+ iqk_info->lna_idx--; -+ else -+ iqk_info->isbnd = true; -+ fail = true; -+ } else if (rxbb == 0xa) { -+ if (idx != 0) -+ idx--; -+ else if (iqk_info->lna_idx != 0x4) -+ iqk_info->lna_idx++; -+ else -+ iqk_info->isbnd = true; -+ fail = true; -+ } else { -+ fail = false; -+ } -+ -+ if (iqk_info->isbnd) -+ fail = false; -+#endif -+ -+#if 0 -+ if (rxbb == 0x1) { -+ if (iqk_info->lna_idx != 0x0) -+ iqk_info->lna_idx--; -+ else if (idx != 3) -+ idx++; -+ else -+ iqk_info->isbnd = true; -+ fail = true; -+ } else if (rxbb == 0xa) { -+ if (idx != 0) -+ idx--; -+ else if (iqk_info->lna_idx != 0x7) -+ iqk_info->lna_idx++; -+ else -+ iqk_info->isbnd = true; -+ fail = true; -+ } else -+ fail = false; -+ -+ if (iqk_info->isbnd == true) -+ fail = false; -+#endif -+ iqk_info->tmp1bcc = IQMUX[idx]; -+ -+ if (fail) { -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ odm_write_4byte(dm, 0x1b24, (odm_read_4byte(dm, 0x1b24) & 0xffffc3ff) | (*(plna + iqk_info->lna_idx) << 10)); -+ } -+ } -+ return fail; -+} -+void _iqk_rxk2setting_by_toneindex_8821c(struct dm_struct *dm, u8 path, -+ boolean is_gs, u8 toneindex) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if (iqk_info->is_btg) { -+ iqk_info->tmp1bcc = 0x1b; -+ iqk_info->lna_idx = 2; -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ odm_write_1byte(dm, 0x1b2b, 0x80); -+ odm_write_4byte(dm, 0x1bcc, iqk_info->tmp1bcc); -+ odm_write_4byte(dm, 0x1b20, 0x01450008); -+ odm_write_4byte(dm, 0x1b24, (0x01460048 | (btg_lna[iqk_info->lna_idx] << 10))); -+ /*0x78[11:0] = IDAC value*/ -+ odm_set_rf_reg(dm, path, RF_0x78, RFREGOFFSETMASK, 0x8cbba); -+ odm_set_rf_reg(dm, path, RF_0x5c, RFREGOFFSETMASK, 0x00320); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa8018); -+ } else { -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ switch (*dm->band_type) { -+ case ODM_BAND_2_4G: -+ iqk_info->tmp1bcc = 0x12; -+ iqk_info->lna_idx = 2; -+ odm_write_1byte(dm, 0x1bcc, iqk_info->tmp1bcc); -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ odm_write_4byte(dm, 0x1b20, 0x01450008); -+ odm_write_4byte(dm, 0x1b24, (0x01460048 | (wlg_lna[iqk_info->lna_idx] << 10))); -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x510f3); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa9c00); -+ break; -+ case ODM_BAND_5G: -+ iqk_info->tmp1bcc = 0x09; -+ iqk_info->lna_idx = 2; -+ odm_write_1byte(dm, 0x1bcc, iqk_info->tmp1bcc); -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ odm_write_4byte(dm, 0x1b20, 0x00450008); -+ odm_write_4byte(dm, 0x1b24, (0x01460048 | (wla_lna[iqk_info->lna_idx] << 10))); -+#if 0 -+ /*odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x51000);*/ -+#endif -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, 0x51060); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa9c00); -+ break; -+ } -+ } -+ odm_write_4byte(dm, 0x1b20, (odm_read_4byte(dm, 0x1b20) & 0x000fffff) | toneindex << 20); -+ odm_write_4byte(dm, 0x1b24, (odm_read_4byte(dm, 0x1b24) & 0x000fffff) | toneindex << 20); -+} -+ -+boolean -+_iqk_rx_iqk_gain_search_fail_by_toneindex_8821c(struct dm_struct *dm, u8 path, -+ u8 step, u8 tone_index) -+{ -+ boolean fail = true; -+ u32 IQK_CMD; -+#if 0 -+ /*u8 lna_setting[5];*/ -+#endif -+ -+ _iqk_rxk2setting_by_toneindex_8821c(dm, path, RXIQK1, tone_index); -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ -+ IQK_CMD = 0xf8000208 | (1 << (path + 4)); -+ -+ _iqk_set_gnt_wl_gnt_bt(dm, true); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD + 0x1); -+#if 0 -+ /*ODM_sleep_ms(GS_delay_8821C);*/ -+#endif -+ fail = _iqk_check_cal_8821c(dm, IQK_CMD); -+ _iqk_set_gnt_wl_gnt_bt(dm, false); -+ -+ return fail; -+} -+ -+boolean -+_lok_one_shot_8821c(void *dm_void, u8 path, u8 pad_index) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 delay_count = 0; -+ boolean LOK_notready = false; -+ u32 LOK_temp2 = 0, LOK_temp3 = 0; -+ u32 IQK_CMD = 0x0; -+#if 0 -+ /*u8 LOKreg[] = {0x58, 0x78};*/ -+#endif -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]==========S%d LOK ==========\n", -+ iqk_info->is_btg); -+ -+ IQK_CMD = 0xf8000008 | (1 << (4 + path)); -+ -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]LOK_Trigger = 0x%x\n", IQK_CMD); -+ -+ _iqk_set_gnt_wl_gnt_bt(dm, true); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD + 1); -+ /*LOK: CMD ID = 0 {0xf8000018, 0xf8000028}*/ -+ /*LOK: CMD ID = 0 {0xf8000019, 0xf8000029}*/ -+#if 0 -+ /*ODM_sleep_ms(LOK_delay_8821C);*/ -+#endif -+ ODM_delay_us(10); -+ -+ delay_count = 0; -+ LOK_notready = true; -+ -+ while (LOK_notready) { -+ if (odm_get_rf_reg(dm, path, RF_0x8, RFREGOFFSETMASK) == 0x12345) -+ LOK_notready = false; -+ else -+ LOK_notready = true; -+ -+ if (LOK_notready) { -+#if 0 -+ /*ODM_sleep_ms(1);*/ -+#endif -+ ODM_delay_us(10); -+ delay_count++; -+ } -+ -+ if (delay_count >= 50000) { -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]S%d LOK timeout!!!\n", -+ path); -+ break; -+ } -+ } -+ odm_set_rf_reg(dm, path, RF_0x8, RFREGOFFSETMASK, 0x0); -+ -+ _iqk_set_gnt_wl_gnt_bt(dm, false); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]S%d ==> delay_count = 0x%x\n", path, -+ delay_count); -+ -+ if (!LOK_notready) { -+ LOK_temp2 = odm_get_rf_reg(dm, (enum rf_path)path, RF_0x8, RFREGOFFSETMASK); -+ LOK_temp3 = odm_get_rf_reg(dm, (enum rf_path)path, RF_0x58, RFREGOFFSETMASK); -+ -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]0x8 = 0x%x, 0x58 = 0x%x\n", -+ LOK_temp2, LOK_temp3); -+ } else { -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]==>S%d LOK Fail!!!\n", path); -+ } -+ -+ iqk_info->lok_fail[path] = LOK_notready; -+ -+ /*fill IDAC LUT table*/ -+#if 0 -+ /* -+ for (i = 0; i < 8; i++) { -+ odm_set_rf_reg(dm, path, RF_0x33, BIT(2)|BIT(1)|BIT(0), i); -+ odm_set_rf_reg(dm, path, RF_0x8, RFREGOFFSETMASK, LOK_temp2); -+ } -+ */ -+#endif -+ return LOK_notready; -+} -+ -+boolean -+_iqk_one_shot_8821c(void *dm_void, u8 path, u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 delay_count = 0; -+ boolean fail = true; -+ u32 IQK_CMD = 0x0; -+ u16 iqk_apply[2] = {0xc94, 0xe94}; -+ -+ if (idx == TX_IQK) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]============ S%d WBTXIQK ============\n", -+ iqk_info->is_btg); -+ else if (idx == RXIQK1) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]============ S%d WBRXIQK STEP1============\n", -+ iqk_info->is_btg); -+ else -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]============ S%d WBRXIQK STEP2============\n", -+ iqk_info->is_btg); -+ -+ if (idx == TXIQK) { -+ IQK_CMD = 0xf8000008 | ((*dm->band_width + 4) << 8) | (1 << (path + 4)); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]TXK_Trigger = 0x%x\n", IQK_CMD); -+#if 0 -+ /*{0xf8000418, 0xf800042a} ==> 20 WBTXK (CMD = 4)*/ -+ /*{0xf8000518, 0xf800052a} ==> 40 WBTXK (CMD = 5)*/ -+ /*{0xf8000618, 0xf800062a} ==> 80 WBTXK (CMD = 6)*/ -+#endif -+ } else if (idx == RXIQK1) { -+ if (*dm->band_width == 2) -+ IQK_CMD = 0xf8000808 | (1 << (path + 4)); -+ else -+ IQK_CMD = 0xf8000708 | (1 << (path + 4)); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]RXK1_Trigger = 0x%x\n", IQK_CMD); -+#if 0 -+ /*{0xf8000718, 0xf800072a} ==> 20 WBTXK (CMD = 7)*/ -+ /*{0xf8000718, 0xf800072a} ==> 40 WBTXK (CMD = 7)*/ -+ /*{0xf8000818, 0xf800082a} ==> 80 WBTXK (CMD = 8)*/ -+#endif -+ } else if (idx == RXIQK2) { -+ IQK_CMD = 0xf8000008 | ((*dm->band_width + 9) << 8) | (1 << (path + 4)); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]RXK2_Trigger = 0x%x\n", IQK_CMD); -+#if 0 -+ /*{0xf8000918, 0xf800092a} ==> 20 WBRXK (CMD = 9)*/ -+ /*{0xf8000a18, 0xf8000a2a} ==> 40 WBRXK (CMD = 10)*/ -+ /*{0xf8000b18, 0xf8000b2a} ==> 80 WBRXK (CMD = 11)*/ -+#endif -+ } -+ -+ _iqk_set_gnt_wl_gnt_bt(dm, true); -+ -+ odm_write_4byte(dm, 0x1bc8, 0x80000000); -+ odm_write_4byte(dm, 0x8f8, 0x41400080); -+ -+ if (odm_get_rf_reg(dm, path, RF_0x08, RFREGOFFSETMASK) != 0x0) -+ odm_set_rf_reg(dm, path, RF_0x8, RFREGOFFSETMASK, 0x0); -+ -+ odm_write_4byte(dm, 0x1b00, IQK_CMD); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD + 0x1); -+ -+#if 0 -+ /*ODM_sleep_ms(WBIQK_delay_8821C);*/ -+#endif -+ -+ fail = _iqk_check_nctl_done_8821c(dm, path, IQK_CMD); -+ -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]check 0x49c = %x\n", -+ odm_read_1byte(dm, 0x49c)); -+ -+ _iqk_set_gnt_wl_gnt_bt(dm, false); -+ -+ if (dm->debug_components & DBG_RF_IQK) { -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]S%d ==> 0x1b00 = 0x%x, 0x1b08 = 0x%x\n", path, -+ odm_read_4byte(dm, 0x1b00), odm_read_4byte(dm, 0x1b08)); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]S%d ==> delay_count = 0x%x\n", -+ path, delay_count); -+ if (idx != TXIQK) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]S%d ==> RF0x0 = 0x%x, RF0x%x = 0x%x\n", -+ path, -+ odm_get_rf_reg(dm, path, RF_0x0, -+ RFREGOFFSETMASK), -+ (iqk_info->is_btg) ? 0x78 : 0x56, -+ (iqk_info->is_btg) ? -+ odm_get_rf_reg(dm, path, RF_0x78, -+ RFREGOFFSETMASK) : -+ odm_get_rf_reg(dm, path, RF_0x56, -+ RFREGOFFSETMASK)); -+ } -+ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ if (idx == TXIQK) { -+ if (fail) -+ odm_set_bb_reg(dm, iqk_apply[path], BIT(0), 0x0); -+ else -+ _iqk_backup_iqk_8821c(dm, 0x2, path); -+ } -+ if (idx == RXIQK2) { -+ iqk_info->rxiqk_agc[0][path] = -+ (u16)(((odm_get_rf_reg(dm, (enum rf_path)path, RF_0x0, RFREGOFFSETMASK) >> 5) & 0xff) | -+ (iqk_info->tmp1bcc << 8)); -+ -+ odm_write_4byte(dm, 0x1b38, 0x20000000); -+ -+ if (fail) -+ odm_set_bb_reg(dm, iqk_apply[path], (BIT(11) | BIT(10)), 0x0); -+ else -+ _iqk_backup_iqk_8821c(dm, 0x3, path); -+ } -+ -+ if (idx == TXIQK) -+ iqk_info->iqk_fail_report[0][path][TXIQK] = fail; -+ else -+ iqk_info->iqk_fail_report[0][path][RXIQK] = fail; -+ -+ return fail; -+} -+ -+boolean -+_iqk_rxiqkbystep_8821c(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ boolean KFAIL = true, gonext; -+ -+#if 1 -+ switch (iqk_info->rxiqk_step) { -+ case 1: /*gain search_RXK1*/ -+ _iqk_rxk1setting_8821c(dm, path); -+ gonext = false; -+ while (1) { -+ KFAIL = _iqk_rx_iqk_gain_search_fail_8821c(dm, path, RXIQK1); -+ if (KFAIL && iqk_info->gs_retry_count[0][path][0] < 2) { -+ iqk_info->gs_retry_count[0][path][0]++; -+ } else if (KFAIL) { -+ iqk_info->rxiqk_fail_code[0][path] = 0; -+ iqk_info->rxiqk_step = 5; -+ gonext = true; -+ } else { -+ iqk_info->rxiqk_step++; -+ gonext = true; -+ } -+ if (gonext) -+ break; -+ } -+ halrf_iqk_xym_read(dm, 0x0, 0x2); -+ break; -+ case 2: /*gain search_RXK2*/ -+ _iqk_rxk2setting_8821c(dm, path, true); -+ iqk_info->isbnd = false; -+ while (1) { -+ KFAIL = _iqk_rx_iqk_gain_search_fail_8821c(dm, path, RXIQK2); -+ if (KFAIL && iqk_info->gs_retry_count[0][path][1] < rxiqk_gs_limit) { -+ iqk_info->gs_retry_count[0][path][1]++; -+ } else { -+ iqk_info->rxiqk_step++; -+ break; -+ } -+ } -+ halrf_iqk_xym_read(dm, 0x0, 0x3); -+ break; -+ case 3: /*RXK1*/ -+ _iqk_rxk1setting_8821c(dm, path); -+ gonext = false; -+ while (1) { -+ KFAIL = _iqk_one_shot_8821c(dm, path, RXIQK1); -+ if (KFAIL && iqk_info->retry_count[0][path][RXIQK1] < 2) { -+ iqk_info->retry_count[0][path][RXIQK1]++; -+ } else if (KFAIL) { -+ iqk_info->rxiqk_fail_code[0][path] = 1; -+ iqk_info->rxiqk_step = 5; -+ gonext = true; -+ } else { -+ iqk_info->rxiqk_step++; -+ gonext = true; -+ } -+ if (gonext) -+ break; -+ } -+ halrf_iqk_xym_read(dm, 0x0, 0x4); -+ break; -+ case 4: /*RXK2*/ -+ _iqk_rxk2setting_8821c(dm, path, false); -+ gonext = false; -+ while (1) { -+ KFAIL = _iqk_one_shot_8821c(dm, path, RXIQK2); -+ if (KFAIL && iqk_info->retry_count[0][path][RXIQK2] < 2) { -+ iqk_info->retry_count[0][path][RXIQK2]++; -+ } else if (KFAIL) { -+ iqk_info->rxiqk_fail_code[0][path] = 2; -+ iqk_info->rxiqk_step = 5; -+ gonext = true; -+ } else { -+ iqk_info->rxiqk_step++; -+ gonext = true; -+ } -+ if (gonext) -+ break; -+ } -+ halrf_iqk_xym_read(dm, 0x0, 0x0); -+ break; -+ } -+ return KFAIL; -+#endif -+} -+void _iqk_iqk_by_path_8821c(void *dm_void, boolean segment_iqk) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ boolean KFAIL = true; -+ u8 i, kcount_limit; -+ -+#if 0 -+ /* RF_DBG(dm, DBG_RF_IQK, "[IQK]iqk_step = 0x%x\n", dm->rf_calibrate_info.iqk_step); */ -+#endif -+ if (*dm->band_width == 2) -+ kcount_limit = kcount_limit_80m; -+ else -+ kcount_limit = kcount_limit_others; -+ -+ while (1) { -+ switch (dm->rf_calibrate_info.iqk_step) { -+ case 1: /*S0 LOK*/ -+ for (i = 0; i < 8; i++) { /* the LOK Cal in the each PAD stage*/ -+ _iqk_lok_setting_8821c(dm, RF_PATH_A, i); -+ _lok_one_shot_8821c(dm, RF_PATH_A, i); -+ } -+ dm->rf_calibrate_info.iqk_step++; -+ break; -+ case 2: /*S0 TXIQK*/ -+ _iqk_txk_setting_8821c(dm, RF_PATH_A); -+ KFAIL = _iqk_one_shot_8821c(dm, RF_PATH_A, TXIQK); -+ iqk_info->kcount++; -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]KFail = 0x%x\n", KFAIL); -+ if (KFAIL && iqk_info->retry_count[0][RF_PATH_A][TXIQK] < 3) -+ iqk_info->retry_count[0][RF_PATH_A][TXIQK]++; -+ else -+ dm->rf_calibrate_info.iqk_step++; -+ halrf_iqk_xym_read(dm, 0x0, 0x1); -+ break; -+ case 3: /*S0 RXIQK*/ -+ while (1) { -+ KFAIL = _iqk_rxiqkbystep_8821c(dm, RF_PATH_A); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]S0RXK KFail = 0x%x\n", KFAIL); -+ if (iqk_info->rxiqk_step == 5) { -+ dm->rf_calibrate_info.iqk_step++; -+ iqk_info->rxiqk_step = 1; -+ if (KFAIL) -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]S0RXK fail code: %d!!!\n", iqk_info->rxiqk_fail_code[0][RF_PATH_A]); -+ break; -+ } -+ } -+ iqk_info->kcount++; -+ break; -+ } -+ -+ if (dm->rf_calibrate_info.iqk_step == 4) { -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]==========LOK summary ==========\n"); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]PathA_LOK_notready = %d\n", -+ iqk_info->lok_fail[RF_PATH_A]); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]==========IQK summary ==========\n"); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]PathA_TXIQK_fail = %d\n", -+ iqk_info->iqk_fail_report[0][RF_PATH_A][TXIQK]); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]PathA_RXIQK_fail = %d\n", -+ iqk_info->iqk_fail_report[0][RF_PATH_A][RXIQK]); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]PathA_TXIQK_retry = %d\n", -+ iqk_info->retry_count[0][RF_PATH_A][TXIQK]); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]PathA_RXK1_retry = %d, PathA_RXK2_retry = %d\n", -+ iqk_info->retry_count[0][RF_PATH_A][RXIQK1], -+ iqk_info->retry_count[0][RF_PATH_A][RXIQK2]); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]PathA_GS1_retry = %d, PathA_GS2_retry = %d\n", -+ iqk_info->gs_retry_count[0][RF_PATH_A][0], -+ iqk_info->gs_retry_count[0][RF_PATH_A][1]); -+ -+ for (i = 0; i < SS_8821C; i++) { -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | i << 1); -+ odm_write_4byte(dm, 0x1b2c, 0x7); -+ odm_write_4byte(dm, 0x1bcc, 0x0); -+ odm_write_4byte(dm, 0x1b38, 0x20000000); -+ } -+ break; -+ } -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]segmentIQK = %d, Kcount = %d\n", -+ segment_iqk, iqk_info->kcount); -+ if (segment_iqk && iqk_info->kcount == kcount_limit) -+ break; -+ } -+} -+ -+void _iqk_start_iqk_8821c(struct dm_struct *dm, boolean segment_iqk) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u32 tmp; -+ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ odm_write_4byte(dm, 0x1bb8, 0x00000000); -+ /*GNT_WL = 1*/ -+ if (iqk_info->is_btg) { -+ tmp = odm_get_rf_reg(dm, RF_PATH_A, RF_0x1, RFREGOFFSETMASK); -+ tmp = (tmp & (~BIT(3))) | BIT(0) | BIT(2) | BIT(5); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x1, RFREGOFFSETMASK, tmp); -+ } else { -+ tmp = odm_get_rf_reg(dm, RF_PATH_A, RF_0x1, RFREGOFFSETMASK); -+ tmp = ((tmp & (~BIT(3))) & (~BIT(5))) | BIT(0) | BIT(2); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x1, RFREGOFFSETMASK, tmp); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]==> RF0x1 = 0x%x\n", -+ odm_get_rf_reg(dm, RF_PATH_A, RF_0x1, RFREGOFFSETMASK)); -+ } -+ _iqk_iqk_by_path_8821c(dm, segment_iqk); -+} -+ -+void _iq_calibrate_8821c_init(struct dm_struct *dm) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ u8 i, j, k, m; -+ static boolean firstrun = true; -+ -+ if (firstrun) { -+ firstrun = false; -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]=====>PHY_IQCalibrate_8821C_Init\n"); -+ -+ for (i = 0; i < SS_8821C; i++) { -+ for (j = 0; j < 2; j++) { -+ iqk_info->lok_fail[i] = true; -+ iqk_info->iqk_fail[j][i] = true; -+ iqk_info->iqc_matrix[j][i] = 0x20000000; -+ } -+ } -+ -+ for (i = 0; i < 2; i++) { -+ iqk_info->iqk_channel[i] = 0x0; -+ -+ for (j = 0; j < SS_8821C; j++) { -+ iqk_info->lok_idac[i][j] = 0x0; -+ iqk_info->rxiqk_agc[i][j] = 0x0; -+ iqk_info->bypass_iqk[i][j] = 0x0; -+ -+ for (k = 0; k < 2; k++) { -+ iqk_info->iqk_fail_report[i][j][k] = true; -+ for (m = 0; m < 8; m++) { -+ iqk_info->iqk_cfir_real[i][j][k][m] = 0x0; -+ iqk_info->iqk_cfir_imag[i][j][k][m] = 0x0; -+ } -+ } -+ -+ for (k = 0; k < 3; k++) -+ iqk_info->retry_count[i][j][k] = 0x0; -+ } -+ } -+ } -+} -+ -+u8 _txgapk_txpower_compare_8821c(struct dm_struct *dm, u8 path, u32 pw1, -+ u32 pw2, u32 *pwr_table) -+{ -+ u8 pwr_delta; -+ u32 temp = 0x0; -+ temp = (u32)(pw1 / (pw2 / 1000)); -+ -+ if (temp < pwr_table[0]) /*<-3.5 dB*/ -+ pwr_delta = 0x0; -+ else if (temp < pwr_table[1]) -+ pwr_delta = 0x1; -+ else if (temp < pwr_table[2]) -+ pwr_delta = 0x2; -+ else if (temp < pwr_table[3]) -+ pwr_delta = 0x3; -+ else if (temp < pwr_table[4]) -+ pwr_delta = 0x4; -+ else if (temp < pwr_table[5]) -+ pwr_delta = 0x5; -+ else if (temp < pwr_table[6]) -+ pwr_delta = 0x6; -+ else if (temp < pwr_table[7]) -+ pwr_delta = 0x7; -+ else if (temp < pwr_table[8]) -+ pwr_delta = 0x8; -+ else if (temp < pwr_table[9]) -+ pwr_delta = 0x9; -+ else if (temp < pwr_table[0xa]) -+ pwr_delta = 0xa; -+ else if (temp < pwr_table[0xb]) -+ pwr_delta = 0xb; -+ else if (temp < pwr_table[0xc]) -+ pwr_delta = 0xc; -+ else if (temp < pwr_table[0xd]) -+ pwr_delta = 0xd; -+ else if (temp < pwr_table[0xe]) -+ pwr_delta = 0xe; -+ else if (temp < pwr_table[0xf]) -+ pwr_delta = 0xf; -+ else if (temp < pwr_table[0x10]) -+ pwr_delta = 0x10; -+ else if (temp < pwr_table[0x11]) -+ pwr_delta = 0x11; -+ else if (temp < pwr_table[0x12]) -+ pwr_delta = 0x12; -+ else if (temp < pwr_table[0x13]) -+ pwr_delta = 0x13; -+ else if (temp < pwr_table[0x14]) -+ pwr_delta = 0x14; -+ else if (temp < pwr_table[0x15]) -+ pwr_delta = 0x15; -+ else if (temp < pwr_table[0x16]) -+ pwr_delta = 0x16; -+ else if (temp < pwr_table[0x17]) -+ pwr_delta = 0x17; -+ else if (temp < pwr_table[0x18]) -+ pwr_delta = 0x18; -+ else if (temp < pwr_table[0x19]) -+ pwr_delta = 0x19; -+ else -+ pwr_delta = 0x1a; -+ -+ RF_DBG(dm, DBG_RF_IQK, "[TXGAPK] temp =%d, pwr_delta =%x\n", temp, -+ pwr_delta); -+ -+ return pwr_delta; -+} -+ -+u32 _txgapk_txgap_compenstion_8821c(struct dm_struct *dm, u8 path, -+ u32 txgain_0x56, u8 pwr_delta) -+{ -+ u32 new_txgain_0x56; -+ -+ /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 */ -+ /* -3.5 -3 -2.5 -2 -1.5 -1 -0.5 0 0.5 1 1.5 2 2.5 3 3.5 (dB)*/ -+#if 0 -+ /* pwr_table[0xf]={89,100,112,125,141,158,177,199,223,251,281,316,354,398,446}*/ -+#endif -+ -+ switch (pwr_delta) { -+ case 0x1a: -+ case 0x19: -+ case 0x18: -+ case 0x17: -+ case 0x16: -+ case 0x15: -+ case 0x14: -+#if 0 -+ /* -+ if ((txgain_0x56 & 0x1f)<=0x1d) -+ new_txgain_0x56 = txgain_0x56 + 0x2; //< -1.5 ~ -2.5dB -+ else if ((txgain_0x56 & 0x1f)<= 0x1e) -+ new_txgain_0x56 = txgain_0x56 + 0x1; -+ else -+ new_txgain_0x56 = txgain_0x56; -+ break; -+*/ -+#endif -+ case 0x13: -+ case 0x12: -+ if ((txgain_0x56 & 0x1f) <= 0x1e) -+ new_txgain_0x56 = txgain_0x56 + 0x1;/*< -0.5 ~ -1.5dB*/ -+ else -+ new_txgain_0x56 = txgain_0x56; -+ break; -+ case 0x11: -+ case 0x10: -+ case 0xf: -+ case 0xe: -+ case 0xd: -+ case 0xc: -+ new_txgain_0x56 = txgain_0x56; /*< -0.5~0.5dB*/ -+ break; -+ case 0xb: -+ case 0xa: -+ case 0x9: -+ case 0x8: -+ case 0x7: -+ if ((txgain_0x56 & 0x1f) >= 0x01) -+ new_txgain_0x56 = txgain_0x56 - 0x1; /* >0.5~1.5dB */ -+ else -+ new_txgain_0x56 = txgain_0x56; -+ break; -+ case 0x6: -+ case 0x5: -+ case 0x4: -+ case 0x3: -+#if 0 -+ /* -+ if ((txgain_0x56 & 0x1f)>= 0x02) -+ new_txgain_0x56 = txgain_0x56 - 0x2; //>1.5~2.5dB -+ else if ((txgain_0x56 & 0x1f)>= 0x01) -+ new_txgain_0x56 = txgain_0x56 - 0x1; -+ else -+ new_txgain_0x56 = txgain_0x56; -+ break; -+*/ -+#endif -+ case 0x2: -+ case 0x1: -+ case 0x0: -+#if 0 -+ /* -+ if ((txgain_0x56 & 0x1f)>= 0x03) -+ new_txgain_0x56 = txgain_0x56 - 0x3; //>2.5~3.5dB -+ else if ((txgain_0x56 & 0x1f)>= 0x02) -+ new_txgain_0x56 = txgain_0x56 - 0x2; -+ else if ((txgain_0x56 & 0x1f)>= 0x01) -+ new_txgain_0x56 = txgain_0x56 - 0x1; -+ else -+ new_txgain_0x56 = txgain_0x56; -+ break; -+*/ -+#endif -+ default: -+ new_txgain_0x56 = txgain_0x56; -+ break; -+ } -+ if ((new_txgain_0x56 & 0x1f) < 0x02) -+ new_txgain_0x56 = (new_txgain_0x56 & 0xffffc) + 0x2; -+ if ((new_txgain_0x56 & 0x1f) > 0x1d) -+ new_txgain_0x56 = (new_txgain_0x56 | 0x3) - 0x2; -+ -+ return new_txgain_0x56; -+} -+ -+void _txgapk_backup_8821c(struct dm_struct *dm, u32 *backup_txgap, -+ u32 *backup_txgap_reg, u8 txgapk_reg_num) -+{ -+ u32 i; -+ -+ for (i = 0; i < txgapk_reg_num; i++) -+ backup_txgap[i] = odm_read_4byte(dm, backup_txgap_reg[i]); -+} -+u32 _txgapk_get_rf_tx_index_8821c(struct dm_struct *dm, u8 path, -+ u32 txgain_index) -+{ -+ u32 rf_backup_reg00, rf_backup_regdf, rf_reg56; -+ -+ rf_backup_reg00 = odm_get_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK); -+ rf_backup_regdf = odm_get_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, 0x08009); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK, 0x20000 + txgain_index); -+ /*ODM_sleep_us(10);*/ -+ -+ ODM_delay_us(10); -+ rf_reg56 = odm_get_rf_reg(dm, RF_PATH_A, RF_0x56, RFREGOFFSETMASK); -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TXGAPK](2) txgain_index =0x%x, rf_reg56=0x%x\n", txgain_index, -+ rf_reg56); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK, rf_backup_reg00); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, rf_backup_regdf); -+ return rf_reg56; -+} -+ -+void _txgapk_restore_8821c(struct dm_struct *dm, u32 *backup_txgap, -+ u32 *backup_txgap_reg, u8 txgapk_reg_num) -+{ -+ u32 i; -+ -+ for (i = 0; i < txgapk_reg_num; i++) -+ odm_write_4byte(dm, backup_txgap_reg[i], backup_txgap[i]); -+} -+ -+void _txgapk_setting_8821c(struct dm_struct *dm, u8 path) -+{ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ /*RF*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREGOFFSETMASK, 0x80000); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x00024); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3e, RFREGOFFSETMASK, 0x0003F); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREGOFFSETMASK, 0xCBFCE); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREGOFFSETMASK, 0x00000); -+ if (iqk_info->is_btg) { -+ } else { -+ switch (*dm->band_type) { -+ case ODM_BAND_2_4G: -+ break; -+ case ODM_BAND_5G: -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x8f, RFREGOFFSETMASK, 0xA9C00); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, 0x00809); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK, 0x4001c); -+ -+ odm_write_4byte(dm, 0x1bcc, 0x00000009); /*try the iqk swing*/ -+ odm_write_4byte(dm, 0x1b20, 0x01040008); -+ odm_write_4byte(dm, 0x1b24, 0x01040848); -+ -+ odm_write_4byte(dm, 0x1b14, 0x00001000); -+ odm_write_4byte(dm, 0x1b1c, 0x82193d31); -+ -+ odm_write_1byte(dm, 0x1b22, 0x04); /*sync with RF0x33[3:0]*/ -+ odm_write_1byte(dm, 0x1b26, 0x04); /*sync with RF0x33[3:0]*/ -+ odm_write_1byte(dm, 0x1b2c, 0x03); -+ odm_write_4byte(dm, 0x1b38, 0x20000000); -+ odm_write_4byte(dm, 0x1b3c, 0x20000000); -+ odm_write_4byte(dm, 0xc00, 0x4); -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK](1) txgap calibration setting!!!\n"); -+ -+ break; -+ } -+ } -+} -+ -+u32 _txgapk_one_shot_8821c(struct dm_struct *dm_void, u8 path, u32 reg0x56) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean txgap_k_notready = true; -+ u8 delay_count = 0x0; -+ u32 txgap_k_tmp1 = 0x1, txgap_k_tmp2 = 0x2; -+ u8 offset; -+ u32 reg_1bb8; -+ u32 rx_dsp_power; -+ -+ reg_1bb8 = odm_read_4byte(dm, 0x1bb8); -+ /*clear the flag*/ -+ odm_write_1byte(dm, 0x1bd6, 0x0b); -+ odm_set_bb_reg(dm, R_0x1bfc, BIT(1), 0x0); -+ txgap_k_notready = true; -+ delay_count = 0x0; -+ /* get tx gain*/ -+ odm_write_1byte(dm, 0x1b2b, 0x00); -+ odm_write_1byte(dm, 0x1bb8, 0x00); -+ odm_set_rf_reg(dm, path, RF_0xdf, RFREGOFFSETMASK, 0x00802); -+ odm_set_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK, 0xa9c00); -+ odm_set_rf_reg(dm, path, RF_0x56, RFREGOFFSETMASK, reg0x56); -+ odm_write_4byte(dm, 0x1bb8, 0x00100000); -+#if 0 -+ /*ODM_sleep_us(10);*/ -+#endif -+ -+ ODM_delay_us(10); -+ /* one-shot-1*/ -+ odm_write_4byte(dm, 0x1b34, 0x1); -+ odm_write_4byte(dm, 0x1b34, 0x0); -+ -+#if 1 -+ while (txgap_k_notready) { -+ odm_write_1byte(dm, 0x1bd6, 0x0b); -+ if ((boolean)odm_get_bb_reg(dm, R_0x1bfc, BIT(1))) -+ txgap_k_notready = false; -+ else -+ txgap_k_notready = true; -+ -+ if (txgap_k_notready) { -+#if 0 -+ /*ODM_sleep_us(100);*/ -+#endif -+ ODM_delay_us(100); -+ delay_count++; -+ } -+ -+ if (delay_count >= 20) { -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TXGAPK] (3)txgapktimeout,delay_count=0x%x !!!\n", -+ delay_count); -+ txgap_k_notready = false; -+ break; -+ } -+ } -+#else -+ ODM_sleep_ms(1); -+ if ((boolean)odm_get_bb_reg(dm, R_0x1bfc, BIT(1))) -+ txgap_k_notready = false; -+ else -+ txgap_k_notready = true; -+ -+#endif -+ -+ if (!txgap_k_notready) { -+ odm_write_1byte(dm, 0x1bd6, 0x5); -+ txgap_k_tmp1 = odm_read_4byte(dm, 0x1bfc) >> 27; -+ odm_write_1byte(dm, 0x1bd6, 0xe); -+ txgap_k_tmp2 = odm_read_4byte(dm, 0x1bfc); -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TXGAPK] reg0x56 =0x%x, txgapK_tmp1 =0x%x, txgapK_tmp2 =0x%x!!!\n", -+ reg0x56, txgap_k_tmp1, txgap_k_tmp2); -+ -+ if (txgap_k_tmp1 == 0) -+ offset = 0x0; -+ else if (txgap_k_tmp1 < 2) -+ offset = 0x1; -+ else if (txgap_k_tmp1 < 4) -+ offset = 0x2; -+ else -+ offset = 0x3; -+ -+ if (txgap_k_tmp1 == 0x0) { -+ rx_dsp_power = txgap_k_tmp2; -+ } else { -+ txgap_k_tmp1 = txgap_k_tmp1 << (32 - offset); -+ txgap_k_tmp2 = txgap_k_tmp2 >> offset; -+ rx_dsp_power = txgap_k_tmp1 + txgap_k_tmp2; -+ overflowflag = true; -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TXGAPK](3) (1)overflowflag = true, txgapK_tmp1 =0x%x, txgapK_tmp2 =0x%x!!!\n", -+ txgap_k_tmp1, txgap_k_tmp2); -+ } -+ } else { -+ RF_DBG(dm, DBG_RF_IQK, "[TXGAPK](3) txgapK Fail!!!\n"); -+ } -+ -+ odm_write_4byte(dm, 0x1bb8, reg_1bb8); -+ -+ return rx_dsp_power; -+} -+ -+void _phy_txgapk_calibrate_8821c(void *dm_void, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 txgain[txgap_k_number] = {0, 0, 0, 0, 0, 0, 0}; -+ u32 txgain_rf56[txgap_k_number] = {0, 0, 0, 0, 0, 0, 0}; -+ u8 add_base, txgapk_num = 0x0, psd_delta = 0x0; -+ u8 i, bandselect = 0x0; -+ u32 backup_txgap_reg[11] = {0x1b14, 0x1b1c, 0x1b20, 0x1b24, 0x1b28, 0x1b2c, 0x1b38, 0x1b3c, 0x1bd6, 0x1bb8, 0x1bcc}; -+ u32 backup_txgap[11]; -+ u8 gain_gap_index[txgap_k_number] = {0x13, 0x10, 0xd, 0xa, 0x7, 0x4, 0x1}; -+ u32 txgainindex[txgap_k_number] = {0x26, 0x25, 0x24, 0x23, 0x22, 0x21, 0x20}; -+ u32 tmp1, tmp2, tmp3, tmp4, tmp5; -+ u8 skip_low_power_index = 0x3; -+ -+ s8 psd_single_tone_offset_1db[3][3] = {{-1, 0, 0}, {-2, -1, -1}, {-1, -1, -1} }; /*5G, L,M,H, index 32,26,20*/ -+ static u32 pwr_table_1db[27] = {590, 630, 668, 707, 749, 794, 841, 891, 944, 1000, 1040, 1096, 1148, 1202, 1258, 1318, -+ 1380, 1412, 1513, 1584, 1678, 1778, 1888, 1995, 2113, 2387, 2391}; -+ static u32 pwr_table_3db[27] = {944, 1000, 1059, 1122, 1185, 1258, 1333, 1412, 1496, 1584, 1659, 1737, 1819, 1905, 1995, 2089, -+ 2187, 2290, 2398, 2511, 2660, 2818, 2985, 3162, 3349, 3548, 3758}; -+ boolean txgapkdone = false; -+ u8 txgap_changed = 0x0; -+ u8 ref_val = 0x0; -+ -+ overflowflag = 0; -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TXGAPK] (1) *dm->band_width = %x, *dm->channel =%d, *dm->band_type=%x\n", -+ *dm->band_width, *dm->channel, *dm->band_type); -+ -+ if (!(*dm->mp_mode)) -+ return; -+ -+ if (!(*dm->band_type == ODM_BAND_5G)) -+ return; -+ -+ if (*dm->band_width == 0) { -+#if 0 -+ /* return;*/ -+#endif -+ if (*dm->channel < 64) { -+ bandselect = 0x0; -+ add_base = 0x0; -+ } else if (*dm->channel < 153) { -+ bandselect = 0x1; -+ add_base = 0x40; -+#if 0 -+ /*else if (*dm->channel ==153){*/ -+#endif -+ } else { -+ bandselect = 0x2; -+ add_base = 0x80; -+ } -+ } else if (*dm->band_width == 1) { -+ if (*dm->channel < 102) { -+ bandselect = 0x0; -+ add_base = 0x0; -+ } else if (*dm->channel < 151) { -+ bandselect = 0x1; -+ add_base = 0x40; -+#if 0 -+ /*else if (*dm->channel ==151){*/ -+#endif -+ } else { -+ bandselect = 0x2; -+ add_base = 0x80; -+ } -+ } else if (*dm->band_width == 2) { -+ /* return;*/ -+ if (*dm->channel < 106) { -+ bandselect = 0x0; -+ add_base = 0x0; -+ } else if (*dm->channel < 155) { -+ bandselect = 0x1; -+ add_base = 0x40; -+#if 0 -+ /*else if (*dm->channel ==155){*/ -+#endif -+ } else { -+ bandselect = 0x2; -+ add_base = 0x80; -+ } -+ } else { -+ return; -+ } -+ -+ if (txgap_done[bandselect]) -+ return; -+ -+ /*Step 1*/ -+ _txgapk_backup_8821c(dm, backup_txgap, backup_txgap_reg, 0xb); -+ /*step 2*/ -+ phydm_clear_kfree_to_rf(dm, RF_PATH_A, 1); -+ -+ for (i = 0; i < txgap_k_number; i++) { -+ txgain_rf56[i] = _txgapk_get_rf_tx_index_8821c(dm, RF_PATH_A, gain_gap_index[i]); -+ txgain[i] = txgain_rf56[i]; -+ } -+ -+ for (i = 0; i < txgap_k_number; i++) { -+ RF_DBG(dm, DBG_RF_IQK, "[TXGAPK] start txgain1[%x]=0x%x\n", i, -+ txgain_rf56[i]); -+ } -+ -+ _txgapk_setting_8821c(dm, RF_PATH_A); -+ -+ /*step 3*/ -+ -+ /*1st*/ -+ while (!txgapkdone) { -+ txgapk_num++; -+ if (txgapk_num > 2) -+ break; -+ -+ for (i = 0; i < txgap_k_number - 1 - skip_low_power_index; i++) { -+ tmp1 = (txgain[i] & 0x000000e0) >> 5; -+ tmp2 = (txgain[i + 1] & 0x000000e0) >> 5; -+ tmp5 = txgain[i + 1]; -+#if 0 -+ //if (tmp1 != tmp2){ -+#endif -+ if (true) { -+ tmp3 = _txgapk_one_shot_8821c(dm, RF_PATH_A, txgain[i] - 2); -+ tmp4 = _txgapk_one_shot_8821c(dm, RF_PATH_A, txgain[i + 1]); -+ if (overflowflag) -+ overflowflag = false; -+#if 0 -+ //tmp4 = tmp4>>1; -+#endif -+ -+ psd_delta = -+ _txgapk_txpower_compare_8821c(dm, RF_PATH_A, tmp3, tmp4, pwr_table_1db); -+ -+ psd_delta = psd_delta + psd_single_tone_offset_1db[bandselect][i]; -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TXGAPK] new psd_detla = %x\n", -+ psd_delta); -+ -+ if (psd_delta <= 0xb) -+ txgap_changed++; -+ else if (psd_delta <= 0x11) -+ ; -+ else -+ txgap_changed++; -+ -+ txgain[i + 1] = -+ _txgapk_txgap_compenstion_8821c(dm, RF_PATH_A, txgain[i + 1], psd_delta); -+ } else { -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TXGAPK]skip i=%d, txgain[%x]=0x%x\n", -+ i, i + 1, txgain[i + 1]); -+ } -+ } -+ -+ /*2nd*/ -+ -+ if (txgap_changed > 0x0) { -+ RF_DBG(dm, DBG_RF_IQK, "[TXGAPK] do 3dB check\n"); -+ -+ for (i = 0; i < txgap_k_number - 1 - skip_low_power_index; i++) { -+ tmp1 = (txgain[i] & 0x000000e0) >> 5; -+ tmp2 = (txgain[i + 1] & 0x000000e0) >> 5; -+ -+ if (tmp1 != tmp2) { -+ if (i == 0) -+ tmp3 = _txgapk_one_shot_8821c(dm, RF_PATH_A, txgain[i] - 2); -+ else -+ tmp3 = _txgapk_one_shot_8821c(dm, RF_PATH_A, txgain[i]); -+ -+ tmp4 = _txgapk_one_shot_8821c(dm, RF_PATH_A, txgain[i + 1]); -+ -+ if (overflowflag) { -+ overflowflag = false; -+ RF_DBG(dm, DBG_RF_IQK, "[IQK] tmp3= %x, tmp4= %x\n", tmp3, tmp4); -+ } -+ if (i == 0) -+ psd_delta = -+ _txgapk_txpower_compare_8821c(dm, RF_PATH_A, tmp3, tmp4, pwr_table_1db); -+ -+ else -+ psd_delta = -+ _txgapk_txpower_compare_8821c(dm, RF_PATH_A, tmp3, tmp4, pwr_table_3db); -+ -+ if (psd_delta <= 0xa) -+ ref_val++; -+ else if (psd_delta <= 0x12) -+ ; -+ else -+ ref_val++; -+ } else { -+ RF_DBG(dm, DBG_RF_IQK, "[TXGAPK]skip i=%d, txgain[%x]=0x%x\n", i, i + 1, txgain[i + 1]); -+ } -+ } -+ -+ if (ref_val == 0x0) { -+ txgapkdone = true; -+ txgap_changed = 0x0; -+ } else { -+ /* restore default rf 0x56 */ -+ for (i = 0; i < txgap_k_number; i++) -+ txgain[i] = txgain_rf56[i]; -+ } -+ -+ } else { -+ txgapkdone = true; -+ } -+ } -+ -+ /*step 7*/ -+ _txgapk_restore_8821c(dm, backup_txgap, backup_txgap_reg, 0xb); -+ -+ /*step 8*/ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[TXGAPK]txgapkdone =%x, txgap_changed=0x%x, ref_val =0x%x\n", -+ txgapkdone, txgap_changed, ref_val); -+ -+ if (txgapkdone) { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREGOFFSETMASK, 0x00800); -+ -+ for (i = 0; i < txgap_k_number; i++) { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, txgainindex[i] + add_base); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREGOFFSETMASK, txgain[i]); -+ } -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREGOFFSETMASK, 0x00000); -+ txgap_done[bandselect] = true; -+ txgapkdone = false; -+ } -+} -+ -+#if 0 -+/* -+void -+_DPK_BackupReg_8821C( -+ struct dm_struct* dm, -+ static u32* DPK_backup, -+ u32* backup_dpk_reg -+ ) -+{ -+ -+ u32 i; -+ -+ for (i = 0; i < DPK_BACKUP_REG_NUM_8821C; i++) -+ DPK_backup[i] = odm_read_4byte(dm, backup_dpk_reg[i]); -+ -+} -+void -+_DPK_Restore_8821C( -+ struct dm_struct* dm, -+ static u32* DPK_backup, -+ u32* backup_dpk_reg -+ ) -+{ -+ u32 i; -+ for (i = 0; i < DPK_BACKUP_REG_NUM_8821C; i++) -+ odm_write_4byte(dm, backup_dpk_reg[i], DPK_backup[i]); -+} -+ -+*/ -+#endif -+void _dpk_toggle_rxagc(struct dm_struct *dm, boolean reset) -+{ -+ /*toggle RXAGC workaround method*/ -+ u32 tmp1; -+ tmp1 = odm_read_4byte(dm, 0xc50); -+ odm_set_bb_reg(dm, R_0xc50, BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x0); -+#if 0 -+ /* ODM_sleep_ms(2);*/ -+#endif -+ ODM_delay_us(10); -+ odm_set_bb_reg(dm, R_0xc50, BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x2); -+#if 0 -+ /* ODM_sleep_ms(2);*/ -+#endif -+ ODM_delay_us(10); -+ odm_set_bb_reg(dm, R_0xc50, BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x0); -+ odm_write_4byte(dm, 0xc50, tmp1); -+} -+ -+void _dpk_set_gain_scaling(struct dm_struct *dm, u8 path) -+{ -+ u32 tmp1, tmp2, tmp3, tmp4, reg_1bfc; -+ u32 lut_i = 0x0, lut_q = 0x0, lut_pw = 0x0, lut_pw_avg = 0x0; -+ u16 gain_scaling = 0x0; -+ -+ tmp1 = odm_read_4byte(dm, 0x1b00); -+ tmp2 = odm_read_4byte(dm, 0x1b08); -+ tmp3 = odm_read_4byte(dm, 0x1bd4); -+ tmp4 = odm_read_4byte(dm, 0x1bdc); -+ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ odm_write_4byte(dm, 0x1b08, 0x00000080); -+ odm_write_4byte(dm, 0x1bd4, 0x00040001); -+ odm_write_4byte(dm, 0x1bdc, 0xc0000081); -+ -+ reg_1bfc = odm_read_4byte(dm, 0x1bfc); -+ lut_i = (reg_1bfc & 0x003ff800) >> 11; -+ lut_q = (reg_1bfc & 0x00007ff); -+ -+ if ((lut_i & 0x400) == 0x400) -+ lut_i = 0x800 - lut_i; -+ if ((lut_q & 0x400) == 0x400) -+ lut_q = 0x800 - lut_q; -+ -+ lut_pw = lut_i * lut_i + lut_q * lut_q; -+ lut_pw_avg = (u32)(lut_i + lut_q) >> 1; -+ gain_scaling = (u16)(0x800000 / lut_pw_avg); -+ -+ odm_set_bb_reg(dm, R_0x1b98, 0x0000ffff, gain_scaling); -+ odm_set_bb_reg(dm, R_0x1b98, 0xffff0000, gain_scaling); -+ -+ odm_write_4byte(dm, 0x1b00, tmp1); -+ odm_write_4byte(dm, 0x1b08, tmp2); -+ odm_write_4byte(dm, 0x1bd4, tmp3); -+ odm_write_4byte(dm, 0x1bdc, tmp4); -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK] reg_1bfc =0x%x, lut_pw =0x%x, lut_i = 0x%x, lut_q = 0x%x, lut_pw_avg = 0x%x, gain_scaling = 0x%x, 0x1b98 =0x%x!!!\n", -+ reg_1bfc, lut_pw, lut_i, lut_q, lut_pw_avg, gain_scaling, -+ odm_read_4byte(dm, 0x1b98)); -+} -+ -+void _dpk_set_dpk_pa_scan(struct dm_struct *dm, u8 path) -+{ -+ u32 tmp1, tmp2, reg_1bfc; -+ u32 pa_scan_i = 0x0, pa_scan_q = 0x0, pa_scan_pw = 0x0; -+ u32 gainloss_back = 0x0; -+#if 0 -+ /* boolean pa_scan_search_fail = false;*/ -+#endif -+ tmp1 = odm_read_4byte(dm, 0x1bcf); -+ tmp2 = odm_read_4byte(dm, 0x1bd4); -+ -+ odm_write_4byte(dm, 0x1bcf, 0x11); -+ odm_write_4byte(dm, 0x1bd4, 0x00060000); -+ -+ reg_1bfc = odm_read_4byte(dm, 0x1bfc); -+ odm_write_4byte(dm, 0x1bcf, 0x15); -+ pa_scan_i = (reg_1bfc & 0xffff0000) >> 16; -+ pa_scan_q = (reg_1bfc & 0x0000ffff); -+ -+ if ((pa_scan_i & 0x8000) == 0x8000) -+ pa_scan_i = 0x10000 - pa_scan_i; -+ if ((pa_scan_q & 0x8000) == 0x8000) -+ pa_scan_q = 0x10000 - pa_scan_q; -+ -+ pa_scan_pw = pa_scan_i * pa_scan_i + pa_scan_q * pa_scan_q; -+ -+ /*estimated pa_scan_pw*/ -+#if 0 -+ /*0dB => (512^2) * 10^(0/10) = 262144*/ -+ /*1dB => (512^2) * 10^(1/10) = 330019*/ -+ /*2dB => (512^2) * 10^(2/10) = 415470*/ -+ /*3dB => (512^2) * 10^(3/10) = 523046*/ -+ /*4dB => (512^2) * 10^(4/10) = 658475*/ -+ /*5dB => (512^2) * 10^(5/10) = 828972*/ -+ /*6dB => (512^2) * 10^(6/10) = 1043614*/ -+ /*7dB => (512^2) * 10^(7/10) = 1313832*/ -+ /*8dB => (512^2) * 10^(0/10) = 1654016*/ -+ /*9dB => (512^2) * 10^(1/10) = 2082283*/ -+ /*10dB => (512^2) * 10^(2/10) = 2621440*/ -+ /*11dB => (512^2) * 10^(3/10) = 3300197*/ -+ /*12dB => (512^2) * 10^(4/10) = 4154702*/ -+ /*13dB => (512^2) * 10^(5/10) = 5230460*/ -+ /*14dB => (512^2) * 10^(6/10) = 6584759*/ -+ /*15dB => (512^2) * 10^(7/10) = 8289721*/ -+#endif -+ if (pa_scan_pw >= 0x7e7db9) -+ pa_scan_pw = 0x0f; -+ else if (pa_scan_pw >= 0x6479b7) -+ pa_scan_pw = 0x0e; -+ else if (pa_scan_pw >= 0x4fcf7c) -+ pa_scan_pw = 0x0d; -+ else if (pa_scan_pw >= 0x3f654e) -+ pa_scan_pw = 0x0c; -+ else if (pa_scan_pw >= 0x325b65) -+ pa_scan_pw = 0x0b; -+ else if (pa_scan_pw >= 0x280000) -+ pa_scan_pw = 0x0a; -+ else if (pa_scan_pw >= 0x1fc5eb) -+ pa_scan_pw = 0x09; -+ else if (pa_scan_pw >= 0x193d00) -+ pa_scan_pw = 0x8; -+ else if (pa_scan_pw >= 0x140c28) -+ pa_scan_pw = 0x7; -+ else if (pa_scan_pw >= 0xefc9e) -+ pa_scan_pw = 0x6; -+ else if (pa_scan_pw >= 0xca62c) -+ pa_scan_pw = 0x5; -+ else if (pa_scan_pw > 0xa0c2b) -+ pa_scan_pw = 0x4; -+ else if (pa_scan_pw > 0x7fb26) -+ pa_scan_pw = 0x3; -+ else if (pa_scan_pw > 0x656ee) -+ pa_scan_pw = 0x2; -+ else if (pa_scan_pw > 0x50923) -+ pa_scan_pw = 0x1; -+ else /*262144 >= pa_scan_pw*/ -+ pa_scan_pw = 0x0; -+ -+ odm_write_4byte(dm, 0x1bd4, 0x00060001); -+ gainloss_back = (odm_read_4byte(dm, 0x1bfc) & 0x0000000f); -+ -+ if (gainloss_back <= 0xa) -+ gainloss_back = 0xa - gainloss_back; -+ -+ if (gainloss_back > pa_scan_pw + 0x8) -+ odm_set_rf_reg(dm, path, RF_0x8f, BIT(14) | BIT(13), 0x11); -+ else if ((pa_scan_pw + 0x8 - gainloss_back) >= 0x6) -+ odm_set_rf_reg(dm, path, RF_0x8f, BIT(14) | BIT(13), 0x00); -+ else -+#if 0 -+ /*if (0x6 >= (pa_scan_pw + 0x8 - gainloss_back)> 0x0 )*/ -+#endif -+ odm_set_rf_reg(dm, path, RF_0x8f, BIT(14) | BIT(13), 0x01); -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK] reg_1bfc =0x%x, pa_scan_pw =0x%x, gainloss_back = 0x%x, pa_scan_i = 0x%x, pa_scan_q = 0x%x, RF0x8f = 0x%x, !!!\n", -+ reg_1bfc, pa_scan_pw, gainloss_back, pa_scan_i, pa_scan_q, -+ odm_get_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK)); -+ -+ odm_write_4byte(dm, 0x1bcf, tmp1); -+ odm_write_4byte(dm, 0x1bd4, tmp2); -+} -+ -+void _dpk_disable_bb_dynamic_pwr_threshold(struct dm_struct *dm, boolean flag) -+{ -+ if (flag) /*disable BB dynamic pwr threshold hold*/ -+ odm_set_bb_reg(dm, R_0x1c74, BIT(31) | BIT(30) | BIT(29) | BIT(28), 0x0); -+ else -+ odm_set_bb_reg(dm, R_0x1c74, BIT(31) | BIT(30) | BIT(29) | BIT(28), 0x2); -+ RF_DBG(dm, DBG_RF_IQK, "[DPK]\nset 0x1c74 = 0x%x\n", -+ odm_read_4byte(dm, 0x1c74)); -+} -+ -+void _dpk_set_dpk_sram_to_10_8821c(struct dm_struct *dm, u8 path) -+{ -+ u32 tmp1, tmp2; -+ u8 i; -+ tmp1 = odm_read_4byte(dm, 0x1b00); -+ tmp2 = odm_read_4byte(dm, 0x1b08); -+ -+ for (i = 0; i < 64; i++) -+ odm_write_4byte(dm, 0x1bdc, 0xd0000001 + (i * 2) + 1); -+ -+ for (i = 0; i < 64; i++) -+ odm_write_4byte(dm, 0x1bdc, 0x90000080 + (i * 2) + 1); -+ -+#if 0 -+ /* -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]return txagc = 0x%x , 1bfc = 0x%x,rf00=0x%x\n", -+ tmp4, odm_read_4byte(dm, 0x1bfc), -+ odm_get_rf_reg(dm, path, RF_0x00, RFREGOFFSETMASK)); -+*/ -+#endif -+ odm_write_4byte(dm, 0x1bdc, 0x0); -+ odm_write_4byte(dm, 0x1b00, tmp1); -+ odm_write_4byte(dm, 0x1b08, tmp2); -+} -+ -+void _dpk_set_bbtxagc_8821c(struct dm_struct *dm, u8 path) -+{ -+ u8 hw_rate, tmp; -+ -+ for (hw_rate = 0; hw_rate < 0x53; hw_rate++) { -+ phydm_write_txagc_1byte_8821c(dm, 0x30, (enum rf_path)0x0, hw_rate); -+ -+ tmp = config_phydm_read_txagc_8821c(dm, (enum rf_path)0x0, hw_rate); -+#if 0 -+ /* -+ RF_DBG(dm, DBG_RF_IQK, -+ "hw_rate =0x%x, tmp =0x%x \n", hw_rate, tmp); -+*/ -+#endif -+ } -+} -+ -+u8 _dpk_get_txagcindpk_8821c(struct dm_struct *dm, u8 path) -+{ -+ u32 tmp1, tmp2, tmp3; -+ u8 tmp4; -+ tmp1 = odm_read_4byte(dm, 0x1bcc); -+ odm_set_bb_reg(dm, R_0x1bcc, BIT(26), 0x01); -+ tmp2 = odm_read_4byte(dm, 0x1bd4); -+ odm_set_bb_reg(dm, R_0x1bd4, BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16), 0x0a); -+ tmp3 = odm_read_4byte(dm, 0x1bfc); -+ tmp4 = ((u8)odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD)) >> 2; -+#if 0 -+ /* -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]return txagc = 0x%x , 1bfc = 0x%x,rf00=0x%x\n", -+ tmp4, odm_read_4byte(dm, 0x1bfc), -+ odm_get_rf_reg(dm, path, RF_0x00, RFREGOFFSETMASK)); -+*/ -+#endif -+ odm_write_4byte(dm, 0x1bcc, tmp1); -+ odm_write_4byte(dm, 0x1bd4, tmp2); -+ -+ return tmp4; -+} -+ -+void _dpk_ampmcurce_8821c(struct dm_struct *dm, u8 path) -+{ -+ u8 i; -+ RF_DBG(dm, DBG_RF_IQK, "[DPK] 0x1bcc = 0x%x, 0x1bb8 =0x%x\n", -+ odm_read_4byte(dm, 0x1bcc), odm_read_4byte(dm, 0x1bb8)); -+ -+ odm_write_4byte(dm, 0x1bcc, 0x118f8800); -+ for (i = 0; i < 8; i++) { -+ odm_write_4byte(dm, 0x1b90, 0x0101e018 + i); -+ odm_write_4byte(dm, 0x1bd4, 0x00060000); -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ odm_write_4byte(dm, 0x1bd4, 0x00070000); -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ odm_write_4byte(dm, 0x1bd4, 0x00080000); -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ odm_write_4byte(dm, 0x1bd4, 0x00090000); -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ } -+ -+ odm_write_4byte(dm, 0x1b90, 0x0001e018); -+} -+void _dpk_readsram_8821c(struct dm_struct *dm, u8 path) -+{ -+ /* dbg message*/ -+ u8 i; -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ odm_write_4byte(dm, 0x1b08, 0x00000080); -+ odm_write_4byte(dm, 0x1bd4, 0x00040001); -+ -+ RF_DBG(dm, DBG_RF_IQK, "[DPK] SRAM value!!!\n"); -+ -+ for (i = 0; i < 64; i++) { -+#if 0 -+ /*odm_write_4byte(dm, 0x1b90, 0x0101e018+i);*/ -+#endif -+ odm_write_4byte(dm, 0x1bdc, 0xc0000081 + i * 2); -+ -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ } -+ odm_write_4byte(dm, 0x1bd4, 0x00050001); -+ for (i = 0; i < 64; i++) { -+#if 0 -+ /*odm_write_4byte(dm, 0x1b90, 0x0101e018+i);*/ -+#endif -+ odm_write_4byte(dm, 0x1bdc, 0xc0000081 + i * 2); -+ -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ } -+#if 0 -+ /*ODM_sleep_ms(200);*/ -+#endif -+ ODM_delay_ms(200); -+#if 0 -+ /*odm_write_4byte(dm, 0x1b08, 0x00000080);*/ -+#endif -+ odm_write_4byte(dm, 0x1bd4, 0xA0001); -+ odm_write_4byte(dm, 0x1bdc, 0x00000000); -+} -+ -+void _dpk_restore_8821c(struct dm_struct *dm, u8 path) -+{ -+ odm_write_4byte(dm, 0xc60, 0x700B8040); -+ odm_write_4byte(dm, 0xc60, 0x700B8040); -+ odm_write_4byte(dm, 0xc60, 0x70146040); -+ odm_write_4byte(dm, 0xc60, 0x70246040); -+ odm_write_4byte(dm, 0xc60, 0x70346040); -+ odm_write_4byte(dm, 0xc60, 0x70446040); -+ odm_write_4byte(dm, 0xc60, 0x705B2040); -+ odm_write_4byte(dm, 0xc60, 0x70646040); -+ odm_write_4byte(dm, 0xc60, 0x707B8040); -+ odm_write_4byte(dm, 0xc60, 0x708B8040); -+ odm_write_4byte(dm, 0xc60, 0x709B8040); -+ odm_write_4byte(dm, 0xc60, 0x70aB8040); -+ odm_write_4byte(dm, 0xc60, 0x70bB6040); -+ odm_write_4byte(dm, 0xc60, 0x70c06040); -+ odm_write_4byte(dm, 0xc60, 0x70d06040); -+ odm_write_4byte(dm, 0xc60, 0x70eF6040); -+ odm_write_4byte(dm, 0xc60, 0x70f06040); -+ -+ odm_write_4byte(dm, 0xc58, 0xd8020402); -+ odm_write_4byte(dm, 0xc5c, 0xde000120); -+ odm_write_4byte(dm, 0xc6c, 0x0000122a); -+ -+ odm_write_4byte(dm, 0x808, 0x24028211); -+#if 0 -+ /*odm_write_4byte(dm, 0x810, 0x211042A5);*/ -+#endif -+ odm_write_4byte(dm, 0x90c, 0x13000000); -+ odm_write_4byte(dm, 0x9a4, 0x80000088); -+ odm_write_4byte(dm, 0xc94, 0x01000101); -+ odm_write_4byte(dm, 0x1904, 0x00238000); -+ odm_write_4byte(dm, 0x1904, 0x00228000); -+ odm_write_4byte(dm, 0xC00, 0x00000007); -+} -+ -+void _dpk_clear_sram_8821c(struct dm_struct *dm, u8 path) -+{ -+ u8 i; -+ -+ /* write pwsf*/ -+ /*S3*/ -+ odm_write_4byte(dm, 0x1bdc, 0x40caffe1); -+ odm_write_4byte(dm, 0x1bdc, 0x4080a1e3); -+ odm_write_4byte(dm, 0x1bdc, 0x405165e5); -+ odm_write_4byte(dm, 0x1bdc, 0x403340e7); -+ odm_write_4byte(dm, 0x1bdc, 0x402028e9); -+ odm_write_4byte(dm, 0x1bdc, 0x401419eb); -+ odm_write_4byte(dm, 0x1bdc, 0x400d10ed); -+ odm_write_4byte(dm, 0x1bdc, 0x40080aef); -+ -+ odm_write_4byte(dm, 0x1bdc, 0x400506f1); -+ odm_write_4byte(dm, 0x1bdc, 0x400304f3); -+ odm_write_4byte(dm, 0x1bdc, 0x400203f5); -+ odm_write_4byte(dm, 0x1bdc, 0x400102f7); -+ odm_write_4byte(dm, 0x1bdc, 0x400101f9); -+ odm_write_4byte(dm, 0x1bdc, 0x400101fb); -+ odm_write_4byte(dm, 0x1bdc, 0x400101fd); -+ odm_write_4byte(dm, 0x1bdc, 0x400101ff); -+ /*S0*/ -+ odm_write_4byte(dm, 0x1bdc, 0x40caff81); -+ odm_write_4byte(dm, 0x1bdc, 0x4080a183); -+ odm_write_4byte(dm, 0x1bdc, 0x40516585); -+ odm_write_4byte(dm, 0x1bdc, 0x40334087); -+ odm_write_4byte(dm, 0x1bdc, 0x40202889); -+ odm_write_4byte(dm, 0x1bdc, 0x4014198b); -+ odm_write_4byte(dm, 0x1bdc, 0x400d108d); -+ odm_write_4byte(dm, 0x1bdc, 0x40080a8f); -+ odm_write_4byte(dm, 0x1bdc, 0x40050691); -+ odm_write_4byte(dm, 0x1bdc, 0x40030493); -+ odm_write_4byte(dm, 0x1bdc, 0x40020395); -+ odm_write_4byte(dm, 0x1bdc, 0x40010297); -+ odm_write_4byte(dm, 0x1bdc, 0x40010199); -+ odm_write_4byte(dm, 0x1bdc, 0x4001019b); -+ odm_write_4byte(dm, 0x1bdc, 0x4001019d); -+ odm_write_4byte(dm, 0x1bdc, 0x4001019f); -+ -+ odm_write_4byte(dm, 0x1bdc, 0x00000000); -+ -+ /*clear sram even*/ -+ for (i = 0; i < 0x40; i++) -+ odm_write_4byte(dm, 0x1bdc, 0xd0000000 + ((i * 2) + 1)); -+ /*clear sram odd*/ -+ for (i = 0; i < 0x40; i++) -+ odm_write_4byte(dm, 0x1bdc, 0x90000080 + ((i * 2) + 1)); -+ -+ odm_write_4byte(dm, 0x1bdc, 0x0); -+ RF_DBG(dm, DBG_RF_IQK, "[DPK]==========write pwsf and clear sram/n"); -+} -+ -+void _dpk_setting_8821c(struct dm_struct *dm, u8 path) -+{ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]==========Start the DPD setting Initilaize/n"); -+ /*AFE setting*/ -+ odm_write_4byte(dm, 0xc60, 0x50000000); -+ odm_write_4byte(dm, 0xc60, 0x700F0040); -+ odm_write_4byte(dm, 0xc5c, 0xd1000120); -+ odm_write_4byte(dm, 0xc58, 0xd8000402); -+ odm_write_4byte(dm, 0xc6c, 0x00000a15); -+ odm_write_4byte(dm, 0xc00, 0x00000004); -+#if 0 -+ /*_iqk_bb_reset_8821c(dm);*/ -+#endif -+ odm_write_4byte(dm, 0xe5c, 0xD1000120); -+ odm_write_4byte(dm, 0xc6c, 0x00000A15); -+ odm_write_4byte(dm, 0xe6c, 0x00000A15); -+ odm_write_4byte(dm, 0x808, 0x2D028200); -+#if 0 -+ /*odm_write_4byte(dm, 0x810, 0x211042A5);*/ -+#endif -+ odm_write_4byte(dm, 0x8f4, 0x00d80fb1); -+ odm_write_4byte(dm, 0x90c, 0x0B00C000); -+ odm_write_4byte(dm, 0x9a4, 0x00000080); -+ odm_write_4byte(dm, 0xc94, 0x01000101); -+ odm_write_4byte(dm, 0xe94, 0x01000101); -+ odm_write_4byte(dm, 0xe5c, 0xD1000120); -+ odm_write_4byte(dm, 0xc6c, 0x00000A15); -+ odm_write_4byte(dm, 0xe6c, 0x00000A15); -+ odm_write_4byte(dm, 0x1904, 0x00020000); -+ /*path A*/ -+ /*RF*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREGOFFSETMASK, 0x80000); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREGOFFSETMASK, 0x00024); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3e, RFREGOFFSETMASK, 0x0003F); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREGOFFSETMASK, 0xCBFCE); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREGOFFSETMASK, 0x00000); -+ /*AGC boundary selection*/ -+ odm_write_4byte(dm, 0x1bbc, 0x0001abf6); -+ odm_write_4byte(dm, 0x1b90, 0x0001e018); -+ odm_write_4byte(dm, 0x1bb8, 0x000fffff); -+ odm_write_4byte(dm, 0x1bc8, 0x000c55aa); -+#if 0 -+ /*odm_write_4byte(dm, 0x1bcc, 0x11978200);*/ -+#endif -+ odm_write_4byte(dm, 0x1bcc, 0x11978800); -+#if 0 -+ /*odm_write_4byte(dm, 0xcb0, 0x77775747);*/ -+ /*odm_write_4byte(dm, 0xcb4, 0x100000f7);*/ -+ /*odm_write_4byte(dm, 0xcb4, 0x10000007);*/ -+ /*odm_write_4byte(dm, 0xcbc, 0x0);*/ -+#endif -+} -+ -+void _dpk_dynamic_bias_8821c(struct dm_struct *dm, u8 path, u8 dynamicbias) -+{ -+ u32 tmp; -+ tmp = odm_get_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK); -+ tmp = tmp | BIT(8); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, tmp); -+ if ((*dm->band_type == ODM_BAND_5G) && (*dm->band_width == 1)) -+ odm_set_rf_reg(dm, path, RF_0x61, BIT(7) | BIT(6) | BIT(5) | BIT(4), dynamicbias); -+ if ((*dm->band_type == ODM_BAND_5G) && (*dm->band_width == 2)) -+ odm_set_rf_reg(dm, path, RF_0x61, BIT(7) | BIT(6) | BIT(5) | BIT(4), dynamicbias); -+ tmp = tmp & (~BIT(8)); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, tmp); -+ RF_DBG(dm, DBG_RF_IQK, "[DPK]Set DynamicBias 0xdf=0x%x, 0x61=0x%x\n", -+ odm_get_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK), -+ odm_get_rf_reg(dm, RF_PATH_A, RF_0x61, RFREGOFFSETMASK)); -+} -+ -+void _dpk_boundary_selection_8821c(struct dm_struct *dm, u8 path) -+{ -+ u8 tmp_pad, compared_pad, compared_txbb; -+ u32 rf_backup_reg00; -+ u8 i = 0; -+ u8 j = 1; -+ u32 boundaryselect = 0; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ RF_DBG(dm, DBG_RF_IQK, "[DPK]Start the DPD boundary selection\n"); -+ rf_backup_reg00 = odm_get_rf_reg(dm, (enum rf_path)path, RF_0x00, RFREGOFFSETMASK); -+ tmp_pad = 0; -+ compared_pad = 0; -+ boundaryselect = 0; -+#if dpk_forcein_sram4 -+ for (i = 0x1f; i > 0x0; i--) { /*i=tx index*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK, 0x20000 + i); -+ -+ if (iqk_info->is_btg) { -+ compared_pad = (u8)((0x1c000 & odm_get_rf_reg(dm, (enum rf_path)path, RF_0x78, RFREGOFFSETMASK)) >> 14); -+ compared_txbb = (u8)((0x07C00 & odm_get_rf_reg(dm, (enum rf_path)path, RF_0x5c, RFREGOFFSETMASK)) >> 10); -+ } else { -+ compared_pad = (u8)((0xe0 & odm_get_rf_reg(dm, (enum rf_path)path, RF_0x56, RFREGOFFSETMASK)) >> 5); -+ compared_txbb = (u8)((0x1f & odm_get_rf_reg(dm, (enum rf_path)path, RF_0x56, RFREGOFFSETMASK))); -+ } -+ if (i == 0x1f) { -+ /*boundaryselect = compared_txbb;*/ -+ boundaryselect = 0x1f; -+ tmp_pad = compared_pad; -+ } -+ if (compared_pad < tmp_pad) { -+ boundaryselect = boundaryselect + (i << (j * 5)); -+ tmp_pad = compared_pad; -+ j++; -+ } -+ -+ if (j >= 4) -+ break; -+ } -+ -+#else -+ boundaryselect = 0x0; -+#endif -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK, rf_backup_reg00); -+ odm_write_4byte(dm, 0x1bbc, boundaryselect); -+} -+ -+u8 _dpk_get_dpk_tx_agc_8821c(struct dm_struct *dm, u8 path) -+{ -+ u8 tx_agc_init_value = 0x1f; /* DPK TXAGC value*/ -+ u32 rf_reg00 = 0x0; -+ u8 gainloss = 0x1; -+ u8 best_tx_agc, txagcindpk = 0x0; -+ u8 tmp; -+ boolean fail = true; -+ u32 IQK_CMD = 0xf8000d18; -+ -+ /* rf_reg00 = 0x40000 + tx_agc_init_value; set TXAGC value */ -+ if (*dm->band_type == ODM_BAND_5G) { -+ tx_agc_init_value = 0x1c; -+ rf_reg00 = 0x40000 + tx_agc_init_value; /* set TXAGC value*/ -+#if 0 -+ /*rf_reg00 = 0x54000 + tx_agc_init_value;*/ /* set TXAGC value*/ -+#endif -+ odm_write_4byte(dm, 0x1bc8, 0x000c55aa); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x8f, RFREGOFFSETMASK, 0xa9c00); -+ } else { -+ tx_agc_init_value = 0x17; -+ rf_reg00 = 0x44000 + tx_agc_init_value; /* set TXAGC value*/ -+#if 0 -+ /*rf_reg00 = 0x54000 + tx_agc_init_value; */ /* set TXAGC value*/ -+#endif -+ odm_write_4byte(dm, 0x1bc8, 0x000c44aa); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x8f, RFREGOFFSETMASK, 0xaec00); -+ } -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK, rf_reg00); -+ odm_set_bb_reg(dm, R_0x1b8c, BIT(15) | BIT(14) | BIT(13), gainloss); -+ odm_set_bb_reg(dm, R_0x1bc8, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0x8f8, BIT(25) | BIT(24) | BIT(23) | BIT(22), 0x5); -+ -+ _dpk_set_bbtxagc_8821c(dm, RF_PATH_A); -+ txagcindpk = _dpk_get_txagcindpk_8821c(dm, RF_PATH_A); -+ -+ if (odm_get_rf_reg(dm, path, RF_0x08, RFREGOFFSETMASK) != 0x0) -+ odm_set_rf_reg(dm, path, RF_0x8, RFREGOFFSETMASK, 0x0); -+ ; -+#if 0 -+ /*ODM_sleep_ms(1);*/ -+#endif -+ ODM_delay_us(10); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD + 1); -+ -+ fail = _iqk_check_nctl_done_8821c(dm, path, IQK_CMD); -+ -+ odm_write_4byte(dm, 0x1b90, 0x0001e018); -+#if 0 -+ /* -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]rf_reg00 =0x%x, 0x8F =0x%x, txagcindpk =0x%x\n", -+ odm_get_rf_reg(dm, path, RF_0x00, RFREGOFFSETMASK), -+ odm_get_rf_reg(dm, path, RF_0x8f, RFREGOFFSETMASK),txagcindpk); -+*/ -+#endif -+ -+ odm_write_4byte(dm, 0x1bd4, 0x60001); -+ tmp = (u8)odm_read_4byte(dm, 0x1bfc); -+ best_tx_agc = tx_agc_init_value - (0xa - tmp); -+#if 0 -+/* -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK](2), 0x1b8c =0x%x, rf_reg00 = 0x%x, 0x1b00 = 0x%x, 0x1bfc = 0x%x, 0x1bd4 = 0x%x,best_tx_agc =0x%x, 0x1bfc[7:0] =0x%x\n", -+ odm_read_4byte(dm, 0x1b8c), -+ odm_get_rf_reg(dm, path, RF_0x00, RFREGOFFSETMASK), -+ odm_read_4byte(dm, 0x1b00), -+ odm_read_4byte(dm, 0x1bfc), odm_read_4byte(dm, 0x1bd4), -+ best_tx_agc, tmp); -+*/ -+#endif -+/* dbg message*/ -+#if 0 -+ -+ RF_DBG(dm, DBG_RF_IQK, "[DPK] 0x1bcc = 0x%x, 0x1bb8 =0x%x\n", -+ odm_read_4byte(dm, 0x1bcc), odm_read_4byte(dm, 0x1bb8)); -+ -+ odm_write_4byte(dm, 0x1bcc, 0x118f8800); -+ for (i = 0 ; i < 8; i++) { -+ odm_write_4byte(dm, 0x1b90, 0x0101e018 + i); -+ odm_write_4byte(dm, 0x1bd4, 0x00060000); -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ odm_write_4byte(dm, 0x1bd4, 0x00070000); -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ odm_write_4byte(dm, 0x1bd4, 0x00080000); -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ odm_write_4byte(dm, 0x1bd4, 0x00090000); -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ } -+ -+ odm_write_4byte(dm, 0x1b90, 0x0001e018); -+ -+#endif -+ return best_tx_agc; -+} -+ -+boolean -+_dpk_enable_dpk_8821c(struct dm_struct *dm, u8 path, u8 best_tx_agc) -+{ -+ u32 rf_reg00 = 0x0; -+ boolean fail = true; -+ u32 IQK_CMD = 0xf8000e18; -+ -+ if (*dm->band_type == ODM_BAND_5G) -+ rf_reg00 = 0x40000 + best_tx_agc; /* set TXAGC value*/ -+ else -+ rf_reg00 = 0x44000 + best_tx_agc; /* set TXAGC value*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK, rf_reg00); -+ _dpk_set_dpk_pa_scan(dm, RF_PATH_A); -+ -+ /*ODM_sleep_ms(1);*/ -+ ODM_delay_us(10); -+ odm_set_bb_reg(dm, R_0x1bc8, BIT(31), 0x1); -+ odm_write_4byte(dm, 0x8f8, 0x41400080); -+ -+ if (odm_get_rf_reg(dm, path, RF_0x08, RFREGOFFSETMASK) != 0x0) -+ odm_set_rf_reg(dm, path, RF_0x8, RFREGOFFSETMASK, 0x0); -+ -+ /*ODM_sleep_ms(1);*/ -+ ODM_delay_us(10); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD + 1); -+ -+ odm_write_4byte(dm, 0x1b90, 0x0001e018); -+ odm_write_4byte(dm, 0x1bd4, 0xA0001); -+ fail = _iqk_check_nctl_done_8821c(dm, path, IQK_CMD); -+#if 0 -+/* -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK] (3) 0x1b0b = 0x%x, 0x1bc8 = 0x%x, rf_reg00 = 0x%x, ,0x1bfc = 0x%x, 0x1b90=0x%x, 0x1b94=0x%x\n", -+ odm_read_1byte(dm, 0x1b0b), odm_read_4byte(dm, 0x1bc8), odm_get_rf_reg(dm, path, RF_0x00, RFREGOFFSETMASK), -+ odm_read_4byte(dm, 0x1bfc), odm_read_4byte(dm, 0x1b90), odm_read_4byte(dm, 0x1b94)); -+*/ -+#endif -+#if 0 /* dbg message*/ -+ u8 delay_count = 0x0; -+ u8 i; -+ u32 tmp; -+ odm_write_4byte(dm, 0x1b00, 0xf8000008); -+ odm_write_4byte(dm, 0x1b08, 0x00000080); -+ odm_write_4byte(dm, 0x1bd4, 0x00040001); -+ -+ RF_DBG(dm, DBG_RF_IQK, "[DPK] SRAM value!!!\n"); -+ -+ for (i = 0 ; i < 64; i++) { -+ /*odm_write_4byte(dm, 0x1b90, 0x0101e018+i);*/ -+ odm_write_4byte(dm, 0x1bdc, 0xc0000081 + i * 2); -+ -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ } -+ odm_write_4byte(dm, 0x1bd4, 0x00050001); -+ for (i = 0 ; i < 64; i++) { -+ /*odm_write_4byte(dm, 0x1b90, 0x0101e018+i);*/ -+ odm_write_4byte(dm, 0x1bdc, 0xc0000081 + i * 2); -+ -+ RF_DBG(dm, DBG_RF_IQK, "0x%x\n", odm_read_4byte(dm, 0x1bfc)); -+ } -+ -+ /*odm_write_4byte(dm, 0x1b08, 0x00000080);*/ -+ odm_write_4byte(dm, 0x1bd4, 0xA0001); -+ odm_write_4byte(dm, 0x1bdc, 0x00000000); -+#endif -+ return fail; -+} -+ -+boolean -+_dpk_enable_dpd_8821c(struct dm_struct *dm, u8 path, u8 best_tx_agc) -+{ -+ boolean fail = true; -+ u8 offset = 0x0; -+ u32 IQK_CMD = 0xf8000f18; -+ u8 external_pswf_gain; -+ boolean gain_scaling_enable = false; -+ -+ odm_set_bb_reg(dm, R_0x1bc8, BIT(31), 0x1); -+ odm_write_4byte(dm, 0x8f8, 0x41400080); -+ if (odm_get_rf_reg(dm, path, RF_0x08, RFREGOFFSETMASK) != 0x0) -+ odm_set_rf_reg(dm, path, RF_0x8, RFREGOFFSETMASK, 0x0); -+ /*ODM_sleep_ms(1);*/ -+ ODM_delay_us(10); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD); -+ odm_write_4byte(dm, 0x1b00, IQK_CMD + 1); -+ fail = _iqk_check_nctl_done_8821c(dm, path, IQK_CMD); -+ -+ odm_write_4byte(dm, 0x1b90, 0x0001e018); -+ odm_write_4byte(dm, 0x1bd4, 0xA0001); -+ -+ if (!fail) { -+ odm_write_4byte(dm, 0x1bcf, 0x19); -+ odm_write_4byte(dm, 0x1bdc, 0x0); -+ /*add 2db extrnal for compensate performnace, the reason is unknown*/ -+ external_pswf_gain = 0x2; -+ best_tx_agc = best_tx_agc + external_pswf_gain; -+ -+ if (best_tx_agc >= 0x19) -+ offset = best_tx_agc - 0x19; -+ else -+ offset = 0x20 - (0x19 - best_tx_agc); -+ odm_set_bb_reg(dm, R_0x1bd0, BIT(12) | BIT(11) | BIT(10) | BIT(9) | BIT(8), offset); -+ if (gain_scaling_enable) -+ _dpk_set_gain_scaling(dm, RF_PATH_A); -+ else -+ odm_write_4byte(dm, 0x1b98, 0x4c004c00); -+ -+ } else { -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK](4)0x1b08 =%x, 0x1bc8 = 0x%x,0x1bfc = 0x%x, ,0x1bd0 = 0x%x, offset =%x, 1bcc =%x\n", -+ odm_read_4byte(dm, 0x1b08), odm_read_4byte(dm, 0x1bc8), -+ odm_read_1byte(dm, 0x1bfc), odm_read_4byte(dm, 0x1bd0), -+ offset, odm_read_4byte(dm, 0x1bcc)); -+ } -+ -+ return fail; -+} -+ -+void _phy_dpd_calibrate_8821c(struct dm_struct *dm, boolean reset) -+{ -+ u32 backup_dpdbb[3]; -+ u8 best_tx_agc = 0x1c; -+ u32 MAC_backup[MAC_REG_NUM_8821C], RF_backup[RF_REG_NUM_8821C][1]; -+ u32 backup_mac_reg[MAC_REG_NUM_8821C] = {0x520, 0x550, 0x1518}; -+ u32 BB_backup[DPK_BB_REG_NUM_8821C]; -+ u32 backup_bb_reg[DPK_BB_REG_NUM_8821C] = {0x808, 0x90c, 0xc00, 0xcb0, 0xcb4, 0xcbc, 0x1990, 0x9a4, 0xa04, 0xc58, 0xc5c, 0xe58, 0xe5c, 0xc6c, 0xe6c, 0x90c, 0xc94, 0xe94, 0x1904, 0xcb0, 0xcb4, 0xcbc, 0xc00}; -+ u32 backup_rf_reg[RF_REG_NUM_8821C] = {0xdf, 0xde, 0x8f, 0x0, 0x1}; -+ u8 i; -+ u32 backup_dpk_reg[3] = {0x1bd0, 0x1b98, 0x1bbc}; -+ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ iqk_info->is_btg = (boolean)odm_get_bb_reg(dm, R_0xcb8, BIT(16)); -+ if (!(*dm->mp_mode)) -+ if (_iqk_reload_iqk_8821c(dm, reset)) -+ return; -+ if (!(*dm->band_type == ODM_BAND_5G)) -+ return; -+ -+ RF_DBG(dm, DBG_RF_IQK, "[DPK]==========DPK strat!!!!!==========\n"); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]band_type = %s, band_width = %d, ExtPA2G = %d, ext_pa_5g = %d\n", -+ (*dm->band_type == ODM_BAND_5G) ? "5G" : "2G", *dm->band_width, -+ dm->ext_pa, dm->ext_pa_5g); -+ _iqk_backup_mac_bb_8821c(dm, MAC_backup, BB_backup, backup_mac_reg, backup_bb_reg, DPK_BB_REG_NUM_8821C); -+ _iqk_afe_setting_8821c(dm, true); -+ _iqk_backup_rf_8821c(dm, RF_backup, backup_rf_reg); -+ -+ if (iqk_info->is_btg) { -+ } else { -+ if (*dm->band_type == ODM_BAND_2_4G) -+ odm_set_bb_reg(dm, R_0xcb8, BIT(8), 0x1); -+ else -+ odm_set_bb_reg(dm, R_0xcb8, BIT(8), 0x0); -+ } -+ -+ /*backup 0x1b2c, 1b38,0x1b3c*/ -+ backup_dpdbb[0] = odm_read_4byte(dm, 0x1b2c); -+ backup_dpdbb[1] = odm_read_4byte(dm, 0x1b38); -+ backup_dpdbb[2] = odm_read_4byte(dm, 0x1b3c); -+ RF_DBG(dm, DBG_RF_IQK, "[DPK]In DPD Process(1), Backup\n"); -+ -+ /*PDK Init Register setting*/ -+ _dpk_clear_sram_8821c(dm, RF_PATH_A); -+ _dpk_setting_8821c(dm, RF_PATH_A); -+ _dpk_boundary_selection_8821c(dm, RF_PATH_A); -+ odm_set_bb_reg(dm, R_0x1bc8, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0x8f8, BIT(25) | BIT(24) | BIT(23) | BIT(22), 0x5); -+ /* Get the best TXAGC*/ -+ -+ best_tx_agc = _dpk_get_dpk_tx_agc_8821c(dm, RF_PATH_A); -+#if 0 -+ /*ODM_sleep_ms(2);*/ -+#endif -+ -+ ODM_delay_us(10); -+ RF_DBG(dm, DBG_RF_IQK, "[DPK]In DPD Process(2), Best TXAGC = 0x%x\n", -+ best_tx_agc); -+ -+ if (_dpk_enable_dpk_8821c(dm, RF_PATH_A, best_tx_agc)) { -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]In DPD Process(3), DPK process is Fail\n"); -+ } -+#if 0 -+ /*ODM_sleep_ms(2);*/ -+#endif -+ ODM_delay_us(10); -+ if (_dpk_enable_dpd_8821c(dm, RF_PATH_A, best_tx_agc)) { -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]In DPD Process(4), DPD process is Fail\n"); -+ } -+ /* restore IQK */ -+ iqk_info->rf_reg18 = odm_get_rf_reg(dm, RF_PATH_A, RF_0x18, RFREGOFFSETMASK); -+ _iqk_reload_iqk_setting_8821c(dm, 0, 2); -+ _iqk_fill_iqk_report_8821c(dm, 0); -+#if 0 -+ /* -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]reload IQK result before, iqk_info->rf_reg18=0x%x, iqk_info->iqk_channel[0]=0x%x, iqk_info->iqk_channel[1]=0x%x!!!!\n", -+ iqk_info->rf_reg18, iqk_info->iqk_channel[0], iqk_info->iqk_channel[1]); -+ */ -+#endif -+ -+ /* Restore setup */ -+#if 0 -+ /*_dpk_readsram_8821c(dm, RF_PATH_A);*/ -+#endif -+ _dpk_restore_8821c(dm, RF_PATH_A); -+ odm_set_bb_reg(dm, R_0x8f8, BIT(25) | BIT(24) | BIT(23) | BIT(22), 0x5); -+ odm_set_bb_reg(dm, R_0x1bd4, BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16), 0x0); -+ odm_set_bb_reg(dm, R_0x1b00, BIT(2) | BIT(1), 0x0); -+ odm_set_bb_reg(dm, R_0x1b08, BIT(6) | BIT(5), 0x2); -+ -+ odm_write_4byte(dm, 0x1b2c, backup_dpdbb[0]); -+ odm_write_4byte(dm, 0x1b38, backup_dpdbb[1]); -+ odm_write_4byte(dm, 0x1b3c, backup_dpdbb[2]); -+ /*enable DPK*/ -+ odm_set_bb_reg(dm, R_0x1b2c, BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x5); -+/*enable boundary condition*/ -+#if dpk_forcein_sram4 /* disable : froce in sram4*/ -+ odm_set_bb_reg(dm, R_0x1bcc, BIT(27), 0x1); -+#endif -+ odm_write_4byte(dm, 0x1bcc, 0x11868800); -+ RF_DBG(dm, DBG_RF_IQK, "[DPK]In DPD Process(5), Restore\n"); -+ _iqk_restore_mac_bb_8821c(dm, MAC_backup, BB_backup, backup_mac_reg, backup_bb_reg, DPK_BB_REG_NUM_8821C); -+ _iqk_afe_setting_8821c(dm, false); -+ _iqk_restore_rf_8821c(dm, backup_rf_reg, RF_backup); -+ /*toggle dynamic_pwr_threshold*/ -+ -+ /* backup the DPK current result*/ -+ for (i = 0; i < DPK_BACKUP_REG_NUM_8821C; i++) -+ dpk_result[i] = odm_read_4byte(dm, backup_dpk_reg[i]); -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]the DPD calibration Process Finish (6), 0x1bd0 = 0x%x, 0x1b98 = 0x%x, 0x1bbc0= 0x%x\n", -+ dpk_result[0], dpk_result[1], dpk_result[2]); -+} -+ -+u32 _iqk_tximr_selfcheck_8821c(void *dm_void, u8 tone_index, u8 path) -+{ -+ u32 tx_ini_power_H[2], tx_ini_power_L[2]; -+ u32 tmp1, tmp2, tmp3, tmp4, tmp5; -+ u32 IQK_CMD; -+ u32 tximr = 0x0; -+ u8 i; -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ /*backup*/ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ odm_write_4byte(dm, 0x1bc8, 0x80000000); -+ odm_write_4byte(dm, 0x8f8, 0x41400080); -+ tmp1 = odm_read_4byte(dm, 0x1b0c); -+ tmp2 = odm_read_4byte(dm, 0x1b14); -+ tmp3 = odm_read_4byte(dm, 0x1b1c); -+ tmp4 = odm_read_4byte(dm, 0x1b20); -+ tmp5 = odm_read_4byte(dm, 0x1b24); -+ /*setup*/ -+ odm_write_4byte(dm, 0x1b0c, 0x00003000); -+ odm_write_4byte(dm, 0x1b1c, 0xA2193C32); -+ odm_write_1byte(dm, 0x1b15, 0x00); -+ odm_write_4byte(dm, 0x1b20, (u32)(tone_index << 20 | 0x00040008)); -+ odm_write_4byte(dm, 0x1b24, (u32)(tone_index << 20 | 0x00060008)); -+ odm_write_4byte(dm, 0x1b2c, 0x07); -+ odm_write_4byte(dm, 0x1b38, 0x20000000); -+ odm_write_4byte(dm, 0x1b3c, 0x20000000); -+ /* ======derive pwr1========*/ -+ for (i = 0; i < 2; i++) { -+ if (i == 0) -+ odm_write_4byte(dm, 0x1bcc, 0x0f); -+ else -+ odm_write_4byte(dm, 0x1bcc, 0x09); -+ /* One Shot*/ -+ IQK_CMD = 0x00000800; -+ odm_write_4byte(dm, 0x1b34, IQK_CMD + 1); -+ odm_write_4byte(dm, 0x1b34, IQK_CMD); -+ ODM_delay_us(10); -+ odm_write_4byte(dm, 0x1bd4, 0x00040001); -+ tx_ini_power_H[i] = odm_read_4byte(dm, 0x1bfc); -+ odm_write_4byte(dm, 0x1bd4, 0x000C0001); -+ tx_ini_power_L[i] = odm_read_4byte(dm, 0x1bfc); -+ } -+ /*restore*/ -+ odm_write_4byte(dm, 0x1b0c, tmp1); -+ odm_write_4byte(dm, 0x1b14, tmp2); -+ odm_write_4byte(dm, 0x1b1c, tmp3); -+ odm_write_4byte(dm, 0x1b20, tmp4); -+ odm_write_4byte(dm, 0x1b24, tmp5); -+ -+ if (tx_ini_power_H[1] == tx_ini_power_H[0]) -+ tximr = (3 * (halrf_psd_log2base(tx_ini_power_L[0] << 2) - halrf_psd_log2base(tx_ini_power_L[1]))) / 100; -+ else -+ tximr = 0; -+ return tximr; -+} -+ -+u32 _iqk_rximr_selfcheck_8821c(void *dm_void, u8 tone_index, u8 path, -+ u32 tmp1b38) -+{ -+ u32 rx_ini_power_H[2], rx_ini_power_L[2]; /*[0]: psd tone; [1]: image tone*/ -+ u32 tmp1, tmp2, tmp3, tmp4, tmp5; -+ u32 IQK_CMD, tmp1bcc; -+ u8 i; -+ u32 rximr = 0x0; -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /*backup*/ -+ odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); -+ tmp1 = odm_read_4byte(dm, 0x1b0c); -+ tmp2 = odm_read_4byte(dm, 0x1b14); -+ tmp3 = odm_read_4byte(dm, 0x1b1c); -+ tmp4 = odm_read_4byte(dm, 0x1b20); -+ tmp5 = odm_read_4byte(dm, 0x1b24); -+ -+ tmp1bcc = (odm_read_4byte(dm, 0x1be8) & 0x0000ff00) >> 8; -+ odm_write_4byte(dm, 0x1b0c, 0x00001000); -+ odm_write_1byte(dm, 0x1b15, 0x00); -+ odm_write_4byte(dm, 0x1b1c, 0x82193d31); -+ odm_write_4byte(dm, 0x1b20, (u32)(tone_index << 20 | 0x00040008)); -+ odm_write_4byte(dm, 0x1b24, (u32)(tone_index << 20 | 0x00060048)); -+ odm_write_4byte(dm, 0x1b2c, 0x07); -+#if 0 -+ //odm_write_4byte(dm, 0x1b38, iqk_info->rxk1_tmp1b38[path][(tone_index&0xff0)>>4]); -+#endif -+ odm_write_4byte(dm, 0x1b38, tmp1b38); -+ -+ odm_write_4byte(dm, 0x1b3c, 0x20000000); -+ odm_write_4byte(dm, 0x1bcc, tmp1bcc); -+ for (i = 0; i < 2; i++) { -+ if (i == 0) -+ odm_write_4byte(dm, 0x1b1c, 0x82193d31); -+ else -+ odm_write_4byte(dm, 0x1b1c, 0xA2193d31); -+ IQK_CMD = 0x00000800; -+ odm_write_4byte(dm, 0x1b34, IQK_CMD + 1); -+ odm_write_4byte(dm, 0x1b34, IQK_CMD); -+ ODM_delay_us(2000); -+ odm_write_1byte(dm, 0x1bd6, 0xb); -+#if 0 -+ /*if ((boolean)odm_get_bb_reg(dm, R_0x1bfc, BIT(1))){*/ -+#endif -+ if (1) { -+ odm_write_1byte(dm, 0x1bd6, 0x5); -+ rx_ini_power_H[i] = odm_read_4byte(dm, 0x1bfc); -+ odm_write_1byte(dm, 0x1bd6, 0xe); -+ rx_ini_power_L[i] = odm_read_4byte(dm, 0x1bfc); -+ } else { -+ rx_ini_power_H[i] = 0x0; -+ rx_ini_power_L[i] = 0x0; -+ } -+ } -+ /*restore*/ -+ odm_write_4byte(dm, 0x1b0c, tmp1); -+ odm_write_4byte(dm, 0x1b14, tmp2); -+ odm_write_4byte(dm, 0x1b1c, tmp3); -+ odm_write_4byte(dm, 0x1b20, tmp4); -+ odm_write_4byte(dm, 0x1b24, tmp5); -+ -+ for (i = 0; i < 2; i++) -+ rx_ini_power_H[i] = (rx_ini_power_H[i] & 0xf8000000) >> 27; -+ -+ if (rx_ini_power_H[0] != rx_ini_power_H[1]) -+ switch (rx_ini_power_H[0]) { -+ case 1: -+ rx_ini_power_L[0] = (u32)((rx_ini_power_L[0] >> 1) | 0x80000000); -+ rx_ini_power_L[1] = (u32)rx_ini_power_L[1] >> 1; -+ break; -+ case 2: -+ rx_ini_power_L[0] = (u32)((rx_ini_power_L[0] >> 2) | 0x80000000); -+ rx_ini_power_L[1] = (u32)rx_ini_power_L[1] >> 2; -+ break; -+ case 3: -+ rx_ini_power_L[0] = (u32)((rx_ini_power_L[0] >> 2) | 0xc0000000); -+ rx_ini_power_L[1] = (u32)rx_ini_power_L[1] >> 2; -+ break; -+ case 4: -+ rx_ini_power_L[0] = (u32)((rx_ini_power_L[0] >> 3) | 0x80000000); -+ rx_ini_power_L[1] = (u32)rx_ini_power_L[1] >> 3; -+ break; -+ case 5: -+ rx_ini_power_L[0] = (u32)((rx_ini_power_L[0] >> 3) | 0xa0000000); -+ rx_ini_power_L[1] = (u32)rx_ini_power_L[1] >> 3; -+ break; -+ case 6: -+ rx_ini_power_L[0] = (u32)((rx_ini_power_L[0] >> 3) | 0xc0000000); -+ rx_ini_power_L[1] = (u32)rx_ini_power_L[1] >> 3; -+ break; -+ case 7: -+ rx_ini_power_L[0] = (u32)((rx_ini_power_L[0] >> 3) | 0xe0000000); -+ rx_ini_power_L[1] = (u32)rx_ini_power_L[1] >> 3; -+ break; -+ default: -+ break; -+ } -+ rximr = (u32)(3 * ((halrf_psd_log2base(rx_ini_power_L[0] / 100) - halrf_psd_log2base(rx_ini_power_L[1] / 100))) / 100); -+#if 0 -+ /* -+ RF_DBG(dm, DBG_RF_IQK, "%-20s: 0x%x, 0x%x, 0x%x, 0x%x,0x%x, tone_index=%x, rximr= %d\n", -+ (path == 0) ? "PATH A RXIMR ": "PATH B RXIMR", -+ rx_ini_power_H[0], rx_ini_power_L[0], rx_ini_power_H[1], rx_ini_power_L[1], tmp1bcc, tone_index, rximr); -+*/ -+#endif -+ return rximr; -+} -+ -+void _iqk_start_imr_test_8821c(void *dm_void, u8 path) -+{ -+ u8 imr_limit, i, tone_index; -+ u32 tmp; -+ boolean KFAIL; -+ u32 rxk1_tmp1b38[2][15]; -+ u32 imr_result[2]; -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /*TX IMR*/ -+ if (*dm->band_width == 2) -+ imr_limit = 0xe; -+ else if (*dm->band_width == 1) -+ imr_limit = 0x7; -+ else -+ imr_limit = 0x3; -+ -+ _iqk_txk_setting_8821c(dm, RF_PATH_A); -+ KFAIL = _iqk_one_shot_8821c(dm, RF_PATH_A, TXIQK); -+ for (i = 0x0; i <= imr_limit; i++) { -+ tone_index = (u8)(0x08 | i << 4); -+ imr_result[RF_PATH_A] = _iqk_tximr_selfcheck_8821c(dm, tone_index, RF_PATH_A); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]toneindex = %x, TXIMR = %d\n", -+ tone_index, imr_result[RF_PATH_A]); -+ } -+ RF_DBG(dm, DBG_RF_IQK, "\n"); -+ /*RX IMR*/ -+ /*get the rxk1 tone index 0x1b38 setting*/ -+ _iqk_rxk1setting_8821c(dm, path); -+ tmp = odm_read_4byte(dm, 0x1b1c); -+ for (path = 0; path < SS_8821C; path++) { -+ for (i = 0; i <= imr_limit; i++) { -+ tone_index = (u8)(0x08 | i << 4); -+ KFAIL = _iqk_rx_iqk_gain_search_fail_by_toneindex_8821c(dm, path, RXIQK1, tone_index); -+ if (!KFAIL) { -+ odm_write_4byte(dm, 0x1b1c, 0xa2193c32); -+ odm_write_4byte(dm, 0x1b14, 0xe5); -+ odm_write_4byte(dm, 0x1b14, 0x0); -+ rxk1_tmp1b38[path][i] = odm_read_4byte(dm, 0x1b38); -+ } else { -+ rxk1_tmp1b38[path][i] = 0x0; -+ } -+ } -+ } -+ _iqk_rxk2setting_8821c(dm, path, true); -+ for (path = 0; path < SS_8821C; path++) { -+ for (i = 0x0; i <= imr_limit; i++) { -+ tone_index = (u8)(0x08 | i << 4); -+ imr_result[RF_PATH_A] = _iqk_rximr_selfcheck_8821c(dm, tone_index, RF_PATH_A, rxk1_tmp1b38[path][i]); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]toneindex = %x, RXIMR = %d\n", tone_index, -+ imr_result[RF_PATH_A]); -+ } -+ } -+ odm_write_4byte(dm, 0x1b1c, tmp); -+ odm_write_4byte(dm, 0x1b38, 0x20000000); -+} -+ -+void _phy_iq_calibrate_8821c(struct dm_struct *dm, boolean reset, -+ boolean segment_iqk, boolean do_imr_test) -+{ -+ u32 MAC_backup[MAC_REG_NUM_8821C], BB_backup[BB_REG_NUM_8821C]; -+ u32 RF_backup[RF_REG_NUM_8821C][1]; -+ u32 backup_mac_reg[MAC_REG_NUM_8821C] = {0x520, 0x550, 0x1518}; -+ u32 backup_bb_reg[BB_REG_NUM_8821C] = {0x808, 0x90c, 0xc00, 0xcb0, -+ 0xcb4, 0xcbc, 0x1990, -+ 0x9a4, 0xa04, 0x838}; -+ u32 backup_rf_reg[RF_REG_NUM_8821C] = {0xdf, 0xde, 0x8f, 0x0, 0x1}; -+ boolean is_mp = false; -+ int i = 0; -+ -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+ if (*dm->mp_mode) -+ is_mp = true; -+ else if (dm->is_linked) -+ segment_iqk = false; -+ iqk_info->is_btg = (boolean)odm_get_bb_reg(dm, R_0xcb8, BIT(16)); -+ -+ if (!is_mp) -+ if (_iqk_reload_iqk_8821c(dm, reset)) -+ return; -+ if (!do_imr_test) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]==========IQK strat!!!!!==========\n"); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]band_type = %s, band_width = %d, ExtPA2G = %d, ext_pa_5g = %d\n", -+ (*dm->band_type == ODM_BAND_5G) ? "5G" : "2G", *dm->band_width, -+ dm->ext_pa, dm->ext_pa_5g); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]Interface = %d, Cv = %x\n", -+ dm->support_interface, dm->cut_version); -+ -+ iqk_info->tmp_gntwl = _iqk_indirect_read_reg(dm, 0x38); -+ iqk_info->iqk_times++; -+ iqk_info->kcount = 0; -+ dm->rf_calibrate_info.iqk_total_progressing_time = 0; -+ dm->rf_calibrate_info.iqk_step = 1; -+ iqk_info->rxiqk_step = 1; -+ iqk_info->is_reload = false; -+ -+ _iqk_backup_iqk_8821c(dm, 0x0, 0x0); -+ _iqk_backup_mac_bb_8821c(dm, MAC_backup, BB_backup, backup_mac_reg, backup_bb_reg, BB_REG_NUM_8821C); -+ _iqk_backup_rf_8821c(dm, RF_backup, backup_rf_reg); -+ -+ while (1) { -+ if (!is_mp) -+ dm->rf_calibrate_info.iqk_start_time = odm_get_current_time(dm); -+ -+ _iqk_configure_macbb_8821c(dm); -+ _iqk_afe_setting_8821c(dm, true); -+ _iqk_rfe_setting_8821c(dm, false); -+ _iqk_agc_bnd_int_8821c(dm); -+ _iqk_rfsetting_8821c(dm); -+ if (do_imr_test) { -+ _iqk_start_imr_test_8821c(dm, 0x0); -+ dm->rf_calibrate_info.iqk_step = 4; -+ } else { -+ _iqk_start_iqk_8821c(dm, segment_iqk); -+ } -+ _iqk_afe_setting_8821c(dm, false); -+ _iqk_restore_mac_bb_8821c(dm, MAC_backup, BB_backup, backup_mac_reg, backup_bb_reg, BB_REG_NUM_8821C); -+ _iqk_restore_rf_8821c(dm, backup_rf_reg, RF_backup); -+ -+ if (!is_mp) { -+ dm->rf_calibrate_info.iqk_progressing_time = odm_get_progressing_time(dm, dm->rf_calibrate_info.iqk_start_time); -+ dm->rf_calibrate_info.iqk_total_progressing_time += odm_get_progressing_time(dm, dm->rf_calibrate_info.iqk_start_time); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]IQK progressing_time = %lld ms\n", -+ dm->rf_calibrate_info.iqk_progressing_time); -+ } -+ -+ if (dm->rf_calibrate_info.iqk_step == 4) -+ break; -+ -+ iqk_info->kcount = 0; -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]delay 50ms!!!\n"); -+#if 0 -+ /*ODM_sleep_ms(50);*/ -+#endif -+ for (i = 0; i<1000; i++) -+ ODM_delay_us(10); -+ } -+ -+ if (!do_imr_test) { -+ if (segment_iqk) -+ _iqk_reload_iqk_setting_8821c(dm, 0x0, 0x1); -+ _iqk_fill_iqk_report_8821c(dm, 0); -+ if (!is_mp) -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]Total IQK progressing_time = %lld ms\n", -+ dm->rf_calibrate_info.iqk_total_progressing_time) -+ ; -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK]==========IQK end!!!!!==========\n"); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]check 0x49c = %x\n", -+ odm_read_1byte(dm, 0x49c)); -+ } -+} -+ -+void _phy_iq_calibrate_by_fw_8821c(void *dm_void, u8 clear, u8 segment_iqk) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ enum hal_status status = HAL_STATUS_FAILURE; -+ -+ if (*dm->mp_mode) -+ clear = 0x1; -+ else if (dm->is_linked) -+ segment_iqk = 0x1; -+ -+ status = odm_iq_calibrate_by_fw(dm, clear, segment_iqk); -+ -+ if (status == HAL_STATUS_SUCCESS) -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]FWIQK OK!!!\n"); -+ else -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]FWIQK fail!!!\n"); -+} -+ -+/*********debug message start**************/ -+ -+void _phy_iqk_XYM_Read_Using_0x1b38_8821c(struct dm_struct *dm, u8 path) -+{ -+ u32 tmp = 0x0; -+ u32 tmp2; -+ u8 i; -+ -+ tmp = odm_read_4byte(dm, 0x1b1c); -+ odm_write_4byte(dm, 0x1b1c, 0xA2193C32); -+ RF_DBG(dm, DBG_RF_IQK, "\n"); -+ for (i = 0; i < 0xa; i++) { -+ odm_write_4byte(dm, 0x1b14, 0xe6 + i); -+ odm_write_4byte(dm, 0x1b14, 0x0); -+ tmp2 = odm_read_4byte(dm, 0x1b38); -+ RF_DBG(dm, DBG_RF_IQK, "%x\n", tmp2); -+ } -+ odm_write_4byte(dm, 0x1b1c, tmp); -+ RF_DBG(dm, DBG_RF_IQK, "\n"); -+ odm_write_4byte(dm, 0x1b38, 0x20000000); -+} -+ -+void _phy_iqk_debug_inner_lpbk_psd_8821c(struct dm_struct *dm, u8 path) -+{ -+ s16 tx_x; -+ s16 tx_y; -+ u32 temp = 0x0; -+ u32 psd_pwr = 0x0; -+ u32 tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7, tmp8, tmp9, tmp10; -+ -+ tmp1 = odm_read_4byte(dm, 0x1b20); -+ tmp2 = odm_read_4byte(dm, 0x1b24); -+ tmp3 = odm_read_4byte(dm, 0x1b15); -+ tmp4 = odm_read_4byte(dm, 0x1b18); -+ tmp5 = odm_read_4byte(dm, 0x1b1c); -+ tmp6 = odm_read_4byte(dm, 0x1b28); -+ tmp7 = odm_read_4byte(dm, 0x1b90); -+ tmp8 = odm_read_4byte(dm, 0x1bcc); -+ tmp9 = odm_read_4byte(dm, 0x1b2c); -+ tmp10 = odm_read_4byte(dm, 0x1b30); -+ odm_write_4byte(dm, 0x1b20, 0x03840008); -+ odm_write_4byte(dm, 0x1b24, 0x03860008); -+ odm_write_1byte(dm, 0x1b15, 0x00); -+ odm_write_4byte(dm, 0x1b18, 0x00010101); -+ odm_write_4byte(dm, 0x1b1c, 0x02effcb2); -+ odm_write_4byte(dm, 0x1b28, 0x00060c00); -+ odm_write_4byte(dm, 0x1b90, 0x00080003); -+ odm_write_4byte(dm, 0x1bcc, 0x00000009); -+ odm_write_4byte(dm, 0x1b2c, 0x20000003); -+ odm_write_4byte(dm, 0x1b30, 0x20000000); -+ RF_DBG(dm, DBG_RF_IQK, "\n"); -+ for (tx_x = 507; tx_x <= 532; tx_x++) { -+ for (tx_y = 0; tx_y <= 10 + 20; tx_y++) { -+ if (tx_y < 0) -+ temp = (tx_x << 20) | (tx_y + 2048) << 8; -+ else -+ temp = (tx_x << 20) | (tx_y << 8); -+ odm_write_4byte(dm, 0x1b38, temp); -+ odm_write_4byte(dm, 0x1b3c, 0x20000000); -+ odm_write_4byte(dm, 0x1b34, 0x00000801); -+ odm_write_4byte(dm, 0x1b34, 0x00000800); -+ ODM_delay_us(10); -+ /*PSD_bef_K*/ -+ odm_write_4byte(dm, 0x1bd4, 0x000c0001); -+ psd_pwr = odm_read_4byte(dm, 0x1bfc); -+ RF_DBG(dm, DBG_RF_IQK, "%d ", psd_pwr); -+ } -+ } -+ RF_DBG(dm, DBG_RF_IQK, "\n"); -+ odm_write_4byte(dm, 0x1b20, tmp1); -+ odm_write_4byte(dm, 0x1b24, tmp2); -+ odm_write_4byte(dm, 0x1b15, tmp3); -+ odm_write_4byte(dm, 0x1b18, tmp4); -+ odm_write_4byte(dm, 0x1b1c, tmp5); -+ odm_write_4byte(dm, 0x1b28, tmp6); -+ odm_write_4byte(dm, 0x1b90, tmp7); -+ odm_write_4byte(dm, 0x1bcc, tmp8); -+ odm_write_4byte(dm, 0x1b2c, tmp9); -+ odm_write_4byte(dm, 0x1b30, tmp10); -+ odm_write_4byte(dm, 0x1b38, 0x20000000); -+} -+ -+void _iqk_readsram_8821c(struct dm_struct *dm, u8 path) -+{ -+ u32 tmp1bd4, tmp1bd8, tmp; -+ u8 i; -+ -+ tmp1bd4 = odm_read_4byte(dm, 0x1bd4); -+ tmp1bd8 = odm_read_4byte(dm, 0x1bd8); -+ odm_write_4byte(dm, 0x1bd4, 0x00010001); -+ for (i = 0; i < 0x80; i++) { -+ odm_write_4byte(dm, 0x1bd8, 0xa0000101 + (u32)(i << 1)); -+ tmp = (u32)odm_read_4byte(dm, 0x1bfc) & 0x3ff; -+ if (i < 0x40) -+ RF_DBG(dm, DBG_RF_IQK, "adc_i[%d] = %x\n", i, tmp); -+ else -+ RF_DBG(dm, DBG_RF_IQK, "adc_q[%d] = %x\n", i, tmp); -+ } -+} -+ -+void do_imr_test_8821c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK] ************IMR Test *****************\n"); -+ _phy_iq_calibrate_8821c(dm, false, false, true); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[IQK] **********End IMR Test *******************\n"); -+} -+ -+/*********debug message end***************/ -+ -+/*IQK version:0x23, NCTL:0x8*/ -+/*1. modify the iqk counters for coex.*/ -+ -+void phy_iq_calibrate_8821c(void *dm_void, boolean clear, boolean segment_iqk) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+ if (!(*dm->mp_mode)) -+ _iqk_check_coex_status(dm, true); -+ -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]fw_ver= 0x%x\n", rf->fw_ver); -+ if (*dm->mp_mode) -+ halrf_iqk_hwtx_check(dm, true); -+ /*FW IQK*/ -+ if (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) { -+ _phy_iq_calibrate_by_fw_8821c(dm, clear, segment_iqk); -+ phydm_get_read_counter_8821c(dm); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]0x38= 0x%x\n", -+ _iqk_indirect_read_reg(dm, 0x38)); -+ } else { -+ _iq_calibrate_8821c_init(dm); -+ _phy_iq_calibrate_8821c(dm, clear, segment_iqk, false); -+ } -+ _iqk_fail_count_8821c(dm); -+ -+ if (*dm->mp_mode) -+ halrf_iqk_hwtx_check(dm, false); -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _iqk_iqk_fail_report_8821c(dm); -+#endif -+ halrf_iqk_dbg(dm); -+ -+ if (!(*dm->mp_mode)) -+ _iqk_check_coex_status(dm, false); -+ RF_DBG(dm, DBG_RF_IQK, "[IQK]final 0x49c = %x\n", -+ odm_read_1byte(dm, 0x49c)); -+} -+ -+void phy_dp_calibrate_8821c(void *dm_void, boolean clear) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ if (odm_check_power_status(dm) == false) -+ return; -+#endif -+ -+#if (MP_DRIVER) -+ if ((dm->mp_mode != NULL) && (rf->is_con_tx != NULL) && (rf->is_single_tone != NULL) && (rf->is_carrier_suppresion != NULL)) -+ if (*(dm->mp_mode) && ((*(rf->is_con_tx) || *(rf->is_single_tone) || *(rf->is_carrier_suppresion)))) -+ return; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (!(rf->rf_supportability & HAL_RF_DPK)) -+ return; -+#endif -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+ RF_DBG(dm, DBG_RF_IQK, "[DPK] In PHY, dm->dpk_en == %x\n", rf->dpk_en); -+ -+ /*if dpk is not enable*/ -+ if (rf->dpk_en == 0x0) -+ return; -+ -+ /*start*/ -+ if (!dm->rf_calibrate_info.is_iqk_in_progress) { -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ dm->rf_calibrate_info.is_iqk_in_progress = true; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ if (*dm->mp_mode) -+ dm->rf_calibrate_info.iqk_start_time = odm_get_current_time(dm); -+ -+ if (*dm->mp_mode) { -+ /*do DPK*/ -+ _phy_dpd_calibrate_8821c(dm, clear); -+ _dpk_toggle_rxagc(dm, clear); -+ } -+ -+ if (*dm->mp_mode) { -+ dm->rf_calibrate_info.iqk_progressing_time = odm_get_progressing_time(dm, dm->rf_calibrate_info.iqk_start_time); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]DPK progressing_time = %lld ms\n", -+ dm->rf_calibrate_info.iqk_progressing_time); -+ } -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ dm->rf_calibrate_info.is_iqk_in_progress = false; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ } else { -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK]== Return the DPK CMD, because the DPK in Progress ==\n"); -+ } -+} -+void phy_txtap_calibrate_8821c(void *dm_void, boolean clear) -+{ -+ u32 MAC_backup[MAC_REG_NUM_8821C], BB_backup[BB_REG_NUM_8821C], RF_backup[RF_REG_NUM_8821C][1]; -+ u32 backup_mac_reg[MAC_REG_NUM_8821C] = {0x520, 0x550, 0x1518}; -+ u32 backup_bb_reg[BB_REG_NUM_8821C] = {0x808, 0x90c, 0xc00, 0xcb0, 0xcb4, 0xcbc, 0x1990, 0x9a4, 0xa04}; -+ u32 backup_rf_reg[RF_REG_NUM_8821C] = {0xdf, 0xde, 0x8f, 0x0, 0x1}; -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct dm_iqk_info *iqk_info = &dm->IQK_info; -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ struct _ADAPTER *adapter = dm->adapter; -+ -+#if (MP_DRIVER == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMPT_CONTEXT p_mpt_ctx = &(adapter->MptCtx); -+#else -+#ifdef CONFIG_MP_INCLUDED -+ PMPT_CONTEXT p_mpt_ctx = &(adapter->mppriv.mpt_ctx); -+#endif -+#endif -+#endif -+ -+ struct _hal_rf_ *rf = &dm->rf_table; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (!(rf->rf_supportability & HAL_RF_IQK)) -+ return; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ if (odm_check_power_status(adapter) == false) -+ return; -+#endif -+ -+#if MP_DRIVER == 1 -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (p_mpt_ctx->bSingleTone || p_mpt_ctx->bCarrierSuppression) -+ return; -+#else -+#ifdef CONFIG_MP_INCLUDED -+ if (p_mpt_ctx->is_single_tone || p_mpt_ctx->is_carrier_suppression) -+ return; -+#endif -+#endif -+#endif -+#endif -+ -+ if (!(*dm->mp_mode)) -+ _iqk_check_coex_status(dm, true); -+ -+ if ((dm->rf_table.rf_supportability & HAL_RF_TXGAPK)) -+ if (iqk_info->lok_fail[RF_PATH_A] == 0 && -+ iqk_info->iqk_fail_report[0][RF_PATH_A][TXIQK] == 0 && -+ iqk_info->iqk_fail_report[0][RF_PATH_A][RXIQK] == 0) { -+ _iqk_backup_iqk_8821c(dm, 0x0, 0x0); -+ _iqk_backup_mac_bb_8821c(dm, MAC_backup, BB_backup, backup_mac_reg, backup_bb_reg, BB_REG_NUM_8821C); -+ _iqk_backup_rf_8821c(dm, RF_backup, backup_rf_reg); -+ -+ _iqk_configure_macbb_8821c(dm); -+ _iqk_afe_setting_8821c(dm, true); -+ _iqk_rfe_setting_8821c(dm, false); -+ _iqk_agc_bnd_int_8821c(dm); -+ _iqk_rfsetting_8821c(dm); -+ -+ _phy_txgapk_calibrate_8821c(dm, RF_PATH_A); -+ -+ _iqk_afe_setting_8821c(dm, false); -+ _iqk_restore_mac_bb_8821c(dm, MAC_backup, BB_backup, backup_mac_reg, backup_bb_reg, BB_REG_NUM_8821C); -+ _iqk_restore_rf_8821c(dm, backup_rf_reg, RF_backup); -+ } -+} -+void dpk_temperature_compensate_8821c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _hal_rf_ *rf = &dm->rf_table; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ u8 pgthermal = hal_data->eeprom_thermal_meter; -+#else -+ struct rtl8192cd_priv *priv = dm->priv; -+ u8 pgthermal = (u8)priv->pmib->dot11RFEntry.ther; -+ -+#endif -+ static u8 dpk_tm_trigger; -+ u8 thermal_value = 0, delta_dpk, i = 0; -+ u8 thermal_value_avg_count = 0; -+ u8 thermal_value_avg_times = 2; -+ u32 thermal_value_avg = 0; -+ u8 tmp, abs_temperature; -+ -+ /*if dpk is not enable*/ -+ if (rf->dpk_en == 0x0) -+ return; -+ /*if ap mode, disable dpk*/ -+ if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ return; -+ if (!dpk_tm_trigger) { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x42, BIT(17) | BIT(16), 0x03); -+#if 0 -+ /*RF_DBG(dm, DBG_RF_IQK, "[DPK] (1) Trigger Thermal Meter!!\n");*/ -+#endif -+ dpk_tm_trigger = 1; -+ return; -+ } -+ -+ /* Initialize */ -+ dpk_tm_trigger = 0; -+#if 0 -+ /*RF_DBG(dm, DBG_RF_IQK, "[DPK] (2) calculate the thermal !!\n"); -+ */ -+#endif -+ -+ /* calculate average thermal meter */ -+ thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, RF_0x42, 0xfc00); /*0x42: RF Reg[15:10] 88E*/ -+ RF_DBG(dm, DBG_RF_IQK, "[DPK] (3) current Thermal Meter = %d\n", -+ thermal_value); -+ -+ dm->rf_calibrate_info.thermal_value_dpk = thermal_value; -+ dm->rf_calibrate_info.thermal_value_avg[dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; -+ dm->rf_calibrate_info.thermal_value_avg_index++; -+ if (dm->rf_calibrate_info.thermal_value_avg_index == thermal_value_avg_times) -+ dm->rf_calibrate_info.thermal_value_avg_index = 0; -+ for (i = 0; i < thermal_value_avg_times; i++) { -+ if (dm->rf_calibrate_info.thermal_value_avg[i]) { -+ thermal_value_avg += dm->rf_calibrate_info.thermal_value_avg[i]; -+ thermal_value_avg_count++; -+ } -+ } -+ if (thermal_value_avg_count) /*Calculate Average thermal_value after average enough times*/ -+ thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count); -+ /* compensate the DPK */ -+ delta_dpk = (thermal_value > pgthermal) ? (thermal_value - pgthermal) : (pgthermal - thermal_value); -+ tmp = (u8)((dpk_result[0] & 0x00001f00) >> 8); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK] (5)delta_dpk = %d, eeprom_thermal_meter = %d, tmp=%d\n", -+ delta_dpk, pgthermal, tmp); -+ -+ if (thermal_value > pgthermal) { -+ abs_temperature = thermal_value - pgthermal; -+ if (abs_temperature >= 20) -+ tmp = tmp + 4; -+ else if (abs_temperature >= 15) -+ tmp = tmp + 3; -+ else if (abs_temperature >= 10) -+ tmp = tmp + 2; -+ else if (abs_temperature >= 5) -+ tmp = tmp + 1; -+ } else { /*low temperature*/ -+ abs_temperature = pgthermal - thermal_value; -+ if (abs_temperature >= 20) -+ tmp = tmp - 4; -+ else if (abs_temperature >= 15) -+ tmp = tmp - 3; -+ else if (abs_temperature >= 10) -+ tmp = tmp - 2; -+ else if (abs_temperature >= 5) -+ tmp = tmp - 1; -+ } -+ -+ odm_set_bb_reg(dm, R_0x1bd0, BIT(12) | BIT(11) | BIT(10) | BIT(9) | BIT(8), tmp); -+ RF_DBG(dm, DBG_RF_IQK, -+ "[DPK] (6)delta_dpk = %d, eeprom_thermal_meter = %d, new tmp=%d, 0x1bd0=0x%x\n", -+ delta_dpk, pgthermal, tmp, odm_read_4byte(dm, 0x1bd0)); -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_iqk_8821c.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_iqk_8821c.h -new file mode 100644 -index 000000000..12194f744 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/halrf_iqk_8821c.h -@@ -0,0 +1,62 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __HALRF_IQK_8821C_H__ -+#define __HALRF_IQK_8821C_H__ -+ -+#if (RTL8821C_SUPPORT == 1) -+/*============================================================*/ -+/*Definition */ -+/*============================================================*/ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define MAC_REG_NUM_8821C 3 -+#define BB_REG_NUM_8821C 10 -+#define RF_REG_NUM_8821C 5 -+#define DPK_BB_REG_NUM_8821C 23 -+#define DPK_BACKUP_REG_NUM_8821C 3 -+ -+#define LOK_delay_8821C 2 -+#define GS_delay_8821C 2 -+#define WBIQK_delay_8821C 2 -+ -+#define TXIQK 0 -+#define RXIQK 1 -+#define SS_8821C 1 -+ -+/*---------------------------End Define Parameters-------------------------------*/ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+void do_iqk_8821c(void *dm_void, u8 delta_thermal_index, u8 thermal_value, -+ u8 threshold); -+#else -+void do_iqk_8821c(void *dm_void, u8 delta_thermal_index, u8 thermal_value, -+ u8 threshold); -+#endif -+ -+void phy_iq_calibrate_8821c(void *dm_void, boolean clear, boolean segment_iqk); -+ -+void phy_dp_calibrate_8821c(void *dm_void, boolean clear); -+ -+void do_imr_test_8821c(void *dm_void); -+ -+#else /* (RTL8821C_SUPPORT == 0)*/ -+ -+#define phy_iq_calibrate_8821c(_pdm_void, clear, segment_iqk) -+#define phy_dp_calibrate_8821c(_pDM_VOID, clear) -+ -+#endif /* RTL8821C_SUPPORT */ -+ -+#endif /*#ifndef __HALRF_IQK_8821C_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/version_rtl8821c_rf.h b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/version_rtl8821c_rf.h -new file mode 100644 -index 000000000..0c9df4b3b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/halrf/rtl8821c/version_rtl8821c_rf.h -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+/*RTL8821C RF Parameters*/ -+#define RF_RELEASE_VERSION_8821C 1 -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/mp_precomp.h b/drivers/net/wireless/rtl8821cs/hal/phydm/mp_precomp.h -new file mode 100644 -index 000000000..897adc13f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/mp_precomp.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm.c -new file mode 100644 -index 000000000..9722044b2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm.c -@@ -0,0 +1,3868 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+const u16 phy_rate_table[] = { -+ /*@20M*/ -+ 1, 2, 5, 11, -+ 6, 9, 12, 18, 24, 36, 48, 54, -+ 6, 13, 19, 26, 39, 52, 58, 65, /*@MCS0~7*/ -+ 13, 26, 39, 52, 78, 104, 117, 130, /*@MCS8~15*/ -+ 19, 39, 58, 78, 117, 156, 175, 195, /*@MCS16~23*/ -+ 26, 52, 78, 104, 156, 208, 234, 260, /*@MCS24~31*/ -+ 6, 13, 19, 26, 39, 52, 58, 65, 78, 90, /*@1ss MCS0~9*/ -+ 13, 26, 39, 52, 78, 104, 117, 130, 156, 180, /*@2ss MCS0~9*/ -+ 19, 39, 58, 78, 117, 156, 175, 195, 234, 260, /*@3ss MCS0~9*/ -+ 26, 52, 78, 104, 156, 208, 234, 260, 312, 360 /*@4ss MCS0~9*/ -+}; -+ -+void phydm_traffic_load_decision(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 shift = 0; -+ -+ /*@---TP & Trafic-load calculation---*/ -+ -+ if (dm->last_tx_ok_cnt > *dm->num_tx_bytes_unicast) -+ dm->last_tx_ok_cnt = *dm->num_tx_bytes_unicast; -+ -+ if (dm->last_rx_ok_cnt > *dm->num_rx_bytes_unicast) -+ dm->last_rx_ok_cnt = *dm->num_rx_bytes_unicast; -+ -+ dm->cur_tx_ok_cnt = *dm->num_tx_bytes_unicast - dm->last_tx_ok_cnt; -+ dm->cur_rx_ok_cnt = *dm->num_rx_bytes_unicast - dm->last_rx_ok_cnt; -+ dm->last_tx_ok_cnt = *dm->num_tx_bytes_unicast; -+ dm->last_rx_ok_cnt = *dm->num_rx_bytes_unicast; -+ -+ /*@AP: <<3(8bit), >>20(10^6,M), >>0(1sec)*/ -+ shift = 17 + (PHYDM_WATCH_DOG_PERIOD - 1); -+ /*@WIN&CE: <<3(8bit), >>20(10^6,M), >>1(2sec)*/ -+ -+ dm->tx_tp = (dm->tx_tp >> 1) + (u32)((dm->cur_tx_ok_cnt >> shift) >> 1); -+ dm->rx_tp = (dm->rx_tp >> 1) + (u32)((dm->cur_rx_ok_cnt >> shift) >> 1); -+ -+ dm->total_tp = dm->tx_tp + dm->rx_tp; -+ -+ /*@[Calculate TX/RX state]*/ -+ if (dm->tx_tp > (dm->rx_tp << 1)) -+ dm->txrx_state_all = TX_STATE; -+ else if (dm->rx_tp > (dm->tx_tp << 1)) -+ dm->txrx_state_all = RX_STATE; -+ else -+ dm->txrx_state_all = BI_DIRECTION_STATE; -+ -+ /*@[Traffic load decision]*/ -+ dm->pre_traffic_load = dm->traffic_load; -+ -+ if (dm->cur_tx_ok_cnt > 1875000 || dm->cur_rx_ok_cnt > 1875000) { -+ /* @( 1.875M * 8bit ) / 2sec= 7.5M bits /sec )*/ -+ dm->traffic_load = TRAFFIC_HIGH; -+ } else if (dm->cur_tx_ok_cnt > 500000 || dm->cur_rx_ok_cnt > 500000) { -+ /*@( 0.5M * 8bit ) / 2sec = 2M bits /sec )*/ -+ dm->traffic_load = TRAFFIC_MID; -+ } else if (dm->cur_tx_ok_cnt > 100000 || dm->cur_rx_ok_cnt > 100000) { -+ /*@( 0.1M * 8bit ) / 2sec = 0.4M bits /sec )*/ -+ dm->traffic_load = TRAFFIC_LOW; -+ } else if (dm->cur_tx_ok_cnt > 25000 || dm->cur_rx_ok_cnt > 25000) { -+ /*@( 0.025M * 8bit ) / 2sec = 0.1M bits /sec )*/ -+ dm->traffic_load = TRAFFIC_ULTRA_LOW; -+ } else { -+ dm->traffic_load = TRAFFIC_NO_TP; -+ } -+ -+ /*@[Calculate consecutive idlel time]*/ -+ if (dm->traffic_load == 0) -+ dm->consecutive_idlel_time += PHYDM_WATCH_DOG_PERIOD; -+ else -+ dm->consecutive_idlel_time = 0; -+ -+ #if 0 -+ PHYDM_DBG(dm, DBG_COMMON_FLOW, -+ "cur_tx_ok_cnt = %d, cur_rx_ok_cnt = %d, last_tx_ok_cnt = %d, last_rx_ok_cnt = %d\n", -+ dm->cur_tx_ok_cnt, dm->cur_rx_ok_cnt, dm->last_tx_ok_cnt, -+ dm->last_rx_ok_cnt); -+ -+ PHYDM_DBG(dm, DBG_COMMON_FLOW, "tx_tp = %d, rx_tp = %d\n", dm->tx_tp, -+ dm->rx_tp); -+ #endif -+} -+ -+void phydm_cck_new_agc_chk(struct dm_struct *dm) -+{ -+ u32 new_agc_addr = 0x0; -+ -+ dm->cck_new_agc = false; -+#if (RTL8723D_SUPPORT || RTL8822B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8197F_SUPPORT || RTL8710B_SUPPORT || RTL8192F_SUPPORT ||\ -+ RTL8195B_SUPPORT || RTL8198F_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8721D_SUPPORT || RTL8710C_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8723D | ODM_RTL8822B | ODM_RTL8821C | -+ ODM_RTL8197F | ODM_RTL8710B | ODM_RTL8192F | ODM_RTL8195B | -+ ODM_RTL8721D | ODM_RTL8710C)) { -+ new_agc_addr = R_0xa9c; -+ } else if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8822C | -+ ODM_RTL8814B | ODM_RTL8197G | ODM_RTL8814C)) { -+ new_agc_addr = R_0x1a9c; -+ } -+ -+ /*@1: new agc 0: old agc*/ -+ dm->cck_new_agc = (boolean)odm_get_bb_reg(dm, new_agc_addr, BIT(17)); -+#endif -+#if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8723F)) -+ dm->cck_new_agc = true; -+#endif -+} -+ -+/*select 3 or 4 bit LNA */ -+void phydm_cck_lna_bit_num_chk(struct dm_struct *dm) -+{ -+ boolean report_type = 0; -+ #if (RTL8192E_SUPPORT) -+ u32 value_824, value_82c; -+ #endif -+ -+ #if (RTL8192E_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8192E)) { -+ /* @0x824[9] = 0x82C[9] = 0xA80[7] those registers setting -+ * should be equal or CCK RSSI report may be incorrect -+ */ -+ value_824 = odm_get_bb_reg(dm, R_0x824, BIT(9)); -+ value_82c = odm_get_bb_reg(dm, R_0x82c, BIT(9)); -+ -+ if (value_824 != value_82c) -+ odm_set_bb_reg(dm, R_0x82c, BIT(9), value_824); -+ odm_set_bb_reg(dm, R_0xa80, BIT(7), value_824); -+ report_type = (boolean)value_824; -+ } -+ #endif -+ -+ #if (RTL8703B_SUPPORT || RTL8723D_SUPPORT || RTL8710B_SUPPORT) -+ if (dm->support_ic_type & -+ (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B)) { -+ report_type = (boolean)odm_get_bb_reg(dm, R_0x950, BIT(11)); -+ -+ if (report_type != 1) -+ pr_debug("[Warning] CCK should be 4bit LNA\n"); -+ } -+ #endif -+ -+ #if (RTL8821C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8821C) { -+ if (dm->default_rf_set_8821c == SWITCH_TO_BTG) -+ report_type = 1; -+ } -+ #endif -+ -+ dm->cck_agc_report_type = report_type; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "cck_agc_report_type=((%d))\n", -+ dm->cck_agc_report_type); -+} -+ -+void phydm_init_cck_setting(struct dm_struct *dm) -+{ -+ u32 reg_tmp = 0; -+ u32 mask_tmp = 0; -+ -+ phydm_cck_new_agc_chk(dm); -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ return; -+ -+ reg_tmp = ODM_REG(CCK_RPT_FORMAT, dm); -+ mask_tmp = ODM_BIT(CCK_RPT_FORMAT, dm); -+ dm->is_cck_high_power = (boolean)odm_get_bb_reg(dm, reg_tmp, mask_tmp); -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ext_lna_gain=((%d))\n", dm->ext_lna_gain); -+ -+ phydm_config_cck_rx_antenna_init(dm); -+ -+ if (dm->support_ic_type & ODM_RTL8192F) -+ phydm_config_cck_rx_path(dm, BB_PATH_AB); -+ else if (dm->valid_path_set == BB_PATH_A) -+ phydm_config_cck_rx_path(dm, BB_PATH_A); -+ else if (dm->valid_path_set == BB_PATH_B) -+ phydm_config_cck_rx_path(dm, BB_PATH_B); -+ -+ phydm_cck_lna_bit_num_chk(dm); -+ phydm_get_cck_rssi_table_from_reg(dm); -+} -+ -+#ifdef CONFIG_RFE_BY_HW_INFO -+void phydm_init_hw_info_by_rfe(struct dm_struct *dm) -+{ -+ #if (RTL8821C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8821C) -+ phydm_init_hw_info_by_rfe_type_8821c(dm); -+ #endif -+ #if (RTL8197F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197F) -+ phydm_init_hw_info_by_rfe_type_8197f(dm); -+ #endif -+ #if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197G) -+ phydm_init_hw_info_by_rfe_type_8197g(dm); -+ #endif -+} -+#endif -+ -+void phydm_common_info_self_init(struct dm_struct *dm) -+{ -+ u32 reg_tmp = 0; -+ u32 mask_tmp = 0; -+ -+ dm->run_in_drv_fw = RUN_IN_DRIVER; -+ -+ /*@BB IP Generation*/ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ dm->ic_ip_series = PHYDM_IC_JGR3; -+ else if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ dm->ic_ip_series = PHYDM_IC_AC; -+ else if (dm->support_ic_type & ODM_IC_11N_SERIES) -+ dm->ic_ip_series = PHYDM_IC_N; -+ -+ /*@BB phy-status Generation*/ -+ if (dm->support_ic_type & PHYSTS_3RD_TYPE_IC) -+ dm->ic_phy_sts_type = PHYDM_PHYSTS_TYPE_3; -+ else if (dm->support_ic_type & PHYSTS_2ND_TYPE_IC) -+ dm->ic_phy_sts_type = PHYDM_PHYSTS_TYPE_2; -+ else -+ dm->ic_phy_sts_type = PHYDM_PHYSTS_TYPE_1; -+ -+ phydm_init_cck_setting(dm); -+ -+ reg_tmp = ODM_REG(BB_RX_PATH, dm); -+ mask_tmp = ODM_BIT(BB_RX_PATH, dm); -+ dm->rf_path_rx_enable = (u8)odm_get_bb_reg(dm, reg_tmp, mask_tmp); -+#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -+ dm->is_net_closed = &dm->BOOLEAN_temp; -+ -+ phydm_init_debug_setting(dm); -+#endif -+ phydm_init_soft_ml_setting(dm); -+ -+ dm->phydm_sys_up_time = 0; -+ -+ if (dm->support_ic_type & ODM_IC_1SS) -+ dm->num_rf_path = 1; -+ else if (dm->support_ic_type & ODM_IC_2SS) -+ dm->num_rf_path = 2; -+ #if 0 -+ /* @RTK do not has IC which is equipped with 3 RF paths, -+ * so ODM_IC_3SS is an enpty macro and result in coverity check errors -+ */ -+ else if (dm->support_ic_type & ODM_IC_3SS) -+ dm->num_rf_path = 3; -+ #endif -+ else if (dm->support_ic_type & ODM_IC_4SS) -+ dm->num_rf_path = 4; -+ else -+ dm->num_rf_path = 1; -+ -+ phydm_trx_antenna_setting_init(dm, dm->num_rf_path); -+ -+ dm->tx_rate = 0xFF; -+ dm->rssi_min_by_path = 0xFF; -+ -+ dm->number_linked_client = 0; -+ dm->pre_number_linked_client = 0; -+ dm->number_active_client = 0; -+ dm->pre_number_active_client = 0; -+ -+ dm->last_tx_ok_cnt = 0; -+ dm->last_rx_ok_cnt = 0; -+ dm->tx_tp = 0; -+ dm->rx_tp = 0; -+ dm->total_tp = 0; -+ dm->traffic_load = TRAFFIC_LOW; -+ -+ dm->nbi_set_result = 0; -+ dm->is_init_hw_info_by_rfe = false; -+ dm->pre_dbg_priority = DBGPORT_RELEASE; -+ dm->tp_active_th = 5; -+ dm->disable_phydm_watchdog = 0; -+ -+ dm->u8_dummy = 0xf; -+ dm->u16_dummy = 0xffff; -+ dm->u32_dummy = 0xffffffff; -+#if (RTL8814B_SUPPORT) -+/*@------------For spur detection Default Mode------------@*/ -+ dm->dsde_sel = DET_CSI; -+ dm->csi_wgt = 4; -+/*@-------------------------------------------------------@*/ -+#endif -+ dm->pre_is_linked = false; -+ dm->is_linked = false; -+/*dym bw thre and it can config by registry*/ -+ if (dm->en_auto_bw_th == 0) -+ dm->en_auto_bw_th = 20; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (!(dm->is_fcs_mode_enable)) { -+ dm->is_fcs_mode_enable = &dm->boolean_dummy; -+ pr_debug("[Warning] is_fcs_mode_enable=NULL\n"); -+ } -+#endif -+ /*init IOT table*/ -+ odm_memory_set(dm, &dm->iot_table, 0, sizeof(struct phydm_iot_center)); -+} -+ -+void phydm_iot_patch_id_update(void *dm_void, u32 iot_idx, boolean en) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_iot_center *iot_table = &dm->iot_table; -+ -+ PHYDM_DBG(dm, DBG_CMN, "[IOT] 0x%x = %d\n", iot_idx, en); -+ switch (iot_idx) { -+ case 0x100f0401: -+ iot_table->patch_id_100f0401 = en; -+ PHYDM_DBG(dm, DBG_CMN, "[IOT] patch_id_100f0401 = %d\n", -+ iot_table->patch_id_100f0401); -+ break; -+ case 0x10120200: -+ iot_table->patch_id_10120200 = en; -+ PHYDM_DBG(dm, DBG_CMN, "[IOT] patch_id_10120200 = %d\n", -+ iot_table->patch_id_10120200); -+ break; -+ case 0x40010700: -+ iot_table->patch_id_40010700 = en; -+ PHYDM_DBG(dm, DBG_CMN, "[IOT] patch_id_40010700 = %d\n", -+ iot_table->patch_id_40010700); -+ break; -+ case 0x021f0800: -+ iot_table->patch_id_021f0800 = en; -+ PHYDM_DBG(dm, DBG_CMN, "[IOT] patch_id_021f0800 = %d\n", -+ iot_table->patch_id_021f0800); -+ break; -+ case 0x011f0500: -+ iot_table->patch_id_011f0500 = en; -+ PHYDM_DBG(dm, DBG_CMN, "[IOT] patch_id_011f0500 = %d\n", -+ iot_table->patch_id_011f0500); -+ break; -+ default: -+ pr_debug("[%s] warning!\n", __func__); -+ break; -+ } -+} -+ -+void phydm_cmn_sta_info_update(void *dm_void, u8 macid) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[macid]; -+ struct ra_sta_info *ra = NULL; -+ -+ if (is_sta_active(sta)) { -+ ra = &sta->ra_info; -+ } else { -+ PHYDM_DBG(dm, DBG_RA_MASK, "[Warning] %s invalid sta_info\n", -+ __func__); -+ return; -+ } -+ -+ PHYDM_DBG(dm, DBG_RA_MASK, "%s ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_RA_MASK, "MACID=%d\n", sta->mac_id); -+ -+ /*@[Calculate TX/RX state]*/ -+ if (sta->tx_moving_average_tp > (sta->rx_moving_average_tp << 1)) -+ ra->txrx_state = TX_STATE; -+ else if (sta->rx_moving_average_tp > (sta->tx_moving_average_tp << 1)) -+ ra->txrx_state = RX_STATE; -+ else -+ ra->txrx_state = BI_DIRECTION_STATE; -+ -+ ra->is_noisy = dm->noisy_decision; -+} -+ -+void phydm_common_info_self_update(struct dm_struct *dm) -+{ -+ u8 sta_cnt = 0, num_active_client = 0; -+ u32 i, one_entry_macid = 0; -+ u32 ma_rx_tp = 0; -+ u32 tp_diff = 0; -+ struct cmn_sta_info *sta; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER adapter = (PADAPTER)dm->adapter; -+ PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo; -+ -+ sta = dm->phydm_sta_info[0]; -+ -+ /* STA mode is linked to AP */ -+ if (is_sta_active(sta) && !ACTING_AS_AP(adapter)) -+ dm->bsta_state = true; -+ else -+ dm->bsta_state = false; -+#endif -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ sta = dm->phydm_sta_info[i]; -+ if (is_sta_active(sta)) { -+ sta_cnt++; -+ -+ if (sta_cnt == 1) -+ one_entry_macid = i; -+ -+ phydm_cmn_sta_info_update(dm, (u8)i); -+ #ifdef PHYDM_BEAMFORMING_SUPPORT -+ /*@phydm_get_txbf_device_num(dm, (u8)i);*/ -+ #endif -+ -+ ma_rx_tp = sta->rx_moving_average_tp + -+ sta->tx_moving_average_tp; -+ -+ PHYDM_DBG(dm, DBG_COMMON_FLOW, -+ "TP[%d]: ((%d )) bit/sec\n", i, ma_rx_tp); -+ -+ if (ma_rx_tp > ACTIVE_TP_THRESHOLD) -+ num_active_client++; -+ } -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ dm->is_linked = (sta_cnt != 0) ? true : false; -+#endif -+ -+ if (sta_cnt == 1) { -+ dm->is_one_entry_only = true; -+ dm->one_entry_macid = one_entry_macid; -+ dm->one_entry_tp = ma_rx_tp; -+ -+ dm->tp_active_occur = 0; -+ -+ PHYDM_DBG(dm, DBG_COMMON_FLOW, -+ "one_entry_tp=((%d)), pre_one_entry_tp=((%d))\n", -+ dm->one_entry_tp, dm->pre_one_entry_tp); -+ -+ if (dm->one_entry_tp > dm->pre_one_entry_tp && -+ dm->pre_one_entry_tp <= 2) { -+ tp_diff = dm->one_entry_tp - dm->pre_one_entry_tp; -+ -+ if (tp_diff > dm->tp_active_th) -+ dm->tp_active_occur = 1; -+ } -+ dm->pre_one_entry_tp = dm->one_entry_tp; -+ } else { -+ dm->is_one_entry_only = false; -+ } -+ -+ dm->pre_number_linked_client = dm->number_linked_client; -+ dm->pre_number_active_client = dm->number_active_client; -+ -+ dm->number_linked_client = sta_cnt; -+ dm->number_active_client = num_active_client; -+ -+ /*Traffic load information update*/ -+ phydm_traffic_load_decision(dm); -+ -+ dm->phydm_sys_up_time += PHYDM_WATCH_DOG_PERIOD; -+ -+ dm->is_dfs_band = phydm_is_dfs_band(dm); -+ dm->phy_dbg_info.show_phy_sts_cnt = 0; -+ -+ /*[Link Status Check]*/ -+ dm->first_connect = dm->is_linked && !dm->pre_is_linked; -+ dm->first_disconnect = !dm->is_linked && dm->pre_is_linked; -+ dm->pre_is_linked = dm->is_linked; -+} -+ -+void phydm_common_info_self_reset(struct dm_struct *dm) -+{ -+ struct odm_phy_dbg_info *dbg_t = &dm->phy_dbg_info; -+ -+ dbg_t->beacon_cnt_in_period = dbg_t->num_qry_beacon_pkt; -+ dbg_t->num_qry_beacon_pkt = 0; -+ -+ dm->rxsc_l = 0xff; -+ dm->rxsc_20 = 0xff; -+ dm->rxsc_40 = 0xff; -+ dm->rxsc_80 = 0xff; -+} -+ -+void * -+phydm_get_structure(struct dm_struct *dm, u8 structure_type) -+ -+{ -+ void *structure = NULL; -+ -+ switch (structure_type) { -+ case PHYDM_FALSEALMCNT: -+ structure = &dm->false_alm_cnt; -+ break; -+ -+ case PHYDM_CFOTRACK: -+ structure = &dm->dm_cfo_track; -+ break; -+ -+ case PHYDM_ADAPTIVITY: -+ structure = &dm->adaptivity; -+ break; -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ case PHYDM_DFS: -+ structure = &dm->dfs; -+ break; -+#endif -+ default: -+ break; -+ } -+ -+ return structure; -+} -+ -+void phydm_phy_info_update(struct dm_struct *dm) -+{ -+#if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8822B) -+ dm->phy_dbg_info.condi_num = phydm_get_condi_num_8822b(dm); -+#endif -+} -+ -+void phydm_hw_setting(struct dm_struct *dm) -+{ -+#if (RTL8188F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8188F) -+ odm_hw_setting_8188F(dm); -+#endif -+#if (RTL8821A_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8821) -+ odm_hw_setting_8821a(dm); -+#endif -+ -+#if (RTL8814A_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8814A) -+ phydm_hwsetting_8814a(dm); -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8822B) -+ phydm_hwsetting_8822b(dm); -+#endif -+ -+#if (RTL8812A_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8812) -+ phydm_hwsetting_8812a(dm); -+#endif -+ -+#if (RTL8197F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197F) -+ phydm_hwsetting_8197f(dm); -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8192F) -+ phydm_hwsetting_8192f(dm); -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8822C) -+ phydm_hwsetting_8822c(dm); -+#endif -+ -+#if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197G) -+ phydm_hwsetting_8197g(dm); -+#endif -+ -+#if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8723F) -+ phydm_hwsetting_8723f(dm); -+#endif -+ -+#if (RTL8821C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8821C) -+ phydm_hwsetting_8821c(dm); -+#endif -+ -+#if (RTL8812F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8812F) -+ phydm_hwsetting_8812f(dm); -+#endif -+ -+#ifdef PHYDM_CCK_RX_PATHDIV_SUPPORT -+ phydm_cck_rx_pathdiv_watchdog(dm); -+#endif -+} -+ -+__odm_func__ -+boolean phydm_chk_bb_rf_pkg_set_valid(struct dm_struct *dm) -+{ -+ boolean valid = true; -+ -+ if (dm->support_ic_type == ODM_RTL8822C) { -+ #if (RTL8822C_SUPPORT) -+ valid = phydm_chk_pkg_set_valid_8822c(dm, -+ RELEASE_VERSION_8822C, -+ RF_RELEASE_VERSION_8822C); -+ #else -+ valid = true; /*@Just for preventing compile warnings*/ -+ #endif -+ #if (RTL8812F_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8812F) { -+ valid = phydm_chk_pkg_set_valid_8812f(dm, -+ RELEASE_VERSION_8812F, -+ RF_RELEASE_VERSION_8812F); -+ #endif -+ #if (RTL8197G_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8197G) { -+ valid = phydm_chk_pkg_set_valid_8197g(dm, -+ RELEASE_VERSION_8197G, -+ RF_RELEASE_VERSION_8197G); -+ #endif -+ #if (RTL8812F_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8812F) { -+ valid = phydm_chk_pkg_set_valid_8812f(dm, -+ RELEASE_VERSION_8812F, -+ RF_RELEASE_VERSION_8812F); -+ #endif -+ #if (RTL8198F_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8198F) { -+ valid = phydm_chk_pkg_set_valid_8198f(dm, -+ RELEASE_VERSION_8198F, -+ RF_RELEASE_VERSION_8198F); -+ #endif -+ #if (RTL8814B_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8814B) { -+ valid = phydm_chk_pkg_set_valid_8814b(dm, -+ RELEASE_VERSION_8814B, -+ RF_RELEASE_VERSION_8814B); -+ #endif -+ #if (RTL8814C_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8814C) { -+ valid = phydm_chk_pkg_set_valid_8814b(dm, -+ RELEASE_VERSION_8814C, -+ RF_RELEASE_VERSION_8814C); -+ #endif -+ #if (RTL8723F_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8723F) { -+ valid = phydm_chk_pkg_set_valid_8723f(dm, -+ RELEASE_VERSION_8723F, -+ RF_RELEASE_VERSION_8723F); -+ #endif -+ } -+ -+ return valid; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+u64 phydm_supportability_init_win( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u64 support_ability = 0; -+ -+ switch (dm->support_ic_type) { -+/*@---------------N Series--------------------*/ -+#if (RTL8188E_SUPPORT) -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR | -+ ODM_BB_PRIMARY_CCA; -+ break; -+#endif -+ -+#if (RTL8192E_SUPPORT) -+ case ODM_RTL8192E: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR | -+ ODM_BB_PRIMARY_CCA; -+ break; -+#endif -+ -+#if (RTL8723B_SUPPORT) -+ case ODM_RTL8723B: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR | -+ ODM_BB_PRIMARY_CCA; -+ break; -+#endif -+ -+#if (RTL8703B_SUPPORT) -+ case ODM_RTL8703B: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8723D_SUPPORT) -+ case ODM_RTL8723D: -+ 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_BB_PWR_TRAIN | -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8710B_SUPPORT) -+ case ODM_RTL8710B: -+ 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_BB_PWR_TRAIN | -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8188F_SUPPORT) -+ case ODM_RTL8188F: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ case ODM_RTL8192F: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ ODM_BB_PWR_TRAIN | -+ ODM_BB_RATE_ADAPTIVE | -+ /*ODM_BB_PATH_DIV |*/ -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ADAPTIVE_SOML | -+ ODM_BB_ENV_MONITOR; -+ /*ODM_BB_LNA_SAT_CHK |*/ -+ /*ODM_BB_PRIMARY_CCA*/ -+ -+ break; -+#endif -+ -+/*@---------------AC Series-------------------*/ -+ -+#if (RTL8812A_SUPPORT || RTL8821A_SUPPORT) -+ case ODM_RTL8812: -+ case ODM_RTL8821: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8814A_SUPPORT) -+ case ODM_RTL8814A: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ case ODM_RTL8822B: -+ 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_BB_PWR_TRAIN |*/ -+ /*ODM_BB_ADAPTIVE_SOML |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ /*ODM_BB_PATH_DIV |*/ -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8821C_SUPPORT) -+ case ODM_RTL8821C: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+/*@---------------JGR3 Series-------------------*/ -+ -+#if (RTL8822C_SUPPORT) -+ case ODM_RTL8822C: -+ 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_BB_RATE_ADAPTIVE | -+ ODM_BB_PATH_DIV | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8814B_SUPPORT) -+ case ODM_RTL8814B: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING; -+ /*ODM_BB_ENV_MONITOR;*/ -+ break; -+#endif -+ -+#if (RTL8723F_SUPPORT) -+ case ODM_RTL8723F: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ default: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ -+ pr_debug("[Warning] Supportability Init Warning !!!\n"); -+ break; -+ } -+ -+ return support_ability; -+} -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+u64 phydm_supportability_init_ce(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u64 support_ability = 0; -+ -+ switch (dm->support_ic_type) { -+/*@---------------N Series--------------------*/ -+#if (RTL8188E_SUPPORT) -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR | -+ ODM_BB_PRIMARY_CCA; -+ break; -+#endif -+ -+#if (RTL8192E_SUPPORT) -+ case ODM_RTL8192E: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR | -+ ODM_BB_PRIMARY_CCA; -+ break; -+#endif -+ -+#if (RTL8723B_SUPPORT) -+ case ODM_RTL8723B: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR | -+ ODM_BB_PRIMARY_CCA; -+ break; -+#endif -+ -+#if (RTL8703B_SUPPORT) -+ case ODM_RTL8703B: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8723D_SUPPORT) -+ case ODM_RTL8723D: -+ 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_BB_PWR_TRAIN | -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8710B_SUPPORT) -+ case ODM_RTL8710B: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8188F_SUPPORT) -+ case ODM_RTL8188F: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ case ODM_RTL8192F: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ ODM_BB_PWR_TRAIN | -+ ODM_BB_RATE_ADAPTIVE | -+ /*ODM_BB_PATH_DIV |*/ -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ /*@ODM_BB_ADAPTIVE_SOML |*/ -+ ODM_BB_ENV_MONITOR; -+ /*@ODM_BB_LNA_SAT_CHK |*/ -+ /*@ODM_BB_PRIMARY_CCA*/ -+ break; -+#endif -+/*@---------------AC Series-------------------*/ -+ -+#if (RTL8812A_SUPPORT || RTL8821A_SUPPORT) -+ case ODM_RTL8812: -+ case ODM_RTL8821: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8814A_SUPPORT) -+ case ODM_RTL8814A: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ case ODM_RTL8822B: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ /*ODM_BB_PATH_DIV |*/ -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8821C_SUPPORT) -+ case ODM_RTL8821C: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+/*@---------------JGR3 Series-------------------*/ -+ -+#if (RTL8822C_SUPPORT) -+ case ODM_RTL8822C: -+ 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_BB_RATE_ADAPTIVE | -+ /* ODM_BB_PATH_DIV | */ -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8814B_SUPPORT) -+ case ODM_RTL8814B: -+ 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_BB_PWR_TRAIN |*/ -+ /*ODM_BB_RATE_ADAPTIVE |*/ -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING; -+ /*ODM_BB_ENV_MONITOR;*/ -+ break; -+#endif -+#if (RTL8723F_SUPPORT) -+ case ODM_RTL8723F: -+ 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_BB_RATE_ADAPTIVE | -+ /* ODM_BB_PATH_DIV | */ -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ default: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ -+ pr_debug("[Warning] Supportability Init Warning !!!\n"); -+ break; -+ } -+ -+ return support_ability; -+} -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+u64 phydm_supportability_init_ap( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u64 support_ability = 0; -+ -+ switch (dm->support_ic_type) { -+/*@---------------N Series--------------------*/ -+#if (RTL8188E_SUPPORT) -+ case ODM_RTL8188E: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR | -+ ODM_BB_PRIMARY_CCA; -+ break; -+#endif -+ -+#if (RTL8192E_SUPPORT) -+ case ODM_RTL8192E: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR | -+ ODM_BB_PRIMARY_CCA; -+ break; -+#endif -+ -+#if (RTL8723B_SUPPORT) -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT || RTL8197F_SUPPORT) -+ case ODM_RTL8198F: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ /*ODM_BB_RATE_ADAPTIVE |*/ -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING; -+ /*ODM_BB_ADAPTIVE_SOML |*/ -+ /*ODM_BB_ENV_MONITOR |*/ -+ /*ODM_BB_LNA_SAT_CHK |*/ -+ /*ODM_BB_PRIMARY_CCA;*/ -+ break; -+ case ODM_RTL8197F: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ADAPTIVE_SOML | -+ ODM_BB_ENV_MONITOR | -+ ODM_BB_LNA_SAT_CHK | -+ ODM_BB_PRIMARY_CCA; -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ case ODM_RTL8192F: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ /*ODM_BB_CFO_TRACKING |*/ -+ ODM_BB_ADAPTIVE_SOML | -+ /*ODM_BB_PATH_DIV |*/ -+ ODM_BB_ENV_MONITOR | -+ /*ODM_BB_LNA_SAT_CHK |*/ -+ /*ODM_BB_PRIMARY_CCA |*/ -+ 0; -+ break; -+#endif -+ -+/*@---------------AC Series-------------------*/ -+ -+#if (RTL8881A_SUPPORT) -+ case ODM_RTL8881A: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8814A_SUPPORT) -+ case ODM_RTL8814A: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ case ODM_RTL8822B: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ /*ODM_BB_ADAPTIVE_SOML |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8821C_SUPPORT) -+ case ODM_RTL8821C: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ -+ break; -+#endif -+ -+/*@---------------JGR3 Series-------------------*/ -+ -+#if (RTL8814B_SUPPORT) -+ case ODM_RTL8814B: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ /*ODM_BB_RATE_ADAPTIVE |*/ -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+ case ODM_RTL8814C: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ /*ODM_BB_RATE_ADAPTIVE |*/ -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8197G_SUPPORT) -+ case ODM_RTL8197G: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8812F_SUPPORT) -+ case ODM_RTL8812F: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8723F_SUPPORT) -+ case ODM_RTL8723F: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ default: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ /*ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ -+ pr_debug("[Warning] Supportability Init Warning !!!\n"); -+ break; -+ } -+ -+ return support_ability; -+} -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+u64 phydm_supportability_init_iot( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u64 support_ability = 0; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8710B_SUPPORT) -+ case ODM_RTL8710B: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8195A_SUPPORT) -+ case ODM_RTL8195A: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8195B_SUPPORT) -+ case ODM_RTL8195B: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8721D_SUPPORT) -+ case ODM_RTL8721D: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ -+#if (RTL8710C_SUPPORT) -+ case ODM_RTL8710C: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_ADAPTIVITY | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ break; -+#endif -+ default: -+ 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_BB_PWR_TRAIN |*/ -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_ENV_MONITOR; -+ -+ pr_debug("[Warning] Supportability Init Warning !!!\n"); -+ break; -+ } -+ -+ return support_ability; -+} -+#endif -+ -+void phydm_fwoffload_ability_init(struct dm_struct *dm, -+ enum phydm_offload_ability offload_ability) -+{ -+ switch (offload_ability) { -+ case PHYDM_PHY_PARAM_OFFLOAD: -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_FW_PARAM_OFFLOAD) -+ dm->fw_offload_ability |= PHYDM_PHY_PARAM_OFFLOAD; -+ break; -+ -+ case PHYDM_RF_IQK_OFFLOAD: -+ dm->fw_offload_ability |= PHYDM_RF_IQK_OFFLOAD; -+ break; -+ -+ case PHYDM_RF_DPK_OFFLOAD: -+ dm->fw_offload_ability |= PHYDM_RF_DPK_OFFLOAD; -+ break; -+ -+ default: -+ PHYDM_DBG(dm, ODM_COMP_INIT, "fwofflad, wrong init type!!\n"); -+ break; -+ } -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "fw_offload_ability = %x\n", -+ dm->fw_offload_ability); -+} -+ -+void phydm_fwoffload_ability_clear(struct dm_struct *dm, -+ enum phydm_offload_ability offload_ability) -+{ -+ switch (offload_ability) { -+ case PHYDM_PHY_PARAM_OFFLOAD: -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_FW_PARAM_OFFLOAD) -+ dm->fw_offload_ability &= (~PHYDM_PHY_PARAM_OFFLOAD); -+ break; -+ -+ case PHYDM_RF_IQK_OFFLOAD: -+ dm->fw_offload_ability &= (~PHYDM_RF_IQK_OFFLOAD); -+ break; -+ -+ case PHYDM_RF_DPK_OFFLOAD: -+ dm->fw_offload_ability &= (~PHYDM_RF_DPK_OFFLOAD); -+ break; -+ -+ default: -+ PHYDM_DBG(dm, ODM_COMP_INIT, "fwofflad, wrong init type!!\n"); -+ break; -+ } -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "fw_offload_ability = %x\n", -+ dm->fw_offload_ability); -+} -+ -+void phydm_supportability_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u64 support_ability; -+ -+ if (dm->manual_supportability && -+ *dm->manual_supportability != 0xffffffff) { -+ support_ability = *dm->manual_supportability; -+ } else if (*dm->mp_mode) { -+ support_ability = 0; -+ } else { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ support_ability = phydm_supportability_init_win(dm); -+ #elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ support_ability = phydm_supportability_init_ap(dm); -+ #elif(DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ support_ability = phydm_supportability_init_ce(dm); -+ #elif(DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+ support_ability = phydm_supportability_init_iot(dm); -+ #endif -+ -+ /*@[Config Antenna Diversity]*/ -+ if (IS_FUNC_EN(dm->enable_antdiv)) -+ support_ability |= ODM_BB_ANT_DIV; -+ -+ /*@[Config TXpath Diversity]*/ -+ if (IS_FUNC_EN(dm->enable_pathdiv)) -+ support_ability |= ODM_BB_PATH_DIV; -+ -+ /*@[Config Adaptive SOML]*/ -+ if (IS_FUNC_EN(dm->en_adap_soml)) -+ support_ability |= ODM_BB_ADAPTIVE_SOML; -+ -+ /*@[DYNAMIC_TXPWR and TSSI cannot coexist]*/ -+ if(IS_FUNC_EN(&dm->en_tssi_mode) && -+ (dm->support_ic_type & ODM_RTL8822C)) -+ support_ability &= ~ODM_BB_DYNAMIC_TXPWR; -+ /*@[DYNAMIC_TXPWR and TSSI cannot coexist]*/ -+ if(IS_FUNC_EN(&dm->en_tssi_mode) && -+ (dm->support_ic_type & ODM_RTL8723F)) -+ support_ability &= ~ODM_BB_DYNAMIC_TXPWR; -+ } -+ dm->support_ability = support_ability; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "IC=0x%x, mp=%d, Supportability=0x%llx\n", -+ dm->support_ic_type, *dm->mp_mode, dm->support_ability); -+} -+ -+void phydm_rfe_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "RFE_Init\n"); -+#if (RTL8822B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822B) -+ phydm_rfe_8822b_init(dm); -+#endif -+} -+ -+#ifdef CONFIG_DYNAMIC_TXCOLLISION_TH -+void phydm_tx_collsion_th_init(void *dm_void) -+{ -+ -+struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197G) -+ phydm_tx_collsion_th_init_8197g(dm); -+#endif -+ -+#if (RTL8812F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8812F) -+ phydm_tx_collsion_th_init_8812f(dm); -+#endif -+ -+} -+ -+void phydm_tx_collsion_th_set(void *dm_void, u8 val_r2t, u8 val_t2r) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197G) -+ phydm_tx_collsion_th_set_8197g(dm, val_r2t, val_t2r); -+#endif -+ -+#if (RTL8812F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8812F) -+ phydm_tx_collsion_th_set_8812f(dm, val_r2t, val_t2r); -+#endif -+ -+} -+#endif -+ -+void phydm_dm_early_init(struct dm_struct *dm) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ phydm_init_debug_setting(dm); -+#endif -+} -+ -+enum phydm_init_result odm_dm_init(struct dm_struct *dm) -+{ -+ enum phydm_init_result result = PHYDM_INIT_SUCCESS; -+ -+ if (!phydm_chk_bb_rf_pkg_set_valid(dm)) { -+ pr_debug("[Warning][%s] Init fail\n", __func__); -+ return PHYDM_INIT_FAIL_BBRF_REG_INVALID; -+ } -+ -+ halrf_init(dm); -+ phydm_supportability_init(dm); -+ phydm_pause_func_init(dm); -+ phydm_rfe_init(dm); -+ phydm_common_info_self_init(dm); -+ phydm_rx_phy_status_init(dm); -+#ifdef PHYDM_AUTO_DEGBUG -+ phydm_auto_dbg_engine_init(dm); -+#endif -+ phydm_dig_init(dm); -+#ifdef PHYDM_SUPPORT_CCKPD -+#ifdef PHYDM_DCC_ENHANCE -+ phydm_dig_cckpd_coex_init(dm); -+#endif -+ phydm_cck_pd_init(dm); -+#endif -+ phydm_env_monitor_init(dm); -+ phydm_adaptivity_init(dm); -+ phydm_ra_info_init(dm); -+ phydm_rssi_monitor_init(dm); -+ phydm_cfo_tracking_init(dm); -+ phydm_rf_init(dm); -+ phydm_dc_cancellation(dm); -+#ifdef PHYDM_TXA_CALIBRATION -+ phydm_txcurrentcalibration(dm); -+ phydm_get_pa_bias_offset(dm); -+#endif -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ odm_antenna_diversity_init(dm); -+#endif -+#ifdef CONFIG_ADAPTIVE_SOML -+ phydm_adaptive_soml_init(dm); -+#endif -+#ifdef CONFIG_PATH_DIVERSITY -+ phydm_tx_path_diversity_init(dm); -+#endif -+#ifdef CONFIG_DYNAMIC_TX_TWR -+ phydm_dynamic_tx_power_init(dm); -+#endif -+#if (PHYDM_LA_MODE_SUPPORT) -+ phydm_la_init(dm); -+#endif -+ -+#ifdef PHYDM_BEAMFORMING_VERSION1 -+ phydm_beamforming_init(dm); -+#endif -+ -+#if (RTL8188E_SUPPORT) -+ odm_ra_info_init_all(dm); -+#endif -+#ifdef PHYDM_PRIMARY_CCA -+ phydm_primary_cca_init(dm); -+#endif -+#ifdef CONFIG_PSD_TOOL -+ phydm_psd_init(dm); -+#endif -+ -+#ifdef CONFIG_SMART_ANTENNA -+ phydm_smt_ant_init(dm); -+#endif -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ phydm_lna_sat_check_init(dm); -+#endif -+#ifdef CONFIG_MCC_DM -+ phydm_mcc_init(dm); -+#endif -+ -+#ifdef PHYDM_CCK_RX_PATHDIV_SUPPORT -+ phydm_cck_rx_pathdiv_init(dm); -+#endif -+ -+#ifdef CONFIG_MU_RSOML -+ phydm_mu_rsoml_init(dm); -+#endif -+ -+#ifdef CONFIG_DYNAMIC_TXCOLLISION_TH -+ phydm_tx_collsion_th_init(dm); -+#endif -+ -+ return result; -+} -+ -+void odm_dm_reset(struct dm_struct *dm) -+{ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ odm_ant_div_reset(dm); -+ #endif -+ phydm_set_edcca_threshold_api(dm); -+} -+ -+void phydm_supportability_en(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 dm_value[10] = {0}; -+ u64 pre_support_ability, one = 1; -+ u64 comp = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i; -+ -+ for (i = 0; i < 5; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &dm_value[i]); -+ } -+ -+ pre_support_ability = dm->support_ability; -+ comp = dm->support_ability; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n================================\n"); -+ -+ if (dm_value[0] == 100) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Supportability] PhyDM Selection\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "================================\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "00. (( %s ))DIG\n", -+ ((comp & ODM_BB_DIG) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "01. (( %s ))RA_MASK\n", -+ ((comp & ODM_BB_RA_MASK) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "02. (( %s ))DYN_TXPWR\n", -+ ((comp & ODM_BB_DYNAMIC_TXPWR) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "03. (( %s ))FA_CNT\n", -+ ((comp & ODM_BB_FA_CNT) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "04. (( %s ))RSSI_MNTR\n", -+ ((comp & ODM_BB_RSSI_MONITOR) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "05. (( %s ))CCK_PD\n", -+ ((comp & ODM_BB_CCK_PD) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "06. (( %s ))ANT_DIV\n", -+ ((comp & ODM_BB_ANT_DIV) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "07. (( %s ))SMT_ANT\n", -+ ((comp & ODM_BB_SMT_ANT) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "08. (( %s ))PWR_TRAIN\n", -+ ((comp & ODM_BB_PWR_TRAIN) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "09. (( %s ))RA\n", -+ ((comp & ODM_BB_RATE_ADAPTIVE) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "10. (( %s ))PATH_DIV\n", -+ ((comp & ODM_BB_PATH_DIV) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "11. (( %s ))DFS\n", -+ ((comp & ODM_BB_DFS) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "12. (( %s ))DYN_ARFR\n", -+ ((comp & ODM_BB_DYNAMIC_ARFR) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "13. (( %s ))ADAPTIVITY\n", -+ ((comp & ODM_BB_ADAPTIVITY) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "14. (( %s ))CFO_TRACK\n", -+ ((comp & ODM_BB_CFO_TRACKING) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "15. (( %s ))ENV_MONITOR\n", -+ ((comp & ODM_BB_ENV_MONITOR) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "16. (( %s ))PRI_CCA\n", -+ ((comp & ODM_BB_PRIMARY_CCA) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "17. (( %s ))ADPTV_SOML\n", -+ ((comp & ODM_BB_ADAPTIVE_SOML) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "18. (( %s ))LNA_SAT_CHK\n", -+ ((comp & ODM_BB_LNA_SAT_CHK) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "================================\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Supportability] PhyDM offload ability\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "================================\n"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "00. (( %s ))PHY PARAM OFFLOAD\n", -+ ((dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) ? -+ ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "01. (( %s ))RF IQK OFFLOAD\n", -+ ((dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? -+ ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "================================\n"); -+ -+ } else if (dm_value[0] == 101) { -+ dm->support_ability = 0; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Disable all support_ability components\n"); -+ } else { -+ if (dm_value[1] == 1) { /* @enable */ -+ dm->support_ability |= (one << dm_value[0]); -+ } else if (dm_value[1] == 2) {/* @disable */ -+ dm->support_ability &= ~(one << dm_value[0]); -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Warning!!!] 1:enable, 2:disable\n"); -+ } -+ } -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pre-supportability = 0x%llx\n", pre_support_ability); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Cur-supportability = 0x%llx\n", dm->support_ability); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "================================\n"); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_watchdog_lps_32k(struct dm_struct *dm) -+{ -+ PHYDM_DBG(dm, DBG_COMMON_FLOW, "%s ======>\n", __func__); -+ -+ phydm_common_info_self_update(dm); -+ phydm_rssi_monitor_check(dm); -+ phydm_dig_lps_32k(dm); -+ phydm_common_info_self_reset(dm); -+} -+ -+void phydm_watchdog_lps(struct dm_struct *dm) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) -+ PHYDM_DBG(dm, DBG_COMMON_FLOW, "%s ======>\n", __func__); -+ -+ phydm_common_info_self_update(dm); -+ phydm_rssi_monitor_check(dm); -+ phydm_basic_dbg_message(dm); -+ phydm_receiver_blocking(dm); -+ phydm_false_alarm_counter_statistics(dm); -+ phydm_dig_by_rssi_lps(dm); -+ #ifdef PHYDM_SUPPORT_CCKPD -+ phydm_cck_pd_th(dm); -+ #endif -+ phydm_adaptivity(dm); -+ #ifdef CONFIG_BW_INDICATION -+ phydm_dyn_bw_indication(dm); -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ /*@enable AntDiv in PS mode, request from SD4 Jeff*/ -+ odm_antenna_diversity(dm); -+ #endif -+ #endif -+ phydm_common_info_self_reset(dm); -+#endif -+} -+ -+void phydm_watchdog_mp(struct dm_struct *dm) -+{ -+} -+ -+void phydm_pause_dm_watchdog(void *dm_void, enum phydm_pause_type pause_type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (pause_type == PHYDM_PAUSE) { -+ dm->disable_phydm_watchdog = 1; -+ PHYDM_DBG(dm, ODM_COMP_API, "PHYDM Stop\n"); -+ } else { -+ dm->disable_phydm_watchdog = 0; -+ PHYDM_DBG(dm, ODM_COMP_API, "PHYDM Start\n"); -+ } -+} -+ -+void phydm_pause_func_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ dm->pause_lv_table.lv_cckpd = PHYDM_PAUSE_RELEASE; -+ dm->pause_lv_table.lv_dig = PHYDM_PAUSE_RELEASE; -+ dm->pause_lv_table.lv_antdiv = PHYDM_PAUSE_RELEASE; -+ dm->pause_lv_table.lv_dig = PHYDM_PAUSE_RELEASE; -+ dm->pause_lv_table.lv_adapt = PHYDM_PAUSE_RELEASE; -+ dm->pause_lv_table.lv_adsl = PHYDM_PAUSE_RELEASE; -+} -+ -+u8 phydm_pause_func(void *dm_void, enum phydm_func_idx pause_func, -+ enum phydm_pause_type pause_type, -+ enum phydm_pause_level pause_lv, u8 val_lehgth, -+ u32 *val_buf) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_func_poiner *func_t = &dm->phydm_func_handler; -+ s8 *pause_lv_pre = &dm->s8_dummy; -+ u32 *bkp_val = &dm->u32_dummy; -+ u32 ori_val[5] = {0}; -+ u64 pause_func_bitmap = (u64)BIT(pause_func); -+ u8 i = 0; -+ u8 en_2rcca = 0; -+ u8 en_bw40m = 0; -+ u8 pause_result = PAUSE_FAIL; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "\n"); -+ PHYDM_DBG(dm, ODM_COMP_API, "[%s][%s] LV=%d, Len=%d\n", __func__, -+ ((pause_type == PHYDM_PAUSE) ? "Pause" : -+ ((pause_type == PHYDM_RESUME) ? "Resume" : "Pause no_set")), -+ pause_lv, val_lehgth); -+ -+ if (pause_lv >= PHYDM_PAUSE_MAX_NUM) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[WARNING]Wrong LV=%d\n", pause_lv); -+ return PAUSE_FAIL; -+ } -+ -+ if (pause_func == F00_DIG) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[DIG]\n"); -+ -+ if (val_lehgth != 1) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] length != 1\n"); -+ return PAUSE_FAIL; -+ } -+ -+ ori_val[0] = (u32)(dm->dm_dig_table.cur_ig_value); -+ pause_lv_pre = &dm->pause_lv_table.lv_dig; -+ bkp_val = (u32 *)(&dm->dm_dig_table.rvrt_val); -+ /*@function pointer hook*/ -+ func_t->pause_phydm_handler = phydm_set_dig_val; -+ -+#ifdef PHYDM_SUPPORT_CCKPD -+ } else if (pause_func == F05_CCK_PD) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[CCK_PD]\n"); -+ -+ if (val_lehgth != 1) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] length != 1\n"); -+ return PAUSE_FAIL; -+ } -+ -+ ori_val[0] = (u32)dm->dm_cckpd_table.cck_pd_lv; -+ pause_lv_pre = &dm->pause_lv_table.lv_cckpd; -+ bkp_val = (u32 *)(&dm->dm_cckpd_table.rvrt_val); -+ /*@function pointer hook*/ -+ func_t->pause_phydm_handler = phydm_set_cckpd_val; -+#endif -+ -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ } else if (pause_func == F06_ANT_DIV) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[AntDiv]\n"); -+ -+ if (val_lehgth != 1) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] length != 1\n"); -+ return PAUSE_FAIL; -+ } -+ /*@default antenna*/ -+ ori_val[0] = (u32)(dm->dm_fat_table.rx_idle_ant); -+ pause_lv_pre = &dm->pause_lv_table.lv_antdiv; -+ bkp_val = (u32 *)(&dm->dm_fat_table.rvrt_val); -+ /*@function pointer hook*/ -+ func_t->pause_phydm_handler = phydm_set_antdiv_val; -+ -+#endif -+#ifdef PHYDM_SUPPORT_ADAPTIVITY -+ } else if (pause_func == F13_ADPTVTY) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[Adaptivity]\n"); -+ -+ if (val_lehgth != 2) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] length != 2\n"); -+ return PAUSE_FAIL; -+ } -+ -+ ori_val[0] = (u32)(dm->adaptivity.th_l2h); /*th_l2h*/ -+ ori_val[1] = (u32)(dm->adaptivity.th_h2l); /*th_h2l*/ -+ pause_lv_pre = &dm->pause_lv_table.lv_adapt; -+ bkp_val = (u32 *)(&dm->adaptivity.rvrt_val); -+ /*@function pointer hook*/ -+ func_t->pause_phydm_handler = phydm_set_edcca_val; -+ -+#endif -+#ifdef CONFIG_ADAPTIVE_SOML -+ } else if (pause_func == F17_ADPTV_SOML) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[AD-SOML]\n"); -+ -+ if (val_lehgth != 1) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] length != 1\n"); -+ return PAUSE_FAIL; -+ } -+ /*SOML_ON/OFF*/ -+ ori_val[0] = (u32)(dm->dm_soml_table.soml_on_off); -+ -+ pause_lv_pre = &dm->pause_lv_table.lv_adsl; -+ bkp_val = (u32 *)(&dm->dm_soml_table.rvrt_val); -+ /*@function pointer hook*/ -+ func_t->pause_phydm_handler = phydm_set_adsl_val; -+ -+#endif -+ } else { -+ PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] error func idx\n"); -+ return PAUSE_FAIL; -+ } -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "Pause_LV{new , pre} = {%d ,%d}\n", -+ pause_lv, *pause_lv_pre); -+ -+ if (pause_type == PHYDM_PAUSE || pause_type == PHYDM_PAUSE_NO_SET) { -+ if (pause_lv <= *pause_lv_pre) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[PAUSE FAIL] Pre_LV >= Curr_LV\n"); -+ return PAUSE_FAIL; -+ } -+ -+ if (!(dm->pause_ability & pause_func_bitmap)) { -+ for (i = 0; i < val_lehgth; i++) -+ bkp_val[i] = ori_val[i]; -+ } -+ -+ dm->pause_ability |= pause_func_bitmap; -+ PHYDM_DBG(dm, ODM_COMP_API, "pause_ability=0x%llx\n", -+ dm->pause_ability); -+ -+ if (pause_type == PHYDM_PAUSE) { -+ for (i = 0; i < val_lehgth; i++) -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[PAUSE SUCCESS] val_idx[%d]{New, Ori}={0x%x, 0x%x}\n", -+ i, val_buf[i], bkp_val[i]); -+ func_t->pause_phydm_handler(dm, val_buf, val_lehgth); -+ } else { -+ for (i = 0; i < val_lehgth; i++) -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[PAUSE NO Set: SUCCESS] val_idx[%d]{Ori}={0x%x}\n", -+ i, bkp_val[i]); -+ } -+ -+ *pause_lv_pre = pause_lv; -+ pause_result = PAUSE_SUCCESS; -+ -+ } else if (pause_type == PHYDM_RESUME) { -+ if (pause_lv < *pause_lv_pre) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[Resume FAIL] Pre_LV >= Curr_LV\n"); -+ return PAUSE_FAIL; -+ } -+ -+ if ((dm->pause_ability & pause_func_bitmap) == 0) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[RESUME] No Need to Revert\n"); -+ return PAUSE_SUCCESS; -+ } -+ -+ dm->pause_ability &= ~pause_func_bitmap; -+ PHYDM_DBG(dm, ODM_COMP_API, "pause_ability=0x%llx\n", -+ dm->pause_ability); -+ -+ *pause_lv_pre = PHYDM_PAUSE_RELEASE; -+ -+ for (i = 0; i < val_lehgth; i++) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[RESUME] val_idx[%d]={0x%x}\n", i, -+ bkp_val[i]); -+ } -+ -+ func_t->pause_phydm_handler(dm, bkp_val, val_lehgth); -+ -+ pause_result = PAUSE_SUCCESS; -+ } else { -+ PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] error pause_type\n"); -+ pause_result = PAUSE_FAIL; -+ } -+ return pause_result; -+} -+ -+void phydm_pause_func_console(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 i; -+ u8 length = 0; -+ u32 buf[5] = {0}; -+ u8 set_result = 0; -+ enum phydm_func_idx func = 0; -+ enum phydm_pause_type type = 0; -+ enum phydm_pause_level lv = 0; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{Func} {1:pause,2:pause no set 3:Resume} {lv:0~3} Val[5:0]\n"); -+ -+ goto out; -+ } -+ -+ for (i = 0; i < 10; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ } -+ -+ func = (enum phydm_func_idx)var1[0]; -+ type = (enum phydm_pause_type)var1[1]; -+ lv = (enum phydm_pause_level)var1[2]; -+ -+ for (i = 0; i < 5; i++) -+ buf[i] = var1[3 + i]; -+ -+ if (func == F00_DIG) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[DIG]\n"); -+ length = 1; -+ -+ } else if (func == F05_CCK_PD) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[CCK_PD]\n"); -+ length = 1; -+ } else if (func == F06_ANT_DIV) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Ant_Div]\n"); -+ length = 1; -+ } else if (func == F13_ADPTVTY) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Adaptivity]\n"); -+ length = 2; -+ } else if (func == F17_ADPTV_SOML) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ADSL]\n"); -+ length = 1; -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Set Function Error]\n"); -+ length = 0; -+ } -+ -+ if (length != 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{%s, lv=%d} val = %d, %d}\n", -+ ((type == PHYDM_PAUSE) ? "Pause" : -+ ((type == PHYDM_RESUME) ? "Resume" : "Pause no_set")), -+ lv, var1[3], var1[4]); -+ -+ set_result = phydm_pause_func(dm, func, type, lv, length, buf); -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "set_result = %d\n", set_result); -+ -+out: -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_pause_dm_by_asso_pkt(struct dm_struct *dm, -+ enum phydm_pause_type pause_type, u8 rssi) -+{ -+ u32 igi_val = rssi + 10; -+ u32 th_buf[2]; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "[%s][%s] rssi=%d\n", __func__, -+ ((pause_type == PHYDM_PAUSE) ? "Pause" : -+ ((pause_type == PHYDM_RESUME) ? "Resume" : "Pause no_set")), -+ rssi); -+ -+ if (pause_type == PHYDM_RESUME) { -+ phydm_pause_func(dm, F00_DIG, PHYDM_RESUME, -+ PHYDM_PAUSE_LEVEL_1, 1, &igi_val); -+ -+ phydm_pause_func(dm, F13_ADPTVTY, PHYDM_RESUME, -+ PHYDM_PAUSE_LEVEL_1, 2, th_buf); -+ } else { -+ odm_write_dig(dm, (u8)igi_val); -+ phydm_pause_func(dm, F00_DIG, PHYDM_PAUSE, -+ PHYDM_PAUSE_LEVEL_1, 1, &igi_val); -+ -+ th_buf[0] = 0xff; -+ th_buf[1] = 0xff; -+ -+ phydm_pause_func(dm, F13_ADPTVTY, PHYDM_PAUSE, -+ PHYDM_PAUSE_LEVEL_1, 2, th_buf); -+ } -+} -+ -+u8 phydm_stop_dm_watchdog_check(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->disable_phydm_watchdog == 1) { -+ PHYDM_DBG(dm, DBG_COMMON_FLOW, "Disable phydm\n"); -+ return true; -+ } else { -+ return false; -+ } -+} -+ -+void phydm_watchdog(struct dm_struct *dm) -+{ -+ PHYDM_DBG(dm, DBG_COMMON_FLOW, "%s ======>\n", __func__); -+ -+ phydm_common_info_self_update(dm); -+ phydm_phy_info_update(dm); -+ phydm_rssi_monitor_check(dm); -+ phydm_basic_dbg_message(dm); -+ phydm_dm_summary(dm, FIRST_MACID); -+#ifdef PHYDM_AUTO_DEGBUG -+ phydm_auto_dbg_engine(dm); -+#endif -+ phydm_receiver_blocking(dm); -+ -+ if (phydm_stop_dm_watchdog_check(dm) == true) -+ return; -+ -+ phydm_hw_setting(dm); -+ -+ phydm_env_mntr_result_watchdog(dm); -+ -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+ if (dm->original_dig_restore == 0) { -+ phydm_tdma_dig_timer_check(dm); -+ } else -+#endif -+ { -+ phydm_false_alarm_counter_statistics(dm); -+ #if (ODM_IC_11N_SERIES_SUPPORT || ODM_IC_11AC_SERIES_SUPPORT) -+ if (dm->support_ic_type & (ODM_IC_11N_SERIES | -+ ODM_IC_11AC_SERIES)) -+ phydm_noisy_detection(dm); -+ #endif -+ -+ #if defined(PHYDM_DCC_ENHANCE) && defined(PHYDM_SUPPORT_CCKPD) -+ phydm_dig_cckpd_coex(dm); -+ #else -+ phydm_dig(dm); -+ #ifdef PHYDM_SUPPORT_CCKPD -+ phydm_cck_pd_th(dm); -+ #endif -+ #endif -+ } -+ -+#ifdef PHYDM_HW_IGI -+ phydm_hwigi(dm); -+#endif -+#ifdef PHYDM_POWER_TRAINING_SUPPORT -+ phydm_update_power_training_state(dm); -+#endif -+ phydm_adaptivity(dm); -+ phydm_ra_info_watchdog(dm); -+#ifdef CONFIG_PATH_DIVERSITY -+ phydm_tx_path_diversity(dm); -+#endif -+ phydm_cfo_tracking(dm); -+#ifdef CONFIG_DYNAMIC_TX_TWR -+ phydm_dynamic_tx_power(dm); -+#endif -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ odm_antenna_diversity(dm); -+#endif -+#ifdef CONFIG_ADAPTIVE_SOML -+ phydm_adaptive_soml(dm); -+#endif -+ -+#ifdef PHYDM_BEAMFORMING_VERSION1 -+ phydm_beamforming_watchdog(dm); -+#endif -+ -+ halrf_watchdog(dm); -+#ifdef PHYDM_PRIMARY_CCA -+ phydm_primary_cca(dm); -+#endif -+#ifdef CONFIG_BW_INDICATION -+ phydm_dyn_bw_indication(dm); -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ odm_dtc(dm); -+#endif -+ -+ phydm_env_mntr_set_watchdog(dm); -+ -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ phydm_lna_sat_chk_watchdog(dm); -+#endif -+ -+#ifdef CONFIG_MCC_DM -+ phydm_mcc_switch(dm); -+#endif -+ -+#ifdef CONFIG_MU_RSOML -+ phydm_mu_rsoml_decision(dm); -+#endif -+ -+ phydm_common_info_self_reset(dm); -+} -+ -+void phydm_fw_dm_ctrl_en(void *dm_void, enum phydm_func_idx fun_idx, -+ boolean enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 h2c_val[H2C_MAX_LENGTH] = {0}; -+ u8 para4[4]; /*4 bit*/ -+ u8 para8[4]; /*8 bit*/ -+ u8 i = 0; -+ -+ for (i = 0; i < 4; i++) { -+ para4[i] = 0; -+ para8[i] = 0; -+ } -+ -+ switch (fun_idx) { -+ case F00_DIG: -+ phydm_fill_fw_dig_info(dm, &enable, para4, para8); -+ break; -+ default: -+ pr_debug("[Warning] %s\n", __func__); -+ return; -+ } -+ -+ h2c_val[0] = (u8)((fun_idx & 0x3f) | (enable << 6)); -+ h2c_val[1] = para8[0]; -+ h2c_val[2] = para8[1]; -+ h2c_val[3] = para8[2]; -+ h2c_val[4] = para8[3]; -+ h2c_val[5] = (para4[0] & 0xf) | ((para4[1] & 0xf) << 3); -+ h2c_val[6] = (para4[2] & 0xf) | ((para4[3] & 0xf) << 3); -+ -+ PHYDM_DBG(dm, DBG_FW_DM, -+ "H2C[0x59] fun_idx=%d,en=%d,para8={%x %x %x %x},para4={%x %x %x %x}\n", -+ fun_idx, enable, -+ para8[0], para8[1], para8[2], para8[3], -+ para4[0], para4[1], para4[2], para4[3]); -+ -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_FW_DM_CTRL, H2C_MAX_LENGTH, h2c_val); -+} -+ -+/*@ -+ * Init /.. Fixed HW value. Only init time. -+ */ -+void odm_cmn_info_init(struct dm_struct *dm, enum odm_cmninfo cmn_info, -+ u64 value) -+{ -+ /* This section is used for init value */ -+ switch (cmn_info) { -+ /* @Fixed ODM value. */ -+ case ODM_CMNINFO_ABILITY: -+ dm->support_ability = (u64)value; -+ break; -+ -+ case ODM_CMNINFO_RF_TYPE: -+ dm->rf_type = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_PLATFORM: -+ dm->support_platform = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_INTERFACE: -+ dm->support_interface = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_MP_TEST_CHIP: -+ dm->is_mp_chip = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_IC_TYPE: -+ dm->support_ic_type = (u32)value; -+ break; -+ -+ case ODM_CMNINFO_CUT_VER: -+ dm->cut_version = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_FAB_VER: -+ dm->fab_version = (u8)value; -+ break; -+ case ODM_CMNINFO_FW_VER: -+ dm->fw_version = (u8)value; -+ break; -+ case ODM_CMNINFO_FW_SUB_VER: -+ dm->fw_sub_version = (u8)value; -+ break; -+ case ODM_CMNINFO_RFE_TYPE: -+#if (RTL8821C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8821C) -+ dm->rfe_type_expand = (u8)value; -+ else -+#endif -+ dm->rfe_type = (u8)value; -+ -+#ifdef CONFIG_RFE_BY_HW_INFO -+ phydm_init_hw_info_by_rfe(dm); -+#endif -+ break; -+ -+ case ODM_CMNINFO_RF_ANTENNA_TYPE: -+ dm->ant_div_type = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH: -+ dm->with_extenal_ant_switch = (u8)value; -+ break; -+ -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ case ODM_CMNINFO_BE_FIX_TX_ANT: -+ dm->dm_fat_table.b_fix_tx_ant = (u8)value; -+ break; -+#endif -+ -+ case ODM_CMNINFO_BOARD_TYPE: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->board_type = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_PACKAGE_TYPE: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->package_type = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_EXT_LNA: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->ext_lna = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_5G_EXT_LNA: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->ext_lna_5g = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_EXT_PA: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->ext_pa = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_5G_EXT_PA: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->ext_pa_5g = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_GPA: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->type_gpa = (u16)value; -+ break; -+ -+ case ODM_CMNINFO_APA: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->type_apa = (u16)value; -+ break; -+ -+ case ODM_CMNINFO_GLNA: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->type_glna = (u16)value; -+ break; -+ -+ case ODM_CMNINFO_ALNA: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->type_alna = (u16)value; -+ break; -+ -+ case ODM_CMNINFO_EXT_TRSW: -+ if (!dm->is_init_hw_info_by_rfe) -+ dm->ext_trsw = (u8)value; -+ break; -+ case ODM_CMNINFO_EXT_LNA_GAIN: -+ dm->ext_lna_gain = (u8)value; -+ break; -+ case ODM_CMNINFO_PATCH_ID: -+ dm->iot_table.win_patch_id = (u8)value; -+ break; -+ case ODM_CMNINFO_BINHCT_TEST: -+ dm->is_in_hct_test = (boolean)value; -+ break; -+ case ODM_CMNINFO_BWIFI_TEST: -+ dm->wifi_test = (u8)value; -+ break; -+ case ODM_CMNINFO_SMART_CONCURRENT: -+ dm->is_dual_mac_smart_concurrent = (boolean)value; -+ break; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ case ODM_CMNINFO_CONFIG_BB_RF: -+ dm->config_bbrf = (boolean)value; -+ break; -+#endif -+ case ODM_CMNINFO_IQKPAOFF: -+ dm->rf_calibrate_info.is_iqk_pa_off = (boolean)value; -+ break; -+ case ODM_CMNINFO_REGRFKFREEENABLE: -+ dm->rf_calibrate_info.reg_rf_kfree_enable = (u8)value; -+ break; -+ case ODM_CMNINFO_RFKFREEENABLE: -+ dm->rf_calibrate_info.rf_kfree_enable = (u8)value; -+ break; -+ case ODM_CMNINFO_NORMAL_RX_PATH_CHANGE: -+ dm->normal_rx_path = (u8)value; -+ break; -+ case ODM_CMNINFO_VALID_PATH_SET: -+ dm->valid_path_set = (u8)value; -+ break; -+ case ODM_CMNINFO_EFUSE0X3D8: -+ dm->efuse0x3d8 = (u8)value; -+ break; -+ case ODM_CMNINFO_EFUSE0X3D7: -+ dm->efuse0x3d7 = (u8)value; -+ break; -+ case ODM_CMNINFO_ADVANCE_OTA: -+ dm->p_advance_ota = (u8)value; -+ break; -+ -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ case ODM_CMNINFO_DFS_REGION_DOMAIN: -+ dm->dfs_region_domain = (u8)value; -+ break; -+#endif -+ case ODM_CMNINFO_SOFT_AP_SPECIAL_SETTING: -+ dm->soft_ap_special_setting = (u32)value; -+ break; -+ -+ case ODM_CMNINFO_X_CAP_SETTING: -+ dm->dm_cfo_track.crystal_cap_default = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_DPK_EN: -+ /*@dm->dpk_en = (u1Byte)value;*/ -+ halrf_cmn_info_set(dm, HALRF_CMNINFO_DPK_EN, (u64)value); -+ break; -+ -+ case ODM_CMNINFO_HP_HWID: -+ dm->hp_hw_id = (boolean)value; -+ break; -+ case ODM_CMNINFO_TSSI_ENABLE: -+ dm->en_tssi_mode = (u8)value; -+ break; -+ case ODM_CMNINFO_DIS_DPD: -+ dm->en_dis_dpd = (boolean)value; -+ break; -+ case ODM_CMNINFO_EN_AUTO_BW_TH: -+ dm->en_auto_bw_th = (u8)value; -+ break; -+ case ODM_CMNINFO_EN_NBI_DETECT: -+ dm->en_nbi_detect = (boolean)value; -+ break; -+#if (RTL8721D_SUPPORT) -+ case ODM_CMNINFO_POWER_VOLTAGE: -+ dm->power_voltage = (u8)value; -+ break; -+ case ODM_CMNINFO_ANTDIV_GPIO: -+ dm->antdiv_gpio = (u8)value; -+ break; -+ case ODM_CMNINFO_PEAK_DETECT_MODE: -+ dm->peak_detect_mode = (u8)value; -+ break; -+#endif -+ default: -+ break; -+ } -+} -+ -+void odm_cmn_info_hook(struct dm_struct *dm, enum odm_cmninfo cmn_info, -+ void *value) -+{ -+ /* @Hook call by reference pointer. */ -+ switch (cmn_info) { -+ /* @Dynamic call by reference pointer. */ -+ case ODM_CMNINFO_TX_UNI: -+ dm->num_tx_bytes_unicast = (u64 *)value; -+ break; -+ -+ case ODM_CMNINFO_RX_UNI: -+ dm->num_rx_bytes_unicast = (u64 *)value; -+ break; -+ -+ case ODM_CMNINFO_BAND: -+ dm->band_type = (u8 *)value; -+ break; -+ -+ case ODM_CMNINFO_SEC_CHNL_OFFSET: -+ dm->sec_ch_offset = (u8 *)value; -+ break; -+ -+ case ODM_CMNINFO_SEC_MODE: -+ dm->security = (u8 *)value; -+ break; -+ -+ case ODM_CMNINFO_BW: -+ dm->band_width = (u8 *)value; -+ break; -+ -+ case ODM_CMNINFO_CHNL: -+ dm->channel = (u8 *)value; -+ break; -+ -+ case ODM_CMNINFO_SCAN: -+ dm->is_scan_in_process = (boolean *)value; -+ break; -+ -+ case ODM_CMNINFO_POWER_SAVING: -+ dm->is_power_saving = (boolean *)value; -+ break; -+ -+ case ODM_CMNINFO_TDMA: -+ dm->is_tdma = (boolean *)value; -+ break; -+ -+ case ODM_CMNINFO_ONE_PATH_CCA: -+ dm->one_path_cca = (u8 *)value; -+ break; -+ -+ case ODM_CMNINFO_DRV_STOP: -+ dm->is_driver_stopped = (boolean *)value; -+ break; -+ case ODM_CMNINFO_INIT_ON: -+ dm->pinit_adpt_in_progress = (boolean *)value; -+ break; -+ -+ case ODM_CMNINFO_ANT_TEST: -+ dm->antenna_test = (u8 *)value; -+ break; -+ -+ case ODM_CMNINFO_NET_CLOSED: -+ dm->is_net_closed = (boolean *)value; -+ break; -+ -+ case ODM_CMNINFO_FORCED_RATE: -+ dm->forced_data_rate = (u16 *)value; -+ break; -+ case ODM_CMNINFO_ANT_DIV: -+ dm->enable_antdiv = (u8 *)value; -+ break; -+ case ODM_CMNINFO_PATH_DIV: -+ dm->enable_pathdiv = (u8 *)value; -+ break; -+ case ODM_CMNINFO_ADAPTIVE_SOML: -+ dm->en_adap_soml = (u8 *)value; -+ break; -+ case ODM_CMNINFO_ADAPTIVITY: -+ dm->edcca_mode = (u8 *)value; -+ break; -+ -+ case ODM_CMNINFO_P2P_LINK: -+ dm->dm_dig_table.is_p2p_in_process = (u8 *)value; -+ break; -+ -+ case ODM_CMNINFO_IS1ANTENNA: -+ dm->is_1_antenna = (boolean *)value; -+ break; -+ -+ case ODM_CMNINFO_RFDEFAULTPATH: -+ dm->rf_default_path = (u8 *)value; -+ break; -+ -+ case ODM_CMNINFO_FCS_MODE: /* @fast channel switch (= MCC mode)*/ -+ dm->is_fcs_mode_enable = (boolean *)value; -+ break; -+ -+ case ODM_CMNINFO_HUBUSBMODE: -+ dm->hub_usb_mode = (u8 *)value; -+ break; -+ case ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS: -+ dm->is_fw_dw_rsvd_page_in_progress = (boolean *)value; -+ break; -+ case ODM_CMNINFO_TX_TP: -+ dm->current_tx_tp = (u32 *)value; -+ break; -+ case ODM_CMNINFO_RX_TP: -+ dm->current_rx_tp = (u32 *)value; -+ break; -+ case ODM_CMNINFO_SOUNDING_SEQ: -+ dm->sounding_seq = (u8 *)value; -+ break; -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ case ODM_CMNINFO_DFS_MASTER_ENABLE: -+ dm->dfs_master_enabled = (u8 *)value; -+ break; -+#endif -+ -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ case ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC: -+ dm->dm_fat_table.p_force_tx_by_desc = (u8 *)value; -+ break; -+ case ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA: -+ dm->dm_fat_table.p_default_s0_s1 = (u8 *)value; -+ break; -+ case ODM_CMNINFO_BF_ANTDIV_DECISION: -+ dm->dm_fat_table.is_no_csi_feedback = (boolean *)value; -+ break; -+#endif -+ -+ case ODM_CMNINFO_SOFT_AP_MODE: -+ dm->soft_ap_mode = (u32 *)value; -+ break; -+ case ODM_CMNINFO_MP_MODE: -+ dm->mp_mode = (u8 *)value; -+ break; -+ case ODM_CMNINFO_INTERRUPT_MASK: -+ dm->interrupt_mask = (u32 *)value; -+ break; -+ case ODM_CMNINFO_BB_OPERATION_MODE: -+ dm->bb_op_mode = (u8 *)value; -+ break; -+ case ODM_CMNINFO_MANUAL_SUPPORTABILITY: -+ dm->manual_supportability = (u32 *)value; -+ break; -+ case ODM_CMNINFO_EN_DYM_BW_INDICATION: -+ dm->dis_dym_bw_indication = (u8 *)value; -+ break; -+#if (RTL8192F_SUPPORT || RTL8721D_SUPPORT || RTL8710C_SUPPORT) -+ case ODM_ANTI_INTERFERENCE_EN: -+ dm->anti_interference_en = (u8 *)value; -+ break; -+#endif -+ default: -+ /*do nothing*/ -+ break; -+ } -+} -+ -+/*@ -+ * Update band/CHannel/.. The values are dynamic but non-per-packet. -+ */ -+void odm_cmn_info_update(struct dm_struct *dm, u32 cmn_info, u64 value) -+{ -+ /* This init variable may be changed in run time. */ -+ switch (cmn_info) { -+ case ODM_CMNINFO_LINK_IN_PROGRESS: -+ dm->is_link_in_process = (boolean)value; -+ break; -+ -+ case ODM_CMNINFO_ABILITY: -+ dm->support_ability = (u64)value; -+ break; -+ -+ case ODM_CMNINFO_RF_TYPE: -+ dm->rf_type = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_WIFI_DIRECT: -+ dm->is_wifi_direct = (boolean)value; -+ break; -+ -+ case ODM_CMNINFO_WIFI_DISPLAY: -+ dm->is_wifi_display = (boolean)value; -+ break; -+ -+ case ODM_CMNINFO_LINK: -+ dm->is_linked = (boolean)value; -+ break; -+ -+ case ODM_CMNINFO_CMW500LINK: -+ dm->iot_table.is_linked_cmw500 = (boolean)value; -+ break; -+ -+ case ODM_CMNINFO_STATION_STATE: -+ dm->bsta_state = (boolean)value; -+ break; -+ -+ case ODM_CMNINFO_RSSI_MIN: -+#if 0 -+ dm->rssi_min = (u8)value; -+#endif -+ break; -+ -+ case ODM_CMNINFO_RSSI_MIN_BY_PATH: -+ dm->rssi_min_by_path = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_DBG_COMP: -+ dm->debug_components = (u64)value; -+ break; -+ -+#ifdef ODM_CONFIG_BT_COEXIST -+ /* The following is for BT HS mode and BT coexist mechanism. */ -+ case ODM_CMNINFO_BT_ENABLED: -+ dm->bt_info_table.is_bt_enabled = (boolean)value; -+ break; -+ -+ case ODM_CMNINFO_BT_HS_CONNECT_PROCESS: -+ dm->bt_info_table.is_bt_connect_process = (boolean)value; -+ break; -+ -+ case ODM_CMNINFO_BT_HS_RSSI: -+ dm->bt_info_table.bt_hs_rssi = (u8)value; -+ break; -+ -+ case ODM_CMNINFO_BT_OPERATION: -+ dm->bt_info_table.is_bt_hs_operation = (boolean)value; -+ break; -+ -+ case ODM_CMNINFO_BT_LIMITED_DIG: -+ dm->bt_info_table.is_bt_limited_dig = (boolean)value; -+ break; -+#endif -+ -+ case ODM_CMNINFO_AP_TOTAL_NUM: -+ dm->ap_total_num = (u8)value; -+ break; -+ -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ case ODM_CMNINFO_DFS_REGION_DOMAIN: -+ dm->dfs_region_domain = (u8)value; -+ break; -+#endif -+ -+ case ODM_CMNINFO_BT_CONTINUOUS_TURN: -+ dm->is_bt_continuous_turn = (boolean)value; -+ break; -+ case ODM_CMNINFO_IS_DOWNLOAD_FW: -+ dm->is_download_fw = (boolean)value; -+ break; -+ case ODM_CMNINFO_PHYDM_PATCH_ID: -+ dm->iot_table.phydm_patch_id = (u32)value; -+ break; -+ case ODM_CMNINFO_RRSR_VAL: -+ dm->dm_ra_table.rrsr_val_init = (u32)value; -+ break; -+ case ODM_CMNINFO_LINKED_BF_SUPPORT: -+ dm->linked_bf_support = (u8)value; -+ break; -+ case ODM_CMNINFO_FLATNESS_TYPE: -+ dm->flatness_type = (u8)value; -+ break; -+ case ODM_CMNINFO_TSSI_ENABLE: -+ dm->en_tssi_mode = (u8)value; -+ break; -+ case ODM_CMNINFO_HUAWEI_HWID: -+ dm->is_dig_low_bond = (boolean)value; -+ break; -+ case ODM_CMNINFO_ATHEROS_HWID: -+ dm->is_R2R_CCA_MASKT_TIME_SHORT = (boolean)value; -+ break; -+ default: -+ break; -+ } -+} -+ -+u32 phydm_cmn_info_query(struct dm_struct *dm, enum phydm_info_query info_type) -+{ -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct ccx_info *ccx_info = &dm->dm_ccx_info; -+ -+ switch (info_type) { -+ /*@=== [FA Relative] ===========================================*/ -+ case PHYDM_INFO_FA_OFDM: -+ return fa_t->cnt_ofdm_fail; -+ -+ case PHYDM_INFO_FA_CCK: -+ return fa_t->cnt_cck_fail; -+ -+ case PHYDM_INFO_FA_TOTAL: -+ return fa_t->cnt_all; -+ -+ case PHYDM_INFO_CCA_OFDM: -+ return fa_t->cnt_ofdm_cca; -+ -+ case PHYDM_INFO_CCA_CCK: -+ return fa_t->cnt_cck_cca; -+ -+ case PHYDM_INFO_CCA_ALL: -+ return fa_t->cnt_cca_all; -+ -+ case PHYDM_INFO_CRC32_OK_VHT: -+ return fa_t->cnt_vht_crc32_ok; -+ -+ case PHYDM_INFO_CRC32_OK_HT: -+ return fa_t->cnt_ht_crc32_ok; -+ -+ case PHYDM_INFO_CRC32_OK_LEGACY: -+ return fa_t->cnt_ofdm_crc32_ok; -+ -+ case PHYDM_INFO_CRC32_OK_CCK: -+ return fa_t->cnt_cck_crc32_ok; -+ -+ case PHYDM_INFO_CRC32_ERROR_VHT: -+ return fa_t->cnt_vht_crc32_error; -+ -+ case PHYDM_INFO_CRC32_ERROR_HT: -+ return fa_t->cnt_ht_crc32_error; -+ -+ case PHYDM_INFO_CRC32_ERROR_LEGACY: -+ return fa_t->cnt_ofdm_crc32_error; -+ -+ case PHYDM_INFO_CRC32_ERROR_CCK: -+ return fa_t->cnt_cck_crc32_error; -+ -+ case PHYDM_INFO_EDCCA_FLAG: -+ return fa_t->edcca_flag; -+ -+ case PHYDM_INFO_OFDM_ENABLE: -+ return fa_t->ofdm_block_enable; -+ -+ case PHYDM_INFO_CCK_ENABLE: -+ return fa_t->cck_block_enable; -+ -+ case PHYDM_INFO_DBG_PORT_0: -+ return fa_t->dbg_port0; -+ -+ case PHYDM_INFO_CRC32_OK_HT_AGG: -+ return fa_t->cnt_ht_crc32_ok_agg; -+ -+ case PHYDM_INFO_CRC32_ERROR_HT_AGG: -+ return fa_t->cnt_ht_crc32_error_agg; -+ -+ /*@=== [DIG] ================================================*/ -+ -+ case PHYDM_INFO_CURR_IGI: -+ return dig_t->cur_ig_value; -+ -+ /*@=== [RSSI] ===============================================*/ -+ case PHYDM_INFO_RSSI_MIN: -+ return (u32)dm->rssi_min; -+ -+ case PHYDM_INFO_RSSI_MAX: -+ return (u32)dm->rssi_max; -+ -+ case PHYDM_INFO_CLM_RATIO: -+ return (u32)ccx_info->clm_ratio; -+ case PHYDM_INFO_NHM_RATIO: -+ return (u32)ccx_info->nhm_ratio; -+ case PHYDM_INFO_NHM_NOISE_PWR: -+ return (u32)ccx_info->nhm_level; -+ case PHYDM_INFO_NHM_PWR: -+ return (u32)ccx_info->nhm_pwr; -+ case PHYDM_INFO_NHM_ENV_RATIO: -+ return (u32)ccx_info->nhm_env_ratio; -+ case PHYDM_INFO_TXEN_CCK: -+ return (u32)fa_t->cnt_cck_txen; -+ case PHYDM_INFO_TXEN_OFDM: -+ return (u32)fa_t->cnt_ofdm_txen; -+ case PHYDM_INFO_NHM_IDLE_RATIO: -+ return (u32)ccx_info->nhm_idle_ratio; -+ case PHYDM_INFO_NHM_TX_RATIO: -+ return (u32)ccx_info->nhm_tx_ratio; -+ default: -+ return 0xffffffff; -+ } -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void odm_init_all_work_items(struct dm_struct *dm) -+{ -+ void *adapter = dm->adapter; -+#if USE_WORKITEM -+ -+#ifdef CONFIG_ADAPTIVE_SOML -+ odm_initialize_work_item(dm, -+ &dm->dm_soml_table.phydm_adaptive_soml_workitem, -+ (RT_WORKITEM_CALL_BACK)phydm_adaptive_soml_workitem_callback, -+ (void *)adapter, -+ "AdaptiveSOMLWorkitem"); -+#endif -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ odm_initialize_work_item(dm, -+ &dm->phydm_evm_antdiv_workitem, -+ (RT_WORKITEM_CALL_BACK)phydm_evm_antdiv_workitem_callback, -+ (void *)adapter, -+ "EvmAntdivWorkitem"); -+#endif -+ -+#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_initialize_work_item(dm, -+ &dm->dm_swat_table.phydm_sw_antenna_switch_workitem, -+ (RT_WORKITEM_CALL_BACK)odm_sw_antdiv_workitem_callback, -+ (void *)adapter, -+ "AntennaSwitchWorkitem"); -+#endif -+#if (defined(CONFIG_HL_SMART_ANTENNA)) -+ odm_initialize_work_item(dm, -+ &dm->dm_sat_table.hl_smart_antenna_workitem, -+ (RT_WORKITEM_CALL_BACK)phydm_beam_switch_workitem_callback, -+ (void *)adapter, -+ "hl_smart_ant_workitem"); -+ -+ odm_initialize_work_item(dm, -+ &dm->dm_sat_table.hl_smart_antenna_decision_workitem, -+ (RT_WORKITEM_CALL_BACK)phydm_beam_decision_workitem_callback, -+ (void *)adapter, -+ "hl_smart_ant_decision_workitem"); -+#endif -+ -+ odm_initialize_work_item( -+ dm, -+ &dm->ra_rpt_workitem, -+ (RT_WORKITEM_CALL_BACK)halrf_update_init_rate_work_item_callback, -+ (void *)adapter, -+ "ra_rpt_workitem"); -+ -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ odm_initialize_work_item( -+ dm, -+ &dm->fast_ant_training_workitem, -+ (RT_WORKITEM_CALL_BACK)odm_fast_ant_training_work_item_callback, -+ (void *)adapter, -+ "fast_ant_training_workitem"); -+#endif -+ -+#endif /*#if USE_WORKITEM*/ -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ odm_initialize_work_item( -+ dm, -+ &dm->beamforming_info.txbf_info.txbf_enter_work_item, -+ (RT_WORKITEM_CALL_BACK)hal_com_txbf_enter_work_item_callback, -+ (void *)adapter, -+ "txbf_enter_work_item"); -+ -+ odm_initialize_work_item( -+ dm, -+ &dm->beamforming_info.txbf_info.txbf_leave_work_item, -+ (RT_WORKITEM_CALL_BACK)hal_com_txbf_leave_work_item_callback, -+ (void *)adapter, -+ "txbf_leave_work_item"); -+ -+ odm_initialize_work_item( -+ dm, -+ &dm->beamforming_info.txbf_info.txbf_fw_ndpa_work_item, -+ (RT_WORKITEM_CALL_BACK)hal_com_txbf_fw_ndpa_work_item_callback, -+ (void *)adapter, -+ "txbf_fw_ndpa_work_item"); -+ -+ odm_initialize_work_item( -+ dm, -+ &dm->beamforming_info.txbf_info.txbf_clk_work_item, -+ (RT_WORKITEM_CALL_BACK)hal_com_txbf_clk_work_item_callback, -+ (void *)adapter, -+ "txbf_clk_work_item"); -+ -+ odm_initialize_work_item( -+ dm, -+ &dm->beamforming_info.txbf_info.txbf_rate_work_item, -+ (RT_WORKITEM_CALL_BACK)hal_com_txbf_rate_work_item_callback, -+ (void *)adapter, -+ "txbf_rate_work_item"); -+ -+ odm_initialize_work_item( -+ dm, -+ &dm->beamforming_info.txbf_info.txbf_status_work_item, -+ (RT_WORKITEM_CALL_BACK)hal_com_txbf_status_work_item_callback, -+ (void *)adapter, -+ "txbf_status_work_item"); -+ -+ odm_initialize_work_item( -+ dm, -+ &dm->beamforming_info.txbf_info.txbf_reset_tx_path_work_item, -+ (RT_WORKITEM_CALL_BACK)hal_com_txbf_reset_tx_path_work_item_callback, -+ (void *)adapter, -+ "txbf_reset_tx_path_work_item"); -+ -+ odm_initialize_work_item( -+ dm, -+ &dm->beamforming_info.txbf_info.txbf_get_tx_rate_work_item, -+ (RT_WORKITEM_CALL_BACK)hal_com_txbf_get_tx_rate_work_item_callback, -+ (void *)adapter, -+ "txbf_get_tx_rate_work_item"); -+#endif -+ -+#if (PHYDM_LA_MODE_SUPPORT == 1) -+ odm_initialize_work_item( -+ dm, -+ &dm->adcsmp.adc_smp_work_item, -+ (RT_WORKITEM_CALL_BACK)adc_smp_work_item_callback, -+ (void *)adapter, -+ "adc_smp_work_item"); -+ -+ odm_initialize_work_item( -+ dm, -+ &dm->adcsmp.adc_smp_work_item_1, -+ (RT_WORKITEM_CALL_BACK)adc_smp_work_item_callback, -+ (void *)adapter, -+ "adc_smp_work_item_1"); -+#endif -+} -+ -+void odm_free_all_work_items(struct dm_struct *dm) -+{ -+#if USE_WORKITEM -+ -+#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_free_work_item(&dm->dm_swat_table.phydm_sw_antenna_switch_workitem); -+#endif -+ -+#ifdef CONFIG_ADAPTIVE_SOML -+ odm_free_work_item(&dm->dm_soml_table.phydm_adaptive_soml_workitem); -+#endif -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ odm_free_work_item(&dm->phydm_evm_antdiv_workitem); -+#endif -+ -+#if (defined(CONFIG_HL_SMART_ANTENNA)) -+ odm_free_work_item(&dm->dm_sat_table.hl_smart_antenna_workitem); -+ odm_free_work_item(&dm->dm_sat_table.hl_smart_antenna_decision_workitem); -+#endif -+ -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ odm_free_work_item(&dm->fast_ant_training_workitem); -+#endif -+ odm_free_work_item(&dm->ra_rpt_workitem); -+/*odm_free_work_item((&dm->sbdcnt_workitem));*/ -+#endif -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_enter_work_item)); -+ odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_leave_work_item)); -+ odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_fw_ndpa_work_item)); -+ odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_clk_work_item)); -+ odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_rate_work_item)); -+ odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_status_work_item)); -+ odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_reset_tx_path_work_item)); -+ odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_get_tx_rate_work_item)); -+#endif -+ -+#if (PHYDM_LA_MODE_SUPPORT == 1) -+ odm_free_work_item((&dm->adcsmp.adc_smp_work_item)); -+ odm_free_work_item((&dm->adcsmp.adc_smp_work_item_1)); -+#endif -+} -+#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ -+void odm_init_all_timers(struct dm_struct *dm) -+{ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ odm_ant_div_timers(dm, INIT_ANTDIV_TIMMER); -+#endif -+#if (defined(PHYDM_TDMA_DIG_SUPPORT)) -+#ifdef IS_USE_NEW_TDMA -+ phydm_tdma_dig_timers(dm, INIT_TDMA_DIG_TIMMER); -+#endif -+#endif -+#ifdef CONFIG_ADAPTIVE_SOML -+ phydm_adaptive_soml_timers(dm, INIT_SOML_TIMMER); -+#endif -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+#ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+ phydm_lna_sat_chk_timers(dm, INIT_LNA_SAT_CHK_TIMMER); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ odm_initialize_timer(dm, &dm->sbdcnt_timer, -+ (void *)phydm_sbd_callback, NULL, "SbdTimer"); -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ odm_initialize_timer(dm, &dm->beamforming_info.txbf_info.txbf_fw_ndpa_timer, -+ (void *)hal_com_txbf_fw_ndpa_timer_callback, NULL, -+ "txbf_fw_ndpa_timer"); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ odm_initialize_timer(dm, &dm->beamforming_info.beamforming_timer, -+ (void *)beamforming_sw_timer_callback, NULL, -+ "beamforming_timer"); -+#endif -+#endif -+} -+ -+void odm_cancel_all_timers(struct dm_struct *dm) -+{ -+#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*/ -+ if (dm->adapter == NULL) -+ return; -+#endif -+ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ odm_ant_div_timers(dm, CANCEL_ANTDIV_TIMMER); -+#endif -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+#ifdef IS_USE_NEW_TDMA -+ phydm_tdma_dig_timers(dm, CANCEL_TDMA_DIG_TIMMER); -+#endif -+#endif -+#ifdef CONFIG_ADAPTIVE_SOML -+ phydm_adaptive_soml_timers(dm, CANCEL_SOML_TIMMER); -+#endif -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+#ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+ phydm_lna_sat_chk_timers(dm, CANCEL_LNA_SAT_CHK_TIMMER); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ odm_cancel_timer(dm, &dm->sbdcnt_timer); -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ odm_cancel_timer(dm, &dm->beamforming_info.txbf_info.txbf_fw_ndpa_timer); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ odm_cancel_timer(dm, &dm->beamforming_info.beamforming_timer); -+#endif -+#endif -+} -+ -+void odm_release_all_timers(struct dm_struct *dm) -+{ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ odm_ant_div_timers(dm, RELEASE_ANTDIV_TIMMER); -+#endif -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+#ifdef IS_USE_NEW_TDMA -+ phydm_tdma_dig_timers(dm, RELEASE_TDMA_DIG_TIMMER); -+#endif -+#endif -+#ifdef CONFIG_ADAPTIVE_SOML -+ phydm_adaptive_soml_timers(dm, RELEASE_SOML_TIMMER); -+#endif -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+#ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+ phydm_lna_sat_chk_timers(dm, RELEASE_LNA_SAT_CHK_TIMMER); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ odm_release_timer(dm, &dm->sbdcnt_timer); -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ odm_release_timer(dm, &dm->beamforming_info.txbf_info.txbf_fw_ndpa_timer); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ odm_release_timer(dm, &dm->beamforming_info.beamforming_timer); -+#endif -+#endif -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+void odm_init_all_threads( -+ struct dm_struct *dm) -+{ -+#ifdef TPT_THREAD -+ k_tpt_task_init(dm->priv); -+#endif -+} -+ -+void odm_stop_all_threads( -+ struct dm_struct *dm) -+{ -+#ifdef TPT_THREAD -+ k_tpt_task_stop(dm->priv); -+#endif -+} -+#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(struct dm_struct *dm) -+{ -+#ifdef CONFIG_DM_RESP_TXAGC -+/* RSSI higher than this value, start to decade TX power */ -+#define DTC_BASE 35 -+ -+/* RSSI lower than this value, start to increase TX power */ -+#define DTC_DWN_BASE (DTC_BASE - 5) -+ -+ /* 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 (dm->rssi_min > DTC_BASE) { -+ /* need to decade the CTS TX power */ -+ sign = 1; -+ for (i = 0; i < ARRAY_SIZE(dtc_table_down); i++) { -+ if (dtc_table_down[i] >= dm->rssi_min || dtc_steps >= 6) -+ break; -+ else -+ dtc_steps++; -+ } -+ } -+#if 0 -+ else if (dm->rssi_min > DTC_DWN_BASE) { -+ /* needs to increase the CTS TX power */ -+ sign = 0; -+ dtc_steps = 1; -+ for (i = 0; i < ARRAY_SIZE(dtc_table_up); i++) { -+ if (dtc_table_up[i] <= dm->rssi_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_write_1byte(dm, 0x06d9, resp_txagc); -+ -+ PHYDM_DBG(dm, ODM_COMP_PWR_TRAIN, -+ "%s rssi_min:%u, set RESP_TXAGC to %s %u\n", __func__, -+ dm->rssi_min, sign ? "minus" : "plus", dtc_steps); -+#endif /* @CONFIG_RESP_TXAGC_ADJUST */ -+} -+ -+#endif /* @#if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ -+ -+/*@<20170126, BB-Kevin>8188F D-CUT DC cancellation and 8821C*/ -+void phydm_dc_cancellation(struct dm_struct *dm) -+{ -+#ifdef PHYDM_DC_CANCELLATION -+ u32 offset_i_hex[PHYDM_MAX_RF_PATH] = {0}; -+ u32 offset_q_hex[PHYDM_MAX_RF_PATH] = {0}; -+ u32 reg_value32[PHYDM_MAX_RF_PATH] = {0}; -+ u8 path = RF_PATH_A; -+ u8 set_result; -+ -+ if (!(dm->support_ic_type & ODM_DC_CANCELLATION_SUPPORT)) -+ return; -+ if ((dm->support_ic_type & ODM_RTL8188F) && -+ dm->cut_version < ODM_CUT_D) -+ return; -+ if ((dm->support_ic_type & ODM_RTL8192F) && -+ dm->cut_version == ODM_CUT_A) -+ return; -+ if (*dm->band_width == CHANNEL_WIDTH_5) -+ return; -+ if (*dm->band_width == CHANNEL_WIDTH_10) -+ return; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "%s ======>\n", __func__); -+ -+ /*@DC_Estimation (only for 2x2 ic now) */ -+ -+ for (path = RF_PATH_A; path < PHYDM_MAX_RF_PATH; path++) { -+ if (path > RF_PATH_A && -+ dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8188F | -+ ODM_RTL8710B | ODM_RTL8721D | -+ ODM_RTL8710C | ODM_RTL8723D)) -+ break; -+ else if (path > RF_PATH_B && -+ dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8192F)) -+ break; -+ if (phydm_stop_ic_trx(dm, PHYDM_SET) == PHYDM_SET_FAIL) { -+ PHYDM_DBG(dm, ODM_COMP_API, "STOP_TRX_FAIL\n"); -+ return; -+ } -+ odm_write_dig(dm, 0x7e); -+ /*@Disable LNA*/ -+ if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8721D | -+ ODM_RTL8710C)) -+ halrf_rf_lna_setting(dm, HALRF_LNA_DISABLE); -+ /*Turn off 3-wire*/ -+ phydm_stop_3_wire(dm, PHYDM_SET); -+ if (dm->support_ic_type & (ODM_RTL8188F | ODM_RTL8723D | -+ ODM_RTL8710B)) { -+ /*set debug port to 0x235*/ -+ if (!phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x235)) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set Debug port Fail\n"); -+ return; -+ } -+ } else if (dm->support_ic_type & (ODM_RTL8721D | -+ ODM_RTL8710C)) { -+ /*set debug port to 0x200*/ -+ if (!phydm_set_bb_dbg_port(dm, DBGPORT_PRI_2, 0x200)) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set Debug port Fail\n"); -+ return; -+ } -+ } else if (dm->support_ic_type & ODM_RTL8821C) { -+ if (!phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x200)) { -+ /*set debug port to 0x200*/ -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set Debug port Fail\n"); -+ return; -+ } -+ phydm_bb_dbg_port_header_sel(dm, 0x0); -+ } else if (dm->support_ic_type & ODM_RTL8822B) { -+ if (path == RF_PATH_A && -+ !phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x200)) { -+ /*set debug port to 0x200*/ -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set Debug port Fail\n"); -+ return; -+ } -+ if (path == RF_PATH_B && -+ !phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x202)) { -+ /*set debug port to 0x200*/ -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set Debug port Fail\n"); -+ return; -+ } -+ phydm_bb_dbg_port_header_sel(dm, 0x0); -+ } else if (dm->support_ic_type & ODM_RTL8192F) { -+ if (path == RF_PATH_A && -+ !phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x235)) { -+ /*set debug port to 0x235*/ -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set Debug port Fail\n"); -+ return; -+ } -+ if (path == RF_PATH_B && -+ !phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x23d)) { -+ /*set debug port to 0x23d*/ -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set Debug port Fail\n"); -+ return; -+ } -+ } -+ -+ /*@disable CCK DCNF*/ -+ odm_set_bb_reg(dm, R_0xa78, MASKBYTE1, 0x0); -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "DC cancellation Begin!!!\n"); -+ -+ phydm_stop_ck320(dm, true); /*stop ck320*/ -+ -+ /* the same debug port both for path-a and path-b*/ -+ reg_value32[path] = phydm_get_bb_dbg_port_val(dm); -+ -+ phydm_stop_ck320(dm, false); /*start ck320*/ -+ -+ phydm_release_bb_dbg_port(dm); -+ /* @Turn on 3-wire*/ -+ phydm_stop_3_wire(dm, PHYDM_REVERT); -+ /* @Enable LNA*/ -+ if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8721D | -+ ODM_RTL8710C)) -+ halrf_rf_lna_setting(dm, HALRF_LNA_ENABLE); -+ -+ odm_write_dig(dm, 0x20); -+ -+ set_result = phydm_stop_ic_trx(dm, PHYDM_REVERT); -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "DC cancellation OK!!!\n"); -+ } -+ -+ /*@DC_Cancellation*/ -+ /*@DC compensation to CCK data path*/ -+ odm_set_bb_reg(dm, R_0xa9c, BIT(20), 0x1); -+ if (dm->support_ic_type & (ODM_RTL8188F | ODM_RTL8723D | -+ ODM_RTL8710B)) { -+ offset_i_hex[0] = (reg_value32[0] & 0xffc0000) >> 18; -+ offset_q_hex[0] = (reg_value32[0] & 0x3ff00) >> 8; -+ -+ /*@Before filling into registers, -+ *offset should be multiplexed (-1) -+ */ -+ offset_i_hex[0] = (offset_i_hex[0] >= 0x200) ? -+ (0x400 - offset_i_hex[0]) : -+ (0x1ff - offset_i_hex[0]); -+ offset_q_hex[0] = (offset_q_hex[0] >= 0x200) ? -+ (0x400 - offset_q_hex[0]) : -+ (0x1ff - offset_q_hex[0]); -+ -+ odm_set_bb_reg(dm, R_0x950, 0x1ff, offset_i_hex[0]); -+ odm_set_bb_reg(dm, R_0x950, 0x1ff0000, offset_q_hex[0]); -+ } else if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B)) { -+ /* Path-a */ -+ offset_i_hex[0] = (reg_value32[0] & 0xffc00) >> 10; -+ offset_q_hex[0] = reg_value32[0] & 0x3ff; -+ -+ /*@Before filling into registers, -+ *offset should be multiplexed (-1) -+ */ -+ offset_i_hex[0] = 0x400 - offset_i_hex[0]; -+ offset_q_hex[0] = 0x400 - offset_q_hex[0]; -+ -+ odm_set_bb_reg(dm, R_0xc10, 0x3c000000, -+ (0x3c0 & offset_i_hex[0]) >> 6); -+ odm_set_bb_reg(dm, R_0xc10, 0xfc00, 0x3f & offset_i_hex[0]); -+ odm_set_bb_reg(dm, R_0xc14, 0x3c000000, -+ (0x3c0 & offset_q_hex[0]) >> 6); -+ odm_set_bb_reg(dm, R_0xc14, 0xfc00, 0x3f & offset_q_hex[0]); -+ -+ /* Path-b */ -+ if (dm->rf_type > RF_1T1R) { -+ offset_i_hex[1] = (reg_value32[1] & 0xffc00) >> 10; -+ offset_q_hex[1] = reg_value32[1] & 0x3ff; -+ -+ /*@Before filling into registers, -+ *offset should be multiplexed (-1) -+ */ -+ offset_i_hex[1] = 0x400 - offset_i_hex[1]; -+ offset_q_hex[1] = 0x400 - offset_q_hex[1]; -+ -+ odm_set_bb_reg(dm, R_0xe10, 0x3c000000, -+ (0x3c0 & offset_i_hex[1]) >> 6); -+ odm_set_bb_reg(dm, R_0xe10, 0xfc00, -+ 0x3f & offset_i_hex[1]); -+ odm_set_bb_reg(dm, R_0xe14, 0x3c000000, -+ (0x3c0 & offset_q_hex[1]) >> 6); -+ odm_set_bb_reg(dm, R_0xe14, 0xfc00, -+ 0x3f & offset_q_hex[1]); -+ } -+ } else if (dm->support_ic_type & (ODM_RTL8192F)) { -+ /* Path-a I:df4[27:18],Q:df4[17:8]*/ -+ offset_i_hex[0] = (reg_value32[0] & 0xffc0000) >> 18; -+ offset_q_hex[0] = (reg_value32[0] & 0x3ff00) >> 8; -+ -+ /*@Before filling into registers, -+ *offset should be multiplexed (-1) -+ */ -+ offset_i_hex[0] = (offset_i_hex[0] >= 0x200) ? -+ (0x400 - offset_i_hex[0]) : -+ (0xff - offset_i_hex[0]); -+ offset_q_hex[0] = (offset_q_hex[0] >= 0x200) ? -+ (0x400 - offset_q_hex[0]) : -+ (0xff - offset_q_hex[0]); -+ /*Path-a I:c10[7:0],Q:c10[15:8]*/ -+ odm_set_bb_reg(dm, R_0xc10, 0xff, offset_i_hex[0]); -+ odm_set_bb_reg(dm, R_0xc10, 0xff00, offset_q_hex[0]); -+ -+ /* Path-b */ -+ if (dm->rf_type > RF_1T1R) { -+ /* @I:df4[27:18],Q:df4[17:8]*/ -+ offset_i_hex[1] = (reg_value32[1] & 0xffc0000) >> 18; -+ offset_q_hex[1] = (reg_value32[1] & 0x3ff00) >> 8; -+ -+ /*@Before filling into registers, -+ *offset should be multiplexed (-1) -+ */ -+ offset_i_hex[1] = (offset_i_hex[1] >= 0x200) ? -+ (0x400 - offset_i_hex[1]) : -+ (0xff - offset_i_hex[1]); -+ offset_q_hex[1] = (offset_q_hex[1] >= 0x200) ? -+ (0x400 - offset_q_hex[1]) : -+ (0xff - offset_q_hex[1]); -+ /*Path-b I:c18[7:0],Q:c18[15:8]*/ -+ odm_set_bb_reg(dm, R_0xc18, 0xff, offset_i_hex[1]); -+ odm_set_bb_reg(dm, R_0xc18, 0xff00, offset_q_hex[1]); -+ } -+ } else if (dm->support_ic_type & (ODM_RTL8721D | ODM_RTL8710C)) { -+ /*judy modified 20180517*/ -+ offset_i_hex[0] = (reg_value32[0] & 0xff80000) >> 19; -+ offset_q_hex[0] = (reg_value32[0] & 0x3fe00) >> 9; -+ -+ if ((offset_i_hex[0] > 0xF && offset_i_hex[0] < 0x1F1) -+ || (offset_q_hex[0] > 0xF && offset_q_hex[0] < 0x1F1)) { -+ /*@Discard outliers*/ -+ offset_i_hex[0] = 0x0; -+ offset_q_hex[0] = 0x0; -+ } else { -+ /*@Before filling into registers, -+ *offset should be multiplexed (-1) -+ */ -+ offset_i_hex[0] = 0x200 - offset_i_hex[0]; -+ offset_q_hex[0] = 0x200 - offset_q_hex[0]; -+ } -+ odm_set_bb_reg(dm, R_0x950, 0x1ff, offset_i_hex[0]); -+ odm_set_bb_reg(dm, R_0x950, 0x1ff0000, offset_q_hex[0]); -+ } -+#endif -+} -+ -+void phydm_receiver_blocking(void *dm_void) -+{ -+#ifdef CONFIG_RECEIVER_BLOCKING -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 chnl = *dm->channel; -+ u8 bw = *dm->band_width; -+ u32 bb_regf0 = odm_get_bb_reg(dm, R_0xf0, 0xf000); -+ -+ if (!(dm->support_ic_type & ODM_RECEIVER_BLOCKING_SUPPORT) || -+ *dm->edcca_mode != PHYDM_EDCCA_ADAPT_MODE) -+ return; -+ -+ if ((dm->support_ic_type & ODM_RTL8188E && bb_regf0 < 8) || -+ dm->support_ic_type & ODM_RTL8192E) { -+ /*@8188E_T version*/ -+ if (dm->consecutive_idlel_time <= 10 || *dm->mp_mode) -+ goto end; -+ -+ if (bw == CHANNEL_WIDTH_20 && chnl == 1) { -+ phydm_nbi_setting(dm, FUNC_ENABLE, chnl, 20, 2410, -+ PHYDM_DONT_CARE); -+ dm->is_rx_blocking_en = true; -+ } else if ((bw == CHANNEL_WIDTH_20) && (chnl == 13)) { -+ phydm_nbi_setting(dm, FUNC_ENABLE, chnl, 20, 2473, -+ PHYDM_DONT_CARE); -+ dm->is_rx_blocking_en = true; -+ } else if (dm->is_rx_blocking_en && chnl != 1 && chnl != 13) { -+ phydm_nbi_enable(dm, FUNC_DISABLE); -+ odm_set_bb_reg(dm, R_0xc40, 0x1f000000, 0x1f); -+ dm->is_rx_blocking_en = false; -+ } -+ return; -+ } else if ((dm->support_ic_type & ODM_RTL8188E && bb_regf0 >= 8)) { -+ /*@8188E_S version*/ -+ if (dm->consecutive_idlel_time <= 10 || *dm->mp_mode) -+ goto end; -+ -+ if (bw == CHANNEL_WIDTH_20 && chnl == 13) { -+ phydm_nbi_setting(dm, FUNC_ENABLE, chnl, 20, 2473, -+ PHYDM_DONT_CARE); -+ dm->is_rx_blocking_en = true; -+ } else if (dm->is_rx_blocking_en && chnl != 13) { -+ phydm_nbi_enable(dm, FUNC_DISABLE); -+ odm_set_bb_reg(dm, R_0xc40, 0x1f000000, 0x1f); -+ dm->is_rx_blocking_en = false; -+ } -+ return; -+ } -+ -+end: -+ if (dm->is_rx_blocking_en) { -+ phydm_nbi_enable(dm, FUNC_DISABLE); -+ odm_set_bb_reg(dm, R_0xc40, 0x1f000000, 0x1f); -+ dm->is_rx_blocking_en = false; -+ } -+#endif -+} -+ -+void phydm_dyn_bw_indication(void *dm_void) -+{ -+#ifdef CONFIG_BW_INDICATION -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 en_auto_bw_th = dm->en_auto_bw_th; -+ -+ if (!(dm->support_ic_type & ODM_DYM_BW_INDICATION_SUPPORT)) -+ return; -+ -+ /*driver decide bw cobime timing*/ -+ if (dm->dis_dym_bw_indication) { -+ if (*dm->dis_dym_bw_indication) -+ return; -+ } -+ -+ /*check for auto bw*/ -+ if (dm->rssi_min <= en_auto_bw_th && dm->is_linked) { -+ phydm_bw_fixed_enable(dm, FUNC_DISABLE); -+ return; -+ } -+ -+ phydm_bw_fixed_setting(dm); -+#endif -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm.h -new file mode 100644 -index 000000000..7ece890b2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm.h -@@ -0,0 +1,1592 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALDMOUTSRC_H__ -+#define __HALDMOUTSRC_H__ -+ -+/*@============================================================*/ -+/*@include files*/ -+/*@============================================================*/ -+/*PHYDM header*/ -+#include "phydm_pre_define.h" -+#include "phydm_features.h" -+#include "phydm_dig.h" -+#ifdef CONFIG_PATH_DIVERSITY -+#include "phydm_pathdiv.h" -+#endif -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+#include "phydm_antdiv.h" -+#endif -+ -+#include "phydm_soml.h" -+ -+#ifdef CONFIG_SMART_ANTENNA -+#include "phydm_smt_ant.h" -+#endif -+#ifdef CONFIG_ANT_DETECTION -+#include "phydm_antdect.h" -+#endif -+#include "phydm_rainfo.h" -+#ifdef CONFIG_DYNAMIC_TX_TWR -+#include "phydm_dynamictxpower.h" -+#endif -+#include "phydm_cfotracking.h" -+#include "phydm_adaptivity.h" -+#include "phydm_dfs.h" -+#include "phydm_ccx.h" -+#include "txbf/phydm_hal_txbf_api.h" -+#if (PHYDM_LA_MODE_SUPPORT) -+#include "phydm_adc_sampling.h" -+#endif -+#ifdef CONFIG_PSD_TOOL -+#include "phydm_psd.h" -+#endif -+#ifdef PHYDM_PRIMARY_CCA -+#include "phydm_primary_cca.h" -+#endif -+#include "phydm_cck_pd.h" -+#include "phydm_rssi_monitor.h" -+#ifdef PHYDM_AUTO_DEGBUG -+#include "phydm_auto_dbg.h" -+#endif -+#include "phydm_math_lib.h" -+#include "phydm_noisemonitor.h" -+#include "phydm_api.h" -+#ifdef PHYDM_POWER_TRAINING_SUPPORT -+#include "phydm_pow_train.h" -+#endif -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+#include "phydm_lna_sat.h" -+#endif -+#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT -+#include "phydm_pmac_tx_setting.h" -+#endif -+#ifdef PHYDM_MP_SUPPORT -+#include "phydm_mp.h" -+#endif -+ -+#ifdef PHYDM_CCK_RX_PATHDIV_SUPPORT -+#include "phydm_cck_rx_pathdiv.h" -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ #include "phydm_beamforming.h" -+#endif -+ -+#ifdef CONFIG_DIRECTIONAL_BF -+#include "phydm_direct_bf.h" -+#endif -+ -+#include "phydm_regtable.h" -+ -+/*@HALRF header*/ -+#include "halrf/halrf_iqk.h" -+#include "halrf/halrf_dpk.h" -+#include "halrf/halrf.h" -+#include "halrf/halrf_powertracking.h" -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ #include "halrf/halphyrf_ap.h" -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ #include "halrf/halphyrf_ce.h" -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ #include "halrf/halphyrf_win.h" -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+ #include "halrf/halphyrf_iot.h" -+#endif -+ -+extern const u16 phy_rate_table[84]; -+ -+/*@============================================================*/ -+/*@Definition */ -+/*@============================================================*/ -+ -+/* Traffic load decision */ -+#define TRAFFIC_NO_TP 0 -+#define TRAFFIC_ULTRA_LOW 1 -+#define TRAFFIC_LOW 2 -+#define TRAFFIC_MID 3 -+#define TRAFFIC_HIGH 4 -+ -+#define NONE 0 -+ -+#if defined(DM_ODM_CE_MAC80211) -+#define MAX_2(x, y) \ -+ __max2(typeof(x), typeof(y), \ -+ x, y) -+#define __max2(t1, t2, x, y) ({ \ -+ t1 m80211_max1 = (x); \ -+ t2 m80211_max2 = (y); \ -+ m80211_max1 > m80211_max2 ? m80211_max1 : m80211_max2; }) -+ -+#define MIN_2(x, y) \ -+ __min2(typeof(x), typeof(y), \ -+ x, y) -+#define __min2(t1, t2, x, y) ({ \ -+ t1 m80211_min1 = (x); \ -+ t2 m80211_min2 = (y); \ -+ m80211_min1 < m80211_min2 ? m80211_min1 : m80211_min2; }) -+ -+#define DIFF_2(x, y) \ -+ __diff2(typeof(x), typeof(y), \ -+ x, y) -+#define __diff2(t1, t2, x, y) ({ \ -+ t1 __d1 = (x); \ -+ t2 __d2 = (y); \ -+ (__d1 >= __d2) ? (__d1 - __d2) : (__d2 - __d1); }) -+#else -+#define MAX_2(_x_, _y_) (((_x_) > (_y_)) ? (_x_) : (_y_)) -+#define MIN_2(_x_, _y_) (((_x_) < (_y_)) ? (_x_) : (_y_)) -+#define DIFF_2(_x_, _y_) ((_x_ >= _y_) ? (_x_ - _y_) : (_y_ - _x_)) -+#endif -+ -+#define IS_GREATER(_x_, _y_) (((_x_) >= (_y_)) ? true : false) -+#define IS_LESS(_x_, _y_) (((_x_) < (_y_)) ? true : false) -+ -+#if defined(DM_ODM_CE_MAC80211) -+#define BYTE_DUPLICATE_2_DWORD(B0) ({ \ -+ u32 __b_dup = (B0);\ -+ (((__b_dup) << 24) | ((__b_dup) << 16) | ((__b_dup) << 8) | (__b_dup));\ -+ }) -+#else -+#define BYTE_DUPLICATE_2_DWORD(B0) \ -+ (((B0) << 24) | ((B0) << 16) | ((B0) << 8) | (B0)) -+#endif -+#define BYTE_2_DWORD(B3, B2, B1, B0) \ -+ (((B3) << 24) | ((B2) << 16) | ((B1) << 8) | (B0)) -+#define BIT_2_BYTE(B3, B2, B1, B0) \ -+ (((B3) << 3) | ((B2) << 2) | ((B1) << 1) | (B0)) -+ -+/*@For cmn sta info*/ -+#if defined(DM_ODM_CE_MAC80211) -+#define is_sta_active(sta) ({ \ -+ struct cmn_sta_info *__sta = (sta); \ -+ ((__sta) && (__sta->dm_ctrl & STA_DM_CTRL_ACTIVE)); \ -+ }) -+ -+#define IS_FUNC_EN(name) ({ \ -+ u8 *__is_func_name = (name); \ -+ (__is_func_name) && (*__is_func_name); \ -+ }) -+#else -+#define is_sta_active(sta) ((sta) && (sta->dm_ctrl & STA_DM_CTRL_ACTIVE)) -+ -+#define IS_FUNC_EN(name) ((name) && (*name)) -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #define PHYDM_WATCH_DOG_PERIOD 1 /*second*/ -+#else -+ #define PHYDM_WATCH_DOG_PERIOD 2 /*second*/ -+#endif -+ -+#define PHY_HIST_SIZE 12 -+#define PHY_HIST_TH_SIZE (PHY_HIST_SIZE - 1) -+ -+#define S_TO_US 1000000 -+ -+/*@============================================================*/ -+/*structure and define*/ -+/*@============================================================*/ -+ -+#define dm_type_by_fw 0 -+#define dm_type_by_driver 1 -+ -+#define HW_IGI_TXINFO_TABLE_SIZE 64 -+ -+#ifdef BB_RAM_SUPPORT -+ -+struct phydm_bb_ram_per_sta { -+ /* @Reg0x1E84 for RAM I/O*/ -+ boolean hw_igi_en; -+ boolean tx_pwr_offset0_en; -+ boolean tx_pwr_offset1_en; -+ /* @ macid from 0 to 63, above 63 => mapping to 63*/ -+ u8 macid_addr; -+ /* @hw_igi value for paths after packet Tx in a period of time*/ -+ u8 hw_igi; -+ /* @tx_pwr_offset0 offset for Tx power index*/ -+ s8 tx_pwr_offset0; -+ s8 tx_pwr_offset1; -+ -+}; -+ -+struct phydm_bb_ram_ctrl { -+ /*@ For 98F/14B/22C/12F, each tx_pwr_ofst step will be 1dB*/ -+ struct phydm_bb_ram_per_sta pram_sta_ctrl[HW_IGI_TXINFO_TABLE_SIZE]; -+ /*------------ For table2 do not set power offset by macid --------*/ -+ /* For type == 2'b10, 0x1e70[22:16] = tx_pwr_offset_reg0, 0x1e70[23] = enable */ -+ boolean tx_pwr_ofst_reg0_en; -+ u8 tx_pwr_ofst_reg0; -+ /* For type == 2'b11, 0x1e70[30:24] = tx_pwr_offset_reg1, 0x1e70[31] = enable */ -+ boolean tx_pwr_ofst_reg1_en; -+ u8 tx_pwr_ofst_reg1; -+ boolean hwigi_watchdog_en; -+ u64 macid_is_linked; -+ u64 hwigi_macid_is_linked; -+}; -+ -+#endif -+ -+struct phydm_phystatus_statistic { -+ /*@[CCK]*/ -+ u32 rssi_cck_sum; -+ u32 rssi_cck_cnt; -+ u32 rssi_beacon_sum[RF_PATH_MEM_SIZE]; -+ u32 rssi_beacon_cnt; -+ #ifdef PHYSTS_3RD_TYPE_SUPPORT -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ u32 rssi_cck_sum_abv_2ss[RF_PATH_MEM_SIZE - 1]; -+ #endif -+ #endif -+ /*@[OFDM]*/ -+ u32 rssi_ofdm_sum[RF_PATH_MEM_SIZE]; -+ u32 rssi_ofdm_cnt; -+ u32 evm_ofdm_sum; -+ u32 snr_ofdm_sum[RF_PATH_MEM_SIZE]; -+ u16 evm_ofdm_hist[PHY_HIST_SIZE]; -+ u16 snr_ofdm_hist[PHY_HIST_SIZE]; -+ /*@[1SS]*/ -+ u32 rssi_1ss_cnt; -+ u32 rssi_1ss_sum[RF_PATH_MEM_SIZE]; -+ u32 evm_1ss_sum; -+ u32 snr_1ss_sum[RF_PATH_MEM_SIZE]; -+ u16 evm_1ss_hist[PHY_HIST_SIZE]; -+ u16 snr_1ss_hist[PHY_HIST_SIZE]; -+ /*@[2SS]*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ u32 rssi_2ss_cnt; -+ u32 rssi_2ss_sum[RF_PATH_MEM_SIZE]; -+ u32 evm_2ss_sum[2]; -+ u32 snr_2ss_sum[RF_PATH_MEM_SIZE]; -+ u16 evm_2ss_hist[2][PHY_HIST_SIZE]; -+ u16 snr_2ss_hist[2][PHY_HIST_SIZE]; -+ #endif -+ /*@[3SS]*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ u32 rssi_3ss_cnt; -+ u32 rssi_3ss_sum[RF_PATH_MEM_SIZE]; -+ u32 evm_3ss_sum[3]; -+ u32 snr_3ss_sum[RF_PATH_MEM_SIZE]; -+ u16 evm_3ss_hist[3][PHY_HIST_SIZE]; -+ u16 snr_3ss_hist[3][PHY_HIST_SIZE]; -+ #endif -+ /*@[4SS]*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ u32 rssi_4ss_cnt; -+ u32 rssi_4ss_sum[RF_PATH_MEM_SIZE]; -+ u32 evm_4ss_sum[4]; -+ u32 snr_4ss_sum[RF_PATH_MEM_SIZE]; -+ u16 evm_4ss_hist[4][PHY_HIST_SIZE]; -+ u16 snr_4ss_hist[4][PHY_HIST_SIZE]; -+ #endif -+#ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ u16 p4_cnt[RF_PATH_MEM_SIZE]; /*phy-sts page4 cnt*/ -+ u16 cn_sum[RF_PATH_MEM_SIZE]; /*condition number*/ -+ u16 cn_hist[RF_PATH_MEM_SIZE][PHY_HIST_SIZE]; -+#endif -+}; -+ -+struct phydm_phystatus_avg { -+ /*@[CCK]*/ -+ u8 rssi_cck_avg; -+ u8 rssi_beacon_avg[RF_PATH_MEM_SIZE]; -+ #ifdef PHYSTS_3RD_TYPE_SUPPORT -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ u8 rssi_cck_avg_abv_2ss[RF_PATH_MEM_SIZE - 1]; -+ #endif -+ #endif -+ /*@[OFDM]*/ -+ u8 rssi_ofdm_avg[RF_PATH_MEM_SIZE]; -+ u8 evm_ofdm_avg; -+ u8 snr_ofdm_avg[RF_PATH_MEM_SIZE]; -+ /*@[1SS]*/ -+ u8 rssi_1ss_avg[RF_PATH_MEM_SIZE]; -+ u8 evm_1ss_avg; -+ u8 snr_1ss_avg[RF_PATH_MEM_SIZE]; -+ /*@[2SS]*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ u8 rssi_2ss_avg[RF_PATH_MEM_SIZE]; -+ u8 evm_2ss_avg[2]; -+ u8 snr_2ss_avg[RF_PATH_MEM_SIZE]; -+ #endif -+ /*@[3SS]*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ u8 rssi_3ss_avg[RF_PATH_MEM_SIZE]; -+ u8 evm_3ss_avg[3]; -+ u8 snr_3ss_avg[RF_PATH_MEM_SIZE]; -+ #endif -+ /*@[4SS]*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ u8 rssi_4ss_avg[RF_PATH_MEM_SIZE]; -+ u8 evm_4ss_avg[4]; -+ u8 snr_4ss_avg[RF_PATH_MEM_SIZE]; -+ #endif -+}; -+ -+struct odm_phy_dbg_info { -+ /*@ODM Write,debug info*/ -+ u32 num_qry_phy_status_cck; -+ u32 num_qry_phy_status_ofdm; -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) || (defined(PHYSTS_3RD_TYPE_SUPPORT)) -+ u32 num_qry_mu_pkt; -+ u32 num_qry_bf_pkt; -+ u16 num_mu_vht_pkt[VHT_RATE_NUM]; -+ boolean is_ldpc_pkt; -+ boolean is_stbc_pkt; -+ u8 num_of_ppdu[4]; -+ u8 gid_num[4]; -+#endif -+ u32 condi_num; /*@condition number U(18,4)*/ -+ u8 condi_num_cdf[CN_CNT_MAX]; -+ u8 num_qry_beacon_pkt; -+ u8 beacon_cnt_in_period; /*@beacon cnt within watchdog period*/ -+ u8 beacon_phy_rate; -+ u8 show_phy_sts_all_pkt; /*@Show phy status witch not match BSSID*/ -+ u16 show_phy_sts_max_cnt; /*@show number of phy-status row data per PHYDM watchdog*/ -+ u16 show_phy_sts_cnt; -+ u16 num_qry_legacy_pkt[LEGACY_RATE_NUM]; -+ u16 num_qry_ht_pkt[HT_RATE_NUM]; -+ u16 num_qry_pkt_sc_20m[LOW_BW_RATE_NUM]; /*@20M SC*/ -+ boolean ht_pkt_not_zero; -+ boolean low_bw_20_occur; -+ #if ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT) -+ u16 num_qry_vht_pkt[VHT_RATE_NUM]; -+ u16 num_qry_pkt_sc_40m[LOW_BW_RATE_NUM]; /*@40M SC*/ -+ boolean vht_pkt_not_zero; -+ boolean low_bw_40_occur; -+ #endif -+ u16 snr_hist_th[PHY_HIST_TH_SIZE]; -+ u16 evm_hist_th[PHY_HIST_TH_SIZE]; -+ #ifdef PHYSTS_3RD_TYPE_SUPPORT -+ u16 cn_hist_th[PHY_HIST_TH_SIZE]; /*U(16,1)*/ -+ u8 condition_num_seg0; -+ u8 eigen_val[4]; -+ s16 cfo_tail[4]; /*per-path's cfo_tail */ -+ #endif -+ struct phydm_phystatus_statistic physts_statistic_info; -+ struct phydm_phystatus_avg phystatus_statistic_avg; -+}; -+ -+enum odm_cmninfo { -+ /*@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_FW_VER, -+ ODM_CMNINFO_FW_SUB_VER, -+ ODM_CMNINFO_RF_TYPE, -+ ODM_CMNINFO_RFE_TYPE, -+ ODM_CMNINFO_DPK_EN, -+ 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_TDMA, -+ 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_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, -+ ODM_CMNINFO_VALID_PATH_SET, -+ ODM_CMNINFO_EFUSE0X3D8, -+ ODM_CMNINFO_EFUSE0X3D7, -+ ODM_CMNINFO_SOFT_AP_SPECIAL_SETTING, -+ ODM_CMNINFO_X_CAP_SETTING, -+ ODM_CMNINFO_ADVANCE_OTA, -+ ODM_CMNINFO_HP_HWID, -+ ODM_CMNINFO_HUAWEI_HWID, -+ ODM_CMNINFO_ATHEROS_HWID, -+ ODM_CMNINFO_TSSI_ENABLE, /*also for cmn_info_update*/ -+ ODM_CMNINFO_DIS_DPD, -+ ODM_CMNINFO_POWER_VOLTAGE, -+ ODM_CMNINFO_ANTDIV_GPIO, -+ ODM_CMNINFO_EN_AUTO_BW_TH, -+ ODM_CMNINFO_PEAK_DETECT_MODE, -+ ODM_CMNINFO_EN_NBI_DETECT, -+ /*@-----------HOOK BEFORE REG INIT-----------*/ -+ -+ /*@Dynamic value:*/ -+ -+ /*@--------- POINTER REFERENCE-----------*/ -+ ODM_CMNINFO_TX_UNI, -+ ODM_CMNINFO_RX_UNI, -+ 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_PATH_DIV, -+ ODM_CMNINFO_ADAPTIVE_SOML, -+ ODM_CMNINFO_ADAPTIVITY, -+ 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_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, -+ ODM_CMNINFO_SOFT_AP_MODE, -+ ODM_CMNINFO_MP_MODE, -+ ODM_CMNINFO_INTERRUPT_MASK, -+ ODM_CMNINFO_BB_OPERATION_MODE, -+ ODM_CMNINFO_BF_ANTDIV_DECISION, -+ ODM_CMNINFO_MANUAL_SUPPORTABILITY, -+ ODM_CMNINFO_EN_DYM_BW_INDICATION, -+ ODM_ANTI_INTERFERENCE_EN, -+ /*@--------- POINTER REFERENCE-----------*/ -+ -+ /*@------------CALL BY VALUE-------------*/ -+ ODM_CMNINFO_WIFI_DIRECT, -+ ODM_CMNINFO_WIFI_DISPLAY, -+ ODM_CMNINFO_LINK_IN_PROGRESS, -+ ODM_CMNINFO_LINK, -+ ODM_CMNINFO_CMW500LINK, -+ ODM_CMNINFO_STATION_STATE, -+ ODM_CMNINFO_RSSI_MIN, -+ ODM_CMNINFO_RSSI_MIN_BY_PATH, -+ ODM_CMNINFO_DBG_COMP, -+ ODM_CMNINFO_RA_THRESHOLD_HIGH, /*to be removed*/ -+ ODM_CMNINFO_RA_THRESHOLD_LOW, /*to be removed*/ -+ 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_AP_TOTAL_NUM, -+ ODM_CMNINFO_POWER_TRAINING, -+ ODM_CMNINFO_DFS_REGION_DOMAIN, -+ ODM_CMNINFO_BT_CONTINUOUS_TURN, -+ ODM_CMNINFO_IS_DOWNLOAD_FW, -+ ODM_CMNINFO_PHYDM_PATCH_ID, -+ ODM_CMNINFO_RRSR_VAL, -+ ODM_CMNINFO_LINKED_BF_SUPPORT, -+ ODM_CMNINFO_FLATNESS_TYPE, -+ /*@------------CALL BY VALUE-------------*/ -+ -+ /*@Dynamic ptr array hook itms.*/ -+ ODM_CMNINFO_STA_STATUS, -+ ODM_CMNINFO_MAX, -+ -+}; -+ -+enum phydm_rfe_bb_source_sel { -+ PAPE_2G = 0, -+ PAPE_5G = 1, -+ LNA0N_2G = 2, -+ LNAON_5G = 3, -+ TRSW = 4, -+ TRSW_B = 5, -+ GNT_BT = 6, -+ ZERO = 7, -+ ANTSEL_0 = 8, -+ ANTSEL_1 = 9, -+ ANTSEL_2 = 0xa, -+ ANTSEL_3 = 0xb, -+ ANTSEL_4 = 0xc, -+ ANTSEL_5 = 0xd, -+ ANTSEL_6 = 0xe, -+ ANTSEL_7 = 0xf -+}; -+ -+enum phydm_info_query { -+ 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_CRC32_OK_HT_AGG, -+ PHYDM_INFO_CRC32_ERROR_HT_AGG, -+ PHYDM_INFO_DBG_PORT_0, -+ PHYDM_INFO_CURR_IGI, -+ PHYDM_INFO_RSSI_MIN, -+ PHYDM_INFO_RSSI_MAX, -+ PHYDM_INFO_CLM_RATIO, -+ PHYDM_INFO_NHM_RATIO, -+ PHYDM_INFO_NHM_NOISE_PWR, -+ PHYDM_INFO_NHM_PWR, -+ PHYDM_INFO_NHM_ENV_RATIO, -+ PHYDM_INFO_TXEN_CCK, -+ PHYDM_INFO_TXEN_OFDM, -+ PHYDM_INFO_NHM_IDLE_RATIO, -+ PHYDM_INFO_NHM_TX_RATIO, -+}; -+ -+enum phydm_api { -+ PHYDM_API_NBI = 1, -+ PHYDM_API_CSI_MASK = 2, -+}; -+ -+enum phydm_func_idx { /*@F_XXX = PHYDM XXX function*/ -+ -+ F00_DIG = 0, -+ F01_RA_MASK = 1, -+ F02_DYN_TXPWR = 2, -+ F03_FA_CNT = 3, -+ F04_RSSI_MNTR = 4, -+ F05_CCK_PD = 5, -+ F06_ANT_DIV = 6, -+ F07_SMT_ANT = 7, -+ F08_PWR_TRAIN = 8, -+ F09_RA = 9, -+ F10_PATH_DIV = 10, -+ F11_DFS = 11, -+ F12_DYN_ARFR = 12, -+ F13_ADPTVTY = 13, -+ F14_CFO_TRK = 14, -+ F15_ENV_MNTR = 15, -+ F16_PRI_CCA = 16, -+ F17_ADPTV_SOML = 17, -+ F18_LNA_SAT_CHK = 18, -+}; -+ -+/*@=[PHYDM supportability]==========================================*/ -+enum odm_ability { -+ ODM_BB_DIG = BIT(F00_DIG), -+ ODM_BB_RA_MASK = BIT(F01_RA_MASK), -+ ODM_BB_DYNAMIC_TXPWR = BIT(F02_DYN_TXPWR), -+ ODM_BB_FA_CNT = BIT(F03_FA_CNT), -+ ODM_BB_RSSI_MONITOR = BIT(F04_RSSI_MNTR), -+ ODM_BB_CCK_PD = BIT(F05_CCK_PD), -+ ODM_BB_ANT_DIV = BIT(F06_ANT_DIV), -+ ODM_BB_SMT_ANT = BIT(F07_SMT_ANT), -+ ODM_BB_PWR_TRAIN = BIT(F08_PWR_TRAIN), -+ ODM_BB_RATE_ADAPTIVE = BIT(F09_RA), -+ ODM_BB_PATH_DIV = BIT(F10_PATH_DIV), -+ ODM_BB_DFS = BIT(F11_DFS), -+ ODM_BB_DYNAMIC_ARFR = BIT(F12_DYN_ARFR), -+ ODM_BB_ADAPTIVITY = BIT(F13_ADPTVTY), -+ ODM_BB_CFO_TRACKING = BIT(F14_CFO_TRK), -+ ODM_BB_ENV_MONITOR = BIT(F15_ENV_MNTR), -+ ODM_BB_PRIMARY_CCA = BIT(F16_PRI_CCA), -+ ODM_BB_ADAPTIVE_SOML = BIT(F17_ADPTV_SOML), -+ ODM_BB_LNA_SAT_CHK = BIT(F18_LNA_SAT_CHK), -+}; -+ -+/*@=[PHYDM Debug Component]=====================================*/ -+enum phydm_dbg_comp { -+ /*@BB Driver Functions*/ -+ DBG_DIG = BIT(F00_DIG), -+ DBG_RA_MASK = BIT(F01_RA_MASK), -+ DBG_DYN_TXPWR = BIT(F02_DYN_TXPWR), -+ DBG_FA_CNT = BIT(F03_FA_CNT), -+ DBG_RSSI_MNTR = BIT(F04_RSSI_MNTR), -+ DBG_CCKPD = BIT(F05_CCK_PD), -+ DBG_ANT_DIV = BIT(F06_ANT_DIV), -+ DBG_SMT_ANT = BIT(F07_SMT_ANT), -+ DBG_PWR_TRAIN = BIT(F08_PWR_TRAIN), -+ DBG_RA = BIT(F09_RA), -+ DBG_PATH_DIV = BIT(F10_PATH_DIV), -+ DBG_DFS = BIT(F11_DFS), -+ DBG_DYN_ARFR = BIT(F12_DYN_ARFR), -+ DBG_ADPTVTY = BIT(F13_ADPTVTY), -+ DBG_CFO_TRK = BIT(F14_CFO_TRK), -+ DBG_ENV_MNTR = BIT(F15_ENV_MNTR), -+ DBG_PRI_CCA = BIT(F16_PRI_CCA), -+ DBG_ADPTV_SOML = BIT(F17_ADPTV_SOML), -+ DBG_LNA_SAT_CHK = BIT(F18_LNA_SAT_CHK), -+ /*Neet to re-arrange*/ -+ DBG_PHY_STATUS = BIT(20), -+ DBG_TMP = BIT(21), -+ DBG_FW_TRACE = BIT(22), -+ DBG_TXBF = BIT(23), -+ DBG_COMMON_FLOW = BIT(24), -+ DBG_COMP_MCC = BIT(25), -+ DBG_FW_DM = BIT(26), -+ DBG_DM_SUMMARY = BIT(27), -+ ODM_PHY_CONFIG = BIT(28), -+ ODM_COMP_INIT = BIT(29), -+ DBG_CMN = BIT(30),/*@common*/ -+ ODM_COMP_API = BIT(31) -+}; -+ -+/*@=========================================================*/ -+ -+/*@ODM_CMNINFO_ONE_PATH_CCA*/ -+enum odm_cca_path { -+ ODM_CCA_2R = 0, -+ ODM_CCA_1R_A = 1, -+ ODM_CCA_1R_B = 2, -+}; -+ -+enum phy_reg_pg_type { -+ PHY_REG_PG_RELATIVE_VALUE = 0, -+ PHY_REG_PG_EXACT_VALUE = 1 -+}; -+ -+enum phydm_offload_ability { -+ PHYDM_PHY_PARAM_OFFLOAD = BIT(0), -+ PHYDM_RF_IQK_OFFLOAD = BIT(1), -+ PHYDM_RF_DPK_OFFLOAD = BIT(2), -+}; -+ -+enum phydm_init_result { -+ PHYDM_INIT_SUCCESS = 0, -+ PHYDM_INIT_FAIL_BBRF_REG_INVALID = 1 -+}; -+ -+struct phydm_pause_lv { -+ s8 lv_dig; -+ s8 lv_cckpd; -+ s8 lv_antdiv; -+ s8 lv_adapt; -+ s8 lv_adsl; -+}; -+ -+struct phydm_func_poiner { -+ void (*pause_phydm_handler)(void *dm_void, u32 *val_buf, u8 val_len); -+}; -+ -+struct pkt_process_info { -+ #ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ /*@send phystatus in each sampling time*/ -+ boolean physts_auto_swch_en; -+ u8 mac_ppdu_cnt; -+ u8 phy_ppdu_cnt; /*change with phy cca cnt*/ -+ u8 page_bitmap_target; -+ u8 page_bitmap_record; -+ u8 ppdu_phy_rate; -+ u8 ppdu_macid; -+ boolean is_1st_mpdu; -+ #endif -+ u8 lna_idx; -+ u8 vga_idx; -+}; -+ -+#ifdef ODM_CONFIG_BT_COEXIST -+struct phydm_bt_info { -+ boolean is_bt_enabled; /*@BT is enabled*/ -+ boolean is_bt_connect_process; /*@BT HS is under connection progress.*/ -+ u8 bt_hs_rssi; /*@BT HS mode wifi rssi value.*/ -+ boolean is_bt_hs_operation; /*@BT HS mode is under progress*/ -+ boolean is_bt_limited_dig; /*@BT is busy.*/ -+}; -+#endif -+ -+struct phydm_iot_center { -+ boolean is_linked_cmw500; -+ u8 win_patch_id; /*Customer ID*/ -+ boolean patch_id_100f0401; -+ boolean patch_id_10120200; -+ boolean patch_id_40010700; -+ boolean patch_id_021f0800; -+ boolean patch_id_011f0500; -+ u32 phydm_patch_id; /*temp for CCX IOT */ -+}; -+ -+#if (RTL8822B_SUPPORT) -+struct drp_rtl8822b_struct { -+ enum bb_path path_judge; -+ u16 path_a_cck_fa; -+ u16 path_b_cck_fa; -+}; -+#endif -+ -+#ifdef CONFIG_MCC_DM -+#define MCC_DM_REG_NUM 32 -+struct _phydm_mcc_dm_ { -+ u8 mcc_pre_status; -+ u8 mcc_reg_id[MCC_DM_REG_NUM]; -+ u16 mcc_dm_reg[MCC_DM_REG_NUM]; -+ u8 mcc_dm_val[MCC_DM_REG_NUM][2]; -+ /*mcc DIG*/ -+ u8 mcc_rssi[2]; -+ /*u8 mcc_igi[2];*/ -+ -+ /* need to be config by driver*/ -+ u8 mcc_status; -+ u8 sta_macid[2][NUM_STA]; -+ u16 mcc_rf_ch[2]; -+ -+}; -+#endif -+ -+#if (RTL8822C_SUPPORT || RTL8812F_SUPPORT || RTL8197G_SUPPORT || RTL8723F_SUPPORT) -+struct phydm_physts { -+ u8 cck_gi_u_bnd; -+ u8 cck_gi_l_bnd; -+}; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #if (RT_PLATFORM != PLATFORM_LINUX) -+ typedef -+ #endif -+ -+struct dm_struct { -+#else/*for AP, CE Team*/ -+struct dm_struct { -+#endif -+ /*@Add for different team use temporarily*/ -+ void *adapter; /*@For CE/NIC team*/ -+ struct rtl8192cd_priv *priv; /*@For AP team*/ -+ boolean odm_ready; -+ enum phy_reg_pg_type phy_reg_pg_value_type; -+ u8 phy_reg_pg_version; -+ u64 support_ability; /*@PHYDM function Supportability*/ -+ u64 pause_ability; /*@PHYDM function pause Supportability*/ -+ u64 debug_components; -+ u8 cmn_dbg_msg_period; -+ u8 cmn_dbg_msg_cnt; -+ u32 fw_debug_components; -+ u32 num_qry_phy_status_all; /*@CCK + OFDM*/ -+ u32 last_num_qry_phy_status_all; -+ u32 rx_pwdb_ave; -+ boolean is_init_hw_info_by_rfe; -+ boolean is_R2R_CCA_MASKT_TIME_SHORT; -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ u32 rts_drop_cnt; -+ u32 low_rate_tx_fail_cnt; -+ u32 low_rate_tx_ok_cnt; -+#endif -+ -+ //TSSI -+ u8 en_tssi_mode; -+ #if (RTL8723F_SUPPORT) -+ //ZWDFS for 80M -+ u8 en_zwdfs_bw80; -+ #endif -+ -+ /*@------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ -+ boolean is_cck_high_power; -+ u8 rf_path_rx_enable; -+ /*@------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ -+ -+ /* @COMMON INFORMATION */ -+ -+ /*@Init value*/ -+ /*@-----------HOOK BEFORE REG INIT-----------*/ -+ -+ u8 support_platform; /*@PHYDM Platform info WIN/AP/CE = 1/2/3 */ -+ u8 normal_rx_path; -+ u8 valid_path_set; /*@use for single rx path only*/ -+ boolean brxagcswitch; /* @for rx AGC table switch in Microsoft case */ -+ u8 support_interface; /*@PHYDM PCIE/USB/SDIO = 1/2/3*/ -+ u32 support_ic_type; /*@PHYDM supported IC*/ -+ enum phydm_api_host run_in_drv_fw; /*@PHYDM API is using in FW or Driver*/ -+ u8 ic_ip_series; /*N/AC/JGR3*/ -+ enum phydm_phy_sts_type ic_phy_sts_type; /*@Type1/type2/type3*/ -+ u8 cut_version; /*@cut version TestChip/A-cut/B-cut... = 0/1/2/3/...*/ -+ u8 fab_version; /*@Fab version TSMC/UMC = 0/1*/ -+ u8 fw_version; -+ u8 fw_sub_version; -+ u8 rf_type; /*@RF type 4T4R/3T3R/2T2R/1T2R/1T1R/...*/ -+ u8 rfe_type; -+ u8 board_type; -+ u8 package_type; -+ u16 type_glna; -+ u16 type_gpa; -+ u16 type_alna; -+ u16 type_apa; -+ u8 ext_lna; /*@with 2G external LNA NO/Yes = 0/1*/ -+ u8 ext_lna_5g; /*@with 5G external LNA NO/Yes = 0/1*/ -+ u8 ext_pa; /*@with 2G external PNA NO/Yes = 0/1*/ -+ u8 ext_pa_5g; /*@with 5G external PNA NO/Yes = 0/1*/ -+ u8 efuse0x3d7; /*@with Efuse number*/ -+ u8 efuse0x3d8; -+ u8 ext_trsw; /*@with external TRSW NO/Yes = 0/1*/ -+ u8 ext_lna_gain; /*@gain of external lna*/ -+ boolean is_in_hct_test; -+ u8 wifi_test; -+ boolean is_dual_mac_smart_concurrent; -+ u32 bk_support_ability; /*SD4 only*/ -+ u8 with_extenal_ant_switch; -+ /*@cck agc relative*/ -+ boolean cck_new_agc; -+ s8 cck_lna_gain_table[8]; -+ u8 cck_sat_cnt_th_init; -+ /*@-------------------------------------*/ -+ u32 phydm_sys_up_time; -+ u8 num_rf_path; /*@ex: 8821C=1, 8192E=2, 8814B=4*/ -+ u32 soft_ap_special_setting; -+ boolean boolean_dummy; -+ s8 s8_dummy; -+ u8 u8_dummy; -+ u16 u16_dummy; -+ u32 u32_dummy; -+ u8 rfe_hwsetting_band; -+ u8 p_advance_ota; -+ boolean hp_hw_id; -+ boolean BOOLEAN_temp; -+ boolean is_dfs_band; -+ u8 is_rx_blocking_en; -+ u16 fw_offload_ability; -+ boolean is_download_fw; -+ boolean en_dis_dpd; -+ u16 dis_dpd_rate; -+ u8 en_auto_bw_th; -+ boolean is_pause_dig; -+ boolean en_nbi_detect; -+ #if (RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8197G_SUPPORT) -+ u8 txagc_buff[RF_PATH_MEM_SIZE][PHY_NUM_RATE_IDX]; -+ u32 bp_0x9b0; -+ #elif (RTL8723F_SUPPORT) -+ u8 txagc_buff[2][PHY_NUM_RATE_IDX]; -+ u32 bp_0x9b0; -+ #endif -+ #if (RTL8822C_SUPPORT || RTL8723F_SUPPORT) -+ u8 ofdm_rxagc_l_bnd[16]; -+ boolean l_bnd_detect[16]; -+ u16 agc_rf_gain_ori[16][64];/*[table][mp_gain_idx]*/ -+ u16 agc_rf_gain[16][64];/*[table][mp_gain_idx]*/ -+ u8 agc_table_cnt; -+ boolean is_agc_tab_pos_shift; -+ u8 agc_table_shift; -+ #endif -+/*@-----------HOOK BEFORE REG INIT-----------*/ -+/*@===========================================================*/ -+/*@====[ CALL BY Reference ]=========================================*/ -+/*@===========================================================*/ -+ -+ u64 *num_tx_bytes_unicast; /*@TX Unicast byte cnt*/ -+ u64 *num_rx_bytes_unicast; /*@RX Unicast byte cnt*/ -+ u8 *band_type; /*@2.4G/5G = 0/1*/ -+ u8 *sec_ch_offset; /*@Secondary channel offset don't_care/below/above = 0/1/2*/ -+ u8 *security; /*@security mode Open/WEP/AES/TKIP = 0/1/2/3*/ -+ u8 *band_width; /*@20M/40M/80M = 0/1/2*/ -+ u8 *channel; /*@central CH number*/ -+ boolean *is_scan_in_process; -+ boolean *is_power_saving; -+ boolean *is_tdma; -+ u8 *one_path_cca; /*@CCA path 2-path/path-A/path-B = 0/1/2; using enum odm_cca_path.*/ -+ u8 *antenna_test; -+ boolean *is_net_closed; -+ boolean *is_fcs_mode_enable; /*@fast channel switch (= MCC mode)*/ -+ /*@--------- For 8723B IQK-------------------------------------*/ -+ boolean *is_1_antenna; -+ u8 *rf_default_path; /* @0:S1, 1:S0 */ -+ /*@-----------------------------------------------------------*/ -+ -+ u16 *forced_data_rate; -+ u8 *enable_antdiv; -+ u8 *enable_pathdiv; -+ u8 *en_adap_soml; -+ u8 *edcca_mode; -+ u8 *hub_usb_mode; /*@1:USB2.0, 2:USB3.0*/ -+ boolean *is_fw_dw_rsvd_page_in_progress; -+ u32 *current_tx_tp; -+ u32 *current_rx_tp; -+ u8 *sounding_seq; -+ u32 *soft_ap_mode; -+ u8 *mp_mode; -+ u32 *interrupt_mask; -+ u8 *bb_op_mode; -+ u32 *manual_supportability; -+ u8 *dis_dym_bw_indication; -+ u8 *anti_interference_en; -+/*@===========================================================*/ -+/*@====[ CALL BY VALUE ]===========================================*/ -+/*@===========================================================*/ -+ -+ u8 disable_phydm_watchdog; -+ boolean is_link_in_process; -+ boolean is_wifi_direct; -+ boolean is_wifi_display; -+ boolean is_linked; -+ boolean pre_is_linked; -+ boolean first_connect; -+ boolean first_disconnect; -+ boolean bsta_state; -+ u8 rssi_min; -+ u8 rssi_min_macid; -+ u8 pre_rssi_min; -+ u8 rssi_max; -+ u8 rssi_max_macid; -+ u8 rssi_min_by_path; -+ boolean is_mp_chip; -+ boolean is_one_entry_only; -+ u32 one_entry_macid; -+ u32 one_entry_tp; -+ u32 pre_one_entry_tp; -+ u8 pre_number_linked_client; -+ u8 number_linked_client; -+ u8 pre_number_active_client; -+ u8 number_active_client; -+ boolean is_disable_phy_api; -+ u8 rssi_a; -+ u8 rssi_b; -+ u8 rssi_c; -+ u8 rssi_d; -+ s8 rxsc_80; -+ s8 rxsc_40; -+ s8 rxsc_20; -+ s8 rxsc_l; -+ u64 rssi_trsw; -+ u64 rssi_trsw_h; -+ u64 rssi_trsw_l; -+ u64 rssi_trsw_iso; -+ u8 tx_ant_status; /*TX path enable*/ -+ u8 rx_ant_status; /*RX path enable*/ -+ #ifdef PHYDM_COMPILE_ABOVE_4SS -+ enum bb_path tx_4ss_status; /*@Use N-X for 4STS rate*/ -+ #endif -+ #ifdef PHYDM_COMPILE_ABOVE_3SS -+ enum bb_path tx_3ss_status; /*@Use N-X for 3STS rate*/ -+ #endif -+ #ifdef PHYDM_COMPILE_ABOVE_2SS -+ enum bb_path tx_2ss_status; /*@Use N-X for 2STS rate*/ -+ #endif -+ enum bb_path tx_1ss_status; /*@Use N-X for 1STS rate*/ -+ u8 cck_lna_idx; -+ u8 cck_vga_idx; -+ u8 curr_station_id; -+ u8 ofdm_agc_idx[4]; -+ u8 rx_rate; -+ u8 rate_ss; -+ u8 tx_rate; -+ u8 linked_interval; -+ u8 pre_channel; -+ u32 txagc_offset_value_a; -+ boolean is_txagc_offset_positive_a; -+ u32 txagc_offset_value_b; -+ boolean is_txagc_offset_positive_b; -+ u8 ap_total_num; -+ boolean flatness_type; -+ /*@[traffic]*/ -+ u8 traffic_load; -+ u8 pre_traffic_load; -+ u32 tx_tp; /*@Mbps*/ -+ u32 rx_tp; /*@Mbps*/ -+ u32 total_tp; /*@Mbps*/ -+ u8 txrx_state_all; /*@0:tx, 1:rx, 2:bi-dir*/ -+ u64 cur_tx_ok_cnt; -+ u64 cur_rx_ok_cnt; -+ u64 last_tx_ok_cnt; -+ u64 last_rx_ok_cnt; -+ u16 consecutive_idlel_time; /*@unit: second*/ -+ /*@---------------------------*/ -+ boolean is_bb_swing_offset_positive_a; -+ boolean is_bb_swing_offset_positive_b; -+ -+ /*@[DIG]*/ -+ boolean MPDIG_2G; /*off MPDIG*/ -+ u8 times_2g; /*@for MP DIG*/ -+ u8 force_igi; /*@for debug*/ -+ boolean is_dig_low_bond; -+ -+ /*@[TDMA-DIG]*/ -+ u8 tdma_dig_timer_ms; -+ u8 tdma_dig_state_number; -+ u8 tdma_dig_low_upper_bond; -+ u8 force_tdma_low_igi; -+ u8 force_tdma_high_igi; -+ u8 fix_expire_to_zero; -+ boolean original_dig_restore; -+ /*@---------------------------*/ -+ -+ /*@[AntDiv]*/ -+ u8 ant_div_type; -+ u8 antdiv_rssi; -+ u8 fat_comb_a; -+ u8 fat_comb_b; -+ u8 antdiv_intvl; -+ u8 antdiv_delay; -+ u8 ant_type; -+ u8 ant_type2; -+ u8 pre_ant_type; -+ u8 pre_ant_type2; -+ u8 antdiv_period; -+ u8 evm_antdiv_period; -+ u8 antdiv_select; -+ u8 antdiv_train_num; /*@training time for each antenna in EVM method*/ -+ u8 stop_antdiv_rssi_th; -+ u16 stop_antdiv_tp_diff_th; -+ u16 stop_antdiv_tp_th; -+ u8 antdiv_tp_period; -+ u16 tp_active_th; -+ u8 tp_active_occur; -+ u8 path_select; -+ u8 antdiv_evm_en; -+ u8 bdc_holdstate; -+ u8 antdiv_counter; -+ /*@---------------------------*/ -+ -+ u8 ndpa_period; -+ boolean h2c_rarpt_connect; -+ boolean cck_agc_report_type; /*@1:4bit LNA, 0:3bit LNA */ -+ u8 print_agc; -+ u8 la_mode; -+ /*@---8821C Antenna and RF Set BTG/WLG/WLA Select---------------*/ -+ u8 current_rf_set_8821c; -+ u8 default_rf_set_8821c; -+ u8 current_ant_num_8821c; -+ u8 default_ant_num_8821c; -+ u8 rfe_type_expand; -+ /*@-----------------------------------------------------------*/ -+ /*@---For Adaptivtiy---------------------------------------------*/ -+ s8 TH_L2H_default; -+ s8 th_edcca_hl_diff_default; -+ s8 th_l2h_ini; -+ s8 th_edcca_hl_diff; -+ boolean carrier_sense_enable; -+ /*@-----------------------------------------------------------*/ -+ u8 pre_dbg_priority; -+ u8 nbi_set_result; -+ u8 c2h_cmd_start; -+ u8 fw_debug_trace[60]; -+ u8 pre_c2h_seq; -+ boolean fw_buff_is_enpty; -+ u32 data_frame_num; -+ /*@--- for spur detection ---------------------------------------*/ -+ boolean en_reg_mntr_bb; -+ boolean en_reg_mntr_rf; -+ boolean en_reg_mntr_mac; -+ boolean en_reg_mntr_byte; -+ /*@--------------------------------------------------------------*/ -+#if (RTL8814B_SUPPORT || RTL8812F_SUPPORT || RTL8198F_SUPPORT) -+ u8 dsde_sel; -+ u8 nbi_path_sel; -+ u8 csi_wgt; -+#endif -+#if (RTL8814B_SUPPORT || RTL8198F_SUPPORT) -+ u8 csi_wgt_th_db[5]; /*@wgt 4,3,2,1,0 */ -+ /* ^ ^ ^ ^ ^ */ -+#endif -+ /*@------------------------------------------*/ -+ -+ /*@--- for noise detection ---------------------------------------*/ -+ boolean is_noisy_state; -+ boolean noisy_decision; /*@b_noisy*/ -+ boolean pre_b_noisy; -+ u32 noisy_decision_smooth; -+ /*@-----------------------------------------------------------*/ -+ -+ /*@--- for MCC ant weighting ------------------------------------*/ -+ boolean is_stop_dym_ant_weighting; -+ /*@-----------------------------------------------------------*/ -+ -+ boolean is_disable_dym_ecs; -+ boolean is_disable_dym_ant_weighting; -+ struct cmn_sta_info *phydm_sta_info[ODM_ASSOCIATE_ENTRY_NUM]; -+ u8 phydm_macid_table[ODM_ASSOCIATE_ENTRY_NUM];/*@sta_idx = phydm_macid_table[HW_macid]*/ -+ -+#if (RATE_ADAPTIVE_SUPPORT) -+ u16 currmin_rpt_time; -+ struct _phydm_txstatistic_ hw_stats; -+ struct _odm_ra_info_ ra_info[ODM_ASSOCIATE_ENTRY_NUM]; -+/*Use mac_id as array index. STA mac_id=0*/ -+/*VWiFi Client mac_id={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 ra_support88e; -+ boolean *is_driver_stopped; -+ boolean *is_driver_is_going_to_pnp_set_power_sleep; -+ boolean *pinit_adpt_in_progress; -+ boolean is_user_assign_level; -+ u8 RSSI_BT; /*@come from BT*/ -+ -+ /*@---PSD Relative ---------------------------------------------*/ -+ boolean is_psd_in_process; -+ boolean is_psd_active; -+ /*@-----------------------------------------------------------*/ -+ -+ boolean bsomlenabled; /* @D-SoML control */ -+ u8 no_ndp_cnts; -+ u16 ndp_cnt_pre; -+ boolean is_beamformed; -+ u8 linked_bf_support; -+ boolean bhtstfdisabled; /* @dynamic HTSTF gain control*/ -+ u32 n_iqk_cnt; -+ u32 n_iqk_ok_cnt; -+ u32 n_iqk_fail_cnt; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ boolean config_bbrf; -+#endif -+ boolean is_disable_power_training; -+ boolean is_bt_continuous_turn; -+ u8 enhance_pwr_th[3]; -+ u8 set_pwr_th[3]; -+ /*@----------Dyn Tx Pwr ---------------------------------------*/ -+#ifdef BB_RAM_SUPPORT -+ struct phydm_bb_ram_ctrl p_bb_ram_ctrl; -+#endif -+ u8 dynamic_tx_high_power_lvl; -+ void (*fill_desc_dyntxpwr)(void *dm, u8 *desc, u8 dyn_tx_power); -+ u8 last_dtp_lvl; -+ u8 min_power_index; -+ u32 tx_agc_ofdm_18_6; -+ /*-------------------------------------------------------------*/ -+ u8 rx_pkt_type; -+ -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ u8 dfs_region_domain; -+ u8 *dfs_master_enabled; -+ /*@---phydm_radar_detect_with_dbg_parm start --------------------*/ -+ u8 radar_detect_dbg_parm_en; -+ u32 radar_detect_reg_918; -+ u32 radar_detect_reg_91c; -+ u32 radar_detect_reg_920; -+ u32 radar_detect_reg_924; -+ -+ u32 radar_detect_reg_a40; -+ u32 radar_detect_reg_a44; -+ u32 radar_detect_reg_a48; -+ u32 radar_detect_reg_a4c; -+ u32 radar_detect_reg_a50; -+ u32 radar_detect_reg_a54; -+ -+ u32 radar_detect_reg_f54; -+ u32 radar_detect_reg_f58; -+ u32 radar_detect_reg_f5c; -+ u32 radar_detect_reg_f70; -+ u32 radar_detect_reg_f74; -+ /*@---For zero-wait DFS---------------------------------------*/ -+ boolean seg1_dfs_flag; -+ /*@---For ETSI 302 ---------------------------------------*/ -+/*@-----------------------------------------------------------*/ -+#endif -+ -+/*@=== RTL8721D ===*/ -+#if (RTL8721D_SUPPORT) -+ boolean cbw20_adc80; -+ boolean invalid_mode; -+ u8 power_voltage; -+ u8 cca_cbw20_lev; -+ u8 cca_cbw40_lev; -+ u8 antdiv_gpio; -+ u8 peak_detect_mode; -+#endif -+ -+/*@=== PHYDM Timer ========================================== (start)*/ -+ -+ struct phydm_timer_list mpt_dig_timer; -+ struct phydm_timer_list fast_ant_training_timer; -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ struct phydm_timer_list evm_fast_ant_training_timer; -+#endif -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+ struct phydm_timer_list tdma_dig_timer; -+#endif -+ struct phydm_timer_list sbdcnt_timer; -+ -+/*@=== PHYDM Workitem ======================================= (start)*/ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if USE_WORKITEM -+ RT_WORK_ITEM fast_ant_training_workitem; -+ RT_WORK_ITEM ra_rpt_workitem; -+ RT_WORK_ITEM sbdcnt_workitem; -+ RT_WORK_ITEM phydm_evm_antdiv_workitem; -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+ RT_WORK_ITEM phydm_tdma_dig_workitem; -+#endif -+#endif -+#endif -+ -+/*@=== PHYDM Structure ======================================== (start)*/ -+ struct phydm_func_poiner phydm_func_handler; -+ struct phydm_iot_center iot_table; -+ -+#ifdef ODM_CONFIG_BT_COEXIST -+ struct phydm_bt_info bt_info_table; -+#endif -+ -+ struct pkt_process_info pkt_proc_struct; -+ struct phydm_adaptivity_struct adaptivity; -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ struct _DFS_STATISTICS dfs; -+#endif -+ struct odm_noise_monitor noise_level; -+ struct odm_phy_dbg_info phy_dbg_info; -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ struct odm_phy_dbg_info phy_dbg_info_win_bkp; -+#endif -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ struct phydm_bf_rate_info_jgr3 bf_rate_info_jgr3; -+#endif -+ -+#ifdef CONFIG_ADAPTIVE_SOML -+ struct adaptive_soml dm_soml_table; -+#endif -+ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ struct _BF_DIV_COEX_ dm_bdc_table; -+ #endif -+ -+ #if (defined(CONFIG_HL_SMART_ANTENNA)) -+ struct smt_ant_honbo dm_sat_table; -+ #endif -+#endif -+ -+#if (defined(CONFIG_SMART_ANTENNA)) -+ struct smt_ant smtant_table; -+#endif -+ -+ struct _hal_rf_ rf_table; /*@for HALRF function*/ -+ struct dm_rf_calibration_struct rf_calibrate_info; -+ struct dm_iqk_info IQK_info; -+ struct dm_dpk_info dpk_info; -+ struct dm_dack_info dack_info; -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ struct phydm_fat_struct dm_fat_table; -+ struct sw_antenna_switch dm_swat_table; -+#endif -+ struct phydm_dig_struct dm_dig_table; -+ -+#ifdef PHYDM_SUPPORT_CCKPD -+ struct phydm_cckpd_struct dm_cckpd_table; -+ -+ #ifdef PHYDM_DCC_ENHANCE -+ struct phydm_dcc_struct dm_dcc_info; /*dig cckpd coex*/ -+ #endif -+#endif -+ -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ struct phydm_lna_sat_t dm_lna_sat_info; -+#endif -+ -+#ifdef CONFIG_MCC_DM -+ struct _phydm_mcc_dm_ mcc_dm; -+#endif -+ -+#ifdef PHYDM_PRIMARY_CCA -+ struct phydm_pricca_struct dm_pri_cca; -+#endif -+ -+ struct ra_table dm_ra_table; -+ struct phydm_fa_struct false_alm_cnt; -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+ struct phydm_fa_acc_struct false_alm_cnt_acc; -+#ifdef IS_USE_NEW_TDMA -+ struct phydm_fa_acc_struct false_alm_cnt_acc_low; -+#endif -+#endif -+ struct phydm_cfo_track_struct dm_cfo_track; -+ struct ccx_info dm_ccx_info; -+ -+ struct odm_power_trim_data power_trim_data; -+#if (RTL8822B_SUPPORT) -+ struct drp_rtl8822b_struct phydm_rtl8822b; -+#endif -+ -+#ifdef CONFIG_PSD_TOOL -+ struct psd_info dm_psd_table; -+#endif -+ -+#if (PHYDM_LA_MODE_SUPPORT) -+ struct rt_adcsmp adcsmp; -+#endif -+ -+#if (defined(CONFIG_PATH_DIVERSITY)) -+ struct _ODM_PATH_DIVERSITY_ dm_path_div; -+#endif -+ -+#if (defined(CONFIG_ANT_DETECTION)) -+ struct _ANT_DETECTED_INFO ant_detected_info; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ struct _RT_BEAMFORMING_INFO beamforming_info; -+#endif -+#endif -+#ifdef PHYDM_AUTO_DEGBUG -+ struct phydm_auto_dbg_struct auto_dbg_table; -+#endif -+ -+ struct phydm_pause_lv pause_lv_table; -+ struct phydm_api_stuc api_table; -+#ifdef PHYDM_POWER_TRAINING_SUPPORT -+ struct phydm_pow_train_stuc pow_train_table; -+#endif -+ -+#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT -+ struct phydm_pmac_tx dm_pmac_tx_table; -+#endif -+ -+#ifdef PHYDM_MP_SUPPORT -+ struct phydm_mp dm_mp_table; -+#endif -+ -+#ifdef PHYDM_CCK_RX_PATHDIV_SUPPORT -+ struct phydm_cck_rx_pathdiv dm_cck_rx_pathdiv_table; -+#endif -+/*@==========================================================*/ -+ -+#if (RTL8822C_SUPPORT || RTL8812F_SUPPORT || RTL8197G_SUPPORT || RTL8723F_SUPPORT) -+ /*@-------------------phydm_phystatus report --------------------*/ -+ struct phydm_physts dm_physts_table; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+#if (RT_PLATFORM != PLATFORM_LINUX) -+} dm_struct; /*@DM_Dynamic_Mechanism_Structure*/ -+#else -+}; -+#endif -+ -+#else /*@for AP,CE Team*/ -+}; -+#endif -+ -+enum phydm_adv_ota { -+ PHYDM_PATHB_1RCCA = BIT(0), -+ PHYDM_HP_OTA_SETTING_A = BIT(1), -+ PHYDM_HP_OTA_SETTING_B = BIT(2), -+ PHYDM_ASUS_OTA_SETTING = BIT(3), -+ PHYDM_ASUS_OTA_SETTING_CCK_PATH = BIT(4), -+ PHYDM_HP_OTA_SETTING_CCK_PATH = BIT(5), -+ PHYDM_LENOVO_OTA_SETTING_NBI_CSI = BIT(6), -+ -+}; -+ -+enum phydm_bb_op_mode { -+ PHYDM_PERFORMANCE_MODE = 0, /*Service one device*/ -+ PHYDM_BALANCE_MODE = 1, /*@Service more than one device*/ -+}; -+ -+enum phydm_structure_type { -+ PHYDM_FALSEALMCNT, -+ PHYDM_CFOTRACK, -+ PHYDM_ADAPTIVITY, -+ PHYDM_DFS, -+ PHYDM_ROMINFO, -+ -+}; -+ -+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, -+ CONFIG_BB_RF_CAL_INIT, -+}; -+ -+enum odm_rf_config_type { -+ CONFIG_RF_RADIO, -+ CONFIG_RF_TXPWR_LMT, -+ CONFIG_RF_SYN_RADIO, -+}; -+ -+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, -+}; -+ -+/*status code*/ -+#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -+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, -+}; -+#endif /*@end of enum rt_status definition*/ -+ -+void -+phydm_watchdog_lps(struct dm_struct *dm); -+ -+void -+phydm_watchdog_lps_32k(struct dm_struct *dm); -+ -+void -+phydm_txcurrentcalibration(struct dm_struct *dm); -+ -+void -+phydm_dm_early_init(struct dm_struct *dm); -+ -+enum phydm_init_result -+odm_dm_init(struct dm_struct *dm); -+ -+void -+odm_dm_reset(struct dm_struct *dm); -+ -+void -+phydm_fwoffload_ability_init(struct dm_struct *dm, -+ enum phydm_offload_ability offload_ability); -+ -+void -+phydm_fwoffload_ability_clear(struct dm_struct *dm, -+ enum phydm_offload_ability offload_ability); -+ -+void -+phydm_supportability_en(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void -+phydm_pause_dm_watchdog(void *dm_void, enum phydm_pause_type pause_type); -+ -+void -+phydm_watchdog(struct dm_struct *dm); -+ -+void -+phydm_watchdog_mp(struct dm_struct *dm); -+ -+void -+phydm_pause_func_init(void *dm_void); -+ -+u8 -+phydm_pause_func(void *dm_void, enum phydm_func_idx pause_func, -+ enum phydm_pause_type pause_type, -+ enum phydm_pause_level pause_lv, u8 val_lehgth, u32 *val_buf); -+ -+void -+phydm_pause_func_console(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void phydm_pause_dm_by_asso_pkt(struct dm_struct *dm, -+ enum phydm_pause_type pause_type, u8 rssi); -+ -+void phydm_fw_dm_ctrl_en(void *dm_void, enum phydm_func_idx fun_idx, -+ boolean enable); -+ -+void -+odm_cmn_info_init(struct dm_struct *dm, enum odm_cmninfo cmn_info, u64 value); -+ -+void -+odm_cmn_info_hook(struct dm_struct *dm, enum odm_cmninfo cmn_info, void *value); -+ -+void -+odm_cmn_info_update(struct dm_struct *dm, u32 cmn_info, u64 value); -+ -+u32 -+phydm_cmn_info_query(struct dm_struct *dm, enum phydm_info_query info_type); -+ -+void -+odm_init_all_timers(struct dm_struct *dm); -+ -+void -+odm_cancel_all_timers(struct dm_struct *dm); -+ -+void -+odm_release_all_timers(struct dm_struct *dm); -+ -+void * -+phydm_get_structure(struct dm_struct *dm, u8 structure_type); -+ -+void -+phydm_dc_cancellation(struct dm_struct *dm); -+ -+void -+phydm_receiver_blocking(void *dm_void); -+ -+void -+phydm_dyn_bw_indication(void *dm_void); -+ -+void -+phydm_iot_patch_id_update(void *dm_void, u32 iot_idx, boolean en); -+ -+ -+#ifdef CONFIG_DYNAMIC_TXCOLLISION_TH -+void -+phydm_tx_collsion_th_init(void *dm_void); -+ -+void -+phydm_tx_collsion_th_set(void *dm_void, u8 val_r2t, u8 val_t2r); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void -+odm_init_all_work_items( -+ struct dm_struct *dm -+); -+void -+odm_free_all_work_items( -+ struct dm_struct *dm -+); -+#endif /*@#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+void -+odm_dtc(struct dm_struct *dm); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+void -+odm_init_all_threads( -+ struct dm_struct *dm -+); -+ -+void -+odm_stop_all_threads( -+ struct dm_struct *dm -+); -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm.mk b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm.mk -new file mode 100644 -index 000000000..2c007b79f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm.mk -@@ -0,0 +1,259 @@ -+EXTRA_CFLAGS += -I$(src)/hal/phydm -+ -+_PHYDM_FILES := hal/phydm/phydm_debug.o \ -+ hal/phydm/phydm_antdiv.o\ -+ hal/phydm/phydm_soml.o\ -+ hal/phydm/phydm_smt_ant.o\ -+ hal/phydm/phydm_antdect.o\ -+ hal/phydm/phydm_interface.o\ -+ hal/phydm/phydm_phystatus.o\ -+ hal/phydm/phydm_hwconfig.o\ -+ hal/phydm/phydm.o\ -+ hal/phydm/phydm_dig.o\ -+ hal/phydm/phydm_pathdiv.o\ -+ hal/phydm/phydm_rainfo.o\ -+ hal/phydm/phydm_dynamictxpower.o\ -+ hal/phydm/phydm_adaptivity.o\ -+ hal/phydm/phydm_cfotracking.o\ -+ hal/phydm/phydm_noisemonitor.o\ -+ hal/phydm/phydm_beamforming.o\ -+ hal/phydm/phydm_direct_bf.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_adc_sampling.o\ -+ hal/phydm/phydm_ccx.o\ -+ hal/phydm/phydm_psd.o\ -+ hal/phydm/phydm_primary_cca.o\ -+ hal/phydm/phydm_cck_pd.o\ -+ hal/phydm/phydm_rssi_monitor.o\ -+ hal/phydm/phydm_auto_dbg.o\ -+ hal/phydm/phydm_math_lib.o\ -+ hal/phydm/phydm_api.o\ -+ hal/phydm/phydm_pow_train.o\ -+ hal/phydm/phydm_lna_sat.o\ -+ hal/phydm/phydm_pmac_tx_setting.o\ -+ hal/phydm/phydm_mp.o\ -+ hal/phydm/phydm_cck_rx_pathdiv.o\ -+ hal/phydm/halrf/halrf.o\ -+ hal/phydm/halrf/halrf_debug.o\ -+ hal/phydm/halrf/halphyrf_ce.o\ -+ hal/phydm/halrf/halrf_powertracking_ce.o\ -+ hal/phydm/halrf/halrf_powertracking.o\ -+ hal/phydm/halrf/halrf_kfree.o\ -+ hal/phydm/halrf/halrf_psd.o -+ -+ifeq ($(CONFIG_RTL8188E), y) -+RTL871X = rtl8188e -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8188e_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8188e_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8188e.o\ -+ hal/phydm/$(RTL871X)/hal8188erateadaptive.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8188e.o -+endif -+ -+ifeq ($(CONFIG_RTL8192E), y) -+RTL871X = rtl8192e -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8192e_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192e_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192e_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8192e_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8192e.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8192e.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8812A), y) -+RTL871X = rtl8812a -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8812a_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8812a_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8812a_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_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) -+RTL871X = rtl8821a -+_PHYDM_FILES += hal/phydm/rtl8821a/halhwimg8821a_mac.o\ -+ hal/phydm/rtl8821a/halhwimg8821a_bb.o\ -+ hal/phydm/rtl8821a/halhwimg8821a_rf.o\ -+ hal/phydm/halrf/rtl8812a/halrf_8812a_ce.o\ -+ hal/phydm/halrf/rtl8821a/halrf_8821a_ce.o\ -+ hal/phydm/rtl8821a/phydm_regconfig8821a.o\ -+ hal/phydm/rtl8821a/phydm_rtl8821a.o\ -+ hal/phydm/halrf/rtl8821a/halrf_iqk_8821a_ce.o\ -+ hal/phydm/txbf/haltxbfjaguar.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8723B), y) -+RTL871X = rtl8723b -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8723b_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_mp.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8723b.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8723b_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8723b.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8814A), y) -+RTL871X = rtl8814a -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8814a_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8814a_mac.o\ -+ hal/phydm/halrf/$(RTL871X)/halhwimg8814a_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_iqk_8814a.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8814a.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8814a_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8814a.o\ -+ hal/phydm/txbf/haltxbf8814a.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8723C), y) -+RTL871X = rtl8703b -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8703b_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8703b_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8703b_rf.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8703b.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8703b.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8703b.o -+endif -+ -+ifeq ($(CONFIG_RTL8723D), y) -+RTL871X = rtl8723d -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8723d_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723d_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723d_rf.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8723d.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8723d.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8723d.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8710B), y) -+RTL871X = rtl8710b -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8710b_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8710b_mac.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8710b.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8710b.o\ -+ hal/phydm/halrf/$(RTL871X)/halhwimg8710b_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8710b.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8188F), y) -+RTL871X = rtl8188f -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8188f_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188f_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188f_rf.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8188f.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8188f.o \ -+ hal/phydm/$(RTL871X)/phydm_rtl8188f.o -+endif -+ -+ifeq ($(CONFIG_RTL8822B), y) -+RTL871X = rtl8822b -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8822b_bb.o \ -+ hal/phydm/$(RTL871X)/halhwimg8822b_mac.o \ -+ hal/phydm/halrf/$(RTL871X)/halrf_8822b.o \ -+ hal/phydm/$(RTL871X)/phydm_hal_api8822b.o \ -+ hal/phydm/halrf/$(RTL871X)/halhwimg8822b_rf.o \ -+ hal/phydm/halrf/$(RTL871X)/halrf_iqk_8822b.o \ -+ hal/phydm/halrf/$(RTL871X)/halrf_rfk_init_8822b.o \ -+ hal/phydm/$(RTL871X)/phydm_regconfig8822b.o \ -+ hal/phydm/$(RTL871X)/phydm_rtl8822b.o -+ -+_PHYDM_FILES += hal/phydm/txbf/haltxbf8822b.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8821C), y) -+RTL871X = rtl8821c -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8821c_bb.o \ -+ hal/phydm/$(RTL871X)/halhwimg8821c_mac.o \ -+ hal/phydm/$(RTL871X)/phydm_hal_api8821c.o \ -+ hal/phydm/$(RTL871X)/phydm_regconfig8821c.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8821c.o\ -+ hal/phydm/halrf/$(RTL871X)/halhwimg8821c_rf.o \ -+ hal/phydm/halrf/$(RTL871X)/halrf_8821c.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_iqk_8821c.o -+endif -+ifeq ($(CONFIG_RTL8192F), y) -+RTL871X = rtl8192f -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8192f_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192f_mac.o\ -+ hal/phydm/$(RTL871X)/phydm_hal_api8192f.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8192f.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8192f.o\ -+ hal/phydm/halrf/$(RTL871X)/halhwimg8192f_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8192f.o -+endif -+ -+ifeq ($(CONFIG_RTL8198F), y) -+RTL871X = rtl8198f -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8198f_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8198f_mac.o\ -+ hal/phydm/$(RTL871X)/phydm_hal_api8198f.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8198f.o\ -+ hal/phydm/halrf/$(RTL871X)/halhwimg8198f_rf.o -+endif -+ -+ifeq ($(CONFIG_RTL8822C), y) -+RTL871X = rtl8822c -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8822c_bb.o\ -+ hal/phydm/$(RTL871X)/phydm_hal_api8822c.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8822c.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8822c.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8822c.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_iqk_8822c.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_tssi_8822c.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_dpk_8822c.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_txgapk_8822c.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_rfk_init_8822c.o\ -+ hal/phydm/halrf/$(RTL871X)/halhwimg8822c_rf.o -+endif -+ -+ifeq ($(CONFIG_RTL8814B), y) -+RTL871X = rtl8814b -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8814b_bb.o\ -+ hal/phydm/$(RTL871X)/phydm_hal_api8814b.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8814b.o\ -+ hal/phydm/$(RTL871X)/phydm_extraagc8814b.o\ -+ hal/phydm/halrf/$(RTL871X)/halhwimg8814b_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8814b.o \ -+ hal/phydm/halrf/$(RTL871X)/halrf_iqk_8814b.o \ -+ hal/phydm/halrf/$(RTL871X)/halrf_dpk_8814b.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_rfk_init_8814b.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_txgapk_8814b.o -+ ifeq ($(CONFIG_RTL8814C), y) -+ _PHYDM_FILES += hal/phydm/halrf/rtl8814c/halrf_8814c.o\ -+ hal/phydm/halrf/rtl8814c/halrf_iqk_8814c.o\ -+ hal/phydm/halrf/rtl8814c/halrf_dpk_8814c.o\ -+ hal/phydm/halrf/rtl8814c/halrf_rfk_init_8814c.o\ -+ hal/phydm/halrf/rtl8814c/halhwimg8814c_rf.o\ -+ hal/phydm/halrf/rtl8814c/halrf_8814c.o\ -+ hal/phydm/rtl8814c/halhwimg8814c_bb.o\ -+ hal/phydm/rtl8814c/phydm_extraagc8814c.o -+ endif -+endif -+ifeq ($(CONFIG_RTL8723F), y) -+RTL871X = rtl8723f -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8723f_bb.o\ -+ hal/phydm/$(RTL871X)/phydm_hal_api8723f.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8723f.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8723f.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8723f.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_iqk_8723f.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_tssi_8723f.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_dpk_8723f.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_txgapk_8723f.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_rfk_init_8723f.o\ -+ hal/phydm/halrf/$(RTL871X)/halhwimg8723f_rf.o -+endif -\ No newline at end of file -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adaptivity.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adaptivity.c -new file mode 100644 -index 000000000..ed6fea4d9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adaptivity.c -@@ -0,0 +1,1193 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * 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 -+#ifdef PHYDM_SUPPORT_ADAPTIVITY -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+boolean -+phydm_check_channel_plan(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ void *adapter = dm->adapter; -+ PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo; -+ -+ if (mgnt_info->RegEnableAdaptivity != 2) -+ return false; -+ -+ if (!dm->carrier_sense_enable) { /*@check domain Code for adaptivity or CarrierSense*/ -+ if ((*dm->band_type == ODM_BAND_5G) && -+ !(adapt->regulation_5g == REGULATION_ETSI || adapt->regulation_5g == REGULATION_WW)) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "adaptivity skip 5G domain code : %d\n", -+ adapt->regulation_5g); -+ return true; -+ } else if ((*dm->band_type == ODM_BAND_2_4G) && -+ !(adapt->regulation_2g == REGULATION_ETSI || adapt->regulation_2g == REGULATION_WW)) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "adaptivity skip 2.4G domain code : %d\n", -+ adapt->regulation_2g); -+ return true; -+ } else if ((*dm->band_type != ODM_BAND_2_4G) && (*dm->band_type != ODM_BAND_5G)) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "adaptivity neither 2G nor 5G band, return\n"); -+ return true; -+ } -+ } else { -+ if ((*dm->band_type == ODM_BAND_5G) && -+ !(adapt->regulation_5g == REGULATION_MKK || adapt->regulation_5g == REGULATION_WW)) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "CarrierSense skip 5G domain code : %d\n", -+ adapt->regulation_5g); -+ return true; -+ } else if ((*dm->band_type == ODM_BAND_2_4G) && -+ !(adapt->regulation_2g == REGULATION_MKK || adapt->regulation_2g == REGULATION_WW)) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "CarrierSense skip 2.4G domain code : %d\n", -+ adapt->regulation_2g); -+ return true; -+ } else if ((*dm->band_type != ODM_BAND_2_4G) && (*dm->band_type != ODM_BAND_5G)) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "CarrierSense neither 2G nor 5G band, return\n"); -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+boolean -+phydm_soft_ap_special_set(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ boolean disable_ap_adapt_setting = false; -+ -+ if (dm->soft_ap_mode != NULL) { -+ if (*dm->soft_ap_mode != 0 && -+ (dm->soft_ap_special_setting & BIT(0))) -+ disable_ap_adapt_setting = true; -+ else -+ disable_ap_adapt_setting = false; -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "soft_ap_setting = %x, soft_ap = %d, dis_ap_adapt = %d\n", -+ dm->soft_ap_special_setting, *dm->soft_ap_mode, -+ disable_ap_adapt_setting); -+ } -+ -+ return disable_ap_adapt_setting; -+} -+ -+boolean -+phydm_ap_num_check(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ boolean dis_adapt = false; -+ -+ if (dm->ap_total_num > adapt->ap_num_th) -+ dis_adapt = true; -+ else -+ dis_adapt = false; -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "AP total num = %d, AP num threshold = %d\n", -+ dm->ap_total_num, adapt->ap_num_th); -+ return dis_adapt; -+} -+ -+void phydm_check_adaptivity(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ boolean disable_adapt = false; -+ -+ if (!adapt->mode_cvrt_en) -+ return; -+ -+ if (phydm_check_channel_plan(dm) || phydm_ap_num_check(dm) || -+ phydm_soft_ap_special_set(dm)) -+ disable_adapt = true; -+ -+ if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE && disable_adapt) -+ *dm->edcca_mode = PHYDM_EDCCA_NORMAL_MODE; -+ else if (*dm->edcca_mode == PHYDM_EDCCA_NORMAL_MODE && !disable_adapt) -+ *dm->edcca_mode = PHYDM_EDCCA_ADAPT_MODE; -+} -+ -+void phydm_set_l2h_th_ini_win(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /*@ [New Format: JGR3]IGI-idx:45 = RSSI:35 = -65dBm*/ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8723F)) -+ dm->th_l2h_ini = 45; -+ else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ dm->th_l2h_ini = 49; -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ /*@ [Old Format] -11+base(50) = IGI_idx:39 = RSSI:29 = -71dBm*/ -+ if (dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8812)) { -+ dm->th_l2h_ini = -17; -+ } else { -+ if (*dm->band_type == ODM_BAND_5G) -+ dm->th_l2h_ini = -14; -+ else if (*dm->band_type == ODM_BAND_2_4G) -+ dm->th_l2h_ini = -9; -+ } -+ } else { /*ODM_IC_11N_SERIES*/ -+ dm->th_l2h_ini = -9; -+ } -+} -+ -+void phydm_l2h_ini_recorder_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ struct phydm_l2h_ini_recorder_strcut *adapt_rc = &adapt->l2h_ini_recorder_t; -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "%s ======>\n", __func__); -+ -+ odm_memory_set(dm, &adapt_rc->l2h_ini_bitmap, 0, -+ sizeof(struct phydm_l2h_ini_recorder_strcut)); -+} -+ -+ -+void phydm_l2h_ini_recorder(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ struct phydm_l2h_ini_recorder_strcut *adapt_rc = &adapt->l2h_ini_recorder_t; -+ u32 low_rate_tx_fail_cnt = dm->low_rate_tx_fail_cnt; -+ s8 l2h_ini_curr = dm->th_l2h_ini; -+ s8 l2h_ini_pre = adapt_rc->l2h_ini_hist[0]; -+ s8 l2h_ini_down = 0; -+ -+ if (!dm->is_linked || adapt->is_adapt_by_dig || adapt->rts_drop_en) -+ return; -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "%s ======>\n", __func__); -+ -+ if (dm->first_connect) { -+ phydm_l2h_ini_recorder_reset(dm); -+ adapt_rc->l2h_ini_hist[0] = l2h_ini_curr; -+ return; -+ } -+ -+ l2h_ini_down = (l2h_ini_curr < l2h_ini_pre) ? 1 : 0; -+ adapt_rc->l2h_ini_bitmap = ((adapt_rc->l2h_ini_bitmap << 1) & 0xfe) | l2h_ini_down; -+ -+ adapt_rc->l2h_ini_hist[3] = adapt_rc->l2h_ini_hist[2]; -+ adapt_rc->l2h_ini_hist[2] = adapt_rc->l2h_ini_hist[1]; -+ adapt_rc->l2h_ini_hist[1] = adapt_rc->l2h_ini_hist[0]; -+ adapt_rc->l2h_ini_hist[0] = l2h_ini_curr; -+ -+ adapt_rc->low_rate_tx_fail_hist[3] = adapt_rc->low_rate_tx_fail_hist[2]; -+ adapt_rc->low_rate_tx_fail_hist[2] = adapt_rc->low_rate_tx_fail_hist[1]; -+ adapt_rc->low_rate_tx_fail_hist[1] = adapt_rc->low_rate_tx_fail_hist[0]; -+ adapt_rc->low_rate_tx_fail_hist[0] = low_rate_tx_fail_cnt; -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "l2h_ini_hist[3:0] = {0x%x, 0x%x, 0x%x, 0x%x}\n", -+ adapt_rc->l2h_ini_hist[3], adapt_rc->l2h_ini_hist[2], -+ adapt_rc->l2h_ini_hist[1], adapt_rc->l2h_ini_hist[0]); -+ PHYDM_DBG(dm, DBG_ADPTVTY, "low_rate_tx_fail_hist[3:0] = {%d, %d, %d, %d}\n", -+ adapt_rc->low_rate_tx_fail_hist[3], adapt_rc->low_rate_tx_fail_hist[2], -+ adapt_rc->low_rate_tx_fail_hist[1], adapt_rc->low_rate_tx_fail_hist[0]); -+ PHYDM_DBG(dm, DBG_ADPTVTY, "l2h_ini_bitmap = {%d, %d, %d, %d} = 0x%x\n", -+ (u8)((adapt_rc->l2h_ini_bitmap & BIT(3)) >> 3), -+ (u8)((adapt_rc->l2h_ini_bitmap & BIT(2)) >> 2), -+ (u8)((adapt_rc->l2h_ini_bitmap & BIT(1)) >> 1), -+ (u8)(adapt_rc->l2h_ini_bitmap & BIT(0)), -+ adapt_rc->l2h_ini_bitmap); -+} -+ -+void phydm_rts_drop_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ u32 time_tmp = 0; -+ -+ if (!dm->is_linked || adapt->is_adapt_by_dig) -+ return; -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "%s ======>\n", __func__); -+ -+ if (dm->rts_drop_cnt > 0) { -+ adapt->rts_drop_en = 1; -+ adapt->rts_drop_limit_time = dm->phydm_sys_up_time; -+ } -+ -+ /*@== Fix l2h_ini to l2h_ini_range_min================================*/ -+ if (adapt->rts_drop_en) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "[RTS DROP!] rts_drop_limit_time=%d, phydm_sys_up_time=%d\n", -+ adapt->rts_drop_limit_time, dm->phydm_sys_up_time); -+ -+ time_tmp = adapt->rts_drop_limit_time + L2H_INI_LIMIT_PERIOD; -+ dm->th_l2h_ini = adapt->l2h_ini_range_min; -+ -+ if (time_tmp < dm->phydm_sys_up_time && dm->rts_drop_cnt == 0) { -+ adapt->rts_drop_en = 0; -+ PHYDM_DBG(dm, DBG_ADPTVTY, "rts_drop_cnt=%d\n", -+ dm->rts_drop_cnt); -+ } -+ } -+ return; -+} -+ -+ -+void phydm_l2h_ini_damping_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ struct phydm_l2h_ini_recorder_strcut *adapt_rc = &adapt->l2h_ini_recorder_t; -+ u8 l2h_ini_bitmap_4bit = adapt_rc->l2h_ini_bitmap & 0xf; -+ s8 diff1 = 0, diff2 = 0, min_l2h_ini = 0x7f; -+ u32 tx_fail_low_th = adapt->low_rate_tx_fail_th[0]; -+ u32 tx_fail_high_th = adapt->low_rate_tx_fail_th[1]; -+ u32 tx_fail_high_th2 = adapt->low_rate_tx_fail_th[2]; -+ u8 tx_fail_pattern_match = 0; -+ u32 time_tmp = 0; -+ u8 i = 0; -+ -+ if (!dm->is_linked || adapt->is_adapt_by_dig || adapt->rts_drop_en) -+ return; -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "%s ======>\n", __func__); -+ -+ /*@== Release Damping ================================================*/ -+ if (adapt_rc->damping_limit_en) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "[Damping Limit!] limit_time=%d, phydm_sys_up_time=%d\n", -+ adapt_rc->limit_time, dm->phydm_sys_up_time); -+ -+ time_tmp = adapt_rc->limit_time + L2H_INI_LIMIT_PERIOD; -+ -+ if (DIFF_2(dm->low_rate_tx_fail_cnt, adapt_rc->limit_low_rate_tx_fail) > 3 || -+ time_tmp < dm->phydm_sys_up_time) { -+ adapt_rc->damping_limit_en = 0; -+ PHYDM_DBG(dm, DBG_ADPTVTY, "low_rate_tx_fail_cnt=%d, limit_low_rate_tx_fail=%d\n", -+ dm->low_rate_tx_fail_cnt, adapt_rc->limit_low_rate_tx_fail); -+ } -+ return; -+ } -+ -+ /*@== Damping Pattern Check===========================================*/ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "low_rate_tx_fail_th{H, L}= {%d,%d}\n", tx_fail_high_th, tx_fail_low_th); -+ -+ switch (l2h_ini_bitmap_4bit) { -+ case 0x5: -+ /*@ 4b'0101 -+ * L2H_INI: [3]up(40) ->[2]down(38)->[1]up(40) ->[0]down(38)->[new](Lock @ 38) -+ * low_rate_tx_fail_cnt: [3] >high1 ->[2] [1] >high1 ->[0] [new] [2]down(40)->[1]up(42) ->[0]down(37)->[new](Lock @ 37) -+ * low_rate_tx_fail_cnt: [3] >high2 ->[2] [1] >high2 ->[0] [new] l2h_ini_hist[0] < adapt_rc->l2h_ini_hist[1]) -+ diff1 = adapt_rc->l2h_ini_hist[1] - adapt_rc->l2h_ini_hist[0]; -+ -+ if (adapt_rc->l2h_ini_hist[2] < adapt_rc->l2h_ini_hist[3]) -+ diff2 = adapt_rc->l2h_ini_hist[3] - adapt_rc->l2h_ini_hist[2]; -+ -+ if (adapt_rc->low_rate_tx_fail_hist[0] < tx_fail_low_th && -+ adapt_rc->low_rate_tx_fail_hist[1] > tx_fail_high_th && -+ adapt_rc->low_rate_tx_fail_hist[2] < tx_fail_low_th && -+ adapt_rc->low_rate_tx_fail_hist[3] > tx_fail_high_th) { -+ /*@Check each rts drop element*/ -+ tx_fail_pattern_match = 1; -+ } -+ break; -+ case 0x9: -+ /*@ 4b'1001 -+ * L2H_INI: [3]down(40)->[2]up(42)->[1]up(44) ->[0]down(39)->[new](Lock @ 39) -+ * low_rate_tx_fail_cnt: [3] [2] [1] >high2 ->[0] [new] l2h_ini_hist[0] < adapt_rc->l2h_ini_hist[1]) -+ diff1 = adapt_rc->l2h_ini_hist[1] - adapt_rc->l2h_ini_hist[0]; -+ -+ if (adapt_rc->l2h_ini_hist[2] > adapt_rc->l2h_ini_hist[3]) -+ diff2 = adapt_rc->l2h_ini_hist[2] - adapt_rc->l2h_ini_hist[3]; -+ -+ if (adapt_rc->low_rate_tx_fail_hist[0] < tx_fail_low_th && -+ adapt_rc->low_rate_tx_fail_hist[1] > tx_fail_high_th2 && -+ adapt_rc->low_rate_tx_fail_hist[2] < tx_fail_low_th && -+ adapt_rc->low_rate_tx_fail_hist[3] < tx_fail_low_th) { -+ /*@Check each fa element*/ -+ tx_fail_pattern_match = 1; -+ } -+ break; -+ default: -+ break; -+ } -+ -+ if (diff1 >= 2 && diff2 >= 2 && tx_fail_pattern_match) { -+ for (i = 0; i < L2H_INI_RECORD_NUM; i++) { -+ if (min_l2h_ini > adapt_rc->l2h_ini_hist[i]) -+ min_l2h_ini = adapt_rc->l2h_ini_hist[i]; -+ } -+ -+ adapt_rc->damping_limit_en = 1; -+ adapt_rc->damping_limit_val = min_l2h_ini; -+ adapt_rc->limit_time = dm->phydm_sys_up_time; -+ adapt_rc->limit_low_rate_tx_fail = dm->low_rate_tx_fail_cnt; -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "[Start damping_limit!] l2h_ini_min=0x%x, limit_time=%d, limit_low_rate_tx_fail=%d\n", -+ adapt_rc->damping_limit_val, -+ adapt_rc->limit_time, adapt_rc->limit_low_rate_tx_fail); -+ } -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "damping_limit=%d\n", adapt_rc->damping_limit_en); -+} -+ -+void phydm_low_rate_tx_fail_threshold_check(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ -+ if (adapt->is_dbg_low_rate_tx_fail_th) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, "Manual Fix low_rate_tx_fail_th\n"); -+ } else { -+ adapt->low_rate_tx_fail_th[0] = 2; -+ adapt->low_rate_tx_fail_th[1] = 2; -+ adapt->low_rate_tx_fail_th[2] = 5; -+ } -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "low_rate_tx_fail_th={%d,%d,%d}\n", adapt->low_rate_tx_fail_th[0], -+ adapt->low_rate_tx_fail_th[1], adapt->low_rate_tx_fail_th[2]); -+} -+ -+s8 phydm_new_l2h_ini_by_low_rate_tx_fail(void *dm_void, s8 l2h_ini, -+ u8 *step_size) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ u32 low_rate_tx_fail_cnt = dm->low_rate_tx_fail_cnt; -+ -+ if (low_rate_tx_fail_cnt > adapt->low_rate_tx_fail_th[2]) -+ l2h_ini = l2h_ini - step_size[2]; -+ else if (low_rate_tx_fail_cnt > adapt->low_rate_tx_fail_th[1]) -+ l2h_ini = l2h_ini - step_size[1]; -+ else if (low_rate_tx_fail_cnt < adapt->low_rate_tx_fail_th[0]) -+ l2h_ini = l2h_ini + step_size[0]; -+ -+ return l2h_ini; -+} -+ -+ -+void phydm_get_new_l2h_ini(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ struct phydm_l2h_ini_recorder_strcut *adapt_rc = &adapt->l2h_ini_recorder_t; -+ u8 step[3] = {1, 2, 5}; -+ u32 low_rate_tx_fail_cnt = dm->low_rate_tx_fail_cnt; -+ u32 low_rate_tx_ok_cnt = dm->low_rate_tx_ok_cnt; -+ s8 l2h_ini = dm->th_l2h_ini; -+ -+ if (!dm->is_linked || adapt->is_adapt_by_dig || adapt->rts_drop_en) -+ return; -+ -+ if (adapt_rc->damping_limit_en) { -+ dm->th_l2h_ini = adapt_rc->damping_limit_val; -+ PHYDM_DBG(dm, DBG_ADPTVTY, "[Limit by Damping] l2h_ini: 0x%x -> 0x%x\n", -+ l2h_ini, dm->th_l2h_ini); -+ return; -+ } -+ -+ l2h_ini = phydm_new_l2h_ini_by_low_rate_tx_fail(dm, l2h_ini, step); -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "step = {-%d, -%d, +%d}\n", step[2], step[1], -+ step[0]); -+ -+ /*@Check th_l2h_ini by dyn-upper/lower bound */ -+ if (l2h_ini < adapt->l2h_ini_range_min) -+ l2h_ini = adapt->l2h_ini_range_min; -+ -+ if (l2h_ini > adapt->l2h_ini_range_max) -+ l2h_ini = adapt->l2h_ini_range_max; -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "low_rate_tx_fail_cnt = %d, low_rate_tx_ok_cnt = %d, l2h_ini: 0x%x -> 0x%x\n", -+ low_rate_tx_fail_cnt, low_rate_tx_ok_cnt, dm->th_l2h_ini, -+ l2h_ini); -+ -+ dm->th_l2h_ini = l2h_ini; -+} -+ -+void phydm_dyn_l2h_ini(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ -+ if (dm->rssi_min <= 20 || !dm->is_linked) { -+ phydm_set_l2h_th_ini_win(dm); -+ PHYDM_DBG(dm, DBG_ADPTVTY, "th_l2h_ini = %d\n", dm->th_l2h_ini); -+ return; -+ } -+ -+ /*Check rts drop*/ -+ phydm_rts_drop_chk(dm); -+ -+ /*Record l2h_ini History*/ -+ phydm_l2h_ini_recorder(dm); -+ -+ /*@l2h_ini Damping Check*/ -+ phydm_l2h_ini_damping_chk(dm); -+ -+ /*@low_rate_tx_fail threshold decision */ -+ phydm_low_rate_tx_fail_threshold_check(dm); -+ -+ /*Select new l2h_ini by tx_fail */ -+ phydm_get_new_l2h_ini(dm); -+ PHYDM_DBG(dm, DBG_ADPTVTY, "Adjust l2h init @ linked, th_l2h_ini = %d\n", -+ dm->th_l2h_ini); -+} -+ -+#endif -+ -+void phydm_dig_up_bound_lmt_en(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ -+ if (*dm->edcca_mode != PHYDM_EDCCA_ADAPT_MODE || -+ !dm->is_linked) { -+ adapt->igi_up_bound_lmt_cnt = 0; -+ adapt->igi_lmt_en = false; -+ return; -+ } -+ -+ if (dm->total_tp > 1) { -+ adapt->igi_lmt_en = true; -+ adapt->igi_up_bound_lmt_cnt = adapt->igi_up_bound_lmt_val; -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "TP >1, Start limit IGI upper bound\n"); -+ } else { -+ if (adapt->igi_up_bound_lmt_cnt == 0) -+ adapt->igi_lmt_en = false; -+ else -+ adapt->igi_up_bound_lmt_cnt--; -+ } -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, "IGI_lmt_cnt = %d\n", -+ adapt->igi_up_bound_lmt_cnt); -+} -+ -+void phydm_set_edcca_threshold(void *dm_void, s8 H2L, s8 L2H) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ odm_set_bb_reg(dm, R_0x84c, MASKBYTE2, (u8)L2H + 0x80); -+ odm_set_bb_reg(dm, R_0x84c, MASKBYTE3, (u8)H2L + 0x80); -+ } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ odm_set_bb_reg(dm, R_0xc4c, MASKBYTE0, (u8)L2H); -+ odm_set_bb_reg(dm, R_0xc4c, MASKBYTE2, (u8)H2L); -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ odm_set_bb_reg(dm, R_0x8a4, MASKBYTE0, (u8)L2H); -+ odm_set_bb_reg(dm, R_0x8a4, MASKBYTE1, (u8)H2L); -+ } -+} -+ -+void phydm_mac_edcca_state(void *dm_void, enum phydm_mac_edcca_type state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (state == PHYDM_IGNORE_EDCCA) { -+ /*@ignore EDCCA*/ -+ odm_set_mac_reg(dm, R_0x520, BIT(15), 1); -+ /*@enable EDCCA count down*/ -+ odm_set_mac_reg(dm, R_0x524, BIT(11), 0); -+ } else { /*@don't set MAC ignore EDCCA signal*/ -+ /*@don't ignore EDCCA*/ -+ odm_set_mac_reg(dm, R_0x520, BIT(15), 0); -+ /*@disable EDCCA count down*/ -+ odm_set_mac_reg(dm, R_0x524, BIT(11), 1); -+ } -+ PHYDM_DBG(dm, DBG_ADPTVTY, "EDCCA enable state = %d\n", state); -+} -+ -+void phydm_search_pwdb_lower_bound(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ u32 value32 = 0, reg_value32 = 0; -+ u8 cnt = 0, try_count = 0; -+ u8 tx_edcca1 = 0; -+ boolean is_adjust = true; -+ s8 th_l2h, th_h2l, igi_target_dc = 0x32; -+ s8 diff = 0; -+ s8 IGI = adapt->igi_base + 30 + dm->th_l2h_ini - dm->th_edcca_hl_diff; -+ -+ halrf_rf_lna_setting(dm, HALRF_LNA_DISABLE); -+ diff = igi_target_dc - IGI; -+ th_l2h = dm->th_l2h_ini + diff; -+ if (th_l2h > 10) -+ th_l2h = 10; -+ -+ th_h2l = th_l2h - dm->th_edcca_hl_diff; -+ phydm_set_edcca_threshold(dm, th_h2l, th_l2h); -+ ODM_delay_ms(30); -+ -+ while (is_adjust) { -+ /*@check CCA status*/ -+ /*set debug port to 0x0*/ -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x0)) { -+ reg_value32 = phydm_get_bb_dbg_port_val(dm); -+ -+ while (reg_value32 & BIT(3) && try_count < 3) { -+ ODM_delay_ms(3); -+ try_count = try_count + 1; -+ reg_value32 = phydm_get_bb_dbg_port_val(dm); -+ } -+ phydm_release_bb_dbg_port(dm); -+ try_count = 0; -+ } -+ -+ /*@count EDCCA signal = 1 times*/ -+ for (cnt = 0; cnt < 20; cnt++) { -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, -+ adapt->adaptivity_dbg_port)) { -+ value32 = phydm_get_bb_dbg_port_val(dm); -+ phydm_release_bb_dbg_port(dm); -+ } -+ -+ if (value32 & BIT(30) && dm->support_ic_type & -+ (ODM_RTL8723B | ODM_RTL8188E)) -+ tx_edcca1 = tx_edcca1 + 1; -+ else if (value32 & BIT(29)) -+ tx_edcca1 = tx_edcca1 + 1; -+ } -+ -+ if (tx_edcca1 > 1) { -+ IGI = IGI - 1; -+ th_l2h = th_l2h + 1; -+ if (th_l2h > 10) -+ th_l2h = 10; -+ -+ th_h2l = th_l2h - dm->th_edcca_hl_diff; -+ phydm_set_edcca_threshold(dm, th_h2l, th_l2h); -+ tx_edcca1 = 0; -+ if (th_l2h == 10) -+ is_adjust = false; -+ -+ } else { -+ is_adjust = false; -+ } -+ } -+ -+ adapt->adapt_igi_up = IGI - ADAPT_DC_BACKOFF; -+ adapt->h2l_lb = th_h2l + ADAPT_DC_BACKOFF; -+ adapt->l2h_lb = th_l2h + ADAPT_DC_BACKOFF; -+ -+ halrf_rf_lna_setting(dm, HALRF_LNA_ENABLE); -+ phydm_set_edcca_threshold(dm, 0x7f, 0x7f); /*resume to no link state*/ -+} -+ -+boolean phydm_re_search_condition(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; -+ u8 adaptivity_igi_upper = adaptivity->adapt_igi_up + ADAPT_DC_BACKOFF; -+ -+ if (adaptivity_igi_upper <= 0x26) -+ return true; -+ else -+ return false; -+} -+ -+void phydm_set_l2h_th_ini(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /*@ [New Format: JGR3]IGI-idx:45 = RSSI:35 = -65dBm*/ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8723F)) -+ dm->th_l2h_ini = 45; -+ else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ dm->th_l2h_ini = 49; -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ /*@ [Old Format] -11+base(50) = IGI_idx:39 = RSSI:29 = -71dBm*/ -+ if (dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8812)) -+ dm->th_l2h_ini = -17; -+ else -+ dm->th_l2h_ini = -14; -+ } else { /*ODM_IC_11N_SERIES*/ -+ if (dm->support_ic_type & ODM_RTL8721D) -+ dm->th_l2h_ini = -14; -+ else -+ dm->th_l2h_ini = -11; -+ } -+} -+ -+void phydm_set_l2h_th_ini_carrier_sense(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ dm->th_l2h_ini = 60; /*@ -50dBm*/ -+ else -+ dm->th_l2h_ini = 10; /*@ -50dBm*/ -+} -+ -+void phydm_set_forgetting_factor(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (*dm->edcca_mode != PHYDM_EDCCA_ADAPT_MODE) -+ return; -+ -+ if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8814A | -+ ODM_RTL8195B)) -+ odm_set_bb_reg(dm, R_0x8a0, BIT(1) | BIT(0), 0); -+} -+ -+void phydm_edcca_decision_opt(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (*dm->edcca_mode != PHYDM_EDCCA_ADAPT_MODE) -+ return; -+ -+ if (dm->support_ic_type & ODM_RTL8822B) -+ odm_set_bb_reg(dm, R_0x8dc, BIT(5), 0x1); -+ else if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) -+ odm_set_bb_reg(dm, R_0xce8, BIT(13), 0x1); -+ else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ odm_set_bb_reg(dm, R_0x844, BIT(30) | BIT(29), 0x0); -+} -+ -+void phydm_adaptivity_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; -+ struct phydm_l2h_ini_recorder_strcut *adapt_rc = &adaptivity->l2h_ini_recorder_t; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ char help[] = "-h"; -+ u32 dm_value[10] = {0}; -+ u8 i = 0, input_idx = 0; -+ u32 reg_value32 = 0; -+ s8 h2l_diff = 0; -+ -+ for (i = 0; i < 6; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); -+ input_idx++; -+ } -+ if (strcmp(input[1], help) == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Show adaptivity message: {0}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Enter debug mode: {1} {th_l2h_ini} {th_edcca_hl_diff}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Leave debug mode: {2}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "RTS drop debug mode: {3} {en} {low_rate_tx_fail_th[0]} {low_rate_tx_fail_th[1]} {low_rate_tx_fail_th[2]}\n"); -+ goto out; -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ if (dm_value[0] == PHYDM_ADAPT_DEBUG) { -+ adaptivity->debug_mode = true; -+ if (dm_value[1] != 0) -+ dm->th_l2h_ini = (s8)dm_value[1]; -+ if (dm_value[2] != 0) -+ dm->th_edcca_hl_diff = (s8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "th_l2h_ini = %d, th_edcca_hl_diff = %d\n", -+ dm->th_l2h_ini, dm->th_edcca_hl_diff); -+ } else if (dm_value[0] == PHYDM_ADAPT_RESUME) { -+ adaptivity->debug_mode = false; -+ dm->th_l2h_ini = adaptivity->th_l2h_ini_backup; -+ dm->th_edcca_hl_diff = adaptivity->th_edcca_hl_diff_backup; -+ } else if (dm_value[0] == PHYDM_ADAPT_MSG) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "debug_mode = %s, th_l2h_ini = %d\n", -+ (adaptivity->debug_mode ? "TRUE" : "FALSE"), -+ dm->th_l2h_ini); -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ reg_value32 = odm_get_bb_reg(dm, R_0x84c, MASKDWORD); -+ h2l_diff = (s8)((0x00ff0000 & reg_value32) >> 16) - -+ (s8)((0xff000000 & reg_value32) >> 24); -+ } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ reg_value32 = odm_get_bb_reg(dm, R_0xc4c, MASKDWORD); -+ h2l_diff = (s8)(0x000000ff & reg_value32) - -+ (s8)((0x00ff0000 & reg_value32) >> 16); -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ reg_value32 = odm_get_bb_reg(dm, R_0x8a4, MASKDWORD); -+ h2l_diff = (s8)(0x000000ff & reg_value32) - -+ (s8)((0x0000ff00 & reg_value32) >> 8); -+ } -+ -+ if (h2l_diff == 7) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "adaptivity enable\n"); -+ else -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "adaptivity disable\n"); -+ } else if (dm_value[0] == PHYDM_L2H_INI_DEBUG) { -+ if (dm_value[1] == 1) { -+ adaptivity->is_dbg_low_rate_tx_fail_th = true; -+ adaptivity->low_rate_tx_fail_th[0] = (u32)dm_value[2]; -+ adaptivity->low_rate_tx_fail_th[1] = (u32)dm_value[3]; -+ adaptivity->low_rate_tx_fail_th[2] = (u32)dm_value[4]; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set low_rate_tx_fail_th={%d,%d,%d}\n", -+ adaptivity->low_rate_tx_fail_th[0], -+ adaptivity->low_rate_tx_fail_th[1], -+ adaptivity->low_rate_tx_fail_th[2]); -+ } else { -+ adaptivity->is_dbg_low_rate_tx_fail_th = false; -+ } -+ } -+ -+out: -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_set_edcca_val(void *dm_void, u32 *val_buf, u8 val_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (val_len != 2) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[Error][adaptivity]Need val_len = 2\n"); -+ return; -+ } -+ phydm_set_edcca_threshold(dm, (s8)val_buf[1], (s8)val_buf[0]); -+} -+ -+boolean phydm_edcca_abort(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = dm->adapter; -+ u32 is_fw_in_psmode = false; -+#endif -+ -+ if (!(dm->support_ability & ODM_BB_ADAPTIVITY)) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, "adaptivity disable\n"); -+ return true; -+ } -+ -+ if (dm->pause_ability & ODM_BB_ADAPTIVITY) { -+ PHYDM_DBG(dm, DBG_ADPTVTY, "Return: Pause ADPTVTY in LV=%d\n", -+ dm->pause_lv_table.lv_adapt); -+ return true; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ((PADAPTER)adapter)->HalFunc.GetHwRegHandler(adapter, -+ HW_VAR_FW_PSMODE_STATUS, -+ (u8 *)(&is_fw_in_psmode)); -+ -+ /*@Disable EDCCA while under LPS mode, added by Roger, 2012.09.14.*/ -+ if (is_fw_in_psmode) -+ return true; -+#endif -+ -+ return false; -+} -+ -+void phydm_edcca_thre_calc_jgr3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ u8 igi = dig_t->cur_ig_value; -+ s8 th_l2h = 0, th_h2l = 0; -+ -+ if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE) { -+ /*prevent pwdB clipping and result in Miss Detection*/ -+ adapt->l2h_dyn_min = (u8)(dm->th_l2h_ini - ADC_BACKOFF); -+ -+ if (igi < adapt->l2h_dyn_min) -+ th_l2h = igi + ADC_BACKOFF; -+ else -+ th_l2h = dm->th_l2h_ini; -+ -+ th_h2l = th_l2h - dm->th_edcca_hl_diff; -+ } else { -+ th_l2h = MAX_2(igi + TH_L2H_DIFF_IGI, EDCCA_TH_L2H_LB); -+ th_h2l = th_l2h - EDCCA_HL_DIFF_NORMAL; -+ } -+ adapt->th_l2h = th_l2h; -+ adapt->th_h2l = th_h2l; -+ -+ phydm_set_edcca_threshold(dm, adapt->th_h2l, adapt->th_l2h); -+} -+ -+void phydm_edcca_thre_calc(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ u8 igi = dig_t->cur_ig_value; -+ s8 th_l2h = 0, th_h2l = 0; -+ s8 diff = 0, igi_target = adapt->igi_base; -+ -+ if (dm->support_ic_type & ODM_IC_PWDB_EDCCA) { -+ /*@fix EDCCA hang issue*/ -+ if (dm->support_ic_type & ODM_RTL8812) { -+ /*@ADC_mask disable*/ -+ odm_set_bb_reg(dm, R_0x800, BIT(10), 1); -+ /*@ADC_mask enable*/ -+ odm_set_bb_reg(dm, R_0x800, BIT(10), 0); -+ } -+ -+ if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE) { -+ /*@Limit IGI upper bound for adaptivity*/ -+ phydm_dig_up_bound_lmt_en(dm); -+ diff = igi_target - (s8)igi; -+ th_l2h = dm->th_l2h_ini + diff; -+ if (th_l2h > 10) -+ th_l2h = 10; -+ -+ th_h2l = th_l2h - dm->th_edcca_hl_diff; -+ } else { -+ th_l2h = 70 - igi; -+ th_h2l = th_l2h - EDCCA_HL_DIFF_NORMAL; -+ } -+ /*replace lower bound to prevent EDCCA always equal 1*/ -+ if (th_h2l < adapt->h2l_lb) -+ th_h2l = adapt->h2l_lb; -+ if (th_l2h < adapt->l2h_lb) -+ th_l2h = adapt->l2h_lb; -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "adapt_igi_up=0x%x, l2h_lb = %d dBm, h2l_lb = %d dBm\n", -+ adapt->adapt_igi_up, -+ IGI_2_DBM(adapt->l2h_lb + adapt->adapt_igi_up), -+ IGI_2_DBM(adapt->h2l_lb + adapt->adapt_igi_up)); -+ } else { /* < JGR2 & N*/ -+ if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE) { -+ /*need to consider PwdB upper bound for 8814 later IC*/ -+ adapt->l2h_dyn_min = (u8)(dm->th_l2h_ini + igi_target); -+ -+ if (igi < adapt->l2h_dyn_min) -+ th_l2h = igi; -+ else -+ th_l2h = adapt->l2h_dyn_min; -+ -+ th_h2l = th_l2h - dm->th_edcca_hl_diff; -+ } else { -+ th_l2h = MAX_2(igi + TH_L2H_DIFF_IGI, EDCCA_TH_L2H_LB); -+ th_h2l = th_l2h - EDCCA_HL_DIFF_NORMAL; -+ } -+ } -+ -+ adapt->th_l2h = th_l2h; -+ adapt->th_h2l = th_h2l; -+ -+ phydm_set_edcca_threshold(dm, adapt->th_h2l, adapt->th_l2h); -+} -+#endif -+ -+void phydm_set_edcca_threshold_api(void *dm_void) -+{ -+#ifdef PHYDM_SUPPORT_ADAPTIVITY -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ -+ if (*dm->edcca_mode != PHYDM_EDCCA_ADAPT_MODE) -+ return; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_edcca_thre_calc_jgr3(dm); -+ else -+ phydm_edcca_thre_calc(dm); -+ -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "API :IGI = 0x%x, th_l2h = %d, th_h2l = %d\n", -+ dm->dm_dig_table.cur_ig_value, adapt->th_l2h, adapt->th_h2l); -+#endif -+} -+ -+void phydm_adaptivity_info_init(void *dm_void, enum phydm_adapinfo cmn_info, -+ u32 value) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; -+ -+ switch (cmn_info) { -+ case PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE: -+ dm->carrier_sense_enable = (boolean)value; -+ break; -+ case PHYDM_ADAPINFO_TH_L2H_INI: -+ dm->th_l2h_ini = (s8)value; -+ break; -+ case PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF: -+ dm->th_edcca_hl_diff = (s8)value; -+ break; -+ case PHYDM_ADAPINFO_AP_NUM_TH: -+ adaptivity->ap_num_th = (u8)value; -+ break; -+ case PHYDM_ADAPINFO_SWITCH_TH_L2H_INI_IN_BAND: -+ adaptivity->switch_th_l2h_ini_in_band = (u8)value; -+ break; -+ default: -+ break; -+ } -+} -+ -+void phydm_adaptivity_info_update(void *dm_void, enum phydm_adapinfo cmn_info, -+ u32 value) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ -+ /*This init variable may be changed in run time.*/ -+ switch (cmn_info) { -+ case PHYDM_ADAPINFO_DOMAIN_CODE_2G: -+ adapt->regulation_2g = (u8)value; -+ break; -+ case PHYDM_ADAPINFO_DOMAIN_CODE_5G: -+ adapt->regulation_5g = (u8)value; -+ break; -+ default: -+ break; -+ } -+} -+ -+void phydm_adaptivity_init(void *dm_void) -+{ -+#ifdef PHYDM_SUPPORT_ADAPTIVITY -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; -+ -+ /* @[Config Adaptivity]*/ -+ if (!dm->edcca_mode) { -+ pr_debug("[%s] warning!\n", __func__); -+ dm->edcca_mode = &dm->u8_dummy; -+ dm->support_ability &= ~ODM_BB_ADAPTIVITY; -+ return; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (!dm->carrier_sense_enable) { -+ if (dm->th_l2h_ini == 0 && -+ !adaptivity->switch_th_l2h_ini_in_band) -+ phydm_set_l2h_th_ini(dm); -+ } else { -+ phydm_set_l2h_th_ini_carrier_sense(dm); -+ } -+ -+ if (dm->th_edcca_hl_diff == 0) -+ dm->th_edcca_hl_diff = 7; -+ -+ if (dm->wifi_test & RT_WIFI_LOGO) -+ dm->support_ability &= ~ODM_BB_ADAPTIVITY; -+ -+ if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE) -+ adaptivity->mode_cvrt_en = true; -+ else -+ adaptivity->mode_cvrt_en = false; -+ -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ adaptivity->l2h_ini_range_max = 45; -+ adaptivity->l2h_ini_range_min = 35; -+ } else { -+ adaptivity->l2h_ini_range_max = dm->th_l2h_ini; -+ adaptivity->l2h_ini_range_min = dm->th_l2h_ini; -+ } -+ adaptivity->low_rate_tx_fail_th[0] = 2; -+ adaptivity->low_rate_tx_fail_th[1] = 2; -+ adaptivity->low_rate_tx_fail_th[2] = 5; -+ adaptivity->is_dbg_low_rate_tx_fail_th = false; -+ adaptivity->rts_drop_en = false; -+ phydm_l2h_ini_recorder_reset(dm); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ if (!dm->carrier_sense_enable) { -+ if (dm->th_l2h_ini == 0) -+ phydm_set_l2h_th_ini(dm); -+ } else { -+ phydm_set_l2h_th_ini_carrier_sense(dm); -+ } -+ -+ if (dm->th_edcca_hl_diff == 0) -+ dm->th_edcca_hl_diff = 7; -+ -+ if (dm->wifi_test || *dm->mp_mode) -+ dm->support_ability &= ~ODM_BB_ADAPTIVITY; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (dm->carrier_sense_enable) { -+ phydm_set_l2h_th_ini_carrier_sense(dm); -+ dm->th_edcca_hl_diff = 7; -+ } else { -+ dm->th_l2h_ini = dm->TH_L2H_default; /*set by mib*/ -+ dm->th_edcca_hl_diff = dm->th_edcca_hl_diff_default; -+ } -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ if (!dm->carrier_sense_enable) { -+ if (dm->th_l2h_ini == 0) -+ phydm_set_l2h_th_ini(dm); -+ } else { -+ phydm_set_l2h_th_ini_carrier_sense(dm); -+ } -+ -+ if (dm->th_edcca_hl_diff == 0) -+ dm->th_edcca_hl_diff = 7; -+#endif -+ -+ adaptivity->debug_mode = false; -+ adaptivity->th_l2h_ini_backup = dm->th_l2h_ini; -+ adaptivity->th_edcca_hl_diff_backup = dm->th_edcca_hl_diff; -+ adaptivity->igi_base = 0x32; -+ adaptivity->adapt_igi_up = 0; -+ adaptivity->h2l_lb = 0; -+ adaptivity->l2h_lb = 0; -+ adaptivity->l2h_dyn_min = 0; -+ adaptivity->th_l2h = 0x7f; -+ adaptivity->th_h2l = 0x7f; -+ -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) -+ adaptivity->adaptivity_dbg_port = 0x208; -+ else if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ adaptivity->adaptivity_dbg_port = 0x209; -+ -+ if (dm->support_ic_type & ODM_IC_11N_SERIES && -+ !(dm->support_ic_type & ODM_IC_PWDB_EDCCA)) { -+ if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) { -+ /*set to page B1*/ -+ odm_set_bb_reg(dm, R_0xe28, BIT(30), 0x1); -+ /*@0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ -+ odm_set_bb_reg(dm, R_0xbc0, BIT(27) | BIT(26), 0x1); -+ odm_set_bb_reg(dm, R_0xe28, BIT(30), 0x0); -+ } else { -+ /*@0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ -+ odm_set_bb_reg(dm, R_0xe24, BIT(21) | BIT(20), 0x1); -+ } -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES && -+ !(dm->support_ic_type & ODM_IC_PWDB_EDCCA)) { -+ /*@0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ -+ odm_set_bb_reg(dm, R_0x944, BIT(29) | BIT(28), 0x1); -+ } -+ -+ if (dm->support_ic_type & ODM_IC_PWDB_EDCCA) { -+ phydm_search_pwdb_lower_bound(dm); -+ if (phydm_re_search_condition(dm)) -+ phydm_search_pwdb_lower_bound(dm); -+ } else { -+ /*resume to no link state*/ -+ phydm_set_edcca_threshold(dm, 0x7f, 0x7f); -+ } -+ -+ /*@whether to ignore EDCCA*/ -+ phydm_mac_edcca_state(dm, PHYDM_DONT_IGNORE_EDCCA); -+ -+ /*@forgetting factor setting*/ -+ phydm_set_forgetting_factor(dm); -+ -+ /*@EDCCA behavior based on maximum or mean power*/ -+ phydm_edcca_decision_opt(dm); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ adaptivity->igi_up_bound_lmt_val = 180; -+#else -+ adaptivity->igi_up_bound_lmt_val = 90; -+#endif -+ adaptivity->igi_up_bound_lmt_cnt = 0; -+ adaptivity->igi_lmt_en = false; -+#endif -+} -+ -+void phydm_adaptivity(void *dm_void) -+{ -+#ifdef PHYDM_SUPPORT_ADAPTIVITY -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ if (phydm_edcca_abort(dm)) -+ return; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ phydm_check_adaptivity(dm); /*@Check adaptivity enable*/ -+ -+ if (!dm->carrier_sense_enable && -+ !adapt->debug_mode && -+ adapt->switch_th_l2h_ini_in_band) -+ phydm_set_l2h_th_ini_win(dm); -+ -+ if (dm->support_ic_type & ODM_RTL8822C) -+ phydm_dyn_l2h_ini(dm); -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (!adapt->debug_mode) { -+ if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE && -+ dm->carrier_sense_enable) -+ phydm_set_l2h_th_ini_carrier_sense(dm); -+ else if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE) -+ phydm_set_l2h_th_ini(dm); -+ } -+#endif -+ PHYDM_DBG(dm, DBG_ADPTVTY, "%s ====>\n", __func__); -+ PHYDM_DBG(dm, DBG_ADPTVTY, "mode = %s, debug_mode = %d\n", -+ (*dm->edcca_mode ? -+ (dm->carrier_sense_enable ? -+ "CARRIER SENSE" : -+ "ADAPTIVITY") : -+ "NORMAL"), -+ adapt->debug_mode); -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_edcca_thre_calc_jgr3(dm); -+ else -+ phydm_edcca_thre_calc(dm); -+ -+ if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE) -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "th_l2h_ini = %d, th_edcca_hl_diff = %d\n", -+ dm->th_l2h_ini, dm->th_edcca_hl_diff); -+ if (dm->support_ic_type & ODM_IC_PWDB_EDCCA) -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "IGI = 0x%x, th_l2h = %d dBm, th_h2l = %d dBm\n", -+ dig_t->cur_ig_value, -+ IGI_2_DBM(adapt->th_l2h + dig_t->cur_ig_value), -+ IGI_2_DBM(adapt->th_h2l + dig_t->cur_ig_value)); -+ else -+ PHYDM_DBG(dm, DBG_ADPTVTY, -+ "IGI = 0x%x, th_l2h = %d dBm, th_h2l = %d dBm\n", -+ dig_t->cur_ig_value, -+ IGI_2_DBM(adapt->th_l2h), -+ IGI_2_DBM(adapt->th_h2l)); -+#endif -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adaptivity.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adaptivity.h -new file mode 100644 -index 000000000..35adabddd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adaptivity.h -@@ -0,0 +1,146 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMADAPTIVITY_H__ -+#define __PHYDMADAPTIVITY_H__ -+ -+#define ADAPTIVITY_VERSION "9.7.08" /*@20210121 changed by Archer, -+ *add dynamic th_l2h_ini -+ */ -+#define ADC_BACKOFF 12 -+#define EDCCA_TH_L2H_LB 48 -+#define TH_L2H_DIFF_IGI 8 -+#define EDCCA_HL_DIFF_NORMAL 8 -+#define IGI_2_DBM(igi) (igi - 110) -+#define L2H_INI_RECORD_NUM 4 -+#define L2H_INI_LIMIT_PERIOD 60 /*60 sec*/ -+/*@ [PHYDM-337][Old IC] EDCCA TH = IGI + REG setting*/ -+#define ODM_IC_PWDB_EDCCA (ODM_RTL8188E | ODM_RTL8723B | ODM_RTL8192E |\ -+ ODM_RTL8881A | ODM_RTL8821 | ODM_RTL8812) -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) -+ #define ADAPT_DC_BACKOFF 2 -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #define ADAPT_DC_BACKOFF 4 -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ #define ADAPT_DC_BACKOFF 0 -+#endif -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+enum phydm_regulation_type { -+ REGULATION_FCC = 0, -+ REGULATION_MKK = 1, -+ REGULATION_ETSI = 2, -+ REGULATION_WW = 3, -+ MAX_REGULATION_NUM = 4 -+}; -+#endif -+struct phydm_l2h_ini_recorder_strcut { -+ u8 l2h_ini_bitmap; /*@Don't add any new parameter before this*/ -+ s8 l2h_ini_hist[L2H_INI_RECORD_NUM]; -+ u32 low_rate_tx_fail_hist[L2H_INI_RECORD_NUM]; -+ u8 damping_limit_en; -+ s8 damping_limit_val; /*@Limit l2h_ini_dyn_max*/ -+ u32 limit_time; -+ u32 limit_low_rate_tx_fail; -+}; -+ -+enum phydm_edcca_mode { -+ PHYDM_EDCCA_NORMAL_MODE = 0, -+ PHYDM_EDCCA_ADAPT_MODE = 1 -+}; -+ -+enum phydm_adapinfo { -+ PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE = 0, -+ PHYDM_ADAPINFO_TH_L2H_INI, -+ PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, -+ PHYDM_ADAPINFO_AP_NUM_TH, -+ PHYDM_ADAPINFO_DOMAIN_CODE_2G, -+ PHYDM_ADAPINFO_DOMAIN_CODE_5G, -+ PHYDM_ADAPINFO_SWITCH_TH_L2H_INI_IN_BAND -+}; -+ -+enum phydm_mac_edcca_type { -+ PHYDM_IGNORE_EDCCA = 0, -+ PHYDM_DONT_IGNORE_EDCCA = 1 -+}; -+ -+enum phydm_adaptivity_debug_mode { -+ PHYDM_ADAPT_MSG = 0, -+ PHYDM_ADAPT_DEBUG = 1, -+ PHYDM_ADAPT_RESUME = 2, -+ PHYDM_L2H_INI_DEBUG = 3 -+}; -+ -+struct phydm_adaptivity_struct { -+ struct phydm_l2h_ini_recorder_strcut l2h_ini_recorder_t; -+ u32 low_rate_tx_fail_th[3]; -+ u32 rts_drop_limit_time; -+ s8 l2h_ini_range_max; /*@l2h_ini_dynamic_max*/ -+ s8 l2h_ini_range_min; /*@l2h_ini_dynamic_min*/ -+ boolean rts_drop_en; -+ boolean is_dbg_low_rate_tx_fail_th; -+ boolean is_adapt_by_dig; -+ boolean mode_cvrt_en; -+ s8 th_l2h_ini_backup; -+ s8 th_edcca_hl_diff_backup; -+ s8 igi_base; -+ s8 h2l_lb; -+ s8 l2h_lb; -+ u8 ap_num_th; -+ u8 l2h_dyn_min; -+ u32 adaptivity_dbg_port; /*N:0x208, AC:0x209*/ -+ u8 debug_mode; -+ u16 igi_up_bound_lmt_cnt; /*@When igi_up_bound_lmt_cnt !=0, limit IGI upper bound to "adapt_igi_up"*/ -+ u16 igi_up_bound_lmt_val; /*@max value of igi_up_bound_lmt_cnt*/ -+ boolean igi_lmt_en; -+ u8 adapt_igi_up; -+ u32 rvrt_val[2]; /*@all rvrt_val for pause API must set to u32*/ -+ s8 th_l2h; -+ s8 th_h2l; -+ u8 regulation_2g; -+ u8 regulation_5g; -+ u8 switch_th_l2h_ini_in_band; -+}; -+ -+#ifdef PHYDM_SUPPORT_ADAPTIVITY -+void phydm_adaptivity_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void phydm_set_edcca_val(void *dm_void, u32 *val_buf, u8 val_len); -+#endif -+ -+void phydm_set_edcca_threshold_api(void *dm_void); -+ -+void phydm_adaptivity_info_init(void *dm_void, enum phydm_adapinfo cmn_info, -+ u32 value); -+ -+void phydm_adaptivity_info_update(void *dm_void, enum phydm_adapinfo cmn_info, -+ u32 value); -+ -+void phydm_adaptivity_init(void *dm_void); -+ -+void phydm_adaptivity(void *dm_void); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adc_sampling.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adc_sampling.c -new file mode 100644 -index 000000000..7cf20a822 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adc_sampling.c -@@ -0,0 +1,1789 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (PHYDM_LA_MODE_SUPPORT) -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #if (RTL8197F_SUPPORT || RTL8822B_SUPPORT || RTL8192F_SUPPORT) -+ #include "rtl8197f/Hal8197FPhyReg.h" -+ #include "WlanHAL/HalMac88XX/halmac_reg2.h" -+ #else -+ #include "WlanHAL/HalHeader/HalComReg.h" -+ #endif -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #if WPP_SOFTWARE_TRACE -+ #include "phydm_adc_sampling.tmh" -+ #endif -+#endif -+ -+#if RTL8814B_SUPPORT -+boolean phydm_la_finish_addr_recover_8814B(void *dm_void, u32 *finish_addr) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ boolean recover_success; -+ -+ if (!(dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C))) -+ return false; -+ -+ if (smp->la_buff_mode == ADCSMP_BUFF_HALF) { -+ if (*finish_addr < 0x4000) /*0~0x4000*/ -+ *finish_addr += 0x8000; -+ -+ recover_success = true; -+ } else { -+ if (*finish_addr >= 0x4000 && *finish_addr < 0x8000) -+ recover_success = true; -+ else -+ recover_success = false; -+ } -+ pr_debug("[8814B] recover_success=(%d)\n", recover_success); -+ -+ return recover_success; -+} -+#endif -+ -+#if RTL8198F_SUPPORT -+void phydm_la_pre_run(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct rt_adcsmp_string *buf = &smp->adc_smp_buf; -+ u8 i = 0; -+ u8 tmp = 0; -+ u8 target_polling_bit = BIT(1); -+ -+ if (!(dm->support_ic_type & ODM_RTL8198F)) -+ return; -+ -+ if (smp->la_trig_mode == PHYDM_ADC_MAC_TRIG) -+ return; -+ -+ /*pre run */ -+ /*force to bb trigger*/ -+ odm_set_mac_reg(dm, R_0x7c0, BIT(3), 0); -+ /*dma_trig_and(AND1) output 1*/ -+ odm_set_bb_reg(dm, R_0x1ce4, 0xf0000000, 0x0); -+ /*r_dma_trigger_AND1_inv = 1*/ -+ odm_set_bb_reg(dm, R_0x1ce8, BIT5, 1); /*@AND 1 val*/ -+ /* polling bit for BB ADC mode */ -+ odm_set_mac_reg(dm, R_0x7c0, BIT(1), 1); -+ -+ pr_debug("buf[end:start]=(0x%x~0x%x)\n", buf->end_pos, buf->start_pos); -+ -+ do { -+ tmp = odm_read_1byte(dm, R_0x7c0); -+ if ((tmp & target_polling_bit) == false) { -+ pr_debug("LA pre-run fail.\n"); -+ phydm_la_stop(dm); -+ phydm_release_bb_dbg_port(dm); -+ } else { -+ ODM_delay_ms(100); -+ pr_debug("LA pre-run while_cnt = %d.\n", i); -+ i++; -+ } -+ } while (i < 3); -+ -+ /*r_dma_trigger_AND1_inv = 0*/ -+ odm_set_bb_reg(dm, R_0x1ce8, BIT5, 0); /*@AND 1 val*/ -+ -+ if (smp->la_trig_mode == PHYDM_ADC_MAC_TRIG) -+ odm_set_mac_reg(dm, R_0x7c0, BIT(3), 1); -+} -+#endif -+ -+#if (RTL8821C_SUPPORT || RTL8195B_SUPPORT) -+void -+phydm_la_clk_en(void *dm_void, boolean enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 val = (enable) ? 1 : 0; -+ -+ if (!(dm->support_ic_type & (ODM_RTL8195B | ODM_RTL8821C))) -+ return; -+ -+ if (dm->support_ic_type == ODM_RTL8821C && -+ dm->cut_version == ODM_CUT_A) -+ return; -+ -+ odm_set_bb_reg(dm, R_0x95c, BIT(23), val); -+} -+#endif -+ -+#if (RTL8723F_SUPPORT) -+void -+phydm_la_mac_clk_en(void *dm_void, boolean enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 val = (enable) ? 1 : 0; -+ -+ if (!(dm->support_ic_type & ODM_RTL8723F)) -+ return; -+ -+ odm_set_mac_reg(dm, R_0x1008, BIT(1), val); -+ /*Set IRAM2/3*/ -+ odm_set_mac_reg(dm, R_0x1000, 0xc0, 0x0); -+ odm_set_mac_reg(dm, R_0x1000, 0x3000, 0x3); -+} -+#endif -+ -+#if (RTL8197F_SUPPORT) -+void -+phydm_la_stop_dma_8197f(void *dm_void, enum phydm_backup_type opt) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ -+ if (dm->support_ic_type != ODM_RTL8197F) -+ return; -+ -+ if (opt == PHYDM_BACKUP) { -+ /*Stop DMA*/ -+ smp->backup_dma = odm_get_mac_reg(dm, R_0x300, 0xffff); -+ odm_set_mac_reg(dm, R_0x300, 0x7fff, 0x7fff); -+ } else { /*restore*/ -+ /*Resume DMA*/ -+ odm_set_mac_reg(dm, R_0x300, 0x7fff, smp->backup_dma); -+ } -+} -+#endif -+ -+#ifdef PHYDM_COMPILE_LA_STORE_IN_IMEM -+void -+phydm_la_mv_data_2_tx_buffer(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct rt_adcsmp_string *buf = &smp->adc_smp_buf; -+ -+ if (!(dm->support_ic_type & PHYDM_LA_STORE_IN_IMEM_IC)) -+ return; -+ -+ pr_debug("GetTxPktBuf from iMEM\n"); -+ odm_set_mac_reg(dm, R_0x7c0, BIT(0), 0x0); /*Disable LA mode HW block*/ -+ -+ /* 98F LA memory loccation is separate from normal -+ * driver use, DMA is no longer required to stop -+ */ -+ #if (RTL8197F_SUPPORT) -+ phydm_la_stop_dma_8197f(dm, PHYDM_BACKUP); -+ #endif -+ -+ /* @move LA mode content from IMEM to TxPktBuffer -+ * Source : OCPBASE_IMEM 0x00000000 -+ * Destination : OCPBASE_TXBUF 0x18780000 -+ * Length : 64K -+ */ -+ GET_HAL_INTERFACE(dm->priv)->init_ddma_handler(dm->priv, -+ OCPBASE_IMEM, -+ OCPBASE_TXBUF -+ + buf->start_pos, -+ 0x10000); -+} -+#endif -+ -+ -+#if(RTL8723F_SUPPORT) -+void -+phydm_la_mv_data_2_tx_buffer_rtl8723f(void *dm_void, u32 source, u32 dest, u32 length) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct rt_adcsmp_string *buf = &smp->adc_smp_buf; -+ //u32 ch0ctrl = (BIT(29)|BIT(31)); -+ u32 ch0ctrl = BIT(31); -+ u32 cnt=25000; -+ -+ pr_debug("GetTxPktBuf from iMEM\n"); -+ /*Disable LA mode HW block*/ -+ odm_set_mac_reg(dm, R_0x7c0, BIT(0), 0x0); -+ -+ /* @move LA mode content from IMEM to TxPktBuffer -+ * Source : OCPBASE_IMEM 0x14040000 -+ * Destination : OCPBASE_TXBUF 0x18780000 -+ * Length : 32K -+ */ -+ /* -+ OCPBASE_IMEM = 0x18600000; -+ OCPBASE_TXBUF = 0x18780000; -+ GET_HAL_INTERFACE(dm->priv)->init_ddma_handler(dm->priv, -+ OCPBASE_IMEM, -+ OCPBASE_TXBUF -+ + buf->start_pos, -+ 0x8000); -+ */ -+ -+ // TODO: Replace all register define & bit define -+ -+ -+ //check if ddma ch0 is idle -+ while(odm_get_mac_reg(dm, R_0x1208 , BIT(31))){ -+ ODM_delay_ms(10); -+ cnt--; -+ if(cnt==0){ -+ pr_debug("1 InitDDMA88XX polling fail \n"); -+ return; -+ } -+ } -+ -+ ch0ctrl |= length & 0x3FFFF; -+ -+ //check if chksum continuous -+ //ch0ctrl |= BIT(24); -+ -+ odm_set_mac_reg(dm, R_0x1200, MASKDWORD, source); /*0x1200[31:0]:Source Address*/ -+ odm_set_mac_reg(dm, R_0x1204, MASKDWORD, dest); /*0x1204[31:0]:Destination Address*/ -+ odm_set_mac_reg(dm, R_0x1208, MASKDWORD, ch0ctrl); /*0x1208[17:0]:DMA Length*/ -+//check if ddma ch0 is idle -+ while(odm_get_mac_reg(dm, R_0x1208 , BIT(31))){ -+ ODM_delay_ms(10); -+ cnt--; -+ if(cnt==0){ -+ pr_debug("2 InitDDMA88XX polling fail \n"); -+ return ; -+ } -+ } -+} -+#endif -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ -+void phydm_la_bb_adv_reset_jgr3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct la_adv_trig *adv = &smp->adv_trig_table; -+ -+ odm_memory_set(dm, adv, 0, sizeof(struct la_adv_trig)); -+ -+} -+ -+void phydm_la_bb_adv_trig_setting_jgr3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct la_adv_trig *adv = &smp->adv_trig_table; -+ -+ pr_debug(" *ADV BB-trig = %d\n", adv->la_adv_bbtrigger_en); -+ -+ if (!adv->la_adv_bbtrigger_en) { /*normal LA mode & back to default*/ -+ /*@AND0*/ -+ odm_set_bb_reg(dm, R_0x1ce4, BIT(27), 0); -+ -+ /*@AND1*/ -+ odm_set_bb_reg(dm, R_0x1ce4, MASKH4BITS, 0); -+ odm_set_bb_reg(dm, R_0x1ce8, BIT(5), 0); /*@AND 1 inv*/ -+ /*@AND2*/ -+ odm_set_bb_reg(dm, R_0x1ce8, 0x3c0, 0); -+ odm_set_bb_reg(dm, R_0x1ce8, BIT(15), 0); /*@AND 2 inv*/ -+ /*@AND3*/ -+ odm_set_bb_reg(dm, R_0x1ce8, 0xf0000, 0); -+ odm_set_bb_reg(dm, R_0x1ce8, BIT(25), 0); /*@AND 3 inv*/ -+ /*@AND4*/ -+ odm_set_bb_reg(dm, R_0x1cf0, MASKDWORD, 0); /*@AND 4 mask en*/ -+ odm_set_bb_reg(dm, R_0x1ce8, BIT(26), 0); /*@AND 4 inv*/ -+ } else { -+ /*@AND0 */ -+ /*path 1 default: enable ori. BB trigger*/ -+ odm_set_bb_reg(dm, R_0x1ce4, BIT(27), -+ (adv->la_ori_bb_dis ? 1 : 0)); -+ -+ /* @AND1 */ -+ odm_set_bb_reg(dm, R_0x1ce8, BIT(5), adv->la_and1_inv); -+ odm_set_bb_reg(dm, R_0x1ce4, MASKH4BITS, adv->la_and1_sel); -+ odm_set_bb_reg(dm, R_0x1ce8, 0x1f, adv->la_and1_val); -+ -+ /*@AND2 */ -+ odm_set_bb_reg(dm, R_0x1ce8, BIT(15), adv->la_and2_inv); -+ odm_set_bb_reg(dm, R_0x1ce8, 0x3c0, adv->la_and2_sel); -+ odm_set_bb_reg(dm, R_0x1ce8, 0x7c00, adv->la_and2_val); -+ -+ /*@AND3 */ -+ odm_set_bb_reg(dm, R_0x1ce8, BIT(25), adv->la_and3_inv); -+ odm_set_bb_reg(dm, R_0x1ce8, 0xf0000, adv->la_and3_sel); -+ odm_set_bb_reg(dm, R_0x1ce8, 0x1f00000, adv->la_and3_val); -+ -+ /*@AND4 */ -+ odm_set_bb_reg(dm, R_0x1ce8, BIT(26), adv->la_and4_inv); -+ odm_set_bb_reg(dm, R_0x1cf0, MASKDWORD, adv->la_and4_mask); -+ odm_set_bb_reg(dm, R_0x1cec, MASKDWORD, adv->la_and4_bitmap); -+ } -+} -+ -+void phydm_la_bb_adv_cmd_show_jgr3(void *dm_void, u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct la_adv_trig *adv = &smp->adv_trig_table; -+ -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ " *And0 Disable=%d\n", adv->la_ori_bb_dis); -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ " *And1{sel,val,inv}={0x%x,0x%x,%d}\n *And2{sel,val,inv}={0x%x,0x%x,%d}\n *And3{sel,val,inv}={0x%x,0x%x,%d}\n", -+ adv->la_and1_sel, adv->la_and1_val, adv->la_and1_inv, -+ adv->la_and2_sel, adv->la_and2_val, adv->la_and2_inv, -+ adv->la_and3_sel, adv->la_and3_val, adv->la_and3_inv); -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ " *And4{mask,bitmap,inv}={0x%x,0x%x,%d}\n", -+ adv->la_and4_mask, adv->la_and4_bitmap, adv->la_and4_inv); -+} -+ -+void phydm_la_bb_adv_cmd_jgr3(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct la_adv_trig *adv = &smp->adv_trig_table; -+ u32 var1[10] = {0}; -+ u32 adv_trig_en; -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return; -+ -+ if ((strcmp(input[2], "show") == 0)) { -+ phydm_la_bb_adv_cmd_show_jgr3(dm, _used, output, _out_len); -+ return; -+ } -+ -+ PHYDM_SSCANF(input[2], DCMD_HEX, &var1[0]); -+ PHYDM_SSCANF(input[3], DCMD_HEX, &var1[1]); -+ PHYDM_SSCANF(input[4], DCMD_HEX, &var1[2]); -+ PHYDM_SSCANF(input[5], DCMD_HEX, &var1[3]); -+ PHYDM_SSCANF(input[6], DCMD_HEX, &var1[4]); -+ -+ adv_trig_en = var1[0]; -+ -+ if (adv_trig_en != 1) { -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "Back to Ori-BB-trig\n"); -+ phydm_la_bb_adv_reset_jgr3(dm); -+ return; -+ } -+ -+ adv->la_adv_bbtrigger_en = true; -+ -+ if (var1[1] == 0) { -+ adv->la_ori_bb_dis = (boolean)var1[2]; -+ } else if (var1[1] == 1) { -+ adv->la_and1_sel = (u8)var1[2]; -+ adv->la_and1_val = (u8)var1[3]; -+ adv->la_and1_inv = (boolean)var1[4]; -+ } else if (var1[1] == 2) { -+ adv->la_and2_sel = (u8)var1[2]; -+ adv->la_and2_val = (u8)var1[3]; -+ adv->la_and2_inv = (boolean)var1[4]; -+ } else if (var1[1] == 3) { -+ adv->la_and3_sel = (u8)var1[2]; -+ adv->la_and3_val = (u8)var1[3]; -+ adv->la_and2_inv = (boolean)var1[4]; -+ } else if (var1[1] == 4) { -+ adv->la_and4_mask = var1[2]; -+ adv->la_and4_bitmap = var1[3]; -+ adv->la_and4_inv = (boolean)var1[4]; -+ } -+ -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "[Adv_trig_en=%d]\n\n", adv_trig_en); -+ -+ phydm_la_bb_adv_cmd_show_jgr3(dm, _used, output, _out_len); -+} -+ -+void phydm_la_cmd_fast_jgr3(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct la_adv_trig *adv = &smp->adv_trig_table; -+ enum auto_detection_state ad_mode; -+ const u8 ofdm_codeword[8] = {0xb, 0xf, 0xa, 0xe, 0x9, 0xd, 0x8, 0xc}; -+ u32 codeword; -+ u8 rate_idx; -+ u32 trig_time_cca = 0; -+ s32 val_sign32_tmp = 0; -+ u32 var[10] = {0}; -+ u8 bw = *dm->band_width; -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) { -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "Only Support for JGR-3 ICs\n"); -+ return; -+ } -+ -+ if (bw > 2) { -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "Not Support for BW > %dM\n", 20 << bw); -+ return; -+ } -+ -+ PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var[0]); -+ PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var[1]); -+ PHYDM_SSCANF(input[4], DCMD_DECIMAL, &var[2]); -+ -+ trig_time_cca = ((smp->smp_number_max >> (bw + 1)) / 10) -+ - (2 << (2 - bw)) - (2 - bw); -+ -+ if (var[0] < 10) { -+ /*=== [Type: 0 ~ 10] : CCA P-edge trigger ==========================*/ -+ /*--- Basic Trigger Setting --------------------------------*/ -+ smp->la_trig_mode = 1; -+ smp->la_trig_sig_sel = 2; -+ smp->la_trigger_time = trig_time_cca; -+ smp->la_mac_mask_or_hdr_sel = 0; -+ smp->la_trigger_edge = 0; -+ smp->la_smp_rate = 2 - bw; -+ smp->la_count = 0; -+ if (var[0] == 0) { /*AGC*/ -+ smp->la_dma_type = 5; -+ smp->la_dbg_port = 0x870; -+ } else if (var[0] == 1) { /*EVM*/ -+ smp->la_dma_type = 4; -+ smp->la_dbg_port = 0x392; -+ } else if (var[0] == 2) { /*SNR*/ -+ smp->la_dma_type = 4; -+ if (var[1] == 0) -+ smp->la_dbg_port = 0x89e; -+ else -+ smp->la_dbg_port = 0xa9e; -+ } else if (var[0] == 3) { /*CFO*/ -+ smp->la_dma_type = 4; -+ if (var[1] == 0) -+ smp->la_dbg_port = 0x88c; -+ else -+ smp->la_dbg_port = 0xa8c; -+ } else if (var[0] == 4) { /*ADC*/ -+ if (var[1] == 0) { -+ smp->la_dma_type = 0; -+ smp->la_dbg_port = 0x880; -+ } else { -+ smp->la_dma_type = 1; -+ smp->la_dbg_port = 0xa80; -+ } -+ } -+ /*--- Adv-Trigger Setting------------------------------------*/ -+ adv->la_adv_bbtrigger_en = false; -+ } else if (var[0] < 20) { -+ /*=== [Type: 10 ~ 19]: RX-EVM Trigger ===============================*/ -+ /*--- Basic Trigger Setting ---------------------------------*/ -+ smp->la_trig_mode = 0; -+ smp->la_trig_sig_sel = 0; -+ smp->la_mac_mask_or_hdr_sel = 0; -+ smp->la_trigger_edge = 0; -+ smp->la_smp_rate = 2 - bw; -+ smp->la_count = 0; -+ smp->la_dma_type = 4; -+ smp->la_dbg_port = 0x392; -+ -+ /*--- Adv-Trigger Setting -----------------------------------*/ -+ phydm_la_bb_adv_reset_jgr3(dm); -+ adv->la_adv_bbtrigger_en = true; -+ -+ /*And[0]*/ -+ adv->la_ori_bb_dis = true; -+ -+ /*And[1]*/ -+ adv->la_and1_inv = 0; -+ adv->la_and1_sel = 4; /*RX-state*/ -+ if (var[2] == 0) { -+ /*L-preamble 8+8+4 = 20*/ -+ smp->la_trigger_time = trig_time_cca - 20; -+ /*Legacy Data*/ -+ adv->la_and1_val = 5; -+ } else if (var[2] == 1) { -+ /*HT-preamble (8+8+4) + (8+4+4*Nrx) = 32 + Nrx * 4*/ -+ smp->la_trigger_time = trig_time_cca - 32 - -+ (dm->num_rf_path * 4); -+ /*HT Data*/ -+ adv->la_and1_val = 18; -+ } else { -+ /*VHT-preamble (8+8+4) + (8+4+4*Nrx) +4 = 36 + Nrx * 4*/ -+ smp->la_trigger_time = trig_time_cca - 36 - -+ (dm->num_rf_path * 4); -+ /*VHT Data*/ -+ adv->la_and1_val = 18; -+ } -+ -+ /*And[2]*/ -+ adv->la_and2_inv = 0; -+ adv->la_and2_sel = 0; /*Disable*/ -+ -+ /*And[3]*/ -+ adv->la_and2_inv = 0; -+ adv->la_and3_sel = 0; /*Disable*/ -+ -+ /*And[4]*/ -+ adv->la_and4_inv = 0; -+ -+ if (var[0] == 11) { -+ /*[>= -X dB]*/ -+ if (var[1] == 2) { -+ adv->la_and4_bitmap = 0; -+ adv->la_and4_mask = 0x1; -+ } else if (var[1] == 4) { -+ adv->la_and4_bitmap = 0; -+ adv->la_and4_mask = 0x3; -+ } else if (var[1] == 8) { -+ adv->la_and4_bitmap = 0; -+ adv->la_and4_mask = 0x7; -+ } else if (var[1] == 16) { -+ adv->la_and4_bitmap = 0; -+ adv->la_and4_mask = 0xf; -+ } else if (var[1] == 32) { -+ adv->la_and4_bitmap = 0; -+ adv->la_and4_mask = 0x1f; -+ } else if (var[1] == 64) { -+ adv->la_and4_bitmap = 0; -+ adv->la_and4_mask = 0x3f; -+ } else { -+ PDM_SNPF(*_out_len, *_used, output + *_used, -+ *_out_len - *_used, -+ "Not Support >= -%d dB\n", var[1]); -+ return; -+ } -+ } else if (var[0] == 10) { -+ /*[<= -X dB]*/ -+ if (var[1] == 2) { -+ adv->la_and4_bitmap = 0x7e; -+ adv->la_and4_mask = 0x7e; -+ } else if (var[1] == 4) { -+ adv->la_and4_bitmap = 0x7c; -+ adv->la_and4_mask = 0x7c; -+ } else if (var[1] == 8) { -+ adv->la_and4_bitmap = 0x78; -+ adv->la_and4_mask = 0x78; -+ } else if (var[1] == 16) { -+ adv->la_and4_bitmap = 0x70; -+ adv->la_and4_mask = 0x70; -+ } else if (var[1] == 32) { -+ adv->la_and4_bitmap = 0x60; -+ adv->la_and4_mask = 0x60; -+ } else if (var[1] == 64) { -+ adv->la_and4_bitmap = 0x40; -+ adv->la_and4_mask = 0x40; -+ } else { -+ PDM_SNPF(*_out_len, *_used, output + *_used, -+ *_out_len - *_used, -+ "Not Support <= -%d dB\n", var[1]); -+ return; -+ } -+ } else if (var[0] == 12) { -+ /*[= -X dB]*/ -+ val_sign32_tmp = 0 - (s32)var[1]; -+ adv->la_and4_bitmap = (u32)(val_sign32_tmp & 0x7f); -+ adv->la_and4_mask = 0x7f; -+ } -+ } else if (var[0] < 30) { -+ /*=== [Type: 20 ~ 29]: RX-Rate Trigger ==============================*/ -+ /*--- Basic Trigger Setting ---------------------------------*/ -+ smp->la_trig_mode = 0; -+ smp->la_trig_sig_sel = 0; -+ smp->la_mac_mask_or_hdr_sel = 0; -+ smp->la_trigger_edge = 0; -+ smp->la_smp_rate = 2 - bw; -+ smp->la_count = 0; -+ smp->la_dma_type = 4; -+ -+ rate_idx = (u8)var[1]; -+ -+ /*--- Adv-Trigger Setting -----------------------------------*/ -+ phydm_la_bb_adv_reset_jgr3(dm); -+ adv->la_adv_bbtrigger_en = true; -+ -+ /*And[0]*/ -+ adv->la_ori_bb_dis = true; -+ -+ /*And[1]*/ -+ adv->la_and1_inv = 0; -+ adv->la_and1_sel = 4; /*RX-state*/ -+ -+ if (rate_idx <= ODM_RATE54M && rate_idx >= ODM_RATE6M) { -+ ad_mode = AD_LEGACY_MODE; -+ codeword = (u32)ofdm_codeword[rate_idx - ODM_RATE6M]; -+ smp->la_dbg_port = 0x3a9; -+ /*L-preamble 8+8 = 16*/ -+ smp->la_trigger_time = trig_time_cca - 20; -+ /*Legacy Data*/ -+ adv->la_and1_val = 5; -+ } else if (rate_idx <= ODM_RATEMCS31) { -+ ad_mode = AD_HT_MODE; -+ codeword = (u32)(rate_idx - ODM_RATEMCS0); -+ smp->la_dbg_port = 0x3aa; -+ /*HT-preamble (8+8+4) + (8+4+4*Nrx) = 32 + Nrx * 4*/ -+ smp->la_trigger_time = trig_time_cca - 32 - -+ (dm->num_rf_path * 4); -+ /*HT,VHT Data*/ -+ adv->la_and1_val = 18; -+ } else if (rate_idx <= ODM_RATEVHTSS4MCS9) { -+ ad_mode = AD_VHT_MODE; -+ codeword = (u32)phydm_rate_order_compute(dm, rate_idx); -+ codeword--; -+ smp->la_dbg_port = 0x3ab; -+ /*VHT-preamble (8+8+4) + (8+4+4*Nrx) = 36 + Nrx * 4*/ -+ smp->la_trigger_time = trig_time_cca - 36 - -+ (dm->num_rf_path * 4); -+ /*HT,VHT Data*/ -+ adv->la_and1_val = 18; -+ } else { -+ PDM_SNPF(*_out_len, *_used, output + *_used, -+ *_out_len - *_used, -+ "Not Support\n"); -+ return; -+ } -+ -+ /*And[2]*/ -+ adv->la_and2_inv = 0; -+ adv->la_and2_sel = 0; /*Disable*/ -+ -+ /*And[3]*/ -+ adv->la_and2_inv = 0; -+ adv->la_and3_sel = 0; /*Disable*/ -+ -+ /*And[4]*/ -+ adv->la_and4_inv = 0; -+ -+ if (var[0] == 20) { -+ if (ad_mode == AD_LEGACY_MODE) { -+ adv->la_and4_bitmap = codeword; -+ adv->la_and4_mask = 0x3000000f; -+ } else if (ad_mode == AD_HT_MODE) { -+ adv->la_and4_bitmap = (2 << 28) | codeword; -+ adv->la_and4_mask = 0x3000003f; -+ } else { /* AD_VHT_MODE*/ -+ adv->la_and4_bitmap = (1 << 28) | -+ (codeword << 4); -+ adv->la_and4_mask = 0x300000f0; -+ } -+ } else { -+ PDM_SNPF(*_out_len, *_used, output + *_used, -+ *_out_len - *_used, -+ "Not Support\n"); -+ return; -+ } -+ } else { -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "Not Support\n"); -+ return; -+ } -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "[Basic-Trigger]\n"); -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ " *echo lamode 1 %d %d %d %d %d %x %d %d %d\n\n", -+ smp->la_trig_mode, smp->la_trig_sig_sel, smp->la_dma_type, -+ smp->la_trigger_time, smp->la_mac_mask_or_hdr_sel, -+ smp->la_dbg_port, smp->la_trigger_edge, smp->la_smp_rate, -+ smp->la_count); -+ pr_debug("echo lamode 1 %d %d %d %d %d %x %d %d %d\n\n", -+ smp->la_trig_mode, smp->la_trig_sig_sel, smp->la_dma_type, -+ smp->la_trigger_time, smp->la_mac_mask_or_hdr_sel, -+ smp->la_dbg_port, smp->la_trigger_edge, smp->la_smp_rate, -+ smp->la_count); -+ -+ if (adv->la_adv_bbtrigger_en) { -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "[Adv-Trigger]\n"); -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ " *And0 Disable=%d\n", adv->la_ori_bb_dis); -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ " *And1{sel,val,inv}={0x%x,0x%x,%d}\n *And2{sel,val,inv}={0x%x,0x%x,%d}\n *And3{sel,val,inv}={0x%x,0x%x,%d}\n", -+ adv->la_and1_sel, adv->la_and1_val, adv->la_and1_inv, -+ adv->la_and2_sel, adv->la_and2_val, adv->la_and2_inv, -+ adv->la_and3_sel, adv->la_and3_val, adv->la_and3_inv); -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ " *And4{mask,bitmap,inv}={0x%x,0x%x,%d}\n", -+ adv->la_and4_mask, adv->la_and4_bitmap, -+ adv->la_and4_inv); -+ } -+ phydm_la_set(dm); -+} -+ -+#endif -+ -+void -+phydm_la_buffer_print(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct rt_adcsmp_string *buf = &smp->adc_smp_buf; -+ u64 la_pattern_msb, la_pattern_lsb; -+ u64 la_pattern, la_pattern_part; -+ s64 tmp_s64; -+ u64 mask = 0xffffffff; -+ u8 mask_length = 0; -+ u32 i; -+ u32 idx; -+ u32 var[10] = {0}; -+ -+ if (!buf->octet || buf->length == 0 || buf->length < smp->smp_number) -+ return; -+ -+ PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var[0]); -+ PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var[1]); -+ PHYDM_SSCANF(input[4], DCMD_DECIMAL, &var[2]); -+ PHYDM_SSCANF(input[5], DCMD_DECIMAL, &var[3]); -+ -+ pr_debug("echo lamode 1 %d %d %d %d %d %x %d %d %d\n\n", -+ smp->la_trig_mode, smp->la_trig_sig_sel, smp->la_dma_type, -+ smp->la_trigger_time, smp->la_mac_mask_or_hdr_sel, -+ smp->la_dbg_port, smp->la_trigger_edge, smp->la_smp_rate, -+ smp->la_count); -+ pr_debug("[LA Data Dump] smp_number = %d\n", smp->smp_number); -+ pr_debug("Dump_Start\n"); -+ -+ if (var[0] == 0) { -+ for (i = 0; i < smp->smp_number; i++) { -+ idx = i << 1; -+ pr_debug("%08x%08x\n", buf->octet[idx], -+ buf->octet[idx + 1]); -+ } -+ } else if (var[0] == 1) { -+ /*------------------------*/ -+ if (var[1] == 0) -+ pr_debug("[Hex]\n"); -+ else if (var[1] == 1) -+ pr_debug("[Dec unsigned]\n"); -+ else if (var[1] == 2) -+ pr_debug("[Dec signed]\n"); -+ -+ pr_debug("BIT[%d:%d]\n", var[3], var[2]); -+ -+ if (var[2] > var[3]) { -+ pr_debug("[Warning] BIT_L > BIT_H\n"); -+ return; -+ } -+ -+ mask_length = (u8)(var[3] - var[2] + 1); -+ mask = phydm_gen_bitmask(mask_length) << var[2]; -+ /*------------------------*/ -+ for (i = 0; i < smp->smp_number; i++) { -+ idx = i << 1; -+ la_pattern_msb = (u64)buf->octet[idx]; -+ la_pattern_lsb = (u64)buf->octet[idx + 1]; -+ la_pattern = (la_pattern_msb << 32) | la_pattern_lsb; -+ la_pattern_part = (la_pattern & mask) >> var[2]; -+ -+ if (var[1] == 0) { -+ pr_debug("0x%llx\n", la_pattern_part); -+ } else if (var[1] == 1) { -+ pr_debug("%llu\n", la_pattern_part); -+ } else if (var[1] == 2) { -+ tmp_s64 = phydm_cnvrt_2_sign_64(la_pattern_part, -+ mask_length); -+ pr_debug("%lld\n", tmp_s64); -+ } -+ } -+ } -+ pr_debug("Dump_End\n\n"); -+} -+ -+void -+phydm_la_buffer_release(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct rt_adcsmp_string *buf = &smp->adc_smp_buf; -+ -+ if (buf->length != 0x0) { -+ odm_free_memory(dm, buf->octet, buf->length); -+ buf->length = 0x0; -+ } -+} -+ -+boolean -+phydm_la_buffer_allocate(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ #endif -+ struct rt_adcsmp_string *buf = &smp->adc_smp_buf; -+ boolean ret = true; -+ -+ pr_debug("[LA mode BufferAllocate]\n"); -+ -+ if (buf->length == 0) { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (PlatformAllocateMemoryWithZero(adapter, (void **)& -+ buf->octet, -+ buf->buffer_size) != -+ RT_STATUS_SUCCESS) -+ ret = false; -+ #else -+ odm_allocate_memory(dm, (void **)&buf->octet, buf->buffer_size); -+ -+ if (!buf->octet) -+ ret = false; -+ #endif -+ -+ if (ret) -+ buf->length = buf->buffer_size; -+ } -+ -+ return ret; -+} -+ -+void phydm_la_access_tx_pkt_buf(void *dm_void, u32 addr, u32 buff_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct rt_adcsmp_string *buf = &smp->adc_smp_buf; -+ u32 page; -+ u32 data_l = 0, data_h = 0; -+ -+ #if (RTL8192F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8192F) { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ indirect_access_sdram_8192f(dm->adapter, TX_PACKET_BUFFER, -+ TRUE, (u16)addr >> 3, 0, -+ &data_h, &data_l); -+ #else -+ odm_write_1byte(dm, R_0x0106, 0x69); -+ odm_set_mac_reg(dm, R_0x0140, MASKDWORD, addr >> 3); -+ data_l = odm_get_mac_reg(dm, R_0x0144, MASKDWORD); -+ data_h = odm_get_mac_reg(dm, R_0x0148, MASKDWORD); -+ odm_write_1byte(dm, R_0x0106, 0x0); -+ #endif -+ } else -+ #endif -+ { -+ /* Reg140=0x780+(addr>>12), -+ * addr=0x30~0x3F, total 16 pages -+ */ -+ page = addr >> 12; -+ -+ if (page != smp->txff_page) { -+ smp->txff_page = page; -+ odm_set_mac_reg(dm, R_0x0140, MASKLWORD, 0x780 + page); -+ } -+ data_l = odm_read_4byte(dm, R_0x8000 + (addr & 0xfff)); -+ data_h = odm_read_4byte(dm, R_0x8000 + (addr & 0xfff) + 4); -+ } -+ -+ buf->octet[buff_idx] = data_h; -+ buf->octet[buff_idx + 1] = data_l; -+ -+ /*@==== [Print LA Patterns] ==========================================*/ -+ if (smp->is_la_print) -+ pr_debug("%08x%08x\n", data_h, data_l); -+} -+ -+void phydm_la_get_tx_pkt_buf(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct rt_adcsmp_string *buf = &smp->adc_smp_buf; -+ u32 i = 0, value32 = 0; -+ u32 addr = 0, finish_addr = 0; /* @(unit: 8Byte)*/ -+ boolean is_round_up = false; -+ u32 addr_8byte = 0; -+ u32 round_up_point = 0; -+ u32 index = 0; -+ u32 imem_base; -+ u32 txbuf_base; -+ u32 dma_len; -+ u32 imem_start_addr; -+ u32 imem_start_addr_offset; -+ u32 txbuff_start_addr; -+ u32 tx_buff_addr; -+ -+ #if (RTL8814B_SUPPORT) -+ boolean recover_success = true; -+ #endif -+ -+ odm_memory_set(dm, buf->octet, 0, buf->length); -+ pr_debug("GetTxPktBuf\n"); -+ -+ /*@==== [Get LA Report] ==============================================*/ -+ if (dm->support_ic_type & ODM_RTL8192F) { -+ value32 = odm_read_4byte(dm, R_0x7f0); -+ is_round_up = (boolean)((value32 & BIT(31)) >> 31); -+ finish_addr = (value32 & 0x7FFF8000) >> 15; /*@16 bit (unit: 8Byte)*/ -+ } else { -+ odm_write_1byte(dm, R_0x0106, 0x69); -+ value32 = odm_read_4byte(dm, R_0x7c0); -+ is_round_up = (boolean)((value32 & BIT(31)) >> 31); -+ -+ if (dm->support_ic_type & PHYDM_LA_STORE_IN_IMEM_IC) -+ finish_addr = (value32 & 0x7FFF8000) >> 15; /*@16 bit (unit: 8Byte)*/ -+ else -+ finish_addr = (value32 & 0x7FFF0000) >> 16; /*@15bit (unit: 8Byte)*/ -+ } -+ -+ #if (RTL8814B_SUPPORT) -+ recover_success = phydm_la_finish_addr_recover_8814B(dm, &finish_addr); -+ #endif -+ -+ pr_debug("start_addr = ((0x%x)), end_addr = ((0x%x)), buffer_size = ((0x%x))\n", -+ buf->start_pos, buf->end_pos, buf->buffer_size); -+ if (is_round_up) { -+ pr_debug("buf_start(0x%x)|----2---->|finish_addr(0x%x)|----1---->|buf_end(0x%x)\n", -+ buf->start_pos, finish_addr << 3, buf->end_pos); -+ addr = (finish_addr + 2) << 3; /*+1 or +2 ??*/ -+ round_up_point = (buf->end_pos - addr) >> 3; /*@Byte to 8Byte*/ -+ smp->smp_number = smp->smp_number_max; -+ pr_debug("is_round_up=(%d), round_up_point=(%d), 0x7c0/0x7F0=(0x%x), smp_number=(%d)\n", -+ is_round_up, round_up_point, value32, smp->smp_number); -+ } else { -+ pr_debug("buf_start(0x%x)|------->|finish_addr(0x%x) |buf_end(0x%x)\n", -+ buf->start_pos, finish_addr << 3, buf->end_pos); -+ addr = buf->start_pos; -+ addr_8byte = addr >> 3; -+ smp->smp_number = DIFF_2(addr_8byte, finish_addr); -+ -+ pr_debug("is_round_up=(%d), smp_number=(%d)\n", -+ is_round_up, smp->smp_number); -+ } -+ -+ /*@==== [Get LA Patterns in TXFF] ====================================*/ -+ pr_debug("Dump_Start\n"); -+#if(RTL8723F_SUPPORT) -+ imem_base = 0x14040000; -+ txbuf_base = 0x18780000; -+ dma_len = 0x8000; -+ txbuff_start_addr = txbuf_base; -+ imem_start_addr_offset = addr; -+ if (is_round_up) { -+ for(index = 0;index < 4;index++) { -+ dma_len = 0x8000; -+ imem_start_addr= imem_base + (imem_start_addr_offset&0x1FFFF); -+ -+ if((imem_start_addr_offset + 0x8000) >= buf->end_pos) { -+ dma_len = buf->end_pos-imem_start_addr_offset; -+ -+ phydm_la_mv_data_2_tx_buffer_rtl8723f(dm, imem_start_addr, txbuff_start_addr, dma_len); -+ -+ tx_buff_addr = 0; -+ for (i = 0; i < (dma_len >> 3); i++) { -+ phydm_la_access_tx_pkt_buf(dm, tx_buff_addr, i << 1); -+ tx_buff_addr += 8; -+ } -+ imem_start_addr = imem_base; -+ dma_len = 0x8000-dma_len; -+ phydm_la_mv_data_2_tx_buffer_rtl8723f(dm, imem_start_addr, txbuff_start_addr, dma_len); -+ -+ tx_buff_addr = 0; -+ for (i = 0; i < (dma_len >> 3); i++) { -+ phydm_la_access_tx_pkt_buf(dm, tx_buff_addr, i << 1); -+ tx_buff_addr += 8; -+ } -+ imem_start_addr_offset = dma_len; -+ } -+ else { -+ dma_len = 0x8000; -+ phydm_la_mv_data_2_tx_buffer_rtl8723f(dm, imem_start_addr, txbuff_start_addr, dma_len); -+ -+ tx_buff_addr = 0; -+ for (i = 0; i <4096; i++) { -+ phydm_la_access_tx_pkt_buf(dm, tx_buff_addr, i << 1); -+ tx_buff_addr += 8; -+ } -+ imem_start_addr_offset += 0x8000; -+ } -+ } -+ } else { -+ for(index = 0; index < 4;index++) { -+ imem_start_addr = imem_base + (imem_start_addr_offset & 0x1FFFF); -+ if ((imem_start_addr_offset + 0x8000) > (finish_addr << 3)) -+ dma_len = (finish_addr << 3) - imem_start_addr_offset; /*0x1208[17:0]:DMA Length*/ -+ phydm_la_mv_data_2_tx_buffer_rtl8723f(dm,imem_start_addr, txbuff_start_addr, dma_len); -+ tx_buff_addr = 0; -+ for (i = 0; i < (dma_len >> 3); i++) { -+ phydm_la_access_tx_pkt_buf(dm, tx_buff_addr, i << 1); -+ tx_buff_addr += 8; -+ } -+ dma_len = 0x8000; -+ imem_start_addr_offset += 0x8000; -+ if (imem_start_addr_offset > (finish_addr << 3)) -+ break; -+ } -+ } -+#else -+ -+ #ifdef PHYDM_COMPILE_LA_STORE_IN_IMEM -+ phydm_la_mv_data_2_tx_buffer(dm); -+ #endif -+ -+ #if (RTL8814B_SUPPORT) -+ if ((dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) && -+ !recover_success) { -+ addr = buf->start_pos; -+ smp->smp_number = smp->smp_number_max; -+ } -+ #endif -+ -+ for (i = 0; i < smp->smp_number; i++) { -+ phydm_la_access_tx_pkt_buf(dm, addr, i << 1); -+ addr += 8; -+ -+ if (addr >= buf->end_pos) -+ addr = buf->start_pos; /*Ring buffer*/ -+ } -+ -+ #if (RTL8197F_SUPPORT) -+ phydm_la_stop_dma_8197f(dm, PHYDM_RESTORE); -+ #endif -+#endif -+ pr_debug("Dump_End\n"); -+} -+ -+void phydm_la_set_trig_src(void *dm_void, u8 la_trig_mode) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 reg = (dm->support_ic_type == ODM_RTL8192F) ? R_0x7f0 : R_0x7c0; -+ -+ if (la_trig_mode == PHYDM_ADC_MAC_TRIG) -+ odm_set_mac_reg(dm, reg, BIT(3), 1); -+ else -+ odm_set_mac_reg(dm, reg, BIT(3), 0); -+} -+ -+void phydm_la_set_mac_iq_dump(void *dm_void, boolean impossible_trig_condi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ u32 reg_value = 0; -+ u32 reg1 = 0, reg2 = 0, reg3 = 0; -+ -+ if (dm->support_ic_type & ODM_RTL8192F) { -+ reg1 = R_0x7f0; -+ reg2 = R_0x7f4; -+ reg3 = R_0x7f8; -+ } else { -+ reg1 = R_0x7c0; -+ reg2 = R_0x7c4; -+ reg3 = R_0x7c8; -+ } -+ -+ odm_write_1byte(dm, reg1, 0); /*@clear all reg1*/ -+ /*@Enable LA mode HW block*/ -+ odm_set_mac_reg(dm, reg1, BIT(0), 1); -+ -+ #if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8723F) -+ phydm_la_mac_clk_en(dm, true); -+ #endif -+ -+ if (smp->la_trig_mode == PHYDM_MAC_TRIG) { -+ smp->la_dump_mode = LA_MAC_DBG_DUMP; -+ /*polling bit for MAC mode*/ -+ odm_set_mac_reg(dm, reg1, BIT(2), 1); -+ /*trigger mode for MAC*/ -+ odm_set_mac_reg(dm, reg1, 0x18, smp->la_trigger_edge); -+ pr_debug("[MAC_trig] ref_mask=(0x%x), ref_value=(0x%x), dbg_port =(0x%x)\n", -+ smp->la_mac_mask_or_hdr_sel, smp->la_trig_sig_sel, -+ smp->la_dbg_port); -+ /*@[Set MAC Debug Port]*/ -+ odm_set_mac_reg(dm, R_0xf4, BIT(16), 1); -+ odm_set_mac_reg(dm, R_0x38, 0xff0000, smp->la_dbg_port); -+ odm_set_mac_reg(dm, reg2, MASKDWORD, -+ smp->la_mac_mask_or_hdr_sel); -+ odm_set_mac_reg(dm, reg3, MASKDWORD, smp->la_trig_sig_sel); -+ } else { -+ smp->la_dump_mode = LA_BB_ADC_DUMP; -+ -+ if (smp->la_trig_mode == PHYDM_ADC_MAC_TRIG) { -+ /*polling bit for MAC trigger event*/ -+ if (impossible_trig_condi) -+ phydm_la_set_trig_src(dm, PHYDM_ADC_BB_TRIG); -+ else -+ phydm_la_set_trig_src(dm, PHYDM_ADC_MAC_TRIG); -+ -+ odm_set_mac_reg(dm, reg1, 0xc0, smp->la_trig_sig_sel); -+ -+ if (smp->la_trig_sig_sel == ADCSMP_TRIG_REG) { -+ /* @manual trigger reg1[5] = 0->1*/ -+ odm_set_mac_reg(dm, reg1, BIT(5), 1); -+ } -+ } -+ /*polling bit for BB ADC mode*/ -+ odm_set_mac_reg(dm, reg1, BIT(1), 1); -+ } -+ -+ reg_value = odm_get_mac_reg(dm, reg1, 0xff); -+ pr_debug("4. [Set MAC IQ dump] 0x%x[7:0]=(0x%x)\n", reg1, reg_value); -+ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, -+ ("4. [Set MAC IQ dump] 0x%x[7:0]=(0x%x)\n", reg1, -+ reg_value)); -+ #endif -+} -+ -+void phydm_la_set_bb_dbg_port(void *dm_void, boolean impossible_trig_condi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ -+ u8 trig_mode = smp->la_trig_mode; -+ u32 trig_sel = smp->la_trig_sig_sel; -+ u32 dbg_port = smp->la_dbg_port; -+ -+ if (trig_mode == PHYDM_MAC_TRIG) -+ trig_sel = 0; /*@ignore this setting*/ -+ -+ /*set BB debug port*/ -+ if (impossible_trig_condi) { -+ dbg_port = 0xf; -+ trig_sel = 0; -+ pr_debug("[BB Setting] fake-trigger!\n"); -+ } -+ -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, dbg_port)) { -+ pr_debug(" *Set dbg_port=(0x%x)\n", dbg_port); -+ } else { -+ dbg_port = phydm_get_bb_dbg_port_idx(dm); -+ pr_debug("[Set dbg_port fail!] Curr-DbgPort=0x%x\n", dbg_port); -+ } -+ -+ /*@debug port bit*/ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ odm_set_bb_reg(dm, R_0x95c, 0x1f, trig_sel); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ odm_set_bb_reg(dm, R_0x1ce4, 0x3e000, trig_sel); -+ #endif -+ } else { -+ odm_set_bb_reg(dm, R_0x9a0, 0x1f, trig_sel); -+ } -+ -+ if (smp->la_trig_mode == PHYDM_ADC_BB_TRIG) { -+ pr_debug(" *Set dbg_port[BIT] = %d\n", trig_sel); -+ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, -+ (" *Set dbg_port[BIT] = %d\n", trig_sel)); -+ #endif -+ } -+} -+ -+void phydm_la_set_bb(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ -+ u8 trig_mode = smp->la_trig_mode; -+ u8 edge = smp->la_trigger_edge; -+ u8 smp_rate = smp->la_smp_rate; -+ u8 dma_type = smp->la_dma_type; -+ u32 dbg_port_hdr_sel = 0; -+ char *trig_mode_word = NULL; -+ -+ pr_debug("3. [BB Setting] mode=(%d), Edge=(%s), smp_rate=(%dM), Dma_type=(%d)\n", -+ trig_mode, -+ (edge == 0) ? "P" : "N", 80 >> smp_rate, dma_type); -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ if (trig_mode == PHYDM_ADC_RF0_TRIG) -+ dbg_port_hdr_sel = 9; /*@DBGOUT_RFC_a[31:0]*/ -+ else if (trig_mode == PHYDM_ADC_RF1_TRIG) -+ dbg_port_hdr_sel = 8; /*@DBGOUT_RFC_b[31:0]*/ -+ else if ((trig_mode == PHYDM_ADC_BB_TRIG) || -+ (trig_mode == PHYDM_ADC_MAC_TRIG)) { -+ if (smp->la_mac_mask_or_hdr_sel <= 0xf) -+ dbg_port_hdr_sel = smp->la_mac_mask_or_hdr_sel; -+ else -+ dbg_port_hdr_sel = 0; -+ } -+ -+ phydm_bb_dbg_port_header_sel(dm, dbg_port_hdr_sel); -+ -+ odm_set_bb_reg(dm, R_0x8b4, BIT(7), 1);/*@update rpt every pkt*/ -+ odm_set_bb_reg(dm, R_0x95c, 0xf00, dma_type); -+ /*@0: posedge, 1: negedge*/ -+ odm_set_bb_reg(dm, R_0x95c, BIT(31), edge); -+ odm_set_bb_reg(dm, R_0x95c, 0xe0, smp_rate); -+ /* @(0:) '80MHz' -+ * (1:) '40MHz' -+ * (2:) '20MHz' -+ * (3:) '10MHz' -+ * (4:) '5MHz' -+ * (5:) '2.5MHz' -+ * (6:) '1.25MHz' -+ * (7:) '160MHz (for BW160 ic)' -+ */ -+ #if (RTL8821C_SUPPORT || RTL8195B_SUPPORT) -+ phydm_la_clk_en(dm, true); -+ #endif -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ odm_set_bb_reg(dm, R_0x1eb4, BIT(23), 0x1);/*@update rpt every pkt*/ -+ /*@MAC-PHY timing*/ -+ odm_set_bb_reg(dm, R_0x1ce4, BIT(7) | BIT(6), 0); -+ odm_set_bb_reg(dm, R_0x1cf4, BIT(23), 1); /*@LA mode on*/ -+ odm_set_bb_reg(dm, R_0x1ce4, 0x3f, dma_type); -+ /*@0: posedge, 1: negedge ??*/ -+ odm_set_bb_reg(dm, R_0x1ce4, BIT(26), edge); -+ odm_set_bb_reg(dm, R_0x1ce4, 0x700, smp_rate); -+ -+ phydm_la_bb_adv_trig_setting_jgr3(dm); -+ #endif -+ } else { -+ if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) -+ odm_set_bb_reg(dm, R_0xd00, BIT(26), 0x1); /*@update rpt every pkt*/ -+ -+ #if (RTL8192F_SUPPORT) -+ if ((dm->support_ic_type & ODM_RTL8192F)) -+ /*@LA reset HW block enable for true-mac asic*/ -+ odm_set_bb_reg(dm, R_0x9a0, BIT(15), 1); -+ #endif -+ -+ odm_set_bb_reg(dm, R_0x9a0, 0xf00, dma_type); -+ /*@0: posedge, 1: negedge*/ -+ odm_set_bb_reg(dm, R_0x9a0, BIT(31), edge); -+ odm_set_bb_reg(dm, R_0x9a0, 0xe0, smp_rate); -+ /* @(0:) '80MHz' -+ * (1:) '40MHz' -+ * (2:) '20MHz' -+ * (3:) '10MHz' -+ * (4:) '5MHz' -+ * (5:) '2.5MHz' -+ * (6:) '1.25MHz' -+ * (7:) '160MHz (for BW160 ic)' -+ */ -+ } -+} -+ -+void phydm_la_set_mac_trigger_time(void *dm_void, u32 trigger_time_mu_sec) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 time_unit_num = 0; -+ u32 unit = 0; -+ -+ if (trigger_time_mu_sec < 128) -+ unit = 0; /*unit: 1mu sec*/ -+ else if (trigger_time_mu_sec < 256) -+ unit = 1; /*unit: 2mu sec*/ -+ else if (trigger_time_mu_sec < 512) -+ unit = 2; /*unit: 4mu sec*/ -+ else if (trigger_time_mu_sec < 1024) -+ unit = 3; /*unit: 8mu sec*/ -+ else if (trigger_time_mu_sec < 2048) -+ unit = 4; /*unit: 16mu sec*/ -+ else if (trigger_time_mu_sec < 4096) -+ unit = 5; /*unit: 32mu sec*/ -+ else if (trigger_time_mu_sec < 8192) -+ unit = 6; /*unit: 64mu sec*/ -+ else if (trigger_time_mu_sec < 16384) -+ if (dm->support_ic_type & ODM_RTL8723F) -+ unit = 7; /*unit: 128mu sec*/ -+ -+ time_unit_num = (u8)(trigger_time_mu_sec >> unit); -+ -+ pr_debug("2. [Set Trigger Time] Trig_Time = ((%d)) * unit = ((2^%d us))\n", -+ time_unit_num, unit); -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, ( -+ "3. [Set Trigger Time] Trig_Time = ((%d)) * unit = ((2^%d us))\n", -+ time_unit_num, unit)); -+ #endif -+ -+ if (dm->support_ic_type & ODM_RTL8192F) { -+ odm_set_mac_reg(dm, R_0x7fc, BIT(2) | BIT(1) | BIT(0), unit); -+ odm_set_mac_reg(dm, R_0x7f0, 0x7f00, (time_unit_num & 0x7f)); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ odm_set_mac_reg(dm, R_0x7cc, BIT(20) | BIT(19) | BIT(18), unit); -+ odm_set_mac_reg(dm, R_0x7c0, 0x7f00, (time_unit_num & 0x7f)); -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ odm_set_mac_reg(dm, R_0x7cc, BIT(18) | BIT(17) | BIT(16), unit); -+ odm_set_mac_reg(dm, R_0x7c0, 0x7f00, (time_unit_num & 0x7f)); -+ #endif -+ } else { -+ odm_set_mac_reg(dm, R_0x7cc, BIT(20) | BIT(19) | BIT(18), unit); -+ odm_set_mac_reg(dm, R_0x7c0, 0x7f00, (time_unit_num & 0x7f)); -+ } -+} -+ -+void phydm_la_set_buff_mode(void *dm_void, enum la_buff_mode mode) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct rt_adcsmp_string *buf = &smp->adc_smp_buf; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ struct rtl8192cd_priv *priv = dm->priv; -+ u8 normal_LA_on = priv->pmib->miscEntry.normal_LA_on; -+#endif -+ u32 buff_size_base = 0; -+ u32 end_pos_tmp = 0; -+ -+ smp->la_buff_mode = mode; -+ switch (dm->support_ic_type) { -+ case ODM_RTL8814A: -+ buff_size_base = 0x10000; -+ end_pos_tmp = 0x40000; -+ break; -+ case ODM_RTL8822B: -+ case ODM_RTL8822C: -+ case ODM_RTL8812F: -+ buff_size_base = 0x20000; /*@WIN: TX_FIFO_SIZE_LA_8822C*/ -+ end_pos_tmp = 0x40000; -+ break; -+ case ODM_RTL8814B: -+ case ODM_RTL8814C: -+ buff_size_base = 0x30000; -+ end_pos_tmp = 0x60000; -+ break; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ case ODM_RTL8197F: -+ case ODM_RTL8198F: -+ case ODM_RTL8197G: -+ buff_size_base = 0x10000; -+ end_pos_tmp = (normal_LA_on == 1) ? 0x20000 : 0x10000; -+ break; -+#endif -+ case ODM_RTL8192F: -+ buff_size_base = 0xE000; -+ end_pos_tmp = 0x10000; -+ break; -+ case ODM_RTL8821C: -+ buff_size_base = 0x8000; -+ end_pos_tmp = 0x10000; -+ break; -+ case ODM_RTL8195B: -+ buff_size_base = 0x4000; -+ end_pos_tmp = 0x8000; -+ break; -+ case ODM_RTL8723F: -+ buff_size_base = 0x20000; -+ end_pos_tmp = 0x20000; -+ break; -+ default: -+ pr_debug("[%s] Warning!", __func__); -+ break; -+ } -+ -+ buf->buffer_size = buff_size_base; -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (mode == ADCSMP_BUFF_HALF) { -+ odm_set_mac_reg(dm, R_0x7cc, BIT(21), 0); -+ } else { -+ buf->buffer_size = buf->buffer_size << 1; -+ odm_set_mac_reg(dm, R_0x7cc, BIT(21), 1); -+ } -+ } else if (dm->support_ic_type & FULL_BUFF_MODE_SUPPORT) { -+ if (mode == ADCSMP_BUFF_HALF) { -+ odm_set_mac_reg(dm, R_0x7cc, BIT(30), 0); -+ } else { -+ buf->buffer_size = buf->buffer_size << 1; -+ odm_set_mac_reg(dm, R_0x7cc, BIT(30), 1); -+ } -+ } -+ -+ buf->end_pos = end_pos_tmp; -+ buf->start_pos = end_pos_tmp - buf->buffer_size; -+ smp->smp_number_max = buf->buffer_size >> 3; -+ -+ pr_debug("start_addr=(0x%x), end_addr=(0x%x), buffer_size=(0x%x), smp_number_max=(%d)\n", -+ buf->start_pos, buf->end_pos, buf->buffer_size, -+ smp->smp_number_max); -+} -+ -+void phydm_la_adc_smp_start(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ u8 tmp_u1b = 0; -+ u8 i = 0; -+ u8 polling_bit = 0; -+ u8 bkp_val = 0; -+ boolean polling_ok = false; -+ boolean impossible_trig_condi = (smp->en_fake_trig) ? true : false; -+ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, -+ ("1. [BB Setting] Mode=(%d), DbgPort=(0x%x), Edge=(%d), SmpRate=(%d), Trig_Sel=(0x%x), Dma_type=(%d)\n", -+ smp->la_trig_mode, smp->la_dbg_port, smp->la_trigger_edge, -+ smp->la_smp_rate, smp->la_trig_sig_sel, smp->la_dma_type)); -+ #endif -+ pr_debug("1. [BB Setting] trig_mode = ((%d)), dbg_port = ((0x%x)), Trig_Edge = ((%d)), smp_rate = ((%d)), Trig_Sel = ((0x%x)), Dma_type = ((%d))\n", -+ smp->la_trig_mode, smp->la_dbg_port, smp->la_trigger_edge, -+ smp->la_smp_rate, smp->la_trig_sig_sel, smp->la_dma_type); -+ -+ if(dm->support_ic_type & ODM_RTL8723F) -+ bkp_val = (u8)odm_get_mac_reg(dm, R_0x1008, BIT(1)); -+ -+ phydm_la_set_mac_trigger_time(dm, smp->la_trigger_time); -+ phydm_la_set_bb(dm); -+ phydm_la_set_bb_dbg_port(dm, impossible_trig_condi); -+ phydm_la_set_mac_iq_dump(dm, impossible_trig_condi); -+ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ watchdog_stop(dm->priv); -+ #endif -+ -+ if (impossible_trig_condi) { -+ ODM_delay_ms(100); -+ phydm_la_set_bb_dbg_port(dm, false); -+ -+ if (smp->la_trig_mode == PHYDM_ADC_MAC_TRIG) { -+ phydm_la_set_trig_src(dm, PHYDM_ADC_MAC_TRIG); -+ } -+ } -+#if RTL8198F_SUPPORT -+ phydm_la_pre_run(dm); -+#endif -+ polling_bit = (smp->la_dump_mode == LA_BB_ADC_DUMP) ? BIT(1) : BIT(2); -+ do { /*Polling time always use 100ms, when it exceed 2s, break loop*/ -+ if (dm->support_ic_type & ODM_RTL8192F) -+ tmp_u1b = odm_read_1byte(dm, R_0x7f0); -+ else -+ tmp_u1b = odm_read_1byte(dm, R_0x7c0); -+ -+ pr_debug("[%d] polling rpt=((0x%x))\n", i, tmp_u1b); -+ -+ if (smp->adc_smp_state != ADCSMP_STATE_SET) { -+ pr_debug("[state Error] state != ADCSMP_STATE_SET\n"); -+ break; -+ -+ } else if (tmp_u1b & polling_bit) { -+ ODM_delay_ms(100); -+ i++; -+ continue; -+ } else { -+ pr_debug("[LA Query OK] polling_bit=%d\n", polling_bit); -+ polling_ok = true; -+ break; -+ } -+ } while (i < 20); -+ -+ if (smp->adc_smp_state == ADCSMP_STATE_SET) { -+ if (polling_ok) -+ phydm_la_get_tx_pkt_buf(dm); -+ else -+ pr_debug("[Polling timeout]\n"); -+ } -+ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ watchdog_resume(dm->priv); -+ #endif -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ if (smp->adc_smp_state == ADCSMP_STATE_SET) -+ smp->adc_smp_state = ADCSMP_STATE_QUERY; -+ #endif -+ -+ pr_debug("[LA mode] la_count = ((%d))\n", smp->la_count); -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, -+ ("[LA mode] la_count = ((%d))\n", smp->la_count)); -+ #endif -+ -+ phydm_la_stop(dm); -+ -+ if (smp->la_count == 0) { -+ pr_debug("LA Dump finished ---------->\n\n\n"); -+ phydm_release_bb_dbg_port(dm); -+ -+ #if (RTL8821C_SUPPORT || RTL8195B_SUPPORT) -+ phydm_la_clk_en(dm, false); -+ #endif -+ #if (RTL8723F_SUPPORT) -+ if(dm->support_ic_type & ODM_RTL8723F) -+ phydm_la_mac_clk_en(dm, (bkp_val == 1) ? true : false); -+ #endif -+ } else { -+ smp->la_count--; -+ pr_debug("LA Dump more ---------->\n\n\n"); -+ phydm_la_set(dm); -+ } -+} -+ -+void phydm_la_set(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean is_set_success = true; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ -+ if (smp->adc_smp_state != ADCSMP_STATE_IDLE) -+ is_set_success = false; -+ else if (smp->adc_smp_buf.length == 0) -+ is_set_success = phydm_la_buffer_allocate(dm); -+ -+ if (!is_set_success) { -+ pr_debug("[LA Set Fail] LA_State=(%d)\n", smp->adc_smp_state); -+ return; -+ } -+ -+ smp->adc_smp_state = ADCSMP_STATE_SET; -+ -+ pr_debug("[LA Set Success] LA_State=(%d)\n", smp->adc_smp_state); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ pr_debug("ADCSmp_work_item_index=(%d)\n", smp->la_work_item_index); -+ -+ if (smp->la_work_item_index != 0) { -+ odm_schedule_work_item(&smp->adc_smp_work_item_1); -+ smp->la_work_item_index = 0; -+ } else { -+ odm_schedule_work_item(&smp->adc_smp_work_item); -+ smp->la_work_item_index = 1; -+ } -+#else -+ phydm_la_adc_smp_start(dm); -+#endif -+} -+ -+void phydm_la_cmd(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_LA_MODE)) -+ return; -+ -+#ifdef PHYDM_COMPILE_LA_STORE_IN_IMEM -+ if (dm->support_ic_type & PHYDM_LA_STORE_IN_IMEM_IC) { -+ if (dm->is_download_fw) -+ return; -+ } -+ #if RTL8198F_SUPPORT -+ if (dm->support_ic_type & ODM_RTL8198F) { -+ if (!*dm->mp_mode && !dm->priv->pmib->miscEntry.normal_LA_on) { -+ pr_debug("plz re-set normal_LA_on = 1 & DnUp.\n"); -+ return; -+ } -+ } -+ #endif -+#endif -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ /*@dbg_print("echo cmd input_num = %d\n", input_num);*/ -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "=====[LA Mode Help] =============================\n"); -+ /*Trigger*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "BB_trig: 1 0 {DbgPort Bit} {DMA#} {TrigTime} {DbgPort_head(Jgr2)}\n\t{DbgPort} {Edge: 0(P),1(N)} {f_smp:80 >> N} {Capture num}\n\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "MAC_trig: 1 1 {0-ok/1-fail/2-cca} {DMA#} {TrigTime} {DbgPort_head(Jgr2)}\n\t{DbgPort} {N/A} {f_smp:80 >> N} {Cpture num}\n\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "All: {En} {0:ADC_BB_trig,1:ADC MAC_trig,2:RF0,3:RF1,4:MAC}\n\t{BB:dbg_port[bit],BB_MAC:0-ok/1-fail/2-cca,MAC:ref} {DMA#} {TrigTime}\n\t{DbgPort_head/ref_mask} {dbg_port} {0:P_Edge, 1:N_Edge} {SpRate:0-80M,1-40M,2-20M} {Capture num}\n\n"); -+ /*Adv-Trig*/ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "adv show\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "adv {adv_trig_en} {0:And[0]_disable} {en}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "adv {adv_trig_en} {1~3: And[3:0]} {Sel} {Val} {Inv}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "adv {adv_trig_en} {4: And[4]} {BitMask} {BitVal} {Inv}\n\n"); -+ #endif -+ /*Setting*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "set {1:tx_buff_size} {0: half, 1:full}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "set {2:Fake Trigger} {en}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "set {3:Auto Print} {en}\n\n"); -+ /*Print*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "print {0: all(Hex)}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "print {1: partial} {0:hex 1:dec 2: s-dec} {bit_L} {bit_H}\n\n"); -+ -+ /*Fast Trigger*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fast {0: CCA trig & AGC Dbg Port}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fast {1: CCA trig & EVM Dbg Port}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fast {2: CCA trig & SNR Dbg Port}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fast {3: CCA trig & CFO Dbg Port}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fast {4: CCA trig & ADC output Dbg Port}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fast {10: EVM>=-X dB, 11: EVM<=-X dB} {X=2/4/8/16/32/64} {0:Lgcy, 1:HT}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fast {12: EVM=-X dB} {X} {0:Lgcy, 1:HT}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fast {20: RX-rate-idx=X} {X}\n"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "=================================================\n"); -+ } else if ((strcmp(input[1], "print") == 0)) { -+ phydm_la_buffer_print(dm, input, &used, output, &out_len); -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if ((strcmp(input[1], "fast") == 0)) { -+ phydm_la_cmd_fast_jgr3(dm, input, &used, output, &out_len); -+ -+ } else if ((strcmp(input[1], "adv") == 0)) { -+ phydm_la_bb_adv_cmd_jgr3(dm, input, &used, output, &out_len); -+#endif -+ } else if ((strcmp(input[1], "set") == 0)) { -+ PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); -+ -+ if (var1[1] == 1) { -+ PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var1[2]); -+ phydm_la_set_buff_mode(dm, (enum la_buff_mode)var1[2]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Buff_mode=(%d/2)\n", smp->la_buff_mode + 1); -+ } else if (var1[1] == 2) { -+ PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var1[2]); -+ smp->en_fake_trig = (boolean)var1[2]; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "en_fake_trig=(%d)\n", smp->en_fake_trig); -+ } else if (var1[1] == 3) { -+ PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var1[2]); -+ smp->is_la_print = (boolean)var1[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Auto print=(%d)\n", smp->is_la_print); -+ } -+ } else if (var1[0] == 1) { -+ PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); -+ -+ smp->la_trig_mode = (u8)var1[1]; -+ -+ if (smp->la_trig_mode == PHYDM_MAC_TRIG) -+ PHYDM_SSCANF(input[3], DCMD_HEX, &var1[2]); -+ else -+ PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var1[2]); -+ smp->la_trig_sig_sel = var1[2]; -+ -+ PHYDM_SSCANF(input[4], DCMD_DECIMAL, &var1[3]); -+ PHYDM_SSCANF(input[5], DCMD_DECIMAL, &var1[4]); -+ PHYDM_SSCANF(input[6], DCMD_HEX, &var1[5]); -+ 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]); -+ -+ smp->la_dma_type = (u8)var1[3]; -+ smp->la_trigger_time = var1[4]; /*unit: us*/ -+ smp->la_mac_mask_or_hdr_sel = var1[5]; -+ smp->la_dbg_port = var1[6]; -+ smp->la_trigger_edge = (u8)var1[7]; -+ smp->la_smp_rate = (u8)(var1[8] & 0x7); -+ smp->la_count = var1[9]; -+ -+ pr_debug("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]); -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, -+ ("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])); -+ #endif -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "a.En= ((1)), b.mode = ((%d)), c.Trig_Sel = ((0x%x)), d.Dma_type = ((%d))\n", -+ smp->la_trig_mode, smp->la_trig_sig_sel, -+ smp->la_dma_type); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "e.Trig_Time = ((%dus)), f.Dbg_head/mac_ref_mask = ((0x%x)), g.dbg_port = ((0x%x))\n", -+ smp->la_trigger_time, -+ smp->la_mac_mask_or_hdr_sel, smp->la_dbg_port); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "h.Trig_edge = ((%d)), i.smp rate = ((%d MHz)), j.Cap_num = ((%d))\n", -+ smp->la_trigger_edge, (80 >> smp->la_smp_rate), -+ smp->la_count); -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "k.en_new_bbtrigger = ((%d))\n", -+ smp->adv_trig_table.la_adv_bbtrigger_en); -+ #endif -+ -+ phydm_la_set(dm); -+ } else { -+ phydm_la_stop(dm); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Disable LA mode\n"); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_la_stop(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ -+ smp->adc_smp_state = ADCSMP_STATE_IDLE; -+} -+ -+void phydm_la_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ struct rt_adcsmp_string *buf = &smp->adc_smp_buf; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_LA_MODE)) -+ return; -+ -+ smp->adc_smp_state = ADCSMP_STATE_IDLE; -+ smp->is_la_print = true; -+ smp->en_fake_trig = false; -+ smp->txff_page = 0xffffffff; -+ phydm_la_set_buff_mode(dm, ADCSMP_BUFF_HALF); -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ phydm_la_bb_adv_reset_jgr3(dm); -+ #endif -+} -+ -+void adc_smp_de_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_LA_MODE)) -+ return; -+ -+ phydm_la_stop(dm); -+ phydm_la_buffer_release(dm); -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+void adc_smp_work_item_callback(void *context) -+{ -+ void *adapter = (void *)context; -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ struct rt_adcsmp *smp = &dm->adcsmp; -+ -+ pr_debug("[WorkItem Call back] LA_State=(%d)\n", smp->adc_smp_state); -+ phydm_la_adc_smp_start(dm); -+} -+#endif -+#endif /*@endif PHYDM_LA_MODE_SUPPORT*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adc_sampling.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adc_sampling.h -new file mode 100644 -index 000000000..d0ad1c173 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_adc_sampling.h -@@ -0,0 +1,172 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __INC_ADCSMP_H -+#define __INC_ADCSMP_H -+ -+#if (PHYDM_LA_MODE_SUPPORT) -+ -+/* 2020.07.03 [8723F] Fix SD4 compile error*/ -+#define DYNAMIC_LA_MODE "4.2" -+ -+/* @1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+#if (RTL8197F_SUPPORT || RTL8198F_SUPPORT || RTL8197G_SUPPORT) -+ #define PHYDM_COMPILE_LA_STORE_IN_IMEM -+#endif -+#endif -+ -+#define PHYDM_LA_STORE_IN_IMEM_IC (ODM_RTL8197F | ODM_RTL8198F | ODM_RTL8197G) -+ -+#define FULL_BUFF_MODE_SUPPORT (ODM_RTL8821C | ODM_RTL8195B | ODM_RTL8822C |\ -+ ODM_RTL8812F | ODM_RTL8814B | ODM_RTL8814C) -+ -+/* @ ============================================================ -+ * enumrate -+ * ============================================================ -+ */ -+enum la_dump_mode { -+ LA_BB_ADC_DUMP = 0, -+ LA_MAC_DBG_DUMP = 1 -+}; -+ -+enum rt_adcsmp_trig_sel { -+ PHYDM_ADC_BB_TRIG = 0, -+ PHYDM_ADC_MAC_TRIG = 1, -+ PHYDM_ADC_RF0_TRIG = 2, -+ PHYDM_ADC_RF1_TRIG = 3, -+ PHYDM_MAC_TRIG = 4 -+}; -+ -+enum rt_adcsmp_trig_sig_sel { -+ ADCSMP_TRIG_CRCOK = 0, -+ ADCSMP_TRIG_CRCFAIL = 1, -+ ADCSMP_TRIG_CCA = 2, -+ ADCSMP_TRIG_REG = 3 -+}; -+ -+enum rt_adcsmp_state { -+ ADCSMP_STATE_IDLE = 0, -+ ADCSMP_STATE_SET = 1, -+ ADCSMP_STATE_QUERY = 2 -+}; -+ -+enum la_buff_mode { -+ ADCSMP_BUFF_HALF = 0, -+ ADCSMP_BUFF_ALL = 1 /*Only use in MP Driver*/ -+}; -+ -+/* @ ============================================================ -+ * structure -+ * ============================================================ -+ */ -+ -+struct rt_adcsmp_string { -+ u32 *octet; -+ u32 length; -+ u32 buffer_size; -+ u32 start_pos; -+ u32 end_pos; /*@buf addr*/ -+}; -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+struct la_adv_trig { -+ boolean la_adv_bbtrigger_en; -+ boolean la_ori_bb_dis; -+ u8 la_and1_sel; -+ u8 la_and1_val; -+ boolean la_and1_inv; -+ u8 la_and2_sel; -+ u8 la_and2_val; -+ boolean la_and2_inv; -+ u8 la_and3_sel; -+ u8 la_and3_val; -+ boolean la_and3_inv; -+ u32 la_and4_mask; -+ u32 la_and4_bitmap; -+ boolean la_and4_inv; -+}; -+#endif -+ -+struct rt_adcsmp { -+ struct rt_adcsmp_string adc_smp_buf; -+ enum rt_adcsmp_state adc_smp_state; -+ enum la_buff_mode la_buff_mode; -+ enum la_dump_mode la_dump_mode; -+ u8 la_trig_mode; -+ u32 la_trig_sig_sel; -+ u8 la_dma_type; -+ u32 la_trigger_time; -+ /*@1.BB mode: Dbg port header sel, 2.MAC mode: for reference mask*/ -+ u32 la_mac_mask_or_hdr_sel; -+ u32 la_dbg_port; -+ u8 la_trigger_edge; -+ u8 la_smp_rate; -+ u32 la_count; -+ u32 smp_number; -+ u32 smp_number_max; -+ u32 txff_page; -+ boolean is_la_print; -+ boolean en_fake_trig; -+#if (RTL8197F_SUPPORT) -+ u32 backup_dma; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ u8 la_work_item_index; -+ RT_WORK_ITEM adc_smp_work_item; -+ RT_WORK_ITEM adc_smp_work_item_1; -+#endif -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ struct la_adv_trig adv_trig_table; -+#endif -+}; -+ -+/* @ ============================================================ -+ * Function Prototype -+ * ============================================================ -+ */ -+ -+void phydm_la_set(void *dm_void); -+ -+void phydm_la_cmd(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len); -+ -+void phydm_la_stop(void *dm_void); -+ -+void phydm_la_init(void *dm_void); -+ -+void adc_smp_de_init(void *dm_void); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+void adc_smp_work_item_callback(void *context); -+#endif -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdect.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdect.c -new file mode 100644 -index 000000000..a3213896c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdect.c -@@ -0,0 +1,888 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef 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_sw_ant_div_construct_scan_chnl( -+ void *adapter, -+ u8 scan_chnl) -+{ -+} -+ -+u8 odm_sw_ant_div_select_scan_chnl( -+ void *adapter) -+{ -+ return 0; -+} -+ -+void odm_single_dual_antenna_default_setting( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *dm_swat_table = &dm->dm_swat_table; -+ void *adapter = dm->adapter; -+ -+ u8 bt_ant_num = BT_GetPgAntNum(adapter); -+ /* Set default antenna A and B status */ -+ if (bt_ant_num == 2) { -+ dm_swat_table->ANTA_ON = true; -+ dm_swat_table->ANTB_ON = true; -+ -+ } else if (bt_ant_num == 1) { -+ /* Set antenna A as default */ -+ dm_swat_table->ANTA_ON = true; -+ dm_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_single_dual_antenna_detection( -+ void *dm_void, -+ u8 mode) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ struct sw_antenna_switch *dm_swat_table = &dm->dm_swat_table; -+ u32 current_channel, rf_loop_reg; -+ u8 n; -+ u32 reg88c, regc08, reg874, regc50, reg948, regb2c, reg92c, reg930, reg064, afe_rrx_wait_cca; -+ u8 initial_gain = 0x5a; -+ u32 PSD_report_tmp; -+ u32 ant_a_report = 0x0, ant_b_report = 0x0, ant_0_report = 0x0; -+ boolean is_result = true; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s============>\n", __func__); -+ -+ if (!(dm->support_ic_type & ODM_RTL8723B)) -+ return is_result; -+ -+ /* Retrieve antenna detection registry info, added by Roger, 2012.11.27. */ -+ if (!IS_ANT_DETECT_SUPPORT_SINGLE_TONE(((PADAPTER)adapter))) -+ return is_result; -+ -+ /* @1 Backup Current RF/BB Settings */ -+ -+ current_channel = odm_get_rf_reg(dm, RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK); -+ rf_loop_reg = odm_get_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK); -+ if (dm->support_ic_type & ODM_RTL8723B) { -+ reg92c = odm_get_bb_reg(dm, REG_DPDT_CONTROL, MASKDWORD); -+ reg930 = odm_get_bb_reg(dm, rfe_ctrl_anta_src, MASKDWORD); -+ reg948 = odm_get_bb_reg(dm, REG_S0_S1_PATH_SWITCH, MASKDWORD); -+ regb2c = odm_get_bb_reg(dm, REG_AGC_TABLE_SELECT, MASKDWORD); -+ reg064 = odm_get_mac_reg(dm, REG_SYM_WLBT_PAPE_SEL, BIT(29)); -+ odm_set_bb_reg(dm, REG_DPDT_CONTROL, 0x3, 0x1); -+ odm_set_bb_reg(dm, rfe_ctrl_anta_src, 0xff, 0x77); -+ odm_set_mac_reg(dm, REG_SYM_WLBT_PAPE_SEL, BIT(29), 0x1); /* @dbg 7 */ -+ odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, 0x3c0, 0x0); /* @dbg 8 */ -+ odm_set_bb_reg(dm, REG_AGC_TABLE_SELECT, BIT(31), 0x0); -+ } -+ -+ ODM_delay_us(10); -+ -+ /* Store A path Register 88c, c08, 874, c50 */ -+ reg88c = odm_get_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD); -+ regc08 = odm_get_bb_reg(dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD); -+ reg874 = odm_get_bb_reg(dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD); -+ regc50 = odm_get_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD); -+ -+ /* Store AFE Registers */ -+ if (dm->support_ic_type & ODM_RTL8723B) -+ afe_rrx_wait_cca = odm_get_bb_reg(dm, REG_RX_WAIT_CCA, MASKDWORD); -+ -+ /* Set PSD 128 pts */ -+ odm_set_bb_reg(dm, REG_FPGA0_PSD_FUNCTION, BIT(14) | BIT15, 0x0); /* @128 pts */ -+ -+ /* To SET CH1 to do */ -+ odm_set_rf_reg(dm, RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK, 0x7401); /* @channel 1 */ -+ -+ /* @AFE all on step */ -+ if (dm->support_ic_type & ODM_RTL8723B) -+ odm_set_bb_reg(dm, REG_RX_WAIT_CCA, MASKDWORD, 0x01c00016); -+ -+ /* @3 wire Disable */ -+ odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD, 0xCCF000C0); -+ -+ /* @BB IQK setting */ -+ odm_set_bb_reg(dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800E4); -+ odm_set_bb_reg(dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22208000); -+ -+ /* @IQK setting tone@ 4.34Mhz */ -+ odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008C1C); -+ odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, 0x01007c00); -+ -+ /* Page B init */ -+ odm_set_bb_reg(dm, REG_CONFIG_ANT_A, MASKDWORD, 0x00080000); -+ odm_set_bb_reg(dm, REG_CONFIG_ANT_A, MASKDWORD, 0x0f600000); -+ odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x01004800); -+ odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x10008c1f); -+ if (dm->support_ic_type & ODM_RTL8723B) { -+ odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82150016); -+ odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28150016); -+ } -+ odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x001028d0); -+ odm_set_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, 0x7f, initial_gain); -+ -+ /* @IQK Single tone start */ -+ odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); -+ odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); -+ odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); -+ -+ ODM_delay_us(10000); -+ -+ /* PSD report of antenna A */ -+ PSD_report_tmp = 0x0; -+ for (n = 0; n < 2; n++) { -+ PSD_report_tmp = phydm_get_psd_data(dm, 14, initial_gain); -+ if (PSD_report_tmp > ant_a_report) -+ ant_a_report = PSD_report_tmp; -+ } -+ -+ /* @change to Antenna B */ -+ if (dm->support_ic_type & ODM_RTL8723B) { -+ odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, 0xfff, 0x280); -+ odm_set_bb_reg(dm, REG_AGC_TABLE_SELECT, BIT(31), 0x1); -+ } -+ -+ ODM_delay_us(10); -+ -+ /* PSD report of antenna B */ -+ PSD_report_tmp = 0x0; -+ for (n = 0; n < 2; n++) { -+ PSD_report_tmp = phydm_get_psd_data(dm, 14, initial_gain); -+ if (PSD_report_tmp > ant_b_report) -+ ant_b_report = PSD_report_tmp; -+ } -+ -+ /* @Close IQK Single Tone function */ -+ odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); -+ -+ /* @1 Return to antanna A */ -+ if (dm->support_ic_type & ODM_RTL8723B) { -+ /* @external DPDT */ -+ odm_set_bb_reg(dm, REG_DPDT_CONTROL, MASKDWORD, reg92c); -+ -+ /* @internal S0/S1 */ -+ odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, MASKDWORD, reg948); -+ odm_set_bb_reg(dm, REG_AGC_TABLE_SELECT, MASKDWORD, regb2c); -+ odm_set_bb_reg(dm, rfe_ctrl_anta_src, MASKDWORD, reg930); -+ odm_set_mac_reg(dm, REG_SYM_WLBT_PAPE_SEL, BIT(29), reg064); -+ } -+ -+ odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD, reg88c); -+ odm_set_bb_reg(dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, regc08); -+ odm_set_bb_reg(dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, reg874); -+ odm_set_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, 0x7F, 0x40); -+ odm_set_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD, regc50); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, current_channel); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK, rf_loop_reg); -+ -+ /* Reload AFE Registers */ -+ if (dm->support_ic_type & ODM_RTL8723B) -+ odm_set_bb_reg(dm, REG_RX_WAIT_CCA, MASKDWORD, afe_rrx_wait_cca); -+ -+ if (dm->support_ic_type & ODM_RTL8723B) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "psd_report_A[%d]= %d\n", 2416, -+ ant_a_report); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "psd_report_B[%d]= %d\n", 2416, -+ ant_b_report); -+ -+ /* @2 Test ant B based on ant A is ON */ -+ if (ant_a_report >= 100 && ant_b_report >= 100 && ant_a_report <= 135 && ant_b_report <= 135) { -+ u8 TH1 = 2, TH2 = 6; -+ -+ if ((ant_a_report - ant_b_report < TH1) || (ant_b_report - ant_a_report < TH1)) { -+ dm_swat_table->ANTA_ON = true; -+ dm_swat_table->ANTB_ON = true; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Dual Antenna\n", -+ __func__); -+ } else if (((ant_a_report - ant_b_report >= TH1) && (ant_a_report - ant_b_report <= TH2)) || -+ ((ant_b_report - ant_a_report >= TH1) && (ant_b_report - ant_a_report <= TH2))) { -+ dm_swat_table->ANTA_ON = false; -+ dm_swat_table->ANTB_ON = false; -+ is_result = false; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "%s: Need to check again\n", -+ __func__); -+ } else { -+ dm_swat_table->ANTA_ON = true; -+ dm_swat_table->ANTB_ON = false; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "%s: Single Antenna\n", __func__); -+ } -+ dm->ant_detected_info.is_ant_detected = true; -+ dm->ant_detected_info.db_for_ant_a = ant_a_report; -+ dm->ant_detected_info.db_for_ant_b = ant_b_report; -+ dm->ant_detected_info.db_for_ant_o = ant_0_report; -+ -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "return false!!\n"); -+ is_result = false; -+ } -+ } -+ return is_result; -+} -+ -+/* @1 [2. Scan AP RSSI method] ================================================== */ -+ -+boolean -+odm_sw_ant_div_check_before_link( -+ void *dm_void) -+{ -+#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM) -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ //PMGNT_INFO mgnt_info = &adapter->MgntInfo; -+ PMGNT_INFO mgnt_info = &(((PADAPTER)(adapter))->MgntInfo); -+ struct sw_antenna_switch *dm_swat_table = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ s8 score = 0; -+ PRT_WLAN_BSS p_tmp_bss_desc, p_test_bss_desc; -+ u8 power_target_L = 9, power_target_H = 16; -+ u8 tmp_power_diff = 0, power_diff = 0, avg_power_diff = 0, max_power_diff = 0, min_power_diff = 0xff; -+ u16 index, counter = 0; -+ static u8 scan_channel; -+ u32 tmp_swas_no_link_bk_reg948; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "ANTA_ON = (( %d )) , ANTB_ON = (( %d ))\n", -+ dm->dm_swat_table.ANTA_ON, dm->dm_swat_table.ANTB_ON); -+ -+ /* @if(HP id) */ -+ { -+ if (dm->dm_swat_table.rssi_ant_dect_result == true && dm->support_ic_type == ODM_RTL8723B) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "8723B RSSI-based Antenna Detection is done\n"); -+ return false; -+ } -+ -+ if (dm->support_ic_type == ODM_RTL8723B) { -+ if (dm_swat_table->swas_no_link_bk_reg948 == 0xff) -+ dm_swat_table->swas_no_link_bk_reg948 = odm_read_4byte(dm, REG_S0_S1_PATH_SWITCH); -+ } -+ } -+ -+ if (dm->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(((PADAPTER)adapter))) -+ return false; -+ else -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Antenna Detection: RSSI method\n"); -+ -+ /* Since driver is going to set BB register, it shall check if there is another thread controlling BB/RF. */ -+ odm_acquire_spin_lock(dm, RT_RF_STATE_SPINLOCK); -+ if (hal_data->eRFPowerState != eRfOn || mgnt_info->RFChangeInProgress || mgnt_info->bMediaConnect) { -+ odm_release_spin_lock(dm, RT_RF_STATE_SPINLOCK); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "%s: rf_change_in_progress(%x), e_rf_power_state(%x)\n", -+ __func__, mgnt_info->RFChangeInProgress, -+ hal_data->eRFPowerState); -+ -+ dm_swat_table->swas_no_link_state = 0; -+ -+ return false; -+ } else -+ odm_release_spin_lock(dm, RT_RF_STATE_SPINLOCK); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "dm_swat_table->swas_no_link_state = %d\n", -+ dm_swat_table->swas_no_link_state); -+ /* @1 Run AntDiv mechanism "Before Link" part. */ -+ if (dm_swat_table->swas_no_link_state == 0) { -+ /* @1 Prepare to do Scan again to check current antenna state. */ -+ -+ /* Set check state to next step. */ -+ dm_swat_table->swas_no_link_state = 1; -+ -+ /* @Copy Current Scan list. */ -+ mgnt_info->tmpNumBssDesc = mgnt_info->NumBssDesc; -+ PlatformMoveMemory((void *)mgnt_info->tmpbssDesc, (void *)mgnt_info->bssDesc, sizeof(RT_WLAN_BSS) * MAX_BSS_DESC); -+ -+ /* @Go back to scan function again. */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Scan one more time\n", -+ __func__); -+ mgnt_info->ScanStep = 0; -+ mgnt_info->bScanAntDetect = true; -+ scan_channel = odm_sw_ant_div_select_scan_chnl(adapter); -+ -+ if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8821)) { -+ if (fat_tab->rx_idle_ant == MAIN_ANT) -+ odm_update_rx_idle_ant(dm, AUX_ANT); -+ else -+ odm_update_rx_idle_ant(dm, MAIN_ANT); -+ if (scan_channel == 0) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "%s: No AP List Avaiable, Using ant(%s)\n", -+ __func__, -+ (fat_tab->rx_idle_ant == MAIN_ANT) ? -+ "AUX_ANT" : "MAIN_ANT"); -+ -+ if (IS_5G_WIRELESS_MODE(mgnt_info->dot11CurrentWirelessMode)) { -+ dm_swat_table->ant_5g = fat_tab->rx_idle_ant; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "dm_swat_table->ant_5g=%s\n", (fat_tab->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ } else { -+ dm_swat_table->ant_2g = fat_tab->rx_idle_ant; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "dm_swat_table->ant_2g=%s\n", (fat_tab->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ } -+ return false; -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "%s: Change to %s for testing.\n", __func__, -+ ((fat_tab->rx_idle_ant == MAIN_ANT) ? -+ "MAIN_ANT" : "AUX_ANT")); -+ } else if (dm->support_ic_type & (ODM_RTL8723B)) { -+ /*Switch Antenna to another one.*/ -+ -+ tmp_swas_no_link_bk_reg948 = odm_read_4byte(dm, REG_S0_S1_PATH_SWITCH); -+ -+ if (dm_swat_table->cur_antenna == MAIN_ANT && tmp_swas_no_link_bk_reg948 == 0x200) { -+ odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, 0xfff, 0x280); -+ odm_set_bb_reg(dm, REG_AGC_TABLE_SELECT, BIT(31), 0x1); -+ dm_swat_table->cur_antenna = AUX_ANT; -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Reg[948]= (( %x )) was in wrong state\n", -+ tmp_swas_no_link_bk_reg948); -+ return false; -+ } -+ ODM_delay_us(10); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "%s: Change to (( %s-ant)) for testing.\n", -+ __func__, -+ (dm_swat_table->cur_antenna == MAIN_ANT) ? -+ "MAIN" : "AUX"); -+ } -+ -+ odm_sw_ant_div_construct_scan_chnl(adapter, scan_channel); -+ PlatformSetTimer(adapter, &mgnt_info->ScanTimer, 5); -+ -+ return true; -+ } else { /* @dm_swat_table->swas_no_link_state == 1 */ -+ /* @1 ScanComple() is called after antenna swiched. */ -+ /* @1 Check scan result and determine which antenna is going */ -+ /* @1 to be used. */ -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, " tmp_num_bss_desc= (( %d ))\n", -+ mgnt_info->tmpNumBssDesc); /* @debug for Dino */ -+ -+ for (index = 0; index < mgnt_info->tmpNumBssDesc; index++) { -+ p_tmp_bss_desc = &mgnt_info->tmpbssDesc[index]; /* @Antenna 1 */ -+ p_test_bss_desc = &mgnt_info->bssDesc[index]; /* @Antenna 2 */ -+ -+ if (PlatformCompareMemory(p_test_bss_desc->bdBssIdBuf, p_tmp_bss_desc->bdBssIdBuf, 6) != 0) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "%s: ERROR!! This shall not happen.\n", -+ __func__); -+ continue; -+ } -+ -+ if (dm->support_ic_type != ODM_RTL8723B) { -+ if (p_tmp_bss_desc->ChannelNumber == scan_channel) { -+ if (p_tmp_bss_desc->RecvSignalPower > p_test_bss_desc->RecvSignalPower) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Compare scan entry: score++\n", __func__); -+ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", p_tmp_bss_desc->bdSsIdBuf, p_tmp_bss_desc->bdSsIdLen); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "at ch %d, Original: %d, Test: %d\n\n", p_tmp_bss_desc->ChannelNumber, p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower); -+ -+ score++; -+ PlatformMoveMemory(p_test_bss_desc, p_tmp_bss_desc, sizeof(RT_WLAN_BSS)); -+ } else if (p_tmp_bss_desc->RecvSignalPower < p_test_bss_desc->RecvSignalPower) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Compare scan entry: score--\n", __func__); -+ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", p_tmp_bss_desc->bdSsIdBuf, p_tmp_bss_desc->bdSsIdLen); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "at ch %d, Original: %d, Test: %d\n\n", p_tmp_bss_desc->ChannelNumber, p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower); -+ score--; -+ } else { -+ if (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp < 5000) { -+ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", p_tmp_bss_desc->bdSsIdBuf, p_tmp_bss_desc->bdSsIdLen); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "at ch %d, Original: %d, Test: %d\n", p_tmp_bss_desc->ChannelNumber, p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "The 2nd Antenna didn't get this AP\n\n"); -+ } -+ } -+ } -+ } else { /* @8723B */ -+ if (p_tmp_bss_desc->ChannelNumber == scan_channel) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "channel_number == scan_channel->(( %d ))\n", p_tmp_bss_desc->ChannelNumber); -+ -+ if (p_tmp_bss_desc->RecvSignalPower > p_test_bss_desc->RecvSignalPower) { /* Pow(Ant1) > Pow(Ant2) */ -+ counter++; -+ tmp_power_diff = (u8)(p_tmp_bss_desc->RecvSignalPower - p_test_bss_desc->RecvSignalPower); -+ power_diff = power_diff + tmp_power_diff; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower); -+ PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "SSID:", p_tmp_bss_desc->bdSsIdBuf); -+ PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "BSSID:", p_tmp_bss_desc->bdSsIdBuf); -+ -+#if 0 -+ /* PHYDM_DBG(dm,DBG_ANT_DIV, "tmp_power_diff: (( %d)),max_power_diff: (( %d)),min_power_diff: (( %d))\n", tmp_power_diff,max_power_diff,min_power_diff); */ -+#endif -+ 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; -+#if 0 -+ /* PHYDM_DBG(dm,DBG_ANT_DIV, "max_power_diff: (( %d)),min_power_diff: (( %d))\n",max_power_diff,min_power_diff); */ -+#endif -+ -+ PlatformMoveMemory(p_test_bss_desc, p_tmp_bss_desc, sizeof(RT_WLAN_BSS)); -+ } else if (p_test_bss_desc->RecvSignalPower > p_tmp_bss_desc->RecvSignalPower) { /* Pow(Ant1) < Pow(Ant2) */ -+ counter++; -+ tmp_power_diff = (u8)(p_test_bss_desc->RecvSignalPower - p_tmp_bss_desc->RecvSignalPower); -+ power_diff = power_diff + tmp_power_diff; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower); -+ PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "SSID:", p_tmp_bss_desc->bdSsIdBuf); -+ PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "BSSID:", p_tmp_bss_desc->bdSsIdBuf); -+ 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 (p_test_bss_desc->bdTstamp > p_tmp_bss_desc->bdTstamp) { /* Stamp(Ant1) < Stamp(Ant2) */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "time_diff: %lld\n", (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp) / 1000); -+ if (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp > 5000) { -+ counter++; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower); -+ PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "SSID:", p_tmp_bss_desc->bdSsIdBuf); -+ PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "BSSID:", p_tmp_bss_desc->bdSsIdBuf); -+ min_power_diff = 0; -+ } -+ } else -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Error !!!]: Time_diff: %lld\n", (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp) / 1000); -+ } -+ } -+ } -+ } -+ -+ if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8821)) { -+ if (mgnt_info->NumBssDesc != 0 && score < 0) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "%s: Using ant(%s)\n", __func__, -+ (fat_tab->rx_idle_ant == MAIN_ANT) ? -+ "MAIN_ANT" : "AUX_ANT"); -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "%s: Remain ant(%s)\n", __func__, -+ (fat_tab->rx_idle_ant == MAIN_ANT) ? -+ "AUX_ANT" : "MAIN_ANT"); -+ -+ if (fat_tab->rx_idle_ant == MAIN_ANT) -+ odm_update_rx_idle_ant(dm, AUX_ANT); -+ else -+ odm_update_rx_idle_ant(dm, MAIN_ANT); -+ } -+ -+ if (IS_5G_WIRELESS_MODE(mgnt_info->dot11CurrentWirelessMode)) { -+ dm_swat_table->ant_5g = fat_tab->rx_idle_ant; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "dm_swat_table->ant_5g=%s\n", -+ (fat_tab->rx_idle_ant == MAIN_ANT) ? -+ "MAIN_ANT" : "AUX_ANT"); -+ } else { -+ dm_swat_table->ant_2g = fat_tab->rx_idle_ant; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "dm_swat_table->ant_2g=%s\n", -+ (fat_tab->rx_idle_ant == MAIN_ANT) ? -+ "MAIN_ANT" : "AUX_ANT"); -+ } -+ } else if (dm->support_ic_type == ODM_RTL8723B) { -+ if (counter == 0) { -+ if (dm->dm_swat_table.pre_aux_fail_detec == false) { -+ dm->dm_swat_table.pre_aux_fail_detec = true; -+ dm->dm_swat_table.rssi_ant_dect_result = false; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "counter=(( 0 )) , [[ Cannot find any AP with Aux-ant ]] -> Scan Target-channel again\n"); -+ -+ /* @3 [ Scan again ] */ -+ odm_sw_ant_div_construct_scan_chnl(adapter, scan_channel); -+ PlatformSetTimer(adapter, &mgnt_info->ScanTimer, 5); -+ return true; -+ } else { /* pre_aux_fail_detec == true */ -+ /* @2 [ Single Antenna ] */ -+ dm->dm_swat_table.pre_aux_fail_detec = false; -+ dm->dm_swat_table.rssi_ant_dect_result = true; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "counter=(( 0 )) , [[ Still cannot find any AP ]]\n"); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Single antenna\n", __func__); -+ } -+ dm->dm_swat_table.aux_fail_detec_counter++; -+ } else { -+ dm->dm_swat_table.pre_aux_fail_detec = false; -+ -+ if (counter == 3) { -+ avg_power_diff = ((power_diff - max_power_diff - min_power_diff) >> 1) + ((max_power_diff + min_power_diff) >> 2); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "counter: (( %d )) , power_diff: (( %d ))\n", counter, power_diff); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ 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); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "counter: (( %d )) , power_diff: (( %d ))\n", counter, power_diff); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ 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; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "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) { -+ dm->dm_swat_table.retry_counter++; -+ -+ if (dm->dm_swat_table.retry_counter <= 3) { -+ dm->dm_swat_table.rssi_ant_dect_result = false; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[[ Low confidence result ]] avg_power_diff= (( %d )) -> Scan Target-channel again ]]\n", avg_power_diff); -+ -+ /* @3 [ Scan again ] */ -+ odm_sw_ant_div_construct_scan_chnl(adapter, scan_channel); -+ PlatformSetTimer(adapter, &mgnt_info->ScanTimer, 5); -+ return true; -+ } else { -+ dm->dm_swat_table.rssi_ant_dect_result = true; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[[ Still Low confidence result ]] (( retry_counter > 3 ))\n"); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Single antenna\n", __func__); -+ } -+ } -+ /* @2 [ Dual Antenna ] */ -+ else if ((mgnt_info->NumBssDesc != 0) && (avg_power_diff < power_target_L)) { -+ dm->dm_swat_table.rssi_ant_dect_result = true; -+ if (dm->dm_swat_table.ANTB_ON == false) { -+ dm->dm_swat_table.ANTA_ON = true; -+ dm->dm_swat_table.ANTB_ON = true; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Dual antenna\n", __func__); -+ dm->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 ] */ -+ dm->support_ability |= ODM_BB_ANT_DIV; -+ odm_ant_div_init(dm); -+ } -+ /* @2 [ Single Antenna ] */ -+ else if (avg_power_diff > power_target_H) { -+ dm->dm_swat_table.rssi_ant_dect_result = true; -+ if (dm->dm_swat_table.ANTB_ON == true) { -+ dm->dm_swat_table.ANTA_ON = true; -+ dm->dm_swat_table.ANTB_ON = false; -+#if 0 -+ /* @bt_set_bt_coex_ant_num(adapter, BT_COEX_ANT_TYPE_DETECTED, 1); */ -+#endif -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Single antenna\n", __func__); -+ dm->dm_swat_table.single_ant_counter++; -+ } -+ } -+#if 0 -+ /* PHYDM_DBG(dm,DBG_ANT_DIV, "is_result=(( %d ))\n",dm->dm_swat_table.rssi_ant_dect_result); */ -+#endif -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "dual_ant_counter = (( %d )), single_ant_counter = (( %d )) , retry_counter = (( %d )) , aux_fail_detec_counter = (( %d ))\n\n\n", -+ dm->dm_swat_table.dual_ant_counter, -+ dm->dm_swat_table.single_ant_counter, -+ dm->dm_swat_table.retry_counter, -+ dm->dm_swat_table.aux_fail_detec_counter); -+ -+ /* @2 recover the antenna setting */ -+ -+ if (dm->dm_swat_table.ANTB_ON == false) -+ odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, 0xfff, (dm_swat_table->swas_no_link_bk_reg948)); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "is_result=(( %d )), Recover Reg[948]= (( %x ))\n\n", -+ dm->dm_swat_table.rssi_ant_dect_result, -+ dm_swat_table->swas_no_link_bk_reg948); -+ } -+ -+ /* @Check state reset to default and wait for next time. */ -+ dm_swat_table->swas_no_link_state = 0; -+ mgnt_info->bScanAntDetect = false; -+ -+ return false; -+ } -+ -+#else -+ return false; -+#endif -+ -+ return false; -+} -+ -+/* @1 [3. PSD method] ========================================================== */ -+void odm_single_dual_antenna_detection_psd( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 channel_ori; -+ u8 initial_gain = 0x36; -+ u8 tone_idx; -+ u8 tone_lenth_1 = 7, tone_lenth_2 = 4; -+ u16 tone_idx_1[7] = {88, 104, 120, 8, 24, 40, 56}; -+ u16 tone_idx_2[4] = {8, 24, 40, 56}; -+ u32 psd_report_main[11] = {0}, psd_report_aux[11] = {0}; -+ /* u8 tone_lenth_1=4, tone_lenth_2=2; */ -+ /* u16 tone_idx_1[4]={88, 120, 24, 56}; */ -+ /* u16 tone_idx_2[2]={ 24, 56}; */ -+ /* u32 psd_report_main[6]={0}, psd_report_aux[6]={0}; */ -+ -+ u32 PSD_report_temp, max_psd_report_main = 0, max_psd_report_aux = 0; -+ u32 PSD_power_threshold; -+ u32 main_psd_result = 0, aux_psd_result = 0; -+ u32 regc50, reg948, regb2c, regc14, reg908; -+ u32 i = 0, test_num = 8; -+ -+ if (dm->support_ic_type != ODM_RTL8723B) -+ return; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s============>\n", __func__); -+ -+ /* @2 [ Backup Current RF/BB Settings ] */ -+ -+ channel_ori = odm_get_rf_reg(dm, RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK); -+ reg948 = odm_get_bb_reg(dm, REG_S0_S1_PATH_SWITCH, MASKDWORD); -+ regb2c = odm_get_bb_reg(dm, REG_AGC_TABLE_SELECT, MASKDWORD); -+ regc50 = odm_get_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD); -+ regc14 = odm_get_bb_reg(dm, R_0xc14, MASKDWORD); -+ reg908 = odm_get_bb_reg(dm, R_0x908, MASKDWORD); -+ -+ /* @2 [ setting for doing PSD function (CH4)] */ -+ odm_set_bb_reg(dm, REG_FPGA0_RFMOD, BIT(24), 0); /* @disable whole CCK block */ -+ odm_write_1byte(dm, REG_TXPAUSE, 0xFF); /* Turn off TX -> Pause TX Queue */ -+ odm_set_bb_reg(dm, R_0xc14, MASKDWORD, 0x0); /* @[ Set IQK Matrix = 0 ] equivalent to [ Turn off CCA] */ -+ -+ /* PHYTXON while loop */ -+ odm_set_bb_reg(dm, R_0x908, MASKDWORD, 0x803); -+ while (odm_get_bb_reg(dm, R_0xdf4, BIT(6))) { -+ i++; -+ if (i > 1000000) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Wait in %s() more than %d times!\n", -+ __FUNCTION__, i); -+ break; -+ } -+ } -+ -+ odm_set_bb_reg(dm, R_0xc50, 0x7f, initial_gain); -+ odm_set_rf_reg(dm, RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); /* Set RF to CH4 & 40M */ -+ odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0xf); /* @3 wire Disable 88c[23:20]=0xf */ -+ odm_set_bb_reg(dm, REG_FPGA0_PSD_FUNCTION, BIT(14) | BIT15, 0x0); /* 128 pt */ /* Set PSD 128 ptss */ -+ ODM_delay_us(3000); -+ -+ /* @2 [ Doing PSD Function in (CH4)] */ -+ -+ /* @Antenna A */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Switch to Main-ant (CH4)\n"); -+ odm_set_bb_reg(dm, R_0x948, 0xfff, 0x200); -+ ODM_delay_us(10); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "dbg\n"); -+ for (i = 0; i < test_num; i++) { -+ for (tone_idx = 0; tone_idx < tone_lenth_1; tone_idx++) { -+ PSD_report_temp = phydm_get_psd_data(dm, tone_idx_1[tone_idx], initial_gain); -+ /* @if( PSD_report_temp>psd_report_main[tone_idx] ) */ -+ psd_report_main[tone_idx] += PSD_report_temp; -+ } -+ } -+ /* @Antenna B */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Switch to Aux-ant (CH4)\n"); -+ odm_set_bb_reg(dm, R_0x948, 0xfff, 0x280); -+ ODM_delay_us(10); -+ for (i = 0; i < test_num; i++) { -+ for (tone_idx = 0; tone_idx < tone_lenth_1; tone_idx++) { -+ PSD_report_temp = phydm_get_psd_data(dm, tone_idx_1[tone_idx], initial_gain); -+ /* @if( PSD_report_temp>psd_report_aux[tone_idx] ) */ -+ psd_report_aux[tone_idx] += PSD_report_temp; -+ } -+ } -+ /* @2 [ Doing PSD Function in (CH8)] */ -+ -+ odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0x0); /* @3 wire enable 88c[23:20]=0x0 */ -+ ODM_delay_us(3000); -+ -+ odm_set_bb_reg(dm, R_0xc50, 0x7f, initial_gain); -+ odm_set_rf_reg(dm, RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); /* Set RF to CH8 & 40M */ -+ -+ odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0xf); /* @3 wire Disable 88c[23:20]=0xf */ -+ ODM_delay_us(3000); -+ -+ /* @Antenna A */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Switch to Main-ant (CH8)\n"); -+ odm_set_bb_reg(dm, R_0x948, 0xfff, 0x200); -+ ODM_delay_us(10); -+ -+ for (i = 0; i < test_num; i++) { -+ for (tone_idx = 0; tone_idx < tone_lenth_2; tone_idx++) { -+ PSD_report_temp = phydm_get_psd_data(dm, tone_idx_2[tone_idx], initial_gain); -+ /* @if( PSD_report_temp>psd_report_main[tone_idx] ) */ -+ psd_report_main[tone_lenth_1 + tone_idx] += PSD_report_temp; -+ } -+ } -+ -+ /* @Antenna B */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Switch to Aux-ant (CH8)\n"); -+ odm_set_bb_reg(dm, R_0x948, 0xfff, 0x280); -+ ODM_delay_us(10); -+ -+ for (i = 0; i < test_num; i++) { -+ for (tone_idx = 0; tone_idx < tone_lenth_2; tone_idx++) { -+ PSD_report_temp = phydm_get_psd_data(dm, tone_idx_2[tone_idx], initial_gain); -+ /* @if( PSD_report_temp>psd_report_aux[tone_idx] ) */ -+ psd_report_aux[tone_lenth_1 + tone_idx] += PSD_report_temp; -+ } -+ } -+ -+ /* @2 [ Calculate Result ] */ -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "\nMain PSD Result: (ALL)\n"); -+ for (tone_idx = 0; tone_idx < (tone_lenth_1 + tone_lenth_2); tone_idx++) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[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]; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "--------------------------- \nTotal_Main= (( %d ))\n", -+ main_psd_result); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "MAX_Main = (( %d ))\n", -+ max_psd_report_main); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "\nAux PSD Result: (ALL)\n"); -+ for (tone_idx = 0; tone_idx < (tone_lenth_1 + tone_lenth_2); tone_idx++) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[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]; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "--------------------------- \nTotal_Aux= (( %d ))\n", -+ aux_psd_result); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "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; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 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 (dm->dm_swat_table.ANTB_ON == false) { -+ dm->dm_swat_table.ANTA_ON = true; -+ dm->dm_swat_table.ANTB_ON = true; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "odm_sw_ant_div_check_before_link(): Dual antenna\n"); -+ -+#if 0 -+ /* set bt coexDM from 1ant coexDM to 2ant coexDM */ -+ /* @bt_set_bt_coex_ant_num(adapter, BT_COEX_ANT_TYPE_DETECTED, 2); */ -+#endif -+ -+ /* @Init antenna diversity */ -+ dm->support_ability |= ODM_BB_ANT_DIV; -+ odm_ant_div_init(dm); -+ } -+ /* @3 [ Single Antenna ] */ -+ else { -+ if (dm->dm_swat_table.ANTB_ON == true) { -+ dm->dm_swat_table.ANTA_ON = true; -+ dm->dm_swat_table.ANTB_ON = false; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "odm_sw_ant_div_check_before_link(): Single antenna\n"); -+ } -+ -+ /* @2 [ Recover all parameters ] */ -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, channel_ori); -+ odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0x0); /* @3 wire enable 88c[23:20]=0x0 */ -+ odm_set_bb_reg(dm, R_0xc50, 0x7f, regc50); -+ -+ odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, MASKDWORD, reg948); -+ odm_set_bb_reg(dm, REG_AGC_TABLE_SELECT, MASKDWORD, regb2c); -+ -+ odm_set_bb_reg(dm, REG_FPGA0_RFMOD, BIT(24), 1); /* @enable whole CCK block */ -+ odm_write_1byte(dm, REG_TXPAUSE, 0x0); /* Turn on TX */ /* Resume TX Queue */ -+ odm_set_bb_reg(dm, R_0xc14, MASKDWORD, regc14); /* @[ Set IQK Matrix = 0 ] equivalent to [ Turn on CCA] */ -+ odm_set_bb_reg(dm, R_0x908, MASKDWORD, reg908); -+ -+ return; -+} -+ -+void odm_sw_ant_detect_init(void *dm_void) -+{ -+#if (RTL8723B_SUPPORT == 1) -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *dm_swat_table = &dm->dm_swat_table; -+ -+ if (dm->support_ic_type != ODM_RTL8723B) -+ return; -+ -+ /* @dm_swat_table->pre_antenna = MAIN_ANT; */ -+ /* @dm_swat_table->cur_antenna = MAIN_ANT; */ -+ dm_swat_table->swas_no_link_state = 0; -+ dm_swat_table->pre_aux_fail_detec = false; -+ dm_swat_table->swas_no_link_bk_reg948 = 0xff; -+ -+#ifdef CONFIG_PSD_TOOL -+ phydm_psd_init(dm); -+#endif -+#endif -+} -+#endif -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdect.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdect.h -new file mode 100644 -index 000000000..f7fc75f18 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdect.h -@@ -0,0 +1,78 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMANTDECT_H__ -+#define __PHYDMANTDECT_H__ -+ -+#define ANTDECT_VERSION "2.1" -+ -+#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 -+ -+struct _ANT_DETECTED_INFO { -+ boolean is_ant_detected; -+ u32 db_for_ant_a; -+ u32 db_for_ant_b; -+ u32 db_for_ant_o; -+}; -+ -+enum dm_swas { -+ antenna_a = 1, -+ antenna_b = 2, -+ antenna_max = 3, -+}; -+ -+/* @1 [1. Single Tone method] =================================================== */ -+ -+void odm_single_dual_antenna_default_setting( -+ void *dm_void); -+ -+boolean -+odm_single_dual_antenna_detection( -+ void *dm_void, -+ u8 mode); -+ -+/* @1 [2. Scan AP RSSI method] ================================================== */ -+ -+#define sw_ant_div_check_before_link odm_sw_ant_div_check_before_link -+ -+boolean -+odm_sw_ant_div_check_before_link( -+ void *dm_void); -+ -+/* @1 [3. PSD method] ========================================================== */ -+ -+void odm_single_dual_antenna_detection_psd( -+ void *dm_void); -+ -+void odm_sw_ant_detect_init(void *dm_void); -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdiv.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdiv.c -new file mode 100644 -index 000000000..3c2cc583e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdiv.c -@@ -0,0 +1,6640 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/************************************************************* -+ * 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. -+ ***************************************************** -+ */ -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+#if (RTL8710C_SUPPORT == 1) -+void odm_s0s1_sw_ant_div_init_8710c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***8710C AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n"); -+ /*MAC setting*/ -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0xdc, HAL_READ32(SYSTEM_CTRL_BASE, R_0xdc) | BIT18 | BIT17 | BIT16); -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0xac, HAL_READ32(SYSTEM_CTRL_BASE, R_0xac) | BIT24 | BIT6); -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0x10, 0x307); -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0x08, 0x80000111); -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0x1208, 0x800000); -+ -+ /* Status init */ -+ fat_tab->is_become_linked = false; -+ swat_tab->try_flag = SWAW_STEP_INIT; -+ swat_tab->double_chk_flag = 0; -+ swat_tab->cur_antenna = MAIN_ANT; -+ swat_tab->pre_ant = MAIN_ANT; -+ dm->antdiv_counter = CONFIG_ANTDIV_PERIOD; -+} -+ -+void odm_trx_hw_ant_div_init_8710c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[8710C] AntDiv_Init => ant_div_type=[CG_TRX_HW_ANTDIV]\n"); -+ odm_set_mac_reg(dm, R_0x74, BIT(13) | BIT(12), 1); -+ odm_set_mac_reg(dm, R_0x74, BIT(4), 1); -+ -+ /*@BT Coexistence*/ -+ /*@keep antsel_map when GNT_BT = 1*/ -+ odm_set_bb_reg(dm, R_0x864, BIT(12), 1); -+ -+ /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ -+ odm_set_bb_reg(dm, R_0x874, BIT(23), 1); -+ odm_set_bb_reg(dm, R_0x930, 0xF00, 8); /* RFE CTRL_2 ANTSEL0 */ -+ -+ odm_set_bb_reg(dm, R_0x870, BIT(8), 0); -+ odm_set_bb_reg(dm, R_0x804, BIT(8), 0); /* r_keep_rfpin */ -+ -+ /*@Mapping Table*/ -+ //odm_set_bb_reg(dm, R_0x864, BIT2|BIT1|BIT0, 2); -+ odm_set_bb_reg(dm, R_0x944, 0xFFFF, 0xffff); -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 1); -+ /*@antenna training */ -+ odm_set_bb_reg(dm, R_0xe08, BIT(16), 0); -+ -+ //need to check!!!!!!!!!! -+ /* Set WLBB_SEL_RF_ON 1 if RXFIR_PWDB > 0xCcc[3:0] */ -+ odm_set_bb_reg(dm, R_0xccc, BIT(12), 0); -+ /* @Low-to-High threshold for WLBB_SEL_RF_ON when OFDM enable */ -+ odm_set_bb_reg(dm, R_0xccc, 0x0F, 0x01); -+ /* @High-to-Low threshold for WLBB_SEL_RF_ON when OFDM enable */ -+ odm_set_bb_reg(dm, R_0xccc, 0xF0, 0x0); -+ /* @b Low-to-High threshold for WLBB_SEL_RF_ON when OFDM disable (CCK)*/ -+ odm_set_bb_reg(dm, R_0xabc, 0xFF, 0x06); -+ /* @High-to-Low threshold for WLBB_SEL_RF_ON when OFDM disable (CCK) */ -+ odm_set_bb_reg(dm, R_0xabc, 0xFF00, 0x00); -+ -+ /*OFDM HW AntDiv Parameters*/ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0x80); -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x00); -+ odm_set_bb_reg(dm, R_0xc5c, BIT(20) | BIT(19) | BIT(18), 0x04); -+ -+ /*@CCK HW AntDiv Parameters*/ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); -+ odm_set_bb_reg(dm, R_0xaa8, BIT(8), 0); -+ -+ odm_set_bb_reg(dm, R_0xa0c, 0x0F, 0xf); -+ odm_set_bb_reg(dm, R_0xa14, 0x1F, 0xf); -+ odm_set_bb_reg(dm, R_0xa10, BIT(13), 0x1); -+ odm_set_bb_reg(dm, R_0xa74, BIT(8), 0x0); -+ odm_set_bb_reg(dm, R_0xb34, BIT(30), 0x1); -+} -+void odm_update_rx_idle_ant_8710c(void *dm_void, u8 ant, u32 default_ant, -+ u32 optional_ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ void *adapter = dm->adapter; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***odm_update_rx_idle_ant_8710c!!!\n"); -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ if (default_ant == 0x0) -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0x1210,0x800000); -+ else -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0x1214,0x800000); -+ -+ fat_tab->rx_idle_ant = ant; -+ }else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ odm_set_bb_reg(dm, R_0x864, BIT(5) | BIT(4) | BIT(3), default_ant); -+ /*@Default RX*/ -+ odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); -+ /*@Optional RX*/ -+ odm_set_bb_reg(dm, R_0x860, BIT(14) | BIT(13) | BIT(12), default_ant); -+ /*@Default TX*/ -+ fat_tab->rx_idle_ant = ant; -+ } -+} -+#endif -+ -+#if (RTL8721D_SUPPORT == 1) -+ -+void odm_update_rx_idle_ant_8721d(void *dm_void, u8 ant, u32 default_ant, -+ u32 optional_ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ odm_set_bb_reg(dm, R_0x864, BIT(5) | BIT(4) | BIT(3), default_ant); -+ /*@Default RX*/ -+ odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); -+ /*@Optional RX*/ -+ odm_set_bb_reg(dm, R_0x860, BIT(14) | BIT(13) | BIT(12), default_ant); -+ /*@Default TX*/ -+ fat_tab->rx_idle_ant = ant; -+} -+ -+void odm_trx_hw_ant_div_init_8721d(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[8721D] AntDiv_Init => ant_div_type=[CG_TRX_HW_ANTDIV]\n"); -+ -+ /*@BT Coexistence*/ -+ /*@keep antsel_map when GNT_BT = 1*/ -+ odm_set_bb_reg(dm, R_0x864, BIT(12), 1); -+ /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ -+ odm_set_bb_reg(dm, R_0x874, BIT(23), 0); -+ /* @Disable hw antsw & fast_train.antsw when BT TX/RX */ -+ odm_set_bb_reg(dm, R_0xe64, 0xFFFF0000, 0x000c); -+ -+ switch (dm->antdiv_gpio) { -+ case ANTDIV_GPIO_PA2PA4: { -+ PAD_CMD(_PA_2, ENABLE); -+ Pinmux_Config(_PA_2, PINMUX_FUNCTION_RFE); -+ PAD_CMD(_PA_4, ENABLE); -+ Pinmux_Config(_PA_4, PINMUX_FUNCTION_RFE); -+ break; -+ } -+ case ANTDIV_GPIO_PA5PA6: { -+ PAD_CMD(_PA_5, ENABLE); -+ Pinmux_Config(_PA_5, PINMUX_FUNCTION_RFE); -+ PAD_CMD(_PA_6, ENABLE); -+ Pinmux_Config(_PA_6, PINMUX_FUNCTION_RFE); -+ break; -+ } -+ case ANTDIV_GPIO_PA12PA13: { -+ PAD_CMD(_PA_12, ENABLE); -+ Pinmux_Config(_PA_12, PINMUX_FUNCTION_RFE); -+ PAD_CMD(_PA_13, ENABLE); -+ Pinmux_Config(_PA_13, PINMUX_FUNCTION_RFE); -+ break; -+ } -+ case ANTDIV_GPIO_PA14PA15: { -+ PAD_CMD(_PA_14, ENABLE); -+ Pinmux_Config(_PA_14, PINMUX_FUNCTION_RFE); -+ PAD_CMD(_PA_15, ENABLE); -+ Pinmux_Config(_PA_15, PINMUX_FUNCTION_RFE); -+ break; -+ } -+ case ANTDIV_GPIO_PA16PA17: { -+ PAD_CMD(_PA_16, ENABLE); -+ Pinmux_Config(_PA_16, PINMUX_FUNCTION_RFE); -+ PAD_CMD(_PA_17, ENABLE); -+ Pinmux_Config(_PA_17, PINMUX_FUNCTION_RFE); -+ break; -+ } -+ case ANTDIV_GPIO_PB1PB2: { -+ PAD_CMD(_PB_1, ENABLE); -+ Pinmux_Config(_PB_1, PINMUX_FUNCTION_RFE); -+ PAD_CMD(_PB_2, ENABLE); -+ Pinmux_Config(_PB_2, PINMUX_FUNCTION_RFE); -+ break; -+ } -+ case ANTDIV_GPIO_PB26PB29: { -+ PAD_CMD(_PB_26, ENABLE); -+ Pinmux_Config(_PB_26, PINMUX_FUNCTION_RFE); -+ PAD_CMD(_PB_29, ENABLE); -+ Pinmux_Config(_PB_29, PINMUX_FUNCTION_RFE); -+ break; -+ } -+ case ANTDIV_GPIO_PB1PB2PB26:{ -+ PAD_CMD(_PB_1, ENABLE); -+ Pinmux_Config(_PB_1, PINMUX_FUNCTION_RFE); -+ PAD_CMD(_PB_2, ENABLE); -+ Pinmux_Config(_PB_2, PINMUX_FUNCTION_RFE); -+ PAD_CMD(_PB_26, ENABLE); -+ Pinmux_Config(_PB_26, PINMUX_FUNCTION_RFE); -+ break; -+ } -+ default: { -+ } -+ } -+ -+ if (dm->antdiv_gpio == ANTDIV_GPIO_PA12PA13 || -+ dm->antdiv_gpio == ANTDIV_GPIO_PA14PA15 || -+ dm->antdiv_gpio == ANTDIV_GPIO_PA16PA17 || -+ dm->antdiv_gpio == ANTDIV_GPIO_PB1PB2) { -+ /* ANT_SEL_P, ANT_SEL_N */ -+ odm_set_bb_reg(dm, R_0x930, 0xF, 8); -+ odm_set_bb_reg(dm, R_0x930, 0xF0, 8); -+ odm_set_bb_reg(dm, R_0x92c, BIT(1) | BIT(0), 2); -+ odm_set_bb_reg(dm, R_0x944, 0x00000003, 0x3); -+ } else if (dm->antdiv_gpio == ANTDIV_GPIO_PA2PA4 || -+ dm->antdiv_gpio == ANTDIV_GPIO_PA5PA6 || -+ dm->antdiv_gpio == ANTDIV_GPIO_PB26PB29) { -+ /* TRSW_P, TRSW_N */ -+ odm_set_bb_reg(dm, R_0x930, 0xF00, 8); -+ odm_set_bb_reg(dm, R_0x930, 0xF000, 8); -+ odm_set_bb_reg(dm, R_0x92c, BIT(3) | BIT(2), 2); -+ odm_set_bb_reg(dm, R_0x944, 0x0000000C, 0x3); -+ } -+ else if(dm->antdiv_gpio == ANTDIV_GPIO_PB1PB2PB26){ -+ /* 3 antenna diversity for AmebaD only */ -+ odm_set_bb_reg(dm, R_0x930, 0xF, 8); -+ odm_set_bb_reg(dm, R_0x930, 0xF0, 9); -+ odm_set_bb_reg(dm, R_0x930, 0xF00,0xa); /* set the RFE control table to select antenna*/ -+ odm_set_bb_reg(dm, R_0x944, 0x00000007, 0x7); -+ } -+ -+ u32 sysreg208 = HAL_READ32(SYSTEM_CTRL_BASE_LP, REG_LP_FUNC_EN0); -+ -+ sysreg208 |= BIT(28); -+ HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_LP_FUNC_EN0, sysreg208); -+ -+ u32 sysreg344 = -+ HAL_READ32(SYSTEM_CTRL_BASE_LP, REG_AUDIO_SHARE_PAD_CTRL); -+ -+ sysreg344 |= BIT(9); -+ HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_AUDIO_SHARE_PAD_CTRL, sysreg344); -+ -+ u32 sysreg280 = HAL_READ32(SYSTEM_CTRL_BASE_LP, REG_LP_SYSPLL_CTRL0); -+ -+ sysreg280 |= 0x7; -+ HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_LP_SYSPLL_CTRL0, sysreg280); -+ -+ sysreg344 |= BIT(8); -+ HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_AUDIO_SHARE_PAD_CTRL, sysreg344); -+ -+ sysreg344 |= BIT(0); -+ HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_AUDIO_SHARE_PAD_CTRL, sysreg344); -+ -+ odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); -+ odm_set_bb_reg(dm, R_0x804, 0xF00, 1); /* r_keep_rfpin */ -+ -+ /*PTA setting: WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL)*/ -+ /*odm_set_bb_reg(dm, R_0x948, BIT6, 0);*/ -+ /*odm_set_bb_reg(dm, R_0x948, BIT8, 0);*/ -+ /*@GNT_WL tx*/ -+ odm_set_bb_reg(dm, R_0x950, BIT(29), 0); -+ -+ /*@Mapping Table*/ -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 1); -+ if (dm->antdiv_gpio == ANTDIV_GPIO_PB1PB2PB26) { -+ odm_set_bb_reg(dm, R_0x914, 0x00000F, 0x1); -+ odm_set_bb_reg(dm, R_0x914, 0x000F00, 0x2); -+ odm_set_bb_reg(dm, R_0x914, 0x0F0000, 0x4); -+ } -+ /* odm_set_bb_reg(dm, R_0x864, BIT5|BIT4|BIT3, 0); */ -+ /* odm_set_bb_reg(dm, R_0x864, BIT8|BIT7|BIT6, 1); */ -+ -+ /* Set WLBB_SEL_RF_ON 1 if RXFIR_PWDB > 0xCcc[3:0] */ -+ odm_set_bb_reg(dm, R_0xccc, BIT(12), 0); -+ /* @Low-to-High threshold for WLBB_SEL_RF_ON */ -+ /*when OFDM enable */ -+ odm_set_bb_reg(dm, R_0xccc, 0x0F, 0x01); -+ /* @High-to-Low threshold for WLBB_SEL_RF_ON */ -+ /* when OFDM enable */ -+ odm_set_bb_reg(dm, R_0xccc, 0xF0, 0x0); -+ /* @b Low-to-High threshold for WLBB_SEL_RF_ON*/ -+ /*when OFDM disable ( only CCK ) */ -+ odm_set_bb_reg(dm, R_0xabc, 0xFF, 0x06); -+ /* @High-to-Low threshold for WLBB_SEL_RF_ON*/ -+ /* when OFDM disable ( only CCK ) */ -+ odm_set_bb_reg(dm, R_0xabc, 0xFF00, 0x00); -+ -+ /*OFDM HW AntDiv Parameters*/ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xa0); -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x00); -+ odm_set_bb_reg(dm, R_0xc5c, BIT(20) | BIT(19) | BIT(18), 0x04); -+ -+ /*@CCK HW AntDiv Parameters*/ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 0); -+ odm_set_bb_reg(dm, R_0xaa8, BIT(8), 0); -+ -+ odm_set_bb_reg(dm, R_0xa0c, 0x0F, 0xf); -+ odm_set_bb_reg(dm, R_0xa14, 0x1F, 0x8); -+ odm_set_bb_reg(dm, R_0xa10, BIT(13), 0x1); -+ odm_set_bb_reg(dm, R_0xa74, BIT(8), 0x0); -+ odm_set_bb_reg(dm, R_0xb34, BIT(30), 0x1); -+ -+ /*@disable antenna training */ -+ odm_set_bb_reg(dm, R_0xe08, BIT(16), 0); -+ odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); -+} -+#endif -+ -+void odm_stop_antenna_switch_dm(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ /* @disable ODM antenna diversity */ -+ dm->support_ability &= ~ODM_BB_ANT_DIV; -+#if (RTL8710C_SUPPORT == 1) -+ dm->support_ability |= ODM_BB_ANT_DIV; -+#endif -+ if (fat_tab->div_path_type == ANT_PATH_A) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ else if (fat_tab->div_path_type == ANT_PATH_B) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_B); -+ else if (fat_tab->div_path_type == ANT_PATH_AB) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_AB); -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "STOP Antenna Diversity\n"); -+} -+ -+void phydm_enable_antenna_diversity(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ dm->support_ability |= ODM_BB_ANT_DIV; -+ dm->antdiv_select = 0; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "AntDiv is enabled & Re-Init AntDiv\n"); -+ odm_antenna_diversity_init(dm); -+} -+ -+void odm_set_ant_config(void *dm_void, u8 ant_setting /* @0=A, 1=B, 2=C,...*/) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type == ODM_RTL8723B) { -+ if (ant_setting == 0) /* @ant A*/ -+ odm_set_bb_reg(dm, R_0x948, MASKDWORD, 0x00000000); -+ else if (ant_setting == 1) -+ odm_set_bb_reg(dm, R_0x948, MASKDWORD, 0x00000280); -+ } else if (dm->support_ic_type == ODM_RTL8723D) { -+ if (ant_setting == 0) /* @ant A*/ -+ odm_set_bb_reg(dm, R_0x948, MASKLWORD, 0x0000); -+ else if (ant_setting == 1) -+ odm_set_bb_reg(dm, R_0x948, MASKLWORD, 0x0280); -+ } -+} -+ -+/* ****************************************************** */ -+ -+void odm_sw_ant_div_rest_after_link(void *dm_void) -+{ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u32 i; -+ -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ swat_tab->try_flag = SWAW_STEP_INIT; -+ swat_tab->rssi_trying = 0; -+ swat_tab->double_chk_flag = 0; -+ fat_tab->rx_idle_ant = MAIN_ANT; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) -+ phydm_antdiv_reset_statistic(dm, i); -+ } -+ -+#endif -+} -+ -+void phydm_n_on_off(void *dm_void, u8 swch, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ if (path == ANT_PATH_A) { -+ odm_set_bb_reg(dm, R_0xc50, BIT(7), swch); -+ } else if (path == ANT_PATH_B) { -+ odm_set_bb_reg(dm, R_0xc58, BIT(7), swch); -+ } else if (path == ANT_PATH_AB) { -+ odm_set_bb_reg(dm, R_0xc50, BIT(7), swch); -+ odm_set_bb_reg(dm, R_0xc58, BIT(7), swch); -+ } -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); -+#if (RTL8723D_SUPPORT == 1) -+ /*@Mingzhi 2017-05-08*/ -+ if (dm->support_ic_type == ODM_RTL8723D) { -+ if (swch == ANTDIV_ON) { -+ odm_set_bb_reg(dm, R_0xce0, BIT(1), 1); -+ odm_set_bb_reg(dm, R_0x948, BIT(6), 1); -+ /*@1:HW ctrl 0:SW ctrl*/ -+ } else { -+ odm_set_bb_reg(dm, R_0xce0, BIT(1), 0); -+ odm_set_bb_reg(dm, R_0x948, BIT(6), 0); -+ /*@1:HW ctrl 0:SW ctrl*/ -+ } -+ } -+#endif -+} -+ -+void phydm_ac_on_off(void *dm_void, u8 swch, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ if (dm->support_ic_type & ODM_RTL8812) { -+ odm_set_bb_reg(dm, R_0xc50, BIT(7), swch); -+ /* OFDM AntDiv function block enable */ -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); -+ /* @CCK AntDiv function block enable */ -+ } else if (dm->support_ic_type & ODM_RTL8822B) { -+ odm_set_bb_reg(dm, R_0x800, BIT(25), swch); -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); -+ if (path == ANT_PATH_A) { -+ odm_set_bb_reg(dm, R_0xc50, BIT(7), swch); -+ } else if (path == ANT_PATH_B) { -+ odm_set_bb_reg(dm, R_0xe50, BIT(7), swch); -+ } else if (path == ANT_PATH_AB) { -+ odm_set_bb_reg(dm, R_0xc50, BIT(7), swch); -+ odm_set_bb_reg(dm, R_0xe50, BIT(7), swch); -+ } -+ } else { -+ odm_set_bb_reg(dm, R_0x8d4, BIT(24), swch); -+ /* OFDM AntDiv function block enable */ -+ -+ if (dm->cut_version >= ODM_CUT_C && -+ dm->support_ic_type == ODM_RTL8821 && -+ dm->ant_div_type != S0S1_SW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "(Turn %s) CCK HW-AntDiv\n", -+ (swch == ANTDIV_ON) ? "ON" : "OFF"); -+ odm_set_bb_reg(dm, R_0x800, BIT(25), swch); -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); -+ /* @CCK AntDiv function block enable */ -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "(Turn %s) CCK HW-AntDiv\n", -+ (swch == ANTDIV_ON) ? "ON" : "OFF"); -+ odm_set_bb_reg(dm, R_0x800, BIT(25), swch); -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); -+ /* @CCK AntDiv function block enable */ -+ } -+ } -+} -+ -+void phydm_jgr3_on_off(void *dm_void, u8 swch, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ odm_set_bb_reg(dm, R_0x8a0, BIT(17), swch); -+ /* OFDM AntDiv function block enable */ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ odm_set_bb_reg(dm, R_0x1a48, BIT(16), swch); -+ /* @CCK AntDiv function block enable */ -+ } -+ else{ -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); -+ /* @CCK AntDiv function block enable */ -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[8723F] AntDiv_on\n"); -+} -+ -+void odm_ant_div_on_off(void *dm_void, u8 swch, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ if (fat_tab->ant_div_on_off != swch) { -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) -+ return; -+ -+ if (dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "(( Turn %s )) N-Series HW-AntDiv block\n", -+ (swch == ANTDIV_ON) ? "ON" : "OFF"); -+ phydm_n_on_off(dm, swch, path); -+ -+ } else if (dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "(( Turn %s )) AC-Series HW-AntDiv block\n", -+ (swch == ANTDIV_ON) ? "ON" : "OFF"); -+ phydm_ac_on_off(dm, swch, path); -+ } else if (dm->support_ic_type & ODM_JGR3_ANTDIV_SUPPORT) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "(( Turn %s )) JGR3 HW-AntDiv block\n", -+ (swch == ANTDIV_ON) ? "ON" : "OFF"); -+ phydm_jgr3_on_off(dm, swch, path); -+ } -+ } -+ fat_tab->ant_div_on_off = swch; -+} -+ -+void odm_tx_by_tx_desc_or_reg(void *dm_void, u8 swch) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u8 enable; -+ -+ if (fat_tab->b_fix_tx_ant == NO_FIX_TX_ANT) -+ enable = (swch == TX_BY_DESC) ? 1 : 0; -+ else -+ enable = 0; /*@Force TX by Reg*/ -+ -+ if (dm->ant_div_type != CGCS_RX_HW_ANTDIV) { -+ if (dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) -+ odm_set_bb_reg(dm, R_0x80c, BIT(21), enable); -+ else if (dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) -+ odm_set_bb_reg(dm, R_0x900, BIT(18), enable); -+ else if (dm->support_ic_type & ODM_JGR3_ANTDIV_SUPPORT) -+ odm_set_bb_reg(dm, R_0x186c, BIT(1), enable); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[AntDiv] TX_Ant_BY (( %s ))\n", -+ (enable == TX_BY_DESC) ? "DESC" : "REG"); -+ } -+} -+ -+void phydm_antdiv_reset_statistic(void *dm_void, u32 macid) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ fat_tab->main_sum[macid] = 0; -+ fat_tab->aux_sum[macid] = 0; -+ fat_tab->main_cnt[macid] = 0; -+ fat_tab->aux_cnt[macid] = 0; -+ fat_tab->main_sum_cck[macid] = 0; -+ fat_tab->aux_sum_cck[macid] = 0; -+ fat_tab->main_cnt_cck[macid] = 0; -+ fat_tab->aux_cnt_cck[macid] = 0; -+} -+ -+void phydm_fast_training_enable(void *dm_void, u8 swch) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 enable; -+ -+ if (swch == FAT_ON) -+ enable = 1; -+ else -+ enable = 0; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Fast ant Training_en = ((%d))\n", enable); -+ -+ if (dm->support_ic_type == ODM_RTL8188E) { -+ odm_set_bb_reg(dm, R_0xe08, BIT(16), enable); -+ /*@enable fast training*/ -+ } else if (dm->support_ic_type == ODM_RTL8192E) { -+ odm_set_bb_reg(dm, R_0xb34, BIT(28), enable); -+ /*@enable fast training (path-A)*/ -+#if 0 -+ odm_set_bb_reg(dm, R_0xb34, BIT(29), enable); -+ /*enable fast training (path-B)*/ -+#endif -+ } else if (dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8822B)) { -+ odm_set_bb_reg(dm, R_0x900, BIT(19), enable); -+ /*@enable fast training */ -+ } -+} -+ -+void phydm_keep_rx_ack_ant_by_tx_ant_time(void *dm_void, u32 time) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /* Timming issue: keep Rx ant after tx for ACK ( time x 3.2 mu sec)*/ -+ if (dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) -+ odm_set_bb_reg(dm, R_0xe20, 0xf00000, time); -+ else if (dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) -+ odm_set_bb_reg(dm, R_0x818, 0xf00000, time); -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ odm_set_bb_reg(dm, R_0x1c8c, 0xf00, time); -+ /* keep antenna index after tx */ -+ } -+ -+ -+} -+ -+void phydm_update_rx_idle_ac(void *dm_void, u8 ant, u32 default_ant, -+ u32 optional_ant, u32 default_tx_ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ u16 value16 = odm_read_2byte(dm, 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 &= ~(BIT(11) | BIT(10) | BIT(9) | BIT(8) | BIT(7) | BIT(6) | -+ BIT(5) | BIT(4) | BIT(3)); -+ value16 |= ((u16)default_ant << 3); -+ value16 |= ((u16)optional_ant << 6); -+ value16 |= ((u16)default_tx_ant << 9); -+ odm_write_2byte(dm, ODM_REG_TRMUX_11AC + 2, value16); -+#if 0 -+ odm_set_bb_reg(dm, ODM_REG_TRMUX_11AC, 0x380000, default_ant); -+ /* @Default RX */ -+ odm_set_bb_reg(dm, ODM_REG_TRMUX_11AC, 0x1c00000, optional_ant); -+ /* Optional RX */ -+ odm_set_bb_reg(dm, ODM_REG_TRMUX_11AC, 0xe000000, default_ant); -+ /* @Default TX */ -+#endif -+} -+ -+void phydm_update_rx_idle_n(void *dm_void, u8 ant, u32 default_ant, -+ u32 optional_ant, u32 default_tx_ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 value32; -+ -+ if (dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8197F)) { -+ odm_set_bb_reg(dm, R_0xb38, 0x38, default_ant); -+ /* @Default RX */ -+ odm_set_bb_reg(dm, R_0xb38, 0x1c0, optional_ant); -+ /* Optional RX */ -+ odm_set_bb_reg(dm, R_0x860, 0x7000, default_ant); -+ /* @Default TX */ -+#if (RTL8723B_SUPPORT == 1) -+ } else if (dm->support_ic_type == ODM_RTL8723B) { -+ value32 = odm_get_bb_reg(dm, R_0x948, 0xFFF); -+ -+ if (value32 != 0x280) -+ odm_update_rx_idle_ant_8723b(dm, ant, default_ant, -+ optional_ant); -+ else -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Update Rx-Idle-ant ] 8723B: Fail to set RX antenna due to 0x948 = 0x280\n"); -+#endif -+ -+#if (RTL8723D_SUPPORT == 1) /*@Mingzhi 2017-05-08*/ -+ } else if (dm->support_ic_type == ODM_RTL8723D) { -+ phydm_set_tx_ant_pwr_8723d(dm, ant); -+ odm_update_rx_idle_ant_8723d(dm, ant, default_ant, -+ optional_ant); -+#endif -+ -+#if (RTL8721D_SUPPORT == 1) -+ } else if (dm->support_ic_type == ODM_RTL8721D) { -+ odm_update_rx_idle_ant_8721d(dm, ant, default_ant, -+ optional_ant); -+#endif -+ -+#if (RTL8710C_SUPPORT == 1) -+ } else if (dm->support_ic_type == ODM_RTL8710C) { -+ odm_update_rx_idle_ant_8710c(dm, ant, default_ant, -+ optional_ant); -+#endif -+ -+ } else { -+/*@8188E & 8188F*/ -+/*@ if (dm->support_ic_type == ODM_RTL8723D) {*/ -+/*#if (RTL8723D_SUPPORT == 1)*/ -+/* phydm_set_tx_ant_pwr_8723d(dm, ant);*/ -+/*#endif*/ -+/* }*/ -+#if (RTL8188F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188F) -+ phydm_update_rx_idle_antenna_8188F(dm, default_ant); -+#endif -+ -+ odm_set_bb_reg(dm, R_0x864, 0x38, default_ant);/*@Default RX*/ -+ odm_set_bb_reg(dm, R_0x864, 0x1c0, optional_ant); -+ /*Optional RX*/ -+ odm_set_bb_reg(dm, R_0x860, 0x7000, default_tx_ant); -+ /*@Default TX*/ -+ } -+} -+ -+void phydm_update_rx_idle_jgr3(void *dm_void, u8 ant, u32 default_ant, -+ u32 optional_ant, u32 default_tx_ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 value32; -+ -+ odm_set_bb_reg(dm, R_0x1884, 0xf0, default_ant);/*@Default RX*/ -+ odm_set_bb_reg(dm, R_0x1884, 0xf00, optional_ant); -+ /*Optional RX*/ -+ odm_set_bb_reg(dm, R_0x1884, 0xf000, default_tx_ant); -+ /*@Default TX*/ -+} -+void odm_update_rx_idle_ant(void *dm_void, u8 ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u32 default_ant, optional_ant, value32, default_tx_ant; -+ if (dm->support_ic_type & ODM_JGR3_ANTDIV_SUPPORT) { -+ PHYDM_DBG(dm, DBG_ANT_DIV,"JGR3 HW-AntDiv block\n"); -+ } -+ else{ -+ PHYDM_DBG(dm, DBG_ANT_DIV,"not suppoty JGR3 HW-AntDiv block\n"); -+ PHYDM_DBG(dm, DBG_ANT_DIV,"dm->support_ic_type=%d\n",dm->support_ic_type); -+} -+ if (fat_tab->rx_idle_ant != ant) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Update Rx-Idle-ant ] rx_idle_ant =%s\n", -+ (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ -+ if (!(dm->support_ic_type & ODM_RTL8723B)) -+ fat_tab->rx_idle_ant = ant; -+ -+ if (ant == MAIN_ANT) { -+ default_ant = ANT1_2G; -+ optional_ant = ANT2_2G; -+ } else { -+ default_ant = ANT2_2G; -+ optional_ant = ANT1_2G; -+ } -+ -+ if (fat_tab->b_fix_tx_ant != NO_FIX_TX_ANT) -+ default_tx_ant = (fat_tab->b_fix_tx_ant == -+ FIX_TX_AT_MAIN) ? 0 : 1; -+ else -+ default_tx_ant = default_ant; -+ -+ if (dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) { -+ phydm_update_rx_idle_n(dm, ant, default_ant, -+ optional_ant, default_tx_ant); -+ } else if (dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) { -+ phydm_update_rx_idle_ac(dm, ant, default_ant, -+ optional_ant, default_tx_ant); -+ } else if (dm->support_ic_type & ODM_JGR3_ANTDIV_SUPPORT) { -+ phydm_update_rx_idle_jgr3(dm, ant, default_ant, -+ optional_ant, default_tx_ant); -+ } -+ /*PathA Resp Tx*/ -+ if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B | -+ ODM_RTL8814A | ODM_RTL8195B)) -+ odm_set_mac_reg(dm, R_0x6d8, 0x7, default_tx_ant); -+ else if (dm->support_ic_type == ODM_RTL8188E) -+ odm_set_mac_reg(dm, R_0x6d8, 0xc0, default_tx_ant); -+ else if (dm->support_ic_type & ODM_JGR3_ANTDIV_SUPPORT) -+ odm_set_mac_reg(dm, R_0x6f8, 0xf, default_tx_ant); -+ else -+ odm_set_mac_reg(dm, R_0x6d8, 0x700, default_tx_ant); -+ -+ } else { /* @fat_tab->rx_idle_ant == ant */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Stay in Ori-ant ] rx_idle_ant =%s\n", -+ (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ fat_tab->rx_idle_ant = ant; -+ } -+} -+ -+#if (RTL8721D_SUPPORT) -+void odm_update_rx_idle_ant_sp3t(void *dm_void, u8 ant) /* added by Jiao Qi on May.25,2020, for AmebaD SP3T only */ -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u32 default_ant, optional_ant, value32, default_tx_ant; -+ -+ if (!(dm->support_ic_type & ODM_RTL8723B)) -+ fat_tab->rx_idle_ant = ant; -+ -+ default_ant = fat_tab->ant_idx_vec[0]-1; -+ optional_ant = fat_tab->ant_idx_vec[1]-1; -+ -+ if(fat_tab->b_fix_tx_ant != NO_FIX_TX_ANT) -+ default_tx_ant = (fat_tab->b_fix_tx_ant == -+ FIX_TX_AT_MAIN) ? 0 : 1; -+ else -+ default_tx_ant = default_ant; -+ -+ odm_set_bb_reg(dm, R_0x864, BIT(5) | BIT(4) | BIT(3), default_ant); -+ /*@Default RX*/ -+ odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); -+ /*@Optional RX*/ -+ odm_set_bb_reg(dm, R_0x860, BIT(14) | BIT(13) | BIT(12), default_ant); -+ /*@Default TX*/ -+ -+ /*PathA Resp Tx*/ -+ if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B | -+ ODM_RTL8814A)) -+ odm_set_mac_reg(dm, R_0x6d8, 0x7, default_tx_ant); -+ else if (dm->support_ic_type == ODM_RTL8188E) -+ odm_set_mac_reg(dm, R_0x6d8, 0xc0, default_tx_ant); -+ else -+ odm_set_mac_reg(dm, R_0x6d8, 0x700, default_tx_ant); -+ -+} -+#endif -+void phydm_update_rx_idle_ant_pathb(void *dm_void, u8 ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u32 default_ant, optional_ant, value32, default_tx_ant; -+ -+ if (fat_tab->rx_idle_ant2 != ant) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Update Rx-Idle-ant2 ] rx_idle_ant2 =%s\n", -+ (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ if (ant == MAIN_ANT) { -+ default_ant = ANT1_2G; -+ optional_ant = ANT2_2G; -+ } else { -+ default_ant = ANT2_2G; -+ optional_ant = ANT1_2G; -+ } -+ -+ if (fat_tab->b_fix_tx_ant != NO_FIX_TX_ANT) -+ default_tx_ant = (fat_tab->b_fix_tx_ant == -+ FIX_TX_AT_MAIN) ? 0 : 1; -+ else -+ default_tx_ant = default_ant; -+ if (dm->support_ic_type & ODM_RTL8822B) { -+ u16 v16 = odm_read_2byte(dm, ODM_REG_ANT_11AC_B + 2); -+ -+ v16 &= ~(0xff8);/*0xE08[11:3]*/ -+ v16 |= ((u16)default_ant << 3); -+ v16 |= ((u16)optional_ant << 6); -+ v16 |= ((u16)default_tx_ant << 9); -+ odm_write_2byte(dm, ODM_REG_ANT_11AC_B + 2, v16); -+ odm_set_mac_reg(dm, R_0x6d8, 0x38, default_tx_ant); -+ /*PathB Resp Tx*/ -+ } -+ } else { -+ /* fat_tab->rx_idle_ant2 == ant */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Stay Ori Ant] rx_idle_ant2 = %s\n", -+ (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ fat_tab->rx_idle_ant2 = ant; -+ } -+} -+ -+void phydm_set_antdiv_val(void *dm_void, u32 *val_buf, u8 val_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ability & ODM_BB_ANT_DIV)) -+ return; -+ -+ if (val_len != 1) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[Error][antdiv]Need val_len=1\n"); -+ return; -+ } -+ -+ odm_update_rx_idle_ant(dm, (u8)(*val_buf)); -+} -+ -+void odm_update_tx_ant(void *dm_void, u8 ant, u32 mac_id) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u8 tx_ant; -+ -+ if (fat_tab->b_fix_tx_ant != NO_FIX_TX_ANT) -+ ant = (fat_tab->b_fix_tx_ant == FIX_TX_AT_MAIN) ? -+ MAIN_ANT : AUX_ANT; -+ -+ if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) -+ tx_ant = ant; -+ else { -+ if (ant == MAIN_ANT) -+ tx_ant = ANT1_2G; -+ else -+ tx_ant = ANT2_2G; -+ } -+#if (RTL8721D_SUPPORT) -+ if (dm->antdiv_gpio != ANTDIV_GPIO_PB1PB2PB26) { -+ if (ant == MAIN_ANT) -+ tx_ant = ANT1_2G; -+ else -+ tx_ant = ANT2_2G; -+ } -+ else -+ tx_ant = fat_tab->ant_idx_vec[0]-1; -+#endif -+ fat_tab->antsel_a[mac_id] = tx_ant & BIT(0); -+ fat_tab->antsel_b[mac_id] = (tx_ant & BIT(1)) >> 1; -+ fat_tab->antsel_c[mac_id] = (tx_ant & BIT(2)) >> 2; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Set TX-DESC value]: mac_id:(( %d )), tx_ant = (( %s ))\n", -+ mac_id, (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+#if 0 -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "antsel_tr_mux=(( 3'b%d%d%d ))\n", -+ fat_tab->antsel_c[mac_id], fat_tab->antsel_b[mac_id], -+ fat_tab->antsel_a[mac_id]); -+#endif -+} -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+void odm_bdc_init( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "\n[ BDC Initialization......]\n"); -+ dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; -+ dm_bdc_table->bdc_mode = BDC_MODE_NULL; -+ dm_bdc_table->bdc_try_flag = 0; -+ dm_bdc_table->bd_ccoex_type_wbfer = 0; -+ dm->bdc_holdstate = 0xff; -+ -+ if (dm->support_ic_type == ODM_RTL8192E) { -+ odm_set_bb_reg(dm, R_0xd7c, 0x0FFFFFFF, 0x1081008); -+ odm_set_bb_reg(dm, R_0xd80, 0x0FFFFFFF, 0); -+ } else if (dm->support_ic_type == ODM_RTL8812) { -+ odm_set_bb_reg(dm, R_0x9b0, 0x0FFFFFFF, 0x1081008); -+ /* @0x9b0[30:0] = 01081008 */ -+ odm_set_bb_reg(dm, R_0x9b4, 0x0FFFFFFF, 0); -+ /* @0x9b4[31:0] = 00000000 */ -+ } -+} -+ -+void odm_CSI_on_off( -+ void *dm_void, -+ u8 CSI_en) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ if (CSI_en == CSI_ON) { -+ if (dm->support_ic_type == ODM_RTL8192E) -+ odm_set_mac_reg(dm, R_0xd84, BIT(11), 1); -+ /* @0xd84[11]=1 */ -+ else if (dm->support_ic_type == ODM_RTL8812) -+ odm_set_mac_reg(dm, R_0x9b0, BIT(31), 1); -+ /* @0x9b0[31]=1 */ -+ -+ } else if (CSI_en == CSI_OFF) { -+ if (dm->support_ic_type == ODM_RTL8192E) -+ odm_set_mac_reg(dm, R_0xd84, BIT(11), 0); -+ /* @0xd84[11]=0 */ -+ else if (dm->support_ic_type == ODM_RTL8812) -+ odm_set_mac_reg(dm, R_0x9b0, BIT(31), 0); -+ /* @0x9b0[31]=0 */ -+ } -+} -+ -+void odm_bd_ccoex_type_with_bfer_client( -+ void *dm_void, -+ u8 swch) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; -+ u8 bd_ccoex_type_wbfer; -+ -+ if (swch == DIVON_CSIOFF) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[BDCcoexType: 1] {DIV,CSI} ={1,0}\n"); -+ bd_ccoex_type_wbfer = 1; -+ -+ if (bd_ccoex_type_wbfer != dm_bdc_table->bd_ccoex_type_wbfer) { -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); -+ odm_CSI_on_off(dm, CSI_OFF); -+ dm_bdc_table->bd_ccoex_type_wbfer = 1; -+ } -+ } else if (swch == DIVOFF_CSION) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[BDCcoexType: 2] {DIV,CSI} ={0,1}\n"); -+ bd_ccoex_type_wbfer = 2; -+ -+ if (bd_ccoex_type_wbfer != dm_bdc_table->bd_ccoex_type_wbfer) { -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ odm_CSI_on_off(dm, CSI_ON); -+ dm_bdc_table->bd_ccoex_type_wbfer = 2; -+ } -+ } -+} -+ -+void odm_bf_ant_div_mode_arbitration( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; -+ u8 current_bdc_mode; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ PHYDM_DBG(dm, DBG_ANT_DIV, "\n"); -+ -+ /* @2 mode 1 */ -+ if (dm_bdc_table->num_txbfee_client != 0 && -+ dm_bdc_table->num_txbfer_client == 0) { -+ current_bdc_mode = BDC_MODE_1; -+ -+ if (current_bdc_mode != dm_bdc_table->bdc_mode) { -+ dm_bdc_table->bdc_mode = BDC_MODE_1; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); -+ dm_bdc_table->bdc_rx_idle_update_counter = 1; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Change to (( Mode1 ))\n"); -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Antdiv + BF coextance mode] : (( Mode1 ))\n"); -+ } -+ /* @2 mode 2 */ -+ else if ((dm_bdc_table->num_txbfee_client == 0) && -+ (dm_bdc_table->num_txbfer_client != 0)) { -+ current_bdc_mode = BDC_MODE_2; -+ -+ if (current_bdc_mode != dm_bdc_table->bdc_mode) { -+ dm_bdc_table->bdc_mode = BDC_MODE_2; -+ dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; -+ dm_bdc_table->bdc_try_flag = 0; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Change to (( Mode2 ))\n"); -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Antdiv + BF coextance mode] : (( Mode2 ))\n"); -+ } -+ /* @2 mode 3 */ -+ else if ((dm_bdc_table->num_txbfee_client != 0) && -+ (dm_bdc_table->num_txbfer_client != 0)) { -+ current_bdc_mode = BDC_MODE_3; -+ -+ if (current_bdc_mode != dm_bdc_table->bdc_mode) { -+ dm_bdc_table->bdc_mode = BDC_MODE_3; -+ dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; -+ dm_bdc_table->bdc_try_flag = 0; -+ dm_bdc_table->bdc_rx_idle_update_counter = 1; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Change to (( Mode3 ))\n"); -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Antdiv + BF coextance mode] : (( Mode3 ))\n"); -+ } -+ /* @2 mode 4 */ -+ else if ((dm_bdc_table->num_txbfee_client == 0) && -+ (dm_bdc_table->num_txbfer_client == 0)) { -+ current_bdc_mode = BDC_MODE_4; -+ -+ if (current_bdc_mode != dm_bdc_table->bdc_mode) { -+ dm_bdc_table->bdc_mode = BDC_MODE_4; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Change to (( Mode4 ))\n"); -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Antdiv + BF coextance mode] : (( Mode4 ))\n"); -+ } -+#endif -+} -+ -+void odm_div_train_state_setting( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "\n*****[S T A R T ]***** [2-0. DIV_TRAIN_STATE]\n"); -+ dm_bdc_table->bdc_try_counter = 2; -+ dm_bdc_table->bdc_try_flag = 1; -+ dm_bdc_table->BDC_state = bdc_bfer_train_state; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); -+} -+ -+void odm_bd_ccoex_bfee_rx_div_arbitration( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; -+ boolean stop_bf_flag; -+ u8 bdc_active_mode; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***{ num_BFee, num_BFer, num_client} = (( %d , %d , %d))\n", -+ dm_bdc_table->num_txbfee_client, -+ dm_bdc_table->num_txbfer_client, dm_bdc_table->num_client); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***{ num_BF_tars, num_DIV_tars } = (( %d , %d ))\n", -+ dm_bdc_table->num_bf_tar, dm_bdc_table->num_div_tar); -+ -+ /* @2 [ MIB control ] */ -+ if (dm->bdc_holdstate == 2) { -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); -+ dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Force in [ BF STATE]\n"); -+ return; -+ } else if (dm->bdc_holdstate == 1) { -+ dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Force in [ DIV STATE]\n"); -+ return; -+ } -+ -+ /* @------------------------------------------------------------ */ -+ -+ /* @2 mode 2 & 3 */ -+ if (dm_bdc_table->bdc_mode == BDC_MODE_2 || -+ dm_bdc_table->bdc_mode == BDC_MODE_3) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "\n{ Try_flag, Try_counter } = { %d , %d }\n", -+ dm_bdc_table->bdc_try_flag, -+ dm_bdc_table->bdc_try_counter); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "BDCcoexType = (( %d ))\n\n", -+ dm_bdc_table->bd_ccoex_type_wbfer); -+ -+ /* @All Client have Bfer-Cap------------------------------- */ -+ if (dm_bdc_table->num_txbfer_client == dm_bdc_table->num_client) { -+ /* @BFer STA Only?: yes */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "BFer STA only? (( Yes ))\n"); -+ dm_bdc_table->bdc_try_flag = 0; -+ dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); -+ return; -+ } else -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "BFer STA only? (( No ))\n"); -+ if (dm_bdc_table->is_all_bf_sta_idle == false && dm_bdc_table->is_all_div_sta_idle == true) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "All DIV-STA are idle, but BF-STA not\n"); -+ dm_bdc_table->bdc_try_flag = 0; -+ dm_bdc_table->BDC_state = bdc_bfer_train_state; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); -+ return; -+ } else if (dm_bdc_table->is_all_bf_sta_idle == true && dm_bdc_table->is_all_div_sta_idle == false) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "All BF-STA are idle, but DIV-STA not\n"); -+ dm_bdc_table->bdc_try_flag = 0; -+ dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); -+ return; -+ } -+ -+ /* Select active mode-------------------------------------- */ -+ if (dm_bdc_table->num_bf_tar == 0) { /* Selsect_1, Selsect_2 */ -+ if (dm_bdc_table->num_div_tar == 0) { /* Selsect_3 */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Select active mode (( 1 ))\n"); -+ dm_bdc_table->bdc_active_mode = 1; -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Select active mode (( 2 ))\n"); -+ dm_bdc_table->bdc_active_mode = 2; -+ } -+ dm_bdc_table->bdc_try_flag = 0; -+ dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); -+ return; -+ } else { /* num_bf_tar > 0 */ -+ if (dm_bdc_table->num_div_tar == 0) { /* Selsect_3 */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Select active mode (( 3 ))\n"); -+ dm_bdc_table->bdc_active_mode = 3; -+ dm_bdc_table->bdc_try_flag = 0; -+ dm_bdc_table->BDC_state = bdc_bfer_train_state; -+ odm_bd_ccoex_type_with_bfer_client(dm, -+ DIVOFF_CSION) -+ ; -+ return; -+ } else { /* Selsect_4 */ -+ bdc_active_mode = 4; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Select active mode (( 4 ))\n"); -+ -+ if (bdc_active_mode != dm_bdc_table->bdc_active_mode) { -+ dm_bdc_table->bdc_active_mode = 4; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Change to active mode (( 4 )) & return!!!\n"); -+ return; -+ } -+ } -+ } -+ -+#if 1 -+ if (dm->bdc_holdstate == 0xff) { -+ dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Force in [ DIV STATE]\n"); -+ return; -+ } -+#endif -+ -+ /* @Does Client number changed ? ------------------------------- */ -+ if (dm_bdc_table->num_client != dm_bdc_table->pre_num_client) { -+ dm_bdc_table->bdc_try_flag = 0; -+ dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ The number of client has been changed !!!] return to (( BDC_DIV_TRAIN_STATE ))\n"); -+ } -+ dm_bdc_table->pre_num_client = dm_bdc_table->num_client; -+ -+ if (dm_bdc_table->bdc_try_flag == 0) { -+ /* @2 DIV_TRAIN_STATE (mode 2-0) */ -+ if (dm_bdc_table->BDC_state == BDC_DIV_TRAIN_STATE) -+ odm_div_train_state_setting(dm); -+ /* @2 BFer_TRAIN_STATE (mode 2-1) */ -+ else if (dm_bdc_table->BDC_state == bdc_bfer_train_state) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*****[2-1. BFer_TRAIN_STATE ]*****\n"); -+ -+#if 0 -+ /* @if(dm_bdc_table->num_bf_tar==0) */ -+ /* @{ */ -+ /* PHYDM_DBG(dm,DBG_ANT_DIV, "BF_tars exist? : (( No )), [ bdc_bfer_train_state ] >> [BDC_DIV_TRAIN_STATE]\n"); */ -+ /* odm_div_train_state_setting( dm); */ -+ /* @} */ -+ /* else */ /* num_bf_tar != 0 */ -+ /* @{ */ -+#endif -+ dm_bdc_table->bdc_try_counter = 2; -+ dm_bdc_table->bdc_try_flag = 1; -+ dm_bdc_table->BDC_state = BDC_DECISION_STATE; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "BF_tars exist? : (( Yes )), [ bdc_bfer_train_state ] >> [BDC_DECISION_STATE]\n"); -+ /* @} */ -+ } -+ /* @2 DECISION_STATE (mode 2-2) */ -+ else if (dm_bdc_table->BDC_state == BDC_DECISION_STATE) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*****[2-2. DECISION_STATE]*****\n"); -+#if 0 -+ /* @if(dm_bdc_table->num_bf_tar==0) */ -+ /* @{ */ -+ /* ODM_AntDiv_Printk(("BF_tars exist? : (( No )), [ DECISION_STATE ] >> [BDC_DIV_TRAIN_STATE]\n")); */ -+ /* odm_div_train_state_setting( dm); */ -+ /* @} */ -+ /* else */ /* num_bf_tar != 0 */ -+ /* @{ */ -+#endif -+ if (dm_bdc_table->BF_pass == false || dm_bdc_table->DIV_pass == false) -+ stop_bf_flag = true; -+ else -+ stop_bf_flag = false; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "BF_tars exist? : (( Yes )), {BF_pass, DIV_pass, stop_bf_flag } = { %d, %d, %d }\n", -+ dm_bdc_table->BF_pass, -+ dm_bdc_table->DIV_pass, stop_bf_flag); -+ -+ if (stop_bf_flag == true) { /* @DIV_en */ -+ dm_bdc_table->bdc_hold_counter = 10; /* @20 */ -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); -+ dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ stop_bf_flag= ((true)), BDC_DECISION_STATE ] >> [BDC_DIV_HOLD_STATE]\n"); -+ } else { /* @BF_en */ -+ dm_bdc_table->bdc_hold_counter = 10; /* @20 */ -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); -+ dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[stop_bf_flag= ((false)), BDC_DECISION_STATE ] >> [BDC_BF_HOLD_STATE]\n"); -+ } -+ /* @} */ -+ } -+ /* @2 BF-HOLD_STATE (mode 2-3) */ -+ else if (dm_bdc_table->BDC_state == BDC_BF_HOLD_STATE) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*****[2-3. BF_HOLD_STATE ]*****\n"); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "bdc_hold_counter = (( %d ))\n", -+ dm_bdc_table->bdc_hold_counter); -+ -+ if (dm_bdc_table->bdc_hold_counter == 1) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n"); -+ odm_div_train_state_setting(dm); -+ } else { -+ dm_bdc_table->bdc_hold_counter--; -+ -+#if 0 -+ /* @if(dm_bdc_table->num_bf_tar==0) */ -+ /* @{ */ -+ /* PHYDM_DBG(dm,DBG_ANT_DIV, "BF_tars exist? : (( No )), [ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n"); */ -+ /* odm_div_train_state_setting( dm); */ -+ /* @} */ -+ /* else */ /* num_bf_tar != 0 */ -+ /* @{ */ -+ /* PHYDM_DBG(dm,DBG_ANT_DIV, "BF_tars exist? : (( Yes ))\n"); */ -+#endif -+ dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ BDC_BF_HOLD_STATE ] >> [BDC_BF_HOLD_STATE]\n"); -+ /* @} */ -+ } -+ } -+ /* @2 DIV-HOLD_STATE (mode 2-4) */ -+ else if (dm_bdc_table->BDC_state == BDC_DIV_HOLD_STATE) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*****[2-4. DIV_HOLD_STATE ]*****\n"); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "bdc_hold_counter = (( %d ))\n", -+ dm_bdc_table->bdc_hold_counter); -+ -+ if (dm_bdc_table->bdc_hold_counter == 1) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n"); -+ odm_div_train_state_setting(dm); -+ } else { -+ dm_bdc_table->bdc_hold_counter--; -+ dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; -+ odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_HOLD_STATE]\n"); -+ } -+ } -+ -+ } else if (dm_bdc_table->bdc_try_flag == 1) { -+ /* @2 Set Training counter */ -+ if (dm_bdc_table->bdc_try_counter > 1) { -+ dm_bdc_table->bdc_try_counter--; -+ if (dm_bdc_table->bdc_try_counter == 1) -+ dm_bdc_table->bdc_try_flag = 0; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Training !!\n"); -+ /* return ; */ -+ } -+ } -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "\n[end]\n"); -+ -+#endif /* @#if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ -+} -+ -+#endif -+#endif /* @#ifdef PHYDM_BEAMFORMING_SUPPORT*/ -+ -+#if (RTL8188E_SUPPORT == 1) -+ -+void odm_rx_hw_ant_div_init_88e(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 value32; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* @MAC setting */ -+ value32 = odm_get_mac_reg(dm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD); -+ odm_set_mac_reg(dm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD, -+ value32 | (BIT(23) | BIT(25))); -+ /* Reg4C[25]=1, Reg4C[23]=1 for pin output */ -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, ODM_REG_PIN_CTRL_11N, BIT(9) | BIT(8), 0); -+ /* reg870[8]=1'b0, reg870[9]=1'b0 */ -+ /* antsel antselb by HW */ -+ odm_set_bb_reg(dm, ODM_REG_RX_ANT_CTRL_11N, BIT(10), 0); -+ /* reg864[10]=1'b0 */ /* antsel2 by HW */ -+ odm_set_bb_reg(dm, ODM_REG_LNA_SWITCH_11N, BIT(22), 1); -+ /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ -+ odm_set_bb_reg(dm, ODM_REG_LNA_SWITCH_11N, BIT(31), 1); -+ /* regb2c[31]=1'b1 */ /* output at CG only */ -+ /* OFDM Settings */ -+ odm_set_bb_reg(dm, ODM_REG_ANTDIV_PARA1_11N, MASKDWORD, 0x000000a0); -+ /* @CCK Settings */ -+ odm_set_bb_reg(dm, ODM_REG_BB_PWR_SAV4_11N, BIT(7), 1); -+ /* @Fix CCK PHY status report issue */ -+ odm_set_bb_reg(dm, ODM_REG_CCK_ANTDIV_PARA2_11N, BIT(4), 1); -+ /* @CCK complete HW AntDiv within 64 samples */ -+ -+ odm_set_bb_reg(dm, ODM_REG_ANT_MAPPING1_11N, 0xFFFF, 0x0001); -+ /* @antenna mapping table */ -+ -+ fat_tab->enable_ctrl_frame_antdiv = 1; -+} -+ -+void odm_trx_hw_ant_div_init_88e(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 value32; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* @MAC setting */ -+ value32 = odm_get_mac_reg(dm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD); -+ odm_set_mac_reg(dm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD, -+ value32 | (BIT(23) | BIT(25))); -+ /* Reg4C[25]=1, Reg4C[23]=1 for pin output */ -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, ODM_REG_PIN_CTRL_11N, BIT(9) | BIT(8), 0); -+ /* reg870[8]=1'b0, reg870[9]=1'b0 */ -+ /* antsel antselb by HW */ -+ odm_set_bb_reg(dm, ODM_REG_RX_ANT_CTRL_11N, BIT(10), 0); -+ /* reg864[10]=1'b0 */ /* antsel2 by HW */ -+ odm_set_bb_reg(dm, ODM_REG_LNA_SWITCH_11N, BIT(22), 0); -+ /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ -+ odm_set_bb_reg(dm, ODM_REG_LNA_SWITCH_11N, BIT(31), 1); -+ /* regb2c[31]=1'b1 */ /* output at CG only */ -+ /* OFDM Settings */ -+ odm_set_bb_reg(dm, ODM_REG_ANTDIV_PARA1_11N, MASKDWORD, 0x000000a0); -+ /* @CCK Settings */ -+ odm_set_bb_reg(dm, ODM_REG_BB_PWR_SAV4_11N, BIT(7), 1); -+ /* @Fix CCK PHY status report issue */ -+ odm_set_bb_reg(dm, ODM_REG_CCK_ANTDIV_PARA2_11N, BIT(4), 1); -+ /* @CCK complete HW AntDiv within 64 samples */ -+ -+ /* @antenna mapping table */ -+ if (!dm->is_mp_chip) { /* testchip */ -+ odm_set_bb_reg(dm, ODM_REG_RX_DEFAULT_A_11N, 0x700, 1); -+ /* Reg858[10:8]=3'b001 */ -+ odm_set_bb_reg(dm, ODM_REG_RX_DEFAULT_A_11N, 0x3800, 2); -+ /* Reg858[13:11]=3'b010 */ -+ } else /* @MPchip */ -+ odm_set_bb_reg(dm, ODM_REG_ANT_MAPPING1_11N, MASKDWORD, 0x0201); -+ /*Reg914=3'b010, Reg915=3'b001*/ -+ -+ fat_tab->enable_ctrl_frame_antdiv = 1; -+} -+ -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+void odm_smart_hw_ant_div_init_88e( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 value32, i; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***8188E AntDiv_Init => ant_div_type=[CG_TRX_SMART_ANTDIV]\n"); -+ -+#if 0 -+ if (*dm->mp_mode == true) { -+ PHYDM_DBG(dm, ODM_COMP_INIT, "dm->ant_div_type: %d\n", -+ dm->ant_div_type); -+ return; -+ } -+#endif -+ -+ fat_tab->train_idx = 0; -+ fat_tab->fat_state = FAT_PREPARE_STATE; -+ -+ dm->fat_comb_a = 5; -+ dm->antdiv_intvl = 0x64; /* @100ms */ -+ -+ for (i = 0; i < 6; i++) -+ fat_tab->bssid[i] = 0; -+ for (i = 0; i < (dm->fat_comb_a); i++) { -+ fat_tab->ant_sum_rssi[i] = 0; -+ fat_tab->ant_rssi_cnt[i] = 0; -+ fat_tab->ant_ave_rssi[i] = 0; -+ } -+ -+ /* @MAC setting */ -+ value32 = odm_get_mac_reg(dm, R_0x4c, MASKDWORD); -+ odm_set_mac_reg(dm, R_0x4c, MASKDWORD, value32 | (BIT(23) | BIT(25))); /* Reg4C[25]=1, Reg4C[23]=1 for pin output */ -+ value32 = odm_get_mac_reg(dm, R_0x7b4, MASKDWORD); -+ odm_set_mac_reg(dm, R_0x7b4, MASKDWORD, value32 | (BIT(16) | BIT(17))); /* Reg7B4[16]=1 enable antenna training, Reg7B4[17]=1 enable A2 match */ -+ /* value32 = platform_efio_read_4byte(adapter, 0x7B4); */ -+ /* platform_efio_write_4byte(adapter, 0x7b4, value32|BIT(18)); */ /* append MACID in reponse packet */ -+ -+ /* @Match MAC ADDR */ -+ odm_set_mac_reg(dm, R_0x7b4, 0xFFFF, 0); -+ odm_set_mac_reg(dm, R_0x7b0, MASKDWORD, 0); -+ -+ odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); /* reg870[8]=1'b0, reg870[9]=1'b0 */ /* antsel antselb by HW */ -+ odm_set_bb_reg(dm, R_0x864, BIT(10), 0); /* reg864[10]=1'b0 */ /* antsel2 by HW */ -+ odm_set_bb_reg(dm, R_0xb2c, BIT(22), 0); /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ -+ odm_set_bb_reg(dm, R_0xb2c, BIT(31), 0); /* regb2c[31]=1'b1 */ /* output at CS only */ -+ odm_set_bb_reg(dm, R_0xca4, MASKDWORD, 0x000000a0); -+ -+ /* @antenna mapping table */ -+ if (dm->fat_comb_a == 2) { -+ if (!dm->is_mp_chip) { /* testchip */ -+ odm_set_bb_reg(dm, R_0x858, BIT(10) | BIT(9) | BIT(8), 1); /* Reg858[10:8]=3'b001 */ -+ odm_set_bb_reg(dm, R_0x858, BIT(13) | BIT(12) | BIT(11), 2); /* Reg858[13:11]=3'b010 */ -+ } else { /* @MPchip */ -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 1); -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 2); -+ } -+ } else { -+ if (!dm->is_mp_chip) { /* testchip */ -+ odm_set_bb_reg(dm, R_0x858, BIT(10) | BIT(9) | BIT(8), 0); /* Reg858[10:8]=3'b000 */ -+ odm_set_bb_reg(dm, R_0x858, BIT(13) | BIT(12) | BIT(11), 1); /* Reg858[13:11]=3'b001 */ -+ odm_set_bb_reg(dm, R_0x878, BIT(16), 0); -+ odm_set_bb_reg(dm, R_0x858, BIT(15) | BIT(14), 2); /* @(Reg878[0],Reg858[14:15])=3'b010 */ -+ odm_set_bb_reg(dm, R_0x878, BIT(19) | BIT(18) | BIT(17), 3); /* Reg878[3:1]=3b'011 */ -+ odm_set_bb_reg(dm, R_0x878, BIT(22) | BIT(21) | BIT(20), 4); /* Reg878[6:4]=3b'100 */ -+ odm_set_bb_reg(dm, R_0x878, BIT(25) | BIT(24) | BIT(23), 5); /* Reg878[9:7]=3b'101 */ -+ odm_set_bb_reg(dm, R_0x878, BIT(28) | BIT(27) | BIT(26), 6); /* Reg878[12:10]=3b'110 */ -+ odm_set_bb_reg(dm, R_0x878, BIT(31) | BIT(30) | BIT(29), 7); /* Reg878[15:13]=3b'111 */ -+ } else { /* @MPchip */ -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 4); /* @0: 3b'000 */ -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 2); /* @1: 3b'001 */ -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE2, 0); /* @2: 3b'010 */ -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE3, 1); /* @3: 3b'011 */ -+ odm_set_bb_reg(dm, R_0x918, MASKBYTE0, 3); /* @4: 3b'100 */ -+ odm_set_bb_reg(dm, R_0x918, MASKBYTE1, 5); /* @5: 3b'101 */ -+ odm_set_bb_reg(dm, R_0x918, MASKBYTE2, 6); /* @6: 3b'110 */ -+ odm_set_bb_reg(dm, R_0x918, MASKBYTE3, 255); /* @7: 3b'111 */ -+ } -+ } -+ -+ /* @Default ant setting when no fast training */ -+ odm_set_bb_reg(dm, R_0x864, BIT(5) | BIT(4) | BIT(3), 0); /* @Default RX */ -+ odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), 1); /* Optional RX */ -+ odm_set_bb_reg(dm, R_0x860, BIT(14) | BIT(13) | BIT(12), 0); /* @Default TX */ -+ -+ /* @Enter Traing state */ -+ odm_set_bb_reg(dm, R_0x864, BIT(2) | BIT(1) | BIT(0), (dm->fat_comb_a - 1)); /* reg864[2:0]=3'd6 */ /* ant combination=reg864[2:0]+1 */ -+ -+#if 0 -+ /* SW Control */ -+ /* phy_set_bb_reg(adapter, 0x864, BIT10, 1); */ -+ /* phy_set_bb_reg(adapter, 0x870, BIT9, 1); */ -+ /* phy_set_bb_reg(adapter, 0x870, BIT8, 1); */ -+ /* phy_set_bb_reg(adapter, 0x864, BIT11, 1); */ -+ /* phy_set_bb_reg(adapter, 0x860, BIT9, 0); */ -+ /* phy_set_bb_reg(adapter, 0x860, BIT8, 0); */ -+#endif -+} -+#endif -+ -+#endif /* @#if (RTL8188E_SUPPORT == 1) */ -+ -+#if (RTL8192E_SUPPORT == 1) -+void odm_rx_hw_ant_div_init_92e(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+#if 0 -+ if (*dm->mp_mode == true) { -+ odm_ant_div_on_off(dm, ANTDIV_OFF); -+ odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); -+ /* r_rxdiv_enable_anta regc50[8]=1'b0 0: control by c50[9] */ -+ odm_set_bb_reg(dm, R_0xc50, BIT(9), 1); -+ /* @1:CG, 0:CS */ -+ return; -+ } -+#endif -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, R_0x870, BIT(8), 0); -+ /* reg870[8]=1'b0, antsel is controled by HWs */ -+ odm_set_bb_reg(dm, R_0xc50, BIT(8), 1); -+ /* regc50[8]=1'b1 CS/CG switching is controled by HWs*/ -+ -+ /* @Mapping table */ -+ odm_set_bb_reg(dm, R_0x914, 0xFFFF, 0x0100); -+ /* @antenna mapping table */ -+ -+ /* OFDM Settings */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x0); /* @bias */ -+ -+ /* @CCK Settings */ -+ odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); -+ /* Select which path to receive for CCK_1 & CCK_2 */ -+ odm_set_bb_reg(dm, R_0xb34, BIT(30), 0); -+ /* @(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* @Fix CCK PHY status report issue */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); -+ /* @CCK complete HW AntDiv within 64 samples */ -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ phydm_evm_sw_antdiv_init(dm); -+#endif -+} -+ -+void odm_trx_hw_ant_div_init_92e(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if 0 -+ if (*dm->mp_mode == true) { -+ odm_ant_div_on_off(dm, ANTDIV_OFF); -+ odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); /* r_rxdiv_enable_anta regc50[8]=1'b0 0: control by c50[9] */ -+ odm_set_bb_reg(dm, R_0xc50, BIT(9), 1); /* @1:CG, 0:CS */ -+ return; -+ } -+#endif -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* @3 --RFE pin setting--------- */ -+ /* @[MAC] */ -+ odm_set_mac_reg(dm, R_0x38, BIT(11), 1); -+ /* @DBG PAD Driving control (GPIO 8) */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); /* path-A, RFE_CTRL_3 */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(29), 1); /* path-A, RFE_CTRL_8 */ -+ /* @[BB] */ -+ odm_set_bb_reg(dm, R_0x944, BIT(3), 1); /* RFE_buffer */ -+ odm_set_bb_reg(dm, R_0x944, BIT(8), 1); -+ odm_set_bb_reg(dm, R_0x940, BIT(7) | BIT(6), 0x0); -+ /* r_rfe_path_sel_ (RFE_CTRL_3) */ -+ odm_set_bb_reg(dm, R_0x940, BIT(17) | BIT(16), 0x0); -+ /* r_rfe_path_sel_ (RFE_CTRL_8) */ -+ odm_set_bb_reg(dm, R_0x944, BIT(31), 0); /* RFE_buffer */ -+ odm_set_bb_reg(dm, R_0x92c, BIT(3), 0); /* rfe_inv (RFE_CTRL_3) */ -+ odm_set_bb_reg(dm, R_0x92c, BIT(8), 1); /* rfe_inv (RFE_CTRL_8) */ -+ odm_set_bb_reg(dm, R_0x930, 0xF000, 0x8); /* path-A, RFE_CTRL_3 */ -+ odm_set_bb_reg(dm, R_0x934, 0xF, 0x8); /* path-A, RFE_CTRL_8 */ -+ /* @3 ------------------------- */ -+ -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); -+ /* path-A */ /* disable CS/CG switch */ -+ -+#if 0 -+ /* @Let it follows PHY_REG for bit9 setting */ -+ if (dm->priv->pshare->rf_ft_var.use_ext_pa || -+ dm->priv->pshare->rf_ft_var.use_ext_lna) -+ odm_set_bb_reg(dm, R_0xc50, BIT(9), 1);/* path-A output at CS */ -+ else -+ odm_set_bb_reg(dm, R_0xc50, BIT(9), 0); -+ /* path-A output at CG ->normal power */ -+#endif -+ -+ odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); -+ /* path-A*/ /* antsel antselb by HW */ -+ odm_set_bb_reg(dm, R_0xb38, BIT(10), 0);/* path-A*/ /* antsel2 by HW */ -+ -+ /* @Mapping table */ -+ odm_set_bb_reg(dm, R_0x914, 0xFFFF, 0x0100); -+ /* @antenna mapping table */ -+ -+ /* OFDM Settings */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x0); /* @bias */ -+ -+ /* @CCK Settings */ -+ odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); -+ /* Select which path to receive for CCK_1 & CCK_2 */ -+ odm_set_bb_reg(dm, R_0xb34, BIT(30), 0); -+ /* @(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* @Fix CCK PHY status report issue */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); -+ /* @CCK complete HW AntDiv within 64 samples */ -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ phydm_evm_sw_antdiv_init(dm); -+#endif -+} -+ -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+void odm_smart_hw_ant_div_init_92e( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***8192E AntDiv_Init => ant_div_type=[CG_TRX_SMART_ANTDIV]\n"); -+} -+#endif -+ -+#endif /* @#if (RTL8192E_SUPPORT == 1) */ -+ -+#if (RTL8192F_SUPPORT == 1) -+void odm_rx_hw_ant_div_init_92f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, R_0x870, BIT(8), 0); -+ /* reg870[8]=1'b0, "antsel" is controlled by HWs */ -+ odm_set_bb_reg(dm, R_0xc50, BIT(8), 1); -+ /* regc50[8]=1'b1, " CS/CG switching" is controlled by HWs */ -+ -+ /* @Mapping table */ -+ odm_set_bb_reg(dm, R_0x914, 0xFFFF, 0x0100); -+ /* @antenna mapping table */ -+ -+ /* OFDM Settings */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x0); /* @bias */ -+ -+ /* @CCK Settings */ -+ odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); -+ /* Select which path to receive for CCK_1 & CCK_2 */ -+ odm_set_bb_reg(dm, R_0xb34, BIT(30), 0); -+ /* @(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* @Fix CCK PHY status report issue */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); -+ /* @CCK complete HW AntDiv within 64 samples */ -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ phydm_evm_sw_antdiv_init(dm); -+#endif -+} -+ -+void odm_trx_hw_ant_div_init_92f(void *dm_void) -+ -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ /* @3 --RFE pin setting--------- */ -+ /* @[MAC] */ -+ odm_set_mac_reg(dm, R_0x1048, BIT(0), 1); -+ /* @DBG PAD Driving control (gpioA_0) */ -+ odm_set_mac_reg(dm, R_0x1048, BIT(1), 1); -+ /* @DBG PAD Driving control (gpioA_1) */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); -+ odm_set_mac_reg(dm, R_0x1038, BIT(25) | BIT(24) | BIT(23), 0); -+ /* @gpioA_0,gpioA_1*/ -+ odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); -+ /* @[BB] */ -+ odm_set_bb_reg(dm, R_0x944, BIT(8), 1); /* output enable */ -+ odm_set_bb_reg(dm, R_0x944, BIT(9), 1); -+ odm_set_bb_reg(dm, R_0x940, BIT(16) | BIT(17), 0x0); -+ /* r_rfe_path_sel_ (RFE_CTRL_8) */ -+ odm_set_bb_reg(dm, R_0x940, BIT(18) | BIT(19), 0x0); -+ /* r_rfe_path_sel_ (RFE_CTRL_9) */ -+ odm_set_bb_reg(dm, R_0x944, BIT(31), 0); /* RFE_buffer_en */ -+ odm_set_bb_reg(dm, R_0x92c, BIT(8), 0); /* rfe_inv (RFE_CTRL_8) */ -+ odm_set_bb_reg(dm, R_0x92c, BIT(9), 1); /* rfe_inv (RFE_CTRL_9) */ -+ odm_set_bb_reg(dm, R_0x934, 0xF, 0x8); /* path-A, RFE_CTRL_8 */ -+ odm_set_bb_reg(dm, R_0x934, 0xF0, 0x8); /* path-A, RFE_CTRL_9 */ -+ /* @3 ------------------------- */ -+ -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); -+ /* path-A,disable CS/CG switch */ -+ odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); -+ /* path-A*, antsel antselb by HW */ -+ odm_set_bb_reg(dm, R_0xb38, BIT(10), 0); /* path-A ,antsel2 by HW */ -+ -+ /* @Mapping table */ -+ odm_set_bb_reg(dm, R_0x914, 0xFFFF, 0x0100); -+ /* @antenna mapping table */ -+ -+ /* OFDM Settings */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x0); /* @bias */ -+ -+ /* @CCK Settings */ -+ odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); -+ /* Select which path to receive for CCK_1 & CCK_2 */ -+ odm_set_bb_reg(dm, R_0xb34, BIT(30), 0); -+ /* @(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* @Fix CCK PHY status report issue */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); -+ /* @CCK complete HW AntDiv within 64 samples */ -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ phydm_evm_sw_antdiv_init(dm); -+#endif -+} -+ -+#endif /* @#if (RTL8192F_SUPPORT == 1) */ -+ -+#if (RTL8822B_SUPPORT == 1) -+void phydm_trx_hw_ant_div_init_22b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, R_0xcb8, BIT(21) | BIT(20), 0x1); -+ odm_set_bb_reg(dm, R_0xcb8, BIT(23) | BIT(22), 0x1); -+ odm_set_bb_reg(dm, R_0xc1c, BIT(7) | BIT(6), 0x0); -+ /* @------------------------- */ -+ -+ /* @Mapping table */ -+ /* @antenna mapping table */ -+ odm_set_bb_reg(dm, R_0xca4, 0xFFFF, 0x0100); -+ -+ /* OFDM Settings */ -+ /* thershold */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); -+ /* @bias */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x0); -+ odm_set_bb_reg(dm, R_0x668, BIT(3), 0x1); -+ -+ /* @CCK Settings */ -+ /* Select which path to receive for CCK_1 & CCK_2 */ -+ odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); -+ /* @Fix CCK PHY status report issue */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* @CCK complete HW AntDiv within 64 samples */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); -+ /* @BT Coexistence */ -+ /* @keep antsel_map when GNT_BT = 1 */ -+ odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); -+ /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ -+ odm_set_bb_reg(dm, R_0x804, BIT(4), 1); -+ /* response TX ant by RX ant */ -+ odm_set_mac_reg(dm, R_0x668, BIT(3), 1); -+#if (defined(CONFIG_2T4R_ANTENNA)) -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***8822B AntDiv_Init => 2T4R case\n"); -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, R_0xeb8, BIT(21) | BIT(20), 0x1); -+ odm_set_bb_reg(dm, R_0xeb8, BIT(23) | BIT(22), 0x1); -+ odm_set_bb_reg(dm, R_0xe1c, BIT(7) | BIT(6), 0x0); -+ /* @BT Coexistence */ -+ odm_set_bb_reg(dm, R_0xeac, BIT(9), 1); -+ /* @keep antsel_map when GNT_BT = 1 */ -+ /* Mapping table */ -+ /* antenna mapping table */ -+ odm_set_bb_reg(dm, R_0xea4, 0xFFFF, 0x0100); -+ /*odm_set_bb_reg(dm, R_0x900, 0x30000, 0x3);*/ -+#endif -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ phydm_evm_sw_antdiv_init(dm); -+#endif -+} -+#endif /* @#if (RTL8822B_SUPPORT == 1) */ -+ -+#if (RTL8197F_SUPPORT == 1) -+void phydm_rx_hw_ant_div_init_97f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+#if 0 -+ if (*dm->mp_mode == true) { -+ odm_ant_div_on_off(dm, ANTDIV_OFF); -+ odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); -+ /* r_rxdiv_enable_anta regc50[8]=1'b0 0: control by c50[9] */ -+ odm_set_bb_reg(dm, R_0xc50, BIT(9), 1); /* @1:CG, 0:CS */ -+ return; -+ } -+#endif -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, R_0x870, BIT(8), 0); -+ /* reg870[8]=1'b0, */ /* "antsel" is controlled by HWs */ -+ odm_set_bb_reg(dm, R_0xc50, BIT(8), 1); -+ /* regc50[8]=1'b1 *//*"CS/CG switching" is controlled by HWs */ -+ -+ /* @Mapping table */ -+ odm_set_bb_reg(dm, R_0x914, 0xFFFF, 0x0100); -+ /* @antenna mapping table */ -+ -+ /* OFDM Settings */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x0); /* @bias */ -+ -+ /* @CCK Settings */ -+ odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); -+ /* Select which path to receive for CCK_1 & CCK_2 */ -+ odm_set_bb_reg(dm, R_0xb34, BIT(30), 0); -+ /* @(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* @Fix CCK PHY status report issue */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); -+ /* @CCK complete HW AntDiv within 64 samples */ -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ phydm_evm_sw_antdiv_init(dm); -+#endif -+} -+#endif //#if (RTL8197F_SUPPORT == 1) -+ -+#if (RTL8197G_SUPPORT == 1) -+void phydm_rx_hw_ant_div_init_97g(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, R_0x1884, BIT(23), 0); -+ /* reg1844[23]=1'b0 *//*"CS/CG switching" is controlled by HWs*/ -+ odm_set_bb_reg(dm, R_0x1884, BIT(16), 1); -+ /* reg1844[16]=1'b1 *//*"antsel" is controlled by HWs*/ -+ -+ /* @Mapping table */ -+ odm_set_bb_reg(dm, R_0x1870, 0xFFFF, 0x0100); -+ /* @antenna mapping table */ -+ -+ /* OFDM Settings */ -+ odm_set_bb_reg(dm, R_0x1938, 0xFFE0, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0x1938, 0x7FF0000, 0x0); /* @bias */ -+ -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ phydm_evm_sw_antdiv_init(dm); -+#endif -+} -+#endif //#if (RTL8197F_SUPPORT == 1) -+ -+#if (RTL8723F_SUPPORT == 1) -+void phydm_rx_hw_ant_div_init_23f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ /* @3 --RFE pin setting--------- */ -+ /* @[MAC] */ -+ /* @gpioA_11,gpioA_12*/ -+ odm_set_mac_reg(dm, R_0x10d8, 0xFF000000, 0x16); -+ odm_set_mac_reg(dm, R_0x10dc, 0xFF, 0x16); -+ /* @[BB] */ -+ odm_set_bb_reg(dm, R_0x1c94, BIT(2) | BIT(3), 0x3); /* output enable */ -+ odm_set_bb_reg(dm, R_0x1ca0, BIT(2) | BIT(3), 0x0); -+ odm_set_bb_reg(dm, R_0x1c98, BIT(4) | BIT(5), 0x0); -+ /* r_rfe_path_sel_ (RFE_CTRL_2) */ -+ odm_set_bb_reg(dm, R_0x1c98, BIT(6) | BIT(7), 0x0); -+ /* r_rfe_path_sel_ (RFE_CTRL_3) */ -+ odm_set_bb_reg(dm, R_0x1838, BIT(28), 0); /* RFE_buffer_en */ -+ odm_set_bb_reg(dm, R_0x183c, BIT(2), 1); /* rfe_inv (RFE_CTRL_2) */ -+ odm_set_bb_reg(dm, R_0x183c, BIT(3), 0); /* rfe_inv (RFE_CTRL_3) */ -+ odm_set_bb_reg(dm, R_0x1840, 0xF00, 0x8); /* path-A, RFE_CTRL_2 */ -+ odm_set_bb_reg(dm, R_0x1840, 0xF000, 0x8); /* path-A, RFE_CTRL_3 */ -+ /* @3 ------------------------- */ -+ -+ /* Pin Settings */ -+ odm_set_bb_reg(dm, R_0x1884, BIT(23), 0); -+ odm_set_bb_reg(dm, R_0x1884, BIT(25), 0); -+ /* reg1844[23]=1'b0 *//*"CG switching" is controlled by HWs*/ -+ /* reg1844[25]=1'b0 *//*"CG switching" is controlled by HWs*/ -+ odm_set_bb_reg(dm, R_0x1884, BIT(16), 1); -+ /* reg1844[16]=1'b1 *//*"antsel" is controlled by HWs*/ -+ -+ /* @Mapping table */ -+ odm_set_bb_reg(dm, R_0x1870, 0xFFFF, 0x0100); -+ /* @antenna mapping table */ -+ -+ /* OFDM Settings */ -+ odm_set_bb_reg(dm, R_0x1938, 0xFFE0, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0x1938, 0x7FF0000, 0x0); /* @bias */ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ phydm_evm_sw_antdiv_init(dm); -+#endif -+} -+#endif //#if (RTL8723F_SUPPORT == 1) -+ -+#if (RTL8723D_SUPPORT == 1) -+void odm_trx_hw_ant_div_init_8723d(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /*@BT Coexistence*/ -+ /*@keep antsel_map when GNT_BT = 1*/ -+ odm_set_bb_reg(dm, R_0x864, BIT(12), 1); -+ /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ -+ odm_set_bb_reg(dm, R_0x874, BIT(23), 0); -+ /* @Disable hw antsw & fast_train.antsw when BT TX/RX */ -+ odm_set_bb_reg(dm, R_0xe64, 0xFFFF0000, 0x000c); -+ -+ odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); -+#if 0 -+ /*PTA setting: WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL)*/ -+ /*odm_set_bb_reg(dm, R_0x948, BIT6, 0);*/ -+ /*odm_set_bb_reg(dm, R_0x948, BIT8, 0);*/ -+#endif -+ /*@GNT_WL tx*/ -+ odm_set_bb_reg(dm, R_0x950, BIT(29), 0); -+ -+ /*@Mapping Table*/ -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 3); -+#if 0 -+ /* odm_set_bb_reg(dm, R_0x864, BIT5|BIT4|BIT3, 0); */ -+ /* odm_set_bb_reg(dm, R_0x864, BIT8|BIT7|BIT6, 1); */ -+#endif -+ -+ /* Set WLBB_SEL_RF_ON 1 if RXFIR_PWDB > 0xCcc[3:0] */ -+ odm_set_bb_reg(dm, R_0xccc, BIT(12), 0); -+ /* @Low-to-High threshold for WLBB_SEL_RF_ON when OFDM enable */ -+ odm_set_bb_reg(dm, R_0xccc, 0x0F, 0x01); -+ /* @High-to-Low threshold for WLBB_SEL_RF_ON when OFDM enable */ -+ odm_set_bb_reg(dm, R_0xccc, 0xF0, 0x0); -+ /* @b Low-to-High threshold for WLBB_SEL_RF_ON when OFDM disable (CCK)*/ -+ odm_set_bb_reg(dm, R_0xabc, 0xFF, 0x06); -+ /* @High-to-Low threshold for WLBB_SEL_RF_ON when OFDM disable (CCK) */ -+ odm_set_bb_reg(dm, R_0xabc, 0xFF00, 0x00); -+ -+ /*OFDM HW AntDiv Parameters*/ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xa0); -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x00); -+ odm_set_bb_reg(dm, R_0xc5c, BIT(20) | BIT(19) | BIT(18), 0x04); -+ -+ /*@CCK HW AntDiv Parameters*/ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); -+ odm_set_bb_reg(dm, R_0xaa8, BIT(8), 0); -+ -+ odm_set_bb_reg(dm, R_0xa0c, 0x0F, 0xf); -+ odm_set_bb_reg(dm, R_0xa14, 0x1F, 0x8); -+ odm_set_bb_reg(dm, R_0xa10, BIT(13), 0x1); -+ odm_set_bb_reg(dm, R_0xa74, BIT(8), 0x0); -+ odm_set_bb_reg(dm, R_0xb34, BIT(30), 0x1); -+ -+ /*@disable antenna training */ -+ odm_set_bb_reg(dm, R_0xe08, BIT(16), 0); -+ odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); -+} -+/*@Mingzhi 2017-05-08*/ -+ -+void odm_s0s1_sw_ant_div_init_8723d(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***8723D AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n"); -+ -+ /*@keep antsel_map when GNT_BT = 1*/ -+ odm_set_bb_reg(dm, R_0x864, BIT(12), 1); -+ -+ /* @Disable antsw when GNT_BT=1 */ -+ odm_set_bb_reg(dm, R_0x874, BIT(23), 0); -+ -+ /* @Mapping Table */ -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 1); -+ -+ /* Output Pin Settings */ -+#if 0 -+ /* odm_set_bb_reg(dm, R_0x948, BIT6, 0x1); */ -+#endif -+ odm_set_bb_reg(dm, R_0x870, BIT(8), 1); -+ odm_set_bb_reg(dm, R_0x870, BIT(9), 1); -+ -+ /* Status init */ -+ fat_tab->is_become_linked = false; -+ swat_tab->try_flag = SWAW_STEP_INIT; -+ swat_tab->double_chk_flag = 0; -+ swat_tab->cur_antenna = MAIN_ANT; -+ swat_tab->pre_ant = MAIN_ANT; -+ dm->antdiv_counter = CONFIG_ANTDIV_PERIOD; -+ -+ /* @2 [--For HW Bug setting] */ -+ odm_set_bb_reg(dm, R_0x80c, BIT(21), 0); /* TX ant by Reg */ -+} -+ -+void odm_update_rx_idle_ant_8723d(void *dm_void, u8 ant, u32 default_ant, -+ u32 optional_ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ void *adapter = dm->adapter; -+ u8 count = 0; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ /*score board to BT ,a002:WL to do ant-div*/ -+ odm_set_mac_reg(dm, R_0xa8, MASKHWORD, 0xa002); -+ ODM_delay_us(50); -+#endif -+#if 0 -+ /* odm_set_bb_reg(dm, R_0x948, BIT(6), 0x1); */ -+#endif -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ odm_set_bb_reg(dm, R_0x860, BIT(8), default_ant); -+ odm_set_bb_reg(dm, R_0x860, BIT(9), default_ant); -+ } -+ odm_set_bb_reg(dm, R_0x864, BIT(5) | BIT(4) | BIT(3), default_ant); -+ /*@Default RX*/ -+ odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); -+ /*Optional RX*/ -+ odm_set_bb_reg(dm, R_0x860, BIT(14) | BIT(13) | BIT(12), default_ant); -+ /*@Default TX*/ -+ fat_tab->rx_idle_ant = ant; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ /*score board to BT ,a000:WL@S1 a001:WL@S0*/ -+ if (default_ant == ANT1_2G) -+ odm_set_mac_reg(dm, R_0xa8, MASKHWORD, 0xa000); -+ else -+ odm_set_mac_reg(dm, R_0xa8, MASKHWORD, 0xa001); -+#endif -+} -+ -+void phydm_set_tx_ant_pwr_8723d(void *dm_void, u8 ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ void *adapter = dm->adapter; -+ -+ fat_tab->rx_idle_ant = ant; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ((PADAPTER)adapter)->HalFunc.SetTxPowerLevelHandler(adapter, *dm->channel); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtw_hal_set_tx_power_level(adapter, *dm->channel); -+#endif -+} -+#endif -+ -+#if (RTL8723B_SUPPORT == 1) -+void odm_trx_hw_ant_div_init_8723b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***8723B AntDiv_Init => ant_div_type=[CG_TRX_HW_ANTDIV(DPDT)]\n"); -+ -+ /* @Mapping Table */ -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 1); -+ -+ /* OFDM HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xa0); /* thershold */ -+ odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x00); /* @bias */ -+ -+ /* @CCK HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* patch for clk from 88M to 80M */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); -+ /* @do 64 samples */ -+ -+ /* @BT Coexistence */ -+ odm_set_bb_reg(dm, R_0x864, BIT(12), 0); -+ /* @keep antsel_map when GNT_BT = 1 */ -+ odm_set_bb_reg(dm, R_0x874, BIT(23), 0); -+ /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ -+ -+ /* Output Pin Settings */ -+ odm_set_bb_reg(dm, R_0x870, BIT(8), 0); -+ -+ odm_set_bb_reg(dm, R_0x948, BIT(6), 0); -+ /* WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL) */ -+ odm_set_bb_reg(dm, R_0x948, BIT(7), 0); -+ -+ odm_set_mac_reg(dm, R_0x40, BIT(3), 1); -+ odm_set_mac_reg(dm, R_0x38, BIT(11), 1); -+ odm_set_mac_reg(dm, R_0x4c, BIT(24) | BIT(23), 2); -+ /* select DPDT_P and DPDT_N as output pin */ -+ -+ odm_set_bb_reg(dm, R_0x944, BIT(0) | BIT(1), 3); /* @in/out */ -+ odm_set_bb_reg(dm, R_0x944, BIT(31), 0); -+ -+ odm_set_bb_reg(dm, R_0x92c, BIT(1), 0); /* @DPDT_P non-inverse */ -+ odm_set_bb_reg(dm, R_0x92c, BIT(0), 1); /* @DPDT_N inverse */ -+ -+ odm_set_bb_reg(dm, R_0x930, 0xF0, 8); /* @DPDT_P = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0x930, 0xF, 8); /* @DPDT_N = ANTSEL[0] */ -+ -+ /* @2 [--For HW Bug setting] */ -+ if (dm->ant_type == ODM_AUTO_ANT) -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); -+ /* @CCK AntDiv function block enable */ -+} -+ -+void odm_s0s1_sw_ant_div_init_8723b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***8723B AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n"); -+ -+ /* @Mapping Table */ -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 1); -+ -+#if 0 -+ /* Output Pin Settings */ -+ /* odm_set_bb_reg(dm, R_0x948, BIT6, 0x1); */ -+#endif -+ odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); -+ -+ fat_tab->is_become_linked = false; -+ swat_tab->try_flag = SWAW_STEP_INIT; -+ swat_tab->double_chk_flag = 0; -+ -+ /* @2 [--For HW Bug setting] */ -+ odm_set_bb_reg(dm, R_0x80c, BIT(21), 0); /* TX ant by Reg */ -+} -+ -+void odm_update_rx_idle_ant_8723b( -+ void *dm_void, -+ u8 ant, -+ u32 default_ant, -+ u32 optional_ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ void *adapter = dm->adapter; -+ u8 count = 0; -+ /*u8 u1_temp;*/ -+ /*u8 h2c_parameter;*/ -+ -+ if (!dm->is_linked && dm->ant_type == ODM_AUTO_ANT) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 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_fill_h2c_cmd(dm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); -+ -+ /* @Check if H2C command sucess or not (0x1e6) */ -+ u1_temp = odm_read_1byte(dm, 0x1e6); -+ while ((u1_temp != 0x1) && (count < 100)) { -+ ODM_delay_us(10); -+ u1_temp = odm_read_1byte(dm, 0x1e6); -+ count++; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Update Rx-Idle-ant ] 8723B: H2C command status = %d, count = %d\n", -+ u1_temp, count); -+ -+ if (u1_temp == 0x1) { -+ /* @Check if BT is doing IQK (0x1e7) */ -+ count = 0; -+ u1_temp = odm_read_1byte(dm, 0x1e7); -+ while ((!(u1_temp & BIT(0))) && (count < 100)) { -+ ODM_delay_us(50); -+ u1_temp = odm_read_1byte(dm, 0x1e7); -+ count++; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Update Rx-Idle-ant ] 8723B: BT IQK status = %d, count = %d\n", -+ u1_temp, count); -+ -+ if (u1_temp & BIT(0)) { -+ odm_set_bb_reg(dm, R_0x948, BIT(6), 0x1); -+ odm_set_bb_reg(dm, R_0x948, BIT(9), default_ant); -+ odm_set_bb_reg(dm, R_0x864, 0x38, default_ant); -+ /* @Default RX */ -+ odm_set_bb_reg(dm, R_0x864, 0x1c0, optional_ant); -+ /* @Optional RX */ -+ odm_set_bb_reg(dm, R_0x860, 0x7000, default_ant); -+ /* @Default TX */ -+ fat_tab->rx_idle_ant = ant; -+ -+ /* Set TX AGC by S0/S1 */ -+ /* Need to consider Linux driver */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ adapter->hal_func.set_tx_power_level_handler(adapter, *dm->channel); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtw_hal_set_tx_power_level(adapter, *dm->channel); -+#endif -+ -+ /* Set IQC by S0/S1 */ -+ odm_set_iqc_by_rfpath(dm, default_ant); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Update Rx-Idle-ant ] 8723B: Success to set RX antenna\n"); -+ } else -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Update Rx-Idle-ant ] 8723B: Fail to set RX antenna due to BT IQK\n"); -+ } else -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 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_fill_h2c_cmd(dm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); -+#else -+ -+ odm_set_bb_reg(dm, R_0x948, BIT(6), 0x1); -+ odm_set_bb_reg(dm, R_0x948, BIT(9), default_ant); -+ odm_set_bb_reg(dm, R_0x864, BIT(5) | BIT(4) | BIT(3), default_ant); -+ /*@Default RX*/ -+ odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); -+ /*Optional RX*/ -+ odm_set_bb_reg(dm, R_0x860, BIT(14) | BIT(13) | BIT(12), default_ant); -+ /*@Default TX*/ -+ fat_tab->rx_idle_ant = ant; -+ -+/* Set TX AGC by S0/S1 */ -+/* Need to consider Linux driver */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ((PADAPTER)adapter)->HalFunc.SetTxPowerLevelHandler(adapter, *dm->channel); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtw_hal_set_tx_power_level(adapter, *dm->channel); -+#endif -+ -+ /* Set IQC by S0/S1 */ -+ odm_set_iqc_by_rfpath(dm, default_ant); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Update Rx-Idle-ant ] 8723B: Success to set RX antenna\n"); -+ -+#endif -+} -+ -+boolean -+phydm_is_bt_enable_8723b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 bt_state; -+#if 0 -+ /*u32 reg75;*/ -+ -+ /*reg75 = odm_get_bb_reg(dm, R_0x74, BIT8);*/ -+ /*odm_set_bb_reg(dm, R_0x74, BIT8, 0x0);*/ -+#endif -+ odm_set_bb_reg(dm, R_0xa0, BIT(24) | BIT(25) | BIT(26), 0x5); -+ bt_state = odm_get_bb_reg(dm, R_0xa0, 0xf); -+#if 0 -+ /*odm_set_bb_reg(dm, R_0x74, BIT8, reg75);*/ -+#endif -+ -+ 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) -+ -+void odm_trx_hw_ant_div_init_8821a(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* Output Pin Settings */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); -+ -+ odm_set_mac_reg(dm, R_0x64, BIT(29), 1); /* PAPE by WLAN control */ -+ odm_set_mac_reg(dm, R_0x64, BIT(28), 1); /* @LNAON by WLAN control */ -+ -+ odm_set_bb_reg(dm, R_0xcb8, BIT(16), 0); -+ -+ odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); -+ /* select DPDT_P and DPDT_N as output pin */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); /* @by WLAN control */ -+ odm_set_bb_reg(dm, R_0xcb4, 0xF, 8); /* @DPDT_P = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb4, 0xF0, 8); /* @DPDT_N = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(29), 0); /* @DPDT_P non-inverse */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(28), 1); /* @DPDT_N inverse */ -+ -+ /* @Mapping Table */ -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); -+ -+ /* OFDM HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x10); /* @bias */ -+ -+ /* @CCK HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* patch for clk from 88M to 80M */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ -+ -+ odm_set_bb_reg(dm, R_0x800, BIT(25), 0); -+ /* @ANTSEL_CCK sent to the smart_antenna circuit */ -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); -+ /* @CCK AntDiv function block enable */ -+ -+ /* @BT Coexistence */ -+ odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); -+ /* @keep antsel_map when GNT_BT = 1 */ -+ odm_set_bb_reg(dm, R_0x804, BIT(4), 1); -+ /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ -+ -+ odm_set_bb_reg(dm, R_0x8cc, BIT(20) | BIT(19) | BIT(18), 3); -+ /* settling time of antdiv by RF LNA = 100ns */ -+ -+ /* response TX ant by RX ant */ -+ odm_set_mac_reg(dm, R_0x668, BIT(3), 1); -+} -+ -+void odm_s0s1_sw_ant_div_init_8821a(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* Output Pin Settings */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); -+ -+ odm_set_mac_reg(dm, R_0x64, BIT(29), 1); /* PAPE by WLAN control */ -+ odm_set_mac_reg(dm, R_0x64, BIT(28), 1); /* @LNAON by WLAN control */ -+ -+ odm_set_bb_reg(dm, R_0xcb8, BIT(16), 0); -+ -+ odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); -+ /* select DPDT_P and DPDT_N as output pin */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); /* @by WLAN control */ -+ odm_set_bb_reg(dm, R_0xcb4, 0xF, 8); /* @DPDT_P = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb4, 0xF0, 8); /* @DPDT_N = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(29), 0); /* @DPDT_P non-inverse */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(28), 1); /* @DPDT_N inverse */ -+ -+ /* @Mapping Table */ -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); -+ -+ /* OFDM HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x10); /* @bias */ -+ -+ /* @CCK HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* patch for clk from 88M to 80M */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ -+ -+ odm_set_bb_reg(dm, R_0x800, BIT(25), 0); -+ /* @ANTSEL_CCK sent to the smart_antenna circuit */ -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); -+ /* @CCK AntDiv function block enable */ -+ -+ /* @BT Coexistence */ -+ odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); -+ /* @keep antsel_map when GNT_BT = 1 */ -+ odm_set_bb_reg(dm, R_0x804, BIT(4), 1); -+ /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ -+ -+ odm_set_bb_reg(dm, R_0x8cc, BIT(20) | BIT(19) | BIT(18), 3); -+ /* settling time of antdiv by RF LNA = 100ns */ -+ -+ /* response TX ant by RX ant */ -+ odm_set_mac_reg(dm, R_0x668, BIT(3), 1); -+ -+ odm_set_bb_reg(dm, R_0x900, BIT(18), 0); -+ -+ swat_tab->try_flag = SWAW_STEP_INIT; -+ swat_tab->double_chk_flag = 0; -+ swat_tab->cur_antenna = MAIN_ANT; -+ swat_tab->pre_ant = MAIN_ANT; -+ swat_tab->swas_no_link_state = 0; -+} -+#endif /* @#if (RTL8821A_SUPPORT == 1) */ -+ -+#if (RTL8821C_SUPPORT == 1) -+void odm_trx_hw_ant_div_init_8821c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ /* Output Pin Settings */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); -+ -+ odm_set_mac_reg(dm, R_0x64, BIT(29), 1); /* PAPE by WLAN control */ -+ odm_set_mac_reg(dm, R_0x64, BIT(28), 1); /* @LNAON by WLAN control */ -+ -+ odm_set_bb_reg(dm, R_0xcb8, BIT(16), 0); -+ -+ odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); -+ /* select DPDT_P and DPDT_N as output pin */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); /* @by WLAN control */ -+ odm_set_bb_reg(dm, R_0xcb4, 0xF, 8); /* @DPDT_P = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb4, 0xF0, 8); /* @DPDT_N = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(29), 0); /* @DPDT_P non-inverse */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(28), 1); /* @DPDT_N inverse */ -+ -+ /* @Mapping Table */ -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); -+ -+ /* OFDM HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x10); /* @bias */ -+ -+ /* @CCK HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* patch for clk from 88M to 80M */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ -+ -+ odm_set_bb_reg(dm, R_0x800, BIT(25), 0); -+ /* @ANTSEL_CCK sent to the smart_antenna circuit */ -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); -+ /* @CCK AntDiv function block enable */ -+ -+ /* @BT Coexistence */ -+ odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); -+ /* @keep antsel_map when GNT_BT = 1 */ -+ odm_set_bb_reg(dm, R_0x804, BIT(4), 1); -+ /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ -+ -+ /* Timming issue */ -+ odm_set_bb_reg(dm, R_0x818, BIT(23) | BIT(22) | BIT(21) | BIT(20), 0); -+ /*@keep antidx after tx for ACK ( unit x 3.2 mu sec)*/ -+ odm_set_bb_reg(dm, R_0x8cc, BIT(20) | BIT(19) | BIT(18), 3); -+ /* settling time of antdiv by RF LNA = 100ns */ -+ -+ /* response TX ant by RX ant */ -+ odm_set_mac_reg(dm, R_0x668, BIT(3), 1); -+} -+ -+void phydm_s0s1_sw_ant_div_init_8821c(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* Output Pin Settings */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); -+ -+ odm_set_mac_reg(dm, R_0x64, BIT(29), 1); /* PAPE by WLAN control */ -+ odm_set_mac_reg(dm, R_0x64, BIT(28), 1); /* @LNAON by WLAN control */ -+ -+ odm_set_bb_reg(dm, R_0xcb8, BIT(16), 0); -+ -+ odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); -+ /* select DPDT_P and DPDT_N as output pin */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); /* @by WLAN control */ -+ odm_set_bb_reg(dm, R_0xcb4, 0xF, 8); /* @DPDT_P = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb4, 0xF0, 8); /* @DPDT_N = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(29), 0); /* @DPDT_P non-inverse */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(28), 1); /* @DPDT_N inverse */ -+ -+ /* @Mapping Table */ -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); -+ -+ /* OFDM HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x00); /* @bias */ -+ -+ /* @CCK HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* patch for clk from 88M to 80M */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ -+ -+ odm_set_bb_reg(dm, R_0x800, BIT(25), 0); -+ /* @ANTSEL_CCK sent to the smart_antenna circuit */ -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); -+ /* @CCK AntDiv function block enable */ -+ -+ /* @BT Coexistence */ -+ odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); -+ /* @keep antsel_map when GNT_BT = 1 */ -+ odm_set_bb_reg(dm, R_0x804, BIT(4), 1); -+ /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ -+ -+ odm_set_bb_reg(dm, R_0x8cc, BIT(20) | BIT(19) | BIT(18), 3); -+ /* settling time of antdiv by RF LNA = 100ns */ -+ -+ /* response TX ant by RX ant */ -+ odm_set_mac_reg(dm, R_0x668, BIT(3), 1); -+ -+ odm_set_bb_reg(dm, R_0x900, BIT(18), 0); -+ -+ swat_tab->try_flag = SWAW_STEP_INIT; -+ swat_tab->double_chk_flag = 0; -+ swat_tab->cur_antenna = MAIN_ANT; -+ swat_tab->pre_ant = MAIN_ANT; -+ swat_tab->swas_no_link_state = 0; -+} -+#endif /* @#if (RTL8821C_SUPPORT == 1) */ -+ -+#if (RTL8195B_SUPPORT == 1) -+void odm_trx_hw_ant_div_init_8195b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ odm_set_bb_reg(dm, R_0xcb8, BIT(16), 0); -+ /*RFE control pin 0,1*/ -+ odm_set_bb_reg(dm, R_0xcb0, 0xF, 8); /* @DPDT_P = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb0, 0xF0, 8); /* @DPDT_N = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(20), 0); /* @DPDT_P non-inverse */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(21), 1); /* @DPDT_N inverse */ -+ -+ /* @Mapping Table */ -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); -+ -+ /* OFDM HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x10); /* @bias */ -+ -+ /* @CCK HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* patch for clk from 88M to 80M */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ -+ -+ odm_set_bb_reg(dm, R_0x800, BIT(25), 0); -+ /* @ANTSEL_CCK sent to the smart_antenna circuit */ -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); -+ /* @CCK AntDiv function block enable */ -+ -+ /* @BT Coexistence */ -+ odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); -+ /* @keep antsel_map when GNT_BT = 1 */ -+ odm_set_bb_reg(dm, R_0x804, BIT(4), 1); -+ /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ -+ -+ /* Timming issue */ -+ odm_set_bb_reg(dm, R_0x818, BIT(23) | BIT(22) | BIT(21) | BIT(20), 0); -+ /*@keep antidx after tx for ACK ( unit x 3.2 mu sec)*/ -+ odm_set_bb_reg(dm, R_0x8cc, BIT(20) | BIT(19) | BIT(18), 3); -+ /* settling time of antdiv by RF LNA = 100ns */ -+ -+ /* response TX ant by RX ant */ -+ odm_set_mac_reg(dm, R_0x668, BIT(3), 1); -+} -+#endif /* @#if (RTL8195B_SUPPORT == 1) */ -+ -+#if (RTL8881A_SUPPORT == 1) -+void odm_trx_hw_ant_div_init_8881a(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* Output Pin Settings */ -+ /* @[SPDT related] */ -+ odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); -+ odm_set_mac_reg(dm, R_0x4c, BIT(26), 0); -+ odm_set_bb_reg(dm, R_0xcb4, BIT(31), 0); /* @delay buffer */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(22), 0); -+ odm_set_bb_reg(dm, R_0xcb4, BIT(24), 1); -+ odm_set_bb_reg(dm, R_0xcb0, 0xF00, 8); /* @DPDT_P = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb0, 0xF0000, 8); /* @DPDT_N = ANTSEL[0] */ -+ -+ /* @Mapping Table */ -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); -+ -+ /* OFDM HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x0); /* @bias */ -+ odm_set_bb_reg(dm, R_0x8cc, BIT(20) | BIT(19) | BIT(18), 3); -+ /* settling time of antdiv by RF LNA = 100ns */ -+ -+ /* @CCK HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* patch for clk from 88M to 80M */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ -+ -+ /* @2 [--For HW Bug setting] */ -+ -+ odm_set_bb_reg(dm, R_0x900, BIT(18), 0); -+ /* TX ant by Reg *//* A-cut bug */ -+} -+ -+#endif /* @#if (RTL8881A_SUPPORT == 1) */ -+ -+#if (RTL8812A_SUPPORT == 1) -+void odm_trx_hw_ant_div_init_8812a(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+ /* @3 */ /* @3 --RFE pin setting--------- */ -+ /* @[BB] */ -+ odm_set_bb_reg(dm, R_0x900, BIT(10) | BIT(9) | BIT(8), 0x0); -+ /* @disable SW switch */ -+ odm_set_bb_reg(dm, R_0x900, BIT(17) | BIT(16), 0x0); -+ odm_set_bb_reg(dm, R_0x974, BIT(7) | BIT(6), 0x3); /* @in/out */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(31), 0); /* @delay buffer */ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(26), 0); -+ odm_set_bb_reg(dm, R_0xcb4, BIT(27), 1); -+ odm_set_bb_reg(dm, R_0xcb0, 0xF000000, 8); /* @DPDT_P = ANTSEL[0] */ -+ odm_set_bb_reg(dm, R_0xcb0, 0xF0000000, 8); /* @DPDT_N = ANTSEL[0] */ -+ /* @3 ------------------------- */ -+ -+ /* @Mapping Table */ -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); -+ odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); -+ -+ /* OFDM HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ -+ odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x0); /* @bias */ -+ odm_set_bb_reg(dm, R_0x8cc, BIT(20) | BIT(19) | BIT(18), 3); -+ /* settling time of antdiv by RF LNA = 100ns */ -+ -+ /* @CCK HW AntDiv Parameters */ -+ odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); -+ /* patch for clk from 88M to 80M */ -+ odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ -+ -+ /* @2 [--For HW Bug setting] */ -+ -+ odm_set_bb_reg(dm, R_0x900, BIT(18), 0); -+ /* TX ant by Reg */ /* A-cut bug */ -+} -+ -+#endif /* @#if (RTL8812A_SUPPORT == 1) */ -+ -+#if (RTL8188F_SUPPORT == 1) -+void odm_s0s1_sw_ant_div_init_8188f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); -+ -+#if 0 -+ /*@GPIO setting*/ -+ /*odm_set_mac_reg(dm, R_0x64, BIT(18), 0); */ -+ /*odm_set_mac_reg(dm, R_0x44, BIT(28)|BIT(27), 0);*/ -+ /*odm_set_mac_reg(dm, R_0x44, BIT(20) | BIT(19), 0x3);*/ -+ /*enable_output for P_GPIO[4:3]*/ -+ /*odm_set_mac_reg(dm, R_0x44, BIT(12)|BIT(11), 0);*/ /*output value*/ -+ /*odm_set_mac_reg(dm, R_0x40, BIT(1)|BIT(0), 0);*/ /*GPIO function*/ -+#endif -+ -+ if (dm->support_ic_type == ODM_RTL8188F) { -+ if (dm->support_interface == ODM_ITRF_USB) -+ odm_set_mac_reg(dm, R_0x44, BIT(20) | BIT(19), 0x3); -+ /*@enable_output for P_GPIO[4:3]*/ -+ else if (dm->support_interface == ODM_ITRF_SDIO) -+ odm_set_mac_reg(dm, R_0x44, BIT(18), 0x1); -+ /*@enable_output for P_GPIO[2]*/ -+ } -+ -+ fat_tab->is_become_linked = false; -+ swat_tab->try_flag = SWAW_STEP_INIT; -+ swat_tab->double_chk_flag = 0; -+} -+ -+void phydm_update_rx_idle_antenna_8188F(void *dm_void, u32 default_ant) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 codeword; -+ -+ if (dm->support_ic_type == ODM_RTL8188F) { -+ if (dm->support_interface == ODM_ITRF_USB) { -+ if (default_ant == ANT1_2G) -+ codeword = 1; /*@2'b01*/ -+ else -+ codeword = 2; /*@2'b10*/ -+ odm_set_mac_reg(dm, R_0x44, 0x1800, codeword); -+ /*@GPIO[4:3] output value*/ -+ } else if (dm->support_interface == ODM_ITRF_SDIO) { -+ if (default_ant == ANT1_2G) { -+ codeword = 0; /*@1'b0*/ -+ odm_set_bb_reg(dm, R_0x870, 0x300, 0x3); -+ odm_set_bb_reg(dm, R_0x860, 0x300, 0x1); -+ } else { -+ codeword = 1; /*@1'b1*/ -+ odm_set_bb_reg(dm, R_0x870, 0x300, 0x3); -+ odm_set_bb_reg(dm, R_0x860, 0x300, 0x2); -+ } -+ odm_set_mac_reg(dm, R_0x44, BIT(10), codeword); -+ /*@GPIO[2] output value*/ -+ } -+ } -+} -+#endif -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+void phydm_rx_rate_for_antdiv(void *dm_void, void *pkt_info_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ u8 data_rate = 0; -+ -+ pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ data_rate = pktinfo->data_rate & 0x7f; -+ -+ if (!fat_tab->get_stats) -+ return; -+ -+ if (fat_tab->antsel_rx_keep_0 == ANT1_2G) { -+ if (data_rate >= ODM_RATEMCS0 && -+ data_rate <= ODM_RATEMCS15) -+ fat_tab->main_ht_cnt[data_rate - ODM_RATEMCS0]++; -+ else if (data_rate >= ODM_RATEVHTSS1MCS0 && -+ data_rate <= ODM_RATEVHTSS2MCS9) -+ fat_tab->main_vht_cnt[data_rate - ODM_RATEVHTSS1MCS0]++; -+ } else { /*ANT2_2G*/ -+ if (data_rate >= ODM_RATEMCS0 && -+ data_rate <= ODM_RATEMCS15) -+ fat_tab->aux_ht_cnt[data_rate - ODM_RATEMCS0]++; -+ else if (data_rate >= ODM_RATEVHTSS1MCS0 && -+ data_rate <= ODM_RATEVHTSS2MCS9) -+ fat_tab->aux_vht_cnt[data_rate - ODM_RATEVHTSS1MCS0]++; -+ } -+} -+ -+void phydm_antdiv_reset_rx_rate(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ odm_memory_set(dm, &fat_tab->main_ht_cnt[0], 0, HT_IDX * 2); -+ odm_memory_set(dm, &fat_tab->aux_ht_cnt[0], 0, HT_IDX * 2); -+ odm_memory_set(dm, &fat_tab->main_vht_cnt[0], 0, VHT_IDX * 2); -+ odm_memory_set(dm, &fat_tab->aux_vht_cnt[0], 0, VHT_IDX * 2); -+} -+ -+void phydm_statistics_evm_1ss(void *dm_void, void *phy_info_void, -+ u8 antsel_tr_mux, u32 id, u32 utility) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct phydm_phyinfo_struct *phy_info = NULL; -+ -+ phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ if (antsel_tr_mux == ANT1_2G) { -+ fat_tab->main_evm_sum[id] += ((phy_info->rx_mimo_evm_dbm[0]) -+ << 5); -+ fat_tab->main_evm_cnt[id]++; -+ } else { -+ fat_tab->aux_evm_sum[id] += ((phy_info->rx_mimo_evm_dbm[0]) -+ << 5); -+ fat_tab->aux_evm_cnt[id]++; -+ } -+} -+ -+void phydm_statistics_evm_2ss(void *dm_void, void *phy_info_void, -+ u8 antsel_tr_mux, u32 id, u32 utility) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct phydm_phyinfo_struct *phy_info = NULL; -+ -+ phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ if (antsel_tr_mux == ANT1_2G) { -+ fat_tab->main_evm_2ss_sum[id][0] += phy_info->rx_mimo_evm_dbm[0] -+ << 5; -+ fat_tab->main_evm_2ss_sum[id][1] += phy_info->rx_mimo_evm_dbm[1] -+ << 5; -+ fat_tab->main_evm_2ss_cnt[id]++; -+ -+ } else { -+ fat_tab->aux_evm_2ss_sum[id][0] += (phy_info->rx_mimo_evm_dbm[0] -+ << 5); -+ fat_tab->aux_evm_2ss_sum[id][1] += (phy_info->rx_mimo_evm_dbm[1] -+ << 5); -+ fat_tab->aux_evm_2ss_cnt[id]++; -+ } -+} -+ -+void phydm_evm_sw_antdiv_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ /*@EVM enhance AntDiv method init----------------*/ -+ fat_tab->evm_method_enable = 0; -+ fat_tab->fat_state = NORMAL_STATE_MIAN; -+ fat_tab->fat_state_cnt = 0; -+ fat_tab->pre_antdiv_rssi = 0; -+ -+ dm->antdiv_intvl = 30; -+ dm->antdiv_delay = 20; -+ dm->antdiv_train_num = 4; -+ if (dm->support_ic_type & ODM_RTL8192E) -+ odm_set_bb_reg(dm, R_0x910, 0x3f, 0xf); -+ dm->antdiv_evm_en = 1; -+ /*@dm->antdiv_period=1;*/ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ dm->evm_antdiv_period = 1; -+#else -+ dm->evm_antdiv_period = 3; -+#endif -+ dm->stop_antdiv_rssi_th = 3; -+ dm->stop_antdiv_tp_th = 80; -+ dm->antdiv_tp_period = 3; -+ dm->stop_antdiv_tp_diff_th = 5; -+} -+ -+void odm_evm_fast_ant_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ fat_tab->evm_method_enable = 0; -+ if (fat_tab->div_path_type == ANT_PATH_A) -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); -+ else if (fat_tab->div_path_type == ANT_PATH_B) -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_B); -+ else if (fat_tab->div_path_type == ANT_PATH_AB) -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_AB); -+ fat_tab->fat_state = NORMAL_STATE_MIAN; -+ fat_tab->fat_state_cnt = 0; -+ dm->antdiv_period = 0; -+ odm_set_mac_reg(dm, R_0x608, BIT(8), 0); -+} -+ -+void odm_evm_enhance_ant_div(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 main_rssi, aux_rssi; -+ u32 main_crc_utility = 0, aux_crc_utility = 0, utility_ratio = 1; -+ u32 main_evm, aux_evm, diff_rssi = 0, diff_EVM = 0; -+ u32 main_2ss_evm[2], aux_2ss_evm[2]; -+ u32 main_1ss_evm, aux_1ss_evm; -+ u32 main_2ss_evm_sum, aux_2ss_evm_sum; -+ u8 score_EVM = 0, score_CRC = 0; -+ u8 rssi_larger_ant = 0; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u32 value32, i, mac_id; -+ boolean main_above1 = false, aux_above1 = false; -+ boolean force_antenna = false; -+ struct cmn_sta_info *sta; -+ u32 main_tp_avg, aux_tp_avg; -+ u8 curr_rssi, rssi_diff; -+ u32 tp_diff, tp_diff_avg; -+ u16 main_max_cnt = 0, aux_max_cnt = 0; -+ u16 main_max_idx = 0, aux_max_idx = 0; -+ u16 main_cnt_all = 0, aux_cnt_all = 0; -+ u8 rate_num = dm->num_rf_path; -+ u8 rate_ss_shift = 0; -+ u8 tp_diff_return = 0, tp_return = 0, rssi_return = 0; -+ u8 target_ant_evm_1ss, target_ant_evm_2ss; -+ u8 decision_evm_ss; -+ u8 next_ant; -+ -+ fat_tab->target_ant_enhance = 0xFF; -+ -+ if ((dm->support_ic_type & ODM_EVM_ANTDIV_IC)) { -+ if (dm->is_one_entry_only) { -+#if 0 -+ /* PHYDM_DBG(dm,DBG_ANT_DIV, "[One Client only]\n"); */ -+#endif -+ mac_id = dm->one_entry_macid; -+ sta = dm->phydm_sta_info[mac_id]; -+ -+ main_rssi = (fat_tab->main_cnt[mac_id] != 0) ? (fat_tab->main_sum[mac_id] / fat_tab->main_cnt[mac_id]) : 0; -+ aux_rssi = (fat_tab->aux_cnt[mac_id] != 0) ? (fat_tab->aux_sum[mac_id] / fat_tab->aux_cnt[mac_id]) : 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; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Main_Cnt=(( %d )), main_rssi=(( %d ))\n", -+ fat_tab->main_cnt[mac_id], main_rssi); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Aux_Cnt=(( %d )), aux_rssi=(( %d ))\n", -+ fat_tab->aux_cnt[mac_id], aux_rssi); -+ -+ if (((main_rssi >= evm_rssi_th_high || aux_rssi >= evm_rssi_th_high) || fat_tab->evm_method_enable == 1) -+ /* @&& (diff_rssi <= FORCE_RSSI_DIFF + 1) */ -+ ) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "> TH_H || evm_method_enable==1\n"); -+ -+ if ((main_rssi >= evm_rssi_th_low || aux_rssi >= evm_rssi_th_low)) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "> TH_L, fat_state_cnt =((%d))\n", fat_tab->fat_state_cnt); -+ -+ /*Traning state: 0(alt) 1(ori) 2(alt) 3(ori)============================================================*/ -+ if (fat_tab->fat_state_cnt < (dm->antdiv_train_num << 1)) { -+ if (fat_tab->fat_state_cnt == 0) { -+ /*Reset EVM 1SS Method */ -+ fat_tab->main_evm_sum[mac_id] = 0; -+ fat_tab->aux_evm_sum[mac_id] = 0; -+ fat_tab->main_evm_cnt[mac_id] = 0; -+ fat_tab->aux_evm_cnt[mac_id] = 0; -+ /*Reset EVM 2SS Method */ -+ fat_tab->main_evm_2ss_sum[mac_id][0] = 0; -+ fat_tab->main_evm_2ss_sum[mac_id][1] = 0; -+ fat_tab->aux_evm_2ss_sum[mac_id][0] = 0; -+ fat_tab->aux_evm_2ss_sum[mac_id][1] = 0; -+ fat_tab->main_evm_2ss_cnt[mac_id] = 0; -+ fat_tab->aux_evm_2ss_cnt[mac_id] = 0; -+ -+ /*Reset TP Method */ -+ fat_tab->main_tp = 0; -+ fat_tab->aux_tp = 0; -+ fat_tab->main_tp_cnt = 0; -+ fat_tab->aux_tp_cnt = 0; -+ phydm_antdiv_reset_rx_rate(dm); -+ -+ /*Reset CRC Method */ -+ fat_tab->main_crc32_ok_cnt = 0; -+ fat_tab->main_crc32_fail_cnt = 0; -+ fat_tab->aux_crc32_ok_cnt = 0; -+ fat_tab->aux_crc32_fail_cnt = 0; -+ -+#ifdef SKIP_EVM_ANTDIV_TRAINING_PATCH -+ if ((*dm->band_width == CHANNEL_WIDTH_20) && sta->mimo_type == RF_2T2R) { -+ /*@1. Skip training: RSSI*/ -+#if 0 -+ /*PHYDM_DBG(pDM_Odm,DBG_ANT_DIV, "TargetAnt_enhance=((%d)), RxIdleAnt=((%d))\n", pDM_FatTable->TargetAnt_enhance, pDM_FatTable->RxIdleAnt);*/ -+#endif -+ curr_rssi = (u8)((fat_tab->rx_idle_ant == MAIN_ANT) ? main_rssi : aux_rssi); -+ rssi_diff = (curr_rssi > fat_tab->pre_antdiv_rssi) ? (curr_rssi - fat_tab->pre_antdiv_rssi) : (fat_tab->pre_antdiv_rssi - curr_rssi); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[1] rssi_return, curr_rssi=((%d)), pre_rssi=((%d))\n", curr_rssi, fat_tab->pre_antdiv_rssi); -+ -+ fat_tab->pre_antdiv_rssi = curr_rssi; -+ if (rssi_diff < dm->stop_antdiv_rssi_th && curr_rssi != 0) -+ rssi_return = 1; -+ -+ /*@2. Skip training: TP Diff*/ -+ tp_diff = (dm->rx_tp > fat_tab->pre_antdiv_tp) ? (dm->rx_tp - fat_tab->pre_antdiv_tp) : (fat_tab->pre_antdiv_tp - dm->rx_tp); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[2] tp_diff_return, curr_tp=((%d)), pre_tp=((%d))\n", dm->rx_tp, fat_tab->pre_antdiv_tp); -+ fat_tab->pre_antdiv_tp = dm->rx_tp; -+ if ((tp_diff < (u32)(dm->stop_antdiv_tp_diff_th) && dm->rx_tp != 0)) -+ tp_diff_return = 1; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[3] tp_return, curr_rx_tp=((%d))\n", dm->rx_tp); -+ /*@3. Skip training: TP*/ -+ if (dm->rx_tp >= (u32)(dm->stop_antdiv_tp_th)) -+ tp_return = 1; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[4] Return {rssi, tp_diff, tp} = {%d, %d, %d}\n", rssi_return, tp_diff_return, tp_return); -+ /*@4. Joint Return Decision*/ -+ if (tp_return) { -+ if (tp_diff_return || rssi_diff) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "***Return EVM SW AntDiv\n"); -+ return; -+ } -+ } -+ } -+#endif -+ -+ fat_tab->evm_method_enable = 1; -+ if (fat_tab->div_path_type == ANT_PATH_A) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ else if (fat_tab->div_path_type == ANT_PATH_B) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_B); -+ else if (fat_tab->div_path_type == ANT_PATH_AB) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_AB); -+ dm->antdiv_period = dm->evm_antdiv_period; -+ odm_set_mac_reg(dm, R_0x608, BIT(8), 1); /*RCR accepts CRC32-Error packets*/ -+ fat_tab->fat_state_cnt++; -+ fat_tab->get_stats = false; -+ next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? MAIN_ANT : AUX_ANT; -+ odm_update_rx_idle_ant(dm, next_ant); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Antdiv Delay ]\n"); -+ odm_set_timer(dm, &dm->evm_fast_ant_training_timer, dm->antdiv_delay); //ms -+ } else if ((fat_tab->fat_state_cnt % 2) != 0) { -+ fat_tab->fat_state_cnt++; -+ fat_tab->get_stats = true; -+ odm_set_timer(dm, &dm->evm_fast_ant_training_timer, dm->antdiv_intvl); //ms -+ } else if ((fat_tab->fat_state_cnt % 2) == 0) { -+ fat_tab->fat_state_cnt++; -+ fat_tab->get_stats = false; -+ next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; -+ odm_update_rx_idle_ant(dm, next_ant); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Antdiv Delay ]\n"); -+ odm_set_timer(dm, &dm->evm_fast_ant_training_timer, dm->antdiv_delay); //ms -+ } -+ } -+ /*@Decision state: 4==============================================================*/ -+ else { -+ fat_tab->get_stats = false; -+ fat_tab->fat_state_cnt = 0; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Decisoin state ]\n"); -+ -+/* @3 [CRC32 statistic] */ -+#if 0 -+ if ((fat_tab->main_crc32_ok_cnt > (fat_tab->aux_crc32_ok_cnt << 1)) || (diff_rssi >= 40 && rssi_larger_ant == MAIN_ANT)) { -+ fat_tab->target_ant_crc32 = MAIN_ANT; -+ force_antenna = true; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "CRC32 Force Main\n"); -+ } else if ((fat_tab->aux_crc32_ok_cnt > ((fat_tab->main_crc32_ok_cnt) << 1)) || ((diff_rssi >= 40) && (rssi_larger_ant == AUX_ANT))) { -+ fat_tab->target_ant_crc32 = AUX_ANT; -+ force_antenna = true; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "CRC32 Force Aux\n"); -+ } else -+#endif -+ { -+ if (fat_tab->main_crc32_fail_cnt <= 5) -+ fat_tab->main_crc32_fail_cnt = 5; -+ -+ if (fat_tab->aux_crc32_fail_cnt <= 5) -+ fat_tab->aux_crc32_fail_cnt = 5; -+ -+ if (fat_tab->main_crc32_ok_cnt > fat_tab->main_crc32_fail_cnt) -+ main_above1 = true; -+ -+ if (fat_tab->aux_crc32_ok_cnt > fat_tab->aux_crc32_fail_cnt) -+ aux_above1 = true; -+ -+ if (main_above1 == true && aux_above1 == false) { -+ force_antenna = true; -+ fat_tab->target_ant_crc32 = MAIN_ANT; -+ } else if (main_above1 == false && aux_above1 == true) { -+ force_antenna = true; -+ fat_tab->target_ant_crc32 = AUX_ANT; -+ } else if (main_above1 == true && aux_above1 == true) { -+ main_crc_utility = ((fat_tab->main_crc32_ok_cnt) << 7) / fat_tab->main_crc32_fail_cnt; -+ aux_crc_utility = ((fat_tab->aux_crc32_ok_cnt) << 7) / fat_tab->aux_crc32_fail_cnt; -+ fat_tab->target_ant_crc32 = (main_crc_utility == aux_crc_utility) ? (fat_tab->pre_target_ant_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 (fat_tab->main_crc32_ok_cnt == 0) -+ fat_tab->main_crc32_ok_cnt = 1; -+ if (fat_tab->aux_crc32_ok_cnt == 0) -+ fat_tab->aux_crc32_ok_cnt = 1; -+ -+ main_crc_utility = ((fat_tab->main_crc32_fail_cnt) << 7) / fat_tab->main_crc32_ok_cnt; -+ aux_crc_utility = ((fat_tab->aux_crc32_fail_cnt) << 7) / fat_tab->aux_crc32_ok_cnt; -+ fat_tab->target_ant_crc32 = (main_crc_utility == aux_crc_utility) ? (fat_tab->pre_target_ant_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_set_mac_reg(dm, R_0x608, BIT(8), 0); /* NOT Accept CRC32 Error packets. */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "MAIN_CRC: Ok=((%d)), Fail = ((%d)), Utility = ((%d))\n", fat_tab->main_crc32_ok_cnt, fat_tab->main_crc32_fail_cnt, main_crc_utility); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "AUX__CRC: Ok=((%d)), Fail = ((%d)), Utility = ((%d))\n", fat_tab->aux_crc32_ok_cnt, fat_tab->aux_crc32_fail_cnt, aux_crc_utility); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "***1.TargetAnt_CRC32 = ((%s))\n", (fat_tab->target_ant_crc32 == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ -+ for (i = 0; i < HT_IDX; i++) { -+ main_cnt_all += fat_tab->main_ht_cnt[i]; -+ aux_cnt_all += fat_tab->aux_ht_cnt[i]; -+ -+ if (fat_tab->main_ht_cnt[i] > main_max_cnt) { -+ main_max_cnt = fat_tab->main_ht_cnt[i]; -+ main_max_idx = i; -+ } -+ -+ if (fat_tab->aux_ht_cnt[i] > aux_max_cnt) { -+ aux_max_cnt = fat_tab->aux_ht_cnt[i]; -+ aux_max_idx = i; -+ } -+ } -+ -+ for (i = 0; i < rate_num; i++) { -+ rate_ss_shift = (i << 3); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "*main_ht_cnt HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (rate_ss_shift), (rate_ss_shift + 7), -+ fat_tab->main_ht_cnt[rate_ss_shift + 0], fat_tab->main_ht_cnt[rate_ss_shift + 1], -+ fat_tab->main_ht_cnt[rate_ss_shift + 2], fat_tab->main_ht_cnt[rate_ss_shift + 3], -+ fat_tab->main_ht_cnt[rate_ss_shift + 4], fat_tab->main_ht_cnt[rate_ss_shift + 5], -+ fat_tab->main_ht_cnt[rate_ss_shift + 6], fat_tab->main_ht_cnt[rate_ss_shift + 7]); -+ } -+ -+ for (i = 0; i < rate_num; i++) { -+ rate_ss_shift = (i << 3); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "*aux_ht_cnt HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (rate_ss_shift), (rate_ss_shift + 7), -+ fat_tab->aux_ht_cnt[rate_ss_shift + 0], fat_tab->aux_ht_cnt[rate_ss_shift + 1], -+ fat_tab->aux_ht_cnt[rate_ss_shift + 2], fat_tab->aux_ht_cnt[rate_ss_shift + 3], -+ fat_tab->aux_ht_cnt[rate_ss_shift + 4], fat_tab->aux_ht_cnt[rate_ss_shift + 5], -+ fat_tab->aux_ht_cnt[rate_ss_shift + 6], fat_tab->aux_ht_cnt[rate_ss_shift + 7]); -+ } -+ -+ /* @3 [EVM statistic] */ -+ /*@1SS EVM*/ -+ main_1ss_evm = (fat_tab->main_evm_cnt[mac_id] != 0) ? (fat_tab->main_evm_sum[mac_id] / fat_tab->main_evm_cnt[mac_id]) : 0; -+ aux_1ss_evm = (fat_tab->aux_evm_cnt[mac_id] != 0) ? (fat_tab->aux_evm_sum[mac_id] / fat_tab->aux_evm_cnt[mac_id]) : 0; -+ target_ant_evm_1ss = (main_1ss_evm == aux_1ss_evm) ? (fat_tab->pre_target_ant_enhance) : ((main_1ss_evm >= aux_1ss_evm) ? MAIN_ANT : AUX_ANT); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Main1ss_EVM= (( %d ))\n", fat_tab->main_evm_cnt[mac_id], main_1ss_evm); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Aux_1ss_EVM = (( %d ))\n", fat_tab->aux_evm_cnt[mac_id], aux_1ss_evm); -+ -+ /*@2SS EVM*/ -+ main_2ss_evm[0] = (fat_tab->main_evm_2ss_cnt[mac_id] != 0) ? (fat_tab->main_evm_2ss_sum[mac_id][0] / fat_tab->main_evm_2ss_cnt[mac_id]) : 0; -+ main_2ss_evm[1] = (fat_tab->main_evm_2ss_cnt[mac_id] != 0) ? (fat_tab->main_evm_2ss_sum[mac_id][1] / fat_tab->main_evm_2ss_cnt[mac_id]) : 0; -+ main_2ss_evm_sum = main_2ss_evm[0] + main_2ss_evm[1]; -+ -+ aux_2ss_evm[0] = (fat_tab->aux_evm_2ss_cnt[mac_id] != 0) ? (fat_tab->aux_evm_2ss_sum[mac_id][0] / fat_tab->aux_evm_2ss_cnt[mac_id]) : 0; -+ aux_2ss_evm[1] = (fat_tab->aux_evm_2ss_cnt[mac_id] != 0) ? (fat_tab->aux_evm_2ss_sum[mac_id][1] / fat_tab->aux_evm_2ss_cnt[mac_id]) : 0; -+ aux_2ss_evm_sum = aux_2ss_evm[0] + aux_2ss_evm[1]; -+ -+ target_ant_evm_2ss = (main_2ss_evm_sum == aux_2ss_evm_sum) ? (fat_tab->pre_target_ant_enhance) : ((main_2ss_evm_sum >= aux_2ss_evm_sum) ? MAIN_ANT : AUX_ANT); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Main2ss_EVM{A,B,Sum} = {%d, %d, %d}\n", -+ fat_tab->main_evm_2ss_cnt[mac_id], main_2ss_evm[0], main_2ss_evm[1], main_2ss_evm_sum); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Aux_2ss_EVM{A,B,Sum} = {%d, %d, %d}\n", -+ fat_tab->aux_evm_2ss_cnt[mac_id], aux_2ss_evm[0], aux_2ss_evm[1], aux_2ss_evm_sum); -+ -+ if ((main_2ss_evm_sum + aux_2ss_evm_sum) != 0) { -+ decision_evm_ss = 2; -+ main_evm = main_2ss_evm_sum; -+ aux_evm = aux_2ss_evm_sum; -+ fat_tab->target_ant_evm = target_ant_evm_2ss; -+ } else { -+ decision_evm_ss = 1; -+ main_evm = main_1ss_evm; -+ aux_evm = aux_1ss_evm; -+ fat_tab->target_ant_evm = target_ant_evm_1ss; -+ } -+ -+ if ((main_evm == 0 || aux_evm == 0)) -+ diff_EVM = 100; -+ else if (main_evm >= aux_evm) -+ diff_EVM = main_evm - aux_evm; -+ else -+ diff_EVM = aux_evm - main_evm; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "***2.TargetAnt_EVM((%d-ss)) = ((%s))\n", decision_evm_ss, (fat_tab->target_ant_evm == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ -+ //3 [TP statistic] -+ main_tp_avg = (fat_tab->main_tp_cnt != 0) ? (fat_tab->main_tp / fat_tab->main_tp_cnt) : 0; -+ aux_tp_avg = (fat_tab->aux_tp_cnt != 0) ? (fat_tab->aux_tp / fat_tab->aux_tp_cnt) : 0; -+ tp_diff_avg = DIFF_2(main_tp_avg, aux_tp_avg); -+ fat_tab->target_ant_tp = (tp_diff_avg < 100) ? (fat_tab->pre_target_ant_enhance) : ((main_tp_avg >= aux_tp_avg) ? MAIN_ANT : AUX_ANT); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Main_TP = ((%d))\n", fat_tab->main_tp_cnt, main_tp_avg); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Aux_TP = ((%d))\n", fat_tab->aux_tp_cnt, aux_tp_avg); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "***3.TargetAnt_TP = ((%s))\n", (fat_tab->target_ant_tp == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ -+ /*Reset TP Method */ -+ fat_tab->main_tp = 0; -+ fat_tab->aux_tp = 0; -+ fat_tab->main_tp_cnt = 0; -+ fat_tab->aux_tp_cnt = 0; -+ -+ /* @2 [ Decision state ] */ -+ #if 1 -+ if (main_max_idx == aux_max_idx && ((main_cnt_all + aux_cnt_all) != 0)) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Decision EVM, main_max_idx = ((MCS%d)), aux_max_idx = ((MCS%d))\n", main_max_idx, aux_max_idx); -+ fat_tab->target_ant_enhance = fat_tab->target_ant_evm; -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Decision TP, main_max_idx = ((MCS%d)), aux_max_idx = ((MCS%d))\n", main_max_idx, aux_max_idx); -+ fat_tab->target_ant_enhance = fat_tab->target_ant_tp; -+ } -+ #else -+ if (fat_tab->target_ant_evm == fat_tab->target_ant_crc32) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Decision type 1, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM); -+ -+ if ((utility_ratio < 2 && force_antenna == false) && diff_EVM <= 30) -+ fat_tab->target_ant_enhance = fat_tab->pre_target_ant_enhance; -+ else -+ fat_tab->target_ant_enhance = fat_tab->target_ant_evm; -+ } -+ #if 0 -+ else if ((diff_EVM <= 50 && (utility_ratio > 4 && force_antenna == false)) || (force_antenna == true)) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Decision type 2, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM); -+ fat_tab->target_ant_enhance = fat_tab->target_ant_crc32; -+ } -+ #endif -+ else if (diff_EVM >= 20) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Decision type 3, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM); -+ fat_tab->target_ant_enhance = fat_tab->target_ant_evm; -+ } else if (utility_ratio >= 6 && force_antenna == false) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Decision type 4, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM); -+ fat_tab->target_ant_enhance = fat_tab->target_ant_crc32; -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Decision type 5, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM); -+ -+ if (force_antenna == true) -+ score_CRC = 2; -+ else if (utility_ratio >= 5) /*@>2.5*/ -+ score_CRC = 2; -+ else if (utility_ratio >= 4) /*@>2*/ -+ score_CRC = 1; -+ else -+ score_CRC = 0; -+ -+ if (diff_EVM >= 15) -+ score_EVM = 3; -+ else if (diff_EVM >= 10) -+ score_EVM = 2; -+ else if (diff_EVM >= 5) -+ score_EVM = 1; -+ else -+ score_EVM = 0; -+ -+ if (score_CRC > score_EVM) -+ fat_tab->target_ant_enhance = fat_tab->target_ant_crc32; -+ else if (score_CRC < score_EVM) -+ fat_tab->target_ant_enhance = fat_tab->target_ant_evm; -+ else -+ fat_tab->target_ant_enhance = fat_tab->pre_target_ant_enhance; -+ } -+ #endif -+ fat_tab->pre_target_ant_enhance = fat_tab->target_ant_enhance; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "*** 4.TargetAnt_enhance = (( %s ))******\n", (fat_tab->target_ant_enhance == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ } -+ } else { /* RSSI< = evm_rssi_th_low */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ TH_L ]\n"); -+ odm_evm_fast_ant_reset(dm); -+ } -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[escape from> TH_H || evm_method_enable==1]\n"); -+ odm_evm_fast_ant_reset(dm); -+ } -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[multi-Client]\n"); -+ odm_evm_fast_ant_reset(dm); -+ } -+ } -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_evm_antdiv_callback( -+ struct phydm_timer_list *timer) -+{ -+ void *adapter = (void *)timer->Adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ #if USE_WORKITEM -+ odm_schedule_work_item(&dm->phydm_evm_antdiv_workitem); -+ #else -+ { -+ odm_hw_ant_div(dm); -+ } -+ #endif -+ #else -+ odm_schedule_work_item(&dm->phydm_evm_antdiv_workitem); -+ #endif -+} -+ -+void phydm_evm_antdiv_workitem_callback( -+ void *context) -+{ -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+ odm_hw_ant_div(dm); -+} -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+void phydm_evm_antdiv_callback(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *padapter = dm->adapter; -+ -+ if (*dm->is_net_closed) -+ return; -+ if (dm->support_interface == ODM_ITRF_PCIE) { -+ odm_hw_ant_div(dm); -+ } else { -+ /* @Can't do I/O in timer callback*/ -+ phydm_run_in_thread_cmd(dm, -+ phydm_evm_antdiv_workitem_callback, -+ padapter); -+ } -+} -+ -+void phydm_evm_antdiv_workitem_callback(void *context) -+{ -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->odmpriv; -+ -+ odm_hw_ant_div(dm); -+} -+ -+#else -+void phydm_evm_antdiv_callback( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "******AntDiv_Callback******\n"); -+ odm_hw_ant_div(dm); -+} -+#endif -+ -+#endif -+ -+void odm_hw_ant_div(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 i, min_max_rssi = 0xFF, ant_div_max_rssi = 0, max_rssi = 0; -+ u32 main_rssi, aux_rssi, mian_cnt, aux_cnt, local_max_rssi; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u8 rx_idle_ant = fat_tab->rx_idle_ant, target_ant = 7; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct cmn_sta_info *sta; -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; -+ u32 TH1 = 500000; -+ u32 TH2 = 10000000; -+ u32 ma_rx_temp, degrade_TP_temp, improve_TP_temp; -+ u8 monitor_rssi_threshold = 30; -+ -+ dm_bdc_table->BF_pass = true; -+ dm_bdc_table->DIV_pass = true; -+ dm_bdc_table->is_all_div_sta_idle = true; -+ dm_bdc_table->is_all_bf_sta_idle = true; -+ dm_bdc_table->num_bf_tar = 0; -+ dm_bdc_table->num_div_tar = 0; -+ dm_bdc_table->num_client = 0; -+#endif -+#endif -+ -+ if (!dm->is_linked) { /* @is_linked==False */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[No Link!!!]\n"); -+ -+ if (fat_tab->is_become_linked) { -+ if (fat_tab->div_path_type == ANT_PATH_A) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ else if (fat_tab->div_path_type == ANT_PATH_B) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_B); -+ else if (fat_tab->div_path_type == ANT_PATH_AB) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_AB); -+ odm_update_rx_idle_ant(dm, MAIN_ANT); -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ dm->antdiv_period = 0; -+ -+ fat_tab->is_become_linked = dm->is_linked; -+ } -+ return; -+ } else { -+ if (!fat_tab->is_become_linked) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Linked !!!]\n"); -+ if (fat_tab->div_path_type == ANT_PATH_A) -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); -+ else if (fat_tab->div_path_type == ANT_PATH_B) -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_B); -+ else if (fat_tab->div_path_type == ANT_PATH_AB) -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_AB); -+ #if 0 -+ /*odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC);*/ -+ -+ /* @if(dm->support_ic_type == ODM_RTL8821 ) */ -+ /* odm_set_bb_reg(dm, R_0x800, BIT(25), 0); */ -+ /* CCK AntDiv function disable */ -+ -+ /* @#if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ -+ /* @else if(dm->support_ic_type == ODM_RTL8881A) */ -+ /* odm_set_bb_reg(dm, R_0x800, BIT(25), 0); */ -+ /* CCK AntDiv function disable */ -+ /* @#endif */ -+ -+ /* @else if(dm->support_ic_type == ODM_RTL8723B ||*/ -+ /* @dm->support_ic_type == ODM_RTL8812) */ -+ /* odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); */ -+ /* CCK AntDiv function disable */ -+ #endif -+ -+ fat_tab->is_become_linked = dm->is_linked; -+ -+ if (dm->support_ic_type == ODM_RTL8723B && -+ dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ odm_set_bb_reg(dm, R_0x930, 0xF0, 8); -+ /* @DPDT_P = ANTSEL[0] for 8723B AntDiv */ -+ odm_set_bb_reg(dm, R_0x930, 0xF, 8); -+ /* @DPDT_N = ANTSEL[0] */ -+ } -+ -+ /* @ BDC Init */ -+ #ifdef PHYDM_BEAMFORMING_SUPPORT -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ odm_bdc_init(dm); -+ #endif -+ #endif -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ odm_evm_fast_ant_reset(dm); -+ #endif -+ } -+ } -+ -+ if (!(*fat_tab->p_force_tx_by_desc)) { -+ if (dm->is_one_entry_only) -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ else -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); -+ } -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ if (dm->antdiv_evm_en == 1) { -+ odm_evm_enhance_ant_div(dm); -+ if (fat_tab->fat_state_cnt != 0) -+ return; -+ } else -+ odm_evm_fast_ant_reset(dm); -+#endif -+ -+/* @2 BDC mode Arbitration */ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (dm->antdiv_evm_en == 0 || fat_tab->evm_method_enable == 0) -+ odm_bf_ant_div_mode_arbitration(dm); -+#endif -+#endif -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ sta = dm->phydm_sta_info[i]; -+ if (!is_sta_active(sta)) { -+ phydm_antdiv_reset_statistic(dm, i); -+ continue; -+ } -+ -+ /* @2 Caculate RSSI per Antenna */ -+ if (fat_tab->main_cnt[i] != 0 || fat_tab->aux_cnt[i] != 0) { -+ mian_cnt = fat_tab->main_cnt[i]; -+ aux_cnt = fat_tab->aux_cnt[i]; -+ main_rssi = (mian_cnt != 0) ? -+ (fat_tab->main_sum[i] / mian_cnt) : 0; -+ aux_rssi = (aux_cnt != 0) ? -+ (fat_tab->aux_sum[i] / aux_cnt) : 0; -+ target_ant = (mian_cnt == aux_cnt) ? -+ fat_tab->rx_idle_ant : -+ ((mian_cnt >= aux_cnt) ? -+ fat_tab->ant_idx_vec[0]:fat_tab->ant_idx_vec[1]); -+ /*Use counter number for OFDM*/ -+ -+ } else { /*@CCK only case*/ -+ mian_cnt = fat_tab->main_cnt_cck[i]; -+ aux_cnt = fat_tab->aux_cnt_cck[i]; -+ main_rssi = (mian_cnt != 0) ? -+ (fat_tab->main_sum_cck[i] / mian_cnt) : 0; -+ aux_rssi = (aux_cnt != 0) ? -+ (fat_tab->aux_sum_cck[i] / aux_cnt) : 0; -+ target_ant = (main_rssi == aux_rssi) ? -+ fat_tab->rx_idle_ant : -+ ((main_rssi >= aux_rssi) ? -+ fat_tab->ant_idx_vec[0]:fat_tab->ant_idx_vec[1]); -+ /*Use RSSI for CCK only case*/ -+ } -+#if (RTL8721D_SUPPORT) -+ if(dm->antdiv_gpio == ANTDIV_GPIO_PB1PB2PB26) { /* added by Jiao Qi on May.25,2020, only for 3 antenna diversity */ -+ u8 tmp; -+ if(target_ant == fat_tab->ant_idx_vec[0]){/* switch the second & third ant index */ -+ tmp = fat_tab->ant_idx_vec[1]; -+ fat_tab->ant_idx_vec[1] = fat_tab->ant_idx_vec[2]; -+ fat_tab->ant_idx_vec[2] = tmp; -+ }else{ -+ /* switch the first & second ant index */ -+ tmp = fat_tab->ant_idx_vec[0]; -+ fat_tab->ant_idx_vec[0] = fat_tab->ant_idx_vec[1]; -+ fat_tab->ant_idx_vec[1] = tmp; -+ /* switch the second & third ant index */ -+ tmp = fat_tab->ant_idx_vec[1]; -+ fat_tab->ant_idx_vec[1] = fat_tab->ant_idx_vec[2]; -+ fat_tab->ant_idx_vec[2] = tmp; -+ } -+ } -+#endif -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*** Client[ %d ] : Main_Cnt = (( %d )) , CCK_Main_Cnt = (( %d )) , main_rssi= (( %d ))\n", -+ i, fat_tab->main_cnt[i], -+ fat_tab->main_cnt_cck[i], main_rssi); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*** Client[ %d ] : Aux_Cnt = (( %d )) , CCK_Aux_Cnt = (( %d )) , aux_rssi = (( %d ))\n", -+ i, fat_tab->aux_cnt[i], -+ fat_tab->aux_cnt_cck[i], aux_rssi); -+ -+ local_max_rssi = (main_rssi > aux_rssi) ? main_rssi : aux_rssi; -+ /* @ Select max_rssi for DIG */ -+ if (local_max_rssi > ant_div_max_rssi && local_max_rssi < 40) -+ ant_div_max_rssi = local_max_rssi; -+ if (local_max_rssi > max_rssi) -+ max_rssi = local_max_rssi; -+ -+ /* @ Select RX Idle Antenna */ -+ if (local_max_rssi != 0 && local_max_rssi < min_max_rssi) { -+ rx_idle_ant = target_ant; -+ min_max_rssi = local_max_rssi; -+ } -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ if (dm->antdiv_evm_en == 1) { -+ if (fat_tab->target_ant_enhance != 0xFF) { -+ target_ant = fat_tab->target_ant_enhance; -+ rx_idle_ant = fat_tab->target_ant_enhance; -+ } -+ } -+#endif -+ -+ /* @2 Select TX Antenna */ -+ if (dm->ant_div_type != CGCS_RX_HW_ANTDIV) { -+ #ifdef PHYDM_BEAMFORMING_SUPPORT -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (dm_bdc_table->w_bfee_client[i] == 0) -+ #endif -+ #endif -+ { -+ odm_update_tx_ant(dm, target_ant, i); -+ } -+ } -+ -+/* @------------------------------------------------------------ */ -+ -+ #ifdef PHYDM_BEAMFORMING_SUPPORT -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ dm_bdc_table->num_client++; -+ -+ if (dm_bdc_table->bdc_mode == BDC_MODE_2 || dm_bdc_table->bdc_mode == BDC_MODE_3) { -+ /* @2 Byte counter */ -+ -+ ma_rx_temp = sta->rx_moving_average_tp; /* RX TP ( bit /sec) */ -+ -+ if (dm_bdc_table->BDC_state == bdc_bfer_train_state) -+ dm_bdc_table->MA_rx_TP_DIV[i] = ma_rx_temp; -+ else -+ dm_bdc_table->MA_rx_TP[i] = ma_rx_temp; -+ -+ if (ma_rx_temp < TH2 && ma_rx_temp > TH1 && local_max_rssi <= monitor_rssi_threshold) { -+ if (dm_bdc_table->w_bfer_client[i] == 1) { /* @Bfer_Target */ -+ dm_bdc_table->num_bf_tar++; -+ -+ if (dm_bdc_table->BDC_state == BDC_DECISION_STATE && dm_bdc_table->bdc_try_flag == 0) { -+ improve_TP_temp = (dm_bdc_table->MA_rx_TP_DIV[i] * 9) >> 3; /* @* 1.125 */ -+ dm_bdc_table->BF_pass = (dm_bdc_table->MA_rx_TP[i] > improve_TP_temp) ? true : false; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "*** Client[ %d ] : { MA_rx_TP,improve_TP_temp, MA_rx_TP_DIV, BF_pass}={ %d, %d, %d , %d }\n", i, dm_bdc_table->MA_rx_TP[i], improve_TP_temp, dm_bdc_table->MA_rx_TP_DIV[i], dm_bdc_table->BF_pass); -+ } -+ } else { /* @DIV_Target */ -+ dm_bdc_table->num_div_tar++; -+ -+ if (dm_bdc_table->BDC_state == BDC_DECISION_STATE && dm_bdc_table->bdc_try_flag == 0) { -+ degrade_TP_temp = (dm_bdc_table->MA_rx_TP_DIV[i] * 5) >> 3; /* @* 0.625 */ -+ dm_bdc_table->DIV_pass = (dm_bdc_table->MA_rx_TP[i] > degrade_TP_temp) ? true : false; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "*** Client[ %d ] : { MA_rx_TP, degrade_TP_temp, MA_rx_TP_DIV, DIV_pass}=\n{ %d, %d, %d , %d }\n", i, dm_bdc_table->MA_rx_TP[i], degrade_TP_temp, dm_bdc_table->MA_rx_TP_DIV[i], dm_bdc_table->DIV_pass); -+ } -+ } -+ } -+ -+ if (ma_rx_temp > TH1) { -+ if (dm_bdc_table->w_bfer_client[i] == 1) /* @Bfer_Target */ -+ dm_bdc_table->is_all_bf_sta_idle = false; -+ else /* @DIV_Target */ -+ dm_bdc_table->is_all_div_sta_idle = false; -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*** Client[ %d ] : { BFmeeCap, BFmerCap} = { %d , %d }\n", -+ i, dm_bdc_table->w_bfee_client[i], -+ dm_bdc_table->w_bfer_client[i]); -+ -+ if (dm_bdc_table->BDC_state == bdc_bfer_train_state) -+ PHYDM_DBG(dm, DBG_ANT_DIV, "*** Client[ %d ] : MA_rx_TP_DIV = (( %d ))\n", i, dm_bdc_table->MA_rx_TP_DIV[i]); -+ -+ else -+ PHYDM_DBG(dm, DBG_ANT_DIV, "*** Client[ %d ] : MA_rx_TP = (( %d ))\n", i, dm_bdc_table->MA_rx_TP[i]); -+ } -+ #endif -+ #endif -+ -+ #ifdef PHYDM_BEAMFORMING_SUPPORT -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (dm_bdc_table->bdc_try_flag == 0) -+ #endif -+ #endif -+ { -+ phydm_antdiv_reset_statistic(dm, i); -+ } -+ } -+ -+/* @2 Set RX Idle Antenna & TX Antenna(Because of HW Bug ) */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ PHYDM_DBG(dm, DBG_ANT_DIV, "*** rx_idle_ant = (( %s ))\n", -+ (rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (dm_bdc_table->bdc_mode == BDC_MODE_1 || dm_bdc_table->bdc_mode == BDC_MODE_3) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*** bdc_rx_idle_update_counter = (( %d ))\n", -+ dm_bdc_table->bdc_rx_idle_update_counter); -+ -+ if (dm_bdc_table->bdc_rx_idle_update_counter == 1) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***Update RxIdle Antenna!!!\n"); -+ dm_bdc_table->bdc_rx_idle_update_counter = 30; -+ odm_update_rx_idle_ant(dm, rx_idle_ant); -+ } else { -+ dm_bdc_table->bdc_rx_idle_update_counter--; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***NOT update RxIdle Antenna because of BF ( need to fix TX-ant)\n"); -+ } -+ } else -+#endif -+#endif -+ odm_update_rx_idle_ant(dm, rx_idle_ant); -+#else -+#if (RTL8721D_SUPPORT) -+if (dm->antdiv_gpio == ANTDIV_GPIO_PB1PB2PB26) { -+ if(odm_get_bb_reg(dm,R_0xc50,0x80) || odm_get_bb_reg(dm, R_0xa00, 0x8000)) -+ odm_update_rx_idle_ant_sp3t(dm, rx_idle_ant); -+} -+else -+#endif -+ odm_update_rx_idle_ant(dm, rx_idle_ant); -+ -+#endif /* @#if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ -+ -+/* @2 BDC Main Algorithm */ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (dm->antdiv_evm_en == 0 || fat_tab->evm_method_enable == 0) -+ odm_bd_ccoex_bfee_rx_div_arbitration(dm); -+ -+ dm_bdc_table->num_txbfee_client = 0; -+ dm_bdc_table->num_txbfer_client = 0; -+#endif -+#endif -+ -+ if (ant_div_max_rssi == 0) -+ dig_t->ant_div_rssi_max = dm->rssi_min; -+ else -+ dig_t->ant_div_rssi_max = ant_div_max_rssi; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "***AntDiv End***\n\n"); -+} -+ -+#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ -+void odm_s0s1_sw_ant_div_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ fat_tab->is_become_linked = false; -+ swat_tab->try_flag = SWAW_STEP_INIT; -+ swat_tab->double_chk_flag = 0; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s: fat_tab->is_become_linked = %d\n", -+ __func__, fat_tab->is_become_linked); -+} -+ -+void phydm_sw_antdiv_train_time(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ u8 high_traffic_train_time_u = 0x32, high_traffic_train_time_l = 0; -+ u8 low_traffic_train_time_u = 200, low_traffic_train_time_l = 0; -+ u8 train_time_temp; -+ -+ if (dm->traffic_load == TRAFFIC_HIGH) { -+ train_time_temp = swat_tab->train_time; -+ -+ if (swat_tab->train_time_flag == 3) { -+ high_traffic_train_time_l = 0xa; -+ -+ if (train_time_temp <= 16) -+ train_time_temp = high_traffic_train_time_l; -+ else -+ train_time_temp -= 16; -+ -+ } else if (swat_tab->train_time_flag == 2) { -+ train_time_temp -= 8; -+ high_traffic_train_time_l = 0xf; -+ } else if (swat_tab->train_time_flag == 1) { -+ train_time_temp -= 4; -+ high_traffic_train_time_l = 0x1e; -+ } else if (swat_tab->train_time_flag == 0) { -+ train_time_temp += 8; -+ high_traffic_train_time_l = 0x28; -+ } -+ -+ if (dm->support_ic_type == ODM_RTL8188F) { -+ if (dm->support_interface == ODM_ITRF_SDIO) -+ high_traffic_train_time_l += 0xa; -+ } -+ -+ /* @-- */ -+ if (train_time_temp > high_traffic_train_time_u) -+ train_time_temp = high_traffic_train_time_u; -+ -+ else if (train_time_temp < high_traffic_train_time_l) -+ train_time_temp = high_traffic_train_time_l; -+ -+ swat_tab->train_time = train_time_temp; /*@10ms~200ms*/ -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "train_time_flag=((%d)), train_time=((%d))\n", -+ swat_tab->train_time_flag, -+ swat_tab->train_time); -+ -+ } else if ((dm->traffic_load == TRAFFIC_MID) || -+ (dm->traffic_load == TRAFFIC_LOW)) { -+ train_time_temp = swat_tab->train_time; -+ -+ if (swat_tab->train_time_flag == 3) { -+ low_traffic_train_time_l = 10; -+ if (train_time_temp < 50) -+ train_time_temp = low_traffic_train_time_l; -+ else -+ train_time_temp -= 50; -+ } else if (swat_tab->train_time_flag == 2) { -+ train_time_temp -= 30; -+ low_traffic_train_time_l = 36; -+ } else if (swat_tab->train_time_flag == 1) { -+ train_time_temp -= 10; -+ low_traffic_train_time_l = 40; -+ } else { -+ train_time_temp += 10; -+ low_traffic_train_time_l = 50; -+ } -+ -+ if (dm->support_ic_type == ODM_RTL8188F) { -+ if (dm->support_interface == ODM_ITRF_SDIO) -+ low_traffic_train_time_l += 10; -+ } -+ -+ /* @-- */ -+ if (train_time_temp >= low_traffic_train_time_u) -+ train_time_temp = low_traffic_train_time_u; -+ -+ else if (train_time_temp <= low_traffic_train_time_l) -+ train_time_temp = low_traffic_train_time_l; -+ -+ swat_tab->train_time = train_time_temp; /*@10ms~200ms*/ -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "train_time_flag=((%d)) , train_time=((%d))\n", -+ swat_tab->train_time_flag, swat_tab->train_time); -+ -+ } else { -+ swat_tab->train_time = 0xc8; /*@200ms*/ -+ } -+} -+ -+void phydm_sw_antdiv_decision(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u32 i, min_max_rssi = 0xFF, local_max_rssi, local_min_rssi; -+ u32 main_rssi, aux_rssi; -+ u8 rx_idle_ant = swat_tab->pre_ant; -+ u8 target_ant = swat_tab->pre_ant, next_ant = 0; -+ struct cmn_sta_info *entry = NULL; -+ u32 main_cnt = 0, aux_cnt = 0, main_sum = 0, aux_sum = 0; -+ u32 main_ctrl_cnt = 0, aux_ctrl_cnt = 0; -+ boolean is_by_ctrl_frame = false; -+ boolean cond_23d_main, cond_23d_aux; -+ u64 pkt_cnt_total = 0; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ entry = dm->phydm_sta_info[i]; -+ if (!is_sta_active(entry)) { -+ phydm_antdiv_reset_statistic(dm, i); -+ continue; -+ } -+ -+ /* @2 Caculate RSSI per Antenna */ -+ if (fat_tab->main_cnt[i] != 0 || fat_tab->aux_cnt[i] != 0) { -+ main_cnt = (u32)fat_tab->main_cnt[i]; -+ aux_cnt = (u32)fat_tab->aux_cnt[i]; -+ main_rssi = (main_cnt != 0) ? -+ (fat_tab->main_sum[i] / main_cnt) : 0; -+ aux_rssi = (aux_cnt != 0) ? -+ (fat_tab->aux_sum[i] / aux_cnt) : 0; -+ if (dm->support_ic_type == ODM_RTL8723D || dm->support_ic_type == ODM_RTL8710C) { -+ cond_23d_main = (aux_cnt > main_cnt) && -+ ((main_rssi - aux_rssi < 5) || -+ (aux_rssi > main_rssi)); -+ cond_23d_aux = (main_cnt > aux_cnt) && -+ ((aux_rssi - main_rssi < 5) || -+ (main_rssi > aux_rssi)); -+ if (swat_tab->pre_ant == MAIN_ANT) { -+ if (main_cnt == 0) -+ target_ant = (aux_cnt != 0) ? -+ AUX_ANT : -+ swat_tab->pre_ant; -+ else -+ target_ant = cond_23d_main ? -+ AUX_ANT : -+ swat_tab->pre_ant; -+ } else { -+ if (aux_cnt == 0) -+ target_ant = (main_cnt != 0) ? -+ MAIN_ANT : -+ swat_tab->pre_ant; -+ else -+ target_ant = cond_23d_aux ? -+ MAIN_ANT : -+ swat_tab->pre_ant; -+ } -+ } else { -+ if (swat_tab->pre_ant == MAIN_ANT) { -+ target_ant = (aux_rssi > main_rssi) ? -+ AUX_ANT : -+ swat_tab->pre_ant; -+ } else if (swat_tab->pre_ant == AUX_ANT) { -+ target_ant = (main_rssi > aux_rssi) ? -+ MAIN_ANT : -+ swat_tab->pre_ant; -+ } -+ } -+ } else { /*@CCK only case*/ -+ main_cnt = fat_tab->main_cnt_cck[i]; -+ aux_cnt = fat_tab->aux_cnt_cck[i]; -+ main_rssi = (main_cnt != 0) ? -+ (fat_tab->main_sum_cck[i] / main_cnt) : 0; -+ aux_rssi = (aux_cnt != 0) ? -+ (fat_tab->aux_sum_cck[i] / aux_cnt) : 0; -+ target_ant = (main_rssi == aux_rssi) ? -+ swat_tab->pre_ant : -+ ((main_rssi >= aux_rssi) ? -+ MAIN_ANT : AUX_ANT); -+ /*Use RSSI for CCK only case*/ -+ } -+ local_max_rssi = (main_rssi >= aux_rssi) ? main_rssi : aux_rssi; -+ local_min_rssi = (main_rssi >= aux_rssi) ? aux_rssi : main_rssi; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*** CCK_counter_main = (( %d )) , CCK_counter_aux= (( %d ))\n", -+ fat_tab->main_cnt_cck[i], fat_tab->aux_cnt_cck[i]); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*** OFDM_counter_main = (( %d )) , OFDM_counter_aux= (( %d ))\n", -+ fat_tab->main_cnt[i], fat_tab->aux_cnt[i]); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*** main_Cnt = (( %d )) , aux_Cnt = (( %d ))\n", -+ main_cnt, aux_cnt); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*** main_rssi= (( %d )) , aux_rssi = (( %d ))\n", -+ main_rssi, aux_rssi); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*** MAC ID:[ %d ] , target_ant = (( %s ))\n", i, -+ (target_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -+ -+ /* @2 Select RX Idle Antenna */ -+ -+ if (local_max_rssi != 0 && local_max_rssi < min_max_rssi) { -+ rx_idle_ant = target_ant; -+ min_max_rssi = local_max_rssi; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "*** local_max_rssi-local_min_rssi = ((%d))\n", -+ (local_max_rssi - local_min_rssi)); -+ -+ if ((local_max_rssi - local_min_rssi) > 8) { -+ if (local_min_rssi != 0) { -+ swat_tab->train_time_flag = 3; -+ } else { -+ if (min_max_rssi > RSSI_CHECK_THRESHOLD) -+ swat_tab->train_time_flag = 0; -+ else -+ swat_tab->train_time_flag = 3; -+ } -+ } else if ((local_max_rssi - local_min_rssi) > 5) { -+ swat_tab->train_time_flag = 2; -+ } else if ((local_max_rssi - local_min_rssi) > 2) { -+ swat_tab->train_time_flag = 1; -+ } else { -+ swat_tab->train_time_flag = 0; -+ } -+ } -+ -+ /* @2 Select TX Antenna */ -+ if (target_ant == MAIN_ANT) -+ fat_tab->antsel_a[i] = ANT1_2G; -+ else -+ fat_tab->antsel_a[i] = ANT2_2G; -+ -+ phydm_antdiv_reset_statistic(dm, i); -+ pkt_cnt_total += (main_cnt + aux_cnt); -+ } -+ -+ if (swat_tab->is_sw_ant_div_by_ctrl_frame) { -+ odm_s0s1_sw_ant_div_by_ctrl_frame(dm, SWAW_STEP_DETERMINE); -+ is_by_ctrl_frame = true; -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Control frame packet counter = %d, data frame packet counter = %llu\n", -+ swat_tab->pkt_cnt_sw_ant_div_by_ctrl_frame, pkt_cnt_total); -+ -+ if (min_max_rssi == 0xff || ((pkt_cnt_total < -+ (swat_tab->pkt_cnt_sw_ant_div_by_ctrl_frame >> 1)) && -+ dm->phy_dbg_info.num_qry_beacon_pkt < 2)) { -+ min_max_rssi = 0; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Check RSSI of control frame because min_max_rssi == 0xff\n"); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "is_by_ctrl_frame = %d\n", -+ is_by_ctrl_frame); -+ -+ if (is_by_ctrl_frame) { -+ main_ctrl_cnt = fat_tab->main_ctrl_cnt; -+ aux_ctrl_cnt = fat_tab->aux_ctrl_cnt; -+ main_rssi = (main_ctrl_cnt != 0) ? -+ (fat_tab->main_ctrl_sum / main_ctrl_cnt) : -+ 0; -+ aux_rssi = (aux_ctrl_cnt != 0) ? -+ (fat_tab->aux_ctrl_sum / aux_ctrl_cnt) : 0; -+ -+ if (main_ctrl_cnt <= 1 && -+ fat_tab->cck_ctrl_frame_cnt_main >= 1) -+ main_rssi = 0; -+ -+ if (aux_ctrl_cnt <= 1 && -+ fat_tab->cck_ctrl_frame_cnt_aux >= 1) -+ aux_rssi = 0; -+ -+ if (main_rssi != 0 || aux_rssi != 0) { -+ rx_idle_ant = (main_rssi == aux_rssi) ? -+ swat_tab->pre_ant : -+ ((main_rssi >= aux_rssi) ? -+ MAIN_ANT : AUX_ANT); -+ local_max_rssi = (main_rssi >= aux_rssi) ? -+ main_rssi : aux_rssi; -+ local_min_rssi = (main_rssi >= aux_rssi) ? -+ aux_rssi : main_rssi; -+ -+ if ((local_max_rssi - local_min_rssi) > 8) -+ swat_tab->train_time_flag = 3; -+ else if ((local_max_rssi - local_min_rssi) > 5) -+ swat_tab->train_time_flag = 2; -+ else if ((local_max_rssi - local_min_rssi) > 2) -+ swat_tab->train_time_flag = 1; -+ else -+ swat_tab->train_time_flag = 0; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Control frame: main_rssi = %d, aux_rssi = %d\n", -+ main_rssi, aux_rssi); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "rx_idle_ant decided by control frame = %s\n", -+ (rx_idle_ant == MAIN_ANT ? -+ "MAIN" : "AUX")); -+ } -+ } -+ } -+ -+ fat_tab->min_max_rssi = min_max_rssi; -+ swat_tab->try_flag = SWAW_STEP_PEEK; -+ -+ if (swat_tab->double_chk_flag == 1) { -+ swat_tab->double_chk_flag = 0; -+ -+ if (fat_tab->min_max_rssi > RSSI_CHECK_THRESHOLD) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ " [Double check] min_max_rssi ((%d)) > %d again!!\n", -+ fat_tab->min_max_rssi, RSSI_CHECK_THRESHOLD); -+ -+ odm_update_rx_idle_ant(dm, rx_idle_ant); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[reset try_flag = 0] Training accomplished !!!]\n\n\n"); -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ " [Double check] min_max_rssi ((%d)) <= %d !!\n", -+ fat_tab->min_max_rssi, RSSI_CHECK_THRESHOLD); -+ -+ next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? -+ AUX_ANT : MAIN_ANT; -+ swat_tab->try_flag = SWAW_STEP_PEEK; -+ swat_tab->reset_idx = RSSI_CHECK_RESET_PERIOD; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[set try_flag=0] Normal state: Need to tryg again!!\n\n\n"); -+ } -+ } else { -+ if (fat_tab->min_max_rssi < RSSI_CHECK_THRESHOLD) -+ swat_tab->reset_idx = RSSI_CHECK_RESET_PERIOD; -+ -+ swat_tab->pre_ant = rx_idle_ant; -+ odm_update_rx_idle_ant(dm, rx_idle_ant); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[reset try_flag = 0] Training accomplished !!!]\n\n\n"); -+ } -+} -+ -+void odm_s0s1_sw_ant_div(void *dm_void, u8 step) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u32 value32; -+ u8 next_ant = 0; -+ -+ if (!dm->is_linked) { /* @is_linked==False */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[No Link!!!]\n"); -+ if (fat_tab->is_become_linked == true) { -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ if (dm->support_ic_type == ODM_RTL8723B) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Set REG 948[9:6]=0x0\n"); -+ odm_set_bb_reg(dm, R_0x948, 0x3c0, 0x0); -+ } -+ fat_tab->is_become_linked = dm->is_linked; -+ } -+ return; -+ } else { -+ if (fat_tab->is_become_linked == false) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Linked !!!]\n"); -+ -+ if (dm->support_ic_type == ODM_RTL8723B) { -+ value32 = odm_get_bb_reg(dm, R_0x864, 0x38); -+ -+#if (RTL8723B_SUPPORT == 1) -+ if (value32 == 0x0) -+ odm_update_rx_idle_ant_8723b(dm, -+ MAIN_ANT, -+ ANT1_2G, -+ ANT2_2G); -+ else if (value32 == 0x1) -+ odm_update_rx_idle_ant_8723b(dm, -+ AUX_ANT, -+ ANT2_2G, -+ ANT1_2G); -+#endif -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "8723B: First link! Force antenna to %s\n", -+ (value32 == 0x0 ? "MAIN" : "AUX")); -+ } -+ -+ if (dm->support_ic_type == ODM_RTL8723D) { -+ value32 = odm_get_bb_reg(dm, R_0x864, 0x38); -+#if (RTL8723D_SUPPORT == 1) -+ if (value32 == 0x0) -+ odm_update_rx_idle_ant_8723d(dm, -+ MAIN_ANT, -+ ANT1_2G, -+ ANT2_2G); -+ else if (value32 == 0x1) -+ odm_update_rx_idle_ant_8723d(dm, -+ AUX_ANT, -+ ANT2_2G, -+ ANT1_2G); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "8723D: First link! Force antenna to %s\n", -+ (value32 == 0x0 ? "MAIN" : "AUX")); -+#endif -+ } -+ if (dm->support_ic_type == ODM_RTL8710C) { -+#if (RTL8710C_SUPPORT == 1) -+ value32 = (HAL_READ32(SYSTEM_CTRL_BASE, R_0x121c) & 0x800000); -+ if (value32 == 0x0) -+ odm_update_rx_idle_ant_8710c(dm, -+ MAIN_ANT, -+ ANT1_2G, -+ ANT2_2G); -+ else if (value32 == 0x1) -+ odm_update_rx_idle_ant_8710c(dm, -+ AUX_ANT, -+ ANT2_2G, -+ ANT1_2G); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "8710C: First link! Force antenna to %s\n", -+ (value32 == 0x0 ? "MAIN" : "AUX")); -+#endif -+ } -+ fat_tab->is_become_linked = dm->is_linked; -+ } -+ } -+ -+ if (!(*fat_tab->p_force_tx_by_desc)) { -+ if (dm->is_one_entry_only == true) -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ else -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[%d] { try_flag=(( %d )), step=(( %d )), double_chk_flag = (( %d )) }\n", -+ __LINE__, swat_tab->try_flag, step, -+ swat_tab->double_chk_flag); -+ -+ /* @ Handling step mismatch condition. */ -+ /* @ Peak step is not finished at last time. */ -+ /* @ Recover the variable and check again. */ -+ if (step != swat_tab->try_flag) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[step != try_flag] Need to Reset After Link\n"); -+ odm_sw_ant_div_rest_after_link(dm); -+ } -+ -+ if (swat_tab->try_flag == SWAW_STEP_INIT) { -+ swat_tab->try_flag = SWAW_STEP_PEEK; -+ swat_tab->train_time_flag = 0; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[set try_flag = 0] Prepare for peek!\n\n"); -+ return; -+ -+ } else { -+ /* @1 Normal state (Begin Trying) */ -+ if (swat_tab->try_flag == SWAW_STEP_PEEK) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "TxOkCnt=(( %llu )), RxOkCnt=(( %llu )), traffic_load = (%d))\n", -+ dm->cur_tx_ok_cnt, dm->cur_rx_ok_cnt, -+ dm->traffic_load); -+ phydm_sw_antdiv_train_time(dm); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Current min_max_rssi is ((%d))\n", -+ fat_tab->min_max_rssi); -+ -+ /* @---reset index--- */ -+ if (swat_tab->reset_idx >= RSSI_CHECK_RESET_PERIOD) { -+ fat_tab->min_max_rssi = 0; -+ swat_tab->reset_idx = 0; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, "reset_idx = (( %d ))\n", -+ swat_tab->reset_idx); -+ -+ swat_tab->reset_idx++; -+ -+ /* @---double check flag--- */ -+ if (fat_tab->min_max_rssi > RSSI_CHECK_THRESHOLD && -+ swat_tab->double_chk_flag == 0) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ " min_max_rssi is ((%d)), and > %d\n", -+ fat_tab->min_max_rssi, -+ RSSI_CHECK_THRESHOLD); -+ -+ swat_tab->double_chk_flag = 1; -+ swat_tab->try_flag = SWAW_STEP_DETERMINE; -+ swat_tab->rssi_trying = 0; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Test the current ant for (( %d )) ms again\n", -+ swat_tab->train_time); -+ odm_update_rx_idle_ant(dm, -+ fat_tab->rx_idle_ant); -+ odm_set_timer(dm, &swat_tab->sw_antdiv_timer, -+ swat_tab->train_time); /*@ms*/ -+ return; -+ } -+ -+ next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? -+ AUX_ANT : MAIN_ANT; -+ -+ swat_tab->try_flag = SWAW_STEP_DETERMINE; -+ -+ if (swat_tab->reset_idx <= 1) -+ swat_tab->rssi_trying = 2; -+ else -+ swat_tab->rssi_trying = 1; -+ -+ odm_s0s1_sw_ant_div_by_ctrl_frame(dm, SWAW_STEP_PEEK); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[set try_flag=1] Normal state: Begin Trying!!\n"); -+ -+ } else if ((swat_tab->try_flag == SWAW_STEP_DETERMINE) && -+ (swat_tab->double_chk_flag == 0)) { -+ next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? -+ AUX_ANT : MAIN_ANT; -+ swat_tab->rssi_trying--; -+ } -+ -+ /* @1 Decision state */ -+ if (swat_tab->try_flag == SWAW_STEP_DETERMINE && -+ swat_tab->rssi_trying == 0) { -+ phydm_sw_antdiv_decision(dm); -+ return; -+ } -+ } -+ -+ /* @1 4.Change TRX antenna */ -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "rssi_trying = (( %d )), ant: (( %s )) >>> (( %s ))\n", -+ swat_tab->rssi_trying, -+ (fat_tab->rx_idle_ant == MAIN_ANT ? "MAIN" : "AUX"), -+ (next_ant == MAIN_ANT ? "MAIN" : "AUX")); -+ -+ odm_update_rx_idle_ant(dm, next_ant); -+ -+ /* @1 5.Reset Statistics */ -+ -+ fat_tab->rx_idle_ant = next_ant; -+ -+ if (dm->support_ic_type == ODM_RTL8723D || dm->support_ic_type == ODM_RTL8710C) { -+ -+ if (fat_tab->rx_idle_ant == MAIN_ANT) { -+ fat_tab->main_sum[0] = 0; -+ fat_tab->main_cnt[0] = 0; -+ fat_tab->main_sum_cck[0] = 0; -+ fat_tab->main_cnt_cck[0] = 0; -+ } else { -+ fat_tab->aux_sum[0] = 0; -+ fat_tab->aux_cnt[0] = 0; -+ fat_tab->aux_sum_cck[0] = 0; -+ fat_tab->aux_cnt_cck[0] = 0; -+ } -+ } -+ -+ if (dm->support_ic_type == ODM_RTL8188F) { -+ if (dm->support_interface == ODM_ITRF_SDIO) { -+ ODM_delay_us(200); -+ -+ if (fat_tab->rx_idle_ant == MAIN_ANT) { -+ fat_tab->main_sum[0] = 0; -+ fat_tab->main_cnt[0] = 0; -+ fat_tab->main_sum_cck[0] = 0; -+ fat_tab->main_cnt_cck[0] = 0; -+ } else { -+ fat_tab->aux_sum[0] = 0; -+ fat_tab->aux_cnt[0] = 0; -+ fat_tab->aux_sum_cck[0] = 0; -+ fat_tab->aux_cnt_cck[0] = 0; -+ } -+ } -+ } -+ /* @1 6.Set next timer (Trying state) */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, " Test ((%s)) ant for (( %d )) ms\n", -+ (next_ant == MAIN_ANT ? "MAIN" : "AUX"), -+ swat_tab->train_time); -+ odm_set_timer(dm, &swat_tab->sw_antdiv_timer, swat_tab->train_time); -+ /*@ms*/ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void odm_sw_antdiv_callback(struct phydm_timer_list *timer) -+{ -+ void *adapter = (void *)timer->Adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct sw_antenna_switch *swat_tab = &hal_data->DM_OutSrc.dm_swat_table; -+ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+#if USE_WORKITEM -+ odm_schedule_work_item(&swat_tab->phydm_sw_antenna_switch_workitem); -+#else -+ { -+#if 0 -+ /* @dbg_print("SW_antdiv_Callback"); */ -+#endif -+ odm_s0s1_sw_ant_div(&hal_data->DM_OutSrc, SWAW_STEP_DETERMINE); -+ } -+#endif -+#else -+ odm_schedule_work_item(&swat_tab->phydm_sw_antenna_switch_workitem); -+#endif -+} -+ -+void odm_sw_antdiv_workitem_callback(void *context) -+{ -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ -+#if 0 -+ /* @dbg_print("SW_antdiv_Workitem_Callback"); */ -+#endif -+ odm_s0s1_sw_ant_div(&hal_data->DM_OutSrc, SWAW_STEP_DETERMINE); -+} -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+void odm_sw_antdiv_workitem_callback(void *context) -+{ -+ void * -+ adapter = (void *)context; -+ HAL_DATA_TYPE -+ *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ -+#if 0 -+ /*@dbg_print("SW_antdiv_Workitem_Callback");*/ -+#endif -+ odm_s0s1_sw_ant_div(&hal_data->odmpriv, SWAW_STEP_DETERMINE); -+} -+ -+void odm_sw_antdiv_callback(void *function_context) -+{ -+ struct dm_struct *dm = (struct dm_struct *)function_context; -+ void *padapter = dm->adapter; -+ if (*dm->is_net_closed == true) -+ return; -+ -+#if 0 /* @Can't do I/O in timer callback*/ -+ odm_s0s1_sw_ant_div(dm, SWAW_STEP_DETERMINE); -+#else -+ rtw_run_in_thread_cmd(padapter, odm_sw_antdiv_workitem_callback, -+ padapter); -+#endif -+} -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+void odm_sw_antdiv_callback(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "******AntDiv_Callback******\n"); -+ odm_s0s1_sw_ant_div(dm, SWAW_STEP_DETERMINE); -+} -+#endif -+ -+void odm_s0s1_sw_ant_div_by_ctrl_frame(void *dm_void, u8 step) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ switch (step) { -+ case SWAW_STEP_PEEK: -+ swat_tab->pkt_cnt_sw_ant_div_by_ctrl_frame = 0; -+ swat_tab->is_sw_ant_div_by_ctrl_frame = true; -+ fat_tab->main_ctrl_cnt = 0; -+ fat_tab->aux_ctrl_cnt = 0; -+ fat_tab->main_ctrl_sum = 0; -+ fat_tab->aux_ctrl_sum = 0; -+ fat_tab->cck_ctrl_frame_cnt_main = 0; -+ fat_tab->cck_ctrl_frame_cnt_aux = 0; -+ fat_tab->ofdm_ctrl_frame_cnt_main = 0; -+ fat_tab->ofdm_ctrl_frame_cnt_aux = 0; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "odm_S0S1_SwAntDivForAPMode(): Start peek and reset counter\n"); -+ break; -+ case SWAW_STEP_DETERMINE: -+ swat_tab->is_sw_ant_div_by_ctrl_frame = false; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "odm_S0S1_SwAntDivForAPMode(): Stop peek\n"); -+ break; -+ default: -+ swat_tab->is_sw_ant_div_by_ctrl_frame = false; -+ break; -+ } -+} -+ -+void odm_antsel_statistics_ctrl(void *dm_void, u8 antsel_tr_mux, -+ u32 rx_pwdb_all) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ if (antsel_tr_mux == ANT1_2G) { -+ fat_tab->main_ctrl_sum += rx_pwdb_all; -+ fat_tab->main_ctrl_cnt++; -+ } else { -+ fat_tab->aux_ctrl_sum += rx_pwdb_all; -+ fat_tab->aux_ctrl_cnt++; -+ } -+} -+ -+void odm_s0s1_sw_ant_div_by_ctrl_frame_process_rssi(void *dm_void, -+ void *phy_info_void, -+ void *pkt_info_void -+ /* struct phydm_phyinfo_struct* phy_info, */ -+ /* struct phydm_perpkt_info_struct* pktinfo */ -+ ) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_phyinfo_struct *phy_info = NULL; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u8 rssi_cck; -+ -+ phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ -+ if (!(dm->support_ability & ODM_BB_ANT_DIV)) -+ return; -+ -+ if (dm->ant_div_type != S0S1_SW_ANTDIV) -+ return; -+ -+ /* @In try state */ -+ if (!swat_tab->is_sw_ant_div_by_ctrl_frame) -+ return; -+ -+ /* No HW error and match receiver address */ -+ if (!pktinfo->is_to_self) -+ return; -+ -+ swat_tab->pkt_cnt_sw_ant_div_by_ctrl_frame++; -+ -+ if (pktinfo->is_cck_rate) { -+ rssi_cck = phy_info->rx_mimo_signal_strength[RF_PATH_A]; -+ fat_tab->antsel_rx_keep_0 = (fat_tab->rx_idle_ant == MAIN_ANT) ? -+ ANT1_2G : ANT2_2G; -+ -+ if (fat_tab->antsel_rx_keep_0 == ANT1_2G) -+ fat_tab->cck_ctrl_frame_cnt_main++; -+ else -+ fat_tab->cck_ctrl_frame_cnt_aux++; -+ -+ odm_antsel_statistics_ctrl(dm, fat_tab->antsel_rx_keep_0, -+ rssi_cck); -+ } else { -+ fat_tab->antsel_rx_keep_0 = (fat_tab->rx_idle_ant == MAIN_ANT) ? -+ ANT1_2G : ANT2_2G; -+ -+ if (fat_tab->antsel_rx_keep_0 == ANT1_2G) -+ fat_tab->ofdm_ctrl_frame_cnt_main++; -+ else -+ fat_tab->ofdm_ctrl_frame_cnt_aux++; -+ -+ odm_antsel_statistics_ctrl(dm, fat_tab->antsel_rx_keep_0, -+ phy_info->rx_pwdb_all); -+ } -+} -+ -+#endif /* @#if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) */ -+ -+void odm_set_next_mac_addr_target(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct cmn_sta_info *entry; -+ u32 value32, i; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "%s ==>\n", __func__); -+ -+ if (dm->is_linked) { -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ if ((fat_tab->train_idx + 1) == ODM_ASSOCIATE_ENTRY_NUM) -+ fat_tab->train_idx = 0; -+ else -+ fat_tab->train_idx++; -+ -+ entry = dm->phydm_sta_info[fat_tab->train_idx]; -+ -+ if (is_sta_active(entry)) { -+ /*@Match MAC ADDR*/ -+ value32 = (entry->mac_addr[5] << 8) | entry->mac_addr[4]; -+ -+ odm_set_mac_reg(dm, R_0x7b4, 0xFFFF, value32); /*@0x7b4~0x7b5*/ -+ -+ value32 = (entry->mac_addr[3] << 24) | (entry->mac_addr[2] << 16) | (entry->mac_addr[1] << 8) | entry->mac_addr[0]; -+ -+ odm_set_mac_reg(dm, R_0x7b0, MASKDWORD, value32); /*@0x7b0~0x7b3*/ -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "fat_tab->train_idx=%d\n", -+ fat_tab->train_idx); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Training MAC addr = %x:%x:%x:%x:%x:%x\n", -+ entry->mac_addr[5], -+ entry->mac_addr[4], -+ entry->mac_addr[3], -+ entry->mac_addr[2], -+ entry->mac_addr[1], -+ entry->mac_addr[0]); -+ -+ break; -+ } -+ } -+ } -+} -+ -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ -+void odm_fast_ant_training( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ u32 max_rssi_path_a = 0, pckcnt_path_a = 0; -+ u8 i, target_ant_path_a = 0; -+ boolean is_pkt_filter_macth_path_a = false; -+#if (RTL8192E_SUPPORT == 1) -+ u32 max_rssi_path_b = 0, pckcnt_path_b = 0; -+ u8 target_ant_path_b = 0; -+ boolean is_pkt_filter_macth_path_b = false; -+#endif -+ -+ if (!dm->is_linked) { /* @is_linked==False */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[No Link!!!]\n"); -+ -+ if (fat_tab->is_become_linked == true) { -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ phydm_fast_training_enable(dm, FAT_OFF); -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ fat_tab->is_become_linked = dm->is_linked; -+ } -+ return; -+ } else { -+ if (fat_tab->is_become_linked == false) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Linked!!!]\n"); -+ fat_tab->is_become_linked = dm->is_linked; -+ } -+ } -+ -+ if (!(*fat_tab->p_force_tx_by_desc)) { -+ if (dm->is_one_entry_only == true) -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ else -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); -+ } -+ -+ if (dm->support_ic_type == ODM_RTL8188E) -+ odm_set_bb_reg(dm, R_0x864, BIT(2) | BIT(1) | BIT(0), ((dm->fat_comb_a) - 1)); -+#if (RTL8192E_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8192E) { -+ odm_set_bb_reg(dm, R_0xb38, BIT(2) | BIT(1) | BIT(0), ((dm->fat_comb_a) - 1)); /* path-A */ /* ant combination=regB38[2:0]+1 */ -+ odm_set_bb_reg(dm, R_0xb38, BIT(18) | BIT(17) | BIT(16), ((dm->fat_comb_b) - 1)); /* path-B */ /* ant combination=regB38[18:16]+1 */ -+ } -+#endif -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "==>%s\n", __func__); -+ -+ /* @1 TRAINING STATE */ -+ if (fat_tab->fat_state == FAT_TRAINING_STATE) { -+ /* @2 Caculate RSSI per Antenna */ -+ -+ /* @3 [path-A]--------------------------- */ -+ for (i = 0; i < (dm->fat_comb_a); i++) { /* @i : antenna index */ -+ if (fat_tab->ant_rssi_cnt[i] == 0) -+ fat_tab->ant_ave_rssi[i] = 0; -+ else { -+ fat_tab->ant_ave_rssi[i] = fat_tab->ant_sum_rssi[i] / fat_tab->ant_rssi_cnt[i]; -+ is_pkt_filter_macth_path_a = true; -+ } -+ -+ if (fat_tab->ant_ave_rssi[i] > max_rssi_path_a) { -+ max_rssi_path_a = fat_tab->ant_ave_rssi[i]; -+ pckcnt_path_a = fat_tab->ant_rssi_cnt[i]; -+ target_ant_path_a = i; -+ } else if (fat_tab->ant_ave_rssi[i] == max_rssi_path_a) { -+ if (fat_tab->ant_rssi_cnt[i] > pckcnt_path_a) { -+ max_rssi_path_a = fat_tab->ant_ave_rssi[i]; -+ pckcnt_path_a = fat_tab->ant_rssi_cnt[i]; -+ target_ant_path_a = i; -+ } -+ } -+ -+ PHYDM_DBG( -+ "*** ant-index : [ %d ], counter = (( %d )), Avg RSSI = (( %d ))\n", -+ i, fat_tab->ant_rssi_cnt[i], -+ fat_tab->ant_ave_rssi[i]); -+ } -+ -+#if 0 -+#if (RTL8192E_SUPPORT == 1) -+ /* @3 [path-B]--------------------------- */ -+ for (i = 0; i < (dm->fat_comb_b); i++) { -+ if (fat_tab->antRSSIcnt_pathB[i] == 0) -+ fat_tab->antAveRSSI_pathB[i] = 0; -+ else { /* @(ant_rssi_cnt[i] != 0) */ -+ fat_tab->antAveRSSI_pathB[i] = fat_tab->antSumRSSI_pathB[i] / fat_tab->antRSSIcnt_pathB[i]; -+ is_pkt_filter_macth_path_b = true; -+ } -+ if (fat_tab->antAveRSSI_pathB[i] > max_rssi_path_b) { -+ max_rssi_path_b = fat_tab->antAveRSSI_pathB[i]; -+ pckcnt_path_b = fat_tab->antRSSIcnt_pathB[i]; -+ target_ant_path_b = (u8)i; -+ } -+ if (fat_tab->antAveRSSI_pathB[i] == max_rssi_path_b) { -+ if (fat_tab->antRSSIcnt_pathB > pckcnt_path_b) { -+ max_rssi_path_b = fat_tab->antAveRSSI_pathB[i]; -+ target_ant_path_b = (u8)i; -+ } -+ } -+ if (dm->fat_print_rssi == 1) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***{path-B}: Sum RSSI[%d] = (( %d )), cnt RSSI [%d] = (( %d )), Avg RSSI[%d] = (( %d ))\n", -+ i, fat_tab->antSumRSSI_pathB[i], i, -+ fat_tab->antRSSIcnt_pathB[i], i, -+ fat_tab->antAveRSSI_pathB[i]); -+ } -+ } -+#endif -+#endif -+ -+ /* @1 DECISION STATE */ -+ -+ /* @2 Select TRX Antenna */ -+ -+ phydm_fast_training_enable(dm, FAT_OFF); -+ -+ /* @3 [path-A]--------------------------- */ -+ if (is_pkt_filter_macth_path_a == false) { -+#if 0 -+ /* PHYDM_DBG(dm,DBG_ANT_DIV, "{path-A}: None Packet is matched\n"); */ -+#endif -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "{path-A}: None Packet is matched\n"); -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ } else { -+ PHYDM_DBG( -+ "target_ant_path_a = (( %d )) , max_rssi_path_a = (( %d ))\n", -+ target_ant_path_a, max_rssi_path_a); -+ -+ /* @3 [ update RX-optional ant ] Default RX is Omni, Optional RX is the best decision by FAT */ -+ if (dm->support_ic_type == ODM_RTL8188E) -+ odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), target_ant_path_a); -+ else if (dm->support_ic_type == ODM_RTL8192E) -+ odm_set_bb_reg(dm, R_0xb38, BIT(8) | BIT(7) | BIT(6), target_ant_path_a); /* Optional RX [pth-A] */ -+ -+ /* @3 [ update TX ant ] */ -+ odm_update_tx_ant(dm, target_ant_path_a, (fat_tab->train_idx)); -+ -+ if (target_ant_path_a == 0) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ } -+#if 0 -+#if (RTL8192E_SUPPORT == 1) -+ /* @3 [path-B]--------------------------- */ -+ if (is_pkt_filter_macth_path_b == false) { -+ if (dm->fat_print_rssi == 1) -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***[%d]{path-B}: None Packet is matched\n\n\n", -+ __LINE__); -+ } else { -+ if (dm->fat_print_rssi == 1) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ " ***target_ant_path_b = (( %d )) *** max_rssi = (( %d ))***\n\n\n", -+ target_ant_path_b, max_rssi_path_b); -+ } -+ odm_set_bb_reg(dm, R_0xb38, BIT(21) | BIT20 | BIT19, target_ant_path_b); /* @Default RX is Omni, Optional RX is the best decision by FAT */ -+ odm_set_bb_reg(dm, R_0x80c, BIT(21), 1); /* Reg80c[21]=1'b1 //from TX Info */ -+ -+ fat_tab->antsel_pathB[fat_tab->train_idx] = target_ant_path_b; -+ } -+#endif -+#endif -+ -+ /* @2 Reset counter */ -+ for (i = 0; i < (dm->fat_comb_a); i++) { -+ fat_tab->ant_sum_rssi[i] = 0; -+ fat_tab->ant_rssi_cnt[i] = 0; -+ } -+ /*@ -+ #if (RTL8192E_SUPPORT == 1) -+ for(i=0; i<=(dm->fat_comb_b); i++) -+ { -+ fat_tab->antSumRSSI_pathB[i] = 0; -+ fat_tab->antRSSIcnt_pathB[i] = 0; -+ } -+ #endif -+ */ -+ -+ fat_tab->fat_state = FAT_PREPARE_STATE; -+ return; -+ } -+ -+ /* @1 NORMAL STATE */ -+ if (fat_tab->fat_state == FAT_PREPARE_STATE) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ Start Prepare state ]\n"); -+ -+ odm_set_next_mac_addr_target(dm); -+ -+ /* @2 Prepare Training */ -+ fat_tab->fat_state = FAT_TRAINING_STATE; -+ phydm_fast_training_enable(dm, FAT_ON); -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); -+ /* @enable HW AntDiv */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Start Training state]\n"); -+ -+ odm_set_timer(dm, &dm->fast_ant_training_timer, dm->antdiv_intvl); /* @ms */ -+ } -+} -+ -+void odm_fast_ant_training_callback( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (*(dm->is_net_closed) == true) -+ return; -+#endif -+ -+#if USE_WORKITEM -+ odm_schedule_work_item(&dm->fast_ant_training_workitem); -+#else -+ PHYDM_DBG(dm, DBG_ANT_DIV, "******%s******\n", __func__); -+ odm_fast_ant_training(dm); -+#endif -+} -+ -+void odm_fast_ant_training_work_item_callback( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "******%s******\n", __func__); -+ odm_fast_ant_training(dm); -+} -+ -+#endif -+ -+void odm_ant_div_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; -+ u8 i; -+ if (!(dm->support_ability & ODM_BB_ANT_DIV)) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] Not Support Antenna Diversity Function\n"); -+ return; -+ } -+/* @--- */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (fat_tab->ant_div_2g_5g == ODM_ANTDIV_2G) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[2G AntDiv Init]: Only Support 2G Antenna Diversity Function\n"); -+ if (!(dm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC)) -+ return; -+ } else if (fat_tab->ant_div_2g_5g == ODM_ANTDIV_5G) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[5G AntDiv Init]: Only Support 5G Antenna Diversity Function\n"); -+ if (!(dm->support_ic_type & ODM_ANTDIV_5G_SUPPORT_IC)) -+ return; -+ } else if (fat_tab->ant_div_2g_5g == (ODM_ANTDIV_2G | ODM_ANTDIV_5G)) -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[2G & 5G AntDiv Init]:Support Both 2G & 5G Antenna Diversity Function\n"); -+ -+#endif -+ /* @--- */ -+ -+ /* @2 [--General---] */ -+ dm->antdiv_period = 0; -+ -+ fat_tab->is_become_linked = false; -+ fat_tab->ant_div_on_off = 0xff; -+ -+ for(i=0;i<3;i++) -+ fat_tab->ant_idx_vec[i]=i+1; /* initialize ant_idx_vec for SP3T */ -+ -+ -+/* @3 - AP - */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ odm_bdc_init(dm); -+#endif -+#endif -+ -+/* @3 - WIN - */ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ swat_tab->ant_5g = MAIN_ANT; -+ swat_tab->ant_2g = MAIN_ANT; -+//#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+// swat_tab->ant_2g = MAIN_ANT; -+#endif -+ -+ /* @2 [---Set MAIN_ANT as default antenna if Auto-ant enable---] */ -+ if (fat_tab->div_path_type == ANT_PATH_A) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ else if (fat_tab->div_path_type == ANT_PATH_B) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_B); -+ else if (fat_tab->div_path_type == ANT_PATH_AB) -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_AB); -+ -+ dm->ant_type = ODM_AUTO_ANT; -+ -+ fat_tab->rx_idle_ant = 0xff; -+ -+ if (dm->support_ic_type == ODM_RTL8710C) { -+ /* Soft ware*/ -+#if (RTL8710C_SUPPORT == 1) -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0xdc, HAL_READ32(SYSTEM_CTRL_BASE, R_0xdc) | BIT18 | BIT17 | BIT16); -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0xac, HAL_READ32(SYSTEM_CTRL_BASE, R_0xac) | BIT24 | BIT6); -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0x10, 0x307);// 1: enable gpio db32 clock , 1: enable gpio pclock -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0x08, 0x80000111); -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0x1208, 0x800000); -+ } else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0xdc, HAL_READ32(SYSTEM_CTRL_BASE, R_0xdc) | BIT18 | BIT17); -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0xdc, HAL_READ32(SYSTEM_CTRL_BASE, R_0xdc) & (~BIT16)); -+ HAL_WRITE32(SYSTEM_CTRL_BASE, R_0xac, HAL_READ32(SYSTEM_CTRL_BASE, R_0xac) | BIT24 | BIT6); -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8710C Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+#endif -+ } -+ -+ /*to make RX-idle-antenna will be updated absolutly*/ -+ odm_update_rx_idle_ant(dm, MAIN_ANT); -+ phydm_keep_rx_ack_ant_by_tx_ant_time(dm, 0); -+ /* Timming issue: keep Rx ant after tx for ACK(5 x 3.2 mu = 16mu sec)*/ -+ -+ /* @2 [---Set TX Antenna---] */ -+ if (!fat_tab->p_force_tx_by_desc) { -+ fat_tab->force_tx_by_desc = 0; -+ fat_tab->p_force_tx_by_desc = &fat_tab->force_tx_by_desc; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, "p_force_tx_by_desc = %d\n", -+ *fat_tab->p_force_tx_by_desc); -+ -+ if (*fat_tab->p_force_tx_by_desc) -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); -+ else -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ -+ /* @2 [--88E---] */ -+ if (dm->support_ic_type == ODM_RTL8188E) { -+#if (RTL8188E_SUPPORT == 1) -+ /* @dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ -+ /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ -+ /* @dm->ant_div_type = CG_TRX_SMART_ANTDIV; */ -+ -+ if (dm->ant_div_type != CGCS_RX_HW_ANTDIV && -+ dm->ant_div_type != CG_TRX_HW_ANTDIV && -+ dm->ant_div_type != CG_TRX_SMART_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 88E Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) -+ odm_rx_hw_ant_div_init_88e(dm); -+ else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_trx_hw_ant_div_init_88e(dm); -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ else if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) -+ odm_smart_hw_ant_div_init_88e(dm); -+#endif -+#endif -+ } -+ -+/* @2 [--92E---] */ -+#if (RTL8192E_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8192E) { -+ /* @dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ -+ /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ -+ /* @dm->ant_div_type = CG_TRX_SMART_ANTDIV; */ -+ -+ if (dm->ant_div_type != CGCS_RX_HW_ANTDIV && -+ dm->ant_div_type != CG_TRX_HW_ANTDIV && -+ dm->ant_div_type != CG_TRX_SMART_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8192E Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) -+ odm_rx_hw_ant_div_init_92e(dm); -+ else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_trx_hw_ant_div_init_92e(dm); -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ else if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) -+ odm_smart_hw_ant_div_init_92e(dm); -+#endif -+ } -+#endif -+ -+ /* @2 [--92F---] */ -+#if (RTL8192F_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8192F) { -+ /* @dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ -+ /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ -+ /* @dm->ant_div_type = CG_TRX_SMART_ANTDIV; */ -+ -+ if (dm->ant_div_type != CGCS_RX_HW_ANTDIV) { -+ if (dm->ant_div_type != CG_TRX_HW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8192F Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ } -+ if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) -+ odm_rx_hw_ant_div_init_92f(dm); -+ else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_trx_hw_ant_div_init_92f(dm); -+ } -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8197F) { -+ dm->ant_div_type = CGCS_RX_HW_ANTDIV; -+ -+ if (dm->ant_div_type != CGCS_RX_HW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8197F Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ phydm_rx_hw_ant_div_init_97f(dm); -+ } -+#endif -+ -+#if (RTL8197G_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8197G) { -+ dm->ant_div_type = CGCS_RX_HW_ANTDIV; -+ -+ if (dm->ant_div_type != CGCS_RX_HW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8197F Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ phydm_rx_hw_ant_div_init_97g(dm); -+ } -+#endif -+ -+#if (RTL8723F_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8723F) { -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ -+ if (dm->ant_div_type != CG_TRX_HW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8723F Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ phydm_rx_hw_ant_div_init_23f(dm); -+ } -+#endif -+/* @2 [--8723B---] */ -+#if (RTL8723B_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8723B) { -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ -+ -+ if (dm->ant_div_type != S0S1_SW_ANTDIV && -+ dm->ant_div_type != CG_TRX_HW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8723B Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) -+ odm_s0s1_sw_ant_div_init_8723b(dm); -+ else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_trx_hw_ant_div_init_8723b(dm); -+ } -+#endif -+/*@2 [--8723D---]*/ -+#if (RTL8723D_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8723D) { -+ if (fat_tab->p_default_s0_s1 == NULL) { -+ fat_tab->default_s0_s1 = 1; -+ fat_tab->p_default_s0_s1 = &fat_tab->default_s0_s1; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, "default_s0_s1 = %d\n", -+ *fat_tab->p_default_s0_s1); -+ -+ if (*fat_tab->p_default_s0_s1 == true) -+ odm_update_rx_idle_ant(dm, MAIN_ANT); -+ else -+ odm_update_rx_idle_ant(dm, AUX_ANT); -+ -+ if (dm->ant_div_type == S0S1_TRX_HW_ANTDIV) -+ odm_trx_hw_ant_div_init_8723d(dm); -+ else if (dm->ant_div_type == S0S1_SW_ANTDIV) -+ odm_s0s1_sw_ant_div_init_8723d(dm); -+ else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8723D Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ } -+#endif -+#if (RTL8710C_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8710C) { -+ if (dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_trx_hw_ant_div_init_8710c(dm); -+ else if(dm->ant_div_type == S0S1_SW_ANTDIV){ -+ if (fat_tab->p_default_s0_s1 == NULL){ -+ fat_tab->default_s0_s1 = 1; -+ fat_tab->p_default_s0_s1 = &fat_tab->default_s0_s1; -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, "default_s0_s1 = %d\n", -+ *fat_tab->p_default_s0_s1); -+ if (*fat_tab->p_default_s0_s1 == true) -+ odm_update_rx_idle_ant(dm, MAIN_ANT); -+ else -+ odm_update_rx_idle_ant(dm, AUX_ANT); -+ odm_s0s1_sw_ant_div_init_8710c(dm); -+ } -+ } -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8721D) { -+ /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ -+ -+ if (dm->ant_div_type != CG_TRX_HW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8721D Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ if (dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_trx_hw_ant_div_init_8721d(dm); -+ } -+#endif -+/* @2 [--8811A 8821A---] */ -+#if (RTL8821A_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8821) { -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ dm->ant_div_type = HL_SW_SMART_ANT_TYPE1; -+ -+ if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { -+ odm_trx_hw_ant_div_init_8821a(dm); -+ phydm_hl_smart_ant_type1_init_8821a(dm); -+ } else -+#endif -+ { -+#ifdef ODM_CONFIG_BT_COEXIST -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+#else -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+#endif -+ -+ if (dm->ant_div_type != CG_TRX_HW_ANTDIV && -+ dm->ant_div_type != S0S1_SW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8821A & 8811A Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ if (dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_trx_hw_ant_div_init_8821a(dm); -+ else if (dm->ant_div_type == S0S1_SW_ANTDIV) -+ odm_s0s1_sw_ant_div_init_8821a(dm); -+ } -+ } -+#endif -+ -+/* @2 [--8821C---] */ -+#if (RTL8821C_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8821C) { -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ if (dm->ant_div_type != S0S1_SW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8821C Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ phydm_s0s1_sw_ant_div_init_8821c(dm); -+ odm_trx_hw_ant_div_init_8821c(dm); -+ } -+#endif -+ -+/* @2 [--8195B---] */ -+#if (RTL8195B_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8195B) { -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ if (dm->ant_div_type != CG_TRX_HW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8821C Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ odm_trx_hw_ant_div_init_8195b(dm); -+ } -+#endif -+ -+/* @2 [--8881A---] */ -+#if (RTL8881A_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8881A) { -+ /* @dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ -+ /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ -+ -+ if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ odm_trx_hw_ant_div_init_8881a(dm); -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8881A Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ odm_trx_hw_ant_div_init_8881a(dm); -+ } -+#endif -+ -+/* @2 [--8812---] */ -+#if (RTL8812A_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8812) { -+ /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ -+ -+ if (dm->ant_div_type != CG_TRX_HW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8812A Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ odm_trx_hw_ant_div_init_8812a(dm); -+ } -+#endif -+ -+/*@[--8188F---]*/ -+#if (RTL8188F_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8188F) { -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ odm_s0s1_sw_ant_div_init_8188f(dm); -+ } -+#endif -+ -+/*@[--8822B---]*/ -+#if (RTL8822B_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8822B) { -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ -+ if (dm->ant_div_type != CG_TRX_HW_ANTDIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] 8822B Not Supprrt This AntDiv type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ phydm_trx_hw_ant_div_init_22b(dm); -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 -+ dm->ant_div_type = HL_SW_SMART_ANT_TYPE2; -+ -+ if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE2) -+ phydm_hl_smart_ant_type2_init_8822b(dm); -+#endif -+ } -+#endif -+ -+/*@PHYDM_DBG(dm, DBG_ANT_DIV, "*** support_ic_type=[%lu]\n",*/ -+/*dm->support_ic_type);*/ -+/*PHYDM_DBG(dm, DBG_ANT_DIV, "*** AntDiv support_ability=[%lu]\n",*/ -+/* (dm->support_ability & ODM_BB_ANT_DIV)>>6);*/ -+/*PHYDM_DBG(dm, DBG_ANT_DIV, "*** AntDiv type=[%d]\n",dm->ant_div_type);*/ -+} -+ -+void odm_ant_div(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+#if (defined(CONFIG_HL_SMART_ANTENNA)) -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+#endif -+ -+ if (!(dm->support_ability & ODM_BB_ANT_DIV)) -+ return; -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ if (dm->is_linked) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "tp_active_occur=((%d)), evm_method_enable=((%d))\n", -+ dm->tp_active_occur, fat_tab->evm_method_enable); -+ -+ if (dm->tp_active_occur == 1 && -+ fat_tab->evm_method_enable == 1) { -+ fat_tab->idx_ant_div_counter_5g = dm->antdiv_period; -+ fat_tab->idx_ant_div_counter_2g = dm->antdiv_period; -+ } -+ } -+#endif -+ -+ if (*dm->band_type == ODM_BAND_5G) { -+ if (fat_tab->idx_ant_div_counter_5g < dm->antdiv_period) { -+ fat_tab->idx_ant_div_counter_5g++; -+ return; -+ } else -+ fat_tab->idx_ant_div_counter_5g = 0; -+ } else if (*dm->band_type == ODM_BAND_2_4G) { -+ if (fat_tab->idx_ant_div_counter_2g < dm->antdiv_period) { -+ fat_tab->idx_ant_div_counter_2g++; -+ return; -+ } else -+ fat_tab->idx_ant_div_counter_2g = 0; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN || DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+ if (fat_tab->enable_ctrl_frame_antdiv) { -+ if (dm->data_frame_num <= 10 && dm->is_linked) -+ fat_tab->use_ctrl_frame_antdiv = 1; -+ else -+ fat_tab->use_ctrl_frame_antdiv = 0; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "use_ctrl_frame_antdiv = (( %d )), data_frame_num = (( %d ))\n", -+ fat_tab->use_ctrl_frame_antdiv, dm->data_frame_num); -+ dm->data_frame_num = 0; -+ } -+ -+ { -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ -+ enum beamforming_cap beamform_cap = phydm_get_beamform_cap(dm); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "is_bt_continuous_turn = ((%d))\n", -+ dm->is_bt_continuous_turn); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ AntDiv Beam Cap ] cap= ((%d))\n", beamform_cap); -+ if (!dm->is_bt_continuous_turn) { -+ if ((beamform_cap & BEAMFORMEE_CAP) && -+ (!(*fat_tab->is_no_csi_feedback))) { -+ /* @BFmee On && Div On->Div Off */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ AntDiv : OFF ] BFmee ==1; cap= ((%d))\n", -+ beamform_cap); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ AntDiv BF] is_no_csi_feedback= ((%d))\n", -+ *(fat_tab->is_no_csi_feedback)); -+ if (fat_tab->fix_ant_bfee == 0) { -+ odm_ant_div_on_off(dm, ANTDIV_OFF, -+ ANT_PATH_A); -+ fat_tab->fix_ant_bfee = 1; -+ } -+ return; -+ } else { /* @BFmee Off && Div Off->Div On */ -+ if (fat_tab->fix_ant_bfee == 1 && -+ dm->is_linked) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ AntDiv : ON ] BFmee ==0; cap=((%d))\n", -+ beamform_cap); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ AntDiv BF] is_no_csi_feedback= ((%d))\n", -+ *fat_tab->is_no_csi_feedback); -+ if (dm->ant_div_type != S0S1_SW_ANTDIV) -+ odm_ant_div_on_off(dm, ANTDIV_ON -+ , ANT_PATH_A) -+ ; -+ fat_tab->fix_ant_bfee = 0; -+ } -+ } -+ } else { -+ if (fat_tab->div_path_type == ANT_PATH_A) -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); -+ else if (fat_tab->div_path_type == ANT_PATH_B) -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_B); -+ else if (fat_tab->div_path_type == ANT_PATH_AB) -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_AB); -+ } -+#endif -+ } -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ /* @----------just for fool proof */ -+ -+ if (dm->antdiv_rssi) -+ dm->debug_components |= DBG_ANT_DIV; -+ else -+ dm->debug_components &= ~DBG_ANT_DIV; -+ -+ if (fat_tab->ant_div_2g_5g == ODM_ANTDIV_2G) { -+ if (!(dm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC)) -+ return; -+ } else if (fat_tab->ant_div_2g_5g == ODM_ANTDIV_5G) { -+ if (!(dm->support_ic_type & ODM_ANTDIV_5G_SUPPORT_IC)) -+ return; -+ } -+#endif -+ -+ /* @---------- */ -+ -+ if (dm->antdiv_select == 1) -+ dm->ant_type = ODM_FIX_MAIN_ANT; -+ else if (dm->antdiv_select == 2) -+ dm->ant_type = ODM_FIX_AUX_ANT; -+ else { /* @if (dm->antdiv_select==0) */ -+ dm->ant_type = ODM_AUTO_ANT; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /*Stop Antenna diversity for CMW500 testing case*/ -+ if (dm->consecutive_idlel_time >= 10) { -+ dm->ant_type = ODM_FIX_MAIN_ANT; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[AntDiv: OFF] No TP case, consecutive_idlel_time=((%d))\n", -+ dm->consecutive_idlel_time); -+ } -+#endif -+ } -+ -+ /*PHYDM_DBG(dm, DBG_ANT_DIV,"ant_type= (%d), pre_ant_type= (%d)\n",*/ -+ /*dm->ant_type,dm->pre_ant_type); */ -+ -+ if (dm->ant_type != ODM_AUTO_ANT) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Fix Antenna at (( %s ))\n", -+ (dm->ant_type == ODM_FIX_MAIN_ANT) ? "MAIN" : "AUX"); -+ -+ if (dm->ant_type != dm->pre_ant_type) { -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ -+ if (dm->ant_type == ODM_FIX_MAIN_ANT) -+ odm_update_rx_idle_ant(dm, MAIN_ANT); -+ else if (dm->ant_type == ODM_FIX_AUX_ANT) -+ odm_update_rx_idle_ant(dm, AUX_ANT); -+ } -+ dm->pre_ant_type = dm->ant_type; -+ return; -+ } else { -+ if (dm->ant_type != dm->pre_ant_type) { -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); -+ } -+ dm->pre_ant_type = dm->ant_type; -+ } -+#if (defined(CONFIG_2T4R_ANTENNA)) -+ if (dm->ant_type2 != ODM_AUTO_ANT) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "PathB Fix Ant at (( %s ))\n", -+ (dm->ant_type2 == ODM_FIX_MAIN_ANT) ? "MAIN" : "AUX"); -+ -+ if (dm->ant_type2 != dm->pre_ant_type2) { -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_B); -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ -+ if (dm->ant_type2 == ODM_FIX_MAIN_ANT) -+ phydm_update_rx_idle_ant_pathb(dm, MAIN_ANT); -+ else if (dm->ant_type2 == ODM_FIX_AUX_ANT) -+ phydm_update_rx_idle_ant_pathb(dm, AUX_ANT); -+ } -+ dm->pre_ant_type2 = dm->ant_type2; -+ return; -+ } -+ if (dm->ant_type2 != dm->pre_ant_type2) { -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_B); -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); -+ } -+ dm->pre_ant_type2 = dm->ant_type2; -+ -+#endif -+ -+/*@ ----------------------------------------------- */ -+/*@ [--8188E--] */ -+ if (dm->support_ic_type == ODM_RTL8188E) { -+#if (RTL8188E_SUPPORT == 1) -+ if (dm->ant_div_type == CG_TRX_HW_ANTDIV || -+ dm->ant_div_type == CGCS_RX_HW_ANTDIV) -+ odm_hw_ant_div(dm); -+ -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ -+ (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ else if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) -+ odm_fast_ant_training(dm); -+#endif -+ -+#endif -+ } -+/*@ [--8192E--] */ -+#if (RTL8192E_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8192E) { -+ if (dm->ant_div_type == CGCS_RX_HW_ANTDIV || -+ dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_hw_ant_div(dm); -+ -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ -+ (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ else if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) -+ odm_fast_ant_training(dm); -+#endif -+ } -+#endif -+/*@ [--8197F--] */ -+#if (RTL8197F_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8197F) { -+ if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) -+ odm_hw_ant_div(dm); -+ } -+#endif -+ -+/*@ [--8197G--] */ -+#if (RTL8197G_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8197G) { -+ if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) -+ odm_hw_ant_div(dm); -+ } -+#endif -+ -+/*@ [--8723F--] */ -+#if (RTL8723F_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8723F) { -+ if (dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_hw_ant_div(dm); -+ } -+#endif -+ -+#if (RTL8723B_SUPPORT == 1) -+/*@ [--8723B---] */ -+ else if (dm->support_ic_type == ODM_RTL8723B) { -+ if (phydm_is_bt_enable_8723b(dm)) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[BT is enable!!!]\n"); -+ if (fat_tab->is_become_linked == true) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Set REG 948[9:6]=0x0\n"); -+ if (dm->support_ic_type == ODM_RTL8723B) -+ odm_set_bb_reg(dm, R_0x948, 0x3c0, 0x0) -+ ; -+ -+ fat_tab->is_become_linked = false; -+ } -+ } else { -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); -+ #endif -+ } else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_hw_ant_div(dm); -+ } -+ } -+#endif -+/*@ [--8723D--]*/ -+#if (RTL8723D_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8723D) { -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ if (dm->antdiv_counter == CONFIG_ANTDIV_PERIOD) { -+ odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); -+ dm->antdiv_counter--; -+ } else { -+ dm->antdiv_counter--; -+ } -+ if (dm->antdiv_counter == 0) -+ dm->antdiv_counter = CONFIG_ANTDIV_PERIOD; -+ #endif -+ } else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ odm_hw_ant_div(dm); -+ } -+ } -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8721D) { -+ if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ odm_hw_ant_div(dm); -+ } -+ } -+#endif -+#if (RTL8710C_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8710C) { -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ if (dm->antdiv_counter == CONFIG_ANTDIV_PERIOD) { -+ odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); -+ dm->antdiv_counter--; -+ } else { -+ dm->antdiv_counter--; -+ } -+ if (dm->antdiv_counter == 0) -+ dm->antdiv_counter = CONFIG_ANTDIV_PERIOD; -+ #endif -+ } else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ odm_hw_ant_div(dm); -+ } -+ } -+#endif -+/*@ [--8821A--] */ -+#if (RTL8821A_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8821) { -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { -+ if (sat_tab->fix_beam_pattern_en != 0) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ " [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", -+ sat_tab->fix_beam_pattern_codeword); -+ /*return;*/ -+ } else { -+ odm_fast_ant_training_hl_smart_antenna_type1(dm); -+ } -+ -+ } else -+ #endif -+ { -+ #ifdef ODM_CONFIG_BT_COEXIST -+ if (!dm->bt_info_table.is_bt_enabled) { /*@BT disabled*/ -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ " [S0S1_SW_ANTDIV] -> [CG_TRX_HW_ANTDIV]\n"); -+ /*odm_set_bb_reg(dm, 0x8d4, BIT24, 1);*/ -+ if (fat_tab->is_become_linked == true) -+ odm_ant_div_on_off(dm, -+ ANTDIV_ON, -+ ANT_PATH_A); -+ } -+ -+ } else { /*@BT enabled*/ -+ -+ if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ " [CG_TRX_HW_ANTDIV] -> [S0S1_SW_ANTDIV]\n"); -+ /*odm_set_bb_reg(dm, 0x8d4, BIT24, 0);*/ -+ odm_ant_div_on_off(dm, ANTDIV_OFF, -+ ANT_PATH_A); -+ } -+ } -+ #endif -+ -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); -+ #endif -+ } else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ odm_hw_ant_div(dm); -+ } -+ } -+ } -+#endif -+ -+/*@ [--8821C--] */ -+#if (RTL8821C_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8821C) { -+ if (!dm->is_bt_continuous_turn) { -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "is_bt_continuous_turn = ((%d)) ==> SW AntDiv\n", -+ dm->is_bt_continuous_turn); -+ -+ } else { -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "is_bt_continuous_turn = ((%d)) ==> HW AntDiv\n", -+ dm->is_bt_continuous_turn); -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); -+ } -+ -+ if (fat_tab->force_antdiv_type) -+ dm->ant_div_type = fat_tab->antdiv_type_dbg; -+ -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); -+ #endif -+ } else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); -+ odm_hw_ant_div(dm); -+ } -+ } -+#endif -+ -+/* @ [--8195B--] */ -+#if (RTL8195B_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8195B) { -+ if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { -+ odm_hw_ant_div(dm); -+ } -+ } -+#endif -+ -+/* @ [--8881A--] */ -+#if (RTL8881A_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8881A) -+ odm_hw_ant_div(dm); -+#endif -+ -+/*@ [--8812A--] */ -+#if (RTL8812A_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8812) -+ odm_hw_ant_div(dm); -+#endif -+ -+#if (RTL8188F_SUPPORT == 1) -+/*@ [--8188F--]*/ -+ else if (dm->support_ic_type == ODM_RTL8188F) { -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); -+ #endif -+ } -+#endif -+ -+/*@ [--8822B--]*/ -+#if (RTL8822B_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8822B) { -+ if (dm->ant_div_type == CG_TRX_HW_ANTDIV) -+ odm_hw_ant_div(dm); -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 -+ if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE2) { -+ if (sat_tab->fix_beam_pattern_en != 0) -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ " [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", -+ sat_tab->fix_beam_pattern_codeword); -+ else -+ phydm_fast_ant_training_hl_smart_antenna_type2(dm); -+ } -+ #endif -+ } -+#endif -+} -+ -+void odm_antsel_statistics(void *dm_void, void *phy_info_void, -+ u8 antsel_tr_mux, u32 mac_id, u32 utility, u8 method, -+ u8 is_cck_rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct phydm_phyinfo_struct *phy_info = NULL; -+ -+ phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ -+ if (method == RSSI_METHOD) { -+ if (is_cck_rate) { -+ if (antsel_tr_mux == fat_tab->ant_idx_vec[0]-1) { -+ /*to prevent u16 overflow, max(RSSI)=100, 65435+100 = 65535 (u16)*/ -+ if (fat_tab->main_sum_cck[mac_id] > 65435) -+ return; -+ -+ fat_tab->main_sum_cck[mac_id] += (u16)utility; -+ fat_tab->main_cnt_cck[mac_id]++; -+ } else { -+ if (fat_tab->aux_sum_cck[mac_id] > 65435) -+ return; -+ -+ fat_tab->aux_sum_cck[mac_id] += (u16)utility; -+ fat_tab->aux_cnt_cck[mac_id]++; -+ } -+ -+ } else { /*ofdm rate*/ -+ -+ if (antsel_tr_mux == fat_tab->ant_idx_vec[0]-1) { -+ if (fat_tab->main_sum[mac_id] > 65435) -+ return; -+ -+ fat_tab->main_sum[mac_id] += (u16)utility; -+ fat_tab->main_cnt[mac_id]++; -+ } else { -+ if (fat_tab->aux_sum[mac_id] > 65435) -+ return; -+ -+ fat_tab->aux_sum[mac_id] += (u16)utility; -+ fat_tab->aux_cnt[mac_id]++; -+ } -+ } -+ } -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ else if (method == EVM_METHOD) { -+ if (!fat_tab->get_stats) -+ return; -+ -+ if (dm->rate_ss == 1) { -+ phydm_statistics_evm_1ss(dm, phy_info, antsel_tr_mux, -+ mac_id, utility); -+ } else { /*@>= 2SS*/ -+ phydm_statistics_evm_2ss(dm, phy_info, antsel_tr_mux, -+ mac_id, utility); -+ } -+ -+ } else if (method == CRC32_METHOD) { -+ if (antsel_tr_mux == ANT1_2G) { -+ fat_tab->main_crc32_ok_cnt += utility; -+ fat_tab->main_crc32_fail_cnt++; -+ } else { -+ fat_tab->aux_crc32_ok_cnt += utility; -+ fat_tab->aux_crc32_fail_cnt++; -+ } -+ -+ } else if (method == TP_METHOD) { -+ if (!fat_tab->get_stats) -+ return; -+ if (utility <= ODM_RATEMCS15 && utility >= ODM_RATEMCS0) { -+ if (antsel_tr_mux == ANT1_2G) { -+ fat_tab->main_tp += (phy_rate_table[utility]) -+ << 5; -+ fat_tab->main_tp_cnt++; -+ } else { -+ fat_tab->aux_tp += (phy_rate_table[utility]) -+ << 5; -+ fat_tab->aux_tp_cnt++; -+ } -+ } -+ } -+#endif -+} -+ -+void odm_process_rssi_smart(void *dm_void, void *phy_info_void, -+ void *pkt_info_void, u8 rx_power_ant0) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_phyinfo_struct *phy_info = NULL; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ -+ if ((dm->support_ic_type & ODM_SMART_ANT_SUPPORT) && -+ pktinfo->is_packet_to_self && -+ fat_tab->fat_state == FAT_TRAINING_STATE) { -+ /* @(pktinfo->is_packet_match_bssid && (!pktinfo->is_packet_beacon)) */ -+ u8 antsel_tr_mux; -+ -+ antsel_tr_mux = (fat_tab->antsel_rx_keep_2 << 2) | -+ (fat_tab->antsel_rx_keep_1 << 1) | -+ fat_tab->antsel_rx_keep_0; -+ fat_tab->ant_sum_rssi[antsel_tr_mux] += rx_power_ant0; -+ fat_tab->ant_rssi_cnt[antsel_tr_mux]++; -+ } -+} -+ -+void odm_process_rssi_normal(void *dm_void, void *phy_info_void, -+ void *pkt_info_void, u8 rx_pwr0) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_phyinfo_struct *phy_info = NULL; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u8 rx_evm0, rx_evm1; -+ boolean b_main; -+ -+ phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ rx_evm0 = phy_info->rx_mimo_signal_quality[0]; -+ rx_evm1 = phy_info->rx_mimo_signal_quality[1]; -+ -+ if (!(pktinfo->is_packet_to_self || fat_tab->use_ctrl_frame_antdiv)) -+ return; -+ -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) { -+ if (pktinfo->is_cck_rate || -+ dm->support_ic_type == ODM_RTL8188F || dm->support_ic_type == ODM_RTL8710C) { -+ -+ b_main = (fat_tab->rx_idle_ant == MAIN_ANT); -+ fat_tab->antsel_rx_keep_0 = b_main ? ANT1_2G : ANT2_2G; -+ } -+ -+ odm_antsel_statistics(dm, phy_info, fat_tab->antsel_rx_keep_0, -+ pktinfo->station_id, rx_pwr0, RSSI_METHOD, -+ pktinfo->is_cck_rate); -+ } else { -+ odm_antsel_statistics(dm, phy_info, fat_tab->antsel_rx_keep_0, -+ pktinfo->station_id, rx_pwr0, RSSI_METHOD, -+ pktinfo->is_cck_rate); -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ if (!(dm->support_ic_type & ODM_EVM_ANTDIV_IC)) -+ return; -+ if (pktinfo->is_cck_rate) -+ return; -+ -+ odm_antsel_statistics(dm, phy_info, fat_tab->antsel_rx_keep_0, -+ pktinfo->station_id, rx_evm0, EVM_METHOD, -+ pktinfo->is_cck_rate); -+ odm_antsel_statistics(dm, phy_info, fat_tab->antsel_rx_keep_0, -+ pktinfo->station_id, pktinfo->data_rate, -+ TP_METHOD, pktinfo->is_cck_rate); -+ #endif -+ } -+} -+ -+void odm_process_rssi_for_ant_div(void *dm_void, void *phy_info_void, -+ void *pkt_info_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_phyinfo_struct *phy_info = NULL; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+#if (defined(CONFIG_HL_SMART_ANTENNA)) -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ u32 beam_tmp; -+ u8 next_ant; -+ u8 train_pkt_number; -+#endif -+ boolean b_main; -+ u8 rx_power_ant0, rx_power_ant1; -+ u8 rx_evm_ant0, rx_evm_ant1; -+ u8 rssi_avg; -+ u64 rssi_linear = 0; -+ -+ phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ rx_power_ant0 = phy_info->rx_mimo_signal_strength[0]; -+ rx_power_ant1 = phy_info->rx_mimo_signal_strength[1]; -+ rx_evm_ant0 = phy_info->rx_mimo_signal_quality[0]; -+ rx_evm_ant1 = phy_info->rx_mimo_signal_quality[1]; -+ -+ if ((dm->support_ic_type & ODM_IC_2SS) && !pktinfo->is_cck_rate) { -+ if (rx_power_ant1 < 100) { -+ rssi_linear = phydm_db_2_linear(rx_power_ant0) + -+ phydm_db_2_linear(rx_power_ant1); -+ /* @Rounding and removing fractional bits */ -+ rssi_linear = (rssi_linear + -+ (1 << (FRAC_BITS - 1))) >> FRAC_BITS; -+ /* @Calculate average RSSI */ -+ rssi_linear = DIVIDED_2(rssi_linear); -+ /* @averaged PWDB */ -+ rssi_avg = (u8)odm_convert_to_db(rssi_linear); -+ } -+ -+ } else { -+ rx_power_ant0 = (u8)phy_info->rx_pwdb_all; -+ rssi_avg = rx_power_ant0; -+ } -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 -+ if ((dm->ant_div_type == HL_SW_SMART_ANT_TYPE2) && (fat_tab->fat_state == FAT_TRAINING_STATE)) -+ phydm_process_rssi_for_hb_smtant_type2(dm, phy_info, pktinfo, rssi_avg); /*@for 8822B*/ -+ else -+#endif -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+#ifdef CONFIG_FAT_PATCH -+ if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE1 && fat_tab->fat_state == FAT_TRAINING_STATE) { -+ /*@[Beacon]*/ -+ if (pktinfo->is_packet_beacon) { -+ sat_tab->beacon_counter++; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "MatchBSSID_beacon_counter = ((%d))\n", -+ sat_tab->beacon_counter); -+ -+ if (sat_tab->beacon_counter >= sat_tab->pre_beacon_counter + 2) { -+ if (sat_tab->ant_num > 1) { -+ next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; -+ odm_update_rx_idle_ant(dm, next_ant); -+ } -+ -+ sat_tab->update_beam_idx++; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "pre_beacon_counter = ((%d)), pkt_counter = ((%d)), update_beam_idx = ((%d))\n", -+ sat_tab->pre_beacon_counter, -+ sat_tab->pkt_counter, -+ sat_tab->update_beam_idx); -+ -+ sat_tab->pre_beacon_counter = sat_tab->beacon_counter; -+ sat_tab->pkt_counter = 0; -+ } -+ } -+ /*@[data]*/ -+ else if (pktinfo->is_packet_to_self) { -+ if (sat_tab->pkt_skip_statistic_en == 0) { -+ /*@ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", -+ pktinfo->station_id, fat_tab->antsel_rx_keep_0, fat_tab->hw_antsw_occur, sat_tab->fast_training_beam_num, rx_power_ant0); -+ */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "ID[%d][pkt_cnt = %d]: {ANT, Beam} = {%d, %d}, RSSI = ((%d))\n", -+ pktinfo->station_id, -+ sat_tab->pkt_counter, -+ fat_tab->antsel_rx_keep_0, -+ sat_tab->fast_training_beam_num, -+ rx_power_ant0); -+ -+ sat_tab->pkt_rssi_sum[fat_tab->antsel_rx_keep_0][sat_tab->fast_training_beam_num] += rx_power_ant0; -+ sat_tab->pkt_rssi_cnt[fat_tab->antsel_rx_keep_0][sat_tab->fast_training_beam_num]++; -+ sat_tab->pkt_counter++; -+ -+#if 1 -+ train_pkt_number = sat_tab->beam_train_cnt[fat_tab->rx_idle_ant - 1][sat_tab->fast_training_beam_num]; -+#else -+ train_pkt_number = sat_tab->per_beam_training_pkt_num; -+#endif -+ -+ /*Swich Antenna erery N pkts*/ -+ if (sat_tab->pkt_counter == train_pkt_number) { -+ if (sat_tab->ant_num > 1) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "packet enugh ((%d ))pkts ---> Switch antenna\n", train_pkt_number); -+ next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; -+ odm_update_rx_idle_ant(dm, next_ant); -+ } -+ -+ sat_tab->update_beam_idx++; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "pre_beacon_counter = ((%d)), update_beam_idx_counter = ((%d))\n", -+ sat_tab->pre_beacon_counter, sat_tab->update_beam_idx); -+ -+ sat_tab->pre_beacon_counter = sat_tab->beacon_counter; -+ sat_tab->pkt_counter = 0; -+ } -+ } -+ } -+ -+ /*Swich Beam after switch "sat_tab->ant_num" antennas*/ -+ if (sat_tab->update_beam_idx == sat_tab->ant_num) { -+ sat_tab->update_beam_idx = 0; -+ sat_tab->pkt_counter = 0; -+ beam_tmp = sat_tab->fast_training_beam_num; -+ -+ if (sat_tab->fast_training_beam_num >= (sat_tab->beam_patten_num_each_ant - 1)) { -+ fat_tab->fat_state = FAT_DECISION_STATE; -+ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ odm_fast_ant_training_hl_smart_antenna_type1(dm); -+#endif -+#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) -+ odm_schedule_work_item(&sat_tab->hl_smart_antenna_decision_workitem); -+#endif -+ -+ } else { -+ sat_tab->fast_training_beam_num++; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Update Beam_num (( %d )) -> (( %d ))\n", -+ beam_tmp, -+ sat_tab->fast_training_beam_num); -+ phydm_set_all_ant_same_beam_num(dm); -+ -+ fat_tab->fat_state = FAT_TRAINING_STATE; -+ } -+ } -+ } -+#else -+ -+ if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { -+ if ((dm->support_ic_type & ODM_HL_SMART_ANT_TYPE1_SUPPORT) && -+ pktinfo->is_packet_to_self && -+ fat_tab->fat_state == FAT_TRAINING_STATE) { -+ if (sat_tab->pkt_skip_statistic_en == 0) { -+ /*@ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", -+ pktinfo->station_id, fat_tab->antsel_rx_keep_0, fat_tab->hw_antsw_occur, sat_tab->fast_training_beam_num, rx_power_ant0); -+ */ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "StaID[%d]: antsel_pathA = ((%d)), is_packet_to_self = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", -+ pktinfo->station_id, -+ fat_tab->antsel_rx_keep_0, -+ pktinfo->is_packet_to_self, -+ sat_tab->fast_training_beam_num, -+ rx_power_ant0); -+ -+ sat_tab->pkt_rssi_sum[fat_tab->antsel_rx_keep_0][sat_tab->fast_training_beam_num] += rx_power_ant0; -+ sat_tab->pkt_rssi_cnt[fat_tab->antsel_rx_keep_0][sat_tab->fast_training_beam_num]++; -+ sat_tab->pkt_counter++; -+ -+ /*swich beam every N pkt*/ -+ if (sat_tab->pkt_counter >= sat_tab->per_beam_training_pkt_num) { -+ sat_tab->pkt_counter = 0; -+ beam_tmp = sat_tab->fast_training_beam_num; -+ -+ if (sat_tab->fast_training_beam_num >= (sat_tab->beam_patten_num_each_ant - 1)) { -+ fat_tab->fat_state = FAT_DECISION_STATE; -+ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ odm_fast_ant_training_hl_smart_antenna_type1(dm); -+#endif -+#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) -+ odm_schedule_work_item(&sat_tab->hl_smart_antenna_decision_workitem); -+#endif -+ -+ } else { -+ sat_tab->fast_training_beam_num++; -+ phydm_set_all_ant_same_beam_num(dm); -+ -+ fat_tab->fat_state = FAT_TRAINING_STATE; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, sat_tab->fast_training_beam_num); -+ } -+ } -+ } -+ } -+ } -+#endif -+ else -+#endif -+ if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) { -+ odm_process_rssi_smart(dm, phy_info, pktinfo, -+ rx_power_ant0); -+ } else { /* @ant_div_type != CG_TRX_SMART_ANTDIV */ -+ odm_process_rssi_normal(dm, phy_info, pktinfo, -+ rx_power_ant0); -+ } -+#if 0 -+/* PHYDM_DBG(dm,DBG_ANT_DIV,"is_cck_rate=%d, pwdb_all=%d\n", -+ * pktinfo->is_cck_rate, phy_info->rx_pwdb_all); -+ * PHYDM_DBG(dm,DBG_ANT_DIV,"antsel_tr_mux=3'b%d%d%d\n", -+ * fat_tab->antsel_rx_keep_2, fat_tab->antsel_rx_keep_1, -+ * fat_tab->antsel_rx_keep_0); -+ */ -+#endif -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) -+void odm_set_tx_ant_by_tx_info(void *dm_void, u8 *desc, u8 mac_id) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ if (!(dm->support_ability & ODM_BB_ANT_DIV)) -+ return; -+ -+ if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) -+ return; -+ -+ if (dm->support_ic_type == (ODM_RTL8723B | ODM_RTL8721D)) { -+#if (RTL8723B_SUPPORT == 1 || RTL8721D_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_8723B(desc, fat_tab->antsel_a[mac_id]); -+/*PHYDM_DBG(dm,DBG_ANT_DIV, -+ * "[8723B] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", -+ * mac_id, fat_tab->antsel_c[mac_id], fat_tab->antsel_b[mac_id], -+ * fat_tab->antsel_a[mac_id]); -+ */ -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8821) { -+#if (RTL8821A_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_8812(desc, fat_tab->antsel_a[mac_id]); -+/*PHYDM_DBG(dm,DBG_ANT_DIV, -+ * "[8821A] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", -+ * mac_id, fat_tab->antsel_c[mac_id], fat_tab->antsel_b[mac_id], -+ * fat_tab->antsel_a[mac_id]); -+ */ -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8188E) { -+#if (RTL8188E_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_88E(desc, fat_tab->antsel_a[mac_id]); -+ SET_TX_DESC_ANTSEL_B_88E(desc, fat_tab->antsel_b[mac_id]); -+ SET_TX_DESC_ANTSEL_C_88E(desc, fat_tab->antsel_c[mac_id]); -+/*PHYDM_DBG(dm,DBG_ANT_DIV, -+ * "[8188E] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", -+ * mac_id, fat_tab->antsel_c[mac_id], fat_tab->antsel_b[mac_id], -+ * fat_tab->antsel_a[mac_id]); -+ */ -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8821C) { -+#if (RTL8821C_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_8821C(desc, fat_tab->antsel_a[mac_id]); -+/*PHYDM_DBG(dm,DBG_ANT_DIV, -+ * "[8821C] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", -+ * mac_id, fat_tab->antsel_c[mac_id], fat_tab->antsel_b[mac_id], -+ * fat_tab->antsel_a[mac_id]); -+ */ -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8195B) { -+#if (RTL8195B_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_8195B(desc, fat_tab->antsel_a[mac_id]); -+#endif -+ } else if (dm->support_ic_type == ODM_RTL8822B) { -+#if (RTL8822B_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_8822B(desc, fat_tab->antsel_a[mac_id]); -+#endif -+ -+ } -+} -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+void odm_set_tx_ant_by_tx_info( -+ struct rtl8192cd_priv *priv, -+ struct tx_desc *pdesc, -+ unsigned short aid) -+{ -+ struct dm_struct *dm = GET_PDM_ODM(priv); /*@&(priv->pshare->_dmODM);*/ -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ -+ if (!(dm->support_ability & ODM_BB_ANT_DIV)) -+ return; -+ -+ if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) -+ return; -+ -+ if (dm->support_ic_type == ODM_RTL8881A) { -+#if 0 -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__); */ -+#endif -+ pdesc->Dword6 &= set_desc(~(BIT(18) | BIT(17) | BIT(16))); -+ pdesc->Dword6 |= set_desc(fat_tab->antsel_a[aid] << 16); -+ } else if (dm->support_ic_type == ODM_RTL8192E) { -+#if 0 -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8192E******\n",__FUNCTION__,__LINE__); */ -+#endif -+ pdesc->Dword6 &= set_desc(~(BIT(18) | BIT(17) | BIT(16))); -+ pdesc->Dword6 |= set_desc(fat_tab->antsel_a[aid] << 16); -+ } else if (dm->support_ic_type == ODM_RTL8197F) { -+#if 0 -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8192E******\n",__FUNCTION__,__LINE__); */ -+#endif -+ pdesc->Dword6 &= set_desc(~(BIT(17) | BIT(16))); -+ pdesc->Dword6 |= set_desc(fat_tab->antsel_a[aid] << 16); -+ } else if (dm->support_ic_type == ODM_RTL8822B) { -+ pdesc->Dword6 &= set_desc(~(BIT(17) | BIT(16))); -+ pdesc->Dword6 |= set_desc(fat_tab->antsel_a[aid] << 16); -+ } else if (dm->support_ic_type == ODM_RTL8188E) { -+#if 0 -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8188E******\n",__FUNCTION__,__LINE__);*/ -+#endif -+ pdesc->Dword2 &= set_desc(~BIT(24)); -+ pdesc->Dword2 &= set_desc(~BIT(25)); -+ pdesc->Dword7 &= set_desc(~BIT(29)); -+ -+ pdesc->Dword2 |= set_desc(fat_tab->antsel_a[aid] << 24); -+ pdesc->Dword2 |= set_desc(fat_tab->antsel_b[aid] << 25); -+ pdesc->Dword7 |= set_desc(fat_tab->antsel_c[aid] << 29); -+ -+ } else if (dm->support_ic_type == ODM_RTL8812) { -+ /*@[path-A]*/ -+#if 0 -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__);*/ -+#endif -+ -+ pdesc->Dword6 &= set_desc(~BIT(16)); -+ pdesc->Dword6 &= set_desc(~BIT(17)); -+ pdesc->Dword6 &= set_desc(~BIT(18)); -+ -+ pdesc->Dword6 |= set_desc(fat_tab->antsel_a[aid] << 16); -+ pdesc->Dword6 |= set_desc(fat_tab->antsel_b[aid] << 17); -+ pdesc->Dword6 |= set_desc(fat_tab->antsel_c[aid] << 18); -+ } -+} -+ -+#if 1 /*@def CONFIG_WLAN_HAL*/ -+void odm_set_tx_ant_by_tx_info_hal( -+ struct rtl8192cd_priv *priv, -+ void *pdesc_data, -+ u16 aid) -+{ -+ struct dm_struct *dm = GET_PDM_ODM(priv); /*@&(priv->pshare->_dmODM);*/ -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ PTX_DESC_DATA_88XX pdescdata = (PTX_DESC_DATA_88XX)pdesc_data; -+ -+ if (!(dm->support_ability & ODM_BB_ANT_DIV)) -+ return; -+ -+ if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) -+ return; -+ -+ if (dm->support_ic_type & (ODM_RTL8881A | ODM_RTL8192E | ODM_RTL8814A | -+ ODM_RTL8197F | ODM_RTL8822B)) { -+#if 0 -+ /*panic_printk("[%s] [%d] **odm_set_tx_ant_by_tx_info_hal**\n", -+ * __FUNCTION__,__LINE__); -+ */ -+#endif -+ pdescdata->ant_sel = 1; -+ pdescdata->ant_sel_a = fat_tab->antsel_a[aid]; -+ } -+} -+#endif /*@#ifdef CONFIG_WLAN_HAL*/ -+ -+#endif -+ -+void odm_ant_div_config(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ PHYDM_DBG(dm, DBG_ANT_DIV, "WIN Config Antenna Diversity\n"); -+ /*@ -+ if(dm->support_ic_type==ODM_RTL8723B) -+ { -+ if((!dm->swat_tab.ANTA_ON || !dm->swat_tab.ANTB_ON)) -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ } -+ */ -+ #if (defined(CONFIG_2T3R_ANTENNA)) -+ #if (RTL8822B_SUPPORT == 1) -+ dm->rfe_type = ANT_2T3R_RFE_TYPE; -+ #endif -+ #endif -+ -+ #if (defined(CONFIG_2T4R_ANTENNA)) -+ #if (RTL8822B_SUPPORT == 1) -+ dm->rfe_type = ANT_2T4R_RFE_TYPE; -+ #endif -+ #endif -+ -+ if (dm->support_ic_type == ODM_RTL8723D) -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "CE Config Antenna Diversity\n"); -+ -+ if (dm->support_ic_type == ODM_RTL8723B) -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ -+ if (dm->support_ic_type == ODM_RTL8723D) -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "IOT Config Antenna Diversity\n"); -+ -+ if (dm->support_ic_type == ODM_RTL8721D) -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ if (dm->support_ic_type == ODM_RTL8710C){ -+ if(dm->cut_version > ODM_CUT_C) -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ else -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ } -+ -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "AP Config Antenna Diversity\n"); -+ -+ /* @2 [ NOT_SUPPORT_ANTDIV ] */ -+#if (defined(CONFIG_NOT_SUPPORT_ANTDIV)) -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Disable AntDiv function] : Not Support 2.4G & 5G Antenna Diversity\n"); -+ -+ /* @2 [ 2G&5G_SUPPORT_ANTDIV ] */ -+#elif (defined(CONFIG_2G5G_SUPPORT_ANTDIV)) -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Enable AntDiv function] : 2.4G & 5G Support Antenna Diversity Simultaneously\n"); -+ fat_tab->ant_div_2g_5g = (ODM_ANTDIV_2G | ODM_ANTDIV_5G); -+ -+ if (dm->support_ic_type & ODM_ANTDIV_SUPPORT) -+ dm->support_ability |= ODM_BB_ANT_DIV; -+ if (*dm->band_type == ODM_BAND_5G) { -+ #if (defined(CONFIG_5G_CGCS_RX_DIVERSITY)) -+ dm->ant_div_type = CGCS_RX_HW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 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)) -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 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)) -+ dm->ant_div_type = CG_TRX_SMART_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 5G] : AntDiv type = CG_SMART_ANTDIV\n"); -+ #elif (defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY)) -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 5G] : AntDiv type = S0S1_SW_ANTDIV\n"); -+ #endif -+ } else if (*dm->band_type == ODM_BAND_2_4G) { -+ #if (defined(CONFIG_2G_CGCS_RX_DIVERSITY)) -+ dm->ant_div_type = CGCS_RX_HW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 2.4G] : AntDiv type = CGCS_RX_HW_ANTDIV\n"); -+ #elif (defined(CONFIG_2G_CG_TRX_DIVERSITY) ||\ -+ defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 2.4G] : AntDiv type = CG_TRX_HW_ANTDIV\n"); -+ #elif (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ dm->ant_div_type = CG_TRX_SMART_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 2.4G] : AntDiv type = CG_SMART_ANTDIV\n"); -+ #elif (defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY)) -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 2.4G] : AntDiv type = S0S1_SW_ANTDIV\n"); -+ #endif -+ } -+ -+ /* @2 [ 5G_SUPPORT_ANTDIV ] */ -+#elif (defined(CONFIG_5G_SUPPORT_ANTDIV)) -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n"); -+ panic_printk("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n"); -+ fat_tab->ant_div_2g_5g = (ODM_ANTDIV_5G); -+ if (*dm->band_type == ODM_BAND_5G) { -+ if (dm->support_ic_type & ODM_ANTDIV_5G_SUPPORT_IC) -+ dm->support_ability |= ODM_BB_ANT_DIV; -+ #if (defined(CONFIG_5G_CGCS_RX_DIVERSITY)) -+ dm->ant_div_type = CGCS_RX_HW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 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)) -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ panic_printk("[ 5G] : AntDiv type = CG_TRX_HW_ANTDIV\n"); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 5G] : AntDiv type = CG_TRX_HW_ANTDIV\n"); -+ #elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) -+ dm->ant_div_type = CG_TRX_SMART_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 5G] : AntDiv type = CG_SMART_ANTDIV\n"); -+ #elif (defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY)) -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 5G] : AntDiv type = S0S1_SW_ANTDIV\n"); -+ #endif -+ } else if (*dm->band_type == ODM_BAND_2_4G) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Not Support 2G ant_div_type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ } -+ -+ /* @2 [ 2G_SUPPORT_ANTDIV ] */ -+#elif (defined(CONFIG_2G_SUPPORT_ANTDIV)) -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Enable AntDiv function] : Only 2.4G Support Antenna Diversity\n"); -+ fat_tab->ant_div_2g_5g = (ODM_ANTDIV_2G); -+ if (*dm->band_type == ODM_BAND_2_4G) { -+ if (dm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC) -+ dm->support_ability |= ODM_BB_ANT_DIV; -+ #if (defined(CONFIG_2G_CGCS_RX_DIVERSITY)) -+ dm->ant_div_type = CGCS_RX_HW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 2.4G] : AntDiv type = CGCS_RX_HW_ANTDIV\n"); -+ #elif (defined(CONFIG_2G_CG_TRX_DIVERSITY)) -+ dm->ant_div_type = CG_TRX_HW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 2.4G] : AntDiv type = CG_TRX_HW_ANTDIV\n"); -+ #elif (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ dm->ant_div_type = CG_TRX_SMART_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 2.4G] : AntDiv type = CG_SMART_ANTDIV\n"); -+ #elif (defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY)) -+ dm->ant_div_type = S0S1_SW_ANTDIV; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ 2.4G] : AntDiv type = S0S1_SW_ANTDIV\n"); -+ #endif -+ } else if (*dm->band_type == ODM_BAND_5G) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Not Support 5G ant_div_type\n"); -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ } -+#endif -+ -+ if (!(dm->support_ic_type & ODM_ANTDIV_SUPPORT_IC)) { -+ fat_tab->ant_div_2g_5g = 0; -+ dm->support_ability &= ~(ODM_BB_ANT_DIV); -+ } -+#endif -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[AntDiv Config Info] AntDiv_SupportAbility = (( %x ))\n", -+ ((dm->support_ability & ODM_BB_ANT_DIV) ? 1 : 0)); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[AntDiv Config Info] be_fix_tx_ant = ((%d))\n", -+ dm->dm_fat_table.b_fix_tx_ant); -+} -+ -+void odm_ant_div_timers(void *dm_void, u8 state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ if (state == INIT_ANTDIV_TIMMER) { -+#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_initialize_timer(dm, -+ &dm->dm_swat_table.sw_antdiv_timer, -+ (void *)odm_sw_antdiv_callback, NULL, -+ "sw_antdiv_timer"); -+#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ -+ (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ odm_initialize_timer(dm, &dm->fast_ant_training_timer, -+ (void *)odm_fast_ant_training_callback, -+ NULL, "fast_ant_training_timer"); -+#endif -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ odm_initialize_timer(dm, &dm->evm_fast_ant_training_timer, -+ (void *)phydm_evm_antdiv_callback, NULL, -+ "evm_fast_ant_training_timer"); -+#endif -+ } else if (state == CANCEL_ANTDIV_TIMMER) { -+#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_cancel_timer(dm, -+ &dm->dm_swat_table.sw_antdiv_timer); -+#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ -+ (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ odm_cancel_timer(dm, &dm->fast_ant_training_timer); -+#endif -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ odm_cancel_timer(dm, &dm->evm_fast_ant_training_timer); -+#endif -+ } else if (state == RELEASE_ANTDIV_TIMMER) { -+#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_release_timer(dm, -+ &dm->dm_swat_table.sw_antdiv_timer); -+#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ -+ (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ odm_release_timer(dm, &dm->fast_ant_training_timer); -+#endif -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ odm_release_timer(dm, &dm->evm_fast_ant_training_timer); -+#endif -+ } -+} -+ -+void phydm_antdiv_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 dm_value[10] = {0}; -+ char help[] = "-h"; -+ u8 i, input_idx = 0; -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{1} {0:auto, 1:fix main, 2:fix auto}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{2} {antdiv_period}\n"); -+ #if (RTL8821C_SUPPORT == 1) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{3} {en} {0:Default, 1:HW_Div, 2:SW_Div}\n"); -+ #endif -+ -+ } else if (dm_value[0] == 1) { -+ /*@fixed or auto antenna*/ -+ if (dm_value[1] == 0) { -+ dm->ant_type = ODM_AUTO_ANT; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "AntDiv: Auto\n"); -+ } else if (dm_value[1] == 1) { -+ dm->ant_type = ODM_FIX_MAIN_ANT; -+ -+ #if (RTL8710C_SUPPORT == 1) -+ dm->antdiv_select = 1; -+ #endif -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "AntDiv: Fix Main\n"); -+ } else if (dm_value[1] == 2) { -+ dm->ant_type = ODM_FIX_AUX_ANT; -+ -+ #if (RTL8710C_SUPPORT == 1) -+ dm->antdiv_select = 2; -+ #endif -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "AntDiv: Fix Aux\n"); -+ } -+ -+ if (dm->ant_type != ODM_AUTO_ANT) { -+ odm_stop_antenna_switch_dm(dm); -+ if (dm->ant_type == ODM_FIX_MAIN_ANT) -+ odm_update_rx_idle_ant(dm, MAIN_ANT); -+ else if (dm->ant_type == ODM_FIX_AUX_ANT) -+ odm_update_rx_idle_ant(dm, AUX_ANT); -+ } else { -+ phydm_enable_antenna_diversity(dm); -+ } -+ dm->pre_ant_type = dm->ant_type; -+ } else if (dm_value[0] == 2) { -+ /*@dynamic period for AntDiv*/ -+ dm->antdiv_period = (u8)dm_value[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "AntDiv_period=((%d))\n", dm->antdiv_period); -+ } -+ #if (RTL8821C_SUPPORT == 1) -+ else if (dm_value[0] == 3 && -+ dm->support_ic_type == ODM_RTL8821C) { -+ /*Only for 8821C*/ -+ if (dm_value[1] == 0) { -+ fat_tab->force_antdiv_type = false; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[8821C] AntDiv: Default\n"); -+ } else if (dm_value[1] == 1) { -+ fat_tab->force_antdiv_type = true; -+ fat_tab->antdiv_type_dbg = CG_TRX_HW_ANTDIV; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[8821C] AntDiv: HW diversity\n"); -+ } else if (dm_value[1] == 2) { -+ fat_tab->force_antdiv_type = true; -+ fat_tab->antdiv_type_dbg = S0S1_SW_ANTDIV; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[8821C] AntDiv: SW diversity\n"); -+ } -+ } -+ #endif -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ else if (dm_value[0] == 4) { -+ if (dm_value[1] == 0) { -+ /*@init parameters for EVM AntDiv*/ -+ phydm_evm_sw_antdiv_init(dm); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "init evm antdiv parameters\n"); -+ } else if (dm_value[1] == 1) { -+ /*training number for EVM AntDiv*/ -+ dm->antdiv_train_num = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "antdiv_train_num = ((%d))\n", -+ dm->antdiv_train_num); -+ } else if (dm_value[1] == 2) { -+ /*training interval for EVM AntDiv*/ -+ dm->antdiv_intvl = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "antdiv_intvl = ((%d))\n", -+ dm->antdiv_intvl); -+ } else if (dm_value[1] == 3) { -+ /*@function period for EVM AntDiv*/ -+ dm->evm_antdiv_period = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "evm_antdiv_period = ((%d))\n", -+ dm->evm_antdiv_period); -+ } else if (dm_value[1] == 100) {/*show parameters*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "ant_type = ((%d))\n", dm->ant_type); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "antdiv_train_num = ((%d))\n", -+ dm->antdiv_train_num); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "antdiv_intvl = ((%d))\n", -+ dm->antdiv_intvl); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "evm_antdiv_period = ((%d))\n", -+ dm->evm_antdiv_period); -+ } -+ } -+ #ifdef CONFIG_2T4R_ANTENNA -+ else if (dm_value[0] == 5) { /*Only for 8822B 2T4R case*/ -+ -+ if (dm_value[1] == 0) { -+ dm->ant_type2 = ODM_AUTO_ANT; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "AntDiv: PathB Auto\n"); -+ } else if (dm_value[1] == 1) { -+ dm->ant_type2 = ODM_FIX_MAIN_ANT; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "AntDiv: PathB Fix Main\n"); -+ } else if (dm_value[1] == 2) { -+ dm->ant_type2 = ODM_FIX_AUX_ANT; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "AntDiv: PathB Fix Aux\n"); -+ } -+ -+ if (dm->ant_type2 != ODM_AUTO_ANT) { -+ odm_stop_antenna_switch_dm(dm); -+ if (dm->ant_type2 == ODM_FIX_MAIN_ANT) -+ phydm_update_rx_idle_ant_pathb(dm, MAIN_ANT); -+ else if (dm->ant_type2 == ODM_FIX_AUX_ANT) -+ phydm_update_rx_idle_ant_pathb(dm, AUX_ANT); -+ } else { -+ phydm_enable_antenna_diversity(dm); -+ } -+ dm->pre_ant_type2 = dm->ant_type2; -+ } -+ #endif -+ #endif -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void odm_ant_div_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ability & ODM_BB_ANT_DIV)) -+ return; -+ -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ if (dm->ant_div_type == S0S1_SW_ANTDIV) -+ odm_s0s1_sw_ant_div_reset(dm); -+ #endif -+} -+ -+void odm_antenna_diversity_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_ant_div_config(dm); -+ odm_ant_div_init(dm); -+} -+ -+void odm_antenna_diversity(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (*dm->mp_mode) -+ return; -+ -+ if (!(dm->support_ability & ODM_BB_ANT_DIV)) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Return!!!] Not Support Antenna Diversity Function\n"); -+ return; -+ } -+ -+ if (dm->pause_ability & ODM_BB_ANT_DIV) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Return: Pause AntDIv in LV=%d\n", -+ dm->pause_lv_table.lv_antdiv); -+ return; -+ } -+ -+ odm_ant_div(dm); -+} -+#endif /*@#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdiv.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdiv.h -new file mode 100644 -index 000000000..f68bbdb25 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_antdiv.h -@@ -0,0 +1,547 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#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 */ -+#define ANTDIV_VERSION "4.0" /*@2017.05.25 Mark, Add SW antenna diversity*/ -+ /*@for 8821c because HW transient issue */ -+ -+/* @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 SUPPORT_BEAM_SET_PATTERN_NUM 16 -+ -+#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 |\ -+ ODM_RTL8197F | ODM_RTL8721D | ODM_RTL8710C) -+#define ODM_AC_ANTDIV_SUPPORT (ODM_RTL8821 | ODM_RTL8881A | ODM_RTL8812 |\ -+ ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8814B |\ -+ ODM_RTL8195B | ODM_RTL8814C) -+#define ODM_JGR3_ANTDIV_SUPPORT (ODM_RTL8197G | ODM_RTL8723F) -+#define ODM_ANTDIV_SUPPORT (ODM_N_ANTDIV_SUPPORT | ODM_AC_ANTDIV_SUPPORT |\ -+ ODM_JGR3_ANTDIV_SUPPORT) -+#define ODM_SMART_ANT_SUPPORT (ODM_RTL8188E | ODM_RTL8192E) -+#define ODM_HL_SMART_ANT_TYPE1_SUPPORT (ODM_RTL8821 | ODM_RTL8822B) -+ -+#define ODM_ANTDIV_2G_SUPPORT_IC (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8723B |\ -+ ODM_RTL8881A | ODM_RTL8188F | ODM_RTL8723D |\ -+ ODM_RTL8197F | ODM_RTL8197G|ODM_RTL8723F) -+#define ODM_ANTDIV_5G_SUPPORT_IC (ODM_RTL8821 | ODM_RTL8881A | ODM_RTL8812 |\ -+ ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8195B|ODM_RTL8723F) -+ -+#define ODM_ANTDIV_SUPPORT_IC (ODM_ANTDIV_2G_SUPPORT_IC | ODM_ANTDIV_5G_SUPPORT_IC) -+ -+#define ODM_EVM_ANTDIV_IC (ODM_RTL8192E | ODM_RTL8197F | ODM_RTL8822B |\ -+ ODM_RTL8197G) -+ -+#define ODM_ANTDIV_2G BIT(0) -+#define ODM_ANTDIV_5G BIT(1) -+ -+#define ANTDIV_ON 1 -+#define ANTDIV_OFF 0 -+ -+#define ANT_PATH_A 0 -+#define ANT_PATH_B 1 -+#define ANT_PATH_AB 2 -+ -+#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 TP_METHOD 3 -+ -+#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 HT_IDX 16 -+#define VHT_IDX 20 -+ -+#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 -+ -+#if (RTL8723D_SUPPORT == 1 || RTL8710C_SUPPORT == 1) -+ #ifndef CONFIG_ANTDIV_PERIOD -+ #define CONFIG_ANTDIV_PERIOD 1 -+ #endif -+#endif -+/* @1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+ -+ -+struct sw_antenna_switch { -+ u8 double_chk_flag; -+ /*@If current antenna RSSI > "RSSI_CHECK_THRESHOLD", than*/ -+ /*@check this antenna again*/ -+ u8 try_flag; -+ s32 pre_rssi; -+ u8 cur_antenna; -+ u8 pre_ant; -+ u8 rssi_trying; -+ u8 reset_idx; -+ u8 train_time; -+ u8 train_time_flag; -+ /*@base on RSSI difference between two antennas*/ -+ struct phydm_timer_list sw_antdiv_timer; -+ u32 pkt_cnt_sw_ant_div_by_ctrl_frame; -+ boolean is_sw_ant_div_by_ctrl_frame; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if USE_WORKITEM -+ RT_WORK_ITEM phydm_sw_antenna_switch_workitem; -+#endif -+#endif -+ -+ /* @AntDect (Before link Antenna Switch check) need to be moved*/ -+ u16 single_ant_counter; -+ u16 dual_ant_counter; -+ u16 aux_fail_detec_counter; -+ u16 retry_counter; -+ u8 swas_no_link_state; -+ u32 swas_no_link_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_fail_detec; -+ boolean rssi_ant_dect_result; -+ u8 ant_5g; -+ u8 ant_2g; -+}; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+struct _BF_DIV_COEX_ { -+ boolean w_bfer_client[ODM_ASSOCIATE_ENTRY_NUM]; -+ boolean w_bfee_client[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 MA_rx_TP[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 MA_rx_TP_DIV[ODM_ASSOCIATE_ENTRY_NUM]; -+ -+ u8 bd_ccoex_type_wbfer; -+ u8 num_txbfee_client; -+ u8 num_txbfer_client; -+ u8 bdc_try_counter; -+ u8 bdc_hold_counter; -+ u8 bdc_mode; -+ u8 bdc_active_mode; -+ u8 BDC_state; -+ u8 bdc_rx_idle_update_counter; -+ u8 num_client; -+ u8 pre_num_client; -+ u8 num_bf_tar; -+ u8 num_div_tar; -+ -+ boolean is_all_div_sta_idle; -+ boolean is_all_bf_sta_idle; -+ boolean bdc_try_flag; -+ boolean BF_pass; -+ boolean DIV_pass; -+}; -+#endif -+#endif -+ -+struct phydm_fat_struct { -+ u8 bssid[6]; -+ u8 antsel_rx_keep_0; -+ u8 antsel_rx_keep_1; -+ u8 antsel_rx_keep_2; -+ u8 antsel_rx_keep_3; -+ u32 ant_sum_rssi[7]; -+ u32 ant_rssi_cnt[7]; -+ u32 ant_ave_rssi[7]; -+ u8 fat_state; -+ u8 fat_state_cnt; -+ u32 train_idx; -+ u8 antsel_a[ODM_ASSOCIATE_ENTRY_NUM]; -+ u8 antsel_b[ODM_ASSOCIATE_ENTRY_NUM]; -+ u8 antsel_c[ODM_ASSOCIATE_ENTRY_NUM]; -+ u16 main_ht_cnt[HT_IDX]; -+ u16 aux_ht_cnt[HT_IDX]; -+ u16 main_vht_cnt[VHT_IDX]; -+ u16 aux_vht_cnt[VHT_IDX]; -+ u16 main_sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u16 aux_sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u16 main_cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u16 aux_cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u16 main_sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; -+ u16 aux_sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; -+ u16 main_cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; -+ u16 aux_cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; -+ u8 rx_idle_ant; -+ u8 rx_idle_ant2; -+ u32 rvrt_val; /*all rvrt_val for pause API must set to u32*/ -+ u8 ant_div_on_off; -+ u8 div_path_type; -+ boolean is_become_linked; -+ boolean get_stats; -+ u32 min_max_rssi; -+ u8 idx_ant_div_counter_2g; -+ u8 idx_ant_div_counter_5g; -+ u8 ant_div_2g_5g; -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ /*@For 1SS RX phy rate*/ -+ u32 main_evm_sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 aux_evm_sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 main_evm_cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 aux_evm_cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ -+ /*@For 2SS RX phy rate*/ -+ u32 main_evm_2ss_sum[ODM_ASSOCIATE_ENTRY_NUM][2];/*@2SS with A1+B*/ -+ u32 aux_evm_2ss_sum[ODM_ASSOCIATE_ENTRY_NUM][2];/*@2SS with A2+B*/ -+ u32 main_evm_2ss_cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 aux_evm_2ss_cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ -+ boolean evm_method_enable; -+ u8 target_ant_evm; -+ u8 target_ant_crc32; -+ u8 target_ant_tp; -+ u8 target_ant_enhance; -+ u8 pre_target_ant_enhance; -+ u16 main_mpdu_ok_cnt; -+ u16 aux_mpdu_ok_cnt; -+ -+ u32 crc32_ok_cnt; -+ u32 crc32_fail_cnt; -+ u32 main_crc32_ok_cnt; -+ u32 aux_crc32_ok_cnt; -+ u32 main_crc32_fail_cnt; -+ u32 aux_crc32_fail_cnt; -+ -+ u32 main_tp; -+ u32 aux_tp; -+ u32 main_tp_cnt; -+ u32 aux_tp_cnt; -+ -+ u8 pre_antdiv_rssi; -+ u8 pre_antdiv_tp; -+#endif -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) -+ u32 cck_ctrl_frame_cnt_main; -+ u32 cck_ctrl_frame_cnt_aux; -+ u32 ofdm_ctrl_frame_cnt_main; -+ u32 ofdm_ctrl_frame_cnt_aux; -+ u32 main_ctrl_sum; -+ u32 aux_ctrl_sum; -+ u32 main_ctrl_cnt; -+ u32 aux_ctrl_cnt; -+#endif -+ -+ u8 b_fix_tx_ant; -+ boolean fix_ant_bfee; -+ boolean enable_ctrl_frame_antdiv; -+ boolean use_ctrl_frame_antdiv; -+ boolean *is_no_csi_feedback; -+ boolean force_antdiv_type; -+ u8 antdiv_type_dbg; -+ u8 hw_antsw_occur; -+ u8 *p_force_tx_by_desc; -+ u8 force_tx_by_desc; -+ /*@A temp value, will hook to driver team's outer parameter later*/ -+ u8 *p_default_s0_s1; -+ u8 default_s0_s1; -+ u8 ant_idx_vec[3]; /* for SP3T only, added by Jiao Qi on June.6,2020*/ -+ -+ -+}; -+ -+/* @1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ */ -+ -+enum fat_state /*@Fast antenna training*/ -+{ -+ FAT_BEFORE_LINK_STATE = 0, -+ FAT_PREPARE_STATE = 1, -+ FAT_TRAINING_STATE = 2, -+ FAT_DECISION_STATE = 3 -+}; -+ -+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*/ -+ HL_SW_SMART_ANT_TYPE2 = 0x11 -+ /*@Hong-Bo Smart antenna use for 8822B which is a 2 ant. entitys*/ -+}; -+ -+/* @1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ */ -+ -+void odm_stop_antenna_switch_dm(void *dm_void); -+ -+void phydm_enable_antenna_diversity(void *dm_void); -+ -+void odm_set_ant_config(void *dm_void, u8 ant_setting /* @0=A, 1=B, 2=C,....*/ -+ ); -+ -+#define sw_ant_div_rest_after_link odm_sw_ant_div_rest_after_link -+ -+void odm_sw_ant_div_rest_after_link(void *dm_void); -+ -+void odm_ant_div_on_off(void *dm_void, u8 swch, u8 path); -+ -+void odm_tx_by_tx_desc_or_reg(void *dm_void, u8 swch); -+ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ -+void phydm_antdiv_reset_statistic(void *dm_void, u32 macid); -+ -+void odm_update_rx_idle_ant(void *dm_void, u8 ant); -+ -+void odm_update_rx_idle_ant_sp3t(void *dm_void, u8 ant); -+ -+void phydm_update_rx_idle_ant_pathb(void *dm_void, u8 ant); -+ -+void phydm_set_antdiv_val(void *dm_void, u32 *val_buf, u8 val_len); -+ -+#if (RTL8723B_SUPPORT == 1) -+void odm_update_rx_idle_ant_8723b(void *dm_void, u8 ant, u32 default_ant, -+ u32 optional_ant); -+#endif -+ -+#if (RTL8188F_SUPPORT == 1) -+void phydm_update_rx_idle_antenna_8188F(void *dm_void, u32 default_ant); -+#endif -+ -+#if (RTL8723D_SUPPORT == 1) -+ -+void phydm_set_tx_ant_pwr_8723d(void *dm_void, u8 ant); -+ -+void odm_update_rx_idle_ant_8723d(void *dm_void, u8 ant, u32 default_ant, -+ u32 optional_ant); -+ -+#endif -+ -+#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void odm_sw_antdiv_callback(struct phydm_timer_list *timer); -+ -+void odm_sw_antdiv_workitem_callback(void *context); -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+void odm_sw_antdiv_workitem_callback(void *context); -+ -+void odm_sw_antdiv_callback(void *function_context); -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ -+void odm_sw_antdiv_callback(void *dm_void); -+ -+#endif -+ -+void odm_s0s1_sw_ant_div_by_ctrl_frame(void *dm_void, u8 step); -+ -+void odm_antsel_statistics_ctrl(void *dm_void, u8 antsel_tr_mux, -+ u32 rx_pwdb_all); -+ -+void odm_s0s1_sw_ant_div_by_ctrl_frame_process_rssi(void *dm_void, -+ void *phy_info_void, -+ void *pkt_info_void); -+ -+#endif -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+void phydm_evm_sw_antdiv_init(void *dm_void); -+ -+void phydm_rx_rate_for_antdiv(void *dm_void, void *pkt_info_void); -+ -+void phydm_antdiv_reset_rx_rate(void *dm_void); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_evm_antdiv_callback(struct phydm_timer_list *timer); -+ -+void phydm_evm_antdiv_workitem_callback(void *context); -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+void phydm_evm_antdiv_callback(void *dm_void); -+ -+void phydm_evm_antdiv_workitem_callback(void *context); -+ -+#else -+void phydm_evm_antdiv_callback(void *dm_void); -+#endif -+ -+#endif -+ -+void odm_hw_ant_div(void *dm_void); -+ -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ -+ (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+void odm_fast_ant_training( -+ void *dm_void); -+ -+void odm_fast_ant_training_callback(void *dm_void); -+ -+void odm_fast_ant_training_work_item_callback(void *dm_void); -+#endif -+ -+void odm_ant_div_init(void *dm_void); -+ -+void odm_ant_div(void *dm_void); -+ -+void odm_antsel_statistics(void *dm_void, void *phy_info_void, -+ u8 antsel_tr_mux, u32 mac_id, u32 utility, u8 method, -+ u8 is_cck_rate); -+ -+void odm_process_rssi_for_ant_div(void *dm_void, void *phy_info_void, -+ void *pkt_info_void); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+void odm_set_tx_ant_by_tx_info(void *dm_void, u8 *desc, u8 mac_id); -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+struct tx_desc; -+/*@declared tx_desc here or compile error happened when enabled 8822B*/ -+ -+void odm_set_tx_ant_by_tx_info(struct rtl8192cd_priv *priv, -+ struct tx_desc *pdesc, unsigned short aid); -+ -+#if 1 /*@def def CONFIG_WLAN_HAL*/ -+void odm_set_tx_ant_by_tx_info_hal(struct rtl8192cd_priv *priv, -+ void *pdesc_data, u16 aid); -+#endif /*@#ifdef CONFIG_WLAN_HAL*/ -+#endif -+ -+void odm_ant_div_config(void *dm_void); -+ -+void odm_ant_div_timers(void *dm_void, u8 state); -+ -+void phydm_antdiv_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void odm_ant_div_reset(void *dm_void); -+ -+void odm_antenna_diversity_init(void *dm_void); -+ -+void odm_antenna_diversity(void *dm_void); -+#endif /*@#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY*/ -+#endif /*@#ifndef __ODMANTDIV_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_api.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_api.c -new file mode 100644 -index 000000000..349f35744 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_api.c -@@ -0,0 +1,3768 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ * ************************************************************ -+ */ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+enum channel_width phydm_rxsc_2_bw(void *dm_void, u8 rxsc) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ enum channel_width bw = 0; -+ -+ /* @Check RX bandwidth */ -+ if (rxsc == 0) -+ bw = *dm->band_width; /*@full bw*/ -+ else if (rxsc >= 1 && rxsc <= 8) -+ bw = CHANNEL_WIDTH_20; -+ else if (rxsc >= 9 && rxsc <= 12) -+ bw = CHANNEL_WIDTH_40; -+ else /*if (rxsc >= 13)*/ -+ bw = CHANNEL_WIDTH_80; -+ -+ return bw; -+} -+ -+void phydm_reset_bb_hw_cnt(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /*@ Reset all counter when 1 */ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ #if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ odm_set_bb_reg(dm, R_0x2a44, BIT(21), 0); -+ odm_set_bb_reg(dm, R_0x2a44, BIT(21), 1); -+ } -+ #endif -+ odm_set_bb_reg(dm, R_0x1eb4, BIT(25), 1); -+ odm_set_bb_reg(dm, R_0x1eb4, BIT(25), 0); -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ /*@ Reset all counter when 1 (including PMAC and PHY)*/ -+ /* Reset Page F counter*/ -+ odm_set_bb_reg(dm, R_0xb58, BIT(0), 1); -+ odm_set_bb_reg(dm, R_0xb58, BIT(0), 0); -+ } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ odm_set_bb_reg(dm, R_0xf14, BIT(16), 0x1); -+ odm_set_bb_reg(dm, R_0xf14, BIT(16), 0x0); -+ } -+} -+ -+void phydm_dynamic_ant_weighting(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#ifdef DYN_ANT_WEIGHTING_SUPPORT -+ #if (RTL8197F_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8197F)) -+ phydm_dynamic_ant_weighting_8197f(dm); -+ #endif -+ -+ #if (RTL8812A_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8812)) { -+ phydm_dynamic_ant_weighting_8812a(dm); -+ } -+ #endif -+ -+ #if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8822B)) -+ phydm_dynamic_ant_weighting_8822b(dm); -+ #endif -+#endif -+} -+ -+#ifdef DYN_ANT_WEIGHTING_SUPPORT -+void phydm_ant_weight_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ if (!(dm->support_ic_type & -+ (ODM_RTL8192F | ODM_RTL8822B | ODM_RTL8812 | ODM_RTL8197F))) { -+ return; -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "echo dis_dym_ant_weighting {0/1}\n"); -+ -+ } else { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if (var1[0] == 1) { -+ dm->is_disable_dym_ant_weighting = 1; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Disable dyn-ant-weighting\n"); -+ } else { -+ dm->is_disable_dym_ant_weighting = 0; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Enable dyn-ant-weighting\n"); -+ } -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -+ -+void phydm_trx_antenna_setting_init(void *dm_void, u8 num_rf_path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rx_ant = 0, tx_ant = 0; -+ u8 path_bitmap = 1; -+ -+ path_bitmap = (u8)phydm_gen_bitmask(num_rf_path); -+ -+ /*PHYDM_DBG(dm, ODM_COMP_INIT, "path_bitmap=0x%x\n", path_bitmap);*/ -+ -+ dm->tx_ant_status = path_bitmap; -+ dm->rx_ant_status = path_bitmap; -+ -+ if (num_rf_path == PDM_1SS) -+ return; -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & -+ (ODM_RTL8192F | ODM_RTL8192E | ODM_RTL8197F)) { -+ dm->rx_ant_status = (u8)odm_get_bb_reg(dm, R_0xc04, 0x3); -+ dm->tx_ant_status = (u8)odm_get_bb_reg(dm, R_0x90c, 0x3); -+ } else if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8814A)) { -+ dm->rx_ant_status = (u8)odm_get_bb_reg(dm, R_0x808, 0xf); -+ dm->tx_ant_status = (u8)odm_get_bb_reg(dm, R_0x80c, 0xf); -+ } -+ #endif -+ /* @trx_ant_status are already updated in trx mode API in JGR3 ICs */ -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "[%s]ant_status{tx,rx}={0x%x, 0x%x}\n", -+ __func__, dm->tx_ant_status, dm->rx_ant_status); -+} -+ -+void phydm_config_ofdm_tx_path(void *dm_void, enum bb_path path) -+{ -+#if (RTL8192E_SUPPORT || RTL8192F_SUPPORT || RTL8812A_SUPPORT) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 ofdm_tx_path = 0x33; -+ -+ if (dm->num_rf_path == PDM_1SS) -+ return; -+ -+ switch (dm->support_ic_type) { -+ #if (RTL8192E_SUPPORT || RTL8192F_SUPPORT) -+ case ODM_RTL8192E: -+ case ODM_RTL8192F: -+ if (path == BB_PATH_A) -+ odm_set_bb_reg(dm, R_0x90c, MASKDWORD, 0x81121313); -+ else if (path == BB_PATH_B) -+ odm_set_bb_reg(dm, R_0x90c, MASKDWORD, 0x82221323); -+ else if (path == BB_PATH_AB) -+ odm_set_bb_reg(dm, R_0x90c, MASKDWORD, 0x83321333); -+ -+ break; -+ #endif -+ -+ #if (RTL8812A_SUPPORT) -+ case ODM_RTL8812: -+ if (path == BB_PATH_A) -+ ofdm_tx_path = 0x11; -+ else if (path == BB_PATH_B) -+ ofdm_tx_path = 0x22; -+ else if (path == BB_PATH_AB) -+ ofdm_tx_path = 0x33; -+ -+ odm_set_bb_reg(dm, R_0x80c, 0xff00, ofdm_tx_path); -+ -+ break; -+ #endif -+ -+ default: -+ break; -+ } -+#endif -+} -+ -+void phydm_config_ofdm_rx_path(void *dm_void, enum bb_path path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 val = 0; -+ -+ if (dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8192F)) { -+#if (RTL8192E_SUPPORT || RTL8192F_SUPPORT) -+ if (path == BB_PATH_A) -+ val = 1; -+ else if (path == BB_PATH_B) -+ val = 2; -+ else if (path == BB_PATH_AB) -+ val = 3; -+ -+ odm_set_bb_reg(dm, R_0xc04, 0xff, ((val << 4) | val)); -+ odm_set_bb_reg(dm, R_0xd04, 0xf, val); -+#endif -+ } -+#if (RTL8812A_SUPPORT || RTL8822B_SUPPORT) -+ else if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8822B)) { -+ if (path == BB_PATH_A) -+ val = 1; -+ else if (path == BB_PATH_B) -+ val = 2; -+ else if (path == BB_PATH_AB) -+ val = 3; -+ -+ odm_set_bb_reg(dm, R_0x808, MASKBYTE0, ((val << 4) | val)); -+ } -+#endif -+} -+ -+void phydm_config_cck_rx_antenna_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & ODM_IC_1SS) -+ return; -+ -+ /*@CCK 2R CCA parameters*/ -+ odm_set_bb_reg(dm, R_0xa00, BIT(15), 0x0); /*@Disable Ant diversity*/ -+ odm_set_bb_reg(dm, R_0xa70, BIT(7), 0); /*@Concurrent CCA at LSB & USB*/ -+ odm_set_bb_reg(dm, R_0xa74, BIT(8), 0); /*RX path diversity enable*/ -+ odm_set_bb_reg(dm, R_0xa14, BIT(7), 0); /*r_en_mrc_antsel*/ -+ odm_set_bb_reg(dm, R_0xa20, (BIT(5) | BIT(4)), 1); /*@MBC weighting*/ -+ -+ if (dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8197F | ODM_RTL8192F)) -+ odm_set_bb_reg(dm, R_0xa08, BIT(28), 1); /*r_cck_2nd_sel_eco*/ -+ else if (dm->support_ic_type & ODM_RTL8814A) -+ odm_set_bb_reg(dm, R_0xa84, BIT(28), 1); /*@2R CCA only*/ -+#endif -+} -+ -+void phydm_config_cck_rx_path(void *dm_void, enum bb_path path) -+{ -+#if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 path_div_select = 0; -+ u8 cck_path[2] = {0}; -+ u8 en_2R_path = 0; -+ u8 en_2R_mrc = 0; -+ u8 i = 0, j = 0; -+ u8 num_enable_path = 0; -+ u8 cck_mrc_max_path = 2; -+ -+ if (dm->support_ic_type & ODM_IC_1SS) -+ return; -+ -+ for (i = 0; i < 4; i++) { -+ if (path & BIT(i)) { /*@ex: PHYDM_ABCD*/ -+ num_enable_path++; -+ cck_path[j] = i; -+ j++; -+ } -+ if (num_enable_path >= cck_mrc_max_path) -+ break; -+ } -+ -+ if (num_enable_path > 1) { -+ path_div_select = 1; -+ en_2R_path = 1; -+ en_2R_mrc = 1; -+ } else { -+ path_div_select = 0; -+ en_2R_path = 0; -+ en_2R_mrc = 0; -+ } -+ /*@CCK_1 input signal path*/ -+ odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), cck_path[0]); -+ /*@CCK_2 input signal path*/ -+ odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), cck_path[1]); -+ /*@enable Rx path diversity*/ -+ odm_set_bb_reg(dm, R_0xa74, BIT(8), path_div_select); -+ /*@enable 2R Rx path*/ -+ odm_set_bb_reg(dm, R_0xa2c, BIT(18), en_2R_path); -+ /*@enable 2R MRC*/ -+ odm_set_bb_reg(dm, R_0xa2c, BIT(22), en_2R_mrc); -+ if (dm->support_ic_type & (ODM_RTL8192F | ODM_RTL8197F)) { -+ if (path == BB_PATH_A) { -+ odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), 0); -+ odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), 0); -+ odm_set_bb_reg(dm, R_0xa74, BIT(8), 0); -+ odm_set_bb_reg(dm, R_0xa2c, (BIT(18) | BIT(17)), 0); -+ odm_set_bb_reg(dm, R_0xa2c, (BIT(22) | BIT(21)), 0); -+ } else if (path == BB_PATH_B) {/*@for DC cancellation*/ -+ odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), 1); -+ odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), 1); -+ odm_set_bb_reg(dm, R_0xa74, BIT(8), 0); -+ odm_set_bb_reg(dm, R_0xa2c, (BIT(18) | BIT(17)), 0); -+ odm_set_bb_reg(dm, R_0xa2c, (BIT(22) | BIT(21)), 0); -+ } else if (path == BB_PATH_AB) { -+ odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), 0); -+ odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), 1); -+ odm_set_bb_reg(dm, R_0xa74, BIT(8), 1); -+ odm_set_bb_reg(dm, R_0xa2c, (BIT(18) | BIT(17)), 1); -+ odm_set_bb_reg(dm, R_0xa2c, (BIT(22) | BIT(21)), 1); -+ } -+ } else if (dm->support_ic_type & ODM_RTL8822B) { -+ if (path == BB_PATH_A) { -+ odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), 0); -+ odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), 0); -+ } else { -+ odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), 1); -+ odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), 1); -+ } -+ } -+ -+#endif -+} -+ -+void phydm_config_cck_tx_path(void *dm_void, enum bb_path path) -+{ -+#if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (path == BB_PATH_A) -+ odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0x8); -+ else if (path == BB_PATH_B) -+ odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0x4); -+ else /*if (path == BB_PATH_AB)*/ -+ odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0xc); -+#endif -+} -+ -+void phydm_config_trx_path_v2(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8197G_SUPPORT ||\ -+ RTL8812F_SUPPORT || RTL8198F_SUPPORT) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 val[10] = {0}; -+ char help[] = "-h"; -+ u8 i = 0, input_idx = 0; -+ enum bb_path tx_path, rx_path, tx_path_ctrl; -+ boolean dbg_mode_en; -+ -+ if (!(dm->support_ic_type & -+ (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F | ODM_RTL8822C | -+ ODM_RTL8814B | ODM_RTL8812F | ODM_RTL8197G | ODM_RTL8198F | -+ ODM_RTL8814C))) -+ return; -+ -+ for (i = 0; i < 5; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &val[i]); -+ input_idx++; -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ dbg_mode_en = (boolean)val[0]; -+ tx_path = (enum bb_path)val[1]; -+ rx_path = (enum bb_path)val[2]; -+ tx_path_ctrl = (enum bb_path)val[3]; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8822B | -+ ODM_RTL8192F)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{en} {tx_path} {rx_path} {ff:auto, else:1ss_tx_path}\n" -+ ); -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{en} {tx_path} {rx_path} {is_tx_2_path}\n"); -+ } -+ -+ } else if (dbg_mode_en) { -+ dm->is_disable_phy_api = false; -+ phydm_api_trx_mode(dm, tx_path, rx_path, tx_path_ctrl); -+ dm->is_disable_phy_api = true; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "T/RX path = 0x%x/0x%x, tx_path_ctrl=%d\n", -+ tx_path, rx_path, tx_path_ctrl); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "T/RX path_en={0x%x, 0x%x}, tx_1ss=%d\n", -+ dm->tx_ant_status, dm->rx_ant_status, -+ dm->tx_1ss_status); -+ } else { -+ dm->is_disable_phy_api = false; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Disable API debug mode\n"); -+ } -+#endif -+} -+ -+void phydm_config_trx_path_v1(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+#if (RTL8192E_SUPPORT || RTL8812A_SUPPORT) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 val[10] = {0}; -+ char help[] = "-h"; -+ u8 i = 0, input_idx = 0; -+ -+ if (!(dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8812))) -+ return; -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &val[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{0:CCK, 1:OFDM} {1:TX, 2:RX} {1:path_A, 2:path_B, 3:path_AB}\n"); -+ -+ *_used = used; -+ *_out_len = out_len; -+ return; -+ -+ } else if (val[0] == 0) { -+ /* @CCK */ -+ if (val[1] == 1) { /*TX*/ -+ if (val[2] == 1) -+ phydm_config_cck_tx_path(dm, BB_PATH_A); -+ else if (val[2] == 2) -+ phydm_config_cck_tx_path(dm, BB_PATH_B); -+ else if (val[2] == 3) -+ phydm_config_cck_tx_path(dm, BB_PATH_AB); -+ } else if (val[1] == 2) { /*RX*/ -+ -+ phydm_config_cck_rx_antenna_init(dm); -+ -+ if (val[2] == 1) -+ phydm_config_cck_rx_path(dm, BB_PATH_A); -+ else if (val[2] == 2) -+ phydm_config_cck_rx_path(dm, BB_PATH_B); -+ else if (val[2] == 3) -+ phydm_config_cck_rx_path(dm, BB_PATH_AB); -+ } -+ } -+ /* OFDM */ -+ else if (val[0] == 1) { -+ if (val[1] == 1) /*TX*/ -+ phydm_config_ofdm_tx_path(dm, val[2]); -+ else if (val[1] == 2) /*RX*/ -+ phydm_config_ofdm_rx_path(dm, val[2]); -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "PHYDM Set path [%s] [%s] = [%s%s%s%s]\n", -+ (val[0] == 1) ? "OFDM" : "CCK", -+ (val[1] == 1) ? "TX" : "RX", -+ (val[2] & 0x1) ? "A" : "", (val[2] & 0x2) ? "B" : "", -+ (val[2] & 0x4) ? "C" : "", -+ (val[2] & 0x8) ? "D" : ""); -+ -+ *_used = used; -+ *_out_len = out_len; -+#endif -+} -+ -+void phydm_config_trx_path(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8812)) { -+ #if (RTL8192E_SUPPORT || RTL8812A_SUPPORT) -+ phydm_config_trx_path_v1(dm, input, _used, output, _out_len); -+ #endif -+ } else if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F | -+ ODM_RTL8192F | ODM_RTL8822C | ODM_RTL8812F | -+ ODM_RTL8197G | ODM_RTL8814B | ODM_RTL8198F | -+ ODM_RTL8814C)) { -+ #if (RTL8822B_SUPPORT || RTL8197F_SUPPORT ||\ -+ RTL8192F_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8814B_SUPPORT || RTL8812F_SUPPORT ||\ -+ RTL8197G_SUPPORT || RTL8198F_SUPPORT) -+ phydm_config_trx_path_v2(dm, input, _used, output, _out_len); -+ #endif -+ } -+} -+ -+void phydm_tx_2path(void *dm_void) -+{ -+#if (defined(PHYDM_COMPILE_IC_2SS)) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ enum bb_path rx_path = (enum bb_path)dm->rx_ant_status; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "%s ======>\n", __func__); -+ -+ -+ if (!(dm->support_ic_type & ODM_IC_2SS)) -+ return; -+ -+ #if (RTL8822B_SUPPORT || RTL8192F_SUPPORT || RTL8197F_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8812F_SUPPORT || RTL8197G_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F | -+ ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G)) -+ phydm_api_trx_mode(dm, BB_PATH_AB, rx_path, BB_PATH_AB); -+ #endif -+ -+ #if (RTL8812A_SUPPORT || RTL8192E_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) { -+ phydm_config_cck_tx_path(dm, BB_PATH_AB); -+ phydm_config_ofdm_tx_path(dm, BB_PATH_AB); -+ } -+ #endif -+#endif -+} -+ -+void phydm_stop_3_wire(void *dm_void, u8 set_type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (set_type == PHYDM_SET) { -+ /*@[Stop 3-wires]*/ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ odm_set_bb_reg(dm, R_0x180c, 0x3, 0x0); -+ odm_set_bb_reg(dm, R_0x180c, BIT(28), 0x1); -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) { -+ odm_set_bb_reg(dm, R_0x410c, 0x3, 0x0); -+ odm_set_bb_reg(dm, R_0x410c, BIT(28), 0x1); -+ } -+ #endif -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { -+ odm_set_bb_reg(dm, R_0x520c, 0x3, 0x0); -+ odm_set_bb_reg(dm, R_0x520c, BIT(28), 0x1); -+ odm_set_bb_reg(dm, R_0x530c, 0x3, 0x0); -+ odm_set_bb_reg(dm, R_0x530c, BIT(28), 0x1); -+ } -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ odm_set_bb_reg(dm, R_0xc00, 0xf, 0x4); -+ odm_set_bb_reg(dm, R_0xe00, 0xf, 0x4); -+ } else { -+ odm_set_bb_reg(dm, R_0x88c, 0xf00000, 0xf); -+ } -+ -+ } else { /*@if (set_type == PHYDM_REVERT)*/ -+ -+ /*@[Start 3-wires]*/ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ odm_set_bb_reg(dm, R_0x180c, 0x3, 0x3); -+ odm_set_bb_reg(dm, R_0x180c, BIT(28), 0x1); -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) { -+ odm_set_bb_reg(dm, R_0x410c, 0x3, 0x3); -+ odm_set_bb_reg(dm, R_0x410c, BIT(28), 0x1); -+ } -+ #endif -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { -+ odm_set_bb_reg(dm, R_0x520c, 0x3, 0x3); -+ odm_set_bb_reg(dm, R_0x520c, BIT(28), 0x1); -+ odm_set_bb_reg(dm, R_0x530c, 0x3, 0x3); -+ odm_set_bb_reg(dm, R_0x530c, BIT(28), 0x1); -+ } -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ odm_set_bb_reg(dm, R_0xc00, 0xf, 0x7); -+ odm_set_bb_reg(dm, R_0xe00, 0xf, 0x7); -+ } else { -+ odm_set_bb_reg(dm, R_0x88c, 0xf00000, 0x0); -+ } -+ } -+} -+ -+u8 phydm_stop_ic_trx(void *dm_void, u8 set_type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_api_stuc *api = &dm->api_table; -+ u8 i = 0; -+ boolean trx_idle_success = false; -+ u32 dbg_port_value = 0; -+ -+ if (set_type == PHYDM_SET) { -+ /*[Stop TRX]---------------------------------------------------------*/ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ #if (RTL8723F_SUPPORT) -+ /*Judy 2020-0515*/ -+ /*set debug port to 0x0*/ -+ if (!phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, 0x0)) -+ return PHYDM_SET_FAIL; -+ #endif -+ for (i = 0; i < 100; i++) { -+ dbg_port_value = odm_get_bb_reg(dm, R_0x2db4, -+ MASKDWORD); -+ /* BB idle */ -+ if ((dbg_port_value & 0x1FFEFF3F) == 0 && -+ (dbg_port_value & 0xC0010000) == -+ 0xC0010000) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Stop trx wait for (%d) times\n", -+ i); -+ -+ trx_idle_success = true; -+ break; -+ } -+ } -+ } else { -+ /*set debug port to 0x0*/ -+ if (!phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, 0x0)) -+ return PHYDM_SET_FAIL; -+ for (i = 0; i < 100; i++) { -+ dbg_port_value = phydm_get_bb_dbg_port_val(dm); -+ /* PHYTXON && CCA_all */ -+ if (dm->support_ic_type & (ODM_RTL8721D | -+ ODM_RTL8710B | ODM_RTL8710C | -+ ODM_RTL8188F | ODM_RTL8723D)) { -+ if ((dbg_port_value & -+ (BIT(20) | BIT(15))) == 0) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Stop trx wait for (%d) times\n", -+ i); -+ -+ trx_idle_success = true; -+ break; -+ } -+ } else { -+ if ((dbg_port_value & -+ (BIT(17) | BIT(3))) == 0) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Stop trx wait for (%d) times\n", -+ i); -+ -+ trx_idle_success = true; -+ break; -+ } -+ } -+ ODM_delay_ms(1); -+ } -+ phydm_release_bb_dbg_port(dm); -+ } -+ -+ if (trx_idle_success) { -+ api->tx_queue_bitmap = odm_read_1byte(dm, R_0x522); -+ -+ /*pause all TX queue*/ -+ odm_set_mac_reg(dm, R_0x520, 0xff0000, 0xff); -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ /*disable OFDM RX CCA*/ -+ odm_set_bb_reg(dm, R_0x1d58, 0xff8, 0x1ff); -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ /*disable OFDM RX CCA*/ -+ odm_set_bb_reg(dm, R_0x838, BIT(1), 1); -+ } else { -+ api->rxiqc_reg1 = odm_read_4byte(dm, R_0xc14); -+ api->rxiqc_reg2 = odm_read_4byte(dm, R_0xc1c); -+ /* [ Set IQK Matrix = 0 ] -+ * equivalent to [ Turn off CCA] -+ */ -+ odm_set_bb_reg(dm, R_0xc14, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, R_0xc1c, MASKDWORD, 0x0); -+ } -+ phydm_dis_cck_trx(dm, PHYDM_SET); -+ } else { -+ return PHYDM_SET_FAIL; -+ } -+ -+ return PHYDM_SET_SUCCESS; -+ -+ } else { /*@if (set_type == PHYDM_REVERT)*/ -+ /*Release all TX queue*/ -+ odm_write_1byte(dm, R_0x522, api->tx_queue_bitmap); -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ /*@enable OFDM RX CCA*/ -+ odm_set_bb_reg(dm, R_0x1d58, 0xff8, 0x0); -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ /*@enable OFDM RX CCA*/ -+ odm_set_bb_reg(dm, R_0x838, BIT(1), 0); -+ } else { -+ /* @[Set IQK Matrix = 0] equivalent to [ Turn off CCA]*/ -+ odm_write_4byte(dm, R_0xc14, api->rxiqc_reg1); -+ odm_write_4byte(dm, R_0xc1c, api->rxiqc_reg2); -+ } -+ phydm_dis_cck_trx(dm, PHYDM_REVERT); -+ return PHYDM_SET_SUCCESS; -+ } -+} -+ -+void phydm_dis_cck_trx(void *dm_void, u8 set_type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_api_stuc *api = &dm->api_table; -+ -+ if (set_type == PHYDM_SET) { -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ if(dm->support_ic_type & ODM_RTL8723F) { -+ api->ccktx_path = 1; -+ /* @disable CCK CCA */ -+ odm_set_bb_reg(dm, R_0x2a24, BIT(13), 0x1); -+ /* @disable CCK Tx */ -+ odm_set_bb_reg(dm, R_0x2a00, BIT(1), 0x1); -+ } else { -+ api->ccktx_path = (u8)odm_get_bb_reg(dm, R_0x1a04, -+ 0xf0000000); -+ /* @CCK RxIQ weighting = [0,0] */ -+ odm_set_bb_reg(dm, R_0x1a14, 0x300, 0x3); -+ /* @disable CCK Tx */ -+ odm_set_bb_reg(dm, R_0x1a04, 0xf0000000, 0x0); -+ } -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ api->ccktx_path = (u8)odm_get_bb_reg(dm, R_0xa04, -+ 0xf0000000); -+ /* @disable CCK block */ -+ odm_set_bb_reg(dm, R_0x808, BIT(28), 0); -+ /* @disable CCK Tx */ -+ odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0x0); -+ } else { -+ api->ccktx_path = (u8)odm_get_bb_reg(dm, R_0xa04, -+ 0xf0000000); -+ /* @disable whole CCK block */ -+ odm_set_bb_reg(dm, R_0x800, BIT(24), 0); -+ /* @disable CCK Tx */ -+ odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0x0); -+ } -+ } else if (set_type == PHYDM_REVERT) { -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ if(dm->support_ic_type & ODM_RTL8723F) { -+ /* @enable CCK CCA */ -+ odm_set_bb_reg(dm, R_0x2a24, BIT(13), 0x0); -+ /* @enable CCK Tx */ -+ odm_set_bb_reg(dm, R_0x2a00, BIT(1), 0x0); -+ } else { -+ /* @CCK RxIQ weighting = [1,1] */ -+ odm_set_bb_reg(dm, R_0x1a14, 0x300, 0x0); -+ /* @enable CCK Tx */ -+ odm_set_bb_reg(dm, R_0x1a04, 0xf0000000, -+ api->ccktx_path); -+ } -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ /* @enable CCK block */ -+ odm_set_bb_reg(dm, R_0x808, BIT(28), 1); -+ /* @enable CCK Tx */ -+ odm_set_bb_reg(dm, R_0xa04, 0xf0000000, -+ api->ccktx_path); -+ } else { -+ /* @enable whole CCK block */ -+ odm_set_bb_reg(dm, R_0x800, BIT(24), 1); -+ /* @enable CCK Tx */ -+ odm_set_bb_reg(dm, R_0xa04, 0xf0000000, -+ api->ccktx_path); -+ } -+ } -+} -+ -+void phydm_bw_fixed_enable(void *dm_void, u8 enable) -+{ -+#ifdef CONFIG_BW_INDICATION -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean val = (enable == FUNC_ENABLE) ? 1 : 0; -+ -+ if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8195B)) -+ odm_set_bb_reg(dm, R_0x840, BIT(4), val); -+ else if (dm->support_ic_type & ODM_RTL8822C) -+ odm_set_bb_reg(dm, R_0x878, BIT(28), val); -+#endif -+} -+ -+void phydm_bw_fixed_setting(void *dm_void) -+{ -+#ifdef CONFIG_BW_INDICATION -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_api_stuc *api = &dm->api_table; -+ u8 bw = *dm->band_width; -+ u32 reg = 0, reg_mask = 0, reg_value = 0; -+ -+ if (!(dm->support_ic_type & ODM_DYM_BW_INDICATION_SUPPORT)) -+ return; -+ -+ if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B | -+ ODM_RTL8195B)) { -+ reg = R_0x840; -+ reg_mask = 0xf; -+ reg_value = api->pri_ch_idx; -+ } else if (dm->support_ic_type & ODM_RTL8822C) { -+ reg = R_0x878; -+ reg_mask = 0xc0000000; -+ reg_value = 0x0; -+ } -+ -+ switch (bw) { -+ case CHANNEL_WIDTH_80: -+ odm_set_bb_reg(dm, reg, reg_mask, reg_value); -+ break; -+ case CHANNEL_WIDTH_40: -+ odm_set_bb_reg(dm, reg, reg_mask, reg_value); -+ break; -+ default: -+ odm_set_bb_reg(dm, reg, reg_mask, 0x0); -+ } -+ -+ phydm_bw_fixed_enable(dm, FUNC_ENABLE); -+#endif -+} -+ -+void phydm_set_ext_switch(void *dm_void, u32 ext_ant_switch) -+{ -+#if (RTL8821A_SUPPORT || RTL8881A_SUPPORT) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8881A))) -+ return; -+ -+ /*Output Pin Settings*/ -+ -+ /*select DPDT_P and DPDT_N as output pin*/ -+ odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); -+ -+ /*@by WLAN control*/ -+ odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); -+ -+ /*@DPDT_N = 1b'0*/ /*@DPDT_P = 1b'0*/ -+ odm_set_bb_reg(dm, R_0xcb4, 0xFF, 77); -+ -+ if (ext_ant_switch == 1) { /*@2b'01*/ -+ odm_set_bb_reg(dm, R_0xcb4, (BIT(29) | BIT(28)), 1); -+ PHYDM_DBG(dm, ODM_COMP_API, "8821A ant swh=2b'01\n"); -+ } else if (ext_ant_switch == 2) { /*@2b'10*/ -+ odm_set_bb_reg(dm, R_0xcb4, BIT(29) | BIT(28), 2); -+ PHYDM_DBG(dm, ODM_COMP_API, "*8821A ant swh=2b'10\n"); -+ } -+#endif -+} -+ -+void phydm_csi_mask_enable(void *dm_void, u32 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean en = false; -+ -+ en = (enable == FUNC_ENABLE) ? true : false; -+ -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ odm_set_bb_reg(dm, R_0xd2c, BIT(28), en); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Enable CSI Mask: Reg 0xD2C[28] = ((0x%x))\n", en); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ odm_set_bb_reg(dm, R_0xc0c, BIT(3), en); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Enable CSI Mask: Reg 0xc0c[3] = ((0x%x))\n", en); -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ odm_set_bb_reg(dm, R_0x874, BIT(0), en); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Enable CSI Mask: Reg 0x874[0] = ((0x%x))\n", en); -+ } -+} -+ -+void phydm_clean_all_csi_mask(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ odm_set_bb_reg(dm, R_0xd40, MASKDWORD, 0); -+ odm_set_bb_reg(dm, R_0xd44, MASKDWORD, 0); -+ odm_set_bb_reg(dm, R_0xd48, MASKDWORD, 0); -+ odm_set_bb_reg(dm, R_0xd4c, MASKDWORD, 0); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ u8 i = 0, idx_lmt = 0; -+ -+ if (dm->support_ic_type & -+ (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G)) -+ idx_lmt = 127; -+ else /*@for IC supporting 80 + 80*/ -+ idx_lmt = 255; -+ -+ odm_set_bb_reg(dm, R_0x1ee8, 0x3, 0x3); -+ odm_set_bb_reg(dm, R_0x1d94, BIT(31) | BIT(30), 0x1); -+ for (i = 0; i < idx_lmt; i++) { -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, i); -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE0, 0x0); -+ } -+ odm_set_bb_reg(dm, R_0x1ee8, 0x3, 0x0); -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ odm_set_bb_reg(dm, R_0x880, MASKDWORD, 0); -+ odm_set_bb_reg(dm, R_0x884, MASKDWORD, 0); -+ odm_set_bb_reg(dm, R_0x888, MASKDWORD, 0); -+ odm_set_bb_reg(dm, R_0x88c, MASKDWORD, 0); -+ odm_set_bb_reg(dm, R_0x890, MASKDWORD, 0); -+ odm_set_bb_reg(dm, R_0x894, MASKDWORD, 0); -+ odm_set_bb_reg(dm, R_0x898, MASKDWORD, 0); -+ odm_set_bb_reg(dm, R_0x89c, MASKDWORD, 0); -+ } -+} -+ -+void phydm_set_csi_mask(void *dm_void, u32 tone_idx_tmp, u8 tone_direction) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 byte_offset = 0, bit_offset = 0; -+ u32 target_reg = 0; -+ u8 reg_tmp_value = 0; -+ u32 tone_num = 64; -+ u32 tone_num_shift = 0; -+ u32 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 (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ tone_num = 64; -+ csi_mask_reg_p = 0xD40; -+ csi_mask_reg_n = 0xD48; -+ -+ } else if (dm->support_ic_type & 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 = (u8)(tone_idx_tmp >> 3); -+ bit_offset = (u8)(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 = (u8)(tone_idx_tmp >> 3); -+ bit_offset = (u8)(tone_idx_tmp & 0x7); -+ target_reg = csi_mask_reg_n + byte_offset; -+ } -+ -+ reg_tmp_value = odm_read_1byte(dm, target_reg); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "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_write_1byte(dm, target_reg, reg_tmp_value); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "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(void *dm_void, u32 tone_idx_tmp, u32 bw) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ /*tone_idx X 10*/ -+ u32 nbi_128[NBI_128TONE] = {25, 55, 85, 115, 135, -+ 155, 185, 205, 225, 245, -+ 265, 285, 305, 335, 355, -+ 375, 395, 415, 435, 455, -+ 485, 505, 525, 555, 585, 615, 635}; -+ /*tone_idx X 10*/ -+ u32 nbi_256[NBI_256TONE] = {25, 55, 85, 115, 135, -+ 155, 175, 195, 225, 245, -+ 265, 285, 305, 325, 345, -+ 365, 385, 405, 425, 445, -+ 465, 485, 505, 525, 545, -+ 565, 585, 605, 625, 645, -+ 665, 695, 715, 735, 755, -+ 775, 795, 815, 835, 855, -+ 875, 895, 915, 935, 955, -+ 975, 995, 1015, 1035, 1055, -+ 1085, 1105, 1125, 1145, 1175, -+ 1195, 1225, 1255, 1275}; -+ u32 reg_idx = 0; -+ u32 i; -+ u8 nbi_table_idx = FFT_128_TYPE; -+ -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ nbi_table_idx = FFT_128_TYPE; -+ } else if (dm->support_ic_type & ODM_IC_11AC_1_SERIES) { -+ nbi_table_idx = FFT_256_TYPE; -+ } else if (dm->support_ic_type & 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_128TONE; i++) { -+ if (tone_idx_tmp < nbi_128[i]) { -+ reg_idx = i + 1; -+ break; -+ } -+ } -+ -+ } else if (nbi_table_idx == FFT_256_TYPE) { -+ for (i = 0; i < NBI_256TONE; i++) { -+ if (tone_idx_tmp < nbi_256[i]) { -+ reg_idx = i + 1; -+ break; -+ } -+ } -+ } -+ -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ odm_set_bb_reg(dm, R_0xc40, 0x1f000000, reg_idx); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set tone idx: Reg0xC40[28:24] = ((0x%x))\n", -+ reg_idx); -+ } else { -+ odm_set_bb_reg(dm, R_0x87c, 0xfc000, reg_idx); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set tone idx: Reg0x87C[19:14] = ((0x%x))\n", -+ reg_idx); -+ } -+} -+ -+void phydm_nbi_enable(void *dm_void, u32 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 val = 0; -+ -+ val = (enable == FUNC_ENABLE) ? 1 : 0; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "Enable NBI=%d\n", val); -+ -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ if (dm->support_ic_type & (ODM_RTL8192F | ODM_RTL8197F)) { -+ val = (enable == FUNC_ENABLE) ? 0xf : 0; -+ odm_set_bb_reg(dm, R_0xc50, 0xf000000, val); -+ } else { -+ odm_set_bb_reg(dm, R_0xc40, BIT(9), val); -+ } -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C | -+ ODM_RTL8195B)) { -+ odm_set_bb_reg(dm, R_0x87c, BIT(13), val); -+ odm_set_bb_reg(dm, R_0xc20, BIT(28), val); -+ if (dm->rf_type > RF_1T1R) -+ odm_set_bb_reg(dm, R_0xe20, BIT(28), val); -+ } else { -+ odm_set_bb_reg(dm, R_0x87c, BIT(13), val); -+ } -+ } -+} -+ -+u8 phydm_find_fc(void *dm_void, u32 channel, u32 bw, u32 second_ch, u32 *fc_in) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 fc = *fc_in; -+ u32 start_ch_per_40m[NUM_START_CH_40M] = {36, 44, 52, 60, 100, -+ 108, 116, 124, 132, 140, -+ 149, 157, 165, 173}; -+ u32 start_ch_per_80m[NUM_START_CH_80M] = {36, 52, 100, 116, 132, -+ 149, 165}; -+ u32 *start_ch = &start_ch_per_40m[0]; -+ u32 num_start_channel = NUM_START_CH_40M; -+ u32 channel_offset = 0; -+ u32 i; -+ -+ /*@2.4G*/ -+ if (channel <= 14 && channel > 0) { -+ if (bw == 80) -+ return PHYDM_SET_FAIL; -+ -+ fc = 2412 + (channel - 1) * 5; -+ -+ if (bw == 40 && second_ch == PHYDM_ABOVE) { -+ if (channel >= 10) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "CH = ((%d)), Scnd_CH = ((%d)) Error setting\n", -+ channel, second_ch); -+ return PHYDM_SET_FAIL; -+ } -+ fc += 10; -+ } else if (bw == 40 && (second_ch == PHYDM_BELOW)) { -+ if (channel <= 2) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "CH = ((%d)), Scnd_CH = ((%d)) Error setting\n", -+ channel, second_ch); -+ return PHYDM_SET_FAIL; -+ } -+ fc -= 10; -+ } -+ } -+ /*@5G*/ -+ else if (channel >= 36 && channel <= 177) { -+ if (bw != 20) { -+ if (bw == 40) { -+ num_start_channel = NUM_START_CH_40M; -+ start_ch = &start_ch_per_40m[0]; -+ channel_offset = CH_OFFSET_40M; -+ } else if (bw == 80) { -+ num_start_channel = NUM_START_CH_80M; -+ start_ch = &start_ch_per_80m[0]; -+ channel_offset = CH_OFFSET_80M; -+ } -+ -+ for (i = 0; i < (num_start_channel - 1); i++) { -+ if (channel < start_ch[i + 1]) { -+ channel = start_ch[i] + channel_offset; -+ break; -+ } -+ } -+ PHYDM_DBG(dm, ODM_COMP_API, "Mod_CH = ((%d))\n", -+ channel); -+ } -+ -+ fc = 5180 + (channel - 36) * 5; -+ -+ } else { -+ PHYDM_DBG(dm, ODM_COMP_API, "CH = ((%d)) Error setting\n", -+ channel); -+ return PHYDM_SET_FAIL; -+ } -+ -+ *fc_in = fc; -+ -+ return PHYDM_SET_SUCCESS; -+} -+ -+u8 phydm_find_intf_distance(void *dm_void, u32 bw, u32 fc, u32 f_interference, -+ u32 *tone_idx_tmp_in) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 bw_up = 0, bw_low = 0; -+ u32 int_distance = 0; -+ u32 tone_idx_tmp = 0; -+ u8 set_result = PHYDM_SET_NO_NEED; -+ -+ bw_up = fc + bw / 2; -+ bw_low = fc - bw / 2; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[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 = DIFF_2(fc, f_interference); -+ /*@10*(int_distance /0.3125)*/ -+ tone_idx_tmp = (int_distance << 5); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "int_distance = ((%d MHz)) Mhz, tone_idx_tmp = ((%d.%d))\n", -+ int_distance, tone_idx_tmp / 10, -+ tone_idx_tmp % 10); -+ *tone_idx_tmp_in = tone_idx_tmp; -+ set_result = PHYDM_SET_SUCCESS; -+ } -+ -+ return set_result; -+} -+ -+u8 phydm_csi_mask_setting(void *dm_void, u32 enable, u32 ch, u32 bw, -+ u32 f_intf, u32 sec_ch) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 fc = 2412; -+ u8 direction = FREQ_POSITIVE; -+ u32 tone_idx = 0; -+ u8 set_result = PHYDM_SET_SUCCESS; -+ u8 rpt = 0; -+ -+ if (enable == FUNC_DISABLE) { -+ set_result = PHYDM_SET_SUCCESS; -+ phydm_clean_all_csi_mask(dm); -+ -+ } else { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[Set CSI MASK_] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", -+ ch, bw, f_intf, -+ (((bw == 20) || (ch > 14)) ? "Don't care" : -+ (sec_ch == PHYDM_ABOVE) ? "H" : "L")); -+ -+ /*@calculate fc*/ -+ if (phydm_find_fc(dm, ch, bw, sec_ch, &fc) == PHYDM_SET_FAIL) { -+ set_result = PHYDM_SET_FAIL; -+ } else { -+ /*@calculate interference distance*/ -+ rpt = phydm_find_intf_distance(dm, bw, fc, f_intf, -+ &tone_idx); -+ if (rpt == PHYDM_SET_SUCCESS) { -+ if (f_intf >= fc) -+ direction = FREQ_POSITIVE; -+ else -+ direction = FREQ_NEGATIVE; -+ -+ phydm_set_csi_mask(dm, tone_idx, direction); -+ set_result = PHYDM_SET_SUCCESS; -+ } else { -+ set_result = PHYDM_SET_NO_NEED; -+ } -+ } -+ } -+ -+ if (set_result == PHYDM_SET_SUCCESS) -+ phydm_csi_mask_enable(dm, enable); -+ else -+ phydm_csi_mask_enable(dm, FUNC_DISABLE); -+ -+ return set_result; -+} -+ -+boolean phydm_spur_case_mapping(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 channel = *dm->channel, bw = *dm->band_width; -+ boolean mapping_result = false; -+#if (RTL8814B_SUPPORT == 1) -+ if (channel == 153 && bw == CHANNEL_WIDTH_20) -+ mapping_result = true; -+ else if (channel == 151 && bw == CHANNEL_WIDTH_40) -+ mapping_result = true; -+ else if (channel == 155 && bw == CHANNEL_WIDTH_80) -+ mapping_result = true; -+#endif -+ return mapping_result; -+} -+ -+enum odm_rf_band phydm_ch_to_rf_band(void *dm_void, u8 central_ch) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ enum odm_rf_band rf_band = ODM_RF_BAND_5G_LOW; -+ -+ if (central_ch <= 14) -+ rf_band = ODM_RF_BAND_2G; -+ else if (central_ch >= 36 && central_ch <= 64) -+ rf_band = ODM_RF_BAND_5G_LOW; -+ else if ((central_ch >= 100) && (central_ch <= 144)) -+ rf_band = ODM_RF_BAND_5G_MID; -+ else if (central_ch >= 149) -+ rf_band = ODM_RF_BAND_5G_HIGH; -+ else -+ PHYDM_DBG(dm, ODM_COMP_API, "mapping channel to band fail\n"); -+ -+ return rf_band; -+} -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+u32 phydm_rf_psd_jgr3(void *dm_void, u8 path, u32 tone_idx) -+{ -+#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 reg_1b04 = 0, reg_1b08 = 0, reg_1b0c_11_10 = 0; -+ u32 reg_1b14 = 0, reg_1b18 = 0, reg_1b1c = 0; -+ u32 reg_1b28 = 0; -+ u32 reg_1bcc_5_0 = 0; -+ u32 reg_1b2c_27_16 = 0, reg_1b34 = 0, reg_1bd4 = 0; -+ u32 reg_180c = 0, reg_410c = 0, reg_520c = 0, reg_530c = 0; -+ u32 igi = 0; -+ u32 i = 0; -+ u32 psd_val = 0, psd_val_msb = 0, psd_val_lsb = 0, psd_max = 0; -+ u32 psd_status_temp = 0; -+ u16 poll_cnt = 0; -+ -+ /*read and record the ori. value*/ -+ reg_1b04 = odm_get_bb_reg(dm, R_0x1b04, MASKDWORD); -+ reg_1b08 = odm_get_bb_reg(dm, R_0x1b08, MASKDWORD); -+ reg_1b0c_11_10 = odm_get_bb_reg(dm, R_0x1b0c, 0xc00); -+ reg_1b14 = odm_get_bb_reg(dm, R_0x1b14, MASKDWORD); -+ reg_1b18 = odm_get_bb_reg(dm, R_0x1b18, MASKDWORD); -+ reg_1b1c = odm_get_bb_reg(dm, R_0x1b1c, MASKDWORD); -+ reg_1b28 = odm_get_bb_reg(dm, R_0x1b28, MASKDWORD); -+ reg_1bcc_5_0 = odm_get_bb_reg(dm, R_0x1bcc, 0x3f); -+ reg_1b2c_27_16 = odm_get_bb_reg(dm, R_0x1b2c, 0xfff0000); -+ reg_1b34 = odm_get_bb_reg(dm, R_0x1b34, MASKDWORD); -+ reg_1bd4 = odm_get_bb_reg(dm, R_0x1bd4, MASKDWORD); -+ igi = odm_get_bb_reg(dm, R_0x1d70, MASKDWORD); -+ reg_180c = odm_get_bb_reg(dm, R_0x180c, 0x3); -+ reg_410c = odm_get_bb_reg(dm, R_0x410c, 0x3); -+ reg_520c = odm_get_bb_reg(dm, R_0x520c, 0x3); -+ reg_530c = odm_get_bb_reg(dm, R_0x530c, 0x3); -+ -+ /*rf psd reg setting*/ -+ odm_set_bb_reg(dm, R_0x1b00, 0x6, path); /*path is RF_path*/ -+ odm_set_bb_reg(dm, R_0x1b04, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, R_0x1b08, MASKDWORD, 0x80); -+ odm_set_bb_reg(dm, R_0x1b0c, 0xc00, 0x3); -+ odm_set_bb_reg(dm, R_0x1b14, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, R_0x1b18, MASKDWORD, 0x1); -+/*#if (DM_ODM_SUPPORT_TYPE == ODM_AP)*/ -+ odm_set_bb_reg(dm, R_0x1b1c, MASKDWORD, 0x82103D21); -+/*#else*/ -+ /*odm_set_bb_reg(dm, R_0x1b1c, MASKDWORD, 0x821A3D21);*/ -+/*#endif*/ -+ odm_set_bb_reg(dm, R_0x1b28, MASKDWORD, 0x0); -+ odm_set_bb_reg(dm, R_0x1bcc, 0x3f, 0x3f); -+ odm_set_bb_reg(dm, R_0x8a0, 0xf, 0x0); /* AGC off */ -+ odm_set_bb_reg(dm, R_0x1d70, MASKDWORD, 0x20202020); -+ -+ for (i = tone_idx - 1; i <= tone_idx + 1; i++) { -+ /*set psd tone_idx for detection*/ -+ odm_set_bb_reg(dm, R_0x1b2c, 0xfff0000, i); -+ /*one shot for RXIQK psd*/ -+ odm_set_bb_reg(dm, R_0x1b34, MASKDWORD, 0x1); -+ odm_set_bb_reg(dm, R_0x1b34, MASKDWORD, 0x0); -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ for (poll_cnt = 0; poll_cnt < 20; poll_cnt++) { -+ odm_set_bb_reg(dm, R_0x1bd4, 0x3f0000, 0x2b); -+ psd_status_temp = odm_get_bb_reg(dm, R_0x1bfc, -+ BIT(1)); -+ if (!psd_status_temp) -+ ODM_delay_us(10); -+ else -+ break; -+ } -+ else -+ ODM_delay_us(250); -+ -+ /*read RxIQK power*/ -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x00250001); -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ psd_val_msb = odm_get_bb_reg(dm, R_0x1bfc, 0x7ff0000); -+ else if (dm->support_ic_type & ODM_RTL8198F) -+ psd_val_msb = odm_get_bb_reg(dm, R_0x1bfc, 0x1f0000); -+ -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x002e0001); -+ psd_val_lsb = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ psd_val = (psd_val_msb << 21) + (psd_val_lsb >> 11); -+ else if (dm->support_ic_type & ODM_RTL8198F) -+ psd_val = (psd_val_msb << 27) + (psd_val_lsb >> 5); -+ -+ if (psd_val > psd_max) -+ psd_max = psd_val; -+ } -+ -+ /*refill the ori. value*/ -+ odm_set_bb_reg(dm, R_0x1b00, 0x6, path); -+ odm_set_bb_reg(dm, R_0x1b04, MASKDWORD, reg_1b04); -+ odm_set_bb_reg(dm, R_0x1b08, MASKDWORD, reg_1b08); -+ odm_set_bb_reg(dm, R_0x1b0c, 0xc00, reg_1b0c_11_10); -+ odm_set_bb_reg(dm, R_0x1b14, MASKDWORD, reg_1b14); -+ odm_set_bb_reg(dm, R_0x1b18, MASKDWORD, reg_1b18); -+ odm_set_bb_reg(dm, R_0x1b1c, MASKDWORD, reg_1b1c); -+ odm_set_bb_reg(dm, R_0x1b28, MASKDWORD, reg_1b28); -+ odm_set_bb_reg(dm, R_0x1bcc, 0x3f, reg_1bcc_5_0); -+ odm_set_bb_reg(dm, R_0x1b2c, 0xfff0000, reg_1b2c_27_16); -+ odm_set_bb_reg(dm, R_0x1b34, MASKDWORD, reg_1b34); -+ odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, reg_1bd4); -+ odm_set_bb_reg(dm, R_0x8a0, 0xf, 0xf); /* AGC on */ -+ odm_set_bb_reg(dm, R_0x1d70, MASKDWORD, igi); -+ PHYDM_DBG(dm, ODM_COMP_API, "psd_max %d\n", psd_max); -+ -+ return psd_max; -+#else -+ return 0; -+#endif -+} -+ -+u8 phydm_find_intf_distance_jgr3(void *dm_void, u32 bw, u32 fc, -+ u32 f_interference, u32 *tone_idx_tmp_in) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 bw_up = 0, bw_low = 0; -+ u32 int_distance = 0; -+ u32 tone_idx_tmp = 0; -+ u8 set_result = PHYDM_SET_NO_NEED; -+ u8 channel = *dm->channel; -+ -+ bw_up = 1000 * (fc + bw / 2); -+ bw_low = 1000 * (fc - bw / 2); -+ fc = 1000 * fc; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[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 = DIFF_2(fc, f_interference); -+ /*@10*(int_distance /0.3125)*/ -+ if (channel < 15 && -+ (dm->support_ic_type & -+ (ODM_RTL8814B | ODM_RTL8198F | ODM_RTL8814C))) -+ tone_idx_tmp = int_distance / 312; -+ else -+ tone_idx_tmp = ((int_distance + 156) / 312); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "int_distance = ((%d)) , tone_idx_tmp = ((%d))\n", -+ int_distance, tone_idx_tmp); -+ *tone_idx_tmp_in = tone_idx_tmp; -+ set_result = PHYDM_SET_SUCCESS; -+ } -+ -+ return set_result; -+} -+ -+u8 phydm_csi_mask_setting_jgr3(void *dm_void, u32 enable, u32 ch, u32 bw, -+ u32 f_intf, u32 sec_ch, u8 wgt) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 fc = 2412; -+ u8 direction = FREQ_POSITIVE; -+ u32 tone_idx = 0; -+ u8 set_result = PHYDM_SET_SUCCESS; -+ u8 rpt = 0; -+ -+ if (enable == FUNC_DISABLE) { -+ phydm_csi_mask_enable(dm, FUNC_ENABLE); -+ phydm_clean_all_csi_mask(dm); -+ phydm_csi_mask_enable(dm, FUNC_DISABLE); -+ set_result = PHYDM_SET_SUCCESS; -+ } else { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[Set CSI MASK] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s)), wgt = ((%d))\n", -+ ch, bw, f_intf, -+ (((bw == 20) || (ch > 14)) ? "Don't care" : -+ (sec_ch == PHYDM_ABOVE) ? "H" : "L"), wgt); -+ -+ /*@calculate fc*/ -+ if (phydm_find_fc(dm, ch, bw, sec_ch, &fc) == PHYDM_SET_FAIL) { -+ set_result = PHYDM_SET_FAIL; -+ } else { -+ /*@calculate interference distance*/ -+ rpt = phydm_find_intf_distance_jgr3(dm, bw, fc, f_intf, -+ &tone_idx); -+ if (rpt == PHYDM_SET_SUCCESS) { -+ if (f_intf >= 1000 * fc) -+ direction = FREQ_POSITIVE; -+ else -+ direction = FREQ_NEGATIVE; -+ -+ phydm_csi_mask_enable(dm, FUNC_ENABLE); -+ phydm_set_csi_mask_jgr3(dm, tone_idx, direction, -+ wgt); -+ set_result = PHYDM_SET_SUCCESS; -+ } else { -+ set_result = PHYDM_SET_NO_NEED; -+ } -+ } -+ if (!(set_result == PHYDM_SET_SUCCESS)) -+ phydm_csi_mask_enable(dm, FUNC_DISABLE); -+ } -+ -+ return set_result; -+} -+ -+void phydm_set_csi_mask_jgr3(void *dm_void, u32 tone_idx_tmp, u8 tone_direction, -+ u8 wgt) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 multi_tone_idx_tmp = 0; -+ u32 reg_tmp = 0; -+ u32 tone_num = 64; -+ u32 table_addr = 0; -+ u32 addr = 0; -+ u8 rf_bw = 0; -+ u8 value = 0; -+ u8 channel = *dm->channel; -+ -+ rf_bw = odm_read_1byte(dm, R_0x9b0); -+ if (((rf_bw & 0xc) >> 2) == 0x2) -+ tone_num = 128; /* @RF80 : tone(-1) at tone_idx=255 */ -+ else -+ tone_num = 64; /* @RF20/40 : tone(-1) at tone_idx=127 */ -+ -+ if (tone_direction == FREQ_POSITIVE) { -+ if (tone_idx_tmp >= (tone_num - 1)) -+ tone_idx_tmp = (tone_num - 1); -+ } else { -+ if (tone_idx_tmp >= tone_num) -+ tone_idx_tmp = tone_num; -+ -+ tone_idx_tmp = (tone_num << 1) - tone_idx_tmp; -+ } -+ table_addr = tone_idx_tmp >> 1; -+ -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Pre Mask tone idx[%d]: Reg0x1d94 = ((0x%x))\n", -+ tone_idx_tmp, reg_tmp); -+ odm_set_bb_reg(dm, R_0x1ee8, 0x3, 0x3); -+ odm_set_bb_reg(dm, R_0x1d94, BIT(31) | BIT(30), 0x1); -+ -+ if (channel < 15 && -+ (dm->support_ic_type & -+ (ODM_RTL8814B | ODM_RTL8198F | ODM_RTL8814C))) { -+ if (tone_idx_tmp % 2 == 1) { -+ if (tone_direction == FREQ_POSITIVE) { -+ /*===Tone 1===*/ -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, -+ (table_addr & 0xff)); -+ value = (BIT(3) | (wgt & 0x7)) << 4; -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask tone 1 idx[%d]: Reg0x1d94 = ((0x%x))\n", -+ tone_idx_tmp, reg_tmp); -+ /*===Tone 2===*/ -+ value = 0; -+ multi_tone_idx_tmp = tone_idx_tmp + 1; -+ table_addr = multi_tone_idx_tmp >> 1; -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, -+ (table_addr & 0xff)); -+ value = (BIT(3) | (wgt & 0x7)); -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask tone 2 idx[%d]: Reg0x1d94 = ((0x%x))\n", -+ tone_idx_tmp, reg_tmp); -+ } else { -+ /*===Tone 1 & 2===*/ -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, -+ (table_addr & 0xff)); -+ value = ((BIT(3) | (wgt & 0x7)) << 4) | -+ (BIT(3) | (wgt & 0x7)); -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask tone 1 & 2 idx[%d]: Reg0x1d94 = ((0x%x))\n", -+ tone_idx_tmp, reg_tmp); -+ } -+ } else { -+ if (tone_direction == FREQ_POSITIVE) { -+ /*===Tone 1 & 2===*/ -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, -+ (table_addr & 0xff)); -+ value = ((BIT(3) | (wgt & 0x7)) << 4) | -+ (BIT(3) | (wgt & 0x7)); -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask tone 1 & 2 idx[%d]: Reg0x1d94 = ((0x%x))\n", -+ tone_idx_tmp, reg_tmp); -+ } else { -+ /*===Tone 1===*/ -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, -+ (table_addr & 0xff)); -+ value = (BIT(3) | (wgt & 0x7)); -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask tone 1 idx[%d]: Reg0x1d94 = ((0x%x))\n", -+ tone_idx_tmp, reg_tmp); -+ -+ /*===Tone 2===*/ -+ value = 0; -+ multi_tone_idx_tmp = tone_idx_tmp - 1; -+ table_addr = multi_tone_idx_tmp >> 1; -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, -+ (table_addr & 0xff)); -+ value = (BIT(3) | (wgt & 0x7)) << 4; -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask tone 2 idx[%d]: Reg0x1d94 = ((0x%x))\n", -+ tone_idx_tmp, reg_tmp); -+ } -+ } -+ } else { -+ if ((dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) && -+ phydm_spur_case_mapping(dm)) { -+ if (!(tone_idx_tmp % 2)) { -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, -+ (table_addr & 0xff)); -+ value = ((BIT(3) | (((wgt + 4) <= 7 ? (wgt + -+ 4) : 7) & 0x7)) << 4) | (BIT(3) | -+ (wgt & 0x7)); -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask tone idx[%d]: Reg0x1d94 = ((0x%x))\n", -+ tone_idx_tmp, reg_tmp); -+ if (tone_idx_tmp == 0) -+ table_addr = tone_num - 1; -+ else -+ table_addr = table_addr - 1; -+ if (tone_idx_tmp != tone_num) { -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, -+ (table_addr & 0xff)); -+ value = (BIT(3) | (((wgt + 4) <= 7 ? -+ (wgt + 4) : 7) & 0x7)) << 4; -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, -+ value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask Reg0x1d94 = ((0x%x))\n", -+ reg_tmp); -+ } -+ } else { -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, -+ (table_addr & 0xff)); -+ value = ((BIT(3) | (wgt & 0x7)) << 4) | -+ (BIT(3) | (((wgt + 4) <= 7 ? (wgt + -+ 4) : 7) & 0x7)); -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask tone idx[%d]: Reg0x1d94 = ((0x%x))\n", -+ tone_idx_tmp, reg_tmp); -+ if (tone_idx_tmp == (tone_num << 1) - 1) -+ table_addr = 0; -+ else -+ table_addr = table_addr + 1; -+ if (tone_idx_tmp != tone_num - 1) { -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, -+ (table_addr & 0xff)); -+ value = (BIT(3) | (((wgt + 4) <= 7 ? -+ (wgt + 4) : 7) & 0x7)); -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, -+ value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask Reg0x1d94 = ((0x%x))\n", -+ reg_tmp); -+ } -+ } -+ } else { -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, (table_addr & -+ 0xff)); -+ if (tone_idx_tmp % 2) -+ value = (BIT(3) | (wgt & 0x7)) << 4; -+ else -+ value = BIT(3) | (wgt & 0x7); -+ -+ odm_set_bb_reg(dm, R_0x1d94, 0xff, value); -+ reg_tmp = odm_read_4byte(dm, R_0x1d94); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "New Mask tone idx[%d]: Reg0x1d94 = ((0x%x))\n", -+ tone_idx_tmp, reg_tmp); -+ } -+ } -+ odm_set_bb_reg(dm, R_0x1ee8, 0x3, 0x0); -+} -+ -+void phydm_nbi_reset_jgr3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_set_bb_reg(dm, R_0x818, BIT(3), 1); -+ odm_set_bb_reg(dm, R_0x1d3c, 0x78000000, 0); -+ odm_set_bb_reg(dm, R_0x818, BIT(3), 0); -+ odm_set_bb_reg(dm, R_0x818, BIT(11), 0); -+ #if RTL8814B_SUPPORT -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ odm_set_bb_reg(dm, R_0x1944, 0x300, 0x3); -+ odm_set_bb_reg(dm, R_0x4044, 0x300, 0x3); -+ odm_set_bb_reg(dm, R_0x5044, 0x300, 0x3); -+ odm_set_bb_reg(dm, R_0x5144, 0x300, 0x3); -+ odm_set_bb_reg(dm, R_0x810, 0xf, 0x0); -+ odm_set_bb_reg(dm, R_0x810, 0xf0000, 0x0); -+ odm_set_bb_reg(dm, R_0xc24, MASKDWORD, 0x406000ff); -+ } -+ #endif -+} -+ -+u8 phydm_nbi_setting_jgr3(void *dm_void, u32 enable, u32 ch, u32 bw, u32 f_intf, -+ u32 sec_ch, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 fc = 2412; -+ u8 direction = FREQ_POSITIVE; -+ u32 tone_idx = 0; -+ u8 set_result = PHYDM_SET_SUCCESS; -+ u8 rpt = 0; -+ -+ if (enable == FUNC_DISABLE) { -+ phydm_nbi_reset_jgr3(dm); -+ set_result = PHYDM_SET_SUCCESS; -+ } else { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[Set NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", -+ ch, bw, f_intf, -+ (((sec_ch == PHYDM_DONT_CARE) || (bw == 20) || -+ (ch > 14)) ? "Don't care" : -+ (sec_ch == PHYDM_ABOVE) ? "H" : "L")); -+ -+ /*@calculate fc*/ -+ if (phydm_find_fc(dm, ch, bw, sec_ch, &fc) == PHYDM_SET_FAIL) { -+ set_result = PHYDM_SET_FAIL; -+ } else { -+ /*@calculate interference distance*/ -+ rpt = phydm_find_intf_distance_jgr3(dm, bw, fc, f_intf, -+ &tone_idx); -+ if (rpt == PHYDM_SET_SUCCESS) { -+ if (f_intf >= 1000 * fc) -+ direction = FREQ_POSITIVE; -+ else -+ direction = FREQ_NEGATIVE; -+ -+ phydm_set_nbi_reg_jgr3(dm, tone_idx, direction, -+ path); -+ set_result = PHYDM_SET_SUCCESS; -+ } else { -+ set_result = PHYDM_SET_NO_NEED; -+ } -+ } -+ } -+ -+ if (set_result == PHYDM_SET_SUCCESS) -+ phydm_nbi_enable_jgr3(dm, enable, path); -+ else -+ phydm_nbi_enable_jgr3(dm, FUNC_DISABLE, path); -+ -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ odm_set_bb_reg(dm, R_0x1d3c, BIT(19), 0); -+ -+ return set_result; -+} -+ -+void phydm_set_nbi_reg_jgr3(void *dm_void, u32 tone_idx_tmp, u8 tone_direction, -+ u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 reg_tmp_value = 0; -+ u32 tone_num = 64; -+ u32 addr = 0; -+ u8 rf_bw = 0; -+ -+ rf_bw = odm_read_1byte(dm, R_0x9b0); -+ if (((rf_bw & 0xc) >> 2) == 0x2) -+ tone_num = 128; /* RF80 : tone-1 at tone_idx=255 */ -+ else -+ tone_num = 64; /* RF20/40 : tone-1 at tone_idx=127 */ -+ -+ if (tone_direction == FREQ_POSITIVE) { -+ if (tone_idx_tmp >= (tone_num - 1)) -+ tone_idx_tmp = (tone_num - 1); -+ } else { -+ if (tone_idx_tmp >= tone_num) -+ tone_idx_tmp = tone_num; -+ -+ tone_idx_tmp = (tone_num << 1) - tone_idx_tmp; -+ } -+ /*Mark the tone idx for Packet detection*/ -+ #if RTL8814B_SUPPORT -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ odm_set_bb_reg(dm, R_0xc24, 0xff, 0xff); -+ if ((*dm->channel == 5) && -+ (*dm->band_width == CHANNEL_WIDTH_40)) -+ odm_set_bb_reg(dm, R_0xc24, 0xff00, 0x1a); -+ else -+ odm_set_bb_reg(dm, R_0xc24, 0xff00, tone_idx_tmp); -+ } -+ #endif -+ switch (path) { -+ case RF_PATH_A: -+ odm_set_bb_reg(dm, R_0x1944, 0x001FF000, tone_idx_tmp); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set tone idx[%d]:PATH-A = ((0x%x))\n", -+ tone_idx_tmp, tone_idx_tmp); -+ break; -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case RF_PATH_B: -+ odm_set_bb_reg(dm, R_0x4044, 0x001FF000, tone_idx_tmp); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set tone idx[%d]:PATH-B = ((0x%x))\n", -+ tone_idx_tmp, tone_idx_tmp); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case RF_PATH_C: -+ odm_set_bb_reg(dm, R_0x5044, 0x001FF000, tone_idx_tmp); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set tone idx[%d]:PATH-C = ((0x%x))\n", -+ tone_idx_tmp, tone_idx_tmp); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case RF_PATH_D: -+ odm_set_bb_reg(dm, R_0x5144, 0x001FF000, tone_idx_tmp); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "Set tone idx[%d]:PATH-D = ((0x%x))\n", -+ tone_idx_tmp, tone_idx_tmp); -+ break; -+ #endif -+ default: -+ break; -+ } -+} -+ -+void phydm_nbi_enable_jgr3(void *dm_void, u32 enable, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean val = false; -+ -+ val = (enable == FUNC_ENABLE) ? true : false; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "Enable NBI=%d\n", val); -+ -+ if (dm->support_ic_type & ODM_RTL8814B) { -+ odm_set_bb_reg(dm, R_0x1d3c, BIT(19), val); -+ odm_set_bb_reg(dm, R_0x818, BIT(3), val); -+ } else if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F)) { -+ odm_set_bb_reg(dm, R_0x818, BIT(3), !val); -+ } -+ odm_set_bb_reg(dm, R_0x818, BIT(11), val); -+ odm_set_bb_reg(dm, R_0x1d3c, 0x78000000, 0xf); -+ -+ if (enable == FUNC_ENABLE) { -+ switch (path) { -+ case RF_PATH_A: -+ odm_set_bb_reg(dm, R_0x1940, BIT(31), val); -+ break; -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case RF_PATH_B: -+ odm_set_bb_reg(dm, R_0x4040, BIT(31), val); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case RF_PATH_C: -+ odm_set_bb_reg(dm, R_0x5040, BIT(31), val); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case RF_PATH_D: -+ odm_set_bb_reg(dm, R_0x5140, BIT(31), val); -+ break; -+ #endif -+ default: -+ break; -+ } -+ } else { -+ odm_set_bb_reg(dm, R_0x1940, BIT(31), val); -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ odm_set_bb_reg(dm, R_0x4040, BIT(31), val); -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ odm_set_bb_reg(dm, R_0x5040, BIT(31), val); -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ odm_set_bb_reg(dm, R_0x5140, BIT(31), val); -+ #endif -+ #if RTL8812F_SUPPORT -+ if (dm->support_ic_type & ODM_RTL8812F) { -+ odm_set_bb_reg(dm, R_0x818, BIT(3), val); -+ odm_set_bb_reg(dm, R_0x1d3c, 0x78000000, 0x0); -+ } -+ #endif -+ } -+} -+ -+u8 phydm_phystat_rpt_jgr3(void *dm_void, enum phystat_rpt info, -+ enum rf_path ant_path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ s8 evm_org, cfo_org, rxsnr_org; -+ u8 i, return_info = 0, tmp_lsb = 0, tmp_msb = 0, tmp_info = 0; -+ -+ /* Update the status for each pkt */ -+ odm_set_bb_reg(dm, R_0x8c4, 0xfff000, 0x448); -+ odm_set_bb_reg(dm, R_0x8c0, MASKLWORD, 0x4001); -+ /* PHY status Page1 */ -+ odm_set_bb_reg(dm, R_0x8c0, 0x3C00000, 0x1); -+ /*choose debug port for phystatus */ -+ odm_set_bb_reg(dm, R_0x1c3c, 0xFFF00, 0x380); -+ -+ if (info == PHY_PWDB) { -+ /* Choose the report of the diff path */ -+ if (ant_path == RF_PATH_A) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x1); -+ else if (ant_path == RF_PATH_B) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x2); -+ else if (ant_path == RF_PATH_C) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x3); -+ else if (ant_path == RF_PATH_D) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x4); -+ } else if (info == PHY_EVM) { -+ /* Choose the report of the diff path */ -+ if (ant_path == RF_PATH_A) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x10); -+ else if (ant_path == RF_PATH_B) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x11); -+ else if (ant_path == RF_PATH_C) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x12); -+ else if (ant_path == RF_PATH_D) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x13); -+ return_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xff); -+ } else if (info == PHY_CFO) { -+ /* Choose the report of the diff path */ -+ if (ant_path == RF_PATH_A) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x14); -+ else if (ant_path == RF_PATH_B) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x15); -+ else if (ant_path == RF_PATH_C) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x16); -+ else if (ant_path == RF_PATH_D) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x17); -+ return_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xff); -+ } else if (info == PHY_RXSNR) { -+ /* Choose the report of the diff path */ -+ if (ant_path == RF_PATH_A) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x18); -+ else if (ant_path == RF_PATH_B) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x19); -+ else if (ant_path == RF_PATH_C) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x1a); -+ else if (ant_path == RF_PATH_D) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x1b); -+ return_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xff); -+ } else if (info == PHY_LGAIN) { -+ /* choose page */ -+ odm_set_bb_reg(dm, R_0x8c0, 0x3c00000, 0x2); -+ /* Choose the report of the diff path */ -+ if (ant_path == RF_PATH_A) { -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0xd); -+ tmp_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0x3f); -+ return_info = tmp_info; -+ } else if (ant_path == RF_PATH_B) { -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0xd); -+ tmp_lsb = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xc0); -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0xe); -+ tmp_msb = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xf); -+ tmp_info |= (tmp_msb << 2) | tmp_lsb; -+ return_info = tmp_info; -+ } else if (ant_path == RF_PATH_C) { -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0xe); -+ tmp_lsb = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xf0); -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0xf); -+ tmp_msb = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0x3); -+ tmp_info |= (tmp_msb << 4) | tmp_lsb; -+ return_info = tmp_info; -+ } else if (ant_path == RF_PATH_D) { -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x10); -+ tmp_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0x3f); -+ return_info = tmp_info; -+ } -+ } else if (info == PHY_HT_AAGC_GAIN) { -+ /* choose page */ -+ odm_set_bb_reg(dm, R_0x8c0, 0x3c00000, 0x2); -+ /* Choose the report of the diff path */ -+ if (ant_path == RF_PATH_A) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x12); -+ else if (ant_path == RF_PATH_B) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x13); -+ else if (ant_path == RF_PATH_C) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x14); -+ else if (ant_path == RF_PATH_D) -+ odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x15); -+ return_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xff); -+ } -+ return return_info; -+} -+ -+void phydm_ex_hal8814b_wifi_only_hw_config(void *dm_void) -+{ -+ /*BB control*/ -+ /*halwifionly_phy_set_bb_reg(pwifionlycfg, 0x4c, 0x01800000, 0x2);*/ -+ /*SW control*/ -+ /*halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcb4, 0xff, 0x77);*/ -+ /*antenna mux switch */ -+ /*halwifionly_phy_set_bb_reg(pwifionlycfg, 0x974, 0x300, 0x3);*/ -+ -+ /*halwifionly_phy_set_bb_reg(pwifionlycfg, 0x1990, 0x300, 0x0);*/ -+ -+ /*halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcbc, 0x80000, 0x0);*/ -+ /*switch to WL side controller and gnt_wl gnt_bt debug signal */ -+ /*halwifionly_phy_set_bb_reg(pwifionlycfg, 0x70, 0xff000000, 0x0e);*/ -+ /*gnt_wl=1 , gnt_bt=0*/ -+ /*halwifionly_phy_set_bb_reg(pwifionlycfg, 0x1704, 0xffffffff, -+ * 0x7700); -+ */ -+ /*halwifionly_phy_set_bb_reg(pwifionlycfg, 0x1700, 0xffffffff, -+ * 0xc00f0038); -+ */ -+} -+ -+void phydm_user_position_for_sniffer(void *dm_void, u8 user_position) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /* user position valid */ -+ odm_set_bb_reg(dm, R_0xa68, BIT(17), 1); -+ /* Select user seat from pmac */ -+ odm_set_bb_reg(dm, R_0xa68, BIT(16), 1); -+ /*user seat*/ -+ odm_set_bb_reg(dm, R_0xa68, (BIT(19) | BIT(18)), user_position); -+} -+ -+boolean -+phydm_bb_ctrl_txagc_ofst_jgr3(void *dm_void, s8 pw_offset, /*@(unit: dB)*/ -+ u8 add_half_db /*@(+0.5 dB)*/) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ s8 pw_idx = pw_offset * 4; /*@ 7Bit, 0.25dB unit*/ -+ -+ if (pw_offset < -16 || pw_offset > 15) { -+ pr_debug("[Warning][%s]Ofst error=%d", __func__, pw_offset); -+ return false; -+ } -+ -+ if (add_half_db) -+ pw_idx += 2; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "Pw_ofst=0x%x\n", pw_idx); -+ -+ odm_set_bb_reg(dm, R_0x18a0, 0x3f, pw_idx); -+ -+ if (dm->num_rf_path >= 2) -+ odm_set_bb_reg(dm, R_0x41a0, 0x3f, pw_idx); -+ -+ if (dm->num_rf_path >= 3) -+ odm_set_bb_reg(dm, R_0x52a0, 0x3f, pw_idx); -+ -+ if (dm->num_rf_path >= 4) -+ odm_set_bb_reg(dm, R_0x53a0, 0x3f, pw_idx); -+ -+ return true; -+} -+ -+#endif -+u8 phydm_nbi_setting(void *dm_void, u32 enable, u32 ch, u32 bw, u32 f_intf, -+ u32 sec_ch) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 fc = 2412; -+ u8 direction = FREQ_POSITIVE; -+ u32 tone_idx = 0; -+ u8 set_result = PHYDM_SET_SUCCESS; -+ u8 rpt = 0; -+ -+ if (enable == FUNC_DISABLE) { -+ set_result = PHYDM_SET_SUCCESS; -+ } else { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "[Set NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", -+ ch, bw, f_intf, -+ (((sec_ch == PHYDM_DONT_CARE) || (bw == 20) || -+ (ch > 14)) ? "Don't care" : -+ (sec_ch == PHYDM_ABOVE) ? "H" : "L")); -+ -+ /*@calculate fc*/ -+ if (phydm_find_fc(dm, ch, bw, sec_ch, &fc) == PHYDM_SET_FAIL) { -+ set_result = PHYDM_SET_FAIL; -+ } else { -+ /*@calculate interference distance*/ -+ rpt = phydm_find_intf_distance(dm, bw, fc, f_intf, -+ &tone_idx); -+ if (rpt == PHYDM_SET_SUCCESS) { -+ if (f_intf >= fc) -+ direction = FREQ_POSITIVE; -+ else -+ direction = FREQ_NEGATIVE; -+ -+ phydm_set_nbi_reg(dm, tone_idx, bw); -+ -+ set_result = PHYDM_SET_SUCCESS; -+ } else { -+ set_result = PHYDM_SET_NO_NEED; -+ } -+ } -+ } -+ -+ if (set_result == PHYDM_SET_SUCCESS) -+ phydm_nbi_enable(dm, enable); -+ else -+ phydm_nbi_enable(dm, FUNC_DISABLE); -+ -+ return set_result; -+} -+ -+void phydm_nbi_debug(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 val[10] = {0}; -+ char help[] = "-h"; -+ u8 i = 0, input_idx = 0, idx_lmt = 0; -+ u32 enable = 0; /*@function enable*/ -+ u32 ch = 0; -+ u32 bw = 0; -+ u32 f_int = 0; /*@interference frequency*/ -+ u32 sec_ch = 0; /*secondary channel*/ -+ u8 rpt = 0; -+ u8 path = 0; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ idx_lmt = 6; -+ else -+ idx_lmt = 5; -+ for (i = 0; i < idx_lmt; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &val[i]); -+ input_idx++; -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ enable = val[0]; -+ ch = val[1]; -+ bw = val[2]; -+ f_int = val[3]; -+ sec_ch = val[4]; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ path = (u8)val[5]; -+ #endif -+ -+ if ((strcmp(input[1], help) == 0)) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{en:1 Dis:2} {ch} {BW:20/40/80} {f_intf(khz)} {Scnd_CH(L=1, H=2)} {Path:A~D(0~3)}\n"); -+ else -+ #endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{en:1 Dis:2} {ch} {BW:20/40/80} {f_intf(khz)} {Scnd_CH(L=1, H=2)}\n"); -+ *_used = used; -+ *_out_len = out_len; -+ return; -+ } else if (val[0] == FUNC_ENABLE) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Enable NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", -+ ch, bw, f_int, -+ ((sec_ch == PHYDM_DONT_CARE) || -+ (bw == 20) || (ch > 14)) ? "Don't care" : -+ ((sec_ch == PHYDM_ABOVE) ? "H" : "L")); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ rpt = phydm_nbi_setting_jgr3(dm, enable, ch, bw, f_int, -+ sec_ch, path); -+ else -+ #endif -+ rpt = phydm_nbi_setting(dm, enable, ch, bw, f_int, -+ sec_ch); -+ } else if (val[0] == FUNC_DISABLE) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Disable NBI]\n"); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ rpt = phydm_nbi_setting_jgr3(dm, enable, ch, bw, f_int, -+ sec_ch, path); -+ else -+ #endif -+ rpt = phydm_nbi_setting(dm, enable, ch, bw, f_int, -+ sec_ch); -+ } else { -+ rpt = PHYDM_SET_FAIL; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[NBI set result: %s]\n", -+ (rpt == PHYDM_SET_SUCCESS) ? "Success" : -+ ((rpt == PHYDM_SET_NO_NEED) ? "No need" : "Error")); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_csi_debug(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 val[10] = {0}; -+ char help[] = "-h"; -+ u8 i = 0, input_idx = 0, idx_lmt = 0; -+ u32 enable = 0; /*@function enable*/ -+ u32 ch = 0; -+ u32 bw = 0; -+ u32 f_int = 0; /*@interference frequency*/ -+ u32 sec_ch = 0; /*secondary channel*/ -+ u8 rpt = 0; -+ u8 wgt = 0; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ idx_lmt = 6; -+ else -+ idx_lmt = 5; -+ -+ for (i = 0; i < idx_lmt; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &val[i]); -+ input_idx++; -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ enable = val[0]; -+ ch = val[1]; -+ bw = val[2]; -+ f_int = val[3]; -+ sec_ch = val[4]; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ wgt = (u8)val[5]; -+ #endif -+ -+ if ((strcmp(input[1], help) == 0)) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{en:1 Dis:2} {ch} {BW:20/40/80} {f_intf(KHz)} {Scnd_CH(L=1, H=2)}\n{wgt:(7:3/4),(6~1: 1/2 ~ 1/64),(0:0)}\n"); -+ else -+ #endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{en:1 Dis:2} {ch} {BW:20/40/80} {f_intf(Mhz)} {Scnd_CH(L=1, H=2)}\n"); -+ -+ *_used = used; -+ *_out_len = out_len; -+ return; -+ -+ } else if (val[0] == FUNC_ENABLE) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Enable CSI MASK] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", -+ ch, bw, f_int, -+ (ch > 14) ? "Don't care" : -+ (((sec_ch == PHYDM_DONT_CARE) || -+ (bw == 20) || (ch > 14)) ? "H" : "L")); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ rpt = phydm_csi_mask_setting_jgr3(dm, enable, ch, bw, -+ f_int, sec_ch, wgt); -+ else -+ #endif -+ rpt = phydm_csi_mask_setting(dm, enable, ch, bw, f_int, -+ sec_ch); -+ } else if (val[0] == FUNC_DISABLE) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Disable CSI MASK]\n"); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ rpt = phydm_csi_mask_setting_jgr3(dm, enable, ch, bw, -+ f_int, sec_ch, wgt); -+ else -+ #endif -+ rpt = phydm_csi_mask_setting(dm, enable, ch, bw, f_int, -+ sec_ch); -+ } else { -+ rpt = PHYDM_SET_FAIL; -+ } -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[CSI MASK set result: %s]\n", -+ (rpt == PHYDM_SET_SUCCESS) ? "Success" : -+ ((rpt == PHYDM_SET_NO_NEED) ? "No need" : "Error")); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_stop_ck320(void *dm_void, u8 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 val = enable ? 1 : 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ odm_set_bb_reg(dm, R_0x8b4, BIT(6), val); -+ } else { -+ if (dm->support_ic_type & ODM_IC_N_2SS) /*N-2SS*/ -+ odm_set_bb_reg(dm, R_0x87c, BIT(29), val); -+ else /*N-1SS*/ -+ odm_set_bb_reg(dm, R_0x87c, BIT(31), val); -+ } -+} -+ -+boolean -+phydm_bb_ctrl_txagc_ofst(void *dm_void, s8 pw_offset, /*@(unit: dB)*/ -+ u8 add_half_db /*@(+0.5 dB)*/) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ s8 pw_idx; -+ u8 offset_bit_num = 0; -+ -+ if (dm->support_ic_type & N_IC_TX_OFFEST_5_BIT) { -+ /*@ 5Bit, 0.5dB unit*/ -+ if (pw_offset < -8 || pw_offset > 7) { -+ pr_debug("[Warning][%s] Ofst=%d", __func__, pw_offset); -+ return false; -+ } -+ offset_bit_num = 5; -+ } else { -+ if (pw_offset < -16 || pw_offset > 15) { -+ pr_debug("[Warning][%s] Ofst=%d", __func__, pw_offset); -+ return false; -+ } -+ if (dm->support_ic_type & N_IC_TX_OFFEST_7_BIT) { -+ /*@ 7Bit, 0.25dB unit*/ -+ offset_bit_num = 7; -+ } else { -+ /*@ 6Bit, 0.5dB unit*/ -+ offset_bit_num = 6; -+ } -+ } -+ -+ pw_idx = (offset_bit_num == 7) ? pw_offset * 4 : pw_offset * 2; -+ -+ if (add_half_db) -+ pw_idx = (offset_bit_num == 7) ? pw_idx + 2 : pw_idx + 1; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "Pw_ofst=0x%x\n", pw_idx); -+ -+ switch (dm->ic_ip_series) { -+ case PHYDM_IC_AC: -+ odm_set_bb_reg(dm, R_0x8b4, 0x3f, pw_idx); /*6Bit*/ -+ break; -+ case PHYDM_IC_N: -+ if (offset_bit_num == 5) { -+ odm_set_bb_reg(dm, R_0x80c, 0x1f00, pw_idx); -+ if (dm->num_rf_path >= 2) -+ odm_set_bb_reg(dm, R_0x80c, 0x3e000, pw_idx); -+ } else if (offset_bit_num == 6) { -+ odm_set_bb_reg(dm, R_0x80c, 0x3f00, pw_idx); -+ if (dm->num_rf_path >= 2) -+ odm_set_bb_reg(dm, R_0x80c, 0xfc000, pw_idx); -+ } else { /*7Bit*/ -+ odm_set_bb_reg(dm, R_0x80c, 0x7f00, pw_idx); -+ if (dm->num_rf_path >= 2) -+ odm_set_bb_reg(dm, R_0x80c, 0x3f8000, pw_idx); -+ } -+ break; -+ } -+ return true; -+} -+ -+boolean -+phydm_set_bb_txagc_offset(void *dm_void, s8 pw_offset, /*@(unit: dB)*/ -+ u8 add_half_db /*@(+0.5 dB)*/) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean rpt = false; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "power_offset=%d, add_half_db =%d\n", -+ pw_offset, add_half_db); -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ rpt = phydm_bb_ctrl_txagc_ofst_jgr3(dm, pw_offset, add_half_db); -+ } else -+#endif -+ { -+ rpt = phydm_bb_ctrl_txagc_ofst(dm, pw_offset, add_half_db); -+ } -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "TX AGC Offset set_success=%d", rpt); -+ -+ return rpt; -+} -+ -+#ifdef PHYDM_COMMON_API_SUPPORT -+void phydm_reset_txagc(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 r_txagc_cck[4] = {R_0x18a0, R_0x41a0, R_0x52a0, R_0x53a0}; -+ u32 r_txagc_ofdm[4] = {R_0x18e8, R_0x41e8, R_0x52e8, R_0x53e8}; -+ u32 r_txagc_diff = R_0x3a00; -+ u8 i = 0; -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) { -+ PHYDM_DBG(dm, ODM_COMP_API, "Only for JGR3 ICs!\n"); -+ return; -+ } -+ -+ for (i = RF_PATH_A; i < dm->num_rf_path; i++) { -+ odm_set_bb_reg(dm, r_txagc_cck[i], 0x7f0000, 0x0); -+ odm_set_bb_reg(dm, r_txagc_ofdm[i], 0x1fc00, 0x0); -+ } -+ -+ for (i = 0; i <= ODM_RATEVHTSS4MCS6; i = i + 4) -+ odm_set_bb_reg(dm, r_txagc_diff + i, MASKDWORD, 0x0); -+} -+boolean -+phydm_api_shift_txagc(void *dm_void, u32 pwr_offset, enum rf_path path, -+ boolean is_positive) { -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean ret = false; -+ u32 txagc_cck = 0; -+ u32 txagc_ofdm = 0; -+ u32 r_txagc_ofdm[4] = {R_0x18e8, R_0x41e8, R_0x52e8, R_0x53e8}; -+ u32 r_txagc_cck[4] = {R_0x18a0, R_0x41a0, R_0x52a0, R_0x53a0}; -+ u32 r_new_txagc[1] = {R_0x4308}; -+ -+ #if (RTL8822C_SUPPORT || RTL8812F_SUPPORT || RTL8197G_SUPPORT) -+ if (dm->support_ic_type & -+ (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G)) { -+ if (path > RF_PATH_B) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "Unsupported path (%d)\n", -+ path); -+ return false; -+ } -+ txagc_cck = (u8)odm_get_bb_reg(dm, r_txagc_cck[path], -+ 0x7F0000); -+ txagc_ofdm = (u8)odm_get_bb_reg(dm, r_txagc_ofdm[path], -+ 0x1FC00); -+ if (is_positive) { -+ if (((txagc_cck + pwr_offset) > 127) || -+ ((txagc_ofdm + pwr_offset) > 127)) -+ return false; -+ -+ txagc_cck += pwr_offset; -+ txagc_ofdm += pwr_offset; -+ } else { -+ if (pwr_offset > txagc_cck || pwr_offset > txagc_ofdm) -+ return false; -+ -+ txagc_cck -= pwr_offset; -+ txagc_ofdm -= pwr_offset; -+ } -+ #if (RTL8822C_SUPPORT) -+ ret = config_phydm_write_txagc_ref_8822c(dm, (u8)txagc_cck, -+ path, PDM_CCK); -+ ret &= config_phydm_write_txagc_ref_8822c(dm, (u8)txagc_ofdm, -+ path, PDM_OFDM); -+ #endif -+ #if (RTL8812F_SUPPORT) -+ ret = config_phydm_write_txagc_ref_8812f(dm, (u8)txagc_cck, -+ path, PDM_CCK); -+ ret &= config_phydm_write_txagc_ref_8812f(dm, (u8)txagc_ofdm, -+ path, PDM_OFDM); -+ #endif -+ #if (RTL8197G_SUPPORT) -+ ret = config_phydm_write_txagc_ref_8197g(dm, (u8)txagc_cck, -+ path, PDM_CCK); -+ ret &= config_phydm_write_txagc_ref_8197g(dm, (u8)txagc_ofdm, -+ path, PDM_OFDM); -+ #endif -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "%s: path-%d txagc_cck_ref=%x txagc_ofdm_ref=0x%x\n", -+ __func__, path, txagc_cck, txagc_ofdm); -+ } -+ #endif -+ -+ #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+ if (dm->support_ic_type & -+ (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C)) { -+ if (path > RF_PATH_D) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "Unsupported path (%d)\n", -+ path); -+ return false; -+ } -+ txagc_cck = (u8)odm_get_bb_reg(dm, r_txagc_cck[path], -+ 0x7F0000); -+ txagc_ofdm = (u8)odm_get_bb_reg(dm, r_txagc_ofdm[path], -+ 0x1FC00); -+ if (is_positive) { -+ if (((txagc_cck + pwr_offset) > 127) || -+ ((txagc_ofdm + pwr_offset) > 127)) -+ return false; -+ -+ txagc_cck += pwr_offset; -+ txagc_ofdm += pwr_offset; -+ } else { -+ if (pwr_offset > txagc_cck || pwr_offset > txagc_ofdm) -+ return false; -+ -+ txagc_cck -= pwr_offset; -+ txagc_ofdm -= pwr_offset; -+ } -+ #if (RTL8198F_SUPPORT) -+ ret = config_phydm_write_txagc_ref_8198f(dm, (u8)txagc_cck, -+ path, PDM_CCK); -+ ret &= config_phydm_write_txagc_ref_8198f(dm, (u8)txagc_ofdm, -+ path, PDM_OFDM); -+ #endif -+ #if (RTL8814B_SUPPORT) -+ ret = config_phydm_write_txagc_ref_8814b(dm, (u8)txagc_cck, -+ path, PDM_CCK); -+ ret &= config_phydm_write_txagc_ref_8814b(dm, (u8)txagc_ofdm, -+ path, PDM_OFDM); -+ #endif -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "%s: path-%d txagc_cck_ref=%x txagc_ofdm_ref=0x%x\n", -+ __func__, path, txagc_cck, txagc_ofdm); -+ } -+ #endif -+ -+ #if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8723F)) { -+ if (path > RF_PATH_A) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "Unsupported path (%d)\n", -+ path); -+ return false; -+ } -+ txagc_cck = (u8)odm_get_bb_reg(dm, r_new_txagc[path], -+ 0x0000007f); -+ txagc_ofdm = (u8)odm_get_bb_reg(dm, r_new_txagc[path], -+ 0x00007f00); -+ if (is_positive) { -+ if (((txagc_cck + pwr_offset) > 127) || -+ ((txagc_ofdm + pwr_offset) > 127)) -+ return false; -+ -+ txagc_cck += pwr_offset; -+ txagc_ofdm += pwr_offset; -+ } else { -+ if (pwr_offset > txagc_cck || pwr_offset > txagc_ofdm) -+ return false; -+ -+ txagc_cck -= pwr_offset; -+ txagc_ofdm -= pwr_offset; -+ } -+ #if (RTL8723F_SUPPORT) -+ ret = config_phydm_write_txagc_ref_8723f(dm, (u8)txagc_cck, -+ path, PDM_CCK); -+ ret &= config_phydm_write_txagc_ref_8723f(dm, (u8)txagc_ofdm, -+ path, PDM_OFDM); -+ #endif -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "%s: path-%d txagc_cck_ref=%x txagc_ofdm_ref=0x%x\n", -+ __func__, path, txagc_cck, txagc_ofdm); -+ } -+ #endif -+ -+ return ret; -+} -+ -+boolean -+phydm_api_set_txagc(void *dm_void, u32 pwr_idx, enum rf_path path, -+ u8 rate, boolean is_single_rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean ret = false; -+ #if (RTL8198F_SUPPORT || RTL8822C_SUPPORT || RTL8812F_SUPPORT ||\ -+ RTL8814B_SUPPORT || RTL8197G_SUPPORT || RTL8723F_SUPPORT) -+ u8 base = 0; -+ u8 txagc_tmp = 0; -+ s8 pw_by_rate_tmp = 0; -+ s8 pw_by_rate_new = 0; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ u8 i = 0; -+ #endif -+ -+#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT || RTL8195B_SUPPORT) -+ if (dm->support_ic_type & -+ (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8195B)) { -+ if (is_single_rate) { -+ #if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8822B) -+ ret = phydm_write_txagc_1byte_8822b(dm, pwr_idx, -+ path, rate); -+ #endif -+ -+ #if (RTL8821C_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8821C) -+ ret = phydm_write_txagc_1byte_8821c(dm, pwr_idx, -+ path, rate); -+ #endif -+ -+ #if (RTL8195B_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8195B) -+ ret = phydm_write_txagc_1byte_8195b(dm, pwr_idx, -+ path, rate); -+ #endif -+ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ set_current_tx_agc(dm->priv, path, rate, (u8)pwr_idx); -+ #endif -+ -+ } else { -+ #if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8822B) -+ ret = config_phydm_write_txagc_8822b(dm, -+ pwr_idx, -+ path, -+ rate); -+ #endif -+ -+ #if (RTL8821C_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8821C) -+ ret = config_phydm_write_txagc_8821c(dm, -+ pwr_idx, -+ path, -+ rate); -+ #endif -+ -+ #if (RTL8195B_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8195B) -+ ret = config_phydm_write_txagc_8195b(dm, -+ pwr_idx, -+ path, -+ rate); -+ #endif -+ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ for (i = 0; i < 4; i++) -+ set_current_tx_agc(dm->priv, path, (rate + i), -+ (u8)pwr_idx); -+ #endif -+ } -+ } -+#endif -+ -+#if (RTL8198F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8198F) { -+ if (rate < 0x4) -+ txagc_tmp = config_phydm_read_txagc_8198f(dm, path, -+ rate, -+ PDM_CCK); -+ else -+ txagc_tmp = config_phydm_read_txagc_8198f(dm, path, -+ rate, -+ PDM_OFDM); -+ -+ pw_by_rate_tmp = config_phydm_read_txagc_diff_8198f(dm, rate); -+ base = txagc_tmp - pw_by_rate_tmp; -+ base = base & 0x7f; -+ if (DIFF_2((pwr_idx & 0x7f), base) > 64 || pwr_idx > 127) -+ return false; -+ -+ pw_by_rate_new = (s8)(pwr_idx - base); -+ ret = phydm_write_txagc_1byte_8198f(dm, pw_by_rate_new, rate); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", -+ __func__, path, rate, base, pw_by_rate_new); -+ } -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ if (rate < 0x4) -+ txagc_tmp = config_phydm_read_txagc_8822c(dm, path, -+ rate, -+ PDM_CCK); -+ else -+ txagc_tmp = config_phydm_read_txagc_8822c(dm, path, -+ rate, -+ PDM_OFDM); -+ -+ pw_by_rate_tmp = config_phydm_read_txagc_diff_8822c(dm, rate); -+ base = txagc_tmp - pw_by_rate_tmp; -+ base = base & 0x7f; -+ if (DIFF_2((pwr_idx & 0x7f), base) > 63 || pwr_idx > 127) -+ return false; -+ -+ pw_by_rate_new = (s8)(pwr_idx - base); -+ ret = phydm_write_txagc_1byte_8822c(dm, pw_by_rate_new, rate); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", -+ __func__, path, rate, base, pw_by_rate_new); -+ } -+#endif -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (rate < 0x4) -+ txagc_tmp = config_phydm_read_txagc_8814b(dm, path, -+ rate, -+ PDM_CCK); -+ else -+ txagc_tmp = config_phydm_read_txagc_8814b(dm, path, -+ rate, -+ PDM_OFDM); -+ -+ pw_by_rate_tmp = config_phydm_read_txagc_diff_8814b(dm, rate); -+ base = txagc_tmp - pw_by_rate_tmp; -+ base = base & 0x7f; -+ if (DIFF_2((pwr_idx & 0x7f), base) > 64) -+ return false; -+ -+ pw_by_rate_new = (s8)(pwr_idx - base); -+ ret = phydm_write_txagc_1byte_8814b(dm, pw_by_rate_new, rate); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", -+ __func__, path, rate, base, pw_by_rate_new); -+ } -+#endif -+ -+#if (RTL8812F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8812F) { -+ if (rate < 0x4) -+ txagc_tmp = config_phydm_read_txagc_8812f(dm, path, -+ rate, -+ PDM_CCK); -+ else -+ txagc_tmp = config_phydm_read_txagc_8812f(dm, path, -+ rate, -+ PDM_OFDM); -+ -+ pw_by_rate_tmp = config_phydm_read_txagc_diff_8812f(dm, rate); -+ base = txagc_tmp - pw_by_rate_tmp; -+ base = base & 0x7f; -+ if (DIFF_2((pwr_idx & 0x7f), base) > 63 || pwr_idx > 127) -+ return false; -+ -+ pw_by_rate_new = (s8)(pwr_idx - base); -+ ret = phydm_write_txagc_1byte_8812f(dm, pw_by_rate_new, rate); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", -+ __func__, path, rate, base, pw_by_rate_new); -+ } -+#endif -+ -+#if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197G) { -+ if (rate < 0x4) -+ txagc_tmp = config_phydm_read_txagc_8197g(dm, path, -+ rate, -+ PDM_CCK); -+ else -+ txagc_tmp = config_phydm_read_txagc_8197g(dm, path, -+ rate, -+ PDM_OFDM); -+ -+ pw_by_rate_tmp = config_phydm_read_txagc_diff_8197g(dm, rate); -+ base = txagc_tmp - pw_by_rate_tmp; -+ base = base & 0x7f; -+ if (DIFF_2((pwr_idx & 0x7f), base) > 63 || pwr_idx > 127) -+ return false; -+ -+ pw_by_rate_new = (s8)(pwr_idx - base); -+ ret = phydm_write_txagc_1byte_8197g(dm, pw_by_rate_new, rate); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", -+ __func__, path, rate, base, pw_by_rate_new); -+ } -+#endif -+#if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ if (rate < 0x4) -+ txagc_tmp = config_phydm_read_txagc_8723f(dm, path, -+ rate, -+ PDM_CCK); -+ else -+ txagc_tmp = config_phydm_read_txagc_8723f(dm, path, -+ rate, -+ PDM_OFDM); -+ -+ pw_by_rate_tmp = config_phydm_read_txagc_diff_8723f(dm, rate); -+ base = txagc_tmp - pw_by_rate_tmp; -+ base = base & 0x7f; -+ if (DIFF_2((pwr_idx & 0x7f), base) > 63 || pwr_idx > 127) -+ return false; -+ -+ pw_by_rate_new = (s8)(pwr_idx - base); -+ ret = phydm_write_txagc_1byte_8723f(dm, pw_by_rate_new, rate); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", -+ __func__, path, rate, base, pw_by_rate_new); -+ } -+#endif -+ -+#if (RTL8197F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197F) -+ ret = config_phydm_write_txagc_8197f(dm, pwr_idx, path, rate); -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8192F) -+ ret = config_phydm_write_txagc_8192f(dm, pwr_idx, path, rate); -+#endif -+ -+#if (RTL8721D_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8721D) -+ ret = config_phydm_write_txagc_8721d(dm, pwr_idx, path, rate); -+#endif -+#if (RTL8710C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8710C) -+ ret = config_phydm_write_txagc_8710c(dm, pwr_idx, path, rate); -+#endif -+ return ret; -+} -+ -+u8 phydm_api_get_txagc(void *dm_void, enum rf_path path, u8 hw_rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 ret = 0; -+ -+#if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8822B) -+ ret = config_phydm_read_txagc_8822b(dm, path, hw_rate); -+#endif -+ -+#if (RTL8197F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197F) -+ ret = config_phydm_read_txagc_8197f(dm, path, hw_rate); -+#endif -+ -+#if (RTL8821C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8821C) -+ ret = config_phydm_read_txagc_8821c(dm, path, hw_rate); -+#endif -+ -+#if (RTL8195B_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8195B) -+ ret = config_phydm_read_txagc_8195b(dm, path, hw_rate); -+#endif -+ -+/*@jj add 20170822*/ -+#if (RTL8192F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8192F) -+ ret = config_phydm_read_txagc_8192f(dm, path, hw_rate); -+#endif -+ -+#if (RTL8198F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8198F) { -+ if (hw_rate < 0x4) { -+ ret = config_phydm_read_txagc_8198f(dm, path, hw_rate, -+ PDM_CCK); -+ } else { -+ ret = config_phydm_read_txagc_8198f(dm, path, hw_rate, -+ PDM_OFDM); -+ } -+ } -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ if (hw_rate < 0x4) { -+ ret = config_phydm_read_txagc_8822c(dm, path, hw_rate, -+ PDM_CCK); -+ } else { -+ ret = config_phydm_read_txagc_8822c(dm, path, hw_rate, -+ PDM_OFDM); -+ } -+ } -+#endif -+ -+#if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ if (hw_rate < 0x4) { -+ ret = config_phydm_read_txagc_8723f(dm, path, hw_rate, -+ PDM_CCK); -+ } else { -+ ret = config_phydm_read_txagc_8723f(dm, path, hw_rate, -+ PDM_OFDM); -+ } -+ } -+#endif -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (hw_rate < 0x4) { -+ ret = config_phydm_read_txagc_8814b(dm, path, hw_rate, -+ PDM_CCK); -+ } else { -+ ret = config_phydm_read_txagc_8814b(dm, path, hw_rate, -+ PDM_OFDM); -+ } -+ } -+#endif -+ -+#if (RTL8812F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8812F) { -+ if (hw_rate < 0x4) { -+ ret = config_phydm_read_txagc_8812f(dm, path, hw_rate, -+ PDM_CCK); -+ } else { -+ ret = config_phydm_read_txagc_8812f(dm, path, hw_rate, -+ PDM_OFDM); -+ } -+ } -+#endif -+ -+#if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197G) { -+ if (hw_rate < 0x4) { -+ ret = config_phydm_read_txagc_8197g(dm, path, -+ hw_rate, -+ PDM_CCK); -+ } else { -+ ret = config_phydm_read_txagc_8197g(dm, path, -+ hw_rate, -+ PDM_OFDM); -+ } -+ } -+#endif -+ -+#if (RTL8721D_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8721D) -+ ret = config_phydm_read_txagc_8721d(dm, path, hw_rate); -+#endif -+#if (RTL8710C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8710C) -+ ret = config_phydm_read_txagc_8710c(dm, path, hw_rate); -+#endif -+ return ret; -+} -+ -+#if (RTL8822C_SUPPORT) -+void phydm_shift_rxagc_table(void *dm_void, boolean is_pos_shift, u8 sft) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ u8 j = 0; -+ u32 reg = 0; -+ u16 max_rf_gain = 0; -+ u16 min_rf_gain = 0; -+ -+ dm->is_agc_tab_pos_shift = is_pos_shift; -+ dm->agc_table_shift = sft; -+ -+ for (i = 0; i <= dm->agc_table_cnt; i++) { -+ max_rf_gain = dm->agc_rf_gain_ori[i][0]; -+ min_rf_gain = dm->agc_rf_gain_ori[i][63]; -+ -+ if (dm->support_ic_type & ODM_RTL8822C) -+ dm->l_bnd_detect[i] = false; -+ -+ for (j = 0; j < 64; j++) { -+ if (is_pos_shift) { -+ if (j < sft) -+ reg = (max_rf_gain & 0x3ff); -+ else -+ reg = (dm->agc_rf_gain_ori[i][j - sft] & -+ 0x3ff); -+ } else { -+ if (j > 63 - sft) -+ reg = (min_rf_gain & 0x3ff); -+ -+ else -+ reg = (dm->agc_rf_gain_ori[i][j + sft] & -+ 0x3ff); -+ } -+ dm->agc_rf_gain[i][j] = (u16)(reg & 0x3ff); -+ -+ reg |= (j & 0x3f) << 16;/*mp_gain_idx*/ -+ reg |= (i & 0xf) << 22;/*table*/ -+ reg |= BIT(29) | BIT(28);/*write en*/ -+ odm_set_bb_reg(dm, R_0x1d90, MASKDWORD, reg); -+ } -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8822C) -+ odm_set_bb_reg(dm, R_0x828, 0xf8, L_BND_DEFAULT_8822C); -+} -+#endif -+ -+boolean -+phydm_api_switch_bw_channel(void *dm_void, u8 ch, u8 pri_ch, -+ enum channel_width bw) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean ret = false; -+ -+ switch (dm->support_ic_type) { -+#if (RTL8822B_SUPPORT) -+ case ODM_RTL8822B: -+ ret = config_phydm_switch_channel_bw_8822b(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8197F_SUPPORT) -+ case ODM_RTL8197F: -+ ret = config_phydm_switch_channel_bw_8197f(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8821C_SUPPORT) -+ case ODM_RTL8821C: -+ ret = config_phydm_switch_channel_bw_8821c(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8195B_SUPPORT) -+ case ODM_RTL8195B: -+ ret = config_phydm_switch_channel_bw_8195b(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ case ODM_RTL8192F: -+ ret = config_phydm_switch_channel_bw_8192f(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8198F_SUPPORT) -+ case ODM_RTL8198F: -+ ret = config_phydm_switch_channel_bw_8198f(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ case ODM_RTL8822C: -+ ret = config_phydm_switch_channel_bw_8822c(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8723F_SUPPORT) -+ case ODM_RTL8723F: -+ ret = config_phydm_switch_channel_bw_8723f(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8814B_SUPPORT) -+ case ODM_RTL8814B: -+ case ODM_RTL8814C: -+ ret = config_phydm_switch_channel_bw_8814b(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8812F_SUPPORT) -+ case ODM_RTL8812F: -+ ret = config_phydm_switch_channel_bw_8812f(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8197G_SUPPORT) -+ case ODM_RTL8197G: -+ ret = config_phydm_switch_channel_bw_8197g(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+#if (RTL8721D_SUPPORT) -+ case ODM_RTL8721D: -+ ret = config_phydm_switch_channel_bw_8721d(dm, ch, pri_ch, bw); -+ break; -+#endif -+#if (RTL8710C_SUPPORT) -+ case ODM_RTL8710C: -+ ret = config_phydm_switch_channel_bw_8710c(dm, ch, pri_ch, bw); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ return ret; -+} -+ -+boolean -+phydm_api_trx_mode(void *dm_void, enum bb_path tx_path, enum bb_path rx_path, -+ enum bb_path tx_path_ctrl) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean ret = false; -+ boolean is_2tx = false; -+ -+ if (tx_path_ctrl == BB_PATH_AB) -+ is_2tx = true; -+ -+ switch (dm->support_ic_type) { -+ #if (RTL8822B_SUPPORT) -+ case ODM_RTL8822B: -+ ret = config_phydm_trx_mode_8822b(dm, tx_path, rx_path, -+ tx_path_ctrl); -+ break; -+ #endif -+ -+ #if (RTL8197F_SUPPORT) -+ case ODM_RTL8197F: -+ ret = config_phydm_trx_mode_8197f(dm, tx_path, rx_path, is_2tx); -+ break; -+ #endif -+ -+ #if (RTL8192F_SUPPORT) -+ case ODM_RTL8192F: -+ ret = config_phydm_trx_mode_8192f(dm, tx_path, rx_path, -+ tx_path_ctrl); -+ break; -+ #endif -+ -+ #if (RTL8198F_SUPPORT) -+ case ODM_RTL8198F: -+ ret = config_phydm_trx_mode_8198f(dm, tx_path, rx_path, is_2tx); -+ break; -+ #endif -+ -+ #if (RTL8814B_SUPPORT) -+ case ODM_RTL8814B: -+ case ODM_RTL8814C: -+ ret = config_phydm_trx_mode_8814b(dm, tx_path, rx_path); -+ break; -+ #endif -+ -+ #if (RTL8822C_SUPPORT) -+ case ODM_RTL8822C: -+ ret = config_phydm_trx_mode_8822c(dm, tx_path, rx_path, -+ tx_path_ctrl); -+ break; -+ #endif -+ -+ #if (RTL8723F_SUPPORT) -+ case ODM_RTL8723F: -+ ret = config_phydm_trx_mode_8723f(dm, tx_path, rx_path, -+ tx_path_ctrl); -+ break; -+ #endif -+ -+ #if (RTL8812F_SUPPORT) -+ case ODM_RTL8812F: -+ ret = config_phydm_trx_mode_8812f(dm, tx_path, rx_path, is_2tx); -+ break; -+ #endif -+ -+ #if (RTL8197G_SUPPORT) -+ case ODM_RTL8197G: -+ ret = config_phydm_trx_mode_8197g(dm, tx_path, rx_path, is_2tx); -+ break; -+ #endif -+ -+ #if (RTL8721D_SUPPORT) -+ case ODM_RTL8721D: -+ ret = config_phydm_trx_mode_8721d(dm, tx_path, rx_path, is_2tx); -+ break; -+ #endif -+ -+ #if (RTL8710C_SUPPORT) -+ case ODM_RTL8710C: -+ ret = config_phydm_trx_mode_8710c(dm, tx_path, rx_path, is_2tx); -+ break; -+ #endif -+ } -+ return ret; -+} -+#endif -+ -+#ifdef PHYDM_COMMON_API_NOT_SUPPORT -+u8 config_phydm_read_txagc_n(void *dm_void, enum rf_path path, u8 hw_rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 read_back_data = INVALID_TXAGC_DATA; -+ u32 reg_txagc; -+ u32 reg_mask; -+ /* This function is for 92E/88E etc... */ -+ /* @Input need to be HW rate index, not driver rate index!!!! */ -+ -+ /* @Error handling */ -+ if (path > RF_PATH_B || hw_rate > ODM_RATEMCS15) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s: unsupported path (%d)\n", -+ __func__, path); -+ return INVALID_TXAGC_DATA; -+ } -+ -+ if (path == RF_PATH_A) { -+ switch (hw_rate) { -+ case ODM_RATE1M: -+ reg_txagc = R_0xe08; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATE2M: -+ reg_txagc = R_0x86c; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATE5_5M: -+ reg_txagc = R_0x86c; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATE11M: -+ reg_txagc = R_0x86c; -+ reg_mask = 0x7f000000; -+ break; -+ -+ case ODM_RATE6M: -+ reg_txagc = R_0xe00; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATE9M: -+ reg_txagc = R_0xe00; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATE12M: -+ reg_txagc = R_0xe00; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATE18M: -+ reg_txagc = R_0xe00; -+ reg_mask = 0x7f000000; -+ break; -+ case ODM_RATE24M: -+ reg_txagc = R_0xe04; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATE36M: -+ reg_txagc = R_0xe04; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATE48M: -+ reg_txagc = R_0xe04; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATE54M: -+ reg_txagc = R_0xe04; -+ reg_mask = 0x7f000000; -+ break; -+ -+ case ODM_RATEMCS0: -+ reg_txagc = R_0xe10; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATEMCS1: -+ reg_txagc = R_0xe10; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATEMCS2: -+ reg_txagc = R_0xe10; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATEMCS3: -+ reg_txagc = R_0xe10; -+ reg_mask = 0x7f000000; -+ break; -+ case ODM_RATEMCS4: -+ reg_txagc = R_0xe14; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATEMCS5: -+ reg_txagc = R_0xe14; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATEMCS6: -+ reg_txagc = R_0xe14; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATEMCS7: -+ reg_txagc = R_0xe14; -+ reg_mask = 0x7f000000; -+ break; -+ case ODM_RATEMCS8: -+ reg_txagc = R_0xe18; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATEMCS9: -+ reg_txagc = R_0xe18; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATEMCS10: -+ reg_txagc = R_0xe18; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATEMCS11: -+ reg_txagc = R_0xe18; -+ reg_mask = 0x7f000000; -+ break; -+ case ODM_RATEMCS12: -+ reg_txagc = R_0xe1c; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATEMCS13: -+ reg_txagc = R_0xe1c; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATEMCS14: -+ reg_txagc = R_0xe1c; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATEMCS15: -+ reg_txagc = R_0xe1c; -+ reg_mask = 0x7f000000; -+ break; -+ -+ default: -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "Invalid HWrate!\n"); -+ break; -+ } -+ } else if (path == RF_PATH_B) { -+ switch (hw_rate) { -+ case ODM_RATE1M: -+ reg_txagc = R_0x838; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATE2M: -+ reg_txagc = R_0x838; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATE5_5M: -+ reg_txagc = R_0x838; -+ reg_mask = 0x7f000000; -+ break; -+ case ODM_RATE11M: -+ reg_txagc = R_0x86c; -+ reg_mask = 0x0000007f; -+ break; -+ -+ case ODM_RATE6M: -+ reg_txagc = R_0x830; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATE9M: -+ reg_txagc = R_0x830; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATE12M: -+ reg_txagc = R_0x830; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATE18M: -+ reg_txagc = R_0x830; -+ reg_mask = 0x7f000000; -+ break; -+ case ODM_RATE24M: -+ reg_txagc = R_0x834; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATE36M: -+ reg_txagc = R_0x834; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATE48M: -+ reg_txagc = R_0x834; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATE54M: -+ reg_txagc = R_0x834; -+ reg_mask = 0x7f000000; -+ break; -+ -+ case ODM_RATEMCS0: -+ reg_txagc = R_0x83c; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATEMCS1: -+ reg_txagc = R_0x83c; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATEMCS2: -+ reg_txagc = R_0x83c; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATEMCS3: -+ reg_txagc = R_0x83c; -+ reg_mask = 0x7f000000; -+ break; -+ case ODM_RATEMCS4: -+ reg_txagc = R_0x848; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATEMCS5: -+ reg_txagc = R_0x848; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATEMCS6: -+ reg_txagc = R_0x848; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATEMCS7: -+ reg_txagc = R_0x848; -+ reg_mask = 0x7f000000; -+ break; -+ -+ case ODM_RATEMCS8: -+ reg_txagc = R_0x84c; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATEMCS9: -+ reg_txagc = R_0x84c; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATEMCS10: -+ reg_txagc = R_0x84c; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATEMCS11: -+ reg_txagc = R_0x84c; -+ reg_mask = 0x7f000000; -+ break; -+ case ODM_RATEMCS12: -+ reg_txagc = R_0x868; -+ reg_mask = 0x0000007f; -+ break; -+ case ODM_RATEMCS13: -+ reg_txagc = R_0x868; -+ reg_mask = 0x00007f00; -+ break; -+ case ODM_RATEMCS14: -+ reg_txagc = R_0x868; -+ reg_mask = 0x007f0000; -+ break; -+ case ODM_RATEMCS15: -+ reg_txagc = R_0x868; -+ reg_mask = 0x7f000000; -+ break; -+ -+ default: -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "Invalid HWrate!\n"); -+ break; -+ } -+ } else { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "Invalid RF path!!\n"); -+ } -+ read_back_data = (u8)odm_get_bb_reg(dm, reg_txagc, reg_mask); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s: path-%d rate index 0x%x = 0x%x\n", -+ __func__, path, hw_rate, read_back_data); -+ return read_back_data; -+} -+#endif -+ -+#ifdef CONFIG_MCC_DM -+#ifdef DYN_ANT_WEIGHTING_SUPPORT -+void phydm_set_weighting_cmn(struct dm_struct *dm) -+{ -+ PHYDM_DBG(dm, DBG_COMP_MCC, "%s\n", __func__); -+ odm_set_bb_reg(dm, 0xc04, (BIT(18) | BIT(21)), 0x0); -+ odm_set_bb_reg(dm, 0xe04, (BIT(18) | BIT(21)), 0x0); -+} -+ -+void phydm_set_weighting_mcc(u8 b_equal_weighting, void *dm_void, u8 port) -+{ -+ /*u8 reg_8;*/ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ u8 val_0x98e, val_0x98f, val_0x81b; -+ u32 temp_reg; -+ -+ PHYDM_DBG(dm, DBG_COMP_MCC, "ant_weighting_mcc, port = %d\n", port); -+ if (b_equal_weighting) { -+ temp_reg = odm_get_bb_reg(dm, 0x98c, 0x00ff0000); -+ val_0x98e = (u8)(temp_reg >> 16) & 0xc0; -+ temp_reg = odm_get_bb_reg(dm, 0x98c, 0xff000000); -+ val_0x98f = (u8)(temp_reg >> 24) & 0x7f; -+ temp_reg = odm_get_bb_reg(dm, 0x818, 0xff000000); -+ val_0x81b = (u8)(temp_reg >> 24) & 0xfd; -+ PHYDM_DBG(dm, DBG_COMP_MCC, "Equal weighting ,rssi_min = %d\n", -+ dm->rssi_min); -+ /*equal weighting*/ -+ } else { -+ val_0x98e = 0x44; -+ val_0x98f = 0x43; -+ temp_reg = odm_get_bb_reg(dm, 0x818, 0xff000000); -+ val_0x81b = (u8)(temp_reg >> 24) | BIT(2); -+ PHYDM_DBG(dm, DBG_COMP_MCC, "AGC weighting ,rssi_min = %d\n", -+ dm->rssi_min); -+ /*fix sec_min_wgt = 1/2*/ -+ } -+ mcc_dm->mcc_reg_id[2] = 0x2; -+ mcc_dm->mcc_dm_reg[2] = 0x98e; -+ mcc_dm->mcc_dm_val[2][port] = val_0x98e; -+ -+ mcc_dm->mcc_reg_id[3] = 0x3; -+ mcc_dm->mcc_dm_reg[3] = 0x98f; -+ mcc_dm->mcc_dm_val[3][port] = val_0x98f; -+ -+ mcc_dm->mcc_reg_id[4] = 0x4; -+ mcc_dm->mcc_dm_reg[4] = 0x81b; -+ mcc_dm->mcc_dm_val[4][port] = val_0x81b; -+} -+ -+void phydm_dyn_ant_dec_mcc(u8 port, u8 rssi_in, void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rssi_l2h = 43, rssi_h2l = 37; -+ -+ if (rssi_in == 0xff) -+ phydm_set_weighting_mcc(FALSE, dm, port); -+ else if (rssi_in >= rssi_l2h) -+ phydm_set_weighting_mcc(TRUE, dm, port); -+ else if (rssi_in <= rssi_h2l) -+ phydm_set_weighting_mcc(FALSE, dm, port); -+} -+ -+void phydm_dynamic_ant_weighting_mcc_8822b(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ u8 i; -+ -+ phydm_set_weighting_cmn(dm); -+ for (i = 0; i <= 1; i++) -+ phydm_dyn_ant_dec_mcc(i, mcc_dm->mcc_rssi[i], dm); -+} -+#endif /*#ifdef DYN_ANT_WEIGHTING_SUPPORT*/ -+ -+void phydm_mcc_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ u8 i; -+ -+ /*PHYDM_DBG(dm, DBG_COMP_MCC, ("MCC init\n"));*/ -+ PHYDM_DBG(dm, DBG_COMP_MCC, "MCC init\n"); -+ for (i = 0; i < MCC_DM_REG_NUM; i++) { -+ mcc_dm->mcc_reg_id[i] = 0xff; -+ mcc_dm->mcc_dm_reg[i] = 0; -+ mcc_dm->mcc_dm_val[i][0] = 0; -+ mcc_dm->mcc_dm_val[i][1] = 0; -+ } -+ for (i = 0; i < NUM_STA; i++) { -+ mcc_dm->sta_macid[0][i] = 0xff; -+ mcc_dm->sta_macid[1][i] = 0xff; -+ } -+ /* Function init */ -+ dm->is_stop_dym_ant_weighting = 0; -+} -+ -+u8 phydm_check(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ struct cmn_sta_info *p_entry = NULL; -+ u8 shift = 0; -+ u8 i = 0; -+ u8 j = 0; -+ u8 rssi_min[2] = {0xff, 0xff}; -+ u8 sta_num = 8; -+ u8 mcc_macid = 0; -+ -+ for (i = 0; i <= 1; i++) { -+ for (j = 0; j < sta_num; j++) { -+ if (mcc_dm->sta_macid[i][j] != 0xff) { -+ mcc_macid = mcc_dm->sta_macid[i][j]; -+ p_entry = dm->phydm_sta_info[mcc_macid]; -+ if (!p_entry) { -+ PHYDM_DBG(dm, DBG_COMP_MCC, -+ "PEntry NULL(mac=%d)\n", -+ mcc_dm->sta_macid[i][j]); -+ return _FAIL; -+ } -+ PHYDM_DBG(dm, DBG_COMP_MCC, -+ "undec_smoothed_pwdb=%d\n", -+ p_entry->rssi_stat.rssi); -+ if (p_entry->rssi_stat.rssi < rssi_min[i]) -+ rssi_min[i] = p_entry->rssi_stat.rssi; -+ } -+ } -+ } -+ mcc_dm->mcc_rssi[0] = (u8)rssi_min[0]; -+ mcc_dm->mcc_rssi[1] = (u8)rssi_min[1]; -+ return _SUCCESS; -+} -+ -+void phydm_mcc_h2ccmd_rst(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ u8 i; -+ u8 regid; -+ u8 h2c_mcc[H2C_MAX_LENGTH]; -+ -+ /* RST MCC */ -+ for (i = 0; i < H2C_MAX_LENGTH; i++) -+ h2c_mcc[i] = 0xff; -+ h2c_mcc[0] = 0x00; -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_MCC, H2C_MAX_LENGTH, h2c_mcc); -+ PHYDM_DBG(dm, DBG_COMP_MCC, "MCC H2C RST\n"); -+} -+ -+void phydm_mcc_h2ccmd(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ u8 i; -+ u8 regid; -+ u8 h2c_mcc[H2C_MAX_LENGTH]; -+ -+ if (mcc_dm->mcc_rf_ch[0] == 0xff && mcc_dm->mcc_rf_ch[1] == 0xff) { -+ PHYDM_DBG(dm, DBG_COMP_MCC, "MCC channel Error\n"); -+ return; -+ } -+ /* Set Channel number */ -+ for (i = 0; i < H2C_MAX_LENGTH; i++) -+ h2c_mcc[i] = 0xff; -+ h2c_mcc[0] = 0xe0; -+ h2c_mcc[1] = (u8)(mcc_dm->mcc_rf_ch[0]); -+ h2c_mcc[2] = (u8)(mcc_dm->mcc_rf_ch[0] >> 8); -+ h2c_mcc[3] = (u8)(mcc_dm->mcc_rf_ch[1]); -+ h2c_mcc[4] = (u8)(mcc_dm->mcc_rf_ch[1] >> 8); -+ h2c_mcc[5] = 0xff; -+ h2c_mcc[6] = 0xff; -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_MCC, H2C_MAX_LENGTH, h2c_mcc); -+ PHYDM_DBG(dm, DBG_COMP_MCC, -+ "MCC H2C SetCH: 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", -+ h2c_mcc[0], h2c_mcc[1], h2c_mcc[2], h2c_mcc[3], -+ h2c_mcc[4], h2c_mcc[5], h2c_mcc[6]); -+ -+ /* Set Reg and value*/ -+ for (i = 0; i < H2C_MAX_LENGTH; i++) -+ h2c_mcc[i] = 0xff; -+ -+ for (i = 0; i < MCC_DM_REG_NUM; i++) { -+ regid = mcc_dm->mcc_reg_id[i]; -+ if (regid != 0xff) { -+ h2c_mcc[0] = 0xa0 | (regid & 0x1f); -+ h2c_mcc[1] = (u8)(mcc_dm->mcc_dm_reg[i]); -+ h2c_mcc[2] = (u8)(mcc_dm->mcc_dm_reg[i] >> 8); -+ h2c_mcc[3] = mcc_dm->mcc_dm_val[i][0]; -+ h2c_mcc[4] = mcc_dm->mcc_dm_val[i][1]; -+ h2c_mcc[5] = 0xff; -+ h2c_mcc[6] = 0xff; -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_MCC, H2C_MAX_LENGTH, -+ h2c_mcc); -+ PHYDM_DBG(dm, DBG_COMP_MCC, -+ "MCC H2C: 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", -+ h2c_mcc[0], h2c_mcc[1], h2c_mcc[2], -+ h2c_mcc[3], h2c_mcc[4], -+ h2c_mcc[5], h2c_mcc[6]); -+ } -+ } -+} -+ -+void phydm_mcc_ctrl(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ PHYDM_DBG(dm, DBG_COMP_MCC, "MCC status: %x\n", mcc_dm->mcc_status); -+ /*MCC stage no change*/ -+ if (mcc_dm->mcc_status == mcc_dm->mcc_pre_status) -+ return; -+ /*Not in MCC stage*/ -+ if (mcc_dm->mcc_status == 0) { -+ /* Enable normal Ant-weighting */ -+ dm->is_stop_dym_ant_weighting = 0; -+ /* Enable normal DIG */ -+ odm_pause_dig(dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, 0x20); -+ } else { -+ /* Disable normal Ant-weighting */ -+ dm->is_stop_dym_ant_weighting = 1; -+ /* Enable normal DIG */ -+ odm_pause_dig(dm, PHYDM_PAUSE_NO_SET, PHYDM_PAUSE_LEVEL_1, -+ 0x20); -+ } -+ if (mcc_dm->mcc_status == 0 && mcc_dm->mcc_pre_status != 0) -+ phydm_mcc_init(dm); -+ mcc_dm->mcc_pre_status = mcc_dm->mcc_status; -+ } -+ -+void phydm_fill_mcccmd(void *dm_void, u8 regid, u16 reg_add, -+ u8 val0, u8 val1) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ -+ mcc_dm->mcc_reg_id[regid] = regid; -+ mcc_dm->mcc_dm_reg[regid] = reg_add; -+ mcc_dm->mcc_dm_val[regid][0] = val0; -+ mcc_dm->mcc_dm_val[regid][1] = val1; -+} -+ -+void phydm_mcc_switch(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ s8 ret; -+ -+ phydm_mcc_ctrl(dm); -+ if (mcc_dm->mcc_status == 0) {/*Not in MCC stage*/ -+ phydm_mcc_h2ccmd_rst(dm); -+ return; -+ } -+ PHYDM_DBG(dm, DBG_COMP_MCC, "MCC switch\n"); -+ ret = phydm_check(dm); -+ if (ret == _FAIL) { -+ PHYDM_DBG(dm, DBG_COMP_MCC, "MCC check fail\n"); -+ return; -+ } -+ /* Set IGI*/ -+ phydm_mcc_igi_cal(dm); -+ -+ /* Set Antenna Gain*/ -+#if (RTL8822B_SUPPORT == 1) -+ phydm_dynamic_ant_weighting_mcc_8822b(dm); -+#endif -+ /* Set H2C Cmd*/ -+ phydm_mcc_h2ccmd(dm); -+} -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_normal_driver_rx_sniffer( -+ struct dm_struct *dm, -+ u8 *desc, -+ PRT_RFD_STATUS rt_rfd_status, -+ u8 *drv_info, -+ u8 phy_status) -+{ -+#if (defined(CONFIG_PHYDM_RX_SNIFFER_PARSING)) -+ u32 *msg; -+ u16 seq_num; -+ -+ if (rt_rfd_status->packet_report_type != NORMAL_RX) -+ return; -+ -+ if (!dm->is_linked) { -+ if (rt_rfd_status->is_hw_error) -+ return; -+ } -+ -+ if (phy_status == true) { -+ if (dm->rx_pkt_type == type_block_ack || -+ dm->rx_pkt_type == type_rts || dm->rx_pkt_type == type_cts) -+ seq_num = 0; -+ else -+ seq_num = rt_rfd_status->seq_num; -+ -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, -+ "%04d , %01s, rate=0x%02x, L=%04d , %s , %s", -+ seq_num, -+ /*rt_rfd_status->mac_id,*/ -+ (rt_rfd_status->is_crc ? "C" : -+ rt_rfd_status->is_ampdu ? "A" : "_"), -+ rt_rfd_status->data_rate, -+ rt_rfd_status->length, -+ ((rt_rfd_status->band_width == 0) ? "20M" : -+ ((rt_rfd_status->band_width == 1) ? "40M" : "80M")), -+ (rt_rfd_status->is_ldpc ? "LDP" : "BCC")); -+ -+ if (dm->rx_pkt_type == type_asoc_req) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "AS_REQ"); -+ else if (dm->rx_pkt_type == type_asoc_rsp) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "AS_RSP"); -+ else if (dm->rx_pkt_type == type_probe_req) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "PR_REQ"); -+ else if (dm->rx_pkt_type == type_probe_rsp) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "PR_RSP"); -+ else if (dm->rx_pkt_type == type_deauth) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "DEAUTH"); -+ else if (dm->rx_pkt_type == type_beacon) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "BEACON"); -+ else if (dm->rx_pkt_type == type_block_ack_req) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "BA_REQ"); -+ else if (dm->rx_pkt_type == type_rts) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "__RTS_"); -+ else if (dm->rx_pkt_type == type_cts) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "__CTS_"); -+ else if (dm->rx_pkt_type == type_ack) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "__ACK_"); -+ else if (dm->rx_pkt_type == type_block_ack) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "__BA__"); -+ else if (dm->rx_pkt_type == type_data) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "_DATA_"); -+ else if (dm->rx_pkt_type == type_data_ack) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "Data_Ack"); -+ else if (dm->rx_pkt_type == type_qos_data) -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "QoS_Data"); -+ else -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [0x%x]", -+ dm->rx_pkt_type); -+ -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [RSSI=%d,%d,%d,%d ]", -+ dm->rssi_a, -+ dm->rssi_b, -+ dm->rssi_c, -+ dm->rssi_d); -+ -+ msg = (u32 *)drv_info; -+ -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, -+ " , P-STS[28:0]=%08x-%08x-%08x-%08x-%08x-%08x-%08x\n", -+ msg[6], msg[5], msg[4], msg[3], -+ msg[2], msg[1], msg[1]); -+ } else { -+ PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, -+ "%04d , %01s, rate=0x%02x, L=%04d , %s , %s\n", -+ rt_rfd_status->seq_num, -+ /*rt_rfd_status->mac_id,*/ -+ (rt_rfd_status->is_crc ? "C" : -+ (rt_rfd_status->is_ampdu) ? "A" : "_"), -+ rt_rfd_status->data_rate, -+ rt_rfd_status->length, -+ ((rt_rfd_status->band_width == 0) ? "20M" : -+ ((rt_rfd_status->band_width == 1) ? "40M" : "80M")), -+ (rt_rfd_status->is_ldpc ? "LDP" : "BCC")); -+ } -+ -+#endif -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_api.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_api.h -new file mode 100644 -index 000000000..a27b72514 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_api.h -@@ -0,0 +1,228 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_API_H__ -+#define __PHYDM_API_H__ -+ -+/* 2019.10.22 Add get/shift rxagc API for 8822C*/ -+#define PHYDM_API_VERSION "2.3" -+ -+/* @1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+#define N_IC_TX_OFFEST_5_BIT (ODM_RTL8188E | ODM_RTL8192E) -+ -+#define N_IC_TX_OFFEST_6_BIT (ODM_RTL8723D | ODM_RTL8197F | ODM_RTL8710B |\ -+ ODM_RTL8723B | ODM_RTL8703B | ODM_RTL8195A |\ -+ ODM_RTL8188F) -+ -+#define N_IC_TX_OFFEST_7_BIT (ODM_RTL8721D | ODM_RTL8710C) -+ -+#define CN_CNT_MAX 10 /*@max condition number threshold*/ -+ -+#define FUNC_ENABLE 1 -+#define FUNC_DISABLE 2 -+ -+/*@NBI API------------------------------------*/ -+#define NBI_128TONE 27 /*register table size*/ -+#define NBI_256TONE 59 /*register table size*/ -+ -+#define NUM_START_CH_80M 7 -+#define NUM_START_CH_40M 14 -+ -+#define CH_OFFSET_40M 2 -+#define CH_OFFSET_80M 6 -+ -+#define FFT_128_TYPE 1 -+#define FFT_256_TYPE 2 -+ -+#define FREQ_POSITIVE 1 -+#define FREQ_NEGATIVE 2 -+/*@------------------------------------------------*/ -+ -+enum phystat_rpt { -+ PHY_PWDB = 0, -+ PHY_EVM = 1, -+ PHY_CFO = 2, -+ PHY_RXSNR = 3, -+ PHY_LGAIN = 4, -+ PHY_HT_AAGC_GAIN = 5, -+}; -+ -+#ifndef PHYDM_COMMON_API_SUPPORT -+#define INVALID_RF_DATA 0xffffffff -+#define INVALID_TXAGC_DATA 0xff -+#endif -+ -+/* @1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+ -+struct phydm_api_stuc { -+ u32 rxiqc_reg1; /*N-mode: for pathA REG0xc14*/ -+ u32 rxiqc_reg2; /*N-mode: for pathB REG0xc1c*/ -+ u8 tx_queue_bitmap; /*REG0x520[23:16]*/ -+ u8 ccktx_path; -+ u8 pri_ch_idx; -+}; -+ -+/* @1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ */ -+ -+/* @1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ */ -+enum channel_width phydm_rxsc_2_bw(void *dm_void, u8 rxsc); -+ -+void phydm_reset_bb_hw_cnt(void *dm_void); -+ -+void phydm_dynamic_ant_weighting(void *dm_void); -+ -+#ifdef DYN_ANT_WEIGHTING_SUPPORT -+void phydm_ant_weight_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#endif -+ -+void phydm_trx_antenna_setting_init(void *dm_void, u8 num_rf_path); -+ -+void phydm_config_ofdm_rx_path(void *dm_void, enum bb_path path); -+ -+void phydm_config_cck_rx_path(void *dm_void, enum bb_path path); -+ -+void phydm_config_cck_rx_antenna_init(void *dm_void); -+ -+void phydm_config_trx_path(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void phydm_config_ofdm_tx_path(void *dm_void, enum bb_path path); -+ -+void phydm_config_cck_tx_path(void *dm_void, enum bb_path path); -+ -+void phydm_tx_2path(void *dm_void); -+ -+void phydm_stop_3_wire(void *dm_void, u8 set_type); -+ -+u8 phydm_stop_ic_trx(void *dm_void, u8 set_type); -+ -+void phydm_dis_cck_trx(void *dm_void, u8 set_type); -+ -+void phydm_bw_fixed_enable(void *dm_void, u8 enable); -+ -+void phydm_bw_fixed_setting(void *dm_void); -+ -+void phydm_set_ext_switch(void *dm_void, u32 ext_ant_switch); -+ -+void phydm_nbi_enable(void *dm_void, u32 enable); -+ -+u8 phydm_csi_mask_setting(void *dm_void, u32 enable, u32 ch, u32 bw, u32 f_intf, -+ u32 sec_ch); -+ -+u8 phydm_nbi_setting(void *dm_void, u32 enable, u32 ch, u32 bw, u32 f_intf, -+ u32 sec_ch); -+ -+void phydm_nbi_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void phydm_csi_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void phydm_stop_ck320(void *dm_void, u8 enable); -+ -+boolean -+phydm_set_bb_txagc_offset(void *dm_void, s8 power_offset, u8 add_half_db); -+ -+boolean phydm_spur_case_mapping(void *dm_void); -+ -+enum odm_rf_band phydm_ch_to_rf_band(void *dm_void, u8 central_ch); -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+u32 phydm_rf_psd_jgr3(void *dm_void, u8 path, u32 tone_idx); -+ -+u8 phydm_csi_mask_setting_jgr3(void *dm_void, u32 enable, u32 ch, u32 bw, -+ u32 f_intf, u32 sec_ch, u8 wgt); -+ -+void phydm_set_csi_mask_jgr3(void *dm_void, u32 tone_idx_tmp, u8 tone_direction, -+ u8 wgt); -+ -+u8 phydm_nbi_setting_jgr3(void *dm_void, u32 enable, u32 ch, u32 bw, u32 f_intf, -+ u32 sec_ch, u8 path); -+ -+void phydm_set_nbi_reg_jgr3(void *dm_void, u32 tone_idx_tmp, u8 tone_direction, -+ u8 path); -+ -+void phydm_nbi_enable_jgr3(void *dm_void, u32 enable, u8 path); -+ -+u8 phydm_phystat_rpt_jgr3(void *dm_void, enum phystat_rpt info, -+ enum rf_path ant_path); -+void phydm_user_position_for_sniffer(void *dm_void, u8 user_position); -+ -+#endif -+ -+#ifdef PHYDM_COMMON_API_SUPPORT -+void phydm_reset_txagc(void *dm_void); -+ -+boolean -+phydm_api_shift_txagc(void *dm_void, u32 pwr_offset, enum rf_path path, -+ boolean is_positive); -+boolean -+phydm_api_set_txagc(void *dm_void, u32 power_index, enum rf_path path, -+ u8 hw_rate, boolean is_single_rate); -+ -+u8 phydm_api_get_txagc(void *dm_void, enum rf_path path, u8 hw_rate); -+ -+#if (RTL8822C_SUPPORT) -+void phydm_shift_rxagc_table(void *dm_void, boolean shift_up, u8 shift); -+#endif -+ -+boolean -+phydm_api_switch_bw_channel(void *dm_void, u8 central_ch, u8 primary_ch_idx, -+ enum channel_width bandwidth); -+ -+boolean -+phydm_api_trx_mode(void *dm_void, enum bb_path tx_path, enum bb_path rx_path, -+ enum bb_path tx_path_ctrl); -+ -+#endif -+ -+#ifdef PHYDM_COMMON_API_NOT_SUPPORT -+u8 config_phydm_read_txagc_n(void *dm_void, enum rf_path path, u8 hw_rate); -+#endif -+ -+#ifdef CONFIG_MCC_DM -+#ifdef DYN_ANT_WEIGHTING_SUPPORT -+void phydm_dynamic_ant_weighting_mcc_8822b(void *dm_void); -+#endif /*#ifdef DYN_ANT_WEIGHTING_SUPPORT*/ -+void phydm_fill_mcccmd(void *dm_void, u8 regid, u16 reg_add, -+ u8 val0, u8 val1); -+u8 phydm_check(void *dm_void); -+void phydm_mcc_init(void *dm_void); -+void phydm_mcc_switch(void *dm_void); -+#endif /*#ifdef CONFIG_MCC_DM*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_auto_dbg.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_auto_dbg.c -new file mode 100644 -index 000000000..203764d7c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_auto_dbg.c -@@ -0,0 +1,725 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/************************************************************* -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef PHYDM_AUTO_DEGBUG -+ -+void phydm_check_hang_reset( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; -+ -+ atd_t->dbg_step = 0; -+ atd_t->auto_dbg_type = AUTO_DBG_STOP; -+ phydm_pause_dm_watchdog(dm, PHYDM_RESUME); -+ dm->debug_components &= (~ODM_COMP_API); -+} -+ -+void phydm_check_hang_init( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; -+ -+ atd_t->dbg_step = 0; -+ atd_t->auto_dbg_type = AUTO_DBG_STOP; -+ phydm_pause_dm_watchdog(dm, PHYDM_RESUME); -+} -+ -+#if (ODM_IC_11N_SERIES_SUPPORT == 1) -+void phydm_auto_check_hang_engine_n( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; -+ struct n_dbgport_803 dbgport_803 = {0}; -+ u32 value32_tmp = 0, value32_tmp_2 = 0; -+ u8 i; -+ u32 curr_dbg_port_val[DBGPORT_CHK_NUM] = {0, 0, 0, 0, 0, 0}; -+ u16 curr_ofdm_t_cnt; -+ u16 curr_ofdm_r_cnt; -+ u16 curr_cck_t_cnt; -+ u16 curr_cck_r_cnt; -+ u16 curr_ofdm_crc_error_cnt; -+ u16 curr_cck_crc_error_cnt; -+ u16 diff_ofdm_t_cnt; -+ u16 diff_ofdm_r_cnt; -+ u16 diff_cck_t_cnt; -+ u16 diff_cck_r_cnt; -+ u16 diff_ofdm_crc_error_cnt; -+ u16 diff_cck_crc_error_cnt; -+ u8 rf_mode; -+ -+ if (atd_t->auto_dbg_type == AUTO_DBG_STOP) -+ return; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ phydm_check_hang_reset(dm); -+ return; -+ } -+ -+ if (atd_t->dbg_step == 0) { -+ pr_debug("dbg_step=0\n\n"); -+ -+ /*Reset all packet counter*/ -+ odm_set_bb_reg(dm, R_0xf14, BIT(16), 1); -+ odm_set_bb_reg(dm, R_0xf14, BIT(16), 0); -+ -+ } else if (atd_t->dbg_step == 1) { -+ pr_debug("dbg_step=1\n\n"); -+ -+ /*Check packet counter Register*/ -+ atd_t->ofdm_t_cnt = (u16)odm_get_bb_reg(dm, R_0x9cc, MASKHWORD); -+ atd_t->ofdm_r_cnt = (u16)odm_get_bb_reg(dm, R_0xf94, MASKLWORD); -+ atd_t->ofdm_crc_error_cnt = (u16)odm_get_bb_reg(dm, R_0xf94, -+ MASKHWORD); -+ -+ atd_t->cck_t_cnt = (u16)odm_get_bb_reg(dm, R_0x9d0, MASKHWORD); -+ atd_t->cck_r_cnt = (u16)odm_get_bb_reg(dm, R_0xfa0, MASKHWORD); -+ atd_t->cck_crc_error_cnt = (u16)odm_get_bb_reg(dm, R_0xf84, -+ 0x3fff); -+ -+ /*Check Debug Port*/ -+ for (i = 0; i < DBGPORT_CHK_NUM; i++) { -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, -+ (u32)atd_t->dbg_port_table[i]) -+ ) { -+ atd_t->dbg_port_val[i] = -+ phydm_get_bb_dbg_port_val(dm); -+ phydm_release_bb_dbg_port(dm); -+ } -+ } -+ -+ } else if (atd_t->dbg_step == 2) { -+ pr_debug("dbg_step=2\n\n"); -+ -+ /*Check packet counter Register*/ -+ curr_ofdm_t_cnt = (u16)odm_get_bb_reg(dm, R_0x9cc, MASKHWORD); -+ curr_ofdm_r_cnt = (u16)odm_get_bb_reg(dm, R_0xf94, MASKLWORD); -+ curr_ofdm_crc_error_cnt = (u16)odm_get_bb_reg(dm, R_0xf94, -+ MASKHWORD); -+ -+ curr_cck_t_cnt = (u16)odm_get_bb_reg(dm, R_0x9d0, MASKHWORD); -+ curr_cck_r_cnt = (u16)odm_get_bb_reg(dm, R_0xfa0, MASKHWORD); -+ curr_cck_crc_error_cnt = (u16)odm_get_bb_reg(dm, R_0xf84, -+ 0x3fff); -+ -+ /*Check Debug Port*/ -+ for (i = 0; i < DBGPORT_CHK_NUM; i++) { -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, -+ (u32)atd_t->dbg_port_table[i]) -+ ) { -+ curr_dbg_port_val[i] = -+ phydm_get_bb_dbg_port_val(dm); -+ phydm_release_bb_dbg_port(dm); -+ } -+ } -+ -+ /*=== Make check hang decision ===============================*/ -+ pr_debug("Check Hang Decision\n\n"); -+ -+ /* ----- Check RF Register -----------------------------------*/ -+ for (i = 0; i < dm->num_rf_path; i++) { -+ rf_mode = (u8)odm_get_rf_reg(dm, i, RF_0x0, 0xf0000); -+ pr_debug("RF0x0[%d] = 0x%x\n", i, rf_mode); -+ if (rf_mode > 3) { -+ pr_debug("Incorrect RF mode\n"); -+ pr_debug("ReasonCode:RHN-1\n"); -+ } -+ } -+ value32_tmp = odm_get_rf_reg(dm, 0, RF_0xb0, 0xf0000); -+ if (dm->support_ic_type == ODM_RTL8188E) { -+ if (value32_tmp != 0xff8c8) { -+ pr_debug("ReasonCode:RHN-3\n"); -+ } -+ } -+ /* ----- Check BB Register ----------------------------------*/ -+ /*BB mode table*/ -+ value32_tmp = odm_get_bb_reg(dm, R_0x824, 0xe); -+ value32_tmp_2 = odm_get_bb_reg(dm, R_0x82c, 0xe); -+ pr_debug("BB TX mode table {A, B}= {%d, %d}\n", -+ value32_tmp, value32_tmp_2); -+ -+ if (value32_tmp > 3 || value32_tmp_2 > 3) { -+ pr_debug("ReasonCode:RHN-2\n"); -+ } -+ -+ value32_tmp = odm_get_bb_reg(dm, R_0x824, 0x700000); -+ value32_tmp_2 = odm_get_bb_reg(dm, R_0x82c, 0x700000); -+ pr_debug("BB RX mode table {A, B}= {%d, %d}\n", value32_tmp, -+ value32_tmp_2); -+ -+ if (value32_tmp > 3 || value32_tmp_2 > 3) { -+ pr_debug("ReasonCode:RHN-2\n"); -+ } -+ -+ /*BB HW Block*/ -+ value32_tmp = odm_get_bb_reg(dm, R_0x800, MASKDWORD); -+ -+ if (!(value32_tmp & BIT(24))) { -+ pr_debug("Reg0x800[24] = 0, CCK BLK is disabled\n"); -+ pr_debug("ReasonCode: THN-3\n"); -+ } -+ -+ if (!(value32_tmp & BIT(25))) { -+ pr_debug("Reg0x800[24] = 0, OFDM BLK is disabled\n"); -+ pr_debug("ReasonCode:THN-3\n"); -+ } -+ -+ /*BB Continue TX*/ -+ value32_tmp = odm_get_bb_reg(dm, R_0xd00, 0x70000000); -+ pr_debug("Continue TX=%d\n", value32_tmp); -+ if (value32_tmp != 0) { -+ pr_debug("ReasonCode: THN-4\n"); -+ } -+ -+ /* ----- Check Packet Counter --------------------------------*/ -+ diff_ofdm_t_cnt = curr_ofdm_t_cnt - atd_t->ofdm_t_cnt; -+ diff_ofdm_r_cnt = curr_ofdm_r_cnt - atd_t->ofdm_r_cnt; -+ diff_ofdm_crc_error_cnt = curr_ofdm_crc_error_cnt - -+ atd_t->ofdm_crc_error_cnt; -+ -+ diff_cck_t_cnt = curr_cck_t_cnt - atd_t->cck_t_cnt; -+ diff_cck_r_cnt = curr_cck_r_cnt - atd_t->cck_r_cnt; -+ diff_cck_crc_error_cnt = curr_cck_crc_error_cnt - -+ atd_t->cck_crc_error_cnt; -+ -+ pr_debug("OFDM[t=0~1] {TX, RX, CRC_error} = {%d, %d, %d}\n", -+ atd_t->ofdm_t_cnt, atd_t->ofdm_r_cnt, -+ atd_t->ofdm_crc_error_cnt); -+ pr_debug("OFDM[t=1~2] {TX, RX, CRC_error} = {%d, %d, %d}\n", -+ curr_ofdm_t_cnt, curr_ofdm_r_cnt, -+ curr_ofdm_crc_error_cnt); -+ pr_debug("OFDM_diff {TX, RX, CRC_error} = {%d, %d, %d}\n", -+ diff_ofdm_t_cnt, diff_ofdm_r_cnt, -+ diff_ofdm_crc_error_cnt); -+ -+ pr_debug("CCK[t=0~1] {TX, RX, CRC_error} = {%d, %d, %d}\n", -+ atd_t->cck_t_cnt, atd_t->cck_r_cnt, -+ atd_t->cck_crc_error_cnt); -+ pr_debug("CCK[t=1~2] {TX, RX, CRC_error} = {%d, %d, %d}\n", -+ curr_cck_t_cnt, curr_cck_r_cnt, -+ curr_cck_crc_error_cnt); -+ pr_debug("CCK_diff {TX, RX, CRC_error} = {%d, %d, %d}\n", -+ diff_cck_t_cnt, diff_cck_r_cnt, -+ diff_cck_crc_error_cnt); -+ -+ /* ----- Check Dbg Port --------------------------------*/ -+ -+ for (i = 0; i < DBGPORT_CHK_NUM; i++) { -+ pr_debug("Dbg_port=((0x%x))\n", -+ atd_t->dbg_port_table[i]); -+ pr_debug("Val{pre, curr}={0x%x, 0x%x}\n", -+ atd_t->dbg_port_val[i], curr_dbg_port_val[i]); -+ -+ if (atd_t->dbg_port_table[i] == 0) { -+ if (atd_t->dbg_port_val[i] == -+ curr_dbg_port_val[i]) { -+ pr_debug("BB state hang\n"); -+ pr_debug("ReasonCode:\n"); -+ } -+ -+ } else if (atd_t->dbg_port_table[i] == 0x803) { -+ if (atd_t->dbg_port_val[i] == -+ curr_dbg_port_val[i]) { -+ /* dbgport_803 = */ -+ /* (struct n_dbgport_803 ) */ -+ /* (atd_t->dbg_port_val[i]); */ -+ odm_move_memory(dm, &dbgport_803, -+ &atd_t->dbg_port_val[i], -+ sizeof(struct n_dbgport_803)); -+ pr_debug("RSTB{BB, GLB, OFDM}={%d, %d,%d}\n", -+ dbgport_803.bb_rst_b, -+ dbgport_803.glb_rst_b, -+ dbgport_803.ofdm_rst_b); -+ pr_debug("{ofdm_tx_en, cck_tx_en, phy_tx_on}={%d, %d, %d}\n", -+ dbgport_803.ofdm_tx_en, -+ dbgport_803.cck_tx_en, -+ dbgport_803.phy_tx_on); -+ pr_debug("CCA_PP{OFDM, CCK}={%d, %d}\n", -+ dbgport_803.ofdm_cca_pp, -+ dbgport_803.cck_cca_pp); -+ -+ if (dbgport_803.phy_tx_on) -+ pr_debug("Maybe TX Hang\n"); -+ else if (dbgport_803.ofdm_cca_pp || -+ dbgport_803.cck_cca_pp) -+ pr_debug("Maybe RX Hang\n"); -+ } -+ -+ } else if (atd_t->dbg_port_table[i] == 0x208) { -+ if ((atd_t->dbg_port_val[i] & BIT(30)) && -+ (curr_dbg_port_val[i] & BIT(30))) { -+ pr_debug("EDCCA Pause TX\n"); -+ pr_debug("ReasonCode: THN-2\n"); -+ } -+ -+ } else if (atd_t->dbg_port_table[i] == 0xab0) { -+ /* atd_t->dbg_port_val[i] & 0xffffff == 0 */ -+ /* curr_dbg_port_val[i] & 0xffffff == 0 */ -+ if (((atd_t->dbg_port_val[i] & -+ MASK24BITS) == 0) || -+ ((curr_dbg_port_val[i] & -+ MASK24BITS) == 0)) { -+ pr_debug("Wrong L-SIG formate\n"); -+ pr_debug("ReasonCode: THN-1\n"); -+ } -+ } -+ } -+ -+ phydm_check_hang_reset(dm); -+ } -+ -+ atd_t->dbg_step++; -+} -+ -+void phydm_bb_auto_check_hang_start_n( -+ void *dm_void, -+ u32 *_used, -+ char *output, -+ u32 *_out_len) -+{ -+ u32 value32 = 0; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ return; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "PHYDM auto check hang (N-series) is started, Please check the system log\n"); -+ -+ dm->debug_components |= ODM_COMP_API; -+ atd_t->auto_dbg_type = AUTO_DBG_CHECK_HANG; -+ atd_t->dbg_step = 0; -+ -+ phydm_pause_dm_watchdog(dm, PHYDM_PAUSE); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_dbg_port_dump_n(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ u32 value32 = 0; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ return; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "not support now\n"); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT == 1) -+void phydm_dbg_port_dump_ac(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ u32 value32 = 0; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) -+ return; -+ -+ value32 = odm_get_bb_reg(dm, R_0xf80, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "rptreg of sc/bw/ht/...", value32); -+ -+ if (dm->support_ic_type & ODM_RTL8822B) -+ odm_set_bb_reg(dm, R_0x198c, BIT(2) | BIT(1) | BIT(0), 7); -+ -+ /* dbg_port = basic state machine */ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x000); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "basic state machine", value32); -+ } -+ -+ /* dbg_port = state machine */ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x007); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "state machine", value32); -+ } -+ -+ /* dbg_port = CCA-related*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x204); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "CCA-related", value32); -+ } -+ -+ /* dbg_port = edcca/rxd*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x278); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "edcca/rxd", value32); -+ } -+ -+ /* dbg_port = rx_state/mux_state/ADC_MASK_OFDM*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x290); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", -+ "rx_state/mux_state/ADC_MASK_OFDM", value32); -+ } -+ -+ /* dbg_port = bf-related*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x2B2); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "bf-related", value32); -+ } -+ -+ /* dbg_port = bf-related*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x2B8); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "bf-related", value32); -+ } -+ -+ /* dbg_port = txon/rxd*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA03); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "txon/rxd", value32); -+ } -+ -+ /* dbg_port = l_rate/l_length*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA0B); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "l_rate/l_length", value32); -+ } -+ -+ /* dbg_port = rxd/rxd_hit*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA0D); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "rxd/rxd_hit", value32); -+ } -+ -+ /* dbg_port = dis_cca*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAA0); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "dis_cca", value32); -+ } -+ -+ /* dbg_port = tx*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAB0); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "tx", value32); -+ } -+ -+ /* dbg_port = rx plcp*/ -+ { -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD0); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "rx plcp", value32); -+ -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD1); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "rx plcp", value32); -+ -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD2); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "rx plcp", value32); -+ -+ odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD3); -+ value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "0x8fc", value32); -+ -+ value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = 0x%x", "rx plcp", value32); -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+void phydm_dbg_port_dump_jgr3(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ /*u32 dbg_port_idx_all[3] = {0x000, 0x001, 0x002};*/ -+ u32 val = 0; -+ u32 dbg_port_idx = 0; -+ u32 i = 0; -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return; -+ -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "%-17s = %s\n", "DbgPort index", "Value"); -+ -+#if 0 -+ /*0x000/0x001/0x002*/ -+ for (i = 0; i < 3; i++) { -+ dbg_port_idx = dbg_port_idx_all[i]; -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, dbg_port_idx)) { -+ val = phydm_get_bb_dbg_port_val(dm); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "0x%-15x = 0x%x\n", dbg_port_idx, val); -+ phydm_release_bb_dbg_port(dm); -+ } -+ } -+#endif -+ for (dbg_port_idx = 0x0; dbg_port_idx <= 0xfff; dbg_port_idx++) { -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, dbg_port_idx)) { -+ val = phydm_get_bb_dbg_port_val(dm); -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, -+ "0x%-15x = 0x%x\n", dbg_port_idx, val); -+ phydm_release_bb_dbg_port(dm); -+ } -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -+ -+void phydm_dbg_port_dump(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "------ BB debug port start ------\n"); -+ -+ switch (dm->ic_ip_series) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ case PHYDM_IC_JGR3: -+ phydm_dbg_port_dump_jgr3(dm, &used, output, &out_len); -+ break; -+ #endif -+ -+ #if (ODM_IC_11AC_SERIES_SUPPORT == 1) -+ case PHYDM_IC_AC: -+ phydm_dbg_port_dump_ac(dm, &used, output, &out_len); -+ break; -+ #endif -+ -+ #if (ODM_IC_11N_SERIES_SUPPORT == 1) -+ case PHYDM_IC_N: -+ phydm_dbg_port_dump_n(dm, &used, output, &out_len); -+ break; -+ #endif -+ -+ default: -+ break; -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_auto_dbg_console( -+ void *dm_void, -+ char input[][16], -+ u32 *_used, -+ char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "hang: {1} {1:Show DbgPort, 2:Auto check hang}\n"); -+ return; -+ } else if (var1[0] == 1) { -+ PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); -+ if (var1[1] == 1) { -+ phydm_dbg_port_dump(dm, &used, output, &out_len); -+ } else if (var1[1] == 2) { -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "Not support\n"); -+ } else { -+ #if (ODM_IC_11N_SERIES_SUPPORT == 1) -+ phydm_bb_auto_check_hang_start_n(dm, &used, -+ output, -+ &out_len); -+ #else -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "Not support\n"); -+ #endif -+ } -+ } -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_auto_dbg_engine(void *dm_void) -+{ -+ u32 value32 = 0; -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; -+ -+ if (atd_t->auto_dbg_type == AUTO_DBG_STOP) -+ return; -+ -+ pr_debug("%s ======>\n", __func__); -+ -+ if (atd_t->auto_dbg_type == AUTO_DBG_CHECK_HANG) { -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ pr_debug("Not Support\n"); -+ } else { -+ #if (ODM_IC_11N_SERIES_SUPPORT == 1) -+ phydm_auto_check_hang_engine_n(dm); -+ #else -+ pr_debug("Not Support\n"); -+ #endif -+ } -+ -+ } else if (atd_t->auto_dbg_type == AUTO_DBG_CHECK_RA) { -+ pr_debug("Not Support\n"); -+ } -+} -+ -+void phydm_auto_dbg_engine_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; -+ u16 dbg_port_table[DBGPORT_CHK_NUM] = {0x0, 0x803, 0x208, 0xab0, -+ 0xab1, 0xab2}; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "%s ======>\n", __func__); -+ -+ odm_move_memory(dm, &atd_t->dbg_port_table[0], -+ &dbg_port_table[0], (DBGPORT_CHK_NUM * 2)); -+ -+ phydm_check_hang_init(dm); -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_auto_dbg.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_auto_dbg.h -new file mode 100644 -index 000000000..78bde627f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_auto_dbg.h -@@ -0,0 +1,115 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_AUTO_DBG_H__ -+#define __PHYDM_AUTO_DBG_H__ -+ -+#define AUTO_DBG_VERSION "1.0" /* @2017.05.015 Dino, Add phydm_auto_dbg.h*/ -+ -+/* @1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+ -+#define AUTO_CHK_HANG_STEP_MAX 3 -+#define DBGPORT_CHK_NUM 6 -+ -+#ifdef PHYDM_AUTO_DEGBUG -+ -+/* @1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ */ -+ -+enum auto_dbg_type_e { -+ AUTO_DBG_STOP = 0, -+ AUTO_DBG_CHECK_HANG = 1, -+ AUTO_DBG_CHECK_RA = 2, -+ AUTO_DBG_CHECK_DIG = 3 -+}; -+ -+/* @1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+ -+struct n_dbgport_803 { -+ /*@BYTE 3*/ -+ u8 bb_rst_b : 1; -+ u8 glb_rst_b : 1; -+ u8 zero_1bit_1 : 1; -+ u8 ofdm_rst_b : 1; -+ u8 cck_txpe : 1; -+ u8 ofdm_txpe : 1; -+ u8 phy_tx_on : 1; -+ u8 tdrdy : 1; -+ /*@BYTE 2*/ -+ u8 txd : 8; -+ /*@BYTE 1*/ -+ u8 cck_cca_pp : 1; -+ u8 ofdm_cca_pp : 1; -+ u8 rx_rst : 1; -+ u8 rdrdy : 1; -+ u8 rxd_7_4 : 4; -+ /*@BYTE 0*/ -+ u8 rxd_3_0 : 4; -+ u8 ofdm_tx_en : 1; -+ u8 cck_tx_en : 1; -+ u8 zero_1bit_2 : 1; -+ u8 clk_80m : 1; -+}; -+ -+struct phydm_auto_dbg_struct { -+ enum auto_dbg_type_e auto_dbg_type; -+ u8 dbg_step; -+ u16 dbg_port_table[DBGPORT_CHK_NUM]; -+ u32 dbg_port_val[DBGPORT_CHK_NUM]; -+ u16 ofdm_t_cnt; -+ u16 ofdm_r_cnt; -+ u16 cck_t_cnt; -+ u16 cck_r_cnt; -+ u16 ofdm_crc_error_cnt; -+ u16 cck_crc_error_cnt; -+}; -+ -+/* @1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ */ -+ -+void phydm_dbg_port_dump(void *dm_void, u32 *used, char *output, u32 *out_len); -+ -+void phydm_auto_dbg_console( -+ void *dm_void, -+ char input[][16], -+ u32 *_used, -+ char *output, -+ u32 *_out_len); -+ -+void phydm_auto_dbg_engine(void *dm_void); -+ -+void phydm_auto_dbg_engine_init(void *dm_void); -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_beamforming.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_beamforming.c -new file mode 100644 -index 000000000..1c055c8b9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_beamforming.c -@@ -0,0 +1,1989 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#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 -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ -+void phydm_get_txbf_device_num( -+ void *dm_void, -+ u8 macid) -+{ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) /*@For BDC*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[macid]; -+ struct bf_cmn_info *bf = NULL; -+ struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; -+ u8 act_as_bfer = 0; -+ u8 act_as_bfee = 0; -+ -+ if (!(dm->support_ability & ODM_BB_ANT_DIV)) -+ return; -+ -+ if (is_sta_active(sta)) { -+ bf = &(sta->bf_info); -+ } else { -+ PHYDM_DBG(dm, DBG_TXBF, "[Warning] %s invalid sta_info\n", -+ __func__); -+ return; -+ } -+ -+ if (sta->support_wireless_set & WIRELESS_VHT) { -+ if (bf->vht_beamform_cap & BEAMFORMING_VHT_BEAMFORMEE_ENABLE) -+ act_as_bfer = 1; -+ -+ if (bf->vht_beamform_cap & BEAMFORMING_VHT_BEAMFORMER_ENABLE) -+ act_as_bfee = 1; -+ -+ } else if (sta->support_wireless_set & WIRELESS_HT) { -+ if (bf->ht_beamform_cap & BEAMFORMING_HT_BEAMFORMEE_ENABLE) -+ act_as_bfer = 1; -+ -+ if (bf->ht_beamform_cap & BEAMFORMING_HT_BEAMFORMER_ENABLE) -+ act_as_bfee = 1; -+ } -+ -+ if (act_as_bfer) -+ { /* Our Device act as BFer */ -+ dm_bdc_table->w_bfee_client[macid] = true; -+ dm_bdc_table->num_txbfee_client++; -+ } -+ else -+ dm_bdc_table->w_bfee_client[macid] = false; -+ -+ if (act_as_bfee) -+ { /* Our Device act as BFee */ -+ dm_bdc_table->w_bfer_client[macid] = true; -+ dm_bdc_table->num_txbfer_client++; -+ } -+ else -+ dm_bdc_table->w_bfer_client[macid] = false; -+ -+#endif -+#endif -+} -+ -+struct _RT_BEAMFORM_STAINFO * -+phydm_sta_info_init(struct dm_struct *dm, u16 sta_idx, u8 *my_mac_addr) -+{ -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORM_STAINFO *entry = &beam_info->beamform_sta_info; -+ struct cmn_sta_info *cmn_sta = dm->phydm_sta_info[sta_idx]; -+ //void *adapter = dm->adapter; -+ ADAPTER * adapter = dm->adapter; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMGNT_INFO p_MgntInfo = &((adapter)->MgntInfo); -+ PRT_HIGH_THROUGHPUT p_ht_info = GET_HT_INFO(p_MgntInfo); -+ PRT_VERY_HIGH_THROUGHPUT p_vht_info = GET_VHT_INFO(p_MgntInfo); -+#endif -+ -+ if (!is_sta_active(cmn_sta)) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s => sta_info(mac_id:%d) failed\n", -+ __func__, sta_idx); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtw_warn_on(1); -+ #endif -+ -+ return entry; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /*odm_move_memory(dm, (PVOID)(entry->my_mac_addr),*/ -+ /*(PVOID)(adapter->CurrentAddress), 6);*/ -+ odm_move_memory(dm, entry->my_mac_addr, my_mac_addr, 6); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ /*odm_move_memory(dm, entry->my_mac_addr,*/ -+ /*adapter_mac_addr(sta->padapter), 6);*/ -+ odm_move_memory(dm, entry->my_mac_addr, my_mac_addr, 6); -+#endif -+ -+ entry->aid = cmn_sta->aid; -+ entry->ra = cmn_sta->mac_addr; -+ entry->mac_id = cmn_sta->mac_id; -+ entry->bw = cmn_sta->bw_mode; -+ entry->cur_beamform = cmn_sta->bf_info.ht_beamform_cap; -+ entry->ht_beamform_cap = cmn_sta->bf_info.ht_beamform_cap; -+ -+#if ODM_IC_11AC_SERIES_SUPPORT -+ if (cmn_sta->support_wireless_set & WIRELESS_VHT) { -+ entry->cur_beamform_vht = cmn_sta->bf_info.vht_beamform_cap; -+ entry->vht_beamform_cap = cmn_sta->bf_info.vht_beamform_cap; -+ } -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) /*To Be Removed */ -+ entry->ht_beamform_cap = p_ht_info->HtBeamformCap; /*To Be Removed*/ -+ entry->vht_beamform_cap = p_vht_info->VhtBeamformCap; /*To Be Removed*/ -+ -+ if (sta_idx == 0) { /*@client mode*/ -+ #if ODM_IC_11AC_SERIES_SUPPORT -+ if (cmn_sta->support_wireless_set & WIRELESS_VHT) -+ entry->cur_beamform_vht = p_vht_info->VhtCurBeamform; -+ #endif -+ } -+#endif -+ -+ PHYDM_DBG(dm, DBG_TXBF, "wireless_set = 0x%x, staidx = %d\n", -+ cmn_sta->support_wireless_set, sta_idx); -+ PHYDM_DBG(dm, DBG_TXBF, -+ "entry->cur_beamform = 0x%x, entry->cur_beamform_vht = 0x%x\n", -+ entry->cur_beamform, entry->cur_beamform_vht); -+ return entry; -+} -+void phydm_sta_info_update( -+ struct dm_struct *dm, -+ u16 sta_idx, -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry) -+{ -+ struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; -+ -+ if (!is_sta_active(sta)) -+ return; -+ -+ sta->bf_info.p_aid = beamform_entry->p_aid; -+ sta->bf_info.g_id = beamform_entry->g_id; -+} -+ -+struct _RT_BEAMFORMEE_ENTRY * -+phydm_beamforming_get_bfee_entry_by_addr( -+ void *dm_void, -+ u8 *RA, -+ u8 *idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (beam_info->beamformee_entry[i].is_used && (eq_mac_addr(RA, beam_info->beamformee_entry[i].mac_addr))) { -+ *idx = i; -+ return &beam_info->beamformee_entry[i]; -+ } -+ } -+ -+ return NULL; -+} -+ -+struct _RT_BEAMFORMER_ENTRY * -+phydm_beamforming_get_bfer_entry_by_addr( -+ void *dm_void, -+ u8 *TA, -+ u8 *idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { -+ if (beam_info->beamformer_entry[i].is_used && (eq_mac_addr(TA, beam_info->beamformer_entry[i].mac_addr))) { -+ *idx = i; -+ return &beam_info->beamformer_entry[i]; -+ } -+ } -+ -+ return NULL; -+} -+ -+struct _RT_BEAMFORMEE_ENTRY * -+phydm_beamforming_get_entry_by_mac_id( -+ void *dm_void, -+ u8 mac_id, -+ u8 *idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (beam_info->beamformee_entry[i].is_used && mac_id == beam_info->beamformee_entry[i].mac_id) { -+ *idx = i; -+ return &beam_info->beamformee_entry[i]; -+ } -+ } -+ -+ return NULL; -+} -+ -+enum beamforming_cap -+phydm_beamforming_get_entry_beam_cap_by_mac_id( -+ void *dm_void, -+ u8 mac_id) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ enum beamforming_cap beamform_entry_cap = BEAMFORMING_CAP_NONE; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (beam_info->beamformee_entry[i].is_used && mac_id == beam_info->beamformee_entry[i].mac_id) { -+ beamform_entry_cap = beam_info->beamformee_entry[i].beamform_entry_cap; -+ i = BEAMFORMEE_ENTRY_NUM; -+ } -+ } -+ -+ return beamform_entry_cap; -+} -+ -+struct _RT_BEAMFORMEE_ENTRY * -+phydm_beamforming_get_free_bfee_entry( -+ void *dm_void, -+ u8 *idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (beam_info->beamformee_entry[i].is_used == false) { -+ *idx = i; -+ return &beam_info->beamformee_entry[i]; -+ } -+ } -+ return NULL; -+} -+ -+struct _RT_BEAMFORMER_ENTRY * -+phydm_beamforming_get_free_bfer_entry( -+ void *dm_void, -+ u8 *idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s ===>\n", __func__); -+ -+ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { -+ if (beam_info->beamformer_entry[i].is_used == false) { -+ *idx = i; -+ return &beam_info->beamformer_entry[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. -+ * -+ */ -+u8 phydm_beamforming_get_first_mu_bfee_entry_idx( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 idx = 0xFF; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ boolean is_found = false; -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ if (beam_info->beamformee_entry[idx].is_used && beam_info->beamformee_entry[idx].is_mu_sta) { -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] idx=%d!\n", __func__, -+ idx); -+ is_found = true; -+ break; -+ } -+ } -+ -+ if (!is_found) -+ idx = 0xFF; -+ -+ return idx; -+} -+ -+/*@Add SU BFee and MU BFee*/ -+struct _RT_BEAMFORMEE_ENTRY * -+beamforming_add_bfee_entry( -+ void *dm_void, -+ struct _RT_BEAMFORM_STAINFO *sta, -+ enum beamforming_cap beamform_cap, -+ u8 num_of_sounding_dim, -+ u8 comp_steering_num_of_bfer, -+ u8 *idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMEE_ENTRY *entry = phydm_beamforming_get_free_bfee_entry(dm, idx); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ if (entry != NULL) { -+ entry->is_used = true; -+ entry->aid = sta->aid; -+ entry->mac_id = sta->mac_id; -+ entry->sound_bw = sta->bw; -+ odm_move_memory(dm, entry->my_mac_addr, sta->my_mac_addr, 6); -+ -+ if (phydm_acting_determine(dm, phydm_acting_as_ap)) { -+ /*@BSSID[44:47] xor BSSID[40:43]*/ -+ u16 bssid = ((sta->my_mac_addr[5] & 0xf0) >> 4) ^ (sta->my_mac_addr[5] & 0xf); -+ /*@(dec(A) + dec(B)*32) mod 512*/ -+ entry->p_aid = (sta->aid + bssid * 32) & 0x1ff; -+ entry->g_id = 63; -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s: BFee P_AID addressed to STA=%d\n", -+ __func__, entry->p_aid); -+ } else if (phydm_acting_determine(dm, phydm_acting_as_ibss)) { -+ /*@ad hoc mode*/ -+ entry->p_aid = 0; -+ entry->g_id = 63; -+ PHYDM_DBG(dm, DBG_TXBF, "%s: BFee P_AID as IBSS=%d\n", -+ __func__, entry->p_aid); -+ } else { -+ /*@client mode*/ -+ entry->p_aid = sta->ra[5]; -+ /*@BSSID[39:47]*/ -+ entry->p_aid = (entry->p_aid << 1) | (sta->ra[4] >> 7); -+ entry->g_id = 0; -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s: BFee P_AID addressed to AP=0x%X\n", -+ __func__, entry->p_aid); -+ } -+ cp_mac_addr(entry->mac_addr, sta->ra); -+ entry->is_txbf = false; -+ entry->is_sound = false; -+ entry->sound_period = 400; -+ entry->beamform_entry_cap = beamform_cap; -+ entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ -+ /* @entry->log_seq = 0xff; Move to beamforming_add_bfer_entry*/ -+ /* @entry->log_retry_cnt = 0; Move to beamforming_add_bfer_entry*/ -+ /* @entry->LogSuccessCnt = 0; Move to beamforming_add_bfer_entry*/ -+ -+ entry->log_status_fail_cnt = 0; -+ -+ entry->num_of_sounding_dim = num_of_sounding_dim; -+ entry->comp_steering_num_of_bfer = comp_steering_num_of_bfer; -+ -+ if (beamform_cap & BEAMFORMER_CAP_VHT_MU) { -+ dm->beamforming_info.beamformee_mu_cnt += 1; -+ entry->is_mu_sta = true; -+ dm->beamforming_info.first_mu_bfee_index = phydm_beamforming_get_first_mu_bfee_entry_idx(dm); -+ } else if (beamform_cap & (BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP_HT_EXPLICIT)) { -+ dm->beamforming_info.beamformee_su_cnt += 1; -+ entry->is_mu_sta = false; -+ } -+ -+ return entry; -+ } else -+ return NULL; -+} -+ -+/*@Add SU BFee and MU BFer*/ -+struct _RT_BEAMFORMER_ENTRY * -+beamforming_add_bfer_entry( -+ void *dm_void, -+ struct _RT_BEAMFORM_STAINFO *sta, -+ enum beamforming_cap beamform_cap, -+ u8 num_of_sounding_dim, -+ u8 *idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMER_ENTRY *entry = phydm_beamforming_get_free_bfer_entry(dm, idx); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ if (entry != NULL) { -+ entry->is_used = true; -+ odm_move_memory(dm, entry->my_mac_addr, sta->my_mac_addr, 6); -+ if (phydm_acting_determine(dm, phydm_acting_as_ap)) { -+ /*@BSSID[44:47] xor BSSID[40:43]*/ -+ u16 bssid = ((sta->my_mac_addr[5] & 0xf0) >> 4) ^ (sta->my_mac_addr[5] & 0xf); -+ -+ entry->p_aid = (sta->aid + bssid * 32) & 0x1ff; -+ entry->g_id = 63; -+ /*@(dec(A) + dec(B)*32) mod 512*/ -+ } else if (phydm_acting_determine(dm, phydm_acting_as_ibss)) { -+ entry->p_aid = 0; -+ entry->g_id = 63; -+ } else { -+ entry->p_aid = sta->ra[5]; -+ /*@BSSID[39:47]*/ -+ entry->p_aid = (entry->p_aid << 1) | (sta->ra[4] >> 7); -+ entry->g_id = 0; -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s: P_AID addressed to AP=0x%X\n", __func__, -+ entry->p_aid); -+ } -+ -+ cp_mac_addr(entry->mac_addr, sta->ra); -+ entry->beamform_entry_cap = beamform_cap; -+ -+ entry->pre_log_seq = 0; /*@Modified by Jeffery @2015-04-13*/ -+ entry->log_seq = 0; /*@Modified by Jeffery @2014-10-29*/ -+ entry->log_retry_cnt = 0; /*@Modified by Jeffery @2014-10-29*/ -+ entry->log_success = 0; /*@log_success is NOT needed to be accumulated, so LogSuccessCnt->log_success, 2015-04-13, Jeffery*/ -+ entry->clock_reset_times = 0; /*@Modified by Jeffery @2015-04-13*/ -+ -+ entry->num_of_sounding_dim = num_of_sounding_dim; -+ -+ if (beamform_cap & BEAMFORMEE_CAP_VHT_MU) { -+ dm->beamforming_info.beamformer_mu_cnt += 1; -+ entry->is_mu_ap = true; -+ entry->aid = sta->aid; -+ } else if (beamform_cap & (BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP_HT_EXPLICIT)) { -+ dm->beamforming_info.beamformer_su_cnt += 1; -+ entry->is_mu_ap = false; -+ } -+ -+ return entry; -+ } else -+ return NULL; -+} -+ -+/* Used for beamforming_start_v1 */ -+void phydm_beamforming_ndpa_rate( -+ void *dm_void, -+ enum channel_width BW, -+ u8 rate) -+{ -+ u16 ndpa_rate = rate; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ if (ndpa_rate == 0) { -+ if (dm->rssi_min > 30) /* @link RSSI > 30% */ -+ ndpa_rate = ODM_RATE24M; -+ else -+ ndpa_rate = ODM_RATE6M; -+ } -+ -+ if (ndpa_rate < ODM_RATEMCS0) -+ BW = (enum channel_width)CHANNEL_WIDTH_20; -+ -+ ndpa_rate = (ndpa_rate << 8) | BW; -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_RATE, (u8 *)&ndpa_rate); -+} -+ -+/* Used for beamforming_start_sw and beamforming_start_fw */ -+void phydm_beamforming_dym_ndpa_rate( -+ void *dm_void) -+{ -+ u16 ndpa_rate = ODM_RATE6M, BW; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ ndpa_rate = ODM_RATE6M; -+ BW = CHANNEL_WIDTH_20; -+ -+ ndpa_rate = ndpa_rate << 8 | BW; -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_RATE, (u8 *)&ndpa_rate); -+ PHYDM_DBG(dm, DBG_TXBF, "%s End, NDPA rate = 0x%X\n", __func__, -+ ndpa_rate); -+} -+ -+/*@ -+* SW Sounding : SW Timer unit 1ms -+* HW Timer unit (1/32000) s 32k is clock. -+* FW Sounding : FW Timer unit 10ms -+*/ -+void beamforming_dym_period( -+ void *dm_void, -+ u8 status) -+{ -+ u8 idx; -+ boolean is_change_period = false; -+ u16 sound_period_sw, sound_period_fw; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_SOUNDING_INFO *sound_info = &beam_info->sounding_info; -+ -+ struct _RT_BEAMFORMEE_ENTRY *entry = &beam_info->beamformee_entry[beam_info->beamformee_cur_idx]; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ /* @3 TODO per-client throughput caculation. */ -+ -+ if ((*dm->current_tx_tp + *dm->current_rx_tp > 2) && (entry->log_status_fail_cnt <= 20 || status)) { -+ sound_period_sw = 40; /* @40ms */ -+ sound_period_fw = 40; /* @From H2C cmd, unit = 10ms */ -+ } else { -+ sound_period_sw = 4000; /* @4s */ -+ sound_period_fw = 400; -+ } -+ PHYDM_DBG(dm, DBG_TXBF, "[%s]sound_period_sw=%d, sound_period_fw=%d\n", -+ __func__, sound_period_sw, sound_period_fw); -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ beamform_entry = beam_info->beamformee_entry + idx; -+ -+ if (beamform_entry->default_csi_cnt > 20) { -+ /*@Modified by David*/ -+ sound_period_sw = 4000; -+ sound_period_fw = 400; -+ } -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] period = %d\n", __func__, -+ sound_period_sw); -+ if ((beamform_entry->beamform_entry_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) == 0) -+ continue; -+ -+ if (sound_info->sound_mode == SOUNDING_FW_VHT_TIMER || sound_info->sound_mode == SOUNDING_FW_HT_TIMER) { -+ if (beamform_entry->sound_period != sound_period_fw) { -+ beamform_entry->sound_period = sound_period_fw; -+ is_change_period = true; /*Only FW sounding need to send H2C packet to change sound period. */ -+ } -+ } else if (beamform_entry->sound_period != sound_period_sw) -+ beamform_entry->sound_period = sound_period_sw; -+ } -+ -+ if (is_change_period) -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); -+} -+ -+boolean -+beamforming_send_ht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ enum channel_width BW, -+ u8 q_idx) -+{ -+ boolean ret = true; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (q_idx == BEACON_QUEUE) -+ ret = send_fw_ht_ndpa_packet(dm, RA, BW); -+ else -+ ret = send_sw_ht_ndpa_packet(dm, RA, BW); -+ -+ return ret; -+} -+ -+boolean -+beamforming_send_vht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ u16 AID, -+ enum channel_width BW, -+ u8 q_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ boolean ret = true; -+ -+ hal_com_txbf_set(dm, TXBF_SET_GET_TX_RATE, NULL); -+ -+ if (beam_info->tx_bf_data_rate >= ODM_RATEVHTSS3MCS7 && beam_info->tx_bf_data_rate <= ODM_RATEVHTSS3MCS9 && !beam_info->snding3ss) -+ PHYDM_DBG(dm, DBG_TXBF, "@%s: 3SS VHT 789 don't sounding\n", -+ __func__); -+ -+ else { -+ if (q_idx == BEACON_QUEUE) /* Send to reserved page => FW NDPA */ -+ ret = send_fw_vht_ndpa_packet(dm, RA, AID, BW); -+ else { -+#ifdef SUPPORT_MU_BF -+#if (SUPPORT_MU_BF == 1) -+ beam_info->is_mu_sounding = true; -+ ret = send_sw_vht_mu_ndpa_packet(dm, BW); -+#else -+ beam_info->is_mu_sounding = false; -+ ret = send_sw_vht_ndpa_packet(dm, RA, AID, BW); -+#endif -+#else -+ beam_info->is_mu_sounding = false; -+ ret = send_sw_vht_ndpa_packet(dm, RA, AID, BW); -+#endif -+ } -+ } -+ return ret; -+} -+ -+enum beamforming_notify_state -+phydm_beamfomring_is_sounding( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beam_info, -+ u8 *idx) -+{ -+ enum beamforming_notify_state is_sounding = BEAMFORMING_NOTIFY_NONE; -+ struct _RT_BEAMFORMING_OID_INFO beam_oid_info = beam_info->beamforming_oid_info; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ /*@if(( Beamforming_GetBeamCap(beam_info) & BEAMFORMER_CAP) == 0)*/ -+ /*@is_sounding = BEAMFORMING_NOTIFY_RESET;*/ -+ if (beam_oid_info.sound_oid_mode == sounding_stop_all_timer) { -+ is_sounding = BEAMFORMING_NOTIFY_RESET; -+ goto out; -+ } -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "@%s: BFee Entry %d is_used=%d, is_sound=%d\n", -+ __func__, i, beam_info->beamformee_entry[i].is_used, -+ beam_info->beamformee_entry[i].is_sound); -+ if (beam_info->beamformee_entry[i].is_used && !beam_info->beamformee_entry[i].is_sound) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s: Add BFee entry %d\n", -+ __func__, i); -+ *idx = i; -+ if (beam_info->beamformee_entry[i].is_mu_sta) -+ is_sounding = BEAMFORMEE_NOTIFY_ADD_MU; -+ else -+ is_sounding = BEAMFORMEE_NOTIFY_ADD_SU; -+ } -+ -+ if (!beam_info->beamformee_entry[i].is_used && beam_info->beamformee_entry[i].is_sound) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s: Delete BFee entry %d\n", -+ __func__, i); -+ *idx = i; -+ if (beam_info->beamformee_entry[i].is_mu_sta) -+ is_sounding = BEAMFORMEE_NOTIFY_DELETE_MU; -+ else -+ is_sounding = BEAMFORMEE_NOTIFY_DELETE_SU; -+ } -+ } -+ -+out: -+ PHYDM_DBG(dm, DBG_TXBF, "%s End, is_sounding = %d\n", __func__, -+ is_sounding); -+ return is_sounding; -+} -+ -+/* This function is unused */ -+u8 phydm_beamforming_sounding_idx( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beam_info) -+{ -+ u8 idx = 0; -+ struct _RT_BEAMFORMING_OID_INFO beam_oid_info = beam_info->beamforming_oid_info; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ if (beam_oid_info.sound_oid_mode == SOUNDING_SW_HT_TIMER || beam_oid_info.sound_oid_mode == SOUNDING_SW_VHT_TIMER || -+ beam_oid_info.sound_oid_mode == SOUNDING_HW_HT_TIMER || beam_oid_info.sound_oid_mode == SOUNDING_HW_VHT_TIMER) -+ idx = beam_oid_info.sound_oid_idx; -+ else { -+ u8 i; -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (beam_info->beamformee_entry[i].is_used && !beam_info->beamformee_entry[i].is_sound) { -+ idx = i; -+ break; -+ } -+ } -+ } -+ -+ return idx; -+} -+ -+enum sounding_mode -+phydm_beamforming_sounding_mode( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beam_info, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 support_interface = dm->support_interface; -+ -+ struct _RT_BEAMFORMEE_ENTRY beam_entry = beam_info->beamformee_entry[idx]; -+ struct _RT_BEAMFORMING_OID_INFO beam_oid_info = beam_info->beamforming_oid_info; -+ enum sounding_mode mode = beam_oid_info.sound_oid_mode; -+ -+ if (beam_oid_info.sound_oid_mode == SOUNDING_SW_VHT_TIMER || beam_oid_info.sound_oid_mode == SOUNDING_HW_VHT_TIMER) { -+ if (beam_entry.beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) -+ mode = beam_oid_info.sound_oid_mode; -+ else -+ mode = sounding_stop_all_timer; -+ } else if (beam_oid_info.sound_oid_mode == SOUNDING_SW_HT_TIMER || beam_oid_info.sound_oid_mode == SOUNDING_HW_HT_TIMER) { -+ if (beam_entry.beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) -+ mode = beam_oid_info.sound_oid_mode; -+ else -+ mode = sounding_stop_all_timer; -+ } else if (beam_entry.beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) { -+ if (support_interface == ODM_ITRF_USB && !(dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B))) -+ mode = SOUNDING_FW_VHT_TIMER; -+ else -+ mode = SOUNDING_SW_VHT_TIMER; -+ } else if (beam_entry.beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) { -+ if (support_interface == ODM_ITRF_USB && !(dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B))) -+ mode = SOUNDING_FW_HT_TIMER; -+ else -+ mode = SOUNDING_SW_HT_TIMER; -+ } else -+ mode = sounding_stop_all_timer; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] support_interface=%d, mode=%d\n", -+ __func__, support_interface, mode); -+ -+ return mode; -+} -+ -+u16 phydm_beamforming_sounding_time( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beam_info, -+ enum sounding_mode mode, -+ u8 idx) -+{ -+ u16 sounding_time = 0xffff; -+ struct _RT_BEAMFORMEE_ENTRY beam_entry = beam_info->beamformee_entry[idx]; -+ struct _RT_BEAMFORMING_OID_INFO beam_oid_info = beam_info->beamforming_oid_info; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ if (mode == SOUNDING_HW_HT_TIMER || mode == SOUNDING_HW_VHT_TIMER) -+ sounding_time = beam_oid_info.sound_oid_period * 32; -+ else if (mode == SOUNDING_SW_HT_TIMER || mode == SOUNDING_SW_VHT_TIMER) -+ /*@Modified by David*/ -+ sounding_time = beam_entry.sound_period; /*@beam_oid_info.sound_oid_period;*/ -+ else -+ sounding_time = beam_entry.sound_period; -+ -+ return sounding_time; -+} -+ -+enum channel_width -+phydm_beamforming_sounding_bw( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beam_info, -+ enum sounding_mode mode, -+ u8 idx) -+{ -+ enum channel_width sounding_bw = CHANNEL_WIDTH_20; -+ struct _RT_BEAMFORMEE_ENTRY beam_entry = beam_info->beamformee_entry[idx]; -+ struct _RT_BEAMFORMING_OID_INFO beam_oid_info = beam_info->beamforming_oid_info; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (mode == SOUNDING_HW_HT_TIMER || mode == SOUNDING_HW_VHT_TIMER) -+ sounding_bw = beam_oid_info.sound_oid_bw; -+ else if (mode == SOUNDING_SW_HT_TIMER || mode == SOUNDING_SW_VHT_TIMER) -+ /*@Modified by David*/ -+ sounding_bw = beam_entry.sound_bw; /*@beam_oid_info.sound_oid_bw;*/ -+ else -+ sounding_bw = beam_entry.sound_bw; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s, sounding_bw=0x%X\n", __func__, -+ sounding_bw); -+ -+ return sounding_bw; -+} -+ -+boolean -+phydm_beamforming_select_beam_entry( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beam_info) -+{ -+ struct _RT_SOUNDING_INFO *sound_info = &beam_info->sounding_info; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /*@entry.is_sound 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 sound_idx.*/ -+ sound_info->sound_idx = phydm_beamforming_sounding_idx(dm, beam_info); -+ /*sound_info->sound_idx = 0;*/ -+ -+ if (sound_info->sound_idx < BEAMFORMEE_ENTRY_NUM) -+ sound_info->sound_mode = phydm_beamforming_sounding_mode(dm, beam_info, sound_info->sound_idx); -+ else -+ sound_info->sound_mode = sounding_stop_all_timer; -+ -+ if (sounding_stop_all_timer == sound_info->sound_mode) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] Return because of sounding_stop_all_timer\n", -+ __func__); -+ return false; -+ } else { -+ sound_info->sound_bw = phydm_beamforming_sounding_bw(dm, beam_info, sound_info->sound_mode, sound_info->sound_idx); -+ sound_info->sound_period = phydm_beamforming_sounding_time(dm, beam_info, sound_info->sound_mode, sound_info->sound_idx); -+ return true; -+ } -+} -+ -+/*SU BFee Entry Only*/ -+boolean -+phydm_beamforming_start_period( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean ret = true; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_SOUNDING_INFO *sound_info = &beam_info->sounding_info; -+ -+ phydm_beamforming_dym_ndpa_rate(dm); -+ -+ phydm_beamforming_select_beam_entry(dm, beam_info); /* @Modified */ -+ -+ if (sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || sound_info->sound_mode == SOUNDING_SW_HT_TIMER) -+ odm_set_timer(dm, &beam_info->beamforming_timer, sound_info->sound_period); -+ else if (sound_info->sound_mode == SOUNDING_HW_VHT_TIMER || sound_info->sound_mode == SOUNDING_HW_HT_TIMER || -+ sound_info->sound_mode == SOUNDING_AUTO_VHT_TIMER || sound_info->sound_mode == SOUNDING_AUTO_HT_TIMER) { -+ HAL_HW_TIMER_TYPE timer_type = HAL_TIMER_TXBF; -+ u32 val = (sound_info->sound_period | (timer_type << 16)); -+ -+ /* @HW timer stop: All IC has the same setting */ -+ phydm_set_hw_reg_handler_interface(dm, HW_VAR_HW_REG_TIMER_STOP, (u8 *)(&timer_type)); -+ /* odm_write_1byte(dm, 0x15F, 0); */ -+ /* @HW timer init: All IC has the same setting, but 92E & 8812A only write 2 bytes */ -+ phydm_set_hw_reg_handler_interface(dm, HW_VAR_HW_REG_TIMER_INIT, (u8 *)(&val)); -+ /* odm_write_1byte(dm, 0x164, 1); */ -+ /* odm_write_4byte(dm, 0x15C, val); */ -+ /* @HW timer start: All IC has the same setting */ -+ phydm_set_hw_reg_handler_interface(dm, HW_VAR_HW_REG_TIMER_START, (u8 *)(&timer_type)); -+ /* odm_write_1byte(dm, 0x15F, 0x5); */ -+ } else if (sound_info->sound_mode == SOUNDING_FW_VHT_TIMER || sound_info->sound_mode == SOUNDING_FW_HT_TIMER) -+ ret = beamforming_start_fw(dm, sound_info->sound_idx); -+ else -+ ret = false; -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] sound_idx=%d, sound_mode=%d, sound_bw=%d, sound_period=%d\n", -+ __func__, sound_info->sound_idx, sound_info->sound_mode, -+ sound_info->sound_bw, sound_info->sound_period); -+ -+ return ret; -+} -+ -+/* Used after beamforming_leave, and will clear the setting of the "already deleted" entry -+ *SU BFee Entry Only*/ -+void phydm_beamforming_end_period_sw( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ /*void *adapter = dm->adapter;*/ -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_SOUNDING_INFO *sound_info = &beam_info->sounding_info; -+ -+ HAL_HW_TIMER_TYPE timer_type = HAL_TIMER_TXBF; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ if (sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || sound_info->sound_mode == SOUNDING_SW_HT_TIMER) -+ odm_cancel_timer(dm, &beam_info->beamforming_timer); -+ else if (sound_info->sound_mode == SOUNDING_HW_VHT_TIMER || sound_info->sound_mode == SOUNDING_HW_HT_TIMER || -+ sound_info->sound_mode == SOUNDING_AUTO_VHT_TIMER || sound_info->sound_mode == SOUNDING_AUTO_HT_TIMER) -+ /*@HW timer stop: All IC has the same setting*/ -+ phydm_set_hw_reg_handler_interface(dm, HW_VAR_HW_REG_TIMER_STOP, (u8 *)(&timer_type)); -+ /*odm_write_1byte(dm, 0x15F, 0);*/ -+} -+ -+void phydm_beamforming_end_period_fw( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 idx = 0; -+ -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s]\n", __func__); -+} -+ -+/*SU BFee Entry Only*/ -+void phydm_beamforming_clear_entry_sw( -+ void *dm_void, -+ boolean is_delete, -+ u8 delete_idx) -+{ -+ u8 idx = 0; -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = NULL; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ if (is_delete) { -+ if (delete_idx < BEAMFORMEE_ENTRY_NUM) { -+ beamform_entry = beam_info->beamformee_entry + delete_idx; -+ if (!(!beamform_entry->is_used && beamform_entry->is_sound)) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] SW delete_idx is wrong!!!!!\n", -+ __func__); -+ return; -+ } -+ } -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] SW delete BFee entry %d\n", -+ __func__, delete_idx); -+ if (beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) { -+ beamform_entry->is_beamforming_in_progress = false; -+ beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ } else if (beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&delete_idx); -+ } -+ beamform_entry->is_sound = false; -+ return; -+ } -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ beamform_entry = beam_info->beamformee_entry + idx; -+ -+ /*Used after is_sounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ -+ /*This function is mainly used in case "beam_oid_info.sound_oid_mode == sounding_stop_all_timer".*/ -+ /*@However, setting oid doesn't delete entries (is_used is still true), new entries may fail to be added in.*/ -+ -+ if (!beamform_entry->is_sound) -+ continue; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%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 (beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ phydm_beamforming_end_sw(dm, 0); -+ else if (beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&idx); -+ } -+ -+ beamform_entry->is_sound = false; -+ } -+} -+ -+void phydm_beamforming_clear_entry_fw( -+ void *dm_void, -+ boolean is_delete, -+ u8 delete_idx) -+{ -+ u8 idx = 0; -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = NULL; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ if (is_delete) { -+ if (delete_idx < BEAMFORMEE_ENTRY_NUM) { -+ beamform_entry = beam_info->beamformee_entry + delete_idx; -+ -+ if (!(!beamform_entry->is_used && beamform_entry->is_sound)) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] FW delete_idx is wrong!!!!!\n", -+ __func__); -+ return; -+ } -+ } -+ PHYDM_DBG(dm, DBG_TXBF, "%s: FW delete BFee entry %d\n", -+ __func__, delete_idx); -+ beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ beamform_entry->is_sound = false; -+ } else { -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ beamform_entry = beam_info->beamformee_entry + idx; -+ -+ /*Used after is_sounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ -+ /*This function is mainly used in case "beam_oid_info.sound_oid_mode == sounding_stop_all_timer".*/ -+ /*@However, setting oid doesn't delete entries (is_used is still true), new entries may fail to be added in.*/ -+ -+ if (beamform_entry->is_sound) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%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. -+ */ -+ -+ beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ beamform_entry->is_sound = false; -+ } -+ } -+ } -+} -+ -+/*@ -+* Called : -+* 1. Add and delete entry : beamforming_enter/beamforming_leave -+* 2. FW trigger : Beamforming_SetTxBFen -+* 3. Set OID_RT_BEAMFORMING_PERIOD : beamforming_control_v2 -+*/ -+void phydm_beamforming_notify( -+ void *dm_void) -+{ -+ u8 idx = BEAMFORMEE_ENTRY_NUM; -+ enum beamforming_notify_state is_sounding = BEAMFORMING_NOTIFY_NONE; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_SOUNDING_INFO *sound_info = &beam_info->sounding_info; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ is_sounding = phydm_beamfomring_is_sounding(dm, beam_info, &idx); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s, Before notify, is_sounding=%d, idx=%d\n", -+ __func__, is_sounding, idx); -+ PHYDM_DBG(dm, DBG_TXBF, "%s: beam_info->beamformee_su_cnt = %d\n", -+ __func__, beam_info->beamformee_su_cnt); -+ -+ switch (is_sounding) { -+ case BEAMFORMEE_NOTIFY_ADD_SU: -+ PHYDM_DBG(dm, DBG_TXBF, "%s: BEAMFORMEE_NOTIFY_ADD_SU\n", -+ __func__); -+ phydm_beamforming_start_period(dm); -+ break; -+ -+ case BEAMFORMEE_NOTIFY_DELETE_SU: -+ PHYDM_DBG(dm, DBG_TXBF, "%s: BEAMFORMEE_NOTIFY_DELETE_SU\n", -+ __func__); -+ if (sound_info->sound_mode == SOUNDING_FW_HT_TIMER || sound_info->sound_mode == SOUNDING_FW_VHT_TIMER) { -+ phydm_beamforming_clear_entry_fw(dm, true, idx); -+ if (beam_info->beamformee_su_cnt == 0) { /* @For 2->1 entry, we should not cancel SW timer */ -+ phydm_beamforming_end_period_fw(dm); -+ PHYDM_DBG(dm, DBG_TXBF, "%s: No BFee left\n", -+ __func__); -+ } -+ } else { -+ phydm_beamforming_clear_entry_sw(dm, true, idx); -+ if (beam_info->beamformee_su_cnt == 0) { /* @For 2->1 entry, we should not cancel SW timer */ -+ phydm_beamforming_end_period_sw(dm); -+ PHYDM_DBG(dm, DBG_TXBF, "%s: No BFee left\n", -+ __func__); -+ } -+ } -+ break; -+ -+ case BEAMFORMEE_NOTIFY_ADD_MU: -+ PHYDM_DBG(dm, DBG_TXBF, "%s: BEAMFORMEE_NOTIFY_ADD_MU\n", -+ __func__); -+ if (beam_info->beamformee_mu_cnt == 2) { -+ /*@if (sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || sound_info->sound_mode == SOUNDING_SW_HT_TIMER) -+ odm_set_timer(dm, &beam_info->beamforming_timer, sound_info->sound_period);*/ -+ odm_set_timer(dm, &beam_info->beamforming_timer, 1000); /*@Do MU sounding every 1sec*/ -+ } else -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s: Less or larger than 2 MU STAs, not to set timer\n", -+ __func__); -+ break; -+ -+ case BEAMFORMEE_NOTIFY_DELETE_MU: -+ PHYDM_DBG(dm, DBG_TXBF, "%s: BEAMFORMEE_NOTIFY_DELETE_MU\n", -+ __func__); -+ if (beam_info->beamformee_mu_cnt == 1) { -+ /*@if (sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || sound_info->sound_mode == SOUNDING_SW_HT_TIMER)*/ { -+ odm_cancel_timer(dm, &beam_info->beamforming_timer); -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s: Less than 2 MU STAs, stop sounding\n", -+ __func__); -+ } -+ } -+ break; -+ -+ case BEAMFORMING_NOTIFY_RESET: -+ if (sound_info->sound_mode == SOUNDING_FW_HT_TIMER || sound_info->sound_mode == SOUNDING_FW_VHT_TIMER) { -+ phydm_beamforming_clear_entry_fw(dm, false, idx); -+ phydm_beamforming_end_period_fw(dm); -+ } else { -+ phydm_beamforming_clear_entry_sw(dm, false, idx); -+ phydm_beamforming_end_period_sw(dm); -+ } -+ -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+boolean -+beamforming_init_entry(void *dm_void, u16 sta_idx, u8 *bfer_bfee_idx, -+ u8 *my_mac_addr) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *cmn_sta = dm->phydm_sta_info[sta_idx]; -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = NULL; -+ struct _RT_BEAMFORMER_ENTRY *beamformer_entry = NULL; -+ struct _RT_BEAMFORM_STAINFO *sta = NULL; -+ enum beamforming_cap beamform_cap = BEAMFORMING_CAP_NONE; -+ u8 bfer_idx = 0xF, bfee_idx = 0xF; -+ u8 num_of_sounding_dim = 0, comp_steering_num_of_bfer = 0; -+ -+ if (!is_sta_active(cmn_sta)) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s => sta_info(mac_id:%d) failed\n", -+ __func__, sta_idx); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtw_warn_on(1); -+ #endif -+ return false; -+ } -+ -+ sta = phydm_sta_info_init(dm, sta_idx, my_mac_addr); -+ /*The current setting does not support Beaforming*/ -+ if (BEAMFORMING_CAP_NONE == sta->ht_beamform_cap && BEAMFORMING_CAP_NONE == sta->vht_beamform_cap) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "The configuration disabled Beamforming! Skip...\n"); -+ return false; -+ } -+ -+ if (!(cmn_sta->support_wireless_set & (WIRELESS_VHT | WIRELESS_HT))) -+ return false; -+ else { -+ if (cmn_sta->support_wireless_set & WIRELESS_HT) { /*@HT*/ -+ if (TEST_FLAG(sta->cur_beamform, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { /*We are Beamformee because the STA is Beamformer*/ -+ beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMEE_CAP_HT_EXPLICIT); -+ num_of_sounding_dim = (sta->cur_beamform & BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP) >> 6; -+ } -+ /*We are Beamformer because the STA is Beamformee*/ -+ if (TEST_FLAG(sta->cur_beamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE) || -+ TEST_FLAG(sta->ht_beamform_cap, BEAMFORMING_HT_BEAMFORMER_TEST)) { -+ beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMER_CAP_HT_EXPLICIT); -+ comp_steering_num_of_bfer = (sta->cur_beamform & BEAMFORMING_HT_BEAMFORMER_STEER_NUM) >> 4; -+ } -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] HT cur_beamform=0x%X, beamform_cap=0x%X\n", -+ __func__, sta->cur_beamform, beamform_cap); -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] HT num_of_sounding_dim=%d, comp_steering_num_of_bfer=%d\n", -+ __func__, num_of_sounding_dim, -+ comp_steering_num_of_bfer); -+ } -+#if (ODM_IC_11AC_SERIES_SUPPORT == 1) -+ if (cmn_sta->support_wireless_set & WIRELESS_VHT) { /*VHT*/ -+ -+ /* We are Beamformee because the STA is SU Beamformer*/ -+ if (TEST_FLAG(sta->cur_beamform_vht, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { -+ beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMEE_CAP_VHT_SU); -+ num_of_sounding_dim = (sta->cur_beamform_vht & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM) >> 12; -+ } -+ /* We are Beamformer because the STA is SU Beamformee*/ -+ if (TEST_FLAG(sta->cur_beamform_vht, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) || -+ TEST_FLAG(sta->vht_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { -+ beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMER_CAP_VHT_SU); -+ comp_steering_num_of_bfer = (sta->cur_beamform_vht & BEAMFORMING_VHT_BEAMFORMER_STS_CAP) >> 8; -+ } -+ /* We are Beamformee because the STA is MU Beamformer*/ -+ if (TEST_FLAG(sta->cur_beamform_vht, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) { -+ beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMEE_CAP_VHT_MU); -+ num_of_sounding_dim = (sta->cur_beamform_vht & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM) >> 12; -+ } -+ /* We are Beamformer because the STA is MU Beamformee*/ -+ if (phydm_acting_determine(dm, phydm_acting_as_ap)) { /* Only AP mode supports to act an MU beamformer */ -+ if (TEST_FLAG(sta->cur_beamform_vht, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE) || -+ TEST_FLAG(sta->vht_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { -+ beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMER_CAP_VHT_MU); -+ comp_steering_num_of_bfer = (sta->cur_beamform_vht & BEAMFORMING_VHT_BEAMFORMER_STS_CAP) >> 8; -+ } -+ } -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s]VHT cur_beamform_vht=0x%X, beamform_cap=0x%X\n", -+ __func__, sta->cur_beamform_vht, -+ beamform_cap); -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s]VHT num_of_sounding_dim=0x%X, comp_steering_num_of_bfer=0x%X\n", -+ __func__, num_of_sounding_dim, -+ comp_steering_num_of_bfer); -+ } -+#endif -+ } -+ -+ if (beamform_cap == BEAMFORMING_CAP_NONE) -+ return false; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Self BF Entry Cap = 0x%02X\n", __func__, -+ beamform_cap); -+ -+ /*We are BFee, so the entry is BFer*/ -+ if (beamform_cap & (BEAMFORMEE_CAP_VHT_MU | BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP_HT_EXPLICIT)) { -+ beamformer_entry = phydm_beamforming_get_bfer_entry_by_addr(dm, sta->ra, &bfer_idx); -+ -+ if (beamformer_entry == NULL) { -+ beamformer_entry = beamforming_add_bfer_entry(dm, sta, beamform_cap, num_of_sounding_dim, &bfer_idx); -+ if (beamformer_entry == NULL) -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s]Not enough BFer entry!!!!!\n", -+ __func__); -+ } -+ } -+ -+ /*We are BFer, so the entry is BFee*/ -+ if (beamform_cap & (BEAMFORMER_CAP_VHT_MU | BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP_HT_EXPLICIT)) { -+ beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, sta->ra, &bfee_idx); -+ -+ /*@if BFeeIdx = 0xF, that represent for no matched MACID among all linked entrys */ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Get BFee entry 0x%X by address\n", -+ __func__, bfee_idx); -+ if (beamform_entry == NULL) { -+ beamform_entry = beamforming_add_bfee_entry(dm, sta, beamform_cap, num_of_sounding_dim, comp_steering_num_of_bfer, &bfee_idx); -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s]: sta->AID=%d, sta->mac_id=%d\n", -+ __func__, sta->aid, sta->mac_id); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s]: Add BFee entry %d\n", -+ __func__, bfee_idx); -+ -+ if (beamform_entry == NULL) -+ return false; -+ else -+ beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; -+ } else { -+ /*@Entry has been created. If entry is initialing or progressing then errors occur.*/ -+ if (beamform_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && -+ beamform_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) -+ return false; -+ else -+ beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; -+ } -+ beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ phydm_sta_info_update(dm, sta_idx, beamform_entry); -+ } -+ -+ *bfer_bfee_idx = (bfer_idx << 4) | bfee_idx; -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] End: bfer_idx=0x%X, bfee_idx=0x%X, bfer_bfee_idx=0x%X\n", -+ __func__, bfer_idx, bfee_idx, *bfer_bfee_idx); -+ -+ return true; -+} -+ -+void beamforming_deinit_entry( -+ void *dm_void, -+ u8 *RA) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 idx = 0; -+ -+ struct _RT_BEAMFORMER_ENTRY *bfer_entry = phydm_beamforming_get_bfer_entry_by_addr(dm, RA, &idx); -+ struct _RT_BEAMFORMEE_ENTRY *bfee_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ boolean ret = false; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ if (bfee_entry != NULL) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s, bfee_entry\n", __func__); -+ bfee_entry->is_used = false; -+ bfee_entry->beamform_entry_cap = BEAMFORMING_CAP_NONE; -+ bfee_entry->is_beamforming_in_progress = false; -+ if (bfee_entry->is_mu_sta) { -+ dm->beamforming_info.beamformee_mu_cnt -= 1; -+ dm->beamforming_info.first_mu_bfee_index = phydm_beamforming_get_first_mu_bfee_entry_idx(dm); -+ } else -+ dm->beamforming_info.beamformee_su_cnt -= 1; -+ ret = true; -+ } -+ -+ if (bfer_entry != NULL) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s, bfer_entry\n", __func__); -+ bfer_entry->is_used = false; -+ bfer_entry->beamform_entry_cap = BEAMFORMING_CAP_NONE; -+ if (bfer_entry->is_mu_ap) -+ dm->beamforming_info.beamformer_mu_cnt -= 1; -+ else -+ dm->beamforming_info.beamformer_su_cnt -= 1; -+ ret = true; -+ } -+ -+ if (ret == true) -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_LEAVE, (u8 *)&idx); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s End, idx = 0x%X\n", __func__, idx); -+} -+ -+boolean -+beamforming_start_v1( -+ void *dm_void, -+ u8 *RA, -+ boolean mode, -+ enum channel_width BW, -+ u8 rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 idx = 0; -+ struct _RT_BEAMFORMEE_ENTRY *entry; -+ boolean ret = true; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ -+ if (entry->is_used == false) { -+ entry->is_beamforming_in_progress = false; -+ return false; -+ } else { -+ if (entry->is_beamforming_in_progress) -+ return false; -+ -+ entry->is_beamforming_in_progress = true; -+ -+ if (mode == 1) { -+ if (!(entry->beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)) { -+ entry->is_beamforming_in_progress = false; -+ return false; -+ } -+ } else if (mode == 0) { -+ if (!(entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU)) { -+ entry->is_beamforming_in_progress = false; -+ return false; -+ } -+ } -+ -+ if (entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ entry->is_beamforming_in_progress = false; -+ return false; -+ } else { -+ entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ entry->is_sound = true; -+ } -+ } -+ -+ entry->sound_bw = BW; -+ beam_info->beamformee_cur_idx = idx; -+ phydm_beamforming_ndpa_rate(dm, BW, rate); -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&idx); -+ -+ if (mode == 1) -+ ret = beamforming_send_ht_ndpa_packet(dm, RA, BW, NORMAL_QUEUE); -+ else -+ ret = beamforming_send_vht_ndpa_packet(dm, RA, entry->aid, BW, NORMAL_QUEUE); -+ -+ if (ret == false) { -+ beamforming_leave(dm, RA); -+ entry->is_beamforming_in_progress = false; -+ return false; -+ } -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s idx %d\n", __func__, idx); -+ return true; -+} -+ -+boolean -+beamforming_start_sw( -+ void *dm_void, -+ u8 idx, -+ u8 mode, -+ enum channel_width BW) -+{ -+ u8 *ra = NULL; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMEE_ENTRY *entry; -+ boolean ret = true; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+#ifdef SUPPORT_MU_BF -+#if (SUPPORT_MU_BF == 1) -+ u8 i, poll_sta_cnt = 0; -+ boolean is_get_first_bfee = false; -+#endif -+#endif -+ -+ if (beam_info->is_mu_sounding) { -+ beam_info->is_mu_sounding_in_progress = true; -+ entry = &beam_info->beamformee_entry[idx]; -+ ra = entry->mac_addr; -+ -+ } else { -+ entry = &beam_info->beamformee_entry[idx]; -+ -+ if (entry->is_used == false) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "Skip Beamforming, no entry for idx =%d\n", -+ idx); -+ entry->is_beamforming_in_progress = false; -+ return false; -+ } -+ -+ if (entry->is_beamforming_in_progress) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "is_beamforming_in_progress, skip...\n"); -+ return false; -+ } -+ -+ entry->is_beamforming_in_progress = true; -+ ra = entry->mac_addr; -+ -+ if (mode == SOUNDING_SW_HT_TIMER || mode == SOUNDING_HW_HT_TIMER || mode == SOUNDING_AUTO_HT_TIMER) { -+ if (!(entry->beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)) { -+ entry->is_beamforming_in_progress = false; -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%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 (!(entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU)) { -+ entry->is_beamforming_in_progress = false; -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s Return by not support BEAMFORMER_CAP_VHT_SU <==\n", -+ __func__); -+ return false; -+ } -+ } -+ if (entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ entry->is_beamforming_in_progress = false; -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s Return by incorrect beamform_entry_state(%d) <==\n", -+ __func__, entry->beamform_entry_state); -+ return false; -+ } else { -+ entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ entry->is_sound = true; -+ } -+ -+ beam_info->beamformee_cur_idx = idx; -+ } -+ -+ /*@2014.12.22 Luke: Need to be checked*/ -+ /*@GET_TXBF_INFO(adapter)->fTxbfSet(adapter, TXBF_SET_SOUNDING_STATUS, (u8*)&idx);*/ -+ -+ if (mode == SOUNDING_SW_HT_TIMER || mode == SOUNDING_HW_HT_TIMER || mode == SOUNDING_AUTO_HT_TIMER) -+ ret = beamforming_send_ht_ndpa_packet(dm, ra, BW, NORMAL_QUEUE); -+ else -+ ret = beamforming_send_vht_ndpa_packet(dm, ra, entry->aid, BW, NORMAL_QUEUE); -+ -+ if (ret == false) { -+ beamforming_leave(dm, ra); -+ entry->is_beamforming_in_progress = false; -+ return false; -+ } -+ -+/*@-------------------------- -+ * Send BF Report Poll for MU BF -+ --------------------------*/ -+#ifdef SUPPORT_MU_BF -+#if (SUPPORT_MU_BF == 1) -+ if (beam_info->beamformee_mu_cnt <= 1) -+ goto out; -+ -+ /* @More than 1 MU STA*/ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ entry = &beam_info->beamformee_entry[i]; -+ if (!entry->is_mu_sta) -+ continue; -+ -+ if (!is_get_first_bfee) { -+ is_get_first_bfee = true; -+ continue; -+ } -+ -+ poll_sta_cnt++; -+ if (poll_sta_cnt == (beam_info->beamformee_mu_cnt - 1)) /* The last STA*/ -+ send_sw_vht_bf_report_poll(dm, entry->mac_addr, true); -+ else -+ send_sw_vht_bf_report_poll(dm, entry->mac_addr, false); -+ } -+out: -+#endif -+#endif -+ return true; -+} -+ -+boolean -+beamforming_start_fw( -+ void *dm_void, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMEE_ENTRY *entry; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ entry = &beam_info->beamformee_entry[idx]; -+ if (entry->is_used == false) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "Skip Beamforming, no entry for idx =%d\n", idx); -+ return false; -+ } -+ -+ entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ entry->is_sound = true; -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] End, idx=0x%X\n", __func__, idx); -+ return true; -+} -+ -+void beamforming_check_sounding_success( -+ void *dm_void, -+ boolean status) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *entry = &beam_info->beamformee_entry[beam_info->beamformee_cur_idx]; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[David]@%s Start!\n", __func__); -+ -+ if (status == 1) { -+ if (entry->log_status_fail_cnt == 21) -+ beamforming_dym_period(dm, status); -+ entry->log_status_fail_cnt = 0; -+ } else if (entry->log_status_fail_cnt <= 20) { -+ entry->log_status_fail_cnt++; -+ PHYDM_DBG(dm, DBG_TXBF, "%s log_status_fail_cnt %d\n", __func__, -+ entry->log_status_fail_cnt); -+ } -+ if (entry->log_status_fail_cnt > 20) { -+ entry->log_status_fail_cnt = 21; -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s log_status_fail_cnt > 20, Stop SOUNDING\n", -+ __func__); -+ beamforming_dym_period(dm, status); -+ } -+} -+ -+void phydm_beamforming_end_sw( -+ void *dm_void, -+ boolean status) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *entry = &beam_info->beamformee_entry[beam_info->beamformee_cur_idx]; -+ -+ if (beam_info->is_mu_sounding) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s: MU sounding done\n", __func__); -+ beam_info->is_mu_sounding_in_progress = false; -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, -+ (u8 *)&beam_info->beamformee_cur_idx); -+ } else { -+ if (entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSING) { -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] BeamformStatus %d\n", -+ __func__, entry->beamform_entry_state); -+ return; -+ } -+ -+ if (beam_info->tx_bf_data_rate >= ODM_RATEVHTSS3MCS7 && beam_info->tx_bf_data_rate <= ODM_RATEVHTSS3MCS9 && !beam_info->snding3ss) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] VHT3SS 7,8,9, do not apply V matrix.\n", -+ __func__); -+ entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, -+ (u8 *)&beam_info->beamformee_cur_idx); -+ } else if (status == 1) { -+ entry->log_status_fail_cnt = 0; -+ entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, -+ (u8 *)&beam_info->beamformee_cur_idx); -+ } else { -+ entry->log_status_fail_cnt++; -+ entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ hal_com_txbf_set(dm, TXBF_SET_TX_PATH_RESET, -+ (u8 *)&beam_info->beamformee_cur_idx); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] log_status_fail_cnt %d\n", -+ __func__, entry->log_status_fail_cnt); -+ } -+ -+ if (entry->log_status_fail_cnt > 50) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s log_status_fail_cnt > 50, Stop SOUNDING\n", -+ __func__); -+ entry->is_sound = false; -+ beamforming_deinit_entry(dm, entry->mac_addr); -+ -+ /*@Modified by David - Every action of deleting entry should follow by Notify*/ -+ phydm_beamforming_notify(dm); -+ } -+ -+ entry->is_beamforming_in_progress = false; -+ } -+ PHYDM_DBG(dm, DBG_TXBF, "%s: status=%d\n", __func__, status); -+} -+ -+void beamforming_timer_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *dm_void -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ void *context -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ void *adapter = (void *)context; -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->odmpriv; -+#endif -+ boolean ret = false; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ struct _RT_BEAMFORMEE_ENTRY *entry = &(beam_info->beamformee_entry[beam_info->beamformee_cur_idx]); -+ struct _RT_SOUNDING_INFO *sound_info = &(beam_info->sounding_info); -+ boolean is_beamforming_in_progress; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ if (beam_info->is_mu_sounding) -+ is_beamforming_in_progress = beam_info->is_mu_sounding_in_progress; -+ else -+ is_beamforming_in_progress = entry->is_beamforming_in_progress; -+ -+ if (is_beamforming_in_progress) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "is_beamforming_in_progress, reset it\n"); -+ phydm_beamforming_end_sw(dm, 0); -+ } -+ -+ ret = phydm_beamforming_select_beam_entry(dm, beam_info); -+#if (SUPPORT_MU_BF == 1) -+ if (ret && beam_info->beamformee_mu_cnt > 1) -+ ret = 1; -+ else -+ ret = 0; -+#endif -+ if (ret) -+ ret = beamforming_start_sw(dm, sound_info->sound_idx, sound_info->sound_mode, sound_info->sound_bw); -+ else -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s, Error value return from BeamformingStart_V2\n", -+ __func__); -+ -+ if (beam_info->beamformee_su_cnt != 0 || beam_info->beamformee_mu_cnt > 1) { -+ if (sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || sound_info->sound_mode == SOUNDING_SW_HT_TIMER) -+ odm_set_timer(dm, &beam_info->beamforming_timer, sound_info->sound_period); -+ else { -+ u32 val = (sound_info->sound_period << 16) | HAL_TIMER_TXBF; -+ phydm_set_hw_reg_handler_interface(dm, HW_VAR_HW_REG_TIMER_RESTART, (u8 *)(&val)); -+ } -+ } -+} -+ -+void beamforming_sw_timer_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct phydm_timer_list *timer -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ void *function_context -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = (void *)timer->Adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ beamforming_timer_callback(dm); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ struct dm_struct *dm = (struct dm_struct *)function_context; -+ void *adapter = dm->adapter; -+ -+ if (*dm->is_net_closed == true) -+ return; -+ phydm_run_in_thread_cmd(dm, beamforming_timer_callback, adapter); -+#endif -+} -+ -+void phydm_beamforming_init( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMING_OID_INFO *beam_oid_info = &beam_info->beamforming_oid_info; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ -+#ifdef BEAMFORMING_VERSION_1 -+ if (hal_data->beamforming_version != BEAMFORMING_VERSION_1) { -+ return; -+ } -+#endif -+#endif -+ -+ beam_oid_info->sound_oid_mode = SOUNDING_STOP_OID_TIMER; -+ PHYDM_DBG(dm, DBG_TXBF, "%s mode (%d)\n", __func__, -+ beam_oid_info->sound_oid_mode); -+ -+ beam_info->beamformee_su_cnt = 0; -+ beam_info->beamformer_su_cnt = 0; -+ beam_info->beamformee_mu_cnt = 0; -+ beam_info->beamformer_mu_cnt = 0; -+ beam_info->beamformee_mu_reg_maping = 0; -+ beam_info->mu_ap_index = 0; -+ beam_info->is_mu_sounding = false; -+ beam_info->first_mu_bfee_index = 0xFF; -+ beam_info->apply_v_matrix = true; -+ beam_info->snding3ss = false; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ beam_info->source_adapter = dm->adapter; -+#endif -+ hal_com_txbf_beamform_init(dm); -+} -+ -+boolean -+phydm_acting_determine( -+ void *dm_void, -+ enum phydm_acting_type type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean ret = false; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = dm->beamforming_info.source_adapter; -+#else -+ struct _ADAPTER *adapter = dm->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(((PADAPTER)(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(void *dm_void, u16 sta_idx, u8 *my_mac_addr) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 bfer_bfee_idx = 0xff; -+ -+ if (beamforming_init_entry(dm, sta_idx, &bfer_bfee_idx, my_mac_addr)) -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_ENTER, (u8 *)&bfer_bfee_idx); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] End!\n", __func__); -+} -+ -+void beamforming_leave( -+ void *dm_void, -+ u8 *RA) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (RA != NULL) { -+ beamforming_deinit_entry(dm, RA); -+ phydm_beamforming_notify(dm); -+ } -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] End!!\n", __func__); -+} -+ -+enum beamforming_cap -+phydm_beamforming_get_beam_cap( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beam_info) -+{ -+ u8 i; -+ boolean is_self_beamformer = false; -+ boolean is_self_beamformee = false; -+ struct _RT_BEAMFORMEE_ENTRY beamformee_entry; -+ struct _RT_BEAMFORMER_ENTRY beamformer_entry; -+ enum beamforming_cap beamform_cap = BEAMFORMING_CAP_NONE; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ beamformee_entry = beam_info->beamformee_entry[i]; -+ -+ if (beamformee_entry.is_used) { -+ is_self_beamformer = true; -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] BFee entry %d is_used=true\n", __func__, -+ i); -+ break; -+ } -+ } -+ -+ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { -+ beamformer_entry = beam_info->beamformer_entry[i]; -+ -+ if (beamformer_entry.is_used) { -+ is_self_beamformee = true; -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s]: BFer entry %d is_used=true\n", -+ __func__, i); -+ break; -+ } -+ } -+ -+ if (is_self_beamformer) -+ beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMER_CAP); -+ if (is_self_beamformee) -+ beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMEE_CAP); -+ -+ return beamform_cap; -+} -+ -+boolean -+beamforming_control_v1( -+ void *dm_void, -+ u8 *RA, -+ u8 AID, -+ u8 mode, -+ enum channel_width BW, -+ u8 rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean ret = true; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "AID (%d), mode (%d), BW (%d)\n", AID, mode, -+ BW); -+ -+ switch (mode) { -+ case 0: -+ ret = beamforming_start_v1(dm, RA, 0, BW, rate); -+ break; -+ case 1: -+ ret = beamforming_start_v1(dm, RA, 1, BW, rate); -+ break; -+ case 2: -+ phydm_beamforming_ndpa_rate(dm, BW, rate); -+ ret = beamforming_send_vht_ndpa_packet(dm, RA, AID, BW, NORMAL_QUEUE); -+ break; -+ case 3: -+ phydm_beamforming_ndpa_rate(dm, BW, rate); -+ ret = beamforming_send_ht_ndpa_packet(dm, RA, BW, NORMAL_QUEUE); -+ break; -+ } -+ return ret; -+} -+ -+/*Only OID uses this function*/ -+boolean -+phydm_beamforming_control_v2( -+ void *dm_void, -+ u8 idx, -+ u8 mode, -+ enum channel_width BW, -+ u16 period) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMING_OID_INFO *beam_oid_info = &beam_info->beamforming_oid_info; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ PHYDM_DBG(dm, DBG_TXBF, "idx (%d), mode (%d), BW (%d), period (%d)\n", -+ idx, mode, BW, period); -+ -+ beam_oid_info->sound_oid_idx = idx; -+ beam_oid_info->sound_oid_mode = (enum sounding_mode)mode; -+ beam_oid_info->sound_oid_bw = BW; -+ beam_oid_info->sound_oid_period = period; -+ -+ phydm_beamforming_notify(dm); -+ -+ return true; -+} -+ -+void phydm_beamforming_watchdog( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); -+ -+ if (beam_info->beamformee_su_cnt == 0) -+ return; -+ -+ beamforming_dym_period(dm, 0); -+} -+enum beamforming_cap -+phydm_get_beamform_cap( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = NULL; -+ struct bf_cmn_info *bf_info = NULL; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ void *adapter = dm->adapter; -+ enum beamforming_cap beamform_cap = BEAMFORMING_CAP_NONE; -+ u8 macid; -+ u8 ht_curbeamformcap = 0; -+ u16 vht_curbeamformcap = 0; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMGNT_INFO p_MgntInfo = &(((PADAPTER)(adapter))->MgntInfo); -+ PRT_VERY_HIGH_THROUGHPUT p_vht_info = GET_VHT_INFO(p_MgntInfo); -+ PRT_HIGH_THROUGHPUT p_ht_info = GET_HT_INFO(p_MgntInfo); -+ -+ ht_curbeamformcap = p_ht_info->HtCurBeamform; -+ vht_curbeamformcap = p_vht_info->VhtCurBeamform; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[%s] WIN ht_curcap = %d ; vht_curcap = %d\n", __func__, -+ ht_curbeamformcap, vht_curbeamformcap); -+ -+ if (TEST_FLAG(ht_curbeamformcap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) /*We are Beamformee because the STA is Beamformer*/ -+ beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_HT_EXPLICIT | BEAMFORMEE_CAP)); -+ -+ /*We are Beamformer because the STA is Beamformee*/ -+ if (TEST_FLAG(ht_curbeamformcap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) -+ beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP)); -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT == 1) -+ -+ /* We are Beamformee because the STA is SU Beamformer*/ -+ if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) -+ beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP)); -+ -+ /* We are Beamformer because the STA is SU Beamformee*/ -+ if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) -+ beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP)); -+ -+ /* We are Beamformee because the STA is MU Beamformer*/ -+ if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) -+ beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_VHT_MU | BEAMFORMEE_CAP)); -+#endif -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+ for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { -+ sta = dm->phydm_sta_info[macid]; -+ -+ if (!is_sta_active(sta)) -+ continue; -+ -+ bf_info = &sta->bf_info; -+ vht_curbeamformcap = bf_info->vht_beamform_cap; -+ ht_curbeamformcap = bf_info->ht_beamform_cap; -+ -+ if (TEST_FLAG(ht_curbeamformcap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) /*We are Beamformee because the STA is Beamformer*/ -+ beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_HT_EXPLICIT | BEAMFORMEE_CAP)); -+ -+ /*We are Beamformer because the STA is Beamformee*/ -+ if (TEST_FLAG(ht_curbeamformcap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) -+ beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP)); -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT == 1) -+ /* We are Beamformee because the STA is SU Beamformer*/ -+ if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) -+ beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP)); -+ -+ /* We are Beamformer because the STA is SU Beamformee*/ -+ if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) -+ beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP)); -+ -+ /* We are Beamformee because the STA is MU Beamformer*/ -+ if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) -+ beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_VHT_MU | BEAMFORMEE_CAP)); -+#endif -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[%s] CE ht_curcap = %d ; vht_curcap = %d\n", -+ __func__, ht_curbeamformcap, vht_curbeamformcap); -+ -+#endif -+ -+ return beamform_cap; -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_beamforming.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_beamforming.h -new file mode 100644 -index 000000000..efb53e309 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_beamforming.h -@@ -0,0 +1,363 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __INC_PHYDM_BEAMFORMING_H -+#define __INC_PHYDM_BEAMFORMING_H -+ -+/*@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" -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+#define eq_mac_addr(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 cp_mac_addr(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]) -+ -+#endif -+ -+#define MAX_BEAMFORMEE_SU 2 -+#define MAX_BEAMFORMER_SU 2 -+#if ((RTL8822B_SUPPORT == 1) || (RTL8812F_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 -+ -+enum beamforming_entry_state { -+ BEAMFORMING_ENTRY_STATE_UNINITIALIZE, -+ BEAMFORMING_ENTRY_STATE_INITIALIZEING, -+ BEAMFORMING_ENTRY_STATE_INITIALIZED, -+ BEAMFORMING_ENTRY_STATE_PROGRESSING, -+ BEAMFORMING_ENTRY_STATE_PROGRESSED -+}; -+ -+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 -+}; -+ -+enum beamforming_cap { -+ BEAMFORMING_CAP_NONE = 0x0, -+ BEAMFORMER_CAP_HT_EXPLICIT = BIT(1), -+ BEAMFORMEE_CAP_HT_EXPLICIT = BIT(2), -+ BEAMFORMER_CAP_VHT_SU = BIT(5), /* @Self has er Cap, because Reg er & peer ee */ -+ BEAMFORMEE_CAP_VHT_SU = BIT(6), /* @Self has ee Cap, because Reg ee & peer er */ -+ BEAMFORMER_CAP_VHT_MU = BIT(7), /* @Self has er Cap, because Reg er & peer ee */ -+ BEAMFORMEE_CAP_VHT_MU = BIT(8), /* @Self has ee Cap, because Reg ee & peer er */ -+ BEAMFORMER_CAP = BIT(9), -+ BEAMFORMEE_CAP = BIT(10), -+}; -+ -+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, -+}; -+ -+struct _RT_BEAMFORM_STAINFO { -+ u8 *ra; -+ u16 aid; -+ u16 mac_id; -+ u8 my_mac_addr[6]; -+ /*WIRELESS_MODE wireless_mode;*/ -+ enum channel_width bw; -+ enum beamforming_cap beamform_cap; -+ u8 ht_beamform_cap; -+ u16 vht_beamform_cap; -+ u8 cur_beamform; -+ u16 cur_beamform_vht; -+}; -+ -+struct _RT_BEAMFORMEE_ENTRY { -+ boolean is_used; -+ boolean is_txbf; -+ boolean is_sound; -+ 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 g_id; /*Used to fill Tx DESC*/ -+ u8 my_mac_addr[6]; -+ u8 mac_addr[6]; /*@Used to fill Reg6E4 to fill Mac address of CSI report frame.*/ -+ enum channel_width sound_bw; /*Sounding band_width*/ -+ u16 sound_period; -+ enum beamforming_cap beamform_entry_cap; -+ enum beamforming_entry_state beamform_entry_state; -+ boolean is_beamforming_in_progress; -+ /*@u8 log_seq; // Move to _RT_BEAMFORMER_ENTRY*/ -+ /*@u16 log_retry_cnt:3; // 0~4 // Move to _RT_BEAMFORMER_ENTRY*/ -+ /*@u16 LogSuccessCnt:2; // 0~2 // Move to _RT_BEAMFORMER_ENTRY*/ -+ u16 log_status_fail_cnt : 5; /* @0~21 */ -+ u16 default_csi_cnt : 5; /* @0~21 */ -+ u8 csi_matrix[327]; -+ u16 csi_matrix_len; -+ u8 num_of_sounding_dim; -+ u8 comp_steering_num_of_bfer; -+ u8 su_reg_index; -+ /*@For MU-MIMO*/ -+ boolean is_mu_sta; -+ u8 mu_reg_index; -+ u8 gid_valid[8]; -+ u8 user_position[16]; -+}; -+ -+struct _RT_BEAMFORMER_ENTRY { -+ boolean is_used; -+ /*P_AID of BFer entry is probably not used*/ -+ u16 p_aid; /*@Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ -+ u8 g_id; -+ u8 my_mac_addr[6]; -+ u8 mac_addr[6]; -+ enum beamforming_cap beamform_entry_cap; -+ u8 num_of_sounding_dim; -+ u8 clock_reset_times; /*@Modified by Jeffery @2015-04-10*/ -+ u8 pre_log_seq; /*@Modified by Jeffery @2015-03-30*/ -+ u8 log_seq; /*@Modified by Jeffery @2014-10-29*/ -+ u16 log_retry_cnt : 3; /*@Modified by Jeffery @2014-10-29*/ -+ u16 log_success : 2; /*@Modified by Jeffery @2014-10-29*/ -+ u8 su_reg_index; -+ /*@For MU-MIMO*/ -+ boolean is_mu_ap; -+ u8 gid_valid[8]; -+ u8 user_position[16]; -+ u16 aid; -+}; -+ -+struct _RT_SOUNDING_INFO { -+ u8 sound_idx; -+ enum channel_width sound_bw; -+ enum sounding_mode sound_mode; -+ u16 sound_period; -+}; -+ -+struct _RT_BEAMFORMING_OID_INFO { -+ u8 sound_oid_idx; -+ enum channel_width sound_oid_bw; -+ enum sounding_mode sound_oid_mode; -+ u16 sound_oid_period; -+}; -+ -+struct _RT_BEAMFORMING_INFO { -+ enum beamforming_cap beamform_cap; -+ struct _RT_BEAMFORMEE_ENTRY beamformee_entry[BEAMFORMEE_ENTRY_NUM]; -+ struct _RT_BEAMFORMER_ENTRY beamformer_entry[BEAMFORMER_ENTRY_NUM]; -+ struct _RT_BEAMFORM_STAINFO beamform_sta_info; -+ u8 beamformee_cur_idx; -+ struct phydm_timer_list beamforming_timer; -+ struct phydm_timer_list mu_timer; -+ struct _RT_SOUNDING_INFO sounding_info; -+ struct _RT_BEAMFORMING_OID_INFO beamforming_oid_info; -+ struct _HAL_TXBF_INFO txbf_info; -+ 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 mu_ap_index; -+ boolean is_mu_sounding; -+ u8 first_mu_bfee_index; -+ boolean is_mu_sounding_in_progress; -+ boolean dbg_disable_mu_tx; -+ boolean apply_v_matrix; -+ boolean snding3ss; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *source_adapter; -+#endif -+ /* @Control register */ -+ u32 reg_mu_tx_ctrl; /* @For USB/SDIO interfaces aync I/O */ -+ u8 tx_bf_data_rate; -+ u8 last_usb_hub; -+}; -+ -+void phydm_get_txbf_device_num( -+ void *dm_void, -+ u8 macid); -+ -+struct _RT_NDPA_STA_INFO { -+ u16 aid : 12; -+ u16 feedback_type : 1; -+ u16 nc_index : 3; -+}; -+ -+enum phydm_acting_type { -+ phydm_acting_as_ibss = 0, -+ phydm_acting_as_ap = 1 -+}; -+ -+enum beamforming_cap -+phydm_beamforming_get_entry_beam_cap_by_mac_id( -+ void *dm_void, -+ u8 mac_id); -+ -+struct _RT_BEAMFORMEE_ENTRY * -+phydm_beamforming_get_bfee_entry_by_addr( -+ void *dm_void, -+ u8 *RA, -+ u8 *idx); -+ -+struct _RT_BEAMFORMER_ENTRY * -+phydm_beamforming_get_bfer_entry_by_addr( -+ void *dm_void, -+ u8 *TA, -+ u8 *idx); -+ -+void phydm_beamforming_notify( -+ void *dm_void); -+ -+boolean -+phydm_acting_determine( -+ void *dm_void, -+ enum phydm_acting_type type); -+ -+void beamforming_enter(void *dm_void, u16 sta_idx, u8 *my_mac_addr); -+ -+void beamforming_leave( -+ void *dm_void, -+ u8 *RA); -+ -+boolean -+beamforming_start_fw( -+ void *dm_void, -+ u8 idx); -+ -+void beamforming_check_sounding_success( -+ void *dm_void, -+ boolean status); -+ -+void phydm_beamforming_end_sw( -+ void *dm_void, -+ boolean status); -+ -+void beamforming_timer_callback( -+ void *dm_void); -+ -+void phydm_beamforming_init( -+ void *dm_void); -+ -+enum beamforming_cap -+phydm_beamforming_get_beam_cap( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beam_info); -+ -+enum beamforming_cap -+phydm_get_beamform_cap( -+ void *dm_void); -+ -+boolean -+beamforming_control_v1( -+ void *dm_void, -+ u8 *RA, -+ u8 AID, -+ u8 mode, -+ enum channel_width BW, -+ u8 rate); -+ -+boolean -+phydm_beamforming_control_v2( -+ void *dm_void, -+ u8 idx, -+ u8 mode, -+ enum channel_width BW, -+ u16 period); -+ -+void phydm_beamforming_watchdog( -+ void *dm_void); -+ -+void beamforming_sw_timer_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct phydm_timer_list *timer -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ void *function_context -+#endif -+ ); -+ -+boolean -+beamforming_send_ht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ enum channel_width BW, -+ u8 q_idx); -+ -+boolean -+beamforming_send_vht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ u16 AID, -+ enum channel_width BW, -+ u8 q_idx); -+ -+#else -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_AP)) -+#define beamforming_gid_paid(adapter, tcb) -+#define phydm_acting_determine(dm, type) false -+#define beamforming_enter(dm, sta_idx, my_mac_addr) -+#define beamforming_leave(dm, RA) -+#define beamforming_end_fw(dm) -+#define beamforming_control_v1(dm, RA, AID, mode, BW, rate) true -+#define beamforming_control_v2(dm, idx, mode, BW, period) true -+#define phydm_beamforming_end_sw(dm, _status) -+#define beamforming_timer_callback(dm) -+#define phydm_beamforming_init(dm) -+#define phydm_beamforming_control_v2(dm, _idx, _mode, _BW, _period) false -+#define beamforming_watchdog(dm) -+#define phydm_beamforming_watchdog(dm) -+#endif /*@(DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP))*/ -+#endif /*@#ifdef PHYDM_BEAMFORMING_SUPPORT*/ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_pd.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_pd.c -new file mode 100644 -index 000000000..15a4b9319 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_pd.c -@@ -0,0 +1,1940 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef PHYDM_SUPPORT_CCKPD -+#ifdef PHYDM_COMPILE_CCKPD_TYPE1 -+void phydm_write_cck_pd_type1(void *dm_void, u8 cca_th) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "[%s] cck_cca_th=((0x%x))\n", -+ __func__, cca_th); -+ -+ odm_write_1byte(dm, R_0xa0a, cca_th); -+ cckpd_t->cur_cck_cca_thres = cca_th; -+} -+ -+void phydm_set_cckpd_lv_type1(void *dm_void, enum cckpd_lv lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u8 pd_th = 0; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_CCKPD, "lv: (%d) -> (%d)\n", cckpd_t->cck_pd_lv, lv); -+ -+ if (cckpd_t->cck_pd_lv == lv) { -+ PHYDM_DBG(dm, DBG_CCKPD, "stay in lv=%d\n", lv); -+ return; -+ } -+ -+ cckpd_t->cck_pd_lv = lv; -+ cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; -+ -+ if (lv == CCK_PD_LV_4) -+ pd_th = 0xed; -+ else if (lv == CCK_PD_LV_3) -+ pd_th = 0xdd; -+ else if (lv == CCK_PD_LV_2) -+ pd_th = 0xcd; -+ else if (lv == CCK_PD_LV_1) -+ pd_th = 0x83; -+ else if (lv == CCK_PD_LV_0) -+ pd_th = 0x40; -+ -+ phydm_write_cck_pd_type1(dm, pd_th); -+} -+ -+void phydm_cckpd_type1(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ enum cckpd_lv lv = CCK_PD_LV_INIT; -+ boolean is_update = true; -+ -+ if (dm->is_linked) { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ if (dm->support_ic_type & ODM_RTL8822B) { -+ if (dm->rssi_min > 35) { -+ lv = CCK_PD_LV_2; -+ } else if (dm->rssi_min > 20) { -+ if (cckpd_t->cck_fa_ma > 500) -+ lv = CCK_PD_LV_2; -+ else if (cckpd_t->cck_fa_ma < 250) -+ lv = CCK_PD_LV_1; -+ else -+ is_update = false; -+ } else { /*RSSI < 20*/ -+ lv = CCK_PD_LV_1; -+ } -+ } else { -+ if (dm->rssi_min > 60) { -+ lv = CCK_PD_LV_3; -+ } else if (dm->rssi_min > 35) { -+ lv = CCK_PD_LV_2; -+ } else if (dm->rssi_min > 20) { -+ if (cckpd_t->cck_fa_ma > 500) -+ lv = CCK_PD_LV_2; -+ else if (cckpd_t->cck_fa_ma < 250) -+ lv = CCK_PD_LV_1; -+ else -+ is_update = false; -+ } else { /*RSSI < 20*/ -+ lv = CCK_PD_LV_1; -+ } -+ } -+ #else /*ODM_AP*/ -+ if (dig_t->cur_ig_value > 0x32) { -+ lv = CCK_PD_LV_4; -+ // remove lv4 only for 8822b -+ if (dm->support_ic_type & ODM_RTL8822B) { -+ lv = CCK_PD_LV_3; -+ } -+ } else if (dig_t->cur_ig_value > 0x2a) { -+ lv = CCK_PD_LV_3; -+ } else if (dig_t->cur_ig_value > 0x24) { -+ lv = CCK_PD_LV_2; -+ } else { -+ lv = CCK_PD_LV_1; -+ } -+ #endif -+ } else { -+ if (cckpd_t->cck_fa_ma > 1000) -+ lv = CCK_PD_LV_1; -+ else if (cckpd_t->cck_fa_ma < 500) -+ lv = CCK_PD_LV_0; -+ else -+ is_update = false; -+ } -+ -+ /*[Abnormal case] =================================================*/ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ /*@HP 22B LPS power consumption issue & [PCIE-1596]*/ -+ if (dm->hp_hw_id && dm->traffic_load == TRAFFIC_ULTRA_LOW) { -+ lv = CCK_PD_LV_0; -+ PHYDM_DBG(dm, DBG_CCKPD, "CCKPD Abnormal case1\n"); -+ } else if ((dm->p_advance_ota & PHYDM_ASUS_OTA_SETTING) && -+ cckpd_t->cck_fa_ma > 200 && dm->rssi_min <= 20) { -+ lv = CCK_PD_LV_1; -+ cckpd_t->cck_pd_lv = lv; -+ phydm_write_cck_pd_type1(dm, 0xc3); /*@for ASUS OTA test*/ -+ is_update = false; -+ PHYDM_DBG(dm, DBG_CCKPD, "CCKPD Abnormal case2\n"); -+ } -+ #elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ #ifdef MCR_WIRELESS_EXTEND -+ lv = CCK_PD_LV_2; -+ cckpd_t->cck_pd_lv = lv; -+ phydm_write_cck_pd_type1(dm, 0x43); -+ is_update = false; -+ PHYDM_DBG(dm, DBG_CCKPD, "CCKPD Abnormal case3\n"); -+ #endif -+ #endif -+ /*=================================================================*/ -+ -+ if (is_update) -+ phydm_set_cckpd_lv_type1(dm, lv); -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "is_linked=%d, lv=%d, pd_th=0x%x\n\n", -+ dm->is_linked, cckpd_t->cck_pd_lv, -+ cckpd_t->cur_cck_cca_thres); -+} -+#endif /*#ifdef PHYDM_COMPILE_CCKPD_TYPE1*/ -+ -+#ifdef PHYDM_COMPILE_CCKPD_TYPE2 -+void phydm_write_cck_pd_type2(void *dm_void, u8 cca_th, u8 cca_th_aaa) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "[%s] pd_th=0x%x, cs_ratio=0x%x\n", -+ __func__, cca_th, cca_th_aaa); -+ -+ odm_set_bb_reg(dm, R_0xa08, 0x3f0000, cca_th); -+ odm_set_bb_reg(dm, R_0xaa8, 0x1f0000, cca_th_aaa); -+ cckpd_t->cur_cck_cca_thres = cca_th; -+ cckpd_t->cck_cca_th_aaa = cca_th_aaa; -+} -+ -+void phydm_set_cckpd_lv_type2(void *dm_void, enum cckpd_lv lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u8 pd_th = 0, cs_ratio = 0, cs_2r_offset = 0; -+ u8 cck_n_rx = 1; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_CCKPD, "lv: (%d) -> (%d)\n", cckpd_t->cck_pd_lv, lv); -+ -+ /*@r_mrx & r_cca_mrc*/ -+ cck_n_rx = (odm_get_bb_reg(dm, R_0xa2c, BIT(18)) && -+ odm_get_bb_reg(dm, R_0xa2c, BIT(22))) ? 2 : 1; -+ -+ if (cckpd_t->cck_pd_lv == lv && cckpd_t->cck_n_rx == cck_n_rx) { -+ PHYDM_DBG(dm, DBG_CCKPD, "stay in lv=%d\n", lv); -+ return; -+ } -+ -+ cckpd_t->cck_n_rx = cck_n_rx; -+ cckpd_t->cck_pd_lv = lv; -+ cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; -+ -+ if (lv == CCK_PD_LV_4) { -+ cs_ratio = cckpd_t->aaa_default + 8; -+ cs_2r_offset = 5; -+ pd_th = 0xd; -+ } else if (lv == CCK_PD_LV_3) { -+ cs_ratio = cckpd_t->aaa_default + 6; -+ cs_2r_offset = 4; -+ pd_th = 0xd; -+ } else if (lv == CCK_PD_LV_2) { -+ cs_ratio = cckpd_t->aaa_default + 4; -+ cs_2r_offset = 3; -+ pd_th = 0xd; -+ } else if (lv == CCK_PD_LV_1) { -+ cs_ratio = cckpd_t->aaa_default + 2; -+ cs_2r_offset = 1; -+ pd_th = 0x7; -+ } else if (lv == CCK_PD_LV_0) { -+ cs_ratio = cckpd_t->aaa_default; -+ cs_2r_offset = 0; -+ pd_th = 0x3; -+ } -+ -+ if (cckpd_t->cck_n_rx == 2) { -+ if (cs_ratio >= cs_2r_offset) -+ cs_ratio = cs_ratio - cs_2r_offset; -+ else -+ cs_ratio = 0; -+ } -+ phydm_write_cck_pd_type2(dm, pd_th, cs_ratio); -+} -+ -+#if 0 -+void phydm_set_cckpd_lv_type2_bcn(void *dm_void, enum cckpd_lv lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u8 pd_th = 0, cs_ratio = 0, cs_2r_offset = 0; -+ u8 cck_n_rx = 1; -+ u8 cs_ratio_pre = 0; -+ u8 bcn_cnt = dm->phy_dbg_info.beacon_cnt_in_period; //BCN CNT -+ u8 ofst = 0; -+ u8 ofst_direc = 0; //0:+, 1:- -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_CCKPD, "lv: (%d) -> (%d)\n", cckpd_t->cck_pd_lv, lv); -+ -+ /*@r_mrx & r_cca_mrc*/ -+ cck_n_rx = (odm_get_bb_reg(dm, R_0xa2c, BIT(18)) && -+ odm_get_bb_reg(dm, R_0xa2c, BIT(22))) ? 2 : 1; -+ cs_ratio_pre = (u8)((odm_get_bb_reg(dm, R_0xaa8, 0x1f0000))); -+ PHYDM_DBG(dm, DBG_CCKPD, "BCN: %d, pre CS ratio: 0x%x\n", bcn_cnt, -+ cs_ratio_pre); -+ -+ if (cckpd_t->cck_pd_lv == lv && cckpd_t->cck_n_rx == cck_n_rx && -+ (bcn_cnt >= 10 && bcn_cnt < 14)) { -+ PHYDM_DBG(dm, DBG_CCKPD, "BCN ok, stay lv=%d, cs ratio=0x%x\n", -+ lv, cs_ratio_pre); -+ return; -+ } -+ -+ cckpd_t->cck_n_rx = cck_n_rx; -+ cckpd_t->cck_pd_lv = lv; -+ cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; -+ -+ if (lv == CCK_PD_LV_4) { -+ cs_ratio = cckpd_t->aaa_default + 8; -+ cs_2r_offset = 5; -+ pd_th = 0xd; -+ } else if (lv == CCK_PD_LV_3) { -+ cs_ratio = cckpd_t->aaa_default + 6; -+ cs_2r_offset = 4; -+ pd_th = 0xd; -+ } else if (lv == CCK_PD_LV_2) { -+ cs_ratio = cckpd_t->aaa_default + 4; -+ cs_2r_offset = 3; -+ pd_th = 0xd; -+ } else if (lv == CCK_PD_LV_1) { -+ cs_ratio = cckpd_t->aaa_default + 2; -+ cs_2r_offset = 1; -+ pd_th = 0x7; -+ } else if (lv == CCK_PD_LV_0) { -+ cs_ratio = cckpd_t->aaa_default; -+ cs_2r_offset = 0; -+ pd_th = 0x3; -+ } -+ -+ if (cckpd_t->cck_n_rx == 2) { -+ if (cs_ratio >= cs_2r_offset) -+ cs_ratio = cs_ratio - cs_2r_offset; -+ else -+ cs_ratio = 0; -+ } -+ -+ if (bcn_cnt >= 18) { -+ ofst_direc = 0; -+ ofst = 0x2; -+ } else if (bcn_cnt >= 14) { -+ ofst_direc = 0; -+ ofst = 0x1; -+ } else if (bcn_cnt >= 10) { -+ ofst_direc = 0; -+ ofst = 0x0; -+ } else if (bcn_cnt >= 5) { -+ ofst_direc = 1; -+ ofst = 0x3; -+ } else { -+ ofst_direc = 1; -+ ofst = 0x4; -+ } -+ PHYDM_DBG(dm, DBG_CCKPD, "bcn:(%d), ofst:(%s%d)\n", bcn_cnt, -+ ((ofst_direc) ? "-" : "+"), ofst); -+ -+ if (ofst_direc == 0) -+ cs_ratio = cs_ratio + ofst; -+ else -+ cs_ratio = cs_ratio - ofst; -+ -+ if (cs_ratio == cs_ratio_pre) { -+ PHYDM_DBG(dm, DBG_CCKPD, "Same cs ratio, lv=%d cs_ratio=0x%x\n", -+ lv, cs_ratio); -+ return; -+ } -+ phydm_write_cck_pd_type2(dm, pd_th, cs_ratio); -+} -+#endif -+ -+void phydm_cckpd_type2(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ enum cckpd_lv lv = CCK_PD_LV_INIT; -+ u8 igi = dig_t->cur_ig_value; -+ u8 rssi_min = dm->rssi_min; -+ boolean is_update = true; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ -+ if (dm->is_linked) { -+ if (igi > 0x38 && rssi_min > 32) { -+ lv = CCK_PD_LV_4; -+ } else if (igi > 0x2a && rssi_min > 32) { -+ lv = CCK_PD_LV_3; -+ } else if (igi > 0x24 || (rssi_min > 24 && rssi_min <= 30)) { -+ lv = CCK_PD_LV_2; -+ } else if (igi <= 0x24 || rssi_min < 22) { -+ if (cckpd_t->cck_fa_ma > 1000) { -+ lv = CCK_PD_LV_1; -+ } else if (cckpd_t->cck_fa_ma < 500) { -+ lv = CCK_PD_LV_0; -+ } else { -+ is_update = false; -+ } -+ } else { -+ is_update = false; -+ } -+ } else { -+ if (cckpd_t->cck_fa_ma > 1000) { -+ lv = CCK_PD_LV_1; -+ } else if (cckpd_t->cck_fa_ma < 500) { -+ lv = CCK_PD_LV_0; -+ } else { -+ is_update = false; -+ } -+ } -+ -+ /*[Abnormal case] =================================================*/ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ /*@21C Miracast lag issue & [PCIE-3298]*/ -+ if (dm->support_ic_type & ODM_RTL8821C && rssi_min > 60) { -+ lv = CCK_PD_LV_4; -+ cckpd_t->cck_pd_lv = lv; -+ phydm_write_cck_pd_type2(dm, 0x1d, (cckpd_t->aaa_default + 8)); -+ is_update = false; -+ PHYDM_DBG(dm, DBG_CCKPD, "CCKPD Abnormal case1\n"); -+ } -+ #endif -+ /*=================================================================*/ -+ -+ if (is_update) { -+ phydm_set_cckpd_lv_type2(dm, lv); -+ } -+ -+ PHYDM_DBG(dm, DBG_CCKPD, -+ "is_linked=%d, lv=%d, n_rx=%d, cs_ratio=0x%x, pd_th=0x%x\n\n", -+ dm->is_linked, cckpd_t->cck_pd_lv, cckpd_t->cck_n_rx, -+ cckpd_t->cck_cca_th_aaa, cckpd_t->cur_cck_cca_thres); -+} -+#endif /*#ifdef PHYDM_COMPILE_CCKPD_TYPE2*/ -+ -+#ifdef PHYDM_COMPILE_CCKPD_TYPE3 -+void phydm_write_cck_pd_type3(void *dm_void, u8 pd_th, u8 cs_ratio, -+ enum cckpd_mode mode) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, -+ "[%s] mode=%d, pd_th=0x%x, cs_ratio=0x%x\n", __func__, -+ mode, pd_th, cs_ratio); -+ -+ switch (mode) { -+ case CCK_BW20_1R: /*RFBW20_1R*/ -+ { -+ cckpd_t->cur_cck_pd_20m_1r = pd_th; -+ cckpd_t->cur_cck_cs_ratio_20m_1r = cs_ratio; -+ odm_set_bb_reg(dm, R_0xac8, 0xff, pd_th); -+ odm_set_bb_reg(dm, R_0xad0, 0x1f, cs_ratio); -+ } break; -+ case CCK_BW20_2R: /*RFBW20_2R*/ -+ { -+ cckpd_t->cur_cck_pd_20m_2r = pd_th; -+ cckpd_t->cur_cck_cs_ratio_20m_2r = cs_ratio; -+ odm_set_bb_reg(dm, R_0xac8, 0xff00, pd_th); -+ odm_set_bb_reg(dm, R_0xad0, 0x3e0, cs_ratio); -+ } break; -+ case CCK_BW40_1R: /*RFBW40_1R*/ -+ { -+ cckpd_t->cur_cck_pd_40m_1r = pd_th; -+ cckpd_t->cur_cck_cs_ratio_40m_1r = cs_ratio; -+ odm_set_bb_reg(dm, R_0xacc, 0xff, pd_th); -+ odm_set_bb_reg(dm, R_0xad0, 0x1f00000, cs_ratio); -+ } break; -+ case CCK_BW40_2R: /*RFBW40_2R*/ -+ { -+ cckpd_t->cur_cck_pd_40m_2r = pd_th; -+ cckpd_t->cur_cck_cs_ratio_40m_2r = cs_ratio; -+ odm_set_bb_reg(dm, R_0xacc, 0xff00, pd_th); -+ odm_set_bb_reg(dm, R_0xad0, 0x3e000000, cs_ratio); -+ } break; -+ -+ default: -+ /*@pr_debug("[%s] warning!\n", __func__);*/ -+ break; -+ } -+} -+ -+void phydm_set_cckpd_lv_type3(void *dm_void, enum cckpd_lv lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ enum cckpd_mode cck_mode = CCK_BW20_2R; -+ enum channel_width cck_bw = CHANNEL_WIDTH_20; -+ u8 cck_n_rx = 1; -+ u8 pd_th; -+ u8 cs_ratio; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_CCKPD, "lv: (%d) -> (%d)\n", cckpd_t->cck_pd_lv, lv); -+ -+ /*[Check Nrx]*/ -+ cck_n_rx = (odm_get_bb_reg(dm, R_0xa2c, BIT(17))) ? 2 : 1; -+ -+ /*[Check BW]*/ -+ if (odm_get_bb_reg(dm, R_0x800, BIT(0))) -+ cck_bw = CHANNEL_WIDTH_40; -+ else -+ cck_bw = CHANNEL_WIDTH_20; -+ -+ /*[Check LV]*/ -+ if (cckpd_t->cck_pd_lv == lv && -+ cckpd_t->cck_n_rx == cck_n_rx && -+ cckpd_t->cck_bw == cck_bw) { -+ PHYDM_DBG(dm, DBG_CCKPD, "stay in lv=%d\n", lv); -+ return; -+ } -+ -+ cckpd_t->cck_bw = cck_bw; -+ cckpd_t->cck_n_rx = cck_n_rx; -+ cckpd_t->cck_pd_lv = lv; -+ cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; -+ -+ if (cck_n_rx == 2) { -+ if (cck_bw == CHANNEL_WIDTH_20) { -+ pd_th = cckpd_t->cck_pd_20m_2r; -+ cs_ratio = cckpd_t->cck_cs_ratio_20m_2r; -+ cck_mode = CCK_BW20_2R; -+ } else { -+ pd_th = cckpd_t->cck_pd_40m_2r; -+ cs_ratio = cckpd_t->cck_cs_ratio_40m_2r; -+ cck_mode = CCK_BW40_2R; -+ } -+ } else { -+ if (cck_bw == CHANNEL_WIDTH_20) { -+ pd_th = cckpd_t->cck_pd_20m_1r; -+ cs_ratio = cckpd_t->cck_cs_ratio_20m_1r; -+ cck_mode = CCK_BW20_1R; -+ } else { -+ pd_th = cckpd_t->cck_pd_40m_1r; -+ cs_ratio = cckpd_t->cck_cs_ratio_40m_1r; -+ cck_mode = CCK_BW40_1R; -+ } -+ } -+ -+ if (lv == CCK_PD_LV_4) { -+ if (cck_n_rx == 2) { -+ pd_th += 4; -+ cs_ratio += 2; -+ } else { -+ pd_th += 4; -+ cs_ratio += 3; -+ } -+ } else if (lv == CCK_PD_LV_3) { -+ if (cck_n_rx == 2) { -+ pd_th += 3; -+ cs_ratio += 1; -+ } else { -+ pd_th += 3; -+ cs_ratio += 2; -+ } -+ } else if (lv == CCK_PD_LV_2) { -+ pd_th += 2; -+ cs_ratio += 1; -+ } else if (lv == CCK_PD_LV_1) { -+ pd_th += 1; -+ cs_ratio += 1; -+ } -+ -+ phydm_write_cck_pd_type3(dm, pd_th, cs_ratio, cck_mode); -+} -+ -+void phydm_cckpd_type3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ enum cckpd_lv lv = CCK_PD_LV_INIT; -+ u8 igi = dm->dm_dig_table.cur_ig_value; -+ boolean is_update = true; -+ u8 pd_th = 0; -+ u8 cs_ratio = 0; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ -+ if (dm->is_linked) { -+ if (igi > 0x38 && dm->rssi_min > 32) { -+ lv = CCK_PD_LV_4; -+ } else if ((igi > 0x2a) && (dm->rssi_min > 32)) { -+ lv = CCK_PD_LV_3; -+ } else if ((igi > 0x24) || -+ (dm->rssi_min > 24 && dm->rssi_min <= 30)) { -+ lv = CCK_PD_LV_2; -+ } else if ((igi <= 0x24) || (dm->rssi_min < 22)) { -+ if (cckpd_t->cck_fa_ma > 1000) -+ lv = CCK_PD_LV_1; -+ else if (cckpd_t->cck_fa_ma < 500) -+ lv = CCK_PD_LV_0; -+ else -+ is_update = false; -+ } -+ if ((dm->anti_interference_en != NULL) && (*dm->anti_interference_en == 1)) { -+ if (igi >= 0x20 && dm->rssi_min >= 27 && (igi - dm->rssi_min < 10)) { -+ //printf(">>>>>TUYA CCK FA CNT = %d, RSSI = %d, IGI =%d \n", cckpd_t->cck_fa_ma, dm->rssi_min, igi); -+ is_update = false; -+ odm_set_bb_reg(dm, R_0xa08, BIT(21) | BIT(20), 0x2); -+ //odm_set_bb_reg(dm, R_0xac8, 0xff, 0x18); -+ } -+ else { -+ //printf("CCK FA CNT = %d, RSSI = %d, IGI =%d \n", cckpd_t->cck_fa_ma, dm->rssi_min, igi); -+ odm_set_bb_reg(dm, R_0xa08, BIT(21) | BIT(20), cckpd_t->cck_din_shift_opt); -+ //odm_set_bb_reg(dm, R_0xac8, 0xff, cckpd_t->cck_pd_20m_1r); -+ } -+ } -+ } else { -+ if (cckpd_t->cck_fa_ma > 1000) -+ lv = CCK_PD_LV_1; -+ else if (cckpd_t->cck_fa_ma < 500) -+ lv = CCK_PD_LV_0; -+ else -+ is_update = false; -+ } -+ -+ if (is_update) -+ phydm_set_cckpd_lv_type3(dm, lv); -+ -+ if (cckpd_t->cck_n_rx == 2) { -+ if (cckpd_t->cck_bw == CHANNEL_WIDTH_20) { -+ pd_th = cckpd_t->cur_cck_pd_20m_2r; -+ cs_ratio = cckpd_t->cur_cck_cs_ratio_20m_2r; -+ } else { -+ pd_th = cckpd_t->cur_cck_pd_40m_2r; -+ cs_ratio = cckpd_t->cur_cck_cs_ratio_40m_2r; -+ } -+ } else { -+ if (cckpd_t->cck_bw == CHANNEL_WIDTH_20) { -+ pd_th = cckpd_t->cur_cck_pd_20m_1r; -+ cs_ratio = cckpd_t->cur_cck_cs_ratio_20m_1r; -+ } else { -+ pd_th = cckpd_t->cur_cck_pd_40m_1r; -+ cs_ratio = cckpd_t->cur_cck_cs_ratio_40m_1r; -+ } -+ } -+ PHYDM_DBG(dm, DBG_CCKPD, -+ "[%dR][%dM] is_linked=%d, lv=%d, cs_ratio=0x%x, pd_th=0x%x\n\n", -+ cckpd_t->cck_n_rx, 20 << cckpd_t->cck_bw, dm->is_linked, -+ cckpd_t->cck_pd_lv, cs_ratio, pd_th); -+} -+ -+void phydm_cck_pd_init_type3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u32 reg_tmp = 0; -+ -+ /*Get Default value*/ -+ cckpd_t->cck_pd_20m_1r = (u8)odm_get_bb_reg(dm, R_0xac8, 0xff); -+ cckpd_t->cck_pd_20m_2r = (u8)odm_get_bb_reg(dm, R_0xac8, 0xff00); -+ cckpd_t->cck_pd_40m_1r = (u8)odm_get_bb_reg(dm, R_0xacc, 0xff); -+ cckpd_t->cck_pd_40m_2r = (u8)odm_get_bb_reg(dm, R_0xacc, 0xff00); -+ cckpd_t->cck_din_shift_opt = (u8)odm_get_bb_reg(dm, R_0xa08, BIT(21) | BIT(20)); -+ -+ reg_tmp = odm_get_bb_reg(dm, R_0xad0, MASKDWORD); -+ cckpd_t->cck_cs_ratio_20m_1r = (u8)(reg_tmp & 0x1f); -+ cckpd_t->cck_cs_ratio_20m_2r = (u8)((reg_tmp & 0x3e0) >> 5); -+ cckpd_t->cck_cs_ratio_40m_1r = (u8)((reg_tmp & 0x1f00000) >> 20); -+ cckpd_t->cck_cs_ratio_40m_2r = (u8)((reg_tmp & 0x3e000000) >> 25); -+} -+#endif /*#ifdef PHYDM_COMPILE_CCKPD_TYPE3*/ -+ -+#ifdef PHYDM_COMPILE_CCKPD_TYPE4 -+void phydm_write_cck_pd_type4(void *dm_void, enum cckpd_lv lv, -+ enum cckpd_mode mode) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u32 val = 0; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "write CCK CCA parameters(CS_ratio & PD)\n"); -+ switch (mode) { -+ case CCK_BW20_1R: /*RFBW20_1R*/ -+ { -+ val = cckpd_t->cckpd_jgr3[0][0][0][lv]; -+ odm_set_bb_reg(dm, R_0x1ac8, 0xff, val); -+ val = cckpd_t->cckpd_jgr3[0][0][1][lv]; -+ odm_set_bb_reg(dm, R_0x1ad0, 0x1f, val); -+ } break; -+ case CCK_BW40_1R: /*RFBW40_1R*/ -+ { -+ val = cckpd_t->cckpd_jgr3[1][0][0][lv]; -+ odm_set_bb_reg(dm, R_0x1acc, 0xff, val); -+ val = cckpd_t->cckpd_jgr3[1][0][1][lv]; -+ odm_set_bb_reg(dm, R_0x1ad0, 0x01F00000, val); -+ } break; -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case CCK_BW20_2R: /*RFBW20_2R*/ -+ { -+ val = cckpd_t->cckpd_jgr3[0][1][0][lv]; -+ odm_set_bb_reg(dm, R_0x1ac8, 0xff00, val); -+ val = cckpd_t->cckpd_jgr3[0][1][1][lv]; -+ odm_set_bb_reg(dm, R_0x1ad0, 0x3e0, val); -+ } break; -+ case CCK_BW40_2R: /*RFBW40_2R*/ -+ { -+ val = cckpd_t->cckpd_jgr3[1][1][0][lv]; -+ odm_set_bb_reg(dm, R_0x1acc, 0xff00, val); -+ val = cckpd_t->cckpd_jgr3[1][1][1][lv]; -+ odm_set_bb_reg(dm, R_0x1ad0, 0x3E000000, val); -+ } break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case CCK_BW20_3R: /*RFBW20_3R*/ -+ { -+ val = cckpd_t->cckpd_jgr3[0][2][0][lv]; -+ odm_set_bb_reg(dm, R_0x1ac8, 0xff0000, val); -+ val = cckpd_t->cckpd_jgr3[0][2][1][lv]; -+ odm_set_bb_reg(dm, R_0x1ad0, 0x7c00, val); -+ } break; -+ case CCK_BW40_3R: /*RFBW40_3R*/ -+ { -+ val = cckpd_t->cckpd_jgr3[1][2][0][lv]; -+ odm_set_bb_reg(dm, R_0x1acc, 0xff0000, val); -+ val = cckpd_t->cckpd_jgr3[1][2][1][lv] & 0x3; -+ odm_set_bb_reg(dm, R_0x1ad0, 0xC0000000, val); -+ val = (cckpd_t->cckpd_jgr3[1][2][1][lv] & 0x1c) >> 2; -+ odm_set_bb_reg(dm, R_0x1ad4, 0x7, val); -+ } break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case CCK_BW20_4R: /*RFBW20_4R*/ -+ { -+ val = cckpd_t->cckpd_jgr3[0][3][0][lv]; -+ odm_set_bb_reg(dm, R_0x1ac8, 0xff000000, val); -+ val = cckpd_t->cckpd_jgr3[0][3][1][lv]; -+ odm_set_bb_reg(dm, R_0x1ad0, 0xF8000, val); -+ } break; -+ case CCK_BW40_4R: /*RFBW40_4R*/ -+ { -+ val = cckpd_t->cckpd_jgr3[1][3][0][lv]; -+ odm_set_bb_reg(dm, R_0x1acc, 0xff000000, val); -+ val = cckpd_t->cckpd_jgr3[1][3][1][lv]; -+ odm_set_bb_reg(dm, R_0x1ad4, 0xf8, val); -+ } break; -+ #endif -+ default: -+ /*@pr_debug("[%s] warning!\n", __func__);*/ -+ break; -+ } -+} -+ -+void phydm_set_cck_pd_lv_type4(void *dm_void, enum cckpd_lv lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ enum cckpd_mode cck_mode = CCK_BW20_2R; -+ enum channel_width cck_bw = CHANNEL_WIDTH_20; -+ u8 cck_n_rx = 0; -+ u32 val = 0; -+ /*u32 val_dbg = 0;*/ -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_CCKPD, "lv: (%d) -> (%d)\n", cckpd_t->cck_pd_lv, lv); -+ -+ /*[Check Nrx]*/ -+ cck_n_rx = (u8)odm_get_bb_reg(dm, R_0x1a2c, 0x60000) + 1; -+ -+ /*[Check BW]*/ -+ val = odm_get_bb_reg(dm, R_0x9b0, 0xc); -+ if (val == 0) -+ cck_bw = CHANNEL_WIDTH_20; -+ else if (val == 1) -+ cck_bw = CHANNEL_WIDTH_40; -+ else -+ cck_bw = CHANNEL_WIDTH_80; -+ -+ /*[Check LV]*/ -+ if (cckpd_t->cck_pd_lv == lv && -+ cckpd_t->cck_n_rx == cck_n_rx && -+ cckpd_t->cck_bw == cck_bw) { -+ PHYDM_DBG(dm, DBG_CCKPD, "stay in lv=%d\n", lv); -+ return; -+ } -+ -+ cckpd_t->cck_bw = cck_bw; -+ cckpd_t->cck_n_rx = cck_n_rx; -+ cckpd_t->cck_pd_lv = lv; -+ cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; -+ -+ switch (cck_n_rx) { -+ case 1: /*1R*/ -+ { -+ if (cck_bw == CHANNEL_WIDTH_20) -+ cck_mode = CCK_BW20_1R; -+ else if (cck_bw == CHANNEL_WIDTH_40) -+ cck_mode = CCK_BW40_1R; -+ } break; -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case 2: /*2R*/ -+ { -+ if (cck_bw == CHANNEL_WIDTH_20) -+ cck_mode = CCK_BW20_2R; -+ else if (cck_bw == CHANNEL_WIDTH_40) -+ cck_mode = CCK_BW40_2R; -+ } break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case 3: /*3R*/ -+ { -+ if (cck_bw == CHANNEL_WIDTH_20) -+ cck_mode = CCK_BW20_3R; -+ else if (cck_bw == CHANNEL_WIDTH_40) -+ cck_mode = CCK_BW40_3R; -+ } break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case 4: /*4R*/ -+ { -+ if (cck_bw == CHANNEL_WIDTH_20) -+ cck_mode = CCK_BW20_4R; -+ else if (cck_bw == CHANNEL_WIDTH_40) -+ cck_mode = CCK_BW40_4R; -+ } break; -+ #endif -+ default: -+ /*@pr_debug("[%s] warning!\n", __func__);*/ -+ break; -+ } -+ phydm_write_cck_pd_type4(dm, lv, cck_mode); -+} -+ -+void phydm_read_cckpd_para_type4(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u8 bw = 0; /*r_RX_RF_BW*/ -+ u8 n_rx = 0; -+ u8 curr_cck_pd_t[2][4][2]; -+ u32 reg0 = 0; -+ u32 reg1 = 0; -+ u32 reg2 = 0; -+ u32 reg3 = 0; -+ -+ if (!(dm->debug_components & DBG_CCKPD)) -+ return; -+ -+ bw = (u8)odm_get_bb_reg(dm, R_0x9b0, 0xc); -+ n_rx = (u8)odm_get_bb_reg(dm, R_0x1a2c, 0x60000) + 1; -+ -+ reg0 = odm_get_bb_reg(dm, R_0x1ac8, MASKDWORD); -+ reg1 = odm_get_bb_reg(dm, R_0x1acc, MASKDWORD); -+ reg2 = odm_get_bb_reg(dm, R_0x1ad0, MASKDWORD); -+ reg3 = odm_get_bb_reg(dm, R_0x1ad4, MASKDWORD); -+ curr_cck_pd_t[0][0][0] = (u8)(reg0 & 0x000000ff); -+ curr_cck_pd_t[1][0][0] = (u8)(reg1 & 0x000000ff); -+ curr_cck_pd_t[0][0][1] = (u8)(reg2 & 0x0000001f); -+ curr_cck_pd_t[1][0][1] = (u8)((reg2 & 0x01f00000) >> 20); -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) { -+ curr_cck_pd_t[0][1][0] = (u8)((reg0 & 0x0000ff00) >> 8); -+ curr_cck_pd_t[1][1][0] = (u8)((reg1 & 0x0000ff00) >> 8); -+ curr_cck_pd_t[0][1][1] = (u8)((reg2 & 0x000003E0) >> 5); -+ curr_cck_pd_t[1][1][1] = (u8)((reg2 & 0x3E000000) >> 25); -+ } -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_3SS) { -+ curr_cck_pd_t[0][2][0] = (u8)((reg0 & 0x00ff0000) >> 16); -+ curr_cck_pd_t[1][2][0] = (u8)((reg1 & 0x00ff0000) >> 16); -+ curr_cck_pd_t[0][2][1] = (u8)((reg2 & 0x00007C00) >> 10); -+ curr_cck_pd_t[1][2][1] = (u8)((reg2 & 0xC0000000) >> 30) | -+ (u8)((reg3 & 0x00000007) << 2); -+ } -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { -+ curr_cck_pd_t[0][3][0] = (u8)((reg0 & 0xff000000) >> 24); -+ curr_cck_pd_t[1][3][0] = (u8)((reg1 & 0xff000000) >> 24); -+ curr_cck_pd_t[0][3][1] = (u8)((reg2 & 0x000F8000) >> 15); -+ curr_cck_pd_t[1][3][1] = (u8)((reg3 & 0x000000F8) >> 3); -+ } -+ #endif -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "bw=%dM, Nrx=%d\n", 20 << bw, n_rx); -+ PHYDM_DBG(dm, DBG_CCKPD, "lv=%d, readback CS_th=0x%x, PD th=0x%x\n", -+ cckpd_t->cck_pd_lv, -+ curr_cck_pd_t[bw][n_rx - 1][1], -+ curr_cck_pd_t[bw][n_rx - 1][0]); -+} -+ -+void phydm_cckpd_type4(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u8 igi = dm->dm_dig_table.cur_ig_value; -+ enum cckpd_lv lv = 0; -+ boolean is_update = true; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ -+ if (dm->is_linked) { -+ PHYDM_DBG(dm, DBG_CCKPD, "Linked!!!\n"); -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ if (dm->rssi_min > 40) { -+ lv = CCK_PD_LV_4; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 1\n"); -+ } else if (dm->rssi_min > 32) { -+ lv = CCK_PD_LV_3; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 2\n"); -+ } else if (dm->rssi_min > 24) { -+ lv = CCK_PD_LV_2; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 3\n"); -+ } else { -+ if (cckpd_t->cck_fa_ma > 1000) { -+ lv = CCK_PD_LV_1; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 4-1\n"); -+ } else if (cckpd_t->cck_fa_ma < 500) { -+ lv = CCK_PD_LV_0; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 4-2\n"); -+ } else { -+ is_update = false; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 4-3\n"); -+ } -+ } -+ #else /*ODM_AP*/ -+ if (igi > 0x38 && dm->rssi_min > 32) { -+ lv = CCK_PD_LV_4; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 1\n"); -+ } else if (igi > 0x2a && dm->rssi_min > 32) { -+ lv = CCK_PD_LV_3; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 2\n"); -+ } else if (igi > 0x24 || dm->rssi_min > 24) { -+ lv = CCK_PD_LV_2; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 3\n"); -+ } else { -+ if (cckpd_t->cck_fa_ma > 1000) { -+ lv = CCK_PD_LV_1; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 4-1\n"); -+ } else if (cckpd_t->cck_fa_ma < 500) { -+ lv = CCK_PD_LV_0; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 4-2\n"); -+ } else { -+ is_update = false; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 4-3\n"); -+ } -+ } -+ #endif -+ } else { -+ PHYDM_DBG(dm, DBG_CCKPD, "UnLinked!!!\n"); -+ if (cckpd_t->cck_fa_ma > 1000) { -+ lv = CCK_PD_LV_1; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 1\n"); -+ } else if (cckpd_t->cck_fa_ma < 500) { -+ lv = CCK_PD_LV_0; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 2\n"); -+ } else { -+ is_update = false; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 3\n"); -+ } -+ } -+ -+ if (is_update) { -+ phydm_set_cck_pd_lv_type4(dm, lv); -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "setting CS_th = 0x%x, PD th = 0x%x\n", -+ cckpd_t->cckpd_jgr3[cckpd_t->cck_bw] -+ [cckpd_t->cck_n_rx - 1][1][lv], -+ cckpd_t->cckpd_jgr3[cckpd_t->cck_bw] -+ [cckpd_t->cck_n_rx - 1][0][lv]); -+ } -+ phydm_read_cckpd_para_type4(dm); -+} -+ -+void phydm_cck_pd_init_type4(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u32 reg0 = 0; -+ u32 reg1 = 0; -+ u32 reg2 = 0; -+ u32 reg3 = 0; -+ u8 pw_step = 0; -+ u8 cs_step = 0; -+ u8 cck_bw = 0; /*r_RX_RF_BW*/ -+ u8 cck_n_rx = 0; -+ u8 val = 0; -+ u8 i = 0; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "[%s]======>\n", __func__); -+ -+ #if 0 -+ /*@ -+ *cckpd_t[0][0][0][0] = 1ac8[7:0] r_PD_lim_RFBW20_1R -+ *cckpd_t[0][1][0][0] = 1ac8[15:8] r_PD_lim_RFBW20_2R -+ *cckpd_t[0][2][0][0] = 1ac8[23:16] r_PD_lim_RFBW20_3R -+ *cckpd_t[0][3][0][0] = 1ac8[31:24] r_PD_lim_RFBW20_4R -+ *cckpd_t[1][0][0][0] = 1acc[7:0] r_PD_lim_RFBW40_1R -+ *cckpd_t[1][1][0][0] = 1acc[15:8] r_PD_lim_RFBW40_2R -+ *cckpd_t[1][2][0][0] = 1acc[23:16] r_PD_lim_RFBW40_3R -+ *cckpd_t[1][3][0][0] = 1acc[31:24] r_PD_lim_RFBW40_4R -+ * -+ * -+ *cckpd_t[0][0][1][0] = 1ad0[4:0] r_CS_ratio_RFBW20_1R[4:0] -+ *cckpd_t[0][1][1][0] = 1ad0[9:5] r_CS_ratio_RFBW20_2R[4:0] -+ *cckpd_t[0][2][1][0] = 1ad0[14:10] r_CS_ratio_RFBW20_3R[4:0] -+ *cckpd_t[0][3][1][0] = 1ad0[19:15] r_CS_ratio_RFBW20_4R[4:0] -+ *cckpd_t[1][0][1][0] = 1ad0[24:20] r_CS_ratio_RFBW40_1R[4:0] -+ *cckpd_t[1][1][1][0] = 1ad0[29:25] r_CS_ratio_RFBW40_2R[4:0] -+ *cckpd_t[1][2][1][0] = 1ad0[31:30] r_CS_ratio_RFBW40_3R[1:0] -+ * 1ad4[2:0] r_CS_ratio_RFBW40_3R[4:2] -+ *cckpd_t[1][3][1][0] = 1ad4[7:3] r_CS_ratio_RFBW40_4R[4:0] -+ */ -+ #endif -+ /*[Check Nrx]*/ -+ cck_n_rx = (u8)odm_get_bb_reg(dm, R_0x1a2c, 0x60000) + 1; -+ -+ /*[Check BW]*/ -+ val = (u8)odm_get_bb_reg(dm, R_0x9b0, 0xc); -+ if (val == 0) -+ cck_bw = CHANNEL_WIDTH_20; -+ else if (val == 1) -+ cck_bw = CHANNEL_WIDTH_40; -+ else -+ cck_bw = CHANNEL_WIDTH_80; -+ -+ cckpd_t->cck_bw = cck_bw; -+ cckpd_t->cck_n_rx = cck_n_rx; -+ reg0 = odm_get_bb_reg(dm, R_0x1ac8, MASKDWORD); -+ reg1 = odm_get_bb_reg(dm, R_0x1acc, MASKDWORD); -+ reg2 = odm_get_bb_reg(dm, R_0x1ad0, MASKDWORD); -+ reg3 = odm_get_bb_reg(dm, R_0x1ad4, MASKDWORD); -+ -+ for (i = 0 ; i < CCK_PD_LV_MAX ; i++) { -+ pw_step = i * 2; -+ cs_step = i * 2; -+ -+ #if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197G) { -+ pw_step = i; -+ cs_step = i; -+ if (i > CCK_PD_LV_3) { -+ pw_step = 3; -+ cs_step = 3; -+ } -+ } -+ #endif -+ -+ #if (RTL8822C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ if (i == CCK_PD_LV_1) { -+ pw_step = 9; /*IGI-19.2:0x11=d'17*/ -+ cs_step = 0; -+ } else if (i == CCK_PD_LV_2) { -+ pw_step = 12; /*IGI-15.5:0x14=d'20*/ -+ cs_step = 1; -+ } else if (i == CCK_PD_LV_3) { -+ pw_step = 14; /*IGI-14:0x16=d'22*/ -+ cs_step = 1; -+ } else if (i == CCK_PD_LV_4) { -+ pw_step = 17; /*IGI-12:0x19=d'25*/ -+ cs_step = 1; -+ } -+ } -+ #endif -+ -+ val = (u8)(reg0 & 0x000000ff) + pw_step; -+ PHYDM_DBG(dm, DBG_CCKPD, "lvl %d val = %x\n\n", i, val); -+ cckpd_t->cckpd_jgr3[0][0][0][i] = val; -+ -+ val = (u8)(reg1 & 0x000000ff) + pw_step; -+ cckpd_t->cckpd_jgr3[1][0][0][i] = val; -+ -+ val = (u8)(reg2 & 0x0000001f) + cs_step; -+ cckpd_t->cckpd_jgr3[0][0][1][i] = val; -+ -+ val = (u8)((reg2 & 0x01f00000) >> 20) + cs_step; -+ cckpd_t->cckpd_jgr3[1][0][1][i] = val; -+ -+ #ifdef PHYDM_COMPILE_ABOVE_2SS -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) { -+ val = (u8)((reg0 & 0x0000ff00) >> 8) + pw_step; -+ cckpd_t->cckpd_jgr3[0][1][0][i] = val; -+ -+ val = (u8)((reg1 & 0x0000ff00) >> 8) + pw_step; -+ cckpd_t->cckpd_jgr3[1][1][0][i] = val; -+ -+ val = (u8)((reg2 & 0x000003e0) >> 5) + cs_step; -+ cckpd_t->cckpd_jgr3[0][1][1][i] = val; -+ -+ val = (u8)((reg2 & 0x3e000000) >> 25) + cs_step; -+ cckpd_t->cckpd_jgr3[1][1][1][i] = val; -+ } -+ #endif -+ -+ #ifdef PHYDM_COMPILE_ABOVE_3SS -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_3SS) { -+ val = (u8)((reg0 & 0x00ff0000) >> 16) + pw_step; -+ cckpd_t->cckpd_jgr3[0][2][0][i] = val; -+ -+ val = (u8)((reg1 & 0x00ff0000) >> 16) + pw_step; -+ cckpd_t->cckpd_jgr3[1][2][0][i] = val; -+ val = (u8)((reg2 & 0x00007c00) >> 10) + cs_step; -+ cckpd_t->cckpd_jgr3[0][2][1][i] = val; -+ val = (u8)(((reg2 & 0xc0000000) >> 30) | -+ ((reg3 & 0x7) << 3)) + cs_step; -+ cckpd_t->cckpd_jgr3[1][2][1][i] = val; -+ } -+ #endif -+ -+ #ifdef PHYDM_COMPILE_ABOVE_4SS -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { -+ val = (u8)((reg0 & 0xff000000) >> 24) + pw_step; -+ cckpd_t->cckpd_jgr3[0][3][0][i] = val; -+ -+ val = (u8)((reg1 & 0xff000000) >> 24) + pw_step; -+ cckpd_t->cckpd_jgr3[1][3][0][i] = val; -+ -+ val = (u8)((reg2 & 0x000f8000) >> 15) + cs_step; -+ cckpd_t->cckpd_jgr3[0][3][1][i] = val; -+ -+ val = (u8)((reg3 & 0x000000f8) >> 3) + cs_step; -+ cckpd_t->cckpd_jgr3[1][3][1][i] = val; -+ } -+ #endif -+ } -+} -+ -+void phydm_invalid_cckpd_type4(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u8 val = 0; -+ u8 i = 0; -+ u8 j = 0; -+ u8 k = 0; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "[%s]======>\n", __func__); -+ -+ for (i = 0; i < CCK_PD_LV_MAX; i++) { -+ for (j = 0; j < 2; j++) { -+ for (k = 0; k < dm->num_rf_path; k++) { -+ val = cckpd_t->cckpd_jgr3[j][k][1][i]; -+ if (val == INVALID_CS_RATIO_0) -+ cckpd_t->cckpd_jgr3[j][k][1][i] = 0x1c; -+ else if (val == INVALID_CS_RATIO_1) -+ cckpd_t->cckpd_jgr3[j][k][1][i] = 0x1e; -+ else if (val > MAXVALID_CS_RATIO) -+ cckpd_t->cckpd_jgr3[j][k][1][i] = -+ MAXVALID_CS_RATIO; -+ } -+ } -+ -+ #if (RTL8198F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8198F) { -+ val = cckpd_t->cckpd_jgr3[0][3][1][i]; -+ if (i == CCK_PD_LV_1 && val > 0x10) -+ cckpd_t->cckpd_jgr3[0][3][1][i] = 0x10; -+ else if (i == CCK_PD_LV_2 && val > 0x10) -+ cckpd_t->cckpd_jgr3[0][3][1][i] = 0x10; -+ else if (i == CCK_PD_LV_3 && val > 0x10) -+ cckpd_t->cckpd_jgr3[0][3][1][i] = 0x10; -+ else if (i == CCK_PD_LV_4 && val > 0x10) -+ cckpd_t->cckpd_jgr3[0][3][1][i] = 0x10; -+ val = cckpd_t->cckpd_jgr3[1][3][1][i]; -+ if (i == CCK_PD_LV_1 && val > 0xF) -+ cckpd_t->cckpd_jgr3[1][3][1][i] = 0xF; -+ else if (i == CCK_PD_LV_2 && val > 0xF) -+ cckpd_t->cckpd_jgr3[1][3][1][i] = 0xF; -+ else if (i == CCK_PD_LV_3 && val > 0xF) -+ cckpd_t->cckpd_jgr3[1][3][1][i] = 0xF; -+ else if (i == CCK_PD_LV_4 && val > 0xF) -+ cckpd_t->cckpd_jgr3[1][3][1][i] = 0xF; -+ } -+ #endif -+ } -+} -+ -+#endif /*#ifdef PHYDM_COMPILE_CCKPD_TYPE4*/ -+ -+ -+#ifdef PHYDM_COMPILE_CCKPD_TYPE5 -+void phydm_write_cck_pd_type5(void *dm_void, enum cckpd_lv lv, -+ enum cckpd_mode mode) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u32 val = 0; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "write CCK CCA parameters(CS_ratio & PD)\n"); -+ switch (mode) { -+ case CCK_BW20_1R: /*RFBW20_1R*/ -+ { -+ val = cckpd_t->cck_pd_table_jgr3[0][0][0][lv]; -+ odm_set_bb_reg(dm, R_0x1a30, 0x1f, val); -+ val = cckpd_t->cck_pd_table_jgr3[0][0][1][lv]; -+ odm_set_bb_reg(dm, R_0x1a20, 0x1f, val); -+ } break; -+ case CCK_BW40_1R: /*RFBW40_1R*/ -+ { -+ val = cckpd_t->cck_pd_table_jgr3[1][0][0][lv]; -+ odm_set_bb_reg(dm, R_0x1a34, 0x1f, val); -+ val = cckpd_t->cck_pd_table_jgr3[1][0][1][lv]; -+ odm_set_bb_reg(dm, R_0x1a24, 0x1f, val); -+ } break; -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case CCK_BW20_2R: /*RFBW20_2R*/ -+ { -+ val = cckpd_t->cck_pd_table_jgr3[0][1][0][lv]; -+ odm_set_bb_reg(dm, R_0x1a30, 0x3e0, val); -+ val = cckpd_t->cck_pd_table_jgr3[0][1][1][lv]; -+ odm_set_bb_reg(dm, R_0x1a20, 0x3e0, val); -+ } break; -+ case CCK_BW40_2R: /*RFBW40_2R*/ -+ { -+ val = cckpd_t->cck_pd_table_jgr3[1][1][0][lv]; -+ odm_set_bb_reg(dm, R_0x1a34, 0x3e0, val); -+ val = cckpd_t->cck_pd_table_jgr3[1][1][1][lv]; -+ odm_set_bb_reg(dm, R_0x1a24, 0x3e0, val); -+ } break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case CCK_BW20_3R: /*RFBW20_3R*/ -+ { -+ val = cckpd_t->cck_pd_table_jgr3[0][2][0][lv]; -+ odm_set_bb_reg(dm, R_0x1a30, 0x7c00, val); -+ val = cckpd_t->cck_pd_table_jgr3[0][2][1][lv]; -+ odm_set_bb_reg(dm, R_0x1a20, 0x7c00, val); -+ } break; -+ case CCK_BW40_3R: /*RFBW40_3R*/ -+ { -+ val = cckpd_t->cck_pd_table_jgr3[1][2][0][lv]; -+ odm_set_bb_reg(dm, R_0x1a34, 0x7c00, val); -+ val = cckpd_t->cck_pd_table_jgr3[1][2][1][lv]; -+ odm_set_bb_reg(dm, R_0x1a24, 0x7c00, val); -+ } break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case CCK_BW20_4R: /*RFBW20_4R*/ -+ { -+ val = cckpd_t->cck_pd_table_jgr3[0][3][0][lv]; -+ odm_set_bb_reg(dm, R_0x1a30, 0xF8000, val); -+ val = cckpd_t->cck_pd_table_jgr3[0][3][1][lv]; -+ odm_set_bb_reg(dm, R_0x1a20, 0xF8000, val); -+ } break; -+ case CCK_BW40_4R: /*RFBW40_4R*/ -+ { -+ val = cckpd_t->cck_pd_table_jgr3[1][3][0][lv]; -+ odm_set_bb_reg(dm, R_0x1a34, 0xF8000, val); -+ val = cckpd_t->cck_pd_table_jgr3[1][3][1][lv]; -+ odm_set_bb_reg(dm, R_0x1a24, 0xF8000, val); -+ } break; -+ #endif -+ default: -+ /*@pr_debug("[%s] warning!\n", __func__);*/ -+ break; -+ } -+} -+ -+ -+void phydm_set_cck_pd_lv_type5(void *dm_void, enum cckpd_lv lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ enum cckpd_mode cck_mode = CCK_BW20_1R; -+ enum channel_width cck_bw = CHANNEL_WIDTH_20; -+ u8 cck_n_rx = 0; -+ u32 val = 0; -+ /*u32 val_dbg = 0;*/ -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_CCKPD, "lv: (%d) -> (%d)\n", cckpd_t->cck_pd_lv, lv); -+ -+ /*[Check Nrx] for 8723F*/ -+ cck_n_rx = 1; -+ -+ /*[Check BW]*/ -+ val = odm_get_bb_reg(dm, R_0x9b0, 0xc); -+ if (val == 0) -+ cck_bw = CHANNEL_WIDTH_20; -+ else if (val == 1) -+ cck_bw = CHANNEL_WIDTH_40; -+ else -+ cck_bw = CHANNEL_WIDTH_80; -+ -+ /*[Check LV]*/ -+ if (cckpd_t->cck_pd_lv == lv && -+ cckpd_t->cck_n_rx == cck_n_rx && -+ cckpd_t->cck_bw == cck_bw) { -+ PHYDM_DBG(dm, DBG_CCKPD, "stay in lv=%d\n", lv); -+ return; -+ } -+ cckpd_t->cck_bw = cck_bw; -+ cckpd_t->cck_n_rx = cck_n_rx; -+ cckpd_t->cck_pd_lv = lv; -+ cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; -+ -+ switch (cck_n_rx) { -+ case 1: /*1R*/ -+ { -+ if (cck_bw == CHANNEL_WIDTH_20) -+ cck_mode = CCK_BW20_1R; -+ else if (cck_bw == CHANNEL_WIDTH_40) -+ cck_mode = CCK_BW40_1R; -+ } break; -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case 2: /*2R*/ -+ { -+ if (cck_bw == CHANNEL_WIDTH_20) -+ cck_mode = CCK_BW20_2R; -+ else if (cck_bw == CHANNEL_WIDTH_40) -+ cck_mode = CCK_BW40_2R; -+ } break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case 3: /*3R*/ -+ { -+ if (cck_bw == CHANNEL_WIDTH_20) -+ cck_mode = CCK_BW20_3R; -+ else if (cck_bw == CHANNEL_WIDTH_40) -+ cck_mode = CCK_BW40_3R; -+ } break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case 4: /*4R*/ -+ { -+ if (cck_bw == CHANNEL_WIDTH_20) -+ cck_mode = CCK_BW20_4R; -+ else if (cck_bw == CHANNEL_WIDTH_40) -+ cck_mode = CCK_BW40_4R; -+ } break; -+ #endif -+ default: -+ /*@pr_debug("[%s] warning!\n", __func__);*/ -+ break; -+ } -+ -+ -+ -+phydm_write_cck_pd_type5(dm, lv, cck_mode); -+} -+ -+void phydm_read_cckpd_para_type5(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u8 bw = 0; /*r_RX_RF_BW*/ -+ u8 n_rx = 0; -+ u8 curr_cck_pd_t[2][4][2]; -+ u32 reg0 = 0; -+ u32 reg1 = 0; -+ u32 reg2 = 0; -+ u32 reg3 = 0; -+ -+ bw = (u8)odm_get_bb_reg(dm, R_0x9b0, 0xc); -+ -+ reg0 = odm_get_bb_reg(dm, R_0x1a30, MASKDWORD); -+ reg1 = odm_get_bb_reg(dm, R_0x1a34, MASKDWORD); -+ reg2 = odm_get_bb_reg(dm, R_0x1a20, MASKDWORD); -+ reg3 = odm_get_bb_reg(dm, R_0x1a24, MASKDWORD); -+ curr_cck_pd_t[0][0][0] = (u8)(reg0 & 0x0000001f); -+ curr_cck_pd_t[1][0][0] = (u8)(reg1 & 0x0000001f); -+ curr_cck_pd_t[0][0][1] = (u8)(reg2 & 0x0000001f); -+ curr_cck_pd_t[1][0][1] = (u8)(reg3 & 0x0000001f); -+ n_rx = 1; -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) { -+ curr_cck_pd_t[0][1][0] = (u8)((reg0 & 0x000003E0) >> 5); -+ curr_cck_pd_t[1][1][0] = (u8)((reg1 & 0x000003E0) >> 5); -+ curr_cck_pd_t[0][1][1] = (u8)((reg2 & 0x000003E0) >> 5); -+ curr_cck_pd_t[1][1][1] = (u8)((reg3 & 0x000003E0) >> 5); -+ n_rx = 2; -+ } -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_3SS) { -+ curr_cck_pd_t[0][2][0] = (u8)((reg0 & 0x00007C00) >> 10); -+ curr_cck_pd_t[1][2][0] = (u8)((reg1 & 0x00007C00) >> 10); -+ curr_cck_pd_t[0][2][1] = (u8)((reg2 & 0x00007C00) >> 10); -+ curr_cck_pd_t[1][2][1] = (u8)((reg3 & 0x00007C00) >> 10); -+ n_rx = 3; -+ } -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { -+ curr_cck_pd_t[0][3][0] = (u8)((reg0 & 0x000F8000) >> 15); -+ curr_cck_pd_t[1][3][0] = (u8)((reg1 & 0x000F8000) >> 15); -+ curr_cck_pd_t[0][3][1] = (u8)((reg2 & 0x000F8000) >> 15); -+ curr_cck_pd_t[1][3][1] = (u8)((reg3 & 0x000F8000) >> 15); -+ n_rx = 4; -+ } -+ #endif -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "bw=%dM, Nrx=%d\n", 20 << bw, n_rx); -+ PHYDM_DBG(dm, DBG_CCKPD, "lv=%d, readback CS_th=0x%x, PD th=0x%x\n", -+ cckpd_t->cck_pd_lv, -+ curr_cck_pd_t[bw][n_rx - 1][1], -+ curr_cck_pd_t[bw][n_rx - 1][0]); -+} -+ -+void phydm_cckpd_type5(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u8 igi = dm->dm_dig_table.cur_ig_value; -+ enum cckpd_lv lv = 0; -+ boolean is_update = true; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ -+ if (dm->is_linked) { -+ PHYDM_DBG(dm, DBG_CCKPD, "Linked!!!\n"); -+ if (dm->rssi_min > 40) { -+ lv = CCK_PD_LV_4; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 1\n"); -+ } else if (dm->rssi_min > 32) { -+ lv = CCK_PD_LV_3; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 2\n"); -+ } else if (dm->rssi_min > 24) { -+ lv = CCK_PD_LV_2; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 3\n"); -+ } else { -+ if (cckpd_t->cck_fa_ma > 1000) { -+ lv = CCK_PD_LV_1; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 4-1\n"); -+ } else if (cckpd_t->cck_fa_ma < 500) { -+ lv = CCK_PD_LV_0; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 4-2\n"); -+ } else { -+ is_update = false; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 4-3\n"); -+ } -+ } -+ } else { -+ PHYDM_DBG(dm, DBG_CCKPD, "UnLinked!!!\n"); -+ if (cckpd_t->cck_fa_ma > 1000) { -+ lv = CCK_PD_LV_1; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 1\n"); -+ } else if (cckpd_t->cck_fa_ma < 500) { -+ lv = CCK_PD_LV_0; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 2\n"); -+ } else { -+ is_update = false; -+ PHYDM_DBG(dm, DBG_CCKPD, "Order 3\n"); -+ } -+ } -+ -+ if (is_update) { -+ phydm_set_cck_pd_lv_type5(dm, lv); -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "setting CS_th = 0x%x, PD th = 0x%x\n", -+ cckpd_t->cck_pd_table_jgr3[cckpd_t->cck_bw] -+ [cckpd_t->cck_n_rx - 1][1][lv], -+ cckpd_t->cck_pd_table_jgr3[cckpd_t->cck_bw] -+ [cckpd_t->cck_n_rx - 1][0][lv]); -+ } -+ -+ phydm_read_cckpd_para_type5(dm); -+} -+ -+void phydm_cck_pd_init_type5(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u32 reg0 = 0; -+ u32 reg1 = 0; -+ u32 reg2 = 0; -+ u32 reg3 = 0; -+ u8 pw_step = 0; -+ u8 cs_step = 0; -+ u8 cck_bw = 0; /*r_RX_RF_BW*/ -+ u8 cck_n_rx = 0; -+ u8 val = 0; -+ u8 i = 0; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "[%s]======>\n", __func__); -+ #if 0 -+ /*@ -+ *cckpd_t[0][0][0][0] = 1a30[4:0] r_PD_lim_RFBW20_1R -+ *cckpd_t[0][1][0][0] = 1a30[9:5] r_PD_lim_RFBW20_2R -+ *cckpd_t[0][2][0][0] = 1a30[14:10] r_PD_lim_RFBW20_3R -+ *cckpd_t[0][3][0][0] = 1a30[19:15] r_PD_lim_RFBW20_4R -+ *cckpd_t[1][0][0][0] = 1a34[4:0] r_PD_lim_RFBW40_1R -+ *cckpd_t[1][1][0][0] = 1a34[9:5] r_PD_lim_RFBW40_2R -+ *cckpd_t[1][2][0][0] = 1a34[14:10] r_PD_lim_RFBW40_3R -+ *cckpd_t[1][3][0][0] = 1a34[19:15] r_PD_lim_RFBW40_4R -+ * -+ * -+ *cckpd_t[0][0][1][0] = 1a20[4:0] r_CS_ratio_RFBW20_1R -+ *cckpd_t[0][1][1][0] = 1a20[9:5] r_CS_ratio_RFBW20_2R -+ *cckpd_t[0][2][1][0] = 1a20[14:10] r_CS_ratio_RFBW20_3R -+ *cckpd_t[0][3][1][0] = 1a20[19:15] r_CS_ratio_RFBW20_4R -+ *cckpd_t[1][0][1][0] = 1a24[4:0] r_CS_ratio_RFBW40_1R -+ *cckpd_t[1][1][1][0] = 1a24[9:5] r_CS_ratio_RFBW40_2R -+ *cckpd_t[1][2][1][0] = 1a24[14:10] r_CS_ratio_RFBW40_3R -+ *cckpd_t[1][3][1][0] = 1a24[19:15] r_CS_ratio_RFBW40_4R -+ */ -+ #endif -+ /*[Check Nrx]*/ -+ cck_n_rx = 1; -+ -+ /*[Check BW]*/ -+ val = (u8)odm_get_bb_reg(dm, R_0x9b0, 0xc); -+ if (val == 0) -+ cck_bw = CHANNEL_WIDTH_20; -+ else if (val == 1) -+ cck_bw = CHANNEL_WIDTH_40; -+ else -+ cck_bw = CHANNEL_WIDTH_80; -+ -+ cckpd_t->cck_bw = cck_bw; -+ reg0 = odm_get_bb_reg(dm, R_0x1a30, MASKDWORD); -+ reg1 = odm_get_bb_reg(dm, R_0x1a34, MASKDWORD); -+ reg2 = odm_get_bb_reg(dm, R_0x1a20, MASKDWORD); -+ reg3 = odm_get_bb_reg(dm, R_0x1a24, MASKDWORD); -+ -+ for (i = 0 ; i < CCK_PD_LV_MAX ; i++) { -+ pw_step = i * 2; -+ cs_step = i * 2; -+ -+ #if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ if (i == CCK_PD_LV_1) { -+ pw_step = 9; /*IGI-19.2:0x11=d'17*/ -+ cs_step = 0; -+ } else if (i == CCK_PD_LV_2) { -+ pw_step = 12; /*IGI-15.5:0x14=d'20*/ -+ cs_step = 1; -+ } else if (i == CCK_PD_LV_3) { -+ pw_step = 14; /*IGI-14:0x16=d'22*/ -+ cs_step = 1; -+ } else if (i == CCK_PD_LV_4) { -+ pw_step = 17; /*IGI-12:0x19=d'25*/ -+ cs_step = 1; -+ } -+ } -+ #endif -+ val = (u8)(reg0 & 0x0000001F) + pw_step; -+ PHYDM_DBG(dm, DBG_CCKPD, "lvl %d val = %x\n\n", i, val); -+ cckpd_t->cck_pd_table_jgr3[0][0][0][i] = val; -+ -+ val = (u8)(reg1 & 0x0000001F) + pw_step; -+ cckpd_t->cck_pd_table_jgr3[1][0][0][i] = val; -+ -+ val = (u8)(reg2 & 0x0000001F) + cs_step; -+ cckpd_t->cck_pd_table_jgr3[0][0][1][i] = val; -+ -+ val = (u8)(reg3 & 0x0000001F) + cs_step; -+ cckpd_t->cck_pd_table_jgr3[1][0][1][i] = val; -+ -+ #ifdef PHYDM_COMPILE_ABOVE_2SS -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) { -+ val = (u8)((reg0 & 0x000003E0) >> 5) + pw_step; -+ cckpd_t->cck_pd_table_jgr3[0][1][0][i] = val; -+ -+ val = (u8)((reg1 & 0x000003E0) >> 5) + pw_step; -+ cckpd_t->cck_pd_table_jgr3[1][1][0][i] = val; -+ -+ val = (u8)((reg2 & 0x000003E0) >> 5) + cs_step; -+ cckpd_t->cck_pd_table_jgr3[0][1][1][i] = val; -+ -+ val = (u8)((reg3 & 0x000003E0) >> 5) + cs_step; -+ cckpd_t->cck_pd_table_jgr3[1][1][1][i] = val; -+ -+ cck_n_rx = 2; -+ } -+ #endif -+ #ifdef PHYDM_COMPILE_ABOVE_3SS -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_3SS) { -+ val = (u8)((reg0 & 0x00007C00) >> 10) + pw_step; -+ cckpd_t->cck_pd_table_jgr3[0][2][0][i] = val; -+ -+ val = (u8)((reg1 & 0x00007C00) >> 10) + pw_step; -+ cckpd_t->cck_pd_table_jgr3[1][2][0][i] = val; -+ -+ val = (u8)((reg2 & 0x00007C00) >> 10) + cs_step; -+ cckpd_t->cck_pd_table_jgr3[0][2][1][i] = val; -+ -+ val = (u8)((reg3 & 0x00007C00) >> 10) + cs_step; -+ cckpd_t->cck_pd_table_jgr3[1][2][1][i] = val; -+ -+ cck_n_rx = 3; -+ } -+ #endif -+ -+ #ifdef PHYDM_COMPILE_ABOVE_4SS -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { -+ val = (u8)((reg0 & 0x000F8000) >> 15) + pw_step; -+ cckpd_t->cck_pd_table_jgr3[0][3][0][i] = val; -+ -+ val = (u8)((reg1 & 0x000F8000) >> 15) + pw_step; -+ cckpd_t->cck_pd_table_jgr3[1][3][0][i] = val; -+ -+ val = (u8)((reg2 & 0x000F8000) >> 15) + cs_step; -+ cckpd_t->cck_pd_table_jgr3[0][3][1][i] = val; -+ -+ val = (u8)((reg3 & 0x000F8000) >> 15) + cs_step; -+ cckpd_t->cck_pd_table_jgr3[1][3][1][i] = val; -+ -+ cck_n_rx = 4; -+ } -+ #endif -+ } -+ cckpd_t->cck_n_rx = cck_n_rx; -+} -+ -+ -+ -+ -+#endif /*#ifdef PHYDM_COMPILE_CCKPD_TYPE5*/ -+ -+ -+ -+ -+void phydm_set_cckpd_val(void *dm_void, u32 *val_buf, u8 val_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ enum cckpd_lv lv; -+ -+ if (val_len != 1) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[Error][CCKPD]Need val_len=1\n"); -+ return; -+ } -+ -+ lv = (enum cckpd_lv)val_buf[0]; -+ -+ if (lv > CCK_PD_LV_4) { -+ pr_debug("[%s] warning! lv=%d\n", __func__, lv); -+ return; -+ } -+ -+ switch (cckpd_t->cckpd_hw_type) { -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE1 -+ case 1: -+ phydm_set_cckpd_lv_type1(dm, lv); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE2 -+ case 2: -+ phydm_set_cckpd_lv_type2(dm, lv); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE3 -+ case 3: -+ phydm_set_cckpd_lv_type3(dm, lv); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE4 -+ case 4: -+ phydm_set_cck_pd_lv_type4(dm, lv); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE5 -+ case 5: -+ phydm_set_cck_pd_lv_type5(dm, lv); -+ break; -+ #endif -+ default: -+ pr_debug("[%s]warning\n", __func__); -+ break; -+ } -+} -+ -+boolean -+phydm_stop_cck_pd_th(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ability & ODM_BB_FA_CNT)) { -+ PHYDM_DBG(dm, DBG_CCKPD, "Not Support:ODM_BB_FA_CNT disable\n"); -+ return true; -+ } -+ -+ if (!(dm->support_ability & ODM_BB_CCK_PD)) { -+ PHYDM_DBG(dm, DBG_CCKPD, "Not Support:ODM_BB_CCK_PD disable\n"); -+ return true; -+ } -+ -+ if (dm->pause_ability & ODM_BB_CCK_PD) { -+ PHYDM_DBG(dm, DBG_CCKPD, "Return: Pause CCKPD in LV=%d\n", -+ dm->pause_lv_table.lv_cckpd); -+ return true; -+ } -+ -+ if (dm->is_linked && (*dm->channel > 36)) { -+ PHYDM_DBG(dm, DBG_CCKPD, "Return: 5G CH=%d\n", *dm->channel); -+ return true; -+ } -+ return false; -+} -+ -+void phydm_cck_pd_th(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ u32 cck_fa = fa_t->cnt_cck_fail; -+ #ifdef PHYDM_TDMA_DIG_SUPPORT -+ struct phydm_fa_acc_struct *fa_acc_t = &dm->false_alm_cnt_acc; -+ #endif -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "[%s] ======>\n", __func__); -+ -+ if (phydm_stop_cck_pd_th(dm)) -+ return; -+ -+ #ifdef PHYDM_TDMA_DIG_SUPPORT -+ if (dm->original_dig_restore) -+ cck_fa = fa_t->cnt_cck_fail; -+ else -+ cck_fa = fa_acc_t->cnt_cck_fail_1sec; -+ #endif -+ -+ if (cckpd_t->cck_fa_ma == CCK_FA_MA_RESET) -+ cckpd_t->cck_fa_ma = cck_fa; -+ else -+ cckpd_t->cck_fa_ma = (cckpd_t->cck_fa_ma * 3 + cck_fa) >> 2; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, -+ "IGI=0x%x, rssi_min=%d, cck_fa=%d, cck_fa_ma=%d\n", -+ dm->dm_dig_table.cur_ig_value, dm->rssi_min, -+ cck_fa, cckpd_t->cck_fa_ma); -+ -+ switch (cckpd_t->cckpd_hw_type) { -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE1 -+ case 1: -+ phydm_cckpd_type1(dm); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE2 -+ case 2: -+ phydm_cckpd_type2(dm); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE3 -+ case 3: -+ phydm_cckpd_type3(dm); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE4 -+ case 4: -+ #ifdef PHYDM_DCC_ENHANCE -+ if (dm->dm_dcc_info.dcc_en) -+ phydm_cckpd_type4_dcc(dm); -+ else -+ #endif -+ phydm_cckpd_type4(dm); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE5 -+ case 5: -+ phydm_cckpd_type5(dm); -+ break; -+ #endif -+ default: -+ pr_debug("[%s]warning\n", __func__); -+ break; -+ } -+} -+ -+void phydm_cck_pd_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ -+ if (*dm->mp_mode) -+ return; -+ -+ if (dm->support_ic_type & CCK_PD_IC_TYPE1) -+ cckpd_t->cckpd_hw_type = 1; -+ else if (dm->support_ic_type & CCK_PD_IC_TYPE2) -+ cckpd_t->cckpd_hw_type = 2; -+ else if (dm->support_ic_type & CCK_PD_IC_TYPE3) -+ cckpd_t->cckpd_hw_type = 3; -+ else if (dm->support_ic_type & CCK_PD_IC_TYPE4) -+ cckpd_t->cckpd_hw_type = 4; -+ -+ if (dm->support_ic_type & CCK_PD_IC_TYPE5) -+ cckpd_t->cckpd_hw_type = 5; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "[%s] cckpd_hw_type=%d\n", -+ __func__, cckpd_t->cckpd_hw_type); -+ -+ cckpd_t->cck_pd_lv = CCK_PD_LV_INIT; -+ cckpd_t->cck_n_rx = 0xff; -+ cckpd_t->cck_bw = CHANNEL_WIDTH_MAX; -+ cckpd_t->cck_fa_th[1] = 400; -+ cckpd_t->cck_fa_th[0] = 200; -+ -+ switch (cckpd_t->cckpd_hw_type) { -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE1 -+ case 1: -+ phydm_set_cckpd_lv_type1(dm, CCK_PD_LV_1); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE2 -+ case 2: -+ cckpd_t->aaa_default = odm_read_1byte(dm, 0xaaa) & 0x1f; -+ phydm_set_cckpd_lv_type2(dm, CCK_PD_LV_1); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE3 -+ case 3: -+ phydm_cck_pd_init_type3(dm); -+ phydm_set_cckpd_lv_type3(dm, CCK_PD_LV_1); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE4 -+ case 4: -+ phydm_cck_pd_init_type4(dm); -+ phydm_invalid_cckpd_type4(dm); -+ phydm_set_cck_pd_lv_type4(dm, CCK_PD_LV_1); -+ break; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE5 -+ case 5: -+ phydm_cck_pd_init_type5(dm); -+ break; -+ #endif -+ default: -+ pr_debug("[%s]warning\n", __func__); -+ break; -+ } -+} -+ -+#ifdef PHYDM_DCC_ENHANCE -+ -+void phydm_cckpd_type4_dcc(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ enum cckpd_lv lv_curr = cckpd_t->cck_pd_lv; -+ enum phydm_cck_pd_trend trend = CCKPD_STABLE; -+ u8 th_ofst = 0; -+ u16 lv_up_th, lv_down_th; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); -+ -+ if (!dm->is_linked) -+ th_ofst = 1; -+ -+ lv_up_th = (cckpd_t->cck_fa_th[1]) << th_ofst; -+ lv_down_th = (cckpd_t->cck_fa_th[0]) << th_ofst; -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "th{Up, Down}: {%d, %d}\n", -+ lv_up_th, lv_down_th); -+ -+ if (cckpd_t->cck_fa_ma > lv_up_th) { -+ if (lv_curr <= CCK_PD_LV_3) { -+ lv_curr++; -+ trend = CCKPD_INCREASING; -+ } else { -+ lv_curr = CCK_PD_LV_4; -+ } -+ } else if (cckpd_t->cck_fa_ma < lv_down_th) { -+ if (lv_curr >= CCK_PD_LV_1) { -+ lv_curr--; -+ trend = CCKPD_DECREASING; -+ } else { -+ lv_curr = CCK_PD_LV_0; -+ } -+ } -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "lv: %d->%d\n", cckpd_t->cck_pd_lv, lv_curr); -+#if 1 -+ if (trend != CCKPD_STABLE) { -+ phydm_set_cck_pd_lv_type4(dm, lv_curr); -+ -+ PHYDM_DBG(dm, DBG_CCKPD, "setting CS_th = 0x%x, PD th = 0x%x\n", -+ cckpd_t->cckpd_jgr3[cckpd_t->cck_bw] -+ [cckpd_t->cck_n_rx - 1][1][lv_curr], -+ cckpd_t->cckpd_jgr3[cckpd_t->cck_bw] -+ [cckpd_t->cck_n_rx - 1][0][lv_curr]); -+ } -+ phydm_read_cckpd_para_type4(dm); -+#endif -+} -+ -+boolean phydm_do_cckpd(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ if (dig_t->igi_trend == DIG_INCREASING) -+ return false; -+ -+ return true; -+} -+ -+void phydm_dig_cckpd_coex(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dcc_struct *dcc = &dm->dm_dcc_info; -+ -+ if (*dm->channel > 36) { -+ phydm_dig(dm); -+ return; -+ } else if (!dcc->dcc_en) { -+ phydm_dig(dm); -+ phydm_cck_pd_th(dm); -+ return; -+ } -+ -+ dcc->dig_execute_cnt++; -+ PHYDM_DBG(dm, DBG_CCKPD, "DCC_cnt: %d\n", dcc->dig_execute_cnt); -+ -+ if (dcc->dig_execute_cnt % dcc->dcc_ratio) { -+ PHYDM_DBG(dm, DBG_CCKPD, "DCC: DIG\n"); -+ phydm_dig(dm); -+ } else { -+ if (phydm_do_cckpd(dm)) { -+ PHYDM_DBG(dm, DBG_CCKPD, "DCC: CCKPD\n"); -+ dcc->dcc_mode = DCC_CCK_PD; -+ phydm_cck_pd_th(dm); -+ } else { -+ PHYDM_DBG(dm, DBG_CCKPD, "DCC: Boost_DIG\n"); -+ dcc->dcc_mode = DCC_DIG; -+ phydm_dig(dm); -+ } -+ } -+} -+ -+void phydm_dig_cckpd_coex_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_dcc_struct *dcc = &dm->dm_dcc_info; -+ -+ dcc->dcc_mode = DCC_DIG; -+ dcc->dcc_en = false; -+ dcc->dig_execute_cnt = 0; -+ dcc->dcc_ratio = 2; -+} -+ -+void phydm_dig_cckpd_coex_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; -+ struct phydm_dcc_struct *dcc = &dm->dm_dcc_info; -+ char help[] = "-h"; -+ u32 var[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ -+ for (i = 0; i < 3; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var[i]); -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Enable: en {0/1}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DCC_ratio: ratio {x}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "threshold: th {Down_th} {Up_th}\n"); -+ } else if ((strcmp(input[1], "en") == 0)) { -+ dcc->dcc_en = (var[1]) ? true : false; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "en=%d\n", dcc->dcc_en); -+ } else if ((strcmp(input[1], "ratio") == 0)) { -+ dcc->dcc_ratio = (u8)var[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Ratio=%d\n", dcc->dcc_ratio); -+ } else if ((strcmp(input[1], "th") == 0)) { -+ cckpd_t->cck_fa_th[1] = (u16)var[2]; -+ cckpd_t->cck_fa_th[0] = (u16)var[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "th{Down, Up}: {%d, %d}\n", -+ cckpd_t->cck_fa_th[0], cckpd_t->cck_fa_th[1]); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif -+#endif /*#ifdef PHYDM_SUPPORT_CCKPD*/ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_pd.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_pd.h -new file mode 100644 -index 000000000..2a1d3eab5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_pd.h -@@ -0,0 +1,202 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_CCK_PD_H__ -+#define __PHYDM_CCK_PD_H__ -+ -+/* 2019.12.25 decrease CS_ratio in 8822C due to Lenovo test result(PCIE-5136).*/ -+#define CCK_PD_VERSION "4.0" -+ -+/*@ -+ * 1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+#define CCK_FA_MA_RESET 0xffffffff -+ -+#define INVALID_CS_RATIO_0 0x1b /* @ only for type4 ICs*/ -+#define INVALID_CS_RATIO_1 0x1d /* @ only for type4 ICs*/ -+#define MAXVALID_CS_RATIO 0x1f -+/*@Run time flag of CCK_PD HW type*/ -+#define CCK_PD_IC_TYPE1 (ODM_RTL8188E | ODM_RTL8812 | ODM_RTL8821 |\ -+ ODM_RTL8192E | ODM_RTL8723B | ODM_RTL8814A |\ -+ ODM_RTL8881A | ODM_RTL8822B | ODM_RTL8703B |\ -+ ODM_RTL8195A | ODM_RTL8188F) -+ -+#define CCK_PD_IC_TYPE2 (ODM_RTL8197F | ODM_RTL8821C | ODM_RTL8723D |\ -+ ODM_RTL8710B | ODM_RTL8195B) /*extend 0xaaa*/ -+ -+#define CCK_PD_IC_TYPE3 (ODM_RTL8192F | ODM_RTL8721D | ODM_RTL8710C) -+/*@extend for different bw & path*/ -+ -+#define CCK_PD_IC_TYPE4 ODM_IC_JGR3_SERIES /*@extend for different bw & path*/ -+#define CCK_PD_IC_TYPE5 (ODM_RTL8723F) /*@extend for different CR*/ -+ -+/*@Compile time flag of CCK_PD HW type*/ -+#if (RTL8188E_SUPPORT || RTL8812A_SUPPORT || RTL8821A_SUPPORT ||\ -+ RTL8192E_SUPPORT || RTL8723B_SUPPORT || RTL8814A_SUPPORT ||\ -+ RTL8881A_SUPPORT || RTL8822B_SUPPORT || RTL8703B_SUPPORT ||\ -+ RTL8195A_SUPPORT || RTL8188F_SUPPORT) -+ #define PHYDM_COMPILE_CCKPD_TYPE1 /*@only 0xa0a*/ -+#endif -+ -+#if (RTL8197F_SUPPORT || RTL8821C_SUPPORT || RTL8723D_SUPPORT ||\ -+ RTL8710B_SUPPORT || RTL8195B_SUPPORT) -+ #define PHYDM_COMPILE_CCKPD_TYPE2 /*@extend 0xaaa*/ -+#endif -+ -+#if (RTL8192F_SUPPORT || RTL8721D_SUPPORT || RTL8710C_SUPPORT) -+ #define PHYDM_COMPILE_CCKPD_TYPE3 /*@extend for different & path*/ -+#endif -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ #define PHYDM_COMPILE_CCKPD_TYPE4 /*@extend for different bw & path*/ -+#endif -+#if (RTL8723F_SUPPORT) -+ #define PHYDM_COMPILE_CCKPD_TYPE5 /*@extend for different & path*/ -+#endif -+ -+/*@ -+ * 1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ */ -+enum cckpd_lv { -+ CCK_PD_LV_INIT = 0xff, -+ CCK_PD_LV_0 = 0, -+ CCK_PD_LV_1 = 1, -+ CCK_PD_LV_2 = 2, -+ CCK_PD_LV_3 = 3, -+ CCK_PD_LV_4 = 4, -+ CCK_PD_LV_MAX = 5 -+}; -+ -+enum cckpd_mode { -+ CCK_BW20_1R = 0, -+ CCK_BW20_2R = 1, -+ CCK_BW20_3R = 2, -+ CCK_BW20_4R = 3, -+ CCK_BW40_1R = 4, -+ CCK_BW40_2R = 5, -+ CCK_BW40_3R = 6, -+ CCK_BW40_4R = 7 -+}; -+ -+enum dcc_mode { -+ DCC_DIG = 0, -+ DCC_CCK_PD = 1 -+}; -+ -+enum phydm_cck_pd_trend { -+ CCKPD_STABLE = 0, -+ CCKPD_INCREASING = 1, -+ CCKPD_DECREASING = 2 -+}; -+ -+/*@ -+ * 1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+ -+#ifdef PHYDM_SUPPORT_CCKPD -+ -+#ifdef PHYDM_DCC_ENHANCE -+struct phydm_dcc_struct { /*DIG CCK_PD coexistence*/ -+ boolean dcc_en; -+ enum dcc_mode dcc_mode; -+ u32 dig_execute_cnt; -+ u8 dcc_ratio; -+}; -+#endif -+ -+struct phydm_cckpd_struct { -+ u8 cckpd_hw_type; -+ u8 cur_cck_cca_thres; /*@current cck_pd value 0xa0a*/ -+ u32 cck_fa_ma; -+ u32 rvrt_val; /*all rvrt_val for pause API must set to u32*/ -+ u8 pause_lv; -+ u8 cck_n_rx; -+ u16 cck_fa_th[2]; -+ enum channel_width cck_bw; -+ enum cckpd_lv cck_pd_lv; -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE2 -+ u8 cck_cca_th_aaa; /*@current cs_ratio value 0xaaa*/ -+ u8 aaa_default; /*@Init cs_ratio value - 0xaaa*/ -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE3 -+ /*Default value*/ -+ u8 cck_pd_20m_1r; -+ u8 cck_pd_20m_2r; -+ u8 cck_pd_40m_1r; -+ u8 cck_pd_40m_2r; -+ u8 cck_cs_ratio_20m_1r; -+ u8 cck_cs_ratio_20m_2r; -+ u8 cck_cs_ratio_40m_1r; -+ u8 cck_cs_ratio_40m_2r; -+ u8 cck_din_shift_opt; -+ /*Current value*/ -+ u8 cur_cck_pd_20m_1r; -+ u8 cur_cck_pd_20m_2r; -+ u8 cur_cck_pd_40m_1r; -+ u8 cur_cck_pd_40m_2r; -+ u8 cur_cck_cs_ratio_20m_1r; -+ u8 cur_cck_cs_ratio_20m_2r; -+ u8 cur_cck_cs_ratio_40m_1r; -+ u8 cur_cck_cs_ratio_40m_2r; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE4 -+ /*@[bw][nrx][0:PD/1:CS][lv]*/ -+ u8 cckpd_jgr3[2][4][2][CCK_PD_LV_MAX]; -+ #endif -+ #ifdef PHYDM_COMPILE_CCKPD_TYPE5 -+ /*@[bw][nrx][0:PD/1:CS][lv]*/ -+ u8 cck_pd_table_jgr3[2][4][2][CCK_PD_LV_MAX]; -+ #endif -+}; -+#endif -+ -+/*@ -+ * 1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ */ -+void phydm_set_cckpd_val(void *dm_void, u32 *val_buf, u8 val_len); -+ -+void phydm_cck_pd_th(void *dm_void); -+ -+void phydm_cck_pd_init(void *dm_void); -+ -+#ifdef PHYDM_DCC_ENHANCE -+void phydm_cckpd_type4_dcc(void *dm_void); -+ -+void phydm_dig_cckpd_coex(void *dm_void); -+ -+void phydm_dig_cckpd_coex_init(void *dm_void); -+ -+void phydm_dig_cckpd_coex_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_rx_pathdiv.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_rx_pathdiv.c -new file mode 100644 -index 000000000..3106f1939 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_rx_pathdiv.c -@@ -0,0 +1,163 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef PHYDM_CCK_RX_PATHDIV_SUPPORT /* @PHYDM-342*/ -+void phydm_cck_rx_pathdiv_manaul(void *dm_void, boolean en_cck_rx_pathdiv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /* @Can not apply for 98F/14B/97G from DD YC*/ -+ if (en_cck_rx_pathdiv) { -+ odm_set_bb_reg(dm, R_0x1a14, BIT(7), 0x0); -+ odm_set_bb_reg(dm, R_0x1a74, BIT(8), 0x1); -+ } else { -+ odm_set_bb_reg(dm, R_0x1a14, BIT(7), 0x1); -+ odm_set_bb_reg(dm, R_0x1a74, BIT(8), 0x0); -+ } -+} -+ -+void phydm_cck_rx_pathdiv_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cck_rx_pathdiv *cckrx_t = &dm->dm_cck_rx_pathdiv_table; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ u8 rssi_th = 0; -+ u32 rssi_a = 0, rssi_b = 0, rssi_avg = 0; -+ -+ if (!cckrx_t->en_cck_rx_pathdiv) -+ return; -+ -+ rssi_a = PHYDM_DIV(cckrx_t->path_a_sum, cckrx_t->path_a_cnt); -+ rssi_b = PHYDM_DIV(cckrx_t->path_b_sum, cckrx_t->path_b_cnt); -+ rssi_avg = (rssi_a + rssi_b) >> 1; -+ -+ pr_debug("Rx-A:%d, Rx-B:%d, avg:%d\n", rssi_a, rssi_b, rssi_avg); -+ -+ cckrx_t->path_a_cnt = 0; -+ cckrx_t->path_a_sum = 0; -+ cckrx_t->path_b_cnt = 0; -+ cckrx_t->path_b_sum = 0; -+ -+ if (fa_t->cnt_all >= 100) -+ rssi_th = cckrx_t->rssi_fa_th; -+ else -+ rssi_th = cckrx_t->rssi_th; -+ -+ if (dm->phy_dbg_info.num_qry_beacon_pkt > 14 && rssi_avg <= rssi_th) -+ phydm_cck_rx_pathdiv_manaul(dm, true); -+ else -+ phydm_cck_rx_pathdiv_manaul(dm, false); -+} -+ -+void phydm_cck_rx_pathdiv_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cck_rx_pathdiv *cckrx_t = &dm->dm_cck_rx_pathdiv_table; -+ -+ cckrx_t->en_cck_rx_pathdiv = false; -+ cckrx_t->path_a_cnt = 0; -+ cckrx_t->path_a_sum = 0; -+ cckrx_t->path_b_cnt = 0; -+ cckrx_t->path_b_sum = 0; -+ cckrx_t->rssi_fa_th = 45; -+ cckrx_t->rssi_th = 25; -+} -+ -+void phydm_process_rssi_for_cck_rx_pathdiv(void *dm_void, void *phy_info_void, -+ void *pkt_info_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_phyinfo_struct *phy_info = NULL; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ struct phydm_cck_rx_pathdiv *cckrx_t = &dm->dm_cck_rx_pathdiv_table; -+ -+ phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ -+ if (!(pktinfo->is_packet_to_self || pktinfo->is_packet_match_bssid)) -+ return; -+ -+ if (pktinfo->is_cck_rate) -+ return; -+ -+ cckrx_t->path_a_sum += phy_info->rx_mimo_signal_strength[0]; -+ cckrx_t->path_a_cnt++; -+ -+ cckrx_t->path_b_sum += phy_info->rx_mimo_signal_strength[1]; -+ cckrx_t->path_b_cnt++; -+} -+ -+void phydm_cck_rx_pathdiv_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cck_rx_pathdiv *cckrx_t = &dm->dm_cck_rx_pathdiv_table; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ -+ if (!(dm->support_ic_type & ODM_RTL8822C)) -+ return; -+ -+ for (i = 0; i < 3; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "CCK rx pathdiv manual on: {1} {En}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "CCK rx pathdiv watchdog on: {2} {En}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "CCK rx pathdiv rssi_th : {3} {th} {fa_th}\n"); -+ } else if (var1[0] == 1) { -+ if (var1[1] == 1) -+ phydm_cck_rx_pathdiv_manaul(dm, true); -+ else -+ phydm_cck_rx_pathdiv_manaul(dm, false); -+ } else if (var1[0] == 2) { -+ if (var1[1] == 1) { -+ cckrx_t->en_cck_rx_pathdiv = true; -+ } else { -+ cckrx_t->en_cck_rx_pathdiv = false; -+ phydm_cck_rx_pathdiv_manaul(dm, false); -+ } -+ } else if (var1[0] == 3) { -+ cckrx_t->rssi_th = (u8)var1[1]; -+ cckrx_t->rssi_fa_th = (u8)var1[2]; -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_rx_pathdiv.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_rx_pathdiv.h -new file mode 100644 -index 000000000..952bcf5f9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cck_rx_pathdiv.h -@@ -0,0 +1,67 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_CCK_RX_PATHDIV_H__ -+#define __PHYDM_CCK_RX_PATHDIV_H__ -+ -+#define CCK_RX_PATHDIV_VERSION "1.1" -+ -+/* @1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+/* @1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+struct phydm_cck_rx_pathdiv { -+ boolean en_cck_rx_pathdiv; -+ u32 path_a_sum; -+ u32 path_b_sum; -+ u16 path_a_cnt; -+ u16 path_b_cnt; -+ u8 rssi_fa_th; -+ u8 rssi_th; -+}; -+ -+/* @1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ */ -+ -+/* @1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ */ -+void phydm_cck_rx_pathdiv_watchdog(void *dm_void); -+ -+void phydm_cck_rx_pathdiv_init(void *dm_void); -+ -+void phydm_process_rssi_for_cck_rx_pathdiv(void *dm_void, void *phy_info_void, -+ void *pkt_info_void); -+ -+void phydm_cck_rx_pathdiv_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_ccx.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_ccx.c -new file mode 100644 -index 000000000..2bd002a3f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_ccx.c -@@ -0,0 +1,3803 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+u8 phydm_env_mntr_get_802_11_k_rsni(void *dm_void, s8 rcpi, s8 anpi) -+{ -+ u8 rsni = 0; -+ u8 signal = 0; -+ u8 sig_to_rsni[13] = {0, 8, 15, 20, 24, 27, 30, 32, 35, 37, 39, 41, 43}; -+ -+ /*rcpi = signal + noise + interference = rssi*/ -+ /*anpi = noise + interferecne = nhm*/ -+ /*signal = rcpi - anpi*/ -+ -+ /*rsni = 2*(10*log10((rcpi_lin/anpi_lin)-1)+10), unit = 0.5dB*/ -+ /*rcpi_lin/anpi_lin=10^((rcpi_dB-anpi_db)/10)*/ -+ /*rsni is approximated as 2*((rcpi_db-anpi_db)+10) when signal >= 13*/ -+ -+ if (rcpi <= anpi) -+ signal = 0; -+ else if (rcpi - anpi >= 117) -+ signal = 117; -+ else -+ signal = rcpi - anpi; -+ -+ if (signal < 13) -+ rsni = sig_to_rsni[signal]; -+ else -+ rsni = 2 * (signal + 10); -+ -+ return rsni; -+} -+ -+void phydm_ccx_hw_restart(void *dm_void) -+ /*@Will Restart NHM/CLM/FAHM simultaneously*/ -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 reg1 = 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ reg1 = R_0x994; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ reg1 = R_0x1e60; -+ #endif -+ else -+ reg1 = R_0x890; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ /*@disable NHM,CLM, FAHM*/ -+ odm_set_bb_reg(dm, reg1, 0x7, 0x0); -+ odm_set_bb_reg(dm, reg1, BIT(8), 0x0); -+ odm_set_bb_reg(dm, reg1, BIT(8), 0x1); -+} -+ -+u8 phydm_ccx_get_rpt_ratio(void *dm_void, u16 rpt, u16 denom) -+{ -+ u32 numer = 0; -+ -+ numer = rpt * 100 + (denom >> 1); -+ -+ return (u8)PHYDM_DIV(numer, denom); -+} -+ -+#ifdef NHM_SUPPORT -+ -+void phydm_nhm_racing_release(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 value32 = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "lv:(%d)->(0)\n", ccx->nhm_set_lv); -+ -+ ccx->nhm_ongoing = false; -+ ccx->nhm_set_lv = NHM_RELEASE; -+ -+ if (!(ccx->nhm_app == NHM_BACKGROUND || ccx->nhm_app == NHM_ACS)) { -+ phydm_pause_func(dm, F00_DIG, PHYDM_RESUME, -+ PHYDM_PAUSE_LEVEL_1, 1, &value32); -+ } -+ -+ ccx->nhm_app = NHM_BACKGROUND; -+} -+ -+u8 phydm_nhm_racing_ctrl(void *dm_void, enum phydm_nhm_level nhm_lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 set_result = PHYDM_SET_SUCCESS; -+ /*@acquire to control NHM API*/ -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "nhm_ongoing=%d, lv:(%d)->(%d)\n", -+ ccx->nhm_ongoing, ccx->nhm_set_lv, nhm_lv); -+ if (ccx->nhm_ongoing) { -+ if (nhm_lv <= ccx->nhm_set_lv) { -+ set_result = PHYDM_SET_FAIL; -+ } else { -+ phydm_ccx_hw_restart(dm); -+ ccx->nhm_ongoing = false; -+ } -+ } -+ -+ if (set_result) -+ ccx->nhm_set_lv = nhm_lv; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "nhm racing success=%d\n", set_result); -+ return set_result; -+} -+ -+void phydm_nhm_trigger(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 nhm_reg1 = 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ nhm_reg1 = R_0x994; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ nhm_reg1 = R_0x1e60; -+ #endif -+ else -+ nhm_reg1 = R_0x890; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ /* @Trigger NHM*/ -+ pdm_set_reg(dm, nhm_reg1, BIT(1), 0); -+ pdm_set_reg(dm, nhm_reg1, BIT(1), 1); -+ ccx->nhm_trigger_time = dm->phydm_sys_up_time; -+ ccx->nhm_rpt_stamp++; -+ ccx->nhm_ongoing = true; -+} -+ -+boolean -+phydm_nhm_check_rdy(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean is_ready = false; -+ u32 reg1 = 0, reg1_bit = 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ reg1 = R_0xfb4; -+ reg1_bit = 16; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ reg1 = R_0x2d4c; -+ reg1_bit = 16; -+ #endif -+ } else { -+ reg1 = R_0x8b4; -+ if (dm->support_ic_type & (ODM_RTL8710B | ODM_RTL8721D | -+ ODM_RTL8710C)) -+ reg1_bit = 25; -+ else -+ reg1_bit = 17; -+ } -+ if (odm_get_bb_reg(dm, reg1, BIT(reg1_bit))) -+ is_ready = true; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "NHM rdy=%d\n", is_ready); -+ -+ return is_ready; -+} -+ -+void phydm_nhm_cal_wgt(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 i = 0; -+ -+ for (i = 0; i < NHM_RPT_NUM; i++) { -+ if (i == 0) -+ ccx->nhm_wgt[0] = (u8)(MAX_2(ccx->nhm_th[0] - 2, 0)); -+ else if (i == (NHM_RPT_NUM - 1)) -+ ccx->nhm_wgt[NHM_RPT_NUM - 1] = (u8)(ccx->nhm_th[NHM_TH_NUM - 1] + 2); -+ else -+ ccx->nhm_wgt[i] = (u8)((ccx->nhm_th[i - 1] + ccx->nhm_th[i]) >> 1); -+ } -+} -+ -+u8 phydm_nhm_cal_wgt_avg(void *dm_void, u8 start_i, u8 end_i, u8 n_sum) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 i = 0; -+ u32 noise_tmp = 0; -+ u8 noise = 0; -+ u32 nhm_valid = 0; -+ -+ if (n_sum == 0) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "n_sum = 0, don't need to update noise\n"); -+ return 0x0; -+ } else if (end_i > NHM_RPT_NUM - 1) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[WARNING]end_i is larger than 11!!\n"); -+ return 0x0; -+ } -+ -+ for (i = start_i; i <= end_i; i++) -+ noise_tmp += ccx->nhm_result[i] * ccx->nhm_wgt[i]; -+ -+ /* protection for the case of minus noise(RSSI)*/ -+ noise = (u8)(NTH_TH_2_RSSI(MAX_2(PHYDM_DIV(noise_tmp, n_sum), 20))); -+ nhm_valid = (n_sum * 100) >> 8; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "cal wgt_avg : valid: ((%d)) percent, noise(RSSI)=((%d))\n", -+ nhm_valid, noise); -+ -+ return noise; -+} -+ -+u8 phydm_nhm_cal_nhm_env(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 first_idx = 0; -+ u8 nhm_env = 0; -+ u8 i = 0; -+ -+ nhm_env = ccx->nhm_rpt_sum; -+ -+ /*search first cluster*/ -+ for (i = 0; i < NHM_RPT_NUM; i++) { -+ if (ccx->nhm_result[i]) { -+ first_idx = i; -+ break; -+ } -+ } -+ -+ /*exclude first cluster under -80dBm*/ -+ for (i = 0; i < 4; i++) { -+ if (((first_idx + i) < NHM_RPT_NUM) && -+ (ccx->nhm_wgt[first_idx + i] <= NHM_IC_NOISE_TH)) -+ nhm_env -= ccx->nhm_result[first_idx + i]; -+ } -+ -+ /*exclude nhm_rpt[0] above -80dBm*/ -+ if (ccx->nhm_wgt[0] > NHM_IC_NOISE_TH) -+ nhm_env -= ccx->nhm_result[0]; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "cal nhm_env: first_idx=%d, nhm_env=%d\n", -+ first_idx, nhm_env); -+ -+ return nhm_env; -+} -+ -+void phydm_nhm_get_utility(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 nhm_rpt_non_0 = 0; -+ u8 nhm_rpt_non_11 = 0; -+ u8 nhm_env = 0; -+ -+ if (ccx->nhm_rpt_sum >= ccx->nhm_result[0]) { -+ phydm_nhm_cal_wgt(dm); -+ -+ nhm_rpt_non_0 = ccx->nhm_rpt_sum - ccx->nhm_result[0]; -+ nhm_rpt_non_11 = ccx->nhm_rpt_sum - ccx->nhm_result[11]; -+ /*exclude nhm_r[0] above -80dBm or first cluster under -80dBm*/ -+ nhm_env = phydm_nhm_cal_nhm_env(dm); -+ ccx->nhm_ratio = phydm_ccx_get_rpt_ratio(dm, nhm_rpt_non_0, -+ NHM_RPT_MAX); -+ ccx->nhm_env_ratio = phydm_ccx_get_rpt_ratio(dm, nhm_env, -+ NHM_RPT_MAX); -+ if ((ccx->nhm_include_txon == NHM_EXCLUDE_TXON) && -+ (ccx->nhm_include_cca == NHM_EXCLUDE_CCA)) -+ ccx->nhm_idle_ratio = phydm_ccx_get_rpt_ratio(dm, -+ ccx->nhm_duration, -+ ccx->nhm_period); -+ else -+ ccx->nhm_idle_ratio = ENV_MNTR_FAIL; -+ ccx->nhm_level_valid = phydm_ccx_get_rpt_ratio(dm, -+ nhm_rpt_non_11, NHM_RPT_MAX); -+ ccx->nhm_level = phydm_nhm_cal_wgt_avg(dm, 0, NHM_RPT_NUM - 2, -+ nhm_rpt_non_11); -+ ccx->nhm_pwr = phydm_nhm_cal_wgt_avg(dm, 0, NHM_RPT_NUM - 1, -+ ccx->nhm_rpt_sum); -+ } else { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[warning] nhm_rpt_sum invalid\n"); -+ ccx->nhm_ratio = ENV_MNTR_FAIL; -+ ccx->nhm_env_ratio = ENV_MNTR_FAIL; -+ ccx->nhm_idle_ratio = ENV_MNTR_FAIL; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "nhm_ratio=%d, nhm_env_ratio=%d, nhm_level=%d, nhm_pwr=%d\n", -+ ccx->nhm_ratio, ccx->nhm_env_ratio, ccx->nhm_level, -+ ccx->nhm_pwr); -+} -+ -+boolean -+phydm_nhm_get_result(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 value32 = 0; -+ u8 i = 0; -+ u32 nhm_reg1 = 0; -+ u16 nhm_rpt_sum_tmp = 0; -+ u16 nhm_duration = 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ nhm_reg1 = R_0x994; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ nhm_reg1 = R_0x1e60; -+ #endif -+ else -+ nhm_reg1 = R_0x890; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if ((dm->support_ic_type & ODM_IC_11N_SERIES) || -+ (dm->support_ic_type & ODM_IC_11AC_SERIES) || -+ (dm->support_ic_type & ODM_RTL8198F) || -+ (dm->support_ic_type & ODM_RTL8814B)) -+ pdm_set_reg(dm, nhm_reg1, BIT(1), 0); -+ -+ if (!(phydm_nhm_check_rdy(dm))) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get NHM report Fail\n"); -+ phydm_nhm_racing_release(dm); -+ return false; -+ } -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ value32 = odm_read_4byte(dm, R_0xfa8); -+ value32 = odm_convert_to_le32(value32); -+ odm_move_memory(dm, &ccx->nhm_result[0], &value32, 4); -+ -+ value32 = odm_read_4byte(dm, R_0xfac); -+ value32 = odm_convert_to_le32(value32); -+ odm_move_memory(dm, &ccx->nhm_result[4], &value32, 4); -+ -+ value32 = odm_read_4byte(dm, R_0xfb0); -+ value32 = odm_convert_to_le32(value32); -+ odm_move_memory(dm, &ccx->nhm_result[8], &value32, 4); -+ -+ /*@Get NHM duration*/ -+ value32 = odm_read_4byte(dm, R_0xfb4); -+ nhm_duration = (u16)(value32 & MASKLWORD); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ value32 = odm_read_4byte(dm, R_0x2d40); -+ value32 = odm_convert_to_le32(value32); -+ odm_move_memory(dm, &ccx->nhm_result[0], &value32, 4); -+ -+ value32 = odm_read_4byte(dm, R_0x2d44); -+ value32 = odm_convert_to_le32(value32); -+ odm_move_memory(dm, &ccx->nhm_result[4], &value32, 4); -+ -+ value32 = odm_read_4byte(dm, R_0x2d48); -+ value32 = odm_convert_to_le32(value32); -+ odm_move_memory(dm, &ccx->nhm_result[8], &value32, 4); -+ -+ /*@Get NHM duration*/ -+ value32 = odm_read_4byte(dm, R_0x2d4c); -+ nhm_duration = (u16)(value32 & MASKLWORD); -+ #endif -+ } else { -+ value32 = odm_read_4byte(dm, R_0x8d8); -+ value32 = odm_convert_to_le32(value32); -+ odm_move_memory(dm, &ccx->nhm_result[0], &value32, 4); -+ -+ value32 = odm_read_4byte(dm, R_0x8dc); -+ value32 = odm_convert_to_le32(value32); -+ odm_move_memory(dm, &ccx->nhm_result[4], &value32, 4); -+ -+ value32 = odm_read_4byte(dm, R_0x8d0); -+ -+ ccx->nhm_result[8] = (u8)((value32 & MASKBYTE2) >> 16); -+ ccx->nhm_result[9] = (u8)((value32 & MASKBYTE3) >> 24); -+ -+ value32 = odm_read_4byte(dm, R_0x8d4); -+ -+ ccx->nhm_result[10] = (u8)((value32 & MASKBYTE2) >> 16); -+ ccx->nhm_result[11] = (u8)((value32 & MASKBYTE3) >> 24); -+ -+ /*@Get NHM duration*/ -+ nhm_duration = (u16)(value32 & MASKLWORD); -+ } -+ ccx->nhm_duration = nhm_duration; -+ -+ /* sum all nhm_result */ -+ if (ccx->nhm_period >= 65530) -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "NHM valid time = %d, valid: %d percent\n", -+ nhm_duration, (nhm_duration * 100) >> 16); -+ -+ for (i = 0; i < NHM_RPT_NUM; i++) -+ nhm_rpt_sum_tmp = (u16)(nhm_rpt_sum_tmp + ccx->nhm_result[i]); -+ -+ ccx->nhm_rpt_sum = (u8)nhm_rpt_sum_tmp; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "NHM_Rpt[%d](H->L)[%d %d %d %d %d %d %d %d %d %d %d %d]\n", -+ ccx->nhm_rpt_stamp, ccx->nhm_result[11], ccx->nhm_result[10], -+ ccx->nhm_result[9], ccx->nhm_result[8], ccx->nhm_result[7], -+ ccx->nhm_result[6], ccx->nhm_result[5], ccx->nhm_result[4], -+ ccx->nhm_result[3], ccx->nhm_result[2], ccx->nhm_result[1], -+ ccx->nhm_result[0]); -+ -+ phydm_nhm_racing_release(dm); -+ -+ if (nhm_rpt_sum_tmp > 255) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[Warning] Invalid NHM RPT, total=%d\n", -+ nhm_rpt_sum_tmp); -+ return false; -+ } -+ -+ return true; -+} -+ -+void phydm_nhm_set_th_reg(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 reg1 = 0, reg2 = 0, reg3 = 0, reg4 = 0, reg4_bit = 0; -+ u32 val = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ reg1 = R_0x994; -+ reg2 = R_0x998; -+ reg3 = R_0x99c; -+ reg4 = R_0x9a0; -+ reg4_bit = MASKBYTE0; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ reg1 = R_0x1e60; -+ reg2 = R_0x1e44; -+ reg3 = R_0x1e48; -+ reg4 = R_0x1e5c; -+ reg4_bit = MASKBYTE2; -+ #endif -+ } else { -+ reg1 = R_0x890; -+ reg2 = R_0x898; -+ reg3 = R_0x89c; -+ reg4 = R_0xe28; -+ reg4_bit = MASKBYTE0; -+ } -+ -+ /*Set NHM threshold*/ /*Unit: PWdB U(8,1)*/ -+ val = BYTE_2_DWORD(ccx->nhm_th[3], ccx->nhm_th[2], -+ ccx->nhm_th[1], ccx->nhm_th[0]); -+ pdm_set_reg(dm, reg2, MASKDWORD, val); -+ val = BYTE_2_DWORD(ccx->nhm_th[7], ccx->nhm_th[6], -+ ccx->nhm_th[5], ccx->nhm_th[4]); -+ pdm_set_reg(dm, reg3, MASKDWORD, val); -+ pdm_set_reg(dm, reg4, reg4_bit, ccx->nhm_th[8]); -+ val = BYTE_2_DWORD(0, 0, ccx->nhm_th[10], ccx->nhm_th[9]); -+ pdm_set_reg(dm, reg1, 0xffff0000, val); -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Update NHM_th[H->L]=[%d %d %d %d %d %d %d %d %d %d %d]\n", -+ ccx->nhm_th[10], ccx->nhm_th[9], ccx->nhm_th[8], -+ ccx->nhm_th[7], ccx->nhm_th[6], ccx->nhm_th[5], -+ ccx->nhm_th[4], ccx->nhm_th[3], ccx->nhm_th[2], -+ ccx->nhm_th[1], ccx->nhm_th[0]); -+} -+ -+boolean -+phydm_nhm_th_update_chk(void *dm_void, enum nhm_application nhm_app, u8 *nhm_th, -+ u32 *igi_new, boolean en_1db_mode, u8 nhm_th0_manual) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean is_update = false; -+ u8 igi_curr = phydm_get_igi(dm, BB_PATH_A); -+ u8 nhm_igi_th_11k_low[NHM_TH_NUM] = {0x12, 0x15, 0x18, 0x1b, 0x1e, -+ 0x23, 0x28, 0x2c, 0x78, -+ 0x78, 0x78}; -+ u8 nhm_igi_th_11k_high[NHM_TH_NUM] = {0x1e, 0x23, 0x28, 0x2d, 0x32, -+ 0x37, 0x78, 0x78, 0x78, 0x78, -+ 0x78}; -+ u8 nhm_igi_th_xbox[NHM_TH_NUM] = {0x1a, 0x2c, 0x2e, 0x30, 0x32, 0x34, -+ 0x36, 0x38, 0x3a, 0x3c, 0x3d}; -+ u8 nhm_igi_th_11k[NHM_TH_NUM] = {0x12, 0x15, 0x18, 0x1b, 0x1e, 0x23, -+ 0x28, 0x2d, 0x32, 0x37, 0x3c}; -+ /*11k_dbm : {-92, -89, -86, -83, -80, -75, -70, -65, -60, -55, -50};*/ -+ /*11k_gain_idx : {18, 21, 24, 27, 30, 35, 40, 45, 50, 55, 60};*/ -+ -+ u8 i = 0; -+ u8 th_tmp = igi_curr - CCA_CAP; -+ u8 th_step = 2; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "App=%d, nhm_igi=0x%x, igi_curr=0x%x\n", -+ nhm_app, ccx->nhm_igi, igi_curr); -+ -+ if (igi_curr < 0x10) /* Protect for invalid IGI*/ -+ return false; -+ -+ switch (nhm_app) { -+ case NHM_BACKGROUND: /* @Get IGI form driver parameter(cur_ig_value)*/ -+ if (ccx->nhm_igi != igi_curr || ccx->nhm_app != nhm_app) { -+ is_update = true; -+ *igi_new = (u32)igi_curr; -+ -+ #ifdef NHM_DYM_PW_TH_SUPPORT -+ if (ccx->nhm_dym_pw_th_en) { -+ th_tmp = MAX_2(igi_curr - DYM_PWTH_CCA_CAP, 0); -+ th_step = 3; -+ } -+ #endif -+ -+ nhm_th[0] = (u8)IGI_2_NHM_TH(th_tmp); -+ -+ for (i = 1; i <= 10; i++) -+ nhm_th[i] = nhm_th[0] + -+ IGI_2_NHM_TH(th_step * i); -+ -+ } -+ break; -+ -+ case NHM_ACS: -+ if (ccx->nhm_igi != igi_curr || ccx->nhm_app != nhm_app) { -+ is_update = true; -+ *igi_new = (u32)igi_curr; -+ for (i = 0; i < NHM_TH_NUM; i++) -+ nhm_th[i] = IGI_2_NHM_TH(nhm_igi_th_11k[i]); -+ } -+ break; -+ -+ case IEEE_11K_HIGH: -+ is_update = true; -+ *igi_new = 0x2c; -+ for (i = 0; i < NHM_TH_NUM; i++) -+ nhm_th[i] = IGI_2_NHM_TH(nhm_igi_th_11k_high[i]); -+ break; -+ -+ case IEEE_11K_LOW: -+ is_update = true; -+ *igi_new = 0x20; -+ for (i = 0; i < NHM_TH_NUM; i++) -+ nhm_th[i] = IGI_2_NHM_TH(nhm_igi_th_11k_low[i]); -+ break; -+ -+ case INTEL_XBOX: -+ is_update = true; -+ *igi_new = 0x36; -+ for (i = 0; i < NHM_TH_NUM; i++) -+ nhm_th[i] = IGI_2_NHM_TH(nhm_igi_th_xbox[i]); -+ break; -+ -+ case NHM_DBG: /*@Get IGI form register*/ -+ igi_curr = phydm_get_igi(dm, BB_PATH_A); -+ if (ccx->nhm_igi != igi_curr || ccx->nhm_app != nhm_app) { -+ is_update = true; -+ *igi_new = (u32)igi_curr; -+ if (en_1db_mode) { -+ nhm_th[0] = (u8)IGI_2_NHM_TH(nhm_th0_manual + -+ 10); -+ th_step = 1; -+ } else { -+ nhm_th[0] = (u8)IGI_2_NHM_TH(igi_curr - -+ CCA_CAP); -+ } -+ -+ for (i = 1; i <= 10; i++) -+ nhm_th[i] = nhm_th[0] + IGI_2_NHM_TH(th_step * -+ i); -+ } -+ break; -+ } -+ -+ if (is_update) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[Update NHM_TH] igi_RSSI=%d\n", -+ IGI_2_RSSI(*igi_new)); -+ -+ for (i = 0; i < NHM_TH_NUM; i++) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "NHM_th[%d](RSSI) = %d\n", -+ i, NTH_TH_2_RSSI(nhm_th[i])); -+ } -+ } else { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "No need to update NHM_TH\n"); -+ } -+ return is_update; -+} -+ -+void phydm_nhm_set(void *dm_void, enum nhm_option_txon_all include_tx, -+ enum nhm_option_cca_all include_cca, -+ enum nhm_divider_opt_all divi_opt, -+ enum nhm_application nhm_app, u16 period, -+ boolean en_1db_mode, u8 nhm_th0_manual) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 nhm_th[NHM_TH_NUM] = {0}; -+ u32 igi = 0x20; -+ u32 reg1 = 0, reg2 = 0; -+ u32 val_tmp = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "incld{tx, cca}={%d, %d}, divi_opt=%d, period=%d\n", -+ include_tx, include_cca, divi_opt, period); -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ reg1 = R_0x994; -+ reg2 = R_0x990; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ reg1 = R_0x1e60; -+ reg2 = R_0x1e40; -+ #endif -+ } else { -+ reg1 = R_0x890; -+ reg2 = R_0x894; -+ } -+ -+ /*Set disable_ignore_cca, disable_ignore_txon, ccx_en*/ -+ if (include_tx != ccx->nhm_include_txon || -+ include_cca != ccx->nhm_include_cca || -+ divi_opt != ccx->nhm_divider_opt) { -+ /* some old ic is not supported on NHM divider option */ -+ if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8723B | -+ ODM_RTL8195A | ODM_RTL8192E)) { -+ val_tmp = (u32)((include_tx << 2) | -+ (include_cca << 1) | 1); -+ pdm_set_reg(dm, reg1, 0x700, val_tmp); -+ } else { -+ val_tmp = (u32)BIT_2_BYTE(divi_opt, include_tx, -+ include_cca, 1); -+ pdm_set_reg(dm, reg1, 0xf00, val_tmp); -+ } -+ ccx->nhm_include_txon = include_tx; -+ ccx->nhm_include_cca = include_cca; -+ ccx->nhm_divider_opt = divi_opt; -+ } -+ -+ /*Set NHM period*/ -+ if (period != ccx->nhm_period) { -+ pdm_set_reg(dm, reg2, MASKHWORD, period); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Update NHM period ((%d)) -> ((%d))\n", -+ ccx->nhm_period, period); -+ -+ ccx->nhm_period = period; -+ } -+ -+ /*Set NHM threshold*/ -+ if (phydm_nhm_th_update_chk(dm, nhm_app, &nhm_th[0], &igi, -+ en_1db_mode, nhm_th0_manual)) { -+ /*Pause IGI*/ -+ if (nhm_app == NHM_BACKGROUND || nhm_app == NHM_ACS) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "DIG Free Run\n"); -+ } else if (phydm_pause_func(dm, F00_DIG, PHYDM_PAUSE, -+ PHYDM_PAUSE_LEVEL_1, 1, &igi) -+ == PAUSE_FAIL) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "pause DIG Fail\n"); -+ return; -+ } else { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "pause DIG=0x%x\n", igi); -+ } -+ ccx->nhm_app = nhm_app; -+ ccx->nhm_igi = (u8)igi; -+ odm_move_memory(dm, &ccx->nhm_th[0], &nhm_th, NHM_TH_NUM); -+ -+ /*Set NHM th*/ -+ phydm_nhm_set_th_reg(dm); -+ } -+} -+ -+boolean -+phydm_nhm_mntr_set(void *dm_void, struct nhm_para_info *nhm_para) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 nhm_time = 0; /*unit: 4us*/ -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (nhm_para->mntr_time == 0) -+ return false; -+ -+ if (nhm_para->nhm_lv >= NHM_MAX_NUM) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Wrong LV=%d\n", nhm_para->nhm_lv); -+ return false; -+ } -+ -+ if (phydm_nhm_racing_ctrl(dm, nhm_para->nhm_lv) == PHYDM_SET_FAIL) -+ return false; -+ -+ if (nhm_para->mntr_time >= 262) -+ nhm_time = NHM_PERIOD_MAX; -+ else -+ nhm_time = nhm_para->mntr_time * MS_TO_4US_RATIO; -+ -+ phydm_nhm_set(dm, nhm_para->incld_txon, nhm_para->incld_cca, -+ nhm_para->div_opt, nhm_para->nhm_app, nhm_time, -+ nhm_para->en_1db_mode, nhm_para->nhm_th0_manual); -+ -+ return true; -+} -+ -+#ifdef NHM_DYM_PW_TH_SUPPORT -+void -+phydm_nhm_restore_pw_th(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ odm_set_bb_reg(dm, R_0x82c, 0x3f, ccx->pw_th_rf20_ori); -+} -+ -+void -+phydm_nhm_set_pw_th(void *dm_void, u8 noise, boolean chk_succ) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean not_update = false; -+ u8 pw_th_rf20_new = 0; -+ u8 pw_th_u_bnd = 0; -+ s8 noise_diff = 0; -+ u8 point_mean = 15; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (*dm->band_width != CHANNEL_WIDTH_20 || -+ *dm->band_type == ODM_BAND_5G) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "bandwidth=((%d)), band=((%d))\n", -+ *dm->band_width, *dm->band_type); -+ phydm_nhm_restore_pw_th(dm); -+ return; -+ } -+ -+ if (chk_succ) { -+ noise_diff = noise - (ccx->nhm_igi - 10); -+ pw_th_u_bnd = (u8)(noise_diff + 32 + point_mean); -+ -+ pw_th_u_bnd = MIN_2(pw_th_u_bnd, ccx->nhm_pw_th_max); -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "noise_diff=((%d)), max=((%d)), pw_th_u_bnd=((%d))\n", -+ noise_diff, ccx->nhm_pw_th_max, pw_th_u_bnd); -+ -+ if (pw_th_u_bnd > ccx->pw_th_rf20_cur) { -+ pw_th_rf20_new = ccx->pw_th_rf20_cur + 1; -+ } else if (pw_th_u_bnd < ccx->pw_th_rf20_cur) { -+ if (ccx->pw_th_rf20_cur > ccx->pw_th_rf20_ori) -+ pw_th_rf20_new = ccx->pw_th_rf20_cur - 1; -+ else /*ccx->pw_th_rf20_cur == ccx->pw_th_ori*/ -+ not_update = true; -+ } else {/*pw_th_u_bnd == ccx->pw_th_rf20_cur*/ -+ not_update = true; -+ } -+ } else { -+ if (ccx->pw_th_rf20_cur > ccx->pw_th_rf20_ori) -+ pw_th_rf20_new = ccx->pw_th_rf20_cur - 1; -+ else /*ccx->pw_th_rf20_cur == ccx->pw_th_ori*/ -+ not_update = true; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "pw_th_cur=((%d)), pw_th_new=((%d))\n", -+ ccx->pw_th_rf20_cur, pw_th_rf20_new); -+ -+ if (!not_update) { -+ odm_set_bb_reg(dm, R_0x82c, 0x3f, pw_th_rf20_new); -+ ccx->pw_th_rf20_cur = pw_th_rf20_new; -+ } -+} -+ -+void -+phydm_nhm_dym_pw_th(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 i = 0; -+ u8 n_sum = 0; -+ u8 noise = 0; -+ boolean chk_succ = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ for (i = 0; i < NHM_RPT_NUM - 3; i++) { -+ n_sum = ccx->nhm_result[i] + ccx->nhm_result[i + 1] + -+ ccx->nhm_result[i + 2] + ccx->nhm_result[i + 3]; -+ if (n_sum >= ccx->nhm_sl_pw_th) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Do sl[%d:%d]\n", i, i + 3); -+ chk_succ = true; -+ noise = phydm_nhm_cal_wgt_avg(dm, i, i + 3, n_sum); -+ break; -+ } -+ } -+ -+ if (!chk_succ) -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "SL method failed!\n"); -+ -+ phydm_nhm_set_pw_th(dm, noise, chk_succ); -+} -+ -+boolean -+phydm_nhm_dym_pw_th_en(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ struct phydm_iot_center *iot_table = &dm->iot_table; -+ -+ if (!(dm->support_ic_type & ODM_RTL8822C)) -+ return false; -+ -+ if (ccx->dym_pwth_manual_ctrl) -+ return true; -+ -+ if (dm->iot_table.phydm_patch_id == 0x100f0401 || -+ iot_table->patch_id_100f0401) { -+ return true; -+ } else if (ccx->nhm_dym_pw_th_en) { -+ phydm_nhm_restore_pw_th(dm); -+ return false; -+ } else { -+ return false; -+ } -+} -+#endif -+ -+/*Environment Monitor*/ -+boolean -+phydm_nhm_mntr_racing_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 sys_return_time = 0; -+ -+ if (ccx->nhm_manual_ctrl) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "NHM in manual ctrl\n"); -+ return true; -+ } -+ -+ sys_return_time = ccx->nhm_trigger_time + MAX_ENV_MNTR_TIME; -+ -+ if (ccx->nhm_app != NHM_BACKGROUND && -+ (sys_return_time > dm->phydm_sys_up_time)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "nhm_app=%d, trigger_time %d, sys_time=%d\n", -+ ccx->nhm_app, ccx->nhm_trigger_time, -+ dm->phydm_sys_up_time); -+ -+ return true; -+ } -+ -+ return false; -+} -+ -+boolean -+phydm_nhm_mntr_chk(void *dm_void, u16 monitor_time /*unit ms*/) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ struct nhm_para_info nhm_para = {0}; -+ boolean nhm_chk_result = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (phydm_nhm_mntr_racing_chk(dm)) -+ return nhm_chk_result; -+ -+ /*[NHM trigger setting]------------------------------------------*/ -+ nhm_para.incld_txon = NHM_EXCLUDE_TXON; -+ nhm_para.incld_cca = NHM_EXCLUDE_CCA; -+ nhm_para.div_opt = NHM_CNT_ALL; -+ nhm_para.nhm_app = NHM_BACKGROUND; -+ nhm_para.nhm_lv = NHM_LV_1; -+ nhm_para.en_1db_mode = false; -+ nhm_para.mntr_time = monitor_time; -+ -+ #ifdef NHM_DYM_PW_TH_SUPPORT -+ if (ccx->nhm_dym_pw_th_en) { -+ nhm_para.div_opt = NHM_VALID; -+ nhm_para.mntr_time = monitor_time >> ccx->nhm_period_decre; -+ } -+ #endif -+ -+ nhm_chk_result = phydm_nhm_mntr_set(dm, &nhm_para); -+ -+ return nhm_chk_result; -+} -+ -+boolean -+phydm_nhm_mntr_result(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean nhm_chk_result = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (phydm_nhm_mntr_racing_chk(dm)) -+ return nhm_chk_result; -+ -+ /*[NHM get result & calculate Utility]---------------------------*/ -+ if (phydm_nhm_get_result(dm)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get NHM_rpt success\n"); -+ phydm_nhm_get_utility(dm); -+ nhm_chk_result = true; -+ } -+ -+ #ifdef NHM_DYM_PW_TH_SUPPORT -+ ccx->nhm_dym_pw_th_en = phydm_nhm_dym_pw_th_en(dm); -+ if (ccx->nhm_dym_pw_th_en) { -+ if (nhm_chk_result) -+ phydm_nhm_dym_pw_th(dm); -+ else -+ phydm_nhm_set_pw_th(dm, 0x0, false); -+ } -+ #endif -+ -+ return nhm_chk_result; -+} -+ -+void phydm_nhm_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "cur_igi=0x%x\n", -+ dm->dm_dig_table.cur_ig_value); -+ -+ ccx->nhm_app = NHM_BACKGROUND; -+ ccx->nhm_igi = 0xff; -+ -+ /*Set NHM threshold*/ -+ ccx->nhm_ongoing = false; -+ ccx->nhm_set_lv = NHM_RELEASE; -+ -+ if (phydm_nhm_th_update_chk(dm, ccx->nhm_app, &ccx->nhm_th[0], -+ (u32 *)&ccx->nhm_igi, false, 0)) -+ phydm_nhm_set_th_reg(dm); -+ -+ ccx->nhm_period = 0; -+ -+ ccx->nhm_include_cca = NHM_CCA_INIT; -+ ccx->nhm_include_txon = NHM_TXON_INIT; -+ ccx->nhm_divider_opt = NHM_CNT_INIT; -+ -+ ccx->nhm_manual_ctrl = 0; -+ ccx->nhm_rpt_stamp = 0; -+ -+ #ifdef NHM_DYM_PW_TH_SUPPORT -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ ccx->nhm_dym_pw_th_en = false; -+ ccx->pw_th_rf20_ori = (u8)odm_get_bb_reg(dm, R_0x82c, 0x3f); -+ ccx->pw_th_rf20_cur = ccx->pw_th_rf20_ori; -+ ccx->nhm_pw_th_max = 63; -+ ccx->nhm_sl_pw_th = 100; /*39%*/ -+ ccx->nhm_period_decre = 1; -+ ccx->dym_pwth_manual_ctrl = false; -+ } -+ #endif -+} -+ -+void phydm_nhm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ struct nhm_para_info nhm_para = {0}; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 result_tmp = 0; -+ u8 i = 0; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "NHM Basic-Trigger 262ms: {1}\n"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "NHM Adv-Trigger: {2} {Include TXON} {Include CCA}\n{0:Cnt_all, 1:Cnt valid} {App:5 for dbg} {LV:1~4} {0~262ms}, 1dB mode :{en} {t[0](RSSI)}\n"); -+ #ifdef NHM_DYM_PW_TH_SUPPORT -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "NHM dym_pw_th: {3} {0:off}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "NHM dym_pw_th: {3} {1:on} {max} {period_decre} {sl_th}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "NHM dym_pw_th: {3} {2:fast on}\n"); -+ } -+ #endif -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "NHM Get Result: {100}\n"); -+ } else if (var1[0] == 100) { /*Get NHM results*/ -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "IGI=0x%x, rpt_stamp=%d\n", ccx->nhm_igi, -+ ccx->nhm_rpt_stamp); -+ -+ if (phydm_nhm_get_result(dm)) { -+ for (i = 0; i < NHM_RPT_NUM; i++) { -+ result_tmp = ccx->nhm_result[i]; -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "nhm_rpt[%d] = %d (%d percent)\n", -+ i, result_tmp, -+ (((result_tmp * 100) + 128) >> 8)); -+ } -+ phydm_nhm_get_utility(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "NHM_noise: valid: %d percent, noise(RSSI) = %d\n", -+ ccx->nhm_level_valid, ccx->nhm_level); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "NHM_pwr: nhm_pwr (RSSI) = %d\n", ccx->nhm_pwr); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "ratio: nhm_ratio=%d, nhm_env_ratio=%d, nhm_idle_ratio=%d\n", -+ ccx->nhm_ratio, ccx->nhm_env_ratio, -+ ccx->nhm_idle_ratio); -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Get NHM_rpt Fail\n"); -+ } -+ ccx->nhm_manual_ctrl = 0; -+ #ifdef NHM_DYM_PW_TH_SUPPORT -+ } else if (var1[0] == 3) { /*NMH dym_pw_th*/ -+ if (dm->support_ic_type & ODM_RTL8822C) { -+ for (i = 1; i < 7; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var1[i]); -+ } -+ -+ if (var1[1] == 1) { -+ ccx->nhm_dym_pw_th_en = true; -+ ccx->nhm_pw_th_max = (u8)var1[2]; -+ ccx->nhm_period_decre = (u8)var1[3]; -+ ccx->nhm_sl_pw_th = (u8)var1[4]; -+ ccx->dym_pwth_manual_ctrl = true; -+ } else if (var1[1] == 2) { -+ ccx->nhm_dym_pw_th_en = true; -+ ccx->nhm_pw_th_max = 63; -+ ccx->nhm_period_decre = 1; -+ ccx->nhm_sl_pw_th = 100; -+ ccx->dym_pwth_manual_ctrl = true; -+ } else { -+ ccx->nhm_dym_pw_th_en = false; -+ phydm_nhm_restore_pw_th(dm); -+ ccx->dym_pwth_manual_ctrl = false; -+ } -+ } -+ #endif -+ } else { /*NMH trigger*/ -+ ccx->nhm_manual_ctrl = 1; -+ -+ for (i = 1; i < 9; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var1[i]); -+ } -+ -+ if (var1[0] == 1) { -+ nhm_para.incld_txon = NHM_EXCLUDE_TXON; -+ nhm_para.incld_cca = NHM_EXCLUDE_CCA; -+ nhm_para.div_opt = NHM_CNT_ALL; -+ nhm_para.nhm_app = NHM_DBG; -+ nhm_para.nhm_lv = NHM_LV_4; -+ nhm_para.mntr_time = 262; -+ nhm_para.en_1db_mode = false; -+ nhm_para.nhm_th0_manual = 0; -+ } else { -+ nhm_para.incld_txon = (enum nhm_option_txon_all)var1[1]; -+ nhm_para.incld_cca = (enum nhm_option_cca_all)var1[2]; -+ nhm_para.div_opt = (enum nhm_divider_opt_all)var1[3]; -+ nhm_para.nhm_app = (enum nhm_application)var1[4]; -+ nhm_para.nhm_lv = (enum phydm_nhm_level)var1[5]; -+ nhm_para.mntr_time = (u16)var1[6]; -+ nhm_para.en_1db_mode = (boolean)var1[7]; -+ nhm_para.nhm_th0_manual = (u8)var1[8]; -+ -+ /*some old ic is not supported on NHM divider option */ -+ if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8723B | -+ ODM_RTL8195A | ODM_RTL8192E)) { -+ nhm_para.div_opt = NHM_CNT_ALL; -+ } -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "txon=%d, cca=%d, dev=%d, app=%d, lv=%d, time=%d ms\n", -+ nhm_para.incld_txon, nhm_para.incld_cca, -+ nhm_para.div_opt, nhm_para.nhm_app, -+ nhm_para.nhm_lv, nhm_para.mntr_time); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "en_1db_mode=%d, th0(for 1db mode)=%d\n", -+ nhm_para.en_1db_mode, nhm_para.nhm_th0_manual); -+ -+ if (phydm_nhm_mntr_set(dm, &nhm_para)) -+ phydm_nhm_trigger(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "IGI=0x%x, rpt_stamp=%d\n", ccx->nhm_igi, -+ ccx->nhm_rpt_stamp); -+ -+ for (i = 0; i < NHM_TH_NUM; i++) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "NHM_th[%d] RSSI = %d\n", i, -+ NTH_TH_2_RSSI(ccx->nhm_th[i])); -+ } -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif /*@#ifdef NHM_SUPPORT*/ -+ -+#ifdef CLM_SUPPORT -+ -+void phydm_clm_racing_release(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "lv:(%d)->(0)\n", ccx->clm_set_lv); -+ -+ ccx->clm_ongoing = false; -+ ccx->clm_set_lv = CLM_RELEASE; -+ ccx->clm_app = CLM_BACKGROUND; -+} -+ -+u8 phydm_clm_racing_ctrl(void *dm_void, enum phydm_clm_level clm_lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 set_result = PHYDM_SET_SUCCESS; -+ /*@acquire to control CLM API*/ -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "clm_ongoing=%d, lv:(%d)->(%d)\n", -+ ccx->clm_ongoing, ccx->clm_set_lv, clm_lv); -+ if (ccx->clm_ongoing) { -+ if (clm_lv <= ccx->clm_set_lv) { -+ set_result = PHYDM_SET_FAIL; -+ } else { -+ phydm_ccx_hw_restart(dm); -+ ccx->clm_ongoing = false; -+ } -+ } -+ -+ if (set_result) -+ ccx->clm_set_lv = clm_lv; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "clm racing success=%d\n", set_result); -+ return set_result; -+} -+ -+void phydm_clm_c2h_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx_info = &dm->dm_ccx_info; -+ u8 clm_report = cmd_buf[0]; -+ /*@u8 clm_report_idx = cmd_buf[1];*/ -+ -+ if (cmd_len >= 12) -+ return; -+ -+ ccx_info->clm_fw_result_acc += clm_report; -+ ccx_info->clm_fw_result_cnt++; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%d] clm_report= %d\n", -+ ccx_info->clm_fw_result_cnt, clm_report); -+} -+ -+void phydm_clm_h2c(void *dm_void, u16 obs_time, u8 fw_clm_en) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 h2c_val[H2C_MAX_LENGTH] = {0}; -+ u8 i = 0; -+ u8 obs_time_idx = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "obs_time_index=%d *4 us\n", obs_time); -+ -+ for (i = 1; i <= 16; i++) { -+ if (obs_time & BIT(16 - i)) { -+ obs_time_idx = 16 - i; -+ break; -+ } -+ } -+#if 0 -+ obs_time = (2 ^ 16 - 1)~(2 ^ 15) => obs_time_idx = 15 (65535 ~32768) -+ obs_time = (2 ^ 15 - 1)~(2 ^ 14) => obs_time_idx = 14 -+ ... -+ ... -+ ... -+ obs_time = (2 ^ 1 - 1)~(2 ^ 0) => obs_time_idx = 0 -+ -+#endif -+ -+ h2c_val[0] = obs_time_idx | (((fw_clm_en) ? 1 : 0) << 7); -+ h2c_val[1] = CLM_MAX_REPORT_TIME; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "PHYDM h2c[0x4d]=0x%x %x %x %x %x %x %x\n", -+ h2c_val[6], h2c_val[5], h2c_val[4], h2c_val[3], h2c_val[2], -+ h2c_val[1], h2c_val[0]); -+ -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_FW_CLM_MNTR, H2C_MAX_LENGTH, h2c_val); -+} -+ -+void phydm_clm_setting(void *dm_void, u16 clm_period /*@4us sample 1 time*/) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ if (ccx->clm_period != clm_period) { -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ odm_set_bb_reg(dm, R_0x990, MASKLWORD, clm_period); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ odm_set_bb_reg(dm, R_0x1e40, MASKLWORD, clm_period); -+ #endif -+ else if (dm->support_ic_type & ODM_IC_11N_SERIES) -+ odm_set_bb_reg(dm, R_0x894, MASKLWORD, clm_period); -+ -+ ccx->clm_period = clm_period; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Update CLM period ((%d)) -> ((%d))\n", -+ ccx->clm_period, clm_period); -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Set CLM period=%d * 4us\n", -+ ccx->clm_period); -+} -+ -+void phydm_clm_trigger(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 reg1 = 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ reg1 = R_0x994; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ reg1 = R_0x1e60; -+ #endif -+ else -+ reg1 = R_0x890; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ odm_set_bb_reg(dm, reg1, BIT(0), 0x0); -+ odm_set_bb_reg(dm, reg1, BIT(0), 0x1); -+ -+ ccx->clm_trigger_time = dm->phydm_sys_up_time; -+ ccx->clm_rpt_stamp++; -+ ccx->clm_ongoing = true; -+} -+ -+boolean -+phydm_clm_check_rdy(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean is_ready = false; -+ u32 reg1 = 0, reg1_bit = 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ reg1 = R_0xfa4; -+ reg1_bit = 16; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ reg1 = R_0x2d88; -+ reg1_bit = 16; -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ if (dm->support_ic_type & (ODM_RTL8710B | ODM_RTL8721D | -+ ODM_RTL8710C)) { -+ reg1 = R_0x8b4; -+ reg1_bit = 24; -+ } else { -+ reg1 = R_0x8b4; -+ reg1_bit = 16; -+ } -+ } -+ if (odm_get_bb_reg(dm, reg1, BIT(reg1_bit))) -+ is_ready = true; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "CLM rdy=%d\n", is_ready); -+ -+ return is_ready; -+} -+ -+void phydm_clm_get_utility(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ if (ccx->clm_period == 0) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[warning] clm_period = 0\n"); -+ ccx->clm_ratio = 0; -+ } else { -+ ccx->clm_ratio = phydm_ccx_get_rpt_ratio(dm, ccx->clm_result, -+ ccx->clm_period); -+ } -+} -+ -+boolean -+phydm_clm_get_result(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx_info = &dm->dm_ccx_info; -+ u32 reg1 = 0; -+ u32 val = 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ reg1 = R_0x994; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ reg1 = R_0x1e60; -+ #endif -+ else -+ reg1 = R_0x890; -+ if ((dm->support_ic_type & ODM_IC_11N_SERIES) || -+ (dm->support_ic_type & ODM_IC_11AC_SERIES) || -+ (dm->support_ic_type & ODM_RTL8198F) || -+ (dm->support_ic_type & ODM_RTL8814B)) -+ odm_set_bb_reg(dm, reg1, BIT(0), 0x0); -+ -+ if (!(phydm_clm_check_rdy(dm))) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get CLM report Fail\n"); -+ phydm_clm_racing_release(dm); -+ return false; -+ } -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ val = odm_get_bb_reg(dm, R_0xfa4, MASKLWORD); -+ ccx_info->clm_result = (u16)val; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ val = odm_get_bb_reg(dm, R_0x2d88, MASKLWORD); -+ ccx_info->clm_result = (u16)val; -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ val = odm_get_bb_reg(dm, R_0x8d0, MASKLWORD); -+ ccx_info->clm_result = (u16)val; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "CLM result = %d *4 us\n", -+ ccx_info->clm_result); -+ phydm_clm_racing_release(dm); -+ return true; -+} -+ -+boolean -+phydm_clm_mntr_set(void *dm_void, struct clm_para_info *clm_para) -+{ -+ /*@Driver Monitor CLM*/ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u16 clm_period = 0; -+ -+ if (clm_para->mntr_time == 0) -+ return false; -+ -+ if (clm_para->clm_lv >= CLM_MAX_NUM) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[WARNING] Wrong LV=%d\n", -+ clm_para->clm_lv); -+ return false; -+ } -+ -+ if (phydm_clm_racing_ctrl(dm, clm_para->clm_lv) == PHYDM_SET_FAIL) -+ return false; -+ -+ if (clm_para->mntr_time >= 262) -+ clm_period = CLM_PERIOD_MAX; -+ else -+ clm_period = clm_para->mntr_time * MS_TO_4US_RATIO; -+ -+ ccx->clm_app = clm_para->clm_app; -+ phydm_clm_setting(dm, clm_period); -+ -+ return true; -+} -+ -+boolean -+phydm_clm_mntr_racing_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 sys_return_time = 0; -+ -+ if (ccx->clm_manual_ctrl) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "CLM in manual ctrl\n"); -+ return true; -+ } -+ -+ sys_return_time = ccx->clm_trigger_time + MAX_ENV_MNTR_TIME; -+ -+ if (ccx->clm_app != CLM_BACKGROUND && -+ (sys_return_time > dm->phydm_sys_up_time)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "clm_app=%d, trigger_time %d, sys_time=%d\n", -+ ccx->clm_app, ccx->clm_trigger_time, -+ dm->phydm_sys_up_time); -+ -+ return true; -+ } -+ -+ return false; -+} -+ -+boolean -+phydm_clm_mntr_chk(void *dm_void, u16 monitor_time /*unit ms*/) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ struct clm_para_info clm_para = {0}; -+ boolean clm_chk_result = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); -+ -+ if (phydm_clm_mntr_racing_chk(dm)) -+ return clm_chk_result; -+ -+ clm_para.clm_app = CLM_BACKGROUND; -+ clm_para.clm_lv = CLM_LV_1; -+ clm_para.mntr_time = monitor_time; -+ if (ccx->clm_mntr_mode == CLM_DRIVER_MNTR) { -+ if (phydm_clm_mntr_set(dm, &clm_para)) -+ clm_chk_result = true; -+ } else { -+ if (monitor_time >= 262) -+ ccx->clm_period = 65535; -+ else -+ ccx->clm_period = monitor_time * MS_TO_4US_RATIO; -+ -+ phydm_clm_h2c(dm, ccx->clm_period, true); -+ } -+ -+ return clm_chk_result; -+} -+ -+boolean -+phydm_clm_mntr_result(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean clm_chk_result = false; -+ u32 val = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); -+ -+ if (phydm_clm_mntr_racing_chk(dm)) -+ return clm_chk_result; -+ -+ if (ccx->clm_mntr_mode == CLM_DRIVER_MNTR) { -+ if (phydm_clm_get_result(dm)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get CLM_rpt success\n"); -+ phydm_clm_get_utility(dm); -+ if ((ccx->ccx_watchdog_result & NHM_SUCCESS) && -+ ((ccx->nhm_idle_ratio != ENV_MNTR_FAIL))) -+ ccx->nhm_tx_ratio = 100 - ccx->clm_ratio - -+ ccx->nhm_idle_ratio; -+ else -+ ccx->nhm_tx_ratio = ENV_MNTR_FAIL; -+ clm_chk_result = true; -+ } -+ } else { -+ if (ccx->clm_fw_result_cnt != 0) { -+ val = ccx->clm_fw_result_acc / ccx->clm_fw_result_cnt; -+ ccx->clm_ratio = (u8)val; -+ clm_chk_result = true; -+ } else { -+ ccx->clm_ratio = 0; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "clm_fw_result_acc=%d, clm_fw_result_cnt=%d\n", -+ ccx->clm_fw_result_acc, ccx->clm_fw_result_cnt); -+ -+ ccx->nhm_tx_ratio = ENV_MNTR_FAIL; -+ ccx->clm_fw_result_acc = 0; -+ ccx->clm_fw_result_cnt = 0; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "clm_ratio=%d\n", ccx->clm_ratio); -+ -+ return clm_chk_result; -+} -+ -+void phydm_set_clm_mntr_mode(void *dm_void, enum clm_monitor_mode mode) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx_info = &dm->dm_ccx_info; -+ -+ if (ccx_info->clm_mntr_mode != mode) { -+ ccx_info->clm_mntr_mode = mode; -+ phydm_ccx_hw_restart(dm); -+ -+ if (mode == CLM_DRIVER_MNTR) -+ phydm_clm_h2c(dm, CLM_PERIOD_MAX, 0); -+ } -+} -+ -+void phydm_clm_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ ccx->clm_ongoing = false; -+ ccx->clm_manual_ctrl = 0; -+ ccx->clm_mntr_mode = CLM_DRIVER_MNTR; -+ ccx->clm_period = 0; -+ ccx->clm_rpt_stamp = 0; -+ phydm_clm_setting(dm, 65535); -+} -+ -+void phydm_clm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ struct clm_para_info clm_para = {0}; -+ u32 i; -+ -+ for (i = 0; i < 4; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "CLM Driver Basic-Trigger 262ms: {1}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "CLM Driver Adv-Trigger: {2} {app} {LV} {0~262ms}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "CLM FW Trigger: {3} {1:drv, 2:fw}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "CLM Get Result: {100}\n"); -+ } else if (var1[0] == 100) { /* @Get CLM results */ -+ -+ if (phydm_clm_get_result(dm)) -+ phydm_clm_get_utility(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "clm_rpt_stamp=%d\n", ccx->clm_rpt_stamp); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "clm_ratio:((%d percent)) = (%d us/ %d us)\n", -+ ccx->clm_ratio, ccx->clm_result << 2, -+ ccx->clm_period << 2); -+ -+ ccx->clm_manual_ctrl = 0; -+ } else if (var1[0] == 3) { -+ phydm_set_clm_mntr_mode(dm, (enum clm_monitor_mode)var1[1]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "CLM mode: %s mode\n", -+ ((ccx->clm_mntr_mode == CLM_FW_MNTR) ? "FW" : "Drv")); -+ } else { /* Set & trigger CLM */ -+ ccx->clm_manual_ctrl = 1; -+ -+ if (var1[0] == 1) { -+ clm_para.clm_app = CLM_BACKGROUND; -+ clm_para.clm_lv = CLM_LV_4; -+ clm_para.mntr_time = 262; -+ ccx->clm_mntr_mode = CLM_DRIVER_MNTR; -+ } else if (var1[0] == 2) { -+ clm_para.clm_app = (enum clm_application)var1[1]; -+ clm_para.clm_lv = (enum phydm_clm_level)var1[2]; -+ ccx->clm_mntr_mode = CLM_DRIVER_MNTR; -+ clm_para.mntr_time = (u16)var1[3]; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "app=%d, lv=%d, mode=%s, time=%d ms\n", -+ clm_para.clm_app, clm_para.clm_lv, -+ ((ccx->clm_mntr_mode == CLM_FW_MNTR) ? "FW" : -+ "driver"), clm_para.mntr_time); -+ -+ if (phydm_clm_mntr_set(dm, &clm_para)) -+ phydm_clm_trigger(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "clm_rpt_stamp=%d\n", ccx->clm_rpt_stamp); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif /*@#ifdef CLM_SUPPORT*/ -+ -+u8 phydm_env_mntr_trigger(void *dm_void, struct nhm_para_info *nhm_para, -+ struct clm_para_info *clm_para, -+ struct env_trig_rpt *trig_rpt) -+{ -+ u8 trigger_result = 0; -+#if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT)) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean nhm_set_ok = false; -+ boolean clm_set_ok = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); -+ -+ /*@[NHM]*/ -+ nhm_set_ok = phydm_nhm_mntr_set(dm, nhm_para); -+ -+ /*@[CLM]*/ -+ if (ccx->clm_mntr_mode == CLM_DRIVER_MNTR) { -+ clm_set_ok = phydm_clm_mntr_set(dm, clm_para); -+ } else if (ccx->clm_mntr_mode == CLM_FW_MNTR) { -+ phydm_clm_h2c(dm, CLM_PERIOD_MAX, true); -+ trigger_result |= CLM_SUCCESS; -+ } -+ -+ if (nhm_set_ok) { -+ phydm_nhm_trigger(dm); -+ trigger_result |= NHM_SUCCESS; -+ } -+ -+ if (clm_set_ok) { -+ phydm_clm_trigger(dm); -+ trigger_result |= CLM_SUCCESS; -+ } -+ -+ /*@monitor for the test duration*/ -+ ccx->start_time = odm_get_current_time(dm); -+ -+ trig_rpt->nhm_rpt_stamp = ccx->nhm_rpt_stamp; -+ trig_rpt->clm_rpt_stamp = ccx->clm_rpt_stamp; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "nhm_rpt_stamp=%d, clm_rpt_stamp=%d,\n\n", -+ trig_rpt->nhm_rpt_stamp, trig_rpt->clm_rpt_stamp); -+#endif -+ return trigger_result; -+} -+ -+u8 phydm_env_mntr_result(void *dm_void, struct env_mntr_rpt *rpt) -+{ -+ u8 env_mntr_rpt = 0; -+#if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT)) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u64 progressing_time = 0; -+ u32 val_tmp = 0; -+ -+ /*@monitor for the test duration*/ -+ progressing_time = odm_get_progressing_time(dm, ccx->start_time); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "env_time=%lld\n", progressing_time); -+ -+ /*@Get NHM result*/ -+ if (phydm_nhm_get_result(dm)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get NHM_rpt success\n"); -+ phydm_nhm_get_utility(dm); -+ rpt->nhm_ratio = ccx->nhm_ratio; -+ rpt->nhm_env_ratio = ccx->nhm_env_ratio; -+ rpt->nhm_idle_ratio = ccx->nhm_idle_ratio; -+ rpt->nhm_noise_pwr = ccx->nhm_level; -+ rpt->nhm_pwr = ccx->nhm_pwr; -+ env_mntr_rpt |= NHM_SUCCESS; -+ -+ odm_move_memory(dm, &rpt->nhm_result[0], -+ &ccx->nhm_result[0], NHM_RPT_NUM); -+ } else { -+ rpt->nhm_ratio = ENV_MNTR_FAIL; -+ rpt->nhm_env_ratio = ENV_MNTR_FAIL; -+ rpt->nhm_idle_ratio = ENV_MNTR_FAIL; -+ } -+ -+ /*@Get CLM result*/ -+ if (ccx->clm_mntr_mode == CLM_DRIVER_MNTR) { -+ if (phydm_clm_get_result(dm)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get CLM_rpt success\n"); -+ phydm_clm_get_utility(dm); -+ env_mntr_rpt |= CLM_SUCCESS; -+ rpt->clm_ratio = ccx->clm_ratio; -+ if ((env_mntr_rpt & NHM_SUCCESS) && -+ (rpt->nhm_idle_ratio != ENV_MNTR_FAIL)) -+ rpt->nhm_tx_ratio = 100 - rpt->clm_ratio - -+ rpt->nhm_idle_ratio; -+ else -+ rpt->nhm_tx_ratio = ENV_MNTR_FAIL; -+ } else { -+ rpt->clm_ratio = ENV_MNTR_FAIL; -+ rpt->nhm_tx_ratio = ENV_MNTR_FAIL; -+ } -+ } else { -+ if (ccx->clm_fw_result_cnt != 0) { -+ val_tmp = ccx->clm_fw_result_acc -+ / ccx->clm_fw_result_cnt; -+ ccx->clm_ratio = (u8)val_tmp; -+ } else { -+ ccx->clm_ratio = 0; -+ } -+ -+ rpt->clm_ratio = ccx->clm_ratio; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "clm_fw_result_acc=%d, clm_fw_result_cnt=%d\n", -+ ccx->clm_fw_result_acc, ccx->clm_fw_result_cnt); -+ -+ rpt->nhm_tx_ratio = ENV_MNTR_FAIL; -+ ccx->clm_fw_result_acc = 0; -+ ccx->clm_fw_result_cnt = 0; -+ env_mntr_rpt |= CLM_SUCCESS; -+ } -+ -+ rpt->nhm_rpt_stamp = ccx->nhm_rpt_stamp; -+ rpt->clm_rpt_stamp = ccx->clm_rpt_stamp; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "IGI=0x%x, nhm_ratio=%d, nhm_env_ratio=%d, clm_ratio=%d, nhm_rpt_stamp=%d, clm_rpt_stamp=%d\n\n", -+ ccx->nhm_igi, rpt->nhm_ratio, rpt->nhm_env_ratio, -+ rpt->clm_ratio, rpt->nhm_rpt_stamp, rpt->clm_rpt_stamp); -+#endif -+ return env_mntr_rpt; -+} -+ -+void phydm_env_mntr_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ struct clm_para_info clm_para = {0}; -+ struct nhm_para_info nhm_para = {0}; -+ struct env_mntr_rpt rpt = {0}; -+ struct env_trig_rpt trig_rpt = {0}; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 set_result = 0; -+ u8 i = 0; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Basic-Trigger 262ms: {1}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Get Result: {100}\n"); -+ } else if (var1[0] == 100) { /* Get results */ -+ set_result = phydm_env_mntr_result(dm, &rpt); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set Result=%d\n nhm_ratio=%d nhm_env_ratio=%d clm_ratio=%d\n nhm_rpt_stamp=%d, clm_rpt_stamp=%d,\n", -+ set_result, rpt.nhm_ratio, rpt.nhm_env_ratio, -+ rpt.clm_ratio, rpt.nhm_rpt_stamp, rpt.clm_rpt_stamp); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "nhm_idle_ratio=%d, nhm_tx_ratio=%d\n", -+ rpt.nhm_idle_ratio, rpt.nhm_tx_ratio); -+ for (i = 0; i <= 11; i++) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "nhm_rpt[%d] = %d (%d percent)\n", i, -+ rpt.nhm_result[i], -+ (((rpt.nhm_result[i] * 100) + 128) >> 8)); -+ } -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[NHM] valid: %d percent, noise(RSSI) = %d\n", -+ ccx->nhm_level_valid, ccx->nhm_level); -+ } else { /* Set & trigger*/ -+ /*nhm para*/ -+ nhm_para.incld_txon = NHM_EXCLUDE_TXON; -+ nhm_para.incld_cca = NHM_EXCLUDE_CCA; -+ nhm_para.div_opt = NHM_CNT_ALL; -+ nhm_para.nhm_app = NHM_ACS; -+ nhm_para.nhm_lv = NHM_LV_2; -+ nhm_para.mntr_time = 262; -+ nhm_para.en_1db_mode = false; -+ -+ /*clm para*/ -+ clm_para.clm_app = CLM_ACS; -+ clm_para.clm_lv = CLM_LV_2; -+ clm_para.mntr_time = 262; -+ -+ set_result = phydm_env_mntr_trigger(dm, &nhm_para, -+ &clm_para, &trig_rpt); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set Result=%d, nhm_rpt_stamp=%d, clm_rpt_stamp=%d\n", -+ set_result, trig_rpt.nhm_rpt_stamp, -+ trig_rpt.clm_rpt_stamp); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#ifdef FAHM_SUPPORT -+ -+void phydm_fahm_racing_release(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 value32 = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "fahm_racing_release : lv:(%d)->(0)\n", -+ ccx->fahm_set_lv); -+ -+ ccx->fahm_ongoing = false; -+ ccx->fahm_set_lv = FAHM_RELEASE; -+ -+ if (!(ccx->fahm_app == FAHM_BACKGROUND || ccx->fahm_app == FAHM_ACS)) -+ phydm_pause_func(dm, F00_DIG, PHYDM_RESUME, -+ PHYDM_PAUSE_LEVEL_1, 1, &value32); -+ -+ ccx->fahm_app = FAHM_BACKGROUND; -+} -+ -+u8 phydm_fahm_racing_ctrl(void *dm_void, enum phydm_fahm_level lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 set_result = PHYDM_SET_SUCCESS; -+ /*acquire to control FAHM API*/ -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "fahm_ongoing=%d, lv:(%d)->(%d)\n", -+ ccx->fahm_ongoing, ccx->fahm_set_lv, lv); -+ if (ccx->fahm_ongoing) { -+ if (lv <= ccx->fahm_set_lv) { -+ set_result = PHYDM_SET_FAIL; -+ } else { -+ phydm_ccx_hw_restart(dm); -+ ccx->fahm_ongoing = false; -+ } -+ } -+ -+ if (set_result) -+ ccx->fahm_set_lv = lv; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "fahm racing success=%d\n", set_result); -+ return set_result; -+} -+ -+void phydm_fahm_trigger(void *dm_void) -+{ /*@unit (4us)*/ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 reg = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ switch (dm->ic_ip_series) { -+ case PHYDM_IC_JGR3: -+ reg = R_0x1e60; -+ break; -+ case PHYDM_IC_AC: -+ reg = R_0x994; -+ break; -+ case PHYDM_IC_N: -+ reg = R_0x890; -+ break; -+ default: -+ break; -+ } -+ -+ odm_set_bb_reg(dm, reg, BIT(2), 0); -+ odm_set_bb_reg(dm, reg, BIT(2), 1); -+ -+ ccx->fahm_trigger_time = dm->phydm_sys_up_time; -+ ccx->fahm_rpt_stamp++; -+ ccx->fahm_ongoing = true; -+} -+ -+boolean -+phydm_fahm_check_rdy(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean is_ready = false; -+ u32 reg = 0, reg_bit = 0; -+ -+ switch (dm->ic_ip_series) { -+ case PHYDM_IC_JGR3: -+ reg = R_0x2d84; -+ reg_bit = 31; -+ break; -+ case PHYDM_IC_AC: -+ reg = R_0x1f98; -+ reg_bit = 31; -+ break; -+ case PHYDM_IC_N: -+ reg = R_0x9f0; -+ reg_bit = 31; -+ break; -+ default: -+ break; -+ } -+ -+ if (odm_get_bb_reg(dm, reg, BIT(reg_bit))) -+ is_ready = true; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "FAHM rdy=%d\n", is_ready); -+ -+ return is_ready; -+} -+ -+u8 phydm_fahm_cal_wgt_avg(void *dm_void, u8 start_i, u8 end_i, u16 r_sum, -+ u16 period) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 i = 0; -+ u32 pwr_tmp = 0; -+ u8 pwr = 0; -+ u32 fahm_valid = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (r_sum == 0) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "rpt_sum = 0, don't need to update\n"); -+ return 0x0; -+ } else if (end_i > FAHM_RPT_NUM - 1) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[WARNING]end_i is larger than 11!!\n"); -+ return 0x0; -+ } -+ -+ for (i = start_i; i <= end_i; i++) { -+ if (i == 0) -+ pwr_tmp += ccx->fahm_result[0] * -+ MAX_2(ccx->fahm_th[0] - 2, 0); -+ else if (i == (FAHM_RPT_NUM - 1)) -+ pwr_tmp += ccx->fahm_result[FAHM_RPT_NUM - 1] * -+ (ccx->fahm_th[FAHM_TH_NUM - 1] + 2); -+ else -+ pwr_tmp += ccx->fahm_result[i] * -+ (ccx->fahm_th[i - 1] + ccx->fahm_th[i]) >> 1; -+ } -+ -+ /* protection for the case of minus pwr(RSSI)*/ -+ pwr = (u8)(NTH_TH_2_RSSI(MAX_2(PHYDM_DIV(pwr_tmp, r_sum), 20))); -+ fahm_valid = PHYDM_DIV(r_sum * 100, period); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "valid: ((%d)) percent, pwr(RSSI)=((%d))\n", -+ fahm_valid, pwr); -+ -+ return pwr; -+} -+ -+void phydm_fahm_get_utility(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ if (ccx->fahm_result_sum >= ccx->fahm_result[0]) { -+ ccx->fahm_pwr = phydm_fahm_cal_wgt_avg(dm, 0, FAHM_RPT_NUM - 1, -+ ccx->fahm_result_sum, -+ ccx->fahm_period); -+ ccx->fahm_ratio = phydm_ccx_get_rpt_ratio(dm, -+ ccx->fahm_result_sum, ccx->fahm_period); -+ ccx->fahm_denom_ratio = phydm_ccx_get_rpt_ratio(dm, -+ ccx->fahm_denom_result, -+ ccx->fahm_period); -+ } else { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[warning] fahm_result_sum invalid\n"); -+ ccx->fahm_pwr = 0; -+ ccx->fahm_ratio = 0; -+ ccx->fahm_denom_ratio = 0; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "fahm_pwr=%d, fahm_ratio=%d, fahm_denom_ratio=%d\n", -+ ccx->fahm_pwr, ccx->fahm_ratio, ccx->fahm_denom_ratio); -+} -+ -+boolean -+phydm_fahm_get_result(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 value32 = 0; -+ u32 reg1 = 0; -+ u32 reg2 = 0; -+ u8 i = 0; -+ u32 fahm_rpt_sum_tmp = 0; -+ -+ switch (dm->ic_ip_series) { -+ case PHYDM_IC_JGR3: -+ reg1 = R_0x2d6c; -+ reg2 = R_0x2d84; -+ break; -+ case PHYDM_IC_AC: -+ reg1 = R_0x1f80; -+ reg2 = R_0x1f98; -+ break; -+ case PHYDM_IC_N: -+ reg1 = R_0x9d8; -+ reg2 = R_0x9f0; -+ break; -+ default: -+ break; -+ } -+ -+ if (!(phydm_fahm_check_rdy(dm))) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get FAHM report Fail\n"); -+ phydm_fahm_racing_release(dm); -+ return false; -+ } -+ -+ /*Get FAHM numerator and sum all fahm_result*/ -+ for (i = 0; i < 6; i++) { -+ value32 = odm_get_bb_reg(dm, reg1 + (i << 2), MASKDWORD); -+ ccx->fahm_result[i * 2] = (u16)(value32 & MASKLWORD); -+ ccx->fahm_result[i * 2 + 1] = (u16)((value32 & MASKHWORD) >> 16); -+ fahm_rpt_sum_tmp = (u32)(fahm_rpt_sum_tmp + -+ ccx->fahm_result[i * 2] + -+ ccx->fahm_result[i * 2 + 1]); -+ } -+ ccx->fahm_result_sum = (u16)fahm_rpt_sum_tmp; -+ -+ /*Get FAHM Denominator*/ -+ ccx->fahm_denom_result = (u16)odm_get_bb_reg(dm, reg2, MASKLWORD); -+ -+ if (!(ccx->fahm_inclu_cck)) -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "===>The following fahm report does not count CCK pkt\n"); -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "fahm_result_sum=%d, fahm_denom_result = %d\n", -+ ccx->fahm_result_sum, ccx->fahm_denom_result); -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "FAHM_Rpt[%d](H->L)[%d %d %d %d %d %d %d %d %d %d %d %d]\n", -+ ccx->fahm_rpt_stamp, ccx->fahm_result[11], -+ ccx->fahm_result[10], ccx->fahm_result[9], -+ ccx->fahm_result[8], ccx->fahm_result[7], ccx->fahm_result[6], -+ ccx->fahm_result[5], ccx->fahm_result[4], ccx->fahm_result[3], -+ ccx->fahm_result[2], ccx->fahm_result[1], -+ ccx->fahm_result[0]); -+ -+ phydm_fahm_racing_release(dm); -+ -+ if (fahm_rpt_sum_tmp > 0xffff) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[Warning] Invalid FAHM RPT, total=%d\n", -+ fahm_rpt_sum_tmp); -+ return false; -+ } -+ -+ return true; -+} -+ -+void phydm_fahm_set_th_reg(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 val = 0; -+ -+ /*Set FAHM threshold*/ /*Unit: PWdB U(8,1)*/ -+ switch (dm->ic_ip_series) { -+ case PHYDM_IC_JGR3: -+ val = BYTE_2_DWORD(ccx->fahm_th[3], ccx->fahm_th[2], -+ ccx->fahm_th[1], ccx->fahm_th[0]); -+ odm_set_bb_reg(dm, R_0x1e50, MASKDWORD, val); -+ val = BYTE_2_DWORD(ccx->fahm_th[7], ccx->fahm_th[6], -+ ccx->fahm_th[5], ccx->fahm_th[4]); -+ odm_set_bb_reg(dm, R_0x1e54, MASKDWORD, val); -+ val = BYTE_2_DWORD(0, ccx->fahm_th[10], ccx->fahm_th[9], -+ ccx->fahm_th[8]); -+ odm_set_bb_reg(dm, R_0x1e58, 0xffffff, val); -+ break; -+ case PHYDM_IC_AC: -+ val = BYTE_2_DWORD(0, ccx->fahm_th[2], ccx->fahm_th[1], -+ ccx->fahm_th[0]); -+ odm_set_bb_reg(dm, R_0x1c38, 0xffffff00, val); -+ val = BYTE_2_DWORD(0, ccx->fahm_th[5], ccx->fahm_th[4], -+ ccx->fahm_th[3]); -+ odm_set_bb_reg(dm, R_0x1c78, 0xffffff00, val); -+ val = BYTE_2_DWORD(0, 0, ccx->fahm_th[7], ccx->fahm_th[6]); -+ odm_set_bb_reg(dm, R_0x1c7c, 0xffff0000, val); -+ val = BYTE_2_DWORD(0, ccx->fahm_th[10], ccx->fahm_th[9], -+ ccx->fahm_th[8]); -+ odm_set_bb_reg(dm, R_0x1cb8, 0xffffff00, val); -+ break; -+ case PHYDM_IC_N: -+ val = BYTE_2_DWORD(ccx->fahm_th[3], ccx->fahm_th[2], -+ ccx->fahm_th[1], ccx->fahm_th[0]); -+ odm_set_bb_reg(dm, R_0x970, MASKDWORD, val); -+ val = BYTE_2_DWORD(ccx->fahm_th[7], ccx->fahm_th[6], -+ ccx->fahm_th[5], ccx->fahm_th[4]); -+ odm_set_bb_reg(dm, R_0x974, MASKDWORD, val); -+ val = BYTE_2_DWORD(0, ccx->fahm_th[10], ccx->fahm_th[9], -+ ccx->fahm_th[8]); -+ odm_set_bb_reg(dm, R_0x978, 0xffffff, val); -+ break; -+ default: -+ break; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Update FAHM_th[H->L]=[%d %d %d %d %d %d %d %d %d %d %d]\n", -+ ccx->fahm_th[10], ccx->fahm_th[9], ccx->fahm_th[8], -+ ccx->fahm_th[7], ccx->fahm_th[6], ccx->fahm_th[5], -+ ccx->fahm_th[4], ccx->fahm_th[3], ccx->fahm_th[2], -+ ccx->fahm_th[1], ccx->fahm_th[0]); -+} -+ -+boolean -+phydm_fahm_th_update_chk(void *dm_void, enum fahm_application fahm_app, -+ u8 *fahm_th, u32 *igi_new, boolean en_1db_mode, -+ u8 fahm_th0_manual) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean is_update = false; -+ u8 igi_curr = phydm_get_igi(dm, BB_PATH_A); -+ u8 i = 0; -+ u8 th_tmp = igi_curr - CCA_CAP; -+ u8 th_step = 2; -+ u8 fahm_igi_th_11k[NHM_TH_NUM] = {0x12, 0x15, 0x18, 0x1b, 0x1e, 0x23, -+ 0x28, 0x2d, 0x32, 0x37, 0x3c}; -+ /*11k_dbm : {-92, -89, -86, -83, -80, -75, -70, -65, -60, -55, -50};*/ -+ /*11k_gain_idx : {18, 21, 24, 27, 30, 35, 40, 45, 50, 55, 60};*/ -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "fahm_th_update_chk : App=%d, fahm_igi=0x%x, igi_curr=0x%x\n", -+ fahm_app, ccx->fahm_igi, igi_curr); -+ -+ if (igi_curr < 0x10) /* Protect for invalid IGI*/ -+ return false; -+ -+ switch (fahm_app) { -+ case FAHM_BACKGROUND: /*Get IGI from driver parameter(cur_ig_value)*/ -+ if (ccx->fahm_igi != igi_curr || ccx->fahm_app != fahm_app) { -+ is_update = true; -+ *igi_new = (u32)igi_curr; -+ -+ fahm_th[0] = (u8)IGI_2_NHM_TH(th_tmp); -+ -+ for (i = 1; i <= 10; i++) -+ fahm_th[i] = fahm_th[0] + -+ IGI_2_NHM_TH(th_step * i); -+ -+ } -+ break; -+ case FAHM_ACS: -+ if (ccx->fahm_igi != igi_curr || ccx->fahm_app != fahm_app) { -+ is_update = true; -+ *igi_new = (u32)igi_curr; -+ for (i = 0; i < FAHM_TH_NUM; i++) -+ fahm_th[i] = IGI_2_NHM_TH(fahm_igi_th_11k[i]); -+ } -+ break; -+ case FAHM_DBG: /*Get IGI from register*/ -+ igi_curr = phydm_get_igi(dm, BB_PATH_A); -+ if (ccx->fahm_igi != igi_curr || ccx->fahm_app != fahm_app) { -+ is_update = true; -+ *igi_new = (u32)igi_curr; -+ if (en_1db_mode) { -+ fahm_th[0] = (u8)IGI_2_NHM_TH(fahm_th0_manual + -+ 10); -+ th_step = 1; -+ } else { -+ fahm_th[0] = (u8)IGI_2_NHM_TH(igi_curr - -+ CCA_CAP); -+ } -+ -+ for (i = 1; i <= 10; i++) -+ fahm_th[i] = fahm_th[0] + -+ IGI_2_NHM_TH(th_step * i); -+ } -+ break; -+ } -+ -+ if (is_update) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[Update FAHM_TH] igi_RSSI=%d\n", -+ IGI_2_RSSI(*igi_new)); -+ -+ for (i = 0; i < FAHM_TH_NUM; i++) -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "FAHM_th[%d](RSSI) = %d\n", -+ i, NTH_TH_2_RSSI(fahm_th[i])); -+ } else { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "No need to update FAHM_TH\n"); -+ } -+ return is_update; -+} -+ -+void phydm_fahm_set(void *dm_void, u8 numer_opt, u8 denom_opt, -+ enum fahm_application app, u16 period, boolean en_1db_mode, -+ u8 th0_manual) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 fahm_th[FAHM_TH_NUM] = {0}; -+ u32 igi = 0x20; -+ u32 reg1 = 0, reg2 = 0, reg3 = 0; -+ u32 val_tmp = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "numer_opt=%d, denom_opt=%d, period=%d\n", -+ numer_opt, denom_opt, period); -+ -+ switch (dm->ic_ip_series) { -+ case PHYDM_IC_JGR3: -+ reg1 = R_0x1e60; -+ reg2 = R_0x1e58; -+ reg3 = R_0x1e5c; -+ break; -+ case PHYDM_IC_AC: -+ reg1 = R_0x994; -+ reg2 = R_0x1cf8; -+ break; -+ case PHYDM_IC_N: -+ reg1 = R_0x890; -+ reg2 = R_0x978; -+ reg3 = R_0x97c; -+ break; -+ default: -+ break; -+ } -+ -+ /*Set enable fa, ignore crc32 ok, ignore crc32 err*/ -+ if (numer_opt != ccx->fahm_numer_opt || -+ denom_opt != ccx->fahm_denom_opt) { -+ odm_set_bb_reg(dm, reg1, 0xe0, numer_opt); -+ odm_set_bb_reg(dm, reg1, 0x7000, denom_opt); -+ ccx->fahm_numer_opt = numer_opt; -+ ccx->fahm_denom_opt = denom_opt; -+ -+ /*[PHYDM-400]*/ -+ /*Counting B mode pkt for new B mode IP or fahm_opt is non-FA*/ -+ if ((dm->support_ic_type & ODM_RTL8723F) || -+ (((numer_opt | denom_opt) & FAHM_INCLU_FA) == 0)) -+ ccx->fahm_inclu_cck = true; -+ else -+ ccx->fahm_inclu_cck = false; -+ -+ odm_set_bb_reg(dm, reg1, BIT(4), ccx->fahm_inclu_cck); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "fahm_inclu_cck=%d\n", -+ ccx->fahm_inclu_cck); -+ } -+ -+ /*Set FAHM period*/ -+ if (period != ccx->fahm_period) { -+ switch (dm->ic_ip_series) { -+ case PHYDM_IC_AC: -+ odm_set_bb_reg(dm, reg2, 0xffff00, period); -+ break; -+ case PHYDM_IC_JGR3: -+ case PHYDM_IC_N: -+ odm_set_bb_reg(dm, reg2, 0xff000000, (period & 0xff)); -+ odm_set_bb_reg(dm, reg3, 0xff, (period & 0xff00) >> 8); -+ break; -+ default: -+ break; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Update FAHM period ((%d)) -> ((%d))\n", -+ ccx->fahm_period, period); -+ -+ ccx->fahm_period = period; -+ } -+ -+ /*Set FAHM threshold*/ -+ if (phydm_fahm_th_update_chk(dm, app, &fahm_th[0], &igi, en_1db_mode, -+ th0_manual)) { -+ /*Pause IGI*/ -+ if (app == FAHM_BACKGROUND || app == FAHM_ACS) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "DIG Free Run\n"); -+ } else if (phydm_pause_func(dm, F00_DIG, PHYDM_PAUSE, -+ PHYDM_PAUSE_LEVEL_1, 1, &igi) -+ == PAUSE_FAIL) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "pause DIG Fail\n"); -+ return; -+ } else { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "pause DIG=0x%x\n", igi); -+ } -+ ccx->fahm_app = app; -+ ccx->fahm_igi = (u8)igi; -+ odm_move_memory(dm, &ccx->fahm_th[0], &fahm_th, FAHM_TH_NUM); -+ -+ /*Set FAHM th*/ -+ phydm_fahm_set_th_reg(dm); -+ } -+} -+ -+boolean -+phydm_fahm_mntr_set(void *dm_void, struct fahm_para_info *para) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 fahm_time = 0; /*unit: 4us*/ -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (para->mntr_time == 0) -+ return false; -+ -+ if (para->lv >= FAHM_MAX_NUM) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Wrong LV=%d\n", para->lv); -+ return false; -+ } -+ -+ if (phydm_fahm_racing_ctrl(dm, para->lv) == PHYDM_SET_FAIL) -+ return false; -+ -+ if (para->mntr_time >= 262) -+ fahm_time = FAHM_PERIOD_MAX; -+ else -+ fahm_time = para->mntr_time * MS_TO_4US_RATIO; -+ -+ phydm_fahm_set(dm, para->numer_opt, para->denom_opt, para->app, -+ fahm_time, para->en_1db_mode, para->th0_manual); -+ -+ return true; -+} -+ -+boolean -+phydm_fahm_mntr_racing_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 sys_return_time = 0; -+ -+ if (ccx->fahm_manual_ctrl) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "FAHM in manual ctrl\n"); -+ return true; -+ } -+ -+ sys_return_time = ccx->fahm_trigger_time + MAX_ENV_MNTR_TIME; -+ -+ if (ccx->fahm_app != FAHM_BACKGROUND && -+ (sys_return_time > dm->phydm_sys_up_time)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "fahm_app=%d, trigger_time %d, sys_time=%d\n", -+ ccx->fahm_app, ccx->fahm_trigger_time, -+ dm->phydm_sys_up_time); -+ -+ return true; -+ } -+ -+ return false; -+} -+ -+boolean -+phydm_fahm_mntr_chk(void *dm_void, u16 monitor_time /*unit ms*/) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ struct fahm_para_info para = {0}; -+ boolean fahm_chk_result = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (phydm_fahm_mntr_racing_chk(dm)) -+ return fahm_chk_result; -+ -+ /*[FAHM trigger setting]------------------------------------------*/ -+ para.numer_opt = FAHM_INCLU_FA; -+ para.denom_opt = FAHM_INCLU_CRC_ERR; -+ para.app = FAHM_BACKGROUND; -+ para.lv = FAHM_LV_1; -+ para.en_1db_mode = false; -+ para.mntr_time = monitor_time; -+ -+ fahm_chk_result = phydm_fahm_mntr_set(dm, ¶); -+ -+ return fahm_chk_result; -+} -+ -+boolean -+phydm_fahm_mntr_result(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean fahm_chk_result = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (phydm_fahm_mntr_racing_chk(dm)) -+ return fahm_chk_result; -+ -+ /*[FAHM get result & calculate Utility]---------------------------*/ -+ if (phydm_fahm_get_result(dm)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get FAHM_rpt success\n"); -+ phydm_fahm_get_utility(dm); -+ fahm_chk_result = true; -+ } -+ -+ return fahm_chk_result; -+} -+ -+void phydm_fahm_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 reg = 0; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_FAHM)) -+ return; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ ccx->fahm_app = FAHM_BACKGROUND; -+ ccx->fahm_igi = 0xff; -+ -+ /*Set FAHM threshold*/ -+ ccx->fahm_ongoing = false; -+ ccx->fahm_set_lv = FAHM_RELEASE; -+ -+ if (phydm_fahm_th_update_chk(dm, ccx->fahm_app, &ccx->fahm_th[0], -+ (u32 *)&ccx->fahm_igi, false, 0)) -+ phydm_fahm_set_th_reg(dm); -+ -+ ccx->fahm_period = 0; -+ ccx->fahm_numer_opt = 0; -+ ccx->fahm_denom_opt = 0; -+ ccx->fahm_manual_ctrl = 0; -+ ccx->fahm_rpt_stamp = 0; -+ ccx->fahm_inclu_cck = false; -+ -+ switch (dm->ic_ip_series) { -+ case PHYDM_IC_JGR3: -+ reg = R_0x1e60; -+ break; -+ case PHYDM_IC_AC: -+ reg = R_0x994; -+ break; -+ case PHYDM_IC_N: -+ reg = R_0x890; -+ break; -+ default: -+ break; -+ } -+ -+ /*Counting OFDM pkt*/ -+ odm_set_bb_reg(dm, reg, BIT(3), 1); -+} -+ -+void phydm_fahm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ struct fahm_para_info para = {0}; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u16 result_tmp = 0; -+ u8 i = 0; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_FAHM)) -+ return; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "FAHM Basic-Trigger 262ms: {1}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "FAHM Adv-Trigger: {2} {numer_opt} {denom_opt}\n {App:1 for dbg} {LV:1~4} {0~262ms}, 1dB mode :{en} {t[0](RSSI)}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "FAHM Get Result: {100}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "numer_opt/denom_opt: {BIT 0/1/2} = {FA/CRC32_OK/CRC32_ERR}\n"); -+ } else if (var1[0] == 100) { /*Get FAHM results*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "IGI=0x%x, rpt_stamp=%d\n", ccx->fahm_igi, -+ ccx->fahm_rpt_stamp); -+ -+ if (phydm_fahm_get_result(dm)) { -+ if (!(ccx->fahm_inclu_cck)) -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "===>The following fahm report does not count CCK pkt\n"); -+ -+ for (i = 0; i < FAHM_RPT_NUM; i++) { -+ result_tmp = ccx->fahm_result[i]; -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "fahm_rpt[%d] = %d (%d percent)\n", -+ i, result_tmp, -+ (((result_tmp * 100) + 32768) >> 16)); -+ } -+ phydm_fahm_get_utility(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fahm_pwr=%d, fahm_ratio=%d, fahm_denom_ratio=%d\n", -+ ccx->fahm_pwr, ccx->fahm_ratio, -+ ccx->fahm_denom_ratio); -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Get FAHM_rpt Fail\n"); -+ } -+ ccx->fahm_manual_ctrl = 0; -+ } else { /*FAMH trigger*/ -+ ccx->fahm_manual_ctrl = 1; -+ -+ for (i = 1; i < 9; i++) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ -+ if (var1[0] == 1) { -+ para.numer_opt = FAHM_INCLU_FA; -+ para.denom_opt = FAHM_INCLU_CRC_ERR; -+ para.app = FAHM_DBG; -+ para.lv = FAHM_LV_4; -+ para.mntr_time = 262; -+ para.en_1db_mode = false; -+ para.th0_manual = 0; -+ } else { -+ para.numer_opt = (u8)var1[1]; -+ para.denom_opt = (u8)var1[2]; -+ para.app = (enum fahm_application)var1[3]; -+ para.lv = (enum phydm_fahm_level)var1[4]; -+ para.mntr_time = (u16)var1[5]; -+ para.en_1db_mode = (boolean)var1[6]; -+ para.th0_manual = (u8)var1[7]; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "numer_opt=%d, denom_opt=%d, app=%d, lv=%d, time=%d ms\n", -+ para.numer_opt, para.denom_opt,para.app, para.lv, -+ para.mntr_time); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "en_1db_mode=%d, th0(for 1db mode)=%d\n", -+ para.en_1db_mode, para.th0_manual); -+ -+ if (phydm_fahm_mntr_set(dm, ¶)) -+ phydm_fahm_trigger(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "IGI=0x%x, rpt_stamp=%d\n", ccx->fahm_igi, -+ ccx->fahm_rpt_stamp); -+ -+ for (i = 0; i < FAHM_TH_NUM; i++) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "FAHM_th[%d] RSSI = %d\n", i, -+ NTH_TH_2_RSSI(ccx->fahm_th[i])); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif /*#ifdef FAHM_SUPPORT*/ -+ -+#ifdef IFS_CLM_SUPPORT -+void phydm_ifs_clm_restart(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ /*restart IFS_CLM*/ -+ odm_set_bb_reg(dm, R_0x1ee4, BIT(29), 0x0); -+ odm_set_bb_reg(dm, R_0x1ee4, BIT(29), 0x1); -+} -+ -+void phydm_ifs_clm_racing_release(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "ifs clm lv:(%d)->(0)\n", -+ ccx->ifs_clm_set_lv); -+ -+ ccx->ifs_clm_ongoing = false; -+ ccx->ifs_clm_set_lv = IFS_CLM_RELEASE; -+ ccx->ifs_clm_app = IFS_CLM_BACKGROUND; -+} -+ -+u8 phydm_ifs_clm_racing_ctrl(void *dm_void, enum phydm_ifs_clm_level ifs_clm_lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 set_result = PHYDM_SET_SUCCESS; -+ /*acquire to control IFS CLM API*/ -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "ifs clm_ongoing=%d, lv:(%d)->(%d)\n", -+ ccx->ifs_clm_ongoing, ccx->ifs_clm_set_lv, ifs_clm_lv); -+ if (ccx->ifs_clm_ongoing) { -+ if (ifs_clm_lv <= ccx->ifs_clm_set_lv) { -+ set_result = PHYDM_SET_FAIL; -+ } else { -+ phydm_ifs_clm_restart(dm); -+ ccx->ifs_clm_ongoing = false; -+ } -+ } -+ -+ if (set_result) -+ ccx->ifs_clm_set_lv = ifs_clm_lv; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "ifs clm racing success=%d\n", set_result); -+ return set_result; -+} -+ -+void phydm_ifs_clm_trigger(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ /*Trigger IFS_CLM*/ -+ pdm_set_reg(dm, R_0x1ee4, BIT(29), 0); -+ pdm_set_reg(dm, R_0x1ee4, BIT(29), 1); -+ ccx->ifs_clm_trigger_time = dm->phydm_sys_up_time; -+ ccx->ifs_clm_rpt_stamp++; -+ ccx->ifs_clm_ongoing = true; -+} -+ -+void phydm_ifs_clm_get_utility(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u16 denom = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ denom = ccx->ifs_clm_period; -+ ccx->ifs_clm_tx_ratio = phydm_ccx_get_rpt_ratio(dm, ccx->ifs_clm_tx, -+ denom); -+ ccx->ifs_clm_edcca_excl_cca_ratio = phydm_ccx_get_rpt_ratio(dm, -+ ccx->ifs_clm_edcca_excl_cca, -+ denom); -+ ccx->ifs_clm_cck_fa_ratio = phydm_ccx_get_rpt_ratio(dm, -+ ccx->ifs_clm_cckfa, denom); -+ ccx->ifs_clm_ofdm_fa_ratio = phydm_ccx_get_rpt_ratio(dm, -+ ccx->ifs_clm_ofdmfa, denom); -+ ccx->ifs_clm_cck_cca_excl_fa_ratio = phydm_ccx_get_rpt_ratio(dm, -+ ccx->ifs_clm_cckcca_excl_fa, -+ denom); -+ ccx->ifs_clm_ofdm_cca_excl_fa_ratio = phydm_ccx_get_rpt_ratio(dm, -+ ccx->ifs_clm_ofdmcca_excl_fa, -+ denom); -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Tx_ratio = %d, EDCCA_exclude_CCA_ratio = %d \n", -+ ccx->ifs_clm_tx_ratio, ccx->ifs_clm_edcca_excl_cca_ratio); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "CCK : FA_ratio = %d, CCA_exclude_FA_ratio = %d \n", -+ ccx->ifs_clm_cck_fa_ratio, -+ ccx->ifs_clm_cck_cca_excl_fa_ratio); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "OFDM : FA_ratio = %d, CCA_exclude_FA_ratio = %d \n", -+ ccx->ifs_clm_ofdm_fa_ratio, -+ ccx->ifs_clm_ofdm_cca_excl_fa_ratio); -+} -+ -+void phydm_ifs_clm_get_result(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 value32 = 0; -+ u8 i = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ /*Enhance CLM result*/ -+ value32 = odm_get_bb_reg(dm, R_0x2e60, MASKDWORD); -+ ccx->ifs_clm_tx = (u16)(value32 & MASKLWORD); -+ ccx->ifs_clm_edcca_excl_cca = (u16)((value32 & MASKHWORD) >> 16); -+ value32 = odm_get_bb_reg(dm, R_0x2e64, MASKDWORD); -+ ccx->ifs_clm_ofdmfa = (u16)(value32 & MASKLWORD); -+ ccx->ifs_clm_ofdmcca_excl_fa = (u16)((value32 & MASKHWORD) >> 16); -+ value32 = odm_get_bb_reg(dm, R_0x2e68, MASKDWORD); -+ ccx->ifs_clm_cckfa = (u16)(value32 & MASKLWORD); -+ ccx->ifs_clm_cckcca_excl_fa = (u16)((value32 & MASKHWORD) >> 16); -+ value32 = odm_get_bb_reg(dm, R_0x2e6c, MASKDWORD); -+ ccx->ifs_clm_total_cca = (u16)(value32 & MASKLWORD); -+ -+ /* IFS result */ -+ value32 = odm_get_bb_reg(dm, R_0x2e70, MASKDWORD); -+ value32 = odm_convert_to_le32(value32); -+ odm_move_memory(dm, &ccx->ifs_clm_his[0], &value32, 4); -+ value32 = odm_get_bb_reg(dm, R_0x2e74, MASKDWORD); -+ ccx->ifs_clm_avg[0] = (u16)(value32 & MASKLWORD); -+ ccx->ifs_clm_avg[1] = (u16)((value32 & MASKHWORD) >> 16); -+ value32 = odm_get_bb_reg(dm, R_0x2e78, MASKDWORD); -+ ccx->ifs_clm_avg[2] = (u16)(value32 & MASKLWORD); -+ ccx->ifs_clm_avg[3] = (u16)((value32 & MASKHWORD) >> 16); -+ value32 = odm_get_bb_reg(dm, R_0x2e7c, MASKDWORD); -+ ccx->ifs_clm_avg_cca[0] = (u16)(value32 & MASKLWORD); -+ ccx->ifs_clm_avg_cca[1] = (u16)((value32 & MASKHWORD) >> 16); -+ value32 = odm_get_bb_reg(dm, R_0x2e80, MASKDWORD); -+ ccx->ifs_clm_avg_cca[2] = (u16)(value32 & MASKLWORD); -+ ccx->ifs_clm_avg_cca[3] = (u16)((value32 & MASKHWORD) >> 16); -+ -+ /* Print Result */ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "ECLM_Rpt[%d]: \nTx = %d, EDCCA_exclude_CCA = %d \n", -+ ccx->ifs_clm_rpt_stamp, ccx->ifs_clm_tx, -+ ccx->ifs_clm_edcca_excl_cca); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[FA_cnt] {CCK, OFDM} = {%d, %d}\n", -+ ccx->ifs_clm_cckfa, ccx->ifs_clm_ofdmfa); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[CCA_exclude_FA_cnt] {CCK, OFDM} = {%d, %d}\n", -+ ccx->ifs_clm_cckcca_excl_fa, ccx->ifs_clm_ofdmcca_excl_fa); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "CCATotal = %d\n", ccx->ifs_clm_total_cca); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Time:[his, avg, avg_cca]\n"); -+ for (i = 0; i < IFS_CLM_NUM; i++) -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "T%d:[%d, %d, %d]\n", i + 1, -+ ccx->ifs_clm_his[i], ccx->ifs_clm_avg[i], -+ ccx->ifs_clm_avg_cca[i]); -+ -+ phydm_ifs_clm_racing_release(dm); -+ -+ return; -+} -+ -+void phydm_ifs_clm_set_th_reg(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 i = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ /*Set IFS period TH*/ -+ odm_set_bb_reg(dm, R_0x1ed4, BIT(31), ccx->ifs_clm_th_en[0]); -+ odm_set_bb_reg(dm, R_0x1ed8, BIT(31), ccx->ifs_clm_th_en[1]); -+ odm_set_bb_reg(dm, R_0x1edc, BIT(31), ccx->ifs_clm_th_en[2]); -+ odm_set_bb_reg(dm, R_0x1ee0, BIT(31), ccx->ifs_clm_th_en[3]); -+ odm_set_bb_reg(dm, R_0x1ed4, 0x7fff0000, ccx->ifs_clm_th_low[0]); -+ odm_set_bb_reg(dm, R_0x1ed8, 0x7fff0000, ccx->ifs_clm_th_low[1]); -+ odm_set_bb_reg(dm, R_0x1edc, 0x7fff0000, ccx->ifs_clm_th_low[2]); -+ odm_set_bb_reg(dm, R_0x1ee0, 0x7fff0000, ccx->ifs_clm_th_low[3]); -+ odm_set_bb_reg(dm, R_0x1ed4, MASKLWORD, ccx->ifs_clm_th_high[0]); -+ odm_set_bb_reg(dm, R_0x1ed8, MASKLWORD, ccx->ifs_clm_th_high[1]); -+ odm_set_bb_reg(dm, R_0x1edc, MASKLWORD, ccx->ifs_clm_th_high[2]); -+ odm_set_bb_reg(dm, R_0x1ee0, MASKLWORD, ccx->ifs_clm_th_high[3]); -+ -+ for (i = 0; i < IFS_CLM_NUM; i++) -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Update IFS_CLM_th%d[High Low] : [%d %d]\n", i + 1, -+ ccx->ifs_clm_th_high[i], ccx->ifs_clm_th_low[i]); -+} -+ -+boolean phydm_ifs_clm_th_update_chk(void *dm_void, -+ enum ifs_clm_application ifs_clm_app, -+ boolean *ifs_clm_th_en, u16 *ifs_clm_th_low, -+ u16 *ifs_clm_th_high, s16 th_shift) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean is_update = false; -+ u16 ifs_clm_th_low_bg[IFS_CLM_NUM] = {12, 5, 2, 0}; -+ u16 ifs_clm_th_high_bg[IFS_CLM_NUM] = {64, 12, 5, 2}; -+ u8 i = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "App=%d, th_shift=%d\n", ifs_clm_app, -+ th_shift); -+ -+ switch (ifs_clm_app) { -+ case IFS_CLM_BACKGROUND: -+ case IFS_CLM_ACS: -+ case IFS_CLM_HP_TAS: -+ if (ccx->ifs_clm_app != ifs_clm_app || th_shift != 0) { -+ is_update = true; -+ -+ for (i = 0; i < IFS_CLM_NUM; i++) { -+ ifs_clm_th_en[i] = true; -+ ifs_clm_th_low[i] = ifs_clm_th_low_bg[i]; -+ ifs_clm_th_high[i] = ifs_clm_th_high_bg[i]; -+ } -+ } -+ break; -+ case IFS_CLM_DBG: -+ if (ccx->ifs_clm_app != ifs_clm_app || th_shift != 0) { -+ is_update = true; -+ -+ for (i = 0; i < IFS_CLM_NUM; i++) { -+ ifs_clm_th_en[i] = true; -+ ifs_clm_th_low[i] = MAX_2(ccx->ifs_clm_th_low[i] + -+ th_shift, 0); -+ ifs_clm_th_high[i] = MAX_2(ccx->ifs_clm_th_high[i] + -+ th_shift, 0); -+ } -+ } -+ break; -+ default: -+ break; -+ } -+ -+ if (is_update) -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[Update IFS_TH]\n"); -+ else -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "No need to update IFS_TH\n"); -+ -+ return is_update; -+} -+ -+void phydm_ifs_clm_set(void *dm_void, enum ifs_clm_application ifs_clm_app, -+ u16 period, u8 ctrl_unit, s16 th_shift) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean ifs_clm_th_en[IFS_CLM_NUM] = {0}; -+ u16 ifs_clm_th_low[IFS_CLM_NUM] = {0}; -+ u16 ifs_clm_th_high[IFS_CLM_NUM] = {0}; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "period=%d, ctrl_unit=%d\n", period, -+ ctrl_unit); -+ -+ /*Set Unit*/ -+ if (ctrl_unit != ccx->ifs_clm_ctrl_unit) { -+ odm_set_bb_reg(dm, R_0x1ee4, 0xc0000000, ctrl_unit); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Update IFS_CLM unit ((%d)) -> ((%d))\n", -+ ccx->ifs_clm_ctrl_unit, ctrl_unit); -+ ccx->ifs_clm_ctrl_unit = ctrl_unit; -+ } -+ -+ /*Set Duration*/ -+ if (period != ccx->ifs_clm_period) { -+ odm_set_bb_reg(dm, R_0x1eec, 0xc0000000, (period & 0x3)); -+ odm_set_bb_reg(dm, R_0x1ef0, 0xfe000000, ((period >> 2) & -+ 0x7f)); -+ odm_set_bb_reg(dm, R_0x1ef4, 0xc0000000, ((period >> 9) & -+ 0x3)); -+ odm_set_bb_reg(dm, R_0x1ef8, 0x3e000000, ((period >> 11) & -+ 0x1f)); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Update IFS_CLM period ((%d)) -> ((%d))\n", -+ ccx->ifs_clm_period, period); -+ ccx->ifs_clm_period = period; -+ } -+ -+ /*Set IFS CLM threshold*/ -+ if (phydm_ifs_clm_th_update_chk(dm, ifs_clm_app, &ifs_clm_th_en[0], -+ &ifs_clm_th_low[0], &ifs_clm_th_high[0], -+ th_shift)) { -+ -+ ccx->ifs_clm_app = ifs_clm_app; -+ odm_move_memory(dm, &ccx->ifs_clm_th_en[0], &ifs_clm_th_en, -+ IFS_CLM_NUM); -+ odm_move_memory(dm, &ccx->ifs_clm_th_low[0], &ifs_clm_th_low, -+ IFS_CLM_NUM); -+ odm_move_memory(dm, &ccx->ifs_clm_th_high[0], &ifs_clm_th_high, -+ IFS_CLM_NUM); -+ -+ phydm_ifs_clm_set_th_reg(dm); -+ } -+} -+ -+boolean -+phydm_ifs_clm_mntr_set(void *dm_void, struct ifs_clm_para_info *ifs_clm_para) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 ifs_clm_time = 0; /*unit: 4/8/12/16us*/ -+ u8 unit = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (ifs_clm_para->mntr_time == 0) -+ return false; -+ -+ if (ifs_clm_para->ifs_clm_lv >= IFS_CLM_MAX_NUM) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Wrong LV=%d\n", -+ ifs_clm_para->ifs_clm_lv); -+ return false; -+ } -+ -+ if (phydm_ifs_clm_racing_ctrl(dm, ifs_clm_para->ifs_clm_lv) == PHYDM_SET_FAIL) -+ return false; -+ -+ if (ifs_clm_para->mntr_time >= 1048) { -+ unit = IFS_CLM_16; -+ ifs_clm_time = IFS_CLM_PERIOD_MAX; /*65535 * 16us = 1048ms*/ -+ } else if (ifs_clm_para->mntr_time >= 786) {/*65535 * 12us = 786 ms*/ -+ unit = IFS_CLM_16; -+ ifs_clm_time = PHYDM_DIV(ifs_clm_para->mntr_time * MS_TO_US, 16); -+ } else if (ifs_clm_para->mntr_time >= 524) { -+ unit = IFS_CLM_12; -+ ifs_clm_time = PHYDM_DIV(ifs_clm_para->mntr_time * MS_TO_US, 12); -+ } else if (ifs_clm_para->mntr_time >= 262) { -+ unit = IFS_CLM_8; -+ ifs_clm_time = PHYDM_DIV(ifs_clm_para->mntr_time * MS_TO_US, 8); -+ } else { -+ unit = IFS_CLM_4; -+ ifs_clm_time = PHYDM_DIV(ifs_clm_para->mntr_time * MS_TO_US, 4); -+ } -+ -+ phydm_ifs_clm_set(dm, ifs_clm_para->ifs_clm_app, ifs_clm_time, unit, -+ ifs_clm_para->th_shift); -+ -+ return true; -+} -+ -+boolean -+phydm_ifs_clm_mntr_racing_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 sys_return_time = 0; -+ -+ if (ccx->ifs_clm_manual_ctrl) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "IFS_CLM in manual ctrl\n"); -+ return true; -+ } -+ -+ sys_return_time = ccx->ifs_clm_trigger_time + MAX_ENV_MNTR_TIME; -+ -+ if (ccx->ifs_clm_app != IFS_CLM_BACKGROUND && -+ (sys_return_time > dm->phydm_sys_up_time)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "ifs_clm_app=%d, trigger_time %d, sys_time=%d\n", -+ ccx->ifs_clm_app, ccx->ifs_clm_trigger_time, -+ dm->phydm_sys_up_time); -+ -+ return true; -+ } -+ -+ return false; -+} -+ -+boolean -+phydm_ifs_clm_mntr_chk(void *dm_void, u16 monitor_time /*unit ms*/) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ struct ifs_clm_para_info ifs_clm_para = {0}; -+ boolean ifs_clm_chk_result = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (phydm_ifs_clm_mntr_racing_chk(dm)) -+ return ifs_clm_chk_result; -+ -+ /*[IFS CLM trigger setting]------------------------------------------*/ -+ ifs_clm_para.ifs_clm_app = IFS_CLM_BACKGROUND; -+ ifs_clm_para.ifs_clm_lv = IFS_CLM_LV_1; -+ ifs_clm_para.mntr_time = monitor_time; -+ ifs_clm_para.th_shift = 0; -+ -+ ifs_clm_chk_result = phydm_ifs_clm_mntr_set(dm, &ifs_clm_para); -+ -+ return ifs_clm_chk_result; -+} -+ -+boolean -+phydm_ifs_clm_mntr_result(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean ifs_clm_chk_result = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (phydm_ifs_clm_mntr_racing_chk(dm)) -+ return ifs_clm_chk_result; -+ -+ /*[IFS CLM get result] ------------------------------------]*/ -+ phydm_ifs_clm_get_result(dm); -+ phydm_ifs_clm_get_utility(dm); -+ ifs_clm_chk_result = true; -+ -+ return ifs_clm_chk_result; -+} -+ -+void phydm_ifs_clm_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ ccx->ifs_clm_app = IFS_CLM_BACKGROUND; -+ -+ /*Set IFS threshold*/ -+ ccx->ifs_clm_ongoing = false; -+ ccx->ifs_clm_set_lv = IFS_CLM_RELEASE; -+ -+ if (phydm_ifs_clm_th_update_chk(dm, ccx->ifs_clm_app, -+ &ccx->ifs_clm_th_en[0], -+ &ccx->ifs_clm_th_low[0], -+ &ccx->ifs_clm_th_high[0], 0xffff)) -+ phydm_ifs_clm_set_th_reg(dm); -+ -+ ccx->ifs_clm_period = 0; -+ ccx->ifs_clm_ctrl_unit = IFS_CLM_INIT; -+ ccx->ifs_clm_manual_ctrl = 0; -+ ccx->ifs_clm_rpt_stamp = 0; -+} -+ -+void phydm_ifs_clm_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ struct ifs_clm_para_info ifs_clm_para; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 result_tmp = 0; -+ u8 i = 0; -+ u16 th_shift = 0; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_IFS_CLM)) -+ return; -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var1[i]); -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "IFS_CLM Basic-Trigger 960ms: {1}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "IFS_CLM Adv-Trigger: {2} {App:3 for dbg} {LV:1~4} {0~2096ms} {th_shift}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "IFS_CLM Get Result: {100}\n"); -+ } else if (var1[0] == 100) { /*Get IFS_CLM results*/ -+ phydm_ifs_clm_get_result(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "ECLM_Rpt[%d]: \nTx = %d \nEDCCA_exclude_CCA = %d\n", -+ ccx->ifs_clm_rpt_stamp, ccx->ifs_clm_tx, -+ ccx->ifs_clm_edcca_excl_cca); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[FA_cnt] {CCK, OFDM} = {%d, %d}\n", -+ ccx->ifs_clm_cckfa, ccx->ifs_clm_ofdmfa); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[CCA_exclude_FA_cnt] {CCK, OFDM} = {%d, %d}\n", -+ ccx->ifs_clm_cckcca_excl_fa, -+ ccx->ifs_clm_ofdmcca_excl_fa); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "CCATotal = %d\n", ccx->ifs_clm_total_cca); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Time:[his, avg, avg_cca]\n"); -+ for (i = 0; i < IFS_CLM_NUM; i++) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "T%d:[%d, %d, %d]\n", i + 1, -+ ccx->ifs_clm_his[i], ccx->ifs_clm_avg[i], -+ ccx->ifs_clm_avg_cca[i]); -+ -+ phydm_ifs_clm_get_utility(dm); -+ -+ ccx->ifs_clm_manual_ctrl = 0; -+ } else { /*IFS_CLM trigger*/ -+ ccx->ifs_clm_manual_ctrl = 1; -+ -+ if (var1[0] == 1) { -+ ifs_clm_para.ifs_clm_app = IFS_CLM_DBG; -+ ifs_clm_para.ifs_clm_lv = IFS_CLM_LV_4; -+ ifs_clm_para.mntr_time = 960; -+ ifs_clm_para.th_shift = 0; -+ } else { -+ ifs_clm_para.ifs_clm_app = (enum ifs_clm_application)var1[1]; -+ ifs_clm_para.ifs_clm_lv = (enum phydm_ifs_clm_level)var1[2]; -+ ifs_clm_para.mntr_time = (u16)var1[3]; -+ ifs_clm_para.th_shift = (s16)var1[4]; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "app=%d, lv=%d, time=%d ms, th_shift=%s%d\n", -+ ifs_clm_para.ifs_clm_app, ifs_clm_para.ifs_clm_lv, -+ ifs_clm_para.mntr_time, -+ (ifs_clm_para.th_shift > 0) ? "+" : "-", -+ ifs_clm_para.th_shift); -+ -+ if (phydm_ifs_clm_mntr_set(dm, &ifs_clm_para) == PHYDM_SET_SUCCESS) -+ phydm_ifs_clm_trigger(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "rpt_stamp=%d\n", ccx->ifs_clm_rpt_stamp); -+ for (i = 0; i < IFS_CLM_NUM; i++) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "IFS_CLM_th%d[High Low] : [%d %d]\n", i + 1, -+ ccx->ifs_clm_th_high[i], -+ ccx->ifs_clm_th_low[i]); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -+ -+u8 phydm_enhance_mntr_trigger(void *dm_void, struct nhm_para_info *nhm_para, -+ struct clm_para_info *clm_para, -+ struct fahm_para_info *fahm_para, -+ struct ifs_clm_para_info *ifs_clm_para, -+ struct enhance_mntr_trig_rpt *trig_rpt) -+{ -+ u8 trigger_result = 0; -+#if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT) && defined(FAHM_SUPPORT) && defined(IFS_CLM_SUPPORT)) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean nhm_set_ok = false; -+ boolean clm_set_ok = false; -+ boolean fahm_set_ok = false; -+ boolean ifs_clm_set_ok = false; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_FAHM) || -+ !(dm->support_ic_type & PHYDM_IC_SUPPORT_IFS_CLM)) -+ return trigger_result; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); -+ -+ nhm_set_ok = phydm_nhm_mntr_set(dm, nhm_para); -+ -+ if (ccx->clm_mntr_mode == CLM_DRIVER_MNTR) { -+ clm_set_ok = phydm_clm_mntr_set(dm, clm_para); -+ } else if (ccx->clm_mntr_mode == CLM_FW_MNTR) { -+ phydm_clm_h2c(dm, CLM_PERIOD_MAX, true); -+ trigger_result |= CLM_SUCCESS; -+ } -+ -+ fahm_set_ok = phydm_fahm_mntr_set(dm, fahm_para); -+ -+ ifs_clm_set_ok = phydm_ifs_clm_mntr_set(dm, ifs_clm_para); -+ -+ if (nhm_set_ok) { -+ phydm_nhm_trigger(dm); -+ trigger_result |= NHM_SUCCESS; -+ } -+ -+ if (clm_set_ok) { -+ phydm_clm_trigger(dm); -+ trigger_result |= CLM_SUCCESS; -+ } -+ -+ if (fahm_set_ok) { -+ phydm_fahm_trigger(dm); -+ trigger_result |= FAHM_SUCCESS; -+ } -+ -+ if (ifs_clm_set_ok) { -+ phydm_ifs_clm_trigger(dm); -+ trigger_result |= IFS_CLM_SUCCESS; -+ } -+ -+ /*monitor for the test duration*/ -+ ccx->start_time = odm_get_current_time(dm); -+ -+ trig_rpt->nhm_rpt_stamp = ccx->nhm_rpt_stamp; -+ trig_rpt->clm_rpt_stamp = ccx->clm_rpt_stamp; -+ trig_rpt->fahm_rpt_stamp = ccx->fahm_rpt_stamp; -+ trig_rpt->ifs_clm_rpt_stamp = ccx->ifs_clm_rpt_stamp; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "rpt_stamp{NHM, CLM, FAHM, IFS_CLM}={%d, %d, %d, %d}\n\n", -+ trig_rpt->nhm_rpt_stamp, trig_rpt->clm_rpt_stamp, -+ trig_rpt->fahm_rpt_stamp, trig_rpt->ifs_clm_rpt_stamp); -+ -+#endif -+ return trigger_result; -+} -+ -+u8 phydm_enhance_mntr_result(void *dm_void, struct enhance_mntr_rpt *rpt) -+{ -+ u8 enhance_mntr_rpt = 0; -+#if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT) && defined(FAHM_SUPPORT) && defined(IFS_CLM_SUPPORT)) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u64 progressing_time = 0; -+ u32 val_tmp = 0; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_FAHM) || -+ !(dm->support_ic_type & PHYDM_IC_SUPPORT_IFS_CLM)) -+ return enhance_mntr_rpt; -+ -+ /*monitor for the test duration*/ -+ progressing_time = odm_get_progressing_time(dm, ccx->start_time); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "enhance_mntr_time=%lld\n", -+ progressing_time); -+ -+ /*Get NHM result*/ -+ if (phydm_nhm_get_result(dm)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get NHM_rpt success\n"); -+ phydm_nhm_get_utility(dm); -+ rpt->nhm_ratio = ccx->nhm_ratio; -+ rpt->nhm_env_ratio = ccx->nhm_env_ratio; -+ rpt->nhm_idle_ratio = ccx->nhm_idle_ratio; -+ rpt->nhm_noise_pwr = ccx->nhm_level; -+ rpt->nhm_pwr = ccx->nhm_pwr; -+ enhance_mntr_rpt |= NHM_SUCCESS; -+ -+ odm_move_memory(dm, &rpt->nhm_result[0], -+ &ccx->nhm_result[0], NHM_RPT_NUM); -+ } else { -+ rpt->nhm_ratio = ENV_MNTR_FAIL; -+ rpt->nhm_env_ratio = ENV_MNTR_FAIL; -+ rpt->nhm_idle_ratio = ENV_MNTR_FAIL; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[NHM]rpt_stamp=%d, IGI=0x%x, ratio=%d, env_ratio=%d, noise_pwr=%d, pwr=%d\n", -+ rpt->nhm_rpt_stamp, ccx->nhm_igi, rpt->nhm_ratio, -+ rpt->nhm_env_ratio, rpt->nhm_noise_pwr, rpt->nhm_pwr); -+ -+ /*Get CLM result*/ -+ if (ccx->clm_mntr_mode == CLM_DRIVER_MNTR) { -+ if (phydm_clm_get_result(dm)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get CLM_rpt success\n"); -+ phydm_clm_get_utility(dm); -+ enhance_mntr_rpt |= CLM_SUCCESS; -+ rpt->clm_ratio = ccx->clm_ratio; -+ if ((enhance_mntr_rpt & NHM_SUCCESS) && -+ (rpt->nhm_idle_ratio != ENV_MNTR_FAIL)) -+ rpt->nhm_tx_ratio = 100 - rpt->clm_ratio - -+ rpt->nhm_idle_ratio; -+ else -+ rpt->nhm_tx_ratio = ENV_MNTR_FAIL; -+ } else { -+ rpt->clm_ratio = ENV_MNTR_FAIL; -+ rpt->nhm_tx_ratio = ENV_MNTR_FAIL; -+ } -+ } else { -+ if (ccx->clm_fw_result_cnt != 0) { -+ val_tmp = ccx->clm_fw_result_acc -+ / ccx->clm_fw_result_cnt; -+ ccx->clm_ratio = (u8)val_tmp; -+ } else { -+ ccx->clm_ratio = 0; -+ } -+ rpt->clm_ratio = ccx->clm_ratio; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "clm_fw_result_acc=%d, clm_fw_result_cnt=%d\n", -+ ccx->clm_fw_result_acc, ccx->clm_fw_result_cnt); -+ -+ rpt->nhm_tx_ratio = ENV_MNTR_FAIL; -+ ccx->clm_fw_result_acc = 0; -+ ccx->clm_fw_result_cnt = 0; -+ enhance_mntr_rpt |= CLM_SUCCESS; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[CLM]rpt_stamp=%d, ratio=%d\n", -+ rpt->clm_rpt_stamp, rpt->clm_ratio); -+ -+ /*Get FAHM result*/ -+ if (phydm_fahm_get_result(dm)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get FAHM_rpt success\n"); -+ phydm_fahm_get_utility(dm); -+ rpt->fahm_pwr = ccx->fahm_pwr; -+ rpt->fahm_ratio = ccx->fahm_ratio; -+ rpt->fahm_denom_ratio = ccx->fahm_denom_ratio; -+ rpt->fahm_inclu_cck = ccx->fahm_inclu_cck; -+ enhance_mntr_rpt |= FAHM_SUCCESS; -+ -+ odm_move_memory(dm, &rpt->fahm_result[0], -+ &ccx->fahm_result[0], FAHM_RPT_NUM * 2); -+ } else { -+ rpt->fahm_pwr = 0; -+ rpt->fahm_ratio = 0; -+ rpt->fahm_denom_ratio = 0; -+ } -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[FAHM]stamp=%d, IGI=0x%x, fahm_inclu_cck=%d, fahm_pwr=%d, fahm_ratio=%d, fahm_denom_ratio=%d\n", -+ rpt->fahm_rpt_stamp, ccx->fahm_igi, rpt->fahm_inclu_cck, -+ rpt->fahm_pwr, rpt->fahm_ratio, rpt->fahm_denom_ratio); -+ -+ /*Get IFS_CLM result*/ -+ phydm_ifs_clm_get_result(dm); -+ phydm_ifs_clm_get_utility(dm); -+ rpt->ifs_clm_tx_ratio = ccx->ifs_clm_tx_ratio; -+ rpt->ifs_clm_edcca_excl_cca_ratio = ccx->ifs_clm_edcca_excl_cca_ratio; -+ rpt->ifs_clm_cck_fa_ratio = ccx->ifs_clm_cck_fa_ratio; -+ rpt->ifs_clm_cck_cca_excl_fa_ratio = ccx->ifs_clm_cck_cca_excl_fa_ratio; -+ rpt->ifs_clm_ofdm_fa_ratio = ccx->ifs_clm_ofdm_fa_ratio; -+ rpt->ifs_clm_ofdm_cca_excl_fa_ratio = ccx->ifs_clm_ofdm_cca_excl_fa_ratio; -+ rpt->ifs_clm_rpt_stamp = ccx->ifs_clm_rpt_stamp; -+ enhance_mntr_rpt |= IFS_CLM_SUCCESS; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[IFS_CLM]rpt_stamp = %d, Tx_ratio = %d, EDCCA_exclude_CCA_ratio = %d\n", -+ ccx->ifs_clm_rpt_stamp, ccx->ifs_clm_tx_ratio, -+ ccx->ifs_clm_edcca_excl_cca_ratio); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "CCK : FA_ratio = %d, CCA_exclude_FA_ratio = %d\n", -+ ccx->ifs_clm_cck_fa_ratio, ccx->ifs_clm_cck_cca_excl_fa_ratio); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "OFDM : FA_ratio = %d, CCA_exclude_FA_ratio = %d\n", -+ ccx->ifs_clm_ofdm_fa_ratio, -+ ccx->ifs_clm_ofdm_cca_excl_fa_ratio); -+ -+ rpt->nhm_rpt_stamp = ccx->nhm_rpt_stamp; -+ rpt->clm_rpt_stamp = ccx->clm_rpt_stamp; -+ rpt->fahm_rpt_stamp = ccx->fahm_rpt_stamp; -+ rpt->ifs_clm_rpt_stamp = ccx->ifs_clm_rpt_stamp; -+#endif -+ return enhance_mntr_rpt; -+} -+ -+void phydm_enhance_mntr_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+#if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT) && defined(FAHM_SUPPORT) && defined(IFS_CLM_SUPPORT)) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ struct nhm_para_info nhm_para = {0}; -+ struct clm_para_info clm_para = {0}; -+ struct fahm_para_info fahm_para = {0}; -+ struct ifs_clm_para_info ifs_clm_para = {0}; -+ struct enhance_mntr_rpt rpt = {0}; -+ struct enhance_mntr_trig_rpt trig_rpt = {0}; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 set_result = 0; -+ u8 i = 0; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_FAHM) || -+ !(dm->support_ic_type & PHYDM_IC_SUPPORT_IFS_CLM)) -+ return; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Basic-Trigger 960ms for ifs_clm, 262ms for others: {1}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Get Result: {100}\n"); -+ } else if (var1[0] == 100) { /* Get results */ -+ set_result = phydm_enhance_mntr_result(dm, &rpt); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set Result=%d, rpt_stamp{NHM, CLM, FAHM, IFS_CLM}={%d, %d, %d, %d}\n", -+ set_result, rpt.nhm_rpt_stamp, rpt.clm_rpt_stamp, -+ rpt.fahm_rpt_stamp, rpt.ifs_clm_rpt_stamp); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "clm_ratio=%d, nhm_idle_ratio=%d, nhm_tx_ratio=%d\n", -+ rpt.clm_ratio, rpt.nhm_idle_ratio, rpt.nhm_tx_ratio); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "nhm_IGI=0x%x, nhm_ratio=%d, nhm_env_ratio=%d, nhm_noise_pwr=%d, nhm_pwr=%d\n", -+ ccx->nhm_igi, rpt.nhm_ratio, rpt.nhm_env_ratio, -+ rpt.nhm_noise_pwr, rpt.nhm_pwr); -+ for (i = 0; i < NHM_RPT_NUM; i++) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "nhm_rpt[%d] = %d (%d percent)\n", i, -+ rpt.nhm_result[i], -+ (((rpt.nhm_result[i] * 100) + 128) >> 8)); -+ } -+ if (!(rpt.fahm_inclu_cck)) -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "===>The following fahm report does not count CCK pkt\n"); -+ -+ for (i = 0; i < FAHM_RPT_NUM; i++) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fahm_rpt[%d] = %d (%d percent)\n", i, -+ rpt.fahm_result[i], -+ (((rpt.fahm_result[i] * 100) + 32768) >> 16)); -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fahm_IGI=0x%x, fahm_pwr=%d, fahm_ratio=%d, fahm_denom_ratio=%d\n", -+ ccx->fahm_igi, rpt.fahm_pwr, rpt.fahm_ratio, -+ rpt.fahm_denom_ratio); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "ifs_clm_Tx_ratio = %d, ifs_clm_EDCCA_exclude_CCA_ratio = %d \n", -+ rpt.ifs_clm_tx_ratio, -+ rpt.ifs_clm_edcca_excl_cca_ratio); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "ifs_clm_cck_fa_ratio = %d, ifs_clm_cck_cca_exclude_FA_ratio = %d \n", -+ rpt.ifs_clm_cck_fa_ratio, -+ rpt.ifs_clm_cck_cca_excl_fa_ratio); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "ifs_clm_ofdm_fa_ratio = %d, ifs_clm_ofdm_cca_exclude_FA_ratio = %d \n", -+ rpt.ifs_clm_ofdm_fa_ratio, -+ rpt.ifs_clm_ofdm_cca_excl_fa_ratio); -+ } else { /* Set & trigger*/ -+ /*nhm para*/ -+ nhm_para.incld_txon = NHM_EXCLUDE_TXON; -+ nhm_para.incld_cca = NHM_EXCLUDE_CCA; -+ nhm_para.div_opt = NHM_CNT_ALL; -+ nhm_para.nhm_app = NHM_ACS; -+ nhm_para.nhm_lv = NHM_LV_2; -+ nhm_para.mntr_time = 262; -+ nhm_para.en_1db_mode = false; -+ -+ /*clm para*/ -+ clm_para.clm_app = CLM_ACS; -+ clm_para.clm_lv = CLM_LV_2; -+ clm_para.mntr_time = 262; -+ -+ /*fahm para*/ -+ fahm_para.numer_opt = FAHM_INCLU_FA; -+ fahm_para.denom_opt = FAHM_INCLU_CRC_ERR; -+ fahm_para.app = FAHM_ACS; -+ fahm_para.lv = FAHM_LV_2; -+ fahm_para.mntr_time = 262; -+ fahm_para.en_1db_mode = false; -+ -+ ifs_clm_para.ifs_clm_app = IFS_CLM_ACS; -+ ifs_clm_para.ifs_clm_lv = IFS_CLM_LV_2; -+ ifs_clm_para.mntr_time = 960; -+ ifs_clm_para.th_shift = 0; -+ -+ set_result = phydm_enhance_mntr_trigger(dm, &nhm_para, -+ &clm_para, &fahm_para, -+ &ifs_clm_para, -+ &trig_rpt); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set Result=%d, rpt_stamp{NHM, CLM, FAHM, IFS_CLM}={%d, %d ,%d, %d}\n", -+ set_result, trig_rpt.nhm_rpt_stamp, -+ trig_rpt.clm_rpt_stamp, trig_rpt.fahm_rpt_stamp, -+ trig_rpt.ifs_clm_rpt_stamp); -+ } -+ *_used = used; -+ *_out_len = out_len; -+#endif -+} -+ -+#ifdef EDCCA_CLM_SUPPORT -+ -+void phydm_edcca_clm_racing_release(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "lv:(%d)->(0)\n", ccx->edcca_clm_set_lv); -+ -+ ccx->edcca_clm_ongoing = false; -+ ccx->edcca_clm_set_lv = EDCCA_CLM_RELEASE; -+ ccx->edcca_clm_app = EDCCA_CLM_BACKGROUND; -+} -+ -+u8 phydm_edcca_clm_racing_ctrl(void *dm_void, enum phydm_edcca_clm_level lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u8 set_result = PHYDM_SET_SUCCESS; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "edcca_clm_ongoing=%d, lv:(%d)->(%d)\n", -+ ccx->edcca_clm_ongoing, ccx->edcca_clm_set_lv, lv); -+ if (ccx->edcca_clm_ongoing) { -+ if (lv <= ccx->edcca_clm_set_lv) { -+ set_result = PHYDM_SET_FAIL; -+ } else { -+ phydm_ccx_hw_restart(dm); -+ ccx->edcca_clm_ongoing = false; -+ } -+ } -+ -+ if (set_result) -+ ccx->edcca_clm_set_lv = lv; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "edcca_clm racing success=%d\n", -+ set_result); -+ return set_result; -+} -+ -+void phydm_edcca_clm_trigger(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ odm_set_bb_reg(dm, R_0x1e5c, BIT(26), 0x0); -+ odm_set_bb_reg(dm, R_0x1e5c, BIT(26), 0x1); -+ -+ ccx->edcca_clm_trigger_time = dm->phydm_sys_up_time; -+ ccx->edcca_clm_rpt_stamp++; -+ ccx->edcca_clm_ongoing = true; -+} -+ -+void phydm_edcca_clm_get_utility(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ ccx->edcca_clm_ratio = phydm_ccx_get_rpt_ratio(dm, -+ ccx->edcca_clm_result, -+ EDCCA_CLM_PERIOD); -+} -+ -+boolean -+phydm_edcca_clm_get_result(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx_info = &dm->dm_ccx_info; -+ u32 val = 0; -+ -+ if (!(odm_get_bb_reg(dm, R_0x2d8c, BIT(16)))) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get EDCCA_CLM report Fail\n"); -+ phydm_edcca_clm_racing_release(dm); -+ return false; -+ } -+ -+ val = odm_get_bb_reg(dm, R_0x2d8c, MASKLWORD); -+ ccx_info->edcca_clm_result = (u16)val; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "EDCCA_CLM result = %d *4 us\n", -+ ccx_info->edcca_clm_result); -+ phydm_edcca_clm_racing_release(dm); -+ return true; -+} -+ -+u8 phydm_edcca_clm_mntr_set(void *dm_void, struct edcca_clm_para_info *para) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ if (para->edcca_clm_lv >= EDCCA_CLM_MAX_NUM) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[WARNING] Wrong LV=%d\n", -+ para->edcca_clm_lv); -+ return PHYDM_SET_FAIL; -+ } -+ -+ if (phydm_edcca_clm_racing_ctrl(dm, para->edcca_clm_lv) == PHYDM_SET_FAIL) -+ return PHYDM_SET_FAIL; -+ -+ ccx->edcca_clm_app = para->edcca_clm_app; -+ -+ return PHYDM_SET_SUCCESS; -+} -+ -+boolean -+phydm_edcca_clm_mntr_racing_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 sys_return_time = 0; -+ -+ if (ccx->edcca_clm_manual_ctrl) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "EDCCA_CLM in manual ctrl\n"); -+ return true; -+ } -+ -+ sys_return_time = ccx->edcca_clm_trigger_time + MAX_ENV_MNTR_TIME; -+ -+ if (ccx->edcca_clm_app != EDCCA_CLM_BACKGROUND && -+ (sys_return_time > dm->phydm_sys_up_time)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "edcca_clm_app=%d, trigger_time %d, sys_time=%d\n", -+ ccx->edcca_clm_app, ccx->edcca_clm_trigger_time, -+ dm->phydm_sys_up_time); -+ -+ return true; -+ } -+ -+ return false; -+} -+ -+boolean -+phydm_edcca_clm_mntr_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ struct edcca_clm_para_info para = {0}; -+ boolean edcca_clm_chk_result = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (phydm_edcca_clm_mntr_racing_chk(dm)) -+ return edcca_clm_chk_result; -+ -+ /*[EDCCA_CLM trigger setting]----------------------------------------*/ -+ para.edcca_clm_app = EDCCA_CLM_BACKGROUND; -+ para.edcca_clm_lv = EDCCA_CLM_LV_1; -+ -+ edcca_clm_chk_result = phydm_edcca_clm_mntr_set(dm, ¶); -+ -+ return edcca_clm_chk_result; -+} -+ -+boolean -+phydm_edcca_clm_mntr_result(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ boolean edcca_clm_chk_result = false; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ if (phydm_edcca_clm_mntr_racing_chk(dm)) -+ return edcca_clm_chk_result; -+ -+ /*[EDCCA_CLM get result & calculate Utility]-------------------------*/ -+ if (phydm_edcca_clm_get_result(dm)) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Get EDCCA_CLM_rpt success\n"); -+ phydm_edcca_clm_get_utility(dm); -+ edcca_clm_chk_result = true; -+ } -+ -+ return edcca_clm_chk_result; -+} -+ -+void phydm_edcca_clm_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ ccx->edcca_clm_ongoing = false; -+ ccx->edcca_clm_manual_ctrl = 0; -+ ccx->edcca_clm_rpt_stamp = 0; -+} -+ -+void phydm_edcca_clm_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ struct edcca_clm_para_info para = {0}; -+ u32 i; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_EDCCA_CLM)) -+ return; -+ -+ for (i = 0; i < 4; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "EDCCA_CLM Basic-Trigger 262ms: {1}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "EDCCA_CLM Adv-Trigger 262ms: {2} {app} {LV}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "EDCCA_CLM Get Result: {100}\n"); -+ } else if (var1[0] == 100) { -+ if (phydm_edcca_clm_get_result(dm)) -+ phydm_edcca_clm_get_utility(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "edcca_clm_rpt_stamp=%d\n", ccx->edcca_clm_rpt_stamp); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "edcca_clm_ratio:((%d percent)) = (%d us/ 262140 us)\n", -+ ccx->edcca_clm_ratio, ccx->edcca_clm_result << 2); -+ -+ ccx->edcca_clm_manual_ctrl = 0; -+ } else { -+ ccx->edcca_clm_manual_ctrl = 1; -+ -+ if (var1[0] == 1) { -+ para.edcca_clm_app = EDCCA_CLM_DBG; -+ para.edcca_clm_lv = EDCCA_CLM_LV_4; -+ } else if (var1[0] == 2) { -+ para.edcca_clm_app = (enum edcca_clm_application)var1[1]; -+ para.edcca_clm_lv = (enum phydm_edcca_clm_level)var1[2]; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "app=%d, lv=%d\n", para.edcca_clm_app, -+ para.edcca_clm_lv); -+ -+ if (phydm_edcca_clm_mntr_set(dm, ¶) == PHYDM_SET_SUCCESS) -+ phydm_edcca_clm_trigger(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "edcca_clm_rpt_stamp=%d\n", ccx->edcca_clm_rpt_stamp); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif -+ -+/*Environment Monitor*/ -+void phydm_env_mntr_result_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ ccx->ccx_watchdog_result = 0; -+ -+ if (!(dm->support_ability & ODM_BB_ENV_MONITOR)) -+ return; -+ -+ #if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT)) -+ if (phydm_nhm_mntr_result(dm)) -+ ccx->ccx_watchdog_result |= NHM_SUCCESS; -+ -+ if (phydm_clm_mntr_result(dm)) -+ ccx->ccx_watchdog_result |= CLM_SUCCESS; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Summary: nhm_ratio=((%d)) nhm_env_ratio=((%d)) clm_ratio=((%d))\n", -+ ccx->nhm_ratio, ccx->nhm_env_ratio, ccx->clm_ratio); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "nhm_idle_ratio=((%d)) nhm_tx_ratio=((%d))\n\n", -+ ccx->nhm_idle_ratio, ccx->nhm_tx_ratio); -+ #endif -+ -+ #ifdef FAHM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_FAHM) { -+ if (phydm_fahm_mntr_result(dm)) -+ ccx->ccx_watchdog_result |= FAHM_SUCCESS; -+ } -+ #endif -+ -+ #ifdef IFS_CLM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_IFS_CLM) { -+ if (phydm_ifs_clm_mntr_result(dm)) -+ ccx->ccx_watchdog_result |= IFS_CLM_SUCCESS; -+ } -+ #endif -+ -+ #ifdef EDCCA_CLM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_EDCCA_CLM) { -+ if (phydm_edcca_clm_mntr_result(dm)) -+ ccx->ccx_watchdog_result |= EDCCA_CLM_SUCCESS; -+ } -+ #endif -+} -+ -+void phydm_env_mntr_set_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ if (!(dm->support_ability & ODM_BB_ENV_MONITOR)) -+ return; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); -+ -+ #if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT)) -+ if (phydm_nhm_mntr_chk(dm, 262)) -+ phydm_nhm_trigger(dm); -+ -+ if (phydm_clm_mntr_chk(dm, 262)) -+ phydm_clm_trigger(dm); -+ #endif -+ -+ #ifdef FAHM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_FAHM) { -+ if (phydm_fahm_mntr_chk(dm, 262)) -+ phydm_fahm_trigger(dm); -+ } -+ #endif -+ -+ #ifdef IFS_CLM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_IFS_CLM) { -+ if (phydm_ifs_clm_mntr_chk(dm, 960)) -+ phydm_ifs_clm_trigger(dm); -+ } -+ #endif -+ -+ #ifdef EDCCA_CLM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_EDCCA_CLM) { -+ if (phydm_edcca_clm_mntr_chk(dm)) -+ phydm_edcca_clm_trigger(dm); -+ } -+ #endif -+} -+ -+void phydm_env_monitor_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ #if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT)) -+ phydm_ccx_hw_restart(dm); -+ phydm_nhm_init(dm); -+ phydm_clm_init(dm); -+ #endif -+ -+ #ifdef FAHM_SUPPORT -+ phydm_fahm_init(dm); -+ #endif -+ -+ #ifdef IFS_CLM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_IFS_CLM) { -+ phydm_ifs_clm_restart(dm); -+ phydm_ifs_clm_init(dm); -+ } -+ #endif -+ -+ #ifdef EDCCA_CLM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_EDCCA_CLM) -+ phydm_edcca_clm_init(dm); -+ #endif -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_ccx.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_ccx.h -new file mode 100644 -index 000000000..2dd7c57de ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_ccx.h -@@ -0,0 +1,474 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMCCX_H__ -+#define __PHYDMCCX_H__ -+ -+/* 2021.03.10 Add 8814C flag*/ -+#define CCX_VERSION "4.9" -+ -+/* @1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+#define CCX_EN 1 -+ -+#define MAX_ENV_MNTR_TIME 8 /*second*/ -+#define MS_TO_US 1000 -+#define MS_TO_4US_RATIO 250 -+#define CCA_CAP 14 -+/*CLM*/ -+#define CLM_MAX_REPORT_TIME 10 -+#define CLM_PERIOD_MAX 65535 -+/*NHM*/ -+#define NHM_PERIOD_MAX 65534 -+#define NHM_TH_NUM 11 /*threshold number of NHM*/ -+#define NHM_RPT_NUM 12 -+#define NHM_IC_NOISE_TH 60 /*60/2 - 10 = 20 = -80 dBm*/ -+#define NHM_RPT_MAX 255 -+#ifdef NHM_DYM_PW_TH_SUPPORT -+#define DYM_PWTH_CCA_CAP 24 -+#endif -+#define IGI_2_NHM_TH(igi) ((igi) << 1)/*NHM/FAHM threshold = IGI * 2*/ -+#define NTH_TH_2_RSSI(th) ((th >> 1) - 10) -+/*FAHM*/ -+#define FAHM_INCLU_FA BIT(0) -+#define FAHM_INCLU_CRC_OK BIT(1) -+#define FAHM_INCLU_CRC_ERR BIT(2) -+#define FAHM_PERIOD_MAX 65534 -+#define FAHM_TH_NUM 11 /*threshold number of FAHM*/ -+#define FAHM_RPT_NUM 12 -+/*IFS-CLM*/ -+#define IFS_CLM_PERIOD_MAX 65535 -+#define IFS_CLM_NUM 4 -+/*EDCCA-CLM*/ -+#define EDCCA_CLM_PERIOD 65535 -+ -+#define NHM_SUCCESS BIT(0) -+#define CLM_SUCCESS BIT(1) -+#define FAHM_SUCCESS BIT(2) -+#define IFS_CLM_SUCCESS BIT(3) -+#define EDCCA_CLM_SUCCESS BIT(4) -+#define ENV_MNTR_FAIL 0xff -+ -+/* @1 ============================================================ -+ * 1 enumrate -+ * 1 ============================================================ -+ */ -+enum phydm_clm_level { -+ CLM_RELEASE = 0, -+ CLM_LV_1 = 1, /* @Low Priority function */ -+ CLM_LV_2 = 2, /* @Middle Priority function */ -+ CLM_LV_3 = 3, /* @High priority function (ex: Check hang function) */ -+ CLM_LV_4 = 4, /* @Debug function (the highest priority) */ -+ CLM_MAX_NUM = 5 -+}; -+ -+enum phydm_nhm_level { -+ NHM_RELEASE = 0, -+ NHM_LV_1 = 1, /* @Low Priority function */ -+ NHM_LV_2 = 2, /* @Middle Priority function */ -+ NHM_LV_3 = 3, /* @High priority function (ex: Check hang function) */ -+ NHM_LV_4 = 4, /* @Debug function (the highest priority) */ -+ NHM_MAX_NUM = 5 -+}; -+ -+enum phydm_fahm_level { -+ FAHM_RELEASE = 0, -+ FAHM_LV_1 = 1, /* Low Priority function */ -+ FAHM_LV_2 = 2, /* Middle Priority function */ -+ FAHM_LV_3 = 3, /* High priority function (ex: Check hang function) */ -+ FAHM_LV_4 = 4, /* Debug function (the highest priority) */ -+ FAHM_MAX_NUM = 5 -+}; -+ -+enum phydm_ifs_clm_level { -+ IFS_CLM_RELEASE = 0, -+ IFS_CLM_LV_1 = 1, /* @Low Priority function */ -+ IFS_CLM_LV_2 = 2, /* @Middle Priority function */ -+ IFS_CLM_LV_3 = 3, /* @High priority function (ex: Check hang function) */ -+ IFS_CLM_LV_4 = 4, /* @Debug function (the highest priority) */ -+ IFS_CLM_MAX_NUM = 5 -+}; -+ -+enum phydm_edcca_clm_level { -+ EDCCA_CLM_RELEASE = 0, -+ EDCCA_CLM_LV_1 = 1, /* @Low Priority function */ -+ EDCCA_CLM_LV_2 = 2, /* @Middle Priority function */ -+ EDCCA_CLM_LV_3 = 3, /* @High priority function (ex: Check hang function) */ -+ EDCCA_CLM_LV_4 = 4, /* @Debug function (the highest priority) */ -+ EDCCA_CLM_MAX_NUM = 5 -+}; -+ -+enum nhm_divider_opt_all { -+ NHM_CNT_ALL = 0, /*nhm SUM report <= 255*/ -+ NHM_VALID = 1, /*nhm SUM report = 255*/ -+ NHM_CNT_INIT -+}; -+ -+enum nhm_setting { -+ SET_NHM_SETTING, -+ STORE_NHM_SETTING, -+ RESTORE_NHM_SETTING -+}; -+ -+enum nhm_option_cca_all { -+ NHM_EXCLUDE_CCA = 0, -+ NHM_INCLUDE_CCA = 1, -+ NHM_CCA_INIT -+}; -+ -+enum nhm_option_txon_all { -+ NHM_EXCLUDE_TXON = 0, -+ NHM_INCLUDE_TXON = 1, -+ NHM_TXON_INIT -+}; -+ -+enum nhm_application { -+ NHM_BACKGROUND = 0,/*@default*/ -+ NHM_ACS = 1, -+ IEEE_11K_HIGH = 2, -+ IEEE_11K_LOW = 3, -+ INTEL_XBOX = 4, -+ NHM_DBG = 5, /*@manual trigger*/ -+}; -+ -+enum clm_application { -+ CLM_BACKGROUND = 0,/*@default*/ -+ CLM_ACS = 1, -+}; -+ -+enum fahm_application { -+ FAHM_BACKGROUND = 0,/*default*/ -+ FAHM_ACS = 1, -+ FAHM_DBG = 2, /*manual trigger*/ -+}; -+ -+enum ifs_clm_application { -+ IFS_CLM_BACKGROUND = 0,/*default*/ -+ IFS_CLM_ACS = 1, -+ IFS_CLM_HP_TAS = 2, -+ IFS_CLM_DBG = 3, -+}; -+ -+enum clm_monitor_mode { -+ CLM_DRIVER_MNTR = 1, -+ CLM_FW_MNTR = 2 -+}; -+ -+enum phydm_ifs_clm_unit { -+ IFS_CLM_4 = 0, /*4us*/ -+ IFS_CLM_8 = 1, /*8us*/ -+ IFS_CLM_12 = 2, /*12us*/ -+ IFS_CLM_16 = 3, /*16us*/ -+ IFS_CLM_INIT -+}; -+ -+enum edcca_clm_application { -+ EDCCA_CLM_BACKGROUND = 0,/*@default*/ -+ EDCCA_CLM_ACS = 1, -+ EDCCA_CLM_DBG = 2, -+}; -+ -+/* @1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+struct env_trig_rpt { -+ u8 nhm_rpt_stamp; -+ u8 clm_rpt_stamp; -+}; -+ -+struct env_mntr_rpt { -+ u8 nhm_ratio; -+ u8 nhm_env_ratio; /*exclude nhm_r[0] above -80dBm or first cluster under -80dBm*/ -+ u8 nhm_idle_ratio; -+ u8 nhm_tx_ratio; -+ u8 nhm_result[NHM_RPT_NUM]; -+ u8 clm_ratio; -+ u8 nhm_rpt_stamp; -+ u8 clm_rpt_stamp; -+ u8 nhm_noise_pwr; /*including r[0]~r[10]*/ -+ u8 nhm_pwr; /*including r[0]~r[11]*/ -+}; -+ -+struct enhance_mntr_trig_rpt { -+ u8 nhm_rpt_stamp; -+ u8 clm_rpt_stamp; -+ u8 fahm_rpt_stamp; -+ u8 ifs_clm_rpt_stamp; -+}; -+ -+struct enhance_mntr_rpt { -+ u8 nhm_ratio; -+ u8 nhm_env_ratio; /*exclude nhm_r[0] above -80dBm or first cluster under -80dBm*/ -+ u8 nhm_idle_ratio; -+ u8 nhm_tx_ratio; -+ u8 nhm_result[NHM_RPT_NUM]; -+ u8 clm_ratio; -+ u8 nhm_rpt_stamp; -+ u8 clm_rpt_stamp; -+ u8 nhm_noise_pwr; /*including r[0]~r[10]*/ -+ u8 nhm_pwr; /*including r[0]~r[11]*/ -+ u16 fahm_result[NHM_RPT_NUM]; -+ u8 fahm_rpt_stamp; -+ u8 fahm_pwr; -+ u8 fahm_ratio; -+ u8 fahm_denom_ratio; -+ u8 fahm_inclu_cck; -+ u8 ifs_clm_rpt_stamp; -+ u8 ifs_clm_tx_ratio; -+ u8 ifs_clm_edcca_excl_cca_ratio; -+ u8 ifs_clm_cck_fa_ratio; -+ u8 ifs_clm_cck_cca_excl_fa_ratio; -+ u8 ifs_clm_ofdm_fa_ratio; -+ u8 ifs_clm_ofdm_cca_excl_fa_ratio; -+}; -+ -+struct nhm_para_info { -+ enum nhm_option_txon_all incld_txon; /*@Include TX on*/ -+ enum nhm_option_cca_all incld_cca; /*@Include CCA*/ -+ enum nhm_divider_opt_all div_opt; /*@divider option*/ -+ enum nhm_application nhm_app; -+ enum phydm_nhm_level nhm_lv; -+ u16 mntr_time; /*@0~262 unit ms*/ -+ boolean en_1db_mode; -+ u8 nhm_th0_manual; /* for 1-db mode*/ -+}; -+ -+struct clm_para_info { -+ enum clm_application clm_app; -+ enum phydm_clm_level clm_lv; -+ u16 mntr_time; /*@0~262 unit ms*/ -+}; -+ -+struct fahm_para_info { -+ enum fahm_application app; -+ enum phydm_fahm_level lv; -+ u16 mntr_time; /*0~262 unit ms*/ -+ u8 numer_opt; -+ u8 denom_opt; -+ boolean en_1db_mode; -+ u8 th0_manual;/* for 1-db mode*/ -+}; -+ -+struct ifs_clm_para_info { -+ enum ifs_clm_application ifs_clm_app; -+ enum phydm_ifs_clm_level ifs_clm_lv; -+ enum phydm_ifs_clm_unit ifs_clm_ctrl_unit; /*unit*/ -+ u16 mntr_time; /*ms*/ -+ boolean ifs_clm_th_en[IFS_CLM_NUM]; -+ u16 ifs_clm_th_low[IFS_CLM_NUM]; -+ u16 ifs_clm_th_high[IFS_CLM_NUM]; -+ s16 th_shift; -+}; -+ -+struct edcca_clm_para_info { -+ enum edcca_clm_application edcca_clm_app; -+ enum phydm_edcca_clm_level edcca_clm_lv; -+}; -+ -+struct ccx_info { -+ u32 nhm_trigger_time; -+ u32 clm_trigger_time; -+ u32 fahm_trigger_time; -+ u32 ifs_clm_trigger_time; -+ u32 edcca_clm_trigger_time; -+ u64 start_time; /*@monitor for the test duration*/ -+ u8 ccx_watchdog_result; -+#ifdef NHM_SUPPORT -+ enum nhm_application nhm_app; -+ enum nhm_option_txon_all nhm_include_txon; -+ enum nhm_option_cca_all nhm_include_cca; -+ enum nhm_divider_opt_all nhm_divider_opt; -+ /*Report*/ -+ u8 nhm_th[NHM_TH_NUM]; -+ u8 nhm_result[NHM_RPT_NUM]; -+ u8 nhm_wgt[NHM_RPT_NUM]; -+ u16 nhm_period; /* @4us per unit */ -+ u8 nhm_igi; -+ u8 nhm_manual_ctrl; -+ u8 nhm_ratio; /*@1% per nuit, it means the interference igi can't overcome.*/ -+ u8 nhm_env_ratio; /*exclude nhm_r[0] above -80dBm or first cluster under -80dBm*/ -+ u8 nhm_idle_ratio; -+ u8 nhm_tx_ratio; -+ u8 nhm_rpt_sum; -+ u16 nhm_duration; /*@Real time of NHM_VALID */ -+ u8 nhm_set_lv; -+ boolean nhm_ongoing; -+ u8 nhm_rpt_stamp; -+ u8 nhm_level; /*including r[0]~r[10]*/ -+ u8 nhm_level_valid; -+ u8 nhm_pwr; /*including r[0]~r[11]*/ -+#ifdef NHM_DYM_PW_TH_SUPPORT -+ boolean nhm_dym_pw_th_en; -+ boolean dym_pwth_manual_ctrl; -+ u8 pw_th_rf20_ori; -+ u8 pw_th_rf20_cur; -+ u8 nhm_pw_th_max; -+ u8 nhm_period_decre; -+ u8 nhm_sl_pw_th; -+#endif -+#endif -+ -+#ifdef CLM_SUPPORT -+ enum clm_application clm_app; -+ u8 clm_manual_ctrl; -+ u8 clm_set_lv; -+ boolean clm_ongoing; -+ u16 clm_period; /* @4us per unit */ -+ u16 clm_result; -+ u8 clm_ratio; -+ u32 clm_fw_result_acc; -+ u8 clm_fw_result_cnt; -+ enum clm_monitor_mode clm_mntr_mode; -+ u8 clm_rpt_stamp; -+#endif -+#ifdef FAHM_SUPPORT -+ enum fahm_application fahm_app; -+ boolean fahm_ongoing; -+ u8 fahm_numer_opt; -+ u8 fahm_denom_opt; -+ boolean fahm_inclu_cck; -+ u8 fahm_th[NHM_TH_NUM]; -+ u16 fahm_result[NHM_RPT_NUM]; -+ u16 fahm_result_sum; -+ u16 fahm_denom_result; -+ u16 fahm_period; /*unit: 4us*/ -+ u8 fahm_igi; -+ u8 fahm_manual_ctrl; -+ u8 fahm_set_lv; -+ u8 fahm_rpt_stamp; -+ u8 fahm_pwr; /*including r[0]~r[11]*/ -+ u8 fahm_ratio; -+ u8 fahm_denom_ratio; -+#endif -+#ifdef IFS_CLM_SUPPORT -+ enum ifs_clm_application ifs_clm_app; -+ /*Control*/ -+ enum phydm_ifs_clm_unit ifs_clm_ctrl_unit; /*4,8,12,16us per unit*/ -+ u16 ifs_clm_period; -+ boolean ifs_clm_th_en[IFS_CLM_NUM]; -+ u16 ifs_clm_th_low[IFS_CLM_NUM]; -+ u16 ifs_clm_th_high[IFS_CLM_NUM]; -+ /*Flow control*/ -+ u8 ifs_clm_set_lv; -+ u8 ifs_clm_manual_ctrl; -+ boolean ifs_clm_ongoing; -+ /*Report*/ -+ u8 ifs_clm_rpt_stamp; -+ u16 ifs_clm_tx; -+ u16 ifs_clm_edcca_excl_cca; -+ u16 ifs_clm_ofdmfa; -+ u16 ifs_clm_ofdmcca_excl_fa; -+ u16 ifs_clm_cckfa; -+ u16 ifs_clm_cckcca_excl_fa; -+ u8 ifs_clm_his[IFS_CLM_NUM]; /*trx_neg_edge to CCA/FA posedge per times*/ -+ u16 ifs_clm_total_cca; -+ u16 ifs_clm_avg[IFS_CLM_NUM]; /*4,8,12,16us per unit*/ -+ u16 ifs_clm_avg_cca[IFS_CLM_NUM]; /*4,8,12,16us per unit*/ -+ u8 ifs_clm_tx_ratio; -+ u8 ifs_clm_edcca_excl_cca_ratio; -+ u8 ifs_clm_cck_fa_ratio; -+ u8 ifs_clm_cck_cca_excl_fa_ratio; -+ u8 ifs_clm_ofdm_fa_ratio; -+ u8 ifs_clm_ofdm_cca_excl_fa_ratio; -+#endif -+#ifdef EDCCA_CLM_SUPPORT -+ enum edcca_clm_application edcca_clm_app; -+ u8 edcca_clm_manual_ctrl; -+ u8 edcca_clm_set_lv; -+ boolean edcca_clm_ongoing; -+ u16 edcca_clm_result; -+ u8 edcca_clm_ratio; -+ u8 edcca_clm_rpt_stamp; -+#endif -+}; -+ -+/* @1 ============================================================ -+ * 1 Function Prototype -+ * 1 ============================================================ -+ */ -+ -+#ifdef FAHM_SUPPORT -+void phydm_fahm_init(void *dm_void); -+ -+void phydm_fahm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len); -+#endif -+ -+#ifdef NHM_SUPPORT -+void phydm_nhm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len); -+u8 phydm_get_igi(void *dm_void, enum bb_path path); -+#endif -+ -+#ifdef CLM_SUPPORT -+void phydm_clm_c2h_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len); -+ -+void phydm_clm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len); -+#endif -+ -+u8 phydm_env_mntr_trigger(void *dm_void, struct nhm_para_info *nhm_para, -+ struct clm_para_info *clm_para, -+ struct env_trig_rpt *rpt); -+ -+u8 phydm_env_mntr_result(void *dm_void, struct env_mntr_rpt *rpt); -+ -+void phydm_env_mntr_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+#ifdef IFS_CLM_SUPPORT -+void phydm_ifs_clm_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#endif -+ -+u8 phydm_enhance_mntr_trigger(void *dm_void, -+ struct nhm_para_info *nhm_para, -+ struct clm_para_info *clm_para, -+ struct fahm_para_info *fahm_para, -+ struct ifs_clm_para_info *ifs_clm_para, -+ struct enhance_mntr_trig_rpt *trig_rpt); -+ -+u8 phydm_enhance_mntr_result(void *dm_void, struct enhance_mntr_rpt *rpt); -+ -+void phydm_enhance_mntr_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+#ifdef EDCCA_CLM_SUPPORT -+void phydm_edcca_clm_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#endif -+ -+void phydm_env_mntr_result_watchdog(void *dm_void); -+ -+void phydm_env_mntr_set_watchdog(void *dm_void); -+ -+u8 phydm_env_mntr_get_802_11_k_rsni(void *dm_void, s8 rcpi, s8 anpi); -+ -+void phydm_env_monitor_init(void *dm_void); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cfotracking.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cfotracking.c -new file mode 100644 -index 000000000..766511a4a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cfotracking.c -@@ -0,0 +1,627 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+s32 phydm_get_cfo_hz(void *dm_void, u32 val, u8 bit_num, u8 frac_num) -+{ -+ s32 val_s = 0; -+ -+ val_s = phydm_cnvrt_2_sign(val, bit_num); -+ -+ if (frac_num == 10) /*@ (X*312500)/1024 ~= X*305*/ -+ val_s *= 305; -+ else if (frac_num == 11) /*@ (X*312500)/2048 ~= X*152*/ -+ val_s *= 152; -+ else if (frac_num == 12) /*@ (X*312500)/4096 ~= X*76*/ -+ val_s *= 76; -+ -+ return val_s; -+} -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT) -+void phydm_get_cfo_info_ac(void *dm_void, struct phydm_cfo_rpt *cfo) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ u32 val[4] = {0}; -+ u32 val_1[4] = {0}; -+ u32 val_2[4] = {0}; -+ u32 val_tmp = 0; -+ -+ val[0] = odm_read_4byte(dm, R_0xd0c); -+ val_1[0] = odm_read_4byte(dm, R_0xd10); -+ val_2[0] = odm_get_bb_reg(dm, R_0xd14, 0x1fff0000); -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ val[1] = odm_read_4byte(dm, R_0xd4c); -+ val_1[1] = odm_read_4byte(dm, R_0xd50); -+ val_2[1] = odm_get_bb_reg(dm, R_0xd54, 0x1fff0000); -+ #endif -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ val[2] = odm_read_4byte(dm, R_0xd8c); -+ val_1[2] = odm_read_4byte(dm, R_0xd90); -+ val_2[2] = odm_get_bb_reg(dm, R_0xd94, 0x1fff0000); -+ #endif -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ val[3] = odm_read_4byte(dm, R_0xdcc); -+ val_1[3] = odm_read_4byte(dm, R_0xdd0); -+ val_2[3] = odm_get_bb_reg(dm, R_0xdd4, 0x1fff0000); -+ #endif -+ -+ for (i = 0; i < dm->num_rf_path; i++) { -+ val_tmp = val[i] & 0xfff; /*@ Short CFO, S(12,11)*/ -+ cfo->cfo_rpt_s[i] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); -+ -+ val_tmp = val[i] >> 16; /*@ Long CFO, S(13,12)*/ -+ cfo->cfo_rpt_l[i] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); -+ -+ val_tmp = val_1[i] & 0x7ff; /*@ SCFO, S(11,10)*/ -+ cfo->cfo_rpt_sec[i] = phydm_get_cfo_hz(dm, val_tmp, 11, 10); -+ -+ val_tmp = val_1[i] >> 16; /*@ Acq CFO, S(13,12)*/ -+ cfo->cfo_rpt_acq[i] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); -+ -+ val_tmp = val_2[i]; /*@ End CFO, S(13,12)*/ -+ cfo->cfo_rpt_end[i] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); -+ } -+} -+#endif -+ -+#if (ODM_IC_11N_SERIES_SUPPORT) -+void phydm_get_cfo_info_n(void *dm_void, struct phydm_cfo_rpt *cfo) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 val[5] = {0}; -+ u32 val_tmp = 0; -+ -+ odm_set_bb_reg(dm, R_0xd00, BIT(26), 1); -+ -+ val[0] = odm_read_4byte(dm, R_0xdac); /*@ Short CFO*/ -+ val[1] = odm_read_4byte(dm, R_0xdb0); /*@ Long CFO*/ -+ val[2] = odm_read_4byte(dm, R_0xdb8); /*@ Sec CFO*/ -+ val[3] = odm_read_4byte(dm, R_0xde0); /*@ Acq CFO*/ -+ val[4] = odm_read_4byte(dm, R_0xdbc); /*@ End CFO*/ -+ -+ /*@[path-A]*/ -+ if (dm->support_ic_type & (ODM_RTL8721D | ODM_RTL8710C)) { -+ val_tmp = (val[0] & 0x0fff0000) >> 16; /*@ Short CFO, S(12,11)*/ -+ cfo->cfo_rpt_s[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); -+ val_tmp = (val[1] & 0x0fff0000) >> 16; /*@ Long CFO, S(12,11)*/ -+ cfo->cfo_rpt_l[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); -+ val_tmp = (val[2] & 0x0fff0000) >> 16; /*@ Sec CFO, S(12,11)*/ -+ cfo->cfo_rpt_sec[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); -+ val_tmp = (val[3] & 0x0fff0000) >> 16; /*@ Acq CFO, S(12,11)*/ -+ cfo->cfo_rpt_acq[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); -+ val_tmp = (val[4] & 0x0fff0000) >> 16; /*@ Acq CFO, S(12,11)*/ -+ cfo->cfo_rpt_end[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); -+ } else { -+ val_tmp = (val[0] & 0x0fff0000) >> 16; /*@ Short CFO, S(12,11)*/ -+ cfo->cfo_rpt_s[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); -+ val_tmp = (val[1] & 0x1fff0000) >> 16; /*@ Long CFO, S(13,12)*/ -+ cfo->cfo_rpt_l[0] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); -+ val_tmp = (val[2] & 0x7ff0000) >> 16; /*@ Sec CFO, S(11,10)*/ -+ cfo->cfo_rpt_sec[0] = phydm_get_cfo_hz(dm, val_tmp, 11, 10); -+ val_tmp = (val[3] & 0x1fff0000) >> 16; /*@ Acq CFO, S(13,12)*/ -+ cfo->cfo_rpt_acq[0] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); -+ val_tmp = (val[4] & 0x1fff0000) >> 16; /*@ Acq CFO, S(13,12)*/ -+ cfo->cfo_rpt_end[0] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); -+ } -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ /*@[path-B]*/ -+ val_tmp = val[0] & 0xfff; /*@ Short CFO, S(12,11)*/ -+ cfo->cfo_rpt_s[1] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); -+ val_tmp = val[1] & 0x1fff; /*@ Long CFO, S(13,12)*/ -+ cfo->cfo_rpt_l[1] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); -+ val_tmp = val[2] & 0x7ff; /*@ Sec CFO, S(11,10)*/ -+ cfo->cfo_rpt_sec[1] = phydm_get_cfo_hz(dm, val_tmp, 11, 10); -+ val_tmp = val[3] & 0x1fff; /*@ Acq CFO, S(13,12)*/ -+ cfo->cfo_rpt_acq[1] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); -+ val_tmp = val[4] & 0x1fff; /*@ Acq CFO, S(13,12)*/ -+ cfo->cfo_rpt_end[1] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); -+ #endif -+} -+ -+void phydm_set_atc_status(void *dm_void, boolean atc_status) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; -+ u32 reg_tmp = 0; -+ u32 mask_tmp = 0; -+ -+ PHYDM_DBG(dm, DBG_CFO_TRK, "[%s]ATC_en=%d\n", __func__, atc_status); -+ -+ if (cfo_track->is_atc_status == atc_status) -+ return; -+ -+ reg_tmp = ODM_REG(BB_ATC, dm); -+ mask_tmp = ODM_BIT(BB_ATC, dm); -+ odm_set_bb_reg(dm, reg_tmp, mask_tmp, atc_status); -+ cfo_track->is_atc_status = atc_status; -+} -+ -+boolean -+phydm_get_atc_status(void *dm_void) -+{ -+ boolean atc_status = false; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 reg_tmp = 0; -+ u32 mask_tmp = 0; -+ -+ reg_tmp = ODM_REG(BB_ATC, dm); -+ mask_tmp = ODM_BIT(BB_ATC, dm); -+ -+ atc_status = (boolean)odm_get_bb_reg(dm, reg_tmp, mask_tmp); -+ -+ PHYDM_DBG(dm, DBG_CFO_TRK, "[%s]atc_status=%d\n", __func__, atc_status); -+ return atc_status; -+} -+#endif -+ -+void phydm_get_cfo_info(void *dm_void, struct phydm_cfo_rpt *cfo) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ switch (dm->ic_ip_series) { -+ #if (ODM_IC_11N_SERIES_SUPPORT) -+ case PHYDM_IC_N: -+ phydm_get_cfo_info_n(dm, cfo); -+ break; -+ #endif -+ #if (ODM_IC_11AC_SERIES_SUPPORT) -+ case PHYDM_IC_AC: -+ phydm_get_cfo_info_ac(dm, cfo); -+ break; -+ #endif -+ default: -+ break; -+ } -+} -+ -+boolean -+phydm_set_crystal_cap_reg(void *dm_void, u8 crystal_cap) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; -+ u32 reg_val = 0; -+ -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | -+ ODM_RTL8195B | ODM_RTL8812F | ODM_RTL8721D | -+ ODM_RTL8710C | ODM_RTL8723F | ODM_RTL8814C)) { -+ crystal_cap &= 0x7F; -+ reg_val = crystal_cap | (crystal_cap << 7); -+ } else { -+ crystal_cap &= 0x3F; -+ reg_val = crystal_cap | (crystal_cap << 6); -+ } -+ -+ cfo_track->crystal_cap = crystal_cap; -+ -+ if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8188F)) { -+ #if (RTL8188E_SUPPORT || RTL8188F_SUPPORT) -+ /* write 0x24[22:17] = 0x24[16:11] = crystal_cap */ -+ odm_set_mac_reg(dm, R_0x24, 0x7ff800, reg_val); -+ #endif -+ } -+ #if (RTL8812A_SUPPORT) -+ else if (dm->support_ic_type & ODM_RTL8812) { -+ /* write 0x2C[30:25] = 0x2C[24:19] = crystal_cap */ -+ odm_set_mac_reg(dm, R_0x2c, 0x7FF80000, reg_val); -+ } -+ #endif -+ #if (RTL8703B_SUPPORT || RTL8723B_SUPPORT || RTL8192E_SUPPORT ||\ -+ RTL8821A_SUPPORT || RTL8723D_SUPPORT) -+ else if ((dm->support_ic_type & -+ (ODM_RTL8703B | ODM_RTL8723B | ODM_RTL8192E | ODM_RTL8821 | -+ ODM_RTL8723D))) { -+ /* @0x2C[23:18] = 0x2C[17:12] = crystal_cap */ -+ odm_set_mac_reg(dm, R_0x2c, 0x00FFF000, reg_val); -+ } -+ #endif -+ #if (RTL8814A_SUPPORT) -+ else if (dm->support_ic_type & ODM_RTL8814A) { -+ /* write 0x2C[26:21] = 0x2C[20:15] = crystal_cap */ -+ odm_set_mac_reg(dm, R_0x2c, 0x07FF8000, reg_val); -+ } -+ #endif -+ #if (RTL8822B_SUPPORT || RTL8821C_SUPPORT || RTL8197F_SUPPORT ||\ -+ RTL8192F_SUPPORT || RTL8197G_SUPPORT || RTL8198F_SUPPORT) -+ else if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C | -+ ODM_RTL8197F | ODM_RTL8192F | ODM_RTL8197G | ODM_RTL8198F)) { -+ /* write 0x24[30:25] = 0x28[6:1] = crystal_cap */ -+ odm_set_mac_reg(dm, R_0x24, 0x7e000000, crystal_cap); -+ odm_set_mac_reg(dm, R_0x28, 0x7e, crystal_cap); -+ } -+ #endif -+ #if (RTL8710B_SUPPORT) -+ else if (dm->support_ic_type & (ODM_RTL8710B)) { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ /* write 0x60[29:24] = 0x60[23:18] = crystal_cap */ -+ HAL_SetSYSOnReg(dm->adapter, R_0x60, 0x3FFC0000, reg_val); -+ #endif -+ } -+ #endif -+ #if (RTL8195B_SUPPORT) -+ else if (dm->support_ic_type & ODM_RTL8195B) { -+ phydm_set_crystalcap(dm, (u8)(reg_val & 0x7f)); -+ } -+ #endif -+ #if (RTL8721D_SUPPORT) -+ else if (dm->support_ic_type & (ODM_RTL8721D)) { -+ /* write 0x4800_0228[30:24] crystal_cap */ -+ /*HAL_SetSYSOnReg(dm->adapter, */ -+ /*REG_SYS_XTAL_8721d, 0x7F000000, crystal_cap);*/ -+ u32 temp_val = HAL_READ32(SYSTEM_CTRL_BASE_LP, -+ REG_SYS_EFUSE_SYSCFG2); -+ temp_val = ((crystal_cap << 24) & 0x7F000000) -+ | (temp_val & (~0x7F000000)); -+ HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_SYS_EFUSE_SYSCFG2, -+ temp_val); -+ } -+ #endif -+ #if (RTL8710C_SUPPORT) -+ else if (dm->support_ic_type & (ODM_RTL8710C)) { -+ /* write MAC reg 0x28[13:7][6:0] crystal_cap */ -+ phydm_set_crystalcap(dm, (u8)(reg_val & 0x7f)); -+ } -+ #endif -+ #if (RTL8723F_SUPPORT) -+ else if (dm->support_ic_type & ODM_RTL8723F) { -+ /* write 0x103c[23:17] = 0x103c[16:10] = crystal_cap */ -+ odm_set_mac_reg(dm, R_0x103c, 0x00FFFC00, reg_val); -+ } -+ #endif -+#if (RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8812F_SUPPORT) -+ else if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | -+ ODM_RTL8812F | ODM_RTL8814C)) { -+ /* write 0x1040[23:17] = 0x1040[16:10] = crystal_cap */ -+ odm_set_mac_reg(dm, R_0x1040, 0x00FFFC00, reg_val); -+ } else { -+ return false; -+ } -+#endif -+ return true; -+} -+ -+void phydm_set_crystal_cap(void *dm_void, u8 crystal_cap) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; -+ -+ if (cfo_track->crystal_cap == crystal_cap) -+ return; -+ -+ if (phydm_set_crystal_cap_reg(dm, crystal_cap)) -+ PHYDM_DBG(dm, DBG_CFO_TRK, "Set crystal_cap = 0x%x\n", -+ cfo_track->crystal_cap); -+ else -+ PHYDM_DBG(dm, DBG_CFO_TRK, "Set fail\n"); -+} -+ -+void phydm_cfo_tracking_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; -+ -+ PHYDM_DBG(dm, DBG_CFO_TRK, "%s ======>\n", __func__); -+ -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | ODM_RTL8195B | -+ ODM_RTL8812F | ODM_RTL8710C | ODM_RTL8721D | ODM_RTL8723F | -+ ODM_RTL8814C)) -+ cfo_track->def_x_cap = cfo_track->crystal_cap_default & 0x7f; -+ else -+ cfo_track->def_x_cap = cfo_track->crystal_cap_default & 0x3f; -+ -+ cfo_track->is_adjust = true; -+ -+ if (cfo_track->crystal_cap > cfo_track->def_x_cap) { -+ phydm_set_crystal_cap(dm, cfo_track->crystal_cap - 1); -+ PHYDM_DBG(dm, DBG_CFO_TRK, "approch to Init-val (0x%x)\n", -+ cfo_track->crystal_cap); -+ -+ } else if (cfo_track->crystal_cap < cfo_track->def_x_cap) { -+ phydm_set_crystal_cap(dm, cfo_track->crystal_cap + 1); -+ PHYDM_DBG(dm, DBG_CFO_TRK, "approch to init-val 0x%x\n", -+ cfo_track->crystal_cap); -+ } -+ -+#if ODM_IC_11N_SERIES_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) -+ phydm_set_atc_status(dm, true); -+#endif -+#endif -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_AP)) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ /*Disable advance time for CFO residual*/ -+ odm_set_bb_reg(dm, R_0xc2c, BIT29, 0x0); -+ } -+#endif -+#endif -+} -+ -+void phydm_cfo_tracking_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; -+ -+ PHYDM_DBG(dm, DBG_CFO_TRK, "[%s]=========>\n", __func__); -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | ODM_RTL8195B | -+ ODM_RTL8812F | ODM_RTL8710C | ODM_RTL8721D | ODM_RTL8723F | -+ ODM_RTL8814C)) -+ cfo_track->crystal_cap = cfo_track->crystal_cap_default & 0x7f; -+ else -+ cfo_track->crystal_cap = cfo_track->crystal_cap_default & 0x3f; -+ -+ cfo_track->def_x_cap = cfo_track->crystal_cap; -+ cfo_track->is_adjust = true; -+ PHYDM_DBG(dm, DBG_CFO_TRK, "crystal_cap=0x%x\n", cfo_track->def_x_cap); -+ -+#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT) -+ /* @Crystal cap. control by WiFi */ -+ if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) -+ odm_set_mac_reg(dm, R_0x10, 0x40, 0x1); -+#endif -+} -+ -+void phydm_cfo_tracking(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; -+ s32 cfo_avg = 0, cfo_path_sum = 0, cfo_abs = 0; -+ u32 cfo_rpt_sum = 0, cfo_khz_avg[4] = {0}; -+ s8 crystal_cap = cfo_track->crystal_cap; -+ u8 i = 0, valid_path_cnt = 0; -+ -+ if (!(dm->support_ability & ODM_BB_CFO_TRACKING)) -+ return; -+ -+ PHYDM_DBG(dm, DBG_CFO_TRK, "%s ======>\n", __func__); -+ -+ if (!dm->is_linked || !dm->is_one_entry_only) { -+ phydm_cfo_tracking_reset(dm); -+ PHYDM_DBG(dm, DBG_CFO_TRK, "is_linked=%d, one_entry_only=%d\n", -+ dm->is_linked, dm->is_one_entry_only); -+ -+ } else { -+ /* No new packet */ -+ if (cfo_track->packet_count == cfo_track->packet_count_pre) { -+ PHYDM_DBG(dm, DBG_CFO_TRK, "Pkt cnt doesn't change\n"); -+ return; -+ } -+ cfo_track->packet_count_pre = cfo_track->packet_count; -+ -+ /*@Calculate CFO */ -+ for (i = 0; i < dm->num_rf_path; i++) { -+ if (!(dm->rx_ant_status & BIT(i))) -+ continue; -+ -+ valid_path_cnt++; -+ -+ if (cfo_track->CFO_tail[i] < 0) -+ cfo_abs = 0 - cfo_track->CFO_tail[i]; -+ else -+ cfo_abs = cfo_track->CFO_tail[i]; -+ -+ cfo_rpt_sum = (u32)CFO_HW_RPT_2_KHZ(cfo_abs); -+ cfo_khz_avg[i] = PHYDM_DIV(cfo_rpt_sum, -+ cfo_track->CFO_cnt[i]); -+ -+ PHYDM_DBG(dm, DBG_CFO_TRK, -+ "[Path-%d] CFO_sum=((%d)), cnt=((%d)), CFO_avg=((%s%d))kHz\n", -+ i, cfo_rpt_sum, cfo_track->CFO_cnt[i], -+ ((cfo_track->CFO_tail[i] < 0) ? "-" : " "), -+ cfo_khz_avg[i]); -+ -+ if (cfo_track->CFO_tail[i] < 0) -+ cfo_path_sum += (0 - (s32)cfo_khz_avg[i]); -+ else -+ cfo_path_sum += (s32)cfo_khz_avg[i]; -+ } -+ -+ if (valid_path_cnt >= 2) -+ cfo_avg = cfo_path_sum / valid_path_cnt; -+ else -+ cfo_avg = cfo_path_sum; -+ -+ cfo_track->CFO_ave_pre = cfo_avg; -+ -+ PHYDM_DBG(dm, DBG_CFO_TRK, "path_cnt=%d, CFO_avg_path=%d kHz\n", -+ valid_path_cnt, cfo_avg); -+ -+ /*reset counter*/ -+ for (i = 0; i < dm->num_rf_path; i++) { -+ cfo_track->CFO_tail[i] = 0; -+ cfo_track->CFO_cnt[i] = 0; -+ } -+ -+ /* To adjust crystal cap or not */ -+ if (!cfo_track->is_adjust) { -+ if (cfo_avg > CFO_TRK_ENABLE_TH || -+ cfo_avg < (-CFO_TRK_ENABLE_TH)) -+ cfo_track->is_adjust = true; -+ } else { -+ if (cfo_avg <= CFO_TRK_STOP_TH && -+ cfo_avg >= (-CFO_TRK_STOP_TH)) -+ cfo_track->is_adjust = false; -+ } -+ -+ #ifdef ODM_CONFIG_BT_COEXIST -+ /*@BT case: Disable CFO tracking */ -+ if (dm->bt_info_table.is_bt_enabled) { -+ cfo_track->is_adjust = false; -+ phydm_set_crystal_cap(dm, cfo_track->def_x_cap); -+ PHYDM_DBG(dm, DBG_CFO_TRK, "[BT]Disable CFO_track\n"); -+ } -+ #endif -+ -+ /*@Adjust Crystal Cap. */ -+ if (cfo_track->is_adjust) { -+ if (cfo_avg > CFO_TRK_STOP_TH) -+ crystal_cap += 1; -+ else if (cfo_avg < (-CFO_TRK_STOP_TH)) -+ crystal_cap -= 1; -+ -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | -+ ODM_RTL8195B | ODM_RTL8812F | ODM_RTL8710C | -+ ODM_RTL8721D | ODM_RTL8723F | ODM_RTL8814C)) { -+ if (crystal_cap > 0x7F) -+ crystal_cap = 0x7F; -+ } else { -+ if (crystal_cap > 0x3F) -+ crystal_cap = 0x3F; -+ } -+ if (crystal_cap < 0) -+ crystal_cap = 0; -+ -+ phydm_set_crystal_cap(dm, (u8)crystal_cap); -+ } -+ -+ PHYDM_DBG(dm, DBG_CFO_TRK, "X_cap{Curr,Default}={0x%x,0x%x}\n", -+ cfo_track->crystal_cap, cfo_track->def_x_cap); -+ -+ /* @Dynamic ATC switch */ -+ #if ODM_IC_11N_SERIES_SUPPORT -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ if (cfo_avg < CFO_TH_ATC && cfo_avg > -CFO_TH_ATC) -+ phydm_set_atc_status(dm, false); -+ else -+ phydm_set_atc_status(dm, true); -+ -+ } -+ #endif -+ #endif -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_AP)) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ //Disable advance time for CFO residual -+ odm_set_bb_reg(dm, R_0xc2c, BIT29, 0x0); -+ } -+ #endif -+ #endif -+ } -+} -+ -+void phydm_parsing_cfo(void *dm_void, void *pktinfo_void, s8 *pcfotail, -+ u8 num_ss) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; -+ boolean valid_info = false; -+ u8 i = 0; -+ -+ if (!(dm->support_ability & ODM_BB_CFO_TRACKING)) -+ return; -+ -+ pktinfo = (struct phydm_perpkt_info_struct *)pktinfo_void; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) -+ if (pktinfo->is_packet_match_bssid) -+ valid_info = true; -+#else -+ if (dm->number_active_client == 1) -+ valid_info = true; -+#endif -+ if (valid_info) { -+ if (num_ss > dm->num_rf_path) /*@For fool proof*/ -+ num_ss = dm->num_rf_path; -+ #if 0 -+ PHYDM_DBG(dm, DBG_CFO_TRK, "num_ss=%d, num_rf_path=%d\n", -+ num_ss, dm->num_rf_path); -+ #endif -+ -+ /* @ Update CFO report for path-A & path-B */ -+ /* Only paht-A and path-B have CFO tail and short CFO */ -+ for (i = 0; i < dm->num_rf_path; i++) { -+ if (!(dm->rx_ant_status & BIT(i))) -+ continue; -+ cfo_track->CFO_tail[i] += pcfotail[i]; -+ cfo_track->CFO_cnt[i]++; -+ #if 0 -+ PHYDM_DBG(dm, DBG_CFO_TRK, -+ "[ID %d][path %d][rate 0x%x] CFO_tail = ((%d)), CFO_tail_sum = ((%d)), CFO_cnt = ((%d))\n", -+ pktinfo->station_id, i, pktinfo->data_rate, -+ pcfotail[i], cfo_track->CFO_tail[i], -+ cfo_track->CFO_cnt[i]); -+ #endif -+ } -+ -+ /* @ Update packet counter */ -+ if (cfo_track->packet_count == 0xffffffff) -+ cfo_track->packet_count = 0; -+ else -+ cfo_track->packet_count++; -+ } -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phy_Init_crystal_capacity(void *dm_void, u8 crystal_cap) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!phydm_set_crystal_cap_reg(dm, crystal_cap)) -+ RT_TRACE_F(COMP_INIT, DBG_SERIOUS, -+ ("Crystal is not initialized!\n")); -+} -+#endif -+ -+void phydm_cfo_tracking_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "set Xcap: {1}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "show Xcap: {100}\n"); -+ } else { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if (var1[0] == 1) { -+ PHYDM_SSCANF(input[2], DCMD_HEX, &var1[1]); -+ phydm_set_crystal_cap(dm, (u8)var1[1]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set X_cap=0x%x\n", cfo_track->crystal_cap); -+ } else if (var1[0] == 100) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "X_cap=0x%x\n", cfo_track->crystal_cap); -+ } -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cfotracking.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cfotracking.h -new file mode 100644 -index 000000000..253f3ba3e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_cfotracking.h -@@ -0,0 +1,74 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMCFOTRACK_H__ -+#define __PHYDMCFOTRACK_H__ -+ -+/* 2019.03.28 fix 8197G crystal_cap register address*/ -+#define CFO_TRACKING_VERSION "2.4" -+ -+#define CFO_TRK_ENABLE_TH 20 /* @kHz enable CFO_Track threshold*/ -+#define CFO_TRK_STOP_TH 10 /* @kHz disable CFO_Track threshold*/ -+#define CFO_TH_ATC 80 /* @kHz */ -+ -+struct phydm_cfo_track_struct { -+ boolean is_atc_status; -+ boolean is_adjust; /*@already modify crystal cap*/ -+ u8 crystal_cap; -+ u8 crystal_cap_default; -+ u8 def_x_cap; -+ s32 CFO_tail[4]; -+ u32 CFO_cnt[4]; -+ s32 CFO_ave_pre; -+ u32 packet_count; -+ u32 packet_count_pre; -+}; -+ -+struct phydm_cfo_rpt { -+ s32 cfo_rpt_s[PHYDM_MAX_RF_PATH]; -+ s32 cfo_rpt_l[PHYDM_MAX_RF_PATH]; -+ s32 cfo_rpt_acq[PHYDM_MAX_RF_PATH]; -+ s32 cfo_rpt_sec[PHYDM_MAX_RF_PATH]; -+ s32 cfo_rpt_end[PHYDM_MAX_RF_PATH]; -+}; -+ -+void phydm_get_cfo_info(void *dm_void, struct phydm_cfo_rpt *cfo); -+ -+boolean phydm_set_crystal_cap_reg(void *dm_void, u8 crystal_cap); -+ -+void phydm_set_crystal_cap(void *dm_void, u8 crystal_cap); -+ -+void phydm_cfo_tracking_init(void *dm_void); -+ -+void phydm_cfo_tracking(void *dm_void); -+ -+void phydm_parsing_cfo(void *dm_void, void *pktinfo_void, s8 *pcfotail, -+ u8 num_ss); -+void phydm_cfo_tracking_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phy_Init_crystal_capacity(void *dm_void, u8 crystal_cap); -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_debug.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_debug.c -new file mode 100644 -index 000000000..1d1df021a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_debug.c -@@ -0,0 +1,6229 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+void phydm_init_debug_setting(struct dm_struct *dm) -+{ -+ dm->fw_debug_components = 0; -+ dm->debug_components = -+ -+#if DBG -+ /*@BB Functions*/ -+ /*@DBG_DIG |*/ -+ /*@DBG_RA_MASK |*/ -+ /*@DBG_DYN_TXPWR |*/ -+ /*@DBG_FA_CNT |*/ -+ /*@DBG_RSSI_MNTR |*/ -+ /*@DBG_CCKPD |*/ -+ /*@DBG_ANT_DIV |*/ -+ /*@DBG_SMT_ANT |*/ -+ /*@DBG_PWR_TRAIN |*/ -+ /*@DBG_RA |*/ -+ /*@DBG_PATH_DIV |*/ -+ /*@DBG_DFS |*/ -+ /*@DBG_DYN_ARFR |*/ -+ /*@DBG_ADPTVTY |*/ -+ /*@DBG_CFO_TRK |*/ -+ /*@DBG_ENV_MNTR |*/ -+ /*@DBG_PRI_CCA |*/ -+ /*@DBG_ADPTV_SOML |*/ -+ /*@DBG_LNA_SAT_CHK |*/ -+ /*@DBG_PHY_STATUS |*/ -+ /*@DBG_TMP |*/ -+ /*@DBG_FW_TRACE |*/ -+ /*@DBG_TXBF |*/ -+ /*@DBG_COMMON_FLOW |*/ -+ /*@ODM_PHY_CONFIG |*/ -+ /*@ODM_COMP_INIT |*/ -+ /*@DBG_CMN |*/ -+ /*@ODM_COMP_API |*/ -+#endif -+ 0; -+ -+ dm->fw_buff_is_enpty = true; -+ dm->pre_c2h_seq = 0; -+ dm->c2h_cmd_start = 0; -+ dm->cmn_dbg_msg_cnt = PHYDM_WATCH_DOG_PERIOD; -+ dm->cmn_dbg_msg_period = PHYDM_WATCH_DOG_PERIOD; -+ phydm_reset_rx_rate_distribution(dm); -+} -+ -+void phydm_bb_dbg_port_header_sel(void *dm_void, u32 header_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ odm_set_bb_reg(dm, R_0x8f8, 0x3c00000, header_idx); -+ -+ /*@ -+ * header_idx: -+ * (0:) '{ofdm_dbg[31:0]}' -+ * (1:) '{cca,crc32_fail,dbg_ofdm[29:0]}' -+ * (2:) '{vbon,crc32_fail,dbg_ofdm[29:0]}' -+ * (3:) '{cca,crc32_ok,dbg_ofdm[29:0]}' -+ * (4:) '{vbon,crc32_ok,dbg_ofdm[29:0]}' -+ * (5:) '{dbg_iqk_anta}' -+ * (6:) '{cca,ofdm_crc_ok,dbg_dp_anta[29:0]}' -+ * (7:) '{dbg_iqk_antb}' -+ * (8:) '{DBGOUT_RFC_b[31:0]}' -+ * (9:) '{DBGOUT_RFC_a[31:0]}' -+ * (a:) '{dbg_ofdm}' -+ * (b:) '{dbg_cck}' -+ */ -+ } -+} -+ -+void phydm_bb_dbg_port_clock_en(void *dm_void, u8 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 reg_value = 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_2_SERIES) { -+ /*@enable/disable debug port clock, for power saving*/ -+ reg_value = enable ? 0x7 : 0; -+ odm_set_bb_reg(dm, R_0x198c, 0x7, reg_value); -+ } -+} -+ -+u32 phydm_get_bb_dbg_port_idx(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 val = 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ phydm_bb_dbg_port_clock_en(dm, true); -+ val = odm_get_bb_reg(dm, R_0x8fc, MASKDWORD); -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ val = odm_get_bb_reg(dm, R_0x1c3c, 0xfff00); -+ } else { /*@if (dm->support_ic_type & ODM_IC_11N_SERIES)*/ -+ val = odm_get_bb_reg(dm, R_0x908, MASKDWORD); -+ } -+ return val; -+} -+ -+u8 phydm_set_bb_dbg_port(void *dm_void, u8 curr_dbg_priority, u32 debug_port) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 dbg_port_result = false; -+ -+ if (curr_dbg_priority > dm->pre_dbg_priority) { -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ phydm_bb_dbg_port_clock_en(dm, true); -+ -+ odm_set_bb_reg(dm, R_0x8fc, MASKDWORD, debug_port); -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ odm_set_bb_reg(dm, R_0x1c3c, 0xfff00, debug_port); -+ } else { /*@if (dm->support_ic_type & ODM_IC_11N_SERIES)*/ -+ odm_set_bb_reg(dm, R_0x908, MASKDWORD, debug_port); -+ } -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "DbgPort ((0x%x)) set success, Cur_priority=((%d)), Pre_priority=((%d))\n", -+ debug_port, curr_dbg_priority, dm->pre_dbg_priority); -+ dm->pre_dbg_priority = curr_dbg_priority; -+ dbg_port_result = true; -+ } -+ -+ return dbg_port_result; -+} -+ -+void phydm_release_bb_dbg_port(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ phydm_bb_dbg_port_clock_en(dm, false); -+ phydm_bb_dbg_port_header_sel(dm, 0); -+ -+ dm->pre_dbg_priority = DBGPORT_RELEASE; -+ PHYDM_DBG(dm, ODM_COMP_API, "Release BB dbg_port\n"); -+} -+ -+u32 phydm_get_bb_dbg_port_val(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 dbg_port_value = 0; -+ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ dbg_port_value = odm_get_bb_reg(dm, R_0xfa0, MASKDWORD); -+ else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ dbg_port_value = odm_get_bb_reg(dm, R_0x2dbc, MASKDWORD); -+ else /*@if (dm->support_ic_type & ODM_IC_11N_SERIES)*/ -+ dbg_port_value = odm_get_bb_reg(dm, R_0xdf4, MASKDWORD); -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "dbg_port_value = 0x%x\n", dbg_port_value); -+ return dbg_port_value; -+} -+ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+#if (ODM_IC_11N_SERIES_SUPPORT) -+void phydm_bb_hw_dbg_info_n(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 value32 = 0, value32_1 = 0; -+ u8 rf_gain_a = 0, rf_gain_b = 0, rf_gain_c = 0, rf_gain_d = 0; -+ u8 rx_snr_a = 0, rx_snr_b = 0, rx_snr_c = 0, rx_snr_d = 0; -+ s8 rxevm_0 = 0, rxevm_1 = 0; -+ #if 1 -+ struct phydm_cfo_rpt cfo; -+ u8 i = 0; -+ #else -+ s32 short_cfo_a = 0, short_cfo_b = 0, long_cfo_a = 0, long_cfo_b = 0; -+ s32 scfo_a = 0, scfo_b = 0, avg_cfo_a = 0, avg_cfo_b = 0; -+ s32 cfo_end_a = 0, cfo_end_b = 0, acq_cfo_a = 0, acq_cfo_b = 0; -+ #endif -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s\n", -+ "BB Report Info"); -+ -+ /*@AGC result*/ -+ value32 = odm_get_bb_reg(dm, R_0xdd0, MASKDWORD); -+ rf_gain_a = (u8)(value32 & 0x3f); -+ rf_gain_a = rf_gain_a << 1; -+ -+ rf_gain_b = (u8)((value32 >> 8) & 0x3f); -+ rf_gain_b = rf_gain_b << 1; -+ -+ rf_gain_c = (u8)((value32 >> 16) & 0x3f); -+ rf_gain_c = rf_gain_c << 1; -+ -+ rf_gain_d = (u8)((value32 >> 24) & 0x3f); -+ rf_gain_d = rf_gain_d << 1; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d / %d / %d", "OFDM RX RF Gain(A/B/C/D)", -+ rf_gain_a, rf_gain_b, rf_gain_c, rf_gain_d); -+ -+ /*SNR report*/ -+ value32 = odm_get_bb_reg(dm, R_0xdd4, MASKDWORD); -+ rx_snr_a = (u8)(value32 & 0xff); -+ rx_snr_a = rx_snr_a >> 1; -+ -+ rx_snr_b = (u8)((value32 >> 8) & 0xff); -+ rx_snr_b = rx_snr_b >> 1; -+ -+ rx_snr_c = (u8)((value32 >> 16) & 0xff); -+ rx_snr_c = rx_snr_c >> 1; -+ -+ rx_snr_d = (u8)((value32 >> 24) & 0xff); -+ rx_snr_d = rx_snr_d >> 1; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d / %d / %d", "RXSNR(A/B/C/D, dB)", -+ rx_snr_a, rx_snr_b, rx_snr_c, rx_snr_d); -+ -+ /* PostFFT related info*/ -+ value32 = odm_get_bb_reg(dm, R_0xdd8, MASKDWORD); -+ -+ rxevm_0 = (s8)((value32 & MASKBYTE2) >> 16); -+ rxevm_0 /= 2; -+ if (rxevm_0 < -63) -+ rxevm_0 = 0; -+ -+ rxevm_1 = (s8)((value32 & MASKBYTE3) >> 24); -+ rxevm_1 /= 2; -+ if (rxevm_1 < -63) -+ rxevm_1 = 0; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "RXEVM (1ss/2ss)", rxevm_0, rxevm_1); -+ -+#if 1 -+ phydm_get_cfo_info(dm, &cfo); -+ for (i = 0; i < dm->num_rf_path; i++) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %s[%d] %-28s = {%d, %d, %d, %d, %d}", -+ "CFO", i, "{S, L, Sec, Acq, End}", -+ cfo.cfo_rpt_s[i], cfo.cfo_rpt_l[i], cfo.cfo_rpt_sec[i], -+ cfo.cfo_rpt_acq[i], cfo.cfo_rpt_end[i]); -+ } -+#else -+ /*@CFO Report Info*/ -+ odm_set_bb_reg(dm, R_0xd00, BIT(26), 1); -+ -+ /*Short CFO*/ -+ value32 = odm_get_bb_reg(dm, R_0xdac, MASKDWORD); -+ value32_1 = odm_get_bb_reg(dm, R_0xdb0, MASKDWORD); -+ -+ short_cfo_b = (s32)(value32 & 0xfff); /*S(12,11)*/ -+ short_cfo_a = (s32)((value32 & 0x0fff0000) >> 16); -+ -+ long_cfo_b = (s32)(value32_1 & 0x1fff); /*S(13,12)*/ -+ long_cfo_a = (s32)((value32_1 & 0x1fff0000) >> 16); -+ -+ /*SFO 2's to dec*/ -+ if (short_cfo_a > 2047) -+ short_cfo_a = short_cfo_a - 4096; -+ if (short_cfo_b > 2047) -+ short_cfo_b = short_cfo_b - 4096; -+ -+ short_cfo_a = (short_cfo_a * 312500) / 2048; -+ short_cfo_b = (short_cfo_b * 312500) / 2048; -+ -+ /*@LFO 2's to dec*/ -+ -+ if (long_cfo_a > 4095) -+ long_cfo_a = long_cfo_a - 8192; -+ -+ if (long_cfo_b > 4095) -+ long_cfo_b = long_cfo_b - 8192; -+ -+ long_cfo_a = long_cfo_a * 312500 / 4096; -+ long_cfo_b = long_cfo_b * 312500 / 4096; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s", -+ "CFO Report Info"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "Short CFO(Hz) ", short_cfo_a, -+ short_cfo_b); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "Long CFO(Hz) ", long_cfo_a, -+ long_cfo_b); -+ -+ /*SCFO*/ -+ value32 = odm_get_bb_reg(dm, R_0xdb8, MASKDWORD); -+ value32_1 = odm_get_bb_reg(dm, R_0xdb4, MASKDWORD); -+ -+ scfo_b = (s32)(value32 & 0x7ff); /*S(11,10)*/ -+ scfo_a = (s32)((value32 & 0x07ff0000) >> 16); -+ -+ if (scfo_a > 1023) -+ scfo_a = scfo_a - 2048; -+ -+ if (scfo_b > 1023) -+ scfo_b = scfo_b - 2048; -+ -+ scfo_a = scfo_a * 312500 / 1024; -+ scfo_b = scfo_b * 312500 / 1024; -+ -+ avg_cfo_b = (s32)(value32_1 & 0x1fff); /*S(13,12)*/ -+ avg_cfo_a = (s32)((value32_1 & 0x1fff0000) >> 16); -+ -+ if (avg_cfo_a > 4095) -+ avg_cfo_a = avg_cfo_a - 8192; -+ -+ if (avg_cfo_b > 4095) -+ avg_cfo_b = avg_cfo_b - 8192; -+ -+ avg_cfo_a = avg_cfo_a * 312500 / 4096; -+ avg_cfo_b = avg_cfo_b * 312500 / 4096; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "value SCFO(Hz) ", scfo_a, -+ scfo_b); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "Avg CFO(Hz) ", avg_cfo_a, -+ avg_cfo_b); -+ -+ value32 = odm_get_bb_reg(dm, R_0xdbc, MASKDWORD); -+ value32_1 = odm_get_bb_reg(dm, R_0xde0, MASKDWORD); -+ -+ cfo_end_b = (s32)(value32 & 0x1fff); /*S(13,12)*/ -+ cfo_end_a = (s32)((value32 & 0x1fff0000) >> 16); -+ -+ if (cfo_end_a > 4095) -+ cfo_end_a = cfo_end_a - 8192; -+ -+ if (cfo_end_b > 4095) -+ cfo_end_b = cfo_end_b - 8192; -+ -+ cfo_end_a = cfo_end_a * 312500 / 4096; -+ cfo_end_b = cfo_end_b * 312500 / 4096; -+ -+ acq_cfo_b = (s32)(value32_1 & 0x1fff); /*S(13,12)*/ -+ acq_cfo_a = (s32)((value32_1 & 0x1fff0000) >> 16); -+ -+ if (acq_cfo_a > 4095) -+ acq_cfo_a = acq_cfo_a - 8192; -+ -+ if (acq_cfo_b > 4095) -+ acq_cfo_b = acq_cfo_b - 8192; -+ -+ acq_cfo_a = acq_cfo_a * 312500 / 4096; -+ acq_cfo_b = acq_cfo_b * 312500 / 4096; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "End CFO(Hz) ", cfo_end_a, -+ cfo_end_b); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "ACQ CFO(Hz) ", acq_cfo_a, -+ acq_cfo_b); -+#endif -+} -+#endif -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT) -+#if (RTL8822B_SUPPORT) -+void phydm_bb_hw_dbg_info_8822b(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 condi_num = 0; -+ u8 i = 0; -+ -+ if (!(dm->support_ic_type == ODM_RTL8822B)) -+ return; -+ -+ condi_num = phydm_get_condi_num_8822b(dm); -+ phydm_get_condi_num_acc_8822b(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d.%.4d", "condi_num", -+ condi_num >> 4, phydm_show_fraction_num(condi_num & 0xf, 4)); -+ -+ for (i = 0; i < CN_CNT_MAX; i++) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n Tone_num[CN>%d]%-21s = %d", -+ i, " ", dm->phy_dbg_info.condi_num_cdf[i]); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -+ -+void phydm_bb_hw_dbg_info_ac(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ char *tmp_string = NULL; -+ u8 rx_ht_bw, rx_vht_bw, rxsc, rx_ht, bw_idx = 0; -+ static u8 v_rx_bw; -+ u32 value32, value32_1, value32_2, value32_3; -+ struct phydm_cfo_rpt cfo; -+ u8 i = 0; -+ static u8 tail, parity, rsv, vrsv, smooth, htsound, agg; -+ static u8 stbc, vstbc, fec, fecext, sgi, sgiext, htltf, vgid, v_nsts; -+ static u8 vtxops, vrsv2, vbrsv, bf, vbcrc; -+ static u16 h_length, htcrc8, length; -+ static u16 vpaid; -+ static u16 v_length, vhtcrc8, v_mcss, v_tail, vb_tail; -+ static u8 hmcss, hrx_bw; -+ u8 pwdb; -+ s8 rxevm_0, rxevm_1, rxevm_2; -+ u8 rf_gain[4]; -+ u8 rx_snr[4]; -+ s32 sig_power; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s\n", -+ "BB Report Info"); -+ -+ /*@ [BW & Mode] =====================================================*/ -+ -+ value32 = odm_get_bb_reg(dm, R_0xf80, MASKDWORD); -+ rx_ht = (u8)((value32 & 0x180) >> 7); -+ -+ if (rx_ht == AD_VHT_MODE) { -+ tmp_string = "VHT"; -+ bw_idx = (u8)((value32 >> 1) & 0x3); -+ } else if (rx_ht == AD_HT_MODE) { -+ tmp_string = "HT"; -+ bw_idx = (u8)(value32 & 0x1); -+ } else { -+ tmp_string = "Legacy"; -+ bw_idx = 0; -+ } -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s %s %dM", "mode", tmp_string, (20 << bw_idx)); -+ -+ if (rx_ht != AD_LEGACY_MODE) { -+ rxsc = (u8)(value32 & 0x78); -+ -+ 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"; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-35s", tmp_string); -+ } -+ -+ /*@ [RX signal power and AGC related info] ==========================*/ -+ -+ pwdb = (u8)odm_get_bb_reg(dm, R_0xf90, MASKBYTE1); -+ sig_power = -110 + (pwdb >> 1); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d", "OFDM RX Signal Power(dB)", sig_power); -+ -+ value32 = odm_get_bb_reg(dm, R_0xd14, MASKDWORD); -+ rx_snr[RF_PATH_A] = (u8)(value32 & 0xFF) >> 1; /*@ S(8,1)*/ -+ rf_gain[RF_PATH_A] = (s8)(((value32 & MASKBYTE1) >> 8) * 2); -+ -+ value32 = odm_get_bb_reg(dm, R_0xd54, MASKDWORD); -+ rx_snr[RF_PATH_B] = (u8)(value32 & 0xFF) >> 1; /*@ S(8,1)*/ -+ rf_gain[RF_PATH_B] = (s8)(((value32 & MASKBYTE1) >> 8) * 2); -+ -+ value32 = odm_get_bb_reg(dm, R_0xd94, MASKDWORD); -+ rx_snr[RF_PATH_C] = (u8)(value32 & 0xFF) >> 1; /*@ S(8,1)*/ -+ rf_gain[RF_PATH_C] = (s8)(((value32 & MASKBYTE1) >> 8) * 2); -+ -+ value32 = odm_get_bb_reg(dm, R_0xdd4, MASKDWORD); -+ rx_snr[RF_PATH_D] = (u8)(value32 & 0xFF) >> 1; /*@ S(8,1)*/ -+ rf_gain[RF_PATH_D] = (s8)(((value32 & MASKBYTE1) >> 8) * 2); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d / %d / %d", "OFDM RX RF Gain(A/B/C/D)", -+ rf_gain[RF_PATH_A], rf_gain[RF_PATH_B], -+ rf_gain[RF_PATH_C], rf_gain[RF_PATH_D]); -+ -+ /*@ [RX counter Info] ===============================================*/ -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d", "OFDM CCA cnt", -+ odm_get_bb_reg(dm, R_0xf08, 0xFFFF0000)); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d", "OFDM SBD Fail cnt", -+ odm_get_bb_reg(dm, R_0xfd0, 0xFFFF)); -+ -+ value32 = odm_get_bb_reg(dm, R_0xfc4, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "VHT SIGA/SIGB CRC8 Fail cnt", -+ value32 & 0xFFFF, ((value32 & 0xFFFF0000) >> 16)); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d", "CCK CCA cnt", -+ odm_get_bb_reg(dm, R_0xfcc, 0xFFFF)); -+ -+ value32 = odm_get_bb_reg(dm, R_0xfbc, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", -+ "LSIG (parity Fail/rate Illegal) cnt", value32 & 0xFFFF, -+ ((value32 & 0xFFFF0000) >> 16)); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "HT/VHT MCS NOT SUPPORT cnt", -+ odm_get_bb_reg(dm, R_0xfc0, (0xFFFF0000 >> 16)), -+ odm_get_bb_reg(dm, R_0xfc8, 0xFFFF)); -+ -+ /*@ [PostFFT Info] =================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0xf8c, MASKDWORD); -+ rxevm_0 = (s8)((value32 & MASKBYTE2) >> 16); -+ rxevm_0 /= 2; -+ if (rxevm_0 < -63) -+ rxevm_0 = 0; -+ -+ rxevm_1 = (s8)((value32 & MASKBYTE3) >> 24); -+ rxevm_1 /= 2; -+ value32 = odm_get_bb_reg(dm, R_0xf88, MASKDWORD); -+ rxevm_2 = (s8)((value32 & MASKBYTE2) >> 16); -+ rxevm_2 /= 2; -+ -+ if (rxevm_1 < -63) -+ rxevm_1 = 0; -+ if (rxevm_2 < -63) -+ rxevm_2 = 0; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d / %d", "RXEVM (1ss/2ss/3ss)", rxevm_0, -+ rxevm_1, rxevm_2); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d / %d / %d", "RXSNR(A/B/C/D dB)", -+ rx_snr[RF_PATH_A], rx_snr[RF_PATH_B], -+ rx_snr[RF_PATH_C], rx_snr[RF_PATH_D]); -+ -+ value32 = odm_get_bb_reg(dm, R_0xf8c, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "CSI_1st /CSI_2nd", value32 & 0xFFFF, -+ ((value32 & 0xFFFF0000) >> 16)); -+ -+ /*@ [CFO Report Info] ===============================================*/ -+ phydm_get_cfo_info(dm, &cfo); -+ for (i = 0; i < dm->num_rf_path; i++) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %s[%d] %-28s = {%d, %d, %d, %d, %d}", -+ "CFO", i, "{S, L, Sec, Acq, End}", -+ cfo.cfo_rpt_s[i], cfo.cfo_rpt_l[i], cfo.cfo_rpt_sec[i], -+ cfo.cfo_rpt_acq[i], cfo.cfo_rpt_end[i]); -+ } -+ -+ /*@ [L-SIG Content] =================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0xf20, MASKDWORD); -+ -+ tail = (u8)((value32 & 0xfc0000) >> 18);/*@[23:18]*/ -+ parity = (u8)((value32 & 0x20000) >> 17);/*@[17]*/ -+ length = (u16)((value32 & 0x1ffe0) >> 5);/*@[16:5]*/ -+ rsv = (u8)((value32 & 0x10) >> 4);/*@[4]*/ -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s", -+ "L-SIG"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d M", "rate", -+ phydm_get_l_sig_rate(dm, (u8)(value32 & 0x0f))); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x / %d / %d", "Rsv/length/parity", rsv, length, -+ parity); -+ -+ if (rx_ht == AD_HT_MODE) { -+ /*@ [HT SIG 1] ======================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0xf2c, MASKDWORD); -+ -+ hmcss = (u8)(value32 & 0x7F); -+ hrx_bw = (u8)((value32 & 0x80) >> 7); -+ h_length = (u16)((value32 & 0x0fff00) >> 8); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s", "HT-SIG1"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d / %d", "MCS/BW/length", -+ hmcss, hrx_bw, h_length); -+ /*@ [HT SIG 2] ======================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0xf30, MASKDWORD); -+ smooth = (u8)(value32 & 0x01); -+ htsound = (u8)((value32 & 0x02) >> 1); -+ rsv = (u8)((value32 & 0x04) >> 2); -+ agg = (u8)((value32 & 0x08) >> 3); -+ stbc = (u8)((value32 & 0x30) >> 4); -+ fec = (u8)((value32 & 0x40) >> 6); -+ sgi = (u8)((value32 & 0x80) >> 7); -+ htltf = (u8)((value32 & 0x300) >> 8); -+ htcrc8 = (u16)((value32 & 0x3fc00) >> 10); -+ tail = (u8)((value32 & 0xfc0000) >> 18); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s", -+ "HT-SIG2"); -+ PDM_SNPF(out_len, used, 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); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x / %x / %x / %x", -+ "SGI/E-HT-LTFs/CRC/tail", -+ sgi, htltf, htcrc8, tail); -+ } else if (rx_ht == AD_VHT_MODE) { -+ /*@ [VHT SIG A1] ====================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0xf2c, MASKDWORD); -+ -+ v_rx_bw = (u8)(value32 & 0x03); -+ vrsv = (u8)((value32 & 0x04) >> 2); -+ vstbc = (u8)((value32 & 0x08) >> 3); -+ vgid = (u8)((value32 & 0x3f0) >> 4); -+ v_nsts = (u8)(((value32 & 0x1c00) >> 10) + 1); -+ vpaid = (u16)((value32 & 0x3fe000) >> 13); -+ vtxops = (u8)((value32 & 0x400000) >> 22); -+ vrsv2 = (u8)((value32 & 0x800000) >> 23); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s", -+ "VHT-SIG-A1"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x / %x", -+ "BW/Rsv1/STBC/GID/Nsts/PAID/TXOPPS/Rsv2", v_rx_bw, -+ vrsv, vstbc, vgid, v_nsts, vpaid, vtxops, vrsv2); -+ -+ /*@ [VHT SIG A2] ====================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0xf30, MASKDWORD); -+ -+ /* @sgi=(u8)(value32&0x01); */ -+ sgiext = (u8)(value32 & 0x03); -+ /* @fec = (u8)(value32&0x04); */ -+ fecext = (u8)((value32 & 0x0C) >> 2); -+ -+ v_mcss = (u8)((value32 & 0xf0) >> 4); -+ bf = (u8)((value32 & 0x100) >> 8); -+ vrsv = (u8)((value32 & 0x200) >> 9); -+ vhtcrc8 = (u16)((value32 & 0x3fc00) >> 10); -+ v_tail = (u8)((value32 & 0xfc0000) >> 18); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s", "VHT-SIG-A2"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x", -+ "SGI/FEC/MCS/BF/Rsv/CRC/tail", -+ sgiext, fecext, v_mcss, bf, vrsv, vhtcrc8, v_tail); -+ -+ /*@ [VHT SIG B] ====================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0xf34, MASKDWORD); -+ -+ #if 0 -+ v_length = (u16)(value32 & 0x1fffff); -+ vbrsv = (u8)((value32 & 0x600000) >> 21); -+ vb_tail = (u16)((value32 & 0x1f800000) >> 23); -+ vbcrc = (u8)((value32 & 0x80000000) >> 31); -+ #endif -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s", "VHT-SIG-B"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x", -+ "Codeword", value32); -+ -+ #if 0 -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x / %x / %x / %x", -+ "length/Rsv/tail/CRC", -+ v_length, vbrsv, vb_tail, vbcrc); -+ #endif -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+void phydm_bb_hw_dbg_info_jgr3(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ char *tmp_string = NULL; -+ u8 rx_ht_bw = 0, rx_vht_bw = 0, rx_ht = 0; -+ static u8 v_rx_bw; -+ u32 value32 = 0; -+ u8 i = 0; -+ static u8 tail, parity, rsv, vrsv, smooth, htsound, agg; -+ static u8 stbc, vstbc, fec, fecext, sgi, sgiext, htltf, vgid, v_nsts; -+ static u8 vtxops, vrsv2, vbrsv, bf, vbcrc; -+ static u16 h_length, htcrc8, length; -+ static u16 vpaid; -+ static u16 v_length, vhtcrc8, v_mcss, v_tail, vb_tail; -+ static u8 hmcss, hrx_bw; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s\n", -+ "BB Report Info"); -+ -+ /*@ [Mode] =====================================================*/ -+ -+ value32 = odm_get_bb_reg(dm, R_0x2c20, MASKDWORD); -+ rx_ht = (u8)((value32 & 0xC0000) >> 18); -+ if (rx_ht == AD_VHT_MODE) -+ tmp_string = "VHT"; -+ else if (rx_ht == AD_HT_MODE) -+ tmp_string = "HT"; -+ else -+ tmp_string = "Legacy"; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s %s", "mode", tmp_string); -+ /*@ [RX counter Info] ===============================================*/ -+ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d", "CCK CCA cnt", -+ odm_get_bb_reg(dm, R_0x2aa0, 0xFFFF)); -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d", "CCK CCA cnt", -+ odm_get_bb_reg(dm, R_0x2c08, 0xFFFF)); -+ } -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d", "OFDM CCA cnt", -+ odm_get_bb_reg(dm, R_0x2c08, 0xFFFF0000)); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d", "OFDM SBD Fail cnt", -+ odm_get_bb_reg(dm, R_0x2d20, 0xFFFF0000)); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", -+ "LSIG (parity Fail/rate Illegal) cnt", -+ odm_get_bb_reg(dm, R_0x2d04, 0xFFFF0000), -+ odm_get_bb_reg(dm, R_0x2d08, 0xFFFF)); -+ -+ value32 = odm_get_bb_reg(dm, R_0x2d10, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "HT/VHT MCS NOT SUPPORT cnt", -+ value32 & 0xFFFF, ((value32 & 0xFFFF0000) >> 16)); -+ -+ value32 = odm_get_bb_reg(dm, R_0x2d0c, MASKDWORD); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d", "VHT SIGA/SIGB CRC8 Fail cnt", -+ value32 & 0xFFFF, ((value32 & 0xFFFF0000) >> 16)); -+ /*@ [L-SIG Content] =================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0x2c20, MASKDWORD); -+ -+ parity = (u8)((value32 & 0x20000) >> 17);/*@[17]*/ -+ length = (u16)((value32 & 0x1ffe0) >> 5);/*@[16:5]*/ -+ rsv = (u8)((value32 & 0x10) >> 4);/*@[4]*/ -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s", -+ "L-SIG"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d M", "rate", -+ phydm_get_l_sig_rate(dm, (u8)(value32 & 0x0f))); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x / %d / %d", "Rsv/length/parity", rsv, length, -+ parity); -+ -+ if (rx_ht == AD_HT_MODE) { -+ /*@ [HT SIG 1] ======================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0x2c2c, MASKDWORD); -+ -+ hmcss = (u8)(value32 & 0x7F); -+ hrx_bw = (u8)((value32 & 0x80) >> 7); -+ h_length = (u16)((value32 & 0x0fff00) >> 8); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s", "HT-SIG1"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %d / %d / %d", "MCS/BW/length", -+ hmcss, hrx_bw, h_length); -+ /*@ [HT SIG 2] ======================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0x2c30, MASKDWORD); -+ smooth = (u8)(value32 & 0x01); -+ htsound = (u8)((value32 & 0x02) >> 1); -+ rsv = (u8)((value32 & 0x04) >> 2); -+ agg = (u8)((value32 & 0x08) >> 3); -+ stbc = (u8)((value32 & 0x30) >> 4); -+ fec = (u8)((value32 & 0x40) >> 6); -+ sgi = (u8)((value32 & 0x80) >> 7); -+ htltf = (u8)((value32 & 0x300) >> 8); -+ htcrc8 = (u16)((value32 & 0x3fc00) >> 10); -+ tail = (u8)((value32 & 0xfc0000) >> 18); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s", -+ "HT-SIG2"); -+ PDM_SNPF(out_len, used, 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); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x / %x / %x / %x", -+ "SGI/E-HT-LTFs/CRC/tail", -+ sgi, htltf, htcrc8, tail); -+ } else if (rx_ht == AD_VHT_MODE) { -+ /*@ [VHT SIG A1] ====================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0x2c2c, MASKDWORD); -+ -+ v_rx_bw = (u8)(value32 & 0x03); -+ vrsv = (u8)((value32 & 0x04) >> 2); -+ vstbc = (u8)((value32 & 0x08) >> 3); -+ vgid = (u8)((value32 & 0x3f0) >> 4); -+ v_nsts = (u8)(((value32 & 0x1c00) >> 10) + 1); -+ vpaid = (u16)((value32 & 0x3fe000) >> 13); -+ vtxops = (u8)((value32 & 0x400000) >> 22); -+ vrsv2 = (u8)((value32 & 0x800000) >> 23); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s", -+ "VHT-SIG-A1"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x / %x", -+ "BW/Rsv1/STBC/GID/Nsts/PAID/TXOPPS/Rsv2", v_rx_bw, -+ vrsv, vstbc, vgid, v_nsts, vpaid, vtxops, vrsv2); -+ -+ /*@ [VHT SIG A2] ====================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0x2c30, MASKDWORD); -+ -+ /* @sgi=(u8)(value32&0x01); */ -+ sgiext = (u8)(value32 & 0x03); -+ /* @fec = (u8)(value32&0x04); */ -+ fecext = (u8)((value32 & 0x0C) >> 2); -+ -+ v_mcss = (u8)((value32 & 0xf0) >> 4); -+ bf = (u8)((value32 & 0x100) >> 8); -+ vrsv = (u8)((value32 & 0x200) >> 9); -+ vhtcrc8 = (u16)((value32 & 0x3fc00) >> 10); -+ v_tail = (u8)((value32 & 0xfc0000) >> 18); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s", "VHT-SIG-A2"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x", -+ "SGI/FEC/MCS/BF/Rsv/CRC/tail", -+ sgiext, fecext, v_mcss, bf, vrsv, vhtcrc8, v_tail); -+ -+ /*@ [VHT SIG B] ====================================================*/ -+ value32 = odm_get_bb_reg(dm, R_0x2c34, MASKDWORD); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s", "VHT-SIG-B"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x", -+ "Codeword", value32); -+ -+ if (v_rx_bw == 0) { -+ v_length = (u16)(value32 & 0x1ffff); -+ vbrsv = (u8)((value32 & 0xE0000) >> 17); -+ vb_tail = (u16)((value32 & 0x03F00000) >> 20); -+ } else if (v_rx_bw == 1) { -+ v_length = (u16)(value32 & 0x7FFFF); -+ vbrsv = (u8)((value32 & 0x180000) >> 19); -+ vb_tail = (u16)((value32 & 0x07E00000) >> 21); -+ } else if (v_rx_bw == 2) { -+ v_length = (u16)(value32 & 0x1fffff); -+ vbrsv = (u8)((value32 & 0x600000) >> 21); -+ vb_tail = (u16)((value32 & 0x1f800000) >> 23); -+ } -+ vbcrc = (u8)((value32 & 0x80000000) >> 31); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n %-35s = %x / %x / %x / %x", -+ "length/Rsv/tail/CRC", -+ v_length, vbrsv, vb_tail, vbcrc); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -+ -+u8 phydm_get_l_sig_rate(void *dm_void, u8 rate_idx_l_sig) -+{ -+ u8 rate_idx = 0xff; -+ -+ switch (rate_idx_l_sig) { -+ case 0x0b: -+ rate_idx = 6; -+ break; -+ case 0x0f: -+ rate_idx = 9; -+ break; -+ case 0x0a: -+ rate_idx = 12; -+ break; -+ case 0x0e: -+ rate_idx = 18; -+ break; -+ case 0x09: -+ rate_idx = 24; -+ break; -+ case 0x0d: -+ rate_idx = 36; -+ break; -+ case 0x08: -+ rate_idx = 48; -+ break; -+ case 0x0c: -+ rate_idx = 54; -+ break; -+ default: -+ rate_idx = 0xff; -+ break; -+ } -+ -+ return rate_idx; -+} -+ -+void phydm_bb_hw_dbg_info(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ switch (dm->ic_ip_series) { -+ #if (ODM_IC_11N_SERIES_SUPPORT) -+ case PHYDM_IC_N: -+ phydm_bb_hw_dbg_info_n(dm, &used, output, &out_len); -+ break; -+ #endif -+ -+ #if (ODM_IC_11AC_SERIES_SUPPORT) -+ case PHYDM_IC_AC: -+ phydm_bb_hw_dbg_info_ac(dm, &used, output, &out_len); -+ phydm_reset_bb_hw_cnt(dm); -+ #if (RTL8822B_SUPPORT) -+ phydm_bb_hw_dbg_info_8822b(dm, &used, output, &out_len); -+ #endif -+ break; -+ #endif -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ case PHYDM_IC_JGR3: -+ phydm_bb_hw_dbg_info_jgr3(dm, &used, output, &out_len); -+ phydm_reset_bb_hw_cnt(dm); -+ break; -+ #endif -+ default: -+ break; -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+void phydm_dm_summary_cli_win(void *dm_void, char *buf, u8 macid) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_cfo_track_struct *cfo_t = &dm->dm_cfo_track; -+ struct cmn_sta_info *sta = NULL; -+ struct ra_sta_info *ra = NULL; -+ struct dtp_info *dtp = NULL; -+ u64 comp = dm->support_ability; -+ u64 pause_comp = dm->pause_ability; -+ -+ if (!dm->is_linked) { -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "[%s]No Link !!!\n", __func__); -+ RT_PRINT(buf); -+ return; -+ } -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "00.(%s) %-12s: IGI=0x%x, Dyn_Rng=0x%x~0x%x, fa_src=%d, FA_th={%d,%d,%d}\n", -+ ((comp & ODM_BB_DIG) ? -+ ((pause_comp & ODM_BB_DIG) ? "P" : "V") : "."), -+ "DIG", -+ dig_t->cur_ig_value, -+ dig_t->rx_gain_range_min, dig_t->rx_gain_range_max, -+ dig_t->fa_source, -+ dig_t->fa_th[0], dig_t->fa_th[1], dig_t->fa_th[2]); -+ RT_PRINT(buf); -+ -+ sta = dm->phydm_sta_info[macid]; -+ if (is_sta_active(sta)) { -+ ra = &sta->ra_info; -+ dtp = &sta->dtp_stat; -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "01.(%s) %-12s: rssi_lv=%d, mask=0x%llx\n", -+ ((comp & ODM_BB_RA_MASK) ? -+ ((pause_comp & ODM_BB_RA_MASK) ? "P" : "V") : "."), -+ "RaMask", -+ ra->rssi_level, ra->ramask); -+ RT_PRINT(buf); -+ -+ #ifdef CONFIG_DYNAMIC_TX_TWR -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "02.(%s) %-12s: pwr_lv=%d\n", -+ ((comp & ODM_BB_DYNAMIC_TXPWR) ? -+ ((pause_comp & ODM_BB_DYNAMIC_TXPWR) ? "P" : "V") : "."), -+ "DynTxPwr", -+ dtp->sta_tx_high_power_lvl); -+ RT_PRINT(buf); -+ #endif -+ } -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "05.(%s) %-12s: cck_pd_lv=%d\n", -+ ((comp & ODM_BB_CCK_PD) ? -+ ((pause_comp & ODM_BB_CCK_PD) ? "P" : "V") : "."), -+ "CCK_PD", dm->dm_cckpd_table.cck_pd_lv); -+ RT_PRINT(buf); -+ -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "06.(%s) %-12s: div_type=%d, curr_ant=%s\n", -+ ((comp & ODM_BB_ANT_DIV) ? -+ ((pause_comp & ODM_BB_ANT_DIV) ? "P" : "V") : "."), -+ "ANT_DIV", -+ dm->ant_div_type, -+ (dm->dm_fat_table.rx_idle_ant == MAIN_ANT) ? "MAIN" : "AUX"); -+ RT_PRINT(buf); -+#endif -+ -+#ifdef PHYDM_POWER_TRAINING_SUPPORT -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "08.(%s) %-12s: PT_score=%d, disable_PT=%d\n", -+ ((comp & ODM_BB_PWR_TRAIN) ? -+ ((pause_comp & ODM_BB_PWR_TRAIN) ? "P" : "V") : "."), -+ "PwrTrain", -+ dm->pow_train_table.pow_train_score, -+ dm->is_disable_power_training); -+ RT_PRINT(buf); -+#endif -+ -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "11.(%s) %-12s: dbg_mode=%d, region_domain=%d\n", -+ ((comp & ODM_BB_DFS) ? -+ ((pause_comp & ODM_BB_DFS) ? "P" : "V") : "."), -+ "DFS", -+ dm->dfs.dbg_mode, dm->dfs_region_domain); -+ RT_PRINT(buf); -+#endif -+#ifdef PHYDM_SUPPORT_ADAPTIVITY -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "13.(%s) %-12s: th{l2h, h2l}={%d, %d}, edcca_flag=%d\n", -+ ((comp & ODM_BB_ADAPTIVITY) ? -+ ((pause_comp & ODM_BB_ADAPTIVITY) ? "P" : "V") : "."), -+ "Adaptivity", -+ dm->adaptivity.th_l2h, dm->adaptivity.th_h2l, -+ dm->false_alm_cnt.edcca_flag); -+ RT_PRINT(buf); -+#endif -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "14.(%s) %-12s: CFO_avg=%d kHz, CFO_traking=%s%d\n", -+ ((comp & ODM_BB_CFO_TRACKING) ? -+ ((pause_comp & ODM_BB_CFO_TRACKING) ? "P" : "V") : "."), -+ "CfoTrack", -+ cfo_t->CFO_ave_pre, -+ ((cfo_t->crystal_cap > cfo_t->def_x_cap) ? "+" : "-"), -+ DIFF_2(cfo_t->crystal_cap, cfo_t->def_x_cap)); -+ RT_PRINT(buf); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "15.(%s) %-12s: ratio{nhm, nhm_env, clm, idle, tx}={%d, %d, %d, %d, %d}, nhm_pwr=%d\n", -+ ((comp & ODM_BB_ENV_MONITOR) ? -+ ((pause_comp & ODM_BB_ENV_MONITOR) ? "P" : "V") : "."), -+ "EnvMntr", -+ dm->dm_ccx_info.nhm_ratio, dm->dm_ccx_info.nhm_env_ratio, -+ dm->dm_ccx_info.clm_ratio, dm->dm_ccx_info.nhm_idle_ratio, -+ dm->dm_ccx_info.nhm_tx_ratio, dm->dm_ccx_info.nhm_pwr); -+ RT_PRINT(buf); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "15.(%s) %-12s: NHM_Rpt(H->L)[%d %d %d %d %d %d %d %d %d %d %d %d]\n", -+ ((comp & ODM_BB_ENV_MONITOR) ? -+ ((pause_comp & ODM_BB_ENV_MONITOR) ? "P" : "V") : "."), -+ "EnvMntr", -+ dm->dm_ccx_info.nhm_result[11], -+ dm->dm_ccx_info.nhm_result[10], -+ dm->dm_ccx_info.nhm_result[9], dm->dm_ccx_info.nhm_result[8], -+ dm->dm_ccx_info.nhm_result[7], dm->dm_ccx_info.nhm_result[6], -+ dm->dm_ccx_info.nhm_result[5], dm->dm_ccx_info.nhm_result[4], -+ dm->dm_ccx_info.nhm_result[3], dm->dm_ccx_info.nhm_result[2], -+ dm->dm_ccx_info.nhm_result[1], dm->dm_ccx_info.nhm_result[0]); -+ RT_PRINT(buf); -+ -+#ifdef EDCCA_CLM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_EDCCA_CLM) { -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "15.(%s) %-12s: edcca_clm_ratio=%d\n", -+ ((comp & ODM_BB_ENV_MONITOR) ? -+ ((pause_comp & ODM_BB_ENV_MONITOR) ? "P" : "V") : "."), -+ "EnvMntr", -+ dm->dm_ccx_info.edcca_clm_ratio); -+ RT_PRINT(buf); -+ } -+#endif -+ -+#ifdef PHYDM_PRIMARY_CCA -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "16.(%s) %-12s: CCA @ (%s SB)\n", -+ ((comp & ODM_BB_PRIMARY_CCA) ? -+ ((pause_comp & ODM_BB_PRIMARY_CCA) ? "P" : "V") : "."), -+ "PriCCA", -+ ((dm->dm_pri_cca.mf_state == MF_USC_LSC) ? "D" : -+ ((dm->dm_pri_cca.mf_state == MF_LSC) ? "L" : "U"))); -+ RT_PRINT(buf); -+#endif -+#ifdef CONFIG_ADAPTIVE_SOML -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "17.(%s) %-12s: soml_en = %s\n", -+ ((comp & ODM_BB_ADAPTIVE_SOML) ? -+ ((pause_comp & ODM_BB_ADAPTIVE_SOML) ? "P" : "V") : "."), -+ "A-SOML", -+ (dm->dm_soml_table.soml_last_state == SOML_ON) ? -+ "ON" : "OFF"); -+ RT_PRINT(buf); -+#endif -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "18.(%s) %-12s:\n", -+ ((comp & ODM_BB_LNA_SAT_CHK) ? -+ ((pause_comp & ODM_BB_LNA_SAT_CHK) ? "P" : "V") : "."), -+ "LNA_SAT_CHK"); -+ RT_PRINT(buf); -+#endif -+} -+ -+void phydm_basic_dbg_msg_cli_win(void *dm_void, char *buf) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ struct phydm_cfo_track_struct *cfo_t = &dm->dm_cfo_track; -+ struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info_win_bkp; -+ struct phydm_phystatus_statistic *dbg_s = &dbg->physts_statistic_info; -+ struct phydm_phystatus_avg *dbg_avg = &dbg->phystatus_statistic_avg; -+ -+ char *rate_type = NULL; -+ u8 tmp_rssi_avg[4]; -+ u8 tmp_snr_avg[4]; -+ u8 tmp_evm_avg[4]; -+ u32 tmp_cnt = 0; -+ u8 macid, target_macid = 0; -+ u8 i = 0; -+ u8 rate_num = dm->num_rf_path; -+ u8 ss_ofst = 0; -+ struct cmn_sta_info *entry = NULL; -+ char dbg_buf[PHYDM_SNPRINT_SIZE] = {0}; -+ -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n PHYDM Common Dbg Msg --------->"); -+ RT_PRINT(buf); -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n System up time=%d", dm->phydm_sys_up_time); -+ RT_PRINT(buf); -+ -+ if (dm->is_linked) { -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n ID=((%d)), BW=((%d)), fc=((CH-%d))", -+ dm->curr_station_id, 20 << *dm->band_width, *dm->channel); -+ RT_PRINT(buf); -+ -+ if (((*dm->channel <= 14) && (*dm->band_width == CHANNEL_WIDTH_40)) && -+ (dm->support_ic_type & ODM_IC_11N_SERIES)) { -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n Primary CCA at ((%s SB))", -+ (*dm->sec_ch_offset == SECOND_CH_AT_LSB) ? "U" : "L"); -+ RT_PRINT(buf); -+ } -+ -+ if (dm->cck_new_agc || dm->rx_rate > ODM_RATE11M) { -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [AGC Idx] {0x%x, 0x%x, 0x%x, 0x%x}", -+ dm->ofdm_agc_idx[0], dm->ofdm_agc_idx[1], -+ dm->ofdm_agc_idx[2], dm->ofdm_agc_idx[3]); -+ RT_PRINT(buf); -+ } else { -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [CCK AGC Idx] {LNA,VGA}={0x%x, 0x%x}", -+ dm->cck_lna_idx, dm->cck_vga_idx); -+ RT_PRINT(buf); -+ } -+ -+ phydm_print_rate_2_buff(dm, dm->rx_rate, dbg_buf, PHYDM_SNPRINT_SIZE); -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n RSSI:{%d, %d, %d, %d}, RxRate:%s (0x%x)", -+ (dm->rssi_a == 0xff) ? 0 : dm->rssi_a, -+ (dm->rssi_b == 0xff) ? 0 : dm->rssi_b, -+ (dm->rssi_c == 0xff) ? 0 : dm->rssi_c, -+ (dm->rssi_d == 0xff) ? 0 : dm->rssi_d, -+ dbg_buf, dm->rx_rate); -+ RT_PRINT(buf); -+ -+ phydm_print_rate_2_buff(dm, dm->phy_dbg_info.beacon_phy_rate, dbg_buf, PHYDM_SNPRINT_SIZE); -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n Beacon_cnt=%d, rate_idx:%s (0x%x)", -+ dm->phy_dbg_info.beacon_cnt_in_period, -+ dbg_buf, -+ dm->phy_dbg_info.beacon_phy_rate); -+ RT_PRINT(buf); -+ -+ /*Show phydm_rx_rate_distribution;*/ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [RxRate Cnt] =============>"); -+ RT_PRINT(buf); -+ -+ /*@======CCK=================================================*/ -+ if (*dm->channel <= 14) { -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * CCK = {%d, %d, %d, %d}", -+ dbg->num_qry_legacy_pkt[0], dbg->num_qry_legacy_pkt[1], -+ dbg->num_qry_legacy_pkt[2], dbg->num_qry_legacy_pkt[3]); -+ RT_PRINT(buf); -+ } -+ /*@======OFDM================================================*/ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * OFDM = {%d, %d, %d, %d, %d, %d, %d, %d}", -+ dbg->num_qry_legacy_pkt[4], dbg->num_qry_legacy_pkt[5], -+ dbg->num_qry_legacy_pkt[6], dbg->num_qry_legacy_pkt[7], -+ dbg->num_qry_legacy_pkt[8], dbg->num_qry_legacy_pkt[9], -+ dbg->num_qry_legacy_pkt[10], dbg->num_qry_legacy_pkt[11]); -+ RT_PRINT(buf); -+ -+ /*@======HT==================================================*/ -+ if (dbg->ht_pkt_not_zero) { -+ for (i = 0; i < rate_num; i++) { -+ ss_ofst = (i << 3); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}", -+ (ss_ofst), (ss_ofst + 7), -+ dbg->num_qry_ht_pkt[ss_ofst + 0], dbg->num_qry_ht_pkt[ss_ofst + 1], -+ dbg->num_qry_ht_pkt[ss_ofst + 2], dbg->num_qry_ht_pkt[ss_ofst + 3], -+ dbg->num_qry_ht_pkt[ss_ofst + 4], dbg->num_qry_ht_pkt[ss_ofst + 5], -+ dbg->num_qry_ht_pkt[ss_ofst + 6], dbg->num_qry_ht_pkt[ss_ofst + 7]); -+ RT_PRINT(buf); -+ } -+ -+ if (dbg->low_bw_20_occur) { -+ for (i = 0; i < rate_num; i++) { -+ ss_ofst = (i << 3); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * [Low BW 20M] HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}", -+ (ss_ofst), (ss_ofst + 7), -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 0], dbg->num_qry_pkt_sc_20m[ss_ofst + 1], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 2], dbg->num_qry_pkt_sc_20m[ss_ofst + 3], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 4], dbg->num_qry_pkt_sc_20m[ss_ofst + 5], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 6], dbg->num_qry_pkt_sc_20m[ss_ofst + 7]); -+ RT_PRINT(buf); -+ } -+ } -+ } -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ /*@======VHT=================================================*/ -+ if (dbg->vht_pkt_not_zero) { -+ for (i = 0; i < rate_num; i++) { -+ ss_ofst = 10 * i; -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}", -+ (i + 1), -+ dbg->num_qry_vht_pkt[ss_ofst + 0], dbg->num_qry_vht_pkt[ss_ofst + 1], -+ dbg->num_qry_vht_pkt[ss_ofst + 2], dbg->num_qry_vht_pkt[ss_ofst + 3], -+ dbg->num_qry_vht_pkt[ss_ofst + 4], dbg->num_qry_vht_pkt[ss_ofst + 5], -+ dbg->num_qry_vht_pkt[ss_ofst + 6], dbg->num_qry_vht_pkt[ss_ofst + 7], -+ dbg->num_qry_vht_pkt[ss_ofst + 8], dbg->num_qry_vht_pkt[ss_ofst + 9]); -+ RT_PRINT(buf); -+ } -+ -+ if (dbg->low_bw_20_occur) { -+ for (i = 0; i < rate_num; i++) { -+ ss_ofst = 10 * i; -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n *[Low BW 20M] VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}", -+ (i + 1), -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 0], dbg->num_qry_pkt_sc_20m[ss_ofst + 1], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 2], dbg->num_qry_pkt_sc_20m[ss_ofst + 3], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 4], dbg->num_qry_pkt_sc_20m[ss_ofst + 5], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 6], dbg->num_qry_pkt_sc_20m[ss_ofst + 7], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 8], dbg->num_qry_pkt_sc_20m[ss_ofst + 9]); -+ RT_PRINT(buf); -+ } -+ } -+ -+ if (dbg->low_bw_40_occur) { -+ for (i = 0; i < rate_num; i++) { -+ ss_ofst = 10 * i; -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n *[Low BW 40M] VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}", -+ (i + 1), -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 0], dbg->num_qry_pkt_sc_40m[ss_ofst + 1], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 2], dbg->num_qry_pkt_sc_40m[ss_ofst + 3], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 4], dbg->num_qry_pkt_sc_40m[ss_ofst + 5], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 6], dbg->num_qry_pkt_sc_40m[ss_ofst + 7], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 8], dbg->num_qry_pkt_sc_40m[ss_ofst + 9]); -+ RT_PRINT(buf); -+ } -+ } -+ } -+#endif -+ -+ //1 Show phydm_avg_phystatus_val -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n [Avg PHY Statistic] ==============>\n"); -+ RT_PRINT(buf); -+ -+ /*===[Beacon]===*/ -+ switch (dm->num_rf_path) { -+#if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case 4: -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0], -+ dbg_avg->rssi_beacon_avg[1], -+ dbg_avg->rssi_beacon_avg[2], -+ dbg_avg->rssi_beacon_avg[3]); -+ break; -+#endif -+#if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case 3: -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0], -+ dbg_avg->rssi_beacon_avg[1], -+ dbg_avg->rssi_beacon_avg[2]); -+ break; -+#endif -+#if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case 2: -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0], -+ dbg_avg->rssi_beacon_avg[1]); -+ break; -+#endif -+ default: -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0]); -+ break; -+ } -+ RT_PRINT(buf); -+ -+ /*===[CCK]===*/ -+ switch (dm->num_rf_path) { -+#ifdef PHYSTS_3RD_TYPE_SUPPORT -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case 4: -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, -+ dbg_avg->rssi_cck_avg, -+ dbg_avg->rssi_cck_avg_abv_2ss[0], -+ dbg_avg->rssi_cck_avg_abv_2ss[1], -+ dbg_avg->rssi_cck_avg_abv_2ss[2]); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case 3: -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, -+ dbg_avg->rssi_cck_avg, -+ dbg_avg->rssi_cck_avg_abv_2ss[0], -+ dbg_avg->rssi_cck_avg_abv_2ss[1]); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case 2: -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, -+ dbg_avg->rssi_cck_avg, -+ dbg_avg->rssi_cck_avg_abv_2ss[0]); -+ break; -+ #endif -+#endif -+ default: -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, -+ dbg_avg->rssi_cck_avg); -+ break; -+ } -+ RT_PRINT(buf); -+ -+ for (i = 0; i <= 4; i++) { -+ if (i > dm->num_rf_path) -+ break; -+ -+ odm_memory_set(dm, tmp_rssi_avg, 0, 4); -+ odm_memory_set(dm, tmp_snr_avg, 0, 4); -+ odm_memory_set(dm, tmp_evm_avg, 0, 4); -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ if (i == 4) { -+ rate_type = "[4-SS]"; -+ tmp_cnt = dbg_s->rssi_4ss_cnt; -+ odm_move_memory(dm, tmp_rssi_avg, dbg_avg->rssi_4ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_4ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_evm_avg, dbg_avg->evm_4ss_avg, 4); -+ } else -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ if (i == 3) { -+ rate_type = "[3-SS]"; -+ tmp_cnt = dbg_s->rssi_3ss_cnt; -+ odm_move_memory(dm, tmp_rssi_avg, dbg_avg->rssi_3ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_3ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_evm_avg, dbg_avg->evm_3ss_avg, 3); -+ } else -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (i == 2) { -+ rate_type = "[2-SS]"; -+ tmp_cnt = dbg_s->rssi_2ss_cnt; -+ odm_move_memory(dm, tmp_rssi_avg, dbg_avg->rssi_2ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_2ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_evm_avg, dbg_avg->evm_2ss_avg, 2); -+ } else -+ #endif -+ if (i == 1) { -+ rate_type = "[1-SS]"; -+ tmp_cnt = dbg_s->rssi_1ss_cnt; -+ odm_move_memory(dm, tmp_rssi_avg, dbg_avg->rssi_1ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_1ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_evm_avg, &dbg_avg->evm_1ss_avg, 1); -+ } else { -+ rate_type = "[L-OFDM]"; -+ tmp_cnt = dbg_s->rssi_ofdm_cnt; -+ odm_move_memory(dm, tmp_rssi_avg, dbg_avg->rssi_ofdm_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_ofdm_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_evm_avg, &dbg_avg->evm_ofdm_avg, 1); -+ } -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d} SNR:{%.2d, %.2d, %.2d, %.2d} EVM:{-%.2d, -%.2d, -%.2d, -%.2d}\n", -+ rate_type, tmp_cnt, -+ tmp_rssi_avg[0], tmp_rssi_avg[1], tmp_rssi_avg[2], tmp_rssi_avg[3], -+ tmp_snr_avg[0], tmp_snr_avg[1], tmp_snr_avg[2], tmp_snr_avg[3], -+ tmp_evm_avg[0], tmp_evm_avg[1], tmp_evm_avg[2], tmp_evm_avg[3]); -+ RT_PRINT(buf); -+ } -+ /*@----------------------------------------------------------*/ -+ -+ /*Print TX rate*/ -+ for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { -+ entry = dm->phydm_sta_info[macid]; -+ -+ if (is_sta_active(entry)) { -+ phydm_print_rate_2_buff(dm, entry->ra_info.curr_tx_rate, dbg_buf, PHYDM_SNPRINT_SIZE); -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n TxRate[%d]=%s (0x%x)", macid, dbg_buf, entry->ra_info.curr_tx_rate); -+ RT_PRINT(buf); -+ target_macid = macid; -+ break; -+ } -+ } -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n TP {Tx, Rx, Total} = {%d, %d, %d}Mbps, Traffic_Load=(%d))", -+ dm->tx_tp, dm->rx_tp, dm->total_tp, dm->traffic_load); -+ RT_PRINT(buf); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n CFO_avg=((%d kHz)), CFO_traking = ((%s%d))", -+ cfo_t->CFO_ave_pre, -+ ((cfo_t->crystal_cap > cfo_t->def_x_cap) ? "+" : "-"), -+ DIFF_2(cfo_t->crystal_cap, cfo_t->def_x_cap)); -+ RT_PRINT(buf); -+ -+ /* @Condition number */ -+ #if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n Condi_Num=((%d.%.4d))", -+ dm->phy_dbg_info.condi_num >> 4, -+ phydm_show_fraction_num(dm->phy_dbg_info.condi_num & 0xf, 4)); -+ RT_PRINT(buf); -+ } -+ #endif -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT || defined(PHYSTS_3RD_TYPE_SUPPORT)) -+ /*STBC or LDPC pkt*/ -+ if (dm->support_ic_type & (PHYSTS_2ND_TYPE_IC | -+ PHYSTS_3RD_TYPE_IC)) -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n Coding: LDPC=((%s)), STBC=((%s))", -+ (dm->phy_dbg_info.is_ldpc_pkt) ? "Y" : "N", -+ (dm->phy_dbg_info.is_stbc_pkt) ? "Y" : "N"); -+ RT_PRINT(buf); -+#endif -+ -+ } else { -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n No Link !!!"); -+ RT_PRINT(buf); -+ } -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n [Tx cnt] {CCK_TxEN, CCK_TxON, OFDM_TxEN, OFDM_TxON} = {%d, %d, %d, %d}", -+ fa_t->cnt_cck_txen, fa_t->cnt_cck_txon, fa_t->cnt_ofdm_txen, -+ fa_t->cnt_ofdm_txon); -+ RT_PRINT(buf); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}", -+ fa_t->cnt_cck_cca, fa_t->cnt_ofdm_cca, fa_t->cnt_cca_all); -+ RT_PRINT(buf); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}", -+ fa_t->cnt_cck_fail, fa_t->cnt_ofdm_fail, fa_t->cnt_all); -+ RT_PRINT(buf); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n [FA duration(us)] {exp, ifs_clm, fahm} = {%d, %d, %d}", -+ fa_t->time_fa_exp, fa_t->time_fa_ifs_clm, -+ fa_t->time_fa_fahm); -+ RT_PRINT(buf); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n [OFDM FA] Parity=%d, Rate=%d, Fast_Fsync=%d, SBD=%d", -+ fa_t->cnt_parity_fail, fa_t->cnt_rate_illegal, -+ fa_t->cnt_fast_fsync, fa_t->cnt_sb_search_fail); -+ RT_PRINT(buf); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [HT FA] CRC8=%d, MCS=%d", -+ fa_t->cnt_crc8_fail, fa_t->cnt_mcs_fail); -+ RT_PRINT(buf); -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ if (dm->support_ic_type & (ODM_IC_11AC_SERIES | ODM_IC_JGR3_SERIES)) { -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n [VHT FA] SIGA_CRC8=%d, SIGB_CRC8=%d, MCS=%d", -+ fa_t->cnt_crc8_fail_vhta, fa_t->cnt_crc8_fail_vhtb, -+ fa_t->cnt_mcs_fail_vht); -+ RT_PRINT(buf); -+ } -+#endif -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n [CRC32 OK Cnt] {CCK, OFDM, HT, VHT, Total} = {%d, %d, %d, %d, %d}", -+ fa_t->cnt_cck_crc32_ok, fa_t->cnt_ofdm_crc32_ok, -+ fa_t->cnt_ht_crc32_ok, fa_t->cnt_vht_crc32_ok, -+ fa_t->cnt_crc32_ok_all); -+ RT_PRINT(buf); -+ -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n [CRC32 Err Cnt] {CCK, OFDM, HT, VHT, Total} = {%d, %d, %d, %d, %d}", -+ fa_t->cnt_cck_crc32_error, fa_t->cnt_ofdm_crc32_error, -+ fa_t->cnt_ht_crc32_error, fa_t->cnt_vht_crc32_error, -+ fa_t->cnt_crc32_error_all); -+ RT_PRINT(buf); -+ -+ if (fa_t->ofdm2_rate_idx) { -+ phydm_print_rate_2_buff(dm, fa_t->ofdm2_rate_idx, -+ dbg_buf, PHYDM_SNPRINT_SIZE); -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n [OFDM:%s CRC32 Cnt] {error, ok}= {%d, %d} (%d percent)", -+ dbg_buf, fa_t->cnt_ofdm2_crc32_error, -+ fa_t->cnt_ofdm2_crc32_ok, fa_t->ofdm2_pcr); -+ RT_PRINT(buf); -+ } -+ -+ if (fa_t->ht2_rate_idx) { -+ phydm_print_rate_2_buff(dm, fa_t->ht2_rate_idx, dbg_buf, -+ PHYDM_SNPRINT_SIZE); -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n [HT :%s CRC32 Cnt] {error, ok}= {%d, %d} (%d percent)", -+ dbg_buf, fa_t->cnt_ht2_crc32_error, -+ fa_t->cnt_ht2_crc32_ok, fa_t->ht2_pcr); -+ RT_PRINT(buf); -+ } -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ if (dm->support_ic_type & (ODM_IC_11AC_SERIES | ODM_IC_JGR3_SERIES)) { -+ if (fa_t->vht2_rate_idx) { -+ phydm_print_rate_2_buff(dm, fa_t->vht2_rate_idx, -+ dbg_buf, PHYDM_SNPRINT_SIZE); -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n [VHT :%s CRC32 Cnt] {error, ok}= {%d, %d} (%d percent)", -+ dbg_buf, fa_t->cnt_vht2_crc32_error, -+ fa_t->cnt_vht2_crc32_ok, fa_t->vht2_pcr); -+ RT_PRINT(buf); -+ } -+ } -+#endif -+ -+ if (dm->support_ic_type & (ODM_IC_11N_SERIES | ODM_IC_11AC_SERIES)) -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n is_linked = %d, Num_client = %d, rssi_min = %d, IGI = 0x%x, bNoisy=%d\n", -+ dm->is_linked, dm->number_linked_client, dm->rssi_min, -+ dm->dm_dig_table.cur_ig_value, dm->noisy_decision); -+ else -+ RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, -+ "\r\n is_linked = %d, Num_client = %d, rssi_min = %d, IGI = 0x%x\n", -+ dm->is_linked, dm->number_linked_client, dm->rssi_min, -+ dm->dm_dig_table.cur_ig_value); -+ -+ RT_PRINT(buf); -+ -+ phydm_dm_summary_cli_win(dm, buf, target_macid); -+} -+ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+void phydm_sbd_check( -+ struct dm_struct *dm) -+{ -+ static u32 pkt_cnt; -+ static boolean sbd_state; -+ u32 sym_count, count, value32; -+ -+ if (sbd_state == 0) { -+ pkt_cnt++; -+ /*read SBD conter once every 5 packets*/ -+ if (pkt_cnt % 5 == 0) { -+ odm_set_timer(dm, &dm->sbdcnt_timer, 0); /*@ms*/ -+ sbd_state = 1; -+ } -+ } else { /*read counter*/ -+ value32 = odm_get_bb_reg(dm, R_0xf98, MASKDWORD); -+ sym_count = (value32 & 0x7C000000) >> 26; -+ count = (value32 & 0x3F00000) >> 20; -+ pr_debug("#SBD# sym_count %d count %d\n", sym_count, count); -+ sbd_state = 0; -+ } -+} -+#endif -+ -+void phydm_sbd_callback( -+ struct phydm_timer_list *timer) -+{ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+ void *adapter = timer->Adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA((PADAPTER)adapter); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+#if USE_WORKITEM -+ odm_schedule_work_item(&dm->sbdcnt_workitem); -+#else -+ phydm_sbd_check(dm); -+#endif -+#endif -+} -+ -+void phydm_sbd_workitem_callback( -+ void *context) -+{ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA((PADAPTER)adapter); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+ phydm_sbd_check(dm); -+#endif -+} -+#endif -+ -+void phydm_reset_rx_rate_distribution(struct dm_struct *dm) -+{ -+ struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; -+ -+ odm_memory_set(dm, &dbg->num_qry_legacy_pkt[0], 0, -+ (LEGACY_RATE_NUM * 2)); -+ odm_memory_set(dm, &dbg->num_qry_ht_pkt[0], 0, -+ (HT_RATE_NUM * 2)); -+ odm_memory_set(dm, &dbg->num_qry_pkt_sc_20m[0], 0, -+ (LOW_BW_RATE_NUM * 2)); -+ -+ dbg->ht_pkt_not_zero = false; -+ dbg->low_bw_20_occur = false; -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ odm_memory_set(dm, &dbg->num_qry_vht_pkt[0], 0, VHT_RATE_NUM * 2); -+ odm_memory_set(dm, &dbg->num_qry_pkt_sc_40m[0], 0, LOW_BW_RATE_NUM * 2); -+ #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) || (defined(PHYSTS_3RD_TYPE_SUPPORT)) -+ odm_memory_set(dm, &dbg->num_mu_vht_pkt[0], 0, VHT_RATE_NUM * 2); -+ #endif -+ dbg->vht_pkt_not_zero = false; -+ dbg->low_bw_40_occur = false; -+#endif -+} -+ -+void phydm_rx_rate_distribution(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; -+ u8 i = 0; -+ u8 rate_num = dm->num_rf_path, ss_ofst = 0; -+ -+ PHYDM_DBG(dm, DBG_CMN, "[RxRate Cnt] =============>\n"); -+ -+ /*@======CCK=========================================================*/ -+ if (*dm->channel <= 14) { -+ PHYDM_DBG(dm, DBG_CMN, "* CCK = {%d, %d, %d, %d}\n", -+ dbg->num_qry_legacy_pkt[0], -+ dbg->num_qry_legacy_pkt[1], -+ dbg->num_qry_legacy_pkt[2], -+ dbg->num_qry_legacy_pkt[3]); -+ } -+ /*@======OFDM========================================================*/ -+ PHYDM_DBG(dm, DBG_CMN, "* OFDM = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ dbg->num_qry_legacy_pkt[4], dbg->num_qry_legacy_pkt[5], -+ dbg->num_qry_legacy_pkt[6], dbg->num_qry_legacy_pkt[7], -+ dbg->num_qry_legacy_pkt[8], dbg->num_qry_legacy_pkt[9], -+ dbg->num_qry_legacy_pkt[10], dbg->num_qry_legacy_pkt[11]); -+ -+ /*@======HT==========================================================*/ -+ if (dbg->ht_pkt_not_zero) { -+ for (i = 0; i < rate_num; i++) { -+ ss_ofst = (i << 3); -+ -+ PHYDM_DBG(dm, DBG_CMN, -+ "* HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (ss_ofst), (ss_ofst + 7), -+ dbg->num_qry_ht_pkt[ss_ofst + 0], -+ dbg->num_qry_ht_pkt[ss_ofst + 1], -+ dbg->num_qry_ht_pkt[ss_ofst + 2], -+ dbg->num_qry_ht_pkt[ss_ofst + 3], -+ dbg->num_qry_ht_pkt[ss_ofst + 4], -+ dbg->num_qry_ht_pkt[ss_ofst + 5], -+ dbg->num_qry_ht_pkt[ss_ofst + 6], -+ dbg->num_qry_ht_pkt[ss_ofst + 7]); -+ } -+ -+ if (dbg->low_bw_20_occur) { -+ for (i = 0; i < rate_num; i++) { -+ ss_ofst = (i << 3); -+ -+ PHYDM_DBG(dm, DBG_CMN, -+ "* [Low BW 20M] HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (ss_ofst), (ss_ofst + 7), -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 0], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 1], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 2], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 3], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 4], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 5], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 6], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 7]); -+ } -+ } -+ } -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ /*@======VHT==========================================================*/ -+ if (dbg->vht_pkt_not_zero) { -+ for (i = 0; i < rate_num; i++) { -+ ss_ofst = 10 * i; -+ -+ PHYDM_DBG(dm, DBG_CMN, -+ "* VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (i + 1), -+ dbg->num_qry_vht_pkt[ss_ofst + 0], -+ dbg->num_qry_vht_pkt[ss_ofst + 1], -+ dbg->num_qry_vht_pkt[ss_ofst + 2], -+ dbg->num_qry_vht_pkt[ss_ofst + 3], -+ dbg->num_qry_vht_pkt[ss_ofst + 4], -+ dbg->num_qry_vht_pkt[ss_ofst + 5], -+ dbg->num_qry_vht_pkt[ss_ofst + 6], -+ dbg->num_qry_vht_pkt[ss_ofst + 7], -+ dbg->num_qry_vht_pkt[ss_ofst + 8], -+ dbg->num_qry_vht_pkt[ss_ofst + 9]); -+ } -+ -+ if (dbg->low_bw_20_occur) { -+ for (i = 0; i < rate_num; i++) { -+ ss_ofst = 10 * i; -+ -+ PHYDM_DBG(dm, DBG_CMN, -+ "*[Low BW 20M] VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (i + 1), -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 0], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 1], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 2], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 3], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 4], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 5], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 6], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 7], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 8], -+ dbg->num_qry_pkt_sc_20m[ss_ofst + 9]); -+ } -+ } -+ -+ if (dbg->low_bw_40_occur) { -+ for (i = 0; i < rate_num; i++) { -+ ss_ofst = 10 * i; -+ -+ PHYDM_DBG(dm, DBG_CMN, -+ "*[Low BW 40M] VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (i + 1), -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 0], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 1], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 2], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 3], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 4], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 5], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 6], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 7], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 8], -+ dbg->num_qry_pkt_sc_40m[ss_ofst + 9]); -+ } -+ } -+ } -+#endif -+} -+ -+u16 phydm_rx_utility(void *dm_void, u16 avg_phy_rate, u8 rx_max_ss, -+ enum channel_width bw) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; -+ u16 utility_primitive = 0, utility = 0; -+ -+ if (dbg->ht_pkt_not_zero) { -+ /*@ MCS7 20M: tp = 65, 1000/65 = 15.38, 65*15.5 = 1007*/ -+ utility_primitive = avg_phy_rate * 15 + (avg_phy_rate >> 1); -+ } -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ else if (dbg->vht_pkt_not_zero) { -+ /*@ VHT 1SS MCS9(fake) 20M: tp = 90, 1000/90 = 11.11, 65*11.125 = 1001*/ -+ utility_primitive = avg_phy_rate * 11 + (avg_phy_rate >> 3); -+ } -+#endif -+ else { -+ /*@ 54M, 1000/54 = 18.5, 54*18.5 = 999*/ -+ utility_primitive = avg_phy_rate * 18 + (avg_phy_rate >> 1); -+ } -+ -+ utility = (utility_primitive / rx_max_ss) >> bw; -+ -+ if (utility > 1000) -+ utility = 1000; -+ -+ return utility; -+} -+ -+u16 phydm_rx_avg_phy_rate(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; -+ u8 i = 0, rate_num = 0, rate_base = 0; -+ u16 rate = 0, avg_phy_rate = 0; -+ u32 pkt_cnt = 0, phy_rate_sum = 0; -+ -+ if (dbg->ht_pkt_not_zero) { -+ rate_num = HT_RATE_NUM; -+ rate_base = ODM_RATEMCS0; -+ for (i = 0; i < rate_num; i++) { -+ rate = phy_rate_table[i + rate_base] << *dm->band_width; -+ phy_rate_sum += dbg->num_qry_ht_pkt[i] * rate; -+ pkt_cnt += dbg->num_qry_ht_pkt[i]; -+ } -+ } -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ else if (dbg->vht_pkt_not_zero) { -+ rate_num = VHT_RATE_NUM; -+ rate_base = ODM_RATEVHTSS1MCS0; -+ for (i = 0; i < rate_num; i++) { -+ rate = phy_rate_table[i + rate_base] << *dm->band_width; -+ phy_rate_sum += dbg->num_qry_vht_pkt[i] * rate; -+ pkt_cnt += dbg->num_qry_vht_pkt[i]; -+ } -+ } -+#endif -+ else { -+ for (i = ODM_RATE1M; i <= ODM_RATE54M; i++) { -+ /*SKIP 1M & 6M for beacon case*/ -+ if (*dm->channel < 36 && i == ODM_RATE1M) -+ continue; -+ -+ if (*dm->channel >= 36 && i == ODM_RATE6M) -+ continue; -+ -+ rate = phy_rate_table[i]; -+ phy_rate_sum += dbg->num_qry_legacy_pkt[i] * rate; -+ pkt_cnt += dbg->num_qry_legacy_pkt[i]; -+ } -+ } -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ if (dbg->low_bw_40_occur) { -+ for (i = 0; i < LOW_BW_RATE_NUM; i++) { -+ rate = phy_rate_table[i + rate_base] -+ << CHANNEL_WIDTH_40; -+ phy_rate_sum += dbg->num_qry_pkt_sc_40m[i] * rate; -+ pkt_cnt += dbg->num_qry_pkt_sc_40m[i]; -+ } -+ } -+#endif -+ -+ if (dbg->low_bw_20_occur) { -+ for (i = 0; i < LOW_BW_RATE_NUM; i++) { -+ rate = phy_rate_table[i + rate_base]; -+ phy_rate_sum += dbg->num_qry_pkt_sc_20m[i] * rate; -+ pkt_cnt += dbg->num_qry_pkt_sc_20m[i]; -+ } -+ } -+ -+ avg_phy_rate = (pkt_cnt == 0) ? 0 : (u16)(phy_rate_sum / pkt_cnt); -+ -+ return avg_phy_rate; -+} -+ -+void phydm_print_hist_2_buf(void *dm_void, u16 *val, u16 len, char *buf, -+ u16 buf_size) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (len == PHY_HIST_SIZE) { -+ PHYDM_SNPRINTF(buf, buf_size, -+ "[%.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d]", -+ val[0], val[1], val[2], val[3], val[4], -+ val[5], val[6], val[7], val[8], val[9], -+ val[10], val[11]); -+ } else if (len == (PHY_HIST_SIZE - 1)) { -+ PHYDM_SNPRINTF(buf, buf_size, -+ "[%.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d]", -+ val[0], val[1], val[2], val[3], val[4], -+ val[5], val[6], val[7], val[8], val[9], -+ val[10]); -+ } -+} -+ -+void phydm_nss_hitogram(void *dm_void, enum PDM_RATE_TYPE rate_type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; -+ char buf[PHYDM_SNPRINT_SIZE] = {0}; -+ u16 buf_size = PHYDM_SNPRINT_SIZE; -+ u16 h_size = PHY_HIST_SIZE; -+ u16 *evm_hist = &dbg_s->evm_1ss_hist[0]; -+ u16 *snr_hist = &dbg_s->snr_1ss_hist[0]; -+ u8 i = 0; -+ u8 ss = phydm_rate_type_2_num_ss(dm, rate_type); -+ -+ for (i = 0; i < ss; i++) { -+ if (rate_type == PDM_1SS) { -+ evm_hist = &dbg_s->evm_1ss_hist[0]; -+ snr_hist = &dbg_s->snr_1ss_hist[0]; -+ } else if (rate_type == PDM_2SS) { -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ evm_hist = &dbg_s->evm_2ss_hist[i][0]; -+ snr_hist = &dbg_s->snr_2ss_hist[i][0]; -+ #endif -+ } else if (rate_type == PDM_3SS) { -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ evm_hist = &dbg_s->evm_3ss_hist[i][0]; -+ snr_hist = &dbg_s->snr_3ss_hist[i][0]; -+ #endif -+ } else if (rate_type == PDM_4SS) { -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ evm_hist = &dbg_s->evm_4ss_hist[i][0]; -+ snr_hist = &dbg_s->snr_4ss_hist[i][0]; -+ #endif -+ } -+ -+ phydm_print_hist_2_buf(dm, evm_hist, h_size, buf, buf_size); -+ PHYDM_DBG(dm, DBG_CMN, "[%d-SS][EVM][%d]=%s\n", ss, i, buf); -+ phydm_print_hist_2_buf(dm, snr_hist, h_size, buf, buf_size); -+ PHYDM_DBG(dm, DBG_CMN, "[%d-SS][SNR][%d]=%s\n", ss, i, buf); -+ } -+} -+ -+#ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+void phydm_show_cn_hitogram(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; -+ u16 th_tmp[PHY_HIST_TH_SIZE]; -+ char buf[PHYDM_SNPRINT_SIZE] = {0}; -+ u8 i = 0; -+ u16 *cn_hist = NULL; -+ u32 cn_avg = 0; -+ -+ if (!dm->pkt_proc_struct.physts_auto_swch_en) -+ return; -+ -+ if (dm->num_rf_path == 1) -+ return; -+ -+ PHYDM_DBG(dm, DBG_CMN, "[Condition number Histogram] ========>\n"); -+/*@===[Threshold]=============================================================*/ -+ for (i = 0; i < PHY_HIST_TH_SIZE; i++) -+ th_tmp[i] = dbg_i->cn_hist_th[i] >> 1; -+ -+ phydm_print_hist_2_buf(dm, th_tmp, -+ PHY_HIST_TH_SIZE, buf, PHYDM_SNPRINT_SIZE); -+ PHYDM_DBG(dm, DBG_CMN, "%-24s=%s\n", "[CN_TH]", buf); -+ -+/*@===[Histogram]=============================================================*/ -+ -+ for (i = 1; i <= dm->num_rf_path; i++) { -+ if (dbg_s->p4_cnt[i] == 0) -+ continue; -+ -+ cn_avg = PHYDM_DIV((dbg_s->cn_sum[i] + -+ (dbg_s->p4_cnt[i] >> 1)) << 2, -+ dbg_s->p4_cnt[i]); /*u(8,1)<<2 -> u(10,3)*/ -+ -+ cn_hist = &dbg_s->cn_hist[i][0]; -+ phydm_print_hist_2_buf(dm, cn_hist, -+ PHY_HIST_SIZE, buf, PHYDM_SNPRINT_SIZE); -+ PHYDM_DBG(dm, DBG_CMN, "[%d-SS]%s=(avg:%d.%4d)%s\n", -+ i + 1, "[CN]", cn_avg >> 3, -+ phydm_show_fraction_num(cn_avg & 0x7, 3), buf); -+ } -+} -+#endif -+ -+void phydm_show_phy_hitogram(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; -+ char buf[PHYDM_SNPRINT_SIZE] = {0}; -+ u16 buf_size = PHYDM_SNPRINT_SIZE; -+ u16 th_size = PHY_HIST_SIZE - 1; -+ u8 i = 0; -+ -+ PHYDM_DBG(dm, DBG_CMN, "[PHY Histogram] ==============>\n"); -+/*@===[Threshold]=============================================================*/ -+ phydm_print_hist_2_buf(dm, dbg_i->evm_hist_th, th_size, buf, buf_size); -+ PHYDM_DBG(dm, DBG_CMN, "%-16s=%s\n", "[EVM_TH]", buf); -+ -+ phydm_print_hist_2_buf(dm, dbg_i->snr_hist_th, th_size, buf, buf_size); -+ PHYDM_DBG(dm, DBG_CMN, "%-16s=%s\n", "[SNR_TH]", buf); -+/*@===[OFDM]==================================================================*/ -+ if (dbg_s->rssi_ofdm_cnt) { -+ phydm_print_hist_2_buf(dm, dbg_s->evm_ofdm_hist, PHY_HIST_SIZE, -+ buf, buf_size); -+ PHYDM_DBG(dm, DBG_CMN, "%-14s=%s\n", "[OFDM][EVM]", buf); -+ -+ phydm_print_hist_2_buf(dm, dbg_s->snr_ofdm_hist, PHY_HIST_SIZE, -+ buf, buf_size); -+ PHYDM_DBG(dm, DBG_CMN, "%-14s=%s\n", "[OFDM][SNR]", buf); -+ } -+/*@===[1-SS]==================================================================*/ -+ if (dbg_s->rssi_1ss_cnt) -+ phydm_nss_hitogram(dm, PDM_1SS); -+/*@===[2-SS]==================================================================*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if ((dm->support_ic_type & PHYDM_IC_ABOVE_2SS) && dbg_s->rssi_2ss_cnt) -+ phydm_nss_hitogram(dm, PDM_2SS); -+ #endif -+/*@===[3-SS]==================================================================*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ if ((dm->support_ic_type & PHYDM_IC_ABOVE_3SS) && dbg_s->rssi_3ss_cnt) -+ phydm_nss_hitogram(dm, PDM_3SS); -+ #endif -+/*@===[4-SS]==================================================================*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS && dbg_s->rssi_4ss_cnt) -+ phydm_nss_hitogram(dm, PDM_4SS); -+ #endif -+} -+ -+void phydm_avg_phy_val_nss(void *dm_void, u8 nss) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; -+ struct phydm_phystatus_avg *dbg_avg = &dbg_i->phystatus_statistic_avg; -+ char *rate_type = NULL; -+ u32 *tmp_cnt = NULL; -+ u8 *tmp_rssi_avg = NULL; -+ u32 *tmp_rssi_sum = NULL; -+ u8 *tmp_snr_avg = NULL; -+ u32 *tmp_snr_sum = NULL; -+ u8 *tmp_evm_avg = NULL; -+ u32 *tmp_evm_sum = NULL; -+ u8 evm_rpt_show[RF_PATH_MEM_SIZE]; -+ u8 i = 0; -+ -+ odm_memory_set(dm, &evm_rpt_show[0], 0, RF_PATH_MEM_SIZE); -+ -+ switch (nss) { -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case 4: -+ rate_type = "[4-SS]"; -+ tmp_cnt = &dbg_s->rssi_4ss_cnt; -+ tmp_rssi_avg = &dbg_avg->rssi_4ss_avg[0]; -+ tmp_snr_avg = &dbg_avg->snr_4ss_avg[0]; -+ tmp_rssi_sum = &dbg_s->rssi_4ss_sum[0]; -+ tmp_snr_sum = &dbg_s->snr_4ss_sum[0]; -+ tmp_evm_avg = &dbg_avg->evm_4ss_avg[0]; -+ tmp_evm_sum = &dbg_s->evm_4ss_sum[0]; -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case 3: -+ rate_type = "[3-SS]"; -+ tmp_cnt = &dbg_s->rssi_3ss_cnt; -+ tmp_rssi_avg = &dbg_avg->rssi_3ss_avg[0]; -+ tmp_snr_avg = &dbg_avg->snr_3ss_avg[0]; -+ tmp_rssi_sum = &dbg_s->rssi_3ss_sum[0]; -+ tmp_snr_sum = &dbg_s->snr_3ss_sum[0]; -+ tmp_evm_avg = &dbg_avg->evm_3ss_avg[0]; -+ tmp_evm_sum = &dbg_s->evm_3ss_sum[0]; -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case 2: -+ rate_type = "[2-SS]"; -+ tmp_cnt = &dbg_s->rssi_2ss_cnt; -+ tmp_rssi_avg = &dbg_avg->rssi_2ss_avg[0]; -+ tmp_snr_avg = &dbg_avg->snr_2ss_avg[0]; -+ tmp_rssi_sum = &dbg_s->rssi_2ss_sum[0]; -+ tmp_snr_sum = &dbg_s->snr_2ss_sum[0]; -+ tmp_evm_avg = &dbg_avg->evm_2ss_avg[0]; -+ tmp_evm_sum = &dbg_s->evm_2ss_sum[0]; -+ break; -+ #endif -+ case 1: -+ rate_type = "[1-SS]"; -+ tmp_cnt = &dbg_s->rssi_1ss_cnt; -+ tmp_rssi_avg = &dbg_avg->rssi_1ss_avg[0]; -+ tmp_snr_avg = &dbg_avg->snr_1ss_avg[0]; -+ tmp_rssi_sum = &dbg_s->rssi_1ss_sum[0]; -+ tmp_snr_sum = &dbg_s->snr_1ss_sum[0]; -+ tmp_evm_avg = &dbg_avg->evm_1ss_avg; -+ tmp_evm_sum = &dbg_s->evm_1ss_sum; -+ break; -+ case 0: -+ rate_type = "[L-OFDM]"; -+ tmp_cnt = &dbg_s->rssi_ofdm_cnt; -+ tmp_rssi_avg = &dbg_avg->rssi_ofdm_avg[0]; -+ tmp_snr_avg = &dbg_avg->snr_ofdm_avg[0]; -+ tmp_rssi_sum = &dbg_s->rssi_ofdm_sum[0]; -+ tmp_snr_sum = &dbg_s->snr_ofdm_sum[0]; -+ tmp_evm_avg = &dbg_avg->evm_ofdm_avg; -+ tmp_evm_sum = &dbg_s->evm_ofdm_sum; -+ break; -+ default: -+ PHYDM_DBG(dm, DBG_CMN, "[warning] %s\n", __func__); -+ return; -+ } -+ -+ if (*tmp_cnt != 0) { -+ for (i = 0; i < dm->num_rf_path; i++) { -+ tmp_rssi_avg[i] = (u8)(tmp_rssi_sum[i] / *tmp_cnt); -+ tmp_snr_avg[i] = (u8)(tmp_snr_sum[i] / *tmp_cnt); -+ } -+ -+ if (nss == 0 || nss == 1) { -+ *tmp_evm_avg = (u8)(*tmp_evm_sum / *tmp_cnt); -+ evm_rpt_show[0] = *tmp_evm_avg; -+ } else { -+ for (i = 0; i < nss; i++) { -+ tmp_evm_avg[i] = (u8)(tmp_evm_sum[i] / -+ *tmp_cnt); -+ evm_rpt_show[i] = tmp_evm_avg[i]; -+ } -+ } -+ } -+ -+#if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ PHYDM_DBG(dm, DBG_CMN, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d} SNR:{%.2d, %.2d, %.2d, %.2d} EVM:{-%.2d, -%.2d, -%.2d, -%.2d}\n", -+ rate_type, *tmp_cnt, -+ tmp_rssi_avg[0], tmp_rssi_avg[1], tmp_rssi_avg[2], -+ tmp_rssi_avg[3], tmp_snr_avg[0], tmp_snr_avg[1], -+ tmp_snr_avg[2], tmp_snr_avg[3], evm_rpt_show[0], -+ evm_rpt_show[1], evm_rpt_show[2], evm_rpt_show[3]); -+#elif (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ PHYDM_DBG(dm, DBG_CMN, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d} SNR:{%.2d, %.2d, %.2d} EVM:{-%.2d, -%.2d, -%.2d}\n", -+ rate_type, *tmp_cnt, -+ tmp_rssi_avg[0], tmp_rssi_avg[1], tmp_rssi_avg[2], -+ tmp_snr_avg[0], tmp_snr_avg[1], tmp_snr_avg[2], -+ evm_rpt_show[0], evm_rpt_show[1], evm_rpt_show[2]); -+#elif (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ PHYDM_DBG(dm, DBG_CMN, -+ "* %-8s Cnt= ((%.3d)) RSSI:{%.2d, %.2d} SNR:{%.2d, %.2d} EVM:{-%.2d, -%.2d}\n", -+ rate_type, *tmp_cnt, -+ tmp_rssi_avg[0], tmp_rssi_avg[1], -+ tmp_snr_avg[0], tmp_snr_avg[1], -+ evm_rpt_show[0], evm_rpt_show[1]); -+#else -+ PHYDM_DBG(dm, DBG_CMN, -+ "* %-8s Cnt= ((%.3d)) RSSI:{%.2d} SNR:{%.2d} EVM:{-%.2d}\n", -+ rate_type, *tmp_cnt, -+ tmp_rssi_avg[0], tmp_snr_avg[0], evm_rpt_show[0]); -+#endif -+} -+ -+void phydm_get_avg_phystatus_val(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; -+ struct phydm_phystatus_avg *dbg_avg = &dbg_i->phystatus_statistic_avg; -+ u32 avg_tmp = 0; -+ u8 i = 0; -+ -+ PHYDM_DBG(dm, DBG_CMN, "[PHY Avg] ==============>\n"); -+ phydm_reset_phystatus_avg(dm); -+ -+ /*@===[Beacon]===*/ -+ if (dbg_s->rssi_beacon_cnt) { -+ for (i = 0; i < dm->num_rf_path; i++) { -+ avg_tmp = dbg_s->rssi_beacon_sum[i] / -+ dbg_s->rssi_beacon_cnt; -+ dbg_avg->rssi_beacon_avg[i] = (u8)avg_tmp; -+ } -+ } -+ -+ switch (dm->num_rf_path) { -+#if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case 4: -+ PHYDM_DBG(dm, DBG_CMN, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0], -+ dbg_avg->rssi_beacon_avg[1], -+ dbg_avg->rssi_beacon_avg[2], -+ dbg_avg->rssi_beacon_avg[3]); -+ break; -+#endif -+#if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case 3: -+ PHYDM_DBG(dm, DBG_CMN, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0], -+ dbg_avg->rssi_beacon_avg[1], -+ dbg_avg->rssi_beacon_avg[2]); -+ break; -+#endif -+#if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case 2: -+ PHYDM_DBG(dm, DBG_CMN, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0], -+ dbg_avg->rssi_beacon_avg[1]); -+ break; -+#endif -+ default: -+ PHYDM_DBG(dm, DBG_CMN, "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0]); -+ break; -+ } -+ -+ /*@===[CCK]===*/ -+ if (dbg_s->rssi_cck_cnt) { -+ dbg_avg->rssi_cck_avg = (u8)(dbg_s->rssi_cck_sum / -+ dbg_s->rssi_cck_cnt); -+ #if (defined(PHYSTS_3RD_TYPE_SUPPORT) && defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & PHYSTS_3RD_TYPE_IC) { -+ for (i = 0; i < dm->num_rf_path - 1; i++) { -+ avg_tmp = dbg_s->rssi_cck_sum_abv_2ss[i] / -+ dbg_s->rssi_cck_cnt; -+ dbg_avg->rssi_cck_avg_abv_2ss[i] = (u8)avg_tmp; -+ } -+ } -+ #endif -+ } -+ -+ switch (dm->num_rf_path) { -+#ifdef PHYSTS_3RD_TYPE_SUPPORT -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case 4: -+ PHYDM_DBG(dm, DBG_CMN, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, dbg_avg->rssi_cck_avg, -+ dbg_avg->rssi_cck_avg_abv_2ss[0], -+ dbg_avg->rssi_cck_avg_abv_2ss[1], -+ dbg_avg->rssi_cck_avg_abv_2ss[2]); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case 3: -+ PHYDM_DBG(dm, DBG_CMN, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, dbg_avg->rssi_cck_avg, -+ dbg_avg->rssi_cck_avg_abv_2ss[0], -+ dbg_avg->rssi_cck_avg_abv_2ss[1]); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case 2: -+ PHYDM_DBG(dm, DBG_CMN, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, dbg_avg->rssi_cck_avg, -+ dbg_avg->rssi_cck_avg_abv_2ss[0]); -+ break; -+ #endif -+#endif -+ default: -+ PHYDM_DBG(dm, DBG_CMN, "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, dbg_avg->rssi_cck_avg); -+ break; -+ } -+ -+ for (i = 0; i <= dm->num_rf_path; i++) -+ phydm_avg_phy_val_nss(dm, i); -+} -+ -+void phydm_get_phy_statistic(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[dm->one_entry_macid]; -+ enum channel_width bw; -+ u16 avg_phy_rate = 0; -+ u16 utility = 0; -+ u8 rx_ss = 1; -+ -+ avg_phy_rate = phydm_rx_avg_phy_rate(dm); -+ -+ if (dm->is_one_entry_only && is_sta_active(sta)) { -+ rx_ss = phydm_get_rx_stream_num(dm, sta->mimo_type); -+ bw = sta->bw_mode; -+ utility = phydm_rx_utility(dm, avg_phy_rate, rx_ss, bw); -+ } -+ PHYDM_DBG(dm, DBG_CMN, "Avg_rx_rate = %d, rx_utility=( %d / 1000 )\n", -+ avg_phy_rate, utility); -+ -+ phydm_rx_rate_distribution(dm); -+ phydm_reset_rx_rate_distribution(dm); -+ -+ phydm_show_phy_hitogram(dm); -+ #ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ phydm_show_cn_hitogram(dm); -+ #endif -+ phydm_get_avg_phystatus_val(dm); -+ phydm_reset_phystatus_statistic(dm); -+}; -+ -+void phydm_basic_dbg_msg_linked(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_cfo_track_struct *cfo_t = &dm->dm_cfo_track; -+ struct odm_phy_dbg_info *dbg_t = &dm->phy_dbg_info; -+ u16 macid, client_cnt = 0; -+ u8 rate = 0; -+ struct cmn_sta_info *entry = NULL; -+ char dbg_buf[PHYDM_SNPRINT_SIZE] = {0}; -+ struct phydm_cfo_rpt cfo; -+ u8 i = 0; -+ -+ PHYDM_DBG(dm, DBG_CMN, "ID=((%d)), BW=((%d)), fc=((CH-%d))\n", -+ dm->curr_station_id, 20 << *dm->band_width, *dm->channel); -+ -+ #ifdef ODM_IC_11N_SERIES_SUPPORT -+ #ifdef PHYDM_PRIMARY_CCA -+ if (((*dm->channel <= 14) && (*dm->band_width == CHANNEL_WIDTH_40)) && -+ (dm->support_ic_type & ODM_IC_11N_SERIES) && -+ (dm->support_ability & ODM_BB_PRIMARY_CCA)) { -+ PHYDM_DBG(dm, DBG_CMN, "Primary CCA at ((%s SB))\n", -+ ((*dm->sec_ch_offset == SECOND_CH_AT_LSB) ? "U" : -+ "L")); -+ } -+ #endif -+ #endif -+ -+ if (dm->cck_new_agc || dm->rx_rate > ODM_RATE11M) { -+ PHYDM_DBG(dm, DBG_CMN, "[AGC Idx] {0x%x, 0x%x, 0x%x, 0x%x}\n", -+ dm->ofdm_agc_idx[0], dm->ofdm_agc_idx[1], -+ dm->ofdm_agc_idx[2], dm->ofdm_agc_idx[3]); -+ } else { -+ PHYDM_DBG(dm, DBG_CMN, "[CCK AGC Idx] {LNA,VGA}={0x%x, 0x%x}\n", -+ dm->cck_lna_idx, dm->cck_vga_idx); -+ } -+ -+ phydm_print_rate_2_buff(dm, dm->rx_rate, dbg_buf, PHYDM_SNPRINT_SIZE); -+ PHYDM_DBG(dm, DBG_CMN, "RSSI:{%d, %d, %d, %d}, RxRate:%s (0x%x)\n", -+ (dm->rssi_a == 0xff) ? 0 : dm->rssi_a, -+ (dm->rssi_b == 0xff) ? 0 : dm->rssi_b, -+ (dm->rssi_c == 0xff) ? 0 : dm->rssi_c, -+ (dm->rssi_d == 0xff) ? 0 : dm->rssi_d, -+ dbg_buf, dm->rx_rate); -+ -+ rate = dbg_t->beacon_phy_rate; -+ phydm_print_rate_2_buff(dm, rate, dbg_buf, PHYDM_SNPRINT_SIZE); -+ -+ PHYDM_DBG(dm, DBG_CMN, "Beacon_cnt=%d, rate_idx=%s (0x%x)\n", -+ dbg_t->num_qry_beacon_pkt, dbg_buf, dbg_t->beacon_phy_rate); -+ -+ phydm_get_phy_statistic(dm); -+ -+ PHYDM_DBG(dm, DBG_CMN, -+ "rxsc_idx {Legacy, 20, 40, 80} = {%d, %d, %d, %d}\n", -+ dm->rxsc_l, dm->rxsc_20, dm->rxsc_40, dm->rxsc_80); -+ -+ /*Print TX rate*/ -+ for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { -+ entry = dm->phydm_sta_info[macid]; -+ -+ if (!is_sta_active(entry)) -+ continue; -+ -+ rate = entry->ra_info.curr_tx_rate; -+ phydm_print_rate_2_buff(dm, rate, dbg_buf, PHYDM_SNPRINT_SIZE); -+ PHYDM_DBG(dm, DBG_CMN, "TxRate[%d]=%s (0x%x)\n", -+ macid, dbg_buf, entry->ra_info.curr_tx_rate); -+ -+ client_cnt++; -+ -+ if (client_cnt >= dm->number_linked_client) -+ break; -+ } -+ -+ PHYDM_DBG(dm, DBG_CMN, -+ "TP {Tx, Rx, Total} = {%d, %d, %d}Mbps, Traffic_Load=(%d))\n", -+ dm->tx_tp, dm->rx_tp, dm->total_tp, dm->traffic_load); -+ -+ PHYDM_DBG(dm, DBG_CMN, "CFO_avg=((%d kHz)), CFO_traking = ((%s%d))\n", -+ cfo_t->CFO_ave_pre, -+ ((cfo_t->crystal_cap > cfo_t->def_x_cap) ? "+" : "-"), -+ DIFF_2(cfo_t->crystal_cap, cfo_t->def_x_cap)); -+ -+ /* @CFO report */ -+ switch (dm->ic_ip_series) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ case PHYDM_IC_JGR3: -+ PHYDM_DBG(dm, DBG_CMN, "cfo_tail = {%d, %d, %d, %d}\n", -+ dbg_t->cfo_tail[0], dbg_t->cfo_tail[1], -+ dbg_t->cfo_tail[2], dbg_t->cfo_tail[3]); -+ break; -+ #endif -+ default: -+ phydm_get_cfo_info(dm, &cfo); -+ for (i = 0; i < dm->num_rf_path; i++) { -+ PHYDM_DBG(dm, DBG_CMN, -+ "CFO[%d] {S, L, Sec, Acq, End} = {%d, %d, %d, %d, %d}\n", -+ i, cfo.cfo_rpt_s[i], cfo.cfo_rpt_l[i], -+ cfo.cfo_rpt_sec[i], cfo.cfo_rpt_acq[i], -+ cfo.cfo_rpt_end[i]); -+ } -+ break; -+ } -+ -+/* @Condition number */ -+#if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ PHYDM_DBG(dm, DBG_CMN, "Condi_Num=((%d.%.4d)), %d\n", -+ dbg_t->condi_num >> 4, -+ phydm_show_fraction_num(dbg_t->condi_num & 0xf, 4), -+ dbg_t->condi_num); -+ } -+#endif -+#ifdef PHYSTS_3RD_TYPE_SUPPORT -+ if (dm->support_ic_type & PHYSTS_3RD_TYPE_IC) { -+ PHYDM_DBG(dm, DBG_CMN, "Condi_Num=((%d.%4d dB))\n", -+ dbg_t->condi_num >> 1, -+ phydm_show_fraction_num(dbg_t->condi_num & 0x1, 1)); -+ } -+#endif -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT || defined(PHYSTS_3RD_TYPE_SUPPORT)) -+ /*STBC or LDPC pkt*/ -+ if (dm->support_ic_type & (PHYSTS_2ND_TYPE_IC | PHYSTS_3RD_TYPE_IC)) -+ PHYDM_DBG(dm, DBG_CMN, "Coding: LDPC=((%s)), STBC=((%s))\n", -+ (dbg_t->is_ldpc_pkt) ? "Y" : "N", -+ (dbg_t->is_stbc_pkt) ? "Y" : "N"); -+#endif -+ -+#if (RTL8822C_SUPPORT || RTL8723F_SUPPORT) -+ /*Beamformed pkt*/ -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8723F)) -+ PHYDM_DBG(dm, DBG_CMN, "Beamformed=((%s))\n", -+ (dm->is_beamformed) ? "Y" : "N"); -+#endif -+} -+ -+void phydm_dm_summary(void *dm_void, u8 macid) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_cfo_track_struct *cfo_t = &dm->dm_cfo_track; -+ struct cmn_sta_info *sta = NULL; -+ struct ra_sta_info *ra = NULL; -+ struct dtp_info *dtp = NULL; -+ u64 comp = dm->support_ability; -+ u64 pause_comp = dm->pause_ability; -+ -+ if (!(dm->debug_components & DBG_DM_SUMMARY)) -+ return; -+ -+ if (!dm->is_linked) { -+ pr_debug("[%s]No Link !!!\n", __func__); -+ return; -+ } -+ -+ sta = dm->phydm_sta_info[macid]; -+ -+ if (!is_sta_active(sta)) { -+ pr_debug("[Warning] %s invalid STA, macid=%d\n", -+ __func__, macid); -+ return; -+ } -+ -+ ra = &sta->ra_info; -+ dtp = &sta->dtp_stat; -+ pr_debug("[%s]===========>\n", __func__); -+ -+ pr_debug("00.(%s) %-12s: IGI=0x%x, Dyn_Rng=0x%x~0x%x, FA_th={%d,%d,%d}\n", -+ ((comp & ODM_BB_DIG) ? -+ ((pause_comp & ODM_BB_DIG) ? "P" : "V") : "."), -+ "DIG", -+ dig_t->cur_ig_value, -+ dig_t->rx_gain_range_min, dig_t->rx_gain_range_max, -+ dig_t->fa_th[0], dig_t->fa_th[1], dig_t->fa_th[2]); -+ -+ pr_debug("01.(%s) %-12s: rssi_lv=%d, mask=0x%llx\n", -+ ((comp & ODM_BB_RA_MASK) ? -+ ((pause_comp & ODM_BB_RA_MASK) ? "P" : "V") : "."), -+ "RaMask", -+ ra->rssi_level, ra->ramask); -+ -+#ifdef CONFIG_DYNAMIC_TX_TWR -+ pr_debug("02.(%s) %-12s: pwr_lv=%d\n", -+ ((comp & ODM_BB_DYNAMIC_TXPWR) ? -+ ((pause_comp & ODM_BB_DYNAMIC_TXPWR) ? "P" : "V") : "."), -+ "DynTxPwr", -+ dtp->sta_tx_high_power_lvl); -+#endif -+ -+ pr_debug("05.(%s) %-12s: cck_pd_lv=%d\n", -+ ((comp & ODM_BB_CCK_PD) ? -+ ((pause_comp & ODM_BB_CCK_PD) ? "P" : "V") : "."), -+ "CCK_PD", dm->dm_cckpd_table.cck_pd_lv); -+ -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ pr_debug("06.(%s) %-12s: div_type=%d, curr_ant=%s\n", -+ ((comp & ODM_BB_ANT_DIV) ? -+ ((pause_comp & ODM_BB_ANT_DIV) ? "P" : "V") : "."), -+ "ANT_DIV", -+ dm->ant_div_type, -+ (dm->dm_fat_table.rx_idle_ant == MAIN_ANT) ? "MAIN" : "AUX"); -+#endif -+ -+#ifdef PHYDM_POWER_TRAINING_SUPPORT -+ pr_debug("08.(%s) %-12s: PT_score=%d, disable_PT=%d\n", -+ ((comp & ODM_BB_PWR_TRAIN) ? -+ ((pause_comp & ODM_BB_PWR_TRAIN) ? "P" : "V") : "."), -+ "PwrTrain", -+ dm->pow_train_table.pow_train_score, -+ dm->is_disable_power_training); -+#endif -+ -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ pr_debug("11.(%s) %-12s: dbg_mode=%d, region_domain=%d\n", -+ ((comp & ODM_BB_DFS) ? -+ ((pause_comp & ODM_BB_DFS) ? "P" : "V") : "."), -+ "DFS", -+ dm->dfs.dbg_mode, dm->dfs_region_domain); -+#endif -+#ifdef PHYDM_SUPPORT_ADAPTIVITY -+ pr_debug("13.(%s) %-12s: th{l2h, h2l}={%d, %d}, edcca_flag=%d\n", -+ ((comp & ODM_BB_ADAPTIVITY) ? -+ ((pause_comp & ODM_BB_ADAPTIVITY) ? "P" : "V") : "."), -+ "Adaptivity", -+ dm->adaptivity.th_l2h, dm->adaptivity.th_h2l, -+ dm->false_alm_cnt.edcca_flag); -+#endif -+ pr_debug("14.(%s) %-12s: CFO_avg=%d kHz, CFO_traking=%s%d\n", -+ ((comp & ODM_BB_CFO_TRACKING) ? -+ ((pause_comp & ODM_BB_CFO_TRACKING) ? "P" : "V") : "."), -+ "CfoTrack", -+ cfo_t->CFO_ave_pre, -+ ((cfo_t->crystal_cap > cfo_t->def_x_cap) ? "+" : "-"), -+ DIFF_2(cfo_t->crystal_cap, cfo_t->def_x_cap)); -+ -+ pr_debug("15.(%s) %-12s: ratio{nhm, clm}={%d, %d}\n", -+ ((comp & ODM_BB_ENV_MONITOR) ? -+ ((pause_comp & ODM_BB_ENV_MONITOR) ? "P" : "V") : "."), -+ "EnvMntr", -+ dm->dm_ccx_info.nhm_ratio, dm->dm_ccx_info.clm_ratio); -+ -+#ifdef PHYDM_PRIMARY_CCA -+ pr_debug("16.(%s) %-12s: CCA @ (%s SB)\n", -+ ((comp & ODM_BB_PRIMARY_CCA) ? -+ ((pause_comp & ODM_BB_PRIMARY_CCA) ? "P" : "V") : "."), -+ "PriCCA", -+ ((dm->dm_pri_cca.mf_state == MF_USC_LSC) ? "D" : -+ ((dm->dm_pri_cca.mf_state == MF_LSC) ? "L" : "U"))); -+#endif -+#ifdef CONFIG_ADAPTIVE_SOML -+ pr_debug("17.(%s) %-12s: soml_en = %s\n", -+ ((comp & ODM_BB_ADAPTIVE_SOML) ? -+ ((pause_comp & ODM_BB_ADAPTIVE_SOML) ? "P" : "V") : "."), -+ "A-SOML", -+ (dm->dm_soml_table.soml_last_state == SOML_ON) ? -+ "ON" : "OFF"); -+#endif -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ pr_debug("18.(%s) %-12s:\n", -+ ((comp & ODM_BB_LNA_SAT_CHK) ? -+ ((pause_comp & ODM_BB_LNA_SAT_CHK) ? "P" : "V") : "."), -+ "LNA_SAT_CHK"); -+#endif -+} -+ -+void phydm_basic_dbg_message(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct odm_phy_dbg_info *dbg_b = &dm->phy_dbg_info_win_bkp; -+ #endif -+ #ifdef NHM_SUPPORT -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ #endif -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /* backup memory*/ -+ odm_move_memory(dm, dbg_b, dbg, sizeof(struct odm_phy_dbg_info)); -+ #endif -+ -+ if (!(dm->debug_components & DBG_CMN)) { -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /* reset rx rate distribution*/ -+ phydm_reset_rx_rate_distribution(dm); -+ /* cal & reset avg of rssi/snr/evm*/ -+ phydm_get_avg_phystatus_val(dm); -+ /* reset sum of rssi/snr/evm*/ -+ phydm_reset_phystatus_statistic(dm); -+ #endif -+ return; -+ } -+ -+ if (dm->cmn_dbg_msg_cnt >= dm->cmn_dbg_msg_period) { -+ dm->cmn_dbg_msg_cnt = PHYDM_WATCH_DOG_PERIOD; -+ } else { -+ dm->cmn_dbg_msg_cnt += PHYDM_WATCH_DOG_PERIOD; -+ return; -+ } -+ -+ PHYDM_DBG(dm, DBG_CMN, "[%s] System up time: ((%d sec))---->\n", -+ __func__, dm->phydm_sys_up_time); -+ -+ if (dm->is_linked) -+ phydm_basic_dbg_msg_linked(dm); -+ else -+ PHYDM_DBG(dm, DBG_CMN, "No Link !!!\n"); -+ -+ PHYDM_DBG(dm, DBG_CMN, -+ "[Tx cnt] {CCK_TxEN, CCK_TxON, OFDM_TxEN, OFDM_TxON} = {%d, %d, %d, %d}\n", -+ fa_t->cnt_cck_txen, fa_t->cnt_cck_txon, fa_t->cnt_ofdm_txen, -+ fa_t->cnt_ofdm_txon); -+ PHYDM_DBG(dm, DBG_CMN, "[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ fa_t->cnt_cck_cca, fa_t->cnt_ofdm_cca, fa_t->cnt_cca_all); -+ PHYDM_DBG(dm, DBG_CMN, "[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ fa_t->cnt_cck_fail, fa_t->cnt_ofdm_fail, fa_t->cnt_all); -+ PHYDM_DBG(dm, DBG_CMN, -+ "[FA duration(us)] {exp, ifs_clm, fahm} = {%d, %d, %d}\n", -+ fa_t->time_fa_exp, fa_t->time_fa_ifs_clm, -+ fa_t->time_fa_fahm); -+ PHYDM_DBG(dm, DBG_CMN, -+ "[OFDM FA] Parity=%d, Rate=%d, Fast_Fsync=%d, SBD=%d\n", -+ fa_t->cnt_parity_fail, fa_t->cnt_rate_illegal, -+ fa_t->cnt_fast_fsync, fa_t->cnt_sb_search_fail); -+ PHYDM_DBG(dm, DBG_CMN, "[HT FA] CRC8=%d, MCS=%d\n", -+ fa_t->cnt_crc8_fail, fa_t->cnt_mcs_fail); -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ if (dm->support_ic_type & (ODM_IC_11AC_SERIES | ODM_IC_JGR3_SERIES)) { -+ PHYDM_DBG(dm, DBG_CMN, -+ "[VHT FA] SIGA_CRC8=%d, SIGB_CRC8=%d, MCS=%d\n", -+ fa_t->cnt_crc8_fail_vhta, fa_t->cnt_crc8_fail_vhtb, -+ fa_t->cnt_mcs_fail_vht); -+ } -+#endif -+ PHYDM_DBG(dm, DBG_CMN, -+ "[CRC32 OK Cnt] {CCK, OFDM, HT, VHT, Total} = {%d, %d, %d, %d, %d}\n", -+ fa_t->cnt_cck_crc32_ok, fa_t->cnt_ofdm_crc32_ok, -+ fa_t->cnt_ht_crc32_ok, fa_t->cnt_vht_crc32_ok, -+ fa_t->cnt_crc32_ok_all); -+ PHYDM_DBG(dm, DBG_CMN, -+ "[CRC32 Err Cnt] {CCK, OFDM, HT, VHT, Total} = {%d, %d, %d, %d, %d}\n", -+ fa_t->cnt_cck_crc32_error, fa_t->cnt_ofdm_crc32_error, -+ fa_t->cnt_ht_crc32_error, fa_t->cnt_vht_crc32_error, -+ fa_t->cnt_crc32_error_all); -+ -+ if (dm->support_ic_type & (ODM_IC_11N_SERIES | ODM_IC_11AC_SERIES)) -+ PHYDM_DBG(dm, DBG_CMN, -+ "is_linked = %d, Num_client = %d, rssi_min = %d, IGI = 0x%x, bNoisy=%d\n", -+ dm->is_linked, dm->number_linked_client, dm->rssi_min, -+ dm->dm_dig_table.cur_ig_value, dm->noisy_decision); -+ else -+ PHYDM_DBG(dm, DBG_CMN, -+ "is_linked = %d, Num_client = %d, rssi_min = %d, IGI = 0x%x\n", -+ dm->is_linked, dm->number_linked_client, dm->rssi_min, -+ dm->dm_dig_table.cur_ig_value); -+ -+ PHYDM_DBG(dm, DBG_CMN, -+ "ratio{nhm, nhm_env, clm, idle, tx}={%d, %d, %d, %d, %d}, nhm_pwr=%d\n", -+ ccx->nhm_ratio, ccx->nhm_env_ratio, ccx->clm_ratio, -+ ccx->nhm_idle_ratio, ccx->nhm_tx_ratio, ccx->nhm_pwr); -+ -+ PHYDM_DBG(dm, DBG_CMN, -+ "NHM_Rpt(H->L)[%d %d %d %d %d %d %d %d %d %d %d %d]\n", -+ ccx->nhm_result[11], ccx->nhm_result[10], ccx->nhm_result[9], -+ ccx->nhm_result[8], ccx->nhm_result[7], ccx->nhm_result[6], -+ ccx->nhm_result[5], ccx->nhm_result[4], ccx->nhm_result[3], -+ ccx->nhm_result[2], ccx->nhm_result[1], ccx->nhm_result[0]); -+ -+#ifdef EDCCA_CLM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_EDCCA_CLM) { -+ PHYDM_DBG(dm, DBG_CMN, "edcca_clm_ratio=%d\n", -+ ccx->edcca_clm_ratio); -+ } -+#endif -+} -+ -+void phydm_basic_profile(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char *cut = NULL; -+ char *ic_type = NULL; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 date = 0; -+ char *commit_by = NULL; -+ u32 release_ver = 0; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-35s\n", -+ "% Basic Profile %"); -+ -+ if (dm->support_ic_type == ODM_RTL8188E) { -+#if (RTL8188E_SUPPORT) -+ ic_type = "RTL8188E"; -+ date = RELEASE_DATE_8188E; -+ commit_by = COMMIT_BY_8188E; -+ release_ver = RELEASE_VERSION_8188E; -+#endif -+#if (RTL8812A_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8812) { -+ ic_type = "RTL8812A"; -+ date = RELEASE_DATE_8812A; -+ commit_by = COMMIT_BY_8812A; -+ release_ver = RELEASE_VERSION_8812A; -+#endif -+#if (RTL8821A_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8821) { -+ ic_type = "RTL8821A"; -+ date = RELEASE_DATE_8821A; -+ commit_by = COMMIT_BY_8821A; -+ release_ver = RELEASE_VERSION_8821A; -+#endif -+#if (RTL8192E_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8192E) { -+ ic_type = "RTL8192E"; -+ date = RELEASE_DATE_8192E; -+ commit_by = COMMIT_BY_8192E; -+ release_ver = RELEASE_VERSION_8192E; -+#endif -+#if (RTL8723B_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8723B) { -+ ic_type = "RTL8723B"; -+ date = RELEASE_DATE_8723B; -+ commit_by = COMMIT_BY_8723B; -+ release_ver = RELEASE_VERSION_8723B; -+#endif -+#if (RTL8814A_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8814A) { -+ ic_type = "RTL8814A"; -+ date = RELEASE_DATE_8814A; -+ commit_by = COMMIT_BY_8814A; -+ release_ver = RELEASE_VERSION_8814A; -+#endif -+#if (RTL8881A_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8881A) { -+ ic_type = "RTL8881A"; -+#endif -+#if (RTL8822B_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8822B) { -+ ic_type = "RTL8822B"; -+ date = RELEASE_DATE_8822B; -+ commit_by = COMMIT_BY_8822B; -+ release_ver = RELEASE_VERSION_8822B; -+#endif -+#if (RTL8197F_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8197F) { -+ ic_type = "RTL8197F"; -+ date = RELEASE_DATE_8197F; -+ commit_by = COMMIT_BY_8197F; -+ release_ver = RELEASE_VERSION_8197F; -+#endif -+#if (RTL8703B_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8703B) { -+ ic_type = "RTL8703B"; -+ date = RELEASE_DATE_8703B; -+ commit_by = COMMIT_BY_8703B; -+ release_ver = RELEASE_VERSION_8703B; -+#endif -+#if (RTL8195A_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8195A) { -+ ic_type = "RTL8195A"; -+#endif -+#if (RTL8188F_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8188F) { -+ ic_type = "RTL8188F"; -+ date = RELEASE_DATE_8188F; -+ commit_by = COMMIT_BY_8188F; -+ release_ver = RELEASE_VERSION_8188F; -+#endif -+#if (RTL8723D_SUPPORT) -+ } else if (dm->support_ic_type == ODM_RTL8723D) { -+ ic_type = "RTL8723D"; -+ date = RELEASE_DATE_8723D; -+ commit_by = COMMIT_BY_8723D; -+ release_ver = RELEASE_VERSION_8723D; -+#endif -+ } -+ -+/* @JJ ADD 20161014 */ -+#if (RTL8710B_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8710B) { -+ ic_type = "RTL8710B"; -+ date = RELEASE_DATE_8710B; -+ commit_by = COMMIT_BY_8710B; -+ release_ver = RELEASE_VERSION_8710B; -+ } -+#endif -+ -+#if (RTL8721D_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8721D) { -+ ic_type = "RTL8721D"; -+ date = RELEASE_DATE_8721D; -+ commit_by = COMMIT_BY_8721D; -+ release_ver = RELEASE_VERSION_8721D; -+ } -+#endif -+ -+#if (RTL8710C_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8710C) { -+ ic_type = "RTL8710C"; -+ date = RELEASE_DATE_8710C; -+ commit_by = COMMIT_BY_8710C; -+ release_ver = RELEASE_VERSION_8710C; -+ } -+#endif -+ -+#if (RTL8821C_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8821C) { -+ ic_type = "RTL8821C"; -+ date = RELEASE_DATE_8821C; -+ commit_by = COMMIT_BY_8821C; -+ release_ver = RELEASE_VERSION_8821C; -+ } -+#endif -+ -+/*@jj add 20170822*/ -+#if (RTL8192F_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8192F) { -+ ic_type = "RTL8192F"; -+ date = RELEASE_DATE_8192F; -+ commit_by = COMMIT_BY_8192F; -+ release_ver = RELEASE_VERSION_8192F; -+ } -+#endif -+ -+#if (RTL8198F_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8198F) { -+ ic_type = "RTL8198F"; -+ date = RELEASE_DATE_8198F; -+ commit_by = COMMIT_BY_8198F; -+ release_ver = RELEASE_VERSION_8198F; -+ } -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8822C) { -+ ic_type = "RTL8822C"; -+ date = RELEASE_DATE_8822C; -+ commit_by = COMMIT_BY_8822C; -+ release_ver = RELEASE_VERSION_8822C; -+ } -+#endif -+ -+#if (RTL8723F_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8723F) { -+ ic_type = "RTL8723F"; -+ date = RELEASE_DATE_8723F; -+ commit_by = COMMIT_BY_8723F; -+ release_ver = RELEASE_VERSION_8723F; -+ } -+#endif -+#if (RTL8812F_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8812F) { -+ ic_type = "RTL8812F"; -+ date = RELEASE_DATE_8812F; -+ commit_by = COMMIT_BY_8812F; -+ release_ver = RELEASE_VERSION_8812F; -+ } -+#endif -+ -+#if (RTL8197G_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8197G) { -+ ic_type = "RTL8197G"; -+ date = RELEASE_DATE_8197G; -+ commit_by = COMMIT_BY_8197G; -+ release_ver = RELEASE_VERSION_8197G; -+ } -+#endif -+ -+#if (RTL8814B_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8814B) { -+ ic_type = "RTL8814B"; -+ date = RELEASE_DATE_8814B; -+ commit_by = COMMIT_BY_8814B; -+ release_ver = RELEASE_VERSION_8814B; -+ } -+#endif -+#if (RTL8814C_SUPPORT) -+ else if (dm->support_ic_type == ODM_RTL8814C) { -+ ic_type = "RTL8814C"; -+ date = RELEASE_DATE_8814C; -+ commit_by = COMMIT_BY_8814C; -+ release_ver = RELEASE_VERSION_8814C; -+ } -+#endif -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-35s: %s (MP Chip: %s)\n", "IC type", ic_type, -+ dm->is_mp_chip ? "Yes" : "No"); -+ -+ if (dm->cut_version == ODM_CUT_A) -+ cut = "A"; -+ else if (dm->cut_version == ODM_CUT_B) -+ cut = "B"; -+ else if (dm->cut_version == ODM_CUT_C) -+ cut = "C"; -+ else if (dm->cut_version == ODM_CUT_D) -+ cut = "D"; -+ else if (dm->cut_version == ODM_CUT_E) -+ cut = "E"; -+ else if (dm->cut_version == ODM_CUT_F) -+ cut = "F"; -+ else if (dm->cut_version == ODM_CUT_G) -+ cut = "G"; -+ else if (dm->cut_version == ODM_CUT_H) -+ cut = "H"; -+ else if (dm->cut_version == ODM_CUT_I) -+ cut = "I"; -+ else if (dm->cut_version == ODM_CUT_J) -+ cut = "J"; -+ else if (dm->cut_version == ODM_CUT_K) -+ cut = "K"; -+ else if (dm->cut_version == ODM_CUT_L) -+ cut = "L"; -+ else if (dm->cut_version == ODM_CUT_M) -+ cut = "M"; -+ else if (dm->cut_version == ODM_CUT_N) -+ cut = "N"; -+ else if (dm->cut_version == ODM_CUT_O) -+ cut = "O"; -+ else if (dm->cut_version == ODM_CUT_TEST) -+ cut = "TEST"; -+ else -+ cut = "UNKNOWN"; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %d\n", -+ "RFE type", dm->rfe_type); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "CART_Ver", cut); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %d\n", -+ "PHY Para Ver", odm_get_hw_img_version(dm)); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %d\n", -+ "PHY Para Commit date", date); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "PHY Para Commit by", commit_by); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %d\n", -+ "PHY Para Release Ver", release_ver); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-35s: %d (Subversion: %d)\n", "FW Ver", dm->fw_version, -+ dm->fw_sub_version); -+ -+ /* @1 PHY DM version List */ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%-35s\n", -+ "% PHYDM version %"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "Code base", PHYDM_CODE_BASE); -+#ifdef PHYDM_SVN_REV -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "PHYDM SVN Ver", PHYDM_SVN_REV); -+#endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "Release Date", PHYDM_RELEASE_DATE); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "Adaptivity", ADAPTIVITY_VERSION); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "DIG", DIG_VERSION); -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "CFO Tracking", CFO_TRACKING_VERSION); -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "AntDiv", ANTDIV_VERSION); -+#endif -+#ifdef CONFIG_DYNAMIC_TX_TWR -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "Dynamic TxPower", DYNAMIC_TXPWR_VERSION); -+#endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "RA Info", RAINFO_VERSION); -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "AntDetect", ANTDECT_VERSION); -+#endif -+#ifdef CONFIG_PATH_DIVERSITY -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "PathDiv", PATHDIV_VERSION); -+#endif -+#ifdef CONFIG_ADAPTIVE_SOML -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "Adaptive SOML", ADAPTIVE_SOML_VERSION); -+#endif -+#if (PHYDM_LA_MODE_SUPPORT) -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "LA mode", DYNAMIC_LA_MODE); -+#endif -+#ifdef PHYDM_PRIMARY_CCA -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "Primary CCA", PRIMARYCCA_VERSION); -+#endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", -+ "DFS", DFS_VERSION); -+ -+#if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8822B) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-35s: %s\n", "PHY config 8822B", -+ PHY_CONFIG_VERSION_8822B); -+ -+#endif -+#if (RTL8197F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197F) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-35s: %s\n", "PHY config 8197F", -+ PHY_CONFIG_VERSION_8197F); -+#endif -+ -+/*@jj add 20170822*/ -+#if (RTL8192F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8192F) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-35s: %s\n", "PHY config 8192F", -+ PHY_CONFIG_VERSION_8192F); -+#endif -+#if (RTL8721D_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8721D) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-35s: %s\n", "PHY config 8721D", -+ PHY_CONFIG_VERSION_8721D); -+#endif -+ -+#if (RTL8710C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8710C) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-35s: %s\n", "PHY config 8710C", -+ PHY_CONFIG_VERSION_8710C); -+#endif -+ -+ *_used = used; -+ *_out_len = out_len; -+ -+#endif /*@#if CONFIG_PHYDM_DEBUG_FUNCTION*/ -+} -+ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+void phydm_fw_trace_en_h2c(void *dm_void, boolean enable, -+ u32 fw_dbg_comp, u32 monitor_mode, u32 macid) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 h2c_parameter[7] = {0}; -+ u8 cmd_length; -+ -+ if (dm->support_ic_type & PHYDM_IC_3081_SERIES) { -+ h2c_parameter[0] = enable; -+ h2c_parameter[1] = (u8)(fw_dbg_comp & MASKBYTE0); -+ h2c_parameter[2] = (u8)((fw_dbg_comp & MASKBYTE1) >> 8); -+ h2c_parameter[3] = (u8)((fw_dbg_comp & MASKBYTE2) >> 16); -+ h2c_parameter[4] = (u8)((fw_dbg_comp & MASKBYTE3) >> 24); -+ h2c_parameter[5] = (u8)monitor_mode; -+ h2c_parameter[6] = (u8)macid; -+ cmd_length = 7; -+ -+ } else { -+ h2c_parameter[0] = enable; -+ h2c_parameter[1] = (u8)monitor_mode; -+ h2c_parameter[2] = (u8)macid; -+ cmd_length = 3; -+ } -+ -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[H2C] FW_debug_en: (( %d )), mode: (( %d )), macid: (( %d ))\n", -+ enable, monitor_mode, macid); -+ -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_FW_TRACE_EN, cmd_length, h2c_parameter); -+} -+ -+void phydm_get_per_path_txagc(void *dm_void, u8 path, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rate_idx = 0; -+ u8 txagc = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+#ifdef PHYDM_COMMON_API_SUPPORT -+ if (!(dm->support_ic_type & CMN_API_SUPPORT_IC)) -+ return; -+ -+ if (dm->num_rf_path == 1 && path > RF_PATH_A) -+ return; -+ else if (dm->num_rf_path == 2 && path > RF_PATH_B) -+ return; -+ else if (dm->num_rf_path == 3 && path > RF_PATH_C) -+ return; -+ else if (dm->num_rf_path == 4 && path > RF_PATH_D) -+ return; -+ -+ for (rate_idx = 0; rate_idx <= 0x53; rate_idx++) { -+ if (!(dm->support_ic_type & PHYDM_IC_ABOVE_3SS) && -+ ((rate_idx >= ODM_RATEMCS16 && -+ rate_idx < ODM_RATEVHTSS1MCS0) || -+ rate_idx >= ODM_RATEVHTSS3MCS0)) -+ continue; -+ -+ if (rate_idx == ODM_RATE1M) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " %-35s\n", "CCK====>"); -+ else if (rate_idx == ODM_RATE6M) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n %-35s\n", "OFDM====>"); -+ else if (rate_idx == ODM_RATEMCS0) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n %-35s\n", "HT 1ss====>"); -+ else if (rate_idx == ODM_RATEMCS8) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n %-35s\n", "HT 2ss====>"); -+ else if (rate_idx == ODM_RATEMCS16) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n %-35s\n", "HT 3ss====>"); -+ else if (rate_idx == ODM_RATEMCS24) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n %-35s\n", "HT 4ss====>"); -+ else if (rate_idx == ODM_RATEVHTSS1MCS0) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n %-35s\n", "VHT 1ss====>"); -+ else if (rate_idx == ODM_RATEVHTSS2MCS0) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n %-35s\n", "VHT 2ss====>"); -+ else if (rate_idx == ODM_RATEVHTSS3MCS0) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n %-35s\n", "VHT 3ss====>"); -+ else if (rate_idx == ODM_RATEVHTSS4MCS0) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n %-35s\n", "VHT 4ss====>"); -+ -+ txagc = phydm_api_get_txagc(dm, (enum rf_path)path, rate_idx); -+ if (config_phydm_read_txagc_check(txagc)) -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, " 0x%02x ", txagc); -+ else -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, " 0x%s ", "xx"); -+ } -+#endif -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_get_txagc(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ -+ #if (RTL8822C_SUPPORT) -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "Disabled DPD rate mask: 0x%x\n", -+ dm->dis_dpd_rate); -+ #endif -+ -+ for (i = RF_PATH_A; i < dm->num_rf_path; i++) { -+ if (i == RF_PATH_A) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-35s\n", "path-A===================="); -+ else if (i == RF_PATH_B) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n%-35s\n", "path-B===================="); -+ else if (i == RF_PATH_C) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n%-35s\n", "path-C===================="); -+ else if (i == RF_PATH_D) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n%-35s\n", "path-D===================="); -+ -+ phydm_get_per_path_txagc(dm, i, &used, output, &out_len); -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_set_txagc(void *dm_void, u32 *const val, u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ u32 pow = 0; /*power index*/ -+ u8 vht_start_rate = ODM_RATEVHTSS1MCS0; -+ boolean rpt = true; -+ enum rf_path path = RF_PATH_A; -+ -+/*@val[1] = path*/ -+/*@val[2] = hw_rate*/ -+/*@val[3] = power_index*/ -+ -+#ifdef PHYDM_COMMON_API_SUPPORT -+ if (!(dm->support_ic_type & CMN_API_SUPPORT_IC)) -+ return; -+ -+ path = (enum rf_path)val[1]; -+ -+ if (val[1] >= dm->num_rf_path) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Write path-%d rate_idx-0x%x fail\n", val[1], val[2]); -+ } else if ((u8)val[2] != 0xff) { -+ if (phydm_api_set_txagc(dm, val[3], path, (u8)val[2], true)) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Write path-%d rate_idx-0x%x = 0x%x\n", -+ val[1], val[2], val[3]); -+ else -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Write path-%d rate index-0x%x fail\n", -+ val[1], val[2]); -+ } else { -+ -+ if (dm->support_ic_type & -+ (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8195B)) { -+ pow = (val[3] & 0x3f); -+ pow = BYTE_DUPLICATE_2_DWORD(pow); -+ -+ for (i = 0; i < ODM_RATEVHTSS2MCS9; i += 4) -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); -+ } else if (dm->support_ic_type & -+ (ODM_RTL8197F | ODM_RTL8192F)) { -+ pow = (val[3] & 0x3f); -+ for (i = 0; i <= ODM_RATEMCS15; i++) -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); -+ } else if (dm->support_ic_type & ODM_RTL8198F) { -+ pow = (val[3] & 0x7f); -+ for (i = 0; i <= ODM_RATEVHTSS4MCS9; i++) -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); -+ } else if (dm->support_ic_type & -+ (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G)) { -+ pow = (val[3] & 0x7f); -+ for (i = 0; i <= ODM_RATEMCS15; i++) -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); -+ for (i = vht_start_rate; i <= ODM_RATEVHTSS2MCS9; i++) -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); -+ } else if (dm->support_ic_type & -+ (ODM_RTL8721D | ODM_RTL8710C)) { -+ pow = (val[3] & 0x3f); -+ for (i = 0; i <= ODM_RATEMCS7; i++) -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); -+ } else if (dm->support_ic_type &(ODM_RTL8723F)) { -+ pow = (val[3] & 0x7f); -+ for (i = 0; i <= ODM_RATEMCS7; i++) -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); -+ } -+ -+ if (rpt) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Write all TXAGC of path-%d = 0x%x\n", -+ val[1], val[3]); -+ else -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Write all TXAGC of path-%d fail\n", val[1]); -+ } -+ -+#endif -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_shift_txagc(void *dm_void, u32 *const val, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ u32 pow = 0; /*Power index*/ -+ boolean rpt = true; -+ u8 vht_start_rate = ODM_RATEVHTSS1MCS0; -+ enum rf_path path = RF_PATH_A; -+ -+#ifdef PHYDM_COMMON_API_SUPPORT -+ if (!(dm->support_ic_type & CMN_API_SUPPORT_IC)) -+ return; -+ -+ if (val[1] >= dm->num_rf_path) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Write path-%d fail\n", val[1]); -+ return; -+ } -+ -+ path = (enum rf_path)val[1]; -+ -+ if ((u8)val[2] == 0) { -+ /*@{0:-, 1:+} {Pwr Offset}*/ -+ if (dm->support_ic_type & (ODM_RTL8195B | ODM_RTL8821C)) { -+ for (i = 0; i <= ODM_RATEMCS7; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) - val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ for (i = vht_start_rate; i <= ODM_RATEVHTSS1MCS9; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) - val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ } else if (dm->support_ic_type & (ODM_RTL8822B)) { -+ for (i = 0; i <= ODM_RATEMCS15; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) - val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ for (i = vht_start_rate; i <= ODM_RATEVHTSS2MCS9; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) - val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ } else if (dm->support_ic_type & -+ (ODM_RTL8197F | ODM_RTL8192F)) { -+ for (i = 0; i <= ODM_RATEMCS15; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) - val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ rpt &= phydm_api_shift_txagc(dm, val[3], path, 0); -+ } else if (dm->support_ic_type & -+ (ODM_RTL8721D | ODM_RTL8710C)) { -+ for (i = 0; i <= ODM_RATEMCS7; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) - val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ } -+ } else if ((u8)val[2] == 1) { -+ /*@{0:-, 1:+} {Pwr Offset}*/ -+ if (dm->support_ic_type & (ODM_RTL8195B | ODM_RTL8821C)) { -+ for (i = 0; i <= ODM_RATEMCS7; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) + val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ for (i = vht_start_rate; i <= ODM_RATEVHTSS1MCS9; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) + val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ } else if (dm->support_ic_type & (ODM_RTL8822B)) { -+ for (i = 0; i <= ODM_RATEMCS15; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) + val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ for (i = vht_start_rate; i <= ODM_RATEVHTSS2MCS9; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) + val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ } else if (dm->support_ic_type & -+ (ODM_RTL8197F | ODM_RTL8192F)) { -+ for (i = 0; i <= ODM_RATEMCS15; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) + val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ } else if (dm->support_ic_type & (ODM_RTL8721D | -+ ODM_RTL8710C)) { -+ for (i = 0; i <= ODM_RATEMCS7; i++) { -+ pow = phydm_api_get_txagc(dm, path, i) + val[3]; -+ rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); -+ } -+ } else if (dm->support_ic_type & -+ (ODM_RTL8822C | ODM_RTL8814B | ODM_RTL8814C | -+ ODM_RTL8812F | ODM_RTL8197G | ODM_RTL8723F)) { -+ rpt &= phydm_api_shift_txagc(dm, val[3], path, 1); -+ } -+ } -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[All rate] Set Path-%d Pow_idx: %s %d\n", -+ val[1], (val[2] ? "+" : "-"), val[3]); -+ else -+ #endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[All rate] Set Path-%d Pow_idx: %s %d(%d.%s dB)\n", -+ val[1], (val[2] ? "+" : "-"), val[3], val[3] >> 1, -+ ((val[3] & 1) ? "5" : "0")); -+ -+#endif -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_set_txagc_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 var1[10] = {0}; -+ char help[] = "-h"; -+ u8 i = 0, input_idx = 0; -+ -+ for (i = 0; i < 5; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ input_idx++; -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{Dis:0, En:1} {pathA~D(0~3)} {rate_idx(Hex), All_rate:0xff} {txagc_idx (Hex)}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{Pwr Shift(All rate):2} {pathA~D(0~3)} {0:-, 1:+} {Pwr Offset(Hex)}\n"); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{reset all rate ref/diff to 0x0:0xff}\n"); -+ #endif -+ } else if (var1[0] == 0) { -+ dm->is_disable_phy_api = false; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Disable API debug mode\n"); -+ } else if (var1[0] == 1) { -+ dm->is_disable_phy_api = false; -+ #ifdef CONFIG_TXAGC_DEBUG_8822C -+ config_phydm_write_txagc_8822c(dm, var1[3], -+ (enum rf_path)var1[1], -+ (u8)var1[2]); -+ #elif (defined(CONFIG_TXAGC_DEBUG_8814B)) -+ config_phydm_write_txagc_8814b(dm, var1[3], -+ (enum rf_path)var1[1], -+ (u8)var1[2]); -+ #else -+ phydm_set_txagc(dm, (u32 *)var1, &used, output, &out_len); -+ #endif -+ dm->is_disable_phy_api = true; -+ } else if (var1[0] == 2) { -+ PHYDM_SSCANF(input[4], DCMD_HEX, &var1[3]); -+ dm->is_disable_phy_api = false; -+ phydm_shift_txagc(dm, (u32 *)var1, &used, output, &out_len); -+ dm->is_disable_phy_api = true; -+ } -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ else if (var1[0] == 0xff) { -+ dm->is_disable_phy_api = false; -+ phydm_reset_txagc(dm); -+ dm->is_disable_phy_api = true; -+ } -+ #endif -+ #ifdef CONFIG_TXAGC_DEBUG_8822C -+ else if (var1[0] == 3) { -+ dm->is_disable_phy_api = false; -+ phydm_txagc_tab_buff_show_8822c(dm); -+ dm->is_disable_phy_api = true; -+ } else if (var1[0] == 4) { -+ dm->is_disable_phy_api = false; -+ config_phydm_set_txagc_to_hw_8822c(dm); -+ dm->is_disable_phy_api = true; -+ } -+ #elif (defined(CONFIG_TXAGC_DEBUG_8814B)) -+ else if (var1[0] == 3) { -+ dm->is_disable_phy_api = false; -+ phydm_txagc_tab_buff_show_8814b(dm); -+ dm->is_disable_phy_api = true; -+ } else if (var1[0] == 4) { -+ dm->is_disable_phy_api = false; -+ config_phydm_set_txagc_to_hw_8814b(dm); -+ dm->is_disable_phy_api = true; -+ } -+ #endif -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_cmn_msg_setting(void *dm_void, u32 *val, u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ if (val[1] == 1) { -+ dm->cmn_dbg_msg_period = (u8)val[2]; -+ -+ if (dm->cmn_dbg_msg_period < PHYDM_WATCH_DOG_PERIOD) -+ dm->cmn_dbg_msg_period = PHYDM_WATCH_DOG_PERIOD; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "cmn_dbg_msg_period=%d\n", dm->cmn_dbg_msg_period); -+ } -+ -+#ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ if (val[1] == 1) -+ phydm_physts_auto_switch_jgr3_set(dm, true, BIT(4) | BIT(1)); -+ else -+ phydm_physts_auto_switch_jgr3_set(dm, false, BIT(1)); -+#endif -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_debug_trace(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u64 pre_debug_components, one = 1; -+ u64 comp = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 val[10] = {0}; -+ u8 i = 0; -+ -+ for (i = 0; i < 5; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &val[i]); -+ } -+ comp = dm->debug_components; -+ pre_debug_components = dm->debug_components; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\n================================\n"); -+ if (val[0] == 100) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[DBG MSG] Component Selection\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "================================\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "00. (( %s ))DIG\n", -+ ((comp & DBG_DIG) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "01. (( %s ))RA_MASK\n", -+ ((comp & DBG_RA_MASK) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "02. (( %s ))DYN_TXPWR\n", -+ ((comp & DBG_DYN_TXPWR) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "03. (( %s ))FA_CNT\n", -+ ((comp & DBG_FA_CNT) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "04. (( %s ))RSSI_MNTR\n", -+ ((comp & DBG_RSSI_MNTR) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "05. (( %s ))CCKPD\n", -+ ((comp & DBG_CCKPD) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "06. (( %s ))ANT_DIV\n", -+ ((comp & DBG_ANT_DIV) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "07. (( %s ))SMT_ANT\n", -+ ((comp & DBG_SMT_ANT) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "08. (( %s ))PWR_TRAIN\n", -+ ((comp & DBG_PWR_TRAIN) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "09. (( %s ))RA\n", -+ ((comp & DBG_RA) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "10. (( %s ))PATH_DIV\n", -+ ((comp & DBG_PATH_DIV) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "11. (( %s ))DFS\n", -+ ((comp & DBG_DFS) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "12. (( %s ))DYN_ARFR\n", -+ ((comp & DBG_DYN_ARFR) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "13. (( %s ))ADAPTIVITY\n", -+ ((comp & DBG_ADPTVTY) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "14. (( %s ))CFO_TRK\n", -+ ((comp & DBG_CFO_TRK) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "15. (( %s ))ENV_MNTR\n", -+ ((comp & DBG_ENV_MNTR) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "16. (( %s ))PRI_CCA\n", -+ ((comp & DBG_PRI_CCA) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "17. (( %s ))ADPTV_SOML\n", -+ ((comp & DBG_ADPTV_SOML) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "18. (( %s ))LNA_SAT_CHK\n", -+ ((comp & DBG_LNA_SAT_CHK) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "20. (( %s ))PHY_STATUS\n", -+ ((comp & DBG_PHY_STATUS) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "21. (( %s ))TMP\n", -+ ((comp & DBG_TMP) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "22. (( %s ))FW_DBG_TRACE\n", -+ ((comp & DBG_FW_TRACE) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "23. (( %s ))TXBF\n", -+ ((comp & DBG_TXBF) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "24. (( %s ))COMMON_FLOW\n", -+ ((comp & DBG_COMMON_FLOW) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "28. (( %s ))PHY_CONFIG\n", -+ ((comp & ODM_PHY_CONFIG) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "29. (( %s ))INIT\n", -+ ((comp & ODM_COMP_INIT) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "30. (( %s ))COMMON\n", -+ ((comp & DBG_CMN) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "31. (( %s ))API\n", -+ ((comp & ODM_COMP_API) ? ("V") : ("."))); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "================================\n"); -+ -+ } else if (val[0] == 101) { -+ dm->debug_components = 0; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Disable all debug components\n"); -+ } else { -+ if (val[1] == 1) /*@enable*/ -+ dm->debug_components |= (one << val[0]); -+ else if (val[1] == 2) /*@disable*/ -+ dm->debug_components &= ~(one << val[0]); -+ else -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Warning] 1:on, 2:off\n"); -+ -+ if ((BIT(val[0]) == DBG_PHY_STATUS) && val[1] == 1) { -+ dm->phy_dbg_info.show_phy_sts_all_pkt = (u8)val[2]; -+ dm->phy_dbg_info.show_phy_sts_max_cnt = (u16)val[3]; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "show_all_pkt=%d, show_max_num=%d\n\n", -+ dm->phy_dbg_info.show_phy_sts_all_pkt, -+ dm->phy_dbg_info.show_phy_sts_max_cnt); -+ -+ } else if (BIT(val[0]) == DBG_CMN) { -+ phydm_cmn_msg_setting(dm, val, &used, output, &out_len); -+ } -+ } -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pre-DbgComponents = 0x%llx\n", pre_debug_components); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Curr-DbgComponents = 0x%llx\n", dm->debug_components); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "================================\n"); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_fw_debug_trace(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 val[10] = {0}; -+ u8 i, input_idx = 0; -+ char help[] = "-h"; -+ u32 pre_fw_debug_components = 0, one = 1; -+ u32 comp = 0; -+ -+ for (i = 0; i < 5; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &val[i]); -+ input_idx++; -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ pre_fw_debug_components = dm->fw_debug_components; -+ comp = dm->fw_debug_components; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{dbg_comp} {1:en, 2:dis} {mode} {macid}\n"); -+ } else { -+ if (val[0] == 101) { -+ dm->fw_debug_components = 0; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%s\n", "Clear all fw debug components"); -+ } else { -+ if (val[1] == 1) /*@enable*/ -+ dm->fw_debug_components |= (one << val[0]); -+ else if (val[1] == 2) /*@disable*/ -+ dm->fw_debug_components &= ~(one << val[0]); -+ else -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "%s\n", -+ "[Warning!!!] 1:enable, 2:disable"); -+ } -+ -+ comp = dm->fw_debug_components; -+ -+ if (comp == 0) { -+ dm->debug_components &= ~DBG_FW_TRACE; -+ /*@H2C to enable C2H Msg*/ -+ phydm_fw_trace_en_h2c(dm, false, comp, val[2], val[3]); -+ } else { -+ dm->debug_components |= DBG_FW_TRACE; -+ /*@H2C to enable C2H Msg*/ -+ phydm_fw_trace_en_h2c(dm, true, comp, val[2], val[3]); -+ } -+ } -+} -+ -+#if (ODM_IC_11N_SERIES_SUPPORT) -+void phydm_dump_bb_reg_n(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 addr = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ /*@For Nseries IC we only need to dump page8 to pageF using 3 digits*/ -+ for (addr = 0x800; addr < 0xfff; addr += 4) { -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "0x%03x 0x%08x\n", -+ addr, odm_get_bb_reg(dm, addr, MASKDWORD)); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT) -+void phydm_dump_bb_reg_ac(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 addr = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ for (addr = 0x800; addr < 0xfff; addr += 4) { -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "0x%04x 0x%08x\n", -+ addr, odm_get_bb_reg(dm, addr, MASKDWORD)); -+ } -+ -+ if (!(dm->support_ic_type & -+ (ODM_RTL8822B | ODM_RTL8814A | ODM_RTL8821C | ODM_RTL8195B))) -+ goto rpt_reg; -+ -+ if (dm->rf_type > RF_2T2R) { -+ for (addr = 0x1800; addr < 0x18ff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%04x 0x%08x\n", -+ addr, -+ odm_get_bb_reg(dm, addr, MASKDWORD)); -+ } -+ -+ if (dm->rf_type > RF_3T3R) { -+ for (addr = 0x1a00; addr < 0x1aff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%04x 0x%08x\n", -+ addr, -+ odm_get_bb_reg(dm, addr, MASKDWORD)); -+ } -+ -+ for (addr = 0x1900; addr < 0x19ff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "0x%04x 0x%08x\n", -+ addr, odm_get_bb_reg(dm, addr, MASKDWORD)); -+ -+ for (addr = 0x1c00; addr < 0x1cff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "0x%04x 0x%08x\n", -+ addr, odm_get_bb_reg(dm, addr, MASKDWORD)); -+ -+ for (addr = 0x1f00; addr < 0x1fff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "0x%04x 0x%08x\n", -+ addr, odm_get_bb_reg(dm, addr, MASKDWORD)); -+ -+rpt_reg: -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+void phydm_dump_bb_reg_jgr3(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 addr = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ for (addr = 0x800; addr < 0xdff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%04x 0x%08x\n", addr, -+ odm_get_bb_reg(dm, addr, MASKDWORD)); -+ -+ for (addr = 0x1800; addr < 0x1aff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%04x 0x%08x\n", addr, -+ odm_get_bb_reg(dm, addr, MASKDWORD)); -+ -+ for (addr = 0x1c00; addr < 0x1eff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%04x 0x%08x\n", addr, -+ odm_get_bb_reg(dm, addr, MASKDWORD)); -+ -+ #if (defined(RTL8723F_SUPPORT)) -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ for (addr = 0x2a00; addr < 0x2a5c; addr += 4) { -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%04x 0x%08x\n", -+ addr, -+ odm_get_bb_reg(dm, addr, -+ MASKDWORD)); -+ } -+ } -+ #endif -+ -+ for (addr = 0x4000; addr < 0x41ff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%04x 0x%08x\n", addr, -+ odm_get_bb_reg(dm, addr, MASKDWORD)); -+ -+ #if (defined(RTL8723F_SUPPORT)) -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ for (addr = 0x4300; addr < 0x43bf; addr += 4) { -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%04x 0x%08x\n", -+ addr, -+ odm_get_bb_reg(dm, addr, -+ MASKDWORD)); -+ } -+ } -+ #endif -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_dump_bb_reg2_jgr3(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 addr = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return; -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { -+ for (addr = 0x5000; addr < 0x53ff; addr += 4) { -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%04x 0x%08x\n", -+ addr, -+ odm_get_bb_reg(dm, addr, MASKDWORD)); -+ } -+ } -+ #endif -+ -+ /* @Do not change the order of page-2C/2D*/ -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "------ BB report-register start ------\n"); -+ -+ #if (defined(RTL8723F_SUPPORT)) -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ for (addr = 0x2aa0; addr < 0x2aff; addr += 4) { -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%04x 0x%08x\n", -+ addr, -+ odm_get_bb_reg(dm, addr, MASKDWORD)); -+ } -+ } -+ #endif -+ -+ for (addr = 0x2c00; addr < 0x2dff; addr += 4) { -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "0x%04x 0x%08x\n", -+ addr, odm_get_bb_reg(dm, addr, MASKDWORD)); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_get_per_path_anapar_jgr3(void *dm_void, u8 path, u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 state = 0; -+ u8 state_bp = 0; -+ u32 control_bb = 0; -+ u32 control_pow = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 reg_idx = 0; -+ u32 dbgport_idx = 0; -+ u32 dbgport_val = 0; -+ -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "path-%d:\n", path); -+ -+ if (path == RF_PATH_A) { -+ reg_idx = R_0x1830; -+ dbgport_idx = 0x9F0; -+ } else if (path == RF_PATH_B) { -+ reg_idx = R_0x4130; -+ dbgport_idx = 0xBF0; -+ } else if (path == RF_PATH_C) { -+ reg_idx = R_0x5230; -+ dbgport_idx = 0xDF0; -+ } else if (path == RF_PATH_D) { -+ reg_idx = R_0x5330; -+ dbgport_idx = 0xFF0; -+ } -+ -+ state_bp = (u8)odm_get_bb_reg(dm, reg_idx, 0xf00000); -+ odm_set_bb_reg(dm, reg_idx, 0x38000000, 0x5); /* @read en*/ -+ -+ for (state = 0; state <= 0xf; state++) { -+ odm_set_bb_reg(dm, reg_idx, 0xF00000, state); -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, dbgport_idx)) { -+ dbgport_val = phydm_get_bb_dbg_port_val(dm); -+ phydm_release_bb_dbg_port(dm); -+ } else { -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, -+ "state:0x%x = read dbg_port error!\n", -+ state); -+ } -+ control_bb = (dbgport_val & 0xFFFF0) >> 4; -+ control_pow = dbgport_val & 0xF; -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "state:0x%x = control_bb:0x%x pow_bb:0x%x\n", -+ state, control_bb, control_pow); -+ } -+ odm_set_bb_reg(dm, reg_idx, 0xf00000, state_bp); -+ odm_set_bb_reg(dm, reg_idx, 0x38000000, 0x6); /* @write en*/ -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_get_csi_table_jgr3(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 table_idx = 0; -+ u8 table_val = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 dbgport_idx = 0x39e; -+ u32 dbgport_val = 0; -+ -+ /*enable clk*/ -+ odm_set_bb_reg(dm, R_0x1ee8, 0x3, 0x3); -+ /*enable read table*/ -+ odm_set_bb_reg(dm, R_0x1d94, BIT(31) | BIT(30), 0x2); -+ -+ for (table_idx = 0; table_idx < 128; table_idx++) { -+ odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, table_idx); -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, dbgport_idx)) { -+ dbgport_val = phydm_get_bb_dbg_port_val(dm); -+ phydm_release_bb_dbg_port(dm); -+ } else { -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, -+ "table_idx:0x%x = read dbg_port error!\n", -+ table_idx); -+ } -+ table_val = dbgport_val >> 24; -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "table_idx: 0x%x = 0x%x\n", -+ table_idx, table_val); -+ } -+ /*enable write table*/ -+ odm_set_bb_reg(dm, R_0x1d94, BIT(31) | BIT(30), 0x1); -+ /*disable clk*/ -+ odm_set_bb_reg(dm, R_0x1ee8, 0x3, 0x0); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif -+ -+void phydm_dump_bb_reg(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "BB==========\n"); -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "------ BB control register start ------\n"); -+ -+ switch (dm->ic_ip_series) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ case PHYDM_IC_JGR3: -+ phydm_dump_bb_reg_jgr3(dm, &used, output, &out_len); -+ break; -+ #endif -+ -+ #if (ODM_IC_11AC_SERIES_SUPPORT) -+ case PHYDM_IC_AC: -+ phydm_dump_bb_reg_ac(dm, &used, output, &out_len); -+ break; -+ #endif -+ -+ #if (ODM_IC_11N_SERIES_SUPPORT) -+ case PHYDM_IC_N: -+ phydm_dump_bb_reg_n(dm, &used, output, &out_len); -+ break; -+ #endif -+ -+ default: -+ break; -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_dump_rf_reg(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 addr = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 reg = 0; -+ -+ /* @dump RF register */ -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "RF-A==========\n"); -+ -+ for (addr = 0; addr <= 0xFF; addr++) { -+ reg = odm_get_rf_reg(dm, RF_PATH_A, addr, RFREG_MASK); -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "0x%02x 0x%05x\n", addr, reg); -+ } -+ -+#ifdef PHYDM_COMPILE_ABOVE_2SS -+ if (dm->rf_type > RF_1T1R) { -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "RF-B==========\n"); -+ -+ for (addr = 0; addr <= 0xFF; addr++) { -+ reg = odm_get_rf_reg(dm, RF_PATH_B, addr, RFREG_MASK); -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%02x 0x%05x\n", -+ addr, reg); -+ } -+ } -+#endif -+ -+#ifdef PHYDM_COMPILE_ABOVE_3SS -+ if (dm->rf_type > RF_2T2R) { -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "RF-C==========\n"); -+ -+ for (addr = 0; addr <= 0xFF; addr++) { -+ reg = odm_get_rf_reg(dm, RF_PATH_C, addr, RFREG_MASK); -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%02x 0x%05x\n", -+ addr, reg); -+ } -+ } -+#endif -+ -+#ifdef PHYDM_COMPILE_ABOVE_4SS -+ if (dm->rf_type > RF_3T3R) { -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "RF-D==========\n"); -+ -+ for (addr = 0; addr <= 0xFF; addr++) { -+ reg = odm_get_rf_reg(dm, RF_PATH_D, addr, RFREG_MASK); -+ PDM_VAST_SNPF(out_len, used, output + used, -+ out_len - used, "0x%02x 0x%05x\n", -+ addr, reg); -+ } -+ } -+#endif -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_dump_mac_reg(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 addr = 0; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ /* @dump MAC register */ -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "MAC==========\n"); -+ -+ for (addr = 0; addr < 0x7ff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "0x%04x 0x%08x\n", -+ addr, odm_get_bb_reg(dm, addr, MASKDWORD)); -+ -+ for (addr = 0x1000; addr < 0x17ff; addr += 4) -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "0x%04x 0x%08x\n", -+ addr, odm_get_bb_reg(dm, addr, MASKDWORD)); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_dump_reg(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 addr = 0; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if ((strcmp(input[1], help) == 0)) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "dumpreg {0:all, 1:BB, 2:RF, 3:MAC 4:BB2 for jgr3}\n"); -+ else -+ #endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "dumpreg {0:all, 1:BB, 2:RF, 3:MAC}\n"); -+ } else if (var1[0] == 0) { -+ phydm_dump_mac_reg(dm, &used, output, &out_len); -+ phydm_dump_bb_reg(dm, &used, output, &out_len); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->ic_ip_series == PHYDM_IC_JGR3) -+ phydm_dump_bb_reg2_jgr3(dm, &used, output, &out_len); -+ #endif -+ -+ phydm_dump_rf_reg(dm, &used, output, &out_len); -+ } else if (var1[0] == 1) { -+ phydm_dump_bb_reg(dm, &used, output, &out_len); -+ } else if (var1[0] == 2) { -+ phydm_dump_rf_reg(dm, &used, output, &out_len); -+ } else if (var1[0] == 3) { -+ phydm_dump_mac_reg(dm, &used, output, &out_len); -+ } else if (var1[0] == 4) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->ic_ip_series == PHYDM_IC_JGR3) -+ phydm_dump_bb_reg2_jgr3(dm, &used, output, &out_len); -+ #endif -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_enable_big_jump(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+#if (RTL8822B_SUPPORT) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u32 dm_value[10] = {0}; -+ u8 i, input_idx = 0; -+ u32 val; -+ -+ if (!(dm->support_ic_type & ODM_RTL8822B)) -+ return; -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ if (dm_value[0] == 0) { -+ dm->dm_dig_table.enable_adjust_big_jump = false; -+ -+ val = (dig_t->big_jump_step3 << 5) | -+ (dig_t->big_jump_step2 << 3) | -+ dig_t->big_jump_step1; -+ -+ odm_set_bb_reg(dm, R_0x8c8, 0xfe, val); -+ } else { -+ dm->dm_dig_table.enable_adjust_big_jump = true; -+ } -+#endif -+} -+ -+void phydm_show_rx_rate(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT || RTL8814B_SUPPORT ||\ -+ RTL8195B_SUPPORT || RTL8822C_SUPPORT || RTL8723F_SUPPORT) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 var1[10] = {0}; -+ char help[] = "-h"; -+ u8 i, input_idx = 0; -+ -+ for (i = 0; i < 5; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ input_idx++; -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{1: show Rx rate, 0:reset counter}\n"); -+ *_used = used; -+ *_out_len = out_len; -+ return; -+ -+ } else if (var1[0] == 0) { -+ phydm_reset_rx_rate_distribution(dm); -+ *_used = used; -+ *_out_len = out_len; -+ return; -+ } -+ -+ /* @==Show SU Rate====================================================*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "=====Rx SU rate Statistics=====\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[SU][1SS] {%d, %d, %d, %d | %d, %d, %d, %d | %d, %d}\n", -+ dbg->num_qry_vht_pkt[0], dbg->num_qry_vht_pkt[1], -+ dbg->num_qry_vht_pkt[2], dbg->num_qry_vht_pkt[3], -+ dbg->num_qry_vht_pkt[4], dbg->num_qry_vht_pkt[5], -+ dbg->num_qry_vht_pkt[6], dbg->num_qry_vht_pkt[7], -+ dbg->num_qry_vht_pkt[8], dbg->num_qry_vht_pkt[9]); -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & (PHYDM_IC_ABOVE_2SS)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[SU][2SS] {%d, %d, %d, %d | %d, %d, %d, %d | %d, %d}\n", -+ dbg->num_qry_vht_pkt[10], dbg->num_qry_vht_pkt[11], -+ dbg->num_qry_vht_pkt[12], dbg->num_qry_vht_pkt[13], -+ dbg->num_qry_vht_pkt[14], dbg->num_qry_vht_pkt[15], -+ dbg->num_qry_vht_pkt[16], dbg->num_qry_vht_pkt[17], -+ dbg->num_qry_vht_pkt[18], dbg->num_qry_vht_pkt[19]); -+ } -+ #endif -+ /* @==Show MU Rate====================================================*/ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) || (defined(PHYSTS_3RD_TYPE_SUPPORT)) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "=====Rx MU rate Statistics=====\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[MU][1SS] {%d, %d, %d, %d | %d, %d, %d, %d | %d, %d}\n", -+ dbg->num_mu_vht_pkt[0], dbg->num_mu_vht_pkt[1], -+ dbg->num_mu_vht_pkt[2], dbg->num_mu_vht_pkt[3], -+ dbg->num_mu_vht_pkt[4], dbg->num_mu_vht_pkt[5], -+ dbg->num_mu_vht_pkt[6], dbg->num_mu_vht_pkt[7], -+ dbg->num_mu_vht_pkt[8], dbg->num_mu_vht_pkt[9]); -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & (PHYDM_IC_ABOVE_2SS)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[MU][2SS] {%d, %d, %d, %d | %d, %d, %d, %d | %d, %d}\n", -+ dbg->num_mu_vht_pkt[10], dbg->num_mu_vht_pkt[11], -+ dbg->num_mu_vht_pkt[12], dbg->num_mu_vht_pkt[13], -+ dbg->num_mu_vht_pkt[14], dbg->num_mu_vht_pkt[15], -+ dbg->num_mu_vht_pkt[16], dbg->num_mu_vht_pkt[17], -+ dbg->num_mu_vht_pkt[18], dbg->num_mu_vht_pkt[19]); -+ } -+ #endif -+#endif -+ *_used = used; -+ *_out_len = out_len; -+#endif -+} -+ -+void phydm_per_tone_evm(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i, j; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 var1[4] = {0}; -+ u32 val, tone_num, round; -+ s8 rxevm_0, rxevm_1; -+ s32 avg_num, evm_tone_0[256] = {0}, evm_tone_1[256] = {0}; -+ s32 rxevm_sum_0, rxevm_sum_1; -+ -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ pr_debug("n series not support yet !\n"); -+ return; -+ } -+ -+ for (i = 0; i < 4; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ avg_num = var1[0]; -+ round = var1[1]; -+ -+ if (!dm->is_linked) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "No Link !!\n"); -+ -+ *_used = used; -+ *_out_len = out_len; -+ -+ return; -+ } -+ -+ pr_debug("ID=((%d)), BW=((%d)), fc=((CH-%d))\n", dm->curr_station_id, -+ 20 << *dm->band_width, *dm->channel); -+ pr_debug("avg_num =((%d)), round =((%d))\n", avg_num, round); -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ watchdog_stop(dm->priv); -+#endif -+ for (j = 0; j < round; j++) { -+ pr_debug("\nround((%d))\n", (j + 1)); -+ if (*dm->band_width == CHANNEL_WIDTH_20) { -+ for (tone_num = 228; tone_num <= 255; tone_num++) { -+ odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); -+ rxevm_sum_0 = 0; -+ rxevm_sum_1 = 0; -+ for (i = 0; i < avg_num; i++) { -+ val = odm_read_4byte(dm, R_0xf8c); -+ -+ rxevm_0 = (s8)((val & MASKBYTE2) >> 16); -+ rxevm_0 = (rxevm_0 / 2); -+ if (rxevm_0 < -63) -+ rxevm_0 = 0; -+ -+ rxevm_1 = (s8)((val & MASKBYTE3) >> 24); -+ rxevm_1 = (rxevm_1 / 2); -+ if (rxevm_1 < -63) -+ rxevm_1 = 0; -+ rxevm_sum_0 += rxevm_0; -+ rxevm_sum_1 += rxevm_1; -+ ODM_delay_ms(1); -+ } -+ evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); -+ evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); -+ pr_debug("Tone(-%-3d) RXEVM(1ss/2ss)=%d, %d\n", -+ (256 - tone_num), evm_tone_0[tone_num], -+ evm_tone_1[tone_num]); -+ } -+ -+ for (tone_num = 1; tone_num <= 28; tone_num++) { -+ odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); -+ rxevm_sum_0 = 0; -+ rxevm_sum_1 = 0; -+ for (i = 0; i < avg_num; i++) { -+ val = odm_read_4byte(dm, R_0xf8c); -+ -+ rxevm_0 = (s8)((val & MASKBYTE2) >> 16); -+ rxevm_0 = (rxevm_0 / 2); -+ if (rxevm_0 < -63) -+ rxevm_0 = 0; -+ -+ rxevm_1 = (s8)((val & MASKBYTE3) >> 24); -+ rxevm_1 = (rxevm_1 / 2); -+ if (rxevm_1 < -63) -+ rxevm_1 = 0; -+ rxevm_sum_0 += rxevm_0; -+ rxevm_sum_1 += rxevm_1; -+ ODM_delay_ms(1); -+ } -+ evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); -+ evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); -+ pr_debug("Tone(%-3d) RXEVM(1ss/2ss)=%d, %d\n", -+ tone_num, evm_tone_0[tone_num], -+ evm_tone_1[tone_num]); -+ } -+ } else if (*dm->band_width == CHANNEL_WIDTH_40) { -+ for (tone_num = 198; tone_num <= 254; tone_num++) { -+ odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); -+ rxevm_sum_0 = 0; -+ rxevm_sum_1 = 0; -+ for (i = 0; i < avg_num; i++) { -+ val = odm_read_4byte(dm, R_0xf8c); -+ -+ rxevm_0 = (s8)((val & MASKBYTE2) >> 16); -+ rxevm_0 = (rxevm_0 / 2); -+ if (rxevm_0 < -63) -+ rxevm_0 = 0; -+ -+ rxevm_1 = (s8)((val & MASKBYTE3) >> 24); -+ rxevm_1 = (rxevm_1 / 2); -+ if (rxevm_1 < -63) -+ rxevm_1 = 0; -+ -+ rxevm_sum_0 += rxevm_0; -+ rxevm_sum_1 += rxevm_1; -+ ODM_delay_ms(1); -+ } -+ evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); -+ evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); -+ pr_debug("Tone(-%-3d) RXEVM(1ss/2ss)=%d, %d\n", -+ (256 - tone_num), evm_tone_0[tone_num], -+ evm_tone_1[tone_num]); -+ } -+ -+ for (tone_num = 2; tone_num <= 58; tone_num++) { -+ odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); -+ rxevm_sum_0 = 0; -+ rxevm_sum_1 = 0; -+ for (i = 0; i < avg_num; i++) { -+ val = odm_read_4byte(dm, R_0xf8c); -+ -+ rxevm_0 = (s8)((val & MASKBYTE2) >> 16); -+ rxevm_0 = (rxevm_0 / 2); -+ if (rxevm_0 < -63) -+ rxevm_0 = 0; -+ -+ rxevm_1 = (s8)((val & MASKBYTE3) >> 24); -+ rxevm_1 = (rxevm_1 / 2); -+ if (rxevm_1 < -63) -+ rxevm_1 = 0; -+ rxevm_sum_0 += rxevm_0; -+ rxevm_sum_1 += rxevm_1; -+ ODM_delay_ms(1); -+ } -+ evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); -+ evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); -+ pr_debug("Tone(%-3d) RXEVM(1ss/2ss)=%d, %d\n", -+ tone_num, evm_tone_0[tone_num], -+ evm_tone_1[tone_num]); -+ } -+ } else if (*dm->band_width == CHANNEL_WIDTH_80) { -+ for (tone_num = 134; tone_num <= 254; tone_num++) { -+ odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); -+ rxevm_sum_0 = 0; -+ rxevm_sum_1 = 0; -+ for (i = 0; i < avg_num; i++) { -+ val = odm_read_4byte(dm, R_0xf8c); -+ -+ rxevm_0 = (s8)((val & MASKBYTE2) >> 16); -+ rxevm_0 = (rxevm_0 / 2); -+ if (rxevm_0 < -63) -+ rxevm_0 = 0; -+ -+ rxevm_1 = (s8)((val & MASKBYTE3) >> 24); -+ rxevm_1 = (rxevm_1 / 2); -+ if (rxevm_1 < -63) -+ rxevm_1 = 0; -+ rxevm_sum_0 += rxevm_0; -+ rxevm_sum_1 += rxevm_1; -+ ODM_delay_ms(1); -+ } -+ evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); -+ evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); -+ pr_debug("Tone(-%-3d) RXEVM(1ss/2ss)=%d, %d\n", -+ (256 - tone_num), evm_tone_0[tone_num], -+ evm_tone_1[tone_num]); -+ } -+ -+ for (tone_num = 2; tone_num <= 122; tone_num++) { -+ odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); -+ rxevm_sum_0 = 0; -+ rxevm_sum_1 = 0; -+ for (i = 0; i < avg_num; i++) { -+ val = odm_read_4byte(dm, R_0xf8c); -+ -+ rxevm_0 = (s8)((val & MASKBYTE2) >> 16); -+ rxevm_0 = (rxevm_0 / 2); -+ if (rxevm_0 < -63) -+ rxevm_0 = 0; -+ -+ rxevm_1 = (s8)((val & MASKBYTE3) >> 24); -+ rxevm_1 = (rxevm_1 / 2); -+ if (rxevm_1 < -63) -+ rxevm_1 = 0; -+ rxevm_sum_0 += rxevm_0; -+ rxevm_sum_1 += rxevm_1; -+ ODM_delay_ms(1); -+ } -+ evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); -+ evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); -+ pr_debug("Tone(%-3d) RXEVM (1ss/2ss)=%d, %d\n", -+ tone_num, evm_tone_0[tone_num], -+ evm_tone_1[tone_num]); -+ } -+ } -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_bw_ch_adjust(void *dm_void, char input[][16], -+ u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i; -+ boolean is_enable_dbg_mode; -+ u8 central_ch, primary_ch_idx; -+ enum channel_width bw; -+ -+#ifdef PHYDM_COMMON_API_SUPPORT -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{en} {CH} {pr_ch_idx 1/2/3/4/9/10} {0:20M,1:40M,2:80M}\n"); -+ goto out; -+ } -+ -+ if (!(dm->support_ic_type & CMN_API_SUPPORT_IC)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Not support this API\n"); -+ goto out; -+ } -+ -+ for (i = 0; i < 4; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ is_enable_dbg_mode = (boolean)var1[0]; -+ central_ch = (u8)var1[1]; -+ primary_ch_idx = (u8)var1[2]; -+ bw = (enum channel_width)var1[3]; -+ -+ if (is_enable_dbg_mode) { -+ dm->is_disable_phy_api = false; -+ phydm_api_switch_bw_channel(dm, central_ch, primary_ch_idx, bw); -+ dm->is_disable_phy_api = true; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "central_ch = %d, primary_ch_idx = %d, bw = %d\n", -+ central_ch, primary_ch_idx, bw); -+ } -+out: -+#endif -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_ext_rf_element_ctrl(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 val[10] = {0}; -+ u8 i = 0, input_idx = 0; -+ -+ for (i = 0; i < 5; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &val[i]); -+ input_idx++; -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ if (val[0] == 1) /*@ext switch*/ { -+ phydm_set_ext_switch(dm, val[1]); -+ } -+} -+ -+void phydm_print_dbgport(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 dbg_port_value = 0; -+ u8 val[32]; -+ u8 tmp = 0; -+ u8 i; -+ -+ if (strcmp(input[1], help) == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{dbg_port_idx}\n"); -+ goto out; -+ } -+ -+ PHYDM_SSCANF(input[1], DCMD_HEX, &var1[0]); -+ -+ dm->debug_components |= ODM_COMP_API; -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, var1[0])) { -+ dbg_port_value = phydm_get_bb_dbg_port_val(dm); -+ phydm_release_bb_dbg_port(dm); -+ -+ for (i = 0; i < 32; i++) -+ val[i] = (u8)((dbg_port_value & BIT(i)) >> i); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Dbg Port[0x%x] = ((0x%x))\n", var1[0], -+ dbg_port_value); -+ -+ for (i = 4; i != 0; i--) { -+ tmp = 8 * (i - 1); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "val[%d:%d] = 8b'%d %d %d %d %d %d %d %d\n", -+ tmp + 7, tmp, val[tmp + 7], val[tmp + 6], -+ val[tmp + 5], val[tmp + 4], val[tmp + 3], -+ val[tmp + 2], val[tmp + 1], val[tmp + 0]); -+ } -+ } -+ dm->debug_components &= (~ODM_COMP_API); -+out: -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_get_anapar_table(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ enum rf_path i = RF_PATH_A; -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return; -+ -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "------ Analog parameters start ------\n"); -+ -+ for (i = RF_PATH_A; i < (enum rf_path)dm->num_rf_path; i++) -+ phydm_get_per_path_anapar_jgr3(dm, i, &used, output, &out_len); -+#endif -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_get_csi_table(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return; -+ -+ PDM_VAST_SNPF(out_len, used, output + used, out_len - used, -+ "------ CSI Table Parsing start ------\n"); -+ -+ phydm_get_csi_table_jgr3(dm, &used, output, &out_len); -+#endif -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_dd_dbg_dump(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "dump: {1}\n"); -+ return; -+ } else if (var1[0] == 1) { -+ /*[Reg]*/ -+ phydm_dump_mac_reg(dm, &used, output, &out_len); -+ phydm_dump_bb_reg(dm, &used, output, &out_len); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->ic_ip_series == PHYDM_IC_JGR3) -+ phydm_dump_bb_reg2_jgr3(dm, &used, output, &out_len); -+ #endif -+ -+ phydm_dump_rf_reg(dm, &used, output, &out_len); -+ /*[Dbg Port]*/ -+ #ifdef PHYDM_AUTO_DEGBUG -+ phydm_dbg_port_dump(dm, &used, output, &out_len); -+ #endif -+ /*[Analog Parameters]*/ -+ phydm_get_anapar_table(dm, &used, output, &out_len); -+ } -+} -+ -+void phydm_nss_hitogram_mp(void *dm_void, enum PDM_RATE_TYPE rate_type, -+ u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ char buf[PHYDM_SNPRINT_SIZE] = {0}; -+ u16 buf_size = PHYDM_SNPRINT_SIZE; -+ u16 h_size = PHY_HIST_SIZE; -+ u16 *evm_hist = &dbg_s->evm_1ss_hist[0]; -+ u16 *snr_hist = &dbg_s->snr_1ss_hist[0]; -+ u8 i = 0; -+ u8 ss = phydm_rate_type_2_num_ss(dm, rate_type); -+ -+ if (rate_type == PDM_OFDM) { -+ phydm_print_hist_2_buf(dm, dbg_s->evm_ofdm_hist, PHY_HIST_SIZE, -+ buf, buf_size); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-14s=%s\n", "[OFDM][EVM]", buf); -+ -+ phydm_print_hist_2_buf(dm, dbg_s->snr_ofdm_hist, PHY_HIST_SIZE, -+ buf, buf_size); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-14s=%s\n", "[OFDM][SNR]", buf); -+ -+ *_used = used; -+ *_out_len = out_len; -+ return; -+ } -+ -+ for (i = 0; i < ss; i++) { -+ if (rate_type == PDM_1SS) { -+ evm_hist = &dbg_s->evm_1ss_hist[0]; -+ snr_hist = &dbg_s->snr_1ss_hist[0]; -+ } else if (rate_type == PDM_2SS) { -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ evm_hist = &dbg_s->evm_2ss_hist[i][0]; -+ snr_hist = &dbg_s->snr_2ss_hist[i][0]; -+ #endif -+ } else if (rate_type == PDM_3SS) { -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ evm_hist = &dbg_s->evm_3ss_hist[i][0]; -+ snr_hist = &dbg_s->snr_3ss_hist[i][0]; -+ #endif -+ } else if (rate_type == PDM_4SS) { -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ evm_hist = &dbg_s->evm_4ss_hist[i][0]; -+ snr_hist = &dbg_s->snr_4ss_hist[i][0]; -+ #endif -+ } -+ -+ phydm_print_hist_2_buf(dm, evm_hist, h_size, buf, buf_size); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[%d-SS][EVM][%d]=%s\n", ss, i, buf); -+ phydm_print_hist_2_buf(dm, snr_hist, h_size, buf, buf_size); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[%d-SS][SNR][%d]=%s\n", ss, i, buf); -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_mp_dbg(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; -+ struct phydm_phystatus_avg *dbg_avg = &dbg_i->phystatus_statistic_avg; -+ char *rate_type = NULL; -+ u8 tmp_rssi_avg[4]; -+ u8 tmp_snr_avg[4]; -+ u8 tmp_evm_avg[4]; -+ u32 tmp_cnt = 0; -+ char buf[PHYDM_SNPRINT_SIZE] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 var1[10] = {0}; -+ u16 buf_size = PHYDM_SNPRINT_SIZE; -+ u16 th_size = PHY_HIST_SIZE - 1; -+ u8 i = 0; -+ -+ if (!(*dm->mp_mode)) -+ return; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "BW=((%d)), fc=((CH-%d))\n", -+ 20 << *dm->band_width, *dm->channel); -+ -+ /*@===[PHY Histogram]================================================*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[PHY Histogram] ==============>\n"); -+ /*@===[Threshold]===*/ -+ phydm_print_hist_2_buf(dm, dbg_i->evm_hist_th, th_size, buf, buf_size); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-16s=%s\n", "[EVM_TH]", buf); -+ phydm_print_hist_2_buf(dm, dbg_i->snr_hist_th, th_size, buf, buf_size); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%-16s=%s\n", "[SNR_TH]", buf); -+ /*@===[OFDM]===*/ -+ phydm_nss_hitogram_mp(dm, PDM_OFDM, &used, output, &out_len); -+ /*@===[1-SS]===*/ -+ phydm_nss_hitogram_mp(dm, PDM_1SS, &used, output, &out_len); -+ /*@===[2-SS]===*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) -+ phydm_nss_hitogram_mp(dm, PDM_2SS, &used, output, &out_len); -+ #endif -+ /*@===[3-SS]===*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_3SS) -+ phydm_nss_hitogram_mp(dm, PDM_3SS, &used, output, &out_len); -+ #endif -+ /*@===[4-SS]===*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) -+ phydm_nss_hitogram_mp(dm, PDM_4SS, &used, output, &out_len); -+ #endif -+ /*@===[PHY Avg]======================================================*/ -+ phydm_get_avg_phystatus_val(dm); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[PHY Avg] ==============>\n"); -+ -+ phydm_get_avg_phystatus_val(dm); -+ -+ switch (dm->num_rf_path) { -+#if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case 4: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0], -+ dbg_avg->rssi_beacon_avg[1], -+ dbg_avg->rssi_beacon_avg[2], -+ dbg_avg->rssi_beacon_avg[3]); -+ break; -+#endif -+#if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case 3: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0], -+ dbg_avg->rssi_beacon_avg[1], -+ dbg_avg->rssi_beacon_avg[2]); -+ break; -+#endif -+#if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case 2: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0], -+ dbg_avg->rssi_beacon_avg[1]); -+ break; -+#endif -+ default: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", -+ "[Beacon]", dbg_s->rssi_beacon_cnt, -+ dbg_avg->rssi_beacon_avg[0]); -+ break; -+ } -+ -+ switch (dm->num_rf_path) { -+#ifdef PHYSTS_3RD_TYPE_SUPPORT -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case 4: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, -+ dbg_avg->rssi_cck_avg, -+ dbg_avg->rssi_cck_avg_abv_2ss[0], -+ dbg_avg->rssi_cck_avg_abv_2ss[1], -+ dbg_avg->rssi_cck_avg_abv_2ss[2]); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case 3: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, -+ dbg_avg->rssi_cck_avg, -+ dbg_avg->rssi_cck_avg_abv_2ss[0], -+ dbg_avg->rssi_cck_avg_abv_2ss[1]); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case 2: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, -+ dbg_avg->rssi_cck_avg, -+ dbg_avg->rssi_cck_avg_abv_2ss[0]); -+ break; -+ #endif -+#endif -+ default: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", -+ "[CCK]", dbg_s->rssi_cck_cnt, dbg_avg->rssi_cck_avg); -+ break; -+ } -+ -+ for (i = 0; i <= 4; i++) { -+ if (i > dm->num_rf_path) -+ break; -+ -+ odm_memory_set(dm, tmp_rssi_avg, 0, 4); -+ odm_memory_set(dm, tmp_snr_avg, 0, 4); -+ odm_memory_set(dm, tmp_evm_avg, 0, 4); -+ -+ switch (i) { -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case 4: -+ rate_type = "[4-SS]"; -+ tmp_cnt = dbg_s->rssi_4ss_cnt; -+ odm_move_memory(dm, tmp_rssi_avg, -+ dbg_avg->rssi_4ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_snr_avg, -+ dbg_avg->snr_4ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_evm_avg, dbg_avg->evm_4ss_avg, -+ 4); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case 3: -+ rate_type = "[3-SS]"; -+ tmp_cnt = dbg_s->rssi_3ss_cnt; -+ odm_move_memory(dm, tmp_rssi_avg, -+ dbg_avg->rssi_3ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_snr_avg, -+ dbg_avg->snr_3ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_evm_avg, -+ dbg_avg->evm_3ss_avg, 3); -+ break; -+ #endif -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case 2: -+ rate_type = "[2-SS]"; -+ tmp_cnt = dbg_s->rssi_2ss_cnt; -+ odm_move_memory(dm, tmp_rssi_avg, -+ dbg_avg->rssi_2ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_2ss_avg, -+ dm->num_rf_path); -+ odm_move_memory(dm, tmp_evm_avg, -+ dbg_avg->evm_2ss_avg, 2); -+ break; -+ #endif -+ case 1: -+ rate_type = "[1-SS]"; -+ tmp_cnt = dbg_s->rssi_1ss_cnt; -+ odm_move_memory(dm, tmp_rssi_avg, -+ dbg_avg->rssi_1ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_snr_avg, -+ dbg_avg->snr_1ss_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_evm_avg, -+ &dbg_avg->evm_1ss_avg, 1); -+ break; -+ default: -+ rate_type = "[L-OFDM]"; -+ tmp_cnt = dbg_s->rssi_ofdm_cnt; -+ odm_move_memory(dm, tmp_rssi_avg, -+ dbg_avg->rssi_ofdm_avg, -+ dm->num_rf_path); -+ odm_move_memory(dm, tmp_snr_avg, -+ dbg_avg->snr_ofdm_avg, dm->num_rf_path); -+ odm_move_memory(dm, tmp_evm_avg, -+ &dbg_avg->evm_ofdm_avg, 1); -+ break; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d} SNR:{%.2d, %.2d, %.2d, %.2d} EVM:{-%.2d, -%.2d, -%.2d, -%.2d}\n", -+ rate_type, tmp_cnt, -+ tmp_rssi_avg[0], tmp_rssi_avg[1], -+ tmp_rssi_avg[2], tmp_rssi_avg[3], -+ tmp_snr_avg[0], tmp_snr_avg[1], -+ tmp_snr_avg[2], tmp_snr_avg[3], -+ tmp_evm_avg[0], tmp_evm_avg[1], -+ tmp_evm_avg[2], tmp_evm_avg[3]); -+ } -+ -+ phydm_reset_phystatus_statistic(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "rxsc_idx {Legacy, 20, 40, 80} = {%d, %d, %d, %d}\n", -+ dm->rxsc_l, dm->rxsc_20, dm->rxsc_40, dm->rxsc_80); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_reg_monitor(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ boolean en_mntr = false; -+ u8 i = 0; -+ -+ for (i = 0; i < 7; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "reg_mntr {en} {0:all, 1:BB, 2:RF, 3:MAC 4:1/2/4 byte}\n"); -+ } else { -+ if (var1[0] == 1) -+ en_mntr = true; -+ else -+ en_mntr = false; -+ -+ if (var1[1] == 0) { -+ dm->en_reg_mntr_bb = en_mntr; -+ dm->en_reg_mntr_rf = en_mntr; -+ dm->en_reg_mntr_mac = en_mntr; -+ dm->en_reg_mntr_byte = en_mntr; -+ } else if (var1[1] == 1) { -+ dm->en_reg_mntr_bb = en_mntr; -+ } else if (var1[1] == 2) { -+ dm->en_reg_mntr_rf = en_mntr; -+ } else if (var1[1] == 3) { -+ dm->en_reg_mntr_mac = en_mntr; -+ } else if (var1[1] == 4) { -+ dm->en_reg_mntr_byte = en_mntr; -+ } -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "en: BB:%d, RF:%d, MAC:%d, byte:%d\n", dm->en_reg_mntr_bb, -+ dm->en_reg_mntr_rf, dm->en_reg_mntr_mac, dm->en_reg_mntr_byte); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#if (RTL8822C_SUPPORT) -+u16 phydm_get_agc_rf_gain(void *dm_void, boolean is_mod, u8 tab, u8 mp_gain_i) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 rf_gain = 0x0; -+ -+ if (is_mod) -+ rf_gain = dm->agc_rf_gain[tab][mp_gain_i]; -+ else -+ rf_gain = dm->agc_rf_gain_ori[tab][mp_gain_i]; -+ -+ return rf_gain; -+} -+#endif -+ -+void phydm_get_rxagc_table_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 tab = 0; -+ boolean is_modified = false; -+ u8 mp_gain = 0; -+ u16 rf_gain = 0; -+ u8 i = 0; -+ -+#if (RTL8822C_SUPPORT) -+ if (!(dm->support_ic_type & ODM_RTL8822C)) -+ return; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "get rxagc table : {0:ori, 1:modified} {table:0~15} {mp_gain_idx:0~63, all:0xff}\n"); -+ } else { -+ for (i = 0; i < 3; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ } -+ -+ is_modified = (boolean)var1[0]; -+ tab = (u8)var1[1]; -+ mp_gain = (u8)var1[2]; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "agc_table_cnt:%d, is_agc_tab_pos_shift:%d, agc_table_shift:%d\n", -+ dm->agc_table_cnt, dm->is_agc_tab_pos_shift, -+ dm->agc_table_shift); -+ -+ if (mp_gain == 0xff) { -+ for (i = 0; i < 64; i++) { -+ rf_gain = phydm_get_agc_rf_gain(dm, is_modified, -+ tab, i); -+ -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "agc_table:%d, mp_gain_idx:0x%x, rf_gain_idx:0x%x\n", -+ tab, i, rf_gain); -+ } -+ } else { -+ rf_gain = phydm_get_agc_rf_gain(dm, is_modified, tab, -+ mp_gain); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "agc_table:%d, mp_gain_idx:0x%x, rf_gain_idx:0x%x\n", -+ tab, mp_gain, rf_gain); -+ } -+ } -+#endif -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_shift_rxagc_table_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ u16 value_db = 0; -+ -+#if (RTL8822C_SUPPORT) -+ if (!(dm->support_ic_type & ODM_RTL8822C)) -+ return; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "shift rxagc table : {0:-, 1:+} {value(0~63, unit:2dB)}\n"); -+ } else { -+ for (i = 0; i < 3; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var1[i]); -+ } -+ -+ if ((u8)var1[1] > 63) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Do not enter the value larger than 63!\n"); -+ } else { -+ phydm_shift_rxagc_table(dm, (boolean)var1[0], -+ (u8)var1[1]); -+ -+ value_db = (u8)var1[1] << 1; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "shift %s%d dB gain\n", -+ (((boolean)var1[0]) ? "+" : "-"), value_db); -+ } -+ } -+#endif -+} -+ -+#if (RTL8814B_SUPPORT || RTL8198F_SUPPORT) -+void phydm_spur_detect_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 i; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{0: Auto spur detect(NBI+CSI), 1:NBI always ON/ CSI Auto,"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "2: CSI always On/ NBI Auto, 3: Disable, 4: CSI & NBI ON}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{If CSI always ON (Mode 2 or 4) -> CSI wgt manual(0~7)}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{5: Adjust CSI weight threshold} {0:-,1:+} {th offset}\n"); -+ } else { -+ for (i = 0; i < 10; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var1[i]); -+ } -+ -+ if (var1[0] == 1) { -+ dm->dsde_sel = DET_NBI; -+ } else if (var1[0] == 2) { -+ dm->dsde_sel = DET_CSI; -+ } else if (var1[0] == 3) { -+ dm->dsde_sel = DET_DISABLE; -+ } else if (var1[0] == 4) { -+ dm->dsde_sel = DET_CSI_NBI_EN; -+ } else if (var1[0] == 0) { -+ dm->dsde_sel = DET_AUTO; -+ } else if (var1[0] == 5) { -+ if (var1[1] == 0) -+ for (i = 0; i < 5; i++) -+ dm->csi_wgt_th_db[i] -= (u8)var1[2]; -+ else if (var1[1] == 1) -+ for (i = 0; i < 5; i++) -+ dm->csi_wgt_th_db[i] += (u8)var1[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, "current csi weight threshold:\n"); -+ for (i = 0; i < 5; i++) -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "----%2d", -+ dm->csi_wgt_th_db[i]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, "\n"); -+ for (i = 0; i < 5; i++) -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "--%d--|", i); -+ PDM_SNPF(out_len, used, output + used, out_len - used, "\n"); -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Spur detection mode invalid!\n"); -+ return; -+ } -+ if (var1[0] < 5) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "spur detect mode = %d\n", dm->dsde_sel); -+ -+ if (dm->dsde_sel == DET_CSI_NBI_EN) { -+ if (var1[1] < 8) { -+ dm->csi_wgt = (u8)var1[1]; -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "CSI wgt %d\n", -+ dm->csi_wgt); -+ } else { -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "CSI wgt setting invalid. Please set the correct wgt!\n"); -+ return; -+ } -+ } -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -+ -+struct phydm_command { -+ char name[16]; -+ u8 id; -+}; -+ -+enum PHYDM_CMD_ID { -+ PHYDM_HELP, -+ PHYDM_DEMO, -+ PHYDM_RF_CMD, -+ PHYDM_DIG, -+ PHYDM_RA, -+ PHYDM_PROFILE, -+ PHYDM_ANTDIV, -+ PHYDM_PATHDIV, -+ PHYDM_DEBUG, -+ PHYDM_MP_DEBUG, -+ PHYDM_FW_DEBUG, -+ PHYDM_SUPPORT_ABILITY, -+ PHYDM_GET_TXAGC, -+ PHYDM_SET_TXAGC, -+ PHYDM_SMART_ANT, -+ PHYDM_CH_BW, -+ PHYDM_TRX_PATH, -+ PHYDM_LA_MODE, -+ PHYDM_DUMP_REG, -+ PHYDM_AUTO_DBG, -+ PHYDM_DD_DBG, -+ PHYDM_BIG_JUMP, -+ PHYDM_SHOW_RXRATE, -+ PHYDM_NBI_EN, -+ PHYDM_CSI_MASK_EN, -+ PHYDM_DFS_DEBUG, -+ PHYDM_DFS_HIST, -+ PHYDM_NHM, -+ PHYDM_CLM, -+ PHYDM_FAHM, -+ PHYDM_ENV_MNTR, -+ PHYDM_BB_INFO, -+ //PHYDM_TXBF, -+ PHYDM_H2C, -+ PHYDM_EXT_RF_E_CTRL, -+ PHYDM_ADAPTIVE_SOML, -+ PHYDM_PSD, -+ PHYDM_DEBUG_PORT, -+ PHYDM_DIS_HTSTF_CONTROL, -+ PHYDM_CFO_TRK, -+ PHYDM_ADAPTIVITY_DEBUG, -+ PHYDM_DIS_DYM_ANT_WEIGHTING, -+ PHYDM_FORECE_PT_STATE, -+ PHYDM_STA_INFO, -+ PHYDM_PAUSE_FUNC, -+ PHYDM_PER_TONE_EVM, -+ PHYDM_DYN_TXPWR, -+ PHYDM_LNA_SAT, -+ PHYDM_ANAPAR, -+ PHYDM_CCK_RX_PATHDIV, -+ PHYDM_BEAM_FORMING, -+ PHYDM_REG_MONITOR, -+#if RTL8814B_SUPPORT -+ PHYDM_SPUR_DETECT, -+#endif -+ PHYDM_PHY_STATUS, -+ PHYDM_CRC32_CNT, -+ PHYDM_DCC, -+#ifdef PHYDM_HW_IGI -+ PHYDM_HWIGI, -+#endif -+#ifdef PHYDM_HW_SWITCH_AGC_TAB -+ PHYDM_HW_AGCTAB, -+#endif -+ PHYDM_PMAC_TX, -+ PHYDM_GET_RXAGC, -+ PHYDM_SHIFT_RXAGC, -+ PHYDM_IFS_CLM, -+ PHYDM_ENHANCE_MNTR, -+ PHYDM_CSI_DBG, -+ PHYDM_EDCCA_CLM -+}; -+ -+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*/ -+ {"rf", PHYDM_RF_CMD}, -+ {"dig", PHYDM_DIG}, -+ {"ra", PHYDM_RA}, -+ {"profile", PHYDM_PROFILE}, -+ {"antdiv", PHYDM_ANTDIV}, -+ {"pathdiv", PHYDM_PATHDIV}, -+ {"dbg", PHYDM_DEBUG}, -+ {"mp_dbg", PHYDM_MP_DEBUG}, -+ {"fw_dbg", PHYDM_FW_DEBUG}, -+ {"ability", PHYDM_SUPPORT_ABILITY}, -+ {"get_txagc", PHYDM_GET_TXAGC}, -+ {"set_txagc", PHYDM_SET_TXAGC}, -+ {"smtant", PHYDM_SMART_ANT}, -+ {"ch_bw", PHYDM_CH_BW}, -+ {"trxpath", PHYDM_TRX_PATH}, -+ {"lamode", PHYDM_LA_MODE}, -+ {"dumpreg", PHYDM_DUMP_REG}, -+ {"auto_dbg", PHYDM_AUTO_DBG}, -+ {"dd_dbg", PHYDM_DD_DBG}, -+ {"bigjump", PHYDM_BIG_JUMP}, -+ {"rxrate", PHYDM_SHOW_RXRATE}, -+ {"nbi", PHYDM_NBI_EN}, -+ {"csi_mask", PHYDM_CSI_MASK_EN}, -+ {"dfs", PHYDM_DFS_DEBUG}, -+ {"dfs_hist", PHYDM_DFS_HIST}, -+ {"nhm", PHYDM_NHM}, -+ {"clm", PHYDM_CLM}, -+ {"fahm", PHYDM_FAHM}, -+ {"env_mntr", PHYDM_ENV_MNTR}, -+ {"bbinfo", PHYDM_BB_INFO}, -+ /*{"txbf", PHYDM_TXBF},*/ -+ {"h2c", PHYDM_H2C}, -+ {"ext_rfe", PHYDM_EXT_RF_E_CTRL}, -+ {"soml", PHYDM_ADAPTIVE_SOML}, -+ {"psd", PHYDM_PSD}, -+ {"dbgport", PHYDM_DEBUG_PORT}, -+ {"dis_htstf", PHYDM_DIS_HTSTF_CONTROL}, -+ {"cfo_trk", PHYDM_CFO_TRK}, -+ {"adapt_debug", PHYDM_ADAPTIVITY_DEBUG}, -+ {"dis_dym_ant_wgt", PHYDM_DIS_DYM_ANT_WEIGHTING}, -+ {"force_pt_state", PHYDM_FORECE_PT_STATE}, -+ {"sta_info", PHYDM_STA_INFO}, -+ {"pause", PHYDM_PAUSE_FUNC}, -+ {"evm", PHYDM_PER_TONE_EVM}, -+ {"dyn_txpwr", PHYDM_DYN_TXPWR}, -+ {"lna_sat", PHYDM_LNA_SAT}, -+ {"anapar", PHYDM_ANAPAR}, -+ {"cck_rx_pathdiv", PHYDM_CCK_RX_PATHDIV}, -+ {"bf", PHYDM_BEAM_FORMING}, -+ {"reg_mntr", PHYDM_REG_MONITOR}, -+#if RTL8814B_SUPPORT -+ {"spur_detect", PHYDM_SPUR_DETECT}, -+#endif -+ {"physts", PHYDM_PHY_STATUS}, -+ {"crc32_cnt", PHYDM_CRC32_CNT}, -+#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT -+ {"pmac_tx", PHYDM_PMAC_TX}, -+#endif -+#ifdef PHYDM_HW_IGI -+ {"hwigi", PHYDM_HWIGI}, -+#endif -+#ifdef PHYDM_HW_SWITCH_AGC_TAB -+ {"hw_agctab", PHYDM_HW_AGCTAB}, -+#endif -+ {"dcc", PHYDM_DCC}, -+ {"get_rxagc", PHYDM_GET_RXAGC}, -+ {"shift_rxagc", PHYDM_SHIFT_RXAGC}, -+ {"ifs_clm", PHYDM_IFS_CLM}, -+ {"enh_mntr", PHYDM_ENHANCE_MNTR}, -+ {"csi_dbg", PHYDM_CSI_DBG}, -+ {"edcca_clm", PHYDM_EDCCA_CLM} -+ }; -+ -+#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ -+ -+void phydm_cmd_parser(struct dm_struct *dm, char input[][MAX_ARGV], -+ u32 input_num, u8 flag, char *output, u32 out_len) -+{ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+ u32 used = 0; -+ u8 id = 0; -+ u32 var1[10] = {0}; -+ u32 i; -+ u32 phydm_ary_size = sizeof(phy_dm_ary) / sizeof(struct phydm_command); -+ -+ if (flag == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "GET, nothing to print\n"); -+ return; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, "\n"); -+ -+ /* Parsing Cmd ID */ -+ if (input_num) { -+ 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) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "PHYDM command not found!\n"); -+ return; -+ } -+ } -+ -+ switch (id) { -+ case PHYDM_HELP: { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "BB cmd ==>\n"); -+ -+ for (i = 0; i < phydm_ary_size - 2; i++) -+ PDM_SNPF(out_len, used, 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*/ -+ u32 directory = 0; -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) -+ char char_temp; -+ #else -+ u32 char_temp = ' '; -+ #endif -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &directory); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Decimal value = %d\n", directory); -+ PHYDM_SSCANF(input[2], DCMD_HEX, &directory); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Hex value = 0x%x\n", directory); -+ PHYDM_SSCANF(input[3], DCMD_CHAR, &char_temp); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Char = %c\n", char_temp); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "String = %s\n", input[4]); -+ } break; -+ case PHYDM_RF_CMD: -+ halrf_cmd_parser(dm, input, &used, output, &out_len, input_num); -+ break; -+ -+ case PHYDM_DIG: -+ phydm_dig_debug(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_RA: -+ phydm_ra_debug(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_ANTDIV: -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ phydm_antdiv_debug(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_PATHDIV: -+ #if (defined(CONFIG_PATH_DIVERSITY)) -+ phydm_pathdiv_debug(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_DEBUG: -+ phydm_debug_trace(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_MP_DEBUG: -+ phydm_mp_dbg(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_FW_DEBUG: -+ phydm_fw_debug_trace(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_SUPPORT_ABILITY: -+ phydm_supportability_en(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_SMART_ANT: -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 -+ phydm_hl_smt_ant_dbg_type2(dm, input, &used, output, &out_len); -+ #elif (defined(CONFIG_HL_SMART_ANTENNA_TYPE1)) -+ phydm_hl_smart_ant_debug(dm, input, &used, output, &out_len); -+ #endif -+ -+ #elif (defined(CONFIG_CUMITEK_SMART_ANTENNA)) -+ phydm_cumitek_smt_ant_debug(dm, input, &used, output, &out_len); -+ #endif -+ -+ break; -+ -+ case PHYDM_CH_BW: -+ phydm_bw_ch_adjust(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_PROFILE: -+ phydm_basic_profile(dm, &used, output, &out_len); -+ break; -+ -+ case PHYDM_GET_TXAGC: -+ phydm_get_txagc(dm, &used, output, &out_len); -+ break; -+ -+ case PHYDM_SET_TXAGC: -+ phydm_set_txagc_dbg(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_TRX_PATH: -+ phydm_config_trx_path(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_LA_MODE: -+ #if (PHYDM_LA_MODE_SUPPORT) -+ phydm_la_cmd(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_DUMP_REG: -+ phydm_dump_reg(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_BIG_JUMP: -+ phydm_enable_big_jump(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_AUTO_DBG: -+ #ifdef PHYDM_AUTO_DEGBUG -+ phydm_auto_dbg_console(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_DD_DBG: -+ phydm_dd_dbg_dump(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_SHOW_RXRATE: -+ phydm_show_rx_rate(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_NBI_EN: -+ phydm_nbi_debug(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_CSI_MASK_EN: -+ phydm_csi_debug(dm, input, &used, output, &out_len); -+ break; -+ -+ #ifdef CONFIG_PHYDM_DFS_MASTER -+ case PHYDM_DFS_DEBUG: -+ phydm_dfs_debug(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_DFS_HIST: -+ phydm_dfs_hist_dbg(dm, input, &used, output, &out_len); -+ break; -+ #endif -+ -+ case PHYDM_NHM: -+ #ifdef NHM_SUPPORT -+ phydm_nhm_dbg(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_CLM: -+ #ifdef CLM_SUPPORT -+ phydm_clm_dbg(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ #ifdef FAHM_SUPPORT -+ case PHYDM_FAHM: -+ phydm_fahm_dbg(dm, input, &used, output, &out_len); -+ break; -+ #endif -+ -+ case PHYDM_ENV_MNTR: -+ phydm_env_mntr_dbg(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_BB_INFO: -+ phydm_bb_hw_dbg_info(dm, input, &used, output, &out_len); -+ break; -+ /* -+ case PHYDM_TXBF: { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ #ifdef PHYDM_BEAMFORMING_SUPPORT -+ struct _RT_BEAMFORMING_INFO *beamforming_info = NULL; -+ -+ beamforming_info = &dm->beamforming_info; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ if (var1[0] == 0) { -+ beamforming_info->apply_v_matrix = false; -+ beamforming_info->snding3ss = true; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n dont apply V matrix and 3SS 789 snding\n"); -+ } else if (var1[0] == 1) { -+ beamforming_info->apply_v_matrix = true; -+ beamforming_info->snding3ss = true; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n apply V matrix and 3SS 789 snding\n"); -+ } else if (var1[0] == 2) { -+ beamforming_info->apply_v_matrix = true; -+ beamforming_info->snding3ss = false; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n default txbf setting\n"); -+ } else -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "\r\n unknown cmd!!\n"); -+ #endif -+ #endif -+ } break; -+ */ -+ case PHYDM_H2C: -+ phydm_h2C_debug(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_EXT_RF_E_CTRL: -+ phydm_ext_rf_element_ctrl(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_ADAPTIVE_SOML: -+ #ifdef CONFIG_ADAPTIVE_SOML -+ phydm_soml_debug(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_PSD: -+ -+ #ifdef CONFIG_PSD_TOOL -+ phydm_psd_debug(dm, input, &used, output, &out_len); -+ #endif -+ -+ break; -+ -+ case PHYDM_DEBUG_PORT: -+ phydm_print_dbgport(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_DIS_HTSTF_CONTROL: { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if (var1[0] == 1) { -+ /* setting being false is for debug */ -+ dm->bhtstfdisabled = true; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Dynamic HT-STF Gain Control is Disable\n"); -+ } else { -+ /* @default setting should be true, -+ * always be dynamic control -+ */ -+ dm->bhtstfdisabled = false; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Dynamic HT-STF Gain Control is Enable\n"); -+ } -+ } break; -+ -+ case PHYDM_CFO_TRK: -+ phydm_cfo_tracking_debug(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_ADAPTIVITY_DEBUG: -+ #ifdef PHYDM_SUPPORT_ADAPTIVITY -+ phydm_adaptivity_debug(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_DIS_DYM_ANT_WEIGHTING: -+ #ifdef DYN_ANT_WEIGHTING_SUPPORT -+ phydm_ant_weight_dbg(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_FORECE_PT_STATE: -+ #ifdef PHYDM_POWER_TRAINING_SUPPORT -+ phydm_pow_train_debug(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_STA_INFO: -+ phydm_show_sta_info(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_PAUSE_FUNC: -+ phydm_pause_func_console(dm, input, &used, output, &out_len); -+ break; -+ -+ case PHYDM_PER_TONE_EVM: -+ phydm_per_tone_evm(dm, input, &used, output, &out_len); -+ break; -+ -+ #ifdef CONFIG_DYNAMIC_TX_TWR -+ case PHYDM_DYN_TXPWR: -+ phydm_dtp_debug(dm, input, &used, output, &out_len); -+ break; -+ #endif -+ -+ case PHYDM_LNA_SAT: -+ #ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ phydm_lna_sat_debug(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_ANAPAR: -+ phydm_get_anapar_table(dm, &used, output, &out_len); -+ break; -+ case PHYDM_CCK_RX_PATHDIV: -+ #ifdef PHYDM_CCK_RX_PATHDIV_SUPPORT -+ phydm_cck_rx_pathdiv_dbg(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ -+ case PHYDM_BEAM_FORMING: -+ #ifdef CONFIG_BB_TXBF_API -+ phydm_bf_debug(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ case PHYDM_REG_MONITOR: -+ phydm_reg_monitor(dm, input, &used, output, &out_len); -+ break; -+ -+#if RTL8814B_SUPPORT -+ case PHYDM_SPUR_DETECT: -+ phydm_spur_detect_dbg(dm, input, &used, output, &out_len); -+ break; -+#endif -+ case PHYDM_CRC32_CNT: -+ phydm_crc32_cnt_dbg(dm, input, &used, output, &out_len); -+ break; -+ case PHYDM_PHY_STATUS: -+ phydm_physts_dbg(dm, input, &used, output, &out_len); -+ break; -+#ifdef PHYDM_DCC_ENHANCE -+ case PHYDM_DCC: -+ phydm_dig_cckpd_coex_dbg(dm, input, &used, output, &out_len); -+ break; -+#endif -+#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT -+ case PHYDM_PMAC_TX: -+ phydm_pmac_tx_dbg(dm, input, &used, output, &out_len); -+ break; -+#endif -+#ifdef PHYDM_HW_IGI -+ case PHYDM_HWIGI: -+ phydm_hwigi_dbg(dm, input, &used, output, &out_len); -+ break; -+#endif -+#ifdef PHYDM_HW_SWITCH_AGC_TAB -+ case PHYDM_HW_AGCTAB: -+ phydm_auto_agc_tab_debug(dm, input, &used, output, &out_len); -+ break; -+#endif -+ case PHYDM_GET_RXAGC: -+ phydm_get_rxagc_table_dbg(dm, input, &used, output, &out_len); -+ break; -+ case PHYDM_SHIFT_RXAGC: -+ phydm_shift_rxagc_table_dbg(dm, input, &used, output, &out_len); -+ break; -+ case PHYDM_IFS_CLM: -+ #ifdef IFS_CLM_SUPPORT -+ phydm_ifs_clm_dbg(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ case PHYDM_ENHANCE_MNTR: -+ phydm_enhance_mntr_dbg(dm, input, &used, output, &out_len); -+ break; -+ case PHYDM_CSI_DBG: -+ phydm_get_csi_table(dm, &used, output, &out_len); -+ break; -+ case PHYDM_EDCCA_CLM: -+ #ifdef EDCCA_CLM_SUPPORT -+ phydm_edcca_clm_dbg(dm, input, &used, output, &out_len); -+ #endif -+ break; -+ default: -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Do not support this command\n"); -+ break; -+ } -+#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ -+} -+ -+#if defined __ECOS || defined __ICCARM__ -+#ifndef strsep -+char *strsep(char **s, const char *ct) -+{ -+ char *sbegin = *s; -+ char *end; -+ -+ if (!sbegin) -+ return NULL; -+ -+ end = strpbrk(sbegin, ct); -+ if (end) -+ *end++ = '\0'; -+ *s = end; -+ return sbegin; -+} -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP | ODM_IOT)) -+s32 phydm_cmd(struct dm_struct *dm, char *input, u32 in_len, u8 flag, -+ char *output, u32 out_len) -+{ -+ char *token; -+ u32 argc = 0; -+ char argv[MAX_ARGC][MAX_ARGV]; -+ -+ do { -+ token = strsep(&input, ", "); -+ if (token) { -+ if (strlen(token) <= MAX_ARGV) -+ strcpy(argv[argc], token); -+ -+ argc++; -+ } else { -+ break; -+ } -+ } while (argc < MAX_ARGC); -+ -+ if (argc == 1) -+ argv[0][strlen(argv[0]) - 1] = '\0'; -+ -+ phydm_cmd_parser(dm, argv, argc, flag, output, out_len); -+ -+ return 0; -+} -+#endif -+ -+void phydm_fw_trace_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len) -+{ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /*@u8 debug_trace_11byte[60];*/ -+ u8 freg_num, c2h_seq, buf_0 = 0; -+ -+ if (!(dm->support_ic_type & PHYDM_IC_3081_SERIES)) -+ return; -+ -+ if (cmd_len > 12 || cmd_len == 0) { -+ pr_debug("[Warning] Error C2H cmd_len=%d\n", cmd_len); -+ return; -+ } -+ -+ buf_0 = cmd_buf[0]; -+ freg_num = (buf_0 & 0xf); -+ c2h_seq = (buf_0 & 0xf0) >> 4; -+ -+ #if 0 -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW debug message] freg_num = (( %d )), c2h_seq=(( %d ))\n", -+ freg_num, c2h_seq); -+ -+ strncpy(debug_trace_11byte, &cmd_buf[1], (cmd_len - 1)); -+ debug_trace_11byte[cmd_len - 1] = '\0'; -+ PHYDM_DBG(dm, DBG_FW_TRACE, "[FW debug message] %s\n", -+ debug_trace_11byte); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "[FW debug message] cmd_len = (( %d ))\n", -+ cmd_len); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "[FW debug message] c2h_cmd_start=((%d))\n", -+ dm->c2h_cmd_start); -+ -+ PHYDM_DBG(dm, DBG_FW_TRACE, "pre_seq = (( %d )), current_seq=((%d))\n", -+ dm->pre_c2h_seq, c2h_seq); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "fw_buff_is_enpty = (( %d ))\n", -+ dm->fw_buff_is_enpty); -+ #endif -+ -+ if (c2h_seq != dm->pre_c2h_seq && dm->fw_buff_is_enpty == false) { -+ dm->fw_debug_trace[dm->c2h_cmd_start] = '\0'; -+ PHYDM_DBG(dm, DBG_FW_TRACE, "[FW Dbg Queue Overflow] %s\n", -+ dm->fw_debug_trace); -+ dm->c2h_cmd_start = 0; -+ } -+ -+ if ((cmd_len - 1) > (60 - dm->c2h_cmd_start)) { -+ dm->fw_debug_trace[dm->c2h_cmd_start] = '\0'; -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW Dbg Queue error: wrong C2H length] %s\n", -+ dm->fw_debug_trace); -+ dm->c2h_cmd_start = 0; -+ return; -+ } -+ -+ strncpy((char *)&dm->fw_debug_trace[dm->c2h_cmd_start], -+ (char *)&cmd_buf[1], (cmd_len - 1)); -+ dm->c2h_cmd_start += (cmd_len - 1); -+ dm->fw_buff_is_enpty = false; -+ -+ if (freg_num == 0 || dm->c2h_cmd_start >= 60) { -+ if (dm->c2h_cmd_start < 60) -+ dm->fw_debug_trace[dm->c2h_cmd_start] = '\0'; -+ else -+ dm->fw_debug_trace[59] = '\0'; -+ -+ PHYDM_DBG(dm, DBG_FW_TRACE, "[FW DBG Msg] %s\n", -+ dm->fw_debug_trace); -+ -+ dm->c2h_cmd_start = 0; -+ dm->fw_buff_is_enpty = true; -+ } -+ -+ dm->pre_c2h_seq = c2h_seq; -+#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ -+} -+ -+void phydm_fw_trace_handler_code(void *dm_void, u8 *buffer, u8 cmd_len) -+{ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 function = buffer[0]; -+ u8 dbg_num = buffer[1]; -+ u16 content_0 = (((u16)buffer[3]) << 8) | ((u16)buffer[2]); -+ u16 content_1 = (((u16)buffer[5]) << 8) | ((u16)buffer[4]); -+ u16 content_2 = (((u16)buffer[7]) << 8) | ((u16)buffer[6]); -+ u16 content_3 = (((u16)buffer[9]) << 8) | ((u16)buffer[8]); -+ u16 content_4 = (((u16)buffer[11]) << 8) | ((u16)buffer[10]); -+ -+ if (cmd_len > 12) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW Msg] Invalid cmd length (( %d )) >12\n", -+ cmd_len); -+/*@--------------------------------------------*/ -+#ifdef CONFIG_RA_FW_DBG_CODE -+ if (function == RATE_DECISION) { -+ if (dbg_num == 0) { -+ if (content_0 == 1) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW] RA_CNT=((%d)) Max_device=((%d))--------------------------->\n", -+ content_1, content_2); -+ else if (content_0 == 2) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW] RTY[0,1,2,3]=[ %d , %d , %d , %d ]\n", -+ content_1, content_2, content_3, -+ content_4); -+ else if (content_0 == 2) { -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW] RTY[4]=[ %d ], drop=(( %d )), total=(( %d )), current_rate=((0x %x ))", -+ content_1, content_2, content_3, -+ content_4); -+ phydm_print_rate(dm, (u8)content_4, -+ DBG_FW_TRACE); -+ } else if (content_0 == 3) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW] penality_idx=(( %d ))\n", -+ content_1); -+ else if (content_0 == 4) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW] RSSI=(( %d )), ra_stage = (( %d ))\n", -+ content_1, content_2); -+ } else if (dbg_num == 3) { -+ if (content_0 == 1) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW] Fast_RA (( UP )) ((rate Down Hold)) RA_CNT=((%d))\n", -+ content_1); -+ else if (content_0 == 4) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW] Fast_RA (( UP )) ((tota_accl<5 skip)) RA_CNT=((%d))\n", -+ content_1); -+ else if (content_0 == 8) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW] Fast_RA (( Reset Tx Rpt )) RA_CNT=((%d))\n", -+ content_1); -+ } else if (dbg_num == 4) { -+ if (content_0 == 3) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW] ((DOWN)) Nsc=(( %d )), N_Low=(( %d ))\n", -+ content_1, content_2); -+ else if (content_0 == 3) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW] ((AP RPT)) macid=((%d)), BUPDATE[macid]=((%d))\n", -+ content_1, content_2); -+ else if (content_0 == 4) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW][RateUp] ((Highest rate->return)), macid=((%d)) Nsc=((%d))\n", -+ content_1, content_2); -+ } else if (dbg_num == 5) { -+ if (content_0 == 0) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW][H2C=0x49] fw_trace_en=((%d)), mode =((%d)), macid=((%d))\n", -+ content_1, content_2, content_3); -+ } -+ } else if (function == F_RATE_AP_RPT) { -+ if (dbg_num == 1) { -+ if (content_0 == 1) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW][AP RPT] ((1)), SPE_STATIS=((0x%x))---------->\n", -+ content_3); -+ } else if (dbg_num == 2) { -+ if (content_0 == 1) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW][AP RPT] RTY_all=((%d))\n", -+ content_1); -+ } else if (dbg_num == 3) { -+ if (content_0 == 1) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[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) -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW][AP RPT] MACID2[%d],, PASS=((%d)), DROP=((%d))\n", -+ content_3, content_1, content_2); -+ } -+ } else if (function == DBC_FW_CLM) { -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW][CLM][%d, %d] = {%d, %d, %d, %d}\n", dbg_num, -+ content_0, content_1, content_2, content_3, -+ content_4); -+ } else { -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW][general][%d, %d, %d] = {%d, %d, %d, %d}\n", -+ function, dbg_num, content_0, content_1, content_2, -+ content_3, content_4); -+ } -+#else -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "[FW][general][%d, %d, %d] = {%d, %d, %d, %d}\n", function, -+ dbg_num, content_0, content_1, content_2, content_3, -+ content_4); -+#endif -+/*@--------------------------------------------*/ -+ -+#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ -+} -+ -+void phydm_fw_trace_handler_8051(void *dm_void, u8 *buffer, u8 cmd_len) -+{ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ int i = 0; -+ u8 extend_c2h_sub_id = 0, extend_c2h_dbg_len = 0; -+ u8 extend_c2h_dbg_seq = 0; -+ u8 fw_debug_trace[128]; -+ u8 *extend_c2h_dbg_content = 0; -+ -+ if (cmd_len > 127) -+ return; -+ -+ extend_c2h_sub_id = buffer[0]; -+ extend_c2h_dbg_len = buffer[1]; -+ extend_c2h_dbg_content = 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_c2h_dbg_len=%d\n", -+ extend_c2h_sub_id, extend_c2h_dbg_len)); -+ -+ RT_DISP_DATA(FC2H, C2H_Summary, "[Extend C2H packet], Content Hex:", extend_c2h_dbg_content, cmd_len - 2); -+#endif -+ -+go_backfor_aggre_dbg_pkt: -+ i = 0; -+ extend_c2h_dbg_seq = buffer[2]; -+ extend_c2h_dbg_content = buffer + 3; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISP(FC2H, C2H_Summary, ("[RTKFW, SEQ= %d] :", extend_c2h_dbg_seq)); -+#endif -+ -+ for (;; i++) { -+ fw_debug_trace[i] = extend_c2h_dbg_content[i]; -+ if (extend_c2h_dbg_content[i + 1] == '\0') { -+ fw_debug_trace[i + 1] = '\0'; -+ PHYDM_DBG(dm, DBG_FW_TRACE, "[FW DBG Msg] %s", -+ &fw_debug_trace[0]); -+ break; -+ } else if (extend_c2h_dbg_content[i] == '\n') { -+ fw_debug_trace[i + 1] = '\0'; -+ PHYDM_DBG(dm, DBG_FW_TRACE, "[FW DBG Msg] %s", -+ &fw_debug_trace[0]); -+ buffer = extend_c2h_dbg_content + i + 3; -+ goto go_backfor_aggre_dbg_pkt; -+ } -+ } -+#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_debug.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_debug.h -new file mode 100644 -index 000000000..08c6a52b6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_debug.h -@@ -0,0 +1,482 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#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 DEBUG_VERSION "1.4"*/ /*2017.03.13 Dino*/ -+/*#define DEBUG_VERSION "2.0"*/ /*2018.01.10 Dino*/ -+/*2020.07.03 fix cck report bug due to 8723F coding error*/ -+#define DEBUG_VERSION "4.6" -+ -+/*@ -+ * ============================================================ -+ * Definition -+ * ============================================================ -+ */ -+ -+/*@FW DBG MSG*/ -+#define RATE_DECISION 1 -+#define INIT_RA_TABLE 2 -+#define RATE_UP 4 -+#define RATE_DOWN 8 -+#define TRY_DONE 16 -+#define RA_H2C 32 -+#define F_RATE_AP_RPT 64 -+#define DBC_FW_CLM 9 -+ -+#define PHYDM_SNPRINT_SIZE 64 -+/* @---------------------------------------------------------------------------- -+ * Define the tracing components -+ * -+ * ----------------------------------------------------------------------------- -+ * BB FW Functions -+ */ -+#define PHYDM_FW_COMP_RA BIT(0) -+#define PHYDM_FW_COMP_MU BIT(1) -+#define PHYDM_FW_COMP_PATH_DIV BIT(2) -+#define PHYDM_FW_COMP_PT BIT(3) -+ -+/*@------------------------Export Marco Definition---------------------------*/ -+ -+#define config_phydm_read_txagc_check(data) (data != INVALID_TXAGC_DATA) -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if (DBG_CMD_SUPPORT == 1) -+ extern VOID DCMD_Printf(const char *pMsg); -+ #else -+ #define DCMD_Printf(_pMsg) -+ #endif -+ -+ #if OS_WIN_FROM_WIN10(OS_VERSION) -+ #define pr_debug(fmt, ...) DbgPrintEx(DPFLTR_IHVNETWORK_ID, DPFLTR_ERROR_LEVEL, fmt, ##__VA_ARGS__) -+ #else -+ #define pr_debug DbgPrint -+ #endif -+ -+ #define dcmd_printf DCMD_Printf -+ #define dcmd_scanf DCMD_Scanf -+ #define RT_PRINTK pr_debug -+ #define PRINT_MAX_SIZE 512 -+ #define PHYDM_SNPRINTF RT_SPRINTF -+ #define PHYDM_TRACE(_MSG_) EXhalPHYDMoutsrc_Print(_MSG_) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ #define PHYDM_SNPRINTF snprintf -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #define RT_PRINTK(fmt, args...) pr_debug(fmt, ## args) -+ #define RT_DISP(dbgtype, dbgflag, printstr) -+ #define RT_TRACE(adapter, comp, drv_level, fmt, args...) \ -+ RTW_INFO(fmt, ## args) -+ #define PHYDM_SNPRINTF snprintf -+#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ #define pr_debug(fmt, args...) RTW_PRINT_MSG(fmt, ## args) -+ #define RT_DEBUG(comp, drv_level, fmt, args...) \ -+ RTW_PRINT_MSG(fmt, ## args) -+ #define PHYDM_SNPRINTF snprintf -+#else -+ #define pr_debug panic_printk -+ /*@#define RT_PRINTK(fmt, args...) pr_debug("%s(): " fmt, __FUNCTION__, ## args);*/ -+ #define RT_PRINTK(fmt, args...) pr_debug(fmt, ## args) -+ #define PHYDM_SNPRINTF snprintf -+#endif -+ -+#ifndef ASSERT -+ #define ASSERT(expr) -+#endif -+ -+#if DBG -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#define PHYDM_DBG(dm, comp, fmt, args...) \ -+ do { \ -+ if ((comp) & dm->debug_components) { \ -+ pr_debug("[PHYDM] "); \ -+ RT_PRINTK(fmt, ## args); \ -+ } \ -+ } while (0) -+ -+#define PHYDM_DBG_F(dm, comp, fmt, args...) \ -+ do { \ -+ if ((comp) & dm->debug_components) { \ -+ RT_PRINTK(fmt, ## args); \ -+ } \ -+ } while (0) -+ -+#define PHYDM_PRINT_ADDR(dm, comp, title_str, addr) \ -+ do { \ -+ if ((comp) & dm->debug_components) { \ -+ int __i; \ -+ u8 *__ptr = (u8 *)addr; \ -+ pr_debug("[PHYDM] "); \ -+ pr_debug(title_str); \ -+ pr_debug(" "); \ -+ for (__i = 0; __i < 6; __i++) \ -+ pr_debug("%02X%s", __ptr[__i], (__i == 5) ? "" : "-");\ -+ pr_debug("\n"); \ -+ } \ -+ } while (0) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+static __inline void PHYDM_DBG(PDM_ODM_T dm, int comp, char *fmt, ...) -+{ -+ RT_STATUS rt_status; -+ va_list args; -+ char buf[PRINT_MAX_SIZE] = {0}; -+ -+ if ((comp & dm->debug_components) == 0) -+ return; -+ -+ if (fmt == NULL) -+ return; -+ -+ va_start(args, fmt); -+ rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, PRINT_MAX_SIZE, fmt, args); -+ va_end(args); -+ -+ if (rt_status != RT_STATUS_SUCCESS) { -+ DbgPrint("Failed (%d) to print message to buffer\n", rt_status); -+ return; -+ } -+ -+ #if OS_WIN_FROM_WIN10(OS_VERSION) -+ DbgPrintEx(DPFLTR_IHVNETWORK_ID, DPFLTR_ERROR_LEVEL, "%s", buf); -+ #else -+ DbgPrint("%s", buf); -+ #endif -+} -+ -+static __inline void PHYDM_DBG_F(PDM_ODM_T dm, int comp, char *fmt, ...) -+{ -+ RT_STATUS rt_status; -+ va_list args; -+ char buf[PRINT_MAX_SIZE] = {0}; -+ -+ if ((comp & dm->debug_components) == 0) -+ return; -+ -+ if (fmt == NULL) -+ return; -+ -+ va_start(args, fmt); -+ rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, PRINT_MAX_SIZE, fmt, args); -+ va_end(args); -+ -+ if (rt_status != RT_STATUS_SUCCESS) { -+ /*@DbgPrint("DM Print Fail\n");*/ -+ return; -+ } -+ -+ #if OS_WIN_FROM_WIN10(OS_VERSION) -+ DbgPrintEx(DPFLTR_IHVNETWORK_ID, DPFLTR_ERROR_LEVEL, "%s", buf); -+ #else -+ DbgPrint("%s", buf); -+ #endif -+} -+ -+#define PHYDM_PRINT_ADDR(p_dm, comp, title_str, ptr) \ -+ do { \ -+ if ((comp) & p_dm->debug_components) { \ -+ \ -+ int __i; \ -+ u8 *__ptr = (u8 *)ptr; \ -+ pr_debug("[PHYDM] "); \ -+ pr_debug(title_str); \ -+ pr_debug(" "); \ -+ for (__i = 0; __i < 6; __i++) \ -+ pr_debug("%02X%s", __ptr[__i], (__i == 5) ? "" : "-"); \ -+ pr_debug("\n"); \ -+ } \ -+ } while (0) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ -+#define PHYDM_DBG(dm, comp, fmt, args...) \ -+ do { \ -+ if ((comp) & dm->debug_components) { \ -+ RT_DEBUG(COMP_PHYDM, \ -+ DBG_DMESG, "[PHYDM] " fmt, ##args); \ -+ } \ -+ } while (0) -+ -+#define PHYDM_DBG_F(dm, comp, fmt, args...) \ -+ do { \ -+ if ((comp) & dm->debug_components) { \ -+ RT_DEBUG(COMP_PHYDM, \ -+ DBG_DMESG, fmt, ##args); \ -+ } \ -+ } while (0) -+ -+#define PHYDM_PRINT_ADDR(dm, comp, title_str, addr) \ -+ do { \ -+ if ((comp) & dm->debug_components) { \ -+ RT_DEBUG(COMP_PHYDM, \ -+ DBG_DMESG, "[PHYDM] " title_str "%pM\n", \ -+ addr); \ -+ } \ -+ } while (0) -+ -+#elif defined(DM_ODM_CE_MAC80211_V2) -+ -+#define PHYDM_DBG(dm, comp, fmt, args...) -+#define PHYDM_DBG_F(dm, comp, fmt, args...) -+#define PHYDM_PRINT_ADDR(dm, comp, title_str, addr) -+ -+#else -+ -+#define PHYDM_DBG(dm, comp, fmt, args...) \ -+ do { \ -+ struct dm_struct *__dm = (dm); \ -+ if ((comp) & __dm->debug_components) { \ -+ RT_TRACE(((struct rtl_priv *)__dm->adapter),\ -+ COMP_PHYDM, DBG_DMESG, \ -+ "[PHYDM] " fmt, ##args); \ -+ } \ -+ } while (0) -+ -+#define PHYDM_DBG_F(dm, comp, fmt, args...) \ -+ do { \ -+ struct dm_struct *__dm = (dm); \ -+ if ((comp) & __dm->debug_components) { \ -+ RT_TRACE(((struct rtl_priv *)__dm->adapter),\ -+ COMP_PHYDM, DBG_DMESG, fmt, ##args); \ -+ } \ -+ } while (0) -+ -+#define PHYDM_PRINT_ADDR(dm, comp, title_str, addr) \ -+ do { \ -+ struct dm_struct *__dm = (dm); \ -+ if ((comp) & __dm->debug_components) { \ -+ RT_TRACE(((struct rtl_priv *)__dm->adapter),\ -+ COMP_PHYDM, DBG_DMESG, \ -+ "[PHYDM] " title_str "%pM\n", addr);\ -+ } \ -+ } while (0) -+#endif -+ -+#else /*@#if DBG*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+static __inline void PHYDM_DBG(struct dm_struct *dm, int comp, char *fmt, ...) -+{ -+ RT_STATUS rt_status; -+ va_list args; -+ char buf[PRINT_MAX_SIZE] = {0}; -+ -+ if ((comp & dm->debug_components) == 0) -+ return; -+ -+ if (fmt == NULL) -+ return; -+ -+ va_start(args, fmt); -+ rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, PRINT_MAX_SIZE, fmt, args); -+ va_end(args); -+ -+ if (rt_status != RT_STATUS_SUCCESS) { -+ DbgPrint("Failed (%d) to print message to buffer\n", rt_status); -+ return; -+ } -+ -+ PHYDM_TRACE(buf); -+} -+static __inline void PHYDM_DBG_F(struct dm_struct *dm, int comp, char *fmt, ...) -+{ -+} -+#else -+#define PHYDM_DBG(dm, comp, fmt, args...) -+#define PHYDM_DBG_F(dm, comp, fmt, args...) -+#endif -+#define PHYDM_PRINT_ADDR(dm, comp, title_str, ptr) -+ -+#endif -+ -+#define DBGPORT_PRI_3 3 /*@Debug function (the highest priority)*/ -+#define DBGPORT_PRI_2 2 /*@Check hang function & Strong function*/ -+#define DBGPORT_PRI_1 1 /*Watch dog function*/ -+#define DBGPORT_RELEASE 0 /*@Init value (the lowest priority)*/ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define PHYDM_DBGPRINT 0 -+#define PHYDM_SSCANF(x, y, z) dcmd_scanf(x, y, z) -+#define PDM_VAST_SNPF PDM_SNPF -+#if (PHYDM_DBGPRINT == 1) -+#define PDM_SNPF(msg) \ -+ do {\ -+ rsprintf msg;\ -+ pr_debug("%s", output);\ -+ } while (0) -+#else -+ -+static __inline void PDM_SNPF(u32 out_len, u32 used, char *buff, int len, -+ char *fmt, ...) -+{ -+ RT_STATUS rt_status; -+ va_list args; -+ char buf[PRINT_MAX_SIZE] = {0}; -+ -+ if (fmt == NULL) -+ return; -+ -+ va_start(args, fmt); -+ rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, PRINT_MAX_SIZE, fmt, args); -+ va_end(args); -+ -+ if (rt_status != RT_STATUS_SUCCESS) { -+ /*@DbgPrint("DM Print Fail\n");*/ -+ return; -+ } -+ -+ DCMD_Printf(buf); -+} -+ -+ -+ -+#endif /*@#if (PHYDM_DBGPRINT == 1)*/ -+#else /*@(DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP))*/ -+ #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) -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+#define PDM_VAST_SNPF(out_len, used, buff, len, fmt, args...) RT_PRINTK(fmt, ## args) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+#define PDM_VAST_SNPF(out_len, used, buff, len, fmt, args...) \ -+ do { \ -+ RT_DEBUG(COMP_PHYDM, DBG_DMESG, fmt, ##args); \ -+ } while (0) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+#define PDM_VAST_SNPF(out_len, used, buff, len, fmt, args...) -+#else -+#define PDM_VAST_SNPF(out_len, used, buff, len, fmt, args...) \ -+ RT_TRACE(((struct rtl_priv *)dm->adapter), COMP_PHYDM, \ -+ DBG_DMESG, fmt, ##args) -+#endif -+ -+#if (PHYDM_DBGPRINT == 1) -+#define PDM_SNPF(out_len, used, buff, len, fmt, args...) \ -+ do { \ -+ snprintf(buff, len, fmt, ##args); \ -+ pr_debug("%s", output); \ -+ } while (0) -+#else -+#define PDM_SNPF(out_len, used, buff, len, fmt, args...) \ -+ do { \ -+ u32 *__pdm_snpf_u = &(used); \ -+ if (out_len > *__pdm_snpf_u) \ -+ *__pdm_snpf_u += snprintf(buff, len, fmt, ##args);\ -+ } while (0) -+#endif -+#endif -+/* @1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ */ -+ -+enum auto_detection_state { /*@Fast antenna training*/ -+ AD_LEGACY_MODE = 0, -+ AD_HT_MODE = 1, -+ AD_VHT_MODE = 2 -+}; -+ -+/*@ -+ * ============================================================ -+ * 1 structure -+ * ============================================================ -+ */ -+ -+#ifdef CONFIG_PHYDM_DEBUG_FUNCTION -+u8 phydm_get_l_sig_rate(void *dm_void, u8 rate_idx_l_sig); -+#endif -+ -+void phydm_init_debug_setting(struct dm_struct *dm); -+ -+void phydm_bb_dbg_port_header_sel(void *dm_void, u32 header_idx); -+ -+u32 phydm_get_bb_dbg_port_idx(void *dm_void); -+ -+u8 phydm_set_bb_dbg_port(void *dm_void, u8 curr_dbg_priority, u32 debug_port); -+ -+void phydm_release_bb_dbg_port(void *dm_void); -+ -+u32 phydm_get_bb_dbg_port_val(void *dm_void); -+ -+void phydm_reset_rx_rate_distribution(struct dm_struct *dm); -+ -+void phydm_rx_rate_distribution(void *dm_void); -+ -+u16 phydm_rx_avg_phy_rate(void *dm_void); -+ -+void phydm_show_phy_hitogram(void *dm_void); -+ -+void phydm_get_avg_phystatus_val(void *dm_void); -+ -+void phydm_get_phy_statistic(void *dm_void); -+ -+void phydm_dm_summary(void *dm_void, u8 macid); -+ -+void phydm_basic_dbg_message(void *dm_void); -+ -+void phydm_basic_profile(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len); -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) -+s32 phydm_cmd(struct dm_struct *dm, char *input, u32 in_len, u8 flag, -+ char *output, u32 out_len); -+#endif -+void phydm_cmd_parser(struct dm_struct *dm, char input[][16], u32 input_num, -+ u8 flag, char *output, u32 out_len); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_basic_dbg_msg_cli_win(void *dm_void, char *buf); -+ -+void phydm_sbd_check( -+ struct dm_struct *dm); -+ -+void phydm_sbd_callback( -+ struct phydm_timer_list *timer); -+ -+void phydm_sbd_workitem_callback( -+ void *context); -+#endif -+ -+void phydm_fw_trace_en_h2c(void *dm_void, boolean enable, -+ u32 fw_debug_component, u32 monitor_mode, u32 macid); -+ -+void phydm_fw_trace_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len); -+ -+void phydm_fw_trace_handler_code(void *dm_void, u8 *buffer, u8 cmd_len); -+ -+void phydm_fw_trace_handler_8051(void *dm_void, u8 *cmd_buf, u8 cmd_len); -+ -+#endif /* @__ODM_DBG_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dfs.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dfs.c -new file mode 100644 -index 000000000..8742acc85 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dfs.c -@@ -0,0 +1,2907 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@ -+ * ============================================================ -+ * include files -+ * ============================================================ -+ */ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if defined(CONFIG_PHYDM_DFS_MASTER) -+ -+boolean phydm_dfs_is_meteorology_channel(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ u8 ch = *dm->channel; -+ u8 bw = *dm->band_width; -+ -+ return ((bw == CHANNEL_WIDTH_80 && (ch) >= 116 && (ch) <= 128) || -+ (bw == CHANNEL_WIDTH_40 && (ch) >= 116 && (ch) <= 128) || -+ (bw == CHANNEL_WIDTH_20 && (ch) >= 120 && (ch) <= 128)); -+} -+ -+void phydm_dfs_segment_distinguish(void *dm_void, enum rf_syn syn_path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C))) -+ return; -+ if (syn_path == RF_SYN1) -+ dm->seg1_dfs_flag = 1; -+ else -+ dm->seg1_dfs_flag = 0; -+} -+ -+void phydm_dfs_segment_flag_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C))) -+ return; -+ if (dm->seg1_dfs_flag) -+ dm->seg1_dfs_flag = 0; -+} -+ -+void phydm_radar_detect_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8822C | ODM_RTL8812F | -+ ODM_RTL8197G | ODM_RTL8723F)) { -+ odm_set_bb_reg(dm, R_0xa40, BIT(15), 0); -+ odm_set_bb_reg(dm, R_0xa40, BIT(15), 1); -+ #if (RTL8721D_SUPPORT) -+ } else if (dm->support_ic_type & (ODM_RTL8721D)) { -+ odm_set_bb_reg(dm, R_0xf58, BIT(29), 0); -+ odm_set_bb_reg(dm, R_0xf58, BIT(29), 1); -+ #endif -+ } else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (dm->seg1_dfs_flag == 1) { -+ odm_set_bb_reg(dm, R_0xa6c, BIT(0), 0); -+ odm_set_bb_reg(dm, R_0xa6c, BIT(0), 1); -+ return; -+ } -+ odm_set_bb_reg(dm, R_0xa40, BIT(15), 0); -+ odm_set_bb_reg(dm, R_0xa40, BIT(15), 1); -+ } else { -+ odm_set_bb_reg(dm, R_0x924, BIT(15), 0); -+ odm_set_bb_reg(dm, R_0x924, BIT(15), 1); -+ } -+} -+ -+void phydm_radar_detect_disable(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8822C | ODM_RTL8812F | -+ ODM_RTL8197G | ODM_RTL8723F)) -+ odm_set_bb_reg(dm, R_0xa40, BIT(15), 0); -+ else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (dm->seg1_dfs_flag == 1) { -+ odm_set_bb_reg(dm, R_0xa6c, BIT(0), 0); -+ dm->seg1_dfs_flag = 0; -+ return; -+ } -+ odm_set_bb_reg(dm, R_0xa40, BIT(15), 0); -+ } -+ #if (RTL8721D_SUPPORT) -+ else if (dm->support_ic_type & (ODM_RTL8721D)) -+ odm_set_bb_reg(dm, R_0xf58, BIT(29), 0); -+ #endif -+ else -+ odm_set_bb_reg(dm, R_0x924, BIT(15), 0); -+ -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+} -+ -+static void phydm_radar_detect_with_dbg_parm(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_RTL8721D) { -+ odm_set_bb_reg(dm, R_0xf54, MASKDWORD, -+ dm->radar_detect_reg_f54); -+ odm_set_bb_reg(dm, R_0xf58, MASKDWORD, -+ dm->radar_detect_reg_f58); -+ odm_set_bb_reg(dm, R_0xf5c, MASKDWORD, -+ dm->radar_detect_reg_f5c); -+ odm_set_bb_reg(dm, R_0xf70, MASKDWORD, -+ dm->radar_detect_reg_f70); -+ odm_set_bb_reg(dm, R_0xf74, MASKDWORD, -+ dm->radar_detect_reg_f74); -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ odm_set_bb_reg(dm, R_0xa40, MASKDWORD, -+ dm->radar_detect_reg_a40); -+ odm_set_bb_reg(dm, R_0xa44, MASKDWORD, -+ dm->radar_detect_reg_a44); -+ odm_set_bb_reg(dm, R_0xa48, MASKDWORD, -+ dm->radar_detect_reg_a48); -+ odm_set_bb_reg(dm, R_0xa4c, MASKDWORD, -+ dm->radar_detect_reg_a4c); -+ odm_set_bb_reg(dm, R_0xa50, MASKDWORD, -+ dm->radar_detect_reg_a50); -+ odm_set_bb_reg(dm, R_0xa54, MASKDWORD, -+ dm->radar_detect_reg_a54); -+ } else { -+ odm_set_bb_reg(dm, R_0x918, MASKDWORD, -+ dm->radar_detect_reg_918); -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ dm->radar_detect_reg_91c); -+ odm_set_bb_reg(dm, R_0x920, MASKDWORD, -+ dm->radar_detect_reg_920); -+ odm_set_bb_reg(dm, R_0x924, MASKDWORD, -+ dm->radar_detect_reg_924); -+ } -+} -+ -+/* @Init radar detection parameters, called after ch, bw is set */ -+ -+void phydm_radar_detect_enable(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ u8 region_domain = dm->dfs_region_domain; -+ u8 c_channel = *dm->channel; -+ u8 band_width = *dm->band_width; -+ u8 enable = 0, i; -+ u8 short_pw_upperbound = 0; -+ -+ PHYDM_DBG(dm, DBG_DFS, "test, region_domain = %d\n", region_domain); -+ if (region_domain == PHYDM_DFS_DOMAIN_UNKNOWN) { -+ PHYDM_DBG(dm, DBG_DFS, "PHYDM_DFS_DOMAIN_UNKNOWN\n"); -+ goto exit; -+ } -+ -+ if (dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8812 | ODM_RTL8881A)) { -+ odm_set_bb_reg(dm, R_0x814, 0x3fffffff, 0x04cc4d10); -+ odm_set_bb_reg(dm, R_0x834, MASKBYTE0, 0x06); -+ -+ if (dm->radar_detect_dbg_parm_en) { -+ phydm_radar_detect_with_dbg_parm(dm); -+ enable = 1; -+ goto exit; -+ } -+ -+ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { -+ odm_set_bb_reg(dm, R_0x918, MASKDWORD, 0x1c17ecdf); -+ odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x01528500); -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, 0x0fa21a20); -+ odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe0f69204); -+ -+ } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { -+ odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x01528500); -+ odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe0d67234); -+ -+ if (c_channel >= 52 && c_channel <= 64) { -+ odm_set_bb_reg(dm, R_0x918, MASKDWORD, -+ 0x1c16ecdf); -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ 0x0f141a20); -+ } else { -+ odm_set_bb_reg(dm, R_0x918, MASKDWORD, -+ 0x1c16acdf); -+ if (band_width == CHANNEL_WIDTH_20) -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ 0x64721a20); -+ else -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ 0x68721a20); -+ } -+ -+ } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { -+ odm_set_bb_reg(dm, R_0x918, MASKDWORD, 0x1c16acdf); -+ odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x01528500); -+ odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe0d67231); -+ if (band_width == CHANNEL_WIDTH_20) -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ 0x64741a20); -+ else -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ 0x68741a20); -+ -+ } else { -+ /* not supported */ -+ PHYDM_DBG(dm, DBG_DFS, -+ "Unsupported dfs_region_domain:%d\n", -+ region_domain); -+ goto exit; -+ } -+ -+ } else if (dm->support_ic_type & -+ (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) { -+ -+ odm_set_bb_reg(dm, R_0x814, 0x3fffffff, 0x04cc4d10); -+ odm_set_bb_reg(dm, R_0x834, MASKBYTE0, 0x06); -+ -+ /* @8822B only, when BW = 20M, DFIR output is 40Mhz, -+ * but DFS input is 80MMHz, so it need to upgrade to 80MHz -+ */ -+ if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { -+ if (band_width == CHANNEL_WIDTH_20) -+ odm_set_bb_reg(dm, R_0x1984, BIT(26), 1); -+ else -+ odm_set_bb_reg(dm, R_0x1984, BIT(26), 0); -+ } -+ -+ if (dm->radar_detect_dbg_parm_en) { -+ phydm_radar_detect_with_dbg_parm(dm); -+ enable = 1; -+ goto exit; -+ } -+ -+ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { -+ odm_set_bb_reg(dm, R_0x918, MASKDWORD, 0x1c16acdf); -+ odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x095a8500); -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, 0x0fc01a1f); -+ odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe0f57204); -+ -+ } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { -+ odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x095a8500); -+ odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe0d67234); -+ -+ if (c_channel >= 52 && c_channel <= 64) { -+ odm_set_bb_reg(dm, R_0x918, MASKDWORD, -+ 0x1c16ecdf); -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ 0x0f141a1f); -+ } else { -+ odm_set_bb_reg(dm, R_0x918, MASKDWORD, -+ 0x1c166cdf); -+ if (band_width == CHANNEL_WIDTH_20) -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ 0x64721a1f); -+ else -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ 0x68721a1f); -+ } -+ -+ } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { -+ odm_set_bb_reg(dm, R_0x918, MASKDWORD, 0x1c176cdf); -+ odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x095a8400); -+ odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe076d231); -+ if (band_width == CHANNEL_WIDTH_20) -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ 0x64901a1f); -+ else -+ odm_set_bb_reg(dm, R_0x91c, MASKDWORD, -+ 0x62901a1f); -+ -+ } else { -+ /* not supported */ -+ PHYDM_DBG(dm, DBG_DFS, -+ "Unsupported dfs_region_domain:%d\n", -+ region_domain); -+ goto exit; -+ } -+ /*RXHP low corner will extend the pulse width, -+ *so we need to increase the upper bound. -+ */ -+ if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { -+ if (odm_get_bb_reg(dm, 0x8d8, -+ BIT28 | BIT27 | BIT26) == 0) { -+ short_pw_upperbound = -+ (u8)odm_get_bb_reg(dm, 0x91c, -+ BIT23 | BIT22 | -+ BIT21 | BIT20); -+ if ((short_pw_upperbound + 4) > 15) -+ odm_set_bb_reg(dm, 0x91c, -+ BIT23 | BIT22 | -+ BIT21 | BIT20, 15); -+ else -+ odm_set_bb_reg(dm, 0x91c, -+ BIT23 | BIT22 | -+ BIT21 | BIT20, -+ short_pw_upperbound + 4); -+ } -+ /*@if peak index -1~+1, use original NB method*/ -+ odm_set_bb_reg(dm, 0x19e4, 0x003C0000, 13); -+ odm_set_bb_reg(dm, 0x924, 0x70000, 0); -+ } -+ -+ if (dm->support_ic_type & (ODM_RTL8881A)) -+ odm_set_bb_reg(dm, 0xb00, 0xc0000000, 3); -+ -+ /*@for 8814 new dfs mechanism setting*/ -+ if (dm->support_ic_type & -+ (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) { -+ /*Turn off dfs scaling factor*/ -+ odm_set_bb_reg(dm, 0x19e4, 0x1fff, 0x0c00); -+ /*NonDC peak_th = 2times DC peak_th*/ -+ odm_set_bb_reg(dm, 0x19e4, 0x30000, 1); -+ /*power for debug and auto test flow latch after ST*/ -+ odm_set_bb_reg(dm, 0x9f8, 0xc0000000, 3); -+ -+ /*@low pulse width radar pattern will cause wrong drop*/ -+ /*@disable peak index should the same -+ *during the same short pulse (new mechan) -+ */ -+ odm_set_bb_reg(dm, 0x9f4, 0x80000000, 0); -+ -+ /*@disable peak index should the same -+ *during the same short pulse (old mechan) -+ */ -+ odm_set_bb_reg(dm, 0x924, 0x20000000, 0); -+ -+ /*@if peak index diff >=2, then drop the result*/ -+ odm_set_bb_reg(dm, 0x19e4, 0xe000, 2); -+ if (region_domain == 2) { -+ if ((c_channel >= 52) && (c_channel <= 64)) { -+ /*pulse width hist th setting*/ -+ /*th1=2*04us*/ -+ odm_set_bb_reg(dm, 0x19e4, -+ 0xff000000, 2); -+ /*th2 = 3*0.4us, th3 = 4*0.4us -+ *th4 = 7*0.4, th5 = 34*0.4 -+ */ -+ odm_set_bb_reg(dm, 0x19e8, -+ MASKDWORD, 0x22070403); -+ -+ /*PRI hist th setting*/ -+ /*th1=42*32us*/ -+ odm_set_bb_reg(dm, 0x19b8, -+ 0x00007f80, 42); -+ /*th2=47*32us, th3=115*32us, -+ *th4=123*32us, th5=130*32us -+ */ -+ odm_set_bb_reg(dm, 0x19ec, -+ MASKDWORD, 0x827b732f); -+ } else { -+ /*pulse width hist th setting*/ -+ /*th1=2*04us*/ -+ odm_set_bb_reg(dm, 0x19e4, -+ 0xff000000, 1); -+ /*th2 = 13*0.4us, th3 = 26*0.4us -+ *th4 = 75*0.4us, th5 = 255*0.4us -+ */ -+ odm_set_bb_reg(dm, 0x19e8, -+ MASKDWORD, 0xff4b1a0d); -+ /*PRI hist th setting*/ -+ /*th1=4*32us*/ -+ -+ odm_set_bb_reg(dm, 0x19b8, -+ 0x00007f80, 4); -+ /*th2=8*32us, th3=16*32us, -+ *th4=32*32us, th5=128*32=4096us -+ */ -+ odm_set_bb_reg(dm, 0x19ec, -+ MASKDWORD, 0x80201008); -+ } -+ } -+ /*@ETSI*/ -+ else if (region_domain == 3) { -+ /*pulse width hist th setting*/ -+ /*th1=2*04us*/ -+ odm_set_bb_reg(dm, 0x19e4, 0xff000000, 1); -+ odm_set_bb_reg(dm, 0x19e8, -+ MASKDWORD, 0x68260d06); -+ /*PRI hist th setting*/ -+ /*th1=7*32us*/ -+ odm_set_bb_reg(dm, 0x19b8, 0x00007f80, 7); -+ /*th2=40*32us, th3=80*32us, -+ *th4=110*32us, th5=157*32=5024 -+ */ -+ odm_set_bb_reg(dm, 0x19ec, -+ MASKDWORD, 0xc06e2010); -+ } -+ /*@FCC*/ -+ else if (region_domain == 1) { -+ /*pulse width hist th setting*/ -+ /*th1=2*04us*/ -+ odm_set_bb_reg(dm, 0x19e4, 0xff000000, 2); -+ /*th2 = 13*0.4us, th3 = 26*0.4us, -+ *th4 = 75*0.4us, th5 = 255*0.4us -+ */ -+ odm_set_bb_reg(dm, 0x19e8, -+ MASKDWORD, 0xff4b1a0d); -+ -+ /*PRI hist th setting*/ -+ /*th1=4*32us*/ -+ odm_set_bb_reg(dm, 0x19b8, 0x00007f80, 4); -+ /*th2=8*32us, th3=21*32us, -+ *th4=32*32us, th5=96*32=3072 -+ */ -+ if (band_width == CHANNEL_WIDTH_20) -+ odm_set_bb_reg(dm, 0x19ec, -+ MASKDWORD, 0x60282010); -+ else -+ odm_set_bb_reg(dm, 0x19ec, -+ MASKDWORD, 0x60282420); -+ } else { -+ } -+ } -+ } else if (dm->support_ic_type & -+ ODM_IC_JGR3_SERIES) { -+ if (dm->radar_detect_dbg_parm_en) { -+ phydm_radar_detect_with_dbg_parm(dm); -+ enable = 1; -+ goto exit; -+ } -+ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { -+ odm_set_bb_reg(dm, R_0xa40, MASKDWORD, 0xb25dc0bd); -+ if (dm->support_ic_type & -+ (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (dm->seg1_dfs_flag == 1) -+ odm_set_bb_reg(dm, R_0xa6c, BIT(0), 1); -+ } -+ odm_set_bb_reg(dm, R_0xa44, MASKDWORD, 0x3030bea0); -+ odm_set_bb_reg(dm, R_0xa48, MASKDWORD, 0x2a521254); -+ odm_set_bb_reg(dm, R_0xa4c, MASKDWORD, 0x42533345); -+ odm_set_bb_reg(dm, R_0xa50, MASKDWORD, 0x605be0c3); -+ odm_set_bb_reg(dm, R_0xa54, MASKDWORD, 0x500009e8); -+ odm_set_bb_reg(dm, R_0x180c, 0xe0000, 0x0); -+ } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { -+ odm_set_bb_reg(dm, R_0xa40, MASKDWORD, 0xb25dc0bd); -+ if (dm->support_ic_type & -+ (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (dm->seg1_dfs_flag == 1) -+ odm_set_bb_reg(dm, R_0xa6c, BIT(0), 1); -+ } -+ odm_set_bb_reg(dm, R_0xa44, MASKDWORD, 0x3030bea0); -+ odm_set_bb_reg(dm, R_0xa48, MASKDWORD, 0x2a521254); -+ odm_set_bb_reg(dm, R_0xa4c, MASKDWORD, 0x42533345); -+ odm_set_bb_reg(dm, R_0xa50, MASKDWORD, 0x605be0c3); -+ odm_set_bb_reg(dm, R_0xa54, MASKDWORD, 0x500009e8); -+ odm_set_bb_reg(dm, R_0x180c, 0xe0000, 0x0); -+ } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { -+ odm_set_bb_reg(dm, R_0xa40, MASKDWORD, 0xb25dc0bd); -+ if (dm->support_ic_type & -+ (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (dm->seg1_dfs_flag == 1) -+ odm_set_bb_reg(dm, R_0xa6c, BIT(0), 1); -+ } -+ odm_set_bb_reg(dm, R_0xa44, MASKDWORD, 0x3030bea0); -+ odm_set_bb_reg(dm, R_0xa48, MASKDWORD, 0x2a521254); -+ odm_set_bb_reg(dm, R_0xa4c, MASKDWORD, 0x42533345); -+ odm_set_bb_reg(dm, R_0xa50, MASKDWORD, 0x605be0c3); -+ odm_set_bb_reg(dm, R_0xa54, MASKDWORD, 0x500009e8); -+ odm_set_bb_reg(dm, R_0x180c, 0xe0000, 0x0); -+ } else { -+ /* not supported */ -+ PHYDM_DBG(dm, DBG_DFS, -+ "Unsupported dfs_region_domain:%d\n", -+ region_domain); -+ goto exit; -+ } -+ #if (RTL8721D_SUPPORT) -+ } else if (dm->support_ic_type & ODM_RTL8721D) { -+ odm_set_bb_reg(dm, R_0x814, 0x3fffffff, 0x04cc4d10); -+ /*CCA MASK*/ -+ odm_set_bb_reg(dm, R_0xc38, 0x07c00000, 0x06); -+ /*CCA Threshold*/ -+ odm_set_bb_reg(dm, R_0xc3c, 0x00000007, 0x0); -+ -+ if (dm->radar_detect_dbg_parm_en) { -+ phydm_radar_detect_with_dbg_parm(dm); -+ enable = 1; -+ goto exit; -+ } -+ -+ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { -+ odm_set_bb_reg(dm, R_0xf54, MASKDWORD, 0x230006a8); -+ odm_set_bb_reg(dm, R_0xf58, MASKDWORD, 0x354cd7dd); -+ odm_set_bb_reg(dm, R_0xf5c, MASKDWORD, 0x9984ab25); -+ odm_set_bb_reg(dm, R_0xf70, MASKDWORD, 0xbd9fab98); -+ odm_set_bb_reg(dm, R_0xf74, MASKDWORD, 0xcc45029f); -+ -+ } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { -+ odm_set_bb_reg(dm, R_0xf54, MASKDWORD, 0x230006a8); -+ odm_set_bb_reg(dm, R_0xf5c, MASKDWORD, 0x9984ab25); -+ odm_set_bb_reg(dm, R_0xf70, MASKDWORD, 0xbd9fb398); -+ odm_set_bb_reg(dm, R_0xf74, MASKDWORD, 0xcc450e9d); -+ -+ if (c_channel >= 52 && c_channel <= 64) { -+ odm_set_bb_reg(dm, R_0xf58, MASKDWORD, -+ 0x354cd7fd); -+ } else { -+ odm_set_bb_reg(dm, R_0xf58, MASKDWORD, -+ 0x354cd7bd); -+ } -+ } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { -+ odm_set_bb_reg(dm, R_0xf54, MASKDWORD, 0x230006a8); -+ odm_set_bb_reg(dm, R_0xf58, MASKDWORD, 0x3558d7bd); -+ odm_set_bb_reg(dm, R_0xf5c, MASKDWORD, 0x9984ab35); -+ odm_set_bb_reg(dm, R_0xf70, MASKDWORD, 0xbd9fb398); -+ odm_set_bb_reg(dm, R_0xf74, MASKDWORD, 0xcc444e9d); -+ } else { -+ /* not supported */ -+ PHYDM_DBG(dm, DBG_DFS, -+ "Unsupported dfs_region_domain:%d\n", -+ region_domain); -+ goto exit; -+ } -+ -+ /*if peak index -1~+1, use original NB method*/ -+ odm_set_bb_reg(dm, R_0xf70, 0x00070000, 0x7); -+ odm_set_bb_reg(dm, R_0xf74, 0x000c0000, 0); -+ -+ /*Turn off dfs scaling factor*/ -+ odm_set_bb_reg(dm, R_0xf70, 0x00080000, 0x0); -+ /*NonDC peak_th = 2times DC peak_th*/ -+ odm_set_bb_reg(dm, R_0xf58, 0x00007800, 1); -+ -+ /*low pulse width radar pattern will cause wrong drop*/ -+ /*disable peak index should the same*/ -+ /*during the same short pulse (new mechan)*/ -+ odm_set_bb_reg(dm, R_0xf70, 0x00100000, 0x0); -+ /*if peak index diff >=2, then drop the result*/ -+ odm_set_bb_reg(dm, R_0xf70, 0x30000000, 0x2); -+ #endif -+ } else { -+ /*not supported IC type*/ -+ PHYDM_DBG(dm, DBG_DFS, "Unsupported IC type:%d\n", -+ dm->support_ic_type); -+ goto exit; -+ } -+ -+ enable = 1; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ dfs->st_l2h_cur = (u8)odm_get_bb_reg(dm, R_0xa40, 0x00007f00); -+ dfs->pwdb_th_cur = (u8)odm_get_bb_reg(dm, R_0xa50, 0x000000f0); -+ dfs->peak_th = (u8)odm_get_bb_reg(dm, R_0xa48, 0x00c00000); -+ dfs->short_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0xa50, -+ 0x00f00000); -+ dfs->long_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0xa4c, -+ 0xf0000000); -+ dfs->peak_window = (u8)odm_get_bb_reg(dm, R_0xa40, 0x00030000); -+ dfs->three_peak_opt = (u8)odm_get_bb_reg(dm, R_0xa40, -+ 0x30000000); -+ dfs->three_peak_th2 = (u8)odm_get_bb_reg(dm, R_0xa44, -+ 0x00000007); -+ #if (RTL8721D_SUPPORT) -+ } else if (dm->support_ic_type & (ODM_RTL8721D)) { -+ dfs->st_l2h_cur = (u8)odm_get_bb_reg(dm, R_0xf54, -+ 0x0000001f) << 2); -+ dfs->st_l2h_cur += (u8)odm_get_bb_reg(dm, R_0xf58, 0xc0000000); -+ dfs->pwdb_th_cur = (u8)odm_get_bb_reg(dm, R_0xf70, 0x03c00000); -+ dfs->peak_th = (u8)odm_get_bb_reg(dm, R_0xf5c, 0x00000030); -+ dfs->short_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0xf70, -+ 0x00007800); -+ dfs->long_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0xf74, -+ 0x0000000f); -+ dfs->peak_window = (u8)odm_get_bb_reg(dm, R_0xf58, 0x18000000); -+ dfs->three_peak_opt = (u8)odm_get_bb_reg(dm, R_0xf58, -+ 0x00030000); -+ dfs->three_peak_th2 = (u8)odm_get_bb_reg(dm, -+ R_0xf58, 0x00007c00); -+ #endif -+ } else { -+ dfs->st_l2h_cur = (u8)odm_get_bb_reg(dm, R_0x91c, 0x000000ff); -+ dfs->pwdb_th_cur = (u8)odm_get_bb_reg(dm, R_0x918, 0x00001f00); -+ dfs->peak_th = (u8)odm_get_bb_reg(dm, R_0x918, 0x00030000); -+ dfs->short_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0x920, -+ 0x000f0000); -+ dfs->long_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0x920, -+ 0x00f00000); -+ dfs->peak_window = (u8)odm_get_bb_reg(dm, R_0x920, 0x00000300); -+ dfs->three_peak_opt = (u8)odm_get_bb_reg(dm, 0x924, 0x00000180); -+ dfs->three_peak_th2 = (u8)odm_get_bb_reg(dm, 0x924, 0x00007000); -+ } -+ -+ phydm_dfs_parameter_init(dm); -+ -+exit: -+ if (enable) { -+ phydm_radar_detect_reset(dm); -+ PHYDM_DBG(dm, DBG_DFS, "on cch:%u, bw:%u\n", c_channel, -+ band_width); -+ } else -+ phydm_radar_detect_disable(dm); -+} -+ -+void phydm_dfs_parameter_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ -+ u8 i; -+ for (i = 0; i < 5; i++) { -+ dfs->pulse_flag_hist[i] = 0; -+ dfs->pulse_type_hist[i] = 0; -+ dfs->radar_det_mask_hist[i] = 0; -+ dfs->fa_inc_hist[i] = 0; -+ } -+ -+ /*@for dfs mode*/ -+ dfs->force_TP_mode = 0; -+ dfs->sw_trigger_mode = 0; -+ dfs->det_print = 0; -+ dfs->det_print2 = 0; -+ dfs->print_hist_rpt = 0; -+ if (dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) -+ dfs->hist_cond_on = 1; -+ else -+ dfs->hist_cond_on = 0; -+ if (dm->support_ic_type & (ODM_RTL8723F | ODM_RTL8822C)) { -+ dfs->det_print_jar3 = 1; -+ dfs->nhm_dfs_en = true; -+ dfs->det_jar3_en = true; -+ } else { -+ dfs->det_print_jar3 = 0; -+ dfs->nhm_dfs_en = false; -+ dfs->det_jar3_en = false; -+ } -+ -+ /*@for flag en*/ -+ dfs->pw_flag_en = true; -+ dfs->pri_flag_en = true; -+ dfs->loct_flag_en = true; -+ dfs->nhm_cnt_th = 4; -+ dfs->nhm_dty_th = 40; -+ -+ /*@for jgar3*/ -+ dfs->pri_var_offset = 2; -+ dfs->pri_var_tp_offset = 10; -+ dfs->pri_cnt_th = 2; -+ dfs->loct_diff_th = 15; -+ dfs->dc_cnt_th = 3; -+ -+ /*@for dynamic dfs*/ -+ dfs->pwdb_th = 8; -+ dfs->fa_mask_th = 120 * dfs->dfs_polling_time / 100; -+ dfs->st_l2h_min = 0x20; -+ dfs->st_l2h_max = 0x4e; -+ dfs->pwdb_scalar_factor = 12; -+ -+ /*@for dfs histogram*/ -+ dfs->pri_hist_th = 5; -+ dfs->pri_sum_g1_th = 9; -+ dfs->pri_sum_g5_th = 5; -+ dfs->pri_sum_g1_fcc_th = 4; /*@FCC Type6*/ -+ dfs->pri_sum_g3_fcc_th = 6; -+ dfs->pri_sum_safe_th = 50; -+ dfs->pri_sum_safe_fcc_th = 110; /*@30 for AP*/ -+ dfs->pri_sum_type4_th = 16; -+ dfs->pri_sum_type6_th = 12; -+ dfs->pri_sum_g5_under_g1_th = 4; -+ dfs->pri_pw_diff_th = 4; -+ dfs->pri_pw_diff_fcc_th = 8; -+ dfs->pri_pw_diff_fcc_idle_th = 2; -+ dfs->pri_pw_diff_w53_th = 10; -+ dfs->pw_std_th = 7; /*@FCC Type4*/ -+ dfs->pw_std_idle_th = 10; -+ dfs->pri_std_th = 6; /*@FCC Type3,4,6*/ -+ dfs->pri_std_idle_th = 10; -+ dfs->pri_type1_upp_fcc_th = 110; -+ dfs->pri_type1_low_fcc_th = 50; -+ dfs->pri_type1_cen_fcc_th = 70; -+ dfs->pw_g0_th = 8; -+ dfs->pw_long_lower_th = 6; /*@7->6*/ -+ dfs->pri_long_upper_th = 30; -+ dfs->pw_long_lower_20m_th = 7; /*@7 for AP*/ -+ dfs->pw_long_sum_upper_th = 60; -+ dfs->type4_pw_max_cnt = 7; -+ dfs->type4_safe_pri_sum_th = 5; -+} -+ -+void phydm_dfs_dynamic_setting( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ -+ u8 peak_th_cur = 0, short_pulse_cnt_th_cur = 0; -+ u8 long_pulse_cnt_th_cur = 0, three_peak_opt_cur = 0; -+ u8 three_peak_th2_cur = 0; -+ u8 peak_window_cur = 0; -+ u8 region_domain = dm->dfs_region_domain; -+ u8 c_channel = *dm->channel; -+ -+ if (dm->rx_tp + dm->tx_tp <= 2) { -+ dfs->idle_mode = 1; -+ if (dfs->force_TP_mode) -+ dfs->idle_mode = 0; -+ } else { -+ dfs->idle_mode = 0; -+ } -+ -+ if (dfs->idle_mode == 1) { /*@idle (no traffic)*/ -+ peak_th_cur = 3; -+ short_pulse_cnt_th_cur = 6; -+ long_pulse_cnt_th_cur = 9; -+ peak_window_cur = 2; -+ three_peak_opt_cur = 0; -+ three_peak_th2_cur = 2; -+ if (region_domain == PHYDM_DFS_DOMAIN_MKK) { -+ if (c_channel >= 52 && c_channel <= 64) { -+ short_pulse_cnt_th_cur = 14; -+ long_pulse_cnt_th_cur = 15; -+ three_peak_th2_cur = 0; -+ } else { -+ short_pulse_cnt_th_cur = 6; -+ three_peak_th2_cur = 0; -+ long_pulse_cnt_th_cur = 10; -+ } -+ } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { -+ three_peak_th2_cur = 0; -+ } else if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { -+ long_pulse_cnt_th_cur = 15; -+ if (phydm_dfs_is_meteorology_channel(dm)) { -+ /*need to add check cac end condition*/ -+ peak_th_cur = 2; -+ three_peak_opt_cur = 0; -+ three_peak_th2_cur = 0; -+ short_pulse_cnt_th_cur = 7; -+ } else { -+ three_peak_opt_cur = 0; -+ three_peak_th2_cur = 0; -+ short_pulse_cnt_th_cur = 7; -+ } -+ } else /*@default: FCC*/ -+ three_peak_th2_cur = 0; -+ -+ } else { /*@in service (with TP)*/ -+ peak_th_cur = 2; -+ short_pulse_cnt_th_cur = 6; -+ long_pulse_cnt_th_cur = 7; -+ peak_window_cur = 2; -+ three_peak_opt_cur = 0; -+ three_peak_th2_cur = 2; -+ if (region_domain == PHYDM_DFS_DOMAIN_MKK) { -+ if (c_channel >= 52 && c_channel <= 64) { -+ long_pulse_cnt_th_cur = 15; -+ /*@for high duty cycle*/ -+ short_pulse_cnt_th_cur = 5; -+ three_peak_th2_cur = 0; -+ } else { -+ three_peak_opt_cur = 0; -+ three_peak_th2_cur = 0; -+ long_pulse_cnt_th_cur = 8; -+ } -+ } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { -+ long_pulse_cnt_th_cur = 5; /*for 80M FCC*/ -+ short_pulse_cnt_th_cur = 5; /*for 80M FCC*/ -+ } else if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { -+ long_pulse_cnt_th_cur = 15; -+ short_pulse_cnt_th_cur = 5; -+ three_peak_opt_cur = 0; -+ } -+ } -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ /* -+ if (dfs->peak_th != peak_th_cur) -+ odm_set_bb_reg(dm, R_0xa48, 0x00c00000, peak_th_cur); -+ if (dfs->short_pulse_cnt_th != short_pulse_cnt_th_cur) -+ odm_set_bb_reg(dm, R_0xa50, 0x00f00000, -+ short_pulse_cnt_th_cur); -+ if (dfs->long_pulse_cnt_th != long_pulse_cnt_th_cur) -+ odm_set_bb_reg(dm, R_0xa4c, 0xf0000000, -+ long_pulse_cnt_th_cur); -+ if (dfs->peak_window != peak_window_cur) -+ odm_set_bb_reg(dm, R_0xa40, 0x00030000, -+ peak_window_cur); -+ if (dfs->three_peak_opt != three_peak_opt_cur) -+ odm_set_bb_reg(dm, R_0xa40, 0x30000000, -+ three_peak_opt_cur); -+ if (dfs->three_peak_th2 != three_peak_th2_cur) -+ odm_set_bb_reg(dm, R_0xa44, 0x00000007, -+ three_peak_th2_cur); -+ */ -+ #if (RTL8721D_SUPPORT) -+ } else if (dm->support_ic_type & (ODM_RTL8721D)) { -+ if (dfs->peak_th != peak_th_cur) -+ odm_set_bb_reg(dm, R_0xf5c, 0x00000030, peak_th_cur); -+ if (dfs->short_pulse_cnt_th != short_pulse_cnt_th_cur) -+ odm_set_bb_reg(dm, R_0xf70, 0x00007800, -+ short_pulse_cnt_th_cur); -+ if (dfs->long_pulse_cnt_th != long_pulse_cnt_th_cur) -+ odm_set_bb_reg(dm, R_0xf74, 0x0000000f, -+ long_pulse_cnt_th_cur); -+ if (dfs->peak_window != peak_window_cur) -+ odm_set_bb_reg(dm, R_0xf58, 0x18000000, -+ peak_window_cur); -+ if (dfs->three_peak_opt != three_peak_opt_cur) -+ odm_set_bb_reg(dm, R_0xf58, 0x00030000, -+ three_peak_opt_cur); -+ if (dfs->three_peak_th2 != three_peak_th2_cur) -+ odm_set_bb_reg(dm, R_0xf58, 0x00007c00, -+ three_peak_th2_cur); -+ #endif -+ } else { -+ if (dfs->peak_th != peak_th_cur) -+ odm_set_bb_reg(dm, R_0x918, 0x00030000, peak_th_cur); -+ if (dfs->short_pulse_cnt_th != short_pulse_cnt_th_cur) -+ odm_set_bb_reg(dm, R_0x920, 0x000f0000, -+ short_pulse_cnt_th_cur); -+ if (dfs->long_pulse_cnt_th != long_pulse_cnt_th_cur) -+ odm_set_bb_reg(dm, R_0x920, 0x00f00000, -+ long_pulse_cnt_th_cur); -+ if (dfs->peak_window != peak_window_cur) -+ odm_set_bb_reg(dm, R_0x920, 0x00000300, -+ peak_window_cur); -+ if (dfs->three_peak_opt != three_peak_opt_cur) -+ odm_set_bb_reg(dm, R_0x924, 0x00000180, -+ three_peak_opt_cur); -+ if (dfs->three_peak_th2 != three_peak_th2_cur) -+ odm_set_bb_reg(dm, R_0x924, 0x00007000, -+ three_peak_th2_cur); -+ } -+ -+ dfs->peak_th = peak_th_cur; -+ dfs->short_pulse_cnt_th = short_pulse_cnt_th_cur; -+ dfs->long_pulse_cnt_th = long_pulse_cnt_th_cur; -+ dfs->peak_window = peak_window_cur; -+ dfs->three_peak_opt = three_peak_opt_cur; -+ dfs->three_peak_th2 = three_peak_th2_cur; -+} -+ -+boolean -+phydm_radar_detect_dm_check( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ u8 region_domain = dm->dfs_region_domain, index = 0; -+ -+ u16 i = 0, j = 0, fa_count_cur = 0, fa_count_inc = 0; -+ u16 total_fa_in_hist = 0, total_pulse_count_inc = 0; -+ u16 short_pulse_cnt_inc = 0, short_pulse_cnt_cur = 0; -+ u16 long_pulse_cnt_inc = 0, long_pulse_cnt_cur = 0; -+ u32 regf98_value = 0, reg918_value = 0, reg91c_value = 0; -+ u32 reg920_value = 0, reg924_value = 0, radar_rpt_reg_value = 0; -+ u32 regf54_value = 0, regf58_value = 0, regf5c_value = 0; -+ u32 regdf4_value = 0, regf70_value = 0, regf74_value = 0; -+ #if (RTL8812F_SUPPORT || RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8723F_SUPPORT) -+ u32 rega40_value = 0, rega44_value = 0, rega48_value = 0; -+ u32 rega4c_value = 0, rega50_value = 0, rega54_value = 0; -+ u32 reg_2e08 = 0, reg_2e24 = 0, reg_2e28 = 0; -+ u32 reg_2e2c = 0, reg_2e30 = 0, reg_2e34 = 0; -+ u32 reg_2e0c = 0, reg_2e10 = 0, reg_2e20 = 0; -+ #endif -+ #if (RTL8721D_SUPPORT) -+ u32 reg908_value = 0, regdf4_value = 0; -+ u32 regf54_value = 0, regf58_value = 0, regf5c_value = 0; -+ u32 regf70_value = 0, regf74_value = 0; -+ #endif -+ boolean tri_short_pulse = 0, tri_long_pulse = 0, radar_type = 0; -+ boolean fault_flag_det = 0, fault_flag_psd = 0, fa_flag = 0; -+ boolean radar_detected = 0; -+ u8 st_l2h_new = 0, fa_mask_th = 0, k = 0, sum = 0; -+ u8 c_channel = *dm->channel; -+ -+ /*@Get FA count during past 100ms, R_0xf48 for AC series*/ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ /*fa_count_cur = (u16)odm_get_bb_reg(dm, R_0x2d00, MASKLWORD);*/ -+ /*1-sec period*/ -+ fa_count_cur = (u16)(fa_t->cnt_all * dfs->dfs_polling_time / 1000); -+ #if (RTL8721D_SUPPORT) -+ else if (dm->support_ic_type & (ODM_RTL8721D)) { -+ fa_count_cur = (u16)odm_get_bb_reg(dm, -+ ODM_REG_OFDM_FA_TYPE2_11N, -+ MASKHWORD); -+ fa_count_cur += (u16)odm_get_bb_reg(dm, -+ ODM_REG_OFDM_FA_TYPE3_11N, -+ MASKLWORD); -+ fa_count_cur += (u16)odm_get_bb_reg(dm, -+ ODM_REG_OFDM_FA_TYPE3_11N, -+ MASKHWORD); -+ fa_count_cur += (u16)odm_get_bb_reg(dm, -+ ODM_REG_OFDM_FA_TYPE4_11N, -+ MASKLWORD); -+ fa_count_cur += (u16)odm_get_bb_reg(dm, -+ ODM_REG_OFDM_FA_TYPE1_11N, -+ MASKLWORD); -+ fa_count_cur += (u16)odm_get_bb_reg(dm, -+ ODM_REG_OFDM_FA_TYPE1_11N, -+ MASKHWORD); -+ } -+ #endif -+ else -+ fa_count_cur = (u16)odm_get_bb_reg(dm, R_0xf48, 0x0000ffff); -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) { -+ if (dfs->fa_count_pre == 0) -+ fa_count_inc = 0; -+ else if (fa_count_cur >= dfs->fa_count_pre) -+ fa_count_inc = fa_count_cur - dfs->fa_count_pre; -+ else -+ fa_count_inc = fa_count_cur; -+ dfs->fa_count_pre = fa_count_cur; -+ } else { -+ fa_count_inc = fa_count_cur; -+ } -+ -+ for (i = 0; i < 5; i++) -+ total_fa_in_hist = total_fa_in_hist + dfs->fa_inc_hist[i]; -+ -+ if (dfs->mask_idx >= 2) -+ index = dfs->mask_idx - 2; -+ else -+ index = 5 + dfs->mask_idx - 2; -+ -+ if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8822C | ODM_RTL8812F | -+ ODM_RTL8197G| ODM_RTL8723F)) { -+ radar_rpt_reg_value = odm_get_bb_reg(dm, R_0x2e00, 0xffffffff); -+ short_pulse_cnt_cur = (u16)((radar_rpt_reg_value & 0x000ff800) -+ >> 11); -+ long_pulse_cnt_cur = (u16)((radar_rpt_reg_value & 0x0fc00000) -+ >> 22); -+ #if (RTL8721D_SUPPORT) -+ } else if (dm->support_ic_type & (ODM_RTL8721D)) { -+ reg908_value = (u32)odm_get_bb_reg(dm, R_0x908, MASKDWORD); -+ odm_set_bb_reg(dm, R_0x908, MASKDWORD, 0x254); -+ regdf4_value = odm_get_bb_reg(dm, R_0xdf4, MASKDWORD); -+ short_pulse_cnt_cur = (u16)((regdf4_value & 0x000ff000) >> 12); -+ long_pulse_cnt_cur = (u16)((regdf4_value & 0x0fc00000) >> 22); -+ -+ tri_short_pulse = (regdf4_value & BIT(20)) ? 1 : 0; -+ tri_long_pulse = (regdf4_value & BIT(28)) ? 1 : 0; -+ if (tri_short_pulse || tri_long_pulse) { -+ odm_set_bb_reg(dm, R_0xf58, BIT(29), 0); -+ odm_set_bb_reg(dm, R_0xf58, BIT(29), 1); -+ } -+ #endif -+ } else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (dm->seg1_dfs_flag == 1) -+ radar_rpt_reg_value = odm_get_bb_reg(dm, R_0x2e20, -+ 0xffffffff); -+ else -+ radar_rpt_reg_value = odm_get_bb_reg(dm, R_0x2e00, -+ 0xffffffff); -+ short_pulse_cnt_cur = (u16)((radar_rpt_reg_value & 0x000ff800) -+ >> 11); -+ long_pulse_cnt_cur = (u16)((radar_rpt_reg_value & 0x0fc00000) -+ >> 22); -+ } else { -+ regf98_value = odm_get_bb_reg(dm, R_0xf98, 0xffffffff); -+ short_pulse_cnt_cur = (u16)(regf98_value & 0x000000ff); -+ long_pulse_cnt_cur = (u16)((regf98_value & 0x0000ff00) >> 8); -+ } -+ -+ /*@Get short pulse count, need carefully handle the counter overflow*/ -+ if (short_pulse_cnt_cur >= dfs->short_pulse_cnt_pre) { -+ short_pulse_cnt_inc = short_pulse_cnt_cur - -+ dfs->short_pulse_cnt_pre; -+ } else { -+ short_pulse_cnt_inc = short_pulse_cnt_cur; -+ } -+ dfs->short_pulse_cnt_pre = short_pulse_cnt_cur; -+ -+ /*@Get long pulse count, need carefully handle the counter overflow*/ -+ if (long_pulse_cnt_cur >= dfs->long_pulse_cnt_pre) { -+ long_pulse_cnt_inc = long_pulse_cnt_cur - -+ dfs->long_pulse_cnt_pre; -+ } else { -+ long_pulse_cnt_inc = long_pulse_cnt_cur; -+ } -+ dfs->long_pulse_cnt_pre = long_pulse_cnt_cur; -+ -+ total_pulse_count_inc = short_pulse_cnt_inc + long_pulse_cnt_inc; -+ -+ if (dfs->det_print) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "===============================================\n"); -+ PHYDM_DBG(dm, DBG_DFS, "FA_count_inc[%d]\n", fa_count_inc); -+ if (dm->support_ic_type & (ODM_RTL8721D)) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "Init_Gain[%x] st_l2h_cur[%x] 0xdf4[%08x] short_pulse_cnt_inc[%d] long_pulse_cnt_inc[%d]\n", -+ dfs->igi_cur, dfs->st_l2h_cur, regdf4_value, -+ short_pulse_cnt_inc, long_pulse_cnt_inc); -+ regf54_value = odm_get_bb_reg(dm, R_0xf54, MASKDWORD); -+ regf58_value = odm_get_bb_reg(dm, R_0xf58, MASKDWORD); -+ regf5c_value = odm_get_bb_reg(dm, R_0xf5c, MASKDWORD); -+ regf70_value = odm_get_bb_reg(dm, R_0xf70, MASKDWORD); -+ regf74_value = odm_get_bb_reg(dm, R_0xf74, MASKDWORD); -+ PHYDM_DBG(dm, DBG_DFS, -+ "0xf54[%08x] 0xf58[%08x] 0xf5c[%08x] 0xf70[%08x] 0xf74[%08x]\n", -+ regf54_value, regf58_value, regf5c_value, -+ regf70_value, regf74_value); -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "Init_Gain[%x] st_l2h_cur[%x] 0x2dbc[%08x] short_pulse_cnt_inc[%d] long_pulse_cnt_inc[%d]\n", -+ dfs->igi_cur, dfs->st_l2h_cur, -+ radar_rpt_reg_value, short_pulse_cnt_inc, -+ long_pulse_cnt_inc); -+ #if (RTL8812F_SUPPORT || RTL8822C_SUPPORT || RTL8814B_SUPPORT) -+ rega40_value = odm_get_bb_reg(dm, R_0xa40, MASKDWORD); -+ rega44_value = odm_get_bb_reg(dm, R_0xa44, MASKDWORD); -+ rega48_value = odm_get_bb_reg(dm, R_0xa48, MASKDWORD); -+ rega4c_value = odm_get_bb_reg(dm, R_0xa4c, MASKDWORD); -+ rega50_value = odm_get_bb_reg(dm, R_0xa50, MASKDWORD); -+ rega54_value = odm_get_bb_reg(dm, R_0xa54, MASKDWORD); -+ PHYDM_DBG(dm, DBG_DFS, -+ "0xa40[%08x] 0xa44[%08x] 0xa48[%08x] 0xa4c[%08x] 0xa50[%08x] 0xa54[%08x]\n", -+ rega40_value, rega44_value, rega48_value, -+ rega4c_value, rega50_value, rega54_value); -+ #endif -+ } else { -+ PHYDM_DBG(dm, DBG_DFS, -+ "Init_Gain[%x] 0x91c[%x] 0xf98[%08x] short_pulse_cnt_inc[%d] long_pulse_cnt_inc[%d]\n", -+ dfs->igi_cur, dfs->st_l2h_cur, regf98_value, -+ short_pulse_cnt_inc, long_pulse_cnt_inc); -+ reg918_value = odm_get_bb_reg(dm, R_0x918, -+ 0xffffffff); -+ reg91c_value = odm_get_bb_reg(dm, R_0x91c, -+ 0xffffffff); -+ reg920_value = odm_get_bb_reg(dm, R_0x920, -+ 0xffffffff); -+ reg924_value = odm_get_bb_reg(dm, R_0x924, -+ 0xffffffff); -+ PHYDM_DBG(dm, DBG_DFS, -+ "0x918[%08x] 0x91c[%08x] 0x920[%08x] 0x924[%08x]\n", -+ reg918_value, reg91c_value, -+ reg920_value, reg924_value); -+ } -+ PHYDM_DBG(dm, DBG_DFS, "Throughput: %dMbps\n", -+ (dm->rx_tp + dm->tx_tp)); -+ -+ PHYDM_DBG(dm, DBG_DFS, -+ "dfs_regdomain = %d, dbg_mode = %d, idle_mode = %d, print_hist_rpt = %d, hist_cond_on = %d\n", -+ region_domain, dfs->dbg_mode, -+ dfs->idle_mode, dfs->print_hist_rpt, -+ dfs->hist_cond_on); -+ } -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ tri_short_pulse = (radar_rpt_reg_value & BIT(20)) ? 1 : 0; -+ tri_long_pulse = (radar_rpt_reg_value & BIT(28)) ? 1 : 0; -+ } else { -+ tri_short_pulse = (regf98_value & BIT(17)) ? 1 : 0; -+ tri_long_pulse = (regf98_value & BIT(19)) ? 1 : 0; -+ } -+ -+ if (tri_long_pulse){ -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ PHYDM_DBG(dm, DBG_DFS, "tri_long_pulse = %d\n", tri_long_pulse); -+ dfs->pulse_flag_hist[dfs->mask_idx] = 1; -+ dfs->pulse_type_hist[dfs->mask_idx] = 1; -+ } -+ -+ else if (tri_short_pulse){ -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ PHYDM_DBG(dm, DBG_DFS, "tri_short_pulse = %d\n", tri_short_pulse); -+ dfs->pulse_flag_hist[dfs->mask_idx] = 1; -+ dfs->pulse_type_hist[dfs->mask_idx] = 0; -+ } -+ -+ else{ -+ dfs->pulse_flag_hist[dfs->mask_idx] = 0; -+ dfs->pulse_type_hist[dfs->mask_idx] = 0; -+ } -+ -+ -+ -+ if (tri_short_pulse) { -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ phydm_radar_detect_reset(dm); -+ } -+ if (tri_long_pulse) { -+ /* -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ phydm_radar_detect_reset(dm); -+ */ -+ if (region_domain == PHYDM_DFS_DOMAIN_MKK) { -+ if (c_channel >= 52 && c_channel <= 64) { -+ tri_long_pulse = 0; -+ } -+ } -+ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { -+ tri_long_pulse = 0; -+ } -+ } -+ -+ st_l2h_new = dfs->st_l2h_cur; -+#if (RTL8723F_SUPPORT||RTL8822C_SUPPORT) -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ if (dfs->pulse_type_hist[dfs->mask_idx]) -+ dfs->radar_type = 1; -+ else -+ dfs->radar_type = 0; -+ -+ if (dfs->pulse_flag_hist[dfs->mask_idx]) { -+ if (dfs->det_jar3_en) -+ phydm_dfs_rpt_distinguish(dm); -+ phydm_radar_detect_reset(dm); -+ } -+ } -+#endif -+ -+ /* PSD(not ready) */ -+ -+ fault_flag_det = 0; -+ fault_flag_psd = 0; -+ fa_flag = 0; -+ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { -+ fa_mask_th = dfs->fa_mask_th + 20; -+ } else { -+ fa_mask_th = dfs->fa_mask_th; -+ } -+ if (total_fa_in_hist >= fa_mask_th || dfs->igi_cur >= 0x30) { -+ /* st_l2h_new = dfs->st_l2h_max; */ -+ dfs->radar_det_mask_hist[index] = 1; -+ if (dfs->pulse_flag_hist[index] == 1) { -+ dfs->pulse_flag_hist[index] = 0; -+ if (dfs->det_print2) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "Radar is masked : FA mask\n"); -+ } -+ } -+ fa_flag = 1; -+ } else { -+ dfs->radar_det_mask_hist[index] = 0; -+ } -+ -+ if (dfs->det_print) { -+ PHYDM_DBG(dm, DBG_DFS, "mask_idx: %d\n", dfs->mask_idx); -+ PHYDM_DBG(dm, DBG_DFS, "radar_det_mask_hist: "); -+ for (i = 0; i < 5; i++) -+ PHYDM_DBG(dm, DBG_DFS, "%d ", -+ dfs->radar_det_mask_hist[i]); -+ PHYDM_DBG(dm, DBG_DFS, "pulse_flag_hist: "); -+ for (i = 0; i < 5; i++) -+ PHYDM_DBG(dm, DBG_DFS, "%d ", dfs->pulse_flag_hist[i]); -+ PHYDM_DBG(dm, DBG_DFS, "fa_inc_hist: "); -+ for (i = 0; i < 5; i++) -+ PHYDM_DBG(dm, DBG_DFS, "%d ", dfs->fa_inc_hist[i]); -+ PHYDM_DBG(dm, DBG_DFS, -+ "\nfa_mask_th: %d, total_fa_in_hist: %d ", -+ fa_mask_th, total_fa_in_hist); -+ } -+ -+ sum = 0; -+ for (k = 0; k < 5; k++) { -+ if (dfs->radar_det_mask_hist[k] == 1) -+ sum++; -+ } -+ -+ if (dfs->mask_hist_checked <= 5) -+ dfs->mask_hist_checked++; -+ -+ if (dfs->mask_hist_checked >= 5 && dfs->pulse_flag_hist[dfs->mask_idx]) { -+ if (sum <= 2) { -+ if (dfs->hist_cond_on) { -+ /*return the value from hist_radar_detected*/ -+ radar_detected = phydm_dfs_hist_log(dm, index); -+ } else if (dfs->det_jar3_en) { -+ if (dfs->nhm_dfs_flag || dfs->b_flag) { -+ radar_detected = false; -+ } else if (dfs->pw_flag && dfs->pri_flag && -+ dfs->loct_flag) { -+ PHYDM_DBG(dm, DBG_DFS, "Detected type %d radar signal!\n", -+ dfs->radar_type); -+ radar_detected = true; -+ } -+ } else { -+ if (dfs->pulse_type_hist[dfs->mask_idx] == 0) -+ dfs->radar_type = 0; -+ else if (dfs->pulse_type_hist[dfs->mask_idx] == 1) -+ dfs->radar_type = 1; -+ radar_detected = true; -+ PHYDM_DBG(dm, DBG_DFS, -+ "Detected type %d radar signal!\n", -+ dfs->radar_type); -+ } -+ } else { -+ fault_flag_det = 1; -+ if (dfs->det_print2) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "Radar is masked : mask_hist large than thd\n"); -+ } -+ } -+ } -+ -+ dfs->mask_idx++; -+ if (dfs->mask_idx == 5) -+ dfs->mask_idx = 0; -+ -+ if (fault_flag_det == 0 && fault_flag_psd == 0 && fa_flag == 0) { -+ if (dfs->igi_cur < 0x30) { -+ st_l2h_new = dfs->st_l2h_min; -+ } -+ } -+ -+ if (st_l2h_new != dfs->st_l2h_cur) { -+ if (st_l2h_new < dfs->st_l2h_min) { -+ dfs->st_l2h_cur = dfs->st_l2h_min; -+ } else if (st_l2h_new > dfs->st_l2h_max) -+ dfs->st_l2h_cur = dfs->st_l2h_max; -+ else -+ dfs->st_l2h_cur = st_l2h_new; -+ /*odm_set_bb_reg(dm, R_0x91c, 0xff, dfs->st_l2h_cur);*/ -+ -+ dfs->pwdb_th_cur = ((int)dfs->st_l2h_cur - (int)dfs->igi_cur) -+ / 2 + dfs->pwdb_scalar_factor; -+ -+ /*@limit the pwdb value to absolute lower bound 8*/ -+ dfs->pwdb_th_cur = MAX_2(dfs->pwdb_th_cur, (int)dfs->pwdb_th); -+ -+ /*@limit the pwdb value to absolute upper bound 0x1f*/ -+ dfs->pwdb_th_cur = MIN_2(dfs->pwdb_th_cur, 0x1f); -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ odm_set_bb_reg(dm, R_0xa50, 0x000000f0, -+ dfs->pwdb_th_cur); -+ #if (RTL8721D_SUPPORT) -+ else if (dm->support_ic_type & ODM_RTL8721D) { -+ odm_set_bb_reg(dm, R_0xf54, 0x0000001f, -+ ((dfs->st_l2h_cur & 0x0000007c) >> 2)); -+ odm_set_bb_reg(dm, R_0xf58, 0xc0000000, -+ (dfs->st_l2h_cur & 0x00000003)); -+ odm_set_bb_reg(dm, R_0xf70, 0x03c00000, -+ dfs->pwdb_th_cur); -+ } -+ #endif -+ else -+ odm_set_bb_reg(dm, R_0x918, 0x00001f00, -+ dfs->pwdb_th_cur); -+ } -+ -+ if (dfs->det_print) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "fault_flag_det[%d], fault_flag_psd[%d], DFS_detected [%d]\n", -+ fault_flag_det, fault_flag_psd, radar_detected); -+ } -+ #if (RTL8721D_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8721D)) -+ odm_set_bb_reg(dm, R_0x908, MASKDWORD, reg908_value); -+ #endif -+ -+ return radar_detected; -+} -+#if (RTL8723F_SUPPORT || RTL8822C_SUPPORT) -+void phydm_dfs_rpt_distinguish(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ -+ u8 region_domain = dm->dfs_region_domain; -+ u8 c_channel = *dm->channel; -+ u8 band_width = *dm->band_width; -+ -+ u32 reg_2e08, reg_2e24, reg_2e28, reg_2e2c, reg_2e30, reg_2e34; -+ u32 reg_2e0c, reg_2e10, reg_2e20; -+ u16 pw_rpt_set[12] = {0}, pri_rpt_set[12] = {0}; -+ s8 loct_rpt_set[12] = {0}; -+ u8 pw_lth[10] = {255,255,255,255,255,255,255,255,255,255}; -+ u16 pw_uth[10] = {255,255,255,255,255,255,255,255,255,255}; -+ u8 pri_lth[10] = {255,255,255,255,255,255,255,255,255,255}; -+ u8 pri_uth[10] = {255,255,255,255,255,255,255,255,255,255}; -+ u8 pri_vd_max = 0, pri_vd_min = 255, rdr_tmp = 0; -+ u8 i, j, dc_cnt = 0, rdr_num = 0, rdr_cnt[10] = {0}; -+ u8 short_cnt_th, long_cnt_th, loop_cnt, cnt_th, loct_diff = 0; -+ u8 pri_var_up, pri_var_low, pri_cnt_tmp, pri_cnt_fnl = 0; -+ u8 pri_cnt_th = dfs->pri_cnt_th; -+ -+ /* PW : Wordlength : U(8,0) , unit: 400ns */ -+ reg_2e08 = odm_get_bb_reg(dm, 0x2e08, 0xffffffff); -+ pw_rpt_set[0]=(unsigned int)(reg_2e08 & 0x000000ff); -+ pw_rpt_set[1]=(unsigned int)((reg_2e08 & 0x0000ff00)>>8); -+ pw_rpt_set[2]=(unsigned int)((reg_2e08 & 0x00ff0000)>>16); -+ pw_rpt_set[3]=(unsigned int)((reg_2e08 & 0xff000000)>>24); -+ reg_2e24 = odm_get_bb_reg(dm, 0x2e24, 0xffffffff); -+ pw_rpt_set[4]=(unsigned int)(reg_2e24 & 0x000000ff); -+ pw_rpt_set[5]=(unsigned int)((reg_2e24 & 0x0000ff00)>>8); -+ pw_rpt_set[6]=(unsigned int)((reg_2e24 & 0x00ff0000)>>16); -+ pw_rpt_set[7]=(unsigned int)((reg_2e24 & 0xff000000)>>24); -+ reg_2e28 = odm_get_bb_reg(dm, 0x2e28, 0xffffffff); -+ pw_rpt_set[8]=(unsigned int)(reg_2e28 & 0x000000ff); -+ pw_rpt_set[9]=(unsigned int)((reg_2e28 & 0x0000ff00)>>8); -+ pw_rpt_set[10]=(unsigned int)((reg_2e28 & 0x00ff0000)>>16); -+ pw_rpt_set[11]=(unsigned int)((reg_2e28 & 0xff000000)>>24); -+ -+ /* PRI : Wordlength : U(8,0) , unit: 25.6us */ -+ reg_2e2c = odm_get_bb_reg(dm, 0x2e2c, 0xffffffff); -+ pri_rpt_set[0]=(unsigned int)(reg_2e2c & 0x000000ff); -+ pri_rpt_set[1]=(unsigned int)((reg_2e2c & 0x0000ff00)>>8); -+ pri_rpt_set[2]=(unsigned int)((reg_2e2c & 0x00ff0000)>>16); -+ pri_rpt_set[3]=(unsigned int)((reg_2e2c & 0xff000000)>>24); -+ reg_2e30 = odm_get_bb_reg(dm, 0x2e30, 0xffffffff); -+ pri_rpt_set[4]=(unsigned int)(reg_2e30 & 0x000000ff); -+ pri_rpt_set[5]=(unsigned int)((reg_2e30 & 0x0000ff00)>>8); -+ pri_rpt_set[6]=(unsigned int)((reg_2e30 & 0x00ff0000)>>16); -+ pri_rpt_set[7]=(unsigned int)((reg_2e30 & 0xff000000)>>24); -+ reg_2e34 = odm_get_bb_reg(dm, 0x2e34, 0xffffffff); -+ pri_rpt_set[8]=(unsigned int)(reg_2e34 & 0x000000ff); -+ pri_rpt_set[9]=(unsigned int)((reg_2e34 & 0x0000ff00)>>8); -+ pri_rpt_set[10]=(unsigned int)((reg_2e34 & 0x00ff0000)>>16); -+ pri_rpt_set[11]=(unsigned int)((reg_2e34 & 0xff000000)>>24); -+ -+ /* Location : Wordlength : S(8,0) , unit: MHz */ -+ reg_2e0c = odm_get_bb_reg(dm, 0x2e0c, 0xffffffff); -+ loct_rpt_set[0]=(signed char)(reg_2e0c & 0x000000ff); -+ loct_rpt_set[1]=(signed char)((reg_2e0c & 0x0000ff00)>>8); -+ loct_rpt_set[2]=(signed char)((reg_2e0c & 0x00ff0000)>>16); -+ loct_rpt_set[3]=(signed char)((reg_2e0c & 0xff000000)>>24); -+ reg_2e10 = odm_get_bb_reg(dm, 0x2e10, 0xffffffff); -+ loct_rpt_set[4]=(signed char)(reg_2e10 & 0x000000ff); -+ loct_rpt_set[5]=(signed char)((reg_2e10 & 0x0000ff00)>>8); -+ loct_rpt_set[6]=(signed char)((reg_2e10 & 0x00ff0000)>>16); -+ loct_rpt_set[7]=(signed char)((reg_2e10 & 0xff000000)>>24); -+ reg_2e20 = odm_get_bb_reg(dm, 0x2e20, 0xffffffff); -+ loct_rpt_set[8]=(signed char)(reg_2e20 & 0x000000ff); -+ loct_rpt_set[9]=(signed char)((reg_2e20 & 0x0000ff00)>>8); -+ loct_rpt_set[10]=(signed char)((reg_2e20 & 0x00ff0000)>>16); -+ loct_rpt_set[11]=(signed char)((reg_2e20 & 0xff000000)>>24); -+ -+ dfs->pw_flag = false; -+ dfs->loct_flag = false; -+ dfs->pri_flag = false; -+ for (i = 0; i < 12; i++) { -+ dfs->pw_rslt[i] = 0; -+ dfs->loct_rslt[i] = 0; -+ dfs->pri_rslt[i] = 0; -+ } -+ -+ // for NHMxDFS // -+ dfs->nhm_dfs_cnt = 0; -+ dfs->nhm_dfs_flag = false; -+ dfs->b_flag = false; -+ -+ short_cnt_th = (u8)odm_get_bb_reg(dm, 0xa50, 0x00f00000); -+ long_cnt_th = (u8)odm_get_bb_reg(dm, 0xa4c, 0xf0000000); -+ -+ if (dfs->radar_type) -+ loop_cnt = long_cnt_th + 2; -+ else -+ loop_cnt = short_cnt_th + 2; -+ -+ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) -+ loop_cnt = short_cnt_th + 2; -+ -+ if (loop_cnt > 12) -+ loop_cnt = 12; -+ -+ cnt_th = loop_cnt / 2; -+ -+ /* Calculate the difference between each element (1st Not calculated) */ -+ for(i = 0; i < loop_cnt; i++) -+ dfs->loct_rslt[i] = loct_rpt_set[i]; -+ for(i = 1; i < loop_cnt; i++) -+ loct_diff = loct_diff + abs(dfs->loct_rslt[i] - dfs->loct_rslt[i-1]); -+ -+ for (i = 0; i < loop_cnt; i++) { -+ if ((-2 < loct_rpt_set[i]) && (loct_rpt_set[i] < 2)) -+ dc_cnt++; -+ } -+ -+ if (region_domain == PHYDM_DFS_DOMAIN_FCC){ -+ rdr_num = 7; -+ -+ pw_lth[0]=2; -+ pw_lth[1]=2; -+ pw_lth[2]=2; -+ pw_lth[3]=12; -+ pw_lth[4]=22; -+ pw_lth[5]=120; -+ pw_lth[6]=2; -+ -+ pw_uth[0]=3; -+ pw_uth[1]=3; -+ pw_uth[2]=15; -+ pw_uth[3]=30; -+ pw_uth[4]=60; -+ pw_uth[5]=253; -+ pw_uth[6]=3; -+ -+ pri_lth[0]=50; -+ pri_lth[1]=18; -+ pri_lth[2]=5; -+ pri_lth[3]=7; -+ pri_lth[4]=7; -+ pri_lth[5]=38; -+ pri_lth[6]=11; -+ -+ pri_uth[0]=62; -+ pri_uth[1]=130; -+ pri_uth[2]=10; -+ pri_uth[3]=21; -+ pri_uth[4]=21; -+ pri_uth[5]=80; -+ pri_uth[6]=15; -+ if (dc_cnt > dfs->dc_cnt_th){ -+ pw_lth[0] = 0; -+ pw_lth[1] = 0; -+ pw_lth[2] = 0; -+ pw_lth[3] = 0; -+ pw_lth[4] = 0; -+ pw_lth[5] = 80; -+ pw_lth[6] = 0; -+ } -+ } -+ else if (region_domain == PHYDM_DFS_DOMAIN_MKK){ -+ rdr_num = 8; -+ if (c_channel >= 52 && c_channel <= 64){ -+ dfs->loct_diff_th = dfs->loct_diff_th + 15; -+ pw_lth[0]=1; -+ pw_lth[1]=1; -+ pw_lth[2]=1; -+ pw_lth[3]=1; -+ pw_lth[4]=1; -+ pw_lth[5]=1; -+ pw_lth[6]=1; -+ pw_lth[7]=1; -+ -+ pw_uth[0]=14; -+ pw_uth[1]=40; -+ pw_uth[2]=14; -+ pw_uth[3]=40; -+ pw_uth[4]=5; -+ pw_uth[5]=5; -+ pw_uth[6]=5; -+ pw_uth[7]=5; -+ -+ pri_lth[0]=35; -+ pri_lth[1]=20; -+ pri_lth[2]=35; -+ pri_lth[3]=18; -+ pri_lth[4]=32; -+ pri_lth[5]=38; -+ pri_lth[6]=40; -+ pri_lth[7]=48; -+ -+ pri_uth[0]=200; -+ pri_uth[1]=200; -+ pri_uth[2]=200; -+ pri_uth[3]=200; -+ pri_uth[4]=38; -+ pri_uth[5]=44; -+ pri_uth[6]=48; -+ pri_uth[7]=55; -+ if (dc_cnt > dfs->dc_cnt_th){ -+ pw_lth[0] = 0; -+ pw_lth[1] = 0; -+ pw_lth[2] = 0; -+ pw_lth[3] = 0; -+ pw_lth[4] = 0; -+ pw_lth[5] = 0; -+ pw_lth[6] = 0; -+ pw_lth[7] = 0; -+ cnt_th--; -+ } -+ } -+ else{ -+ pw_lth[0]=1; -+ pw_lth[1]=2; -+ pw_lth[2]=4; -+ pw_lth[3]=2; -+ pw_lth[4]=12; -+ pw_lth[5]=22; -+ pw_lth[6]=100; -+ pw_lth[7]=2; -+ -+ pw_uth[0]=2; -+ pw_uth[1]=3; -+ pw_uth[2]=6; -+ pw_uth[3]=15; -+ pw_uth[4]=30; -+ pw_uth[5]=60; -+ pw_uth[6]=300; -+ pw_uth[7]=3; -+ -+ pri_lth[0]=33; -+ pri_lth[1]=35; -+ pri_lth[2]=130; -+ pri_lth[3]=5; -+ pri_lth[4]=7; -+ pri_lth[5]=7; -+ pri_lth[6]=35; -+ pri_lth[7]=11; -+ -+ pri_uth[0]=73; -+ pri_uth[1]=75; -+ pri_uth[2]=170; -+ pri_uth[3]=10; -+ pri_uth[4]=22; -+ pri_uth[5]=22; -+ pri_uth[6]=86; -+ pri_uth[7]=15; -+ if (dc_cnt > dfs->dc_cnt_th){ -+ pw_lth[0] = 0; -+ pw_lth[1] = 0; -+ pw_lth[2] = 0; -+ pw_lth[3] = 0; -+ pw_lth[4] = 0; -+ pw_lth[5] = 0; -+ pw_lth[6] = 80; -+ pw_lth[7] = 0; -+ } -+ } -+ } -+ else if (region_domain == PHYDM_DFS_DOMAIN_ETSI){ -+ rdr_num = 6; -+ pw_lth[0]=1; -+ pw_lth[1]=1; -+ pw_lth[2]=1; -+ pw_lth[3]=40; -+ pw_lth[4]=1; -+ pw_lth[5]=1; -+ -+ pw_uth[0]=15; -+ pw_uth[1]=45; -+ pw_uth[2]=45; -+ pw_uth[3]=90; -+ pw_uth[4]=6; -+ pw_uth[5]=6; -+ -+ pri_lth[0]=35; -+ pri_lth[1]=21; -+ pri_lth[2]=8; -+ pri_lth[3]=8; -+ pri_lth[4]=87; -+ pri_lth[5]=29; -+ -+ pri_uth[0]=215; -+ pri_uth[1]=215; -+ pri_uth[2]=19; -+ pri_uth[3]=22; -+ pri_uth[4]=144; -+ pri_uth[5]=108; -+ if (dc_cnt > dfs->dc_cnt_th){ -+ pw_lth[0] = 0; -+ pw_lth[1] = 0; -+ pw_lth[2] = 0; -+ pw_lth[3] = 0; -+ pw_lth[4] = 0; -+ pw_lth[5] = 0; -+ } -+ } -+ -+ for (i = 0; i < loop_cnt; i++) { -+ dfs->pw_rslt[i] = (u8)pw_rpt_set[i]; -+ dfs->pri_rslt[i] = (u8)pri_rpt_set[i]; -+ for (j = 0; j < rdr_num; j++) { -+ if (dfs->radar_type) { -+ if ((pw_lth[j] <= dfs->pw_rslt[i]) && (dfs->pw_rslt[i] <= pw_uth[j])) -+ rdr_cnt[j]++; -+ } else { -+ if ((pw_lth[j] <= dfs->pw_rslt[i]) && (dfs->pw_rslt[i] <= pw_uth[j]) && -+ (pri_lth[j] <= dfs->pri_rslt[i]) && (dfs->pri_rslt[i] <= pri_uth[j])) { -+ rdr_cnt[j]++; -+ if (dfs->pri_rslt[i] > pri_vd_max) -+ pri_vd_max = dfs->pri_rslt[i]; -+ if (dfs->pri_rslt[i] < pri_vd_min) -+ pri_vd_min = dfs->pri_rslt[i]; -+ } -+ } -+ } -+ } -+ -+ /* Pattern Judgement */ -+ for (i = 0; i < rdr_num; i++){ -+ if (rdr_cnt[i] >= cnt_th){ -+ dfs->pw_flag = true; -+ rdr_tmp = i; -+ } -+ } -+ -+ /* Add NHM to decide the validity of the three flags */ -+ /* Use for chaotic open space */ -+ if (dfs->nhm_dfs_en) { -+ for (i = 0; i <= (NHM_RPT_NUM - 1); i++) { -+ if (ccx->nhm_result[i] > 0) -+ break; -+ } -+ for (j = (i + 1); j <= (NHM_RPT_NUM - 1); j++) { -+ if (ccx->nhm_result[j] > 0) -+ dfs->nhm_dfs_cnt++; -+ } -+ if (dfs->nhm_dfs_cnt > dfs->nhm_cnt_th) { -+ dfs->nhm_dfs_flag = true; -+ cnt_th = loop_cnt; -+ } -+ } -+ if (dm->support_ability & ODM_BB_ENV_MONITOR) { -+ if ((100-((ccx->nhm_rpt_sum * 100) >> 8)) >= dfs->nhm_dty_th) { -+ dfs->b_flag = true; -+ cnt_th = loop_cnt; -+ } -+ } -+ -+ /* Relax */ -+ if (!(dfs->idle_mode)) { -+ pri_cnt_th--; -+ if (!(region_domain == PHYDM_DFS_DOMAIN_ETSI)){ -+ dfs->pri_var_offset = 15; -+ if (region_domain == PHYDM_DFS_DOMAIN_MKK) -+ dfs->pri_var_offset = 5 + 10*pri_vd_min/20; -+ } -+ else -+ dfs->pri_var_offset = dfs->pri_var_tp_offset; -+ } -+ -+ // Mode approximation for PRI -+ for (i = 0; i < (loop_cnt - 1); i++) { -+ pri_cnt_tmp = 0; -+ for (j = 0; j < (loop_cnt - 1); j++) { -+ if ((i == j) || (dfs->pri_rslt[i] <= 4)) -+ continue; -+ if (dfs->pri_rslt[j] > (255 - dfs->pri_var_offset)) -+ pri_var_up = 255; -+ else -+ pri_var_up = dfs->pri_rslt[j] + dfs->pri_var_offset; -+ if (dfs->pri_var_offset >= dfs->pri_rslt[j]) -+ pri_var_low = 0; -+ else -+ pri_var_low = dfs->pri_rslt[j] - dfs->pri_var_offset; -+ if ((dfs->pri_rslt[i] <= pri_var_up) && (dfs->pri_rslt[i] >= pri_var_low) && -+ (dfs->pri_rslt[i] <= pri_vd_max) && (dfs->pri_rslt[i] >= pri_vd_min)) -+ pri_cnt_tmp++; -+ } -+ if (pri_cnt_tmp > pri_cnt_fnl) -+ pri_cnt_fnl = pri_cnt_tmp; -+ } -+ -+ // Advanced PRI Judgement (Bypass for long pulse flag) -+ if (pri_cnt_fnl != 0) -+ pri_cnt_fnl++; -+ -+ /* PRI */ -+ if (dfs->radar_type) -+ dfs->pri_flag= true; -+ else if (pri_cnt_fnl >= pri_cnt_th) -+ dfs->pri_flag= true; -+ /* For the case of SRTC */ -+ else if ((dfs->pri_rslt[0] == 0) && (dfs->pri_rslt[1] > 0) && -+ (dfs->pri_rslt[2] == 0) && (dfs->pri_rslt[3] > 0)) -+ dfs->pri_flag= true; -+ else if ((dfs->pri_rslt[0] > 0) && (dfs->pri_rslt[1] == 0) && -+ (dfs->pri_rslt[2] > 0) && (dfs->pri_rslt[3] == 0)) -+ dfs->pri_flag= true; -+ else if (!(dfs->pri_flag_en)) -+ dfs->pri_flag= true; -+ -+ if (region_domain == PHYDM_DFS_DOMAIN_MKK){ -+ if (c_channel >= 52 && c_channel <= 64){ -+ if (!(dfs->idle_mode)) -+ dfs->pri_flag= true; // MKK, 52<=ch<=64 , TP mode -+ } -+ } -+ -+ /* PW */ -+ if (!(dfs->pw_flag_en)) -+ dfs->pw_flag = true; -+ -+ /* LOCT */ -+ if (!(dfs->idle_mode)) -+ dfs->loct_diff_th = dfs->loct_diff_th + 15; -+ if (loct_diff <= dfs->loct_diff_th) -+ dfs->loct_flag = true; -+ else if (dfs->radar_type) -+ dfs->loct_flag = true; -+ else if (!(dfs->loct_flag_en)) -+ dfs->loct_flag = true; -+ -+ if (dfs->det_print_jar3) { -+ if (dfs->nhm_dfs_flag || dfs->b_flag) -+ PHYDM_DBG(dm, DBG_DFS, "Anti-FRD Rdr Drop\n"); -+ if (!(dfs->pw_flag_en) || !(dfs->loct_flag_en) || !(dfs->pri_flag_en)) -+ PHYDM_DBG(dm, DBG_DFS, "Byps flag scenario\n"); -+ if (dc_cnt > dfs->dc_cnt_th) -+ PHYDM_DBG(dm, DBG_DFS, "Radar is near DC\n"); -+ if (!(dfs->pw_flag)) -+ PHYDM_DBG(dm, DBG_DFS, "- PW/PRI-J Failure\n"); -+ if (!(dfs->loct_flag)) -+ PHYDM_DBG(dm, DBG_DFS, "- Loct-J Failure\n"); -+ if (!(dfs->pri_flag)) -+ PHYDM_DBG(dm, DBG_DFS, "- Adv-PRI-J Failure\n"); -+ if (!(dfs->pw_flag) || !(dfs->pri_flag) || !(dfs->loct_flag)) -+ PHYDM_DBG(dm, DBG_DFS, "Suspected radar result is dropped by SW mechanism !!\n"); -+ -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ PHYDM_DBG(dm, DBG_DFS, "The current information: ([Lower bound / Upper bound])\n"); -+ PHYDM_DBG(dm, DBG_DFS, "pw_th1 : [%d, %d], pw_th2 : [%d, %d], pw_th3 : [%d, %d]\n", -+ pw_lth[0], pw_uth[0], pw_lth[1], pw_uth[1], -+ pw_lth[2], pw_uth[2]); -+ PHYDM_DBG(dm, DBG_DFS, "pw_th4 : [%d, %d], pw_th5 : [%d, %d], pw_th6 : [%d, %d] \n", -+ pw_lth[3], pw_uth[3], pw_lth[4], -+ pw_uth[4], pw_lth[5], pw_uth[5]); -+ PHYDM_DBG(dm, DBG_DFS, "pw_th7 : [%d, %d], pw_th8 : [%d, %d]\n", -+ pw_lth[6], pw_uth[6], pw_lth[7], pw_uth[7]); -+ PHYDM_DBG(dm, DBG_DFS, "pri_th1 : [%d, %d], pri_th2 : [%d, %d], pri_th3 : [%d, %d]\n", -+ pri_lth[0], pri_uth[0], pri_lth[1], pri_uth[1], -+ pri_lth[2], pri_uth[2]); -+ PHYDM_DBG(dm, DBG_DFS, "pri_th4 : [%d, %d], pri_th5 : [%d, %d], pri_th6 : [%d, %d]\n", -+ pri_lth[3], pri_uth[3], pri_lth[4], pri_uth[4], -+ pri_lth[5], pri_uth[5]); -+ PHYDM_DBG(dm, DBG_DFS, "pri_th7 : [%d, %d], pri_th8 : [%d, %d]\n", -+ pri_lth[6], pri_uth[6], pri_lth[7], pri_uth[7]); -+ -+ if (!(dfs->idle_mode)) -+ PHYDM_DBG(dm, DBG_DFS, "loct_diff_th = [%d](Relax for TP mode)\n", -+ dfs->loct_diff_th); -+ else -+ PHYDM_DBG(dm, DBG_DFS, "loct_diff_th = [%d](Idle mode)\n", -+ dfs->loct_diff_th); -+ -+ if (!(dfs->idle_mode)) { -+ PHYDM_DBG(dm, DBG_DFS, "pri_var_offset = [%d] (Relax for TP mode)\n", -+ dfs->pri_var_offset); -+ PHYDM_DBG(dm, DBG_DFS, "pri_cnt_th = [%d] (Relax for TP mode)\n", -+ pri_cnt_th); -+ } else { -+ PHYDM_DBG(dm, DBG_DFS, "pri_var_offset = [%d] (Idle mode)\n", -+ dfs->pri_var_offset); -+ PHYDM_DBG(dm, DBG_DFS, "pri_cnt_th = [%d] (Idle mode)\n", -+ pri_cnt_th); -+ } -+ -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ PHYDM_DBG(dm, DBG_DFS, "loop_cnt = [%d]\n", loop_cnt); -+ if (dfs->nhm_dfs_flag) { -+ PHYDM_DBG(dm, DBG_DFS, "Nmode cnt = %d!\n", -+ dfs->nhm_dfs_cnt); -+ } -+ else if (dfs->b_flag) { -+ PHYDM_DBG(dm, DBG_DFS, "Bmode DTY = %d\n", -+ (100-((ccx->nhm_rpt_sum * 100) >> 8))); -+ } -+ else { -+ PHYDM_DBG(dm, DBG_DFS, "cnt_th = [%d] (Default : Half of loop cnt)\n", -+ cnt_th); -+ PHYDM_DBG(dm, DBG_DFS, "Bmode DTY = %d\n", -+ (100-((ccx->nhm_rpt_sum * 100) >> 8))); -+ } -+ -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ PHYDM_DBG(dm, DBG_DFS, "The current report:\n"); -+ PHYDM_DBG(dm, DBG_DFS, "pw_rpt(1-12) = [%d, %d, %d, %d, %d, %d, %d, %d, %d, %d, %d, %d]\n", -+ pw_rpt_set[0], pw_rpt_set[1], pw_rpt_set[2], -+ pw_rpt_set[3], pw_rpt_set[4], pw_rpt_set[5], -+ pw_rpt_set[6], pw_rpt_set[7], pw_rpt_set[8], -+ pw_rpt_set[9], pw_rpt_set[10], pw_rpt_set[11]); -+ PHYDM_DBG(dm, DBG_DFS, "loct_rpt(1-12) = [%d, %d, %d, %d, %d, %d, %d, %d, %d, %d, %d, %d]\n", -+ loct_rpt_set[0], loct_rpt_set[1], -+ loct_rpt_set[2], loct_rpt_set[3], -+ loct_rpt_set[4], loct_rpt_set[5], -+ loct_rpt_set[6], loct_rpt_set[7], -+ loct_rpt_set[8], loct_rpt_set[9], -+ loct_rpt_set[10], loct_rpt_set[11]); -+ PHYDM_DBG(dm, DBG_DFS, "pri_rpt(1-12) = [%d, %d, %d, %d, %d, %d, %d, %d, %d, %d, %d, %d]\n", -+ pri_rpt_set[0], pri_rpt_set[1], -+ pri_rpt_set[2], pri_rpt_set[3], -+ pri_rpt_set[4], pri_rpt_set[5], -+ pri_rpt_set[6], pri_rpt_set[7], -+ pri_rpt_set[8], pri_rpt_set[9], -+ pri_rpt_set[10], pri_rpt_set[11]); -+ -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ PHYDM_DBG(dm, DBG_DFS, "dc_cnt = [%d]\n", dc_cnt); -+ PHYDM_DBG(dm, DBG_DFS, "loct_diff = [%d]\n", loct_diff); -+ -+ if (pri_vd_max == 0 && pri_vd_min == 255) -+ PHYDM_DBG(dm, DBG_DFS, "No vaild pri_max and pri_min"); -+ else -+ PHYDM_DBG(dm, DBG_DFS, "pri_vaild_max = %d, pri_vaild_min = %d\n", -+ pri_vd_max, pri_vd_min); -+ PHYDM_DBG(dm, DBG_DFS, "advanced_pri_cnt = %d\n", -+ pri_cnt_fnl); -+ -+ PHYDM_DBG(dm, DBG_DFS, "radar_class_cnt[1-8] = [%d, %d, %d, %d, %d, %d, %d, %d]\n", -+ rdr_cnt[0], rdr_cnt[1], rdr_cnt[2], rdr_cnt[3], -+ rdr_cnt[4], rdr_cnt[5], rdr_cnt[6], rdr_cnt[7]); -+ } -+} -+#endif -+ -+#if (RTL8814A_SUPPORT || RTL8822B_SUPPORT || RTL8821C_SUPPORT) -+void phydm_dfs_histogram_radar_distinguish( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ u8 region_domain = dm->dfs_region_domain; -+ u8 c_channel = *dm->channel; -+ u8 band_width = *dm->band_width; -+ -+ u8 dfs_pw_thd1 = 0, dfs_pw_thd2 = 0, dfs_pw_thd3 = 0; -+ u8 dfs_pw_thd4 = 0, dfs_pw_thd5 = 0; -+ u8 dfs_pri_thd1 = 0, dfs_pri_thd2 = 0, dfs_pri_thd3 = 0; -+ u8 dfs_pri_thd4 = 0, dfs_pri_thd5 = 0; -+ u8 pri_th = 0, i = 0; -+ u8 max_pri_idx = 0, max_pw_idx = 0, max_pri_cnt_th = 0; -+ u8 max_pri_cnt_fcc_g1_th = 0, max_pri_cnt_fcc_g3_th = 0; -+ u8 safe_pri_pw_diff_th = 0, safe_pri_pw_diff_fcc_th = 0; -+ u8 safe_pri_pw_diff_w53_th = 0, safe_pri_pw_diff_fcc_idle_th = 0; -+ u8 j = 0; -+ u32 dfs_hist1_pw = 0, dfs_hist2_pw = 0, g_pw[6] = {0}; -+ u32 dfs_hist1_pri = 0, dfs_hist2_pri = 0, g_pri[6] = {0}; -+ u8 pw_sum_g0g5 = 0, pw_sum_g1g2g3g4 = 0; -+ u8 pri_sum_g0g5 = 0, pri_sum_g1g2g3g4 = 0; -+ u16 pw_sum_ss_g1g2g3g4 = 0, pri_sum_ss_g1g2g3g4 = 0; -+ u8 max_pri_cnt = 0, max_pw_cnt = 0; -+ #if (RTL8721D_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8721D)) -+ return; -+ #endif -+ -+ /*read pulse width hist report*/ -+ odm_set_bb_reg(dm, 0x19e4, BIT(22) | BIT(23), 0x1); -+ dfs_hist1_pw = odm_get_bb_reg(dm, 0xf5c, 0xffffffff); -+ dfs_hist2_pw = odm_get_bb_reg(dm, 0xf74, 0xffffffff); -+ -+ g_pw[0] = (unsigned int)((dfs_hist2_pw & 0xff000000) >> 24); -+ g_pw[1] = (unsigned int)((dfs_hist2_pw & 0x00ff0000) >> 16); -+ g_pw[2] = (unsigned int)((dfs_hist2_pw & 0x0000ff00) >> 8); -+ g_pw[3] = (unsigned int)dfs_hist2_pw & 0x000000ff; -+ g_pw[4] = (unsigned int)((dfs_hist1_pw & 0xff000000) >> 24); -+ g_pw[5] = (unsigned int)((dfs_hist1_pw & 0x00ff0000) >> 16); -+ -+ /*read pulse repetition interval hist report*/ -+ odm_set_bb_reg(dm, 0x19e4, BIT(22) | BIT(23), 0x3); -+ dfs_hist1_pri = odm_get_bb_reg(dm, 0xf5c, 0xffffffff); -+ dfs_hist2_pri = odm_get_bb_reg(dm, 0xf74, 0xffffffff); -+ odm_set_bb_reg(dm, 0x19b4, 0x10000000, 1); /*reset histo report*/ -+ odm_set_bb_reg(dm, 0x19b4, 0x10000000, 0); /*@continue histo report*/ -+ -+ g_pri[0] = (unsigned int)((dfs_hist2_pri & 0xff000000) >> 24); -+ g_pri[1] = (unsigned int)((dfs_hist2_pri & 0x00ff0000) >> 16); -+ g_pri[2] = (unsigned int)((dfs_hist2_pri & 0x0000ff00) >> 8); -+ g_pri[3] = (unsigned int)dfs_hist2_pri & 0x000000ff; -+ g_pri[4] = (unsigned int)((dfs_hist1_pri & 0xff000000) >> 24); -+ g_pri[5] = (unsigned int)((dfs_hist1_pri & 0x00ff0000) >> 16); -+ -+ dfs->pri_cond1 = 0; -+ dfs->pri_cond2 = 0; -+ dfs->pri_cond3 = 0; -+ dfs->pri_cond4 = 0; -+ dfs->pri_cond5 = 0; -+ dfs->pw_cond1 = 0; -+ dfs->pw_cond2 = 0; -+ dfs->pw_cond3 = 0; -+ dfs->pri_type3_4_cond1 = 0; /*@for ETSI*/ -+ dfs->pri_type3_4_cond2 = 0; /*@for ETSI*/ -+ dfs->pw_long_cond1 = 0; /*@for long radar*/ -+ dfs->pw_long_cond2 = 0; /*@for long radar*/ -+ dfs->pri_long_cond1 = 0; /*@for long radar*/ -+ dfs->pw_flag = 0; -+ dfs->pri_flag = 0; -+ dfs->pri_type3_4_flag = 0; /*@for ETSI*/ -+ dfs->long_radar_flag = 0; -+ dfs->pw_std = 0; /*The std(var) of reasonable num of pw group*/ -+ dfs->pri_std = 0; /*The std(var) of reasonable num of pri group*/ -+ -+ for (i = 0; i < 6; i++) { -+ dfs->pw_hold_sum[i] = 0; -+ dfs->pri_hold_sum[i] = 0; -+ } -+ -+ if (dfs->idle_mode == 1) -+ pri_th = dfs->pri_hist_th; -+ else -+ pri_th = dfs->pri_hist_th - 1; -+ -+ for (i = 0; i < 6; i++) { -+ dfs->pw_hold[dfs->hist_idx][i] = (u8)g_pw[i]; -+ dfs->pri_hold[dfs->hist_idx][i] = (u8)g_pri[i]; -+ /*@collect whole histogram report may take some time -+ *so we add the counter of 2 time slots in FCC and ETSI -+ */ -+ dfs->pw_hold_sum[i] = dfs->pw_hold_sum[i] + -+ dfs->pw_hold[(dfs->hist_idx + 1) % 3][i] + -+ dfs->pw_hold[(dfs->hist_idx + 2) % 3][i]; -+ dfs->pri_hold_sum[i] = dfs->pri_hold_sum[i] + -+ dfs->pri_hold[(dfs->hist_idx + 1) % 3][i] + -+ dfs->pri_hold[(dfs->hist_idx + 2) % 3][i]; -+ } -+ /*@For long radar type*/ -+ for (j = 1; j < 4; j++) { -+ dfs->pw_long_hold_sum[i] = dfs->pw_long_hold_sum[i] + -+ dfs->pw_hold[(dfs->hist_long_idx + j) % 4][i]; -+ dfs->pri_long_hold_sum[i] = dfs->pri_long_hold_sum[i] + -+ dfs->pri_hold[(dfs->hist_long_idx + j) % 4][i]; -+ } -+ -+ dfs->hist_idx++; -+ if (dfs->hist_idx == 3) -+ dfs->hist_idx = 0; -+ dfs->hist_long_idx++; -+ if (dfs->hist_long_idx == 4) -+ dfs->hist_long_idx = 0; -+ -+ max_pri_cnt = 0; -+ max_pri_idx = 0; -+ max_pw_cnt = 0; -+ max_pw_idx = 0; -+ max_pri_cnt_th = dfs->pri_sum_g1_th; -+ max_pri_cnt_fcc_g1_th = dfs->pri_sum_g1_fcc_th; -+ max_pri_cnt_fcc_g3_th = dfs->pri_sum_g3_fcc_th; -+ safe_pri_pw_diff_th = dfs->pri_pw_diff_th; -+ safe_pri_pw_diff_fcc_th = dfs->pri_pw_diff_fcc_th; -+ safe_pri_pw_diff_fcc_idle_th = dfs->pri_pw_diff_fcc_idle_th; -+ safe_pri_pw_diff_w53_th = dfs->pri_pw_diff_w53_th; -+ -+ /*@g1 to g4 is the reseasonable range of pri and pw*/ -+ for (i = 1; i <= 4; i++) { -+ if (dfs->pri_hold_sum[i] > max_pri_cnt) { -+ max_pri_cnt = dfs->pri_hold_sum[i]; -+ max_pri_idx = i; -+ } -+ if (dfs->pw_hold_sum[i] > max_pw_cnt) { -+ max_pw_cnt = dfs->pw_hold_sum[i]; -+ max_pw_idx = i; -+ } -+ if (dfs->pri_hold_sum[i] >= pri_th) -+ dfs->pri_cond1 = 1; -+ } -+ -+ pri_sum_g0g5 = dfs->pri_hold_sum[0]; -+ if (pri_sum_g0g5 == 0) -+ pri_sum_g0g5 = 1; -+ pri_sum_g1g2g3g4 = dfs->pri_hold_sum[1] + dfs->pri_hold_sum[2] -+ + dfs->pri_hold_sum[3] + dfs->pri_hold_sum[4]; -+ -+ /*pw will reduce because of dc, so we do not treat g0 as illegal group*/ -+ pw_sum_g0g5 = dfs->pw_hold_sum[5]; -+ if (pw_sum_g0g5 == 0) -+ pw_sum_g0g5 = 1; -+ pw_sum_g1g2g3g4 = dfs->pw_hold_sum[1] + dfs->pw_hold_sum[2] + -+ dfs->pw_hold_sum[3] + dfs->pw_hold_sum[4]; -+ -+ /*@Calculate the variation from g1 to g4*/ -+ for (i = 1; i < 5; i++) { -+ /*Sum of square*/ -+ pw_sum_ss_g1g2g3g4 = pw_sum_ss_g1g2g3g4 + -+ (dfs->pw_hold_sum[i] - (pw_sum_g1g2g3g4 / 4)) * -+ (dfs->pw_hold_sum[i] - (pw_sum_g1g2g3g4 / 4)); -+ pri_sum_ss_g1g2g3g4 = pri_sum_ss_g1g2g3g4 + -+ (dfs->pri_hold_sum[i] - (pri_sum_g1g2g3g4 / 4)) * -+ (dfs->pri_hold_sum[i] - (pri_sum_g1g2g3g4 / 4)); -+ } -+ /*The value may less than the normal variance, -+ *since the variable type is int (not float) -+ */ -+ dfs->pw_std = (u8)(pw_sum_ss_g1g2g3g4 / 4); -+ dfs->pri_std = (u8)(pri_sum_ss_g1g2g3g4 / 4); -+ -+ if (region_domain == 1) { -+ dfs->pri_type3_4_flag = 1; /*@ETSI flag*/ -+ -+ /*(OTA) Cancel long PRI case*/ -+ dfs->pri_cond2 = 1; -+ -+ /*reasonable group shouldn't large*/ -+ if ((pri_sum_g0g5 + pri_sum_g1g2g3g4) / pri_sum_g0g5 > 2 && -+ pri_sum_g1g2g3g4 <= dfs->pri_sum_safe_fcc_th) -+ dfs->pri_cond3 = 1; -+ -+ /*@Cancel the condition that the abs between pri and pw*/ -+ if (dfs->pri_std >= dfs->pri_std_th) -+ dfs->pri_cond4 = 1; -+ else if (max_pri_idx == 1 && -+ max_pri_cnt >= max_pri_cnt_fcc_g1_th) -+ dfs->pri_cond4 = 1; -+ -+ /*(OTA) Cancel the condition (type 3,4 distinction)*/ -+ dfs->pri_cond5 = 1; -+ -+ if (dfs->pri_cond1 && dfs->pri_cond2 && dfs->pri_cond3 && -+ dfs->pri_cond4 && dfs->pri_cond5) -+ dfs->pri_flag = 1; -+ -+ /* PW judgment conditions for short radar type */ -+ /*ratio of reasonable and illegal group && g5 should be zero*/ -+ if (((pw_sum_g0g5 + pw_sum_g1g2g3g4) / pw_sum_g0g5 > 2) && -+ (dfs->pw_hold_sum[5] <= 1)) -+ dfs->pw_cond1 = 1; -+ /*unreasonable group*/ -+ if (dfs->pw_hold_sum[4] == 0 && dfs->pw_hold_sum[5] == 0) -+ dfs->pw_cond2 = 1; -+ /*pw's std (short radar) should be large(=7)*/ -+ if (dfs->pw_std >= dfs->pw_std_th) -+ dfs->pw_cond3 = 1; -+ if (dfs->pw_cond1 && dfs->pw_cond2 && dfs->pw_cond3) -+ dfs->pw_flag = 1; -+ -+ /* @Judgment conditions of long radar type */ -+ if (band_width == CHANNEL_WIDTH_20) { -+ if (dfs->pw_long_hold_sum[4] >= -+ dfs->pw_long_lower_20m_th) -+ dfs->pw_long_cond1 = 1; -+ } else{ -+ if (dfs->pw_long_hold_sum[4] >= dfs->pw_long_lower_th) -+ dfs->pw_long_cond1 = 1; -+ } -+ /* @Disable the condition that dfs->pw_long_hold_sum[1] */ -+ if (dfs->pw_long_hold_sum[2] + dfs->pw_long_hold_sum[3] + -+ dfs->pw_long_hold_sum[4] <= dfs->pw_long_sum_upper_th && -+ dfs->pw_long_hold_sum[2] <= dfs->pw_long_hold_sum[4] && -+ dfs->pw_long_hold_sum[3] <= dfs->pw_long_hold_sum[4]) -+ dfs->pw_long_cond2 = 1; -+ /*@g4 should be large for long radar*/ -+ if (dfs->pri_long_hold_sum[4] <= dfs->pri_long_upper_th) -+ dfs->pri_long_cond1 = 1; -+ if (dfs->pw_long_cond1 && dfs->pw_long_cond2 && -+ dfs->pri_long_cond1) -+ dfs->long_radar_flag = 1; -+ } else if (region_domain == 2) { -+ dfs->pri_type3_4_flag = 1; /*@ETSI flag*/ -+ -+ /*PRI judgment conditions for short radar type*/ -+ if ((pri_sum_g0g5 + pri_sum_g1g2g3g4) / pri_sum_g0g5 > 2) -+ dfs->pri_cond2 = 1; -+ -+ /*reasonable group shouldn't too large*/ -+ if (pri_sum_g1g2g3g4 <= dfs->pri_sum_safe_fcc_th) -+ dfs->pri_cond3 = 1; -+ -+ /*Cancel the abs diff between pri and pw for idle mode (thr=2)*/ -+ dfs->pri_cond4 = 1; -+ -+ if (dfs->idle_mode == 1) { -+ if (dfs->pri_std >= dfs->pri_std_idle_th) { -+ if (max_pw_idx == 3 && -+ pri_sum_g1g2g3g4 <= dfs->pri_sum_type4_th){ -+ /*To distinguish between type 4 radar and false detection*/ -+ dfs->pri_cond5 = 1; -+ } else if (max_pw_idx == 1 && -+ pri_sum_g1g2g3g4 >= -+ dfs->pri_sum_type6_th) { -+ /*To distinguish between type 6 radar and false detection*/ -+ dfs->pri_cond5 = 1; -+ } else { -+ /*pri variation of short radar should be large (idle mode)*/ -+ dfs->pri_cond5 = 1; -+ } -+ } -+ } else { -+ /*pri variation of short radar should be large (TP mode)*/ -+ if (dfs->pri_std >= dfs->pri_std_th) -+ dfs->pri_cond5 = 1; -+ } -+ -+ if (dfs->pri_cond1 && dfs->pri_cond2 && dfs->pri_cond3 && -+ dfs->pri_cond4 && dfs->pri_cond5) -+ dfs->pri_flag = 1; -+ -+ /* PW judgment conditions for short radar type */ -+ if (((pw_sum_g0g5 + pw_sum_g1g2g3g4) / pw_sum_g0g5 > 2) && -+ (dfs->pw_hold_sum[5] <= 1)) -+ /*ratio of reasonable and illegal group && g5 should be zero*/ -+ dfs->pw_cond1 = 1; -+ -+ if ((c_channel >= 52) && (c_channel <= 64)) -+ dfs->pw_cond2 = 1; -+ /*unreasonable group shouldn't too large*/ -+ else if (dfs->pw_hold_sum[0] <= dfs->pw_g0_th) -+ dfs->pw_cond2 = 1; -+ -+ if (dfs->idle_mode == 1) { -+ /*pw variation of short radar should be large (idle mode)*/ -+ if (dfs->pw_std >= dfs->pw_std_idle_th) -+ dfs->pw_cond3 = 1; -+ } else { -+ /*pw variation of short radar should be large (TP mode)*/ -+ if (dfs->pw_std >= dfs->pw_std_th) -+ dfs->pw_cond3 = 1; -+ } -+ if (dfs->pw_cond1 && dfs->pw_cond2 && dfs->pw_cond3) -+ dfs->pw_flag = 1; -+ -+ /* @Judgment conditions of long radar type */ -+ if (band_width == CHANNEL_WIDTH_20) { -+ if (dfs->pw_long_hold_sum[4] >= -+ dfs->pw_long_lower_20m_th) -+ dfs->pw_long_cond1 = 1; -+ } else{ -+ if (dfs->pw_long_hold_sum[4] >= dfs->pw_long_lower_th) -+ dfs->pw_long_cond1 = 1; -+ } -+ if (dfs->pw_long_hold_sum[1] + dfs->pw_long_hold_sum[2] + -+ dfs->pw_long_hold_sum[3] + dfs->pw_long_hold_sum[4] -+ <= dfs->pw_long_sum_upper_th) -+ dfs->pw_long_cond2 = 1; -+ /*@g4 should be large for long radar*/ -+ if (dfs->pri_long_hold_sum[4] <= dfs->pri_long_upper_th) -+ dfs->pri_long_cond1 = 1; -+ if (dfs->pw_long_cond1 && -+ dfs->pw_long_cond2 && dfs->pri_long_cond1) -+ dfs->long_radar_flag = 1; -+ } else if (region_domain == 3) { -+ /*ratio of reasonable group and illegal group */ -+ if ((pri_sum_g0g5 + pri_sum_g1g2g3g4) / pri_sum_g0g5 > 2) -+ dfs->pri_cond2 = 1; -+ -+ if (pri_sum_g1g2g3g4 <= dfs->pri_sum_safe_th) -+ dfs->pri_cond3 = 1; -+ -+ /*@Cancel the condition that the abs between pri and pw*/ -+ dfs->pri_cond4 = 1; -+ -+ if (dfs->pri_hold_sum[5] <= dfs->pri_sum_g5_th) -+ dfs->pri_cond5 = 1; -+ -+ if (band_width == CHANNEL_WIDTH_40) { -+ if (max_pw_idx == 4) { -+ if (max_pw_cnt >= dfs->type4_pw_max_cnt && -+ pri_sum_g1g2g3g4 >= -+ dfs->type4_safe_pri_sum_th) { -+ dfs->pri_cond1 = 1; -+ dfs->pri_cond4 = 1; -+ dfs->pri_type3_4_cond1 = 1; -+ } -+ } -+ } -+ -+ if (dfs->pri_cond1 && dfs->pri_cond2 && -+ dfs->pri_cond3 && dfs->pri_cond4 && dfs->pri_cond5) -+ dfs->pri_flag = 1; -+ -+ if (((pw_sum_g0g5 + pw_sum_g1g2g3g4) / pw_sum_g0g5 > 2)) -+ dfs->pw_flag = 1; -+ -+ /*@max num pri group is g1 means radar type3 or type4*/ -+ if (max_pri_idx == 1) { -+ if (max_pri_cnt >= max_pri_cnt_th) -+ dfs->pri_type3_4_cond1 = 1; -+ if (dfs->pri_hold_sum[4] <= -+ dfs->pri_sum_g5_under_g1_th && -+ dfs->pri_hold_sum[5] <= dfs->pri_sum_g5_under_g1_th) -+ dfs->pri_type3_4_cond2 = 1; -+ } else { -+ dfs->pri_type3_4_cond1 = 1; -+ dfs->pri_type3_4_cond2 = 1; -+ } -+ if (dfs->pri_type3_4_cond1 && dfs->pri_type3_4_cond2) -+ dfs->pri_type3_4_flag = 1; -+ } else { -+ } -+ -+ if (dfs->print_hist_rpt) { -+ dfs_pw_thd1 = (u8)odm_get_bb_reg(dm, 0x19e4, 0xff000000); -+ dfs_pw_thd2 = (u8)odm_get_bb_reg(dm, 0x19e8, 0x000000ff); -+ dfs_pw_thd3 = (u8)odm_get_bb_reg(dm, 0x19e8, 0x0000ff00); -+ dfs_pw_thd4 = (u8)odm_get_bb_reg(dm, 0x19e8, 0x00ff0000); -+ dfs_pw_thd5 = (u8)odm_get_bb_reg(dm, 0x19e8, 0xff000000); -+ -+ dfs_pri_thd1 = (u8)odm_get_bb_reg(dm, 0x19b8, 0x7F80); -+ dfs_pri_thd2 = (u8)odm_get_bb_reg(dm, 0x19ec, 0x000000ff); -+ dfs_pri_thd3 = (u8)odm_get_bb_reg(dm, 0x19ec, 0x0000ff00); -+ dfs_pri_thd4 = (u8)odm_get_bb_reg(dm, 0x19ec, 0x00ff0000); -+ dfs_pri_thd5 = (u8)odm_get_bb_reg(dm, 0x19ec, 0xff000000); -+ -+ PHYDM_DBG(dm, DBG_DFS, "\ndfs_pw_thd=%d %d %d %d %d\n", -+ dfs_pw_thd1, dfs_pw_thd2, dfs_pw_thd3, -+ dfs_pw_thd4, dfs_pw_thd5); -+ PHYDM_DBG(dm, DBG_DFS, "-----pulse width hist-----\n"); -+ PHYDM_DBG(dm, DBG_DFS, "dfs_hist_pw=%x %x\n", -+ dfs_hist1_pw, dfs_hist2_pw); -+ PHYDM_DBG(dm, DBG_DFS, "g_pw_hist = %x %x %x %x %x %x\n", -+ g_pw[0], g_pw[1], g_pw[2], g_pw[3], -+ g_pw[4], g_pw[5]); -+ PHYDM_DBG(dm, DBG_DFS, "dfs_pri_thd=%d %d %d %d %d\n", -+ dfs_pri_thd1, dfs_pri_thd2, dfs_pri_thd3, -+ dfs_pri_thd4, dfs_pri_thd5); -+ PHYDM_DBG(dm, DBG_DFS, "-----pulse interval hist-----\n"); -+ PHYDM_DBG(dm, DBG_DFS, "dfs_hist_pri=%x %x\n", -+ dfs_hist1_pri, dfs_hist2_pri); -+ PHYDM_DBG(dm, DBG_DFS, -+ "g_pri_hist = %x %x %x %x %x %x, pw_flag = %d, pri_flag = %d\n", -+ g_pri[0], g_pri[1], g_pri[2], g_pri[3], g_pri[4], -+ g_pri[5], dfs->pw_flag, dfs->pri_flag); -+ if (region_domain == 1 || region_domain == 3) { -+ PHYDM_DBG(dm, DBG_DFS, "hist_idx= %d\n", -+ (dfs->hist_idx + 2) % 3); -+ } else { -+ PHYDM_DBG(dm, DBG_DFS, "hist_idx= %d\n", -+ (dfs->hist_idx + 3) % 4); -+ } -+ PHYDM_DBG(dm, DBG_DFS, "hist_long_idx= %d\n", -+ (dfs->hist_long_idx + 299) % 300); -+ PHYDM_DBG(dm, DBG_DFS, -+ "pw_sum_g0g5 = %d, pw_sum_g1g2g3g4 = %d\n", -+ pw_sum_g0g5, pw_sum_g1g2g3g4); -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_sum_g0g5 = %d, pri_sum_g1g2g3g4 = %d\n", -+ pri_sum_g0g5, pri_sum_g1g2g3g4); -+ PHYDM_DBG(dm, DBG_DFS, "pw_hold_sum = %d %d %d %d %d %d\n", -+ dfs->pw_hold_sum[0], dfs->pw_hold_sum[1], -+ dfs->pw_hold_sum[2], dfs->pw_hold_sum[3], -+ dfs->pw_hold_sum[4], dfs->pw_hold_sum[5]); -+ PHYDM_DBG(dm, DBG_DFS, "pri_hold_sum = %d %d %d %d %d %d\n", -+ dfs->pri_hold_sum[0], dfs->pri_hold_sum[1], -+ dfs->pri_hold_sum[2], dfs->pri_hold_sum[3], -+ dfs->pri_hold_sum[4], dfs->pri_hold_sum[5]); -+ PHYDM_DBG(dm, DBG_DFS, "pw_long_hold_sum = %d %d %d %d %d %d\n", -+ dfs->pw_long_hold_sum[0], dfs->pw_long_hold_sum[1], -+ dfs->pw_long_hold_sum[2], dfs->pw_long_hold_sum[3], -+ dfs->pw_long_hold_sum[4], dfs->pw_long_hold_sum[5]); -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_long_hold_sum = %d %d %d %d %d %d\n", -+ dfs->pri_long_hold_sum[0], dfs->pri_long_hold_sum[1], -+ dfs->pri_long_hold_sum[2], dfs->pri_long_hold_sum[3], -+ dfs->pri_long_hold_sum[4], dfs->pri_long_hold_sum[5]); -+ PHYDM_DBG(dm, DBG_DFS, "idle_mode = %d\n", dfs->idle_mode); -+ PHYDM_DBG(dm, DBG_DFS, "pw_standard = %d\n", dfs->pw_std); -+ PHYDM_DBG(dm, DBG_DFS, "pri_standard = %d\n", dfs->pri_std); -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_cond1 = %d, pri_cond2 = %d, pri_cond3 = %d, pri_cond4 = %d, pri_cond5 = %d\n", -+ dfs->pri_cond1, dfs->pri_cond2, dfs->pri_cond3, -+ dfs->pri_cond4, dfs->pri_cond5); -+ PHYDM_DBG(dm, DBG_DFS, -+ "bandwidth = %d, pri_th = %d, max_pri_cnt_th = %d, safe_pri_pw_diff_th = %d\n", -+ band_width, pri_th, max_pri_cnt_th, -+ safe_pri_pw_diff_th); -+ } -+} -+#endif -+boolean phydm_dfs_hist_log(void *dm_void, u8 index) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ u8 i = 0, j = 0; -+ boolean hist_radar_detected = 0; -+ -+ if (dfs->pulse_type_hist[index] == 0) { -+ dfs->radar_type = 0; -+ if (dfs->pw_flag && dfs->pri_flag && -+ dfs->pri_type3_4_flag) { -+ hist_radar_detected = 1; -+ PHYDM_DBG(dm, DBG_DFS, -+ "Detected type %d radar signal!\n", -+ dfs->radar_type); -+ if (dfs->det_print2) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "hist_idx= %d\n", -+ (dfs->hist_idx + 3) % 4); -+ for (j = 0; j < 4; j++) { -+ for (i = 0; i < 6; i++) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_hold = %d ", -+ dfs->pri_hold[j][i]); -+ } -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ } -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ for (j = 0; j < 4; j++) { -+ for (i = 0; i < 6; i++) { -+ PHYDM_DBG(dm, DBG_DFS, "pw_hold = %d ", -+ dfs->pw_hold[j][i]); -+ } -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ } -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ PHYDM_DBG(dm, DBG_DFS, "idle_mode = %d\n", -+ dfs->idle_mode); -+ PHYDM_DBG(dm, DBG_DFS, -+ "pw_hold_sum = %d %d %d %d %d %d\n", -+ dfs->pw_hold_sum[0], -+ dfs->pw_hold_sum[1], -+ dfs->pw_hold_sum[2], -+ dfs->pw_hold_sum[3], -+ dfs->pw_hold_sum[4], -+ dfs->pw_hold_sum[5]); -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_hold_sum = %d %d %d %d %d %d\n", -+ dfs->pri_hold_sum[0], -+ dfs->pri_hold_sum[1], -+ dfs->pri_hold_sum[2], -+ dfs->pri_hold_sum[3], -+ dfs->pri_hold_sum[4], -+ dfs->pri_hold_sum[5]); -+ } -+ } else { -+ if (dfs->det_print2) { -+ if (dfs->pulse_flag_hist[index] && -+ dfs->pri_flag == 0) { -+ PHYDM_DBG(dm, DBG_DFS, "pri_variation = %d\n", -+ dfs->pri_std); -+ PHYDM_DBG(dm, DBG_DFS, -+ "PRI criterion is not satisfied!\n"); -+ if (dfs->pri_cond1 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_cond1 is not satisfied!\n"); -+ if (dfs->pri_cond2 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_cond2 is not satisfied!\n"); -+ if (dfs->pri_cond3 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_cond3 is not satisfied!\n"); -+ if (dfs->pri_cond4 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_cond4 is not satisfied!\n"); -+ if (dfs->pri_cond5 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_cond5 is not satisfied!\n"); -+ } -+ if (dfs->pulse_flag_hist[index] && -+ dfs->pw_flag == 0) { -+ PHYDM_DBG(dm, DBG_DFS, "pw_variation = %d\n", -+ dfs->pw_std); -+ PHYDM_DBG(dm, DBG_DFS, -+ "PW criterion is not satisfied!\n"); -+ if (dfs->pw_cond1 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pw_cond1 is not satisfied!\n"); -+ if (dfs->pw_cond2 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pw_cond2 is not satisfied!\n"); -+ if (dfs->pw_cond3 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pw_cond3 is not satisfied!\n"); -+ } -+ if (dfs->pulse_flag_hist[index] && -+ (dfs->pri_type3_4_flag == 0)) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_type3_4 criterion is not satisfied!\n"); -+ if (dfs->pri_type3_4_cond1 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_type3_4_cond1 is not satisfied!\n"); -+ if (dfs->pri_type3_4_cond2 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_type3_4_cond2 is not satisfied!\n"); -+ } -+ PHYDM_DBG(dm, DBG_DFS, "hist_idx= %d\n", -+ (dfs->hist_idx + 3) % 4); -+ for (j = 0; j < 4; j++) { -+ for (i = 0; i < 6; i++) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_hold = %d ", -+ dfs->pri_hold[j][i]); -+ } -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ } -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ for (j = 0; j < 4; j++) { -+ for (i = 0; i < 6; i++) -+ PHYDM_DBG(dm, DBG_DFS, -+ "pw_hold = %d ", -+ dfs->pw_hold[j][i]); -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ } -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ PHYDM_DBG(dm, DBG_DFS, "idle_mode = %d\n", -+ dfs->idle_mode); -+ PHYDM_DBG(dm, DBG_DFS, -+ "pw_hold_sum = %d %d %d %d %d %d\n", -+ dfs->pw_hold_sum[0], dfs->pw_hold_sum[1], -+ dfs->pw_hold_sum[2], dfs->pw_hold_sum[3], -+ dfs->pw_hold_sum[4], dfs->pw_hold_sum[5]); -+ PHYDM_DBG(dm, DBG_DFS, -+ "pri_hold_sum = %d %d %d %d %d %d\n", -+ dfs->pri_hold_sum[0], dfs->pri_hold_sum[1], -+ dfs->pri_hold_sum[2], dfs->pri_hold_sum[3], -+ dfs->pri_hold_sum[4], dfs->pri_hold_sum[5]); -+ } -+ } -+ } else { -+ dfs->radar_type = 1; -+ if (dfs->det_print2) { -+ PHYDM_DBG(dm, DBG_DFS, "\n"); -+ PHYDM_DBG(dm, DBG_DFS, "idle_mode = %d\n", -+ dfs->idle_mode); -+ } -+ /* @Long radar should satisfy three conditions */ -+ if (dfs->long_radar_flag == 1) { -+ hist_radar_detected = 1; -+ PHYDM_DBG(dm, DBG_DFS, -+ "Detected type %d radar signal!\n", -+ dfs->radar_type); -+ } else { -+ if (dfs->det_print2) { -+ if (dfs->pw_long_cond1 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "--pw_long_cond1 is not satisfied!--\n"); -+ if (dfs->pw_long_cond2 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "--pw_long_cond2 is not satisfied!--\n"); -+ if (dfs->pri_long_cond1 == 0) -+ PHYDM_DBG(dm, DBG_DFS, -+ "--pri_long_cond1 is not satisfied!--\n"); -+ } -+ } -+ } -+ return hist_radar_detected; -+} -+ -+boolean phydm_radar_detect(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ boolean radar_detected = false; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ dfs->igi_cur = (u8)odm_get_bb_reg(dm, R_0x1d70, 0x0000007f); -+ dfs->st_l2h_cur = (u8)odm_get_bb_reg(dm, R_0xa40, 0x00007f00); -+ #if (RTL8721D_SUPPORT) -+ } else if (dm->support_ic_type & (ODM_RTL8721D)) { -+ dfs->st_l2h_cur = (u8)(odm_get_bb_reg(dm, R_0xf54, -+ 0x0000001f) << 2); -+ dfs->st_l2h_cur += (u8)odm_get_bb_reg(dm, R_0xf58, 0xc0000000); -+ #endif -+ } else { -+ dfs->igi_cur = (u8)odm_get_bb_reg(dm, R_0xc50, 0x0000007f); -+ dfs->st_l2h_cur = (u8)odm_get_bb_reg(dm, R_0x91c, 0x000000ff); -+ } -+ -+ /* @dynamic pwdb calibration */ -+ if (dfs->igi_pre != dfs->igi_cur) { -+ dfs->pwdb_th_cur = ((int)dfs->st_l2h_cur - (int)dfs->igi_cur) -+ / 2 + dfs->pwdb_scalar_factor; -+ -+ /* @limit the pwdb value to absolute lower bound 0xa */ -+ dfs->pwdb_th_cur = MAX_2(dfs->pwdb_th_cur, (int)dfs->pwdb_th); -+ /* @limit the pwdb value to absolute upper bound 0x1f */ -+ dfs->pwdb_th_cur = MIN_2(dfs->pwdb_th_cur, 0x1f); -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ odm_set_bb_reg(dm, R_0xa50, 0x000000f0, -+ dfs->pwdb_th_cur); -+ #if (RTL8721D_SUPPORT) -+ else if (dm->support_ic_type & (ODM_RTL8721D)) -+ odm_set_bb_reg(dm, R_0xf70, 0x03c00000, -+ dfs->pwdb_th_cur); -+ #endif -+ else -+ odm_set_bb_reg(dm, R_0x918, 0x00001f00, -+ dfs->pwdb_th_cur); -+ } -+ dfs->igi_pre = dfs->igi_cur; -+ -+ phydm_dfs_dynamic_setting(dm); -+ #if (RTL8814A_SUPPORT || RTL8822B_SUPPORT || RTL8821C_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) -+ phydm_dfs_histogram_radar_distinguish(dm); -+ #endif -+ radar_detected = phydm_radar_detect_dm_check(dm); -+ -+ if (radar_detected) { -+ /* -+ PHYDM_DBG(dm, DBG_DFS, -+ "Radar detect: %d\n", radar_detected); -+ */ -+ phydm_radar_detect_reset(dm); -+ if (dfs->dbg_mode == 1) { -+ PHYDM_DBG(dm, DBG_DFS, -+ "Radar is detected in DFS dbg mode!!!!!!!!!!!\n"); -+ radar_detected = 0; -+ } -+ } -+ -+ if (dfs->sw_trigger_mode) { -+ radar_detected = 1; -+ PHYDM_DBG(dm, DBG_DFS, -+ "Radar is detected in DFS SW trigger mode.\n"); -+ } -+ -+ return radar_detected; -+} -+ -+void phydm_dfs_hist_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ char help[] = "-h"; -+ u32 argv[5] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{0} pri_hist_th = %d\n", dfs->pri_hist_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{1} pri_sum_g1_th = %d\n", dfs->pri_sum_g1_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{2} pri_sum_g5_th = %d\n", dfs->pri_sum_g5_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{3} pri_sum_g1_fcc_th = %d\n", -+ dfs->pri_sum_g1_fcc_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{4} pri_sum_g3_fcc_th = %d\n", -+ dfs->pri_sum_g3_fcc_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{5} pri_sum_safe_fcc_th = %d\n", -+ dfs->pri_sum_safe_fcc_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{6} pri_sum_type4_th = %d\n", dfs->pri_sum_type4_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{7} pri_sum_type6_th = %d\n", dfs->pri_sum_type6_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{8} pri_sum_safe_th = %d\n", dfs->pri_sum_safe_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{9} pri_sum_g5_under_g1_th = %d\n", -+ dfs->pri_sum_g5_under_g1_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{10} pri_pw_diff_th = %d\n", dfs->pri_pw_diff_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{11} pri_pw_diff_fcc_th = %d\n", -+ dfs->pri_pw_diff_fcc_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{12} pri_pw_diff_fcc_idle_th = %d\n", -+ dfs->pri_pw_diff_fcc_idle_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{13} pri_pw_diff_w53_th = %d\n", -+ dfs->pri_pw_diff_w53_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{14} pri_type1_low_fcc_th = %d\n", -+ dfs->pri_type1_low_fcc_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{15} pri_type1_upp_fcc_th = %d\n", -+ dfs->pri_type1_upp_fcc_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{16} pri_type1_cen_fcc_th = %d\n", -+ dfs->pri_type1_cen_fcc_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{17} pw_g0_th = %d\n", dfs->pw_g0_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{18} pw_long_lower_20m_th = %d\n", -+ dfs->pw_long_lower_20m_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{19} pw_long_lower_th = %d\n", -+ dfs->pw_long_lower_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{20} pri_long_upper_th = %d\n", -+ dfs->pri_long_upper_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{21} pw_long_sum_upper_th = %d\n", -+ dfs->pw_long_sum_upper_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{22} pw_std_th = %d\n", dfs->pw_std_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{23} pw_std_idle_th = %d\n", dfs->pw_std_idle_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{24} pri_std_th = %d\n", dfs->pri_std_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{25} pri_std_idle_th = %d\n", dfs->pri_std_idle_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{26} type4_pw_max_cnt = %d\n", dfs->type4_pw_max_cnt); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{27} type4_safe_pri_sum_th = %d\n", -+ dfs->type4_safe_pri_sum_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{28} fa_mask_th = %d\n", -+ dfs->fa_mask_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{29} nhm_cnt_th = %d\n", -+ dfs->nhm_cnt_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{30} nhm_dty_th = %d\n", -+ dfs->nhm_dty_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{31} pw_flag_en = %d\n", -+ dfs->pw_flag_en); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{32} loct_flag_en = %d\n", -+ dfs->loct_flag_en); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{33} pri_flag_en = %d\n", -+ dfs->pri_flag_en); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{34} pri_var_offset = %d\n", -+ dfs->pri_var_offset); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{35} pri_var_tp_offset = %d\n", -+ dfs->pri_var_tp_offset); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{36} pri_cnt_th = %d\n", -+ dfs->pri_cnt_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{37} loct_diff_th = %d\n", -+ dfs->loct_diff_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{38} dc_cnt_th = %d\n", -+ dfs->dc_cnt_th); -+ } else { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &argv[0]); -+ -+ for (i = 1; i < 5; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &argv[i]); -+ } -+ if (argv[0] == 0) { -+ dfs->pri_hist_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_hist_th = %d\n", -+ dfs->pri_hist_th); -+ } else if (argv[0] == 1) { -+ dfs->pri_sum_g1_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_sum_g1_th = %d\n", -+ dfs->pri_sum_g1_th); -+ } else if (argv[0] == 2) { -+ dfs->pri_sum_g5_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_sum_g5_th = %d\n", -+ dfs->pri_sum_g5_th); -+ } else if (argv[0] == 3) { -+ dfs->pri_sum_g1_fcc_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_sum_g1_fcc_th = %d\n", -+ dfs->pri_sum_g1_fcc_th); -+ } else if (argv[0] == 4) { -+ dfs->pri_sum_g3_fcc_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_sum_g3_fcc_th = %d\n", -+ dfs->pri_sum_g3_fcc_th); -+ } else if (argv[0] == 5) { -+ dfs->pri_sum_safe_fcc_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_sum_safe_fcc_th = %d\n", -+ dfs->pri_sum_safe_fcc_th); -+ } else if (argv[0] == 6) { -+ dfs->pri_sum_type4_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_sum_type4_th = %d\n", -+ dfs->pri_sum_type4_th); -+ } else if (argv[0] == 7) { -+ dfs->pri_sum_type6_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_sum_type6_th = %d\n", -+ dfs->pri_sum_type6_th); -+ } else if (argv[0] == 8) { -+ dfs->pri_sum_safe_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_sum_safe_th = %d\n", -+ dfs->pri_sum_safe_th); -+ } else if (argv[0] == 9) { -+ dfs->pri_sum_g5_under_g1_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_sum_g5_under_g1_th = %d\n", -+ dfs->pri_sum_g5_under_g1_th); -+ } else if (argv[0] == 10) { -+ dfs->pri_pw_diff_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_pw_diff_th = %d\n", -+ dfs->pri_pw_diff_th); -+ } else if (argv[0] == 11) { -+ dfs->pri_pw_diff_fcc_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_pw_diff_fcc_th = %d\n", -+ dfs->pri_pw_diff_fcc_th); -+ } else if (argv[0] == 12) { -+ dfs->pri_pw_diff_fcc_idle_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_pw_diff_fcc_idle_th = %d\n", -+ dfs->pri_pw_diff_fcc_idle_th); -+ } else if (argv[0] == 13) { -+ dfs->pri_pw_diff_w53_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_pw_diff_w53_th = %d\n", -+ dfs->pri_pw_diff_w53_th); -+ } else if (argv[0] == 14) { -+ dfs->pri_type1_low_fcc_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_type1_low_fcc_th = %d\n", -+ dfs->pri_type1_low_fcc_th); -+ } else if (argv[0] == 15) { -+ dfs->pri_type1_upp_fcc_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_type1_upp_fcc_th = %d\n", -+ dfs->pri_type1_upp_fcc_th); -+ } else if (argv[0] == 16) { -+ dfs->pri_type1_cen_fcc_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_type1_cen_fcc_th = %d\n", -+ dfs->pri_type1_cen_fcc_th); -+ } else if (argv[0] == 17) { -+ dfs->pw_g0_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pw_g0_th = %d\n", -+ dfs->pw_g0_th); -+ } else if (argv[0] == 18) { -+ dfs->pw_long_lower_20m_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pw_long_lower_20m_th = %d\n", -+ dfs->pw_long_lower_20m_th); -+ } else if (argv[0] == 19) { -+ dfs->pw_long_lower_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pw_long_lower_th = %d\n", -+ dfs->pw_long_lower_th); -+ } else if (argv[0] == 20) { -+ dfs->pri_long_upper_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_long_upper_th = %d\n", -+ dfs->pri_long_upper_th); -+ } else if (argv[0] == 21) { -+ dfs->pw_long_sum_upper_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pw_long_sum_upper_th = %d\n", -+ dfs->pw_long_sum_upper_th); -+ } else if (argv[0] == 22) { -+ dfs->pw_std_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pw_std_th = %d\n", -+ dfs->pw_std_th); -+ } else if (argv[0] == 23) { -+ dfs->pw_std_idle_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pw_std_idle_th = %d\n", -+ dfs->pw_std_idle_th); -+ } else if (argv[0] == 24) { -+ dfs->pri_std_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_std_th = %d\n", -+ dfs->pri_std_th); -+ } else if (argv[0] == 25) { -+ dfs->pri_std_idle_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_std_idle_th = %d\n", -+ dfs->pri_std_idle_th); -+ } else if (argv[0] == 26) { -+ dfs->type4_pw_max_cnt = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "type4_pw_max_cnt = %d\n", -+ dfs->type4_pw_max_cnt); -+ } else if (argv[0] == 27) { -+ dfs->type4_safe_pri_sum_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "type4_safe_pri_sum_th = %d\n", -+ dfs->type4_safe_pri_sum_th); -+ } else if (argv[0] == 28) { -+ dfs->fa_mask_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fa_mask_th = %d\n", -+ dfs->fa_mask_th); -+ } else if (argv[0] == 29) { -+ dfs->nhm_cnt_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "nhm_cnt_th = %d\n", -+ dfs->nhm_cnt_th); -+ } else if (argv[0] == 30) { -+ dfs->nhm_dty_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "nhm_dty_th = %d\n", -+ dfs->nhm_dty_th); -+ } else if (argv[0] == 31) { -+ dfs->pw_flag_en = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pw_flag_en = %d\n", -+ dfs->pw_flag_en); -+ } else if (argv[0] == 32) { -+ dfs->loct_flag_en = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "loct_flag_en = %d\n", -+ dfs->loct_flag_en); -+ } else if (argv[0] == 33) { -+ dfs->pri_flag_en = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_flag_en = %d\n", -+ dfs->pri_flag_en); -+ } else if (argv[0] == 34) { -+ dfs->pri_var_offset = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_var_offset = %d\n", -+ dfs->pri_var_offset); -+ } else if (argv[0] == 35) { -+ dfs->pri_var_tp_offset = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_var_tp_offset = %d\n", -+ dfs->pri_var_tp_offset); -+ } else if (argv[0] == 36) { -+ dfs->pri_cnt_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pri_cnt_th = %d\n", -+ dfs->pri_cnt_th); -+ } else if (argv[0] == 37) { -+ dfs->loct_diff_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "loct_diff_th = %d\n", -+ dfs->loct_diff_th); -+ } else if (argv[0] == 38) { -+ dfs->dc_cnt_th = (u8)argv[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "dc_cnt_th = %d\n", -+ dfs->dc_cnt_th); -+ } -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_dfs_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 argv[10] = {0}; -+ u8 i, input_idx = 0; -+ -+ for (i = 0; i < 10; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &argv[i]); -+ input_idx++; -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ dfs->dbg_mode = (boolean)argv[0]; -+ dfs->sw_trigger_mode = (boolean)argv[1]; -+ dfs->force_TP_mode = (boolean)argv[2]; -+ dfs->det_print = (boolean)argv[3]; -+ dfs->det_print2 = (boolean)argv[4]; -+ dfs->print_hist_rpt = (boolean)argv[5]; -+ dfs->hist_cond_on = (boolean)argv[6]; -+ dfs->det_print_jar3 = (boolean)argv[7]; -+ dfs->nhm_dfs_en = (boolean)argv[8]; -+ dfs->det_jar3_en = (boolean)argv[9]; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "dbg_mode: %d, sw_trigger_mode: %d, force_TP_mode: %d, det_print: %d, det_print2: %d, print_hist_rpt: %d, hist_cond_on: %d\n, det_print_jar3: %d, nhm_dfs_en: %d, dfs->det_jar3_en: %d\n", -+ dfs->dbg_mode, dfs->sw_trigger_mode, dfs->force_TP_mode, -+ dfs->det_print, dfs->det_print2, dfs->print_hist_rpt, -+ dfs->hist_cond_on, dfs->det_print_jar3, dfs->nhm_dfs_en, -+ dfs->det_jar3_en); -+} -+ -+u8 phydm_dfs_polling_time(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _DFS_STATISTICS *dfs = &dm->dfs; -+ -+ if (dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8822C | ODM_RTL8723F)) -+ dfs->dfs_polling_time = 40; -+ else -+ dfs->dfs_polling_time = 100; -+ -+ return dfs->dfs_polling_time; -+} -+ -+#endif /* @defined(CONFIG_PHYDM_DFS_MASTER) */ -+ -+boolean -+phydm_is_dfs_band(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (((*dm->channel >= 52) && (*dm->channel <= 64)) || -+ ((*dm->channel >= 100) && (*dm->channel <= 144))) -+ return true; -+ else -+ return false; -+} -+ -+boolean -+phydm_dfs_master_enabled(void *dm_void) -+{ -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean ret_val = false; -+ -+ if (dm->dfs_master_enabled) /*pointer protection*/ -+ ret_val = *dm->dfs_master_enabled ? true : false; -+ -+ return ret_val; -+#else -+ return false; -+#endif -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+void phydm_dfs_ap_reset_radar_detect_counter_and_flag(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /* @Clear Radar Counter and Radar flag */ -+ odm_set_bb_reg(dm, R_0xa40, BIT(15), 0); -+ odm_set_bb_reg(dm, R_0xa40, BIT(15), 1); -+ -+ /* RT_TRACE(COMP_DFS, DBG_LOUD, ("[DFS], After reset radar counter, 0xcf8 = 0x%x, 0xcf4 = 0x%x\n", */ -+ /* PHY_QueryBBReg(Adapter, 0xcf8, bMaskDWord), */ -+ /* PHY_QueryBBReg(Adapter, 0xcf4, bMaskDWord))); */ -+} -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dfs.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dfs.h -new file mode 100644 -index 000000000..c63f237a5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dfs.h -@@ -0,0 +1,218 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_DFS_H__ -+#define __PHYDM_DFS_H__ -+ -+#define DFS_VERSION "1.1" -+ -+/*@ -+ * ============================================================ -+ * Definition -+ * ============================================================ -+ */ -+ -+/*@ -+ * ============================================================ -+ * 1 structure -+ * ============================================================ -+ */ -+ -+struct _DFS_STATISTICS { -+ u8 mask_idx; -+ u8 igi_cur; -+ u8 igi_pre; -+ u8 st_l2h_cur; -+ u16 fa_count_pre; -+ u16 fa_inc_hist[5]; -+ u16 short_pulse_cnt_pre; -+ u16 long_pulse_cnt_pre; -+ u8 pwdb_th; -+ u8 pwdb_th_cur; -+ u8 pwdb_scalar_factor; -+ u8 peak_th; -+ u8 short_pulse_cnt_th; -+ u8 long_pulse_cnt_th; -+ u8 peak_window; -+ u8 three_peak_opt; -+ u8 three_peak_th2; -+ u8 fa_mask_th; -+ u8 st_l2h_max; -+ u8 st_l2h_min; -+ u8 dfs_polling_time; -+ u8 mask_hist_checked : 3; -+ boolean pulse_flag_hist[5]; -+ boolean pulse_type_hist[5]; -+ boolean radar_det_mask_hist[5]; -+ boolean idle_mode; -+ boolean force_TP_mode; -+ boolean dbg_mode; -+ boolean sw_trigger_mode; -+ boolean det_print; -+ boolean det_print2; -+ boolean det_print_jar3; -+ boolean det_jar3_en; -+ boolean radar_type; -+ boolean print_hist_rpt; -+ boolean hist_cond_on; -+ /*@dfs histogram*/ -+ boolean pri_cond1; -+ boolean pri_cond2; -+ boolean pri_cond3; -+ boolean pri_cond4; -+ boolean pri_cond5; -+ boolean pw_cond1; -+ boolean pw_cond2; -+ boolean pw_cond3; -+ boolean pri_type3_4_cond1; /*@for ETSI*/ -+ boolean pri_type3_4_cond2; /*@for ETSI*/ -+ boolean pw_long_cond1; /*@for long radar*/ -+ boolean pw_long_cond2; /*@for long radar*/ -+ boolean pri_long_cond1; /*@for long radar*/ -+ boolean pw_flag; -+ boolean pri_flag; -+ boolean loct_flag; -+ boolean pri_type3_4_flag; /*@for ETSI*/ -+ boolean long_radar_flag; -+ u8 pri_hold_sum[6]; -+ u8 pw_hold_sum[6]; -+ u8 pri_long_hold_sum[6]; -+ u8 pw_long_hold_sum[6]; -+ u8 hist_idx; -+ u8 hist_long_idx; -+ u8 pw_hold[4][6]; -+ u8 pri_hold[4][6]; -+ u8 pw_std; /*@The std(var) of reasonable num of pw group*/ -+ u8 pri_std;/*@The std(var) of reasonable num of pri group*/ -+ /*@dfs histogram threshold*/ -+ u8 pri_hist_th : 3; -+ u8 pri_sum_g1_th : 4; -+ u8 pri_sum_g5_th : 4; -+ u8 pri_sum_g1_fcc_th : 3; -+ u8 pri_sum_g3_fcc_th : 3; -+ u8 pri_sum_safe_fcc_th : 7; -+ u8 pri_sum_type4_th : 5; -+ u8 pri_sum_type6_th : 5; -+ u8 pri_sum_safe_th : 6; -+ u8 pri_sum_g5_under_g1_th : 3; -+ u8 pri_pw_diff_th : 3; -+ u8 pri_pw_diff_fcc_th : 4; -+ u8 pri_pw_diff_fcc_idle_th : 2; -+ u8 pri_pw_diff_w53_th : 4; -+ u8 pri_type1_low_fcc_th : 7; -+ u8 pri_type1_upp_fcc_th : 7; -+ u8 pri_type1_cen_fcc_th : 7; -+ u8 pw_g0_th : 4; -+ u8 pw_long_lower_20m_th : 4; -+ u8 pw_long_lower_th : 3; -+ u8 pri_long_upper_th : 6; -+ u8 pw_long_sum_upper_th : 7; -+ u8 pw_std_th : 4; -+ u8 pw_std_idle_th : 4; -+ u8 pri_std_th : 4; -+ u8 pri_std_idle_th : 4; -+ u8 type4_pw_max_cnt : 4; -+ u8 type4_safe_pri_sum_th : 3; -+ u8 pw_rslt[12]; -+ u8 pri_rslt[12]; -+ s8 loct_rslt[12]; -+ /* -+ u8 pw_lth[10]; -+ u8 pri_lth[10]; -+ u16 pw_uth[10]; -+ u8 pri_uth[10]; -+ */ -+ boolean nhm_dfs_en; -+ boolean nhm_dfs_flag; -+ u8 nhm_dfs_cnt; -+ u8 nhm_cnt_th; -+ u8 nhm_dty_th; -+ boolean b_flag; -+ boolean pw_flag_en; -+ boolean loct_flag_en; -+ boolean pri_flag_en; -+ u8 pri_var_offset; -+ u8 pri_var_tp_offset; -+ u8 pri_cnt_th; -+ u8 loct_diff_th; -+ u8 dc_cnt_th; -+}; -+ -+/*@ -+ * ============================================================ -+ * enumeration -+ * ============================================================ -+ */ -+ -+enum phydm_dfs_region_domain { -+ PHYDM_DFS_DOMAIN_UNKNOWN = 0, -+ PHYDM_DFS_DOMAIN_FCC = 1, -+ PHYDM_DFS_DOMAIN_MKK = 2, -+ PHYDM_DFS_DOMAIN_ETSI = 3, -+}; -+ -+/*@ -+ * ============================================================ -+ * function prototype -+ * ============================================================ -+ */ -+#if defined(CONFIG_PHYDM_DFS_MASTER) -+void phydm_radar_detect_reset(void *dm_void); -+void phydm_radar_detect_disable(void *dm_void); -+void phydm_radar_detect_enable(void *dm_void); -+boolean phydm_radar_detect(void *dm_void); -+void phydm_dfs_histogram_radar_distinguish(void *dm_void); -+boolean phydm_dfs_hist_log(void *dm_void, u8 index); -+void phydm_dfs_parameter_init(void *dm_void); -+void phydm_dfs_rpt_distinguish(void *dm_void); -+void phydm_dfs_hist_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+void phydm_dfs_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+u8 phydm_dfs_polling_time(void *dm_void); -+#endif /* @defined(CONFIG_PHYDM_DFS_MASTER) */ -+ -+boolean -+phydm_dfs_is_meteorology_channel(void *dm_void); -+ -+void -+phydm_dfs_segment_distinguish(void *dm_void, enum rf_syn syn_path); -+ -+void -+phydm_dfs_segment_flag_reset(void *dm_void); -+ -+boolean -+phydm_is_dfs_band(void *dm_void); -+ -+boolean -+phydm_dfs_master_enabled(void *dm_void); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+void phydm_dfs_ap_reset_radar_detect_counter_and_flag(void *dm_void); -+#endif -+#endif -+ -+#endif /*@#ifndef __PHYDM_DFS_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dig.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dig.c -new file mode 100644 -index 000000000..3798f989d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dig.c -@@ -0,0 +1,3697 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ * ************************************************************ -+ */ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef CFG_DIG_DAMPING_CHK -+void phydm_dig_recorder_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s ======>\n", __func__); -+ -+ odm_memory_set(dm, &dig_rc->igi_bitmap, 0, -+ sizeof(struct phydm_dig_recorder_strcut)); -+} -+ -+void phydm_dig_recorder(void *dm_void, u8 igi_curr, -+ u32 fa_metrics) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; -+ u8 igi_pre = dig_rc->igi_history[0]; -+ u8 igi_up = 0; -+ -+ if (!dm->is_linked) -+ return; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s ======>\n", __func__); -+ -+ if (dm->first_connect) { -+ phydm_dig_recorder_reset(dm); -+ dig_rc->igi_history[0] = igi_curr; -+ dig_rc->fa_history[0] = fa_metrics; -+ return; -+ } -+ -+ if (igi_curr % 2) -+ igi_curr--; -+ -+ igi_pre = dig_rc->igi_history[0]; -+ igi_up = (igi_curr > igi_pre) ? 1 : 0; -+ dig_rc->igi_bitmap = ((dig_rc->igi_bitmap << 1) & 0xfe) | igi_up; -+ -+ dig_rc->igi_history[3] = dig_rc->igi_history[2]; -+ dig_rc->igi_history[2] = dig_rc->igi_history[1]; -+ dig_rc->igi_history[1] = dig_rc->igi_history[0]; -+ dig_rc->igi_history[0] = igi_curr; -+ -+ dig_rc->fa_history[3] = dig_rc->fa_history[2]; -+ dig_rc->fa_history[2] = dig_rc->fa_history[1]; -+ dig_rc->fa_history[1] = dig_rc->fa_history[0]; -+ dig_rc->fa_history[0] = fa_metrics; -+ -+ PHYDM_DBG(dm, DBG_DIG, "igi_history[3:0] = {0x%x, 0x%x, 0x%x, 0x%x}\n", -+ dig_rc->igi_history[3], dig_rc->igi_history[2], -+ dig_rc->igi_history[1], dig_rc->igi_history[0]); -+ PHYDM_DBG(dm, DBG_DIG, "fa_history[3:0] = {%d, %d, %d, %d}\n", -+ dig_rc->fa_history[3], dig_rc->fa_history[2], -+ dig_rc->fa_history[1], dig_rc->fa_history[0]); -+ PHYDM_DBG(dm, DBG_DIG, "igi_bitmap = {%d, %d, %d, %d} = 0x%x\n", -+ (u8)((dig_rc->igi_bitmap & BIT(3)) >> 3), -+ (u8)((dig_rc->igi_bitmap & BIT(2)) >> 2), -+ (u8)((dig_rc->igi_bitmap & BIT(1)) >> 1), -+ (u8)(dig_rc->igi_bitmap & BIT(0)), -+ dig_rc->igi_bitmap); -+} -+ -+void phydm_dig_damping_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; -+ u8 igi_bitmap_4bit = dig_rc->igi_bitmap & 0xf; -+ u8 diff1 = 0, diff2 = 0; -+ u32 fa_low_th = dig_t->fa_th[0]; -+ u32 fa_high_th = dig_t->fa_th[1]; -+ u32 fa_high_th2 = dig_t->fa_th[2]; -+ u8 fa_pattern_match = 0; -+ u32 time_tmp = 0; -+ -+ if (!dm->is_linked) -+ return; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s ======>\n", __func__); -+ -+ /*@== Release Damping ================================================*/ -+ if (dig_rc->damping_limit_en) { -+ PHYDM_DBG(dm, DBG_DIG, -+ "[Damping Limit!] limit_time=%d, phydm_sys_up_time=%d\n", -+ dig_rc->limit_time, dm->phydm_sys_up_time); -+ -+ time_tmp = dig_rc->limit_time + DIG_LIMIT_PERIOD; -+ -+ if (DIFF_2(dm->rssi_min, dig_rc->limit_rssi) > 3 || -+ time_tmp < dm->phydm_sys_up_time) { -+ dig_rc->damping_limit_en = 0; -+ PHYDM_DBG(dm, DBG_DIG, "rssi_min=%d, limit_rssi=%d\n", -+ dm->rssi_min, dig_rc->limit_rssi); -+ } -+ return; -+ } -+ -+ /*@== Damping Pattern Check===========================================*/ -+ PHYDM_DBG(dm, DBG_DIG, "fa_th{H, L}= {%d,%d}\n", fa_high_th, fa_low_th); -+ -+ switch (igi_bitmap_4bit) { -+ case 0x5: -+ /*@ 4b'0101 -+ * IGI:[3]down(0x24)->[2]up(0x26)->[1]down(0x24)->[0]up(0x26)->[new](Lock @ 0x26) -+ * FA: [3] >high1 ->[2] [1] >high1 ->[0] [new] [2]up(0x28)->[1]down(0x24)->[0]up(0x28)->[new](Lock @ 0x28) -+ * FA: [3] >high2 ->[2] [1] >high2 ->[0] [new] igi_history[0] > dig_rc->igi_history[1]) -+ diff1 = dig_rc->igi_history[0] - dig_rc->igi_history[1]; -+ -+ if (dig_rc->igi_history[2] > dig_rc->igi_history[3]) -+ diff2 = dig_rc->igi_history[2] - dig_rc->igi_history[3]; -+ -+ if (dig_rc->fa_history[0] < fa_low_th && -+ dig_rc->fa_history[1] > fa_high_th && -+ dig_rc->fa_history[2] < fa_low_th && -+ dig_rc->fa_history[3] > fa_high_th) { -+ /*@Check each fa element*/ -+ fa_pattern_match = 1; -+ } -+ break; -+ case 0x9: -+ /*@ 4b'1001 -+ * IGI:[3]up(0x28)->[2]down(0x26)->[1]down(0x24)->[0]up(0x28)->[new](Lock @ 0x28) -+ * FA: [3] [2] [1] >high2 ->[0] [new] igi_history[0] > dig_rc->igi_history[1]) -+ diff1 = dig_rc->igi_history[0] - dig_rc->igi_history[1]; -+ -+ if (dig_rc->igi_history[2] < dig_rc->igi_history[3]) -+ diff2 = dig_rc->igi_history[3] - dig_rc->igi_history[2]; -+ -+ if (dig_rc->fa_history[0] < fa_low_th && -+ dig_rc->fa_history[1] > fa_high_th2 && -+ dig_rc->fa_history[2] < fa_low_th && -+ dig_rc->fa_history[3] < fa_low_th) { -+ /*@Check each fa element*/ -+ fa_pattern_match = 1; -+ } -+ break; -+ default: -+ break; -+ } -+ -+ if (diff1 >= 2 && diff2 >= 2 && fa_pattern_match) { -+ dig_rc->damping_limit_en = 1; -+ dig_rc->damping_limit_val = dig_rc->igi_history[0]; -+ dig_rc->limit_time = dm->phydm_sys_up_time; -+ dig_rc->limit_rssi = dm->rssi_min; -+ -+ PHYDM_DBG(dm, DBG_DIG, -+ "[Start damping_limit!] IGI_dyn_min=0x%x, limit_time=%d, limit_rssi=%d\n", -+ dig_rc->damping_limit_val, -+ dig_rc->limit_time, dig_rc->limit_rssi); -+ } -+ -+ PHYDM_DBG(dm, DBG_DIG, "damping_limit=%d\n", dig_rc->damping_limit_en); -+} -+#endif -+ -+void phydm_fa_threshold_check(void *dm_void, boolean is_dfs_band) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u8 i = 0; -+ -+ dig_t->dm_dig_fa_th1 = DM_DIG_FA_TH1; -+ -+ if (dig_t->is_dbg_fa_th) { -+ PHYDM_DBG(dm, DBG_DIG, "Manual Fix FA_th\n"); -+ } else if (dm->is_linked) { -+ if (dm->rssi_min < 20) { /*@[PHYDM-252]*/ -+ dig_t->fa_th[0] = 500; -+ dig_t->fa_th[1] = 750; -+ dig_t->fa_th[2] = 1000; -+ } else if (((dm->rx_tp >> 2) > dm->tx_tp) && /*Test RX TP*/ -+ (dm->rx_tp < 10) && (dm->rx_tp > 1)) { /*TP=1~10Mb*/ -+ dig_t->fa_th[0] = 125; -+ dig_t->fa_th[1] = 250; -+ dig_t->fa_th[2] = 500; -+ } else { -+ dig_t->fa_th[0] = 250; -+ dig_t->fa_th[1] = 500; -+ dig_t->fa_th[2] = 750; -+ } -+ } else { -+ if (is_dfs_band) { /* @For DFS band and no link */ -+ -+ dig_t->fa_th[0] = 250; -+ dig_t->fa_th[1] = 1000; -+ dig_t->fa_th[2] = 2000; -+ } else { -+ dig_t->fa_th[0] = 2000; -+ dig_t->fa_th[1] = 4000; -+ dig_t->fa_th[2] = 5000; -+ } -+ } -+ -+ if ((dig_t->fa_source >= 1) && (dig_t->fa_source <= 3)) { -+ for (i = 0; i < 3; i++) -+ dig_t->fa_th[i] *= OFDM_FA_EXP_DURATION; -+ -+ dig_t->dm_dig_fa_th1 *= OFDM_FA_EXP_DURATION; -+ } -+ -+ PHYDM_DBG(dm, DBG_DIG, "FA_th={%d,%d,%d}\n", dig_t->fa_th[0], -+ dig_t->fa_th[1], dig_t->fa_th[2]); -+} -+ -+void phydm_set_big_jump_step(void *dm_void, u8 curr_igi) -+{ -+#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u8 step1[8] = {24, 30, 40, 50, 60, 70, 80, 90}; -+ u8 big_jump_lmt = dig_t->big_jump_lmt[dig_t->agc_table_idx]; -+ u8 i; -+ -+ if (dig_t->enable_adjust_big_jump == 0) -+ return; -+ -+ for (i = 0; i <= dig_t->big_jump_step1; i++) { -+ if ((curr_igi + step1[i]) > big_jump_lmt) { -+ if (i != 0) -+ i = i - 1; -+ break; -+ } else if (i == dig_t->big_jump_step1) { -+ break; -+ } -+ } -+ if (dm->support_ic_type & ODM_RTL8822B) -+ odm_set_bb_reg(dm, R_0x8c8, 0xe, i); -+ else if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) -+ odm_set_bb_reg(dm, ODM_REG_BB_AGC_SET_2_11N, 0xe, i); -+ -+ PHYDM_DBG(dm, DBG_DIG, "Bigjump = %d (ori = 0x%x), LMT=0x%x\n", i, -+ dig_t->big_jump_step1, big_jump_lmt); -+#endif -+} -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+void phydm_write_dig_reg_jgr3(void *dm_void, u8 igi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); -+ -+ /* Set IGI value */ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return; -+ -+ odm_set_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_11AC, igi); -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) -+ odm_set_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_B_11AC3, igi); -+ #endif -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { -+ odm_set_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_C_11AC3, igi); -+ odm_set_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_D_11AC3, igi); -+ } -+ #endif -+} -+ -+u8 phydm_get_igi_reg_val_jgr3(void *dm_void, enum bb_path path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 val = 0; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); -+ -+ /* Set IGI value */ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return (u8)val; -+ -+ if (path == BB_PATH_A) -+ val = odm_get_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_11AC); -+#if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ else if (path == BB_PATH_B) -+ val = odm_get_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_B_11AC3); -+#endif -+ -+#if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ else if (path == BB_PATH_C) -+ val = odm_get_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_C_11AC3); -+#endif -+ -+#if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ else if (path == BB_PATH_D) -+ val = odm_get_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_D_11AC3); -+#endif -+ return (u8)val; -+} -+ -+void phydm_fa_cnt_statistics_jgr3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ u32 ret_value = 0; -+ u32 cck_enable = 0; -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return; -+ -+ ret_value = odm_get_bb_reg(dm, R_0x2de4, MASKDWORD); -+ fa_t->cnt_cck_txen = (ret_value & 0xffff); -+ fa_t->cnt_cck_txon = ((ret_value & 0xffff0000) >> 16); -+ ret_value = odm_get_bb_reg(dm, R_0x2de0, MASKDWORD); -+ fa_t->cnt_ofdm_txen = (ret_value & 0xffff); -+ fa_t->cnt_ofdm_txon = ((ret_value & 0xffff0000) >> 16); -+ -+ ret_value = odm_get_bb_reg(dm, R_0x2d20, MASKDWORD); -+ fa_t->cnt_fast_fsync = ret_value & 0xffff; -+ fa_t->cnt_sb_search_fail = (ret_value & 0xffff0000) >> 16; -+ -+ ret_value = odm_get_bb_reg(dm, R_0x2d04, MASKDWORD); -+ fa_t->cnt_parity_fail = (ret_value & 0xffff0000) >> 16; -+ -+ ret_value = odm_get_bb_reg(dm, R_0x2d08, MASKDWORD); -+ fa_t->cnt_rate_illegal = ret_value & 0xffff; -+ fa_t->cnt_crc8_fail = (ret_value & 0xffff0000) >> 16; -+ -+ ret_value = odm_get_bb_reg(dm, R_0x2d10, MASKDWORD); -+ fa_t->cnt_mcs_fail = ret_value & 0xffff; -+ -+ /* read CCK CRC32 counter */ -+ if (dm->support_ic_type & ODM_RTL8723F) -+ ret_value = odm_get_bb_reg(dm, R_0x2aac, MASKDWORD); -+ else -+ ret_value = odm_get_bb_reg(dm, R_0x2c04, MASKDWORD); -+ fa_t->cnt_cck_crc32_ok = ret_value & 0xffff; -+ fa_t->cnt_cck_crc32_error = (ret_value & 0xffff0000) >> 16; -+ -+ /* read OFDM CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, R_0x2c14, MASKDWORD); -+ fa_t->cnt_ofdm_crc32_ok = ret_value & 0xffff; -+ fa_t->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; -+ -+ /* read OFDM2 CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, R_0x2c1c, MASKDWORD); -+ fa_t->cnt_ofdm2_crc32_ok = ret_value & 0xffff; -+ fa_t->cnt_ofdm2_crc32_error = (ret_value & 0xffff0000) >> 16; -+ -+ /* read HT CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, R_0x2c10, MASKDWORD); -+ fa_t->cnt_ht_crc32_ok = ret_value & 0xffff; -+ fa_t->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; -+ -+ /* read HT2 CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, R_0x2c18, MASKDWORD); -+ fa_t->cnt_ht2_crc32_ok = ret_value & 0xffff; -+ fa_t->cnt_ht2_crc32_error = (ret_value & 0xffff0000) >> 16; -+ -+ /*for VHT part */ -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F | -+ ODM_RTL8814B | ODM_RTL8814C)) { -+ /*read VHT CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, R_0x2c0c, MASKDWORD); -+ fa_t->cnt_vht_crc32_ok = ret_value & 0xffff; -+ fa_t->cnt_vht_crc32_error = (ret_value & 0xffff0000) >> 16; -+ -+ /*read VHT2 CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, R_0x2c54, MASKDWORD); -+ fa_t->cnt_vht2_crc32_ok = ret_value & 0xffff; -+ fa_t->cnt_vht2_crc32_error = (ret_value & 0xffff0000) >> 16; -+ -+ ret_value = odm_get_bb_reg(dm, R_0x2d10, MASKDWORD); -+ fa_t->cnt_mcs_fail_vht = (ret_value & 0xffff0000) >> 16; -+ -+ ret_value = odm_get_bb_reg(dm, R_0x2d0c, MASKDWORD); -+ fa_t->cnt_crc8_fail_vhta = ret_value & 0xffff; -+ fa_t->cnt_crc8_fail_vhtb = (ret_value & 0xffff0000) >> 16; -+ } else { -+ fa_t->cnt_vht_crc32_error = 0; -+ fa_t->cnt_vht_crc32_ok = 0; -+ fa_t->cnt_vht2_crc32_error = 0; -+ fa_t->cnt_vht2_crc32_ok = 0; -+ fa_t->cnt_mcs_fail_vht = 0; -+ fa_t->cnt_crc8_fail_vhta = 0; -+ fa_t->cnt_crc8_fail_vhtb = 0; -+ } -+ -+ /* @calculate OFDM FA counter instead of reading brk_cnt*/ -+ fa_t->cnt_ofdm_fail = fa_t->cnt_parity_fail + fa_t->cnt_rate_illegal + -+ fa_t->cnt_crc8_fail + fa_t->cnt_mcs_fail + -+ fa_t->cnt_fast_fsync + fa_t->cnt_sb_search_fail + -+ fa_t->cnt_mcs_fail_vht + fa_t->cnt_crc8_fail_vhta; -+ -+ /* Read CCK FA counter */ -+ if (dm->support_ic_type & ODM_RTL8723F){ -+ ret_value= odm_get_bb_reg(dm, R_0x2aa8, MASKLWORD); -+ fa_t->cnt_cck_fail=(ret_value&0xffff)+((ret_value&0xffff0000)>>16); -+ } -+ else -+ fa_t->cnt_cck_fail = odm_get_bb_reg(dm, R_0x1a5c, MASKLWORD); -+ -+ /* read CCK/OFDM CCA counter */ -+ ret_value = odm_get_bb_reg(dm, R_0x2c08, MASKDWORD); -+ fa_t->cnt_ofdm_cca = ((ret_value & 0xffff0000) >> 16); -+ if (dm->support_ic_type & ODM_RTL8723F) -+ ret_value = odm_get_bb_reg(dm, R_0x2aa0, MASKDWORD); -+ fa_t->cnt_cck_cca = ret_value & 0xffff; -+ -+ /* @CCK RxIQ weighting = 1 => 0x1a14[9:8]=0x0 */ -+ if (dm->support_ic_type & ODM_RTL8723F) -+ cck_enable = odm_get_bb_reg(dm, R_0x2a24, BIT(13)); -+ else -+ cck_enable = odm_get_bb_reg(dm, R_0x1a14, 0x300); -+ -+ if (cck_enable == 0x0) { /* @if(*dm->band_type == ODM_BAND_2_4G) */ -+ fa_t->cnt_all = fa_t->cnt_ofdm_fail + fa_t->cnt_cck_fail; -+ fa_t->cnt_cca_all = fa_t->cnt_cck_cca + fa_t->cnt_ofdm_cca; -+ } else { -+ fa_t->cnt_all = fa_t->cnt_ofdm_fail; -+ fa_t->cnt_cca_all = fa_t->cnt_ofdm_cca; -+ } -+} -+ -+#endif -+ -+void phydm_write_dig_reg_c50(void *dm_void, u8 igi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); -+ -+ odm_set_bb_reg(dm, ODM_REG(IGI_A, dm), ODM_BIT(IGI, dm), igi); -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) -+ odm_set_bb_reg(dm, ODM_REG(IGI_B, dm), ODM_BIT(IGI, dm), igi); -+ #endif -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { -+ odm_set_bb_reg(dm, ODM_REG(IGI_C, dm), ODM_BIT(IGI, dm), igi); -+ odm_set_bb_reg(dm, ODM_REG(IGI_D, dm), ODM_BIT(IGI, dm), igi); -+ } -+ #endif -+} -+ -+void phydm_write_dig_reg(void *dm_void, u8 igi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u8 rf_gain = 0; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_write_dig_reg_jgr3(dm, igi); -+ else -+ #endif -+ phydm_write_dig_reg_c50(dm, igi); -+ -+ #if (RTL8721D_SUPPORT) -+ if (dm->invalid_mode) { -+ if (igi <= 0x10) -+ rf_gain = 0xfa; -+ else if (igi <= 0x40) -+ rf_gain = 0xe3 + 0x20 - (igi >> 1); -+ else if (igi <= 0x50) -+ rf_gain = 0xcb - (igi >> 1); -+ else if (igi <= 0x5e) -+ rf_gain = 0x92 - (igi >> 1); -+ else if (igi <= 0x64) -+ rf_gain = 0x74 - (igi >> 1); -+ else -+ rf_gain = (0x3d > (igi >> 1)) ? (0x3d - (igi >> 1)) : 0; -+ odm_set_bb_reg(dm, R_0x850, 0x1fe0, rf_gain); -+ } -+ #endif -+ -+ if (igi == dig_t->cur_ig_value) -+ dig_t->igi_trend = DIG_STABLE; -+ else if (igi > dig_t->cur_ig_value) -+ dig_t->igi_trend = DIG_INCREASING; -+ else -+ dig_t->igi_trend = DIG_DECREASING; -+ -+ PHYDM_DBG(dm, DBG_DIG, "Update IGI:0x%x -> 0x%x\n", -+ dig_t->cur_ig_value, igi); -+ -+ dig_t->cur_ig_value = igi; -+} -+ -+void odm_write_dig(void *dm_void, u8 new_igi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); -+ -+ /* @1 Check IGI by upper bound */ -+ if (adaptivity->igi_lmt_en && -+ new_igi > adaptivity->adapt_igi_up && dm->is_linked) { -+ new_igi = adaptivity->adapt_igi_up; -+ -+ PHYDM_DBG(dm, DBG_DIG, "Force Adaptivity Up-bound=((0x%x))\n", -+ new_igi); -+ } -+ -+ #if (RTL8192F_SUPPORT) -+ if ((dm->support_ic_type & ODM_RTL8192F) && -+ dm->cut_version == ODM_CUT_A && -+ new_igi > 0x38) { -+ new_igi = 0x38; -+ PHYDM_DBG(dm, DBG_DIG, -+ "Force 92F Adaptivity Up-bound=((0x%x))\n", new_igi); -+ } -+ #endif -+ -+ if (dig_t->cur_ig_value != new_igi) { -+ #if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) -+ /* @Modify big jump step for 8822B and 8197F */ -+ if (dm->support_ic_type & -+ (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F)) -+ phydm_set_big_jump_step(dm, new_igi); -+ #endif -+ -+ #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) -+ /* Set IGI value of CCK for new CCK AGC */ -+ if (dm->cck_new_agc && -+ (dm->support_ic_type & PHYSTS_2ND_TYPE_IC)) -+ odm_set_bb_reg(dm, R_0xa0c, 0x3f00, (new_igi >> 1)); -+ #endif -+ -+ /*@Add by YuChen for USB IO too slow issue*/ -+ if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE) { -+ if (!(dm->support_ic_type & ODM_IC_PWDB_EDCCA)) { -+ if (new_igi < dig_t->cur_ig_value || -+ dm->is_pause_dig) { -+ dig_t->cur_ig_value = new_igi; -+ adaptivity->is_adapt_by_dig = true; -+ phydm_adaptivity(dm); -+ } -+ } else { -+ if (new_igi > dig_t->cur_ig_value) { -+ dig_t->cur_ig_value = new_igi; -+ adaptivity->is_adapt_by_dig = true; -+ phydm_adaptivity(dm); -+ } -+ } -+ } -+ adaptivity->is_adapt_by_dig = false; -+ phydm_write_dig_reg(dm, new_igi); -+ } else { -+ dig_t->igi_trend = DIG_STABLE; -+ } -+ -+ PHYDM_DBG(dm, DBG_DIG, "[%s]New_igi=((0x%x))\n\n", -+ ((dig_t->igi_trend == DIG_STABLE) ? "=" : -+ ((dig_t->igi_trend == DIG_INCREASING) ? "+" : "-")), -+ new_igi); -+} -+ -+u8 phydm_get_igi_reg_val(void *dm_void, enum bb_path path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 val = 0; -+ u32 bit_map = ODM_BIT(IGI, dm); -+ -+ switch (path) { -+ case BB_PATH_A: -+ val = odm_get_bb_reg(dm, ODM_REG(IGI_A, dm), bit_map); -+ break; -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ case BB_PATH_B: -+ val = odm_get_bb_reg(dm, ODM_REG(IGI_B, dm), bit_map); -+ break; -+ #endif -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ case BB_PATH_C: -+ val = odm_get_bb_reg(dm, ODM_REG(IGI_C, dm), bit_map); -+ break; -+ #endif -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ case BB_PATH_D: -+ val = odm_get_bb_reg(dm, ODM_REG(IGI_D, dm), bit_map); -+ break; -+ #endif -+ -+ default: -+ break; -+ } -+ -+ return (u8)val; -+} -+ -+u8 phydm_get_igi(void *dm_void, enum bb_path path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 val = 0; -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ val = phydm_get_igi_reg_val_jgr3(dm, path); -+ else -+ #endif -+ val = phydm_get_igi_reg_val(dm, path); -+ -+ return val; -+} -+ -+void phydm_set_dig_val(void *dm_void, u32 *val_buf, u8 val_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (val_len != 1) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[Error][DIG]Need val_len=1\n"); -+ return; -+ } -+ -+ odm_write_dig(dm, (u8)(*val_buf)); -+} -+ -+void odm_pause_dig(void *dm_void, enum phydm_pause_type type, -+ enum phydm_pause_level lv, u8 igi_input) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rpt = false; -+ u32 igi = (u32)igi_input; -+ -+ PHYDM_DBG(dm, DBG_DIG, "[%s]type=%d, LV=%d, igi=0x%x\n", __func__, type, -+ lv, igi); -+ -+ switch (type) { -+ case PHYDM_PAUSE: -+ case PHYDM_PAUSE_NO_SET: { -+ dm->is_pause_dig = true; -+ rpt = phydm_pause_func(dm, F00_DIG, PHYDM_PAUSE, lv, 1, &igi); -+ break; -+ } -+ -+ case PHYDM_RESUME: { -+ rpt = phydm_pause_func(dm, F00_DIG, PHYDM_RESUME, lv, 1, &igi); -+ dm->is_pause_dig = false; -+ break; -+ } -+ default: -+ PHYDM_DBG(dm, DBG_DIG, "Wrong type\n"); -+ break; -+ } -+ -+ PHYDM_DBG(dm, DBG_DIG, "DIG pause_result=%d\n", rpt); -+} -+ -+boolean -+phydm_dig_abort(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+#endif -+ -+ /* support_ability */ -+ if ((!(dm->support_ability & ODM_BB_FA_CNT)) || -+ (!(dm->support_ability & ODM_BB_DIG))) { -+ PHYDM_DBG(dm, DBG_DIG, "[DIG] Not Support\n"); -+ return true; -+ } -+ -+ if (dm->pause_ability & ODM_BB_DIG) { -+ PHYDM_DBG(dm, DBG_DIG, "Return: Pause DIG in LV=%d\n", -+ dm->pause_lv_table.lv_dig); -+ return true; -+ } -+ -+ if (*dm->is_scan_in_process) { -+ PHYDM_DBG(dm, DBG_DIG, "Return: Scan in process\n"); -+ return true; -+ } -+ -+ if (dm->dm_dig_table.fw_dig_enable) { -+ PHYDM_DBG(dm, DBG_DIG, "Return: FW DIG enable\n"); -+ return true; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if OS_WIN_FROM_WIN7(OS_VERSION) -+ if (IsAPModeExist(adapter) && ((PADAPTER)(adapter))->bInHctTest) { -+ PHYDM_DBG(dm, DBG_DIG, " Return: Is AP mode or In HCT Test\n"); -+ return true; -+ } -+#endif -+#endif -+ -+ return false; -+} -+ -+#ifdef PHYDM_HW_IGI -+#ifdef BB_RAM_SUPPORT -+void phydm_rd_hwigi_pre_setting(void *dm_void, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 igi_ofst = 0x0; -+ u32 t1, t2, t3 = 0x0; -+ -+ igi_ofst = (u8)odm_get_bb_reg(dm, R_0x1e80, MASKBYTE0); -+ t1 = odm_get_bb_reg(dm, R_0x1e80, MASKBYTE1) * 400; -+ t2 = odm_get_bb_reg(dm, R_0x1e80, MASKBYTE2) * 400; -+ t3 = odm_get_bb_reg(dm, R_0x1e80, MASKBYTE3) * 400; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "igi_offset:0x%x, t1:%d(ns), t2:%d(ns), t3:%d(ns)\n", -+ igi_ofst, t1, t2, t3); -+} -+ -+void phydm_set_hwigi_pre_setting(void *dm_void, u8 igi_ofst, u8 t1, u8 t2, -+ u8 t3) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 reg_0x1e80 = 0; -+ -+ reg_0x1e80 = igi_ofst + (t1 << 8) + (t2 << 16) + (t3 << 24); -+ odm_set_bb_reg(dm, R_0x1e80, MASKDWORD, reg_0x1e80); -+} -+ -+void phydm_rd_hwigi_table(void *dm_void, u8 macid, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ boolean hwigi_en = false; -+ u8 hwigi = 0x0; -+ u8 hwigi_rx_offset = 0x0; -+ u32 reg_0x1e84 = 0x0; -+ -+ reg_0x1e84 |= (macid & 0x3f) << 24; /*macid*/ -+ reg_0x1e84 |= BIT(31); /*read_en*/ -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, reg_0x1e84); -+ -+ hwigi_en = (boolean)odm_get_bb_reg(dm, R_0x2de8, BIT(15)); -+ hwigi = (u8)odm_get_bb_reg(dm, R_0x2de8, 0x7f00); -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, 0x0); /* disable rd/wt*/ -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "(macid:%d) hwigi_en:%d, hwigi:0x%x\n", macid, hwigi_en, -+ hwigi); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_wt_hwigi_table(void *dm_void, u8 macid, boolean hwigi_en, u8 hwigi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bb_ram_per_sta *dm_ram_per_sta = NULL; -+ u32 reg_0x1e84 = 0; -+ -+ if (macid > 63) -+ macid = 63; -+ -+ dm_ram_per_sta = &dm->p_bb_ram_ctrl.pram_sta_ctrl[macid]; -+ dm_ram_per_sta->hw_igi_en = hwigi_en; -+ dm_ram_per_sta->hw_igi = hwigi; -+ -+ reg_0x1e84 = (dm_ram_per_sta->tx_pwr_offset0_en << 15) + -+ ((dm_ram_per_sta->tx_pwr_offset0 & 0x7f) << 8) + -+ (dm_ram_per_sta->tx_pwr_offset1_en << 23) + -+ ((dm_ram_per_sta->tx_pwr_offset1 & 0x7f) << 16); -+ -+ reg_0x1e84 |= (hwigi_en << 7) + (hwigi & 0x7f); -+ reg_0x1e84 |= (macid & 0x3f) << 24;/*macid*/ -+ reg_0x1e84 |= BIT(30); /*write_en*/ -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, reg_0x1e84); -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, 0x80000000); /*read_en*/ -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, 0x0); /*disable rd/wt*/ -+} -+ -+void phydm_rst_hwigi(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bb_ram_per_sta *dm_ram_per_sta = NULL; -+ u32 reg_0x1e84 = 0; -+ u8 i = 0; -+ -+ PHYDM_DBG(dm, DBG_DIG, "reset hwigi!\n"); -+ -+ for (i = 0; i < 64; i++) { -+ dm_ram_per_sta = &dm->p_bb_ram_ctrl.pram_sta_ctrl[i]; -+ dm_ram_per_sta->hw_igi_en = false; -+ dm_ram_per_sta->hw_igi = 0x0; -+ -+ reg_0x1e84 = (dm_ram_per_sta->tx_pwr_offset0_en << 15) + -+ ((dm_ram_per_sta->tx_pwr_offset0 & 0x7f) << 8) + -+ (dm_ram_per_sta->tx_pwr_offset1_en << 23) + -+ ((dm_ram_per_sta->tx_pwr_offset1 & 0x7f) << 16); -+ -+ reg_0x1e84 |= (i & 0x3f) << 24; -+ reg_0x1e84 |= BIT(30); -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, reg_0x1e84); -+ } -+ -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, 0x80000000); -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, 0x0); -+} -+ -+void phydm_hwigi_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bb_ram_ctrl *bb_ctrl = &dm->p_bb_ram_ctrl; -+ u8 igi_ofst = 0x0; -+ u8 t1 = 0x0; -+ u8 t2 = 0x0; -+ u8 t3 = 0x0; -+ -+ t1 = 0x55; /*34 us*/ -+ t3 = 0x55; /*34 us*/ -+ -+ bb_ctrl->hwigi_watchdog_en = false; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_set_hwigi_pre_setting(dm, igi_ofst, t1, t2, t3); -+} -+ -+void phydm_hwigi(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = NULL; -+ struct phydm_bb_ram_per_sta *dm_ram_per_sta = NULL; -+ struct rssi_info *rssi = NULL; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_bb_ram_ctrl *bb_ctrl = &dm->p_bb_ram_ctrl; -+ u8 sta_cnt = 0; -+ u8 i = 0; -+ u8 hwigi = 0x0; -+ u8 macid = 0; -+ u8 macid_cnt = 0; -+ u64 macid_cur = 0; -+ u64 macid_diff = 0; -+ u64 macid_mask = 0; -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return; -+ -+ if (!(bb_ctrl->hwigi_watchdog_en)) { -+ return; -+ } -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ sta = dm->phydm_sta_info[i]; -+ if (is_sta_active(sta)) { -+ sta_cnt++; -+ -+ if (sta->mac_id > 63) -+ macid = 63; -+ else -+ macid = sta->mac_id; -+ -+ dm_ram_per_sta = &bb_ctrl->pram_sta_ctrl[macid]; -+ rssi = &sta->rssi_stat; -+ macid_mask = (u64)BIT(sta->mac_id); -+ bb_ctrl->hwigi_macid_is_linked |= macid_mask; -+ macid_cur |= macid_mask; -+ PHYDM_DBG(dm, DBG_DIG, -+ "STA_id=%d, MACID=%d, RSSI=%d, hwigi_en=%d, hwigi=0x%x\n", -+ i, sta->mac_id, rssi->rssi, -+ dm_ram_per_sta->hw_igi_en, -+ dm_ram_per_sta->hw_igi); -+ -+ hwigi = MAX_2((u8)(rssi->rssi + 10), -+ dig_t->cur_ig_value); -+ -+ if (hwigi > DIG_MAX_PERFORMANCE_MODE) -+ hwigi = DIG_MAX_PERFORMANCE_MODE; -+ else if (hwigi < DIG_MIN_PERFORMANCE) -+ hwigi = DIG_MIN_PERFORMANCE; -+ -+ if (dm_ram_per_sta->hw_igi == hwigi) { -+ PHYDM_DBG(dm, DBG_DIG, -+ "hwigi not change!\n"); -+ } else { -+ -+ PHYDM_DBG(dm, DBG_DIG, -+ "hwigi update: ((0x%x)) -> ((0x%x))\n", -+ dm_ram_per_sta->hw_igi, hwigi); -+ -+ phydm_wt_hwigi_table(dm, sta->mac_id, true, hwigi); -+ } -+ -+ if (sta_cnt == dm->number_linked_client) -+ break; -+ } -+ } -+ macid_diff = bb_ctrl->hwigi_macid_is_linked ^ macid_cur; -+ if (macid_diff) -+ bb_ctrl->hwigi_macid_is_linked &= ~macid_diff; -+ while (macid_diff) { -+ if (macid_diff & 0x1) -+ phydm_wt_hwigi_table(dm, macid_cnt, false, 0x0); -+ macid_cnt++; -+ macid_diff >>= 1; -+ } -+} -+ -+void phydm_hwigi_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bb_ram_ctrl *bb_ctrl = &dm->p_bb_ram_ctrl; -+ char help[] = "-h"; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 var1[7] = {0}; -+ u8 i = 0; -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Disable/Enable watchdog : {0/1}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set hwigi pre-setting: {2} {IGI offset} {T1(after data tx)} {T2(after Rx)} {T3(after rsp tx)}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set hwigi table: {3} {en} {value} {macid}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Read hwigi : {4} {macid(0~63), 255:all}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Reset all hwigi : {5}\n"); -+ } else { -+ for (i = 0; i < 7; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var1[i]); -+ } -+ switch (var1[0]) { -+ case 0: -+ case 1: -+ bb_ctrl->hwigi_watchdog_en = (var1[0]) ? true : false; -+ break; -+ case 2: -+ phydm_set_hwigi_pre_setting(dm, (u8)var1[1], -+ (u8)var1[2], (u8)var1[3], -+ (u8)var1[4]); -+ break; -+ case 3: -+ phydm_wt_hwigi_table(dm, (u8)var1[3], (boolean)var1[1], -+ (boolean)var1[2]); -+ break; -+ case 4: -+ phydm_rd_hwigi_pre_setting(dm, &used, output, &out_len); -+ if ((u8)var1[1] == 0xff) -+ for (i = 0; i < 64; i++) -+ phydm_rd_hwigi_table(dm, i, &used, -+ output, &out_len); -+ else -+ phydm_rd_hwigi_table(dm, (u8)var1[1], &used, -+ output, &out_len); -+ break; -+ case 5: -+ phydm_rst_hwigi(dm); -+ break; -+ } -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -+#endif -+ -+void phydm_dig_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ struct phydm_fa_struct *false_alm_cnt = &dm->false_alm_cnt; -+#endif -+ u32 ret_value = 0; -+ u8 i; -+ -+ dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; -+ dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; -+ -+ dig_t->cur_ig_value = phydm_get_igi(dm, BB_PATH_A); -+ -+ dig_t->fa_th[0] = 250; -+ dig_t->fa_th[1] = 500; -+ dig_t->fa_th[2] = 750; -+ dig_t->dm_dig_fa_th1 = DM_DIG_FA_TH1; -+ dig_t->is_dbg_fa_th = false; -+ dig_t->igi_dyn_up_hit = false; -+ dig_t->fw_dig_enable = false; -+ dig_t->fa_source = 0; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ /* @For RTL8881A */ -+ false_alm_cnt->cnt_ofdm_fail_pre = 0; -+#endif -+ -+ dig_t->rx_gain_range_max = DIG_MAX_BALANCE_MODE; -+ dig_t->rx_gain_range_min = dig_t->cur_ig_value; -+ -+#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) -+ if (dm->support_ic_type & -+ (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F)) { -+ dig_t->enable_adjust_big_jump = 1; -+ -+ if (dm->support_ic_type & ODM_RTL8822B) -+ ret_value = odm_get_bb_reg(dm, R_0x8c8, MASKLWORD); -+ else if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) -+ ret_value = odm_get_bb_reg(dm, R_0xc74, MASKLWORD); -+ -+ dig_t->big_jump_step1 = (u8)(ret_value & 0xe) >> 1; -+ dig_t->big_jump_step2 = (u8)(ret_value & 0x30) >> 4; -+ dig_t->big_jump_step3 = (u8)(ret_value & 0xc0) >> 6; -+ -+ for (i = 0; i < sizeof(dig_t->big_jump_lmt); i++) { -+ if (dig_t->big_jump_lmt[i] == 0) -+ dig_t->big_jump_lmt[i] = 0x64; -+ /* Set -10dBm as default value */ -+ } -+ } -+#endif -+ -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ dm->original_dig_restore = true; -+ dm->tdma_dig_state_number = DIG_NUM_OF_TDMA_STATES; -+ dm->tdma_dig_timer_ms = DIG_TIMER_MS; -+ #endif -+ dig_t->tdma_force_l_igi = 0xff; -+ dig_t->tdma_force_h_igi = 0xff; -+#endif -+#ifdef CFG_DIG_DAMPING_CHK -+ phydm_dig_recorder_reset(dm); -+ dig_t->dig_dl_en = 1; -+#endif -+ -+#ifdef PHYDM_HW_IGI -+ phydm_hwigi_init(dm); -+#endif -+} -+void phydm_dig_abs_boundary_decision(struct dm_struct *dm, boolean is_dfs_band) -+{ -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+ -+ if (is_dfs_band) { -+ if (*dm->band_width == CHANNEL_WIDTH_20){ -+ if (dm->support_ic_type & -+ (ODM_RTL8814A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8822B)){ -+ if (odm_get_bb_reg(dm, R_0x8d8, BIT(27)) == 1) -+ dig_t->dm_dig_min = DIG_MIN_DFS + 2; -+ else -+ dig_t->dm_dig_min = DIG_MIN_DFS; -+ } -+ else -+ dig_t->dm_dig_min = DIG_MIN_DFS; -+ } -+ else -+ dig_t->dm_dig_min = DIG_MIN_DFS; -+ -+ dig_t->dig_max_of_min = DIG_MIN_DFS; -+ dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; -+ } else if (!dm->is_linked) { -+ dig_t->dm_dig_max = DIG_MAX_COVERAGR; -+ dig_t->dm_dig_min = DIG_MIN_COVERAGE; -+ } else { -+ if (*dm->bb_op_mode == PHYDM_BALANCE_MODE) { -+ /*service > 2 devices*/ -+ dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; -+ #if (DIG_HW == 1) -+ dig_t->dig_max_of_min = DIG_MIN_COVERAGE; -+ #else -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; -+ #endif -+ } else if (*dm->bb_op_mode == PHYDM_PERFORMANCE_MODE) { -+ /*service 1 devices*/ -+ if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE && -+ dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) -+ /*dig_max shouldn't be too high because of adaptivity*/ -+ dig_t->dm_dig_max = -+ MIN_2((adapt->th_l2h + 30), -+ DIG_MAX_PERFORMANCE_MODE); -+ else -+ dig_t->dm_dig_max = DIG_MAX_PERFORMANCE_MODE; -+ -+ #if (RTL8822B_SUPPORT == 1) -+ if (dm->is_dig_low_bond) -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_PERFORMANCE_MODE_22B; -+ else -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_PERFORMANCE_MODE; -+ #else -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_PERFORMANCE_MODE; -+ #endif -+ } -+ -+ if (dm->support_ic_type & -+ (ODM_RTL8814A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8822B)) -+ dig_t->dm_dig_min = 0x1c; -+ else if (dm->support_ic_type & ODM_RTL8197F) -+ dig_t->dm_dig_min = 0x1e; /*@For HW setting*/ -+ else -+ dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; -+ } -+ -+ PHYDM_DBG(dm, DBG_DIG, "Abs{Max, Min}={0x%x, 0x%x}, Max_of_min=0x%x\n", -+ dig_t->dm_dig_max, dig_t->dm_dig_min, dig_t->dig_max_of_min); -+} -+ -+void phydm_dig_dym_boundary_decision(struct dm_struct *dm, boolean is_dfs_band) -+{ -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+#ifdef CFG_DIG_DAMPING_CHK -+ struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; -+#endif -+ u8 offset = 15, tmp_max = 0; -+ u8 max_of_rssi_min = 0; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s ======>\n", __func__); -+ #if (RTL8822B_SUPPORT == 1) -+ if (dm->is_dig_low_bond) -+ offset = 5; -+ else -+ offset = 15; -+ #else -+ offset = 15; -+ #endif -+ -+ if (!dm->is_linked) { -+ /*@if no link, always stay at lower bound*/ -+ dig_t->rx_gain_range_max = dig_t->dig_max_of_min; -+ dig_t->rx_gain_range_min = dig_t->dm_dig_min; -+ -+ PHYDM_DBG(dm, DBG_DIG, "No-Link, Dyn{Max, Min}={0x%x, 0x%x}\n", -+ dig_t->rx_gain_range_max, dig_t->rx_gain_range_min); -+ return; -+ } -+ -+ PHYDM_DBG(dm, DBG_DIG, "rssi_min=%d, ofst=%d\n", dm->rssi_min, offset); -+ -+ /* @DIG lower bound */ -+ if (is_dfs_band) -+ dig_t->rx_gain_range_min = dig_t->dm_dig_min; -+ else if (dm->rssi_min > dig_t->dig_max_of_min) -+ dig_t->rx_gain_range_min = dig_t->dig_max_of_min; -+ else if (dm->rssi_min < dig_t->dm_dig_min) -+ dig_t->rx_gain_range_min = dig_t->dm_dig_min; -+ else -+ dig_t->rx_gain_range_min = dm->rssi_min; -+ -+#ifdef CFG_DIG_DAMPING_CHK -+ /*@Limit Dyn min by damping*/ -+ if (dig_t->dig_dl_en && -+ dig_rc->damping_limit_en && -+ dig_t->rx_gain_range_min < dig_rc->damping_limit_val) { -+ PHYDM_DBG(dm, DBG_DIG, -+ "[Limit by Damping] Dig_dyn_min=0x%x -> 0x%x\n", -+ dig_t->rx_gain_range_min, dig_rc->damping_limit_val); -+ -+ dig_t->rx_gain_range_min = dig_rc->damping_limit_val; -+ } -+#endif -+ -+ /* @DIG upper bound */ -+ tmp_max = dig_t->rx_gain_range_min + offset; -+ if (dig_t->rx_gain_range_min != dm->rssi_min) { -+ max_of_rssi_min = dm->rssi_min + offset; -+ if (tmp_max > max_of_rssi_min) -+ tmp_max = max_of_rssi_min; -+ } -+ -+ if (tmp_max > dig_t->dm_dig_max) -+ dig_t->rx_gain_range_max = dig_t->dm_dig_max; -+ else if (tmp_max < dig_t->dm_dig_min) -+ dig_t->rx_gain_range_max = dig_t->dm_dig_min; -+ else -+ dig_t->rx_gain_range_max = tmp_max; -+ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ /* @1 Force Lower Bound for AntDiv */ -+ if (!dm->is_one_entry_only && -+ (dm->support_ability & ODM_BB_ANT_DIV) && -+ (dm->ant_div_type == CG_TRX_HW_ANTDIV || -+ dm->ant_div_type == CG_TRX_SMART_ANTDIV)) { -+ if (dig_t->ant_div_rssi_max > dig_t->dig_max_of_min) -+ dig_t->rx_gain_range_min = dig_t->dig_max_of_min; -+ else -+ dig_t->rx_gain_range_min = (u8)dig_t->ant_div_rssi_max; -+ -+ PHYDM_DBG(dm, DBG_DIG, "Force Dyn-Min=0x%x, RSSI_max=0x%x\n", -+ dig_t->rx_gain_range_min, dig_t->ant_div_rssi_max); -+ } -+ #endif -+ -+ PHYDM_DBG(dm, DBG_DIG, "Dyn{Max, Min}={0x%x, 0x%x}\n", -+ dig_t->rx_gain_range_max, dig_t->rx_gain_range_min); -+} -+ -+void phydm_dig_abnormal_case(struct dm_struct *dm) -+{ -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ /* @Abnormal lower bound case */ -+ if (dig_t->rx_gain_range_min > dig_t->rx_gain_range_max) -+ dig_t->rx_gain_range_min = dig_t->rx_gain_range_max; -+ -+ PHYDM_DBG(dm, DBG_DIG, "Abnoraml checked {Max, Min}={0x%x, 0x%x}\n", -+ dig_t->rx_gain_range_max, dig_t->rx_gain_range_min); -+} -+ -+u8 phydm_new_igi_by_fa(struct dm_struct *dm, u8 igi, u32 fa_metrics, -+ u8 *step_size) -+{ -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ if (fa_metrics > dig_t->fa_th[2]) -+ igi = igi + step_size[0]; -+ else if (fa_metrics > dig_t->fa_th[1]) -+ igi = igi + step_size[1]; -+ else if (fa_metrics < dig_t->fa_th[0]) -+ igi = igi - step_size[2]; -+ -+ return igi; -+} -+ -+u8 phydm_get_new_igi(struct dm_struct *dm, u8 igi, u32 fa_metrics, -+ boolean is_dfs_band) -+{ -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u8 step[3] = {0}; -+ -+ if (dm->is_linked) { -+ if (dm->pre_rssi_min <= dm->rssi_min) { -+ PHYDM_DBG(dm, DBG_DIG, "pre_rssi_min <= rssi_min\n"); -+ step[0] = 2; -+ step[1] = 1; -+ step[2] = 2; -+ } else { -+ step[0] = 4; -+ step[1] = 2; -+ step[2] = 2; -+ } -+ } else { -+ step[0] = 2; -+ step[1] = 1; -+ step[2] = 2; -+ } -+ -+ PHYDM_DBG(dm, DBG_DIG, "step = {-%d, +%d, +%d}\n", step[2], step[1], -+ step[0]); -+ -+ if (dm->first_connect) { -+ if (is_dfs_band) { -+ if (dm->rssi_min > DIG_MAX_DFS) -+ igi = DIG_MAX_DFS; -+ else -+ igi = dm->rssi_min; -+ PHYDM_DBG(dm, DBG_DIG, "DFS band:IgiMax=0x%x\n", -+ dig_t->rx_gain_range_max); -+ } else { -+ igi = dig_t->rx_gain_range_min; -+ } -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ #if (RTL8812A_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8812) -+ odm_config_bb_with_header_file(dm, -+ CONFIG_BB_AGC_TAB_DIFF); -+ #endif -+ #endif -+ PHYDM_DBG(dm, DBG_DIG, "First connect: foce IGI=0x%x\n", igi); -+ } else if (dm->is_linked) { -+ PHYDM_DBG(dm, DBG_DIG, "Adjust IGI @ linked\n"); -+ /* @4 Abnormal # beacon case */ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ if (dm->phy_dbg_info.num_qry_beacon_pkt < 5 && -+ fa_metrics < dig_t->dm_dig_fa_th1 && dm->bsta_state && -+ dm->support_ic_type != ODM_RTL8723D && -+ dm->support_ic_type != ODM_RTL8822B && -+ dm->support_ic_type != ODM_RTL8822C) { -+ dig_t->rx_gain_range_min = 0x1c; -+ igi = dig_t->rx_gain_range_min; -+ PHYDM_DBG(dm, DBG_DIG, "Beacon_num=%d,force igi=0x%x\n", -+ dm->phy_dbg_info.num_qry_beacon_pkt, igi); -+ } else { -+ igi = phydm_new_igi_by_fa(dm, igi, fa_metrics, step); -+ } -+ #else -+ igi = phydm_new_igi_by_fa(dm, igi, fa_metrics, step); -+ #endif -+ } else { -+ /* @2 Before link */ -+ PHYDM_DBG(dm, DBG_DIG, "Adjust IGI before link\n"); -+ -+ if (dm->first_disconnect) { -+ igi = dig_t->dm_dig_min; -+ PHYDM_DBG(dm, DBG_DIG, -+ "First disconnect:foce IGI to lower bound\n"); -+ } else { -+ PHYDM_DBG(dm, DBG_DIG, "Pre_IGI=((0x%x)), FA=((%d))\n", -+ igi, fa_metrics); -+ -+ igi = phydm_new_igi_by_fa(dm, igi, fa_metrics, step); -+ } -+ } -+ -+ /*@Check IGI by dyn-upper/lower bound */ -+ if (igi < dig_t->rx_gain_range_min) -+ igi = dig_t->rx_gain_range_min; -+ -+ if (igi >= dig_t->rx_gain_range_max) { -+ igi = dig_t->rx_gain_range_max; -+ dig_t->igi_dyn_up_hit = true; -+ } else { -+ dig_t->igi_dyn_up_hit = false; -+ } -+ PHYDM_DBG(dm, DBG_DIG, "igi_dyn_up_hit=%d\n", -+ dig_t->igi_dyn_up_hit); -+ -+ PHYDM_DBG(dm, DBG_DIG, "fa_metrics = %d, IGI: 0x%x -> 0x%x\n", -+ fa_metrics, dig_t->cur_ig_value, igi); -+ -+ return igi; -+} -+ -+boolean phydm_dig_dfs_mode_en(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean dfs_mode_en = false; -+ -+ /* @Modify lower bound for DFS band */ -+ if (dm->is_dfs_band) { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ dfs_mode_en = true; -+ #else -+ if (phydm_dfs_master_enabled(dm)) -+ dfs_mode_en = true; -+ #endif -+ PHYDM_DBG(dm, DBG_DIG, "In DFS band\n"); -+ } -+ return dfs_mode_en; -+} -+ -+void phydm_dig_fa_source(void *dm_void, u8 fa_source, u32 *fa_metrics) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa = &dm->false_alm_cnt; -+ -+ switch (fa_source) { -+ case 1: -+ *fa_metrics = fa->time_fa_exp; -+ break; -+ #ifdef IFS_CLM_SUPPORT -+ case 2: -+ if (fa->time_fa_ifs_clm) { -+ *fa_metrics = fa->time_fa_ifs_clm; -+ } else { -+ fa_source = 1; -+ *fa_metrics = fa->time_fa_exp; -+ } -+ break; -+ #endif -+ #ifdef FAHM_SUPPORT -+ case 3: -+ if (fa->time_fa_fahm) { -+ *fa_metrics = fa->time_fa_fahm; -+ } else { -+ fa_source = 1; -+ *fa_metrics = fa->time_fa_exp; -+ } -+ break; -+ #endif -+ default: -+ break; -+ } -+ -+ PHYDM_DBG(dm, DBG_DIG, -+ "fa_source:%d, fa_cnt=%d ,time_fa_exp=%d, fa_metrics=%d\n", -+ fa_source, fa->cnt_all, fa->time_fa_exp, *fa_metrics); -+} -+ -+void phydm_dig(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_fa_struct *fa = &dm->false_alm_cnt; -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+ struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc; -+#endif -+ u8 igi = dig_t->cur_ig_value; -+ u8 new_igi = 0x20; -+ u32 fa_metrics = fa->cnt_all; -+ boolean dfs_mode_en = false; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s Start===>\n", __func__); -+ -+ #ifdef PHYDM_DCC_ENHANCE -+ if (dm->dm_dcc_info.dcc_en) { -+ fa_metrics = fa->cnt_ofdm_fail; /*OFDM FA only*/ -+ dig_t->fa_source = 0; -+ } -+ #endif -+ -+ #ifdef PHYDM_TDMA_DIG_SUPPORT -+ if (!(dm->original_dig_restore)) { -+ if (dig_t->cur_ig_value_tdma == 0) -+ dig_t->cur_ig_value_tdma = dig_t->cur_ig_value; -+ -+ igi = dig_t->cur_ig_value_tdma; -+ fa_metrics = falm_cnt_acc->cnt_all_1sec; -+ dig_t->fa_source = 0; -+ } -+ #endif -+ -+ if (phydm_dig_abort(dm)) { -+ dig_t->cur_ig_value = phydm_get_igi(dm, BB_PATH_A); -+ return; -+ } -+ -+ if (dig_t->fa_source) -+ phydm_dig_fa_source(dm, dig_t->fa_source, &fa_metrics); -+ -+ PHYDM_DBG(dm, DBG_DIG, -+ "is_linked=%d, RSSI=%d, 1stConnect=%d, 1stDisconnect=%d\n", -+ dm->is_linked, dm->rssi_min, -+ dm->first_connect, dm->first_disconnect); -+ -+ PHYDM_DBG(dm, DBG_DIG, "DIG ((%s)) mode\n", -+ (*dm->bb_op_mode ? "Balance" : "Performance")); -+ -+ /*@DFS mode enable check*/ -+ dfs_mode_en = phydm_dig_dfs_mode_en(dm); -+ -+#ifdef CFG_DIG_DAMPING_CHK -+ /*Record IGI History*/ -+ phydm_dig_recorder(dm, igi, fa_metrics); -+ -+ /*@DIG Damping Check*/ -+ phydm_dig_damping_chk(dm); -+#endif -+ -+ /*@Absolute Boundary Decision */ -+ phydm_dig_abs_boundary_decision(dm, dfs_mode_en); -+ -+ /*@Dynamic Boundary Decision*/ -+ phydm_dig_dym_boundary_decision(dm, dfs_mode_en); -+ -+ /*@Abnormal case check*/ -+ phydm_dig_abnormal_case(dm); -+ -+ /*@FA threshold decision */ -+ phydm_fa_threshold_check(dm, dfs_mode_en); -+ -+ /*Select new IGI by FA */ -+ new_igi = phydm_get_new_igi(dm, igi, fa_metrics, dfs_mode_en); -+ -+ /* @1 Update status */ -+ #ifdef PHYDM_TDMA_DIG_SUPPORT -+ if (!(dm->original_dig_restore)) { -+ dig_t->cur_ig_value_tdma = new_igi; -+ /*@It is possible fa_acc_1sec_tsf >= */ -+ /*@1sec while tdma_dig_state == 0*/ -+ if (dig_t->tdma_dig_state != 0) -+ odm_write_dig(dm, dig_t->cur_ig_value_tdma); -+ } else -+ #endif -+ odm_write_dig(dm, new_igi); -+} -+ -+void phydm_dig_lps_32k(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 current_igi = dm->rssi_min; -+ -+ odm_write_dig(dm, current_igi); -+} -+ -+void phydm_dig_by_rssi_lps(void *dm_void) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *falm_cnt; -+ -+ u8 rssi_lower = DIG_MIN_LPS; /* @0x1E or 0x1C */ -+ u8 current_igi = dm->rssi_min; -+ -+ falm_cnt = &dm->false_alm_cnt; -+ if (phydm_dig_abort(dm)) -+ return; -+ -+ current_igi = current_igi + RSSI_OFFSET_DIG_LPS; -+ PHYDM_DBG(dm, DBG_DIG, "%s==>\n", __func__); -+ -+ /* Using FW PS mode to make IGI */ -+ /* @Adjust by FA in LPS MODE */ -+ if (falm_cnt->cnt_all > DM_DIG_FA_TH2_LPS) -+ current_igi = current_igi + 4; -+ else if (falm_cnt->cnt_all > DM_DIG_FA_TH1_LPS) -+ current_igi = current_igi + 2; -+ else if (falm_cnt->cnt_all < DM_DIG_FA_TH0_LPS) -+ current_igi = current_igi - 2; -+ -+ /* @Lower bound checking */ -+ -+ /* RSSI Lower bound check */ -+ if ((dm->rssi_min - 10) > DIG_MIN_LPS) -+ rssi_lower = (dm->rssi_min - 10); -+ else -+ rssi_lower = DIG_MIN_LPS; -+ -+ /* Upper and Lower Bound checking */ -+ if (current_igi > DIG_MAX_LPS) -+ current_igi = DIG_MAX_LPS; -+ else if (current_igi < rssi_lower) -+ current_igi = rssi_lower; -+ -+ PHYDM_DBG(dm, DBG_DIG, "fa_cnt_all=%d, rssi_min=%d, curr_igi=0x%x\n", -+ falm_cnt->cnt_all, dm->rssi_min, current_igi); -+ odm_write_dig(dm, current_igi); -+#endif -+} -+ -+void phydm_get_dig_coverage(void *dm_void, u8 *max, u8 *min) -+{ -+ *min = DIG_MIN_COVERAGE; -+ *max = DIG_MAX_PERFORMANCE_MODE; -+} -+ -+u8 phydm_get_igi_for_target_pin_scan(void *dm_void, u8 rssi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 igi = 0; -+ u8 max = 0; -+ u8 min = 0; -+ -+ igi = rssi + 10; -+ -+ phydm_get_dig_coverage(dm, &max, &min); -+ -+ if (igi > max) -+ igi = max; -+ else if (igi < min) -+ igi = min; -+ -+ return igi; -+} -+ -+/* @3============================================================ -+ * 3 FASLE ALARM CHECK -+ * 3============================================================ -+ */ -+void phydm_false_alarm_counter_reg_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc; -+#endif -+ u32 false_alm_cnt = 0; -+ -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+ if (!(dm->original_dig_restore)) { -+ if (dig_t->cur_ig_value_tdma == 0) -+ dig_t->cur_ig_value_tdma = dig_t->cur_ig_value; -+ -+ false_alm_cnt = falm_cnt_acc->cnt_all_1sec; -+ } else -+#endif -+ { -+ false_alm_cnt = falm_cnt->cnt_all; -+ } -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ /* @reset CCK FA and CCA counter */ -+ odm_set_bb_reg(dm, R_0x2a44, BIT(21), 0); -+ odm_set_bb_reg(dm, R_0x2a44, BIT(21), 1); -+ } else { -+ /* @reset CCK FA counter */ -+ odm_set_bb_reg(dm, R_0x1a2c, BIT(15) | BIT(14), 0); -+ odm_set_bb_reg(dm, R_0x1a2c, BIT(15) | BIT(14), 2); -+ -+ /* @reset CCK CCA counter */ -+ odm_set_bb_reg(dm, R_0x1a2c, BIT(13) | BIT(12), 0); -+ odm_set_bb_reg(dm, R_0x1a2c, BIT(13) | BIT(12), 2); -+ } -+ /* @Disable common rx clk gating => WLANBB-1106*/ -+ odm_set_bb_reg(dm, R_0x1d2c, BIT(31), 0); -+ /* @reset OFDM CCA counter, OFDM FA counter*/ -+ phydm_reset_bb_hw_cnt(dm); -+ /* @Enable common rx clk gating => WLANBB-1106*/ -+ odm_set_bb_reg(dm, R_0x1d2c, BIT(31), 1); -+ } -+#endif -+#if (ODM_IC_11N_SERIES_SUPPORT) -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ /* @reset false alarm counter registers*/ -+ odm_set_bb_reg(dm, R_0xc0c, BIT(31), 1); -+ odm_set_bb_reg(dm, R_0xc0c, BIT(31), 0); -+ odm_set_bb_reg(dm, R_0xd00, BIT(27), 1); -+ odm_set_bb_reg(dm, R_0xd00, BIT(27), 0); -+ -+ /* @update ofdm counter*/ -+ /* @update page C counter*/ -+ odm_set_bb_reg(dm, R_0xc00, BIT(31), 0); -+ /* @update page D counter*/ -+ odm_set_bb_reg(dm, R_0xd00, BIT(31), 0); -+ -+ /* @reset CCK CCA counter*/ -+ odm_set_bb_reg(dm, R_0xa2c, BIT(13) | BIT(12), 0); -+ odm_set_bb_reg(dm, R_0xa2c, BIT(13) | BIT(12), 2); -+ -+ /* @reset CCK FA counter*/ -+ odm_set_bb_reg(dm, R_0xa2c, BIT(15) | BIT(14), 0); -+ odm_set_bb_reg(dm, R_0xa2c, BIT(15) | BIT(14), 2); -+ -+ /* @reset CRC32 counter*/ -+ odm_set_bb_reg(dm, R_0xf14, BIT(16), 1); -+ odm_set_bb_reg(dm, R_0xf14, BIT(16), 0); -+ } -+#endif /* @#if (ODM_IC_11N_SERIES_SUPPORT) */ -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT) -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ #if (RTL8881A_SUPPORT) -+ /* @Reset FA counter by enable/disable OFDM */ -+ if ((dm->support_ic_type == ODM_RTL8881A) && -+ false_alm_cnt->cnt_ofdm_fail_pre >= 0x7fff) { -+ /* reset OFDM */ -+ odm_set_bb_reg(dm, R_0x808, BIT(29), 0); -+ odm_set_bb_reg(dm, R_0x808, BIT(29), 1); -+ false_alm_cnt->cnt_ofdm_fail_pre = 0; -+ PHYDM_DBG(dm, DBG_FA_CNT, "Reset FA_cnt\n"); -+ } -+ #endif /* @#if (RTL8881A_SUPPORT) */ -+ -+ /* @reset OFDM FA countner */ -+ odm_set_bb_reg(dm, R_0x9a4, BIT(17), 1); -+ odm_set_bb_reg(dm, R_0x9a4, BIT(17), 0); -+ -+ /* @reset CCK FA counter */ -+ odm_set_bb_reg(dm, R_0xa2c, BIT(15), 0); -+ odm_set_bb_reg(dm, R_0xa2c, BIT(15), 1); -+ -+ /* @reset CCA counter */ -+ phydm_reset_bb_hw_cnt(dm); -+ } -+#endif /* @#if (ODM_IC_11AC_SERIES_SUPPORT) */ -+} -+ -+void phydm_false_alarm_counter_reg_hold(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_RTL8723F) -+ return; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ /* @hold cck counter */ -+ odm_set_bb_reg(dm, R_0x1a2c, BIT(12), 1); -+ odm_set_bb_reg(dm, R_0x1a2c, BIT(14), 1); -+ } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ /*@hold ofdm counter*/ -+ /*@hold page C counter*/ -+ odm_set_bb_reg(dm, R_0xc00, BIT(31), 1); -+ /*@hold page D counter*/ -+ odm_set_bb_reg(dm, R_0xd00, BIT(31), 1); -+ -+ /*@hold cck counter*/ -+ odm_set_bb_reg(dm, R_0xa2c, BIT(12), 1); -+ odm_set_bb_reg(dm, R_0xa2c, BIT(14), 1); -+ } -+} -+ -+#if (ODM_IC_11N_SERIES_SUPPORT) -+void phydm_fa_cnt_statistics_n(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ u32 reg = 0; -+ -+ if (!(dm->support_ic_type & ODM_IC_11N_SERIES)) -+ return; -+ -+ /* @hold ofdm & cck counter */ -+ phydm_false_alarm_counter_reg_hold(dm); -+ -+ reg = odm_get_bb_reg(dm, R_0x9d0, MASKDWORD); -+ fa_t->cnt_cck_txon = (reg & 0xffff); -+ fa_t->cnt_cck_txen = ((reg & 0xffff0000) >> 16); -+ reg = odm_get_bb_reg(dm, R_0x9cc, MASKDWORD); -+ fa_t->cnt_ofdm_txon = (reg & 0xffff); -+ fa_t->cnt_ofdm_txen = ((reg & 0xffff0000) >> 16); -+ -+ reg = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE1_11N, MASKDWORD); -+ fa_t->cnt_fast_fsync = (reg & 0xffff); -+ fa_t->cnt_sb_search_fail = ((reg & 0xffff0000) >> 16); -+ -+ reg = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE2_11N, MASKDWORD); -+ fa_t->cnt_ofdm_cca = (reg & 0xffff); -+ fa_t->cnt_parity_fail = ((reg & 0xffff0000) >> 16); -+ -+ reg = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE3_11N, MASKDWORD); -+ fa_t->cnt_rate_illegal = (reg & 0xffff); -+ fa_t->cnt_crc8_fail = ((reg & 0xffff0000) >> 16); -+ -+ reg = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE4_11N, MASKDWORD); -+ fa_t->cnt_mcs_fail = (reg & 0xffff); -+ -+ fa_t->cnt_ofdm_fail = -+ fa_t->cnt_parity_fail + fa_t->cnt_rate_illegal + -+ fa_t->cnt_crc8_fail + fa_t->cnt_mcs_fail + -+ fa_t->cnt_fast_fsync + fa_t->cnt_sb_search_fail; -+ -+ /* read CCK CRC32 counter */ -+ fa_t->cnt_cck_crc32_error = odm_get_bb_reg(dm, R_0xf84, MASKDWORD); -+ fa_t->cnt_cck_crc32_ok = odm_get_bb_reg(dm, R_0xf88, MASKDWORD); -+ -+ /* read OFDM CRC32 counter */ -+ reg = odm_get_bb_reg(dm, ODM_REG_OFDM_CRC32_CNT_11N, MASKDWORD); -+ fa_t->cnt_ofdm_crc32_error = (reg & 0xffff0000) >> 16; -+ fa_t->cnt_ofdm_crc32_ok = reg & 0xffff; -+ -+ /* read OFDM2 CRC32 counter */ -+ reg = odm_get_bb_reg(dm, R_0xf9c, MASKDWORD); -+ fa_t->cnt_ofdm_crc32_error = (reg & 0xffff0000) >> 16; -+ fa_t->cnt_ofdm2_crc32_ok = reg & 0xffff; -+ -+ /* read HT CRC32 counter */ -+ reg = odm_get_bb_reg(dm, ODM_REG_HT_CRC32_CNT_11N, MASKDWORD); -+ fa_t->cnt_ht_crc32_error = (reg & 0xffff0000) >> 16; -+ fa_t->cnt_ht_crc32_ok = reg & 0xffff; -+ -+ /* read HT2 CRC32 counter */ -+ reg = odm_get_bb_reg(dm, R_0xf98, MASKDWORD); -+ fa_t->cnt_ht_crc32_error = (reg & 0xffff0000) >> 16; -+ fa_t->cnt_ht2_crc32_ok = reg & 0xffff; -+ -+ /* read VHT CRC32 counter */ -+ fa_t->cnt_vht_crc32_error = 0; -+ fa_t->cnt_vht_crc32_ok = 0; -+ -+ #if (RTL8723D_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8723D) { -+ /* read HT CRC32 agg counter */ -+ reg = odm_get_bb_reg(dm, R_0xfb8, MASKDWORD); -+ fa_t->cnt_ht_crc32_error_agg = (reg & 0xffff0000) >> 16; -+ fa_t->cnt_ht_crc32_ok_agg = reg & 0xffff; -+ } -+ #endif -+ -+ #if (RTL8188E_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8188E) { -+ reg = odm_get_bb_reg(dm, ODM_REG_SC_CNT_11N, MASKDWORD); -+ fa_t->cnt_bw_lsc = (reg & 0xffff); -+ fa_t->cnt_bw_usc = ((reg & 0xffff0000) >> 16); -+ } -+ #endif -+ -+ reg = odm_get_bb_reg(dm, ODM_REG_CCK_FA_LSB_11N, MASKBYTE0); -+ fa_t->cnt_cck_fail = reg; -+ -+ reg = odm_get_bb_reg(dm, ODM_REG_CCK_FA_MSB_11N, MASKBYTE3); -+ fa_t->cnt_cck_fail += (reg & 0xff) << 8; -+ -+ reg = odm_get_bb_reg(dm, ODM_REG_CCK_CCA_CNT_11N, MASKDWORD); -+ fa_t->cnt_cck_cca = ((reg & 0xFF) << 8) | ((reg & 0xFF00) >> 8); -+ -+ fa_t->cnt_all_pre = fa_t->cnt_all; -+ -+ fa_t->cnt_all = fa_t->cnt_fast_fsync + -+ fa_t->cnt_sb_search_fail + -+ fa_t->cnt_parity_fail + -+ fa_t->cnt_rate_illegal + -+ fa_t->cnt_crc8_fail + -+ fa_t->cnt_mcs_fail + -+ fa_t->cnt_cck_fail; -+ -+ fa_t->cnt_cca_all = fa_t->cnt_ofdm_cca + fa_t->cnt_cck_cca; -+} -+#endif -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT) -+void phydm_fa_cnt_statistics_ac(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ u32 ret_value = 0; -+ u32 cck_enable = 0; -+ -+ if (!(dm->support_ic_type & ODM_IC_11AC_SERIES)) -+ return; -+ -+ ret_value = odm_get_bb_reg(dm, R_0xf50, MASKDWORD); -+ fa_t->cnt_cck_txen = (ret_value & 0xffff); -+ fa_t->cnt_ofdm_txen = ((ret_value & 0xffff0000) >> 16); -+ fa_t->cnt_cck_txon = (u16)odm_get_bb_reg(dm, R_0xfcc, MASKLWORD); -+ fa_t->cnt_ofdm_txon = (u16)odm_get_bb_reg(dm, R_0xfc8, MASKHWORD); -+ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE1_11AC, MASKDWORD); -+ fa_t->cnt_fast_fsync = (ret_value & 0xffff0000) >> 16; -+ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE2_11AC, MASKDWORD); -+ fa_t->cnt_sb_search_fail = ret_value & 0xffff; -+ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE3_11AC, MASKDWORD); -+ fa_t->cnt_parity_fail = ret_value & 0xffff; -+ fa_t->cnt_rate_illegal = (ret_value & 0xffff0000) >> 16; -+ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE4_11AC, MASKDWORD); -+ fa_t->cnt_crc8_fail = ret_value & 0xffff; -+ fa_t->cnt_mcs_fail = (ret_value & 0xffff0000) >> 16; -+ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE5_11AC, MASKDWORD); -+ fa_t->cnt_crc8_fail_vhta = ret_value & 0xffff; -+ fa_t->cnt_crc8_fail_vhtb = ret_value & 0xffff0000 >> 16; -+ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE6_11AC, MASKDWORD); -+ fa_t->cnt_mcs_fail_vht = ret_value & 0xffff; -+ -+ /* read OFDM FA counter */ -+ fa_t->cnt_ofdm_fail = odm_get_bb_reg(dm, R_0xf48, MASKLWORD); -+ -+ /* Read CCK FA counter */ -+ fa_t->cnt_cck_fail = odm_get_bb_reg(dm, ODM_REG_CCK_FA_11AC, MASKLWORD); -+ -+ /* read CCK/OFDM CCA counter */ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_CCK_CCA_CNT_11AC, MASKDWORD); -+ fa_t->cnt_ofdm_cca = (ret_value & 0xffff0000) >> 16; -+ fa_t->cnt_cck_cca = ret_value & 0xffff; -+ -+ /* read CCK CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_CCK_CRC32_CNT_11AC, MASKDWORD); -+ fa_t->cnt_cck_crc32_error = (ret_value & 0xffff0000) >> 16; -+ fa_t->cnt_cck_crc32_ok = ret_value & 0xffff; -+ -+ /* read OFDM CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_CRC32_CNT_11AC, MASKDWORD); -+ fa_t->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; -+ fa_t->cnt_ofdm_crc32_ok = ret_value & 0xffff; -+ -+ /* read OFDM2 CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, R_0xf1c, MASKDWORD); -+ fa_t->cnt_ofdm2_crc32_ok = ret_value & 0xffff; -+ fa_t->cnt_ofdm2_crc32_error = (ret_value & 0xffff0000) >> 16; -+ -+ /* read HT CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_HT_CRC32_CNT_11AC, MASKDWORD); -+ fa_t->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; -+ fa_t->cnt_ht_crc32_ok = ret_value & 0xffff; -+ -+ /* read HT2 CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, R_0xf18, MASKDWORD); -+ fa_t->cnt_ht2_crc32_ok = ret_value & 0xffff; -+ fa_t->cnt_ht2_crc32_error = (ret_value & 0xffff0000) >> 16; -+ -+ /* read VHT CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, ODM_REG_VHT_CRC32_CNT_11AC, MASKDWORD); -+ fa_t->cnt_vht_crc32_error = (ret_value & 0xffff0000) >> 16; -+ fa_t->cnt_vht_crc32_ok = ret_value & 0xffff; -+ -+ /*read VHT2 CRC32 counter */ -+ ret_value = odm_get_bb_reg(dm, R_0xf54, MASKDWORD); -+ fa_t->cnt_vht2_crc32_ok = ret_value & 0xffff; -+ fa_t->cnt_vht2_crc32_error = (ret_value & 0xffff0000) >> 16; -+ -+ #if (RTL8881A_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8881A) { -+ u32 tmp = 0; -+ -+ if (fa_t->cnt_ofdm_fail >= fa_t->cnt_ofdm_fail_pre) { -+ tmp = fa_t->cnt_ofdm_fail_pre; -+ fa_t->cnt_ofdm_fail_pre = fa_t->cnt_ofdm_fail; -+ fa_t->cnt_ofdm_fail = fa_t->cnt_ofdm_fail - tmp; -+ } else { -+ fa_t->cnt_ofdm_fail_pre = fa_t->cnt_ofdm_fail; -+ } -+ -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[8881]cnt_ofdm_fail{curr,pre}={%d,%d}\n", -+ fa_t->cnt_ofdm_fail_pre, tmp); -+ } -+ #endif -+ -+ cck_enable = odm_get_bb_reg(dm, ODM_REG_BB_RX_PATH_11AC, BIT(28)); -+ -+ if (cck_enable) { /* @if(*dm->band_type == ODM_BAND_2_4G) */ -+ fa_t->cnt_all = fa_t->cnt_ofdm_fail + fa_t->cnt_cck_fail; -+ fa_t->cnt_cca_all = fa_t->cnt_cck_cca + fa_t->cnt_ofdm_cca; -+ } else { -+ fa_t->cnt_all = fa_t->cnt_ofdm_fail; -+ fa_t->cnt_cca_all = fa_t->cnt_ofdm_cca; -+ } -+} -+#endif -+ -+u32 phydm_get_edcca_report(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ u32 dbg_port = dm->adaptivity.adaptivity_dbg_port; -+ u32 val = 0; -+ -+ if (dm->support_ic_type & ODM_RTL8723D) { -+ val = odm_get_bb_reg(dm, R_0x9a0, BIT(29)); -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ val = odm_get_bb_reg(dm, R_0x2d38, BIT(24)); -+ } else if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, dbg_port)) { -+ if (dm->support_ic_type & (ODM_RTL8723B | ODM_RTL8188E)) -+ val = (phydm_get_bb_dbg_port_val(dm) & BIT(30)) >> 30; -+ else -+ val = (phydm_get_bb_dbg_port_val(dm) & BIT(29)) >> 29; -+ phydm_release_bb_dbg_port(dm); -+ } -+ -+ return val; -+} -+ -+void phydm_get_dbg_port_info(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ fa_t->dbg_port0 = odm_get_bb_reg(dm, R_0x2db4, MASKDWORD); -+ } else { -+ /*set debug port to 0x0*/ -+ if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x0)) { -+ fa_t->dbg_port0 = phydm_get_bb_dbg_port_val(dm); -+ phydm_release_bb_dbg_port(dm); -+ } -+ } -+ -+ fa_t->edcca_flag = (boolean)phydm_get_edcca_report(dm); -+ -+ PHYDM_DBG(dm, DBG_FA_CNT, "FA_Cnt: Dbg port 0x0 = 0x%x, EDCCA = %d\n", -+ fa_t->dbg_port0, fa_t->edcca_flag); -+} -+ -+void phydm_set_crc32_cnt2_rate(void *dm_void, u8 rate_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ boolean is_ofdm_rate = phydm_is_ofdm_rate(dm, rate_idx); -+ boolean is_ht_rate = phydm_is_ht_rate(dm, rate_idx); -+ boolean is_vht_rate = phydm_is_vht_rate(dm, rate_idx); -+ u32 reg_addr = 0x0; -+ u32 ofdm_rate_bitmask = 0x0; -+ u32 ht_mcs_bitmask = 0x0; -+ u32 vht_mcs_bitmask = 0x0; -+ u32 vht_ss_bitmask = 0x0; -+ u8 rate = 0x0; -+ u8 ss = 0x0; -+ -+ if (!is_ofdm_rate && !is_ht_rate && !is_vht_rate) -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[FA CNT] rate_idx = (0x%x) is not supported !\n", -+ rate_idx); -+ -+ switch (dm->ic_ip_series) { -+ case PHYDM_IC_N: -+ reg_addr = R_0xf04; -+ ofdm_rate_bitmask = 0x0000f000; -+ ht_mcs_bitmask = 0x007f0000; -+ break; -+ case PHYDM_IC_AC: -+ reg_addr = R_0xb04; -+ ofdm_rate_bitmask = 0x0000f000; -+ ht_mcs_bitmask = 0x007f0000; -+ vht_mcs_bitmask = 0x0f000000; -+ vht_ss_bitmask = 0x30000000; -+ break; -+ case PHYDM_IC_JGR3: -+ reg_addr = R_0x1eb8; -+ ofdm_rate_bitmask = 0x00000f00; -+ ht_mcs_bitmask = 0x007f0000; -+ vht_mcs_bitmask = 0x0000f000; -+ vht_ss_bitmask = 0x000000c0; -+ break; -+ default: -+ break; -+ } -+ -+ if (is_ofdm_rate) { -+ rate = phydm_legacy_rate_2_spec_rate(dm, rate_idx); -+ -+ odm_set_bb_reg(dm, reg_addr, ofdm_rate_bitmask, rate); -+ fa_t->ofdm2_rate_idx = rate_idx; -+ } else if (is_ht_rate) { -+ rate = phydm_rate_2_rate_digit(dm, rate_idx); -+ -+ odm_set_bb_reg(dm, reg_addr, ht_mcs_bitmask, rate); -+ fa_t->ht2_rate_idx = rate_idx; -+ } else if (is_vht_rate) { -+ rate = phydm_rate_2_rate_digit(dm, rate_idx); -+ ss = phydm_rate_to_num_ss(dm, rate_idx); -+ -+ odm_set_bb_reg(dm, reg_addr, vht_mcs_bitmask, rate); -+ odm_set_bb_reg(dm, reg_addr, vht_ss_bitmask, ss - 1); -+ fa_t->vht2_rate_idx = rate_idx; -+ } -+} -+ -+void phydm_fa_cnt_cal_fa_duration(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ u8 norm = 0; /*normalization*/ -+ boolean fahm_chk = false; -+ -+ fa_t->time_fa_all = fa_t->cnt_fast_fsync * 12 + -+ fa_t->cnt_sb_search_fail * 12 + -+ fa_t->cnt_parity_fail * 28 + -+ fa_t->cnt_rate_illegal * 28 + -+ fa_t->cnt_crc8_fail * 20 + -+ fa_t->cnt_crc8_fail_vhta * 28 + -+ fa_t->cnt_mcs_fail_vht * 36 + -+ fa_t->cnt_mcs_fail * 32 + -+ fa_t->cnt_cck_fail * 80; -+ -+ fa_t->time_fa_exp = fa_t->cnt_ofdm_fail * OFDM_FA_EXP_DURATION + -+ fa_t->cnt_cck_fail * CCK_FA_EXP_DURATION; -+ -+ fa_t->time_fa_ifs_clm = 0; -+ fa_t->time_fa_fahm = 0; -+ -+ #ifdef IFS_CLM_SUPPORT -+ if (ccx->ccx_watchdog_result & IFS_CLM_SUCCESS) { -+ norm = (u8)PHYDM_DIV(PHYDM_WATCH_DOG_PERIOD * S_TO_US, -+ ccx->ifs_clm_period); -+ fa_t->time_fa_ifs_clm = (ccx->ifs_clm_cckfa + -+ ccx->ifs_clm_ofdmfa) * norm; -+ } -+ #endif -+ -+ #ifdef FAHM_SUPPORT -+ if (ccx->ccx_watchdog_result & FAHM_SUCCESS) { -+ if (fa_t->cnt_cck_fail) { -+ if (ccx->fahm_inclu_cck) -+ fahm_chk = true; -+ } else { -+ fahm_chk = true; -+ } -+ } -+ -+ if (fahm_chk) { -+ norm = (u8)PHYDM_DIV(PHYDM_WATCH_DOG_PERIOD * S_TO_US, -+ ccx->fahm_period); -+ fa_t->time_fa_fahm = ccx->fahm_result_sum * norm; -+ } -+ #endif -+} -+ -+void phydm_false_alarm_counter_statistics(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; -+ char dbg_buf[PHYDM_SNPRINT_SIZE] = {0}; -+ u32 tmp = 0; -+ -+ if (!(dm->support_ability & ODM_BB_FA_CNT)) -+ return; -+ -+ PHYDM_DBG(dm, DBG_FA_CNT, "%s======>\n", __func__); -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ phydm_fa_cnt_statistics_jgr3(dm); -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ #if (ODM_IC_11N_SERIES_SUPPORT) -+ phydm_fa_cnt_statistics_n(dm); -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ #if (ODM_IC_11AC_SERIES_SUPPORT) -+ phydm_fa_cnt_statistics_ac(dm); -+ #endif -+ } -+ -+ phydm_get_dbg_port_info(dm); -+ phydm_false_alarm_counter_reg_reset(dm_void); -+ -+ phydm_fa_cnt_cal_fa_duration(dm); -+ -+ fa_t->cnt_crc32_error_all = fa_t->cnt_vht_crc32_error + -+ fa_t->cnt_ht_crc32_error + -+ fa_t->cnt_ofdm_crc32_error + -+ fa_t->cnt_cck_crc32_error; -+ -+ fa_t->cnt_crc32_ok_all = fa_t->cnt_vht_crc32_ok + -+ fa_t->cnt_ht_crc32_ok + -+ fa_t->cnt_ofdm_crc32_ok + -+ fa_t->cnt_cck_crc32_ok; -+ -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[Tx cnt] {CCK_TxEN, CCK_TxON, OFDM_TxEN, OFDM_TxON} = {%d, %d, %d, %d}\n", -+ fa_t->cnt_cck_txen, fa_t->cnt_cck_txon, fa_t->cnt_ofdm_txen, -+ fa_t->cnt_ofdm_txon); -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ fa_t->cnt_cck_cca, fa_t->cnt_ofdm_cca, fa_t->cnt_cca_all); -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ fa_t->cnt_cck_fail, fa_t->cnt_ofdm_fail, fa_t->cnt_all); -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[FA duration(us)] {exp, ifs_clm, fahm} = {%d, %d, %d}\n", -+ fa_t->time_fa_exp, fa_t->time_fa_ifs_clm, -+ fa_t->time_fa_fahm); -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[OFDM FA] Parity=%d, Rate=%d, Fast_Fsync=%d, SBD=%d\n", -+ fa_t->cnt_parity_fail, fa_t->cnt_rate_illegal, -+ fa_t->cnt_fast_fsync, fa_t->cnt_sb_search_fail); -+ PHYDM_DBG(dm, DBG_FA_CNT, "[HT FA] CRC8=%d, MCS=%d\n", -+ fa_t->cnt_crc8_fail, fa_t->cnt_mcs_fail); -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ if (dm->support_ic_type & (ODM_IC_11AC_SERIES | ODM_IC_JGR3_SERIES)) { -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[VHT FA] SIGA_CRC8=%d, SIGB_CRC8=%d, MCS=%d\n", -+ fa_t->cnt_crc8_fail_vhta, fa_t->cnt_crc8_fail_vhtb, -+ fa_t->cnt_mcs_fail_vht); -+ } -+#endif -+ -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[CRC32 OK Cnt] {CCK, OFDM, HT, VHT, Total} = {%d, %d, %d, %d, %d}\n", -+ fa_t->cnt_cck_crc32_ok, fa_t->cnt_ofdm_crc32_ok, -+ fa_t->cnt_ht_crc32_ok, fa_t->cnt_vht_crc32_ok, -+ fa_t->cnt_crc32_ok_all); -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[CRC32 Err Cnt] {CCK, OFDM, HT, VHT, Total} = {%d, %d, %d, %d, %d}\n", -+ fa_t->cnt_cck_crc32_error, fa_t->cnt_ofdm_crc32_error, -+ fa_t->cnt_ht_crc32_error, fa_t->cnt_vht_crc32_error, -+ fa_t->cnt_crc32_error_all); -+ -+ if (fa_t->ofdm2_rate_idx) { -+ tmp = fa_t->cnt_ofdm2_crc32_error + fa_t->cnt_ofdm2_crc32_ok; -+ fa_t->ofdm2_pcr = (u8)PHYDM_DIV(fa_t->cnt_ofdm2_crc32_ok * 100, -+ tmp); -+ phydm_print_rate_2_buff(dm, fa_t->ofdm2_rate_idx, dbg_buf, -+ PHYDM_SNPRINT_SIZE); -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[OFDM:%s CRC32 Cnt] {error, ok}= {%d, %d} (%d percent)\n", -+ dbg_buf, fa_t->cnt_ofdm2_crc32_error, -+ fa_t->cnt_ofdm2_crc32_ok, fa_t->ofdm2_pcr); -+ } else { -+ phydm_set_crc32_cnt2_rate(dm, ODM_RATE6M); -+ } -+ -+ if (fa_t->ht2_rate_idx) { -+ tmp = fa_t->cnt_ht2_crc32_error + fa_t->cnt_ht2_crc32_ok; -+ fa_t->ht2_pcr = (u8)PHYDM_DIV(fa_t->cnt_ht2_crc32_ok * 100, -+ tmp); -+ phydm_print_rate_2_buff(dm, fa_t->ht2_rate_idx, dbg_buf, -+ PHYDM_SNPRINT_SIZE); -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[HT:%s CRC32 Cnt] {error, ok}= {%d, %d} (%d percent)\n", -+ dbg_buf, fa_t->cnt_ht2_crc32_error, -+ fa_t->cnt_ht2_crc32_ok, fa_t->ht2_pcr); -+ } else { -+ phydm_set_crc32_cnt2_rate(dm, ODM_RATEMCS0); -+ } -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ if (dm->support_ic_type & (ODM_IC_11AC_SERIES | ODM_IC_JGR3_SERIES)) { -+ if (fa_t->vht2_rate_idx) { -+ tmp = fa_t->cnt_vht2_crc32_error + -+ fa_t->cnt_vht2_crc32_ok; -+ fa_t->vht2_pcr = (u8)PHYDM_DIV(fa_t->cnt_vht2_crc32_ok * -+ 100, tmp); -+ phydm_print_rate_2_buff(dm, fa_t->vht2_rate_idx, -+ dbg_buf, PHYDM_SNPRINT_SIZE); -+ PHYDM_DBG(dm, DBG_FA_CNT, -+ "[VHT:%s CRC32 Cnt] {error, ok}= {%d, %d} (%d percent)\n", -+ dbg_buf, fa_t->cnt_vht2_crc32_error, -+ fa_t->cnt_vht2_crc32_ok, fa_t->vht2_pcr); -+ } else { -+ phydm_set_crc32_cnt2_rate(dm, ODM_RATEVHTSS1MCS0); -+ } -+ } -+#endif -+} -+ -+void phydm_fill_fw_dig_info(void *dm_void, boolean *enable, -+ u8 *para4, u8 *para8) { -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ dig_t->fw_dig_enable = *enable; -+ para8[0] = dig_t->rx_gain_range_max; -+ para8[1] = dig_t->rx_gain_range_min; -+ para8[2] = dm->number_linked_client; -+ para4[0] = (u8)DIG_LPS_MODE; -+} -+ -+void phydm_crc32_cnt_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ u8 rate = 0x0; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[CRC32 Cnt] {rate_idx}\n"); -+ } else { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ rate = (u8)var1[0]; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{rate}={0x%x}", rate); -+ -+ phydm_set_crc32_cnt2_rate(dm, rate); -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+void phydm_set_tdma_dig_timer(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 delta_time_us = dm->tdma_dig_timer_ms * 1000; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u32 timeout = 0; -+ u32 current_time_stamp, diff_time_stamp, regb0 = 0; -+ -+ /*some IC has no FREERUN_CUNT register, like 92E*/ -+ if (dm->support_ic_type & ODM_RTL8197F) -+ current_time_stamp = odm_get_bb_reg(dm, R_0x568, 0xffffffff); -+ else -+ return; -+ -+ timeout = current_time_stamp + delta_time_us; -+ -+ diff_time_stamp = current_time_stamp - dig_t->cur_timestamp; -+ dig_t->pre_timestamp = dig_t->cur_timestamp; -+ dig_t->cur_timestamp = current_time_stamp; -+ -+ /*@HIMR0, it shows HW interrupt mask*/ -+ regb0 = odm_get_bb_reg(dm, R_0xb0, 0xffffffff); -+ -+ PHYDM_DBG(dm, DBG_DIG, "Set next timer\n"); -+ PHYDM_DBG(dm, DBG_DIG, -+ "curr_time_stamp=%d, delta_time_us=%d\n", -+ current_time_stamp, delta_time_us); -+ PHYDM_DBG(dm, DBG_DIG, -+ "timeout=%d, diff_time_stamp=%d, Reg0xb0 = 0x%x\n", -+ timeout, diff_time_stamp, regb0); -+ -+ if (dm->support_ic_type & ODM_RTL8197F) /*REG_PS_TIMER2*/ -+ odm_set_bb_reg(dm, R_0x588, 0xffffffff, timeout); -+ else { -+ PHYDM_DBG(dm, DBG_DIG, "NOT 97F, NOT start\n"); -+ return; -+ } -+} -+ -+void phydm_tdma_dig_timer_check(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ PHYDM_DBG(dm, DBG_DIG, "tdma_dig_cnt=%d, pre_tdma_dig_cnt=%d\n", -+ dig_t->tdma_dig_cnt, dig_t->pre_tdma_dig_cnt); -+ -+ if (dig_t->tdma_dig_cnt == 0 || -+ dig_t->tdma_dig_cnt == dig_t->pre_tdma_dig_cnt) { -+ if (dm->support_ability & ODM_BB_DIG) { -+#ifdef IS_USE_NEW_TDMA -+ if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B | -+ ODM_RTL8812F | ODM_RTL8822B | ODM_RTL8192F | -+ ODM_RTL8821C | ODM_RTL8197G | ODM_RTL8822C | -+ ODM_RTL8723D | ODM_RTL8723F | ODM_RTL8814C)) { -+ PHYDM_DBG(dm, DBG_DIG, -+ "Check fail, Restart timer\n\n"); -+ phydm_false_alarm_counter_reset(dm); -+ odm_set_timer(dm, &dm->tdma_dig_timer, -+ dm->tdma_dig_timer_ms); -+ } else { -+ PHYDM_DBG(dm, DBG_DIG, -+ "Not support TDMADIG, no SW timer\n"); -+ } -+#else -+ /*@if interrupt mask info is got.*/ -+ /*Reg0xb0 is no longer needed*/ -+#if 0 -+ /*regb0 = odm_get_bb_reg(dm, R_0xb0, bMaskDWord);*/ -+#endif -+ PHYDM_DBG(dm, DBG_DIG, -+ "Check fail, Mask[0]=0x%x, restart timer\n", -+ *dm->interrupt_mask); -+ -+ phydm_tdma_dig_add_interrupt_mask_handler(dm); -+ phydm_enable_rx_related_interrupt_handler(dm); -+ phydm_set_tdma_dig_timer(dm); -+#endif -+ } -+ } else { -+ PHYDM_DBG(dm, DBG_DIG, "Check pass, update pre_tdma_dig_cnt\n"); -+ } -+ -+ dig_t->pre_tdma_dig_cnt = dig_t->tdma_dig_cnt; -+} -+ -+/*@different IC/team may use different timer for tdma-dig*/ -+void phydm_tdma_dig_add_interrupt_mask_handler(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (DM_ODM_SUPPORT_TYPE == (ODM_AP)) -+ if (dm->support_ic_type & ODM_RTL8197F) { -+ /*@HAL_INT_TYPE_PSTIMEOUT2*/ -+ phydm_add_interrupt_mask_handler(dm, HAL_INT_TYPE_PSTIMEOUT2); -+ } -+#elif (DM_ODM_SUPPORT_TYPE == (ODM_WIN)) -+#elif (DM_ODM_SUPPORT_TYPE == (ODM_CE)) -+#endif -+} -+ -+/* will be triggered by HW timer*/ -+void phydm_tdma_dig(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; -+ u32 reg_c50 = 0; -+ -+#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8812F_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8192F_SUPPORT || RTL8821C_SUPPORT) -+#ifdef IS_USE_NEW_TDMA -+ if (dm->support_ic_type & -+ (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8812F | ODM_RTL8822B | -+ ODM_RTL8192F | ODM_RTL8821C | ODM_RTL8814C)) { -+ PHYDM_DBG(dm, DBG_DIG, "98F/14B/12F/22B/92F/21C, new tdma\n"); -+ return; -+ } -+#endif -+#endif -+ reg_c50 = odm_get_bb_reg(dm, R_0xc50, MASKBYTE0); -+ -+ dig_t->tdma_dig_state = -+ dig_t->tdma_dig_cnt % dm->tdma_dig_state_number; -+ -+ PHYDM_DBG(dm, DBG_DIG, "tdma_dig_state=%d, regc50=0x%x\n", -+ dig_t->tdma_dig_state, reg_c50); -+ -+ dig_t->tdma_dig_cnt++; -+ -+ if (dig_t->tdma_dig_state == 1) { -+ /* update IGI from tdma_dig_state == 0*/ -+ if (dig_t->cur_ig_value_tdma == 0) -+ dig_t->cur_ig_value_tdma = dig_t->cur_ig_value; -+ -+ odm_write_dig(dm, dig_t->cur_ig_value_tdma); -+ phydm_tdma_false_alarm_counter_check(dm); -+ PHYDM_DBG(dm, DBG_DIG, "tdma_dig_state=%d, reset FA counter\n", -+ dig_t->tdma_dig_state); -+ -+ } else if (dig_t->tdma_dig_state == 0) { -+ /* update dig_t->CurIGValue,*/ -+ /* @it may different from dig_t->cur_ig_value_tdma */ -+ /* TDMA IGI upperbond @ L-state = */ -+ /* rf_ft_var.tdma_dig_low_upper_bond = 0x26 */ -+ -+ if (dig_t->cur_ig_value >= dm->tdma_dig_low_upper_bond) -+ dig_t->low_ig_value = dm->tdma_dig_low_upper_bond; -+ else -+ dig_t->low_ig_value = dig_t->cur_ig_value; -+ -+ odm_write_dig(dm, dig_t->low_ig_value); -+ phydm_tdma_false_alarm_counter_check(dm); -+ } else { -+ phydm_tdma_false_alarm_counter_check(dm); -+ } -+} -+ -+/*@============================================================*/ -+/*@FASLE ALARM CHECK*/ -+/*@============================================================*/ -+void phydm_tdma_false_alarm_counter_check(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; -+ struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ boolean rssi_dump_en = 0; -+ u32 timestamp = 0; -+ u8 tdma_dig_state_number = 0; -+ u32 start_th = 0; -+ -+ if (dig_t->tdma_dig_state == 1) -+ phydm_false_alarm_counter_reset(dm); -+ /* Reset FalseAlarmCounterStatistics */ -+ /* @fa_acc_1sec_tsf = fa_acc_1sec_tsf, keep */ -+ /* @fa_end_tsf = fa_start_tsf = TSF */ -+ else { -+ phydm_false_alarm_counter_statistics(dm); -+ if (dm->support_ic_type & ODM_RTL8197F) /*REG_FREERUN_CNT*/ -+ timestamp = odm_get_bb_reg(dm, R_0x568, bMaskDWord); -+ else { -+ PHYDM_DBG(dm, DBG_DIG, "NOT 97F! NOT start\n"); -+ return; -+ } -+ dig_t->fa_end_timestamp = timestamp; -+ dig_t->fa_acc_1sec_timestamp += -+ (dig_t->fa_end_timestamp - dig_t->fa_start_timestamp); -+ -+ /*prevent dumb*/ -+ if (dm->tdma_dig_state_number == 1) -+ dm->tdma_dig_state_number = 2; -+ -+ tdma_dig_state_number = dm->tdma_dig_state_number; -+ dig_t->sec_factor = -+ tdma_dig_state_number / (tdma_dig_state_number - 1); -+ -+ /*@1sec = 1000000us*/ -+ if (dig_t->sec_factor) -+ start_th = (u32)(1000000 / dig_t->sec_factor); -+ -+ if (dig_t->fa_acc_1sec_timestamp >= start_th) { -+ rssi_dump_en = 1; -+ phydm_false_alarm_counter_acc(dm, rssi_dump_en); -+ PHYDM_DBG(dm, DBG_DIG, -+ "sec_factor=%d, total FA=%d, is_linked=%d\n", -+ dig_t->sec_factor, falm_cnt_acc->cnt_all, -+ dm->is_linked); -+ -+ phydm_noisy_detection(dm); -+ #ifdef PHYDM_SUPPORT_CCKPD -+ phydm_cck_pd_th(dm); -+ #endif -+ phydm_dig(dm); -+ phydm_false_alarm_counter_acc_reset(dm); -+ -+ /* Reset FalseAlarmCounterStatistics */ -+ /* @fa_end_tsf = fa_start_tsf = TSF, keep */ -+ /* @fa_acc_1sec_tsf = 0 */ -+ phydm_false_alarm_counter_reset(dm); -+ } else { -+ phydm_false_alarm_counter_acc(dm, rssi_dump_en); -+ } -+ } -+} -+ -+void phydm_false_alarm_counter_acc(void *dm_void, boolean rssi_dump_en) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; -+ struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ falm_cnt_acc->cnt_parity_fail += falm_cnt->cnt_parity_fail; -+ falm_cnt_acc->cnt_rate_illegal += falm_cnt->cnt_rate_illegal; -+ falm_cnt_acc->cnt_crc8_fail += falm_cnt->cnt_crc8_fail; -+ falm_cnt_acc->cnt_mcs_fail += falm_cnt->cnt_mcs_fail; -+ falm_cnt_acc->cnt_ofdm_fail += falm_cnt->cnt_ofdm_fail; -+ falm_cnt_acc->cnt_cck_fail += falm_cnt->cnt_cck_fail; -+ falm_cnt_acc->cnt_all += falm_cnt->cnt_all; -+ falm_cnt_acc->cnt_fast_fsync += falm_cnt->cnt_fast_fsync; -+ falm_cnt_acc->cnt_sb_search_fail += falm_cnt->cnt_sb_search_fail; -+ falm_cnt_acc->cnt_ofdm_cca += falm_cnt->cnt_ofdm_cca; -+ falm_cnt_acc->cnt_cck_cca += falm_cnt->cnt_cck_cca; -+ falm_cnt_acc->cnt_cca_all += falm_cnt->cnt_cca_all; -+ falm_cnt_acc->cnt_cck_crc32_error += falm_cnt->cnt_cck_crc32_error; -+ falm_cnt_acc->cnt_cck_crc32_ok += falm_cnt->cnt_cck_crc32_ok; -+ falm_cnt_acc->cnt_ofdm_crc32_error += falm_cnt->cnt_ofdm_crc32_error; -+ falm_cnt_acc->cnt_ofdm_crc32_ok += falm_cnt->cnt_ofdm_crc32_ok; -+ falm_cnt_acc->cnt_ht_crc32_error += falm_cnt->cnt_ht_crc32_error; -+ falm_cnt_acc->cnt_ht_crc32_ok += falm_cnt->cnt_ht_crc32_ok; -+ falm_cnt_acc->cnt_vht_crc32_error += falm_cnt->cnt_vht_crc32_error; -+ falm_cnt_acc->cnt_vht_crc32_ok += falm_cnt->cnt_vht_crc32_ok; -+ falm_cnt_acc->cnt_crc32_error_all += falm_cnt->cnt_crc32_error_all; -+ falm_cnt_acc->cnt_crc32_ok_all += falm_cnt->cnt_crc32_ok_all; -+ -+ if (rssi_dump_en == 1) { -+ falm_cnt_acc->cnt_all_1sec = -+ falm_cnt_acc->cnt_all * dig_t->sec_factor; -+ falm_cnt_acc->cnt_cca_all_1sec = -+ falm_cnt_acc->cnt_cca_all * dig_t->sec_factor; -+ falm_cnt_acc->cnt_cck_fail_1sec = -+ falm_cnt_acc->cnt_cck_fail * dig_t->sec_factor; -+ } -+} -+ -+void phydm_false_alarm_counter_acc_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_acc_struct *falm_cnt_acc = NULL; -+ -+#ifdef IS_USE_NEW_TDMA -+ struct phydm_fa_acc_struct *falm_cnt_acc_low = NULL; -+ u32 tmp_cca_1sec = 0; -+ u32 tmp_fa_1sec = 0; -+ -+ /*@clear L-fa_acc struct*/ -+ falm_cnt_acc_low = &dm->false_alm_cnt_acc_low; -+ tmp_cca_1sec = falm_cnt_acc_low->cnt_cca_all_1sec; -+ tmp_fa_1sec = falm_cnt_acc_low->cnt_all_1sec; -+ odm_memory_set(dm, falm_cnt_acc_low, 0, sizeof(dm->false_alm_cnt_acc)); -+ falm_cnt_acc_low->cnt_cca_all_1sec = tmp_cca_1sec; -+ falm_cnt_acc_low->cnt_all_1sec = tmp_fa_1sec; -+ -+ /*@clear H-fa_acc struct*/ -+ falm_cnt_acc = &dm->false_alm_cnt_acc; -+ tmp_cca_1sec = falm_cnt_acc->cnt_cca_all_1sec; -+ tmp_fa_1sec = falm_cnt_acc->cnt_all_1sec; -+ odm_memory_set(dm, falm_cnt_acc, 0, sizeof(dm->false_alm_cnt_acc)); -+ falm_cnt_acc->cnt_cca_all_1sec = tmp_cca_1sec; -+ falm_cnt_acc->cnt_all_1sec = tmp_fa_1sec; -+#else -+ falm_cnt_acc = &dm->false_alm_cnt_acc; -+ /* @Cnt_all_for_rssi_dump & Cnt_CCA_all_for_rssi_dump */ -+ /* @do NOT need to be reset */ -+ odm_memory_set(dm, falm_cnt_acc, 0, sizeof(falm_cnt_acc)); -+#endif -+} -+ -+void phydm_false_alarm_counter_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *falm_cnt; -+ struct phydm_dig_struct *dig_t; -+ u32 timestamp; -+ -+ falm_cnt = &dm->false_alm_cnt; -+ dig_t = &dm->dm_dig_table; -+ -+ memset(falm_cnt, 0, sizeof(dm->false_alm_cnt)); -+ phydm_false_alarm_counter_reg_reset(dm); -+ -+#ifdef IS_USE_NEW_TDMA -+ return; -+#endif -+ if (dig_t->tdma_dig_state != 1) -+ dig_t->fa_acc_1sec_timestamp = 0; -+ else -+ dig_t->fa_acc_1sec_timestamp = dig_t->fa_acc_1sec_timestamp; -+ -+ /*REG_FREERUN_CNT*/ -+ timestamp = odm_get_bb_reg(dm, R_0x568, bMaskDWord); -+ dig_t->fa_start_timestamp = timestamp; -+ dig_t->fa_end_timestamp = timestamp; -+} -+ -+void phydm_tdma_dig_para_upd(void *dm_void, enum upd_type type, u8 input) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ switch (type) { -+ case ENABLE_TDMA: -+ dm->original_dig_restore = !((boolean)input); -+ break; -+ case MODE_DECISION: -+ if (input == (u8)MODE_PERFORMANCE) -+ dm->tdma_dig_state_number = DIG_NUM_OF_TDMA_STATES + 2; -+ else if (input == (u8)MODE_COVERAGE) -+ dm->tdma_dig_state_number = DIG_NUM_OF_TDMA_STATES; -+ else -+ dm->tdma_dig_state_number = DIG_NUM_OF_TDMA_STATES; -+ break; -+ } -+} -+ -+#ifdef IS_USE_NEW_TDMA -+#if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) -+static void pre_phydm_tdma_dig_cbk(unsigned long task_dm) -+{ -+ struct dm_struct *dm = (struct dm_struct *)task_dm; -+ struct rtl8192cd_priv *priv = dm->priv; -+ struct priv_shared_info *pshare = priv->pshare; -+ -+ if (!(priv->drv_state & DRV_STATE_OPEN)) -+ return; -+ -+ if (pshare->bDriverStopped || pshare->bSurpriseRemoved) { -+ printk("[%s] bDriverStopped(%d) OR bSurpriseRemoved(%d)\n", -+ __FUNCTION__, pshare->bDriverStopped, -+ pshare->bSurpriseRemoved); -+ return; -+ } -+ -+ rtw_enqueue_timer_event(priv, &pshare->tdma_dig_event, -+ ENQUEUE_TO_TAIL); -+} -+ -+void phydm_tdma_dig_timers_usb(void *dm_void, u8 state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ if (state == INIT_TDMA_DIG_TIMMER) { -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ init_timer(&dm->tdma_dig_timer); -+ dm->tdma_dig_timer.data = (unsigned long)dm; -+ dm->tdma_dig_timer.function = pre_phydm_tdma_dig_cbk; -+ INIT_TIMER_EVENT_ENTRY(&priv->pshare->tdma_dig_event, -+ phydm_tdma_dig_cbk, -+ (unsigned long)dm); -+ } else if (state == CANCEL_TDMA_DIG_TIMMER) { -+ odm_cancel_timer(dm, &dm->tdma_dig_timer); -+ } else if (state == RELEASE_TDMA_DIG_TIMMER) { -+ odm_release_timer(dm, &dm->tdma_dig_timer); -+ } -+} -+#endif /* defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) */ -+ -+void phydm_tdma_dig_timers(void *dm_void, u8 state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+#if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ if (priv->hci_type == RTL_HCI_USB) { -+ phydm_tdma_dig_timers_usb(dm_void, state); -+ return; -+ } -+#endif /* defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) */ -+ -+ if (state == INIT_TDMA_DIG_TIMMER) -+ odm_initialize_timer(dm, &dm->tdma_dig_timer, -+ (void *)phydm_tdma_dig_cbk, -+ NULL, "phydm_tdma_dig_timer"); -+ else if (state == CANCEL_TDMA_DIG_TIMMER) -+ odm_cancel_timer(dm, &dm->tdma_dig_timer); -+ else if (state == RELEASE_TDMA_DIG_TIMMER) -+ odm_release_timer(dm, &dm->tdma_dig_timer); -+} -+ -+u8 get_new_igi_bound(struct dm_struct *dm, u8 igi, u32 fa_cnt, u8 *rx_gain_max, -+ u8 *rx_gain_min, boolean is_dfs_band) -+{ -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u8 step[3] = {0}; -+ u8 cur_igi = igi; -+ -+ if (dm->is_linked) { -+ if (dm->pre_rssi_min <= dm->rssi_min) { -+ PHYDM_DBG(dm, DBG_DIG, "pre_rssi_min <= rssi_min\n"); -+ step[0] = 2; -+ step[1] = 1; -+ step[2] = 2; -+ } else { -+ step[0] = 4; -+ step[1] = 2; -+ step[2] = 2; -+ } -+ } else { -+ step[0] = 2; -+ step[1] = 1; -+ step[2] = 2; -+ } -+ -+ PHYDM_DBG(dm, DBG_DIG, "step = {-%d, +%d, +%d}\n", step[2], step[1], -+ step[0]); -+ -+ if (dm->first_connect) { -+ if (is_dfs_band) { -+ if (dm->rssi_min > DIG_MAX_DFS) -+ igi = DIG_MAX_DFS; -+ else -+ igi = dm->rssi_min; -+ PHYDM_DBG(dm, DBG_DIG, "DFS band:IgiMax=0x%x\n", -+ *rx_gain_max); -+ } else { -+ igi = *rx_gain_min; -+ } -+ -+ #if 0 -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ #if (RTL8812A_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8812) -+ odm_config_bb_with_header_file(dm, -+ CONFIG_BB_AGC_TAB_DIFF); -+ #endif -+ #endif -+ #endif -+ PHYDM_DBG(dm, DBG_DIG, "First connect: foce IGI=0x%x\n", igi); -+ } else { -+ /* @2 Before link */ -+ PHYDM_DBG(dm, DBG_DIG, "Adjust IGI before link\n"); -+ -+ if (dm->first_disconnect) { -+ igi = dig_t->dm_dig_min; -+ PHYDM_DBG(dm, DBG_DIG, -+ "First disconnect:foce IGI to lower bound\n"); -+ } else { -+ PHYDM_DBG(dm, DBG_DIG, "Pre_IGI=((0x%x)), FA=((%d))\n", -+ igi, fa_cnt); -+ -+ igi = phydm_new_igi_by_fa(dm, igi, fa_cnt, step); -+ } -+ } -+ /*@Check IGI by dyn-upper/lower bound */ -+ if (igi < *rx_gain_min) -+ igi = *rx_gain_min; -+ -+ if (igi > *rx_gain_max) -+ igi = *rx_gain_max; -+ -+ PHYDM_DBG(dm, DBG_DIG, "fa_cnt = %d, IGI: 0x%x -> 0x%x\n", -+ fa_cnt, cur_igi, igi); -+ -+ return igi; -+} -+ -+void phydm_write_tdma_dig(void *dm_void, u8 new_igi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; -+ -+ PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); -+#if 0 -+ /* @1 Check IGI by upper bound */ -+ if (adaptivity->igi_lmt_en && -+ new_igi > adaptivity->adapt_igi_up && dm->is_linked) { -+ new_igi = adaptivity->adapt_igi_up; -+ -+ PHYDM_DBG(dm, DBG_DIG, "Force Adaptivity Up-bound=((0x%x))\n", -+ new_igi); -+ } -+#endif -+ phydm_write_dig_reg(dm, new_igi); -+ -+ PHYDM_DBG(dm, DBG_DIG, "New %s-IGI=((0x%x))\n", -+ (dig_t->tdma_dig_state == TDMA_DIG_LOW_STATE) ? "L" : "H", -+ new_igi); -+} -+ -+void phydm_tdma_dig_new(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ if (phydm_dig_abort(dm) || dm->original_dig_restore) -+ return; -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG, "timer callback =======> tdma_dig_state=%d\n"); -+ * dig_t->tdma_dig_state); -+ *PHYDM_DBG(dm, DBG_DIG, "tdma_h_igi=0x%x, tdma_l_igi=0x%x\n", -+ * dig_t->cur_ig_value_tdma, -+ * dig_t->low_ig_value); -+ */ -+ phydm_tdma_fa_cnt_chk(dm); -+ -+ /*@prevent dumb*/ -+ if (dm->tdma_dig_state_number < 2) -+ dm->tdma_dig_state_number = 2; -+ -+ /*@update state*/ -+ dig_t->tdma_dig_cnt++; -+ dig_t->tdma_dig_state = dig_t->tdma_dig_cnt % dm->tdma_dig_state_number; -+ -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG, "enter state %d, dig count %d\n", -+ * dig_t->tdma_dig_state, dig_t->tdma_dig_cnt); -+ */ -+ -+ if (dig_t->tdma_dig_state == TDMA_DIG_LOW_STATE) -+ odm_write_dig(dm, dig_t->low_ig_value); -+ else if (dig_t->tdma_dig_state >= TDMA_DIG_HIGH_STATE) -+ odm_write_dig(dm, dig_t->cur_ig_value_tdma); -+ -+ odm_set_timer(dm, &dm->tdma_dig_timer, dm->tdma_dig_timer_ms); -+} -+ -+/*@callback function triggered by SW timer*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_tdma_dig_cbk(struct phydm_timer_list *timer) -+{ -+ void *adapter = (void *)timer->Adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrcs; -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ #if USE_WORKITEM -+ odm_schedule_work_item(&dm->phydm_tdma_dig_workitem); -+ #else -+ phydm_tdma_dig_new(dm); -+ #endif -+ #else -+ odm_schedule_work_item(&dm->phydm_tdma_dig_workitem); -+ #endif -+} -+ -+void phydm_tdma_dig_workitem_callback(void *context) -+{ -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+ phydm_tdma_dig_new(dm); -+} -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+void phydm_tdma_dig_cbk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *padapter = dm->adapter; -+ -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ phydm_tdma_dig_workitem_callback(dm); -+ /* @Can't do I/O in timer callback*/ -+ else -+ phydm_run_in_thread_cmd(dm, phydm_tdma_dig_workitem_callback, -+ dm); -+} -+ -+void phydm_tdma_dig_workitem_callback(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ if (phydm_dig_abort(dm) || (dm->original_dig_restore)) -+ return; -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG, "timer callback =======> tdma_dig_state=%d\n"); -+ * dig_t->tdma_dig_state); -+ *PHYDM_DBG(dm, DBG_DIG, "tdma_h_igi=0x%x, tdma_l_igi=0x%x\n", -+ * dig_t->cur_ig_value_tdma, -+ * dig_t->low_ig_value); -+ */ -+ phydm_tdma_fa_cnt_chk(dm); -+ -+ /*@prevent dumb*/ -+ if (dm->tdma_dig_state_number < 2) -+ dm->tdma_dig_state_number = 2; -+ -+ /*@update state*/ -+ dig_t->tdma_dig_cnt++; -+ dig_t->tdma_dig_state = dig_t->tdma_dig_cnt % dm->tdma_dig_state_number; -+ -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG, "enter state %d, dig count %d\n", -+ * dig_t->tdma_dig_state, dig_t->tdma_dig_cnt); -+ */ -+ -+ if (dig_t->tdma_dig_state == TDMA_DIG_LOW_STATE) -+ odm_write_dig(dm, dig_t->low_ig_value); -+ else if (dig_t->tdma_dig_state >= TDMA_DIG_HIGH_STATE) -+ odm_write_dig(dm, dig_t->cur_ig_value_tdma); -+ -+ odm_set_timer(dm, &dm->tdma_dig_timer, dm->tdma_dig_timer_ms); -+} -+#else -+void phydm_tdma_dig_cbk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ -+ if (phydm_dig_abort(dm) || dm->original_dig_restore) -+ return; -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG, "timer callback =======> tdma_dig_state=%d\n"); -+ * dig_t->tdma_dig_state); -+ *PHYDM_DBG(dm, DBG_DIG, "tdma_h_igi=0x%x, tdma_l_igi=0x%x\n", -+ * dig_t->cur_ig_value_tdma, -+ * dig_t->low_ig_value); -+ */ -+ phydm_tdma_fa_cnt_chk(dm); -+ -+ /*@prevent dumb*/ -+ if (dm->tdma_dig_state_number < 2) -+ dm->tdma_dig_state_number = 2; -+ -+ /*@update state*/ -+ dig_t->tdma_dig_cnt++; -+ dig_t->tdma_dig_state = dig_t->tdma_dig_cnt % dm->tdma_dig_state_number; -+ -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG, "enter state %d, dig count %d\n", -+ * dig_t->tdma_dig_state, dig_t->tdma_dig_cnt); -+ */ -+ -+ if (dig_t->tdma_dig_state == TDMA_DIG_LOW_STATE) -+ phydm_write_tdma_dig(dm, dig_t->low_ig_value); -+ else if (dig_t->tdma_dig_state >= TDMA_DIG_HIGH_STATE) -+ phydm_write_tdma_dig(dm, dig_t->cur_ig_value_tdma); -+ -+ odm_set_timer(dm, &dm->tdma_dig_timer, dm->tdma_dig_timer_ms); -+} -+#endif -+/*@============================================================*/ -+/*@FASLE ALARM CHECK*/ -+/*@============================================================*/ -+void phydm_tdma_fa_cnt_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; -+ struct phydm_fa_acc_struct *fa_t_acc = &dm->false_alm_cnt_acc; -+ struct phydm_fa_acc_struct *fa_t_acc_low = &dm->false_alm_cnt_acc_low; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ boolean tdma_dig_block_1sec_flag = false; -+ u32 timestamp = 0; -+ u8 states_per_block = dm->tdma_dig_state_number; -+ u8 cur_tdma_dig_state = 0; -+ u32 start_th = 0; -+ u8 state_diff = 0; -+ u32 tdma_dig_block_period_ms = 0; -+ u32 tdma_dig_block_cnt_thd = 0; -+ u32 timestamp_diff = 0; -+ -+ /*@calculate duration of a tdma block*/ -+ tdma_dig_block_period_ms = dm->tdma_dig_timer_ms * states_per_block; -+ -+ /*@ -+ *caution!ONE_SEC_MS must be divisible by tdma_dig_block_period_ms, -+ *or FA will be fewer. -+ */ -+ tdma_dig_block_cnt_thd = ONE_SEC_MS / tdma_dig_block_period_ms; -+ -+ /*@tdma_dig_state == 0, collect H-state FA, else, collect L-state FA*/ -+ if (dig_t->tdma_dig_state == TDMA_DIG_LOW_STATE) -+ cur_tdma_dig_state = TDMA_DIG_LOW_STATE; -+ else if (dig_t->tdma_dig_state >= TDMA_DIG_HIGH_STATE) -+ cur_tdma_dig_state = TDMA_DIG_HIGH_STATE; -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG, "in state %d, dig count %d\n", -+ * cur_tdma_dig_state, dig_t->tdma_dig_cnt); -+ */ -+ if (cur_tdma_dig_state == 0) { -+ /*@L-state indicates next block*/ -+ dig_t->tdma_dig_block_cnt++; -+ -+ /*@1sec dump check*/ -+ if (dig_t->tdma_dig_block_cnt >= tdma_dig_block_cnt_thd) -+ tdma_dig_block_1sec_flag = true; -+ -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG,"[L-state] tdma_dig_block_cnt=%d\n", -+ * dig_t->tdma_dig_block_cnt); -+ */ -+ -+ /*@collect FA till this block end*/ -+ phydm_false_alarm_counter_statistics(dm); -+ phydm_fa_cnt_acc(dm, tdma_dig_block_1sec_flag, -+ cur_tdma_dig_state); -+ /*@1s L-FA collect end*/ -+ -+ /*@1sec dump reached*/ -+ if (tdma_dig_block_1sec_flag) { -+ /*@L-DIG*/ -+ phydm_noisy_detection(dm); -+ #ifdef PHYDM_SUPPORT_CCKPD -+ phydm_cck_pd_th(dm); -+ #endif -+ PHYDM_DBG(dm, DBG_DIG, "run tdma L-state dig ====>\n"); -+ phydm_tdma_low_dig(dm); -+ PHYDM_DBG(dm, DBG_DIG, "\n\n"); -+ } -+ } else if (cur_tdma_dig_state == 1) { -+ /*@1sec dump check*/ -+ if (dig_t->tdma_dig_block_cnt >= tdma_dig_block_cnt_thd) -+ tdma_dig_block_1sec_flag = true; -+ -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG,"[H-state] tdma_dig_block_cnt=%d\n", -+ * dig_t->tdma_dig_block_cnt); -+ */ -+ -+ /*@collect FA till this block end*/ -+ phydm_false_alarm_counter_statistics(dm); -+ phydm_fa_cnt_acc(dm, tdma_dig_block_1sec_flag, -+ cur_tdma_dig_state); -+ /*@1s H-FA collect end*/ -+ -+ /*@1sec dump reached*/ -+ state_diff = dm->tdma_dig_state_number - dig_t->tdma_dig_state; -+ if (tdma_dig_block_1sec_flag && state_diff == 1) { -+ /*@H-DIG*/ -+ phydm_noisy_detection(dm); -+ #ifdef PHYDM_SUPPORT_CCKPD -+ phydm_cck_pd_th(dm); -+ #endif -+ PHYDM_DBG(dm, DBG_DIG, "run tdma H-state dig ====>\n"); -+ phydm_tdma_high_dig(dm); -+ PHYDM_DBG(dm, DBG_DIG, "\n\n"); -+ PHYDM_DBG(dm, DBG_DIG, "1 sec reached, is_linked=%d\n", -+ dm->is_linked); -+ PHYDM_DBG(dm, DBG_DIG, "1 sec L-CCA=%d, L-FA=%d\n", -+ fa_t_acc_low->cnt_cca_all_1sec, -+ fa_t_acc_low->cnt_all_1sec); -+ PHYDM_DBG(dm, DBG_DIG, "1 sec H-CCA=%d, H-FA=%d\n", -+ fa_t_acc->cnt_cca_all_1sec, -+ fa_t_acc->cnt_all_1sec); -+ PHYDM_DBG(dm, DBG_DIG, -+ "1 sec TOTAL-CCA=%d, TOTAL-FA=%d\n\n", -+ fa_t_acc->cnt_cca_all + -+ fa_t_acc_low->cnt_cca_all, -+ fa_t_acc->cnt_all + fa_t_acc_low->cnt_all); -+ -+ /*@Reset AccFalseAlarmCounterStatistics */ -+ phydm_false_alarm_counter_acc_reset(dm); -+ dig_t->tdma_dig_block_cnt = 0; -+ } -+ } -+ /*@Reset FalseAlarmCounterStatistics */ -+ phydm_false_alarm_counter_reset(dm); -+} -+ -+void phydm_tdma_low_dig(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; -+ struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc_low; -+#ifdef CFG_DIG_DAMPING_CHK -+ struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; -+#endif -+ u8 igi = dig_t->cur_ig_value; -+ u8 new_igi = 0x20; -+ u8 tdma_l_igi = dig_t->low_ig_value; -+ u8 tdma_l_dym_min = dig_t->tdma_rx_gain_min[TDMA_DIG_LOW_STATE]; -+ u8 tdma_l_dym_max = dig_t->tdma_rx_gain_max[TDMA_DIG_LOW_STATE]; -+ u32 fa_cnt = falm_cnt->cnt_all; -+ boolean dfs_mode_en = false, is_performance = true; -+ u8 rssi_min = dm->rssi_min; -+ u8 igi_upper_rssi_min = 0; -+ u8 offset = 15; -+ -+ if (!(dm->original_dig_restore)) { -+ if (tdma_l_igi == 0) -+ tdma_l_igi = igi; -+ -+ fa_cnt = falm_cnt_acc->cnt_all_1sec; -+ } -+ -+ if (phydm_dig_abort(dm)) { -+ dig_t->low_ig_value = phydm_get_igi(dm, BB_PATH_A); -+ return; -+ } -+ -+ /*@Mode Decision*/ -+ dfs_mode_en = false; -+ is_performance = true; -+ -+ /* @Abs Boundary Decision*/ -+ dig_t->dm_dig_max = DIG_MAX_COVERAGR; //0x26 -+ dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; //0x20 -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_COVERAGE; //0x22 -+ -+ if (dm->is_dfs_band) { -+ if (*dm->band_width == CHANNEL_WIDTH_20){ -+ if (dm->support_ic_type & -+ (ODM_RTL8814A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8822B)){ -+ if (odm_get_bb_reg(dm, R_0x8d8, BIT(27)) == 1) -+ dig_t->dm_dig_min = DIG_MIN_DFS + 2; -+ else -+ dig_t->dm_dig_min = DIG_MIN_DFS; -+ } -+ else -+ dig_t->dm_dig_min = DIG_MIN_DFS; -+ } -+ else -+ dig_t->dm_dig_min = DIG_MIN_DFS; -+ -+ } else { -+ #if 0 -+ if (dm->support_ic_type & -+ (ODM_RTL8814A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8822B)) -+ dig_t->dm_dig_min = 0x1c; -+ else if (dm->support_ic_type & ODM_RTL8197F) -+ dig_t->dm_dig_min = 0x1e; /*@For HW setting*/ -+ #endif -+ } -+ -+ PHYDM_DBG(dm, DBG_DIG, "Abs{Max, Min}={0x%x, 0x%x}, Max_of_min=0x%x\n", -+ dig_t->dm_dig_max, dig_t->dm_dig_min, dig_t->dig_max_of_min); -+ -+ /* @Dyn Boundary by RSSI*/ -+ if (!dm->is_linked) { -+ /*@if no link, always stay at lower bound*/ -+ tdma_l_dym_max = 0x26; -+ tdma_l_dym_min = dig_t->dm_dig_min; -+ -+ PHYDM_DBG(dm, DBG_DIG, "No-Link, Dyn{Max, Min}={0x%x, 0x%x}\n", -+ tdma_l_dym_max, tdma_l_dym_min); -+ } else { -+ PHYDM_DBG(dm, DBG_DIG, "rssi_min=%d, ofst=%d\n", -+ dm->rssi_min, offset); -+ -+ /* @DIG lower bound in L-state*/ -+ tdma_l_dym_min = dig_t->dm_dig_min; -+ if (dm->is_dfs_band) -+ tdma_l_dym_min = DIG_MIN_DFS; -+ /*@ -+ *#ifdef CFG_DIG_DAMPING_CHK -+ *@Limit Dyn min by damping -+ *if (dig_t->dig_dl_en && -+ * dig_rc->damping_limit_en && -+ * tdma_l_dym_min < dig_rc->damping_limit_val) { -+ * PHYDM_DBG(dm, DBG_DIG, -+ * "[Limit by Damping] dyn_min=0x%x -> 0x%x\n", -+ * tdma_l_dym_min, dig_rc->damping_limit_val); -+ * -+ * tdma_l_dym_min = dig_rc->damping_limit_val; -+ *} -+ *#endif -+ */ -+ -+ /*@DIG upper bound in L-state*/ -+ igi_upper_rssi_min = rssi_min + offset; -+ if (igi_upper_rssi_min > dig_t->dm_dig_max) -+ tdma_l_dym_max = dig_t->dm_dig_max; -+ else if (igi_upper_rssi_min < dig_t->dm_dig_min) -+ tdma_l_dym_max = dig_t->dm_dig_min; -+ else -+ tdma_l_dym_max = igi_upper_rssi_min; -+ -+ /* @1 Force Lower Bound for AntDiv */ -+ /*@ -+ *if (!dm->is_one_entry_only && -+ *(dm->support_ability & ODM_BB_ANT_DIV) && -+ *(dm->ant_div_type == CG_TRX_HW_ANTDIV || -+ *dm->ant_div_type == CG_TRX_SMART_ANTDIV)) { -+ *if (dig_t->ant_div_rssi_max > dig_t->dig_max_of_min) -+ * dig_t->rx_gain_range_min = dig_t->dig_max_of_min; -+ *else -+ * dig_t->rx_gain_range_min = (u8)dig_t->ant_div_rssi_max; -+ * -+ *PHYDM_DBG(dm, DBG_DIG, "Force Dyn-Min=0x%x, RSSI_max=0x%x\n", -+ * dig_t->rx_gain_range_min, dig_t->ant_div_rssi_max); -+ *} -+ */ -+ -+ PHYDM_DBG(dm, DBG_DIG, "Dyn{Max, Min}={0x%x, 0x%x}\n", -+ tdma_l_dym_max, tdma_l_dym_min); -+ } -+ -+ /*@Abnormal Case Check*/ -+ /*@Abnormal lower bound case*/ -+ if (tdma_l_dym_min > tdma_l_dym_max) -+ tdma_l_dym_min = tdma_l_dym_max; -+ -+ PHYDM_DBG(dm, DBG_DIG, -+ "Abnoraml chk, force {Max, Min}={0x%x, 0x%x}\n", -+ tdma_l_dym_max, tdma_l_dym_min); -+ -+ /*@False Alarm Threshold Decision*/ -+ phydm_fa_threshold_check(dm, dfs_mode_en); -+ -+ /*@Adjust Initial Gain by False Alarm*/ -+ /*Select new IGI by FA */ -+ if (!(dm->original_dig_restore)) { -+ tdma_l_igi = get_new_igi_bound(dm, tdma_l_igi, fa_cnt, -+ &tdma_l_dym_max, -+ &tdma_l_dym_min, -+ dfs_mode_en); -+ } else { -+ new_igi = phydm_get_new_igi(dm, igi, fa_cnt, dfs_mode_en); -+ } -+ -+ /*Update status*/ -+ if (!(dm->original_dig_restore)) { -+ if (dig_t->tdma_force_l_igi == 0xff) -+ dig_t->low_ig_value = tdma_l_igi; -+ else -+ dig_t->low_ig_value = dig_t->tdma_force_l_igi; -+ dig_t->tdma_rx_gain_min[TDMA_DIG_LOW_STATE] = tdma_l_dym_min; -+ dig_t->tdma_rx_gain_max[TDMA_DIG_LOW_STATE] = tdma_l_dym_max; -+#if 0 -+ /*odm_write_dig(dm, tdma_l_igi);*/ -+#endif -+ } else { -+ odm_write_dig(dm, new_igi); -+ } -+} -+ -+void phydm_tdma_high_dig(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; -+ struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc; -+ struct phydm_adaptivity_struct *adapt = &dm->adaptivity; -+#ifdef CFG_DIG_DAMPING_CHK -+ struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; -+#endif -+ u8 igi = dig_t->cur_ig_value; -+ u8 new_igi = 0x20; -+ u8 tdma_h_igi = dig_t->cur_ig_value_tdma; -+ u8 tdma_h_dym_min = dig_t->tdma_rx_gain_min[TDMA_DIG_HIGH_STATE]; -+ u8 tdma_h_dym_max = dig_t->tdma_rx_gain_max[TDMA_DIG_HIGH_STATE]; -+ u32 fa_cnt = falm_cnt->cnt_all; -+ boolean dfs_mode_en = false, is_performance = true; -+ u8 rssi_min = dm->rssi_min; -+ u8 igi_upper_rssi_min = 0; -+ u8 offset = 15; -+ -+ if (!(dm->original_dig_restore)) { -+ if (tdma_h_igi == 0) -+ tdma_h_igi = igi; -+ -+ fa_cnt = falm_cnt_acc->cnt_all_1sec; -+ } -+ -+ if (phydm_dig_abort(dm)) { -+ dig_t->cur_ig_value_tdma = phydm_get_igi(dm, BB_PATH_A); -+ return; -+ } -+ -+ /*@Mode Decision*/ -+ dfs_mode_en = false; -+ is_performance = true; -+ -+ /*@Abs Boundary Decision*/ -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; // 0x2a -+ -+ if (!dm->is_linked) { -+ dig_t->dm_dig_max = DIG_MAX_COVERAGR; -+ dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; // 0x20 -+ } else if (dm->is_dfs_band) { -+ if (*dm->band_width == CHANNEL_WIDTH_20){ -+ if (dm->support_ic_type & -+ (ODM_RTL8814A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8822B)){ -+ if (odm_get_bb_reg(dm, R_0x8d8, BIT(27)) == 1) -+ dig_t->dm_dig_min = DIG_MIN_DFS + 2; -+ else -+ dig_t->dm_dig_min = DIG_MIN_DFS; -+ } -+ else -+ dig_t->dm_dig_min = DIG_MIN_DFS; -+ } -+ else -+ dig_t->dm_dig_min = DIG_MIN_DFS; -+ -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; -+ dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; -+ } else { -+ if (*dm->bb_op_mode == PHYDM_BALANCE_MODE) { -+ /*service > 2 devices*/ -+ dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; -+ #if (DIG_HW == 1) -+ dig_t->dig_max_of_min = DIG_MIN_COVERAGE; -+ #else -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; -+ #endif -+ } else if (*dm->bb_op_mode == PHYDM_PERFORMANCE_MODE) { -+ /*service 1 devices*/ -+ if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE && -+ (dm->support_ic_type & ODM_RTL8192F)) { -+ /*dig_max shouldn't be too high becaus of adaptivity*/ -+ dig_t->dm_dig_max = MIN_2((adapt->th_l2h + 30), -+ DIG_MAX_PERFORMANCE_MODE); -+ } else { -+ dig_t->dm_dig_max = DIG_MAX_PERFORMANCE_MODE; -+ #if (RTL8822B_SUPPORT == 1) -+ if (dm->is_dig_low_bond) -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_PERFORMANCE_MODE_22B; -+ else -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_PERFORMANCE_MODE; -+ #else -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_PERFORMANCE_MODE; -+ #endif -+ } -+ dig_t->dig_max_of_min = DIG_MAX_OF_MIN_PERFORMANCE_MODE; -+ } -+ -+ #if 0 -+ if (dm->support_ic_type & -+ (ODM_RTL8814A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8822B)) -+ dig_t->dm_dig_min = 0x1c; -+ else if (dm->support_ic_type & ODM_RTL8197F) -+ dig_t->dm_dig_min = 0x1e; /*@For HW setting*/ -+ else -+ #endif -+ dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; -+ } -+ PHYDM_DBG(dm, DBG_DIG, "Abs{Max, Min}={0x%x, 0x%x}, Max_of_min=0x%x\n", -+ dig_t->dm_dig_max, dig_t->dm_dig_min, dig_t->dig_max_of_min); -+ -+ /*@Dyn Boundary by RSSI*/ -+ if (!dm->is_linked) { -+ /*@if no link, always stay at lower bound*/ -+ tdma_h_dym_max = dig_t->dig_max_of_min; -+ tdma_h_dym_min = dig_t->dm_dig_min; -+ -+ PHYDM_DBG(dm, DBG_DIG, "No-Link, Dyn{Max, Min}={0x%x, 0x%x}\n", -+ tdma_h_dym_max, tdma_h_dym_min); -+ } else { -+ PHYDM_DBG(dm, DBG_DIG, "rssi_min=%d, ofst=%d\n", -+ dm->rssi_min, offset); -+ -+ /* @DIG lower bound in H-state*/ -+ if (dm->is_dfs_band) -+ tdma_h_dym_min = DIG_MIN_DFS; -+ else if (rssi_min < dig_t->dm_dig_min) -+ tdma_h_dym_min = dig_t->dm_dig_min; -+ else -+ tdma_h_dym_min = rssi_min; // turbo not considered yet -+ -+#ifdef CFG_DIG_DAMPING_CHK -+ /*@Limit Dyn min by damping*/ -+ if (dig_t->dig_dl_en && -+ dig_rc->damping_limit_en && -+ tdma_h_dym_min < dig_rc->damping_limit_val) { -+ PHYDM_DBG(dm, DBG_DIG, -+ "[Limit by Damping] dyn_min=0x%x -> 0x%x\n", -+ tdma_h_dym_min, dig_rc->damping_limit_val); -+ -+ tdma_h_dym_min = dig_rc->damping_limit_val; -+ } -+#endif -+ -+ /*@DIG upper bound in H-state*/ -+ igi_upper_rssi_min = rssi_min + offset; -+ if (igi_upper_rssi_min > dig_t->dm_dig_max) -+ tdma_h_dym_max = dig_t->dm_dig_max; -+ else -+ tdma_h_dym_max = igi_upper_rssi_min; -+ -+ /* @1 Force Lower Bound for AntDiv */ -+ /*@ -+ *if (!dm->is_one_entry_only && -+ *(dm->support_ability & ODM_BB_ANT_DIV) && -+ *(dm->ant_div_type == CG_TRX_HW_ANTDIV || -+ *dm->ant_div_type == CG_TRX_SMART_ANTDIV)) { -+ * if (dig_t->ant_div_rssi_max > dig_t->dig_max_of_min) -+ * dig_t->rx_gain_range_min = dig_t->dig_max_of_min; -+ * else -+ * dig_t->rx_gain_range_min = (u8)dig_t->ant_div_rssi_max; -+ */ -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG, "Force Dyn-Min=0x%x, RSSI_max=0x%x\n", -+ * dig_t->rx_gain_range_min, dig_t->ant_div_rssi_max); -+ *} -+ */ -+ PHYDM_DBG(dm, DBG_DIG, "Dyn{Max, Min}={0x%x, 0x%x}\n", -+ tdma_h_dym_max, tdma_h_dym_min); -+ } -+ -+ /*@Abnormal Case Check*/ -+ /*@Abnormal low higher bound case*/ -+ if (tdma_h_dym_max < dig_t->dm_dig_min) -+ tdma_h_dym_max = dig_t->dm_dig_min; -+ /*@Abnormal lower bound case*/ -+ if (tdma_h_dym_min > tdma_h_dym_max) -+ tdma_h_dym_min = tdma_h_dym_max; -+ -+ PHYDM_DBG(dm, DBG_DIG, "Abnoraml chk, force {Max, Min}={0x%x, 0x%x}\n", -+ tdma_h_dym_max, tdma_h_dym_min); -+ -+ /*@False Alarm Threshold Decision*/ -+ phydm_fa_threshold_check(dm, dfs_mode_en); -+ -+ /*@Adjust Initial Gain by False Alarm*/ -+ /*Select new IGI by FA */ -+ if (!(dm->original_dig_restore)) { -+ tdma_h_igi = get_new_igi_bound(dm, tdma_h_igi, fa_cnt, -+ &tdma_h_dym_max, -+ &tdma_h_dym_min, -+ dfs_mode_en); -+ } else { -+ new_igi = phydm_get_new_igi(dm, igi, fa_cnt, dfs_mode_en); -+ } -+ -+ /*Update status*/ -+ if (!(dm->original_dig_restore)) { -+ if (dig_t->tdma_force_h_igi == 0xff) -+ dig_t->cur_ig_value_tdma = tdma_h_igi; -+ else -+ dig_t->cur_ig_value_tdma = dig_t->tdma_force_h_igi; -+ dig_t->tdma_rx_gain_min[TDMA_DIG_HIGH_STATE] = tdma_h_dym_min; -+ dig_t->tdma_rx_gain_max[TDMA_DIG_HIGH_STATE] = tdma_h_dym_max; -+#if 0 -+ /*odm_write_dig(dm, tdma_h_igi);*/ -+#endif -+ } else { -+ odm_write_dig(dm, new_igi); -+ } -+} -+ -+void phydm_fa_cnt_acc(void *dm_void, boolean tdma_dig_block_1sec_flag, -+ u8 cur_tdma_dig_state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; -+ struct phydm_fa_acc_struct *falm_cnt_acc = NULL; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u8 factor_num = 0; -+ u8 factor_denum = 1; -+ u8 total_state_number = 0; -+ -+ if (cur_tdma_dig_state == TDMA_DIG_LOW_STATE) -+ falm_cnt_acc = &dm->false_alm_cnt_acc_low; -+ else if (cur_tdma_dig_state == TDMA_DIG_HIGH_STATE) -+ -+ falm_cnt_acc = &dm->false_alm_cnt_acc; -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG, -+ * "[%s] ==> dig_state=%d, one_sec=%d\n", __func__, -+ * cur_tdma_dig_state, tdma_dig_block_1sec_flag); -+ */ -+ falm_cnt_acc->cnt_parity_fail += falm_cnt->cnt_parity_fail; -+ falm_cnt_acc->cnt_rate_illegal += falm_cnt->cnt_rate_illegal; -+ falm_cnt_acc->cnt_crc8_fail += falm_cnt->cnt_crc8_fail; -+ falm_cnt_acc->cnt_mcs_fail += falm_cnt->cnt_mcs_fail; -+ falm_cnt_acc->cnt_ofdm_fail += falm_cnt->cnt_ofdm_fail; -+ falm_cnt_acc->cnt_cck_fail += falm_cnt->cnt_cck_fail; -+ falm_cnt_acc->cnt_all += falm_cnt->cnt_all; -+ falm_cnt_acc->cnt_fast_fsync += falm_cnt->cnt_fast_fsync; -+ falm_cnt_acc->cnt_sb_search_fail += falm_cnt->cnt_sb_search_fail; -+ falm_cnt_acc->cnt_ofdm_cca += falm_cnt->cnt_ofdm_cca; -+ falm_cnt_acc->cnt_cck_cca += falm_cnt->cnt_cck_cca; -+ falm_cnt_acc->cnt_cca_all += falm_cnt->cnt_cca_all; -+ falm_cnt_acc->cnt_cck_crc32_error += falm_cnt->cnt_cck_crc32_error; -+ falm_cnt_acc->cnt_cck_crc32_ok += falm_cnt->cnt_cck_crc32_ok; -+ falm_cnt_acc->cnt_ofdm_crc32_error += falm_cnt->cnt_ofdm_crc32_error; -+ falm_cnt_acc->cnt_ofdm_crc32_ok += falm_cnt->cnt_ofdm_crc32_ok; -+ falm_cnt_acc->cnt_ht_crc32_error += falm_cnt->cnt_ht_crc32_error; -+ falm_cnt_acc->cnt_ht_crc32_ok += falm_cnt->cnt_ht_crc32_ok; -+ falm_cnt_acc->cnt_vht_crc32_error += falm_cnt->cnt_vht_crc32_error; -+ falm_cnt_acc->cnt_vht_crc32_ok += falm_cnt->cnt_vht_crc32_ok; -+ falm_cnt_acc->cnt_crc32_error_all += falm_cnt->cnt_crc32_error_all; -+ falm_cnt_acc->cnt_crc32_ok_all += falm_cnt->cnt_crc32_ok_all; -+ -+ /*@ -+ *PHYDM_DBG(dm, DBG_DIG, -+ * "[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ * falm_cnt->cnt_cck_cca, -+ * falm_cnt->cnt_ofdm_cca, -+ * falm_cnt->cnt_cca_all); -+ *PHYDM_DBG(dm, DBG_DIG, -+ * "[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ * falm_cnt->cnt_cck_fail, -+ * falm_cnt->cnt_ofdm_fail, -+ * falm_cnt->cnt_all); -+ */ -+ if (tdma_dig_block_1sec_flag) { -+ total_state_number = dm->tdma_dig_state_number; -+ -+ if (cur_tdma_dig_state == TDMA_DIG_HIGH_STATE) { -+ factor_num = total_state_number; -+ factor_denum = total_state_number - 1; -+ } else if (cur_tdma_dig_state == TDMA_DIG_LOW_STATE) { -+ factor_num = total_state_number; -+ factor_denum = 1; -+ } -+ -+ falm_cnt_acc->cnt_all_1sec = -+ falm_cnt_acc->cnt_all * factor_num / factor_denum; -+ falm_cnt_acc->cnt_cca_all_1sec = -+ falm_cnt_acc->cnt_cca_all * factor_num / factor_denum; -+ falm_cnt_acc->cnt_cck_fail_1sec = -+ falm_cnt_acc->cnt_cck_fail * factor_num / factor_denum; -+ -+ PHYDM_DBG(dm, DBG_DIG, -+ "[ACC CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ falm_cnt_acc->cnt_cck_cca, -+ falm_cnt_acc->cnt_ofdm_cca, -+ falm_cnt_acc->cnt_cca_all); -+ PHYDM_DBG(dm, DBG_DIG, -+ "[ACC FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n\n", -+ falm_cnt_acc->cnt_cck_fail, -+ falm_cnt_acc->cnt_ofdm_fail, -+ falm_cnt_acc->cnt_all); -+ -+ } -+} -+#endif /*@#ifdef IS_USE_NEW_TDMA*/ -+#endif /*@#ifdef PHYDM_TDMA_DIG_SUPPORT*/ -+ -+void phydm_dig_debug(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{0} {en} fa_th[0] fa_th[1] fa_th[2]\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{1} {Damping Limit en}\n"); -+ #ifdef PHYDM_TDMA_DIG_SUPPORT -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{2} {original_dig_restore = %d}\n", -+ dm->original_dig_restore); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{3} {tdma_dig_timer_ms = %d}\n", -+ dm->tdma_dig_timer_ms); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{4} {tdma_dig_state_number = %d}\n", -+ dm->tdma_dig_state_number); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{5} {0:L-state,1:H-state} {force IGI} (L,H)=(%2x,%2x)\n", -+ dig_t->tdma_force_l_igi, dig_t->tdma_force_h_igi); -+ #endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{6} {fw_dig_en}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{7} FA source:{0:original/1:Experimental duration/2:IFS_CLM/3:FAHM}\n"); -+ } else { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ for (i = 1; i < 10; i++) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ -+ if (var1[0] == 0) { -+ if (var1[1] == 1) { -+ dig_t->is_dbg_fa_th = true; -+ dig_t->fa_th[0] = (u32)var1[2]; -+ dig_t->fa_th[1] = (u32)var1[3]; -+ dig_t->fa_th[2] = (u32)var1[4]; -+ -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "Set DIG fa_th[0:2]= {%d, %d, %d}\n", -+ dig_t->fa_th[0], dig_t->fa_th[1], -+ dig_t->fa_th[2]); -+ } else { -+ dig_t->is_dbg_fa_th = false; -+ } -+ #ifdef PHYDM_TDMA_DIG_SUPPORT -+ } else if (var1[0] == 2) { -+ dm->original_dig_restore = (u8)var1[1]; -+ if (dm->original_dig_restore == 1) { -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "Disable TDMA-DIG\n"); -+ } else { -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "Enable TDMA-DIG\n"); -+ } -+ } else if (var1[0] == 3) { -+ dm->tdma_dig_timer_ms = (u8)var1[1]; -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "tdma_dig_timer_ms = %d\n", -+ dm->tdma_dig_timer_ms); -+ } else if (var1[0] == 4) { -+ dm->tdma_dig_state_number = (u8)var1[1]; -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, "tdma_dig_state_number = %d\n", -+ dm->tdma_dig_state_number); -+ } else if (var1[0] == 5) { -+ PHYDM_SSCANF(input[3], DCMD_HEX, &var1[2]); -+ if (var1[1] == 0) { -+ dig_t->tdma_force_l_igi = (u8)var1[2]; -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "force L-state IGI = %2x\n", -+ dig_t->tdma_force_l_igi); -+ } else if (var1[1] == 1) { -+ dig_t->tdma_force_h_igi = (u8)var1[2]; -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "force H-state IGI = %2x\n", -+ dig_t->tdma_force_h_igi); -+ } -+ #endif -+ } -+ -+ #ifdef CFG_DIG_DAMPING_CHK -+ else if (var1[0] == 1) { -+ dig_t->dig_dl_en = (u8)var1[1]; -+ /*@*/ -+ } -+ #endif -+ else if (var1[0] == 6) { -+ phydm_fw_dm_ctrl_en(dm, F00_DIG, (boolean)var1[1]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "fw_dig_enable = %2x\n", dig_t->fw_dig_enable); -+ } else if (var1[0] == 7) { -+ dig_t->fa_source = (u8)var1[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "FA source = %d\n", dig_t->fa_source); -+ } -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#ifdef CONFIG_MCC_DM -+#if (RTL8822B_SUPPORT || RTL8822C_SUPPORT|| RTL8723F_SUPPORT) -+void phydm_mcc_igi_clr(void *dm_void, u8 clr_port) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ -+ mcc_dm->mcc_rssi[clr_port] = 0xff; -+ mcc_dm->mcc_dm_val[0][clr_port] = 0xff; /* 0xc50 clr */ -+ mcc_dm->mcc_dm_val[1][clr_port] = 0xff; /* 0xe50 clr */ -+} -+ -+void phydm_mcc_igi_chk(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ -+ if (mcc_dm->mcc_dm_val[0][0] == 0xff && -+ mcc_dm->mcc_dm_val[0][1] == 0xff) { -+ mcc_dm->mcc_dm_reg[0] = 0xffff; -+ mcc_dm->mcc_reg_id[0] = 0xff; -+ } -+ if (mcc_dm->mcc_dm_val[1][0] == 0xff && -+ mcc_dm->mcc_dm_val[1][1] == 0xff) { -+ mcc_dm->mcc_dm_reg[1] = 0xffff; -+ mcc_dm->mcc_reg_id[1] = 0xff; -+ } -+} -+ -+void phydm_mcc_igi_cal(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u8 shift = 0; -+ u8 igi_val0, igi_val1; -+ -+ if (mcc_dm->mcc_rssi[0] == 0xff) -+ phydm_mcc_igi_clr(dm, 0); -+ if (mcc_dm->mcc_rssi[1] == 0xff) -+ phydm_mcc_igi_clr(dm, 1); -+ phydm_mcc_igi_chk(dm); -+ igi_val0 = mcc_dm->mcc_rssi[0] - shift; -+ igi_val1 = mcc_dm->mcc_rssi[1] - shift; -+ -+ if (igi_val0 < DIG_MIN_PERFORMANCE) -+ igi_val0 = DIG_MIN_PERFORMANCE; -+ -+ if (igi_val1 < DIG_MIN_PERFORMANCE) -+ igi_val1 = DIG_MIN_PERFORMANCE; -+ -+ switch (dm->ic_ip_series) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ case PHYDM_IC_JGR3: -+ phydm_fill_mcccmd(dm, 0, R_0x1d70, igi_val0, igi_val1); -+ phydm_fill_mcccmd(dm, 1, R_0x1d70 + 1, igi_val0, igi_val1); -+ break; -+ #endif -+ default: -+ phydm_fill_mcccmd(dm, 0, R_0xc50, igi_val0, igi_val1); -+ phydm_fill_mcccmd(dm, 1, R_0xe50, igi_val0, igi_val1); -+ break; -+ } -+ -+ PHYDM_DBG(dm, DBG_COMP_MCC, "RSSI_min: %d %d, MCC_igi: %d %d\n", -+ mcc_dm->mcc_rssi[0], mcc_dm->mcc_rssi[1], -+ mcc_dm->mcc_dm_val[0][0], mcc_dm->mcc_dm_val[0][1]); -+} -+#endif /*#if (RTL8822B_SUPPORT)*/ -+#endif /*#ifdef CONFIG_MCC_DM*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dig.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dig.h -new file mode 100644 -index 000000000..68b96ad52 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dig.h -@@ -0,0 +1,396 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMDIG_H__ -+#define __PHYDMDIG_H__ -+ -+/* 2020.08.13 Add IFS-CLM/FAHM in dig fa source for more accurate fa info*/ -+#define DIG_VERSION "3.9" -+ -+#define DIG_HW 0 -+#define DIG_LIMIT_PERIOD 60 /*60 sec*/ -+ -+/*@--------------------Define ---------------------------------------*/ -+ -+/*@=== [DIG Boundary] ========================================*/ -+/*@DIG coverage mode*/ -+#define DIG_MAX_COVERAGR 0x26 -+#define DIG_MIN_COVERAGE 0x1c -+#define DIG_MAX_OF_MIN_COVERAGE 0x22 -+ -+/*@[DIG Balance mode]*/ -+#if (DIG_HW == 1) -+#define DIG_MAX_BALANCE_MODE 0x32 -+#else -+#define DIG_MAX_BALANCE_MODE 0x3e -+#endif -+#define DIG_MAX_OF_MIN_BALANCE_MODE 0x2a -+ -+/*@[DIG Performance mode]*/ -+#define DIG_MAX_PERFORMANCE_MODE 0x5a -+#define DIG_MAX_OF_MIN_PERFORMANCE_MODE 0x40 /*@[WLANBB-871]*/ -+#define DIG_MIN_PERFORMANCE 0x20 -+#if (RTL8822B_SUPPORT == 1) -+#define DIG_MAX_OF_MIN_PERFORMANCE_MODE_22B 0x38 -+#endif -+ -+/*@DIG DFS function*/ -+#define DIG_MAX_DFS 0x28 -+#define DIG_MIN_DFS 0x20 -+ -+/*@DIG LPS function*/ -+#define DIG_MAX_LPS 0x3e -+#define DIG_MIN_LPS 0x20 -+ -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+#define DIG_NUM_OF_TDMA_STATES 2 /*@L, H state*/ -+#define DIG_TIMER_MS 250 -+#define ONE_SEC_MS 1000 -+#endif -+ -+/*@=== [DIG FA Threshold] ======================================*/ -+ -+/*Normal*/ -+#define DM_DIG_FA_TH0 500 -+#define DM_DIG_FA_TH1 750 -+ -+/*@LPS*/ -+#define DM_DIG_FA_TH0_LPS 4 /* @-> 4 lps */ -+#define DM_DIG_FA_TH1_LPS 15 /* @-> 15 lps */ -+#define DM_DIG_FA_TH2_LPS 30 /* @-> 30 lps */ -+ -+#define RSSI_OFFSET_DIG_LPS 5 -+#define DIG_RECORD_NUM 4 -+ -+/*==== [FA duration] =======================================*/ -+/*[PHYDM-406]*/ -+#define OFDM_FA_EXP_DURATION 12 /*us*/ -+#define CCK_FA_EXP_DURATION 175 /*us*/ -+ -+/*@--------------------Enum-----------------------------------*/ -+enum phydm_dig_mode { -+ PHYDM_DIG_PERFORAMNCE_MODE = 0, -+ PHYDM_DIG_COVERAGE_MODE = 1, -+}; -+ -+enum phydm_dig_trend { -+ DIG_STABLE = 0, -+ DIG_INCREASING = 1, -+ DIG_DECREASING = 2 -+}; -+ -+enum phydm_fw_dig_mode_e { -+ DIG_PERFORMANCE_MODE = 0, -+ DIG_COVERAGE_MODE = 1, -+ DIG_LPS_MODE = 2 -+}; -+ -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+enum upd_type { -+ ENABLE_TDMA, -+ MODE_DECISION -+}; -+ -+enum tdma_opmode { -+ MODE_PERFORMANCE = 1, -+ MODE_COVERAGE = 2 -+}; -+ -+#ifdef IS_USE_NEW_TDMA -+enum tdma_dig_timer { -+ INIT_TDMA_DIG_TIMMER, -+ CANCEL_TDMA_DIG_TIMMER, -+ RELEASE_TDMA_DIG_TIMMER -+}; -+ -+enum tdma_dig_state { -+ TDMA_DIG_LOW_STATE = 0, -+ TDMA_DIG_HIGH_STATE = 1, -+ NORMAL_DIG = 2 -+}; -+#endif -+#endif -+ -+/*@--------------------Define Struct-----------------------------------*/ -+#ifdef CFG_DIG_DAMPING_CHK -+struct phydm_dig_recorder_strcut { -+ u8 igi_bitmap; /*@Don't add any new parameter before this*/ -+ u8 igi_history[DIG_RECORD_NUM]; -+ u32 fa_history[DIG_RECORD_NUM]; -+ u8 damping_limit_en; -+ u8 damping_limit_val; /*@Limit IGI_dyn_min*/ -+ u32 limit_time; -+ u8 limit_rssi; -+}; -+#endif -+ -+struct phydm_mcc_dig { -+ u8 mcc_rssi_A; -+ u8 mcc_rssi_B; -+}; -+ -+struct phydm_dig_struct { -+#ifdef CFG_DIG_DAMPING_CHK -+ struct phydm_dig_recorder_strcut dig_recorder_t; -+ u8 dig_dl_en; /*@damping limit function enable*/ -+#endif -+ boolean fw_dig_enable; -+ boolean is_dbg_fa_th; -+ u8 cur_ig_value; -+ boolean igi_dyn_up_hit; -+ u8 igi_trend; -+ u32 rvrt_val; /*all rvrt_val for pause API must set to u32*/ -+ u8 igi_backup; -+ u8 rx_gain_range_max; /*@dig_dynamic_max*/ -+ u8 rx_gain_range_min; /*@dig_dynamic_min*/ -+ u8 dm_dig_max; /*@Absolutly upper bound*/ -+ u8 dm_dig_min; /*@Absolutly lower bound*/ -+ u8 dig_max_of_min; /*@Absolutly max of min*/ -+ u32 ant_div_rssi_max; -+ u8 *is_p2p_in_process; -+ u32 fa_th[3]; -+ u32 dm_dig_fa_th1; -+ u8 fa_source; -+#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8198F_SUPPORT || RTL8192F_SUPPORT || RTL8195B_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8721D_SUPPORT ||\ -+ RTL8710C_SUPPORT || RTL8812F_SUPPORT || RTL8197G_SUPPORT ||\ -+ RTL8723F_SUPPORT) -+ u8 rf_gain_idx; -+ u8 agc_table_idx; -+ u8 big_jump_lmt[16]; -+ u8 enable_adjust_big_jump:1; -+ u8 big_jump_step1:3; -+ u8 big_jump_step2:2; -+ u8 big_jump_step3:2; -+#endif -+ u8 upcheck_init_val; -+ u8 lv0_ratio_reciprocal; -+ u8 lv1_ratio_reciprocal; -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+ u8 cur_ig_value_tdma; -+ u8 low_ig_value; -+ u8 tdma_dig_state; /*@To distinguish which state is now.(L-sate or H-state)*/ -+ u8 tdma_dig_cnt; /*@for phydm_tdma_dig_timer_check use*/ -+ u8 pre_tdma_dig_cnt; -+ u8 sec_factor; -+ u32 cur_timestamp; -+ u32 pre_timestamp; -+ u32 fa_start_timestamp; -+ u32 fa_end_timestamp; -+ u32 fa_acc_1sec_timestamp; -+#ifdef IS_USE_NEW_TDMA -+ u8 tdma_dig_block_cnt;/*@for 1 second dump indicator use*/ -+ /*@dynamic upper bound for L/H state*/ -+ u8 tdma_rx_gain_max[DIG_NUM_OF_TDMA_STATES]; -+ /*@dynamic lower bound for L/H state*/ -+ u8 tdma_rx_gain_min[DIG_NUM_OF_TDMA_STATES]; -+ /*To distinguish current state(L-sate or H-state)*/ -+#endif -+ u8 tdma_force_l_igi; -+ u8 tdma_force_h_igi; -+#endif -+}; -+ -+struct phydm_fa_struct { -+ u32 cnt_parity_fail; -+ u32 cnt_rate_illegal; -+ u32 cnt_crc8_fail; -+ u32 cnt_crc8_fail_vhta; -+ u32 cnt_crc8_fail_vhtb; -+ u32 cnt_mcs_fail; -+ u32 cnt_mcs_fail_vht; -+ u32 cnt_ofdm_fail; -+ u32 cnt_ofdm_fail_pre; /* @For RTL8881A */ -+ u32 cnt_cck_fail; -+ u32 cnt_all; -+ u32 cnt_all_accumulated; -+ u32 cnt_all_pre; -+ 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; -+ u32 cnt_bw_lsc; -+ u32 cnt_cck_crc32_error; -+ u32 cnt_cck_crc32_ok; -+ u32 cnt_ofdm_crc32_error; -+ u32 cnt_ofdm_crc32_ok; -+ u32 cnt_ht_crc32_error; -+ u32 cnt_ht_crc32_ok; -+ u32 cnt_ht_crc32_error_agg; -+ u32 cnt_ht_crc32_ok_agg; -+ u32 cnt_vht_crc32_error; -+ u32 cnt_vht_crc32_ok; -+ u32 cnt_crc32_error_all; -+ u32 cnt_crc32_ok_all; -+ u32 time_fa_all; -+ u32 time_fa_exp; /*FA duration, [PHYDM-406]*/ -+ u32 time_fa_ifs_clm; /*FA duration, [PHYDM-406]*/ -+ u32 time_fa_fahm; /*FA duration, [PHYDM-406]*/ -+ boolean cck_block_enable; -+ boolean ofdm_block_enable; -+ u32 dbg_port0; -+ boolean edcca_flag; -+ u8 ofdm2_rate_idx; -+ u32 cnt_ofdm2_crc32_error; -+ u32 cnt_ofdm2_crc32_ok; -+ u8 ofdm2_pcr; -+ u8 ht2_rate_idx; -+ u32 cnt_ht2_crc32_error; -+ u32 cnt_ht2_crc32_ok; -+ u8 ht2_pcr; -+ u8 vht2_rate_idx; -+ u32 cnt_vht2_crc32_error; -+ u32 cnt_vht2_crc32_ok; -+ u8 vht2_pcr; -+ u32 cnt_cck_txen; -+ u32 cnt_cck_txon; -+ u32 cnt_ofdm_txen; -+ u32 cnt_ofdm_txon; -+}; -+ -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+struct phydm_fa_acc_struct { -+ 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_all_pre; -+ u32 cnt_fast_fsync; -+ u32 cnt_sb_search_fail; -+ u32 cnt_ofdm_cca; -+ u32 cnt_cck_cca; -+ u32 cnt_cca_all; -+ u32 cnt_cck_crc32_error; -+ u32 cnt_cck_crc32_ok; -+ u32 cnt_ofdm_crc32_error; -+ u32 cnt_ofdm_crc32_ok; -+ u32 cnt_ht_crc32_error; -+ u32 cnt_ht_crc32_ok; -+ u32 cnt_vht_crc32_error; -+ u32 cnt_vht_crc32_ok; -+ u32 cnt_crc32_error_all; -+ u32 cnt_crc32_ok_all; -+ u32 cnt_all_1sec; -+ u32 cnt_cca_all_1sec; -+ u32 cnt_cck_fail_1sec; -+}; -+ -+#endif /*@#ifdef PHYDM_TDMA_DIG_SUPPORT*/ -+ -+/*@--------------------Function declaration-----------------------------*/ -+void phydm_write_dig_reg(void *dm_void, u8 igi); -+ -+void odm_write_dig(void *dm_void, u8 current_igi); -+ -+u8 phydm_get_igi(void *dm_void, enum bb_path path); -+ -+void phydm_set_dig_val(void *dm_void, u32 *val_buf, u8 val_len); -+ -+void odm_pause_dig(void *dm_void, enum phydm_pause_type pause_type, -+ enum phydm_pause_level pause_level, u8 igi_value); -+ -+#ifdef PHYDM_HW_IGI -+void phydm_hwigi(void *dm_void); -+ -+void phydm_hwigi_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#endif -+ -+void phydm_dig_init(void *dm_void); -+ -+void phydm_dig(void *dm_void); -+ -+void phydm_dig_lps_32k(void *dm_void); -+ -+void phydm_dig_by_rssi_lps(void *dm_void); -+ -+void phydm_get_dig_coverage(void *dm_void, u8 *max, u8 *min); -+ -+u8 phydm_get_igi_for_target_pin_scan(void *dm_void, u8 rssi); -+ -+void phydm_false_alarm_counter_statistics(void *dm_void); -+ -+u32 phydm_get_edcca_report(void * dm_void); -+ -+#ifdef PHYDM_TDMA_DIG_SUPPORT -+void phydm_set_tdma_dig_timer(void *dm_void); -+ -+void phydm_tdma_dig_timer_check(void *dm_void); -+ -+void phydm_tdma_dig(void *dm_void); -+ -+void phydm_tdma_false_alarm_counter_check(void *dm_void); -+ -+void phydm_tdma_dig_add_interrupt_mask_handler(void *dm_void); -+ -+void phydm_false_alarm_counter_reset(void *dm_void); -+ -+void phydm_false_alarm_counter_acc(void *dm_void, boolean rssi_dump_en); -+ -+void phydm_false_alarm_counter_acc_reset(void *dm_void); -+ -+void phydm_tdma_dig_para_upd(void *dm_void, enum upd_type type, u8 input); -+ -+#ifdef IS_USE_NEW_TDMA -+void phydm_tdma_dig_timers(void *dm_void, u8 state); -+ -+void phydm_tdma_dig_cbk(void *dm_void); -+ -+void phydm_tdma_dig_workitem_callback(void *dm_void); -+ -+void phydm_tdma_fa_cnt_chk(void *dm_void); -+ -+void phydm_tdma_low_dig(void *dm_void); -+ -+void phydm_tdma_high_dig(void *dm_void); -+ -+void phydm_fa_cnt_acc(void *dm_void, boolean rssi_dump_en, -+ u8 cur_tdma_dig_state); -+#endif /*@#ifdef IS_USE_NEW_TDMA*/ -+#endif /*@#ifdef PHYDM_TDMA_DIG_SUPPORT*/ -+ -+void phydm_set_ofdm_agc_tab(void *dm_void, u8 tab_sel); -+ -+void phydm_dig_debug(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len); -+ -+void phydm_fill_fw_dig_info(void *dm_void, boolean *enable, -+ u8 *para4, u8 *para8); -+ -+void phydm_crc32_cnt_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+#ifdef CONFIG_MCC_DM -+void phydm_mcc_igi_cal(void *dm_void); -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_direct_bf.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_direct_bf.c -new file mode 100644 -index 000000000..55dd2f8da ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_direct_bf.c -@@ -0,0 +1,366 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ***************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+#ifdef CONFIG_DIRECTIONAL_BF -+#ifdef PHYDM_COMPILE_IC_2SS -+void phydm_iq_gen_en(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ enum rf_path i = RF_PATH_A; -+ enum rf_path path = RF_PATH_A; -+ -+ #if (ODM_IC_11AC_SERIES_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8822B) { -+ for (i = RF_PATH_A; i <= RF_PATH_B; i++) { -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, path, RF_0xef, BIT(19), 0x1); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, path, RF_0x33, 0xF, 3); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, path, RF_0x3e, 0xfffff, 0x00036); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, path, RF_0x3f, 0xfffff, 0x5AFCE); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, path, RF_0xef, BIT(19), 0x0); -+ } -+ } -+ #endif -+ -+ #if (ODM_IC_11N_SERIES_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8192F) { -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); -+ /* Path A */ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x08000); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0005f); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x01042); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0004f); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x71fc2); -+ /* Path B */ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x08000); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x00050); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x01042); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x00040); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x71fc2); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); -+ } -+ #endif -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_RTL8197G) { -+ /*RF mode table write enable*/ -+ /* Path A */ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x000cf); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x71fc2); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); -+ -+ /* Path B */ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x000cf); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x71fc2); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x08000); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x000ef); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x01042); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); -+ } -+ #endif -+ -+} -+ -+void phydm_dis_cdd(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ #if (ODM_IC_11AC_SERIES_SUPPORT) -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ odm_set_bb_reg(dm, R_0x808, 0x3ffff00, 0); -+ odm_set_bb_reg(dm, R_0x9ac, 0x1fff, 0); -+ odm_set_bb_reg(dm, R_0x9ac, BIT(13), 1); -+ } -+ #endif -+ #if (ODM_IC_11N_SERIES_SUPPORT) -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ odm_set_bb_reg(dm, R_0x90c, 0xffffffff, 0x83321333); -+ /* Set Tx delay setting for CCK pathA,B*/ -+ odm_set_bb_reg(dm, R_0xa2c, 0xf0000000, 0); -+ /*Enable Tx CDD for HT part when spatial expansion is applied*/ -+ odm_set_bb_reg(dm, R_0xd00, BIT(8), 0); -+ /* Tx CDD for Legacy*/ -+ odm_set_bb_reg(dm, R_0xd04, 0xf0000, 0); -+ /* Tx CDD for non-HT*/ -+ odm_set_bb_reg(dm, R_0xd0c, 0x3c0, 0); -+ /* Tx CDD for HT SS1*/ -+ odm_set_bb_reg(dm, R_0xd0c, 0xf8000, 0); -+ } -+ #endif -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ /* Tx CDD for Legacy Preamble*/ -+ odm_set_bb_reg(dm, R_0x1cc0, 0xffffffff, 0x24800000); -+ /* Tx CDD for HT Preamble*/ -+ odm_set_bb_reg(dm, R_0x1cb0, 0xffffffff, 0); -+ } -+ #endif -+} -+ -+void phydm_pathb_q_matrix_rotate_en(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ phydm_iq_gen_en(dm); -+ -+ /*#ifdef PHYDM_COMMON_API_SUPPORT*/ -+ /*path selection is controlled by driver*/ -+ #if 0 -+ if (!phydm_api_trx_mode(dm, BB_PATH_AB, BB_PATH_AB, BB_PATH_AB)) -+ return; -+ #endif -+ -+ phydm_dis_cdd(dm); -+ phydm_pathb_q_matrix_rotate(dm, 0); -+ -+ #if (ODM_IC_11AC_SERIES_SUPPORT) -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ /*Set Q matrix r_v11 =1*/ -+ odm_set_bb_reg(dm, R_0x195c, MASKDWORD, 0x40000); -+ /*Set Q matrix enable*/ -+ odm_set_bb_reg(dm, R_0x191c, BIT(7), 1); -+ } -+ #endif -+} -+ -+void phydm_pathb_q_matrix_rotate(void *dm_void, u16 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ #if (ODM_IC_11AC_SERIES_SUPPORT) -+ u32 phase_table_0[ANGLE_NUM] = {0x40000, 0x376CF, 0x20000, 0x00000, -+ 0xFE0000, 0xFC8930, 0xFC0000, -+ 0xFC8930, 0xFDFFFF, 0x000000, -+ 0x020000, 0x0376CF}; -+ u32 phase_table_1[ANGLE_NUM] = {0x00000, 0x1FFFF, 0x376CF, 0x40000, -+ 0x0376CF, 0x01FFFF, 0x000000, -+ 0xFDFFFF, 0xFC8930, 0xFC0000, -+ 0xFC8930, 0xFDFFFF}; -+ #endif -+ #if (ODM_IC_11N_SERIES_SUPPORT) -+ u32 phase_table_n_0[ANGLE_NUM] = {0x00, 0x0B, 0x02, 0x00, 0x02, 0x02, -+ 0x04, 0x02, 0x0D, 0x09, 0x04, 0x0B}; -+ u32 phase_table_n_1[ANGLE_NUM] = {0x40000100, 0x377F00DD, 0x201D8880, -+ 0x00000000, 0xE01D8B80, 0xC8BF0322, -+ 0xC000FF00, 0xC8BF0322, 0xDFE2777F, -+ 0xFFC003FF, 0x20227480, 0x377F00DD}; -+ u32 phase_table_n_2[ANGLE_NUM] = {0x00, 0x1E, 0x3C, 0x4C, 0x3C, 0x1E, -+ 0x0F, 0xD2, 0xC3, 0xC4, 0xC3, 0xD2}; -+ #endif -+ if (idx >= ANGLE_NUM) { -+ pr_debug("[%s]warning Phase Set Error: %d\n", __func__, idx); -+ return; -+ } -+ -+ switch (dm->ic_ip_series) { -+ #if (ODM_IC_11AC_SERIES_SUPPORT == 1) -+ case PHYDM_IC_AC: -+ /*Set Q matrix r_v21*/ -+ odm_set_bb_reg(dm, R_0x1954, 0xffffff, phase_table_0[idx]); -+ odm_set_bb_reg(dm, R_0x1950, 0xffffff, phase_table_1[idx]); -+ break; -+ #endif -+ -+ #if (ODM_IC_11N_SERIES_SUPPORT == 1) -+ case PHYDM_IC_N: -+ /*Set Q matrix r_v21*/ -+ odm_set_bb_reg(dm, R_0xc4c, 0xff000000, phase_table_n_0[idx]); -+ odm_set_bb_reg(dm, R_0xc88, 0xffffffff, phase_table_n_1[idx]); -+ odm_set_bb_reg(dm, R_0xc9c, 0xff000000, phase_table_n_2[idx]); -+ break; -+ #endif -+ -+ default: -+ break; -+ } -+} -+ -+/*Before use this API, Fill correct Tx Des. and Disable STBC in advance*/ -+void phydm_set_direct_bfer(void *dm_void, u16 phs_idx, u8 su_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8822B) { -+#if 0 -+ u8 phi[13] = {0x0, 0x5, 0xa, 0xf, 0x15, 0x1a, 0x1f, 0x25, -+ 0x2a, 0x2f, 0x35, 0x3a, 0x0}; -+ u8 psi[13] = {0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, -+ 0x7, 0x7, 0x7, 0x7}; -+ u16 psiphi[13] = {0x1c0, 0x1c5, 0x1ca, 0x1cf, 0x1d5, 0x1da, -+ 0x1df, 0x1e5, 0x1ea, 0x1ef, 0x1f5, 0x1fa, -+ 0x1c0}; //{Psi_4bit, Phi_6bit} of 0~360 -+#endif -+ u16 ns[3] = {52, 108, 234}; //20/40/80 MHz subcarrier number -+ u16 psiphi[13] = {0x1c0, 0x1c5, 0x1ca, 0x1cf, 0x1d5, 0x1da, -+ 0x1df, 0x1e5, 0x1ea, 0x1ef, 0x1f5, 0x1fa, -+ 0x1c0}; //{Psi_4bit, Phi_6bit} of 0~360 -+ u16 psiphiR; -+ u8 i; -+ u8 snr = 0x12; // for 1SS BF -+ u8 nc = 0x0; //bit 2-0 -+ u8 nr = 0x1; //bit 5-3 -+ u8 ng = 0x0; //bit 7-6 -+ u8 cb = 0x1; //bit 9-8; 1 => phi:6, psi:4; -+ u32 bw = odm_get_bb_reg(dm, R_0x8ac, 0x3); //bit 11-10 -+ u8 userid = su_idx; //bit 12 -+ u32 csi_report = 0x0; -+ u32 ndp_bw = odm_get_bb_reg(dm, R_0x8ac, 0x3); //bit 11-10 -+ u8 ndp_sc = 0; //bit 11-10 -+ u32 ndp_info = 0x0; -+ -+ u16 mem_num = 0; -+ u8 mem_move = 0; -+ u8 mem_sel = 0; -+ u16 mem_addr = 0; -+ u32 dw0, dw1; -+ u64 vm_info = 0; -+ u64 temp = 0; -+ u8 vm_cnt = 0; -+ -+ mem_num = ((8 + (6 + 4) * ns[bw]) >> 6) + 1; // SU codebook 1 -+ -+ /* setting NDP BW/SC info*/ -+ ndp_info = (ndp_bw & 0x3) | (ndp_bw & 0x3) << 6 | -+ (ndp_bw & 0x3) << 12 | (ndp_sc & 0xf) << 2 | -+ (ndp_sc & 0xf) << 8 | (ndp_sc & 0xf) << 14; -+ odm_set_bb_reg(dm, R_0xb58, 0x000FFFFC, ndp_info); -+ odm_set_bb_reg(dm, R_0x19f8, 0x00010000, 1); -+ ODM_delay_ms(1); // delay 1ms -+ odm_set_bb_reg(dm, R_0x19f8, 0x00010000, 0); -+ -+ /* setting CSI report info*/ -+ csi_report = (userid & 0x1) << 12 | (bw & 0x3) << 10 | -+ (cb & 0x3) << 8 | (ng & 0x3) << 6 | -+ (nr & 0x7) << 3 | (nc & 0x7); -+ odm_set_bb_reg(dm, R_0x72c, 0x1FFF, csi_report); -+ odm_set_bb_reg(dm, R_0x71c, 0x80000000, 1); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] direct BF csi report 0x%x\n", -+ __func__, csi_report); -+ /*========================*/ -+ -+ odm_set_bb_reg(dm, R_0x19b8, 0x40, 1); //0x19b8[6]:1 to csi_rpt -+ odm_set_bb_reg(dm, R_0x19e0, 0x3FC0, 0xFF); //gated_clk off -+ odm_set_bb_reg(dm, R_0x9e8, 0x2000000, 1); //abnormal txbf -+ odm_set_bb_reg(dm, R_0x9e8, 0x1000000, 0); //read phi psi -+ odm_set_bb_reg(dm, R_0x9e8, 0x70000000, su_idx); //SU user 0 -+ odm_set_bb_reg(dm, R_0x1910, 0x8000, 0); //BFer -+ -+ dw0 = 0; // for 0x9ec -+ dw1 = 0; // for 0x1900 -+ mem_addr = 0; -+ mem_sel = 0; -+ mem_move = 0; -+ vm_info = vm_info | (snr & 0xff); //V matrix info -+ vm_cnt = 8; // V matrix length counter -+ psiphiR = (psiphi[phs_idx] & 0x3ff); -+ -+ while (mem_addr < mem_num) { -+ while (vm_cnt <= 32) { -+ // shift only max. 32 bit -+ if (vm_cnt >= 20) { -+ temp = psiphiR << 20; -+ temp = temp << (vm_cnt - 20); -+ } else { -+ temp = psiphiR << vm_cnt; -+ } -+ vm_info |= temp; -+ vm_cnt += 10; -+ } -+ if (mem_sel == 0) { -+ dw0 = vm_info & 0xffffffff; -+ vm_info = vm_info >> 32; -+ vm_cnt -= 32; -+ mem_sel = 1; -+ mem_move = 0; -+ } else { -+ dw1 = vm_info & 0xffffffff; -+ vm_info = vm_info >> 32; -+ vm_cnt -= 32; -+ mem_sel = 0; -+ mem_move = 1; -+ } -+ if (mem_move == 1) { -+ odm_set_bb_reg(dm, 0x9e8, 0x1000000, 0); -+ //read phi psi -+ odm_set_bb_reg(dm, 0x1910, 0x3FF0000, -+ mem_addr); -+ odm_set_bb_reg(dm, 0x09ec, 0xFFFFFFFF, dw0); -+ odm_set_bb_reg(dm, 0x1900, 0xFFFFFFFF, dw1); -+ odm_set_bb_reg(dm, 0x9e8, 0x1000000, 1); -+ //write phi psi -+ mem_move = 0; -+ mem_addr += 1; -+ } -+ } -+ odm_set_bb_reg(dm, 0x9e8, 0x2000000, 0); //normal txbf -+ } -+#endif -+} //end function -+ -+/*Before use this API, Disable STBC in advance*/ -+/*only 1SS rate can improve performance*/ -+void phydm_set_direct_bfer_txdesc_en(void *dm_void, u8 enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197G) { -+ phydm_iq_gen_en(dm); -+ -+ /*#ifdef PHYDM_COMMON_API_SUPPORT*/ -+ /*path selection is controlled by driver, use 1ss 2Tx*/ -+ #if 0 -+ if (!phydm_api_trx_mode(dm, BB_PATH_AB, BB_PATH_AB, BB_PATH_AB)) -+ return; -+ #endif -+ -+ phydm_dis_cdd(dm); -+ if (enable) -+ odm_set_bb_reg(dm, R_0x1d90, 0x8000, 1); -+ else -+ odm_set_bb_reg(dm, R_0x1d90, 0x8000, 0); -+ } -+#endif -+} //end function -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_direct_bf.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_direct_bf.h -new file mode 100644 -index 000000000..c9c4c4bed ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_direct_bf.h -@@ -0,0 +1,44 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_DIR_BF_H__ -+#define __PHYDM_DIR_BF_H__ -+ -+#ifdef CONFIG_DIRECTIONAL_BF -+#define ANGLE_NUM 12 -+ -+/*@ -+ * ============================================================ -+ * function prototype -+ * ============================================================ -+ */ -+void phydm_iq_gen_en(void *dm_void); -+void phydm_dis_cdd(void *dm_void); -+void phydm_pathb_q_matrix_rotate_en(void *dm_void); -+void phydm_pathb_q_matrix_rotate(void *dm_void, u16 idx); -+void phydm_set_direct_bfer(void *dm_void, u16 phs_idx, u8 su_idx); -+void phydm_set_direct_bfer_txdesc_en(void *dm_void, u8 enable); -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dynamictxpower.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dynamictxpower.c -new file mode 100644 -index 000000000..b9d67821e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dynamictxpower.c -@@ -0,0 +1,795 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/************************************************************* -+ * include files -+ ************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef CONFIG_DYNAMIC_TX_TWR -+#ifdef BB_RAM_SUPPORT -+void phydm_rd_reg_pwr(void *dm_void, u32 *_used, char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ boolean pwr_ofst0_en = false; -+ boolean pwr_ofst1_en = false; -+ s8 pwr_ofst0 = 0; -+ s8 pwr_ofst1 = 0; -+ -+ pwr_ofst0_en = (boolean)odm_get_bb_reg(dm, R_0x1e70, BIT(23)); -+ pwr_ofst1_en = (boolean)odm_get_bb_reg(dm, R_0x1e70, BIT(31)); -+ pwr_ofst0 = (s8)odm_get_bb_reg(dm, R_0x1e70, 0x7f0000); -+ pwr_ofst1 = (s8)odm_get_bb_reg(dm, R_0x1e70, 0x7f000000); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "reg0: en:%d, pwr_ofst:0x%x, reg1: en:%d, pwr_ofst:0x%x\n", -+ pwr_ofst0_en, pwr_ofst0, pwr_ofst1_en, pwr_ofst1); -+ -+ *_used = used; -+ *_out_len = out_len; -+}; -+ -+void phydm_wt_reg_pwr(void *dm_void, boolean is_ofst1, boolean pwr_ofst_en, -+ s8 pwr_ofst) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bb_ram_ctrl *bb_ctrl = &dm->p_bb_ram_ctrl; -+ u8 reg_0x1e70 = 0; -+ -+ if (!is_ofst1) { -+ bb_ctrl->tx_pwr_ofst_reg0_en = pwr_ofst_en; -+ bb_ctrl->tx_pwr_ofst_reg0 = pwr_ofst; -+ -+ reg_0x1e70 |= (pwr_ofst_en << 7) + (pwr_ofst & 0x7f); -+ odm_set_bb_reg(dm, R_0x1e70, 0x00ff0000, reg_0x1e70); -+ } else { -+ bb_ctrl->tx_pwr_ofst_reg1_en = pwr_ofst_en; -+ bb_ctrl->tx_pwr_ofst_reg1 = pwr_ofst; -+ -+ reg_0x1e70 |= (pwr_ofst_en << 7) + (pwr_ofst & 0x7f); -+ odm_set_bb_reg(dm, R_0x1e70, 0xff000000, reg_0x1e70); -+ } -+}; -+ -+void phydm_rd_ram_pwr(void *dm_void, u8 macid, u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ boolean pwr_ofst0_en = false; -+ boolean pwr_ofst1_en = false; -+ s8 pwr_ofst0 = 0; -+ s8 pwr_ofst1 = 0; -+ u32 reg_0x1e84 = 0; -+ -+ reg_0x1e84 |= (macid & 0x3f) << 24; /* macid*/ -+ reg_0x1e84 |= BIT(31); /* read_en*/ -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, reg_0x1e84); -+ -+ pwr_ofst0_en = (boolean)odm_get_bb_reg(dm, R_0x2de8, BIT(23)); -+ pwr_ofst1_en = (boolean)odm_get_bb_reg(dm, R_0x2de8, BIT(31)); -+ pwr_ofst0 = (s8)odm_get_bb_reg(dm, R_0x2de8, 0x7f0000); -+ pwr_ofst1 = (s8)odm_get_bb_reg(dm, R_0x2de8, 0x7f000000); -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, 0x0); /* disable rd/wt*/ -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "(macid:%d) ram0: en:%d, pwr_ofst:0x%x, ram1: en:%d, pwr_ofst:0x%x\n", -+ macid, pwr_ofst0_en, pwr_ofst0, pwr_ofst1_en, pwr_ofst1); -+ -+ *_used = used; -+ *_out_len = out_len; -+}; -+ -+void phydm_wt_ram_pwr(void *dm_void, u8 macid, boolean is_ofst1, -+ boolean pwr_ofst_en, s8 pwr_ofst) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bb_ram_per_sta *dm_ram_per_sta = NULL; -+ u32 reg_0x1e84 = 0; -+ boolean pwr_ofst_ano_en = false; -+ s8 pwr_ofst_ano = 0; -+ -+ if (macid > 63) -+ macid = 63; -+ -+ dm_ram_per_sta = &dm->p_bb_ram_ctrl.pram_sta_ctrl[macid]; -+ reg_0x1e84 = (dm_ram_per_sta->hw_igi_en << 7) + dm_ram_per_sta->hw_igi; -+ if (!is_ofst1) { -+ dm_ram_per_sta->tx_pwr_offset0_en = pwr_ofst_en; -+ dm_ram_per_sta->tx_pwr_offset0 = pwr_ofst; -+ -+ pwr_ofst_ano_en = dm_ram_per_sta->tx_pwr_offset1_en; -+ pwr_ofst_ano = dm_ram_per_sta->tx_pwr_offset1; -+ -+ reg_0x1e84 |= (pwr_ofst_en << 15) + ((pwr_ofst & 0x7f) << 8) + -+ (pwr_ofst_ano_en << 23) + -+ ((pwr_ofst_ano & 0x7f) << 16); -+ } else { -+ dm_ram_per_sta->tx_pwr_offset1_en = pwr_ofst_en; -+ dm_ram_per_sta->tx_pwr_offset1 = pwr_ofst; -+ -+ pwr_ofst_ano_en = dm_ram_per_sta->tx_pwr_offset0_en; -+ pwr_ofst_ano = dm_ram_per_sta->tx_pwr_offset0; -+ -+ reg_0x1e84 |= (pwr_ofst_ano_en << 15) + -+ ((pwr_ofst_ano & 0x7f) << 8) + -+ (pwr_ofst_en << 23) + ((pwr_ofst & 0x7f) << 16); -+ } -+ reg_0x1e84 |= (macid & 0x3f) << 24;/* macid*/ -+ reg_0x1e84 |= BIT(30); /* write_en*/ -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, reg_0x1e84); -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, 0x80000000); /* read_en*/ -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, 0x0); /* disable rd/wt*/ -+}; -+ -+void phydm_rst_ram_pwr(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bb_ram_per_sta *dm_ram_per_sta = NULL; -+ u32 reg_0x1e84 = 0; -+ u8 i = 0; -+ -+ for (i = 0; i < 64; i++) { -+ dm_ram_per_sta = &dm->p_bb_ram_ctrl.pram_sta_ctrl[i]; -+ dm_ram_per_sta->tx_pwr_offset0_en = false; -+ dm_ram_per_sta->tx_pwr_offset1_en = false; -+ dm_ram_per_sta->tx_pwr_offset0 = 0x0; -+ dm_ram_per_sta->tx_pwr_offset1 = 0x0; -+ reg_0x1e84 = (dm_ram_per_sta->hw_igi_en << 7) + -+ dm_ram_per_sta->hw_igi; -+ reg_0x1e84 |= (i & 0x3f) << 24; -+ reg_0x1e84 |= BIT(30); -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, reg_0x1e84); -+ } -+ -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, 0x80000000); -+ odm_set_bb_reg(dm, R_0x1e84, MASKDWORD, 0x0); -+}; -+ -+u8 phydm_pwr_lv_mapping_2nd(u8 tx_pwr_lv) -+{ -+ if (tx_pwr_lv == tx_high_pwr_level_level3) -+ return PHYDM_2ND_OFFSET_MINUS_11DB; -+ else if (tx_pwr_lv == tx_high_pwr_level_level2) -+ return PHYDM_2ND_OFFSET_MINUS_7DB; -+ else if (tx_pwr_lv == tx_high_pwr_level_level1) -+ return PHYDM_2ND_OFFSET_MINUS_3DB; -+ else -+ return PHYDM_2ND_OFFSET_ZERO; -+} -+ -+void phydm_pwr_lv_ctrl(void *dm_void, u8 macid, u8 tx_pwr_lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ s8 pwr_offset = 0; -+ -+ if (tx_pwr_lv == tx_high_pwr_level_level3) -+ pwr_offset = PHYDM_BBRAM_OFFSET_MINUS_11DB; -+ else if (tx_pwr_lv == tx_high_pwr_level_level2) -+ pwr_offset = PHYDM_BBRAM_OFFSET_MINUS_7DB; -+ else if (tx_pwr_lv == tx_high_pwr_level_level1) -+ pwr_offset = PHYDM_BBRAM_OFFSET_MINUS_3DB; -+ else -+ pwr_offset = PHYDM_BBRAM_OFFSET_ZERO; -+ -+ phydm_wt_ram_pwr(dm, macid, RAM_PWR_OFST0, true, pwr_offset); -+} -+ -+void phydm_dtp_fill_cmninfo_2nd(void *dm_void, u8 sta_id, u8 dtp_lvl) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[sta_id]; -+ struct dtp_info *dtp = NULL; -+ -+ if (!is_sta_active(sta)) -+ return; -+ -+ dtp = &dm->phydm_sta_info[sta_id]->dtp_stat; -+ dtp->dyn_tx_power = phydm_pwr_lv_mapping_2nd(dtp_lvl); -+ phydm_pwr_lv_ctrl(dm, sta->mac_id, dtp_lvl); -+ -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "Fill cmninfo TxPwr: sta_id=(%d), macid=(%d), PwrLv (%d)\n", -+ sta_id, sta->mac_id, dtp->dyn_tx_power); -+} -+ -+void phydm_dtp_init_2nd(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ -+ #if (RTL8822C_SUPPORT || RTL8812F_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F)) { -+ phydm_rst_ram_pwr(dm); -+ /* rsp tx use type 0*/ -+ odm_set_mac_reg(dm, R_0x6d8, BIT(19) | BIT(18), RAM_PWR_OFST0); -+ } -+ #endif -+}; -+#endif -+ -+boolean -+phydm_check_rates(void *dm_void, u8 rate_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 check_rate_bitmap0 = 0x08080808; /* @check CCK11M, OFDM54M, MCS7, MCS15*/ -+ u32 check_rate_bitmap1 = 0x80200808; /* @check MCS23, MCS31, VHT1SS M9, VHT2SS M9*/ -+ u32 check_rate_bitmap2 = 0x00080200; /* @check VHT3SS M9, VHT4SS M9*/ -+ u32 bitmap_result = 0; -+ -+#if (RTL8822B_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8822B) { -+ check_rate_bitmap2 &= 0; -+ check_rate_bitmap1 &= 0xfffff000; -+ check_rate_bitmap0 &= 0x0fffffff; -+ } -+#endif -+#if (RTL8197F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197F) { -+ check_rate_bitmap2 &= 0; -+ check_rate_bitmap1 &= 0; -+ check_rate_bitmap0 &= 0x0fffffff; -+ } -+#endif -+#if (RTL8192E_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8192E) { -+ check_rate_bitmap2 &= 0; -+ check_rate_bitmap1 &= 0; -+ check_rate_bitmap0 &= 0x0fffffff; -+ } -+#endif -+#if (RTL8192F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8192F) { -+ check_rate_bitmap2 &= 0; -+ check_rate_bitmap1 &= 0; -+ check_rate_bitmap0 &= 0x0fffffff; -+ } -+#endif -+#if (RTL8721D_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8721D) { -+ check_rate_bitmap2 &= 0; -+ check_rate_bitmap1 &= 0; -+ check_rate_bitmap0 &= 0x000fffff; -+ } -+#endif -+#if (RTL8821C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8821C) { -+ check_rate_bitmap2 &= 0; -+ check_rate_bitmap1 &= 0x003ff000; -+ check_rate_bitmap0 &= 0x000fffff; -+ } -+#endif -+ if (rate_idx >= 64) -+ bitmap_result = BIT(rate_idx - 64) & check_rate_bitmap2; -+ else if (rate_idx >= 32) -+ bitmap_result = BIT(rate_idx - 32) & check_rate_bitmap1; -+ else // if (rate_idx <= 31) -+ bitmap_result = BIT(rate_idx) & check_rate_bitmap0; -+ -+ if (bitmap_result != 0) -+ return true; -+ else -+ return false; -+} -+ -+enum rf_path -+phydm_check_paths(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ enum rf_path max_path = RF_PATH_A; -+ -+ if (dm->num_rf_path == 1) -+ max_path = RF_PATH_A; -+ if (dm->num_rf_path == 2) -+ max_path = RF_PATH_B; -+ if (dm->num_rf_path == 3) -+ max_path = RF_PATH_C; -+ if (dm->num_rf_path == 4) -+ max_path = RF_PATH_D; -+ -+ return max_path; -+} -+ -+#ifdef PHYDM_COMMON_API_NOT_SUPPORT -+u8 phydm_dtp_get_txagc(void *dm_void, enum rf_path path, u8 hw_rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 ret = 0xff; -+ -+ ret = config_phydm_read_txagc_n(dm, path, hw_rate); -+ -+ return ret; -+} -+#endif -+ -+u8 phydm_search_min_power_index(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ enum rf_path path; -+ enum rf_path max_path; -+ u8 min_gain_index = 0x3f; -+ u8 gain_index = 0; -+ u8 i; -+ -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, "%s\n", __func__); -+ max_path = phydm_check_paths(dm); -+ for (path = 0; path <= max_path; path++) -+ for (i = 0; i < 84; i++) -+ if (phydm_check_rates(dm, i)) { -+ -+ if (dm->support_ic_type & PHYDM_COMMON_API_IC) { -+ #ifdef PHYDM_COMMON_API_SUPPORT -+ /*97F,8822B,92F,8821C*/ -+ gain_index = phydm_api_get_txagc(dm, path, i); -+ #endif -+ } else { -+ /*92E*/ -+ #ifdef PHYDM_COMMON_API_NOT_SUPPORT -+ gain_index = phydm_dtp_get_txagc(dm, path, i); -+ #endif -+ } -+ -+ if (gain_index == 0xff) { -+ min_gain_index = 0x20; -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "Error Gain idx!! Rewite to: ((%d))\n", -+ min_gain_index); -+ break; -+ } -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "Support Rate: ((%d)) -> Gain idx: ((%d))\n", -+ i, gain_index); -+ if (gain_index < min_gain_index) -+ min_gain_index = gain_index; -+ } -+ return min_gain_index; -+} -+ -+void phydm_dynamic_tx_power_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ -+ dm->last_dtp_lvl = tx_high_pwr_level_normal; -+ dm->dynamic_tx_high_power_lvl = tx_high_pwr_level_normal; -+ -+ switch (dm->ic_ip_series) { -+ #ifdef BB_RAM_SUPPORT -+ case PHYDM_IC_JGR3: -+ dm->set_pwr_th[0] = TX_PWR_NEAR_FIELD_TH_JGR3_LVL1; -+ dm->set_pwr_th[1] = TX_PWR_NEAR_FIELD_TH_JGR3_LVL2; -+ dm->set_pwr_th[2] = TX_PWR_NEAR_FIELD_TH_JGR3_LVL3; -+ phydm_dtp_init_2nd(dm); -+ break; -+ #endif -+ default: -+ for (i = 0; i < 3; i++) -+ dm->enhance_pwr_th[i] = 0xff; -+ -+ dm->set_pwr_th[0] = TX_POWER_NEAR_FIELD_THRESH_LVL1; -+ dm->set_pwr_th[1] = TX_POWER_NEAR_FIELD_THRESH_LVL2; -+ dm->set_pwr_th[2] = 0xff; -+ dm->min_power_index = phydm_search_min_power_index(dm); -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, "DTP init: Min Gain idx: ((%d))\n", -+ dm->min_power_index); -+ break; -+ } -+} -+ -+void phydm_noisy_enhance_hp_th(void *dm_void, u8 noisy_state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (noisy_state == 0) { -+ dm->enhance_pwr_th[0] = dm->set_pwr_th[0]; -+ dm->enhance_pwr_th[1] = dm->set_pwr_th[1]; -+ dm->enhance_pwr_th[2] = dm->set_pwr_th[2]; -+ } else { -+ dm->enhance_pwr_th[0] = dm->set_pwr_th[0] + 8; -+ dm->enhance_pwr_th[1] = dm->set_pwr_th[1] + 5; -+ dm->enhance_pwr_th[2] = dm->set_pwr_th[2]; -+ } -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "DTP hp_enhance_th: Lv1_th =%d ,Lv2_th = %d ,Lv3_th = %d\n", -+ dm->enhance_pwr_th[0], dm->enhance_pwr_th[1], -+ dm->enhance_pwr_th[2]); -+} -+ -+u8 phydm_pwr_lvl_check(void *dm_void, u8 input_rssi, u8 last_pwr_lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 th[DTP_POWER_LEVEL_SIZE]; -+ u8 i; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ for (i = 0; i < DTP_POWER_LEVEL_SIZE; i++) -+ th[i] = dm->set_pwr_th[i]; -+ -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "Ori-DTP th: Lv1_th = %d, Lv2_th = %d, Lv3_th = %d\n", -+ th[0], th[1], th[2]); -+ -+ for (i = 0; i < DTP_POWER_LEVEL_SIZE; i++) { -+ if (i >= (last_pwr_lv)) -+ th[i] += DTP_FLOOR_UP_GAP; -+ } -+ -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "Mod-DTP th: Lv1_th = %d, Lv2_th = %d, Lv3_th = %d\n", -+ th[0], th[1], th[2]); -+ } else { -+ for (i = 0; i < DTP_POWER_LEVEL_SIZE; i++) -+ th[i] = dm->enhance_pwr_th[i]; -+ for (i = 0; i < DTP_POWER_LEVEL_SIZE; i++) { -+ if (i >= (last_pwr_lv)) -+ th[i] += DTP_FLOOR_UP_GAP; -+ } -+ } -+ -+ if (input_rssi >= th[2]) -+ return tx_high_pwr_level_level3; -+ else if (input_rssi < th[2] && input_rssi >= th[1]) -+ return tx_high_pwr_level_level2; -+ else if (input_rssi < th[1] && input_rssi >= th[0]) -+ return tx_high_pwr_level_level1; -+ else -+ return tx_high_pwr_level_normal; -+} -+ -+u8 phydm_pwr_lv_mapping(u8 tx_pwr_lv) -+{ -+ if (tx_pwr_lv == tx_high_pwr_level_level3) -+ return PHYDM_OFFSET_MINUS_11DB; -+ else if (tx_pwr_lv == tx_high_pwr_level_level2) -+ return PHYDM_OFFSET_MINUS_7DB; -+ else if (tx_pwr_lv == tx_high_pwr_level_level1) -+ return PHYDM_OFFSET_MINUS_3DB; -+ else -+ return PHYDM_OFFSET_ZERO; -+} -+ -+void phydm_dynamic_response_power(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rpwr = 0; -+ -+ if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ -+ if (dm->dynamic_tx_high_power_lvl == dm->last_dtp_lvl) { -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, "RespPwr not change\n"); -+ return; -+ } -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "RespPwr update_DTP_lv: ((%d)) -> ((%d))\n", dm->last_dtp_lvl, -+ dm->dynamic_tx_high_power_lvl); -+ dm->last_dtp_lvl = dm->dynamic_tx_high_power_lvl; -+ rpwr = phydm_pwr_lv_mapping(dm->dynamic_tx_high_power_lvl); -+ odm_set_mac_reg(dm, ODM_REG_RESP_TX_11AC, BIT(20) | BIT(19) | BIT(18), -+ rpwr); -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, "RespPwr Set TxPwr: Lv (%d)\n", -+ dm->dynamic_tx_high_power_lvl); -+} -+ -+void phydm_dtp_fill_cmninfo(void *dm_void, u8 sta_id, u8 dtp_lvl) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[sta_id]; -+ struct dtp_info *dtp = NULL; -+ -+ if (!is_sta_active(sta)) -+ return; -+ -+ dtp = &sta->dtp_stat; -+ dtp->dyn_tx_power = phydm_pwr_lv_mapping(dtp_lvl); -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "Fill cmninfo TxPwr: sta_id=(%d), macid=(%d), PwrLv (%d)\n", -+ sta_id, sta->mac_id, dtp->dyn_tx_power); -+} -+ -+void phydm_dtp_per_sta(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = NULL; -+ struct dtp_info *dtp = NULL; -+ struct rssi_info *rssi = NULL; -+ struct phydm_bb_ram_ctrl *bb_ctrl = &dm->p_bb_ram_ctrl; -+ u8 sta_cnt = 0; -+ u8 i = 0; -+ u8 curr_pwr_lv = 0; -+ u8 last_pwr_lv = 0; -+ u8 mac_id_cnt = 0; -+ u64 macid_cur = 0; -+ u64 macid_diff = 0; -+ u64 macid_mask = 0; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ sta = dm->phydm_sta_info[i]; -+ if (is_sta_active(sta)) { -+ sta_cnt++; -+ -+ dtp = &sta->dtp_stat; -+ rssi = &sta->rssi_stat; -+ macid_mask = (u64)BIT(sta->mac_id); -+ if (!(bb_ctrl->macid_is_linked & macid_mask)) -+ dtp->sta_last_dtp_lvl = tx_high_pwr_level_normal; -+ -+ last_pwr_lv = dtp->sta_last_dtp_lvl; -+ curr_pwr_lv = phydm_pwr_lvl_check(dm, rssi->rssi, -+ last_pwr_lv); -+ dtp->sta_tx_high_power_lvl = curr_pwr_lv; -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "STA_id=%d, MACID=%d , RSSI: %d , GetPwrLv: %d\n", -+ i, sta->mac_id, rssi->rssi, curr_pwr_lv); -+ -+ bb_ctrl->macid_is_linked |= macid_mask; -+ macid_cur |= macid_mask; -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "macid_is_linked: (0x%llx), macid_cur: (0x%llx)\n", -+ bb_ctrl->macid_is_linked, macid_cur); -+ -+ if (curr_pwr_lv == last_pwr_lv && dtp->sta_is_alive) { -+ dtp->sta_tx_high_power_lvl = last_pwr_lv; -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "DTP_lv not change: ((%d))\n", -+ curr_pwr_lv); -+ } else { -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "DTP_lv update: ((%d)) -> ((%d))\n", -+ last_pwr_lv, curr_pwr_lv); -+ -+ dtp->sta_last_dtp_lvl = curr_pwr_lv; -+ -+ switch (dm->ic_ip_series) { -+ #ifdef BB_RAM_SUPPORT -+ case PHYDM_IC_JGR3: -+ phydm_dtp_fill_cmninfo_2nd(dm, i, curr_pwr_lv); -+ break; -+ #endif -+ default: -+ phydm_dtp_fill_cmninfo(dm, i, curr_pwr_lv); -+ break; -+ } -+ if(!dtp->sta_is_alive) -+ dtp->sta_is_alive = true; -+ } -+ -+ if (sta_cnt == dm->number_linked_client) -+ break; -+ } -+ } -+ -+ macid_diff = bb_ctrl->macid_is_linked ^ macid_cur; -+ if (macid_diff) -+ bb_ctrl->macid_is_linked &= ~macid_diff; -+ while (macid_diff) { -+ if (macid_diff & 0x1) -+ phydm_pwr_lv_ctrl(dm, mac_id_cnt, tx_high_pwr_level_normal); -+ mac_id_cnt++; -+ macid_diff >>= 1; -+ } -+} -+ -+void odm_set_dyntxpwr(void *dm_void, u8 *desc, u8 sta_id) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[sta_id]; -+ struct dtp_info *dtp = NULL; -+ -+ if (!is_sta_active(sta)) -+ return; -+ dtp = &sta->dtp_stat; -+ -+ if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ -+ if (dm->fill_desc_dyntxpwr) -+ dm->fill_desc_dyntxpwr(dm, desc, dtp->dyn_tx_power); -+ else -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "%s: fill_desc_dyntxpwr is null!\n", __func__); -+ -+ if (dtp->last_tx_power != dtp->dyn_tx_power) { -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "%s: last_offset=%d, txpwr_offset=%d\n", __func__, -+ dtp->last_tx_power, dtp->dyn_tx_power); -+ dtp->last_tx_power = dtp->dyn_tx_power; -+ } -+} -+ -+void phydm_dtp_debug(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[7] = {0}; -+ u8 set_pwr_th1, set_pwr_th2, set_pwr_th3; -+ u8 i = 0; -+ #ifdef BB_RAM_SUPPORT -+ s8 pwr_ofst_tmp = 0x0; -+ #endif -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set DTP threhosld: {1} {Lv1_th} {Lv2_th} {Lv3_th}\n"); -+ #ifdef BB_RAM_SUPPORT -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set pwr_tx_offset: {2} {0:reg 1:macid} {en} {offset 0/1} {0:-, 1:+} {Pwr Offset} {macid}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Read pwr_tx_offset : {3} {0:reg 1:macid} {macid(0~63), 255:all}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Reset all ram pwr_tx_offset : {4}\n"); -+ #endif -+ } else { -+ for (i = 0; i < 7; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var1[i]); -+ } -+ switch (var1[0]) { -+ case 1: -+ for (i = 0; i < 3; i++) { -+ if (var1[i] == 0 || var1[i] > 100) -+ dm->set_pwr_th[i] = 0xff; -+ else -+ dm->set_pwr_th[i] = (u8)var1[1 + i]; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DTP_TH[0:2] = {%d, %d, %d}\n", -+ dm->set_pwr_th[0], dm->set_pwr_th[1], -+ dm->set_pwr_th[2]); -+ break; -+ #ifdef BB_RAM_SUPPORT -+ case 2: -+ if ((boolean)var1[4]) -+ pwr_ofst_tmp = (s8)var1[5]; -+ else -+ pwr_ofst_tmp = 0x0 - (s8)var1[5]; -+ -+ if ((boolean)var1[1]) -+ phydm_wt_ram_pwr(dm, (u8)var1[6], -+ (boolean)var1[3], -+ (boolean)var1[2], -+ pwr_ofst_tmp); -+ else -+ phydm_wt_reg_pwr(dm, (boolean)var1[3], -+ (boolean)var1[2], -+ pwr_ofst_tmp); -+ break; -+ case 3: -+ if ((boolean)var1[1]) { -+ if ((u8)var1[2] == 0xff) -+ for (i = 0; i < 64; i++) -+ phydm_rd_ram_pwr(dm, i, &used, -+ output, -+ &out_len); -+ else -+ phydm_rd_ram_pwr(dm, (u8)var1[2], &used, -+ output, &out_len); -+ } else { -+ phydm_rd_reg_pwr(dm, &used, output, &out_len); -+ } -+ break; -+ case 4: -+ phydm_rst_ram_pwr(dm); -+ break; -+ #endif -+ } -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_dynamic_tx_power(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = NULL; -+ u8 i = 0; -+ -+ u8 rssi_min = dm->rssi_min; -+ u8 rssi_tmp = 0; -+ -+ if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) { -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, -+ "[%s] RSSI_min = %d, Noisy_dec = %d\n", __func__, -+ rssi_min, dm->noisy_decision); -+ phydm_noisy_enhance_hp_th(dm, dm->noisy_decision); -+ /* Response Power */ -+ dm->dynamic_tx_high_power_lvl = phydm_pwr_lvl_check(dm, -+ rssi_min, -+ dm->last_dtp_lvl); -+ phydm_dynamic_response_power(dm); -+ } -+ /* Per STA Tx power */ -+ phydm_dtp_per_sta(dm); -+} -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+void phydm_dynamic_tx_power_init_win(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA((PADAPTER)adapter); -+ -+ mgnt_info->bDynamicTxPowerEnable = false; -+ #if DEV_BUS_TYPE == RT_USB_INTERFACE -+ if (RT_GetInterfaceSelection((PADAPTER)adapter) == -+ INTF_SEL1_USB_High_Power) { -+ mgnt_info->bDynamicTxPowerEnable = true; -+ } -+ #endif -+ -+ hal_data->LastDTPLvl = tx_high_pwr_level_normal; -+ hal_data->DynamicTxHighPowerLvl = tx_high_pwr_level_normal; -+ -+ PHYDM_DBG(dm, DBG_DYN_TXPWR, "[%s] DTP=%d\n", __func__, -+ mgnt_info->bDynamicTxPowerEnable); -+} -+ -+void phydm_dynamic_tx_power_win(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ -+ #if (RTL8814A_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8814A) -+ odm_dynamic_tx_power_8814a(dm); -+ #endif -+ -+ #if (RTL8821A_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8821) { -+ void *adapter = dm->adapter; -+ PMGNT_INFO mgnt_info = GetDefaultMgntInfo((PADAPTER)adapter); -+ -+ if (mgnt_info->RegRspPwr == 1) { -+ if (dm->rssi_min > 60) { -+ /*Resp TXAGC offset = -3dB*/ -+ odm_set_mac_reg(dm, R_0x6d8, 0x1C0000, 1); -+ } else if (dm->rssi_min < 55) { -+ /*Resp TXAGC offset = 0dB*/ -+ odm_set_mac_reg(dm, R_0x6d8, 0x1C0000, 0); -+ } -+ } -+ } -+ #endif -+} -+#endif /*@#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+#endif /* @#ifdef CONFIG_DYNAMIC_TX_TWR */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dynamictxpower.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dynamictxpower.h -new file mode 100644 -index 000000000..88be431f4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_dynamictxpower.h -@@ -0,0 +1,142 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMDYNAMICTXPOWER_H__ -+#define __PHYDMDYNAMICTXPOWER_H__ -+ -+#ifdef CONFIG_DYNAMIC_TX_TWR -+/* @============================================================ -+ * Definition -+ * ============================================================ -+ */ -+ -+/* 2020.6.23, Let gain_idx be initialized to 0 for linux compile warning*/ -+#define DYNAMIC_TXPWR_VERSION "2.1" -+ -+#define DTP_POWER_LEVEL_SIZE 3 -+ -+#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 -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#define TX_PWR_NEAR_FIELD_TH_JGR3_LVL3 80 -+#define TX_PWR_NEAR_FIELD_TH_JGR3_LVL2 63 -+#define TX_PWR_NEAR_FIELD_TH_JGR3_LVL1 55 -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define TX_PWR_NEAR_FIELD_TH_JGR3_LVL3 90 -+#define TX_PWR_NEAR_FIELD_TH_JGR3_LVL2 85 -+#define TX_PWR_NEAR_FIELD_TH_JGR3_LVL1 80 -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#define TX_PWR_NEAR_FIELD_TH_JGR3_LVL3 90 -+#define TX_PWR_NEAR_FIELD_TH_JGR3_LVL2 85 -+#define TX_PWR_NEAR_FIELD_TH_JGR3_LVL1 80 -+#endif -+ -+#define tx_high_pwr_level_normal 0 -+#define tx_high_pwr_level_level1 1 -+#define tx_high_pwr_level_level2 2 -+#define tx_high_pwr_level_level3 3 -+#define tx_high_pwr_level_unchange 4 -+#define DTP_FLOOR_UP_GAP 3 -+ -+/* @============================================================ -+ * enumrate -+ * ============================================================ -+ */ -+enum phydm_dtp_power_offset { -+ PHYDM_OFFSET_ZERO = 0, -+ PHYDM_OFFSET_MINUS_3DB = 1, -+ PHYDM_OFFSET_MINUS_7DB = 2, -+ PHYDM_OFFSET_MINUS_11DB = 3, -+ PHYDM_OFFSET_ADD_3DB = 4, -+ PHYDM_OFFSET_ADD_6DB = 5 -+}; -+ -+enum phydm_dtp_power_offset_2nd { -+ PHYDM_2ND_OFFSET_ZERO = 0, -+ PHYDM_2ND_OFFSET_MINUS_3DB = 1, -+ PHYDM_2ND_OFFSET_MINUS_7DB = 2, -+ PHYDM_2ND_OFFSET_MINUS_11DB = 3 -+}; -+ -+enum phydm_dtp_power_offset_bbram { -+ /*@ HW min use 1dB*/ -+ PHYDM_BBRAM_OFFSET_ZERO = 0, -+ PHYDM_BBRAM_OFFSET_MINUS_3DB = -3, -+ PHYDM_BBRAM_OFFSET_MINUS_7DB = -7, -+ PHYDM_BBRAM_OFFSET_MINUS_11DB = -11 -+}; -+ -+enum phydm_dtp_power_pkt_type { -+ RAM_PWR_OFST0 = 0, -+ RAM_PWR_OFST1 = 1, -+ REG_PWR_OFST0 = 2, -+ REG_PWR_OFST1 = 3 -+}; -+ -+/* @============================================================ -+ * structure -+ * ============================================================ -+ */ -+ -+/* @============================================================ -+ * Function Prototype -+ * ============================================================ -+ */ -+ -+extern void -+odm_set_dyntxpwr(void *dm_void, u8 *desc, u8 mac_id); -+ -+void phydm_dynamic_tx_power(void *dm_void); -+ -+void phydm_dynamic_tx_power_init(void *dm_void); -+ -+void phydm_dtp_debug(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len); -+ -+void phydm_rd_reg_pwr(void *dm_void, u32 *_used, char *output, u32 *_out_len); -+ -+void phydm_wt_reg_pwr(void *dm_void, boolean is_ofst1, boolean pwr_ofst_en, -+ s8 pwr_ofst); -+ -+void phydm_wt_ram_pwr(void *dm_void, u8 macid, boolean is_ofst1, -+ boolean pwr_ofst_en, s8 pwr_ofst); -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void odm_dynamic_tx_power_win(void *dm_void); -+#endif -+ -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features.h -new file mode 100644 -index 000000000..bbbc9edab ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features.h -@@ -0,0 +1,82 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_FEATURES_H__ -+#define __PHYDM_FEATURES_H__ -+ -+#define CONFIG_RUN_IN_DRV -+#define ODM_DC_CANCELLATION_SUPPORT (ODM_RTL8188F | \ -+ ODM_RTL8710B | \ -+ ODM_RTL8192F | \ -+ ODM_RTL8821C | \ -+ ODM_RTL8822B | \ -+ ODM_RTL8721D | \ -+ ODM_RTL8723D | \ -+ ODM_RTL8710C) -+#define ODM_RECEIVER_BLOCKING_SUPPORT (ODM_RTL8188E | ODM_RTL8192E) -+#define ODM_DYM_BW_INDICATION_SUPPORT (ODM_RTL8821C | \ -+ ODM_RTL8822B | \ -+ ODM_RTL8822C) -+ -+/*@20170103 YuChen add for FW API*/ -+#define PHYDM_FW_API_ENABLE_8822B 1 -+#define PHYDM_FW_API_FUNC_ENABLE_8822B 1 -+#define PHYDM_FW_API_ENABLE_8821C 1 -+#define PHYDM_FW_API_FUNC_ENABLE_8821C 1 -+#define PHYDM_FW_API_ENABLE_8195B 1 -+#define PHYDM_FW_API_FUNC_ENABLE_8195B 1 -+#define PHYDM_FW_API_ENABLE_8198F 1 -+#define PHYDM_FW_API_FUNC_ENABLE_8198F 1 -+#define PHYDM_FW_API_ENABLE_8822C 1 -+#define PHYDM_FW_API_FUNC_ENABLE_8822C 1 -+#define PHYDM_FW_API_ENABLE_8814B 1 -+#define PHYDM_FW_API_FUNC_ENABLE_8814B 1 -+#define PHYDM_FW_API_ENABLE_8812F 1 -+#define PHYDM_FW_API_FUNC_ENABLE_8812F 1 -+#define PHYDM_FW_API_ENABLE_8197G 1 -+#define PHYDM_FW_API_FUNC_ENABLE_8197G 1 -+#define PHYDM_FW_API_ENABLE_8723F 1 -+#define PHYDM_FW_API_FUNC_ENABLE_8723F 1 -+ -+#define CONFIG_POWERSAVING 0 -+ -+#ifdef BEAMFORMING_SUPPORT -+#if (BEAMFORMING_SUPPORT) -+ #define PHYDM_BEAMFORMING_SUPPORT -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "phydm_features_win.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "phydm_features_ce.h" -+ /*@#include "phydm_features_ce2_kernel.h"*/ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "phydm_features_ap.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ #include "phydm_features_iot.h" -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_ap.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_ap.h -new file mode 100644 -index 000000000..ce422991e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_ap.h -@@ -0,0 +1,231 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __PHYDM_FEATURES_AP_H__ -+#define __PHYDM_FEATURES_AP_H__ -+ -+#if (RTL8814A_SUPPORT || RTL8821C_SUPPORT || RTL8822B_SUPPORT ||\ -+ RTL8197F_SUPPORT || RTL8192F_SUPPORT || RTL8198F_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8812F_SUPPORT || RTL8814B_SUPPORT ||\ -+ RTL8197G_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_LA_MODE_SUPPORT 1 -+#else -+ #define PHYDM_LA_MODE_SUPPORT 0 -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8812A_SUPPORT || RTL8197F_SUPPORT ||\ -+ RTL8192F_SUPPORT) -+ #define DYN_ANT_WEIGHTING_SUPPORT -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8198F_SUPPORT || RTL8814B_SUPPORT ||\ -+ RTL8197G_SUPPORT || RTL8812F_SUPPORT || RTL8723F_SUPPORT) -+ #define FAHM_SUPPORT -+#endif -+ -+#if (RTL8197G_SUPPORT || RTL8812F_SUPPORT || RTL8723F_SUPPORT) -+ #define IFS_CLM_SUPPORT -+#endif -+ #define NHM_SUPPORT -+ #define CLM_SUPPORT -+ -+#if (RTL8197G_SUPPORT || RTL8812F_SUPPORT) -+ #define EDCCA_CLM_SUPPORT -+#endif -+ -+#if (RTL8812F_SUPPORT) -+ /*#define PHYDM_PHYSTAUS_AUTO_SWITCH*/ -+#endif -+ -+#if (RTL8197F_SUPPORT) -+ /*#define PHYDM_TDMA_DIG_SUPPORT*/ -+#endif -+ -+#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8812F_SUPPORT ||\ -+ RTL8197G_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_TDMA_DIG_SUPPORT 1 -+ #ifdef PHYDM_TDMA_DIG_SUPPORT -+ #define IS_USE_NEW_TDMA /*new tdma dig test*/ -+ #endif -+#endif -+ -+#if (RTL8197F_SUPPORT || RTL8822B_SUPPORT ||\ -+ RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8812F_SUPPORT) -+ #define PHYDM_LNA_SAT_CHK_SUPPORT -+ #ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ -+ #if (RTL8197F_SUPPORT) -+ /*#define PHYDM_LNA_SAT_CHK_SUPPORT_TYPE1*/ -+ #endif -+ -+ #if (RTL8822B_SUPPORT) -+ /*#define PHYDM_LNA_SAT_CHK_TYPE2*/ -+ #endif -+ -+ #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8812F_SUPPORT) -+ #define PHYDM_LNA_SAT_CHK_TYPE1 -+ #endif -+ #endif -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ /*#define PHYDM_POWER_TRAINING_SUPPORT*/ -+#endif -+ -+#if (RTL8814B_SUPPORT || RTL8198F_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8812F_SUPPORT || RTL8197G_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_PMAC_TX_SETTING_SUPPORT -+#endif -+ -+#if (RTL8814B_SUPPORT || RTL8198F_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8812F_SUPPORT || RTL8197G_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_MP_SUPPORT -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ #define PHYDM_TXA_CALIBRATION -+#endif -+ -+#if (RTL8188E_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) -+ #define PHYDM_PRIMARY_CCA -+#endif -+ -+#if (RTL8188F_SUPPORT || RTL8710B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8192F_SUPPORT) -+ #define PHYDM_DC_CANCELLATION -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) -+ #define CONFIG_ADAPTIVE_SOML -+#endif -+ -+#if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8881A_SUPPORT ||\ -+ RTL8192E_SUPPORT || RTL8723B_SUPPORT) -+ /*#define CONFIG_RA_FW_DBG_CODE*/ -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ /*#define CONFIG_8912F_SPUR_CALIBRATION*/ -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+ /* #define CONFIG_8822B_SPUR_CALIBRATION */ -+#endif -+ -+#if (RTL8197G_SUPPORT) -+ #define CONFIG_DIRECTIONAL_BF -+#endif -+ -+#if (RTL8197G_SUPPORT || RTL8812F_SUPPORT || RTL8814B_SUPPORT) -+ #define CONFIG_DYNAMIC_TX_TWR -+#endif -+ -+#if (RTL8197G_SUPPORT || RTL8812F_SUPPORT) -+ #define PHYDM_HW_IGI -+#endif -+ -+#if (RTL8197G_SUPPORT || RTL8812F_SUPPORT) -+ #define CONFIG_DYNAMIC_TXCOLLISION_TH -+#endif -+ -+/*#define CONFIG_PSD_TOOL*/ -+#define PHYDM_SUPPORT_CCKPD -+#define PHYDM_SUPPORT_ADAPTIVITY -+/*#define CONFIG_PATH_DIVERSITY*/ -+/*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+/*#define CONFIG_RA_DYNAMIC_RATE_ID*/ -+#define CONFIG_BB_TXBF_API -+/*#define ODM_CONFIG_BT_COEXIST*/ -+#define PHYDM_SUPPORT_RSSI_MONITOR -+#if !defined(CONFIG_DISABLE_PHYDM_DEBUG_FUNCTION) -+ #define CONFIG_PHYDM_DEBUG_FUNCTION -+#endif -+ -+/* [ Configure Antenna Diversity ] */ -+#if (RTL8188F_SUPPORT) -+ #ifdef CONFIG_ANTENNA_DIVERSITY -+ #define CONFIG_PHYDM_ANTENNA_DIVERSITY -+ #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ #endif -+#endif -+ -+#if defined(CONFIG_RTL_8881A_ANT_SWITCH) || defined(CONFIG_SLOT_0_ANT_SWITCH) || defined(CONFIG_SLOT_1_ANT_SWITCH) || defined(CONFIG_RTL_8197F_ANT_SWITCH) || defined(CONFIG_RTL_8197G_ANT_SWITCH) -+ #define CONFIG_PHYDM_ANTENNA_DIVERSITY -+ #define ODM_EVM_ENHANCE_ANTDIV -+ /*#define SKIP_EVM_ANTDIV_TRAINING_PATCH*/ -+ -+ /*----------*/ -+ #ifdef CONFIG_NO_2G_DIVERSITY_8197F -+ #define CONFIG_NO_2G_DIVERSITY -+ #elif defined(CONFIG_2G_CGCS_RX_DIVERSITY_8197F) -+ #define CONFIG_2G_CGCS_RX_DIVERSITY -+ #elif defined(CONFIG_2G_CG_TRX_DIVERSITY_8197F) -+ #define CONFIG_2G_CG_TRX_DIVERSITY -+ #endif -+ -+ /*----------*/ -+ #ifdef CONFIG_NO_2G_DIVERSITY_8197G -+ #define CONFIG_NO_2G_DIVERSITY -+ #elif defined(CONFIG_2G_CGCS_RX_DIVERSITY_8197G) -+ #define CONFIG_2G_CGCS_RX_DIVERSITY -+ #elif defined(CONFIG_2G_CG_TRX_DIVERSITY_8197G) -+ #define CONFIG_2G_CG_TRX_DIVERSITY -+ #endif -+ -+ #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 /*Antenna Diveristy*/ -+ -+/*[SmartAntenna]*/ -+/*#define CONFIG_SMART_ANTENNA*/ -+#ifdef CONFIG_SMART_ANTENNA -+ /*#define CONFIG_CUMITEK_SMART_ANTENNA*/ -+#endif -+#define CFG_DIG_DAMPING_CHK -+/* --------------------------------------------------*/ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ #if (RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8198F_SUPPORT ||\ -+ RTL8814B_SUPPORT || RTL8812F_SUPPORT) -+ #define DRIVER_BEAMFORMING_VERSION2 -+ #endif -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_ce.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_ce.h -new file mode 100644 -index 000000000..9dc238aff ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_ce.h -@@ -0,0 +1,249 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_FEATURES_CE_H__ -+#define __PHYDM_FEATURES_CE_H__ -+ -+#if (RTL8814A_SUPPORT || RTL8821C_SUPPORT || RTL8822B_SUPPORT ||\ -+ RTL8197F_SUPPORT || RTL8192F_SUPPORT || RTL8198F_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_LA_MODE_SUPPORT 1 -+#else -+ #define PHYDM_LA_MODE_SUPPORT 0 -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8812A_SUPPORT || RTL8197F_SUPPORT ||\ -+ RTL8192F_SUPPORT) -+ #define DYN_ANT_WEIGHTING_SUPPORT -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8814B_SUPPORT || RTL8723F_SUPPORT) -+ #define FAHM_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT || RTL8723F_SUPPORT) -+ #define IFS_CLM_SUPPORT -+#endif -+ #define NHM_SUPPORT -+ #define CLM_SUPPORT -+ -+#if (RTL8822C_SUPPORT || RTL8723F_SUPPORT) -+ #define EDCCA_CLM_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ #define NHM_DYM_PW_TH_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ /*@#define PHYDM_PHYSTAUS_AUTO_SWITCH*/ -+#endif -+ -+/*@#define PHYDM_TDMA_DIG_SUPPORT*/ -+ -+#if (RTL8822B_SUPPORT || RTL8192F_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8723D_SUPPORT ) -+ #ifdef CONFIG_TDMADIG -+ #define PHYDM_TDMA_DIG_SUPPORT -+ #ifdef PHYDM_TDMA_DIG_SUPPORT -+ #define IS_USE_NEW_TDMA /*new tdma dig test*/ -+ #endif -+ #endif -+#endif -+ -+#if (RTL8814B_SUPPORT) -+ /*@#define PHYDM_TDMA_DIG_SUPPORT*/ -+ #ifdef PHYDM_TDMA_DIG_SUPPORT -+ /*@#define IS_USE_NEW_TDMA*/ /*new tdma dig test*/ -+ #endif -+#endif -+ -+#if (RTL8197F_SUPPORT || RTL8822B_SUPPORT || RTL8814B_SUPPORT) -+ /*@#define PHYDM_LNA_SAT_CHK_SUPPORT*/ -+ #ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ -+ #if (RTL8197F_SUPPORT) -+ /*@#define PHYDM_LNA_SAT_CHK_SUPPORT_TYPE1*/ -+ #endif -+ -+ #if (RTL8822B_SUPPORT) -+ /*@#define PHYDM_LNA_SAT_CHK_TYPE2*/ -+ #endif -+ -+ #if (RTL8814B_SUPPORT) -+ /*@#define PHYDM_LNA_SAT_CHK_TYPE1*/ -+ #endif -+ #endif -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8192F_SUPPORT || RTL8723D_SUPPORT) -+ #define PHYDM_POWER_TRAINING_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_PMAC_TX_SETTING_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_MP_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ #define PHYDM_CCK_RX_PATHDIV_SUPPORT -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ #define PHYDM_TXA_CALIBRATION -+#endif -+ -+#if (RTL8188E_SUPPORT) -+ #define PHYDM_PRIMARY_CCA -+#endif -+ -+#if (RTL8188F_SUPPORT || RTL8710B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8192F_SUPPORT) -+ #define PHYDM_DC_CANCELLATION -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) -+ #define CONFIG_ADAPTIVE_SOML -+#endif -+ -+#if (RTL8188E_SUPPORT || RTL8192E_SUPPORT) -+ #define CONFIG_RECEIVER_BLOCKING -+#endif -+ -+#if (RTL8821C_SUPPORT || RTL8822C_SUPPORT || RTL8822B_SUPPORT) -+ #define CONFIG_BW_INDICATION -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ /*#define CONFIG_8912F_SPUR_CALIBRATION*/ -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ #define CONFIG_8822B_SPUR_CALIBRATION -+#endif -+ -+#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR -+#define CONFIG_DYNAMIC_TX_TWR -+#endif -+#if (RTL8822C_SUPPORT) -+#define PHYDM_HW_IGI -+#endif -+#define PHYDM_SUPPORT_CCKPD -+#define PHYDM_SUPPORT_ADAPTIVITY -+ -+/*@Antenna Diversity*/ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ #define CONFIG_PHYDM_ANTENNA_DIVERSITY -+ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ -+ #if (RTL8723B_SUPPORT || RTL8821A_SUPPORT ||\ -+ RTL8188F_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8723D_SUPPORT||RTL8723F_SUPPORT) -+ #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ #endif -+ -+ #if (RTL8821A_SUPPORT) -+ /*@#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ #endif -+ -+ #if (RTL8822B_SUPPORT) -+ /*@#define CONFIG_HL_SMART_ANTENNA_TYPE2*/ -+ #endif -+ -+ #endif -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8822C_SUPPORT || RTL8192F_SUPPORT) -+ #define CONFIG_PATH_DIVERSITY -+#endif -+ -+/*@[SmartAntenna]*/ -+/*@#define CONFIG_SMART_ANTENNA*/ -+#ifdef CONFIG_SMART_ANTENNA -+ /*@#define CONFIG_CUMITEK_SMART_ANTENNA*/ -+#endif -+/* @--------------------------------------------------*/ -+ -+#ifdef CONFIG_DFS_MASTER -+ #define CONFIG_PHYDM_DFS_MASTER -+#endif -+ -+#if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8881A_SUPPORT ||\ -+ RTL8192E_SUPPORT || RTL8723B_SUPPORT) -+ /*@#define CONFIG_RA_FW_DBG_CODE*/ -+#endif -+ -+#define CONFIG_PSD_TOOL -+/*@#define CONFIG_ANT_DETECTION*/ -+/*@#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+#define CONFIG_BB_TXBF_API -+#define CONFIG_PHYDM_DEBUG_FUNCTION -+ -+#ifdef CONFIG_BT_COEXIST -+ #define ODM_CONFIG_BT_COEXIST -+#endif -+#define PHYDM_SUPPORT_RSSI_MONITOR -+#define PHYDM_AUTO_DEGBUG -+#define CFG_DIG_DAMPING_CHK -+ -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ #if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8192E_SUPPORT ||\ -+ RTL8814A_SUPPORT || RTL8881A_SUPPORT) -+ #define PHYDM_BEAMFORMING_VERSION1 -+ #endif -+ #if (RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8198F_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8814B_SUPPORT) -+ #define DRIVER_BEAMFORMING_VERSION2 -+ #endif -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8822C_SUPPORT) -+ #ifdef CONFIG_MCC_MODE -+ #define CONFIG_MCC_DM -+ #endif -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ #ifdef CONFIG_DYNAMIC_BYPASS_MODE -+ #define CONFIG_DYNAMIC_BYPASS -+ #endif -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8192F_SUPPORT) -+ #define CONFIG_DIRECTIONAL_BF -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ #define CONFIG_MU_RSOML -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_ce2_kernel.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_ce2_kernel.h -new file mode 100644 -index 000000000..c206ea605 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_ce2_kernel.h -@@ -0,0 +1,84 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_FEATURES_CE_H__ -+#define __PHYDM_FEATURES_CE_H__ -+ -+#define PHYDM_LA_MODE_SUPPORT 0 -+ -+#if (RTL8822B_SUPPORT || RTL8812A_SUPPORT || RTL8197F_SUPPORT ||\ -+ RTL8192F_SUPPORT) -+ #define DYN_ANT_WEIGHTING_SUPPORT -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT) -+ #define FAHM_SUPPORT -+#endif -+ #define NHM_SUPPORT -+ #define CLM_SUPPORT -+ -+#if (RTL8822B_SUPPORT) -+ #define PHYDM_TXA_CALIBRATION -+#endif -+ -+#if (RTL8188F_SUPPORT || RTL8710B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8192F_SUPPORT) -+ #define PHYDM_DC_CANCELLATION -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ /*#define CONFIG_8912F_SPUR_CALIBRATION*/ -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+ /* #define CONFIG_8822B_SPUR_CALIBRATION */ -+#endif -+ -+#define PHYDM_SUPPORT_CCKPD -+#define PHYDM_SUPPORT_ADAPTIVITY -+ -+#ifdef CONFIG_DFS_MASTER -+ #define CONFIG_PHYDM_DFS_MASTER -+#endif -+ -+#define CONFIG_BB_TXBF_API -+#define CONFIG_PHYDM_DEBUG_FUNCTION -+ -+#ifdef CONFIG_BT_COEXIST -+ #define ODM_CONFIG_BT_COEXIST -+#endif -+#define PHYDM_SUPPORT_RSSI_MONITOR -+#define CFG_DIG_DAMPING_CHK -+ -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ #if (RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8198F_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8814B_SUPPORT) -+ #define DRIVER_BEAMFORMING_VERSION2 -+ #endif -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_iot.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_iot.h -new file mode 100644 -index 000000000..5d2231cd1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_iot.h -@@ -0,0 +1,181 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_FEATURES_IOT_H__ -+#define __PHYDM_FEATURES_IOT_H__ -+ -+#if (RTL8814A_SUPPORT || RTL8821C_SUPPORT || RTL8822B_SUPPORT ||\ -+ RTL8197F_SUPPORT || RTL8192F_SUPPORT || RTL8198F_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8195B_SUPPORT) -+ #define PHYDM_LA_MODE_SUPPORT 1 -+#else -+ #define PHYDM_LA_MODE_SUPPORT 0 -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8812A_SUPPORT || RTL8197F_SUPPORT ||\ -+ RTL8192F_SUPPORT) -+ #define DYN_ANT_WEIGHTING_SUPPORT -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT) -+ #define FAHM_SUPPORT -+#endif -+ #define NHM_SUPPORT -+ #define CLM_SUPPORT -+ -+#if (RTL8197G_SUPPORT || RTL8812F_SUPPORT) -+ #define EDCCA_CLM_SUPPORT -+#endif -+ -+/*#define PHYDM_TDMA_DIG_SUPPORT*/ -+ -+#if (RTL8197F_SUPPORT || RTL8822B_SUPPORT) -+ /*#define PHYDM_LNA_SAT_CHK_SUPPORT*/ -+ #ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ #if (RTL8197F_SUPPORT) -+ /*#define PHYDM_LNA_SAT_CHK_SUPPORT_TYPE1*/ -+ #endif -+ -+ #if (RTL8822B_SUPPORT) -+ /*#define PHYDM_LNA_SAT_CHK_TYPE2*/ -+ #endif -+ #endif -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8721D_SUPPORT || RTL8710C_SUPPORT) -+ #define PHYDM_POWER_TRAINING_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ /* #define PHYDM_PMAC_TX_SETTING_SUPPORT */ -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ /* #define PHYDM_MP_SUPPORT */ -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ #define PHYDM_TXA_CALIBRATION -+#endif -+ -+#if (RTL8188E_SUPPORT) -+ #define PHYDM_PRIMARY_CCA -+#endif -+ -+#if (RTL8188F_SUPPORT || RTL8710B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8721D_SUPPORT || RTL8710C_SUPPORT) -+ #define PHYDM_DC_CANCELLATION -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) -+ #define CONFIG_ADAPTIVE_SOML -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ /*#define CONFIG_DYNAMIC_RX_PATH*/ -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+ /* #define CONFIG_8822B_SPUR_CALIBRATION */ -+#endif -+ -+#if (RTL8188E_SUPPORT || RTL8192E_SUPPORT) -+ #define CONFIG_RECEIVER_BLOCKING -+#endif -+ -+#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR -+#define CONFIG_DYNAMIC_TX_TWR -+#endif -+#define PHYDM_SUPPORT_CCKPD -+#define PHYDM_SUPPORT_ADAPTIVITY -+ -+/*Antenna Diversity*/ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ #define CONFIG_PHYDM_ANTENNA_DIVERSITY -+ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ -+ #if (RTL8723B_SUPPORT || RTL8821A_SUPPORT ||\ -+ RTL8188F_SUPPORT || RTL8821C_SUPPORT || RTL8195B_SUPPORT) -+ #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ #endif -+ -+ #if (RTL8710C_SUPPORT) -+ //#define CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ #endif -+ -+ #if (RTL8821A_SUPPORT) -+ /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ #endif -+ -+ #if (RTL8822B_SUPPORT) -+ /*#define CONFIG_HL_SMART_ANTENNA_TYPE2*/ -+ #endif -+ #endif -+#endif -+ -+/*[SmartAntenna]*/ -+/*#define CONFIG_SMART_ANTENNA*/ -+#ifdef CONFIG_SMART_ANTENNA -+ /*#define CONFIG_CUMITEK_SMART_ANTENNA*/ -+#endif -+/* --------------------------------------------------*/ -+ -+#ifdef CONFIG_DFS_MASTER -+ #define CONFIG_PHYDM_DFS_MASTER -+#endif -+ -+#if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8881A_SUPPORT ||\ -+ RTL8192E_SUPPORT || RTL8723B_SUPPORT) -+ /*#define CONFIG_RA_FW_DBG_CODE*/ -+#endif -+ -+#define CONFIG_PSD_TOOL -+/*#define CONFIG_RA_DBG_CMD*/ -+/*#define CONFIG_ANT_DETECTION*/ -+/*#define CONFIG_PATH_DIVERSITY*/ -+/*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+//#define CONFIG_BB_TXBF_API -+#if DBG -+#define CONFIG_PHYDM_DEBUG_FUNCTION -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ #define ODM_CONFIG_BT_COEXIST -+#endif -+#define PHYDM_SUPPORT_RSSI_MONITOR -+/*#define PHYDM_AUTO_DEGBUG*/ -+#define CFG_DIG_DAMPING_CHK -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ #if (RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8198F_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8814B_SUPPORT) -+ #define DRIVER_BEAMFORMING_VERSION2 -+ #define CONFIG_BB_TXBF_API -+ #endif -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_win.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_win.h -new file mode 100644 -index 000000000..061476821 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_features_win.h -@@ -0,0 +1,219 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __PHYDM_FEATURES_WIN_H__ -+#define __PHYDM_FEATURES_WIN_H__ -+ -+#if (RTL8814A_SUPPORT || RTL8821C_SUPPORT || RTL8822B_SUPPORT ||\ -+ RTL8197F_SUPPORT || RTL8192F_SUPPORT || RTL8198F_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_LA_MODE_SUPPORT 1 -+#else -+ #define PHYDM_LA_MODE_SUPPORT 0 -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8812A_SUPPORT || RTL8197F_SUPPORT ||\ -+ RTL8192F_SUPPORT) -+ #define DYN_ANT_WEIGHTING_SUPPORT -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8814B_SUPPORT || RTL8723F_SUPPORT) -+ #define FAHM_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT || RTL8723F_SUPPORT) -+ #define IFS_CLM_SUPPORT -+#endif -+ #define NHM_SUPPORT -+ #define CLM_SUPPORT -+ -+#if (RTL8822C_SUPPORT || RTL8723F_SUPPORT) -+ #define EDCCA_CLM_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ #define NHM_DYM_PW_TH_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ #define PHYDM_PHYSTAUS_AUTO_SWITCH -+#endif -+ -+/*#define PHYDM_TDMA_DIG_SUPPORT*/ -+ -+#if (RTL8814B_SUPPORT) -+ /*#define PHYDM_TDMA_DIG_SUPPORT*/ -+ #ifdef PHYDM_TDMA_DIG_SUPPORT -+ /*#define IS_USE_NEW_TDMA*/ /*new tdma dig test*/ -+ #endif -+#endif -+ -+#if (RTL8197F_SUPPORT || RTL8822B_SUPPORT || RTL8814B_SUPPORT) -+ /*#define PHYDM_LNA_SAT_CHK_SUPPORT*/ -+ #ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ -+ #if (RTL8197F_SUPPORT) -+ /*#define PHYDM_LNA_SAT_CHK_SUPPORT_TYPE1*/ -+ #endif -+ -+ #if (RTL8822B_SUPPORT) -+ /*#define PHYDM_LNA_SAT_CHK_TYPE2*/ -+ #endif -+ -+ #if (RTL8814B_SUPPORT) -+ /*#define PHYDM_LNA_SAT_CHK_TYPE1*/ -+ #endif -+ #endif -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8710B_SUPPORT || RTL8723D_SUPPORT ||\ -+ RTL8192F_SUPPORT) -+ #define PHYDM_POWER_TRAINING_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_PMAC_TX_SETTING_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_MP_SUPPORT -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ #define PHYDM_CCK_RX_PATHDIV_SUPPORT -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ #define PHYDM_TXA_CALIBRATION -+#endif -+ -+#if (RTL8188E_SUPPORT || RTL8192E_SUPPORT) -+ #define PHYDM_PRIMARY_CCA -+#endif -+ -+#if (RTL8188F_SUPPORT || RTL8710B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8192F_SUPPORT) -+ #define PHYDM_DC_CANCELLATION -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) -+ #define CONFIG_ADAPTIVE_SOML -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ #define CONFIG_8912F_SPUR_CALIBRATION -+#endif -+ -+/*Antenna Diversity*/ -+#define CONFIG_PHYDM_ANTENNA_DIVERSITY -+#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ -+ #if (RTL8723B_SUPPORT || RTL8821A_SUPPORT || RTL8188F_SUPPORT ||\ -+ RTL8821C_SUPPORT || RTL8723D_SUPPORT) -+ #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ #endif -+ -+ #if (RTL8822B_SUPPORT) -+ /*#define ODM_EVM_ENHANCE_ANTDIV*/ -+ /*#define CONFIG_2T3R_ANTENNA*/ -+ /*#define CONFIG_2T4R_ANTENNA*/ -+ #endif -+ -+ /* --[SmtAnt]-----------------------------------------*/ -+ #if (RTL8821A_SUPPORT) -+ /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ #define CONFIG_FAT_PATCH -+ #endif -+ -+ #if (RTL8822B_SUPPORT) -+ /*#define CONFIG_HL_SMART_ANTENNA_TYPE2*/ -+ #endif -+ -+ #if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1) || defined(CONFIG_HL_SMART_ANTENNA_TYPE2)) -+ #define CONFIG_HL_SMART_ANTENNA -+ #endif -+ -+ /* --------------------------------------------------*/ -+ -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8822C_SUPPORT || RTL8192F_SUPPORT) -+ #define CONFIG_PATH_DIVERSITY -+#endif -+ -+/*[SmartAntenna]*/ -+#define CONFIG_SMART_ANTENNA -+#ifdef CONFIG_SMART_ANTENNA -+ /*#define CONFIG_CUMITEK_SMART_ANTENNA*/ -+#endif -+ /* --------------------------------------------------*/ -+ -+#if (RTL8188E_SUPPORT || RTL8192E_SUPPORT) -+ #define CONFIG_RECEIVER_BLOCKING -+#endif -+ -+#if (RTL8821C_SUPPORT || RTL8822C_SUPPORT || RTL8822B_SUPPORT) -+ #define CONFIG_BW_INDICATION -+#endif -+ -+#if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8881A_SUPPORT ||\ -+ RTL8192E_SUPPORT || RTL8723B_SUPPORT) -+ #define CONFIG_RA_FW_DBG_CODE -+#endif -+ -+/* #ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR */ -+#define CONFIG_DYNAMIC_TX_TWR -+/* #endif */ -+#if (RTL8822C_SUPPORT) -+#define PHYDM_HW_IGI -+#endif -+#define CONFIG_PSD_TOOL -+#define PHYDM_SUPPORT_ADAPTIVITY -+#define PHYDM_SUPPORT_CCKPD -+#if (defined(PHYDM_SUPPORT_CCKPD) && RTL8822C_SUPPORT) -+ #define PHYDM_DCC_ENHANCE -+#endif -+/*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+#define CONFIG_ANT_DETECTION -+#define CONFIG_BB_TXBF_API -+#define ODM_CONFIG_BT_COEXIST -+#define CONFIG_PHYDM_DFS_MASTER -+#define PHYDM_SUPPORT_RSSI_MONITOR -+#define PHYDM_AUTO_DEGBUG -+#define CONFIG_PHYDM_DEBUG_FUNCTION -+#define CFG_DIG_DAMPING_CHK -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ #if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8192E_SUPPORT ||\ -+ RTL8814A_SUPPORT || RTL8881A_SUPPORT) -+ #define PHYDM_BEAMFORMING_VERSION1 -+ #endif -+ #if (RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8198F_SUPPORT ||\ -+ RTL8822C_SUPPORT || RTL8814B_SUPPORT) -+ #define DRIVER_BEAMFORMING_VERSION2 -+ #endif -+#endif -+ -+#if (RTL8822B_SUPPORT || RTL8192F_SUPPORT) -+ /*#define CONFIG_DIRECTIONAL_BF*/ -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ #define CONFIG_MU_RSOML -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_hwconfig.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_hwconfig.c -new file mode 100644 -index 000000000..2d6893a84 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_hwconfig.c -@@ -0,0 +1,1719 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#define READ_AND_CONFIG_MP(ic, txt) (odm_read_and_config_mp_##ic##txt(dm)) -+#define READ_AND_CONFIG_TC(ic, txt) (odm_read_and_config_tc_##ic##txt(dm)) -+ -+#if (PHYDM_TESTCHIP_SUPPORT == 1) -+#define READ_AND_CONFIG(ic, txt) \ -+ do { \ -+ if (dm->is_mp_chip) \ -+ 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 GET_VERSION_MP(ic, txt) (odm_get_version_mp_##ic##txt()) -+#define GET_VERSION_TC(ic, txt) (odm_get_version_tc_##ic##txt()) -+ -+#if (PHYDM_TESTCHIP_SUPPORT == 1) -+#define GET_VERSION(ic, txt) (dm->is_mp_chip ? GET_VERSION_MP(ic, txt) : GET_VERSION_TC(ic, txt)) -+#else -+#define GET_VERSION(ic, txt) GET_VERSION_MP(ic, txt) -+#endif -+ -+enum hal_status -+odm_config_rf_with_header_file(struct dm_struct *dm, -+ enum odm_rf_config_type config_type, -+ u8 e_rf_path) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo; -+#endif -+ enum hal_status result = HAL_STATUS_SUCCESS; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===>%s (%s)\n", __func__, -+ (dm->is_mp_chip) ? "MPChip" : "TestChip"); -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "support_platform: 0x%X, support_interface: 0x%X, board_type: 0x%X\n", -+ dm->support_platform, dm->support_interface, dm->board_type); -+ -+/* @1 AP doesn't use PHYDM power tracking table in these ICs */ -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8812A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8812) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8812a, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8812a, _radiob); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ HAL_DATA_TYPE * hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ if ((hal_data->EEPROMSVID == 0x17AA && hal_data->EEPROMSMID == 0xA811) || -+ (hal_data->EEPROMSVID == 0x10EC && hal_data->EEPROMSMID == 0xA812) || -+ (hal_data->EEPROMSVID == 0x10EC && hal_data->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 (dm->support_ic_type == ODM_RTL8821) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8821a, _radioa); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ if (dm->support_interface == ODM_ITRF_USB) { -+ if (dm->ext_pa_5g || dm->ext_lna_5g) -+ READ_AND_CONFIG_MP(8821a, _txpwr_lmt_8811a_u_fem); -+ else -+ READ_AND_CONFIG_MP(8821a, _txpwr_lmt_8811a_u_ipa); -+ } else { -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (mgnt_info->CustomerID == RT_CID_8821AE_ASUS_MB) -+ READ_AND_CONFIG_MP(8821a, _txpwr_lmt_8821a_sar_8mm); -+ else if (mgnt_info->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); -+ } -+ } -+ } -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8192E) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8192e, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8192e, _radiob); -+ } else if (config_type == 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 * hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ -+ if ((hal_data->EEPROMSVID == 0x11AD && hal_data->EEPROMSMID == 0x8192) || -+ (hal_data->EEPROMSVID == 0x11AD && hal_data->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 (dm->support_ic_type == ODM_RTL8723D) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8723d, _radioa); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ READ_AND_CONFIG_MP(8723d, _txpwr_lmt); -+ } -+ } -+#endif -+/* @JJ ADD 20161014 */ -+#if (RTL8710B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8710B) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8710b, _radioa); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8710b, _txpwr_lmt); -+ } -+#endif -+ -+#endif /* @(DM_ODM_SUPPORT_TYPE != ODM_AP) */ -+/* @1 All platforms support */ -+#if (RTL8188E_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188E) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8188e, _radioa); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8188e, _txpwr_lmt); -+ } -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8723B) { -+ if (config_type == CONFIG_RF_RADIO) -+ READ_AND_CONFIG_MP(8723b, _radioa); -+ else if (config_type == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8723b, _txpwr_lmt); -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814A) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8814a, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8814a, _radiob); -+ else if (e_rf_path == RF_PATH_C) -+ READ_AND_CONFIG_MP(8814a, _radioc); -+ else if (e_rf_path == RF_PATH_D) -+ READ_AND_CONFIG_MP(8814a, _radiod); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type0); -+ else if (dm->rfe_type == 1) -+ READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type1); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type2); -+ else if (dm->rfe_type == 3) -+ READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type3); -+ else if (dm->rfe_type == 5) -+ READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type5); -+ else if (dm->rfe_type == 7) -+ READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type7); -+ else if (dm->rfe_type == 8) -+ READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type8); -+ else -+ READ_AND_CONFIG_MP(8814a, _txpwr_lmt); -+ } -+ } -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8703B) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8703b, _radioa); -+ } -+ } -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188F) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8188f, _radioa); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8188f, _txpwr_lmt); -+ } -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8822b, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8822b, _radiob); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ if (dm->rfe_type == 5) -+ READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type5); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type2); -+ else if (dm->rfe_type == 3) -+ READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type3); -+ else if (dm->rfe_type == 4) -+ READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type4); -+ else if (dm->rfe_type == 12) -+ READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type12); -+ else if (dm->rfe_type == 15) -+ READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type15); -+ else if (dm->rfe_type == 16) -+ READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type16); -+ else if (dm->rfe_type == 17) -+ READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type17); -+ else if (dm->rfe_type == 18) -+ READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type18); -+ //else if (dm->rfe_type == 19) -+ //READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type19); -+ else -+ READ_AND_CONFIG_MP(8822b, _txpwr_lmt); -+ } -+ } -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197F) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8197f, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8197f, _radiob); -+ } -+ } -+#endif -+/*@jj add 20170822*/ -+#if (RTL8192F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8192F) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8192f, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8192f, _radiob); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type0); -+ else if (dm->rfe_type == 1) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type1); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type2); -+ else if (dm->rfe_type == 3) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type3); -+ else if (dm->rfe_type == 4) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type4); -+ else if (dm->rfe_type == 5) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type5); -+ else if (dm->rfe_type == 6) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type6); -+ else if (dm->rfe_type == 7) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type7); -+ else if (dm->rfe_type == 8) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type8); -+ else if (dm->rfe_type == 9) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type9); -+ else if (dm->rfe_type == 10) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type10); -+ else if (dm->rfe_type == 11) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type11); -+ else if (dm->rfe_type == 12) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type12); -+ else if (dm->rfe_type == 13) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type13); -+ else if (dm->rfe_type == 14) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type14); -+ else if (dm->rfe_type == 15) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type15); -+ else if (dm->rfe_type == 16) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type16); -+ else if (dm->rfe_type == 17) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type17); -+ else if (dm->rfe_type == 18) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type18); -+ else if (dm->rfe_type == 19) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type19); -+ else if (dm->rfe_type == 20) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type20); -+ else if (dm->rfe_type == 21) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type21); -+ else if (dm->rfe_type == 22) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type22); -+ else if (dm->rfe_type == 23) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type23); -+ else if (dm->rfe_type == 24) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type24); -+ else if (dm->rfe_type == 25) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type25); -+ else if (dm->rfe_type == 26) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type26); -+ else if (dm->rfe_type == 27) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type27); -+ else if (dm->rfe_type == 28) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type28); -+ else if (dm->rfe_type == 29) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type29); -+ else if (dm->rfe_type == 30) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type30); -+ else if (dm->rfe_type == 31) -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type31); -+ else -+ READ_AND_CONFIG_MP(8192f, _txpwr_lmt); -+ } -+ } -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8721D) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8721d, _radioa); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ if (dm->power_voltage == ODM_POWER_18V) -+ READ_AND_CONFIG_MP(8721d, _txpwr_lmt_type0); -+ else -+ READ_AND_CONFIG_MP(8721d, _txpwr_lmt_type1); -+ } -+ } -+#endif -+ -+#if (RTL8710C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8710C) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8710c, _radioa); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8710c, _txpwr_lmt); -+ } -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8821C) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG(8821c, _radioa); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ READ_AND_CONFIG(8821c, _txpwr_lmt); -+ } -+ } -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195B) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG(8195b, _radioa); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ READ_AND_CONFIG(8195b, _txpwr_lmt); -+ } -+ } -+#endif -+#if (RTL8198F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8198F) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8198f, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8198f, _radiob); -+ else if (e_rf_path == RF_PATH_C) -+ READ_AND_CONFIG_MP(8198f, _radioc); -+ else if (e_rf_path == RF_PATH_D) -+ READ_AND_CONFIG_MP(8198f, _radiod); -+ } -+ } -+#endif -+#if (RTL8822C_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8822C) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8822c, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8822c, _radiob); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ if (dm->rfe_type == 5) -+ READ_AND_CONFIG_MP(8822c, _txpwr_lmt_type5); -+ else -+ READ_AND_CONFIG_MP(8822c, _txpwr_lmt); -+ } -+ } -+#endif -+#if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8723F) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8723f, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8723f, _radiob); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ READ_AND_CONFIG_MP(8723f, _txpwr_lmt); -+ } -+ } -+#endif -+#if (RTL8812F_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8812F) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8812f, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8812f, _radiob); -+ } -+ } -+#endif -+#if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8197G) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8197g, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8197g, _radiob); -+ } -+ } -+#endif -+ -+/*8814B need review, when phydm has related files*/ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8814B) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8814b, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8814b, _radiob); -+ else if (e_rf_path == RF_PATH_C) -+ READ_AND_CONFIG_MP(8814b, _radioc); -+ else if (e_rf_path == RF_PATH_D) -+ READ_AND_CONFIG_MP(8814b, _radiod); -+ } -+ if (config_type == CONFIG_RF_SYN_RADIO) { -+ if (e_rf_path == RF_SYN0) -+ READ_AND_CONFIG_MP(8814b, _radiosyn0); -+ else if (e_rf_path == RF_SYN1) -+ READ_AND_CONFIG_MP(8814b, _radiosyn1); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ READ_AND_CONFIG_MP(8814b, _txpwr_lmt); -+ } -+ } -+#endif -+#if (RTL8814C_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8814C) { -+ if (config_type == CONFIG_RF_RADIO) { -+ if (e_rf_path == RF_PATH_A) -+ READ_AND_CONFIG_MP(8814c, _radioa); -+ else if (e_rf_path == RF_PATH_B) -+ READ_AND_CONFIG_MP(8814c, _radiob); -+ else if (e_rf_path == RF_PATH_C) -+ READ_AND_CONFIG_MP(8814c, _radioc); -+ else if (e_rf_path == RF_PATH_D) -+ READ_AND_CONFIG_MP(8814c, _radiod); -+ } -+ if (config_type == CONFIG_RF_SYN_RADIO) { -+ if (e_rf_path == RF_SYN0) -+ READ_AND_CONFIG_MP(8814c, _radiosyn0); -+ else if (e_rf_path == RF_SYN1) -+ READ_AND_CONFIG_MP(8814c, _radiosyn1); -+ } else if (config_type == CONFIG_RF_TXPWR_LMT) { -+ READ_AND_CONFIG_MP(8814c, _txpwr_lmt); -+ } -+ } -+#endif -+ -+ if (config_type == CONFIG_RF_RADIO) { -+ if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { -+ result = phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_END, -+ 0, -+ 0, -+ 0, -+ (enum rf_path)0, -+ 0); -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "rf param offload end!result = %d", result); -+ } -+ } -+ -+ return result; -+} -+ -+enum hal_status -+odm_config_rf_with_tx_pwr_track_header_file(struct dm_struct *dm) -+{ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===>%s (%s)\n", __func__, -+ (dm->is_mp_chip) ? "MPChip" : "TestChip"); -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "support_platform: 0x%X, support_interface: 0x%X, board_type: 0x%X\n", -+ dm->support_platform, dm->support_interface, dm->board_type); -+ -+/* @1 AP doesn't use PHYDM power tracking table in these ICs */ -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if RTL8821A_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8821) { -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8821a, _txpowertrack_pcie); -+ else if (dm->support_interface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8821a, _txpowertrack_usb); -+ else if (dm->support_interface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8821a, _txpowertrack_sdio); -+ } -+#endif -+#if RTL8812A_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8812) { -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8812a, _txpowertrack_pcie); -+ else if (dm->support_interface == ODM_ITRF_USB) { -+ if (dm->rfe_type == 3 && dm->is_mp_chip) -+ READ_AND_CONFIG_MP(8812a, _txpowertrack_rfe3); -+ else -+ READ_AND_CONFIG_MP(8812a, _txpowertrack_usb); -+ } -+ } -+#endif -+#if RTL8192E_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8192E) { -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8192e, _txpowertrack_pcie); -+ else if (dm->support_interface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8192e, _txpowertrack_usb); -+ else if (dm->support_interface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8192e, _txpowertrack_sdio); -+ } -+#endif -+#if RTL8723D_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8723D) { -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8723d, _txpowertrack_pcie); -+ else if (dm->support_interface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8723d, _txpowertrack_usb); -+ else if (dm->support_interface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8723d, _txpowertrack_sdio); -+ -+ READ_AND_CONFIG_MP(8723d, _txxtaltrack); -+ } -+#endif -+/* @JJ ADD 20161014 */ -+#if RTL8710B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8710B) { -+ if (dm->package_type == 1) -+ READ_AND_CONFIG_MP(8710b, _txpowertrack_qfn48m_smic); -+ else if (dm->package_type == 5) -+ READ_AND_CONFIG_MP(8710b, _txpowertrack_qfn48m_umc); -+ -+ READ_AND_CONFIG_MP(8710b, _txxtaltrack); -+ } -+#endif -+#if RTL8188E_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8188E) { -+ if (odm_get_mac_reg(dm, R_0xf0, 0xF000) >= 8) { /*@if 0xF0[15:12] >= 8, SMIC*/ -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8188e, _txpowertrack_pcie_icut); -+ else if (dm->support_interface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8188e, _txpowertrack_usb_icut); -+ else if (dm->support_interface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8188e, _txpowertrack_sdio_icut); -+ } else { /*@else 0xF0[15:12] < 8, TSMC*/ -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8188e, _txpowertrack_pcie); -+ else if (dm->support_interface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8188e, _txpowertrack_usb); -+ else if (dm->support_interface == 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 (dm->support_ic_type == ODM_RTL8723B) { -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8723b, _txpowertrack_pcie); -+ else if (dm->support_interface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8723b, _txpowertrack_usb); -+ else if (dm->support_interface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8723b, _txpowertrack_sdio); -+ } -+#endif -+#if RTL8814A_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8814A) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8814a, _txpowertrack_type0); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8814a, _txpowertrack_type2); -+ else if (dm->rfe_type == 5) -+ READ_AND_CONFIG_MP(8814a, _txpowertrack_type5); -+ else if (dm->rfe_type == 7) -+ READ_AND_CONFIG_MP(8814a, _txpowertrack_type7); -+ else if (dm->rfe_type == 8) -+ READ_AND_CONFIG_MP(8814a, _txpowertrack_type8); -+ else -+ READ_AND_CONFIG_MP(8814a, _txpowertrack); -+ -+ READ_AND_CONFIG_MP(8814a, _txpowertssi); -+ } -+#endif -+#if RTL8703B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8703B) { -+ if (dm->support_interface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8703b, _txpowertrack_usb); -+ else if (dm->support_interface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8703b, _txpowertrack_sdio); -+ -+ READ_AND_CONFIG_MP(8703b, _txxtaltrack); -+ } -+#endif -+#if RTL8188F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8188F) { -+ if (dm->support_interface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8188f, _txpowertrack_usb); -+ else if (dm->support_interface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8188f, _txpowertrack_sdio); -+ } -+#endif -+#if RTL8822B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type0); -+ else if (dm->rfe_type == 1) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type1); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type2); -+ else if ((dm->rfe_type == 3) || (dm->rfe_type == 5)) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type3_type5); -+ else if (dm->rfe_type == 4) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type4); -+ else if (dm->rfe_type == 6) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type6); -+ else if (dm->rfe_type == 7) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type7); -+ else if (dm->rfe_type == 8) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type8); -+ else if (dm->rfe_type == 9) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type9); -+ else if (dm->rfe_type == 10) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type10); -+ else if (dm->rfe_type == 11) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type11); -+ else if (dm->rfe_type == 12) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type12); -+ else if (dm->rfe_type == 13) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type13); -+ else if (dm->rfe_type == 14) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type14); -+ else if (dm->rfe_type == 15) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type15); -+ else if (dm->rfe_type == 16) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type16); -+ else if (dm->rfe_type == 17) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type17); -+ else if (dm->rfe_type == 18) -+ READ_AND_CONFIG_MP(8822b, _txpowertrack_type18); -+ //else if (dm->rfe_type == 19) -+ //READ_AND_CONFIG_MP(8822b, _txpowertrack_type19); -+ else -+ READ_AND_CONFIG_MP(8822b, _txpowertrack); -+ } -+#endif -+#if RTL8197F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8197F) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8197f, _txpowertrack_type0); -+ else if (dm->rfe_type == 1) -+ READ_AND_CONFIG_MP(8197f, _txpowertrack_type1); -+ else -+ READ_AND_CONFIG_MP(8197f, _txpowertrack); -+ } -+#endif -+/*@jj add 20170822*/ -+#if RTL8192F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8192F) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type0); -+ else if (dm->rfe_type == 1) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type1); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type2); -+ else if (dm->rfe_type == 3) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type3); -+ else if (dm->rfe_type == 4) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type4); -+ else if (dm->rfe_type == 5) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type5); -+ else if (dm->rfe_type == 6) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type6); -+ else if (dm->rfe_type == 7) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type7); -+ else if (dm->rfe_type == 8) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type8); -+ else if (dm->rfe_type == 9) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type9); -+ else if (dm->rfe_type == 10) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type10); -+ else if (dm->rfe_type == 11) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type11); -+ else if (dm->rfe_type == 12) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type12); -+ else if (dm->rfe_type == 13) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type13); -+ else if (dm->rfe_type == 14) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type14); -+ else if (dm->rfe_type == 15) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type15); -+ else if (dm->rfe_type == 16) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type16); -+ else if (dm->rfe_type == 17) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type17); -+ else if (dm->rfe_type == 18) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type18); -+ else if (dm->rfe_type == 19) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type19); -+ else if (dm->rfe_type == 20) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type20); -+ else if (dm->rfe_type == 21) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type21); -+ else if (dm->rfe_type == 22) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type22); -+ else if (dm->rfe_type == 23) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type23); -+ else if (dm->rfe_type == 24) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type24); -+ else if (dm->rfe_type == 25) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type25); -+ else if (dm->rfe_type == 26) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type26); -+ else if (dm->rfe_type == 27) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type27); -+ else if (dm->rfe_type == 28) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type28); -+ else if (dm->rfe_type == 29) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type29); -+ else if (dm->rfe_type == 30) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type30); -+ else if (dm->rfe_type == 31) -+ READ_AND_CONFIG_MP(8192f, _txpowertrack_type31); -+ else -+ READ_AND_CONFIG_MP(8192f, _txpowertrack); -+ -+ READ_AND_CONFIG_MP(8192f, _txxtaltrack); -+ } -+#endif -+ -+#if RTL8721D_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8721D) { -+ #if 0 -+ if (dm->package_type == 1) -+ READ_AND_CONFIG_MP(8721d, _txpowertrack_qfn48m_smic); -+ else if (dm->package_type == 5) -+ READ_AND_CONFIG_MP(8721d, _txpowertrack_qfn48m_umc); -+ #endif -+ READ_AND_CONFIG_MP(8721d, _txpowertrack); -+ READ_AND_CONFIG_MP(8721d, _txxtaltrack); -+ } -+#endif -+ -+#if RTL8710C_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8710C) { -+ #if 0 -+ if (dm->package_type == 1) -+ READ_AND_CONFIG_MP(8710c, _txpowertrack_qfn48m_smic); -+ else if (dm->package_type == 5) -+ READ_AND_CONFIG_MP(8710c, _txpowertrack_qfn48m_umc); -+ #endif -+ READ_AND_CONFIG_MP(8710c, _txpowertrack); -+ READ_AND_CONFIG_MP(8710c, _txxtaltrack); -+ } -+#endif -+ -+#if RTL8821C_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8821C) { -+ if (dm->rfe_type == 0x5) -+ READ_AND_CONFIG(8821c, _txpowertrack_type0x28); -+ else if (dm->rfe_type == 0x4) -+ READ_AND_CONFIG(8821c, _txpowertrack_type0x20); -+ else -+ READ_AND_CONFIG(8821c, _txpowertrack); -+ } -+#endif -+ -+#if RTL8198F_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8198F) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8198f, _txpowertrack_type0); -+ else if (dm->rfe_type == 1) -+ READ_AND_CONFIG_MP(8198f, _txpowertrack_type1); -+ else if (dm->rfe_type == 3) -+ READ_AND_CONFIG_MP(8198f, _txpowertrack_type3); -+ else -+ READ_AND_CONFIG_MP(8198f, _txpowertrack); -+ } -+#endif -+ -+#if RTL8195B_SUPPORT -+ if (dm->support_ic_type == ODM_RTL8195B) { -+ if (dm->package_type == 1) { -+ READ_AND_CONFIG_MP(8195b, _txpowertrack_pkg1); -+ READ_AND_CONFIG_MP(8195b, _txxtaltrack_pkg1); -+ } else { -+ READ_AND_CONFIG_MP(8195b, _txpowertrack); -+ READ_AND_CONFIG_MP(8195b, _txxtaltrack); -+ } -+ } -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8822C) { -+ if (dm->en_tssi_mode) -+ READ_AND_CONFIG_MP(8822c, _txpowertracktssi); -+ else -+ READ_AND_CONFIG_MP(8822c, _txpowertrack); -+ } -+#endif -+ -+#if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8723F) { -+ if (dm->en_tssi_mode) -+ READ_AND_CONFIG_MP(8723f, _txpowertracktssi); -+ else -+ READ_AND_CONFIG_MP(8723f, _txpowertrack); -+ READ_AND_CONFIG_MP(8723f, _txxtaltrack); -+ } -+#endif -+#if (RTL8812F_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8812F) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8812f, _txpowertrack_type0); -+ else if (dm->rfe_type == 1) -+ READ_AND_CONFIG_MP(8812f, _txpowertrack_type1); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8812f, _txpowertrack_type2); -+ else if (dm->rfe_type == 3) -+ READ_AND_CONFIG_MP(8812f, _txpowertrack_type3); -+ else if (dm->rfe_type == 4) -+ READ_AND_CONFIG_MP(8812f, _txpowertrack_type4); -+ else if (dm->rfe_type == 5) -+ READ_AND_CONFIG_MP(8812f, _txpowertrack_type5); -+ else -+ READ_AND_CONFIG_MP(8812f, _txpowertrack); -+ } -+#endif -+ -+#if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8197G) -+ READ_AND_CONFIG_MP(8197g, _txpowertrack); -+#endif -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8814B) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8814b, _txpowertrack_type0); -+ else if (dm->rfe_type == 1) -+ READ_AND_CONFIG_MP(8814b, _txpowertrack_type1); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8814b, _txpowertrack_type2); -+#if 0 -+ else if (dm->rfe_type == 3) -+ READ_AND_CONFIG_MP(8814b, _txpowertrack_type3); -+ else if (dm->rfe_type == 6) -+ READ_AND_CONFIG_MP(8814b, _txpowertrack_type6); -+#endif -+ else -+ READ_AND_CONFIG_MP(8814b, _txpowertrack); -+ } -+#endif -+#if (RTL8814C_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8814C) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8814c, _txpowertrack_type0); -+ else if (dm->rfe_type == 1) -+ READ_AND_CONFIG_MP(8814c, _txpowertrack_type1); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8814c, _txpowertrack_type2); -+ else -+ READ_AND_CONFIG_MP(8814c, _txpowertrack); -+ } -+#endif -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+enum hal_status -+odm_config_bb_with_header_file(struct dm_struct *dm, -+ enum odm_bb_config_type config_type) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo; -+#endif -+ enum hal_status result = HAL_STATUS_SUCCESS; -+ -+/* @1 AP doesn't use PHYDM initialization in these ICs */ -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8812A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8812) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8812a, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8812a, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) { -+ if (dm->rfe_type == 3 && dm->is_mp_chip) -+ READ_AND_CONFIG_MP(8812a, _phy_reg_pg_asus); -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ else if (mgnt_info->CustomerID == RT_CID_WNC_NEC && dm->is_mp_chip) -+ 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 (mgnt_info->CustomerID == RT_CID_DNI_BUFFALO) -+ READ_AND_CONFIG_MP(8812a, _phy_reg_pg_dni); -+ /* TP-Link T4UH, Isaiah 2015-03-16*/ -+ else if (mgnt_info->CustomerID == RT_CID_TPLINK_HPWR) { -+ pr_debug("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 (config_type == CONFIG_BB_PHY_REG_MP) -+ READ_AND_CONFIG_MP(8812a, _phy_reg_mp); -+ else if (config_type == CONFIG_BB_AGC_TAB_DIFF) { -+ dm->fw_offload_ability &= ~PHYDM_PHY_PARAM_OFFLOAD; -+ /*@AGC_TAB DIFF dont support FW offload*/ -+ if ((*dm->channel >= 36) && (*dm->channel <= 64)) -+ AGC_DIFF_CONFIG_MP(8812a, lb); -+ else if (*dm->channel >= 100) -+ AGC_DIFF_CONFIG_MP(8812a, hb); -+ } -+ } -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8821) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8821a, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8821a, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) { -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ HAL_DATA_TYPE * hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ -+ if ((hal_data->EEPROMSVID == 0x1043 && hal_data->EEPROMSMID == 0x207F)) -+ READ_AND_CONFIG_MP(8821a, _phy_reg_pg_e202_sa); -+ else -+#endif -+#if (RT_PLATFORM == PLATFORM_MACOSX) -+ /*@ for BUFFALO pwr by rate table */ -+ if (mgnt_info->CustomerID == RT_CID_DNI_BUFFALO) { -+ /*@ for BUFFALO pwr by rate table (JP/US)*/ -+ if (mgnt_info->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); -+ } -+ } -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8192E) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8192e, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8192e, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8192e, _phy_reg_pg); -+ } -+#endif -+#if (RTL8723D_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8723D) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8723d, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8723d, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8723d, _phy_reg_pg); -+ } -+#endif -+/* @JJ ADD 20161014 */ -+#if (RTL8710B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8710B) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8710b, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8710b, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8710b, _phy_reg_pg); -+ } -+#endif -+ -+#endif /* @(DM_ODM_SUPPORT_TYPE != ODM_AP) */ -+/* @1 All platforms support */ -+#if (RTL8188E_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188E) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8188e, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8188e, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8188e, _phy_reg_pg); -+ } -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8723B) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8723b, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8723b, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8723b, _phy_reg_pg); -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814A) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8814a, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8814a, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type0); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type2); -+ else if (dm->rfe_type == 3) -+ READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type3); -+ else if (dm->rfe_type == 4) -+ READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type4); -+ else if (dm->rfe_type == 5) -+ READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type5); -+ else if (dm->rfe_type == 7) -+ READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type7); -+ else if (dm->rfe_type == 8) -+ READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type8); -+ else -+ READ_AND_CONFIG_MP(8814a, _phy_reg_pg); -+ } else if (config_type == CONFIG_BB_PHY_REG_MP) -+ READ_AND_CONFIG_MP(8814a, _phy_reg_mp); -+ } -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8703B) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8703b, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8703b, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8703b, _phy_reg_pg); -+ } -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188F) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8188f, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8188f, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8188f, _phy_reg_pg); -+ } -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ if (config_type == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG_MP(8822b, _phy_reg); -+ } else if (config_type == CONFIG_BB_AGC_TAB) { -+ READ_AND_CONFIG_MP(8822b, _agc_tab); -+ } else if (config_type == CONFIG_BB_PHY_REG_PG) { -+ if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type2); -+ else if (dm->rfe_type == 3) -+ READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type3); -+ else if (dm->rfe_type == 4) -+ READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type4); -+ else if (dm->rfe_type == 5) -+ READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type5); -+ else if (dm->rfe_type == 12) -+ READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type12); -+ else if (dm->rfe_type == 15) -+ READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type15); -+ else if (dm->rfe_type == 16) -+ READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type16); -+ else if (dm->rfe_type == 17) -+ READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type17); -+ else if (dm->rfe_type == 18) -+ READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type18); -+ //else if (dm->rfe_type == 19) -+ //READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type19); -+ else -+ READ_AND_CONFIG_MP(8822b, _phy_reg_pg); -+ } -+ } -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197F) { -+ if (config_type == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG_MP(8197f, _phy_reg); -+ if (dm->cut_version == ODM_CUT_A) -+ phydm_phypara_a_cut(dm); -+ } else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8197f, _agc_tab); -+ } -+#endif -+/*@jj add 20170822*/ -+#if (RTL8192F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8192F) { -+ if (config_type == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG_MP(8192f, _phy_reg); -+ } else if (config_type == CONFIG_BB_AGC_TAB) { -+ READ_AND_CONFIG_MP(8192f, _agc_tab); -+ } else if (config_type == CONFIG_BB_PHY_REG_PG) { -+ if (dm->rfe_type == 0) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type0); -+ else if (dm->rfe_type == 1) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type1); -+ else if (dm->rfe_type == 2) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type2); -+ else if (dm->rfe_type == 3) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type3); -+ else if (dm->rfe_type == 4) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type4); -+ else if (dm->rfe_type == 5) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type5); -+ else if (dm->rfe_type == 6) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type6); -+ else if (dm->rfe_type == 7) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type7); -+ else if (dm->rfe_type == 8) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type8); -+ else if (dm->rfe_type == 9) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type9); -+ else if (dm->rfe_type == 10) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type10); -+ else if (dm->rfe_type == 11) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type11); -+ else if (dm->rfe_type == 12) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type12); -+ else if (dm->rfe_type == 13) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type13); -+ else if (dm->rfe_type == 14) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type14); -+ else if (dm->rfe_type == 15) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type15); -+ else if (dm->rfe_type == 16) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type16); -+ else if (dm->rfe_type == 17) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type17); -+ else if (dm->rfe_type == 18) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type18); -+ else if (dm->rfe_type == 19) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type19); -+ else if (dm->rfe_type == 20) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type20); -+ else if (dm->rfe_type == 21) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type21); -+ else if (dm->rfe_type == 22) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type22); -+ else if (dm->rfe_type == 23) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type23); -+ else if (dm->rfe_type == 24) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type24); -+ else if (dm->rfe_type == 25) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type25); -+ else if (dm->rfe_type == 26) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type26); -+ else if (dm->rfe_type == 27) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type27); -+ else if (dm->rfe_type == 28) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type28); -+ else if (dm->rfe_type == 29) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type29); -+ else if (dm->rfe_type == 30) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type30); -+ else if (dm->rfe_type == 31) -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type31); -+ else -+ READ_AND_CONFIG_MP(8192f, _phy_reg_pg); -+ } -+ } -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8721D) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8721d, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8721d, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) { -+ if (dm->power_voltage == ODM_POWER_18V) -+ READ_AND_CONFIG_MP(8721d, _phy_reg_pg_type0); -+ else -+ READ_AND_CONFIG_MP(8721d, _phy_reg_pg_type1); -+ } -+ } -+#endif -+ -+#if (RTL8710C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8710C) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8710c, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8710c, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8710c, _phy_reg_pg); -+ } -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8821C) { -+ if (config_type == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG(8821c, _phy_reg); -+ } else if (config_type == CONFIG_BB_AGC_TAB) { -+ READ_AND_CONFIG(8821c, _agc_tab); -+ /* @According to RFEtype, choosing correct AGC table*/ -+ if (dm->default_rf_set_8821c == SWITCH_TO_BTG) -+ AGC_DIFF_CONFIG_MP(8821c, btg); -+ } else if (config_type == CONFIG_BB_PHY_REG_PG) { -+ if (dm->rfe_type == 0x5) -+ READ_AND_CONFIG(8821c, _phy_reg_pg_type0x28); -+ else -+ READ_AND_CONFIG(8821c, _phy_reg_pg); -+ } else if (config_type == CONFIG_BB_AGC_TAB_DIFF) { -+ dm->fw_offload_ability &= ~PHYDM_PHY_PARAM_OFFLOAD; -+ /*@AGC_TAB DIFF dont support FW offload*/ -+ if (dm->current_rf_set_8821c == SWITCH_TO_BTG) -+ AGC_DIFF_CONFIG_MP(8821c, btg); -+ else if (dm->current_rf_set_8821c == SWITCH_TO_WLG) -+ AGC_DIFF_CONFIG_MP(8821c, wlg); -+ } else if (config_type == CONFIG_BB_PHY_REG_MP) { -+ READ_AND_CONFIG(8821c, _phy_reg_mp); -+ } -+ } -+#endif -+ -+#if (RTL8195A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195A) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG(8195a, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG(8195a, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG(8195a, _phy_reg_pg); -+ } -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195B) { -+ if (config_type == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG(8195b, _phy_reg); -+ } else if (config_type == CONFIG_BB_AGC_TAB) { -+ READ_AND_CONFIG(8195b, _agc_tab); -+ } else if (config_type == CONFIG_BB_PHY_REG_PG) { -+ READ_AND_CONFIG(8195b, _phy_reg_pg); -+ } else if (config_type == CONFIG_BB_PHY_REG_MP) { -+ if (dm->package_type == 1) -+ odm_set_bb_reg(dm, R_0xaa8, 0x1f0000, 0x10); -+ else -+ odm_set_bb_reg(dm, R_0xaa8, 0x1f0000, 0x12); -+ } -+ } -+#endif -+#if (RTL8198F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8198F) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8198f, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8198f, _agc_tab); -+ } -+#endif -+#if (RTL8814B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814B) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8814b, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8814b, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) { -+ if (dm->rfe_type == 1) -+ READ_AND_CONFIG(8814b, _phy_reg_pg_type1); -+ else -+ READ_AND_CONFIG(8814b, _phy_reg_pg); -+ } -+ } -+#endif -+#if (RTL8814C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814C) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8814c, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8814c, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) { -+ if (dm->rfe_type == 1) -+ READ_AND_CONFIG(8814c, _phy_reg_pg_type1); -+ else -+ READ_AND_CONFIG(8814c, _phy_reg_pg); -+ } -+ } -+#endif -+#if (RTL8822C_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8822C) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8822c, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8822c, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG(8822c, _phy_reg_pg); -+ } -+#endif -+#if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8723F) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8723f, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8723f, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG(8723f, _phy_reg_pg); -+ } -+#endif -+#if (RTL8812F_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8812F) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8812f, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8812f, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG(8812f, _phy_reg_pg); -+ } -+#endif -+#if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8197G) { -+ if (config_type == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8197g, _phy_reg); -+ else if (config_type == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8197g, _agc_tab); -+ else if (config_type == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG(8197g, _phy_reg_pg); -+ } -+#endif -+ -+ if (config_type == CONFIG_BB_PHY_REG || -+ config_type == CONFIG_BB_AGC_TAB) -+ if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { -+ result = phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_END, -+ 0, -+ 0, -+ 0, -+ (enum rf_path)0, -+ 0); -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "phy param offload end!result = %d", result); -+ } -+ -+ return result; -+} -+ -+enum hal_status -+odm_config_mac_with_header_file(struct dm_struct *dm) -+{ -+ enum hal_status result = HAL_STATUS_SUCCESS; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===>%s (%s)\n", __func__, -+ (dm->is_mp_chip) ? "MPChip" : "TestChip"); -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "support_platform: 0x%X, support_interface: 0x%X, board_type: 0x%X\n", -+ dm->support_platform, dm->support_interface, dm->board_type); -+ -+#ifdef PHYDM_IC_HALMAC_PARAM_SUPPORT -+ if (dm->support_ic_type & PHYDM_IC_SUPPORT_HALMAC_PARAM_OFFLOAD) { -+ PHYDM_DBG(dm, ODM_COMP_INIT, "MAC para-package in HALMAC\n"); -+ return result; -+ } -+#endif -+ -+/* @1 AP doesn't use PHYDM initialization in these ICs */ -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8812A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8812) -+ READ_AND_CONFIG_MP(8812a, _mac_reg); -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8821) -+ READ_AND_CONFIG_MP(8821a, _mac_reg); -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8192E) -+ READ_AND_CONFIG_MP(8192e, _mac_reg); -+#endif -+#if (RTL8723D_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8723D) -+ READ_AND_CONFIG_MP(8723d, _mac_reg); -+#endif -+#if (RTL8710B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8710B) -+ READ_AND_CONFIG_MP(8710b, _mac_reg); -+#endif -+#endif /* @(DM_ODM_SUPPORT_TYPE != ODM_AP) */ -+ -+/* @1 All platforms support */ -+#if (RTL8188E_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188E) -+ READ_AND_CONFIG_MP(8188e, _mac_reg); -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8723B) -+ READ_AND_CONFIG_MP(8723b, _mac_reg); -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814A) -+ READ_AND_CONFIG_MP(8814a, _mac_reg); -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8703B) -+ READ_AND_CONFIG_MP(8703b, _mac_reg); -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188F) -+ READ_AND_CONFIG_MP(8188f, _mac_reg); -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822B) -+ READ_AND_CONFIG_MP(8822b, _mac_reg); -+#endif -+#if (RTL8197F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197F) -+ READ_AND_CONFIG_MP(8197f, _mac_reg); -+#endif -+#if (RTL8192F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8192F) -+ READ_AND_CONFIG_MP(8192f, _mac_reg); -+#endif -+#if (RTL8721D_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8721D) -+ READ_AND_CONFIG_MP(8721d, _mac_reg); -+#endif -+ -+#if (RTL8710C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8710C) -+ READ_AND_CONFIG_MP(8710c, _mac_reg); -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8821C) -+ READ_AND_CONFIG(8821c, _mac_reg); -+#endif -+#if (RTL8195A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195A) -+ READ_AND_CONFIG_MP(8195a, _mac_reg); -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195B) -+ READ_AND_CONFIG_MP(8195b, _mac_reg); -+#endif -+#if (RTL8198F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8198F) -+ READ_AND_CONFIG_MP(8198f, _mac_reg); -+#endif -+#if (RTL8197G_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197G) -+ READ_AND_CONFIG_MP(8197g, _mac_reg); -+#endif -+ -+ if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { -+ result = phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_END, -+ 0, -+ 0, -+ 0, -+ (enum rf_path)0, -+ 0); -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "mac param offload end!result = %d", result); -+ } -+ -+ return result; -+} -+ -+u32 odm_get_hw_img_version(struct dm_struct *dm) -+{ -+ u32 version = 0; -+ -+ switch (dm->support_ic_type) { -+/* @1 AP doesn't use PHYDM initialization in these ICs */ -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8821A_SUPPORT) -+ case ODM_RTL8821: -+ version = odm_get_version_mp_8821a_phy_reg(); -+ break; -+#endif -+#if (RTL8192E_SUPPORT) -+ case ODM_RTL8192E: -+ version = odm_get_version_mp_8192e_phy_reg(); -+ break; -+#endif -+#if (RTL8812A_SUPPORT) -+ case ODM_RTL8812: -+ version = odm_get_version_mp_8812a_phy_reg(); -+ break; -+#endif -+#endif /* @(DM_ODM_SUPPORT_TYPE != ODM_AP) */ -+#if (RTL8723D_SUPPORT) -+ case ODM_RTL8723D: -+ version = odm_get_version_mp_8723d_phy_reg(); -+ break; -+#endif -+#if (RTL8710B_SUPPORT) -+ case ODM_RTL8710B: -+ version = odm_get_version_mp_8710b_phy_reg(); -+ break; -+#endif -+#if (RTL8188E_SUPPORT) -+ case ODM_RTL8188E: -+ version = odm_get_version_mp_8188e_phy_reg(); -+ break; -+#endif -+#if (RTL8723B_SUPPORT) -+ case ODM_RTL8723B: -+ version = odm_get_version_mp_8723b_phy_reg(); -+ break; -+#endif -+#if (RTL8814A_SUPPORT) -+ case ODM_RTL8814A: -+ version = odm_get_version_mp_8814a_phy_reg(); -+ break; -+#endif -+#if (RTL8703B_SUPPORT) -+ case ODM_RTL8703B: -+ version = odm_get_version_mp_8703b_phy_reg(); -+ break; -+#endif -+#if (RTL8188F_SUPPORT) -+ case ODM_RTL8188F: -+ version = odm_get_version_mp_8188f_phy_reg(); -+ break; -+#endif -+#if (RTL8822B_SUPPORT) -+ case ODM_RTL8822B: -+ version = odm_get_version_mp_8822b_phy_reg(); -+ break; -+#endif -+#if (RTL8197F_SUPPORT) -+ case ODM_RTL8197F: -+ version = odm_get_version_mp_8197f_phy_reg(); -+ break; -+#endif -+ -+#if (RTL8192F_SUPPORT) -+ case ODM_RTL8192F: -+ version = odm_get_version_mp_8192f_phy_reg(); -+ break; -+#endif -+#if (RTL8721D_SUPPORT) -+ case ODM_RTL8721D: -+ version = odm_get_version_mp_8721d_phy_reg(); -+ break; -+#endif -+#if (RTL8710C_SUPPORT) -+ case ODM_RTL8710C: -+ version = GET_VERSION_MP(8710c, _mac_reg); -+#endif -+#if (RTL8821C_SUPPORT) -+ case ODM_RTL8821C: -+ version = odm_get_version_mp_8821c_phy_reg(); -+ break; -+#endif -+#if (RTL8195B_SUPPORT) -+ case ODM_RTL8195B: -+ version = odm_get_version_mp_8195b_phy_reg(); -+ break; -+#endif -+#if (RTL8198F_SUPPORT) -+ case ODM_RTL8198F: -+ version = odm_get_version_mp_8198f_phy_reg(); -+ break; -+#endif -+#if (RTL8822C_SUPPORT) -+ case ODM_RTL8822C: -+ version = odm_get_version_mp_8822c_phy_reg(); -+ break; -+#endif -+#if (RTL8812F_SUPPORT) -+ case ODM_RTL8812F: -+ version = odm_get_version_mp_8812f_phy_reg(); -+ break; -+#endif -+#if (RTL8197G_SUPPORT) -+ case ODM_RTL8197G: -+ version = odm_get_version_mp_8197g_phy_reg(); -+ break; -+#endif -+#if (RTL8723F_SUPPORT) -+ case ODM_RTL8723F: -+ version = odm_get_version_mp_8723f_phy_reg(); -+ break; -+#endif -+#if (RTL8814B_SUPPORT) -+ case ODM_RTL8814B: -+ version = odm_get_version_mp_8814b_phy_reg(); -+ break; -+#endif -+#if (RTL8814C_SUPPORT) -+ case ODM_RTL8814C: -+ version = odm_get_version_mp_8814c_phy_reg(); -+ break; -+#endif -+ } -+ -+ return version; -+} -+ -+u32 query_phydm_trx_capability(struct dm_struct *dm) -+{ -+ u32 value32 = 0xFFFFFFFF; -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8821C) -+ value32 = query_phydm_trx_capability_8821c(dm); -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195B) -+ value32 = query_phydm_trx_capability_8195b(dm); -+#endif -+ return value32; -+} -+ -+u32 query_phydm_stbc_capability(struct dm_struct *dm) -+{ -+ u32 value32 = 0xFFFFFFFF; -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8821C) -+ value32 = query_phydm_stbc_capability_8821c(dm); -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195B) -+ value32 = query_phydm_stbc_capability_8195b(dm); -+#endif -+ -+ return value32; -+} -+ -+u32 query_phydm_ldpc_capability(struct dm_struct *dm) -+{ -+ u32 value32 = 0xFFFFFFFF; -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8821C) -+ value32 = query_phydm_ldpc_capability_8821c(dm); -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195B) -+ value32 = query_phydm_ldpc_capability_8195b(dm); -+#endif -+ return value32; -+} -+ -+u32 query_phydm_txbf_parameters(struct dm_struct *dm) -+{ -+ u32 value32 = 0xFFFFFFFF; -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8821C) -+ value32 = query_phydm_txbf_parameters_8821c(dm); -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195B) -+ value32 = query_phydm_txbf_parameters_8195b(dm); -+#endif -+ return value32; -+} -+ -+u32 query_phydm_txbf_capability(struct dm_struct *dm) -+{ -+ u32 value32 = 0xFFFFFFFF; -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8821C) -+ value32 = query_phydm_txbf_capability_8821c(dm); -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8195B) -+ value32 = query_phydm_txbf_capability_8195b(dm); -+#endif -+ return value32; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_hwconfig.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_hwconfig.h -new file mode 100644 -index 000000000..7c4d1e38c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_hwconfig.h -@@ -0,0 +1,79 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __HALHWOUTSRC_H__ -+#define __HALHWOUTSRC_H__ -+ -+/*@--------------------------Define -------------------------------------------*/ -+#define AGC_DIFF_CONFIG_MP(ic, band) \ -+ (odm_read_and_config_mp_##ic##_agc_tab_diff(dm, \ -+ 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_read_and_config_tc_##ic##_agc_tab_diff(dm, \ -+ array_tc_##ic##_agc_tab_diff_##band, \ -+ sizeof(array_tc_##ic##_agc_tab_diff_##band) / sizeof(u32))) -+#if defined(DM_ODM_CE_MAC80211) -+#else -+#define AGC_DIFF_CONFIG(ic, band) \ -+ do { \ -+ if (dm->is_mp_chip) \ -+ AGC_DIFF_CONFIG_MP(ic, band); \ -+ else \ -+ AGC_DIFF_CONFIG_TC(ic, band); \ -+ } while (0) -+#endif -+/*@************************************************************ -+ * structure and define -+ ************************************************************/ -+ -+enum hal_status -+odm_config_rf_with_tx_pwr_track_header_file(struct dm_struct *dm); -+ -+enum hal_status -+odm_config_rf_with_header_file(struct dm_struct *dm, -+ enum odm_rf_config_type config_type, -+ u8 e_rf_path); -+ -+enum hal_status -+odm_config_bb_with_header_file(struct dm_struct *dm, -+ enum odm_bb_config_type config_type); -+ -+enum hal_status -+odm_config_mac_with_header_file(struct dm_struct *dm); -+ -+u32 odm_get_hw_img_version(struct dm_struct *dm); -+ -+u32 query_phydm_trx_capability(struct dm_struct *dm); -+ -+u32 query_phydm_stbc_capability(struct dm_struct *dm); -+ -+u32 query_phydm_ldpc_capability(struct dm_struct *dm); -+ -+u32 query_phydm_txbf_parameters(struct dm_struct *dm); -+ -+u32 query_phydm_txbf_capability(struct dm_struct *dm); -+ -+#endif /*@#ifndef __HALHWOUTSRC_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_interface.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_interface.c -new file mode 100644 -index 000000000..96f0c025d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_interface.c -@@ -0,0 +1,1518 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+/*@ -+ * ODM IO Relative API. -+ */ -+ -+u8 odm_read_1byte(struct dm_struct *dm, u32 reg_addr) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ struct rtl8192cd_priv *priv = dm->priv; -+ return RTL_R8(reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ return rtl_read_byte(rtlpriv, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ return rtw_read8(rtwdev, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ void *adapter = dm->adapter; -+ return rtw_read8(adapter, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ return PlatformEFIORead1Byte(adapter, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ return rtw_read8(adapter, reg_addr); -+#endif -+} -+ -+u16 odm_read_2byte(struct dm_struct *dm, u32 reg_addr) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ struct rtl8192cd_priv *priv = dm->priv; -+ return RTL_R16(reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ return rtl_read_word(rtlpriv, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ return rtw_read16(rtwdev, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ void *adapter = dm->adapter; -+ return rtw_read16(adapter, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ return PlatformEFIORead2Byte(adapter, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ return rtw_read16(adapter, reg_addr); -+#endif -+} -+ -+u32 odm_read_4byte(struct dm_struct *dm, u32 reg_addr) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ struct rtl8192cd_priv *priv = dm->priv; -+ return RTL_R32(reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ return rtl_read_dword(rtlpriv, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ return rtw_read32(rtwdev, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ void *adapter = dm->adapter; -+ return rtw_read32(adapter, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ return PlatformEFIORead4Byte(adapter, reg_addr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ return rtw_read32(adapter, reg_addr); -+#endif -+} -+ -+void odm_write_1byte(struct dm_struct *dm, u32 reg_addr, u8 data) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ struct rtl8192cd_priv *priv = dm->priv; -+ RTL_W8(reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ rtl_write_byte(rtlpriv, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ rtw_write8(rtwdev, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ void *adapter = dm->adapter; -+ rtw_write8(adapter, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PlatformEFIOWrite1Byte(adapter, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ rtw_write8(adapter, reg_addr, data); -+#endif -+ -+ if (dm->en_reg_mntr_byte) -+ pr_debug("1byte:addr=0x%x, data=0x%x\n", reg_addr, data); -+} -+ -+void odm_write_2byte(struct dm_struct *dm, u32 reg_addr, u16 data) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ struct rtl8192cd_priv *priv = dm->priv; -+ RTL_W16(reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ rtl_write_word(rtlpriv, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ rtw_write16(rtwdev, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ void *adapter = dm->adapter; -+ rtw_write16(adapter, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PlatformEFIOWrite2Byte(adapter, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ rtw_write16(adapter, reg_addr, data); -+#endif -+ -+ if (dm->en_reg_mntr_byte) -+ pr_debug("2byte:addr=0x%x, data=0x%x\n", reg_addr, data); -+} -+ -+void odm_write_4byte(struct dm_struct *dm, u32 reg_addr, u32 data) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ struct rtl8192cd_priv *priv = dm->priv; -+ RTL_W32(reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ rtl_write_dword(rtlpriv, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ rtw_write32(rtwdev, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ void *adapter = dm->adapter; -+ rtw_write32(adapter, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PlatformEFIOWrite4Byte(adapter, reg_addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ rtw_write32(adapter, reg_addr, data); -+#endif -+ -+ if (dm->en_reg_mntr_byte) -+ pr_debug("4byte:addr=0x%x, data=0x%x\n", reg_addr, data); -+} -+ -+void odm_set_mac_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask, u32 data) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ phy_set_bb_reg(dm->priv, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PHY_SetBBReg(adapter, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ rtl_set_bbreg(rtlpriv->hw, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ rtw_set_reg_with_mask(rtwdev, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ phy_set_bb_reg(dm->adapter, reg_addr, bit_mask, data); -+#else -+ phy_set_bb_reg(dm->adapter, reg_addr, bit_mask, data); -+#endif -+ -+ if (dm->en_reg_mntr_mac) -+ pr_debug("MAC:addr=0x%x, mask=0x%x, data=0x%x\n", -+ reg_addr, bit_mask, data); -+} -+ -+u32 odm_get_mac_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return phy_query_bb_reg(dm->priv, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return PHY_QueryMacReg(dm->adapter, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ return rtl_get_bbreg(rtlpriv->hw, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ return rtw_get_reg_with_mask(rtwdev, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ return phy_query_bb_reg(dm->adapter, reg_addr, bit_mask); -+#else -+ return phy_query_mac_reg(dm->adapter, reg_addr, bit_mask); -+#endif -+} -+ -+void odm_set_bb_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask, u32 data) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ phy_set_bb_reg(dm->priv, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PHY_SetBBReg(adapter, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ rtl_set_bbreg(rtlpriv->hw, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ rtw_set_reg_with_mask(rtwdev, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ phy_set_bb_reg(dm->adapter, reg_addr, bit_mask, data); -+#else -+ phy_set_bb_reg(dm->adapter, reg_addr, bit_mask, data); -+#endif -+ -+ if (dm->en_reg_mntr_bb) -+ pr_debug("BB:addr=0x%x, mask=0x%x, data=0x%x\n", -+ reg_addr, bit_mask, data); -+} -+ -+u32 odm_get_bb_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return phy_query_bb_reg(dm->priv, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ return PHY_QueryBBReg(adapter, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ return rtl_get_bbreg(rtlpriv->hw, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ return rtw_get_reg_with_mask(rtwdev, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ return phy_query_bb_reg(dm->adapter, reg_addr, bit_mask); -+#else -+ return phy_query_bb_reg(dm->adapter, reg_addr, bit_mask); -+#endif -+} -+ -+void odm_set_rf_reg(struct dm_struct *dm, u8 e_rf_path, u32 reg_addr, -+ u32 bit_mask, u32 data) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ phy_set_rf_reg(dm->priv, e_rf_path, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PHY_SetRFReg(adapter, e_rf_path, reg_addr, bit_mask, data); -+ ODM_delay_us(2); -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ rtl_set_rfreg(rtlpriv->hw, e_rf_path, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ rtw_write_rf(rtwdev, e_rf_path, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ phy_set_rf_reg(dm->adapter, e_rf_path, reg_addr, bit_mask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ phy_set_rf_reg(dm->adapter, e_rf_path, reg_addr, bit_mask, data); -+ ODM_delay_us(2); -+#endif -+ -+ if (dm->en_reg_mntr_rf) -+ pr_debug("RF:path=0x%x, addr=0x%x, mask=0x%x, data=0x%x\n", -+ e_rf_path, reg_addr, bit_mask, data); -+} -+ -+u32 odm_get_rf_reg(struct dm_struct *dm, u8 e_rf_path, u32 reg_addr, -+ u32 bit_mask) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return phy_query_rf_reg(dm->priv, e_rf_path, reg_addr, bit_mask, 1); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ return PHY_QueryRFReg(adapter, e_rf_path, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ return rtl_get_rfreg(rtlpriv->hw, e_rf_path, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ return rtw_read_rf(rtwdev, e_rf_path, reg_addr, bit_mask); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ return phy_query_rf_reg(dm->adapter, e_rf_path, reg_addr, bit_mask); -+#else -+ return phy_query_rf_reg(dm->adapter, e_rf_path, reg_addr, bit_mask); -+#endif -+} -+ -+enum hal_status -+phydm_set_reg_by_fw(struct dm_struct *dm, enum phydm_halmac_param config_type, -+ u32 offset, u32 data, u32 mask, enum rf_path e_rf_path, -+ u32 delay_time) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ return HAL_MAC_Config_PHY_WriteNByte(dm, -+ config_type, -+ offset, -+ data, -+ mask, -+ e_rf_path, -+ delay_time); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ PHYDM_DBG(dm, DBG_CMN, "Not support for CE MAC80211 driver!\n"); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ return -ENOTSUPP; -+#else -+ return rtw_phydm_cfg_phy_para(dm, -+ config_type, -+ offset, -+ data, -+ mask, -+ e_rf_path, -+ delay_time); -+#endif -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ PHYDM_DBG(dm, DBG_CMN, "Not support for CE MAC80211 driver!\n"); -+#endif -+} -+ -+/*@ -+ * ODM Memory relative API. -+ */ -+void odm_allocate_memory(struct dm_struct *dm, void **ptr, u32 length) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ *ptr = kmalloc(length, GFP_ATOMIC); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ *ptr = kmalloc(length, GFP_ATOMIC); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ *ptr = kmalloc(length, GFP_ATOMIC); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ *ptr = rtw_zvmalloc(length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PlatformAllocateMemory(adapter, ptr, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ *ptr = rtw_zvmalloc(length); -+#endif -+} -+ -+/* @length could be ignored, used to detect memory leakage. */ -+void odm_free_memory(struct dm_struct *dm, void *ptr, u32 length) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ kfree(ptr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ kfree(ptr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ kfree(ptr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_vmfree(ptr, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ /* struct void* adapter = dm->adapter; */ -+ PlatformFreeMemory(ptr, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_vmfree(ptr, length); -+#endif -+} -+ -+void odm_move_memory(struct dm_struct *dm, void *dest, void *src, u32 length) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ memcpy(dest, src, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ memcpy(dest, src, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ memcpy(dest, src, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ _rtw_memcpy(dest, src, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformMoveMemory(dest, src, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_memcpy(dest, src, length); -+#endif -+} -+ -+u16 odm_convert_to_le16(u16 value) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ return cpu_to_le16(value); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ return cpu_to_le16(value); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ return cpu_to_le16(value); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return cpu_to_le16(value); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return value; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ return cpu_to_le16(value); -+#else -+ return value; -+#endif -+} -+ -+u32 odm_convert_to_le32(u32 value) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ return cpu_to_le32(value); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ return cpu_to_le32(value); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ return cpu_to_le32(value); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return cpu_to_le32(value); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return value; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ return cpu_to_le32(value); -+#else -+ return value; -+#endif -+} -+ -+void odm_memory_set(struct dm_struct *dm, void *pbuf, s8 value, u32 length) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ memset(pbuf, value, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ memset(pbuf, value, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ 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); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_memset(pbuf, value, length); -+#endif -+} -+ -+s32 odm_compare_memory(struct dm_struct *dm, void *buf1, void *buf2, u32 length) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return memcmp(buf1, buf2, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ return memcmp(buf1, buf2, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ return memcmp(buf1, buf2, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return _rtw_memcmp(buf1, buf2, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return PlatformCompareMemory(buf1, buf2, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ return rtw_memcmp(buf1, buf2, length); -+#endif -+} -+ -+/*@ -+ * ODM MISC relative API. -+ */ -+void odm_acquire_spin_lock(struct dm_struct *dm, enum rt_spinlock_type type) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ rtl_odm_acquirespinlock(rtlpriv, type); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ spin_lock(&rtwdev->hal.dm_lock); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ void *adapter = dm->adapter; -+ rtw_odm_acquirespinlock(adapter, type); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PlatformAcquireSpinLock(adapter, type); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ rtw_odm_acquirespinlock(adapter, type); -+#endif -+} -+ -+void odm_release_spin_lock(struct dm_struct *dm, enum rt_spinlock_type type) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+ -+ rtl_odm_releasespinlock(rtlpriv, type); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ -+ spin_unlock(&rtwdev->hal.dm_lock); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ void *adapter = dm->adapter; -+ rtw_odm_releasespinlock(adapter, type); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PlatformReleaseSpinLock(adapter, type); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ rtw_odm_releasespinlock(adapter, type); -+#endif -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+/*@ -+ * Work item relative API. FOr MP driver only~! -+ * */ -+void odm_initialize_work_item( -+ struct dm_struct *dm, -+ PRT_WORK_ITEM work_item, -+ RT_WORKITEM_CALL_BACK callback, -+ void *context, -+ const char *id) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PlatformInitializeWorkItem(adapter, work_item, callback, context, id); -+#endif -+} -+ -+void odm_start_work_item( -+ PRT_WORK_ITEM p_rt_work_item) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStartWorkItem(p_rt_work_item); -+#endif -+} -+ -+void odm_stop_work_item( -+ PRT_WORK_ITEM p_rt_work_item) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStopWorkItem(p_rt_work_item); -+#endif -+} -+ -+void odm_free_work_item( -+ PRT_WORK_ITEM p_rt_work_item) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformFreeWorkItem(p_rt_work_item); -+#endif -+} -+ -+void odm_schedule_work_item( -+ PRT_WORK_ITEM p_rt_work_item) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformScheduleWorkItem(p_rt_work_item); -+#endif -+} -+ -+boolean -+odm_is_work_item_scheduled( -+ PRT_WORK_ITEM p_rt_work_item) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return PlatformIsWorkItemScheduled(p_rt_work_item); -+#endif -+} -+#endif -+ -+/*@ -+ * ODM Timer relative API. -+ */ -+ -+void ODM_delay_ms(u32 ms) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ delay_ms(ms); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ mdelay(ms); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ mdelay(ms); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_mdelay_os(ms); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ delay_ms(ms); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_mdelay_os(ms); -+#endif -+} -+ -+void ODM_delay_us(u32 us) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ delay_us(us); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ udelay(us); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ udelay(us); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_udelay_os(us); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStallExecution(us); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_udelay_os(us); -+#endif -+} -+ -+void ODM_sleep_ms(u32 ms) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ delay_ms(ms); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ msleep(ms); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ msleep(ms); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_msleep_os(ms); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ delay_ms(ms); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_msleep_os(ms); -+#endif -+} -+ -+void ODM_sleep_us(u32 us) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ delay_us(us); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ usleep_range(us, us + 1); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ usleep_range(us, us + 1); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_usleep_os(us); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStallExecution(us); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_usleep_os(us); -+#endif -+} -+ -+void odm_set_timer(struct dm_struct *dm, struct phydm_timer_list *timer, -+ u32 ms_delay) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ mod_timer(timer, jiffies + RTL_MILISECONDS_TO_JIFFIES(ms_delay)); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ mod_timer(timer, jiffies + msecs_to_jiffies(ms_delay)); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ mod_timer(&timer->timer, jiffies + msecs_to_jiffies(ms_delay)); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ _set_timer(timer, ms_delay); /* @ms */ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PlatformSetTimer(adapter, timer, ms_delay); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_set_timer(timer, ms_delay); /* @ms */ -+#endif -+} -+ -+void odm_initialize_timer(struct dm_struct *dm, struct phydm_timer_list *timer, -+ void *call_back_func, void *context, -+ const char *sz_id) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ init_timer(timer); -+ timer->function = call_back_func; -+ timer->data = (unsigned long)dm; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ timer_setup(timer, call_back_func, 0); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ struct _ADAPTER *adapter = dm->adapter; -+ -+ _init_timer(timer, adapter->pnetdev, call_back_func, dm); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ -+ PlatformInitializeTimer(adapter, timer, (RT_TIMER_CALL_BACK)call_back_func, context, sz_id); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ struct _ADAPTER *adapter = dm->adapter; -+ -+ rtw_init_timer(timer, adapter->pnetdev, (TIMER_FUN)call_back_func, dm, NULL); -+#endif -+} -+ -+void odm_cancel_timer(struct dm_struct *dm, struct phydm_timer_list *timer) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ del_timer(timer); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ del_timer(timer); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ del_timer(&timer->timer); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ _cancel_timer_ex(timer); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PlatformCancelTimer(adapter, timer); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_cancel_timer(timer); -+#endif -+} -+ -+void odm_release_timer(struct dm_struct *dm, struct phydm_timer_list *timer) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ void *adapter = dm->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 (timer == 0) { -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "[%s] Timer is NULL! Please check!\n", __func__); -+ return; -+ } -+ -+ PlatformReleaseTimer(adapter, timer); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_del_timer(timer); -+#endif -+} -+ -+u8 phydm_trans_h2c_id(struct dm_struct *dm, u8 phydm_h2c_id) -+{ -+ u8 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 (RTL8188E_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188E) -+ platform_h2c_id = H2C_88E_RSSI_REPORT; -+ else -+ #endif -+ platform_h2c_id = H2C_RSSI_REPORT; -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+#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) || (RTL8192F_SUPPORT == 1)) /*@jj add 20170822*/ -+ if (dm->support_ic_type & (ODM_RTL8881A | ODM_RTL8192E | ODM_RTL8192F | PHYDM_IC_3081_SERIES)) -+ platform_h2c_id = H2C_88XX_RSSI_REPORT; -+ else -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ if (dm->support_ic_type == 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) -+ platform_h2c_id = H2C_RA_PARA_ADJUST; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+#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) || (RTL8192F_SUPPORT == 1)) /*@jj add 20170822*/ -+ if (dm->support_ic_type & (ODM_RTL8881A | ODM_RTL8192E | ODM_RTL8192F | PHYDM_IC_3081_SERIES)) -+ platform_h2c_id = H2C_88XX_RA_PARA_ADJUST; -+ else -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ if (dm->support_ic_type == 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 (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814A) -+ platform_h2c_id = H2C_8814A_DYNAMIC_TX_PATH; -+ #endif -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+#if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8814A) -+ platform_h2c_id = H2C_DYNAMIC_TX_PATH; -+#endif -+#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) -+#if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type == 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) -+ -+ 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) || (RTL8192F_SUPPORT == 1)) /*@jj add 20170822*/ -+ if (dm->support_ic_type & (ODM_RTL8881A | ODM_RTL8192E | ODM_RTL8192F | PHYDM_IC_3081_SERIES)) -+ platform_h2c_id = H2C_88XX_FW_TRACE_EN; -+ else -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ if (dm->support_ic_type == 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)) -+ if (dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8812)) -+ 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_fill_h2c_cmd(struct dm_struct *dm, u8 phydm_h2c_id, u32 cmd_len, -+ u8 *cmd_buf) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ struct rtw_dev *rtwdev = dm->adapter; -+ u8 cmd_id, cmd_class; -+ u8 h2c_pkt[8]; -+#else -+ void *adapter = dm->adapter; -+#endif -+ u8 h2c_id = phydm_trans_h2c_id(dm, phydm_h2c_id); -+ -+ PHYDM_DBG(dm, DBG_RA, "[H2C] h2c_id=((0x%x))\n", h2c_id); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (dm->support_ic_type == ODM_RTL8188E) { -+ if (!dm->ra_support88e) -+ FillH2CCmd88E(adapter, h2c_id, cmd_len, cmd_buf); -+ } else if (dm->support_ic_type == ODM_RTL8814A) -+ FillH2CCmd8814A(adapter, h2c_id, cmd_len, cmd_buf); -+ else if (dm->support_ic_type == ODM_RTL8822B) -+ FillH2CCmd8822B(adapter, h2c_id, cmd_len, cmd_buf); -+ else -+ FillH2CCmd(adapter, h2c_id, cmd_len, cmd_buf); -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+ #ifdef DM_ODM_CE_MAC80211 -+ rtlpriv->cfg->ops->fill_h2c_cmd(rtlpriv->hw, h2c_id, cmd_len, cmd_buf); -+ #elif defined(DM_ODM_CE_MAC80211_V2) -+ cmd_id = phydm_h2c_id & 0x1f; -+ cmd_class = (phydm_h2c_id >> RTW_H2C_CLASS_OFFSET) & 0x7; -+ memcpy(h2c_pkt + 1, cmd_buf, 7); -+ h2c_pkt[0] = phydm_h2c_id; -+ rtw_fw_send_h2c_packet(rtwdev, h2c_pkt, cmd_id, cmd_class); -+ /* TODO: implement fill h2c command for rtwlan */ -+ #else -+ rtw_hal_fill_h2c_cmd(adapter, h2c_id, cmd_len, cmd_buf); -+ #endif -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ #if (RTL8812A_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8812) { -+ fill_h2c_cmd8812(dm->priv, h2c_id, cmd_len, cmd_buf); -+ } else -+ #endif -+ { -+ GET_HAL_INTERFACE(dm->priv)->fill_h2c_cmd_handler(dm->priv, h2c_id, cmd_len, cmd_buf); -+ } -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ rtw_hal_fill_h2c_cmd(adapter, h2c_id, cmd_len, cmd_buf); -+ -+#endif -+} -+ -+u8 phydm_c2H_content_parsing(void *dm_void, u8 c2h_cmd_id, u8 c2h_cmd_len, -+ u8 *tmp_buf) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = dm->adapter; -+#endif -+ u8 extend_c2h_sub_id = 0; -+ u8 find_c2h_cmd = true; -+ -+ if (c2h_cmd_len > 12 || c2h_cmd_len == 0) { -+ pr_debug("[Warning] Error C2H ID=%d, len=%d\n", -+ c2h_cmd_id, c2h_cmd_len); -+ -+ find_c2h_cmd = false; -+ return find_c2h_cmd; -+ } -+ -+ switch (c2h_cmd_id) { -+ case PHYDM_C2H_DBG: -+ phydm_fw_trace_handler(dm, tmp_buf, c2h_cmd_len); -+ break; -+ -+ case PHYDM_C2H_RA_RPT: -+ phydm_c2h_ra_report_handler(dm, tmp_buf, c2h_cmd_len); -+ break; -+ -+ case PHYDM_C2H_RA_PARA_RPT: -+ odm_c2h_ra_para_report_handler(dm, tmp_buf, c2h_cmd_len); -+ break; -+#ifdef CONFIG_PATH_DIVERSITY -+ case PHYDM_C2H_DYNAMIC_TX_PATH_RPT: -+ if (dm->support_ic_type & (ODM_RTL8814A)) -+ phydm_c2h_dtp_handler(dm, tmp_buf, c2h_cmd_len); -+ break; -+#endif -+ -+ case PHYDM_C2H_IQK_FINISH: -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) { -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK Finish ==\n")); -+ odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); -+ dm->rf_calibrate_info.is_iqk_in_progress = false; -+ odm_release_spin_lock(dm, RT_IQK_SPINLOCK); -+ dm->rf_calibrate_info.iqk_progressing_time = 0; -+ dm->rf_calibrate_info.iqk_progressing_time = odm_get_progressing_time(dm, dm->rf_calibrate_info.iqk_start_time); -+ } -+ -+#endif -+ break; -+ -+ case PHYDM_C2H_CLM_MONITOR: -+ phydm_clm_c2h_report_handler(dm, tmp_buf, c2h_cmd_len); -+ break; -+ -+ case PHYDM_C2H_DBG_CODE: -+ phydm_fw_trace_handler_code(dm, tmp_buf, c2h_cmd_len); -+ break; -+ -+ case PHYDM_C2H_EXTEND: -+ extend_c2h_sub_id = tmp_buf[0]; -+ if (extend_c2h_sub_id == PHYDM_EXTEND_C2H_DBG_PRINT) -+ phydm_fw_trace_handler_8051(dm, tmp_buf, c2h_cmd_len); -+ -+ break; -+ -+ default: -+ find_c2h_cmd = false; -+ break; -+ } -+ -+ return find_c2h_cmd; -+} -+ -+u64 odm_get_current_time(struct dm_struct *dm) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return (u64)rtw_get_current_time(); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ return jiffies; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ return jiffies; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return rtw_get_current_time(); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return PlatformGetCurrentTime(); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ return rtw_get_current_time(); -+#endif -+} -+ -+u64 odm_get_progressing_time(struct dm_struct *dm, u64 start_time) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return rtw_get_passing_time_ms((u32)start_time); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ return jiffies_to_msecs(jiffies - start_time); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ return jiffies_to_msecs(jiffies - start_time); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return rtw_get_passing_time_ms((systime)start_time); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return ((PlatformGetCurrentTime() - start_time) >> 10); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ return rtw_get_passing_time_ms(start_time); -+#endif -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) && \ -+ (!defined(DM_ODM_CE_MAC80211) && !defined(DM_ODM_CE_MAC80211_V2)) -+ -+void phydm_set_hw_reg_handler_interface(struct dm_struct *dm, u8 RegName, -+ u8 *val) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ struct _ADAPTER *adapter = dm->adapter; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ ((PADAPTER)adapter)->HalFunc.SetHwRegHandler(adapter, RegName, val); -+#else -+ adapter->hal_func.set_hw_reg_handler(adapter, RegName, val); -+#endif -+ -+#endif -+} -+ -+void phydm_get_hal_def_var_handler_interface(struct dm_struct *dm, -+ enum _HAL_DEF_VARIABLE e_variable, -+ void *value) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ struct _ADAPTER *adapter = dm->adapter; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ ((PADAPTER)adapter)->HalFunc.GetHalDefVarHandler(adapter, e_variable, value); -+#else -+ adapter->hal_func.get_hal_def_var_handler(adapter, e_variable, value); -+#endif -+ -+#endif -+} -+ -+#endif -+ -+void odm_set_tx_power_index_by_rate_section(struct dm_struct *dm, -+ enum rf_path path, u8 ch, -+ u8 section) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ PHY_SetTxPowerIndexByRateSection(adapter, path, ch, section); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ void *adapter = dm->adapter; -+ -+ phy_set_tx_power_index_by_rs(adapter, ch, path, section); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ phy_set_tx_power_index_by_rate_section(dm->adapter, path, ch, section); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ PHY_SetTxPowerIndexByRateSection(adapter, path, ch, section); -+#endif -+} -+ -+u8 odm_get_tx_power_index(struct dm_struct *dm, enum rf_path path, u8 rate, -+ u8 bw, u8 ch) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ -+ return PHY_GetTxPowerIndex(dm->adapter, path, rate, (CHANNEL_WIDTH)bw, ch); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ void *adapter = dm->adapter; -+ -+ return phy_get_tx_power_index(adapter, path, rate, bw, ch); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ void *adapter = dm->adapter; -+ -+ return phy_get_tx_power_index(adapter, path, rate, bw, ch); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return phy_get_tx_power_index(dm->adapter, path, rate, bw, ch); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ return PHY_GetTxPowerIndex(dm->adapter, path, rate, bw, ch); -+#endif -+} -+ -+u8 odm_efuse_one_byte_read(struct dm_struct *dm, u16 addr, u8 *data, -+ boolean b_pseu_do_test) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ -+ return (u8)EFUSE_OneByteRead(adapter, addr, data, b_pseu_do_test); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ void *adapter = dm->adapter; -+ -+ return rtl_efuse_onebyte_read(adapter, addr, data, b_pseu_do_test); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ return -1; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return efuse_onebyte_read(dm->adapter, addr, data, b_pseu_do_test); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ return Efuse_OneByteRead(dm, addr, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ return (u8)efuse_OneByteRead(adapter, addr, data, b_pseu_do_test); -+#endif -+} -+ -+void odm_efuse_logical_map_read(struct dm_struct *dm, u8 type, u16 offset, -+ u32 *data) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ void *adapter = dm->adapter; -+ -+ EFUSE_ShadowRead(adapter, type, offset, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ void *adapter = dm->adapter; -+ -+ rtl_efuse_logical_map_read(adapter, type, offset, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ efuse_logical_map_read(dm->adapter, type, offset, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ void *adapter = dm->adapter; -+ -+ EFUSE_ShadowRead(adapter, type, offset, data); -+#endif -+} -+ -+enum hal_status -+odm_iq_calibrate_by_fw(struct dm_struct *dm, u8 clear, u8 segment) -+{ -+ enum hal_status iqk_result = HAL_STATUS_FAILURE; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ struct _ADAPTER *adapter = dm->adapter; -+ -+ if (HAL_MAC_FWIQK_Trigger(&GET_HAL_MAC_INFO(adapter), clear, segment) == 0) -+ iqk_result = HAL_STATUS_SUCCESS; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ void *adapter = dm->adapter; -+ -+ iqk_result = rtl_phydm_fw_iqk(adapter, clear, segment); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+#else -+ iqk_result = rtw_phydm_fw_iqk(dm, clear, segment); -+#endif -+#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) -+ iqk_result = rtw_phydm_fw_iqk(dm, clear, segment); -+#endif -+ return iqk_result; -+} -+ -+enum hal_status -+odm_dpk_by_fw(struct dm_struct *dm) -+{ -+ enum hal_status dpk_result = HAL_STATUS_FAILURE; -+#if 0 -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ struct _ADAPTER *adapter = dm->adapter; -+ -+ if (hal_mac_fwdpk_trigger(&GET_HAL_MAC_INFO(adapter)) == 0) -+ dpk_result = HAL_STATUS_SUCCESS; -+#else -+ dpk_result = rtw_phydm_fw_dpk(dm); -+#endif -+ -+#endif -+ return dpk_result; -+} -+ -+void phydm_cmn_sta_info_hook(struct dm_struct *dm, u8 mac_id, -+ struct cmn_sta_info *pcmn_sta_info) -+{ -+ dm->phydm_sta_info[mac_id] = pcmn_sta_info; -+ -+ if (is_sta_active(pcmn_sta_info)) -+ dm->phydm_macid_table[pcmn_sta_info->mac_id] = mac_id; -+} -+ -+void phydm_macid2sta_idx_table(struct dm_struct *dm, u8 entry_idx, -+ struct cmn_sta_info *pcmn_sta_info) -+{ -+ if (is_sta_active(pcmn_sta_info)) -+ dm->phydm_macid_table[pcmn_sta_info->mac_id] = entry_idx; -+} -+ -+void phydm_add_interrupt_mask_handler(struct dm_struct *dm, u8 interrupt_type) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ #if IS_EXIST_PCI || IS_EXIST_EMBEDDED -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ GET_HAL_INTERFACE(priv)->AddInterruptMaskHandler(priv, -+ interrupt_type) -+ ; -+ #endif -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#endif -+} -+ -+void phydm_enable_rx_related_interrupt_handler(struct dm_struct *dm) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ #if IS_EXIST_PCI || IS_EXIST_EMBEDDED -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ GET_HAL_INTERFACE(priv)->EnableRxRelatedInterruptHandler(priv); -+ #endif -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#endif -+} -+ -+void phydm_iqk_wait(struct dm_struct *dm, u32 timeout) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ PHYDM_DBG(dm, DBG_CMN, "Not support for CE MAC80211 driver!\n"); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+#else -+ void *adapter = dm->adapter; -+ -+ rtl8812_iqk_wait(adapter, timeout); -+#endif -+#endif -+} -+ -+u8 phydm_get_hwrate_to_mrate(struct dm_struct *dm, u8 rate) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ return HwRateToMRate(rate); -+#endif -+ return 0; -+} -+ -+void phydm_set_crystalcap(struct dm_struct *dm, u8 crystal_cap) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ ROM_odm_SetCrystalCap(dm, crystal_cap); -+#endif -+} -+ -+void phydm_run_in_thread_cmd(struct dm_struct *dm, void (*func)(void *), -+ void *context) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ PHYDM_DBG(dm, DBG_CMN, "Not support for CE MAC80211 driver!\n"); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ void *adapter = dm->adapter; -+ -+ rtw_run_in_thread_cmd(adapter, func, context); -+#endif -+} -+ -+u8 phydm_get_tx_rate(struct dm_struct *dm) -+{ -+ struct _hal_rf_ *rf = &dm->rf_table; -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ struct _ADAPTER *adapter = dm->adapter; -+#endif -+ u8 tx_rate = 0xff; -+ u8 mpt_rate_index = 0; -+ -+ if (*dm->mp_mode == 1) { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if (MP_DRIVER == 1) -+ PMPT_CONTEXT p_mpt_ctx = &adapter->MptCtx; -+ -+ tx_rate = MptToMgntRate(p_mpt_ctx->MptRateIndex); -+#endif -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+#ifdef CONFIG_MP_INCLUDED -+ if (rf->mp_rate_index) -+ mpt_rate_index = *rf->mp_rate_index; -+ -+ tx_rate = mpt_to_mgnt_rate(mpt_rate_index); -+#endif -+#endif -+#endif -+ } else { -+ u16 rate = *dm->forced_data_rate; -+ -+ if (!rate) { /*auto rate*/ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ struct _ADAPTER *adapter = dm->adapter; -+ -+ tx_rate = ((PADAPTER)adapter)->HalFunc.GetHwRateFromMRateHandler(dm->tx_rate); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ tx_rate = dm->tx_rate; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ if (dm->number_linked_client != 0) -+ tx_rate = hw_rate_to_m_rate(dm->tx_rate); -+ else -+ tx_rate = rf->p_rate_index; -+#endif -+ } else { /*force rate*/ -+ tx_rate = (u8)rate; -+ } -+ } -+ -+ return tx_rate; -+} -+ -+u8 phydm_get_tx_power_dbm(struct dm_struct *dm, u8 rf_path, -+ u8 rate, u8 bandwidth, u8 channel) -+{ -+ u8 tx_power_dbm = 0; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct _ADAPTER *adapter = dm->adapter; -+ tx_power_dbm = PHY_GetTxPowerFinalAbsoluteValue(adapter, rf_path, rate, bandwidth, channel); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ tx_power_dbm = phy_get_tx_power_final_absolute_value(dm->adapter, rf_path, rate, bandwidth, channel); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ tx_power_dbm = PHY_GetTxPowerFinalAbsoluteValue(dm, rf_path, rate, bandwidth, channel); -+#endif -+ return tx_power_dbm; -+} -+ -+s16 phydm_get_tx_power_mdbm(struct dm_struct *dm, u8 rf_path, -+ u8 rate, u8 bandwidth, u8 channel) -+{ -+ s16 tx_power_dbm = 0; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct _ADAPTER *adapter = dm->adapter; -+ tx_power_dbm = PHY_GetTxPowerFinalAbsoluteValuemdBm(adapter, rf_path, rate, bandwidth, channel); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ tx_power_dbm = rtw_odm_get_tx_power_mbm(dm, rf_path, rate, bandwidth, channel); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ tx_power_dbm = PHY_GetTxPowerFinalAbsoluteValuembm(dm, rf_path, rate, bandwidth, channel); -+#endif -+ return tx_power_dbm; -+} -+ -+u32 phydm_rfe_ctrl_gpio(struct dm_struct *dm, u8 gpio_num) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ return rtw_phydm_rfe_ctrl_gpio(dm->adapter, gpio_num); -+#endif -+ return 0; -+} -+ -+u64 phydm_division64(u64 x, u64 y) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ do_div(x, y); -+ return x; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return x / y; -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return rtw_division64(x, y); -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_interface.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_interface.h -new file mode 100644 -index 000000000..50efa46bb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_interface.h -@@ -0,0 +1,332 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __ODM_INTERFACE_H__ -+#define __ODM_INTERFACE_H__ -+ -+#define INTERFACE_VERSION "1.3" -+ -+#define pdm_set_reg odm_set_bb_reg -+ -+/*@=========== Constant/Structure/Enum/... Define*/ -+ -+enum phydm_h2c_cmd { -+ PHYDM_H2C_RA_MASK = 0x40, -+ PHYDM_H2C_TXBF = 0x41, -+ ODM_H2C_RSSI_REPORT = 0x42, -+ ODM_H2C_IQ_CALIBRATION = 0x45, -+ PHYDM_RA_MASK_ABOVE_3SS = 0x46, -+ 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, -+ PHYDM_H2C_FW_GENERAL_INIT = 0x4c, -+ PHYDM_H2C_FW_CLM_MNTR = 0x4d, -+ PHYDM_H2C_MCC = 0x4f, -+ PHYDM_H2C_RESP_TX_PATH_CTRL = 0x50, -+ PHYDM_H2C_RESP_TX_ANT_CTRL = 0x51, -+ PHYDM_H2C_FW_DM_CTRL = 0x55, -+ ODM_MAX_H2CCMD -+}; -+ -+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_CLM_MONITOR = 0x2a, -+ PHYDM_C2H_DBG_CODE = 0xFE, -+ PHYDM_C2H_EXTEND = 0xFF, -+}; -+ -+enum phydm_extend_c2h_evt { -+ PHYDM_EXTEND_C2H_DBG_PRINT = 0 -+ -+}; -+ -+enum phydm_halmac_param { -+ PHYDM_HALMAC_CMD_MAC_W8 = 0, -+ PHYDM_HALMAC_CMD_MAC_W16 = 1, -+ PHYDM_HALMAC_CMD_MAC_W32 = 2, -+ PHYDM_HALMAC_CMD_BB_W8, -+ PHYDM_HALMAC_CMD_BB_W16, -+ PHYDM_HALMAC_CMD_BB_W32, -+ PHYDM_HALMAC_CMD_RF_W, -+ PHYDM_HALMAC_CMD_DELAY_US, -+ PHYDM_HALMAC_CMD_DELAY_MS, -+ PHYDM_HALMAC_CMD_END = 0XFF, -+}; -+ -+/*@=========== 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 -+ -+#if defined(DM_ODM_CE_MAC80211) -+#define ODM_BIT(name, dm) \ -+ ((dm->support_ic_type & ODM_IC_11N_SERIES) ? \ -+ ODM_BIT_##name##_11N : ODM_BIT_##name##_11AC) -+ -+#define ODM_REG(name, dm) \ -+ ((dm->support_ic_type & ODM_IC_11N_SERIES) ? \ -+ ODM_REG_##name##_11N : ODM_REG_##name##_11AC) -+#else -+#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, dm)" -+ * gets "ODM_R_A_AGC_CORE1" or "ODM_R_A_AGC_CORE1_8192C", -+ * depends on support_ic_type. -+ */ -+#ifdef __ECOS -+ #define ODM_REG(_name, _pdm_odm) \ -+ _rtk_cat(_name, _pdm_odm->support_ic_type, _reg) -+ #define ODM_BIT(_name, _pdm_odm) \ -+ _rtk_cat(_name, _pdm_odm->support_ic_type, _bit) -+#else -+ #define ODM_REG(_name, _pdm_odm) \ -+ _cat(_name, _pdm_odm->support_ic_type, _reg) -+ #define ODM_BIT(_name, _pdm_odm) \ -+ _cat(_name, _pdm_odm->support_ic_type, _bit) -+#endif -+ -+#endif -+/*@ -+ * =========== Extern Variable ??? It should be forbidden. -+ */ -+ -+/*@ -+ * =========== EXtern Function Prototype -+ */ -+ -+u8 odm_read_1byte(struct dm_struct *dm, u32 reg_addr); -+ -+u16 odm_read_2byte(struct dm_struct *dm, u32 reg_addr); -+ -+u32 odm_read_4byte(struct dm_struct *dm, u32 reg_addr); -+ -+void odm_write_1byte(struct dm_struct *dm, u32 reg_addr, u8 data); -+ -+void odm_write_2byte(struct dm_struct *dm, u32 reg_addr, u16 data); -+ -+void odm_write_4byte(struct dm_struct *dm, u32 reg_addr, u32 data); -+ -+void odm_set_mac_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask, -+ u32 data); -+ -+u32 odm_get_mac_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask); -+ -+void odm_set_bb_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask, u32 data); -+ -+u32 odm_get_bb_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask); -+ -+void odm_set_rf_reg(struct dm_struct *dm, u8 e_rf_path, u32 reg_addr, -+ u32 bit_mask, u32 data); -+ -+u32 odm_get_rf_reg(struct dm_struct *dm, u8 e_rf_path, u32 reg_addr, -+ u32 bit_mask); -+ -+u16 odm_convert_to_le16(u16 value); -+ -+u32 odm_convert_to_le32(u32 value); -+ -+/*@ -+ * Memory Relative Function. -+ */ -+void odm_allocate_memory(struct dm_struct *dm, void **ptr, u32 length); -+void odm_free_memory(struct dm_struct *dm, void *ptr, u32 length); -+ -+void odm_move_memory(struct dm_struct *dm, void *dest, void *src, u32 length); -+ -+s32 odm_compare_memory(struct dm_struct *dm, void *buf1, void *buf2, -+ u32 length); -+ -+void odm_memory_set(struct dm_struct *dm, void *pbuf, s8 value, u32 length); -+ -+/*@ -+ * ODM MISC-spin lock relative API. -+ */ -+void odm_acquire_spin_lock(struct dm_struct *dm, enum rt_spinlock_type type); -+ -+void odm_release_spin_lock(struct dm_struct *dm, enum rt_spinlock_type type); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+/*@ -+ * ODM MISC-workitem relative API. -+ */ -+void odm_initialize_work_item( -+ struct dm_struct *dm, -+ PRT_WORK_ITEM p_rt_work_item, -+ RT_WORKITEM_CALL_BACK rt_work_item_callback, -+ void *context, -+ const char *sz_id); -+ -+void odm_start_work_item( -+ PRT_WORK_ITEM p_rt_work_item); -+ -+void odm_stop_work_item( -+ PRT_WORK_ITEM p_rt_work_item); -+ -+void odm_free_work_item( -+ PRT_WORK_ITEM p_rt_work_item); -+ -+void odm_schedule_work_item( -+ PRT_WORK_ITEM p_rt_work_item); -+ -+boolean -+odm_is_work_item_scheduled( -+ PRT_WORK_ITEM p_rt_work_item); -+#endif -+ -+/*@ -+ * ODM Timer relative API. -+ */ -+void ODM_delay_ms(u32 ms); -+ -+void ODM_delay_us(u32 us); -+ -+void ODM_sleep_ms(u32 ms); -+ -+void ODM_sleep_us(u32 us); -+ -+void odm_set_timer(struct dm_struct *dm, struct phydm_timer_list *timer, -+ u32 ms_delay); -+ -+void odm_initialize_timer(struct dm_struct *dm, struct phydm_timer_list *timer, -+ void *call_back_func, void *context, -+ const char *sz_id); -+ -+void odm_cancel_timer(struct dm_struct *dm, struct phydm_timer_list *timer); -+ -+void odm_release_timer(struct dm_struct *dm, struct phydm_timer_list *timer); -+ -+/*ODM FW relative API.*/ -+ -+enum hal_status -+phydm_set_reg_by_fw(struct dm_struct *dm, enum phydm_halmac_param config_type, -+ u32 offset, u32 data, u32 mask, enum rf_path e_rf_path, -+ u32 delay_time); -+ -+void odm_fill_h2c_cmd(struct dm_struct *dm, u8 element_id, u32 cmd_len, -+ u8 *cmd_buffer); -+ -+u8 phydm_c2H_content_parsing(void *dm_void, u8 c2h_cmd_id, u8 c2h_cmd_len, -+ u8 *tmp_buf); -+ -+u64 odm_get_current_time(struct dm_struct *dm); -+u64 odm_get_progressing_time(struct dm_struct *dm, u64 start_time); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) && \ -+ (!defined(DM_ODM_CE_MAC80211) && !defined(DM_ODM_CE_MAC80211_V2)) -+ -+void phydm_set_hw_reg_handler_interface(struct dm_struct *dm, u8 reg_Name, -+ u8 *val); -+ -+void phydm_get_hal_def_var_handler_interface(struct dm_struct *dm, -+ enum _HAL_DEF_VARIABLE e_variable, -+ void *value); -+ -+#endif -+ -+void odm_set_tx_power_index_by_rate_section(struct dm_struct *dm, -+ enum rf_path path, u8 channel, -+ u8 rate_section); -+ -+u8 odm_get_tx_power_index(struct dm_struct *dm, enum rf_path path, u8 tx_rate, -+ u8 band_width, u8 channel); -+ -+u8 odm_efuse_one_byte_read(struct dm_struct *dm, u16 addr, u8 *data, -+ boolean b_pseu_do_test); -+ -+void odm_efuse_logical_map_read(struct dm_struct *dm, u8 type, u16 offset, -+ u32 *data); -+ -+enum hal_status -+odm_iq_calibrate_by_fw(struct dm_struct *dm, u8 clear, u8 segment); -+ -+enum hal_status -+odm_dpk_by_fw(struct dm_struct *dm); -+ -+void phydm_cmn_sta_info_hook(struct dm_struct *dm, u8 index, -+ struct cmn_sta_info *pcmn_sta_info); -+ -+void phydm_macid2sta_idx_table(struct dm_struct *dm, u8 entry_idx, -+ struct cmn_sta_info *pcmn_sta_info); -+ -+void phydm_add_interrupt_mask_handler(struct dm_struct *dm, u8 interrupt_type); -+ -+void phydm_enable_rx_related_interrupt_handler(struct dm_struct *dm); -+ -+void phydm_iqk_wait(struct dm_struct *dm, u32 timeout); -+u8 phydm_get_hwrate_to_mrate(struct dm_struct *dm, u8 rate); -+ -+void phydm_set_crystalcap(struct dm_struct *dm, u8 crystal_cap); -+void phydm_run_in_thread_cmd(struct dm_struct *dm, void (*func)(void *), -+ void *context); -+u8 phydm_get_tx_rate(struct dm_struct *dm); -+u8 phydm_get_tx_power_dbm(struct dm_struct *dm, u8 rf_path, -+ u8 rate, u8 bandwidth, u8 channel); -+ -+s16 phydm_get_tx_power_mdbm(struct dm_struct *dm, u8 rf_path, -+ u8 rate, u8 bandwidth, u8 channel); -+ -+u32 phydm_rfe_ctrl_gpio(struct dm_struct *dm, u8 gpio_num); -+ -+u64 phydm_division64(u64 x, u64 y); -+ -+#endif /* @__ODM_INTERFACE_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_lna_sat.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_lna_sat.c -new file mode 100644 -index 000000000..204765ee9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_lna_sat.c -@@ -0,0 +1,1700 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/************************************************************* -+ * include files -+ * *************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+ -+#ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+void phydm_lna_sat_chk_init( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_info = &dm->dm_lna_sat_info; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); -+ -+ lna_info->check_time = 0; -+ lna_info->sat_cnt_acc_patha = 0; -+ lna_info->sat_cnt_acc_pathb = 0; -+ #ifdef PHYDM_IC_ABOVE_3SS -+ lna_info->sat_cnt_acc_pathc = 0; -+ #endif -+ #ifdef PHYDM_IC_ABOVE_4SS -+ lna_info->sat_cnt_acc_pathd = 0; -+ #endif -+ lna_info->cur_sat_status = 0; -+ lna_info->pre_sat_status = 0; -+ lna_info->cur_timer_check_cnt = 0; -+ lna_info->pre_timer_check_cnt = 0; -+ -+ #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C)) -+ phydm_lna_sat_chk_bb_init(dm); -+ #endif -+} -+ -+#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+void phydm_lna_sat_chk_bb_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_info = &dm->dm_lna_sat_info; -+ -+ boolean disable_bb_switch_tab = false; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); -+ -+ /*@set table switch mux r_6table_sel_anten*/ -+ odm_set_bb_reg(dm, 0x18ac, BIT(8), 0); -+ -+ /*@tab decision when idle*/ -+ odm_set_bb_reg(dm, 0x18ac, BIT(16), disable_bb_switch_tab); -+ odm_set_bb_reg(dm, 0x41ac, BIT(16), disable_bb_switch_tab); -+ odm_set_bb_reg(dm, 0x52ac, BIT(16), disable_bb_switch_tab); -+ odm_set_bb_reg(dm, 0x53ac, BIT(16), disable_bb_switch_tab); -+ /*@tab decision when ofdmcca*/ -+ odm_set_bb_reg(dm, 0x18ac, BIT(17), disable_bb_switch_tab); -+ odm_set_bb_reg(dm, 0x41ac, BIT(17), disable_bb_switch_tab); -+ odm_set_bb_reg(dm, 0x52ac, BIT(17), disable_bb_switch_tab); -+ odm_set_bb_reg(dm, 0x53ac, BIT(17), disable_bb_switch_tab); -+} -+ -+void phydm_set_ofdm_agc_tab_path( -+ void *dm_void, -+ u8 tab_sel, -+ enum rf_path path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); -+ if (dm->support_ic_type & -+ (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C)) { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "set AGC Tab%d\n", tab_sel); -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "r_6table_sel_anten = 0x%x\n", -+ odm_get_bb_reg(dm, 0x18ac, BIT(8))); -+ } -+ -+ if (dm->support_ic_type & ODM_RTL8198F) { -+ /*@table sel:0/2, mapping 2 to 1 */ -+ if (tab_sel == OFDM_AGC_TAB_0) { -+ odm_set_bb_reg(dm, 0x18ac, BIT(4), 0); -+ odm_set_bb_reg(dm, 0x41ac, BIT(4), 0); -+ odm_set_bb_reg(dm, 0x52ac, BIT(4), 0); -+ odm_set_bb_reg(dm, 0x53ac, BIT(4), 0); -+ } else if (tab_sel == OFDM_AGC_TAB_2) { -+ odm_set_bb_reg(dm, 0x18ac, BIT(4), 1); -+ odm_set_bb_reg(dm, 0x41ac, BIT(4), 1); -+ odm_set_bb_reg(dm, 0x52ac, BIT(4), 1); -+ odm_set_bb_reg(dm, 0x53ac, BIT(4), 1); -+ } else { -+ odm_set_bb_reg(dm, 0x18ac, BIT(4), 0); -+ odm_set_bb_reg(dm, 0x41ac, BIT(4), 0); -+ odm_set_bb_reg(dm, 0x52ac, BIT(4), 0); -+ odm_set_bb_reg(dm, 0x53ac, BIT(4), 0); -+ } -+ } else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (tab_sel == OFDM_AGC_TAB_0) { -+ odm_set_bb_reg(dm, 0x18ac, 0xf0, 0); -+ odm_set_bb_reg(dm, 0x41ac, 0xf0, 0); -+ odm_set_bb_reg(dm, 0x52ac, 0xf0, 0); -+ odm_set_bb_reg(dm, 0x53ac, 0xf0, 0); -+ } else if (tab_sel == OFDM_AGC_TAB_2) { -+ odm_set_bb_reg(dm, 0x18ac, 0xf0, 2); -+ odm_set_bb_reg(dm, 0x41ac, 0xf0, 2); -+ odm_set_bb_reg(dm, 0x52ac, 0xf0, 2); -+ odm_set_bb_reg(dm, 0x53ac, 0xf0, 2); -+ } else { -+ odm_set_bb_reg(dm, 0x18ac, 0xf0, 0); -+ odm_set_bb_reg(dm, 0x41ac, 0xf0, 0); -+ odm_set_bb_reg(dm, 0x52ac, 0xf0, 0); -+ odm_set_bb_reg(dm, 0x53ac, 0xf0, 0); -+ } -+ } -+} -+ -+u8 phydm_get_ofdm_agc_tab_path( -+ void *dm_void, -+ enum rf_path path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 tab_sel = 0; -+ -+ if (dm->support_ic_type & ODM_RTL8198F) { -+ tab_sel = (u8)odm_get_bb_reg(dm, R_0x18ac, BIT(4)); -+ if (tab_sel == 0) -+ tab_sel = OFDM_AGC_TAB_0; -+ else if (tab_sel == 1) -+ tab_sel = OFDM_AGC_TAB_2; -+ } else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ tab_sel = (u8)odm_get_bb_reg(dm, R_0x18ac, 0xf0); -+ if (tab_sel == 0) -+ tab_sel = OFDM_AGC_TAB_0; -+ else if (tab_sel == 2) -+ tab_sel = OFDM_AGC_TAB_2; -+ } -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "get path %d AGC Tab %d\n", -+ path, tab_sel); -+ return tab_sel; -+} -+#endif /*@#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT)*/ -+ -+void phydm_set_ofdm_agc_tab( -+ void *dm_void, -+ u8 tab_sel) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /*@table sel:0/2, 1 is used for CCK */ -+ if (tab_sel == OFDM_AGC_TAB_0) -+ odm_set_bb_reg(dm, R_0xc70, 0x1e00, OFDM_AGC_TAB_0); -+ else if (tab_sel == OFDM_AGC_TAB_2) -+ odm_set_bb_reg(dm, R_0xc70, 0x1e00, OFDM_AGC_TAB_2); -+ else -+ odm_set_bb_reg(dm, R_0xc70, 0x1e00, OFDM_AGC_TAB_0); -+} -+ -+u8 phydm_get_ofdm_agc_tab( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ return (u8)odm_get_bb_reg(dm, R_0xc70, 0x1e00); -+} -+ -+void phydm_lna_sat_chk( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ struct phydm_lna_sat_t *lna_info = &dm->dm_lna_sat_info; -+ u8 igi_rssi_min; -+ u8 rssi_min = dm->rssi_min; -+ u32 sat_status_a, sat_status_b; -+ #ifdef PHYDM_IC_ABOVE_3SS -+ u32 sat_status_c; -+ #endif -+ #ifdef PHYDM_IC_ABOVE_4SS -+ u32 sat_status_d; -+ #endif -+ u8 igi_restore = dig_t->cur_ig_value; -+ u8 i, chk_cnt = lna_info->chk_cnt; -+ u32 lna_sat_cnt_thd = 0; -+ u8 agc_tab; -+ u32 max_check_time = 0; -+ /*@use rssi_max if rssi_min is not stable;*/ -+ /*@rssi_min = dm->rssi_max;*/ -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "\n%s ==>\n", __func__); -+ -+ if (!(dm->support_ability & ODM_BB_LNA_SAT_CHK)) { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "Func disable\n"); -+ return; -+ } -+ -+ if (lna_info->is_disable_lna_sat_chk) { -+ phydm_lna_sat_chk_init(dm); -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "disable_lna_sat_chk\n"); -+ return; -+ } -+ -+ /*@move igi to target pin of rssi_min */ -+ if (rssi_min == 0 || rssi_min == 0xff) { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "rssi_min=%d, set AGC Tab0\n", rssi_min); -+ /*@adapt agc table 0*/ -+ phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_0); -+ phydm_lna_sat_chk_init(dm); -+ return; -+ } else if (rssi_min % 2 != 0) { -+ igi_rssi_min = rssi_min + DIFF_RSSI_TO_IGI - 1; -+ } else { -+ igi_rssi_min = rssi_min + DIFF_RSSI_TO_IGI; -+ } -+ -+ if ((lna_info->chk_period > 0) && (lna_info->chk_period <= ONE_SEC_MS)) -+ max_check_time = chk_cnt * (ONE_SEC_MS / (lna_info->chk_period)) * 5; -+ else -+ max_check_time = chk_cnt * 5; -+ -+ lna_sat_cnt_thd = (max_check_time * lna_info->chk_duty_cycle) / 100; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "check_time=%d, rssi_min=%d, igi_rssi_min=0x%x\nchk_cnt=%d, chk_period=%d, max_check_time=%d, lna_sat_cnt_thd=%d\n", -+ lna_info->check_time, -+ rssi_min, -+ igi_rssi_min, -+ chk_cnt, -+ lna_info->chk_period, -+ max_check_time, -+ lna_sat_cnt_thd); -+ -+ odm_write_dig(dm, igi_rssi_min); -+ -+ /*@adapt agc table 0 check saturation status*/ -+ #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C)) -+ phydm_set_ofdm_agc_tab_path(dm, OFDM_AGC_TAB_0, RF_PATH_A); -+ else -+ #endif -+ phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_0); -+ /*@open rf power detection ckt & set detection range */ -+#if (RTL8198F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8198F) { -+ /*@set rf detection range (threshold)*/ -+ config_phydm_write_rf_reg_8198f(dm, RF_PATH_A, 0x85, -+ 0x3f, 0x3f); -+ config_phydm_write_rf_reg_8198f(dm, RF_PATH_B, 0x85, -+ 0x3f, 0x3f); -+ config_phydm_write_rf_reg_8198f(dm, RF_PATH_C, 0x85, -+ 0x3f, 0x3f); -+ config_phydm_write_rf_reg_8198f(dm, RF_PATH_D, 0x85, -+ 0x3f, 0x3f); -+ /*@open rf power detection ckt*/ -+ config_phydm_write_rf_reg_8198f(dm, RF_PATH_A, 0x86, 0x10, 1); -+ config_phydm_write_rf_reg_8198f(dm, RF_PATH_B, 0x86, 0x10, 1); -+ config_phydm_write_rf_reg_8198f(dm, RF_PATH_C, 0x86, 0x10, 1); -+ config_phydm_write_rf_reg_8198f(dm, RF_PATH_D, 0x86, 0x10, 1); -+ } -+#elif (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ /*@set rf detection range (threshold)*/ -+ config_phydm_write_rf_reg_8814b(dm, RF_PATH_A, 0x8B, 0x3, 0x3); -+ config_phydm_write_rf_reg_8814b(dm, RF_PATH_B, 0x8B, 0x3, 0x3); -+ config_phydm_write_rf_reg_8814b(dm, RF_PATH_C, 0x8B, 0x3, 0x3); -+ config_phydm_write_rf_reg_8814b(dm, RF_PATH_D, 0x8B, 0x3, 0x3); -+ /*@open rf power detection ckt*/ -+ config_phydm_write_rf_reg_8814b(dm, RF_PATH_A, 0x8B, 0x4, 1); -+ config_phydm_write_rf_reg_8814b(dm, RF_PATH_B, 0x8B, 0x4, 1); -+ config_phydm_write_rf_reg_8814b(dm, RF_PATH_C, 0x8B, 0x4, 1); -+ config_phydm_write_rf_reg_8814b(dm, RF_PATH_D, 0x8B, 0x4, 1); -+ } -+#else -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x86, 0x1f, 0x10); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x86, 0x1f, 0x10); -+ #ifdef PHYDM_IC_ABOVE_3SS -+ odm_set_rf_reg(dm, RF_PATH_C, RF_0x86, 0x1f, 0x10); -+ #endif -+ #ifdef PHYDM_IC_ABOVE_4SS -+ odm_set_rf_reg(dm, RF_PATH_D, RF_0x86, 0x1f, 0x10); -+ #endif -+#endif -+ -+ /*@check saturation status*/ -+ for (i = 0; i < chk_cnt; i++) { -+#if (RTL8198F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8198F) { -+ sat_status_a = config_phydm_read_rf_reg_8198f(dm, RF_PATH_A, -+ RF_0xae, -+ 0xe0000); -+ sat_status_b = config_phydm_read_rf_reg_8198f(dm, RF_PATH_B, -+ RF_0xae, -+ 0xe0000); -+ sat_status_c = config_phydm_read_rf_reg_8198f(dm, RF_PATH_C, -+ RF_0xae, -+ 0xe0000); -+ sat_status_d = config_phydm_read_rf_reg_8198f(dm, RF_PATH_D, -+ RF_0xae, -+ 0xe0000); -+ } -+#elif (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ /*@read peak detector info from 8814B rf reg*/ -+ sat_status_a = config_phydm_read_rf_reg_8814b(dm, RF_PATH_A, -+ RF_0xae, -+ 0xc0000); -+ sat_status_b = config_phydm_read_rf_reg_8814b(dm, RF_PATH_B, -+ RF_0xae, -+ 0xc0000); -+ sat_status_c = config_phydm_read_rf_reg_8814b(dm, RF_PATH_C, -+ RF_0xae, -+ 0xc0000); -+ sat_status_d = config_phydm_read_rf_reg_8814b(dm, RF_PATH_D, -+ RF_0xae, -+ 0xc0000); -+ } -+#else -+ sat_status_a = odm_get_rf_reg(dm, RF_PATH_A, RF_0xae, 0xc0000); -+ sat_status_b = odm_get_rf_reg(dm, RF_PATH_B, RF_0xae, 0xc0000); -+ #ifdef PHYDM_IC_ABOVE_3SS -+ sat_status_c = odm_get_rf_reg(dm, RF_PATH_C, RF_0xae, 0xc0000); -+ #endif -+ #ifdef PHYDM_IC_ABOVE_4SS -+ sat_status_d = odm_get_rf_reg(dm, RF_PATH_D, RF_0xae, 0xc0000); -+ #endif -+#endif -+ -+ if (sat_status_a != 0) -+ lna_info->sat_cnt_acc_patha++; -+ if (sat_status_b != 0) -+ lna_info->sat_cnt_acc_pathb++; -+ #ifdef PHYDM_IC_ABOVE_3SS -+ if (sat_status_c != 0) -+ lna_info->sat_cnt_acc_pathc++; -+ #endif -+ #ifdef PHYDM_IC_ABOVE_4SS -+ if (sat_status_d != 0) -+ lna_info->sat_cnt_acc_pathd++; -+ #endif -+ -+ if (lna_info->sat_cnt_acc_patha >= lna_sat_cnt_thd || -+ lna_info->sat_cnt_acc_pathb >= lna_sat_cnt_thd || -+ #ifdef PHYDM_IC_ABOVE_3SS -+ lna_info->sat_cnt_acc_pathc >= lna_sat_cnt_thd || -+ #endif -+ #ifdef PHYDM_IC_ABOVE_4SS -+ lna_info->sat_cnt_acc_pathd >= lna_sat_cnt_thd || -+ #endif -+ 0) { -+ lna_info->cur_sat_status = 1; -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "cur_sat_status=%d, check_time=%d\n", -+ lna_info->cur_sat_status, -+ lna_info->check_time); -+ break; -+ } -+ lna_info->cur_sat_status = 0; -+ } -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "cur_sat_status=%d, pre_sat_status=%d, sat_cnt_acc_patha=%d, sat_cnt_acc_pathb=%d\n", -+ lna_info->cur_sat_status, -+ lna_info->pre_sat_status, -+ lna_info->sat_cnt_acc_patha, -+ lna_info->sat_cnt_acc_pathb); -+ -+ #ifdef PHYDM_IC_ABOVE_4SS -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "cur_sat_status=%d, pre_sat_status=%d, sat_cnt_acc_pathc=%d, sat_cnt_acc_pathd=%d\n", -+ lna_info->cur_sat_status, -+ lna_info->pre_sat_status, -+ lna_info->sat_cnt_acc_pathc, -+ lna_info->sat_cnt_acc_pathd); -+ #endif -+ /*@agc table decision*/ -+ if (lna_info->cur_sat_status) { -+ if (!lna_info->dis_agc_table_swh) -+ #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+ if (dm->support_ic_type & -+ (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C)) -+ phydm_set_ofdm_agc_tab_path(dm, -+ OFDM_AGC_TAB_2, -+ RF_PATH_A); -+ else -+ #endif -+ phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_2); -+ else -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "disable set to AGC Tab%d\n", OFDM_AGC_TAB_2); -+ lna_info->check_time = 0; -+ lna_info->sat_cnt_acc_patha = 0; -+ lna_info->sat_cnt_acc_pathb = 0; -+ #ifdef PHYDM_IC_ABOVE_3SS -+ lna_info->sat_cnt_acc_pathc = 0; -+ #endif -+ #ifdef PHYDM_IC_ABOVE_4SS -+ lna_info->sat_cnt_acc_pathd = 0; -+ #endif -+ lna_info->pre_sat_status = lna_info->cur_sat_status; -+ -+ } else if (lna_info->check_time <= (max_check_time - 1)) { -+ if (lna_info->pre_sat_status && !lna_info->dis_agc_table_swh) -+ #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+ if (dm->support_ic_type & -+ (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C)) -+ phydm_set_ofdm_agc_tab_path(dm, -+ OFDM_AGC_TAB_2, -+ RF_PATH_A); -+ else -+ #endif -+ phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_2); -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "ckeck time not reached\n"); -+ if (lna_info->dis_agc_table_swh) -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "disable set to AGC Tab%d\n", OFDM_AGC_TAB_2); -+ lna_info->check_time++; -+ -+ } else if (lna_info->check_time >= max_check_time) { -+ if (!lna_info->dis_agc_table_swh) -+ #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+ if (dm->support_ic_type & -+ (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C)) -+ phydm_set_ofdm_agc_tab_path(dm, -+ OFDM_AGC_TAB_0, -+ RF_PATH_A); -+ else -+ #endif -+ phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_0); -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "ckeck time reached\n"); -+ if (lna_info->dis_agc_table_swh) -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "disable set to AGC Tab%d\n", OFDM_AGC_TAB_0); -+ lna_info->check_time = 0; -+ lna_info->sat_cnt_acc_patha = 0; -+ lna_info->sat_cnt_acc_pathb = 0; -+ #ifdef PHYDM_IC_ABOVE_3SS -+ lna_info->sat_cnt_acc_pathc = 0; -+ #endif -+ #ifdef PHYDM_IC_ABOVE_4SS -+ lna_info->sat_cnt_acc_pathd = 0; -+ #endif -+ lna_info->pre_sat_status = lna_info->cur_sat_status; -+ } -+ -+ #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C)) -+ agc_tab = phydm_get_ofdm_agc_tab_path(dm, RF_PATH_A); -+ else -+ #endif -+ agc_tab = phydm_get_ofdm_agc_tab(dm); -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "use AGC tab %d\n", agc_tab); -+ -+ /*@restore previous igi*/ -+ odm_write_dig(dm, igi_restore); -+ lna_info->cur_timer_check_cnt++; -+ odm_set_timer(dm, &lna_info->phydm_lna_sat_chk_timer, -+ lna_info->chk_period); -+} -+ -+void phydm_lna_sat_chk_callback( -+ void *dm_void -+ -+ ) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "\n%s ==>\n", __func__); -+ phydm_lna_sat_chk(dm); -+} -+ -+void phydm_lna_sat_chk_timers( -+ void *dm_void, -+ u8 state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_info = &dm->dm_lna_sat_info; -+ -+ if (state == INIT_LNA_SAT_CHK_TIMMER) { -+ odm_initialize_timer(dm, -+ &lna_info->phydm_lna_sat_chk_timer, -+ (void *)phydm_lna_sat_chk_callback, NULL, -+ "phydm_lna_sat_chk_timer"); -+ } else if (state == CANCEL_LNA_SAT_CHK_TIMMER) { -+ odm_cancel_timer(dm, &lna_info->phydm_lna_sat_chk_timer); -+ } else if (state == RELEASE_LNA_SAT_CHK_TIMMER) { -+ odm_release_timer(dm, &lna_info->phydm_lna_sat_chk_timer); -+ } -+} -+ -+void phydm_lna_sat_chk_watchdog_type1( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_info = &dm->dm_lna_sat_info; -+ -+ u8 rssi_min = dm->rssi_min; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); -+ -+ if (!(dm->support_ability & ODM_BB_LNA_SAT_CHK)) { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "func disable\n"); -+ return; -+ } -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "pre_timer_check_cnt=%d, cur_timer_check_cnt=%d\n", -+ lna_info->pre_timer_check_cnt, -+ lna_info->cur_timer_check_cnt); -+ -+ if (lna_info->is_disable_lna_sat_chk) { -+ phydm_lna_sat_chk_init(dm); -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "is_disable_lna_sat_chk=%d, return\n", -+ lna_info->is_disable_lna_sat_chk); -+ return; -+ } -+ -+ if (rssi_min == 0 || rssi_min == 0xff) { -+ /*@adapt agc table 0 */ -+ phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_0); -+ phydm_lna_sat_chk_init(dm); -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "rssi_min=%d, return\n", rssi_min); -+ return; -+ } -+ -+ if (lna_info->cur_timer_check_cnt == lna_info->pre_timer_check_cnt) { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "fail, restart timer\n"); -+ odm_set_timer(dm, &lna_info->phydm_lna_sat_chk_timer, -+ lna_info->chk_period); -+ } else { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "Timer check pass\n"); -+ } -+ lna_info->pre_timer_check_cnt = lna_info->cur_timer_check_cnt; -+} -+ -+#endif /*@#ifdef PHYDM_LNA_SAT_CHK_TYPE1*/ -+ -+#ifdef PHYDM_LNA_SAT_CHK_TYPE2 -+ -+void phydm_bubble_sort( -+ void *dm_void, -+ u8 *array, -+ u16 array_length) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 i, j; -+ u8 temp; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); -+ for (i = 0; i < (array_length - 1); i++) { -+ for (j = (i + 1); j < (array_length); j++) { -+ if (array[i] > array[j]) { -+ temp = array[i]; -+ array[i] = array[j]; -+ array[j] = temp; -+ } -+ } -+ } -+} -+ -+void phydm_lna_sat_chk_type2_init( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ u8 real_shift = pinfo->total_bit_shift; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); -+ -+ pinfo->total_cnt_snr = 1 << real_shift; -+ pinfo->is_sm_done = TRUE; -+ pinfo->is_snr_done = FALSE; -+ pinfo->cur_snr_mean = 0; -+ pinfo->cur_snr_var = 0; -+ pinfo->cur_lower_snr_mean = 0; -+ pinfo->pre_snr_mean = 0; -+ pinfo->pre_snr_var = 0; -+ pinfo->pre_lower_snr_mean = 0; -+ pinfo->nxt_state = ORI_TABLE_MONITOR; -+ pinfo->pre_state = ORI_TABLE_MONITOR; -+} -+ -+void phydm_snr_collect( -+ void *dm_void, -+ u8 rx_snr) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ -+ if (pinfo->is_sm_done) { -+ /* @adapt only path-A for calculation */ -+ pinfo->snr_statistic[pinfo->cnt_snr_statistic] = rx_snr; -+ -+ if (pinfo->cnt_snr_statistic == (pinfo->total_cnt_snr - 1)) { -+ pinfo->is_snr_done = TRUE; -+ pinfo->cnt_snr_statistic = 0; -+ } else { -+ pinfo->cnt_snr_statistic++; -+ } -+ } else { -+ return; -+ } -+} -+ -+void phydm_parsing_snr(void *dm_void, void *pktinfo_void, s8 *rx_snr) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_t = &dm->dm_lna_sat_info; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ u8 target_macid = dm->rssi_min_macid; -+ -+ if (!(dm->support_ability & ODM_BB_LNA_SAT_CHK)) -+ return; -+ -+ pktinfo = (struct phydm_perpkt_info_struct *)pktinfo_void; -+ -+ if (!pktinfo->is_packet_match_bssid) -+ return; -+ -+ if (lna_t->force_traget_macid != 0) -+ target_macid = lna_t->force_traget_macid; -+ -+ if (target_macid != pktinfo->station_id) -+ return; -+ -+ phydm_snr_collect(dm, rx_snr[0]); /*path-A B C D???*/ -+} -+ -+void phydm_snr_data_processing( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ u8 real_shift = pinfo->total_bit_shift; -+ u16 total_snr_cnt = pinfo->total_cnt_snr; -+ u16 total_loop_cnt = (total_snr_cnt - 1), i; -+ u32 temp; -+ u32 sum_snr_statistic = 0; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "total_loop_cnt=%d\n", total_loop_cnt); -+ -+ for (i = 0; (i <= total_loop_cnt); i++) { -+ if (pinfo->is_snr_detail_en) { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "snr[%d]=%d\n", i, pinfo->snr_statistic[i]); -+ } -+ -+ sum_snr_statistic += (u32)(pinfo->snr_statistic[i]); -+ -+ pinfo->snr_statistic_sqr[i] = (u16)(pinfo->snr_statistic[i] * pinfo->snr_statistic[i]); -+ } -+ -+ phydm_bubble_sort(dm, pinfo->snr_statistic, pinfo->total_cnt_snr); -+ -+ /*update SNR's cur mean*/ -+ pinfo->cur_snr_mean = (sum_snr_statistic >> real_shift); -+ -+ for (i = 0; (i <= total_loop_cnt); i++) { -+ if (pinfo->snr_statistic[i] >= pinfo->cur_snr_mean) -+ temp = pinfo->snr_statistic[i] - pinfo->cur_snr_mean; -+ else -+ temp = pinfo->cur_snr_mean - pinfo->snr_statistic[i]; -+ -+ pinfo->cur_snr_var += (temp * temp); -+ } -+ -+ /*update SNR's VAR*/ -+ pinfo->cur_snr_var = (pinfo->cur_snr_var >> real_shift); -+ -+ /*@acquire lower SNR's statistics*/ -+ temp = 0; -+ pinfo->cnt_lower_snr_statistic = (total_snr_cnt >> pinfo->lwr_snr_ratio_bit_shift); -+ pinfo->cnt_lower_snr_statistic = MAX_2(pinfo->cnt_lower_snr_statistic, SNR_RPT_MAX); -+ -+ for (i = 0; i < pinfo->cnt_lower_snr_statistic; i++) -+ temp += pinfo->snr_statistic[i]; -+ -+ pinfo->cur_lower_snr_mean = temp >> (real_shift - pinfo->lwr_snr_ratio_bit_shift); -+} -+ -+boolean phydm_is_snr_improve( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ boolean is_snr_improve; -+ u8 cur_state = pinfo->nxt_state; -+ u32 cur_mean = pinfo->cur_snr_mean; -+ u32 pre_mean = pinfo->pre_snr_mean; -+ u32 cur_lower_mean = pinfo->cur_lower_snr_mean; -+ u32 pre_lower_mean = pinfo->pre_lower_snr_mean; -+ u32 cur_var = pinfo->cur_snr_var; -+ -+ /*special case, zero VAR, interference is gone*/ -+ /*@make sure pre_var is larger enough*/ -+ if (cur_state == SAT_TABLE_MONITOR || -+ cur_state == ORI_TABLE_TRAINING) { -+ if (cur_mean >= pre_mean) { -+ if (cur_var == 0) -+ return true; -+ } -+ } -+#if 0 -+ /*special case, mean degrade less than VAR improvement*/ -+ /*@make sure pre_var is larger enough*/ -+ if (cur_state == ORI_TABLE_MONITOR && -+ cur_mean < pre_mean && -+ cur_var < pre_var) { -+ diff_mean = pre_mean - cur_mean; -+ diff_var = pre_var - cur_var; -+ return (diff_var > (2 * diff_mean * diff_mean)) ? true : false; -+ } -+ -+#endif -+ if (cur_lower_mean >= (pre_lower_mean + pinfo->delta_snr_mean)) -+ is_snr_improve = true; -+ else -+ is_snr_improve = false; -+#if 0 -+/* @condition refine, mean is bigger enough or VAR is smaller enough*/ -+/* @1. from mean's view, mean improve delta_snr_mean(2), VAR not degrade lot*/ -+ if (cur_mean > (pre_mean + pinfo->delta_snr_mean)) { -+ is_mean_improve = TRUE; -+ is_var_improve = (cur_var <= pre_var + dm->delta_snr_var) -+ ? TRUE : FALSE; -+ -+ } else if (cur_var + dm->delta_snr_var <= pre_var) { -+ is_var_improve = TRUE; -+ is_mean_improve = ((cur_mean + 1) >= pre_mean) ? TRUE : FALSE; -+ } else { -+ return false; -+ } -+#endif -+ return is_snr_improve; -+} -+ -+boolean phydm_is_snr_degrade( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ u32 cur_lower_mean = pinfo->cur_lower_snr_mean; -+ u32 pre_lower_mean = pinfo->pre_lower_snr_mean; -+ boolean is_degrade; -+ -+ if (cur_lower_mean <= (pre_lower_mean - pinfo->delta_snr_mean)) -+ is_degrade = TRUE; -+ else -+ is_degrade = FALSE; -+#if 0 -+ is_mean_dgrade = (pinfo->cur_snr_mean + pinfo->delta_snr_mean <= pinfo->pre_snr_mean) ? TRUE : FALSE; -+ is_var_degrade = (pinfo->cur_snr_var > (pinfo->pre_snr_var + pinfo->delta_snr_mean)) ? TRUE : FALSE; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s: cur_mean=%d, pre_mean=%d, cur_var=%d, pre_var=%d\n", -+ __func__, -+ pinfo->cur_snr_mean, -+ pinfo->pre_snr_mean, -+ pinfo->cur_snr_var, -+ pinfo->pre_snr_var); -+ -+ return (is_mean_dgrade & is_var_degrade); -+#endif -+ return is_degrade; -+} -+ -+boolean phydm_is_large_var( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ boolean is_large_var = (pinfo->cur_snr_var >= pinfo->snr_var_thd) ? TRUE : FALSE; -+ -+ return is_large_var; -+} -+ -+void phydm_update_pre_status( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ -+ pinfo->pre_lower_snr_mean = pinfo->cur_lower_snr_mean; -+ pinfo->pre_snr_mean = pinfo->cur_snr_mean; -+ pinfo->pre_snr_var = pinfo->cur_snr_var; -+} -+ -+void phydm_ori_table_monitor( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ -+ if (phydm_is_large_var(dm)) { -+ pinfo->nxt_state = SAT_TABLE_TRAINING; -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); -+ } else { -+ pinfo->nxt_state = ORI_TABLE_MONITOR; -+ /*switch to anti-sat table*/ -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); -+ } -+ phydm_update_pre_status(dm); -+ pinfo->pre_state = ORI_TABLE_MONITOR; -+} -+ -+void phydm_sat_table_training( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ -+ #if 0 -+ if pre_state = ORI_TABLE_MONITOR || SAT_TABLE_TRY_FAIL, -+ /*@"pre" adapt ori-table, "cur" adapt sat-table*/ -+ /*@adapt ori table*/ -+ if (pinfo->pre_state == ORI_TABLE_MONITOR) { -+ pinfo->nxt_state = SAT_TABLE_TRAINING; -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); -+ } else { -+ #endif -+ if (phydm_is_snr_improve(dm)) { -+ pinfo->nxt_state = SAT_TABLE_MONITOR; -+ } else { -+ pinfo->nxt_state = SAT_TABLE_TRY_FAIL; -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); -+ } -+ /*@}*/ -+ -+ phydm_update_pre_status(dm); -+ pinfo->pre_state = SAT_TABLE_TRAINING; -+} -+ -+void phydm_sat_table_try_fail( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ -+ /* @if pre_state = SAT_TABLE_TRAINING, "pre" adapt sat-table, "cur" adapt ori-table */ -+ /* @if pre_state = SAT_TABLE_TRY_FAIL, "pre" adapt ori-table, "cur" adapt ori-table */ -+ -+ if (phydm_is_large_var(dm)) { -+ if (phydm_is_snr_degrade(dm)) { -+ pinfo->nxt_state = SAT_TABLE_TRAINING; -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); -+ } else { -+ pinfo->nxt_state = SAT_TABLE_TRY_FAIL; -+ } -+ } else { -+ pinfo->nxt_state = ORI_TABLE_MONITOR; -+ } -+ phydm_update_pre_status(dm); -+ pinfo->pre_state = SAT_TABLE_TRY_FAIL; -+} -+ -+void phydm_sat_table_monitor( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ -+ if (phydm_is_snr_improve(dm)) { -+ pinfo->sat_table_monitor_times = 0; -+ -+ /* @if pre_state = SAT_TABLE_MONITOR, "pre" adapt sat-table, "cur" adapt sat-table */ -+ if (pinfo->pre_state == SAT_TABLE_MONITOR) { -+ pinfo->nxt_state = ORI_TABLE_TRAINING; -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); -+ //phydm_update_pre_status(dm); -+ } else { -+ pinfo->nxt_state = SAT_TABLE_MONITOR; -+ } -+ -+ /* @if pre_state = SAT_TABLE_TRAINING, "pre" adapt sat-table, "cur" adapt sat-table */ -+ /* @if pre_state = ORI_TABLE_TRAINING, "pre" adapt ori-table, "cur" adapt sat-table */ -+ /*pre_state above is no need to update*/ -+ } else { -+ if (pinfo->sat_table_monitor_times == pinfo->force_change_period) { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s: sat_table_monitor_times=%d\n", -+ __func__, pinfo->sat_table_monitor_times); -+ -+ pinfo->nxt_state = ORI_TABLE_TRAINING; -+ pinfo->sat_table_monitor_times = 0; -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); -+ } else { -+ pinfo->nxt_state = SAT_TABLE_MONITOR; -+ pinfo->sat_table_monitor_times++; -+ } -+ } -+ phydm_update_pre_status(dm); -+ pinfo->pre_state = SAT_TABLE_MONITOR; -+} -+ -+void phydm_ori_table_training( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ -+ /* pre_state = SAT_TABLE_MONITOR, "pre" adapt sat-table, "cur" adapt ori-table */ -+ -+ if (phydm_is_snr_degrade(dm) == FALSE) { -+ pinfo->nxt_state = ORI_TABLE_MONITOR; -+ } else { -+ if (pinfo->pre_snr_var == 0) -+ pinfo->nxt_state = ORI_TABLE_TRY_FAIL; -+ else -+ pinfo->nxt_state = SAT_TABLE_MONITOR; -+ -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); -+ } -+ phydm_update_pre_status(dm); -+ pinfo->pre_state = ORI_TABLE_TRAINING; -+} -+ -+void phydm_ori_table_try_fail( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ -+ if (pinfo->pre_state == ORI_TABLE_TRY_FAIL) { -+ if (phydm_is_snr_improve(dm)) { -+ pinfo->nxt_state = ORI_TABLE_TRAINING; -+ pinfo->ori_table_try_fail_times = 0; -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); -+ } else { -+ if (pinfo->ori_table_try_fail_times == pinfo->force_change_period) { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "%s: ori_table_try_fail_times=%d\n", __func__, pinfo->ori_table_try_fail_times); -+ -+ pinfo->nxt_state = ORI_TABLE_TRY_FAIL; -+ pinfo->ori_table_try_fail_times = 0; -+ phydm_update_pre_status(dm); -+ } else { -+ pinfo->nxt_state = ORI_TABLE_TRY_FAIL; -+ pinfo->ori_table_try_fail_times++; -+ phydm_update_pre_status(dm); -+ //config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); -+ } -+ } -+ } else { -+ pinfo->nxt_state = ORI_TABLE_TRY_FAIL; -+ pinfo->ori_table_try_fail_times = 0; -+ phydm_update_pre_status(dm); -+ //config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); -+ } -+ -+#if 0 -+ if (phydm_is_large_var(dm)) { -+ if (phydm_is_snr_degrade(dm)) { -+ pinfo->nxt_state = SAT_TABLE_TRAINING; -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); -+ } else { -+ pinfo->nxt_state = SAT_TABLE_TRY_FAIL; -+ } -+ } else { -+ pinfo->nxt_state = ORI_TABLE_MONITOR; -+ } -+ -+ phydm_update_pre_status(dm); -+#endif -+ pinfo->pre_state = ORI_TABLE_TRY_FAIL; -+} -+ -+char *phydm_lna_sat_state_msg( -+ void *dm_void, -+ IN u8 state) -+{ -+ char *dbg_message; -+ -+ switch (state) { -+ case ORI_TABLE_MONITOR: -+ dbg_message = "ORI_TABLE_MONITOR"; -+ break; -+ -+ case SAT_TABLE_TRAINING: -+ dbg_message = "SAT_TABLE_TRAINING"; -+ break; -+ -+ case SAT_TABLE_TRY_FAIL: -+ dbg_message = "SAT_TABLE_TRY_FAIL"; -+ break; -+ -+ case SAT_TABLE_MONITOR: -+ dbg_message = "SAT_TABLE_MONITOR"; -+ break; -+ -+ case ORI_TABLE_TRAINING: -+ dbg_message = "ORI_TABLE_TRAINING"; -+ break; -+ -+ case ORI_TABLE_TRY_FAIL: -+ dbg_message = "ORI_TABLE_TRY_FAIL"; -+ break; -+ -+ default: -+ dbg_message = "ORI_TABLE_MONITOR"; -+ break; -+ } -+ -+ return dbg_message; -+} -+ -+void phydm_lna_sat_type2_sm( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; -+ u8 state = pinfo->nxt_state; -+ u8 agc_tab = (u8)odm_get_bb_reg(dm, 0x958, 0x1f); -+ char *dbg_message, *nxt_dbg_message; -+ u8 real_shift = pinfo->total_bit_shift; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "\n\n%s ==>\n", __func__); -+ -+ if ((dm->support_ic_type & ODM_RTL8822B) == FALSE) { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "ODM_BB_LNA_SAT_CHK_TYPE2 only support 22B.\n"); -+ return; -+ } -+ -+ if ((dm->support_ability & ODM_BB_LNA_SAT_CHK) == FALSE) { -+ phydm_lna_sat_chk_type2_init(dm); -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "ODM_BB_LNA_SAT_CHK_TYPE2 is NOT supported, cur table=%d\n", agc_tab); -+ return; -+ } -+ -+ if (pinfo->is_snr_done) -+ phydm_snr_data_processing(dm); -+ else -+ return; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "cur agc table %d\n", agc_tab); -+ -+ if (pinfo->is_force_lna_sat_table != AUTO_AGC_TABLE) { -+ /*reset state machine*/ -+ pinfo->nxt_state = ORI_TABLE_MONITOR; -+ if (pinfo->is_snr_done) { -+ if (pinfo->is_force_lna_sat_table == DEFAULT_AGC_TABLE) -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); -+ else if (pinfo->is_force_lna_sat_table == LNA_SAT_AGC_TABLE) -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); -+ else -+ config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "%s: cur_mean=%d, pre_mean=%d, cur_var=%d, pre_var=%d,cur_lower_mean=%d, pre_lower_mean=%d, cnt_lower_snr=%d\n", -+ __func__, -+ pinfo->cur_snr_mean, -+ pinfo->pre_snr_mean, -+ pinfo->cur_snr_var, -+ pinfo->pre_snr_var, -+ pinfo->cur_lower_snr_mean, -+ pinfo->pre_lower_snr_mean, -+ pinfo->cnt_lower_snr_statistic); -+ -+ pinfo->is_snr_done = FALSE; -+ pinfo->is_sm_done = TRUE; -+ phydm_update_pre_status(dm); -+ } else { -+ return; -+ } -+ } else if (pinfo->is_snr_done) { -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "%s: cur_mean=%d, pre_mean=%d, cur_var=%d, pre_var=%d,cur_lower_mean=%d, pre_lower_mean=%d, cnt_lower_snr=%d\n", -+ __func__, -+ pinfo->cur_snr_mean, -+ pinfo->pre_snr_mean, -+ pinfo->cur_snr_var, -+ pinfo->pre_snr_var, -+ pinfo->cur_lower_snr_mean, -+ pinfo->pre_lower_snr_mean, -+ pinfo->cnt_lower_snr_statistic); -+ -+ switch (state) { -+ case ORI_TABLE_MONITOR: -+ dbg_message = "ORI_TABLE_MONITOR"; -+ phydm_ori_table_monitor(dm); -+ break; -+ -+ case SAT_TABLE_TRAINING: -+ dbg_message = "SAT_TABLE_TRAINING"; -+ phydm_sat_table_training(dm); -+ break; -+ -+ case SAT_TABLE_TRY_FAIL: -+ dbg_message = "SAT_TABLE_TRY_FAIL"; -+ phydm_sat_table_try_fail(dm); -+ break; -+ -+ case SAT_TABLE_MONITOR: -+ dbg_message = "SAT_TABLE_MONITOR"; -+ phydm_sat_table_monitor(dm); -+ break; -+ -+ case ORI_TABLE_TRAINING: -+ dbg_message = "ORI_TABLE_TRAINING"; -+ phydm_ori_table_training(dm); -+ break; -+ -+ case ORI_TABLE_TRY_FAIL: -+ dbg_message = "ORI_TABLE_TRAINING"; -+ phydm_ori_table_try_fail(dm); -+ break; -+ -+ default: -+ dbg_message = "ORI_TABLE_MONITOR"; -+ phydm_ori_table_monitor(dm); -+ break; -+ } -+ -+ dbg_message = phydm_lna_sat_state_msg(dm, state); -+ nxt_dbg_message = phydm_lna_sat_state_msg(dm, pinfo->nxt_state); -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "state: [%s]->[%s]\n", -+ dbg_message, nxt_dbg_message); -+ -+ pinfo->is_snr_done = FALSE; -+ pinfo->is_sm_done = TRUE; -+ pinfo->total_cnt_snr = 1 << real_shift; -+ -+ } else { -+ return; -+ } -+} -+#endif /*@#ifdef PHYDM_LNA_SAT_CHK_TYPE2*/ -+ -+#ifdef PHYDM_HW_SWITCH_AGC_TAB -+u32 phydm_get_lna_pd_reg(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 rf_pd_reg = RF_0x8b; -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (*dm->channel <= 14) -+ rf_pd_reg = RF_0x87; -+ else -+ rf_pd_reg = RF_0x8b; -+ } -+#endif -+ return rf_pd_reg; -+} -+ -+u32 phydm_get_lna_pd_en_mask(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 rf_pd_en_msk = BIT(2); -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (*dm->channel <= 14) -+ rf_pd_en_msk = BIT(4); -+ else -+ rf_pd_en_msk = BIT(2); -+ } -+#endif -+ return rf_pd_en_msk; -+} -+ -+boolean phydm_get_lna_pd_en(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 rf_pd_reg = RF_0x8b; -+ u32 rf_pd_en_msk = BIT(2); -+ u32 pd_en = 0; -+ -+ rf_pd_reg = phydm_get_lna_pd_reg(dm); -+ rf_pd_en_msk = phydm_get_lna_pd_en_mask(dm); -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ pd_en = config_phydm_read_rf_reg_8814b(dm, RF_PATH_A, -+ rf_pd_reg, -+ rf_pd_en_msk); -+#endif -+ return (boolean)pd_en; -+} -+ -+void phydm_set_lna_pd_en(void *dm_void, boolean lna_pd_en) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ enum rf_path i = RF_PATH_A; -+ u32 rf_pd_reg = RF_0x8b; -+ u32 rf_pd_en_msk = BIT(2); -+ -+ rf_pd_reg = phydm_get_lna_pd_reg(dm); -+ rf_pd_en_msk = phydm_get_lna_pd_en_mask(dm); -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ for (i = RF_PATH_A; i < MAX_PATH_NUM_8814B; i++) -+ config_phydm_write_rf_reg_8814b(dm, i, -+ rf_pd_reg, -+ rf_pd_en_msk, -+ (u8)lna_pd_en); -+#endif -+} -+ -+u32 phydm_get_lna_pd_th_mask(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 rf_pd_th_msk = 0x3; -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ rf_pd_th_msk = 0x3; -+#endif -+ return rf_pd_th_msk; -+} -+ -+enum lna_pd_th_level phydm_get_lna_pd_th_lv(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 rf_pd_reg = RF_0x8b; -+ u32 rf_pd_th_msk = 0x3; -+ u32 pd_th_lv = 0x0; -+ -+ rf_pd_reg = phydm_get_lna_pd_reg(dm); -+ rf_pd_th_msk = phydm_get_lna_pd_th_mask(dm); -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ pd_th_lv = config_phydm_read_rf_reg_8814b(dm, RF_PATH_A, -+ rf_pd_reg, -+ rf_pd_th_msk); -+#endif -+ return (enum lna_pd_th_level)pd_th_lv; -+} -+ -+void phydm_set_lna_pd_th_lv(void *dm_void, -+ enum lna_pd_th_level lna_pd_th_lv) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ enum rf_path i = RF_PATH_A; -+ u32 rf_pd_reg = RF_0x8b; -+ u32 rf_pd_th_msk = 0x3; -+ -+ rf_pd_reg = phydm_get_lna_pd_reg(dm); -+ rf_pd_th_msk = phydm_get_lna_pd_th_mask(dm); -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ for (i = RF_PATH_A; i < MAX_PATH_NUM_8814B; i++) -+ config_phydm_write_rf_reg_8814b(dm, i, -+ rf_pd_reg, -+ rf_pd_th_msk, -+ lna_pd_th_lv); -+#endif -+} -+ -+u32 phydm_get_sat_agc_tab_version(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ return odm_get_version_mp_8814b_extra_agc_tab(); -+#endif -+#if (RTL8814C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ return odm_get_version_mp_8814c_extra_agc_tab(); -+#endif -+ return 0; -+} -+ -+boolean phydm_get_auto_agc_config(void *dm_void, -+ enum agc_tab_switch_state state_sel) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 state_en = 0; -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ switch (state_sel) { -+ case AGC_SWH_IDLE: -+ state_en = odm_get_bb_reg(dm, R_0x18ac, BIT(16)); -+ break; -+ case AGC_SWH_OFDM: -+ state_en = odm_get_bb_reg(dm, R_0x18ac, BIT(17)); -+ break; -+ case AGC_SWH_CCK: -+ state_en = odm_get_bb_reg(dm, R_0x18ac, BIT(18)); -+ break; -+ default: -+ state_en = 0; -+ break; -+ } -+#endif -+ return (boolean)state_en; -+} -+ -+boolean phydm_is_auto_agc_on(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean state_on = false; -+ -+ state_on = ((phydm_get_auto_agc_config(dm, AGC_SWH_IDLE) || -+ phydm_get_auto_agc_config(dm, AGC_SWH_CCK) || -+ phydm_get_auto_agc_config(dm, AGC_SWH_OFDM)) && -+ phydm_get_lna_pd_en(dm)); -+ -+ return state_on; -+} -+ -+void phydm_config_auto_agc(void *dm_void, -+ boolean idle_en, -+ boolean cck_cca_en, -+ boolean ofdm_cca_en) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 hwagc_opt = 0; -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (!(dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C))) -+ return; -+ -+ if (idle_en) -+ hwagc_opt |= BIT(0); -+ else -+ hwagc_opt &= ~BIT(0); -+ if (ofdm_cca_en) -+ hwagc_opt |= BIT(1); -+ else -+ hwagc_opt &= ~BIT(1); -+ if (cck_cca_en) -+ hwagc_opt |= BIT(2); -+ else -+ hwagc_opt &= ~BIT(2); -+ -+ odm_set_bb_reg(dm, R_0x18ac, BIT(18) | BIT(17) | BIT(16), hwagc_opt); -+#ifdef PHYDM_COMPILE_ABOVE_2SS -+ odm_set_bb_reg(dm, R_0x41ac, BIT(18) | BIT(17) | BIT(16), hwagc_opt); -+#endif -+#ifdef PHYDM_COMPILE_ABOVE_3SS -+ odm_set_bb_reg(dm, R_0x52ac, BIT(18) | BIT(17) | BIT(16), hwagc_opt); -+#endif -+#ifdef PHYDM_COMPILE_ABOVE_4SS -+ odm_set_bb_reg(dm, R_0x53ac, BIT(18) | BIT(17) | BIT(16), hwagc_opt); -+#endif -+#endif -+} -+ -+void phydm_auto_agc_tab_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ phydm_set_lna_pd_th_lv(dm, 0x0); -+ phydm_config_auto_agc(dm, true, false, true); -+ phydm_set_lna_pd_en(dm, true); -+} -+ -+void phydm_auto_agc_tab_off(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ phydm_config_auto_agc(dm, false, false, false); -+ phydm_set_lna_pd_en(dm, false); -+} -+ -+void phydm_switch_sat_agc_by_band(void *dm_void, enum odm_rf_band band) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8814B) -+ odm_config_mp_8814b_extra_agc_tab(dm, band); -+#endif -+#if (RTL8814C_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8814C) -+ odm_config_mp_8814c_extra_agc_tab(dm, band); -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ pr_debug("%s ==> switch to band%d\n", __func__, band); -+#else -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==> switch to band%d\n", -+ __func__, band); -+#endif -+} -+ -+void phydm_auto_agc_tab_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_sat = &dm->dm_lna_sat_info; -+ u8 channel = *dm->channel; -+ -+ lna_sat->cur_rf_band = phydm_ch_to_rf_band(dm, channel); -+ phydm_switch_sat_agc_by_band(dm, lna_sat->cur_rf_band); -+ -+ if ((dm->support_ability & ODM_BB_LNA_SAT_CHK)) { -+ phydm_auto_agc_tab_reset(dm); -+ lna_sat->hw_swh_tab_on = true; -+ } else { -+ phydm_auto_agc_tab_off(dm); -+ lna_sat->hw_swh_tab_on = false; -+ } -+} -+ -+void phydm_auto_agc_tab_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_sat = &dm->dm_lna_sat_info; -+ boolean hw_swh_on = false; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); -+ -+ if (!(dm->support_ability & ODM_BB_LNA_SAT_CHK)) { -+ if (lna_sat->hw_swh_tab_on) { -+ phydm_auto_agc_tab_off(dm); -+ lna_sat->hw_swh_tab_on = false; -+ } -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "Disabled LNA sat. check\n"); -+ return; -+ } -+ -+ if (!lna_sat->hw_swh_tab_on) -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, -+ "[WARNING] HW switch AGC Tab not fully enabled\n"); -+} -+ -+void phydm_auto_agc_tab_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_sat = &dm->dm_lna_sat_info; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i; -+ u8 agc_tab = 0; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "LNA sat. AGC Tab version : %d\n", -+ phydm_get_sat_agc_tab_version(dm)); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Enable LNA peak detector : {0} {lna_pd_en = %d}\n", -+ phydm_get_lna_pd_en(dm)); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set LNA peak detector lv : {1} {lna_pd_th_lv = %d}\n", -+ phydm_get_lna_pd_th_lv(dm)); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Config hw switch AGC tab : {2} {hw_swh_en_rx_idle} {hw_swh_en_cck_cca} {hw_swh_en_ofdm_cca} = (%d, %d, %d)\n", -+ phydm_get_auto_agc_config(dm, AGC_SWH_IDLE), -+ phydm_get_auto_agc_config(dm, AGC_SWH_CCK), -+ phydm_get_auto_agc_config(dm, AGC_SWH_OFDM)); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Reset to default setting : {3}\n", -+ phydm_get_auto_agc_config(dm, AGC_SWH_IDLE), -+ phydm_get_auto_agc_config(dm, AGC_SWH_CCK), -+ phydm_get_auto_agc_config(dm, AGC_SWH_OFDM)); -+ -+ } else { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ for (i = 1; i < 10; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var1[i]); -+ } -+ -+ if (var1[0] == 0) { -+ phydm_set_lna_pd_en(dm, (boolean)var1[1]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "set lna_pd_en = %d\n", -+ (u8)phydm_get_lna_pd_en(dm)); -+ } else if (var1[0] == 1) { -+ phydm_set_lna_pd_th_lv(dm, (u8)var1[1]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "set lna_pd_th_lv = %d\n", -+ phydm_get_lna_pd_th_lv(dm)); -+ } else if (var1[0] == 2) { -+ phydm_config_auto_agc(dm, (boolean)var1[1], -+ (boolean)var1[2], -+ (boolean)var1[3]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "set hw switch agc tab en: (rx_idle, cck_cca, ofdm_cca) = (%d, %d, %d)\n", -+ phydm_get_auto_agc_config(dm, AGC_SWH_IDLE), -+ phydm_get_auto_agc_config(dm, AGC_SWH_CCK), -+ phydm_get_auto_agc_config(dm, AGC_SWH_OFDM)); -+ } else if (var1[0] == 3) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "reset to default settings\n"); -+ phydm_auto_agc_tab_reset(dm); -+ } -+ lna_sat->hw_swh_tab_on = phydm_is_auto_agc_on(dm); -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif /*@#ifdef PHYDM_HW_SWITCH_AGC_TAB*/ -+ -+void phydm_lna_sat_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_t = &dm->dm_lna_sat_info; -+ char help[] = "-h"; -+ char monitor[] = "-m"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i; -+ u8 agc_tab = 0; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "monitor: -m\n"); -+ #ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{0} {lna_sat_chk_en}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{1} {agc_table_switch_en}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{2} {chk_cnt per callback}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{3} {chk_period(ms)}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{4} {chk_duty_cycle(%)}\n"); -+ #endif -+ } else if ((strcmp(input[1], monitor) == 0)) { -+#ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+ #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+ if (dm->support_ic_type & -+ (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C)) -+ agc_tab = phydm_get_ofdm_agc_tab_path(dm, RF_PATH_A); -+ else -+ #endif -+ agc_tab = phydm_get_ofdm_agc_tab(dm); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "%s%d, %s%d, %s%d, %s%d\n", -+ "check_time = ", lna_t->check_time, -+ "pre_sat_status = ", lna_t->pre_sat_status, -+ "cur_sat_status = ", lna_t->cur_sat_status, -+ "current AGC tab = ", agc_tab); -+#endif -+ } else { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ for (i = 1; i < 10; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var1[i]); -+ } -+ #ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+ if (var1[0] == 0) { -+ if (var1[1] == 1) -+ lna_t->is_disable_lna_sat_chk = false; -+ else if (var1[1] == 0) -+ lna_t->is_disable_lna_sat_chk = true; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "dis_lna_sat_chk=%d\n", -+ lna_t->is_disable_lna_sat_chk); -+ } else if (var1[0] == 1) { -+ if (var1[1] == 1) -+ lna_t->dis_agc_table_swh = false; -+ else if (var1[1] == 0) -+ lna_t->dis_agc_table_swh = true; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "dis_agc_table_swh=%d\n", -+ lna_t->dis_agc_table_swh); -+ -+ } else if (var1[0] == 2) { -+ lna_t->chk_cnt = (u8)var1[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "chk_cnt=%d\n", lna_t->chk_cnt); -+ } else if (var1[0] == 3) { -+ lna_t->chk_period = var1[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "chk_period=%d\n", lna_t->chk_period); -+ } else if (var1[0] == 4) { -+ lna_t->chk_duty_cycle = (u8)var1[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "chk_duty_cycle=%d\n", -+ lna_t->chk_duty_cycle); -+ } -+ #endif -+ #ifdef PHYDM_LNA_SAT_CHK_TYPE2 -+ if (var1[0] == 1) -+ lna_t->force_traget_macid = var1[1]; -+ #endif -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_lna_sat_chk_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_sat = &dm->dm_lna_sat_info; -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); -+ -+ if (lna_sat->lna_sat_type == LNA_SAT_WITH_PEAK_DET) { -+ #ifdef PHYDM_HW_SWITCH_AGC_TAB -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ phydm_auto_agc_tab_watchdog(dm); -+ return; -+ } -+ #endif -+ #ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+ if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8198F | -+ ODM_RTL8814B | ODM_RTL8814C)) { -+ phydm_lna_sat_chk_watchdog_type1(dm); -+ return; -+ } -+ #endif -+ } else if (lna_sat->lna_sat_type == LNA_SAT_WITH_TRAIN) { -+ #ifdef PHYDM_LNA_SAT_CHK_TYPE2 -+ return; -+ #endif -+ } -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "support_ic_type match fail, return\n"); -+} -+ -+void phydm_lna_sat_config(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_sat = &dm->dm_lna_sat_info; -+ -+ lna_sat->lna_sat_type = 0; -+ #if (RTL8822B_SUPPORT == 1) -+ if (dm->support_ic_type & (ODM_RTL8822B)) -+ lna_sat->lna_sat_type = LNA_SAT_WITH_TRAIN; -+ #endif -+ -+ #if (RTL8197F_SUPPORT || RTL8192F_SUPPORT || \ -+ RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F | -+ ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C)) -+ lna_sat->lna_sat_type = LNA_SAT_WITH_PEAK_DET; -+ #endif -+ -+ PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "[%s] lna_sat_type=%d\n", -+ __func__, lna_sat->lna_sat_type); -+} -+ -+void phydm_lna_sat_check_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_lna_sat_t *lna_sat = &dm->dm_lna_sat_info; -+ -+ /*@2018.04.17 Johnson*/ -+ phydm_lna_sat_config(dm); -+ #ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+ lna_sat->chk_period = LNA_CHK_PERIOD; -+ lna_sat->chk_cnt = LNA_CHK_CNT; -+ lna_sat->chk_duty_cycle = LNA_CHK_DUTY_CYCLE; -+ lna_sat->dis_agc_table_swh = false; -+ #endif -+ /*@2018.04.17 Johnson end*/ -+ -+ if (lna_sat->lna_sat_type == LNA_SAT_WITH_PEAK_DET) { -+ #ifdef PHYDM_HW_SWITCH_AGC_TAB -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ phydm_auto_agc_tab_init(dm); -+ return; -+ } -+ #endif -+ #ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+ phydm_lna_sat_chk_init(dm); -+ #endif -+ } else if (lna_sat->lna_sat_type == LNA_SAT_WITH_TRAIN) { -+ #ifdef PHYDM_LNA_SAT_CHK_TYPE2 -+ phydm_lna_sat_chk_type2_init(dm); -+ #endif -+ } -+} -+ -+#endif /*@#ifdef PHYDM_LNA_SAT_CHK_SUPPORT*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_lna_sat.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_lna_sat.h -new file mode 100644 -index 000000000..69a934996 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_lna_sat.h -@@ -0,0 +1,196 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_LNA_SAT_H__ -+#define __PHYDM_LNA_SAT_H__ -+#ifdef PHYDM_LNA_SAT_CHK_SUPPORT -+/* @1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+ -+#define LNA_SAT_VERSION "1.1" -+ -+/*@LNA saturation check*/ -+#define OFDM_AGC_TAB_0 0 -+#define OFDM_AGC_TAB_2 2 -+ -+#define DIFF_RSSI_TO_IGI 10 -+#define ONE_SEC_MS 1000 -+ -+#define LNA_CHK_PERIOD 100 /*@ms*/ -+#define LNA_CHK_CNT 10 /*@checks per callback*/ -+#define LNA_CHK_DUTY_CYCLE 5 /*@percentage*/ -+ -+#define DELTA_STD 2 -+#define DELTA_MEAN 2 -+#define SNR_STATISTIC_SHIFT 8 -+#define SNR_RPT_MAX 256 -+ -+/* @1 ============================================================ -+ * 1 enumrate -+ * 1 ============================================================ -+ */ -+ -+enum lna_sat_timer_state { -+ INIT_LNA_SAT_CHK_TIMMER, -+ CANCEL_LNA_SAT_CHK_TIMMER, -+ RELEASE_LNA_SAT_CHK_TIMMER -+}; -+ -+#ifdef PHYDM_LNA_SAT_CHK_TYPE2 -+enum lna_sat_chk_type2_status { -+ ORI_TABLE_MONITOR, -+ ORI_TABLE_TRAINING, -+ SAT_TABLE_MONITOR, -+ SAT_TABLE_TRAINING, -+ SAT_TABLE_TRY_FAIL, -+ ORI_TABLE_TRY_FAIL -+}; -+ -+#endif -+ -+enum lna_sat_type { -+ LNA_SAT_WITH_PEAK_DET = 1, /*type1*/ -+ LNA_SAT_WITH_TRAIN = 2, /*type2*/ -+}; -+ -+#ifdef PHYDM_HW_SWITCH_AGC_TAB -+enum lna_pd_th_level { -+ LNA_PD_TH_LEVEL0 = 0, -+ LNA_PD_TH_LEVEL1 = 1, -+ LNA_PD_TH_LEVEL2 = 2, -+ LNA_PD_TH_LEVEL3 = 3 -+}; -+ -+enum agc_tab_switch_state { -+ AGC_SWH_IDLE, -+ AGC_SWH_CCK, -+ AGC_SWH_OFDM -+}; -+#endif -+ -+/* @1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+ -+struct phydm_lna_sat_t { -+#ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+ u8 chk_cnt; -+ u8 chk_duty_cycle; -+ u32 chk_period;/*@ms*/ -+ boolean is_disable_lna_sat_chk; -+ boolean dis_agc_table_swh; -+#endif -+#ifdef PHYDM_LNA_SAT_CHK_TYPE2 -+ u8 force_traget_macid; -+ u32 snr_var_thd; -+ u32 delta_snr_mean; -+ u16 ori_table_try_fail_times; -+ u16 cnt_lower_snr_statistic; -+ u16 sat_table_monitor_times; -+ u16 force_change_period; -+ u8 is_snr_detail_en; -+ u8 is_force_lna_sat_table; -+ u8 lwr_snr_ratio_bit_shift; -+ u8 cnt_snr_statistic; -+ u16 snr_statistic_sqr[SNR_RPT_MAX]; -+ u8 snr_statistic[SNR_RPT_MAX]; -+ u8 is_sm_done; -+ u8 is_snr_done; -+ u32 cur_snr_var; -+ u8 total_bit_shift; -+ u8 total_cnt_snr; -+ u32 cur_snr_mean; -+ u8 cur_snr_var0; -+ u32 cur_lower_snr_mean; -+ u32 pre_snr_mean; -+ u32 pre_snr_var; -+ u32 pre_lower_snr_mean; -+ u8 nxt_state; -+ u8 pre_state; -+#endif -+ enum lna_sat_type lna_sat_type; -+ u32 sat_cnt_acc_patha; -+ u32 sat_cnt_acc_pathb; -+#ifdef PHYDM_IC_ABOVE_3SS -+ u32 sat_cnt_acc_pathc; -+#endif -+#ifdef PHYDM_IC_ABOVE_4SS -+ u32 sat_cnt_acc_pathd; -+#endif -+ u32 check_time; -+ boolean pre_sat_status; -+ boolean cur_sat_status; -+#ifdef PHYDM_HW_SWITCH_AGC_TAB -+ boolean hw_swh_tab_on; -+ enum odm_rf_band cur_rf_band; -+#endif -+ struct phydm_timer_list phydm_lna_sat_chk_timer; -+ u32 cur_timer_check_cnt; -+ u32 pre_timer_check_cnt; -+}; -+ -+/* @1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ */ -+void phydm_lna_sat_chk_init(void *dm_void); -+ -+u8 phydm_get_ofdm_agc_tab(void *dm_void); -+ -+void phydm_lna_sat_chk(void *dm_void); -+ -+void phydm_lna_sat_chk_timers(void *dm_void, u8 state); -+ -+#ifdef PHYDM_LNA_SAT_CHK_TYPE1 -+#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) -+void phydm_lna_sat_chk_bb_init(void *dm_void); -+ -+void phydm_set_ofdm_agc_tab_path(void *dm_void, -+ u8 tab_sel, enum rf_path path); -+ -+u8 phydm_get_ofdm_agc_tab_path(void *dm_void, enum rf_path path); -+#endif /*@#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT)*/ -+#endif -+ -+#ifdef PHYDM_LNA_SAT_CHK_TYPE2 -+void phydm_parsing_snr(void *dm_void, void *pktinfo_void, s8 *rx_snr); -+#endif -+ -+void phydm_lna_sat_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void phydm_lna_sat_chk_watchdog(void *dm_void); -+ -+void phydm_lna_sat_check_init(void *dm_void); -+ -+#ifdef PHYDM_HW_SWITCH_AGC_TAB -+void phydm_auto_agc_tab_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#endif -+#endif /*@#if (PHYDM_LNA_SAT_CHK_SUPPORT == 1)*/ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_math_lib.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_math_lib.c -new file mode 100644 -index 000000000..c6c1035af ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_math_lib.c -@@ -0,0 +1,290 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+const u32 db_invert_table[12][8] = { -+ {10, 13, 16, 20, 25, 32, 40, 50}, /* @U(32,3) */ -+ {64, 80, 101, 128, 160, 201, 256, 318}, /* @U(32,3) */ -+ {401, 505, 635, 800, 1007, 1268, 1596, 2010}, /* @U(32,3) */ -+ {316, 398, 501, 631, 794, 1000, 1259, 1585}, /* @U(32,0) */ -+ {1995, 2512, 3162, 3981, 5012, 6310, 7943, 10000}, /* @U(32,0) */ -+ {12589, 15849, 19953, 25119, 31623, 39811, 50119, 63098}, /* @U(32,0) */ -+ {79433, 100000, 125893, 158489, 199526, 251189, 316228, -+ 398107}, /* @U(32,0) */ -+ {501187, 630957, 794328, 1000000, 1258925, 1584893, 1995262, -+ 2511886}, /* @U(32,0) */ -+ {3162278, 3981072, 5011872, 6309573, 7943282, 1000000, 12589254, -+ 15848932}, /* @U(32,0) */ -+ {19952623, 25118864, 31622777, 39810717, 50118723, 63095734, -+ 79432823, 100000000}, /* @U(32,0) */ -+ {125892541, 158489319, 199526232, 251188643, 316227766, 398107171, -+ 501187234, 630957345}, /* @U(32,0) */ -+ {794328235, 1000000000, 1258925412, 1584893192, 1995262315, -+ 2511886432U, 3162277660U, 3981071706U} }; /* @U(32,0) */ -+ -+/*Y = 10*log(X)*/ -+s32 odm_pwdb_conversion(s32 X, u32 total_bit, u32 decimal_bit) -+{ -+ s32 Y, integer = 0, decimal = 0; -+ u32 i; -+ -+ if (X == 0) -+ X = 1; /* @log2(x), x can't be 0 */ -+ -+ for (i = (total_bit - 1); i > 0; i--) { -+ if (X & BIT(i)) { -+ integer = i; -+ if (i > 0) { -+ /*decimal is 0.5dB*3=1.5dB~=2dB */ -+ decimal = (X & BIT(i - 1)) ? 2 : 0; -+ } -+ break; -+ } -+ } -+ -+ Y = 3 * (integer - decimal_bit) + decimal; /* @10*log(x)=3*log2(x), */ -+ -+ return Y; -+} -+ -+s32 odm_sign_conversion(s32 value, u32 total_bit) -+{ -+ if (value & BIT(total_bit - 1)) -+ value -= BIT(total_bit); -+ -+ return value; -+} -+ -+/*threshold must form low to high*/ -+u16 phydm_find_intrvl(void *dm_void, u16 val, u16 *threshold, u16 th_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 i = 0; -+ u16 ret_val = 0; -+ u16 max_th = threshold[th_len - 1]; -+ -+ for (i = 0; i < th_len; i++) { -+ if (val < threshold[i]) { -+ ret_val = i; -+ break; -+ } else if (val >= max_th) { -+ ret_val = th_len; -+ break; -+ } -+ } -+ -+ return ret_val; -+} -+ -+void phydm_seq_sorting(void *dm_void, u32 *value, u32 *rank_idx, u32 *idx_out, -+ u8 seq_length) -+{ -+ u8 i = 0, j = 0; -+ u32 tmp_a, tmp_b; -+ u32 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 = value[j]; -+ tmp_b = value[j + 1]; -+ -+ tmp_idx_a = rank_idx[j]; -+ tmp_idx_b = rank_idx[j + 1]; -+ -+ if (tmp_a < tmp_b) { -+ value[j] = tmp_b; -+ 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++) -+ idx_out[rank_idx[i]] = i + 1; -+} -+ -+u32 odm_convert_to_db(u64 value) -+{ -+ u8 i; -+ u8 j; -+ u32 dB; -+ -+ if (value >= db_invert_table[11][7]) -+ return 96; /* @maximum 96 dB */ -+ -+ for (i = 0; i < 12; i++) { -+ if (i <= 2 && (value << FRAC_BITS) <= db_invert_table[i][7]) -+ break; -+ else if (i > 2 && value <= db_invert_table[i][7]) -+ break; -+ } -+ -+ for (j = 0; j < 8; j++) { -+ if (i <= 2 && (value << FRAC_BITS) <= db_invert_table[i][j]) -+ break; -+ else if (i > 2 && i < 12 && value <= db_invert_table[i][j]) -+ break; -+ } -+ -+ /*special cases*/ -+ if (j == 0 && i == 0) -+ goto end; -+ -+ if (i == 3 && j == 0) { -+ if (db_invert_table[3][0] - value > -+ value - (db_invert_table[2][7] >> FRAC_BITS)) { -+ i = 2; -+ j = 7; -+ } -+ goto end; -+ } -+ -+ if (i < 3) -+ value = value << FRAC_BITS; /*@elements of row 0~2 shift left*/ -+ -+ /*compare difference to get precise dB*/ -+ if (j == 0) { -+ if (db_invert_table[i][j] - value > -+ value - db_invert_table[i - 1][7]) { -+ i = i - 1; -+ j = 7; -+ } -+ } else { -+ if (db_invert_table[i][j] - value > -+ value - db_invert_table[i][j - 1]) { -+ j = j - 1; -+ } -+ } -+end: -+ dB = (i << 3) + j + 1; -+ -+ return dB; -+} -+ -+u64 phydm_db_2_linear(u32 value) -+{ -+ u8 i = 0; -+ u8 j = 0; -+ u64 linear = 0; -+ -+ value = value & 0xFF; -+ -+ /* @1dB~96dB */ -+ if (value > 96) { -+ value = 96; -+ } else if (value < 1) { -+ linear = 1; -+ return linear; -+ } -+ -+ i = (u8)((value - 1) >> 3); -+ j = (u8)(value - 1) - (i << 3); -+ -+ linear = db_invert_table[i][j]; -+ -+ if (i > 2) -+ linear = linear << FRAC_BITS; -+ -+ return linear; -+} -+ -+u16 phydm_show_fraction_num(u32 frac_val, u8 bit_num) -+{ -+ u8 i = 0; -+ u16 val = 0; -+ u16 base = 5000; -+ -+ for (i = bit_num; i > 0; i--) { -+ if (frac_val & BIT(i - 1)) -+ val += (base >> (bit_num - i)); -+ } -+ return val; -+} -+ -+u16 phydm_ones_num_in_bitmap(u64 val, u8 size) -+{ -+ u8 i = 0; -+ u8 ones_num = 0; -+ -+ for (i = 0; i < size; i++) { -+ if (val & BIT(0)) -+ ones_num++; -+ -+ val = val >> 1; -+ } -+ -+ return ones_num; -+} -+ -+u64 phydm_gen_bitmask(u8 mask_num) -+{ -+ u8 i = 0; -+ u64 bitmask = 0; -+ -+ if (mask_num > 64) -+ return 1; -+ -+ for (i = 0; i < mask_num; i++) -+ bitmask = (bitmask << 1) | BIT(0); -+ -+ return bitmask; -+} -+ -+s32 phydm_cnvrt_2_sign(u32 val, u8 bit_num) -+{ -+ if (bit_num >= 32) -+ return (s32)val; -+ -+ if (val & BIT(bit_num - 1)) /*Sign BIT*/ -+ val -= (1 << bit_num); /*@2's*/ -+ -+ return val; -+} -+ -+s64 phydm_cnvrt_2_sign_64(u64 val, u8 bit_num) -+{ -+ u64 one = 1; -+ s64 val_sign = (s64)val; -+ -+ if (bit_num >= 64) -+ return (s64)val; -+ -+ if (val & (one << (bit_num - 1))) /*Sign BIT*/ -+ val_sign = val - (one << bit_num); /*@2's*/ -+ -+ return val_sign; -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_math_lib.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_math_lib.h -new file mode 100644 -index 000000000..a96ae5ee4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_math_lib.h -@@ -0,0 +1,120 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_MATH_LIB_H__ -+#define __PHYDM_MATH_LIB_H__ -+ -+/* @2019.01.24 remove linear2db debug log*/ -+#define AUTO_MATH_LIB_VERSION "1.2" -+ -+/*@ -+ * 1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+ -+#define PHYDM_DIV(a, b) ((b) ? ((a) / (b)) : 0) -+#define DIVIDED_2(X) ((X) >> 1) -+/*@1/3 ~ 11/32*/ -+#if defined(DM_ODM_CE_MAC80211) -+#define DIVIDED_3(X) ({ \ -+ u32 div_3_tmp = (X); \ -+ (((div_3_tmp) + ((div_3_tmp) << 1) + ((div_3_tmp) << 3)) >> 5); }) -+#else -+#define DIVIDED_3(X) (((X) + ((X) << 1) + ((X) << 3)) >> 5) -+#endif -+#define DIVIDED_4(X) ((X) >> 2) -+ -+/*Store Ori Value*/ -+#if defined(DM_ODM_CE_MAC80211) -+#define WEIGHTING_AVG(v1, w1, v2, w2) \ -+ __WEIGHTING_AVG(v1, w1, v2, w2, typeof(v1), typeof(w1), typeof(v2), \ -+ typeof(w2)) -+#define __WEIGHTING_AVG(v1, w1, v2, w2, t1, t2, t3, t4) ({ \ -+ t1 __w_a_v1 = (v1); \ -+ t2 __w_a_w1 = (w1); \ -+ t3 __w_a_v2 = (v2); \ -+ t4 __w_a_w2 = (w2); \ -+ ((__w_a_v1) * (__w_a_w1) + (__w_a_v2) * (__w_a_w2)) \ -+ / ((__w_a_w2) + (__w_a_w1)); }) -+#else -+#define WEIGHTING_AVG(v1, w1, v2, w2) \ -+ (((v1) * (w1) + (v2) * (w2)) / ((w2) + (w1))) -+#endif -+ -+/*Store 2^ma x Value*/ -+#if defined(DM_ODM_CE_MAC80211) -+#define MA_ACC(old, new_val, ma) ({ \ -+ s16 __ma_acc_o = (old); \ -+ (__ma_acc_o) - ((__ma_acc_o) >> (ma)) + (new_val); }) -+#define GET_MA_VAL(val, ma) ({ \ -+ s16 __get_ma_tmp = (ma);\ -+ ((val) + (1 << ((__get_ma_tmp) - 1))) >> (__get_ma_tmp); }) -+#else -+#define MA_ACC(old, new_val, ma) ((old) - ((old) >> (ma)) + (new_val)) -+#define GET_MA_VAL(val, ma) (((val) + (1 << ((ma) - 1))) >> (ma)) -+#endif -+#define FRAC_BITS 3 -+/*@ -+ * 1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ */ -+ -+/*@ -+ * 1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+ -+/*@ -+ * 1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ */ -+ -+s32 odm_pwdb_conversion(s32 X, u32 total_bit, u32 decimal_bit); -+ -+s32 odm_sign_conversion(s32 value, u32 total_bit); -+ -+u16 phydm_find_intrvl(void *dm_void, u16 val, u16 *threshold, u16 th_len); -+ -+void phydm_seq_sorting(void *dm_void, u32 *value, u32 *rank_idx, u32 *idx_out, -+ u8 seq_length); -+ -+u32 odm_convert_to_db(u64 value); -+ -+u64 phydm_db_2_linear(u32 value); -+ -+u16 phydm_show_fraction_num(u32 frac_val, u8 bit_num); -+ -+u16 phydm_ones_num_in_bitmap(u64 val, u8 size); -+ -+u64 phydm_gen_bitmask(u8 mask_num); -+ -+s32 phydm_cnvrt_2_sign(u32 val, u8 bit_num); -+ -+s64 phydm_cnvrt_2_sign_64(u64 val, u8 bit_num); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_mp.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_mp.c -new file mode 100644 -index 000000000..85989133b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_mp.c -@@ -0,0 +1,427 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef PHYDM_MP_SUPPORT -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ -+void phydm_mp_set_single_tone_jgr3(void *dm_void, boolean is_single_tone, -+ u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_mp *mp = &dm->dm_mp_table; -+ u8 start = RF_PATH_A, end = RF_PATH_A; -+ u8 i = 0; -+ u8 max_rf_path = RF_PATH_A; -+ u8 central_ch = 0; -+ boolean is_2g_ch = false; -+ -+ switch (path) { -+ case RF_PATH_A: -+ case RF_PATH_B: -+ case RF_PATH_C: -+ case RF_PATH_D: -+ start = path; -+ end = path; -+ break; -+ case RF_PATH_AB: -+ start = RF_PATH_A; -+ end = RF_PATH_B; -+ break; -+#if (defined(PHYDM_COMPILE_IC_4SS)) -+ case RF_PATH_AC: -+ start = RF_PATH_A; -+ end = RF_PATH_C; -+ break; -+ case RF_PATH_AD: -+ start = RF_PATH_A; -+ end = RF_PATH_D; -+ break; -+ case RF_PATH_BC: -+ start = RF_PATH_B; -+ end = RF_PATH_C; -+ break; -+ case RF_PATH_BD: -+ start = RF_PATH_B; -+ end = RF_PATH_D; -+ break; -+ case RF_PATH_CD: -+ start = RF_PATH_C; -+ end = RF_PATH_D; -+ break; -+ case RF_PATH_ABC: -+ start = RF_PATH_A; -+ end = RF_PATH_C; -+ break; -+ case RF_PATH_ABD: -+ start = RF_PATH_A; -+ end = RF_PATH_D; -+ break; -+ case RF_PATH_ACD: -+ start = RF_PATH_A; -+ end = RF_PATH_D; -+ break; -+ case RF_PATH_BCD: -+ start = RF_PATH_B; -+ end = RF_PATH_D; -+ break; -+ case RF_PATH_ABCD: -+ start = RF_PATH_A; -+ end = RF_PATH_D; -+ break; -+#endif -+ } -+ -+ central_ch = (u8)odm_get_rf_reg(dm, RF_PATH_A, RF_0x18, 0xff); -+ is_2g_ch = (central_ch <= 14) ? true : false; -+ -+ if (dm->support_ic_type & ODM_RTL8723F) -+ max_rf_path = RF_PATH_C; -+ else -+ max_rf_path = RF_PATH_MEM_SIZE; -+ -+ if (is_single_tone) { -+ /*Disable CCA*/ -+ if (is_2g_ch) { /*CCK RxIQ weighting = [0,0]*/ -+ if(!(dm->support_ic_type & ODM_RTL8723F)) { -+ odm_set_bb_reg(dm, R_0x1a9c, BIT(20), 0x0); -+ odm_set_bb_reg(dm, R_0x1a14, 0x300, 0x3); -+ } -+ } -+ /*Disable CCK CCA*/ -+ if(dm->support_ic_type & ODM_RTL8723F) -+ odm_set_bb_reg(dm, R_0x2a24, BIT(13), 0x1); -+ /*Disable OFDM CCA*/ -+ odm_set_bb_reg(dm, R_0x1d58, 0xff8, 0x1ff); -+ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ for (i = start; i <= end; i++) { -+ if (i < max_rf_path) { -+ odm_set_rf_reg(dm, i, RF_0x5, BIT(0), 0x0); -+ mp->rf0[i] = odm_get_rf_reg(dm, i, RF_0x0, RFREG_MASK); -+ /*Tx mode: RF0x00[19:16]=4'b0010 */ -+ odm_set_rf_reg(dm, i, RF_0x0, 0xF0000, 0x2); -+ /*Lowest RF gain index: RF_0x1[5:0] TX power*/ -+ mp->rf1[i] = odm_get_rf_reg(dm, i, RF_0x1, RFREG_MASK); -+ odm_set_rf_reg(dm, i, RF_0x1, 0x3f, 0x0);//TX power -+ /*RF LO enabled */ -+ odm_set_rf_reg(dm, i, RF_0x58, BIT(1), 0x1); -+ } -+ } -+ } else { -+ for (i = start; i <= end; i++) { -+ if (i < max_rf_path) { -+ mp->rf0[i] = odm_get_rf_reg(dm, i, RF_0x0, RFREG_MASK); -+ /*Tx mode: RF0x00[19:16]=4'b0010 */ -+ odm_set_rf_reg(dm, i, RF_0x0, 0xF0000, 0x2); -+ /*Lowest RF gain index: RF_0x0[4:0] = 0*/ -+ odm_set_rf_reg(dm, i, RF_0x0, 0x1f, 0x0); -+ /*RF LO enabled */ -+ odm_set_rf_reg(dm, i, RF_0x58, BIT(1), 0x1); -+ } -+ } -+ } -+ -+ #if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ mp->rf0_syn[RF_SYN0] = config_phydm_read_syn_reg_8814b( -+ dm, RF_SYN0, RF_0x0, RFREG_MASK); -+ /*Lowest RF gain index: RF_0x0[4:0] = 0x0*/ -+ config_phydm_write_rf_syn_8814b(dm, RF_SYN0, RF_0x0, -+ 0x1f, 0x0); -+ /*RF LO enabled */ -+ config_phydm_write_rf_syn_8814b(dm, RF_SYN0, RF_0x58, -+ BIT(1), 0x1); -+ /*SYN1*/ -+ if (*dm->band_width == CHANNEL_WIDTH_80_80) { -+ mp->rf0_syn[RF_SYN1] = config_phydm_read_syn_reg_8814b( -+ dm, RF_SYN1, RF_0x0, -+ RFREG_MASK); -+ config_phydm_write_rf_syn_8814b(dm, RF_SYN1, -+ RF_0x0, 0x1f, -+ 0x0); -+ config_phydm_write_rf_syn_8814b(dm, RF_SYN1, -+ RF_0x58, BIT(1), -+ 0x1); -+ } -+ } -+ #endif -+ } else { -+ /*Enable CCA*/ -+ if (is_2g_ch) { /*CCK RxIQ weighting = [1,1]*/ -+ if(!(dm->support_ic_type & ODM_RTL8723F)) { -+ odm_set_bb_reg(dm, R_0x1a9c, BIT(20), 0x1); -+ odm_set_bb_reg(dm, R_0x1a14, 0x300, 0x0); -+ } -+ } -+ /*Enable CCK CCA*/ -+ if(dm->support_ic_type & ODM_RTL8723F) -+ odm_set_bb_reg(dm, R_0x2a24, BIT(13), 0x0); -+ /*Enable OFDM CCA*/ -+ odm_set_bb_reg(dm, R_0x1d58, 0xff8, 0x0); -+ -+ if(dm->support_ic_type & ODM_RTL8723F) { -+ for (i = start; i <= end; i++) { -+ if (i < max_rf_path) { -+ odm_set_rf_reg(dm, i, RF_0x0, RFREG_MASK, mp->rf0[i]); -+ odm_set_rf_reg(dm, i, RF_0x1, RFREG_MASK, mp->rf1[i]); -+ /*RF LO disabled */ -+ odm_set_rf_reg(dm, i, RF_0x58, BIT(1), 0x0); -+ odm_set_rf_reg(dm, i, RF_0x5, BIT(0), 0x1); -+ } -+ } -+ } else { -+ for (i = start; i <= end; i++) { -+ if (i < max_rf_path) { -+ odm_set_rf_reg(dm, i, RF_0x0, RFREG_MASK, mp->rf0[i]); -+ /*RF LO disabled */ -+ odm_set_rf_reg(dm, i, RF_0x58, BIT(1), 0x0); -+ } -+ } -+ } -+ #if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ config_phydm_write_rf_syn_8814b(dm, RF_SYN0, RF_0x0, -+ RFREG_MASK, -+ mp->rf0_syn[RF_SYN0]); -+ config_phydm_write_rf_syn_8814b(dm, RF_SYN0, RF_0x58, -+ BIT(1), 0x0); -+ /*SYN1*/ -+ if (*dm->band_width == CHANNEL_WIDTH_80_80) { -+ config_phydm_write_rf_syn_8814b(dm, RF_SYN1, -+ RF_0x0, -+ RFREG_MASK, -+ mp->rf0_syn[RF_SYN1]); -+ config_phydm_write_rf_syn_8814b(dm, RF_SYN1, -+ RF_0x58, BIT(1), -+ 0x0); -+ } -+ } -+ #endif -+ } -+} -+ -+void phydm_mp_set_carrier_supp_jgr3(void *dm_void, boolean is_carrier_supp, -+ u32 rate_index) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_mp *mp = &dm->dm_mp_table; -+ -+ if (is_carrier_supp) { -+ if (phydm_is_cck_rate(dm, (u8)rate_index)) { -+ /*if CCK block on? */ -+ if (!odm_get_bb_reg(dm, R_0x1c3c, BIT(1))) -+ odm_set_bb_reg(dm, R_0x1c3c, BIT(1), 1); -+ -+ if(dm->support_ic_type & ODM_RTL8723F){ -+ /* @Carrier suppress tx */ -+ odm_set_bb_reg(dm, R_0x2a08, BIT(18), 0x1); -+ /*turn off scramble setting */ -+ odm_set_bb_reg(dm, R_0x2a04, BIT(5), 0x1); -+ /*Set CCK Tx Test Rate, set TxRate to 2Mbps */ -+ odm_set_bb_reg(dm, R_0x2a08, 0x300000, 0x1); -+ /* BB and PMAC cont tx */ -+ odm_set_bb_reg(dm, R_0x2a08, BIT(17), 0x1); -+ odm_set_bb_reg(dm, R_0x2a00, BIT(28), 0x1); -+ /* TX CCK ON */ -+ odm_set_bb_reg(dm, R_0x2a08, BIT(31), 0x0); -+ odm_set_bb_reg(dm, R_0x2a08, BIT(31), 0x1); -+ } -+ else { -+ /*Turn Off All Test mode */ -+ odm_set_bb_reg(dm, R_0x1ca4, 0x7, 0x0); -+ -+ /*transmit mode */ -+ odm_set_bb_reg(dm, R_0x1a00, 0x3, 0x2); -+ /*turn off scramble setting */ -+ odm_set_bb_reg(dm, R_0x1a00, BIT(3), 0x0); -+ /*Set CCK Tx Test Rate, set TxRate to 1Mbps */ -+ odm_set_bb_reg(dm, R_0x1a00, 0x3000, 0x0); -+ } -+ } -+ } else { /*Stop Carrier Suppression. */ -+ if (phydm_is_cck_rate(dm, (u8)rate_index)) { -+ if(dm->support_ic_type & ODM_RTL8723F) { -+ /* TX Stop */ -+ odm_set_bb_reg(dm, R_0x2a00, BIT(0), 0x1); -+ /* Clear BB cont tx */ -+ odm_set_bb_reg(dm, R_0x2a00, BIT(28), 0x0); -+ /* Clear PMAC cont tx */ -+ odm_set_bb_reg(dm, R_0x2a08, BIT(17), 0x0); -+ /* Clear TX Stop */ -+ odm_set_bb_reg(dm, R_0x2a00, BIT(0), 0x0); -+ /* normal mode */ -+ odm_set_bb_reg(dm, R_0x2a08, BIT(18), 0x0); -+ /* turn on scramble setting */ -+ odm_set_bb_reg(dm, R_0x2a04, BIT(5), 0x0); -+ } -+ else { -+ /*normal mode */ -+ odm_set_bb_reg(dm, R_0x1a00, 0x3, 0x0); -+ /*turn on scramble setting */ -+ odm_set_bb_reg(dm, R_0x1a00, BIT(3), 0x1); -+ } -+ /*BB Reset */ -+ odm_set_bb_reg(dm, R_0x1d0c, BIT(16), 0x0); -+ odm_set_bb_reg(dm, R_0x1d0c, BIT(16), 0x1); -+ } -+ } -+} -+ -+void phydm_mp_set_single_carrier_jgr3(void *dm_void, boolean is_single_carrier) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_mp *mp = &dm->dm_mp_table; -+ -+ if (is_single_carrier) { -+ /*1. if OFDM block on? */ -+ if (!odm_get_bb_reg(dm, R_0x1c3c, BIT(0))) -+ odm_set_bb_reg(dm, R_0x1c3c, BIT(0), 1); -+ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ /*3. turn on scramble setting */ -+ odm_set_bb_reg(dm, R_0x2a04, BIT(5), 0); -+ /*4. Turn On single carrier. */ -+ odm_set_bb_reg(dm, R_0x1ca4, 0x7, OFDM_SINGLE_CARRIER); -+ } -+ else { -+ /*2. set CCK test mode off, set to CCK normal mode */ -+ odm_set_bb_reg(dm, R_0x1a00, 0x3, 0); -+ /*3. turn on scramble setting */ -+ odm_set_bb_reg(dm, R_0x1a00, BIT(3), 1); -+ /*4. Turn On single carrier. */ -+ odm_set_bb_reg(dm, R_0x1ca4, 0x7, OFDM_SINGLE_CARRIER); -+ } -+ } else { -+ /*Turn off all test modes. */ -+ odm_set_bb_reg(dm, R_0x1ca4, 0x7, OFDM_OFF); -+ -+ /*Delay 10 ms */ -+ ODM_delay_ms(10); -+ -+ /*BB Reset*/ -+ odm_set_bb_reg(dm, R_0x1d0c, BIT(16), 0x0); -+ odm_set_bb_reg(dm, R_0x1d0c, BIT(16), 0x1); -+ } -+} -+ -+void phydm_mp_get_tx_ok_jgr3(void *dm_void, u32 rate_index) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_mp *mp = &dm->dm_mp_table; -+ -+ if (phydm_is_cck_rate(dm, (u8)rate_index)) -+ mp->tx_phy_ok_cnt = odm_get_bb_reg(dm, R_0x2de4, MASKLWORD); -+ else -+ mp->tx_phy_ok_cnt = odm_get_bb_reg(dm, R_0x2de0, MASKLWORD); -+} -+ -+void phydm_mp_get_rx_ok_jgr3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_mp *mp = &dm->dm_mp_table; -+ -+ u32 cck_ok = 0, ofdm_ok = 0, ht_ok = 0, vht_ok = 0; -+ u32 cck_err = 0, ofdm_err = 0, ht_err = 0, vht_err = 0; -+ if(dm->support_ic_type & ODM_RTL8723F) -+ cck_ok = odm_get_bb_reg(dm, R_0x2aac, MASKLWORD); -+ else -+ cck_ok = odm_get_bb_reg(dm, R_0x2c04, MASKLWORD); -+ ofdm_ok = odm_get_bb_reg(dm, R_0x2c14, MASKLWORD); -+ ht_ok = odm_get_bb_reg(dm, R_0x2c10, MASKLWORD); -+ vht_ok = odm_get_bb_reg(dm, R_0x2c0c, MASKLWORD); -+ if(dm->support_ic_type & ODM_RTL8723F) -+ cck_err = odm_get_bb_reg(dm, R_0x2aac, MASKHWORD); -+ else -+ cck_err = odm_get_bb_reg(dm, R_0x2c04, MASKHWORD); -+ ofdm_err = odm_get_bb_reg(dm, R_0x2c14, MASKHWORD); -+ ht_err = odm_get_bb_reg(dm, R_0x2c10, MASKHWORD); -+ vht_err = odm_get_bb_reg(dm, R_0x2c0c, MASKHWORD); -+ -+ mp->rx_phy_ok_cnt = cck_ok + ofdm_ok + ht_ok + vht_ok; -+ mp->rx_phy_crc_err_cnt = cck_err + ofdm_err + ht_err + vht_err; -+ mp->io_value = (u32)mp->rx_phy_ok_cnt; -+} -+#endif -+void phydm_mp_set_crystal_cap(void *dm_void, u8 crystal_cap) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ phydm_set_crystal_cap(dm, crystal_cap); -+} -+ -+void phydm_mp_set_single_tone(void *dm_void, boolean is_single_tone, u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_mp_set_single_tone_jgr3(dm, is_single_tone, path); -+} -+ -+void phydm_mp_set_carrier_supp(void *dm_void, boolean is_carrier_supp, -+ u32 rate_index) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_mp_set_carrier_supp_jgr3(dm, is_carrier_supp, rate_index); -+} -+ -+void phydm_mp_set_single_carrier(void *dm_void, boolean is_single_carrier) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_mp_set_single_carrier_jgr3(dm, is_single_carrier); -+} -+void phydm_mp_reset_rx_counters_phy(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ phydm_reset_bb_hw_cnt(dm); -+} -+ -+void phydm_mp_get_tx_ok(void *dm_void, u32 rate_index) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_mp_get_tx_ok_jgr3(dm, rate_index); -+} -+ -+void phydm_mp_get_rx_ok(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_mp_get_rx_ok_jgr3(dm); -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_mp.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_mp.h -new file mode 100644 -index 000000000..5805a0378 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_mp.h -@@ -0,0 +1,83 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_MP_H__ -+#define __PHYDM_MP_H__ -+ -+/*2020.04.27 Refine single tone Tx flow*/ -+#define MP_VERSION "1.5" -+ -+/* @1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+/* @1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+struct phydm_mp { -+ /*Rx OK count, statistics used in Mass Production Test.*/ -+ u64 tx_phy_ok_cnt; -+ u64 rx_phy_ok_cnt; -+ /*Rx CRC32 error count, statistics used in Mass Production Test.*/ -+ u64 rx_phy_crc_err_cnt; -+ /*The Value of IO operation is depend of MptActType.*/ -+ u32 io_value; -+ u32 rf0[RF_PATH_MEM_SIZE]; -+ #if (RTL8814B_SUPPORT) -+ u32 rf0_syn[2]; -+ #endif -+ u32 rf1[RF_PATH_MEM_SIZE]; -+}; -+ -+/* @1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ */ -+enum TX_MODE_OFDM { -+ OFDM_OFF = 0, -+ OFDM_CONT_TX = 1, -+ OFDM_SINGLE_CARRIER = 2, -+ OFDM_SINGLE_TONE = 4, -+}; -+/* @1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ */ -+void phydm_mp_set_crystal_cap(void *dm_void, u8 crystal_cap); -+ -+void phydm_mp_set_single_tone(void *dm_void, boolean is_single_tone, u8 path); -+ -+void phydm_mp_set_carrier_supp(void *dm_void, boolean is_carrier_supp, -+ u32 rate_index); -+ -+void phydm_mp_set_single_carrier(void *dm_void, boolean is_single_carrier); -+ -+void phydm_mp_reset_rx_counters_phy(void *dm_void); -+ -+void phydm_mp_get_tx_ok(void *dm_void, u32 rate_index); -+ -+void phydm_mp_get_rx_ok(void *dm_void); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_noisemonitor.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_noisemonitor.c -new file mode 100644 -index 000000000..d2e95cfa0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_noisemonitor.c -@@ -0,0 +1,467 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/************************************************************* -+ * include files -+ ************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_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] -+ * -+ *************************************************/ -+ -+void phydm_set_noise_data_sum(struct noise_level *noise_data, u8 max_rf_path) -+{ -+ u8 i = 0; -+ -+ for (i = RF_PATH_A; i < max_rf_path; i++) { -+ if (noise_data->valid_cnt[i]) -+ noise_data->sum[i] /= noise_data->valid_cnt[i]; -+ else -+ noise_data->sum[i] = 0; -+ } -+} -+ -+#if (ODM_IC_11N_SERIES_SUPPORT) -+s16 odm_inband_noise_monitor_n(struct dm_struct *dm, u8 is_pause_dig, u8 igi, -+ u32 max_time) -+{ -+ u32 tmp4b; -+ u8 max_rf_path = 0, i = 0; -+ u8 reg_c50, reg_c58, valid_done = 0; -+ struct noise_level noise_data; -+ u64 start = 0, func_start = 0, func_end = 0; -+ s8 val_s8 = 0; -+ -+ func_start = odm_get_current_time(dm); -+ dm->noise_level.noise_all = 0; -+ -+ if (dm->rf_type == RF_1T2R || dm->rf_type == RF_2T2R) -+ max_rf_path = 2; -+ else -+ max_rf_path = 1; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "odm_DebugControlInbandNoise_Nseries() ==>\n"); -+ -+ odm_memory_set(dm, &noise_data, 0, sizeof(struct noise_level)); -+ /* step 1. Disable DIG && Set initial gain. */ -+ -+ if (is_pause_dig) -+ odm_pause_dig(dm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi); -+ -+ /* step 3. Get noise power level */ -+ start = odm_get_current_time(dm); -+ while (1) { -+ /* Stop updating idle time pwer report (for driver read) */ -+ odm_set_bb_reg(dm, REG_FPGA0_TX_GAIN_STAGE, BIT(25), 1); -+ -+ /* Read Noise Floor Report */ -+ tmp4b = odm_get_bb_reg(dm, R_0x8f8, MASKDWORD); -+ -+ /* update idle time pwer report per 5us */ -+ odm_set_bb_reg(dm, REG_FPGA0_TX_GAIN_STAGE, BIT(25), 0); -+ -+ ODM_delay_us(5); -+ -+ noise_data.value[RF_PATH_A] = (u8)(tmp4b & 0xff); -+ noise_data.value[RF_PATH_B] = (u8)((tmp4b & 0xff00) >> 8); -+ -+ for (i = RF_PATH_A; i < max_rf_path; i++) { -+ noise_data.sval[i] = (s8)noise_data.value[i]; -+ noise_data.sval[i] /= 2; -+ } -+ -+ for (i = RF_PATH_A; i < max_rf_path; i++) { -+ if (noise_data.valid_cnt[i] >= VALID_CNT) -+ continue; -+ -+ noise_data.valid_cnt[i]++; -+ noise_data.sum[i] += noise_data.sval[i]; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "rf_path:%d Valid sval=%d\n", i, -+ noise_data.sval[i]); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Sum of sval = %d,\n", -+ noise_data.sum[i]); -+ if (noise_data.valid_cnt[i] == VALID_CNT) -+ valid_done++; -+ } -+ if (valid_done == max_rf_path || -+ (odm_get_progressing_time(dm, start) > max_time)) { -+ phydm_set_noise_data_sum(&noise_data, max_rf_path); -+ break; -+ } -+ } -+ reg_c50 = (u8)odm_get_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, MASKBYTE0); -+ reg_c50 &= ~BIT(7); -+ val_s8 = (s8)(-110 + reg_c50 + noise_data.sum[RF_PATH_A]); -+ dm->noise_level.noise[RF_PATH_A] = val_s8; -+ dm->noise_level.noise_all += dm->noise_level.noise[RF_PATH_A]; -+ -+ if (max_rf_path == 2) { -+ reg_c58 = (u8)odm_get_bb_reg(dm, R_0xc58, MASKBYTE0); -+ reg_c58 &= ~BIT(7); -+ val_s8 = (s8)(-110 + reg_c58 + noise_data.sum[RF_PATH_B]); -+ dm->noise_level.noise[RF_PATH_B] = val_s8; -+ dm->noise_level.noise_all += dm->noise_level.noise[RF_PATH_B]; -+ } -+ dm->noise_level.noise_all /= max_rf_path; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "noise_a = %d, noise_b = %d, noise_all = %d\n", -+ dm->noise_level.noise[RF_PATH_A], -+ dm->noise_level.noise[RF_PATH_B], dm->noise_level.noise_all); -+ -+ /* step 4. Recover the Dig */ -+ if (is_pause_dig) -+ odm_pause_dig(dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi); -+ func_end = odm_get_progressing_time(dm, func_start); -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "end\n"); -+ return dm->noise_level.noise_all; -+} -+#endif -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT) -+s16 phydm_idle_noise_measure_ac(struct dm_struct *dm, u8 pause_dig, -+ u8 igi, u32 max_time) -+{ -+ u32 tmp4b; -+ u8 max_rf_path = 0, i = 0; -+ u8 reg_c50, reg_e50, valid_done = 0; -+ u64 start = 0, func_start = 0, func_end = 0; -+ struct noise_level noise_data; -+ s8 val_s8 = 0; -+ -+ func_start = odm_get_current_time(dm); -+ dm->noise_level.noise_all = 0; -+ -+ if (dm->rf_type == RF_1T2R || dm->rf_type == RF_2T2R) -+ max_rf_path = 2; -+ else -+ max_rf_path = 1; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "%s==>\n", __func__); -+ -+ odm_memory_set(dm, &noise_data, 0, sizeof(struct noise_level)); -+ -+ /*Step 1. Disable DIG && Set initial gain.*/ -+ -+ if (pause_dig) -+ odm_pause_dig(dm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi); -+ -+ /*Step 2. Get noise power level*/ -+ start = odm_get_current_time(dm); -+ -+ while (1) { -+ /*Stop updating idle time pwer report (for driver read)*/ -+ odm_set_bb_reg(dm, R_0x9e4, BIT(30), 0x1); -+ -+ /*Read Noise Floor Report*/ -+ tmp4b = odm_get_bb_reg(dm, R_0xff0, MASKDWORD); -+ -+ /*update idle time pwer report per 5us*/ -+ odm_set_bb_reg(dm, R_0x9e4, BIT(30), 0x0); -+ -+ ODM_delay_us(5); -+ -+ noise_data.value[RF_PATH_A] = (u8)(tmp4b & 0xff); -+ noise_data.value[RF_PATH_B] = (u8)((tmp4b & 0xff00) >> 8); -+ -+ for (i = RF_PATH_A; i < max_rf_path; i++) { -+ noise_data.sval[i] = (s8)noise_data.value[i]; -+ noise_data.sval[i] = noise_data.sval[i] >> 1; -+ } -+ -+ for (i = RF_PATH_A; i < max_rf_path; i++) { -+ if (noise_data.valid_cnt[i] >= VALID_CNT) -+ continue; -+ -+ noise_data.valid_cnt[i]++; -+ noise_data.sum[i] += noise_data.sval[i]; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Path:%d Valid sval = %d\n", -+ i, noise_data.sval[i]); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Sum of sval = %d\n", -+ noise_data.sum[i]); -+ if (noise_data.valid_cnt[i] == VALID_CNT) -+ valid_done++; -+ } -+ -+ if (valid_done == max_rf_path || -+ (odm_get_progressing_time(dm, start) > max_time)) { -+ phydm_set_noise_data_sum(&noise_data, max_rf_path); -+ break; -+ } -+ } -+ reg_c50 = (u8)odm_get_bb_reg(dm, R_0xc50, MASKBYTE0); -+ reg_c50 &= ~BIT(7); -+ val_s8 = (s8)(-110 + reg_c50 + noise_data.sum[RF_PATH_A]); -+ dm->noise_level.noise[RF_PATH_A] = val_s8; -+ dm->noise_level.noise_all += dm->noise_level.noise[RF_PATH_A]; -+ -+ if (max_rf_path == 2) { -+ reg_e50 = (u8)odm_get_bb_reg(dm, R_0xe50, MASKBYTE0); -+ reg_e50 &= ~BIT(7); -+ val_s8 = (s8)(-110 + reg_e50 + noise_data.sum[RF_PATH_B]); -+ dm->noise_level.noise[RF_PATH_B] = val_s8; -+ dm->noise_level.noise_all += dm->noise_level.noise[RF_PATH_B]; -+ } -+ dm->noise_level.noise_all /= max_rf_path; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "noise_a = %d, noise_b = %d, noise_all = %d\n", -+ dm->noise_level.noise[RF_PATH_A], -+ dm->noise_level.noise[RF_PATH_B], dm->noise_level.noise_all); -+ -+ /*Step 3. Recover the Dig*/ -+ if (pause_dig) -+ odm_pause_dig(dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi); -+ func_end = odm_get_progressing_time(dm, func_start); -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "end\n"); -+ return dm->noise_level.noise_all; -+} -+ -+s16 odm_inband_noise_monitor_ac(struct dm_struct *dm, u8 pause_dig, u8 igi, -+ u32 max_time) -+{ -+ s32 rxi_buf_anta, rxq_buf_anta; /*rxi_buf_antb, rxq_buf_antb;*/ -+ s32 value32, pwdb_A = 0, sval, noise, sum = 0; -+ boolean pd_flag; -+ u8 valid_cnt = 0; -+ u8 invalid_cnt = 0; -+ u64 start = 0, func_start = 0, func_end = 0, proc_time = 0; -+ s32 val_s32 = 0; -+ s16 rpt = 0; -+ u8 val_u8 = 0; -+ -+ if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { -+ rpt = phydm_idle_noise_measure_ac(dm, pause_dig, igi, max_time); -+ return rpt; -+ } -+ -+ if (!(dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A))) -+ return 0; -+ -+ func_start = odm_get_current_time(dm); -+ dm->noise_level.noise_all = 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "%s ==>\n", __func__); -+ -+ /* step 1. Disable DIG && Set initial gain. */ -+ if (pause_dig) -+ odm_pause_dig(dm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi); -+ -+ /* step 3. Get noise power level */ -+ start = odm_get_current_time(dm); -+ -+ /* step 3. Get noise power level */ -+ while (1) { -+ /*Set IGI=0x1C */ -+ odm_write_dig(dm, 0x1C); -+ /*stop CK320&CK88 */ -+ odm_set_bb_reg(dm, R_0x8b4, BIT(6), 1); -+ /*Read path-A */ -+ /*set debug port*/ -+ odm_set_bb_reg(dm, R_0x8fc, MASKDWORD, 0x200); -+ /*read debug port*/ -+ value32 = odm_get_bb_reg(dm, R_0xfa0, MASKDWORD); -+ /*rxi_buf_anta=RegFA0[19:10]*/ -+ rxi_buf_anta = (value32 & 0xFFC00) >> 10; -+ rxq_buf_anta = value32 & 0x3FF; /*rxq_buf_anta=RegFA0[19:10]*/ -+ -+ pd_flag = (boolean)((value32 & BIT(31)) >> 31); -+ -+ /*Not in packet detection period or Tx state */ -+ if (!pd_flag || rxi_buf_anta != 0x200) { -+ /*sign conversion*/ -+ rxi_buf_anta = odm_sign_conversion(rxi_buf_anta, 10); -+ rxq_buf_anta = odm_sign_conversion(rxq_buf_anta, 10); -+ -+ val_s32 = rxi_buf_anta * rxi_buf_anta + -+ rxq_buf_anta * rxq_buf_anta; -+ /*S(10,9)*S(10,9)=S(20,18)*/ -+ pwdb_A = odm_pwdb_conversion(val_s32, 20, 18); -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "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_set_bb_reg(dm, R_0x8b4, BIT(6), 0); -+ /*@BB Reset*/ -+ val_u8 = odm_read_1byte(dm, 0x02) & (~BIT(0)); -+ odm_write_1byte(dm, 0x02, val_u8); -+ val_u8 = odm_read_1byte(dm, 0x02) | BIT(0); -+ odm_write_1byte(dm, 0x02, val_u8); -+ /*PMAC Reset*/ -+ val_u8 = odm_read_1byte(dm, 0xB03) & (~BIT(0)); -+ odm_write_1byte(dm, 0xB03, val_u8); -+ val_u8 = odm_read_1byte(dm, 0xB03) | BIT(0); -+ odm_write_1byte(dm, 0xB03, val_u8); -+ /*@CCK Reset*/ -+ if (odm_read_1byte(dm, 0x80B) & BIT(4)) { -+ val_u8 = odm_read_1byte(dm, 0x80B) & (~BIT(4)); -+ odm_write_1byte(dm, 0x80B, val_u8); -+ val_u8 = odm_read_1byte(dm, 0x80B) | BIT(4); -+ odm_write_1byte(dm, 0x80B, val_u8); -+ } -+ -+ sval = pwdb_A; -+ -+ if ((sval < 0 && sval >= -27) && valid_cnt < VALID_CNT) { -+ valid_cnt++; -+ sum += sval; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Valid sval = %d\n", sval); -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Sum of sval = %d,\n", sum); -+ if (valid_cnt >= VALID_CNT || -+ (odm_get_progressing_time(dm, start) > max_time)) { -+ sum /= VALID_CNT; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "After divided, sum = %d\n", sum); -+ break; -+ } -+ } else { -+ /*Invalid sval and return -110 dBm*/ -+ invalid_cnt++; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "Invalid sval\n"); -+ if (invalid_cnt >= VALID_CNT + 5) { -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "Invalid count > TH, Return -110, Break!!\n"); -+ return -110; -+ } -+ } -+ } -+ -+ /*@ADC backoff is 12dB,*/ -+ /*Ptarget=0x1C-110=-82dBm*/ -+ noise = sum + 12 + 0x1C - 110; -+ -+ /*Offset*/ -+ noise = noise - 3; -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "noise = %d\n", noise); -+ dm->noise_level.noise_all = (s16)noise; -+ -+ /* step 4. Recover the Dig*/ -+ if (pause_dig) -+ odm_pause_dig(dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi); -+ -+ func_end = odm_get_progressing_time(dm, func_start); -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, "%s <==\n", __func__); -+ -+ return dm->noise_level.noise_all; -+} -+#endif -+ -+s16 odm_inband_noise_monitor(void *dm_void, u8 pause_dig, u8 igi, -+ u32 max_time) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ s16 val = 0; -+ -+ igi = 0x32; -+ -+ /* since HW ability is about +15~-35, -+ * we fix IGI = -60 for maximum coverage -+ */ -+ #if (ODM_IC_11AC_SERIES_SUPPORT) -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) -+ val = odm_inband_noise_monitor_ac(dm, pause_dig, igi, max_time); -+ #endif -+ -+ #if (ODM_IC_11N_SERIES_SUPPORT) -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) -+ val = odm_inband_noise_monitor_n(dm, pause_dig, igi, max_time); -+ #endif -+ -+ return val; -+} -+ -+void phydm_noisy_detection(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 total_fa_cnt, total_cca_cnt; -+ u32 score = 0, i, score_smooth; -+ -+ total_cca_cnt = dm->false_alm_cnt.cnt_cca_all; -+ total_fa_cnt = dm->false_alm_cnt.cnt_all; -+ -+#if 0 -+ 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% */ -+ ; -+#endif -+ for (i = 0; i <= 16; i++) { -+ if (total_fa_cnt * 16 >= total_cca_cnt * (16 - i)) { -+ score = 16 - i; -+ break; -+ } -+ } -+ -+ /* noisy_decision_smooth = noisy_decision_smooth>>1 + (score<<3)>>1; */ -+ dm->noisy_decision_smooth = (dm->noisy_decision_smooth >> 1) + -+ (score << 2); -+ -+ /* Round the noisy_decision_smooth: +"3" comes from (2^3)/2-1 */ -+ if (total_cca_cnt >= 300) -+ score_smooth = (dm->noisy_decision_smooth + 3) >> 3; -+ else -+ score_smooth = 0; -+ -+ dm->noisy_decision = (score_smooth >= 3) ? 1 : 0; -+ -+ PHYDM_DBG(dm, DBG_ENV_MNTR, -+ "[NoisyDetection] CCA_cnt=%d,FA_cnt=%d, noisy_dec_smooth=%d, score=%d, score_smooth=%d, noisy_dec=%d\n", -+ total_cca_cnt, total_fa_cnt, dm->noisy_decision_smooth, score, -+ score_smooth, dm->noisy_decision); -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_noisemonitor.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_noisemonitor.h -new file mode 100644 -index 000000000..507285adb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_noisemonitor.h -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#ifndef __ODMNOISEMONITOR_H__ -+#define __ODMNOISEMONITOR_H__ -+ -+#define VALID_CNT 5 -+ -+struct noise_level { -+ u8 value[PHYDM_MAX_RF_PATH]; -+ s8 sval[PHYDM_MAX_RF_PATH]; -+ s32 sum[PHYDM_MAX_RF_PATH]; -+ u8 valid[PHYDM_MAX_RF_PATH]; -+ u8 valid_cnt[PHYDM_MAX_RF_PATH]; -+}; -+ -+struct odm_noise_monitor { -+ s8 noise[PHYDM_MAX_RF_PATH]; -+ s16 noise_all; -+}; -+ -+s16 odm_inband_noise_monitor(void *dm_void, u8 is_pause_dig, u8 igi_value, -+ u32 max_time); -+ -+void phydm_noisy_detection(void *dm_void); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pathdiv.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pathdiv.c -new file mode 100644 -index 000000000..a6b347cf7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pathdiv.c -@@ -0,0 +1,1113 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/************************************************************* -+ * include files -+ ************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef CONFIG_PATH_DIVERSITY -+#if RTL8814A_SUPPORT -+void phydm_dtp_fix_tx_path( -+ void *dm_void, -+ u8 path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ u8 i, num_enable_path = 0; -+ -+ if (path == p_div->pre_tx_path) -+ return; -+ else -+ p_div->pre_tx_path = path; -+ -+ odm_set_bb_reg(dm, R_0x93c, BIT(18) | BIT(19), 3); -+ -+ for (i = 0; i < 4; i++) { -+ if (path & BIT(i)) -+ num_enable_path++; -+ } -+ PHYDM_DBG(dm, DBG_PATH_DIV, " number of turn-on path : (( %d ))\n", -+ num_enable_path); -+ -+ if (num_enable_path == 1) { -+ odm_set_bb_reg(dm, R_0x93c, 0xf00000, path); -+ -+ if (path == BB_PATH_A) { /* @1-1 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( A ))\n"); -+ odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); -+ } else if (path == BB_PATH_B) { /* @1-2 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( B ))\n"); -+ odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0); -+ } else if (path == BB_PATH_C) { /* @1-3 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( C ))\n"); -+ odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 0); -+ -+ } else if (path == BB_PATH_D) { /* @1-4 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( D ))\n"); -+ odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 0); -+ } -+ -+ } else if (num_enable_path == 2) { -+ odm_set_bb_reg(dm, R_0x93c, 0xf00000, path); -+ odm_set_bb_reg(dm, R_0x940, 0xf0, path); -+ -+ if (path == (BB_PATH_AB)) { /* @2-1 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ " Turn on path (( A B ))\n"); -+ /* set for 1ss */ -+ odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); -+ odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 1); -+ /* set for 2ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 1); -+ } else if (path == BB_PATH_AC) { /* @2-2 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ " Turn on path (( A C ))\n"); -+ /* set for 1ss */ -+ odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); -+ odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1); -+ /* set for 2ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1); -+ } else if (path == BB_PATH_AD) { /* @2-3 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ " Turn on path (( A D ))\n"); -+ /* set for 1ss */ -+ odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); -+ odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 1); -+ /* set for 2ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 1); -+ } else if (path == BB_PATH_BC) { /* @2-4 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ " Turn on path (( B C ))\n"); -+ /* set for 1ss */ -+ odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0); -+ odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1); -+ /* set for 2ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1); -+ } else if (path == BB_PATH_BD) { /* @2-5 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ " Turn on path (( B D ))\n"); -+ /* set for 1ss */ -+ odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0); -+ odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 1); -+ /* set for 2ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 1); -+ } else if (path == BB_PATH_CD) { /* @2-6 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ " Turn on path (( C D ))\n"); -+ /* set for 1ss */ -+ odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 0); -+ odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 1); -+ /* set for 2ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 1); -+ } -+ -+ } else if (num_enable_path == 3) { -+ odm_set_bb_reg(dm, R_0x93c, 0xf00000, path); -+ odm_set_bb_reg(dm, R_0x940, 0xf0, path); -+ odm_set_bb_reg(dm, R_0x940, 0xf0000, path); -+ -+ if (path == BB_PATH_ABC) { /* @3-1 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ " Turn on path (( A B C))\n"); -+ /* set for 1ss */ -+ odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); -+ odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 1); -+ odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 2); -+ /* set for 2ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 1); -+ odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 2); -+ /* set for 3ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(21) | BIT(20), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(23) | BIT(22), 1); -+ odm_set_bb_reg(dm, R_0x940, BIT(25) | BIT(24), 2); -+ } else if (path == BB_PATH_ABD) { /* @3-2 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ " Turn on path (( A B D ))\n"); -+ /* set for 1ss */ -+ odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); -+ odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 1); -+ odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 2); -+ /* set for 2ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 1); -+ odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 2); -+ /* set for 3ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(21) | BIT(20), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(23) | BIT(22), 1); -+ odm_set_bb_reg(dm, R_0x940, BIT(27) | BIT(26), 2); -+ -+ } else if (path == BB_PATH_ACD) { /* @3-3 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ " Turn on path (( A C D ))\n"); -+ /* set for 1ss */ -+ odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); -+ odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1); -+ odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 2); -+ /* set for 2ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1); -+ odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 2); -+ /* set for 3ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(21) | BIT(20), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(25) | BIT(24), 1); -+ odm_set_bb_reg(dm, R_0x940, BIT(27) | BIT(26), 2); -+ } else if (path == BB_PATH_BCD) { /* @3-4 */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ " Turn on path (( B C D))\n"); -+ /* set for 1ss */ -+ odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0); -+ odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1); -+ odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 2); -+ /* set for 2ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1); -+ odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 2); -+ /* set for 3ss */ -+ odm_set_bb_reg(dm, R_0x940, BIT(23) | BIT(22), 0); -+ odm_set_bb_reg(dm, R_0x940, BIT(25) | BIT(24), 1); -+ odm_set_bb_reg(dm, R_0x940, BIT(27) | BIT(26), 2); -+ } -+ } else if (num_enable_path == 4) -+ PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path ((A B C D))\n"); -+} -+ -+void phydm_find_default_path( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ u32 rssi_a = 0, rssi_b = 0, rssi_c = 0, rssi_d = 0, rssi_bcd = 0; -+ u32 rssi_total_a = 0, rssi_total_b = 0; -+ u32 rssi_total_c = 0, rssi_total_d = 0; -+ -+ /* @2 Default path Selection By RSSI */ -+ -+ rssi_a = (p_div->path_a_cnt_all > 0) ? -+ (p_div->path_a_sum_all / p_div->path_a_cnt_all) : 0; -+ rssi_b = (p_div->path_b_cnt_all > 0) ? -+ (p_div->path_b_sum_all / p_div->path_b_cnt_all) : 0; -+ rssi_c = (p_div->path_c_cnt_all > 0) ? -+ (p_div->path_c_sum_all / p_div->path_c_cnt_all) : 0; -+ rssi_d = (p_div->path_d_cnt_all > 0) ? -+ (p_div->path_d_sum_all / p_div->path_d_cnt_all) : 0; -+ -+ p_div->path_a_sum_all = 0; -+ p_div->path_a_cnt_all = 0; -+ p_div->path_b_sum_all = 0; -+ p_div->path_b_cnt_all = 0; -+ p_div->path_c_sum_all = 0; -+ p_div->path_c_cnt_all = 0; -+ p_div->path_d_sum_all = 0; -+ p_div->path_d_cnt_all = 0; -+ -+ if (p_div->use_path_a_as_default_ant == 1) { -+ rssi_bcd = (rssi_b + rssi_c + rssi_d) / 3; -+ -+ if ((rssi_a + ANT_DECT_RSSI_TH) > rssi_bcd) { -+ p_div->is_path_a_exist = true; -+ p_div->default_path = PATH_A; -+ } else { -+ p_div->is_path_a_exist = false; -+ } -+ } else { -+ if (rssi_a >= rssi_b && -+ rssi_a >= rssi_c && -+ rssi_a >= rssi_d) -+ p_div->default_path = PATH_A; -+ else if ((rssi_b >= rssi_c) && (rssi_b >= rssi_d)) -+ p_div->default_path = PATH_B; -+ else if (rssi_c >= rssi_d) -+ p_div->default_path = PATH_C; -+ else -+ p_div->default_path = PATH_D; -+ } -+} -+ -+void phydm_candidate_dtp_update( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ -+ p_div->num_candidate = 3; -+ -+ if (p_div->use_path_a_as_default_ant == 1) { -+ if (p_div->num_tx_path == 3) { -+ if (p_div->is_path_a_exist) { -+ p_div->ant_candidate_1 = BB_PATH_ABC; -+ p_div->ant_candidate_2 = BB_PATH_ABD; -+ p_div->ant_candidate_3 = BB_PATH_ACD; -+ } else { /* use path BCD */ -+ p_div->num_candidate = 1; -+ phydm_dtp_fix_tx_path(dm, BB_PATH_BCD); -+ return; -+ } -+ } else if (p_div->num_tx_path == 2) { -+ if (p_div->is_path_a_exist) { -+ p_div->ant_candidate_1 = BB_PATH_AB; -+ p_div->ant_candidate_2 = BB_PATH_AC; -+ p_div->ant_candidate_3 = BB_PATH_AD; -+ } else { -+ p_div->ant_candidate_1 = BB_PATH_BC; -+ p_div->ant_candidate_2 = BB_PATH_BD; -+ p_div->ant_candidate_3 = BB_PATH_CD; -+ } -+ } -+ } else { -+ /* @2 3 TX mode */ -+ if (p_div->num_tx_path == 3) { /* @choose 3 ant form 4 */ -+ if (p_div->default_path == PATH_A) { -+ /* @choose 2 ant form 3 */ -+ p_div->ant_candidate_1 = BB_PATH_ABC; -+ p_div->ant_candidate_2 = BB_PATH_ABD; -+ p_div->ant_candidate_3 = BB_PATH_ACD; -+ } else if (p_div->default_path == PATH_B) { -+ p_div->ant_candidate_1 = BB_PATH_ABC; -+ p_div->ant_candidate_2 = BB_PATH_ABD; -+ p_div->ant_candidate_3 = BB_PATH_BCD; -+ } else if (p_div->default_path == PATH_C) { -+ p_div->ant_candidate_1 = BB_PATH_ABC; -+ p_div->ant_candidate_2 = BB_PATH_ACD; -+ p_div->ant_candidate_3 = BB_PATH_BCD; -+ } else if (p_div->default_path == PATH_D) { -+ p_div->ant_candidate_1 = BB_PATH_ABD; -+ p_div->ant_candidate_2 = BB_PATH_ACD; -+ p_div->ant_candidate_3 = BB_PATH_BCD; -+ } -+ } -+ -+ /* @2 2 TX mode */ -+ else if (p_div->num_tx_path == 2) { /* @choose 2 ant form 4 */ -+ if (p_div->default_path == PATH_A) { -+ /* @choose 2 ant form 3 */ -+ p_div->ant_candidate_1 = BB_PATH_AB; -+ p_div->ant_candidate_2 = BB_PATH_AC; -+ p_div->ant_candidate_3 = BB_PATH_AD; -+ } else if (p_div->default_path == PATH_B) { -+ p_div->ant_candidate_1 = BB_PATH_AB; -+ p_div->ant_candidate_2 = BB_PATH_BC; -+ p_div->ant_candidate_3 = BB_PATH_BD; -+ } else if (p_div->default_path == PATH_C) { -+ p_div->ant_candidate_1 = BB_PATH_AC; -+ p_div->ant_candidate_2 = BB_PATH_BC; -+ p_div->ant_candidate_3 = BB_PATH_CD; -+ } else if (p_div->default_path == PATH_D) { -+ p_div->ant_candidate_1 = BB_PATH_AD; -+ p_div->ant_candidate_2 = BB_PATH_BD; -+ p_div->ant_candidate_3 = BB_PATH_CD; -+ } -+ } -+ } -+} -+ -+void phydm_dynamic_tx_path( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ -+ struct sta_info *entry; -+ u32 i; -+ u8 num_client = 0; -+ u8 h2c_parameter[6] = {0}; -+ -+ if (!dm->is_linked) { /* @is_linked==False */ -+ PHYDM_DBG(dm, DBG_PATH_DIV, "DTP_8814 [No Link!!!]\n"); -+ -+ if (p_div->is_become_linked) { -+ PHYDM_DBG(dm, DBG_PATH_DIV, "[Be disconnected]---->\n"); -+ p_div->is_become_linked = dm->is_linked; -+ } -+ return; -+ } else { -+ if (!p_div->is_become_linked) { -+ PHYDM_DBG(dm, DBG_PATH_DIV, " [Be Linked !!!]----->\n"); -+ p_div->is_become_linked = dm->is_linked; -+ } -+ } -+ -+ /* @2 [period CTRL] */ -+ if (p_div->dtp_period >= 2) { -+ p_div->dtp_period = 0; -+ } else { -+ p_div->dtp_period++; -+ return; -+ } -+ -+ /* @2 [Fix path] */ -+ if (dm->path_select != PHYDM_AUTO_PATH) -+ return; -+ -+/* @2 [Check Bfer] */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ { -+ enum beamforming_cap beamform_cap = (dm->beamforming_info.beamform_cap); -+ -+ if (beamform_cap & BEAMFORMER_CAP) { /* @BFmer On && Div On->Div Off */ -+ if (p_div->fix_path_bfer == 0) { -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ "[ PathDiv : OFF ] BFmer ==1\n"); -+ p_div->fix_path_bfer = 1; -+ } -+ return; -+ } else { /* @BFmer Off && Div Off->Div On */ -+ if (p_div->fix_path_bfer == 1) { -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ "[ PathDiv : ON ] BFmer ==0\n"); -+ p_div->fix_path_bfer = 0; -+ } -+ } -+ } -+#endif -+#endif -+ -+ if (p_div->use_path_a_as_default_ant == 1) { -+ phydm_find_default_path(dm); -+ phydm_candidate_dtp_update(dm); -+ } else { -+ if (p_div->phydm_dtp_state == PHYDM_DTP_INIT) { -+ phydm_find_default_path(dm); -+ phydm_candidate_dtp_update(dm); -+ p_div->phydm_dtp_state = PHYDM_DTP_RUNNING_1; -+ } -+ -+ else if (p_div->phydm_dtp_state == PHYDM_DTP_RUNNING_1) { -+ p_div->dtp_check_patha_counter++; -+ -+ if (p_div->dtp_check_patha_counter >= -+ NUM_RESET_DTP_PERIOD) { -+ p_div->dtp_check_patha_counter = 0; -+ p_div->phydm_dtp_state = PHYDM_DTP_INIT; -+ } -+#if 0 -+ /* @2 Search space update */ -+ else { -+ /* @1. find the worst candidate */ -+ -+ -+ /* @2. repalce the worst candidate */ -+ } -+#endif -+ } -+ } -+ -+ /* @2 Dynamic path Selection H2C */ -+ -+ if (p_div->num_candidate == 1) { -+ return; -+ } else { -+ h2c_parameter[0] = p_div->num_candidate; -+ h2c_parameter[1] = p_div->num_tx_path; -+ h2c_parameter[2] = p_div->ant_candidate_1; -+ h2c_parameter[3] = p_div->ant_candidate_2; -+ h2c_parameter[4] = p_div->ant_candidate_3; -+ -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, h2c_parameter); -+ } -+} -+ -+void phydm_dynamic_tx_path_init( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ void *adapter = dm->adapter; -+ u8 search_space_2[NUM_CHOOSE2_FROM4] = {BB_PATH_AB, BB_PATH_AC, BB_PATH_AD, BB_PATH_BC, BB_PATH_BD, BB_PATH_CD}; -+ u8 search_space_3[NUM_CHOOSE3_FROM4] = {BB_PATH_BCD, BB_PATH_ACD, BB_PATH_ABD, BB_PATH_ABC}; -+ -+#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT) -+ p_div->is_u3_mode = (*dm->hub_usb_mode == 2) ? 1 : 0; -+ PHYDM_DBG(dm, DBG_PATH_DIV, "[WIN USB] is_u3_mode = (( %d ))\n", -+ p_div->is_u3_mode); -+#else -+ p_div->is_u3_mode = 1; -+#endif -+ PHYDM_DBG(dm, DBG_PATH_DIV, "Dynamic TX path Init 8814\n"); -+ -+ memcpy(&p_div->search_space_2[0], &search_space_2[0], -+ NUM_CHOOSE2_FROM4); -+ memcpy(&p_div->search_space_3[0], &search_space_3[0], -+ NUM_CHOOSE3_FROM4); -+ -+ p_div->use_path_a_as_default_ant = 1; -+ p_div->phydm_dtp_state = PHYDM_DTP_INIT; -+ dm->path_select = PHYDM_AUTO_PATH; -+ p_div->phydm_path_div_type = PHYDM_4R_PATH_DIV; -+ -+ if (p_div->is_u3_mode) { -+ p_div->num_tx_path = 3; -+ phydm_dtp_fix_tx_path(dm, BB_PATH_BCD); /* @3TX Set Init TX path*/ -+ -+ } else { -+ p_div->num_tx_path = 2; -+ phydm_dtp_fix_tx_path(dm, BB_PATH_BC); /* @2TX // Set Init TX path*/ -+ } -+} -+ -+void phydm_process_rssi_for_path_div_8814a(void *dm_void, void *phy_info_void, -+ void *pkt_info_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_phyinfo_struct *phy_info = NULL; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ -+ phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ -+ if (!(pktinfo->is_packet_to_self || pktinfo->is_packet_match_bssid)) -+ return; -+ -+ if (pktinfo->data_rate <= ODM_RATE11M) -+ return; -+ -+ if (p_div->phydm_path_div_type == PHYDM_4R_PATH_DIV) { -+ p_div->path_a_sum_all += phy_info->rx_mimo_signal_strength[0]; -+ p_div->path_a_cnt_all++; -+ -+ p_div->path_b_sum_all += phy_info->rx_mimo_signal_strength[1]; -+ p_div->path_b_cnt_all++; -+ -+ p_div->path_c_sum_all += phy_info->rx_mimo_signal_strength[2]; -+ p_div->path_c_cnt_all++; -+ -+ p_div->path_d_sum_all += phy_info->rx_mimo_signal_strength[3]; -+ p_div->path_d_cnt_all++; -+ } -+} -+ -+void phydm_pathdiv_debug_8814a(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 dm_value[10] = {0}; -+ u8 i, input_idx = 0; -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ dm->path_select = (u8)(dm_value[0] & 0xf); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Path_select = (( 0x%x ))\n", dm->path_select); -+ -+ /* @2 [Fix path] */ -+ if (dm->path_select != PHYDM_AUTO_PATH) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Turn on path [%s%s%s%s]\n", -+ ((dm->path_select) & 0x1) ? "A" : "", -+ ((dm->path_select) & 0x2) ? "B" : "", -+ ((dm->path_select) & 0x4) ? "C" : "", -+ ((dm->path_select) & 0x8) ? "D" : ""); -+ -+ phydm_dtp_fix_tx_path(dm, dm->path_select); -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, "%s\n", -+ "Auto path"); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif /* @#if RTL8814A_SUPPORT */ -+ -+#if RTL8812A_SUPPORT -+void phydm_update_tx_path_8812a(void *dm_void, enum bb_path path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ -+ if (p_div->default_tx_path != path) { -+ PHYDM_DBG(dm, DBG_PATH_DIV, "Need to Update Tx path\n"); -+ -+ if (path == BB_PATH_A) { -+ /*Tx by Reg*/ -+ odm_set_bb_reg(dm, R_0x80c, 0xFFF0, 0x111); -+ /*Resp Tx by Txinfo*/ -+ odm_set_bb_reg(dm, R_0x6d8, 0xc0, 1); -+ } else { -+ /*Tx by Reg*/ -+ odm_set_bb_reg(dm, R_0x80c, 0xFFF0, 0x222); -+ /*Resp Tx by Txinfo*/ -+ odm_set_bb_reg(dm, R_0x6d8, 0xc0, 2); -+ } -+ } -+ p_div->default_tx_path = path; -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, "path=%s\n", -+ (path == BB_PATH_A) ? "A" : "B"); -+} -+ -+void phydm_path_diversity_init_8812a(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ u32 i; -+ -+ odm_set_bb_reg(dm, R_0x80c, BIT(29), 1); /* Tx path from Reg */ -+ odm_set_bb_reg(dm, R_0x80c, 0xFFF0, 0x111); /* Tx by Reg */ -+ odm_set_bb_reg(dm, R_0x6d8, BIT(7) | BIT6, 1); /* Resp Tx by Txinfo */ -+ phydm_set_tx_path_by_bb_reg(dm, RF_PATH_A); -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) -+ p_div->path_sel[i] = 1; /* TxInfo default at path-A */ -+} -+#endif -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+void phydm_set_resp_tx_path_by_fw_jgr3(void *dm_void, u8 macid, -+ enum bb_path path, boolean enable) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ u8 h2c_para[7] = {0}; -+ u8 path_map[4] = {0}; /* tx logic map*/ -+ u8 num_enable_path = 0; -+ u8 n_tx_path_ctrl_map = 0; -+ u8 i = 0, n_sts = 0; -+ -+ /*Response TX is controlled in FW ctrl info*/ -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] =====>\n", __func__); -+ -+ if (enable) { -+ n_tx_path_ctrl_map = path; -+ -+ for (i = 0; i < 4; i++) { -+ path_map[i] = 0; -+ if (path & BIT(i)) -+ num_enable_path++; -+ } -+ -+ for (i = 0; i < 4; i++) { -+ if (path & BIT(i)) { -+ path_map[i] = n_sts; -+ n_sts++; -+ -+ if (n_sts == num_enable_path) -+ break; -+ } -+ } -+ } -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, "ctrl_map=0x%x Map[D:A]={%d, %d, %d, %d}\n", -+ n_tx_path_ctrl_map, -+ path_map[3], path_map[2], path_map[1], path_map[0]); -+ -+ h2c_para[0] = macid; -+ h2c_para[1] = n_tx_path_ctrl_map; -+ h2c_para[2] = (path_map[3] << 6) | (path_map[2] << 4) | -+ (path_map[1] << 2) | path_map[0]; -+ -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_DYNAMIC_TX_PATH, 7, h2c_para); -+} -+ -+void phydm_get_tx_path_txdesc_jgr3(void *dm_void, u8 macid, -+ struct path_txdesc_ctrl *desc) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ u8 ant_map_a = 0, ant_map_b = 0; -+ u8 ntx_map = 0; -+ -+ if (p_div->path_sel[macid] == BB_PATH_A) { -+ desc->ant_map_a = 0; /*offest24[23:22]*/ -+ desc->ant_map_b = 0; /*offest24[25:24]*/ -+ desc->ntx_map = BB_PATH_A; /*offest28[23:20]*/ -+ } else if (p_div->path_sel[macid] == BB_PATH_B) { -+ desc->ant_map_a = 0; /*offest24[23:22]*/ -+ desc->ant_map_b = 0; /*offest24[25:24]*/ -+ desc->ntx_map = BB_PATH_B; /*offest28[23:20]*/ -+ } else { -+ desc->ant_map_a = 0; /*offest24[23:22]*/ -+ desc->ant_map_b = 1; /*offest24[25:24]*/ -+ desc->ntx_map = BB_PATH_AB; /*offest28[23:20]*/ -+ } -+} -+#endif -+ -+void phydm_tx_path_by_mac_or_reg(void *dm_void, enum phydm_path_ctrl ctrl) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] ctrl=%s\n", -+ __func__, (ctrl == TX_PATH_BY_REG) ? "REG" : "DESC"); -+ -+ if (ctrl == p_div->tx_path_ctrl) -+ return; -+ -+ p_div->tx_path_ctrl = ctrl; -+ -+ switch (dm->support_ic_type) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ case ODM_RTL8822B: -+ case ODM_RTL8822C: -+ case ODM_RTL8812F: -+ case ODM_RTL8197G: -+ if (ctrl == TX_PATH_BY_REG) { -+ odm_set_bb_reg(dm, R_0x1e24, BIT(16), 0); /*OFDM*/ -+ odm_set_bb_reg(dm, R_0x1a84, 0xe0, 0); /*CCK*/ -+ } else { -+ odm_set_bb_reg(dm, R_0x1e24, BIT(16), 1); /*OFDM*/ -+ odm_set_bb_reg(dm, R_0x1a84, 0xe0, 7); /*CCK*/ -+ } -+ -+ break; -+ #endif -+ #if 0 /*(RTL8822B_SUPPORT)*/ /*@ HW Bug*/ -+ case ODM_RTL8822B: -+ if (ctrl == TX_PATH_BY_REG) { -+ odm_set_bb_reg(dm, R_0x93c, BIT(18), 0); -+ odm_set_bb_reg(dm, R_0xa84, 0xe0, 0); /*CCK*/ -+ } else { -+ odm_set_bb_reg(dm, R_0x93c, BIT(18), 1); -+ odm_set_bb_reg(dm, R_0xa84, 0xe0, 7); /*CCK*/ -+ } -+ -+ break; -+ #endif -+ default: -+ break; -+ } -+} -+ -+void phydm_fix_1ss_tx_path_by_bb_reg(void *dm_void, -+ enum bb_path tx_path_sel_1ss, -+ enum bb_path tx_path_sel_cck) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ -+ if (tx_path_sel_1ss != BB_PATH_AUTO) { -+ p_div->ofdm_fix_path_en = true; -+ p_div->ofdm_fix_path_sel = tx_path_sel_1ss; -+ } else { -+ p_div->ofdm_fix_path_en = false; -+ p_div->ofdm_fix_path_sel = dm->tx_1ss_status; -+ } -+ -+ if (tx_path_sel_cck != BB_PATH_AUTO) { -+ p_div->cck_fix_path_en = true; -+ p_div->cck_fix_path_sel = tx_path_sel_cck; -+ } else { -+ p_div->cck_fix_path_en = false; -+ p_div->cck_fix_path_sel = dm->tx_1ss_status; -+ } -+ -+ p_div->force_update = true; -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ "{OFDM_fix_en=%d, path=%d} {CCK_fix_en=%d, path=%d}\n", -+ p_div->ofdm_fix_path_en, p_div->ofdm_fix_path_sel, -+ p_div->cck_fix_path_en, p_div->cck_fix_path_sel); -+} -+ -+void phydm_set_tx_path_by_bb_reg(void *dm_void, enum bb_path tx_path_sel_1ss) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ enum bb_path tx_path_sel_cck = tx_path_sel_1ss; -+ -+ if (!p_div->force_update) { -+ if (tx_path_sel_1ss == p_div->default_tx_path) { -+ PHYDM_DBG(dm, DBG_PATH_DIV, "Stay in TX path=%s\n", -+ (tx_path_sel_1ss == BB_PATH_A) ? "A" : "B"); -+ return; -+ } -+ } -+ p_div->force_update = false; -+ -+ p_div->default_tx_path = tx_path_sel_1ss; -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, "Switch TX path=%s\n", -+ (tx_path_sel_1ss == BB_PATH_A) ? "A" : "B"); -+ -+ /*Adv-ctrl mode*/ -+ if (p_div->cck_fix_path_en) { -+ PHYDM_DBG(dm, DBG_PATH_DIV, "Fix CCK TX path=%d\n", -+ p_div->cck_fix_path_sel); -+ tx_path_sel_cck = p_div->cck_fix_path_sel; -+ } -+ -+ if (p_div->ofdm_fix_path_en) { -+ PHYDM_DBG(dm, DBG_PATH_DIV, "Fix OFDM TX path=%d\n", -+ p_div->ofdm_fix_path_sel); -+ tx_path_sel_1ss = p_div->ofdm_fix_path_sel; -+ } -+ -+ switch (dm->support_ic_type) { -+ #if RTL8822C_SUPPORT -+ case ODM_RTL8822C: -+ phydm_config_tx_path_8822c(dm, dm->tx_2ss_status, -+ tx_path_sel_1ss, tx_path_sel_cck); -+ break; -+ #endif -+ -+ #if RTL8822B_SUPPORT -+ case ODM_RTL8822B: -+ if (dm->tx_ant_status != BB_PATH_AB) -+ return; -+ -+ phydm_config_tx_path_8822b(dm, BB_PATH_AB, -+ tx_path_sel_1ss, tx_path_sel_cck); -+ break; -+ #endif -+ -+ #if RTL8192F_SUPPORT -+ case ODM_RTL8192F: -+ if (dm->tx_ant_status != BB_PATH_AB) -+ return; -+ -+ phydm_config_tx_path_8192f(dm, BB_PATH_AB, -+ tx_path_sel_1ss, tx_path_sel_cck); -+ break; -+ #endif -+ -+ #if RTL8812A_SUPPORT -+ case ODM_RTL8812: -+ phydm_update_tx_path_8812a(dm, tx_path_sel_1ss); -+ break; -+ #endif -+ default: -+ break; -+ } -+} -+ -+void phydm_tx_path_diversity_2ss(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ struct cmn_sta_info *sta; -+ enum bb_path default_tx_path = BB_PATH_A, path = BB_PATH_A; -+ u32 rssi_a = 0, rssi_b = 0; -+ u32 local_max_rssi, glb_min_rssi = 0xff; -+ u8 i = 0; -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] =======>\n", __func__); -+ -+ if (!dm->is_linked) { -+ if (dm->first_disconnect) -+ phydm_tx_path_by_mac_or_reg(dm, TX_PATH_BY_REG); -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, "No Link\n"); -+ return; -+ } -+ -+ #if 0/*def PHYDM_IC_JGR3_SERIES_SUPPORT*/ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ if (dm->is_one_entry_only || p_div->cck_fix_path_en || -+ p_div->ofdm_fix_path_en) -+ phydm_tx_path_by_mac_or_reg(dm, TX_PATH_BY_REG); -+ else -+ phydm_tx_path_by_mac_or_reg(dm, TX_PATH_BY_DESC); -+ } -+ #endif -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ sta = dm->phydm_sta_info[i]; -+ if (!is_sta_active(sta)) -+ continue; -+ -+ /* 2 Caculate RSSI per path */ -+ rssi_a = PHYDM_DIV(p_div->path_a_sum[i], p_div->path_a_cnt[i]); -+ rssi_b = PHYDM_DIV(p_div->path_b_sum[i], p_div->path_b_cnt[i]); -+ -+ if (rssi_a == rssi_b) -+ path = p_div->default_tx_path; -+ else -+ path = (rssi_a > rssi_b) ? BB_PATH_A : BB_PATH_B; -+ -+ local_max_rssi = (rssi_a > rssi_b) ? rssi_a : rssi_b; -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ "[%d]PathA sum=%d, cnt=%d, avg_rssi=%d\n", -+ i, p_div->path_a_sum[i], -+ p_div->path_a_cnt[i], rssi_a); -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ "[%d]PathB sum=%d, cnt=%d, avg_rssi=%d\n", -+ i, p_div->path_b_sum[i], -+ p_div->path_b_cnt[i], rssi_b); -+ -+ /*Select default Tx path */ -+ if (local_max_rssi < glb_min_rssi) { -+ glb_min_rssi = local_max_rssi; -+ default_tx_path = path; -+ } -+ -+ if (p_div->path_sel[i] != path) { -+ p_div->path_sel[i] = path; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_set_resp_tx_path_by_fw_jgr3(dm, i, -+ path, true); -+ #endif -+ } -+ -+ p_div->path_a_cnt[i] = 0; -+ p_div->path_a_sum[i] = 0; -+ p_div->path_b_cnt[i] = 0; -+ p_div->path_b_sum[i] = 0; -+ } -+ -+ /* 2 Update default Tx path */ -+ phydm_set_tx_path_by_bb_reg(dm, default_tx_path); -+ PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] end\n\n", __func__); -+} -+ -+void phydm_tx_path_diversity(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ -+ p_div->path_div_in_progress = false; -+ -+ if (!(dm->support_ability & ODM_BB_PATH_DIV)) -+ return; -+ -+ if (p_div->stop_path_div) { -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ "stop_path_div=1, tx_1ss_status=%d\n", -+ dm->tx_1ss_status); -+ return; -+ } -+ -+ switch (dm->support_ic_type) { -+ #ifdef PHYDM_CONFIG_PATH_DIV_V2 -+ case ODM_RTL8822B: -+ case ODM_RTL8822C: -+ case ODM_RTL8192F: -+ case ODM_RTL8812F: -+ case ODM_RTL8197G: -+ if (dm->rx_ant_status != BB_PATH_AB) { -+ PHYDM_DBG(dm, DBG_PATH_DIV, -+ "[Return] tx_Path_en=%d, rx_Path_en=%d\n", -+ dm->tx_ant_status, dm->rx_ant_status); -+ return; -+ } -+ -+ p_div->path_div_in_progress = true; -+ phydm_tx_path_diversity_2ss(dm); -+ break; -+ #endif -+ -+ #if (RTL8812A_SUPPORT) -+ case ODM_RTL8812: -+ phydm_tx_path_diversity_2ss(dm); -+ break; -+ #endif -+ -+ #if RTL8814A_SUPPORT -+ case ODM_RTL8814A: -+ phydm_dynamic_tx_path(dm); -+ break; -+ #endif -+ } -+} -+ -+void phydm_tx_path_diversity_init_v2(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ u32 i = 0; -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] ====>\n", __func__); -+ -+ /*BB_PATH_AB is a invalid value used for init state*/ -+ p_div->default_tx_path = BB_PATH_A; -+ p_div->tx_path_ctrl = TX_PATH_CTRL_INIT; -+ p_div->path_div_in_progress = false; -+ -+ p_div->cck_fix_path_en = false; -+ p_div->ofdm_fix_path_en = false; -+ p_div->force_update = false; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) -+ p_div->path_sel[i] = BB_PATH_A; /* TxInfo default at path-A */ -+ -+ phydm_tx_path_by_mac_or_reg(dm, TX_PATH_BY_REG); -+} -+ -+void phydm_tx_path_diversity_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ability & ODM_BB_PATH_DIV)) -+ return; -+ -+ switch (dm->support_ic_type) { -+ #ifdef PHYDM_CONFIG_PATH_DIV_V2 -+ case ODM_RTL8822C: -+ case ODM_RTL8822B: -+ case ODM_RTL8192F: -+ case ODM_RTL8812F: -+ case ODM_RTL8197G: -+ phydm_tx_path_diversity_init_v2(dm); /*@ After 8822B*/ -+ break; -+ #endif -+ -+ #if RTL8812A_SUPPORT -+ case ODM_RTL8812: -+ phydm_path_diversity_init_8812a(dm); -+ break; -+ #endif -+ -+ #if RTL8814A_SUPPORT -+ case ODM_RTL8814A: -+ phydm_dynamic_tx_path_init(dm); -+ break; -+ #endif -+ } -+} -+ -+void phydm_process_rssi_for_path_div(void *dm_void, void *phy_info_void, -+ void *pkt_info_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_phyinfo_struct *phy_info = NULL; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ u8 id = 0; -+ -+ phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ -+ if (!(pktinfo->is_packet_to_self || pktinfo->is_packet_match_bssid)) -+ return; -+ -+ if (pktinfo->is_cck_rate) -+ return; -+ -+ id = pktinfo->station_id; -+ p_div->path_a_sum[id] += phy_info->rx_mimo_signal_strength[0]; -+ p_div->path_a_cnt[id]++; -+ -+ p_div->path_b_sum[id] += phy_info->rx_mimo_signal_strength[1]; -+ p_div->path_b_cnt[id]++; -+} -+ -+void phydm_pathdiv_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ char help[] = "-h"; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 val[10] = {0}; -+ u8 i, input_idx = 0; -+ -+ for (i = 0; i < 5; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &val[i]); -+ input_idx++; -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ PHYDM_SSCANF(input[1], DCMD_HEX, &val[0]); -+ PHYDM_SSCANF(input[2], DCMD_HEX, &val[1]); -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{1:TX Ctrl Sig} {0:BB, 1:MAC}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{2:BB Default TX REG} {path}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{3:MAC DESC TX} {path} {macid}\n"); -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{4:MAC Resp TX} {path} {macid}\n"); -+ #endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{5:Fix 1ss path} {ofdm path} {cck path}\n"); -+ } else if (val[0] == 1) { -+ phydm_tx_path_by_mac_or_reg(dm, (enum phydm_path_ctrl)val[1]); -+ } else if (val[0] == 2) { -+ phydm_set_tx_path_by_bb_reg(dm, (enum bb_path)val[1]); -+ } else if (val[0] == 3) { -+ p_div->path_sel[val[2]] = (enum bb_path)val[1]; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ } else if (val[0] == 4) { -+ phydm_set_resp_tx_path_by_fw_jgr3(dm, (u8)val[2], -+ (enum bb_path)val[1], true); -+ #endif -+ } else if (val[0] == 5) { -+ phydm_fix_1ss_tx_path_by_bb_reg(dm, (enum bb_path)val[1], -+ (enum bb_path)val[2]); -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_c2h_dtp_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; -+ -+ u8 macid = cmd_buf[0]; -+ u8 target = cmd_buf[1]; -+ u8 nsc_1 = cmd_buf[2]; -+ u8 nsc_2 = cmd_buf[3]; -+ u8 nsc_3 = cmd_buf[4]; -+ -+ PHYDM_DBG(dm, DBG_PATH_DIV, "Target_candidate = (( %d ))\n", target); -+/*@ -+ if( (nsc_1 >= nsc_2) && (nsc_1 >= nsc_3)) -+ { -+ phydm_dtp_fix_tx_path(dm, p_div->ant_candidate_1); -+ } -+ else if( nsc_2 >= nsc_3) -+ { -+ phydm_dtp_fix_tx_path(dm, p_div->ant_candidate_2); -+ } -+ else -+ { -+ phydm_dtp_fix_tx_path(dm, p_div->ant_candidate_3); -+ } -+ */ -+} -+ -+#endif /* @#ifdef CONFIG_PATH_DIVERSITY */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pathdiv.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pathdiv.h -new file mode 100644 -index 000000000..ee3438252 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pathdiv.h -@@ -0,0 +1,145 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMPATHDIV_H__ -+#define __PHYDMPATHDIV_H__ -+ -+#ifdef CONFIG_PATH_DIVERSITY -+/* @2019.03.07 open resp tx path h2c only for 1ss status*/ -+#define PATHDIV_VERSION "4.4" -+ -+#if (RTL8192F_SUPPORT || RTL8822B_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8812F_SUPPORT || RTL8197G_SUPPORT) -+ #define PHYDM_CONFIG_PATH_DIV_V2 -+#endif -+ -+#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 -+ -+enum phydm_dtp_state { -+ PHYDM_DTP_INIT = 1, -+ PHYDM_DTP_RUNNING_1 -+}; -+ -+enum phydm_path_div_type { -+ PHYDM_2R_PATH_DIV = 1, -+ PHYDM_4R_PATH_DIV = 2 -+}; -+ -+enum phydm_path_ctrl { -+ TX_PATH_BY_REG = 0, -+ TX_PATH_BY_DESC = 1, -+ TX_PATH_CTRL_INIT -+}; -+ -+struct path_txdesc_ctrl { -+ u8 ant_map_a : 2; -+ u8 ant_map_b : 2; -+ u8 ntx_map : 4; -+}; -+ -+struct _ODM_PATH_DIVERSITY_ { -+ boolean stop_path_div; /*@Limit by enabled path number*/ -+ boolean path_div_in_progress; -+ boolean cck_fix_path_en; /*@ BB Reg for Adv-Ctrl (or debug mode)*/ -+ boolean ofdm_fix_path_en; /*@ BB Reg for Adv-Ctrl (or debug mode)*/ -+ enum bb_path cck_fix_path_sel; /*@ BB Reg for Adv-Ctrl (or debug mode)*/ -+ enum bb_path ofdm_fix_path_sel;/*@ BB Reg for Adv-Ctrl (or debug mode)*/ -+ enum phydm_path_ctrl tx_path_ctrl; -+ enum bb_path default_tx_path; -+ enum bb_path path_sel[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 path_a_sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u32 path_b_sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u16 path_a_cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u16 path_b_cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u8 phydm_path_div_type; -+ boolean force_update; -+#if RTL8814A_SUPPORT -+ -+ u32 path_a_sum_all; -+ u32 path_b_sum_all; -+ u32 path_c_sum_all; -+ u32 path_d_sum_all; -+ -+ u32 path_a_cnt_all; -+ u32 path_b_cnt_all; -+ u32 path_c_cnt_all; -+ u32 path_d_cnt_all; -+ -+ u8 dtp_period; -+ boolean is_become_linked; -+ boolean is_u3_mode; -+ u8 num_tx_path; -+ u8 default_path; -+ u8 num_candidate; -+ u8 ant_candidate_1; -+ u8 ant_candidate_2; -+ u8 ant_candidate_3; -+ u8 phydm_dtp_state; -+ u8 dtp_check_patha_counter; -+ boolean fix_path_bfer; -+ u8 search_space_2[NUM_CHOOSE2_FROM4]; -+ u8 search_space_3[NUM_CHOOSE3_FROM4]; -+ -+ u8 pre_tx_path; -+ u8 use_path_a_as_default_ant; -+ boolean is_path_a_exist; -+ -+#endif -+}; -+ -+void phydm_set_tx_path_by_bb_reg(void *dm_void, enum bb_path tx_path_sel_1ss); -+ -+void phydm_get_tx_path_txdesc_jgr3(void *dm_void, u8 macid, -+ struct path_txdesc_ctrl *desc); -+ -+void phydm_c2h_dtp_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len); -+ -+void phydm_tx_path_diversity_init(void *dm_void); -+ -+void phydm_tx_path_diversity(void *dm_void); -+ -+void phydm_process_rssi_for_path_div(void *dm_void, void *phy_info_void, -+ void *pkt_info_void); -+ -+void phydm_pathdiv_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+#endif /* @#ifdef CONFIG_PATH_DIVERSITY */ -+#endif /* @#ifndef __PHYDMPATHDIV_H__ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_phystatus.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_phystatus.c -new file mode 100644 -index 000000000..8d1ed66df ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_phystatus.c -@@ -0,0 +1,3247 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef PHYDM_COMPILE_MU -+u8 phydm_get_gid(struct dm_struct *dm, u8 *phy_status_inf) -+{ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) -+ struct phy_sts_rpt_jgr2_type1 *rpt_jgr2 = NULL; -+#endif -+#ifdef PHYSTS_3RD_TYPE_SUPPORT -+ struct phy_sts_rpt_jgr3_type1 *rpt_jgr3 = NULL; -+#endif -+ u8 gid = 0; -+ -+ if (dm->ic_phy_sts_type == PHYDM_PHYSTS_TYPE_1) -+ return 0; -+ -+ if ((*phy_status_inf & 0xf) != 1) -+ return 0; -+ -+ switch (dm->ic_phy_sts_type) { -+ #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) -+ case PHYDM_PHYSTS_TYPE_2: -+ rpt_jgr2 = (struct phy_sts_rpt_jgr2_type1 *)phy_status_inf; -+ gid = rpt_jgr2->gid; -+ break; -+ #endif -+ #ifdef PHYSTS_3RD_TYPE_SUPPORT -+ case PHYDM_PHYSTS_TYPE_3: -+ rpt_jgr3 = (struct phy_sts_rpt_jgr3_type1 *)phy_status_inf; -+ gid = rpt_jgr3->gid; -+ break; -+ #endif -+ default: -+ break; -+ } -+ -+ return gid; -+} -+#endif -+ -+void phydm_rx_statistic_cal(struct dm_struct *dm, -+ struct phydm_phyinfo_struct *phy_info, -+ u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo) -+{ -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ struct phydm_bf_rate_info_jgr3 *bfrateinfo = &dm->bf_rate_info_jgr3; -+#endif -+ -+ u8 rate = (pktinfo->data_rate & 0x7f); -+ u8 bw_idx = phy_info->band_width; -+ u8 offset = 0; -+ u8 gid = 0; -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT || defined(PHYSTS_3RD_TYPE_SUPPORT)) -+ u8 val = 0; -+#endif -+ #ifdef PHYDM_COMPILE_MU -+ u8 is_mu_pkt = 0; -+ #endif -+ -+ if (rate <= ODM_RATE54M) { -+ dbg_i->num_qry_legacy_pkt[rate]++; -+ } else if (rate <= ODM_RATEMCS31) { -+ dbg_i->ht_pkt_not_zero = true; -+ offset = rate - ODM_RATEMCS0; -+ -+ if (offset > (HT_RATE_NUM - 1)) -+ offset = HT_RATE_NUM - 1; -+ -+ if (dm->support_ic_type & -+ (PHYSTS_2ND_TYPE_IC | PHYSTS_3RD_TYPE_IC)) { -+ if (bw_idx == *dm->band_width) { -+ dbg_i->num_qry_ht_pkt[offset]++; -+ -+ } else if (bw_idx == CHANNEL_WIDTH_20) { -+ dbg_i->num_qry_pkt_sc_20m[offset]++; -+ dbg_i->low_bw_20_occur = true; -+ } -+ } else { -+ dbg_i->num_qry_ht_pkt[offset]++; -+ } -+ } -+#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYSTS_3RD_TYPE_SUPPORT)) -+ else if (rate <= ODM_RATEVHTSS4MCS9) { -+ offset = rate - ODM_RATEVHTSS1MCS0; -+ -+ if (offset > (VHT_RATE_NUM - 1)) -+ offset = VHT_RATE_NUM - 1; -+ -+ #ifdef PHYDM_COMPILE_MU -+ gid = phydm_get_gid(dm, phy_status_inf); -+ -+ if (gid != 0 && gid != 63) -+ is_mu_pkt = true; -+ -+ if (is_mu_pkt) { -+ #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT ||\ -+ (defined(PHYSTS_3RD_TYPE_SUPPORT))) -+ dbg_i->num_mu_vht_pkt[offset]++; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ bfrateinfo->num_mu_vht_pkt[offset]++; -+ #endif -+ #else -+ dbg_i->num_qry_vht_pkt[offset]++; /*@for debug*/ -+ #endif -+ } else -+ #endif -+ { -+ dbg_i->vht_pkt_not_zero = true; -+ -+ if (dm->support_ic_type & -+ (PHYSTS_2ND_TYPE_IC | PHYSTS_3RD_TYPE_IC)) { -+ if (bw_idx == *dm->band_width) { -+ dbg_i->num_qry_vht_pkt[offset]++; -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ bfrateinfo->num_qry_vht_pkt[offset]++; -+ #endif -+ -+ } else if (bw_idx == CHANNEL_WIDTH_20) { -+ dbg_i->num_qry_pkt_sc_20m[offset]++; -+ dbg_i->low_bw_20_occur = true; -+ } else {/*@if (bw_idx == CHANNEL_WIDTH_40)*/ -+ dbg_i->num_qry_pkt_sc_40m[offset]++; -+ dbg_i->low_bw_40_occur = true; -+ } -+ } else { -+ dbg_i->num_qry_vht_pkt[offset]++; -+ } -+ } -+ -+ #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT ||\ -+ (defined(PHYSTS_3RD_TYPE_SUPPORT))) -+ if (pktinfo->ppdu_cnt < 4) { -+ val = rate; -+ -+ #ifdef PHYDM_COMPILE_MU -+ if (is_mu_pkt) -+ val |= BIT(7); -+ #endif -+ -+ dbg_i->num_of_ppdu[pktinfo->ppdu_cnt] = val; -+ dbg_i->gid_num[pktinfo->ppdu_cnt] = gid; -+ } -+ #endif -+ } -+#endif -+} -+ -+void phydm_reset_phystatus_avg(struct dm_struct *dm) -+{ -+ struct phydm_phystatus_avg *dbg_avg = NULL; -+ -+ dbg_avg = &dm->phy_dbg_info.phystatus_statistic_avg; -+ odm_memory_set(dm, &dbg_avg->rssi_cck_avg, 0, -+ sizeof(struct phydm_phystatus_avg)); -+} -+ -+void phydm_reset_phystatus_statistic(struct dm_struct *dm) -+{ -+ struct phydm_phystatus_statistic *dbg_s = NULL; -+ -+ dbg_s = &dm->phy_dbg_info.physts_statistic_info; -+ -+ odm_memory_set(dm, &dbg_s->rssi_cck_sum, 0, -+ sizeof(struct phydm_phystatus_statistic)); -+} -+ -+void phydm_reset_phy_info(struct dm_struct *dm, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ u8 i = 0; -+ -+ odm_memory_set(dm, &phy_info->physts_rpt_valid, 0, -+ sizeof(struct phydm_phyinfo_struct)); -+ -+ phy_info->rx_power = -110; -+ phy_info->recv_signal_power = -110; -+ -+ for (i = 0; i < dm->num_rf_path; i++) -+ phy_info->rx_pwr[i] = -110; -+} -+ -+void phydm_avg_rssi_evm_snr(void *dm_void, -+ struct phydm_phyinfo_struct *phy_info, -+ struct phydm_perpkt_info_struct *pktinfo) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; -+ u8 *rssi = phy_info->rx_mimo_signal_strength; -+ u8 *evm = phy_info->rx_mimo_evm_dbm; -+ s8 *snr = phy_info->rx_snr; -+ u32 size = PHYSTS_PATH_NUM; /*size of path=4*/ -+ u16 size_th = PHY_HIST_SIZE - 1; /*size of threshold*/ -+ u16 val = 0, intvl = 0; -+ u8 i = 0; -+ -+ if (pktinfo->is_packet_beacon) { -+ for (i = 0; i < dm->num_rf_path; i++) -+ dbg_s->rssi_beacon_sum[i] += rssi[i]; -+ -+ dbg_s->rssi_beacon_cnt++; -+ } -+ -+ if (pktinfo->data_rate <= ODM_RATE11M) { -+ /*RSSI*/ -+ dbg_s->rssi_cck_sum += rssi[0]; -+ #if (defined(PHYSTS_3RD_TYPE_SUPPORT) && defined(PHYDM_COMPILE_ABOVE_2SS)) -+ if (dm->support_ic_type & PHYSTS_3RD_TYPE_IC) { -+ for (i = 1; i < dm->num_rf_path; i++) -+ dbg_s->rssi_cck_sum_abv_2ss[i - 1] += rssi[i]; -+ } -+ #endif -+ dbg_s->rssi_cck_cnt++; -+ } else if (pktinfo->data_rate <= ODM_RATE54M) { -+ for (i = 0; i < dm->num_rf_path; i++) { -+ /*SNR & RSSI*/ -+ dbg_s->snr_ofdm_sum[i] += snr[i]; -+ dbg_s->rssi_ofdm_sum[i] += rssi[i]; -+ } -+ /*@evm*/ -+ dbg_s->evm_ofdm_sum += evm[0]; -+ dbg_s->rssi_ofdm_cnt++; -+ -+ val = (u16)evm[0]; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->evm_hist_th, size_th); -+ dbg_s->evm_ofdm_hist[intvl]++; -+ -+ val = (u16)snr[0]; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->snr_hist_th, size_th); -+ dbg_s->snr_ofdm_hist[intvl]++; -+ -+ } else if (pktinfo->rate_ss == 1) { -+/*@===[1-SS]==================================================================*/ -+ for (i = 0; i < dm->num_rf_path; i++) { -+ /*SNR & RSSI*/ -+ dbg_s->snr_1ss_sum[i] += snr[i]; -+ dbg_s->rssi_1ss_sum[i] += rssi[i]; -+ } -+ -+ /*@evm*/ -+ dbg_s->evm_1ss_sum += evm[0]; -+ /*@EVM Histogram*/ -+ val = (u16)evm[0]; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->evm_hist_th, size_th); -+ dbg_s->evm_1ss_hist[intvl]++; -+ -+ /*SNR Histogram*/ -+ val = (u16)snr[0]; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->snr_hist_th, size_th); -+ dbg_s->snr_1ss_hist[intvl]++; -+ -+ dbg_s->rssi_1ss_cnt++; -+ } else if (pktinfo->rate_ss == 2) { -+/*@===[2-SS]==================================================================*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ for (i = 0; i < dm->num_rf_path; i++) { -+ /*SNR & RSSI*/ -+ dbg_s->snr_2ss_sum[i] += snr[i]; -+ dbg_s->rssi_2ss_sum[i] += rssi[i]; -+ } -+ -+ for (i = 0; i < pktinfo->rate_ss; i++) { -+ /*@evm*/ -+ dbg_s->evm_2ss_sum[i] += evm[i]; -+ /*@EVM Histogram*/ -+ val = (u16)evm[i]; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->evm_hist_th, -+ size_th); -+ dbg_s->evm_2ss_hist[i][intvl]++; -+ -+ /*SNR Histogram*/ -+ val = (u16)snr[i]; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->snr_hist_th, -+ size_th); -+ dbg_s->snr_2ss_hist[i][intvl]++; -+ } -+ dbg_s->rssi_2ss_cnt++; -+ #endif -+ } else if (pktinfo->rate_ss == 3) { -+/*@===[3-SS]==================================================================*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ for (i = 0; i < dm->num_rf_path; i++) { -+ /*SNR & RSSI*/ -+ dbg_s->snr_3ss_sum[i] += snr[i]; -+ dbg_s->rssi_3ss_sum[i] += rssi[i]; -+ } -+ -+ for (i = 0; i < pktinfo->rate_ss; i++) { -+ /*@evm*/ -+ dbg_s->evm_3ss_sum[i] += evm[i]; -+ /*@EVM Histogram*/ -+ val = (u16)evm[i]; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->evm_hist_th, -+ size_th); -+ dbg_s->evm_3ss_hist[i][intvl]++; -+ -+ /*SNR Histogram*/ -+ val = (u16)snr[i]; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->snr_hist_th, -+ size_th); -+ dbg_s->snr_3ss_hist[i][intvl]++; -+ } -+ dbg_s->rssi_3ss_cnt++; -+ #endif -+ } else if (pktinfo->rate_ss == 4) { -+/*@===[4-SS]==================================================================*/ -+ #if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ for (i = 0; i < dm->num_rf_path; i++) { -+ /*SNR & RSSI*/ -+ dbg_s->snr_4ss_sum[i] += snr[i]; -+ dbg_s->rssi_4ss_sum[i] += rssi[i]; -+ } -+ -+ for (i = 0; i < pktinfo->rate_ss; i++) { -+ /*@evm*/ -+ dbg_s->evm_4ss_sum[i] += evm[i]; -+ -+ /*@EVM Histogram*/ -+ val = (u16)evm[i]; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->evm_hist_th, -+ size_th); -+ dbg_s->evm_4ss_hist[i][intvl]++; -+ -+ /*SNR Histogram*/ -+ val = (u16)snr[i]; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->snr_hist_th, -+ size_th); -+ dbg_s->snr_4ss_hist[i][intvl]++; -+ } -+ dbg_s->rssi_4ss_cnt++; -+ #endif -+ } -+} -+ -+void phydm_avg_phystatus_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ u16 snr_hist_th[PHY_HIST_TH_SIZE] = {5, 8, 11, 14, 17, 20, 23, 26, -+ 29, 32, 35}; -+ u16 evm_hist_th[PHY_HIST_TH_SIZE] = {5, 8, 11, 14, 17, 20, 23, 26, -+ 29, 32, 35}; -+ #ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ u16 cn_hist_th[PHY_HIST_TH_SIZE] = {2, 3, 4, 5, 6, 8, 10, -+ 12, 14, 16, 18}; -+ #endif -+ u32 size = PHY_HIST_TH_SIZE * 2; -+ u8 i = 0; -+ -+ odm_move_memory(dm, dbg_i->snr_hist_th, snr_hist_th, size); -+ odm_move_memory(dm, dbg_i->evm_hist_th, evm_hist_th, size); -+ #ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ dm->pkt_proc_struct.physts_auto_swch_en = false; -+ for (i = 0; i < PHY_HIST_TH_SIZE; i++) -+ dbg_i->cn_hist_th[i] = cn_hist_th[i] << 1; -+ #endif -+} -+ -+u8 phydm_get_signal_quality(struct phydm_phyinfo_struct *phy_info, -+ struct dm_struct *dm, -+ struct phy_status_rpt_8192cd *phy_sts) -+{ -+ u8 sq_rpt; -+ u8 result = 0; -+ -+ if (phy_info->rx_pwdb_all > 40 && !dm->is_in_hct_test) { -+ result = 100; -+ } else { -+ sq_rpt = phy_sts->cck_sig_qual_ofdm_pwdb_all; -+ -+ if (sq_rpt > 64) -+ result = 0; -+ else if (sq_rpt < 20) -+ result = 100; -+ else -+ result = ((64 - sq_rpt) * 100) / 44; -+ } -+ -+ return result; -+} -+ -+u8 phydm_pw_2_percent(s8 ant_power) -+{ -+ if ((ant_power <= -100) || ant_power >= 20) -+ return 0; -+ else if (ant_power >= 0) -+ return 100; -+ else -+ return 100 + ant_power; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+void phydm_process_signal_strength(struct dm_struct *dm, -+ struct phydm_phyinfo_struct *phy_info, -+ struct phydm_perpkt_info_struct *pktinfo) -+{ -+ boolean is_cck_rate = 0; -+ u8 avg_rssi = 0, tmp_rssi = 0, best_rssi = 0, second_rssi = 0; -+ u8 ss = 0; /*signal strenth after scale mapping*/ -+ u8 pwdb = phy_info->rx_pwdb_all; -+ u8 i; -+ -+ is_cck_rate = (pktinfo->data_rate <= ODM_RATE11M) ? true : false; -+ -+ /*use the best two RSSI only*/ -+ for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { -+ tmp_rssi = phy_info->rx_mimo_signal_strength[i]; -+ -+ /*@Get the best two RSSI*/ -+ if (tmp_rssi > best_rssi && tmp_rssi > second_rssi) { -+ second_rssi = best_rssi; -+ best_rssi = tmp_rssi; -+ } else if (tmp_rssi > second_rssi && tmp_rssi <= best_rssi) { -+ second_rssi = tmp_rssi; -+ } -+ } -+ -+ if (best_rssi == 0) -+ return; -+ -+ if (pktinfo->rate_ss == 1) -+ avg_rssi = best_rssi; -+ else -+ avg_rssi = (best_rssi + second_rssi) >> 1; -+ -+ /* Update signal strength to UI, -+ * and phy_info->rx_pwdb_all is the maximum RSSI of all path -+ */ -+ if (dm->support_ic_type & (PHYSTS_3RD_TYPE_IC | PHYSTS_2ND_TYPE_IC)) -+ ss = SignalScaleProc(dm->adapter, pwdb, false, false); -+ else -+ ss = SignalScaleProc(dm->adapter, pwdb, true, is_cck_rate); -+ -+ phy_info->signal_strength = ss; -+} -+ -+static u8 phydm_sq_patch_lenovo( -+ struct dm_struct *dm, -+ u8 is_cck_rate, -+ u8 pwdb_all, -+ u8 path, -+ u8 RSSI) -+{ -+ u8 sq = 0; -+ -+ if (is_cck_rate) { -+ if (dm->support_ic_type & ODM_RTL8192E) { -+/*@ -+ * -+ * 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 (dm->support_ic_type & ODM_RTL8192E) { -+ 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; -+ } -+ } -+ return sq; -+} -+ -+static u8 phydm_sq_patch_rt_cid_819x_acer( -+ struct dm_struct *dm, -+ u8 is_cck_rate, -+ u8 pwdb_all, -+ u8 path, -+ u8 RSSI) -+{ -+ u8 sq = 0; -+ -+ if (is_cck_rate) { -+#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; -+ -+ /* @Abnormal case, do not indicate the value above 20 on Win7 */ -+ if (pwdb_all == 0) -+ sq = 20; -+#endif -+ -+ } else { -+ /* OFDM rate */ -+ if (dm->support_ic_type & ODM_RTL8192E) { -+ 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; -+ } -+ } -+ return sq; -+} -+#endif -+ -+static u8 -+phydm_evm_2_percent(s8 value) -+{ -+ /* @-33dB~0dB to 0%~99% */ -+ s8 ret_val; -+ -+ ret_val = value; -+ ret_val /= 2; -+ -+/*@dbg_print("value=%d\n", value);*/ -+#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 (u8)ret_val; -+} -+ -+s8 phydm_cck_rssi_convert(struct dm_struct *dm, u16 lna_idx, u8 vga_idx) -+{ -+ /*@phydm_get_cck_rssi_table_from_reg*/ -+ return (dm->cck_lna_gain_table[lna_idx] - (vga_idx << 1)); -+} -+ -+void phydm_get_cck_rssi_table_from_reg(struct dm_struct *dm) -+{ -+ u8 used_lna_idx_tmp; -+ u32 reg_0xa80 = 0x7431, reg_0xabc = 0xcbe5edfd; -+ u32 val = 0; -+ u8 i; -+ -+ /*@example: {-53, -43, -33, -27, -19, -13, -3, 1}*/ -+ /*@{0xCB, 0xD5, 0xDF, 0xE5, 0xED, 0xF3, 0xFD, 0x2}*/ -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "CCK LNA Gain table init\n"); -+ -+ if (!(dm->support_ic_type & ODM_RTL8197F)) -+ return; -+ -+ reg_0xa80 = odm_get_bb_reg(dm, R_0xa80, 0xFFFF); -+ reg_0xabc = odm_get_bb_reg(dm, R_0xabc, MASKDWORD); -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "reg_0xa80 = 0x%x\n", reg_0xa80); -+ PHYDM_DBG(dm, ODM_COMP_INIT, "reg_0xabc = 0x%x\n", reg_0xabc); -+ -+ for (i = 0; i <= 3; i++) { -+ used_lna_idx_tmp = (u8)((reg_0xa80 >> (4 * i)) & 0x7); -+ val = (reg_0xabc >> (8 * i)) & 0xff; -+ dm->cck_lna_gain_table[used_lna_idx_tmp] = (s8)val; -+ } -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "cck_lna_gain_table = {%d,%d,%d,%d,%d,%d,%d,%d}\n", -+ dm->cck_lna_gain_table[0], dm->cck_lna_gain_table[1], -+ dm->cck_lna_gain_table[2], dm->cck_lna_gain_table[3], -+ dm->cck_lna_gain_table[4], dm->cck_lna_gain_table[5], -+ dm->cck_lna_gain_table[6], dm->cck_lna_gain_table[7]); -+} -+ -+s8 phydm_get_cck_rssi(void *dm_void, u8 lna_idx, u8 vga_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ s8 rx_pow = 0; -+ -+ switch (dm->support_ic_type) { -+ #if (RTL8197F_SUPPORT) -+ case ODM_RTL8197F: -+ rx_pow = phydm_cck_rssi_convert(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8723D_SUPPORT) -+ case ODM_RTL8723D: -+ rx_pow = phydm_cckrssi_8723d(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8710B_SUPPORT) -+ case ODM_RTL8710B: -+ rx_pow = phydm_cckrssi_8710b(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8721D_SUPPORT) -+ case ODM_RTL8721D: -+ rx_pow = phydm_cckrssi_8721d(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8710C_SUPPORT) -+ case ODM_RTL8710C: -+ rx_pow = phydm_cckrssi_8710c(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8192F_SUPPORT) -+ case ODM_RTL8192F: -+ rx_pow = phydm_cckrssi_8192f(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8821C_SUPPORT) -+ case ODM_RTL8821C: -+ rx_pow = phydm_cck_rssi_8821c(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8195B_SUPPORT) -+ case ODM_RTL8195B: -+ rx_pow = phydm_cck_rssi_8195B(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8188E_SUPPORT) -+ case ODM_RTL8188E: -+ rx_pow = phydm_cck_rssi_8188e(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8192E_SUPPORT) -+ case ODM_RTL8192E: -+ rx_pow = phydm_cck_rssi_8192e(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8723B_SUPPORT) -+ case ODM_RTL8723B: -+ rx_pow = phydm_cck_rssi_8723b(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8703B_SUPPORT) -+ case ODM_RTL8703B: -+ rx_pow = phydm_cck_rssi_8703b(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8188F_SUPPORT) -+ case ODM_RTL8188F: -+ rx_pow = phydm_cck_rssi_8188f(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8195A_SUPPORT) -+ case ODM_RTL8195A: -+ rx_pow = phydm_cck_rssi_8195a(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8812A_SUPPORT) -+ case ODM_RTL8812: -+ rx_pow = phydm_cck_rssi_8812a(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8821A_SUPPORT || RTL8881A_SUPPORT) -+ case ODM_RTL8821: -+ case ODM_RTL8881A: -+ rx_pow = phydm_cck_rssi_8821a(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ #if (RTL8814A_SUPPORT) -+ case ODM_RTL8814A: -+ rx_pow = phydm_cck_rssi_8814a(dm, lna_idx, vga_idx); -+ break; -+ #endif -+ -+ default: -+ break; -+ } -+ -+ return rx_pow; -+} -+ -+#if (ODM_IC_11N_SERIES_SUPPORT) -+void phydm_phy_sts_n_parsing(struct dm_struct *dm, -+ struct phydm_phyinfo_struct *phy_info, -+ u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo) -+{ -+ u8 i = 0; -+ s8 rx_pwr[4], rx_pwr_all = 0; -+ u8 EVM, pwdb_all = 0, pwdb_all_bt = 0; -+ u8 RSSI, total_rssi = 0; -+ u8 rf_rx_num = 0; -+ u8 lna_idx = 0; -+ u8 vga_idx = 0; -+ u8 cck_agc_rpt; -+ s8 evm_tmp = 0; -+ u8 sq = 0; -+ u8 val_tmp = 0; -+ s8 val_s8 = 0; -+ struct phy_status_rpt_8192cd *phy_sts = NULL; -+ -+ phy_sts = (struct phy_status_rpt_8192cd *)phy_status_inf; -+ -+ if (pktinfo->is_cck_rate) { -+ cck_agc_rpt = phy_sts->cck_agc_rpt_ofdm_cfosho_a; -+ -+ /*@3 bit LNA*/ -+ lna_idx = ((cck_agc_rpt & 0xE0) >> 5); -+ vga_idx = (cck_agc_rpt & 0x1F); -+ -+ #if (RTL8703B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8703B) && -+ dm->cck_agc_report_type == 1) { -+ /*@4 bit LNA*/ -+ if (phy_sts->cck_rpt_b_ofdm_cfosho_b & BIT(7)) -+ val_tmp = 1; -+ else -+ val_tmp = 0; -+ lna_idx = (val_tmp << 3) | lna_idx; -+ } -+ #endif -+ -+ rx_pwr_all = phydm_get_cck_rssi(dm, lna_idx, vga_idx); -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, -+ "ext_lna_gain (( %d )), lna_idx: (( 0x%x )), vga_idx: (( 0x%x )), rx_pwr_all: (( %d ))\n", -+ dm->ext_lna_gain, lna_idx, vga_idx, rx_pwr_all); -+ -+ if (dm->board_type & ODM_BOARD_EXT_LNA) -+ rx_pwr_all -= dm->ext_lna_gain; -+ -+ pwdb_all = phydm_pw_2_percent(rx_pwr_all); -+ -+ if (pktinfo->is_to_self) { -+ dm->cck_lna_idx = lna_idx; -+ dm->cck_vga_idx = vga_idx; -+ } -+ -+ phy_info->rx_pwdb_all = pwdb_all; -+ phy_info->bt_rx_rssi_percentage = pwdb_all; -+ phy_info->recv_signal_power = rx_pwr_all; -+ -+ /* @(3) Get Signal Quality (EVM) */ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) -+ sq = phydm_sq_patch_lenovo(dm, pktinfo->is_cck_rate, pwdb_all, 0, 0); -+ else if (dm->iot_table.win_patch_id == RT_CID_819X_ACER) -+ sq = phydm_sq_patch_rt_cid_819x_acer(dm, pktinfo->is_cck_rate, pwdb_all, 0, 0); -+ else -+ #endif -+ sq = phydm_get_signal_quality(phy_info, dm, phy_sts); -+ -+ /* @dbg_print("cck sq = %d\n", sq); */ -+ -+ phy_info->signal_quality = sq; -+ phy_info->rx_mimo_signal_quality[RF_PATH_A] = sq; -+ phy_info->rx_mimo_signal_quality[RF_PATH_B] = -1; -+ -+ for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { -+ if (i == 0) -+ phy_info->rx_mimo_signal_strength[0] = pwdb_all; -+ else -+ phy_info->rx_mimo_signal_strength[i] = 0; -+ } -+ } else { /* @2 is OFDM rate */ -+ -+ /* @(1)Get RSSI for HT rate */ -+ -+ for (i = RF_PATH_A; i < dm->num_rf_path; i++) { -+ if (dm->rf_path_rx_enable & BIT(i)) -+ rf_rx_num++; -+ -+ val_s8 = phy_sts->path_agc[i].gain & 0x3F; -+ rx_pwr[i] = (val_s8 * 2) - 110; -+ -+ if (pktinfo->is_to_self) -+ dm->ofdm_agc_idx[i] = val_s8; -+ -+ phy_info->rx_pwr[i] = rx_pwr[i]; -+ RSSI = phydm_pw_2_percent(rx_pwr[i]); -+ total_rssi += RSSI; -+ -+ phy_info->rx_mimo_signal_strength[i] = (u8)RSSI; -+ -+ /* @Get Rx snr value in DB */ -+ val_s8 = (s8)(phy_sts->path_rxsnr[i] / 2); -+ phy_info->rx_snr[i] = val_s8; -+ -+ /* Record Signal Strength for next packet */ -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (i == RF_PATH_A) { -+ if (dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) { -+ phy_info->signal_quality = phydm_sq_patch_lenovo(dm, pktinfo->is_cck_rate, pwdb_all, i, RSSI); -+ } else if (dm->iot_table.win_patch_id == RT_CID_819X_ACER) -+ phy_info->signal_quality = phydm_sq_patch_rt_cid_819x_acer(dm, pktinfo->is_cck_rate, pwdb_all, 0, RSSI); -+ } -+ #endif -+ } -+ -+ /* @(2)PWDB, Average PWDB calculated by hardware (for RA) */ -+ val_s8 = phy_sts->cck_sig_qual_ofdm_pwdb_all >> 1; -+ rx_pwr_all = (val_s8 & 0x7f) - 110; -+ -+ pwdb_all = phydm_pw_2_percent(rx_pwr_all); -+ pwdb_all_bt = pwdb_all; -+ -+ phy_info->rx_pwdb_all = pwdb_all; -+ phy_info->bt_rx_rssi_percentage = pwdb_all_bt; -+ phy_info->rx_power = rx_pwr_all; -+ phy_info->recv_signal_power = rx_pwr_all; -+ -+ /* @(3)EVM of HT rate */ -+ for (i = 0; i < pktinfo->rate_ss; 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 (i >= PHYDM_MAX_RF_PATH_N) -+ break; -+ -+ EVM = phydm_evm_2_percent(phy_sts->stream_rxevm[i]); -+ -+ /*@Fill value in RFD, Get the 1st spatial stream only*/ -+ if (i == RF_PATH_A) -+ phy_info->signal_quality = (u8)(EVM & 0xff); -+ -+ phy_info->rx_mimo_signal_quality[i] = (u8)(EVM & 0xff); -+ -+ if (phy_sts->stream_rxevm[i] < 0) -+ evm_tmp = 0 - phy_sts->stream_rxevm[i]; -+ -+ if (evm_tmp == 64) -+ evm_tmp = 0; -+ -+ phy_info->rx_mimo_evm_dbm[i] = (u8)evm_tmp; -+ } -+ phydm_parsing_cfo(dm, pktinfo, -+ phy_sts->path_cfotail, pktinfo->rate_ss); -+ } -+ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->ant_sel; -+ dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->ant_sel_b; -+ dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antsel_rx_keep_2; -+ #endif -+} -+#endif -+ -+#if ODM_IC_11AC_SERIES_SUPPORT -+static s16 -+phydm_cfo(s8 value) -+{ -+ s16 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 | BIT(12); /*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; -+} -+ -+static u8 -+phydm_evm_dbm(s8 value) -+{ -+ s8 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 (u8)ret_val; -+} -+ -+void phydm_rx_physts_bw_parsing(struct phydm_phyinfo_struct *phy_info, -+ struct phydm_perpkt_info_struct * -+ pktinfo, -+ struct phy_status_rpt_8812 * -+ phy_sts) -+{ -+ if (pktinfo->data_rate > ODM_RATE54M) { -+ switch (phy_sts->r_RFMOD) { -+ case 1: -+ if (phy_sts->sub_chnl == 0) -+ phy_info->band_width = 1; -+ else -+ phy_info->band_width = 0; -+ break; -+ -+ case 2: -+ if (phy_sts->sub_chnl == 0) -+ phy_info->band_width = 2; -+ else if (phy_sts->sub_chnl == 9 || -+ phy_sts->sub_chnl == 10) -+ phy_info->band_width = 1; -+ else -+ phy_info->band_width = 0; -+ break; -+ -+ default: -+ case 0: -+ phy_info->band_width = 0; -+ break; -+ } -+ } -+} -+ -+void phydm_get_sq(struct dm_struct *dm, struct phydm_phyinfo_struct *phy_info, -+ u8 is_cck_rate) -+{ -+ u8 sq = 0; -+ u8 pwdb_all = phy_info->rx_pwdb_all; /*precentage*/ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ u8 rssi = phy_info->rx_mimo_signal_strength[0]; -+ #endif -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) { -+ if (is_cck_rate) -+ sq = phydm_sq_patch_lenovo(dm, 1, pwdb_all, 0, 0); -+ else -+ sq = phydm_sq_patch_lenovo(dm, 0, pwdb_all, 0, rssi); -+ } else -+ #endif -+ { -+ if (is_cck_rate) { -+ if (pwdb_all > 40 && !dm->is_in_hct_test) { -+ sq = 100; -+ } else { -+ if (pwdb_all > 64) -+ sq = 0; -+ else if (pwdb_all < 20) -+ sq = 100; -+ else -+ sq = ((64 - pwdb_all) * 100) / 44; -+ } -+ } else { -+ sq = phy_info->rx_mimo_signal_quality[0]; -+ } -+ } -+ -+#if 0 -+ /* @dbg_print("cck sq = %d\n", sq); */ -+#endif -+ phy_info->signal_quality = sq; -+} -+ -+void phydm_rx_physts_1st_type(struct dm_struct *dm, -+ struct phydm_phyinfo_struct *phy_info, -+ u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo) -+{ -+ u8 i = 0; -+ s8 rx_pwr_db = 0; -+ u8 val = 0; /*tmp value*/ -+ s8 val_s8 = 0; /*tmp value*/ -+ u8 rssi = 0; /*pre path RSSI*/ -+ u8 rf_rx_num = 0; -+ u8 lna_idx = 0, vga_idx = 0; -+ u8 cck_agc_rpt = 0; -+ struct phy_status_rpt_8812 *phy_sts = NULL; -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ #endif -+ -+ phy_sts = (struct phy_status_rpt_8812 *)phy_status_inf; -+ phydm_rx_physts_bw_parsing(phy_info, pktinfo, phy_sts); -+ -+ /* @== [CCK rate] ====================================================*/ -+ if (pktinfo->is_cck_rate) { -+ cck_agc_rpt = phy_sts->cfosho[0]; -+ lna_idx = (cck_agc_rpt & 0xE0) >> 5; -+ vga_idx = cck_agc_rpt & 0x1F; -+ -+ rx_pwr_db = phydm_get_cck_rssi(dm, lna_idx, vga_idx); -+ rssi = phydm_pw_2_percent(rx_pwr_db); -+ -+ if (dm->support_ic_type == ODM_RTL8812 && -+ !dm->is_cck_high_power) { -+ if (rssi >= 80) { -+ rssi = ((rssi - 80) << 1) + -+ ((rssi - 80) >> 1) + 80; -+ } else if ((rssi <= 78) && (rssi >= 20)) { -+ rssi += 3; -+ } -+ } -+ dm->cck_lna_idx = lna_idx; -+ dm->cck_vga_idx = vga_idx; -+ -+ phy_info->rx_pwdb_all = rssi; -+ phy_info->rx_mimo_signal_strength[0] = rssi; -+ } else { -+ /* @== [OFDM rate] ===================================================*/ -+ for (i = RF_PATH_A; i < dm->num_rf_path; i++) { -+ /*@[RSSI]*/ -+ if (dm->rf_path_rx_enable & BIT(i)) -+ rf_rx_num++; -+ -+ if (i < RF_PATH_C) -+ val = phy_sts->gain_trsw[i]; -+ else -+ val = phy_sts->gain_trsw_cd[i - 2]; -+ -+ phy_info->rx_pwr[i] = (val & 0x7F) - 110; -+ rssi = phydm_pw_2_percent(phy_info->rx_pwr[i]); -+ phy_info->rx_mimo_signal_strength[i] = rssi; -+ -+ /*@[SNR]*/ -+ if (i < RF_PATH_C) -+ val_s8 = phy_sts->rxsnr[i]; -+ else if (dm->support_ic_type & (ODM_RTL8814A)) -+ val_s8 = (s8)phy_sts->csi_current[i - 2]; -+ -+ phy_info->rx_snr[i] = val_s8 >> 1; -+ -+ /*@[CFO_short & CFO_tail]*/ -+ if (i < RF_PATH_C) { -+ val_s8 = phy_sts->cfosho[i]; -+ phy_info->cfo_short[i] = phydm_cfo(val_s8); -+ val_s8 = phy_sts->cfotail[i]; -+ phy_info->cfo_tail[i] = phydm_cfo(val_s8); -+ } -+ -+ if (i < RF_PATH_C && pktinfo->is_to_self) -+ dm->ofdm_agc_idx[i] = phy_sts->gain_trsw[i]; -+ } -+ -+ /* @== [PWDB] ========================================================*/ -+ -+ /*@(Avg PWDB calculated by hardware*/ -+ if (!dm->is_mp_chip) /*@8812, 8821*/ -+ val = phy_sts->pwdb_all; -+ else -+ val = phy_sts->pwdb_all >> 1; /*old fomula*/ -+ -+ rx_pwr_db = (val & 0x7f) - 110; -+ phy_info->rx_pwdb_all = phydm_pw_2_percent(rx_pwr_db); -+ -+ /*@(4)EVM of OFDM rate*/ -+ for (i = 0; i < pktinfo->rate_ss; i++) { -+ if (!pktinfo->is_cck_rate && -+ pktinfo->data_rate <= ODM_RATE54M) { -+ val_s8 = phy_sts->sigevm; -+ } else if (i < RF_PATH_C) { -+ if (phy_sts->rxevm[i] == -128) -+ phy_sts->rxevm[i] = -25; -+ -+ val_s8 = phy_sts->rxevm[i]; -+ } else { -+ if (phy_sts->rxevm_cd[i - 2] == -128) -+ phy_sts->rxevm_cd[i - 2] = -25; -+ -+ val_s8 = phy_sts->rxevm_cd[i - 2]; -+ } -+ /*@[EVM to 0~100%]*/ -+ val = phydm_evm_2_percent(val_s8); -+ phy_info->rx_mimo_signal_quality[i] = val; -+ /*@[EVM dBm]*/ -+ phy_info->rx_mimo_evm_dbm[i] = phydm_evm_dbm(val_s8); -+ } -+ phydm_parsing_cfo(dm, pktinfo, -+ phy_sts->cfotail, pktinfo->rate_ss); -+ } -+ -+ /* @== [General Info] ================================================*/ -+ -+ phy_info->rx_power = rx_pwr_db; -+ phy_info->bt_rx_rssi_percentage = phy_info->rx_pwdb_all; -+ phy_info->recv_signal_power = phy_info->rx_power; -+ phydm_get_sq(dm, phy_info, pktinfo->is_cck_rate); -+ -+ dm->rx_pwdb_ave = dm->rx_pwdb_ave + phy_info->rx_pwdb_all; -+ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ fat_tab->hw_antsw_occur = phy_sts->hw_antsw_occur; -+ dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_anta; -+ dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_antb; -+ dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_antc; -+ dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_antd; -+ #endif -+} -+ -+#endif -+ -+void phydm_reset_rssi_for_dm(struct dm_struct *dm, u8 station_id) -+{ -+ struct cmn_sta_info *sta; -+ -+ sta = dm->phydm_sta_info[station_id]; -+ -+ if (!is_sta_active(sta)) -+ return; -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "Reset RSSI for macid = (( %d ))\n", -+ station_id); -+ -+ sta->rssi_stat.rssi_cck = -1; -+ sta->rssi_stat.rssi_ofdm = -1; -+ sta->rssi_stat.rssi = -1; -+ sta->rssi_stat.ofdm_pkt_cnt = 0; -+ sta->rssi_stat.cck_pkt_cnt = 0; -+ sta->rssi_stat.cck_sum_power = 0; -+ sta->rssi_stat.is_send_rssi = RA_RSSI_STATE_INIT; -+ sta->rssi_stat.packet_map = 0; -+ sta->rssi_stat.valid_bit = 0; -+} -+ -+#if (ODM_IC_11N_SERIES_SUPPORT || ODM_IC_11AC_SERIES_SUPPORT) -+ -+s32 phydm_get_rssi_8814_ofdm(struct dm_struct *dm, u8 *rssi_in) -+{ -+ s32 rssi_avg; -+ u8 rx_count = 0; -+ u64 rssi_linear = 0; -+ -+ if (dm->rx_ant_status & BB_PATH_A) { -+ rx_count++; -+ rssi_linear += phydm_db_2_linear(rssi_in[RF_PATH_A]); -+ } -+ -+ if (dm->rx_ant_status & BB_PATH_B) { -+ rx_count++; -+ rssi_linear += phydm_db_2_linear(rssi_in[RF_PATH_B]); -+ } -+ -+ if (dm->rx_ant_status & BB_PATH_C) { -+ rx_count++; -+ rssi_linear += phydm_db_2_linear(rssi_in[RF_PATH_C]); -+ } -+ -+ if (dm->rx_ant_status & BB_PATH_D) { -+ rx_count++; -+ rssi_linear += phydm_db_2_linear(rssi_in[RF_PATH_D]); -+ } -+ -+ /* @Rounding and removing fractional bits */ -+ rssi_linear = (rssi_linear + (1 << (FRAC_BITS - 1))) >> FRAC_BITS; -+ -+ /* @Calculate average RSSI */ -+ switch (rx_count) { -+ case 2: -+ rssi_linear = DIVIDED_2(rssi_linear); -+ break; -+ case 3: -+ rssi_linear = DIVIDED_3(rssi_linear); -+ break; -+ case 4: -+ rssi_linear = DIVIDED_4(rssi_linear); -+ break; -+ } -+ rssi_avg = odm_convert_to_db(rssi_linear); -+ -+ return rssi_avg; -+} -+ -+void phydm_process_rssi_for_dm(struct dm_struct *dm, -+ struct phydm_phyinfo_struct *phy_info, -+ struct phydm_perpkt_info_struct *pktinfo) -+{ -+ s32 rssi_ave = 0; /*@average among all paths*/ -+ s8 rssi_all = 0; /*@average value of CCK & OFDM*/ -+ s8 rssi_cck_tmp = 0, rssi_ofdm_tmp = 0; -+ u8 i = 0; -+ u8 rssi_max = 0, rssi_min = 0; -+ u32 w1 = 0, w2 = 0; /*weighting*/ -+ u8 send_rssi_2_fw = 0; -+ u8 *rssi_tmp = NULL; -+ struct cmn_sta_info *sta = NULL; -+ struct rssi_info *rssi_t = NULL; -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ #endif -+ #endif -+ -+ if (pktinfo->station_id >= ODM_ASSOCIATE_ENTRY_NUM) -+ return; -+ -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_s0s1_sw_ant_div_by_ctrl_frame_process_rssi(dm, phy_info, pktinfo); -+ #endif -+ -+ sta = dm->phydm_sta_info[pktinfo->station_id]; -+ -+ if (!is_sta_active(sta)) -+ return; -+ -+ rssi_t = &sta->rssi_stat; -+ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ if ((dm->support_ability & ODM_BB_ANT_DIV) && -+ fat_tab->enable_ctrl_frame_antdiv) { -+ if (pktinfo->is_packet_match_bssid) -+ dm->data_frame_num++; -+ -+ if (fat_tab->use_ctrl_frame_antdiv) { -+ if (!pktinfo->is_to_self) /*@data frame + CTRL frame*/ -+ return; -+ } else { -+ /*@data frame only*/ -+ if (!pktinfo->is_packet_match_bssid) -+ return; -+ } -+ } else -+ #endif -+ #endif -+ { -+ if (!pktinfo->is_packet_match_bssid) /*@data frame only*/ -+ return; -+ } -+ -+ if (pktinfo->is_packet_beacon) { -+ dm->phy_dbg_info.num_qry_beacon_pkt++; -+ dm->phy_dbg_info.beacon_phy_rate = pktinfo->data_rate; -+ } -+ -+ /* @--------------Statistic for antenna/path diversity--------------- */ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ if (dm->antdiv_evm_en) -+ phydm_rx_rate_for_antdiv(dm, pktinfo); -+ #endif -+ -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ if (dm->support_ability & ODM_BB_ANT_DIV) -+ odm_process_rssi_for_ant_div(dm, phy_info, pktinfo); -+ #endif -+ -+ #if (defined(CONFIG_PATH_DIVERSITY)) -+ if (dm->support_ability & ODM_BB_PATH_DIV) -+ phydm_process_rssi_for_path_div(dm, phy_info, pktinfo); -+ #endif -+ /* @----------------------------------------------------------------- */ -+ -+ rssi_cck_tmp = rssi_t->rssi_cck; -+ rssi_ofdm_tmp = rssi_t->rssi_ofdm; -+ rssi_all = rssi_t->rssi; -+ -+ if (!(pktinfo->is_packet_to_self || pktinfo->is_packet_beacon)) -+ return; -+ -+ if (!pktinfo->is_cck_rate) { -+/* @=== [ofdm RSSI] ======================================================== */ -+ rssi_tmp = phy_info->rx_mimo_signal_strength; -+ -+ #if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type & (ODM_RTL8814A)) { -+ rssi_ave = phydm_get_rssi_8814_ofdm(dm, rssi_tmp); -+ } else -+ #endif -+ { -+ if (rssi_tmp[RF_PATH_B] == 0) { -+ rssi_ave = rssi_tmp[RF_PATH_A]; -+ } else { -+ if (rssi_tmp[RF_PATH_A] > rssi_tmp[RF_PATH_B]) { -+ rssi_max = rssi_tmp[RF_PATH_A]; -+ rssi_min = rssi_tmp[RF_PATH_B]; -+ } else { -+ rssi_max = rssi_tmp[RF_PATH_B]; -+ rssi_min = rssi_tmp[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; -+ } -+ } -+ -+ /* OFDM MA RSSI */ -+ if (rssi_ofdm_tmp <= 0) { /* @initialize */ -+ rssi_ofdm_tmp = (s8)phy_info->rx_pwdb_all; -+ } else { -+ rssi_ofdm_tmp = (s8)WEIGHTING_AVG(rssi_ofdm_tmp, -+ (1 << RSSI_MA) - 1, -+ rssi_ave, 1); -+ if (phy_info->rx_pwdb_all > (u32)rssi_ofdm_tmp) -+ rssi_ofdm_tmp++; -+ } -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "rssi_ofdm=%d\n", rssi_ofdm_tmp); -+ } else { -+/* @=== [cck RSSI] ========================================================= */ -+ rssi_ave = phy_info->rx_pwdb_all; -+ -+ if (rssi_t->cck_pkt_cnt <= 63) -+ rssi_t->cck_pkt_cnt++; -+ -+ /* @1 Process CCK RSSI */ -+ if (rssi_cck_tmp <= 0) { /* @initialize */ -+ rssi_cck_tmp = (s8)phy_info->rx_pwdb_all; -+ rssi_t->cck_sum_power = (u16)phy_info->rx_pwdb_all; -+ rssi_t->cck_pkt_cnt = 1; /*reset*/ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "[1]CCK_INIT\n"); -+ } else if (rssi_t->cck_pkt_cnt <= CCK_RSSI_INIT_COUNT) { -+ rssi_t->cck_sum_power = rssi_t->cck_sum_power + -+ (u16)phy_info->rx_pwdb_all; -+ -+ rssi_cck_tmp = rssi_t->cck_sum_power / -+ rssi_t->cck_pkt_cnt; -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, -+ "[2]SumPow=%d, cck_pkt=%d\n", -+ rssi_t->cck_sum_power, rssi_t->cck_pkt_cnt); -+ } else { -+ rssi_cck_tmp = (s8)WEIGHTING_AVG(rssi_cck_tmp, -+ (1 << RSSI_MA) - 1, -+ phy_info->rx_pwdb_all, -+ 1); -+ if (phy_info->rx_pwdb_all > (u32)rssi_cck_tmp) -+ rssi_cck_tmp++; -+ } -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "rssi_cck=%d\n", rssi_cck_tmp); -+ } -+ -+/* @=== [ofdm + cck weighting RSSI] ========================================= */ -+ if (!pktinfo->is_cck_rate) { -+ if (rssi_t->ofdm_pkt_cnt < 8 && !(rssi_t->packet_map & BIT(7))) -+ rssi_t->ofdm_pkt_cnt++; /*OFDM packet cnt in bitmap*/ -+ -+ rssi_t->packet_map = (rssi_t->packet_map << 1) | BIT(0); -+ } else { -+ if (rssi_t->ofdm_pkt_cnt > 0 && rssi_t->packet_map & BIT(7)) -+ rssi_t->ofdm_pkt_cnt--; -+ -+ rssi_t->packet_map = rssi_t->packet_map << 1; -+ } -+ -+ if (rssi_t->ofdm_pkt_cnt == 8) { -+ rssi_all = rssi_ofdm_tmp; -+ } else { -+ if (rssi_t->valid_bit < 8) -+ rssi_t->valid_bit++; -+ -+ if (rssi_t->valid_bit == 8) { -+ if (rssi_t->ofdm_pkt_cnt > 4) -+ w1 = 64; -+ else -+ w1 = (u32)(rssi_t->ofdm_pkt_cnt << 4); -+ -+ w2 = 64 - w1; -+ -+ rssi_all = (s8)((w1 * (u32)rssi_ofdm_tmp + -+ w2 * (u32)rssi_cck_tmp) >> 6); -+ } else if (rssi_t->valid_bit != 0) { /*@(valid_bit > 8)*/ -+ w1 = (u32)rssi_t->ofdm_pkt_cnt; -+ w2 = (u32)(rssi_t->valid_bit - rssi_t->ofdm_pkt_cnt); -+ rssi_all = (s8)WEIGHTING_AVG((u32)rssi_ofdm_tmp, w1, -+ (u32)rssi_cck_tmp, w2); -+ } else { -+ rssi_all = 0; -+ } -+ } -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "rssi=%d,w1=%d,w2=%d\n", rssi_all, w1, w2); -+ -+ if ((rssi_t->ofdm_pkt_cnt >= 1 || rssi_t->cck_pkt_cnt >= 5) && -+ rssi_t->is_send_rssi == RA_RSSI_STATE_INIT) { -+ send_rssi_2_fw = 1; -+ rssi_t->is_send_rssi = RA_RSSI_STATE_SEND; -+ } -+ -+ rssi_t->rssi_cck = rssi_cck_tmp; -+ rssi_t->rssi_ofdm = rssi_ofdm_tmp; -+ rssi_t->rssi = rssi_all; -+ -+ if (send_rssi_2_fw) { /* Trigger init rate by RSSI */ -+ if (rssi_t->ofdm_pkt_cnt != 0) -+ rssi_t->rssi = rssi_ofdm_tmp; -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, -+ "[Send to FW] PWDB=%d, ofdm_pkt=%d, cck_pkt=%d\n", -+ rssi_all, rssi_t->ofdm_pkt_cnt, rssi_t->cck_pkt_cnt); -+ } -+ -+#if 0 -+ /* @dbg_print("ofdm_pkt=%d, weighting=%d\n", ofdm_pkt_cnt, weighting);*/ -+ /* @dbg_print("rssi_ofdm_tmp=%d, rssi_all=%d, rssi_cck_tmp=%d\n", */ -+ /* rssi_ofdm_tmp, rssi_all, rssi_cck_tmp); */ -+#endif -+} -+#endif -+ -+#ifdef PHYSTS_3RD_TYPE_SUPPORT -+#ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+void phydm_physts_auto_switch_jgr3_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct pkt_process_info *pkt_proc = &dm->pkt_proc_struct; -+ -+ pkt_proc->phy_ppdu_cnt = 0xff; -+ pkt_proc->mac_ppdu_cnt = 0xff; -+ pkt_proc->page_bitmap_record = 0; -+} -+ -+boolean phydm_physts_auto_switch_jgr3(void *dm_void, u8 *phy_sts, -+ struct phydm_perpkt_info_struct *pktinfo) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct pkt_process_info *pkt_proc = &dm->pkt_proc_struct; -+ boolean is_skip_physts_parsing = false; -+ u8 phy_sts_byte0 = (*phy_sts & 0xff); -+ u8 phy_ppdu_cnt_pre = 0, mac_ppdu_cnt_pre = 0; -+ u8 ppdu_phy_rate_pre = 0, ppdu_macid_pre = 0; -+ u8 page = phy_sts_byte0 & 0xf; -+ -+ if (!pkt_proc->physts_auto_swch_en) -+ return is_skip_physts_parsing; -+ -+ phy_ppdu_cnt_pre = pkt_proc->phy_ppdu_cnt; -+ mac_ppdu_cnt_pre = pkt_proc->mac_ppdu_cnt; -+ ppdu_phy_rate_pre = pkt_proc->ppdu_phy_rate; -+ ppdu_macid_pre = pkt_proc->ppdu_macid; -+ -+ pkt_proc->phy_ppdu_cnt = (phy_sts_byte0 & 0x30) >> 4; -+ pkt_proc->mac_ppdu_cnt = pktinfo->ppdu_cnt; -+ pkt_proc->ppdu_phy_rate = pktinfo->data_rate; -+ pkt_proc->ppdu_macid = pktinfo->station_id; -+ -+ PHYDM_DBG(dm, DBG_PHY_STATUS, -+ "[rate:0x%x] PPDU mac{pre, curr}= {%d, %d}, phy{pre, curr}= {%d, %d}\n", -+ pktinfo->data_rate, mac_ppdu_cnt_pre, pkt_proc->mac_ppdu_cnt, -+ phy_ppdu_cnt_pre, pkt_proc->phy_ppdu_cnt); -+ -+ if (pktinfo->data_rate < ODM_RATEMCS0) { -+ pkt_proc->page_bitmap_record = 0; -+ return is_skip_physts_parsing; -+ } -+ -+ if (ppdu_macid_pre == pkt_proc->ppdu_macid && -+ ppdu_phy_rate_pre == pkt_proc->ppdu_phy_rate && -+ phy_ppdu_cnt_pre == pkt_proc->phy_ppdu_cnt && -+ mac_ppdu_cnt_pre == pkt_proc->mac_ppdu_cnt) { -+ if (pkt_proc->page_bitmap_record & BIT(page)) { -+ /*@PHYDM_DBG(dm, DBG_PHY_STATUS, "collect page-%d enough\n", page);*/ -+ is_skip_physts_parsing = true; -+ } else if (pkt_proc->page_bitmap_record == -+ pkt_proc->page_bitmap_target) { -+ /*@PHYDM_DBG(dm, DBG_PHY_STATUS, "collect all enough\n");*/ -+ is_skip_physts_parsing = true; -+ } else { -+ /*@PHYDM_DBG(dm, DBG_PHY_STATUS, "update page-%d\n", page);*/ -+ pkt_proc->page_bitmap_record |= BIT(page); -+ } -+ pkt_proc->is_1st_mpdu = false; -+ } else { -+ /*@PHYDM_DBG(dm, DBG_PHY_STATUS, "[New Pkt] update page-%d\n", page);*/ -+ pkt_proc->page_bitmap_record = BIT(page); -+ pkt_proc->is_1st_mpdu = true; -+ } -+ -+ PHYDM_DBG(dm, DBG_PHY_STATUS, -+ "bitmap{record, target}= {0x%x, 0x%x}\n", -+ pkt_proc->page_bitmap_record, -+ pkt_proc->page_bitmap_target); -+ -+ return is_skip_physts_parsing; -+} -+ -+void phydm_physts_auto_switch_jgr3_set(void *dm_void, boolean enable, -+ u8 bitmap_en) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct pkt_process_info *pkt_proc = &dm->pkt_proc_struct; -+ u16 en_page_num = 1; -+ -+ if (!(dm->support_ic_type & PHYSTS_AUTO_SWITCH_IC)) -+ return; -+#if 0 -+ if (!(dm->support_ic_type & PHYSTS_3RD_TYPE_IC)) -+ return; -+#endif -+ pkt_proc->physts_auto_swch_en = enable; -+ pkt_proc->page_bitmap_target = bitmap_en; -+ phydm_physts_auto_switch_jgr3_reset(dm); -+ en_page_num = phydm_ones_num_in_bitmap((u64)bitmap_en, 8); -+ -+ PHYDM_DBG(dm, DBG_CMN, "[%s]en=%d, bitmap_en=%d, en_page_num=%d\n", -+ __func__, enable, bitmap_en, en_page_num); -+ -+ if (enable) { -+ /*@per MPDU latch & update phy-staatus*/ -+ odm_set_mac_reg(dm, R_0x60c, BIT(31), 1); -+ /*@Update Period (OFDM Symbol)*/ -+ odm_set_bb_reg(dm, R_0x8c0, 0xfc000, 3); -+ /*@switchin bitmap*/ -+ odm_set_bb_reg(dm, R_0x8c4, 0x7f80000, bitmap_en); -+ /*@mode 3*/ -+ odm_set_bb_reg(dm, R_0x8c4, (BIT(28) | BIT(27)), 3); -+ } else { -+ odm_set_mac_reg(dm, R_0x60c, BIT(31), 0); -+ odm_set_bb_reg(dm, R_0x8c0, 0xfc000, 0x1); -+ odm_set_bb_reg(dm, R_0x8c4, 0x7f80000, 0x2); -+ odm_set_bb_reg(dm, R_0x8c4, (BIT(28) | BIT(27)), 0); -+ } -+} -+ -+void phydm_avg_condi_num(void *dm_void, -+ struct phydm_phyinfo_struct *phy_info, -+ struct phydm_perpkt_info_struct *pktinfo) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; -+ u16 size_th = PHY_HIST_SIZE - 1; /*size of threshold*/ -+ u16 val = 0, intvl = 0; -+ u8 arry_idx = 0; -+ -+ if (pktinfo->rate_ss == 1) -+ return; -+ -+ arry_idx = pktinfo->rate_ss - 1; -+ -+ dbg_s->p4_cnt[arry_idx]++; -+ dbg_s->cn_sum[arry_idx] += dbg_i->condition_num_seg0; -+ -+ /*CN Histogram*/ -+ val = (u16)dbg_i->condition_num_seg0; -+ intvl = phydm_find_intrvl(dm, val, dbg_i->cn_hist_th, size_th); -+ dbg_s->cn_hist[arry_idx][intvl]++; -+ -+ dbg_i->condi_num = (u32)dbg_i->condition_num_seg0; /*will remove*/ -+} -+#endif -+ -+void phydm_print_phystat_jgr3(struct dm_struct *dm, u8 *phy_sts, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ struct phy_sts_rpt_jgr3_type0 *rpt0 = NULL; -+ struct phy_sts_rpt_jgr3_type1 *rpt1 = NULL; -+ struct phy_sts_rpt_jgr3_type2_3 *rpt2 = NULL; -+ struct phy_sts_rpt_jgr3_type4 *rpt3 = NULL; -+ struct phy_sts_rpt_jgr3_type5 *rpt4 = NULL; -+ struct phy_sts_rpt_jgr3_type6 *rpt5 = NULL; -+ -+ struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; -+ u8 phy_status_page_num = (*phy_sts & 0xf); -+ u32 *phy_status_tmp = NULL; -+ u8 i = 0; -+ /*u32 size = PHY_STATUS_JRGUAR3_DW_LEN << 2;*/ -+ -+ if (!(dm->debug_components & DBG_PHY_STATUS)) -+ return; -+ -+ rpt0 = (struct phy_sts_rpt_jgr3_type0 *)phy_sts; -+ rpt1 = (struct phy_sts_rpt_jgr3_type1 *)phy_sts; -+ rpt2 = (struct phy_sts_rpt_jgr3_type2_3 *)phy_sts; -+ rpt3 = (struct phy_sts_rpt_jgr3_type4 *)phy_sts; -+ rpt4 = (struct phy_sts_rpt_jgr3_type5 *)phy_sts; -+ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ rpt5 = (struct phy_sts_rpt_jgr3_type6 *)phy_sts; -+ -+ if (pktinfo->is_cck_rate) -+ phy_status_page_num = 0; -+ } -+ -+ phy_status_tmp = (u32 *)phy_sts; -+ -+ if (dbg->show_phy_sts_all_pkt == 0) { -+ if (!pktinfo->is_packet_match_bssid) -+ return; -+ } -+ -+ dbg->show_phy_sts_cnt++; -+ -+ if (dbg->show_phy_sts_max_cnt != SHOW_PHY_STATUS_UNLIMITED) { -+ if (dbg->show_phy_sts_cnt > dbg->show_phy_sts_max_cnt) -+ return; -+ } -+ -+ if (phy_status_page_num == 0) -+ pr_debug("Phy Status Rpt: CCK\n"); -+ else -+ pr_debug("Phy Status Rpt: OFDM_%d\n", phy_status_page_num); -+ -+ pr_debug("StaID=%d, RxRate = 0x%x match_bssid=%d, ppdu_cnt=%d\n", -+ pktinfo->station_id, pktinfo->data_rate, -+ pktinfo->is_packet_match_bssid, pktinfo->ppdu_cnt); -+ -+ for (i = 0; i < PHY_STATUS_JRGUAR3_DW_LEN; i++) -+ pr_debug("Offset[%d:%d] = 0x%x\n", -+ ((4 * i) + 3), (4 * i), phy_status_tmp[i]); -+ -+ if (phy_status_page_num == 0) { /* @CCK(default) */ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ #if (RTL8723F_SUPPORT) -+ pr_debug("[0] Pop_idx=%d, Pkt_cnt=%d, Channel_msb=%d, AGC_table_path0=%d, TRSW_mux_keep=%d, HW_AntSW_occur_keep_cck=%d, Gnt_BT_keep_cnt=%d,Rssi_msb=%d\n", -+ rpt5->pop_idx, rpt5->pkt_cnt, -+ rpt5->channel_msb, rpt5->agc_table_a, -+ rpt5->trsw, rpt5->hw_antsw_occur_keep_cck, -+ rpt5->gnt_bt_keep_cck, rpt5->rssi_msb); -+ pr_debug("[4] Channel=%d, Antidx_CCK_keep=%d, Cck_mp_gain_idx_keep=%d\n", -+ rpt5->channel, rpt5->antidx_a, -+ rpt5->mp_gain_idx_a); -+ pr_debug("[8] Rssi=%d\n",rpt5->rssi); -+ pr_debug("[12] Avg_cfo=%d\n",rpt5->avg_cfo); -+ pr_debug("[16] Coarse_cfo=%d, Coarse_cfo_msb=%d, Avg_cfo_msb=%d, Evm_hdr=%d\n", -+ rpt5->coarse_cfo, rpt5->coarse_cfo_msb, -+ rpt5->avg_cfo_msb, rpt5->evm_hdr); -+ pr_debug("[20] Evm_pld=%d\n",rpt5->evm_pld); -+ #endif -+ } else { -+ pr_debug("[0] Pkt_cnt=%d, Channel_msb=%d, Pwdb_a=%d, Gain_a=%d, TRSW=%d, AGC_table_b=%d, AGC_table_c=%d,\n", -+ rpt0->pkt_cnt, rpt0->channel_msb, rpt0->pwdb_a, -+ rpt0->gain_a, rpt0->trsw, rpt0->agc_table_b, -+ rpt0->agc_table_c); -+ pr_debug("[4] Path_Sel_o=%d, Gnt_BT_keep_cnt=%d, HW_AntSW_occur_keep_cck=%d,\n Band=%d, Channel=%d, AGC_table_a=%d, l_RXSC=%d, AGC_table_d=%d\n", -+ rpt0->path_sel_o, rpt0->gnt_bt_keep_cck, -+ rpt0->hw_antsw_occur_keep_cck, rpt0->band, -+ rpt0->channel, rpt0->agc_table_a, rpt0->l_rxsc, -+ rpt0->agc_table_d); -+ pr_debug("[8] AntIdx={%d, %d, %d, %d}, Length=%d\n", -+ rpt0->antidx_d, rpt0->antidx_c, rpt0->antidx_b, -+ rpt0->antidx_a, rpt0->length); -+ pr_debug("[12] MF_off=%d, SQloss=%d, lockbit=%d, raterr=%d, rxrate=%d, lna_h_a=%d, CCK_BB_power_a=%d, lna_l_a=%d, vga_a=%d, sq=%d\n", -+ rpt0->mf_off, rpt0->sqloss, rpt0->lockbit, -+ rpt0->raterr, rpt0->rxrate, rpt0->lna_h_a, -+ rpt0->bb_power_a, rpt0->lna_l_a, rpt0->vga_a, -+ rpt0->signal_quality); -+ pr_debug("[16] Gain_b=%d, lna_h_b=%d, CCK_BB_power_b=%d, lna_l_b=%d, vga_b=%d, Pwdb_b=%d\n", -+ rpt0->gain_b, rpt0->lna_h_b, rpt0->bb_power_b, -+ rpt0->lna_l_b, rpt0->vga_b, rpt0->pwdb_b); -+ pr_debug("[20] Gain_c=%d, lna_h_c=%d, CCK_BB_power_c=%d, lna_l_c=%d, vga_c=%d, Pwdb_c=%d\n", -+ rpt0->gain_c, rpt0->lna_h_c, rpt0->bb_power_c, -+ rpt0->lna_l_c, rpt0->vga_c, rpt0->pwdb_c); -+ pr_debug("[24] Gain_d=%d, lna_h_d=%d, CCK_BB_power_d=%d, lna_l_d=%d, vga_d=%d, Pwdb_d=%d\n", -+ rpt0->gain_c, rpt0->lna_h_c, rpt0->bb_power_c, -+ rpt0->lna_l_c, rpt0->vga_c, rpt0->pwdb_c); -+ } -+ } else if (phy_status_page_num == 1) { -+ pr_debug("[0] pwdb[C:A]={%d, %d, %d}, Channel_pri_msb=%d, Pkt_cnt=%d,\n", -+ rpt1->pwdb_c, rpt1->pwdb_b, rpt1->pwdb_a, -+ rpt1->channel_pri_msb, rpt1->pkt_cnt); -+ pr_debug("[4] BF: %d, stbc=%d, ldpc=%d, gnt_bt=%d, band=%d, Ch_pri_lsb=%d, rxsc[ht, l]={%d, %d}, pwdb[D]=%d\n", -+ rpt1->beamformed, rpt1->stbc, rpt1->ldpc, rpt1->gnt_bt, -+ rpt1->band, rpt1->channel_pri_lsb, rpt1->ht_rxsc, -+ rpt1->l_rxsc, rpt1->pwdb_d); -+ pr_debug("[8] AntIdx[D:A]={%d, %d, %d, %d}, HW_AntSW_occur[D:A]={%d, %d, %d, %d}, Channel_sec[msb,lsb]={%d, %d}\n", -+ rpt1->antidx_d, rpt1->antidx_c, -+ rpt1->antidx_b, rpt1->antidx_a, -+ rpt1->hw_antsw_occur_d, rpt1->hw_antsw_occur_c, -+ rpt1->hw_antsw_occur_b, rpt1->hw_antsw_occur_a, -+ rpt1->channel_sec_msb, rpt1->channel_sec_lsb); -+ pr_debug("[12] GID=%d, PAID[msb,lsb]={%d,%d}\n", -+ rpt1->gid, rpt1->paid_msb, rpt1->paid); -+ pr_debug("[16] RX_EVM[D:A]={%d, %d, %d, %d}\n", -+ rpt1->rxevm[3], rpt1->rxevm[2], -+ rpt1->rxevm[1], rpt1->rxevm[0]); -+ pr_debug("[20] CFO_tail[D:A]={%d, %d, %d, %d}\n", -+ rpt1->cfo_tail[3], rpt1->cfo_tail[2], -+ rpt1->cfo_tail[1], rpt1->cfo_tail[0]); -+ pr_debug("[24] RX_SNR[D:A]={%d, %d, %d, %d}\n\n", -+ rpt1->rxsnr[3], rpt1->rxsnr[2], -+ rpt1->rxsnr[1], rpt1->rxsnr[0]); -+ } else if (phy_status_page_num == 2 || phy_status_page_num == 3) { -+ pr_debug("[0] pwdb[C:A]={%d, %d, %d}, Channel_mdb=%d, Pkt_cnt=%d\n", -+ rpt2->pwdb[2], rpt2->pwdb[1], rpt2->pwdb[0], -+ rpt2->channel_msb, rpt2->pkt_cnt); -+ pr_debug("[4] BF=%d, STBC=%d, LDPC=%d, Gnt_BT=%d, band=%d, CH_lsb=%d, rxsc[ht, l]={%d, %d}, pwdb_D=%d\n", -+ rpt2->beamformed, rpt2->stbc, rpt2->ldpc, rpt2->gnt_bt, -+ rpt2->band, rpt2->channel_lsb, -+ rpt2->ht_rxsc, rpt2->l_rxsc, rpt2->pwdb[3]); -+ pr_debug("[8] AgcTab[D:A]={%d, %d, %d, %d}, pwed_th=%d, shift_l_map=%d\n", -+ rpt2->agc_table_d, rpt2->agc_table_c, -+ rpt2->agc_table_b, rpt2->agc_table_a, -+ rpt2->pwed_th, rpt2->shift_l_map); -+ pr_debug("[12] AvgNoisePowerdB=%d, mp_gain_c[msb, lsb]={%d, %d}, mp_gain_b[msb, lsb]={%d, %d}, mp_gain_a=%d, cnt_cca2agc_rdy=%d\n", -+ rpt2->avg_noise_pwr_lsb, rpt2->mp_gain_c_msb, -+ rpt2->mp_gain_c_lsb, rpt2->mp_gain_b_msb, -+ rpt2->mp_gain_b_lsb, rpt2->mp_gain_a, -+ rpt2->cnt_cca2agc_rdy); -+ pr_debug("[16] HT AAGC gain[B:A]={%d, %d}, AAGC step[D:A]={%d, %d, %d, %d}, IsFreqSelectFadimg=%d, mp_gain_d=%d\n", -+ rpt2->ht_aagc_gain[1], rpt2->ht_aagc_gain[0], -+ rpt2->aagc_step_d, rpt2->aagc_step_c, -+ rpt2->aagc_step_b, rpt2->aagc_step_a, -+ rpt2->is_freq_select_fading, rpt2->mp_gain_d); -+ pr_debug("[20] DAGC gain ant[B:A]={%d, %d}, HT AAGC gain[D:C]={%d, %d}\n", -+ rpt2->dagc_gain[1], rpt2->dagc_gain[0], -+ rpt2->ht_aagc_gain[3], rpt2->ht_aagc_gain[2]); -+ pr_debug("[24] AvgNoisePwerdB=%d, syn_count[msb, lsb]={%d, %d}, counter=%d, DAGC gain ant[D:C]={%d, %d}\n", -+ rpt2->avg_noise_pwr_msb, rpt2->syn_count_msb, -+ rpt2->syn_count_lsb, rpt2->counter, -+ rpt2->dagc_gain[3], rpt2->dagc_gain[2]); -+ } else if (phy_status_page_num == 4) { /*type 4*/ -+ pr_debug("[0] pwdb[C:A]={%d, %d, %d}, Channel_mdb=%d, Pkt_cnt=%d\n", -+ rpt3->pwdb[2], rpt3->pwdb[1], rpt3->pwdb[0], -+ rpt3->channel_msb, rpt3->pkt_cnt); -+ pr_debug("[4] BF=%d, STBC=%d, LDPC=%d, GNT_BT=%d, band=%d, CH_pri=%d, rxsc[ht, l]={%d, %d}, pwdb_D=%d\n", -+ rpt3->beamformed, rpt3->stbc, rpt3->ldpc, rpt3->gnt_bt, -+ rpt3->band, rpt3->channel_lsb, rpt3->ht_rxsc, -+ rpt3->l_rxsc, rpt3->pwdb[3]); -+ pr_debug("[8] AntIdx[D:A]={%d, %d, %d, %d}, HW_AntSW_occur[D:A]={%d, %d, %d, %d}, Training_done[D:A]={%d, %d, %d, %d},\n BadToneCnt_CN_excess_0=%d, BadToneCnt_min_eign_0=%d\n", -+ rpt3->antidx_d, rpt3->antidx_c, -+ rpt3->antidx_b, rpt3->antidx_a, -+ rpt3->hw_antsw_occur_d, rpt3->hw_antsw_occur_c, -+ rpt3->hw_antsw_occur_b, rpt3->hw_antsw_occur_a, -+ rpt3->training_done_d, rpt3->training_done_c, -+ rpt3->training_done_b, rpt3->training_done_a, -+ rpt3->bad_tone_cnt_cn_excess_0, -+ rpt3->bad_tone_cnt_min_eign_0); -+ pr_debug("[12] avg_cond_num_1=%d, avg_cond_num_0=%d, bad_tone_cnt_cn_excess_1=%d,\n bad_tone_cnt_min_eign_1=%d, Tx_pkt_cnt=%d\n", -+ ((rpt3->avg_cond_num_1_msb << 1) | -+ rpt3->avg_cond_num_1_lsb), -+ rpt3->avg_cond_num_0, rpt3->bad_tone_cnt_cn_excess_1, -+ rpt3->bad_tone_cnt_min_eign_1, rpt3->tx_pkt_cnt); -+ pr_debug("[16] Stream RXEVM[D:A]={%d, %d, %d, %d}\n", -+ rpt3->rxevm[3], rpt3->rxevm[2], -+ rpt3->rxevm[1], rpt3->rxevm[0]); -+ pr_debug("[20] Eigenvalue[D:A]={%d, %d, %d, %d}\n", -+ rpt3->eigenvalue[3], rpt3->eigenvalue[2], -+ rpt3->eigenvalue[1], rpt3->eigenvalue[0]); -+ pr_debug("[24] RX SNR[D:A]={%d, %d, %d, %d}\n", -+ rpt3->rxsnr[3], rpt3->rxsnr[2], -+ rpt3->rxsnr[1], rpt3->rxsnr[0]); -+ } else if (phy_status_page_num == 5) { /*type 5*/ -+ pr_debug("[0] pwdb[C:A]={%d, %d, %d}, Channel_mdb=%d, Pkt_cnt=%d\n", -+ rpt4->pwdb[2], rpt4->pwdb[1], rpt4->pwdb[0], -+ rpt4->channel_msb, rpt4->pkt_cnt); -+ pr_debug("[4] BF=%d, STBC=%d, LDPC=%d, GNT_BT=%d, band=%d, CH_pri=%d, rxsc[ht, l]={%d, %d}, pwdb_D=%d\n", -+ rpt4->beamformed, rpt4->stbc, rpt4->ldpc, rpt4->gnt_bt, -+ rpt4->band, rpt4->channel_lsb, rpt4->ht_rxsc, -+ rpt4->l_rxsc, rpt4->pwdb[3]); -+ pr_debug("[8] AntIdx[D:A]={%d, %d, %d, %d}, HW_AntSW_occur[D:A]={%d, %d, %d, %d}\n", -+ rpt4->antidx_d, rpt4->antidx_c, -+ rpt4->antidx_b, rpt4->antidx_a, -+ rpt4->hw_antsw_occur_d, rpt4->hw_antsw_occur_c, -+ rpt4->hw_antsw_occur_b, rpt4->hw_antsw_occur_a); -+ pr_debug("[12] Inf_posD[1,0]={%d, %d}, Inf_posC[1,0]={%d, %d}, Inf_posB[1,0]={%d, %d}, Inf_posA[1,0]={%d, %d}, Tx_pkt_cnt=%d\n", -+ rpt4->inf_pos_1_D_flg, rpt4->inf_pos_0_D_flg, -+ rpt4->inf_pos_1_C_flg, rpt4->inf_pos_0_C_flg, -+ rpt4->inf_pos_1_B_flg, rpt4->inf_pos_0_B_flg, -+ rpt4->inf_pos_1_A_flg, rpt4->inf_pos_0_A_flg, -+ rpt4->tx_pkt_cnt); -+ pr_debug("[16] Inf_pos_B[1,0]={%d, %d}, Inf_pos_A[1,0]={%d, %d}\n", -+ rpt4->inf_pos_1_b, rpt4->inf_pos_0_b, -+ rpt4->inf_pos_1_a, rpt4->inf_pos_0_a); -+ pr_debug("[20] Inf_pos_D[1,0]={%d, %d}, Inf_pos_C[1,0]={%d, %d}\n", -+ rpt4->inf_pos_1_d, rpt4->inf_pos_0_d, -+ rpt4->inf_pos_1_c, rpt4->inf_pos_0_c); -+ } -+} -+ -+void phydm_reset_phy_info_jgr3(struct dm_struct *phydm, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ u8 i; -+ -+ phy_info->rx_pwdb_all = 0; -+ phy_info->signal_quality = 0; -+ phy_info->band_width = 0; -+ phy_info->rx_count = 0; -+ phy_info->rx_power = -110; -+ phy_info->recv_signal_power = -110; -+ phy_info->bt_rx_rssi_percentage = 0; -+ phy_info->signal_strength = 0; -+ phy_info->channel = 0; -+ phy_info->is_mu_packet = 0; -+ phy_info->is_beamformed = 0; -+ phy_info->rxsc = 0; -+ -+ for (i = 0; i < 4; i++) { -+ phy_info->rx_mimo_signal_strength[i] = 0; -+ phy_info->rx_mimo_signal_quality[i] = 0; -+ phy_info->rx_mimo_evm_dbm[i] = 0; -+ phy_info->cfo_short[i] = 0; -+ phy_info->cfo_tail[i] = 0; -+ phy_info->rx_pwr[i] = -110; -+ phy_info->rx_snr[i] = 0; -+ } -+} -+ -+#if 0 -+void phydm_per_path_info_3rd(u8 rx_path, s8 pwr, s8 rx_evm, s8 cfo_tail, -+ s8 rx_snr, struct phydm_phyinfo_struct *phy_info) -+{ -+ u8 evm_dbm = 0; -+ u8 evm_percentage = 0; -+ -+ /* SNR is S(8,1), EVM is S(8,1), CFO is S(8,7) */ -+ -+ evm_dbm = (rx_evm == -128) ? 0 : ((u8)(0 - rx_evm) >> 1); -+ evm_percentage = (evm_dbm >= 34) ? 100 : evm_dbm * 3; -+ -+ phy_info->rx_pwr[rx_path] = pwr; -+ -+ /*@CFO(kHz) = CFO_tail * 312.5(kHz) / 2^7 ~= CFO tail * 5/2 (kHz)*/ -+ phy_info->cfo_tail[rx_path] = (cfo_tail * 5) >> 1; -+ phy_info->rx_mimo_evm_dbm[rx_path] = evm_dbm; -+ phy_info->rx_mimo_signal_strength[rx_path] = phydm_pw_2_percent(pwr); -+ phy_info->rx_mimo_signal_quality[rx_path] = evm_percentage; -+ phy_info->rx_snr[rx_path] = rx_snr >> 1; -+} -+ -+void phydm_common_phy_info_jgr3(s8 rx_power, u8 channel, boolean is_beamformed, -+ boolean is_mu_packet, u8 bandwidth, -+ u8 signal_quality, u8 rxsc, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ phy_info->rx_power = rx_power; /* RSSI in dB */ -+ phy_info->recv_signal_power = rx_power; /* RSSI in dB */ -+ phy_info->channel = channel; /* @channel number */ -+ phy_info->is_beamformed = is_beamformed; /* @apply BF */ -+ phy_info->is_mu_packet = is_mu_packet; /* @MU packet */ -+ phy_info->rxsc = rxsc; -+ -+ phy_info->rx_pwdb_all = phydm_pw_2_percent(rx_power); /*percentage */ -+ phy_info->signal_quality = signal_quality; /* signal quality */ -+ phy_info->band_width = bandwidth; /* @bandwidth */ -+} -+#endif -+ -+void phydm_get_physts_0_jgr3(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ /* type 0 is used for cck packet */ -+ struct phy_sts_rpt_jgr3_type0 *phy_sts = NULL; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ u8 sq = 0, i, rx_cnt = 0; -+ s8 rx_power[4], pwdb; -+ s8 rx_pwr_db_max = -120; -+ -+ phy_sts = (struct phy_sts_rpt_jgr3_type0 *)phy_status_inf; -+ -+ #if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197G) { -+ if (dm->rx_ant_status == BB_PATH_B) { -+ phy_sts->pwdb_b = phy_sts->pwdb_a; -+ phy_sts->gain_b = phy_sts->gain_a; -+ phy_sts->pwdb_a = 0; -+ phy_sts->gain_a = 0; -+ } -+ } -+ #endif -+ -+ rx_power[0] = phy_sts->pwdb_a; -+ rx_power[1] = phy_sts->pwdb_b; -+ rx_power[2] = phy_sts->pwdb_c; -+ rx_power[3] = phy_sts->pwdb_d; -+ -+ #if (RTL8822C_SUPPORT || RTL8197G_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8197G)) { -+ struct phydm_physts *physts_table = &dm->dm_physts_table; -+ if (phy_sts->gain_a < physts_table->cck_gi_l_bnd) -+ rx_power[0] += ((physts_table->cck_gi_l_bnd - -+ phy_sts->gain_a) << 1); -+ else if (phy_sts->gain_a > physts_table->cck_gi_u_bnd) -+ rx_power[0] -= ((phy_sts->gain_a - -+ physts_table->cck_gi_u_bnd) << 1); -+ -+ if (phy_sts->gain_b < physts_table->cck_gi_l_bnd) -+ rx_power[1] += ((physts_table->cck_gi_l_bnd - -+ phy_sts->gain_b) << 1); -+ else if (phy_sts->gain_b > physts_table->cck_gi_u_bnd) -+ rx_power[1] -= ((phy_sts->gain_b - -+ physts_table->cck_gi_u_bnd) << 1); -+ } -+ #endif -+ -+ /* @Update per-path information */ -+ for (i = RF_PATH_A; i < dm->num_rf_path; i++) { -+ if ((dm->rx_ant_status & BIT(i)) == 0) -+ continue; -+ -+ rx_cnt++; /* @check the number of the ant */ -+ -+ if (rx_cnt > dm->num_rf_path) -+ break; -+ -+ if (pktinfo->is_to_self) -+ dm->ofdm_agc_idx[i] = rx_power[i]; -+ -+ /* @Setting the RX power: agc_idx -110 dBm*/ -+ pwdb = rx_power[i] - 110; -+ -+ phy_info->rx_pwr[i] = pwdb; -+ phy_info->rx_mimo_signal_strength[i] = phydm_pw_2_percent(pwdb); -+ -+ /* search maximum pwdb */ -+ if (pwdb > rx_pwr_db_max) -+ rx_pwr_db_max = pwdb; -+ } -+ -+ /* @Calculate Signal Quality*/ -+ if (phy_sts->signal_quality >= 64) { -+ sq = 0; -+ } else if (phy_sts->signal_quality <= 20) { -+ sq = 100; -+ } else { -+ /* @mapping to 2~99% */ -+ sq = 64 - phy_sts->signal_quality; -+ sq = ((sq << 3) + sq) >> 2; -+ } -+ -+ /* @Modify CCK PWDB if old AGC */ -+ if (!dm->cck_new_agc) { -+ u8 lna_idx[4], vga_idx[4]; -+ -+ lna_idx[0] = ((phy_sts->lna_h_a << 3) | phy_sts->lna_l_a); -+ vga_idx[0] = phy_sts->vga_a; -+ lna_idx[1] = ((phy_sts->lna_h_b << 3) | phy_sts->lna_l_b); -+ vga_idx[1] = phy_sts->vga_b; -+ lna_idx[2] = ((phy_sts->lna_h_c << 3) | phy_sts->lna_l_c); -+ vga_idx[2] = phy_sts->vga_c; -+ lna_idx[3] = ((phy_sts->lna_h_d << 3) | phy_sts->lna_l_d); -+ vga_idx[3] = phy_sts->vga_d; -+ } -+ -+ /*@CCK no STBC and LDPC*/ -+ dbg_i->is_ldpc_pkt = false; -+ dbg_i->is_stbc_pkt = false; -+ -+ /*cck channel has hw bug, [WLANBB-1429]*/ -+ phy_info->rx_count = (rx_cnt > 0) ? rx_cnt - 1 : 0; /*from 1~4 to 0~3 */ -+ phy_info->channel = 0; -+ phy_info->rx_power = rx_pwr_db_max; -+ phy_info->recv_signal_power = rx_pwr_db_max; -+ phy_info->is_beamformed = false; -+ phy_info->is_mu_packet = false; -+ phy_info->rxsc = phy_sts->l_rxsc; -+ phy_info->rx_pwdb_all = phydm_pw_2_percent(rx_pwr_db_max); -+ phy_info->signal_quality = sq; -+ phy_info->band_width = CHANNEL_WIDTH_20; -+ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_a; -+ dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_b; -+ dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_c; -+ dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_d; -+ #endif -+} -+ -+void phydm_get_physts_1_others_jgr3(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ struct phy_sts_rpt_jgr3_type1 *phy_sts = NULL; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ s8 evm = 0; -+ u8 i; -+ s8 sq = 0; -+ -+ phy_sts = (struct phy_sts_rpt_jgr3_type1 *)phy_status_inf; -+ -+ /* SNR: S(8,1), EVM: S(8,1), CFO: S(8,7) */ -+ -+ for (i = RF_PATH_A; i < dm->num_rf_path; i++) { -+ if ((dm->rx_ant_status & BIT(i)) == 0) -+ continue; -+ -+ evm = phy_sts->rxevm[i]; -+ evm = (evm == -128) ? 0 : ((0 - evm) >> 1); -+ sq = (evm >= 34) ? 100 : evm * 3; /* @Convert EVM to 0~100%*/ -+ -+ phy_info->rx_mimo_evm_dbm[i] = (u8)evm; -+ phy_info->rx_mimo_signal_quality[i] = sq; -+ phy_info->rx_snr[i] = phy_sts->rxsnr[i] >> 1; -+ /*@CFO(kHz) = CFO_tail*312.5(kHz)/2^7 ~= CFO tail * 5/2 (kHz)*/ -+ phy_info->cfo_tail[i] = (phy_sts->cfo_tail[i] * 5) >> 1; -+ dbg_i->cfo_tail[i] = (phy_sts->cfo_tail[i] * 5) >> 1; -+ } -+ phy_info->signal_quality = phy_info->rx_mimo_signal_quality[0]; -+ -+ if (phy_sts->gid != 0 && phy_sts->gid != 63) { -+ phy_info->is_mu_packet = true; -+ dbg_i->num_qry_mu_pkt++; -+ } else { -+ phy_info->is_mu_packet = false; -+ } -+ -+ phydm_parsing_cfo(dm, pktinfo, phy_sts->cfo_tail, pktinfo->rate_ss); -+ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_a; -+ dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_b; -+ dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_c; -+ dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_d; -+#endif -+} -+ -+void phydm_get_physts_2_others_jgr3(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ /* type 2 & 3 is used for ofdm packet */ -+ struct phy_sts_rpt_jgr3_type2_3 *phy_sts = NULL; -+} -+ -+void phydm_get_physts_4_others_jgr3(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ struct phy_sts_rpt_jgr3_type4 *phy_sts = NULL; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ s8 evm = 0; -+ u8 i; -+ s8 sq = 0; -+ -+ phy_sts = (struct phy_sts_rpt_jgr3_type4 *)phy_status_inf; -+ -+ /* SNR: S(8,1), EVM: S(8,1), CFO: S(8,7) */ -+ -+ for (i = RF_PATH_A; i < dm->num_rf_path; i++) { -+ if ((dm->rx_ant_status & BIT(i)) == 0) -+ continue; -+ -+ evm = phy_sts->rxevm[i]; -+ evm = (evm == -128) ? 0 : ((0 - evm) >> 1); -+ sq = (evm >= 34) ? 100 : evm * 3; /* @Convert EVM to 0~100%*/ -+ -+ phy_info->rx_mimo_evm_dbm[i] = (u8)evm; -+ phy_info->rx_mimo_signal_quality[i] = sq; -+ phy_info->rx_snr[i] = phy_sts->rxsnr[i] >> 1; -+ } -+ phy_info->signal_quality = phy_info->rx_mimo_signal_quality[0]; -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_a; -+ dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_b; -+ dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_c; -+ dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_d; -+#endif -+ odm_move_memory(dm, dbg_i->eigen_val, phy_sts->eigenvalue, 4); -+ dbg_i->condition_num_seg0 = phy_sts->avg_cond_num_0; -+} -+ -+void phydm_get_physts_5_others_jgr3(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ struct phy_sts_rpt_jgr3_type5 *phy_sts = NULL; -+ -+} -+#if (RTL8723F_SUPPORT) -+void phydm_get_physts_6_jgr3(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ /* type 0 is used for cck packet */ -+ struct phy_sts_rpt_jgr3_type6 *phy_sts = NULL; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ u8 sq = 0, i, rx_cnt = 0; -+ s8 rx_power[4], pwdb; -+ s8 rx_pwr_db_max = -120; -+ u8 evm = 0; -+ phy_sts = (struct phy_sts_rpt_jgr3_type6 *)phy_status_inf; -+ /* judy_add_8723F_0512 */ -+ /* rssi S(11,3) */ -+ rx_power[0] = (s8)((phy_sts->rssi_msb << 5) + (phy_sts->rssi >> 3)); -+ /* @Update per-path information */ -+ for (i = RF_PATH_A; i < dm->num_rf_path; i++) { -+ if ((dm->rx_ant_status & BIT(i)) == 0) -+ continue; -+ -+ rx_cnt++; /* @check the number of the ant */ -+ -+ if (rx_cnt > dm->num_rf_path) -+ break; -+ -+ if (pktinfo->is_to_self) -+ dm->ofdm_agc_idx[i] = rx_power[i]+110; -+ -+ /* @Setting the RX power: agc_idx dBm*/ -+ pwdb = rx_power[i]; -+ -+ phy_info->rx_pwr[i] = pwdb; -+ phy_info->rx_mimo_signal_strength[i] = phydm_pw_2_percent(pwdb); -+ -+ /* search maximum pwdb */ -+ if (pwdb > rx_pwr_db_max) -+ rx_pwr_db_max = pwdb; -+ } -+ -+ /* @Calculate EVM U(8,2)*/ -+ evm = phy_sts->evm_pld >> 2; -+ if (pktinfo->data_rate > ODM_RATE2M) -+ phy_info->rx_cck_evm = (u8)(evm - 10);/* @5_5M/11M*/ -+ else -+ phy_info->rx_cck_evm = (u8)(evm - 12);/* @1M/2M*/ -+ -+ sq = (phy_info->rx_cck_evm >= 34) ? 100 : phy_info->rx_cck_evm * 3; -+ phy_info->signal_quality = sq; -+ /*@CCK no STBC and LDPC*/ -+ dbg_i->is_ldpc_pkt = false; -+ dbg_i->is_stbc_pkt = false; -+ -+ /*cck channel has hw bug, [WLANBB-1429]*/ -+ phy_info->rx_count = (rx_cnt > 0) ? rx_cnt - 1 : 0; /*from 1~4 to 0~3 */ -+ phy_info->channel = 0; -+ phy_info->rx_power = rx_pwr_db_max; -+ phy_info->recv_signal_power = rx_pwr_db_max; -+ phy_info->is_beamformed = false; -+ phy_info->is_mu_packet = false; -+ phy_info->rx_pwdb_all = phydm_pw_2_percent(rx_pwr_db_max); -+ phy_info->band_width = CHANNEL_WIDTH_20; -+ -+ //phydm_parsing_cfo(dm, pktinfo, phy_sts->avg_cfo, pktinfo->rate_ss); -+ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_a; -+ dm->dm_fat_table.antsel_rx_keep_1 = 0; -+ dm->dm_fat_table.antsel_rx_keep_2 = 0; -+ dm->dm_fat_table.antsel_rx_keep_3 = 0; -+ #endif -+} -+#endif -+void phydm_get_physts_ofdm_cmn_jgr3(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ struct phy_sts_rpt_jgr3_ofdm_cmn *phy_sts = NULL; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ s8 rx_pwr_db_max = -120; -+ s8 pwdb = 0; -+ u8 i, rx_cnt = 0; -+ -+ phy_sts = (struct phy_sts_rpt_jgr3_ofdm_cmn *)phy_status_inf; -+ -+ /* Parsing Offset0 & 4*/ -+ for (i = RF_PATH_A; i < dm->num_rf_path; i++) { -+ if ((dm->rx_ant_status & BIT(i)) == 0) -+ continue; -+ -+ rx_cnt++; /* @check the number of the ant */ -+ -+ pwdb = (s8)phy_sts->pwdb[i] - 110; /*@dB*/ -+ -+ if (pktinfo->is_to_self) -+ dm->ofdm_agc_idx[i] = phy_sts->pwdb[i]; -+ -+ /* search maximum pwdb */ -+ if (pwdb > rx_pwr_db_max) -+ rx_pwr_db_max = pwdb; -+ -+ phy_info->rx_pwr[i] = pwdb; -+ phy_info->rx_mimo_signal_strength[i] = phydm_pw_2_percent(pwdb); -+ } -+ -+ phy_info->rx_count = (rx_cnt > 0) ? rx_cnt - 1 : 0; /*from 1~4 to 0~3 */ -+ phy_info->rx_power = rx_pwr_db_max; -+ phy_info->rx_pwdb_all = phydm_pw_2_percent(rx_pwr_db_max); -+ phy_info->recv_signal_power = rx_pwr_db_max; -+ phy_info->channel = phy_sts->channel_lsb; -+ phy_info->is_beamformed = (boolean)phy_sts->beamformed; -+ phy_info->rxsc = (PHYDM_IS_LEGACY_RATE(pktinfo->data_rate)) ? -+ phy_sts->l_rxsc : phy_sts->ht_rxsc; -+ phy_info->band_width = phydm_rxsc_2_bw(dm, phy_info->rxsc); -+ -+ dbg_i->is_ldpc_pkt = phy_sts->ldpc; -+ dbg_i->is_stbc_pkt = phy_sts->stbc; -+ dbg_i->num_qry_bf_pkt += phy_sts->beamformed; -+} -+ -+void phydm_process_dm_rssi_jgr3(struct dm_struct *dm, -+ struct phydm_phyinfo_struct *phy_info, -+ struct phydm_perpkt_info_struct *pktinfo) -+{ -+ struct cmn_sta_info *sta = NULL; -+ struct rssi_info *rssi_t = NULL; -+ u8 rssi_tmp = 0; -+ u64 rssi_linear = 0; -+ s16 rssi_db = 0; -+ u8 i = 0; -+ u8 rx_count = 0; -+ -+ #if (defined(PHYDM_CCK_RX_PATHDIV_SUPPORT)) -+ struct phydm_cck_rx_pathdiv *cckrx_t = &dm->dm_cck_rx_pathdiv_table; -+ #endif -+ -+ /*@[Step4]*/ -+ if (pktinfo->station_id >= ODM_ASSOCIATE_ENTRY_NUM) -+ return; -+ -+ sta = dm->phydm_sta_info[pktinfo->station_id]; -+ -+ if (!is_sta_active(sta)) -+ return; -+ -+ if (!pktinfo->is_packet_match_bssid) /*@data frame only*/ -+ return; -+ -+ if (!(pktinfo->is_packet_to_self) && !(pktinfo->is_packet_beacon)) -+ return; -+ -+ if (pktinfo->is_packet_beacon) { -+ dm->phy_dbg_info.num_qry_beacon_pkt++; -+ dm->phy_dbg_info.beacon_phy_rate = pktinfo->data_rate; -+ } -+ -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ if (dm->support_ability & ODM_BB_ANT_DIV) -+ odm_process_rssi_for_ant_div(dm, phy_info, pktinfo); -+ #endif -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ phydm_rx_rate_for_antdiv(dm, pktinfo); -+ #endif -+ -+ #if (defined(CONFIG_PATH_DIVERSITY)) -+ if (dm->support_ability & ODM_BB_PATH_DIV) -+ phydm_process_rssi_for_path_div(dm, phy_info, pktinfo); -+ #endif -+ -+ #if (defined(PHYDM_CCK_RX_PATHDIV_SUPPORT)) -+ if (cckrx_t->en_cck_rx_pathdiv) -+ phydm_process_rssi_for_cck_rx_pathdiv(dm, phy_info, pktinfo); -+ #endif -+ -+ rssi_t = &sta->rssi_stat; -+ -+ for (i = 0; i < dm->num_rf_path; i++) { -+ rssi_tmp = phy_info->rx_mimo_signal_strength[i]; -+ if (rssi_tmp != 0) { -+ rx_count++; -+ rssi_linear += phydm_db_2_linear(rssi_tmp); -+ } -+ } -+ /* @Rounding and removing fractional bits */ -+ rssi_linear = (rssi_linear + (1 << (FRAC_BITS - 1))) >> FRAC_BITS; -+ -+ switch (rx_count) { -+ case 2: -+ rssi_linear = DIVIDED_2(rssi_linear); -+ break; -+ case 3: -+ rssi_linear = DIVIDED_3(rssi_linear); -+ break; -+ case 4: -+ rssi_linear = DIVIDED_4(rssi_linear); -+ break; -+ } -+ -+ rssi_db = (s16)odm_convert_to_db(rssi_linear); -+ -+ if (rssi_t->rssi_acc == 0) { -+ rssi_t->rssi_acc = (s16)(rssi_db << RSSI_MA); -+ rssi_t->rssi = (s8)(rssi_db); -+ } else { -+ rssi_t->rssi_acc = MA_ACC(rssi_t->rssi_acc, rssi_db, RSSI_MA); -+ rssi_t->rssi = (s8)GET_MA_VAL(rssi_t->rssi_acc, RSSI_MA); -+ } -+ -+ if (pktinfo->is_cck_rate) -+ rssi_t->rssi_cck = (s8)rssi_db; -+ else -+ rssi_t->rssi_ofdm = (s8)rssi_db; -+} -+ -+void phydm_rx_physts_jgr3(void *dm_void, u8 *phy_sts, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 phy_status_type = (*phy_sts & 0xf); -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ if (pktinfo->data_rate <= ODM_RATE11M) -+ phy_status_type = 6; -+ } -+ /*@[Step 2]*/ -+ /*phydm_reset_phy_info_jgr3(dm, phy_info);*/ /* @Memory reset */ -+ -+ /* Phy status parsing */ -+ switch (phy_status_type) { -+ case 0: /*@CCK*/ -+ phydm_get_physts_0_jgr3(dm, phy_sts, pktinfo, phy_info); -+ break; -+ case 1: -+ phydm_get_physts_ofdm_cmn_jgr3(dm, phy_sts, pktinfo, phy_info); -+ phydm_get_physts_1_others_jgr3(dm, phy_sts, pktinfo, phy_info); -+ break; -+ case 2: -+ case 3: -+ phydm_get_physts_ofdm_cmn_jgr3(dm, phy_sts, pktinfo, phy_info); -+ phydm_get_physts_2_others_jgr3(dm, phy_sts, pktinfo, phy_info); -+ break; -+ case 4: -+ phydm_get_physts_ofdm_cmn_jgr3(dm, phy_sts, pktinfo, phy_info); -+ phydm_get_physts_4_others_jgr3(dm, phy_sts, pktinfo, phy_info); -+ break; -+ case 5: -+ phydm_get_physts_ofdm_cmn_jgr3(dm, phy_sts, pktinfo, phy_info); -+ phydm_get_physts_5_others_jgr3(dm, phy_sts, pktinfo, phy_info); -+ break; -+#if (RTL8723F_SUPPORT) -+ case 6: -+ phydm_get_physts_6_jgr3(dm, phy_sts, pktinfo, phy_info); -+ break; -+#endif -+ default: -+ break; -+ } -+ -+#if 0 -+ PHYDM_DBG(dm, DBG_PHY_STATUS, "RSSI: {%d, %d}\n", -+ phy_info->rx_mimo_signal_strength[0], -+ phy_info->rx_mimo_signal_strength[1]); -+ PHYDM_DBG(dm, DBG_PHY_STATUS, "rxdb: {%d, %d}\n", -+ phy_info->rx_pwr[0], phy_info->rx_pwr[1]); -+ PHYDM_DBG(dm, DBG_PHY_STATUS, "EVM: {%d, %d}\n", -+ phy_info->rx_mimo_evm_dbm[0], phy_info->rx_mimo_evm_dbm[1]); -+ PHYDM_DBG(dm, DBG_PHY_STATUS, "SQ: {%d, %d}\n", -+ phy_info->rx_mimo_signal_quality[0], -+ phy_info->rx_mimo_signal_quality[1]); -+ PHYDM_DBG(dm, DBG_PHY_STATUS, "SNR: {%d, %d}\n", -+ phy_info->rx_snr[0], phy_info->rx_snr[1]); -+ PHYDM_DBG(dm, DBG_PHY_STATUS, "CFO: {%d, %d}\n", -+ phy_info->cfo_tail[0], phy_info->cfo_tail[1]); -+ PHYDM_DBG(dm, DBG_PHY_STATUS, -+ "rx_pwdb_all = %d, rx_power = %d, recv_signal_power = %d\n", -+ phy_info->rx_pwdb_all, phy_info->rx_power, -+ phy_info->recv_signal_power); -+ PHYDM_DBG(dm, DBG_PHY_STATUS, "signal_quality = %d\n", -+ phy_info->signal_quality); -+ PHYDM_DBG(dm, DBG_PHY_STATUS, -+ "is_beamformed = %d, is_mu_packet = %d, rx_count = %d\n", -+ phy_info->is_beamformed, phy_info->is_mu_packet, -+ phy_info->rx_count); -+ PHYDM_DBG(dm, DBG_PHY_STATUS, -+ "channel = %d, rxsc = %d, band_width = %d\n", -+ phy_info->channel, phy_info->rxsc, phy_info->band_width); -+#endif -+ -+ /*@[Step 1]*/ -+ phydm_print_phystat_jgr3(dm, phy_sts, pktinfo, phy_info); -+} -+ -+#endif -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) -+/* @For 8822B only!! need to move to FW finally */ -+/*@==============================================*/ -+ -+boolean -+phydm_query_is_mu_api(struct dm_struct *phydm, u8 ppdu_idx, u8 *p_data_rate, -+ u8 *p_gid) -+{ -+ u8 data_rate = 0, gid = 0; -+ boolean is_mu = false; -+ -+ data_rate = phydm->phy_dbg_info.num_of_ppdu[ppdu_idx]; -+ gid = phydm->phy_dbg_info.gid_num[ppdu_idx]; -+ -+ if (data_rate & BIT(7)) { -+ is_mu = true; -+ data_rate = data_rate & ~(BIT(7)); -+ } else { -+ is_mu = false; -+ } -+ -+ *p_data_rate = data_rate; -+ *p_gid = gid; -+ -+ return is_mu; -+} -+ -+void phydm_print_phy_sts_jgr2(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ struct phy_sts_rpt_jgr2_type0 *rpt0 = NULL; -+ struct phy_sts_rpt_jgr2_type1 *rpt = NULL; -+ struct phy_sts_rpt_jgr2_type2 *rpt2 = NULL; -+ struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; -+ u8 phy_status_page_num = (*phy_status_inf & 0xf); -+ u32 phy_status[PHY_STATUS_JRGUAR2_DW_LEN] = {0}; -+ u8 i; -+ u32 size = PHY_STATUS_JRGUAR2_DW_LEN << 2; -+ -+ rpt0 = (struct phy_sts_rpt_jgr2_type0 *)phy_status_inf; -+ rpt = (struct phy_sts_rpt_jgr2_type1 *)phy_status_inf; -+ rpt2 = (struct phy_sts_rpt_jgr2_type2 *)phy_status_inf; -+ -+ odm_move_memory(dm, phy_status, phy_status_inf, size); -+ -+ if (!(dm->debug_components & DBG_PHY_STATUS)) -+ return; -+ -+ if (dbg->show_phy_sts_all_pkt == 0) { -+ if (!pktinfo->is_packet_match_bssid) -+ return; -+ } -+ -+ dbg->show_phy_sts_cnt++; -+ #if 0 -+ dbg_print("cnt=%d, max=%d\n", -+ dbg->show_phy_sts_cnt, dbg->show_phy_sts_max_cnt); -+ #endif -+ -+ if (dbg->show_phy_sts_max_cnt != SHOW_PHY_STATUS_UNLIMITED) { -+ if (dbg->show_phy_sts_cnt > dbg->show_phy_sts_max_cnt) -+ return; -+ } -+ -+ pr_debug("Phy Status Rpt: OFDM_%d\n", phy_status_page_num); -+ pr_debug("StaID=%d, RxRate = 0x%x match_bssid=%d\n", -+ pktinfo->station_id, pktinfo->data_rate, -+ pktinfo->is_packet_match_bssid); -+ -+ for (i = 0; i < PHY_STATUS_JRGUAR2_DW_LEN; i++) -+ pr_debug("Offset[%d:%d] = 0x%x\n", -+ ((4 * i) + 3), (4 * i), phy_status[i]); -+ -+ if (phy_status_page_num == 0) { -+ pr_debug("[0] TRSW=%d, MP_gain_idx=%d, pwdb=%d\n", -+ rpt0->trsw, rpt0->gain, rpt0->pwdb); -+ pr_debug("[4] band=%d, CH=%d, agc_table = %d, rxsc = %d\n", -+ rpt0->band, rpt0->channel, -+ rpt0->agc_table, rpt0->rxsc); -+ pr_debug("[8] AntIdx[D:A]={%d, %d, %d, %d}, LSIG_len=%d\n", -+ rpt0->antidx_d, rpt0->antidx_c, rpt0->antidx_b, -+ rpt0->antidx_a, rpt0->length); -+ pr_debug("[12] lna_h=%d, bb_pwr=%d, lna_l=%d, vga=%d, sq=%d\n", -+ rpt0->lna_h, rpt0->bb_power, rpt0->lna_l, -+ rpt0->vga, rpt0->signal_quality); -+ -+ } else if (phy_status_page_num == 1) { -+ pr_debug("[0] pwdb[D:A]={%d, %d, %d, %d}\n", -+ rpt->pwdb[3], rpt->pwdb[2], -+ rpt->pwdb[1], rpt->pwdb[0]); -+ pr_debug("[4] BF: %d, ldpc=%d, stbc=%d, g_bt=%d, antsw=%d, band=%d, CH=%d, rxsc[ht, l]={%d, %d}\n", -+ rpt->beamformed, rpt->ldpc, rpt->stbc, rpt->gnt_bt, -+ rpt->hw_antsw_occu, rpt->band, rpt->channel, -+ rpt->ht_rxsc, rpt->l_rxsc); -+ pr_debug("[8] AntIdx[D:A]={%d, %d, %d, %d}, LSIG_len=%d\n", -+ rpt->antidx_d, rpt->antidx_c, rpt->antidx_b, -+ rpt->antidx_a, rpt->lsig_length); -+ pr_debug("[12] rf_mode=%d, NBI=%d, Intf_pos=%d, GID=%d, PAID=%d\n", -+ rpt->rf_mode, rpt->nb_intf_flag, -+ (rpt->intf_pos + (rpt->intf_pos_msb << 8)), rpt->gid, -+ (rpt->paid + (rpt->paid_msb << 8))); -+ pr_debug("[16] EVM[D:A]={%d, %d, %d, %d}\n", -+ rpt->rxevm[3], rpt->rxevm[2], -+ rpt->rxevm[1], rpt->rxevm[0]); -+ pr_debug("[20] CFO[D:A]={%d, %d, %d, %d}\n", -+ rpt->cfo_tail[3], rpt->cfo_tail[2], rpt->cfo_tail[1], -+ rpt->cfo_tail[0]); -+ pr_debug("[24] SNR[D:A]={%d, %d, %d, %d}\n\n", -+ rpt->rxsnr[3], rpt->rxsnr[2], rpt->rxsnr[1], -+ rpt->rxsnr[0]); -+ -+ } else if (phy_status_page_num == 2) { -+ pr_debug("[0] pwdb[D:A]={%d, %d, %d, %d}\n", -+ rpt2->pwdb[3], rpt2->pwdb[2], rpt2->pwdb[1], -+ rpt2->pwdb[0]); -+ pr_debug("[4] BF: %d, ldpc=%d, stbc=%d, g_bt=%d, antsw=%d, band=%d, CH=%d, rxsc[ht,l]={%d, %d}\n", -+ rpt2->beamformed, rpt2->ldpc, rpt2->stbc, rpt2->gnt_bt, -+ rpt2->hw_antsw_occu, rpt2->band, rpt2->channel, -+ rpt2->ht_rxsc, rpt2->l_rxsc); -+ pr_debug("[8] AgcTab[D:A]={%d, %d, %d, %d}, cnt_pw2cca=%d, shift_l_map=%d\n", -+ rpt2->agc_table_d, rpt2->agc_table_c, -+ rpt2->agc_table_b, rpt2->agc_table_a, -+ rpt2->cnt_pw2cca, rpt2->shift_l_map); -+ pr_debug("[12] (TRSW|Gain)[D:A]={%d %d, %d %d, %d %d, %d %d}, cnt_cca2agc_rdy=%d\n", -+ rpt2->trsw_d, rpt2->gain_d, rpt2->trsw_c, rpt2->gain_c, -+ rpt2->trsw_b, rpt2->gain_b, rpt2->trsw_a, -+ rpt2->gain_a, rpt2->cnt_cca2agc_rdy); -+ pr_debug("[16] AAGC step[D:A]={%d, %d, %d, %d} HT AAGC gain[D:A]={%d, %d, %d, %d}\n", -+ rpt2->aagc_step_d, rpt2->aagc_step_c, -+ rpt2->aagc_step_b, rpt2->aagc_step_a, -+ rpt2->ht_aagc_gain[3], rpt2->ht_aagc_gain[2], -+ rpt2->ht_aagc_gain[1], rpt2->ht_aagc_gain[0]); -+ pr_debug("[20] DAGC gain[D:A]={%d, %d, %d, %d}\n", -+ rpt2->dagc_gain[3], -+ rpt2->dagc_gain[2], rpt2->dagc_gain[1], -+ rpt2->dagc_gain[0]); -+ pr_debug("[24] syn_cnt: %d, Cnt=%d\n\n", -+ rpt2->syn_count, rpt2->counter); -+ } -+} -+ -+void phydm_set_per_path_phy_info(u8 rx_path, s8 pwr, s8 rx_evm, s8 cfo_tail, -+ s8 rx_snr, u8 ant_idx, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ u8 evm_dbm = 0; -+ u8 evm_percentage = 0; -+ -+ /* SNR is S(8,1), EVM is S(8,1), CFO is S(8,7) */ -+ -+ if (rx_evm < 0) { -+ /* @Calculate EVM in dBm */ -+ evm_dbm = ((u8)(0 - rx_evm) >> 1); -+ -+ if (evm_dbm == 64) -+ evm_dbm = 0; /*@if 1SS rate, evm_dbm [2nd stream] =64*/ -+ -+ if (evm_dbm != 0) { -+ /* @Convert EVM to 0%~100% percentage */ -+ if (evm_dbm >= 34) -+ evm_percentage = 100; -+ else -+ evm_percentage = (evm_dbm << 1) + (evm_dbm); -+ } -+ } -+ -+ phy_info->rx_pwr[rx_path] = pwr; -+ -+ /*@CFO(kHz) = CFO_tail * 312.5(kHz) / 2^7 ~= CFO tail * 5/2 (kHz)*/ -+ phy_info->cfo_tail[rx_path] = (cfo_tail * 5) >> 1; -+ phy_info->rx_mimo_evm_dbm[rx_path] = evm_dbm; -+ phy_info->rx_mimo_signal_strength[rx_path] = phydm_pw_2_percent(pwr); -+ phy_info->rx_mimo_signal_quality[rx_path] = evm_percentage; -+ phy_info->rx_snr[rx_path] = rx_snr >> 1; -+ phy_info->ant_idx[rx_path] = ant_idx; -+ -+#if 0 -+ if (!pktinfo->is_packet_match_bssid) -+ return; -+ -+ dbg_print("path (%d)--------\n", rx_path); -+ dbg_print("rx_pwr = %d, Signal strength = %d\n", -+ phy_info->rx_pwr[rx_path], -+ phy_info->rx_mimo_signal_strength[rx_path]); -+ dbg_print("evm_dbm = %d, Signal quality = %d\n", -+ phy_info->rx_mimo_evm_dbm[rx_path], -+ phy_info->rx_mimo_signal_quality[rx_path]); -+ dbg_print("CFO = %d, SNR = %d\n", -+ phy_info->cfo_tail[rx_path], phy_info->rx_snr[rx_path]); -+ -+#endif -+} -+ -+void phydm_set_common_phy_info(s8 rx_power, u8 channel, boolean is_beamformed, -+ boolean is_mu_packet, u8 bandwidth, -+ u8 signal_quality, u8 rxsc, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ phy_info->rx_power = rx_power; /* RSSI in dB */ -+ phy_info->recv_signal_power = rx_power; /* RSSI in dB */ -+ phy_info->channel = channel; /* @channel number */ -+ phy_info->is_beamformed = is_beamformed; /* @apply BF */ -+ phy_info->is_mu_packet = is_mu_packet; /* @MU packet */ -+ phy_info->rxsc = rxsc; -+ -+ /* RSSI in percentage */ -+ phy_info->rx_pwdb_all = phydm_pw_2_percent(rx_power); -+ phy_info->signal_quality = signal_quality; /* signal quality */ -+ phy_info->band_width = bandwidth; /* @bandwidth */ -+ -+#if 0 -+ if (!pktinfo->is_packet_match_bssid) -+ return; -+ -+ dbg_print("rx_pwdb_all = %d, rx_power = %d, recv_signal_power = %d\n", -+ phy_info->rx_pwdb_all, phy_info->rx_power, -+ phy_info->recv_signal_power); -+ dbg_print("signal_quality = %d\n", phy_info->signal_quality); -+ dbg_print("is_beamformed = %d, is_mu_packet = %d, rx_count = %d\n", -+ phy_info->is_beamformed, phy_info->is_mu_packet, -+ phy_info->rx_count + 1); -+ dbg_print("channel = %d, rxsc = %d, band_width = %d\n", channel, -+ rxsc, bandwidth); -+ -+#endif -+} -+ -+void phydm_get_phy_sts_type0(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ /* type 0 is used for cck packet */ -+ struct phy_sts_rpt_jgr2_type0 *phy_sts = NULL; -+ u8 sq = 0; -+ s8 rx_pow = 0; -+ u8 lna_idx = 0, vga_idx = 0; -+ u8 ant_idx; -+ -+ phy_sts = (struct phy_sts_rpt_jgr2_type0 *)phy_status_inf; -+ rx_pow = phy_sts->pwdb - 110; -+ -+ /* Fill in per-path antenna index */ -+ ant_idx = phy_sts->antidx_a; -+ -+ if (dm->support_ic_type & ODM_RTL8723D) { -+ #if (RTL8723D_SUPPORT) -+ rx_pow = phy_sts->pwdb - 97; -+ #endif -+ } -+ #if (RTL8821C_SUPPORT) -+ else if (dm->support_ic_type & ODM_RTL8821C) { -+ if (phy_sts->pwdb >= -57) -+ rx_pow = phy_sts->pwdb - 100; -+ else -+ rx_pow = phy_sts->pwdb - 102; -+ } -+ #endif -+ -+ if (pktinfo->is_to_self) { -+ dm->ofdm_agc_idx[0] = phy_sts->pwdb; -+ dm->ofdm_agc_idx[1] = 0; -+ dm->ofdm_agc_idx[2] = 0; -+ dm->ofdm_agc_idx[3] = 0; -+ } -+ -+ /* @Calculate Signal Quality*/ -+ if (phy_sts->signal_quality >= 64) { -+ sq = 0; -+ } else if (phy_sts->signal_quality <= 20) { -+ sq = 100; -+ } else { -+ /* @mapping to 2~99% */ -+ sq = 64 - phy_sts->signal_quality; -+ sq = ((sq << 3) + sq) >> 2; -+ } -+ -+ /* @Get RSSI for old CCK AGC */ -+ if (!dm->cck_new_agc) { -+ vga_idx = phy_sts->vga; -+ -+ if (dm->support_ic_type & ODM_RTL8197F) { -+ /*@3bit LNA*/ -+ lna_idx = phy_sts->lna_l; -+ } else { -+ /*@4bit LNA*/ -+ lna_idx = (phy_sts->lna_h << 3) | phy_sts->lna_l; -+ } -+ rx_pow = phydm_get_cck_rssi(dm, lna_idx, vga_idx); -+ } -+ -+ /* @Confirm CCK RSSI */ -+ #if (RTL8197F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8197F) { -+ u8 bb_pwr_th_l = 5; /* round( 31*0.15 ) */ -+ u8 bb_pwr_th_h = 27; /* round( 31*0.85 ) */ -+ -+ if (phy_sts->bb_power < bb_pwr_th_l || -+ phy_sts->bb_power > bb_pwr_th_h) -+ rx_pow = 0; /* @Error RSSI for CCK ; set 100*/ -+ } -+ #endif -+ -+ /*@CCK no STBC and LDPC*/ -+ dm->phy_dbg_info.is_ldpc_pkt = false; -+ dm->phy_dbg_info.is_stbc_pkt = false; -+ -+ /* Update Common information */ -+ phydm_set_common_phy_info(rx_pow, phy_sts->channel, false, -+ false, CHANNEL_WIDTH_20, sq, -+ phy_sts->rxsc, phy_info); -+ /* Update CCK pwdb */ -+ phydm_set_per_path_phy_info(RF_PATH_A, rx_pow, 0, 0, 0, ant_idx, -+ phy_info); -+ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_a; -+ dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_b; -+ dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_c; -+ dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_d; -+ #endif -+} -+ -+void phydm_get_phy_sts_type1(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ /* type 1 is used for ofdm packet */ -+ struct phy_sts_rpt_jgr2_type1 *phy_sts = NULL; -+ struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; -+ s8 rx_pwr_db = -120; -+ s8 rx_pwr = 0; -+ u8 i, rxsc, bw = CHANNEL_WIDTH_20, rx_count = 0; -+ boolean is_mu; -+ u8 ant_idx[4]; -+ -+ phy_sts = (struct phy_sts_rpt_jgr2_type1 *)phy_status_inf; -+ -+ /* Fill in per-path antenna index */ -+ ant_idx[0] = phy_sts->antidx_a; -+ ant_idx[1] = phy_sts->antidx_b; -+ ant_idx[2] = phy_sts->antidx_c; -+ ant_idx[3] = phy_sts->antidx_d; -+ -+ /* Update per-path information */ -+ for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { -+ if (!(dm->rx_ant_status & BIT(i))) -+ continue; -+ rx_count++; -+ -+ if (rx_count > dm->num_rf_path) -+ break; -+ -+ /* Update per-path information -+ * (RSSI_dB RSSI_percentage EVM SNR CFO sq) -+ */ -+ /* @EVM report is reported by stream, not path */ -+ rx_pwr = phy_sts->pwdb[i] - 110; /* per-path pwdb(dB)*/ -+ -+ if (pktinfo->is_to_self) -+ dm->ofdm_agc_idx[i] = phy_sts->pwdb[i]; -+ -+ phydm_set_per_path_phy_info(i, rx_pwr, -+ phy_sts->rxevm[rx_count - 1], -+ phy_sts->cfo_tail[i], -+ phy_sts->rxsnr[i], -+ ant_idx[i], phy_info); -+ /* search maximum pwdb */ -+ if (rx_pwr > rx_pwr_db) -+ rx_pwr_db = rx_pwr; -+ } -+ -+ /* @mapping RX counter from 1~4 to 0~3 */ -+ if (rx_count > 0) -+ phy_info->rx_count = rx_count - 1; -+ -+ /* @Check if MU packet or not */ -+ if (phy_sts->gid != 0 && phy_sts->gid != 63) { -+ is_mu = true; -+ dbg_i->num_qry_mu_pkt++; -+ } else { -+ is_mu = false; -+ } -+ -+ /* @count BF packet */ -+ dbg_i->num_qry_bf_pkt = dbg_i->num_qry_bf_pkt + phy_sts->beamformed; -+ -+ /*STBC or LDPC pkt*/ -+ dbg_i->is_ldpc_pkt = phy_sts->ldpc; -+ dbg_i->is_stbc_pkt = phy_sts->stbc; -+ -+ /* @Check sub-channel */ -+ if (pktinfo->data_rate > ODM_RATE11M && -+ pktinfo->data_rate < ODM_RATEMCS0) -+ rxsc = phy_sts->l_rxsc; -+ else -+ rxsc = phy_sts->ht_rxsc; -+ -+ /* @Check RX bandwidth */ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ if (rxsc >= 1 && rxsc <= 8) -+ bw = CHANNEL_WIDTH_20; -+ else if ((rxsc >= 9) && (rxsc <= 12)) -+ bw = CHANNEL_WIDTH_40; -+ else if (rxsc >= 13) -+ bw = CHANNEL_WIDTH_80; -+ else -+ bw = phy_sts->rf_mode; -+ -+ } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ if (phy_sts->rf_mode == 0) -+ bw = CHANNEL_WIDTH_20; -+ else if ((rxsc == 1) || (rxsc == 2)) -+ bw = CHANNEL_WIDTH_20; -+ else -+ bw = CHANNEL_WIDTH_40; -+ } -+ -+ /* Update packet information */ -+ phydm_set_common_phy_info(rx_pwr_db, phy_sts->channel, -+ (boolean)phy_sts->beamformed, is_mu, bw, -+ phy_info->rx_mimo_signal_quality[0], -+ rxsc, phy_info); -+ -+ phydm_parsing_cfo(dm, pktinfo, phy_sts->cfo_tail, pktinfo->rate_ss); -+ #ifdef PHYDM_LNA_SAT_CHK_TYPE2 -+ phydm_parsing_snr(dm, pktinfo, phy_sts->rxsnr); -+ #endif -+ -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_a; -+ dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_b; -+ dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_c; -+ dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_d; -+ #endif -+} -+ -+void phydm_get_phy_sts_type2(struct dm_struct *dm, u8 *phy_status_inf, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ struct phy_sts_rpt_jgr2_type2 *phy_sts = NULL; -+ s8 rx_pwr_db_max = -120; -+ s8 rx_pwr = 0; -+ u8 i, rxsc, bw = CHANNEL_WIDTH_20, rx_count = 0; -+ -+ phy_sts = (struct phy_sts_rpt_jgr2_type2 *)phy_status_inf; -+ -+ for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { -+ if (!(dm->rx_ant_status & BIT(i))) -+ continue; -+ rx_count++; -+ -+ if (rx_count > dm->num_rf_path) -+ break; -+ -+ /* Update per-path information*/ -+ /* RSSI_dB, RSSI_percentage, EVM, SNR, CFO, sq */ -+ #if (RTL8197F_SUPPORT) -+ if ((dm->support_ic_type & ODM_RTL8197F) && -+ phy_sts->pwdb[i] == 0x7f) { /*@97f workaround*/ -+ -+ if (i == RF_PATH_A) { -+ rx_pwr = (phy_sts->gain_a) << 1; -+ rx_pwr = rx_pwr - 110; -+ } else if (i == RF_PATH_B) { -+ rx_pwr = (phy_sts->gain_b) << 1; -+ rx_pwr = rx_pwr - 110; -+ } else { -+ rx_pwr = 0; -+ } -+ } else -+ #endif -+ rx_pwr = phy_sts->pwdb[i] - 110; /*@dBm*/ -+ -+ phydm_set_per_path_phy_info(i, rx_pwr, 0, 0, 0, 0, phy_info); -+ -+ if (rx_pwr > rx_pwr_db_max) /* search max pwdb */ -+ rx_pwr_db_max = rx_pwr; -+ } -+ -+ /* @mapping RX counter from 1~4 to 0~3 */ -+ if (rx_count > 0) -+ phy_info->rx_count = rx_count - 1; -+ -+ /* @Check RX sub-channel */ -+ if (pktinfo->data_rate > ODM_RATE11M && -+ pktinfo->data_rate < ODM_RATEMCS0) -+ rxsc = phy_sts->l_rxsc; -+ else -+ rxsc = phy_sts->ht_rxsc; -+ -+ /*STBC or LDPC pkt*/ -+ dm->phy_dbg_info.is_ldpc_pkt = phy_sts->ldpc; -+ dm->phy_dbg_info.is_stbc_pkt = phy_sts->stbc; -+ -+ /* @Check RX bandwidth */ -+ /* @BW information of sc=0 is useless, -+ *because there is no information of RF mode -+ */ -+ if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ if (rxsc >= 1 && rxsc <= 8) -+ bw = CHANNEL_WIDTH_20; -+ else if ((rxsc >= 9) && (rxsc <= 12)) -+ bw = CHANNEL_WIDTH_40; -+ else if (rxsc >= 13) -+ bw = CHANNEL_WIDTH_80; -+ -+ } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ if (rxsc == 3) -+ bw = CHANNEL_WIDTH_40; -+ else if ((rxsc == 1) || (rxsc == 2)) -+ bw = CHANNEL_WIDTH_20; -+ } -+ -+ /* Update packet information */ -+ phydm_set_common_phy_info(rx_pwr_db_max, phy_sts->channel, -+ (boolean)phy_sts->beamformed, -+ false, bw, 0, rxsc, phy_info); -+} -+ -+void phydm_process_rssi_for_dm_2nd_type(struct dm_struct *dm, -+ struct phydm_phyinfo_struct *phy_info, -+ struct phydm_perpkt_info_struct *pktinfo -+ ) -+{ -+ struct cmn_sta_info *sta = NULL; -+ struct rssi_info *rssi_t = NULL; -+ u8 rssi_tmp = 0; -+ u64 rssi_linear = 0; -+ s16 rssi_db = 0; -+ u8 i = 0; -+ -+ if (pktinfo->station_id >= ODM_ASSOCIATE_ENTRY_NUM) -+ return; -+ -+ sta = dm->phydm_sta_info[pktinfo->station_id]; -+ -+ if (!is_sta_active(sta)) -+ return; -+ -+ if (!pktinfo->is_packet_match_bssid) /*@data frame only*/ -+ return; -+ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ if (dm->support_ability & ODM_BB_ANT_DIV) -+ odm_process_rssi_for_ant_div(dm, phy_info, pktinfo); -+#endif -+ -+#if (defined(CONFIG_PATH_DIVERSITY)) -+ if (dm->support_ability & ODM_BB_PATH_DIV) -+ phydm_process_rssi_for_path_div(dm, phy_info, pktinfo); -+#endif -+ -+#ifdef CONFIG_ADAPTIVE_SOML -+ phydm_rx_qam_for_soml(dm, pktinfo); -+ phydm_rx_rate_for_soml(dm, pktinfo); -+#endif -+ -+ if (!(pktinfo->is_packet_to_self) && !(pktinfo->is_packet_beacon)) -+ return; -+ -+ if (pktinfo->is_packet_beacon) { -+ dm->phy_dbg_info.num_qry_beacon_pkt++; -+ dm->phy_dbg_info.beacon_phy_rate = pktinfo->data_rate; -+ } -+ -+ rssi_t = &sta->rssi_stat; -+ -+ for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { -+ rssi_tmp = phy_info->rx_mimo_signal_strength[i]; -+ if (rssi_tmp != 0) -+ rssi_linear += phydm_db_2_linear(rssi_tmp); -+ } -+ /* @Rounding and removing fractional bits */ -+ rssi_linear = (rssi_linear + (1 << (FRAC_BITS - 1))) >> FRAC_BITS; -+ -+ switch (phy_info->rx_count + 1) { -+ case 2: -+ rssi_linear = DIVIDED_2(rssi_linear); -+ break; -+ case 3: -+ rssi_linear = DIVIDED_3(rssi_linear); -+ break; -+ case 4: -+ rssi_linear = DIVIDED_4(rssi_linear); -+ break; -+ } -+ -+ rssi_db = (s16)odm_convert_to_db(rssi_linear); -+ -+ if (rssi_t->rssi_acc == 0) { -+ rssi_t->rssi_acc = (s16)(rssi_db << RSSI_MA); -+ rssi_t->rssi = (s8)(rssi_db); -+ } else { -+ rssi_t->rssi_acc = MA_ACC(rssi_t->rssi_acc, rssi_db, RSSI_MA); -+ rssi_t->rssi = (s8)GET_MA_VAL(rssi_t->rssi_acc, RSSI_MA); -+ } -+ -+ if (pktinfo->is_cck_rate) -+ rssi_t->rssi_cck = (s8)rssi_db; -+ else -+ rssi_t->rssi_ofdm = (s8)rssi_db; -+} -+ -+void phydm_rx_physts_2nd_type(void *dm_void, u8 *phy_sts, -+ struct phydm_perpkt_info_struct *pktinfo, -+ struct phydm_phyinfo_struct *phy_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 page = (*phy_sts & 0xf); -+ -+ /* Phy status parsing */ -+ switch (page) { -+ case 0: /*@CCK*/ -+ phydm_get_phy_sts_type0(dm, phy_sts, pktinfo, phy_info); -+ break; -+ case 1: -+ phydm_get_phy_sts_type1(dm, phy_sts, pktinfo, phy_info); -+ break; -+ case 2: -+ phydm_get_phy_sts_type2(dm, phy_sts, pktinfo, phy_info); -+ break; -+ default: -+ break; -+ } -+ -+#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT || RTL8195B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8195B)) -+ phydm_print_phy_sts_jgr2(dm, phy_sts, pktinfo, phy_info); -+#endif -+} -+ -+/*@==============================================*/ -+#endif -+ -+boolean odm_phy_status_query(struct dm_struct *dm, -+ struct phydm_phyinfo_struct *phy_info, -+ u8 *phy_sts, -+ struct phydm_perpkt_info_struct *pktinfo) -+{ -+#ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ struct pkt_process_info *pkt_proc = &dm->pkt_proc_struct; -+ boolean auto_swch_en = dm->pkt_proc_struct.physts_auto_swch_en; -+#endif -+ u8 rate = pktinfo->data_rate; -+ u8 page = (*phy_sts & 0xf); -+ -+ pktinfo->is_cck_rate = PHYDM_IS_CCK_RATE(rate); -+ pktinfo->rate_ss = phydm_rate_to_num_ss(dm, rate); -+ dm->rate_ss = pktinfo->rate_ss; /*@For AP EVM SW antenna diversity use*/ -+ -+ if (pktinfo->is_cck_rate) -+ dm->phy_dbg_info.num_qry_phy_status_cck++; -+ else -+ dm->phy_dbg_info.num_qry_phy_status_ofdm++; -+ -+ /*Reset phy_info*/ -+ phydm_reset_phy_info(dm, phy_info); -+ -+ if (dm->support_ic_type & PHYSTS_3RD_TYPE_IC) { -+ #ifdef PHYSTS_3RD_TYPE_SUPPORT -+ #ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ if (phydm_physts_auto_switch_jgr3(dm, phy_sts, pktinfo)) { -+ PHYDM_DBG(dm, DBG_PHY_STATUS, "SKIP parsing\n"); -+ phy_info->physts_rpt_valid = false; -+ return false; -+ } -+ #endif -+ phydm_rx_physts_jgr3(dm, phy_sts, pktinfo, phy_info); -+ phydm_process_dm_rssi_jgr3(dm, phy_info, pktinfo); -+ #endif -+ } else if (dm->support_ic_type & PHYSTS_2ND_TYPE_IC) { -+ #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) -+ phydm_rx_physts_2nd_type(dm, phy_sts, pktinfo, phy_info); -+ phydm_process_rssi_for_dm_2nd_type(dm, phy_info, pktinfo); -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ #if ODM_IC_11AC_SERIES_SUPPORT -+ phydm_rx_physts_1st_type(dm, phy_info, phy_sts, pktinfo); -+ phydm_process_rssi_for_dm(dm, phy_info, pktinfo); -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ #if ODM_IC_11N_SERIES_SUPPORT -+ phydm_phy_sts_n_parsing(dm, phy_info, phy_sts, pktinfo); -+ phydm_process_rssi_for_dm(dm, phy_info, pktinfo); -+ #endif -+ } -+ phy_info->signal_strength = phy_info->rx_pwdb_all; -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ phydm_process_signal_strength(dm, phy_info, pktinfo); -+ #endif -+ -+ /*For basic debug message*/ -+ if (pktinfo->is_packet_match_bssid || *dm->mp_mode) { -+ dm->curr_station_id = pktinfo->station_id; -+ dm->rx_rate = rate; -+ dm->rssi_a = phy_info->rx_mimo_signal_strength[RF_PATH_A]; -+ dm->rssi_b = phy_info->rx_mimo_signal_strength[RF_PATH_B]; -+ dm->rssi_c = phy_info->rx_mimo_signal_strength[RF_PATH_C]; -+ dm->rssi_d = phy_info->rx_mimo_signal_strength[RF_PATH_D]; -+ -+ if (rate >= ODM_RATE6M && rate <= ODM_RATE54M) -+ dm->rxsc_l = (s8)phy_info->rxsc; -+ else if (phy_info->band_width == CHANNEL_WIDTH_20) -+ dm->rxsc_20 = (s8)phy_info->rxsc; -+ else if (phy_info->band_width == CHANNEL_WIDTH_40) -+ dm->rxsc_40 = (s8)phy_info->rxsc; -+ else if (phy_info->band_width == CHANNEL_WIDTH_80) -+ dm->rxsc_80 = (s8)phy_info->rxsc; -+ -+ #ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ if (auto_swch_en && page == 4 && pktinfo->rate_ss > 1) -+ phydm_avg_condi_num(dm, phy_info, pktinfo); -+ -+ if (!auto_swch_en || -+ (pkt_proc->is_1st_mpdu || PHYDM_IS_LEGACY_RATE(rate))) -+ #endif -+ { -+ phydm_avg_rssi_evm_snr(dm, phy_info, pktinfo); -+ phydm_rx_statistic_cal(dm, phy_info, phy_sts, pktinfo); -+ } -+ } -+ -+ phy_info->physts_rpt_valid = true; -+ return true; -+} -+ -+void phydm_rx_phy_status_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; -+ -+ dbg->show_phy_sts_all_pkt = 0; -+ dbg->show_phy_sts_max_cnt = 1; -+ dbg->show_phy_sts_cnt = 0; -+ -+ phydm_avg_phystatus_init(dm); -+ -+ #ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ dm->pkt_proc_struct.physts_auto_swch_en = false; -+ #endif -+} -+ -+void phydm_physts_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ boolean enable; -+ u32 var[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ -+ for (i = 0; i < 3; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var[i]); -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Page Auto Switching: swh {en} {bitmap(hex)}\n"); -+ } else if ((strcmp(input[1], "swh") == 0)) { -+ #ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+ PHYDM_SSCANF(input[3], DCMD_HEX, &var[2]); -+ enable = (boolean)var[1]; -+ phydm_physts_auto_switch_jgr3_set(dm, enable, (u8)var[2]); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Page Auto Switching: en=%d, bitmap=0x%x\n", -+ enable, var[2]); -+ #endif -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_phystatus.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_phystatus.h -new file mode 100644 -index 000000000..c65b6245f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_phystatus.h -@@ -0,0 +1,1250 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_PHYSTATUS_H__ -+#define __PHYDM_PHYSTATUS_H__ -+ -+/* 2020.07.03 fix cck report bug due to 8723F coding error*/ -+#define PHYSTS_VERSION "1.2" -+ -+/*@--------------------------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 -+ -+#if defined(DM_ODM_CE_MAC80211) -+#define CFO_HW_RPT_2_KHZ(val) ({ \ -+ s32 cfo_hw_rpt_2_khz_tmp = (val); \ -+ (cfo_hw_rpt_2_khz_tmp << 1) + (cfo_hw_rpt_2_khz_tmp >> 1); \ -+ }) -+#else -+#define CFO_HW_RPT_2_KHZ(val) ((val << 1) + (val >> 1)) -+#endif -+ -+/* @(X* 312.5 Khz)>>7 ~= X*2.5 Khz= (X<<1 + X>>1)Khz */ -+ -+#define IGI_2_RSSI(igi) (igi - 10) -+ -+#define PHY_STATUS_JRGUAR2_DW_LEN 7 /* @7*4 = 28 Byte */ -+#define PHY_STATUS_JRGUAR3_DW_LEN 7 /* @7*4 = 28 Byte */ -+#define SHOW_PHY_STATUS_UNLIMITED 0 -+#define RSSI_MA 4 /*moving average factor for RSSI: 2^4=16 */ -+ -+#define PHYSTS_PATH_NUM 4 -+ -+/*@************************************************************ -+ * structure and define -+ ************************************************************/ -+ -+__PACK struct phy_rx_agc_info { -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 gain : 7, trsw : 1; -+#else -+ u8 trsw : 1, gain : 7; -+#endif -+}; -+ -+__PACK struct phy_status_rpt_8192cd { -+ struct phy_rx_agc_info 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 -+}; -+ -+struct phy_status_rpt_8812 { -+ /* @DWORD 0*/ -+ u8 gain_trsw[2]; /*path-A and path-B {TRSW, gain[6:0] }*/ -+ u8 chl_num_LSB; /*@channel number[7:0]*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 chl_num_MSB : 2; /*@channel number[9:8]*/ -+ u8 sub_chnl : 4; /*sub-channel location[3:0]*/ -+ u8 r_RFMOD : 2; /*RF mode[1:0]*/ -+#else /*@_BIG_ENDIAN_ */ -+ u8 r_RFMOD : 2; -+ u8 sub_chnl : 4; -+ u8 chl_num_MSB : 2; -+#endif -+ -+ /* @DWORD 1*/ -+ u8 pwdb_all; /*@CCK signal quality / OFDM pwdb all*/ -+ s8 cfosho[2]; /*@CCK AGC report and CCK_BB_Power*/ -+ /*OFDM path-A and path-B short CFO*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 resvd_0 : 6; -+ u8 bt_RF_ch_MSB : 2; /*@8812A:2'b0 8814A: bt rf channel keep[7:6]*/ -+#else /*@_BIG_ENDIAN_*/ -+ u8 bt_RF_ch_MSB : 2; -+ u8 resvd_0 : 6; -+#endif -+ -+/* @DWORD 2*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 ant_div_sw_a : 1; /*@8812A: ant_div_sw_a 8814A: 1'b0*/ -+ u8 ant_div_sw_b : 1; /*@8812A: ant_div_sw_b 8814A: 1'b0*/ -+ u8 bt_RF_ch_LSB : 6; /*@8812A: 6'b0 8814A: bt rf channel keep[5:0]*/ -+#else /*@_BIG_ENDIAN_ */ -+ u8 bt_RF_ch_LSB : 6; -+ u8 ant_div_sw_b : 1; -+ u8 ant_div_sw_a : 1; -+#endif -+ s8 cfotail[2]; /*@DW2 byte 1 DW2 byte 2 path-A and path-B CFO tail*/ -+ u8 PCTS_MSK_RPT_0; /*PCTS mask report[7:0]*/ -+ u8 PCTS_MSK_RPT_1; /*PCTS mask report[15:8]*/ -+ -+ /* @DWORD 3*/ -+ s8 rxevm[2]; /*@DW3 byte 1 DW3 byte 2 stream 1 and stream 2 RX EVM*/ -+ s8 rxsnr[2]; /*@DW3 byte 3 DW4 byte 0 path-A and path-B RX SNR*/ -+ -+ /* @DWORD 4*/ -+ u8 PCTS_MSK_RPT_2; /*PCTS mask report[23:16]*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 PCTS_MSK_RPT_3 : 6; /*PCTS mask report[29:24]*/ -+ u8 pcts_rpt_valid : 1; /*pcts_rpt_valid*/ -+ u8 resvd_1 : 1; /*@1'b0*/ -+#else /*@_BIG_ENDIAN_*/ -+ u8 resvd_1 : 1; -+ u8 pcts_rpt_valid : 1; -+ u8 PCTS_MSK_RPT_3 : 6; -+#endif -+ s8 rxevm_cd[2]; /*@8812A: 16'b0*/ -+ /*@8814A: stream 3 and stream 4 RX EVM*/ -+ /* @DWORD 5*/ -+ u8 csi_current[2]; /*@8812A: stream 1 and 2 CSI*/ -+ /*@8814A: path-C and path-D RX SNR*/ -+ u8 gain_trsw_cd[2]; /*path-C and path-D {TRSW, gain[6:0] }*/ -+ -+ /* @DWORD 6*/ -+ s8 sigevm; /*signal field EVM*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_antc : 3; /*@8812A: 3'b0 8814A: antidx_antc[2:0]*/ -+ u8 antidx_antd : 3; /*@8812A: 3'b0 8814A: antidx_antd[2:0]*/ -+ u8 dpdt_ctrl_keep : 1; /*@8812A: 1'b0 8814A: dpdt_ctrl_keep*/ -+ u8 GNT_BT_keep : 1; /*@8812A: 1'b0 8814A: GNT_BT_keep*/ -+#else /*@_BIG_ENDIAN_*/ -+ u8 GNT_BT_keep : 1; -+ u8 dpdt_ctrl_keep : 1; -+ u8 antidx_antd : 3; -+ u8 antidx_antc : 3; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_anta : 3; /*@antidx_anta[2:0]*/ -+ u8 antidx_antb : 3; /*@antidx_antb[2:0]*/ -+ u8 hw_antsw_occur : 2; /*@1'b0*/ -+#else /*@_BIG_ENDIAN_*/ -+ u8 hw_antsw_occur : 2; -+ u8 antidx_antb : 3; -+ u8 antidx_anta : 3; -+#endif -+}; -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ -+__PACK struct phy_sts_rpt_jgr2_type0 { -+ /* @DW0 */ -+ u8 page_num; -+ u8 pwdb; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 gain : 6; -+ u8 rsvd_0 : 1; -+ u8 trsw : 1; -+#else -+ u8 trsw : 1; -+ u8 rsvd_0 : 1; -+ u8 gain : 6; -+#endif -+ u8 rsvd_1; -+ -+ /* @DW1 */ -+ u8 rsvd_2; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 rxsc : 4; -+ u8 agc_table : 4; -+#else -+ u8 agc_table : 4; -+ u8 rxsc : 4; -+#endif -+ u8 channel; -+ u8 band; -+ -+ /* @DW2 */ -+ u16 length; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_a : 3; -+ u8 antidx_b : 3; -+ u8 rsvd_3 : 2; -+ u8 antidx_c : 3; -+ u8 antidx_d : 3; -+ u8 rsvd_4 : 2; -+#else -+ u8 rsvd_3 : 2; -+ u8 antidx_b : 3; -+ u8 antidx_a : 3; -+ u8 rsvd_4 : 2; -+ u8 antidx_d : 3; -+ u8 antidx_c : 3; -+#endif -+ -+ /* @DW3 */ -+ u8 signal_quality; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 vga : 5; -+ u8 lna_l : 3; -+ u8 bb_power : 6; -+ u8 rsvd_9 : 1; -+ u8 lna_h : 1; -+#else -+ u8 lna_l : 3; -+ u8 vga : 5; -+ u8 lna_h : 1; -+ u8 rsvd_9 : 1; -+ u8 bb_power : 6; -+#endif -+ u8 rsvd_5; -+ -+ /* @DW4 */ -+ u32 rsvd_6; -+ -+ /* @DW5 */ -+ u32 rsvd_7; -+ -+ /* @DW6 */ -+ u32 rsvd_8; -+}; -+ -+__PACK struct phy_sts_rpt_jgr2_type1 { -+ /* @DW0 and DW1 */ -+ u8 page_num; -+ u8 pwdb[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 l_rxsc : 4; -+ u8 ht_rxsc : 4; -+#else -+ u8 ht_rxsc : 4; -+ u8 l_rxsc : 4; -+#endif -+ u8 channel; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 band : 2; -+ u8 rsvd_0 : 1; -+ u8 hw_antsw_occu : 1; -+ u8 gnt_bt : 1; -+ u8 ldpc : 1; -+ u8 stbc : 1; -+ u8 beamformed : 1; -+#else -+ u8 beamformed : 1; -+ u8 stbc : 1; -+ u8 ldpc : 1; -+ u8 gnt_bt : 1; -+ u8 hw_antsw_occu : 1; -+ u8 rsvd_0 : 1; -+ u8 band : 2; -+#endif -+ -+ /* @DW2 */ -+ u16 lsig_length; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_a : 3; -+ u8 antidx_b : 3; -+ u8 rsvd_1 : 2; -+ u8 antidx_c : 3; -+ u8 antidx_d : 3; -+ u8 rsvd_2 : 2; -+#else -+ u8 rsvd_1 : 2; -+ u8 antidx_b : 3; -+ u8 antidx_a : 3; -+ u8 rsvd_2 : 2; -+ u8 antidx_d : 3; -+ u8 antidx_c : 3; -+#endif -+ -+ /* @DW3 */ -+ u8 paid; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 paid_msb : 1; -+ u8 gid : 6; -+ u8 rsvd_3 : 1; -+#else -+ u8 rsvd_3 : 1; -+ u8 gid : 6; -+ u8 paid_msb : 1; -+#endif -+ u8 intf_pos; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 intf_pos_msb : 1; -+ u8 rsvd_4 : 2; -+ u8 nb_intf_flag : 1; -+ u8 rf_mode : 2; -+ u8 rsvd_5 : 2; -+#else -+ u8 rsvd_5 : 2; -+ u8 rf_mode : 2; -+ u8 nb_intf_flag : 1; -+ u8 rsvd_4 : 2; -+ u8 intf_pos_msb : 1; -+#endif -+ -+ /* @DW4 */ -+ s8 rxevm[4]; /* s(8,1) */ -+ -+ /* @DW5 */ -+ s8 cfo_tail[4]; /* s(8,7) */ -+ -+ /* @DW6 */ -+ s8 rxsnr[4]; /* s(8,1) */ -+}; -+ -+__PACK struct phy_sts_rpt_jgr2_type2 { -+ /* @DW0 ane DW1 */ -+ u8 page_num; -+ u8 pwdb[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 l_rxsc : 4; -+ u8 ht_rxsc : 4; -+#else -+ u8 ht_rxsc : 4; -+ u8 l_rxsc : 4; -+#endif -+ u8 channel; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 band : 2; -+ u8 rsvd_0 : 1; -+ u8 hw_antsw_occu : 1; -+ u8 gnt_bt : 1; -+ u8 ldpc : 1; -+ u8 stbc : 1; -+ u8 beamformed : 1; -+#else -+ u8 beamformed : 1; -+ u8 stbc : 1; -+ u8 ldpc : 1; -+ u8 gnt_bt : 1; -+ u8 hw_antsw_occu : 1; -+ u8 rsvd_0 : 1; -+ u8 band : 2; -+#endif -+ -+/* @DW2 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 shift_l_map : 6; -+ u8 rsvd_1 : 2; -+#else -+ u8 rsvd_1 : 2; -+ u8 shift_l_map : 6; -+#endif -+ u8 cnt_pw2cca; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 agc_table_a : 4; -+ u8 agc_table_b : 4; -+ u8 agc_table_c : 4; -+ u8 agc_table_d : 4; -+#else -+ u8 agc_table_b : 4; -+ u8 agc_table_a : 4; -+ u8 agc_table_d : 4; -+ u8 agc_table_c : 4; -+#endif -+ -+ /* @DW3 ~ DW6*/ -+ u8 cnt_cca2agc_rdy; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 gain_a : 6; -+ u8 rsvd_2 : 1; -+ u8 trsw_a : 1; -+ u8 gain_b : 6; -+ u8 rsvd_3 : 1; -+ u8 trsw_b : 1; -+ u8 gain_c : 6; -+ u8 rsvd_4 : 1; -+ u8 trsw_c : 1; -+ u8 gain_d : 6; -+ u8 rsvd_5 : 1; -+ u8 trsw_d : 1; -+ u8 aagc_step_a : 2; -+ u8 aagc_step_b : 2; -+ u8 aagc_step_c : 2; -+ u8 aagc_step_d : 2; -+#else -+ u8 trsw_a : 1; -+ u8 rsvd_2 : 1; -+ u8 gain_a : 6; -+ u8 trsw_b : 1; -+ u8 rsvd_3 : 1; -+ u8 gain_b : 6; -+ u8 trsw_c : 1; -+ u8 rsvd_4 : 1; -+ u8 gain_c : 6; -+ u8 trsw_d : 1; -+ u8 rsvd_5 : 1; -+ u8 gain_d : 6; -+ u8 aagc_step_d : 2; -+ u8 aagc_step_c : 2; -+ u8 aagc_step_b : 2; -+ u8 aagc_step_a : 2; -+#endif -+ u8 ht_aagc_gain[4]; -+ u8 dagc_gain[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 counter : 6; -+ u8 rsvd_6 : 2; -+ u8 syn_count : 5; -+ u8 rsvd_7 : 3; -+#else -+ u8 rsvd_6 : 2; -+ u8 counter : 6; -+ u8 rsvd_7 : 3; -+ u8 syn_count : 5; -+#endif -+}; -+#endif -+ -+/*@==============================================*/ -+#ifdef PHYSTS_3RD_TYPE_SUPPORT -+__PACK struct phy_sts_rpt_jgr3_type0 { -+/* @DW0 : Offset 0 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 page_num : 4; -+ u8 pkt_cnt : 2; -+ u8 channel_msb : 2; -+#else -+ u8 channel_msb : 2; -+ u8 pkt_cnt : 2; -+ u8 page_num : 4; -+#endif -+ u8 pwdb_a; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 gain_a : 6; -+ u8 rsvd_0 : 1; -+ u8 trsw : 1; -+#else -+ u8 trsw : 1; -+ u8 rsvd_0 : 1; -+ u8 gain_a : 6; -+#endif -+ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 agc_table_b : 4; -+ u8 agc_table_c : 4; -+#else -+ u8 agc_table_c : 4; -+ u8 agc_table_b : 4; -+#endif -+ -+/* @DW1 : Offset 4 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 rsvd_1 : 4; -+ u8 agc_table_d : 4; -+#else -+ u8 agc_table_d : 4; -+ u8 rsvd_1 : 4; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 l_rxsc : 4; -+ u8 agc_table_a : 4; -+#else -+ u8 agc_table_a : 4; -+ u8 l_rxsc : 4; -+#endif -+ u8 channel; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 band : 2; -+ u8 rsvd_2_1 : 1; -+ u8 hw_antsw_occur_keep_cck : 1; -+ u8 gnt_bt_keep_cck : 1; -+ u8 rsvd_2_2 : 1; -+ u8 path_sel_o : 2; -+#else -+ u8 path_sel_o : 2; -+ u8 rsvd_2_2 : 1; -+ u8 gnt_bt_keep_cck : 1; -+ u8 hw_antsw_occur_keep_cck : 1; -+ u8 rsvd_2_1 : 1; -+ u8 band : 2; -+#endif -+ -+ /* @DW2 : Offset 8 */ -+ u16 length; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_a : 4; -+ u8 antidx_b : 4; -+#else -+ u8 antidx_b : 4; -+ u8 antidx_a : 4; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_c : 4; -+ u8 antidx_d : 4; -+#else -+ u8 antidx_d : 4; -+ u8 antidx_c : 4; -+#endif -+ -+ /* @DW3 : Offset 12 */ -+ u8 signal_quality; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 vga_a : 5; -+ u8 lna_l_a : 3; -+#else -+ u8 lna_l_a : 3; -+ u8 vga_a : 5; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 bb_power_a : 6; -+ u8 rsvd_3_1 : 1; -+ u8 lna_h_a : 1; -+#else -+ -+ u8 lna_h_a : 1; -+ u8 rsvd_3_1 : 1; -+ u8 bb_power_a : 6; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 rxrate : 2; -+ u8 raterr : 1; -+ u8 lockbit : 1; -+ u8 sqloss : 1; -+ u8 mf_off : 1; -+ u8 rsvd_3_2 : 2; -+#else -+ u8 rsvd_3_2 : 2; -+ u8 mf_off : 1; -+ u8 sqloss : 1; -+ u8 lockbit : 1; -+ u8 raterr : 1; -+ u8 rxrate : 2; -+#endif -+ -+ /* @DW4 : Offset 16 */ -+ u8 pwdb_b; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 vga_b : 5; -+ u8 lna_l_b : 3; -+#else -+ u8 lna_l_b : 3; -+ u8 vga_b : 5; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 bb_power_b : 6; -+ u8 rsvd_4_1 : 1; -+ u8 lna_h_b : 1; -+#else -+ u8 lna_h_b : 1; -+ u8 rsvd_4_1 : 1; -+ u8 bb_power_b : 6; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 gain_b : 6; -+ u8 rsvd_4_2 : 2; -+#else -+ u8 rsvd_4_2 : 2; -+ u8 gain_b : 6; -+#endif -+ -+ /* @DW5 : Offset 20 */ -+ u8 pwdb_c; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 vga_c : 5; -+ u8 lna_l_c : 3; -+#else -+ u8 lna_l_c : 3; -+ u8 vga_c : 5; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 bb_power_c : 6; -+ u8 rsvd_5_1 : 1; -+ u8 lna_h_c : 1; -+#else -+ u8 lna_h_c : 1; -+ u8 rsvd_5_1 : 1; -+ u8 bb_power_c : 6; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 gain_c : 6; -+ u8 rsvd_5_2 : 2; -+#else -+ u8 rsvd_5_2 : 2; -+ u8 gain_c : 6; -+#endif -+ -+ /* @DW6 : Offset 24 */ -+ u8 pwdb_d; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 vga_d : 5; -+ u8 lna_l_d : 3; -+#else -+ u8 lna_l_d : 3; -+ u8 vga_d : 5; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 bb_power_d : 6; -+ u8 rsvd_6_1 : 1; -+ u8 lna_h_d : 1; -+#else -+ u8 lna_h_d : 1; -+ u8 rsvd_6_1 : 1; -+ u8 bb_power_d : 6; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 gain_d : 6; -+ u8 rsvd_6_2 : 2; -+#else -+ u8 rsvd_6_2 : 2; -+ u8 gain_d : 6; -+#endif -+}; -+#if(RTL8723F_SUPPORT) -+__PACK struct phy_sts_rpt_jgr3_type6 { -+ /* judy_add_8723F_0512 */ -+/* @DW0 : Offset 0 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 pop_idx : 4; -+ u8 pkt_cnt : 2; -+ u8 channel_msb : 2; -+#else -+ u8 channel_msb : 2; -+ u8 pkt_cnt : 2; -+ u8 pop_idx : 4; -+#endif -+ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 agc_table_a : 4; -+ u8 rsvd_0 : 4; -+#else -+ u8 rsvd_0 : 4; -+ u8 agc_table_a : 4; -+#endif -+ u8 rsvd_1 : 8; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 trsw : 1; -+ u8 hw_antsw_occur_keep_cck : 1; -+ u8 gnt_bt_keep_cck : 1; -+ u8 rssi_msb : 3; -+ u8 rsvd_2 : 2; -+#else -+ u8 rsvd_2 : 2; -+ u8 rssi_msb : 3; -+ u8 gnt_bt_keep_cck : 1; -+ u8 hw_antsw_occur_keep_cck : 1; -+ u8 trsw : 1; -+#endif -+ -+/* @DW1 : Offset 4 */ -+ u8 channel; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_a : 4; -+ u8 rsvd_2_1 : 4; -+#else -+ u8 rsvd_2_1 : 4; -+ u8 antidx_a : 4; -+#endif -+ u8 rsvd_2_2; -+ u8 mp_gain_idx_a; -+ -+/* @DW2 : Offset 8 */ -+ u16 rsvd_3_1; -+ u8 rsvd_4_1; -+ u8 rssi; -+ -+/* @DW3 : Offset 12 */ -+ u16 rsvd_4_2; -+ u8 rsvd_5_1; -+ u8 avg_cfo; -+/* @DW4 : Offset 16 */ -+ u8 coarse_cfo; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 coarse_cfo_msb : 4; -+ u8 avg_cfo_msb : 4; -+#else -+ u8 avg_cfo_msb : 4; -+ u8 coarse_cfo_msb : 4; -+#endif -+ u8 evm_hdr; -+ u8 evm_pld; -+/* @DW5 : Offset 20 */ -+ u32 rsvd_6_1; -+ u32 rsvd_7_1; -+}; -+#endif -+__PACK struct phy_sts_rpt_jgr3_type1 { -+/* @DW0 : Offset 0 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 page_num : 4; -+ u8 pkt_cnt : 2; -+ u8 channel_pri_msb : 2; -+#else -+ u8 channel_pri_msb : 2; -+ u8 pkt_cnt : 2; -+ u8 page_num : 4; -+#endif -+ u8 pwdb_a; -+ u8 pwdb_b; -+ u8 pwdb_c; -+ -+ /* @DW1 : Offset 4 */ -+ u8 pwdb_d; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 l_rxsc : 4; -+ u8 ht_rxsc : 4; -+#else -+ u8 ht_rxsc : 4; -+ u8 l_rxsc : 4; -+#endif -+ u8 channel_pri_lsb; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 band : 2; -+ u8 rsvd_0 : 2; -+ u8 gnt_bt : 1; -+ u8 ldpc : 1; -+ u8 stbc : 1; -+ u8 beamformed : 1; -+#else -+ u8 beamformed : 1; -+ u8 stbc : 1; -+ u8 ldpc : 1; -+ u8 gnt_bt : 1; -+ u8 rsvd_0 : 2; -+ u8 band : 2; -+#endif -+ -+ /* @DW2 : Offset 8 */ -+ u8 channel_sec_lsb; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 channel_sec_msb : 2; -+ u8 rsvd_1 : 2; -+ u8 hw_antsw_occur_a : 1; -+ u8 hw_antsw_occur_b : 1; -+ u8 hw_antsw_occur_c : 1; -+ u8 hw_antsw_occur_d : 1; -+#else -+ u8 hw_antsw_occur_d : 1; -+ u8 hw_antsw_occur_c : 1; -+ u8 hw_antsw_occur_b : 1; -+ u8 hw_antsw_occur_a : 1; -+ u8 rsvd_1 : 2; -+ u8 channel_sec_msb : 2; -+ -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_a : 4; -+ u8 antidx_b : 4; -+#else -+ u8 antidx_b : 4; -+ u8 antidx_a : 4; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_c : 4; -+ u8 antidx_d : 4; -+#else -+ u8 antidx_d : 4; -+ u8 antidx_c : 4; -+#endif -+ -+ /* @DW3 : Offset 12 */ -+ u8 paid; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 paid_msb : 1; -+ u8 gid : 6; -+ u8 rsvd_3 : 1; -+#else -+ u8 rsvd_3 : 1; -+ u8 gid : 6; -+ u8 paid_msb : 1; -+#endif -+ u16 rsvd_4; -+#if 0 -+ /*@ -+ u8 rsvd_4; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 rsvd_5: 6; -+ u8 rf_mode: 2; -+#else -+ u8 rf_mode: 2; -+ u8 rsvd_5: 6; -+#endif -+*/ -+#endif -+ /* @DW4 : Offset 16 */ -+ s8 rxevm[4]; /* s(8,1) */ -+ -+ /* @DW5 : Offset 20 */ -+ s8 cfo_tail[4]; /* s(8,7) */ -+ -+ /* @DW6 : Offset 24 */ -+ s8 rxsnr[4]; /* s(8,1) */ -+}; -+ -+__PACK struct phy_sts_rpt_jgr3_type2_3 { -+/* Type2 is primary channel & type3 is secondary channel */ -+/* @DW0 and DW1: Offest 0 and Offset 4 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 page_num : 4; -+ u8 pkt_cnt : 2; -+ u8 channel_msb : 2; -+#else -+ u8 channel_msb : 2; -+ u8 pkt_cnt : 2; -+ u8 page_num : 4; -+#endif -+ u8 pwdb[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 l_rxsc : 4; -+ u8 ht_rxsc : 4; -+#else -+ u8 ht_rxsc : 4; -+ u8 l_rxsc : 4; -+#endif -+ u8 channel_lsb; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 band : 2; -+ u8 rsvd_0 : 2; -+ u8 gnt_bt : 1; -+ u8 ldpc : 1; -+ u8 stbc : 1; -+ u8 beamformed : 1; -+#else -+ u8 beamformed : 1; -+ u8 stbc : 1; -+ u8 ldpc : 1; -+ u8 gnt_bt : 1; -+ u8 rsvd_0 : 2; -+ u8 band : 2; -+#endif -+ -+/* @DW2 : Offset 8 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 shift_l_map : 6; -+ u8 rsvd_1 : 2; -+#else -+ u8 rsvd_1 : 2; -+ u8 shift_l_map : 6; -+#endif -+ s8 pwed_th; /* @dynamic energy threshold S(8,2) */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 agc_table_a : 4; -+ u8 agc_table_b : 4; -+#else -+ u8 agc_table_b : 4; -+ u8 agc_table_a : 4; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 agc_table_c : 4; -+ u8 agc_table_d : 4; -+#else -+ u8 agc_table_d : 4; -+ u8 agc_table_c : 4; -+#endif -+ -+ /* @DW3 : Offset 12 */ -+ u8 cnt_cca2agc_rdy; /* Time(ns) = cnt_cca2agc_ready*25 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 mp_gain_a : 6; -+ u8 mp_gain_b_lsb : 2; -+#else -+ u8 mp_gain_b_lsb : 2; -+ u8 mp_gain_a : 6; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 mp_gain_b_msb : 4; -+ u8 mp_gain_c_lsb : 4; -+#else -+ u8 mp_gain_c_lsb : 4; -+ u8 mp_gain_b_msb : 4; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 mp_gain_c_msb : 2; -+ u8 avg_noise_pwr_lsb : 4; -+ u8 rsvd_3 : 2; -+ /* u8 r_rfmod:2; */ -+#else -+ /* u8 r_rfmod:2; */ -+ u8 rsvd_3 : 2; -+ u8 avg_noise_pwr_lsb : 4; -+ u8 mp_gain_c_msb : 2; -+#endif -+ /* @DW4 ~ 5: offset 16 ~20 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 mp_gain_d : 6; -+ u8 is_freq_select_fading : 1; -+ u8 rsvd_2 : 1; -+#else -+ u8 rsvd_2 : 1; -+ u8 is_freq_select_fading : 1; -+ u8 mp_gain_d : 6; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 aagc_step_a : 2; -+ u8 aagc_step_b : 2; -+ u8 aagc_step_c : 2; -+ u8 aagc_step_d : 2; -+#else -+ u8 aagc_step_d : 2; -+ u8 aagc_step_c : 2; -+ u8 aagc_step_b : 2; -+ u8 aagc_step_a : 2; -+#endif -+ u8 ht_aagc_gain[4]; -+ u8 dagc_gain[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 counter : 6; -+ u8 syn_count_lsb : 2; -+#else -+ u8 syn_count_lsb : 2; -+ u8 counter : 6; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 syn_count_msb : 3; -+ u8 avg_noise_pwr_msb : 5; -+#else -+ u8 avg_noise_pwr_msb : 5; -+ u8 syn_count_msb : 3; -+#endif -+}; -+ -+__PACK struct phy_sts_rpt_jgr3_type4 { -+/* smart antenna */ -+/* @DW0 and DW1 : offset 0 and 4 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 page_num : 4; -+ u8 pkt_cnt : 2; -+ u8 channel_msb : 2; -+#else -+ u8 channel_msb : 2; -+ u8 pkt_cnt : 2; -+ u8 page_num : 4; -+#endif -+ u8 pwdb[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 l_rxsc : 4; -+ u8 ht_rxsc : 4; -+#else -+ u8 ht_rxsc : 4; -+ u8 l_rxsc : 4; -+#endif -+ u8 channel_lsb; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 band : 2; -+ u8 rsvd_0 : 2; -+ u8 gnt_bt : 1; -+ u8 ldpc : 1; -+ u8 stbc : 1; -+ u8 beamformed : 1; -+#else -+ u8 beamformed : 1; -+ u8 stbc : 1; -+ u8 ldpc : 1; -+ u8 gnt_bt : 1; -+ u8 rsvd_0 : 1; -+ u8 band : 2; -+#endif -+ -+/* @DW2 : offset 8 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 bad_tone_cnt_min_eign_0 : 4; -+ u8 bad_tone_cnt_cn_excess_0 : 4; -+#else -+ u8 bad_tone_cnt_cn_excess_0 : 4; -+ u8 bad_tone_cnt_min_eign_0 : 4; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 training_done_a : 1; -+ u8 training_done_b : 1; -+ u8 training_done_c : 1; -+ u8 training_done_d : 1; -+ u8 hw_antsw_occur_a : 1; -+ u8 hw_antsw_occur_b : 1; -+ u8 hw_antsw_occur_c : 1; -+ u8 hw_antsw_occur_d : 1; -+#else -+ u8 hw_antsw_occur_d : 1; -+ u8 hw_antsw_occur_c : 1; -+ u8 hw_antsw_occur_b : 1; -+ u8 hw_antsw_occur_a : 1; -+ u8 training_done_d : 1; -+ u8 training_done_c : 1; -+ u8 training_done_b : 1; -+ u8 training_done_a : 1; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_a : 4; -+ u8 antidx_b : 4; -+#else -+ u8 antidx_b : 4; -+ u8 antidx_a : 4; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_c : 4; -+ u8 antidx_d : 4; -+#else -+ u8 antidx_d : 4; -+ u8 antidx_c : 4; -+#endif -+/* @DW3 : offset 12 */ -+ u8 tx_pkt_cnt; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 bad_tone_cnt_min_eign_1 : 4; -+ u8 bad_tone_cnt_cn_excess_1 : 4; -+#else -+ u8 bad_tone_cnt_cn_excess_1 : 4; -+ u8 bad_tone_cnt_min_eign_1 : 4; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 avg_cond_num_0 : 7; -+ u8 avg_cond_num_1_lsb : 1; -+#else -+ u8 avg_cond_num_1_lsb : 1; -+ u8 avg_cond_num_0 : 7; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 avg_cond_num_1_msb : 6; -+ u8 rsvd_1 : 2; -+#else -+ u8 rsvd_1 : 2; -+ u8 avg_cond_num_1_msb : 6; -+#endif -+ -+ /* @DW4 : offset 16 */ -+ s8 rxevm[4]; /* s(8,1) */ -+ -+ /* @DW5 : offset 20 */ -+ u8 eigenvalue[4]; /* @eigenvalue or eigenvalue of seg0 (in dB) */ -+ -+ /* @DW6 : ofset 24 */ -+ s8 rxsnr[4]; /* s(8,1) */ -+}; -+ -+__PACK struct phy_sts_rpt_jgr3_type5 { -+/* @Debug */ -+/* @DW0 ane DW1 : offset 0 and 4 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 page_num : 4; -+ u8 pkt_cnt : 2; -+ u8 channel_msb : 2; -+#else -+ u8 channel_msb : 2; -+ u8 pkt_cnt : 2; -+ u8 page_num : 4; -+#endif -+ u8 pwdb[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 l_rxsc : 4; -+ u8 ht_rxsc : 4; -+#else -+ u8 ht_rxsc : 4; -+ u8 l_rxsc : 4; -+#endif -+ u8 channel_lsb; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 band : 2; -+ u8 rsvd_0 : 2; -+ u8 gnt_bt : 1; -+ u8 ldpc : 1; -+ u8 stbc : 1; -+ u8 beamformed : 1; -+#else -+ u8 beamformed : 1; -+ u8 stbc : 1; -+ u8 ldpc : 1; -+ u8 gnt_bt : 1; -+ u8 rsvd_0 : 2; -+ u8 band : 2; -+#endif -+ /* @DW2 : offset 8 */ -+ u8 rsvd_1; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 rsvd_2 : 4; -+ u8 hw_antsw_occur_a : 1; -+ u8 hw_antsw_occur_b : 1; -+ u8 hw_antsw_occur_c : 1; -+ u8 hw_antsw_occur_d : 1; -+#else -+ u8 hw_antsw_occur_d : 1; -+ u8 hw_antsw_occur_c : 1; -+ u8 hw_antsw_occur_b : 1; -+ u8 hw_antsw_occur_a : 1; -+ u8 rsvd_2 : 4; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_a : 4; -+ u8 antidx_b : 4; -+#else -+ u8 antidx_b : 4; -+ u8 antidx_a : 4; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 antidx_c : 4; -+ u8 antidx_d : 4; -+#else -+ u8 antidx_d : 4; -+ u8 antidx_c : 4; -+#endif -+ /* @DW3 : offset 12 */ -+ u8 tx_pkt_cnt; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 inf_pos_0_A_flg : 1; -+ u8 inf_pos_1_A_flg : 1; -+ u8 inf_pos_0_B_flg : 1; -+ u8 inf_pos_1_B_flg : 1; -+ u8 inf_pos_0_C_flg : 1; -+ u8 inf_pos_1_C_flg : 1; -+ u8 inf_pos_0_D_flg : 1; -+ u8 inf_pos_1_D_flg : 1; -+#else -+ u8 inf_pos_1_D_flg : 1; -+ u8 inf_pos_0_D_flg : 1; -+ u8 inf_pos_1_C_flg : 1; -+ u8 inf_pos_0_C_flg : 1; -+ u8 inf_pos_1_B_flg : 1; -+ u8 inf_pos_0_B_flg : 1; -+ u8 inf_pos_1_A_flg : 1; -+ u8 inf_pos_0_A_flg : 1; -+#endif -+ u8 rsvd_3; -+ u8 rsvd_4; -+ /* @DW4 : offset 16 */ -+ u8 inf_pos_0_a; -+ u8 inf_pos_1_a; -+ u8 inf_pos_0_b; -+ u8 inf_pos_1_b; -+ /* @DW5 : offset 20 */ -+ u8 inf_pos_0_c; -+ u8 inf_pos_1_c; -+ u8 inf_pos_0_d; -+ u8 inf_pos_1_d; -+}; -+ -+__PACK struct phy_sts_rpt_jgr3_ofdm_cmn { -+ #if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 page_num : 4; -+ u8 pkt_cnt : 2; -+ u8 channel_msb : 2; -+ #else -+ u8 channel_msb : 2; -+ u8 pkt_cnt : 2; -+ u8 page_num : 4; -+ #endif -+ u8 pwdb[4]; -+ #if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 l_rxsc : 4; -+ u8 ht_rxsc : 4; -+ #else -+ u8 ht_rxsc : 4; -+ u8 l_rxsc : 4; -+ #endif -+ u8 channel_lsb; -+ #if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u8 band : 2; -+ u8 rsvd_0 : 2; -+ u8 gnt_bt : 1; -+ u8 ldpc : 1; -+ u8 stbc : 1; -+ u8 beamformed : 1; -+ #else -+ u8 beamformed : 1; -+ u8 stbc : 1; -+ u8 ldpc : 1; -+ u8 gnt_bt : 1; -+ u8 rsvd_0 : 1; -+ u8 band : 2; -+ #endif -+}; -+#endif /*@#ifdef PHYSTS_3RD_TYPE_SUPPORT*/ -+ -+#ifdef PHYDM_PHYSTAUS_AUTO_SWITCH -+void phydm_physts_auto_switch_jgr3_set(void *dm_void, boolean enable, -+ u8 bitmap_en); -+#endif -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+boolean -+phydm_query_is_mu_api(struct dm_struct *phydm, u8 ppdu_idx, u8 *p_data_rate, -+ u8 *p_gid); -+#endif -+ -+void phydm_reset_phystatus_avg(struct dm_struct *dm); -+ -+void phydm_reset_phystatus_statistic(struct dm_struct *dm); -+ -+void phydm_reset_rssi_for_dm(struct dm_struct *dm, u8 station_id); -+ -+void phydm_get_cck_rssi_table_from_reg(struct dm_struct *dm); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_normal_driver_rx_sniffer( -+ struct dm_struct *dm, -+ u8 *desc, -+ PRT_RFD_STATUS rt_rfd_status, -+ u8 *drv_info, -+ u8 phy_status); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+s32 phydm_signal_scale_mapping(struct dm_struct *dm, s32 curr_sig); -+#endif -+ -+boolean odm_phy_status_query(struct dm_struct *dm, -+ struct phydm_phyinfo_struct *phy_info, -+ u8 *phy_sts, -+ struct phydm_perpkt_info_struct *pktinfo); -+ -+void phydm_rx_phy_status_init(void *dm_void); -+ -+void phydm_physts_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+#endif /*@#ifndef __HALHWOUTSRC_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pmac_tx_setting.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pmac_tx_setting.c -new file mode 100644 -index 000000000..15a4e9376 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pmac_tx_setting.c -@@ -0,0 +1,585 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+void phydm_start_cck_cont_tx_jgr3(void *dm_void, -+ struct phydm_pmac_info *tx_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ u8 rate = tx_info->tx_rate; /* HW rate */ -+ -+ /* if CCK block on? */ -+ if (!odm_get_bb_reg(dm, R_0x1c3c, BIT(1))) -+ odm_set_bb_reg(dm, R_0x1c3c, BIT(1), 0x1); -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ odm_set_bb_reg(dm, R_0x2a08, BIT(21)|BIT(20), rate); -+ odm_set_bb_reg(dm, R_0x2a04, BIT(5), 0x0); /* turn on scrambler*/ -+ } else { -+ /* Turn Off All Test mode */ -+ odm_set_bb_reg(dm, R_0x1ca4, 0x7, 0x0); -+ -+ odm_set_bb_reg(dm, R_0x1a00, 0x3000, rate); -+ odm_set_bb_reg(dm, R_0x1a00, 0x3, 0x2); /* transmit mode */ -+ odm_set_bb_reg(dm, R_0x1a00, BIT(3), 0x1); /* turn on scrambler*/ -+ -+ /* Fix rate selection issue */ -+ odm_set_bb_reg(dm, R_0x1a70, BIT(14), 0x1); -+ /* set RX weighting for path I & Q to 0 */ -+ odm_set_bb_reg(dm, R_0x1a14, 0x300, 0x3); -+ /* set loopback mode */ -+ odm_set_bb_reg(dm, R_0x1c3c, BIT(4), 0x1); -+ } -+ pmac_tx->cck_cont_tx = true; -+ pmac_tx->ofdm_cont_tx = false; -+} -+ -+void phydm_stop_cck_cont_tx_jgr3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ -+ pmac_tx->cck_cont_tx = false; -+ pmac_tx->ofdm_cont_tx = false; -+ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ /* @Disable pmac tx_en*/ -+ odm_set_bb_reg(dm, R_0x2a04, BIT(5), 0x0); /* turn on scrambler*/ -+ } else { -+ odm_set_bb_reg(dm, R_0x1a00, 0x3, 0x0); /* normal mode */ -+ odm_set_bb_reg(dm, R_0x1a00, BIT(3), 0x1); /* turn on scrambler*/ -+ -+ /* back to default */ -+ odm_set_bb_reg(dm, R_0x1a70, BIT(14), 0x0); -+ odm_set_bb_reg(dm, R_0x1a14, 0x300, 0x0); -+ odm_set_bb_reg(dm, R_0x1c3c, BIT(4), 0x0); -+ } -+ /* BB Reset */ -+ odm_set_bb_reg(dm, R_0x1d0c, BIT(16), 0x0); -+ odm_set_bb_reg(dm, R_0x1d0c, BIT(16), 0x1); -+} -+ -+void phydm_start_ofdm_cont_tx_jgr3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ -+ /* 1. if OFDM block on */ -+ if (!odm_get_bb_reg(dm, R_0x1c3c, BIT(0))) -+ odm_set_bb_reg(dm, R_0x1c3c, BIT(0), 0x1); -+ if (!(dm->support_ic_type & ODM_RTL8723F)) { -+ -+ /* 2. set CCK test mode off, set to CCK normal mode */ -+ odm_set_bb_reg(dm, R_0x1a00, 0x3, 0x0); -+ -+ /* 3. turn on scramble setting */ -+ odm_set_bb_reg(dm, R_0x1a00, BIT(3), 0x1); -+ } -+ /* 4. Turn On Continue Tx and turn off the other test modes. */ -+ odm_set_bb_reg(dm, R_0x1ca4, 0x7, 0x1); -+ -+ pmac_tx->cck_cont_tx = false; -+ pmac_tx->ofdm_cont_tx = true; -+} -+ -+void phydm_stop_ofdm_cont_tx_jgr3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ -+ pmac_tx->cck_cont_tx = false; -+ pmac_tx->ofdm_cont_tx = false; -+ -+ /* Turn Off All Test mode */ -+ odm_set_bb_reg(dm, R_0x1ca4, 0x7, 0x0); -+ -+ /* Delay 10 ms */ -+ ODM_delay_ms(10); -+ -+ /* BB Reset */ -+ odm_set_bb_reg(dm, R_0x1d0c, BIT(16), 0x0); -+ odm_set_bb_reg(dm, R_0x1d0c, BIT(16), 0x1); -+} -+ -+void phydm_stop_pmac_tx_jgr3(void *dm_void, struct phydm_pmac_info *tx_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ u32 tmp = 0; -+ -+ odm_set_bb_reg(dm, R_0x1e70, 0xf, 0x2); /* TX Stop */ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ if (tx_info->mode == CONT_TX) { -+ if (pmac_tx->is_cck_rate) { -+ /* TX Stop */ -+ odm_set_bb_reg(dm, R_0x2a00, BIT(0), 0x1); -+ /* Clear BB cont tx */ -+ odm_set_bb_reg(dm, R_0x2a00, BIT(28), 0x0); -+ /* Clear PMAC cont tx */ -+ odm_set_bb_reg(dm, R_0x2a08, BIT(17), 0x0); -+ /* Clear TX Stop */ -+ odm_set_bb_reg(dm, R_0x2a00, BIT(0), 0x0); -+ phydm_stop_cck_cont_tx_jgr3(dm); -+ } else -+ phydm_stop_ofdm_cont_tx_jgr3(dm); -+ } else { -+ if (pmac_tx->is_cck_rate) { -+ /* packet_count = 0x1 */ -+ odm_set_bb_reg(dm, R_0x2a04, 0x03ff0000, 0x1); -+ /* @Disable pmac tx_en*/ -+ odm_set_bb_reg(dm, R_0x2a08, BIT(31), 0x0); -+ /* @Enable pmac tx_en*/ -+ odm_set_bb_reg(dm, R_0x2a08, BIT(31), 0x1); -+ phydm_stop_cck_cont_tx_jgr3(dm); -+ } -+ } -+ }else { -+ if (tx_info->mode == CONT_TX) { -+ if (pmac_tx->is_cck_rate) -+ phydm_stop_cck_cont_tx_jgr3(dm); -+ else -+ phydm_stop_ofdm_cont_tx_jgr3(dm); -+ } -+ } -+} -+ -+void phydm_set_mac_phy_txinfo_jgr3(void *dm_void, -+ struct phydm_pmac_info *tx_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ u32 tmp = 0; -+ -+ odm_set_bb_reg(dm, R_0xa58, 0x003f8000, tx_info->tx_rate); -+ -+ /*0x900[1] ndp_sound */ -+ odm_set_bb_reg(dm, R_0x900, BIT(1), tx_info->ndp_sound); -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ tx_info->m_stbc = tx_info->m_stbc - 1; -+ #endif -+ /*0x900[27:24] txsc [29:28] bw [31:30] m_stbc */ -+ tmp = (tx_info->tx_sc) | ((tx_info->bw) << 4) | -+ ((tx_info->m_stbc) << 6); -+ odm_set_bb_reg(dm, R_0x900, 0xff000000, tmp); -+ -+ if (tx_info->tx_sc == 1) /*upper*/ -+ odm_set_bb_reg(dm, R_0x1ae0, 0x7000, 0x5); -+ else if (tx_info->tx_sc == 2) /*lower*/ -+ odm_set_bb_reg(dm, R_0x1ae0, 0x7000, 0x6); -+ else /* duplicate*/ -+ odm_set_bb_reg(dm, R_0x1ae0, 0x7000, 0x0); -+ -+ if (pmac_tx->is_ht_rate) { -+ odm_set_bb_reg(dm, R_0x900, BIT(0), 0x1); -+ odm_set_bb_reg(dm, R_0x900, BIT(2), 0x0); -+ } else if (pmac_tx->is_vht_rate) { -+ odm_set_bb_reg(dm, R_0x900, BIT(0), 0x0); -+ odm_set_bb_reg(dm, R_0x900, BIT(2), 0x1); -+ } else { -+ odm_set_bb_reg(dm, R_0x900, BIT(0), 0x0); -+ odm_set_bb_reg(dm, R_0x900, BIT(2), 0x0); -+ } -+ -+ /* for TX interval */ -+ odm_set_bb_reg(dm, R_0x9b8, MASKHWORD, tx_info->packet_period); -+} -+ -+void phydm_set_sig_jgr3(void *dm_void, struct phydm_pmac_info *tx_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ u32 tmp = 0; -+ -+ if (pmac_tx->is_cck_rate) -+ return; -+ -+ odm_set_bb_reg(dm, R_0x1eb4, 0xfffff, tx_info->packet_count); -+ -+ /* L-SIG */ -+ tmp = BYTE_2_DWORD(0, tx_info->lsig[2], tx_info->lsig[1], -+ tx_info->lsig[0]); -+ odm_set_bb_reg(dm, R_0x908, 0xffffff, tmp); -+ if (pmac_tx->is_ht_rate) { -+ /* HT SIG */ -+ tmp = BYTE_2_DWORD(0, tx_info->ht_sig[2], tx_info->ht_sig[1], -+ tx_info->ht_sig[0]); -+ odm_set_bb_reg(dm, R_0x90c, 0xffffff, tmp); -+ tmp = BYTE_2_DWORD(0, tx_info->ht_sig[5], tx_info->ht_sig[4], -+ tx_info->ht_sig[3]); -+ odm_set_bb_reg(dm, R_0x910, 0xffffff, tmp); -+ } else if (pmac_tx->is_vht_rate) { -+ /* VHT SIG A/B/serv_field/delimiter */ -+ tmp = BYTE_2_DWORD(0, tx_info->vht_sig_a[2], -+ tx_info->vht_sig_a[1], -+ tx_info->vht_sig_a[0]); -+ odm_set_bb_reg(dm, R_0x90c, 0xffffff, tmp); -+ tmp = BYTE_2_DWORD(0, tx_info->vht_sig_a[5], -+ tx_info->vht_sig_a[4], -+ tx_info->vht_sig_a[3]); -+ odm_set_bb_reg(dm, R_0x910, 0xffffff, tmp); -+ tmp = BYTE_2_DWORD(tx_info->vht_sig_b[3], tx_info->vht_sig_b[2], -+ tx_info->vht_sig_b[1], -+ tx_info->vht_sig_b[0]); -+ odm_set_bb_reg(dm, R_0x914, 0x1fffffff, tmp); -+ odm_set_bb_reg(dm, R_0x938, 0xff00, tx_info->vht_sig_b_crc); -+ -+ tmp = BYTE_2_DWORD(tx_info->vht_delimiter[3], -+ tx_info->vht_delimiter[2], -+ tx_info->vht_delimiter[1], -+ tx_info->vht_delimiter[0]); -+ odm_set_bb_reg(dm, R_0x940, MASKDWORD, tmp); -+ } -+} -+ -+void phydm_set_cck_preamble_hdr_jgr3(void *dm_void, -+ struct phydm_pmac_info *tx_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ u32 tmp = 0; -+ u8 rate = tx_info->tx_rate; /* HW rate */ -+ -+ if (!pmac_tx->is_cck_rate) -+ return; -+ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ #if (RTL8723F_SUPPORT) -+ odm_set_bb_reg(dm, R_0x2a04, 0x03ff0000, tx_info->packet_count); -+ odm_set_bb_reg(dm, R_0x2a08, BIT(22), tx_info->service_field_bit2); -+ odm_set_bb_reg(dm, R_0x2a08, BIT(21) | BIT(20), rate); -+ odm_set_bb_reg(dm, R_0x2a08, 0x1ffff, tx_info->packet_length); -+ /* turn on scrambler */ -+ odm_set_bb_reg(dm, R_0x2a04, BIT(5), 0x0); -+ -+ if (tx_info->is_short_preamble) -+ odm_set_bb_reg(dm, R_0x2a08, BIT(19), 0x1); -+ else -+ odm_set_bb_reg(dm, R_0x2a08, BIT(19), 0x0); -+ #endif -+ } else { -+ tmp = tx_info->packet_count | (tx_info->sfd << 16); -+ odm_set_bb_reg(dm, R_0x1e64, MASKDWORD, tmp); -+ tmp = tx_info->signal_field | (tx_info->service_field << 8) | -+ (tx_info->length << 16); -+ odm_set_bb_reg(dm, R_0x1e68, MASKDWORD, tmp); -+ tmp = BYTE_2_DWORD(0, 0, tx_info->crc16[1], tx_info->crc16[0]); -+ odm_set_bb_reg(dm, R_0x1e6c, MASKLWORD, tmp); -+ -+ if (tx_info->is_short_preamble) -+ odm_set_bb_reg(dm, R_0x1e6c, BIT(16), 0x0); -+ else -+ odm_set_bb_reg(dm, R_0x1e6c, BIT(16), 0x1); -+ } -+} -+ -+void phydm_set_mode_jgr3(void *dm_void, struct phydm_pmac_info *tx_info, -+ enum phydm_pmac_mode mode) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ -+ if (mode == CONT_TX) { -+ tx_info->packet_count = 1; -+ -+ if (pmac_tx->is_cck_rate) -+ phydm_start_cck_cont_tx_jgr3(dm, tx_info); -+ else -+ phydm_start_ofdm_cont_tx_jgr3(dm); -+ } -+} -+ -+void phydm_set_pmac_txon_jgr3(void *dm_void, struct phydm_pmac_info *tx_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ -+ odm_set_bb_reg(dm, R_0x1d08, BIT(0), 0x1); /*Turn on PMAC */ -+ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ if (pmac_tx->is_cck_rate) { -+ if (tx_info->mode == CONT_TX) { -+ /* BB and PMAC cont tx */ -+ odm_set_bb_reg(dm, R_0x2a08, BIT(17), 0x1); -+ odm_set_bb_reg(dm, R_0x2a00, BIT(28), 0x1); -+ } -+ /* TX CCK ON */ -+ odm_set_bb_reg(dm, R_0x2a08, BIT(31), 0x0); -+ odm_set_bb_reg(dm, R_0x2a08, BIT(31), 0x1); -+ } else { -+ odm_set_bb_reg(dm, R_0x1e70, 0xf, 0x0); /*TX Ofdm OFF */ -+ odm_set_bb_reg(dm, R_0x1e70, 0xf, 0x4); /*TX Ofdm ON */ -+ } -+ } else { -+ /*mac scramble seed setting, only in 8198F */ -+ #if (RTL8198F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8198F) -+ if (!odm_get_bb_reg(dm, R_0x1d10, BIT(16))) -+ odm_set_bb_reg(dm, R_0x1d10, BIT(16), 0x1); -+ #endif -+ -+ if (pmac_tx->is_cck_rate){ -+ odm_set_bb_reg(dm, R_0x1e70, 0xf, 0x8); /*TX CCK ON */ -+ odm_set_bb_reg(dm, R_0x1a84, BIT(31), 0x0); -+ } else { -+ odm_set_bb_reg(dm, R_0x1e70, 0xf, 0x4); /*TX Ofdm ON */ -+ } -+ } -+} -+ -+void phydm_set_pmac_tx_jgr3(void *dm_void, struct phydm_pmac_info *tx_info, -+ enum rf_path mpt_rf_path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; -+ -+ pmac_tx->is_cck_rate = phydm_is_cck_rate(dm, tx_info->tx_rate); -+ pmac_tx->is_ofdm_rate = phydm_is_ofdm_rate(dm, tx_info->tx_rate); -+ pmac_tx->is_ht_rate = phydm_is_ht_rate(dm, tx_info->tx_rate); -+ pmac_tx->is_vht_rate = phydm_is_vht_rate(dm, tx_info->tx_rate); -+ pmac_tx->path = mpt_rf_path; -+ -+ if (!tx_info->en_pmac_tx) { -+ phydm_stop_pmac_tx_jgr3(dm, tx_info); -+ return; -+ } -+ -+ phydm_set_mode_jgr3(dm, tx_info, tx_info->mode); -+ -+ if (pmac_tx->is_cck_rate) -+ phydm_set_cck_preamble_hdr_jgr3(dm, tx_info); -+ else -+ phydm_set_sig_jgr3(dm, tx_info); -+ -+ phydm_set_mac_phy_txinfo_jgr3(dm, tx_info); -+ phydm_set_pmac_txon_jgr3(dm, tx_info); -+} -+ -+void phydm_set_tmac_tx_jgr3(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /* Turn on TMAC */ -+ if (odm_get_bb_reg(dm, R_0x1d08, BIT(0))) -+ odm_set_bb_reg(dm, R_0x1d08, BIT(0), 0x0); -+ -+ /* mac scramble seed setting, only in 8198F */ -+ #if (RTL8198F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8198F) -+ if (odm_get_bb_reg(dm, R_0x1d10, BIT(16))) -+ odm_set_bb_reg(dm, R_0x1d10, BIT(16), 0x0); -+ #endif -+ -+ /* Turn on TMAC CCK */ -+ if (!(dm->support_ic_type & ODM_RTL8723F)) { -+ if (!odm_get_bb_reg(dm, R_0x1a84, BIT(31))) -+ odm_set_bb_reg(dm, R_0x1a84, BIT(31), 0x1); -+ } -+} -+#endif -+ -+void phydm_start_cck_cont_tx(void *dm_void, struct phydm_pmac_info *tx_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_start_cck_cont_tx_jgr3(dm, tx_info); -+ #endif -+} -+ -+void phydm_stop_cck_cont_tx(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_stop_cck_cont_tx_jgr3(dm); -+ #endif -+} -+ -+void phydm_start_ofdm_cont_tx(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_start_ofdm_cont_tx_jgr3(dm); -+ #endif -+} -+ -+void phydm_stop_ofdm_cont_tx(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_stop_ofdm_cont_tx_jgr3(dm); -+ #endif -+} -+ -+void phydm_set_pmac_tx(void *dm_void, struct phydm_pmac_info *tx_info, -+ enum rf_path mpt_rf_path) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_set_pmac_tx_jgr3(dm, tx_info, mpt_rf_path); -+ #endif -+} -+ -+void phydm_set_tmac_tx(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ phydm_set_tmac_tx_jgr3(dm); -+ #endif -+} -+ -+void phydm_pmac_tx_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pmac_info tx_info; -+ char help[] = "-h"; -+ char dbg_buf[PHYDM_SNPRINT_SIZE] = {0}; -+ u32 var[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ u32 tx_cnt = 0x0; -+ u8 poll_cnt = 0x0; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var[0]); -+ -+ if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) -+ return; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[pmac_tx] basic : {1} {rate_idx}(only 1M & 6M) {count}\n"); -+ } else { -+ for (i = 1; i < 7; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var[i]); -+ } -+ } -+ -+ odm_memory_set(dm, &tx_info, 0, sizeof(struct phydm_pmac_info)); -+ tx_info.en_pmac_tx = true; -+ tx_info.mode = PKTS_TX; -+ tx_info.ndp_sound = false; -+ tx_info.bw = CHANNEL_WIDTH_20; -+ tx_info.tx_sc = 0x0; /*duplicate*/ -+ tx_info.m_stbc = 0x0; /*disable*/ -+ tx_info.packet_period = 2000; /*d'500 us*/ -+ tx_info.tx_rate = (u8)var[1]; -+ tx_info.packet_count = (u32)var[2]; -+ -+ if (tx_info.tx_rate == ODM_RATE1M) { -+ tx_info.signal_field = 0xa; /*rate = 1M*/ -+ tx_info.service_field = 0x0; -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ tx_info.service_field_bit2= 0x1; -+ tx_info.packet_length = 1000; /*1000 bytes*/ -+ } -+ tx_info.length = 8000; /*d'8000 us=1000 bytes*/ -+ tx_info.crc16[0] = 0x60; -+ tx_info.crc16[1] = 0x8e; -+ /*long preamble*/ -+ tx_info.is_short_preamble = false; -+ tx_info.sfd = 0xf3a0; -+ } else if (tx_info.tx_rate == ODM_RATE6M) { -+ /*l-sig[3:0] = rate = 6M = 0xb*/ -+ /*l-sig[16:5] = length = 1000 bytes*/ -+ /*l-sig[17] = parity = 1*/ -+ tx_info.lsig[0] = 0xb; -+ tx_info.lsig[1] = 0x7d; -+ tx_info.lsig[2] = 0x2; -+ } -+ phydm_print_rate_2_buff(dm, tx_info.tx_rate, dbg_buf, -+ PHYDM_SNPRINT_SIZE); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "rate=%s, count=%d, pkt_interval=500(us), length=1000(bytes)\n", -+ dbg_buf, tx_info.packet_count); -+ -+ if (phydm_stop_ic_trx(dm, PHYDM_SET) == PHYDM_SET_FAIL) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "check trx idle failed, please try again.\n"); -+ return; -+ } -+ -+ phydm_reset_bb_hw_cnt(dm); -+ phydm_set_pmac_tx_jgr3(dm, &tx_info, RF_PATH_A); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pmac_tx enabled, please wait for tx_cnt = %d\n", -+ tx_info.packet_count); -+ while (1) { -+ if (phydm_is_cck_rate(dm, tx_info.tx_rate)) -+ tx_cnt = odm_get_bb_reg(dm, R_0x2de4, -+ MASKLWORD); -+ else -+ tx_cnt = odm_get_bb_reg(dm, R_0x2de0, -+ MASKLWORD); -+ -+ if (tx_cnt >= tx_info.packet_count || poll_cnt >= 10) -+ break; -+ -+ ODM_delay_ms(100); -+ poll_cnt++; -+ } -+ -+ if (tx_cnt < tx_info.packet_count) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "polling time out(1s), tx_cnt = %d\n", tx_cnt); -+ else -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "pmac_tx finished, poll_cnt = %d\n", poll_cnt); -+ -+ tx_info.en_pmac_tx = false; -+ phydm_set_pmac_tx(dm, &tx_info, RF_PATH_A); -+ phydm_set_tmac_tx(dm); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Stop pmac_tx and turn on true mac mode.\n"); -+ -+ phydm_stop_ic_trx(dm, PHYDM_REVERT); -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+#endif -\ No newline at end of file -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pmac_tx_setting.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pmac_tx_setting.h -new file mode 100644 -index 000000000..532219ba6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pmac_tx_setting.h -@@ -0,0 +1,111 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_PMAC_TX_SETTING_H__ -+#define __PHYDM_PMAC_TX_SETTING_H__ -+ -+/*2020.03.16 Fix TxInfo content in B mode*/ -+#define PMAC_TX_SETTING_VERSION "2.1" -+ -+/* 1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+ -+/* 1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+struct phydm_pmac_info { -+ u8 en_pmac_tx:1; /*0: disable pmac 1: enable pmac */ -+ u8 mode:3; /*0: Packet TX 3:Continuous TX */ -+ u8 tx_rate; /*should be HW rate*/ -+ u8 tx_sc; -+ u8 is_short_preamble:1; -+ u8 ndp_sound:1; -+ u8 bw:3; /* 0:20 1:40 2:80Mhz */ -+ u8 m_stbc; /* bSTBC + 1 for WIN/CE, bSTBC for others*/ -+ u16 packet_period; -+ u32 packet_count; -+ u32 packet_length; -+ u8 packet_pattern; -+ u16 sfd; -+ u8 signal_field; -+ u8 service_field; -+ u8 service_field_bit2:1; -+ u16 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]; -+}; -+ -+struct phydm_pmac_tx { -+ boolean is_cck_rate; -+ boolean is_ofdm_rate; -+ boolean is_ht_rate; -+ boolean is_vht_rate; -+ boolean cck_cont_tx; -+ boolean ofdm_cont_tx; -+ u8 path; -+}; -+ -+/* 1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ */ -+ -+enum phydm_pmac_mode { -+ NONE_TEST, -+ PKTS_TX, -+ PKTS_RX, -+ CONT_TX, -+ OFDM_SINGLE_TONE_TX, -+ CCK_CARRIER_SIPPRESSION_TX -+}; -+ -+/* 1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ */ -+void phydm_start_cck_cont_tx(void *dm_void, struct phydm_pmac_info *tx_info); -+ -+void phydm_stop_cck_cont_tx(void *dm_void); -+ -+void phydm_start_ofdm_cont_tx(void *dm_void); -+ -+void phydm_stop_ofdm_cont_tx(void *dm_void); -+ -+void phydm_set_pmac_tx(void *dm_void, struct phydm_pmac_info *tx_info, -+ enum rf_path mpt_rf_path); -+ -+void phydm_set_tmac_tx(void *dm_void); -+ -+void phydm_pmac_tx_dbg(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pow_train.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pow_train.c -new file mode 100644 -index 000000000..56bc2411d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pow_train.c -@@ -0,0 +1,171 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/************************************************************* -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef PHYDM_POWER_TRAINING_SUPPORT -+void phydm_reset_pt_para(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pow_train_stuc *pt_t = &dm->pow_train_table; -+ -+ pt_t->pow_train_score = 0; -+} -+ -+void phydm_update_power_training_state(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pow_train_stuc *pt_t = &dm->pow_train_table; -+ struct phydm_fa_struct *fa_cnt = &dm->false_alm_cnt; -+ struct ccx_info *ccx = &dm->dm_ccx_info; -+ u32 pt_score_tmp = ENABLE_PT_SCORE; -+ u32 crc_ok_cnt = 0; -+ u32 cca_cnt = 0; -+ -+ /*@is_disable_power_training is the key to H2C to disable/enable PT*/ -+ /*@if is_disable_power_training == 1, it will use largest power*/ -+ if (!(dm->support_ability & ODM_BB_PWR_TRAIN) || !dm->is_linked) { -+ dm->is_disable_power_training = true; -+ phydm_reset_pt_para(dm); -+ return; -+ } -+ -+ PHYDM_DBG(dm, DBG_PWR_TRAIN, "%s ======>\n", __func__); -+ -+ if (pt_t->pt_state == DISABLE_POW_TRAIN) { -+ dm->is_disable_power_training = true; -+ phydm_reset_pt_para(dm); -+ PHYDM_DBG(dm, DBG_PWR_TRAIN, "Disable PT\n"); -+ return; -+ -+ } else if (pt_t->pt_state == ENABLE_POW_TRAIN) { -+ dm->is_disable_power_training = false; -+ phydm_reset_pt_para(dm); -+ PHYDM_DBG(dm, DBG_PWR_TRAIN, "Enable PT\n"); -+ return; -+ -+ } else if (pt_t->pt_state == DYNAMIC_POW_TRAIN) { -+ PHYDM_DBG(dm, DBG_PWR_TRAIN, "Dynamic PT\n"); -+ -+ /* @Compute score */ -+ crc_ok_cnt = dm->phy_dbg_info.num_qry_phy_status_ofdm + -+ dm->phy_dbg_info.num_qry_phy_status_cck; -+ cca_cnt = fa_cnt->cnt_cca_all; -+#if 0 -+ if (crc_ok_cnt > cca_cnt) { /*invalid situation*/ -+ pt_score_tmp = KEEP_PRE_PT_SCORE; -+ return; -+ } else if ((crc_ok_cnt + (crc_ok_cnt >> 1)) <= cca_cnt) { -+ /* @???crc_ok <= (2/3)*cca */ -+ pt_score_tmp = DISABLE_PT_SCORE; -+ dm->is_disable_power_training = true; -+ } else if ((crc_ok_cnt + (crc_ok_cnt >> 2)) <= cca_cnt) { -+ /* @???crc_ok <= (4/5)*cca */ -+ pt_score_tmp = KEEP_PRE_PT_SCORE; -+ } else { -+ /* @???crc_ok > (4/5)*cca */ -+ pt_score_tmp = ENABLE_PT_SCORE; -+ dm->is_disable_power_training = false; -+ } -+#endif -+ if (ccx->nhm_ratio > 10) { -+ pt_score_tmp = DISABLE_PT_SCORE; -+ dm->is_disable_power_training = true; -+ } else if (ccx->nhm_ratio < 5) { -+ pt_score_tmp = ENABLE_PT_SCORE; -+ dm->is_disable_power_training = false; -+ } else { -+ pt_score_tmp = KEEP_PRE_PT_SCORE; -+ } -+ -+ PHYDM_DBG(dm, DBG_PWR_TRAIN, -+ "pkt_cnt{ofdm,cck,all} = {%d, %d, %d}, cnt_cca_all=%d\n", -+ dm->phy_dbg_info.num_qry_phy_status_ofdm, -+ dm->phy_dbg_info.num_qry_phy_status_cck, -+ crc_ok_cnt, cca_cnt); -+ -+ PHYDM_DBG(dm, DBG_PWR_TRAIN, "pt_score_tmp=%d\n", pt_score_tmp); -+ -+ /* smoothing */ -+ pt_t->pow_train_score = (pt_score_tmp << 4) + -+ (pt_t->pow_train_score >> 1) + -+ (pt_t->pow_train_score >> 2); -+ -+ pt_score_tmp = (pt_t->pow_train_score + 32) >> 6; -+ -+ PHYDM_DBG(dm, DBG_PWR_TRAIN, -+ "pow_train_score = %d, score after smoothing = %d, is_disable_PT = %d\n", -+ pt_t->pow_train_score, pt_score_tmp, -+ dm->is_disable_power_training); -+ } else { -+ PHYDM_DBG(dm, DBG_PWR_TRAIN, "[%s]warning\n", __func__); -+ } -+} -+ -+void phydm_pow_train_debug( -+ void *dm_void, -+ char input[][16], -+ u32 *_used, -+ char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pow_train_stuc *pt_t = &dm->pow_train_table; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 i; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{0: Auto PT, 1:enable, 2: disable}\n"); -+ } else { -+ for (i = 0; i < 10; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ } -+ -+ if (var1[0] == 0) -+ pt_t->pt_state = DYNAMIC_POW_TRAIN; -+ else if (var1[0] == 1) -+ pt_t->pt_state = ENABLE_POW_TRAIN; -+ else if (var1[0] == 2) -+ pt_t->pt_state = DISABLE_POW_TRAIN; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "PT state = %d\n", pt_t->pt_state); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pow_train.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pow_train.h -new file mode 100644 -index 000000000..f966607aa ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pow_train.h -@@ -0,0 +1,84 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_POW_TRAIN_H__ -+#define __PHYDM_POW_TRAIN_H__ -+ -+#define POW_TRAIN_VERSION "1.0" /* @2017.07.0141 Dino, Add phydm_pow_train.h*/ -+ -+/**************************************************************** -+ * 1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ ***************************************************************/ -+ -+#ifdef PHYDM_POWER_TRAINING_SUPPORT -+/**************************************************************** -+ * 1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ ***************************************************************/ -+ -+struct phydm_pow_train_stuc { -+ u8 pt_state; -+ u32 pow_train_score; -+}; -+ -+/**************************************************************** -+ * 1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ ***************************************************************/ -+ -+enum pow_train_state { -+ DYNAMIC_POW_TRAIN = 0, -+ ENABLE_POW_TRAIN = 1, -+ DISABLE_POW_TRAIN = 2 -+}; -+ -+enum power_training_score { -+ DISABLE_PT_SCORE = 0, -+ KEEP_PRE_PT_SCORE = 1, -+ ENABLE_PT_SCORE = 2 -+}; -+ -+/**************************************************************** -+ * 1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ ***************************************************************/ -+ -+void phydm_update_power_training_state( -+ void *dm_void); -+ -+void phydm_pow_train_debug( -+ void *dm_void, -+ char input[][16], -+ u32 *_used, -+ char *output, -+ u32 *_out_len); -+ -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pre_define.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pre_define.h -new file mode 100644 -index 000000000..a9c0e6a16 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_pre_define.h -@@ -0,0 +1,1028 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMPREDEFINE_H__ -+#define __PHYDMPREDEFINE_H__ -+ -+/**************************************************************** -+ * 1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ ***************************************************************/ -+ -+#define PHYDM_CODE_BASE "PHYDM_V051_GIT" -+#define PHYDM_RELEASE_DATE "20210415.0" -+ -+/*PHYDM API status*/ -+#define PHYDM_SET_FAIL 0 -+#define PHYDM_SET_SUCCESS 1 -+#define PHYDM_SET_NO_NEED 3 -+ -+/*PHYDM Set/Revert*/ -+#define PHYDM_SET 1 -+#define PHYDM_REVERT 2 -+ -+/* @Max path of IC */ -+/*N-IC*/ -+#define MAX_PATH_NUM_8188E 1 -+#define MAX_PATH_NUM_8188F 1 -+#define MAX_PATH_NUM_8710B 1 -+#define MAX_PATH_NUM_8723B 1 -+#define MAX_PATH_NUM_8723D 1 -+#define MAX_PATH_NUM_8703B 1 -+#define MAX_PATH_NUM_8192E 2 -+#define MAX_PATH_NUM_8192F 2 -+#define MAX_PATH_NUM_8197F 2 -+#define MAX_PATH_NUM_8198F 4 -+#define MAX_PATH_NUM_8197G 2 -+#define MAX_PATH_NUM_8721D 1 -+#define MAX_PATH_NUM_8710C 1 -+#define MAX_PATH_NUM_8723F 2 -+ -+/*@AC-IC*/ -+#define MAX_PATH_NUM_8821A 1 -+#define MAX_PATH_NUM_8881A 1 -+#define MAX_PATH_NUM_8821C 1 -+#define MAX_PATH_NUM_8195B 1 -+#define MAX_PATH_NUM_8812A 2 -+#define MAX_PATH_NUM_8822B 2 -+#define MAX_PATH_NUM_8822C 2 -+#define MAX_PATH_NUM_8814A 4 -+#define MAX_PATH_NUM_8814B 4 -+#define MAX_PATH_NUM_8814C 4 -+#define MAX_PATH_NUM_8195B 1 -+#define MAX_PATH_NUM_8812F 2 -+ -+/* @Max RF path */ -+#define PHYDM_MAX_RF_PATH_N 2 /*@For old N-series IC*/ -+#define PHYDM_MAX_RF_PATH 4 -+ -+/* number of entry */ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ #ifdef DM_ODM_CE_MAC80211 -+ /* @defined in wifi.h (32+1) */ -+ #else -+ #define ASSOCIATE_ENTRY_NUM MACID_NUM_SW_LIMIT /* @Max size of asoc_entry[].*/ -+ #endif -+ #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) -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_IOT)) -+ #ifdef CONFIG_CONCURRENT_MODE -+ #define ASSOCIATE_ENTRY_NUM NUM_STA + 2 /*@2 is for station mod*/ -+ #else -+ #define ASSOCIATE_ENTRY_NUM NUM_STA /*@8 is for max size of asoc_entry[].*/ -+ #endif -+ #define ODM_ASSOCIATE_ENTRY_NUM ASSOCIATE_ENTRY_NUM -+#else -+ #define ODM_ASSOCIATE_ENTRY_NUM (((ASSOCIATE_ENTRY_NUM + 1) * 3) + 1) -+#endif -+ -+/* @-----MGN rate--------------------------------- */ -+ -+enum PDM_RATE_TYPE { -+ PDM_1SS = 1, /*VHT/HT 1SS*/ -+ PDM_2SS = 2, /*VHT/HT 2SS*/ -+ PDM_3SS = 3, /*VHT/HT 3SS*/ -+ PDM_4SS = 4, /*VHT/HT 4SS*/ -+ PDM_CCK = 11, /*@B*/ -+ PDM_OFDM = 12 /*@G*/ -+}; -+ -+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 = 0x80, -+ ODM_MGN_MCS1, -+ ODM_MGN_MCS2, -+ ODM_MGN_MCS3, -+ ODM_MGN_MCS4, -+ ODM_MGN_MCS5, -+ ODM_MGN_MCS6, -+ ODM_MGN_MCS7 = 0x87, -+ 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 = 0x90, -+ ODM_MGN_MCS17, -+ ODM_MGN_MCS18, -+ ODM_MGN_MCS19, -+ ODM_MGN_MCS20, -+ ODM_MGN_MCS21, -+ ODM_MGN_MCS22, -+ ODM_MGN_MCS23, -+ ODM_MGN_MCS24 = 0x98, -+ 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 = 0xa0, -+ 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 = 0xaa, -+ ODM_MGN_VHT2SS_MCS1 = 0xab, -+ ODM_MGN_VHT2SS_MCS2, -+ ODM_MGN_VHT2SS_MCS3, -+ ODM_MGN_VHT2SS_MCS4, -+ ODM_MGN_VHT2SS_MCS5 = 0xaf, -+ ODM_MGN_VHT2SS_MCS6 = 0xb0, -+ ODM_MGN_VHT2SS_MCS7, -+ ODM_MGN_VHT2SS_MCS8, -+ ODM_MGN_VHT2SS_MCS9 = 0xb3, -+ ODM_MGN_VHT3SS_MCS0 = 0xb4, -+ 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 = 0xbb, -+ ODM_MGN_VHT3SS_MCS8 = 0xbc, -+ ODM_MGN_VHT3SS_MCS9 = 0xbd, -+ ODM_MGN_VHT4SS_MCS0 = 0xbe, -+ 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 = 0xc7, -+ 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 -+ -+enum phydm_ctrl_info_rate { -+ ODM_RATE1M = 0x00, -+ ODM_RATE2M = 0x01, -+ ODM_RATE5_5M = 0x02, -+ ODM_RATE11M = 0x03, -+/* OFDM Rates, TxHT = 0 */ -+ ODM_RATE6M = 0x04, -+ ODM_RATE9M = 0x05, -+ ODM_RATE12M = 0x06, -+ ODM_RATE18M = 0x07, -+ ODM_RATE24M = 0x08, -+ ODM_RATE36M = 0x09, -+ ODM_RATE48M = 0x0A, -+ ODM_RATE54M = 0x0B, -+/* @MCS Rates, TxHT = 1 */ -+ ODM_RATEMCS0 = 0x0C, -+ ODM_RATEMCS1 = 0x0D, -+ ODM_RATEMCS2 = 0x0E, -+ ODM_RATEMCS3 = 0x0F, -+ ODM_RATEMCS4 = 0x10, -+ ODM_RATEMCS5 = 0x11, -+ ODM_RATEMCS6 = 0x12, -+ ODM_RATEMCS7 = 0x13, -+ ODM_RATEMCS8 = 0x14, -+ ODM_RATEMCS9 = 0x15, -+ ODM_RATEMCS10 = 0x16, -+ ODM_RATEMCS11 = 0x17, -+ ODM_RATEMCS12 = 0x18, -+ ODM_RATEMCS13 = 0x19, -+ ODM_RATEMCS14 = 0x1A, -+ ODM_RATEMCS15 = 0x1B, -+ ODM_RATEMCS16 = 0x1C, -+ ODM_RATEMCS17 = 0x1D, -+ ODM_RATEMCS18 = 0x1E, -+ ODM_RATEMCS19 = 0x1F, -+ ODM_RATEMCS20 = 0x20, -+ ODM_RATEMCS21 = 0x21, -+ ODM_RATEMCS22 = 0x22, -+ ODM_RATEMCS23 = 0x23, -+ ODM_RATEMCS24 = 0x24, -+ ODM_RATEMCS25 = 0x25, -+ ODM_RATEMCS26 = 0x26, -+ ODM_RATEMCS27 = 0x27, -+ ODM_RATEMCS28 = 0x28, -+ ODM_RATEMCS29 = 0x29, -+ ODM_RATEMCS30 = 0x2A, -+ ODM_RATEMCS31 = 0x2B, -+ ODM_RATEVHTSS1MCS0 = 0x2C, -+ ODM_RATEVHTSS1MCS1 = 0x2D, -+ ODM_RATEVHTSS1MCS2 = 0x2E, -+ ODM_RATEVHTSS1MCS3 = 0x2F, -+ ODM_RATEVHTSS1MCS4 = 0x30, -+ ODM_RATEVHTSS1MCS5 = 0x31, -+ ODM_RATEVHTSS1MCS6 = 0x32, -+ ODM_RATEVHTSS1MCS7 = 0x33, -+ ODM_RATEVHTSS1MCS8 = 0x34, -+ ODM_RATEVHTSS1MCS9 = 0x35, -+ ODM_RATEVHTSS2MCS0 = 0x36, -+ ODM_RATEVHTSS2MCS1 = 0x37, -+ ODM_RATEVHTSS2MCS2 = 0x38, -+ ODM_RATEVHTSS2MCS3 = 0x39, -+ ODM_RATEVHTSS2MCS4 = 0x3A, -+ ODM_RATEVHTSS2MCS5 = 0x3B, -+ ODM_RATEVHTSS2MCS6 = 0x3C, -+ ODM_RATEVHTSS2MCS7 = 0x3D, -+ ODM_RATEVHTSS2MCS8 = 0x3E, -+ ODM_RATEVHTSS2MCS9 = 0x3F, -+ ODM_RATEVHTSS3MCS0 = 0x40, -+ ODM_RATEVHTSS3MCS1 = 0x41, -+ ODM_RATEVHTSS3MCS2 = 0x42, -+ ODM_RATEVHTSS3MCS3 = 0x43, -+ ODM_RATEVHTSS3MCS4 = 0x44, -+ ODM_RATEVHTSS3MCS5 = 0x45, -+ ODM_RATEVHTSS3MCS6 = 0x46, -+ ODM_RATEVHTSS3MCS7 = 0x47, -+ ODM_RATEVHTSS3MCS8 = 0x48, -+ ODM_RATEVHTSS3MCS9 = 0x49, -+ ODM_RATEVHTSS4MCS0 = 0x4A, -+ ODM_RATEVHTSS4MCS1 = 0x4B, -+ ODM_RATEVHTSS4MCS2 = 0x4C, -+ ODM_RATEVHTSS4MCS3 = 0x4D, -+ ODM_RATEVHTSS4MCS4 = 0x4E, -+ ODM_RATEVHTSS4MCS5 = 0x4F, -+ ODM_RATEVHTSS4MCS6 = 0x50, -+ ODM_RATEVHTSS4MCS7 = 0x51, -+ ODM_RATEVHTSS4MCS8 = 0x52, -+ ODM_RATEVHTSS4MCS9 = 0x53, -+}; -+ -+enum phydm_legacy_spec_rate { -+ PHYDM_SPEC_RATE_6M = 0xb, -+ PHYDM_SPEC_RATE_9M = 0xf, -+ PHYDM_SPEC_RATE_12M = 0xa, -+ PHYDM_SPEC_RATE_18M = 0xe, -+ PHYDM_SPEC_RATE_24M = 0x9, -+ PHYDM_SPEC_RATE_36M = 0xd, -+ PHYDM_SPEC_RATE_48M = 0x8, -+ PHYDM_SPEC_RATE_54M = 0xc -+}; -+ -+#define NUM_RATE_AC_4SS (ODM_RATEVHTSS4MCS9 + 1) -+#define NUM_RATE_AC_3SS (ODM_RATEVHTSS3MCS9 + 1) -+#define NUM_RATE_AC_2SS (ODM_RATEVHTSS2MCS9 + 1) -+#define NUM_RATE_AC_1SS (ODM_RATEVHTSS1MCS9 + 1) -+#define NUM_RATE_N_4SS (ODM_RATEMCS31 + 1) -+#define NUM_RATE_N_3SS (ODM_RATEMCS23 + 1) -+#define NUM_RATE_N_2SS (ODM_RATEMCS15 + 1) -+#define NUM_RATE_N_1SS (ODM_RATEMCS7 + 1) -+ -+/*Define from larger rate size to small rate size, DO NOT change the position*/ -+/*[AC-4SS]*/ -+#if (RTL8814B_SUPPORT) -+ #define PHY_NUM_RATE_IDX NUM_RATE_AC_4SS -+/*[AC-3SS]*/ -+#elif (RTL8814A_SUPPORT) -+ #define PHY_NUM_RATE_IDX NUM_RATE_AC_3SS -+/*[AC-2SS]*/ -+#elif (RTL8812A_SUPPORT || RTL8822B_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8812F_SUPPORT) -+ #define PHY_NUM_RATE_IDX NUM_RATE_AC_2SS -+/*[AC-1SS]*/ -+#elif (RTL8881A_SUPPORT || RTL8821A_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8195B_SUPPORT) -+ #define PHY_NUM_RATE_IDX NUM_RATE_AC_1SS -+/*[N-4SS]*/ -+#elif (RTL8198F_SUPPORT) -+ #define PHY_NUM_RATE_IDX NUM_RATE_N_4SS -+/*[N-2SS]*/ -+#elif (RTL8192E_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT ||\ -+ RTL8197G_SUPPORT) -+ #define PHY_NUM_RATE_IDX NUM_RATE_N_2SS -+/*[N-1SS]*/ -+#elif (RTL8723B_SUPPORT || RTL8703B_SUPPORT || RTL8188E_SUPPORT || \ -+ RTL8188F_SUPPORT || RTL8723D_SUPPORT || RTL8195A_SUPPORT ||\ -+ RTL8710B_SUPPORT || RTL8721D_SUPPORT || RTL8710C_SUPPORT || RTL8723F_SUPPORT) -+ #define PHY_NUM_RATE_IDX NUM_RATE_N_1SS -+#else -+ #define PHY_NUM_RATE_IDX NUM_RATE_AC_4SS -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #define CONFIG_SFW_SUPPORTED -+#endif -+ -+/**************************************************************** -+ * 1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ ***************************************************************/ -+ -+/* ODM_CMNINFO_INTERFACE */ -+enum odm_interface { -+ ODM_ITRF_PCIE = 0x1, -+ ODM_ITRF_USB = 0x2, -+ ODM_ITRF_SDIO = 0x4, -+ ODM_ITRF_ALL = 0x7, -+}; -+ -+enum phydm_api_host { -+ RUN_IN_FW = 0, -+ RUN_IN_DRIVER = 1, -+}; -+ -+/*@========[Run time IC flag] ===================================*/ -+ -+enum phydm_ic { -+ ODM_RTL8188E = BIT(0), -+ ODM_RTL8812 = BIT(1), -+ ODM_RTL8821 = BIT(2), -+ ODM_RTL8192E = BIT(3), -+ ODM_RTL8723B = BIT(4), -+ ODM_RTL8814A = BIT(5), -+ ODM_RTL8881A = BIT(6), -+ ODM_RTL8822B = BIT(7), -+ ODM_RTL8703B = BIT(8), -+ ODM_RTL8195A = BIT(9), -+ ODM_RTL8188F = BIT(10), -+ ODM_RTL8723D = BIT(11), -+ ODM_RTL8197F = BIT(12), -+ ODM_RTL8821C = BIT(13), -+ ODM_RTL8814B = BIT(14), -+ ODM_RTL8198F = BIT(15), -+ ODM_RTL8710B = BIT(16), -+ ODM_RTL8192F = BIT(17), -+ ODM_RTL8822C = BIT(18), -+ ODM_RTL8195B = BIT(19), -+ ODM_RTL8812F = BIT(20), -+ ODM_RTL8197G = BIT(21), -+ ODM_RTL8721D = BIT(22), -+ ODM_RTL8710C = BIT(23), -+ ODM_RTL8723F = BIT(24), -+ ODM_RTL8814C = BIT(25) -+}; -+ -+#define ODM_IC_N_1SS (ODM_RTL8188E | ODM_RTL8188F | ODM_RTL8723B |\ -+ ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8195A |\ -+ ODM_RTL8710B | ODM_RTL8721D | ODM_RTL8710C) -+#define ODM_IC_N_2SS (ODM_RTL8192E | ODM_RTL8197F | ODM_RTL8192F) -+#define ODM_IC_N_3SS 0 -+#define ODM_IC_N_4SS 0 -+ -+#define ODM_IC_AC_1SS (ODM_RTL8881A | ODM_RTL8821 | ODM_RTL8821C |\ -+ ODM_RTL8195B) -+#define ODM_IC_AC_2SS (ODM_RTL8812 | ODM_RTL8822B) -+#define ODM_IC_AC_3SS 0 -+#define ODM_IC_AC_4SS (ODM_RTL8814A) -+ -+#define ODM_IC_JGR3_1SS (ODM_RTL8723F) -+#define ODM_IC_JGR3_2SS (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G) -+#define ODM_IC_JGR3_3SS 0 -+#define ODM_IC_JGR3_4SS (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8814C) -+ -+/*@====the following macro DO NOT need to update when adding a new IC======= */ -+#define ODM_IC_1SS (ODM_IC_N_1SS | ODM_IC_AC_1SS | ODM_IC_JGR3_1SS) -+#define ODM_IC_2SS (ODM_IC_N_2SS | ODM_IC_AC_2SS | ODM_IC_JGR3_2SS) -+#define ODM_IC_3SS (ODM_IC_N_3SS | ODM_IC_AC_3SS | ODM_IC_JGR3_3SS) -+#define ODM_IC_4SS (ODM_IC_N_4SS | ODM_IC_AC_4SS | ODM_IC_JGR3_4SS) -+ -+#define PHYDM_IC_ABOVE_1SS (ODM_IC_1SS | ODM_IC_2SS | ODM_IC_3SS |\ -+ ODM_IC_4SS) -+#define PHYDM_IC_ABOVE_2SS (ODM_IC_2SS | ODM_IC_3SS | ODM_IC_4SS) -+#define PHYDM_IC_ABOVE_3SS (ODM_IC_3SS | ODM_IC_4SS) -+#define PHYDM_IC_ABOVE_4SS ODM_IC_4SS -+ -+#define ODM_IC_11N_SERIES (ODM_IC_N_1SS | ODM_IC_N_2SS | ODM_IC_N_3SS |\ -+ ODM_IC_N_4SS) -+#define ODM_IC_11AC_SERIES (ODM_IC_AC_1SS | ODM_IC_AC_2SS |\ -+ ODM_IC_AC_3SS | ODM_IC_AC_4SS) -+#define ODM_IC_JGR3_SERIES (ODM_IC_JGR3_1SS | ODM_IC_JGR3_2SS |\ -+ ODM_IC_JGR3_3SS | ODM_IC_JGR3_4SS) -+/*@====================================================*/ -+ -+#define ODM_IC_11AC_1_SERIES (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A) -+#define ODM_IC_11AC_2_SERIES (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C |\ -+ ODM_RTL8195B) -+ -+/*@[Phy status type]*/ -+#define PHYSTS_2ND_TYPE_IC (ODM_RTL8197F | ODM_RTL8822B | ODM_RTL8723D |\ -+ ODM_RTL8821C | ODM_RTL8710B | ODM_RTL8195B |\ -+ ODM_RTL8192F | ODM_RTL8721D | ODM_RTL8710C) -+#define PHYSTS_3RD_TYPE_IC (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8822C |\ -+ ODM_RTL8812F | ODM_RTL8197G | ODM_RTL8723F |\ -+ ODM_RTL8814C) -+/*@[FW Type]*/ -+#define PHYDM_IC_8051_SERIES (ODM_RTL8881A | ODM_RTL8812 | ODM_RTL8821 |\ -+ ODM_RTL8192E | ODM_RTL8723B | ODM_RTL8703B |\ -+ ODM_RTL8188F | ODM_RTL8192F | ODM_RTL8721D |\ -+ ODM_RTL8710C) -+#define PHYDM_IC_3081_SERIES (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8197F |\ -+ ODM_RTL8821C | ODM_RTL8195B | ODM_RTL8198F |\ -+ ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8814B |\ -+ ODM_RTL8197G | ODM_RTL8723F | ODM_RTL8814C) -+/*@[LA mode]*/ -+#define PHYDM_IC_SUPPORT_LA_MODE (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8197F |\ -+ ODM_RTL8821C | ODM_RTL8195B | ODM_RTL8198F |\ -+ ODM_RTL8192F | ODM_RTL8822C | ODM_RTL8812F |\ -+ ODM_RTL8195B | ODM_RTL8814B | ODM_RTL8197G |\ -+ ODM_RTL8723F | ODM_RTL8814C) -+/*@[BF]*/ -+#define ODM_IC_TXBF_SUPPORT (ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 |\ -+ ODM_RTL8814A | ODM_RTL8881A | ODM_RTL8822B |\ -+ ODM_RTL8197F | ODM_RTL8821C | ODM_RTL8195B |\ -+ ODM_RTL8198F | ODM_RTL8822C | ODM_RTL8812F |\ -+ ODM_RTL8814B | ODM_RTL8197G | ODM_RTL8814C) -+#define PHYDM_IC_SUPPORT_MU_BFEE (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8814B |\ -+ ODM_RTL8195B | ODM_RTL8198F | ODM_RTL8822C |\ -+ ODM_RTL8812F | ODM_RTL8723F | ODM_RTL8814C) -+#define PHYDM_IC_SUPPORT_MU_BFER (ODM_RTL8822B | ODM_RTL8814B | ODM_RTL8198F |\ -+ ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8814C) -+ -+#define PHYDM_IC_SUPPORT_MU (PHYDM_IC_SUPPORT_MU_BFEE |\ -+ PHYDM_IC_SUPPORT_MU_BFER) -+/*@[PHYDM API]*/ -+#define CMN_API_SUPPORT_IC (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F |\ -+ ODM_RTL8821C | ODM_RTL8195B | ODM_RTL8822C |\ -+ ODM_RTL8198F | ODM_RTL8812F | ODM_RTL8814B |\ -+ ODM_RTL8197G | ODM_RTL8721D | ODM_RTL8710C |\ -+ ODM_RTL8723F | ODM_RTL8814C) -+ -+/* fw offload ability*/ -+#define PHYDM_IC_SUPPORT_FW_PARAM_OFFLOAD (ODM_RTL8814A | ODM_RTL8822B |\ -+ ODM_RTL8821C | ODM_RTL8822C) -+ -+/* halmac offload ability*/ -+#define PHYDM_IC_SUPPORT_HALMAC_PARAM_OFFLOAD (ODM_RTL8822C | ODM_RTL8812F |\ -+ ODM_RTL8814B | ODM_RTL8723F |\ -+ ODM_RTL8814C) -+ -+/*[CCX]*/ -+#define PHYDM_IC_SUPPORT_FAHM (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8198F |\ -+ ODM_RTL8814B | ODM_RTL8822C | ODM_RTL8812F |\ -+ ODM_RTL8197G | ODM_RTL8723F | ODM_RTL8814C) -+#define PHYDM_IC_SUPPORT_IFS_CLM (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G |\ -+ ODM_RTL8723F) -+#define PHYDM_IC_SUPPORT_EDCCA_CLM (ODM_RTL8822C | ODM_RTL8812F |\ -+ ODM_RTL8197G | ODM_RTL8723F) -+ -+/*[ARFR]*/ -+/*for MAC HW control rate_id=0~12 and 2.4g vht mode(1ss/2ss) support*/ -+#define PHYDM_IC_RATEID_IDX_TYPE2 (ODM_RTL8822B | ODM_RTL8822C | ODM_RTL8195B |\ -+ ODM_RTL8821C) -+ -+/*@========[Compile time IC flag] ========================*/ -+/*@========[AC-3/AC/N Support] ===========================*/ -+ -+#if (RTL8814B_SUPPORT || RTL8198F_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8812F_SUPPORT || RTL8197G_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYDM_IC_JGR3_SERIES_SUPPORT -+ #if (RTL8814B_SUPPORT || RTL8822C_SUPPORT || RTL8812F_SUPPORT) -+ #define PHYDM_IC_JGR3_80M_SUPPORT -+ #endif -+#endif -+ -+#if (RTL8822C_SUPPORT || RTL8812F_SUPPORT || RTL8814B_SUPPORT ||\ -+ RTL8723F_SUPPORT) -+ #define PHYDM_IC_HALMAC_PARAM_SUPPORT -+#endif -+ -+#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 -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ #define ODM_IC_11AC_SERIES_SUPPORT 1 -+ #define ODM_IC_11N_SERIES_SUPPORT 1 -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ -+ #define ODM_IC_11AC_SERIES_SUPPORT 1 -+ #define ODM_IC_11N_SERIES_SUPPORT 1 -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+ -+ #define ODM_IC_11AC_SERIES_SUPPORT 1 -+ #define ODM_IC_11N_SERIES_SUPPORT 1 -+ -+#else /*ODM_CE*/ -+ -+ #if (RTL8188E_SUPPORT || RTL8723B_SUPPORT || RTL8192E_SUPPORT ||\ -+ RTL8195A_SUPPORT || RTL8703B_SUPPORT || RTL8188F_SUPPORT ||\ -+ RTL8723D_SUPPORT || RTL8197F_SUPPORT || RTL8710B_SUPPORT ||\ -+ RTL8192F_SUPPORT || RTL8721D_SUPPORT || RTL8710C_SUPPORT) -+ #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 -+#endif -+ -+/*@===IC SS Compile Flag, prepare for code size reduction==============*/ -+#if (RTL8188E_SUPPORT || RTL8188F_SUPPORT || RTL8723B_SUPPORT ||\ -+ RTL8703B_SUPPORT || RTL8723D_SUPPORT || RTL8881A_SUPPORT ||\ -+ RTL8821A_SUPPORT || RTL8821C_SUPPORT || RTL8195A_SUPPORT ||\ -+ RTL8710B_SUPPORT || RTL8195B_SUPPORT || RTL8721D_SUPPORT ||\ -+ RTL8710C_SUPPORT || RTL8723F_SUPPORT) -+ -+ #define PHYDM_COMPILE_IC_1SS -+#endif -+ -+#if (RTL8192E_SUPPORT || RTL8197F_SUPPORT || RTL8812A_SUPPORT ||\ -+ RTL8822B_SUPPORT || RTL8192F_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8812F_SUPPORT || RTL8197G_SUPPORT) -+ #define PHYDM_COMPILE_IC_2SS -+#endif -+ -+/*@#define PHYDM_COMPILE_IC_3SS*/ -+ -+#if ((RTL8814B_SUPPORT) || (RTL8814A_SUPPORT) || (RTL8198F_SUPPORT)) -+ #define PHYDM_COMPILE_IC_4SS -+#endif -+ -+/*@==[ABOVE N-SS COMPILE FLAG]=================================================*/ -+#if (defined(PHYDM_COMPILE_IC_1SS) || defined(PHYDM_COMPILE_IC_2SS) ||\ -+ defined(PHYDM_COMPILE_IC_3SS) || defined(PHYDM_COMPILE_IC_4SS)) -+ #define PHYDM_COMPILE_ABOVE_1SS -+#endif -+ -+#if (defined(PHYDM_COMPILE_IC_2SS) || defined(PHYDM_COMPILE_IC_3SS) ||\ -+ defined(PHYDM_COMPILE_IC_4SS)) -+ #define PHYDM_COMPILE_ABOVE_2SS -+#endif -+ -+#if (defined(PHYDM_COMPILE_IC_3SS) || defined(PHYDM_COMPILE_IC_4SS)) -+ #define PHYDM_COMPILE_ABOVE_3SS -+#endif -+ -+#if (defined(PHYDM_COMPILE_IC_4SS)) -+ #define PHYDM_COMPILE_ABOVE_4SS -+#endif -+ -+/*@==[Max RF path number among all compiled ICs]==============================*/ -+/*@ ex: support 8814B & 8821C => size=4 */ -+/*@ ex: support 8822C & 8821C => size=2 */ -+#if (defined(PHYDM_COMPILE_IC_4SS)) -+ #define RF_PATH_MEM_SIZE 4 -+#elif (defined(PHYDM_COMPILE_IC_3SS)) -+ #define RF_PATH_MEM_SIZE 3 -+#elif (defined(PHYDM_COMPILE_IC_2SS)) -+ #define RF_PATH_MEM_SIZE 2 -+#else -+ #define RF_PATH_MEM_SIZE 1 -+#endif -+ -+/*@========[New Phy-Status Support] ========================*/ -+#if (RTL8197F_SUPPORT || RTL8723D_SUPPORT || RTL8822B_SUPPORT ||\ -+ RTL8821C_SUPPORT || RTL8710B_SUPPORT || RTL8195B_SUPPORT ||\ -+ RTL8192F_SUPPORT || RTL8721D_SUPPORT || RTL8710C_SUPPORT) -+ #define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 1 -+#else -+ #define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 0 -+#endif -+ -+#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8812F_SUPPORT || RTL8197G_SUPPORT || RTL8723F_SUPPORT) -+ #define PHYSTS_3RD_TYPE_SUPPORT -+#endif -+ -+#ifdef PHYSTS_3RD_TYPE_SUPPORT -+ #define PHYSTS_AUTO_SWITCH_IC (ODM_RTL8822C) -+#endif -+ -+#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8812F_SUPPORT || RTL8197G_SUPPORT || RTL8723F_SUPPORT) -+ #define BB_RAM_SUPPORT -+#endif -+ -+#if (RTL8821C_SUPPORT || RTL8822B_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8812F_SUPPORT || RTL8814B_SUPPORT || RTL8195B_SUPPORT ||\ -+ RTL8198F_SUPPORT) -+ #define PHYDM_COMPILE_MU -+#endif -+ -+#if (RTL8822B_SUPPORT) -+ #define CONFIG_MU_JAGUAR_2 -+#endif -+ -+#if (RTL8814B_SUPPORT || RTL8822C_SUPPORT || RTL8812F_SUPPORT) -+ #define CONFIG_MU_JAGUAR_3 -+#endif -+ -+#if (defined(CONFIG_MU_JAGUAR_2) || defined(CONFIG_MU_JAGUAR_3)) -+ #if (RTL8814B_SUPPORT) -+ #define MU_EX_MACID 76 -+ #elif (RTL8822B_SUPPORT || RTL8822C_SUPPORT || RTL8812F_SUPPORT) -+ #define MU_EX_MACID 30 -+ #endif -+#endif -+/*@============================================================================*/ -+ -+#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8821C_SUPPORT ||\ -+ RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8822C_SUPPORT ||\ -+ RTL8198F_SUPPORT || RTL8812F_SUPPORT || RTL8814B_SUPPORT ||\ -+ RTL8197G_SUPPORT || RTL8721D_SUPPORT || RTL8710C_SUPPORT || RTL8723F_SUPPORT) -+#define PHYDM_COMMON_API_SUPPORT -+#endif -+ -+#define PHYDM_COMMON_API_IC (ODM_IC_JGR3_SERIES | ODM_RTL8822B |\ -+ ODM_RTL8197F | ODM_RTL8821C | ODM_RTL8192F | ODM_RTL8195B |\ -+ ODM_RTL8721D | ODM_RTL8710C) -+ -+#if (RTL8188E_SUPPORT || RTL8192E_SUPPORT || RTL8821A_SUPPORT ||\ -+ RTL8812A_SUPPORT || RTL8723B_SUPPORT || RTL8703B_SUPPORT ||\ -+ RTL8195A_SUPPORT || RTL8814A_SUPPORT) -+#define PHYDM_COMMON_API_NOT_SUPPORT -+#endif -+ -+#if (RTL8821C_SUPPORT || RTL8197F_SUPPORT || RTL8197G_SUPPORT) -+ #define CONFIG_RFE_BY_HW_INFO -+#endif -+ -+#define CCK_RATE_NUM 4 -+#define OFDM_RATE_NUM 8 -+ -+#define LEGACY_RATE_NUM 12 -+ -+#define HT_RATE_NUM_4SS 32 -+#define VHT_RATE_NUM_4SS 40 -+ -+#define HT_RATE_NUM_3SS 24 -+#define VHT_RATE_NUM_3SS 30 -+ -+#define HT_RATE_NUM_2SS 16 -+#define VHT_RATE_NUM_2SS 20 -+ -+#define HT_RATE_NUM_1SS 8 -+#define VHT_RATE_NUM_1SS 10 -+#if (defined(PHYDM_COMPILE_ABOVE_4SS)) -+ #define HT_RATE_NUM HT_RATE_NUM_4SS -+ #define VHT_RATE_NUM VHT_RATE_NUM_4SS -+#elif (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ #define HT_RATE_NUM HT_RATE_NUM_3SS -+ #define VHT_RATE_NUM VHT_RATE_NUM_3SS -+#elif (defined(PHYDM_COMPILE_ABOVE_2SS)) -+ #define HT_RATE_NUM HT_RATE_NUM_2SS -+ #define VHT_RATE_NUM VHT_RATE_NUM_2SS -+#else -+ #define HT_RATE_NUM HT_RATE_NUM_1SS -+ #define VHT_RATE_NUM VHT_RATE_NUM_1SS -+#endif -+ -+#define LOW_BW_RATE_NUM VHT_RATE_NUM -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#define SECOND_CH_AT_LSB 2 /*@primary CH @ MSB, SD4: HAL_PRIME_CHNL_OFFSET_UPPER*/ -+#define SECOND_CH_AT_USB 1 /*@primary CH @ LSB, SD4: HAL_PRIME_CHNL_OFFSET_LOWER*/ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define SECOND_CH_AT_LSB 2 /*@primary CH @ MSB, SD7: HAL_PRIME_CHNL_OFFSET_UPPER*/ -+#define SECOND_CH_AT_USB 1 /*@primary CH @ LSB, SD7: HAL_PRIME_CHNL_OFFSET_LOWER*/ -+#else /*if (DM_ODM_SUPPORT_TYPE == ODM_AP)*/ -+#define SECOND_CH_AT_LSB 1 /*@primary CH @ MSB, SD8: HT_2NDCH_OFFSET_BELOW*/ -+#define SECOND_CH_AT_USB 2 /*@primary CH @ LSB, SD8: HT_2NDCH_OFFSET_ABOVE*/ -+#endif -+ -+enum phydm_ic_ip { -+ PHYDM_IC_N = 0, -+ PHYDM_IC_AC = 1, -+ PHYDM_IC_JGR3 = 2 -+}; -+ -+enum phydm_phy_sts_type { -+ PHYDM_PHYSTS_TYPE_1 = 1, -+ PHYDM_PHYSTS_TYPE_2 = 2, -+ PHYDM_PHYSTS_TYPE_3 = 3 -+}; -+ -+/* ODM_CMNINFO_CUT_VER */ -+enum odm_cut_version { -+ 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_G = 6, -+ ODM_CUT_H = 7, -+ ODM_CUT_I = 8, -+ ODM_CUT_J = 9, -+ ODM_CUT_K = 10, -+ ODM_CUT_L = 11, -+ ODM_CUT_M = 12, -+ ODM_CUT_N = 13, -+ ODM_CUT_O = 14, -+ ODM_CUT_TEST = 15, -+}; -+ -+/* ODM_CMNINFO_FAB_VER */ -+enum odm_fab { -+ ODM_TSMC = 0, -+ ODM_UMC = 1, -+}; -+ -+/* ODM_CMNINFO_OP_MODE */ -+enum odm_operation_mode { -+ ODM_NO_LINK = BIT(0), -+ ODM_LINK = BIT(1), -+ ODM_SCAN = BIT(2), -+ ODM_POWERSAVE = BIT(3), -+ ODM_AP_MODE = BIT(4), -+ ODM_CLIENT_MODE = BIT(5), -+ ODM_AD_HOC = BIT(6), -+ ODM_WIFI_DIRECT = BIT(7), -+ ODM_WIFI_DISPLAY = BIT(8), -+}; -+ -+/* ODM_CMNINFO_WM_MODE */ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+enum odm_wireless_mode { -+ ODM_WM_UNKNOW = 0x0, -+ ODM_WM_B = BIT(0), -+ ODM_WM_G = BIT(1), -+ ODM_WM_A = BIT(2), -+ ODM_WM_N24G = BIT(3), -+ ODM_WM_N5G = BIT(4), -+ ODM_WM_AUTO = BIT(5), -+ ODM_WM_AC = BIT(6), -+}; -+#else -+enum odm_wireless_mode { -+ ODM_WM_UNKNOWN = 0x00,/*@0x0*/ -+ ODM_WM_A = BIT(0), /* @0x1*/ -+ ODM_WM_B = BIT(1), /* @0x2*/ -+ ODM_WM_G = BIT(2),/* @0x4*/ -+ ODM_WM_AUTO = BIT(3),/* @0x8*/ -+ ODM_WM_N24G = BIT(4),/* @0x10*/ -+ ODM_WM_N5G = BIT(5),/* @0x20*/ -+ ODM_WM_AC_5G = BIT(6),/* @0x40*/ -+ ODM_WM_AC_24G = BIT(7),/* @0x80*/ -+ ODM_WM_AC_ONLY = BIT(8),/* @0x100*/ -+ ODM_WM_MAX = BIT(11)/* @0x800*/ -+ -+}; -+#endif -+ -+/* ODM_CMNINFO_BAND */ -+enum odm_band_type { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ ODM_BAND_2_4G = BIT(0), -+ ODM_BAND_5G = BIT(1), -+#else -+ ODM_BAND_2_4G = 0, -+ ODM_BAND_5G, -+ ODM_BAND_ON_BOTH, -+ ODM_BANDMAX -+#endif -+}; -+ -+enum odm_rf_band { -+ ODM_RF_BAND_2G = 0, -+ ODM_RF_BAND_5G_LOW = 1, -+ ODM_RF_BAND_5G_MID = 2, -+ ODM_RF_BAND_5G_HIGH = 3, -+}; -+ -+/* ODM_CMNINFO_SEC_CHNL_OFFSET */ -+enum phydm_sec_chnl_offset { -+ PHYDM_DONT_CARE = 0, -+ PHYDM_BELOW = 1, -+ PHYDM_ABOVE = 2 -+}; -+ -+/* ODM_CMNINFO_SEC_MODE */ -+enum odm_security { -+ 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_CMNINFO_CHNL */ -+ -+/* ODM_CMNINFO_BOARD_TYPE */ -+enum odm_board_type { -+ 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 */ -+}; -+ -+enum odm_package_type { -+ ODM_PACKAGE_DEFAULT = 0, -+ ODM_PACKAGE_QFN68 = BIT(0), -+ ODM_PACKAGE_TFBGA90 = BIT(1), -+ ODM_PACKAGE_TFBGA79 = BIT(2), -+}; -+ -+enum odm_type_gpa { -+ 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, -+}; -+ -+enum odm_type_apa { -+ 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, -+}; -+ -+enum odm_type_glna { -+ 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, -+}; -+ -+enum odm_type_alna { -+ 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, -+}; -+ -+#if (RTL8721D_SUPPORT) -+/* ODM_CMNINFO_POWER_VOLTAGE */ -+enum odm_power_voltage { -+ ODM_POWER_18V = 0, -+ ODM_POWER_33V = 1, -+}; -+ -+/* ODM_CMNINFO_ANTDIV_GPIO */ -+enum odm_antdiv_gpio { -+ ANTDIV_GPIO_PA2PA4 = 0, -+ ANTDIV_GPIO_PA5PA6 = 1, -+ ANTDIV_GPIO_PA12PA13 = 2, -+ ANTDIV_GPIO_PA14PA15 = 3, -+ ANTDIV_GPIO_PA16PA17 = 4, -+ ANTDIV_GPIO_PB1PB2 = 5, -+ ANTDIV_GPIO_PB26PB29 = 6, -+ ANTDIV_GPIO_PB1PB2PB26 = 7, // add by Jiao Qi for AmebaD SP3T only -+}; -+ -+/* ODM_CMNINFO_PEAK_DETECT_MODE */ -+enum odm_peak_detect_mode { -+ ODM_PD_DIS = 0, -+ ODM_PD_ENG = 1, -+ ODM_PD_ENA = 2, -+ ODM_PD_ENALL = 3, -+}; -+#endif -+ -+#define PAUSE_FAIL 0 -+#define PAUSE_SUCCESS 1 -+ -+enum odm_parameter_init { -+ ODM_PRE_SETTING = 0, -+ ODM_POST_SETTING = 1, -+ ODM_INIT_FW_SETTING = 2, -+ ODM_PRE_RF_SET = 3, -+ ODM_POST_RF_SET = 4 -+}; -+ -+enum phydm_pause_type { -+ PHYDM_PAUSE = 1, /*Pause & Set new value*/ -+ PHYDM_PAUSE_NO_SET = 2, /*Pause & Stay in current value*/ -+ PHYDM_RESUME = 3 -+}; -+ -+enum phydm_backup_type { -+ PHYDM_BACKUP = 1, -+ PHYDM_RESTORE = 2 -+}; -+ -+enum phydm_pause_level { -+ PHYDM_PAUSE_RELEASE = -1, -+ PHYDM_PAUSE_LEVEL_0 = 0, /* @Low Priority function */ -+ PHYDM_PAUSE_LEVEL_1 = 1, /* @Middle Priority function */ -+ PHYDM_PAUSE_LEVEL_2 = 2, /* @High priority function (ex: Check hang function) */ -+ PHYDM_PAUSE_LEVEL_3 = 3, /* @Debug function (the highest priority) */ -+ PHYDM_PAUSE_MAX_NUM = 4 -+}; -+ -+enum phydm_dis_hw_fun { -+ HW_FUN_DIS = 0, /*@Disable a cetain HW function & backup the original value*/ -+ HW_FUN_RESUME = 1 /*Revert */ -+}; -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_precomp.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_precomp.h -new file mode 100644 -index 000000000..bd9f6b010 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_precomp.h -@@ -0,0 +1,665 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __ODM_PRECOMP_H__ -+#define __ODM_PRECOMP_H__ -+ -+#include "phydm_types.h" -+#include "halrf/halrf_features.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" -+ #include "../8192cd_hw.h" -+ #ifdef _BIG_ENDIAN_ -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG -+ #else -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE -+ #endif -+ -+ #include "../8192cd_headers.h" -+ #include "../8192cd_debug.h" -+ -+ #if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) -+ #define INIT_TIMER_EVENT_ENTRY(_entry, _func, _data) \ -+ do { \ -+ _rtw_init_listhead(&(_entry)->list); \ -+ (_entry)->data = (_data); \ -+ (_entry)->function = (_func); \ -+ } while (0) -+ #endif -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #ifdef DM_ODM_CE_MAC80211 -+ #include "../wifi.h" -+ #include "rtl_phydm.h" -+ #elif defined(DM_ODM_CE_MAC80211_V2) -+ #include "../main.h" -+ #include "../hw.h" -+ #include "../fw.h" -+ #endif -+ #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__ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ #include -+ #include -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE -+ #define __PACK -+#endif -+ -+/* @2 OutSrc Header Files */ -+ -+#include "phydm.h" -+#include "phydm_hwconfig.h" -+#include "phydm_phystatus.h" -+#include "phydm_debug.h" -+#include "phydm_regdefine11ac.h" -+#include "phydm_regdefine11n.h" -+#include "phydm_interface.h" -+#include "phydm_reg.h" -+#include "halrf/halrf_debug.h" -+ -+#ifndef RTL8188E_SUPPORT -+ #define RTL8188E_SUPPORT 0 -+#endif -+#ifndef RTL8812A_SUPPORT -+ #define RTL8812A_SUPPORT 0 -+#endif -+#ifndef RTL8821A_SUPPORT -+ #define RTL8821A_SUPPORT 0 -+#endif -+#ifndef RTL8192E_SUPPORT -+ #define RTL8192E_SUPPORT 0 -+#endif -+#ifndef RTL8723B_SUPPORT -+ #define RTL8723B_SUPPORT 0 -+#endif -+#ifndef RTL8814A_SUPPORT -+ #define RTL8814A_SUPPORT 0 -+#endif -+#ifndef RTL8881A_SUPPORT -+ #define RTL8881A_SUPPORT 0 -+#endif -+#ifndef RTL8822B_SUPPORT -+ #define RTL8822B_SUPPORT 0 -+#endif -+#ifndef RTL8703B_SUPPORT -+ #define RTL8703B_SUPPORT 0 -+#endif -+#ifndef RTL8195A_SUPPORT -+ #define RTL8195A_SUPPORT 0 -+#endif -+#ifndef RTL8188F_SUPPORT -+ #define RTL8188F_SUPPORT 0 -+#endif -+#ifndef RTL8723D_SUPPORT -+ #define RTL8723D_SUPPORT 0 -+#endif -+#ifndef RTL8197F_SUPPORT -+ #define RTL8197F_SUPPORT 0 -+#endif -+#ifndef RTL8821C_SUPPORT -+ #define RTL8821C_SUPPORT 0 -+#endif -+#ifndef RTL8814B_SUPPORT -+ #define RTL8814B_SUPPORT 0 -+#endif -+#ifndef RTL8814C_SUPPORT -+ #define RTL8814C_SUPPORT 0 -+#endif -+#ifndef RTL8198F_SUPPORT -+ #define RTL8198F_SUPPORT 0 -+#endif -+#ifndef RTL8710B_SUPPORT -+ #define RTL8710B_SUPPORT 0 -+#endif -+#ifndef RTL8192F_SUPPORT -+ #define RTL8192F_SUPPORT 0 -+#endif -+#ifndef RTL8822C_SUPPORT -+ #define RTL8822C_SUPPORT 0 -+#endif -+#ifndef RTL8195B_SUPPORT -+ #define RTL8195B_SUPPORT 0 -+#endif -+#ifndef RTL8812F_SUPPORT -+ #define RTL8812F_SUPPORT 0 -+#endif -+#ifndef RTL8197G_SUPPORT -+ #define RTL8197G_SUPPORT 0 -+#endif -+#ifndef RTL8721D_SUPPORT -+ #define RTL8721D_SUPPORT 0 -+#endif -+#ifndef RTL8710C_SUPPORT -+ #define RTL8710C_SUPPORT 0 -+#endif -+#ifndef RTL8723F_SUPPORT -+ #define RTL8723F_SUPPORT 0 -+#endif -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && \ -+ (!defined(DM_ODM_CE_MAC80211) && !defined(DM_ODM_CE_MAC80211_V2)) -+ -+void phy_set_tx_power_limit( -+ struct dm_struct *dm, -+ u8 *regulation, -+ u8 *band, -+ u8 *bandwidth, -+ u8 *rate_section, -+ u8 *rf_path, -+ u8 *channel, -+ u8 *power_limit); -+ -+void phy_set_tx_power_limit_ex(struct dm_struct *dm, u8 regulation, u8 band, -+ u8 bandwidth, u8 rate_section, u8 rf_path, -+ u8 channel, s8 power_limit); -+ -+enum hal_status -+rtw_phydm_fw_iqk( -+ struct dm_struct *dm, -+ u8 clear, -+ u8 segment); -+ -+enum hal_status -+rtw_phydm_fw_dpk( -+ struct dm_struct *dm); -+ -+enum hal_status -+rtw_phydm_cfg_phy_para( -+ struct dm_struct *dm, -+ enum phydm_halmac_param config_type, -+ u32 offset, -+ u32 data, -+ u32 mask, -+ enum rf_path e_rf_path, -+ u32 delay_time); -+ -+#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 -+ -+ #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/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 "halrf/rtl8188e/halrf_8188e_ce.h" -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "halrf/rtl8188e/halrf_8188e_win.h" -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "halrf/rtl8188e/halrf_8188e_ap.h" -+ #endif -+#endif /* @88E END */ -+ -+#if (RTL8192E_SUPPORT == 1) -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "halrf/rtl8192e/halrf_8192e_win.h" /*@FOR_8192E_IQK*/ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "halrf/rtl8192e/halrf_8192e_ap.h" /*@FOR_8192E_IQK*/ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "halrf/rtl8192e/halrf_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/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 "halrf/rtl8812a/halrf_8812a_win.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "halrf/rtl8812a/halrf_8812a_ap.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "halrf/rtl8812a/halrf_8812a_ce.h" -+ #endif -+ -+ #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" -+ #endif -+ #include "rtl8812a/phydm_rtl8812a.h" -+ -+ #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_bb.h" -+ #include "rtl8814a/version_rtl8814a.h" -+ #include "rtl8814a/phydm_rtl8814a.h" -+ #include "halrf/rtl8814a/halhwimg8814a_rf.h" -+ #include "halrf/rtl8814a/version_rtl8814a_rf.h" -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "halrf/rtl8814a/halrf_8814a_win.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "halrf/rtl8814a/halrf_8814a_ce.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "halrf/rtl8814a/halrf_8814a_ap.h" -+ #endif -+ #include "rtl8814a/phydm_regconfig8814a.h" -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8814a_hal.h" -+ #include "halrf/rtl8814a/halrf_iqk_8814a.h" -+ #endif -+#endif /* @8814 END */ -+ -+#if (RTL8881A_SUPPORT == 1)/* @FOR_8881_IQK */ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "halrf/rtl8821a/halrf_iqk_8821a_win.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "halrf/rtl8821a/halrf_iqk_8821a_ce.h" -+ #else -+ #include "halrf/rtl8821a/halrf_iqk_8821a_ap.h" -+ #endif -+#endif -+ -+#if (RTL8723B_SUPPORT == 1) -+ #include "rtl8723b/halhwimg8723b_mac.h" -+ #include "rtl8723b/halhwimg8723b_rf.h" -+ #include "rtl8723b/halhwimg8723b_bb.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 "halrf/rtl8723b/halrf_8723b_win.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "halrf/rtl8723b/halrf_8723b_ce.h" -+ #include "rtl8723b/halhwimg8723b_mp.h" -+ #include "rtl8723b_hal.h" -+ #else -+ #include "halrf/rtl8723b/halrf_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/phydm_regconfig8821a.h" -+ #include "rtl8821a/phydm_rtl8821a.h" -+ #include "rtl8821a/version_rtl8821a.h" -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "halrf/rtl8821a/halrf_8821a_win.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "halrf/rtl8821a/halrf_8821a_ce.h" -+ #include "halrf/rtl8821a/halrf_iqk_8821a_ce.h"/*@for IQK*/ -+ #include "halrf/rtl8812a/halrf_8812a_ce.h"/*@for IQK,LCK,Power-tracking*/ -+ #include "rtl8812a_hal.h" -+ #else -+ #endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -+#include "../halmac/halmac_reg2.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) -+#include "../halmac/halmac_reg2.h" -+#endif -+ -+ -+#if (RTL8822B_SUPPORT == 1) -+ #include "rtl8822b/halhwimg8822b_mac.h" -+ #include "rtl8822b/halhwimg8822b_bb.h" -+ #include "rtl8822b/phydm_regconfig8822b.h" -+ #include "halrf/rtl8822b/halrf_8822b.h" -+ #include "halrf/rtl8822b/halhwimg8822b_rf.h" -+ #include "halrf/rtl8822b/version_rtl8822b_rf.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) -+ #ifdef DM_ODM_CE_MAC80211 -+ #include "../halmac/halmac_reg_8822b.h" -+ #elif defined(DM_ODM_CE_MAC80211_V2) -+ #include "../halmac/halmac_reg_8822b.h" -+ #else -+ #include /* @struct HAL_DATA_TYPE */ -+ #include /* @RX_SMOOTH_FACTOR, reg definition and etc.*/ -+ #endif -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #endif -+ -+#endif -+ -+#if (RTL8703B_SUPPORT == 1) -+ #include "rtl8703b/phydm_rtl8703b.h" -+ #include "rtl8703b/phydm_regconfig8703b.h" -+ #include "rtl8703b/halhwimg8703b_mac.h" -+ #include "rtl8703b/halhwimg8703b_rf.h" -+ #include "rtl8703b/halhwimg8703b_bb.h" -+ #include "halrf/rtl8703b/halrf_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/hal8188freg.h" -+ #include "rtl8188f/phydm_rtl8188f.h" -+ #include "rtl8188f/phydm_regconfig8188f.h" -+ #include "halrf/rtl8188f/halrf_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/hal8723dreg.h" -+ #include "rtl8723d/phydm_rtl8723d.h" -+ #include "halrf/rtl8723d/halrf_8723d.h" -+ #include "rtl8723d/version_rtl8723d.h" -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #ifdef DM_ODM_CE_MAC80211 -+ #else -+ #include "rtl8723d_hal.h" -+ #endif -+ #endif -+#endif /* @8723D End */ -+ -+#if (RTL8710B_SUPPORT == 1) -+ #if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+ #include "rtl8710b/halhwimg8710b_bb.h" -+ #include "rtl8710b/halhwimg8710b_mac.h" -+ #include "rtl8710b/phydm_regconfig8710b.h" -+ #include "rtl8710b/hal8710breg.h" -+ #include "rtl8710b/phydm_rtl8710b.h" -+ #include "halrf/rtl8710b/halrf_8710b.h" -+ #include "halrf/rtl8710b/halhwimg8710b_rf.h" -+ #include "halrf/rtl8710b/version_rtl8710b_rf.h" -+ #include "rtl8710b/version_rtl8710b.h" -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8710b_hal.h" -+ #endif -+#endif /* @8710B End */ -+ -+#if (RTL8197F_SUPPORT == 1) -+ #include "rtl8197f/halhwimg8197f_mac.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 "halrf/rtl8197f/halrf_8197f.h" -+ #include "halrf/rtl8197f/halrf_iqk_8197f.h" -+ #include "halrf/rtl8197f/halrf_dpk_8197f.h" -+ #include "halrf/rtl8197f/halhwimg8197f_rf.h" -+ #include "halrf/rtl8197f/version_rtl8197f_rf.h" -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ #include "rtl8821c/phydm_hal_api8821c.h" -+ #include "rtl8821c/halhwimg8821c_mac.h" -+ #include "rtl8821c/halhwimg8821c_bb.h" -+ #include "rtl8821c/phydm_regconfig8821c.h" -+ #include "rtl8821c/phydm_rtl8821c.h" -+ #include "halrf/rtl8821c/halrf_8821c.h" -+ #include "halrf/rtl8821c/halhwimg8821c_rf.h" -+ #include "halrf/rtl8821c/version_rtl8821c_rf.h" -+ #include "rtl8821c/version_rtl8821c.h" -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #ifdef DM_ODM_CE_MAC80211 -+ #include "../halmac/halmac_reg_8821c.h" -+ #else -+ #include "rtl8821c_hal.h" -+ #endif -+ #endif -+#endif -+ -+#if (RTL8192F_SUPPORT == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8192f_hal.h"/*need to before rf.h*/ -+ #endif -+ #include "rtl8192f/halhwimg8192f_mac.h" -+ #include "rtl8192f/halhwimg8192f_bb.h" -+ #include "rtl8192f/phydm_hal_api8192f.h" -+ #include "rtl8192f/version_rtl8192f.h" -+ #include "rtl8192f/phydm_rtl8192f.h" -+ #include "rtl8192f/phydm_regconfig8192f.h" -+ #include "halrf/rtl8192f/halrf_8192f.h" -+ #include "halrf/rtl8192f/halhwimg8192f_rf.h" -+ #include "halrf/rtl8192f/version_rtl8192f_rf.h" -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "halrf/rtl8192f/halrf_dpk_8192f.h" -+ #endif -+#endif -+ -+#if (RTL8721D_SUPPORT == 1) -+ //#include "halrf/rtl8721d/halrf_btiqk_8721d.h" -+ #include "halrf/rtl8721d/halrf_rfk_init_8721d.h" -+ #include "halrf/rtl8721d/halrf_dpk_8721d.h" -+ #include "halrf/rtl8721d/halrf_8721d.h" -+ #include "halrf/rtl8721d/halhwimg8721d_rf.h" -+ #include "halrf/rtl8721d/version_rtl8721d_rf.h" -+ #include "rtl8721d/phydm_hal_api8721d.h" -+ #include "rtl8721d/phydm_regconfig8721d.h" -+ #include "rtl8721d/halhwimg8721d_mac.h" -+ #include "rtl8721d/halhwimg8721d_bb.h" -+ #include "rtl8721d/version_rtl8721d.h" -+ #include "rtl8721d/phydm_rtl8721d.h" -+ #include "rtl8721d/hal8721dreg.h" -+ #include -+ #if 0 -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8721d_hal.h" -+ #endif -+ #endif -+#endif -+ -+#if (RTL8710C_SUPPORT == 1) -+ #include "halrf/rtl8710c/halrf_8710c.h" -+ #include "halrf/rtl8710c/halhwimg8710c_rf.h" -+ //#include "halrf/rtl8710c/version_rtl8710c_rf.h" -+ #include "rtl8710c/phydm_hal_api8710c.h" -+ #include "rtl8710c/phydm_regconfig8710c.h" -+ #include "rtl8710c/halhwimg8710c_mac.h" -+ #include "rtl8710c/halhwimg8710c_bb.h" -+ #include "rtl8710c/version_rtl8710c.h" -+ #include "rtl8710c/phydm_rtl8710c.h" -+ //#include "rtl8710c/hal87100creg.h" -+ #include /*@HAL_DATA_TYPE*/ -+ #if 0 -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "halrf/rtl8710c/halrf_dpk_8710c.h" -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8710c_hal.h" -+ #endif -+ #endif -+#endif -+ -+#if (RTL8195B_SUPPORT == 1) -+ #include "halrf/rtl8195b/halrf_8195b.h" -+ #include "halrf/rtl8195b/halhwimg8195b_rf.h" -+ #include "halrf/rtl8195b/version_rtl8195b_rf.h" -+ #include "rtl8195b/phydm_hal_api8195b.h" -+ #include "rtl8195b/phydm_regconfig8195b.h" -+ #include "rtl8195b/halhwimg8195b_mac.h" -+ #include "rtl8195b/halhwimg8195b_bb.h" -+ #include "rtl8195b/version_rtl8195b.h" -+ #include /*@HAL_DATA_TYPE*/ -+#endif -+ -+#if (RTL8198F_SUPPORT == 1) -+ #include "rtl8198f/phydm_regconfig8198f.h" -+ #include "rtl8198f/phydm_hal_api8198f.h" -+ #include "rtl8198f/halhwimg8198f_mac.h" -+ #include "rtl8198f/halhwimg8198f_bb.h" -+ #include "rtl8198f/version_rtl8198f.h" -+ #include "halrf/rtl8198f/halrf_8198f.h" -+ #include "halrf/rtl8198f/halrf_iqk_8198f.h" -+ #include "halrf/rtl8198f/halhwimg8198f_rf.h" -+ #include "halrf/rtl8198f/version_rtl8198f_rf.h" -+#endif -+ -+#if (RTL8822C_SUPPORT) -+ #include "rtl8822c/halhwimg8822c_bb.h" -+ #include "rtl8822c/phydm_regconfig8822c.h" -+ #include "rtl8822c/phydm_hal_api8822c.h" -+ #include "rtl8822c/version_rtl8822c.h" -+ #include "rtl8822c/phydm_rtl8822c.h" -+ #include "halrf/rtl8822c/halrf_8822c.h" -+ #include "halrf/rtl8822c/halhwimg8822c_rf.h" -+ #include "halrf/rtl8822c/version_rtl8822c_rf.h" -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ /* @struct HAL_DATA_TYPE */ -+ #include -+ /* @RX_SMOOTH_FACTOR, reg definition and etc.*/ -+ #include -+ #endif -+#endif -+#if (RTL8814B_SUPPORT == 1) -+ #include "rtl8814b/halhwimg8814b_bb.h" -+ #include "rtl8814b/phydm_regconfig8814b.h" -+ #include "halrf/rtl8814b/halrf_8814b.h" -+ #include "halrf/rtl8814b/halhwimg8814b_rf.h" -+ #include "halrf/rtl8814b/version_rtl8814b_rf.h" -+ #include "rtl8814b/phydm_hal_api8814b.h" -+ #include "rtl8814b/version_rtl8814b.h" -+ #include "rtl8814b/phydm_extraagc8814b.h" -+#if (RTL8814C_SUPPORT == 1) -+ #include "rtl8814c/halhwimg8814c_bb.h" -+ #include "rtl8814c/phydm_regconfig8814c.h" -+ #include "halrf/rtl8814c/halrf_8814c.h" -+ #include "halrf/rtl8814c/halhwimg8814c_rf.h" -+ #include "halrf/rtl8814c/version_rtl8814c_rf.h" -+ #include "rtl8814c/phydm_hal_api8814c.h" -+ #include "rtl8814c/version_rtl8814c.h" -+ #include "rtl8814c/phydm_extraagc8814c.h" -+#endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include /* @struct HAL_DATA_TYPE */ -+ #include /* @RX_SMOOTH_FACTOR, reg definition and etc.*/ -+ #endif -+#endif -+#if (RTL8812F_SUPPORT) -+ #include "rtl8812f/halhwimg8812f_bb.h" -+ #include "rtl8812f/phydm_regconfig8812f.h" -+ #include "halrf/rtl8812f/halrf_8812f.h" -+ #include "halrf/rtl8812f/halhwimg8812f_rf.h" -+ #include "halrf/rtl8812f/version_rtl8812f_rf.h" -+ #include "rtl8812f/phydm_hal_api8812f.h" -+ #include "rtl8812f/version_rtl8812f.h" -+ #include "rtl8812f/phydm_rtl8812f.h" -+#endif -+#if (RTL8197G_SUPPORT) -+ #include "rtl8197g/halhwimg8197g_bb.h" -+ #include "rtl8197g/halhwimg8197g_mac.h" -+ #include "rtl8197g/phydm_regconfig8197g.h" -+ #include "halrf/rtl8197g/halrf_8197g.h" -+ #include "halrf/rtl8197g/halhwimg8197g_rf.h" -+ #include "halrf/rtl8197g/version_rtl8197g_rf.h" -+ #include "rtl8197g/phydm_hal_api8197g.h" -+ #include "rtl8197g/version_rtl8197g.h" -+ #include "rtl8197g/phydm_rtl8197g.h" -+#endif -+#if (RTL8723F_SUPPORT) -+ #include "rtl8723f/halhwimg8723f_bb.h" -+ #include "rtl8723f/halhwimg8723f_mac.h" -+ #include "rtl8723f/phydm_regconfig8723f.h" -+ #include "halrf/rtl8723f/halrf_8723f.h" -+ #include "halrf/rtl8723f/halhwimg8723f_rf.h" -+ #include "halrf/rtl8723f/version_rtl8723f_rf.h" -+ #include "halrf/rtl8723f/halrf_iqk_8723f.h" -+ #include "halrf/rtl8723f/halrf_dpk_8723f.h" -+ #include "halrf/rtl8723f/halrf_txgapk_8723f.h" -+ #include "halrf/rtl8723f/halrf_tssi_8723f.h" -+ #include "halrf/rtl8723f/halrf_rfk_init_8723f.h" -+ #include "rtl8723f/phydm_hal_api8723f.h" -+ #include "rtl8723f/version_rtl8723f.h" -+ #include "rtl8723f/phydm_rtl8723f.h" -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ /* @struct HAL_DATA_TYPE */ -+ #include -+ /* @RX_SMOOTH_FACTOR, reg definition and etc.*/ -+ #include -+ #endif -+#endif -+#endif /* @__ODM_PRECOMP_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_primary_cca.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_primary_cca.c -new file mode 100644 -index 000000000..dec6c5365 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_primary_cca.c -@@ -0,0 +1,173 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/************************************************************* -+ * include files -+ ************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+#ifdef PHYDM_PRIMARY_CCA -+ -+void phydm_write_dynamic_cca( -+ void *dm_void, -+ u8 curr_mf_state -+ -+ ) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pricca_struct *pri_cca = &dm->dm_pri_cca; -+ -+ if (pri_cca->mf_state == curr_mf_state) -+ return; -+ -+ if (dm->support_ic_type & ODM_IC_11N_SERIES) { -+ if (curr_mf_state == MF_USC_LSC) { -+ odm_set_bb_reg(dm, R_0xc6c, 0x180, MF_USC_LSC); -+ /*@40M OFDM MF CCA threshold*/ -+ odm_set_bb_reg(dm, R_0xc84, 0xf0000000, -+ pri_cca->cca_th_40m_bkp); -+ } else { -+ odm_set_bb_reg(dm, R_0xc6c, 0x180, curr_mf_state); -+ /*@40M OFDM MF CCA threshold*/ -+ odm_set_bb_reg(dm, R_0xc84, 0xf0000000, 0); -+ } -+ } -+ -+ pri_cca->mf_state = curr_mf_state; -+ PHYDM_DBG(dm, DBG_PRI_CCA, "Set CCA at ((%s SB)), 0xc6c[8:7]=((%d))\n", -+ ((curr_mf_state == MF_USC_LSC) ? "D" : -+ ((curr_mf_state == MF_LSC) ? "L" : "U")), curr_mf_state); -+} -+ -+void phydm_primary_cca_reset( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pricca_struct *pri_cca = &dm->dm_pri_cca; -+ -+ PHYDM_DBG(dm, DBG_PRI_CCA, "[PriCCA] Reset\n"); -+ pri_cca->mf_state = 0xff; -+ pri_cca->pre_bw = (enum channel_width)0xff; -+ phydm_write_dynamic_cca(dm, MF_USC_LSC); -+} -+ -+void phydm_primary_cca_11n( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pricca_struct *pri_cca = &dm->dm_pri_cca; -+ enum channel_width curr_bw = (enum channel_width)*dm->band_width; -+ -+ if (!(dm->support_ability & ODM_BB_PRIMARY_CCA)) -+ return; -+ -+ if (!dm->is_linked) { -+ PHYDM_DBG(dm, DBG_PRI_CCA, "[PriCCA][No Link!!!]\n"); -+ -+ if (pri_cca->pri_cca_is_become_linked) { -+ phydm_primary_cca_reset(dm); -+ pri_cca->pri_cca_is_become_linked = dm->is_linked; -+ } -+ return; -+ } else { -+ if (!pri_cca->pri_cca_is_become_linked) { -+ PHYDM_DBG(dm, DBG_PRI_CCA, "[PriCCA][Linked !!!]\n"); -+ pri_cca->pri_cca_is_become_linked = dm->is_linked; -+ } -+ } -+ -+ if (curr_bw != pri_cca->pre_bw) { -+ PHYDM_DBG(dm, DBG_PRI_CCA, "[Primary CCA] start ==>\n"); -+ pri_cca->pre_bw = curr_bw; -+ -+ if (curr_bw == CHANNEL_WIDTH_40) { -+ if (*dm->sec_ch_offset == SECOND_CH_AT_LSB) { -+ /* Primary CH @ upper sideband*/ -+ PHYDM_DBG(dm, DBG_PRI_CCA, -+ "BW40M, Primary CH at USB\n"); -+ phydm_write_dynamic_cca(dm, MF_USC); -+ } else { -+ /*Primary CH @ lower sideband*/ -+ PHYDM_DBG(dm, DBG_PRI_CCA, -+ "BW40M, Primary CH at LSB\n"); -+ phydm_write_dynamic_cca(dm, MF_LSC); -+ } -+ } else { -+ PHYDM_DBG(dm, DBG_PRI_CCA, "Not BW40M, USB + LSB\n"); -+ phydm_primary_cca_reset(dm); -+ } -+ } -+} -+ -+boolean -+odm_dynamic_primary_cca_dup_rts(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pricca_struct *pri_cca = &dm->dm_pri_cca; -+ -+ return pri_cca->dup_rts_flag; -+} -+ -+void phydm_primary_cca_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_pricca_struct *pri_cca = &dm->dm_pri_cca; -+ -+ if (!(dm->support_ability & ODM_BB_PRIMARY_CCA)) -+ return; -+ -+ if (!(dm->support_ic_type & ODM_IC_11N_SERIES)) -+ return; -+ -+ PHYDM_DBG(dm, DBG_PRI_CCA, "[PriCCA] Init ==>\n"); -+#if (RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) -+ pri_cca->dup_rts_flag = 0; -+ pri_cca->intf_flag = 0; -+ pri_cca->intf_type = 0; -+ pri_cca->monitor_flag = 0; -+ pri_cca->pri_cca_flag = 0; -+ pri_cca->ch_offset = 0; -+#endif -+ pri_cca->mf_state = 0xff; -+ pri_cca->pre_bw = (enum channel_width)0xff; -+ pri_cca->cca_th_40m_bkp = (u8)odm_get_bb_reg(dm, R_0xc84, 0xf0000000); -+} -+ -+void phydm_primary_cca(void *dm_void) -+{ -+#ifdef PHYDM_PRIMARY_CCA -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ic_type & ODM_IC_11N_SERIES)) -+ return; -+ -+ if (!(dm->support_ability & ODM_BB_PRIMARY_CCA)) -+ return; -+ -+ phydm_primary_cca_11n(dm); -+ -+#endif -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_primary_cca.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_primary_cca.h -new file mode 100644 -index 000000000..1978586f2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_primary_cca.h -@@ -0,0 +1,76 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_PRIMARYCCA_H__ -+#define __PHYDM_PRIMARYCCA_H__ -+ -+#ifdef PHYDM_PRIMARY_CCA -+#define PRIMARYCCA_VERSION "2.0" -+ -+/*@============================================================*/ -+/*@Definition */ -+/*@============================================================*/ -+ -+#define OFDMCCA_TH 500 -+#define bw_ind_bias 500 -+#define PRI_CCA_MONITOR_TIME 30 -+ -+/*@============================================================*/ -+/*structure and define*/ -+/*@============================================================*/ -+enum primary_cca_ch_position { /*N-series REG0xc6c[8:7]*/ -+ MF_USC_LSC = 0, -+ MF_LSC = 1, -+ MF_USC = 2 -+}; -+ -+struct phydm_pricca_struct { -+ #if (RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) -+ u8 pri_cca_flag; -+ u8 intf_flag; -+ u8 intf_type; -+ u8 monitor_flag; -+ u8 ch_offset; -+ #endif -+ u8 dup_rts_flag; -+ u8 cca_th_40m_bkp; /*@c84[31:28]*/ -+ enum channel_width pre_bw; -+ u8 pri_cca_is_become_linked; -+ u8 mf_state; -+}; -+ -+/*@============================================================*/ -+/*@function prototype*/ -+/*@============================================================*/ -+void phydm_write_dynamic_cca(void *dm_void, u8 curr_mf_state); -+ -+boolean odm_dynamic_primary_cca_dup_rts(void *dm_void); -+ -+void phydm_primary_cca_init(void *dm_void); -+ -+void phydm_primary_cca(void *dm_void); -+#endif /*@#ifdef PHYDM_PRIMARY_CCA*/ -+#endif /*@#ifndef __PHYDM_PRIMARYCCA_H__*/ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_psd.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_psd.c -new file mode 100644 -index 000000000..8a19160b9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_psd.c -@@ -0,0 +1,564 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/****************************************************************************** -+ * include files -+ *****************************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef CONFIG_PSD_TOOL -+u32 phydm_get_psd_data(void *dm_void, u32 psd_tone_idx, u32 igi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct psd_info *dm_psd_table = &dm->dm_psd_table; -+ u32 psd_report = 0; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ #if(RTL8723F_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8723F)) { -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, 0x3ff80000, psd_tone_idx & 0x7ff); -+ /*PSD trigger start*/ -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(16), 1); -+ ODM_delay_us(10 << (dm_psd_table->fft_smp_point >> 7)); -+ /*PSD trigger stop*/ -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(16), 0); -+ } -+ #endif -+ #if 0 -+ odm_set_bb_reg(dm, R_0x1e8c, 0x3ff, psd_tone_idx & 0x3ff); -+ odm_set_bb_reg(dm, R_0x1e88, BIT(27) | BIT(26), -+ psd_tone_idx >> 10); -+ /*PSD trigger start*/ -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(18), 1); -+ ODM_delay_us(10 << (dm_psd_table->fft_smp_point >> 7)); -+ /*PSD trigger stop*/ -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(18), 0); -+ #endif -+ } else if (dm->support_ic_type & (ODM_RTL8721D | -+ ODM_RTL8710C)) { -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, 0xfff, psd_tone_idx); -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(28), 1); -+ /*PSD trigger start*/ -+ ODM_delay_us(10 << (dm_psd_table->fft_smp_point >> 7)); -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(28), 0); -+ /*PSD trigger stop*/ -+ } else { -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, 0x3ff, psd_tone_idx); -+ /*PSD trigger start*/ -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(22), 1); -+ ODM_delay_us(10 << (dm_psd_table->fft_smp_point >> 7)); -+ /*PSD trigger stop*/ -+ odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(22), 0); -+ } -+ -+ /*Get PSD Report*/ -+ if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8721D | -+ ODM_RTL8710C)) { -+ psd_report = odm_get_bb_reg(dm, dm_psd_table->psd_report_reg, -+ 0xffffff); -+ psd_report = psd_report >> 5; -+ } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ #if(RTL8723F_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8723F)) { -+ psd_report = odm_get_bb_reg(dm, dm_psd_table->psd_report_reg, -+ 0x1ffffff); -+ } -+ #endif -+ #if 0 -+ psd_report = odm_get_bb_reg(dm, dm_psd_table->psd_report_reg, -+ 0xffffff); -+ #endif -+ } else { -+ psd_report = odm_get_bb_reg(dm, dm_psd_table->psd_report_reg, -+ 0xffff); -+ } -+ psd_report = odm_convert_to_db((u64)psd_report) + igi; -+ -+ return psd_report; -+} -+ -+u8 psd_result_cali_tone_8821[7] = {21, 28, 33, 93, 98, 105, 127}; -+u8 psd_result_cali_val_8821[7] = {67, 69, 71, 72, 71, 69, 67}; -+ -+u8 phydm_psd(void *dm_void, u32 igi, u16 start_point, u16 stop_point) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct psd_info *dm_psd_table = &dm->dm_psd_table; -+ u32 i = 0, mod_tone_idx = 0; -+ u32 t = 0; -+ u16 fft_max_half_bw = 0; -+ u16 psd_fc_channel = dm_psd_table->psd_fc_channel; -+ u8 ag_rf_mode_reg = 0; -+ u8 is_5G = 0; -+ u32 psd_result_tmp = 0; -+ u8 psd_result = 0; -+ u8 psd_result_cali_tone[7] = {0}; -+ u8 psd_result_cali_val[7] = {0}; -+ u8 noise_idx = 0; -+ u8 set_result = 0; -+ u32 igi_tmp = 0x6e; -+ -+ if (dm->support_ic_type == ODM_RTL8821) { -+ odm_move_memory(dm, psd_result_cali_tone, -+ psd_result_cali_tone_8821, 7); -+ odm_move_memory(dm, psd_result_cali_val, -+ psd_result_cali_val_8821, 7); -+ } -+ -+ dm_psd_table->psd_in_progress = 1; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "PSD Start =>\n"); -+ -+ /* @[Stop DIG]*/ -+ /* @IGI target at 0dBm & make it can't CCA*/ -+ if (phydm_pause_func(dm, F00_DIG, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_3, 1, -+ &igi_tmp) == PAUSE_FAIL) { -+ return PHYDM_SET_FAIL; -+ } -+ -+ ODM_delay_us(10); -+ -+ if (phydm_stop_ic_trx(dm, PHYDM_SET) == PHYDM_SET_FAIL) { -+ phydm_pause_func(dm, F00_DIG, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_3, -+ 1, &igi_tmp); -+ return PHYDM_SET_FAIL; -+ } -+ -+ /* @[Set IGI]*/ -+ phydm_write_dig_reg(dm, (u8)igi); -+ -+ /* @[Backup RF Reg]*/ -+ dm_psd_table->rf_0x18_bkp = odm_get_rf_reg(dm, RF_PATH_A, RF_0x18, -+ RFREG_MASK); -+ dm_psd_table->rf_0x18_bkp_b = odm_get_rf_reg(dm, RF_PATH_B, RF_0x18, -+ RFREG_MASK); -+ -+ if (psd_fc_channel > 14) { -+ is_5G = 1; -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F | -+ ODM_RTL8197G)) { -+ #if 0 -+ if (psd_fc_channel < 80) -+ ag_rf_mode_reg = 0x1; -+ else if (psd_fc_channel >= 80 && psd_fc_channel <= 140) -+ ag_rf_mode_reg = 0x3; -+ else if (psd_fc_channel > 140) -+ ag_rf_mode_reg = 0x5; -+ #endif -+ } else if (dm->support_ic_type & ODM_RTL8723F) { -+ if (psd_fc_channel < 80) -+ ag_rf_mode_reg = 0x1; -+ else if (psd_fc_channel >= 80 && psd_fc_channel <= 144) -+ ag_rf_mode_reg = 0x5; -+ else if (psd_fc_channel > 144) -+ ag_rf_mode_reg = 0x9; -+ } else if (dm->support_ic_type == ODM_RTL8721D) { -+ if (psd_fc_channel >= 36 && psd_fc_channel <= 64) -+ ag_rf_mode_reg = 0x1; -+ else if (psd_fc_channel >= 100 && psd_fc_channel <= 140) -+ ag_rf_mode_reg = 0x5; -+ else if (psd_fc_channel > 140) -+ ag_rf_mode_reg = 0x9; -+ } else { -+ if (psd_fc_channel >= 36 && psd_fc_channel <= 64) -+ ag_rf_mode_reg = 0x1; -+ else if (psd_fc_channel >= 100 && psd_fc_channel <= 140) -+ ag_rf_mode_reg = 0x3; -+ else if (psd_fc_channel > 140) -+ ag_rf_mode_reg = 0x5; -+ } -+ } -+ -+ /* Set RF fc*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0xff, psd_fc_channel); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0xff, psd_fc_channel); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0x300, is_5G); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0x300, is_5G); -+ if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F | -+ ODM_RTL8197G)) { -+ #if 0 -+ /* @2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0x3000, -+ dm_psd_table->psd_bw_rf_reg); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0x3000, -+ dm_psd_table->psd_bw_rf_reg); -+ /* Set RF ag fc mode*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0x70000, -+ ag_rf_mode_reg); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0x70000, -+ ag_rf_mode_reg); -+ #endif -+ } else if (dm->support_ic_type & ODM_RTL8723F) { -+ /* @2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0x1c00, -+ dm_psd_table->psd_bw_rf_reg); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0x1c00, -+ dm_psd_table->psd_bw_rf_reg); -+ /* Set RF ag fc mode*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0x30000, 1); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0x30000, 1); -+ if(ag_rf_mode_reg == 1) { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x19, 0xc0000, 0); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x19, 0xc0000, 0); -+ } -+ else if(ag_rf_mode_reg == 5){ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x19, 0xc0000, 1); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x19, 0xc0000, 1); -+ } -+ else { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x19, 0xc0000, 2); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x19, 0xc0000, 2); -+ } -+ } else { -+ /* @2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ -+ if (dm->support_ic_type == ODM_RTL8721D) { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0x1c00, -+ dm_psd_table->psd_bw_rf_reg); -+#if (RTL8710C_SUPPORT == 1) -+ } else if (dm->support_ic_type == ODM_RTL8710C) { -+ odm_set_rf_reg(dm, RF_PATH_A, -+ RF_0x18, 0x1c00, -+ dm_psd_table->psd_bw_rf_reg); -+#endif -+ } else { -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0xc00, -+ dm_psd_table->psd_bw_rf_reg); -+ } -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0xc00, -+ dm_psd_table->psd_bw_rf_reg); -+ /* Set RF ag fc mode*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0xf0000, -+ ag_rf_mode_reg); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0xf0000, -+ ag_rf_mode_reg); -+ } -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES){ -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ PHYDM_DBG(dm, ODM_COMP_API, "0x1d70=((0x%x))\n", -+ odm_get_bb_reg(dm, R_0x1d70, MASKDWORD)); -+ PHYDM_DBG(dm, ODM_COMP_API, "RF0x19=((0x%x))\n", -+ odm_get_rf_reg(dm, RF_PATH_A, RF_0x19, RFREG_MASK)); -+ } -+ } else -+ PHYDM_DBG(dm, ODM_COMP_API, "0xc50=((0x%x))\n", -+ odm_get_bb_reg(dm, R_0xc50, MASKDWORD)); -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "RF0x18=((0x%x))\n", -+ odm_get_rf_reg(dm, RF_PATH_A, RF_0x18, RFREG_MASK)); -+ -+ /* @[Stop 3-wires]*/ -+ phydm_stop_3_wire(dm, PHYDM_SET); -+ -+ ODM_delay_us(10); -+ -+ if (stop_point > (dm_psd_table->fft_smp_point - 1)) -+ stop_point = (dm_psd_table->fft_smp_point - 1); -+ -+ if (start_point > (dm_psd_table->fft_smp_point - 1)) -+ start_point = (dm_psd_table->fft_smp_point - 1); -+ -+ if (start_point > stop_point) -+ stop_point = start_point; -+ -+ for (i = start_point; i <= stop_point; i++) { -+ fft_max_half_bw = (dm_psd_table->fft_smp_point) >> 1; -+ -+ if (i < fft_max_half_bw) -+ mod_tone_idx = i + fft_max_half_bw; -+ else -+ mod_tone_idx = i - fft_max_half_bw; -+ -+ psd_result_tmp = 0; -+ for (t = 0; t < dm_psd_table->sw_avg_time; t++) -+ psd_result_tmp += phydm_get_psd_data(dm, mod_tone_idx, -+ igi); -+ psd_result = -+ (u8)((psd_result_tmp / dm_psd_table->sw_avg_time)) - -+ dm_psd_table->psd_pwr_common_offset; -+ -+ if (dm_psd_table->fft_smp_point == 128 && -+ dm_psd_table->noise_k_en) { -+ if (i > psd_result_cali_tone[noise_idx]) -+ noise_idx++; -+ -+ if (noise_idx > 6) -+ noise_idx = 6; -+ -+ if (psd_result >= psd_result_cali_val[noise_idx]) -+ psd_result = psd_result - -+ psd_result_cali_val[noise_idx]; -+ else -+ psd_result = 0; -+ -+ dm_psd_table->psd_result[i] = psd_result; -+ } -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "[%d] N_cali = %d, PSD = %d\n", -+ mod_tone_idx, psd_result_cali_val[noise_idx], -+ psd_result); -+ } -+ -+ /*@[Start 3-wires]*/ -+ phydm_stop_3_wire(dm, PHYDM_REVERT); -+ -+ ODM_delay_us(10); -+ -+ /*@[Revert Reg]*/ -+ set_result = phydm_stop_ic_trx(dm, PHYDM_REVERT); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, RFREG_MASK, -+ dm_psd_table->rf_0x18_bkp); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, RFREG_MASK, -+ dm_psd_table->rf_0x18_bkp_b); -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "PSD finished\n\n"); -+ -+ phydm_pause_func(dm, F00_DIG, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_3, 1, -+ &igi_tmp); -+ dm_psd_table->psd_in_progress = 0; -+ -+ return PHYDM_SET_SUCCESS; -+} -+ -+void phydm_psd_para_setting(void *dm_void, u8 sw_avg_time, u8 hw_avg_time, -+ u8 i_q_setting, u16 fft_smp_point, u8 ant_sel, -+ u8 psd_input, u8 channel, u8 noise_k_en) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct psd_info *dm_psd_table = &dm->dm_psd_table; -+ u8 fft_smp_point_idx = 0; -+ -+ dm_psd_table->fft_smp_point = fft_smp_point; -+ -+ if (sw_avg_time == 0) -+ sw_avg_time = 1; -+ -+ dm_psd_table->sw_avg_time = sw_avg_time; -+ dm_psd_table->psd_fc_channel = channel; -+ dm_psd_table->noise_k_en = noise_k_en; -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ if (fft_smp_point == 128) -+ fft_smp_point_idx = 3; -+ else if (fft_smp_point == 256) -+ fft_smp_point_idx = 2; -+ else if (fft_smp_point == 512) -+ fft_smp_point_idx = 1; -+ else if (fft_smp_point == 1024) -+ fft_smp_point_idx = 0; -+ } -+ else { -+ if (fft_smp_point == 128) -+ fft_smp_point_idx = 0; -+ else if (fft_smp_point == 256) -+ fft_smp_point_idx = 1; -+ else if (fft_smp_point == 512) -+ fft_smp_point_idx = 2; -+ else if (fft_smp_point == 1024) -+ fft_smp_point_idx = 3; -+ } -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ #if (RTL8723F_SUPPORT) -+ odm_set_bb_reg(dm, R_0x1e8c, BIT(12) | BIT(11), hw_avg_time); -+ odm_set_bb_reg(dm, R_0x1e8c, BIT(14) | BIT(13), -+ fft_smp_point_idx); -+ odm_set_bb_reg(dm, R_0x1e8c, BIT(18) | BIT(17), ant_sel); -+ odm_set_bb_reg(dm, R_0x1e88, BIT(25) | BIT(24), psd_input); -+ #else -+ #if 0 -+ odm_set_bb_reg(dm, R_0x1e8c, BIT(11) | BIT(10), i_q_setting); -+ odm_set_bb_reg(dm, R_0x1e8c, BIT(13) | BIT(12), hw_avg_time); -+ -+ if (fft_smp_point == 4096) { -+ odm_set_bb_reg(dm, R_0x1e88, BIT(31) | BIT(30), 0x2); -+ } else if (fft_smp_point == 2048) { -+ odm_set_bb_reg(dm, R_0x1e88, BIT(31) | BIT(30), 0x1); -+ } else { -+ odm_set_bb_reg(dm, R_0x1e88, BIT(31) | BIT(30), 0x0); -+ odm_set_bb_reg(dm, R_0x1e8c, BIT(15) | BIT(14), -+ fft_smp_point_idx); -+ } -+ odm_set_bb_reg(dm, R_0x1e8c, BIT(17) | BIT(16), ant_sel); -+ odm_set_bb_reg(dm, R_0x1e8c, BIT(23) | BIT(22), psd_input); -+ #endif -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ odm_set_bb_reg(dm, R_0x910, BIT(11) | BIT(10), i_q_setting); -+ odm_set_bb_reg(dm, R_0x910, BIT(13) | BIT(12), hw_avg_time); -+ odm_set_bb_reg(dm, R_0x910, BIT(15) | BIT(14), -+ fft_smp_point_idx); -+ odm_set_bb_reg(dm, R_0x910, BIT(17) | BIT(16), ant_sel); -+ odm_set_bb_reg(dm, R_0x910, BIT(23), psd_input); -+ } else if (dm->support_ic_type & (ODM_RTL8721D | ODM_RTL8710C)) { -+ odm_set_bb_reg(dm, R_0x808, BIT(19) | BIT(18), i_q_setting); -+ odm_set_bb_reg(dm, R_0x808, BIT(21) | BIT(20), hw_avg_time); -+ odm_set_bb_reg(dm, R_0x808, BIT(23) | BIT(22), -+ fft_smp_point_idx); -+ odm_set_bb_reg(dm, R_0x804, BIT(5) | BIT(4), ant_sel); -+ odm_set_bb_reg(dm, R_0x80c, BIT(23), psd_input); -+ -+#if 0 -+ } else { /*ODM_IC_11N_SERIES*/ -+#endif -+ } -+ /*@bw = (*dm->band_width); //ODM_BW20M */ -+ /*@channel = *(dm->channel);*/ -+} -+ -+void phydm_psd_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct psd_info *dm_psd_table = &dm->dm_psd_table; -+ -+ PHYDM_DBG(dm, ODM_COMP_API, "PSD para init\n"); -+ -+ dm_psd_table->psd_in_progress = false; -+ -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { -+ #if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8723F) { -+ dm_psd_table->psd_reg = R_0x1e8c; -+ dm_psd_table->psd_report_reg = R_0x2d90; -+ -+ /*@2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ -+ dm_psd_table->psd_bw_rf_reg = 2; -+ } -+ #else -+ #if 0 -+ dm_psd_table->psd_reg = R_0x1e8c; -+ dm_psd_table->psd_report_reg = R_0x2d90; -+ -+ /*@2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ -+ dm_psd_table->psd_bw_rf_reg = 1; -+ #endif -+ -+ return; -+ #endif -+ } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { -+ dm_psd_table->psd_reg = R_0x910; -+ dm_psd_table->psd_report_reg = R_0xf44; -+ -+ /*@2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ -+ if (ODM_IC_11AC_2_SERIES) -+ dm_psd_table->psd_bw_rf_reg = 1; -+ else -+ dm_psd_table->psd_bw_rf_reg = 2; -+ } else { -+ dm_psd_table->psd_reg = R_0x808; -+ dm_psd_table->psd_report_reg = R_0x8b4; -+ /*@2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ -+ dm_psd_table->psd_bw_rf_reg = 2; -+ } -+ -+ dm_psd_table->psd_pwr_common_offset = 0; -+ -+ phydm_psd_para_setting(dm, 1, 2, 3, 128, 0, 0, 7, 0); -+#if 0 -+ /*phydm_psd(dm, 0x3c, 0, 127);*/ /* target at -50dBm */ -+#endif -+} -+ -+void phydm_psd_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u8 i = 0; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ #if (RTL8723F_SUPPORT) -+ if (dm->support_ic_type & ODM_RTL8723F) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{0} {sw_avg} {hw_avg 0:3} {1:I,2:Q,3:IQ} {fft_point: 128*(1:4)}\n{path_sel 0~3} {0:ADC, 1:rxdata_fir_in, 2:rx_nbi_nf_stage2} {CH} {noise_k}\n\n"); -+ #endif -+ #if 0 -+ if (dm->support_ic_type & ODM_IC_JGR3_SERIES) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{0} {sw_avg} {hw_avg 0:3} {1:I,2:Q,3:IQ} {fft_point: 128*(1:4) 2048 4096}\n{path_sel 0~3} {0:ADC, 1:rxdata_fir_in, 2:rx_nbi_nf_stage2} {CH} {noise_k}\n\n"); -+ else -+ #endif -+ #endif -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{0} {sw_avg} {hw_avg 0:3} {1:I,2:Q,3:IQ} {fft_point: 128*(1:4)} {path_sel 0~3} {0:ADC, 1:RXIQC} {CH} {noise_k}\n"); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{1} {IGI(hex)} {start_point} {stop_point}\n"); -+ goto out; -+ } -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if (var1[0] == 0) { -+ for (i = 1; i < 10; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, -+ &var1[i]); -+ } -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "sw_avg_time=((%d)), hw_avg_time=((%d)), IQ=((%d)), fft=((%d)), path=((%d)), input =((%d)) ch=((%d)), noise_k=((%d))\n", -+ var1[1], var1[2], var1[3], var1[4], var1[5], -+ var1[6], (u8)var1[7], (u8)var1[8]); -+ phydm_psd_para_setting(dm, (u8)var1[1], (u8)var1[2], -+ (u8)var1[3], (u16)var1[4], -+ (u8)var1[5], (u8)var1[6], -+ (u8)var1[7], (u8)var1[8]); -+ -+ } else if (var1[0] == 1) { -+ PHYDM_SSCANF(input[2], DCMD_HEX, &var1[1]); -+ PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var1[2]); -+ PHYDM_SSCANF(input[4], DCMD_DECIMAL, &var1[3]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "IGI=((0x%x)), start_point=((%d)), stop_point=((%d))\n", -+ var1[1], var1[2], var1[3]); -+ dm->debug_components |= ODM_COMP_API; -+ if (phydm_psd(dm, var1[1], (u16)var1[2], (u16)var1[3]) == -+ PHYDM_SET_FAIL) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "PSD_SET_FAIL\n"); -+ dm->debug_components &= ~(ODM_COMP_API); -+ } -+ -+out: -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+u8 phydm_get_psd_result_table(void *dm_void, int index) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct psd_info *dm_psd_table = &dm->dm_psd_table; -+ u8 result = 0; -+ -+ if (index < 128) -+ result = dm_psd_table->psd_result[index]; -+ -+ return result; -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_psd.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_psd.h -new file mode 100644 -index 000000000..dec384ab2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_psd.h -@@ -0,0 +1,68 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMPSD_H__ -+#define __PHYDMPSD_H__ -+ -+/*@#define PSD_VERSION "1.0"*/ /*@2016.09.22 Dino*/ -+/*@2016.10.07 Dino, Add Option for PSD Tone index Selection */ -+/*@2019.04.26 Early return & "IF0" for JGR3 ICs */ -+#define PSD_VERSION "1.2" -+ -+#ifdef CONFIG_PSD_TOOL -+ -+ -+struct psd_info { -+ u8 psd_in_progress; -+ u32 psd_reg; -+ u32 psd_report_reg; -+ u8 psd_pwr_common_offset; -+ u16 sw_avg_time; -+ u16 fft_smp_point; -+ u32 rf_0x18_bkp; -+ u32 rf_0x18_bkp_b; -+ u16 psd_fc_channel; -+ u32 psd_bw_rf_reg; -+ u8 psd_result[128]; -+ u8 noise_k_en; -+}; -+ -+u32 phydm_get_psd_data(void *dm_void, u32 psd_tone_idx, u32 igi); -+ -+void phydm_psd_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+u8 phydm_psd(void *dm_void, u32 igi, u16 start_point, u16 stop_point); -+ -+void phydm_psd_para_setting(void *dm_void, u8 sw_avg_time, u8 hw_avg_time, -+ u8 i_q_setting, u16 fft_smp_point, u8 ant_sel, -+ u8 psd_input, u8 channel, u8 noise_k_en); -+ -+void phydm_psd_init(void *dm_void); -+ -+u8 phydm_get_psd_result_table(void *dm_void, int index); -+ -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rainfo.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rainfo.c -new file mode 100644 -index 000000000..97be65844 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rainfo.c -@@ -0,0 +1,2434 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+boolean phydm_is_vht_rate(void *dm_void, u8 rate) -+{ -+ return ((rate & 0x7f) >= ODM_RATEVHTSS1MCS0) ? true : false; -+} -+ -+boolean phydm_is_ht_rate(void *dm_void, u8 rate) -+{ -+ return (((rate & 0x7f) >= ODM_RATEMCS0) && -+ ((rate & 0x7f) <= ODM_RATEMCS31)) ? true : false; -+} -+ -+boolean phydm_is_ofdm_rate(void *dm_void, u8 rate) -+{ -+ return (((rate & 0x7f) >= ODM_RATE6M) && -+ ((rate & 0x7f) <= ODM_RATE54M)) ? true : false; -+} -+ -+boolean phydm_is_cck_rate(void *dm_void, u8 rate) -+{ -+ return ((rate & 0x7f) <= ODM_RATE11M) ? true : false; -+} -+ -+u8 phydm_legacy_rate_2_spec_rate(void *dm_void, u8 rate) -+{ -+ u8 rate_idx = 0x0; -+ u8 legacy_spec_rate_t[8] = {PHYDM_SPEC_RATE_6M, PHYDM_SPEC_RATE_9M, -+ PHYDM_SPEC_RATE_12M, PHYDM_SPEC_RATE_18M, -+ PHYDM_SPEC_RATE_24M, PHYDM_SPEC_RATE_36M, -+ PHYDM_SPEC_RATE_48M, PHYDM_SPEC_RATE_54M}; -+ -+ if ((rate >= ODM_RATE6M) && (rate <= ODM_RATE54M)) -+ rate_idx = rate - ODM_RATE6M; -+ return legacy_spec_rate_t[rate_idx]; -+} -+ -+u8 phydm_rate_2_rate_digit(void *dm_void, u8 rate) -+{ -+ u8 legacy_table[12] = {1, 2, 5, 11, 6, 9, 12, 18, 24, 36, 48, 54}; -+ u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ -+ u8 rate_digit = 0; -+ -+ if (rate_idx >= ODM_RATEVHTSS1MCS0) -+ rate_digit = (rate_idx - ODM_RATEVHTSS1MCS0) % 10; -+ else if (rate_idx >= ODM_RATEMCS0) -+ rate_digit = (rate_idx - ODM_RATEMCS0); -+ else if (rate_idx <= ODM_RATE54M) -+ rate_digit = legacy_table[rate_idx]; -+ -+ return rate_digit; -+} -+ -+u8 phydm_rate_type_2_num_ss(void *dm_void, enum PDM_RATE_TYPE type) -+{ -+ u8 num_ss = 1; -+ -+ switch (type) { -+ case PDM_CCK: -+ case PDM_OFDM: -+ case PDM_1SS: -+ num_ss = 1; -+ break; -+ case PDM_2SS: -+ num_ss = 2; -+ break; -+ case PDM_3SS: -+ num_ss = 3; -+ break; -+ case PDM_4SS: -+ num_ss = 4; -+ break; -+ default: -+ break; -+ } -+ -+ return num_ss; -+} -+ -+u8 phydm_rate_to_num_ss(void *dm_void, u8 data_rate) -+{ -+ u8 num_ss = 1; -+ -+ if (data_rate <= ODM_RATE54M) -+ num_ss = 1; -+ else if (data_rate <= ODM_RATEMCS31) -+ num_ss = ((data_rate - ODM_RATEMCS0) >> 3) + 1; -+ else if (data_rate <= ODM_RATEVHTSS1MCS9) -+ num_ss = 1; -+ else if (data_rate <= ODM_RATEVHTSS2MCS9) -+ num_ss = 2; -+ else if (data_rate <= ODM_RATEVHTSS3MCS9) -+ num_ss = 3; -+ else if (data_rate <= ODM_RATEVHTSS4MCS9) -+ num_ss = 4; -+ -+ return num_ss; -+} -+ -+void phydm_h2C_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 dm_value[10] = {0}; -+ u8 i = 0, input_idx = 0; -+ u8 h2c_parameter[H2C_MAX_LENGTH] = {0}; -+ u8 phydm_h2c_id = 0; -+ -+ for (i = 0; i < 8; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); -+ input_idx++; -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ phydm_h2c_id = (u8)dm_value[0]; -+ -+ PDM_SNPF(out_len, used, 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] = (u8)dm_value[i + 1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "H2C: Byte[%d] = ((0x%x))\n", i, h2c_parameter[i]); -+ } -+ -+ odm_fill_h2c_cmd(dm, phydm_h2c_id, H2C_MAX_LENGTH, h2c_parameter); -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_fw_fix_rate(void *dm_void, u8 en, u8 macid, u8 bw, u8 rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 reg_u32_tmp; -+ -+ if (dm->support_ic_type & PHYDM_IC_8051_SERIES) { -+ reg_u32_tmp = (bw << 24) | (rate << 16) | (macid << 8) | en; -+ odm_set_mac_reg(dm, R_0x4a0, MASKDWORD, reg_u32_tmp); -+ -+ } else { -+ if (en == 1) -+ reg_u32_tmp = BYTE_2_DWORD(0x60, macid, bw, rate); -+ else -+ reg_u32_tmp = 0x40000000; -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) -+ odm_set_mac_reg(dm, R_0x448, MASKDWORD, reg_u32_tmp); -+ else -+ odm_set_mac_reg(dm, R_0x450, MASKDWORD, reg_u32_tmp); -+ } -+ if (en == 1) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "FW fix TX rate[id =%d], %dM, Rate(%d)=", macid, -+ (20 << bw), rate); -+ phydm_print_rate(dm, rate, ODM_COMP_API); -+ } else { -+ PHYDM_DBG(dm, ODM_COMP_API, "Auto Rate\n"); -+ } -+} -+ -+void phydm_ra_debug(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ char help[] = "-h"; -+ u32 var[5] = {0}; -+ u8 macid = 0, bw = 0, rate = 0; -+ u8 tx_cls_en = 0, tx_cls_th = 0, tmp = 0; -+ u8 i = 0; -+ -+ for (i = 0; i < 5; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var[i]); -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{1} {0:-,1:+} {ofst}: set offset\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{1} {100}: show offset\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{2} {en} {macid} {bw} {rate}: fw fix rate\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{3} {en}: Dynamic RRSR\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{4} {0:pkt RA, 1:TBTT RA, 100:query RA mode}\n"); -+#ifdef CONFIG_DYNAMIC_TXCOLLISION_TH -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{5} {0:dis, 1:en}{th; 255:auto, xx:dB}: Tx CLS\n"); -+#endif -+ } else if (var[0] == 1) { /*@Adjust PCR offset*/ -+ -+ if (var[1] == 100) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Get] RA_ofst=((%s%d))\n", -+ ((ra_tab->ra_ofst_direc) ? "+" : "-"), -+ ra_tab->ra_th_ofst); -+ -+ } else if (var[1] == 0) { -+ ra_tab->ra_ofst_direc = 0; -+ ra_tab->ra_th_ofst = (u8)var[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Set] RA_ofst=((-%d))\n", ra_tab->ra_th_ofst); -+ } else if (var[1] == 1) { -+ ra_tab->ra_ofst_direc = 1; -+ ra_tab->ra_th_ofst = (u8)var[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Set] RA_ofst=((+%d))\n", ra_tab->ra_th_ofst); -+ } -+ -+ } else if (var[0] == 2) { /*@FW fix rate*/ -+ macid = (u8)var[2]; -+ bw = (u8)var[3]; -+ rate = (u8)var[4]; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[FW fix TX Rate] {en, macid,bw,rate}={%d, %d, %d, 0x%x}", -+ var[1], macid, bw, rate); -+ -+ phydm_fw_fix_rate(dm, (u8)var[1], macid, bw, rate); -+ } else if (var[0] == 3) { /*@Dynamic RRSR*/ -+ ra_tab->dynamic_rrsr_en = (boolean)var[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Dynamic RRSR] enable=%d", ra_tab->dynamic_rrsr_en); -+ } else if (var[0] == 4) { /*@RA trigger mode*/ -+ if (var[1] == 0 || var[1] == 1) -+ ra_tab->ra_trigger_mode = (u8)var[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[RA trigger] mode=%d\n", ra_tab->ra_trigger_mode); -+#ifdef CONFIG_DYNAMIC_TXCOLLISION_TH -+ } else if (var[0] == 5) { /*@Tx Collision Detection*/ -+ tx_cls_en = (u8)var[1]; -+ ra_tab->ra_tx_cls_th = (u8)var[2]; -+ tmp = (u8)var[2]; -+ tx_cls_th = (tmp < 50) ? 0 : (tmp > 81) ? 31 : tmp - 50; -+ if (tx_cls_en) { -+ odm_set_bb_reg(dm, R_0x8f8, BIT(16), 1); -+ if (ra_tab->ra_tx_cls_th != 255) { -+ phydm_tx_collsion_th_set(dm, tx_cls_th, -+ tx_cls_th); -+ } -+ -+ } else { -+ odm_set_bb_reg(dm, R_0x8f8, BIT(16), 0); -+ } -+ -+ if (tx_cls_en & ra_tab->ra_tx_cls_th != 255) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Tx Collision Detec] {en, th}={%d, %d}\n", -+ tx_cls_en, tx_cls_th + 50); -+ } else if (tx_cls_en & ra_tab->ra_tx_cls_th == 255) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Tx Collision Detec] {en, th}={%d, auto}\n", -+ tx_cls_en); -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Tx Collision Detec] {en, th}={%d, xx}\n", -+ tx_cls_en); -+ } -+#endif -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[Set] Error\n"); -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_ra_mask_report_h2c_trigger(void *dm_void, -+ struct ra_mask_rpt_trig *trig_rpt) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ -+ phydm_fw_trace_en_h2c(dm, true, 1, 2, trig_rpt->macid); -+ -+ trig_rpt->ra_mask_rpt_stamp = ra_tab->ra_mask_rpt_stamp; -+} -+void phydm_ra_mask_report_c2h_result(void *dm_void, struct ra_mask_rpt *rpt) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ u8 i = 0; -+ -+ rpt->ra_mask_rpt_stamp = ra_tab->ra_mask_rpt_stamp; -+ -+ odm_move_memory(dm, &rpt->ra_mask_buf[0], &ra_tab->ra_mask_buf[0], 8); -+} -+ -+void odm_c2h_ra_para_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ u8 mode = cmd_buf[0]; /*Retry Penalty, NH, NL*/ -+ u8 i; -+ -+ PHYDM_DBG(dm, DBG_FW_TRACE, "[%s] [mode: %d]----------------------->\n", -+ __func__, mode); -+ -+ if (mode == RADBG_DEBUG_MONITOR1) { -+ if (dm->support_ic_type & PHYDM_IC_3081_SERIES) { -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "RSSI =", -+ cmd_buf[1]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "rate =", -+ cmd_buf[2] & 0x7f); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "SGI =", -+ (cmd_buf[2] & 0x80) >> 7); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "BW =", -+ cmd_buf[3]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "BW_max =", -+ cmd_buf[4]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", -+ "multi_rate0 =", cmd_buf[5]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", -+ "multi_rate1 =", cmd_buf[6]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "DISRA =", -+ cmd_buf[7]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "VHT_EN =", -+ cmd_buf[8]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", -+ "SGI_support =", cmd_buf[9]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "try_ness =", -+ cmd_buf[10]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "pre_rate =", -+ cmd_buf[11]); -+ } else { -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "RSSI =", -+ cmd_buf[1]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %x\n", "BW =", -+ cmd_buf[2]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "DISRA =", -+ cmd_buf[3]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "VHT_EN =", -+ cmd_buf[4]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", -+ "Hightest rate =", cmd_buf[5]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", -+ "Lowest rate =", cmd_buf[6]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", -+ "SGI_support =", cmd_buf[7]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "Rate_ID =", -+ cmd_buf[8]); -+ } -+ } else if (mode == RADBG_DEBUG_MONITOR2) { -+ if (dm->support_ic_type & PHYDM_IC_3081_SERIES) { -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "rate_id =", -+ cmd_buf[1]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", -+ "highest_rate =", cmd_buf[2]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", -+ "lowest_rate =", cmd_buf[3]); -+ -+ for (i = 4; i <= 11; i++) -+ PHYDM_DBG(dm, DBG_FW_TRACE, "RAMASK = 0x%x\n", -+ cmd_buf[i]); -+ -+ odm_move_memory(dm, &ra_tab->ra_mask_buf[0], &cmd_buf[4], 8); -+ ra_tab->ra_mask_rpt_stamp++; -+ } else { -+ PHYDM_DBG(dm, DBG_FW_TRACE, -+ "%5s %x%x %x%x %x%x %x%x\n", "RA Mask:", -+ cmd_buf[8], cmd_buf[7], cmd_buf[6], -+ cmd_buf[5], cmd_buf[4], cmd_buf[3], -+ cmd_buf[2], cmd_buf[1]); -+ } -+ } else if (mode == RADBG_DEBUG_MONITOR3) { -+ for (i = 0; i < (cmd_len - 1); i++) -+ PHYDM_DBG(dm, DBG_FW_TRACE, "content[%d] = %d\n", i, -+ cmd_buf[1 + i]); -+ } else if (mode == RADBG_DEBUG_MONITOR4) -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s {%d.%d}\n", "RA version =", -+ cmd_buf[1], cmd_buf[2]); -+ else if (mode == RADBG_DEBUG_MONITOR5) { -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "Current rate =", -+ cmd_buf[1]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "Retry ratio =", -+ cmd_buf[2]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "rate down ratio =", -+ cmd_buf[3]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "highest rate =", -+ cmd_buf[4]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s {0x%x 0x%x}\n", "Muti-try =", -+ cmd_buf[5], cmd_buf[6]); -+ PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x%x%x%x%x\n", "RA mask =", -+ cmd_buf[11], cmd_buf[10], cmd_buf[9], cmd_buf[8], -+ cmd_buf[7]); -+ } -+ PHYDM_DBG(dm, DBG_FW_TRACE, "-------------------------------\n"); -+} -+ -+void phydm_ra_dynamic_retry_count(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ability & ODM_BB_DYNAMIC_ARFR)) -+ return; -+ -+ /*PHYDM_DBG(dm, DBG_RA, "dm->pre_b_noisy = %d\n", dm->pre_b_noisy );*/ -+ -+ if (dm->pre_b_noisy != dm->noisy_decision) { -+ if (dm->noisy_decision) { -+ PHYDM_DBG(dm, DBG_DYN_ARFR, "Noisy Env. RA fallback\n"); -+ odm_set_mac_reg(dm, R_0x430, MASKDWORD, 0x0); -+ odm_set_mac_reg(dm, R_0x434, MASKDWORD, 0x04030201); -+ } else { -+ PHYDM_DBG(dm, DBG_DYN_ARFR, "Clean Env. RA fallback\n"); -+ odm_set_mac_reg(dm, R_0x430, MASKDWORD, 0x01000000); -+ odm_set_mac_reg(dm, R_0x434, MASKDWORD, 0x06050402); -+ } -+ dm->pre_b_noisy = dm->noisy_decision; -+ } -+} -+ -+void phydm_print_rate(void *dm_void, u8 rate, u32 dbg_component) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ -+ boolean vht_en = phydm_is_vht_rate(dm, rate_idx); -+ u8 b_sgi = (rate & 0x80) >> 7; -+ u8 rate_ss = phydm_rate_to_num_ss(dm, rate_idx); -+ u8 rate_digit = phydm_rate_2_rate_digit(dm, rate_idx); -+ -+ PHYDM_DBG_F(dm, dbg_component, "( %s%s%s%s%s%d%s%s)\n", -+ (vht_en && (rate_ss == 1)) ? "VHT 1ss " : "", -+ (vht_en && (rate_ss == 2)) ? "VHT 2ss " : "", -+ (vht_en && (rate_ss == 3)) ? "VHT 3ss " : "", -+ (vht_en && (rate_ss == 4)) ? "VHT 4ss " : "", -+ (rate_idx >= ODM_RATEMCS0) ? "MCS " : "", -+ rate_digit, -+ (b_sgi) ? "-S" : " ", -+ (rate_idx >= ODM_RATEMCS0) ? "" : "M"); -+} -+ -+void phydm_print_rate_2_buff(void *dm_void, u8 rate, char *buf, u16 buf_size) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ -+ boolean vht_en = phydm_is_vht_rate(dm, rate_idx); -+ u8 b_sgi = (rate & 0x80) >> 7; -+ u8 rate_ss = phydm_rate_to_num_ss(dm, rate_idx); -+ u8 rate_digit = phydm_rate_2_rate_digit(dm, rate_idx); -+ -+ PHYDM_SNPRINTF(buf, buf_size, "( %s%s%s%s%s%d%s%s)", -+ (vht_en && (rate_ss == 1)) ? "VHT 1ss " : "", -+ (vht_en && (rate_ss == 2)) ? "VHT 2ss " : "", -+ (vht_en && (rate_ss == 3)) ? "VHT 3ss " : "", -+ (vht_en && (rate_ss == 4)) ? "VHT 4ss " : "", -+ (rate_idx >= ODM_RATEMCS0) ? "MCS " : "", -+ rate_digit, -+ (b_sgi) ? "-S" : " ", -+ (rate_idx >= ODM_RATEMCS0) ? "" : "M"); -+} -+ -+void phydm_c2h_ra_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ struct cmn_sta_info *sta = NULL; -+ u8 macid = cmd_buf[1]; -+ u8 rate = cmd_buf[0]; -+ u8 ra_ratio = 0xff; -+ u8 curr_bw = 0xff; -+ u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ -+ u8 rate_order; -+ u8 gid_index = 0; -+ u8 txcls_rate = 0; -+ char dbg_buf[PHYDM_SNPRINT_SIZE] = {0}; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ sta = dm->phydm_sta_info[dm->phydm_macid_table[macid]]; -+ #else -+ sta = dm->phydm_sta_info[macid]; -+ #endif -+ -+ if (cmd_len == 7) { -+ ra_ratio = cmd_buf[5]; -+ curr_bw = cmd_buf[6]; -+ PHYDM_DBG(dm, DBG_RA, "[%d] PER=%d\n", macid, ra_ratio); -+ } else if (cmd_len == 8) { -+ ra_ratio = cmd_buf[5]; -+ curr_bw = cmd_buf[6]; -+ txcls_rate = cmd_buf[7]; -+ PHYDM_DBG(dm, DBG_RA, "[%d] PER=%d TxCLS=%d\n", macid, ra_ratio, -+ txcls_rate); -+ } -+ -+ if (cmd_buf[3] != 0) { -+ if (cmd_buf[3] == 0xff) -+ PHYDM_DBG(dm, DBG_RA, "FW Fix Rate\n"); -+ else if (cmd_buf[3] == 1) -+ PHYDM_DBG(dm, DBG_RA, "Try Success\n"); -+ else if (cmd_buf[3] == 2) -+ PHYDM_DBG(dm, DBG_RA, "Try Fail & Again\n"); -+ else if (cmd_buf[3] == 3) -+ PHYDM_DBG(dm, DBG_RA, "Rate Back\n"); -+ else if (cmd_buf[3] == 4) -+ PHYDM_DBG(dm, DBG_RA, "Start rate by RSSI\n"); -+ else if (cmd_buf[3] == 5) -+ PHYDM_DBG(dm, DBG_RA, "Try rate\n"); -+ } -+ phydm_print_rate_2_buff(dm, rate, dbg_buf, PHYDM_SNPRINT_SIZE); -+ PHYDM_DBG(dm, DBG_RA, "Tx Rate=%s (%d)\n", dbg_buf, rate); -+ -+#ifdef MU_EX_MACID -+ if (macid >= 128 && macid < (128 + MU_EX_MACID)) { -+ gid_index = macid - 128; -+ ra_tab->mu1_rate[gid_index] = rate; -+ } -+ if (macid >= ODM_ASSOCIATE_ENTRY_NUM) -+ return; -+#endif -+ if (is_sta_active(sta)) { -+ sta->ra_info.curr_tx_rate = rate; -+ sta->ra_info.curr_tx_bw = (enum channel_width)curr_bw; -+ sta->ra_info.curr_retry_ratio = ra_ratio; -+ } -+ -+ /*trigger power training*/ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ -+ rate_order = phydm_rate_order_compute(dm, rate_idx); -+ -+ if (dm->is_one_entry_only || -+ (rate_order > ra_tab->highest_client_tx_order && -+ ra_tab->power_tracking_flag == 1)) { -+ halrf_update_pwr_track(dm, rate_idx); -+ ra_tab->power_tracking_flag = 0; -+ } -+ -+#endif -+ -+#if 0 -+ /*trigger dynamic rate ID*/ -+ if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) -+ phydm_update_rate_id(dm, rate, macid); -+#endif -+} -+ -+void odm_ra_post_action_on_assoc(void *dm_void) -+{ -+} -+ -+void phydm_modify_RA_PCR_threshold(void *dm_void, u8 ra_ofst_direc, -+ u8 ra_th_ofst) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ -+ ra_tab->ra_ofst_direc = ra_ofst_direc; -+ ra_tab->ra_th_ofst = ra_th_ofst; -+ PHYDM_DBG(dm, DBG_RA_MASK, "Set ra_th_offset=(( %s%d ))\n", -+ ((ra_ofst_direc) ? "+" : "-"), ra_th_ofst); -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+void phydm_gen_ramask_h2c_AP( -+ void *dm_void, -+ struct rtl8192cd_priv *priv, -+ struct sta_info *entry, -+ u8 rssi_level) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type == ODM_RTL8812) { -+ #if (RTL8812A_SUPPORT == 1) -+ UpdateHalRAMask8812(priv, entry, rssi_level); -+ #endif -+ } else if (dm->support_ic_type == ODM_RTL8188E) { -+ #if (RTL8188E_SUPPORT == 1) -+ #ifdef TXREPORT -+ add_RATid(priv, entry); -+ #endif -+ #endif -+ } else { -+ #ifdef CONFIG_WLAN_HAL -+ GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, entry, rssi_level); -+ #endif -+ } -+} -+ -+void phydm_update_hal_ra_mask( -+ void *dm_void, -+ u32 wireless_mode, -+ u8 rf_type, -+ u8 bw, -+ u8 mimo_ps_enable, -+ u8 disable_cck_rate, -+ u32 *ratr_bitmap_msb_in, -+ u32 *ratr_bitmap_lsb_in, -+ u8 tx_rate_level) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 ratr_bitmap = *ratr_bitmap_lsb_in; -+ u32 ratr_bitmap_msb = *ratr_bitmap_msb_in; -+ -+#if 0 -+ /*PHYDM_DBG(dm, DBG_RA_MASK, "phydm_rf_type = (( %x )), rf_type = (( %x ))\n", phydm_rf_type, rf_type);*/ -+#endif -+ PHYDM_DBG(dm, DBG_RA_MASK, -+ "Platfoem original RA Mask = (( 0x %x | %x ))\n", -+ ratr_bitmap_msb, ratr_bitmap); -+ -+ switch (wireless_mode) { -+ 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 (mimo_ps_enable) -+ rf_type = RF_1T1R; -+ -+ if (rf_type == RF_1T1R) { -+ if (bw == CHANNEL_WIDTH_40) -+ ratr_bitmap &= 0x000ff015; -+ else -+ ratr_bitmap &= 0x000ff005; -+ } else if (rf_type == RF_2T2R || rf_type == RF_2T4R || rf_type == RF_2T3R) { -+ if (bw == CHANNEL_WIDTH_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 (rf_type == RF_1T1R) { -+ ratr_bitmap &= 0x003ff015; -+ } else if (rf_type == RF_2T2R || rf_type == RF_2T4R || rf_type == RF_2T3R) { -+ ratr_bitmap &= 0xfffff015; -+ } else { /*@3T*/ -+ -+ ratr_bitmap &= 0xfffff010; -+ ratr_bitmap_msb &= 0x3ff; -+ } -+ -+ if (bw == CHANNEL_WIDTH_20) { /*@AC 20MHz not support MCS9*/ -+ ratr_bitmap &= 0x7fdfffff; -+ ratr_bitmap_msb &= 0x1ff; -+ } -+ } break; -+ -+ case PHYDM_WIRELESS_MODE_AC_5G: { -+ if (rf_type == RF_1T1R) { -+ ratr_bitmap &= 0x003ff010; -+ } else if (rf_type == RF_2T2R || rf_type == RF_2T4R || rf_type == RF_2T3R) { -+ ratr_bitmap &= 0xfffff010; -+ } else { /*@3T*/ -+ -+ ratr_bitmap &= 0xfffff010; -+ ratr_bitmap_msb &= 0x3ff; -+ } -+ -+ if (bw == CHANNEL_WIDTH_20) { /*@AC 20MHz not support MCS9*/ -+ ratr_bitmap &= 0x7fdfffff; -+ ratr_bitmap_msb &= 0x1ff; -+ } -+ } break; -+ -+ default: -+ break; -+ } -+ -+ if (wireless_mode != 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; -+ -+ PHYDM_DBG(dm, DBG_RA_MASK, -+ "wireless_mode= (( 0x%x )), rf_type = (( 0x%x )), BW = (( 0x%x )), MimoPs_en = (( %d )), tx_rate_level= (( 0x%x ))\n", -+ wireless_mode, rf_type, bw, mimo_ps_enable, tx_rate_level); -+ -+#if 0 -+ /*PHYDM_DBG(dm, DBG_RA_MASK, "111 Phydm modified RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap);*/ -+#endif -+ -+ *ratr_bitmap_lsb_in = ratr_bitmap; -+ *ratr_bitmap_msb_in = ratr_bitmap_msb; -+ PHYDM_DBG(dm, DBG_RA_MASK, -+ "Phydm modified RA Mask = (( 0x %x | %x ))\n", -+ *ratr_bitmap_msb_in, *ratr_bitmap_lsb_in); -+} -+ -+#endif -+ -+void phydm_rate_adaptive_mask_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_t = &dm->dm_ra_table; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER adapter = dm->adapter; -+ PMGNT_INFO mgnt_info = &(adapter->MgntInfo); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)dm->adapter)); -+ -+ if (mgnt_info->DM_Type == dm_type_by_driver) -+ hal_data->bUseRAMask = true; -+ else -+ hal_data->bUseRAMask = false; -+ -+#endif -+ -+ ra_t->ldpc_thres = 35; -+ ra_t->up_ramask_cnt = 0; -+ ra_t->up_ramask_cnt_tmp = 0; -+} -+ -+void phydm_refresh_rate_adaptive_mask(void *dm_void) -+{ -+/*@Will be removed*/ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ phydm_ra_mask_watchdog(dm); -+} -+ -+void phydm_show_sta_info(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = NULL; -+ struct ra_sta_info *ra = NULL; -+#ifdef CONFIG_BEAMFORMING -+ struct bf_cmn_info *bf = NULL; -+#endif -+ char help[] = "-h"; -+ u32 var[10] = {0}; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 i, sta_idx_start, sta_idx_end; -+ u8 tatal_sta_num = 0; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var[0]); -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "All STA: {1}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "STA[macid]: {2} {macid}\n"); -+ return; -+ } else if (var[0] == 1) { -+ sta_idx_start = 0; -+ sta_idx_end = ODM_ASSOCIATE_ENTRY_NUM; -+ } else if (var[0] == 2) { -+ sta_idx_start = var[1]; -+ sta_idx_end = var[1]; -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Warning input value!\n"); -+ return; -+ } -+ -+ for (i = sta_idx_start; i < sta_idx_end; i++) { -+ sta = dm->phydm_sta_info[i]; -+ -+ if (!is_sta_active(sta)) -+ continue; -+ -+ ra = &sta->ra_info; -+ #ifdef CONFIG_BEAMFORMING -+ bf = &sta->bf_info; -+ #endif -+ -+ tatal_sta_num++; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "==[sta_idx: %d][MACID: %d]============>\n", i, -+ sta->mac_id); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "AID:%d\n", sta->aid); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "ADDR:%x-%x-%x-%x-%x-%x\n", sta->mac_addr[5], -+ sta->mac_addr[4], sta->mac_addr[3], sta->mac_addr[2], -+ sta->mac_addr[1], sta->mac_addr[0]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "DM_ctrl:0x%x\n", sta->dm_ctrl); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "BW:%d, MIMO_Type:0x%x\n", sta->bw_mode, -+ sta->mimo_type); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "STBC_en:%d, LDPC_en=%d\n", sta->stbc_en, -+ sta->ldpc_en); -+ -+ /*@[RSSI Info]*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "RSSI{All, OFDM, CCK}={%d, %d, %d}\n", -+ sta->rssi_stat.rssi, sta->rssi_stat.rssi_ofdm, -+ sta->rssi_stat.rssi_cck); -+ -+ /*@[RA Info]*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Rate_ID:%d, RSSI_LV:%d, ra_bw:%d, SGI_en:%d\n", -+ ra->rate_id, ra->rssi_level, ra->ra_bw_mode, -+ ra->is_support_sgi); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "VHT_en:%d, Wireless_set=0x%x, sm_ps=%d\n", -+ ra->is_vht_enable, sta->support_wireless_set, -+ sta->sm_ps); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Dis{RA, PT}={%d, %d}, TxRx:%d, Noisy:%d\n", -+ ra->disable_ra, ra->disable_pt, ra->txrx_state, -+ ra->is_noisy); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "TX{Rate, BW}={0x%x, %d}, RTY:%d\n", ra->curr_tx_rate, -+ ra->curr_tx_bw, ra->curr_retry_ratio); -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "RA_Mask:0x%llx\n", ra->ramask); -+ -+ /*@[TP]*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "TP{TX,RX}={%d, %d}\n", sta->tx_moving_average_tp, -+ sta->rx_moving_average_tp); -+ -+#ifdef CONFIG_BEAMFORMING -+ /*@[Beamforming]*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "BF CAP{HT,VHT}={0x%x, 0x%x}\n", bf->ht_beamform_cap, -+ bf->vht_beamform_cap); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "BF {p_aid,g_id}={0x%x, 0x%x}\n\n", bf->p_aid, -+ bf->g_id); -+#endif -+ } -+ -+ if (tatal_sta_num == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "No Linked STA\n"); -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+u8 phydm_get_rx_stream_num(void *dm_void, enum rf_type type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rx_num = 1; -+ -+ if (type == RF_1T1R) -+ rx_num = 1; -+ else if (type == RF_2T2R || type == RF_1T2R) -+ rx_num = 2; -+ else if (type == RF_3T3R || type == RF_2T3R) -+ rx_num = 3; -+ else if (type == RF_4T4R || type == RF_3T4R || type == RF_2T4R) -+ rx_num = 4; -+ else -+ pr_debug("[Warrning] %s\n", __func__); -+ -+ return rx_num; -+} -+ -+u8 phydm_get_tx_stream_num(void *dm_void, enum rf_type type) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 tx_num = 1; -+ -+ if (type == RF_1T1R || type == RF_1T2R) -+ tx_num = 1; -+ else if (type == RF_2T2R || type == RF_2T3R || type == RF_2T4R) -+ tx_num = 2; -+ else if (type == RF_3T3R || type == RF_3T4R) -+ tx_num = 3; -+ else if (type == RF_4T4R) -+ tx_num = 4; -+ else -+ PHYDM_DBG(dm, DBG_RA, "[Warrning] no mimo_type is found\n"); -+ -+ return tx_num; -+} -+ -+u64 phydm_get_bb_mod_ra_mask(void *dm_void, u8 sta_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_iot_center *iot_table = &dm->iot_table; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; -+ struct ra_sta_info *ra = NULL; -+ enum channel_width bw = 0; -+ enum wireless_set wrls_mode = 0; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ struct rtl8192cd_priv *priv = dm->priv; -+#endif -+ u8 tx_stream_num = 1; -+ u8 rssi_lv = 0; -+ u64 ra_mask_bitmap = 0; -+ -+ if (is_sta_active(sta)) { -+ ra = &sta->ra_info; -+ bw = ra->ra_bw_mode; -+ wrls_mode = sta->support_wireless_set; -+ tx_stream_num = phydm_get_tx_stream_num(dm, sta->mimo_type); -+ rssi_lv = ra->rssi_level; -+ ra_mask_bitmap = ra->ramask; -+ } else { -+ PHYDM_DBG(dm, DBG_RA, "[Warning] %s invalid STA\n", __func__); -+ return 0; -+ } -+ -+ PHYDM_DBG(dm, DBG_RA, "macid=%d ori_RA_Mask= 0x%llx\n", sta->mac_id, -+ ra_mask_bitmap); -+ PHYDM_DBG(dm, DBG_RA, -+ "wireless_mode=0x%x, tx_ss=%d, BW=%d, MimoPs=%d, rssi_lv=%d\n", -+ wrls_mode, tx_stream_num, bw, sta->sm_ps, rssi_lv); -+ -+ if (sta->sm_ps == SM_PS_STATIC) /*@mimo_ps_enable*/ -+ tx_stream_num = 1; -+ -+ /*@[Modify RA Mask by Wireless Mode]*/ -+ -+ if (wrls_mode == WIRELESS_CCK) { /*@B mode*/ -+ ra_mask_bitmap &= 0x0000000f; -+ } else if (wrls_mode == WIRELESS_OFDM) { /*@G mode*/ -+ ra_mask_bitmap &= 0x00000ff0; -+ } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM)) { /*@BG mode*/ -+ ra_mask_bitmap &= 0x00000ff5; -+ } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_HT)) { -+ /*N_2G*/ -+ if (tx_stream_num == 1) { -+ if (bw == CHANNEL_WIDTH_40) -+ ra_mask_bitmap &= 0x000ff015; -+ else -+ ra_mask_bitmap &= 0x000ff005; -+ } else if (tx_stream_num == 2) { -+ if (bw == CHANNEL_WIDTH_40) -+ ra_mask_bitmap &= 0x0ffff015; -+ else -+ ra_mask_bitmap &= 0x0ffff005; -+ } else if (tx_stream_num == 3) { -+ ra_mask_bitmap &= 0xffffff015; -+ } else { -+ ra_mask_bitmap &= 0xffffffff015; -+ } -+ } else if (wrls_mode == (WIRELESS_OFDM | WIRELESS_HT)) { /*N_5G*/ -+ -+ if (tx_stream_num == 1) { -+ if (bw == CHANNEL_WIDTH_40) -+ ra_mask_bitmap &= 0x000ff030; -+ else -+ ra_mask_bitmap &= 0x000ff010; -+ } else if (tx_stream_num == 2) { -+ if (bw == CHANNEL_WIDTH_40) -+ ra_mask_bitmap &= 0x0ffff030; -+ else -+ ra_mask_bitmap &= 0x0ffff010; -+ } else if (tx_stream_num == 3) { -+ ra_mask_bitmap &= 0xffffff010; -+ } else { -+ ra_mask_bitmap &= 0xffffffff010; -+ } -+ } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_VHT)) { -+ /*@AC_2G*/ -+ if (tx_stream_num == 1) -+ ra_mask_bitmap &= 0x003ff015; -+ else if (tx_stream_num == 2) -+ ra_mask_bitmap &= 0xfffff015; -+ else if (tx_stream_num == 3) -+ ra_mask_bitmap &= 0x3fffffff015; -+ else /*@AC_4SS 2G*/ -+ ra_mask_bitmap &= 0x000ffffffffff015; -+ if (bw == CHANNEL_WIDTH_20) { -+ /* @AC 20MHz doesn't support MCS9 except 3SS & 6SS*/ -+ ra_mask_bitmap &= 0x0007ffff7fdff015; -+ } else if (bw == CHANNEL_WIDTH_80) { -+ /* @AC 80MHz doesn't support 3SS MCS6*/ -+ ra_mask_bitmap &= 0x000fffbffffff015; -+ } -+ } else if (wrls_mode == (WIRELESS_OFDM | WIRELESS_VHT)) { /*@AC_5G*/ -+ -+ if (tx_stream_num == 1) -+ ra_mask_bitmap &= 0x003ff010; -+ else if (tx_stream_num == 2) -+ ra_mask_bitmap &= 0xfffff010; -+ else if (tx_stream_num == 3) -+ ra_mask_bitmap &= 0x3fffffff010; -+ else /*@AC_4SS 5G*/ -+ ra_mask_bitmap &= 0x000ffffffffff010; -+ -+ if (bw == CHANNEL_WIDTH_20) { -+ /* @AC 20MHz doesn't support MCS9 except 3SS & 6SS*/ -+ ra_mask_bitmap &= 0x0007ffff7fdff010; -+ } else if (bw == CHANNEL_WIDTH_80) { -+ /* @AC 80MHz doesn't support 3SS MCS6*/ -+ ra_mask_bitmap &= 0x000fffbffffff010; -+ } else if (bw == CHANNEL_WIDTH_160) { -+ /* @AC 80M+80M doesn't support 3SS & 4SS*/ -+ ra_mask_bitmap &= 0xfffff010; -+ } -+ } else { -+ PHYDM_DBG(dm, DBG_RA, "[Warrning] RA mask is Not found\n"); -+ } -+ -+ PHYDM_DBG(dm, DBG_RA, "Mod by mode=0x%llx\n", ra_mask_bitmap); -+ -+#if ((DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) -+ if (priv->pshare->veriwave_sta_num > 0) { -+ PHYDM_DBG(dm, DBG_RA, "Mod by RSSI=0x%llx\n", ra_mask_bitmap); -+ return ra_mask_bitmap; -+ } -+#endif -+ /*@[Modify RA Mask by RSSI level]*/ -+ if (wrls_mode != WIRELESS_CCK) { -+ if (iot_table->patch_id_40010700) { -+ ra_mask_bitmap &= (rssi_lv == 0 ? -+ 0xffffffffffffffff : -+ 0xfffffffffffffff0); -+ return ra_mask_bitmap; -+ } -+ -+ if (rssi_lv == 0) -+ ra_mask_bitmap &= 0xffffffffffffffff; -+ else if (rssi_lv == 1) -+ ra_mask_bitmap &= 0xfffffffffffffff0; -+ else if (rssi_lv == 2) -+ ra_mask_bitmap &= 0xffffffffffffefe0; -+ else if (rssi_lv == 3) -+ ra_mask_bitmap &= 0xffffffffffffcfc0; -+ else if (rssi_lv == 4) -+ ra_mask_bitmap &= 0xffffffffffff8f80; -+ else if (rssi_lv >= 5) -+ ra_mask_bitmap &= 0xffffffffffff0f00; -+ } -+ PHYDM_DBG(dm, DBG_RA, "Mod by RSSI=0x%llx\n", ra_mask_bitmap); -+ -+ return ra_mask_bitmap; -+} -+ -+u8 phydm_get_rate_from_rssi_lv(void *dm_void, u8 sta_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; -+ struct ra_sta_info *ra = NULL; -+ enum wireless_set wrls_set = 0; -+ u8 rssi_lv = 0; -+ u8 rate_idx = 0; -+ u8 rate_ofst = 0; -+ -+ if (is_sta_active(sta)) { -+ ra = &sta->ra_info; -+ wrls_set = sta->support_wireless_set; -+ rssi_lv = ra->rssi_level; -+ } else { -+ pr_debug("[Warning] %s: invalid STA\n", __func__); -+ return 0; -+ } -+ -+ PHYDM_DBG(dm, DBG_RA, "[%s]macid=%d, wireless_set=0x%x, rssi_lv=%d\n", -+ __func__, sta->mac_id, wrls_set, rssi_lv); -+ -+ rate_ofst = (rssi_lv <= 1) ? 0 : (rssi_lv - 1); -+ -+ if (wrls_set & WIRELESS_VHT) { -+ rate_idx = ODM_RATEVHTSS1MCS0 + rate_ofst; -+ } else if (wrls_set & WIRELESS_HT) { -+ rate_idx = ODM_RATEMCS0 + rate_ofst; -+ } else if (wrls_set & WIRELESS_OFDM) { -+ rate_idx = ODM_RATE6M + rate_ofst; -+ } else { -+ rate_idx = ODM_RATE1M + rate_ofst; -+ -+ if (rate_idx > ODM_RATE11M) -+ rate_idx = ODM_RATE11M; -+ } -+ return rate_idx; -+} -+ -+u8 phydm_get_rate_id(void *dm_void, u8 sta_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; -+ struct ra_sta_info *ra = NULL; -+ enum channel_width bw = 0; -+ enum wireless_set wrls_mode = 0; -+ u8 tx_stream_num = 1; -+ u8 rate_id_idx = PHYDM_BGN_20M_1SS; -+ -+ if (is_sta_active(sta)) { -+ ra = &sta->ra_info; -+ bw = ra->ra_bw_mode; -+ wrls_mode = sta->support_wireless_set; -+ tx_stream_num = phydm_get_tx_stream_num(dm, sta->mimo_type); -+ -+ } else { -+ PHYDM_DBG(dm, DBG_RA, "[Warning] %s: invalid STA\n", __func__); -+ return 0; -+ } -+ -+ PHYDM_DBG(dm, DBG_RA, "macid=%d,wireless_set=0x%x,tx_SS_num=%d,BW=%d\n", -+ sta->mac_id, wrls_mode, tx_stream_num, bw); -+ -+ if (wrls_mode == WIRELESS_CCK) { -+ /*@B mode*/ -+ rate_id_idx = PHYDM_B_20M; -+ } else if (wrls_mode == WIRELESS_OFDM) { -+ /*@G mode*/ -+ rate_id_idx = PHYDM_G; -+ } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM)) { -+ /*@BG mode*/ -+ rate_id_idx = PHYDM_BG; -+ } else if (wrls_mode == (WIRELESS_OFDM | WIRELESS_HT)) { -+ /*@GN mode*/ -+ if (tx_stream_num == 1) -+ rate_id_idx = PHYDM_GN_N1SS; -+ else if (tx_stream_num == 2) -+ rate_id_idx = PHYDM_GN_N2SS; -+ else if (tx_stream_num == 3) -+ rate_id_idx = PHYDM_ARFR5_N_3SS; -+ else if (tx_stream_num == 4) -+ rate_id_idx = PHYDM_ARFR7_N_4SS; -+ } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_HT)) { -+ /*@BGN mode*/ -+ if (bw == CHANNEL_WIDTH_40) { -+ if (tx_stream_num == 1) -+ rate_id_idx = PHYDM_BGN_40M_1SS; -+ else if (tx_stream_num == 2) -+ rate_id_idx = PHYDM_BGN_40M_2SS; -+ else if (tx_stream_num == 3) -+ rate_id_idx = PHYDM_ARFR5_N_3SS; -+ else if (tx_stream_num == 4) -+ rate_id_idx = PHYDM_ARFR7_N_4SS; -+ -+ } else { -+ if (tx_stream_num == 1) -+ rate_id_idx = PHYDM_BGN_20M_1SS; -+ else if (tx_stream_num == 2) -+ rate_id_idx = PHYDM_BGN_20M_2SS; -+ else if (tx_stream_num == 3) -+ rate_id_idx = PHYDM_ARFR5_N_3SS; -+ else if (tx_stream_num == 4) -+ rate_id_idx = PHYDM_ARFR7_N_4SS; -+ } -+ } else if (wrls_mode == (WIRELESS_OFDM | WIRELESS_VHT)) { -+ /*@AC mode*/ -+ if (bw == CHANNEL_WIDTH_160) { -+ if (tx_stream_num == 1) -+ rate_id_idx = PHYDM_ARFR1_AC_1SS; -+ else if (tx_stream_num == 2) -+ rate_id_idx = PHYDM_ARFR0_AC_2SS; -+ else if (tx_stream_num == 3) -+ rate_id_idx = PHYDM_ARFR0_AC_2SS; -+ else if (tx_stream_num == 4) -+ rate_id_idx = PHYDM_ARFR0_AC_2SS; -+ } else { -+ if (tx_stream_num == 1) -+ rate_id_idx = PHYDM_ARFR1_AC_1SS; -+ else if (tx_stream_num == 2) -+ rate_id_idx = PHYDM_ARFR0_AC_2SS; -+ else if (tx_stream_num == 3) -+ rate_id_idx = PHYDM_ARFR4_AC_3SS; -+ else if (tx_stream_num == 4) -+ rate_id_idx = PHYDM_ARFR6_AC_4SS; -+ } -+ } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_VHT)) { -+ /*@AC 2.4G mode*/ -+ if (bw >= CHANNEL_WIDTH_80) { -+ if (tx_stream_num == 1) -+ rate_id_idx = PHYDM_ARFR1_AC_1SS; -+ else if (tx_stream_num == 2) -+ rate_id_idx = PHYDM_ARFR0_AC_2SS; -+ else if (tx_stream_num == 3) -+ rate_id_idx = PHYDM_ARFR4_AC_3SS; -+ else if (tx_stream_num == 4) -+ rate_id_idx = PHYDM_ARFR6_AC_4SS; -+ } else { -+ if (tx_stream_num == 1) { -+ if (dm->support_ic_type & PHYDM_IC_RATEID_IDX_TYPE2) -+ rate_id_idx = PHYDM_TYPE2_ARFR5_AC_2G_1SS; -+ else -+ rate_id_idx = PHYDM_ARFR2_AC_2G_1SS; -+ } else if (tx_stream_num == 2) { -+ if (dm->support_ic_type & PHYDM_IC_RATEID_IDX_TYPE2) -+ rate_id_idx = PHYDM_TYPE2_ARFR3_AC_2G_2SS; -+ else -+ rate_id_idx = PHYDM_ARFR3_AC_2G_2SS; -+ } else if (tx_stream_num == 3) { -+ rate_id_idx = PHYDM_ARFR4_AC_3SS; -+ } else if (tx_stream_num == 4) { -+ rate_id_idx = PHYDM_ARFR6_AC_4SS; -+ } -+ } -+ } else { -+ PHYDM_DBG(dm, DBG_RA, "[Warrning] No rate_id is found\n"); -+ rate_id_idx = 0; -+ } -+ -+ PHYDM_DBG(dm, DBG_RA, "Rate_ID=((0x%x))\n", rate_id_idx); -+ -+ return rate_id_idx; -+} -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+void phydm_ra_mode_selection(void *dm_void, u8 mode) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ u8 pre_mode = ra_tab->ra_trigger_mode; /* 0:pkt RA, 1:TBTT RA */ -+ -+ if (mode >= 2) { -+ PHYDM_DBG(dm, DBG_RA, "RA mode selection Fail\n"); -+ } else { -+ ra_tab->ra_trigger_mode = mode; -+ PHYDM_DBG(dm, DBG_RA, "RA mode, 0:pkt RA, 1:TBTT RA\n"); -+ PHYDM_DBG(dm, DBG_RA, "PreMode=%d,CurMode=%d\n", pre_mode, -+ mode); -+ } -+} -+#endif -+ -+void phydm_ra_h2c(void *dm_void, u8 sta_idx, u8 dis_ra, u8 dis_pt, -+ u8 no_update_bw, u8 init_ra_lv, u64 ra_mask) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; -+ struct ra_sta_info *ra = NULL; -+ u8 h2c_val[H2C_MAX_LENGTH] = {0}; -+ u8 rate_id_idx = 0; -+ -+ if (is_sta_active(sta)) { -+ ra = &sta->ra_info; -+ } else { -+ PHYDM_DBG(dm, DBG_RA, "[Warning] %s invalid sta_info\n", -+ __func__); -+ return; -+ } -+ -+ PHYDM_DBG(dm, DBG_RA, "%s ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_RA, "MACID=%d\n", sta->mac_id); -+ -+ -+#ifdef PHYDM_POWER_TRAINING_SUPPORT -+ if ((dm->support_ability & ODM_BB_PWR_TRAIN) && !dm->is_disable_power_training) -+ dis_pt = false; -+ else -+ dis_pt = true; -+ -+#else -+ dis_pt= true; -+#endif -+ -+ rate_id_idx = ra->rate_id; -+ -+ /*for compatibility issues with FW RA [PHYDM-405]*/ -+ if (dm->support_ic_type & PHYDM_IC_RATEID_IDX_TYPE2) { -+ if (rate_id_idx == PHYDM_TYPE2_ARFR5_AC_2G_1SS) -+ rate_id_idx = PHYDM_ARFR2_AC_2G_1SS; -+ else if (rate_id_idx == PHYDM_TYPE2_ARFR3_AC_2G_2SS) -+ rate_id_idx = PHYDM_ARFR3_AC_2G_2SS; -+ } -+ -+ h2c_val[0] = sta->mac_id; -+ h2c_val[1] = (rate_id_idx & 0x1f) | ((init_ra_lv & 0x3) << 5) | -+ (ra->is_support_sgi << 7); -+ h2c_val[2] = (u8)((ra->ra_bw_mode) | (((sta->ldpc_en) ? 1 : 0) << 2) | -+ ((no_update_bw & 0x1) << 3) | -+ (ra->is_vht_enable << 4) | -+ ((dis_pt & 0x1) << 6) | ((dis_ra & 0x1) << 7)); -+ -+ h2c_val[3] = (u8)(ra_mask & 0xff); -+ h2c_val[4] = (u8)((ra_mask & 0xff00) >> 8); -+ h2c_val[5] = (u8)((ra_mask & 0xff0000) >> 16); -+ h2c_val[6] = (u8)((ra_mask & 0xff000000) >> 24); -+ -+ PHYDM_DBG(dm, DBG_RA, "PHYDM h2c[0x40]=0x%x %x %x %x %x %x %x\n", -+ h2c_val[6], h2c_val[5], h2c_val[4], h2c_val[3], h2c_val[2], -+ h2c_val[1], h2c_val[0]); -+ -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_RA_MASK, H2C_MAX_LENGTH, h2c_val); -+ -+ #if (defined(PHYDM_COMPILE_ABOVE_3SS)) -+ if (dm->support_ic_type & (PHYDM_IC_ABOVE_3SS)) { -+ h2c_val[3] = (u8)((ra_mask >> 32) & 0x000000ff); -+ h2c_val[4] = (u8)(((ra_mask >> 32) & 0x0000ff00) >> 8); -+ h2c_val[5] = (u8)(((ra_mask >> 32) & 0x00ff0000) >> 16); -+ h2c_val[6] = (u8)(((ra_mask >> 32) & 0xff000000) >> 24); -+ -+ PHYDM_DBG(dm, DBG_RA, "h2c[0x46]=0x%x %x %x %x %x %x %x\n", -+ h2c_val[6], h2c_val[5], h2c_val[4], h2c_val[3], -+ h2c_val[2], h2c_val[1], h2c_val[0]); -+ -+ odm_fill_h2c_cmd(dm, PHYDM_RA_MASK_ABOVE_3SS, -+ H2C_MAX_LENGTH, h2c_val); -+ } -+ #endif -+} -+ -+void phydm_ra_registed(void *dm_void, u8 sta_idx, -+ /*@index of sta_info array, not MACID*/ -+ u8 rssi_from_assoc) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_t = &dm->dm_ra_table; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; -+ struct ra_sta_info *ra = NULL; -+ u8 init_ra_lv = 0; -+ u64 ra_mask = 0; -+ /*@SD7 STA_idx != macid*/ -+ /*@SD4,8 STA_idx == macid, */ -+ -+ PHYDM_DBG(dm, DBG_RA_MASK, "%s ======>\n", __func__); -+ -+ if (is_sta_active(sta)) { -+ ra = &sta->ra_info; -+ PHYDM_DBG(dm, DBG_RA_MASK, "sta_idx=%d, macid=%d\n", sta_idx, -+ sta->mac_id); -+ } else { -+ PHYDM_DBG(dm, DBG_RA_MASK, "[Warning] %s invalid STA\n", -+ __func__); -+ PHYDM_DBG(dm, DBG_RA_MASK, "sta_idx=%d\n", sta_idx); -+ return; -+ } -+ -+ #if (RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188E) -+ ra->rate_id = phydm_get_rate_id_88e(dm, sta_idx); -+ else -+ #endif -+ { -+ ra->rate_id = phydm_get_rate_id(dm, sta_idx); -+ } -+ -+ ra_mask = phydm_get_bb_mod_ra_mask(dm, sta_idx); -+ -+ PHYDM_DBG(dm, DBG_RA_MASK, "rssi_assoc=%d\n", rssi_from_assoc); -+ -+ if (rssi_from_assoc > 40) -+ init_ra_lv = 1; -+ else if (rssi_from_assoc > 20) -+ init_ra_lv = 2; -+ else if (rssi_from_assoc > 1) -+ init_ra_lv = 3; -+ else -+ init_ra_lv = 0; -+ -+ if (ra_t->record_ra_info) -+ ra_t->record_ra_info(dm, sta_idx, sta, ra_mask); -+ -+ #if (RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8188E) -+ /*@Driver RA*/ -+ phydm_ra_update_8188e(dm, sta_idx, ra->rate_id, -+ (u32)ra_mask, ra->is_support_sgi); -+ else -+ #endif -+ { -+ /*@FW RA*/ -+ phydm_ra_h2c(dm, sta_idx, ra->disable_ra, ra->disable_pt, 0, -+ init_ra_lv, ra_mask); -+ } -+} -+ -+void phydm_ra_offline(void *dm_void, u8 sta_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_t = &dm->dm_ra_table; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; -+ struct ra_sta_info *ra = NULL; -+ -+ if (is_sta_active(sta)) { -+ ra = &sta->ra_info; -+ } else { -+ PHYDM_DBG(dm, DBG_RA, "[Warning] %s invalid STA\n", __func__); -+ return; -+ } -+ -+ PHYDM_DBG(dm, DBG_RA, "%s ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_RA, "MACID=%d\n", sta->mac_id); -+ -+ odm_memory_set(dm, &ra->rate_id, 0, sizeof(struct ra_sta_info)); -+ ra->disable_ra = 1; -+ ra->disable_pt = 1; -+ -+ if (ra_t->record_ra_info) -+ ra_t->record_ra_info(dm, sta->mac_id, sta, 0); -+ -+ if (dm->support_ic_type != ODM_RTL8188E) -+ phydm_ra_h2c(dm, sta->mac_id, 1, 1, 0, 0, 0); -+} -+ -+void phydm_ra_mask_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_t = &dm->dm_ra_table; -+ struct cmn_sta_info *sta = NULL; -+ struct ra_sta_info *ra = NULL; -+ boolean force_ra_mask_en = false; -+ u8 sta_idx; -+ u64 ra_mask; -+ u8 rssi_lv_new; -+ u8 rssi = 0; -+ -+ if (!(dm->support_ability & ODM_BB_RA_MASK)) -+ return; -+ -+ if (!dm->is_linked || (dm->phydm_sys_up_time % 2) == 1) -+ return; -+ -+ PHYDM_DBG(dm, DBG_RA_MASK, "%s ======>\n", __func__); -+ -+ ra_t->up_ramask_cnt++; -+ -+ if (ra_t->up_ramask_cnt >= FORCED_UPDATE_RAMASK_PERIOD) { -+ ra_t->up_ramask_cnt = 0; -+ force_ra_mask_en = true; -+ } -+ -+ for (sta_idx = 0; sta_idx < ODM_ASSOCIATE_ENTRY_NUM; sta_idx++) { -+ sta = dm->phydm_sta_info[sta_idx]; -+ -+ if (!is_sta_active(sta)) -+ continue; -+ -+ ra = &sta->ra_info; -+ -+ if (ra->disable_ra) -+ continue; -+ -+ PHYDM_DBG(dm, DBG_RA_MASK, "sta_idx=%d, macid=%d\n", sta_idx, -+ sta->mac_id); -+ -+ rssi = (u8)(sta->rssi_stat.rssi); -+ -+ /*@to be modified*/ -+ #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+ if (dm->support_ic_type == ODM_RTL8812 || -+ (dm->support_ic_type == ODM_RTL8821 && -+ dm->cut_version == ODM_CUT_A) -+ ) { -+ if (rssi < ra_t->ldpc_thres) { -+ /*@LDPC TX enable*/ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ set_ra_ldpc_8812(sta, true); -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ MgntSet_TX_LDPC(dm->adapter, sta->mac_id, true); -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ /*to be added*/ -+ #endif -+ PHYDM_DBG(dm, DBG_RA_MASK, -+ "RSSI=%d, ldpc_en =TRUE\n", rssi); -+ -+ } else if (rssi > (ra_t->ldpc_thres + 3)) { -+ /*@LDPC TX disable*/ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ set_ra_ldpc_8812(sta, false); -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ MgntSet_TX_LDPC(dm->adapter, sta->mac_id, false); -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ /*to be added*/ -+ #endif -+ PHYDM_DBG(dm, DBG_RA_MASK, -+ "RSSI=%d, ldpc_en =FALSE\n", rssi); -+ } -+ } -+ #endif -+ -+ rssi_lv_new = phydm_rssi_lv_dec(dm, (u32)rssi, ra->rssi_level); -+ -+ if (ra->rssi_level != rssi_lv_new || -+ (force_ra_mask_en && dm->number_linked_client < 10)) { -+ PHYDM_DBG(dm, DBG_RA_MASK, "RSSI LV:((%d))->((%d))\n", -+ ra->rssi_level, rssi_lv_new); -+ -+ ra->rssi_level = rssi_lv_new; -+ -+ ra_mask = phydm_get_bb_mod_ra_mask(dm, sta_idx); -+ -+ if (ra_t->record_ra_info) -+ ra_t->record_ra_info(dm, sta_idx, sta, ra_mask); -+ -+ #if (RTL8188E_SUPPORT) && (RATE_ADAPTIVE_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8188E) -+ /*@Driver RA*/ -+ phydm_ra_update_8188e(dm, sta_idx, ra->rate_id, -+ (u32)ra_mask, -+ ra->is_support_sgi); -+ else -+ #endif -+ { -+ /*@FW RA*/ -+ phydm_ra_h2c(dm, sta_idx, ra->disable_ra, -+ ra->disable_pt, 1, 0, ra_mask); -+ } -+ } -+ } -+} -+ -+u8 phydm_vht_en_mapping(void *dm_void, u32 wireless_mode) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 vht_en_out = 0; -+ -+ if (wireless_mode == PHYDM_WIRELESS_MODE_AC_5G || -+ wireless_mode == PHYDM_WIRELESS_MODE_AC_24G || -+ wireless_mode == PHYDM_WIRELESS_MODE_AC_ONLY) -+ vht_en_out = 1; -+ -+ PHYDM_DBG(dm, DBG_RA, "wireless_mode= (( 0x%x )), VHT_EN= (( %d ))\n", -+ wireless_mode, vht_en_out); -+ return vht_en_out; -+} -+ -+u8 phydm_rftype2rateid_2g_n20(void *dm_void, u8 rf_type) -+{ -+ u8 rate_id_idx = 0; -+ -+ if (rf_type == RF_1T1R) -+ rate_id_idx = PHYDM_BGN_20M_1SS; -+ else if (rf_type == RF_2T2R) -+ rate_id_idx = PHYDM_BGN_20M_2SS; -+ else if (rf_type == RF_3T3R) -+ rate_id_idx = PHYDM_ARFR5_N_3SS; -+ else -+ rate_id_idx = PHYDM_ARFR7_N_4SS; -+ return rate_id_idx; -+} -+ -+u8 phydm_rftype2rateid_2g_n40(void *dm_void, u8 rf_type) -+{ -+ u8 rate_id_idx = 0; -+ -+ if (rf_type == RF_1T1R) -+ rate_id_idx = PHYDM_BGN_40M_1SS; -+ else if (rf_type == RF_2T2R) -+ rate_id_idx = PHYDM_BGN_40M_2SS; -+ else if (rf_type == RF_3T3R) -+ rate_id_idx = PHYDM_ARFR5_N_3SS; -+ else -+ rate_id_idx = PHYDM_ARFR7_N_4SS; -+ return rate_id_idx; -+} -+ -+u8 phydm_rftype2rateid_5g_n(void *dm_void, u8 rf_type) -+{ -+ u8 rate_id_idx = 0; -+ -+ if (rf_type == RF_1T1R) -+ rate_id_idx = PHYDM_GN_N1SS; -+ else if (rf_type == RF_2T2R) -+ rate_id_idx = PHYDM_GN_N2SS; -+ else if (rf_type == RF_3T3R) -+ rate_id_idx = PHYDM_ARFR5_N_3SS; -+ else -+ rate_id_idx = PHYDM_ARFR7_N_4SS; -+ return rate_id_idx; -+} -+ -+u8 phydm_rftype2rateid_ac80(void *dm_void, u8 rf_type) -+{ -+ u8 rate_id_idx = 0; -+ -+ if (rf_type == RF_1T1R) -+ rate_id_idx = PHYDM_ARFR1_AC_1SS; -+ else if (rf_type == RF_2T2R) -+ rate_id_idx = PHYDM_ARFR0_AC_2SS; -+ else if (rf_type == RF_3T3R) -+ rate_id_idx = PHYDM_ARFR4_AC_3SS; -+ else -+ rate_id_idx = PHYDM_ARFR6_AC_4SS; -+ return rate_id_idx; -+} -+ -+u8 phydm_rftype2rateid_ac40(void *dm_void, u8 rf_type) -+{ -+ u8 rate_id_idx = 0; -+ -+ if (rf_type == RF_1T1R) -+ rate_id_idx = PHYDM_ARFR2_AC_2G_1SS; -+ else if (rf_type == RF_2T2R) -+ rate_id_idx = PHYDM_ARFR3_AC_2G_2SS; -+ else if (rf_type == RF_3T3R) -+ rate_id_idx = PHYDM_ARFR4_AC_3SS; -+ else -+ rate_id_idx = PHYDM_ARFR6_AC_4SS; -+ return rate_id_idx; -+} -+ -+u8 phydm_rate_id_mapping(void *dm_void, u32 wireless_mode, u8 rf_type, u8 bw) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rate_id_idx = 0; -+ -+ PHYDM_DBG(dm, DBG_RA, -+ "wireless_mode= (( 0x%x )), rf_type = (( 0x%x )), BW = (( 0x%x ))\n", -+ wireless_mode, rf_type, bw); -+ -+ switch (wireless_mode) { -+ case PHYDM_WIRELESS_MODE_N_24G: -+ if (bw == CHANNEL_WIDTH_40) -+ rate_id_idx = phydm_rftype2rateid_2g_n40(dm, rf_type); -+ else -+ rate_id_idx = phydm_rftype2rateid_2g_n20(dm, rf_type); -+ break; -+ -+ case PHYDM_WIRELESS_MODE_N_5G: -+ rate_id_idx = phydm_rftype2rateid_5g_n(dm, rf_type); -+ 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: -+ rate_id_idx = phydm_rftype2rateid_ac80(dm, rf_type); -+ break; -+ -+ case PHYDM_WIRELESS_MODE_AC_24G: -+/*@Becareful to set "Lowest rate" while using PHYDM_ARFR4_AC_3SS in 2.4G/5G*/ -+ if (bw >= CHANNEL_WIDTH_80) -+ rate_id_idx = phydm_rftype2rateid_ac80(dm, rf_type); -+ else -+ rate_id_idx = phydm_rftype2rateid_ac40(dm, rf_type); -+ break; -+ -+ default: -+ rate_id_idx = 0; -+ break; -+ } -+ -+ PHYDM_DBG(dm, DBG_RA, "RA rate ID = (( 0x%x ))\n", rate_id_idx); -+ -+ return rate_id_idx; -+} -+ -+u8 phydm_rssi_lv_dec(void *dm_void, u32 rssi, u8 ratr_state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ /*@MCS0 ~ MCS4 , VHT1SS MCS0 ~ MCS4 , G 6M~24M*/ -+ u8 rssi_lv_t[RA_FLOOR_TABLE_SIZE] = {20, 34, 38, 42, 46, 50, 100}; -+ u8 new_rssi_lv = 0; -+ u8 i; -+ -+ PHYDM_DBG(dm, DBG_RA_MASK, -+ "curr RA level=(%d), Table_ori=[%d, %d, %d, %d, %d, %d]\n", -+ ratr_state, rssi_lv_t[0], rssi_lv_t[1], rssi_lv_t[2], -+ rssi_lv_t[3], rssi_lv_t[4], rssi_lv_t[5]); -+ -+ for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { -+ if (i >= (ratr_state)) -+ rssi_lv_t[i] += RA_FLOOR_UP_GAP; -+ } -+ -+ PHYDM_DBG(dm, DBG_RA_MASK, -+ "RSSI=(%d), Table_mod=[%d, %d, %d, %d, %d, %d]\n", rssi, -+ rssi_lv_t[0], rssi_lv_t[1], rssi_lv_t[2], rssi_lv_t[3], -+ rssi_lv_t[4], rssi_lv_t[5]); -+ -+ for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { -+ if (rssi < rssi_lv_t[i]) { -+ new_rssi_lv = i; -+ break; -+ } -+ } -+ return new_rssi_lv; -+} -+ -+enum phydm_qam_order phydm_get_ofdm_qam_order(void *dm_void, u8 rate_idx) -+{ -+ u8 tmp_idx = rate_idx; -+ enum phydm_qam_order qam_order = PHYDM_QAM_BPSK; -+ enum phydm_qam_order qam[10] = {PHYDM_QAM_BPSK, PHYDM_QAM_QPSK, -+ PHYDM_QAM_QPSK, PHYDM_QAM_16QAM, -+ PHYDM_QAM_16QAM, PHYDM_QAM_64QAM, -+ PHYDM_QAM_64QAM, PHYDM_QAM_64QAM, -+ PHYDM_QAM_256QAM, PHYDM_QAM_256QAM}; -+ -+ if (rate_idx <= ODM_RATE11M) -+ return PHYDM_QAM_CCK; -+ -+ if (rate_idx >= ODM_RATEVHTSS1MCS0) { -+ if (rate_idx >= ODM_RATEVHTSS4MCS0) -+ tmp_idx -= ODM_RATEVHTSS4MCS0; -+ else if (rate_idx >= ODM_RATEVHTSS3MCS0) -+ tmp_idx -= ODM_RATEVHTSS3MCS0; -+ else if (rate_idx >= ODM_RATEVHTSS2MCS0) -+ tmp_idx -= ODM_RATEVHTSS2MCS0; -+ else -+ tmp_idx -= ODM_RATEVHTSS1MCS0; -+ -+ qam_order = qam[tmp_idx]; -+ } else if (rate_idx >= ODM_RATEMCS0) { -+ if (rate_idx >= ODM_RATEMCS24) -+ tmp_idx -= ODM_RATEMCS24; -+ else if (rate_idx >= ODM_RATEMCS16) -+ tmp_idx -= ODM_RATEMCS16; -+ else if (rate_idx >= ODM_RATEMCS8) -+ tmp_idx -= ODM_RATEMCS8; -+ else -+ tmp_idx -= ODM_RATEMCS0; -+ -+ qam_order = qam[tmp_idx]; -+ } else { -+ if (rate_idx > ODM_RATE6M) { -+ tmp_idx -= ODM_RATE6M; -+ qam_order = qam[tmp_idx - 1]; -+ } else { -+ qam_order = PHYDM_QAM_BPSK; -+ } -+ } -+ -+ return qam_order; -+} -+ -+u8 phydm_rate_order_compute(void *dm_void, u8 rate_idx) -+{ -+ u8 rate_order = rate_idx & 0x7f; -+ -+ rate_idx &= 0x7f; -+ -+ if (rate_idx >= ODM_RATEVHTSS4MCS0) -+ rate_order -= ODM_RATEVHTSS4MCS0; -+ else if (rate_idx >= ODM_RATEVHTSS3MCS0) -+ rate_order -= ODM_RATEVHTSS3MCS0; -+ else if (rate_idx >= ODM_RATEVHTSS2MCS0) -+ rate_order -= ODM_RATEVHTSS2MCS0; -+ else if (rate_idx >= ODM_RATEVHTSS1MCS0) -+ rate_order -= ODM_RATEVHTSS1MCS0; -+ else if (rate_idx >= ODM_RATEMCS24) -+ rate_order -= ODM_RATEMCS24; -+ else if (rate_idx >= ODM_RATEMCS16) -+ rate_order -= ODM_RATEMCS16; -+ else if (rate_idx >= ODM_RATEMCS8) -+ rate_order -= ODM_RATEMCS8; -+ else if (rate_idx >= ODM_RATEMCS0) -+ rate_order -= ODM_RATEMCS0; -+ else if (rate_idx >= ODM_RATE6M) -+ rate_order -= ODM_RATE6M; -+ else -+ rate_order -= ODM_RATE1M; -+ -+ if (rate_idx >= ODM_RATEMCS0) -+ rate_order++; -+ -+ return rate_order; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+u8 phydm_rate2ss(void *dm_void, u8 rate_idx) -+{ -+ u8 ret = 0xff; -+ u8 i, j; -+ u8 search_idx; -+ u32 ss_mapping_tab[4][3] = {{0x00000000, 0x003ff000, 0x000ff000}, -+ {0x00000000, 0xffc00000, 0x0ff00000}, -+ {0x000003ff, 0x0000000f, 0xf0000000}, -+ {0x000ffc00, 0x00000ff0, 0x00000000} }; -+ if (rate_idx < 32) { -+ search_idx = rate_idx; -+ j = 0; -+ } else if (rate_idx < 64) { -+ search_idx = rate_idx - 32; -+ j = 1; -+ } else { -+ search_idx = rate_idx - 64; -+ j = 2; -+ } -+ for (i = 0; i < 4; i++) -+ if (ss_mapping_tab[i][j] & BIT(search_idx)) -+ ret = i; -+ return ret; -+} -+ -+u8 phydm_rate2plcp(void *dm_void, u8 rate_idx) -+{ -+ u8 rate2ss = 0; -+ u8 ltftime = 0; -+ u8 plcptime = 0xff; -+ -+ if (rate_idx < ODM_RATE6M) { -+ plcptime = 192; -+ /* @CCK PLCP = 192us (long preamble) */ -+ } else if (rate_idx < ODM_RATEMCS0) { -+ plcptime = 20; -+ /* @LegOFDM PLCP = 20us */ -+ } else { -+ if (rate_idx < ODM_RATEVHTSS1MCS0) -+ plcptime = 32; -+ /* @HT mode PLCP = 20us + 12us + 4us x Nss */ -+ else -+ plcptime = 36; -+ /* VHT mode PLCP = 20us + 16us + 4us x Nss */ -+ rate2ss = phydm_rate2ss(dm_void, rate_idx); -+ if (rate2ss != 0xff) -+ ltftime = (rate2ss + 1) * 4; -+ else -+ return 0xff; -+ -+ plcptime += ltftime; -+ } -+ return plcptime; -+} -+ -+u8 phydm_get_plcp(void *dm_void, u16 macid) -+{ -+ u8 plcp_time = 0; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = NULL; -+ struct ra_sta_info *ra = NULL; -+ -+ sta = dm->phydm_sta_info[macid]; -+ ra = &sta->ra_info; -+ plcp_time = phydm_rate2plcp(dm, ra->curr_tx_rate); -+ return plcp_time; -+} -+#endif -+ -+void phydm_ra_common_info_update(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ struct cmn_sta_info *sta = NULL; -+ u16 macid; -+ u8 rate_order_tmp; -+ u8 rate_idx = 0; -+ u8 cnt = 0; -+ -+ ra_tab->highest_client_tx_order = 0; -+ ra_tab->power_tracking_flag = 1; -+ -+ if (!dm->number_linked_client) -+ return; -+ -+ for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { -+ sta = dm->phydm_sta_info[macid]; -+ -+ if (!is_sta_active(sta)) -+ continue; -+ -+ rate_idx = sta->ra_info.curr_tx_rate & 0x7f; -+ rate_order_tmp = phydm_rate_order_compute(dm, rate_idx); -+ -+ if (rate_order_tmp >= ra_tab->highest_client_tx_order) { -+ ra_tab->highest_client_tx_order = rate_order_tmp; -+ ra_tab->highest_client_tx_rate_order = macid; -+ } -+ -+ cnt++; -+ -+ if (cnt == dm->number_linked_client) -+ break; -+ } -+ PHYDM_DBG(dm, DBG_RA, -+ "MACID[%d], Highest Tx order Update for power traking: %d\n", -+ ra_tab->highest_client_tx_rate_order, -+ ra_tab->highest_client_tx_order); -+} -+ -+void phydm_rrsr_set_register(void *dm_void, u32 rrsr_val) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_set_mac_reg(dm, R_0x440, 0xfffff, rrsr_val); -+} -+ -+void phydm_masked_rrsr_set_register(void *dm_void, u32 rrsr_val) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ -+ if (ra_tab->rrsr_val_curr == rrsr_val) -+ return; -+ -+ ra_tab->rrsr_val_curr = rrsr_val; -+ odm_set_mac_reg(dm, R_0x440, 0xfffff, rrsr_val); -+} -+ -+void phydm_rrsr_mask(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra = &dm->dm_ra_table; -+ struct cmn_sta_info *sta = NULL; -+ u8 rate_order = 0; -+ u8 rate_order_min = 0xff; -+ u32 rrsr_mask = 0, rrsr_mask_ofdm = 0; -+ u8 tx_rate_idx = 0; -+ u8 i = 0, sta_cnt = 0; -+ -+ if (!ra->dynamic_rrsr_en) -+ return; -+ -+ if (!dm->is_linked) { -+ phydm_masked_rrsr_set_register(dm, ra->rrsr_val_init); -+ return; -+ } -+ -+#if 1 -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ sta = dm->phydm_sta_info[i]; -+ if (!is_sta_active(sta)) -+ continue; -+ -+ sta_cnt++; -+ tx_rate_idx = sta->ra_info.curr_tx_rate & 0x7f; -+ rate_order = phydm_rate_order_compute(dm, tx_rate_idx); -+ if (rate_order < rate_order_min) -+ rate_order_min = rate_order; -+ -+ if (sta_cnt == dm->number_linked_client) -+ break; -+ } -+#else -+ sta = dm->phydm_sta_info[dm->rssi_min_macid]; -+ -+ if (!is_sta_active(sta)) { -+ PHYDM_DBG(dm, DBG_DYN_ARFR, "[Warning] %s invalid STA\n", -+ __func__); -+ return; -+ } -+ -+ rate_order = phydm_rate_order_compute(dm, sta->ra_info.curr_tx_rate); -+#endif -+ if (rate_order_min == 0) { -+ rrsr_mask = 0x1f; -+ } else { -+ rrsr_mask_ofdm = (u32)phydm_gen_bitmask(rate_order_min); -+ rrsr_mask = (rrsr_mask_ofdm << 4) | 0xf; -+ } -+ -+ /*ra->rrsr_val_init = 0x15d;*/ -+ -+ phydm_masked_rrsr_set_register(dm, ra->rrsr_val_init & rrsr_mask); -+ -+ PHYDM_DBG(dm, DBG_DYN_ARFR, -+ "tx{rate, rate_order_min}={0x%x, %d}, rrsr_init=0x%x, ofdm_rrsr_mask=0x%x, rrsr_val=0x%x\n", -+ tx_rate_idx, rate_order_min, ra->rrsr_val_init, -+ rrsr_mask, ra->rrsr_val_curr); -+} -+ -+void phydm_ra_info_watchdog(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ phydm_ra_common_info_update(dm); -+ phydm_ra_dynamic_retry_count(dm); -+ phydm_rrsr_mask(dm); -+ phydm_ra_mask_watchdog(dm); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ odm_refresh_basic_rate_mask(dm); -+#endif -+} -+ -+void phydm_rrsr_en(void *dm_void, boolean en_rrsr) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ -+ ra_tab->dynamic_rrsr_en = en_rrsr; -+} -+ -+void phydm_arfr_table_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & PHYDM_IC_RATEID_IDX_TYPE2) { -+ /*ARFR table3(2.4g ac 2ss) for rate_id = 16*/ -+ odm_set_mac_reg(dm, R_0x494, MASKDWORD, 0xfe01f015); -+ odm_set_mac_reg(dm, R_0x498, MASKDWORD, 0x40000000); -+ -+ /*ARFR table5(2.4g ac 1ss) for rate_id = 18*/ -+ odm_set_mac_reg(dm, R_0x4a4, MASKDWORD, 0x3ff015); -+ odm_set_mac_reg(dm, R_0x4a8, MASKDWORD, 0x40000000); -+ } -+} -+ -+void phydm_ra_info_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ -+ ra_tab->highest_client_tx_rate_order = 0; -+ ra_tab->highest_client_tx_order = 0; -+ ra_tab->ra_th_ofst = 0; -+ ra_tab->ra_ofst_direc = 0; -+ ra_tab->rrsr_val_init = odm_get_mac_reg(dm, R_0x440, MASKDWORD); -+ ra_tab->dynamic_rrsr_en = false; -+ ra_tab->ra_trigger_mode = 1; // default TBTT RA -+ ra_tab->ra_tx_cls_th = 255; -+#if (RTL8822B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ u32 ret_value; -+ -+ ret_value = odm_get_mac_reg(dm, R_0x4c8, MASKBYTE2); -+ odm_set_mac_reg(dm, R_0x4cc, MASKBYTE3, (ret_value - 1)); -+ } -+#endif -+ -+ #if 0 /*@CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+ phydm_ra_dynamic_retry_limit_init(dm); -+ #endif -+ -+ #if 0 /*@CONFIG_RA_DYNAMIC_RATE_ID*/ -+ phydm_ra_dynamic_rate_id_init(dm); -+ #endif -+ -+ phydm_arfr_table_init(dm); -+ -+ phydm_rate_adaptive_mask_init(dm); -+} -+ -+u8 odm_find_rts_rate(void *dm_void, u8 tx_rate, boolean is_erp_protect) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 rts_ini_rate = ODM_RATE6M; -+ -+ if (is_erp_protect) { /* use CCK rate as RTS*/ -+ rts_ini_rate = ODM_RATE1M; -+ } else { -+ switch (tx_rate) { -+ case ODM_RATEVHTSS4MCS9: -+ case ODM_RATEVHTSS4MCS8: -+ case ODM_RATEVHTSS4MCS7: -+ case ODM_RATEVHTSS4MCS6: -+ case ODM_RATEVHTSS4MCS5: -+ case ODM_RATEVHTSS4MCS4: -+ case ODM_RATEVHTSS4MCS3: -+ 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_RATEMCS31: -+ case ODM_RATEMCS30: -+ case ODM_RATEMCS29: -+ case ODM_RATEMCS28: -+ case ODM_RATEMCS27: -+ case ODM_RATEMCS23: -+ case ODM_RATEMCS22: -+ case ODM_RATEMCS21: -+ case ODM_RATEMCS20: -+ case ODM_RATEMCS19: -+ 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_RATEVHTSS4MCS2: -+ case ODM_RATEVHTSS4MCS1: -+ case ODM_RATEVHTSS3MCS2: -+ case ODM_RATEVHTSS3MCS1: -+ case ODM_RATEVHTSS2MCS2: -+ case ODM_RATEVHTSS2MCS1: -+ case ODM_RATEVHTSS1MCS2: -+ case ODM_RATEVHTSS1MCS1: -+ case ODM_RATEMCS26: -+ case ODM_RATEMCS25: -+ case ODM_RATEMCS18: -+ case ODM_RATEMCS17: -+ 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_RATEVHTSS4MCS0: -+ case ODM_RATEVHTSS3MCS0: -+ case ODM_RATEVHTSS2MCS0: -+ case ODM_RATEVHTSS1MCS0: -+ case ODM_RATEMCS24: -+ case ODM_RATEMCS16: -+ 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 (*dm->band_type == ODM_BAND_5G) { -+ if (rts_ini_rate < ODM_RATE6M) -+ rts_ini_rate = ODM_RATE6M; -+ } -+ return rts_ini_rate; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+void odm_refresh_basic_rate_mask( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ static u8 stage = 0; -+ u8 cur_stage = 0; -+ OCTET_STRING os_rate_set; -+ PMGNT_INFO mgnt_info = GetDefaultMgntInfo(((PADAPTER)adapter)); -+ u8 rate_set[5] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M, MGN_6M}; -+ -+ if (dm->support_ic_type != ODM_RTL8812 && dm->support_ic_type != ODM_RTL8821) -+ return; -+ -+ if (dm->is_linked == false) /* unlink Default port information */ -+ cur_stage = 0; -+ else if (dm->rssi_min < 40) /* @link RSSI < 40% */ -+ cur_stage = 1; -+ else if (dm->rssi_min > 45) /* @link RSSI > 45% */ -+ cur_stage = 3; -+ else -+ cur_stage = 2; /* @link 25% <= RSSI <= 30% */ -+ -+ if (cur_stage != stage) { -+ if (cur_stage == 1) { -+ FillOctetString(os_rate_set, rate_set, 5); -+ FilterSupportRate(mgnt_info->mBrates, &os_rate_set, false); -+ phydm_set_hw_reg_handler_interface(dm, HW_VAR_BASIC_RATE, (u8 *)&os_rate_set); -+ } else if (cur_stage == 3 && (stage == 1 || stage == 2)) -+ phydm_set_hw_reg_handler_interface(dm, HW_VAR_BASIC_RATE, (u8 *)(&mgnt_info->mBrates)); -+ } -+ -+ stage = cur_stage; -+} -+ -+#endif -+ -+#if 0 /*@CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+ -+void phydm_retry_limit_table_bound( -+ void *dm_void, -+ u8 *retry_limit, -+ u8 offset) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ -+ if (*retry_limit > offset) { -+ *retry_limit -= offset; -+ -+ if (*retry_limit < ra_tab->retrylimit_low) -+ *retry_limit = ra_tab->retrylimit_low; -+ else if (*retry_limit > ra_tab->retrylimit_high) -+ *retry_limit = ra_tab->retrylimit_high; -+ } else -+ *retry_limit = ra_tab->retrylimit_low; -+} -+ -+void phydm_reset_retry_limit_table( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_t = &dm->dm_ra_table; -+ u8 i; -+ -+ u8 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*/ -+ }; -+ u8 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*/ -+ }; -+ -+ memcpy(&ra_t->per_rate_retrylimit_20M[0], -+ &per_rate_retrylimit_table_20M[0], PHY_NUM_RATE_IDX); -+ memcpy(&ra_t->per_rate_retrylimit_40M[0], -+ &per_rate_retrylimit_table_40M[0], PHY_NUM_RATE_IDX); -+ -+ for (i = 0; i < PHY_NUM_RATE_IDX; i++) { -+ phydm_retry_limit_table_bound(dm, -+ &ra_t->per_rate_retrylimit_20M[i], -+ 0); -+ phydm_retry_limit_table_bound(dm, -+ &ra_t->per_rate_retrylimit_40M[i], -+ 0); -+ } -+} -+ -+void phydm_ra_dynamic_retry_limit_init( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ -+ ra_tab->retry_descend_num = RA_RETRY_DESCEND_NUM; -+ ra_tab->retrylimit_low = RA_RETRY_LIMIT_LOW; -+ ra_tab->retrylimit_high = RA_RETRY_LIMIT_HIGH; -+ -+ phydm_reset_retry_limit_table(dm); -+} -+ -+void phydm_ra_dynamic_retry_limit( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ u8 i, retry_offset; -+ u32 ma_rx_tp; -+ -+ if (dm->pre_number_active_client == dm->number_active_client) { -+ PHYDM_DBG(dm, DBG_RA, -+ "pre_number_active_client == number_active_client\n"); -+ return; -+ -+ } else { -+ if (dm->number_active_client == 1) { -+ phydm_reset_retry_limit_table(dm); -+ PHYDM_DBG(dm, DBG_RA, -+ "one client only->reset to default value\n"); -+ } else { -+ retry_offset = dm->number_active_client * ra_tab->retry_descend_num; -+ -+ for (i = 0; i < PHY_NUM_RATE_IDX; i++) { -+ phydm_retry_limit_table_bound(dm, -+ &ra_tab->per_rate_retrylimit_20M[i], -+ retry_offset); -+ phydm_retry_limit_table_bound(dm, -+ &ra_tab->per_rate_retrylimit_40M[i], -+ retry_offset); -+ } -+ } -+ } -+} -+#endif -+ -+#if 0 /*@CONFIG_RA_DYNAMIC_RATE_ID*/ -+void phydm_ra_dynamic_rate_id_on_assoc( -+ void *dm_void, -+ u8 wireless_mode, -+ u8 init_rate_id) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_RA, -+ "[ON ASSOC] rf_mode = ((0x%x)), wireless_mode = ((0x%x)), init_rate_id = ((0x%x))\n", -+ dm->rf_type, wireless_mode, init_rate_id); -+ -+ if (dm->rf_type == RF_2T2R || dm->rf_type == RF_2T3R || dm->rf_type == RF_2T4R) { -+ if ((dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) && -+ (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G))) { -+ PHYDM_DBG(dm, DBG_RA, -+ "[ON ASSOC] set N-2SS ARFR5 table\n"); -+ odm_set_mac_reg(dm, R_0x4a4, MASKDWORD, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ odm_set_mac_reg(dm, R_0x4a8, MASKDWORD, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ } else if ((dm->support_ic_type & (ODM_RTL8812)) && -+ (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY))) { -+ PHYDM_DBG(dm, DBG_RA, -+ "[ON ASSOC] set AC-2SS ARFR0 table\n"); -+ odm_set_mac_reg(dm, R_0x444, MASKDWORD, 0x0fff); /*@AC-2SS, ARFR0, rate_id = 0x9*/ -+ odm_set_mac_reg(dm, R_0x448, MASKDWORD, 0xff01f000); /*@AC-2SS, ARFR0, rate_id = 0x9*/ -+ } -+ } -+} -+ -+void phydm_ra_dynamic_rate_id_init( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) { -+ odm_set_mac_reg(dm, R_0x4a4, MASKDWORD, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ odm_set_mac_reg(dm, R_0x4a8, MASKDWORD, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ -+ odm_set_mac_reg(dm, R_0x444, MASKDWORD, 0x0fff); /*@AC-2SS, ARFR0, rate_id = 0x9*/ -+ odm_set_mac_reg(dm, R_0x448, MASKDWORD, 0xff01f000); /*@AC-2SS, ARFR0, rate_id = 0x9*/ -+ } -+} -+ -+void phydm_update_rate_id( -+ void *dm_void, -+ u8 rate, -+ u8 platform_macid) -+{ -+#if 0 -+ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ u8 current_tx_ss; -+ u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ -+ enum wireless_set wireless_set; -+ u8 phydm_macid; -+ struct cmn_sta_info *sta; -+ -+#if 0 -+ if (rate_idx >= ODM_RATEVHTSS2MCS0) { -+ PHYDM_DBG(dm, DBG_RA, "rate[%d]: (( VHT2SS-MCS%d ))\n", -+ platform_macid, (rate_idx - ODM_RATEVHTSS2MCS0)); -+ /*@dummy for SD4 check patch*/ -+ } else if (rate_idx >= ODM_RATEVHTSS1MCS0) { -+ PHYDM_DBG(dm, DBG_RA, "rate[%d]: (( VHT1SS-MCS%d ))\n", -+ platform_macid, (rate_idx - ODM_RATEVHTSS1MCS0)); -+ /*@dummy for SD4 check patch*/ -+ } else if (rate_idx >= ODM_RATEMCS0) { -+ PHYDM_DBG(dm, DBG_RA, "rate[%d]: (( HT-MCS%d ))\n", -+ platform_macid, (rate_idx - ODM_RATEMCS0)); -+ /*@dummy for SD4 check patch*/ -+ } else { -+ PHYDM_DBG(dm, DBG_RA, "rate[%d]: (( HT-MCS%d ))\n", -+ platform_macid, rate_idx); -+ /*@dummy for SD4 check patch*/ -+ } -+#endif -+ -+ phydm_macid = dm->phydm_macid_table[platform_macid]; -+ sta = dm->phydm_sta_info[phydm_macid]; -+ -+ if (is_sta_active(sta)) { -+ wireless_set = sta->support_wireless_set; -+ -+ if (dm->rf_type == RF_2T2R || dm->rf_type == RF_2T3R || dm->rf_type == RF_2T4R) { -+ if (wireless_set & WIRELESS_HT) { /*N mode*/ -+ if (rate_idx >= ODM_RATEMCS8 && rate_idx <= ODM_RATEMCS15) { /*@2SS mode*/ -+ -+ sta->ra_info.rate_id = ARFR_5_RATE_ID; -+ PHYDM_DBG(dm, DBG_RA, "ARFR_5\n"); -+ } -+ } else if (wireless_set & WIRELESS_VHT) {/*@AC mode*/ -+ if (rate_idx >= ODM_RATEVHTSS2MCS0 && rate_idx <= ODM_RATEVHTSS2MCS9) {/*@2SS mode*/ -+ -+ sta->ra_info.rate_id = ARFR_0_RATE_ID; -+ PHYDM_DBG(dm, DBG_RA, "ARFR_0\n"); -+ } -+ } else -+ sta->ra_info.rate_id = ARFR_0_RATE_ID; -+ -+ PHYDM_DBG(dm, DBG_RA, "UPdate_RateID[%d]: (( 0x%x ))\n", -+ platform_macid, sta->ra_info.rate_id); -+ } -+ } -+#endif -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rainfo.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rainfo.h -new file mode 100644 -index 000000000..5cef3ce17 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rainfo.h -@@ -0,0 +1,333 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMRAINFO_H__ -+#define __PHYDMRAINFO_H__ -+ -+/* 2020.08.05 Fix ARFR bug due to rate_id error for 2.4G VHT mode*/ -+#define RAINFO_VERSION "8.8" -+ -+#define FORCED_UPDATE_RAMASK_PERIOD 5 -+ -+#define H2C_MAX_LENGTH 7 -+ -+#define RA_FLOOR_UP_GAP 3 -+#define RA_FLOOR_TABLE_SIZE 7 -+ -+#define ACTIVE_TP_THRESHOLD 1 -+#define RA_RETRY_DESCEND_NUM 2 -+#define RA_RETRY_LIMIT_LOW 4 -+#define RA_RETRY_LIMIT_HIGH 32 -+ -+#define PHYDM_IS_LEGACY_RATE(rate) ((rate <= ODM_RATE54M) ? true : false) -+#define PHYDM_IS_CCK_RATE(rate) ((rate <= ODM_RATE11M) ? true : false) -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #define FIRST_MACID 1 -+#else -+ #define FIRST_MACID 0 -+#endif -+ -+/* @1 ============================================================ -+ * 1 enumrate -+ * 1 ============================================================ -+ */ -+ -+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 -+}; -+ -+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 -+}; -+ -+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_ARFR7_N_4SS = 15, -+ PHYDM_ARFR6_AC_4SS = 16 -+}; -+ -+/*ARFR4(0x49c/0x4a0) can not be used because FW BT would use.*/ -+enum phydm_rateid_idx_type_2 { -+ PHYDM_TYPE2_AC_2SS = 9, -+ PHYDM_TYPE2_AC_1SS = 10, -+ PHYDM_TYPE2_MIX_1SS = 11, -+ PHYDM_TYPE2_MIX_2SS = 12, -+ PHYDM_TYPE2_ARFR3_AC_2G_2SS = 16, /*0x494/0x498*/ -+ PHYDM_TYPE2_ARFR5_AC_2G_1SS = 18 /*0x4a4/0x4a8*/ -+}; -+ -+enum phydm_qam_order { -+ PHYDM_QAM_CCK = 0, -+ PHYDM_QAM_BPSK = 1, -+ PHYDM_QAM_QPSK = 2, -+ PHYDM_QAM_16QAM = 3, -+ PHYDM_QAM_64QAM = 4, -+ PHYDM_QAM_256QAM = 5 -+}; -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1)/* @88E RA */ -+ -+struct _phydm_txstatistic_ { -+ u32 hw_total_tx; -+ u32 hw_tx_success; -+ u32 hw_tx_rty; -+ u32 hw_tx_drop; -+}; -+ -+/* @1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+struct _odm_ra_info_ { -+ u8 rate_id; -+ u32 rate_mask; -+ u32 ra_use_rate; -+ u8 rate_sgi; -+ u8 rssi_sta_ra; -+ u8 pre_rssi_sta_ra; -+ u8 sgi_enable; -+ u8 decision_rate; -+ u8 pre_rate; -+ u8 highest_rate; -+ u8 lowest_rate; -+ u32 nsc_up; -+ u32 nsc_down; -+ u16 RTY[5]; -+ u32 TOTAL; -+ u16 DROP; -+ u8 active; -+ u16 rpt_time; -+ u8 ra_waiting_counter; -+ u8 ra_pending_counter; -+ u8 ra_drop_after_down; -+#if 1 /* POWER_TRAINING_ACTIVE == 1 */ /* For compile pass only~! */ -+ u8 pt_active; /* on or off */ -+ u8 pt_try_state; /* @0 trying state, 1 for decision state */ -+ u8 pt_stage; /* @0~6 */ -+ u8 pt_stop_count; /* Stop PT counter */ -+ u8 pt_pre_rate; /* @if rate change do PT */ -+ u8 pt_pre_rssi; /* @if RSSI change 5% do PT */ -+ u8 pt_mode_ss; /* @decide whitch rate should do PT */ -+ u8 ra_stage; /* @StageRA, decide how many times RA will be done between PT */ -+ u8 pt_smooth_factor; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+ u8 rate_down_counter; -+ u8 rate_up_counter; -+ u8 rate_direction; -+ u8 bounding_type; -+ u8 bounding_counter; -+ u8 bounding_learning_time; -+ u8 rate_down_start_time; -+#endif -+}; -+#endif -+ -+ -+struct ra_table { -+ #ifdef MU_EX_MACID -+ u8 mu1_rate[MU_EX_MACID]; -+ #endif -+ u8 highest_client_tx_order; -+ u16 highest_client_tx_rate_order; -+ u8 power_tracking_flag; -+ u8 ra_th_ofst; /*RA_threshold_offset*/ -+ u8 ra_ofst_direc; /*RA_offset_direction*/ -+ u8 up_ramask_cnt; /*@force update_ra_mask counter*/ -+ u8 up_ramask_cnt_tmp; /*@Just for debug, should be removed latter*/ -+ u32 rrsr_val_init; /*0x440*/ -+ u32 rrsr_val_curr; /*0x440*/ -+ boolean dynamic_rrsr_en; -+ u8 ra_trigger_mode; /*0: pkt RA, 1: TBTT RA*/ -+ u8 ra_tx_cls_th; /*255: auto, xx: in dB*/ -+#if 0 /*@CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+ u8 per_rate_retrylimit_20M[PHY_NUM_RATE_IDX]; -+ u8 per_rate_retrylimit_40M[PHY_NUM_RATE_IDX]; -+ u8 retry_descend_num; -+ u8 retrylimit_low; -+ u8 retrylimit_high; -+#endif -+ u8 ldpc_thres; /* @if RSSI > ldpc_th => switch from LPDC to BCC */ -+ void (*record_ra_info)(void *dm_void, u8 macid, -+ struct cmn_sta_info *sta, u64 ra_mask); -+ u8 ra_mask_rpt_stamp; -+ u8 ra_mask_buf[8]; -+}; -+ -+struct ra_mask_rpt_trig { -+ u8 ra_mask_rpt_stamp; -+ u8 macid; -+}; -+ -+struct ra_mask_rpt { -+ u8 ra_mask_rpt_stamp; -+ u8 ra_mask_buf[8]; -+}; -+ -+/* @1 ============================================================ -+ * 1 Function Prototype -+ * 1 ============================================================ -+ */ -+boolean phydm_is_cck_rate(void *dm_void, u8 rate); -+ -+boolean phydm_is_ofdm_rate(void *dm_void, u8 rate); -+ -+boolean phydm_is_ht_rate(void *dm_void, u8 rate); -+ -+boolean phydm_is_vht_rate(void *dm_void, u8 rate); -+ -+u8 phydm_legacy_rate_2_spec_rate(void *dm_void, u8 rate); -+ -+u8 phydm_rate_2_rate_digit(void *dm_void, u8 rate); -+ -+u8 phydm_rate_type_2_num_ss(void *dm_void, enum PDM_RATE_TYPE type); -+ -+u8 phydm_rate_to_num_ss(void *dm_void, u8 data_rate); -+ -+void phydm_h2C_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void phydm_ra_debug(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len); -+ -+void phydm_ra_mask_report_h2c_trigger(void *dm_void, -+ struct ra_mask_rpt_trig *trig_rpt); -+ -+void phydm_ra_mask_report_c2h_result(void *dm_void, struct ra_mask_rpt *rpt); -+ -+void odm_c2h_ra_para_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len); -+ -+void phydm_print_rate(void *dm_void, u8 rate, u32 dbg_component); -+ -+void phydm_print_rate_2_buff(void *dm_void, u8 rate, char *buf, u16 buf_size); -+ -+void phydm_c2h_ra_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len); -+ -+u8 phydm_rate_order_compute(void *dm_void, u8 rate_idx); -+ -+void phydm_rrsr_set_register(void *dm_void, u32 rrsr_val); -+ -+void phydm_ra_info_watchdog(void *dm_void); -+ -+void phydm_rrsr_en(void *dm_void, boolean en_rrsr); -+ -+void phydm_ra_info_init(void *dm_void); -+ -+void phydm_modify_RA_PCR_threshold(void *dm_void, u8 ra_ofst_direc, -+ u8 ra_th_ofst); -+ -+u8 phydm_vht_en_mapping(void *dm_void, u32 wireless_mode); -+ -+u8 phydm_rate_id_mapping(void *dm_void, u32 wireless_mode, u8 rf_type, u8 bw); -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+void phydm_update_hal_ra_mask( -+ void *dm_void, -+ u32 wireless_mode, -+ u8 rf_type, -+ u8 BW, -+ u8 mimo_ps_enable, -+ u8 disable_cck_rate, -+ u32 *ratr_bitmap_msb_in, -+ u32 *ratr_bitmap_in, -+ u8 tx_rate_level); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+u8 phydm_get_plcp(void *dm_void, u16 macid); -+#endif -+ -+void phydm_refresh_rate_adaptive_mask(void *dm_void); -+ -+u8 phydm_get_rx_stream_num(void *dm_void, enum rf_type type); -+ -+u8 phydm_rssi_lv_dec(void *dm_void, u32 rssi, u8 ratr_state); -+ -+void odm_ra_post_action_on_assoc(void *dm); -+ -+u8 odm_find_rts_rate(void *dm_void, u8 tx_rate, boolean is_erp_protect); -+ -+void phydm_show_sta_info(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+u8 phydm_get_rate_from_rssi_lv(void *dm_void, u8 sta_idx); -+ -+void phydm_ra_registed(void *dm_void, u8 macid, u8 rssi_from_assoc); -+ -+void phydm_ra_offline(void *dm_void, u8 macid); -+ -+void phydm_ra_mask_watchdog(void *dm_void); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void odm_refresh_basic_rate_mask( -+ void *dm_void); -+#endif -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+void phydm_ra_mode_selection(void *dm_void, u8 mode); -+#endif -+ -+#endif /*@#ifndef __PHYDMRAINFO_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_reg.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_reg.h -new file mode 100644 -index 000000000..0835f34bd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_reg.h -@@ -0,0 +1,243 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+/************************************************************* -+ * 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 REG_RF_TX_GAIN_OFFSET 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 REG_TX_AGC_A_CCK_11_CCK_1_JAGUAR 0xc20 -+ #define REG_TX_AGC_A_OFDM18_OFDM6_JAGUAR 0xc24 -+ #define REG_TX_AGC_A_OFDM54_OFDM24_JAGUAR 0xc28 -+ #define REG_TX_AGC_A_MCS3_MCS0_JAGUAR 0xc2c -+ #define REG_TX_AGC_A_MCS7_MCS4_JAGUAR 0xc30 -+ #define REG_TX_AGC_A_MCS11_MCS8_JAGUAR 0xc34 -+ #define REG_TX_AGC_A_MCS15_MCS12_JAGUAR 0xc38 -+ #define REG_TX_AGC_A_NSS1_INDEX3_NSS1_INDEX0_JAGUAR 0xc3c -+ #define REG_TX_AGC_A_NSS1_INDEX7_NSS1_INDEX4_JAGUAR 0xc40 -+ #define REG_TX_AGC_A_NSS2_INDEX1_NSS1_INDEX8_JAGUAR 0xc44 -+ #define REG_TX_AGC_A_NSS2_INDEX5_NSS2_INDEX2_JAGUAR 0xc48 -+ #define REG_TX_AGC_A_NSS2_INDEX9_NSS2_INDEX6_JAGUAR 0xc4c -+ #if defined(CONFIG_WLAN_HAL_8814AE) -+ #define REG_TX_AGC_A_MCS19_MCS16_JAGUAR 0xcd8 -+ #define REG_TX_AGC_A_MCS23_MCS20_JAGUAR 0xcdc -+ #define REG_TX_AGC_A_NSS3_INDEX3_NSS3_INDEX0_JAGUAR 0xce0 -+ #define REG_TX_AGC_A_NSS3_INDEX7_NSS3_INDEX4_JAGUAR 0xce4 -+ #define REG_TX_AGC_A_NSS3_INDEX9_NSS3_INDEX8_JAGUAR 0xce8 -+ #endif -+ #define REG_TX_AGC_B_CCK_11_CCK_1_JAGUAR 0xe20 -+ #define REG_TX_AGC_B_OFDM18_OFDM6_JAGUAR 0xe24 -+ #define REG_TX_AGC_B_OFDM54_OFDM24_JAGUAR 0xe28 -+ #define REG_TX_AGC_B_MCS3_MCS0_JAGUAR 0xe2c -+ #define REG_TX_AGC_B_MCS7_MCS4_JAGUAR 0xe30 -+ #define REG_TX_AGC_B_MCS11_MCS8_JAGUAR 0xe34 -+ #define REG_TX_AGC_B_MCS15_MCS12_JAGUAR 0xe38 -+ #define REG_TX_AGC_B_NSS1_INDEX3_NSS1_INDEX0_JAGUAR 0xe3c -+ #define REG_TX_AGC_B_NSS1_INDEX7_NSS1_INDEX4_JAGUAR 0xe40 -+ #define REG_TX_AGC_B_NSS2_INDEX1_NSS1_INDEX8_JAGUAR 0xe44 -+ #define REG_TX_AGC_B_NSS2_INDEX5_NSS2_INDEX2_JAGUAR 0xe48 -+ #define REG_TX_AGC_B_NSS2_INDEX9_NSS2_INDEX6_JAGUAR 0xe4c -+ #if defined(CONFIG_WLAN_HAL_8814AE) -+ #define REG_TX_AGC_B_MCS19_MCS16_JAGUAR 0xed8 -+ #define REG_TX_AGC_B_MCS23_MCS20_JAGUAR 0xedc -+ #define REG_TX_AGC_B_NSS3_INDEX3_NSS3_INDEX0_JAGUAR 0xee0 -+ #define REG_TX_AGC_B_NSS3_INDEX7_NSS3_INDEX4_JAGUAR 0xee4 -+ #define REG_TX_AGC_B_NSS3_INDEX9_NSS3_INDEX8_JAGUAR 0xee8 -+ #define REG_TX_AGC_C_CCK_11_CCK_1_JAGUAR 0x1820 -+ #define REG_TX_AGC_C_OFDM18_OFDM6_JAGUAR 0x1824 -+ #define REG_TX_AGC_C_OFDM54_OFDM24_JAGUAR 0x1828 -+ #define REG_TX_AGC_C_MCS3_MCS0_JAGUAR 0x182c -+ #define REG_TX_AGC_C_MCS7_MCS4_JAGUAR 0x1830 -+ #define REG_TX_AGC_C_MCS11_MCS8_JAGUAR 0x1834 -+ #define REG_TX_AGC_C_MCS15_MCS12_JAGUAR 0x1838 -+ #define REG_TX_AGC_C_NSS1_INDEX3_NSS1_INDEX0_JAGUAR 0x183c -+ #define REG_TX_AGC_C_NSS1_INDEX7_NSS1_INDEX4_JAGUAR 0x1840 -+ #define REG_TX_AGC_C_NSS2_INDEX1_NSS1_INDEX8_JAGUAR 0x1844 -+ #define REG_TX_AGC_C_NSS2_INDEX5_NSS2_INDEX2_JAGUAR 0x1848 -+ #define REG_TX_AGC_C_NSS2_INDEX9_NSS2_INDEX6_JAGUAR 0x184c -+ #define REG_TX_AGC_C_MCS19_MCS16_JAGUAR 0x18d8 -+ #define REG_TX_AGC_C_MCS23_MCS20_JAGUAR 0x18dc -+ #define REG_TX_AGC_C_NSS3_INDEX3_NSS3_INDEX0_JAGUAR 0x18e0 -+ #define REG_TX_AGC_C_NSS3_INDEX7_NSS3_INDEX4_JAGUAR 0x18e4 -+ #define REG_TX_AGC_C_NSS3_INDEX9_NSS3_INDEX8_JAGUAR 0x18e8 -+ #define REG_TX_AGC_D_CCK_11_CCK_1_JAGUAR 0x1a20 -+ #define REG_TX_AGC_D_OFDM18_OFDM6_JAGUAR 0x1a24 -+ #define REG_TX_AGC_D_OFDM54_OFDM24_JAGUAR 0x1a28 -+ #define REG_TX_AGC_D_MCS3_MCS0_JAGUAR 0x1a2c -+ #define REG_TX_AGC_D_MCS7_MCS4_JAGUAR 0x1a30 -+ #define REG_TX_AGC_D_MCS11_MCS8_JAGUAR 0x1a34 -+ #define REG_TX_AGC_D_MCS15_MCS12_JAGUAR 0x1a38 -+ #define REG_TX_AGC_D_NSS1_INDEX3_NSS1_INDEX0_JAGUAR 0x1a3c -+ #define REG_TX_AGC_D_NSS1_INDEX7_NSS1_INDEX4_JAGUAR 0x1a40 -+ #define REG_TX_AGC_D_NSS2_INDEX1_NSS1_INDEX8_JAGUAR 0x1a44 -+ #define REG_TX_AGC_D_NSS2_INDEX5_NSS2_INDEX2_JAGUAR 0x1a48 -+ #define REG_TX_AGC_D_NSS2_INDEX9_NSS2_INDEX6_JAGUAR 0x1a4c -+ #define REG_TX_AGC_D_MCS19_MCS16_JAGUAR 0x1ad8 -+ #define REG_TX_AGC_D_MCS23_MCS20_JAGUAR 0x1adc -+ #define REG_TX_AGC_D_NSS3_INDEX3_NSS3_INDEX0_JAGUAR 0x1ae0 -+ #define REG_TX_AGC_D_NSS3_INDEX7_NSS3_INDEX4_JAGUAR 0x1ae4 -+ #define REG_TX_AGC_D_NSS3_INDEX9_NSS3_INDEX8_JAGUAR 0x1ae8 -+ #endif -+ -+ #define is_tx_agc_byte0_jaguar 0xff -+ #define is_tx_agc_byte1_jaguar 0xff00 -+ #define is_tx_agc_byte2_jaguar 0xff0000 -+ #define is_tx_agc_byte3_jaguar 0xff000000 -+#if defined(CONFIG_WLAN_HAL_8198F) || defined(CONFIG_WLAN_HAL_8822CE) ||\ -+defined(CONFIG_WLAN_HAL_8814BE) || defined(CONFIG_WLAN_HAL_8812FE) ||\ -+defined(CONFIG_WLAN_HAL_8197G) -+ #define REG_TX_AGC_CCK_11_CCK_1_JAGUAR3 0x3a00 -+ #define REG_TX_AGC_OFDM_18_CCK_6_JAGUAR3 0x3a04 -+ #define REG_TX_AGC_OFDM_54_CCK_24_JAGUAR3 0x3a08 -+ #define REG_TX_AGC_MCS3_0_JAGUAR3 0x3a0c -+ #define REG_TX_AGC_MCS7_4_JAGUAR3 0x3a10 -+ #define REG_TX_AGC_MCS11_8_JAGUAR3 0x3a14 -+ #define REG_TX_AGC_MCS15_12_JAGUAR3 0x3a18 -+ #define REG_TX_AGC_MCS19_16_JAGUAR3 0x3a1c -+ #define REG_TX_AGC_MCS23_20_JAGUAR3 0x3a20 -+ #define REG_TX_AGC_MCS27_24_JAGUAR3 0x3a24 -+ #define REG_TX_AGC_MCS31_28_JAGUAR3 0x3a28 -+ #define REG_TX_AGC_VHT_Nss1_MCS3_0_JAGUAR3 0x3a2c -+ #define REG_TX_AGC_VHT_Nss1_MCS7_4_JAGUAR3 0x3a30 -+ #define REG_TX_AGC_VHT_NSS2_MCS1_NSS1_MCS8_JAGUAR3 0x3a34 -+ #define REG_TX_AGC_VHT_Nss2_MCS5_2_JAGUAR3 0x3a38 -+ #define REG_TX_AGC_VHT_Nss2_MCS9_6_JAGUAR3 0x3a3c -+ #define REG_TX_AGC_VHT_Nss3_MCS3_0_JAGUAR3 0x3a40 -+ #define REG_TX_AGC_VHT_Nss3_MCS7_4_JAGUAR3 0x3a44 -+ #define REG_TX_AGC_VHT_Nss4_MCS1_Nss3_MCS8_JAGUAR3 0x3a48 -+ #define REG_TX_AGC_VHT_Nss4_MCS5_2_JAGUAR3 0x3a4c -+ #define REG_TX_AGC_VHT_Nss4_MCS9_6_JAGUAR3 0x3a50 -+#endif -+#endif -+ -+#define BIT_FA_RESET BIT(0) -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_regdefine11ac.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_regdefine11ac.h -new file mode 100644 -index 000000000..7824ac22c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_regdefine11ac.h -@@ -0,0 +1,109 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#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_ANT_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_OFDM_FA_TYPE1_11AC 0xFCC -+#define ODM_REG_OFDM_FA_TYPE2_11AC 0xFD0 -+#define ODM_REG_OFDM_FA_TYPE3_11AC 0xFBC -+#define ODM_REG_OFDM_FA_TYPE4_11AC 0xFC0 -+#define ODM_REG_OFDM_FA_TYPE5_11AC 0xFC4 -+#define ODM_REG_OFDM_FA_TYPE6_11AC 0xFC8 -+#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 -+/* PAGE 18 */ -+#define ODM_REG_IGI_C_11AC 0x1850 -+/* PAGE 1A */ -+#define ODM_REG_IGI_D_11AC 0x1A50 -+ -+/* PAGE 1D */ -+#define ODM_REG_IGI_11AC3 0x1D70 -+ -+/* @2 MAC REG LIST */ -+#define ODM_REG_RESP_TX_11AC 0x6D8 -+ -+ -+ -+/* @DIG Related */ -+#define ODM_BIT_IGI_11AC 0x0000007F -+#define ODM_BIT_IGI_B_11AC3 0x00007F00 -+#define ODM_BIT_IGI_C_11AC3 0x007F0000 -+#define ODM_BIT_IGI_D_11AC3 0x7F000000 -+#define ODM_BIT_CCK_RPT_FORMAT_11AC BIT(16) -+#define ODM_BIT_BB_RX_PATH_11AC 0xF -+#define ODM_BIT_BB_TX_PATH_11AC 0xF -+#define ODM_BIT_BB_ATC_11AC BIT(14) -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_regdefine11n.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_regdefine11n.h -new file mode 100644 -index 000000000..aa162327a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_regdefine11n.h -@@ -0,0 +1,220 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#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 -+#define ODM_REF_RF_DF_11N 0xDF -+ -+ -+ -+/* @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_DEFAULT_A_11N 0x858 -+#define ODM_REG_RX_DEFAULT_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 struct acs_info, 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 -+#define ODM_REG_SOML_97F 0x998 -+ -+/* 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 -+#define ODM_REG_HT_CRC32_CNT_11N_AGG 0xFB8 -+ -+/* @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 BIT(9) -+#define ODM_BIT_BB_RX_PATH_11N 0xF -+#define ODM_BIT_BB_TX_PATH_11N 0xF -+#define ODM_BIT_BB_ATC_11N BIT(11) -+#endif -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_regtable.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_regtable.h -new file mode 100644 -index 000000000..9146c6b19 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_regtable.h -@@ -0,0 +1,1128 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * -+ *****************************************************************************/ -+ -+#define R_0x0 0x0 -+#define R_0x00 0x00 -+#define R_0x08 0x08 -+#define R_0x0106 0x0106 -+#define R_0x0140 0x0140 -+#define R_0x0144 0x0144 -+#define R_0x0148 0x0148 -+#define R_0x040 0x040 -+#define R_0x10 0x10 -+#define R_0x100 0x100 -+#define R_0x1000 0x1000 -+#define R_0x1008 0x1008 -+#define R_0x1038 0x1038 -+#define R_0x103c 0x103c -+#define R_0x1040 0x1040 -+#define R_0x1048 0x1048 -+#define R_0x1064 0x1064 -+#define R_0x1080 0x1080 -+#define R_0x10d8 0x10d8 -+#define R_0x10dc 0x10dc -+#define R_0x1200 0x1200 -+#define R_0x1204 0x1204 -+#define R_0x1208 0x1208 -+#define R_0x1210 0x1210 -+#define R_0x1214 0x1214 -+#define R_0x1218 0x1218 -+#define R_0x121c 0x121c -+#define R_0x14 0x14 -+#define R_0x14c0 0x14c0 -+#define R_0x14c4 0x14c4 -+#define R_0x14c8 0x14c8 -+#define R_0x14cc 0x14cc -+#define R_0x1518 0x1518 -+#define R_0x1684 0x1684 -+#define R_0x1688 0x1688 -+#define R_0x168c 0x168c -+#define R_0x1700 0x1700 -+#define R_0x1704 0x1704 -+#define R_0x1800 0x1800 -+#define R_0x1804 0x1804 -+#define R_0x1808 0x1808 -+#define R_0x180c 0x180c -+#define R_0x1810 0x1810 -+#define R_0x1814 0x1814 -+#define R_0x1818 0x1818 -+#define R_0x181c 0x181c -+#define R_0x1830 0x1830 -+#define R_0x1834 0x1834 -+#define R_0x1838 0x1838 -+#define R_0x183c 0x183c -+#define R_0x1840 0x1840 -+#define R_0x1844 0x1844 -+#define R_0x1848 0x1848 -+#define R_0x1860 0x1860 -+#define R_0x1864 0x1864 -+#define R_0x1868 0x1868 -+#define R_0x186c 0x186c -+#define R_0x1870 0x1870 -+#define R_0x1880 0x1880 -+#define R_0x1884 0x1884 -+#define R_0x188c 0x188c -+#define R_0x1894 0x1894 -+#define R_0x189c 0x189c -+#define R_0x18a0 0x18a0 -+#define R_0x18a4 0x18a4 -+#define R_0x18a8 0x18a8 -+#define R_0x18ac 0x18ac -+#define R_0x18e0 0x18e0 -+#define R_0x18e8 0x18e8 -+#define R_0x18ec 0x18ec -+#define R_0x18f0 0x18f0 -+#define R_0x18f8 0x18f8 -+#define R_0x18fc 0x18fc -+#define R_0x1900 0x1900 -+#define R_0x1904 0x1904 -+#define R_0x1908 0x1908 -+#define R_0x1910 0x1910 -+#define R_0x1918 0x1918 -+#define R_0x191c 0x191c -+#define R_0x1928 0x1928 -+#define R_0x1938 0x1938 -+#define R_0x1940 0x1940 -+#define R_0x1944 0x1944 -+#define R_0x1950 0x1950 -+#define R_0x1954 0x1954 -+#define R_0x195c 0x195c -+#define R_0x1968 0x1968 -+#define R_0x1970 0x1970 -+#define R_0x1984 0x1984 -+#define R_0x1988 0x1988 -+#define R_0x198c 0x198c -+#define R_0x1990 0x1990 -+#define R_0x1991 0x1991 -+#define R_0x1998 0x1998 -+#define R_0x19a8 0x19a8 -+#define R_0x19b8 0x19b8 -+#define R_0x19d4 0x19d4 -+#define R_0x19d8 0x19d8 -+#define R_0x19e0 0x19e0 -+#define R_0x19f0 0x19f0 -+#define R_0x19f8 0x19f8 -+#define R_0x1a00 0x1a00 -+#define R_0x1a04 0x1a04 -+#define R_0x1a08 0x1a08 -+#define R_0x1a0c 0x1a0c -+#define R_0x1a10 0x1a10 -+#define R_0x1a14 0x1a14 -+#define R_0x1a18 0x1a18 -+#define R_0x1a1c 0x1a1c -+#define R_0x1a20 0x1a20 -+#define R_0x1a24 0x1a24 -+#define R_0x1a28 0x1a28 -+#define R_0x1a2c 0x1a2c -+#define R_0x1a30 0x1a30 -+#define R_0x1a34 0x1a34 -+#define R_0x1a38 0x1a38 -+#define R_0x1a48 0x1a48 -+#define R_0x1a5c 0x1a5c -+#define R_0x1a70 0x1a70 -+#define R_0x1a74 0x1a74 -+#define R_0x1a80 0x1a80 -+#define R_0x1a84 0x1a84 -+#define R_0x1a8c 0x1a8c -+#define R_0x1a94 0x1a94 -+#define R_0x1a98 0x1a98 -+#define R_0x1a9c 0x1a9c -+#define R_0x1aa0 0x1aa0 -+#define R_0x1aa8 0x1aa8 -+#define R_0x1aac 0x1aac -+#define R_0x1ab0 0x1ab0 -+#define R_0x1abc 0x1abc -+#define R_0x1ac0 0x1ac0 -+#define R_0x1ac8 0x1ac8 -+#define R_0x1acc 0x1acc -+#define R_0x1ad0 0x1ad0 -+#define R_0x1ad4 0x1ad4 -+#define R_0x1ae0 0x1ae0 -+#define R_0x1ae8 0x1ae8 -+#define R_0x1aec 0x1aec -+#define R_0x1b00 0x1b00 -+#define R_0x1b04 0x1b04 -+#define R_0x1b08 0x1b08 -+#define R_0x1b0c 0x1b0c -+#define R_0x1b10 0x1b10 -+#define R_0x1b14 0x1b14 -+#define R_0x1b18 0x1b18 -+#define R_0x1b1c 0x1b1c -+#define R_0x1b20 0x1b20 -+#define R_0x1b23 0x1b23 -+#define R_0x1b24 0x1b24 -+#define R_0x1b28 0x1b28 -+#define R_0x1b2c 0x1b2c -+#define R_0x1b30 0x1b30 -+#define R_0x1b34 0x1b34 -+#define R_0x1b38 0x1b38 -+#define R_0x1b3c 0x1b3c -+#define R_0x1b40 0x1b40 -+#define R_0x1b44 0x1b44 -+#define R_0x1b48 0x1b48 -+#define R_0x1b4c 0x1b4c -+#define R_0x1b50 0x1b50 -+#define R_0x1b54 0x1b54 -+#define R_0x1b58 0x1b58 -+#define R_0x1b5c 0x1b5c -+#define R_0x1b60 0x1b60 -+#define R_0x1b64 0x1b64 -+#define R_0x1b67 0x1b67 -+#define R_0x1b68 0x1b68 -+#define R_0x1b6c 0x1b6c -+#define R_0x1b70 0x1b70 -+#define R_0x1b74 0x1b74 -+#define R_0x1b78 0x1b78 -+#define R_0x1b7c 0x1b7c -+#define R_0x1b80 0x1b80 -+#define R_0x1b83 0x1b83 -+#define R_0x1b84 0x1b84 -+#define R_0x1b88 0x1b88 -+#define R_0x1b8c 0x1b8c -+#define R_0x1b90 0x1b90 -+#define R_0x1b92 0x1b92 -+#define R_0x1b94 0x1b94 -+#define R_0x1b97 0x1b97 -+#define R_0x1b98 0x1b98 -+#define R_0x1b9c 0x1b9c -+#define R_0x1ba0 0x1ba0 -+#define R_0x1ba4 0x1ba4 -+#define R_0x1ba8 0x1ba8 -+#define R_0x1bac 0x1bac -+#define R_0x1bb0 0x1bb0 -+#define R_0x1bb4 0x1bb4 -+#define R_0x1bb8 0x1bb8 -+#define R_0x1bbc 0x1bbc -+#define R_0x1bc0 0x1bc0 -+#define R_0x1bc4 0x1bc4 -+#define R_0x1bc8 0x1bc8 -+#define R_0x1bca 0x1bca -+#define R_0x1bcb 0x1bcb -+#define R_0x1bcc 0x1bcc -+#define R_0x1bce 0x1bce -+#define R_0x1bd0 0x1bd0 -+#define R_0x1bd4 0x1bd4 -+#define R_0x1bd6 0x1bd6 -+#define R_0x1bd8 0x1bd8 -+#define R_0x1bdc 0x1bdc -+#define R_0x1be3 0x1be3 -+#define R_0x1be4 0x1be4 -+#define R_0x1be8 0x1be8 -+#define R_0x1beb 0x1beb -+#define R_0x1bec 0x1bec -+#define R_0x1bef 0x1bef -+#define R_0x1bf0 0x1bf0 -+#define R_0x1bf4 0x1bf4 -+#define R_0x1bf8 0x1bf8 -+#define R_0x1bfc 0x1bfc -+#define R_0x1c 0x1c -+#define R_0x1c20 0x1c20 -+#define R_0x1c24 0x1c24 -+#define R_0x1c28 0x1c28 -+#define R_0x1c2c 0x1c2c -+#define R_0x1c30 0x1c30 -+#define R_0x1c34 0x1c34 -+#define R_0x1c38 0x1c38 -+#define R_0x1c3c 0x1c3c -+#define R_0x1c64 0x1c64 -+#define R_0x1c68 0x1c68 -+#define R_0x1c6c 0x1c6c -+#define R_0x1c74 0x1c74 -+#define R_0x1c78 0x1c78 -+#define R_0x1c7c 0x1c7c -+#define R_0x1c80 0x1c80 -+#define R_0x1c84 0x1c84 -+#define R_0x1c8c 0x1c8c -+#define R_0x1c90 0x1c90 -+#define R_0x1c94 0x1c94 -+#define R_0x1c98 0x1c98 -+#define R_0x1c9c 0x1c9c -+#define R_0x1ca0 0x1ca0 -+#define R_0x1ca4 0x1ca4 -+#define R_0x1cb0 0x1cb0 -+#define R_0x1cb8 0x1cb8 -+#define R_0x1cbc 0x1cbc -+#define R_0x1cc0 0x1cc0 -+#define R_0x1cd0 0x1cd0 -+#define R_0x1cd8 0x1cd8 -+#define R_0x1ce4 0x1ce4 -+#define R_0x1ce8 0x1ce8 -+#define R_0x1cec 0x1cec -+#define R_0x1cf0 0x1cf0 -+#define R_0x1cf4 0x1cf4 -+#define R_0x1cf8 0x1cf8 -+#define R_0x1d04 0x1d04 -+#define R_0x1d08 0x1d08 -+#define R_0x1d0c 0x1d0c -+#define R_0x1d10 0x1d10 -+#define R_0x1d2c 0x1d2c -+#define R_0x1d30 0x1d30 -+#define R_0x1d3c 0x1d3c -+#define R_0x1d40 0x1d40 -+#define R_0x1d44 0x1d44 -+#define R_0x1d48 0x1d48 -+#define R_0x1d58 0x1d58 -+#define R_0x1d60 0x1d60 -+#define R_0x1d6c 0x1d6c -+#define R_0x1d70 0x1d70 -+#define R_0x1d90 0x1d90 -+#define R_0x1d94 0x1d94 -+#define R_0x1d9c 0x1d9c -+#define R_0x1da4 0x1da4 -+#define R_0x1da8 0x1da8 -+#define R_0x1de8 0x1de8 -+#define R_0x1e14 0x1e14 -+#define R_0x1e18 0x1e18 -+#define R_0x1e1c 0x1e1c -+#define R_0x1e24 0x1e24 -+#define R_0x1e28 0x1e28 -+#define R_0x1e2c 0x1e2c -+#define R_0x1e28 0x1e28 -+#define R_0x1e30 0x1e30 -+#define R_0x1e40 0x1e40 -+#define R_0x1e44 0x1e44 -+#define R_0x1e48 0x1e48 -+#define R_0x1e4c 0x1e4c -+#define R_0x1e50 0x1e50 -+#define R_0x1e54 0x1e54 -+#define R_0x1e58 0x1e58 -+#define R_0x1e5c 0x1e5c -+#define R_0x1e60 0x1e60 -+#define R_0x1e64 0x1e64 -+#define R_0x1e68 0x1e68 -+#define R_0x1e6c 0x1e6c -+#define R_0x1e70 0x1e70 -+#define R_0x1e7c 0x1e7c -+#define R_0x1e80 0x1e80 -+#define R_0x1e84 0x1e84 -+#define R_0x1e88 0x1e88 -+#define R_0x1e8c 0x1e8c -+#define R_0x1ea4 0x1ea4 -+#define R_0x1ea8 0x1ea8 -+#define R_0x1eb4 0x1eb4 -+#define R_0x1eb8 0x1eb8 -+#define R_0x1ed4 0x1ed4 -+#define R_0x1ed8 0x1ed8 -+#define R_0x1edc 0x1edc -+#define R_0x1ee0 0x1ee0 -+#define R_0x1ee4 0x1ee4 -+#define R_0x1ee8 0x1ee8 -+#define R_0x1eec 0x1eec -+#define R_0x1ef0 0x1ef0 -+#define R_0x1ef4 0x1ef4 -+#define R_0x1ef8 0x1ef8 -+#define R_0x1efc 0x1efc -+#define R_0x1f80 0x1f80 -+#define R_0x1f98 0x1f98 -+#define R_0x24 0x24 -+#define R_0x28 0x28 -+#define R_0x2a00 0x2a00 -+#define R_0x2a04 0x2a04 -+#define R_0x2a08 0x2a08 -+#define R_0x2a24 0x2a24 -+#define R_0x2a38 0x2a38 -+#define R_0x2a3c 0x2a3c -+#define R_0x2a44 0x2a44 -+#define R_0x2aa0 0x2aa0 -+#define R_0x2aa8 0x2aa8 -+#define R_0x2aac 0x2aac -+#define R_0x2ad0 0x2ad0 -+#define R_0x2c 0x2c -+#define R_0x28a4 0x28a4 -+#define R_0x28bc 0x28bc -+#define R_0x2c04 0x2c04 -+#define R_0x2c08 0x2c08 -+#define R_0x2c0c 0x2c0c -+#define R_0x2c10 0x2c10 -+#define R_0x2c14 0x2c14 -+#define R_0x2c18 0x2c18 -+#define R_0x2c1c 0x2c1c -+#define R_0x2c20 0x2c20 -+#define R_0x2c2c 0x2c2c -+#define R_0x2c30 0x2c30 -+#define R_0x2c34 0x2c34 -+#define R_0x2c54 0x2c54 -+#define R_0x2d00 0x2d00 -+#define R_0x2d04 0x2d04 -+#define R_0x2d08 0x2d08 -+#define R_0x2d0c 0x2d0c -+#define R_0x2d10 0x2d10 -+#define R_0x2d20 0x2d20 -+#define R_0x2d38 0x2d38 -+#define R_0x2d40 0x2d40 -+#define R_0x2d44 0x2d44 -+#define R_0x2d48 0x2d48 -+#define R_0x2d4c 0x2d4c -+#define R_0x2d6c 0x2d6c -+#define R_0x2d84 0x2d84 -+#define R_0x2d88 0x2d88 -+#define R_0x2d8c 0x2d8c -+#define R_0x2d90 0x2d90 -+#define R_0x2d9c 0x2d9c -+#define R_0x2db4 0x2db4 -+#define R_0x2db8 0x2db8 -+#define R_0x2dbc 0x2dbc -+#define R_0x2de0 0x2de0 -+#define R_0x2de4 0x2de4 -+#define R_0x2de8 0x2de8 -+#define R_0x2e00 0x2e00 -+#define R_0x2e20 0x2e20 -+#define R_0x2e60 0x2e60 -+#define R_0x2e64 0x2e64 -+#define R_0x2e68 0x2e68 -+#define R_0x2e6c 0x2e6c -+#define R_0x2e70 0x2e70 -+#define R_0x2e74 0x2e74 -+#define R_0x2e78 0x2e78 -+#define R_0x2e7c 0x2e7c -+#define R_0x2e80 0x2e80 -+#define R_0x300 0x300 -+#define R_0x38 0x38 -+#define R_0x3a00 0x3a00 -+#define R_0x3a04 0x3a04 -+#define R_0x3a08 0x3a08 -+#define R_0x3a0c 0x3a0c -+#define R_0x3a10 0x3a10 -+#define R_0x3a14 0x3a14 -+#define R_0x3a18 0x3a18 -+#define R_0x3a1c 0x3a1c -+#define R_0x3a20 0x3a20 -+#define R_0x3a24 0x3a24 -+#define R_0x3a28 0x3a28 -+#define R_0x3a2c 0x3a2c -+#define R_0x3a30 0x3a30 -+#define R_0x3a34 0x3a34 -+#define R_0x3a38 0x3a38 -+#define R_0x3a3c 0x3a3c -+#define R_0x3a40 0x3a40 -+#define R_0x3a44 0x3a44 -+#define R_0x3a48 0x3a48 -+#define R_0x3a4c 0x3a4c -+#define R_0x3a50 0x3a50 -+#define R_0x3a54 0x3a54 -+#define R_0x3a58 0x3a58 -+#define R_0x3a5c 0x3a5c -+#define R_0x3a60 0x3a60 -+#define R_0x3a64 0x3a64 -+#define R_0x3a68 0x3a68 -+#define R_0x3a6c 0x3a6c -+#define R_0x3a70 0x3a70 -+#define R_0x3a74 0x3a74 -+#define R_0x3a78 0x3a78 -+#define R_0x3a7c 0x3a7c -+#define R_0x3a80 0x3a80 -+#define R_0x3a84 0x3a84 -+#define R_0x3a88 0x3a88 -+#define R_0x3a8c 0x3a8c -+#define R_0x3a90 0x3a90 -+#define R_0x3a94 0x3a94 -+#define R_0x3a98 0x3a98 -+#define R_0x3a9c 0x3a9c -+#define R_0x3aa0 0x3aa0 -+#define R_0x3aa4 0x3aa4 -+#define R_0x3c00 0x3c00 -+#define R_0x40 0x40 -+#define R_0x4000 0x4000 -+#define R_0x4008 0x4008 -+#define R_0x4018 0x4018 -+#define R_0x401c 0x401c -+#define R_0x4028 0x4028 -+#define R_0x4040 0x4040 -+#define R_0x4044 0x4044 -+#define R_0x4100 0x4100 -+#define R_0x4104 0x4104 -+#define R_0x4108 0x4108 -+#define R_0x410c 0x410c -+#define R_0x4110 0x4110 -+#define R_0x4114 0x4114 -+#define R_0x4118 0x4118 -+#define R_0x411c 0x411c -+#define R_0x4130 0x4130 -+#define R_0x4134 0x4134 -+#define R_0x4138 0x4138 -+#define R_0x413c 0x413c -+#define R_0x4140 0x4140 -+#define R_0x4144 0x4144 -+#define R_0x4148 0x4148 -+#define R_0x4160 0x4160 -+#define R_0x4164 0x4164 -+#define R_0x4168 0x4168 -+#define R_0x416c 0x416c -+#define R_0x4180 0x4180 -+#define R_0x419c 0x419c -+#define R_0x41a0 0x41a0 -+#define R_0x41a4 0x41a4 -+#define R_0x41a8 0x41a8 -+#define R_0x41ac 0x41ac -+#define R_0x41e0 0x41e0 -+#define R_0x41e8 0x41e8 -+#define R_0x41ec 0x41ec -+#define R_0x41f0 0x41f0 -+#define R_0x41f8 0x41f8 -+#define R_0x41fc 0x41fc -+#define R_0x42 0x42 -+#define R_0x430 0x430 -+#define R_0x434 0x434 -+#define R_0x42a4 0x42a4 -+#define R_0x42b0 0x42b0 -+#define R_0x42b4 0x42b4 -+#define R_0x42e8 0x42e8 -+#define R_0x42f0 0x42f0 -+#define R_0x4300 0x4300 -+#define R_0x4304 0x4304 -+#define R_0x4308 0x4308 -+#define R_0x430c 0x430c -+#define R_0x4310 0x4310 -+#define R_0x4314 0x4314 -+#define R_0x4318 0x4318 -+#define R_0x431c 0x431c -+#define R_0x4320 0x4320 -+#define R_0x4324 0x4324 -+#define R_0x4328 0x4328 -+#define R_0x432c 0x432c -+#define R_0x4330 0x4330 -+#define R_0x4334 0x4334 -+#define R_0x4338 0x4338 -+#define R_0x433c 0x433c -+#define R_0x4340 0x4340 -+#define R_0x4344 0x4344 -+#define R_0x4348 0x4348 -+#define R_0x434c 0x434c -+#define R_0x4350 0x4350 -+#define R_0x4354 0x4354 -+#define R_0x4358 0x4358 -+#define R_0x435c 0x435c -+#define R_0x4360 0x4360 -+#define R_0x4364 0x4364 -+#define R_0x4368 0x4368 -+#define R_0x436c 0x436c -+#define R_0x4370 0x4370 -+#define R_0x4374 0x4374 -+#define R_0x4378 0x4378 -+#define R_0x437c 0x437c -+#define R_0x4380 0x4380 -+#define R_0x4384 0x4384 -+#define R_0x4388 0x4388 -+#define R_0x438c 0x438c -+#define R_0x4390 0x4390 -+#define R_0x4394 0x4394 -+#define R_0x4398 0x4398 -+#define R_0x439c 0x439c -+#define R_0x43a0 0x43a0 -+#define R_0x43a4 0x43a4 -+#define R_0x43a8 0x43a8 -+#define R_0x43ac 0x43ac -+#define R_0x43b0 0x43b0 -+#define R_0x43b4 0x43b4 -+#define R_0x43b8 0x43b8 -+#define R_0x44 0x44 -+#define R_0x440 0x440 -+#define R_0x444 0x444 -+#define R_0x448 0x448 -+#define R_0x450 0x450 -+#define R_0x454 0x454 -+#define R_0x494 0x494 -+#define R_0x498 0x498 -+#define R_0x49c 0x49c -+#define R_0x4a0 0x4a0 -+#define R_0x4a4 0x4a4 -+#define R_0x4a8 0x4a8 -+#define R_0x4c 0x4c -+#define R_0x4c8 0x4c8 -+#define R_0x4cc 0x4cc -+#define R_0x45a4 0x45a4 -+#define R_0x4c00 0x4c00 -+#define R_0x5000 0x5000 -+#define R_0x5008 0x5008 -+#define R_0x5018 0x5018 -+#define R_0x501c 0x501c -+#define R_0x5028 0x5028 -+#define R_0x5040 0x5040 -+#define R_0x5044 0x5044 -+#define R_0x5100 0x5100 -+#define R_0x5108 0x5108 -+#define R_0x5118 0x5118 -+#define R_0x511c 0x511c -+#define R_0x5128 0x5128 -+#define R_0x5140 0x5140 -+#define R_0x5144 0x5144 -+#define R_0x520 0x520 -+#define R_0x5200 0x5200 -+#define R_0x520c 0x520c -+#define R_0x522 0x522 -+#define R_0x524 0x524 -+#define R_0x5230 0x5230 -+#define R_0x5234 0x5234 -+#define R_0x5238 0x5238 -+#define R_0x523c 0x523c -+#define R_0x5240 0x5240 -+#define R_0x5244 0x5244 -+#define R_0x5248 0x5248 -+#define R_0x526c 0x526c -+#define R_0x5280 0x5280 -+#define R_0x52a0 0x52a0 -+#define R_0x52a4 0x52a4 -+#define R_0x52ac 0x52ac -+#define R_0x52e8 0x52e8 -+#define R_0x5300 0x5300 -+#define R_0x530c 0x530c -+#define R_0x5330 0x5330 -+#define R_0x5334 0x5334 -+#define R_0x5338 0x5338 -+#define R_0x533c 0x533c -+#define R_0x5340 0x5340 -+#define R_0x5344 0x5344 -+#define R_0x5348 0x5348 -+#define R_0x536c 0x536c -+#define R_0x5380 0x5380 -+#define R_0x53a0 0x53a0 -+#define R_0x53a4 0x53a4 -+#define R_0x53ac 0x53ac -+#define R_0x53e8 0x53e8 -+#define R_0x550 0x550 -+#define R_0x551 0x551 -+#define R_0x568 0x568 -+#define R_0x588 0x588 -+#define R_0x60 0x60 -+#define R_0x604 0x604 -+#define R_0x608 0x608 -+#define R_0x60c 0x60c -+#define R_0x60f 0x60f -+#define R_0x64 0x64 -+#define R_0x66 0x66 -+#define R_0x660 0x660 -+#define R_0x668 0x668 -+#define R_0x688 0x688 -+#define R_0x6a0 0x6a0 -+#define R_0x6d8 0x6d8 -+#define R_0x6dc 0x6dc -+#define R_0x6f8 0x6f8 -+#define R_0x70 0x70 -+#define R_0x74 0x74 -+#define R_0x700 0x700 -+#define R_0x71c 0x71c -+#define R_0x72c 0x72c -+#define R_0x764 0x764 -+#define R_0x7b0 0x7b0 -+#define R_0x7b4 0x7b4 -+#define R_0x7c0 0x7c0 -+#define R_0x7c4 0x7c4 -+#define R_0x7c8 0x7c8 -+#define R_0x7cc 0x7cc -+#define R_0x7f0 0x7f0 -+#define R_0x7f4 0x7f4 -+#define R_0x7f8 0x7f8 -+#define R_0x7fc 0x7fc -+#define R_0x800 0x800 -+#define R_0x8000 0x8000 -+#define R_0x804 0x804 -+#define R_0x808 0x808 -+#define R_0x80c 0x80c -+#define R_0x810 0x810 -+#define R_0x814 0x814 -+#define R_0x818 0x818 -+#define R_0x81c 0x81c -+#define R_0x820 0x820 -+#define R_0x824 0x824 -+#define R_0x828 0x828 -+#define R_0x82c 0x82c -+#define R_0x830 0x830 -+#define R_0x834 0x834 -+#define R_0x838 0x838 -+#define R_0x83c 0x83c -+#define R_0x840 0x840 -+#define R_0x844 0x840 -+#define R_0x848 0x848 -+#define R_0x84c 0x84c -+#define R_0x850 0x850 -+#define R_0x854 0x854 -+#define R_0x858 0x858 -+#define R_0x85c 0x85c -+#define R_0x860 0x860 -+#define R_0x864 0x864 -+#define R_0x868 0x868 -+#define R_0x86c 0x86c -+#define R_0x870 0x870 -+#define R_0x874 0x874 -+#define R_0x878 0x878 -+#define R_0x87c 0x87c -+#define R_0x880 0x880 -+#define R_0x884 0x884 -+#define R_0x888 0x888 -+#define R_0x88c 0x88c -+#define R_0x890 0x890 -+#define R_0x894 0x894 -+#define R_0x898 0x898 -+#define R_0x89c 0x89c -+#define R_0x8a0 0x8a0 -+#define R_0x8a4 0x8a4 -+#define R_0x8ac 0x8ac -+#define R_0x8b4 0x8b4 -+#define R_0x8b8 0x8b8 -+#define R_0x8c0 0x8c0 -+#define R_0x8c4 0x8c4 -+#define R_0x8c8 0x8c8 -+#define R_0x8cc 0x8cc -+#define R_0x8d0 0x8d0 -+#define R_0x8d4 0x8d4 -+#define R_0x8d8 0x8d8 -+#define R_0x8dc 0x8dc -+#define R_0x8f0 0x8f0 -+#define R_0x8f8 0x8f8 -+#define R_0x8fc 0x8fc -+#define R_0x900 0x900 -+#define R_0x908 0x908 -+#define R_0x90c 0x90c -+#define R_0x910 0x910 -+#define R_0x914 0x914 -+#define R_0x918 0x918 -+#define R_0x91c 0x91c -+#define R_0x920 0x920 -+#define R_0x924 0x924 -+#define R_0x92c 0x92c -+#define R_0x930 0x930 -+#define R_0x934 0x934 -+#define R_0x938 0x938 -+#define R_0x93c 0x93c -+#define R_0x940 0x940 -+#define R_0x944 0x944 -+#define R_0x948 0x948 -+#define R_0x94c 0x94c -+#define R_0x950 0x950 -+#define R_0x954 0x954 -+#define R_0x958 0x958 -+#define R_0x95c 0x95c -+#define R_0x960 0x960 -+#define R_0x964 0x964 -+#define R_0x968 0x968 -+#define R_0x970 0x970 -+#define R_0x974 0x974 -+#define R_0x978 0x978 -+#define R_0x97c 0x97c -+#define R_0x980 0x980 -+#define R_0x988 0x988 -+#define R_0x98c 0x98c -+#define R_0x990 0x990 -+#define R_0x994 0x994 -+#define R_0x998 0x998 -+#define R_0x99c 0x99c -+#define R_0x9a0 0x9a0 -+#define R_0x9a4 0x9a4 -+#define R_0x9ac 0x9ac -+#define R_0x9b0 0x9b0 -+#define R_0x9b4 0x9b4 -+#define R_0x9b8 0x9b8 -+#define R_0x9cc 0x9cc -+#define R_0x9d0 0x9d0 -+#define R_0x9d8 0x9d8 -+#define R_0x9e4 0x9e4 -+#define R_0x9e8 0x9e8 -+#define R_0x9f0 0x9f0 -+#define R_0xa0 0xa0 -+#define R_0xa00 0xa00 -+#define R_0xa04 0xa04 -+#define R_0xa08 0xa08 -+#define R_0xa0a 0xa0a -+#define R_0xa0c 0xa0c -+#define R_0xa10 0xa10 -+#define R_0xa14 0xa14 -+#define R_0xa20 0xa20 -+#define R_0xa24 0xa24 -+#define R_0xa28 0xa28 -+#define R_0xa2c 0xa2c -+#define R_0xa40 0xa40 -+#define R_0xa44 0xa44 -+#define R_0xa48 0xa48 -+#define R_0xa4c 0xa4c -+#define R_0xa50 0xa50 -+#define R_0xa54 0xa54 -+#define R_0xa58 0xa58 -+#define R_0xa68 0xa68 -+#define R_0xa6c 0xa6c -+#define R_0xa70 0xa70 -+#define R_0xa74 0xa74 -+#define R_0xa78 0xa78 -+#define R_0xa8 0xa8 -+#define R_0xa80 0xa80 -+#define R_0xa84 0xa84 -+#define R_0xa98 0xa98 -+#define R_0xa9c 0xa9c -+#define R_0xaa8 0xaa8 -+#define R_0xaac 0xaac -+#define R_0xab4 0xab4 -+#define R_0xabc 0xabc -+#define R_0xac 0xac -+#define R_0xac8 0xac8 -+#define R_0xacc 0xacc -+#define R_0xad0 0xad0 -+#define R_0xb0 0xb0 -+#define R_0xb00 0xb00 -+#define R_0xb04 0xb04 -+#define R_0xb07 0xb07 -+#define R_0xb08 0xb08 -+#define R_0xb0c 0xb0c -+#define R_0xb10 0xb10 -+#define R_0xb14 0xb14 -+#define R_0xb18 0xb18 -+#define R_0xb1c 0xb1c -+#define R_0xb20 0xb20 -+#define R_0xb24 0xb24 -+#define R_0xb28 0xb28 -+#define R_0xb2a 0xb2a -+#define R_0xb2b 0xb2b -+#define R_0xb2c 0xb2c -+#define R_0xb30 0xb30 -+#define R_0xb34 0xb34 -+#define R_0xb38 0xb38 -+#define R_0xb3b 0xb3b -+#define R_0xb3c 0xb3c -+#define R_0xb40 0xb40 -+#define R_0xb44 0xb44 -+#define R_0xb48 0xb48 -+#define R_0xb54 0xb54 -+#define R_0xb58 0xb58 -+#define R_0xb60 0xb60 -+#define R_0xb64 0xb64 -+#define R_0xb68 0xb68 -+#define R_0xb6a 0xb6a -+#define R_0xb6b 0xb6b -+#define R_0xb6c 0xb6c -+#define R_0xb6e 0xb6e -+#define R_0xb70 0xb70 -+#define R_0xb74 0xb74 -+#define R_0xb77 0xb77 -+#define R_0xb78 0xb78 -+#define R_0xb7c 0xb7c -+#define R_0xb80 0xb80 -+#define R_0xb84 0xb84 -+#define R_0xb88 0xb88 -+#define R_0xb8c 0xb8c -+#define R_0xb90 0xb90 -+#define R_0xb94 0xb94 -+#define R_0xb98 0xb98 -+#define R_0xb9b 0xb9b -+#define R_0xb9c 0xb9c -+#define R_0xba0 0xba0 -+#define R_0xba4 0xba4 -+#define R_0xba8 0xba8 -+#define R_0xbac 0xbac -+#define R_0xbad 0xbad -+#define R_0xbc0 0xbc0 -+#define R_0xbc4 0xbc4 -+#define R_0xbc8 0xbc8 -+#define R_0xbcc 0xbcc -+#define R_0xbd8 0xbd8 -+#define R_0xbdc 0xbdc -+#define R_0xbe0 0xbe0 -+#define R_0xbe4 0xbe4 -+#define R_0xbe8 0xbe8 -+#define R_0xbec 0xbec -+#define R_0xbf0 0xbf0 -+#define R_0xbf4 0xbf4 -+#define R_0xbf8 0xbf8 -+#define R_0xc00 0xc00 -+#define R_0xc04 0xc04 -+#define R_0xc08 0xc08 -+#define R_0xc0c 0xc0c -+#define R_0xc10 0xc10 -+#define R_0xc14 0xc14 -+#define R_0xc18 0xc18 -+#define R_0xc1c 0xc1c -+#define R_0xc20 0xc20 -+#define R_0xc24 0xc24 -+#define R_0xc2c 0xc2c -+#define R_0xc30 0xc30 -+#define R_0xc34 0xc34 -+#define R_0xc38 0xc38 -+#define R_0xc3c 0xc3c -+#define R_0xc40 0xc40 -+#define R_0xc44 0xc44 -+#define R_0xc4c 0xc4c -+#define R_0xc50 0xc50 -+#define R_0xc54 0xc54 -+#define R_0xc58 0xc58 -+#define R_0xc5c 0xc5c -+#define R_0xc6c 0xc6c -+#define R_0xc70 0xc70 -+#define R_0xc74 0xc74 -+#define R_0xc78 0xc78 -+#define R_0xc7c 0xc7c -+#define R_0xc80 0xc80 -+#define R_0xc84 0xc84 -+#define R_0xc88 0xc88 -+#define R_0xc8c 0xc8c -+#define R_0xc90 0xc90 -+#define R_0xc94 0xc94 -+#define R_0xc9c 0xc9c -+#define R_0xca0 0xca0 -+#define R_0xca4 0xca4 -+#define R_0xca8 0xca8 -+#define R_0xcac 0xcac -+#define R_0xcb0 0xcb0 -+#define R_0xcb4 0xcb4 -+#define R_0xcb8 0xcb8 -+#define R_0xcbc 0xcbc -+#define R_0xcbd 0xcbd -+#define R_0xcbe 0xcbe -+#define R_0xcc0 0xcc0 -+#define R_0xcc4 0xcc4 -+#define R_0xcc8 0xcc8 -+#define R_0xccc 0xccc -+#define R_0xcd0 0xcd0 -+#define R_0xcd4 0xcd4 -+#define R_0xcd8 0xcd8 -+#define R_0xce0 0xce0 -+#define R_0xce4 0xce4 -+#define R_0xce8 0xce8 -+#define R_0xd00 0xd00 -+#define R_0xd04 0xd04 -+#define R_0xd08 0xd08 -+#define R_0xd0c 0xd0c -+#define R_0xd10 0xd10 -+#define R_0xd14 0xd14 -+#define R_0xd2c 0xd2c -+#define R_0xd30 0xd30 -+#define R_0xd40 0xd40 -+#define R_0xd44 0xd44 -+#define R_0xd48 0xd48 -+#define R_0xd4c 0xd4c -+#define R_0xd50 0xd50 -+#define R_0xd54 0xd54 -+#define R_0xd5c 0xd5c -+#define R_0xd6c 0xd6c -+#define R_0xd7c 0xd7c -+#define R_0xd80 0xd80 -+#define R_0xd84 0xd84 -+#define R_0xd8c 0xd8c -+#define R_0xd90 0xd90 -+#define R_0xd94 0xd94 -+#define R_0xdac 0xdac -+#define R_0xdb0 0xdb0 -+#define R_0xdb4 0xdb4 -+#define R_0xdb8 0xdb8 -+#define R_0xdbc 0xdbc -+#define R_0xdc 0xdc -+#define R_0xdcc 0xdcc -+#define R_0xdd0 0xdd0 -+#define R_0xdd4 0xdd4 -+#define R_0xdd8 0xdd8 -+#define R_0xde0 0xde0 -+#define R_0xdec 0xdec -+#define R_0xdf4 0xdf4 -+#define R_0xe00 0xe00 -+#define R_0xe04 0xe04 -+#define R_0xe08 0xe08 -+#define R_0xe10 0xe10 -+#define R_0xe14 0xe14 -+#define R_0xe18 0xe18 -+#define R_0xe1c 0xe1c -+#define R_0xe20 0xe20 -+#define R_0xe24 0xe24 -+#define R_0xe28 0xe28 -+#define R_0xe30 0xe30 -+#define R_0xe34 0xe34 -+#define R_0xe38 0xe38 -+#define R_0xe3c 0xe3c -+#define R_0xe40 0xe40 -+#define R_0xe44 0xe44 -+#define R_0xe48 0xe48 -+#define R_0xe4c 0xe4c -+#define R_0xe50 0xe50 -+#define R_0xe54 0xe54 -+#define R_0xe5c 0xe5c -+#define R_0xe64 0xe64 -+#define R_0xe6c 0xe6c -+#define R_0xe70 0xe70 -+#define R_0xe74 0xe74 -+#define R_0xe78 0xe78 -+#define R_0xe7c 0xe7c -+#define R_0xe80 0xe80 -+#define R_0xe84 0xe84 -+#define R_0xe88 0xe88 -+#define R_0xe8c 0xe8c -+#define R_0xe90 0xe90 -+#define R_0xe94 0xe94 -+#define R_0xe98 0xe98 -+#define R_0xe9c 0xe9c -+#define R_0xea0 0xea0 -+#define R_0xea4 0xea4 -+#define R_0xea8 0xea8 -+#define R_0xeac 0xeac -+#define R_0xeb0 0xeb0 -+#define R_0xeb4 0xeb4 -+#define R_0xeb8 0xeb8 -+#define R_0xebc 0xebc -+#define R_0xec 0xec -+#define R_0xec0 0xec0 -+#define R_0xec4 0xec4 -+#define R_0xec8 0xec8 -+#define R_0xecc 0xecc -+#define R_0xed0 0xed0 -+#define R_0xed4 0xed4 -+#define R_0xed8 0xed8 -+#define R_0xedc 0xedc -+#define R_0xee0 0xee0 -+#define R_0xee8 0xee8 -+#define R_0xeec 0xeec -+#define R_0xf0 0xf0 -+#define R_0xf00 0xf00 -+#define R_0xf04 0xf04 -+#define R_0xf08 0xf08 -+#define R_0xf0c 0xf0c -+#define R_0xf10 0xf10 -+#define R_0xf14 0xf14 -+#define R_0xf18 0xf18 -+#define R_0xf1c 0xf1c -+#define R_0xf20 0xf20 -+#define R_0xf24 0xf24 -+#define R_0xf2c 0xf2c -+#define R_0xf30 0xf30 -+#define R_0xf34 0xf34 -+#define R_0xf4 0xf4 -+#define R_0xf44 0xf44 -+#define R_0xf48 0xf48 -+#define R_0xf4c 0xf4c -+#define R_0xf50 0xf50 -+#define R_0xf54 0xf54 -+#define R_0xf58 0xf58 -+#define R_0xf5c 0xf5c -+#define R_0xf70 0xf70 -+#define R_0xf74 0xf74 -+#define R_0xf80 0xf80 -+#define R_0xf84 0xf84 -+#define R_0xf87 0xf87 -+#define R_0xf88 0xf88 -+#define R_0xf8c 0xf8c -+#define R_0xf90 0xf90 -+#define R_0xf94 0xf94 -+#define R_0xf98 0xf98 -+#define R_0xf9c 0xf9c -+#define R_0xfa0 0xfa0 -+#define R_0xfa4 0xfa4 -+#define R_0xfa8 0xfa8 -+#define R_0xfac 0xfac -+#define R_0xfb0 0xfb0 -+#define R_0xfb4 0xfb4 -+#define R_0xfb8 0xfb8 -+#define R_0xfbc 0xfbc -+#define R_0xfc0 0xfc0 -+#define R_0xfc4 0xfc4 -+#define R_0xfc8 0xfc8 -+#define R_0xfcc 0xfcc -+#define R_0xfd0 0xfd0 -+#define R_0xff0 0xff0 -+#define RF_0x0 0x0 -+#define RF_0x00 0x00 -+#define RF_0x08 0x08 -+#define RF_0x09 0x09 -+#define RF_0x0c 0x0c -+#define RF_0x0d 0x0d -+#define RF_0x1 0x1 -+#define RF_0x18 0x18 -+#define RF_0x19 0x19 -+#define RF_0x1a 0x1a -+#define RF_0x1bf0 0x1bf0 -+#define RF_0x2 0x2 -+#define RF_0x3 0x3 -+#define RF_0x1e 0x1e -+#define RF_0x1f 0x1f -+#define RF_0x20 0x20 -+#define RF_0x30 0x30 -+#define RF_0x31 0x31 -+#define RF_0x32 0x32 -+#define RF_0x33 0x33 -+#define RF_0x35 0x35 -+#define RF_0x3e 0x3e -+#define RF_0x3f 0x3f -+#define RF_0x4 0x4 -+#define RF_0x42 0x42 -+#define RF_0x43 0x43 -+#define RF_0x5 0x5 -+#define RF_0x51 0x51 -+#define RF_0x52 0x52 -+#define RF_0x53 0x53 -+#define RF_0x54 0x54 -+#define RF_0x55 0x55 -+#define RF_0x56 0x56 -+#define RF_0x57 0x57 -+#define RF_0x58 0x58 -+#define RF_0x5c 0x5c -+#define RF_0x5d 0x5d -+#define RF_0x5e 0x5e -+#define RF_0x60 0x60 -+#define RF_0x61 0x61 -+#define RF_0x63 0x63 -+#define RF_0x64 0x64 -+#define RF_0x65 0x65 -+#define RF_0x66 0x66 -+#define RF_0x67 0x67 -+#define RF_0x6d 0x6d -+#define RF_0x6e 0x6e -+#define RF_0x6f 0x6f -+#define RF_0x75 0x75 -+#define RF_0x76 0x76 -+#define RF_0x78 0x78 -+#define RF_0x7c 0x7c -+#define RF_0x7f 0x7f -+#define RF_0x8 0x8 -+#define RF_0x80 0x80 -+#define RF_0x81 0x81 -+#define RF_0x82 0x82 -+#define RF_0x83 0x83 -+#define RF_0x85 0x85 -+#define RF_0x86 0x86 -+#define RF_0x87 0x87 -+#define RF_0x88 0x88 -+#define RF_0x8a 0x8a -+#define RF_0x8b 0x8b -+#define RF_0x8c 0x8c -+#define RF_0x8d 0x8d -+#define RF_0x8f 0x8f -+#define RF_0x92 0x92 -+#define RF_0x93 0x93 -+#define RF_0x9e 0x9e -+#define RF_0x9f 0x9f -+#define RF_0xa3 0xa3 -+#define RF_0xa9 0xa9 -+#define RF_0xae 0xae -+#define RF_0xb0 0xb0 -+#define RF_0xb3 0xb3 -+#define RF_0xb4 0xb4 -+#define RF_0xb8 0xb8 -+#define RF_0xbc 0xbc -+#define RF_0xbe 0xbe -+#define RF_0xc4 0xc4 -+#define RF_0xc8 0xc8 -+#define RF_0xc9 0xc9 -+#define RF_0xca 0xca -+#define RF_0xcc 0xcc -+#define RF_0xd 0xd -+#define RF_0xdd 0xdd -+#define RF_0xde 0xde -+#define RF_0xdf 0xdf -+#define RF_0xed 0xed -+#define RF_0xee 0xee -+#define RF_0xef 0xef -+#define RF_0xf5 0xf5 -+#define RF_0xf6 0xf6 -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rssi_monitor.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rssi_monitor.c -new file mode 100644 -index 000000000..1fde03691 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rssi_monitor.c -@@ -0,0 +1,189 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*@************************************************************ -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef PHYDM_SUPPORT_RSSI_MONITOR -+ -+void phydm_rssi_monitor_h2c(void *dm_void, u8 macid) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_t = &dm->dm_ra_table; -+ struct cmn_sta_info *sta = dm->phydm_sta_info[macid]; -+ struct ra_sta_info *ra = NULL; -+ #ifdef CONFIG_BEAMFORMING -+ struct bf_cmn_info *bf = NULL; -+ #endif -+ u8 h2c[H2C_MAX_LENGTH] = {0}; -+ u8 stbc_en, ldpc_en; -+ u8 bf_en = 0; -+ u8 is_rx, is_tx; -+ -+ if (is_sta_active(sta)) { -+ ra = &sta->ra_info; -+ } else { -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "[Warning] %s\n", __func__); -+ return; -+ } -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "%s ======>\n", __func__); -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "MACID=%d\n", sta->mac_id); -+ -+ is_rx = (ra->txrx_state == RX_STATE) ? 1 : 0; -+ is_tx = (ra->txrx_state == TX_STATE) ? 1 : 0; -+ stbc_en = (sta->stbc_en) ? 1 : 0; -+ ldpc_en = (sta->ldpc_en) ? 1 : 0; -+ -+ #ifdef CONFIG_BEAMFORMING -+ bf = &sta->bf_info; -+ -+ if ((bf->ht_beamform_cap & BEAMFORMING_HT_BEAMFORMEE_ENABLE) || -+ (bf->vht_beamform_cap & BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) -+ bf_en = 1; -+ #endif -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "RA_th_ofst=(( %s%d ))\n", -+ ((ra_t->ra_ofst_direc) ? "+" : "-"), ra_t->ra_th_ofst); -+ -+ h2c[0] = sta->mac_id; -+ h2c[1] = 0; -+ h2c[2] = sta->rssi_stat.rssi; -+ h2c[3] = is_rx | (stbc_en << 1) | -+ ((dm->noisy_decision & 0x1) << 2) | (bf_en << 6); -+ h2c[4] = (ra_t->ra_th_ofst & 0x7f) | -+ ((ra_t->ra_ofst_direc & 0x1) << 7); -+ h2c[5] = 0; -+ h2c[6] = ((ra_t->ra_trigger_mode) << 2); -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "PHYDM h2c[0x42]=0x%x %x %x %x %x %x %x\n", -+ h2c[6], h2c[5], h2c[4], h2c[3], h2c[2], h2c[1], h2c[0]); -+ -+ #if (RTL8188E_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8188E) -+ odm_ra_set_rssi_8188e(dm, sta->mac_id, sta->rssi_stat.rssi); -+ else -+ #endif -+ { -+ odm_fill_h2c_cmd(dm, ODM_H2C_RSSI_REPORT, H2C_MAX_LENGTH, h2c); -+ } -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+void phydm_sta_rssi_init(void *dm_void, u8 macid, u8 init_rssi) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta = NULL; -+ struct rssi_info *rssi_t = NULL; -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "%s ======>\n", __func__); -+ -+ sta = dm->phydm_sta_info[macid]; -+ rssi_t = &sta->rssi_stat; -+ -+ rssi_t->rssi_acc = (init_rssi << RSSI_MA); -+ rssi_t->rssi = init_rssi; -+} -+#endif -+void phydm_calculate_rssi_min_max(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct cmn_sta_info *sta; -+ s8 rssi_max_tmp = 0, rssi_min_tmp = 100; -+ u8 i; -+ u8 sta_cnt = 0; -+ -+ if (!dm->is_linked) -+ return; -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "%s ======>\n", __func__); -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ sta = dm->phydm_sta_info[i]; -+ if (is_sta_active(sta)) { -+ sta_cnt++; -+ -+ if (sta->rssi_stat.rssi < rssi_min_tmp) { -+ rssi_min_tmp = sta->rssi_stat.rssi; -+ dm->rssi_min_macid = i; -+ } -+ -+ if (sta->rssi_stat.rssi > rssi_max_tmp) { -+ rssi_max_tmp = sta->rssi_stat.rssi; -+ dm->rssi_max_macid = i; -+ } -+ -+ /*@[Send RSSI to FW]*/ -+ if (!sta->ra_info.disable_ra) -+ phydm_rssi_monitor_h2c(dm, i); -+ -+ if (sta_cnt == dm->number_linked_client) -+ break; -+ } -+ } -+ dm->pre_rssi_min = dm->rssi_min; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (dm->number_linked_client == 0) -+ return; -+#endif -+ dm->rssi_max = (u8)rssi_max_tmp; -+ dm->rssi_min = (u8)rssi_min_tmp; -+} -+ -+void phydm_rssi_monitor_check(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ability & ODM_BB_RSSI_MONITOR)) -+ return; -+ -+ /*@for AP watchdog period = 1 sec*/ -+ if ((dm->phydm_sys_up_time % 2) == 1) -+ return; -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "%s ======>\n", __func__); -+ -+ phydm_calculate_rssi_min_max(dm); -+ -+ PHYDM_DBG(dm, DBG_RSSI_MNTR, "RSSI {max, min} = {%d, %d}\n", -+ dm->rssi_max, dm->rssi_min); -+} -+ -+void phydm_rssi_monitor_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ -+ dm->pre_rssi_min = 0; -+ dm->rssi_max = 0; -+ dm->rssi_min = 0; -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rssi_monitor.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rssi_monitor.h -new file mode 100644 -index 000000000..b0f446ea2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_rssi_monitor.h -@@ -0,0 +1,58 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDM_RSSI_MONITOR_H__ -+#define __PHYDM_RSSI_MONITOR_H__ -+ -+#define RSSI_MONITOR_VERSION "2.0" -+ -+/* @1 ============================================================ -+ * 1 Definition -+ * 1 ============================================================ -+ */ -+ -+/* @1 ============================================================ -+ * 1 structure -+ * 1 ============================================================ -+ */ -+ -+/* @1 ============================================================ -+ * 1 enumeration -+ * 1 ============================================================ -+ */ -+ -+/* @1 ============================================================ -+ * 1 function prototype -+ * 1 ============================================================ -+ */ -+ -+void phydm_rssi_monitor_check(void *dm_void); -+ -+void phydm_rssi_monitor_init(void *dm_void); -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+void phydm_sta_rssi_init(void *dm_void, u8 macid, u8 init_rssi); -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_smt_ant.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_smt_ant.c -new file mode 100644 -index 000000000..8e805b3ce ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_smt_ant.c -@@ -0,0 +1,2277 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/* ************************************************************ -+ * 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. -+ ******************************************************/ -+#if (defined(CONFIG_SMART_ANTENNA)) -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+#if (RTL8198F_SUPPORT == 1) -+void phydm_smt_ant_init_98f(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 val = 0; -+ -+ #if 0 -+ odm_set_bb_reg(dm, R_0x1da4, 0x3c, 4); /*6.25*4 = 25ms*/ -+ odm_set_bb_reg(dm, R_0x1da4, BIT(6), 1); -+ odm_set_bb_reg(dm, R_0x1da4, BIT(7), 1); -+ #endif -+} -+#endif -+#endif -+ -+#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) -+void phydm_cumitek_smt_ant_mapping_table_8822b( -+ void *dm_void, -+ u8 *table_path_a, -+ u8 *table_path_b) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 path_a_0to3_idx = 0; -+ u32 path_b_0to3_idx = 0; -+ u32 path_a_4to7_idx = 0; -+ u32 path_b_4to7_idx = 0; -+ -+ path_a_0to3_idx = ((table_path_a[3] & 0xf) << 24) | ((table_path_a[2] & 0xf) << 16) | ((table_path_a[1] & 0xf) << 8) | (table_path_a[0] & 0xf); -+ -+ path_b_0to3_idx = ((table_path_b[3] & 0xf) << 28) | ((table_path_b[2] & 0xf) << 20) | ((table_path_b[1] & 0xf) << 12) | ((table_path_b[0] & 0xf) << 4); -+ -+ path_a_4to7_idx = ((table_path_a[7] & 0xf) << 24) | ((table_path_a[6] & 0xf) << 16) | ((table_path_a[5] & 0xf) << 8) | (table_path_a[4] & 0xf); -+ -+ path_b_4to7_idx = ((table_path_b[7] & 0xf) << 28) | ((table_path_b[6] & 0xf) << 20) | ((table_path_b[5] & 0xf) << 12) | ((table_path_b[4] & 0xf) << 4); -+ -+#if 0 -+ /*PHYDM_DBG(dm, DBG_SMT_ANT, "mapping table{A, B} = {0x%x, 0x%x}\n", path_a_0to3_idx, path_b_0to3_idx);*/ -+#endif -+ -+ /*pathA*/ -+ odm_set_bb_reg(dm, R_0xca4, MASKDWORD, path_a_0to3_idx); /*@ant map 1*/ -+ odm_set_bb_reg(dm, R_0xca8, MASKDWORD, path_a_4to7_idx); /*@ant map 2*/ -+ -+ /*pathB*/ -+ odm_set_bb_reg(dm, R_0xea4, MASKDWORD, path_b_0to3_idx); /*@ant map 1*/ -+ odm_set_bb_reg(dm, R_0xea8, MASKDWORD, path_b_4to7_idx); /*@ant map 2*/ -+} -+ -+void phydm_cumitek_smt_ant_init_8822b( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant *smtant_table = &dm->smtant_table; -+ struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; -+ u32 value32; -+ -+ PHYDM_DBG(dm, DBG_SMT_ANT, "[8822B Cumitek SmtAnt Int]\n"); -+ -+ /*@========= MAC GPIO setting =================================*/ -+ -+ /* Pin, pin_name, RFE_CTRL_NUM*/ -+ -+ /* @A0, 55, 5G_TRSW, 3*/ -+ /* @A1, 52, 5G_TRSW, 0*/ -+ /* @A2, 25, 5G_TRSW, 8*/ -+ -+ /* @B0, 16, 5G_TRSW, 4*/ -+ /* @B1, 13, 5G_TRSW, 11*/ -+ /* @B2, 24, 5G_TRSW, 9*/ -+ -+ /*@for RFE_CTRL 8 & 9*/ -+ odm_set_mac_reg(dm, R_0x4c, BIT(24) | BIT(23), 2); -+ odm_set_mac_reg(dm, R_0x44, BIT(27) | BIT(26), 0); -+ -+ /*@for RFE_CTRL 0*/ -+ odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); -+ odm_set_mac_reg(dm, R_0x64, BIT(29), 1); -+ -+ /*@for RFE_CTRL 2 & 3*/ -+ odm_set_mac_reg(dm, R_0x4c, BIT(26), 0); -+ odm_set_mac_reg(dm, R_0x64, BIT(28), 1); -+ -+ /*@for RFE_CTRL 11*/ -+ odm_set_mac_reg(dm, R_0x40, BIT(3), 1); -+ -+ /*@0x604[25]=1 : 2bit mode for pathA&B&C&D*/ -+ /*@0x604[25]=0 : 3bit mode for pathA&B*/ -+ smtant_table->tx_desc_mode = 0; -+ odm_set_mac_reg(dm, R_0x604, BIT(25), (u32)smtant_table->tx_desc_mode); -+ -+ /*@========= BB RFE setting =================================*/ -+#if 0 -+ /*path A*/ -+ odm_set_bb_reg(dm, R_0x1990, BIT(3), 0); /*RFE_CTRL_3*/ /*A_0*/ -+ odm_set_bb_reg(dm, R_0xcbc, BIT(3), 0); /*@inv*/ -+ odm_set_bb_reg(dm, R_0xcb0, 0xf000, 8); -+ -+ odm_set_bb_reg(dm, R_0x1990, BIT(0), 0); /*RFE_CTRL_0*/ /*A_1*/ -+ odm_set_bb_reg(dm, R_0xcbc, BIT(0), 0); /*@inv*/ -+ odm_set_bb_reg(dm, R_0xcb0, 0xf, 0x9); -+ -+ odm_set_bb_reg(dm, R_0x1990, BIT(8), 0); /*RFE_CTRL_8*/ /*A_2*/ -+ odm_set_bb_reg(dm, R_0xcbc, BIT(8), 0); /*@inv*/ -+ odm_set_bb_reg(dm, R_0xcb4, 0xf, 0xa); -+ -+ -+ /*path B*/ -+ odm_set_bb_reg(dm, R_0x1990, BIT(4), 1); /*RFE_CTRL_4*/ /*B_0*/ -+ odm_set_bb_reg(dm, R_0xdbc, BIT(4), 0); /*@inv*/ -+ odm_set_bb_reg(dm, R_0xdb0, 0xf0000, 0xb); -+ -+ odm_set_bb_reg(dm, R_0x1990, BIT(11), 1); /*RFE_CTRL_11*/ /*B_1*/ -+ odm_set_bb_reg(dm, R_0xdbc, BIT(11), 0); /*@inv*/ -+ odm_set_bb_reg(dm, R_0xdb4, 0xf000, 0xc); -+ -+ odm_set_bb_reg(dm, R_0x1990, BIT(9), 1); /*RFE_CTRL_9*/ /*B_2*/ -+ odm_set_bb_reg(dm, R_0xdbc, BIT(9), 0); /*@inv*/ -+ odm_set_bb_reg(dm, R_0xdb4, 0xf0, 0xd); -+#endif -+ /*@========= BB SmtAnt setting =================================*/ -+ odm_set_mac_reg(dm, R_0x6d8, BIT(22) | BIT(21), 2); /*resp tx by register*/ -+ odm_set_mac_reg(dm, R_0x668, BIT(3), 1); -+ odm_set_bb_reg(dm, R_0x804, BIT(4), 0); /*@lathch antsel*/ -+ odm_set_bb_reg(dm, R_0x818, 0xf00000, 0); /*@keep tx by rx*/ -+ odm_set_bb_reg(dm, R_0x900, BIT(19), 0); /*@fast train*/ -+ odm_set_bb_reg(dm, R_0x900, BIT(18), 1); /*@1: by TXDESC*/ -+ -+ /*pathA*/ -+ odm_set_bb_reg(dm, R_0xca4, MASKDWORD, 0x03020100); /*@ant map 1*/ -+ odm_set_bb_reg(dm, R_0xca8, MASKDWORD, 0x07060504); /*@ant map 2*/ -+ odm_set_bb_reg(dm, R_0xcac, BIT(9), 0); /*@keep antsel map by GNT_BT*/ -+ -+ /*pathB*/ -+ odm_set_bb_reg(dm, R_0xea4, MASKDWORD, 0x30201000); /*@ant map 1*/ -+ odm_set_bb_reg(dm, R_0xea8, MASKDWORD, 0x70605040); /*@ant map 2*/ -+ odm_set_bb_reg(dm, R_0xeac, BIT(9), 0); /*@keep antsel map by GNT_BT*/ -+} -+ -+void phydm_cumitek_smt_ant_init_8197f( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant *smtant_table = &dm->smtant_table; -+ struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; -+ u32 value32; -+ -+ PHYDM_DBG(dm, DBG_SMT_ANT, "[8197F Cumitek SmtAnt Int]\n"); -+ -+ /*@GPIO setting*/ -+} -+ -+void phydm_cumitek_smt_ant_init_8192f( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant *smtant_table = &dm->smtant_table; -+ struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; -+ u32 value32; -+ PHYDM_DBG(dm, DBG_SMT_ANT, "[8192F Cumitek SmtAnt Int]\n"); -+ -+ /*@GPIO setting*/ -+} -+ -+void phydm_cumitek_smt_tx_ant_update( -+ void *dm_void, -+ u8 tx_ant_idx_path_a, -+ u8 tx_ant_idx_path_b, -+ u32 mac_id) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant *smtant_table = &dm->smtant_table; -+ struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Cumitek] Set TX-ANT[%d] = (( A:0x%x , B:0x%x ))\n", mac_id, -+ tx_ant_idx_path_a, tx_ant_idx_path_b); -+ -+ /*path-A*/ -+ cumi_smtant_table->tx_ant_idx[0][mac_id] = tx_ant_idx_path_a; /*@fill this value into TXDESC*/ -+ -+ /*path-B*/ -+ cumi_smtant_table->tx_ant_idx[1][mac_id] = tx_ant_idx_path_b; /*@fill this value into TXDESC*/ -+} -+ -+void phydm_cumitek_smt_rx_default_ant_update( -+ void *dm_void, -+ u8 rx_ant_idx_path_a, -+ u8 rx_ant_idx_path_b) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant *smtant_table = &dm->smtant_table; -+ struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Cumitek] Set RX-ANT = (( A:0x%x, B:0x%x ))\n", -+ rx_ant_idx_path_a, rx_ant_idx_path_b); -+ -+ /*path-A*/ -+ if (cumi_smtant_table->rx_default_ant_idx[0] != rx_ant_idx_path_a) { -+ #if (RTL8822B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ odm_set_bb_reg(dm, R_0xc08, BIT(21) | BIT(20) | BIT(19), rx_ant_idx_path_a); /*@default RX antenna*/ -+ odm_set_mac_reg(dm, R_0x6d8, BIT(2) | BIT(1) | BIT(0), rx_ant_idx_path_a); /*@default response TX antenna*/ -+ } -+ #endif -+ -+ #if (RTL8197F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197F) { -+ } -+ #endif -+ -+ /*@jj add 20170822*/ -+ #if (RTL8192F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8192F) { -+ } -+ #endif -+ cumi_smtant_table->rx_default_ant_idx[0] = rx_ant_idx_path_a; -+ } -+ -+ /*path-B*/ -+ if (cumi_smtant_table->rx_default_ant_idx[1] != rx_ant_idx_path_b) { -+ #if (RTL8822B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ odm_set_bb_reg(dm, R_0xe08, BIT(21) | BIT(20) | BIT(19), rx_ant_idx_path_b); /*@default antenna*/ -+ odm_set_mac_reg(dm, R_0x6d8, BIT(5) | BIT(4) | BIT(3), rx_ant_idx_path_b); /*@default response TX antenna*/ -+ } -+ #endif -+ -+ #if (RTL8197F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197F) { -+ } -+ #endif -+ -+ /*@jj add 20170822*/ -+ #if (RTL8192F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8192F) { -+ } -+ #endif -+ cumi_smtant_table->rx_default_ant_idx[1] = rx_ant_idx_path_b; -+ } -+} -+ -+void phydm_cumitek_smt_ant_debug( -+ void *dm_void, -+ char input[][16], -+ u32 *_used, -+ char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant *smtant_table = &dm->smtant_table; -+ struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ char help[] = "-h"; -+ u32 dm_value[10] = {0}; -+ u8 i; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &dm_value[0]); -+ -+ if (strcmp(input[1], help) == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{1} {PathA rx_ant_idx} {pathB rx_ant_idx}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{2} {PathA tx_ant_idx} {pathB tx_ant_idx} {macid}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{3} {PathA mapping table} {PathB mapping table}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "{4} {txdesc_mode 0:3bit, 1:2bit}\n"); -+ -+ } else if (dm_value[0] == 1) { /*@fix rx_idle pattern*/ -+ -+ PHYDM_SSCANF(input[2], DCMD_DECIMAL, &dm_value[1]); -+ PHYDM_SSCANF(input[3], DCMD_DECIMAL, &dm_value[2]); -+ -+ phydm_cumitek_smt_rx_default_ant_update(dm, (u8)dm_value[1], (u8)dm_value[2]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "RX Ant{A, B}={%d, %d}\n", dm_value[1], dm_value[2]); -+ -+ } else if (dm_value[0] == 2) { /*@fix tx pattern*/ -+ -+ for (i = 1; i < 4; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &dm_value[i]); -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "STA[%d] TX Ant{A, B}={%d, %d}\n", dm_value[3], -+ dm_value[1], dm_value[2]); -+ phydm_cumitek_smt_tx_ant_update(dm, (u8)dm_value[1], (u8)dm_value[2], (u8)dm_value[3]); -+ -+ } else if (dm_value[0] == 3) { -+ u8 table_path_a[8] = {0}; -+ u8 table_path_b[8] = {0}; -+ -+ for (i = 1; i < 4; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Set Path-AB mapping table={%d, %d}\n", dm_value[1], -+ dm_value[2]); -+ -+ for (i = 0; i < 8; i++) { -+ table_path_a[i] = (u8)((dm_value[1] >> (4 * i)) & 0xf); -+ table_path_b[i] = (u8)((dm_value[2] >> (4 * i)) & 0xf); -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Ant_Table_A[7:0]={0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x}\n", -+ table_path_a[7], table_path_a[6], table_path_a[5], -+ table_path_a[4], table_path_a[3], table_path_a[2], -+ table_path_a[1], table_path_a[0]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Ant_Table_B[7:0]={0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x}\n", -+ table_path_b[7], table_path_b[6], table_path_b[5], -+ table_path_b[4], table_path_b[3], table_path_b[2], -+ table_path_b[1], table_path_b[0]); -+ -+ phydm_cumitek_smt_ant_mapping_table_8822b(dm, &table_path_a[0], &table_path_b[0]); -+ -+ } else if (dm_value[0] == 4) { -+ smtant_table->tx_desc_mode = (u8)dm_value[1]; -+ odm_set_mac_reg(dm, R_0x604, BIT(25), (u32)smtant_table->tx_desc_mode); -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+#endif -+ -+#if (defined(CONFIG_HL_SMART_ANTENNA)) -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 -+ -+#if (RTL8822B_SUPPORT == 1) -+void phydm_hl_smart_ant_type2_init_8822b( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u8 j; -+ u8 rfu_codeword_table_init_2g[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B] = { -+ {1, 1}, /*@0*/ -+ {1, 2}, -+ {2, 1}, -+ {2, 2}, -+ {4, 0}, -+ {5, 0}, -+ {6, 0}, -+ {7, 0}, -+ {8, 0}, /*@8*/ -+ {9, 0}, -+ {0xa, 0}, -+ {0xb, 0}, -+ {0xc, 0}, -+ {0xd, 0}, -+ {0xe, 0}, -+ {0xf, 0}}; -+ u8 rfu_codeword_table_init_5g[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B] = { -+#if 1 -+ {9, 1}, /*@0*/ -+ {9, 9}, -+ {1, 9}, -+ {9, 6}, -+ {2, 1}, -+ {2, 9}, -+ {9, 2}, -+ {2, 2}, /*@8*/ -+ {6, 1}, -+ {6, 9}, -+ {2, 9}, -+ {2, 2}, -+ {6, 2}, -+ {6, 6}, -+ {2, 6}, -+ {1, 1} -+#else -+ {1, 1}, /*@0*/ -+ {9, 1}, -+ {9, 9}, -+ {1, 9}, -+ {1, 2}, -+ {9, 2}, -+ {9, 6}, -+ {1, 6}, -+ {2, 1}, /*@8*/ -+ {6, 1}, -+ {6, 9}, -+ {2, 9}, -+ {2, 2}, -+ {6, 2}, -+ {6, 6}, -+ {2, 6} -+#endif -+ }; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***RTK 8822B SmartAnt_Init: Hong-Bo SmrtAnt Type2]\n"); -+ -+ /* @---------------------------------------- */ -+ /* @GPIO 0-1 for Beam control */ -+ /* reg0x66[2:0]=0 */ -+ /* reg0x44[25:24] = 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 */ -+ /* @------------------------------------------ */ -+ -+ odm_move_memory(dm, sat_tab->rfu_codeword_table_2g, rfu_codeword_table_init_2g, (SUPPORT_BEAM_SET_PATTERN_NUM * MAX_PATH_NUM_8822B)); -+ odm_move_memory(dm, sat_tab->rfu_codeword_table_5g, rfu_codeword_table_init_5g, (SUPPORT_BEAM_SET_PATTERN_NUM * MAX_PATH_NUM_8822B)); -+ -+ /*@GPIO setting*/ -+ odm_set_mac_reg(dm, R_0x64, (BIT(18) | BIT(17) | BIT(16)), 0); -+ odm_set_mac_reg(dm, R_0x44, BIT(25) | BIT(24), 0); /*@config P_GPIO[3:2] to data port*/ -+ odm_set_mac_reg(dm, R_0x44, BIT(17) | BIT(16), 0x3); /*@enable_output for P_GPIO[3:2]*/ -+#if 0 -+ /*odm_set_mac_reg(dm, R_0x44, BIT(9)|BIT(8), 0);*/ /*P_GPIO[3:2] output value*/ -+#endif -+ odm_set_mac_reg(dm, R_0x40, BIT(1) | BIT(0), 0); /*@GPIO function*/ -+ -+ /*@Hong_lin smart antenna HW setting*/ -+ sat_tab->rfu_protocol_type = 2; -+ sat_tab->rfu_protocol_delay_time = 45; -+ -+ sat_tab->rfu_codeword_total_bit_num = 16; /*@max=32bit*/ -+ sat_tab->rfu_each_ant_bit_num = 4; -+ -+ sat_tab->total_beam_set_num = 4; -+ sat_tab->total_beam_set_num_2g = 4; -+ sat_tab->total_beam_set_num_5g = 8; -+ -+#if DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ if (dm->support_interface == ODM_ITRF_SDIO) -+ sat_tab->latch_time = 100; /*@mu sec*/ -+#endif -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB) -+ sat_tab->latch_time = 100; /*@mu sec*/ -+#endif -+ sat_tab->pkt_skip_statistic_en = 0; -+ -+ sat_tab->ant_num = 2; -+ sat_tab->ant_num_total = MAX_PATH_NUM_8822B; -+ sat_tab->first_train_ant = MAIN_ANT; -+ -+ sat_tab->fix_beam_pattern_en = 0; -+ sat_tab->decision_holding_period = 0; -+ -+ /*@beam training setting*/ -+ sat_tab->pkt_counter = 0; -+ sat_tab->per_beam_training_pkt_num = 10; -+ -+ /*set default beam*/ -+ sat_tab->fast_training_beam_num = 0; -+ sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; -+ -+ for (j = 0; j < SUPPORT_BEAM_SET_PATTERN_NUM; j++) { -+ sat_tab->beam_set_avg_rssi_pre[j] = 0; -+ sat_tab->beam_set_train_val_diff[j] = 0; -+ sat_tab->beam_set_train_cnt[j] = 0; -+ } -+ phydm_set_rfu_beam_pattern_type2(dm); -+ fat_tab->fat_state = FAT_BEFORE_LINK_STATE; -+} -+#endif -+ -+u32 phydm_construct_hb_rfu_codeword_type2( -+ void *dm_void, -+ u32 beam_set_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ u32 sync_codeword = 0x7f; -+ u32 codeword = 0; -+ u32 data_tmp = 0; -+ u32 i; -+ -+ for (i = 0; i < sat_tab->ant_num_total; i++) { -+ if (*dm->band_type == ODM_BAND_5G) -+ data_tmp = sat_tab->rfu_codeword_table_5g[beam_set_idx][i]; -+ else -+ data_tmp = sat_tab->rfu_codeword_table_2g[beam_set_idx][i]; -+ -+ codeword |= (data_tmp << (i * sat_tab->rfu_each_ant_bit_num)); -+ } -+ -+ codeword = (codeword << 8) | sync_codeword; -+ -+ return codeword; -+} -+ -+void phydm_update_beam_pattern_type2( -+ void *dm_void, -+ u32 codeword, -+ u32 codeword_length) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ u8 i; -+ boolean beam_ctrl_signal; -+ u32 one = 0x1; -+ u32 reg44_tmp_p, reg44_tmp_n, reg44_ori; -+ u8 devide_num = 4; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Set codeword = ((0x%x))\n", codeword); -+ -+ reg44_ori = odm_get_mac_reg(dm, R_0x44, MASKDWORD); -+ reg44_tmp_p = reg44_ori; -+#if 0 -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_ori =0x%x\n", reg44_ori);*/ -+#endif -+ -+ /*@devide_num = (sat_tab->rfu_protocol_type == 2) ? 8 : 4;*/ -+ -+ for (i = 0; i <= (codeword_length - 1); i++) { -+ beam_ctrl_signal = (boolean)((codeword & BIT(i)) >> i); -+ -+ #if 1 -+ if (dm->debug_components & DBG_ANT_DIV) { -+ if (i == (codeword_length - 1)) -+ pr_debug("%d ]\n", beam_ctrl_signal); -+ else if (i == 0) -+ pr_debug("Start sending codeword[1:%d] ---> [ %d ", codeword_length, beam_ctrl_signal); -+ else if ((i % devide_num) == (devide_num - 1)) -+ pr_debug("%d | ", beam_ctrl_signal); -+ else -+ pr_debug("%d ", beam_ctrl_signal); -+ } -+ #endif -+ -+ if (dm->support_ic_type == ODM_RTL8821) { -+ #if (RTL8821A_SUPPORT == 1) -+ reg44_tmp_p = reg44_ori & (~(BIT(11) | BIT(10))); /*@clean bit 10 & 11*/ -+ reg44_tmp_p |= ((1 << 11) | (beam_ctrl_signal << 10)); -+ reg44_tmp_n = reg44_ori & (~(BIT(11) | BIT(10))); -+ -+#if 0 -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n);*/ -+#endif -+ odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_p); -+ odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_n); -+ #endif -+ } -+ #if (RTL8822B_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8822B) { -+ if (sat_tab->rfu_protocol_type == 2) { -+ reg44_tmp_p = reg44_tmp_p & ~(BIT(8)); /*@clean bit 8*/ -+ reg44_tmp_p = reg44_tmp_p ^ BIT(9); /*@get new clk high/low, exclusive-or*/ -+ -+ reg44_tmp_p |= (beam_ctrl_signal << 8); -+ -+ odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_p); -+ ODM_delay_us(sat_tab->rfu_protocol_delay_time); -+#if 0 -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44 =(( 0x%x )), reg44[9:8] = ((%x)), beam_ctrl_signal =((%x))\n", reg44_tmp_p, ((reg44_tmp_p & 0x300)>>8), beam_ctrl_signal);*/ -+#endif -+ -+ } else { -+ reg44_tmp_p = reg44_ori & (~(BIT(9) | BIT(8))); /*@clean bit 9 & 8*/ -+ reg44_tmp_p |= ((1 << 9) | (beam_ctrl_signal << 8)); -+ reg44_tmp_n = reg44_ori & (~(BIT(9) | BIT(8))); -+ -+#if 0 -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n); */ -+#endif -+ odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_p); -+ ODM_delay_us(10); -+ odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_n); -+ ODM_delay_us(10); -+ } -+ } -+ #endif -+ } -+} -+ -+void phydm_update_rx_idle_beam_type2( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ u32 i; -+ -+ sat_tab->update_beam_codeword = phydm_construct_hb_rfu_codeword_type2(dm, sat_tab->rx_idle_beam_set_idx); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Update Rx-Idle-Beam ] BeamSet idx = ((%d))\n", -+ sat_tab->rx_idle_beam_set_idx); -+ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ phydm_update_beam_pattern_type2(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); -+#endif -+#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) -+ odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); -+#if 0 -+ /*odm_stall_execution(1);*/ -+#endif -+#endif -+ -+ sat_tab->pre_codeword = sat_tab->update_beam_codeword; -+} -+ -+void phydm_hl_smt_ant_dbg_type2( -+ void *dm_void, -+ char input[][16], -+ u32 *_used, -+ char *output, -+ u32 *_out_len -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 one = 0x1; -+ u32 codeword_length = sat_tab->rfu_codeword_total_bit_num; -+ u32 beam_ctrl_signal, i; -+ u8 devide_num = 4; -+ char help[] = "-h"; -+ u32 dm_value[10] = {0}; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &dm_value[0]); -+ PHYDM_SSCANF(input[2], DCMD_DECIMAL, &dm_value[1]); -+ PHYDM_SSCANF(input[3], DCMD_DECIMAL, &dm_value[2]); -+ PHYDM_SSCANF(input[4], DCMD_DECIMAL, &dm_value[3]); -+ PHYDM_SSCANF(input[5], DCMD_DECIMAL, &dm_value[4]); -+ -+ if (strcmp(input[1], help) == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " 1 {fix_en} {codeword(Hex)}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " 3 {Fix_training_num_en} {Per_beam_training_pkt_num} {Decision_holding_period}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " 5 {0:show, 1:2G, 2:5G} {beam_num} {idxA(Hex)} {idxB(Hex)}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " 7 {0:show, 1:2G, 2:5G} {total_beam_set_num}\n"); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ " 8 {0:show, 1:set} {RFU delay time(us)}\n"); -+ -+ } else if (dm_value[0] == 1) { /*@fix beam pattern*/ -+ -+ sat_tab->fix_beam_pattern_en = dm_value[1]; -+ -+ if (sat_tab->fix_beam_pattern_en == 1) { -+ PHYDM_SSCANF(input[3], DCMD_HEX, &dm_value[2]); -+ sat_tab->fix_beam_pattern_codeword = dm_value[2]; -+ -+ if (sat_tab->fix_beam_pattern_codeword > (one << codeword_length)) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ SmartAnt ] Codeword overflow, Current codeword is ((0x%x)), and should be less than ((%d))bit\n", -+ sat_tab->fix_beam_pattern_codeword, -+ codeword_length); -+ -+ (sat_tab->fix_beam_pattern_codeword) &= 0xffffff; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ SmartAnt ] Auto modify to (0x%x)\n", -+ sat_tab->fix_beam_pattern_codeword); -+ } -+ -+ sat_tab->update_beam_codeword = sat_tab->fix_beam_pattern_codeword; -+ -+ /*@---------------------------------------------------------*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Fix Beam Pattern\n"); -+ -+ /*@devide_num = (sat_tab->rfu_protocol_type == 2) ? 8 : 4;*/ -+ -+ for (i = 0; i <= (codeword_length - 1); i++) { -+ beam_ctrl_signal = (boolean)((sat_tab->update_beam_codeword & BIT(i)) >> i); -+ -+ if (i == (codeword_length - 1)) -+ PDM_SNPF(out_len, used, -+ output + used, -+ out_len - used, -+ "%d]\n", -+ beam_ctrl_signal); -+ else if (i == 0) -+ PDM_SNPF(out_len, used, -+ output + used, -+ out_len - used, -+ "Send Codeword[1:%d] to RFU -> [%d", -+ sat_tab->rfu_codeword_total_bit_num, -+ beam_ctrl_signal); -+ else if ((i % devide_num) == (devide_num - 1)) -+ PDM_SNPF(out_len, used, -+ output + used, -+ out_len - used, "%d|", -+ beam_ctrl_signal); -+ else -+ PDM_SNPF(out_len, used, -+ output + used, -+ out_len - used, "%d", -+ beam_ctrl_signal); -+ } -+/*@---------------------------------------------------------*/ -+ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ phydm_update_beam_pattern_type2(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); -+#endif -+#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) -+ odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); -+#if 0 -+ /*odm_stall_execution(1);*/ -+#endif -+#endif -+ } else if (sat_tab->fix_beam_pattern_en == 0) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ SmartAnt ] Smart Antenna: Enable\n"); -+ -+ } else if (dm_value[0] == 2) { /*set latch time*/ -+ -+ sat_tab->latch_time = dm_value[1]; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ SmartAnt ] latch_time =0x%x\n", -+ sat_tab->latch_time); -+ } else if (dm_value[0] == 3) { -+ sat_tab->fix_training_num_en = dm_value[1]; -+ -+ if (sat_tab->fix_training_num_en == 1) { -+ sat_tab->per_beam_training_pkt_num = (u8)dm_value[2]; -+ sat_tab->decision_holding_period = (u8)dm_value[3]; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[SmtAnt] Fix_train_en = (( %d )), train_pkt_num = (( %d )), holding_period = (( %d )),\n", -+ sat_tab->fix_training_num_en, -+ sat_tab->per_beam_training_pkt_num, -+ sat_tab->decision_holding_period); -+ -+ } else if (sat_tab->fix_training_num_en == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ SmartAnt ] AUTO per_beam_training_pkt_num\n"); -+ } -+ } else if (dm_value[0] == 4) { -+ #if 0 -+ if (dm_value[1] == 1) { -+ sat_tab->ant_num = 1; -+ sat_tab->first_train_ant = MAIN_ANT; -+ -+ } else if (dm_value[1] == 2) { -+ sat_tab->ant_num = 1; -+ sat_tab->first_train_ant = AUX_ANT; -+ -+ } else if (dm_value[1] == 3) { -+ sat_tab->ant_num = 2; -+ sat_tab->first_train_ant = MAIN_ANT; -+ } -+ -+ PDM_SNPF((output + used, out_len - used, -+ "[ SmartAnt ] Set ant Num = (( %d )), first_train_ant = (( %d ))\n", -+ sat_tab->ant_num, (sat_tab->first_train_ant - 1))); -+ #endif -+ } else if (dm_value[0] == 5) { /*set beam set table*/ -+ -+ PHYDM_SSCANF(input[4], DCMD_HEX, &dm_value[3]); -+ PHYDM_SSCANF(input[5], DCMD_HEX, &dm_value[4]); -+ -+ if (dm_value[1] == 1) { /*@2G*/ -+ if (dm_value[2] < SUPPORT_BEAM_SET_PATTERN_NUM) { -+ sat_tab->rfu_codeword_table_2g[dm_value[2]][0] = (u8)dm_value[3]; -+ sat_tab->rfu_codeword_table_2g[dm_value[2]][1] = (u8)dm_value[4]; -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "[SmtAnt] Set 2G Table[%d] = [A:0x%x, B:0x%x]\n", -+ dm_value[2], dm_value[3], dm_value[4]); -+ } -+ -+ } else if (dm_value[1] == 2) { /*@5G*/ -+ if (dm_value[2] < SUPPORT_BEAM_SET_PATTERN_NUM) { -+ sat_tab->rfu_codeword_table_5g[dm_value[2]][0] = (u8)dm_value[3]; -+ sat_tab->rfu_codeword_table_5g[dm_value[2]][1] = (u8)dm_value[4]; -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "[SmtAnt] Set5G Table[%d] = [A:0x%x, B:0x%x]\n", -+ dm_value[2], dm_value[3], dm_value[4]); -+ } -+ } else if (dm_value[1] == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[SmtAnt] 2G Beam Table==============>\n"); -+ for (i = 0; i < sat_tab->total_beam_set_num_2g; i++) { -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "2G Table[%d] = [A:0x%x, B:0x%x]\n", i, -+ sat_tab->rfu_codeword_table_2g[i][0], -+ sat_tab->rfu_codeword_table_2g[i][1]); -+ } -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[SmtAnt] 5G Beam Table==============>\n"); -+ for (i = 0; i < sat_tab->total_beam_set_num_5g; i++) { -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "5G Table[%d] = [A:0x%x, B:0x%x]\n", i, -+ sat_tab->rfu_codeword_table_5g[i][0], -+ sat_tab->rfu_codeword_table_5g[i][1]); -+ } -+ } -+ -+ } else if (dm_value[0] == 6) { -+#if 0 -+ if (dm_value[1] == 0) { -+ if (dm_value[2] < SUPPORT_BEAM_SET_PATTERN_NUM) { -+ sat_tab->rfu_codeword_table_5g[dm_value[2] ][0] = (u8)dm_value[3]; -+ sat_tab->rfu_codeword_table_5g[dm_value[2] ][1] = (u8)dm_value[4]; -+ PDM_SNPF((output + used, out_len - used, -+ "[SmtAnt] Set5G Table[%d] = [A:0x%x, B:0x%x]\n", -+ dm_value[2], dm_value[3], -+ dm_value[4])); -+ } -+ } else { -+ for (i = 0; i < sat_tab->total_beam_set_num_5g; i++) { -+ PDM_SNPF((output + used, out_len - used, -+ "[SmtAnt] Read 5G Table[%d] = [A:0x%x, B:0x%x]\n", -+ i, -+ sat_tab->rfu_codeword_table_5g[i][0], -+ sat_tab->rfu_codeword_table_5g[i][1])); -+ } -+ } -+#endif -+ } else if (dm_value[0] == 7) { -+ if (dm_value[1] == 1) { -+ sat_tab->total_beam_set_num_2g = (u8)(dm_value[2]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ SmartAnt ] total_beam_set_num_2g = ((%d))\n", -+ sat_tab->total_beam_set_num_2g); -+ -+ } else if (dm_value[1] == 2) { -+ sat_tab->total_beam_set_num_5g = (u8)(dm_value[2]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ SmartAnt ] total_beam_set_num_5g = ((%d))\n", -+ sat_tab->total_beam_set_num_5g); -+ } else if (dm_value[1] == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ SmartAnt ] Show total_beam_set_num{2g,5g} = {%d,%d}\n", -+ sat_tab->total_beam_set_num_2g, -+ sat_tab->total_beam_set_num_5g); -+ } -+ -+ } else if (dm_value[0] == 8) { -+ if (dm_value[1] == 1) { -+ sat_tab->rfu_protocol_delay_time = (u16)(dm_value[2]); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[SmtAnt] Set rfu_protocol_delay_time = ((%d))\n", -+ sat_tab->rfu_protocol_delay_time); -+ } else if (dm_value[1] == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[SmtAnt] Read rfu_protocol_delay_time = ((%d))\n", -+ sat_tab->rfu_protocol_delay_time); -+ } -+ } -+ -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_set_rfu_beam_pattern_type2( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ -+ if (dm->ant_div_type != HL_SW_SMART_ANT_TYPE2) -+ return; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Training beam_set index = (( 0x%x ))\n", -+ sat_tab->fast_training_beam_num); -+ sat_tab->update_beam_codeword = phydm_construct_hb_rfu_codeword_type2(dm, sat_tab->fast_training_beam_num); -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ phydm_update_beam_pattern_type2(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); -+ #endif -+ #if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) -+ odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); -+#if 0 -+ /*odm_stall_execution(1);*/ -+#endif -+ #endif -+} -+ -+void phydm_fast_ant_training_hl_smart_antenna_type2( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct sw_antenna_switch *dm_swat_table = &dm->dm_swat_table; -+ u32 codeword = 0; -+ u8 i = 0, j = 0; -+ u8 avg_rssi_tmp; -+ u8 avg_rssi_tmp_ma; -+ u8 max_beam_ant_rssi = 0; -+ u8 rssi_target_beam = 0, target_beam_max_rssi = 0; -+ u8 evm1ss_target_beam = 0, evm2ss_target_beam = 0; -+ u32 target_beam_max_evm1ss = 0, target_beam_max_evm2ss = 0; -+ u32 beam_tmp; -+ u8 per_beam_val_diff_tmp = 0, training_pkt_num_offset; -+ u32 avg_evm2ss[2] = {0}, avg_evm2ss_sum = 0; -+ u32 avg_evm1ss = 0; -+ u32 beam_path_evm_2ss_cnt_all = 0; /*sum of all 2SS-pattern cnt*/ -+ u32 beam_path_evm_1ss_cnt_all = 0; /*sum of all 1SS-pattern cnt*/ -+ u8 decision_type; -+ -+ if (!dm->is_linked) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[No Link!!!]\n"); -+ -+ if (fat_tab->is_become_linked == true) { -+ sat_tab->decision_holding_period = 0; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Link->no Link\n"); -+ fat_tab->fat_state = FAT_BEFORE_LINK_STATE; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "change to (( %d )) FAT_state\n", -+ fat_tab->fat_state); -+ fat_tab->is_become_linked = dm->is_linked; -+ } -+ return; -+ -+ } else { -+ if (fat_tab->is_become_linked == false) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Linked !!!]\n"); -+ -+ fat_tab->fat_state = FAT_PREPARE_STATE; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "change to (( %d )) FAT_state\n", -+ fat_tab->fat_state); -+ -+ /*sat_tab->fast_training_beam_num = 0;*/ -+ /*phydm_set_rfu_beam_pattern_type2(dm);*/ -+ -+ fat_tab->is_become_linked = dm->is_linked; -+ } -+ } -+ -+#if 0 -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "HL Smart ant Training: state (( %d ))\n", fat_tab->fat_state);*/ -+#endif -+ -+ /* @[DECISION STATE] */ -+ /*@=======================================================================================*/ -+ if (fat_tab->fat_state == FAT_DECISION_STATE) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ 3. In Decision state]\n"); -+ -+ /*@compute target beam in each antenna*/ -+ -+ for (j = 0; j < (sat_tab->total_beam_set_num); j++) { -+ /*@[Decision1: RSSI]-------------------------------------------------------------------*/ -+ if (sat_tab->statistic_pkt_cnt[j] == 0) { /*@if new RSSI = 0 -> MA_RSSI-=2*/ -+ avg_rssi_tmp = sat_tab->beam_set_avg_rssi_pre[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 = (u8)((sat_tab->beam_set_rssi_avg_sum[j]) / (sat_tab->statistic_pkt_cnt[j])); -+ avg_rssi_tmp_ma = (avg_rssi_tmp + sat_tab->beam_set_avg_rssi_pre[j]) >> 1; -+ } -+ -+ sat_tab->beam_set_avg_rssi_pre[j] = avg_rssi_tmp; -+ -+ if (avg_rssi_tmp > target_beam_max_rssi) { -+ rssi_target_beam = j; -+ target_beam_max_rssi = avg_rssi_tmp; -+ } -+ -+ /*@[Decision2: EVM 2ss]-------------------------------------------------------------------*/ -+ if (sat_tab->beam_path_evm_2ss_cnt[j] != 0) { -+ avg_evm2ss[0] = sat_tab->beam_path_evm_2ss_sum[j][0] / sat_tab->beam_path_evm_2ss_cnt[j]; -+ avg_evm2ss[1] = sat_tab->beam_path_evm_2ss_sum[j][1] / sat_tab->beam_path_evm_2ss_cnt[j]; -+ avg_evm2ss_sum = avg_evm2ss[0] + avg_evm2ss[1]; -+ beam_path_evm_2ss_cnt_all += sat_tab->beam_path_evm_2ss_cnt[j]; -+ -+ sat_tab->beam_set_avg_evm_2ss_pre[j] = (u8)avg_evm2ss_sum; -+ } -+ -+ if (avg_evm2ss_sum > target_beam_max_evm2ss) { -+ evm2ss_target_beam = j; -+ target_beam_max_evm2ss = avg_evm2ss_sum; -+ } -+ -+ /*@[Decision3: EVM 1ss]-------------------------------------------------------------------*/ -+ if (sat_tab->beam_path_evm_1ss_cnt[j] != 0) { -+ avg_evm1ss = sat_tab->beam_path_evm_1ss_sum[j] / sat_tab->beam_path_evm_1ss_cnt[j]; -+ beam_path_evm_1ss_cnt_all += sat_tab->beam_path_evm_1ss_cnt[j]; -+ -+ sat_tab->beam_set_avg_evm_1ss_pre[j] = (u8)avg_evm1ss; -+ } -+ -+ if (avg_evm1ss > target_beam_max_evm1ss) { -+ evm1ss_target_beam = j; -+ target_beam_max_evm1ss = avg_evm1ss; -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Beam[%d] Pkt_cnt=(( %d )), avg{MA,rssi}={%d, %d}, EVM1={%d}, EVM2={%d, %d, %d}\n", -+ j, sat_tab->statistic_pkt_cnt[j], -+ avg_rssi_tmp_ma, avg_rssi_tmp, avg_evm1ss, -+ avg_evm2ss[0], avg_evm2ss[1], avg_evm2ss_sum); -+ -+ /*reset counter value*/ -+ sat_tab->beam_set_rssi_avg_sum[j] = 0; -+ sat_tab->beam_path_rssi_sum[j][0] = 0; -+ sat_tab->beam_path_rssi_sum[j][1] = 0; -+ sat_tab->statistic_pkt_cnt[j] = 0; -+ -+ sat_tab->beam_path_evm_2ss_sum[j][0] = 0; -+ sat_tab->beam_path_evm_2ss_sum[j][1] = 0; -+ sat_tab->beam_path_evm_2ss_cnt[j] = 0; -+ -+ sat_tab->beam_path_evm_1ss_sum[j] = 0; -+ sat_tab->beam_path_evm_1ss_cnt[j] = 0; -+ } -+ -+ /*@[Joint Decision]-------------------------------------------------------------------*/ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "--->1.[RSSI] Target Beam(( %d )) RSSI_max=((%d))\n", -+ rssi_target_beam, target_beam_max_rssi); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "--->2.[Evm2SS] Target Beam(( %d )) EVM2SS_max=((%d))\n", -+ evm2ss_target_beam, target_beam_max_evm2ss); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "--->3.[Evm1SS] Target Beam(( %d )) EVM1SS_max=((%d))\n", -+ evm1ss_target_beam, target_beam_max_evm1ss); -+ -+ if (target_beam_max_rssi <= 10) { -+ sat_tab->rx_idle_beam_set_idx = rssi_target_beam; -+ decision_type = 1; -+ } else { -+ if (beam_path_evm_2ss_cnt_all != 0) { -+ sat_tab->rx_idle_beam_set_idx = evm2ss_target_beam; -+ decision_type = 2; -+ } else if (beam_path_evm_1ss_cnt_all != 0) { -+ sat_tab->rx_idle_beam_set_idx = evm1ss_target_beam; -+ decision_type = 3; -+ } else { -+ sat_tab->rx_idle_beam_set_idx = rssi_target_beam; -+ decision_type = 1; -+ } -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "---> Decision_type=((%d)), Final Target Beam(( %d ))\n", -+ decision_type, sat_tab->rx_idle_beam_set_idx); -+ -+ /*@Calculate packet counter offset*/ -+ for (j = 0; j < (sat_tab->total_beam_set_num); j++) { -+ if (decision_type == 1) { -+ per_beam_val_diff_tmp = target_beam_max_rssi - sat_tab->beam_set_avg_rssi_pre[j]; -+ -+ } else if (decision_type == 2) { -+ per_beam_val_diff_tmp = ((u8)target_beam_max_evm2ss - sat_tab->beam_set_avg_evm_2ss_pre[j]) >> 1; -+ } else if (decision_type == 3) { -+ per_beam_val_diff_tmp = (u8)target_beam_max_evm1ss - sat_tab->beam_set_avg_evm_1ss_pre[j]; -+ } -+ sat_tab->beam_set_train_val_diff[j] = per_beam_val_diff_tmp; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Beam_Set[%d]: diff= ((%d))\n", j, -+ per_beam_val_diff_tmp); -+ } -+ -+ /*set beam in each antenna*/ -+ phydm_update_rx_idle_beam_type2(dm); -+ fat_tab->fat_state = FAT_PREPARE_STATE; -+ } -+ /* @[TRAINING STATE] */ -+ else if (fat_tab->fat_state == FAT_TRAINING_STATE) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ 2. In Training state]\n"); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "curr_beam_idx = (( %d )), pre_beam_idx = (( %d ))\n", -+ sat_tab->fast_training_beam_num, -+ sat_tab->pre_fast_training_beam_num); -+ -+ if (sat_tab->fast_training_beam_num > sat_tab->pre_fast_training_beam_num) -+ -+ sat_tab->force_update_beam_en = 0; -+ -+ else { -+ sat_tab->force_update_beam_en = 1; -+ -+ sat_tab->pkt_counter = 0; -+ beam_tmp = sat_tab->fast_training_beam_num; -+ if (sat_tab->fast_training_beam_num >= ((u32)sat_tab->total_beam_set_num - 1)) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Timeout Update] Beam_num (( %d )) -> (( decision ))\n", -+ sat_tab->fast_training_beam_num); -+ fat_tab->fat_state = FAT_DECISION_STATE; -+ phydm_fast_ant_training_hl_smart_antenna_type2(dm); -+ -+ } else { -+ sat_tab->fast_training_beam_num++; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Timeout Update] Beam_num (( %d )) -> (( %d ))\n", -+ beam_tmp, -+ sat_tab->fast_training_beam_num); -+ phydm_set_rfu_beam_pattern_type2(dm); -+ fat_tab->fat_state = FAT_TRAINING_STATE; -+ } -+ } -+ sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Update Pre_Beam =(( %d ))\n", -+ sat_tab->pre_fast_training_beam_num); -+ } -+ /* @[Prepare state] */ -+ /*@=======================================================================================*/ -+ else if (fat_tab->fat_state == FAT_PREPARE_STATE) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "\n\n[ 1. In Prepare state]\n"); -+ -+ if (dm->pre_traffic_load == dm->traffic_load) { -+ if (sat_tab->decision_holding_period != 0) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Holding_period = (( %d )), return!!!\n", -+ sat_tab->decision_holding_period); -+ sat_tab->decision_holding_period--; -+ return; -+ } -+ } -+ -+ /* Set training packet number*/ -+ if (sat_tab->fix_training_num_en == 0) { -+ switch (dm->traffic_load) { -+ case TRAFFIC_HIGH: -+ sat_tab->per_beam_training_pkt_num = 8; -+ sat_tab->decision_holding_period = 2; -+ break; -+ case TRAFFIC_MID: -+ sat_tab->per_beam_training_pkt_num = 6; -+ sat_tab->decision_holding_period = 3; -+ break; -+ case TRAFFIC_LOW: -+ sat_tab->per_beam_training_pkt_num = 3; /*ping 60000*/ -+ sat_tab->decision_holding_period = 4; -+ break; -+ case TRAFFIC_ULTRA_LOW: -+ sat_tab->per_beam_training_pkt_num = 1; -+ sat_tab->decision_holding_period = 6; -+ break; -+ default: -+ break; -+ } -+ } -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "TrafficLoad = (( %d )), Fix_beam = (( %d )), per_beam_training_pkt_num = (( %d )), decision_holding_period = ((%d))\n", -+ dm->traffic_load, sat_tab->fix_training_num_en, -+ sat_tab->per_beam_training_pkt_num, -+ sat_tab->decision_holding_period); -+ -+ /*@Beam_set number*/ -+ if (*dm->band_type == ODM_BAND_5G) { -+ sat_tab->total_beam_set_num = sat_tab->total_beam_set_num_5g; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "5G beam_set num = ((%d))\n", -+ sat_tab->total_beam_set_num); -+ } else { -+ sat_tab->total_beam_set_num = sat_tab->total_beam_set_num_2g; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "2G beam_set num = ((%d))\n", -+ sat_tab->total_beam_set_num); -+ } -+ -+ for (j = 0; j < (sat_tab->total_beam_set_num); j++) { -+ training_pkt_num_offset = sat_tab->beam_set_train_val_diff[j]; -+ -+ if (sat_tab->per_beam_training_pkt_num > training_pkt_num_offset) -+ sat_tab->beam_set_train_cnt[j] = sat_tab->per_beam_training_pkt_num - training_pkt_num_offset; -+ else -+ sat_tab->beam_set_train_cnt[j] = 1; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Beam_Set[ %d ] training_pkt_offset = ((%d)), training_pkt_num = ((%d))\n", -+ j, sat_tab->beam_set_train_val_diff[j], -+ sat_tab->beam_set_train_cnt[j]); -+ } -+ -+ sat_tab->pre_beacon_counter = sat_tab->beacon_counter; -+ sat_tab->update_beam_idx = 0; -+ sat_tab->pkt_counter = 0; -+ -+ sat_tab->fast_training_beam_num = 0; -+ phydm_set_rfu_beam_pattern_type2(dm); -+ sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; -+ fat_tab->fat_state = FAT_TRAINING_STATE; -+ } -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+void phydm_beam_switch_workitem_callback( -+ void *context) -+{ -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ -+#if DEV_BUS_TYPE != RT_PCI_INTERFACE -+ sat_tab->pkt_skip_statistic_en = 1; -+#endif -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ SmartAnt ] Beam Switch Workitem Callback, pkt_skip_statistic_en = (( %d ))\n", -+ sat_tab->pkt_skip_statistic_en); -+ -+ phydm_update_beam_pattern_type2(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); -+ -+#if DEV_BUS_TYPE != RT_PCI_INTERFACE -+#if 0 -+ /*odm_stall_execution(sat_tab->latch_time);*/ -+#endif -+ sat_tab->pkt_skip_statistic_en = 0; -+#endif -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "pkt_skip_statistic_en = (( %d )), latch_time = (( %d ))\n", -+ sat_tab->pkt_skip_statistic_en, sat_tab->latch_time); -+} -+ -+void phydm_beam_decision_workitem_callback( -+ void *context) -+{ -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ SmartAnt ] Beam decision Workitem Callback\n"); -+ phydm_fast_ant_training_hl_smart_antenna_type2(dm); -+} -+#endif -+ -+void phydm_process_rssi_for_hb_smtant_type2( -+ void *dm_void, -+ void *phy_info_void, -+ void *pkt_info_void, -+ u8 rssi_avg) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_phyinfo_struct *phy_info = (struct phydm_phyinfo_struct *)phy_info_void; -+ struct phydm_perpkt_info_struct *pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ u8 train_pkt_number; -+ u32 beam_tmp; -+ u8 rx_power_ant0 = phy_info->rx_mimo_signal_strength[0]; -+ u8 rx_power_ant1 = phy_info->rx_mimo_signal_strength[1]; -+ u8 rx_evm_ant0 = phy_info->rx_mimo_evm_dbm[0]; -+ u8 rx_evm_ant1 = phy_info->rx_mimo_evm_dbm[1]; -+ -+ /*@[Beacon]*/ -+ if (pktinfo->is_packet_beacon) { -+ sat_tab->beacon_counter++; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "MatchBSSID_beacon_counter = ((%d))\n", -+ sat_tab->beacon_counter); -+ -+ if (sat_tab->beacon_counter >= sat_tab->pre_beacon_counter + 2) { -+ sat_tab->update_beam_idx++; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "pre_beacon_counter = ((%d)), pkt_counter = ((%d)), update_beam_idx = ((%d))\n", -+ sat_tab->pre_beacon_counter, -+ sat_tab->pkt_counter, -+ sat_tab->update_beam_idx); -+ -+ sat_tab->pre_beacon_counter = sat_tab->beacon_counter; -+ sat_tab->pkt_counter = 0; -+ } -+ } -+ /*@[data]*/ -+ else if (pktinfo->is_packet_to_self) { -+ if (sat_tab->pkt_skip_statistic_en == 0) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "ID[%d] pkt_cnt=((%d)): Beam_set = ((%d)), RSSI{A,B,avg} = {%d, %d, %d}\n", -+ pktinfo->station_id, sat_tab->pkt_counter, -+ sat_tab->fast_training_beam_num, -+ rx_power_ant0, rx_power_ant1, rssi_avg); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Rate_ss = ((%d)), EVM{A,B} = {%d, %d}, RX Rate =", -+ pktinfo->rate_ss, rx_evm_ant0, rx_evm_ant1); -+ phydm_print_rate(dm, dm->rx_rate, DBG_ANT_DIV); -+ -+ if (sat_tab->pkt_counter >= 1) /*packet skip count*/ -+ { -+ sat_tab->beam_set_rssi_avg_sum[sat_tab->fast_training_beam_num] += rssi_avg; -+ sat_tab->statistic_pkt_cnt[sat_tab->fast_training_beam_num]++; -+ -+ sat_tab->beam_path_rssi_sum[sat_tab->fast_training_beam_num][0] += rx_power_ant0; -+ sat_tab->beam_path_rssi_sum[sat_tab->fast_training_beam_num][1] += rx_power_ant1; -+ -+ if (pktinfo->rate_ss == 2) { -+ sat_tab->beam_path_evm_2ss_sum[sat_tab->fast_training_beam_num][0] += rx_evm_ant0; -+ sat_tab->beam_path_evm_2ss_sum[sat_tab->fast_training_beam_num][1] += rx_evm_ant1; -+ sat_tab->beam_path_evm_2ss_cnt[sat_tab->fast_training_beam_num]++; -+ } else { -+ sat_tab->beam_path_evm_1ss_sum[sat_tab->fast_training_beam_num] += rx_evm_ant0; -+ sat_tab->beam_path_evm_1ss_cnt[sat_tab->fast_training_beam_num]++; -+ } -+ } -+ -+ sat_tab->pkt_counter++; -+ -+ train_pkt_number = sat_tab->beam_set_train_cnt[sat_tab->fast_training_beam_num]; -+ -+ if (sat_tab->pkt_counter >= train_pkt_number) { -+ sat_tab->update_beam_idx++; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "pre_beacon_counter = ((%d)), Update_new_beam = ((%d))\n", -+ sat_tab->pre_beacon_counter, -+ sat_tab->update_beam_idx); -+ -+ sat_tab->pre_beacon_counter = sat_tab->beacon_counter; -+ sat_tab->pkt_counter = 0; -+ } -+ } -+ } -+ -+ if (sat_tab->update_beam_idx > 0) { -+ sat_tab->update_beam_idx = 0; -+ -+ if (sat_tab->fast_training_beam_num >= ((u32)sat_tab->total_beam_set_num - 1)) { -+ fat_tab->fat_state = FAT_DECISION_STATE; -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ phydm_fast_ant_training_hl_smart_antenna_type2(dm); /*@go to make decision*/ -+ #endif -+ #if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) -+ odm_schedule_work_item(&sat_tab->hl_smart_antenna_decision_workitem); -+ #endif -+ -+ } else { -+ beam_tmp = sat_tab->fast_training_beam_num; -+ sat_tab->fast_training_beam_num++; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Update Beam_num (( %d )) -> (( %d ))\n", -+ beam_tmp, sat_tab->fast_training_beam_num); -+ phydm_set_rfu_beam_pattern_type2(dm); -+ sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; -+ -+ fat_tab->fat_state = FAT_TRAINING_STATE; -+ } -+ } -+} -+#endif -+ -+#if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1)) -+ -+void phydm_hl_smart_ant_type1_init_8821a( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ u32 value32; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "***8821A SmartAnt_Init => ant_div_type=[Hong-Lin Smart ant Type1]\n"); -+ -+#if 0 -+ /* @---------------------------------------- */ -+ /* @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 */ -+ /* @------------------------------------------ */ -+#endif -+ -+ /*@GPIO setting*/ -+ odm_set_mac_reg(dm, R_0x64, BIT(18), 0); -+ odm_set_mac_reg(dm, R_0x44, BIT(27) | BIT(26), 0); -+ odm_set_mac_reg(dm, R_0x44, BIT(19) | BIT(18), 0x3); /*@enable_output for P_GPIO[3:2]*/ -+#if 0 -+ /*odm_set_mac_reg(dm, R_0x44, BIT(11)|BIT(10), 0);*/ /*output value*/ -+#endif -+ odm_set_mac_reg(dm, R_0x40, BIT(1) | BIT(0), 0); /*@GPIO function*/ -+ -+ /*@Hong_lin smart antenna HW setting*/ -+ sat_tab->rfu_codeword_total_bit_num = 24; /*@max=32*/ -+ sat_tab->rfu_each_ant_bit_num = 4; -+ sat_tab->beam_patten_num_each_ant = 4; -+ -+#if DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ sat_tab->latch_time = 100; /*@mu sec*/ -+#elif DEV_BUS_TYPE == RT_USB_INTERFACE -+ sat_tab->latch_time = 100; /*@mu sec*/ -+#endif -+ sat_tab->pkt_skip_statistic_en = 0; -+ -+ sat_tab->ant_num = 1; /*@max=8*/ -+ sat_tab->ant_num_total = NUM_ANTENNA_8821A; -+ sat_tab->first_train_ant = MAIN_ANT; -+ -+ sat_tab->rfu_codeword_table[0] = 0x0; -+ sat_tab->rfu_codeword_table[1] = 0x4; -+ sat_tab->rfu_codeword_table[2] = 0x8; -+ sat_tab->rfu_codeword_table[3] = 0xc; -+ -+ sat_tab->rfu_codeword_table_5g[0] = 0x1; -+ sat_tab->rfu_codeword_table_5g[1] = 0x2; -+ sat_tab->rfu_codeword_table_5g[2] = 0x4; -+ sat_tab->rfu_codeword_table_5g[3] = 0x8; -+ -+ sat_tab->fix_beam_pattern_en = 0; -+ sat_tab->decision_holding_period = 0; -+ -+ /*@beam training setting*/ -+ sat_tab->pkt_counter = 0; -+ sat_tab->per_beam_training_pkt_num = 10; -+ -+ /*set default beam*/ -+ sat_tab->fast_training_beam_num = 0; -+ sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; -+ phydm_set_all_ant_same_beam_num(dm); -+ -+ fat_tab->fat_state = FAT_BEFORE_LINK_STATE; -+ -+ odm_set_bb_reg(dm, R_0xca4, MASKDWORD, 0x01000100); -+ odm_set_bb_reg(dm, R_0xca8, MASKDWORD, 0x01000100); -+ -+ /*@[BB] FAT setting*/ -+ odm_set_bb_reg(dm, R_0xc08, BIT(18) | BIT(17) | BIT(16), sat_tab->ant_num); -+ odm_set_bb_reg(dm, R_0xc08, BIT(31), 0); /*@increase ant num every FAT period 0:+1, 1+2*/ -+ odm_set_bb_reg(dm, R_0x8c4, BIT(2) | BIT(1), 1); /*@change cca antenna timming threshold if no CCA occurred: 0:200ms / 1:100ms / 2:no use / 3: 300*/ -+ odm_set_bb_reg(dm, R_0x8c4, BIT(0), 1); /*@FAT_watchdog_en*/ -+ -+ value32 = odm_get_mac_reg(dm, R_0x7b4, MASKDWORD); -+ odm_set_mac_reg(dm, R_0x7b4, MASKDWORD, value32 | (BIT(16) | BIT(17))); /*Reg7B4[16]=1 enable antenna training */ -+ /*Reg7B4[17]=1 enable match MAC addr*/ -+ odm_set_mac_reg(dm, R_0x7b4, 0xFFFF, 0); /*@Match MAC ADDR*/ -+ odm_set_mac_reg(dm, R_0x7b0, MASKDWORD, 0); -+} -+ -+u32 phydm_construct_hl_beam_codeword( -+ void *dm_void, -+ u32 *beam_pattern_idx, -+ u32 ant_num) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ u32 codeword = 0; -+ u32 data_tmp; -+ u32 i; -+ u32 break_counter = 0; -+ -+ if (ant_num < 8) { -+ for (i = 0; i < (sat_tab->ant_num_total); i++) { -+#if 0 -+ /*PHYDM_DBG(dm,DBG_ANT_DIV, "beam_pattern_num[%x] = %x\n",i,beam_pattern_num[i] );*/ -+#endif -+ if ((i < (sat_tab->first_train_ant - 1)) || break_counter >= sat_tab->ant_num) { -+ data_tmp = 0; -+ } else { -+ break_counter++; -+ -+ if (beam_pattern_idx[i] == 0) { -+ if (*dm->band_type == ODM_BAND_5G) -+ data_tmp = sat_tab->rfu_codeword_table_5g[0]; -+ else -+ data_tmp = sat_tab->rfu_codeword_table[0]; -+ -+ } else if (beam_pattern_idx[i] == 1) { -+ if (*dm->band_type == ODM_BAND_5G) -+ data_tmp = sat_tab->rfu_codeword_table_5g[1]; -+ else -+ data_tmp = sat_tab->rfu_codeword_table[1]; -+ -+ } else if (beam_pattern_idx[i] == 2) { -+ if (*dm->band_type == ODM_BAND_5G) -+ data_tmp = sat_tab->rfu_codeword_table_5g[2]; -+ else -+ data_tmp = sat_tab->rfu_codeword_table[2]; -+ -+ } else if (beam_pattern_idx[i] == 3) { -+ if (*dm->band_type == ODM_BAND_5G) -+ data_tmp = sat_tab->rfu_codeword_table_5g[3]; -+ else -+ data_tmp = sat_tab->rfu_codeword_table[3]; -+ } -+ } -+ -+ codeword |= (data_tmp << (i * 4)); -+ } -+ } -+ -+ return codeword; -+} -+ -+void phydm_update_beam_pattern( -+ void *dm_void, -+ u32 codeword, -+ u32 codeword_length) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ u8 i; -+ boolean beam_ctrl_signal; -+ u32 one = 0x1; -+ u32 reg44_tmp_p, reg44_tmp_n, reg44_ori; -+ u8 devide_num = 4; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ SmartAnt ] Set Beam Pattern =0x%x\n", -+ codeword); -+ -+ reg44_ori = odm_get_mac_reg(dm, R_0x44, MASKDWORD); -+ reg44_tmp_p = reg44_ori; -+#if 0 -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_ori =0x%x\n", reg44_ori);*/ -+#endif -+ -+ devide_num = (sat_tab->rfu_protocol_type == 2) ? 6 : 4; -+ -+ for (i = 0; i <= (codeword_length - 1); i++) { -+ beam_ctrl_signal = (boolean)((codeword & BIT(i)) >> i); -+ -+ if (dm->debug_components & DBG_ANT_DIV) { -+ if (i == (codeword_length - 1)) -+ pr_debug("%d ]\n", beam_ctrl_signal); -+ else if (i == 0) -+ pr_debug("Send codeword[1:%d] ---> [ %d ", codeword_length, beam_ctrl_signal); -+ else if ((i % devide_num) == (devide_num - 1)) -+ pr_debug("%d | ", beam_ctrl_signal); -+ else -+ pr_debug("%d ", beam_ctrl_signal); -+ } -+ -+ if (dm->support_ic_type == ODM_RTL8821) { -+ #if (RTL8821A_SUPPORT == 1) -+ reg44_tmp_p = reg44_ori & (~(BIT(11) | BIT(10))); /*@clean bit 10 & 11*/ -+ reg44_tmp_p |= ((1 << 11) | (beam_ctrl_signal << 10)); -+ reg44_tmp_n = reg44_ori & (~(BIT(11) | BIT(10))); -+ -+#if 0 -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n);*/ -+#endif -+ odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_p); -+ odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_n); -+ #endif -+ } -+ #if (RTL8822B_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8822B) { -+ if (sat_tab->rfu_protocol_type == 2) { -+ reg44_tmp_p = reg44_tmp_p & ~(BIT(8)); /*@clean bit 8*/ -+ reg44_tmp_p = reg44_tmp_p ^ BIT(9); /*@get new clk high/low, exclusive-or*/ -+ -+ reg44_tmp_p |= (beam_ctrl_signal << 8); -+ -+ odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_p); -+ ODM_delay_us(10); -+#if 0 -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44 =(( 0x%x )), reg44[9:8] = ((%x)), beam_ctrl_signal =((%x))\n", reg44_tmp_p, ((reg44_tmp_p & 0x300)>>8), beam_ctrl_signal);*/ -+#endif -+ -+ } else { -+ reg44_tmp_p = reg44_ori & (~(BIT(9) | BIT(8))); /*@clean bit 9 & 8*/ -+ reg44_tmp_p |= ((1 << 9) | (beam_ctrl_signal << 8)); -+ reg44_tmp_n = reg44_ori & (~(BIT(9) | BIT(8))); -+ -+#if 0 -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n); */ -+#endif -+ odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_p); -+ ODM_delay_us(10); -+ odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_n); -+ ODM_delay_us(10); -+ } -+ } -+ #endif -+ } -+} -+ -+void phydm_update_rx_idle_beam( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ u32 i; -+ -+ sat_tab->update_beam_codeword = phydm_construct_hl_beam_codeword(dm, -+ &sat_tab->rx_idle_beam[0], -+ sat_tab->ant_num); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Set target beam_pattern codeword = (( 0x%x ))\n", -+ sat_tab->update_beam_codeword); -+ -+ for (i = 0; i < (sat_tab->ant_num); i++) -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ Update Rx-Idle-Beam ] RxIdleBeam[%d] =%d\n", i, -+ sat_tab->rx_idle_beam[i]); -+ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ phydm_update_beam_pattern(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); -+#endif -+#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) -+ odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); -+#if 0 -+ /*odm_stall_execution(1);*/ -+#endif -+#endif -+ -+ sat_tab->pre_codeword = sat_tab->update_beam_codeword; -+} -+ -+void phydm_hl_smart_ant_debug( -+ void *dm_void, -+ char input[][16], -+ u32 *_used, -+ char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 one = 0x1; -+ u32 codeword_length = sat_tab->rfu_codeword_total_bit_num; -+ u32 beam_ctrl_signal, i; -+ u8 devide_num = 4; -+ -+ if (dm_value[0] == 1) { /*@fix beam pattern*/ -+ -+ sat_tab->fix_beam_pattern_en = dm_value[1]; -+ -+ if (sat_tab->fix_beam_pattern_en == 1) { -+ sat_tab->fix_beam_pattern_codeword = dm_value[2]; -+ -+ if (sat_tab->fix_beam_pattern_codeword > (one << codeword_length)) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ SmartAnt ] Codeword overflow, Current codeword is ((0x%x)), and should be less than ((%d))bit\n", -+ sat_tab->fix_beam_pattern_codeword, -+ codeword_length); -+ -+ (sat_tab->fix_beam_pattern_codeword) &= 0xffffff; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ SmartAnt ] Auto modify to (0x%x)\n", -+ sat_tab->fix_beam_pattern_codeword); -+ } -+ -+ sat_tab->update_beam_codeword = sat_tab->fix_beam_pattern_codeword; -+ -+ /*@---------------------------------------------------------*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "Fix Beam Pattern\n"); -+ -+ devide_num = (sat_tab->rfu_protocol_type == 2) ? 6 : 4; -+ -+ for (i = 0; i <= (codeword_length - 1); i++) { -+ beam_ctrl_signal = (boolean)((sat_tab->update_beam_codeword & BIT(i)) >> i); -+ -+ if (i == (codeword_length - 1)) -+ PDM_SNPF(out_len, used, -+ output + used, -+ out_len - used, -+ "%d]\n", -+ beam_ctrl_signal); -+ else if (i == 0) -+ PDM_SNPF(out_len, used, -+ output + used, -+ out_len - used, -+ "Send Codeword[1:24] to RFU -> [%d", -+ beam_ctrl_signal); -+ else if ((i % devide_num) == (devide_num - 1)) -+ PDM_SNPF(out_len, used, -+ output + used, -+ out_len - used, "%d|", -+ beam_ctrl_signal); -+ else -+ PDM_SNPF(out_len, used, -+ output + used, -+ out_len - used, "%d", -+ beam_ctrl_signal); -+ } -+/*@---------------------------------------------------------*/ -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ phydm_update_beam_pattern(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); -+ #endif -+ #if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) -+ odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); -+#if 0 -+ /*odm_stall_execution(1);*/ -+#endif -+ #endif -+ } else if (sat_tab->fix_beam_pattern_en == 0) -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ SmartAnt ] Smart Antenna: Enable\n"); -+ -+ } else if (dm_value[0] == 2) { /*set latch time*/ -+ -+ sat_tab->latch_time = dm_value[1]; -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ SmartAnt ] latch_time =0x%x\n", -+ sat_tab->latch_time); -+ } else if (dm_value[0] == 3) { -+ sat_tab->fix_training_num_en = dm_value[1]; -+ -+ if (sat_tab->fix_training_num_en == 1) { -+ sat_tab->per_beam_training_pkt_num = (u8)dm_value[2]; -+ sat_tab->decision_holding_period = (u8)dm_value[3]; -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[SmartAnt][Dbg] Fix_train_en = (( %d )), train_pkt_num = (( %d )), holding_period = (( %d )),\n", -+ sat_tab->fix_training_num_en, -+ sat_tab->per_beam_training_pkt_num, -+ sat_tab->decision_holding_period); -+ -+ } else if (sat_tab->fix_training_num_en == 0) { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ SmartAnt ] AUTO per_beam_training_pkt_num\n"); -+ } -+ } else if (dm_value[0] == 4) { -+ if (dm_value[1] == 1) { -+ sat_tab->ant_num = 1; -+ sat_tab->first_train_ant = MAIN_ANT; -+ -+ } else if (dm_value[1] == 2) { -+ sat_tab->ant_num = 1; -+ sat_tab->first_train_ant = AUX_ANT; -+ -+ } else if (dm_value[1] == 3) { -+ sat_tab->ant_num = 2; -+ sat_tab->first_train_ant = MAIN_ANT; -+ } -+ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ SmartAnt ] Set ant Num = (( %d )), first_train_ant = (( %d ))\n", -+ sat_tab->ant_num, (sat_tab->first_train_ant - 1)); -+ } else if (dm_value[0] == 5) { -+ if (dm_value[1] <= 3) { -+ sat_tab->rfu_codeword_table[dm_value[1]] = dm_value[2]; -+ PDM_SNPF(out_len, used, 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++) { -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "[ SmartAnt ] Show Beam_2G: (( %d )), RFU codeword table = (( 0x%x ))\n", -+ i, sat_tab->rfu_codeword_table[i]); -+ } -+ } -+ } else if (dm_value[0] == 6) { -+ if (dm_value[1] <= 3) { -+ sat_tab->rfu_codeword_table_5g[dm_value[1]] = dm_value[2]; -+ PDM_SNPF(out_len, used, 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++) { -+ PDM_SNPF(out_len, used, output + used, -+ out_len - used, -+ "[ SmartAnt ] Show Beam_5G: (( %d )), RFU codeword table = (( 0x%x ))\n", -+ i, sat_tab->rfu_codeword_table_5g[i]); -+ } -+ } -+ } else if (dm_value[0] == 7) { -+ if (dm_value[1] <= 4) { -+ sat_tab->beam_patten_num_each_ant = dm_value[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ SmartAnt ] Set Beam number = (( %d ))\n", -+ sat_tab->beam_patten_num_each_ant); -+ } else { -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "[ SmartAnt ] Show Beam number = (( %d ))\n", -+ sat_tab->beam_patten_num_each_ant); -+ } -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_set_all_ant_same_beam_num( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ -+ if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { /*@2ant for 8821A*/ -+ -+ sat_tab->rx_idle_beam[0] = sat_tab->fast_training_beam_num; -+ sat_tab->rx_idle_beam[1] = sat_tab->fast_training_beam_num; -+ } -+ -+ sat_tab->update_beam_codeword = phydm_construct_hl_beam_codeword(dm, -+ &sat_tab->rx_idle_beam[0], -+ sat_tab->ant_num); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ SmartAnt ] Set all ant beam_pattern: codeword = (( 0x%x ))\n", -+ sat_tab->update_beam_codeword); -+ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ phydm_update_beam_pattern(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); -+#endif -+#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) -+ odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); -+/*odm_stall_execution(1);*/ -+#endif -+} -+ -+void odm_fast_ant_training_hl_smart_antenna_type1( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -+ struct sw_antenna_switch *dm_swat_table = &dm->dm_swat_table; -+ u32 codeword = 0, i, j; -+ u32 target_ant; -+ u32 avg_rssi_tmp, avg_rssi_tmp_ma; -+ u32 target_ant_beam_max_rssi[SUPPORT_RF_PATH_NUM] = {0}; -+ u32 max_beam_ant_rssi = 0; -+ u32 target_ant_beam[SUPPORT_RF_PATH_NUM] = {0}; -+ u32 beam_tmp; -+ u8 next_ant; -+ u32 rssi_sorting_seq[SUPPORT_BEAM_PATTERN_NUM] = {0}; -+ u32 rank_idx_seq[SUPPORT_BEAM_PATTERN_NUM] = {0}; -+ u32 rank_idx_out[SUPPORT_BEAM_PATTERN_NUM] = {0}; -+ u8 per_beam_rssi_diff_tmp = 0, training_pkt_num_offset; -+ u32 break_counter = 0; -+ u32 used_ant; -+ -+ if (!dm->is_linked) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[No Link!!!]\n"); -+ -+ if (fat_tab->is_become_linked == true) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Link->no Link\n"); -+ fat_tab->fat_state = FAT_BEFORE_LINK_STATE; -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "change to (( %d )) FAT_state\n", -+ fat_tab->fat_state); -+ -+ fat_tab->is_become_linked = dm->is_linked; -+ } -+ return; -+ -+ } else { -+ if (fat_tab->is_become_linked == false) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[Linked !!!]\n"); -+ -+ fat_tab->fat_state = FAT_PREPARE_STATE; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "change to (( %d )) FAT_state\n", -+ fat_tab->fat_state); -+ -+#if 0 -+ /*sat_tab->fast_training_beam_num = 0;*/ -+ /*phydm_set_all_ant_same_beam_num(dm);*/ -+#endif -+ -+ fat_tab->is_become_linked = dm->is_linked; -+ } -+ } -+ -+ if (!(*fat_tab->p_force_tx_by_desc)) { -+ if (dm->is_one_entry_only == true) -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); -+ else -+ odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); -+ } -+ -+#if 0 -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "HL Smart ant Training: state (( %d ))\n", fat_tab->fat_state);*/ -+#endif -+ -+ /* @[DECISION STATE] */ -+ /*@=======================================================================================*/ -+ if (fat_tab->fat_state == FAT_DECISION_STATE) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ 3. In Decision state]\n"); -+ phydm_fast_training_enable(dm, FAT_OFF); -+ -+ break_counter = 0; -+ /*@compute target beam in each antenna*/ -+ for (i = (sat_tab->first_train_ant - 1); i < sat_tab->ant_num_total; i++) { -+ for (j = 0; j < (sat_tab->beam_patten_num_each_ant); j++) { -+ if (sat_tab->pkt_rssi_cnt[i][j] == 0) { -+ avg_rssi_tmp = sat_tab->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 = (sat_tab->pkt_rssi_sum[i][j]) / (sat_tab->pkt_rssi_cnt[i][j]); -+ avg_rssi_tmp_ma = (avg_rssi_tmp + sat_tab->pkt_rssi_pre[i][j]) >> 1; -+ } -+ -+ rssi_sorting_seq[j] = avg_rssi_tmp; -+ sat_tab->pkt_rssi_pre[i][j] = avg_rssi_tmp; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "ant[%d], Beam[%d]: pkt_cnt=(( %d )), avg_rssi_MA=(( %d )), avg_rssi=(( %d ))\n", -+ i, j, sat_tab->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*/ -+ sat_tab->pkt_rssi_sum[i][j] = 0; -+ sat_tab->pkt_rssi_cnt[i][j] = 0; -+ } -+ sat_tab->rx_idle_beam[i] = target_ant_beam[i]; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "---------> Target of ant[%d]: Beam_num-(( %d )) RSSI= ((%d))\n", -+ i, target_ant_beam[i], -+ target_ant_beam_max_rssi[i]); -+ -+#if 0 -+ /*sorting*/ -+ /*@ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[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(dm, &rssi_sorting_seq[0], &rank_idx_seq[0], &rank_idx_out[0], SUPPORT_BEAM_PATTERN_NUM);*/ -+ -+ /*@ -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[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]); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[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]); -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[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]); -+ */ -+#endif -+ -+ if (target_ant_beam_max_rssi[i] > max_beam_ant_rssi) { -+ target_ant = i; -+ max_beam_ant_rssi = target_ant_beam_max_rssi[i]; -+#if -+ /*PHYDM_DBG(dm, DBG_ANT_DIV, "Target of ant = (( %d )) max_beam_ant_rssi = (( %d ))\n", -+ target_ant, max_beam_ant_rssi);*/ -+#endif -+ } -+ break_counter++; -+ if (break_counter >= sat_tab->ant_num) -+ break; -+ } -+ -+#ifdef CONFIG_FAT_PATCH -+ break_counter = 0; -+ for (i = (sat_tab->first_train_ant - 1); i < sat_tab->ant_num_total; i++) { -+ for (j = 0; j < (sat_tab->beam_patten_num_each_ant); j++) { -+ per_beam_rssi_diff_tmp = (u8)(max_beam_ant_rssi - sat_tab->pkt_rssi_pre[i][j]); -+ sat_tab->beam_train_rssi_diff[i][j] = per_beam_rssi_diff_tmp; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "ant[%d], Beam[%d]: RSSI_diff= ((%d))\n", -+ i, j, per_beam_rssi_diff_tmp); -+ } -+ break_counter++; -+ if (break_counter >= sat_tab->ant_num) -+ break; -+ } -+#endif -+ -+ if (target_ant == 0) -+ target_ant = MAIN_ANT; -+ else if (target_ant == 1) -+ target_ant = AUX_ANT; -+ -+ if (sat_tab->ant_num > 1) { -+ /* @[ update RX ant ]*/ -+ odm_update_rx_idle_ant(dm, (u8)target_ant); -+ -+ /* @[ update TX ant ]*/ -+ odm_update_tx_ant(dm, (u8)target_ant, (fat_tab->train_idx)); -+ } -+ -+ /*set beam in each antenna*/ -+ phydm_update_rx_idle_beam(dm); -+ -+ odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); -+ fat_tab->fat_state = FAT_PREPARE_STATE; -+ return; -+ } -+ /* @[TRAINING STATE] */ -+ else if (fat_tab->fat_state == FAT_TRAINING_STATE) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "[ 2. In Training state]\n"); -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "fat_beam_n = (( %d )), pre_fat_beam_n = (( %d ))\n", -+ sat_tab->fast_training_beam_num, -+ sat_tab->pre_fast_training_beam_num); -+ -+ if (sat_tab->fast_training_beam_num > sat_tab->pre_fast_training_beam_num) -+ -+ sat_tab->force_update_beam_en = 0; -+ -+ else { -+ sat_tab->force_update_beam_en = 1; -+ -+ sat_tab->pkt_counter = 0; -+ beam_tmp = sat_tab->fast_training_beam_num; -+ if (sat_tab->fast_training_beam_num >= (sat_tab->beam_patten_num_each_ant - 1)) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Timeout Update] Beam_num (( %d )) -> (( decision ))\n", -+ sat_tab->fast_training_beam_num); -+ fat_tab->fat_state = FAT_DECISION_STATE; -+ odm_fast_ant_training_hl_smart_antenna_type1(dm); -+ -+ } else { -+ sat_tab->fast_training_beam_num++; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[Timeout Update] Beam_num (( %d )) -> (( %d ))\n", -+ beam_tmp, -+ sat_tab->fast_training_beam_num); -+ phydm_set_all_ant_same_beam_num(dm); -+ fat_tab->fat_state = FAT_TRAINING_STATE; -+ } -+ } -+ sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[prepare state] Update Pre_Beam =(( %d ))\n", -+ sat_tab->pre_fast_training_beam_num); -+ } -+ /* @[Prepare state] */ -+ /*@=======================================================================================*/ -+ else if (fat_tab->fat_state == FAT_PREPARE_STATE) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "\n\n[ 1. In Prepare state]\n"); -+ -+ if (dm->pre_traffic_load == dm->traffic_load) { -+ if (sat_tab->decision_holding_period != 0) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Holding_period = (( %d )), return!!!\n", -+ sat_tab->decision_holding_period); -+ sat_tab->decision_holding_period--; -+ return; -+ } -+ } -+ -+ /* Set training packet number*/ -+ if (sat_tab->fix_training_num_en == 0) { -+ switch (dm->traffic_load) { -+ case TRAFFIC_HIGH: -+ sat_tab->per_beam_training_pkt_num = 8; -+ sat_tab->decision_holding_period = 2; -+ break; -+ case TRAFFIC_MID: -+ sat_tab->per_beam_training_pkt_num = 6; -+ sat_tab->decision_holding_period = 3; -+ break; -+ case TRAFFIC_LOW: -+ sat_tab->per_beam_training_pkt_num = 3; /*ping 60000*/ -+ sat_tab->decision_holding_period = 4; -+ break; -+ case TRAFFIC_ULTRA_LOW: -+ sat_tab->per_beam_training_pkt_num = 1; -+ sat_tab->decision_holding_period = 6; -+ break; -+ default: -+ break; -+ } -+ } -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "Fix_training_en = (( %d )), training_pkt_num_base = (( %d )), holding_period = ((%d))\n", -+ sat_tab->fix_training_num_en, -+ sat_tab->per_beam_training_pkt_num, -+ sat_tab->decision_holding_period); -+ -+#ifdef CONFIG_FAT_PATCH -+ break_counter = 0; -+ for (i = (sat_tab->first_train_ant - 1); i < sat_tab->ant_num_total; i++) { -+ for (j = 0; j < (sat_tab->beam_patten_num_each_ant); j++) { -+ per_beam_rssi_diff_tmp = sat_tab->beam_train_rssi_diff[i][j]; -+ training_pkt_num_offset = per_beam_rssi_diff_tmp; -+ -+ if (sat_tab->per_beam_training_pkt_num > training_pkt_num_offset) -+ sat_tab->beam_train_cnt[i][j] = sat_tab->per_beam_training_pkt_num - training_pkt_num_offset; -+ else -+ sat_tab->beam_train_cnt[i][j] = 1; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "ant[%d]: Beam_num-(( %d )) training_pkt_num = ((%d))\n", -+ i, j, sat_tab->beam_train_cnt[i][j]); -+ } -+ break_counter++; -+ if (break_counter >= sat_tab->ant_num) -+ break; -+ } -+ -+ phydm_fast_training_enable(dm, FAT_OFF); -+ sat_tab->pre_beacon_counter = sat_tab->beacon_counter; -+ sat_tab->update_beam_idx = 0; -+ -+ if (*dm->band_type == ODM_BAND_5G) { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Set 5G ant\n"); -+ /*used_ant = (sat_tab->first_train_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT;*/ -+ used_ant = sat_tab->first_train_ant; -+ } else { -+ PHYDM_DBG(dm, DBG_ANT_DIV, "Set 2.4G ant\n"); -+ used_ant = sat_tab->first_train_ant; -+ } -+ -+ odm_update_rx_idle_ant(dm, (u8)used_ant); -+ -+#else -+ /* Set training MAC addr. of target */ -+ odm_set_next_mac_addr_target(dm); -+ phydm_fast_training_enable(dm, FAT_ON); -+#endif -+ -+ odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); -+ sat_tab->pkt_counter = 0; -+ sat_tab->fast_training_beam_num = 0; -+ phydm_set_all_ant_same_beam_num(dm); -+ sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; -+ fat_tab->fat_state = FAT_TRAINING_STATE; -+ } -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+void phydm_beam_switch_workitem_callback( -+ void *context) -+{ -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; -+ -+#if DEV_BUS_TYPE != RT_PCI_INTERFACE -+ sat_tab->pkt_skip_statistic_en = 1; -+#endif -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ SmartAnt ] Beam Switch Workitem Callback, pkt_skip_statistic_en = (( %d ))\n", -+ sat_tab->pkt_skip_statistic_en); -+ -+ phydm_update_beam_pattern(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); -+ -+#if DEV_BUS_TYPE != RT_PCI_INTERFACE -+#if 0 -+ /*odm_stall_execution(sat_tab->latch_time);*/ -+#endif -+ sat_tab->pkt_skip_statistic_en = 0; -+#endif -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "pkt_skip_statistic_en = (( %d )), latch_time = (( %d ))\n", -+ sat_tab->pkt_skip_statistic_en, sat_tab->latch_time); -+} -+ -+void phydm_beam_decision_workitem_callback( -+ void *context) -+{ -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+ PHYDM_DBG(dm, DBG_ANT_DIV, -+ "[ SmartAnt ] Beam decision Workitem Callback\n"); -+ odm_fast_ant_training_hl_smart_antenna_type1(dm); -+} -+#endif -+ -+#endif /*@#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ -+#endif /*@#ifdef CONFIG_HL_SMART_ANTENNA*/ -+ -+void phydm_smt_ant_config( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant *smtant_table = &dm->smtant_table; -+ -+#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) -+ -+ dm->support_ability |= ODM_BB_SMT_ANT; -+ smtant_table->smt_ant_vendor = SMTANT_CUMITEK; -+ smtant_table->smt_ant_type = 1; -+#if (RTL8822B_SUPPORT == 1) -+ dm->rfe_type = SMTANT_TMP_RFE_TYPE; -+#endif -+#elif (defined(CONFIG_HL_SMART_ANTENNA)) -+ -+ dm->support_ability |= ODM_BB_SMT_ANT; -+ smtant_table->smt_ant_vendor = SMTANT_HON_BO; -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ smtant_table->smt_ant_type = 1; -+#endif -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 -+ smtant_table->smt_ant_type = 2; -+#endif -+#endif -+ -+ PHYDM_DBG(dm, DBG_SMT_ANT, -+ "[SmtAnt Config] Vendor=((%d)), Smt_ant_type =((%d))\n", -+ smtant_table->smt_ant_vendor, smtant_table->smt_ant_type); -+} -+ -+void phydm_smt_ant_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct smt_ant *smtant_table = &dm->smtant_table; -+ -+ phydm_smt_ant_config(dm); -+ -+ if (smtant_table->smt_ant_vendor == SMTANT_CUMITEK) { -+#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) -+#if (RTL8822B_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8822B) -+ phydm_cumitek_smt_ant_init_8822b(dm); -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8197F) -+ phydm_cumitek_smt_ant_init_8197f(dm); -+#endif -+/*@jj add 20170822*/ -+#if (RTL8192F_SUPPORT == 1) -+ if (dm->support_ic_type == ODM_RTL8192F) -+ phydm_cumitek_smt_ant_init_8192f(dm); -+#endif -+#endif /*@#if (defined(CONFIG_CUMITEK_SMART_ANTENNA))*/ -+ -+ } else if (smtant_table->smt_ant_vendor == SMTANT_HON_BO) { -+#if (defined(CONFIG_HL_SMART_ANTENNA)) -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ if (dm->support_ic_type == ODM_RTL8821) -+ phydm_hl_smart_ant_type1_init_8821a(dm); -+#endif -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 -+ if (dm->support_ic_type == ODM_RTL8822B) -+ phydm_hl_smart_ant_type2_init_8822b(dm); -+#endif -+#endif /*@#if (defined(CONFIG_HL_SMART_ANTENNA))*/ -+ } -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_smt_ant.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_smt_ant.h -new file mode 100644 -index 000000000..3a408c4c6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_smt_ant.h -@@ -0,0 +1,210 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+#ifndef __PHYDMSMTANT_H__ -+#define __PHYDMSMTANT_H__ -+ -+/*@#define SMT_ANT_VERSION "1.1"*/ /*@2017.03.13*/ -+/*@#define SMT_ANT_VERSION "1.2"*/ /*@2017.03.28*/ -+#define SMT_ANT_VERSION "2.0" /* @Add Cumitek SmtAnt 2017.05.25*/ -+ -+#define SMTANT_RTK 1 -+#define SMTANT_HON_BO 2 -+#define SMTANT_CUMITEK 3 -+ -+#if (defined(CONFIG_SMART_ANTENNA)) -+ -+#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) -+struct smt_ant_cumitek { -+ u8 tx_ant_idx[2][ODM_ASSOCIATE_ENTRY_NUM]; /*@[pathA~B] [MACID 0~128]*/ -+ u8 rx_default_ant_idx[2]; /*@[pathA~B]*/ -+}; -+#endif -+ -+#if (defined(CONFIG_HL_SMART_ANTENNA)) -+struct smt_ant_honbo { -+ u32 latch_time; -+ boolean pkt_skip_statistic_en; -+ u32 fix_beam_pattern_en; -+ u32 fix_training_num_en; -+ u32 fix_beam_pattern_codeword; -+ u32 update_beam_codeword; -+ u32 ant_num; /*number of "used" smart beam antenna*/ -+ u32 ant_num_total;/*number of "total" smart beam antenna*/ -+ u32 first_train_ant; /*@decide witch antenna to train first*/ -+ -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ u32 pkt_rssi_pre[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM];/*@rssi of each path with a certain beam pattern*/ -+ u8 beam_train_rssi_diff[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; -+ u8 beam_train_cnt[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; -+ u32 rfu_codeword_table[4]; /*@2G beam truth table*/ -+ u32 rfu_codeword_table_5g[4]; /*@5G beam truth table*/ -+ u32 beam_patten_num_each_ant;/*@number of beam can be switched in each antenna*/ -+ u32 rx_idle_beam[SUPPORT_RF_PATH_NUM]; -+ u32 pkt_rssi_sum[8][SUPPORT_BEAM_PATTERN_NUM]; -+ u32 pkt_rssi_cnt[8][SUPPORT_BEAM_PATTERN_NUM]; -+ #endif -+ -+ u32 fast_training_beam_num;/*@current training beam_set index*/ -+ u32 pre_fast_training_beam_num;/*pre training beam_set index*/ -+ u32 rfu_codeword_total_bit_num; /* @total bit number of RFU protocol*/ -+ u32 rfu_each_ant_bit_num; /* @bit number of RFU protocol for each ant*/ -+ u8 per_beam_training_pkt_num; -+ u8 decision_holding_period; -+ -+ -+ u32 pre_codeword; -+ boolean force_update_beam_en; -+ u32 beacon_counter; -+ u32 pre_beacon_counter; -+ u8 pkt_counter; /*@packet number that each beam-set should be colected in training state*/ -+ u8 update_beam_idx; /*@the index announce that the beam can be updated*/ -+ u8 rfu_protocol_type; -+ u16 rfu_protocol_delay_time; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_WORK_ITEM hl_smart_antenna_workitem; -+ RT_WORK_ITEM hl_smart_antenna_decision_workitem; -+ #endif -+ -+ -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 -+ u8 beam_set_avg_rssi_pre[SUPPORT_BEAM_SET_PATTERN_NUM]; /*@avg pre_rssi of each beam set*/ -+ u8 beam_set_train_val_diff[SUPPORT_BEAM_SET_PATTERN_NUM]; /*@rssi of a beam pattern set, ex: a set = {ant1_beam=1, ant2_beam=3}*/ -+ u8 beam_set_train_cnt[SUPPORT_BEAM_SET_PATTERN_NUM]; /*@training pkt num of each beam set*/ -+ u32 beam_set_rssi_avg_sum[SUPPORT_BEAM_SET_PATTERN_NUM]; /*@RSSI_sum of avg(pathA,pathB) for each beam-set)*/ -+ u32 beam_path_rssi_sum[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B];/*@RSSI_sum of each path for each beam-set)*/ -+ -+ u8 beam_set_avg_evm_2ss_pre[SUPPORT_BEAM_SET_PATTERN_NUM]; -+ u32 beam_path_evm_2ss_sum[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B];/*@2SS evm_sum of each path for each beam-set)*/ -+ u32 beam_path_evm_2ss_cnt[SUPPORT_BEAM_SET_PATTERN_NUM]; -+ -+ u8 beam_set_avg_evm_1ss_pre[SUPPORT_BEAM_SET_PATTERN_NUM]; -+ u32 beam_path_evm_1ss_sum[SUPPORT_BEAM_SET_PATTERN_NUM];/*@1SS evm_sum of each path for each beam-set)*/ -+ u32 beam_path_evm_1ss_cnt[SUPPORT_BEAM_SET_PATTERN_NUM]; -+ -+ u32 statistic_pkt_cnt[SUPPORT_BEAM_SET_PATTERN_NUM]; /*@statistic_pkt_cnt for SmtAnt make decision*/ -+ -+ u8 total_beam_set_num; /*@number of beam set can be switched*/ -+ u8 total_beam_set_num_2g;/*@number of beam set can be switched in 2G*/ -+ u8 total_beam_set_num_5g;/*@number of beam set can be switched in 5G*/ -+ -+ u8 rfu_codeword_table_2g[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B]; /*@2G beam truth table*/ -+ u8 rfu_codeword_table_5g[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B]; /*@5G beam truth table*/ -+ u8 rx_idle_beam_set_idx; /*the filanl decsion result*/ -+ #endif -+ -+ -+}; -+#endif /*@#if (defined(CONFIG_HL_SMART_ANTENNA))*/ -+ -+struct smt_ant { -+ u8 smt_ant_vendor; -+ u8 smt_ant_type; -+ u8 tx_desc_mode; /*@0:3 bit mode, 1:2 bit mode*/ -+ #if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) -+ struct smt_ant_cumitek cumi_smtant_table; -+ #endif -+}; -+ -+#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) -+void phydm_cumitek_smt_tx_ant_update( -+ void *dm_void, -+ u8 tx_ant_idx_path_a, -+ u8 tx_ant_idx_path_b, -+ u32 mac_id); -+ -+void phydm_cumitek_smt_rx_default_ant_update( -+ void *dm_void, -+ u8 rx_ant_idx_path_a, -+ u8 rx_ant_idx_path_b); -+ -+void phydm_cumitek_smt_ant_debug( -+ void *dm_void, -+ char input[][16], -+ u32 *_used, -+ char *output, -+ u32 *_out_len); -+ -+#endif -+ -+#if (defined(CONFIG_HL_SMART_ANTENNA)) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_beam_switch_workitem_callback( -+ void *context); -+ -+void phydm_beam_decision_workitem_callback( -+ void *context); -+#endif /*@#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 -+void phydm_hl_smart_ant_type2_init_8822b( -+ void *dm_void); -+ -+void phydm_update_beam_pattern_type2( -+ void *dm_void, -+ u32 codeword, -+ u32 codeword_length); -+ -+void phydm_set_rfu_beam_pattern_type2( -+ void *dm_void); -+ -+void phydm_hl_smt_ant_dbg_type2( -+ void *dm_void, -+ char input[][16], -+ u32 *_used, -+ char *output, -+ u32 *_out_len); -+ -+void phydm_process_rssi_for_hb_smtant_type2( -+ void *dm_void, -+ void *phy_info_void, -+ void *pkt_info_void, -+ u8 rssi_avg); -+ -+#endif /*@#if (defined(CONFIG_HL_SMART_ANTENNA_TYPE2))*/ -+ -+#if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1)) -+ -+void phydm_update_beam_pattern( -+ void *dm_void, -+ u32 codeword, -+ u32 codeword_length); -+ -+void phydm_set_all_ant_same_beam_num( -+ void *dm_void); -+ -+void phydm_hl_smart_ant_debug( -+ void *dm_void, -+ char input[][16], -+ u32 *_used, -+ char *output, -+ u32 *_out_len); -+ -+#endif /*@#if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1))*/ -+#endif /*@#if (defined(CONFIG_HL_SMART_ANTENNA))*/ -+void phydm_smt_ant_init(void *dm_void); -+#endif /*@#if (defined(CONFIG_SMART_ANTENNA))*/ -+#endif -\ No newline at end of file -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_soml.c b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_soml.c -new file mode 100644 -index 000000000..cd4001afd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_soml.c -@@ -0,0 +1,1451 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/************************************************************* -+ * include files -+ ************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#ifdef CONFIG_ADAPTIVE_SOML -+ -+void phydm_dynamicsoftmletting(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 ret_val; -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (!*dm->mp_mode) { -+ if (dm->support_ic_type & ODM_RTL8822B) { -+ if (!dm->is_linked | dm->iot_table.is_linked_cmw500) -+ return; -+ -+ if (dm->bsomlenabled) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "PHYDM_DynamicSoftMLSetting(): SoML has been enable, skip dynamic SoML switch\n"); -+ return; -+ } -+ -+ ret_val = odm_get_bb_reg(dm, R_0xf8c, MASKBYTE0); -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "PHYDM_DynamicSoftMLSetting(): Read 0xF8C = 0x%08X\n", -+ ret_val); -+ -+ if (ret_val < 0x16) { -+ PHYDM_DBG(dm, ODM_COMP_API, -+ "PHYDM_DynamicSoftMLSetting(): 0xF8C(== 0x%08X) < 0x16, enable SoML\n", -+ ret_val); -+ phydm_somlrxhp_setting(dm, true); -+#if 0 -+ /*odm_set_bb_reg(dm, R_0x19a8, MASKDWORD, 0xc10a0000);*/ -+#endif -+ dm->bsomlenabled = true; -+ } -+ } -+ } -+#endif -+} -+ -+void phydm_soml_on_off(void *dm_void, u8 swch) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ -+ if (swch == SOML_ON) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "(( Turn on )) SOML\n"); -+ -+ if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) -+ odm_set_bb_reg(dm, R_0x998, BIT(6), swch); -+#if (RTL8822B_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8822B) -+ phydm_somlrxhp_setting(dm, true); -+#endif -+ -+ } else if (swch == SOML_OFF) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "(( Turn off )) SOML\n"); -+ -+ if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) -+ odm_set_bb_reg(dm, R_0x998, BIT(6), swch); -+#if (RTL8822B_SUPPORT == 1) -+ else if (dm->support_ic_type == ODM_RTL8822B) -+ phydm_somlrxhp_setting(dm, false); -+#endif -+ } -+ soml_tab->soml_on_off = swch; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_adaptive_soml_callback(struct phydm_timer_list *timer) -+{ -+ void *adapter = (void *)timer->Adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ #if USE_WORKITEM -+ odm_schedule_work_item(&soml_tab->phydm_adaptive_soml_workitem); -+ #else -+ { -+#if 0 -+ /*@dbg_print("%s\n",__func__);*/ -+#endif -+ phydm_adsl(dm); -+ } -+ #endif -+ #else -+ odm_schedule_work_item(&soml_tab->phydm_adaptive_soml_workitem); -+ #endif -+} -+ -+void phydm_adaptive_soml_workitem_callback(void *context) -+{ -+#ifdef CONFIG_ADAPTIVE_SOML -+ void *adapter = (void *)context; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+#if 0 -+ /*@dbg_print("%s\n",__func__);*/ -+#endif -+ phydm_adsl(dm); -+#endif -+} -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+void phydm_adaptive_soml_callback(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *padapter = dm->adapter; -+ -+ if (*dm->is_net_closed == true) -+ return; -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ phydm_adsl(dm); -+ else { -+ /* @Can't do I/O in timer callback*/ -+ phydm_run_in_thread_cmd(dm, -+ phydm_adaptive_soml_workitem_callback, -+ dm); -+ } -+} -+ -+void phydm_adaptive_soml_workitem_callback(void *context) -+{ -+ struct dm_struct *dm = (void *)context; -+ -+#if 0 -+ /*@dbg_print("%s\n",__func__);*/ -+#endif -+ phydm_adsl(dm); -+} -+ -+#else -+void phydm_adaptive_soml_callback(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "******SOML_Callback******\n"); -+ phydm_adsl(dm); -+} -+#endif -+ -+void phydm_rx_rate_for_soml(void *dm_void, void *pkt_info_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ u8 data_rate; -+ -+ pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ data_rate = (pktinfo->data_rate & 0x7f); -+ -+ if (pktinfo->data_rate >= ODM_RATEMCS0 && -+ pktinfo->data_rate <= ODM_RATEMCS31) -+ soml_tab->ht_cnt[data_rate - ODM_RATEMCS0]++; -+ else if ((pktinfo->data_rate >= ODM_RATEVHTSS1MCS0) && -+ (pktinfo->data_rate <= ODM_RATEVHTSS4MCS9)) -+ soml_tab->vht_cnt[data_rate - ODM_RATEVHTSS1MCS0]++; -+} -+ -+void phydm_rx_qam_for_soml(void *dm_void, void *pkt_info_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ struct phydm_perpkt_info_struct *pktinfo = NULL; -+ u8 date_rate; -+ -+ pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; -+ date_rate = (pktinfo->data_rate & 0x7f); -+ if (soml_tab->soml_state_cnt < (soml_tab->soml_train_num << 1)) { -+ if (soml_tab->soml_on_off == SOML_ON) { -+ return; -+ } else if (soml_tab->soml_on_off == SOML_OFF) { -+ if (date_rate >= ODM_RATEMCS8 && -+ date_rate <= ODM_RATEMCS10) -+ soml_tab->num_ht_qam[BPSK_QPSK]++; -+ -+ else if ((date_rate >= ODM_RATEMCS11) && -+ (date_rate <= ODM_RATEMCS12)) -+ soml_tab->num_ht_qam[QAM16]++; -+ -+ else if ((date_rate >= ODM_RATEMCS13) && -+ (date_rate <= ODM_RATEMCS15)) -+ soml_tab->num_ht_qam[QAM64]++; -+ -+ else if ((date_rate >= ODM_RATEVHTSS2MCS0) && -+ (date_rate <= ODM_RATEVHTSS2MCS2)) -+ soml_tab->num_vht_qam[BPSK_QPSK]++; -+ -+ else if ((date_rate >= ODM_RATEVHTSS2MCS3) && -+ (date_rate <= ODM_RATEVHTSS2MCS4)) -+ soml_tab->num_vht_qam[QAM16]++; -+ -+ else if ((date_rate >= ODM_RATEVHTSS2MCS5) && -+ (date_rate <= ODM_RATEVHTSS2MCS5)) -+ soml_tab->num_vht_qam[QAM64]++; -+ -+ else if ((date_rate >= ODM_RATEVHTSS2MCS8) && -+ (date_rate <= ODM_RATEVHTSS2MCS9)) -+ soml_tab->num_vht_qam[QAM256]++; -+ } -+ } -+} -+ -+void phydm_soml_reset_rx_rate(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u8 order; -+ -+ for (order = 0; order < HT_RATE_IDX; order++) { -+ soml_tab->ht_cnt[order] = 0; -+ soml_tab->pre_ht_cnt[order] = 0; -+ soml_tab->ht_cnt_on[order] = 0; -+ soml_tab->ht_cnt_off[order] = 0; -+ soml_tab->ht_crc_ok_cnt_on[order] = 0; -+ soml_tab->ht_crc_fail_cnt_on[order] = 0; -+ soml_tab->ht_crc_ok_cnt_off[order] = 0; -+ soml_tab->ht_crc_fail_cnt_off[order] = 0; -+ } -+ -+ for (order = 0; order < VHT_RATE_IDX; order++) { -+ soml_tab->vht_cnt[order] = 0; -+ soml_tab->pre_vht_cnt[order] = 0; -+ soml_tab->vht_cnt_on[order] = 0; -+ soml_tab->vht_cnt_off[order] = 0; -+ soml_tab->vht_crc_ok_cnt_on[order] = 0; -+ soml_tab->vht_crc_fail_cnt_on[order] = 0; -+ soml_tab->vht_crc_ok_cnt_off[order] = 0; -+ soml_tab->vht_crc_fail_cnt_off[order] = 0; -+ } -+} -+ -+void phydm_soml_reset_qam(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u8 order; -+ -+ for (order = 0; order < HT_ORDER_TYPE; order++) -+ soml_tab->num_ht_qam[order] = 0; -+ -+ for (order = 0; order < VHT_ORDER_TYPE; order++) -+ soml_tab->num_vht_qam[order] = 0; -+} -+ -+void phydm_soml_cfo_process(void *dm_void, s32 *diff_a, s32 *diff_b) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 value32, value32_1, value32_2, value32_3; -+ s32 cfo_acq_a, cfo_acq_b, cfo_end_a, cfo_end_b; -+ -+ value32 = odm_get_bb_reg(dm, R_0xd10, MASKDWORD); -+ value32_1 = odm_get_bb_reg(dm, R_0xd14, MASKDWORD); -+ value32_2 = odm_get_bb_reg(dm, R_0xd50, MASKDWORD); -+ value32_3 = odm_get_bb_reg(dm, R_0xd54, MASKDWORD); -+ -+ cfo_acq_a = (s32)((value32 & 0x1fff0000) >> 16); -+ cfo_end_a = (s32)((value32_1 & 0x1fff0000) >> 16); -+ cfo_acq_b = (s32)((value32_2 & 0x1fff0000) >> 16); -+ cfo_end_b = (s32)((value32_3 & 0x1fff0000) >> 16); -+ -+ *diff_a = ((cfo_acq_a >= cfo_end_a) ? (cfo_acq_a - cfo_end_a) : -+ (cfo_end_a - cfo_acq_a)); -+ *diff_b = ((cfo_acq_b >= cfo_end_b) ? (cfo_acq_b - cfo_end_b) : -+ (cfo_end_b - cfo_acq_b)); -+ -+ *diff_a = ((*diff_a * 312) + (*diff_a >> 1)) >> 12; /* @312.5/2^12 */ -+ *diff_b = ((*diff_b * 312) + (*diff_b >> 1)) >> 12; /* @312.5/2^12 */ -+} -+ -+void phydm_soml_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u32 used = *_used; -+ u32 out_len = *_out_len; -+ u32 dm_value[10] = {0}; -+ u8 i = 0, input_idx = 0; -+ -+ if (!(dm->support_ability & ODM_BB_ADAPTIVE_SOML)) -+ return; -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &dm_value[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx == 0) -+ return; -+ -+ if (dm_value[0] == 1) { /*Turn on/off SOML*/ -+ soml_tab->soml_select = (u8)dm_value[1]; -+ -+ } else if (dm_value[0] == 2) { /*training number for SOML*/ -+ -+ soml_tab->soml_train_num = (u8)dm_value[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "soml_train_num = ((%d))\n", -+ soml_tab->soml_train_num); -+ } else if (dm_value[0] == 3) { /*training interval for SOML*/ -+ -+ soml_tab->soml_intvl = (u8)dm_value[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "soml_intvl = ((%d))\n", soml_tab->soml_intvl); -+ } else if (dm_value[0] == 4) { /*@function period for SOML*/ -+ -+ soml_tab->soml_period = (u8)dm_value[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "soml_period = ((%d))\n", soml_tab->soml_period); -+ } else if (dm_value[0] == 5) { /*@delay_time for SOML*/ -+ -+ soml_tab->soml_delay_time = (u8)dm_value[1]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "soml_delay_time = ((%d))\n", -+ soml_tab->soml_delay_time); -+ } else if (dm_value[0] == 6) { /* @for SOML Rx QAM distribution th*/ -+ if (dm_value[1] == 256) { -+ soml_tab->qam256_dist_th = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "qam256_dist_th = ((%d))\n", -+ soml_tab->qam256_dist_th); -+ } else if (dm_value[1] == 64) { -+ soml_tab->qam64_dist_th = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "qam64_dist_th = ((%d))\n", -+ soml_tab->qam64_dist_th); -+ } else if (dm_value[1] == 16) { -+ soml_tab->qam16_dist_th = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "qam16_dist_th = ((%d))\n", -+ soml_tab->qam16_dist_th); -+ } else if (dm_value[1] == 4) { -+ soml_tab->bpsk_qpsk_dist_th = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "bpsk_qpsk_dist_th = ((%d))\n", -+ soml_tab->bpsk_qpsk_dist_th); -+ } -+ } else if (dm_value[0] == 7) { /* @for SOML cfo th*/ -+ if (dm_value[1] == 256) { -+ soml_tab->cfo_qam256_th = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "cfo_qam256_th = ((%d KHz))\n", -+ soml_tab->cfo_qam256_th); -+ } else if (dm_value[1] == 64) { -+ soml_tab->cfo_qam64_th = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "cfo_qam64_th = ((%d KHz))\n", -+ soml_tab->cfo_qam64_th); -+ } else if (dm_value[1] == 16) { -+ soml_tab->cfo_qam16_th = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "cfo_qam16_th = ((%d KHz))\n", -+ soml_tab->cfo_qam16_th); -+ } else if (dm_value[1] == 4) { -+ soml_tab->cfo_qpsk_th = (u8)dm_value[2]; -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "cfo_qpsk_th = ((%d KHz))\n", -+ soml_tab->cfo_qpsk_th); -+ } -+ } else if (dm_value[0] == 100) { -+ /*show parameters*/ -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "soml_select = ((%d))\n", soml_tab->soml_select); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "soml_train_num = ((%d))\n", -+ soml_tab->soml_train_num); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "soml_intvl = ((%d))\n", soml_tab->soml_intvl); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "soml_period = ((%d))\n", soml_tab->soml_period); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "soml_delay_time = ((%d))\n\n", -+ soml_tab->soml_delay_time); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "qam256_dist_th = ((%d)), qam64_dist_th = ((%d)), ", -+ soml_tab->qam256_dist_th, -+ soml_tab->qam64_dist_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "qam16_dist_th = ((%d)), bpsk_qpsk_dist_th = ((%d))\n", -+ soml_tab->qam16_dist_th, -+ soml_tab->bpsk_qpsk_dist_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "cfo_qam256_th = ((%d KHz)), cfo_qam64_th = ((%d KHz)), ", -+ soml_tab->cfo_qam256_th, -+ soml_tab->cfo_qam64_th); -+ PDM_SNPF(out_len, used, output + used, out_len - used, -+ "cfo_qam16_th = ((%d KHz)), cfo_qpsk_th = ((%d KHz))\n", -+ soml_tab->cfo_qam16_th, -+ soml_tab->cfo_qpsk_th); -+ } -+ *_used = used; -+ *_out_len = out_len; -+} -+ -+void phydm_soml_stats_ht_on(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u8 i, mcs0; -+ u16 num_bytes_diff, num_rate_diff; -+ -+ mcs0 = ODM_RATEMCS0; -+ for (i = mcs0; i <= ODM_RATEMCS15; i++) { -+ num_rate_diff = soml_tab->ht_cnt[i - mcs0] - -+ soml_tab->pre_ht_cnt[i - mcs0]; -+ soml_tab->ht_cnt_on[i - mcs0] += num_rate_diff; -+ soml_tab->pre_ht_cnt[i - mcs0] = soml_tab->ht_cnt[i - mcs0]; -+ num_bytes_diff = soml_tab->ht_byte[i - mcs0] - -+ soml_tab->pre_ht_byte[i - mcs0]; -+ soml_tab->ht_byte_on[i - mcs0] += num_bytes_diff; -+ soml_tab->pre_ht_byte[i - mcs0] = soml_tab->ht_byte[i - mcs0]; -+ } -+} -+ -+void phydm_soml_stats_ht_off(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u8 i, mcs0; -+ u16 num_bytes_diff, num_rate_diff; -+ -+ mcs0 = ODM_RATEMCS0; -+ for (i = mcs0; i <= ODM_RATEMCS15; i++) { -+ num_rate_diff = soml_tab->ht_cnt[i - mcs0] - -+ soml_tab->pre_ht_cnt[i - mcs0]; -+ soml_tab->ht_cnt_off[i - mcs0] += num_rate_diff; -+ soml_tab->pre_ht_cnt[i - mcs0] = soml_tab->ht_cnt[i - mcs0]; -+ num_bytes_diff = soml_tab->ht_byte[i - mcs0] - -+ soml_tab->pre_ht_byte[i - mcs0]; -+ soml_tab->ht_byte_off[i - mcs0] += num_bytes_diff; -+ soml_tab->pre_ht_byte[i - mcs0] = soml_tab->ht_byte[i - mcs0]; -+ } -+} -+ -+void phydm_soml_stats_vht_on(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u8 j, vht0; -+ u16 num_bytes_diff, num_rate_diff; -+ -+ vht0 = ODM_RATEVHTSS1MCS0; -+ for (j = vht0; j <= ODM_RATEVHTSS2MCS9; j++) { -+ num_rate_diff = soml_tab->vht_cnt[j - vht0] - -+ soml_tab->pre_vht_cnt[j - vht0]; -+ soml_tab->vht_cnt_on[j - vht0] += num_rate_diff; -+ soml_tab->pre_vht_cnt[j - vht0] = soml_tab->vht_cnt[j - vht0]; -+ num_bytes_diff = soml_tab->vht_byte[j - vht0] - -+ soml_tab->pre_vht_byte[j - vht0]; -+ soml_tab->vht_byte_on[j - vht0] += num_bytes_diff; -+ soml_tab->pre_vht_byte[j - vht0] = soml_tab->vht_byte[j - vht0]; -+ } -+} -+ -+void phydm_soml_stats_vht_off(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u8 j, vht0; -+ u16 num_bytes_diff, num_rate_diff; -+ -+ vht0 = ODM_RATEVHTSS1MCS0; -+ for (j = vht0; j <= ODM_RATEVHTSS2MCS9; j++) { -+ num_rate_diff = soml_tab->vht_cnt[j - vht0] - -+ soml_tab->pre_vht_cnt[j - vht0]; -+ soml_tab->vht_cnt_off[j - vht0] += num_rate_diff; -+ soml_tab->pre_vht_cnt[j - vht0] = soml_tab->vht_cnt[j - vht0]; -+ num_bytes_diff = soml_tab->vht_byte[j - vht0] - -+ soml_tab->pre_vht_byte[j - vht0]; -+ soml_tab->vht_byte_off[j - vht0] += num_bytes_diff; -+ soml_tab->pre_vht_byte[j - vht0] = soml_tab->vht_byte[j - vht0]; -+ } -+} -+ -+void phydm_soml_statistics(void *dm_void, u8 on_off_state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ -+ if (on_off_state == SOML_ON) { -+ if (*dm->channel <= 14) -+ phydm_soml_stats_ht_on(dm); -+ if (dm->support_ic_type == ODM_RTL8822B) -+ phydm_soml_stats_vht_on(dm); -+ } else if (on_off_state == SOML_OFF) { -+ if (*dm->channel <= 14) -+ phydm_soml_stats_ht_off(dm); -+ if (dm->support_ic_type == ODM_RTL8822B) -+ phydm_soml_stats_vht_off(dm); -+ } -+} -+ -+void phydm_adsl_init_state(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ -+ u8 next_on_off; -+ u16 ht_reset[HT_RATE_IDX] = {0}, vht_reset[VHT_RATE_IDX] = {0}; -+ u8 size = sizeof(ht_reset[0]); -+ -+ phydm_soml_reset_rx_rate(dm); -+ odm_move_memory(dm, soml_tab->ht_byte, ht_reset, -+ HT_RATE_IDX * size); -+ odm_move_memory(dm, soml_tab->ht_byte_on, ht_reset, -+ HT_RATE_IDX * size); -+ odm_move_memory(dm, soml_tab->ht_byte_off, ht_reset, -+ HT_RATE_IDX * size); -+ odm_move_memory(dm, soml_tab->vht_byte, vht_reset, -+ VHT_RATE_IDX * size); -+ odm_move_memory(dm, soml_tab->vht_byte_on, vht_reset, -+ VHT_RATE_IDX * size); -+ odm_move_memory(dm, soml_tab->vht_byte_off, vht_reset, -+ VHT_RATE_IDX * size); -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ soml_tab->cfo_cnt++; -+ phydm_soml_cfo_process(dm, -+ &soml_tab->cfo_diff_a, -+ &soml_tab->cfo_diff_b); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ (%d) cfo_diff_a = %d KHz; cfo_diff_b = %d KHz ]\n", -+ soml_tab->cfo_cnt, soml_tab->cfo_diff_a, -+ soml_tab->cfo_diff_b); -+ soml_tab->cfo_diff_sum_a += soml_tab->cfo_diff_a; -+ soml_tab->cfo_diff_sum_b += soml_tab->cfo_diff_b; -+ } -+ -+ soml_tab->is_soml_method_enable = 1; -+ soml_tab->get_stats = false; -+ soml_tab->soml_state_cnt++; -+ next_on_off = (soml_tab->soml_on_off == SOML_ON) ? SOML_ON : SOML_OFF; -+ phydm_soml_on_off(dm, next_on_off); -+ odm_set_timer(dm, &soml_tab->phydm_adaptive_soml_timer, -+ soml_tab->soml_delay_time); /*@ms*/ -+} -+ -+void phydm_adsl_odd_state(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u16 ht_reset[HT_RATE_IDX] = {0}, vht_reset[VHT_RATE_IDX] = {0}; -+ u8 size = sizeof(ht_reset[0]); -+ -+ soml_tab->get_stats = true; -+ soml_tab->soml_state_cnt++; -+ odm_move_memory(dm, soml_tab->pre_ht_cnt, soml_tab->ht_cnt, -+ HT_RATE_IDX * size); -+ odm_move_memory(dm, soml_tab->pre_vht_cnt, soml_tab->vht_cnt, -+ VHT_RATE_IDX * size); -+ odm_move_memory(dm, soml_tab->pre_ht_byte, soml_tab->ht_byte, -+ HT_RATE_IDX * size); -+ odm_move_memory(dm, soml_tab->pre_vht_byte, soml_tab->vht_byte, -+ VHT_RATE_IDX * size); -+ -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ soml_tab->cfo_cnt++; -+ phydm_soml_cfo_process(dm, -+ &soml_tab->cfo_diff_a, -+ &soml_tab->cfo_diff_b); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ (%d) cfo_diff_a = %d KHz; cfo_diff_b = %d KHz ]\n", -+ soml_tab->cfo_cnt, soml_tab->cfo_diff_a, -+ soml_tab->cfo_diff_b); -+ soml_tab->cfo_diff_sum_a += soml_tab->cfo_diff_a; -+ soml_tab->cfo_diff_sum_b += soml_tab->cfo_diff_b; -+ } -+ odm_set_timer(dm, &soml_tab->phydm_adaptive_soml_timer, -+ soml_tab->soml_intvl); /*@ms*/ -+} -+ -+void phydm_adsl_even_state(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u8 next_on_off; -+ -+ soml_tab->get_stats = false; -+ if (dm->support_ic_type == ODM_RTL8822B) { -+ soml_tab->cfo_cnt++; -+ phydm_soml_cfo_process(dm, -+ &soml_tab->cfo_diff_a, -+ &soml_tab->cfo_diff_b); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ (%d) cfo_diff_a = %d KHz; cfo_diff_b = %d KHz ]\n", -+ soml_tab->cfo_cnt, soml_tab->cfo_diff_a, -+ soml_tab->cfo_diff_b); -+ soml_tab->cfo_diff_sum_a += soml_tab->cfo_diff_a; -+ soml_tab->cfo_diff_sum_b += soml_tab->cfo_diff_b; -+ } -+ soml_tab->soml_state_cnt++; -+ phydm_soml_statistics(dm, soml_tab->soml_on_off); -+ next_on_off = (soml_tab->soml_on_off == SOML_ON) ? SOML_OFF : SOML_ON; -+ phydm_soml_on_off(dm, next_on_off); -+ odm_set_timer(dm, &soml_tab->phydm_adaptive_soml_timer, -+ soml_tab->soml_delay_time); /*@ms*/ -+} -+ -+void phydm_adsl_decision_state(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ boolean on_above = false, off_above = false; -+ u8 i, max_idx_on = 0, max_idx_off = 0; -+ u8 next_on_off = soml_tab->soml_last_state; -+ u8 mcs0 = ODM_RATEMCS0, vht0 = ODM_RATEVHTSS1MCS0; -+ u8 crc_taget = soml_tab->soml_last_state; -+ u8 rate_num = 1, ss_shift = 0; -+ u16 ht_ok_max_on = 0, ht_fail_max_on = 0, utility_on = 0; -+ u16 ht_ok_max_off = 0, ht_fail_max_off = 0, utility_off = 0; -+ u16 vht_ok_max_on = 0, vht_fail_max_on = 0; -+ u16 vht_ok_max_off = 0, vht_fail_max_off = 0; -+ u16 num_total_qam = 0; -+ u16 cnt_max_on = 0, cnt_max_off = 0; -+ u32 ht_total_cnt_on = 0, ht_total_cnt_off = 0; -+ u32 total_ht_rate_on = 0, total_ht_rate_off = 0; -+ u32 vht_total_cnt_on = 0, vht_total_cnt_off = 0; -+ u32 total_vht_rate_on = 0, total_vht_rate_off = 0; -+ u32 rate_per_pkt_on = 0, rate_per_pkt_off = 0; -+ s32 cfo_diff_avg_a, cfo_diff_avg_b; -+ u16 vht_phy_rate_table[] = { -+ /*@20M*/ -+ 6, 13, 19, 26, 39, 52, 58, 65, 78, 90, /*@1SS MCS0~9*/ -+ 13, 26, 39, 52, 78, 104, 117, 130, 156, 180 /*@2SSMCS0~9*/ -+ }; -+ -+ if (dm->support_ic_type & ODM_IC_1SS) -+ rate_num = 1; -+ #ifdef PHYDM_COMPILE_ABOVE_2SS -+ else if (dm->support_ic_type & ODM_IC_2SS) -+ rate_num = 2; -+ #endif -+ #ifdef PHYDM_COMPILE_ABOVE_3SS -+ else if (dm->support_ic_type & ODM_IC_3SS) -+ rate_num = 3; -+ #endif -+ #ifdef PHYDM_COMPILE_ABOVE_4SS -+ else if (dm->support_ic_type & ODM_IC_4SS) -+ rate_num = 4; -+ #endif -+ else -+ pr_debug("%s: mismatch IC type %x\n", __func__, -+ dm->support_ic_type); -+ soml_tab->get_stats = false; -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "[Decisoin state ]\n"); -+ phydm_soml_statistics(dm, soml_tab->soml_on_off); -+ if (*dm->channel <= 14) { -+ /* @[Search 1st and 2nd rate by counter] */ -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = (i << 3); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "*ht_cnt_on HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (ss_shift), (ss_shift + 7), -+ soml_tab->ht_cnt_on[ss_shift + 0], -+ soml_tab->ht_cnt_on[ss_shift + 1], -+ soml_tab->ht_cnt_on[ss_shift + 2], -+ soml_tab->ht_cnt_on[ss_shift + 3], -+ soml_tab->ht_cnt_on[ss_shift + 4], -+ soml_tab->ht_cnt_on[ss_shift + 5], -+ soml_tab->ht_cnt_on[ss_shift + 6], -+ soml_tab->ht_cnt_on[ss_shift + 7]); -+ } -+ -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = (i << 3); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "*ht_cnt_off HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (ss_shift), (ss_shift + 7), -+ soml_tab->ht_cnt_off[ss_shift + 0], -+ soml_tab->ht_cnt_off[ss_shift + 1], -+ soml_tab->ht_cnt_off[ss_shift + 2], -+ soml_tab->ht_cnt_off[ss_shift + 3], -+ soml_tab->ht_cnt_off[ss_shift + 4], -+ soml_tab->ht_cnt_off[ss_shift + 5], -+ soml_tab->ht_cnt_off[ss_shift + 6], -+ soml_tab->ht_cnt_off[ss_shift + 7]); -+ } -+ -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = (i << 3); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "*ht_crc_ok_cnt_on HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (ss_shift), (ss_shift + 7), -+ soml_tab->ht_crc_ok_cnt_on[ss_shift + 0], -+ soml_tab->ht_crc_ok_cnt_on[ss_shift + 1], -+ soml_tab->ht_crc_ok_cnt_on[ss_shift + 2], -+ soml_tab->ht_crc_ok_cnt_on[ss_shift + 3], -+ soml_tab->ht_crc_ok_cnt_on[ss_shift + 4], -+ soml_tab->ht_crc_ok_cnt_on[ss_shift + 5], -+ soml_tab->ht_crc_ok_cnt_on[ss_shift + 6], -+ soml_tab->ht_crc_ok_cnt_on[ss_shift + 7]); -+ } -+ -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = (i << 3); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "*ht_crc_fail_cnt_on HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (ss_shift), (ss_shift + 7), -+ soml_tab->ht_crc_fail_cnt_on[ss_shift + 0], -+ soml_tab->ht_crc_fail_cnt_on[ss_shift + 1], -+ soml_tab->ht_crc_fail_cnt_on[ss_shift + 2], -+ soml_tab->ht_crc_fail_cnt_on[ss_shift + 3], -+ soml_tab->ht_crc_fail_cnt_on[ss_shift + 4], -+ soml_tab->ht_crc_fail_cnt_on[ss_shift + 5], -+ soml_tab->ht_crc_fail_cnt_on[ss_shift + 6], -+ soml_tab->ht_crc_fail_cnt_on[ss_shift + 7]); -+ } -+ -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = (i << 3); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "*ht_crc_ok_cnt_off HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (ss_shift), (ss_shift + 7), -+ soml_tab->ht_crc_ok_cnt_off[ss_shift + 0], -+ soml_tab->ht_crc_ok_cnt_off[ss_shift + 1], -+ soml_tab->ht_crc_ok_cnt_off[ss_shift + 2], -+ soml_tab->ht_crc_ok_cnt_off[ss_shift + 3], -+ soml_tab->ht_crc_ok_cnt_off[ss_shift + 4], -+ soml_tab->ht_crc_ok_cnt_off[ss_shift + 5], -+ soml_tab->ht_crc_ok_cnt_off[ss_shift + 6], -+ soml_tab->ht_crc_ok_cnt_off[ss_shift + 7]); -+ } -+ -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = (i << 3); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "*ht_crc_fail_cnt_off HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (ss_shift), (ss_shift + 7), -+ soml_tab->ht_crc_fail_cnt_off[ss_shift + 0], -+ soml_tab->ht_crc_fail_cnt_off[ss_shift + 1], -+ soml_tab->ht_crc_fail_cnt_off[ss_shift + 2], -+ soml_tab->ht_crc_fail_cnt_off[ss_shift + 3], -+ soml_tab->ht_crc_fail_cnt_off[ss_shift + 4], -+ soml_tab->ht_crc_fail_cnt_off[ss_shift + 5], -+ soml_tab->ht_crc_fail_cnt_off[ss_shift + 6], -+ soml_tab->ht_crc_fail_cnt_off[ss_shift + 7]); -+ } -+ for (i = ODM_RATEMCS0; i <= ODM_RATEMCS15; i++) { -+ ht_total_cnt_on += soml_tab->ht_cnt_on[i - mcs0]; -+ ht_total_cnt_off += soml_tab->ht_cnt_off[i - mcs0]; -+ total_ht_rate_on += (soml_tab->ht_cnt_on[i - mcs0] * -+ phy_rate_table[i]); -+ total_ht_rate_off += (soml_tab->ht_cnt_off[i - mcs0] * -+ phy_rate_table[i]); -+ if (soml_tab->ht_cnt_on[i - mcs0] > cnt_max_on) { -+ cnt_max_on = soml_tab->ht_cnt_on[i - mcs0]; -+ max_idx_on = i - mcs0; -+ } -+ -+ if (soml_tab->ht_cnt_off[i - mcs0] > cnt_max_off) { -+ cnt_max_off = soml_tab->ht_cnt_off[i - mcs0]; -+ max_idx_off = i - mcs0; -+ } -+ } -+ total_ht_rate_on = total_ht_rate_on << 3; -+ total_ht_rate_off = total_ht_rate_off << 3; -+ rate_per_pkt_on = (ht_total_cnt_on != 0) ? -+ (total_ht_rate_on / ht_total_cnt_on) : 0; -+ rate_per_pkt_off = (ht_total_cnt_off != 0) ? -+ (total_ht_rate_off / ht_total_cnt_off) : 0; -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ ht_ok_max_on = soml_tab->ht_crc_ok_cnt_on[max_idx_on]; -+ ht_fail_max_on = soml_tab->ht_crc_fail_cnt_on[max_idx_on]; -+ ht_ok_max_off = soml_tab->ht_crc_ok_cnt_off[max_idx_off]; -+ ht_fail_max_off = soml_tab->ht_crc_fail_cnt_off[max_idx_off]; -+ -+ if (ht_fail_max_on == 0) -+ ht_fail_max_on = 1; -+ -+ if (ht_fail_max_off == 0) -+ ht_fail_max_off = 1; -+ -+ if (ht_ok_max_on > ht_fail_max_on) -+ on_above = true; -+ -+ if (ht_ok_max_off > ht_fail_max_off) -+ off_above = true; -+ -+ if (on_above && !off_above) { -+ crc_taget = SOML_ON; -+ } else if (!on_above && off_above) { -+ crc_taget = SOML_OFF; -+ } else if (on_above && off_above) { -+ utility_on = (ht_ok_max_on << 7) / ht_fail_max_on; -+ utility_off = (ht_ok_max_off << 7) / ht_fail_max_off; -+ crc_taget = (utility_on == utility_off) ? -+ (soml_tab->soml_last_state) : -+ ((utility_on > utility_off) ? SOML_ON : -+ SOML_OFF); -+ -+ } else if (!on_above && !off_above) { -+ if (ht_ok_max_on == 0) -+ ht_ok_max_on = 1; -+ if (ht_ok_max_off == 0) -+ ht_ok_max_off = 1; -+ utility_on = (ht_fail_max_on << 7) / ht_ok_max_on; -+ utility_off = (ht_fail_max_off << 7) / ht_ok_max_off; -+ crc_taget = (utility_on == utility_off) ? -+ (soml_tab->soml_last_state) : -+ ((utility_on < utility_off) ? SOML_ON : -+ SOML_OFF); -+ } -+ #endif -+ } else if (dm->support_ic_type == ODM_RTL8822B) { -+ cfo_diff_avg_a = soml_tab->cfo_diff_sum_a / soml_tab->cfo_cnt; -+ cfo_diff_avg_b = soml_tab->cfo_diff_sum_b / soml_tab->cfo_cnt; -+ soml_tab->cfo_diff_avg_a = (soml_tab->cfo_cnt != 0) ? -+ cfo_diff_avg_a : 0; -+ soml_tab->cfo_diff_avg_b = (soml_tab->cfo_cnt != 0) ? -+ cfo_diff_avg_b : 0; -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ cfo_diff_avg_a = %d KHz; cfo_diff_avg_b = %d KHz]\n", -+ soml_tab->cfo_diff_avg_a, -+ soml_tab->cfo_diff_avg_b); -+ for (i = 0; i < VHT_ORDER_TYPE; i++) -+ num_total_qam += soml_tab->num_vht_qam[i]; -+ -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ ((2SS)) BPSK_QPSK_count = %d ; 16QAM_count = %d ; 64QAM_count = %d ; 256QAM_count = %d ; num_total_qam = %d]\n", -+ soml_tab->num_vht_qam[BPSK_QPSK], -+ soml_tab->num_vht_qam[QAM16], -+ soml_tab->num_vht_qam[QAM64], -+ soml_tab->num_vht_qam[QAM256], -+ num_total_qam); -+ if (((soml_tab->num_vht_qam[QAM256] * 100) > -+ (num_total_qam * soml_tab->qam256_dist_th)) && -+ cfo_diff_avg_a > soml_tab->cfo_qam256_th && -+ cfo_diff_avg_b > soml_tab->cfo_qam256_th) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ QAM256_ratio > %d ; cfo_diff_avg_a > %d KHz ==> SOML_OFF]\n", -+ soml_tab->qam256_dist_th, -+ soml_tab->cfo_qam256_th); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Final decisoin ] : "); -+ phydm_soml_on_off(dm, SOML_OFF); -+ return; -+ } else if (((soml_tab->num_vht_qam[QAM64] * 100) > -+ (num_total_qam * soml_tab->qam64_dist_th)) && -+ (cfo_diff_avg_a > soml_tab->cfo_qam64_th) && -+ (cfo_diff_avg_b > soml_tab->cfo_qam64_th)) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ QAM64_ratio > %d ; cfo_diff_avg_a > %d KHz ==> SOML_OFF]\n", -+ soml_tab->qam64_dist_th, -+ soml_tab->cfo_qam64_th); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Final decisoin ] : "); -+ phydm_soml_on_off(dm, SOML_OFF); -+ return; -+ } else if (((soml_tab->num_vht_qam[QAM16] * 100) > -+ (num_total_qam * soml_tab->qam16_dist_th)) && -+ (cfo_diff_avg_a > soml_tab->cfo_qam16_th) && -+ (cfo_diff_avg_b > soml_tab->cfo_qam16_th)) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ QAM16_ratio > %d ; cfo_diff_avg_a > %d KHz ==> SOML_OFF]\n", -+ soml_tab->qam16_dist_th, -+ soml_tab->cfo_qam16_th); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Final decisoin ] : "); -+ phydm_soml_on_off(dm, SOML_OFF); -+ return; -+ } else if (((soml_tab->num_vht_qam[BPSK_QPSK] * 100) > -+ (num_total_qam * soml_tab->bpsk_qpsk_dist_th)) && -+ (cfo_diff_avg_a > soml_tab->cfo_qpsk_th) && -+ (cfo_diff_avg_b > soml_tab->cfo_qpsk_th)) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ BPSK_QPSK_ratio > %d ; cfo_diff_avg_a > %d KHz ==> SOML_OFF]\n", -+ soml_tab->bpsk_qpsk_dist_th, -+ soml_tab->cfo_qpsk_th); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Final decisoin ] : "); -+ phydm_soml_on_off(dm, SOML_OFF); -+ return; -+ } -+ -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = 10 * i; -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ vht_cnt_on VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d} ]\n", -+ (i + 1), -+ soml_tab->vht_cnt_on[ss_shift + 0], -+ soml_tab->vht_cnt_on[ss_shift + 1], -+ soml_tab->vht_cnt_on[ss_shift + 2], -+ soml_tab->vht_cnt_on[ss_shift + 3], -+ soml_tab->vht_cnt_on[ss_shift + 4], -+ soml_tab->vht_cnt_on[ss_shift + 5], -+ soml_tab->vht_cnt_on[ss_shift + 6], -+ soml_tab->vht_cnt_on[ss_shift + 7], -+ soml_tab->vht_cnt_on[ss_shift + 8], -+ soml_tab->vht_cnt_on[ss_shift + 9]); -+ } -+ -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = 10 * i; -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ vht_cnt_off VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d} ]\n", -+ (i + 1), -+ soml_tab->vht_cnt_off[ss_shift + 0], -+ soml_tab->vht_cnt_off[ss_shift + 1], -+ soml_tab->vht_cnt_off[ss_shift + 2], -+ soml_tab->vht_cnt_off[ss_shift + 3], -+ soml_tab->vht_cnt_off[ss_shift + 4], -+ soml_tab->vht_cnt_off[ss_shift + 5], -+ soml_tab->vht_cnt_off[ss_shift + 6], -+ soml_tab->vht_cnt_off[ss_shift + 7], -+ soml_tab->vht_cnt_off[ss_shift + 8], -+ soml_tab->vht_cnt_off[ss_shift + 9]); -+ } -+ -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = 10 * i; -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "*vht_crc_ok_cnt_on VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (i + 1), -+ soml_tab->vht_crc_ok_cnt_on[ss_shift + 0], -+ soml_tab->vht_crc_ok_cnt_on[ss_shift + 1], -+ soml_tab->vht_crc_ok_cnt_on[ss_shift + 2], -+ soml_tab->vht_crc_ok_cnt_on[ss_shift + 3], -+ soml_tab->vht_crc_ok_cnt_on[ss_shift + 4], -+ soml_tab->vht_crc_ok_cnt_on[ss_shift + 5], -+ soml_tab->vht_crc_ok_cnt_on[ss_shift + 6], -+ soml_tab->vht_crc_ok_cnt_on[ss_shift + 7], -+ soml_tab->vht_crc_ok_cnt_on[ss_shift + 8], -+ soml_tab->vht_crc_ok_cnt_on[ss_shift + 9]); -+ } -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = 10 * i; -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "*vht_crc_fail_cnt_on VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (i + 1), -+ soml_tab->vht_crc_fail_cnt_on[ss_shift + 0], -+ soml_tab->vht_crc_fail_cnt_on[ss_shift + 1], -+ soml_tab->vht_crc_fail_cnt_on[ss_shift + 2], -+ soml_tab->vht_crc_fail_cnt_on[ss_shift + 3], -+ soml_tab->vht_crc_fail_cnt_on[ss_shift + 4], -+ soml_tab->vht_crc_fail_cnt_on[ss_shift + 5], -+ soml_tab->vht_crc_fail_cnt_on[ss_shift + 6], -+ soml_tab->vht_crc_fail_cnt_on[ss_shift + 7], -+ soml_tab->vht_crc_fail_cnt_on[ss_shift + 8], -+ soml_tab->vht_crc_fail_cnt_on[ss_shift + 9]); -+ } -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = 10 * i; -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "*vht_crc_ok_cnt_off VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (i + 1), -+ soml_tab->vht_crc_ok_cnt_off[ss_shift + 0], -+ soml_tab->vht_crc_ok_cnt_off[ss_shift + 1], -+ soml_tab->vht_crc_ok_cnt_off[ss_shift + 2], -+ soml_tab->vht_crc_ok_cnt_off[ss_shift + 3], -+ soml_tab->vht_crc_ok_cnt_off[ss_shift + 4], -+ soml_tab->vht_crc_ok_cnt_off[ss_shift + 5], -+ soml_tab->vht_crc_ok_cnt_off[ss_shift + 6], -+ soml_tab->vht_crc_ok_cnt_off[ss_shift + 7], -+ soml_tab->vht_crc_ok_cnt_off[ss_shift + 8], -+ soml_tab->vht_crc_ok_cnt_off[ss_shift + 9]); -+ } -+ for (i = 0; i < rate_num; i++) { -+ ss_shift = 10 * i; -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "*vht_crc_fail_cnt_off VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", -+ (i + 1), -+ soml_tab->vht_crc_fail_cnt_off[ss_shift + 0], -+ soml_tab->vht_crc_fail_cnt_off[ss_shift + 1], -+ soml_tab->vht_crc_fail_cnt_off[ss_shift + 2], -+ soml_tab->vht_crc_fail_cnt_off[ss_shift + 3], -+ soml_tab->vht_crc_fail_cnt_off[ss_shift + 4], -+ soml_tab->vht_crc_fail_cnt_off[ss_shift + 5], -+ soml_tab->vht_crc_fail_cnt_off[ss_shift + 6], -+ soml_tab->vht_crc_fail_cnt_off[ss_shift + 7], -+ soml_tab->vht_crc_fail_cnt_off[ss_shift + 8], -+ soml_tab->vht_crc_fail_cnt_off[ss_shift + 9]); -+ } -+ -+ for (i = ODM_RATEVHTSS2MCS0; i <= ODM_RATEVHTSS2MCS9; i++) { -+ vht_total_cnt_on += soml_tab->vht_cnt_on[i - vht0]; -+ vht_total_cnt_off += soml_tab->vht_cnt_off[i - vht0]; -+ total_vht_rate_on += (soml_tab->vht_cnt_on[i - vht0] * -+ vht_phy_rate_table[i - vht0]); -+ total_vht_rate_off += (soml_tab->vht_cnt_off[i - vht0] * -+ vht_phy_rate_table[i - vht0]); -+ -+ if (soml_tab->vht_cnt_on[i - vht0] > cnt_max_on) { -+ cnt_max_on = soml_tab->vht_cnt_on[i - vht0]; -+ max_idx_on = i - vht0; -+ } -+ -+ if (soml_tab->vht_cnt_off[i - vht0] > cnt_max_off) { -+ cnt_max_off = soml_tab->vht_cnt_off[i - vht0]; -+ max_idx_off = i - vht0; -+ } -+ } -+ total_vht_rate_on = total_vht_rate_on << 3; -+ total_vht_rate_off = total_vht_rate_off << 3; -+ rate_per_pkt_on = (vht_total_cnt_on != 0) ? -+ (total_vht_rate_on / vht_total_cnt_on) : 0; -+ rate_per_pkt_off = (vht_total_cnt_off != 0) ? -+ (total_vht_rate_off / vht_total_cnt_off) : 0; -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ vht_ok_max_on = soml_tab->vht_crc_ok_cnt_on[max_idx_on]; -+ vht_fail_max_on = soml_tab->vht_crc_fail_cnt_on[max_idx_on]; -+ vht_ok_max_off = soml_tab->vht_crc_ok_cnt_off[max_idx_off]; -+ vht_fail_max_off = soml_tab->vht_crc_fail_cnt_off[max_idx_off]; -+ -+ if (vht_fail_max_on == 0) -+ vht_fail_max_on = 1; -+ -+ if (vht_fail_max_off == 0) -+ vht_fail_max_off = 1; -+ -+ if (vht_ok_max_on > vht_fail_max_on) -+ on_above = true; -+ -+ if (vht_ok_max_off > vht_fail_max_off) -+ off_above = true; -+ -+ if (on_above && !off_above) { -+ crc_taget = SOML_ON; -+ } else if (!on_above && off_above) { -+ crc_taget = SOML_OFF; -+ } else if (on_above && off_above) { -+ utility_on = (vht_ok_max_on << 7) / vht_fail_max_on; -+ utility_off = (vht_ok_max_off << 7) / vht_fail_max_off; -+ crc_taget = (utility_on == utility_off) ? -+ (soml_tab->soml_last_state) : -+ ((utility_on > utility_off) ? SOML_ON : -+ SOML_OFF); -+ -+ } else if (!on_above && !off_above) { -+ if (vht_ok_max_on == 0) -+ vht_ok_max_on = 1; -+ if (vht_ok_max_off == 0) -+ vht_ok_max_off = 1; -+ utility_on = (vht_fail_max_on << 7) / vht_ok_max_on; -+ utility_off = (vht_fail_max_off << 7) / vht_ok_max_off; -+ crc_taget = (utility_on == utility_off) ? -+ (soml_tab->soml_last_state) : -+ ((utility_on < utility_off) ? SOML_ON : -+ SOML_OFF); -+ } -+ #endif -+ -+ } -+ -+ /* @[Decision] */ -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ rate_per_pkt_on = %d ; rate_per_pkt_off = %d ]\n", -+ rate_per_pkt_on, rate_per_pkt_off); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (max_idx_on == max_idx_off && max_idx_on != 0) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ max_idx_on == max_idx_off ]\n"); -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ max_idx = %d, crc_utility_on = %d, crc_utility_off = %d, crc_target = %d]\n", -+ max_idx_on, utility_on, utility_off, -+ crc_taget); -+ next_on_off = crc_taget; -+ } else -+ #endif -+ if (rate_per_pkt_on > rate_per_pkt_off) { -+ next_on_off = SOML_ON; -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ rate_per_pkt_on > rate_per_pkt_off ==> SOML_ON ]\n"); -+ } else if (rate_per_pkt_on < rate_per_pkt_off) { -+ next_on_off = SOML_OFF; -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ rate_per_pkt_on < rate_per_pkt_off ==> SOML_OFF ]\n"); -+ } else { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ stay at soml_last_state ]\n"); -+ next_on_off = soml_tab->soml_last_state; -+ } -+ -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Final decisoin ] : "); -+ phydm_soml_on_off(dm, next_on_off); -+ soml_tab->soml_last_state = next_on_off; -+} -+ -+void phydm_adsl(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ -+ if (dm->support_ic_type & PHYDM_ADAPTIVE_SOML_IC) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "soml_state_cnt =((%d))\n", -+ soml_tab->soml_state_cnt); -+ /*Traning state: 0(alt) 1(ori) 2(alt) 3(ori)===============*/ -+ if (soml_tab->soml_state_cnt < -+ (soml_tab->soml_train_num << 1)) { -+ if (soml_tab->soml_state_cnt == 0) -+ phydm_adsl_init_state(dm); -+ else if ((soml_tab->soml_state_cnt % 2) != 0) -+ phydm_adsl_odd_state(dm); -+ else if ((soml_tab->soml_state_cnt % 2) == 0) -+ phydm_adsl_even_state(dm); -+ } else { -+ phydm_adsl_decision_state(dm); -+ } -+ } -+} -+ -+void phydm_adaptive_soml_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ -+ soml_tab->soml_state_cnt = 0; -+ soml_tab->is_soml_method_enable = 0; -+ soml_tab->soml_counter = 0; -+} -+ -+void phydm_set_adsl_val(void *dm_void, u32 *val_buf, u8 val_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (!(dm->support_ability & ODM_BB_ADAPTIVE_SOML)) -+ return; -+ -+ if (val_len != 1) { -+ PHYDM_DBG(dm, ODM_COMP_API, "[Error][ADSL]Need val_len=1\n"); -+ return; -+ } -+ -+ phydm_soml_on_off(dm, (u8)val_buf[1]); -+} -+ -+void phydm_soml_crc_acq(void *dm_void, u8 rate_id, boolean crc32, u32 length) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u8 offset = 0; -+ -+ if (!(dm->support_ability & ODM_BB_ADAPTIVE_SOML)) -+ return; -+ -+ if (!soml_tab->get_stats) -+ return; -+ if (length < 1400) -+ return; -+ -+ if (soml_tab->soml_on_off == SOML_ON) { -+ if (rate_id >= ODM_RATEMCS0 && rate_id <= ODM_RATEMCS15) { -+ offset = rate_id - ODM_RATEMCS0; -+ if (crc32 == CRC_OK) -+ soml_tab->ht_crc_ok_cnt_on[offset]++; -+ else if (crc32 == CRC_FAIL) -+ soml_tab->ht_crc_fail_cnt_on[offset]++; -+ } else if (rate_id >= ODM_RATEVHTSS1MCS0 && -+ rate_id <= ODM_RATEVHTSS2MCS9) { -+ offset = rate_id - ODM_RATEVHTSS1MCS0; -+ if (crc32 == CRC_OK) -+ soml_tab->vht_crc_ok_cnt_on[offset]++; -+ else if (crc32 == CRC_FAIL) -+ soml_tab->vht_crc_fail_cnt_on[offset]++; -+ } -+ } else if (soml_tab->soml_on_off == SOML_OFF) { -+ if (rate_id >= ODM_RATEMCS0 && rate_id <= ODM_RATEMCS15) { -+ offset = rate_id - ODM_RATEMCS0; -+ if (crc32 == CRC_OK) -+ soml_tab->ht_crc_ok_cnt_off[offset]++; -+ else if (crc32 == CRC_FAIL) -+ soml_tab->ht_crc_fail_cnt_off[offset]++; -+ } else if (rate_id >= ODM_RATEVHTSS1MCS0 && -+ rate_id <= ODM_RATEVHTSS2MCS9) { -+ offset = rate_id - ODM_RATEVHTSS1MCS0; -+ if (crc32 == CRC_OK) -+ soml_tab->vht_crc_ok_cnt_off[offset]++; -+ else if (crc32 == CRC_FAIL) -+ soml_tab->vht_crc_fail_cnt_off[offset]++; -+ } -+ } -+} -+ -+void phydm_soml_bytes_acq(void *dm_void, u8 rate_id, u32 length) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ u8 offset = 0; -+ -+ if (!(dm->support_ability & ODM_BB_ADAPTIVE_SOML)) -+ return; -+ -+ if (rate_id >= ODM_RATEMCS0 && rate_id <= ODM_RATEMCS31) { -+ offset = rate_id - ODM_RATEMCS0; -+ if (offset > (HT_RATE_IDX - 1)) -+ offset = HT_RATE_IDX - 1; -+ -+ soml_tab->ht_byte[offset] += (u16)length; -+ } else if (rate_id >= ODM_RATEVHTSS1MCS0 && -+ rate_id <= ODM_RATEVHTSS4MCS9) { -+ offset = rate_id - ODM_RATEVHTSS1MCS0; -+ if (offset > (VHT_RATE_IDX - 1)) -+ offset = VHT_RATE_IDX - 1; -+ -+ soml_tab->vht_byte[offset] += (u16)length; -+ } -+} -+ -+#if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) -+static void pre_phydm_adaptive_soml_callback(unsigned long task_dm) -+{ -+ struct dm_struct *dm = (struct dm_struct *)task_dm; -+ struct rtl8192cd_priv *priv = dm->priv; -+ struct priv_shared_info *pshare = priv->pshare; -+ -+ if (!(priv->drv_state & DRV_STATE_OPEN)) -+ return; -+ if (pshare->bDriverStopped || pshare->bSurpriseRemoved) { -+ printk("[%s] bDriverStopped(%d) OR bSurpriseRemoved(%d)\n", -+ __FUNCTION__, pshare->bDriverStopped, -+ pshare->bSurpriseRemoved); -+ return; -+ } -+ -+ rtw_enqueue_timer_event(priv, &pshare->adaptive_soml_event, -+ ENQUEUE_TO_TAIL); -+} -+ -+void phydm_adaptive_soml_timers_usb(void *dm_void, u8 state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ if (state == INIT_SOML_TIMMER) { -+ init_timer(&soml_tab->phydm_adaptive_soml_timer); -+ soml_tab->phydm_adaptive_soml_timer.data = (unsigned long)dm; -+ soml_tab->phydm_adaptive_soml_timer.function = pre_phydm_adaptive_soml_callback; -+ INIT_TIMER_EVENT_ENTRY(&priv->pshare->adaptive_soml_event, -+ phydm_adaptive_soml_callback, -+ (unsigned long)dm); -+ } else if (state == CANCEL_SOML_TIMMER) { -+ odm_cancel_timer(dm, &soml_tab->phydm_adaptive_soml_timer); -+ } else if (state == RELEASE_SOML_TIMMER) { -+ odm_release_timer(dm, &soml_tab->phydm_adaptive_soml_timer); -+ } -+} -+#endif /* defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) */ -+ -+void phydm_adaptive_soml_timers(void *dm_void, u8 state) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ -+ if (!(dm->support_ic_type & PHYDM_ADAPTIVE_SOML_IC)) -+ return; -+ -+#if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) -+ struct rtl8192cd_priv *priv = dm->priv; -+ -+ if (priv->hci_type == RTL_HCI_USB) { -+ phydm_adaptive_soml_timers_usb(dm_void, state); -+ } else -+#endif /* defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) */ -+ { -+ if (state == INIT_SOML_TIMMER) { -+ odm_initialize_timer(dm, &soml_tab->phydm_adaptive_soml_timer, -+ (void *)phydm_adaptive_soml_callback, NULL, -+ "phydm_adaptive_soml_timer"); -+ } else if (state == CANCEL_SOML_TIMMER) { -+ odm_cancel_timer(dm, &soml_tab->phydm_adaptive_soml_timer); -+ } else if (state == RELEASE_SOML_TIMMER) { -+ odm_release_timer(dm, &soml_tab->phydm_adaptive_soml_timer); -+ } -+ } -+} -+ -+void phydm_adaptive_soml_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+#if 0 -+ if (!(dm->support_ability & ODM_BB_ADAPTIVE_SOML)) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[Return] Not Support Adaptive SOML\n"); -+ return; -+ } -+#endif -+ -+ if (!(dm->support_ic_type & PHYDM_ADAPTIVE_SOML_IC)) -+ return; -+ -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "%s\n", __func__); -+ -+ soml_tab->soml_state_cnt = 0; -+ soml_tab->soml_delay_time = 40; -+ soml_tab->soml_intvl = 150; -+ soml_tab->soml_train_num = 4; -+ soml_tab->is_soml_method_enable = 0; -+ soml_tab->soml_counter = 0; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ soml_tab->soml_period = 1; -+#else -+ soml_tab->soml_period = 4; -+#endif -+ soml_tab->soml_select = 0; -+ soml_tab->cfo_cnt = 0; -+ soml_tab->cfo_diff_sum_a = 0; -+ soml_tab->cfo_diff_sum_b = 0; -+ -+ soml_tab->cfo_qpsk_th = 94; -+ soml_tab->cfo_qam16_th = 38; -+ soml_tab->cfo_qam64_th = 17; -+ soml_tab->cfo_qam256_th = 7; -+ -+ soml_tab->bpsk_qpsk_dist_th = 20; -+ soml_tab->qam16_dist_th = 20; -+ soml_tab->qam64_dist_th = 20; -+ soml_tab->qam256_dist_th = 20; -+ -+ if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) -+ odm_set_bb_reg(dm, 0x988, BIT(25), 1); -+} -+ -+void phydm_adaptive_soml(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ -+ if (!(dm->support_ability & ODM_BB_ADAPTIVE_SOML)) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[Return!!!] Not Support Adaptive SOML Function\n"); -+ return; -+ } -+ -+ if (dm->pause_ability & ODM_BB_ADAPTIVE_SOML) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "Return: Pause ADSL in LV=%d\n", -+ dm->pause_lv_table.lv_adsl); -+ return; -+ } -+ -+ if (soml_tab->soml_counter < soml_tab->soml_period) { -+ soml_tab->soml_counter++; -+ return; -+ } -+ soml_tab->soml_counter = 0; -+ soml_tab->soml_state_cnt = 0; -+ soml_tab->cfo_cnt = 0; -+ soml_tab->cfo_diff_sum_a = 0; -+ soml_tab->cfo_diff_sum_b = 0; -+ -+ phydm_soml_reset_qam(dm); -+ -+ if (soml_tab->soml_select == 0) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, -+ "[ Adaptive SOML Training !!!]\n"); -+ } else if (soml_tab->soml_select == 1) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Stop Adaptive SOML !!!]\n"); -+ phydm_soml_on_off(dm, SOML_ON); -+ return; -+ } else if (soml_tab->soml_select == 2) { -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Stop Adaptive SOML !!!]\n"); -+ phydm_soml_on_off(dm, SOML_OFF); -+ return; -+ } -+ -+ if (dm->support_ic_type & PHYDM_ADAPTIVE_SOML_IC) -+ phydm_adsl(dm); -+} -+ -+void phydm_enable_adaptive_soml(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "[%s]\n", __func__); -+ dm->support_ability |= ODM_BB_ADAPTIVE_SOML; -+ phydm_soml_on_off(dm, SOML_ON); -+} -+ -+void phydm_stop_adaptive_soml(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_ADPTV_SOML, "[%s]\n", __func__); -+ dm->support_ability &= ~ODM_BB_ADAPTIVE_SOML; -+ phydm_soml_on_off(dm, SOML_ON); -+} -+ -+void phydm_adaptive_soml_para_set(void *dm_void, u8 train_num, u8 intvl, -+ u8 period, u8 delay_time) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct adaptive_soml *soml_tab = &dm->dm_soml_table; -+ -+ soml_tab->soml_train_num = train_num; -+ soml_tab->soml_intvl = intvl; -+ soml_tab->soml_period = period; -+ soml_tab->soml_delay_time = delay_time; -+} -+#endif /* @end of CONFIG_ADAPTIVE_SOML*/ -+ -+void phydm_init_soft_ml_setting(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 soml_mask = BIT(31) | BIT(30) | BIT(29) | BIT(28); -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (!*dm->mp_mode) { -+ if (dm->support_ic_type & ODM_RTL8822B) { -+#if 0 -+ /*odm_set_bb_reg(dm, R_0x19a8, MASKDWORD, 0xd10a0000);*/ -+#endif -+ phydm_somlrxhp_setting(dm, true); -+ dm->bsomlenabled = true; -+ } -+ } -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ if (!*dm->mp_mode) { -+ if (dm->support_ic_type & ODM_RTL8821C) -+ odm_set_bb_reg(dm, R_0x19a8, soml_mask, 0xd); -+ } -+#endif -+#if (RTL8195B_SUPPORT == 1) -+ if (!*dm->mp_mode) { -+ if (dm->support_ic_type & ODM_RTL8195B) -+ odm_set_bb_reg(dm, R_0x19a8, soml_mask, 0xd); -+ } -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_soml.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_soml.h -new file mode 100644 -index 000000000..e2c6e17c2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_soml.h -@@ -0,0 +1,199 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#ifndef __PHYDMSOML_H__ -+#define __PHYDMSOML_H__ -+ -+/*@#define ADAPTIVE_SOML_VERSION "1.0" Byte counter version*/ -+#define ADAPTIVE_SOML_VERSION "2.0" /*@add avg. phy rate decision 20180126*/ -+ -+#define PHYDM_ADAPTIVE_SOML_IC (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F) -+/*@jj add 20170822*/ -+ -+#define INIT_SOML_TIMMER 0 -+#define CANCEL_SOML_TIMMER 1 -+#define RELEASE_SOML_TIMMER 2 -+ -+#define SOML_RSSI_TH_HIGH 25 -+#define SOML_RSSI_TH_LOW 20 -+ -+#define HT_RATE_IDX 16 -+#define VHT_RATE_IDX 20 -+ -+#define HT_ORDER_TYPE 3 -+#define VHT_ORDER_TYPE 4 -+ -+#define CRC_FAIL 1 -+#define CRC_OK 0 -+ -+#if 0 -+#define CFO_QPSK_TH 20 -+#define CFO_QAM16_TH 20 -+#define CFO_QAM64_TH 20 -+#define CFO_QAM256_TH 20 -+ -+#define BPSK_QPSK_DIST 20 -+#define QAM16_DIST 30 -+#define QAM64_DIST 30 -+#define QAM256_DIST 20 -+#endif -+#define HT_TYPE 1 -+#define VHT_TYPE 2 -+ -+#define SOML_ON 1 -+#define SOML_OFF 0 -+ -+#ifdef CONFIG_ADAPTIVE_SOML -+ -+struct adaptive_soml { -+ u32 rvrt_val; /*all rvrt_val for pause API must set to u32*/ -+ boolean is_soml_method_enable; -+ boolean get_stats; -+ u8 soml_on_off; -+ u8 soml_state_cnt; -+ u8 soml_delay_time; -+ u8 soml_intvl; -+ u8 soml_train_num; -+ u8 soml_counter; -+ u8 soml_period; -+ u8 soml_select; -+ u8 soml_last_state; -+ u8 cfo_qpsk_th; -+ u8 cfo_qam16_th; -+ u8 cfo_qam64_th; -+ u8 cfo_qam256_th; -+ u8 bpsk_qpsk_dist_th; -+ u8 qam16_dist_th; -+ u8 qam64_dist_th; -+ u8 qam256_dist_th; -+ u8 cfo_cnt; -+ s32 cfo_diff_a; -+ s32 cfo_diff_b; -+ s32 cfo_diff_sum_a; -+ s32 cfo_diff_sum_b; -+ s32 cfo_diff_avg_a; -+ s32 cfo_diff_avg_b; -+ u16 ht_cnt[HT_RATE_IDX]; -+ u16 pre_ht_cnt[HT_RATE_IDX]; -+ u16 ht_cnt_on[HT_RATE_IDX]; -+ u16 ht_cnt_off[HT_RATE_IDX]; -+ u16 ht_crc_ok_cnt_on[HT_RATE_IDX]; -+ u16 ht_crc_fail_cnt_on[HT_RATE_IDX]; -+ u16 ht_crc_ok_cnt_off[HT_RATE_IDX]; -+ u16 ht_crc_fail_cnt_off[HT_RATE_IDX]; -+ u16 vht_crc_ok_cnt_on[VHT_RATE_IDX]; -+ u16 vht_crc_fail_cnt_on[VHT_RATE_IDX]; -+ u16 vht_crc_ok_cnt_off[VHT_RATE_IDX]; -+ u16 vht_crc_fail_cnt_off[VHT_RATE_IDX]; -+ -+ u16 vht_cnt[VHT_RATE_IDX]; -+ u16 pre_vht_cnt[VHT_RATE_IDX]; -+ u16 vht_cnt_on[VHT_RATE_IDX]; -+ u16 vht_cnt_off[VHT_RATE_IDX]; -+ -+ u16 num_ht_qam[HT_ORDER_TYPE]; -+ u16 ht_byte[HT_RATE_IDX]; -+ u16 pre_ht_byte[HT_RATE_IDX]; -+ u16 ht_byte_on[HT_RATE_IDX]; -+ u16 ht_byte_off[HT_RATE_IDX]; -+ u16 num_vht_qam[VHT_ORDER_TYPE]; -+ u16 vht_byte[VHT_RATE_IDX]; -+ u16 pre_vht_byte[VHT_RATE_IDX]; -+ u16 vht_byte_on[VHT_RATE_IDX]; -+ u16 vht_byte_off[VHT_RATE_IDX]; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if USE_WORKITEM -+ RT_WORK_ITEM phydm_adaptive_soml_workitem; -+#endif -+#endif -+ struct phydm_timer_list phydm_adaptive_soml_timer; -+ -+}; -+ -+enum qam_order { -+ BPSK_QPSK = 0, -+ QAM16 = 1, -+ QAM64 = 2, -+ QAM256 = 3 -+}; -+ -+void phydm_dynamicsoftmletting(void *dm_void); -+ -+void phydm_soml_on_off(void *dm_void, u8 swch); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_adaptive_soml_callback(struct phydm_timer_list *timer); -+ -+void phydm_adaptive_soml_workitem_callback(void *context); -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+void phydm_adaptive_soml_callback(void *dm_void); -+ -+void phydm_adaptive_soml_workitem_callback(void *context); -+ -+#else -+void phydm_adaptive_soml_callback(void *dm_void); -+#endif -+ -+void phydm_rx_rate_for_soml(void *dm_void, void *pkt_info_void); -+ -+void phydm_rx_qam_for_soml(void *dm_void, void *pkt_info_void); -+ -+void phydm_soml_reset_rx_rate(void *dm_void); -+ -+void phydm_soml_reset_qam(void *dm_void); -+ -+void phydm_soml_cfo_process(void *dm_void, s32 *diff_a, s32 *diff_b); -+ -+void phydm_soml_debug(void *dm_void, char input[][16], u32 *_used, -+ char *output, u32 *_out_len); -+ -+void phydm_soml_statistics(void *dm_void, u8 on_off_state); -+ -+void phydm_adsl(void *dm_void); -+ -+void phydm_adaptive_soml_reset(void *dm_void); -+ -+void phydm_set_adsl_val(void *dm_void, u32 *val_buf, u8 val_len); -+ -+void phydm_soml_crc_acq(void *dm_void, u8 rate_id, boolean crc32, u32 length); -+ -+void phydm_soml_bytes_acq(void *dm_void, u8 rate_id, u32 length); -+ -+void phydm_adaptive_soml_timers(void *dm_void, u8 state); -+ -+void phydm_adaptive_soml_init(void *dm_void); -+ -+void phydm_adaptive_soml(void *dm_void); -+ -+void phydm_enable_adaptive_soml(void *dm_void); -+ -+void phydm_stop_adaptive_soml(void *dm_void); -+ -+void phydm_adaptive_soml_para_set(void *dm_void, u8 train_num, u8 intvl, -+ u8 period, u8 delay_time); -+#endif -+void phydm_init_soft_ml_setting(void *dm_void); -+#endif /*@#ifndef __PHYDMSOML_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_types.h b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_types.h -new file mode 100644 -index 000000000..6ee74c1bb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/phydm_types.h -@@ -0,0 +1,421 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#ifndef __ODM_TYPES_H__ -+#define __ODM_TYPES_H__ -+ -+/*Define Different SW team support*/ -+#define ODM_AP 0x01 /*BIT(0)*/ -+#define ODM_CE 0x04 /*BIT(2)*/ -+#define ODM_WIN 0x08 /*BIT(3)*/ -+#define ODM_ADSL 0x10 -+/*BIT(4)*/ /*already combine with ODM_AP, and is nouse now*/ -+#define ODM_IOT 0x20 /*BIT(5)*/ -+ -+/*For FW API*/ -+#define __iram_odm_func__ -+#define __odm_func__ -+#define __odm_func_aon__ -+ -+/*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) ((struct dm_struct*)(&(GET_HAL_DATA(__padapter))->DM_OutSrc)) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #define GET_PDM_ODM(__padapter) ((struct dm_struct *)(&(GET_HAL_DATA(__padapter))->odmpriv)) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #define GET_PDM_ODM(__padapter) ((struct dm_struct*)(&__padapter->pshare->_dmODM)) -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -+ #if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) -+ /* enable PCI & USB HCI at the same time */ -+ #define RT_PCI_USB_INTERFACE 1 -+ #define RT_PCI_INTERFACE RT_PCI_USB_INTERFACE -+ #define RT_USB_INTERFACE RT_PCI_USB_INTERFACE -+ #define RT_SDIO_INTERFACE 3 -+ #else -+ #define RT_PCI_INTERFACE 1 -+ #define RT_USB_INTERFACE 2 -+ #define RT_SDIO_INTERFACE 3 -+ #endif -+#endif -+ -+enum hal_status { -+ HAL_STATUS_SUCCESS, -+ HAL_STATUS_FAILURE, -+#if 0 -+ RT_STATUS_PENDING, -+ RT_STATUS_RESOURCE, -+ RT_STATUS_INVALID_CONTEXT, -+ RT_STATUS_INVALID_PARAMETER, -+ RT_STATUS_NOT_SUPPORT, -+ RT_STATUS_OS_API_FAILED, -+#endif -+}; -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -+ -+#define VISTA_USB_RX_REVISE 0 -+ -+/* -+ * Declare for ODM spin lock definition temporarily fro compile pass. -+ */ -+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_bt_data_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, -+}; -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #define sta_info _RT_WLAN_STA -+ #define __func__ __FUNCTION__ -+ #define PHYDM_TESTCHIP_SUPPORT TESTCHIP_SUPPORT -+ #define MASKH3BYTES 0xffffff00 -+ #define SUCCESS 0 -+ #define FAIL (-1) -+ -+ #define u8 u1Byte -+ #define s8 s1Byte -+ -+ #define u16 u2Byte -+ #define s16 s2Byte -+ -+ #define u32 u4Byte -+ #define s32 s4Byte -+ -+ #define u64 u8Byte -+ #define s64 s8Byte -+ -+ #define phydm_timer_list _RT_TIMER -+ -+ // for power limit table -+ enum odm_pw_lmt_regulation_type { -+ PW_LMT_REGU_FCC = 0, -+ PW_LMT_REGU_ETSI = 1, -+ PW_LMT_REGU_MKK = 2, -+ PW_LMT_REGU_WW13 = 3, -+ PW_LMT_REGU_IC = 4, -+ PW_LMT_REGU_KCC = 5, -+ PW_LMT_REGU_ACMA = 6, -+ PW_LMT_REGU_CHILE = 7, -+ PW_LMT_REGU_UKRAINE = 8, -+ PW_LMT_REGU_MEXICO = 9, -+ PW_LMT_REGU_CN = 10 -+ }; -+ -+ enum odm_pw_lmt_band_type { -+ PW_LMT_BAND_2_4G = 0, -+ PW_LMT_BAND_5G = 1 -+ }; -+ -+ enum odm_pw_lmt_bandwidth_type { -+ PW_LMT_BW_20M = 0, -+ PW_LMT_BW_40M = 1, -+ PW_LMT_BW_80M = 2, -+ PW_LMT_BW_160M = 3 -+ }; -+ -+ enum odm_pw_lmt_ratesection_type { -+ PW_LMT_RS_CCK = 0, -+ PW_LMT_RS_OFDM = 1, -+ PW_LMT_RS_HT = 2, -+ PW_LMT_RS_VHT = 3 -+ }; -+ -+ enum odm_pw_lmt_rfpath_type { -+ PW_LMT_PH_1T = 0, -+ PW_LMT_PH_2T = 1, -+ PW_LMT_PH_3T = 2, -+ PW_LMT_PH_4T = 3 -+ }; -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "../typedef.h" -+ -+ #ifdef CONFIG_PCI_HCI -+ #if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) -+ #define DEV_BUS_TYPE RT_PCI_USB_INTERFACE -+ #else -+ #define DEV_BUS_TYPE RT_PCI_INTERFACE -+ #endif -+ #endif -+ -+ #if (defined(TESTCHIP_SUPPORT)) -+ #define PHYDM_TESTCHIP_SUPPORT 1 -+ #else -+ #define PHYDM_TESTCHIP_SUPPORT 0 -+ #endif -+ -+ #define sta_info stat_info -+ #define boolean bool -+ -+ #define phydm_timer_list timer_list -+ #if defined(__ECOS) -+ #define s64 s8Byte -+ #endif -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -+ -+ #include -+ -+ #define DEV_BUS_TYPE RT_PCI_INTERFACE -+ -+ #if defined(__LITTLE_ENDIAN) -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE -+ #elif defined(__BIG_ENDIAN) -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG -+ #else -+ #error -+ #endif -+ -+ /* 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 -+ #define PHYDM_TESTCHIP_SUPPORT 0 -+ -+ -+ #define RATE_ADAPTIVE_SUPPORT 0 -+ #define POWER_TRAINING_ACTIVE 0 -+ -+ #define sta_info rtl_sta_info -+ #define boolean bool -+ -+ #define phydm_timer_list timer_list -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include -+ -+ #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 -+ -+ #define boolean bool -+ -+ #define SET_TX_DESC_ANTSEL_A_88E(__ptx_desc, __value) SET_BITS_TO_LE_4BYTE(__ptx_desc + 8, 24, 1, __value) -+ #define SET_TX_DESC_ANTSEL_B_88E(__ptx_desc, __value) SET_BITS_TO_LE_4BYTE(__ptx_desc + 8, 25, 1, __value) -+ #define SET_TX_DESC_ANTSEL_C_88E(__ptx_desc, __value) SET_BITS_TO_LE_4BYTE(__ptx_desc + 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 -+ -+ #define phydm_timer_list rtw_timer_list -+ -+ // for power limit table -+ enum odm_pw_lmt_regulation_type { -+ PW_LMT_REGU_FCC = 0, -+ PW_LMT_REGU_ETSI = 1, -+ PW_LMT_REGU_MKK = 2, -+ PW_LMT_REGU_WW13 = 3, -+ PW_LMT_REGU_IC = 4, -+ PW_LMT_REGU_KCC = 5, -+ PW_LMT_REGU_ACMA = 6, -+ PW_LMT_REGU_CHILE = 7, -+ PW_LMT_REGU_UKRAINE = 8, -+ PW_LMT_REGU_MEXICO = 9, -+ PW_LMT_REGU_CN = 10 -+ }; -+ -+ enum odm_pw_lmt_band_type { -+ PW_LMT_BAND_2_4G = 0, -+ PW_LMT_BAND_5G = 1 -+ }; -+ -+ enum odm_pw_lmt_bandwidth_type { -+ PW_LMT_BW_20M = 0, -+ PW_LMT_BW_40M = 1, -+ PW_LMT_BW_80M = 2, -+ PW_LMT_BW_160M = 3 -+ }; -+ -+ enum odm_pw_lmt_ratesection_type { -+ PW_LMT_RS_CCK = 0, -+ PW_LMT_RS_OFDM = 1, -+ PW_LMT_RS_HT = 2, -+ PW_LMT_RS_VHT = 3 -+ }; -+ -+ enum odm_pw_lmt_rfpath_type { -+ PW_LMT_PH_1T = 0, -+ PW_LMT_PH_2T = 1, -+ PW_LMT_PH_3T = 2, -+ PW_LMT_PH_4T = 3 -+ }; -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ #define boolean bool -+ #define true _TRUE -+ #define false _FALSE -+ -+ // for power limit table -+ enum odm_pw_lmt_regulation_type { -+ PW_LMT_REGU_NULL = 0, -+ PW_LMT_REGU_FCC = 1, -+ PW_LMT_REGU_ETSI = 2, -+ PW_LMT_REGU_MKK = 3, -+ PW_LMT_REGU_WW13 = 4, -+ PW_LMT_REGU_IC = 5, -+ PW_LMT_REGU_KCC = 6, -+ PW_LMT_REGU_ACMA = 7, -+ PW_LMT_REGU_CHILE = 8, -+ PW_LMT_REGU_UKRAINE = 9, -+ PW_LMT_REGU_MEXICO = 10, -+ PW_LMT_REGU_CN = 11, -+ PW_LMT_REGU_MAX_NUM = 12 -+ }; -+ -+ enum odm_pw_lmt_band_type { -+ PW_LMT_BAND_NULL = 0, -+ PW_LMT_BAND_2_4G = 1, -+ PW_LMT_BAND_5G = 2 -+ }; -+ -+ enum odm_pw_lmt_bandwidth_type { -+ PW_LMT_BW_NULL = 0, -+ PW_LMT_BW_20M = 1, -+ PW_LMT_BW_40M = 2, -+ PW_LMT_BW_80M = 3 -+ }; -+ -+ enum odm_pw_lmt_ratesection_type { -+ PW_LMT_RS_NULL = 0, -+ PW_LMT_RS_CCK = 1, -+ PW_LMT_RS_OFDM = 2, -+ PW_LMT_RS_HT = 3, -+ PW_LMT_RS_VHT = 4 -+ }; -+ -+ enum odm_pw_lmt_rfpath_type { -+ PW_LMT_PH_NULL = 0, -+ PW_LMT_PH_1T = 1, -+ PW_LMT_PH_2T = 2, -+ PW_LMT_PH_3T = 3, -+ PW_LMT_PH_4T = 4 -+ }; -+ -+ #define phydm_timer_list timer_list -+ -+#endif -+ -+#define READ_NEXT_PAIR(v1, v2, i) do { if (i + 2 >= array_len) break; i += 2; v1 = array[i]; v2 = array[i + 1]; } while (0) -+#define COND_ELSE 2 -+#define COND_ENDIF 3 -+ -+#define MASKBYTE0 0xff -+#define MASKBYTE1 0xff00 -+#define MASKBYTE2 0xff0000 -+#define MASKBYTE3 0xff000000 -+#define MASKHWORD 0xffff0000 -+#define MASKLWORD 0x0000ffff -+#define MASKDWORD 0xffffffff -+ -+#define MASK7BITS 0x7f -+#define MASK12BITS 0xfff -+#define MASKH4BITS 0xf0000000 -+#define MASK20BITS 0xfffff -+#define MASK24BITS 0xffffff -+#define MASKOFDM_D 0xffc00000 -+#define MASKCCK 0x3f3f3f3f -+ -+#define RFREGOFFSETMASK 0xfffff -+#define RFREG_MASK 0xfffff -+ -+#define MASKH3BYTES 0xffffff00 -+#define MASKL3BYTES 0x00ffffff -+#define MASKBYTE2HIGHNIBBLE 0x00f00000 -+#define MASKBYTE3LOWNIBBLE 0x0f000000 -+#define MASKL3BYTES 0x00ffffff -+ -+#endif /* __ODM_TYPES_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_bb.c b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_bb.c -new file mode 100644 -index 000000000..9c1592f89 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_bb.c -@@ -0,0 +1,4579 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*Image2HeaderVersion: R3 1.5.10.1*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8821C_SUPPORT == 1) -+static boolean -+check_positive(struct dm_struct *dm, -+ const u32 condition1, -+ const u32 condition2, -+ const u32 condition3, -+ const u32 condition4 -+) -+{ -+ u32 cond1 = condition1, cond2 = condition2, -+ cond3 = condition3, cond4 = condition4; -+ -+ u8 cut_version_for_para = -+ (dm->cut_version == ODM_CUT_A) ? 15 : dm->cut_version; -+ -+ u8 pkg_type_for_para = -+ (dm->package_type == 0) ? 15 : dm->package_type; -+ -+ u32 driver1 = cut_version_for_para << 24 | -+ (dm->support_interface & 0xF0) << 16 | -+ dm->support_platform << 16 | -+ pkg_type_for_para << 12 | -+ (dm->support_interface & 0x0F) << 8 | -+ dm->rfe_type; -+ -+ u32 driver2 = (dm->type_glna & 0xFF) << 0 | -+ (dm->type_gpa & 0xFF) << 8 | -+ (dm->type_alna & 0xFF) << 16 | -+ (dm->type_apa & 0xFF) << 24; -+ -+ u32 driver3 = 0; -+ -+ u32 driver4 = (dm->type_glna & 0xFF00) >> 8 | -+ (dm->type_gpa & 0xFF00) | -+ (dm->type_alna & 0xFF00) << 8 | -+ (dm->type_apa & 0xFF00) << 16; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "===> %s (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", -+ __func__, cond1, cond2, cond3, cond4); -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "===> %s (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", -+ __func__, driver1, driver2, driver3, driver4); -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ " (Platform, Interface) = (0x%X, 0x%X)\n", -+ dm->support_platform, dm->support_interface); -+ PHYDM_DBG(dm, ODM_COMP_INIT, " (RFE, Package) = (0x%X, 0x%X)\n", -+ dm->rfe_type, dm->package_type); -+ -+ /*============== value Defined Check ===============*/ -+ /*cut version [27:24] need to do value check*/ -+ if (((cond1 & 0x0F000000) != 0) && -+ ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return false; -+ -+ /*pkg type [15:12] need to do value check*/ -+ if (((cond1 & 0x0000F000) != 0) && -+ ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return false; -+ -+ /*interface [11:8] need to do value check*/ -+ if (((cond1 & 0x00000F00) != 0) && -+ ((cond1 & 0x00000F00) != (driver1 & 0x00000F00))) -+ return false; -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x000000FF; -+ driver1 &= 0x000000FF; -+ -+ if (cond1 == driver1) -+ return true; -+ else -+ return false; -+} -+ -+ -+/****************************************************************************** -+ * agc_tab.TXT -+ ******************************************************************************/ -+ -+const u32 array_mp_8821c_agc_tab[] = { -+ 0x80001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFB000003, -+ 0x81C, 0xFA020003, -+ 0x81C, 0xF9040003, -+ 0x81C, 0xF8060003, -+ 0x81C, 0xF7080003, -+ 0x81C, 0xF60A0003, -+ 0x81C, 0xF50C0003, -+ 0x81C, 0xF40E0003, -+ 0x81C, 0xF3100003, -+ 0x81C, 0xF2120003, -+ 0x81C, 0xF1140003, -+ 0x81C, 0xF0160003, -+ 0x81C, 0xEF180003, -+ 0x81C, 0xEE1A0003, -+ 0x81C, 0xED1C0003, -+ 0x81C, 0xEC1E0003, -+ 0x81C, 0xEB200003, -+ 0x81C, 0xEA220003, -+ 0x81C, 0xE9240003, -+ 0x81C, 0xE8260003, -+ 0x81C, 0xE7280003, -+ 0x81C, 0xE62A0003, -+ 0x81C, 0xE52C0003, -+ 0x81C, 0xE42E0003, -+ 0x81C, 0xE3300003, -+ 0x81C, 0xE2320003, -+ 0x81C, 0xE1340003, -+ 0x81C, 0xC4360003, -+ 0x81C, 0xC3380003, -+ 0x81C, 0xC23A0003, -+ 0x81C, 0xC13C0003, -+ 0x81C, 0x883E0003, -+ 0x81C, 0x87400003, -+ 0x81C, 0x86420003, -+ 0x81C, 0x85440003, -+ 0x81C, 0x84460003, -+ 0x81C, 0x83480003, -+ 0x81C, 0x824A0003, -+ 0x81C, 0x814C0003, -+ 0x81C, 0x804E0003, -+ 0x81C, 0x64500003, -+ 0x81C, 0x63520003, -+ 0x81C, 0x62540003, -+ 0x81C, 0x61560003, -+ 0x81C, 0x60580003, -+ 0x81C, 0x475A0003, -+ 0x81C, 0x465C0003, -+ 0x81C, 0x455E0003, -+ 0x81C, 0x44600003, -+ 0x81C, 0x43620003, -+ 0x81C, 0x42640003, -+ 0x81C, 0x41660003, -+ 0x81C, 0x40680003, -+ 0x81C, 0x236A0003, -+ 0x81C, 0x226C0003, -+ 0x81C, 0x056E0003, -+ 0x81C, 0x04700003, -+ 0x81C, 0x03720003, -+ 0x81C, 0x02740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x90001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFB000003, -+ 0x81C, 0xFA020003, -+ 0x81C, 0xF9040003, -+ 0x81C, 0xF8060003, -+ 0x81C, 0xF7080003, -+ 0x81C, 0xF60A0003, -+ 0x81C, 0xF50C0003, -+ 0x81C, 0xF40E0003, -+ 0x81C, 0xF3100003, -+ 0x81C, 0xF2120003, -+ 0x81C, 0xF1140003, -+ 0x81C, 0xF0160003, -+ 0x81C, 0xEF180003, -+ 0x81C, 0xEE1A0003, -+ 0x81C, 0xED1C0003, -+ 0x81C, 0xEC1E0003, -+ 0x81C, 0xEB200003, -+ 0x81C, 0xEA220003, -+ 0x81C, 0xE9240003, -+ 0x81C, 0xE8260003, -+ 0x81C, 0xE7280003, -+ 0x81C, 0xE62A0003, -+ 0x81C, 0xE52C0003, -+ 0x81C, 0xE42E0003, -+ 0x81C, 0xE3300003, -+ 0x81C, 0xE2320003, -+ 0x81C, 0xE1340003, -+ 0x81C, 0xC4360003, -+ 0x81C, 0xC3380003, -+ 0x81C, 0xC23A0003, -+ 0x81C, 0xC13C0003, -+ 0x81C, 0x883E0003, -+ 0x81C, 0x87400003, -+ 0x81C, 0x86420003, -+ 0x81C, 0x85440003, -+ 0x81C, 0x84460003, -+ 0x81C, 0x83480003, -+ 0x81C, 0x824A0003, -+ 0x81C, 0x814C0003, -+ 0x81C, 0x804E0003, -+ 0x81C, 0x64500003, -+ 0x81C, 0x63520003, -+ 0x81C, 0x62540003, -+ 0x81C, 0x61560003, -+ 0x81C, 0x60580003, -+ 0x81C, 0x475A0003, -+ 0x81C, 0x465C0003, -+ 0x81C, 0x455E0003, -+ 0x81C, 0x44600003, -+ 0x81C, 0x43620003, -+ 0x81C, 0x42640003, -+ 0x81C, 0x41660003, -+ 0x81C, 0x40680003, -+ 0x81C, 0x236A0003, -+ 0x81C, 0x226C0003, -+ 0x81C, 0x056E0003, -+ 0x81C, 0x04700003, -+ 0x81C, 0x03720003, -+ 0x81C, 0x02740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFB000003, -+ 0x81C, 0xFA020003, -+ 0x81C, 0xF9040003, -+ 0x81C, 0xF8060003, -+ 0x81C, 0xF7080003, -+ 0x81C, 0xF60A0003, -+ 0x81C, 0xF50C0003, -+ 0x81C, 0xF40E0003, -+ 0x81C, 0xF3100003, -+ 0x81C, 0xF2120003, -+ 0x81C, 0xF1140003, -+ 0x81C, 0xF0160003, -+ 0x81C, 0xEF180003, -+ 0x81C, 0xEE1A0003, -+ 0x81C, 0xED1C0003, -+ 0x81C, 0xEC1E0003, -+ 0x81C, 0xEB200003, -+ 0x81C, 0xEA220003, -+ 0x81C, 0xE9240003, -+ 0x81C, 0xE8260003, -+ 0x81C, 0xE7280003, -+ 0x81C, 0xE62A0003, -+ 0x81C, 0xCA2C0003, -+ 0x81C, 0xC92E0003, -+ 0x81C, 0xC8300003, -+ 0x81C, 0xC7320003, -+ 0x81C, 0xC6340003, -+ 0x81C, 0xC5360003, -+ 0x81C, 0xC4380003, -+ 0x81C, 0xC33A0003, -+ 0x81C, 0xC23C0003, -+ 0x81C, 0xC13E0003, -+ 0x81C, 0x88400003, -+ 0x81C, 0x87420003, -+ 0x81C, 0x86440003, -+ 0x81C, 0x85460003, -+ 0x81C, 0x84480003, -+ 0x81C, 0x834A0003, -+ 0x81C, 0x674C0003, -+ 0x81C, 0x664E0003, -+ 0x81C, 0x65500003, -+ 0x81C, 0x64520003, -+ 0x81C, 0x63540003, -+ 0x81C, 0x62560003, -+ 0x81C, 0x61580003, -+ 0x81C, 0x455A0003, -+ 0x81C, 0x445C0003, -+ 0x81C, 0x435E0003, -+ 0x81C, 0x42600003, -+ 0x81C, 0x41620003, -+ 0x81C, 0x25640003, -+ 0x81C, 0x24660003, -+ 0x81C, 0x23680003, -+ 0x81C, 0x226A0003, -+ 0x81C, 0x216C0003, -+ 0x81C, 0x016E0003, -+ 0x81C, 0x01700003, -+ 0x81C, 0x01720003, -+ 0x81C, 0x01740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFB000003, -+ 0x81C, 0xFA020003, -+ 0x81C, 0xF9040003, -+ 0x81C, 0xF8060003, -+ 0x81C, 0xF7080003, -+ 0x81C, 0xF60A0003, -+ 0x81C, 0xF50C0003, -+ 0x81C, 0xF40E0003, -+ 0x81C, 0xF3100003, -+ 0x81C, 0xF2120003, -+ 0x81C, 0xF1140003, -+ 0x81C, 0xF0160003, -+ 0x81C, 0xEF180003, -+ 0x81C, 0xEE1A0003, -+ 0x81C, 0xED1C0003, -+ 0x81C, 0xEC1E0003, -+ 0x81C, 0xEB200003, -+ 0x81C, 0xEA220003, -+ 0x81C, 0xE9240003, -+ 0x81C, 0xE8260003, -+ 0x81C, 0xE7280003, -+ 0x81C, 0xE62A0003, -+ 0x81C, 0xCA2C0003, -+ 0x81C, 0xC92E0003, -+ 0x81C, 0xC8300003, -+ 0x81C, 0xC7320003, -+ 0x81C, 0xC6340003, -+ 0x81C, 0xC5360003, -+ 0x81C, 0xC4380003, -+ 0x81C, 0xC33A0003, -+ 0x81C, 0xC23C0003, -+ 0x81C, 0xC13E0003, -+ 0x81C, 0x88400003, -+ 0x81C, 0x87420003, -+ 0x81C, 0x86440003, -+ 0x81C, 0x85460003, -+ 0x81C, 0x84480003, -+ 0x81C, 0x834A0003, -+ 0x81C, 0x674C0003, -+ 0x81C, 0x664E0003, -+ 0x81C, 0x65500003, -+ 0x81C, 0x64520003, -+ 0x81C, 0x63540003, -+ 0x81C, 0x62560003, -+ 0x81C, 0x61580003, -+ 0x81C, 0x455A0003, -+ 0x81C, 0x445C0003, -+ 0x81C, 0x435E0003, -+ 0x81C, 0x42600003, -+ 0x81C, 0x41620003, -+ 0x81C, 0x25640003, -+ 0x81C, 0x24660003, -+ 0x81C, 0x23680003, -+ 0x81C, 0x226A0003, -+ 0x81C, 0x216C0003, -+ 0x81C, 0x016E0003, -+ 0x81C, 0x01700003, -+ 0x81C, 0x01720003, -+ 0x81C, 0x01740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0xB0000000, 0x00000000, -+ 0x80001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFD000103, -+ 0x81C, 0xFC020103, -+ 0x81C, 0xFB040103, -+ 0x81C, 0xFA060103, -+ 0x81C, 0xF9080103, -+ 0x81C, 0xF80A0103, -+ 0x81C, 0xF70C0103, -+ 0x81C, 0xF60E0103, -+ 0x81C, 0xF5100103, -+ 0x81C, 0xF4120103, -+ 0x81C, 0xF3140103, -+ 0x81C, 0xF2160103, -+ 0x81C, 0xF1180103, -+ 0x81C, 0xF01A0103, -+ 0x81C, 0xEF1C0103, -+ 0x81C, 0xEE1E0103, -+ 0x81C, 0xED200103, -+ 0x81C, 0xEC220103, -+ 0x81C, 0xEB240103, -+ 0x81C, 0xEA260103, -+ 0x81C, 0xE9280103, -+ 0x81C, 0xE82A0103, -+ 0x81C, 0xE72C0103, -+ 0x81C, 0xE62E0103, -+ 0x81C, 0xE5300103, -+ 0x81C, 0xE4320103, -+ 0x81C, 0xE3340103, -+ 0x81C, 0xE2360103, -+ 0x81C, 0xE1380103, -+ 0x81C, 0xE03A0103, -+ 0x81C, 0xC33C0103, -+ 0x81C, 0xC23E0103, -+ 0x81C, 0xC1400103, -+ 0x81C, 0xC0420103, -+ 0x81C, 0xA3440103, -+ 0x81C, 0xA2460103, -+ 0x81C, 0xA1480103, -+ 0x81C, 0xA04A0103, -+ 0x81C, 0x824C0103, -+ 0x81C, 0x814E0103, -+ 0x81C, 0x80500103, -+ 0x81C, 0x62520103, -+ 0x81C, 0x61540103, -+ 0x81C, 0x60560103, -+ 0x81C, 0x24580103, -+ 0x81C, 0x235A0103, -+ 0x81C, 0x225C0103, -+ 0x81C, 0x215E0103, -+ 0x81C, 0x20600103, -+ 0x81C, 0x03620103, -+ 0x81C, 0x02640103, -+ 0x81C, 0x01660103, -+ 0x81C, 0x01680103, -+ 0x81C, 0x016A0103, -+ 0x81C, 0x016C0103, -+ 0x81C, 0x016E0103, -+ 0x81C, 0x01700103, -+ 0x81C, 0x01720103, -+ 0x81C, 0x01740103, -+ 0x81C, 0x01760103, -+ 0x81C, 0x01780103, -+ 0x81C, 0x017A0103, -+ 0x81C, 0x017C0103, -+ 0x81C, 0x017E0103, -+ 0x90001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xF6000103, -+ 0x81C, 0xF5020103, -+ 0x81C, 0xF4040103, -+ 0x81C, 0xF3060103, -+ 0x81C, 0xF2080103, -+ 0x81C, 0xF10A0103, -+ 0x81C, 0xF00C0103, -+ 0x81C, 0xEF0E0103, -+ 0x81C, 0xEE100103, -+ 0x81C, 0xED120103, -+ 0x81C, 0xEC140103, -+ 0x81C, 0xCE160103, -+ 0x81C, 0xEA180103, -+ 0x81C, 0xE91A0103, -+ 0x81C, 0xE81C0103, -+ 0x81C, 0xE71E0103, -+ 0x81C, 0xE6200103, -+ 0x81C, 0xE5220103, -+ 0x81C, 0xE4240103, -+ 0x81C, 0xE3260103, -+ 0x81C, 0xE2280103, -+ 0x81C, 0xE12A0103, -+ 0x81C, 0xC32C0103, -+ 0x81C, 0xA62E0103, -+ 0x81C, 0xC1300103, -+ 0x81C, 0xA4320103, -+ 0x81C, 0xA3340103, -+ 0x81C, 0xA2360103, -+ 0x81C, 0xA1380103, -+ 0x81C, 0x833A0103, -+ 0x81C, 0x823C0103, -+ 0x81C, 0x813E0103, -+ 0x81C, 0x63400103, -+ 0x81C, 0x62420103, -+ 0x81C, 0x61440103, -+ 0x81C, 0x60460103, -+ 0x81C, 0x25480103, -+ 0x81C, 0x244A0103, -+ 0x81C, 0x234C0103, -+ 0x81C, 0x064E0103, -+ 0x81C, 0x21500103, -+ 0x81C, 0x04520103, -+ 0x81C, 0x03540103, -+ 0x81C, 0x02560103, -+ 0x81C, 0x01580103, -+ 0x81C, 0x005A0103, -+ 0x81C, 0x005C0103, -+ 0x81C, 0x005E0103, -+ 0x81C, 0x00600103, -+ 0x81C, 0x00620103, -+ 0x81C, 0x00640103, -+ 0x81C, 0x00660103, -+ 0x81C, 0x00680103, -+ 0x81C, 0x006A0103, -+ 0x81C, 0x006C0103, -+ 0x81C, 0x006E0103, -+ 0x81C, 0x00700103, -+ 0x81C, 0x00720103, -+ 0x81C, 0x00740103, -+ 0x81C, 0x00760103, -+ 0x81C, 0x00780103, -+ 0x81C, 0x007A0103, -+ 0x81C, 0x007C0103, -+ 0x81C, 0x007E0103, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFD000103, -+ 0x81C, 0xFC020103, -+ 0x81C, 0xFB040103, -+ 0x81C, 0xFA060103, -+ 0x81C, 0xF9080103, -+ 0x81C, 0xF80A0103, -+ 0x81C, 0xF70C0103, -+ 0x81C, 0xF60E0103, -+ 0x81C, 0xF5100103, -+ 0x81C, 0xF4120103, -+ 0x81C, 0xF3140103, -+ 0x81C, 0xF2160103, -+ 0x81C, 0xF1180103, -+ 0x81C, 0xF01A0103, -+ 0x81C, 0xEF1C0103, -+ 0x81C, 0xEE1E0103, -+ 0x81C, 0xED200103, -+ 0x81C, 0xEC220103, -+ 0x81C, 0xEB240103, -+ 0x81C, 0xEA260103, -+ 0x81C, 0xE9280103, -+ 0x81C, 0xE82A0103, -+ 0x81C, 0xE72C0103, -+ 0x81C, 0xE62E0103, -+ 0x81C, 0xE5300103, -+ 0x81C, 0xE4320103, -+ 0x81C, 0xE3340103, -+ 0x81C, 0xE2360103, -+ 0x81C, 0xE1380103, -+ 0x81C, 0xE03A0103, -+ 0x81C, 0xA83C0103, -+ 0x81C, 0xA73E0103, -+ 0x81C, 0xA6400103, -+ 0x81C, 0xA5420103, -+ 0x81C, 0xA4440103, -+ 0x81C, 0xA3460103, -+ 0x81C, 0xA2480103, -+ 0x81C, 0xA14A0103, -+ 0x81C, 0x834C0103, -+ 0x81C, 0x824E0103, -+ 0x81C, 0x81500103, -+ 0x81C, 0x63520103, -+ 0x81C, 0x62540103, -+ 0x81C, 0x61560103, -+ 0x81C, 0x25580103, -+ 0x81C, 0x245A0103, -+ 0x81C, 0x235C0103, -+ 0x81C, 0x225E0103, -+ 0x81C, 0x04600103, -+ 0x81C, 0x03620103, -+ 0x81C, 0x02640103, -+ 0x81C, 0x01660103, -+ 0x81C, 0x01680103, -+ 0x81C, 0x016A0103, -+ 0x81C, 0x016C0103, -+ 0x81C, 0x016E0103, -+ 0x81C, 0x01700103, -+ 0x81C, 0x01720103, -+ 0x81C, 0x01740103, -+ 0x81C, 0x01760103, -+ 0x81C, 0x01780103, -+ 0x81C, 0x017A0103, -+ 0x81C, 0x017C0103, -+ 0x81C, 0x017E0103, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFD000103, -+ 0x81C, 0xFC020103, -+ 0x81C, 0xFB040103, -+ 0x81C, 0xFA060103, -+ 0x81C, 0xF9080103, -+ 0x81C, 0xF80A0103, -+ 0x81C, 0xF70C0103, -+ 0x81C, 0xF60E0103, -+ 0x81C, 0xF5100103, -+ 0x81C, 0xF4120103, -+ 0x81C, 0xF3140103, -+ 0x81C, 0xF2160103, -+ 0x81C, 0xF1180103, -+ 0x81C, 0xF01A0103, -+ 0x81C, 0xEF1C0103, -+ 0x81C, 0xEE1E0103, -+ 0x81C, 0xED200103, -+ 0x81C, 0xEC220103, -+ 0x81C, 0xEB240103, -+ 0x81C, 0xEA260103, -+ 0x81C, 0xE9280103, -+ 0x81C, 0xE82A0103, -+ 0x81C, 0xE72C0103, -+ 0x81C, 0xE62E0103, -+ 0x81C, 0xE5300103, -+ 0x81C, 0xE4320103, -+ 0x81C, 0xE3340103, -+ 0x81C, 0xE2360103, -+ 0x81C, 0xE1380103, -+ 0x81C, 0xE03A0103, -+ 0x81C, 0xA83C0103, -+ 0x81C, 0xA73E0103, -+ 0x81C, 0xA6400103, -+ 0x81C, 0xA5420103, -+ 0x81C, 0xA4440103, -+ 0x81C, 0xA3460103, -+ 0x81C, 0xA2480103, -+ 0x81C, 0xA14A0103, -+ 0x81C, 0x834C0103, -+ 0x81C, 0x824E0103, -+ 0x81C, 0x81500103, -+ 0x81C, 0x63520103, -+ 0x81C, 0x62540103, -+ 0x81C, 0x61560103, -+ 0x81C, 0x25580103, -+ 0x81C, 0x245A0103, -+ 0x81C, 0x235C0103, -+ 0x81C, 0x225E0103, -+ 0x81C, 0x04600103, -+ 0x81C, 0x03620103, -+ 0x81C, 0x02640103, -+ 0x81C, 0x01660103, -+ 0x81C, 0x01680103, -+ 0x81C, 0x016A0103, -+ 0x81C, 0x016C0103, -+ 0x81C, 0x016E0103, -+ 0x81C, 0x01700103, -+ 0x81C, 0x01720103, -+ 0x81C, 0x01740103, -+ 0x81C, 0x01760103, -+ 0x81C, 0x01780103, -+ 0x81C, 0x017A0103, -+ 0x81C, 0x017C0103, -+ 0x81C, 0x017E0103, -+ 0xB0000000, 0x00000000, -+ 0x80001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFB000203, -+ 0x81C, 0xFA020203, -+ 0x81C, 0xF9040203, -+ 0x81C, 0xF8060203, -+ 0x81C, 0xF7080203, -+ 0x81C, 0xF60A0203, -+ 0x81C, 0xF50C0203, -+ 0x81C, 0xF40E0203, -+ 0x81C, 0xF3100203, -+ 0x81C, 0xF2120203, -+ 0x81C, 0xF1140203, -+ 0x81C, 0xF0160203, -+ 0x81C, 0xEF180203, -+ 0x81C, 0xEE1A0203, -+ 0x81C, 0xED1C0203, -+ 0x81C, 0xEC1E0203, -+ 0x81C, 0xEB200203, -+ 0x81C, 0xEA220203, -+ 0x81C, 0xE9240203, -+ 0x81C, 0xE8260203, -+ 0x81C, 0xE7280203, -+ 0x81C, 0xE62A0203, -+ 0x81C, 0xE52C0203, -+ 0x81C, 0xE42E0203, -+ 0x81C, 0xE3300203, -+ 0x81C, 0xE2320203, -+ 0x81C, 0xE1340203, -+ 0x81C, 0xC5360203, -+ 0x81C, 0xC4380203, -+ 0x81C, 0xC33A0203, -+ 0x81C, 0xC23C0203, -+ 0x81C, 0xC13E0203, -+ 0x81C, 0xA4400203, -+ 0x81C, 0xA3420203, -+ 0x81C, 0xA2440203, -+ 0x81C, 0xA1460203, -+ 0x81C, 0xA0480203, -+ 0x81C, 0x834A0203, -+ 0x81C, 0x824C0203, -+ 0x81C, 0x814E0203, -+ 0x81C, 0x63500203, -+ 0x81C, 0x62520203, -+ 0x81C, 0x61540203, -+ 0x81C, 0x60560203, -+ 0x81C, 0x23580203, -+ 0x81C, 0x225A0203, -+ 0x81C, 0x215C0203, -+ 0x81C, 0x205E0203, -+ 0x81C, 0x04600203, -+ 0x81C, 0x03620203, -+ 0x81C, 0x02640203, -+ 0x81C, 0x01660203, -+ 0x81C, 0x01680203, -+ 0x81C, 0x016A0203, -+ 0x81C, 0x016C0203, -+ 0x81C, 0x016E0203, -+ 0x81C, 0x01700203, -+ 0x81C, 0x01720203, -+ 0x81C, 0x01740203, -+ 0x81C, 0x01760203, -+ 0x81C, 0x01780203, -+ 0x81C, 0x017A0203, -+ 0x81C, 0x017C0203, -+ 0x81C, 0x017E0203, -+ 0x90001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xF6000203, -+ 0x81C, 0xF5020203, -+ 0x81C, 0xF4040203, -+ 0x81C, 0xF3060203, -+ 0x81C, 0xF2080203, -+ 0x81C, 0xF10A0203, -+ 0x81C, 0xF00C0203, -+ 0x81C, 0xEF0E0203, -+ 0x81C, 0xEE100203, -+ 0x81C, 0xED120203, -+ 0x81C, 0xEC140203, -+ 0x81C, 0xEB160203, -+ 0x81C, 0xEA180203, -+ 0x81C, 0xE91A0203, -+ 0x81C, 0xE81C0203, -+ 0x81C, 0xE71E0203, -+ 0x81C, 0xE6200203, -+ 0x81C, 0xE5220203, -+ 0x81C, 0xE4240203, -+ 0x81C, 0xE3260203, -+ 0x81C, 0xE2280203, -+ 0x81C, 0xE12A0203, -+ 0x81C, 0xE02C0203, -+ 0x81C, 0xC22E0203, -+ 0x81C, 0xC1300203, -+ 0x81C, 0xC0320203, -+ 0x81C, 0xA3340203, -+ 0x81C, 0xA2360203, -+ 0x81C, 0xA1380203, -+ 0x81C, 0xA03A0203, -+ 0x81C, 0x833C0203, -+ 0x81C, 0x823E0203, -+ 0x81C, 0x81400203, -+ 0x81C, 0x80420203, -+ 0x81C, 0x62440203, -+ 0x81C, 0x61460203, -+ 0x81C, 0x42480203, -+ 0x81C, 0x414A0203, -+ 0x81C, 0x234C0203, -+ 0x81C, 0x224E0203, -+ 0x81C, 0x21500203, -+ 0x81C, 0x20520203, -+ 0x81C, 0x03540203, -+ 0x81C, 0x02560203, -+ 0x81C, 0x01580203, -+ 0x81C, 0x005A0203, -+ 0x81C, 0x005C0203, -+ 0x81C, 0x005E0203, -+ 0x81C, 0x00600203, -+ 0x81C, 0x00620203, -+ 0x81C, 0x00640203, -+ 0x81C, 0x00660203, -+ 0x81C, 0x00680203, -+ 0x81C, 0x006A0203, -+ 0x81C, 0x006C0203, -+ 0x81C, 0x006E0203, -+ 0x81C, 0x00700203, -+ 0x81C, 0x00720203, -+ 0x81C, 0x00740203, -+ 0x81C, 0x00760203, -+ 0x81C, 0x00780203, -+ 0x81C, 0x007A0203, -+ 0x81C, 0x007C0203, -+ 0x81C, 0x007E0203, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFC000203, -+ 0x81C, 0xFB020203, -+ 0x81C, 0xFA040203, -+ 0x81C, 0xF9060203, -+ 0x81C, 0xF8080203, -+ 0x81C, 0xF70A0203, -+ 0x81C, 0xF60C0203, -+ 0x81C, 0xF50E0203, -+ 0x81C, 0xF4100203, -+ 0x81C, 0xF3120203, -+ 0x81C, 0xF2140203, -+ 0x81C, 0xF1160203, -+ 0x81C, 0xF0180203, -+ 0x81C, 0xEF1A0203, -+ 0x81C, 0xEE1C0203, -+ 0x81C, 0xED1E0203, -+ 0x81C, 0xEC200203, -+ 0x81C, 0xEB220203, -+ 0x81C, 0xEA240203, -+ 0x81C, 0xE9260203, -+ 0x81C, 0xE8280203, -+ 0x81C, 0xE72A0203, -+ 0x81C, 0xE62C0203, -+ 0x81C, 0xE52E0203, -+ 0x81C, 0xE4300203, -+ 0x81C, 0xE3320203, -+ 0x81C, 0xE2340203, -+ 0x81C, 0xE1360203, -+ 0x81C, 0xC5380203, -+ 0x81C, 0xC43A0203, -+ 0x81C, 0xC33C0203, -+ 0x81C, 0xC23E0203, -+ 0x81C, 0xA6400203, -+ 0x81C, 0xA5420203, -+ 0x81C, 0xA4440203, -+ 0x81C, 0xA3460203, -+ 0x81C, 0xA2480203, -+ 0x81C, 0x844A0203, -+ 0x81C, 0x834C0203, -+ 0x81C, 0x824E0203, -+ 0x81C, 0x64500203, -+ 0x81C, 0x63520203, -+ 0x81C, 0x62540203, -+ 0x81C, 0x61560203, -+ 0x81C, 0x60580203, -+ 0x81C, 0x235A0203, -+ 0x81C, 0x225C0203, -+ 0x81C, 0x215E0203, -+ 0x81C, 0x04600203, -+ 0x81C, 0x03620203, -+ 0x81C, 0x02640203, -+ 0x81C, 0x01660203, -+ 0x81C, 0x01680203, -+ 0x81C, 0x016A0203, -+ 0x81C, 0x016C0203, -+ 0x81C, 0x016E0203, -+ 0x81C, 0x01700203, -+ 0x81C, 0x01720203, -+ 0x81C, 0x01740203, -+ 0x81C, 0x01760203, -+ 0x81C, 0x01780203, -+ 0x81C, 0x017A0203, -+ 0x81C, 0x017C0203, -+ 0x81C, 0x017E0203, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFC000203, -+ 0x81C, 0xFB020203, -+ 0x81C, 0xFA040203, -+ 0x81C, 0xF9060203, -+ 0x81C, 0xF8080203, -+ 0x81C, 0xF70A0203, -+ 0x81C, 0xF60C0203, -+ 0x81C, 0xF50E0203, -+ 0x81C, 0xF4100203, -+ 0x81C, 0xF3120203, -+ 0x81C, 0xF2140203, -+ 0x81C, 0xF1160203, -+ 0x81C, 0xF0180203, -+ 0x81C, 0xEF1A0203, -+ 0x81C, 0xEE1C0203, -+ 0x81C, 0xED1E0203, -+ 0x81C, 0xEC200203, -+ 0x81C, 0xEB220203, -+ 0x81C, 0xEA240203, -+ 0x81C, 0xE9260203, -+ 0x81C, 0xE8280203, -+ 0x81C, 0xE72A0203, -+ 0x81C, 0xE62C0203, -+ 0x81C, 0xE52E0203, -+ 0x81C, 0xE4300203, -+ 0x81C, 0xE3320203, -+ 0x81C, 0xE2340203, -+ 0x81C, 0xE1360203, -+ 0x81C, 0xC5380203, -+ 0x81C, 0xC43A0203, -+ 0x81C, 0xC33C0203, -+ 0x81C, 0xC23E0203, -+ 0x81C, 0xA6400203, -+ 0x81C, 0xA5420203, -+ 0x81C, 0xA4440203, -+ 0x81C, 0xA3460203, -+ 0x81C, 0xA2480203, -+ 0x81C, 0x844A0203, -+ 0x81C, 0x834C0203, -+ 0x81C, 0x824E0203, -+ 0x81C, 0x64500203, -+ 0x81C, 0x63520203, -+ 0x81C, 0x62540203, -+ 0x81C, 0x61560203, -+ 0x81C, 0x60580203, -+ 0x81C, 0x235A0203, -+ 0x81C, 0x225C0203, -+ 0x81C, 0x215E0203, -+ 0x81C, 0x04600203, -+ 0x81C, 0x03620203, -+ 0x81C, 0x02640203, -+ 0x81C, 0x01660203, -+ 0x81C, 0x01680203, -+ 0x81C, 0x016A0203, -+ 0x81C, 0x016C0203, -+ 0x81C, 0x016E0203, -+ 0x81C, 0x01700203, -+ 0x81C, 0x01720203, -+ 0x81C, 0x01740203, -+ 0x81C, 0x01760203, -+ 0x81C, 0x01780203, -+ 0x81C, 0x017A0203, -+ 0x81C, 0x017C0203, -+ 0x81C, 0x017E0203, -+ 0xB0000000, 0x00000000, -+ 0x80001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFB000303, -+ 0x81C, 0xFA020303, -+ 0x81C, 0xF9040303, -+ 0x81C, 0xF8060303, -+ 0x81C, 0xF7080303, -+ 0x81C, 0xF60A0303, -+ 0x81C, 0xF50C0303, -+ 0x81C, 0xF40E0303, -+ 0x81C, 0xF3100303, -+ 0x81C, 0xF2120303, -+ 0x81C, 0xF1140303, -+ 0x81C, 0xF0160303, -+ 0x81C, 0xEF180303, -+ 0x81C, 0xEE1A0303, -+ 0x81C, 0xED1C0303, -+ 0x81C, 0xEC1E0303, -+ 0x81C, 0xEB200303, -+ 0x81C, 0xEA220303, -+ 0x81C, 0xE9240303, -+ 0x81C, 0xE8260303, -+ 0x81C, 0xE7280303, -+ 0x81C, 0xE62A0303, -+ 0x81C, 0xE52C0303, -+ 0x81C, 0xE42E0303, -+ 0x81C, 0xE3300303, -+ 0x81C, 0xE2320303, -+ 0x81C, 0xE1340303, -+ 0x81C, 0xC4360303, -+ 0x81C, 0xC3380303, -+ 0x81C, 0xC23A0303, -+ 0x81C, 0xC13C0303, -+ 0x81C, 0xA53E0303, -+ 0x81C, 0xA4400303, -+ 0x81C, 0xA3420303, -+ 0x81C, 0xA2440303, -+ 0x81C, 0xA1460303, -+ 0x81C, 0x83480303, -+ 0x81C, 0x824A0303, -+ 0x81C, 0x814C0303, -+ 0x81C, 0x644E0303, -+ 0x81C, 0x63500303, -+ 0x81C, 0x62520303, -+ 0x81C, 0x61540303, -+ 0x81C, 0x60560303, -+ 0x81C, 0x23580303, -+ 0x81C, 0x225A0303, -+ 0x81C, 0x215C0303, -+ 0x81C, 0x045E0303, -+ 0x81C, 0x03600303, -+ 0x81C, 0x02620303, -+ 0x81C, 0x01640303, -+ 0x81C, 0x01660303, -+ 0x81C, 0x01680303, -+ 0x81C, 0x016A0303, -+ 0x81C, 0x016C0303, -+ 0x81C, 0x016E0303, -+ 0x81C, 0x01700303, -+ 0x81C, 0x01720303, -+ 0x81C, 0x01740303, -+ 0x81C, 0x01760303, -+ 0x81C, 0x01780303, -+ 0x81C, 0x017A0303, -+ 0x81C, 0x017C0303, -+ 0x81C, 0x017E0303, -+ 0x90001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xF5000303, -+ 0x81C, 0xF4020303, -+ 0x81C, 0xF3040303, -+ 0x81C, 0xF2060303, -+ 0x81C, 0xF1080303, -+ 0x81C, 0xF00A0303, -+ 0x81C, 0xEF0C0303, -+ 0x81C, 0xEE0E0303, -+ 0x81C, 0xED100303, -+ 0x81C, 0xEC120303, -+ 0x81C, 0xEB140303, -+ 0x81C, 0xEA160303, -+ 0x81C, 0xE9180303, -+ 0x81C, 0xE81A0303, -+ 0x81C, 0xE71C0303, -+ 0x81C, 0xE61E0303, -+ 0x81C, 0xE5200303, -+ 0x81C, 0xE4220303, -+ 0x81C, 0xE3240303, -+ 0x81C, 0xE2260303, -+ 0x81C, 0xE1280303, -+ 0x81C, 0xE02A0303, -+ 0x81C, 0xA72C0303, -+ 0x81C, 0xA62E0303, -+ 0x81C, 0xA5300303, -+ 0x81C, 0xA4320303, -+ 0x81C, 0xA3340303, -+ 0x81C, 0xA2360303, -+ 0x81C, 0xA1380303, -+ 0x81C, 0xA03A0303, -+ 0x81C, 0x823C0303, -+ 0x81C, 0x643E0303, -+ 0x81C, 0x63400303, -+ 0x81C, 0x62420303, -+ 0x81C, 0x61440303, -+ 0x81C, 0x60460303, -+ 0x81C, 0x24480303, -+ 0x81C, 0x234A0303, -+ 0x81C, 0x224C0303, -+ 0x81C, 0x054E0303, -+ 0x81C, 0x04500303, -+ 0x81C, 0x03520303, -+ 0x81C, 0x02540303, -+ 0x81C, 0x01560303, -+ 0x81C, 0x00580303, -+ 0x81C, 0x005A0303, -+ 0x81C, 0x005C0303, -+ 0x81C, 0x005E0303, -+ 0x81C, 0x00600303, -+ 0x81C, 0x00620303, -+ 0x81C, 0x00640303, -+ 0x81C, 0x00660303, -+ 0x81C, 0x00680303, -+ 0x81C, 0x006A0303, -+ 0x81C, 0x006C0303, -+ 0x81C, 0x006E0303, -+ 0x81C, 0x00700303, -+ 0x81C, 0x00720303, -+ 0x81C, 0x00740303, -+ 0x81C, 0x00760303, -+ 0x81C, 0x00780303, -+ 0x81C, 0x007A0303, -+ 0x81C, 0x007C0303, -+ 0x81C, 0x007E0303, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFC000303, -+ 0x81C, 0xFB020303, -+ 0x81C, 0xFA040303, -+ 0x81C, 0xF9060303, -+ 0x81C, 0xF8080303, -+ 0x81C, 0xF70A0303, -+ 0x81C, 0xF60C0303, -+ 0x81C, 0xF50E0303, -+ 0x81C, 0xF4100303, -+ 0x81C, 0xF3120303, -+ 0x81C, 0xF2140303, -+ 0x81C, 0xF1160303, -+ 0x81C, 0xF0180303, -+ 0x81C, 0xEF1A0303, -+ 0x81C, 0xEE1C0303, -+ 0x81C, 0xED1E0303, -+ 0x81C, 0xEC200303, -+ 0x81C, 0xEB220303, -+ 0x81C, 0xEA240303, -+ 0x81C, 0xE9260303, -+ 0x81C, 0xE8280303, -+ 0x81C, 0xE72A0303, -+ 0x81C, 0xE62C0303, -+ 0x81C, 0xE52E0303, -+ 0x81C, 0xE4300303, -+ 0x81C, 0xE3320303, -+ 0x81C, 0xE2340303, -+ 0x81C, 0xE1360303, -+ 0x81C, 0xE0380303, -+ 0x81C, 0xC53A0303, -+ 0x81C, 0xC43C0303, -+ 0x81C, 0xC33E0303, -+ 0x81C, 0xA5400303, -+ 0x81C, 0xA4420303, -+ 0x81C, 0xA3440303, -+ 0x81C, 0xA2460303, -+ 0x81C, 0xA1480303, -+ 0x81C, 0x834A0303, -+ 0x81C, 0x824C0303, -+ 0x81C, 0x814E0303, -+ 0x81C, 0x64500303, -+ 0x81C, 0x63520303, -+ 0x81C, 0x62540303, -+ 0x81C, 0x61560303, -+ 0x81C, 0x24580303, -+ 0x81C, 0x235A0303, -+ 0x81C, 0x225C0303, -+ 0x81C, 0x215E0303, -+ 0x81C, 0x04600303, -+ 0x81C, 0x03620303, -+ 0x81C, 0x02640303, -+ 0x81C, 0x01660303, -+ 0x81C, 0x01680303, -+ 0x81C, 0x016A0303, -+ 0x81C, 0x016C0303, -+ 0x81C, 0x016E0303, -+ 0x81C, 0x01700303, -+ 0x81C, 0x01720303, -+ 0x81C, 0x01740303, -+ 0x81C, 0x01760303, -+ 0x81C, 0x01780303, -+ 0x81C, 0x017A0303, -+ 0x81C, 0x017C0303, -+ 0x81C, 0x017E0303, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFC000303, -+ 0x81C, 0xFB020303, -+ 0x81C, 0xFA040303, -+ 0x81C, 0xF9060303, -+ 0x81C, 0xF8080303, -+ 0x81C, 0xF70A0303, -+ 0x81C, 0xF60C0303, -+ 0x81C, 0xF50E0303, -+ 0x81C, 0xF4100303, -+ 0x81C, 0xF3120303, -+ 0x81C, 0xF2140303, -+ 0x81C, 0xF1160303, -+ 0x81C, 0xF0180303, -+ 0x81C, 0xEF1A0303, -+ 0x81C, 0xEE1C0303, -+ 0x81C, 0xED1E0303, -+ 0x81C, 0xEC200303, -+ 0x81C, 0xEB220303, -+ 0x81C, 0xEA240303, -+ 0x81C, 0xE9260303, -+ 0x81C, 0xE8280303, -+ 0x81C, 0xE72A0303, -+ 0x81C, 0xE62C0303, -+ 0x81C, 0xE52E0303, -+ 0x81C, 0xE4300303, -+ 0x81C, 0xE3320303, -+ 0x81C, 0xE2340303, -+ 0x81C, 0xE1360303, -+ 0x81C, 0xC4380303, -+ 0x81C, 0xC33A0303, -+ 0x81C, 0xC23C0303, -+ 0x81C, 0xC13E0303, -+ 0x81C, 0xA5400303, -+ 0x81C, 0xA4420303, -+ 0x81C, 0xA3440303, -+ 0x81C, 0xA2460303, -+ 0x81C, 0xA1480303, -+ 0x81C, 0x834A0303, -+ 0x81C, 0x824C0303, -+ 0x81C, 0x814E0303, -+ 0x81C, 0x64500303, -+ 0x81C, 0x63520303, -+ 0x81C, 0x62540303, -+ 0x81C, 0x61560303, -+ 0x81C, 0x24580303, -+ 0x81C, 0x235A0303, -+ 0x81C, 0x225C0303, -+ 0x81C, 0x215E0303, -+ 0x81C, 0x04600303, -+ 0x81C, 0x03620303, -+ 0x81C, 0x02640303, -+ 0x81C, 0x01660303, -+ 0x81C, 0x01680303, -+ 0x81C, 0x016A0303, -+ 0x81C, 0x016C0303, -+ 0x81C, 0x016E0303, -+ 0x81C, 0x01700303, -+ 0x81C, 0x01720303, -+ 0x81C, 0x01740303, -+ 0x81C, 0x01760303, -+ 0x81C, 0x01780303, -+ 0x81C, 0x017A0303, -+ 0x81C, 0x017C0303, -+ 0x81C, 0x017E0303, -+ 0xB0000000, 0x00000000, -+ 0x80001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFC000803, -+ 0x81C, 0xFB020803, -+ 0x81C, 0xFA040803, -+ 0x81C, 0xF9060803, -+ 0x81C, 0xF8080803, -+ 0x81C, 0xF70A0803, -+ 0x81C, 0xF60C0803, -+ 0x81C, 0xF50E0803, -+ 0x81C, 0xF4100803, -+ 0x81C, 0xF3120803, -+ 0x81C, 0xF2140803, -+ 0x81C, 0xF1160803, -+ 0x81C, 0xF0180803, -+ 0x81C, 0xEF1A0803, -+ 0x81C, 0xEE1C0803, -+ 0x81C, 0xED1E0803, -+ 0x81C, 0xB5200803, -+ 0x81C, 0xB4220803, -+ 0x81C, 0xB3240803, -+ 0x81C, 0xB2260803, -+ 0x81C, 0xB1280803, -+ 0x81C, 0xB02A0803, -+ 0x81C, 0xAF2C0803, -+ 0x81C, 0xAE2E0803, -+ 0x81C, 0xAD300803, -+ 0x81C, 0xAC320803, -+ 0x81C, 0xAB340803, -+ 0x81C, 0xAA360803, -+ 0x81C, 0xA9380803, -+ 0x81C, 0xA83A0803, -+ 0x81C, 0xA73C0803, -+ 0x81C, 0xA63E0803, -+ 0x81C, 0x88400803, -+ 0x81C, 0x87420803, -+ 0x81C, 0x86440803, -+ 0x81C, 0x85460803, -+ 0x81C, 0x84480803, -+ 0x81C, 0x834A0803, -+ 0x81C, 0x674C0803, -+ 0x81C, 0x664E0803, -+ 0x81C, 0x65500803, -+ 0x81C, 0x64520803, -+ 0x81C, 0x63540803, -+ 0x81C, 0x62560803, -+ 0x81C, 0x61580803, -+ 0x81C, 0x455A0803, -+ 0x81C, 0x445C0803, -+ 0x81C, 0x435E0803, -+ 0x81C, 0x42600803, -+ 0x81C, 0x41620803, -+ 0x81C, 0x25640803, -+ 0x81C, 0x24660803, -+ 0x81C, 0x23680803, -+ 0x81C, 0x226A0803, -+ 0x81C, 0x216C0803, -+ 0x81C, 0x016E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0x90001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFC000803, -+ 0x81C, 0xFB020803, -+ 0x81C, 0xFA040803, -+ 0x81C, 0xF9060803, -+ 0x81C, 0xF8080803, -+ 0x81C, 0xF70A0803, -+ 0x81C, 0xF60C0803, -+ 0x81C, 0xF50E0803, -+ 0x81C, 0xF4100803, -+ 0x81C, 0xF3120803, -+ 0x81C, 0xF2140803, -+ 0x81C, 0xF1160803, -+ 0x81C, 0xF0180803, -+ 0x81C, 0xEF1A0803, -+ 0x81C, 0xEE1C0803, -+ 0x81C, 0xED1E0803, -+ 0x81C, 0xB5200803, -+ 0x81C, 0xB4220803, -+ 0x81C, 0xB3240803, -+ 0x81C, 0xB2260803, -+ 0x81C, 0xB1280803, -+ 0x81C, 0xB02A0803, -+ 0x81C, 0xAF2C0803, -+ 0x81C, 0xAE2E0803, -+ 0x81C, 0xAD300803, -+ 0x81C, 0xAC320803, -+ 0x81C, 0xAB340803, -+ 0x81C, 0xAA360803, -+ 0x81C, 0xA9380803, -+ 0x81C, 0xA83A0803, -+ 0x81C, 0xA73C0803, -+ 0x81C, 0xA63E0803, -+ 0x81C, 0x88400803, -+ 0x81C, 0x87420803, -+ 0x81C, 0x86440803, -+ 0x81C, 0x85460803, -+ 0x81C, 0x84480803, -+ 0x81C, 0x834A0803, -+ 0x81C, 0x674C0803, -+ 0x81C, 0x664E0803, -+ 0x81C, 0x65500803, -+ 0x81C, 0x64520803, -+ 0x81C, 0x63540803, -+ 0x81C, 0x62560803, -+ 0x81C, 0x61580803, -+ 0x81C, 0x455A0803, -+ 0x81C, 0x445C0803, -+ 0x81C, 0x435E0803, -+ 0x81C, 0x42600803, -+ 0x81C, 0x41620803, -+ 0x81C, 0x25640803, -+ 0x81C, 0x24660803, -+ 0x81C, 0x23680803, -+ 0x81C, 0x226A0803, -+ 0x81C, 0x216C0803, -+ 0x81C, 0x016E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFC000803, -+ 0x81C, 0xFB020803, -+ 0x81C, 0xFA040803, -+ 0x81C, 0xF9060803, -+ 0x81C, 0xF8080803, -+ 0x81C, 0xF70A0803, -+ 0x81C, 0xF60C0803, -+ 0x81C, 0xF50E0803, -+ 0x81C, 0xF4100803, -+ 0x81C, 0xF3120803, -+ 0x81C, 0xF2140803, -+ 0x81C, 0xF1160803, -+ 0x81C, 0xF0180803, -+ 0x81C, 0xEF1A0803, -+ 0x81C, 0xEE1C0803, -+ 0x81C, 0xED1E0803, -+ 0x81C, 0xB5200803, -+ 0x81C, 0xB4220803, -+ 0x81C, 0xB3240803, -+ 0x81C, 0xB2260803, -+ 0x81C, 0xB1280803, -+ 0x81C, 0xB02A0803, -+ 0x81C, 0xAF2C0803, -+ 0x81C, 0xAE2E0803, -+ 0x81C, 0xAD300803, -+ 0x81C, 0xAC320803, -+ 0x81C, 0xAB340803, -+ 0x81C, 0xAA360803, -+ 0x81C, 0xA9380803, -+ 0x81C, 0xA83A0803, -+ 0x81C, 0xA73C0803, -+ 0x81C, 0xA63E0803, -+ 0x81C, 0x88400803, -+ 0x81C, 0x87420803, -+ 0x81C, 0x86440803, -+ 0x81C, 0x85460803, -+ 0x81C, 0x84480803, -+ 0x81C, 0x834A0803, -+ 0x81C, 0x674C0803, -+ 0x81C, 0x664E0803, -+ 0x81C, 0x65500803, -+ 0x81C, 0x64520803, -+ 0x81C, 0x63540803, -+ 0x81C, 0x62560803, -+ 0x81C, 0x61580803, -+ 0x81C, 0x455A0803, -+ 0x81C, 0x445C0803, -+ 0x81C, 0x435E0803, -+ 0x81C, 0x42600803, -+ 0x81C, 0x41620803, -+ 0x81C, 0x25640803, -+ 0x81C, 0x24660803, -+ 0x81C, 0x23680803, -+ 0x81C, 0x226A0803, -+ 0x81C, 0x216C0803, -+ 0x81C, 0x016E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFC000803, -+ 0x81C, 0xFB020803, -+ 0x81C, 0xFA040803, -+ 0x81C, 0xF9060803, -+ 0x81C, 0xF8080803, -+ 0x81C, 0xF70A0803, -+ 0x81C, 0xF60C0803, -+ 0x81C, 0xF50E0803, -+ 0x81C, 0xF4100803, -+ 0x81C, 0xF3120803, -+ 0x81C, 0xF2140803, -+ 0x81C, 0xF1160803, -+ 0x81C, 0xF0180803, -+ 0x81C, 0xEF1A0803, -+ 0x81C, 0xEE1C0803, -+ 0x81C, 0xED1E0803, -+ 0x81C, 0xB5200803, -+ 0x81C, 0xB4220803, -+ 0x81C, 0xB3240803, -+ 0x81C, 0xB2260803, -+ 0x81C, 0xB1280803, -+ 0x81C, 0xB02A0803, -+ 0x81C, 0xAF2C0803, -+ 0x81C, 0xAE2E0803, -+ 0x81C, 0xAD300803, -+ 0x81C, 0xAC320803, -+ 0x81C, 0xAB340803, -+ 0x81C, 0xAA360803, -+ 0x81C, 0xA9380803, -+ 0x81C, 0xA83A0803, -+ 0x81C, 0xA73C0803, -+ 0x81C, 0xA63E0803, -+ 0x81C, 0x88400803, -+ 0x81C, 0x87420803, -+ 0x81C, 0x86440803, -+ 0x81C, 0x85460803, -+ 0x81C, 0x84480803, -+ 0x81C, 0x834A0803, -+ 0x81C, 0x674C0803, -+ 0x81C, 0x664E0803, -+ 0x81C, 0x65500803, -+ 0x81C, 0x64520803, -+ 0x81C, 0x63540803, -+ 0x81C, 0x62560803, -+ 0x81C, 0x61580803, -+ 0x81C, 0x455A0803, -+ 0x81C, 0x445C0803, -+ 0x81C, 0x435E0803, -+ 0x81C, 0x42600803, -+ 0x81C, 0x41620803, -+ 0x81C, 0x25640803, -+ 0x81C, 0x24660803, -+ 0x81C, 0x23680803, -+ 0x81C, 0x226A0803, -+ 0x81C, 0x216C0803, -+ 0x81C, 0x016E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0xB0000000, 0x00000000, -+ 0x80001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFF000913, -+ 0x81C, 0xFE020913, -+ 0x81C, 0xFD040913, -+ 0x81C, 0xFC060913, -+ 0x81C, 0xFB080913, -+ 0x81C, 0xFA0A0913, -+ 0x81C, 0xF90C0913, -+ 0x81C, 0xF80E0913, -+ 0x81C, 0xF7100913, -+ 0x81C, 0xF6120913, -+ 0x81C, 0xF5140913, -+ 0x81C, 0xF4160913, -+ 0x81C, 0xF3180913, -+ 0x81C, 0xF21A0913, -+ 0x81C, 0xF11C0913, -+ 0x81C, 0x941E0913, -+ 0x81C, 0x93200913, -+ 0x81C, 0x92220913, -+ 0x81C, 0x91240913, -+ 0x81C, 0x90260913, -+ 0x81C, 0x8F280913, -+ 0x81C, 0x8E2A0913, -+ 0x81C, 0x8D2C0913, -+ 0x81C, 0x8C2E0913, -+ 0x81C, 0x8B300913, -+ 0x81C, 0x8A320913, -+ 0x81C, 0x89340913, -+ 0x81C, 0x88360913, -+ 0x81C, 0x87380913, -+ 0x81C, 0x863A0913, -+ 0x81C, 0x853C0913, -+ 0x81C, 0x843E0913, -+ 0x81C, 0x83400913, -+ 0x81C, 0x82420913, -+ 0x81C, 0x81440913, -+ 0x81C, 0x07460913, -+ 0x81C, 0x06480913, -+ 0x81C, 0x054A0913, -+ 0x81C, 0x044C0913, -+ 0x81C, 0x034E0913, -+ 0x81C, 0x02500913, -+ 0x81C, 0x01520913, -+ 0x81C, 0x88540903, -+ 0x81C, 0x87560903, -+ 0x81C, 0x86580903, -+ 0x81C, 0x855A0903, -+ 0x81C, 0x845C0903, -+ 0x81C, 0x835E0903, -+ 0x81C, 0x82600903, -+ 0x81C, 0x81620903, -+ 0x81C, 0x07640903, -+ 0x81C, 0x06660903, -+ 0x81C, 0x05680903, -+ 0x81C, 0x046A0903, -+ 0x81C, 0x036C0903, -+ 0x81C, 0x026E0903, -+ 0x81C, 0x01700903, -+ 0x81C, 0x01720903, -+ 0x81C, 0x01740903, -+ 0x81C, 0x01760903, -+ 0x81C, 0x01780903, -+ 0x81C, 0x017A0903, -+ 0x81C, 0x017C0903, -+ 0x81C, 0x017E0903, -+ 0x90001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFF000913, -+ 0x81C, 0xFE020913, -+ 0x81C, 0xFD040913, -+ 0x81C, 0xFC060913, -+ 0x81C, 0xFB080913, -+ 0x81C, 0xFA0A0913, -+ 0x81C, 0xF90C0913, -+ 0x81C, 0xF80E0913, -+ 0x81C, 0xF7100913, -+ 0x81C, 0xF6120913, -+ 0x81C, 0xF5140913, -+ 0x81C, 0xF4160913, -+ 0x81C, 0xF3180913, -+ 0x81C, 0xF21A0913, -+ 0x81C, 0xF11C0913, -+ 0x81C, 0x941E0913, -+ 0x81C, 0x93200913, -+ 0x81C, 0x92220913, -+ 0x81C, 0x91240913, -+ 0x81C, 0x90260913, -+ 0x81C, 0x8F280913, -+ 0x81C, 0x8E2A0913, -+ 0x81C, 0x8D2C0913, -+ 0x81C, 0x8C2E0913, -+ 0x81C, 0x8B300913, -+ 0x81C, 0x8A320913, -+ 0x81C, 0x89340913, -+ 0x81C, 0x88360913, -+ 0x81C, 0x87380913, -+ 0x81C, 0x863A0913, -+ 0x81C, 0x853C0913, -+ 0x81C, 0x843E0913, -+ 0x81C, 0x83400913, -+ 0x81C, 0x82420913, -+ 0x81C, 0x81440913, -+ 0x81C, 0x07460913, -+ 0x81C, 0x06480913, -+ 0x81C, 0x054A0913, -+ 0x81C, 0x044C0913, -+ 0x81C, 0x034E0913, -+ 0x81C, 0x02500913, -+ 0x81C, 0x01520913, -+ 0x81C, 0x88540903, -+ 0x81C, 0x87560903, -+ 0x81C, 0x86580903, -+ 0x81C, 0x855A0903, -+ 0x81C, 0x845C0903, -+ 0x81C, 0x835E0903, -+ 0x81C, 0x82600903, -+ 0x81C, 0x81620903, -+ 0x81C, 0x07640903, -+ 0x81C, 0x06660903, -+ 0x81C, 0x05680903, -+ 0x81C, 0x046A0903, -+ 0x81C, 0x036C0903, -+ 0x81C, 0x026E0903, -+ 0x81C, 0x01700903, -+ 0x81C, 0x01720903, -+ 0x81C, 0x01740903, -+ 0x81C, 0x01760903, -+ 0x81C, 0x01780903, -+ 0x81C, 0x017A0903, -+ 0x81C, 0x017C0903, -+ 0x81C, 0x017E0903, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFF000913, -+ 0x81C, 0xFE020913, -+ 0x81C, 0xFD040913, -+ 0x81C, 0xFC060913, -+ 0x81C, 0xFB080913, -+ 0x81C, 0xFA0A0913, -+ 0x81C, 0xF90C0913, -+ 0x81C, 0xF80E0913, -+ 0x81C, 0xF7100913, -+ 0x81C, 0xF6120913, -+ 0x81C, 0xF5140913, -+ 0x81C, 0xF4160913, -+ 0x81C, 0xF3180913, -+ 0x81C, 0xF21A0913, -+ 0x81C, 0xF11C0913, -+ 0x81C, 0x941E0913, -+ 0x81C, 0x93200913, -+ 0x81C, 0x92220913, -+ 0x81C, 0x91240913, -+ 0x81C, 0x90260913, -+ 0x81C, 0x8F280913, -+ 0x81C, 0x8E2A0913, -+ 0x81C, 0x8D2C0913, -+ 0x81C, 0x8C2E0913, -+ 0x81C, 0x8B300913, -+ 0x81C, 0x8A320913, -+ 0x81C, 0x89340913, -+ 0x81C, 0x88360913, -+ 0x81C, 0x87380913, -+ 0x81C, 0x863A0913, -+ 0x81C, 0x853C0913, -+ 0x81C, 0x843E0913, -+ 0x81C, 0x83400913, -+ 0x81C, 0x82420913, -+ 0x81C, 0x81440913, -+ 0x81C, 0x07460913, -+ 0x81C, 0x06480913, -+ 0x81C, 0x054A0913, -+ 0x81C, 0x044C0913, -+ 0x81C, 0x034E0913, -+ 0x81C, 0x02500913, -+ 0x81C, 0x01520913, -+ 0x81C, 0x88540903, -+ 0x81C, 0x87560903, -+ 0x81C, 0x86580903, -+ 0x81C, 0x855A0903, -+ 0x81C, 0x845C0903, -+ 0x81C, 0x835E0903, -+ 0x81C, 0x82600903, -+ 0x81C, 0x81620903, -+ 0x81C, 0x07640903, -+ 0x81C, 0x06660903, -+ 0x81C, 0x05680903, -+ 0x81C, 0x046A0903, -+ 0x81C, 0x036C0903, -+ 0x81C, 0x026E0903, -+ 0x81C, 0x01700903, -+ 0x81C, 0x01720903, -+ 0x81C, 0x01740903, -+ 0x81C, 0x01760903, -+ 0x81C, 0x01780903, -+ 0x81C, 0x017A0903, -+ 0x81C, 0x017C0903, -+ 0x81C, 0x017E0903, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFF000913, -+ 0x81C, 0xFE020913, -+ 0x81C, 0xFD040913, -+ 0x81C, 0xFC060913, -+ 0x81C, 0xFB080913, -+ 0x81C, 0xFA0A0913, -+ 0x81C, 0xF90C0913, -+ 0x81C, 0xF80E0913, -+ 0x81C, 0xF7100913, -+ 0x81C, 0xF6120913, -+ 0x81C, 0xF5140913, -+ 0x81C, 0xF4160913, -+ 0x81C, 0xF3180913, -+ 0x81C, 0xF21A0913, -+ 0x81C, 0xF11C0913, -+ 0x81C, 0x941E0913, -+ 0x81C, 0x93200913, -+ 0x81C, 0x92220913, -+ 0x81C, 0x91240913, -+ 0x81C, 0x90260913, -+ 0x81C, 0x8F280913, -+ 0x81C, 0x8E2A0913, -+ 0x81C, 0x8D2C0913, -+ 0x81C, 0x8C2E0913, -+ 0x81C, 0x8B300913, -+ 0x81C, 0x8A320913, -+ 0x81C, 0x89340913, -+ 0x81C, 0x88360913, -+ 0x81C, 0x87380913, -+ 0x81C, 0x863A0913, -+ 0x81C, 0x853C0913, -+ 0x81C, 0x843E0913, -+ 0x81C, 0x83400913, -+ 0x81C, 0x82420913, -+ 0x81C, 0x81440913, -+ 0x81C, 0x07460913, -+ 0x81C, 0x06480913, -+ 0x81C, 0x054A0913, -+ 0x81C, 0x044C0913, -+ 0x81C, 0x034E0913, -+ 0x81C, 0x02500913, -+ 0x81C, 0x01520913, -+ 0x81C, 0x88540903, -+ 0x81C, 0x87560903, -+ 0x81C, 0x86580903, -+ 0x81C, 0x855A0903, -+ 0x81C, 0x845C0903, -+ 0x81C, 0x835E0903, -+ 0x81C, 0x82600903, -+ 0x81C, 0x81620903, -+ 0x81C, 0x07640903, -+ 0x81C, 0x06660903, -+ 0x81C, 0x05680903, -+ 0x81C, 0x046A0903, -+ 0x81C, 0x036C0903, -+ 0x81C, 0x026E0903, -+ 0x81C, 0x01700903, -+ 0x81C, 0x01720903, -+ 0x81C, 0x01740903, -+ 0x81C, 0x01760903, -+ 0x81C, 0x01780903, -+ 0x81C, 0x017A0903, -+ 0x81C, 0x017C0903, -+ 0x81C, 0x017E0903, -+ 0xB0000000, 0x00000000, -+ 0x80001004, 0x00000000, 0x40000000, 0x00000000, -+ 0xC50, 0x00000022, -+ 0xC50, 0x00000020, -+ 0x90001005, 0x00000000, 0x40000000, 0x00000000, -+ 0xC50, 0x00000022, -+ 0xC50, 0x00000020, -+ 0x90000400, 0x00000000, 0x40000000, 0x00000000, -+ 0xC50, 0x00000022, -+ 0xC50, 0x00000020, -+ 0xA0000000, 0x00000000, -+ 0xC50, 0x00000022, -+ 0xC50, 0x00000020, -+ 0xB0000000, 0x00000000, -+ -+}; -+ -+void -+odm_read_and_config_mp_8821c_agc_tab(struct dm_struct *dm) -+{ -+ u32 i = 0; -+ u8 c_cond; -+ boolean is_matched = true, is_skipped = false; -+ u32 array_len = -+ sizeof(array_mp_8821c_agc_tab) / sizeof(u32); -+ u32 *array = (u32 *)array_mp_8821c_agc_tab; -+ -+ u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ u32 a1 = 0, a2 = 0, a3 = 0, a4 = 0; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+ while ((i + 1) < array_len) { -+ v1 = array[i]; -+ v2 = array[i + 1]; -+ -+ if (v1 & (BIT(31) | BIT(30))) {/*positive & negative condition*/ -+ if (v1 & BIT(31)) {/* positive condition*/ -+ c_cond = -+ (u8)((v1 & (BIT(29) | BIT(28))) >> 28); -+ if (c_cond == COND_ENDIF) {/*end*/ -+ is_matched = true; -+ is_skipped = false; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ENDIF\n"); -+ } else if (c_cond == COND_ELSE) { /*else*/ -+ is_matched = is_skipped ? false : true; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ELSE\n"); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "IF or ELSE IF\n"); -+ } -+ } else if (v1 & BIT(30)) { /*negative condition*/ -+ if (!is_skipped) { -+ a1 = pre_v1; a2 = pre_v2; -+ a3 = v1; a4 = v2; -+ if (check_positive(dm, -+ a1, a2, a3, a4)) { -+ is_matched = true; -+ is_skipped = true; -+ } else { -+ is_matched = false; -+ is_skipped = false; -+ } -+ } else { -+ is_matched = false; -+ } -+ } -+ } else { -+ if (is_matched) -+ odm_config_bb_agc_8821c(dm, v1, MASKDWORD, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u32 -+odm_get_version_mp_8821c_agc_tab(void) -+{ -+ return 64; -+} -+ -+/****************************************************************************** -+ * agc_tab_diff.TXT -+ ******************************************************************************/ -+ -+const u32 array_mp_8821c_agc_tab_diff_wlg[] = { -+ 0x80001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFB000003, -+ 0x81C, 0xFA020003, -+ 0x81C, 0xF9040003, -+ 0x81C, 0xF8060003, -+ 0x81C, 0xF7080003, -+ 0x81C, 0xF60A0003, -+ 0x81C, 0xF50C0003, -+ 0x81C, 0xF40E0003, -+ 0x81C, 0xF3100003, -+ 0x81C, 0xF2120003, -+ 0x81C, 0xF1140003, -+ 0x81C, 0xF0160003, -+ 0x81C, 0xEF180003, -+ 0x81C, 0xEE1A0003, -+ 0x81C, 0xED1C0003, -+ 0x81C, 0xEC1E0003, -+ 0x81C, 0xEB200003, -+ 0x81C, 0xEA220003, -+ 0x81C, 0xE9240003, -+ 0x81C, 0xE8260003, -+ 0x81C, 0xE7280003, -+ 0x81C, 0xE62A0003, -+ 0x81C, 0xE52C0003, -+ 0x81C, 0xE42E0003, -+ 0x81C, 0xE3300003, -+ 0x81C, 0xE2320003, -+ 0x81C, 0xE1340003, -+ 0x81C, 0xC4360003, -+ 0x81C, 0xC3380003, -+ 0x81C, 0xC23A0003, -+ 0x81C, 0xC13C0003, -+ 0x81C, 0x883E0003, -+ 0x81C, 0x87400003, -+ 0x81C, 0x86420003, -+ 0x81C, 0x85440003, -+ 0x81C, 0x84460003, -+ 0x81C, 0x83480003, -+ 0x81C, 0x824A0003, -+ 0x81C, 0x814C0003, -+ 0x81C, 0x804E0003, -+ 0x81C, 0x64500003, -+ 0x81C, 0x63520003, -+ 0x81C, 0x62540003, -+ 0x81C, 0x61560003, -+ 0x81C, 0x60580003, -+ 0x81C, 0x475A0003, -+ 0x81C, 0x465C0003, -+ 0x81C, 0x455E0003, -+ 0x81C, 0x44600003, -+ 0x81C, 0x43620003, -+ 0x81C, 0x42640003, -+ 0x81C, 0x41660003, -+ 0x81C, 0x40680003, -+ 0x81C, 0x236A0003, -+ 0x81C, 0x226C0003, -+ 0x81C, 0x056E0003, -+ 0x81C, 0x04700003, -+ 0x81C, 0x03720003, -+ 0x81C, 0x02740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x81C, 0xFF000803, -+ 0x81C, 0xFE020803, -+ 0x81C, 0xFD040803, -+ 0x81C, 0xFC060803, -+ 0x81C, 0xFB080803, -+ 0x81C, 0xFA0A0803, -+ 0x81C, 0xF90C0803, -+ 0x81C, 0xF80E0803, -+ 0x81C, 0xF7100803, -+ 0x81C, 0xF6120803, -+ 0x81C, 0xF5140803, -+ 0x81C, 0xF4160803, -+ 0x81C, 0xF3180803, -+ 0x81C, 0xF21A0803, -+ 0x81C, 0xF11C0803, -+ 0x81C, 0xF01E0803, -+ 0x81C, 0xB7200803, -+ 0x81C, 0xB6220803, -+ 0x81C, 0xB5240803, -+ 0x81C, 0xB4260803, -+ 0x81C, 0xB3280803, -+ 0x81C, 0xB22A0803, -+ 0x81C, 0xB12C0803, -+ 0x81C, 0xAF2E0803, -+ 0x81C, 0xAE300803, -+ 0x81C, 0xAD320803, -+ 0x81C, 0xAC340803, -+ 0x81C, 0xAB360803, -+ 0x81C, 0xAA380803, -+ 0x81C, 0xA93A0803, -+ 0x81C, 0xA83C0803, -+ 0x81C, 0xA73E0803, -+ 0x81C, 0x88400803, -+ 0x81C, 0x87420803, -+ 0x81C, 0x86440803, -+ 0x81C, 0x85460803, -+ 0x81C, 0x84480803, -+ 0x81C, 0x834A0803, -+ 0x81C, 0x674C0803, -+ 0x81C, 0x664E0803, -+ 0x81C, 0x65500803, -+ 0x81C, 0x64520803, -+ 0x81C, 0x63540803, -+ 0x81C, 0x62560803, -+ 0x81C, 0x61580803, -+ 0x81C, 0x455A0803, -+ 0x81C, 0x445C0803, -+ 0x81C, 0x435E0803, -+ 0x81C, 0x42600803, -+ 0x81C, 0x41620803, -+ 0x81C, 0x25640803, -+ 0x81C, 0x24660803, -+ 0x81C, 0x23680803, -+ 0x81C, 0x226A0803, -+ 0x81C, 0x216C0803, -+ 0x81C, 0x016E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0x90001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFB000003, -+ 0x81C, 0xFA020003, -+ 0x81C, 0xF9040003, -+ 0x81C, 0xF8060003, -+ 0x81C, 0xF7080003, -+ 0x81C, 0xF60A0003, -+ 0x81C, 0xF50C0003, -+ 0x81C, 0xF40E0003, -+ 0x81C, 0xF3100003, -+ 0x81C, 0xF2120003, -+ 0x81C, 0xF1140003, -+ 0x81C, 0xF0160003, -+ 0x81C, 0xEF180003, -+ 0x81C, 0xEE1A0003, -+ 0x81C, 0xED1C0003, -+ 0x81C, 0xEC1E0003, -+ 0x81C, 0xEB200003, -+ 0x81C, 0xEA220003, -+ 0x81C, 0xE9240003, -+ 0x81C, 0xE8260003, -+ 0x81C, 0xE7280003, -+ 0x81C, 0xE62A0003, -+ 0x81C, 0xE52C0003, -+ 0x81C, 0xE42E0003, -+ 0x81C, 0xE3300003, -+ 0x81C, 0xE2320003, -+ 0x81C, 0xE1340003, -+ 0x81C, 0xC4360003, -+ 0x81C, 0xC3380003, -+ 0x81C, 0xC23A0003, -+ 0x81C, 0xC13C0003, -+ 0x81C, 0x883E0003, -+ 0x81C, 0x87400003, -+ 0x81C, 0x86420003, -+ 0x81C, 0x85440003, -+ 0x81C, 0x84460003, -+ 0x81C, 0x83480003, -+ 0x81C, 0x824A0003, -+ 0x81C, 0x814C0003, -+ 0x81C, 0x804E0003, -+ 0x81C, 0x64500003, -+ 0x81C, 0x63520003, -+ 0x81C, 0x62540003, -+ 0x81C, 0x61560003, -+ 0x81C, 0x60580003, -+ 0x81C, 0x475A0003, -+ 0x81C, 0x465C0003, -+ 0x81C, 0x455E0003, -+ 0x81C, 0x44600003, -+ 0x81C, 0x43620003, -+ 0x81C, 0x42640003, -+ 0x81C, 0x41660003, -+ 0x81C, 0x40680003, -+ 0x81C, 0x236A0003, -+ 0x81C, 0x226C0003, -+ 0x81C, 0x056E0003, -+ 0x81C, 0x04700003, -+ 0x81C, 0x03720003, -+ 0x81C, 0x02740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x81C, 0xFF000803, -+ 0x81C, 0xFE020803, -+ 0x81C, 0xFD040803, -+ 0x81C, 0xFC060803, -+ 0x81C, 0xFB080803, -+ 0x81C, 0xFA0A0803, -+ 0x81C, 0xF90C0803, -+ 0x81C, 0xF80E0803, -+ 0x81C, 0xF7100803, -+ 0x81C, 0xF6120803, -+ 0x81C, 0xF5140803, -+ 0x81C, 0xF4160803, -+ 0x81C, 0xF3180803, -+ 0x81C, 0xF21A0803, -+ 0x81C, 0xF11C0803, -+ 0x81C, 0xF01E0803, -+ 0x81C, 0xB7200803, -+ 0x81C, 0xB6220803, -+ 0x81C, 0xB5240803, -+ 0x81C, 0xB4260803, -+ 0x81C, 0xB3280803, -+ 0x81C, 0xB22A0803, -+ 0x81C, 0xB12C0803, -+ 0x81C, 0xAF2E0803, -+ 0x81C, 0xAE300803, -+ 0x81C, 0xAD320803, -+ 0x81C, 0xAC340803, -+ 0x81C, 0xAB360803, -+ 0x81C, 0xAA380803, -+ 0x81C, 0xA93A0803, -+ 0x81C, 0xA83C0803, -+ 0x81C, 0xA73E0803, -+ 0x81C, 0x88400803, -+ 0x81C, 0x87420803, -+ 0x81C, 0x86440803, -+ 0x81C, 0x85460803, -+ 0x81C, 0x84480803, -+ 0x81C, 0x834A0803, -+ 0x81C, 0x674C0803, -+ 0x81C, 0x664E0803, -+ 0x81C, 0x65500803, -+ 0x81C, 0x64520803, -+ 0x81C, 0x63540803, -+ 0x81C, 0x62560803, -+ 0x81C, 0x61580803, -+ 0x81C, 0x455A0803, -+ 0x81C, 0x445C0803, -+ 0x81C, 0x435E0803, -+ 0x81C, 0x42600803, -+ 0x81C, 0x41620803, -+ 0x81C, 0x25640803, -+ 0x81C, 0x24660803, -+ 0x81C, 0x23680803, -+ 0x81C, 0x226A0803, -+ 0x81C, 0x216C0803, -+ 0x81C, 0x016E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFB000003, -+ 0x81C, 0xFA020003, -+ 0x81C, 0xF9040003, -+ 0x81C, 0xF8060003, -+ 0x81C, 0xF7080003, -+ 0x81C, 0xF60A0003, -+ 0x81C, 0xF50C0003, -+ 0x81C, 0xF40E0003, -+ 0x81C, 0xF3100003, -+ 0x81C, 0xF2120003, -+ 0x81C, 0xF1140003, -+ 0x81C, 0xF0160003, -+ 0x81C, 0xEF180003, -+ 0x81C, 0xEE1A0003, -+ 0x81C, 0xED1C0003, -+ 0x81C, 0xEC1E0003, -+ 0x81C, 0xEB200003, -+ 0x81C, 0xEA220003, -+ 0x81C, 0xE9240003, -+ 0x81C, 0xE8260003, -+ 0x81C, 0xE7280003, -+ 0x81C, 0xE62A0003, -+ 0x81C, 0xCA2C0003, -+ 0x81C, 0xC92E0003, -+ 0x81C, 0xC8300003, -+ 0x81C, 0xC7320003, -+ 0x81C, 0xC6340003, -+ 0x81C, 0xC5360003, -+ 0x81C, 0xC4380003, -+ 0x81C, 0xC33A0003, -+ 0x81C, 0xC23C0003, -+ 0x81C, 0xC13E0003, -+ 0x81C, 0x88400003, -+ 0x81C, 0x87420003, -+ 0x81C, 0x86440003, -+ 0x81C, 0x85460003, -+ 0x81C, 0x84480003, -+ 0x81C, 0x834A0003, -+ 0x81C, 0x674C0003, -+ 0x81C, 0x664E0003, -+ 0x81C, 0x65500003, -+ 0x81C, 0x64520003, -+ 0x81C, 0x63540003, -+ 0x81C, 0x62560003, -+ 0x81C, 0x61580003, -+ 0x81C, 0x455A0003, -+ 0x81C, 0x445C0003, -+ 0x81C, 0x435E0003, -+ 0x81C, 0x42600003, -+ 0x81C, 0x41620003, -+ 0x81C, 0x25640003, -+ 0x81C, 0x24660003, -+ 0x81C, 0x23680003, -+ 0x81C, 0x226A0003, -+ 0x81C, 0x216C0003, -+ 0x81C, 0x016E0003, -+ 0x81C, 0x01700003, -+ 0x81C, 0x01720003, -+ 0x81C, 0x01740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x81C, 0xFF000803, -+ 0x81C, 0xFE020803, -+ 0x81C, 0xFD040803, -+ 0x81C, 0xFC060803, -+ 0x81C, 0xFB080803, -+ 0x81C, 0xFA0A0803, -+ 0x81C, 0xF90C0803, -+ 0x81C, 0xF80E0803, -+ 0x81C, 0xF7100803, -+ 0x81C, 0xF6120803, -+ 0x81C, 0xF5140803, -+ 0x81C, 0xF4160803, -+ 0x81C, 0xF3180803, -+ 0x81C, 0xF21A0803, -+ 0x81C, 0xF11C0803, -+ 0x81C, 0xF01E0803, -+ 0x81C, 0xB7200803, -+ 0x81C, 0xB6220803, -+ 0x81C, 0xB5240803, -+ 0x81C, 0xB4260803, -+ 0x81C, 0xB3280803, -+ 0x81C, 0xB22A0803, -+ 0x81C, 0xB12C0803, -+ 0x81C, 0xAF2E0803, -+ 0x81C, 0xAE300803, -+ 0x81C, 0xAD320803, -+ 0x81C, 0xAC340803, -+ 0x81C, 0xAB360803, -+ 0x81C, 0xAA380803, -+ 0x81C, 0xA93A0803, -+ 0x81C, 0xA83C0803, -+ 0x81C, 0xA73E0803, -+ 0x81C, 0x88400803, -+ 0x81C, 0x87420803, -+ 0x81C, 0x86440803, -+ 0x81C, 0x85460803, -+ 0x81C, 0x84480803, -+ 0x81C, 0x834A0803, -+ 0x81C, 0x674C0803, -+ 0x81C, 0x664E0803, -+ 0x81C, 0x65500803, -+ 0x81C, 0x64520803, -+ 0x81C, 0x63540803, -+ 0x81C, 0x62560803, -+ 0x81C, 0x61580803, -+ 0x81C, 0x455A0803, -+ 0x81C, 0x445C0803, -+ 0x81C, 0x435E0803, -+ 0x81C, 0x42600803, -+ 0x81C, 0x41620803, -+ 0x81C, 0x25640803, -+ 0x81C, 0x24660803, -+ 0x81C, 0x23680803, -+ 0x81C, 0x226A0803, -+ 0x81C, 0x216C0803, -+ 0x81C, 0x016E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0xB0000000, 0x00000000, -+}; -+ -+const u32 array_mp_8821c_agc_tab_diff_btg[] = { -+ 0x80001004, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFF000013, -+ 0x81C, 0xFE020013, -+ 0x81C, 0xFD040013, -+ 0x81C, 0xFC060013, -+ 0x81C, 0xFB080013, -+ 0x81C, 0xFA0A0013, -+ 0x81C, 0xF90C0013, -+ 0x81C, 0xF80E0013, -+ 0x81C, 0xF7100013, -+ 0x81C, 0xF6120013, -+ 0x81C, 0xF5140013, -+ 0x81C, 0xF4160013, -+ 0x81C, 0xF3180013, -+ 0x81C, 0xF21A0013, -+ 0x81C, 0xF11C0013, -+ 0x81C, 0xF01E0013, -+ 0x81C, 0xEF200013, -+ 0x81C, 0xEE220013, -+ 0x81C, 0xED240013, -+ 0x81C, 0xEC260013, -+ 0x81C, 0xEB280013, -+ 0x81C, 0xEA2A0013, -+ 0x81C, 0xE92C0013, -+ 0x81C, 0xE82E0013, -+ 0x81C, 0xE7300013, -+ 0x81C, 0x8B320013, -+ 0x81C, 0x8A340013, -+ 0x81C, 0x89360013, -+ 0x81C, 0x88380013, -+ 0x81C, 0x873A0013, -+ 0x81C, 0x863C0013, -+ 0x81C, 0x853E0013, -+ 0x81C, 0x84400013, -+ 0x81C, 0x83420013, -+ 0x81C, 0x82440013, -+ 0x81C, 0x81460013, -+ 0x81C, 0x08480013, -+ 0x81C, 0x074A0013, -+ 0x81C, 0x064C0013, -+ 0x81C, 0x054E0013, -+ 0x81C, 0x04500013, -+ 0x81C, 0x03520013, -+ 0x81C, 0x88540003, -+ 0x81C, 0x87560003, -+ 0x81C, 0x86580003, -+ 0x81C, 0x855A0003, -+ 0x81C, 0x845C0003, -+ 0x81C, 0x835E0003, -+ 0x81C, 0x82600003, -+ 0x81C, 0x81620003, -+ 0x81C, 0x07640003, -+ 0x81C, 0x06660003, -+ 0x81C, 0x05680003, -+ 0x81C, 0x046A0003, -+ 0x81C, 0x036C0003, -+ 0x81C, 0x026E0003, -+ 0x81C, 0x01700003, -+ 0x81C, 0x01720003, -+ 0x81C, 0x01740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x81C, 0xFF000813, -+ 0x81C, 0xFE020813, -+ 0x81C, 0xFD040813, -+ 0x81C, 0xFC060813, -+ 0x81C, 0xFB080813, -+ 0x81C, 0xFA0A0813, -+ 0x81C, 0xF90C0813, -+ 0x81C, 0xF80E0813, -+ 0x81C, 0xF7100813, -+ 0x81C, 0xF6120813, -+ 0x81C, 0xF5140813, -+ 0x81C, 0xF4160813, -+ 0x81C, 0xF3180813, -+ 0x81C, 0xF21A0813, -+ 0x81C, 0xF11C0813, -+ 0x81C, 0x941E0813, -+ 0x81C, 0x93200813, -+ 0x81C, 0x92220813, -+ 0x81C, 0x91240813, -+ 0x81C, 0x90260813, -+ 0x81C, 0x8F280813, -+ 0x81C, 0x8E2A0813, -+ 0x81C, 0x8D2C0813, -+ 0x81C, 0x8C2E0813, -+ 0x81C, 0x8B300813, -+ 0x81C, 0x8A320813, -+ 0x81C, 0x89340813, -+ 0x81C, 0x88360813, -+ 0x81C, 0x87380813, -+ 0x81C, 0x863A0813, -+ 0x81C, 0x853C0813, -+ 0x81C, 0x843E0813, -+ 0x81C, 0x83400813, -+ 0x81C, 0x82420813, -+ 0x81C, 0x81440813, -+ 0x81C, 0x07460813, -+ 0x81C, 0x06480813, -+ 0x81C, 0x054A0813, -+ 0x81C, 0x044C0813, -+ 0x81C, 0x034E0813, -+ 0x81C, 0x02500813, -+ 0x81C, 0x01520813, -+ 0x81C, 0x88540803, -+ 0x81C, 0x87560803, -+ 0x81C, 0x86580803, -+ 0x81C, 0x855A0803, -+ 0x81C, 0x845C0803, -+ 0x81C, 0x835E0803, -+ 0x81C, 0x82600803, -+ 0x81C, 0x81620803, -+ 0x81C, 0x07640803, -+ 0x81C, 0x06660803, -+ 0x81C, 0x05680803, -+ 0x81C, 0x046A0803, -+ 0x81C, 0x036C0803, -+ 0x81C, 0x026E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0x90001005, 0x00000000, 0x40000000, 0x00000000, -+ 0x81C, 0xFF000013, -+ 0x81C, 0xFE020013, -+ 0x81C, 0xFD040013, -+ 0x81C, 0xFC060013, -+ 0x81C, 0xFB080013, -+ 0x81C, 0xFA0A0013, -+ 0x81C, 0xF90C0013, -+ 0x81C, 0xF80E0013, -+ 0x81C, 0xF7100013, -+ 0x81C, 0xF6120013, -+ 0x81C, 0xF5140013, -+ 0x81C, 0xF4160013, -+ 0x81C, 0xF3180013, -+ 0x81C, 0xF21A0013, -+ 0x81C, 0xF11C0013, -+ 0x81C, 0xF01E0013, -+ 0x81C, 0xEF200013, -+ 0x81C, 0xEE220013, -+ 0x81C, 0xED240013, -+ 0x81C, 0xEC260013, -+ 0x81C, 0xEB280013, -+ 0x81C, 0xEA2A0013, -+ 0x81C, 0xE92C0013, -+ 0x81C, 0xE82E0013, -+ 0x81C, 0xE7300013, -+ 0x81C, 0x8B320013, -+ 0x81C, 0x8A340013, -+ 0x81C, 0x89360013, -+ 0x81C, 0x88380013, -+ 0x81C, 0x873A0013, -+ 0x81C, 0x863C0013, -+ 0x81C, 0x853E0013, -+ 0x81C, 0x84400013, -+ 0x81C, 0x83420013, -+ 0x81C, 0x82440013, -+ 0x81C, 0x81460013, -+ 0x81C, 0x08480013, -+ 0x81C, 0x074A0013, -+ 0x81C, 0x064C0013, -+ 0x81C, 0x054E0013, -+ 0x81C, 0x04500013, -+ 0x81C, 0x03520013, -+ 0x81C, 0x88540003, -+ 0x81C, 0x87560003, -+ 0x81C, 0x86580003, -+ 0x81C, 0x855A0003, -+ 0x81C, 0x845C0003, -+ 0x81C, 0x835E0003, -+ 0x81C, 0x82600003, -+ 0x81C, 0x81620003, -+ 0x81C, 0x07640003, -+ 0x81C, 0x06660003, -+ 0x81C, 0x05680003, -+ 0x81C, 0x046A0003, -+ 0x81C, 0x036C0003, -+ 0x81C, 0x026E0003, -+ 0x81C, 0x01700003, -+ 0x81C, 0x01720003, -+ 0x81C, 0x01740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x81C, 0xFF000813, -+ 0x81C, 0xFE020813, -+ 0x81C, 0xFD040813, -+ 0x81C, 0xFC060813, -+ 0x81C, 0xFB080813, -+ 0x81C, 0xFA0A0813, -+ 0x81C, 0xF90C0813, -+ 0x81C, 0xF80E0813, -+ 0x81C, 0xF7100813, -+ 0x81C, 0xF6120813, -+ 0x81C, 0xF5140813, -+ 0x81C, 0xF4160813, -+ 0x81C, 0xF3180813, -+ 0x81C, 0xF21A0813, -+ 0x81C, 0xF11C0813, -+ 0x81C, 0x941E0813, -+ 0x81C, 0x93200813, -+ 0x81C, 0x92220813, -+ 0x81C, 0x91240813, -+ 0x81C, 0x90260813, -+ 0x81C, 0x8F280813, -+ 0x81C, 0x8E2A0813, -+ 0x81C, 0x8D2C0813, -+ 0x81C, 0x8C2E0813, -+ 0x81C, 0x8B300813, -+ 0x81C, 0x8A320813, -+ 0x81C, 0x89340813, -+ 0x81C, 0x88360813, -+ 0x81C, 0x87380813, -+ 0x81C, 0x863A0813, -+ 0x81C, 0x853C0813, -+ 0x81C, 0x843E0813, -+ 0x81C, 0x83400813, -+ 0x81C, 0x82420813, -+ 0x81C, 0x81440813, -+ 0x81C, 0x07460813, -+ 0x81C, 0x06480813, -+ 0x81C, 0x054A0813, -+ 0x81C, 0x044C0813, -+ 0x81C, 0x034E0813, -+ 0x81C, 0x02500813, -+ 0x81C, 0x01520813, -+ 0x81C, 0x88540803, -+ 0x81C, 0x87560803, -+ 0x81C, 0x86580803, -+ 0x81C, 0x855A0803, -+ 0x81C, 0x845C0803, -+ 0x81C, 0x835E0803, -+ 0x81C, 0x82600803, -+ 0x81C, 0x81620803, -+ 0x81C, 0x07640803, -+ 0x81C, 0x06660803, -+ 0x81C, 0x05680803, -+ 0x81C, 0x046A0803, -+ 0x81C, 0x036C0803, -+ 0x81C, 0x026E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0xA0000000, 0x00000000, -+ 0x81C, 0xFF000013, -+ 0x81C, 0xFE020013, -+ 0x81C, 0xFD040013, -+ 0x81C, 0xFC060013, -+ 0x81C, 0xFB080013, -+ 0x81C, 0xFA0A0013, -+ 0x81C, 0xF90C0013, -+ 0x81C, 0xF80E0013, -+ 0x81C, 0xF7100013, -+ 0x81C, 0xF6120013, -+ 0x81C, 0xF5140013, -+ 0x81C, 0xF4160013, -+ 0x81C, 0xF3180013, -+ 0x81C, 0xF21A0013, -+ 0x81C, 0xF11C0013, -+ 0x81C, 0xF01E0013, -+ 0x81C, 0xEF200013, -+ 0x81C, 0xEE220013, -+ 0x81C, 0xED240013, -+ 0x81C, 0xEC260013, -+ 0x81C, 0xEB280013, -+ 0x81C, 0xEA2A0013, -+ 0x81C, 0xE92C0013, -+ 0x81C, 0xE82E0013, -+ 0x81C, 0xE7300013, -+ 0x81C, 0x8A320013, -+ 0x81C, 0x89340013, -+ 0x81C, 0x88360013, -+ 0x81C, 0x87380013, -+ 0x81C, 0x863A0013, -+ 0x81C, 0x853C0013, -+ 0x81C, 0x843E0013, -+ 0x81C, 0x83400013, -+ 0x81C, 0x82420013, -+ 0x81C, 0x81440013, -+ 0x81C, 0x07460013, -+ 0x81C, 0x06480013, -+ 0x81C, 0x054A0013, -+ 0x81C, 0x044C0013, -+ 0x81C, 0x034E0013, -+ 0x81C, 0x02500013, -+ 0x81C, 0x01520013, -+ 0x81C, 0x88540003, -+ 0x81C, 0x87560003, -+ 0x81C, 0x86580003, -+ 0x81C, 0x855A0003, -+ 0x81C, 0x845C0003, -+ 0x81C, 0x835E0003, -+ 0x81C, 0x82600003, -+ 0x81C, 0x81620003, -+ 0x81C, 0x07640003, -+ 0x81C, 0x06660003, -+ 0x81C, 0x05680003, -+ 0x81C, 0x046A0003, -+ 0x81C, 0x036C0003, -+ 0x81C, 0x026E0003, -+ 0x81C, 0x01700003, -+ 0x81C, 0x01720003, -+ 0x81C, 0x01740003, -+ 0x81C, 0x01760003, -+ 0x81C, 0x01780003, -+ 0x81C, 0x017A0003, -+ 0x81C, 0x017C0003, -+ 0x81C, 0x017E0003, -+ 0x81C, 0xFF000813, -+ 0x81C, 0xFE020813, -+ 0x81C, 0xFD040813, -+ 0x81C, 0xFC060813, -+ 0x81C, 0xFB080813, -+ 0x81C, 0xFA0A0813, -+ 0x81C, 0xF90C0813, -+ 0x81C, 0xF80E0813, -+ 0x81C, 0xF7100813, -+ 0x81C, 0xF6120813, -+ 0x81C, 0xF5140813, -+ 0x81C, 0xF4160813, -+ 0x81C, 0xF3180813, -+ 0x81C, 0xF21A0813, -+ 0x81C, 0xF11C0813, -+ 0x81C, 0x961E0813, -+ 0x81C, 0x95200813, -+ 0x81C, 0x94220813, -+ 0x81C, 0x93240813, -+ 0x81C, 0x92260813, -+ 0x81C, 0x91280813, -+ 0x81C, 0x8F2A0813, -+ 0x81C, 0x8E2C0813, -+ 0x81C, 0x8D2E0813, -+ 0x81C, 0x8C300813, -+ 0x81C, 0x8B320813, -+ 0x81C, 0x8A340813, -+ 0x81C, 0x89360813, -+ 0x81C, 0x88380813, -+ 0x81C, 0x873A0813, -+ 0x81C, 0x863C0813, -+ 0x81C, 0x853E0813, -+ 0x81C, 0x84400813, -+ 0x81C, 0x83420813, -+ 0x81C, 0x82440813, -+ 0x81C, 0x08460813, -+ 0x81C, 0x07480813, -+ 0x81C, 0x064A0813, -+ 0x81C, 0x054C0813, -+ 0x81C, 0x044E0813, -+ 0x81C, 0x03500813, -+ 0x81C, 0x02520813, -+ 0x81C, 0x89540803, -+ 0x81C, 0x88560803, -+ 0x81C, 0x87580803, -+ 0x81C, 0x865A0803, -+ 0x81C, 0x855C0803, -+ 0x81C, 0x845E0803, -+ 0x81C, 0x83600803, -+ 0x81C, 0x82620803, -+ 0x81C, 0x07640803, -+ 0x81C, 0x06660803, -+ 0x81C, 0x05680803, -+ 0x81C, 0x046A0803, -+ 0x81C, 0x036C0803, -+ 0x81C, 0x026E0803, -+ 0x81C, 0x01700803, -+ 0x81C, 0x01720803, -+ 0x81C, 0x01740803, -+ 0x81C, 0x01760803, -+ 0x81C, 0x01780803, -+ 0x81C, 0x017A0803, -+ 0x81C, 0x017C0803, -+ 0x81C, 0x017E0803, -+ 0xB0000000, 0x00000000, -+}; -+ -+void -+odm_read_and_config_mp_8821c_agc_tab_diff(struct dm_struct *dm, -+ const u32 array[], -+ u32 array_len) -+{ -+ u32 i = 0; -+ u8 c_cond; -+ boolean is_matched = true, is_skipped = false; -+ -+ u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ u32 a1 = 0, a2 = 0, a3 = 0, a4 = 0; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+ while ((i + 1) < array_len) { -+ v1 = array[i]; -+ v2 = array[i + 1]; -+ -+ if (v1 & (BIT(31) | BIT(30))) {/*positive & negative condition*/ -+ if (v1 & BIT(31)) {/* positive condition*/ -+ c_cond = -+ (u8)((v1 & (BIT(29) | BIT(28))) >> 28); -+ if (c_cond == COND_ENDIF) {/*end*/ -+ is_matched = true; -+ is_skipped = false; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ENDIF\n"); -+ } else if (c_cond == COND_ELSE) { /*else*/ -+ is_matched = is_skipped ? false : true; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ELSE\n"); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "IF or ELSE IF\n"); -+ } -+ } else if (v1 & BIT(30)) { /*negative condition*/ -+ if (!is_skipped) { -+ a1 = pre_v1; a2 = pre_v2; -+ a3 = v1; a4 = v2; -+ if (check_positive(dm, -+ a1, a2, a3, a4)) { -+ is_matched = true; -+ is_skipped = true; -+ } else { -+ is_matched = false; -+ is_skipped = false; -+ } -+ } else { -+ is_matched = false; -+ } -+ } -+ } else { -+ if (is_matched) -+ odm_config_bb_agc_8821c(dm, v1, MASKDWORD, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u32 -+odm_get_version_mp_8821c_agc_tab_diff(void) -+{ -+ return 64; -+} -+ -+/****************************************************************************** -+ * phy_reg.TXT -+ ******************************************************************************/ -+ -+const u32 array_mp_8821c_phy_reg[] = { -+ 0x800, 0x9020D010, -+ 0x804, 0x80018180, -+ 0x808, 0x04028211, -+ 0x80C, 0x13D10011, -+ 0x810, 0x21104255, -+ 0x814, 0x020C3D10, -+ 0x818, 0x84A10385, -+ 0x81C, 0x1E1E081F, -+ 0x820, 0x0001AAAA, -+ 0x824, 0x00030FE0, -+ 0x828, 0x0000CCCC, -+ 0x82C, 0x75CB7010, -+ 0x830, 0x79A0EAAA, -+ 0x834, 0x072E698A, -+ 0x838, 0x87766461, -+ 0x83C, 0x9194B2B6, -+ 0x840, 0x171740E0, -+ 0x844, 0x4D3D7CDB, -+ 0x848, 0x4AD0408B, -+ 0x84C, 0x6AFBF7A5, -+ 0x850, 0x28A74706, -+ 0x854, 0x0001520C, -+ 0x858, 0x4060C000, -+ 0x85C, 0x74010160, -+ 0x860, 0x68A7C321, -+ 0x864, 0x79F27432, -+ 0x868, 0x8CA7A314, -+ 0x86C, 0x558C2878, -+ 0x870, 0x55555555, -+ 0x874, 0x27612C2E, -+ 0x878, 0xC0003152, -+ 0x87C, 0x5C8FC000, -+ 0x880, 0x00000000, -+ 0x884, 0x00000000, -+ 0x888, 0x00000000, -+ 0x88C, 0x00000000, -+ 0x890, 0x00000000, -+ 0x894, 0x00000000, -+ 0x898, 0x00000000, -+ 0x89C, 0x00000000, -+ 0x8A0, 0x00000013, -+ 0x8A4, 0x7F7F7F7F, -+ 0x8A8, 0x2202033E, -+ 0x8AC, 0xF00F000A, -+ 0x8B0, 0x00000600, -+ 0x8B4, 0x000FC080, -+ 0x8B8, 0xEC0057FF, -+ 0x8BC, 0x2CB520A3, -+ 0x8C0, 0xFFE04020, -+ 0x8C4, 0x47C00000, -+ 0x8C8, 0x00025165, -+ 0x82000400, 0x00000000, 0x40000000, 0x00000000, -+ 0x8CC, 0x08190492, -+ 0xA0000000, 0x00000000, -+ 0x8CC, 0x081A0492, -+ 0xB0000000, 0x00000000, -+ 0x8D0, 0x0000B800, -+ 0x8D4, 0x860308A0, -+ 0x8D8, 0x290B5612, -+ 0x8DC, 0x00000000, -+ 0x8E0, 0x32D16777, -+ 0x8E4, 0x49092925, -+ 0x8E8, 0xFFFFC42C, -+ 0x8EC, 0x99999999, -+ 0x8F0, 0x00009999, -+ 0x8F4, 0x00D80FA1, -+ 0x8F8, 0x400000C0, -+ 0x8FC, 0x00000130, -+ 0x900, 0x00C00000, -+ 0x904, 0x0FFF0FFF, -+ 0x908, 0x00000000, -+ 0x90C, 0x13000000, -+ 0x910, 0x0000FC00, -+ 0x914, 0xC6380000, -+ 0x918, 0x1C1028C0, -+ 0x91C, 0x64B11A1C, -+ 0x920, 0xE0767233, -+ 0x924, 0x855A2500, -+ 0x928, 0x4AB0E4E4, -+ 0x92C, 0xFFFEB200, -+ 0x930, 0xFFFFFFFE, -+ 0x934, 0x001FFFFF, -+ 0x938, 0x00008480, -+ 0x93C, 0xE41C0642, -+ 0x940, 0x0E470430, -+ 0x944, 0x00000000, -+ 0x948, 0xAC000000, -+ 0x94C, 0x10000083, -+ 0x950, 0xB2010080, -+ 0x954, 0x86510080, -+ 0x958, 0x00000181, -+ 0x95C, 0x04248000, -+ 0x960, 0x00000000, -+ 0x964, 0x00000000, -+ 0x968, 0x00000000, -+ 0x96C, 0x00000000, -+ 0x970, 0x00001FFF, -+ 0x974, 0x04000FFF, -+ 0x978, 0x00000000, -+ 0x97C, 0x00000000, -+ 0x980, 0x00000000, -+ 0x984, 0x00000000, -+ 0x988, 0x00000000, -+ 0x98C, 0x23440000, -+ 0x990, 0x27100000, -+ 0x994, 0xFFFF0100, -+ 0x998, 0xFFFFFF5C, -+ 0x99C, 0xFFFFFFFF, -+ 0x9A0, 0x000000FF, -+ 0x9A4, 0x80000088, -+ 0x9A8, 0x0C2F0000, -+ 0x9AC, 0x01560000, -+ 0x9B0, 0x70000000, -+ 0x9B4, 0x00000000, -+ 0x9B8, 0x00000000, -+ 0x9BC, 0x00000000, -+ 0x9C0, 0x00000000, -+ 0x9C4, 0x00000000, -+ 0x9C8, 0x00000000, -+ 0x9CC, 0x00000000, -+ 0x9D0, 0x00000000, -+ 0x9D4, 0x00000000, -+ 0x9D8, 0x00000000, -+ 0x9DC, 0x00000000, -+ 0x9E0, 0x00000000, -+ 0x9E4, 0x02000402, -+ 0x9E8, 0x000022D4, -+ 0x9EC, 0x00000000, -+ 0x9F0, 0x00000000, -+ 0x9F4, 0x00000000, -+ 0x9F8, 0x00000000, -+ 0x9FC, 0xEFFFE7FF, -+ 0xA00, 0x00D040C8, -+ 0xA04, 0x80FF800C, -+ 0xA08, 0x9C838300, -+ 0xA0C, 0x297E000F, -+ 0xA10, 0x9500BB78, -+ 0xA14, 0x1114D028, -+ 0xA18, 0x00881117, -+ 0xA1C, 0x89140F00, -+ 0xA20, 0xE82C0000, -+ 0xA24, 0x64B80C1C, -+ 0xA28, 0x00008810, -+ 0xA2C, 0x00D20000, -+ 0xA70, 0x101FBF00, -+ 0xA74, 0x00000107, -+ 0xA78, 0x00008900, -+ 0xA7C, 0x225B0606, -+ 0xA80, 0x21807532, -+ 0xA84, 0x80120000, -+ 0xA88, 0x048C0000, -+ 0xA8C, 0x12345678, -+ 0xA90, 0xABCDEF00, -+ 0xA94, 0x001B1B89, -+ 0xA98, 0x00000000, -+ 0xA9C, 0x3F000000, -+ 0xAA0, 0x00000000, -+ 0xAA4, 0x00080000, -+ 0xAA8, 0xEACF0004, -+ 0xAAC, 0x01235667, -+ 0xAB0, 0x00000000, -+ 0xB00, 0xE1000440, -+ 0xB04, 0x00800000, -+ 0xB08, 0xFF02030B, -+ 0xB0C, 0x01EAA406, -+ 0xB10, 0x00030690, -+ 0xB14, 0x006000FA, -+ 0xB18, 0x00000002, -+ 0xB1C, 0x00000002, -+ 0xB20, 0x4B00001F, -+ 0xB24, 0x4E8E3E40, -+ 0xB28, 0x03020100, -+ 0xB2C, 0x07060504, -+ 0xB30, 0x0B0A0908, -+ 0xB34, 0x0F0E0D0C, -+ 0xB38, 0x13121110, -+ 0xB3C, 0x0000003A, -+ 0xB40, 0x00000000, -+ 0xB44, 0x80000000, -+ 0xB48, 0x3F0000FA, -+ 0xB4C, 0x88C80020, -+ 0xB50, 0x00000000, -+ 0xB54, 0x00004241, -+ 0xB58, 0xE0008208, -+ 0xB5C, 0x41EFFFF9, -+ 0xB60, 0x00000000, -+ 0xB64, 0x00200063, -+ 0xB68, 0x0000003A, -+ 0xB6C, 0x00000102, -+ 0xB70, 0x4E6D1870, -+ 0xB74, 0x03020100, -+ 0xB78, 0x07060504, -+ 0xB7C, 0x0B0A0908, -+ 0xB80, 0x0F0E0D0C, -+ 0xB84, 0x13121110, -+ 0xB88, 0x00000000, -+ 0xB8C, 0x00000000, -+ 0xC00, 0x00000007, -+ 0xC04, 0x03050020, -+ 0xC08, 0x60403231, -+ 0xC0C, 0x00012345, -+ 0xC10, 0x00000100, -+ 0xC14, 0x01000000, -+ 0xC18, 0x00000000, -+ 0xC1C, 0x40040053, -+ 0xC20, 0x400503A3, -+ 0xC24, 0x00000000, -+ 0xC28, 0x00000000, -+ 0xC2C, 0x00000000, -+ 0xC30, 0x00000000, -+ 0xC34, 0x00000000, -+ 0xC38, 0x00000000, -+ 0xC3C, 0x00000000, -+ 0xC40, 0x00000000, -+ 0xC44, 0x00000000, -+ 0xC48, 0x00000000, -+ 0xC4C, 0x00000000, -+ 0xC50, 0x00000020, -+ 0xC54, 0x00000000, -+ 0xC58, 0xD8020402, -+ 0xC5C, 0xDE000120, -+ 0xC68, 0x0000003F, -+ 0xC6C, 0x0000122A, -+ 0xC70, 0x00000000, -+ 0xC74, 0x00000000, -+ 0xC78, 0x00000000, -+ 0xC7C, 0x00000000, -+ 0xC80, 0x00000000, -+ 0xC84, 0x00000000, -+ 0xC88, 0x00000000, -+ 0xC8C, 0x07000000, -+ 0xC94, 0x01000100, -+ 0xC98, 0x201C8000, -+ 0xC9C, 0x00000000, -+ 0xCA0, 0x0000A555, -+ 0xCA4, 0x08040201, -+ 0xCA8, 0x80402010, -+ 0xCAC, 0x00000000, -+ 0x80001005, 0x00000000, 0x40000000, 0x00000000, -+ 0xCB0, 0x77777717, -+ 0xA0000000, 0x00000000, -+ 0xCB0, 0x77775747, -+ 0xB0000000, 0x00000000, -+ 0xCB8, 0x00000000, -+ 0xCBC, 0x00000000, -+ 0xCC0, 0x00000000, -+ 0xCC4, 0x00000000, -+ 0xCC8, 0x00000000, -+ 0xCCC, 0x00000000, -+ 0xCD0, 0x00000000, -+ 0xCD4, 0x00000000, -+ 0xCD8, 0x00000000, -+ 0xCDC, 0x00000000, -+ 0xCE0, 0x00000000, -+ 0xCE4, 0x00000000, -+ 0xCE8, 0x00000000, -+ 0xCEC, 0x00000000, -+ 0xE00, 0x00000007, -+ 0xE04, 0x00000020, -+ 0xE08, 0x60403231, -+ 0xE0C, 0x00012345, -+ 0xE10, 0x00000100, -+ 0xE14, 0x01000000, -+ 0xE18, 0x00000000, -+ 0xE1C, 0x40040053, -+ 0xE20, 0x00020103, -+ 0xE24, 0x00000000, -+ 0xE28, 0x00000000, -+ 0xE2C, 0x00000000, -+ 0xE30, 0x00000000, -+ 0xE34, 0x00000000, -+ 0xE38, 0x00000000, -+ 0xE3C, 0x00000000, -+ 0xE40, 0x00000000, -+ 0xE44, 0x00000000, -+ 0xE48, 0x00000000, -+ 0xE4C, 0x00000000, -+ 0xE50, 0x00000020, -+ 0xE54, 0x00000000, -+ 0xE58, 0xD8020402, -+ 0xE5C, 0xDE000120, -+ 0xE68, 0x59799979, -+ 0xE6C, 0x0000122A, -+ 0xE70, 0x99795979, -+ 0xE74, 0x99795979, -+ 0xE78, 0x99799979, -+ 0xE7C, 0x99791979, -+ 0xE80, 0x19791979, -+ 0xE84, 0x19791979, -+ 0xE88, 0x00000000, -+ 0xE8C, 0x07000000, -+ 0xE94, 0x01000100, -+ 0xE98, 0x201C8000, -+ 0xE9C, 0x00000000, -+ 0xEA0, 0x0000A555, -+ 0xEA4, 0x08040201, -+ 0xEA8, 0x80402010, -+ 0xEAC, 0x00000000, -+ 0xEB0, 0x98543210, -+ 0xEB4, 0x000000BA, -+ 0xEB8, 0x00000000, -+ 0xEBC, 0x00000000, -+ 0xEC0, 0x00000000, -+ 0xEC4, 0x00000000, -+ 0xEC8, 0x00000000, -+ 0xECC, 0x00000000, -+ 0xED0, 0x00000000, -+ 0xED4, 0x00000000, -+ 0xED8, 0x00000000, -+ 0xEDC, 0x00000000, -+ 0xEE0, 0x00000000, -+ 0xEE4, 0x00000000, -+ 0xEE8, 0x00000000, -+ 0xEEC, 0x00000000, -+ 0x1900, 0x00000000, -+ 0x1904, 0x00238000, -+ 0x1908, 0x00000000, -+ 0x190C, 0x00000000, -+ 0x1910, 0x00001800, -+ 0x1914, 0x00000000, -+ 0x1918, 0x00000000, -+ 0x191C, 0x00000000, -+ 0x1920, 0x00000000, -+ 0x1924, 0x00000000, -+ 0x1928, 0x00000000, -+ 0x192C, 0x00000000, -+ 0x1930, 0x00000000, -+ 0x1934, 0x00000000, -+ 0x1938, 0x00000000, -+ 0x193C, 0x00000000, -+ 0x1940, 0x00000000, -+ 0x1944, 0x00000000, -+ 0x1948, 0x00000000, -+ 0x194C, 0x00000000, -+ 0x1950, 0x00000000, -+ 0x1954, 0x00000000, -+ 0x1958, 0x00000000, -+ 0x195C, 0x00000000, -+ 0x1960, 0x00000000, -+ 0x1964, 0x00000000, -+ 0x1968, 0x00000000, -+ 0x196C, 0x00000000, -+ 0x1970, 0x00000000, -+ 0x1974, 0x00000000, -+ 0x1978, 0x00000000, -+ 0x197C, 0x00000000, -+ 0x1980, 0x00000000, -+ 0x1984, 0x03000000, -+ 0x1988, 0x21401E88, -+ 0x198C, 0x00004000, -+ 0x1990, 0x00000000, -+ 0x1994, 0x00000000, -+ 0x1998, 0x00000053, -+ 0x199C, 0x00000000, -+ 0x19A0, 0x00000000, -+ 0x19A4, 0x00000000, -+ 0x19A8, 0x010A0000, -+ 0x19AC, 0x0E47E47F, -+ 0x19B0, 0x00008000, -+ 0x19B4, 0x0E47E47F, -+ 0x19B8, 0x00000000, -+ 0x19BC, 0x00000000, -+ 0x19C0, 0x00000000, -+ 0x19C4, 0x00000000, -+ 0x19C8, 0x00000000, -+ 0x19CC, 0x00000000, -+ 0x19D0, 0x00000000, -+ 0x19D4, 0x77777777, -+ 0x19D8, 0x00000777, -+ 0x19DC, 0x133E0F37, -+ 0x19E0, 0x00000000, -+ 0x19E4, 0x00000000, -+ 0x19E8, 0x00000000, -+ 0x19EC, 0x00000000, -+ 0x19F0, 0x00000000, -+ 0x19F4, 0x00000000, -+ 0x19F8, 0x01A00000, -+ 0x19FC, 0x00000000, -+ 0x1C00, 0x00000100, -+ 0x1C04, 0x01000000, -+ 0x1C08, 0x00000100, -+ 0x1C0C, 0x01000000, -+ 0x1C10, 0x00000100, -+ 0x1C14, 0x01000000, -+ 0x1C18, 0x00000100, -+ 0x1C1C, 0x01000000, -+ 0x1C20, 0x00000100, -+ 0x1C24, 0x01000000, -+ 0x1C28, 0x00000100, -+ 0x1C2C, 0x01000000, -+ 0x1C30, 0x00000100, -+ 0x1C34, 0x01000000, -+ 0x1C38, 0x00000000, -+ 0x1C3C, 0x00008000, -+ 0x1C40, 0x000C0100, -+ 0x1C44, 0x000000F3, -+ 0x1C48, 0x1A8249A8, -+ 0x1C4C, 0x1461C826, -+ 0x1C50, 0x0001469E, -+ 0x1C54, 0x58D158D1, -+ 0x1C58, 0x04490088, -+ 0x1C5C, 0x04004400, -+ 0x1C60, 0x00000000, -+ 0x1C64, 0x04004400, -+ 0x1C68, 0x0B7B7B75, -+ 0x1C6C, 0x01000000, -+ 0x1C70, 0x00A08145, -+ 0x1C74, 0x2080E0E0, -+ 0x1C78, 0x00000000, -+ 0x1C7C, 0x00000010, -+ 0x1C80, 0x00000100, -+ 0x1C84, 0x01000000, -+ 0x1C88, 0x00000100, -+ 0x1C8C, 0x01000000, -+ 0x1C90, 0x00000100, -+ 0x1C94, 0x01000000, -+ 0x1C98, 0x00000100, -+ 0x1C9C, 0x01000000, -+ 0x1CA0, 0x00000100, -+ 0x1CA4, 0x01000000, -+ 0x1CA8, 0x00000100, -+ 0x1CAC, 0x01000000, -+ 0x1CB0, 0x00000100, -+ 0x1CB4, 0x01000000, -+ 0x1CB8, 0x00000000, -+ 0x1CBC, 0x00000000, -+ 0x1CC0, 0x201B0100, -+ 0x1CC4, 0x00308000, -+ 0x1CC8, 0x5B74B6E9, -+ 0x1CCC, 0x01000000, -+ 0x1CD0, 0x00000400, -+ 0x1CD4, 0x01000000, -+ 0x1CD8, 0x01B8ADEB, -+ 0x1CDC, 0x01000000, -+ 0x1CE0, 0x00030003, -+ 0x1CE4, 0x4E4A0306, -+ 0x1CE8, 0x00000100, -+ 0x1CEC, 0x01000000, -+ 0x1CF0, 0x00000100, -+ 0x1CF4, 0x01000000, -+ 0x1CF8, 0x01B8ADEB, -+ 0x1CFC, 0x00000000, -+ 0xC60, 0x700B8040, -+ 0xC60, 0x700B8040, -+ 0xC60, 0x70146040, -+ 0xC60, 0x70246040, -+ 0xC60, 0x70346040, -+ 0xC60, 0x70446040, -+ 0xC60, 0x705B2040, -+ 0xC60, 0x70646040, -+ 0xC60, 0x707B8040, -+ 0xC60, 0x708B8040, -+ 0xC60, 0x709B8040, -+ 0xC60, 0x70AB8040, -+ 0xC60, 0x70BB6040, -+ 0xC60, 0x70C06040, -+ 0xC60, 0x70D06040, -+ 0xC60, 0x70EF6040, -+ 0xC60, 0x70F06040, -+ 0xE60, 0x700B8040, -+ 0xE60, 0x700B8040, -+ 0xE60, 0x70146040, -+ 0xE60, 0x70246040, -+ 0xE60, 0x70346040, -+ 0xE60, 0x70446040, -+ 0xE60, 0x705B2040, -+ 0xE60, 0x70646040, -+ 0xE60, 0x707B8040, -+ 0xE60, 0x708B8040, -+ 0xE60, 0x709B8040, -+ 0xE60, 0x70AB8040, -+ 0xE60, 0x70BB6040, -+ 0xE60, 0x70C06040, -+ 0xE60, 0x70D06040, -+ 0xE60, 0x70EF6040, -+ 0xE60, 0x70F06040, -+ 0xC64, 0x00800000, -+ 0xC64, 0x08800001, -+ 0xC64, 0x00800002, -+ 0xC64, 0x00800003, -+ 0xC64, 0x00800004, -+ 0xC64, 0x00800005, -+ 0xC64, 0x00800006, -+ 0xC64, 0x08800007, -+ 0xC64, 0x00004000, -+ 0xE64, 0x00800000, -+ 0xE64, 0x08800001, -+ 0xE64, 0x00800002, -+ 0xE64, 0x00800003, -+ 0xE64, 0x00800004, -+ 0xE64, 0x00800005, -+ 0xE64, 0x00800006, -+ 0xE64, 0x08800007, -+ 0xE64, 0x00004000, -+ 0x1B00, 0xF8000008, -+ 0x1B00, 0xF80A7008, -+ 0x1B00, 0xF8015008, -+ 0x1B00, 0xF8000008, -+ 0x1B04, 0xE24629D2, -+ 0x1B08, 0x00000080, -+ 0x1B0C, 0x00000000, -+ 0x1B10, 0x00011C00, -+ 0x1B14, 0x00000000, -+ 0x1B18, 0x00292903, -+ 0x1B1C, 0xA2193C32, -+ 0x1B20, 0x01840008, -+ 0x1B24, 0x01860008, -+ 0x1B28, 0x80060300, -+ 0x1B2C, 0x00000003, -+ 0x1B30, 0x20000000, -+ 0x1B34, 0x00000800, -+ 0x1B3C, 0x20000000, -+ 0x1BC0, 0x01000000, -+ 0x1BCC, 0x00000000, -+ 0x1B90, 0x0001E018, -+ 0x1B94, 0xF76D9F84, -+ 0x1BC8, 0x000C44AA, -+ 0x1BCC, 0x11978200, -+ 0x1B8C, 0x00002000, -+ 0x1B9C, 0x5B554F48, -+ 0x1BA0, 0x6F6B6661, -+ 0x1BA4, 0x817D7874, -+ 0x1BA8, 0x908C8884, -+ 0x1BAC, 0x9D9A9793, -+ 0x1BB0, 0xAAA7A4A1, -+ 0x1BB4, 0xB6B3B0AD, -+ 0x1B40, 0x02CE03E8, -+ 0x1B44, 0x01FD024C, -+ 0x1B48, 0x01A101C9, -+ 0x1B4C, 0x016A0183, -+ 0x1B50, 0x01430153, -+ 0x1B54, 0x01280134, -+ 0x1B58, 0x0112011C, -+ 0x1B5C, 0x01000107, -+ 0x1B60, 0x00F200F9, -+ 0x1B64, 0x00E500EB, -+ 0x1B68, 0x00DA00E0, -+ 0x1B6C, 0x00D200D6, -+ 0x1B70, 0x00C900CD, -+ 0x1B74, 0x00C200C5, -+ 0x1B78, 0x00BB00BE, -+ 0x1B7C, 0x00B500B8, -+ 0x1BDC, 0x40CAFFE1, -+ 0x1BDC, 0x4080A1E3, -+ 0x1BDC, 0x405165E5, -+ 0x1BDC, 0x403340E7, -+ 0x1BDC, 0x402028E9, -+ 0x1BDC, 0x401419EB, -+ 0x1BDC, 0x400D10ED, -+ 0x1BDC, 0x40080AEF, -+ 0x1BDC, 0x400506F1, -+ 0x1BDC, 0x400304F3, -+ 0x1BDC, 0x400203F5, -+ 0x1BDC, 0x400102F7, -+ 0x1BDC, 0x400101F9, -+ 0x1BDC, 0x400101FB, -+ 0x1BDC, 0x400101FD, -+ 0x1BDC, 0x400101FF, -+ 0x1BDC, 0x40CAFF81, -+ 0x1BDC, 0x4080A183, -+ 0x1BDC, 0x40516585, -+ 0x1BDC, 0x40334087, -+ 0x1BDC, 0x40202889, -+ 0x1BDC, 0x4014198B, -+ 0x1BDC, 0x400D108D, -+ 0x1BDC, 0x40080A8F, -+ 0x1BDC, 0x40050691, -+ 0x1BDC, 0x40030493, -+ 0x1BDC, 0x40020395, -+ 0x1BDC, 0x40010297, -+ 0x1BDC, 0x40010199, -+ 0x1BDC, 0x4001019B, -+ 0x1BDC, 0x4001019D, -+ 0x1BDC, 0x4001019F, -+ 0x1BDC, 0x00000000, -+ 0x1BDC, 0xD0000001, -+ 0x1BDC, 0xD0000003, -+ 0x1BDC, 0xD0000005, -+ 0x1BDC, 0xD0000007, -+ 0x1BDC, 0xD0000009, -+ 0x1BDC, 0xD000000B, -+ 0x1BDC, 0xD000000D, -+ 0x1BDC, 0xD000000F, -+ 0x1BDC, 0xD0000011, -+ 0x1BDC, 0xD0000013, -+ 0x1BDC, 0xD0000015, -+ 0x1BDC, 0xD0000017, -+ 0x1BDC, 0xD0000019, -+ 0x1BDC, 0xD000001B, -+ 0x1BDC, 0xD000001D, -+ 0x1BDC, 0xD000001F, -+ 0x1BDC, 0xD0000021, -+ 0x1BDC, 0xD0000023, -+ 0x1BDC, 0xD0000025, -+ 0x1BDC, 0xD0000027, -+ 0x1BDC, 0xD0000029, -+ 0x1BDC, 0xD000002B, -+ 0x1BDC, 0xD000002D, -+ 0x1BDC, 0xD000002F, -+ 0x1BDC, 0xD0000031, -+ 0x1BDC, 0xD0000033, -+ 0x1BDC, 0xD0000035, -+ 0x1BDC, 0xD0000037, -+ 0x1BDC, 0xD0000039, -+ 0x1BDC, 0xD000003B, -+ 0x1BDC, 0xD000003D, -+ 0x1BDC, 0xD000003F, -+ 0x1BDC, 0xD0000041, -+ 0x1BDC, 0xD0000043, -+ 0x1BDC, 0xD0000045, -+ 0x1BDC, 0xD0000047, -+ 0x1BDC, 0xD0000049, -+ 0x1BDC, 0xD000004B, -+ 0x1BDC, 0xD000004D, -+ 0x1BDC, 0xD000004F, -+ 0x1BDC, 0xD0000051, -+ 0x1BDC, 0xD0000053, -+ 0x1BDC, 0xD0000055, -+ 0x1BDC, 0xD0000057, -+ 0x1BDC, 0xD0000059, -+ 0x1BDC, 0xD000005B, -+ 0x1BDC, 0xD000005D, -+ 0x1BDC, 0xD000005F, -+ 0x1BDC, 0xD0000061, -+ 0x1BDC, 0xD0000063, -+ 0x1BDC, 0xD0000065, -+ 0x1BDC, 0xD0000067, -+ 0x1BDC, 0xD0000069, -+ 0x1BDC, 0xD000006B, -+ 0x1BDC, 0xD000006D, -+ 0x1BDC, 0xD000006F, -+ 0x1BDC, 0xD0000071, -+ 0x1BDC, 0xD0000073, -+ 0x1BDC, 0xD0000075, -+ 0x1BDC, 0xD0000077, -+ 0x1BDC, 0xD0000079, -+ 0x1BDC, 0xD000007B, -+ 0x1BDC, 0xD000007D, -+ 0x1BDC, 0xD000007F, -+ 0x1BDC, 0x90000081, -+ 0x1BDC, 0x90000083, -+ 0x1BDC, 0x90000085, -+ 0x1BDC, 0x90000087, -+ 0x1BDC, 0x90000089, -+ 0x1BDC, 0x9000008B, -+ 0x1BDC, 0x9000008D, -+ 0x1BDC, 0x9000008F, -+ 0x1BDC, 0x90000091, -+ 0x1BDC, 0x90000093, -+ 0x1BDC, 0x90000095, -+ 0x1BDC, 0x90000097, -+ 0x1BDC, 0x90000099, -+ 0x1BDC, 0x9000009B, -+ 0x1BDC, 0x9000009D, -+ 0x1BDC, 0x9000009F, -+ 0x1BDC, 0x900000A1, -+ 0x1BDC, 0x900000A3, -+ 0x1BDC, 0x900000A5, -+ 0x1BDC, 0x900000A7, -+ 0x1BDC, 0x900000A9, -+ 0x1BDC, 0x900000AB, -+ 0x1BDC, 0x900000AD, -+ 0x1BDC, 0x900000AF, -+ 0x1BDC, 0x900000B1, -+ 0x1BDC, 0x900000B3, -+ 0x1BDC, 0x900000B5, -+ 0x1BDC, 0x900000B7, -+ 0x1BDC, 0x900000B9, -+ 0x1BDC, 0x900000BB, -+ 0x1BDC, 0x900000BD, -+ 0x1BDC, 0x900000BF, -+ 0x1BDC, 0x900000C1, -+ 0x1BDC, 0x900000C3, -+ 0x1BDC, 0x900000C5, -+ 0x1BDC, 0x900000C7, -+ 0x1BDC, 0x900000C9, -+ 0x1BDC, 0x900000CB, -+ 0x1BDC, 0x900000CD, -+ 0x1BDC, 0x900000CF, -+ 0x1BDC, 0x900000D1, -+ 0x1BDC, 0x900000D3, -+ 0x1BDC, 0x900000D5, -+ 0x1BDC, 0x900000D7, -+ 0x1BDC, 0x900000D9, -+ 0x1BDC, 0x900000DB, -+ 0x1BDC, 0x900000DD, -+ 0x1BDC, 0x900000DF, -+ 0x1BDC, 0x900000E1, -+ 0x1BDC, 0x900000E3, -+ 0x1BDC, 0x900000E5, -+ 0x1BDC, 0x900000E7, -+ 0x1BDC, 0x900000E9, -+ 0x1BDC, 0x900000EB, -+ 0x1BDC, 0x900000ED, -+ 0x1BDC, 0x900000EF, -+ 0x1BDC, 0x900000F1, -+ 0x1BDC, 0x900000F3, -+ 0x1BDC, 0x900000F5, -+ 0x1BDC, 0x900000F7, -+ 0x1BDC, 0x900000F9, -+ 0x1BDC, 0x900000FB, -+ 0x1BDC, 0x900000FD, -+ 0x1BDC, 0x900000FF, -+ 0x1BDC, 0x00000000, -+ 0x1B00, 0xF8000000, -+ 0x1B80, 0x00000007, -+ 0x1B80, 0x090A0005, -+ 0x1B80, 0x090A0007, -+ 0x1B80, 0x0FFE0015, -+ 0x1B80, 0x0FFE0017, -+ 0x1B80, 0x00220025, -+ 0x1B80, 0x00220027, -+ 0x1B80, 0x00040035, -+ 0x1B80, 0x00040037, -+ 0x1B80, 0x05C00045, -+ 0x1B80, 0x05C00047, -+ 0x1B80, 0x00070055, -+ 0x1B80, 0x00070057, -+ 0x1B80, 0x64000065, -+ 0x1B80, 0x64000067, -+ 0x1B80, 0x00020075, -+ 0x1B80, 0x00020077, -+ 0x1B80, 0x00080085, -+ 0x1B80, 0x00080087, -+ 0x1B80, 0x80000095, -+ 0x1B80, 0x80000097, -+ 0x1B80, 0x090800A5, -+ 0x1B80, 0x090800A7, -+ 0x1B80, 0x0F0200B5, -+ 0x1B80, 0x0F0200B7, -+ 0x1B80, 0x002200C5, -+ 0x1B80, 0x002200C7, -+ 0x1B80, 0x000400D5, -+ 0x1B80, 0x000400D7, -+ 0x1B80, 0x05C000E5, -+ 0x1B80, 0x05C000E7, -+ 0x1B80, 0x000700F5, -+ 0x1B80, 0x000700F7, -+ 0x1B80, 0x64020105, -+ 0x1B80, 0x64020107, -+ 0x1B80, 0x00020115, -+ 0x1B80, 0x00020117, -+ 0x1B80, 0x00040125, -+ 0x1B80, 0x00040127, -+ 0x1B80, 0x4A000135, -+ 0x1B80, 0x4A000137, -+ 0x1B80, 0x4B040145, -+ 0x1B80, 0x4B040147, -+ 0x1B80, 0x85030155, -+ 0x1B80, 0x85030157, -+ 0x1B80, 0x40090165, -+ 0x1B80, 0x40090167, -+ 0x1B80, 0xE02A0175, -+ 0x1B80, 0xE02A0177, -+ 0x1B80, 0x4B050185, -+ 0x1B80, 0x4B050187, -+ 0x1B80, 0x86030195, -+ 0x1B80, 0x86030197, -+ 0x1B80, 0x400B01A5, -+ 0x1B80, 0x400B01A7, -+ 0x1B80, 0xE02A01B5, -+ 0x1B80, 0xE02A01B7, -+ 0x1B80, 0x4B0001C5, -+ 0x1B80, 0x4B0001C7, -+ 0x1B80, 0x000701D5, -+ 0x1B80, 0x000701D7, -+ 0x1B80, 0x4C0001E5, -+ 0x1B80, 0x4C0001E7, -+ 0x1B80, 0x000401F5, -+ 0x1B80, 0x000401F7, -+ 0x1B80, 0x4D040205, -+ 0x1B80, 0x4D040207, -+ 0x1B80, 0x2EE00215, -+ 0x1B80, 0x2EE00217, -+ 0x1B80, 0x00000225, -+ 0x1B80, 0x00000227, -+ 0x1B80, 0x2EF00235, -+ 0x1B80, 0x2EF00237, -+ 0x1B80, 0x00000245, -+ 0x1B80, 0x00000247, -+ 0x1B80, 0x20810255, -+ 0x1B80, 0x20810257, -+ 0x1B80, 0x23450265, -+ 0x1B80, 0x23450267, -+ 0x1B80, 0x4D000275, -+ 0x1B80, 0x4D000277, -+ 0x1B80, 0x00040285, -+ 0x1B80, 0x00040287, -+ 0x1B80, 0x30000295, -+ 0x1B80, 0x30000297, -+ 0x1B80, 0xE1D602A5, -+ 0x1B80, 0xE1D602A7, -+ 0x1B80, 0xF01102B5, -+ 0x1B80, 0xF01102B7, -+ 0x1B80, 0xF11102C5, -+ 0x1B80, 0xF11102C7, -+ 0x1B80, 0xF21102D5, -+ 0x1B80, 0xF21102D7, -+ 0x1B80, 0xF31102E5, -+ 0x1B80, 0xF31102E7, -+ 0x1B80, 0xF41102F5, -+ 0x1B80, 0xF41102F7, -+ 0x1B80, 0xF5110305, -+ 0x1B80, 0xF5110307, -+ 0x1B80, 0xF6110315, -+ 0x1B80, 0xF6110317, -+ 0x1B80, 0xF7110325, -+ 0x1B80, 0xF7110327, -+ 0x1B80, 0xF8110335, -+ 0x1B80, 0xF8110337, -+ 0x1B80, 0xF9110345, -+ 0x1B80, 0xF9110347, -+ 0x1B80, 0xFA110355, -+ 0x1B80, 0xFA110357, -+ 0x1B80, 0xFB110365, -+ 0x1B80, 0xFB110367, -+ 0x1B80, 0xFC110375, -+ 0x1B80, 0xFC110377, -+ 0x1B80, 0xFD110385, -+ 0x1B80, 0xFD110387, -+ 0x1B80, 0xFE110395, -+ 0x1B80, 0xFE110397, -+ 0x1B80, 0xFF1103A5, -+ 0x1B80, 0xFF1103A7, -+ 0x1B80, 0x000103B5, -+ 0x1B80, 0x000103B7, -+ 0x1B80, 0x305503C5, -+ 0x1B80, 0x305503C7, -+ 0x1B80, 0x306D03D5, -+ 0x1B80, 0x306D03D7, -+ 0x1B80, 0x30B803E5, -+ 0x1B80, 0x30B803E7, -+ 0x1B80, 0x30BB03F5, -+ 0x1B80, 0x30BB03F7, -+ 0x1B80, 0x306F0405, -+ 0x1B80, 0x306F0407, -+ 0x1B80, 0x307A0415, -+ 0x1B80, 0x307A0417, -+ 0x1B80, 0x30850425, -+ 0x1B80, 0x30850427, -+ 0x1B80, 0x30C50435, -+ 0x1B80, 0x30C50437, -+ 0x1B80, 0x30BF0445, -+ 0x1B80, 0x30BF0447, -+ 0x1B80, 0x30D30455, -+ 0x1B80, 0x30D30457, -+ 0x1B80, 0x30DE0465, -+ 0x1B80, 0x30DE0467, -+ 0x1B80, 0x30E90475, -+ 0x1B80, 0x30E90477, -+ 0x1B80, 0x304C0485, -+ 0x1B80, 0x304C0487, -+ 0x1B80, 0x31180495, -+ 0x1B80, 0x31180497, -+ 0x1B80, 0x312904A5, -+ 0x1B80, 0x312904A7, -+ 0x1B80, 0x313E04B5, -+ 0x1B80, 0x313E04B7, -+ 0x1B80, 0x4D0404C5, -+ 0x1B80, 0x4D0404C7, -+ 0x1B80, 0x2EE004D5, -+ 0x1B80, 0x2EE004D7, -+ 0x1B80, 0x000004E5, -+ 0x1B80, 0x000004E7, -+ 0x1B80, 0x2EF004F5, -+ 0x1B80, 0x2EF004F7, -+ 0x1B80, 0x00000505, -+ 0x1B80, 0x00000507, -+ 0x1B80, 0x20810515, -+ 0x1B80, 0x20810517, -+ 0x1B80, 0xA3B50525, -+ 0x1B80, 0xA3B50527, -+ 0x1B80, 0x4D000535, -+ 0x1B80, 0x4D000537, -+ 0x1B80, 0x30000545, -+ 0x1B80, 0x30000547, -+ 0x1B80, 0xE1690555, -+ 0x1B80, 0xE1690557, -+ 0x1B80, 0x4D040565, -+ 0x1B80, 0x4D040567, -+ 0x1B80, 0x20800575, -+ 0x1B80, 0x20800577, -+ 0x1B80, 0x00000585, -+ 0x1B80, 0x00000587, -+ 0x1B80, 0x4D000595, -+ 0x1B80, 0x4D000597, -+ 0x1B80, 0x550705A5, -+ 0x1B80, 0x550705A7, -+ 0x1B80, 0xE16105B5, -+ 0x1B80, 0xE16105B7, -+ 0x1B80, 0xE16105C5, -+ 0x1B80, 0xE16105C7, -+ 0x1B80, 0x4D0405D5, -+ 0x1B80, 0x4D0405D7, -+ 0x1B80, 0x208805E5, -+ 0x1B80, 0x208805E7, -+ 0x1B80, 0x020005F5, -+ 0x1B80, 0x020005F7, -+ 0x1B80, 0x4D000605, -+ 0x1B80, 0x4D000607, -+ 0x1B80, 0x550F0615, -+ 0x1B80, 0x550F0617, -+ 0x1B80, 0xE1610625, -+ 0x1B80, 0xE1610627, -+ 0x1B80, 0x4F020635, -+ 0x1B80, 0x4F020637, -+ 0x1B80, 0x4E000645, -+ 0x1B80, 0x4E000647, -+ 0x1B80, 0x53020655, -+ 0x1B80, 0x53020657, -+ 0x1B80, 0x52010665, -+ 0x1B80, 0x52010667, -+ 0x1B80, 0xE1650675, -+ 0x1B80, 0xE1650677, -+ 0x1B80, 0x4D080685, -+ 0x1B80, 0x4D080687, -+ 0x1B80, 0x57100695, -+ 0x1B80, 0x57100697, -+ 0x1B80, 0x570006A5, -+ 0x1B80, 0x570006A7, -+ 0x1B80, 0x4D0006B5, -+ 0x1B80, 0x4D0006B7, -+ 0x1B80, 0x000106C5, -+ 0x1B80, 0x000106C7, -+ 0x1B80, 0xE16906D5, -+ 0x1B80, 0xE16906D7, -+ 0x1B80, 0x000106E5, -+ 0x1B80, 0x000106E7, -+ 0x1B80, 0x308F06F5, -+ 0x1B80, 0x308F06F7, -+ 0x1B80, 0x00230705, -+ 0x1B80, 0x00230707, -+ 0x1B80, 0xE1C90715, -+ 0x1B80, 0xE1C90717, -+ 0x1B80, 0x00020725, -+ 0x1B80, 0x00020727, -+ 0x1B80, 0x54E90735, -+ 0x1B80, 0x54E90737, -+ 0x1B80, 0x0BA60745, -+ 0x1B80, 0x0BA60747, -+ 0x1B80, 0x00230755, -+ 0x1B80, 0x00230757, -+ 0x1B80, 0xE1C90765, -+ 0x1B80, 0xE1C90767, -+ 0x1B80, 0x00020775, -+ 0x1B80, 0x00020777, -+ 0x1B80, 0x4D300785, -+ 0x1B80, 0x4D300787, -+ 0x1B80, 0x30A80795, -+ 0x1B80, 0x30A80797, -+ 0x1B80, 0x308B07A5, -+ 0x1B80, 0x308B07A7, -+ 0x1B80, 0x002207B5, -+ 0x1B80, 0x002207B7, -+ 0x1B80, 0xE1C907C5, -+ 0x1B80, 0xE1C907C7, -+ 0x1B80, 0x000207D5, -+ 0x1B80, 0x000207D7, -+ 0x1B80, 0x54E807E5, -+ 0x1B80, 0x54E807E7, -+ 0x1B80, 0x0BA607F5, -+ 0x1B80, 0x0BA607F7, -+ 0x1B80, 0x00220805, -+ 0x1B80, 0x00220807, -+ 0x1B80, 0xE1C90815, -+ 0x1B80, 0xE1C90817, -+ 0x1B80, 0x00020825, -+ 0x1B80, 0x00020827, -+ 0x1B80, 0x4D300835, -+ 0x1B80, 0x4D300837, -+ 0x1B80, 0x30A80845, -+ 0x1B80, 0x30A80847, -+ 0x1B80, 0x63F10855, -+ 0x1B80, 0x63F10857, -+ 0x1B80, 0xE1690865, -+ 0x1B80, 0xE1690867, -+ 0x1B80, 0xE1C90875, -+ 0x1B80, 0xE1C90877, -+ 0x1B80, 0x63F40885, -+ 0x1B80, 0x63F40887, -+ 0x1B80, 0xE1690895, -+ 0x1B80, 0xE1690897, -+ 0x1B80, 0xE1C908A5, -+ 0x1B80, 0xE1C908A7, -+ 0x1B80, 0x0BA808B5, -+ 0x1B80, 0x0BA808B7, -+ 0x1B80, 0x63F808C5, -+ 0x1B80, 0x63F808C7, -+ 0x1B80, 0xE16908D5, -+ 0x1B80, 0xE16908D7, -+ 0x1B80, 0xE1C908E5, -+ 0x1B80, 0xE1C908E7, -+ 0x1B80, 0x0BA908F5, -+ 0x1B80, 0x0BA908F7, -+ 0x1B80, 0x63FC0905, -+ 0x1B80, 0x63FC0907, -+ 0x1B80, 0xE1690915, -+ 0x1B80, 0xE1690917, -+ 0x1B80, 0xE1C90925, -+ 0x1B80, 0xE1C90927, -+ 0x1B80, 0x63FF0935, -+ 0x1B80, 0x63FF0937, -+ 0x1B80, 0xE1690945, -+ 0x1B80, 0xE1690947, -+ 0x1B80, 0xE1C90955, -+ 0x1B80, 0xE1C90957, -+ 0x1B80, 0x63000965, -+ 0x1B80, 0x63000967, -+ 0x1B80, 0xE1690975, -+ 0x1B80, 0xE1690977, -+ 0x1B80, 0xE1C90985, -+ 0x1B80, 0xE1C90987, -+ 0x1B80, 0x63030995, -+ 0x1B80, 0x63030997, -+ 0x1B80, 0xE16909A5, -+ 0x1B80, 0xE16909A7, -+ 0x1B80, 0xE1C909B5, -+ 0x1B80, 0xE1C909B7, -+ 0x1B80, 0xF4D409C5, -+ 0x1B80, 0xF4D409C7, -+ 0x1B80, 0x630709D5, -+ 0x1B80, 0x630709D7, -+ 0x1B80, 0xE16909E5, -+ 0x1B80, 0xE16909E7, -+ 0x1B80, 0xE1C909F5, -+ 0x1B80, 0xE1C909F7, -+ 0x1B80, 0xF5DB0A05, -+ 0x1B80, 0xF5DB0A07, -+ 0x1B80, 0x630B0A15, -+ 0x1B80, 0x630B0A17, -+ 0x1B80, 0xE1690A25, -+ 0x1B80, 0xE1690A27, -+ 0x1B80, 0xE1C90A35, -+ 0x1B80, 0xE1C90A37, -+ 0x1B80, 0x630E0A45, -+ 0x1B80, 0x630E0A47, -+ 0x1B80, 0xE1690A55, -+ 0x1B80, 0xE1690A57, -+ 0x1B80, 0xE1C90A65, -+ 0x1B80, 0xE1C90A67, -+ 0x1B80, 0x4D300A75, -+ 0x1B80, 0x4D300A77, -+ 0x1B80, 0x55010A85, -+ 0x1B80, 0x55010A87, -+ 0x1B80, 0x57040A95, -+ 0x1B80, 0x57040A97, -+ 0x1B80, 0x57000AA5, -+ 0x1B80, 0x57000AA7, -+ 0x1B80, 0x96000AB5, -+ 0x1B80, 0x96000AB7, -+ 0x1B80, 0x57080AC5, -+ 0x1B80, 0x57080AC7, -+ 0x1B80, 0x57000AD5, -+ 0x1B80, 0x57000AD7, -+ 0x1B80, 0x95000AE5, -+ 0x1B80, 0x95000AE7, -+ 0x1B80, 0x4D000AF5, -+ 0x1B80, 0x4D000AF7, -+ 0x1B80, 0x6C070B05, -+ 0x1B80, 0x6C070B07, -+ 0x1B80, 0x7B200B15, -+ 0x1B80, 0x7B200B17, -+ 0x1B80, 0x7A000B25, -+ 0x1B80, 0x7A000B27, -+ 0x1B80, 0x79000B35, -+ 0x1B80, 0x79000B37, -+ 0x1B80, 0x7F200B45, -+ 0x1B80, 0x7F200B47, -+ 0x1B80, 0x7E000B55, -+ 0x1B80, 0x7E000B57, -+ 0x1B80, 0x7D000B65, -+ 0x1B80, 0x7D000B67, -+ 0x1B80, 0x00010B75, -+ 0x1B80, 0x00010B77, -+ 0x1B80, 0x62850B85, -+ 0x1B80, 0x62850B87, -+ 0x1B80, 0xE1690B95, -+ 0x1B80, 0xE1690B97, -+ 0x1B80, 0x00010BA5, -+ 0x1B80, 0x00010BA7, -+ 0x1B80, 0x5C320BB5, -+ 0x1B80, 0x5C320BB7, -+ 0x1B80, 0xE1C50BC5, -+ 0x1B80, 0xE1C50BC7, -+ 0x1B80, 0xE1950BD5, -+ 0x1B80, 0xE1950BD7, -+ 0x1B80, 0x00010BE5, -+ 0x1B80, 0x00010BE7, -+ 0x1B80, 0x5C320BF5, -+ 0x1B80, 0x5C320BF7, -+ 0x1B80, 0x63F40C05, -+ 0x1B80, 0x63F40C07, -+ 0x1B80, 0x62850C15, -+ 0x1B80, 0x62850C17, -+ 0x1B80, 0x0BB00C25, -+ 0x1B80, 0x0BB00C27, -+ 0x1B80, 0xE1690C35, -+ 0x1B80, 0xE1690C37, -+ 0x1B80, 0xE1C90C45, -+ 0x1B80, 0xE1C90C47, -+ 0x1B80, 0x5C320C55, -+ 0x1B80, 0x5C320C57, -+ 0x1B80, 0x63FC0C65, -+ 0x1B80, 0x63FC0C67, -+ 0x1B80, 0x62850C75, -+ 0x1B80, 0x62850C77, -+ 0x1B80, 0x0BB10C85, -+ 0x1B80, 0x0BB10C87, -+ 0x1B80, 0xE1690C95, -+ 0x1B80, 0xE1690C97, -+ 0x1B80, 0xE1C90CA5, -+ 0x1B80, 0xE1C90CA7, -+ 0x1B80, 0x63030CB5, -+ 0x1B80, 0x63030CB7, -+ 0x1B80, 0xE1690CC5, -+ 0x1B80, 0xE1690CC7, -+ 0x1B80, 0xE1C90CD5, -+ 0x1B80, 0xE1C90CD7, -+ 0x1B80, 0xF7040CE5, -+ 0x1B80, 0xF7040CE7, -+ 0x1B80, 0x630B0CF5, -+ 0x1B80, 0x630B0CF7, -+ 0x1B80, 0xE1690D05, -+ 0x1B80, 0xE1690D07, -+ 0x1B80, 0xE1C90D15, -+ 0x1B80, 0xE1C90D17, -+ 0x1B80, 0x00010D25, -+ 0x1B80, 0x00010D27, -+ 0x1B80, 0x30F70D35, -+ 0x1B80, 0x30F70D37, -+ 0x1B80, 0x00230D45, -+ 0x1B80, 0x00230D47, -+ 0x1B80, 0xE1CE0D55, -+ 0x1B80, 0xE1CE0D57, -+ 0x1B80, 0x00020D65, -+ 0x1B80, 0x00020D67, -+ 0x1B80, 0x54E90D75, -+ 0x1B80, 0x54E90D77, -+ 0x1B80, 0x0BA60D85, -+ 0x1B80, 0x0BA60D87, -+ 0x1B80, 0x00230D95, -+ 0x1B80, 0x00230D97, -+ 0x1B80, 0xE1CE0DA5, -+ 0x1B80, 0xE1CE0DA7, -+ 0x1B80, 0x00020DB5, -+ 0x1B80, 0x00020DB7, -+ 0x1B80, 0x4D100DC5, -+ 0x1B80, 0x4D100DC7, -+ 0x1B80, 0x30A80DD5, -+ 0x1B80, 0x30A80DD7, -+ 0x1B80, 0x30F10DE5, -+ 0x1B80, 0x30F10DE7, -+ 0x1B80, 0x00220DF5, -+ 0x1B80, 0x00220DF7, -+ 0x1B80, 0xE1CE0E05, -+ 0x1B80, 0xE1CE0E07, -+ 0x1B80, 0x00020E15, -+ 0x1B80, 0x00020E17, -+ 0x1B80, 0x54E80E25, -+ 0x1B80, 0x54E80E27, -+ 0x1B80, 0x0BA60E35, -+ 0x1B80, 0x0BA60E37, -+ 0x1B80, 0x00220E45, -+ 0x1B80, 0x00220E47, -+ 0x1B80, 0xE1CE0E55, -+ 0x1B80, 0xE1CE0E57, -+ 0x1B80, 0x00020E65, -+ 0x1B80, 0x00020E67, -+ 0x1B80, 0x4D100E75, -+ 0x1B80, 0x4D100E77, -+ 0x1B80, 0x30A80E85, -+ 0x1B80, 0x30A80E87, -+ 0x1B80, 0x5C320E95, -+ 0x1B80, 0x5C320E97, -+ 0x1B80, 0x54F00EA5, -+ 0x1B80, 0x54F00EA7, -+ 0x1B80, 0x67F10EB5, -+ 0x1B80, 0x67F10EB7, -+ 0x1B80, 0xE1950EC5, -+ 0x1B80, 0xE1950EC7, -+ 0x1B80, 0xE1CE0ED5, -+ 0x1B80, 0xE1CE0ED7, -+ 0x1B80, 0x67F40EE5, -+ 0x1B80, 0x67F40EE7, -+ 0x1B80, 0xE1950EF5, -+ 0x1B80, 0xE1950EF7, -+ 0x1B80, 0xE1CE0F05, -+ 0x1B80, 0xE1CE0F07, -+ 0x1B80, 0x5C320F15, -+ 0x1B80, 0x5C320F17, -+ 0x1B80, 0x54F10F25, -+ 0x1B80, 0x54F10F27, -+ 0x1B80, 0x0BA80F35, -+ 0x1B80, 0x0BA80F37, -+ 0x1B80, 0x67F80F45, -+ 0x1B80, 0x67F80F47, -+ 0x1B80, 0xE1950F55, -+ 0x1B80, 0xE1950F57, -+ 0x1B80, 0xE1CE0F65, -+ 0x1B80, 0xE1CE0F67, -+ 0x1B80, 0x5C320F75, -+ 0x1B80, 0x5C320F77, -+ 0x1B80, 0x54F10F85, -+ 0x1B80, 0x54F10F87, -+ 0x1B80, 0x0BA90F95, -+ 0x1B80, 0x0BA90F97, -+ 0x1B80, 0x67FC0FA5, -+ 0x1B80, 0x67FC0FA7, -+ 0x1B80, 0xE1950FB5, -+ 0x1B80, 0xE1950FB7, -+ 0x1B80, 0xE1CE0FC5, -+ 0x1B80, 0xE1CE0FC7, -+ 0x1B80, 0x67FF0FD5, -+ 0x1B80, 0x67FF0FD7, -+ 0x1B80, 0xE1950FE5, -+ 0x1B80, 0xE1950FE7, -+ 0x1B80, 0xE1CE0FF5, -+ 0x1B80, 0xE1CE0FF7, -+ 0x1B80, 0x5C321005, -+ 0x1B80, 0x5C321007, -+ 0x1B80, 0x54F21015, -+ 0x1B80, 0x54F21017, -+ 0x1B80, 0x67001025, -+ 0x1B80, 0x67001027, -+ 0x1B80, 0xE1951035, -+ 0x1B80, 0xE1951037, -+ 0x1B80, 0xE1CE1045, -+ 0x1B80, 0xE1CE1047, -+ 0x1B80, 0x67031055, -+ 0x1B80, 0x67031057, -+ 0x1B80, 0xE1951065, -+ 0x1B80, 0xE1951067, -+ 0x1B80, 0xE1CE1075, -+ 0x1B80, 0xE1CE1077, -+ 0x1B80, 0xF9CC1085, -+ 0x1B80, 0xF9CC1087, -+ 0x1B80, 0x67071095, -+ 0x1B80, 0x67071097, -+ 0x1B80, 0xE19510A5, -+ 0x1B80, 0xE19510A7, -+ 0x1B80, 0xE1CE10B5, -+ 0x1B80, 0xE1CE10B7, -+ 0x1B80, 0xFAD310C5, -+ 0x1B80, 0xFAD310C7, -+ 0x1B80, 0x5C3210D5, -+ 0x1B80, 0x5C3210D7, -+ 0x1B80, 0x54F310E5, -+ 0x1B80, 0x54F310E7, -+ 0x1B80, 0x670B10F5, -+ 0x1B80, 0x670B10F7, -+ 0x1B80, 0xE1951105, -+ 0x1B80, 0xE1951107, -+ 0x1B80, 0xE1CE1115, -+ 0x1B80, 0xE1CE1117, -+ 0x1B80, 0x670E1125, -+ 0x1B80, 0x670E1127, -+ 0x1B80, 0xE1951135, -+ 0x1B80, 0xE1951137, -+ 0x1B80, 0xE1CE1145, -+ 0x1B80, 0xE1CE1147, -+ 0x1B80, 0x4D101155, -+ 0x1B80, 0x4D101157, -+ 0x1B80, 0x30A81165, -+ 0x1B80, 0x30A81167, -+ 0x1B80, 0x00011175, -+ 0x1B80, 0x00011177, -+ 0x1B80, 0x6C001185, -+ 0x1B80, 0x6C001187, -+ 0x1B80, 0x00061195, -+ 0x1B80, 0x00061197, -+ 0x1B80, 0x530011A5, -+ 0x1B80, 0x530011A7, -+ 0x1B80, 0x57F711B5, -+ 0x1B80, 0x57F711B7, -+ 0x1B80, 0x582111C5, -+ 0x1B80, 0x582111C7, -+ 0x1B80, 0x592E11D5, -+ 0x1B80, 0x592E11D7, -+ 0x1B80, 0x5A3811E5, -+ 0x1B80, 0x5A3811E7, -+ 0x1B80, 0x5B4111F5, -+ 0x1B80, 0x5B4111F7, -+ 0x1B80, 0x00071205, -+ 0x1B80, 0x00071207, -+ 0x1B80, 0x5C001215, -+ 0x1B80, 0x5C001217, -+ 0x1B80, 0x4B001225, -+ 0x1B80, 0x4B001227, -+ 0x1B80, 0x4E8F1235, -+ 0x1B80, 0x4E8F1237, -+ 0x1B80, 0x4F151245, -+ 0x1B80, 0x4F151247, -+ 0x1B80, 0x00041255, -+ 0x1B80, 0x00041257, -+ 0x1B80, 0xE1B31265, -+ 0x1B80, 0xE1B31267, -+ 0x1B80, 0xAB001275, -+ 0x1B80, 0xAB001277, -+ 0x1B80, 0x00011285, -+ 0x1B80, 0x00011287, -+ 0x1B80, 0x6C001295, -+ 0x1B80, 0x6C001297, -+ 0x1B80, 0x000612A5, -+ 0x1B80, 0x000612A7, -+ 0x1B80, 0x530012B5, -+ 0x1B80, 0x530012B7, -+ 0x1B80, 0x57F712C5, -+ 0x1B80, 0x57F712C7, -+ 0x1B80, 0x582112D5, -+ 0x1B80, 0x582112D7, -+ 0x1B80, 0x592E12E5, -+ 0x1B80, 0x592E12E7, -+ 0x1B80, 0x5A3812F5, -+ 0x1B80, 0x5A3812F7, -+ 0x1B80, 0x5B411305, -+ 0x1B80, 0x5B411307, -+ 0x1B80, 0x00071315, -+ 0x1B80, 0x00071317, -+ 0x1B80, 0x5C001325, -+ 0x1B80, 0x5C001327, -+ 0x1B80, 0x4B401335, -+ 0x1B80, 0x4B401337, -+ 0x1B80, 0x4E971345, -+ 0x1B80, 0x4E971347, -+ 0x1B80, 0x4F111355, -+ 0x1B80, 0x4F111357, -+ 0x1B80, 0x00041365, -+ 0x1B80, 0x00041367, -+ 0x1B80, 0xE1B31375, -+ 0x1B80, 0xE1B31377, -+ 0x1B80, 0xAB001385, -+ 0x1B80, 0xAB001387, -+ 0x1B80, 0x8B001395, -+ 0x1B80, 0x8B001397, -+ 0x1B80, 0xAB0013A5, -+ 0x1B80, 0xAB0013A7, -+ 0x1B80, 0x8A1913B5, -+ 0x1B80, 0x8A1913B7, -+ 0x1B80, 0x301D13C5, -+ 0x1B80, 0x301D13C7, -+ 0x1B80, 0x000113D5, -+ 0x1B80, 0x000113D7, -+ 0x1B80, 0x6C0113E5, -+ 0x1B80, 0x6C0113E7, -+ 0x1B80, 0x000613F5, -+ 0x1B80, 0x000613F7, -+ 0x1B80, 0x53011405, -+ 0x1B80, 0x53011407, -+ 0x1B80, 0x57F71415, -+ 0x1B80, 0x57F71417, -+ 0x1B80, 0x58211425, -+ 0x1B80, 0x58211427, -+ 0x1B80, 0x592E1435, -+ 0x1B80, 0x592E1437, -+ 0x1B80, 0x5A381445, -+ 0x1B80, 0x5A381447, -+ 0x1B80, 0x5B411455, -+ 0x1B80, 0x5B411457, -+ 0x1B80, 0x00071465, -+ 0x1B80, 0x00071467, -+ 0x1B80, 0x5C001475, -+ 0x1B80, 0x5C001477, -+ 0x1B80, 0x4B001485, -+ 0x1B80, 0x4B001487, -+ 0x1B80, 0x4E871495, -+ 0x1B80, 0x4E871497, -+ 0x1B80, 0x4F1114A5, -+ 0x1B80, 0x4F1114A7, -+ 0x1B80, 0x000414B5, -+ 0x1B80, 0x000414B7, -+ 0x1B80, 0xE1B314C5, -+ 0x1B80, 0xE1B314C7, -+ 0x1B80, 0xAB0014D5, -+ 0x1B80, 0xAB0014D7, -+ 0x1B80, 0x000614E5, -+ 0x1B80, 0x000614E7, -+ 0x1B80, 0x577714F5, -+ 0x1B80, 0x577714F7, -+ 0x1B80, 0x00071505, -+ 0x1B80, 0x00071507, -+ 0x1B80, 0x4E861515, -+ 0x1B80, 0x4E861517, -+ 0x1B80, 0x00041525, -+ 0x1B80, 0x00041527, -+ 0x1B80, 0x00011535, -+ 0x1B80, 0x00011537, -+ 0x1B80, 0x00011545, -+ 0x1B80, 0x00011547, -+ 0x1B80, 0x7B241555, -+ 0x1B80, 0x7B241557, -+ 0x1B80, 0x7A401565, -+ 0x1B80, 0x7A401567, -+ 0x1B80, 0x79001575, -+ 0x1B80, 0x79001577, -+ 0x1B80, 0x55031585, -+ 0x1B80, 0x55031587, -+ 0x1B80, 0x31611595, -+ 0x1B80, 0x31611597, -+ 0x1B80, 0x7B1C15A5, -+ 0x1B80, 0x7B1C15A7, -+ 0x1B80, 0x7A4015B5, -+ 0x1B80, 0x7A4015B7, -+ 0x1B80, 0x550B15C5, -+ 0x1B80, 0x550B15C7, -+ 0x1B80, 0x316115D5, -+ 0x1B80, 0x316115D7, -+ 0x1B80, 0x7B2015E5, -+ 0x1B80, 0x7B2015E7, -+ 0x1B80, 0x7A0015F5, -+ 0x1B80, 0x7A0015F7, -+ 0x1B80, 0x55131605, -+ 0x1B80, 0x55131607, -+ 0x1B80, 0x74011615, -+ 0x1B80, 0x74011617, -+ 0x1B80, 0x74001625, -+ 0x1B80, 0x74001627, -+ 0x1B80, 0x8E001635, -+ 0x1B80, 0x8E001637, -+ 0x1B80, 0x00011645, -+ 0x1B80, 0x00011647, -+ 0x1B80, 0x57021655, -+ 0x1B80, 0x57021657, -+ 0x1B80, 0x57001665, -+ 0x1B80, 0x57001667, -+ 0x1B80, 0x97001675, -+ 0x1B80, 0x97001677, -+ 0x1B80, 0x00011685, -+ 0x1B80, 0x00011687, -+ 0x1B80, 0x4F781695, -+ 0x1B80, 0x4F781697, -+ 0x1B80, 0x538816A5, -+ 0x1B80, 0x538816A7, -+ 0x1B80, 0xE17516B5, -+ 0x1B80, 0xE17516B7, -+ 0x1B80, 0x548016C5, -+ 0x1B80, 0x548016C7, -+ 0x1B80, 0x540016D5, -+ 0x1B80, 0x540016D7, -+ 0x1B80, 0x548116E5, -+ 0x1B80, 0x548116E7, -+ 0x1B80, 0x540016F5, -+ 0x1B80, 0x540016F7, -+ 0x1B80, 0x54821705, -+ 0x1B80, 0x54821707, -+ 0x1B80, 0x54001715, -+ 0x1B80, 0x54001717, -+ 0x1B80, 0xE1801725, -+ 0x1B80, 0xE1801727, -+ 0x1B80, 0xBF1D1735, -+ 0x1B80, 0xBF1D1737, -+ 0x1B80, 0x301D1745, -+ 0x1B80, 0x301D1747, -+ 0x1B80, 0xE1551755, -+ 0x1B80, 0xE1551757, -+ 0x1B80, 0xE15A1765, -+ 0x1B80, 0xE15A1767, -+ 0x1B80, 0xE15E1775, -+ 0x1B80, 0xE15E1777, -+ 0x1B80, 0xE1651785, -+ 0x1B80, 0xE1651787, -+ 0x1B80, 0xE1C51795, -+ 0x1B80, 0xE1C51797, -+ 0x1B80, 0x551317A5, -+ 0x1B80, 0x551317A7, -+ 0x1B80, 0xE16117B5, -+ 0x1B80, 0xE16117B7, -+ 0x1B80, 0x551517C5, -+ 0x1B80, 0x551517C7, -+ 0x1B80, 0xE16517D5, -+ 0x1B80, 0xE16517D7, -+ 0x1B80, 0xE1C517E5, -+ 0x1B80, 0xE1C517E7, -+ 0x1B80, 0x000117F5, -+ 0x1B80, 0x000117F7, -+ 0x1B80, 0x54BF1805, -+ 0x1B80, 0x54BF1807, -+ 0x1B80, 0x54C01815, -+ 0x1B80, 0x54C01817, -+ 0x1B80, 0x54A31825, -+ 0x1B80, 0x54A31827, -+ 0x1B80, 0x54C11835, -+ 0x1B80, 0x54C11837, -+ 0x1B80, 0x54A41845, -+ 0x1B80, 0x54A41847, -+ 0x1B80, 0x4C181855, -+ 0x1B80, 0x4C181857, -+ 0x1B80, 0xBF071865, -+ 0x1B80, 0xBF071867, -+ 0x1B80, 0x54C21875, -+ 0x1B80, 0x54C21877, -+ 0x1B80, 0x54A41885, -+ 0x1B80, 0x54A41887, -+ 0x1B80, 0xBF041895, -+ 0x1B80, 0xBF041897, -+ 0x1B80, 0x54C118A5, -+ 0x1B80, 0x54C118A7, -+ 0x1B80, 0x54A318B5, -+ 0x1B80, 0x54A318B7, -+ 0x1B80, 0xBF0118C5, -+ 0x1B80, 0xBF0118C7, -+ 0x1B80, 0xE1D318D5, -+ 0x1B80, 0xE1D318D7, -+ 0x1B80, 0x54DF18E5, -+ 0x1B80, 0x54DF18E7, -+ 0x1B80, 0x000118F5, -+ 0x1B80, 0x000118F7, -+ 0x1B80, 0x54BF1905, -+ 0x1B80, 0x54BF1907, -+ 0x1B80, 0x54E51915, -+ 0x1B80, 0x54E51917, -+ 0x1B80, 0x050A1925, -+ 0x1B80, 0x050A1927, -+ 0x1B80, 0x54DF1935, -+ 0x1B80, 0x54DF1937, -+ 0x1B80, 0x00011945, -+ 0x1B80, 0x00011947, -+ 0x1B80, 0x7F201955, -+ 0x1B80, 0x7F201957, -+ 0x1B80, 0x7E001965, -+ 0x1B80, 0x7E001967, -+ 0x1B80, 0x7D001975, -+ 0x1B80, 0x7D001977, -+ 0x1B80, 0x55011985, -+ 0x1B80, 0x55011987, -+ 0x1B80, 0x5C311995, -+ 0x1B80, 0x5C311997, -+ 0x1B80, 0xE16119A5, -+ 0x1B80, 0xE16119A7, -+ 0x1B80, 0xE16519B5, -+ 0x1B80, 0xE16519B7, -+ 0x1B80, 0x548019C5, -+ 0x1B80, 0x548019C7, -+ 0x1B80, 0x540019D5, -+ 0x1B80, 0x540019D7, -+ 0x1B80, 0x548119E5, -+ 0x1B80, 0x548119E7, -+ 0x1B80, 0x540019F5, -+ 0x1B80, 0x540019F7, -+ 0x1B80, 0x54821A05, -+ 0x1B80, 0x54821A07, -+ 0x1B80, 0x54001A15, -+ 0x1B80, 0x54001A17, -+ 0x1B80, 0xE1801A25, -+ 0x1B80, 0xE1801A27, -+ 0x1B80, 0xBFED1A35, -+ 0x1B80, 0xBFED1A37, -+ 0x1B80, 0x301D1A45, -+ 0x1B80, 0x301D1A47, -+ 0x1B80, 0x00231A55, -+ 0x1B80, 0x00231A57, -+ 0x1B80, 0x7B201A65, -+ 0x1B80, 0x7B201A67, -+ 0x1B80, 0x7A001A75, -+ 0x1B80, 0x7A001A77, -+ 0x1B80, 0x79001A85, -+ 0x1B80, 0x79001A87, -+ 0x1B80, 0xE1C91A95, -+ 0x1B80, 0xE1C91A97, -+ 0x1B80, 0x00021AA5, -+ 0x1B80, 0x00021AA7, -+ 0x1B80, 0x00011AB5, -+ 0x1B80, 0x00011AB7, -+ 0x1B80, 0x00221AC5, -+ 0x1B80, 0x00221AC7, -+ 0x1B80, 0x7B201AD5, -+ 0x1B80, 0x7B201AD7, -+ 0x1B80, 0x7A001AE5, -+ 0x1B80, 0x7A001AE7, -+ 0x1B80, 0x79001AF5, -+ 0x1B80, 0x79001AF7, -+ 0x1B80, 0xE1C91B05, -+ 0x1B80, 0xE1C91B07, -+ 0x1B80, 0x00021B15, -+ 0x1B80, 0x00021B17, -+ 0x1B80, 0x00011B25, -+ 0x1B80, 0x00011B27, -+ 0x1B80, 0x74021B35, -+ 0x1B80, 0x74021B37, -+ 0x1B80, 0x003F1B45, -+ 0x1B80, 0x003F1B47, -+ 0x1B80, 0x74001B55, -+ 0x1B80, 0x74001B57, -+ 0x1B80, 0x00021B65, -+ 0x1B80, 0x00021B67, -+ 0x1B80, 0x00011B75, -+ 0x1B80, 0x00011B77, -+ 0x1B80, 0x4D041B85, -+ 0x1B80, 0x4D041B87, -+ 0x1B80, 0x2EF81B95, -+ 0x1B80, 0x2EF81B97, -+ 0x1B80, 0x00001BA5, -+ 0x1B80, 0x00001BA7, -+ 0x1B80, 0x23301BB5, -+ 0x1B80, 0x23301BB7, -+ 0x1B80, 0x00241BC5, -+ 0x1B80, 0x00241BC7, -+ 0x1B80, 0x23E01BD5, -+ 0x1B80, 0x23E01BD7, -+ 0x1B80, 0x003F1BE5, -+ 0x1B80, 0x003F1BE7, -+ 0x1B80, 0x23FC1BF5, -+ 0x1B80, 0x23FC1BF7, -+ 0x1B80, 0xBFCE1C05, -+ 0x1B80, 0xBFCE1C07, -+ 0x1B80, 0x2EF01C15, -+ 0x1B80, 0x2EF01C17, -+ 0x1B80, 0x00001C25, -+ 0x1B80, 0x00001C27, -+ 0x1B80, 0x4D001C35, -+ 0x1B80, 0x4D001C37, -+ 0x1B80, 0x00011C45, -+ 0x1B80, 0x00011C47, -+ 0x1B80, 0x549F1C55, -+ 0x1B80, 0x549F1C57, -+ 0x1B80, 0x54FF1C65, -+ 0x1B80, 0x54FF1C67, -+ 0x1B80, 0x54001C75, -+ 0x1B80, 0x54001C77, -+ 0x1B80, 0x00011C85, -+ 0x1B80, 0x00011C87, -+ 0x1B80, 0x5C311C95, -+ 0x1B80, 0x5C311C97, -+ 0x1B80, 0x07141CA5, -+ 0x1B80, 0x07141CA7, -+ 0x1B80, 0x54001CB5, -+ 0x1B80, 0x54001CB7, -+ 0x1B80, 0x5C321CC5, -+ 0x1B80, 0x5C321CC7, -+ 0x1B80, 0x00011CD5, -+ 0x1B80, 0x00011CD7, -+ 0x1B80, 0x5C321CE5, -+ 0x1B80, 0x5C321CE7, -+ 0x1B80, 0x07141CF5, -+ 0x1B80, 0x07141CF7, -+ 0x1B80, 0x54001D05, -+ 0x1B80, 0x54001D07, -+ 0x1B80, 0x5C311D15, -+ 0x1B80, 0x5C311D17, -+ 0x1B80, 0x00011D25, -+ 0x1B80, 0x00011D27, -+ 0x1B80, 0x4C981D35, -+ 0x1B80, 0x4C981D37, -+ 0x1B80, 0x4C181D45, -+ 0x1B80, 0x4C181D47, -+ 0x1B80, 0x00011D55, -+ 0x1B80, 0x00011D57, -+ 0x1B80, 0x5C321D65, -+ 0x1B80, 0x5C321D67, -+ 0x1B80, 0x62841D75, -+ 0x1B80, 0x62841D77, -+ 0x1B80, 0x66861D85, -+ 0x1B80, 0x66861D87, -+ 0x1B80, 0x6C031D95, -+ 0x1B80, 0x6C031D97, -+ 0x1B80, 0x7B201DA5, -+ 0x1B80, 0x7B201DA7, -+ 0x1B80, 0x7A001DB5, -+ 0x1B80, 0x7A001DB7, -+ 0x1B80, 0x79001DC5, -+ 0x1B80, 0x79001DC7, -+ 0x1B80, 0x7F201DD5, -+ 0x1B80, 0x7F201DD7, -+ 0x1B80, 0x7E001DE5, -+ 0x1B80, 0x7E001DE7, -+ 0x1B80, 0x7D001DF5, -+ 0x1B80, 0x7D001DF7, -+ 0x1B80, 0x09011E05, -+ 0x1B80, 0x09011E07, -+ 0x1B80, 0x0C011E15, -+ 0x1B80, 0x0C011E17, -+ 0x1B80, 0x0BA61E25, -+ 0x1B80, 0x0BA61E27, -+ 0x1B80, 0x00011E35, -+ 0x1B80, 0x00011E37, -+ 0x1B80, 0x00000006, -+ 0x1B80, 0x00000002, -+ -+}; -+ -+void -+odm_read_and_config_mp_8821c_phy_reg(struct dm_struct *dm) -+{ -+ u32 i = 0; -+ u8 c_cond; -+ boolean is_matched = true, is_skipped = false; -+ u32 array_len = -+ sizeof(array_mp_8821c_phy_reg) / sizeof(u32); -+ u32 *array = (u32 *)array_mp_8821c_phy_reg; -+ -+ u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ u32 a1 = 0, a2 = 0, a3 = 0, a4 = 0; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+ while ((i + 1) < array_len) { -+ v1 = array[i]; -+ v2 = array[i + 1]; -+ -+ if (v1 & (BIT(31) | BIT(30))) {/*positive & negative condition*/ -+ if (v1 & BIT(31)) {/* positive condition*/ -+ c_cond = -+ (u8)((v1 & (BIT(29) | BIT(28))) >> 28); -+ if (c_cond == COND_ENDIF) {/*end*/ -+ is_matched = true; -+ is_skipped = false; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ENDIF\n"); -+ } else if (c_cond == COND_ELSE) { /*else*/ -+ is_matched = is_skipped ? false : true; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ELSE\n"); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "IF or ELSE IF\n"); -+ } -+ } else if (v1 & BIT(30)) { /*negative condition*/ -+ if (!is_skipped) { -+ a1 = pre_v1; a2 = pre_v2; -+ a3 = v1; a4 = v2; -+ if (check_positive(dm, -+ a1, a2, a3, a4)) { -+ is_matched = true; -+ is_skipped = true; -+ } else { -+ is_matched = false; -+ is_skipped = false; -+ } -+ } else { -+ is_matched = false; -+ } -+ } -+ } else { -+ if (is_matched) -+ odm_config_bb_phy_8821c(dm, v1, MASKDWORD, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u32 -+odm_get_version_mp_8821c_phy_reg(void) -+{ -+ return 64; -+} -+ -+/****************************************************************************** -+ * phy_reg_mp.TXT -+ ******************************************************************************/ -+ -+const u32 array_mp_8821c_phy_reg_mp[] = { -+ 0x810, 0x21104285, -+ 0xAA8, 0xEAD30004, -+ -+}; -+ -+void -+odm_read_and_config_mp_8821c_phy_reg_mp(struct dm_struct *dm) -+{ -+ u32 i = 0; -+ u8 c_cond; -+ boolean is_matched = true, is_skipped = false; -+ u32 array_len = -+ sizeof(array_mp_8821c_phy_reg_mp) / sizeof(u32); -+ u32 *array = (u32 *)array_mp_8821c_phy_reg_mp; -+ -+ u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ u32 a1 = 0, a2 = 0, a3 = 0, a4 = 0; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+ while ((i + 1) < array_len) { -+ v1 = array[i]; -+ v2 = array[i + 1]; -+ -+ if (v1 & (BIT(31) | BIT(30))) {/*positive & negative condition*/ -+ if (v1 & BIT(31)) {/* positive condition*/ -+ c_cond = -+ (u8)((v1 & (BIT(29) | BIT(28))) >> 28); -+ if (c_cond == COND_ENDIF) {/*end*/ -+ is_matched = true; -+ is_skipped = false; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ENDIF\n"); -+ } else if (c_cond == COND_ELSE) { /*else*/ -+ is_matched = is_skipped ? false : true; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ELSE\n"); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "IF or ELSE IF\n"); -+ } -+ } else if (v1 & BIT(30)) { /*negative condition*/ -+ if (!is_skipped) { -+ a1 = pre_v1; a2 = pre_v2; -+ a3 = v1; a4 = v2; -+ if (check_positive(dm, -+ a1, a2, a3, a4)) { -+ is_matched = true; -+ is_skipped = true; -+ } else { -+ is_matched = false; -+ is_skipped = false; -+ } -+ } else { -+ is_matched = false; -+ } -+ } -+ } else { -+ if (is_matched) -+ odm_config_bb_phy_8821c(dm, v1, MASKDWORD, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u32 -+odm_get_version_mp_8821c_phy_reg_mp(void) -+{ -+ return 64; -+} -+ -+/****************************************************************************** -+ * phy_reg_pg.TXT -+ ******************************************************************************/ -+ -+#ifdef CONFIG_8821C -+const u32 array_mp_8821c_phy_reg_pg[] = { -+ 0, 0, 0, 0x00000c20, 0xffffffff, 0x32343638, -+ 0, 0, 0, 0x00000c24, 0xffffffff, 0x36363636, -+ 0, 0, 0, 0x00000c28, 0xffffffff, 0x28303234, -+ 0, 0, 0, 0x00000c2c, 0xffffffff, 0x34363636, -+ 0, 0, 0, 0x00000c30, 0xffffffff, 0x26283032, -+ 0, 0, 0, 0x00000c3c, 0xffffffff, 0x34363636, -+ 0, 0, 0, 0x00000c40, 0xffffffff, 0x26283032, -+ 0, 0, 0, 0x00000c44, 0xffffffff, 0x22222224, -+ 1, 0, 0, 0x00000c24, 0xffffffff, 0x34343434, -+ 1, 0, 0, 0x00000c28, 0xffffffff, 0x26283032, -+ 1, 0, 0, 0x00000c2c, 0xffffffff, 0x32343434, -+ 1, 0, 0, 0x00000c30, 0xffffffff, 0x24262830, -+ 1, 0, 0, 0x00000c3c, 0xffffffff, 0x32343434, -+ 1, 0, 0, 0x00000c40, 0xffffffff, 0x24262830, -+ 1, 0, 0, 0x00000c44, 0xffffffff, 0x20202022 -+}; -+ -+#endif -+ -+void -+odm_read_and_config_mp_8821c_phy_reg_pg(struct dm_struct *dm) -+{ -+#ifdef CONFIG_8821C -+ -+ u32 i = 0; -+ u32 array_len = -+ sizeof(array_mp_8821c_phy_reg_pg) / sizeof(u32); -+ u32 *array = (u32 *)array_mp_8821c_phy_reg_pg; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ -+ odm_memory_set(dm, hal_data->BufOfLinesPwrByRate, 0, -+ MAX_LINES_HWCONFIG_TXT * -+ MAX_BYTES_LINE_HWCONFIG_TXT); -+ hal_data->nLinesReadPwrByRate = array_len / 6; -+#endif -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+ dm->phy_reg_pg_version = 1; -+ dm->phy_reg_pg_value_type = PHY_REG_PG_EXACT_VALUE; -+ -+ for (i = 0; i < array_len; 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_config_bb_phy_reg_pg_8821c(dm, v1, v2, v3, v4, v5, v6); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf((char *)hal_data->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 -+} -+ -+/****************************************************************************** -+ * phy_reg_pg_type0x28.TXT -+ ******************************************************************************/ -+ -+#ifdef CONFIG_8821C_TYPE0X28 -+const u32 array_mp_8821c_phy_reg_pg_type0x28[] = { -+ 0, 0, 0, 0x00000c20, 0xffffffff, 0x32343638, -+ 0, 0, 0, 0x00000c24, 0xffffffff, 0x36363636, -+ 0, 0, 0, 0x00000c28, 0xffffffff, 0x28303234, -+ 0, 0, 0, 0x00000c2c, 0xffffffff, 0x34363636, -+ 0, 0, 0, 0x00000c30, 0xffffffff, 0x26283032, -+ 0, 0, 0, 0x00000c3c, 0xffffffff, 0x34363636, -+ 0, 0, 0, 0x00000c40, 0xffffffff, 0x26283032, -+ 0, 0, 0, 0x00000c44, 0xffffffff, 0x22222224, -+ 1, 0, 0, 0x00000c24, 0xffffffff, 0x40404040, -+ 1, 0, 0, 0x00000c28, 0xffffffff, 0x32343638, -+ 1, 0, 0, 0x00000c2c, 0xffffffff, 0x38383838, -+ 1, 0, 0, 0x00000c30, 0xffffffff, 0x30323436, -+ 1, 0, 0, 0x00000c3c, 0xffffffff, 0x36363636, -+ 1, 0, 0, 0x00000c40, 0xffffffff, 0x30323436, -+ 1, 0, 0, 0x00000c44, 0xffffffff, 0x26262628 -+}; -+ -+#endif -+ -+void -+odm_read_and_config_mp_8821c_phy_reg_pg_type0x28(struct dm_struct *dm) -+{ -+#ifdef CONFIG_8821C_TYPE0X28 -+ -+ u32 i = 0; -+ u32 array_len = -+ sizeof(array_mp_8821c_phy_reg_pg_type0x28) / sizeof(u32); -+ u32 *array = (u32 *)array_mp_8821c_phy_reg_pg_type0x28; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = dm->adapter; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ -+ odm_memory_set(dm, hal_data->BufOfLinesPwrByRate, 0, -+ MAX_LINES_HWCONFIG_TXT * -+ MAX_BYTES_LINE_HWCONFIG_TXT); -+ hal_data->nLinesReadPwrByRate = array_len / 6; -+#endif -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+ dm->phy_reg_pg_version = 1; -+ dm->phy_reg_pg_value_type = PHY_REG_PG_EXACT_VALUE; -+ -+ for (i = 0; i < array_len; 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_config_bb_phy_reg_pg_8821c(dm, v1, v2, v3, v4, v5, v6); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf((char *)hal_data->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 -+} -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_bb.h b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_bb.h -new file mode 100644 -index 000000000..a2331dc7a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_bb.h -@@ -0,0 +1,90 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*Image2HeaderVersion: R3 1.5.10.1*/ -+#if (RTL8821C_SUPPORT == 1) -+#ifndef __INC_MP_BB_HW_IMG_8821C_H -+#define __INC_MP_BB_HW_IMG_8821C_H -+ -+/****************************************************************************** -+ * agc_tab.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_agc_tab(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_agc_tab(void); -+ -+/****************************************************************************** -+ * agc_tab_diff.TXT -+ ******************************************************************************/ -+ -+extern const u32 array_mp_8821c_agc_tab_diff_wlg[780]; -+extern const u32 array_mp_8821c_agc_tab_diff_btg[780]; -+void -+odm_read_and_config_mp_8821c_agc_tab_diff(struct dm_struct *dm, -+ const u32 array[], -+ u32 array_len); -+u32 odm_get_version_mp_8821c_agc_tab_diff(void); -+ -+/****************************************************************************** -+ * phy_reg.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_phy_reg(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_phy_reg(void); -+ -+/****************************************************************************** -+ * phy_reg_mp.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_phy_reg_mp(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_phy_reg_mp(void); -+ -+/****************************************************************************** -+ * phy_reg_pg.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_phy_reg_pg(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_phy_reg_pg(void); -+ -+/****************************************************************************** -+ * phy_reg_pg_type0x28.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_phy_reg_pg_type0x28(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_phy_reg_pg_type0x28(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_mac.c b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_mac.c -new file mode 100644 -index 000000000..693667f61 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_mac.c -@@ -0,0 +1,321 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*Image2HeaderVersion: R3 1.5.10.1*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8821C_SUPPORT == 1) -+static boolean -+check_positive(struct dm_struct *dm, -+ const u32 condition1, -+ const u32 condition2, -+ const u32 condition3, -+ const u32 condition4 -+) -+{ -+ u32 cond1 = condition1, cond2 = condition2, -+ cond3 = condition3, cond4 = condition4; -+ -+ u8 cut_version_for_para = -+ (dm->cut_version == ODM_CUT_A) ? 15 : dm->cut_version; -+ -+ u8 pkg_type_for_para = -+ (dm->package_type == 0) ? 15 : dm->package_type; -+ -+ u32 driver1 = cut_version_for_para << 24 | -+ (dm->support_interface & 0xF0) << 16 | -+ dm->support_platform << 16 | -+ pkg_type_for_para << 12 | -+ (dm->support_interface & 0x0F) << 8 | -+ dm->rfe_type; -+ -+ u32 driver2 = (dm->type_glna & 0xFF) << 0 | -+ (dm->type_gpa & 0xFF) << 8 | -+ (dm->type_alna & 0xFF) << 16 | -+ (dm->type_apa & 0xFF) << 24; -+ -+ u32 driver3 = 0; -+ -+ u32 driver4 = (dm->type_glna & 0xFF00) >> 8 | -+ (dm->type_gpa & 0xFF00) | -+ (dm->type_alna & 0xFF00) << 8 | -+ (dm->type_apa & 0xFF00) << 16; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "===> %s (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", -+ __func__, cond1, cond2, cond3, cond4); -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "===> %s (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", -+ __func__, driver1, driver2, driver3, driver4); -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ " (Platform, Interface) = (0x%X, 0x%X)\n", -+ dm->support_platform, dm->support_interface); -+ PHYDM_DBG(dm, ODM_COMP_INIT, " (RFE, Package) = (0x%X, 0x%X)\n", -+ dm->rfe_type, dm->package_type); -+ -+ /*============== value Defined Check ===============*/ -+ /*cut version [27:24] need to do value check*/ -+ if (((cond1 & 0x0F000000) != 0) && -+ ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return false; -+ -+ /*pkg type [15:12] need to do value check*/ -+ if (((cond1 & 0x0000F000) != 0) && -+ ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return false; -+ -+ /*interface [11:8] need to do value check*/ -+ if (((cond1 & 0x00000F00) != 0) && -+ ((cond1 & 0x00000F00) != (driver1 & 0x00000F00))) -+ return false; -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x000000FF; -+ driver1 &= 0x000000FF; -+ -+ if (cond1 == driver1) -+ return true; -+ else -+ return false; -+} -+ -+ -+/****************************************************************************** -+ * mac_reg.TXT -+ ******************************************************************************/ -+ -+const u32 array_mp_8821c_mac_reg[] = { -+ 0x010, 0x00000043, -+ 0x025, 0x0000001D, -+ 0x026, 0x000000CE, -+ 0x04F, 0x00000001, -+ 0x029, 0x000000F9, -+ 0x420, 0x00000080, -+ 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, 0x000000F0, -+ 0x446, 0x00000001, -+ 0x447, 0x000000FE, -+ 0x448, 0x00000000, -+ 0x449, 0x00000000, -+ 0x44A, 0x00000000, -+ 0x44B, 0x00000040, -+ 0x44C, 0x00000010, -+ 0x44D, 0x000000F0, -+ 0x44E, 0x0000003F, -+ 0x44F, 0x00000000, -+ 0x450, 0x00000000, -+ 0x451, 0x00000000, -+ 0x452, 0x00000000, -+ 0x453, 0x00000040, -+ 0x455, 0x00000070, -+ 0x45E, 0x00000004, -+ 0x49C, 0x00000010, -+ 0x49D, 0x000000F0, -+ 0x49E, 0x00000000, -+ 0x49F, 0x00000006, -+ 0x4A0, 0x000000E0, -+ 0x4A1, 0x00000003, -+ 0x4A2, 0x00000000, -+ 0x4A3, 0x00000040, -+ 0x4A4, 0x00000015, -+ 0x4A5, 0x000000F0, -+ 0x4A6, 0x00000000, -+ 0x4A7, 0x00000006, -+ 0x4A8, 0x000000E0, -+ 0x4A9, 0x00000000, -+ 0x4AA, 0x00000000, -+ 0x4AB, 0x00000000, -+ 0x7DA, 0x00000008, -+ 0x1448, 0x00000006, -+ 0x144A, 0x00000006, -+ 0x144C, 0x00000006, -+ 0x144E, 0x00000006, -+ 0x4C8, 0x000000FF, -+ 0x4C9, 0x00000008, -+ 0x4CC, 0x000000FF, -+ 0x4CD, 0x000000FF, -+ 0x4CE, 0x00000001, -+ 0x4CF, 0x00000008, -+ 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, -+ 0x521, 0x0000002F, -+ 0x525, 0x0000004F, -+ 0x551, 0x00000010, -+ 0x559, 0x00000002, -+ 0x55C, 0x00000050, -+ 0x55D, 0x000000FF, -+ 0x577, 0x0000000B, -+ 0x578, 0x00000014, -+ 0x579, 0x00000014, -+ 0x57A, 0x00000014, -+ 0x5BE, 0x00000064, -+ 0x605, 0x00000030, -+ 0x608, 0x0000000E, -+ 0x609, 0x00000022, -+ 0x60C, 0x00000018, -+ 0x6A0, 0x000000FF, -+ 0x6A1, 0x000000FF, -+ 0x6A2, 0x000000FF, -+ 0x6A3, 0x000000FF, -+ 0x6A4, 0x000000FF, -+ 0x6A5, 0x000000FF, -+ 0x6DE, 0x00000084, -+ 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, -+ 0x7D4, 0x00000098, -+ -+}; -+ -+void -+odm_read_and_config_mp_8821c_mac_reg(struct dm_struct *dm) -+{ -+ u32 i = 0; -+ u8 c_cond; -+ boolean is_matched = true, is_skipped = false; -+ u32 array_len = -+ sizeof(array_mp_8821c_mac_reg) / sizeof(u32); -+ u32 *array = (u32 *)array_mp_8821c_mac_reg; -+ -+ u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ u32 a1 = 0, a2 = 0, a3 = 0, a4 = 0; -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); -+ -+ while ((i + 1) < array_len) { -+ v1 = array[i]; -+ v2 = array[i + 1]; -+ -+ if (v1 & (BIT(31) | BIT(30))) {/*positive & negative condition*/ -+ if (v1 & BIT(31)) {/* positive condition*/ -+ c_cond = -+ (u8)((v1 & (BIT(29) | BIT(28))) >> 28); -+ if (c_cond == COND_ENDIF) {/*end*/ -+ is_matched = true; -+ is_skipped = false; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ENDIF\n"); -+ } else if (c_cond == COND_ELSE) { /*else*/ -+ is_matched = is_skipped ? false : true; -+ PHYDM_DBG(dm, ODM_COMP_INIT, "ELSE\n"); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "IF or ELSE IF\n"); -+ } -+ } else if (v1 & BIT(30)) { /*negative condition*/ -+ if (!is_skipped) { -+ a1 = pre_v1; a2 = pre_v2; -+ a3 = v1; a4 = v2; -+ if (check_positive(dm, -+ a1, a2, a3, a4)) { -+ is_matched = true; -+ is_skipped = true; -+ } else { -+ is_matched = false; -+ is_skipped = false; -+ } -+ } else { -+ is_matched = false; -+ } -+ } -+ } else { -+ if (is_matched) -+ odm_config_mac_8821c(dm, v1, (u8)v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u32 -+odm_get_version_mp_8821c_mac_reg(void) -+{ -+ return 64; -+} -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_mac.h b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_mac.h -new file mode 100644 -index 000000000..978dd89aa ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/halhwimg8821c_mac.h -@@ -0,0 +1,42 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+ -+/*Image2HeaderVersion: R3 1.5.10.1*/ -+#if (RTL8821C_SUPPORT == 1) -+#ifndef __INC_MP_MAC_HW_IMG_8821C_H -+#define __INC_MP_MAC_HW_IMG_8821C_H -+ -+/****************************************************************************** -+ * mac_reg.TXT -+ ******************************************************************************/ -+ -+/* tc: Test Chip, mp: mp Chip*/ -+void -+odm_read_and_config_mp_8821c_mac_reg(struct dm_struct *dm); -+u32 odm_get_version_mp_8821c_mac_reg(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/mp_precomp.h b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/mp_precomp.h -new file mode 100644 -index 000000000..e938c5f71 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/mp_precomp.h -@@ -0,0 +1,14 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_hal_api8821c.c b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_hal_api8821c.c -new file mode 100644 -index 000000000..cff79887a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_hal_api8821c.c -@@ -0,0 +1,1527 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "../phydm_precomp.h" -+ -+#if (RTL8821C_SUPPORT == 1) -+#if (PHYDM_FW_API_ENABLE_8821C == 1) -+/* ======================================================================== */ -+/* These following functions can be used for PHY DM only*/ -+ -+u32 rega24_8821c; -+u32 rega28_8821c; -+u32 regaac_8821c; -+ -+enum channel_width bw_8821c; -+u8 central_ch_8821c; -+ -+__iram_odm_func__ -+void phydm_igi_toggle_8821c(struct dm_struct *dm) -+{ -+ u32 igi = 0x20; -+ -+ igi = odm_get_bb_reg(dm, R_0xc50, 0x7f); -+ odm_set_bb_reg(dm, R_0xc50, 0x7f, (igi - 2)); -+ odm_set_bb_reg(dm, R_0xc50, 0x7f, igi); -+} -+ -+__iram_odm_func__ -+s8 phydm_cck_rssi_8821c(struct dm_struct *dm, u8 lna_idx, u8 vga_idx) -+{ -+ s8 rx_pwr_all = 0; -+ s8 lna_gain = 0; -+ /*only use lna2/3/5/7*/ -+ s8 lna_gain_table_0[8] = {22, 8, -6, -22, -31, -40, -46, -52}; -+ /*only use lna4/8/C/F*/ -+ s8 lna_gain_table_1[16] = {10, 6, 2, -2, -6, -10, -14, -17, -+ -20, -24, -28, -31, -34, -37, -40, -44}; -+ -+ if (dm->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; -+} -+ -+__iram_odm_func__ -+boolean -+phydm_rfe_8821c(struct dm_struct *dm, u8 channel) -+{ -+#if 0 -+ /* Efuse is not wrote now */ -+ /* Need to check RFE type finally */ -+ /*if (dm->rfe_type == 1) {*/ -+ if (channel <= 14) { -+ /* signal source */ -+ odm_set_bb_reg(dm, R_0xcb0, (MASKBYTE2 | MASKLWORD), 0x704570); -+ odm_set_bb_reg(dm, R_0xeb0, (MASKBYTE2 | MASKLWORD), 0x704570); -+ odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x45); -+ odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x45); -+ } else if (channel > 35) { -+ odm_set_bb_reg(dm, R_0xcb0, (MASKBYTE2 | MASKLWORD), 0x174517); -+ odm_set_bb_reg(dm, R_0xeb0, (MASKBYTE2 | MASKLWORD), 0x174517); -+ odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x45); -+ odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x45); -+ } else -+ return false; -+ -+ /* chip top mux */ -+ odm_set_bb_reg(dm, R_0x64, BIT(29) | BIT(28), 0x3); -+ odm_set_bb_reg(dm, R_0x4c, BIT(26) | BIT(25), 0x0); -+ odm_set_bb_reg(dm, R_0x40, BIT(2), 0x1); -+ -+ /* from s0 or s1 */ -+ odm_set_bb_reg(dm, R_0x1990, (BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0)), 0x30); -+ odm_set_bb_reg(dm, R_0x1990, (BIT(11) | BIT(10)), 0x3); -+ -+ /* input or output */ -+ odm_set_bb_reg(dm, R_0x974, (BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0)), 0x3f); -+ odm_set_bb_reg(dm, R_0x974, (BIT(11) | BIT(10)), 0x3); -+ -+ /* delay 400ns for PAPE */ -+ odm_set_bb_reg(dm, R_0x810, MASKBYTE3 | BIT(20) | BIT(21) | BIT(22) | BIT(23), 0x211); -+ -+ /* antenna switch table */ -+ odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa555); -+ odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa555); -+ -+ /* inverse or not */ -+ odm_set_bb_reg(dm, R_0xcbc, (BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0)), 0x0); -+ odm_set_bb_reg(dm, R_0xcbc, (BIT(11) | BIT(10)), 0x0); -+ odm_set_bb_reg(dm, R_0xebc, (BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0)), 0x0); -+ odm_set_bb_reg(dm, R_0xebc, (BIT(11) | BIT(10)), 0x0); -+ /*}*/ -+#endif -+ return true; -+} -+ -+__iram_odm_func__ -+void phydm_ccapar_8821c(struct dm_struct *dm) -+{ -+#if 0 -+ u32 cca_ifem[9][4] = { -+ /*20M*/ -+ {0x75D97010, 0x75D97010, 0x75D97010, 0x75D97010}, /*Reg82C*/ -+ {0x00000000, 0x00000000, 0x00000000, 0x00000000}, /*Reg830*/ -+ {0x00000000, 0x00000000, 0x00000000, 0x00000000}, /*Reg838*/ -+ /*40M*/ -+ {0x75D97010, 0x75D97010, 0x75D97010, 0x75D97010}, /*Reg82C*/ -+ {0x00000000, 0x79a0ea28, 0x00000000, 0x79a0ea28}, /*Reg830*/ -+ {0x87765541, 0x87766341, 0x87765541, 0x87766341}, /*Reg838*/ -+ /*80M*/ -+ {0x75D97010, 0x75D97010, 0x75D97010, 0x75D97010}, /*Reg82C*/ -+ {0x00000000, 0x00000000, 0x00000000, 0x00000000}, /*Reg830*/ -+ {0x00000000, 0x87746641, 0x00000000, 0x87746641} -+ }; /*Reg838*/ -+ -+ u32 cca_efem[9][4] = { -+ /*20M*/ -+ {0x75A76010, 0x75A76010, 0x75A76010, 0x75A75010}, /*Reg82C*/ -+ {0x00000000, 0x00000000, 0x00000000, 0x00000000}, /*Reg830*/ -+ {0x87766651, 0x87766431, 0x87766451, 0x87766431}, /*Reg838*/ -+ /*40M*/ -+ {0x75A75010, 0x75A75010, 0x75A75010, 0x75A75010}, /*Reg82C*/ -+ {0x00000000, 0x00000000, 0x00000000, 0x00000000}, /*Reg830*/ -+ {0x87766431, 0x87766431, 0x87766431, 0x87766431}, /*Reg838*/ -+ /*80M*/ -+ {0x75BA7010, 0x75BA7010, 0x75BA7010, 0x75BA7010}, /*Reg82C*/ -+ {0x00000000, 0x00000000, 0x00000000, 0x00000000}, /*Reg830*/ -+ {0x87766431, 0x87766431, 0x87766431, 0x87766431} -+ }; /*Reg838*/ -+ -+ u8 row, col; -+ u32 reg82c, reg830, reg838; -+ -+ if (dm->cut_version != ODM_CUT_B) -+ return; -+ -+ if (bw_8821c == CHANNEL_WIDTH_20) -+ row = 0; -+ else if (bw_8821c == CHANNEL_WIDTH_40) -+ row = 3; -+ else -+ row = 6; -+ -+ if (central_ch_8821c <= 14) { -+ if (dm->rx_ant_status == BB_PATH_A || dm->rx_ant_status == BB_PATH_B) -+ col = 0; -+ else -+ col = 1; -+ } else { -+ if (dm->rx_ant_status == BB_PATH_A || dm->rx_ant_status == BB_PATH_B) -+ col = 2; -+ else -+ col = 3; -+ } -+ -+ if (dm->rfe_type == 0) {/*iFEM*/ -+ reg82c = (cca_ifem[row][col] != 0) ? cca_ifem[row][col] : reg82c_8821c; -+ reg830 = (cca_ifem[row + 1][col] != 0) ? cca_ifem[row + 1][col] : reg830_8821c; -+ reg838 = (cca_ifem[row + 2][col] != 0) ? cca_ifem[row + 2][col] : reg838_8821c; -+ } else {/*eFEM*/ -+ reg82c = (cca_efem[row][col] != 0) ? cca_efem[row][col] : reg82c_8821c; -+ reg830 = (cca_efem[row + 1][col] != 0) ? cca_efem[row + 1][col] : reg830_8821c; -+ reg838 = (cca_efem[row + 2][col] != 0) ? cca_efem[row + 2][col] : reg838_8821c; -+ } -+ -+ odm_set_bb_reg(dm, R_0x82c, MASKDWORD, reg82c); -+ odm_set_bb_reg(dm, R_0x830, MASKDWORD, reg830); -+ odm_set_bb_reg(dm, R_0x838, MASKDWORD, reg838); -+#endif -+} -+ -+__iram_odm_func__ -+void phydm_ccapar_by_bw_8821c(struct dm_struct *dm, -+ enum channel_width bandwidth) -+{ -+#if 0 -+ u32 reg82c; -+ -+ -+ if (dm->cut_version != ODM_CUT_A) -+ return; -+ -+ /* A-cut */ -+ reg82c = odm_get_bb_reg(dm, R_0x82c, MASKDWORD); -+ -+ if (bandwidth == CHANNEL_WIDTH_20) { -+ /* 82c[15:12] = 4 */ -+ /* 82c[27:24] = 6 */ -+ -+ reg82c &= (~(0x0f00f000)); -+ reg82c |= ((0x4) << 12); -+ reg82c |= ((0x6) << 24); -+ } else if (bandwidth == CHANNEL_WIDTH_40) { -+ /* 82c[19:16] = 9 */ -+ /* 82c[27:24] = 6 */ -+ -+ reg82c &= (~(0x0f0f0000)); -+ reg82c |= ((0x9) << 16); -+ reg82c |= ((0x6) << 24); -+ } else if (bandwidth == CHANNEL_WIDTH_80) { -+ /* 82c[15:12] 7 */ -+ /* 82c[19:16] b */ -+ /* 82c[23:20] d */ -+ /* 82c[27:24] 3 */ -+ -+ reg82c &= (~(0x0ffff000)); -+ reg82c |= ((0xdb7) << 12); -+ reg82c |= ((0x3) << 24); -+ } -+ -+ odm_set_bb_reg(dm, R_0x82c, MASKDWORD, reg82c); -+#endif -+} -+ -+__iram_odm_func__ -+void phydm_ccapar_by_rxpath_8821c(struct dm_struct *dm) -+{ -+#if 0 -+ if (dm->cut_version != ODM_CUT_A) -+ return; -+ -+ if (dm->rx_ant_status == BB_PATH_A || dm->rx_ant_status == BB_PATH_B) { -+ /* 838[7:4] = 8 */ -+ /* 838[11:8] = 7 */ -+ /* 838[15:12] = 6 */ -+ /* 838[19:16] = 7 */ -+ /* 838[23:20] = 7 */ -+ /* 838[27:24] = 7 */ -+ odm_set_bb_reg(dm, R_0x838, 0x0ffffff0, 0x777678); -+ } else { -+ /* 838[7:4] = 3 */ -+ /* 838[11:8] = 3 */ -+ /* 838[15:12] = 6 */ -+ /* 838[19:16] = 6 */ -+ /* 838[23:20] = 7 */ -+ /* 838[27:24] = 7 */ -+ odm_set_bb_reg(dm, R_0x838, 0x0ffffff0, 0x776633); -+ } -+#endif -+} -+ -+__iram_odm_func__ -+void phydm_rxdfirpar_by_bw_8821c(struct dm_struct *dm, -+ enum channel_width bandwidth) -+{ -+ if (bandwidth == CHANNEL_WIDTH_40) { -+ /* RX DFIR for BW40 */ -+ odm_set_bb_reg(dm, R_0x948, BIT(29) | BIT(28), 0x2); -+ odm_set_bb_reg(dm, R_0x94c, BIT(29) | BIT(28), 0x2); -+ odm_set_bb_reg(dm, R_0xc20, BIT(31), 0x0); -+ odm_set_bb_reg(dm, R_0x8f0, BIT(31), 0x0); -+ } else if (bandwidth == CHANNEL_WIDTH_80) { -+ /* RX DFIR for BW80 */ -+ odm_set_bb_reg(dm, R_0x948, BIT(29) | BIT(28), 0x2); -+ odm_set_bb_reg(dm, R_0x94c, BIT(29) | BIT(28), 0x1); -+ odm_set_bb_reg(dm, R_0xc20, BIT(31), 0x0); -+ odm_set_bb_reg(dm, R_0x8f0, BIT(31), 0x1); -+ } else { -+ /* RX DFIR for BW20, BW10 and BW5*/ -+ odm_set_bb_reg(dm, R_0x948, BIT(29) | BIT(28), 0x2); -+ odm_set_bb_reg(dm, R_0x94c, BIT(29) | BIT(28), 0x2); -+ odm_set_bb_reg(dm, R_0xc20, BIT(31), 0x1); -+ odm_set_bb_reg(dm, R_0x8f0, BIT(31), 0x0); -+ } -+ /* PHYDM_DBG(dm, ODM_PHY_CONFIG, "phydm_rxdfirpar_by_bw_8821c\n");*/ -+} -+ -+__iram_odm_func__ -+boolean -+phydm_write_txagc_1byte_8821c(struct dm_struct *dm, u32 power_index, -+ enum rf_path path, u8 hw_rate) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u32 offset_txagc[2] = {0x1d00, 0x1d80}; -+ u8 rate_idx = (hw_rate & 0xfc), i; -+ u8 rate_offset = (hw_rate & 0x3); -+ u32 txagc_content = 0x0; -+ -+ /* For debug command only!!!! */ -+ -+ /* Error handling */ -+ if (path > RF_PATH_A || hw_rate > 0x53) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: unsupported path (%d)\n", -+ __func__, path); -+ return false; -+ } -+ -+#if 1 -+ /* For HW limitation, We can't write TXAGC once a byte. */ -+ for (i = 0; i < 4; i++) { -+ if (i != rate_offset) -+ txagc_content = txagc_content | (config_phydm_read_txagc_8821c(dm, path, rate_idx + i) << (i << 3)); -+ else -+ txagc_content = txagc_content | ((power_index & 0x3f) << (i << 3)); -+ } -+ odm_set_bb_reg(dm, (offset_txagc[path] + rate_idx), MASKDWORD, txagc_content); -+#else -+ odm_write_1byte(dm, (offset_txagc[path] + hw_rate), (power_index & 0x3f)); -+#endif -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: path-%d rate index 0x%x (0x%x) = 0x%x\n", __func__, -+ path, hw_rate, (offset_txagc[path] + hw_rate), power_index); -+ return true; -+#else -+ return false; -+#endif -+} -+ -+__iram_odm_func__ -+void phydm_init_hw_info_by_rfe_type_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ dm->is_init_hw_info_by_rfe = false; -+ /* -+ * Let original variable rfe_type to be rfe_type_8821c. -+ * Varible rfe_type as symbol is used to identify PHY parameter. -+ */ -+ dm->rfe_type = dm->rfe_type_expand >> 3; -+ -+ /*2.4G default rf set with wlg or btg*/ -+ if (dm->rfe_type_expand == 2 || dm->rfe_type_expand == 4 || dm->rfe_type_expand == 7) { -+ dm->default_rf_set_8821c = SWITCH_TO_BTG; -+ } else if (dm->rfe_type_expand == 0 || dm->rfe_type_expand == 1 || -+ dm->rfe_type_expand == 3 || dm->rfe_type_expand == 5 || -+ dm->rfe_type_expand == 6) { -+ dm->default_rf_set_8821c = SWITCH_TO_WLG; -+ } else if (dm->rfe_type_expand == 0x22 || dm->rfe_type_expand == 0x24 || -+ dm->rfe_type_expand == 0x27 || dm->rfe_type_expand == 0x2a || -+ dm->rfe_type_expand == 0x2c || dm->rfe_type_expand == 0x2f) { -+ dm->default_rf_set_8821c = SWITCH_TO_BTG; -+ odm_cmn_info_init(dm, ODM_CMNINFO_PACKAGE_TYPE, 1); -+ } else if (dm->rfe_type_expand == 0x20 || dm->rfe_type_expand == 0x21 || -+ dm->rfe_type_expand == 0x23 || dm->rfe_type_expand == 0x25 || -+ dm->rfe_type_expand == 0x26 || dm->rfe_type_expand == 0x28 || -+ dm->rfe_type_expand == 0x29 || dm->rfe_type_expand == 0x2b || -+ dm->rfe_type_expand == 0x2d || dm->rfe_type_expand == 0x2e) { -+ dm->default_rf_set_8821c = SWITCH_TO_WLG; -+ odm_cmn_info_init(dm, ODM_CMNINFO_PACKAGE_TYPE, 1); -+ } -+ -+ if (dm->rfe_type_expand == 3 || dm->rfe_type_expand == 4 || -+ dm->rfe_type_expand == 0x23 || dm->rfe_type_expand == 0x24 || -+ dm->rfe_type_expand == 0x2b || dm->rfe_type_expand == 0x2c) -+ dm->default_ant_num_8821c = SWITCH_TO_ANT2; -+ else -+ dm->default_ant_num_8821c = SWITCH_TO_ANT1; -+ -+ if (dm->package_type == 1 && dm->rfe_type_expand <= 0x2f && -+ dm->rfe_type_expand >= 0x28) -+ odm_set_bb_reg(dm, R_0xcb4, MASKDWORD, 0x00000073); -+ else if (dm->rfe_type_expand == 4) -+ odm_set_bb_reg(dm, R_0xcb4, MASKDWORD, 0x20000077); -+ else -+ odm_set_bb_reg(dm, R_0xcb4, MASKDWORD, 0x10000077); -+ -+ dm->is_init_hw_info_by_rfe = true; -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s: RFE type (%d), rf set (%s)\n", -+ __FUNCTION__, dm->rfe_type_expand, -+ dm->default_rf_set_8821c == 0 ? "BTG" : "WLG"); -+#endif -+} -+ -+__iram_odm_func__ -+void phydm_set_gnt_state_8821c(struct dm_struct *dm, boolean gnt_wl_state, -+ boolean gnt_bt_state) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u32 gnt_val = 0; -+ -+ odm_set_bb_reg(dm, R_0x70, BIT(26), 0x1); -+ -+ if (gnt_wl_state) -+ gnt_val = 0x3300; -+ else -+ gnt_val = 0x1100; -+ -+ if (gnt_bt_state) -+ gnt_val = gnt_val | 0xcc00; -+ else -+ gnt_val = gnt_val | 0x4400; -+ -+ odm_set_bb_reg(dm, R_0x1704, MASKLWORD, gnt_val); -+ ODM_delay_us(50); /*waiting before access 0x1700 */ -+ odm_set_bb_reg(dm, R_0x1700, MASKDWORD, 0xc00f0038); -+#endif -+} -+ -+__iram_odm_func__ -+void -+phydm_dynamic_spur_det_eliminate_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ -+ u32 freq_5g[FREQ_PT_5G_NUM_8821C] = {0x3e0, 0x20, 0x3a0}; -+ u32 freq_5g_n1[FREQ_PT_5G_NUM_8821C] = {0}; -+ u32 freq_5g_p1[FREQ_PT_5G_NUM_8821C] = {0}; -+ u32 freq_pt_5g_final = 0; -+ u32 max_ret_psd_final = 0; -+ u32 max_ret_psd_2nd[PSD_SMP_NUM_8821C] = {0}; -+ u32 psd_set[PSD_VAL_NUM_8821C] = {0}; -+ u32 rank_psd_index_in[PSD_VAL_NUM_8821C] = {0}; -+ u32 rank_psd_index_out[PSD_VAL_NUM_8821C] = {0}; -+ u32 rank_sample_index_in[PSD_SMP_NUM_8821C] = {0}; -+ u32 rank_sample_index_out[PSD_SMP_NUM_8821C] = {0}; -+ u16 threshold_nbi = 0x11a; -+ u8 j = 0, k = 0; -+ u8 idx = 0; -+ boolean s_donbi_a = false; -+ -+ /*PSD parameters init*/ -+ odm_set_bb_reg(dm, R_0x910, 0xfffc00, 0x3f); -+ -+ /* Reset NBI everytime after changing channel/BW/band */ -+ phydm_nbi_enable(dm, FUNC_DISABLE); -+ -+ /* 5G Channel Setting > 20M: 153; 40M: 151; 80M: 155 */ -+ switch (*dm->channel) { -+ case 153: -+ idx = 0; -+ break; -+ case 151: -+ idx = 1; -+ break; -+ case 155: -+ idx = 2; -+ break; -+ default: -+ idx = 16; -+ break; -+ } -+ -+ if (idx > 13) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "Not support dym spur det\n"); -+ return; -+ } -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s] idx = %d, BW = %d, Channel = %d\n", -+ __func__, idx, *dm->band_width, *dm->channel); -+ -+ for (k = 0; k < FREQ_PT_5G_NUM_8821C; k++) { -+ freq_5g_n1[k] = freq_5g[k] - 1; -+ freq_5g_p1[k] = freq_5g[k] + 1; -+ } -+ -+ for (k = 0; k < PSD_SMP_NUM_8821C; k++) { -+ if (k == 0) -+ freq_pt_5g_final = freq_5g_n1[idx]; -+ else if (k == 1) -+ freq_pt_5g_final = freq_5g[idx]; -+ else if (k == 2) -+ freq_pt_5g_final = freq_5g_p1[idx]; -+ -+ odm_set_bb_reg(dm, R_0x910, 0x3ff, freq_pt_5g_final); -+ -+ for (j = 0; j < PSD_VAL_NUM_8821C; j++) { -+ /*stop TRX*/ -+ if (phydm_stop_ic_trx(dm, PHYDM_SET) == PHYDM_SET_FAIL) -+ return; -+ -+ ODM_delay_us(10); -+ -+ /*Stop 3-wires*/ -+ phydm_stop_3_wire(dm, PHYDM_SET); -+ -+ /* Start PSD */ -+ odm_set_bb_reg(dm, R_0x910, BIT(22), 0x1); -+ -+ ODM_delay_us(500); -+ -+ psd_set[j] = odm_get_bb_reg(dm, R_0xf44, 0xffffff); -+ psd_set[j] = psd_set[j] >> 5; -+ -+ /* turn off PSD */ -+ odm_set_bb_reg(dm, R_0x910, BIT(22), 0x0); -+ -+ /*Start 3-wires*/ -+ phydm_stop_3_wire(dm, PHYDM_REVERT); -+ -+ ODM_delay_us(10); -+ -+ phydm_stop_ic_trx(dm, PHYDM_REVERT); -+ -+ phydm_igi_toggle_8821c(dm); -+ } -+ -+ phydm_seq_sorting(dm, psd_set, rank_psd_index_in, -+ rank_psd_index_out, PSD_VAL_NUM_8821C); -+ max_ret_psd_2nd[k] = psd_set[0]; -+ } -+ -+ phydm_seq_sorting(dm, max_ret_psd_2nd, rank_sample_index_in, -+ rank_sample_index_out, PSD_SMP_NUM_8821C); -+ max_ret_psd_final = max_ret_psd_2nd[0]; -+ -+ if (max_ret_psd_final >= threshold_nbi) -+ s_donbi_a = true; -+ else -+ s_donbi_a = false; -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s] max_ret_psd_final = %d\n", -+ __func__, max_ret_psd_final); -+ -+ if (!s_donbi_a) -+ return; -+ -+ if (*dm->band_width == CHANNEL_WIDTH_20 && *dm->channel == 153) -+ phydm_nbi_setting(dm, FUNC_ENABLE, 153, 20, 5760, -+ PHYDM_DONT_CARE); -+ else if (*dm->band_width == CHANNEL_WIDTH_40 && *dm->channel == 151) -+ phydm_nbi_setting(dm, FUNC_ENABLE, 151, 40, 5760, -+ PHYDM_DONT_CARE); -+ else if (*dm->band_width == CHANNEL_WIDTH_80 && *dm->channel == 155) -+ phydm_nbi_setting(dm, FUNC_ENABLE, 155, 80, 5760, -+ PHYDM_DONT_CARE); -+ -+#endif /*PHYDM_SPUR_CANCELL_ENABLE_8821C == 1*/ -+} -+/* ======================================================================== */ -+ -+/* ======================================================================== */ -+/* These following functions can be used by driver*/ -+ -+__iram_odm_func__ -+u32 config_phydm_read_rf_reg_8821c(struct dm_struct *dm, enum rf_path path, -+ u32 reg_addr, u32 bit_mask) -+{ -+ u32 readback_value, direct_addr; -+ u32 offset_read_rf[2] = {0x2800, 0x2c00}; -+ -+ /* Error handling.*/ -+ if (path > RF_PATH_A) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: unsupported path (%d)\n", -+ __func__, path); -+ return INVALID_RF_DATA; -+ } -+ -+ /* Calculate offset */ -+ reg_addr &= 0xff; -+ direct_addr = offset_read_rf[path] + (reg_addr << 2); -+ -+ /* RF register only has 20bits */ -+ bit_mask &= RFREGOFFSETMASK; -+ -+ /* Read RF register directly */ -+ readback_value = odm_get_bb_reg(dm, direct_addr, bit_mask); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: RF-%d 0x%x = 0x%x, bit mask = 0x%x\n", __func__, path, -+ reg_addr, readback_value, bit_mask); -+ return readback_value; -+} -+ -+__iram_odm_func__ -+boolean -+config_phydm_write_rf_reg_8821c(struct dm_struct *dm, enum rf_path path, -+ u32 reg_addr, u32 bit_mask, u32 data) -+{ -+ u32 data_and_addr = 0, data_original = 0; -+ u32 offset_write_rf[2] = {0xc90, 0xe90}; -+ u8 bit_shift; -+ -+ /* Error handling.*/ -+ if (path > RF_PATH_A) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: unsupported path (%d)\n", -+ __func__, path); -+ return false; -+ } -+ -+ /* Read RF register content first */ -+ reg_addr &= 0xff; -+ bit_mask = bit_mask & RFREGOFFSETMASK; -+ -+ if (bit_mask != RFREGOFFSETMASK) { -+ data_original = config_phydm_read_rf_reg_8821c(dm, path, reg_addr, RFREGOFFSETMASK); -+ -+ /* Error handling. RF is disabled */ -+ if (config_phydm_read_rf_check_8821c(data_original) == false) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Write fail, RF is disable\n", -+ __func__); -+ return false; -+ } -+ -+ /* check bit mask */ -+ if (bit_mask != 0xfffff) { -+ for (bit_shift = 0; bit_shift <= 19; bit_shift++) { -+ if (((bit_mask >> bit_shift) & 0x1) == 1) -+ break; -+ } -+ data = ((data_original) & (~bit_mask)) | (data << bit_shift); -+ } -+ } -+ -+ /* Put write addr in [27:20] and write data in [19:00] */ -+ data_and_addr = ((reg_addr << 20) | (data & 0x000fffff)) & 0x0fffffff; -+ -+ /* Write operation */ -+ odm_set_bb_reg(dm, offset_write_rf[path], MASKDWORD, data_and_addr); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: RF-%d 0x%x = 0x%x (original: 0x%x), bit mask = 0x%x\n", -+ __func__, path, reg_addr, data, data_original, bit_mask); -+ -+#if (defined(CONFIG_RUN_IN_DRV)) -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ ODM_delay_us(13); -+#elif (defined(CONFIG_RUN_IN_FW)) -+ ODM_delay_us(13); -+#endif -+ -+ return true; -+} -+ -+__iram_odm_func__ -+boolean -+config_phydm_write_txagc_8821c(struct dm_struct *dm, u32 power_index, -+ enum rf_path path, u8 hw_rate) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u32 offset_txagc[2] = {0x1d00, 0x1d80}; -+ u8 rate_idx = (hw_rate & 0xfc); -+ -+ /* Input need to be HW rate index, not driver rate index!!!! */ -+ -+ if (dm->is_disable_phy_api) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: disable PHY API for debug!!\n", __func__); -+ return true; -+ } -+ -+ /* Error handling */ -+ if (path > RF_PATH_A || hw_rate > 0x53) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: unsupported path (%d)\n", -+ __func__, path); -+ return false; -+ } -+ -+ /* driver need to construct a 4-byte power index */ -+ odm_set_bb_reg(dm, (offset_txagc[path] + rate_idx), MASKDWORD, power_index); -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: path-%d rate index 0x%x (0x%x) = 0x%x\n", __func__, -+ path, hw_rate, (offset_txagc[path] + hw_rate), power_index); -+ return true; -+#else -+ return false; -+#endif -+} -+ -+__iram_odm_func__ -+u8 config_phydm_read_txagc_8821c(struct dm_struct *dm, enum rf_path path, -+ u8 hw_rate) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u8 read_back_data; -+ -+ /* Input need to be HW rate index, not driver rate index!!!! */ -+ -+ /* Error handling */ -+ if (path > RF_PATH_A || hw_rate > 0x53) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: unsupported path (%d)\n", -+ __func__, path); -+ return INVALID_TXAGC_DATA; -+ } -+ -+ /* Disable TX AGC report */ -+ odm_set_bb_reg(dm, R_0x1998, BIT(16), 0x0); /* need to check */ -+ -+ /* Set data rate index (bit0~6) and path index (bit7) */ -+ odm_set_bb_reg(dm, R_0x1998, MASKBYTE0, (hw_rate | (path << 7))); -+ -+ /* Enable TXAGC report */ -+ odm_set_bb_reg(dm, R_0x1998, BIT(16), 0x1); -+ -+ /* Read TX AGC report */ -+ read_back_data = (u8)odm_get_bb_reg(dm, R_0xd30, 0x7f0000); -+ -+ /* Driver have to disable TXAGC report after reading TXAGC (ref. user guide v11) */ -+ odm_set_bb_reg(dm, R_0x1998, BIT(16), 0x0); -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: path-%d rate index 0x%x = 0x%x\n", -+ __func__, path, hw_rate, read_back_data); -+ return read_back_data; -+#else -+ return 0; -+#endif -+} -+ -+__iram_odm_func__ -+boolean -+config_phydm_switch_band_8821c(struct dm_struct *dm, u8 central_ch) -+{ -+ u32 rf_reg18; -+ boolean rf_reg_status = true; -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]======================>\n", -+ __func__); -+ -+ if (dm->is_disable_phy_api) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: disable PHY API for debug!!\n", __func__); -+ return true; -+ } -+ -+ rf_reg18 = config_phydm_read_rf_reg_8821c(dm, RF_PATH_A, 0x18, RFREGOFFSETMASK); -+ rf_reg_status = rf_reg_status & config_phydm_read_rf_check_8821c(rf_reg18); -+ -+ if (central_ch <= 14) { -+ /* 2.4G */ -+ -+ /* Enable CCK block */ -+ odm_set_bb_reg(dm, R_0x808, BIT(28), 0x1); -+ -+ /* Disable MAC CCK check */ -+ odm_set_bb_reg(dm, R_0x454, BIT(7), 0x0); -+ -+ /* Disable BB CCK check */ -+ odm_set_bb_reg(dm, R_0xa80, BIT(18), 0x0); -+ -+ /*CCA Mask*/ -+ odm_set_bb_reg(dm, R_0x814, 0x0000FC00, 15); /*default value*/ -+ -+ /* RF band */ -+ rf_reg18 = (rf_reg18 & (~(BIT(16) | BIT(9) | BIT(8)))); -+ rf_reg18 = (rf_reg18 & (~(MASKBYTE0))); -+ rf_reg18 = (rf_reg18 | central_ch); -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ /* Switch WLG/BTG*/ -+ if (dm->default_rf_set_8821c == SWITCH_TO_BTG) -+ config_phydm_switch_rf_set_8821c(dm, SWITCH_TO_BTG); -+ else if (dm->default_rf_set_8821c == SWITCH_TO_WLG) -+ config_phydm_switch_rf_set_8821c(dm, SWITCH_TO_WLG); -+#endif -+ /*RF TXA_TANK LUT mode*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, BIT(6), 0x1); -+ -+ /*RF TXA_PA_TANK*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x64, 0x0000f, 0xf); -+ -+ } else if (central_ch > 35) { -+ /* 5G */ -+ -+ /* Enable BB CCK check */ -+ odm_set_bb_reg(dm, R_0xa80, BIT(18), 0x1); -+ -+ /* Enable CCK check */ -+ odm_set_bb_reg(dm, R_0x454, BIT(7), 0x1); -+ -+ /* Disable CCK block */ -+ odm_set_bb_reg(dm, R_0x808, BIT(28), 0x0); -+ -+ /*CCA Mask*/ -+ odm_set_bb_reg(dm, R_0x814, 0x0000FC00, 15); /*default value*/ -+ /*odm_set_bb_reg(dm, R_0x814, 0x0000FC00, 34); CCA mask = 13.6us*/ -+ -+ /* RF band */ -+ rf_reg18 = (rf_reg18 & (~(BIT(16) | BIT(9) | BIT(8)))); -+ rf_reg18 = (rf_reg18 | BIT(8) | BIT(16)); -+ rf_reg18 = (rf_reg18 & (~(MASKBYTE0))); -+ rf_reg18 = (rf_reg18 | central_ch); -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ /* Switch WLA */ -+ config_phydm_switch_rf_set_8821c(dm, SWITCH_TO_WLA); -+#endif -+ /*RF TXA_TANK LUT mode*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, BIT(6), 0x0); -+ -+ } else { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Fail to switch band (ch: %d)\n", __func__, -+ central_ch); -+ return false; -+ } -+ -+ phydm_stop_ic_trx(dm, PHYDM_SET); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, RFREGOFFSETMASK, rf_reg18); -+ phydm_stop_ic_trx(dm, PHYDM_REVERT); -+ -+ if (phydm_rfe_8821c(dm, central_ch) == false) -+ return false; -+ -+ if (!rf_reg_status) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Fail to switch band (ch: %d), because writing RF register is fail\n", -+ __func__, central_ch); -+ return false; -+ } -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: Success to switch band (ch: %d)\n", -+ __func__, central_ch); -+ return true; -+} -+ -+__iram_odm_func__ -+boolean -+config_phydm_switch_channel_8821c(struct dm_struct *dm, u8 central_ch) -+{ -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u32 rf_reg18, rf_reg_b8 = 0; -+ boolean rf_reg_status = true; -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]====================>\n", __func__); -+ -+ if (dm->is_disable_phy_api) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: disable PHY API for debug!!\n", __func__); -+ return true; -+ } -+ -+ central_ch_8821c = central_ch; -+ rf_reg18 = config_phydm_read_rf_reg_8821c(dm, RF_PATH_A, 0x18, RFREGOFFSETMASK); -+ rf_reg_status = rf_reg_status & config_phydm_read_rf_check_8821c(rf_reg18); -+ -+ if (dm->cut_version == ODM_CUT_A) { -+ rf_reg_b8 = config_phydm_read_rf_reg_8821c(dm, RF_PATH_A, 0xb8, RFREGOFFSETMASK); -+ rf_reg_status = rf_reg_status & config_phydm_read_rf_check_8821c(rf_reg_b8); -+ } -+ -+ /* Switch band and channel */ -+ if (central_ch <= 14) { -+ /* 2.4G */ -+ -+ /* 1. RF band and channel*/ -+ rf_reg18 = (rf_reg18 & (~(BIT(18) | BIT(17) | MASKBYTE0))); -+ rf_reg18 = (rf_reg18 | central_ch); -+ -+ /* 2. AGC table selection */ -+ odm_set_bb_reg(dm, R_0xc1c, 0x00000F00, 0x0); -+ dig_t->agc_table_idx = 0x0; -+ -+ /* 3. Set central frequency for clock offset tracking */ -+ odm_set_bb_reg(dm, R_0x860, 0x1ffe0000, 0x96a); -+ -+ /* Fix A-cut LCK fail issue @ 5285MHz~5375MHz, 0xb8[19]=0x0 */ -+ if (dm->cut_version == ODM_CUT_A) -+ rf_reg_b8 = rf_reg_b8 | BIT(19); -+ -+ /* CCK TX filter parameters */ -+ if (central_ch == 14) { -+ odm_set_bb_reg(dm, R_0xa24, MASKDWORD, 0x0000b81c); -+ odm_set_bb_reg(dm, R_0xa28, MASKLWORD, 0x0000); -+ odm_set_bb_reg(dm, R_0xaac, MASKDWORD, 0x00003667); -+ } else { -+ odm_set_bb_reg(dm, R_0xa24, MASKDWORD, rega24_8821c); -+ odm_set_bb_reg(dm, R_0xa28, MASKLWORD, (rega28_8821c & MASKLWORD)); -+ odm_set_bb_reg(dm, R_0xaac, MASKDWORD, regaac_8821c); -+ } -+ -+ } else if (central_ch > 35) { -+ /* 5G */ -+ -+ /* 1. RF band and channel*/ -+ rf_reg18 = (rf_reg18 & (~(BIT(18) | BIT(17) | MASKBYTE0))); -+ rf_reg18 = (rf_reg18 | central_ch); -+ -+ if (central_ch >= 36 && central_ch <= 64) { -+ ; -+ } else if ((central_ch >= 100) && (central_ch <= 140)) { -+ rf_reg18 = (rf_reg18 | BIT(17)); -+ } else if (central_ch > 140) { -+ rf_reg18 = (rf_reg18 | BIT(18)); -+ } else { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Fail to switch channel (RF18) (ch: %d)\n", -+ __func__, central_ch); -+ return false; -+ } -+ -+ /* 2. AGC table selection */ -+ if (central_ch >= 36 && central_ch <= 64) { -+ odm_set_bb_reg(dm, R_0xc1c, 0x00000F00, 0x1); -+ dig_t->agc_table_idx = 0x1; -+ } else if ((central_ch >= 100) && (central_ch <= 144)) { -+ odm_set_bb_reg(dm, R_0xc1c, 0x00000F00, 0x2); -+ dig_t->agc_table_idx = 0x2; -+ } else if (central_ch >= 149) { -+ odm_set_bb_reg(dm, R_0xc1c, 0x00000F00, 0x3); -+ dig_t->agc_table_idx = 0x3; -+ } else { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Fail to switch channel (AGC) (ch: %d)\n", -+ __func__, central_ch); -+ return false; -+ } -+ -+ /* 3. Set central frequency for clock offset tracking */ -+ if (central_ch >= 36 && central_ch <= 48) { -+ odm_set_bb_reg(dm, R_0x860, 0x1ffe0000, 0x494); -+ } else if ((central_ch >= 52) && (central_ch <= 64)) { -+ odm_set_bb_reg(dm, R_0x860, 0x1ffe0000, 0x453); -+ } else if ((central_ch >= 100) && (central_ch <= 116)) { -+ odm_set_bb_reg(dm, R_0x860, 0x1ffe0000, 0x452); -+ } else if ((central_ch >= 118) && (central_ch <= 177)) { -+ odm_set_bb_reg(dm, R_0x860, 0x1ffe0000, 0x412); -+ } else { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Fail to switch channel (fc_area) (ch: %d)\n", -+ __func__, central_ch); -+ return false; -+ } -+ -+ /* Fix A-cut LCK fail issue @ 5285MHz~5375MHz, 0xb8[19]=0x0 */ -+ if (dm->cut_version == ODM_CUT_A) { -+ if (central_ch >= 57 && central_ch <= 75) -+ rf_reg_b8 = rf_reg_b8 & (~BIT(19)); -+ else -+ rf_reg_b8 = rf_reg_b8 | BIT(19); -+ } -+ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ /*notch 5760 spur by CSI_MASK*/ -+ if (central_ch == 153) -+ phydm_csi_mask_setting(dm, FUNC_ENABLE, (u32)central_ch, 20, 5760, PHYDM_DONT_CARE); -+ else if (central_ch == 151) -+ phydm_csi_mask_setting(dm, FUNC_ENABLE, (u32)central_ch, 40, 5760, PHYDM_DONT_CARE); -+ else if (central_ch == 155) -+ phydm_csi_mask_setting(dm, FUNC_ENABLE, (u32)central_ch, 80, 5760, PHYDM_DONT_CARE); -+ else -+ phydm_csi_mask_setting(dm, FUNC_DISABLE, (u32)central_ch, 80, 5760, PHYDM_DONT_CARE); -+#endif -+ -+ } else { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Fail to switch band (ch: %d)\n", __func__, -+ central_ch); -+ return false; -+ } -+ -+ phydm_stop_ic_trx(dm, PHYDM_SET); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, RFREGOFFSETMASK, rf_reg18); -+ phydm_stop_ic_trx(dm, PHYDM_REVERT); -+ -+ if (dm->cut_version == ODM_CUT_A) -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xb8, RFREGOFFSETMASK, rf_reg_b8); -+ -+ if (!rf_reg_status) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Fail to switch channel (ch: %d), because writing RF register is fail\n", -+ __func__, central_ch); -+ return false; -+ } -+ -+ /* Dynamic spur detection by PSD and NBI mask */ -+ if (*dm->mp_mode) -+ phydm_dynamic_spur_det_eliminate_8821c(dm); -+ -+ phydm_ccapar_8821c(dm); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Success to switch channel (ch: %d)\n", __func__, -+ central_ch); -+ return true; -+} -+ -+__iram_odm_func__ -+boolean -+config_phydm_switch_bandwidth_8821c(struct dm_struct *dm, u8 primary_ch_idx, -+ enum channel_width bandwidth) -+{ -+ struct phydm_api_stuc *api = &dm->api_table; -+ u32 rf_reg18; -+ boolean rf_reg_status = true; -+ u32 bb_reg8ac; -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]===================>\n", __func__); -+ -+ if (dm->is_disable_phy_api) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: disable PHY API for debug!!\n", __func__); -+ return true; -+ } -+ -+ /* Error handling */ -+ if (bandwidth >= CHANNEL_WIDTH_MAX || (bandwidth == CHANNEL_WIDTH_40 && primary_ch_idx > 2) || (bandwidth == CHANNEL_WIDTH_80 && primary_ch_idx > 4)) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Fail to switch bandwidth (bw: %d, primary ch: %d)\n", -+ __func__, bandwidth, primary_ch_idx); -+ return false; -+ } -+ /*Make protection*/ -+ if (central_ch_8821c == 165 && !(*dm->mp_mode)) -+ bandwidth = CHANNEL_WIDTH_20; -+ -+ bw_8821c = bandwidth; -+ api->pri_ch_idx = primary_ch_idx; -+ rf_reg18 = config_phydm_read_rf_reg_8821c(dm, RF_PATH_A, 0x18, RFREGOFFSETMASK); -+ rf_reg_status = rf_reg_status & config_phydm_read_rf_check_8821c(rf_reg18); -+ -+ /* Switch bandwidth */ -+ switch (bandwidth) { -+ case CHANNEL_WIDTH_20: { -+/* Small BW([7:6]) = 0, primary channel ([5:2]) = 0, rf mode([1:0]) = 20M */ -+#if 0 -+ odm_set_bb_reg(dm, R_0x8ac, MASKBYTE0, CHANNEL_WIDTH_20); -+ -+ /* ADC clock = 160M clock for BW20 */ -+ odm_set_bb_reg(dm, R_0x8ac, (BIT(9) | BIT(8)), 0x0); -+ odm_set_bb_reg(dm, R_0x8ac, BIT(16), 0x1); -+ -+ /* DAC clock = 160M clock for BW20 */ -+ odm_set_bb_reg(dm, R_0x8ac, (BIT(21) | BIT(20)), 0x0); -+ odm_set_bb_reg(dm, R_0x8ac, BIT(28), 0x1); -+#endif -+ bb_reg8ac = odm_get_bb_reg(dm, R_0x8ac, MASKDWORD); -+ bb_reg8ac &= 0xffcffc00; -+ bb_reg8ac |= 0x10010000; -+ odm_set_bb_reg(dm, R_0x8ac, MASKDWORD, bb_reg8ac); -+ -+ /* ADC buffer clock */ -+ odm_set_bb_reg(dm, R_0x8c4, BIT(30), 0x1); -+ -+ /* RF bandwidth */ -+ rf_reg18 = (rf_reg18 | BIT(11) | BIT(10)); -+ -+ break; -+ } -+ case CHANNEL_WIDTH_40: { -+ /* Small BW([7:6]) = 0, primary channel ([5:2]) = sub-channel, rf mode([1:0]) = 40M */ -+ /*odm_set_bb_reg(dm, R_0x8ac, MASKBYTE0, (((primary_ch_idx & 0xf) << 2) | CHANNEL_WIDTH_40));*/ -+ -+ /* CCK primary channel */ -+ if (primary_ch_idx == 1) -+ odm_set_bb_reg(dm, R_0xa00, BIT(4), primary_ch_idx); -+ else -+ odm_set_bb_reg(dm, R_0xa00, BIT(4), 0); -+#if 0 -+ /* ADC clock = 160M clock for BW40 */ -+ odm_set_bb_reg(dm, R_0x8ac, (BIT(11) | BIT(10)), 0x0); -+ odm_set_bb_reg(dm, R_0x8ac, BIT(17), 0x1); -+ -+ /* DAC clock = 160M clock for BW20 */ -+ odm_set_bb_reg(dm, R_0x8ac, (BIT(23) | BIT(22)), 0x0); -+ odm_set_bb_reg(dm, R_0x8ac, BIT(29), 0x1); -+#endif -+ bb_reg8ac = odm_get_bb_reg(dm, R_0x8ac, MASKDWORD); -+ bb_reg8ac &= 0xff3ff300; -+ bb_reg8ac |= 0x20020000 | ((primary_ch_idx & 0xf) << 2) | CHANNEL_WIDTH_40; -+ odm_set_bb_reg(dm, R_0x8ac, MASKDWORD, bb_reg8ac); -+ -+ /* ADC buffer clock */ -+ odm_set_bb_reg(dm, R_0x8c4, BIT(30), 0x1); -+ -+ /* RF bandwidth */ -+ rf_reg18 = (rf_reg18 & (~(BIT(11) | BIT(10)))); -+ rf_reg18 = (rf_reg18 | BIT(11)); -+ -+ break; -+ } -+ case CHANNEL_WIDTH_80: { -+/* Small BW([7:6]) = 0, primary channel ([5:2]) = sub-channel, rf mode([1:0]) = 80M */ -+#if 0 -+ odm_set_bb_reg(dm, R_0x8ac, MASKBYTE0, (((primary_ch_idx & 0xf) << 2) | CHANNEL_WIDTH_80)); -+ -+ /* ADC clock = 160M clock for BW80 */ -+ odm_set_bb_reg(dm, R_0x8ac, (BIT(13) | BIT(12)), 0x0); -+ odm_set_bb_reg(dm, R_0x8ac, BIT(18), 0x1); -+ -+ /* DAC clock = 160M clock for BW20 */ -+ odm_set_bb_reg(dm, R_0x8ac, (BIT(25) | BIT(24)), 0x0); -+ odm_set_bb_reg(dm, R_0x8ac, BIT(30), 0x1); -+#endif -+ bb_reg8ac = odm_get_bb_reg(dm, R_0x8ac, MASKDWORD); -+ bb_reg8ac &= 0xfcffcf00; -+ bb_reg8ac |= 0x40040000 | ((primary_ch_idx & 0xf) << 2) | CHANNEL_WIDTH_80; -+ odm_set_bb_reg(dm, R_0x8ac, MASKDWORD, bb_reg8ac); -+ -+ /* ADC buffer clock */ -+ odm_set_bb_reg(dm, R_0x8c4, BIT(30), 0x1); -+ -+ /* RF bandwidth */ -+ rf_reg18 = (rf_reg18 & (~(BIT(11) | BIT(10)))); -+ rf_reg18 = (rf_reg18 | BIT(10)); -+ -+ break; -+ } -+ case CHANNEL_WIDTH_5: { -+/* Small BW([7:6]) = 1, primary channel ([5:2]) = 0, rf mode([1:0]) = 20M */ -+#if 0 -+ odm_set_bb_reg(dm, R_0x8ac, MASKBYTE0, (BIT(6) | CHANNEL_WIDTH_20)); -+ -+ /* ADC clock = 40M clock */ -+ odm_set_bb_reg(dm, R_0x8ac, (BIT(9) | BIT(8)), 0x2); -+ odm_set_bb_reg(dm, R_0x8ac, BIT(16), 0x0); -+ -+ /* DAC clock = 160M clock for BW20 */ -+ odm_set_bb_reg(dm, R_0x8ac, (BIT(21) | BIT(20)), 0x2); -+ odm_set_bb_reg(dm, R_0x8ac, BIT(28), 0x0); -+#endif -+ bb_reg8ac = odm_get_bb_reg(dm, R_0x8ac, MASKDWORD); -+ bb_reg8ac &= 0xefcefc00; -+ bb_reg8ac |= (0x2 << 20) | (0x2 << 8) | BIT(6); -+ odm_set_bb_reg(dm, R_0x8ac, MASKDWORD, bb_reg8ac); -+ -+ /* ADC buffer clock */ -+ odm_set_bb_reg(dm, R_0x8c4, BIT(30), 0x0); -+ odm_set_bb_reg(dm, R_0x8c8, BIT(31), 0x1); -+ -+ /* RF bandwidth */ -+ rf_reg18 = (rf_reg18 | BIT(11) | BIT(10)); -+ -+ break; -+ } -+ case CHANNEL_WIDTH_10: { -+/* Small BW([7:6]) = 1, primary channel ([5:2]) = 0, rf mode([1:0]) = 20M */ -+#if 0 -+ odm_set_bb_reg(dm, R_0x8ac, MASKBYTE0, (BIT(7) | CHANNEL_WIDTH_20)); -+ -+ /* ADC clock = 80M clock */ -+ odm_set_bb_reg(dm, R_0x8ac, (BIT(9) | BIT(8)), 0x3); -+ odm_set_bb_reg(dm, R_0x8ac, BIT(16), 0x0); -+ -+ /* DAC clock = 160M clock for BW20 */ -+ odm_set_bb_reg(dm, R_0x8ac, (BIT(21) | BIT(20)), 0x3); -+ odm_set_bb_reg(dm, R_0x8ac, BIT(28), 0x0); -+#endif -+ bb_reg8ac = odm_get_bb_reg(dm, R_0x8ac, MASKDWORD); -+ bb_reg8ac &= 0xefcefc00; -+ bb_reg8ac |= (0x3 << 20) | (0x3 << 8) | BIT(7); -+ odm_set_bb_reg(dm, R_0x8ac, MASKDWORD, bb_reg8ac); -+ -+ /* ADC buffer clock */ -+ odm_set_bb_reg(dm, R_0x8c4, BIT(30), 0x0); -+ odm_set_bb_reg(dm, R_0x8c8, BIT(31), 0x1); -+ -+ /* RF bandwidth */ -+ rf_reg18 = (rf_reg18 | BIT(11) | BIT(10)); -+ -+ break; -+ } -+ default: -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Fail to switch bandwidth (bw: %d, primary ch: %d)\n", -+ __func__, bandwidth, primary_ch_idx); -+ } -+ -+ /* Write RF register */ -+ phydm_stop_ic_trx(dm, PHYDM_SET); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, RFREGOFFSETMASK, rf_reg18); -+ phydm_stop_ic_trx(dm, PHYDM_REVERT); -+ -+ if (!rf_reg_status) { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Fail to switch bandwidth (bw: %d, primary ch: %d), because writing RF register is fail\n", -+ __func__, bandwidth, primary_ch_idx); -+ return false; -+ } -+ -+ /* Modify RX DFIR parameters */ -+ phydm_rxdfirpar_by_bw_8821c(dm, bandwidth); -+ -+ /* Modify CCA parameters */ -+ phydm_ccapar_by_bw_8821c(dm, bandwidth); -+ phydm_ccapar_8821c(dm); -+ -+ /* Toggle RX path to avoid RX dead zone issue */ -+ /*odm_set_bb_reg(dm, R_0x808, MASKBYTE0, 0x0);*/ -+ /*odm_set_bb_reg(dm, R_0x808, MASKBYTE0, 0x11);*/ -+ -+ /* Dynamic spur detection by PSD and NBI mask */ -+ if (*dm->mp_mode) -+ phydm_dynamic_spur_det_eliminate_8821c(dm); -+ -+ /*fix bw setting*/ -+ #ifdef CONFIG_BW_INDICATION -+ if (!(*dm->mp_mode)) -+ phydm_bw_fixed_setting(dm); -+ #endif -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Success to switch bandwidth (bw: %d, primary ch: %d)\n", -+ __func__, bandwidth, primary_ch_idx); -+ return true; -+} -+ -+__iram_odm_func__ -+boolean -+config_phydm_switch_channel_bw_8821c(struct dm_struct *dm, u8 central_ch, -+ u8 primary_ch_idx, -+ enum channel_width bandwidth) -+{ -+ /* Switch band */ -+ if (config_phydm_switch_band_8821c(dm, central_ch) == false) -+ return false; -+ -+ /* Switch channel */ -+ if (config_phydm_switch_channel_8821c(dm, central_ch) == false) -+ return false; -+ -+ /* Switch bandwidth */ -+ if (config_phydm_switch_bandwidth_8821c(dm, primary_ch_idx, bandwidth) == false) -+ return false; -+ -+ return true; -+} -+ -+__iram_odm_func__ -+boolean -+config_phydm_trx_mode_8821c(struct dm_struct *dm, enum bb_path tx_path, -+ enum bb_path rx_path, boolean is_tx2_path) -+{ -+ return true; -+} -+ -+__iram_odm_func__ -+boolean -+config_phydm_parameter_init_8821c(struct dm_struct *dm, -+ enum odm_parameter_init type) -+{ -+ if (type == ODM_PRE_SETTING) { -+ odm_set_bb_reg(dm, R_0x808, (BIT(28) | BIT(29)), 0x0); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Pre setting: disable OFDM and CCK block\n", -+ __func__); -+ } else if (type == ODM_POST_SETTING) { -+ odm_set_bb_reg(dm, R_0x808, (BIT(28) | BIT(29)), 0x3); -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, -+ "[%s]: Post setting: enable OFDM and CCK block\n", -+ __func__); -+ rega24_8821c = odm_get_bb_reg(dm, R_0xa24, MASKDWORD); -+ rega28_8821c = odm_get_bb_reg(dm, R_0xa28, MASKDWORD); -+ regaac_8821c = odm_get_bb_reg(dm, R_0xaac, MASKDWORD); -+ } else { -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: Wrong type!!\n", __func__); -+ return false; -+ } -+ -+ return true; -+} -+ -+__iram_odm_func__ -+void config_phydm_switch_rf_set_8821c(struct dm_struct *dm, u8 rf_set) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter = dm->adapter; -+ PMGNT_INFO mgnt_info = &(((PADAPTER)(adapter))->MgntInfo); -+#endif -+ -+ u32 bb_reg32; -+ -+ odm_set_bb_reg(dm, R_0x1080, BIT(16), 0x1); -+ odm_set_bb_reg(dm, R_0x00, BIT(26), 0x1); -+ /*odm_set_mac_reg(dm, R_0x70, BIT(26), 0x1);*/ -+ /*odm_set_mac_reg(dm, R_0x1704, MASKLWORD, 0x4000);*/ -+ /*odm_set_mac_reg(dm, R_0x1700, (BIT(31) | BIT(30)), 0x3); */ -+ -+ bb_reg32 = odm_get_bb_reg(dm, R_0xcb8, MASKDWORD); -+ switch (rf_set) { -+ case SWITCH_TO_BTG: -+ -+ dm->current_rf_set_8821c = SWITCH_TO_BTG; -+ -+ bb_reg32 = (bb_reg32 | BIT(16)); -+ bb_reg32 &= (~(BIT(18) | BIT(20) | BIT(21) | BIT(22) | BIT(23))); -+ odm_set_bb_reg(dm, R_0xa84, MASKBYTE2, 0xe); -+ odm_set_bb_reg(dm, R_0xa80, MASKLWORD, 0xfc84); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*dm->mp_mode && mgnt_info->RegPHYParaFromFolder == 0) -+#else -+ if (*dm->mp_mode) -+#endif -+ { -+ odm_set_bb_reg(dm, R_0xaa8, 0x1f0000, 0x14); -+ odm_config_bb_with_header_file(dm, CONFIG_BB_AGC_TAB_DIFF); -+ /*Toggle initial gain twice for valid gain table*/ -+ odm_set_bb_reg(dm, ODM_REG(IGI_A, dm), ODM_BIT(IGI, dm), 0x22); -+ odm_set_bb_reg(dm, ODM_REG(IGI_A, dm), ODM_BIT(IGI, dm), 0x20); -+ } -+ break; -+ case SWITCH_TO_WLG: -+ -+ dm->current_rf_set_8821c = SWITCH_TO_WLG; -+ -+ bb_reg32 = (bb_reg32 | BIT(20) | BIT(21) | BIT(22)); -+ bb_reg32 &= (~(BIT(16) | BIT(18) | BIT(23))); -+ odm_set_bb_reg(dm, R_0xa84, MASKBYTE2, 0x12); -+ odm_set_bb_reg(dm, R_0xa80, MASKLWORD, 0x7532); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*dm->mp_mode && mgnt_info->RegPHYParaFromFolder == 0) -+#else -+ if (*dm->mp_mode) -+#endif -+ { -+ odm_set_bb_reg(dm, R_0xaa8, 0x1f0000, 0x13); -+ odm_config_bb_with_header_file(dm, CONFIG_BB_AGC_TAB_DIFF); -+ /*Toggle initial gain twice for valid gain table*/ -+ odm_set_bb_reg(dm, ODM_REG(IGI_A, dm), ODM_BIT(IGI, dm), 0x22); -+ odm_set_bb_reg(dm, ODM_REG(IGI_A, dm), ODM_BIT(IGI, dm), 0x20); -+ } -+ break; -+ case SWITCH_TO_WLA: -+ -+ dm->current_rf_set_8821c = SWITCH_TO_WLA; -+ -+ bb_reg32 = (bb_reg32 | BIT(20) | BIT(22) | BIT(23)); -+ bb_reg32 &= (~(BIT(16) | BIT(18) | BIT(21))); -+ -+ break; -+ case SWITCH_TO_BT: -+ -+ dm->current_rf_set_8821c = SWITCH_TO_BT; -+ -+ break; -+ default: -+ break; -+ } -+ -+ odm_set_bb_reg(dm, R_0xcb8, MASKDWORD, bb_reg32); -+#endif -+} -+ -+__iram_odm_func__ -+void config_phydm_set_ant_path(struct dm_struct *dm, u8 rf_set, u8 ant_num) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ boolean switch_polarity_inverse = false; -+ u8 regval_0xcb7 = 0; -+ -+ dm->current_ant_num_8821c = ant_num; -+ config_phydm_switch_rf_set_8821c(dm, rf_set); -+ -+ if (rf_set == SWITCH_TO_BT) -+ phydm_set_gnt_state_8821c(dm, false, true); /* GNT_WL=0, GNT_BT=1 for BT test */ -+ else -+ phydm_set_gnt_state_8821c(dm, true, false); /* GNT_WL=1, GNT_BT=0 for WL test */ -+ -+ /*switch does not exist*/ -+ if (dm->rfe_type_expand == 0x5 || dm->rfe_type_expand == 0x6 || -+ dm->rfe_type_expand == 0x25 || dm->rfe_type_expand == 0x26 || -+ dm->rfe_type_expand == 0x2a || dm->rfe_type_expand == 0x2d || -+ dm->rfe_type_expand == 0x2e) -+ return; -+ -+ if (dm->current_ant_num_8821c) /*Ant1 = 0, Ant2 = 1*/ -+ switch_polarity_inverse = !switch_polarity_inverse; -+ -+ if (rf_set == SWITCH_TO_WLG) -+ switch_polarity_inverse = !switch_polarity_inverse; -+ -+ /*set antenna control by WL 0xcb4[29:28]*/ -+ odm_set_bb_reg(dm, R_0x4c, BIT(24) | BIT(23), 0x2); -+ -+ /*set RFE_ctrl8 and RFE_ctrl9 as antenna control pins by software*/ -+ odm_set_bb_reg(dm, R_0xcb4, 0x000000ff, 0x77); -+ -+ /*0xcb4[29:28] = 2b'01 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0*/ -+ regval_0xcb7 = (!switch_polarity_inverse ? 0x1 : 0x2); -+ -+ odm_set_bb_reg(dm, R_0xcb4, 0x30000000, regval_0xcb7); -+#endif -+} -+ -+__iram_odm_func__ -+u32 query_phydm_trx_capability_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u32 value32 = 0x00000000; -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: trx_capability = 0x%x\n", __func__, -+ value32); -+ return value32; -+#else -+ return 0; -+#endif -+} -+ -+__iram_odm_func__ -+u32 query_phydm_stbc_capability_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u32 value32 = 0x00010001; -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: stbc_capability = 0x%x\n", -+ __func__, value32); -+ return value32; -+#else -+ return 0; -+#endif -+} -+ -+__iram_odm_func__ -+u32 query_phydm_ldpc_capability_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u32 value32 = 0x01000100; -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: ldpc_capability = 0x%x\n", -+ __func__, value32); -+ return value32; -+#else -+ return 0; -+#endif -+} -+ -+__iram_odm_func__ -+u32 query_phydm_txbf_parameters_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u32 value32 = 0x00030003; -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: txbf_parameters = 0x%x\n", -+ __func__, value32); -+ return value32; -+#else -+ return 0; -+#endif -+} -+ -+__iram_odm_func__ -+u32 query_phydm_txbf_capability_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u32 value32 = 0x01010001; -+ -+ PHYDM_DBG(dm, ODM_PHY_CONFIG, "[%s]: txbf_capability = 0x%x\n", -+ __func__, value32); -+ return value32; -+#else -+ return 0; -+#endif -+} -+ -+__iram_odm_func__ -+u8 query_phydm_default_rf_set_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ return dm->default_rf_set_8821c; -+#else -+ return 0; -+#endif -+} -+ -+__iram_odm_func__ -+u8 query_phydm_current_rf_set_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ return dm->current_rf_set_8821c; -+#else -+ return 0; -+#endif -+} -+ -+__iram_odm_func__ -+u8 query_phydm_rfetype_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ return dm->rfe_type_expand; -+#else -+ return 0; -+#endif -+} -+ -+__iram_odm_func__ -+u8 query_phydm_current_ant_num_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u32 regval_0xcb4 = odm_get_bb_reg(dm, R_0xcb4, BIT(29) | BIT(28)); -+ -+ if (dm->current_rf_set_8821c == SWITCH_TO_BTG || dm->current_rf_set_8821c == SWITCH_TO_WLA || dm->current_rf_set_8821c == SWITCH_TO_BT) { -+ if (regval_0xcb4 == 1) -+ dm->current_ant_num_8821c = SWITCH_TO_ANT1; -+ else if (regval_0xcb4 == 2) -+ dm->current_ant_num_8821c = SWITCH_TO_ANT2; -+ else if (regval_0xcb4 == 1) -+ dm->current_ant_num_8821c = SWITCH_TO_ANT2; -+ else if (regval_0xcb4 == 2) -+ dm->current_ant_num_8821c = SWITCH_TO_ANT1; -+ } -+ -+ return dm->current_ant_num_8821c; -+#else -+ return 0; -+#endif -+} -+ -+__iram_odm_func__ -+u8 query_phydm_ant_num_map_8821c(struct dm_struct *dm) -+{ -+#if (PHYDM_FW_API_FUNC_ENABLE_8821C == 1) -+ u8 mapping_table = 0; -+ -+ /* mapping table meaning -+ * 1: choose ant1 or ant2 -+ * 2: only ant1 -+ * 3: only ant2 -+ * 4: cannot choose -+ */ -+ -+ if (dm->rfe_type_expand == 0 || dm->rfe_type_expand == 7 || dm->rfe_type_expand == 0x20 || -+ dm->rfe_type_expand == 0x27 || dm->rfe_type_expand == 0x28 || dm->rfe_type_expand == 0x2f) -+ mapping_table = 1; -+ else if (dm->rfe_type_expand == 1 || dm->rfe_type_expand == 2 || dm->rfe_type_expand == 0x21 || -+ dm->rfe_type_expand == 0x22 || dm->rfe_type_expand == 0x29 || dm->rfe_type_expand == 0x2a) -+ mapping_table = 2; -+ else if (dm->rfe_type_expand == 3 || dm->rfe_type_expand == 4 || dm->rfe_type_expand == 0x23 || -+ dm->rfe_type_expand == 0x24 || dm->rfe_type_expand == 0x2b || dm->rfe_type_expand == 0x2c) -+ mapping_table = 3; -+ else if (dm->rfe_type_expand == 5 || dm->rfe_type_expand == 6 || dm->rfe_type_expand == 0x25 || -+ dm->rfe_type_expand == 0x26 || dm->rfe_type_expand == 0x2d || dm->rfe_type_expand == 0x2e) -+ mapping_table = 4; -+ -+ return mapping_table; -+#else -+ return 0; -+#endif -+} -+ -+/* ======================================================================== */ -+#endif /*PHYDM_FW_API_ENABLE_8821C == 1*/ -+#endif /* RTL8821C_SUPPORT == 1 */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_hal_api8821c.h b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_hal_api8821c.h -new file mode 100644 -index 000000000..a4333f391 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_hal_api8821c.h -@@ -0,0 +1,129 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_PHYDM_API_H_8821C__ -+#define __INC_PHYDM_API_H_8821C__ -+ -+#if (RTL8821C_SUPPORT == 1) -+ -+#define PHY_CONFIG_VERSION_8821C "3.1.27" /*2017.08.08 (HW user guide version: R03, SW user guide version: R01, Modification: R27)*/ -+ -+#define INVALID_RF_DATA 0xffffffff -+#define INVALID_TXAGC_DATA 0xff -+ -+#define config_phydm_read_rf_check_8821c(data) (data != INVALID_RF_DATA) -+#define config_phydm_read_txagc_check_8821c(data) (data != INVALID_TXAGC_DATA) -+ -+#define PSD_VAL_NUM_8821C 5 -+#define PSD_SMP_NUM_8821C 3 -+#define FREQ_PT_5G_NUM_8821C 3 -+ -+enum rf_set_8821c { -+ SWITCH_TO_BTG = 0x0, -+ SWITCH_TO_WLG = 0x1, -+ SWITCH_TO_WLA = 0x2, -+ SWITCH_TO_BT = 0x3 -+}; -+ -+enum ant_num_8821c { -+ SWITCH_TO_ANT1 = 0x0, -+ SWITCH_TO_ANT2 = 0x1 -+}; -+ -+enum ant_num_map_8821c { -+ BOTH_AVAILABLE = 0x1, -+ ONLY_ANT1 = 0x2, -+ ONLY_ANT2 = 0x3, -+ DONT_CARE = 0x4 -+}; -+ -+s8 phydm_cck_rssi_8821c(struct dm_struct *dm, u8 lna_idx, u8 vga_idx); -+ -+u32 config_phydm_read_rf_reg_8821c(struct dm_struct *dm, enum rf_path path, -+ u32 reg_addr, u32 bit_mask); -+ -+boolean -+config_phydm_write_rf_reg_8821c(struct dm_struct *dm, enum rf_path path, -+ u32 reg_addr, u32 bit_mask, u32 data); -+ -+boolean -+config_phydm_write_txagc_8821c(struct dm_struct *dm, u32 power_index, -+ enum rf_path path, u8 hw_rate); -+ -+u8 config_phydm_read_txagc_8821c(struct dm_struct *dm, enum rf_path path, -+ u8 hw_rate); -+ -+boolean -+config_phydm_switch_band_8821c(struct dm_struct *dm, u8 central_ch); -+ -+boolean -+config_phydm_switch_channel_8821c(struct dm_struct *dm, u8 central_ch); -+ -+boolean -+config_phydm_switch_bandwidth_8821c(struct dm_struct *dm, u8 primary_ch_idx, -+ enum channel_width bandwidth); -+ -+boolean -+config_phydm_switch_channel_bw_8821c(struct dm_struct *dm, u8 central_ch, -+ u8 primary_ch_idx, -+ enum channel_width bandwidth); -+ -+boolean -+config_phydm_trx_mode_8821c(struct dm_struct *dm, enum bb_path tx_path, -+ enum bb_path rx_path, boolean is_tx2_path); -+ -+boolean -+config_phydm_parameter_init_8821c(struct dm_struct *dm, -+ enum odm_parameter_init type); -+ -+void config_phydm_switch_rf_set_8821c(struct dm_struct *dm, u8 rf_set); -+ -+void config_phydm_set_ant_path(struct dm_struct *dm, u8 rf_set, u8 ant_num); -+ -+/* ======================================================================== */ -+/* These following functions can be used for PHY DM only*/ -+ -+boolean -+phydm_write_txagc_1byte_8821c(struct dm_struct *dm, u32 power_index, -+ enum rf_path path, u8 hw_rate); -+ -+void phydm_init_hw_info_by_rfe_type_8821c(struct dm_struct *dm); -+ -+void phydm_set_gnt_state_8821c(struct dm_struct *dm, boolean gnt_wl_state, -+ boolean gnt_bt_state); -+ -+/* ======================================================================== */ -+ -+u32 query_phydm_trx_capability_8821c(struct dm_struct *dm); -+ -+u32 query_phydm_stbc_capability_8821c(struct dm_struct *dm); -+ -+u32 query_phydm_ldpc_capability_8821c(struct dm_struct *dm); -+ -+u32 query_phydm_txbf_parameters_8821c(struct dm_struct *dm); -+ -+u32 query_phydm_txbf_capability_8821c(struct dm_struct *dm); -+ -+u8 query_phydm_default_rf_set_8821c(struct dm_struct *dm); -+ -+u8 query_phydm_current_rf_set_8821c(struct dm_struct *dm); -+ -+u8 query_phydm_rfetype_8821c(struct dm_struct *dm); -+ -+u8 query_phydm_current_ant_num_8821c(struct dm_struct *dm); -+ -+u8 query_phydm_ant_num_map_8821c(struct dm_struct *dm); -+ -+#endif /* RTL8821C_SUPPORT == 1 */ -+#endif /* __INC_PHYDM_API_H_8821C__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_regconfig8821c.c b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_regconfig8821c.c -new file mode 100644 -index 000000000..c8a2d3c56 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_regconfig8821c.c -@@ -0,0 +1,262 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "../phydm_precomp.h" -+ -+#if (RTL8821C_SUPPORT == 1) -+ -+void odm_config_rf_reg_8821c(struct dm_struct *dm, u32 addr, u32 data, -+ enum rf_path rf_path, u32 reg_addr) -+{ -+ if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { -+ if (addr == 0xffe) { -+ phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_DELAY_MS, -+ reg_addr, -+ data, -+ RFREGOFFSETMASK, -+ rf_path, -+ 50); -+ } else if (addr == 0xfe) { -+ phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_DELAY_US, -+ reg_addr, -+ data, -+ RFREGOFFSETMASK, -+ rf_path, -+ 100); -+ } else { -+ phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_RF_W, -+ reg_addr, -+ data, -+ RFREGOFFSETMASK, -+ rf_path, -+ 0); -+ phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_DELAY_US, -+ reg_addr, -+ data, -+ RFREGOFFSETMASK, -+ rf_path, -+ 1); -+ } -+ } else { -+ if (addr == 0xffe) { -+#ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+#else -+ ODM_delay_ms(50); -+#endif -+ } else if (addr == 0xfe) { -+#ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_us(100); -+#else -+ ODM_delay_us(100); -+#endif -+ } else { -+ odm_set_rf_reg(dm, rf_path, reg_addr, RFREGOFFSETMASK, data); -+ -+ /* Add 1us delay between BB/RF register setting. */ -+ ODM_delay_us(1); -+ } -+ } -+} -+ -+void odm_config_rf_radio_a_8821c(struct dm_struct *dm, u32 addr, u32 data) -+{ -+ u32 content = 0x1000; /* RF_Content: radioa_txt */ -+ u32 maskfor_phy_set = (u32)(content & 0xE000); -+ -+ odm_config_rf_reg_8821c(dm, addr, data, RF_PATH_A, addr | maskfor_phy_set); -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "===> odm_config_rf_with_header_file: [RadioA] %08X %08X\n", -+ addr, data); -+} -+ -+void odm_config_mac_8821c(struct dm_struct *dm, u32 addr, u8 data) -+{ -+ if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) -+ phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_MAC_W8, -+ addr, -+ data, -+ 0, -+ (enum rf_path)0, -+ 0); -+ else -+ odm_write_1byte(dm, addr, data); -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> config_mac: [MAC_REG] %08X %08X\n", -+ addr, data); -+} -+ -+void odm_update_agc_big_jump_lmt_8821c(struct dm_struct *dm, u32 addr, u32 data) -+{ -+ struct phydm_dig_struct *dig_t = &dm->dm_dig_table; -+ u8 rf_gain_idx = (u8)((data & 0xFF000000) >> 24); -+ u8 bb_gain_idx = (u8)((data & 0x00ff0000) >> 16); -+ u8 agc_table_idx = (u8)((data & 0x00000f00) >> 8); -+ static boolean is_limit; -+ -+ if (addr != 0x81c) -+ return; -+ -+ /*dbg_print("data = 0x%x, rf_gain_idx = 0x%x, bb_gain_idx = 0x%x, agc_table_idx = 0x%x\n", data, rf_gain_idx, bb_gain_idx, agc_table_idx);*/ -+ /*dbg_print("rf_gain_idx = 0x%x, dig_t->rf_gain_idx = 0x%x\n", rf_gain_idx, dig_t->rf_gain_idx);*/ -+ -+ if (bb_gain_idx > 0x3c) { -+ if (rf_gain_idx == dig_t->rf_gain_idx && is_limit == false) { -+ is_limit = true; -+ dig_t->big_jump_lmt[agc_table_idx] = bb_gain_idx - 2; -+ PHYDM_DBG(dm, DBG_DIG, -+ "===> [AGC_TAB] big_jump_lmt [%d] = 0x%x\n", -+ agc_table_idx, -+ dig_t->big_jump_lmt[agc_table_idx]); -+ } -+ } else { -+ is_limit = false; -+ } -+ -+ dig_t->rf_gain_idx = rf_gain_idx; -+} -+ -+void odm_config_bb_agc_8821c(struct dm_struct *dm, u32 addr, u32 bitmask, -+ u32 data) -+{ -+ odm_update_agc_big_jump_lmt_8821c(dm, addr, data); -+ -+ if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) -+ phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_BB_W32, -+ addr, -+ data, -+ bitmask, -+ (enum rf_path)0, -+ 0); -+ else -+ odm_set_bb_reg(dm, addr, bitmask, data); -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> config_bb: [AGC_TAB] %08X %08X\n", -+ addr, data); -+} -+ -+void odm_config_bb_phy_reg_pg_8821c(struct dm_struct *dm, u32 band, u32 rf_path, -+ u32 tx_num, u32 addr, u32 bitmask, u32 data) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ phy_store_tx_power_by_rate(dm->adapter, band, rf_path, tx_num, addr, bitmask, data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PHY_StoreTxPowerByRate(dm->adapter, band, rf_path, tx_num, addr, bitmask, data); -+#endif -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, -+ "===> odm_config_bb_with_header_file: [PHY_REG] %08X %08X %08X\n", -+ addr, bitmask, data); -+} -+ -+void odm_config_bb_phy_8821c(struct dm_struct *dm, u32 addr, u32 bitmask, -+ u32 data) -+{ -+ if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { -+ u32 delay_time = 0; -+ -+ if (addr >= 0xf9 && addr <= 0xfe) { -+ if (addr == 0xfe || addr == 0xfb) -+ delay_time = 50; -+ else if (addr == 0xfd || addr == 0xfa) -+ delay_time = 5; -+ else -+ delay_time = 1; -+ -+ if (addr >= 0xfc && addr <= 0xfe) -+ phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_DELAY_MS, -+ addr, -+ data, -+ bitmask, -+ (enum rf_path)0, -+ delay_time); -+ else -+ phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_DELAY_US, -+ addr, -+ data, -+ bitmask, -+ (enum rf_path)0, -+ delay_time); -+ } else { -+ phydm_set_reg_by_fw(dm, -+ PHYDM_HALMAC_CMD_BB_W32, -+ addr, -+ data, -+ bitmask, -+ (enum rf_path)0, -+ 0); -+ } -+ } else { -+ 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_set_bb_reg(dm, addr, bitmask, data); -+ } -+ -+ PHYDM_DBG(dm, ODM_COMP_INIT, "===> config_bb: [PHY_REG] %08X %08X\n", -+ addr, data); -+} -+ -+void odm_config_bb_txpwr_lmt_8821c_ex(struct dm_struct *dm, u8 regulation, -+ u8 band, u8 bandwidth, u8 rate_section, -+ u8 rf_path, u8 channel, s8 power_limit) -+{ -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ phy_set_tx_power_limit_ex(dm, regulation, band, bandwidth, rate_section, -+ rf_path, channel, power_limit); -+#endif -+#if 0 -+ PHY_SetTxPowerLimit_ex(dm, regulation, band, bandwidth, rate_section, -+ rf_path, channel, power_limit); -+#endif -+} -+void odm_config_bb_txpwr_lmt_8821c(struct dm_struct *dm, u8 *regulation, -+ u8 *band, u8 *bandwidth, u8 *rate_section, -+ u8 *rf_path, u8 *channel, u8 *power_limit) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ phy_set_tx_power_limit(dm, regulation, band, -+ bandwidth, rate_section, rf_path, channel, power_limit); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PHY_SetTxPowerLimit(dm, regulation, band, -+ bandwidth, rate_section, rf_path, channel, power_limit); -+#endif -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_regconfig8821c.h b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_regconfig8821c.h -new file mode 100644 -index 000000000..0132ab2f0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_regconfig8821c.h -@@ -0,0 +1,54 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_8821C -+#define __INC_ODM_REGCONFIG_H_8821C -+ -+#if (RTL8821C_SUPPORT == 1) -+ -+void odm_config_rf_reg_8821c(struct dm_struct *dm, u32 addr, u32 data, -+ enum rf_path rf_path, u32 reg_addr); -+ -+void odm_config_rf_radio_a_8821c(struct dm_struct *dm, u32 addr, u32 data); -+ -+void odm_config_rf_radio_b_8821c( -+ struct dm_struct *dm, -+ u32 addr, -+ u32 data); -+ -+void odm_config_mac_8821c(struct dm_struct *dm, u32 addr, u8 data); -+ -+void odm_update_agc_big_jump_lmt_8821c(struct dm_struct *dm, u32 addr, -+ u32 data); -+ -+void odm_config_bb_agc_8821c(struct dm_struct *dm, u32 addr, u32 bitmask, -+ u32 data); -+ -+void odm_config_bb_phy_reg_pg_8821c(struct dm_struct *dm, u32 band, u32 rf_path, -+ u32 tx_num, u32 addr, u32 bitmask, -+ u32 data); -+ -+void odm_config_bb_phy_8821c(struct dm_struct *dm, u32 addr, u32 bitmask, -+ u32 data); -+ -+void odm_config_bb_txpwr_lmt_8821c_ex(struct dm_struct *dm, u8 regulation, -+ u8 band, u8 bandwidth, u8 rate_section, -+ u8 rf_path, u8 channel, s8 power_limit); -+ -+void odm_config_bb_txpwr_lmt_8821c(struct dm_struct *dm, u8 *regulation, -+ u8 *band, u8 *bandwidth, u8 *rate_section, -+ u8 *rf_path, u8 *channel, u8 *power_limit); -+ -+#endif -+#endif /* RTL8821C_SUPPORT == 1*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_rtl8821c.c b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_rtl8821c.c -new file mode 100644 -index 000000000..e5432c803 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_rtl8821c.c -@@ -0,0 +1,57 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8821C_SUPPORT) -+void phydm_dynamic_switch_htstf_agc_8821c(struct dm_struct *dm) -+{ -+ u16 ndp_valid_cnt = 0; -+ -+ if (dm->bhtstfdisabled) -+ return; -+ -+ /*This count will be reset every 2 seconds*/ -+ ndp_valid_cnt = (u16)odm_get_bb_reg(dm, R_0xf24, MASKLWORD); -+ -+ if (dm->total_tp == 0 || ndp_valid_cnt != 0) { -+ odm_set_bb_reg(dm, R_0x8d8, BIT(17), 0x1); -+ dm->no_ndp_cnts = 0; -+ } else { -+ dm->no_ndp_cnts++; -+ -+ if (dm->no_ndp_cnts == 3) { -+ odm_set_bb_reg(dm, R_0x8d8, BIT(17), 0x0); -+ dm->no_ndp_cnts = 0; -+ } -+ } -+ dm->ndp_cnt_pre = ndp_valid_cnt; -+} -+ -+void phydm_hwsetting_8821c(struct dm_struct *dm) -+{ -+ /*phydm_dynamic_switch_htstf_agc_8821c(dm);*/ -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_rtl8821c.h b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_rtl8821c.h -new file mode 100644 -index 000000000..3cb440fbc ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/phydm_rtl8821c.h -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#if (RTL8821C_SUPPORT) -+#ifndef __ODM_RTL8821C_H__ -+#define __ODM_RTL8821C_H__ -+ -+void phydm_hwsetting_8821c(struct dm_struct *dm); -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/version_rtl8821c.h b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/version_rtl8821c.h -new file mode 100644 -index 000000000..855334251 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/rtl8821c/version_rtl8821c.h -@@ -0,0 +1,34 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+/*RTL8821C PHY Parameters*/ -+/* -+[Caution] -+ Since 01/Aug/2015, the commit rules will be simplified. -+ You do not need to fill up the version.h anymore, -+ only the maintenance supervisor fills it before formal release. -+*/ -+#define RELEASE_DATE_8821C 20210727 -+#define COMMIT_BY_8821C "Kevin" -+#define RELEASE_VERSION_8821C 64 -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/sd4_phydm_2_kernel.mk b/drivers/net/wireless/rtl8821cs/hal/phydm/sd4_phydm_2_kernel.mk -new file mode 100644 -index 000000000..f11c6ac90 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/sd4_phydm_2_kernel.mk -@@ -0,0 +1,188 @@ -+EXTRA_CFLAGS += -I$(src)/hal/phydm -+ -+_PHYDM_FILES := hal/phydm/phydm_debug.o \ -+ hal/phydm/phydm_interface.o\ -+ hal/phydm/phydm_phystatus.o\ -+ hal/phydm/phydm_hwconfig.o\ -+ hal/phydm/phydm.o\ -+ hal/phydm/phydm_dig.o\ -+ hal/phydm/phydm_rainfo.o\ -+ hal/phydm/phydm_adaptivity.o\ -+ hal/phydm/phydm_cfotracking.o\ -+ hal/phydm/phydm_noisemonitor.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_ccx.o\ -+ hal/phydm/phydm_cck_pd.o\ -+ hal/phydm/phydm_rssi_monitor.o\ -+ hal/phydm/phydm_math_lib.o\ -+ hal/phydm/phydm_api.o\ -+ hal/phydm/halrf/halrf.o\ -+ hal/phydm/halrf/halrf_debug.o\ -+ hal/phydm/halrf/halphyrf_ce.o\ -+ hal/phydm/halrf/halrf_powertracking_ce.o\ -+ hal/phydm/halrf/halrf_powertracking.o\ -+ hal/phydm/halrf/halrf_kfree.o -+ -+ifeq ($(CONFIG_RTL8188E), y) -+RTL871X = rtl8188e -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8188e_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8188e_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8188e.o\ -+ hal/phydm/$(RTL871X)/hal8188erateadaptive.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8188e.o -+endif -+ -+ifeq ($(CONFIG_RTL8192E), y) -+RTL871X = rtl8192e -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8192e_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192e_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192e_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8192e_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8192e.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8192e.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8812A), y) -+RTL871X = rtl8812a -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8812a_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8812a_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8812a_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_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) -+RTL871X = rtl8821a -+_PHYDM_FILES += hal/phydm/rtl8821a/halhwimg8821a_mac.o\ -+ hal/phydm/rtl8821a/halhwimg8821a_bb.o\ -+ hal/phydm/rtl8821a/halhwimg8821a_rf.o\ -+ hal/phydm/halrf/rtl8812a/halrf_8812a_ce.o\ -+ hal/phydm/halrf/rtl8821a/halrf_8821a_ce.o\ -+ hal/phydm/rtl8821a/phydm_regconfig8821a.o\ -+ hal/phydm/rtl8821a/phydm_rtl8821a.o\ -+ hal/phydm/halrf/rtl8821a/halrf_iqk_8821a_ce.o\ -+ hal/phydm/txbf/haltxbfjaguar.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8723B), y) -+RTL871X = rtl8723b -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8723b_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_mp.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8723b.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8723b_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8723b.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8814A), y) -+RTL871X = rtl8814a -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8814a_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8814a_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8814a_rf.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_iqk_8814a.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8814a.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8814a_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8814a.o\ -+ hal/phydm/txbf/haltxbf8814a.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8723C), y) -+RTL871X = rtl8703b -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8703b_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8703b_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8703b_rf.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8703b.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8703b.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8703b.o -+endif -+ -+ifeq ($(CONFIG_RTL8723D), y) -+RTL871X = rtl8723d -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8723d_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723d_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723d_rf.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8723d.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8723d.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8723d.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8710B), y) -+RTL871X = rtl8710b -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8710b_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8710b_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8710b_rf.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8710b.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8710b.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8710b.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8188F), y) -+RTL871X = rtl8188f -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8188f_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188f_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188f_rf.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8188f.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8188f.o \ -+ hal/phydm/$(RTL871X)/phydm_rtl8188f.o -+endif -+ -+ifeq ($(CONFIG_RTL8822B), y) -+RTL871X = rtl8822b -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8822b_bb.o \ -+ hal/phydm/$(RTL871X)/halhwimg8822b_mac.o \ -+ hal/phydm/$(RTL871X)/halhwimg8822b_rf.o \ -+ hal/phydm/halrf/$(RTL871X)/halrf_8822b.o \ -+ hal/phydm/$(RTL871X)/phydm_hal_api8822b.o \ -+ hal/phydm/halrf/$(RTL871X)/halrf_iqk_8822b.o \ -+ hal/phydm/halrf/$(RTL871X)/halrf_rfk_init_8822b.o \ -+ hal/phydm/$(RTL871X)/phydm_regconfig8822b.o \ -+ hal/phydm/$(RTL871X)/phydm_rtl8822b.o -+ -+_PHYDM_FILES += hal/phydm/txbf/haltxbf8822b.o -+endif -+ -+ -+ifeq ($(CONFIG_RTL8821C), y) -+RTL871X = rtl8821c -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8821c_bb.o \ -+ hal/phydm/$(RTL871X)/halhwimg8821c_mac.o \ -+ hal/phydm/$(RTL871X)/halhwimg8821c_rf.o \ -+ hal/phydm/$(RTL871X)/phydm_hal_api8821c.o \ -+ hal/phydm/$(RTL871X)/phydm_regconfig8821c.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8821c.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_iqk_8821c.o -+endif -+ifeq ($(CONFIG_RTL8192F), y) -+RTL871X = rtl8192f -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8192f_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192f_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192f_rf.o\ -+ hal/phydm/$(RTL871X)/phydm_hal_api8192f.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8192f.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8192f.o\ -+ hal/phydm/halrf/$(RTL871X)/halrf_8192f.o -+endif -+ -+ifeq ($(CONFIG_RTL8198F), y) -+RTL871X = rtl8198f -+_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8198f_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8198f_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8198f_rf.o\ -+ hal/phydm/$(RTL871X)/phydm_hal_api8198f.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8198f.o -+endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/halcomtxbf.c b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/halcomtxbf.c -new file mode 100644 -index 000000000..ae45a5b1a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/halcomtxbf.c -@@ -0,0 +1,520 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 TXBF mechanism -+ * -+ ************************************************************/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+/*@Beamforming halcomtxbf API create by YuChen 2015/05*/ -+ -+void hal_com_txbf_beamform_init( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ boolean is_iqgen_setting_ok = false; -+ -+ if (dm->support_ic_type & ODM_RTL8814A) { -+ is_iqgen_setting_ok = phydm_beamforming_set_iqgen_8814A(dm); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] is_iqgen_setting_ok = %d\n", -+ __func__, is_iqgen_setting_ok); -+ } -+} -+ -+/*Only used for MU BFer Entry when get GID management frame (self as MU STA)*/ -+void hal_com_txbf_config_gtab( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->support_ic_type & ODM_RTL8822B) -+ hal_txbf_8822b_config_gtab(dm); -+} -+ -+void phydm_beamform_set_sounding_enter( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ if (!odm_is_work_item_scheduled(&p_txbf_info->txbf_enter_work_item)) -+ odm_schedule_work_item(&p_txbf_info->txbf_enter_work_item); -+#else -+ hal_com_txbf_enter_work_item_callback(dm); -+#endif -+} -+ -+void phydm_beamform_set_sounding_leave( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ if (!odm_is_work_item_scheduled(&p_txbf_info->txbf_leave_work_item)) -+ odm_schedule_work_item(&p_txbf_info->txbf_leave_work_item); -+#else -+ hal_com_txbf_leave_work_item_callback(dm); -+#endif -+} -+ -+void phydm_beamform_set_sounding_rate( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ if (!odm_is_work_item_scheduled(&p_txbf_info->txbf_rate_work_item)) -+ odm_schedule_work_item(&p_txbf_info->txbf_rate_work_item); -+#else -+ hal_com_txbf_rate_work_item_callback(dm); -+#endif -+} -+ -+void phydm_beamform_set_sounding_status( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ if (!odm_is_work_item_scheduled(&p_txbf_info->txbf_status_work_item)) -+ odm_schedule_work_item(&p_txbf_info->txbf_status_work_item); -+#else -+ hal_com_txbf_status_work_item_callback(dm); -+#endif -+} -+ -+void phydm_beamform_set_sounding_fw_ndpa( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ if (*dm->is_fw_dw_rsvd_page_in_progress) -+ odm_set_timer(dm, &p_txbf_info->txbf_fw_ndpa_timer, 5); -+ else -+ odm_schedule_work_item(&p_txbf_info->txbf_fw_ndpa_work_item); -+#else -+ hal_com_txbf_fw_ndpa_work_item_callback(dm); -+#endif -+} -+ -+void phydm_beamform_set_sounding_clk( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ if (!odm_is_work_item_scheduled(&p_txbf_info->txbf_clk_work_item)) -+ odm_schedule_work_item(&p_txbf_info->txbf_clk_work_item); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ phydm_run_in_thread_cmd(dm, hal_com_txbf_clk_work_item_callback, dm); -+#else -+ hal_com_txbf_clk_work_item_callback(dm); -+#endif -+} -+ -+void phydm_beamform_set_reset_tx_path( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ struct _RT_WORK_ITEM *pwi = &p_txbf_info->txbf_reset_tx_path_work_item; -+ -+ if (!odm_is_work_item_scheduled(pwi)) -+ odm_schedule_work_item(pwi); -+#else -+ hal_com_txbf_reset_tx_path_work_item_callback(dm); -+#endif -+} -+ -+void phydm_beamform_set_get_tx_rate( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ struct _RT_WORK_ITEM *pwi = &p_txbf_info->txbf_get_tx_rate_work_item; -+ -+ if (!odm_is_work_item_scheduled(pwi)) -+ odm_schedule_work_item(pwi); -+#else -+ hal_com_txbf_get_tx_rate_work_item_callback(dm); -+#endif -+} -+ -+void hal_com_txbf_enter_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#else -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#endif -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ u8 idx = p_txbf_info->txbf_idx; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) -+ hal_txbf_jaguar_enter(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8192E) -+ hal_txbf_8192e_enter(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8814A) -+ hal_txbf_8814a_enter(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8822B) -+ hal_txbf_8822b_enter(dm, idx); -+} -+ -+void hal_com_txbf_leave_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#else -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#endif -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ u8 idx = p_txbf_info->txbf_idx; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) -+ hal_txbf_jaguar_leave(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8192E) -+ hal_txbf_8192e_leave(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8814A) -+ hal_txbf_8814a_leave(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8822B) -+ hal_txbf_8822b_leave(dm, idx); -+} -+ -+void hal_com_txbf_fw_ndpa_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#else -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#endif -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ u8 idx = p_txbf_info->ndpa_idx; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) -+ hal_txbf_jaguar_fw_txbf(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8192E) -+ hal_txbf_8192e_fw_tx_bf(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8814A) -+ hal_txbf_8814a_fw_txbf(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8822B) -+ hal_txbf_8822b_fw_txbf(dm, idx); -+} -+ -+void hal_com_txbf_clk_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#else -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#endif -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (dm->support_ic_type & ODM_RTL8812) -+ hal_txbf_jaguar_clk_8812a(dm); -+} -+ -+void hal_com_txbf_rate_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#else -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#endif -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ u8 BW = p_txbf_info->BW; -+ u8 rate = p_txbf_info->rate; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (dm->support_ic_type & ODM_RTL8812) -+ hal_txbf_8812a_set_ndpa_rate(dm, BW, rate); -+ else if (dm->support_ic_type & ODM_RTL8192E) -+ hal_txbf_8192e_set_ndpa_rate(dm, BW, rate); -+ else if (dm->support_ic_type & ODM_RTL8814A) -+ hal_txbf_8814a_set_ndpa_rate(dm, BW, rate); -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void hal_com_txbf_fw_ndpa_timer_callback( -+ struct phydm_timer_list *timer) -+{ -+ void *adapter = (void *)timer->Adapter; -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (*dm->is_fw_dw_rsvd_page_in_progress) -+ odm_set_timer(dm, &(p_txbf_info->txbf_fw_ndpa_timer), 5); -+ else -+ odm_schedule_work_item(&(p_txbf_info->txbf_fw_ndpa_work_item)); -+} -+#endif -+ -+void hal_com_txbf_status_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#else -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#endif -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ u8 idx = p_txbf_info->txbf_idx; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) -+ hal_txbf_jaguar_status(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8192E) -+ hal_txbf_8192e_status(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8814A) -+ hal_txbf_8814a_status(dm, idx); -+ else if (dm->support_ic_type & ODM_RTL8822B) -+ hal_txbf_8822b_status(dm, idx); -+} -+ -+void hal_com_txbf_reset_tx_path_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#else -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#endif -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ u8 idx = p_txbf_info->txbf_idx; -+ -+ if (dm->support_ic_type & ODM_RTL8814A) -+ hal_txbf_8814a_reset_tx_path(dm, idx); -+} -+ -+void hal_com_txbf_get_tx_rate_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+#else -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#endif -+ -+ if (dm->support_ic_type & ODM_RTL8814A) -+ hal_txbf_8814a_get_tx_rate(dm); -+} -+ -+boolean -+hal_com_txbf_set( -+ void *dm_void, -+ u8 set_type, -+ void *p_in_buf) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 *p_u1_tmp = (u8 *)p_in_buf; -+ struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] set_type = 0x%X\n", __func__, set_type); -+ -+ switch (set_type) { -+ case TXBF_SET_SOUNDING_ENTER: -+ p_txbf_info->txbf_idx = *p_u1_tmp; -+ phydm_beamform_set_sounding_enter(dm); -+ break; -+ -+ case TXBF_SET_SOUNDING_LEAVE: -+ p_txbf_info->txbf_idx = *p_u1_tmp; -+ phydm_beamform_set_sounding_leave(dm); -+ break; -+ -+ case TXBF_SET_SOUNDING_RATE: -+ p_txbf_info->BW = p_u1_tmp[0]; -+ p_txbf_info->rate = p_u1_tmp[1]; -+ phydm_beamform_set_sounding_rate(dm); -+ break; -+ -+ case TXBF_SET_SOUNDING_STATUS: -+ p_txbf_info->txbf_idx = *p_u1_tmp; -+ phydm_beamform_set_sounding_status(dm); -+ break; -+ -+ case TXBF_SET_SOUNDING_FW_NDPA: -+ p_txbf_info->ndpa_idx = *p_u1_tmp; -+ phydm_beamform_set_sounding_fw_ndpa(dm); -+ break; -+ -+ case TXBF_SET_SOUNDING_CLK: -+ phydm_beamform_set_sounding_clk(dm); -+ break; -+ -+ case TXBF_SET_TX_PATH_RESET: -+ p_txbf_info->txbf_idx = *p_u1_tmp; -+ phydm_beamform_set_reset_tx_path(dm); -+ break; -+ -+ case TXBF_SET_GET_TX_RATE: -+ phydm_beamform_set_get_tx_rate(dm); -+ break; -+ } -+ -+ return true; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+boolean -+hal_com_txbf_get( -+ void *adapter, -+ u8 get_type, -+ void *p_out_buf) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ boolean *p_boolean = (boolean *)p_out_buf; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (get_type == TXBF_GET_EXPLICIT_BEAMFORMEE) { -+ if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(adapter)) -+ *p_boolean = false; -+ else if (/*@IS_HARDWARE_TYPE_8822B(adapter) ||*/ -+ IS_HARDWARE_TYPE_8821B(adapter) || -+ IS_HARDWARE_TYPE_8192E(adapter) || -+ IS_HARDWARE_TYPE_8192F(adapter) || -+ IS_HARDWARE_TYPE_JAGUAR(adapter) || -+ IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter) || -+ IS_HARDWARE_TYPE_JAGUAR3(adapter)) -+ *p_boolean = true; -+ else -+ *p_boolean = false; -+ } else if (get_type == TXBF_GET_EXPLICIT_BEAMFORMER) { -+ if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(adapter)) -+ *p_boolean = false; -+ else if (/*@IS_HARDWARE_TYPE_8822B(adapter) ||*/ -+ IS_HARDWARE_TYPE_8821B(adapter) || -+ IS_HARDWARE_TYPE_8192E(adapter) || -+ IS_HARDWARE_TYPE_8192F(adapter) || -+ IS_HARDWARE_TYPE_JAGUAR(adapter) || -+ IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter) || -+ IS_HARDWARE_TYPE_JAGUAR3(adapter)) { -+ if (hal_data->RF_Type == RF_2T2R || -+ hal_data->RF_Type == RF_3T3R || -+ hal_data->RF_Type == RF_4T4R) -+ *p_boolean = true; -+ else -+ *p_boolean = false; -+ } else -+ *p_boolean = false; -+ } else if (get_type == TXBF_GET_MU_MIMO_STA) { -+#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) ||\ -+ (RTL8822C_SUPPORT == 1)) -+ if (IS_HARDWARE_TYPE_8822B(adapter) || -+ IS_HARDWARE_TYPE_8821C(adapter) || -+ IS_HARDWARE_TYPE_JAGUAR3(adapter)) -+ *p_boolean = true; -+ else -+#endif -+ *p_boolean = false; -+ -+ } else if (get_type == TXBF_GET_MU_MIMO_AP) { -+#if ((RTL8822B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1)) -+ if (IS_HARDWARE_TYPE_8822B(adapter) || -+ IS_HARDWARE_TYPE_JAGUAR3(adapter)) -+ *p_boolean = true; -+ else -+#endif -+ *p_boolean = false; -+ } -+ -+ return true; -+} -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/halcomtxbf.h b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/halcomtxbf.h -new file mode 100644 -index 000000000..5ad303394 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/halcomtxbf.h -@@ -0,0 +1,183 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#ifndef __HAL_COM_TXBF_H__ -+#define __HAL_COM_TXBF_H__ -+ -+#if 0 -+typedef bool -+(*TXBF_GET)( -+ void* adapter, -+ u8 get_type, -+ void* p_out_buf -+ ); -+ -+typedef bool -+(*TXBF_SET)( -+ void* adapter, -+ u8 set_type, -+ void* p_in_buf -+ ); -+#endif -+ -+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 -+}; -+ -+enum txbf_get_type { -+ TXBF_GET_EXPLICIT_BEAMFORMEE, -+ TXBF_GET_EXPLICIT_BEAMFORMER, -+ TXBF_GET_MU_MIMO_STA, -+ TXBF_GET_MU_MIMO_AP -+}; -+ -+/* @2 HAL TXBF related */ -+struct _HAL_TXBF_INFO { -+ u8 txbf_idx; -+ u8 ndpa_idx; -+ u8 BW; -+ u8 rate; -+ -+ struct phydm_timer_list txbf_fw_ndpa_timer; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_WORK_ITEM txbf_enter_work_item; -+ RT_WORK_ITEM txbf_leave_work_item; -+ RT_WORK_ITEM txbf_fw_ndpa_work_item; -+ RT_WORK_ITEM txbf_clk_work_item; -+ RT_WORK_ITEM txbf_status_work_item; -+ RT_WORK_ITEM txbf_rate_work_item; -+ RT_WORK_ITEM txbf_reset_tx_path_work_item; -+ RT_WORK_ITEM txbf_get_tx_rate_work_item; -+#endif -+}; -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ -+void hal_com_txbf_beamform_init( -+ void *dm_void); -+ -+void hal_com_txbf_config_gtab( -+ void *dm_void); -+ -+void hal_com_txbf_enter_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ); -+ -+void hal_com_txbf_leave_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ); -+ -+void hal_com_txbf_fw_ndpa_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ); -+ -+void hal_com_txbf_clk_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ); -+ -+void hal_com_txbf_reset_tx_path_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ); -+ -+void hal_com_txbf_get_tx_rate_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ); -+ -+void hal_com_txbf_rate_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ); -+ -+void hal_com_txbf_fw_ndpa_timer_callback( -+ struct phydm_timer_list *timer); -+ -+void hal_com_txbf_status_work_item_callback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ void *adapter -+#else -+ void *dm_void -+#endif -+ ); -+ -+boolean -+hal_com_txbf_set( -+ void *dm_void, -+ u8 set_type, -+ void *p_in_buf); -+ -+boolean -+hal_com_txbf_get( -+ void *adapter, -+ u8 get_type, -+ void *p_out_buf); -+ -+#else -+#define hal_com_txbf_beamform_init(dm_void) NULL -+#define hal_com_txbf_config_gtab(dm_void) NULL -+#define hal_com_txbf_enter_work_item_callback(_adapter) NULL -+#define hal_com_txbf_leave_work_item_callback(_adapter) NULL -+#define hal_com_txbf_fw_ndpa_work_item_callback(_adapter) NULL -+#define hal_com_txbf_clk_work_item_callback(_adapter) NULL -+#define hal_com_txbf_rate_work_item_callback(_adapter) NULL -+#define hal_com_txbf_fw_ndpa_timer_callback(_adapter) NULL -+#define hal_com_txbf_status_work_item_callback(_adapter) NULL -+#define hal_com_txbf_get(_adapter, _get_type, _pout_buf) -+ -+#endif -+ -+#endif /* @#ifndef __HAL_COM_TXBF_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8192e.c b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8192e.c -new file mode 100644 -index 000000000..daac3e58a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8192e.c -@@ -0,0 +1,384 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 8192E TXBF mechanism -+ * -+ ************************************************************/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if (RTL8192E_SUPPORT == 1) -+ -+void hal_txbf_8192e_set_ndpa_rate( -+ void *dm_void, -+ u8 BW, -+ u8 rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_write_1byte(dm, REG_NDPA_OPT_CTRL_8192E, (rate << 2 | BW)); -+} -+ -+void hal_txbf_8192e_rf_mode( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beam_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (dm->rf_type == RF_1T1R) -+ return; -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ -+ -+ if (beam_info->beamformee_su_cnt > 0) { -+ /*Path_A*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); /*Select RX mode 0x30=0x18000*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0000f); /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x77fc2); /*@Enable TXIQGEN in RX mode*/ -+ /*Path_B*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x0000f); /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x77fc2); /*@Enable TXIQGEN in RX mode*/ -+ } else { -+ /*Path_A*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0000f); /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x77f82); /*@Disable TXIQGEN in RX mode*/ -+ /*Path_B*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x0000f); /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x77f82); /*@Disable TXIQGEN in RX mode*/ -+ } -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_WE_LUT, 0x80000, 0x0); /*RF mode table write disable*/ -+ -+ if (beam_info->beamformee_su_cnt > 0) { -+ odm_set_bb_reg(dm, R_0x90c, MASKDWORD, 0x83321333); -+ odm_set_bb_reg(dm, R_0xa04, MASKBYTE3, 0xc1); -+ } else -+ odm_set_bb_reg(dm, R_0x90c, MASKDWORD, 0x81121313); -+} -+ -+void hal_txbf_8192e_fw_txbf_cmd( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 idx, period0 = 0, period1 = 0; -+ u8 PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u8 u1_tx_bf_parm[3] = {0}; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ if (beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (idx == 0) { -+ if (beam_info->beamformee_entry[idx].is_sound) -+ PageNum0 = 0xFE; -+ else -+ PageNum0 = 0xFF; /* stop sounding */ -+ period0 = (u8)(beam_info->beamformee_entry[idx].sound_period); -+ } else if (idx == 1) { -+ if (beam_info->beamformee_entry[idx].is_sound) -+ PageNum1 = 0xFE; -+ else -+ PageNum1 = 0xFF; /* stop sounding */ -+ period1 = (u8)(beam_info->beamformee_entry[idx].sound_period); -+ } -+ } -+ } -+ -+ u1_tx_bf_parm[0] = PageNum0; -+ u1_tx_bf_parm[1] = PageNum1; -+ u1_tx_bf_parm[2] = (period1 << 4) | period0; -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] PageNum0 = %d period0 = %d, PageNum1 = %d period1 %d\n", -+ __func__, PageNum0, period0, PageNum1, period1); -+} -+ -+void hal_txbf_8192e_download_ndpa( -+ void *dm_void, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 u1b_tmp = 0, tmp_reg422 = 0, head_page; -+ u8 bcn_valid_reg = 0, count = 0, dl_bcn_count = 0; -+ boolean is_send_beacon = false; -+ u8 tx_page_bndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; -+ /*@default reseved 1 page for the IC type which is undefined.*/ -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *dm->is_fw_dw_rsvd_page_in_progress = true; -+#endif -+ if (idx == 0) -+ head_page = 0xFE; -+ else -+ head_page = 0xFE; -+ -+ phydm_get_hal_def_var_handler_interface(dm, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_page_bndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1b_tmp = odm_read_1byte(dm, REG_CR_8192E + 1); -+ odm_write_1byte(dm, REG_CR_8192E + 1, (u1b_tmp | BIT(0))); -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmp_reg422 = odm_read_1byte(dm, REG_FWHW_TXQ_CTRL_8192E + 2); -+ odm_write_1byte(dm, REG_FWHW_TXQ_CTRL_8192E + 2, tmp_reg422 & (~BIT(6))); -+ -+ if (tmp_reg422 & BIT(6)) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s There is an adapter is sending beacon.\n", -+ __func__); -+ is_send_beacon = true; -+ } -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xFE/0xFD NDPA Head for TXDMA*/ -+ odm_write_1byte(dm, REG_DWBCN0_CTRL_8192E + 1, head_page); -+ -+ do { -+ /*@Clear beacon valid check bit.*/ -+ bcn_valid_reg = odm_read_1byte(dm, REG_DWBCN0_CTRL_8192E + 2); -+ odm_write_1byte(dm, REG_DWBCN0_CTRL_8192E + 2, (bcn_valid_reg | BIT(0))); -+ -+ /* @download NDPA rsvd page. */ -+ beamforming_send_ht_ndpa_packet(dm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); -+ -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ if (dm->support_interface == ODM_ITRF_PCIE) { -+ u1b_tmp = odm_read_1byte(dm, REG_MGQ_TXBD_NUM_8192E + 3); -+ count = 0; -+ while ((count < 20) && (u1b_tmp & BIT(4))) { -+ count++; -+ ODM_delay_us(10); -+ u1b_tmp = odm_read_1byte(dm, REG_MGQ_TXBD_NUM_8192E + 3); -+ } -+ odm_write_1byte(dm, REG_MGQ_TXBD_NUM_8192E + 3, u1b_tmp | BIT(4)); -+ } -+#endif -+ -+ /*@check rsvd page download OK.*/ -+ bcn_valid_reg = odm_read_1byte(dm, REG_DWBCN0_CTRL_8192E + 2); -+ count = 0; -+ while (!(bcn_valid_reg & BIT(0)) && count < 20) { -+ count++; -+ ODM_delay_us(10); -+ bcn_valid_reg = odm_read_1byte(dm, REG_DWBCN0_CTRL_8192E + 2); -+ } -+ dl_bcn_count++; -+ } while (!(bcn_valid_reg & BIT(0)) && dl_bcn_count < 5); -+ -+ if (!(bcn_valid_reg & BIT(0))) -+ PHYDM_DBG(dm, DBG_TXBF, "%s Download RSVD page failed!\n", -+ __func__); -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF9 Beacon Head for TXDMA*/ -+ odm_write_1byte(dm, REG_DWBCN0_CTRL_8192E + 1, tx_page_bndy); -+ -+ /*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 (is_send_beacon) -+ odm_write_1byte(dm, REG_FWHW_TXQ_CTRL_8192E + 2, tmp_reg422); -+ -+ /*@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.*/ -+ u1b_tmp = odm_read_1byte(dm, REG_CR_8192E + 1); -+ odm_write_1byte(dm, REG_CR_8192E + 1, (u1b_tmp & (~BIT(0)))); -+ -+ p_beam_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *dm->is_fw_dw_rsvd_page_in_progress = false; -+#endif -+} -+ -+void hal_txbf_8192e_enter( -+ void *dm_void, -+ u8 bfer_bfee_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ u8 bfer_idx = (bfer_bfee_idx & 0xF0) >> 4; -+ u8 bfee_idx = (bfer_bfee_idx & 0xF); -+ u32 csi_param; -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY beamformee_entry; -+ struct _RT_BEAMFORMER_ENTRY beamformer_entry; -+ u16 sta_id = 0; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ hal_txbf_8192e_rf_mode(dm, beamforming_info); -+ -+ if (dm->rf_type == RF_2T2R) -+ odm_write_4byte(dm, 0xd80, 0x00000000); /*nc =2*/ -+ -+ if (beamforming_info->beamformer_su_cnt > 0 && bfer_idx < BEAMFORMER_ENTRY_NUM) { -+ beamformer_entry = beamforming_info->beamformer_entry[bfer_idx]; -+ -+ /*Sounding protocol control*/ -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8192E, 0xCB); -+ -+ /*@MAC address/Partial AID of Beamformer*/ -+ if (bfer_idx == 0) { -+ for (i = 0; i < 6; i++) -+ odm_write_1byte(dm, (REG_ASSOCIATED_BFMER0_INFO_8192E + i), beamformer_entry.mac_addr[i]); -+ } else { -+ for (i = 0; i < 6; i++) -+ odm_write_1byte(dm, (REG_ASSOCIATED_BFMER1_INFO_8192E + i), beamformer_entry.mac_addr[i]); -+ } -+ -+ /*@CSI report parameters of Beamformer Default use nc = 2*/ -+ csi_param = 0x03090309; -+ -+ odm_write_4byte(dm, REG_CSI_RPT_PARAM_BW20_8192E, csi_param); -+ odm_write_4byte(dm, REG_CSI_RPT_PARAM_BW40_8192E, csi_param); -+ odm_write_4byte(dm, 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_write_1byte(dm, REG_SND_PTCL_CTRL_8192E + 3, 0x50); -+ } -+ -+ if (beamforming_info->beamformee_su_cnt > 0 && bfee_idx < BEAMFORMEE_ENTRY_NUM) { -+ beamformee_entry = beamforming_info->beamformee_entry[bfee_idx]; -+ -+ if (phydm_acting_determine(dm, phydm_acting_as_ibss)) -+ sta_id = beamformee_entry.mac_id; -+ else -+ sta_id = beamformee_entry.p_aid; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s], sta_id=0x%X\n", __func__, -+ sta_id); -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (bfee_idx == 0) { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8192E, sta_id); -+ odm_write_1byte(dm, REG_TXBF_CTRL_8192E + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8192E + 3) | BIT(4) | BIT(6) | BIT(7)); -+ } else -+ odm_write_2byte(dm, REG_TXBF_CTRL_8192E + 2, sta_id | BIT(12) | BIT(14) | BIT(15)); -+ -+ /*@CSI report parameters of Beamformee*/ -+ if (bfee_idx == 0) { -+ /*@Get BIT24 & BIT25*/ -+ u8 tmp = odm_read_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E + 3) & 0x3; -+ -+ odm_write_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E + 3, tmp | 0x60); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E, sta_id | BIT(9)); -+ } else { -+ /*Set BIT25*/ -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E + 2, sta_id | 0xE200); -+ } -+ phydm_beamforming_notify(dm); -+ } -+} -+ -+void hal_txbf_8192e_leave( -+ void *dm_void, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ hal_txbf_8192e_rf_mode(dm, beam_info); -+ -+ /* @Clear P_AID of Beamformee -+ * Clear MAC addresss of Beamformer -+ * Clear Associated Bfmee Sel -+ */ -+ if (beam_info->beamform_cap == BEAMFORMING_CAP_NONE) -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8192E, 0xC8); -+ -+ if (idx == 0) { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8192E, 0); -+ odm_write_4byte(dm, REG_ASSOCIATED_BFMER0_INFO_8192E, 0); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMER0_INFO_8192E + 4, 0); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E, 0); -+ } else { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8192E + 2, odm_read_1byte(dm, REG_TXBF_CTRL_8192E + 2) & 0xF000); -+ odm_write_4byte(dm, REG_ASSOCIATED_BFMER1_INFO_8192E, 0); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMER1_INFO_8192E + 4, 0); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E + 2, odm_read_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E + 2) & 0x60); -+ } -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] idx %d\n", __func__, idx); -+} -+ -+void hal_txbf_8192e_status( -+ void *dm_void, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 beam_ctrl_val; -+ u32 beam_ctrl_reg; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY beamform_entry = beam_info->beamformee_entry[idx]; -+ -+ if (phydm_acting_determine(dm, phydm_acting_as_ibss)) -+ beam_ctrl_val = beamform_entry.mac_id; -+ else -+ beam_ctrl_val = beamform_entry.p_aid; -+ -+ if (idx == 0) -+ beam_ctrl_reg = REG_TXBF_CTRL_8192E; -+ else { -+ beam_ctrl_reg = REG_TXBF_CTRL_8192E + 2; -+ beam_ctrl_val |= BIT(12) | BIT(14) | BIT(15); -+ } -+ -+ if (beamform_entry.beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED && beam_info->apply_v_matrix == true) { -+ if (beamform_entry.sound_bw == CHANNEL_WIDTH_20) -+ beam_ctrl_val |= BIT(9); -+ else if (beamform_entry.sound_bw == CHANNEL_WIDTH_40) -+ beam_ctrl_val |= BIT(10); -+ } else -+ beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); -+ -+ odm_write_2byte(dm, beam_ctrl_reg, beam_ctrl_val); -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] idx %d beam_ctrl_reg %x beam_ctrl_val %x\n", __func__, -+ idx, beam_ctrl_reg, beam_ctrl_val); -+} -+ -+void hal_txbf_8192e_fw_tx_bf( -+ void *dm_void, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (p_beam_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ hal_txbf_8192e_download_ndpa(dm, idx); -+ -+ hal_txbf_8192e_fw_txbf_cmd(dm); -+} -+ -+#endif /* @#if (RTL8192E_SUPPORT == 1)*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8192e.h b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8192e.h -new file mode 100644 -index 000000000..9b0c8321f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8192e.h -@@ -0,0 +1,71 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#ifndef __HAL_TXBF_8192E_H__ -+#define __HAL_TXBF_8192E_H__ -+ -+#if (RTL8192E_SUPPORT == 1) -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ -+void hal_txbf_8192e_set_ndpa_rate( -+ void *dm_void, -+ u8 BW, -+ u8 rate); -+ -+void hal_txbf_8192e_enter( -+ void *dm_void, -+ u8 idx); -+ -+void hal_txbf_8192e_leave( -+ void *dm_void, -+ u8 idx); -+ -+void hal_txbf_8192e_status( -+ void *dm_void, -+ u8 idx); -+ -+void hal_txbf_8192e_fw_tx_bf( -+ void *dm_void, -+ u8 idx); -+#else -+ -+#define hal_txbf_8192e_set_ndpa_rate(dm_void, BW, rate) -+#define hal_txbf_8192e_enter(dm_void, idx) -+#define hal_txbf_8192e_leave(dm_void, idx) -+#define hal_txbf_8192e_status(dm_void, idx) -+#define hal_txbf_8192e_fw_tx_bf(dm_void, idx) -+ -+#endif -+ -+#else -+ -+#define hal_txbf_8192e_set_ndpa_rate(dm_void, BW, rate) -+#define hal_txbf_8192e_enter(dm_void, idx) -+#define hal_txbf_8192e_leave(dm_void, idx) -+#define hal_txbf_8192e_status(dm_void, idx) -+#define hal_txbf_8192e_fw_tx_bf(dm_void, idx) -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8814a.c b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8814a.c -new file mode 100644 -index 000000000..7ad6ca909 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8814a.c -@@ -0,0 +1,675 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 8814A TXBF mechanism -+ * -+ * ************************************************************ */ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if (RTL8814A_SUPPORT == 1) -+ -+boolean -+phydm_beamforming_set_iqgen_8814A(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ u16 counter = 0; -+ u32 rf_mode[4]; -+ -+ for (i = RF_PATH_A; i < MAX_RF_PATH; i++) -+ odm_set_rf_reg(dm, i, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ -+ -+ while (1) { -+ counter++; -+ for (i = RF_PATH_A; i < MAX_RF_PATH; i++) -+ odm_set_rf_reg(dm, i, RF_RCK_OS, 0xfffff, 0x18000); /*Select Rx mode*/ -+ -+ ODM_delay_us(2); -+ -+ for (i = RF_PATH_A; i < MAX_RF_PATH; i++) -+ rf_mode[i] = odm_get_rf_reg(dm, i, RF_RCK_OS, 0xfffff); -+ -+ if (rf_mode[0] == 0x18000 && rf_mode[1] == 0x18000 && rf_mode[2] == 0x18000 && rf_mode[3] == 0x18000) -+ break; -+ else if (counter == 100) { -+ PHYDM_DBG(dm, DBG_TXBF, "iqgen setting fail:8814A\n"); -+ return false; -+ } -+ } -+ -+ for (i = RF_PATH_A; i < MAX_RF_PATH; i++) { -+ odm_set_rf_reg(dm, i, RF_TXPA_G1, 0xfffff, 0xBE77F); /*Set Table data*/ -+ odm_set_rf_reg(dm, i, RF_TXPA_G2, 0xfffff, 0x226BF); /*@Enable TXIQGEN in Rx mode*/ -+ } -+ odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G2, 0xfffff, 0xE26BF); /*@Enable TXIQGEN in Rx mode*/ -+ -+ for (i = RF_PATH_A; i < MAX_RF_PATH; i++) -+ odm_set_rf_reg(dm, i, RF_WE_LUT, 0x80000, 0x0); /*RF mode table write disable*/ -+ -+ return true; -+} -+ -+void hal_txbf_8814a_set_ndpa_rate(void *dm_void, u8 BW, u8 rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_write_1byte(dm, REG_NDPA_OPT_CTRL_8814A, BW); -+ odm_write_1byte(dm, REG_NDPA_RATE_8814A, (u8)rate); -+} -+#if 0 -+#define PHYDM_MEMORY_MAP_BUF_READ 0x8000 -+#define PHYDM_CTRL_INFO_PAGE 0x660 -+ -+void -+phydm_data_rate_8814a( -+ struct dm_struct *dm, -+ u8 mac_id, -+ u32 *data, -+ u8 data_len -+) -+{ -+ u8 i = 0; -+ u16 x_read_data_addr = 0; -+ -+ odm_write_2byte(dm, REG_PKTBUF_DBG_CTRL_8814A, PHYDM_CTRL_INFO_PAGE); -+ x_read_data_addr = PHYDM_MEMORY_MAP_BUF_READ + mac_id * 32; /*@Ctrl Info: 32Bytes for each macid(n)*/ -+ -+ if (x_read_data_addr < PHYDM_MEMORY_MAP_BUF_READ || x_read_data_addr > 0x8FFF) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "x_read_data_addr(0x%x) is not correct!\n", -+ x_read_data_addr); -+ return; -+ } -+ -+ /* Read data */ -+ for (i = 0; i < data_len; i++) -+ *(data + i) = odm_read_2byte(dm, x_read_data_addr + i); -+} -+#endif -+ -+void hal_txbf_8814a_get_tx_rate(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *entry; -+ struct ra_table *ra_tab = &dm->dm_ra_table; -+ struct cmn_sta_info *sta = NULL; -+ u8 data_rate = 0xFF; -+ u8 macid = 0; -+ -+ entry = &(beam_info->beamformee_entry[beam_info->beamformee_cur_idx]); -+ macid = (u8)entry->mac_id; -+ -+ sta = dm->phydm_sta_info[macid]; -+ -+ if (is_sta_active(sta)) { -+ data_rate = (sta->ra_info.curr_tx_rate) & 0x7f; /*@Bit7 indicates SGI*/ -+ beam_info->tx_bf_data_rate = data_rate; -+ } -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] dm->tx_bf_data_rate = 0x%x\n", __func__, -+ beam_info->tx_bf_data_rate); -+} -+ -+void hal_txbf_8814a_reset_tx_path(void *dm_void, u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY beamformee_entry; -+ u8 nr_index = 0, tx_ss = 0; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ beamformee_entry = beamforming_info->beamformee_entry[idx]; -+ else -+ return; -+ -+ if (beamforming_info->last_usb_hub != (*dm->hub_usb_mode)) { -+ nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(dm), beamformee_entry.comp_steering_num_of_bfer); -+ -+ if (*dm->hub_usb_mode == 2) { -+ if (dm->rf_type == RF_4T4R) -+ tx_ss = 0xf; -+ else if (dm->rf_type == RF_3T3R) -+ tx_ss = 0xe; -+ else -+ tx_ss = 0x6; -+ } else if (*dm->hub_usb_mode == 1) /*USB 2.0 always 2Tx*/ -+ tx_ss = 0x6; -+ else -+ tx_ss = 0x6; -+ -+ if (tx_ss == 0xf) { -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93f); -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKDWORD, 0x93f93f0); -+ } else if (tx_ss == 0xe) { -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93e); -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e93e0); -+ } else if (tx_ss == 0x6) { -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x936); -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8814A, MASKLWORD, 0x9360); -+ } -+ -+ if (idx == 0) { -+ switch (nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ -+ break; -+ -+ default: /*nr>3, same as Case 3*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ -+ break; -+ } -+ } else { -+ switch (nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ -+ break; -+ -+ default: /*nr>3, same as Case 3*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ -+ break; -+ } -+ } -+ -+ beamforming_info->last_usb_hub = *dm->hub_usb_mode; -+ } else -+ return; -+#endif -+} -+ -+u8 hal_txbf_8814a_get_ntx(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 ntx = 0, tx_ss = 3; -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ tx_ss = *dm->hub_usb_mode; -+#endif -+ if (tx_ss == 3 || tx_ss == 2) { -+ if (dm->rf_type == RF_4T4R) -+ ntx = 3; -+ else if (dm->rf_type == RF_3T3R) -+ ntx = 2; -+ else -+ ntx = 1; -+ } else if (tx_ss == 1) /*USB 2.0 always 2Tx*/ -+ ntx = 1; -+ else -+ ntx = 1; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ntx = %d\n", __func__, ntx); -+ return ntx; -+} -+ -+u8 hal_txbf_8814a_get_nrx(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 nrx = 0; -+ -+ if (dm->rf_type == RF_4T4R) -+ nrx = 3; -+ else if (dm->rf_type == RF_3T3R) -+ nrx = 2; -+ else if (dm->rf_type == RF_2T2R) -+ nrx = 1; -+ else if (dm->rf_type == RF_2T3R) -+ nrx = 2; -+ else if (dm->rf_type == RF_2T4R) -+ nrx = 3; -+ else if (dm->rf_type == RF_1T1R) -+ nrx = 0; -+ else if (dm->rf_type == RF_1T2R) -+ nrx = 1; -+ else -+ nrx = 0; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] nrx = %d\n", __func__, nrx); -+ return nrx; -+} -+ -+void hal_txbf_8814a_rf_mode(void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beamforming_info, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 nr_index = 0; -+ u8 tx_ss = 3; /*@default use 3 Tx*/ -+ struct _RT_BEAMFORMEE_ENTRY beamformee_entry; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ beamformee_entry = beamforming_info->beamformee_entry[idx]; -+ else -+ return; -+ -+ nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(dm), beamformee_entry.comp_steering_num_of_bfer); -+ -+ if (dm->rf_type == RF_1T1R) -+ return; -+ -+ if (beamforming_info->beamformee_su_cnt > 0) { -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ beamforming_info->last_usb_hub = *dm->hub_usb_mode; -+ tx_ss = *dm->hub_usb_mode; -+#endif -+ if (tx_ss == 3 || tx_ss == 2) { -+ if (dm->rf_type == RF_4T4R) -+ tx_ss = 0xf; -+ else if (dm->rf_type == RF_3T3R) -+ tx_ss = 0xe; -+ else -+ tx_ss = 0x6; -+ } else if (tx_ss == 1) /*USB 2.0 always 2Tx*/ -+ tx_ss = 0x6; -+ else -+ tx_ss = 0x6; -+ -+ if (tx_ss == 0xf) { -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93f); -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKDWORD, 0x93f93f0); -+ } else if (tx_ss == 0xe) { -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93e); -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e93e0); -+ } else if (tx_ss == 0x6) { -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x936); -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8814A, MASKLWORD, 0x9360); -+ } -+ -+ /*@for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8814A, BIT(28) | BIT29, 0x2); /*@enable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8814A, BIT30, 0x1); /*@if Nsts > Nc don't apply V matrix*/ -+ -+ if (idx == 0) { -+ switch (nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ -+ break; -+ -+ default: /*nr>3, same as Case 3*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ -+ -+ break; -+ } -+ } else { -+ switch (nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ -+ break; -+ -+ default: /*nr>3, same as Case 3*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ -+ break; -+ } -+ } -+ } -+ -+ if (beamforming_info->beamformee_su_cnt == 0 && beamforming_info->beamformer_su_cnt == 0) { -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x932); /*set tx_path selection for 8814a BFer bug refine*/ -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e9360); -+ } -+} -+#if 0 -+void -+hal_txbf_8814a_download_ndpa( -+ void *dm_void, -+ u8 idx -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 u1b_tmp = 0, tmp_reg422 = 0; -+ u8 bcn_valid_reg = 0, count = 0, dl_bcn_count = 0; -+ u16 head_page = 0x7FE; -+ boolean is_send_beacon = false; -+ u16 tx_page_bndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*@default reseved 1 page for the IC type which is undefined.*/ -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; -+ void *adapter = dm->adapter; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *dm->is_fw_dw_rsvd_page_in_progress = true; -+#endif -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ phydm_get_hal_def_var_handler_interface(dm, HAL_DEF_TX_PAGE_BOUNDARY, (u16 *)&tx_page_bndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1b_tmp = odm_read_1byte(dm, REG_CR_8814A + 1); -+ odm_write_1byte(dm, REG_CR_8814A + 1, (u1b_tmp | BIT(0))); -+ -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmp_reg422 = odm_read_1byte(dm, REG_FWHW_TXQ_CTRL_8814A + 2); -+ odm_write_1byte(dm, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422 & (~BIT(6))); -+ -+ if (tmp_reg422 & BIT(6)) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%s: There is an adapter is sending beacon.\n", -+ __func__); -+ is_send_beacon = true; -+ } -+ -+ /*@0x204[11:0] Beacon Head for TXDMA*/ -+ odm_write_2byte(dm, REG_FIFOPAGE_CTRL_2_8814A, head_page); -+ -+ do { -+ /*@Clear beacon valid check bit.*/ -+ bcn_valid_reg = odm_read_1byte(dm, REG_FIFOPAGE_CTRL_2_8814A + 1); -+ odm_write_1byte(dm, REG_FIFOPAGE_CTRL_2_8814A + 1, (bcn_valid_reg | BIT(7))); -+ -+ /*@download NDPA rsvd page.*/ -+ if (p_beam_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) -+ beamforming_send_vht_ndpa_packet(dm, p_beam_entry->mac_addr, p_beam_entry->AID, p_beam_entry->sound_bw, BEACON_QUEUE); -+ else -+ beamforming_send_ht_ndpa_packet(dm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); -+ -+ /*@check rsvd page download OK.*/ -+ bcn_valid_reg = odm_read_1byte(dm, REG_FIFOPAGE_CTRL_2_8814A + 1); -+ count = 0; -+ while (!(bcn_valid_reg & BIT(7)) && count < 20) { -+ count++; -+ ODM_delay_ms(10); -+ bcn_valid_reg = odm_read_1byte(dm, REG_FIFOPAGE_CTRL_2_8814A + 2); -+ } -+ dl_bcn_count++; -+ } while (!(bcn_valid_reg & BIT(7)) && dl_bcn_count < 5); -+ -+ if (!(bcn_valid_reg & BIT(7))) -+ PHYDM_DBG(dm, DBG_TXBF, "%s Download RSVD page failed!\n", -+ __func__); -+ -+ /*@0x204[11:0] Beacon Head for TXDMA*/ -+ odm_write_2byte(dm, REG_FIFOPAGE_CTRL_2_8814A, tx_page_bndy); -+ -+ /*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 (is_send_beacon) -+ odm_write_1byte(dm, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422); -+ -+ /*@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.*/ -+ u1b_tmp = odm_read_1byte(dm, REG_CR_8814A + 1); -+ odm_write_1byte(dm, REG_CR_8814A + 1, (u1b_tmp & (~BIT(0)))); -+ -+ p_beam_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *dm->is_fw_dw_rsvd_page_in_progress = false; -+#endif -+} -+ -+void -+hal_txbf_8814a_fw_txbf_cmd( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 idx, period = 0; -+ u8 PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u8 u1_tx_bf_parm[3] = {0}; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ if (beam_info->beamformee_entry[idx].is_used && beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (beam_info->beamformee_entry[idx].is_sound) { -+ PageNum0 = 0xFE; -+ PageNum1 = 0x07; -+ period = (u8)(beam_info->beamformee_entry[idx].sound_period); -+ } else if (PageNum0 == 0xFF) { -+ PageNum0 = 0xFF; /*stop sounding*/ -+ PageNum1 = 0x0F; -+ } -+ } -+ } -+ -+ u1_tx_bf_parm[0] = PageNum0; -+ u1_tx_bf_parm[1] = PageNum1; -+ u1_tx_bf_parm[2] = period; -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] PageNum0 = %d, PageNum1 = %d period = %d\n", __func__, -+ PageNum0, PageNum1, period); -+} -+#endif -+void hal_txbf_8814a_enter(void *dm_void, u8 bfer_bfee_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ u8 bfer_idx = (bfer_bfee_idx & 0xF0) >> 4; -+ u8 bfee_idx = (bfer_bfee_idx & 0xF); -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY beamformee_entry; -+ struct _RT_BEAMFORMER_ENTRY beamformer_entry; -+ u16 sta_id = 0, csi_param = 0; -+ u8 nc_index = 0, nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] bfer_idx=%d, bfee_idx=%d\n", __func__, -+ bfer_idx, bfee_idx); -+ odm_set_mac_reg(dm, REG_SND_PTCL_CTRL_8814A, MASKBYTE1 | MASKBYTE2, 0x0202); -+ -+ if (beamforming_info->beamformer_su_cnt > 0 && bfer_idx < BEAMFORMER_ENTRY_NUM) { -+ beamformer_entry = beamforming_info->beamformer_entry[bfer_idx]; -+ /*Sounding protocol control*/ -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8814A, 0xDB); -+ -+ /*@MAC address/Partial AID of Beamformer*/ -+ if (bfer_idx == 0) { -+ for (i = 0; i < 6; i++) -+ odm_write_1byte(dm, (REG_ASSOCIATED_BFMER0_INFO_8814A + i), beamformer_entry.mac_addr[i]); -+ } else { -+ for (i = 0; i < 6; i++) -+ odm_write_1byte(dm, (REG_ASSOCIATED_BFMER1_INFO_8814A + i), beamformer_entry.mac_addr[i]); -+ } -+ -+ /*@CSI report parameters of Beamformer*/ -+ nc_index = hal_txbf_8814a_get_nrx(dm); /*@for 8814A nrx = 3(4 ant), min=0(1 ant)*/ -+ nr_index = beamformer_entry.num_of_sounding_dim; /*@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 (beamformer_entry.beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU) -+ codebookinfo = 1; -+ else if (beamformer_entry.beamform_entry_cap & BEAMFORMEE_CAP_HT_EXPLICIT) -+ codebookinfo = 3; -+ -+ coefficientsize = 3; -+ -+ csi_param = (u16)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (nr_index << 3) | (nc_index)); -+ -+ if (bfer_idx == 0) -+ odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW20_8814A, csi_param); -+ else -+ odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW20_8814A + 2, csi_param); -+ /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8814A + 3, 0x40); -+ } -+ -+ if (beamforming_info->beamformee_su_cnt > 0 && bfee_idx < BEAMFORMEE_ENTRY_NUM) { -+ beamformee_entry = beamforming_info->beamformee_entry[bfee_idx]; -+ -+ hal_txbf_8814a_rf_mode(dm, beamforming_info, bfee_idx); -+ -+ if (phydm_acting_determine(dm, phydm_acting_as_ibss)) -+ sta_id = beamformee_entry.mac_id; -+ else -+ sta_id = beamformee_entry.p_aid; -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (bfee_idx == 0) { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8814A, sta_id); -+ odm_write_1byte(dm, REG_TXBF_CTRL_8814A + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8814A + 3) | BIT(4) | BIT(6) | BIT(7)); -+ } else -+ odm_write_2byte(dm, REG_TXBF_CTRL_8814A + 2, sta_id | BIT(14) | BIT(15) | BIT(12)); -+ -+ /*@CSI report parameters of Beamformee*/ -+ if (bfee_idx == 0) { -+ /*@Get BIT24 & BIT25*/ -+ u8 tmp = odm_read_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3) & 0x3; -+ -+ odm_write_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3, tmp | 0x60); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A, sta_id | BIT(9)); -+ } else -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, sta_id | 0xE200); /*Set BIT25*/ -+ -+ phydm_beamforming_notify(dm); -+ } -+} -+ -+void hal_txbf_8814a_leave(void *dm_void, u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMER_ENTRY beamformer_entry; -+ struct _RT_BEAMFORMEE_ENTRY beamformee_entry; -+ -+ if (idx < BEAMFORMER_ENTRY_NUM) { -+ beamformer_entry = beamforming_info->beamformer_entry[idx]; -+ beamformee_entry = beamforming_info->beamformee_entry[idx]; -+ } else -+ return; -+ -+ /*@Clear P_AID of Beamformee*/ -+ /*@Clear MAC address of Beamformer*/ -+ /*@Clear Associated Bfmee Sel*/ -+ -+ if (beamformer_entry.beamform_entry_cap == BEAMFORMING_CAP_NONE) { -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8814A, 0xD8); -+ if (idx == 0) { -+ odm_write_4byte(dm, REG_ASSOCIATED_BFMER0_INFO_8814A, 0); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMER0_INFO_8814A + 4, 0); -+ odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW20_8814A, 0); -+ } else { -+ odm_write_4byte(dm, REG_ASSOCIATED_BFMER1_INFO_8814A, 0); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMER1_INFO_8814A + 4, 0); -+ odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW20_8814A + 2, 0); -+ } -+ } -+ -+ if (beamformee_entry.beamform_entry_cap == BEAMFORMING_CAP_NONE) { -+ hal_txbf_8814a_rf_mode(dm, beamforming_info, idx); -+ if (idx == 0) { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8814A, 0x0); -+ odm_write_1byte(dm, REG_TXBF_CTRL_8814A + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8814A + 3) | BIT(4) | BIT(6) | BIT(7)); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A, 0); -+ } else { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8814A + 2, 0x0 | BIT(14) | BIT(15) | BIT(12)); -+ -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, odm_read_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2) & 0x60); -+ } -+ } -+} -+ -+void hal_txbf_8814a_status(void *dm_void, u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 beam_ctrl_val, tmp_val; -+ u32 beam_ctrl_reg; -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY beamform_entry; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ beamform_entry = beamforming_info->beamformee_entry[idx]; -+ else -+ return; -+ -+ if (phydm_acting_determine(dm, phydm_acting_as_ibss)) -+ beam_ctrl_val = beamform_entry.mac_id; -+ else -+ beam_ctrl_val = beamform_entry.p_aid; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "@%s, beamform_entry.beamform_entry_state = %d", -+ __func__, beamform_entry.beamform_entry_state); -+ -+ if (idx == 0) -+ beam_ctrl_reg = REG_TXBF_CTRL_8814A; -+ else { -+ beam_ctrl_reg = REG_TXBF_CTRL_8814A + 2; -+ beam_ctrl_val |= BIT(12) | BIT(14) | BIT(15); -+ } -+ -+ if (beamform_entry.beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED && beamforming_info->apply_v_matrix == true) { -+ if (beamform_entry.sound_bw == CHANNEL_WIDTH_20) -+ beam_ctrl_val |= BIT(9); -+ else if (beamform_entry.sound_bw == CHANNEL_WIDTH_40) -+ beam_ctrl_val |= (BIT(9) | BIT(10)); -+ else if (beamform_entry.sound_bw == CHANNEL_WIDTH_80) -+ beam_ctrl_val |= (BIT(9) | BIT(10) | BIT(11)); -+ } else { -+ PHYDM_DBG(dm, DBG_TXBF, "@%s, Don't apply Vmatrix", __func__); -+ beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); -+ } -+ -+ odm_write_2byte(dm, beam_ctrl_reg, beam_ctrl_val); -+ /*@disable NDP packet use beamforming */ -+ tmp_val = odm_read_2byte(dm, REG_TXBF_CTRL_8814A); -+ odm_write_2byte(dm, REG_TXBF_CTRL_8814A, tmp_val | BIT(15)); -+} -+ -+void hal_txbf_8814a_fw_txbf(void *dm_void, u8 idx) -+{ -+#if 0 -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (p_beam_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ hal_txbf_8814a_download_ndpa(dm, idx); -+ -+ hal_txbf_8814a_fw_txbf_cmd(dm); -+#endif -+} -+ -+#endif /* @(RTL8814A_SUPPORT == 1)*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8814a.h b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8814a.h -new file mode 100644 -index 000000000..61b33bbfb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8814a.h -@@ -0,0 +1,77 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#ifndef __HAL_TXBF_8814A_H__ -+#define __HAL_TXBF_8814A_H__ -+ -+#if (RTL8814A_SUPPORT == 1) -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ -+boolean -+phydm_beamforming_set_iqgen_8814A(void *dm_void); -+ -+void hal_txbf_8814a_set_ndpa_rate(void *dm_void, u8 BW, u8 rate); -+ -+u8 hal_txbf_8814a_get_ntx(void *dm_void); -+ -+void hal_txbf_8814a_enter(void *dm_void, u8 idx); -+ -+void hal_txbf_8814a_leave(void *dm_void, u8 idx); -+ -+void hal_txbf_8814a_status(void *dm_void, u8 idx); -+ -+void hal_txbf_8814a_reset_tx_path(void *dm_void, u8 idx); -+ -+void hal_txbf_8814a_get_tx_rate(void *dm_void); -+ -+void hal_txbf_8814a_fw_txbf(void *dm_void, u8 idx); -+ -+#else -+ -+#define hal_txbf_8814a_set_ndpa_rate(dm_void, BW, rate) -+#define hal_txbf_8814a_get_ntx(dm_void) 0 -+#define hal_txbf_8814a_enter(dm_void, idx) -+#define hal_txbf_8814a_leave(dm_void, idx) -+#define hal_txbf_8814a_status(dm_void, idx) -+#define hal_txbf_8814a_reset_tx_path(dm_void, idx) -+#define hal_txbf_8814a_get_tx_rate(dm_void) -+#define hal_txbf_8814a_fw_txbf(dm_void, idx) -+#define phydm_beamforming_set_iqgen_8814A(dm_void) 0 -+ -+#endif -+ -+#else -+ -+#define hal_txbf_8814a_set_ndpa_rate(dm_void, BW, rate) -+#define hal_txbf_8814a_get_ntx(dm_void) 0 -+#define hal_txbf_8814a_enter(dm_void, idx) -+#define hal_txbf_8814a_leave(dm_void, idx) -+#define hal_txbf_8814a_status(dm_void, idx) -+#define hal_txbf_8814a_reset_tx_path(dm_void, idx) -+#define hal_txbf_8814a_get_tx_rate(dm_void) -+#define hal_txbf_8814a_fw_txbf(dm_void, idx) -+#define phydm_beamforming_set_iqgen_8814A(dm_void) 0 -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8822b.c b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8822b.c -new file mode 100644 -index 000000000..a1d35c9b1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8822b.c -@@ -0,0 +1,1088 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 8814A TXBF mechanism */ -+/* @*/ -+/*@============================================================*/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (RTL8822B_SUPPORT == 1) -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ -+u8 hal_txbf_8822b_get_ntx( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 ntx = 0; -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ if (dm->support_interface == ODM_ITRF_USB) { -+ if (*dm->hub_usb_mode == 2) { /*USB3.0*/ -+ if (dm->rf_type == RF_4T4R) -+ ntx = 3; -+ else if (dm->rf_type == RF_3T3R) -+ ntx = 2; -+ else -+ ntx = 1; -+ } else if (*dm->hub_usb_mode == 1) /*USB 2.0 always 2Tx*/ -+ ntx = 1; -+ else -+ ntx = 1; -+ } else -+#endif -+ { -+ if (dm->rf_type == RF_4T4R) -+ ntx = 3; -+ else if (dm->rf_type == RF_3T3R) -+ ntx = 2; -+ else -+ ntx = 1; -+ } -+ -+ return ntx; -+} -+ -+u8 hal_txbf_8822b_get_nrx( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 nrx = 0; -+ -+ if (dm->rf_type == RF_4T4R) -+ nrx = 3; -+ else if (dm->rf_type == RF_3T3R) -+ nrx = 2; -+ else if (dm->rf_type == RF_2T2R) -+ nrx = 1; -+ else if (dm->rf_type == RF_2T3R) -+ nrx = 2; -+ else if (dm->rf_type == RF_2T4R) -+ nrx = 3; -+ else if (dm->rf_type == RF_1T1R) -+ nrx = 0; -+ else if (dm->rf_type == RF_1T2R) -+ nrx = 1; -+ else -+ nrx = 0; -+ -+ return nrx; -+} -+ -+/***************SU & MU BFee Entry********************/ -+void hal_txbf_8822b_rf_mode( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beamforming_info, -+ u8 idx) -+{ -+#if 0 -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i, nr_index = 0; -+ boolean is_self_beamformer = false; -+ boolean is_self_beamformee = false; -+ struct _RT_BEAMFORMEE_ENTRY beamformee_entry; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ beamformee_entry = beamforming_info->beamformee_entry[idx]; -+ else -+ return; -+ -+ if (dm->rf_type == RF_1T1R) -+ return; -+ -+ for (i = RF_PATH_A; i < RF_PATH_B; i++) { -+ odm_set_rf_reg(dm, (enum rf_path)i, rf_welut_jaguar, 0x80000, 0x1); -+ /*RF mode table write enable*/ -+ } -+ -+ if (beamforming_info->beamformee_su_cnt > 0 || beamforming_info->beamformee_mu_cnt > 0) { -+ for (i = RF_PATH_A; i < RF_PATH_B; i++) { -+ odm_set_rf_reg(dm, (enum rf_path)i, rf_mode_table_addr, 0xfffff, 0x18000); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, rf_mode_table_data0, 0xfffff, 0xBE77F); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, rf_mode_table_data1, 0xfffff, 0x226BF); -+ /*@Enable TXIQGEN in RX mode*/ -+ } -+ odm_set_rf_reg(dm, RF_PATH_A, rf_mode_table_data1, 0xfffff, 0xE26BF); -+ /*@Enable TXIQGEN in RX mode*/ -+ } -+ -+ for (i = RF_PATH_A; i < RF_PATH_B; i++) { -+ odm_set_rf_reg(dm, (enum rf_path)i, rf_welut_jaguar, 0x80000, 0x0); -+ /*RF mode table write disable*/ -+ } -+ -+ if (beamforming_info->beamformee_su_cnt > 0) { -+ /*@for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x2); /*@enable BB TxBF ant mapping register*/ -+ -+ if (idx == 0) { -+ /*Nsts = 2 AB*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF0_8822B, 0xffff, 0x0433); -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); -+ /*odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2, MASKLWORD, 0x430);*/ -+ -+ } else {/*@IDX =1*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); -+ /*odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2, MASKLWORD, 0x430;*/ -+ } -+ } else { -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*@1SS by path-A*/ -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8822B, MASKLWORD, 0x430); /*@2SS by path-A,B*/ -+ } -+ -+ if (beamforming_info->beamformee_mu_cnt > 0) { -+ /*@MU STAs share the common setting*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 1); -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); -+ } -+#endif -+} -+#if 0 -+void -+hal_txbf_8822b_download_ndpa( -+ void *adapter, -+ u8 idx -+) -+{ -+ u8 u1b_tmp = 0, tmp_reg422 = 0; -+ u8 bcn_valid_reg = 0, count = 0, dl_bcn_count = 0; -+ u16 head_page = 0x7FE; -+ boolean is_send_beacon = false; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u16 tx_page_bndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*@default reseved 1 page for the IC type which is undefined.*/ -+ struct _RT_BEAMFORMING_INFO *beam_info = GET_BEAMFORM_INFO(adapter); -+ struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; -+ -+ hal_data->is_fw_dw_rsvd_page_in_progress = true; -+ phydm_get_hal_def_var_handler_interface(dm, HAL_DEF_TX_PAGE_BOUNDARY, (u16 *)&tx_page_bndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1b_tmp = platform_efio_read_1byte(adapter, REG_CR_8814A + 1); -+ platform_efio_write_1byte(adapter, REG_CR_8814A + 1, (u1b_tmp | BIT(0))); -+ -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmp_reg422 = platform_efio_read_1byte(adapter, REG_FWHW_TXQ_CTRL_8814A + 2); -+ platform_efio_write_1byte(adapter, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422 & (~BIT(6))); -+ -+ if (tmp_reg422 & BIT(6)) { -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("SetBeamformDownloadNDPA_8814A(): There is an adapter is sending beacon.\n")); -+ is_send_beacon = true; -+ } -+ -+ /*@0x204[11:0] Beacon Head for TXDMA*/ -+ platform_efio_write_2byte(adapter, REG_FIFOPAGE_CTRL_2_8814A, head_page); -+ -+ do { -+ /*@Clear beacon valid check bit.*/ -+ bcn_valid_reg = platform_efio_read_1byte(adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); -+ platform_efio_write_1byte(adapter, REG_FIFOPAGE_CTRL_2_8814A + 1, (bcn_valid_reg | BIT(7))); -+ -+ /*@download NDPA rsvd page.*/ -+ if (p_beam_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) -+ beamforming_send_vht_ndpa_packet(dm, p_beam_entry->mac_addr, p_beam_entry->AID, p_beam_entry->sound_bw, BEACON_QUEUE); -+ else -+ beamforming_send_ht_ndpa_packet(dm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); -+ -+ /*@check rsvd page download OK.*/ -+ bcn_valid_reg = platform_efio_read_1byte(adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); -+ count = 0; -+ while (!(bcn_valid_reg & BIT(7)) && count < 20) { -+ count++; -+ delay_us(10); -+ bcn_valid_reg = platform_efio_read_1byte(adapter, REG_FIFOPAGE_CTRL_2_8814A + 2); -+ } -+ dl_bcn_count++; -+ } while (!(bcn_valid_reg & BIT(7)) && dl_bcn_count < 5); -+ -+ if (!(bcn_valid_reg & BIT(0))) -+ RT_DISP(FBEAM, FBEAM_ERROR, ("%s Download RSVD page failed!\n", __func__)); -+ -+ /*@0x204[11:0] Beacon Head for TXDMA*/ -+ platform_efio_write_2byte(adapter, REG_FIFOPAGE_CTRL_2_8814A, tx_page_bndy); -+ -+ /*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 (is_send_beacon) -+ platform_efio_write_1byte(adapter, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422); -+ -+ /*@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.*/ -+ u1b_tmp = platform_efio_read_1byte(adapter, REG_CR_8814A + 1); -+ platform_efio_write_1byte(adapter, REG_CR_8814A + 1, (u1b_tmp & (~BIT(0)))); -+ -+ p_beam_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ -+ hal_data->is_fw_dw_rsvd_page_in_progress = false; -+} -+ -+void -+hal_txbf_8822b_fw_txbf_cmd( -+ void *adapter -+) -+{ -+ u8 idx, period = 0; -+ u8 PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u8 u1_tx_bf_parm[3] = {0}; -+ -+ PMGNT_INFO mgnt_info = &(adapter->MgntInfo); -+ struct _RT_BEAMFORMING_INFO *beam_info = GET_BEAMFORM_INFO(adapter); -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ if (beam_info->beamformee_entry[idx].is_used && beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (beam_info->beamformee_entry[idx].is_sound) { -+ PageNum0 = 0xFE; -+ PageNum1 = 0x07; -+ period = (u8)(beam_info->beamformee_entry[idx].sound_period); -+ } else if (PageNum0 == 0xFF) { -+ PageNum0 = 0xFF; /*stop sounding*/ -+ PageNum1 = 0x0F; -+ } -+ } -+ } -+ -+ u1_tx_bf_parm[0] = PageNum0; -+ u1_tx_bf_parm[1] = PageNum1; -+ u1_tx_bf_parm[2] = period; -+ fill_h2c_cmd(adapter, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); -+ -+ RT_DISP(FBEAM, FBEAM_FUN, ("@%s End, PageNum0 = 0x%x, PageNum1 = 0x%x period = %d", __func__, PageNum0, PageNum1, period)); -+} -+#endif -+ -+#if 0 -+void -+hal_txbf_8822b_init( -+ void *dm_void -+) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 u1b_tmp; -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ void *adapter = dm->adapter; -+ -+ odm_set_bb_reg(dm, R_0x14c0, BIT(16), 1); /*@Enable P1 aggr new packet according to P0 transfer time*/ -+ odm_set_bb_reg(dm, R_0x14c0, BIT(15) | BIT14 | BIT13 | BIT12, 10); /*@MU Retry Limit*/ -+ odm_set_bb_reg(dm, R_0x14c0, BIT(7), 0); /*@Disable Tx MU-MIMO until sounding done*/ -+ odm_set_bb_reg(dm, R_0x14c0, 0x3F, 0); /* @Clear validity of MU STAs */ -+ odm_write_1byte(dm, 0x167c, 0x70); /*@MU-MIMO Option as default value*/ -+ odm_write_2byte(dm, 0x1680, 0); /*@MU-MIMO Control as default value*/ -+ -+ /* Set MU NDPA rate & BW source */ -+ /* @0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ -+ u1b_tmp = odm_read_1byte(dm, 0x42C); -+ odm_write_1byte(dm, REG_TXBF_CTRL_8822B, (u1b_tmp | BIT(6))); -+ /* @0x45F[7:0] = 0x10 (rate=OFDM_6M, BW20) */ -+ odm_write_1byte(dm, REG_NDPA_OPT_CTRL_8822B, 0x10); -+ -+ /*Temp Settings*/ -+ odm_set_bb_reg(dm, R_0x6dc, 0x3F000000, 4); /*STA2's CSI rate is fixed at 6M*/ -+ odm_set_bb_reg(dm, R_0x1c94, MASKDWORD, 0xAFFFAFFF); /*@Grouping bitmap parameters*/ -+ -+ /* @Init HW variable */ -+ beamforming_info->reg_mu_tx_ctrl = odm_read_4byte(dm, 0x14c0); -+ -+ if (dm->rf_type == RF_2T2R) { /*@2T2R*/ -+ PHYDM_DBG(dm, DBG_TXBF, "%s: rf_type is 2T2R\n", __func__); -+ config_phydm_trx_mode_8822b(dm, (enum bb_path)3, -+ (enum bb_path)3, BB_PATH_AB; -+ } -+ -+#if (OMNIPEEK_SNIFFER_ENABLED == 1) -+ /* @Config HW to receive packet on the user position from registry for sniffer mode. */ -+ /* odm_set_bb_reg(dm, R_0xb00, BIT(9), 1);*/ /* For A-cut only. RegB00[9] = 1 (enable PMAC Rx) */ -+ odm_set_bb_reg(dm, R_0xb54, BIT(30), 1); /* RegB54[30] = 1 (force user position) */ -+ odm_set_bb_reg(dm, R_0xb54, (BIT(29) | BIT28), adapter->MgntInfo.sniff_user_position); /* RegB54[29:28] = user position (0~3) */ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "Set adapter->MgntInfo.sniff_user_position=%#X\n", -+ adapter->MgntInfo.sniff_user_position); -+#endif -+} -+#endif -+ -+void hal_txbf_8822b_enter( -+ void *dm_void, -+ u8 bfer_bfee_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ u8 bfer_idx = (bfer_bfee_idx & 0xF0) >> 4; -+ u8 bfee_idx = (bfer_bfee_idx & 0xF); -+ u16 csi_param = 0; -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *p_beamformee_entry; -+ struct _RT_BEAMFORMER_ENTRY *beamformer_entry; -+ u16 value16, sta_id = 0; -+ u8 nc_index = 0, nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; -+ u32 gid_valid, user_position_l, user_position_h; -+ u32 mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; -+ u8 u1b_tmp; -+ u32 u4b_tmp; -+ -+ RT_DISP(FBEAM, FBEAM_FUN, ("%s: bfer_bfee_idx=%d, bfer_idx=%d, bfee_idx=%d\n", __func__, bfer_bfee_idx, bfer_idx, bfee_idx)); -+ -+ /*************SU BFer Entry Init*************/ -+ if (beamforming_info->beamformer_su_cnt > 0 && bfer_idx < BEAMFORMER_ENTRY_NUM) { -+ beamformer_entry = &beamforming_info->beamformer_entry[bfer_idx]; -+ beamformer_entry->is_mu_ap = false; -+ /*Sounding protocol control*/ -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8822B, 0xDB); -+ -+ for (i = 0; i < MAX_BEAMFORMER_SU; i++) { -+ if ((beamforming_info->beamformer_su_reg_maping & BIT(i)) == 0) { -+ beamforming_info->beamformer_su_reg_maping |= BIT(i); -+ beamformer_entry->su_reg_index = i; -+ break; -+ } -+ } -+ -+ /*@MAC address/Partial AID of Beamformer*/ -+ if (beamformer_entry->su_reg_index == 0) { -+ for (i = 0; i < 6; i++) -+ odm_write_1byte(dm, (REG_ASSOCIATED_BFMER0_INFO_8822B + i), beamformer_entry->mac_addr[i]); -+ } else { -+ for (i = 0; i < 6; i++) -+ odm_write_1byte(dm, (REG_ASSOCIATED_BFMER1_INFO_8822B + i), beamformer_entry->mac_addr[i]); -+ } -+ -+ /*@CSI report parameters of Beamformer*/ -+ nc_index = hal_txbf_8822b_get_nrx(dm); /*@for 8814A nrx = 3(4 ant), min=0(1 ant)*/ -+ nr_index = beamformer_entry->num_of_sounding_dim; /*@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 (beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU) -+ codebookinfo = 1; -+ else if (beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_HT_EXPLICIT) -+ codebookinfo = 3; -+ -+ coefficientsize = 3; -+ -+ csi_param = (u16)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (nr_index << 3) | (nc_index)); -+ -+ if (bfer_idx == 0) -+ odm_write_2byte(dm, REG_TX_CSI_RPT_PARAM_BW20_8822B, csi_param); -+ else -+ odm_write_2byte(dm, REG_TX_CSI_RPT_PARAM_BW20_8822B + 2, csi_param); -+ /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8822B + 3, 0x70); -+ } -+ -+ /*************SU BFee Entry Init*************/ -+ if (beamforming_info->beamformee_su_cnt > 0 && bfee_idx < BEAMFORMEE_ENTRY_NUM) { -+ p_beamformee_entry = &beamforming_info->beamformee_entry[bfee_idx]; -+ p_beamformee_entry->is_mu_sta = false; -+ hal_txbf_8822b_rf_mode(dm, beamforming_info, bfee_idx); -+ -+ if (phydm_acting_determine(dm, phydm_acting_as_ibss)) -+ sta_id = p_beamformee_entry->mac_id; -+ else -+ sta_id = p_beamformee_entry->p_aid; -+ -+ for (i = 0; i < MAX_BEAMFORMEE_SU; i++) { -+ if ((beamforming_info->beamformee_su_reg_maping & BIT(i)) == 0) { -+ beamforming_info->beamformee_su_reg_maping |= BIT(i); -+ p_beamformee_entry->su_reg_index = i; -+ break; -+ } -+ } -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (p_beamformee_entry->su_reg_index == 0) { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8822B, sta_id); -+ odm_write_1byte(dm, REG_TXBF_CTRL_8822B + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8822B + 3) | BIT(4) | BIT(6) | BIT(7)); -+ } else -+ odm_write_2byte(dm, REG_TXBF_CTRL_8822B + 2, sta_id | BIT(14) | BIT(15) | BIT(12)); -+ -+ /*@CSI report parameters of Beamformee*/ -+ if (p_beamformee_entry->su_reg_index == 0) { -+ /*@Get BIT24 & BIT25*/ -+ u8 tmp = odm_read_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3) & 0x3; -+ -+ odm_write_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3, tmp | 0x60); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B, sta_id | BIT(9)); -+ } else -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2, sta_id | 0xE200); /*Set BIT25*/ -+ -+ phydm_beamforming_notify(dm); -+ } -+ -+ /*************MU BFer Entry Init*************/ -+ if (beamforming_info->beamformer_mu_cnt > 0 && bfer_idx < BEAMFORMER_ENTRY_NUM) { -+ beamformer_entry = &beamforming_info->beamformer_entry[bfer_idx]; -+ beamforming_info->mu_ap_index = bfer_idx; -+ beamformer_entry->is_mu_ap = true; -+ for (i = 0; i < 8; i++) -+ beamformer_entry->gid_valid[i] = 0; -+ for (i = 0; i < 16; i++) -+ beamformer_entry->user_position[i] = 0; -+ -+ /*Sounding protocol control*/ -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8822B, 0xDB); -+ -+ /* @MAC address */ -+ for (i = 0; i < 6; i++) -+ odm_write_1byte(dm, (REG_ASSOCIATED_BFMER0_INFO_8822B + i), beamformer_entry->mac_addr[i]); -+ -+ /* Set partial AID */ -+ odm_write_2byte(dm, (REG_ASSOCIATED_BFMER0_INFO_8822B + 6), beamformer_entry->p_aid); -+ -+ /* @Fill our AID to 0x1680[11:0] and [13:12] = 2b'00, BF report segment select to 3895 bytes*/ -+ u1b_tmp = odm_read_1byte(dm, 0x1680); -+ u1b_tmp = (beamformer_entry->p_aid) & 0xFFF; -+ odm_write_1byte(dm, 0x1680, u1b_tmp); -+ -+ /* Set 80us for leaving ndp_rx_standby_state */ -+ odm_write_1byte(dm, 0x71B, 0x50); -+ -+ /* Set 0x6A0[14] = 1 to accept action_no_ack */ -+ u1b_tmp = odm_read_1byte(dm, REG_RXFLTMAP0_8822B + 1); -+ u1b_tmp |= 0x40; -+ odm_write_1byte(dm, REG_RXFLTMAP0_8822B + 1, u1b_tmp); -+ /* Set 0x6A2[5:4] = 1 to NDPA and BF report poll */ -+ u1b_tmp = odm_read_1byte(dm, REG_RXFLTMAP1_8822B); -+ u1b_tmp |= 0x30; -+ odm_write_1byte(dm, REG_RXFLTMAP1_8822B, u1b_tmp); -+ -+ /*@CSI report parameters of Beamformer*/ -+ nc_index = hal_txbf_8822b_get_nrx(dm); /* @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 = (u16)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (nr_index << 3) | (nc_index)); -+ odm_write_2byte(dm, 0x6F4, csi_param); -+ -+ /*@for B-cut*/ -+ odm_set_bb_reg(dm, R_0x6a0, BIT(20), 0); -+ odm_set_bb_reg(dm, R_0x688, BIT(20), 0); -+ } -+ -+ /*************MU BFee Entry Init*************/ -+ if (beamforming_info->beamformee_mu_cnt > 0 && bfee_idx < BEAMFORMEE_ENTRY_NUM) { -+ p_beamformee_entry = &beamforming_info->beamformee_entry[bfee_idx]; -+ p_beamformee_entry->is_mu_sta = true; -+ for (i = 0; i < MAX_BEAMFORMEE_MU; i++) { -+ if ((beamforming_info->beamformee_mu_reg_maping & BIT(i)) == 0) { -+ beamforming_info->beamformee_mu_reg_maping |= BIT(i); -+ p_beamformee_entry->mu_reg_index = i; -+ break; -+ } -+ } -+ -+ if (p_beamformee_entry->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 (p_beamformee_entry->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) { -+ p_beamformee_entry->gid_valid[i] = (u8)(gid_valid & 0xFF); -+ gid_valid = (gid_valid >> 8); -+ } else -+ p_beamformee_entry->gid_valid[i] = 0; -+ } -+ for (i = 0; i < 16; i++) { -+ if (i < 4) -+ p_beamformee_entry->user_position[i] = (u8)((user_position_l >> (i * 8)) & 0xFF); -+ else if (i < 8) -+ p_beamformee_entry->user_position[i] = (u8)((user_position_h >> ((i - 4) * 8)) & 0xFF); -+ else -+ p_beamformee_entry->user_position[i] = 0; -+ } -+ -+ /*Sounding protocol control*/ -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8822B, 0xDB); -+ -+ /*select MU STA table*/ -+ beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); -+ beamforming_info->reg_mu_tx_ctrl |= (p_beamformee_entry->mu_reg_index << 8) & (BIT(8) | BIT(9) | BIT(10)); -+ odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); -+ -+ odm_set_bb_reg(dm, R_0x14c4, MASKDWORD, 0); /*Reset gid_valid table*/ -+ odm_set_bb_reg(dm, R_0x14c8, MASKDWORD, user_position_l); -+ odm_set_bb_reg(dm, R_0x14cc, MASKDWORD, user_position_h); -+ -+ /*set validity of MU STAs*/ -+ beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; -+ beamforming_info->reg_mu_tx_ctrl |= beamforming_info->beamformee_mu_reg_maping & 0x3F; -+ odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "@%s, reg_mu_tx_ctrl = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", -+ __func__, beamforming_info->reg_mu_tx_ctrl, -+ user_position_l, user_position_h); -+ -+ value16 = odm_read_2byte(dm, mu_reg[p_beamformee_entry->mu_reg_index]); -+ value16 &= 0xFE00; /*@Clear PAID*/ -+ value16 |= BIT(9); /*@Enable MU BFee*/ -+ value16 |= p_beamformee_entry->p_aid; -+ odm_write_2byte(dm, mu_reg[p_beamformee_entry->mu_reg_index], value16); -+ -+ /* @0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ -+ u1b_tmp = odm_read_1byte(dm, REG_TXBF_CTRL_8822B + 3); -+ u1b_tmp |= 0xD0; /* Set bit 28, 30, 31 to 3b'111*/ -+ odm_write_1byte(dm, REG_TXBF_CTRL_8822B + 3, u1b_tmp); -+ /* Set NDPA to 6M*/ -+ odm_write_1byte(dm, REG_NDPA_RATE_8822B, 0x4); -+ -+ u1b_tmp = odm_read_1byte(dm, REG_NDPA_OPT_CTRL_8822B); -+ u1b_tmp &= 0xFC; /* @Clear bit 0, 1*/ -+ odm_write_1byte(dm, REG_NDPA_OPT_CTRL_8822B, u1b_tmp); -+ -+ u4b_tmp = odm_read_4byte(dm, REG_SND_PTCL_CTRL_8822B); -+ u4b_tmp = ((u4b_tmp & 0xFF0000FF) | 0x020200); /* Set [23:8] to 0x0202*/ -+ odm_write_4byte(dm, REG_SND_PTCL_CTRL_8822B, u4b_tmp); -+ -+ /* Set 0x6A0[14] = 1 to accept action_no_ack */ -+ u1b_tmp = odm_read_1byte(dm, REG_RXFLTMAP0_8822B + 1); -+ u1b_tmp |= 0x40; -+ odm_write_1byte(dm, REG_RXFLTMAP0_8822B + 1, u1b_tmp); -+ /* @End of MAC registers setting */ -+ -+ hal_txbf_8822b_rf_mode(dm, beamforming_info, bfee_idx); -+#if (SUPPORT_MU_BF == 1) -+ /*Special for plugfest*/ -+ delay_ms(50); /* wait for 4-way handshake ending*/ -+ send_sw_vht_gid_mgnt_frame(dm, p_beamformee_entry->mac_addr, bfee_idx); -+#endif -+ -+ phydm_beamforming_notify(dm); -+#if 1 -+ { -+ u32 ctrl_info_offset, index; -+ /*Set Ctrl Info*/ -+ odm_write_2byte(dm, 0x140, 0x660); -+ ctrl_info_offset = 0x8000 + 32 * p_beamformee_entry->mac_id; -+ /*Reset Ctrl Info*/ -+ for (index = 0; index < 8; index++) -+ odm_write_4byte(dm, ctrl_info_offset + index * 4, 0); -+ -+ odm_write_4byte(dm, ctrl_info_offset, (p_beamformee_entry->mu_reg_index + 1) << 16); -+ odm_write_1byte(dm, 0x81, 0x80); /*RPTBUF ready*/ -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "@%s, mac_id = %d, ctrl_info_offset = 0x%x, mu_reg_index = %x\n", -+ __func__, p_beamformee_entry->mac_id, -+ ctrl_info_offset, -+ p_beamformee_entry->mu_reg_index); -+ } -+#endif -+ } -+} -+ -+void hal_txbf_8822b_leave( -+ void *dm_void, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMER_ENTRY *beamformer_entry; -+ struct _RT_BEAMFORMEE_ENTRY *p_beamformee_entry; -+ u32 mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; -+ -+ if (idx < BEAMFORMER_ENTRY_NUM) { -+ beamformer_entry = &beamforming_info->beamformer_entry[idx]; -+ p_beamformee_entry = &beamforming_info->beamformee_entry[idx]; -+ } else -+ return; -+ -+ /*@Clear P_AID of Beamformee*/ -+ /*@Clear MAC address of Beamformer*/ -+ /*@Clear Associated Bfmee Sel*/ -+ -+ if (beamformer_entry->beamform_entry_cap == BEAMFORMING_CAP_NONE) { -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8822B, 0xD8); -+ if (beamformer_entry->is_mu_ap == 0) { /*SU BFer */ -+ if (beamformer_entry->su_reg_index == 0) { -+ odm_write_4byte(dm, REG_ASSOCIATED_BFMER0_INFO_8822B, 0); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMER0_INFO_8822B + 4, 0); -+ odm_write_2byte(dm, REG_TX_CSI_RPT_PARAM_BW20_8822B, 0); -+ } else { -+ odm_write_4byte(dm, REG_ASSOCIATED_BFMER1_INFO_8822B, 0); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMER1_INFO_8822B + 4, 0); -+ odm_write_2byte(dm, REG_TX_CSI_RPT_PARAM_BW20_8822B + 2, 0); -+ } -+ beamforming_info->beamformer_su_reg_maping &= ~(BIT(beamformer_entry->su_reg_index)); -+ beamformer_entry->su_reg_index = 0xFF; -+ } else { /*@MU BFer */ -+ /*set validity of MU STA0 and MU STA1*/ -+ beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; -+ odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); -+ -+ odm_memory_set(dm, beamformer_entry->gid_valid, 0, 8); -+ odm_memory_set(dm, beamformer_entry->user_position, 0, 16); -+ beamformer_entry->is_mu_ap = false; -+ } -+ } -+ -+ if (p_beamformee_entry->beamform_entry_cap == BEAMFORMING_CAP_NONE) { -+ hal_txbf_8822b_rf_mode(dm, beamforming_info, idx); -+ if (p_beamformee_entry->is_mu_sta == 0) { /*SU BFee*/ -+ if (p_beamformee_entry->su_reg_index == 0) { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8822B, 0x0); -+ odm_write_1byte(dm, REG_TXBF_CTRL_8822B + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8822B + 3) | BIT(4) | BIT(6) | BIT(7)); -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B, 0); -+ } else { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8822B + 2, 0x0 | BIT(14) | BIT(15) | BIT(12)); -+ -+ odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2, -+ odm_read_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2) & 0x60); -+ } -+ beamforming_info->beamformee_su_reg_maping &= ~(BIT(p_beamformee_entry->su_reg_index)); -+ p_beamformee_entry->su_reg_index = 0xFF; -+ } else { /*@MU BFee */ -+ /*@Disable sending NDPA & BF-rpt-poll to this BFee*/ -+ odm_write_2byte(dm, mu_reg[p_beamformee_entry->mu_reg_index], 0); -+ /*set validity of MU STA*/ -+ beamforming_info->reg_mu_tx_ctrl &= ~(BIT(p_beamformee_entry->mu_reg_index)); -+ odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); -+ -+ p_beamformee_entry->is_mu_sta = false; -+ beamforming_info->beamformee_mu_reg_maping &= ~(BIT(p_beamformee_entry->mu_reg_index)); -+ p_beamformee_entry->mu_reg_index = 0xFF; -+ } -+ } -+} -+ -+/***********SU & MU BFee Entry Only when souding done****************/ -+void hal_txbf_8822b_status( -+ void *dm_void, -+ u8 beamform_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 beam_ctrl_val, tmp_val; -+ u32 beam_ctrl_reg; -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry; -+ boolean is_mu_sounding = beamforming_info->is_mu_sounding, is_bitmap_ready = false; -+ u16 bitmap; -+ u8 idx, gid, i; -+ u8 id1, id0; -+ u32 gid_valid[6] = {0}; -+ u32 value32; -+ boolean is_sounding_success[6] = {false}; -+ -+ if (beamform_idx < BEAMFORMEE_ENTRY_NUM) -+ beamform_entry = &beamforming_info->beamformee_entry[beamform_idx]; -+ else -+ return; -+ -+ /*SU sounding done */ -+ if (is_mu_sounding == false) { -+ if (phydm_acting_determine(dm, phydm_acting_as_ibss)) -+ beam_ctrl_val = beamform_entry->mac_id; -+ else -+ beam_ctrl_val = beamform_entry->p_aid; -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "@%s, beamform_entry.beamform_entry_state = %d", -+ __func__, beamform_entry->beamform_entry_state); -+ -+ if (beamform_entry->su_reg_index == 0) -+ beam_ctrl_reg = REG_TXBF_CTRL_8822B; -+ else { -+ beam_ctrl_reg = REG_TXBF_CTRL_8822B + 2; -+ beam_ctrl_val |= BIT(12) | BIT(14) | BIT(15); -+ } -+ -+ if (beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (beamform_entry->sound_bw == CHANNEL_WIDTH_20) -+ beam_ctrl_val |= BIT(9); -+ else if (beamform_entry->sound_bw == CHANNEL_WIDTH_40) -+ beam_ctrl_val |= (BIT(9) | BIT(10)); -+ else if (beamform_entry->sound_bw == CHANNEL_WIDTH_80) -+ beam_ctrl_val |= (BIT(9) | BIT(10) | BIT(11)); -+ } else { -+ PHYDM_DBG(dm, DBG_TXBF, "@%s, Don't apply Vmatrix", -+ __func__); -+ beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); -+ } -+ -+ odm_write_2byte(dm, beam_ctrl_reg, beam_ctrl_val); -+ /*@disable NDP packet use beamforming */ -+ tmp_val = odm_read_2byte(dm, REG_TXBF_CTRL_8822B); -+ odm_write_2byte(dm, REG_TXBF_CTRL_8822B, tmp_val | BIT(15)); -+ } else { -+ PHYDM_DBG(dm, DBG_TXBF, "@%s, MU Sounding Done\n", __func__); -+ /*@MU sounding done */ -+ if (1) { /* @(beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { */ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "@%s, BEAMFORMING_ENTRY_STATE_PROGRESSED\n", -+ __func__); -+ -+ value32 = odm_get_bb_reg(dm, R_0x1684, MASKDWORD); -+ is_sounding_success[0] = (value32 & BIT(10)) ? 1 : 0; -+ is_sounding_success[1] = (value32 & BIT(26)) ? 1 : 0; -+ value32 = odm_get_bb_reg(dm, R_0x1688, MASKDWORD); -+ is_sounding_success[2] = (value32 & BIT(10)) ? 1 : 0; -+ is_sounding_success[3] = (value32 & BIT(26)) ? 1 : 0; -+ value32 = odm_get_bb_reg(dm, R_0x168c, MASKDWORD); -+ is_sounding_success[4] = (value32 & BIT(10)) ? 1 : 0; -+ is_sounding_success[5] = (value32 & BIT(26)) ? 1 : 0; -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "@%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_get_bb_reg(dm, R_0xf4c, 0xFFFF0000); -+ /* odm_set_bb_reg(dm, R_0x19e0, MASKHWORD, 0xFFFF);Let MAC ignore bitmap */ -+ -+ is_bitmap_ready = (boolean)((value32 & BIT(15)) >> 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++) { -+ beamform_entry = &beamforming_info->beamformee_entry[i]; -+ if (beamform_entry->is_mu_sta && beamform_entry->mu_reg_index < 6) { -+ value32 = gid_valid[beamform_entry->mu_reg_index]; -+ for (idx = 0; idx < 4; idx++) { -+ beamform_entry->gid_valid[idx] = (u8)(value32 & 0xFF); -+ value32 = (value32 >> 8); -+ } -+ } -+ } -+ -+ for (idx = 0; idx < 6; idx++) { -+ beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); -+ beamforming_info->reg_mu_tx_ctrl |= ((idx << 8) & (BIT(8) | BIT(9) | BIT(10))); -+ odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); -+ odm_set_mac_reg(dm, R_0x14c4, MASKDWORD, gid_valid[idx]); /*set MU STA gid valid table*/ -+ } -+ -+ /*@Enable TxMU PPDU*/ -+ if (beamforming_info->dbg_disable_mu_tx == false) -+ beamforming_info->reg_mu_tx_ctrl |= BIT(7); -+ else -+ beamforming_info->reg_mu_tx_ctrl &= ~BIT(7); -+ odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); -+ } -+ } -+} -+ -+/*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ -+void hal_txbf_8822b_config_gtab( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMER_ENTRY *beamformer_entry = NULL; -+ u32 gid_valid = 0, user_position_l = 0, user_position_h = 0, i; -+ -+ if (beamforming_info->mu_ap_index < BEAMFORMER_ENTRY_NUM) -+ beamformer_entry = &beamforming_info->beamformer_entry[beamforming_info->mu_ap_index]; -+ else -+ return; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "%s==>\n", __func__); -+ -+ /*@For GID 0~31*/ -+ for (i = 0; i < 4; i++) -+ gid_valid |= (beamformer_entry->gid_valid[i] << (i << 3)); -+ for (i = 0; i < 8; i++) { -+ if (i < 4) -+ user_position_l |= (beamformer_entry->user_position[i] << (i << 3)); -+ else -+ user_position_h |= (beamformer_entry->user_position[i] << ((i - 4) << 3)); -+ } -+ /*select MU STA0 table*/ -+ beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); -+ odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); -+ odm_set_bb_reg(dm, R_0x14c4, MASKDWORD, gid_valid); -+ odm_set_bb_reg(dm, R_0x14c8, MASKDWORD, user_position_l); -+ odm_set_bb_reg(dm, R_0x14cc, MASKDWORD, user_position_h); -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%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 |= (beamformer_entry->gid_valid[i] << ((i - 4) << 3)); -+ for (i = 8; i < 16; i++) { -+ if (i < 4) -+ user_position_l |= (beamformer_entry->user_position[i] << ((i - 8) << 3)); -+ else -+ user_position_h |= (beamformer_entry->user_position[i] << ((i - 12) << 3)); -+ } -+ /*select MU STA1 table*/ -+ beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); -+ beamforming_info->reg_mu_tx_ctrl |= BIT(8); -+ odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); -+ odm_set_bb_reg(dm, R_0x14c4, MASKDWORD, gid_valid); -+ odm_set_bb_reg(dm, R_0x14c8, MASKDWORD, user_position_l); -+ odm_set_bb_reg(dm, R_0x14cc, MASKDWORD, user_position_h); -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "%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*/ -+ beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; -+ beamforming_info->reg_mu_tx_ctrl |= 0x3; /* STA0, STA1*/ -+ odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); -+} -+ -+#if 0 -+/*This function translate the bitmap to GTAB*/ -+void -+haltxbf8822b_gtab_translation( -+ struct dm_struct *dm -+) -+{ -+ 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++) { -+ /*@dbg_print("gid_valid[%d] = 0x%x\n", idx, gid_valid[idx]); -+ dbg_print("user_position[%d] = 0x%x %x\n", idx, user_position_msb[idx], user_position_lsb[idx]);*/ -+ } -+} -+#endif -+ -+void hal_txbf_8822b_fw_txbf( -+ void *dm_void, -+ u8 idx) -+{ -+#if 0 -+ struct _RT_BEAMFORMING_INFO *beam_info = GET_BEAMFORM_INFO(adapter); -+ struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; -+ -+ if (p_beam_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ hal_txbf_8822b_download_ndpa(adapter, idx); -+ -+ hal_txbf_8822b_fw_txbf_cmd(adapter); -+#endif -+} -+ -+#endif -+ -+#if (defined(CONFIG_BB_TXBF_API)) -+/*this function is only used for BFer*/ -+void phydm_8822btxbf_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i; -+ -+ if (dm->rf_type == RF_1T1R) -+ return; -+ -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ for (i = RF_PATH_A; i <= RF_PATH_B; i++) { -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), 0x1); /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, 0xF, 3); /*Select RX mode*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, 0xfffff, 0x00036); /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, 0x5AFCE); /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), 0x0); /*RF mode table write disable*/ -+ } -+ } -+ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(30), 1); /*@if Nsts > Nc, don't apply V matrix*/ -+ -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ /*@for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x2); /*@enable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 1); /*@ignore user since 8822B only 2Tx*/ -+ -+ /*Nsts = 2 AB*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); -+ -+ } else { -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x0); /*@enable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 0); /*@ignore user since 8822B only 2Tx*/ -+ -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*@1SS by path-A*/ -+ odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8822B, MASKLWORD, 0x430); /*@2SS by path-A,B*/ -+ } -+} -+ -+/*this function is for BFer bug workaround*/ -+void phydm_8822b_sutxbfer_workaroud(void *dm_void, boolean enable_su_bfer, -+ u8 nc, u8 nr, u8 ng, u8 CB, u8 BW, -+ boolean is_vht) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (enable_su_bfer) { -+ odm_set_bb_reg(dm, R_0x19f8, BIT(22) | BIT(21) | BIT(20), 0x1); -+ odm_set_bb_reg(dm, R_0x19f8, BIT(25) | BIT(24) | BIT(23), 0x0); -+ odm_set_bb_reg(dm, R_0x19f8, BIT(16), 0x1); -+ -+ if (is_vht) -+ odm_set_bb_reg(dm, R_0x19f0, BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x1f); -+ else -+ odm_set_bb_reg(dm, R_0x19f0, BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x22); -+ -+ odm_set_bb_reg(dm, R_0x19f0, BIT(7) | BIT(6), nc); -+ odm_set_bb_reg(dm, R_0x19f0, BIT(9) | BIT(8), nr); -+ odm_set_bb_reg(dm, R_0x19f0, BIT(11) | BIT(10), ng); -+ odm_set_bb_reg(dm, R_0x19f0, BIT(13) | BIT(12), CB); -+ -+ odm_set_bb_reg(dm, R_0xb58, BIT(3) | BIT(2), BW); -+ odm_set_bb_reg(dm, R_0xb58, BIT(7) | BIT(6) | BIT(5) | BIT(4), 0x0); -+ odm_set_bb_reg(dm, R_0xb58, BIT(9) | BIT(8), BW); -+ odm_set_bb_reg(dm, R_0xb58, BIT(13) | BIT(12) | BIT(11) | BIT(10), 0x0); -+ } else { -+ odm_set_bb_reg(dm, R_0x19f8, BIT(16), 0x0); -+ } -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] enable_su_bfer = %d, is_vht = %d\n", -+ __func__, enable_su_bfer, is_vht); -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] nc = %d, nr = %d, ng = %d, CB = %d, BW = %d\n", -+ __func__, nc, nr, ng, CB, BW); -+} -+#endif -+#endif /* @(RTL8822B_SUPPORT == 1)*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8822b.h b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8822b.h -new file mode 100644 -index 000000000..552fba2a7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbf8822b.h -@@ -0,0 +1,78 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#ifndef __HAL_TXBF_8822B_H__ -+#define __HAL_TXBF_8822B_H__ -+ -+#if (RTL8822B_SUPPORT == 1) -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ -+void hal_txbf_8822b_enter( -+ void *dm_void, -+ u8 idx); -+ -+void hal_txbf_8822b_leave( -+ void *dm_void, -+ u8 idx); -+ -+void hal_txbf_8822b_status( -+ void *dm_void, -+ u8 beamform_idx); -+ -+void hal_txbf_8822b_config_gtab( -+ void *dm_void); -+ -+void hal_txbf_8822b_fw_txbf( -+ void *dm_void, -+ u8 idx); -+#else -+#define hal_txbf_8822b_enter(dm_void, idx) -+#define hal_txbf_8822b_leave(dm_void, idx) -+#define hal_txbf_8822b_status(dm_void, idx) -+#define hal_txbf_8822b_fw_txbf(dm_void, idx) -+#define hal_txbf_8822b_config_gtab(dm_void) -+ -+#endif -+ -+#if (defined(CONFIG_BB_TXBF_API)) -+void phydm_8822btxbf_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt); -+ -+void phydm_8822b_sutxbfer_workaroud(void *dm_void, boolean enable_su_bfer, -+ u8 nc, u8 nr, u8 ng, u8 CB, u8 BW, -+ boolean is_vht); -+ -+#else -+#define phydm_8822btxbf_rfmode(dm_void, su_bfee_cnt, mu_bfee_cnt) -+#define phydm_8822b_sutxbfer_workaroud(dm_void, enable_su_bfer, nc, nr, ng, CB, BW, is_vht) -+#endif -+ -+#else -+#define hal_txbf_8822b_enter(dm_void, idx) -+#define hal_txbf_8822b_leave(dm_void, idx) -+#define hal_txbf_8822b_status(dm_void, idx) -+#define hal_txbf_8822b_fw_txbf(dm_void, idx) -+#define hal_txbf_8822b_config_gtab(dm_void) -+ -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfinterface.c b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfinterface.c -new file mode 100644 -index 000000000..c125fecad ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfinterface.c -@@ -0,0 +1,1484 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 TXBF interface mechanism -+ * -+ ************************************************************/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void beamforming_gid_paid( -+ void *adapter, -+ PRT_TCB tcb) -+{ -+ u8 RA[6] = {0}; -+ u8 *p_header = GET_FRAME_OF_FIRST_FRAG(adapter, tcb); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ -+ if (((PADAPTER)adapter)->HardwareType < HARDWARE_TYPE_RTL8192EE) -+ return; -+ else if (IS_WIRELESS_MODE_N((PADAPTER)adapter) == false) -+ return; -+ -+#if (SUPPORT_MU_BF == 1) -+ if (tcb->tx_bf_pkt_type == RT_BF_PKT_TYPE_BROADCAST_NDPA) { /* @MU NDPA */ -+#else -+ if (0) { -+#endif -+ /* @Fill G_ID and P_AID */ -+ tcb->G_ID = 63; -+ if (beam_info->first_mu_bfee_index < BEAMFORMEE_ENTRY_NUM) { -+ tcb->P_AID = beam_info->beamformee_entry[beam_info->first_mu_bfee_index].p_aid; -+ RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, tcb->G_ID, tcb->P_AID)); -+ } -+ } else { -+ GET_80211_HDR_ADDRESS1(p_header, &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) || tcb->macId == MAC_ID_STATIC_FOR_BROADCAST_MULTICAST) { -+ tcb->G_ID = 63; -+ tcb->P_AID = 0; -+ } else if (ACTING_AS_AP(adapter)) { -+ u16 AID = (u16)(MacIdGetOwnerAssociatedClientAID(adapter, tcb->macId) & 0x1ff); /*@AID[0:8]*/ -+ -+ /*RT_DISP(FBEAM, FBEAM_FUN, ("@%s tcb->mac_id=0x%X, AID=0x%X\n", __func__, tcb->mac_id, AID));*/ -+ tcb->G_ID = 63; -+ -+ if (AID == 0) /*@A PPDU sent by an AP to a non associated STA*/ -+ tcb->P_AID = 0; -+ else { /*Sent by an AP and addressed to a STA associated with that AP*/ -+ u16 BSSID = 0; -+ GET_80211_HDR_ADDRESS2(p_header, &RA); -+ BSSID = ((RA[5] & 0xf0) >> 4) ^ (RA[5] & 0xf); /*@BSSID[44:47] xor BSSID[40:43]*/ -+ tcb->P_AID = (AID + BSSID * 32) & 0x1ff; /*@(dec(A) + dec(B)*32) mod 512*/ -+ } -+ } else if (ACTING_AS_IBSS(((PADAPTER)adapter))) { -+ tcb->G_ID = 63; -+ /*P_AID for infrasturcture mode; MACID for ad-hoc mode. */ -+ tcb->P_AID = tcb->macId; -+ } else if (MgntLinkStatusQuery(adapter)) { /*@Addressed to AP*/ -+ tcb->G_ID = 0; -+ GET_80211_HDR_ADDRESS1(p_header, &RA); -+ tcb->P_AID = RA[5]; /*RA[39:47]*/ -+ tcb->P_AID = (tcb->P_AID << 1) | (RA[4] >> 7); -+ } else { -+ tcb->G_ID = 63; -+ tcb->P_AID = 0; -+ } -+ /*RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, tcb->G_ID, tcb->P_AID));*/ -+ } -+} -+ -+enum rt_status -+beamforming_get_report_frame( -+ void *adapter, -+ PRT_RFD rfd, -+ POCTET_STRING p_pdu_os) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA((PADAPTER)adapter); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = NULL; -+ u8 *p_mimo_ctrl_field, p_csi_matrix; -+ u8 idx, nc, nr, CH_W; -+ u16 csi_matrix_len = 0; -+ -+ ACT_PKT_TYPE pkt_type = ACT_PKT_TYPE_UNKNOWN; -+ -+ /* @Memory comparison to see if CSI report is the same with previous one */ -+ beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, Frame_Addr2(*p_pdu_os), &idx); -+ -+ if (beamform_entry == NULL) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s: Cannot find entry by addr\n", -+ __func__); -+ return RT_STATUS_FAILURE; -+ } -+ -+ pkt_type = PacketGetActionFrameType(p_pdu_os); -+ -+ /* @-@ Modified by David */ -+ if (pkt_type == ACT_PKT_VHT_COMPRESSED_BEAMFORMING) { -+ p_mimo_ctrl_field = p_pdu_os->Octet + 26; -+ nc = ((*p_mimo_ctrl_field) & 0x7) + 1; -+ nr = (((*p_mimo_ctrl_field) & 0x38) >> 3) + 1; -+ CH_W = (((*p_mimo_ctrl_field) & 0xC0) >> 6); -+ /*p_csi_matrix = p_mimo_ctrl_field + 3 + nc;*/ /* 24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(nc=2) */ -+ csi_matrix_len = p_pdu_os->Length - 26 - 3 - nc; -+ } else if (pkt_type == ACT_PKT_HT_COMPRESSED_BEAMFORMING) { -+ p_mimo_ctrl_field = p_pdu_os->Octet + 26; -+ nc = ((*p_mimo_ctrl_field) & 0x3) + 1; -+ nr = (((*p_mimo_ctrl_field) & 0xC) >> 2) + 1; -+ CH_W = (((*p_mimo_ctrl_field) & 0x10) >> 4); -+ /*p_csi_matrix = p_mimo_ctrl_field + 6 + nr;*/ /* 24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(nc=2) */ -+ csi_matrix_len = p_pdu_os->Length - 26 - 6 - nr; -+ } else -+ return RT_STATUS_SUCCESS; -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] idx=%d, pkt type=%d, nc=%d, nr=%d, CH_W=%d\n", __func__, -+ idx, pkt_type, nc, nr, CH_W); -+ -+ return RT_STATUS_SUCCESS; -+} -+ -+void construct_ht_ndpa_packet( -+ // 2017/11 MH PHYDM compile. But why need to use windows maco? -+ // For all linux code, it should be useless? -+ //void *adapter = dm->adapter; -+ ADAPTER * adapter, -+ //void *adapter, -+ u8 *RA, -+ u8 *buffer, -+ u32 *p_length, -+ enum channel_width BW) -+{ -+ u16 duration = 0; -+ PMGNT_INFO mgnt_info = &(((PADAPTER)adapter)->MgntInfo); -+ //PMGNT_INFO mgnt_info = &((MGNT_INFO)(((PADAPTER)adapter)->MgntInfo)); -+ OCTET_STRING p_ndpa_frame, action_content; -+ u8 action_hdr[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, ((PADAPTER)adapter)->CurrentAddress); -+ SET_80211_HDR_ADDRESS3(buffer, ((PMGNT_INFO)mgnt_info)->Bssid); -+ -+ duration = 2 * a_SifsTime + 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(p_ndpa_frame, buffer, sMacHdrLng + sHTCLng); -+ -+ FillOctetString(action_content, action_hdr, 4); -+ PacketAppendData(&p_ndpa_frame, action_content); -+ -+ *p_length = 32; -+} -+ -+boolean -+send_fw_ht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ enum channel_width BW) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ PRT_TCB tcb; -+ PRT_TX_LOCAL_BUFFER p_buf; -+ boolean ret = true; -+ u32 buf_len; -+ u8 *buf_addr; -+ u8 desc_len = 0, idx = 0, ndp_tx_rate; -+ void *p_def_adapter = GetDefaultAdapter(((PADAPTER)adapter)); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (beamform_entry == NULL) -+ return false; -+ -+ ndp_tx_rate = beamforming_get_htndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, -+ ndp_tx_rate); -+ PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetFWBuffer(p_def_adapter, &tcb, &p_buf)) { -+#if (DEV_BUS_TYPE != RT_PCI_INTERFACE) -+ desc_len = ((PADAPTER)adapter)->HWDescHeadLength - hal_data->USBALLDummyLength; -+#endif -+ buf_addr = p_buf->Buffer.VirtualAddress + desc_len; -+ -+ construct_ht_ndpa_packet( -+ adapter, -+ RA, -+ buf_addr, -+ &buf_len, -+ BW); -+ -+ tcb->PacketLength = buf_len + desc_len; -+ -+ tcb->bTxEnableSwCalcDur = true; -+ -+ tcb->BWOfPacket = BW; -+ -+ if (ACTING_AS_IBSS(((PADAPTER)adapter)) || ACTING_AS_AP(((PADAPTER)adapter))) -+ tcb->G_ID = 63; -+ -+ tcb->P_AID = beamform_entry->p_aid; -+ tcb->DataRate = ndp_tx_rate; /*rate of NDP decide by nr*/ -+ -+ ((PADAPTER)adapter)->HalFunc.CmdSendPacketHandler(((PADAPTER)adapter), tcb, p_buf, tcb->PacketLength, DESC_PACKET_TYPE_NORMAL, false); -+ } else -+ ret = false; -+ -+ PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); -+ -+ return ret; -+} -+ -+boolean -+send_sw_ht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ enum channel_width BW) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ PRT_TCB tcb; -+ PRT_TX_LOCAL_BUFFER p_buf; -+ boolean ret = true; -+ u8 idx = 0, ndp_tx_rate = 0; -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ ndp_tx_rate = beamforming_get_htndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, -+ ndp_tx_rate); -+ -+ PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(adapter, &tcb, &p_buf)) { -+ construct_ht_ndpa_packet( -+ adapter, -+ RA, -+ p_buf->Buffer.VirtualAddress, -+ &tcb->PacketLength, -+ BW); -+ -+ tcb->bTxEnableSwCalcDur = true; -+ -+ tcb->BWOfPacket = BW; -+ -+ MgntSendPacket(adapter, tcb, p_buf, tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate); -+ } else -+ ret = false; -+ -+ PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); -+ -+ return ret; -+} -+ -+void construct_vht_ndpa_packet( -+ struct dm_struct *dm, -+ u8 *RA, -+ u16 AID, -+ u8 *buffer, -+ u32 *p_length, -+ enum channel_width BW) -+{ -+ u16 duration = 0; -+ u8 sequence = 0; -+ u8 *p_ndpa_frame = buffer; -+ struct _RT_NDPA_STA_INFO sta_info; -+ // 2017/11 MH PHYDM compile. But why need to use windows maco? -+ // For all linux code, it should be useless? -+ //void *adapter = dm->adapter; -+ ADAPTER * adapter = (PADAPTER)(dm->adapter); -+ u8 idx = 0; -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ /* @Frame control. */ -+ SET_80211_HDR_FRAME_CONTROL(p_ndpa_frame, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(p_ndpa_frame, Type_NDPA); -+ -+ SET_80211_HDR_ADDRESS1(p_ndpa_frame, RA); -+ SET_80211_HDR_ADDRESS2(p_ndpa_frame, beamform_entry->my_mac_addr); -+ -+ // 2017/11 MH PHYDM compile. But why need to use windows maco? -+ // For all linux code, it should be useless? -+ duration = 2 * a_SifsTime + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SET_80211_HDR_DURATION(p_ndpa_frame, duration); -+ -+ sequence = *(dm->sounding_seq) << 2; -+ odm_move_memory(dm, p_ndpa_frame + 16, &sequence, 1); -+ -+ if (phydm_acting_determine(dm, phydm_acting_as_ibss) || phydm_acting_determine(dm, phydm_acting_as_ap) == false) -+ AID = 0; -+ -+ sta_info.aid = AID; -+ sta_info.feedback_type = 0; -+ sta_info.nc_index = 0; -+ -+ odm_move_memory(dm, p_ndpa_frame + 17, (u8 *)&sta_info, 2); -+ -+ *p_length = 19; -+} -+ -+boolean -+send_fw_vht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ u16 AID, -+ enum channel_width BW) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ PRT_TCB tcb; -+ PRT_TX_LOCAL_BUFFER p_buf; -+ boolean ret = true; -+ u32 buf_len; -+ u8 *buf_addr; -+ u8 desc_len = 0, idx = 0, ndp_tx_rate = 0; -+ void *p_def_adapter = GetDefaultAdapter(((PADAPTER)adapter)); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (beamform_entry == NULL) -+ return false; -+ -+ ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, -+ ndp_tx_rate); -+ -+ PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetFWBuffer(p_def_adapter, &tcb, &p_buf)) { -+#if (DEV_BUS_TYPE != RT_PCI_INTERFACE) -+ desc_len = ((PADAPTER)adapter)->HWDescHeadLength - hal_data->USBALLDummyLength; -+#endif -+ buf_addr = p_buf->Buffer.VirtualAddress + desc_len; -+ -+ construct_vht_ndpa_packet( -+ dm, -+ RA, -+ AID, -+ buf_addr, -+ &buf_len, -+ BW); -+ -+ tcb->PacketLength = buf_len + desc_len; -+ -+ tcb->bTxEnableSwCalcDur = true; -+ -+ tcb->BWOfPacket = BW; -+ -+ if (phydm_acting_determine(dm, phydm_acting_as_ibss) || phydm_acting_determine(dm, phydm_acting_as_ap)) -+ tcb->G_ID = 63; -+ -+ tcb->P_AID = beamform_entry->p_aid; -+ tcb->DataRate = ndp_tx_rate; /*@decide by nr*/ -+ -+ ((PADAPTER)adapter)->HalFunc.CmdSendPacketHandler(adapter, tcb, p_buf, tcb->PacketLength, DESC_PACKET_TYPE_NORMAL, false); -+ } else -+ ret = false; -+ -+ PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] End, ret=%d\n", __func__, ret); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); -+ -+ return ret; -+} -+ -+boolean -+send_sw_vht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ u16 AID, -+ enum channel_width BW) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ void *adapter = dm->adapter; -+ PRT_TCB tcb; -+ PRT_TX_LOCAL_BUFFER p_buf; -+ boolean ret = true; -+ u8 idx = 0, ndp_tx_rate = 0; -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ -+ ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, -+ ndp_tx_rate); -+ -+ PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(adapter, &tcb, &p_buf)) { -+ construct_vht_ndpa_packet( -+ dm, -+ RA, -+ AID, -+ p_buf->Buffer.VirtualAddress, -+ &tcb->PacketLength, -+ BW); -+ -+ tcb->bTxEnableSwCalcDur = true; -+ tcb->BWOfPacket = BW; -+ -+ /*rate of NDP decide by nr*/ -+ MgntSendPacket(adapter, tcb, p_buf, tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate); -+ } else -+ ret = false; -+ -+ PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->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. -+ */ -+enum rt_status -+beamforming_get_vht_gid_mgnt_frame( -+ void *adapter, -+ PRT_RFD rfd, -+ POCTET_STRING p_pdu_os) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); -+ struct dm_struct *dm = &hal_data->DM_OutSrc; -+ enum rt_status rt_status = RT_STATUS_SUCCESS; -+ u8 *p_buffer = NULL; -+ u8 *p_raddr = NULL; -+ u8 mem_status[8] = {0}, user_pos[16] = {0}; -+ u8 idx; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ struct _RT_BEAMFORMER_ENTRY *beamform_entry = &beam_info->beamformer_entry[beam_info->mu_ap_index]; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] On VHT GID mgnt frame!\n", __func__); -+ -+ /* @Check length*/ -+ if (p_pdu_os->length < (FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY + 16)) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s: Invalid length (%d)\n", __func__, -+ p_pdu_os->length); -+ return RT_STATUS_INVALID_LENGTH; -+ } -+ -+ /* @Check RA*/ -+ p_raddr = (u8 *)(p_pdu_os->Octet) + 4; -+ if (!eq_mac_addr(p_raddr, adapter->CurrentAddress)) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s: Drop because of RA error.\n", -+ __func__); -+ return RT_STATUS_PKT_DROP; -+ } -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "On VHT GID Mgnt Frame ==>:\n", p_pdu_os->Octet, p_pdu_os->length); -+ -+ /*Parsing Membership status array*/ -+ p_buffer = p_pdu_os->Octet + FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY; -+ for (idx = 0; idx < 8; idx++) { -+ mem_status[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(p_buffer + idx); -+ beamform_entry->gid_valid[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(p_buffer + idx); -+ } -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "mem_status: ", mem_status, 8); -+ -+ /* Parsing User Position array*/ -+ p_buffer = p_pdu_os->Octet + FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY; -+ for (idx = 0; idx < 16; idx++) { -+ user_pos[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(p_buffer + idx); -+ beamform_entry->user_position[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(p_buffer + idx); -+ } -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "user_pos: ", user_pos, 16); -+ -+ /* @Group ID detail printed*/ -+ { -+ u8 i, j; -+ u8 tmp_val; -+ u16 tmp_val2; -+ -+ for (i = 0; i < 8; i++) { -+ tmp_val = mem_status[i]; -+ tmp_val2 = ((user_pos[i * 2 + 1] << 8) & 0xFF00) + (user_pos[i * 2] & 0xFF); -+ for (j = 0; j < 8; j++) { -+ if ((tmp_val >> j) & BIT(0)) { -+ PHYDM_DBG(dm, DBG_TXBF, "Use Group ID (%d), User Position (%d)\n", -+ (i * 8 + j), (tmp_val2 >> 2 * j) & 0x3); -+ } -+ } -+ } -+ } -+ -+ /* @Indicate GID frame to IHV service. */ -+ { -+ u8 indibuffer[24] = {0}; -+ u8 indioffset = 0; -+ -+ PlatformMoveMemory(indibuffer + indioffset, beamform_entry->gid_valid, 8); -+ indioffset += 8; -+ PlatformMoveMemory(indibuffer + indioffset, beamform_entry->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 */ -+ hal_com_txbf_config_gtab(dm); -+ -+ return rt_status; -+} -+ -+/*@ -+ * Description: Construct VHT Group ID (GID) management frame. -+ * -+ * 2015.05.20. Created by tynli. -+ */ -+void construct_vht_gid_mgnt_frame( -+ struct dm_struct *dm, -+ u8 *RA, -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry, -+ u8 *buffer, -+ u32 *p_length -+ -+ ) -+{ -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ void *adapter = beam_info->source_adapter; -+ OCTET_STRING os_ftm_frame, tmp; -+ -+ FillOctetString(os_ftm_frame, buffer, 0); -+ *p_length = 0; -+ -+ ConstructMaFrameHdr( -+ adapter, -+ RA, -+ ACT_CAT_VHT, -+ ACT_VHT_GROUPID_MANAGEMENT, -+ &os_ftm_frame); -+ -+ /* @Membership status array*/ -+ FillOctetString(tmp, beamform_entry->gid_valid, 8); -+ PacketAppendData(&os_ftm_frame, tmp); -+ -+ /* User Position array*/ -+ FillOctetString(tmp, beamform_entry->user_position, 16); -+ PacketAppendData(&os_ftm_frame, tmp); -+ -+ *p_length = os_ftm_frame.length; -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "construct_vht_gid_mgnt_frame():\n", buffer, *p_length); -+} -+ -+boolean -+send_sw_vht_gid_mgnt_frame( -+ void *dm_void, -+ u8 *RA, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ PRT_TCB tcb; -+ PRT_TX_LOCAL_BUFFER p_buf; -+ boolean ret = true; -+ u8 data_rate = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = &beam_info->beamformee_entry[idx]; -+ void *adapter = beam_info->source_adapter; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(adapter, &tcb, &p_buf)) { -+ construct_vht_gid_mgnt_frame( -+ dm, -+ RA, -+ beamform_entry, -+ p_buf->Buffer.VirtualAddress, -+ &tcb->PacketLength); -+ -+ tcb->bw_of_packet = CHANNEL_WIDTH_20; -+ data_rate = MGN_6M; -+ MgntSendPacket(adapter, tcb, p_buf, tcb->PacketLength, NORMAL_QUEUE, data_rate); -+ } else -+ ret = false; -+ -+ PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); -+ -+ return ret; -+} -+ -+/*@ -+ * Description: Construct VHT beamforming report poll. -+ * -+ * 2015.05.20. Created by tynli. -+ */ -+void construct_vht_bf_report_poll( -+ struct dm_struct *dm, -+ u8 *RA, -+ u8 *buffer, -+ u32 *p_length) -+{ -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ void *adapter = beam_info->source_adapter; -+ u8 *p_bf_rpt_poll = buffer; -+ -+ /* @Frame control*/ -+ SET_80211_HDR_FRAME_CONTROL(p_bf_rpt_poll, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(p_bf_rpt_poll, Type_Beamforming_Report_Poll); -+ -+ /* @duration*/ -+ SET_80211_HDR_DURATION(p_bf_rpt_poll, 100); -+ -+ /* RA*/ -+ SET_VHT_BF_REPORT_POLL_RA(p_bf_rpt_poll, RA); -+ -+ /* TA*/ -+ SET_VHT_BF_REPORT_POLL_TA(p_bf_rpt_poll, adapter->CurrentAddress); -+ -+ /* @Feedback Segment Retransmission Bitmap*/ -+ SET_VHT_BF_REPORT_POLL_FEEDBACK_SEG_RETRAN_BITMAP(p_bf_rpt_poll, 0xFF); -+ -+ *p_length = 17; -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "construct_vht_bf_report_poll():\n", buffer, *p_length); -+} -+ -+boolean -+send_sw_vht_bf_report_poll( -+ void *dm_void, -+ u8 *RA, -+ boolean is_final_poll) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ PRT_TCB tcb; -+ PRT_TX_LOCAL_BUFFER p_buf; -+ boolean ret = true; -+ u8 idx = 0, data_rate = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ void *adapter = beam_info->source_adapter; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(adapter, &tcb, &p_buf)) { -+ construct_vht_bf_report_poll( -+ dm, -+ RA, -+ p_buf->Buffer.VirtualAddress, -+ &tcb->PacketLength); -+ -+ tcb->bTxEnableSwCalcDur = true; /* @ need?*/ -+ tcb->BWOfPacket = CHANNEL_WIDTH_20; -+ -+ if (is_final_poll) -+ tcb->TxBFPktType = RT_BF_PKT_TYPE_FINAL_BF_REPORT_POLL; -+ else -+ tcb->TxBFPktType = RT_BF_PKT_TYPE_BF_REPORT_POLL; -+ -+ data_rate = MGN_6M; /* @Legacy OFDM rate*/ -+ MgntSendPacket(adapter, tcb, p_buf, tcb->PacketLength, NORMAL_QUEUE, data_rate); -+ } else -+ ret = false; -+ -+ PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "send_sw_vht_bf_report_poll:\n", -+ p_buf->Buffer.VirtualAddress, tcb->PacketLength); -+ -+ return ret; -+} -+ -+/*@ -+ * Description: Construct VHT MU NDPA packet. -+ * We should combine this function with construct_vht_ndpa_packet() in the future. -+ * -+ * 2015.05.21. Created by tynli. -+ */ -+void construct_vht_mu_ndpa_packet( -+ struct dm_struct *dm, -+ enum channel_width BW, -+ u8 *buffer, -+ u32 *p_length) -+{ -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ void *adapter = beam_info->source_adapter; -+ u16 duration = 0; -+ u8 sequence = 0; -+ u8 *p_ndpa_frame = buffer; -+ struct _RT_NDPA_STA_INFO sta_info; -+ u8 idx; -+ u8 dest_addr[6] = {0}; -+ struct _RT_BEAMFORMEE_ENTRY *entry = 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++) { -+ entry = &(beam_info->beamformee_entry[idx]); -+ if (entry->is_mu_sta) { -+ cp_mac_addr(dest_addr, entry->mac_addr); -+ break; -+ } -+ } -+ if (entry == NULL) -+ return; -+ -+ /* @Frame control.*/ -+ SET_80211_HDR_FRAME_CONTROL(p_ndpa_frame, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(p_ndpa_frame, Type_NDPA); -+ -+ SET_80211_HDR_ADDRESS1(p_ndpa_frame, dest_addr); -+ SET_80211_HDR_ADDRESS2(p_ndpa_frame, entry->my_mac_addr); -+ -+ /*@--------------------------------------------*/ -+ /* @ Need to modify "duration" to MU consideration. */ -+ duration = 2 * a_SifsTime + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ /*@--------------------------------------------*/ -+ -+ SET_80211_HDR_DURATION(p_ndpa_frame, duration); -+ -+ sequence = *(dm->sounding_seq) << 2; -+ odm_move_memory(dm, p_ndpa_frame + 16, &sequence, 1); -+ -+ *p_length = 17; -+ -+ /* @Construct STA info. for multiple STAs*/ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ entry = &(beam_info->beamformee_entry[idx]); -+ if (entry->is_mu_sta) { -+ sta_info.aid = entry->AID; -+ sta_info.feedback_type = 1; /* @1'b1: MU*/ -+ sta_info.nc_index = 0; -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] Get beamformee_entry idx(%d), AID =%d\n", -+ __func__, idx, entry->AID); -+ -+ odm_move_memory(dm, p_ndpa_frame + (*p_length), (u8 *)&sta_info, 2); -+ *p_length += 2; -+ } -+ } -+} -+ -+boolean -+send_sw_vht_mu_ndpa_packet( -+ void *dm_void, -+ enum channel_width BW) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ PRT_TCB tcb; -+ PRT_TX_LOCAL_BUFFER p_buf; -+ boolean ret = true; -+ u8 ndp_tx_rate = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ void *adapter = beam_info->source_adapter; -+ -+ ndp_tx_rate = MGN_VHT2SS_MCS0; -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, -+ ndp_tx_rate); -+ -+ PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(adapter, &tcb, &p_buf)) { -+ construct_vht_mu_ndpa_packet( -+ dm, -+ BW, -+ p_buf->Buffer.VirtualAddress, -+ &tcb->PacketLength); -+ -+ tcb->bTxEnableSwCalcDur = true; -+ tcb->BWOfPacket = BW; -+ tcb->TxBFPktType = RT_BF_PKT_TYPE_BROADCAST_NDPA; -+ -+ /*rate of NDP decide by nr*/ -+ MgntSendPacket(adapter, tcb, p_buf, tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate); -+ } else -+ ret = false; -+ -+ PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); -+ -+ return ret; -+} -+ -+void dbg_construct_vht_mundpa_packet( -+ struct dm_struct *dm, -+ enum channel_width BW, -+ u8 *buffer, -+ u32 *p_length) -+{ -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ void *adapter = beam_info->source_adapter; -+ u16 duration = 0; -+ u8 sequence = 0; -+ u8 *p_ndpa_frame = buffer; -+ struct _RT_NDPA_STA_INFO sta_info; -+ u8 idx; -+ u8 dest_addr[6] = {0}; -+ struct _RT_BEAMFORMEE_ENTRY *entry = 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++) { -+ entry = &(beam_info->beamformee_entry[idx]); -+ if (entry->is_mu_sta) { -+ if (is_STA1 == false) { -+ is_STA1 = true; -+ continue; -+ } else { -+ cp_mac_addr(dest_addr, entry->mac_addr); -+ break; -+ } -+ } -+ } -+ -+ /* @Frame control.*/ -+ SET_80211_HDR_FRAME_CONTROL(p_ndpa_frame, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(p_ndpa_frame, Type_NDPA); -+ -+ SET_80211_HDR_ADDRESS1(p_ndpa_frame, dest_addr); -+ SET_80211_HDR_ADDRESS2(p_ndpa_frame, dm->CurrentAddress); -+ -+ /*@--------------------------------------------*/ -+ /* @ Need to modify "duration" to MU consideration. */ -+ duration = 2 * a_SifsTime + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ /*@--------------------------------------------*/ -+ -+ SET_80211_HDR_DURATION(p_ndpa_frame, duration); -+ -+ sequence = *(dm->sounding_seq) << 2; -+ odm_move_memory(dm, p_ndpa_frame + 16, &sequence, 1); -+ -+ *p_length = 17; -+ -+ /*STA2's STA Info*/ -+ sta_info.aid = entry->aid; -+ sta_info.feedback_type = 1; /* @1'b1: MU */ -+ sta_info.nc_index = 0; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Get beamformee_entry idx(%d), AID =%d\n", -+ __func__, idx, entry->aid); -+ -+ odm_move_memory(dm, p_ndpa_frame + (*p_length), (u8 *)&sta_info, 2); -+ *p_length += 2; -+} -+ -+boolean -+dbg_send_sw_vht_mundpa_packet( -+ void *dm_void, -+ enum channel_width BW) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ PRT_TCB tcb; -+ PRT_TX_LOCAL_BUFFER p_buf; -+ boolean ret = true; -+ u8 ndp_tx_rate = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ void *adapter = beam_info->source_adapter; -+ -+ ndp_tx_rate = MGN_VHT2SS_MCS0; -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, -+ ndp_tx_rate); -+ -+ PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(adapter, &tcb, &p_buf)) { -+ dbg_construct_vht_mundpa_packet( -+ dm, -+ BW, -+ p_buf->Buffer.VirtualAddress, -+ &tcb->PacketLength); -+ -+ tcb->bTxEnableSwCalcDur = true; -+ tcb->BWOfPacket = BW; -+ tcb->TxBFPktType = RT_BF_PKT_TYPE_UNICAST_NDPA; -+ -+ /*rate of NDP decide by nr*/ -+ MgntSendPacket(adapter, tcb, p_buf, tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate); -+ } else -+ ret = false; -+ -+ PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); -+ -+ return ret; -+} -+ -+#endif /*@#if (SUPPORT_MU_BF == 1)*/ -+#endif /*@#ifdef SUPPORT_MU_BF*/ -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+u32 beamforming_get_report_frame( -+ void *dm_void, -+ union recv_frame *precv_frame) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u32 ret = _SUCCESS; -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = NULL; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u32 frame_len = precv_frame->u.hdr.len; -+ u8 *TA; -+ u8 idx, offset; -+ -+ /*@Memory comparison to see if CSI report is the same with previous one*/ -+ TA = get_addr2_ptr(pframe); -+ beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, TA, &idx); -+ if (beamform_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) -+ offset = 31; /*@24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(nc=2)*/ -+ else if (beamform_entry->beamform_entry_cap & 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 -+send_fw_ht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ enum channel_width BW) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ADAPTER *adapter = dm->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); -+ u8 action_hdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 a_sifs_time = 0, ndp_tx_rate = 0, idx = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ PHYDM_DBG(dm, DBG_TXBF, "%s, alloc mgnt frame fail\n", -+ __func__); -+ return false; -+ } -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(adapter, pattrib); -+ -+ pattrib->qsel = QSLT_BEACON; -+ ndp_tx_rate = beamforming_get_htndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, -+ ndp_tx_rate); -+ pattrib->rate = ndp_tx_rate; -+ 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; -+ -+ set_order_bit(pframe); -+ set_frame_sub_type(pframe, WIFI_ACTION_NOACK); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, beamform_entry->my_mac_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ if (pmlmeext->cur_wireless_mode == WIRELESS_11B) -+ a_sifs_time = 10; -+ else -+ a_sifs_time = 16; -+ -+ duration = 2 * a_sifs_time + 40; -+ -+ if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ set_duration(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, action_hdr, 4); -+ -+ pattrib->pktlen = 32; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(adapter, pmgntframe); -+ -+ return true; -+} -+ -+boolean -+send_sw_ht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ enum channel_width BW) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ADAPTER *adapter = dm->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); -+ u8 action_hdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 a_sifs_time = 0, ndp_tx_rate = 0, idx = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ -+ ndp_tx_rate = beamforming_get_htndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ PHYDM_DBG(dm, DBG_TXBF, "%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 = ndp_tx_rate; -+ 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; -+ -+ set_order_bit(pframe); -+ set_frame_sub_type(pframe, WIFI_ACTION_NOACK); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, beamform_entry->my_mac_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ if (pmlmeext->cur_wireless_mode == WIRELESS_11B) -+ a_sifs_time = 10; -+ else -+ a_sifs_time = 16; -+ -+ duration = 2 * a_sifs_time + 40; -+ -+ if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ set_duration(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, action_hdr, 4); -+ -+ pattrib->pktlen = 32; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(adapter, pmgntframe); -+ -+ return true; -+} -+ -+boolean -+send_fw_vht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ u16 AID, -+ enum channel_width BW) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ADAPTER *adapter = dm->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); -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 sequence = 0, a_sifs_time = 0, ndp_tx_rate = 0, idx = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ struct _RT_NDPA_STA_INFO sta_info; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ PHYDM_DBG(dm, DBG_TXBF, "%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; -+ ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, -+ ndp_tx_rate); -+ pattrib->rate = ndp_tx_rate; -+ 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; -+ -+ set_frame_sub_type(pframe, WIFI_NDPA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, beamform_entry->my_mac_addr, ETH_ALEN); -+ -+ if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(pmlmeext->cur_wireless_mode)) -+ a_sifs_time = 16; -+ else -+ a_sifs_time = 10; -+ -+ duration = 2 * a_sifs_time + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ set_duration(pframe, duration); -+ -+ sequence = beam_info->sounding_sequence << 2; -+ if (beam_info->sounding_sequence >= 0x3f) -+ beam_info->sounding_sequence = 0; -+ else -+ beam_info->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 -+send_sw_vht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ u16 AID, -+ enum channel_width BW) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _ADAPTER *adapter = dm->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); -+ struct _RT_NDPA_STA_INFO ndpa_sta_info; -+ u8 ndp_tx_rate = 0, sequence = 0, a_sifs_time = 0, idx = 0; -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); -+ struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); -+ -+ ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, -+ ndp_tx_rate); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ PHYDM_DBG(dm, DBG_TXBF, "%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 = ndp_tx_rate; -+ 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; -+ -+ set_frame_sub_type(pframe, WIFI_NDPA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, beamform_entry->my_mac_addr, ETH_ALEN); -+ -+ if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(pmlmeext->cur_wireless_mode)) -+ a_sifs_time = 16; -+ else -+ a_sifs_time = 10; -+ -+ duration = 2 * a_sifs_time + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ set_duration(pframe, duration); -+ -+ sequence = beam_info->sounding_sequence << 2; -+ if (beam_info->sounding_sequence >= 0x3f) -+ beam_info->sounding_sequence = 0; -+ else -+ beam_info->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; -+ -+ ndpa_sta_info.aid = AID; -+ ndpa_sta_info.feedback_type = 0; -+ ndpa_sta_info.nc_index = 0; -+ -+ _rtw_memcpy(pframe + 17, (u8 *)&ndpa_sta_info, 2); -+ -+ pattrib->pktlen = 19; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(adapter, pmgntframe); -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] [%d]\n", __func__, __LINE__); -+ -+ return true; -+} -+ -+#endif -+ -+void beamforming_get_ndpa_frame( -+ void *dm_void, -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ OCTET_STRING pdu_os -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ union recv_frame *precv_frame -+#endif -+ ) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 *TA; -+ u8 idx, sequence; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ u8 *p_ndpa_frame = pdu_os.Octet; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ u8 *p_ndpa_frame = precv_frame->u.hdr.rx_data; -+#endif -+ struct _RT_BEAMFORMER_ENTRY *beamformer_entry = NULL; /*@Modified By Jeffery @2014-10-29*/ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "beamforming_get_ndpa_frame\n", -+ pdu_os.Octet, pdu_os.Length); -+ if (IsCtrlNDPA(p_ndpa_frame) == false) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (get_frame_sub_type(p_ndpa_frame) != WIFI_NDPA) -+#endif -+ return; -+ else if (!(dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821))) { -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] not 8812 or 8821A, return\n", -+ __func__); -+ return; -+ } -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ TA = Frame_Addr2(pdu_os); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ TA = get_addr2_ptr(p_ndpa_frame); -+#endif -+ /*Remove signaling TA. */ -+ TA[0] = TA[0] & 0xFE; -+ -+ beamformer_entry = phydm_beamforming_get_bfer_entry_by_addr(dm, TA, &idx); /* @Modified By Jeffery @2014-10-29 */ -+ -+ /*@Break options for Clock Reset*/ -+ if (beamformer_entry == NULL) -+ return; -+ else if (!(beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU)) -+ return; -+ /*@log_success: As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is NO LONGER needed !2015-04-10, Jeffery*/ -+ /*@clock_reset_times: While BFer entry always doesn't receive our CSI, clock will reset again and again.So clock_reset_times is limited to 5 times.2015-04-13, Jeffery*/ -+ else if ((beamformer_entry->log_success == 1) || (beamformer_entry->clock_reset_times == 5)) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] log_seq=%d, pre_log_seq=%d, log_retry_cnt=%d, log_success=%d, clock_reset_times=%d, clock reset is no longer needed.\n", -+ __func__, beamformer_entry->log_seq, -+ beamformer_entry->pre_log_seq, -+ beamformer_entry->log_retry_cnt, -+ beamformer_entry->log_success, -+ beamformer_entry->clock_reset_times); -+ -+ return; -+ } -+ -+ sequence = (p_ndpa_frame[16]) >> 2; -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] Start, sequence=%d, log_seq=%d, pre_log_seq=%d, log_retry_cnt=%d, clock_reset_times=%d, log_success=%d\n", -+ __func__, sequence, beamformer_entry->log_seq, -+ beamformer_entry->pre_log_seq, -+ beamformer_entry->log_retry_cnt, -+ beamformer_entry->clock_reset_times, -+ beamformer_entry->log_success); -+ -+ if (beamformer_entry->log_seq != 0 && beamformer_entry->pre_log_seq != 0) { -+ /*Success condition*/ -+ if (beamformer_entry->log_seq != sequence && beamformer_entry->pre_log_seq != beamformer_entry->log_seq) { -+ /* @break option for clcok reset, 2015-03-30, Jeffery */ -+ beamformer_entry->log_retry_cnt = 0; -+ /*@As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is no longer needed.*/ -+ /*That is, log_success is NOT needed to be reset to zero, 2015-04-13, Jeffery*/ -+ beamformer_entry->log_success = 1; -+ -+ } else { /*@Fail condition*/ -+ -+ if (beamformer_entry->log_retry_cnt == 5) { -+ beamformer_entry->clock_reset_times++; -+ beamformer_entry->log_retry_cnt = 0; -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] Clock Reset!!! clock_reset_times=%d\n", -+ __func__, -+ beamformer_entry->clock_reset_times); -+ hal_com_txbf_set(dm, TXBF_SET_SOUNDING_CLK, NULL); -+ -+ } else -+ beamformer_entry->log_retry_cnt++; -+ } -+ } -+ -+ /*Update log_seq & pre_log_seq*/ -+ beamformer_entry->pre_log_seq = beamformer_entry->log_seq; -+ beamformer_entry->log_seq = sequence; -+} -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfinterface.h b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfinterface.h -new file mode 100644 -index 000000000..b97aa349e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfinterface.h -@@ -0,0 +1,167 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#ifndef __HAL_TXBF_INTERFACE_H__ -+#define __HAL_TXBF_INTERFACE_H__ -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+#define a_SifsTime ((IS_WIRELESS_MODE_5G(adapter) || IS_WIRELESS_MODE_N_24G(adapter)) ? 16 : 10) -+ -+void beamforming_gid_paid( -+ void *adapter, -+ PRT_TCB tcb); -+ -+enum rt_status -+beamforming_get_report_frame( -+ void *adapter, -+ PRT_RFD rfd, -+ POCTET_STRING p_pdu_os); -+ -+void beamforming_get_ndpa_frame( -+ void *dm_void, -+ OCTET_STRING pdu_os); -+ -+boolean -+send_fw_ht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ enum channel_width BW); -+ -+boolean -+send_fw_vht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ u16 AID, -+ enum channel_width BW); -+ -+boolean -+send_sw_vht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ u16 AID, -+ enum channel_width BW); -+ -+boolean -+send_sw_ht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ enum channel_width BW); -+ -+#if (SUPPORT_MU_BF == 1) -+enum rt_status -+beamforming_get_vht_gid_mgnt_frame( -+ void *adapter, -+ PRT_RFD rfd, -+ POCTET_STRING p_pdu_os); -+ -+boolean -+send_sw_vht_gid_mgnt_frame( -+ void *dm_void, -+ u8 *RA, -+ u8 idx); -+ -+boolean -+send_sw_vht_bf_report_poll( -+ void *dm_void, -+ u8 *RA, -+ boolean is_final_poll); -+ -+boolean -+send_sw_vht_mu_ndpa_packet( -+ void *dm_void, -+ enum channel_width BW); -+#else -+#define beamforming_get_vht_gid_mgnt_frame(adapter, rfd, p_pdu_os) RT_STATUS_FAILURE -+#define send_sw_vht_gid_mgnt_frame(dm_void, RA) -+#define send_sw_vht_bf_report_poll(dm_void, RA, is_final_poll) -+#define send_sw_vht_mu_ndpa_packet(dm_void, BW) -+#endif -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+u32 beamforming_get_report_frame( -+ void *dm_void, -+ union recv_frame *precv_frame); -+ -+boolean -+send_fw_ht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ enum channel_width BW); -+ -+boolean -+send_sw_ht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ enum channel_width BW); -+ -+boolean -+send_fw_vht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ u16 AID, -+ enum channel_width BW); -+ -+boolean -+send_sw_vht_ndpa_packet( -+ void *dm_void, -+ u8 *RA, -+ u16 AID, -+ enum channel_width BW); -+#endif -+ -+void beamforming_get_ndpa_frame( -+ void *dm_void, -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ OCTET_STRING pdu_os -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ union recv_frame *precv_frame -+#endif -+ ); -+ -+boolean -+dbg_send_sw_vht_mundpa_packet( -+ void *dm_void, -+ enum channel_width BW); -+ -+#else -+#define beamforming_get_ndpa_frame(dm, _pdu_os) -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#define beamforming_get_report_frame(adapter, precv_frame) RT_STATUS_FAILURE -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define beamforming_get_report_frame(adapter, rfd, p_pdu_os) RT_STATUS_FAILURE -+#define beamforming_get_vht_gid_mgnt_frame(adapter, rfd, p_pdu_os) RT_STATUS_FAILURE -+#endif -+#define send_fw_ht_ndpa_packet(dm_void, RA, BW) -+#define send_sw_ht_ndpa_packet(dm_void, RA, BW) -+#define send_fw_vht_ndpa_packet(dm_void, RA, AID, BW) -+#define send_sw_vht_ndpa_packet(dm_void, RA, AID, BW) -+#define send_sw_vht_gid_mgnt_frame(dm_void, RA, idx) -+#define send_sw_vht_bf_report_poll(dm_void, RA, is_final_poll) -+#define send_sw_vht_mu_ndpa_packet(dm_void, BW) -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfjaguar.c b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfjaguar.c -new file mode 100644 -index 000000000..6f1892837 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfjaguar.c -@@ -0,0 +1,509 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 8812/8821/8811 TXBF mechanism -+ * -+ ************************************************************/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+void hal_txbf_8812a_set_ndpa_rate( -+ void *dm_void, -+ u8 BW, -+ u8 rate) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ odm_write_1byte(dm, REG_NDPA_OPT_CTRL_8812A, (rate << 2 | BW)); -+} -+ -+void hal_txbf_jaguar_rf_mode( -+ void *dm_void, -+ struct _RT_BEAMFORMING_INFO *beam_info) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ if (dm->rf_type == RF_1T1R) -+ return; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] set TxIQGen\n", __func__); -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); /*RF mode table write enable*/ -+ -+ if (beam_info->beamformee_su_cnt > 0) { -+ /* Paath_A */ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0x78000, 0x3); /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0xE26BF); /*@Enable TXIQGEN in RX mode*/ -+ /* Path_B */ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0x78000, 0x3); /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0xE26BF); /*@Enable TXIQGEN in RX mode*/ -+ } else { -+ /* Paath_A */ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0x78000, 0x3); /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0xC26BF); /*@Disable TXIQGEN in RX mode*/ -+ /* Path_B */ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0x78000, 0x3); /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0xC26BF); /*@Disable TXIQGEN in RX mode*/ -+ } -+ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); /*RF mode table write disable*/ -+ -+ if (beam_info->beamformee_su_cnt > 0) -+ odm_set_bb_reg(dm, R_0x80c, MASKBYTE1, 0x33); -+ else -+ odm_set_bb_reg(dm, R_0x80c, MASKBYTE1, 0x11); -+} -+ -+void hal_txbf_jaguar_download_ndpa( -+ void *dm_void, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 u1b_tmp = 0, tmp_reg422 = 0, head_page; -+ u8 bcn_valid_reg = 0, count = 0, dl_bcn_count = 0; -+ boolean is_send_beacon = false; -+ u8 tx_page_bndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; /*@default reseved 1 page for the IC type which is undefined.*/ -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; -+ void *adapter = dm->adapter; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *dm->is_fw_dw_rsvd_page_in_progress = true; -+#endif -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ /* if (idx == 0) head_page = 0xFE; */ -+ /* else head_page = 0xFE;*/ -+ head_page = 0xFE; -+ -+ phydm_get_hal_def_var_handler_interface(dm, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_page_bndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1b_tmp = odm_read_1byte(dm, REG_CR_8812A + 1); -+ odm_write_1byte(dm, REG_CR_8812A + 1, (u1b_tmp | BIT(0))); -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmp_reg422 = odm_read_1byte(dm, REG_FWHW_TXQ_CTRL_8812A + 2); -+ odm_write_1byte(dm, REG_FWHW_TXQ_CTRL_8812A + 2, tmp_reg422 & (~BIT(6))); -+ -+ if (tmp_reg422 & BIT(6)) { -+ PHYDM_DBG(dm, DBG_TXBF, -+ "SetBeamformDownloadNDPA_8812(): There is an adapter is sending beacon.\n"); -+ is_send_beacon = true; -+ } -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ -+ odm_write_1byte(dm, REG_TDECTRL_8812A + 1, head_page); -+ -+ do { -+ /*@Clear beacon valid check bit.*/ -+ bcn_valid_reg = odm_read_1byte(dm, REG_TDECTRL_8812A + 2); -+ odm_write_1byte(dm, REG_TDECTRL_8812A + 2, (bcn_valid_reg | BIT(0))); -+ -+ /*@download NDPA rsvd page.*/ -+ if (p_beam_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) -+ beamforming_send_vht_ndpa_packet(dm, p_beam_entry->mac_addr, p_beam_entry->aid, p_beam_entry->sound_bw, BEACON_QUEUE); -+ else -+ beamforming_send_ht_ndpa_packet(dm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); -+ -+ /*@check rsvd page download OK.*/ -+ bcn_valid_reg = odm_read_1byte(dm, REG_TDECTRL_8812A + 2); -+ count = 0; -+ while (!(bcn_valid_reg & BIT(0)) && count < 20) { -+ count++; -+ ODM_delay_ms(10); -+ bcn_valid_reg = odm_read_1byte(dm, REG_TDECTRL_8812A + 2); -+ } -+ dl_bcn_count++; -+ } while (!(bcn_valid_reg & BIT(0)) && dl_bcn_count < 5); -+ -+ if (!(bcn_valid_reg & BIT(0))) -+ PHYDM_DBG(dm, DBG_TXBF, "%s Download RSVD page failed!\n", -+ __func__); -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ -+ odm_write_1byte(dm, REG_TDECTRL_8812A + 1, tx_page_bndy); -+ -+ /*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 (is_send_beacon) -+ odm_write_1byte(dm, REG_FWHW_TXQ_CTRL_8812A + 2, tmp_reg422); -+ -+ /*@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.*/ -+ u1b_tmp = odm_read_1byte(dm, REG_CR_8812A + 1); -+ odm_write_1byte(dm, REG_CR_8812A + 1, (u1b_tmp & (~BIT(0)))); -+ -+ p_beam_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *dm->is_fw_dw_rsvd_page_in_progress = false; -+#endif -+} -+ -+void hal_txbf_jaguar_fw_txbf_cmd( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 idx, period0 = 0, period1 = 0; -+ u8 PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u8 u1_tx_bf_parm[3] = {0}; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ /*@Modified by David*/ -+ if (beam_info->beamformee_entry[idx].is_used && beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (idx == 0) { -+ if (beam_info->beamformee_entry[idx].is_sound) -+ PageNum0 = 0xFE; -+ else -+ PageNum0 = 0xFF; /*stop sounding*/ -+ period0 = (u8)(beam_info->beamformee_entry[idx].sound_period); -+ } else if (idx == 1) { -+ if (beam_info->beamformee_entry[idx].is_sound) -+ PageNum1 = 0xFE; -+ else -+ PageNum1 = 0xFF; /*stop sounding*/ -+ period1 = (u8)(beam_info->beamformee_entry[idx].sound_period); -+ } -+ } -+ } -+ -+ u1_tx_bf_parm[0] = PageNum0; -+ u1_tx_bf_parm[1] = PageNum1; -+ u1_tx_bf_parm[2] = (period1 << 4) | period0; -+ odm_fill_h2c_cmd(dm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); -+ -+ PHYDM_DBG(dm, DBG_TXBF, -+ "[%s] PageNum0 = %d period0 = %d, PageNum1 = %d period1 %d\n", -+ __func__, PageNum0, period0, PageNum1, period1); -+} -+ -+void hal_txbf_jaguar_enter( -+ void *dm_void, -+ u8 bfer_bfee_idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i = 0; -+ u8 bfer_idx = (bfer_bfee_idx & 0xF0) >> 4; -+ u8 bfee_idx = (bfer_bfee_idx & 0xF); -+ u32 csi_param; -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY beamformee_entry; -+ struct _RT_BEAMFORMER_ENTRY beamformer_entry; -+ u16 sta_id = 0; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s]Start!\n", __func__); -+ -+ hal_txbf_jaguar_rf_mode(dm, beamforming_info); -+ -+ if (dm->rf_type == RF_2T2R) -+ odm_set_bb_reg(dm, ODM_REG_CSI_CONTENT_VALUE, MASKDWORD, 0x00000000); /*nc =2*/ -+ else -+ odm_set_bb_reg(dm, ODM_REG_CSI_CONTENT_VALUE, MASKDWORD, 0x01081008); /*nc =1*/ -+ -+ if (beamforming_info->beamformer_su_cnt > 0 && bfer_idx < BEAMFORMER_ENTRY_NUM) { -+ beamformer_entry = beamforming_info->beamformer_entry[bfer_idx]; -+ -+ /*Sounding protocol control*/ -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8812A, 0xCB); -+ -+ /*@MAC address/Partial AID of Beamformer*/ -+ if (bfer_idx == 0) { -+ for (i = 0; i < 6; i++) -+ odm_write_1byte(dm, (REG_BFMER0_INFO_8812A + i), beamformer_entry.mac_addr[i]); -+ /*@CSI report use legacy ofdm so don't need to fill P_AID. */ -+ /*platform_efio_write_2byte(adapter, REG_BFMER0_INFO_8812A+6, beamform_entry.P_AID); */ -+ } else { -+ for (i = 0; i < 6; i++) -+ odm_write_1byte(dm, (REG_BFMER1_INFO_8812A + i), beamformer_entry.mac_addr[i]); -+ /*@CSI report use legacy ofdm so don't need to fill P_AID.*/ -+ /*platform_efio_write_2byte(adapter, REG_BFMER1_INFO_8812A+6, beamform_entry.P_AID);*/ -+ } -+ -+ /*@CSI report parameters of Beamformee*/ -+ if (beamformer_entry.beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU) { -+ if (dm->rf_type == RF_2T2R) -+ csi_param = 0x01090109; -+ else -+ csi_param = 0x01080108; -+ } else { -+ if (dm->rf_type == RF_2T2R) -+ csi_param = 0x03090309; -+ else -+ csi_param = 0x03080308; -+ } -+ -+ odm_write_4byte(dm, REG_CSI_RPT_PARAM_BW20_8812A, csi_param); -+ odm_write_4byte(dm, REG_CSI_RPT_PARAM_BW40_8812A, csi_param); -+ odm_write_4byte(dm, 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_write_1byte(dm, REG_SND_PTCL_CTRL_8812A + 3, 0x50); -+ } -+ -+ if (beamforming_info->beamformee_su_cnt > 0 && bfee_idx < BEAMFORMEE_ENTRY_NUM) { -+ beamformee_entry = beamforming_info->beamformee_entry[bfee_idx]; -+ -+ if (phydm_acting_determine(dm, phydm_acting_as_ibss)) -+ sta_id = beamformee_entry.mac_id; -+ else -+ sta_id = beamformee_entry.p_aid; -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (bfee_idx == 0) { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8812A, sta_id); -+ odm_write_1byte(dm, REG_TXBF_CTRL_8812A + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8812A + 3) | BIT(4) | BIT(6) | BIT(7)); -+ } else -+ odm_write_2byte(dm, REG_TXBF_CTRL_8812A + 2, sta_id | BIT(12) | BIT(14) | BIT(15)); -+ -+ /*@CSI report parameters of Beamformee*/ -+ if (bfee_idx == 0) { -+ /*@Get BIT24 & BIT25*/ -+ u8 tmp = odm_read_1byte(dm, REG_BFMEE_SEL_8812A + 3) & 0x3; -+ -+ odm_write_1byte(dm, REG_BFMEE_SEL_8812A + 3, tmp | 0x60); -+ odm_write_2byte(dm, REG_BFMEE_SEL_8812A, sta_id | BIT(9)); -+ } else { -+ /*Set BIT25*/ -+ odm_write_2byte(dm, REG_BFMEE_SEL_8812A + 2, sta_id | 0xE200); -+ } -+ phydm_beamforming_notify(dm); -+ } -+} -+ -+void hal_txbf_jaguar_leave( -+ void *dm_void, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMER_ENTRY beamformer_entry; -+ struct _RT_BEAMFORMEE_ENTRY beamformee_entry; -+ -+ if (idx < BEAMFORMER_ENTRY_NUM) { -+ beamformer_entry = beamforming_info->beamformer_entry[idx]; -+ beamformee_entry = beamforming_info->beamformee_entry[idx]; -+ } else -+ return; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s]Start!, IDx = %d\n", __func__, idx); -+ -+ /*@Clear P_AID of Beamformee*/ -+ /*@Clear MAC address of Beamformer*/ -+ /*@Clear Associated Bfmee Sel*/ -+ -+ if (beamformer_entry.beamform_entry_cap == BEAMFORMING_CAP_NONE) { -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8812A, 0xC8); -+ if (idx == 0) { -+ odm_write_4byte(dm, REG_BFMER0_INFO_8812A, 0); -+ odm_write_2byte(dm, REG_BFMER0_INFO_8812A + 4, 0); -+ odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW20_8812A, 0); -+ odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW40_8812A, 0); -+ odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW80_8812A, 0); -+ } else { -+ odm_write_4byte(dm, REG_BFMER1_INFO_8812A, 0); -+ odm_write_2byte(dm, REG_BFMER1_INFO_8812A + 4, 0); -+ odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW20_8812A, 0); -+ odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW40_8812A, 0); -+ odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW80_8812A, 0); -+ } -+ } -+ -+ if (beamformee_entry.beamform_entry_cap == BEAMFORMING_CAP_NONE) { -+ hal_txbf_jaguar_rf_mode(dm, beamforming_info); -+ if (idx == 0) { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8812A, 0x0); -+ odm_write_2byte(dm, REG_BFMEE_SEL_8812A, 0); -+ } else { -+ odm_write_2byte(dm, REG_TXBF_CTRL_8812A + 2, odm_read_2byte(dm, REG_TXBF_CTRL_8812A + 2) & 0xF000); -+ odm_write_2byte(dm, REG_BFMEE_SEL_8812A + 2, odm_read_2byte(dm, REG_BFMEE_SEL_8812A + 2) & 0x60); -+ } -+ } -+} -+ -+void hal_txbf_jaguar_status( -+ void *dm_void, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 beam_ctrl_val; -+ u32 beam_ctrl_reg; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY beamform_entry = beam_info->beamformee_entry[idx]; -+ -+ if (phydm_acting_determine(dm, phydm_acting_as_ibss)) -+ beam_ctrl_val = beamform_entry.mac_id; -+ else -+ beam_ctrl_val = beamform_entry.p_aid; -+ -+ if (idx == 0) -+ beam_ctrl_reg = REG_TXBF_CTRL_8812A; -+ else { -+ beam_ctrl_reg = REG_TXBF_CTRL_8812A + 2; -+ beam_ctrl_val |= BIT(12) | BIT(14) | BIT(15); -+ } -+ -+ if (beamform_entry.beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED && beam_info->apply_v_matrix == true) { -+ if (beamform_entry.sound_bw == CHANNEL_WIDTH_20) -+ beam_ctrl_val |= BIT(9); -+ else if (beamform_entry.sound_bw == CHANNEL_WIDTH_40) -+ beam_ctrl_val |= (BIT(9) | BIT(10)); -+ else if (beamform_entry.sound_bw == CHANNEL_WIDTH_80) -+ beam_ctrl_val |= (BIT(9) | BIT(10) | BIT(11)); -+ } else -+ beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] beam_ctrl_val = 0x%x!\n", __func__, -+ beam_ctrl_val); -+ -+ odm_write_2byte(dm, beam_ctrl_reg, beam_ctrl_val); -+} -+ -+void hal_txbf_jaguar_fw_txbf( -+ void *dm_void, -+ u8 idx) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (p_beam_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ hal_txbf_jaguar_download_ndpa(dm, idx); -+ -+ hal_txbf_jaguar_fw_txbf_cmd(dm); -+} -+ -+void hal_txbf_jaguar_patch( -+ void *dm_void, -+ u8 operation) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (beam_info->beamform_cap == BEAMFORMING_CAP_NONE) -+ return; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (operation == SCAN_OPT_BACKUP_BAND0) -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8812A, 0xC8); -+ else if (operation == SCAN_OPT_RESTORE) -+ odm_write_1byte(dm, REG_SND_PTCL_CTRL_8812A, 0xCB); -+#endif -+} -+ -+void hal_txbf_jaguar_clk_8812a( -+ void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u16 u2btmp; -+ u8 count = 0, u1btmp; -+ void *adapter = dm->adapter; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); -+ -+ if (*dm->is_scan_in_process) { -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] return by Scan\n", __func__); -+ return; -+ } -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ /*Stop PCIe TxDMA*/ -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ odm_write_1byte(dm, REG_PCIE_CTRL_REG_8812A + 1, 0xFE); -+#endif -+ -+/*Stop Usb TxDMA*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISABLE_FUNC((PADAPTER)adapter, DF_TX_BIT); -+ PlatformReturnAllPendingTxPackets(adapter); -+#else -+ rtw_write_port_cancel(adapter); -+#endif -+ -+ /*Wait TXFF empty*/ -+ for (count = 0; count < 100; count++) { -+ u2btmp = odm_read_2byte(dm, REG_TXPKT_EMPTY_8812A); -+ u2btmp = u2btmp & 0xfff; -+ if (u2btmp != 0xfff) { -+ ODM_delay_ms(10); -+ continue; -+ } else -+ break; -+ } -+ -+ /*TX pause*/ -+ odm_write_1byte(dm, REG_TXPAUSE_8812A, 0xFF); -+ -+ /*Wait TX state Machine OK*/ -+ for (count = 0; count < 100; count++) { -+ if (odm_read_4byte(dm, REG_SCH_TXCMD_8812A) != 0) -+ continue; -+ else -+ break; -+ } -+ -+ /*Stop RX DMA path*/ -+ u1btmp = odm_read_1byte(dm, REG_RXDMA_CONTROL_8812A); -+ odm_write_1byte(dm, REG_RXDMA_CONTROL_8812A, u1btmp | BIT(2)); -+ -+ for (count = 0; count < 100; count++) { -+ u1btmp = odm_read_1byte(dm, REG_RXDMA_CONTROL_8812A); -+ if (u1btmp & BIT(1)) -+ break; -+ else -+ ODM_delay_ms(10); -+ } -+ -+ /*@Disable clock*/ -+ odm_write_1byte(dm, REG_SYS_CLKR_8812A + 1, 0xf0); -+ /*@Disable 320M*/ -+ odm_write_1byte(dm, REG_AFE_PLL_CTRL_8812A + 3, 0x8); -+ /*@Enable 320M*/ -+ odm_write_1byte(dm, REG_AFE_PLL_CTRL_8812A + 3, 0xa); -+ /*@Enable clock*/ -+ odm_write_1byte(dm, REG_SYS_CLKR_8812A + 1, 0xfc); -+ -+ /*Release Tx pause*/ -+ odm_write_1byte(dm, REG_TXPAUSE_8812A, 0); -+ -+ /*@Enable RX DMA path*/ -+ u1btmp = odm_read_1byte(dm, REG_RXDMA_CONTROL_8812A); -+ odm_write_1byte(dm, REG_RXDMA_CONTROL_8812A, u1btmp & (~BIT(2))); -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ /*@Enable PCIe TxDMA*/ -+ if (dm->support_interface == ODM_ITRF_PCIE) -+ odm_write_1byte(dm, REG_PCIE_CTRL_REG_8812A + 1, 0); -+#endif -+ /*Start Usb TxDMA*/ -+ RT_ENABLE_FUNC((PADAPTER)adapter, DF_TX_BIT); -+} -+ -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfjaguar.h b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfjaguar.h -new file mode 100644 -index 000000000..2c9a623ba ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/haltxbfjaguar.h -@@ -0,0 +1,78 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#ifndef __HAL_TXBF_JAGUAR_H__ -+#define __HAL_TXBF_JAGUAR_H__ -+#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+#ifdef PHYDM_BEAMFORMING_SUPPORT -+ -+void hal_txbf_8812a_set_ndpa_rate( -+ void *dm_void, -+ u8 BW, -+ u8 rate); -+ -+void hal_txbf_jaguar_enter( -+ void *dm_void, -+ u8 idx); -+ -+void hal_txbf_jaguar_leave( -+ void *dm_void, -+ u8 idx); -+ -+void hal_txbf_jaguar_status( -+ void *dm_void, -+ u8 idx); -+ -+void hal_txbf_jaguar_fw_txbf( -+ void *dm_void, -+ u8 idx); -+ -+void hal_txbf_jaguar_patch( -+ void *dm_void, -+ u8 operation); -+ -+void hal_txbf_jaguar_clk_8812a( -+ void *dm_void); -+#else -+ -+#define hal_txbf_8812a_set_ndpa_rate(dm_void, BW, rate) -+#define hal_txbf_jaguar_enter(dm_void, idx) -+#define hal_txbf_jaguar_leave(dm_void, idx) -+#define hal_txbf_jaguar_status(dm_void, idx) -+#define hal_txbf_jaguar_fw_txbf(dm_void, idx) -+#define hal_txbf_jaguar_patch(dm_void, operation) -+#define hal_txbf_jaguar_clk_8812a(dm_void) -+#endif -+#else -+ -+#define hal_txbf_8812a_set_ndpa_rate(dm_void, BW, rate) -+#define hal_txbf_jaguar_enter(dm_void, idx) -+#define hal_txbf_jaguar_leave(dm_void, idx) -+#define hal_txbf_jaguar_status(dm_void, idx) -+#define hal_txbf_jaguar_fw_txbf(dm_void, idx) -+#define hal_txbf_jaguar_patch(dm_void, operation) -+#define hal_txbf_jaguar_clk_8812a(dm_void) -+#endif -+ -+#endif /* @#ifndef __HAL_TXBF_JAGUAR_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/phydm_hal_txbf_api.c b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/phydm_hal_txbf_api.c -new file mode 100644 -index 000000000..ba0205ab4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/phydm_hal_txbf_api.c -@@ -0,0 +1,760 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "phydm_precomp.h" -+ -+#if (defined(CONFIG_BB_TXBF_API)) -+#if (RTL8822B_SUPPORT == 1 || RTL8192F_SUPPORT == 1 || RTL8812F_SUPPORT == 1 ||\ -+ RTL8822C_SUPPORT == 1 || RTL8198F_SUPPORT == 1 || RTL8814B_SUPPORT == 1) -+/*@Add by YuChen for 8822B MU-MIMO API*/ -+ -+/*this function is only used for BFer*/ -+u8 phydm_get_ndpa_rate(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 ndpa_rate = ODM_RATE6M; -+ -+ if (dm->rssi_min >= 30) /*@link RSSI > 30%*/ -+ ndpa_rate = ODM_RATE24M; -+ else if (dm->rssi_min <= 25) -+ ndpa_rate = ODM_RATE6M; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] ndpa_rate = 0x%x\n", __func__, ndpa_rate); -+ -+ return ndpa_rate; -+} -+ -+/*this function is only used for BFer*/ -+u8 phydm_get_beamforming_sounding_info(void *dm_void, u16 *throughput, -+ u8 total_bfee_num, u8 *tx_rate) -+{ -+ u8 idx = 0; -+ u8 snddecision = 0xff; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ for (idx = 0; idx < total_bfee_num; idx++) { -+ if (dm->support_ic_type & (ODM_RTL8814A)) { -+ if ((tx_rate[idx] >= ODM_RATEVHTSS3MCS7 && -+ tx_rate[idx] <= ODM_RATEVHTSS3MCS9)) -+ snddecision = snddecision & ~(1 << idx); -+ } else if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8822C | -+ ODM_RTL8812 | ODM_RTL8192F)) { -+ if ((tx_rate[idx] >= ODM_RATEVHTSS2MCS7 && -+ tx_rate[idx] <= ODM_RATEVHTSS2MCS9)) -+ snddecision = snddecision & ~(1 << idx); -+ } else if (dm->support_ic_type & -+ (ODM_RTL8814B | ODM_RTL8814C)) { -+ if ((tx_rate[idx] >= ODM_RATEVHTSS4MCS7 && -+ tx_rate[idx] <= ODM_RATEVHTSS4MCS9)) -+ snddecision = snddecision & ~(1 << idx); -+ } -+ } -+ -+ for (idx = 0; idx < total_bfee_num; idx++) { -+ if (throughput[idx] <= 10) -+ snddecision = snddecision & ~(1 << idx); -+ } -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] soundingdecision = 0x%x\n", __func__, -+ snddecision); -+ -+ return snddecision; -+} -+ -+/*this function is only used for BFer*/ -+u8 phydm_get_mu_bfee_snding_decision(void *dm_void, u16 throughput) -+{ -+ u8 snding_score = 0; -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /*throughput unit is Mbps*/ -+ if (throughput >= 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; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[%s] snding_score = 0x%x\n", __func__, -+ snding_score); -+ -+ return snding_score; -+} -+ -+#endif -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+u8 beamforming_get_htndp_tx_rate(void *dm_void, u8 bfer_str_num) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 nr_index = 0; -+ u8 ndp_tx_rate; -+/*@Find nr*/ -+#if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814A) -+ nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(dm), bfer_str_num); -+ else -+ nr_index = tx_bf_nr(1, bfer_str_num); -+ -+ switch (nr_index) { -+ case 1: -+ ndp_tx_rate = ODM_MGN_MCS8; -+ break; -+ -+ case 2: -+ ndp_tx_rate = ODM_MGN_MCS16; -+ break; -+ -+ case 3: -+ ndp_tx_rate = ODM_MGN_MCS24; -+ break; -+ -+ default: -+ ndp_tx_rate = ODM_MGN_MCS8; -+ break; -+ } -+#else -+ ndp_tx_rate = ODM_MGN_MCS8; -+#endif -+ -+ return ndp_tx_rate; -+} -+ -+u8 beamforming_get_vht_ndp_tx_rate(void *dm_void, u8 bfer_str_num) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 nr_index = 0; -+ u8 ndp_tx_rate; -+/*@Find nr*/ -+#if (RTL8814A_SUPPORT == 1) -+ if (dm->support_ic_type & ODM_RTL8814A) -+ nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(dm), bfer_str_num); -+ else -+ nr_index = tx_bf_nr(1, bfer_str_num); -+ -+ switch (nr_index) { -+ case 1: -+ ndp_tx_rate = ODM_MGN_VHT2SS_MCS0; -+ break; -+ -+ case 2: -+ ndp_tx_rate = ODM_MGN_VHT3SS_MCS0; -+ break; -+ -+ case 3: -+ ndp_tx_rate = ODM_MGN_VHT4SS_MCS0; -+ break; -+ -+ default: -+ ndp_tx_rate = ODM_MGN_VHT2SS_MCS0; -+ break; -+ } -+#else -+ ndp_tx_rate = ODM_MGN_VHT2SS_MCS0; -+#endif -+ -+ return ndp_tx_rate; -+} -+#endif -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+/*this function is only used for BFer*/ -+void phydm_txbf_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i; -+ -+ if (dm->rf_type == RF_1T1R) -+ return; -+#if (RTL8822C_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8822C) { -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ /*Path A ==================*/ -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(19), 0x1); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, 0xF, 3); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3e, 0x3, 0x2); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0xfffff, -+ 0x65AFF); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(19), 0x0); -+ -+ /*Path B ==================*/ -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, BIT(19), 0x1); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x33, 0xF, 3); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x3f, 0xfffff, -+ 0x996BF); -+ /*Select Standby mode*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x33, 0xF, 1); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x3f, 0xfffff, -+ 0x99230); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, BIT(19), 0x0); -+ } -+ -+ /*@if Nsts > Nc, don't apply V matrix*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); -+ -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ /*@enable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); -+ -+ /* logic mapping */ -+ /* TX BF logic map and TX path en for Nsts = 1~2 */ -+ odm_set_bb_reg(dm, R_0x820, 0xff, 0x33); -+ odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0x404); -+ odm_set_bb_reg(dm, R_0x820, 0xffff0000, 0x33); -+ odm_set_bb_reg(dm, R_0x1e30, 0xffff, 0x404); -+ } else { -+ /*@Disable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); -+ /*@1SS~2ss A, AB*/ -+ odm_set_bb_reg(dm, R_0x820, 0xff, 0x31); -+ odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0x400); -+ } -+ } -+#endif -+#if (RTL8812F_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8812F) { -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ /*Path A ==================*/ -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(19), 0x1); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, 0xF, 3); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3e, 0x3, 0x3); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0xfffff, -+ 0x61AFE); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(19), 0x0); -+ -+ /*Path B ==================*/ -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, BIT(19), 0x1); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x33, 0xF, 3); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x3f, 0xfffff, -+ 0xD86BF); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, BIT(19), 0x0); -+ } -+ -+ /*@if Nsts > Nc, don't apply V matrix*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); -+ -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ /*@enable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); -+ -+ /* logic mapping */ -+ /* TX BF logic map and TX path en for Nsts = 1~2 */ -+ odm_set_bb_reg(dm, R_0x820, 0xff, 0x33); -+ odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0x404); -+ odm_set_bb_reg(dm, R_0x820, 0xffff0000, 0x33); -+ odm_set_bb_reg(dm, R_0x1e30, 0xffff, 0x404); -+ } else { -+ /*@Disable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); -+ /*@1SS~2ss A, AB*/ -+ odm_set_bb_reg(dm, R_0x820, 0xff, 0x31); -+ odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0x400); -+ } -+ } -+#endif -+#if (RTL8814B_SUPPORT) -+ if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C)) { -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ for (i = RF_PATH_A; i <= RF_PATH_D; i++) { -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, -+ BIT(19), 0x1); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, -+ 0xF, 2); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, -+ 0xfffff, 0x3fc); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, -+ 0xfffff, 0x280f7); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, -+ 0xF, 3); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, -+ 0xfffff, 0x365); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, -+ 0xfffff, 0xafcf7); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, -+ BIT(19), 0x0); -+ } -+ } -+ /*@if Nsts > Nc, don't apply V matrix*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); -+ -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ /*@enable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); -+ -+ /* logic mapping */ -+ /* TX BF logic map and TX path en for Nsts = 1~4 */ -+ //odm_set_bb_reg(dm, R_0x820, 0xffff0000, 0xffff); -+ /*verification path-AC*/ -+ //odm_set_bb_reg(dm, R_0x1e30, 0xffffffff, 0xe4e4e4e4); -+ } else { -+ /*@Disable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); -+ /*@1SS~4ss A, AB, ABC, ABCD*/ -+ //odm_set_bb_reg(dm, R_0x820, 0xffff, 0xf731); -+ //odm_set_bb_reg(dm, R_0x1e2c, 0xffffffff, 0xe4240400); -+ } -+ } -+#endif -+#if (RTL8198F_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8198F) { -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ for (i = RF_PATH_A; i <= RF_PATH_D; i++) { -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, -+ BIT(19), 0x1); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x30, -+ 0xfffff, 0x18000); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x31, -+ 0xfffff, 0x4f); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x32, -+ 0xfffff, 0x71fc0); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, -+ BIT(19), 0x0); -+ } -+ } -+ /*@if Nsts > Nc, don't apply V matrix*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); -+ -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ /*@enable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); -+ -+ /* logic mapping */ -+ /* TX BF logic map and TX path en for Nsts = 1~4 */ -+ odm_set_bb_reg(dm, R_0x820, 0xffff0000, 0xffff); -+ odm_set_bb_reg(dm, R_0x1e30, 0xffffffff, 0xe4e4e4e4); -+ } else { -+ /*@Disable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); -+ /*@1SS~4ss A, AB, ABC, ABCD*/ -+ odm_set_bb_reg(dm, R_0x820, 0xffff, 0xf731); -+ odm_set_bb_reg(dm, R_0x1e2c, 0xffffffff, 0xe4240400); -+ } -+ } -+#endif -+#if (RTL8197G_SUPPORT) -+ if (dm->support_ic_type == ODM_RTL8197G) { -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ /*Path A ==================*/ -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(19), 0x1); -+ /*Set RF Rx mode table*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, -+ 0x18000); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, -+ 0x000cf); -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, -+ 0x71fc2); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(19), 0x0); -+ -+ /*Path B ==================*/ -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, BIT(19), 0x1); -+ /*Set RF Rx mode table*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, -+ 0x18000); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, -+ 0x000cf); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, -+ 0x71fc2); -+ /*Set RF Standby mode table*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, -+ 0x18000); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, -+ 0x000ef); -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, -+ 0x01042); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, BIT(19), 0x0); -+ } -+ -+ /*@if Nsts > Nc, don't apply V matrix*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); -+ -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ /*@enable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); -+ -+ /* logic mapping */ -+ /* TX BF logic map and TX path en for Nsts = 1~2 */ -+ odm_set_bb_reg(dm, R_0x820, 0xff, 0x33); -+ odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0x404); -+ odm_set_bb_reg(dm, R_0x820, 0xffff0000, 0x33); -+ odm_set_bb_reg(dm, R_0x1e30, 0xffff, 0x404); -+ } else { -+ /*@Disable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); -+ /*@1SS~2ss A, AB*/ -+ odm_set_bb_reg(dm, R_0x820, 0xff, 0x31); -+ odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0x400); -+ } -+ } -+#endif -+} -+ -+void phydm_mu_rsoml_reset(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bf_rate_info_jgr3 *rateinfo = &dm->bf_rate_info_jgr3; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] %s cnt reset\n", __func__); -+ -+ odm_memory_set(dm, &rateinfo->num_mu_vht_pkt[0], 0, VHT_RATE_NUM * 2); -+ odm_memory_set(dm, &rateinfo->num_qry_vht_pkt[0], 0, VHT_RATE_NUM * 2); -+} -+ -+void phydm_mu_rsoml_init(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bf_rate_info_jgr3 *rateinfo = &dm->bf_rate_info_jgr3; -+ u32 val = 0; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] %s\n", __func__); -+ -+ /*OFDM Tx*/ -+ val = odm_get_bb_reg(dm, R_0x820, MASKDWORD); -+ rateinfo->tx_path_en_ofdm_2sts = (u8)((val & 0xf0) >> 4); -+ rateinfo->tx_path_en_ofdm_1sts = (u8)(val & 0xf); -+ /*OFDM Rx*/ -+ rateinfo->rx_path_en_ofdm = (u8)odm_get_bb_reg(dm, R_0x824, 0xf0000); -+ -+ rateinfo->enable = 1; -+ rateinfo->mu_ratio_th = 30; -+ rateinfo->pre_mu_ratio = 0; -+ rateinfo->mu_set_trxpath = 0; -+ rateinfo->mu_been_iot = 0; -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] %s tx1ss=%d, tx2ss=%d, rx=%d\n", -+ __func__, rateinfo->tx_path_en_ofdm_1sts, -+ rateinfo->tx_path_en_ofdm_2sts, rateinfo->rx_path_en_ofdm); -+ -+ phydm_mu_rsoml_reset(dm); -+} -+ -+void phydm_mu_rsoml_decision(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bf_rate_info_jgr3 *rateinfo = &dm->bf_rate_info_jgr3; -+ struct phydm_iot_center *iot_table = &dm->iot_table; -+ u8 offset = 0; -+ u32 mu_ratio = 0; -+ u32 su_pkt = 0; -+ u32 mu_pkt = 0; -+ u32 total_pkt = 0; -+ -+ if (rateinfo->tx_path_en_ofdm_2sts != 3 || -+ rateinfo->rx_path_en_ofdm != 3) { -+ PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] Init Not 2T2R 22CE\n"); -+ return; -+ } -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] RSOML Decision eanble: %d\n", -+ rateinfo->enable); -+ -+ if (!rateinfo->enable) -+ return; -+ -+ for (offset = 0; offset < VHT_RATE_NUM; offset++) { -+ mu_pkt += rateinfo->num_mu_vht_pkt[offset]; -+ su_pkt += rateinfo->num_qry_vht_pkt[offset]; -+ } -+ total_pkt = su_pkt + mu_pkt; -+ -+ if (total_pkt == 0) -+ mu_ratio = 0; -+ else -+ mu_ratio = (mu_pkt * 100) / total_pkt; // unit:% -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] MU rx ratio: %d, total pkt: %d\n", -+ mu_ratio, total_pkt); -+ -+ if (mu_ratio > rateinfo->mu_ratio_th && -+ rateinfo->pre_mu_ratio > rateinfo->mu_ratio_th) { -+ PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] RSOML status remain\n"); -+ } else if (mu_ratio <= rateinfo->mu_ratio_th && -+ rateinfo->pre_mu_ratio <= rateinfo->mu_ratio_th) { -+ PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] RSOML status remain\n"); -+ } else if (mu_ratio > rateinfo->mu_ratio_th) { -+ odm_set_bb_reg(dm, R_0xc00, BIT(26), 0); -+ PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] RSOML OFF\n"); -+ } else { -+ odm_set_bb_reg(dm, R_0xc00, BIT(26), 1); -+ PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] RSOML ON\n"); -+ } -+ -+ PHYDM_DBG(dm, DBG_TXBF, "[MU IOT] set_trxpath=%d, patch_10120200=%d\n", -+ rateinfo->mu_set_trxpath, iot_table->patch_id_10120200); -+ if (rateinfo->mu_set_trxpath && iot_table->patch_id_10120200) { -+ if (mu_ratio > rateinfo->mu_ratio_th) { -+ phydm_api_trx_mode(dm, BB_PATH_AB, BB_PATH_A, -+ BB_PATH_AUTO); -+ PHYDM_DBG(dm, DBG_TXBF, "[MU IOT] 22C IOT 2T1R\n"); -+ rateinfo->mu_been_iot = 1; -+ } else { -+ phydm_api_trx_mode(dm, BB_PATH_AB, BB_PATH_AB, -+ BB_PATH_AUTO); -+ PHYDM_DBG(dm, DBG_TXBF, "[MU IOT] 22C IOT 2T2R\n"); -+ rateinfo->mu_been_iot = 0; -+ } -+ } else if (rateinfo->mu_been_iot == 1) { -+ if (odm_get_bb_reg(dm, R_0x824, 0xf0000) == 1) { -+ phydm_api_trx_mode(dm, BB_PATH_AB, BB_PATH_AB, -+ BB_PATH_AUTO); -+ PHYDM_DBG(dm, DBG_TXBF, "[MU IOT] 22C IOT Restore\n"); -+ rateinfo->mu_been_iot = 0; -+ } -+ } -+ -+ rateinfo->pre_mu_ratio = mu_ratio; -+ phydm_mu_rsoml_reset(dm); -+} -+ -+ -+#if (RTL8814B_SUPPORT == 1) -+void phydm_txbf_80p80_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ u8 i; -+ -+ if (dm->rf_type == RF_1T1R) -+ return; -+ -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ for (i = RF_PATH_A; i <= RF_PATH_D; i += 3) { -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), -+ 0x1); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, 0xF, 2); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, 0xfffff, -+ 0x3fc); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, -+ 0x280f7); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, 0xF, 3); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, 0xfffff, -+ 0x365); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, -+ 0xafcf7); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), -+ 0x0); -+ } -+ for (i = RF_PATH_B; i <= RF_PATH_C; i++) { -+ /*RF mode table write enable*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), -+ 0x1); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, 0xF, 2); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, -+ 0x280c7); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, -+ 0x280c7); -+ /*Select RX mode*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, 0xF, 3); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, 0xfffff, -+ 0x365); -+ /*Set Table data*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, -+ 0xafcc7); -+ /*RF mode table write disable*/ -+ odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), -+ 0x0); -+ } -+ } -+ /*@if Nsts > Nc, don't apply V matrix*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); -+ -+ if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { -+ /*@enable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); -+ -+ /* logic mapping */ -+ /* TX BF logic map and TX path en for Nsts = 1~2 */ -+ odm_set_bb_reg(dm, R_0x820, 0xff0000, 0x33); /*seg0*/ -+ odm_set_bb_reg(dm, R_0x824, 0xff00, 0xcc); /*seg1*/ -+ odm_set_bb_reg(dm, R_0x1e30, 0xffff, 0xe4e4); -+ -+ } else { -+ /*@Disable BB TxBF ant mapping register*/ -+ odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); -+ odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); -+ /*@1SS~2ss A, AB*/ -+ odm_set_bb_reg(dm, R_0x820, 0xff, 0x31); /*seg0*/ -+ odm_set_bb_reg(dm, R_0x824, 0xff, 0xc8); /*seg1*/ -+ odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0xe420); -+ } -+} -+#endif -+#endif /*PHYSTS_3RD_TYPE_IC*/ -+ -+void phydm_txbf_avoid_hang(void *dm_void) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ -+ /* avoid CCK CCA hang when the BF mode */ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ odm_set_bb_reg(dm, R_0x1e6c, 0x100000, 0x1); -+#endif -+ -+ /* avoid CCK CCA hang when the BFee mode for 92F */ -+#if (RTL8192F_SUPPORT == 1) -+ odm_set_bb_reg(dm, R_0xa70, 0xffff0000, 0x80ff); -+#endif -+} -+ -+void phydm_bf_debug(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len) -+{ -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ char help[] = "-h"; -+ u32 var1[3] = {0}; -+ u32 i; -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "{BF ver1 :0}, {NO applyV:0; applyV:1; default:2}\n"); -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "{MU RSOML:1}, {MU enable:1/0}, {MU Ratio:40}\n"); -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "{MU TRxPath:2}, {TRxPath enable:1/0}\n"); -+ return; -+ } -+ for (i = 0; i < 3; i++) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ if (var1[0] == 0) { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ #ifdef PHYDM_BEAMFORMING_SUPPORT -+ struct _RT_BEAMFORMING_INFO *beamforming_info = NULL; -+ -+ beamforming_info = &dm->beamforming_info; -+ -+ if (var1[1] == 0) { -+ beamforming_info->apply_v_matrix = false; -+ beamforming_info->snding3ss = true; -+ PDM_SNPF(*_out_len, *_used, output + *_used, -+ *_out_len - *_used, -+ "\r\n dont apply V matrix and 3SS 789 snding\n"); -+ } else if (var1[1] == 1) { -+ beamforming_info->apply_v_matrix = true; -+ beamforming_info->snding3ss = true; -+ PDM_SNPF(*_out_len, *_used, output + *_used, -+ *_out_len - *_used, -+ "\r\n apply V matrix and 3SS 789 snding\n"); -+ } else if (var1[1] == 2) { -+ beamforming_info->apply_v_matrix = true; -+ beamforming_info->snding3ss = false; -+ PDM_SNPF(*_out_len, *_used, output + *_used, -+ *_out_len - *_used, -+ "\r\n default txbf setting\n"); -+ } else { -+ PDM_SNPF(*_out_len, *_used, output + *_used, -+ *_out_len - *_used, -+ "\r\n unknown cmd!!\n"); -+ } -+ #endif -+ #endif -+ } else if (var1[0] == 1) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bf_rate_info_jgr3 *bfinfo = &dm->bf_rate_info_jgr3; -+ -+ bfinfo->enable = (u8)var1[1]; -+ bfinfo->mu_ratio_th = (u8)var1[2]; -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "[MU RSOML] enable= %d, MU ratio TH= %d\n", -+ bfinfo->enable, bfinfo->mu_ratio_th); -+ #endif -+ } else if (var1[0] == 2) { -+ #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+ struct dm_struct *dm = (struct dm_struct *)dm_void; -+ struct phydm_bf_rate_info_jgr3 *bfinfo = &dm->bf_rate_info_jgr3; -+ -+ bfinfo->mu_set_trxpath = (u8)var1[1]; -+ PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, -+ "[MU TRxPath] mu_set_trxpath = %d\n", -+ bfinfo->mu_set_trxpath); -+ #endif -+ } -+} -+ -+#endif /*CONFIG_BB_TXBF_API*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/phydm_hal_txbf_api.h b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/phydm_hal_txbf_api.h -new file mode 100644 -index 000000000..15659ccb3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/phydm/txbf/phydm_hal_txbf_api.h -@@ -0,0 +1,89 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 full GNU General Public License is included in this distribution in the -+ * file called LICENSE. -+ * -+ * Contact Information: -+ * wlanfae -+ * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, -+ * Hsinchu 300, Taiwan. -+ * -+ * Larry Finger -+ * -+ *****************************************************************************/ -+#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) -+#if defined(DM_ODM_CE_MAC80211) -+#define tx_bf_nr(a, b) ({ \ -+ u8 __tx_bf_nr_a = (a); \ -+ u8 __tx_bf_nr_b = (b); \ -+ ((__tx_bf_nr_a > __tx_bf_nr_b) ? (__tx_bf_nr_b) : (__tx_bf_nr_a)); }) -+#else -+#define tx_bf_nr(a, b) ((a > b) ? (b) : (a)) -+#endif -+ -+u8 beamforming_get_htndp_tx_rate(void *dm_void, u8 bfer_str_num); -+ -+u8 beamforming_get_vht_ndp_tx_rate(void *dm_void, u8 bfer_str_num); -+ -+#endif -+ -+#if (RTL8822B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 || RTL8192F_SUPPORT == 1 ||\ -+ RTL8814B_SUPPORT == 1 || RTL8198F_SUPPORT == 1 || RTL8812F_SUPPORT == 1) -+u8 phydm_get_beamforming_sounding_info(void *dm_void, u16 *throughput, -+ u8 total_bfee_num, u8 *tx_rate); -+u8 phydm_get_ndpa_rate(void *dm_void); -+ -+u8 phydm_get_mu_bfee_snding_decision(void *dm_void, u16 throughput); -+ -+#else -+#define phydm_get_beamforming_sounding_info(dm, tp, bfee_num, rate) 0 -+#define phydm_get_ndpa_rate(dm) -+#define phydm_get_mu_bfee_snding_decision(dm, tp) -+ -+#endif -+ -+#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT -+struct phydm_bf_rate_info_jgr3 { -+ u8 enable; -+ u8 mu_ratio_th; -+ u32 pre_mu_ratio; -+ u16 num_mu_vht_pkt[VHT_RATE_NUM]; -+ u16 num_qry_vht_pkt[VHT_RATE_NUM]; -+ boolean mu_set_trxpath; -+ u8 tx_path_en_ofdm_1sts; -+ u8 tx_path_en_ofdm_2sts; -+ u8 rx_path_en_ofdm; -+ boolean mu_been_iot; -+}; -+ -+/*this function is only used for BFer*/ -+void phydm_txbf_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt); -+void phydm_txbf_avoid_hang(void *dm_void); -+void phydm_mu_rsoml_init(void *dm_void); -+void phydm_mu_rsoml_decision(void *dm_void); -+ -+#if (RTL8814B_SUPPORT == 1) -+void phydm_txbf_80p80_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt); -+#endif -+ -+#endif /*#PHYDM_IC_JGR3_SERIES_SUPPORT*/ -+void phydm_bf_debug(void *dm_void, char input[][16], u32 *_used, char *output, -+ u32 *_out_len); -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/hal8821c_fw.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/hal8821c_fw.c -new file mode 100644 -index 000000000..75b3288c6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/hal8821c_fw.c -@@ -0,0 +1,53654 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2012 - 2017 Realtek Corporation. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifdef CONFIG_RTL8821C -+ -+#include "drv_types.h" -+ -+#ifdef LOAD_FW_HEADER_FROM_DRIVER -+ -+#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) -+ -+u8 array_mp_8821c_fw_ap[] = { -+0x21, 0x88, 0x00, 0x00, 0x18, 0x00, 0x05, 0x00, -+0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, -+0x09, 0x06, 0x0F, 0x13, 0xE3, 0x07, 0x00, 0x00, -+0x18, 0x00, 0x00, 0x00, 0x0C, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x20, 0x80, 0x38, 0x7D, 0x00, 0x00, -+0x00, 0x00, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xE0, 0xBA, 0x00, 0x00, 0xA8, 0x89, 0x00, 0x00, -+0x00, 0x00, 0x10, 0x80, 0x00, 0x00, 0x03, 0x80, -+0x00, 0x00, 0x04, 0x04, 0x08, 0x08, 0x08, 0x08, -+0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, -+0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, -+0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x03, 0x00, 0x01, 0xFE, 0x03, 0x01, 0x01, 0xFE, -+0x03, 0x02, 0x01, 0xFE, 0x03, 0x03, 0x01, 0xFE, -+0x03, 0x04, 0x01, 0xFE, 0x03, 0x05, 0x01, 0xFE, -+0x03, 0x06, 0x01, 0xFE, 0x03, 0x07, 0x01, 0xFE, -+0x06, 0x00, 0x00, 0x00, 0x05, 0x00, 0x00, 0x00, -+0x01, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, -+0x00, 0x01, 0x10, 0x00, 0x01, 0x00, 0x03, 0x80, -+0x9D, 0x01, 0x03, 0x80, 0x9D, 0x01, 0x03, 0x80, -+0xA1, 0x46, 0x03, 0x80, 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, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x51, 0x46, 0x03, 0x80, 0x01, 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, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x70, 0x83, 0x20, 0x80, 0x41, 0x4E, 0x59, 0x00, -+0x61, 0x6E, 0x79, 0x00, 0x81, 0x00, 0x88, 0x00, -+0x90, 0x00, 0x99, 0x00, 0xA2, 0x00, 0xAC, 0x00, -+0xB6, 0x00, 0xC0, 0x00, 0xCC, 0x00, 0xD8, 0x00, -+0xE5, 0x00, 0xF2, 0x00, 0x01, 0x01, 0x10, 0x01, -+0x20, 0x01, 0x31, 0x01, 0x43, 0x01, 0x56, 0x01, -+0x6A, 0x01, 0x80, 0x01, 0x97, 0x01, 0xAF, 0x01, -+0xC8, 0x01, 0xE3, 0x01, 0x00, 0x02, 0x1E, 0x02, -+0x3E, 0x02, 0x61, 0x02, 0x85, 0x02, 0xAB, 0x02, -+0xD3, 0x02, 0xFE, 0x02, 0x2B, 0x03, 0x5C, 0x03, -+0x8E, 0x03, 0xC4, 0x03, 0xFE, 0x03, 0x00, 0x00, -+0x22, 0x05, 0x50, 0x05, 0x51, 0x05, 0x1A, 0x15, -+0x08, 0x08, 0x0C, 0x09, 0x00, 0x0C, 0xB0, 0x0C, -+0xB4, 0x0C, 0xBC, 0x0C, 0x90, 0x19, 0xA4, 0x09, -+0x04, 0x0A, 0x00, 0x0B, 0x38, 0x08, 0x00, 0x00, -+0xDF, 0xDE, 0x8F, 0x00, 0x01, 0x00, 0x00, 0x00, -+0x06, 0x09, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x36, -+0x01, 0x02, 0x05, 0x0B, 0x00, 0x00, 0x00, 0x00, -+0x01, 0x02, 0x03, 0x06, 0x05, 0x06, 0x07, 0x08, -+0x09, 0x0A, 0x0B, 0x2C, 0xFF, 0x00, 0x01, 0x02, -+0x02, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, -+0x28, 0x28, 0x32, 0x28, 0x1E, 0x19, 0x19, 0x19, -+0x18, 0x18, 0x12, 0x0F, 0x1E, 0x1E, 0x19, 0x1E, -+0x18, 0x16, 0x0C, 0x0C, 0x1E, 0x1E, 0x19, 0x1E, -+0x18, 0x16, 0x0C, 0x0C, 0x1E, 0x1E, 0x19, 0x1C, -+0x18, 0x14, 0x0C, 0x0A, 0x1E, 0x1E, 0x19, 0x1E, -+0x19, 0x18, 0x0F, 0x0E, 0x1E, 0x1E, 0x1E, 0x1E, -+0x1C, 0x16, 0x14, 0x12, 0x0C, 0x0A, 0x1E, 0x1E, -+0x1E, 0x1E, 0x1A, 0x16, 0x12, 0x10, 0x0C, 0x0A, -+0x1E, 0x1E, 0x1E, 0x1E, 0x18, 0x16, 0x0D, 0x0E, -+0x0C, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x12, 0x12, 0x14, 0x12, -+0x0F, 0x0F, 0x0C, 0x0C, 0x09, 0x08, 0x08, 0x07, -+0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, 0x05, 0x04, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x0A, 0x0A, 0x08, 0x08, 0x08, 0x07, 0x07, 0x06, -+0x04, 0x04, 0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, -+0x07, 0x06, 0x05, 0x04, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x05, 0x04, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x02, 0x02, 0x02, 0x04, 0x02, 0x04, 0x06, 0x06, -+0x08, 0x08, 0x09, 0x09, 0x04, 0x08, 0x08, 0x08, -+0x0C, 0x10, 0x10, 0x18, 0x04, 0x08, 0x08, 0x08, -+0x0C, 0x10, 0x10, 0x18, 0x05, 0x08, 0x08, 0x09, -+0x10, 0x14, 0x1C, 0x20, 0x04, 0x06, 0x08, 0x0A, -+0x10, 0x18, 0x18, 0x20, 0x03, 0x05, 0x08, 0x09, -+0x10, 0x14, 0x1C, 0x24, 0x2A, 0x2C, 0x05, 0x07, -+0x09, 0x0A, 0x10, 0x14, 0x1C, 0x28, 0x2C, 0x30, -+0x06, 0x08, 0x0A, 0x0C, 0x12, 0x18, 0x1E, 0x30, -+0x38, 0x42, 0x0A, 0x0C, 0x0C, 0x12, 0x16, 0x1C, -+0x20, 0x24, 0x24, 0x30, 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, -+0x2C, 0x00, 0x04, 0x00, 0x2D, 0x00, 0x2C, 0x01, -+0x2D, 0x01, 0x2C, 0x02, 0x2E, 0x01, 0xFF, 0x00, -+0x2D, 0x02, 0xFF, 0x00, 0x36, 0x2D, 0xFF, 0x36, -+0x2E, 0xFF, 0x37, 0x2F, 0xFF, 0x41, 0x38, 0x30, -+0x39, 0x42, 0x31, 0x42, 0x3A, 0x32, 0x43, 0x3A, -+0x33, 0x43, 0x3A, 0x34, 0x3A, 0x44, 0x35, 0x44, -+0x3B, 0xFF, 0x37, 0x2E, 0x40, 0x38, 0x30, 0x41, -+0x39, 0x42, 0x31, 0x3A, 0x43, 0x32, 0x3B, 0x43, -+0x35, 0x3C, 0x44, 0xFF, 0x3D, 0x45, 0xFF, 0x3E, -+0x45, 0xFF, 0x45, 0x3F, 0xFF, 0x46, 0xFF, 0xFF, -+0x37, 0x41, 0x2F, 0x39, 0x42, 0x31, 0x43, 0x3A, -+0x33, 0x44, 0x3B, 0x35, 0x45, 0x3D, 0xFF, 0x46, -+0x47, 0x3E, 0x47, 0xFF, 0xFF, 0x48, 0xFF, 0xFF, -+0x49, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, -+0x0D, 0x14, 0xFF, 0x15, 0x0E, 0xFF, 0x15, 0x0F, -+0xFF, 0x16, 0x10, 0xFF, 0x17, 0x1E, 0x11, 0x1E, -+0x18, 0x12, 0x1F, 0x18, 0x13, 0x18, 0x1F, 0xFF, -+0x15, 0x0E, 0xFF, 0x16, 0x1D, 0x10, 0x17, 0x1E, -+0x10, 0x18, 0x1E, 0x11, 0x19, 0x1F, 0xFF, 0x1A, -+0x20, 0xFF, 0x21, 0x1B, 0xFF, 0x21, 0xFF, 0xFF, -+0x15, 0x13, 0x0F, 0x17, 0x1E, 0x11, 0x18, 0x1F, -+0x13, 0x20, 0x19, 0xFF, 0x21, 0x1B, 0xFF, 0x22, -+0xFF, 0xFF, 0x23, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, -+0x04, 0x04, 0x04, 0x36, 0x2C, 0xFF, 0x2D, 0xFF, -+0xFF, 0x2E, 0x37, 0xFF, 0x38, 0x41, 0x2F, 0x39, -+0x42, 0x30, 0x43, 0x39, 0x31, 0x42, 0x39, 0x32, -+0x43, 0x3A, 0x33, 0x43, 0x3A, 0x34, 0x2D, 0x2C, -+0xFF, 0x36, 0x2E, 0xFF, 0x37, 0x2F, 0x40, 0x38, -+0x30, 0x41, 0x42, 0x33, 0x39, 0x43, 0x35, 0x3A, -+0x3B, 0x43, 0x34, 0x44, 0x3C, 0x3B, 0x45, 0x3D, -+0x3C, 0x45, 0x3E, 0x3D, 0x37, 0x2E, 0xFF, 0x38, -+0x2F, 0x40, 0x39, 0x31, 0x41, 0x3A, 0x42, 0xFF, -+0x43, 0x3B, 0xFF, 0x44, 0x3C, 0xFF, 0x45, 0x3D, -+0x3C, 0x46, 0x3F, 0x45, 0x47, 0x46, 0x45, 0x48, -+0x47, 0x47, 0x00, 0x00, 0x04, 0xFF, 0xFF, 0x0C, -+0xFF, 0xFF, 0x0D, 0x14, 0xFF, 0x0E, 0x15, 0xFF, -+0x16, 0x0F, 0xFF, 0x17, 0x10, 0xFF, 0x17, 0x11, -+0xFF, 0x17, 0x12, 0xFF, 0x0D, 0x0C, 0xFF, 0x14, -+0x0E, 0xFF, 0x15, 0x0F, 0xFF, 0x16, 0x1D, 0x10, -+0x17, 0x1E, 0x12, 0x18, 0x1F, 0x13, 0x19, 0x20, -+0x19, 0x20, 0x1A, 0x19, 0x14, 0x0E, 0xFF, 0x15, -+0x1C, 0xFF, 0x17, 0x1D, 0x11, 0x18, 0x1E, 0x13, -+0x19, 0x1F, 0x1E, 0x20, 0x1A, 0x1F, 0x21, 0x1B, -+0x20, 0x22, 0x21, 0x1B, 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, 0x30, -+0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, -+0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, -+0x00, 0x00, 0x00, 0x00, 0x24, 0x28, 0x2A, 0x2C, -+0x2E, 0x30, 0x00, 0x00, 0x00, 0x00, 0x26, 0x29, -+0x2B, 0x2D, 0x2F, 0x31, 0x00, 0x00, 0x00, 0x00, -+0x28, 0x2A, 0x2C, 0x2E, 0x30, 0x32, 0x00, 0x00, -+0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, -+0x01, 0x00, 0x02, 0x00, 0x05, 0x00, 0x0B, 0x00, -+0x06, 0x00, 0x09, 0x00, 0x0C, 0x00, 0x12, 0x00, -+0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x36, 0x00, -+0x0E, 0x00, 0x1B, 0x00, 0x29, 0x00, 0x36, 0x00, -+0x51, 0x00, 0x6C, 0x00, 0x7A, 0x00, 0x87, 0x00, -+0x1B, 0x00, 0x36, 0x00, 0x51, 0x00, 0x6C, 0x00, -+0xA2, 0x00, 0xD8, 0x00, 0xF3, 0x00, 0x0E, 0x01, -+0x29, 0x00, 0x51, 0x00, 0x7A, 0x00, 0xA2, 0x00, -+0xF3, 0x00, 0x44, 0x01, 0x6D, 0x01, 0x95, 0x01, -+0x36, 0x00, 0x6C, 0x00, 0xA2, 0x00, 0xD8, 0x00, -+0x44, 0x01, 0xB0, 0x01, 0xE6, 0x01, 0x1C, 0x02, -+0x0E, 0x00, 0x1B, 0x00, 0x29, 0x00, 0x36, 0x00, -+0x51, 0x00, 0x6C, 0x00, 0x7A, 0x00, 0x87, 0x00, -+0xA2, 0x00, 0xB4, 0x00, 0x1B, 0x00, 0x36, 0x00, -+0x51, 0x00, 0x6C, 0x00, 0xA2, 0x00, 0xD8, 0x00, -+0xF3, 0x00, 0xFF, 0x00, 0x23, 0x01, 0x44, 0x01, -+0x29, 0x00, 0x51, 0x00, 0x7A, 0x00, 0xA2, 0x00, -+0xF3, 0x00, 0x44, 0x01, 0x64, 0x01, 0x64, 0x01, -+0xB5, 0x01, 0xE6, 0x01, 0x36, 0x00, 0x6C, 0x00, -+0xA2, 0x00, 0xD8, 0x00, 0x44, 0x01, 0xB0, 0x01, -+0xE6, 0x01, 0x1C, 0x02, 0x88, 0x02, 0xD0, 0x02, -+0x14, 0x14, 0x15, 0x15, 0x16, 0x17, 0x17, 0x18, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1D, 0x1D, 0x1E, 0x1E, -+0x1C, 0x1C, 0x1D, 0x1E, 0x1F, 0x20, 0x20, 0x20, -+0x36, 0x36, 0x37, 0x37, 0x38, 0x39, 0x39, 0x3A, -+0x3A, 0x3A, 0x00, 0x00, 0x40, 0x40, 0x40, 0x40, -+0x41, 0x41, 0x42, 0x42, 0x43, 0x43, 0x00, 0x00, -+0x40, 0x40, 0x41, 0x42, 0x43, 0x44, 0x44, 0x44, -+0x45, 0x46, 0x00, 0x00, 0x00, 0xF0, 0x01, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x01, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x07, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x07, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x00, 0x00, -+0x00, 0x00, 0x30, 0xC0, 0xE0, 0x00, 0x00, 0x00, -+0x00, 0x0C, 0x0E, 0x38, 0x18, 0x00, 0x00, 0x00, -+0x00, 0x83, 0x01, 0x06, 0x80, 0x03, 0x00, 0x00, -+0x00, 0x00, 0x70, 0xE0, 0x00, 0x04, 0x00, 0x00, -+0xE8, 0x67, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x30, 0xF0, 0x21, 0x6C, 0x18, 0xF0, 0x00, 0x4C, -+0xBC, 0x65, 0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x77, 0xF0, -+0x20, 0x6C, 0x80, 0xF0, 0x80, 0x9C, 0x80, 0xF0, -+0x20, 0x6E, 0xCC, 0xEC, 0x1E, 0x24, 0x30, 0xF0, -+0x21, 0x6C, 0xF4, 0xF7, 0x1C, 0x4C, 0x80, 0x9C, -+0xBC, 0x65, 0x30, 0xF0, 0x21, 0x6C, 0xF4, 0xF7, -+0x18, 0x4C, 0x80, 0x9C, 0xFC, 0x65, 0x9F, 0x67, -+0x77, 0xF0, 0x24, 0x6D, 0xE0, 0xF2, 0x90, 0xDD, -+0x9D, 0x67, 0x77, 0xF0, 0x24, 0x6D, 0xE0, 0xF2, -+0x94, 0xDD, 0x9D, 0x67, 0x85, 0x9C, 0x77, 0xF0, -+0x24, 0x6D, 0xE0, 0xF2, 0x98, 0xDD, 0x20, 0xE8, -+0x00, 0x65, 0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, -+0x08, 0x4C, 0x00, 0x6E, 0x30, 0xF0, 0x20, 0x6F, -+0x2F, 0xF0, 0x08, 0x4F, 0xC0, 0xDC, 0x04, 0x4C, -+0xE3, 0xEC, 0xB8, 0x67, 0xFB, 0x2D, 0x30, 0xF0, -+0x21, 0x6C, 0x70, 0xF3, 0x10, 0x4C, 0x00, 0x6E, -+0x30, 0xF0, 0x21, 0x6F, 0xB0, 0xF4, 0x18, 0x4F, -+0xC0, 0xDC, 0x04, 0x4C, 0xE3, 0xEC, 0xB8, 0x67, -+0xFB, 0x2D, 0x30, 0xF0, 0x21, 0x6C, 0x15, 0xF0, -+0x00, 0x4C, 0x00, 0x6E, 0x30, 0xF0, 0x21, 0x6F, -+0x18, 0xF0, 0x00, 0x4F, 0xC0, 0xDC, 0x04, 0x4C, -+0xE3, 0xEC, 0xB8, 0x67, 0xFB, 0x2D, 0x10, 0xF0, -+0x23, 0x6C, 0xC0, 0xF0, 0x01, 0x4C, 0x00, 0xEC, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0xC0, 0xF0, 0x01, 0x4A, 0x40, 0xDB, -+0x00, 0x1C, 0x94, 0x00, 0x80, 0x18, 0xC8, 0x06, -+0x80, 0x18, 0xAF, 0x05, 0x80, 0x18, 0xD1, 0x05, -+0x80, 0x18, 0x88, 0x06, 0x80, 0x18, 0xFF, 0x05, -+0x80, 0x18, 0xA4, 0x06, 0x80, 0x18, 0xF2, 0x03, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF7, 0x54, 0x9A, -+0x30, 0xF0, 0x20, 0x68, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6C, 0x30, 0xF0, 0x21, 0x6A, 0x80, 0xF1, -+0x08, 0x4C, 0x15, 0xF0, 0x00, 0x4A, 0x43, 0xDC, -+0xCE, 0xF7, 0x40, 0x98, 0x00, 0x6D, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x2D, 0xF1, 0x50, 0xDB, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF7, 0x50, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x6F, 0xF0, 0x08, 0x4C, -+0x01, 0x6D, 0x40, 0xEA, 0x30, 0xF0, 0x21, 0x6B, -+0xB0, 0xF4, 0x4C, 0xDB, 0x30, 0xF0, 0x20, 0x6C, -+0x30, 0xF0, 0x21, 0x6A, 0x2F, 0xF0, 0x08, 0x4C, -+0x15, 0xF4, 0x00, 0x4A, 0x43, 0xDC, 0xCE, 0xF7, -+0x40, 0x98, 0x00, 0x6D, 0x40, 0xEA, 0x30, 0xF0, -+0x21, 0x6B, 0xB0, 0xF4, 0x44, 0xDB, 0x00, 0x18, -+0x49, 0xDC, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF2, -+0x60, 0x9A, 0xFF, 0xF7, 0x1F, 0x6C, 0x10, 0xF0, -+0x00, 0x6D, 0x40, 0xAB, 0xAB, 0xED, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF7, 0x58, 0x9A, 0x40, 0xEA, -+0x00, 0x1C, 0x95, 0x45, 0xFF, 0x17, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x6D, 0xB8, 0x00, 0x65, -+0x00, 0xF0, 0x20, 0x6A, 0x7C, 0x4A, 0x6C, 0xEA, -+0x1C, 0x22, 0x00, 0xF0, 0x20, 0x6B, 0x28, 0x4B, -+0x6A, 0xEA, 0x0B, 0x61, 0x4E, 0xB8, 0x00, 0x65, -+0x00, 0xF0, 0x20, 0x6B, 0x01, 0x4B, 0x6B, 0xE2, -+0x60, 0xAA, 0xBF, 0xF6, 0x1A, 0x6A, 0x6A, 0xEA, -+0x31, 0x60, 0x77, 0xF0, 0x24, 0x6A, 0xA0, 0xF1, -+0x1C, 0x4A, 0x1D, 0xF4, 0x00, 0x6B, 0x60, 0xDA, -+0x10, 0xF0, 0x23, 0x6A, 0x64, 0xF2, 0x15, 0x4A, -+0x00, 0xEA, 0x00, 0xF0, 0x20, 0x6A, 0x1F, 0xF7, -+0x00, 0x6A, 0x4C, 0xEB, 0x4C, 0xB8, 0x00, 0x65, -+0x6C, 0xEA, 0x42, 0x32, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF0, 0x00, 0x4B, 0x49, 0xE3, 0x40, 0xA2, -+0x30, 0xF0, 0x20, 0x6B, 0x40, 0xF1, 0x08, 0x4B, -+0x69, 0xE2, 0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, -+0x08, 0x4B, 0x60, 0x9B, 0x05, 0x2B, 0x10, 0xF0, -+0x23, 0x6B, 0x80, 0xF3, 0x01, 0x4B, 0x00, 0xEB, -+0x10, 0xF0, 0x23, 0x6B, 0x00, 0xF4, 0x15, 0x4B, -+0x00, 0xEB, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0x0D, 0xF1, 0x1C, 0x4A, 0x00, 0xF0, 0x20, 0x6B, -+0x01, 0x6B, 0x60, 0xDA, 0x10, 0xF0, 0x23, 0x6B, -+0x40, 0xF2, 0x09, 0x4B, 0x00, 0xEB, 0x00, 0x65, -+0x5A, 0xB8, 0x00, 0x65, 0x7B, 0xB8, 0x00, 0x65, -+0x40, 0xE8, 0x5A, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x7B, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, 0x0D, 0xF1, -+0x1C, 0x4A, 0x00, 0xF0, 0x20, 0x6B, 0x60, 0xDA, -+0x30, 0xF0, 0x20, 0x6A, 0x2D, 0xF1, 0x18, 0x4A, -+0x60, 0x9A, 0x41, 0x9A, 0x6A, 0xEA, 0x0D, 0x61, -+0x6E, 0xB8, 0x00, 0x65, 0x62, 0x43, 0xCB, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x5A, 0xB8, -+0x00, 0x65, 0x7B, 0xB8, 0x00, 0x65, 0x00, 0xBA, -+0x00, 0x65, 0x36, 0x23, 0xDF, 0xF7, 0x00, 0x03, -+0x86, 0xDB, 0xA7, 0xDB, 0xC8, 0xDB, 0xE9, 0xDB, -+0x0A, 0xDB, 0x2B, 0xDB, 0x98, 0x67, 0x8C, 0xDB, -+0x9F, 0x67, 0x8E, 0xDB, 0x12, 0xEC, 0x10, 0xED, -+0x82, 0xDB, 0xA3, 0xDB, 0x9A, 0xB8, 0x00, 0x65, -+0x84, 0xDB, 0x9B, 0xB8, 0x00, 0x65, 0x85, 0xDB, -+0x8E, 0xB8, 0x00, 0x65, 0x82, 0x44, 0x81, 0xDB, -+0x8C, 0xB8, 0x00, 0x65, 0x80, 0xDB, 0x30, 0xF0, -+0x20, 0x6B, 0x2D, 0xF1, 0x18, 0x4B, 0x60, 0x9B, -+0x9D, 0x67, 0x89, 0xDB, 0x6A, 0x9B, 0xCF, 0xF7, -+0x80, 0x44, 0x62, 0xEC, 0x0D, 0x60, 0x77, 0xF0, -+0x24, 0x6C, 0xA0, 0xF1, 0x1C, 0x4C, 0x1D, 0xF4, -+0x01, 0x6B, 0x60, 0xDC, 0x10, 0xF0, 0x23, 0x6C, -+0x64, 0xF2, 0x15, 0x4C, 0x00, 0xEC, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6B, 0x2D, 0xF1, 0x18, 0x4B, -+0x41, 0x9B, 0x40, 0xDB, 0x89, 0x9A, 0xBC, 0x65, -+0x7D, 0x67, 0xDF, 0xF7, 0x00, 0x03, 0x4C, 0xB8, -+0x00, 0x65, 0x00, 0xF0, 0x20, 0x6D, 0x05, 0x4D, -+0xAF, 0xED, 0xAC, 0xEA, 0xA0, 0x9B, 0x04, 0x6C, -+0x8C, 0xED, 0xAD, 0xEA, 0x82, 0x9B, 0xA3, 0x9B, -+0x32, 0xEC, 0x30, 0xED, 0x8E, 0x9B, 0xFC, 0x65, -+0x8C, 0x9B, 0x1C, 0x65, 0x84, 0x9B, 0x5C, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x85, 0x9B, -+0x7C, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x2B, 0x9B, 0x0A, 0x9B, 0xE9, 0x9B, 0xC8, 0x9B, -+0xA7, 0x9B, 0x86, 0x9B, 0x61, 0x9B, 0xCB, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x8A, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x7B, 0xB8, -+0x00, 0x65, 0x5A, 0xB8, 0x00, 0x65, 0x00, 0xBA, -+0xDF, 0xF7, 0x00, 0x03, 0x86, 0xDB, 0xA7, 0xDB, -+0xC8, 0xDB, 0xE9, 0xDB, 0x0A, 0xDB, 0x2B, 0xDB, -+0x98, 0x67, 0x8C, 0xDB, 0x9F, 0x67, 0x8E, 0xDB, -+0x12, 0xEC, 0x10, 0xED, 0x82, 0xDB, 0xA3, 0xDB, -+0x9A, 0xB8, 0x00, 0x65, 0x84, 0xDB, 0x9B, 0xB8, -+0x00, 0x65, 0x85, 0xDB, 0x7D, 0x67, 0x5B, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x40, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0xAD, 0xF1, 0x08, 0x4C, -+0x00, 0xF4, 0x00, 0x4C, 0xBC, 0x65, 0x82, 0x67, -+0x40, 0xEA, 0x00, 0x65, 0x7A, 0xB8, 0x00, 0x65, -+0xBB, 0x65, 0xDF, 0xF7, 0x00, 0x03, 0x82, 0x9B, -+0xA3, 0x9B, 0x32, 0xEC, 0x30, 0xED, 0x8E, 0x9B, -+0xFC, 0x65, 0x8C, 0x9B, 0x1C, 0x65, 0x84, 0x9B, -+0x5C, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x85, 0x9B, 0x7C, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x2B, 0x9B, 0x0A, 0x9B, 0xE9, 0x9B, -+0xC8, 0x9B, 0xA7, 0x9B, 0x86, 0x9B, 0x5A, 0xB8, -+0x00, 0x65, 0x7B, 0xB8, 0x00, 0x65, 0x00, 0xBA, -+0x00, 0x65, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0x0D, 0xF1, 0x1C, 0x4B, 0x40, 0xDB, 0xDF, 0xF7, -+0x00, 0x03, 0x86, 0xDB, 0xA7, 0xDB, 0xC8, 0xDB, -+0xE9, 0xDB, 0x0A, 0xDB, 0x2B, 0xDB, 0x98, 0x67, -+0x8C, 0xDB, 0x9F, 0x67, 0x8E, 0xDB, 0x12, 0xEC, -+0x10, 0xED, 0x82, 0xDB, 0xA3, 0xDB, 0x9A, 0xB8, -+0x00, 0x65, 0x84, 0xDB, 0x9B, 0xB8, 0x00, 0x65, -+0x85, 0xDB, 0x8E, 0xB8, 0x00, 0x65, 0x81, 0xDB, -+0x8C, 0xB8, 0x00, 0x65, 0x80, 0xDB, 0x30, 0xF0, -+0x20, 0x6B, 0x2D, 0xF1, 0x18, 0x4B, 0x60, 0x9B, -+0x9D, 0x67, 0x89, 0xDB, 0x6A, 0x9B, 0xCF, 0xF7, -+0x80, 0x44, 0x62, 0xEC, 0x0D, 0x60, 0x77, 0xF0, -+0x24, 0x6C, 0xA0, 0xF1, 0x1C, 0x4C, 0x1D, 0xF4, -+0x01, 0x6B, 0x60, 0xDC, 0x10, 0xF0, 0x23, 0x6C, -+0x64, 0xF2, 0x15, 0x4C, 0x00, 0xEC, 0x00, 0x65, -+0x40, 0x9A, 0x30, 0xF0, 0x20, 0x6C, 0xAD, 0xF1, -+0x08, 0x4C, 0x00, 0xF4, 0x00, 0x4C, 0xBC, 0x65, -+0x82, 0x67, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6C, -+0x0D, 0xF1, 0x1C, 0x4C, 0x00, 0xF0, 0x20, 0x6D, -+0xA0, 0xDC, 0x30, 0xF0, 0x20, 0x6A, 0x2D, 0xF1, -+0x18, 0x4A, 0x10, 0xF0, 0x23, 0x6B, 0xA0, 0xF4, -+0x1D, 0x4B, 0x00, 0xEB, 0x61, 0x9A, 0x60, 0xDA, -+0x49, 0x9B, 0xBA, 0x65, 0xDF, 0xF7, 0x00, 0x03, -+0x4C, 0xB8, 0x00, 0x65, 0x00, 0xF0, 0x20, 0x6D, -+0x05, 0x4D, 0xAF, 0xED, 0xAC, 0xEA, 0xA0, 0x9B, -+0x00, 0xF0, 0x20, 0x6C, 0x04, 0x4C, 0x8C, 0xED, -+0xAD, 0xEA, 0x82, 0x9B, 0xA3, 0x9B, 0x32, 0xEC, -+0x30, 0xED, 0x8E, 0x9B, 0xFC, 0x65, 0x8C, 0x9B, -+0x1C, 0x65, 0x84, 0x9B, 0x5C, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x85, 0x9B, 0x7C, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x2B, 0x9B, -+0x0A, 0x9B, 0xE9, 0x9B, 0xC8, 0x9B, 0xA7, 0x9B, -+0x86, 0x9B, 0x61, 0x9B, 0xCB, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x8A, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x7B, 0xB8, 0x00, 0x65, -+0x5A, 0xB8, 0x00, 0x65, 0x00, 0xBA, 0x00, 0x65, -+0x5F, 0x67, 0x5A, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x18, 0x66, 0xC0, 0x00, 0x1C, -+0xA9, 0x41, 0x5A, 0xB8, 0x00, 0x65, 0x00, 0xEA, -+0x6D, 0xB8, 0x00, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x00, 0x4A, 0x4F, 0xEA, 0x4C, 0xEB, 0xAB, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x5F, 0x67, -+0x5A, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x1C, 0x6C, 0x41, 0x5A, 0xB8, 0x00, 0x65, -+0x00, 0xEA, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x81, 0xC1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x7B, 0xC1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xAF, 0xC1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x57, 0xC2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x74, 0xC2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x75, 0xC1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xC0, 0xF5, 0x15, 0x4A, 0x40, 0xDB, 0x01, 0x4A, -+0x40, 0xDB, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xE0, 0xF5, 0x0D, 0x4A, 0x40, 0xDB, 0x01, 0x4A, -+0x40, 0xDB, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0x00, 0xF6, 0x05, 0x4A, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xB5, 0xF6, 0x44, 0x9A, 0xC0, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF6, 0x48, 0x9A, -+0xA0, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF6, -+0x4C, 0x9A, 0x80, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF6, 0x50, 0x9A, 0x40, 0x9A, 0x33, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, -+0x10, 0xF0, 0x24, 0x6F, 0xB5, 0xF6, 0xF4, 0x9F, -+0x40, 0x9B, 0xED, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xB5, 0xF6, 0x58, 0x9A, 0xFF, 0x6B, -+0xC0, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF6, -+0x5C, 0x9A, 0xA0, 0xDA, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF6, 0x40, 0x9A, 0x10, 0x6D, 0xAB, 0xED, -+0x80, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF6, -+0x84, 0x9A, 0x40, 0xA4, 0x6C, 0xEA, 0xAC, 0xEA, -+0x02, 0x6D, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF2, 0x84, 0x9A, -+0x80, 0x6D, 0xAB, 0xED, 0x40, 0xA4, 0x6C, 0xEA, -+0xAE, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0x00, 0xF6, 0x06, 0x4A, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0xA0, 0xF6, 0x1D, 0x4A, -+0x40, 0xDB, 0x00, 0x18, 0xBB, 0xDE, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x6C, 0x9A, 0x6C, 0x23, -+0x01, 0x6A, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0xF7, 0xDE, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x4C, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x6E, 0xE0, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x4C, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x54, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, 0x08, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xF8, 0xDE, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, -+0x10, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0xF9, 0xDE, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x4C, 0x9A, 0x20, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x50, 0xE0, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x4C, 0x9A, 0x40, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x48, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, 0x80, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x44, 0xE0, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, 0x6C, 0x9B, -+0xFF, 0x6A, 0x01, 0x4A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x3D, 0xE0, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x6C, 0x9B, 0x04, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xFA, 0xDE, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, 0x6C, 0x9B, -+0x08, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0xFB, 0xDE, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x6C, 0x9B, 0x10, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xFC, 0xDE, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x70, 0x9A, -+0x70, 0x23, 0x01, 0x6A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x23, 0xE0, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x50, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0xFD, 0xDE, 0x30, 0xF0, -+0x20, 0x6B, 0x00, 0xF2, 0x70, 0x9B, 0x04, 0xF0, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0x0B, 0xE0, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x70, 0x9B, 0x08, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, -+0xF0, 0xDF, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x15, 0xF2, 0x40, 0x9A, 0x00, 0xF2, -+0x70, 0x9B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0xFE, 0xDE, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xB5, 0xF2, 0x40, 0x9A, 0x00, 0xF2, -+0x70, 0x9B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0x99, 0xDF, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x95, 0xF1, 0x48, 0x9A, 0x00, 0xF2, -+0x70, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0x9D, 0xDF, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x95, 0xF1, 0x4C, 0x9A, -+0x00, 0xF2, 0x70, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0x9D, 0xDF, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xB5, 0xF6, -+0x54, 0x9A, 0x00, 0xF2, 0x70, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x9D, 0xDF, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0xD5, 0xF6, 0x48, 0x9A, 0x00, 0xF2, 0x70, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, -+0x9D, 0xDF, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x74, 0x9A, 0x55, 0x23, 0x01, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, 0x0B, 0xE0, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, -+0x02, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0xF0, 0xDF, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x0B, 0xE0, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, -+0x08, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, -+0x00, 0x18, 0xF0, 0xDF, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0x0B, 0xE0, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, -+0x20, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, -+0x00, 0x18, 0xF0, 0xDF, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x40, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, 0x0B, 0xE0, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, -+0x80, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0xF0, 0xDF, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xA0, 0xF6, 0x1E, 0x4A, 0x40, 0xDB, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, -+0x70, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x41, 0xF1, -+0x1D, 0x4A, 0x40, 0xDB, 0x00, 0x18, 0x8B, 0xDE, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x5C, 0x9A, -+0x22, 0x22, 0x00, 0x68, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x7C, 0x9B, 0x02, 0xF0, 0x00, 0x6A, -+0x44, 0xE8, 0x6C, 0xEA, 0x03, 0x22, 0x90, 0x67, -+0x00, 0x18, 0xF6, 0xDE, 0x01, 0x48, 0x10, 0x70, -+0xF1, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x5C, 0x9A, 0x80, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x9F, 0xE0, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0x41, 0xF1, 0x1E, 0x4A, 0x40, 0xDB, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xC1, 0xF1, 0x11, 0x4A, 0x40, 0xDB, 0x00, 0x18, -+0x92, 0xDE, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x7C, 0x9A, 0x4A, 0x23, 0x08, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0x33, 0xDF, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x5C, 0x9A, -+0x02, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0xCF, 0xDE, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x5C, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x9B, 0xE0, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x5C, 0x9A, 0x20, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x97, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x5C, 0x9A, 0x40, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xD4, 0xDE, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x5C, 0x9A, -+0x80, 0x6B, 0x6C, 0xEA, 0x05, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x50, 0x9A, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x7C, 0x9B, -+0xFF, 0x6A, 0x01, 0x4A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x93, 0xE0, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x7C, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x8F, 0xE0, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x60, 0x9A, -+0x7D, 0x23, 0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF6, -+0x48, 0x9A, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0x8E, 0xDF, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x75, 0xF1, 0x40, 0x9A, -+0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0x8E, 0xDF, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x95, 0xF6, -+0x54, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x8E, 0xDF, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x15, 0xF2, 0x40, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, -+0x8E, 0xDF, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xB5, 0xF2, 0x40, 0x9A, 0xE0, 0xF1, -+0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0x8E, 0xDF, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x95, 0xF1, 0x44, 0x9A, -+0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0x16, 0xDF, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x95, 0xF1, -+0x48, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0x54, 0xDF, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x95, 0xF1, 0x4C, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, -+0x75, 0xDF, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xB5, 0xF6, 0x54, 0x9A, 0xE0, 0xF1, -+0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0x3C, 0xDF, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x95, 0xF1, 0x40, 0x9A, -+0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0xEC, 0xDE, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x64, 0x9A, 0x78, 0x23, 0x01, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, -+0xE6, 0xE0, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x44, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x10, 0x6C, 0x00, 0x18, 0xB4, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x44, 0x9A, 0x04, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x20, 0x6C, 0x00, 0x18, -+0xB4, 0xE0, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x44, 0x9A, 0x08, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x30, 0x6C, 0x00, 0x18, 0xB4, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x44, 0x9A, 0x10, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x40, 0x6C, 0x00, 0x18, -+0xB4, 0xE0, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x44, 0x9A, 0x20, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x50, 0x6C, 0x00, 0x18, 0xB4, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x44, 0x9A, 0x40, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x60, 0x6C, 0x00, 0x18, -+0xB4, 0xE0, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x44, 0x9A, 0x80, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x70, 0x6C, 0x00, 0x18, 0xB4, 0xE0, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x64, 0x9B, 0xFF, 0x6A, -+0x01, 0x4A, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0xE6, 0xE0, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x64, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, -+0xE6, 0xE0, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x64, 0x9B, 0x00, 0xF4, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0xE6, 0xE0, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x64, 0x9B, -+0x01, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x04, 0x6C, 0x00, 0x18, 0xE6, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x68, 0x9A, 0xA0, 0xF0, -+0x13, 0x23, 0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0x82, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x48, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x10, 0x6C, 0x00, 0x18, -+0x7A, 0xE0, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x20, 0x6C, 0x00, 0x18, 0x7A, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x48, 0x9A, 0x08, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x30, 0x6C, 0x00, 0x18, -+0x7A, 0xE0, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x48, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x40, 0x6C, 0x00, 0x18, 0x7A, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x48, 0x9A, 0x20, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x50, 0x6C, 0x00, 0x18, -+0x7A, 0xE0, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x48, 0x9A, 0x40, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x60, 0x6C, 0x00, 0x18, 0x7A, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x48, 0x9A, 0x80, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x70, 0x6C, 0x00, 0x18, -+0x7A, 0xE0, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x68, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, 0x6C, 0xEA, -+0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, 0x82, 0xE0, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x68, 0x9B, -+0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x02, 0x6C, 0x00, 0x18, 0x82, 0xE0, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x68, 0x9B, 0x00, 0xF4, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, -+0x00, 0x18, 0x82, 0xE0, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x68, 0x9B, 0x01, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, -+0x82, 0xE0, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x68, 0x9B, 0x10, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0x06, 0xC8, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x35, 0xF1, 0x4C, 0x9A, 0xE0, 0xF1, 0x68, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0x06, 0xC8, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x35, 0xF1, 0x50, 0x9A, 0xE0, 0xF1, -+0x68, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, -+0x00, 0x18, 0x06, 0xC8, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x35, 0xF1, 0x58, 0x9A, -+0xE0, 0xF1, 0x68, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0x06, 0xC8, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x48, 0x9A, 0x00, 0x52, -+0x03, 0x60, 0x04, 0x6C, 0x00, 0x18, 0x06, 0xC8, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x6C, 0x9A, -+0xC0, 0xF0, 0x18, 0x23, 0x01, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, 0x16, 0xDF, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, -+0x02, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0x54, 0xDF, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x4C, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, 0x75, 0xDF, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, -+0x08, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0x3C, 0xDF, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x4C, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x16, 0xDF, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, -+0x20, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, -+0x00, 0x18, 0x54, 0xDF, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x4C, 0x9A, 0x40, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x75, 0xDF, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, -+0x80, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, -+0x00, 0x18, 0x3C, 0xDF, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x6C, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, -+0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, -+0x16, 0xDF, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x6C, 0x9B, 0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0x54, 0xDF, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, -+0x00, 0xF4, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0x75, 0xDF, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, 0x01, 0xF0, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, -+0x00, 0x18, 0x3C, 0xDF, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x6C, 0x9B, 0x02, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, -+0x16, 0xDF, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x6C, 0x9B, 0x04, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, 0x54, 0xDF, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, -+0x08, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x04, 0x6C, 0x00, 0x18, 0x75, 0xDF, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, 0x10, 0xF0, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0x3C, 0xDF, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x95, 0xF1, 0x40, 0x9A, -+0xE0, 0xF1, 0x6C, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0x33, 0xDF, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x95, 0xF1, -+0x44, 0x9A, 0xE0, 0xF1, 0x6C, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x33, 0xDF, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x95, 0xF1, 0x48, 0x9A, 0xE0, 0xF1, 0x6C, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, -+0x33, 0xDF, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x95, 0xF1, 0x4C, 0x9A, 0xE0, 0xF1, -+0x6C, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0x33, 0xDF, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xC1, 0xF1, 0x12, 0x4A, 0x40, 0xDB, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA4, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0x0F, 0xF7, -+0x1D, 0x4C, 0x05, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFF, 0x6A, 0xCC, 0xEA, -+0x00, 0x6B, 0x09, 0x10, 0x79, 0xE5, 0xE0, 0xA4, -+0xC0, 0xA6, 0x01, 0x4B, 0x01, 0x4C, 0xEE, 0xEE, -+0x02, 0x26, 0x00, 0x6A, 0x20, 0xE8, 0xFF, 0x6E, -+0x6C, 0xEE, 0x43, 0xEE, 0xF3, 0x61, 0x01, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x18, 0x4A, 0xC0, 0xF1, 0x84, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xC0, 0xF1, -+0x64, 0xC2, 0x00, 0x6B, 0xC0, 0xF1, 0x65, 0xC2, -+0xC0, 0xF1, 0x66, 0xC2, 0xC0, 0xF1, 0x6C, 0xC2, -+0x00, 0x6B, 0xC0, 0xF1, 0x6E, 0xCA, 0xC0, 0xF1, -+0x70, 0xC2, 0xE0, 0xF1, 0x6A, 0xC2, 0xE0, 0xF1, -+0x6B, 0xC2, 0xE0, 0xF1, 0x6C, 0xC2, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF2, 0x68, 0x9B, -+0xE1, 0xF7, 0x1F, 0x6D, 0xFF, 0x6A, 0x60, 0xAB, -+0x4C, 0xEC, 0x6C, 0xED, 0x30, 0xF0, 0x20, 0x6B, -+0xE8, 0xF2, 0x7C, 0xA3, 0x02, 0x73, 0x28, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0x0F, 0xF7, 0x6C, 0xAB, -+0x01, 0x6E, 0xCC, 0xEB, 0x0D, 0x23, 0x10, 0xF0, -+0x24, 0x6B, 0x35, 0xF2, 0xCC, 0x9B, 0x0C, 0x6F, -+0xB5, 0xE4, 0x60, 0xA6, 0x4C, 0xED, 0x4C, 0xEB, -+0xED, 0xEB, 0x4C, 0xEB, 0x60, 0xC6, 0x1B, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF2, 0xCC, 0x9B, -+0x0D, 0x6F, 0xEB, 0xEF, 0x60, 0xA6, 0xB5, 0xE4, -+0x4C, 0xED, 0x4C, 0xEB, 0xEC, 0xEB, 0x04, 0x6F, -+0xED, 0xEB, 0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, -+0x60, 0xC6, 0x15, 0xF2, 0x5C, 0x9A, 0x0B, 0x10, -+0xB5, 0xE4, 0x4C, 0xED, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF2, 0x5C, 0x9A, 0xA0, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF2, 0x50, 0x9A, 0xA0, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x28, 0xF1, 0x74, 0xA2, 0x02, 0x6C, -+0x8E, 0xEB, 0x47, 0x2B, 0x08, 0x9A, 0x01, 0x6A, -+0x0C, 0xEA, 0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x18, 0x4A, 0xE0, 0xF1, 0x80, 0xA2, -+0xC0, 0xF1, 0x74, 0xCA, 0x00, 0x18, 0x14, 0xC4, -+0x02, 0x6A, 0x0C, 0xEA, 0x0B, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0xE0, 0xF1, -+0x81, 0xA2, 0x01, 0x6B, 0xC0, 0xF1, 0x74, 0xCA, -+0x00, 0x18, 0x14, 0xC4, 0x04, 0x6A, 0x0C, 0xEA, -+0x0B, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, -+0x18, 0x4A, 0xE0, 0xF1, 0x82, 0xA2, 0x02, 0x6B, -+0xC0, 0xF1, 0x74, 0xCA, 0x00, 0x18, 0x14, 0xC4, -+0x08, 0x6A, 0x0C, 0xEA, 0x0B, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0xE0, 0xF1, -+0x83, 0xA2, 0x03, 0x6B, 0xC0, 0xF1, 0x74, 0xCA, -+0x00, 0x18, 0x14, 0xC4, 0x10, 0x6A, 0x0C, 0xEA, -+0x36, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, -+0x18, 0x4A, 0xE0, 0xF1, 0x84, 0xA2, 0x04, 0x6B, -+0xC0, 0xF1, 0x74, 0xCA, 0x00, 0x18, 0x14, 0xC4, -+0x2A, 0x10, 0x30, 0xF0, 0x20, 0x68, 0x2F, 0xF5, -+0x18, 0x48, 0xC0, 0xF1, 0x52, 0xA0, 0xC0, 0xF1, -+0x74, 0xA8, 0x5A, 0xEB, 0x01, 0x2A, 0xE5, 0xE8, -+0x10, 0xEA, 0x03, 0x2A, 0xE0, 0xF1, 0x80, 0xA0, -+0x13, 0x10, 0x01, 0x72, 0x03, 0x61, 0xE0, 0xF1, -+0x81, 0xA0, 0x0E, 0x10, 0x02, 0x72, 0x03, 0x61, -+0xE0, 0xF1, 0x82, 0xA0, 0x09, 0x10, 0x03, 0x72, -+0x03, 0x61, 0xE0, 0xF1, 0x83, 0xA0, 0x04, 0x10, -+0x04, 0x72, 0x09, 0x61, 0xE0, 0xF1, 0x84, 0xA0, -+0x00, 0x18, 0x14, 0xC4, 0xC0, 0xF1, 0x54, 0xA8, -+0x01, 0x4A, 0xC0, 0xF1, 0x54, 0xC8, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0xA4, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0x0F, 0xF7, 0x18, 0x4C, 0x05, 0x6E, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0x2F, 0xF5, 0x18, 0x48, 0xC0, 0xF1, -+0x64, 0xA0, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0xC0, 0xF1, 0x44, 0xC0, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF1, 0xA0, 0x9A, 0x01, 0x6C, 0x00, 0x18, -+0xA1, 0xDC, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF2, -+0x48, 0x9A, 0x10, 0xF0, 0x24, 0x6D, 0x15, 0xF2, -+0xBC, 0x9D, 0x80, 0x9A, 0xE1, 0xF7, 0x1F, 0x6B, -+0x6C, 0xEC, 0x80, 0xCD, 0x80, 0x9A, 0x10, 0xF0, -+0x24, 0x6D, 0x15, 0xF2, 0xB8, 0x9D, 0x6C, 0xEC, -+0x80, 0xCD, 0x40, 0x9A, 0x42, 0x32, 0x42, 0x32, -+0x6C, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF2, -+0x70, 0x9B, 0x40, 0xCB, 0x00, 0x6A, 0xC0, 0xF1, -+0x54, 0xC8, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xE5, 0x63, 0x35, 0x62, -+0x34, 0xD1, 0x33, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x18, 0x4A, 0xE0, 0xF1, 0x65, 0xA2, -+0x9D, 0x67, 0x78, 0xC4, 0xE0, 0xF1, 0x66, 0xA2, -+0x79, 0xC4, 0xE0, 0xF1, 0x67, 0xA2, 0x7A, 0xC4, -+0xE0, 0xF1, 0x68, 0xA2, 0x7B, 0xC4, 0xE0, 0xF1, -+0x69, 0xA2, 0x7C, 0xC4, 0xC0, 0xF1, 0x76, 0xA2, -+0x20, 0xF0, 0x60, 0xC4, 0xC0, 0xF1, 0x77, 0xA2, -+0x20, 0xF0, 0x61, 0xC4, 0xC0, 0xF1, 0x78, 0xA2, -+0x20, 0xF0, 0x62, 0xC4, 0xC0, 0xF1, 0x79, 0xA2, -+0x20, 0xF0, 0x63, 0xC4, 0xC0, 0xF1, 0x7A, 0xA2, -+0x20, 0xF0, 0x64, 0xC4, 0xC0, 0xF1, 0x7B, 0xA2, -+0x20, 0xF0, 0x68, 0xC4, 0xC0, 0xF1, 0x7C, 0xA2, -+0x20, 0xF0, 0x69, 0xC4, 0xC0, 0xF1, 0x7D, 0xA2, -+0x20, 0xF0, 0x6A, 0xC4, 0xC0, 0xF1, 0x7E, 0xA2, -+0x20, 0xF0, 0x6B, 0xC4, 0xC0, 0xF1, 0x7F, 0xA2, -+0x20, 0xF0, 0x6C, 0xC4, 0x00, 0x6B, 0x20, 0xF0, -+0x70, 0xC4, 0x20, 0xF0, 0x71, 0xC4, 0x20, 0xF0, -+0x72, 0xC4, 0x20, 0xF0, 0x73, 0xC4, 0xC0, 0xF1, -+0x52, 0xA2, 0x20, 0xF0, 0x74, 0xC4, 0x0C, 0x03, -+0x69, 0xE2, 0x03, 0x10, 0x01, 0x6C, 0x80, 0xC3, -+0x01, 0x4B, 0x4A, 0xEB, 0xFB, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF2, 0x48, 0x9A, 0xE1, 0xF7, -+0x1F, 0x6E, 0xFF, 0xF7, 0x1F, 0x68, 0x40, 0xAA, -+0x1A, 0x05, 0x10, 0x04, 0x4C, 0xEE, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF2, 0x40, 0x9A, 0x15, 0x03, -+0x40, 0xAA, 0x2E, 0xD6, 0x4C, 0xE8, 0x30, 0xF0, -+0x20, 0x6A, 0x0F, 0xF7, 0x4A, 0xA2, 0x2C, 0xD2, -+0x00, 0x6A, 0x1F, 0x10, 0xDD, 0x67, 0x5D, 0xE6, -+0x2E, 0x91, 0xF8, 0xA7, 0x59, 0xE6, 0x01, 0x4A, -+0xFD, 0xE1, 0x10, 0xF0, 0x24, 0x69, 0x55, 0xF2, -+0x24, 0x99, 0xFC, 0x37, 0xE0, 0xDD, 0xE5, 0xE1, -+0x20, 0xA1, 0x04, 0x4D, 0x30, 0xC6, 0x10, 0xF0, -+0x24, 0x69, 0x55, 0xF2, 0x28, 0x99, 0x25, 0xE7, -+0x20, 0xDC, 0x10, 0xF0, 0x24, 0x69, 0x55, 0xF2, -+0x2C, 0x99, 0x04, 0x4C, 0x3D, 0xE7, 0xE0, 0xDB, -+0x04, 0x4B, 0x2C, 0x96, 0xFF, 0x6F, 0x4C, 0xEF, -+0xC3, 0xEF, 0xDC, 0x61, 0x00, 0x69, 0x2F, 0xD1, -+0x4F, 0x12, 0x7D, 0x67, 0x00, 0x6A, 0x30, 0xF0, -+0x20, 0x69, 0x20, 0xF0, 0x58, 0xC3, 0x20, 0xF0, -+0x59, 0xC3, 0x20, 0xF0, 0x5A, 0xC3, 0x20, 0xF0, -+0x5B, 0xC3, 0x20, 0xF0, 0x5C, 0xC3, 0xCE, 0xF4, -+0x4C, 0x99, 0x81, 0x40, 0x40, 0xEA, 0x2C, 0xD2, -+0xCE, 0xF4, 0x4C, 0x99, 0x90, 0x67, 0x40, 0xEA, -+0x2C, 0x94, 0x80, 0x34, 0x4D, 0xEC, 0xE7, 0xF7, -+0x1F, 0x6A, 0x4C, 0xEC, 0xCE, 0xF4, 0x4C, 0x99, -+0x2C, 0xD4, 0x82, 0x40, 0x40, 0xEA, 0x0F, 0x6B, -+0x4C, 0xEB, 0xFF, 0x6D, 0xCE, 0xF4, 0x4C, 0x99, -+0x6C, 0x33, 0xAC, 0xEB, 0x30, 0xD3, 0x87, 0x40, -+0x40, 0xEA, 0x30, 0x96, 0x31, 0xD2, 0xFF, 0x6A, -+0x18, 0x4E, 0x2E, 0xD6, 0x4C, 0xEE, 0xCE, 0xF4, -+0x4C, 0x99, 0x11, 0xE6, 0x2D, 0xD6, 0x40, 0xEA, -+0x22, 0x67, 0x2C, 0x93, 0x2E, 0x95, 0x30, 0xF0, -+0x20, 0x6A, 0x0E, 0xF5, 0x44, 0x9A, 0xB1, 0xE3, -+0x40, 0xEA, 0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEA, -+0x09, 0xE2, 0x2C, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0xA8, 0xF4, 0x4C, 0x9A, 0x2C, 0x96, 0xC3, 0xEA, -+0x03, 0x60, 0x4F, 0xEA, 0x59, 0xE6, 0x2C, 0xD6, -+0x04, 0x6A, 0x4B, 0xEA, 0x2C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x40, 0x72, 0x20, 0xF1, 0x05, 0x61, -+0x30, 0xF0, 0x20, 0x69, 0x2D, 0x93, 0x87, 0x40, -+0xCE, 0xF4, 0x4C, 0x99, 0x11, 0x4C, 0x71, 0xE4, -+0x40, 0xEA, 0x00, 0xF1, 0x0C, 0x2A, 0x2D, 0x95, -+0xCE, 0xF4, 0x4C, 0x99, 0x87, 0x40, 0x12, 0x4C, -+0xB1, 0xE4, 0x40, 0xEA, 0x30, 0x96, 0x2D, 0xD2, -+0x00, 0x6A, 0xC5, 0xE0, 0x32, 0x49, 0x2E, 0xD2, -+0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x4C, 0x9A, 0x91, 0x67, 0x01, 0x49, 0x40, 0xEA, -+0x2E, 0x95, 0x9D, 0x67, 0xAD, 0xE4, 0x01, 0x4D, -+0x60, 0xF0, 0x5C, 0xC3, 0x2E, 0xD5, 0x2E, 0x96, -+0x2D, 0x93, 0xFF, 0x6A, 0xCC, 0xEA, 0x63, 0xEA, -+0xEC, 0x61, 0x00, 0x69, 0x46, 0x2B, 0x30, 0xF0, -+0x20, 0x6C, 0x0F, 0xF7, 0x8A, 0xA4, 0x0E, 0x02, -+0x08, 0x03, 0x51, 0xE4, 0x5C, 0x10, 0x04, 0x02, -+0x31, 0xE2, 0x60, 0xA4, 0x2D, 0x95, 0x2E, 0xD4, -+0xAE, 0xEB, 0x0D, 0x2B, 0x28, 0x33, 0x69, 0xE2, -+0x8C, 0x9A, 0x2D, 0x96, 0x1F, 0x05, 0x00, 0x18, -+0xFB, 0xC3, 0x05, 0x22, 0x2E, 0x96, 0x01, 0x6A, -+0x20, 0xF0, 0x48, 0xC6, 0x27, 0x10, 0x2D, 0x92, -+0x03, 0x72, 0x1F, 0x61, 0x30, 0xF0, 0x20, 0x6C, -+0x6F, 0xF0, 0x0C, 0x4C, 0x1F, 0x05, 0x03, 0x6E, -+0x00, 0x18, 0xFB, 0xC3, 0x09, 0x2A, 0x30, 0xF0, -+0x20, 0x6C, 0x6F, 0xF0, 0x10, 0x4C, 0x1F, 0x05, -+0x03, 0x6E, 0x00, 0x18, 0xFB, 0xC3, 0x08, 0x22, -+0x04, 0x02, 0x29, 0xE2, 0x78, 0xA2, 0x0B, 0x2B, -+0x90, 0xA2, 0x0A, 0x2C, 0x01, 0x6B, 0x08, 0x10, -+0x9D, 0x67, 0x2D, 0xE4, 0x20, 0xF0, 0x58, 0xC3, -+0x05, 0x10, 0x04, 0x02, 0x29, 0xE2, 0x00, 0x6B, -+0x20, 0xF0, 0x68, 0xC2, 0x01, 0x49, 0xFF, 0x6A, -+0x4C, 0xE9, 0x30, 0xF0, 0x20, 0x6A, 0x0F, 0xF7, -+0x4A, 0xA2, 0x43, 0xE9, 0xBC, 0x61, 0xBD, 0x67, -+0x20, 0xF0, 0x58, 0xA5, 0x1A, 0x2A, 0x20, 0xF0, -+0x59, 0xA5, 0x17, 0x2A, 0x20, 0xF0, 0x5A, 0xA5, -+0x14, 0x2A, 0x20, 0xF0, 0x5B, 0xA5, 0x11, 0x2A, -+0x20, 0xF0, 0x5C, 0xA5, 0x1C, 0x10, 0xA0, 0xA3, -+0x02, 0x25, 0x00, 0x6D, 0x01, 0x10, 0x01, 0x6D, -+0xA0, 0xC2, 0x01, 0x4B, 0x01, 0x4A, 0x8A, 0xEA, -+0xF6, 0x61, 0xDD, 0x67, 0x20, 0xF0, 0x58, 0xA6, -+0x02, 0x22, 0x00, 0x69, 0x74, 0x10, 0x3D, 0x67, -+0x20, 0xF0, 0x59, 0xA1, 0xFA, 0x2A, 0x20, 0xF0, -+0x5A, 0xA1, 0xF7, 0x2A, 0x20, 0xF0, 0x5B, 0xA1, -+0xF4, 0x2A, 0x20, 0xF0, 0x5C, 0xA1, 0x6F, 0x22, -+0xF0, 0x17, 0x9D, 0x67, 0x2D, 0xE4, 0x20, 0xF0, -+0x78, 0xA3, 0x5E, 0x23, 0xE0, 0xF1, 0x8E, 0xA2, -+0x01, 0x6B, 0x6C, 0xEC, 0x0F, 0x24, 0xE0, 0xF1, -+0x55, 0xA2, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x53, 0x22, 0x08, 0x10, 0xE0, 0xF3, 0x09, 0x72, -+0x0F, 0x60, 0x01, 0x4A, 0xFF, 0xF7, 0x1F, 0x6B, -+0x6C, 0xEA, 0x01, 0x10, 0x00, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0x55, 0xF2, 0x70, 0x9B, 0x02, 0xF0, -+0x00, 0x6C, 0x60, 0x9B, 0x8C, 0xEB, 0xEE, 0x2B, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF2, 0x50, 0x9A, -+0x02, 0xF0, 0x00, 0x6B, 0x40, 0x9A, 0x6C, 0xEA, -+0x37, 0x2A, 0xBD, 0x67, 0x2D, 0xE5, 0x30, 0xF0, -+0x20, 0x6A, 0x98, 0xA3, 0x6E, 0xF2, 0x5C, 0x9A, -+0x01, 0x6D, 0x08, 0x6E, 0x00, 0x6F, 0x40, 0xEA, -+0xFF, 0xF7, 0x1F, 0x6C, 0x4C, 0xEC, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF2, 0x5C, 0x9A, 0x10, 0xF0, -+0x24, 0x6B, 0x35, 0xF2, 0x78, 0x9B, 0x51, 0xE4, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0x95, 0x55, 0xF2, -+0x54, 0x9A, 0x6D, 0xE0, 0x18, 0x4D, 0x49, 0xE0, -+0xAD, 0xE3, 0xB5, 0xE2, 0x40, 0xA3, 0xFF, 0x6E, -+0x01, 0x4B, 0xCC, 0xEA, 0xAA, 0xEB, 0x40, 0xC4, -+0x01, 0x4C, 0xF8, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF2, 0x5C, 0x9A, 0x40, 0xEA, 0x20, 0x6B, -+0x4D, 0xEB, 0xFF, 0x6A, 0x4C, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF2, 0x58, 0x9A, 0x60, 0xC2, -+0x01, 0x49, 0xFF, 0x6A, 0x4C, 0xE9, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0xC0, 0xF1, -+0x72, 0xA2, 0x63, 0xE9, 0x92, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x0E, 0xF5, 0x40, 0x9A, 0x2C, 0x94, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF2, -+0x5C, 0x9A, 0x23, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, -+0xD2, 0x10, 0x31, 0x94, 0x40, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x6C, 0xEA, 0x07, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0x0E, 0xF5, 0x40, 0x9A, 0x2C, 0x94, -+0x40, 0xEA, 0xC5, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF2, 0x40, 0x9A, 0x2D, 0x95, 0x49, 0xE0, -+0xA9, 0xE2, 0x80, 0xA2, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF2, 0x44, 0x9A, 0x6C, 0xEC, 0x80, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF2, 0x48, 0x9A, -+0x15, 0x04, 0x49, 0xE0, 0xA9, 0xE2, 0x40, 0xA2, -+0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF2, -+0x4C, 0x9A, 0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6B, -+0x0F, 0xF7, 0x6A, 0xA3, 0x0C, 0x02, 0x4D, 0xE3, -+0x1B, 0x65, 0x12, 0x10, 0xC0, 0xA3, 0xFE, 0x65, -+0x3F, 0x67, 0xFF, 0x6E, 0x2C, 0xEE, 0x20, 0xA5, -+0x2E, 0xEE, 0x03, 0x26, 0x00, 0x6B, 0x60, 0xC2, -+0x05, 0x10, 0x01, 0x4B, 0xC3, 0x67, 0xEE, 0xEE, -+0x01, 0x4D, 0xF0, 0x2E, 0x01, 0x4A, 0x04, 0x4C, -+0x78, 0x67, 0x4E, 0xEB, 0x80, 0xF0, 0x1D, 0x2B, -+0x9D, 0x67, 0x20, 0xF0, 0x50, 0xA4, 0x01, 0x72, -+0x12, 0x60, 0x20, 0xF0, 0x51, 0xA4, 0x01, 0x72, -+0x0E, 0x60, 0x20, 0xF0, 0x52, 0xA4, 0x01, 0x72, -+0x0A, 0x60, 0x20, 0xF0, 0x53, 0xA4, 0x01, 0x72, -+0x06, 0x60, 0x20, 0xF0, 0x54, 0xA4, 0x01, 0x72, -+0x02, 0x60, 0x2F, 0x95, 0x55, 0x25, 0x00, 0x18, -+0x80, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF2, -+0x50, 0x9A, 0x66, 0x68, 0x00, 0x6C, 0x00, 0xC2, -+0x80, 0x18, 0x55, 0x07, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF2, 0x54, 0x9A, 0x01, 0x6E, 0x00, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, 0x42, 0xA2, -+0x2F, 0xD6, 0x5D, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x78, 0x9A, 0xFF, 0x6C, 0x01, 0x4C, -+0x40, 0x9B, 0x8C, 0xEA, 0x01, 0x22, 0x80, 0xDB, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x54, 0x9A, -+0xFF, 0x68, 0x01, 0x48, 0x00, 0x6C, 0xB0, 0x67, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, -+0x18, 0x4A, 0xE0, 0xF1, 0xCB, 0xA2, 0x0C, 0x26, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, -+0x42, 0xF1, 0x1C, 0x6C, 0x01, 0x6D, 0xCC, 0x36, -+0x01, 0x69, 0x40, 0xEA, 0x2F, 0xD1, 0x37, 0x10, -+0xE0, 0xF1, 0xCC, 0xA2, 0x09, 0x26, 0x42, 0xF1, -+0x1C, 0x6C, 0x01, 0x6D, 0xC4, 0x36, 0x00, 0x18, -+0x18, 0xDC, 0x01, 0x6A, 0x2F, 0xD2, 0x2B, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, -+0x42, 0xF1, 0x1C, 0x6C, 0x01, 0x6D, 0xD0, 0x67, -+0x40, 0xEA, 0x01, 0x6B, 0x2F, 0xD3, 0x1F, 0x10, -+0x9D, 0x67, 0x20, 0xF0, 0x70, 0xC4, 0x20, 0xF0, -+0x71, 0xC4, 0x20, 0xF0, 0x72, 0xC4, 0x20, 0xF0, -+0x73, 0xC4, 0x20, 0xF0, 0x74, 0xC4, 0x30, 0xF0, -+0x20, 0x6B, 0x0F, 0xF7, 0x6A, 0xA3, 0x0C, 0x02, -+0x4D, 0xE3, 0x03, 0x10, 0x01, 0x6C, 0x80, 0xC2, -+0x01, 0x4A, 0x6A, 0xEA, 0xFB, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x0E, 0xF5, 0x40, 0x9A, 0x2C, 0x94, -+0x40, 0xEA, 0x00, 0x6D, 0x2F, 0xD5, 0x2C, 0x90, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x50, 0x9A, -+0x40, 0xA2, 0x1B, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF6, 0x7C, 0xA2, 0x01, 0x6A, 0xFF, 0x6E, -+0x6C, 0xEA, 0xCC, 0xEA, 0xBF, 0xF5, 0x01, 0x2A, -+0x10, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x10, 0xF0, -+0x24, 0x6F, 0x35, 0xF2, 0x74, 0x9B, 0x30, 0x96, -+0x35, 0xF2, 0xF8, 0x9F, 0x6D, 0xE0, 0x18, 0x4E, -+0xFD, 0xE0, 0xCD, 0xE3, 0xA0, 0x9C, 0xDD, 0xE7, -+0x3D, 0x17, 0x35, 0x97, 0x34, 0x91, 0x33, 0x90, -+0x1B, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF2, -+0x58, 0x9A, 0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF2, -+0x7C, 0x9B, 0x40, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0x95, 0xF1, 0x88, 0x9C, 0x6C, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xA8, 0xF4, 0x4C, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF2, 0x60, 0x9A, 0x30, 0xF0, -+0x20, 0x68, 0x2F, 0xF5, 0x18, 0x48, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0xC0, 0xF1, 0x64, 0xA0, -+0x01, 0x6A, 0x01, 0x6C, 0x6D, 0xEA, 0xC0, 0xF1, -+0x44, 0xC0, 0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, -+0xA0, 0x9A, 0x00, 0x18, 0x70, 0xDC, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF2, 0x44, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x95, 0xF2, 0x8C, 0x9C, 0x60, 0xA2, -+0x07, 0x6A, 0x6C, 0xEA, 0x01, 0x4A, 0xC0, 0xF1, -+0x52, 0xC0, 0x00, 0x6A, 0xC0, 0xF1, 0x54, 0xC8, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF2, 0x68, 0x9A, -+0x40, 0x9B, 0x8C, 0xEA, 0x40, 0xDB, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x60, 0xA4, 0x01, 0x6A, 0x04, 0x67, 0x6C, 0xEA, -+0x0B, 0x22, 0x00, 0x18, 0x23, 0xC6, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF2, 0x50, 0x9A, 0x00, 0x6B, -+0x60, 0xC2, 0x00, 0x18, 0xB4, 0xE8, 0x1B, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, 0x42, 0xA2, -+0x14, 0x22, 0xFF, 0x69, 0x01, 0x49, 0x00, 0x6C, -+0xB1, 0x67, 0x00, 0x18, 0xF1, 0xDC, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF1, 0x78, 0x9A, 0x40, 0x9B, -+0x2C, 0xEA, 0x01, 0x22, 0x20, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF2, 0x50, 0x9A, 0x00, 0x6B, -+0x60, 0xC2, 0x00, 0x18, 0x80, 0xC4, 0x81, 0xA0, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, -+0x01, 0x69, 0xA4, 0x67, 0xC0, 0xF1, 0x85, 0xC2, -+0x2C, 0xED, 0x62, 0xA0, 0xC0, 0xF1, 0xB6, 0xC2, -+0x02, 0x68, 0xA4, 0x67, 0x0C, 0xED, 0xC0, 0xF1, -+0xB7, 0xC2, 0x04, 0x6F, 0xA4, 0x67, 0xEC, 0xED, -+0xC0, 0xF1, 0xB8, 0xC2, 0x08, 0x6E, 0xA4, 0x67, -+0xCC, 0xED, 0xC0, 0xF1, 0xB9, 0xC2, 0x10, 0x6D, -+0xC0, 0xF1, 0x66, 0xC2, 0x6C, 0xE9, 0x6C, 0xE8, -+0x6C, 0xEF, 0x6C, 0xEE, 0xAC, 0xEC, 0xAC, 0xEB, -+0xC0, 0xF1, 0x9A, 0xC2, 0xC0, 0xF1, 0x3B, 0xC2, -+0xC0, 0xF1, 0x1C, 0xC2, 0xC0, 0xF1, 0xFD, 0xC2, -+0xC0, 0xF1, 0xDE, 0xC2, 0xC0, 0xF1, 0x7F, 0xC2, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x95, 0xF1, 0x00, 0x4B, 0x30, 0xF0, 0x20, 0x69, -+0xFF, 0x68, 0xAC, 0xE8, 0xCE, 0xF4, 0x50, 0x99, -+0xA0, 0x9B, 0x82, 0xF0, 0x00, 0x6C, 0x01, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF2, -+0xBC, 0x9B, 0xCE, 0xF4, 0x50, 0x99, 0x00, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x01, 0x6D, 0xA1, 0xF4, -+0x18, 0x6C, 0xAB, 0xED, 0x00, 0x18, 0x05, 0xE1, -+0x01, 0x70, 0x0F, 0x60, 0x03, 0x20, 0x02, 0x70, -+0x16, 0x60, 0x1F, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x95, 0xF1, 0x00, 0x4B, 0x60, 0x9B, 0x6D, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF4, 0x64, 0x9B, -+0x13, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF4, -+0x68, 0x9B, 0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x95, 0xF4, 0x6C, 0x9B, 0x09, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x95, 0xF4, 0x70, 0x9B, 0x6D, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF4, 0x74, 0x9B, -+0x6C, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, -+0x70, 0x9B, 0x01, 0x6D, 0xA1, 0xF4, 0x18, 0x6C, -+0xAB, 0xED, 0xC2, 0x67, 0x40, 0xEB, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0x60, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xA9, 0xF2, -+0x6C, 0xC2, 0x20, 0xE8, 0xFF, 0x6A, 0x4C, 0xED, -+0xFF, 0x75, 0x4C, 0xEC, 0xCC, 0xEA, 0x06, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x71, 0xE4, 0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x71, 0xE4, 0x0C, 0xF7, -+0x7E, 0xA4, 0xAC, 0xEA, 0xAF, 0xED, 0x6C, 0xED, -+0xAD, 0xEA, 0x0C, 0xF7, 0x5E, 0xC4, 0x20, 0xE8, -+0xF7, 0x63, 0x11, 0x62, 0x10, 0xD1, 0x0F, 0xD0, -+0x40, 0xA4, 0x08, 0xD2, 0x08, 0x93, 0x1F, 0x6A, -+0x4C, 0xEB, 0x08, 0xD3, 0x42, 0xA4, 0x61, 0xA4, -+0x0B, 0xD2, 0x43, 0xA4, 0x84, 0xA4, 0x09, 0xD4, -+0x08, 0x94, 0x08, 0x5C, 0x80, 0xF0, 0x11, 0x60, -+0x84, 0x30, 0x09, 0x94, 0x01, 0x2C, 0x28, 0x22, -+0xFF, 0x69, 0x2C, 0xEA, 0x2C, 0xEB, 0xA2, 0x67, -+0xC3, 0x67, 0x90, 0x67, 0x0C, 0xD2, 0x0D, 0xD3, -+0x00, 0x18, 0xA9, 0xC6, 0x0B, 0x94, 0x09, 0x93, -+0x41, 0x40, 0x2C, 0xEC, 0x0B, 0xD4, 0x0B, 0x96, -+0x2C, 0xEA, 0x2C, 0xEB, 0x82, 0x67, 0xA3, 0x67, -+0x30, 0xF0, 0x20, 0x69, 0x0A, 0xD2, 0x09, 0xD3, -+0x00, 0x18, 0xA9, 0xC6, 0xCE, 0xF2, 0x44, 0x99, -+0x0C, 0x95, 0x0D, 0x96, 0x90, 0x67, 0x01, 0x6F, -+0x40, 0xEA, 0xCE, 0xF2, 0x44, 0x99, 0x0A, 0x94, -+0x09, 0x95, 0x0B, 0x96, 0x02, 0x6F, 0x40, 0xEA, -+0x0F, 0x58, 0x08, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x08, 0x33, 0x74, 0xF7, 0x0C, 0x4A, 0x69, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x00, 0x6A, 0x44, 0x10, -+0xD0, 0xF4, 0x44, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF5, 0x54, 0x9A, 0x34, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF5, 0x58, 0x9A, 0x2F, 0x10, -+0x80, 0xF4, 0x44, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF5, 0x5C, 0x9A, 0x24, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF5, 0x40, 0x9A, 0x1F, 0x10, -+0xC0, 0xF4, 0x48, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF5, 0x44, 0x9A, 0x14, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF5, 0x48, 0x9A, 0x0F, 0x10, -+0x70, 0xF4, 0x48, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF5, 0x4C, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF5, 0x50, 0x9A, 0x49, 0xE0, -+0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x6A, 0x6C, 0xEA, -+0x7D, 0x67, 0x53, 0xC3, 0x42, 0x32, 0x54, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x41, 0xE0, 0x0C, 0xF7, 0x5E, 0xA0, 0x55, 0xC3, -+0x0C, 0xF7, 0x5F, 0xA0, 0x56, 0xC3, 0x2C, 0xF7, -+0x4E, 0xA0, 0x57, 0xC3, 0x2C, 0xF7, 0x4F, 0xA0, -+0x58, 0xC3, 0x9D, 0x67, 0x21, 0x6A, 0x50, 0xC4, -+0x07, 0x6A, 0x4F, 0xCC, 0x47, 0x44, 0x19, 0x4A, -+0x40, 0xA2, 0x52, 0xC4, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, 0x40, 0xEA, -+0x11, 0x97, 0x10, 0x91, 0x0F, 0x90, 0x09, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0xFF, 0x74, 0xAC, 0xEA, 0x05, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0x0D, 0xF1, 0x46, 0xC3, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x2C, 0xF7, 0xBE, 0xA3, 0x8C, 0xEA, 0x8F, 0xEC, -+0xAC, 0xEC, 0x8D, 0xEA, 0x2C, 0xF7, 0x5E, 0xC3, -+0x20, 0xE8, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x01, 0xA4, 0x20, 0xA4, -+0x0C, 0x20, 0x90, 0x67, 0xB1, 0x67, 0x00, 0x18, -+0x13, 0xC7, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x90, 0x67, 0xB1, 0x67, 0x53, 0x6E, -+0x40, 0xEA, 0x7D, 0x67, 0x20, 0x6A, 0x50, 0xC3, -+0x03, 0x6A, 0x4F, 0xCB, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x5C, 0x9A, 0x9D, 0x67, 0x40, 0xA2, -+0x52, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x2C, 0xF7, 0x7E, 0xA2, 0x2C, 0xF7, -+0x5F, 0xA2, 0x73, 0xC4, 0x54, 0xC4, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, -+0x40, 0xEA, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x40, 0xA4, 0x0C, 0xF5, -+0xD8, 0xA3, 0x7F, 0x6F, 0x5E, 0x32, 0x5C, 0x32, -+0xEC, 0xEE, 0x4D, 0xEE, 0x0C, 0xF5, 0xD8, 0xC3, -+0xA0, 0xA4, 0x01, 0x6A, 0xBA, 0x35, 0x4C, 0xED, -+0xB8, 0x30, 0x41, 0x6D, 0xAB, 0xED, 0xCC, 0xED, -+0x0D, 0xED, 0x0C, 0xF5, 0xB8, 0xC3, 0xC0, 0xA4, -+0xD6, 0x36, 0x4C, 0xEE, 0xD4, 0x30, 0x21, 0x6E, -+0xCB, 0xEE, 0xAC, 0xEE, 0x0D, 0xEE, 0x0C, 0xF5, -+0xD8, 0xC3, 0xA0, 0xA4, 0xB2, 0x35, 0x4C, 0xED, -+0xB0, 0x30, 0x11, 0x6D, 0xAB, 0xED, 0xCC, 0xED, -+0x0D, 0xED, 0x0C, 0xF5, 0xB8, 0xC3, 0x20, 0xA4, -+0x10, 0x6E, 0x0F, 0x68, 0xCB, 0xEE, 0x0C, 0xE9, -+0xAC, 0xEE, 0x2D, 0xEE, 0x0C, 0xF5, 0xD8, 0xC3, -+0xA1, 0xA4, 0xAC, 0xEF, 0x0C, 0xF5, 0xB9, 0xA3, -+0x0C, 0xF5, 0xFA, 0xC3, 0xE1, 0xA4, 0x1D, 0x65, -+0x02, 0x6D, 0x38, 0x67, 0xAB, 0xED, 0xFE, 0x37, -+0x2C, 0xED, 0xED, 0xED, 0x0C, 0xF5, 0xB9, 0xC3, -+0xE2, 0xA4, 0x0C, 0xF5, 0xFB, 0xC3, 0x03, 0x6F, -+0x83, 0xA4, 0xEB, 0xEF, 0xAC, 0xEF, 0x0C, 0xF5, -+0xB8, 0xA3, 0x4C, 0xEC, 0x84, 0x34, 0xBA, 0x35, -+0x8D, 0xEF, 0x4E, 0xED, 0x86, 0x67, 0x0C, 0xEC, -+0x4C, 0xED, 0x0C, 0xF5, 0xF9, 0xC3, 0x00, 0x18, -+0x7F, 0xDB, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA4, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0x2F, 0xF7, -+0x13, 0x4C, 0x07, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF7, 0x53, 0xA2, 0x05, 0x5A, -+0x13, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, -+0xD4, 0xF7, 0x18, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, -+0x00, 0xEA, 0x00, 0x6C, 0x07, 0x10, 0x01, 0x6C, -+0x05, 0x10, 0x02, 0x6C, 0x03, 0x10, 0x03, 0x6C, -+0x01, 0x10, 0x04, 0x6C, 0x00, 0x18, 0x79, 0xDD, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x69, 0xF3, 0x48, 0xA3, 0x1F, 0x6C, 0x01, 0x6D, -+0x4A, 0x32, 0x8C, 0xEA, 0x30, 0xF0, 0x20, 0x6C, -+0x2F, 0xF7, 0x93, 0xA4, 0x47, 0xEC, 0xAC, 0xEA, -+0x03, 0x22, 0x69, 0xF3, 0x89, 0xC3, 0x04, 0x10, -+0x01, 0x6A, 0x4B, 0xEA, 0x69, 0xF3, 0x49, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x1C, 0x23, 0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x69, 0xF3, 0x68, 0xC2, 0x00, 0x18, 0xED, 0xE2, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x04, 0x93, -+0xEF, 0xF5, 0x5C, 0x9A, 0x6E, 0xEA, 0x03, 0x22, -+0x04, 0x94, 0x00, 0x18, 0x0E, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF3, -+0x88, 0xA2, 0x02, 0x6B, 0x8D, 0xEB, 0x69, 0xF3, -+0x68, 0xC2, 0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, -+0xE0, 0xF1, 0xEE, 0xA2, 0xA0, 0xA4, 0x02, 0x6B, -+0x01, 0x6E, 0x6B, 0xEB, 0xCC, 0xED, 0xEC, 0xEB, -+0xAD, 0xEB, 0xE0, 0xF1, 0x6E, 0xC2, 0xA0, 0xA4, -+0xA6, 0x35, 0xCC, 0xED, 0xA4, 0x37, 0x03, 0x6D, -+0xAB, 0xED, 0x6C, 0xED, 0xED, 0xED, 0xE0, 0xF1, -+0xAE, 0xC2, 0x60, 0xA4, 0x6A, 0x33, 0xCC, 0xEB, -+0x68, 0x37, 0x05, 0x6B, 0x6B, 0xEB, 0xAC, 0xEB, -+0xED, 0xEB, 0xE0, 0xF1, 0x6E, 0xC2, 0xA0, 0xA4, -+0xAE, 0x35, 0xCC, 0xED, 0xAC, 0x36, 0x09, 0x6D, -+0xAB, 0xED, 0x6C, 0xED, 0x10, 0xF0, 0x24, 0x6B, -+0x95, 0xF2, 0x64, 0x9B, 0xCD, 0xED, 0xE0, 0xF1, -+0xAE, 0xC2, 0xA0, 0xA3, 0x07, 0x6B, 0xFF, 0x6E, -+0xAC, 0xEB, 0x0C, 0x23, 0x10, 0xF0, 0x24, 0x6B, -+0x95, 0xF5, 0x68, 0x9B, 0xA0, 0xA3, 0x61, 0xA4, -+0xAC, 0xEE, 0x7B, 0xE6, 0xE0, 0xF1, 0xD6, 0xC2, -+0x61, 0xA4, 0x14, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF1, 0x68, 0x9B, 0xA0, 0xA3, 0x61, 0xA4, -+0xAC, 0xEE, 0x77, 0xE6, 0x05, 0x6B, 0x7A, 0xED, -+0x01, 0x2B, 0xE5, 0xE8, 0x12, 0xED, 0xE0, 0xF1, -+0xB6, 0xC2, 0xA1, 0xA4, 0x7B, 0xED, 0x01, 0x2B, -+0xE5, 0xE8, 0x12, 0xEB, 0xE0, 0xF1, 0x77, 0xC2, -+0x00, 0xA4, 0x01, 0x69, 0x2C, 0xE8, 0x10, 0x28, -+0x00, 0x18, 0x1E, 0xE7, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, 0xFF, 0x6C, -+0xC5, 0x67, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x54, 0x9A, 0x00, 0xC2, 0x0D, 0x10, -+0x01, 0x6C, 0x0C, 0x6D, 0x00, 0x18, 0x73, 0xC9, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, -+0xE0, 0xF1, 0x75, 0xA2, 0x6D, 0xE9, 0xE0, 0xF1, -+0x35, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, -+0x18, 0x4A, 0xE0, 0xF1, 0x8E, 0xA2, 0x08, 0x6B, -+0x8C, 0xEB, 0x06, 0x2B, 0xE0, 0xF1, 0x95, 0xA2, -+0x02, 0x6B, 0x8D, 0xEB, 0xE0, 0xF1, 0x75, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, 0x66, 0xA2, -+0x02, 0x6A, 0x6C, 0xEA, 0x20, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x94, 0xA2, 0x80, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x01, 0x6C, 0x8D, 0xEB, 0x68, 0xF3, 0x99, 0xA2, -+0x68, 0xF3, 0x74, 0xC2, 0x00, 0x6B, 0x68, 0xF3, -+0x78, 0xC2, 0x20, 0x6B, 0x8D, 0xEB, 0x88, 0xF3, -+0xB1, 0xA2, 0x88, 0xF3, 0x90, 0xA2, 0x88, 0xF3, -+0xD7, 0xA2, 0x68, 0xF3, 0x79, 0xC2, 0x06, 0x6F, -+0x00, 0x18, 0x69, 0xCA, 0x18, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x94, 0xA2, 0x80, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x68, 0xF3, 0x74, 0xC2, 0x68, 0xF3, 0x99, 0xA2, -+0x0C, 0x6B, 0x68, 0xF3, 0x78, 0xC2, 0x02, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0x21, 0x6C, 0x8B, 0xEC, -+0x8C, 0xEB, 0x68, 0xF3, 0x79, 0xC2, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x68, -+0x8C, 0xE8, 0x90, 0x67, 0x00, 0x18, 0xA8, 0xCB, -+0x90, 0x67, 0x00, 0x18, 0x21, 0xE6, 0x01, 0x6C, -+0x00, 0x18, 0xBA, 0xCA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6A, 0x27, 0x67, -+0x4C, 0xE9, 0x6F, 0x41, 0x4C, 0xEB, 0x04, 0x67, -+0x02, 0x5B, 0x4C, 0xE8, 0x4C, 0xED, 0x4C, 0xEE, -+0x03, 0x61, 0x90, 0x67, 0x00, 0x18, 0x52, 0xE2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x49, 0xE0, 0x0C, 0xF7, 0x7E, 0xA2, 0x2C, 0xF7, -+0x4E, 0xA2, 0x10, 0x58, 0x6D, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x49, 0x60, 0x10, 0xF0, 0x24, 0x6B, -+0x08, 0x34, 0x75, 0xF0, 0x00, 0x4B, 0x8D, 0xE3, -+0x60, 0x9B, 0x00, 0xEB, 0xD0, 0xF4, 0x64, 0x40, -+0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xEB, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x55, 0xF5, 0x74, 0x9B, -+0x34, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x55, 0xF5, -+0x78, 0x9B, 0x2F, 0x10, 0x80, 0xF4, 0x64, 0x40, -+0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xEB, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x55, 0xF5, 0x7C, 0x9B, -+0x24, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF5, -+0x60, 0x9B, 0x1F, 0x10, 0xC0, 0xF4, 0x68, 0x40, -+0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xEB, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF5, 0x64, 0x9B, -+0x14, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF5, -+0x68, 0x9B, 0x0F, 0x10, 0x70, 0xF4, 0x68, 0x40, -+0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xEB, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF5, 0x6C, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF5, -+0x70, 0x9B, 0x61, 0xE0, 0x40, 0xC0, 0x30, 0xF0, -+0x20, 0x6A, 0xE8, 0xF2, 0x3B, 0xC2, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x4C, 0x9A, 0x42, 0xF1, 0x18, 0x6C, -+0x01, 0x6D, 0x02, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x05, 0x6A, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0x44, 0xF1, 0x01, 0x4A, -+0x40, 0xDB, 0x01, 0x4A, 0x40, 0xDB, 0xF4, 0x17, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF0, 0x74, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF0, 0x50, 0x9A, -+0x01, 0x6C, 0xA4, 0x67, 0x60, 0xDA, 0x00, 0x18, -+0xC7, 0xD0, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF1, -+0x00, 0x4A, 0x10, 0xF0, 0x24, 0x6B, 0xEF, 0x9A, -+0xD5, 0xF0, 0x78, 0x9B, 0x8C, 0x9A, 0xCE, 0x9A, -+0xAD, 0x9A, 0xE0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x7C, 0x9B, 0x00, 0x68, 0xC0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF0, 0x60, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF0, -+0x64, 0x9B, 0x80, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0x89, 0x9A, 0xF5, 0xF0, 0x68, 0x9B, 0x80, 0xDB, -+0x68, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF0, -+0x4C, 0x9A, 0x60, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0x60, 0xF1, 0x48, 0xAA, 0x0B, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0x08, 0x34, 0x2E, 0xF2, 0x0C, 0x4B, -+0x6D, 0xE4, 0x60, 0x9B, 0x05, 0x23, 0x01, 0x48, -+0xFF, 0x6B, 0x6C, 0xE8, 0x43, 0xE8, 0xF3, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF0, 0x70, 0x9A, -+0x7F, 0x6A, 0x00, 0x69, 0x80, 0xA3, 0x20, 0xF0, -+0x20, 0x6D, 0x00, 0xF1, 0x00, 0x4D, 0x8C, 0xEA, -+0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, -+0x40, 0x9B, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF0, -+0xD4, 0x9B, 0x91, 0x67, 0x48, 0x6F, 0x04, 0xD1, -+0x05, 0xD1, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x40, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF0, 0xD8, 0x9B, 0x20, 0xF0, 0x20, 0x6D, -+0x91, 0x67, 0xAD, 0xF1, 0x08, 0x4D, 0x00, 0xF4, -+0x00, 0x6F, 0x04, 0xD1, 0x05, 0xD1, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x40, 0x9B, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF0, 0xDC, 0x9B, -+0x20, 0xF0, 0x21, 0x6D, 0x00, 0x37, 0x91, 0x67, -+0x15, 0xF0, 0x00, 0x4D, 0xE8, 0x37, 0x04, 0xD1, -+0x05, 0xD1, 0x40, 0xEA, 0x00, 0x1C, 0x96, 0x45, -+0xFF, 0x17, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF1, 0x00, 0x4A, 0x60, 0xDA, 0x81, 0xDA, -+0xA2, 0xDA, 0xC3, 0xDA, 0xE4, 0xDA, 0x05, 0xDA, -+0x26, 0xDA, 0x78, 0x67, 0x67, 0xDA, 0x7D, 0x67, -+0x68, 0xDA, 0x7F, 0x67, 0x69, 0xDA, 0x12, 0xEB, -+0x6A, 0xDA, 0x10, 0xEB, 0x6B, 0xDA, 0x6D, 0xB8, -+0x00, 0x65, 0x6C, 0xDA, 0x68, 0xB8, 0x00, 0x65, -+0x6D, 0xDA, 0x6C, 0xB8, 0x00, 0x65, 0x6E, 0xDA, -+0x6E, 0xB8, 0x00, 0x65, 0x6F, 0xDA, 0x10, 0xF0, -+0x23, 0x6A, 0x44, 0xF1, 0x19, 0x4A, 0x00, 0xEA, -+0x00, 0x65, 0x00, 0x65, 0xFF, 0x63, 0x01, 0xD0, -+0xFF, 0x6A, 0x4C, 0xEC, 0x4C, 0xED, 0x8E, 0x37, -+0x4C, 0xEF, 0x07, 0x6E, 0x01, 0x75, 0x8C, 0xEE, -+0x52, 0xF4, 0x60, 0x47, 0x59, 0x61, 0x30, 0xF0, -+0x20, 0x6D, 0xC0, 0xF1, 0x08, 0x4D, 0xBD, 0xE7, -+0xE8, 0xF2, 0xAF, 0xA7, 0x01, 0x68, 0x04, 0xEE, -+0x0D, 0xED, 0xE8, 0xF2, 0xAF, 0xC7, 0x1F, 0xF7, -+0x00, 0x6D, 0x6C, 0xED, 0x02, 0xF0, 0x00, 0x75, -+0x01, 0x60, 0x25, 0x2D, 0x1F, 0xF7, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, -+0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, -+0xA0, 0x9A, 0xB5, 0xE3, 0x60, 0xA5, 0x0B, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0xA0, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x44, 0x9A, -+0xB5, 0xE3, 0x4D, 0xE3, 0x60, 0xA3, 0x01, 0x6A, -+0x00, 0xF6, 0x60, 0x33, 0x44, 0xEE, 0x00, 0xF6, -+0x63, 0x33, 0x4F, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x40, 0xC5, 0x0E, 0x10, 0x10, 0xF0, -+0x24, 0x6D, 0x15, 0xF1, 0xA4, 0x9D, 0x0F, 0xE8, -+0xAD, 0xE3, 0xA0, 0xA3, 0x00, 0xF6, 0xA0, 0x35, -+0x00, 0xF6, 0xA3, 0x35, 0x0C, 0xED, 0x4C, 0xED, -+0xA0, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, -+0x54, 0xA2, 0x4E, 0xEC, 0x52, 0x2C, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x48, 0x9A, 0x60, 0x9A, -+0x30, 0xF0, 0x20, 0x6A, 0x70, 0x33, 0x00, 0xF5, -+0x62, 0x33, 0x48, 0xF5, 0x68, 0xCA, 0x45, 0x10, -+0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, -+0x9D, 0xE7, 0xE8, 0xF2, 0x0F, 0xA7, 0x01, 0x6D, -+0xA4, 0xEE, 0xAF, 0xEC, 0x0C, 0xEC, 0xE8, 0xF2, -+0x8F, 0xC7, 0x1F, 0xF7, 0x00, 0x6C, 0x6C, 0xEC, -+0x02, 0xF0, 0x00, 0x74, 0x01, 0x60, 0x24, 0x2C, -+0x1F, 0xF7, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0xF0, -+0x00, 0x72, 0x01, 0x60, 0x07, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x80, 0x9A, 0x91, 0xE3, -+0x60, 0xA4, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x80, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x44, 0x9A, 0x91, 0xE3, 0x4D, 0xE3, -+0x60, 0xA3, 0x00, 0xF6, 0x60, 0x33, 0x01, 0x6A, -+0x00, 0xF6, 0x63, 0x33, 0x44, 0xEE, 0x6D, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x40, 0xC4, 0x0D, 0x10, -+0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF1, 0x84, 0x9C, -+0x8D, 0xE3, 0x80, 0xA3, 0x00, 0xF6, 0x80, 0x34, -+0x00, 0xF6, 0x83, 0x34, 0xAD, 0xEC, 0x4C, 0xEC, -+0x80, 0xC3, 0x01, 0x90, 0x01, 0x63, 0x20, 0xE8, -+0xFF, 0x6A, 0x4C, 0xEC, 0x05, 0x5C, 0xAC, 0xEA, -+0x4B, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x88, 0x34, -+0x14, 0xF4, 0x18, 0x4B, 0x8D, 0xE3, 0x60, 0x9B, -+0x00, 0xEB, 0x05, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x6C, 0x9A, 0x2D, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x6C, 0x9A, 0x20, 0x10, -+0x05, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, -+0x70, 0x9A, 0x22, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x70, 0x9A, 0x15, 0x10, 0x05, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x74, 0x9A, -+0x17, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, -+0x74, 0x9A, 0x0A, 0x10, 0x05, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x78, 0x9A, 0x0C, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x78, 0x9A, -+0x80, 0xA3, 0xF7, 0x6A, 0x0A, 0x10, 0x0C, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x7C, 0x9A, -+0x40, 0xA3, 0xFF, 0x6C, 0x08, 0x6D, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x7C, 0x9A, -+0xF7, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0x01, 0x6B, 0xAC, 0xEA, 0x6E, 0xEA, 0x01, 0x5A, -+0x58, 0x67, 0x05, 0x5C, 0x48, 0x32, 0x08, 0x60, -+0x10, 0xF0, 0x24, 0x6B, 0x88, 0x34, 0x34, 0xF4, -+0x0C, 0x4B, 0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, -+0x01, 0x6A, 0x4B, 0xEA, 0x20, 0xE8, 0x10, 0xF0, -+0x24, 0x6B, 0x15, 0xF1, 0x88, 0x9B, 0x10, 0xF0, -+0x24, 0x6D, 0x35, 0xF1, 0xA0, 0x9D, 0x60, 0x9C, -+0xAC, 0xEB, 0x1E, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF1, 0x88, 0x9B, 0x10, 0xF0, 0x24, 0x6D, -+0x35, 0xF1, 0xA0, 0x9D, 0x60, 0x9C, 0xAC, 0xEB, -+0x10, 0xF0, 0x24, 0x6D, 0x35, 0xF1, 0xAC, 0x9D, -+0x0E, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF1, -+0x88, 0x9B, 0x10, 0xF0, 0x24, 0x6D, 0x35, 0xF1, -+0xA0, 0x9D, 0x60, 0x9C, 0xAC, 0xEB, 0x10, 0xF0, -+0x24, 0x6D, 0x35, 0xF1, 0xB0, 0x9D, 0xAD, 0xEB, -+0x60, 0xDC, 0x60, 0xF5, 0x60, 0x42, 0x1F, 0xF7, -+0x00, 0x6C, 0x8C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x10, 0x61, 0x2E, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF1, 0x88, 0x9B, 0x10, 0xF0, 0x24, 0x6D, -+0x35, 0xF1, 0xA0, 0x9D, 0x60, 0x9C, 0xAC, 0xEB, -+0x10, 0xF0, 0x24, 0x6D, 0x35, 0xF1, 0xB4, 0x9D, -+0xE6, 0x17, 0x1E, 0x23, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF1, 0x68, 0x9B, 0x1D, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x15, 0xF1, 0x88, 0x9B, 0x10, 0xF0, -+0x24, 0x6D, 0x35, 0xF1, 0xA0, 0x9D, 0x60, 0x9C, -+0xAC, 0xEB, 0x10, 0xF0, 0x24, 0x6D, 0x35, 0xF1, -+0xB8, 0x9D, 0xAD, 0xEB, 0x60, 0xDC, 0x60, 0xF5, -+0x60, 0x42, 0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xEB, -+0x02, 0xF0, 0x00, 0x73, 0x01, 0x60, 0x07, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF1, 0x64, 0x9B, -+0x69, 0xE2, 0x40, 0x9A, 0x20, 0xE8, 0x10, 0xF0, -+0x24, 0x6B, 0x35, 0xF1, 0x68, 0x9B, 0x69, 0xE2, -+0x40, 0x9A, 0x20, 0xE8, 0xFF, 0x6A, 0x4C, 0xEC, -+0x01, 0x74, 0xAC, 0xEA, 0x13, 0x60, 0x03, 0x24, -+0x02, 0x74, 0x15, 0x60, 0x18, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, -+0xD9, 0xA3, 0x01, 0x6D, 0x4C, 0xED, 0x02, 0x6A, -+0x4B, 0xEA, 0xCC, 0xEA, 0xAD, 0xEA, 0x68, 0xF3, -+0x59, 0xC3, 0x09, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0x48, 0xF5, 0x44, 0xC3, 0x04, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0x48, 0xF5, 0x40, 0xC3, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF1, 0x5C, 0x9A, 0x60, 0xA2, -+0x10, 0x6A, 0x6C, 0xEA, 0x24, 0x22, 0x02, 0x5C, -+0x03, 0x61, 0x02, 0x74, 0x17, 0x60, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x68, 0xF3, 0x99, 0xA3, 0x01, 0x6A, 0x8C, 0xEA, -+0x68, 0xF3, 0x9C, 0xA3, 0x7F, 0x6B, 0x5C, 0x32, -+0x8C, 0xEB, 0x6D, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x55, 0xF1, 0x60, 0x9B, -+0x40, 0xC3, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x60, 0xA2, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF1, 0x44, 0x9A, 0x60, 0xC2, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x48, 0x9A, -+0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, 0xFF, 0x72, -+0x00, 0x6A, 0x0B, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF1, 0x4C, 0x9A, 0x60, 0xA2, 0x07, 0x6A, -+0x6C, 0xEA, 0x07, 0x6B, 0x6E, 0xEA, 0x01, 0x5A, -+0x58, 0x67, 0x20, 0xE8, 0xFF, 0x6A, 0x4C, 0xEC, -+0x01, 0x74, 0xAC, 0xEA, 0x03, 0x60, 0x02, 0x74, -+0x09, 0x60, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x02, 0x6B, 0x88, 0xF3, -+0x62, 0xC2, 0x15, 0x10, 0x09, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xE8, 0xF3, -+0x67, 0xA2, 0x88, 0xF3, 0x62, 0xC2, 0x05, 0x10, -+0xFF, 0x4A, 0x30, 0xF0, 0x20, 0x6B, 0x48, 0xF5, -+0x4A, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x88, 0xF3, 0x62, 0xA2, 0x68, 0xF3, -+0x99, 0xA2, 0x88, 0xF3, 0x63, 0xC2, 0x40, 0x6B, -+0x8D, 0xEB, 0x68, 0xF3, 0x79, 0xC2, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x9A, 0xC9, -+0x01, 0x72, 0x15, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, -+0x04, 0x6B, 0x8C, 0xEB, 0x0C, 0x2B, 0x68, 0xF3, -+0x58, 0xA2, 0x05, 0x5A, 0x08, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF7, 0x4D, 0xA2, 0x01, 0x6B, -+0x6E, 0xEA, 0x6C, 0xEA, 0x01, 0x10, 0x00, 0x6A, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x9A, 0xC9, -+0x01, 0x72, 0x1C, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x9D, 0xA2, -+0x03, 0x6B, 0x8C, 0xEB, 0x13, 0x2B, 0x68, 0xF3, -+0x78, 0xA2, 0x10, 0x2B, 0x04, 0x6B, 0x8C, 0xEB, -+0x0D, 0x2B, 0x10, 0x6B, 0x8C, 0xEB, 0x0A, 0x2B, -+0x68, 0xF3, 0x99, 0xA2, 0x20, 0x6B, 0x8C, 0xEB, -+0x05, 0x23, 0xE8, 0xF3, 0x52, 0xA2, 0x01, 0x5A, -+0x58, 0x67, 0x01, 0x10, 0x00, 0x6A, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x50, 0x9A, -+0x40, 0xA2, 0x1E, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF1, 0x54, 0x9A, 0x40, 0xA2, 0x18, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x58, 0x9A, -+0x60, 0xA2, 0x02, 0x6A, 0x6C, 0xEA, 0x10, 0x22, -+0x00, 0x18, 0x9A, 0xC9, 0x01, 0x72, 0x01, 0x6A, -+0x0C, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, -+0x7C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x75, 0xF1, -+0x80, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x00, 0x6A, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0xFF, 0x69, 0x30, 0xF0, -+0x20, 0x6A, 0x8C, 0xE9, 0x6E, 0xF5, 0x58, 0x9A, -+0x2F, 0xF7, 0x94, 0xA3, 0x40, 0xEA, 0x01, 0x72, -+0x29, 0x61, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x68, 0xF3, 0x7A, 0xA0, 0x09, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0xFF, 0x6C, 0x6F, 0x6D, 0x2C, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x50, 0x9A, -+0xC8, 0xF2, 0x9F, 0xA0, 0x01, 0x6D, 0x08, 0x6E, -+0xF1, 0x67, 0x40, 0xEA, 0x01, 0x72, 0x0A, 0x61, -+0x68, 0xF3, 0x7A, 0xA0, 0x02, 0x6A, 0x01, 0x6C, -+0x6D, 0xEA, 0x0E, 0x6D, 0x68, 0xF3, 0x5A, 0xC0, -+0x00, 0x18, 0x73, 0xC9, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0x2E, 0x6E, 0xFF, 0x6C, -+0x6F, 0x6D, 0x40, 0xEA, 0x01, 0x6C, 0x02, 0x6D, -+0x00, 0x18, 0x73, 0xC9, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0xFF, 0x6E, 0x30, 0xF0, -+0x20, 0x6A, 0x8C, 0xEE, 0x2E, 0xF4, 0x48, 0x9A, -+0x48, 0xF5, 0x80, 0xA3, 0x01, 0x6D, 0x40, 0xEA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x7D, 0xA0, 0x10, 0x6A, 0xFF, 0x69, -+0x6D, 0xEA, 0x88, 0xF3, 0x65, 0xA0, 0x8C, 0xE9, -+0x68, 0xF3, 0x5D, 0xC0, 0x02, 0x5B, 0x10, 0x60, -+0x88, 0xF3, 0xC4, 0xA0, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x50, 0x9A, 0xFF, 0x6C, 0xD9, 0xE3, -+0x55, 0x4C, 0x00, 0x6D, 0x40, 0xEA, 0x88, 0xF3, -+0x65, 0xA0, 0x88, 0xF3, 0x44, 0xA0, 0x17, 0x10, -+0x03, 0x6A, 0x58, 0xEB, 0x88, 0xF3, 0xC4, 0xA0, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, -+0xFE, 0x4E, 0xFF, 0x6C, 0x55, 0x4C, 0x00, 0x6D, -+0x12, 0xEB, 0x79, 0xE6, 0x40, 0xEA, 0x88, 0xF3, -+0x45, 0xA0, 0x03, 0x6C, 0x88, 0xF3, 0x64, 0xA0, -+0x98, 0xEA, 0xFE, 0x4B, 0x12, 0xEA, 0x49, 0xE3, -+0x88, 0xF3, 0x57, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x04, 0x6B, 0x6C, 0xEA, -+0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x83, 0x67, 0x01, 0x6D, 0xD1, 0x67, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x74, 0xA0, -+0x00, 0x6A, 0xE8, 0xF3, 0x42, 0xC0, 0x7F, 0x6A, -+0xFF, 0x69, 0x6C, 0xEA, 0x2C, 0xEC, 0x2C, 0xEA, -+0x04, 0xD4, 0x1A, 0x22, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, -+0x2F, 0xF7, 0x94, 0xA3, 0x40, 0xEA, 0x01, 0x72, -+0x0F, 0x61, 0x68, 0xF3, 0x75, 0xA0, 0x0F, 0x6A, -+0x6C, 0xEA, 0x2C, 0xEA, 0x06, 0x22, 0x68, 0xF3, -+0x7A, 0xA0, 0x10, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x03, 0x2A, 0x04, 0x94, 0x00, 0x18, 0x26, 0xCA, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x63, 0x01, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x68, 0xF3, 0x1A, 0xA3, 0x20, 0x6F, 0xFF, 0x6A, -+0x0C, 0xEF, 0x4C, 0xEF, 0x4C, 0xEC, 0x4C, 0xED, -+0x4C, 0xEE, 0x80, 0xF0, 0x0A, 0x2F, 0x68, 0xF3, -+0x19, 0xA3, 0x01, 0x6F, 0x0C, 0xEF, 0x4C, 0xEF, -+0x09, 0x27, 0x88, 0xF3, 0x5B, 0xA3, 0xE4, 0x42, -+0x03, 0x4A, 0x88, 0xF3, 0xF3, 0xC3, 0x88, 0xF3, -+0x52, 0xC3, 0x08, 0x10, 0x05, 0x6F, 0x88, 0xF3, -+0xF3, 0xC3, 0x05, 0x4E, 0x04, 0x6F, 0x88, 0xF3, -+0xF2, 0xC3, 0x4C, 0xEE, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0xF1, 0xA2, -+0x88, 0xF3, 0x72, 0xA2, 0xE3, 0xEB, 0x09, 0x61, -+0x88, 0xF3, 0x73, 0xA2, 0x88, 0xF3, 0xC4, 0xC2, -+0x71, 0xE4, 0xB7, 0xE4, 0x88, 0xF3, 0xB6, 0xC2, -+0x09, 0x10, 0x88, 0xF3, 0x93, 0xA2, 0x77, 0xE5, -+0xB9, 0xE6, 0x6F, 0xE4, 0x88, 0xF3, 0xC4, 0xC2, -+0x88, 0xF3, 0x76, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0x73, 0xA2, -+0x88, 0xF3, 0x96, 0xA2, 0x0A, 0x4B, 0x82, 0xEB, -+0x02, 0x60, 0x88, 0xF3, 0x76, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x76, 0xA2, 0x88, 0xF3, 0x84, 0xA2, 0x23, 0x4B, -+0x82, 0xEB, 0x02, 0x60, 0x88, 0xF3, 0x64, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x76, 0xA2, 0x68, 0xF3, 0x97, 0xA2, -+0x88, 0xF3, 0x6A, 0xCA, 0x18, 0x6B, 0x8C, 0xEB, -+0x10, 0x73, 0x07, 0x61, 0xC8, 0xF3, 0x79, 0xA2, -+0x03, 0x6C, 0x76, 0x33, 0x8C, 0xEB, 0x88, 0xF3, -+0x64, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, -+0x44, 0x9A, 0x60, 0xA2, 0x07, 0x23, 0x60, 0xA2, -+0xFF, 0x6A, 0x4C, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x72, 0xCA, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x48, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0x48, 0xF5, 0x92, 0xAC, 0xA0, 0xA2, 0xFF, 0x6B, -+0x6C, 0xED, 0x8E, 0xED, 0x02, 0x25, 0x8C, 0xEB, -+0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0x9A, 0xA2, 0x41, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, 0x7A, 0xC2, -+0x04, 0x10, 0x40, 0x6A, 0x0D, 0xEA, 0x68, 0xF3, -+0x5A, 0xC3, 0x01, 0x90, 0x01, 0x63, 0x20, 0xE8, -+0xFB, 0x63, 0x09, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0x28, 0xF5, 0xBF, 0xA3, 0x04, 0x6B, 0xFF, 0x6A, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x0C, 0x23, -+0x7D, 0x67, 0x1E, 0x6A, 0x50, 0xC3, 0x01, 0x6A, -+0x4F, 0xCB, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x58, 0x9A, 0x92, 0xC3, 0x04, 0x04, 0x40, 0xEA, -+0x09, 0x97, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x24, 0x67, 0x6E, 0xF5, 0x58, 0x9A, 0x2F, 0xF7, -+0x94, 0xA3, 0xFF, 0x68, 0x0C, 0xE9, 0x40, 0xEA, -+0x01, 0x72, 0x35, 0x61, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, 0x94, 0xA3, -+0x7F, 0x6A, 0x8C, 0xEA, 0x0C, 0xEA, 0x2B, 0x22, -+0x68, 0xF3, 0x75, 0xA3, 0x0F, 0x6A, 0x6C, 0xEA, -+0x01, 0x72, 0x25, 0x61, 0x05, 0x59, 0x03, 0x61, -+0xA0, 0xF6, 0x08, 0x6A, 0x07, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x24, 0x31, 0xD4, 0xF4, 0x18, 0x4A, -+0x49, 0xE1, 0x40, 0xAA, 0x61, 0x42, 0x1F, 0xF7, -+0x00, 0x6C, 0x8C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x75, 0xF1, 0x6C, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x75, 0xF1, 0x70, 0x9B, 0x69, 0xE2, -+0x60, 0xA2, 0x20, 0x6A, 0x6C, 0xEA, 0x4B, 0xEA, -+0xC0, 0xF7, 0x42, 0x32, 0x01, 0x10, 0x01, 0x6A, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x18, 0x4A, 0xE0, 0xF1, 0x6E, 0xA2, -+0x02, 0x6C, 0x8B, 0xEC, 0x03, 0x6D, 0x8C, 0xEB, -+0xAB, 0xED, 0xAC, 0xEB, 0xE0, 0xF1, 0xB5, 0xA2, -+0xAC, 0xEC, 0xE0, 0xF1, 0x95, 0xC2, 0x08, 0x6C, -+0x8D, 0xEB, 0xE0, 0xF1, 0x6E, 0xC2, 0x20, 0xE8, -+0xFF, 0x63, 0x01, 0xD1, 0x00, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0xE0, 0xF1, -+0xCE, 0xA2, 0x01, 0x68, 0x70, 0x67, 0xCC, 0xEB, -+0xFF, 0x6C, 0x29, 0x23, 0xE0, 0xF1, 0xF5, 0xA2, -+0x02, 0x6D, 0x67, 0x67, 0xAC, 0xEB, 0x8C, 0xEB, -+0x22, 0x23, 0x30, 0xF0, 0x21, 0x6B, 0x70, 0xF3, -+0x38, 0xA3, 0x01, 0x49, 0x70, 0xF3, 0x38, 0xC3, -+0x70, 0xF3, 0x38, 0xA3, 0xC9, 0x59, 0x17, 0x61, -+0x03, 0x69, 0x2B, 0xE9, 0xEC, 0xE9, 0xCC, 0xED, -+0xE0, 0xF1, 0x35, 0xC2, 0x8C, 0xED, 0x00, 0x6A, -+0x70, 0xF3, 0x58, 0xC3, 0x0C, 0x25, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x79, 0xA2, 0x6D, 0xE8, 0xD0, 0x6B, 0x68, 0xF3, -+0x19, 0xC2, 0x88, 0xF3, 0x68, 0xCA, 0x01, 0x91, -+0x00, 0x90, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0x2F, 0xF5, 0x18, 0x48, -+0xE0, 0xF1, 0x4E, 0xA0, 0x01, 0x69, 0x2C, 0xEA, -+0x0F, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x50, 0x9A, 0xE0, 0xF1, 0xD6, 0xA0, 0xFF, 0x6C, -+0x55, 0x4C, 0x00, 0x6D, 0x40, 0xEA, 0xE0, 0xF1, -+0x55, 0xA0, 0x4D, 0xE9, 0xE0, 0xF1, 0x35, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, 0x5C, 0xA2, -+0x01, 0x72, 0x12, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x18, 0x4A, 0xE0, 0xF1, 0x8E, 0xA2, -+0x08, 0x6B, 0x8C, 0xEB, 0x09, 0x2B, 0xE0, 0xF1, -+0x75, 0xA2, 0x02, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xFA, 0xCA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, 0x66, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0x2E, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF1, 0x54, 0x9A, 0x00, 0x6B, -+0x02, 0x6C, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x78, 0x9A, 0x40, 0x9B, 0x8C, 0xEA, -+0x01, 0x22, 0x80, 0xDB, 0x00, 0x18, 0x1E, 0xE7, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, 0x66, 0xA2, -+0x02, 0x6A, 0x6C, 0xEA, 0x04, 0x22, 0x01, 0x6C, -+0x0C, 0x6D, 0x00, 0x18, 0x73, 0xC9, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0xE0, 0xF1, -+0x95, 0xA2, 0x01, 0x6B, 0x8D, 0xEB, 0xE0, 0xF1, -+0x75, 0xC2, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x1E, 0xE7, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xC5, 0x67, 0xFF, 0x6C, 0x40, 0xEA, -+0x01, 0x6C, 0x0C, 0x6D, 0x00, 0x18, 0x73, 0xC9, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x68, -+0x8C, 0xE8, 0x00, 0x18, 0x1E, 0xE7, 0x08, 0x20, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, -+0x01, 0x6C, 0x04, 0x6D, 0x00, 0x18, 0x73, 0xC9, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0x2F, 0xF5, 0x18, 0x48, -+0xE0, 0xF1, 0x6E, 0xA0, 0x01, 0x6A, 0xFF, 0x69, -+0x4C, 0xEB, 0x54, 0x23, 0xE0, 0xF1, 0x75, 0xA0, -+0x6C, 0xEA, 0x2C, 0xEA, 0x29, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, 0xE0, 0xF1, -+0xD6, 0xA0, 0xFF, 0x6C, 0x55, 0x4C, 0x00, 0x6D, -+0x40, 0xEA, 0x00, 0x18, 0x1E, 0xE7, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, -+0x91, 0x67, 0xC5, 0x67, 0x40, 0xEA, 0xE0, 0xF1, -+0x6E, 0xA0, 0x02, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x04, 0x22, 0x01, 0x6C, 0x0C, 0x6D, 0x00, 0x18, -+0x73, 0xC9, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, -+0x18, 0x4A, 0xE0, 0xF1, 0x95, 0xA2, 0x01, 0x6B, -+0x8D, 0xEB, 0xE0, 0xF1, 0x75, 0xC2, 0x26, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, -+0xE0, 0xF1, 0xD7, 0xA0, 0xFF, 0x6C, 0x55, 0x4C, -+0x00, 0x6D, 0x40, 0xEA, 0xE0, 0xF1, 0x75, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xE0, 0xF1, -+0x6E, 0xA0, 0xE0, 0xF1, 0x55, 0xC0, 0x02, 0x6A, -+0x6C, 0xEA, 0x2C, 0xEA, 0x05, 0x22, 0x01, 0x6C, -+0x04, 0x6D, 0x00, 0x18, 0x73, 0xC9, 0x0A, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0xFF, 0x6C, 0xA4, 0x67, 0x31, 0x6E, 0x40, 0xEA, -+0x00, 0x18, 0xF1, 0xE6, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0xA4, 0x67, -+0x2F, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF2, 0x40, 0x9A, 0x40, 0xEA, 0x00, 0x18, -+0xF1, 0xE6, 0x01, 0x6C, 0x08, 0x6D, 0x00, 0x18, -+0x73, 0xC9, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x4C, 0xEC, 0x30, 0xF0, 0x20, 0x69, -+0xC0, 0xF1, 0x08, 0x49, 0x04, 0xD4, 0x68, 0xF3, -+0x94, 0xA1, 0x00, 0x6B, 0xE8, 0xF3, 0x62, 0xC1, -+0x7F, 0x6B, 0x8C, 0xEB, 0x4C, 0xEB, 0x16, 0x23, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF5, 0x58, 0x9A, 0x2F, 0xF7, 0x94, 0xA3, -+0x01, 0x68, 0x40, 0xEA, 0x4E, 0xE8, 0x0A, 0x28, -+0x04, 0x94, 0x88, 0xF3, 0xA2, 0xA1, 0x00, 0x18, -+0xE6, 0xE6, 0x04, 0x94, 0x88, 0xF3, 0x03, 0xC1, -+0x00, 0x18, 0x26, 0xCA, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xFF, 0x68, -+0x8C, 0xE8, 0x68, 0xF3, 0x99, 0xA2, 0x03, 0x6B, -+0x6B, 0xEB, 0x41, 0x6D, 0x8C, 0xEB, 0xAB, 0xED, -+0xAC, 0xEB, 0x68, 0xF3, 0xBA, 0xA2, 0x68, 0xF3, -+0x79, 0xC2, 0x11, 0x6B, 0x00, 0x6C, 0x6B, 0xEB, -+0x88, 0xF3, 0x85, 0xC2, 0x68, 0xF3, 0x9D, 0xC2, -+0xAC, 0xEB, 0x88, 0xF3, 0x86, 0xC2, 0x90, 0x67, -+0x68, 0xF3, 0x7A, 0xC2, 0x00, 0x18, 0x28, 0xE6, -+0x90, 0x67, 0x00, 0x18, 0x21, 0xE6, 0x90, 0x67, -+0x00, 0x18, 0x3D, 0xE6, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xF0, 0x6D, 0x01, 0x6C, 0x00, 0x18, 0x73, 0xC9, -+0x00, 0x6C, 0x00, 0x18, 0x6E, 0xE8, 0x00, 0x18, -+0xFE, 0xE1, 0x00, 0x18, 0x35, 0xE2, 0x01, 0x6C, -+0x00, 0x18, 0x6E, 0xE8, 0x01, 0x6C, 0x00, 0x6D, -+0x00, 0x18, 0x73, 0xC9, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x02, 0x22, 0x08, 0x72, 0x06, 0x61, 0x00, 0x18, -+0xDF, 0xC9, 0x01, 0x72, 0x02, 0x61, 0x00, 0x18, -+0xD7, 0xCB, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x61, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0xE3, 0xCB, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x75, 0xF1, 0x7C, 0x9B, 0xFF, 0x6A, 0x24, 0x67, -+0x60, 0xA3, 0x4C, 0xE9, 0x30, 0xF0, 0x20, 0x68, -+0x6C, 0xEA, 0x04, 0xD2, 0x6E, 0xF2, 0x58, 0x98, -+0xFF, 0x6C, 0xA4, 0x67, 0x2D, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, 0x40, 0x9A, -+0x40, 0xEA, 0x07, 0x2A, 0x6E, 0xF2, 0x58, 0x98, -+0x04, 0x95, 0xFF, 0x6C, 0x2D, 0x6E, 0x40, 0xEA, -+0x2C, 0x10, 0x05, 0x59, 0x24, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x28, 0x31, 0x54, 0xF4, 0x00, 0x4A, -+0x29, 0xE2, 0x40, 0x9A, 0x00, 0xEA, 0x00, 0x6C, -+0x08, 0x6D, 0x17, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x6C, 0x95, 0xF1, 0xA0, 0x9A, 0x11, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x04, 0x6C, 0x95, 0xF1, -+0xA4, 0x9A, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x6C, 0x95, 0xF1, 0xA8, 0x9A, 0x05, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, 0xAC, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0x70, 0xDC, 0x00, 0x18, -+0xF1, 0xE6, 0x01, 0x6C, 0x00, 0x6D, 0x00, 0x18, -+0x73, 0xC9, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0x48, 0xF5, 0xA2, 0xA3, -+0x08, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x03, 0x2B, 0x01, 0x6C, 0x0C, 0x6D, -+0x05, 0x10, 0x01, 0x6D, 0x00, 0x18, 0x93, 0xCF, -+0x01, 0x6C, 0x04, 0x6D, 0x00, 0x18, 0x73, 0xC9, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0x48, 0xF5, 0xA2, 0xA3, 0x04, 0x6B, 0xFF, 0x6A, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x06, 0x2B, -+0x03, 0x6D, 0x00, 0x18, 0x93, 0xCF, 0x01, 0x6C, -+0x04, 0x6D, 0x05, 0x10, 0x00, 0x6D, 0x00, 0x18, -+0x93, 0xCF, 0x01, 0x6C, 0x0C, 0x6D, 0x00, 0x18, -+0x73, 0xC9, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x6D, 0x00, 0x18, 0x93, 0xCF, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, -+0xC5, 0x67, 0xFF, 0x6C, 0x40, 0xEA, 0x01, 0x6C, -+0x0C, 0x6D, 0x00, 0x18, 0x73, 0xC9, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x69, 0x2C, 0xEC, -+0xAC, 0xE9, 0x38, 0x24, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, -+0x2F, 0xF7, 0x94, 0xA3, 0x40, 0xEA, 0x01, 0x72, -+0x2D, 0x61, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x68, 0xF3, 0x7A, 0xA0, 0x05, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x2B, 0x6E, 0xFF, 0x6C, 0x0F, 0x6D, 0x40, 0xEA, -+0x91, 0x67, 0x02, 0x6D, 0x00, 0x18, 0x93, 0xCF, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x50, 0x9A, -+0xC8, 0xF2, 0x9F, 0xA0, 0x00, 0x6D, 0x08, 0x6E, -+0xF1, 0x67, 0x40, 0xEA, 0x01, 0x72, 0x0A, 0x61, -+0x68, 0xF3, 0x7A, 0xA0, 0x01, 0x6A, 0x01, 0x6C, -+0x6D, 0xEA, 0x06, 0x6D, 0x68, 0xF3, 0x5A, 0xC0, -+0x00, 0x18, 0x73, 0xC9, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x25, 0x67, 0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, -+0x08, 0x4D, 0x06, 0x67, 0x68, 0xF3, 0xDA, 0xA5, -+0x03, 0x6B, 0xFF, 0x6A, 0xCC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x4C, 0xE9, 0x4C, 0xE8, 0xE0, 0xF0, -+0x03, 0x2B, 0x68, 0xF3, 0x5C, 0xA5, 0x8E, 0xEA, -+0xC0, 0xF0, 0x1E, 0x22, 0x0D, 0x5C, 0xC0, 0xF0, -+0x1B, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, -+0x54, 0xF4, 0x14, 0x4A, 0x89, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x0E, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0x1D, 0xCC, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x03, 0x2A, 0x01, 0x6C, -+0x00, 0x18, 0x5C, 0xCB, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x06, 0x72, 0x03, 0x61, -+0x90, 0x67, 0x00, 0x18, 0x2E, 0xCC, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, 0x04, 0x72, -+0x09, 0x61, 0x05, 0x21, 0x91, 0x67, 0xB0, 0x67, -+0x00, 0x18, 0x4B, 0xCC, 0x03, 0x10, 0x90, 0x67, -+0x00, 0x18, 0x40, 0xCC, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x08, 0x72, 0xA0, 0xF0, -+0x03, 0x61, 0x00, 0x18, 0x52, 0xCB, 0xA0, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x03, 0x2A, 0x01, 0x6C, 0x00, 0x18, 0x5C, 0xCB, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x06, 0x72, 0x03, 0x61, 0x90, 0x67, 0x00, 0x18, -+0x2E, 0xCC, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x0E, 0x72, 0x07, 0x61, 0x00, 0x18, -+0xBC, 0xC9, 0x01, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0x1D, 0xCC, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x0C, 0x72, 0x7C, 0x61, -+0x00, 0x18, 0xBC, 0xC9, 0x01, 0x72, 0x78, 0x61, -+0x90, 0x67, 0x00, 0x18, 0xF4, 0xC9, 0x74, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x0E, 0x72, 0x07, 0x61, 0x00, 0x18, 0xBC, 0xC9, -+0x01, 0x72, 0x03, 0x61, 0x90, 0x67, 0x00, 0x18, -+0x1D, 0xCC, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x06, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0x2E, 0xCC, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x0C, 0x72, 0x07, 0x61, -+0x00, 0x18, 0xBC, 0xC9, 0x01, 0x72, 0x03, 0x61, -+0x90, 0x67, 0x00, 0x18, 0xF4, 0xC9, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, 0x04, 0x72, -+0x4B, 0x61, 0x00, 0x18, 0xCC, 0xC9, 0x01, 0x72, -+0x47, 0x61, 0x90, 0x67, 0x00, 0x18, 0xF3, 0xCB, -+0x43, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x0E, 0x72, 0x07, 0x61, 0x00, 0x18, -+0xBC, 0xC9, 0x01, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0x1D, 0xCC, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x06, 0x72, 0x03, 0x61, -+0x90, 0x67, 0x00, 0x18, 0x2E, 0xCC, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, 0x0C, 0x72, -+0x07, 0x61, 0x00, 0x18, 0xBC, 0xC9, 0x01, 0x72, -+0x03, 0x61, 0x90, 0x67, 0x00, 0x18, 0xF4, 0xC9, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x03, 0x2A, 0x01, 0x6C, 0x00, 0x18, 0x5C, 0xCB, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x04, 0x72, 0x12, 0x61, 0x00, 0x18, 0x14, 0xCA, -+0x0F, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0x7C, 0xA2, 0x0C, 0x73, -+0x07, 0x61, 0x68, 0xF3, 0x79, 0xA2, 0x20, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x9C, 0xCB, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x48, 0xF5, 0xA1, 0xA3, 0x04, 0x6B, 0xFF, 0x6A, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x06, 0x23, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, 0x54, 0x9A, -+0x00, 0x6B, 0x60, 0xC2, 0x02, 0x6D, 0x00, 0x18, -+0x46, 0xE2, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, -+0x58, 0x9A, 0x04, 0x69, 0x30, 0xF0, 0x20, 0x68, -+0x20, 0xDA, 0xC0, 0xF1, 0x08, 0x48, 0xE8, 0xF3, -+0xC6, 0xA0, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x50, 0x9A, 0xFF, 0x6C, 0x59, 0x4C, 0x00, 0x6D, -+0xC6, 0x36, 0x40, 0xEA, 0x68, 0xF3, 0x59, 0xA0, -+0x07, 0x97, 0x4D, 0xE9, 0x68, 0xF3, 0x39, 0xC0, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, -+0xB4, 0xA3, 0x04, 0x67, 0x7F, 0x6C, 0xAC, 0xEC, -+0xFF, 0x6A, 0x01, 0x74, 0x4C, 0xE8, 0x26, 0x61, -+0x68, 0xF3, 0xB5, 0xA3, 0x10, 0x6C, 0x8B, 0xEC, -+0xAC, 0xEC, 0x4C, 0xEC, 0x14, 0x24, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0xD0, 0x67, -+0x0C, 0x6C, 0x00, 0x6D, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, -+0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, 0x90, 0x67, -+0x00, 0x18, 0xED, 0xCC, 0x0B, 0x10, 0x68, 0xF3, -+0x5C, 0xA3, 0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x04, 0x6C, 0x01, 0x6D, -+0xD0, 0x67, 0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0x08, 0xCD, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x69, 0x8C, 0xE9, 0x30, 0xF0, 0x20, 0x68, -+0x91, 0x67, 0xC0, 0xF1, 0x08, 0x48, 0x00, 0x18, -+0xED, 0xCC, 0x68, 0xF3, 0x5C, 0xA0, 0x0C, 0x72, -+0x20, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x0C, 0x6C, 0x00, 0x6D, 0xD1, 0x67, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x00, 0x6D, 0xC5, 0x67, 0xFF, 0x6C, -+0x40, 0xEA, 0x68, 0xF3, 0x7A, 0xA0, 0x01, 0x6A, -+0xC8, 0xF2, 0x9F, 0xA0, 0x6D, 0xEA, 0x68, 0xF3, -+0x5A, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x50, 0x9A, 0x00, 0x6D, 0x08, 0x6E, 0xF1, 0x67, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x24, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, 0x68, 0xF3, -+0xB9, 0xA4, 0x40, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, -+0x4C, 0xEB, 0x4C, 0xE9, 0x09, 0x23, 0x68, 0xF3, -+0x9A, 0xA4, 0x10, 0x6B, 0x8C, 0xEB, 0x4C, 0xEB, -+0x03, 0x23, 0x91, 0x67, 0x00, 0x18, 0x47, 0xE6, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x79, 0xA0, 0x02, 0x6A, 0x6C, 0xEA, -+0x10, 0x22, 0x03, 0x6A, 0x4B, 0xEA, 0x4C, 0xEB, -+0x68, 0xF3, 0x79, 0xC0, 0x68, 0xF3, 0x7D, 0xA0, -+0x6C, 0xEA, 0x68, 0xF3, 0x5D, 0xC0, 0x68, 0xF3, -+0x5D, 0xA0, 0x07, 0x6B, 0x6C, 0xEA, 0x59, 0x2A, -+0x55, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, -+0x78, 0x9A, 0xFF, 0xF7, 0x1F, 0x6C, 0x40, 0xAB, -+0x8C, 0xEA, 0x01, 0x4A, 0x8C, 0xEA, 0x40, 0xCB, -+0x88, 0xF3, 0x45, 0xA0, 0x68, 0xF3, 0x7D, 0xA0, -+0x01, 0x4A, 0x88, 0xF3, 0x45, 0xC0, 0x11, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x5D, 0xC0, -+0x88, 0xF3, 0x65, 0xA0, 0xE8, 0xF3, 0x44, 0xA0, -+0x63, 0xEA, 0x38, 0x60, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, 0x94, 0xA3, -+0x6E, 0xF5, 0x58, 0x9A, 0x40, 0xEA, 0x01, 0x6B, -+0x6E, 0xEA, 0x2F, 0x2A, 0x68, 0xF3, 0x95, 0xA0, -+0xEF, 0x4B, 0x8C, 0xEB, 0xFF, 0x6C, 0x8C, 0xEB, -+0x07, 0x2B, 0x68, 0xF3, 0x79, 0xA0, 0xDF, 0x4A, -+0x6C, 0xEA, 0x68, 0xF3, 0x59, 0xC0, 0x21, 0x10, -+0x88, 0xF3, 0x66, 0xA0, 0x01, 0x4B, 0x88, 0xF3, -+0x66, 0xC0, 0x88, 0xF3, 0x66, 0xA0, 0x02, 0x5B, -+0x0A, 0x61, 0x68, 0xF3, 0x99, 0xA0, 0x21, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, 0x79, 0xC0, -+0x88, 0xF3, 0x46, 0xC0, 0x03, 0x10, 0x91, 0x67, -+0x00, 0x18, 0x2A, 0xCD, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x00, 0x6B, 0x88, 0xF3, -+0x65, 0xC2, 0x03, 0x10, 0x91, 0x67, 0x00, 0x18, -+0x1D, 0xCA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, -+0x05, 0x5A, 0x00, 0x68, 0x24, 0x60, 0x10, 0xF0, -+0x24, 0x6B, 0x48, 0x34, 0x94, 0xF4, 0x08, 0x4B, -+0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, 0x10, 0xF0, -+0x24, 0x6B, 0x95, 0xF1, 0x7C, 0x9B, 0x13, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF1, 0x60, 0x9B, -+0x0E, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF1, -+0x64, 0x9B, 0x09, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0xB5, 0xF1, 0x68, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xB5, 0xF1, 0x6C, 0x9B, 0x60, 0xAB, -+0xFF, 0xF7, 0x1F, 0x68, 0x6C, 0xE8, 0x18, 0xF0, -+0x00, 0x6B, 0x0C, 0xEB, 0x13, 0x2B, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, 0x68, 0xF3, -+0xBD, 0xA4, 0xFE, 0x4B, 0xAC, 0xEB, 0x05, 0x6D, -+0xAB, 0xED, 0xAC, 0xEB, 0x02, 0x4D, 0xAC, 0xEB, -+0x68, 0xF3, 0x7D, 0xC4, 0x82, 0x67, 0x00, 0x18, -+0x1D, 0xCA, 0x5D, 0x10, 0x08, 0xF0, 0x00, 0x6B, -+0x0C, 0xEB, 0x23, 0x23, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, 0xB4, 0xA3, -+0x7F, 0x6C, 0xAC, 0xEC, 0x01, 0x74, 0x27, 0x61, -+0x68, 0xF3, 0xBD, 0xA3, 0x01, 0x6C, 0xAD, 0xEC, -+0x68, 0xF3, 0x9D, 0xC3, 0x68, 0xF3, 0x95, 0xA3, -+0x10, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xFF, 0x6C, -+0x8C, 0xEB, 0x20, 0x73, 0x06, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x54, 0x9A, 0x40, 0xEA, -+0x12, 0x10, 0x82, 0x67, 0x00, 0x18, 0x2A, 0xCD, -+0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0x9D, 0xA3, 0x02, 0x6A, -+0x4B, 0xEA, 0x8C, 0xEA, 0x05, 0x6C, 0x8B, 0xEC, -+0x8C, 0xEA, 0x68, 0xF3, 0x5D, 0xC3, 0x02, 0x30, -+0x1E, 0x30, 0x1A, 0x20, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x5D, 0xA0, -+0x02, 0x69, 0xE8, 0xF3, 0xC5, 0xA0, 0x2D, 0xEA, -+0x68, 0xF3, 0x5D, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x50, 0x9A, 0xFF, 0x6C, 0x55, 0x4C, -+0x00, 0x6D, 0x40, 0xEA, 0x68, 0xF3, 0x59, 0xA0, -+0x4D, 0xE9, 0x68, 0xF3, 0x39, 0xC0, 0x0B, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x9D, 0xA2, 0x03, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x68, 0xF3, 0x7D, 0xC2, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x24, 0x67, 0x6E, 0xF5, 0x58, 0x9A, 0x2F, 0xF7, -+0x94, 0xA3, 0xFF, 0x68, 0x0C, 0xE9, 0x40, 0xEA, -+0x01, 0x72, 0x00, 0xF1, 0x0D, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, -+0x94, 0xA3, 0x7F, 0x6A, 0x8C, 0xEA, 0x0C, 0xEA, -+0x00, 0xF1, 0x02, 0x22, 0x68, 0xF3, 0x75, 0xA3, -+0x0F, 0x6A, 0x6C, 0xEA, 0x01, 0x72, 0x69, 0x61, -+0x05, 0x59, 0x5A, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x28, 0x33, 0x94, 0xF4, 0x1C, 0x4A, 0x69, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF1, 0x50, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF1, -+0x74, 0x9B, 0x3F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF1, 0x58, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF1, -+0x7C, 0x9B, 0x2F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF1, 0x40, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF1, -+0x64, 0x9B, 0x1F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF1, 0x48, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF1, -+0x6C, 0x9B, 0x0F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF1, 0x50, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF1, -+0x74, 0x9B, 0x60, 0xA3, 0x88, 0xF3, 0x62, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x63, 0xA2, 0x02, 0x2B, 0x88, 0xF3, -+0x62, 0xA2, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x6B, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF1, -+0x98, 0x9B, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x00, 0x6A, 0x88, 0xF3, 0x45, 0xC0, -+0x88, 0xF3, 0x46, 0xC0, 0x60, 0xAC, 0xFF, 0xF7, -+0x1F, 0x6D, 0xAC, 0xEB, 0x01, 0x4B, 0xAC, 0xEB, -+0x60, 0xCC, 0x10, 0xF0, 0x24, 0x6B, 0x88, 0xF3, -+0x8A, 0xA0, 0x75, 0xF1, 0x68, 0x9B, 0x80, 0xC3, -+0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF1, 0x74, 0x9B, -+0x91, 0x67, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x58, 0x9A, 0x02, 0x6B, 0x60, 0xC2, -+0x68, 0xF3, 0x7D, 0xA0, 0x03, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x11, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, -+0x68, 0xF3, 0x5D, 0xC0, 0x00, 0x18, 0x8D, 0xCD, -+0x68, 0xF3, 0x79, 0xA0, 0x40, 0x6A, 0x6C, 0xEA, -+0x4E, 0x22, 0x68, 0xF3, 0x9A, 0xA0, 0x10, 0x6B, -+0xFF, 0x6D, 0x44, 0x67, 0x6C, 0xEA, 0xAC, 0xEA, -+0x1B, 0x2A, 0x88, 0xF3, 0x43, 0xA0, 0x88, 0xF3, -+0xA2, 0xA0, 0xAE, 0xEA, 0x40, 0x2A, 0x8D, 0xEB, -+0x68, 0xF3, 0x7A, 0xC0, 0x91, 0x67, 0x00, 0x18, -+0xE6, 0xE6, 0x91, 0x67, 0x00, 0x18, 0x17, 0xE6, -+0x91, 0x67, 0x00, 0x18, 0x4E, 0xE6, 0x91, 0x67, -+0x00, 0x18, 0x47, 0xE6, 0x88, 0xF3, 0x43, 0xA0, -+0xFF, 0x4A, 0x88, 0xF3, 0x43, 0xC0, 0x2B, 0x10, -+0x68, 0xF3, 0x75, 0xA0, 0x0F, 0x6A, 0x6C, 0xEA, -+0x01, 0x72, 0x25, 0x61, 0x88, 0xF3, 0x43, 0xA0, -+0x04, 0xD2, 0x04, 0x93, 0x88, 0xF3, 0x42, 0xA0, -+0x6E, 0xEA, 0x1D, 0x22, 0x91, 0x67, 0x00, 0x18, -+0xDB, 0xE6, 0x04, 0x95, 0xAE, 0xEA, 0x17, 0x22, -+0x68, 0xF3, 0x79, 0xA0, 0x20, 0x6A, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x10, 0x22, 0x68, 0xF3, -+0x7A, 0xA0, 0x11, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x68, 0xF3, 0x5A, 0xC0, 0x91, 0x67, 0x00, 0x18, -+0x3D, 0xE6, 0x91, 0x67, 0x00, 0x18, 0x28, 0xE6, -+0x91, 0x67, 0x00, 0x18, 0x21, 0xE6, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x99, 0xA2, 0x01, 0x6B, 0xE8, 0xF3, 0x62, 0xC2, -+0x20, 0x6B, 0x8D, 0xEB, 0x68, 0xF3, 0x79, 0xC2, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xED, 0x4C, 0xEC, 0xCC, 0xEA, -+0xA0, 0xF0, 0x1D, 0x25, 0x05, 0x5C, 0xA0, 0xF0, -+0x10, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x88, 0x34, -+0xB4, 0xF4, 0x10, 0x4B, 0x8D, 0xE3, 0x60, 0x9B, -+0x00, 0xEB, 0x02, 0x72, 0x0A, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF1, 0xBC, 0x9A, 0x01, 0x6C, -+0x00, 0x18, 0x70, 0xDC, 0x00, 0x6C, 0x08, 0x6D, -+0x1D, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, -+0xA0, 0x9A, 0x01, 0x6C, 0x00, 0x18, 0x70, 0xDC, -+0x00, 0x6C, 0x08, 0x6D, 0x00, 0x18, 0x70, 0xDC, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x54, 0x9A, -+0x01, 0x6C, 0x0C, 0x6D, 0x89, 0x10, 0x02, 0x72, -+0x0C, 0x60, 0x04, 0x6C, 0x0F, 0x6D, 0x00, 0x18, -+0x70, 0xDC, 0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, -+0xA0, 0x9A, 0x04, 0x6C, 0x00, 0x18, 0x70, 0xDC, -+0x7C, 0x10, 0x04, 0x6C, 0x03, 0x6D, 0x00, 0x18, -+0x70, 0xDC, 0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, -+0xA0, 0x9A, 0x04, 0x6C, 0x00, 0x18, 0x70, 0xDC, -+0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0x4E, 0xF2, 0x54, 0x9A, 0x02, 0x6C, 0xF5, 0xF1, -+0xA4, 0x9B, 0x66, 0x10, 0x02, 0x72, 0x0A, 0x60, -+0x04, 0x6C, 0xF0, 0x6D, 0x00, 0x18, 0x70, 0xDC, -+0x10, 0xF0, 0x24, 0x6A, 0x04, 0x6C, 0x95, 0xF1, -+0xA4, 0x9A, 0xDC, 0x17, 0x04, 0x6C, 0x30, 0x6D, -+0x00, 0x18, 0x70, 0xDC, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF1, 0xA4, 0x9A, 0x04, 0x6C, 0x00, 0x18, -+0x70, 0xDC, 0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0x4E, 0xF2, 0x54, 0x9A, 0x02, 0x6C, -+0xF5, 0xF1, 0xA8, 0x9B, 0x45, 0x10, 0x02, 0x72, -+0x0B, 0x60, 0x04, 0x6C, 0x01, 0xF7, 0x00, 0x6D, -+0x00, 0x18, 0x70, 0xDC, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x6C, 0x95, 0xF1, 0xA8, 0x9A, 0xBA, 0x17, -+0x04, 0x6C, 0x00, 0xF3, 0x00, 0x6D, 0x00, 0x18, -+0x70, 0xDC, 0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, -+0xA8, 0x9A, 0x04, 0x6C, 0x00, 0x18, 0x70, 0xDC, -+0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0x4E, 0xF2, 0x54, 0x9A, 0x02, 0x6C, 0xF5, 0xF1, -+0xAC, 0x9B, 0x22, 0x10, 0x02, 0x72, 0x0B, 0x60, -+0x04, 0x6C, 0x1E, 0xF0, 0x00, 0x6D, 0x00, 0x18, -+0x70, 0xDC, 0x10, 0xF0, 0x24, 0x6A, 0x04, 0x6C, -+0x95, 0xF1, 0xAC, 0x9A, 0x97, 0x17, 0x04, 0x6C, -+0x06, 0xF0, 0x00, 0x6D, 0x00, 0x18, 0x70, 0xDC, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, 0xAC, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0x70, 0xDC, 0x30, 0xF0, -+0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, 0x4E, 0xF2, -+0x54, 0x9A, 0x35, 0xF1, 0xB4, 0x9B, 0x02, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, -+0x70, 0x9A, 0xFF, 0x6C, 0x07, 0x6D, 0x40, 0xA3, -+0x8C, 0xEA, 0xAD, 0xEA, 0x65, 0x10, 0x05, 0x5C, -+0x5D, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, -+0xD4, 0xF4, 0x04, 0x4A, 0x89, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF1, -+0xBC, 0x9A, 0x01, 0x6C, 0x00, 0x18, 0xA1, 0xDC, -+0x00, 0x6C, 0x08, 0x6D, 0x00, 0x18, 0xA1, 0xDC, -+0x01, 0x6C, 0x0C, 0x6D, 0x45, 0x10, 0x04, 0x6C, -+0x0F, 0x6D, 0x00, 0x18, 0xA1, 0xDC, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF1, 0xA0, 0x9A, 0x04, 0x6C, -+0x00, 0x18, 0xA1, 0xDC, 0x10, 0xF0, 0x24, 0x6A, -+0x02, 0x6C, 0xF5, 0xF1, 0xA4, 0x9A, 0x34, 0x10, -+0x04, 0x6C, 0xF0, 0x6D, 0x00, 0x18, 0xA1, 0xDC, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, 0xA4, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0xA1, 0xDC, 0x10, 0xF0, -+0x24, 0x6A, 0x02, 0x6C, 0xF5, 0xF1, 0xA8, 0x9A, -+0x23, 0x10, 0x04, 0x6C, 0x01, 0xF7, 0x00, 0x6D, -+0x00, 0x18, 0xA1, 0xDC, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF1, 0xA8, 0x9A, 0x04, 0x6C, 0x00, 0x18, -+0xA1, 0xDC, 0x10, 0xF0, 0x24, 0x6A, 0x02, 0x6C, -+0xF5, 0xF1, 0xAC, 0x9A, 0x11, 0x10, 0x04, 0x6C, -+0x1E, 0xF0, 0x00, 0x6D, 0x00, 0x18, 0xA1, 0xDC, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, 0xAC, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0xA1, 0xDC, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF1, 0xB4, 0x9A, 0x02, 0x6C, -+0x00, 0x18, 0xF1, 0xDC, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF1, 0x70, 0x9A, 0xF8, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x54, 0xA0, -+0x7F, 0x6E, 0xFF, 0x69, 0x4C, 0xEE, 0x2C, 0xEC, -+0x01, 0x6D, 0x2C, 0xEE, 0x04, 0xD4, 0x00, 0x18, -+0x73, 0xCE, 0x88, 0xF3, 0x6A, 0xA8, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF1, 0x48, 0x9A, 0x2C, 0xEB, -+0x60, 0xC2, 0xC8, 0xF3, 0x99, 0xA0, 0x80, 0x6A, -+0x4B, 0xEA, 0x1F, 0x6B, 0x8C, 0xEA, 0x8C, 0xEB, -+0x2C, 0xEA, 0x2C, 0xEB, 0x11, 0x22, 0x6F, 0x32, -+0x2C, 0xEA, 0x82, 0x42, 0x01, 0x4A, 0xC8, 0xF3, -+0x5D, 0xC0, 0x07, 0x6A, 0x6C, 0xEA, 0x68, 0xF3, -+0x77, 0xA0, 0xC8, 0xF3, 0x9C, 0xC0, 0x76, 0x33, -+0x6C, 0x33, 0x6D, 0xEA, 0x2C, 0xEA, 0x06, 0x10, -+0x04, 0x6B, 0xC8, 0xF3, 0x7C, 0xC0, 0x03, 0x6B, -+0xC8, 0xF3, 0x7D, 0xC0, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF1, 0x70, 0x9B, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, -+0x58, 0x9A, 0x2F, 0xF7, 0x94, 0xA3, 0x40, 0xEA, -+0x01, 0x72, 0x19, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, -+0x21, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x68, 0xF3, 0x5C, 0xA2, 0x04, 0x6B, -+0x6C, 0xEA, 0x13, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x04, 0x96, 0x83, 0x67, -+0x01, 0x6D, 0x40, 0xEA, 0x0A, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x99, 0xA2, 0x20, 0x6B, 0x8D, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x25, 0x67, 0x04, 0xD4, 0x4C, 0xE9, 0x4A, 0x2C, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x74, 0xA0, 0x7F, 0x6E, 0x91, 0x67, -+0x6C, 0xEE, 0x4C, 0xEE, 0x00, 0x6D, 0x00, 0x18, -+0x73, 0xCE, 0x7D, 0x67, 0x87, 0x43, 0x09, 0x4C, -+0x10, 0xF0, 0x24, 0x6A, 0x60, 0xA4, 0x75, 0xF1, -+0x54, 0x9A, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x58, 0x9A, 0x02, 0x6B, 0x60, 0xDA, -+0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x6E, 0xF5, 0x58, 0x9A, 0x2F, 0xF7, 0x94, 0xA3, -+0x40, 0xEA, 0x10, 0x2A, 0x00, 0x18, 0x1E, 0xE7, -+0x91, 0x67, 0x00, 0x18, 0x40, 0xCC, 0x68, 0xF3, -+0x7A, 0xA0, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x03, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x68, 0xF3, -+0x5A, 0xC0, 0x08, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x0C, 0x6C, 0x01, 0x6D, -+0xD1, 0x67, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, -+0x05, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x08, 0x10, 0x04, 0x94, 0x01, 0x74, -+0x05, 0x61, 0x91, 0x67, 0x00, 0x18, 0x0B, 0xCF, -+0x80, 0x18, 0x3D, 0x0C, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x69, 0x2C, 0xED, 0x30, 0xF0, 0x20, 0x68, -+0x0A, 0xD4, 0xC0, 0xF1, 0x08, 0x48, 0x85, 0x67, -+0x04, 0xD5, 0x00, 0x18, 0xC0, 0xCB, 0x68, 0xF3, -+0x94, 0xA0, 0x7F, 0x6A, 0x04, 0x95, 0x4C, 0xEC, -+0x2C, 0xEC, 0x00, 0x18, 0x45, 0xCF, 0x68, 0xF3, -+0x54, 0xA0, 0x7F, 0x6B, 0x6C, 0xEA, 0x2C, 0xEA, -+0x18, 0x22, 0x0A, 0x93, 0x0F, 0x6C, 0x41, 0xA3, -+0xA2, 0xA3, 0x4C, 0xEC, 0x2C, 0xEC, 0x00, 0x18, -+0xA5, 0xC9, 0x28, 0xF1, 0x54, 0xA0, 0x03, 0x72, -+0x0C, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, -+0x74, 0x9A, 0x40, 0xA3, 0x4C, 0xE9, 0x02, 0x6A, -+0x2C, 0xEA, 0x03, 0x22, 0xFD, 0x6A, 0x2C, 0xEA, -+0x40, 0xC3, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFF, 0x6A, 0x4C, 0xEC, -+0xAC, 0xEA, 0x0B, 0x2A, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF1, 0xB8, 0x9B, 0x10, 0xF0, 0x24, 0x6E, -+0xF5, 0xF1, 0xDC, 0x9E, 0x60, 0x9D, 0xCC, 0xEB, -+0x0C, 0x10, 0x01, 0x72, 0x0B, 0x61, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF1, 0xB8, 0x9B, 0x10, 0xF0, -+0x24, 0x6E, 0x15, 0xF2, 0xC0, 0x9E, 0x60, 0x9D, -+0xCD, 0xEB, 0x60, 0xDD, 0x05, 0x5C, 0x60, 0xF1, -+0x06, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x88, 0x34, -+0xF4, 0xF4, 0x04, 0x4B, 0x8D, 0xE3, 0x60, 0x9B, -+0x00, 0xEB, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF1, 0x78, 0x9A, 0x0D, 0x11, 0x01, 0x72, -+0x10, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, -+0x78, 0x9A, 0xFF, 0x6C, 0x40, 0x6D, 0x40, 0xA3, -+0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, -+0x40, 0xA3, 0x80, 0x4D, 0xC0, 0x4D, 0x8C, 0xEA, -+0x14, 0x10, 0x02, 0x72, 0x07, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF1, 0x78, 0x9A, 0xBF, 0x6A, -+0x80, 0xA3, 0xF4, 0x10, 0x03, 0x72, 0x20, 0xF1, -+0x1A, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, -+0x78, 0x9A, 0xFF, 0x6C, 0x40, 0x6D, 0x40, 0xA3, -+0x8C, 0xEA, 0xAD, 0xEA, 0xE7, 0x10, 0x07, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, 0x64, 0x9A, -+0xFD, 0x6A, 0x80, 0xA3, 0xDF, 0x10, 0x01, 0x72, -+0x19, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, -+0x98, 0x9A, 0xFF, 0x6A, 0x40, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF2, 0x84, 0x9B, -+0x01, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x60, 0xA4, 0x02, 0x6D, -+0x4C, 0xEB, 0xE1, 0x10, 0x02, 0x72, 0x0F, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, 0x78, 0x9A, -+0xBF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, 0x64, 0x9A, -+0xFE, 0x6A, 0x80, 0xA3, 0xB3, 0x10, 0x03, 0x72, -+0xE0, 0xF0, 0x19, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF1, 0x98, 0x9A, 0xFF, 0x6B, 0x40, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, -+0x84, 0x9A, 0x01, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0x92, 0x10, 0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF2, 0x64, 0x9A, 0xF7, 0x6A, 0x80, 0xA3, -+0x95, 0x10, 0x01, 0x72, 0x19, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF1, 0x98, 0x9A, 0xFF, 0x6A, -+0x40, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF2, 0x84, 0x9B, 0x04, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x60, 0xA4, 0x08, 0x6D, 0x4C, 0xEB, 0x97, 0x10, -+0x02, 0x72, 0x0F, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF1, 0x78, 0x9A, 0xBF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF2, 0x64, 0x9A, 0xFB, 0x6A, 0x80, 0xA3, -+0x69, 0x10, 0x03, 0x72, 0xA0, 0xF0, 0x0F, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, 0x98, 0x9A, -+0xFF, 0x6B, 0x40, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF2, 0x84, 0x9A, 0x04, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0x48, 0x10, 0x07, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, 0x64, 0x9A, -+0xDF, 0x6A, 0x80, 0xA3, 0x4B, 0x10, 0x01, 0x72, -+0x19, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, -+0x98, 0x9A, 0xFF, 0x6A, 0x40, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF2, 0x84, 0x9B, -+0x10, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x60, 0xA4, 0x20, 0x6D, -+0x4C, 0xEB, 0x4D, 0x10, 0x02, 0x72, 0x0F, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, 0x78, 0x9A, -+0xBF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, 0x64, 0x9A, -+0xEF, 0x6A, 0x80, 0xA3, 0x1F, 0x10, 0x03, 0x72, -+0x66, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, -+0x98, 0x9A, 0xFF, 0x6B, 0x40, 0x6D, 0x40, 0xA4, -+0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, 0x84, 0x9A, -+0x10, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x20, 0xE8, 0x09, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, 0x64, 0x9A, -+0x80, 0xA3, 0x7F, 0x6A, 0x8C, 0xEA, 0x40, 0xC3, -+0x20, 0xE8, 0x01, 0x72, 0x1C, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF1, 0x98, 0x9A, 0xFF, 0x6A, -+0x40, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF2, 0x84, 0x9B, 0x60, 0xA4, 0x4C, 0xEB, -+0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, 0x60, 0xA4, -+0x80, 0x4D, 0xC0, 0x4D, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x20, 0xE8, 0x02, 0x72, -+0x10, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF1, -+0x58, 0x9A, 0xBF, 0x6B, 0x80, 0xA2, 0x6C, 0xEC, -+0x80, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, -+0x44, 0x9A, 0x80, 0xA2, 0x8C, 0xEB, 0x60, 0xC2, -+0x20, 0xE8, 0x03, 0x72, 0x14, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF1, 0x98, 0x9A, 0xFF, 0x6B, -+0x40, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF2, 0x84, 0x9A, 0x40, 0xA4, 0x6C, 0xEA, -+0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, 0x20, 0xE8, -+0xFF, 0x63, 0x01, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF2, 0x68, 0x9B, 0xFF, 0x6A, 0x4C, 0xEC, -+0x6D, 0xE5, 0x00, 0xA3, 0x3F, 0x6F, 0x01, 0x74, -+0x0C, 0xEF, 0x4C, 0xEE, 0xE0, 0xC3, 0x10, 0x61, -+0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF2, 0xEC, 0x9C, -+0x10, 0x68, 0xFD, 0xE5, 0x80, 0xA7, 0x4C, 0xEC, -+0x0D, 0xEC, 0x4C, 0xEC, 0x80, 0xC7, 0x80, 0xA3, -+0x80, 0x6F, 0xEB, 0xEF, 0x4C, 0xEC, 0x0D, 0x10, -+0x0F, 0x2C, 0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF2, -+0xEC, 0x9C, 0xEF, 0x6C, 0xFD, 0xE5, 0x00, 0xA7, -+0x0C, 0xEC, 0x80, 0xC7, 0x80, 0xA3, 0x40, 0x6F, -+0x4C, 0xEC, 0xED, 0xEC, 0x4C, 0xEC, 0x80, 0xC3, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, 0x50, 0x9A, -+0x80, 0xF4, 0xC0, 0x36, 0x55, 0xE5, 0x40, 0x9D, -+0x4D, 0xEE, 0xC0, 0xDD, 0x01, 0x90, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, 0x54, 0x9A, -+0xFF, 0x6B, 0x40, 0xA2, 0x6C, 0xEA, 0x52, 0x32, -+0x6C, 0xEA, 0x11, 0x2A, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x5C, 0x9A, -+0xA8, 0xF4, 0x86, 0xA3, 0x00, 0x6D, 0x18, 0x6E, -+0xE5, 0x67, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF2, 0x5C, 0x9A, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x64, 0x67, 0x4C, 0xEB, -+0x85, 0x67, 0x02, 0x5B, 0x4C, 0xEC, 0x43, 0x60, -+0x10, 0xF0, 0x24, 0x6D, 0x15, 0xF2, 0xB8, 0x9D, -+0xFF, 0xF7, 0x1F, 0x6E, 0x30, 0xF0, 0x20, 0x68, -+0xE0, 0xAD, 0x10, 0xF0, 0x24, 0x6D, 0x15, 0xF2, -+0xBC, 0x9D, 0xCC, 0xEF, 0xC0, 0xF1, 0x08, 0x48, -+0xA0, 0xAD, 0xAC, 0xEE, 0xD7, 0xE7, 0xC8, 0xF2, -+0xDF, 0xA0, 0x4C, 0xED, 0xCE, 0xED, 0x2B, 0x2D, -+0x68, 0xF3, 0x5C, 0xA0, 0x0E, 0x72, 0x0F, 0x61, -+0x26, 0x2B, 0x68, 0xF3, 0x7A, 0xA0, 0x03, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, -+0x00, 0x18, 0x93, 0xCF, 0x01, 0x6C, 0x0C, 0x6D, -+0x00, 0x18, 0x73, 0xC9, 0x10, 0x10, 0x06, 0x72, -+0x16, 0x61, 0x15, 0x23, 0x68, 0xF3, 0x7A, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x01, 0x6D, -+0x68, 0xF3, 0x5A, 0xC0, 0x00, 0x18, 0x93, 0xCF, -+0x04, 0x6A, 0x68, 0xF3, 0x5C, 0xC0, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, -+0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF2, 0x54, 0x9A, -+0xFF, 0x6B, 0x80, 0xA2, 0x00, 0xF6, 0x80, 0x34, -+0x00, 0xF6, 0x83, 0x34, 0x00, 0x54, 0x24, 0x60, -+0xA0, 0xA2, 0x7F, 0x6C, 0xAC, 0xEC, 0x80, 0xC2, -+0x80, 0xA2, 0x40, 0x6D, 0x6C, 0xEC, 0xAD, 0xEC, -+0x6C, 0xEC, 0x80, 0xC2, 0x80, 0xA2, 0x10, 0xF0, -+0x24, 0x6C, 0x55, 0xF1, 0x80, 0x9C, 0x3F, 0x6D, -+0x80, 0xA4, 0x10, 0xF0, 0x24, 0x6C, 0x55, 0xF1, -+0x84, 0x9C, 0x80, 0xA4, 0x10, 0xF0, 0x24, 0x6C, -+0x95, 0xF2, 0x98, 0x9C, 0x80, 0xA4, 0x80, 0xA2, -+0x6C, 0xEC, 0xAD, 0xEC, 0x6C, 0xEC, 0x80, 0xC2, -+0x80, 0xA2, 0xBF, 0x6B, 0x8C, 0xEB, 0x60, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0x95, 0xF2, 0x7C, 0x9B, 0xFF, 0x6A, 0x4C, 0xEC, -+0xC0, 0xA3, 0x4C, 0xED, 0x0C, 0x26, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xB5, 0xF2, 0x80, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x20, 0xE8, 0x80, 0xC3, -+0x0B, 0x25, 0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF2, -+0x84, 0x9B, 0x80, 0x6D, 0xAB, 0xED, 0x60, 0xA4, -+0x4C, 0xEB, 0xAE, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x20, 0xE8, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0xF7, 0x1F, 0x6A, -+0x0E, 0x90, 0x24, 0x67, 0x4C, 0xE9, 0x03, 0x6B, -+0x4C, 0xEF, 0x2C, 0xEB, 0x00, 0x6A, 0x0B, 0xD5, -+0x0C, 0xD6, 0x04, 0xD7, 0x40, 0xC8, 0x00, 0x6A, -+0x0A, 0x23, 0x28, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, -+0x40, 0xA8, 0x01, 0x4A, 0x40, 0xC8, 0x1F, 0xF7, -+0x00, 0x6A, 0x2C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x40, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x44, 0x9A, 0x49, 0xE1, -+0x0B, 0x93, 0x40, 0x9A, 0x6C, 0xEA, 0x0C, 0x93, -+0x6E, 0xEA, 0x04, 0x22, 0x40, 0xA8, 0x04, 0x93, -+0x63, 0xEA, 0xDC, 0x61, 0x40, 0xA8, 0x04, 0x93, -+0x63, 0xEA, 0x58, 0x67, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF2, 0x68, 0x9B, -+0xFF, 0x6A, 0xCC, 0xEA, 0x6D, 0xEA, 0xE0, 0xF1, -+0x1F, 0x6B, 0xAC, 0xEB, 0x10, 0xF0, 0x24, 0x6C, -+0xB5, 0xF2, 0x8C, 0x9C, 0x60, 0x33, 0x60, 0x33, -+0x6D, 0xEA, 0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF1, 0x50, 0x9A, 0x6D, 0xEA, 0x40, 0xDC, -+0x20, 0xE8, 0x00, 0x65, 0xE0, 0xF1, 0x1F, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF1, 0x70, 0x9B, -+0xAC, 0xEA, 0x40, 0x32, 0x40, 0x32, 0x6D, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF2, 0x6C, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF2, -+0x50, 0x9A, 0xFF, 0x6B, 0x40, 0xA2, 0x6C, 0xEA, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x01, 0x68, 0x04, 0xEC, -+0x04, 0xF7, 0x10, 0x69, 0x13, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x01, 0x6C, -+0xFF, 0x49, 0x40, 0xEA, 0x0B, 0x29, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, 0x08, 0xF0, -+0x00, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x00, 0x6A, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF2, 0x54, 0x9A, 0x60, 0xAA, 0xFF, 0xF7, -+0x1F, 0x6A, 0x6C, 0xEA, 0x0C, 0xEA, 0xE3, 0x2A, -+0x01, 0x6A, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x0E, 0x92, 0x04, 0x67, -+0x0F, 0x91, 0x04, 0xD2, 0x04, 0x93, 0xFF, 0x6A, -+0x4C, 0xE8, 0x4C, 0xEB, 0x90, 0x67, 0x0B, 0xD5, -+0x0C, 0xD6, 0x0D, 0xD7, 0x04, 0xD3, 0x4C, 0xE9, -+0x00, 0x18, 0x13, 0xD1, 0x80, 0xF0, 0x07, 0x22, -+0x06, 0x58, 0x80, 0xF0, 0x04, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x08, 0x30, 0xF4, 0xF4, 0x18, 0x4A, -+0x09, 0xE2, 0x40, 0x9A, 0x00, 0xEA, 0x02, 0xF2, -+0x10, 0x6A, 0x0E, 0x10, 0x02, 0xF2, 0x00, 0x6A, -+0x0B, 0x10, 0x22, 0xF2, 0x00, 0x6A, 0x08, 0x10, -+0x22, 0xF2, 0x10, 0x6A, 0x05, 0x10, 0x42, 0xF2, -+0x00, 0x6A, 0x02, 0x10, 0x42, 0xF2, 0x10, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0x0D, 0x94, 0x75, 0xF2, -+0x7C, 0x9B, 0x8C, 0xEB, 0x10, 0xF0, 0x24, 0x6C, -+0xB5, 0xF2, 0x98, 0x9C, 0x8D, 0xEB, 0x06, 0x21, -+0x10, 0xF0, 0x24, 0x6C, 0xB5, 0xF2, 0x9C, 0x9C, -+0x6D, 0xEC, 0x05, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0xD5, 0xF2, 0x80, 0x9C, 0x6C, 0xEC, 0x04, 0x96, -+0x06, 0x26, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF1, -+0x70, 0x9B, 0x8D, 0xEB, 0x05, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF2, 0x64, 0x9B, 0x8C, 0xEB, -+0x1F, 0xF7, 0x00, 0x6C, 0x4C, 0xEC, 0x02, 0xF0, -+0x00, 0x74, 0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, -+0x24, 0x6C, 0x15, 0xF1, 0xA0, 0x9C, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF1, 0xA4, 0x9C, -+0x10, 0xF0, 0x24, 0x6C, 0x0B, 0x96, 0xD5, 0xF2, -+0x88, 0x9C, 0xB5, 0xE2, 0xCC, 0xEC, 0x80, 0xDD, -+0x84, 0x42, 0x1F, 0xF7, 0x00, 0x6D, 0xAC, 0xEC, -+0x02, 0xF0, 0x00, 0x74, 0x01, 0x60, 0x05, 0x2C, -+0x10, 0xF0, 0x24, 0x6C, 0xD5, 0xF2, 0xAC, 0x9C, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6C, 0xD5, 0xF2, -+0xB0, 0x9C, 0x10, 0xF0, 0x24, 0x6C, 0x0C, 0x96, -+0xD5, 0xF2, 0x88, 0x9C, 0xB5, 0xE2, 0xCC, 0xEC, -+0x80, 0xDD, 0x87, 0x42, 0x01, 0x4C, 0x1F, 0xF7, -+0x00, 0x6D, 0xAC, 0xEC, 0x02, 0xF0, 0x00, 0x74, -+0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, 0x24, 0x6C, -+0xD5, 0xF2, 0x94, 0x9C, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6C, 0xD5, 0xF2, 0x98, 0x9C, 0x89, 0xE2, -+0x60, 0xDA, 0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x04, 0xF7, 0x10, 0x68, 0x13, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x05, 0x6C, 0xFF, 0x48, 0x40, 0xEA, 0x0B, 0x28, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, -+0x08, 0xF0, 0x00, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x00, 0x6A, 0x09, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xB5, 0xF2, 0x54, 0x9A, 0x60, 0xAA, -+0x3F, 0x6A, 0x6C, 0xEA, 0xE5, 0x2A, 0x01, 0x6A, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF2, 0x54, 0x9A, -+0x40, 0xAA, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF2, 0x54, 0x9A, 0x40, 0xAA, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x6A, 0x10, 0xF0, -+0x24, 0x6C, 0xD5, 0xF0, 0x90, 0x9C, 0x10, 0xF0, -+0x23, 0x6B, 0x48, 0xF6, 0x11, 0x4B, 0x0A, 0x72, -+0x60, 0xDC, 0x0C, 0x61, 0x30, 0xF0, 0x21, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF7, 0x54, 0x9A, -+0xB0, 0xF4, 0x8C, 0x9B, 0x01, 0x6D, 0xAB, 0xED, -+0x40, 0xEA, 0x00, 0x6A, 0x10, 0xF0, 0x24, 0x6C, -+0xFF, 0x6B, 0x01, 0x4A, 0xD5, 0xF0, 0x90, 0x9C, -+0x6C, 0xEA, 0x10, 0xF0, 0x23, 0x6B, 0x48, 0xF6, -+0x12, 0x4B, 0x60, 0xDC, 0xDC, 0x17, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x00, 0x6A, 0x04, 0xD2, 0x04, 0x92, 0x01, 0x72, -+0x58, 0x67, 0x04, 0xD2, 0x10, 0xF0, 0x23, 0x6A, -+0x78, 0x67, 0xA8, 0xF6, 0x01, 0x4A, 0x69, 0xE2, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, -+0x40, 0xDB, 0x00, 0x1C, 0x96, 0x45, 0x00, 0x18, -+0xAE, 0xD0, 0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, -+0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, 0x02, 0x6B, -+0x8C, 0xEB, 0x09, 0x23, 0x03, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x00, 0x18, -+0x0E, 0xDA, 0x00, 0x18, 0x70, 0xDA, 0x00, 0x1C, -+0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x8C, 0x9A, 0x04, 0x6B, 0x8C, 0xEB, 0x09, 0x23, -+0x05, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x00, 0x18, 0xB0, 0xD6, 0x00, 0x18, -+0x1E, 0xD6, 0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, -+0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0x94, 0xA2, 0x7F, 0x6B, -+0x8C, 0xEB, 0x0D, 0x23, 0x68, 0xF3, 0x98, 0xA2, -+0x68, 0xF3, 0x7C, 0xA2, 0x8E, 0xEB, 0x07, 0x23, -+0x68, 0xF3, 0x97, 0xA2, 0xFF, 0x6A, 0x96, 0x34, -+0x4C, 0xEC, 0x00, 0x18, 0x1D, 0xCA, 0x30, 0xF0, -+0x20, 0x6A, 0x40, 0xF2, 0x54, 0x9A, 0x02, 0x2A, -+0x00, 0x18, 0xEC, 0xCB, 0x00, 0x1C, 0x95, 0x45, -+0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, -+0x10, 0x6B, 0x8C, 0xEB, 0x0C, 0x23, 0x11, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, 0x5A, 0xA2, -+0x02, 0x2A, 0x80, 0x18, 0xF5, 0x17, 0x00, 0x1C, -+0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x8C, 0x9A, 0x04, 0xF0, 0x00, 0x6B, 0x8C, 0xEB, -+0x08, 0x23, 0x04, 0xF0, 0x01, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x00, 0x18, -+0x9D, 0xC4, 0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, -+0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, 0x02, 0xF0, -+0x00, 0x6B, 0x8C, 0xEB, 0x08, 0x23, 0x02, 0xF0, -+0x01, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x00, 0x18, 0x5C, 0xE4, 0x00, 0x1C, -+0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, -+0x24, 0x6B, 0x95, 0xF1, 0x64, 0x9B, 0x80, 0xF0, -+0x8C, 0x9A, 0x8C, 0xEB, 0x20, 0x23, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF2, 0x64, 0x9B, 0x8C, 0xEB, -+0x68, 0xF3, 0x94, 0xA2, 0x80, 0xF0, 0x6C, 0xDA, -+0x7F, 0x6B, 0x8C, 0xEB, 0x07, 0x2B, 0x68, 0xF3, -+0x5C, 0xA2, 0x0C, 0x72, 0x03, 0x61, 0x00, 0x18, -+0x2C, 0xD8, 0x0D, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6C, -+0x80, 0xF0, 0x6C, 0x9A, 0x95, 0xF1, 0x84, 0x9C, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x00, 0x1C, -+0x95, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0xCC, 0xF1, -+0x53, 0xA2, 0x0F, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF2, 0x48, 0x9A, 0x01, 0x6B, 0x80, 0xA2, -+0x8C, 0xEB, 0x07, 0x23, 0x80, 0xA2, 0xFE, 0x6B, -+0x8C, 0xEB, 0x60, 0xC2, 0x03, 0x6C, 0x00, 0x18, -+0x47, 0xDB, 0x30, 0xF0, 0x20, 0x69, 0x2F, 0xF5, -+0x18, 0x49, 0x00, 0xF2, 0x03, 0xA1, 0x01, 0x6A, -+0x4E, 0xE8, 0x05, 0x28, 0x0B, 0x6C, 0x00, 0x18, -+0x47, 0xDB, 0x00, 0xF2, 0x03, 0xC1, 0x30, 0xF0, -+0x21, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0xB0, 0xF4, -+0x8C, 0x9B, 0xEE, 0xF7, 0x58, 0x9A, 0x40, 0xEA, -+0xFD, 0x16, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF2, 0x6C, 0x9A, 0xDF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF2, 0xAC, 0x9B, -+0xFF, 0x6A, 0x20, 0x6E, 0x60, 0xA5, 0x4C, 0xEC, -+0x4C, 0xEB, 0xCD, 0xEB, 0x4C, 0xEB, 0x07, 0xF7, -+0x01, 0x4A, 0x4D, 0xEC, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF2, 0x50, 0x9A, 0x60, 0xC5, 0x80, 0xCA, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF2, 0x50, 0x9A, 0x68, 0xF0, 0x04, 0x6B, -+0x60, 0xCA, 0x20, 0xE8, 0x03, 0x6F, 0x8C, 0xEF, -+0x64, 0x67, 0x46, 0x67, 0x04, 0x27, 0x07, 0x10, -+0xA0, 0xDB, 0xFC, 0x4A, 0x04, 0x4B, 0x04, 0x5A, -+0xFB, 0x60, 0x03, 0x6A, 0x4C, 0xEE, 0x04, 0x26, -+0xA0, 0xC4, 0xFF, 0x4E, 0x01, 0x4C, 0xFB, 0x17, -+0x00, 0x6A, 0x20, 0xE8, 0xFF, 0x6A, 0xAC, 0xEA, -+0x03, 0x10, 0x40, 0xC4, 0xFF, 0x4E, 0x01, 0x4C, -+0xFC, 0x2E, 0x00, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0x00, 0x6A, 0x07, 0x26, 0x5D, 0xE5, 0xE0, 0xA7, -+0x4D, 0xE4, 0xFF, 0x4E, 0xE0, 0xC3, 0x01, 0x4A, -+0xF8, 0x17, 0x00, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0x09, 0x10, 0x60, 0xA4, 0x40, 0xA5, 0xFF, 0x4E, -+0x4A, 0xEB, 0x02, 0x60, 0x4B, 0xE3, 0x20, 0xE8, -+0x01, 0x4C, 0x01, 0x4D, 0xF6, 0x2E, 0x00, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0x06, 0x2C, 0x64, 0x6B, -+0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, 0x7C, 0xDA, -+0x04, 0x10, 0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, -+0x9C, 0xDA, 0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, -+0x5C, 0x9A, 0x28, 0x72, 0x2D, 0x60, 0x29, 0x5A, -+0x07, 0x60, 0x14, 0x72, 0x19, 0x60, 0x19, 0x72, -+0x1F, 0x60, 0x0A, 0x72, 0x0D, 0x60, 0x20, 0xE8, -+0x50, 0x72, 0x32, 0x60, 0x51, 0x5A, 0x03, 0x60, -+0x32, 0x72, 0x26, 0x60, 0x20, 0xE8, 0x64, 0x72, -+0x33, 0x60, 0xC8, 0x72, 0x39, 0x60, 0x20, 0xE8, -+0x02, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x60, 0xDA, 0xE0, 0xF7, 0x1E, 0x4B, 0x39, 0x10, -+0x03, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x60, 0xDA, 0xE1, 0xF3, 0x1D, 0x4B, 0x31, 0x10, -+0x09, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x60, 0xDA, 0xE4, 0xF3, 0x17, 0x4B, 0x29, 0x10, -+0x05, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x60, 0xDA, 0xE2, 0xF3, 0x1B, 0x4B, 0x21, 0x10, -+0x11, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x60, 0xDA, 0xE8, 0xF3, 0x0F, 0x4B, 0x19, 0x10, -+0x0A, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x60, 0xDA, 0xE4, 0xF7, 0x16, 0x4B, 0x11, 0x10, -+0x22, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x60, 0xDA, 0x11, 0xF0, 0x00, 0x6B, 0x09, 0x10, -+0x43, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x60, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF2, -+0x74, 0x9A, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x64, 0xDA, 0x20, 0xE8, 0x30, 0xF0, 0x21, 0x6A, -+0x70, 0xF3, 0x5C, 0x9A, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x63, 0x0C, 0x24, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF3, 0x44, 0x9A, 0x58, 0xEC, 0x12, 0xEC, -+0x00, 0xD4, 0x00, 0x92, 0xFF, 0x4A, 0x00, 0xD2, -+0x00, 0x92, 0xFB, 0x2A, 0x01, 0x63, 0x20, 0xE8, -+0xFF, 0x63, 0x0D, 0x24, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF3, 0x40, 0x9A, 0x58, 0xEC, 0x12, 0xEC, -+0x00, 0xD4, 0x00, 0x92, 0x04, 0x22, 0x00, 0x92, -+0xFF, 0x4A, 0x00, 0xD2, 0xFA, 0x17, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x56, 0xD2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xED, 0x00, 0x18, 0x4B, 0xD2, -+0x05, 0x97, 0x00, 0x6A, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x6A, -+0x04, 0x67, 0x4C, 0xEE, 0x00, 0x18, 0x50, 0xD2, -+0x50, 0x67, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0x05, 0xD2, 0x05, 0x93, 0xFF, 0x68, 0x8C, 0xE8, -+0xD0, 0xF7, 0x45, 0x40, 0xC0, 0xF1, 0x08, 0x4B, -+0x4C, 0x32, 0x69, 0xE2, 0x4A, 0xA2, 0x01, 0x6C, -+0x30, 0xF0, 0x20, 0x69, 0x8C, 0xEA, 0x04, 0xD2, -+0x0C, 0x32, 0x69, 0xE2, 0xA7, 0xF6, 0xD3, 0xA2, -+0x2F, 0xF5, 0x18, 0x49, 0x29, 0xE0, 0x8C, 0xEE, -+0xD0, 0x36, 0x07, 0xD6, 0x20, 0xF6, 0xC4, 0xA2, -+0x03, 0x6A, 0x05, 0xD3, 0x4C, 0xEE, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x70, 0x9A, 0xC0, 0x36, -+0x10, 0xF0, 0x24, 0x6A, 0x06, 0xD6, 0xF5, 0xF2, -+0xD8, 0x9A, 0x01, 0x6D, 0xE3, 0xF2, 0x1F, 0x4C, -+0xAB, 0xED, 0x40, 0xEB, 0x06, 0x93, 0x07, 0x96, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x50, 0x9C, -+0x6D, 0xEE, 0x04, 0x93, 0xE3, 0xF3, 0x10, 0x6C, -+0xFF, 0xF7, 0x1F, 0x6D, 0x6D, 0xEE, 0x40, 0xEA, -+0x05, 0x94, 0x00, 0xF3, 0x48, 0x40, 0x10, 0x30, -+0x01, 0xE4, 0x08, 0xF1, 0xD0, 0x98, 0x44, 0x32, -+0x29, 0xE2, 0x63, 0xAA, 0x30, 0xF0, 0x20, 0x6C, -+0x04, 0xD2, 0xC0, 0x36, 0xCE, 0xF4, 0x50, 0x9C, -+0xC0, 0x36, 0x01, 0x6D, 0x6D, 0xEE, 0xE3, 0xF3, -+0x08, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x04, 0x93, -+0x43, 0xAB, 0x01, 0x72, 0x04, 0x61, 0x01, 0x6C, -+0x20, 0xF6, 0x87, 0xC1, 0x03, 0x10, 0x00, 0x6A, -+0x20, 0xF6, 0x47, 0xC1, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x04, 0xD2, 0x00, 0x69, -+0x30, 0xF0, 0x20, 0x68, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF2, 0xD8, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0x23, 0xF3, 0x0C, 0x6C, 0xAB, 0xED, 0x07, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF1, -+0x10, 0x4B, 0xC0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x23, 0xF3, 0x18, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF1, -+0x10, 0x4B, 0xC0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x23, 0xF3, 0x1C, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0xC3, 0xF3, 0x0C, 0x6C, 0xAB, 0xED, 0x00, 0x6E, -+0x40, 0xEA, 0xFF, 0x6A, 0x2C, 0xEA, 0x08, 0x2A, -+0xCE, 0xF4, 0x50, 0x98, 0x03, 0xF3, 0x0C, 0x6C, -+0x06, 0xF0, 0x00, 0x6D, 0x03, 0x6E, 0x07, 0x10, -+0xCE, 0xF4, 0x50, 0x98, 0x03, 0xF3, 0x0C, 0x6C, -+0x06, 0xF0, 0x00, 0x6D, 0x01, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x15, 0xF3, 0xA4, 0x9B, 0xCE, 0xF4, 0x50, 0x9A, -+0xC3, 0xF3, 0x14, 0x6C, 0x10, 0x6E, 0x40, 0xEA, -+0x04, 0x95, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF3, -+0x48, 0x9A, 0xAC, 0x34, 0x91, 0xE1, 0x30, 0xF0, -+0x20, 0x6B, 0x90, 0x35, 0xC0, 0xF1, 0x08, 0x4B, -+0x90, 0x34, 0xB5, 0xE3, 0x8D, 0xE3, 0x46, 0xE9, -+0xE7, 0xF6, 0x0C, 0x4D, 0xE7, 0xF7, 0x0C, 0x4B, -+0x08, 0xD5, 0x07, 0xD3, 0xA3, 0x42, 0x61, 0x42, -+0x23, 0x4A, 0x05, 0xD5, 0x06, 0xD3, 0x09, 0xD2, -+0x08, 0x94, 0x05, 0x93, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xAC, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0xC0, 0x36, 0xC4, 0x36, 0xD9, 0xE3, 0xC3, 0xF3, -+0x18, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x07, 0x94, -+0x06, 0x93, 0xCE, 0xF4, 0x50, 0x98, 0xC0, 0xAC, -+0x01, 0x6D, 0xC3, 0xF3, 0x18, 0x6C, 0xC0, 0x36, -+0xC4, 0x36, 0xAB, 0xED, 0xD9, 0xE3, 0x40, 0xEA, -+0x08, 0x94, 0x05, 0x95, 0x07, 0x92, 0x02, 0x4C, -+0x06, 0x93, 0x08, 0xD4, 0x09, 0x94, 0x04, 0x4D, -+0x02, 0x4A, 0x04, 0x4B, 0x8A, 0xED, 0x05, 0xD5, -+0x07, 0xD2, 0x06, 0xD3, 0xD5, 0x61, 0xFF, 0x6A, -+0x2C, 0xEA, 0x10, 0x2A, 0x04, 0x93, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC0, 0xF7, -+0x15, 0x4B, 0x6C, 0x33, 0x49, 0xE3, 0xCA, 0xA2, -+0x81, 0xF4, 0x14, 0x6C, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x0F, 0x10, 0x04, 0x95, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xAC, 0x33, -+0x49, 0xE3, 0xA7, 0xF6, 0xD3, 0xA2, 0xCE, 0xF4, -+0x50, 0x98, 0x81, 0xF4, 0x14, 0x6C, 0x00, 0xF4, -+0x00, 0x6D, 0xCF, 0xEE, 0x01, 0x49, 0x40, 0xEA, -+0x02, 0x71, 0x3F, 0xF7, 0x1D, 0x61, 0x30, 0xF0, -+0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0xC3, 0xF3, 0x18, 0x6C, 0xAB, 0xED, 0x00, 0x6E, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0x03, 0xF3, -+0x0C, 0x6C, 0x06, 0xF0, 0x00, 0x6D, 0x00, 0x6E, -+0x40, 0xEA, 0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, -+0x07, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x30, 0xF0, -+0x20, 0x68, 0x10, 0xF0, 0x24, 0x6B, 0x4C, 0xEC, -+0x4C, 0xED, 0x95, 0xF1, 0x00, 0x4B, 0x00, 0x6A, -+0xC0, 0xF1, 0x08, 0x48, 0x30, 0xF0, 0x20, 0x69, -+0x05, 0xD5, 0x28, 0xF1, 0x4D, 0xC0, 0xA0, 0x9B, -+0xCE, 0xF4, 0x50, 0x99, 0x04, 0xD4, 0x00, 0x6E, -+0xE3, 0xF3, 0x10, 0x6C, 0x40, 0xEA, 0x04, 0x92, -+0x06, 0x22, 0x00, 0x6A, 0xE7, 0xF6, 0x44, 0xD8, -+0xE7, 0xF6, 0x48, 0xD8, 0x51, 0x10, 0x28, 0xF1, -+0x4C, 0xA0, 0x4E, 0x22, 0x87, 0xF6, 0x70, 0x98, -+0xE7, 0xF6, 0x44, 0x98, 0x4E, 0xEB, 0x04, 0xD3, -+0x1F, 0x2B, 0x05, 0x95, 0x00, 0x6C, 0x00, 0x18, -+0xEC, 0xD2, 0x00, 0x6C, 0x00, 0x18, 0xB7, 0xD2, -+0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF1, 0x00, 0x4B, -+0xCE, 0xF4, 0x50, 0x99, 0xA0, 0x9B, 0xE3, 0xF3, -+0x10, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x21, 0x6A, 0x50, 0xF3, 0x5F, 0xA2, 0x05, 0x22, -+0x5D, 0x67, 0x67, 0x42, 0x09, 0x4B, 0x40, 0xA3, -+0x01, 0x10, 0x01, 0x6A, 0x28, 0xF1, 0x4D, 0xC0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x87, 0xF6, 0x30, 0x98, 0xE7, 0xF6, 0x48, 0x98, -+0x4E, 0xE9, 0x1E, 0x29, 0x05, 0x95, 0x01, 0x6C, -+0x00, 0x18, 0xEC, 0xD2, 0x01, 0x6C, 0x00, 0x18, -+0xB7, 0xD2, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x95, 0xF1, -+0xA0, 0x9B, 0xE3, 0xF3, 0x10, 0x6C, 0x01, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x21, 0x6A, 0x50, 0xF3, -+0x5F, 0xA2, 0x04, 0x2A, 0x01, 0x6A, 0x28, 0xF1, -+0x4D, 0xC0, 0x02, 0x10, 0x28, 0xF1, 0x2D, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, 0x55, 0xA2, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, 0x56, 0xA2, -+0x05, 0x22, 0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, -+0x5D, 0xD3, 0x04, 0x10, 0x00, 0x6C, 0x01, 0x6D, -+0x00, 0x18, 0xEC, 0xD2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x25, 0x67, 0x95, 0xF1, 0xA0, 0x9A, 0xFF, 0x68, -+0x8C, 0xE8, 0xA1, 0xF4, 0x18, 0x6C, 0x00, 0x18, -+0x05, 0xE1, 0x28, 0x22, 0x27, 0x20, 0x03, 0x21, -+0x01, 0x71, 0x12, 0x60, 0x34, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0x1C, 0x9A, 0x00, 0x6C, -+0x01, 0x6D, 0xD0, 0x67, 0x00, 0x18, 0x50, 0xE1, -+0x0E, 0x6B, 0x6B, 0xEB, 0x4C, 0xEB, 0x00, 0x6C, -+0x01, 0x6D, 0xD0, 0x67, 0x09, 0x6F, 0x10, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, 0x1C, 0x9A, -+0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x50, 0xE1, 0x0E, 0x6B, 0x6B, 0xEB, 0x4C, 0xEB, -+0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, 0x05, 0x6F, -+0x6D, 0xEF, 0x0F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF3, 0x1C, 0x9A, 0x00, 0x6C, 0x01, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x50, 0xE1, 0x02, 0x6F, -+0xEB, 0xEF, 0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, -+0x4C, 0xEF, 0x00, 0x18, 0x63, 0xE1, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xED, -+0x01, 0x6B, 0x64, 0xED, 0xE6, 0x67, 0x00, 0xF6, -+0x63, 0x36, 0x01, 0x56, 0x4C, 0xEC, 0x4C, 0xEF, -+0x03, 0x61, 0x4C, 0xEE, 0x03, 0x6B, 0x10, 0x10, -+0x63, 0x35, 0xA3, 0x36, 0x01, 0x56, 0x03, 0x61, -+0x4C, 0xEE, 0x02, 0x6B, 0x09, 0x10, 0x01, 0x55, -+0x04, 0x61, 0xC5, 0x67, 0x4C, 0xEE, 0x01, 0x6B, -+0x03, 0x10, 0xC3, 0x67, 0x4C, 0xEE, 0x00, 0x6B, -+0x2A, 0x27, 0x01, 0x74, 0x0E, 0x60, 0x05, 0x24, -+0x02, 0x74, 0x13, 0x60, 0x03, 0x74, 0x1A, 0x60, -+0x50, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, -+0x44, 0x9A, 0x83, 0x67, 0xA6, 0x67, 0x03, 0x6F, -+0x47, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, -+0x44, 0x9A, 0x84, 0x43, 0xA6, 0x67, 0x04, 0x6F, -+0x3F, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x87, 0x43, -+0xCE, 0xF2, 0x44, 0x9A, 0x01, 0x4C, 0xA6, 0x67, -+0x05, 0x6F, 0x36, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x87, 0x43, 0xCE, 0xF2, 0x44, 0x9A, 0x05, 0x4C, -+0xA6, 0x67, 0x06, 0x6F, 0x2D, 0x10, 0x01, 0x74, -+0x0F, 0x60, 0x05, 0x24, 0x02, 0x74, 0x15, 0x60, -+0x03, 0x74, 0x1D, 0x60, 0x26, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xA6, 0x67, 0xCE, 0xF2, 0x44, 0x9A, -+0x83, 0x67, 0x00, 0x6E, 0x07, 0x6F, 0x1C, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xA6, 0x67, 0xCE, 0xF2, -+0x44, 0x9A, 0x84, 0x43, 0x00, 0x6E, 0x08, 0x6F, -+0x13, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x87, 0x43, -+0xA6, 0x67, 0xCE, 0xF2, 0x44, 0x9A, 0x01, 0x4C, -+0x00, 0x6E, 0x09, 0x6F, 0x09, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF2, 0x44, 0x9A, 0x87, 0x43, -+0xA6, 0x67, 0x05, 0x4C, 0x00, 0x6E, 0x0A, 0x6F, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x40, 0xA4, 0x1F, 0x68, 0x01, 0x6E, 0x56, 0x31, -+0x4C, 0xE8, 0x91, 0x67, 0xB0, 0x67, 0x00, 0x18, -+0xCE, 0xD3, 0x42, 0xF2, 0x8C, 0x41, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x88, 0x34, -+0x91, 0xE3, 0xA2, 0x9C, 0x01, 0x6A, 0x44, 0xE8, -+0xAD, 0xEA, 0x42, 0xDC, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF4, 0x44, 0x9A, 0x34, 0x31, 0x01, 0xE1, -+0x40, 0x9A, 0x42, 0xF2, 0x10, 0x48, 0x08, 0x30, -+0x0D, 0xE3, 0x42, 0xDB, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x40, 0xA4, 0x01, 0x6B, 0x1F, 0x68, 0x6C, 0xEA, -+0x04, 0xD2, 0x41, 0xA4, 0x04, 0x96, 0x56, 0x31, -+0x4C, 0xE8, 0x91, 0x67, 0xB0, 0x67, 0x00, 0x18, -+0xCE, 0xD3, 0x04, 0x94, 0x21, 0x24, 0x30, 0xF0, -+0x20, 0x6A, 0x42, 0xF2, 0x8C, 0x41, 0xC0, 0xF1, -+0x08, 0x4A, 0x88, 0x34, 0x91, 0xE2, 0xA2, 0x9C, -+0x01, 0x6B, 0x64, 0xE8, 0xAD, 0xEB, 0x62, 0xDC, -+0x29, 0xF1, 0x84, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0xFF, 0x6C, 0x8C, 0xEB, 0x29, 0x2B, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF4, 0x64, 0x9B, 0x34, 0x31, -+0x01, 0xE1, 0x60, 0x9B, 0x42, 0xF2, 0x10, 0x48, -+0x08, 0x30, 0x09, 0xE2, 0x62, 0xDA, 0x1C, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0x42, 0xF2, 0x8C, 0x41, -+0xC0, 0xF1, 0x08, 0x4B, 0x88, 0x34, 0x91, 0xE3, -+0xA2, 0x9C, 0x01, 0x6A, 0x44, 0xE8, 0x4F, 0xEA, -+0xAC, 0xEA, 0x42, 0xDC, 0x29, 0xF1, 0x84, 0xA3, -+0x02, 0x6A, 0x8C, 0xEA, 0xFF, 0x6C, 0x8C, 0xEA, -+0x07, 0x2A, 0x28, 0x31, 0x01, 0xE1, 0x42, 0xF2, -+0x10, 0x48, 0x08, 0x30, 0x0D, 0xE3, 0x42, 0xDB, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xD9, 0x63, 0x4D, 0x62, -+0x4C, 0xD1, 0x4B, 0xD0, 0x00, 0x6D, 0x04, 0x04, -+0x80, 0x6E, 0x00, 0x18, 0x4B, 0xD2, 0x01, 0x6A, -+0x4B, 0xEA, 0x7D, 0x67, 0x24, 0x04, 0x50, 0xC3, -+0x00, 0x6D, 0x80, 0x6E, 0x00, 0x18, 0x4B, 0xD2, -+0x30, 0xF0, 0x20, 0x68, 0x00, 0x6C, 0x09, 0xF3, -+0x00, 0x48, 0x48, 0xD4, 0x47, 0xD4, 0x24, 0x67, -+0x40, 0x98, 0x56, 0x22, 0x47, 0x92, 0x00, 0x6C, -+0x45, 0xD4, 0x5C, 0x33, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xE2, 0x48, 0x93, -+0x49, 0xF1, 0x08, 0x4A, 0x44, 0xD2, 0x49, 0xD2, -+0x46, 0xD3, 0x45, 0x95, 0x60, 0x98, 0x01, 0x6A, -+0x44, 0xED, 0x6C, 0xEA, 0x31, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF4, 0x44, 0x9A, 0x49, 0x94, -+0x60, 0x9A, 0x40, 0x9C, 0x30, 0xF0, 0x20, 0x6C, -+0xE9, 0xF2, 0xAC, 0xA4, 0x10, 0xF0, 0x24, 0x6C, -+0xF5, 0xF4, 0x88, 0x9C, 0xBA, 0x35, 0x4F, 0xE3, -+0x98, 0xED, 0x12, 0xEC, 0x63, 0xEC, 0x10, 0x60, -+0x47, 0x94, 0x45, 0x95, 0x00, 0x6E, 0x00, 0x18, -+0xCE, 0xD3, 0x45, 0x92, 0x01, 0x6B, 0x64, 0xEA, -+0x40, 0x98, 0x6F, 0xEB, 0x6C, 0xEA, 0x44, 0x93, -+0x40, 0xD8, 0x00, 0x6A, 0x40, 0xDB, 0x0C, 0x10, -+0x9D, 0x67, 0x10, 0xF1, 0xA8, 0x44, 0x04, 0x03, -+0x80, 0xA5, 0x2D, 0xE3, 0x80, 0xF0, 0x40, 0xC3, -+0x01, 0x49, 0xFF, 0x6A, 0x80, 0xC3, 0x4C, 0xE9, -+0x44, 0x92, 0x45, 0x95, 0x46, 0x93, 0x49, 0x94, -+0x04, 0x4A, 0x01, 0x4D, 0x44, 0xD2, 0x01, 0x4B, -+0xFF, 0x6A, 0x4C, 0xEB, 0x04, 0x4C, 0x20, 0x75, -+0x45, 0xD5, 0x46, 0xD3, 0x49, 0xD4, 0xB9, 0x61, -+0x48, 0x92, 0x47, 0x95, 0x04, 0x48, 0x20, 0x4A, -+0x48, 0xD2, 0x48, 0x93, 0x01, 0x4D, 0xFF, 0x6A, -+0x4C, 0xEB, 0x04, 0x75, 0x47, 0xD5, 0x48, 0xD3, -+0x9B, 0x61, 0x9D, 0x67, 0x80, 0xF0, 0x90, 0xA4, -+0x47, 0xD4, 0x15, 0x11, 0xBD, 0x67, 0x4D, 0xE5, -+0x90, 0xA3, 0xFF, 0x74, 0xA0, 0xF0, 0x0D, 0x60, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF4, 0xAC, 0x9B, -+0x10, 0xF0, 0x24, 0x6E, 0x75, 0xF1, 0xC0, 0x9E, -+0x60, 0x9D, 0xCC, 0xEB, 0x08, 0x2B, 0x60, 0x9D, -+0x40, 0xF6, 0x62, 0x33, 0x6E, 0xEC, 0x03, 0x2C, -+0x01, 0x48, 0xFF, 0x6B, 0x6C, 0xE8, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF4, 0x90, 0x9B, 0x10, 0xF0, -+0x24, 0x6D, 0x75, 0xF1, 0xA0, 0x9D, 0x60, 0x9C, -+0xAC, 0xEB, 0x0B, 0x2B, 0xBD, 0x67, 0x60, 0x9C, -+0x51, 0xE5, 0x90, 0xA4, 0x40, 0xF6, 0x62, 0x33, -+0x8E, 0xEB, 0x03, 0x2B, 0x01, 0x48, 0xFF, 0x6B, -+0x6C, 0xE8, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF4, -+0x94, 0x9B, 0x10, 0xF0, 0x24, 0x6D, 0x75, 0xF1, -+0xA0, 0x9D, 0x60, 0x9C, 0xAC, 0xEB, 0x0B, 0x2B, -+0xBD, 0x67, 0x60, 0x9C, 0x51, 0xE5, 0x90, 0xA4, -+0x40, 0xF6, 0x62, 0x33, 0x8E, 0xEB, 0x03, 0x2B, -+0x01, 0x48, 0xFF, 0x6B, 0x6C, 0xE8, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF4, 0x98, 0x9B, 0x10, 0xF0, -+0x24, 0x6D, 0x75, 0xF1, 0xA0, 0x9D, 0x60, 0x9C, -+0xAC, 0xEB, 0x0B, 0x2B, 0xBD, 0x67, 0x60, 0x9C, -+0x51, 0xE5, 0x90, 0xA4, 0x40, 0xF6, 0x62, 0x33, -+0x8E, 0xEB, 0x03, 0x2B, 0x01, 0x48, 0xFF, 0x6B, -+0x6C, 0xE8, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF4, -+0x9C, 0x9B, 0x10, 0xF0, 0x24, 0x6D, 0x75, 0xF1, -+0xA0, 0x9D, 0x60, 0x9C, 0xAC, 0xEB, 0x0B, 0x2B, -+0xBD, 0x67, 0x60, 0x9C, 0x51, 0xE5, 0x90, 0xA4, -+0x40, 0xF6, 0x62, 0x33, 0x8E, 0xEB, 0x03, 0x2B, -+0x01, 0x48, 0xFF, 0x6B, 0x6C, 0xE8, 0x10, 0xF0, -+0x24, 0x6B, 0x15, 0xF5, 0x80, 0x9B, 0x10, 0xF0, -+0x24, 0x6D, 0x75, 0xF1, 0xA0, 0x9D, 0x60, 0x9C, -+0xAC, 0xEB, 0x0B, 0x2B, 0xBD, 0x67, 0x60, 0x9C, -+0x51, 0xE5, 0x90, 0xA4, 0x40, 0xF6, 0x62, 0x33, -+0x8E, 0xEB, 0x03, 0x2B, 0x01, 0x48, 0xFF, 0x6B, -+0x6C, 0xE8, 0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF5, -+0x84, 0x9B, 0x10, 0xF0, 0x24, 0x6D, 0x75, 0xF1, -+0xA0, 0x9D, 0x60, 0x9C, 0xAC, 0xEB, 0x0B, 0x2B, -+0xBD, 0x67, 0x60, 0x9C, 0x51, 0xE5, 0x90, 0xA4, -+0x40, 0xF6, 0x62, 0x33, 0x8E, 0xEB, 0x03, 0x2B, -+0x01, 0x48, 0xFF, 0x6B, 0x6C, 0xE8, 0x10, 0xF0, -+0x24, 0x6B, 0x15, 0xF5, 0x88, 0x9B, 0x10, 0xF0, -+0x24, 0x6D, 0x75, 0xF1, 0xA0, 0x9D, 0x60, 0x9C, -+0xAC, 0xEB, 0x0B, 0x2B, 0xBD, 0x67, 0x60, 0x9C, -+0x51, 0xE5, 0x90, 0xA4, 0x40, 0xF6, 0x62, 0x33, -+0x8E, 0xEB, 0x03, 0x2B, 0x01, 0x48, 0xFF, 0x6B, -+0x6C, 0xE8, 0x01, 0x4A, 0xFF, 0x6B, 0x6C, 0xEA, -+0x23, 0xEA, 0x5F, 0xF7, 0x07, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xE9, 0xF2, 0x4C, 0xA2, 0x0F, 0x6B, -+0x4A, 0x32, 0x6C, 0xEA, 0x02, 0xEA, 0x4A, 0x60, -+0x5D, 0x67, 0x70, 0xA2, 0x00, 0x6A, 0x46, 0xD2, -+0x80, 0xF0, 0x11, 0x06, 0x00, 0xF0, 0x11, 0x05, -+0x47, 0x94, 0x01, 0x6A, 0x44, 0xD3, 0x45, 0xD0, -+0x11, 0x10, 0xE0, 0xA6, 0x83, 0xEF, 0x09, 0x60, -+0xEF, 0xE4, 0xFF, 0xF7, 0x1F, 0x68, 0x03, 0xEB, -+0x04, 0x60, 0x60, 0xA5, 0x87, 0x67, 0x46, 0xD2, -+0x44, 0xD3, 0x01, 0x4A, 0xFF, 0x6F, 0xEC, 0xEA, -+0x01, 0x4E, 0x01, 0x4D, 0x23, 0xEA, 0xED, 0x61, -+0x44, 0x93, 0x1F, 0x6D, 0x00, 0x6E, 0x76, 0x34, -+0x6C, 0xED, 0x45, 0x90, 0x44, 0xD5, 0x45, 0xD4, -+0x00, 0x18, 0xCE, 0xD3, 0x46, 0x94, 0x7D, 0x67, -+0x44, 0x95, 0x89, 0xE3, 0x45, 0x94, 0x01, 0x6B, -+0x6B, 0xEB, 0x70, 0xC2, 0x42, 0xF2, 0x0C, 0x4C, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0x34, 0x91, 0xE2, 0x01, 0x6B, 0x64, 0xED, -+0xA2, 0x9C, 0x6F, 0xEB, 0xAC, 0xEB, 0x62, 0xDC, -+0x45, 0x94, 0x44, 0x95, 0x94, 0x33, 0xAD, 0xE3, -+0x42, 0xF2, 0x10, 0x4B, 0x68, 0x33, 0x69, 0xE2, -+0x00, 0x6B, 0x62, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0xE9, 0xF2, 0x4C, 0xA2, 0x0F, 0x6B, 0x4A, 0x32, -+0x6C, 0xEA, 0x02, 0xEA, 0x03, 0x60, 0x00, 0x68, -+0x50, 0x67, 0x9E, 0x17, 0x4D, 0x97, 0x4C, 0x91, -+0x4B, 0x90, 0x27, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x00, 0x6B, 0x29, 0xF1, -+0x68, 0xDA, 0x29, 0xF1, 0x78, 0xDA, 0x29, 0xF1, -+0x6C, 0xDA, 0x29, 0xF1, 0x7C, 0xDA, 0x29, 0xF1, -+0x70, 0xDA, 0x49, 0xF1, 0x60, 0xDA, 0x29, 0xF1, -+0x74, 0xDA, 0x49, 0xF1, 0x64, 0xDA, 0x43, 0x67, -+0x52, 0xF2, 0x80, 0x42, 0x30, 0xF0, 0x20, 0x6B, -+0x88, 0x34, 0xC0, 0xF1, 0x08, 0x4B, 0x8D, 0xE3, -+0x00, 0x6C, 0x82, 0xDB, 0x01, 0x4A, 0xFF, 0x6B, -+0x6C, 0xEA, 0x80, 0x72, 0xF1, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, -+0x20, 0x6C, 0xE9, 0xF2, 0x0C, 0x4C, 0x00, 0x6D, -+0x01, 0x6E, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0xA4, 0x67, 0x30, 0xF0, -+0x20, 0x69, 0x30, 0xF0, 0x20, 0x6C, 0xE9, 0xF2, -+0x0C, 0x4C, 0x01, 0x6E, 0xC0, 0xF1, 0x08, 0x49, -+0x40, 0xEA, 0x29, 0xF1, 0x44, 0xA1, 0x03, 0x68, -+0x4C, 0xE8, 0x01, 0x70, 0x14, 0x61, 0x30, 0xF0, -+0x20, 0x68, 0x4E, 0xF2, 0x54, 0x98, 0x00, 0x6C, -+0x20, 0x6D, 0x40, 0xEA, 0x29, 0xF1, 0xC4, 0xA1, -+0xFF, 0x6A, 0xFF, 0x6C, 0xDA, 0x36, 0x4C, 0xEE, -+0x69, 0x4C, 0x01, 0x6D, 0x00, 0x18, 0x18, 0xDC, -+0x4E, 0xF2, 0x54, 0x98, 0x11, 0x10, 0x0A, 0x28, -+0x00, 0x6C, 0x20, 0x6D, 0x00, 0x18, 0xF1, 0xDC, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF5, 0x50, 0x9A, -+0x00, 0xC2, 0x0F, 0x10, 0x03, 0x70, 0x0B, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x54, 0x9A, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF5, 0xAC, 0x9B, -+0x01, 0x6C, 0x40, 0xEA, 0x09, 0x10, 0x02, 0x70, -+0x07, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF5, -+0xAC, 0x9A, 0x01, 0x6C, 0x00, 0x18, 0xF1, 0xDC, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x00, 0x68, 0x17, 0x10, 0xE0, 0xF3, -+0x08, 0x70, 0x0A, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF1, 0x7C, 0x9A, 0x80, 0x6C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, 0x13, 0x10, -+0xFF, 0xF7, 0x1F, 0x6A, 0x01, 0x48, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF1, 0x54, 0x9A, 0x60, 0xA2, 0x01, 0x6A, -+0x6C, 0xEA, 0xE1, 0x2A, 0x01, 0x6A, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF5, -+0x74, 0x9B, 0x15, 0xF5, 0x98, 0x9C, 0x6D, 0xE5, -+0x91, 0xE5, 0x00, 0x6E, 0xC0, 0xDB, 0x04, 0x4B, -+0x8A, 0xEB, 0xFB, 0x61, 0xE7, 0xF7, 0x1F, 0x6B, -+0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF2, -+0x58, 0x9A, 0x10, 0x6C, 0x4D, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF5, 0x54, 0x9A, 0x49, 0xE5, -+0x60, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF5, -+0x5C, 0x9A, 0xFF, 0x6B, 0x55, 0xE5, 0x40, 0xA5, -+0x6C, 0xEA, 0x8D, 0xEA, 0x6C, 0xEA, 0x40, 0xC5, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF4, 0x7D, 0xA2, 0x08, 0xD4, 0x30, 0xF0, -+0x20, 0x69, 0x61, 0xC5, 0x01, 0x4B, 0x90, 0xF4, -+0x7D, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF5, -+0x94, 0x9B, 0x08, 0x93, 0x4E, 0xF2, 0x50, 0x99, -+0x02, 0x6E, 0x91, 0xE3, 0x05, 0x67, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF5, 0x80, 0x9B, -+0x08, 0x93, 0xCE, 0xA0, 0x4E, 0xF2, 0x50, 0x99, -+0xA2, 0x40, 0x91, 0xE3, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x24, 0x67, 0x00, 0x18, 0x63, 0xD5, 0x00, 0x6B, -+0x36, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF2, -+0x58, 0x9A, 0xFF, 0xF7, 0x1F, 0x6E, 0xFF, 0x6F, -+0x00, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF2, -+0x5C, 0x9A, 0x10, 0x6C, 0x8B, 0xEC, 0x4C, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0xA1, 0x40, 0x35, 0xF5, -+0x44, 0x9A, 0x65, 0x67, 0xCC, 0xEB, 0x60, 0xCA, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF5, 0x48, 0x9A, -+0x60, 0xA2, 0xFA, 0x65, 0xA2, 0x32, 0xEC, 0xEB, -+0x8C, 0xEB, 0x42, 0x32, 0x6D, 0xEA, 0xEC, 0xEA, -+0x7F, 0x67, 0x40, 0xC3, 0x87, 0xA9, 0x02, 0x4C, -+0xCC, 0xEC, 0x00, 0x18, 0x78, 0xD5, 0x87, 0x40, -+0x12, 0x4C, 0xB1, 0x67, 0x00, 0x18, 0x8F, 0xD5, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x54, 0x9A, -+0x01, 0x6B, 0x60, 0xC2, 0x01, 0x6B, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x43, 0x67, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, 0xA4, 0x67, -+0x04, 0x6C, 0x8D, 0xEB, 0x30, 0xF0, 0x20, 0x68, -+0x80, 0xF0, 0x6C, 0xDA, 0x2F, 0xF5, 0x18, 0x48, -+0xA0, 0xF0, 0x44, 0xA8, 0x01, 0xF1, 0x00, 0x72, -+0x07, 0x60, 0xA0, 0xF0, 0x64, 0xA0, 0xA0, 0xF0, -+0x45, 0xA0, 0xFF, 0x4B, 0x4E, 0xEB, 0x0A, 0x2B, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, -+0x00, 0xF2, 0x00, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x12, 0x10, 0x50, 0x32, 0x11, 0xE2, -+0x04, 0x4C, 0x10, 0x6E, 0x00, 0x18, 0x50, 0xD2, -+0xA0, 0xF0, 0x45, 0xA0, 0x0A, 0x6B, 0x01, 0x4A, -+0xA0, 0xF0, 0x45, 0xC0, 0xA0, 0xF0, 0x45, 0xA0, -+0x6E, 0xEA, 0x02, 0x2A, 0xA0, 0xF0, 0x45, 0xC0, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x21, 0x6B, 0x90, 0xF4, 0x5C, 0xA3, 0xFF, 0x6F, -+0xE0, 0xF0, 0xC7, 0xA5, 0x41, 0xC5, 0x43, 0xA5, -+0x90, 0xF4, 0x7C, 0xA3, 0x03, 0x4A, 0xEC, 0xEA, -+0x09, 0x10, 0xED, 0x42, 0xFF, 0x68, 0x0C, 0xEF, -+0xFD, 0xE5, 0x64, 0xC7, 0xE6, 0xA7, 0x03, 0x4F, -+0xE9, 0xE2, 0x0C, 0xEA, 0xEF, 0x46, 0xE2, 0xEA, -+0xF4, 0x61, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF4, -+0x7C, 0xA2, 0x01, 0x4B, 0x90, 0xF4, 0x7C, 0xC2, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF5, 0x74, 0x9B, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x71, 0xE4, 0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x24, 0x67, 0x00, 0x18, -+0x63, 0xD5, 0x00, 0x6B, 0x2E, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF2, 0x58, 0x9A, 0x0F, 0x6C, -+0xFF, 0xF7, 0x1F, 0x6B, 0x00, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF2, 0x5C, 0x9A, 0x4C, 0xE8, -+0xA1, 0x40, 0xA2, 0x32, 0x42, 0x32, 0x8C, 0xEA, -+0x10, 0xF0, 0x24, 0x6C, 0x35, 0xF5, 0x84, 0x9C, -+0xC5, 0x67, 0x6C, 0xEE, 0xC0, 0xCC, 0x10, 0xF0, -+0x24, 0x6C, 0x35, 0xF5, 0x88, 0x9C, 0x40, 0xC4, -+0xE0, 0xF0, 0x87, 0xA1, 0x6C, 0xEC, 0x00, 0x18, -+0x78, 0xD5, 0x87, 0x40, 0x12, 0x4C, 0xB1, 0x67, -+0x00, 0x18, 0xE6, 0xD5, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF1, 0x54, 0x9A, 0x01, 0x6B, 0x60, 0xC2, -+0x01, 0x6B, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x43, 0x67, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0x6B, 0xF0, 0x19, 0x4A, 0x10, 0xF0, -+0x30, 0x68, 0x40, 0xDB, 0x00, 0xF0, 0x00, 0x48, -+0xC1, 0xF6, 0x62, 0xA0, 0xC1, 0xF6, 0x43, 0xA0, -+0x6E, 0xEA, 0x39, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF2, 0x40, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0x95, 0xF1, 0x88, 0x9C, 0x40, 0x9A, 0x8C, 0xEA, -+0x2E, 0x2A, 0xE8, 0x6A, 0x58, 0xEB, 0x87, 0x40, -+0x3B, 0x4C, 0x12, 0xEB, 0x71, 0xE4, 0x00, 0x18, -+0xFF, 0xD5, 0x16, 0x22, 0xC1, 0xF6, 0x42, 0xA0, -+0x10, 0x6B, 0x01, 0x4A, 0xC1, 0xF6, 0x42, 0xC0, -+0xC1, 0xF6, 0x42, 0xA0, 0x6E, 0xEA, 0x02, 0x2A, -+0xC1, 0xF6, 0x42, 0xC0, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF6, 0x82, 0xA2, -+0xC1, 0xF6, 0x63, 0xA2, 0x8E, 0xEB, 0x0B, 0x23, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x04, 0x6C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x04, 0x10, 0xC1, 0xF6, -+0x84, 0xC2, 0xC1, 0xF6, 0x65, 0xC2, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF6, 0x62, 0xA2, 0xA4, 0x67, 0x04, 0x2B, -+0xC1, 0xF6, 0x43, 0xA2, 0x0F, 0x72, 0x0B, 0x60, -+0x10, 0xF0, 0x30, 0x68, 0x00, 0xF0, 0x00, 0x48, -+0xC1, 0xF6, 0x42, 0xA0, 0xC1, 0xF6, 0x83, 0xA0, -+0xFF, 0x4A, 0x8E, 0xEA, 0x09, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, 0xFF, 0x6A, -+0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, 0xA7, 0x10, -+0x23, 0xA5, 0xC1, 0xF6, 0x45, 0xA0, 0xFF, 0x6B, -+0x04, 0x49, 0x6C, 0xE9, 0x1F, 0x2A, 0xE8, 0x6A, -+0x58, 0xEC, 0x30, 0xF0, 0x20, 0x6A, 0x67, 0x40, -+0x4E, 0xF2, 0x50, 0x9A, 0x3B, 0x4B, 0xD1, 0x67, -+0x12, 0xEC, 0x91, 0xE3, 0x40, 0xEA, 0xC1, 0xF6, -+0x43, 0xA0, 0xC1, 0xF6, 0x62, 0xA0, 0xC1, 0xF6, -+0x25, 0xC0, 0x4E, 0xEB, 0x74, 0x2B, 0x01, 0x4A, -+0xC1, 0xF6, 0x43, 0xC0, 0xC1, 0xF6, 0x43, 0xA0, -+0x10, 0x6B, 0x6E, 0xEA, 0x6C, 0x2A, 0xC1, 0xF6, -+0x43, 0xC0, 0x69, 0x10, 0x82, 0xA5, 0x37, 0x2C, -+0x51, 0xE1, 0xE3, 0x54, 0x34, 0x60, 0xC1, 0xF6, -+0x84, 0xA0, 0xE8, 0x6E, 0xD8, 0xEC, 0x12, 0xEC, -+0x91, 0xE0, 0x40, 0xF0, 0xC4, 0xA4, 0x2B, 0x2E, -+0x40, 0xF0, 0xC5, 0xA4, 0xFC, 0x4A, 0x6C, 0xEA, -+0xFF, 0x4E, 0x40, 0xF0, 0xC5, 0xC4, 0xC1, 0xF6, -+0x85, 0xA0, 0xE8, 0x6E, 0xFF, 0x4C, 0xC1, 0xF6, -+0x85, 0xC0, 0xC1, 0xF6, 0x84, 0xA0, 0xD8, 0xEC, -+0xD1, 0x67, 0x12, 0xEC, 0x91, 0xE0, 0x51, 0xE4, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x45, 0x4C, 0x40, 0xEA, 0xC1, 0xF6, 0x44, 0xA0, -+0xE8, 0x6B, 0x78, 0xEA, 0x12, 0xEA, 0x49, 0xE0, -+0x40, 0xF0, 0x65, 0xA2, 0x6D, 0xE1, 0x40, 0xF0, -+0x65, 0xC2, 0xC1, 0xF6, 0x45, 0xA0, 0x45, 0xE1, -+0xC1, 0xF6, 0x25, 0xC0, 0x30, 0x10, 0x10, 0xF0, -+0x30, 0x68, 0x00, 0xF0, 0x00, 0x48, 0xC1, 0xF6, -+0x63, 0xA0, 0xE8, 0x6A, 0x87, 0x40, 0x58, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x3B, 0x4C, 0xD1, 0x67, 0x12, 0xEB, 0x71, 0xE4, -+0x40, 0xEA, 0xC1, 0xF6, 0x43, 0xA0, 0x10, 0x6B, -+0xC1, 0xF6, 0x25, 0xC0, 0x01, 0x4A, 0xC1, 0xF6, -+0x43, 0xC0, 0xC1, 0xF6, 0x43, 0xA0, 0x6E, 0xEA, -+0x02, 0x2A, 0xC1, 0xF6, 0x43, 0xC0, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF6, -+0x64, 0xA2, 0x10, 0x6C, 0x01, 0x4B, 0xC1, 0xF6, -+0x64, 0xC2, 0xC1, 0xF6, 0x64, 0xA2, 0x8E, 0xEB, -+0x02, 0x2B, 0xC1, 0xF6, 0x64, 0xC2, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF6, -+0x84, 0xA2, 0xE8, 0x6B, 0x78, 0xEC, 0x04, 0x6C, -+0x12, 0xEB, 0x6D, 0xE2, 0xC1, 0xF6, 0x45, 0xA2, -+0x20, 0xF1, 0x49, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0xCB, 0xF2, 0x01, 0x4A, 0x30, 0xF0, -+0x20, 0x68, 0x40, 0xDB, 0x2F, 0xF5, 0x18, 0x48, -+0xA0, 0xF0, 0x84, 0xA0, 0xA0, 0xF0, 0x45, 0xA0, -+0x8E, 0xEA, 0x3C, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF2, 0x40, 0x9A, 0x10, 0xF0, 0x24, 0x6B, -+0x95, 0xF1, 0x68, 0x9B, 0x40, 0x9A, 0x6C, 0xEA, -+0x31, 0x2A, 0x90, 0x34, 0x44, 0x40, 0x91, 0xE2, -+0x00, 0x18, 0xA4, 0xD5, 0x0B, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x6C, 0x9A, 0x04, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x22, 0x10, 0xA0, 0xF0, 0x44, 0xA0, -+0x01, 0x4A, 0xA0, 0xF0, 0x44, 0xC0, 0xA0, 0xF0, -+0x64, 0xA0, 0xA0, 0xF0, 0x45, 0xA0, 0x6E, 0xEA, -+0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, 0x04, 0x6C, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0xA0, 0xF0, -+0x64, 0xA2, 0x0A, 0x6C, 0x8E, 0xEB, 0x02, 0x2B, -+0xA0, 0xF0, 0x64, 0xC2, 0x00, 0x18, 0xFD, 0xD6, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF2, 0x70, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x35, 0xF1, 0x10, 0x9C, 0x40, 0x9B, -+0x00, 0xF4, 0x1D, 0x6C, 0x10, 0x6D, 0x0D, 0xEA, -+0x40, 0xDB, 0x06, 0x02, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF4, 0x54, 0x9A, 0x00, 0x6E, -+0x82, 0xF3, 0x08, 0x6F, 0x40, 0xEA, 0x07, 0x2A, -+0x10, 0xF0, 0x24, 0x6B, 0x55, 0xF1, 0x9C, 0x9B, -+0x60, 0x9C, 0x0D, 0xEB, 0x60, 0xDC, 0x09, 0x97, -+0x08, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x60, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC8, 0xF2, 0x7D, 0xC2, 0x61, 0xA4, -+0xC8, 0xF2, 0x7E, 0xC2, 0x62, 0xA4, 0xC8, 0xF2, -+0x7F, 0xC2, 0x63, 0xA4, 0xE8, 0xF2, 0x60, 0xC2, -+0x64, 0xA4, 0xE8, 0xF2, 0x61, 0xC2, 0x65, 0xA4, -+0xE8, 0xF2, 0x62, 0xC2, 0x66, 0xA4, 0xE8, 0xF2, -+0x63, 0xC2, 0x20, 0xE8, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF5, 0x4C, 0x9A, 0x60, 0xA2, 0x03, 0x6A, -+0x6C, 0xEA, 0x10, 0x6B, 0x64, 0xEA, 0xFF, 0x6A, -+0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF5, -+0x50, 0x9A, 0x04, 0xD3, 0x40, 0x9A, 0x05, 0xD2, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF5, 0x54, 0x9A, -+0x00, 0x9A, 0x05, 0x92, 0x0A, 0xEA, 0x00, 0xF1, -+0x05, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, 0x02, 0x6C, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, -+0x66, 0xA2, 0x04, 0x2B, 0xC1, 0xF7, 0x47, 0xA2, -+0x07, 0x72, 0x0B, 0x60, 0x10, 0xF0, 0x30, 0x69, -+0x00, 0xF0, 0x00, 0x49, 0xC1, 0xF7, 0x86, 0xA1, -+0xC1, 0xF7, 0x47, 0xA1, 0x6F, 0x44, 0x4E, 0xEB, -+0x0A, 0x2B, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, -+0x7C, 0x9A, 0xFF, 0x6C, 0x01, 0x4C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0xDB, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x35, 0xF5, 0xB8, 0x9B, 0x7F, 0x6B, -+0xB5, 0xE0, 0xC0, 0xA5, 0x6C, 0xEE, 0x80, 0xF0, -+0x0C, 0x2E, 0x03, 0x2C, 0x04, 0x72, 0xC0, 0xF0, -+0x0D, 0x60, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x67, 0xA2, 0xC1, 0xF7, -+0x46, 0xA2, 0x8C, 0x42, 0x6E, 0xEC, 0xC0, 0xF0, -+0x01, 0x24, 0x01, 0x72, 0x03, 0x61, 0x05, 0x73, -+0xA0, 0xF0, 0x1C, 0x60, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, -+0x02, 0x73, 0x05, 0x61, 0xC1, 0xF7, 0x47, 0xA2, -+0x06, 0x72, 0xA0, 0xF0, 0x0F, 0x60, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, -+0x66, 0xA2, 0x03, 0x73, 0x05, 0x61, 0xC1, 0xF7, -+0x47, 0xA2, 0x07, 0x72, 0xA0, 0xF0, 0x02, 0x60, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0x66, 0xA2, 0x05, 0x2B, 0xC1, 0xF7, -+0x47, 0xA2, 0x05, 0x72, 0x80, 0xF0, 0x16, 0x60, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0x67, 0xA2, 0xC1, 0xF7, 0x46, 0xA2, -+0x8D, 0x42, 0x6E, 0xEC, 0x80, 0xF0, 0x0A, 0x24, -+0x01, 0x72, 0x03, 0x61, 0x06, 0x73, 0x80, 0xF0, -+0x05, 0x60, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, 0x02, 0x73, -+0x04, 0x61, 0xC1, 0xF7, 0x47, 0xA2, 0x07, 0x72, -+0x79, 0x60, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, 0x04, 0x2B, -+0xC1, 0xF7, 0x47, 0xA2, 0x06, 0x72, 0x6E, 0x60, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0x67, 0xA2, 0xC1, 0xF7, 0x46, 0xA2, -+0x8E, 0x42, 0x6E, 0xEC, 0x63, 0x24, 0x01, 0x72, -+0x02, 0x61, 0x07, 0x73, 0x5F, 0x60, 0x10, 0xF0, -+0x30, 0x69, 0x00, 0xF0, 0x00, 0x49, 0x10, 0xF0, -+0x24, 0x6A, 0xC1, 0xF7, 0x87, 0xA1, 0x35, 0xF5, -+0x5C, 0x9A, 0x10, 0xF0, 0x24, 0x6D, 0x76, 0x4C, -+0x35, 0xF5, 0xB8, 0x9D, 0x49, 0xE0, 0x94, 0x34, -+0x60, 0xAA, 0x91, 0xE1, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x06, 0x4C, 0xB5, 0xE0, -+0x13, 0x10, 0x80, 0xA5, 0x8C, 0xEB, 0x01, 0x73, -+0x1F, 0x61, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF5, -+0x7C, 0x9B, 0x87, 0x42, 0x6F, 0x4C, 0x6D, 0xE0, -+0x30, 0xF0, 0x20, 0x6A, 0x94, 0x34, 0x60, 0xAB, -+0x4E, 0xF2, 0x50, 0x9A, 0x91, 0xE1, 0x06, 0x4C, -+0xFF, 0x6E, 0x6C, 0xEE, 0x40, 0xEA, 0xC1, 0xF7, -+0x47, 0xA1, 0x08, 0x6B, 0x01, 0x4A, 0xC1, 0xF7, -+0x47, 0xC1, 0xC1, 0xF7, 0x47, 0xA1, 0x6E, 0xEA, -+0x0E, 0x2A, 0xC1, 0xF7, 0x47, 0xC1, 0x0B, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF2, 0x80, 0x9C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF5, 0x40, 0x9A, 0x04, 0x93, -+0x40, 0x9A, 0x0E, 0xEA, 0x61, 0xE0, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF5, 0x44, 0x9A, -+0x00, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF5, -+0x54, 0x9A, 0x00, 0xDA, 0x05, 0x92, 0x4A, 0xE8, -+0x1F, 0xF7, 0x05, 0x61, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFE, 0x63, 0x03, 0xD1, 0x02, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF5, 0x48, 0x9A, 0x0F, 0x6B, -+0x40, 0xA2, 0x4C, 0xEB, 0x0A, 0x23, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x8C, 0x9A, 0x02, 0x6D, 0xAD, 0xEC, 0x80, 0xF0, -+0x8C, 0xDA, 0x10, 0xF0, 0x30, 0x6A, 0x40, 0xF0, -+0x40, 0xA2, 0x00, 0xD2, 0xFF, 0x4A, 0x01, 0xD2, -+0xE5, 0x10, 0x00, 0x92, 0x06, 0x2A, 0x10, 0xF0, -+0x30, 0x6A, 0x40, 0xF0, 0x41, 0xA2, 0x07, 0x72, -+0x09, 0x60, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0x40, 0xF0, 0x01, 0xA2, 0x01, 0x94, -+0x8A, 0xE8, 0x0A, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF1, 0x7C, 0x9A, 0xFF, 0x6C, 0x01, 0x4C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0xCC, 0x10, -+0x30, 0xF0, 0x21, 0x6D, 0x90, 0xF4, 0x9E, 0xA5, -+0xC3, 0x67, 0xC7, 0xEC, 0x86, 0x67, 0x01, 0x6E, -+0xCC, 0xEC, 0xA0, 0xF0, 0x08, 0x24, 0x0C, 0x35, -+0x04, 0x4D, 0xB5, 0xE2, 0x00, 0x6A, 0x30, 0xF0, -+0x21, 0x6E, 0x90, 0xF4, 0xFE, 0xA6, 0xFF, 0x6C, -+0x1F, 0xF7, 0x00, 0x69, 0x8C, 0xEF, 0x74, 0x4F, -+0xE8, 0x37, 0xFD, 0xE2, 0x2C, 0xEF, 0x02, 0xF0, -+0x00, 0x77, 0x08, 0x60, 0x90, 0xF4, 0xFE, 0xA6, -+0x8C, 0xEF, 0x74, 0x4F, 0xE8, 0x37, 0xFD, 0xE2, -+0x2C, 0xEF, 0x0F, 0x2F, 0x30, 0xF0, 0x21, 0x6C, -+0x90, 0xF4, 0x3E, 0xA4, 0xFF, 0x6C, 0x10, 0xF0, -+0x24, 0x6E, 0x8C, 0xE9, 0x74, 0x49, 0x28, 0x31, -+0xE2, 0x67, 0x25, 0xE2, 0x15, 0xF1, 0xC0, 0x9E, -+0x0B, 0x10, 0x90, 0xF4, 0x3E, 0xA6, 0x10, 0xF0, -+0x24, 0x6E, 0x15, 0xF1, 0xC4, 0x9E, 0x8C, 0xE9, -+0x74, 0x49, 0x28, 0x31, 0xE2, 0x67, 0x25, 0xE2, -+0xD9, 0xE1, 0xC0, 0xA6, 0x0C, 0x31, 0xFD, 0xE1, -+0xCC, 0xEC, 0x10, 0xF0, 0x30, 0x6E, 0x00, 0xF0, -+0x00, 0x4E, 0xDD, 0xE7, 0x80, 0xC7, 0x30, 0xF0, -+0x21, 0x6E, 0x90, 0xF4, 0xFE, 0xA6, 0xFF, 0x6C, -+0x1F, 0xF7, 0x00, 0x69, 0x8C, 0xEF, 0x7C, 0x4F, -+0xE8, 0x37, 0xFD, 0xE2, 0x2C, 0xEF, 0x02, 0xF0, -+0x00, 0x77, 0x08, 0x60, 0x90, 0xF4, 0xFE, 0xA6, -+0x8C, 0xEF, 0x7C, 0x4F, 0xE8, 0x37, 0xFD, 0xE2, -+0x2C, 0xEF, 0x0E, 0x2F, 0x30, 0xF0, 0x21, 0x6C, -+0x90, 0xF4, 0xFE, 0xA4, 0xFF, 0x6C, 0x10, 0xF0, -+0x24, 0x6E, 0x8C, 0xEF, 0x7C, 0x4F, 0xE8, 0x37, -+0xFD, 0xE2, 0x15, 0xF1, 0xC0, 0x9E, 0x0A, 0x10, -+0x90, 0xF4, 0xFE, 0xA6, 0x10, 0xF0, 0x24, 0x6E, -+0x15, 0xF1, 0xC4, 0x9E, 0x8C, 0xEF, 0x7C, 0x4F, -+0xE8, 0x37, 0xFD, 0xE2, 0xD9, 0xE7, 0xC0, 0xA6, -+0x01, 0x4A, 0x04, 0x72, 0xCC, 0xEC, 0x80, 0xC5, -+0x01, 0x4D, 0x8D, 0x61, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF4, 0xBE, 0xA2, 0x01, 0x6C, 0xC4, 0x67, -+0xC4, 0xED, 0xCF, 0xED, 0x90, 0xF4, 0xDE, 0xA2, -+0xAC, 0xEB, 0xFF, 0x6D, 0x84, 0xEE, 0x10, 0xF0, -+0x24, 0x6E, 0x55, 0xF5, 0xC8, 0x9E, 0xAC, 0xEC, -+0x80, 0xC6, 0x90, 0xF4, 0x9E, 0xA2, 0xAC, 0xEC, -+0x01, 0x4C, 0xAC, 0xEC, 0x90, 0xF4, 0x9E, 0xC2, -+0x90, 0xF4, 0xBE, 0xA2, 0x03, 0x6C, 0xAC, 0xEC, -+0x90, 0xF4, 0x9E, 0xC2, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0x40, 0xF0, 0x81, 0xA2, -+0x08, 0x6D, 0x01, 0x4C, 0x40, 0xF0, 0x81, 0xC2, -+0x40, 0xF0, 0x81, 0xA2, 0xAE, 0xEC, 0x1A, 0x2C, -+0x40, 0xF0, 0x81, 0xC2, 0x17, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF1, 0x9C, 0x9A, 0x02, 0x6E, -+0x40, 0x9C, 0xCD, 0xEA, 0x40, 0xDC, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF5, 0x4C, 0x9A, 0x60, 0xC2, -+0x90, 0xF4, 0x7E, 0xA5, 0xFF, 0x6A, 0x4C, 0xEB, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF5, 0x50, 0x9A, -+0x60, 0xC2, 0x02, 0x10, 0x1F, 0xF7, 0x19, 0x2B, -+0x03, 0x91, 0x02, 0x90, 0x02, 0x63, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF5, 0x54, 0x9A, 0xFF, 0x68, -+0x60, 0xA2, 0x6C, 0xE8, 0x1D, 0x20, 0x00, 0x6B, -+0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x01, 0x6C, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF5, 0x58, 0x9A, 0x20, 0x6B, -+0x20, 0x70, 0x60, 0xC2, 0x0D, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, -+0x24, 0x6C, 0x80, 0xF0, 0x6C, 0x9A, 0x95, 0xF1, -+0x84, 0x9C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x1C, 0x96, 0x45, -+0x00, 0x18, 0x10, 0xDD, 0x05, 0x6C, 0x01, 0x6D, -+0x00, 0x18, 0xC7, 0xD0, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0xFF, 0x17, 0xDE, 0x63, 0x43, 0x62, -+0x42, 0xD1, 0x41, 0xD0, 0x01, 0x6A, 0x7D, 0x67, -+0x4B, 0xEA, 0x58, 0xC3, 0x01, 0x6A, 0x5A, 0xC3, -+0x08, 0x6A, 0x5B, 0xC3, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, -+0x76, 0x4B, 0x74, 0x33, 0x69, 0xE2, 0x66, 0xA2, -+0x7F, 0x6A, 0x6C, 0xEA, 0x01, 0x72, 0x7E, 0x30, -+0x80, 0xF0, 0x1C, 0x61, 0x48, 0xA4, 0xBD, 0x67, -+0x5C, 0xC5, 0x41, 0xA4, 0x5D, 0xC5, 0x42, 0xA4, -+0x5E, 0xC5, 0x46, 0xA4, 0x20, 0xF0, 0x40, 0xC5, -+0x43, 0xA4, 0x5F, 0xC5, 0x47, 0xA4, 0x20, 0xF0, -+0x41, 0xC5, 0x5C, 0xA5, 0x80, 0xF0, 0x04, 0x2A, -+0x7D, 0x67, 0x5F, 0xA3, 0x7E, 0xA3, 0x40, 0x32, -+0x6D, 0xEA, 0x03, 0x72, 0x05, 0x60, 0x08, 0x72, -+0x21, 0x60, 0x02, 0x72, 0x37, 0x60, 0x78, 0x10, -+0x06, 0x20, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x06, 0x04, 0x40, 0xEA, 0x9D, 0x67, -+0x20, 0xF0, 0xE1, 0xA4, 0x20, 0xF0, 0x40, 0xA4, -+0xFF, 0xF7, 0x1F, 0x6B, 0xE0, 0x37, 0x5D, 0xE7, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, 0x50, 0x9A, -+0x30, 0xF0, 0x20, 0x6D, 0x05, 0x6C, 0xEC, 0xF6, -+0x06, 0x4D, 0x00, 0xF2, 0x00, 0x6E, 0x6C, 0xEF, -+0x40, 0xEA, 0x75, 0x10, 0xBD, 0x67, 0x30, 0xF0, -+0x20, 0x6B, 0x10, 0x6A, 0x5B, 0xC5, 0x30, 0xF0, -+0x20, 0x69, 0x4E, 0xF2, 0x50, 0x9B, 0x09, 0xF6, -+0x04, 0x49, 0x09, 0x04, 0xB1, 0x67, 0x04, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6C, 0x4E, 0xF2, -+0x50, 0x9C, 0xA4, 0x41, 0x0A, 0x04, 0x04, 0x6E, -+0x40, 0xEA, 0x42, 0x10, 0x06, 0x20, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x5C, 0x9A, 0x06, 0x04, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0xEB, 0xF6, 0x74, 0xA0, 0x01, 0x6A, -+0x6C, 0xEA, 0x27, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x50, 0x9A, 0x40, 0xEA, 0xEB, 0xF6, -+0x60, 0xA0, 0x04, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x18, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF5, 0x5C, 0x9A, 0xEB, 0xF6, 0xCC, 0x98, -+0x00, 0x6B, 0x40, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF1, 0x48, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0x52, 0xF3, 0x1D, 0x4C, 0x40, 0x9A, 0xA3, 0x67, -+0x01, 0x6F, 0x5B, 0xE6, 0x04, 0xD3, 0x00, 0x18, -+0xAB, 0xE3, 0x29, 0x10, 0x00, 0x18, 0xD7, 0xE4, -+0x26, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, -+0x54, 0x9A, 0x40, 0xEA, 0xEB, 0xF6, 0xB2, 0xA8, -+0x00, 0x6C, 0x00, 0x18, 0x84, 0xE4, 0x1B, 0x10, -+0x1A, 0x20, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x13, 0x10, 0x14, 0x2A, 0x69, 0xA4, -+0xBD, 0x67, 0x7C, 0xC5, 0x68, 0xA4, 0x5E, 0xC5, -+0x5F, 0xC5, 0x7D, 0xC5, 0x46, 0xA4, 0x20, 0xF0, -+0x40, 0xC5, 0x67, 0xA4, 0x08, 0x20, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x5C, 0x9A, 0x20, 0xF0, -+0x61, 0xC5, 0x06, 0x04, 0x40, 0xEA, 0x43, 0x97, -+0x42, 0x91, 0x41, 0x90, 0x22, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x68, 0x44, 0xFA, 0x4B, 0x4C, 0xEB, 0x04, 0x5B, -+0x03, 0x60, 0x80, 0x18, 0xA9, 0x11, 0x3D, 0x10, -+0xFE, 0x4C, 0x4C, 0xEC, 0x0C, 0x5C, 0x2D, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, 0xB4, 0xF7, -+0x08, 0x4A, 0x89, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, 0x48, 0x9A, -+0x08, 0x10, 0x85, 0x67, 0x00, 0x18, 0x9A, 0xE4, -+0x28, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, -+0x44, 0x9A, 0x85, 0x67, 0x40, 0xEA, 0x21, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, 0x54, 0x9A, -+0x40, 0xEA, 0x1B, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF5, 0x58, 0x9A, 0xF2, 0x17, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF5, 0x5C, 0x9A, 0xED, 0x17, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, 0x40, 0x9A, -+0xE8, 0x17, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, -+0x7C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x95, 0xF1, -+0x84, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0xFF, 0x6A, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0xA0, 0xA4, 0x2F, 0xF5, -+0xD8, 0xA3, 0x02, 0x6A, 0x01, 0x68, 0x4B, 0xEA, -+0x0C, 0xED, 0xCC, 0xEA, 0xAD, 0xEA, 0x2F, 0xF5, -+0x58, 0xC3, 0xA1, 0xA4, 0x2F, 0xF5, 0x18, 0x4B, -+0x0C, 0xEA, 0xA1, 0xC3, 0x82, 0xA4, 0x82, 0xC3, -+0x62, 0xA3, 0x06, 0xD3, 0x20, 0x22, 0x01, 0x69, -+0x2B, 0xE9, 0xD1, 0x67, 0x00, 0x6C, 0x42, 0x6D, -+0x00, 0x18, 0x50, 0xE1, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF1, 0xE4, 0x9B, 0xD1, 0x67, 0x00, 0x6C, -+0x4D, 0xEF, 0x42, 0x6D, 0x00, 0x18, 0x63, 0xE1, -+0x06, 0x96, 0x64, 0x6A, 0x10, 0xF0, 0x24, 0x6C, -+0x01, 0x4E, 0x58, 0xEE, 0x94, 0xF3, 0x01, 0x4C, -+0x00, 0x6D, 0xF1, 0x67, 0x04, 0xD0, 0x12, 0xEE, -+0x00, 0x18, 0xAB, 0xE3, 0x06, 0x10, 0x10, 0xF0, -+0x24, 0x6C, 0x94, 0xF3, 0x01, 0x4C, 0x00, 0x18, -+0x98, 0xE3, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x60, 0xA4, 0x01, 0x6A, -+0x04, 0x67, 0x4C, 0xEB, 0x68, 0x23, 0x61, 0xA4, -+0x08, 0x5B, 0x17, 0x60, 0x10, 0xF0, 0x24, 0x6C, -+0x95, 0xF5, 0xA0, 0x9C, 0xC7, 0x43, 0x22, 0x67, -+0xE0, 0x9D, 0x10, 0x4B, 0x01, 0x4E, 0x82, 0x67, -+0x24, 0xEB, 0x84, 0xEE, 0x71, 0x67, 0xED, 0xEB, -+0x8F, 0xEC, 0x6C, 0xEC, 0x60, 0xA0, 0x66, 0x33, -+0x4C, 0xEB, 0x64, 0xEE, 0x6D, 0xEC, 0x80, 0xDD, -+0x15, 0x10, 0x10, 0xF0, 0x24, 0x6C, 0x95, 0xF5, -+0xC4, 0x9C, 0x87, 0x43, 0x01, 0x4C, 0xA0, 0x9E, -+0xE2, 0x67, 0xE4, 0xEC, 0x87, 0x67, 0xAD, 0xEC, -+0xA2, 0x67, 0xA4, 0xEB, 0xAF, 0xED, 0xAC, 0xEC, -+0xA0, 0xA0, 0xA6, 0x35, 0x4C, 0xED, 0xA4, 0xEB, -+0xAD, 0xEC, 0x80, 0xDE, 0x41, 0xA0, 0x08, 0x5A, -+0x07, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF5, -+0x80, 0x9B, 0x08, 0x4A, 0xA0, 0x9C, 0x05, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF5, 0x84, 0x9B, -+0xA0, 0x9C, 0x01, 0x6B, 0x64, 0xEA, 0xAE, 0xEB, -+0x60, 0xDC, 0x80, 0xA0, 0x00, 0x6D, 0x92, 0x34, -+0x00, 0x18, 0x31, 0xC9, 0x80, 0xA0, 0x01, 0x6D, -+0x22, 0x67, 0x92, 0x34, 0x00, 0x18, 0x31, 0xC9, -+0x9D, 0x67, 0x24, 0x6B, 0x70, 0xC4, 0x08, 0x6B, -+0x6F, 0xCC, 0x22, 0x33, 0x73, 0xC4, 0x62, 0x33, -+0x74, 0xC4, 0x56, 0xC4, 0x42, 0x33, 0x00, 0xF6, -+0x42, 0x32, 0x59, 0xC4, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x58, 0x9A, 0x32, 0xC4, 0x77, 0xC4, -+0x00, 0xF6, 0x22, 0x31, 0x62, 0x33, 0x35, 0xC4, -+0x78, 0xC4, 0x04, 0x04, 0x40, 0xEA, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x24, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0x28, 0xF5, -+0x1C, 0x4C, 0xB1, 0x67, 0x05, 0x6E, 0x30, 0xF0, -+0x20, 0x68, 0x40, 0xEA, 0xC0, 0xF1, 0x08, 0x48, -+0x46, 0xA1, 0xC8, 0xF3, 0x99, 0xA0, 0x7F, 0x6B, -+0x5E, 0x32, 0x5C, 0x32, 0x8C, 0xEB, 0x4D, 0xEB, -+0xC8, 0xF3, 0x79, 0xC0, 0x46, 0xA1, 0x1F, 0x6C, -+0x68, 0xF3, 0xB7, 0xA0, 0x4C, 0xEC, 0x20, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x8D, 0xEA, 0xC8, 0xF3, -+0x59, 0xC0, 0x66, 0xA1, 0x03, 0x6C, 0xB6, 0x35, -+0x76, 0x33, 0x8C, 0xEB, 0x74, 0x34, 0x61, 0x6B, -+0x6B, 0xEB, 0x4C, 0xEB, 0x8D, 0xEB, 0x91, 0x67, -+0xC8, 0xF3, 0x79, 0xC0, 0x00, 0x18, 0x76, 0xCF, -+0x68, 0xF3, 0x58, 0xA0, 0x0C, 0x72, 0x04, 0x61, -+0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0xA7, 0xD3, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0x6C, 0xF5, 0x15, 0x4A, 0x08, 0xD4, 0x40, 0xDB, -+0x41, 0xA4, 0x24, 0x67, 0x06, 0xD2, 0x60, 0xA4, -+0x02, 0x6A, 0x6C, 0xEA, 0x06, 0x93, 0x07, 0xD3, -+0x02, 0x22, 0x42, 0xA4, 0x07, 0xD2, 0x06, 0x90, -+0x1C, 0x10, 0x08, 0x93, 0x01, 0x6D, 0x90, 0x67, -+0x40, 0xA3, 0x4C, 0xED, 0x00, 0x18, 0xB1, 0xC8, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, -+0x90, 0x67, 0x40, 0xEA, 0x05, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF5, 0x54, 0x9A, 0x04, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x50, 0x9A, -+0x90, 0x67, 0x40, 0xEA, 0x01, 0x48, 0xFF, 0x6A, -+0x4C, 0xE8, 0x07, 0x92, 0x03, 0xEA, 0xE1, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, 0x94, 0xA2, -+0x06, 0x92, 0x8E, 0xEA, 0x22, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, 0x40, 0xEA, -+0x1C, 0x2A, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x00, 0x18, 0x1E, 0xE7, 0x68, 0xF3, -+0x97, 0xA0, 0x96, 0x34, 0x00, 0x18, 0x40, 0xCC, -+0x68, 0xF3, 0x79, 0xA0, 0x05, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x68, 0xF3, 0x7A, 0xA0, 0x68, 0xF3, -+0x59, 0xC0, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x03, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x68, 0xF3, -+0x5A, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x60, 0xA1, -+0xCC, 0xF1, 0x50, 0xA2, 0x72, 0x34, 0x15, 0x2A, -+0x04, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x10, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF4, -+0x4C, 0x9A, 0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF5, 0x6C, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF0, 0x50, 0x9A, 0x60, 0xDA, -+0xF0, 0x17, 0x05, 0x74, 0x15, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xCC, 0xF1, 0x52, 0xA2, 0x10, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF4, 0x4C, 0x9A, -+0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF5, 0x70, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF0, 0x50, 0x9A, 0x60, 0xDA, 0xF0, 0x17, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x1C, 0x23, 0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x69, 0xF3, 0x68, 0xC2, 0x00, 0x18, 0xED, 0xE2, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x04, 0x93, -+0xEF, 0xF5, 0x5C, 0x9A, 0x6E, 0xEA, 0x03, 0x22, -+0x04, 0x94, 0x00, 0x18, 0x0E, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF3, -+0x88, 0xA2, 0x02, 0x6B, 0x8D, 0xEB, 0x69, 0xF3, -+0x68, 0xC2, 0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, -+0x07, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, 0x68, 0x44, -+0xC8, 0x4B, 0x4C, 0xEB, 0x20, 0x5B, 0x05, 0x67, -+0x09, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, -+0x5A, 0xA2, 0x80, 0xF0, 0x0B, 0x2A, 0x80, 0x18, -+0x68, 0x14, 0x88, 0x10, 0x1F, 0x74, 0x53, 0x60, -+0x20, 0x5C, 0x18, 0x60, 0x0A, 0x74, 0x3B, 0x60, -+0x0B, 0x5C, 0x08, 0x60, 0x01, 0x74, 0x2F, 0x60, -+0x2A, 0x24, 0x08, 0x74, 0x30, 0x60, 0x09, 0x74, -+0x36, 0x60, 0x69, 0x10, 0x0D, 0x74, 0x3F, 0x60, -+0x0E, 0x5C, 0x03, 0x60, 0x0C, 0x74, 0x37, 0x60, -+0x62, 0x10, 0x13, 0x74, 0x30, 0x60, 0x1E, 0x74, -+0x3E, 0x60, 0x5D, 0x10, 0x2C, 0x74, 0x47, 0x60, -+0x2D, 0x5C, 0x09, 0x60, 0x21, 0x74, 0x66, 0x60, -+0x21, 0x5C, 0x39, 0x61, 0x23, 0x74, 0x62, 0x60, -+0x26, 0x74, 0x39, 0x60, 0x50, 0x10, 0xC3, 0x74, -+0x4A, 0x60, 0xC4, 0x5C, 0x03, 0x60, 0xC2, 0x74, -+0x42, 0x60, 0x49, 0x10, 0xC9, 0x74, 0x37, 0x60, -+0xCB, 0x74, 0x39, 0x60, 0x44, 0x10, 0x85, 0x67, -+0x00, 0x18, 0xF0, 0xD6, 0x4F, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x5D, 0xD9, 0x4B, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x48, 0xC6, 0x47, 0x10, 0x85, 0x67, -+0x00, 0x18, 0xF3, 0xC3, 0x43, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x78, 0xC4, 0x3F, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x39, 0xC7, 0x3B, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x39, 0xD5, 0x37, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x22, 0xD4, 0x33, 0x10, 0x85, 0x67, -+0x00, 0x18, 0xB6, 0xC6, 0x2F, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x1F, 0xC7, 0x2B, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x3A, 0xD9, 0x27, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x9E, 0xC7, 0x23, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x6B, 0xC7, 0x1F, 0x10, 0x85, 0x67, -+0x00, 0x18, 0xFF, 0xD8, 0x1B, 0x10, 0x85, 0x67, -+0x00, 0x18, 0xDC, 0xD8, 0x17, 0x10, 0x85, 0x67, -+0x00, 0x18, 0xA6, 0xC6, 0x13, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x64, 0xDB, 0x0F, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, 0x01, 0x6D, -+0x40, 0x9B, 0xAD, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF0, 0x58, 0x9A, 0x80, 0xC2, -+0x0E, 0x6A, 0x01, 0x10, 0x00, 0x6A, 0x40, 0xC0, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0x2D, 0xF0, 0x19, 0x4A, 0x10, 0xF0, -+0x30, 0x68, 0x40, 0xDB, 0x00, 0xF0, 0x00, 0x48, -+0x40, 0xF0, 0x40, 0xA0, 0x40, 0xF0, 0x61, 0xA0, -+0x4E, 0xEB, 0x29, 0x23, 0x4C, 0x32, 0x0D, 0xE2, -+0x80, 0xA3, 0xA1, 0x42, 0xB5, 0xE0, 0x00, 0x18, -+0xBD, 0xD9, 0x40, 0xF0, 0x40, 0xA0, 0x01, 0x4A, -+0x40, 0xF0, 0x40, 0xC0, 0x40, 0xF0, 0x60, 0xA0, -+0x40, 0xF0, 0x41, 0xA0, 0x6E, 0xEA, 0x0A, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x02, 0x6C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0x40, 0xF0, 0x60, 0xA2, -+0x08, 0x6C, 0x8E, 0xEB, 0x02, 0x2B, 0x40, 0xF0, -+0x60, 0xC2, 0x00, 0x18, 0x92, 0xD7, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x30, 0x68, 0x00, 0xF0, 0x00, 0x48, 0xC1, 0xF7, -+0x66, 0xA0, 0x7F, 0x6C, 0xA7, 0x43, 0x6F, 0x4D, -+0xB4, 0x35, 0xB5, 0xE0, 0x46, 0xA5, 0x8C, 0xEA, -+0x20, 0x2A, 0x74, 0x33, 0x69, 0xE0, 0xC1, 0xF6, -+0x8E, 0xA2, 0xA2, 0x67, 0xC1, 0xF6, 0x0F, 0x4D, -+0x00, 0x18, 0xBD, 0xD9, 0xC1, 0xF7, 0x46, 0xA0, -+0x10, 0xF0, 0x24, 0x6C, 0x95, 0xF5, 0x94, 0x9C, -+0x54, 0x33, 0x6D, 0xE0, 0xC1, 0xF6, 0xAC, 0xA3, -+0x76, 0x4A, 0x54, 0x32, 0xA0, 0xC4, 0xC1, 0xF6, -+0x8D, 0xA3, 0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF5, -+0x78, 0x9B, 0x41, 0xE0, 0x80, 0xC3, 0x86, 0x40, -+0x49, 0x10, 0x01, 0x72, 0x49, 0x61, 0x74, 0x33, -+0x6D, 0xE0, 0xC1, 0xF6, 0x47, 0xA3, 0xFF, 0x72, -+0x0C, 0x61, 0xC1, 0xF6, 0x88, 0xA3, 0x06, 0x4D, -+0x00, 0x18, 0xB6, 0xD8, 0xC1, 0xF7, 0x66, 0xA0, -+0x74, 0x33, 0x61, 0xE0, 0xC1, 0xF6, 0x4E, 0xC0, -+0x04, 0x10, 0x01, 0x6A, 0x4B, 0xEA, 0xC1, 0xF6, -+0x4E, 0xC3, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, 0x10, 0xF0, -+0x24, 0x6D, 0x95, 0xF5, 0xB4, 0x9D, 0x74, 0x34, -+0x91, 0xE2, 0xC1, 0xF6, 0xCC, 0xA4, 0x76, 0x4B, -+0x74, 0x33, 0xC0, 0xC5, 0xC1, 0xF6, 0xAD, 0xA4, -+0x10, 0xF0, 0x24, 0x6C, 0x95, 0xF5, 0x98, 0x9C, -+0x69, 0xE2, 0xA0, 0xC4, 0x46, 0x82, 0x00, 0x52, -+0x0B, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, -+0x7C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x35, 0xF1, -+0x8C, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0x66, 0xA2, 0x76, 0x4B, 0x74, 0x33, -+0x69, 0xE2, 0x86, 0x42, 0x00, 0x18, 0x4D, 0xD8, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0xCD, 0xF1, 0x01, 0x4A, 0x10, 0xF0, -+0x30, 0x68, 0x40, 0xDB, 0x00, 0xF0, 0x00, 0x48, -+0xC1, 0xF7, 0x66, 0xA0, 0xC1, 0xF7, 0x47, 0xA0, -+0x6E, 0xEA, 0x4A, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x18, 0x4A, 0xA0, 0xF0, 0x64, 0xAA, -+0x01, 0xF0, 0x00, 0x73, 0x10, 0x60, 0xA0, 0xF0, -+0x85, 0xA2, 0xA0, 0xF0, 0x44, 0xA2, 0xAE, 0x42, -+0x8E, 0xED, 0x09, 0x25, 0x01, 0xF1, 0x01, 0x73, -+0x06, 0x60, 0x01, 0xF1, 0x00, 0x73, 0x03, 0x60, -+0xFF, 0x4A, 0x4E, 0xEC, 0x0D, 0x2C, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x80, 0xF0, -+0x4C, 0x9B, 0x04, 0x6C, 0x8D, 0xEA, 0x02, 0x6C, -+0x8D, 0xEA, 0x80, 0xF0, 0x4C, 0xDB, 0x24, 0x10, -+0x00, 0x18, 0x30, 0xDA, 0xC1, 0xF7, 0x46, 0xA0, -+0x01, 0x4A, 0xC1, 0xF7, 0x46, 0xC0, 0xC1, 0xF7, -+0x66, 0xA0, 0xC1, 0xF7, 0x47, 0xA0, 0x6E, 0xEA, -+0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, 0x02, 0x6C, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, -+0x66, 0xA2, 0x08, 0x6C, 0x8E, 0xEB, 0x02, 0x2B, -+0xC1, 0xF7, 0x66, 0xC2, 0x00, 0x18, 0xFD, 0xD6, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x44, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, -+0x6C, 0xEC, 0x40, 0xEA, 0x05, 0x2A, 0x01, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, 0x7B, 0xC2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xE0, 0xF1, 0x14, 0x68, 0x0A, 0xD4, 0x24, 0x67, -+0x90, 0x67, 0x04, 0x05, 0x00, 0x18, 0xA2, 0xDA, -+0x7D, 0x67, 0x50, 0xA3, 0x01, 0x48, 0xE0, 0xF1, -+0x1A, 0x70, 0x40, 0xC1, 0x01, 0x49, 0xF4, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x0C, 0xF0, 0x6D, 0xA2, 0x0C, 0xF0, 0x8E, 0xA2, -+0x6C, 0x33, 0x94, 0x34, 0x8D, 0xEB, 0x0C, 0xF0, -+0x8C, 0xA2, 0x8D, 0xEB, 0x0A, 0x94, 0x66, 0xC4, -+0x0C, 0xF0, 0x6F, 0xA2, 0x0C, 0xF0, 0x50, 0xA2, -+0x68, 0x33, 0x58, 0x32, 0x4D, 0xEB, 0x33, 0x6A, -+0x4D, 0xEB, 0x67, 0xC4, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xE0, 0xF1, 0x10, 0x68, 0x0A, 0xD4, 0x24, 0x67, -+0x90, 0x67, 0x04, 0x05, 0x00, 0x18, 0xA2, 0xDA, -+0x7D, 0x67, 0x50, 0xA3, 0x01, 0x48, 0xE0, 0xF1, -+0x14, 0x70, 0x40, 0xC1, 0x01, 0x49, 0xF4, 0x61, -+0xE0, 0xF1, 0x1C, 0x6C, 0x04, 0x05, 0x00, 0x18, -+0xA2, 0xDA, 0x7D, 0x67, 0x50, 0xA3, 0x0A, 0x93, -+0x44, 0xC3, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD0, 0x04, 0x00, 0x90, 0x67, 0x00, 0x18, -+0xAC, 0xDA, 0xA0, 0xF1, 0x02, 0x6A, 0x1F, 0xF7, -+0x00, 0x6B, 0x4C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF1, 0x60, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x15, 0xF1, 0x64, 0x9B, 0x80, 0xA0, -+0x6D, 0xE2, 0x01, 0x4A, 0xA0, 0xF1, 0x0A, 0x72, -+0x80, 0xC3, 0x01, 0x48, 0xE8, 0x61, 0x04, 0x00, -+0x90, 0x67, 0x00, 0x18, 0xC6, 0xDA, 0xA0, 0xF1, -+0x0A, 0x6A, 0x1F, 0xF7, 0x00, 0x6B, 0x4C, 0xEB, -+0x02, 0xF0, 0x00, 0x73, 0x01, 0x60, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF1, 0x60, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF1, -+0x64, 0x9B, 0x80, 0xA0, 0x6D, 0xE2, 0x01, 0x4A, -+0xA0, 0xF1, 0x0F, 0x72, 0x80, 0xC3, 0x01, 0x48, -+0xE8, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF5, -+0x5C, 0x9A, 0x19, 0x6B, 0x60, 0xC2, 0x09, 0x97, -+0x08, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x0C, 0xF0, -+0x4C, 0xA0, 0x0B, 0x2A, 0xE0, 0xF1, 0x1A, 0x6C, -+0x04, 0x05, 0x00, 0x18, 0xA2, 0xDA, 0x9D, 0x67, -+0x70, 0xA4, 0x07, 0x6A, 0x6C, 0xEA, 0x0C, 0xF0, -+0x4C, 0xC0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x0C, 0xF0, 0x4E, 0xA0, 0x0A, 0x2A, -+0xE0, 0xF1, 0x1A, 0x6C, 0x04, 0x05, 0x00, 0x18, -+0xA2, 0xDA, 0x7D, 0x67, 0x50, 0xA3, 0x56, 0x32, -+0x0C, 0xF0, 0x4E, 0xC0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x0C, 0xF0, 0x4F, 0xA0, -+0x0B, 0x2A, 0xE0, 0xF1, 0x1D, 0x6C, 0x04, 0x05, -+0x00, 0x18, 0xA2, 0xDA, 0x9D, 0x67, 0x70, 0xA4, -+0x03, 0x6A, 0x6C, 0xEA, 0x0C, 0xF0, 0x4F, 0xC0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x0C, 0xF0, 0x50, 0xA0, 0x0C, 0x2A, 0xE0, 0xF1, -+0x1D, 0x6C, 0x04, 0x05, 0x00, 0x18, 0xA2, 0xDA, -+0x7D, 0x67, 0x50, 0xA3, 0x30, 0x6B, 0x6C, 0xEA, -+0x53, 0x32, 0x0C, 0xF0, 0x50, 0xC0, 0x07, 0x97, -+0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0x04, 0x01, 0xC0, 0xF1, -+0x08, 0x48, 0x01, 0x6A, 0xE0, 0xF1, 0x1B, 0x6C, -+0xB1, 0x67, 0x0C, 0xF0, 0x48, 0xC0, 0x0C, 0xF0, -+0x49, 0xC0, 0x0C, 0xF0, 0x4A, 0xC0, 0x0C, 0xF0, -+0x4B, 0xC0, 0x00, 0x18, 0xA2, 0xDA, 0x9D, 0x67, -+0x70, 0xA4, 0x07, 0x6A, 0xE0, 0xF1, 0x1D, 0x6C, -+0x6C, 0xEA, 0x0C, 0xF0, 0x4C, 0xC0, 0x18, 0x6A, -+0x6C, 0xEA, 0x4F, 0x32, 0x76, 0x33, 0xB1, 0x67, -+0x0C, 0xF0, 0x4D, 0xC0, 0x0C, 0xF0, 0x6E, 0xC0, -+0x00, 0x18, 0xA2, 0xDA, 0x5D, 0x67, 0x70, 0xA2, -+0x0C, 0x6A, 0x6C, 0xEA, 0x4B, 0x32, 0x7A, 0x33, -+0x0C, 0xF0, 0x4F, 0xC0, 0x0C, 0xF0, 0x70, 0xC0, -+0x00, 0x18, 0xFC, 0xDA, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF5, 0x5C, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0xFD, 0x72, 0x02, 0x61, 0x00, 0x18, -+0xD7, 0xDA, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x22, 0x6A, 0x7D, 0x67, 0x50, 0xC3, 0x01, 0x6A, -+0x4F, 0xCB, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x58, 0x9A, 0x92, 0xC3, 0x04, 0x04, 0x40, 0xEA, -+0x09, 0x97, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x1A, 0x6A, 0x7D, 0x67, -+0x50, 0xC3, 0x00, 0xF0, 0x12, 0x04, 0x05, 0x6A, -+0x4F, 0xCB, 0x00, 0x18, 0xC6, 0xDA, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, -+0x40, 0xEA, 0x09, 0x97, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x19, 0x6A, 0x7D, 0x67, -+0x50, 0xC3, 0x00, 0xF0, 0x12, 0x04, 0x08, 0x6A, -+0x4F, 0xCB, 0x00, 0x18, 0xAC, 0xDA, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, -+0x40, 0xEA, 0x09, 0x97, 0x05, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x40, 0xA4, 0x01, 0x72, -+0x04, 0x61, 0x00, 0x18, 0x5A, 0xDB, 0x00, 0x18, -+0x50, 0xDB, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x00, 0x6B, 0x0C, 0xF5, 0x7A, 0xC2, 0x00, 0x6B, -+0x0C, 0xF5, 0x78, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x8C, 0xEA, 0x08, 0x5A, 0x05, 0x60, -+0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF5, 0x60, 0x9B, -+0x05, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF5, -+0x64, 0x9B, 0xF8, 0x4A, 0x01, 0x6C, 0xA0, 0x9B, -+0x84, 0xEA, 0x00, 0xF6, 0x80, 0x32, 0x4F, 0xEA, -+0xAC, 0xEA, 0x40, 0xDB, 0x40, 0x9B, 0x80, 0x34, -+0x80, 0x34, 0x8F, 0xEC, 0x4C, 0xEC, 0x80, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0x08, 0x5C, 0xAC, 0xEA, 0x05, 0x60, 0x10, 0xF0, -+0x24, 0x6B, 0x95, 0xF5, 0x60, 0x9B, 0x05, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF5, 0x64, 0x9B, -+0xF8, 0x4C, 0x01, 0x6D, 0xC0, 0x9B, 0xA4, 0xEC, -+0x00, 0xF6, 0xA0, 0x34, 0x8F, 0xEC, 0xCC, 0xEC, -+0x80, 0xDB, 0xC0, 0x9B, 0xA0, 0x35, 0xA0, 0x34, -+0xCD, 0xEC, 0x80, 0xDB, 0x04, 0x22, 0x40, 0x9B, -+0xAD, 0xEA, 0x40, 0xDB, 0x20, 0xE8, 0x40, 0x9B, -+0xAF, 0xED, 0x4C, 0xED, 0xA0, 0xDB, 0x20, 0xE8, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0xFF, 0x69, 0x0C, 0xF5, 0x5A, 0xA0, 0x0C, 0xF5, -+0x7B, 0xA0, 0x2C, 0xEC, 0x01, 0x74, 0x05, 0xD2, -+0x04, 0xD3, 0x5A, 0x60, 0x0C, 0xF5, 0x98, 0xA0, -+0x80, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, 0x2C, 0xEA, -+0x53, 0x22, 0x0C, 0xF5, 0xB8, 0xA0, 0x01, 0x6B, -+0x0F, 0x6A, 0xBA, 0x35, 0x4C, 0xEC, 0x6E, 0xED, -+0x6C, 0xED, 0x2C, 0xEC, 0x00, 0x18, 0x7F, 0xDB, -+0x0C, 0xF5, 0xB8, 0xA0, 0x0C, 0xF5, 0x98, 0xA0, -+0x0F, 0x6A, 0x01, 0x6B, 0xBA, 0x35, 0x4C, 0xEC, -+0x6C, 0xED, 0x2C, 0xEC, 0x2C, 0xED, 0x00, 0x18, -+0x7F, 0xDB, 0x0C, 0xF5, 0x78, 0xA0, 0x20, 0x6A, -+0x6C, 0xEA, 0x2C, 0xEA, 0x24, 0x22, 0x05, 0x92, -+0x01, 0x6B, 0x54, 0x36, 0x0C, 0xF5, 0x59, 0xA0, -+0x6C, 0xEA, 0x2C, 0xEA, 0x09, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, 0xFF, 0x6C, -+0x59, 0x4C, 0x00, 0x6D, 0x40, 0xEA, 0x13, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x86, 0x67, 0x40, 0xEA, 0x0C, 0xF5, 0xB8, 0xA0, -+0x0C, 0xF5, 0x98, 0xA0, 0x01, 0x6B, 0x0F, 0x6A, -+0xBA, 0x35, 0x4C, 0xEC, 0x6E, 0xED, 0x2C, 0xEC, -+0x6C, 0xED, 0x00, 0x18, 0x7F, 0xDB, 0x30, 0xF0, -+0x20, 0x6A, 0xEC, 0xF6, 0x60, 0xA2, 0x10, 0x6A, -+0x6C, 0xEA, 0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x04, 0x93, 0xAE, 0xF2, 0x50, 0x9A, 0xFF, 0x6C, -+0x59, 0x4C, 0x00, 0x6D, 0x6C, 0x36, 0x40, 0xEA, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x00, 0x6A, 0x7D, 0x67, 0x52, 0xC3, 0x14, 0x6A, -+0x50, 0xC3, 0x01, 0x6A, 0x4F, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, -+0x40, 0xEA, 0x09, 0x97, 0x05, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xEC, 0xF6, 0x80, 0xA2, 0x80, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x1A, 0x22, -+0x10, 0x6A, 0x8C, 0xEA, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0xCB, 0xDB, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x0C, 0xF5, 0x99, 0xA3, -+0x01, 0x6A, 0x4C, 0xEC, 0x0B, 0x24, 0x0C, 0xF5, -+0xB8, 0xA3, 0x0F, 0x6C, 0xFF, 0x6B, 0xAC, 0xEC, -+0xBA, 0x35, 0x4E, 0xED, 0x6C, 0xEC, 0x4C, 0xED, -+0x00, 0x18, 0x7F, 0xDB, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0xF7, 0x1F, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0x8C, 0xEA, 0xB5, 0xF5, -+0x60, 0x9B, 0x10, 0xF0, 0x24, 0x6C, 0xB5, 0xF5, -+0x84, 0x9C, 0xCC, 0xEB, 0x40, 0xF6, 0xA0, 0x35, -+0x8D, 0xEB, 0x1F, 0xF7, 0x00, 0x6C, 0x4C, 0xEC, -+0x02, 0xF0, 0x00, 0x74, 0xAD, 0xEB, 0x01, 0x60, -+0x05, 0x2C, 0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF1, -+0x80, 0x9C, 0x04, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0x15, 0xF1, 0x84, 0x9C, 0x89, 0xE2, 0x60, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0xF7, 0x1F, 0x6A, -+0x8C, 0xEA, 0x1F, 0xF7, 0x00, 0x6C, 0x4C, 0xEC, -+0xFF, 0x6B, 0x02, 0xF0, 0x00, 0x74, 0xAC, 0xEB, -+0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, 0x24, 0x6C, -+0x15, 0xF1, 0x80, 0x9C, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6C, 0x15, 0xF1, 0x84, 0x9C, 0x91, 0xE2, -+0x00, 0x6D, 0xA0, 0xDC, 0x10, 0xF0, 0x24, 0x6C, -+0xB5, 0xF5, 0x80, 0x9C, 0xD4, 0x36, 0x40, 0xF6, -+0x60, 0x33, 0x8C, 0xEE, 0x6D, 0xEE, 0x10, 0xF0, -+0x24, 0x6B, 0xB5, 0xF5, 0x64, 0x9B, 0x6D, 0xEE, -+0x1F, 0xF7, 0x00, 0x6B, 0x4C, 0xEB, 0x02, 0xF0, -+0x00, 0x73, 0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, -+0x24, 0x6B, 0x15, 0xF1, 0x60, 0x9B, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF1, 0x64, 0x9B, -+0x69, 0xE2, 0xC0, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x0F, 0xF5, 0x00, 0x6B, 0x78, 0xEE, 0xFF, 0xF7, -+0x1F, 0x6A, 0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6C, -+0xB5, 0xF5, 0x80, 0x9C, 0x40, 0xF6, 0xA0, 0x35, -+0x12, 0xEB, 0x8C, 0xEB, 0x10, 0xF0, 0x24, 0x6C, -+0xB5, 0xF5, 0x84, 0x9C, 0xAD, 0xEB, 0x8D, 0xEB, -+0x1F, 0xF7, 0x00, 0x6C, 0x4C, 0xEC, 0x02, 0xF0, -+0x00, 0x74, 0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, -+0x24, 0x6C, 0x15, 0xF1, 0x80, 0x9C, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF1, 0x84, 0x9C, -+0x89, 0xE2, 0x60, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF4, 0x44, 0x9A, -+0x40, 0x9A, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x4C, 0x9B, 0x8D, 0xEA, -+0x4C, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF5, -+0x7C, 0x9B, 0x80, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF5, 0x60, 0x9B, 0x40, 0xDB, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF5, 0x64, 0x9A, 0xC0, 0x6A, -+0xFF, 0x68, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF5, 0x48, 0x9A, 0x01, 0x6B, 0x05, 0x97, -+0x40, 0xA2, 0x0C, 0xEA, 0x5E, 0x32, 0x6E, 0xEA, -+0x6C, 0xEA, 0x0C, 0xEA, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, -+0x70, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x2E, 0xF1, -+0x05, 0x4A, 0x40, 0xDB, 0x00, 0x68, 0x28, 0x10, -+0x82, 0xF3, 0x08, 0x70, 0x11, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, 0x02, 0xF0, -+0x00, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF2, 0x50, 0x9A, -+0x03, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, 0x18, 0x10, -+0xFF, 0xF7, 0x1F, 0x6A, 0x01, 0x48, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x14, 0x6C, 0x40, 0xEA, 0x33, 0x58, 0x08, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF5, 0x4C, 0x9A, -+0x60, 0xA2, 0x08, 0x6A, 0x6C, 0xEA, 0x04, 0x2A, -+0x00, 0x18, 0x38, 0xDC, 0x01, 0x72, 0xD4, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF2, 0x50, 0x9A, -+0x02, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0x2E, 0xF1, 0x06, 0x4A, 0x40, 0xDB, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0x05, 0x5C, 0x5E, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x88, 0x34, 0xF4, 0xF7, 0x0C, 0x4A, 0x89, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x48, 0x9B, 0xAD, 0xEA, 0xC0, 0xF1, -+0x48, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF5, -+0x78, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF5, 0x70, 0x9B, 0x32, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x41, 0x9B, -+0xAD, 0xEA, 0x41, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF5, 0x74, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF5, 0x78, 0x9B, 0x21, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x42, 0x9B, 0xAD, 0xEA, 0x42, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF5, 0x7C, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF5, 0x60, 0x9B, -+0x10, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x43, 0x9B, 0xAD, 0xEA, 0x43, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF5, 0x64, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF5, -+0x68, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x44, 0x9B, -+0xAD, 0xEA, 0x44, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF5, 0x6C, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF5, 0x70, 0x9B, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x05, 0x5C, 0x63, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, 0x15, 0xF0, -+0x00, 0x4A, 0x89, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x88, 0x9B, -+0xAF, 0xEA, 0x8C, 0xEA, 0xC0, 0xF1, 0x48, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF5, 0x70, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF5, -+0x58, 0x9A, 0x35, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x81, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x41, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF5, 0x78, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF5, 0x54, 0x9A, 0x23, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x82, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x42, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF5, 0x60, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF5, -+0x5C, 0x9A, 0x11, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x83, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x43, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF5, 0x68, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF5, 0x44, 0x9A, 0xA0, 0xDA, -+0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x84, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, -+0x44, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF5, -+0x70, 0x9B, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF5, 0x4C, 0x9A, 0xA0, 0xDA, 0x20, 0xE8, -+0x01, 0x74, 0x15, 0x60, 0x03, 0x24, 0x02, 0x74, -+0x23, 0x60, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x4E, 0x9B, 0xAD, 0xEA, -+0x4E, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF1, -+0x78, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF5, 0x74, 0x9B, 0x21, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x4F, 0x9B, -+0xAD, 0xEA, 0x4F, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF5, 0x78, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF5, 0x7C, 0x9B, 0x10, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x50, 0x9B, 0xAD, 0xEA, 0x50, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0x15, 0xF6, 0x60, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF6, 0x64, 0x9B, -+0x40, 0xDB, 0x20, 0xE8, 0x01, 0x74, 0x16, 0x60, -+0x03, 0x24, 0x02, 0x74, 0x25, 0x60, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x8E, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x4E, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF5, 0x74, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, -+0x58, 0x9A, 0x23, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x8F, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x4F, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF5, 0x7C, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF5, 0x58, 0x9A, 0x11, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x90, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x50, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF6, 0x64, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, -+0x40, 0x9A, 0xA0, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6C, 0xD5, 0xF5, 0x90, 0x9C, -+0x00, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x48, 0xDB, 0xC0, 0xF1, 0x08, 0x4B, 0x41, 0xDB, -+0x42, 0xDB, 0x43, 0xDB, 0x44, 0xDB, 0x40, 0xDC, -+0x10, 0xF0, 0x24, 0x6C, 0xD5, 0xF5, 0x98, 0x9C, -+0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6C, 0xF5, 0xF5, -+0x80, 0x9C, 0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6C, -+0xF5, 0xF5, 0x88, 0x9C, 0x40, 0xDC, 0x10, 0xF0, -+0x24, 0x6C, 0xF5, 0xF5, 0x90, 0x9C, 0x40, 0xDC, -+0x10, 0xF0, 0x24, 0x6C, 0xF5, 0xF5, 0x94, 0x9C, -+0x4E, 0xDB, 0x4F, 0xDB, 0x40, 0xDC, 0x10, 0xF0, -+0x24, 0x6C, 0xF5, 0xF5, 0x9C, 0x9C, 0x40, 0xDC, -+0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF6, 0x84, 0x9C, -+0x50, 0xDB, 0x40, 0xDC, 0x4C, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF5, 0x60, 0x9B, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0x75, 0xF5, 0x78, 0x9B, 0x01, 0x6A, 0x4B, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF5, -+0x74, 0x9B, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF5, 0x7C, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF5, 0x64, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF1, 0x78, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF5, -+0x78, 0x9B, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF6, 0x64, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xB5, 0xF5, 0x7C, 0x9B, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0x05, 0x5C, 0x4C, 0xED, 0x00, 0x6A, 0x61, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, 0x15, 0xF0, -+0x14, 0x4A, 0x89, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x05, 0x2D, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, -+0x50, 0x9A, 0x0A, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF6, 0x50, 0x9A, 0x0C, 0x10, 0x07, 0x2D, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, 0x54, 0x9A, -+0x60, 0xA2, 0x01, 0x6A, 0x39, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF6, 0x54, 0x9A, 0x60, 0xA2, -+0xFF, 0x6A, 0x6C, 0xEA, 0x46, 0x32, 0x2F, 0x10, -+0x09, 0x2D, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, -+0x54, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, -+0x4A, 0x32, 0x25, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF6, 0x54, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0x4E, 0x32, 0x1C, 0x10, 0x09, 0x2D, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, 0x54, 0x9A, -+0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, 0x52, 0x32, -+0x12, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, -+0x54, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, -+0x56, 0x32, 0x09, 0x10, 0x0B, 0x2D, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF6, 0x54, 0x9A, 0x60, 0xA2, -+0xFF, 0x6A, 0x6C, 0xEA, 0x5A, 0x32, 0x01, 0x6B, -+0x6C, 0xEA, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF6, 0x54, 0x9A, 0x40, 0xA2, 0x00, 0xF6, -+0x40, 0x32, 0x00, 0xF6, 0x43, 0x32, 0xC0, 0xF7, -+0x42, 0x32, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x69, 0x8C, 0xE9, -+0x00, 0x68, 0xFF, 0x6A, 0x0C, 0xEA, 0x2E, 0xEA, -+0x10, 0x2A, 0x91, 0x67, 0x00, 0x18, 0x21, 0xE6, -+0x91, 0x67, 0x00, 0x18, 0x10, 0xE6, 0x91, 0x67, -+0x00, 0x18, 0x28, 0xE6, 0x91, 0x67, 0x00, 0x18, -+0xE2, 0xE5, 0x91, 0x67, 0x00, 0x18, 0xEF, 0xE5, -+0x0F, 0x10, 0x90, 0x67, 0x00, 0x18, 0x47, 0xE6, -+0x90, 0x67, 0x00, 0x18, 0x36, 0xE6, 0x90, 0x67, -+0x00, 0x18, 0x4E, 0xE6, 0x90, 0x67, 0x00, 0x18, -+0x06, 0xE6, 0x90, 0x67, 0x00, 0x18, 0xFC, 0xE5, -+0x01, 0x48, 0x05, 0x70, 0xDA, 0x61, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0xFF, 0xF7, 0x1F, 0x69, -+0x8C, 0xE9, 0x35, 0xF2, 0x84, 0x9A, 0xFF, 0x6B, -+0x8E, 0x6A, 0xA0, 0xA4, 0x00, 0x68, 0x6C, 0xED, -+0xAC, 0xEA, 0x40, 0xC4, 0x71, 0x6A, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF2, 0x8C, 0x9A, 0x01, 0x6D, 0x40, 0xA4, -+0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x19, 0x10, 0x64, 0x70, 0x0D, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x95, 0xF1, 0x88, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, 0x1C, 0x10, -+0xFF, 0xF7, 0x1F, 0x6A, 0x01, 0x48, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF2, 0x4C, 0x9A, 0x60, 0xA2, 0x01, 0x6A, -+0x6C, 0xEA, 0xDF, 0x2A, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x49, 0x4C, 0xE9, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF2, 0x5C, 0x9A, 0x20, 0xCA, 0x01, 0x6A, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xFF, 0x69, 0x4E, 0xF2, 0x4C, 0x9B, 0x2C, 0xED, -+0xFF, 0xF7, 0x1F, 0x68, 0x11, 0xD7, 0x8C, 0xE8, -+0x08, 0xD5, 0x04, 0x04, 0x00, 0x6D, 0xCC, 0xE9, -+0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x4C, 0x9B, 0x05, 0x04, 0x00, 0x6D, -+0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x50, 0x9B, 0x11, 0x95, 0x04, 0x04, -+0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x50, 0x9B, 0x12, 0x95, 0x06, 0x04, -+0x04, 0x6E, 0x40, 0xEA, 0x00, 0xF1, 0x00, 0x58, -+0x08, 0x61, 0x0E, 0xF0, 0x40, 0x40, 0xFF, 0xF7, -+0x1F, 0x6B, 0x6C, 0xEA, 0x00, 0xF1, 0x00, 0x5A, -+0x39, 0x60, 0x08, 0x92, 0x04, 0x72, 0x11, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x40, 0x9A, -+0xFF, 0x6B, 0x49, 0xE0, 0x40, 0xA2, 0x4C, 0xEB, -+0x5F, 0x21, 0x06, 0x94, 0x8F, 0xEA, 0x6C, 0xEA, -+0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, 0x04, 0xD2, -+0x57, 0x10, 0x08, 0x92, 0x05, 0x72, 0x12, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x40, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6B, 0x49, 0xE0, 0x40, 0xAA, -+0x4C, 0xEB, 0x7F, 0x21, 0x06, 0x94, 0x8F, 0xEA, -+0x6C, 0xEA, 0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, -+0x04, 0xD2, 0x77, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x40, 0x9A, 0x49, 0xE0, 0x60, 0x9A, -+0x80, 0xF0, 0x1E, 0x21, 0x06, 0x94, 0x8F, 0xEA, -+0x6C, 0xEA, 0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, -+0x04, 0xD2, 0x96, 0x10, 0x01, 0xF0, 0x00, 0x58, -+0x09, 0x61, 0x0D, 0xF7, 0x40, 0x40, 0xFF, 0xF7, -+0x1F, 0x6B, 0x6C, 0xEA, 0x00, 0xF7, 0x00, 0x5A, -+0x80, 0xF0, 0x17, 0x60, 0x08, 0x92, 0x04, 0x72, -+0x31, 0x61, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x40, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, -+0x44, 0x9A, 0x49, 0xE0, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0x07, 0x21, 0x06, 0x94, 0x8F, 0xEB, -+0x4C, 0xEB, 0x04, 0x92, 0x8C, 0xEA, 0x4D, 0xEB, -+0x04, 0xD3, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x40, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, -+0x44, 0x9A, 0x7D, 0x67, 0x41, 0xE0, 0x50, 0xA3, -+0x40, 0xC0, 0x7E, 0x10, 0x08, 0x92, 0x05, 0x72, -+0x32, 0x61, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x40, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, -+0x44, 0x9A, 0x49, 0xE0, 0x60, 0xAA, 0xFF, 0xF7, -+0x1F, 0x6A, 0x6C, 0xEA, 0x07, 0x21, 0x06, 0x94, -+0x8F, 0xEB, 0x4C, 0xEB, 0x04, 0x92, 0x8C, 0xEA, -+0x4D, 0xEB, 0x04, 0xD3, 0x1F, 0xF7, 0x00, 0x6A, -+0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, -+0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, -+0x40, 0x9A, 0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x44, 0x9A, 0x7D, 0x67, 0x41, 0xE0, -+0x48, 0xAB, 0x40, 0xC8, 0x49, 0x10, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x40, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x44, 0x9A, 0x49, 0xE0, -+0x60, 0x9A, 0x07, 0x21, 0x06, 0x94, 0x8F, 0xEA, -+0x6C, 0xEA, 0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, -+0x04, 0xD2, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x40, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, -+0x44, 0x9A, 0x41, 0xE0, 0x04, 0x92, 0x40, 0xD8, -+0x1B, 0x10, 0xFF, 0xF7, 0x1C, 0x6A, 0x0C, 0xEA, -+0x01, 0x6D, 0x82, 0x67, 0xAB, 0xED, 0x08, 0xD2, -+0x00, 0x18, 0x05, 0xE1, 0x05, 0xD2, 0x07, 0x21, -+0x06, 0x94, 0x8F, 0xEB, 0x4C, 0xEB, 0x04, 0x92, -+0x8C, 0xEA, 0x4D, 0xEB, 0x04, 0xD3, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x08, 0x94, -+0x04, 0x96, 0x01, 0x6D, 0xAB, 0xED, 0x40, 0xEA, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x41, 0x9C, 0x61, 0xA4, -+0x01, 0xAC, 0x06, 0xD2, 0x42, 0x9C, 0xFF, 0x73, -+0x07, 0xD2, 0x00, 0x6A, 0x59, 0x60, 0x7F, 0x6D, -+0x6C, 0xED, 0x4C, 0x45, 0xFF, 0x6B, 0x6C, 0xEA, -+0x0E, 0x5A, 0x08, 0x60, 0x10, 0xF0, 0x24, 0x6B, -+0x48, 0x32, 0x35, 0xF0, 0x08, 0x4B, 0x4D, 0xE3, -+0x40, 0x9B, 0x00, 0xEA, 0x03, 0x6A, 0x48, 0x10, -+0x61, 0xA4, 0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0xFF, 0x6E, 0x07, 0x03, 0x90, 0x67, 0x4C, 0xEE, -+0x06, 0x07, 0x04, 0xD3, 0x00, 0x18, 0xBB, 0xDD, -+0x1F, 0x10, 0x81, 0xA4, 0x80, 0x6A, 0xFF, 0x69, -+0x64, 0x67, 0x4C, 0xEB, 0x0C, 0xE9, 0x02, 0x32, -+0x01, 0x6E, 0x82, 0x67, 0xB1, 0x67, 0xCB, 0xEE, -+0x08, 0xD3, 0x09, 0xD2, 0x00, 0x18, 0x50, 0xE1, -+0x08, 0x93, 0x07, 0x23, 0x07, 0x94, 0x8F, 0xEB, -+0x4C, 0xEB, 0x06, 0x92, 0x8C, 0xEA, 0x4D, 0xEB, -+0x06, 0xD3, 0x09, 0x94, 0x06, 0x97, 0x01, 0x6E, -+0xB1, 0x67, 0xCB, 0xEE, 0x00, 0x18, 0x63, 0xE1, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x29, 0xF4, 0x7C, 0x9A, 0x06, 0x94, 0x61, 0xE0, -+0x49, 0xF4, 0x60, 0x9A, 0x29, 0xF4, 0x1C, 0xDA, -+0x6D, 0xE4, 0x49, 0xF4, 0x60, 0xDA, 0x0B, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x58, 0x9A, 0x90, 0x67, 0x40, 0xEA, 0x01, 0x6A, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF5, 0x9C, 0x9A, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xA0, 0x9C, 0x4C, 0x9B, -+0xAC, 0xEA, 0x4D, 0xDB, 0x40, 0xDC, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0xD1, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF5, 0x38, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF5, 0x14, 0x4A, 0x40, 0x9A, -+0x60, 0x99, 0x10, 0xF0, 0x24, 0x6C, 0xA0, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF5, 0x5C, 0x9A, -+0xF5, 0xF5, 0x04, 0x4C, 0x80, 0x9C, 0x00, 0x9A, -+0x1A, 0x65, 0x10, 0xF0, 0x24, 0x6A, 0x80, 0x9C, -+0xF5, 0xF5, 0x0C, 0x4A, 0x40, 0x9A, 0x01, 0xD4, -+0x30, 0xF0, 0x20, 0x6C, 0x40, 0x9A, 0xC0, 0xF1, -+0xE8, 0x9C, 0x00, 0xD2, 0x44, 0x67, 0xC0, 0xF1, -+0x08, 0x4A, 0xC1, 0x9A, 0x83, 0x9A, 0x6C, 0xEF, -+0xAC, 0xEE, 0x01, 0x93, 0xA2, 0x9A, 0xE5, 0xDA, -+0x6C, 0xEC, 0x0C, 0xED, 0x64, 0x9A, 0x00, 0x90, -+0x88, 0xDA, 0xC6, 0xDA, 0x0C, 0xEB, 0xA7, 0xDA, -+0x69, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF5, -+0x14, 0x4A, 0x40, 0x9A, 0xE0, 0xD9, 0x18, 0x67, -+0xC0, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF5, -+0x04, 0x4A, 0x40, 0x9A, 0xA0, 0xD8, 0x80, 0xDA, -+0x10, 0xF0, 0x24, 0x6C, 0xF5, 0xF5, 0x0C, 0x4C, -+0x80, 0x9C, 0x60, 0xDC, 0x05, 0x91, 0x04, 0x90, -+0x03, 0x63, 0x20, 0xE8, 0xFF, 0x63, 0x01, 0xD1, -+0x00, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, -+0x18, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF5, -+0xF8, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, -+0xC0, 0x9A, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0x98, 0xAE, 0x9A, 0x60, 0x9F, -+0x20, 0x9E, 0x8C, 0xED, 0x8F, 0x9A, 0xB1, 0xDA, -+0x6C, 0xEC, 0x70, 0x9A, 0x92, 0xDA, 0x2C, 0xEB, -+0x73, 0xDA, 0xA0, 0xD8, 0x80, 0xDF, 0x60, 0xDE, -+0x01, 0x91, 0x00, 0x90, 0x01, 0x63, 0x20, 0xE8, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x50, 0x9A, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0x07, 0x6D, 0xB8, 0xEC, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x01, 0x6E, 0x12, 0xEC, -+0x71, 0xE4, 0xE9, 0xF0, 0xA5, 0xA4, 0xCC, 0xED, -+0x1D, 0x25, 0xE9, 0xF0, 0xA6, 0xA4, 0x29, 0xF1, -+0x60, 0x9B, 0xE9, 0xF0, 0x85, 0xA4, 0x75, 0xE5, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF5, 0x78, 0x9B, -+0xBC, 0x35, 0x21, 0x4D, 0x75, 0xE5, 0xE0, 0xA5, -+0x9E, 0x33, 0x9A, 0x34, 0xCC, 0xEC, 0x78, 0x33, -+0x9C, 0x34, 0x4C, 0xEF, 0x8D, 0xEB, 0xED, 0xEB, -+0x00, 0xF6, 0x60, 0x33, 0x00, 0xF6, 0x63, 0x33, -+0x4C, 0xEB, 0x60, 0xC5, 0x20, 0xE8, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF6, 0x7C, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0x0B, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x6C, 0x9A, 0x04, 0xF0, 0x00, 0x6C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x95, 0xF1, 0x80, 0x9C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, 0x5C, 0x9A, -+0x60, 0xA2, 0x03, 0x6A, 0x6C, 0xEA, 0x03, 0x72, -+0x08, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF6, -+0x60, 0x9A, 0x7F, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, -+0x40, 0xC3, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF6, 0x5C, 0x9A, 0x60, 0xA2, 0x03, 0x6A, -+0x6C, 0xEA, 0x03, 0x72, 0x08, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF6, 0x60, 0x9A, 0x7F, 0x6A, -+0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, 0x94, 0xA3, -+0x6E, 0xF5, 0x58, 0x9A, 0x40, 0xEA, 0x01, 0x6B, -+0x6E, 0xEA, 0x1E, 0x2A, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, 0xB4, 0xA3, -+0x7F, 0x6C, 0xAC, 0xEC, 0x15, 0x24, 0x10, 0xF0, -+0x24, 0x6C, 0x75, 0xF1, 0x94, 0x9C, 0x00, 0x6D, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, -+0x58, 0x9A, 0x02, 0x6C, 0x80, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, 0xE8, 0xF3, -+0xC5, 0xA3, 0xFF, 0x6C, 0x55, 0x4C, 0x40, 0xEA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0x28, 0xF5, 0xBC, 0xA3, -+0x7F, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x02, 0x23, 0x00, 0x18, 0x25, 0xCD, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x24, 0x67, 0x6E, 0xF5, 0x58, 0x9A, 0x2F, 0xF7, -+0x94, 0xA3, 0xFF, 0x68, 0x0C, 0xE9, 0x40, 0xEA, -+0x01, 0x72, 0x19, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x94, 0xA2, -+0x7F, 0x6B, 0x8C, 0xEB, 0x0C, 0xEB, 0x0F, 0x23, -+0x68, 0xF3, 0x9D, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x68, 0xF3, 0x7D, 0xC2, 0x68, 0xF3, -+0x5D, 0xA2, 0x07, 0x6B, 0x6C, 0xEA, 0x03, 0x2A, -+0x91, 0x67, 0x00, 0x18, 0x1D, 0xCA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x24, 0x67, 0x6E, 0xF5, 0x58, 0x9A, 0x2F, 0xF7, -+0x94, 0xA3, 0xFF, 0x68, 0x0C, 0xE9, 0x40, 0xEA, -+0x01, 0x6B, 0x6E, 0xEA, 0x29, 0x2A, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, -+0xB4, 0xA3, 0x7F, 0x6C, 0xAC, 0xEC, 0x0C, 0xEC, -+0x1F, 0x24, 0x10, 0xF0, 0x24, 0x6C, 0x75, 0xF1, -+0x94, 0x9C, 0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x58, 0x9A, 0x02, 0x6C, 0x80, 0xC2, -+0x68, 0xF3, 0x99, 0xA3, 0x03, 0x6A, 0x4B, 0xEA, -+0x4C, 0xEC, 0x68, 0xF3, 0x99, 0xC3, 0x68, 0xF3, -+0x9D, 0xA3, 0x8C, 0xEA, 0x68, 0xF3, 0x5D, 0xC3, -+0x68, 0xF3, 0x5D, 0xA3, 0x07, 0x6B, 0x6C, 0xEA, -+0x03, 0x2A, 0x91, 0x67, 0x00, 0x18, 0x1D, 0xCA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x24, 0x67, 0x6E, 0xF5, -+0x58, 0x9A, 0x2F, 0xF7, 0x94, 0xA3, 0xFF, 0x68, -+0x0C, 0xE9, 0x40, 0xEA, 0x01, 0x72, 0x1B, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x68, 0xF3, 0x94, 0xA3, 0x7F, 0x6A, 0x8C, 0xEA, -+0x0C, 0xEA, 0x11, 0x22, 0x68, 0xF3, 0x75, 0xA3, -+0x10, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x0C, 0xEA, -+0x20, 0x72, 0x06, 0x60, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x54, 0x9A, 0x40, 0xEA, 0x03, 0x10, -+0x91, 0x67, 0x00, 0x18, 0x2A, 0xCD, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x68, -+0x8C, 0xE8, 0x90, 0x67, 0x00, 0x18, 0xC8, 0xCA, -+0x09, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x02, 0x72, 0x03, 0x60, 0x90, 0x67, -+0x00, 0x18, 0xE0, 0xCD, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xFD, 0xD6, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x04, 0x67, 0xE9, 0xF2, 0x8C, 0xA3, 0x01, 0x6B, -+0xFF, 0x6A, 0x8C, 0xEB, 0x4C, 0xEB, 0x4C, 0xE8, -+0x80, 0xF0, 0x11, 0x23, 0x01, 0x70, 0x0D, 0x60, -+0x07, 0x20, 0x02, 0x70, 0x0F, 0x60, 0x00, 0x6A, -+0x03, 0x70, 0x06, 0xD2, 0x16, 0x61, 0x0F, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF6, 0x44, 0x9A, -+0x0E, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF6, -+0x48, 0x9A, 0x09, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF6, 0x4C, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF6, 0x50, 0x9A, 0x40, 0x9A, -+0x06, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x1C, 0x33, -+0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xE2, 0x49, 0xF1, -+0x08, 0x4A, 0x00, 0x6B, 0x05, 0xD2, 0x09, 0xD2, -+0x04, 0xD3, 0x04, 0x92, 0x01, 0x6C, 0x30, 0xF0, -+0x20, 0x69, 0x84, 0xEA, 0x07, 0xD4, 0x64, 0x67, -+0x06, 0x94, 0xC0, 0xF1, 0x08, 0x49, 0x8C, 0xEB, -+0x66, 0xEA, 0xFF, 0x6A, 0x4C, 0xEB, 0x42, 0xF2, -+0x48, 0x40, 0x48, 0x32, 0x49, 0xE1, 0x07, 0x94, -+0x42, 0x9A, 0x8C, 0xEA, 0x04, 0x94, 0x46, 0xEC, -+0xFF, 0x6C, 0x8C, 0xEA, 0x6E, 0xEA, 0x36, 0x22, -+0x01, 0x73, 0x1B, 0x61, 0x04, 0x95, 0x90, 0x67, -+0x01, 0x6E, 0x00, 0x18, 0xCE, 0xD3, 0x42, 0xF2, -+0x6C, 0x40, 0x68, 0x33, 0x6D, 0xE1, 0x42, 0x9B, -+0x07, 0x94, 0x8D, 0xEA, 0x42, 0xDB, 0x29, 0xF1, -+0x64, 0xA1, 0x02, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x20, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF4, 0x44, 0x9A, 0x05, 0x94, 0x40, 0x9A, -+0x18, 0x10, 0x29, 0xF1, 0x44, 0xA1, 0x02, 0x6B, -+0xFF, 0x6C, 0x4C, 0xEB, 0x8C, 0xEB, 0x08, 0xD3, -+0x11, 0x2B, 0x04, 0x95, 0x90, 0x67, 0x00, 0x6E, -+0x00, 0x18, 0xCE, 0xD3, 0x07, 0x93, 0x42, 0xF2, -+0x4C, 0x40, 0x48, 0x32, 0x45, 0xE1, 0x6F, 0xEA, -+0x62, 0x99, 0x09, 0x94, 0x6C, 0xEA, 0x42, 0xD9, -+0x08, 0x92, 0x40, 0xDC, 0x04, 0x93, 0x05, 0x94, -+0x09, 0x92, 0x01, 0x4B, 0x04, 0x4C, 0x04, 0x4A, -+0x20, 0x73, 0x04, 0xD3, 0x05, 0xD4, 0x09, 0xD2, -+0xA4, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x42, 0xF2, -+0x08, 0x48, 0x06, 0x93, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0x30, 0x09, 0xE2, 0x62, 0xDA, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x7A, 0xA0, 0x02, 0x6A, 0xFF, 0x69, -+0x6C, 0xEA, 0x2C, 0xEC, 0x2C, 0xEA, 0x04, 0xD4, -+0x20, 0x22, 0x03, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x01, 0x6D, 0x68, 0xF3, 0x5A, 0xC0, 0x00, 0x18, -+0x45, 0xDD, 0x68, 0xF3, 0x9A, 0xA0, 0x01, 0x6B, -+0x4C, 0xEB, 0x09, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0x68, 0xF3, 0x94, 0xA0, 0x6C, 0x33, 0x6D, 0xEA, -+0x7F, 0x6B, 0x8C, 0xEB, 0x2C, 0xEB, 0x68, 0xF3, -+0x5A, 0xC0, 0x07, 0x23, 0x08, 0x6B, 0x4C, 0xEB, -+0x2C, 0xEB, 0x03, 0x23, 0x04, 0x94, 0x00, 0x18, -+0x1D, 0xCA, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x7A, 0xA0, -+0x01, 0x6A, 0xFF, 0x69, 0x6C, 0xEA, 0x2C, 0xEC, -+0x2C, 0xEA, 0x04, 0xD4, 0x19, 0x22, 0x02, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x00, 0x6D, 0x68, 0xF3, -+0x5A, 0xC0, 0x00, 0x18, 0x45, 0xDD, 0x68, 0xF3, -+0x9A, 0xA0, 0x01, 0x6B, 0x6C, 0xEA, 0xFA, 0x4B, -+0x48, 0x32, 0x8C, 0xEB, 0x4D, 0xEB, 0x04, 0x6A, -+0x6C, 0xEA, 0x2C, 0xEA, 0x68, 0xF3, 0x7A, 0xC0, -+0x03, 0x22, 0x04, 0x94, 0x00, 0x18, 0x1D, 0xCA, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x00, 0x18, 0xB8, 0xE1, 0x02, 0x67, -+0x01, 0x6A, 0x0C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x01, 0x6D, 0x02, 0x10, 0x00, 0x6C, 0xA4, 0x67, -+0x00, 0x18, 0x73, 0xC9, 0x40, 0x6A, 0x0C, 0xEA, -+0x0F, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF6, -+0x54, 0x9A, 0x60, 0xA2, 0x00, 0xF6, 0x60, 0x33, -+0x00, 0xF6, 0x63, 0x33, 0x00, 0x53, 0x00, 0x6B, -+0x02, 0x61, 0x80, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x90, 0xA2, 0x88, 0xF3, 0xB1, 0xA2, -+0x88, 0xF3, 0xD7, 0xA2, 0x02, 0x6F, 0x00, 0x18, -+0x69, 0xCA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF2, 0x50, 0x9A, -+0x66, 0x6B, 0x00, 0x6C, 0x60, 0xC2, 0x80, 0x18, -+0x55, 0x07, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x4C, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x29, 0xF5, 0x70, 0xA2, 0x02, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, 0x00, 0xE4, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x4D, 0xD4, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x74, 0xA0, 0x7F, 0x6A, 0xFF, 0x69, -+0x6C, 0xEA, 0x1E, 0x22, 0x68, 0xF3, 0x97, 0xA0, -+0x96, 0x34, 0x2C, 0xEC, 0x00, 0x18, 0x4C, 0xE2, -+0x02, 0x6B, 0x4C, 0xEB, 0x2C, 0xEB, 0x07, 0x23, -+0x68, 0xF3, 0x97, 0xA0, 0x96, 0x34, 0x2C, 0xEC, -+0x00, 0x18, 0xED, 0xCC, 0x0D, 0x10, 0x68, 0xF3, -+0x97, 0xA0, 0x68, 0xF3, 0x79, 0xA0, 0x05, 0x6A, -+0x4B, 0xEA, 0x96, 0x34, 0x6C, 0xEA, 0x2C, 0xEC, -+0x68, 0xF3, 0x59, 0xC0, 0x00, 0x18, 0x1D, 0xCA, -+0x00, 0x18, 0xD4, 0xDB, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x94, 0xA2, -+0x7F, 0x6B, 0x8C, 0xEB, 0x07, 0x23, 0x68, 0xF3, -+0x97, 0xA2, 0xFF, 0x6A, 0x96, 0x34, 0x4C, 0xEC, -+0x00, 0x18, 0x45, 0xCD, 0x00, 0x18, 0x68, 0xCB, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF6, 0x7C, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x37, 0xC4, 0x00, 0x18, -+0x35, 0xCB, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x68, -+0x0C, 0xEC, 0x00, 0x18, 0x4F, 0xCA, 0x00, 0x6C, -+0x00, 0x18, 0xBA, 0xCA, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF6, 0x7C, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, -+0x0C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x37, 0xC4, -+0x00, 0x18, 0x35, 0xCB, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x91, 0xD1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x8E, 0xD1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x16, 0xD8, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x92, 0xD7, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x83, 0xE7, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, 0x5C, 0x9A, -+0xFF, 0x6C, 0x60, 0xA2, 0x03, 0x6A, 0x6C, 0xEA, -+0x03, 0x72, 0x11, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xA9, 0xF2, 0x4C, 0xA2, 0x01, 0x72, 0x0B, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF6, 0x60, 0x9A, -+0x80, 0x6D, 0xAB, 0xED, 0x40, 0xA3, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x00, 0x18, -+0x18, 0xCB, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x18, 0xA3, 0xE0, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0xB4, 0xA3, 0x04, 0x67, -+0x7F, 0x6C, 0xFF, 0x6A, 0xAC, 0xEC, 0x4C, 0xEC, -+0x4C, 0xE8, 0x0F, 0x24, 0x68, 0xF3, 0xB9, 0xA3, -+0x40, 0x6C, 0xAC, 0xEC, 0x4C, 0xEC, 0x09, 0x24, -+0x68, 0xF3, 0x9A, 0xA3, 0x10, 0x6B, 0x8C, 0xEB, -+0x4C, 0xEB, 0x03, 0x23, 0x90, 0x67, 0x00, 0x18, -+0x47, 0xE6, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, -+0x5C, 0x9A, 0xFF, 0x6C, 0x60, 0xA2, 0x03, 0x6A, -+0x6C, 0xEA, 0x03, 0x72, 0x11, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xA9, 0xF2, 0x4C, 0xA2, 0x01, 0x72, -+0x0B, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF6, -+0x60, 0x9A, 0x80, 0x6D, 0xAB, 0xED, 0x40, 0xA3, -+0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x69, 0xF3, 0x69, 0xA2, 0x0E, 0xEB, 0x11, 0x2B, -+0x69, 0xF3, 0x68, 0xA2, 0x1F, 0x6C, 0x6A, 0x32, -+0x8C, 0xEA, 0x47, 0xE8, 0x01, 0x6C, 0x8C, 0xEA, -+0x08, 0x22, 0x02, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, -+0x00, 0xE4, 0x00, 0x18, 0x18, 0xCB, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x18, 0xB9, 0xE0, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x63, 0x01, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF5, 0x78, 0x9B, -+0xFF, 0x6A, 0x4C, 0xEE, 0x6D, 0xE4, 0x08, 0x68, -+0x80, 0xA3, 0xDB, 0xE0, 0x02, 0x67, 0x4C, 0xED, -+0x07, 0xEE, 0xD0, 0x67, 0x4C, 0xEF, 0x04, 0xED, -+0x4C, 0xEC, 0xCC, 0xEF, 0x0F, 0xE8, 0x8C, 0xE8, -+0xE4, 0xED, 0xED, 0xE8, 0x4C, 0xE8, 0x00, 0xC3, -+0x01, 0x90, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF5, 0x58, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6B, 0x8C, 0xEB, 0x4D, 0xE3, -+0x40, 0xA3, 0xFF, 0x6C, 0x8C, 0xEE, 0x08, 0x6B, -+0xDB, 0xE3, 0x8C, 0xED, 0x8C, 0xEA, 0x64, 0x67, -+0x47, 0xED, 0x67, 0xEE, 0x6C, 0xEA, 0x8C, 0xEA, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF1, 0x64, 0x9B, 0xFF, 0xF7, 0x1F, 0x6A, -+0x8C, 0xEA, 0x69, 0xE2, 0x00, 0x9A, 0x41, 0x45, -+0x25, 0x67, 0x08, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF4, 0x50, 0x9A, 0x85, 0x67, 0x2C, 0xE8, -+0x40, 0xEA, 0x06, 0xEA, 0x50, 0x67, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0xF7, 0x1F, 0x68, 0x41, 0x45, 0x25, 0x67, -+0x0C, 0xD6, 0x8C, 0xE8, 0x07, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x44, 0x9A, 0x41, 0xE0, -+0xC0, 0xD8, 0x1A, 0x10, 0x01, 0x6D, 0x90, 0x67, -+0xAB, 0xED, 0x00, 0x18, 0x05, 0xE1, 0x04, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, 0x50, 0x9A, -+0x91, 0x67, 0x40, 0xEA, 0x0C, 0x93, 0x64, 0xEA, -+0x43, 0x67, 0x04, 0x93, 0x2C, 0xEA, 0x2F, 0xE9, -+0x6C, 0xE9, 0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF1, -+0x64, 0x9B, 0x2D, 0xEA, 0x61, 0xE0, 0x40, 0xD8, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x01, 0x74, 0x0D, 0x60, -+0x06, 0x24, 0x02, 0x74, 0x10, 0x60, 0x03, 0x74, -+0x00, 0x6A, 0x1C, 0x61, 0x14, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xA8, 0x35, 0x35, 0xF6, 0x58, 0x9A, -+0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xA8, 0x35, -+0x35, 0xF6, 0x5C, 0x9A, 0x05, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF6, 0x40, 0x9A, 0xA8, 0x35, -+0x55, 0xE5, 0x40, 0x9D, 0x20, 0xE8, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF6, 0x44, 0x9A, 0xA8, 0x35, -+0x55, 0xE5, 0x40, 0x9D, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x08, 0xF3, 0x00, 0x4A, 0x88, 0x34, 0x91, 0xE2, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, 0x7C, 0x9A, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF5, 0xA0, 0x35, -+0xCC, 0xEB, 0x10, 0xF0, 0x24, 0x6E, 0x95, 0xF4, -+0xD8, 0x9E, 0xCE, 0xF4, 0x50, 0x9A, 0x80, 0xAC, -+0xAD, 0xEB, 0x01, 0x6D, 0xAB, 0xED, 0x6C, 0xEE, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x6B, 0x8C, 0xEB, 0xFF, 0xF7, 0x1F, 0x6A, -+0x81, 0x46, 0x06, 0x67, 0xAC, 0xEA, 0x06, 0x2C, -+0x83, 0x67, 0xA2, 0x67, 0x00, 0x18, 0x2D, 0xE1, -+0x02, 0x67, 0x0D, 0x10, 0x83, 0x67, 0xA2, 0x67, -+0x00, 0x18, 0x2D, 0xE1, 0x22, 0x67, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF4, 0x50, 0x9A, 0x90, 0x67, -+0x2C, 0xE8, 0x40, 0xEA, 0x06, 0xEA, 0x50, 0x67, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x46, 0x67, 0xFF, 0x68, -+0xFF, 0xF7, 0x1F, 0x69, 0x01, 0x4A, 0x0C, 0xD6, -+0x0D, 0xD7, 0x8C, 0xE8, 0xAC, 0xE9, 0x04, 0x2A, -+0x90, 0x67, 0xB1, 0x67, 0xC7, 0x67, 0x15, 0x10, -+0xB1, 0x67, 0x90, 0x67, 0x00, 0x18, 0x2D, 0xE1, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x0C, 0x94, -+0xAE, 0xF4, 0x50, 0x9A, 0x40, 0xEA, 0x0D, 0x96, -+0x90, 0x67, 0xB1, 0x67, 0xC4, 0xEA, 0x0C, 0x92, -+0x4C, 0xEE, 0x4F, 0xEB, 0x04, 0x92, 0x4C, 0xEB, -+0x6D, 0xEE, 0x00, 0x18, 0x40, 0xE1, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, -+0x40, 0xEA, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, -+0x0E, 0x91, 0x04, 0xD2, 0xFF, 0xF7, 0x1F, 0x6A, -+0x4C, 0xED, 0x4C, 0xE9, 0x0C, 0xD6, 0x0D, 0xD7, -+0x0F, 0x90, 0x05, 0xD5, 0x00, 0x6A, 0x08, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x40, 0xA8, 0x01, 0x4A, -+0x40, 0xC8, 0x10, 0xF0, 0x24, 0x6A, 0x04, 0x94, -+0x05, 0x95, 0x35, 0xF3, 0xDC, 0x9A, 0x00, 0x18, -+0x50, 0xE1, 0x0C, 0x93, 0x6C, 0xEA, 0x0D, 0x93, -+0x6E, 0xEA, 0x03, 0x22, 0x40, 0xA8, 0x23, 0xEA, -+0xE7, 0x61, 0x40, 0xA8, 0x09, 0x97, 0x07, 0x90, -+0x23, 0xEA, 0x08, 0x91, 0x58, 0x67, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, -+0x70, 0x9B, 0x10, 0xF0, 0x24, 0x6A, 0x50, 0xF6, -+0x1D, 0x4A, 0x40, 0xDB, 0x00, 0x68, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF6, 0x48, 0x9A, 0x40, 0xA2, -+0x12, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF6, -+0x4C, 0x9A, 0x40, 0xA2, 0x0C, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF6, 0x50, 0x9A, 0x40, 0xA2, -+0x06, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF6, -+0x54, 0x9A, 0x40, 0xA2, 0x18, 0x22, 0xE0, 0xF3, -+0x09, 0x70, 0x0A, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF1, 0x7C, 0x9A, 0x20, 0x6C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, 0x0C, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x32, 0x6C, 0x01, 0x48, 0x40, 0xEA, 0xFF, 0xF7, -+0x1F, 0x6A, 0x4C, 0xE8, 0xD0, 0x17, 0x01, 0x6A, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, -+0x10, 0xF0, 0x24, 0x6A, 0xF0, 0xF6, 0x01, 0x4A, -+0x40, 0xDB, 0x00, 0x6B, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF6, 0xB8, 0x9A, 0xFF, 0x6C, 0x40, 0xA5, -+0xA0, 0xA5, 0x8C, 0xEA, 0xAC, 0xEC, 0x4E, 0xEC, -+0x10, 0x24, 0x64, 0x73, 0x09, 0x61, 0x10, 0xF0, -+0x24, 0x6B, 0x55, 0xF1, 0x9C, 0x9B, 0x40, 0x6D, -+0x60, 0x9C, 0xAD, 0xEB, 0x60, 0xDC, 0x20, 0xE8, -+0x01, 0x4B, 0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xEB, -+0xE5, 0x17, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, 0x24, 0x6A, -+0xFF, 0x69, 0x30, 0xF7, 0x0D, 0x4A, 0x8C, 0xE9, -+0x40, 0xDB, 0x00, 0x68, 0x20, 0x10, 0x82, 0xF3, -+0x08, 0x70, 0x09, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF1, 0x7C, 0x9A, 0x10, 0x6C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x1F, 0x10, 0xFF, 0xF7, -+0x1F, 0x6A, 0x01, 0x48, 0x4C, 0xE8, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x14, 0x6C, -+0x40, 0xEA, 0x33, 0x58, 0x08, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF5, 0x4C, 0x9A, 0x01, 0x6B, -+0x40, 0xA2, 0x6C, 0xEA, 0x0B, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF6, 0x5C, 0x9A, 0x01, 0x6B, -+0x40, 0x9A, 0x42, 0x32, 0x5E, 0x32, 0x6C, 0xEA, -+0x2E, 0xEA, 0xD5, 0x2A, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF0, 0x70, 0x9B, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF7, 0x0E, 0x4A, 0x40, 0xDB, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, -+0x10, 0xF0, 0x24, 0x6A, 0xD0, 0xF7, 0x01, 0x4A, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF6, -+0x40, 0x9A, 0x60, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, -+0xF8, 0x2A, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, -+0x70, 0x9B, 0x10, 0xF0, 0x24, 0x6A, 0xD0, 0xF7, -+0x02, 0x4A, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x99, 0xA2, 0x80, 0x6B, 0x6B, 0xEB, 0x8D, 0xEB, -+0x68, 0xF3, 0x79, 0xC2, 0x88, 0xF3, 0x68, 0xAA, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF6, 0x44, 0x9A, -+0xFF, 0x68, 0x10, 0x6C, 0x60, 0xCA, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF2, 0x74, 0x9A, 0x40, 0xA3, -+0x0C, 0xEA, 0x8D, 0xEA, 0x0C, 0xEA, 0x40, 0xC3, -+0x01, 0x6C, 0x00, 0x18, 0xCB, 0xE1, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF5, 0x54, 0x9A, 0x02, 0x6B, -+0x01, 0x6C, 0x60, 0xDA, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF6, 0x60, 0x9A, 0x40, 0xA3, 0x0C, 0xEA, -+0x8D, 0xEA, 0x0C, 0xEA, 0x40, 0xC3, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xF0, 0xE1, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF2, 0x74, 0x9A, 0xEF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x00, 0x6C, 0x00, 0x18, -+0xCB, 0xE1, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6B, 0x8E, 0x9A, -+0xF5, 0xF5, 0x74, 0x9B, 0x80, 0xDB, 0x68, 0xF3, -+0x99, 0xA2, 0x7F, 0x6B, 0x8C, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFF, 0x6A, 0x4C, 0xEC, 0x94, 0x34, 0x4C, 0xED, -+0x4C, 0xEC, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF6, -+0x48, 0x9A, 0x80, 0xC2, 0xA0, 0xC2, 0x20, 0xE8, -+0xFF, 0x6A, 0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF6, -+0x68, 0x9B, 0x4C, 0xEC, 0x94, 0x34, 0x4C, 0xEC, -+0x80, 0xC3, 0x60, 0xA3, 0x6C, 0xEA, 0x20, 0xE8, -+0xFF, 0x6A, 0x4C, 0xED, 0xFF, 0x75, 0x4C, 0xEC, -+0xCC, 0xEA, 0x06, 0x61, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x71, 0xE4, 0x0B, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x71, 0xE4, 0x2C, 0xF7, 0x6E, 0xA4, 0xAC, 0xEA, -+0xAF, 0xED, 0x6C, 0xED, 0xAD, 0xEA, 0x2C, 0xF7, -+0x4E, 0xC4, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6B, 0x6C, 0xEC, 0x07, 0x6A, -+0x6C, 0xED, 0x8C, 0xEA, 0x01, 0x68, 0xE6, 0x67, -+0x04, 0xEA, 0xAB, 0xEE, 0x30, 0xF0, 0x20, 0x6A, -+0xAD, 0xEE, 0xCE, 0xF2, 0x44, 0x9A, 0x6C, 0xE8, -+0xC0, 0xF7, 0xC3, 0x36, 0x8E, 0x34, 0x6C, 0xEF, -+0xB0, 0x67, 0x0C, 0xEE, 0x6C, 0xEC, 0x40, 0xEA, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFF, 0x6A, 0x4C, 0xEC, 0xFF, 0x74, 0xAC, 0xEA, -+0x05, 0x61, 0x30, 0xF0, 0x20, 0x6B, 0x0D, 0xF1, -+0x47, 0xC3, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x2C, 0xF7, 0xBF, 0xA3, -+0x8C, 0xEA, 0x8F, 0xEC, 0xAC, 0xEC, 0x8D, 0xEA, -+0x2C, 0xF7, 0x5F, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x6A, -+0x06, 0x67, 0x4C, 0xE8, 0x53, 0x70, 0x4C, 0xEC, -+0x4C, 0xED, 0x0A, 0x61, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x2C, 0xF7, 0x9F, 0xA3, -+0x2C, 0xF7, 0x7E, 0xA3, 0x8D, 0xEB, 0x06, 0x10, -+0x0C, 0x2C, 0x30, 0xF0, 0x20, 0x6B, 0x0D, 0xF1, -+0x66, 0xA3, 0xAD, 0xEB, 0x4C, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF1, 0x5C, 0x9A, 0x60, 0xC2, -+0x2C, 0x10, 0x47, 0x70, 0x12, 0x60, 0x48, 0x58, -+0x06, 0x60, 0x17, 0x70, 0x0E, 0x60, 0x44, 0x70, -+0x0C, 0x60, 0x01, 0x70, 0x09, 0x10, 0x4C, 0x70, -+0x08, 0x60, 0x4D, 0x58, 0x02, 0x60, 0x49, 0x70, -+0x03, 0x10, 0x4E, 0x70, 0x02, 0x60, 0x51, 0x70, -+0x06, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x0D, 0xF1, -+0x46, 0xA2, 0xAD, 0xEA, 0x0D, 0x10, 0x00, 0x18, -+0x6E, 0xE2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x2C, 0xF7, 0x7F, 0xA2, 0x2C, 0xF7, -+0x5E, 0xA2, 0x6D, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF1, 0x7C, 0x9B, -+0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, -+0x1A, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF6, -+0x4C, 0x9A, 0x00, 0xC2, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFF, 0x63, 0x01, 0xD0, -+0xFF, 0x6A, 0x4C, 0xED, 0x4C, 0xEE, 0x4C, 0xEF, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF2, 0x5C, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEC, 0x00, 0xAA, -+0xE1, 0xF7, 0x1F, 0x6A, 0x0C, 0xEA, 0x10, 0xF0, -+0x24, 0x68, 0x15, 0xF2, 0x18, 0x98, 0x51, 0xE4, -+0x6C, 0xEC, 0x80, 0xC8, 0x9C, 0x32, 0x10, 0xF0, -+0x24, 0x6C, 0x75, 0xF6, 0x90, 0x9C, 0x10, 0xF0, -+0x24, 0x68, 0x75, 0xF6, 0x14, 0x98, 0x91, 0xE2, -+0x80, 0xAC, 0x01, 0xE2, 0x00, 0x98, 0x6C, 0xEC, -+0x05, 0x25, 0x10, 0xF0, 0x00, 0x6D, 0xAB, 0xED, -+0xAD, 0xEC, 0x6C, 0xEC, 0xD8, 0xF0, 0x00, 0x6B, -+0x8C, 0xEB, 0x10, 0xF0, 0x24, 0x6C, 0x75, 0xF6, -+0x90, 0x9C, 0x91, 0xE2, 0x60, 0xCC, 0x10, 0xF0, -+0x24, 0x6B, 0x75, 0xF6, 0x78, 0x9B, 0x6D, 0xE2, -+0x80, 0xA3, 0x01, 0x6B, 0x8C, 0xEB, 0x05, 0x23, -+0x03, 0xF7, 0x01, 0x6B, 0x6B, 0xEB, 0x0C, 0xEB, -+0x06, 0x10, 0x1F, 0xF7, 0x01, 0x6B, 0x6B, 0xEB, -+0x0C, 0xEB, 0xE0, 0x37, 0xED, 0xEB, 0xFF, 0x76, -+0x13, 0x60, 0x10, 0xF0, 0x24, 0x6C, 0x75, 0xF6, -+0x9C, 0x9C, 0x80, 0xF4, 0xC0, 0x36, 0x6C, 0xEC, -+0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF1, 0x64, 0x9B, -+0x6D, 0xEE, 0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF6, -+0x74, 0x9B, 0x8D, 0xEE, 0x6D, 0xE2, 0xC0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF6, 0x80, 0x9B, -+0x7F, 0x6B, 0x91, 0xE2, 0xA0, 0xA4, 0xAC, 0xEB, -+0x60, 0xC4, 0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF6, -+0x64, 0x9B, 0x1C, 0x6C, 0x80, 0xC3, 0x10, 0xF0, -+0x24, 0x6B, 0x95, 0xF6, 0x68, 0x9B, 0x08, 0xF4, -+0x13, 0x6C, 0x80, 0xCB, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF2, 0x8C, 0x9B, 0xF7, 0x6B, 0x91, 0xE2, -+0xA0, 0xA4, 0xAC, 0xEB, 0x60, 0xC4, 0x01, 0x90, -+0x01, 0x63, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x10, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0x29, 0xF5, 0x51, 0xA2, 0xFF, 0x63, 0x05, 0x5A, -+0x36, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, -+0xB5, 0xF0, 0x00, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, -+0x00, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, -+0x48, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, 0x40, 0x9A, -+0x1A, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, -+0x48, 0x9A, 0x09, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF6, 0x4C, 0x9A, 0x0D, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF6, 0x4C, 0x9A, 0x40, 0x9A, -+0x50, 0x32, 0x00, 0xF5, 0x42, 0x32, 0x08, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF6, 0x50, 0x9A, -+0x40, 0x9A, 0xE1, 0xF7, 0x1F, 0x6B, 0x6C, 0xEA, -+0x00, 0xD2, 0x00, 0x93, 0xE0, 0xF3, 0x08, 0x6A, -+0x60, 0x33, 0x68, 0x33, 0x5B, 0xEB, 0x01, 0x2A, -+0xE5, 0xE8, 0x12, 0xEA, 0x01, 0x10, 0x66, 0x6A, -+0x00, 0xD2, 0x00, 0x92, 0x01, 0x63, 0x20, 0xE8, -+0xFF, 0x63, 0x01, 0xD0, 0x0C, 0x2C, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x95, 0xF6, 0x94, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x58, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF5, 0xDC, 0x9A, 0x30, 0xF0, -+0x20, 0x6A, 0x0F, 0xF6, 0x18, 0x4A, 0x00, 0x6D, -+0x18, 0x6F, 0xF8, 0xED, 0x30, 0xF0, 0x20, 0x6B, -+0x2F, 0xF5, 0x18, 0x4B, 0x12, 0xEF, 0x6D, 0xE7, -+0xC0, 0xF0, 0x14, 0xA3, 0x01, 0x6F, 0xEC, 0xE8, -+0x23, 0x20, 0xC0, 0xF0, 0x74, 0xA3, 0x66, 0x33, -+0xEC, 0xEB, 0xFF, 0x6F, 0xEC, 0xEB, 0x1C, 0x23, -+0xFF, 0xF7, 0x78, 0x9A, 0x9B, 0xEB, 0x01, 0x2C, -+0xE5, 0xE8, 0x12, 0xEB, 0xFF, 0xF7, 0x7C, 0xDA, -+0x10, 0xEF, 0x03, 0x27, 0x01, 0x4B, 0xFF, 0xF7, -+0x7C, 0xDA, 0x60, 0x9A, 0x78, 0xEE, 0x12, 0xEB, -+0x9B, 0xEB, 0x01, 0x2C, 0xE5, 0xE8, 0x12, 0xEB, -+0x60, 0xDA, 0xFF, 0xF7, 0x7C, 0x9A, 0x04, 0x2B, -+0x01, 0x6F, 0xFF, 0xF7, 0xFC, 0xDA, 0x60, 0xDA, -+0x01, 0x4D, 0x0A, 0x75, 0x18, 0x4A, 0xCC, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, -+0xC0, 0xF0, 0x68, 0x9A, 0xC0, 0xF0, 0x84, 0xDA, -+0x7B, 0xEC, 0x01, 0x2B, 0xE5, 0xE8, 0x12, 0xEB, -+0xC0, 0xF0, 0x6C, 0xDA, 0x78, 0x67, 0xC0, 0xF0, -+0x70, 0xDA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, -+0x8D, 0xEB, 0x69, 0xF3, 0x68, 0xC2, 0x01, 0x90, -+0x01, 0x63, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x69, 0xF3, 0x48, 0xA0, -+0x03, 0x69, 0x4C, 0xE9, 0x00, 0x6A, 0x35, 0x29, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF6, 0x58, 0x9A, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6C, -+0x20, 0xC2, 0x4E, 0xF2, 0x4C, 0x9B, 0x29, 0xF5, -+0x10, 0x4C, 0x00, 0x6D, 0xD4, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x4C, 0x9B, -+0x30, 0xF0, 0x20, 0x6C, 0xFF, 0x6E, 0xEF, 0xF5, -+0x1C, 0x4C, 0x00, 0x6D, 0x01, 0x4E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, -+0x01, 0x6B, 0x66, 0x6C, 0xC0, 0xF0, 0x68, 0xDA, -+0xC0, 0xF0, 0x84, 0xDA, 0xC0, 0xF0, 0x8C, 0xDA, -+0x69, 0xF3, 0x88, 0xA0, 0x7D, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x04, 0x6C, 0x8D, 0xEA, 0x6D, 0xEA, -+0x69, 0xF3, 0x48, 0xC0, 0x69, 0xF3, 0x29, 0xC0, -+0x43, 0x67, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x69, 0xF3, 0x88, 0xA0, 0x01, 0x6B, -+0x00, 0x6A, 0x8C, 0xEB, 0x24, 0x23, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF6, 0x58, 0x9A, 0x00, 0x6B, -+0x60, 0xC2, 0x03, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0x69, 0xF3, 0x48, 0xC0, 0x00, 0x18, 0xED, 0xE2, -+0x04, 0xD2, 0x04, 0x94, 0x00, 0x18, 0x0E, 0xE3, -+0x69, 0xF3, 0x68, 0xA0, 0x02, 0x6A, 0xFF, 0x6C, -+0x6D, 0xEA, 0x69, 0xF3, 0x48, 0xC0, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x50, 0x9A, 0x0F, 0xF6, 0xC0, 0x9B, 0x6D, 0x4C, -+0x01, 0x6D, 0x40, 0xEA, 0x01, 0x6A, 0x07, 0x97, -+0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x69, 0xF3, 0xA8, 0xA3, 0x02, 0x6C, 0x00, 0x6A, -+0xAC, 0xEC, 0x0C, 0x24, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF6, 0x58, 0x9A, 0x00, 0x6C, 0x80, 0xC2, -+0x03, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0x69, 0xF3, -+0x48, 0xC3, 0x01, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0x00, 0x6A, 0x18, 0x6C, 0x98, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0x2F, 0xF5, 0x18, 0x4B, 0x01, 0x4A, -+0x0A, 0x72, 0x12, 0xEC, 0x71, 0xE4, 0xC0, 0xF0, -+0xB4, 0xA4, 0x02, 0x6B, 0x6B, 0xEB, 0xAC, 0xEB, -+0xC0, 0xF0, 0x74, 0xC4, 0xEE, 0x61, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0x29, 0xF5, 0x50, 0xA2, -+0x01, 0x6B, 0x4C, 0xEB, 0x00, 0x6A, 0x1C, 0x23, -+0x30, 0xF0, 0x20, 0x6A, 0x0F, 0xF6, 0x1C, 0x4A, -+0x00, 0x6B, 0xA0, 0x9A, 0x8E, 0xED, 0x0F, 0x2D, -+0x18, 0x6E, 0xD8, 0xEB, 0x30, 0xF0, 0x20, 0x6D, -+0x2F, 0xF5, 0x18, 0x4D, 0x12, 0xEE, 0xB9, 0xE6, -+0xC0, 0xF0, 0xF4, 0xA6, 0x02, 0x6D, 0xAB, 0xED, -+0xEC, 0xED, 0xC0, 0xF0, 0xB4, 0xC6, 0x01, 0x4B, -+0x0A, 0x73, 0x18, 0x4A, 0xEA, 0x61, 0x01, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x5D, 0x67, 0x20, 0xF0, -+0x78, 0xA2, 0x30, 0xF0, 0x20, 0x6A, 0x0A, 0xD4, -+0x29, 0xF5, 0x90, 0xA2, 0x01, 0x6A, 0x00, 0xF6, -+0xE0, 0x31, 0x8C, 0xEA, 0x0B, 0xD5, 0x0C, 0xD6, -+0x00, 0xF6, 0x23, 0x31, 0x80, 0xF0, 0x0E, 0x22, -+0x24, 0x23, 0x01, 0x73, 0x80, 0xF0, 0x0A, 0x61, -+0x0A, 0x93, 0x80, 0xF0, 0x07, 0x23, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF6, 0x5C, 0x9A, 0xC3, 0xEA, -+0x80, 0xF0, 0x00, 0x61, 0x7F, 0x71, 0x7E, 0x60, -+0xFF, 0xF7, 0x1F, 0x51, 0x7B, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF5, 0x1C, 0x9A, 0x1B, 0xEE, -+0x01, 0x28, 0xE5, 0xE8, 0x10, 0xEA, 0x12, 0xE8, -+0x02, 0x22, 0x01, 0x48, 0x04, 0x10, 0x03, 0x28, -+0x01, 0x68, 0x50, 0x67, 0x1F, 0x10, 0x01, 0x6B, -+0x20, 0x10, 0x0A, 0x95, 0x67, 0x25, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF6, 0x5C, 0x9A, 0x0C, 0x96, -+0xC3, 0xEA, 0x60, 0x61, 0x7F, 0x71, 0x5E, 0x60, -+0xFF, 0xF7, 0x1F, 0x51, 0x5B, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x0F, 0xF6, 0x00, 0x9A, 0x1B, 0xEE, -+0x01, 0x28, 0xE5, 0xE8, 0x10, 0xEA, 0x12, 0xE8, -+0x02, 0x22, 0x01, 0x48, 0x05, 0x10, 0x04, 0x28, -+0x01, 0x68, 0x00, 0x6A, 0x04, 0xD2, 0x02, 0x10, -+0x00, 0x6B, 0x04, 0xD3, 0x0A, 0x94, 0x00, 0x18, -+0x98, 0xE3, 0x00, 0x6C, 0xFF, 0x6E, 0xA4, 0x67, -+0xCC, 0xED, 0x1D, 0x65, 0x18, 0x6D, 0xB8, 0xEC, -+0x30, 0xF0, 0x20, 0x6B, 0x2F, 0xF5, 0x18, 0x4B, -+0x01, 0x6D, 0x12, 0xEA, 0x69, 0xE2, 0xC0, 0xF0, -+0x54, 0xA2, 0xAC, 0xEA, 0xCC, 0xEA, 0x2F, 0x2A, -+0xD8, 0x67, 0x18, 0x6F, 0xF8, 0xEE, 0x04, 0x96, -+0xC4, 0x36, 0x04, 0xD6, 0x03, 0x6E, 0xCB, 0xEE, -+0x12, 0xEC, 0x71, 0xE4, 0xC0, 0xF0, 0xF4, 0xA4, -+0xEC, 0xEE, 0x04, 0x97, 0xED, 0xEE, 0xC0, 0xF0, -+0xD4, 0xC4, 0x0A, 0x96, 0xE0, 0xF0, 0xC4, 0xDC, -+0x0B, 0x97, 0xE0, 0xF0, 0xE8, 0xDC, 0x0C, 0x96, -+0x18, 0x6F, 0xC0, 0xF0, 0xD8, 0xDC, 0xD8, 0x67, -+0x01, 0x4E, 0xF8, 0xEE, 0x12, 0xEE, 0xCD, 0xE3, -+0xC0, 0xF0, 0x48, 0xDB, 0xC0, 0xF0, 0x04, 0xDB, -+0xC0, 0xF0, 0x56, 0xC4, 0xC0, 0xF0, 0x54, 0xA4, -+0xC0, 0xF0, 0x37, 0xC4, 0x4D, 0xED, 0xC0, 0xF0, -+0xB4, 0xC4, 0x01, 0x6A, 0x04, 0x10, 0x01, 0x4C, -+0x0A, 0x74, 0xBC, 0x61, 0x00, 0x6A, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x06, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x0F, 0xF6, -+0x18, 0x4A, 0x00, 0x6C, 0x4F, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x0F, 0xF6, 0x18, 0x4A, 0x00, 0x6B, -+0x18, 0x6D, 0xB8, 0xEB, 0x30, 0xF0, 0x20, 0x6C, -+0x2F, 0xF5, 0x18, 0x4C, 0x12, 0xED, 0x91, 0xE5, -+0xC0, 0xF0, 0xD4, 0xA4, 0x01, 0x6D, 0xAC, 0xEE, -+0x08, 0x26, 0xC0, 0xF0, 0x94, 0xA4, 0x86, 0x34, -+0xAC, 0xEC, 0x03, 0x24, 0x80, 0x9A, 0x01, 0x4C, -+0x80, 0xDA, 0x01, 0x4B, 0x0A, 0x73, 0x18, 0x4A, -+0xE7, 0x61, 0x00, 0x18, 0xED, 0xE2, 0x04, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x94, 0xA2, 0x7F, 0x6B, 0x8C, 0xEB, -+0x1A, 0x23, 0x68, 0xF3, 0x77, 0xA2, 0x69, 0xF3, -+0x89, 0xA2, 0x76, 0x33, 0x8E, 0xEB, 0x13, 0x2B, -+0x68, 0xF3, 0x95, 0xA2, 0x0F, 0x6B, 0x8C, 0xEB, -+0xFF, 0x6C, 0x8C, 0xEB, 0x0C, 0x23, 0x88, 0xF3, -+0x82, 0xA2, 0x04, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF5, 0x5C, 0x9A, 0x78, 0xEC, 0x12, 0xEC, -+0x8E, 0xEA, 0x09, 0x2A, 0x5B, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x04, 0x93, 0xEF, 0xF5, 0x5C, 0x9A, -+0x6E, 0xEA, 0x54, 0x22, 0x04, 0x94, 0x00, 0x18, -+0x0E, 0xE3, 0x50, 0x10, 0x18, 0x6D, 0xB8, 0xEC, -+0x30, 0xF0, 0x20, 0x6B, 0x2F, 0xF5, 0x18, 0x4B, -+0x12, 0xED, 0x6D, 0xE5, 0xC0, 0xF0, 0xD4, 0xA3, -+0x01, 0x6D, 0xAC, 0xEE, 0x0A, 0x26, 0xC0, 0xF0, -+0x74, 0xA3, 0x66, 0x33, 0xAC, 0xEB, 0xFF, 0x6D, -+0xAC, 0xEB, 0x03, 0x2B, 0x60, 0x9A, 0x01, 0x4B, -+0x60, 0xDA, 0x01, 0x4C, 0x0A, 0x74, 0x18, 0x4A, -+0xE5, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x29, 0xF5, -+0x51, 0xA2, 0xFF, 0x72, 0x2F, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0xC0, 0xF0, -+0x70, 0x9A, 0x01, 0x4B, 0xC0, 0xF0, 0x70, 0xDA, -+0x7C, 0x4A, 0x54, 0x9A, 0x4E, 0xEB, 0x22, 0x2B, -+0x30, 0xF0, 0x20, 0x6A, 0x0F, 0xF6, 0x18, 0x4A, -+0x18, 0x6D, 0xB8, 0xEB, 0x30, 0xF0, 0x20, 0x6C, -+0x2F, 0xF5, 0x18, 0x4C, 0x12, 0xED, 0x91, 0xE5, -+0xC0, 0xF0, 0xD4, 0xA4, 0x01, 0x6D, 0xAC, 0xEE, -+0x08, 0x26, 0xC0, 0xF0, 0x94, 0xA4, 0x86, 0x34, -+0xAC, 0xEC, 0x03, 0x24, 0x80, 0x9A, 0x01, 0x4C, -+0x80, 0xDA, 0x01, 0x4B, 0x0A, 0x73, 0x18, 0x4A, -+0xE7, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x78, 0x67, -+0x0F, 0xF6, 0x68, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x02, 0xF0, 0x00, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, -+0x10, 0xF0, 0x24, 0x6A, 0x72, 0xF1, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x68, 0x40, 0xDB, 0x0F, 0xF6, -+0x0E, 0x48, 0x00, 0x69, 0x18, 0x6A, 0x58, 0xE9, -+0x30, 0xF0, 0x20, 0x6B, 0x2F, 0xF5, 0x18, 0x4B, -+0x12, 0xEA, 0x69, 0xE2, 0xC0, 0xF0, 0x94, 0xA2, -+0x01, 0x6B, 0x8C, 0xEB, 0x27, 0x23, 0x00, 0xF0, -+0x8A, 0x98, 0x00, 0xF0, 0x66, 0x98, 0x63, 0xEC, -+0x21, 0x61, 0x61, 0x80, 0x81, 0x43, 0x04, 0xD4, -+0x07, 0x2C, 0x00, 0xF0, 0x4E, 0x98, 0x00, 0xF0, -+0x92, 0x98, 0x40, 0xEA, 0x04, 0x92, 0x14, 0x10, -+0x80, 0xA0, 0x01, 0x4C, 0x80, 0xC0, 0x80, 0xA0, -+0x82, 0xEB, 0x08, 0x60, 0xC0, 0xF0, 0x94, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xC0, 0xF0, -+0x74, 0xC2, 0x08, 0x10, 0x00, 0xF0, 0x4E, 0x98, -+0x00, 0xF0, 0x92, 0x98, 0x40, 0xEA, 0x00, 0x6A, -+0x00, 0xF0, 0x4A, 0xD8, 0x01, 0x49, 0x0A, 0x71, -+0x18, 0x48, 0xC8, 0x61, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xE0, 0x63, 0x3F, 0x62, 0xFF, 0xF7, 0x1F, 0x6A, -+0xAC, 0xEA, 0xBD, 0x67, 0x56, 0xC5, 0x01, 0x6B, -+0x42, 0x32, 0x57, 0xC5, 0x6B, 0xEB, 0x30, 0xF0, -+0x20, 0x6A, 0x70, 0xC5, 0xAE, 0xF2, 0x5C, 0x9A, -+0x03, 0x6B, 0x72, 0xC5, 0x04, 0x6B, 0x94, 0xC5, -+0x73, 0xC5, 0x04, 0x04, 0x40, 0xEA, 0x3F, 0x97, -+0x20, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA7, 0x44, 0x30, 0xF0, 0x20, 0x6C, 0x01, 0x4D, -+0xAC, 0xF0, 0x08, 0x4C, 0x14, 0x6E, 0x40, 0xEA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x24, 0x67, 0x00, 0x18, 0x91, 0xE4, 0x47, 0xA1, -+0x66, 0xA1, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x40, 0x32, 0xEB, 0xF6, 0x80, 0xA0, -+0x69, 0xE2, 0x01, 0x69, 0xEB, 0xF6, 0x52, 0xC8, -+0x51, 0x67, 0x8C, 0xEA, 0xFF, 0x6B, 0x1C, 0x2A, -+0xEB, 0xF6, 0xB4, 0xA0, 0xFE, 0x4A, 0xAC, 0xEA, -+0xEB, 0xF6, 0x54, 0xC0, 0x02, 0x6A, 0x8C, 0xEA, -+0x6C, 0xEA, 0x51, 0x22, 0xEB, 0xF6, 0x43, 0xA0, -+0x0F, 0x6D, 0xEB, 0xF6, 0x84, 0xA0, 0x4C, 0xED, -+0x52, 0x36, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x54, 0x9A, 0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, -+0x01, 0x72, 0x0D, 0x6A, 0x41, 0x61, 0x3F, 0x10, -+0xEB, 0xF6, 0x74, 0xA0, 0xEB, 0xF6, 0xF0, 0xA8, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x00, 0xF1, -+0x01, 0x5F, 0xEB, 0xF6, 0x54, 0xC0, 0x0C, 0x6A, -+0x33, 0x60, 0x00, 0x6A, 0xEB, 0xF6, 0x55, 0xC0, -+0xEB, 0xF6, 0x56, 0xC0, 0x00, 0x6A, 0xEB, 0xF6, -+0x58, 0xC8, 0xEB, 0xF6, 0x5A, 0xC8, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF2, 0x5C, 0x9A, 0xEB, 0xF6, -+0xC1, 0xA0, 0x10, 0xF0, 0x24, 0x6D, 0x60, 0xAA, -+0xFF, 0xF7, 0x1F, 0x6A, 0xB5, 0xF6, 0xA0, 0x9D, -+0x6C, 0xEA, 0xD9, 0xE2, 0xDC, 0x36, 0x00, 0x6A, -+0xB5, 0xE6, 0x10, 0xF0, 0x24, 0x6E, 0x04, 0xD2, -+0x05, 0xD2, 0xB5, 0xF2, 0xD8, 0x9E, 0x30, 0xF0, -+0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, -+0x40, 0x9A, 0xCC, 0xF0, 0x0E, 0x4B, 0x00, 0x6C, -+0xD9, 0xE3, 0x40, 0xEA, 0xEB, 0xF6, 0x54, 0xA0, -+0x4D, 0xE9, 0xEB, 0xF6, 0x34, 0xC0, 0x00, 0x6A, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0xEB, 0xF6, 0xB8, 0xA8, 0x30, 0xF0, -+0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, -+0x50, 0x9A, 0xCC, 0xF0, 0x0E, 0x4B, 0x30, 0xF0, -+0x20, 0x6C, 0xB5, 0xE3, 0xCC, 0xF0, 0x08, 0x4C, -+0x04, 0x6E, 0x40, 0xEA, 0x0B, 0xF7, 0x63, 0xA0, -+0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0xEB, 0xF6, 0x58, 0xA8, -+0x04, 0x4A, 0xEB, 0xF6, 0x58, 0xC8, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x0B, 0xF7, -+0x61, 0xA0, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x54, 0x9A, 0x0B, 0xF7, 0x80, 0xA0, 0x0F, 0x6D, -+0x6C, 0xED, 0x72, 0x36, 0x40, 0xEA, 0x0E, 0x2A, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0xEB, 0xF6, 0x74, 0xA0, 0x02, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0xEB, 0xF6, 0x54, 0xC0, -+0x01, 0x6C, 0x56, 0x10, 0x0B, 0xF7, 0x63, 0xA0, -+0x7F, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x18, 0x22, 0x01, 0x72, 0x45, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF5, 0x4C, 0x9A, 0x00, 0x6C, -+0x40, 0xEA, 0x49, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF3, 0x50, 0x9A, 0xCB, 0xF6, 0x9D, 0xA0, -+0x00, 0x6D, 0x40, 0xEA, 0x06, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF4, 0x54, 0x9A, 0x40, 0xEA, -+0x3A, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xEB, 0xF6, 0x75, 0xA2, 0x0B, 0xF7, -+0x82, 0xA2, 0x01, 0x4B, 0xEB, 0xF6, 0x75, 0xC2, -+0xEB, 0xF6, 0x7A, 0xAA, 0x6D, 0xE4, 0xEB, 0xF6, -+0x7A, 0xCA, 0xEB, 0xF6, 0x95, 0xA2, 0xEB, 0xF6, -+0x62, 0xA2, 0x8E, 0xEB, 0x09, 0x2B, 0x10, 0xF0, -+0x24, 0x6C, 0x0B, 0xF7, 0xC2, 0xA2, 0xD2, 0xF4, -+0x1D, 0x4C, 0x04, 0xD3, 0x00, 0x6D, 0x09, 0x10, -+0x0B, 0xF7, 0xC2, 0xA2, 0x10, 0xF0, 0x24, 0x6C, -+0x00, 0x6A, 0x04, 0xD2, 0xD2, 0xF4, 0x01, 0x4C, -+0xA2, 0x67, 0x64, 0x6A, 0x58, 0xEE, 0x01, 0x6F, -+0x12, 0xEE, 0x00, 0x18, 0xAB, 0xE3, 0x1B, 0x10, -+0xEB, 0xF6, 0x74, 0xA0, 0x02, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0xEB, 0xF6, 0x54, 0xC0, 0x02, 0x6C, -+0xEB, 0xF6, 0xB2, 0xA8, 0x0E, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, -+0x94, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, 0xEB, 0xF6, -+0xB2, 0xAA, 0x8C, 0xEB, 0xEB, 0xF6, 0x74, 0xC2, -+0x03, 0x6C, 0x00, 0x18, 0x84, 0xE4, 0x07, 0x97, -+0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xAC, 0xF0, 0x7C, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0xD7, 0xE4, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x69, -+0xC0, 0xF1, 0x08, 0x49, 0xEB, 0xF6, 0x94, 0xA1, -+0x01, 0x6A, 0xFF, 0x6B, 0x8C, 0xEA, 0x00, 0xF1, -+0x0C, 0x22, 0xEB, 0xF6, 0xA0, 0xA1, 0x03, 0x6E, -+0xAE, 0x32, 0xCC, 0xEA, 0x6C, 0xEA, 0x02, 0x72, -+0x7E, 0x60, 0x06, 0x67, 0x4E, 0xE8, 0xE0, 0xF0, -+0x02, 0x20, 0x01, 0x72, 0x25, 0x60, 0x02, 0x6A, -+0x4B, 0xEA, 0x8C, 0xEA, 0xEB, 0xF6, 0x54, 0xC1, -+0x02, 0x6A, 0xAC, 0xEA, 0x6C, 0xEA, 0x11, 0x22, -+0xEB, 0xF6, 0x43, 0xA1, 0x0F, 0x6D, 0xEB, 0xF6, -+0x84, 0xA1, 0x4C, 0xED, 0x52, 0x36, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, 0x6C, 0xED, -+0x6C, 0xEE, 0x40, 0xEA, 0x01, 0x72, 0x01, 0x6C, -+0x01, 0x61, 0x00, 0x6C, 0xEB, 0xF6, 0xB2, 0xA9, -+0x00, 0x18, 0x84, 0xE4, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x54, 0x9A, 0x40, 0xEA, 0xD9, 0x10, -+0x02, 0x6A, 0xAC, 0xEA, 0x6C, 0xEA, 0x11, 0x22, -+0xEB, 0xF6, 0x43, 0xA1, 0x0F, 0x6D, 0xEB, 0xF6, -+0x84, 0xA1, 0x4C, 0xED, 0x52, 0x36, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, 0x6C, 0xED, -+0x6C, 0xEE, 0x40, 0xEA, 0x01, 0x72, 0xA0, 0xF0, -+0x14, 0x61, 0xEB, 0xF6, 0xB2, 0xA9, 0x00, 0x6C, -+0x00, 0x18, 0x84, 0xE4, 0x30, 0xF0, 0x20, 0x6A, -+0xAC, 0xF0, 0x4D, 0xA2, 0x5A, 0x33, 0x02, 0x73, -+0x0D, 0x60, 0x03, 0x73, 0x0F, 0x60, 0x01, 0x73, -+0x05, 0x60, 0x3F, 0x6E, 0x4C, 0xEE, 0xFF, 0x6A, -+0x4C, 0xEE, 0x0E, 0x10, 0x3F, 0x6B, 0x4C, 0xEB, -+0x0A, 0x6E, 0x08, 0x10, 0x3F, 0x6B, 0x4C, 0xEB, -+0x64, 0x6E, 0x04, 0x10, 0x3F, 0x6B, 0x4C, 0xEB, -+0xE0, 0xF3, 0x08, 0x6E, 0xD8, 0xEB, 0x12, 0xEE, -+0x0A, 0x6A, 0x58, 0xEE, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, 0x7A, 0xAA, -+0x10, 0xF0, 0x24, 0x6C, 0xD2, 0xF4, 0x01, 0x4C, -+0x12, 0xEE, 0x7B, 0xE6, 0x00, 0x6B, 0xEB, 0xF6, -+0x75, 0xC2, 0x00, 0x6B, 0xEB, 0xF6, 0x7A, 0xCA, -+0xEB, 0xF6, 0x78, 0xCA, 0x00, 0x6A, 0x04, 0xD2, -+0xA2, 0x67, 0x64, 0x6A, 0x62, 0x10, 0x02, 0x6A, -+0xAC, 0xEA, 0x6C, 0xEA, 0x10, 0x22, 0xEB, 0xF6, -+0x43, 0xA1, 0x0F, 0x6D, 0xEB, 0xF6, 0x84, 0xA1, -+0x4C, 0xED, 0x52, 0x36, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x54, 0x9A, 0x6C, 0xED, 0x6C, 0xEE, -+0x40, 0xEA, 0x01, 0x72, 0x62, 0x61, 0xEB, 0xF6, -+0xB2, 0xA9, 0x00, 0x6C, 0x00, 0x18, 0x84, 0xE4, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xEB, 0xF6, 0x87, 0xA2, 0xEB, 0xF6, 0x76, 0xA2, -+0xFF, 0x4C, 0x6E, 0xEC, 0x03, 0x2C, 0xEB, 0xF6, -+0x66, 0xA2, 0x05, 0x10, 0x01, 0x4B, 0xEB, 0xF6, -+0x76, 0xC2, 0xEB, 0xF6, 0x65, 0xA2, 0x7A, 0x32, -+0x02, 0x72, 0x0D, 0x60, 0x03, 0x72, 0x0F, 0x60, -+0x01, 0x72, 0x05, 0x60, 0x3F, 0x6A, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x0E, 0x10, 0x3F, 0x6A, -+0x6C, 0xEA, 0x0A, 0x6B, 0x08, 0x10, 0x3F, 0x6A, -+0x6C, 0xEA, 0x64, 0x6B, 0x04, 0x10, 0x3F, 0x6A, -+0x6C, 0xEA, 0xE0, 0xF3, 0x08, 0x6B, 0x78, 0xEA, -+0x12, 0xEA, 0x0A, 0x6B, 0x78, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xCC, 0xF0, 0x62, 0xAB, 0x00, 0x6C, -+0x64, 0x6E, 0x12, 0xEA, 0x6B, 0xE2, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0xEB, 0xF6, -+0x95, 0xC3, 0x00, 0x6C, 0xEB, 0xF6, 0x9A, 0xCB, -+0xEB, 0xF6, 0x98, 0xCB, 0x00, 0x6B, 0x10, 0xF0, -+0x24, 0x6C, 0x04, 0xD3, 0xD2, 0xF4, 0x01, 0x4C, -+0xA3, 0x67, 0xD8, 0xEA, 0x01, 0x6F, 0x12, 0xEE, -+0x00, 0x18, 0xAB, 0xE3, 0x1E, 0x10, 0xEB, 0xF6, -+0xB2, 0xA9, 0x00, 0x6C, 0x00, 0x18, 0x84, 0xE4, -+0xEB, 0xF6, 0x15, 0xC1, 0xEB, 0xF6, 0x1A, 0xC9, -+0xEB, 0xF6, 0x18, 0xC9, 0x00, 0x18, 0x30, 0xE5, -+0x10, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xEB, 0xF6, 0x94, 0xA2, 0x02, 0x6B, -+0x6B, 0xEB, 0xEB, 0xF6, 0xB2, 0xAA, 0x8C, 0xEB, -+0xEB, 0xF6, 0x74, 0xC2, 0x01, 0x6C, 0x00, 0x18, -+0x84, 0xE4, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x04, 0x67, -+0x25, 0x67, 0x4C, 0xEE, 0x4C, 0xE8, 0x4C, 0xE9, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, 0x4C, 0x9A, -+0x04, 0xD6, 0x90, 0x67, 0xB1, 0x67, 0x40, 0xEA, -+0x90, 0x67, 0x80, 0x18, 0x20, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF7, 0x7A, 0xA2, 0x00, 0x6A, -+0x09, 0x2B, 0x04, 0x97, 0x30, 0xF0, 0x20, 0x6C, -+0x25, 0xF6, 0x08, 0x4C, 0xB0, 0x67, 0xD1, 0x67, -+0x80, 0x18, 0xA9, 0x21, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0x6B, 0x6C, 0xEC, 0x0F, 0x6A, 0x8C, 0xEA, -+0x03, 0x2A, 0x92, 0x32, 0x6C, 0xEA, 0x20, 0xE8, -+0x07, 0x4A, 0x6C, 0xEA, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x54, 0x9A, 0x01, 0x6C, 0x04, 0xF0, 0x00, 0x6D, -+0x09, 0x10, 0xFF, 0x4A, 0x44, 0x33, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x54, 0x9A, 0x01, 0x6D, -+0x02, 0x6C, 0xA4, 0xEB, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x08, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x54, 0x9A, 0x01, 0x6C, -+0x08, 0xF0, 0x00, 0x6D, 0x09, 0x10, 0x44, 0x32, -+0x6F, 0x42, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x54, 0x9A, 0x01, 0x6D, 0x02, 0x6C, 0xA4, 0xEB, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x04, 0x2A, 0x01, 0x6C, 0x08, 0xF0, 0x00, 0x6D, -+0x05, 0x10, 0x44, 0x32, 0xFF, 0x4A, 0x01, 0x6D, -+0x02, 0x6C, 0xA4, 0xEA, 0x00, 0x18, 0xF1, 0xDC, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x04, 0x2A, 0x01, 0x6C, 0x04, 0xF0, 0x00, 0x6D, -+0x05, 0x10, 0xFF, 0x4A, 0x44, 0x32, 0x01, 0x6D, -+0x02, 0x6C, 0xA4, 0xEA, 0x00, 0x18, 0xF1, 0xDC, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6D, 0x8C, 0xED, -+0x01, 0x6C, 0x44, 0x67, 0x15, 0x4D, 0x44, 0xED, -+0xA2, 0x67, 0x00, 0x18, 0x70, 0xDC, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6D, 0x8C, 0xED, 0x04, 0x2D, 0x03, 0x6C, -+0x10, 0xF0, 0x00, 0x6D, 0x05, 0x10, 0x1B, 0x4D, -+0x01, 0x6A, 0x44, 0xED, 0x03, 0x6C, 0xA2, 0x67, -+0x00, 0x18, 0x70, 0xDC, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0xDC, 0xE5, -+0x01, 0x6D, 0x02, 0x6C, 0xA4, 0xEA, 0x00, 0x18, -+0x70, 0xDC, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x18, 0xDC, 0xE5, 0x01, 0x6D, 0x03, 0x6C, -+0xA4, 0xEA, 0x00, 0x18, 0x70, 0xDC, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6D, 0x8C, 0xED, 0x18, 0x4D, 0x01, 0x6A, -+0x44, 0xED, 0x00, 0x6C, 0xA2, 0x67, 0x00, 0x18, -+0x70, 0xDC, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6D, 0x8C, 0xED, -+0x01, 0x6C, 0x44, 0x67, 0x15, 0x4D, 0x44, 0xED, -+0xA2, 0x67, 0x00, 0x18, 0xA1, 0xDC, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6D, 0x8C, 0xED, 0x04, 0x2D, 0x03, 0x6C, -+0x10, 0xF0, 0x00, 0x6D, 0x05, 0x10, 0x1B, 0x4D, -+0x01, 0x6A, 0x44, 0xED, 0x03, 0x6C, 0xA2, 0x67, -+0x00, 0x18, 0xA1, 0xDC, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0xDC, 0xE5, -+0x01, 0x6D, 0x02, 0x6C, 0xA4, 0xEA, 0x00, 0x18, -+0xA1, 0xDC, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x18, 0xDC, 0xE5, 0x01, 0x6D, 0x03, 0x6C, -+0xA4, 0xEA, 0x00, 0x18, 0xA1, 0xDC, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xDE, 0x63, 0x43, 0x62, -+0x42, 0xD1, 0x41, 0xD0, 0x01, 0x6A, 0x7D, 0x67, -+0x4B, 0xEA, 0x54, 0xC3, 0x0F, 0x6A, 0x56, 0xC3, -+0x10, 0x6A, 0x57, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF5, 0x58, 0x9A, 0xFF, 0x69, 0x8C, 0xE9, -+0x30, 0x31, 0x49, 0xE1, 0x40, 0x9A, 0x30, 0xF0, -+0x20, 0x68, 0x06, 0x04, 0x04, 0xD2, 0x4E, 0xF2, -+0x50, 0x98, 0x04, 0x05, 0x04, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF4, 0x50, 0x9A, -+0x07, 0x04, 0x04, 0x05, 0x49, 0xE1, 0x40, 0x9A, -+0x04, 0x6E, 0x04, 0xD2, 0x4E, 0xF2, 0x50, 0x98, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF4, -+0x44, 0x9A, 0x08, 0x04, 0x04, 0x05, 0x49, 0xE1, -+0x40, 0x9A, 0x04, 0x6E, 0x04, 0xD2, 0x4E, 0xF2, -+0x50, 0x98, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF4, 0x58, 0x9A, 0x09, 0x04, 0x04, 0x05, -+0x45, 0xE1, 0x40, 0x99, 0x04, 0x6E, 0x04, 0xD2, -+0x4E, 0xF2, 0x50, 0x98, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x5C, 0x9A, 0x05, 0x04, -+0x40, 0xEA, 0x43, 0x97, 0x42, 0x91, 0x41, 0x90, -+0x22, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF6, 0x50, 0x9A, -+0xD5, 0xF6, 0x74, 0x9B, 0x00, 0xA2, 0x20, 0xA3, -+0xFF, 0x6A, 0x4C, 0xE8, 0x4C, 0xE9, 0x2A, 0xE8, -+0x43, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF5, -+0x58, 0x9A, 0x10, 0x33, 0x49, 0xE3, 0x40, 0xA2, -+0xFF, 0x6B, 0x6C, 0xEA, 0x56, 0x32, 0x6C, 0xEA, -+0x07, 0x5A, 0x2C, 0x60, 0x10, 0xF0, 0x24, 0x6B, -+0x48, 0x32, 0xB5, 0xF0, 0x14, 0x4B, 0x4D, 0xE3, -+0x40, 0x9B, 0x00, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF7, 0x5A, 0xA2, 0x1F, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x54, 0x9A, 0x18, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x5C, 0x9A, -+0x13, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x40, 0x9A, 0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x44, 0x9A, 0x09, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x48, 0x9A, 0x04, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x4C, 0x9A, -+0x90, 0x67, 0x40, 0xEA, 0x01, 0x48, 0x7F, 0x6A, -+0x4C, 0xE8, 0x0A, 0xE9, 0xC2, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF6, 0x50, 0x9A, 0x20, 0xC2, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF6, 0x60, 0x9A, 0x02, 0x6C, 0x00, 0xF4, -+0x00, 0x6D, 0x40, 0x9B, 0x30, 0xF0, 0x20, 0x69, -+0x8D, 0xEA, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF2, 0x64, 0x9A, 0xFF, 0xF7, 0x1F, 0x6C, -+0x40, 0xAB, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xCB, 0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF6, -+0x18, 0x9A, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF6, -+0x1C, 0x4B, 0x40, 0x98, 0x60, 0x9B, 0x0A, 0x6C, -+0x6C, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF1, -+0x64, 0x9B, 0x6D, 0xEA, 0x40, 0xD8, 0xCE, 0xF4, -+0x5C, 0x99, 0x40, 0xEA, 0x40, 0x98, 0xDF, 0xF7, -+0x01, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF6, 0x60, 0x9B, 0x0A, 0x6C, -+0x6D, 0xEA, 0x40, 0xD8, 0xCE, 0xF4, 0x5C, 0x99, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6C, 0xD5, 0xF6, -+0x1C, 0x4C, 0x40, 0x98, 0x80, 0x9C, 0x8C, 0xEA, -+0x40, 0xD8, 0xCE, 0xF4, 0x5C, 0x99, 0x0A, 0x6C, -+0x40, 0xEA, 0x40, 0x98, 0x1D, 0xF0, 0x01, 0x6B, -+0x6B, 0xEB, 0x6C, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF6, 0x64, 0x9B, 0x0A, 0x6C, 0x6D, 0xEA, -+0x40, 0xD8, 0xCE, 0xF4, 0x5C, 0x99, 0x40, 0xEA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF6, 0xA8, 0x9B, 0xFF, 0x6A, 0x08, 0x6E, -+0x60, 0xA5, 0xCB, 0xEE, 0x4C, 0xEC, 0x4C, 0xEB, -+0xCC, 0xEB, 0x6D, 0xEC, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF6, 0x6C, 0x9B, 0x4C, 0xEC, 0x80, 0xC5, -+0x60, 0xA3, 0x6C, 0xEA, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF6, 0xC8, 0x9B, -+0xFF, 0x6A, 0x08, 0x6F, 0x60, 0xA6, 0xEB, 0xEF, -+0x4C, 0xEC, 0x4C, 0xEB, 0xEC, 0xEB, 0x6D, 0xEC, -+0x4C, 0xED, 0x4C, 0xEC, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF6, 0x4C, 0x9A, 0x80, 0xC6, 0xA0, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x00, 0x6C, 0x00, 0x18, -+0x9F, 0xE7, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, -+0x40, 0x9A, 0x01, 0x68, 0x0B, 0xE8, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x69, 0x01, 0xF4, 0x00, 0x6C, -+0xB0, 0x67, 0x00, 0x18, 0x05, 0xE1, 0xCE, 0xF4, -+0x70, 0x99, 0x04, 0x6E, 0xCB, 0xEE, 0x4C, 0xEE, -+0x01, 0xF4, 0x00, 0x6C, 0xB0, 0x67, 0x40, 0xEB, -+0x00, 0x6C, 0xA4, 0x67, 0xD0, 0x67, 0x00, 0x18, -+0x50, 0xE1, 0x00, 0x6C, 0xE4, 0x67, 0x30, 0xF0, -+0x20, 0x6B, 0xA4, 0x67, 0xD0, 0x67, 0xEF, 0xF5, -+0x40, 0xCB, 0x00, 0x18, 0x63, 0xE1, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF3, 0x64, 0x9A, 0xFE, 0x6A, -+0xB0, 0x67, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0xA1, 0xF0, 0x14, 0x6C, 0x00, 0x18, 0x05, 0xE1, -+0xCE, 0xF4, 0x70, 0x99, 0x40, 0x6E, 0xA1, 0xF0, -+0x14, 0x6C, 0xB0, 0x67, 0x4D, 0xEE, 0x40, 0xEB, -+0x00, 0x18, 0x9A, 0xC9, 0x01, 0x72, 0x06, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF2, 0x44, 0x9A, -+0x3F, 0x6B, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF6, 0x70, 0x9A, 0xFD, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF6, 0x70, 0x9A, -+0xFF, 0x69, 0x02, 0x6C, 0x40, 0xA3, 0x01, 0x68, -+0x0B, 0xE8, 0x2C, 0xEA, 0x8D, 0xEA, 0x2C, 0xEA, -+0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF2, -+0x44, 0x9A, 0x01, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF6, 0x54, 0x9A, -+0x09, 0x6B, 0xB0, 0x67, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF3, 0x4C, 0x9A, 0x7A, 0x6B, -+0x6B, 0xEB, 0x60, 0xC2, 0xA1, 0xF0, 0x12, 0x4C, -+0x00, 0x18, 0x05, 0xE1, 0x30, 0xF0, 0x20, 0x6C, -+0xCE, 0xF4, 0x70, 0x9C, 0x41, 0x6E, 0xCB, 0xEE, -+0xB0, 0x67, 0x4C, 0xEE, 0xA1, 0xF0, 0x14, 0x6C, -+0x40, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF3, -+0x64, 0x9A, 0x01, 0x6C, 0x40, 0xA3, 0x2C, 0xEA, -+0x8D, 0xEA, 0x2C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x01, 0xF3, -+0x01, 0x49, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF5, 0xE0, 0xAA, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF1, 0x44, 0x9A, 0x00, 0x6C, 0xD0, 0x67, -+0x4D, 0xEF, 0xA4, 0x67, 0x00, 0x18, 0x63, 0xE1, -+0x91, 0x67, 0xB0, 0x67, 0x00, 0x18, 0x05, 0xE1, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x70, 0x9C, -+0x03, 0x6E, 0xB0, 0x67, 0x4D, 0xEE, 0x91, 0x67, -+0x40, 0xEB, 0x01, 0x6C, 0x00, 0x18, 0x9F, 0xE7, -+0x00, 0x18, 0x9D, 0xD3, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF7, 0x48, 0x9A, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x80, 0xA2, 0xEB, 0xF6, 0xD4, 0xA3, 0xEB, 0xF6, -+0x9C, 0xC3, 0xA0, 0xAA, 0x01, 0xF0, 0x00, 0x6C, -+0xAC, 0xEC, 0x83, 0x35, 0x03, 0x6C, 0xAE, 0x35, -+0x8B, 0xEC, 0xA4, 0x35, 0xCC, 0xEC, 0xAD, 0xEC, -+0xEB, 0xF6, 0x94, 0xC3, 0x10, 0xF0, 0x24, 0x6C, -+0x15, 0xF7, 0x8C, 0x9C, 0xA0, 0xAC, 0xEB, 0xF6, -+0xBE, 0xCB, 0xA0, 0xAA, 0xBF, 0xF7, 0x1F, 0x6B, -+0xAC, 0xEB, 0x60, 0xCA, 0xA0, 0xAA, 0x7F, 0xF7, -+0x1F, 0x6B, 0xAC, 0xEB, 0x60, 0xCA, 0xC0, 0xAA, -+0xFE, 0xF7, 0x1F, 0x6B, 0xFF, 0xF7, 0x1F, 0x6D, -+0xCC, 0xEB, 0x60, 0xCA, 0x40, 0xAC, 0xFF, 0x6B, -+0x21, 0x4B, 0xAC, 0xEA, 0x6D, 0xEA, 0xAC, 0xEA, -+0x40, 0xCC, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6B, -+0xEB, 0xF6, 0x9C, 0xA2, 0x15, 0xF7, 0x68, 0x9B, -+0x01, 0x6E, 0x80, 0xC3, 0x10, 0xF0, 0x24, 0x6C, -+0xEB, 0xF6, 0xBE, 0xAA, 0x15, 0xF7, 0x8C, 0x9C, -+0xA0, 0xCC, 0xEB, 0xF6, 0x54, 0xA2, 0x80, 0xAB, -+0xFF, 0xF7, 0x1F, 0x6D, 0x46, 0x32, 0xCC, 0xEA, -+0xAC, 0xEC, 0x40, 0x32, 0xFE, 0xF7, 0x1E, 0x4E, -+0x4C, 0x32, 0xCC, 0xEC, 0x8D, 0xEA, 0xAC, 0xEA, -+0x40, 0xCB, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF7, -+0x50, 0x9A, 0xEF, 0xF7, 0x1F, 0x68, 0x02, 0x6B, -+0x40, 0xAA, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF5, 0x58, 0xAA, 0x0E, 0xEA, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0xAB, 0xE6, 0x02, 0x6B, -+0x50, 0x67, 0x6C, 0xEA, 0x08, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF5, 0x58, 0xAA, 0x6C, 0xEA, -+0x02, 0x2A, 0x00, 0x18, 0xAB, 0xE6, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF5, 0x58, 0xAA, 0x80, 0x6B, -+0x0E, 0xEA, 0x6C, 0xEA, 0x06, 0x22, 0x0C, 0xEB, -+0x04, 0x2B, 0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, -+0xA7, 0xD3, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF5, -+0x18, 0xCA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x01, 0x74, 0x1C, 0x60, 0x05, 0x24, -+0x02, 0x74, 0x0E, 0x60, 0x03, 0x74, 0x51, 0x60, -+0x5B, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF7, -+0x7C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x35, 0xF7, -+0x80, 0x9C, 0x40, 0x9B, 0x8C, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF7, 0x64, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0xD5, 0xF2, 0x80, 0x9C, -+0x40, 0x9B, 0x8C, 0xEA, 0x44, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF7, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x35, 0xF7, 0x80, 0x9C, 0x40, 0x9B, -+0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF2, -+0x80, 0x9C, 0x8D, 0xEA, 0x40, 0xDB, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF5, 0x58, 0xAA, 0x80, 0x6B, -+0x6C, 0xEA, 0x1F, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x40, 0xA2, 0x05, 0x5A, 0x19, 0x60, -+0x01, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0xA7, 0xD3, -+0x0A, 0x68, 0x01, 0x6E, 0x00, 0x6C, 0x01, 0x6D, -+0xCB, 0xEE, 0x00, 0x18, 0x50, 0xE1, 0x04, 0x6B, -+0x4C, 0xEB, 0x02, 0x23, 0x01, 0x68, 0x04, 0x10, -+0x01, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0xA7, 0xD3, -+0xFF, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0xED, 0x28, -+0x04, 0x10, 0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, -+0xA7, 0xD3, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF7, -+0x64, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0xB5, 0xF2, -+0x9C, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0x15, 0xF2, 0x7C, 0x9B, 0xE9, 0xA4, -+0x48, 0xA4, 0xA0, 0xAB, 0xE0, 0x37, 0x5D, 0xE7, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xEF, 0x4C, 0xED, -+0x4A, 0xA4, 0xCB, 0xA4, 0x02, 0x5A, 0x04, 0x61, -+0x02, 0x72, 0x0B, 0x6A, 0x30, 0x61, 0x0C, 0x10, -+0x00, 0xF1, 0x01, 0x5F, 0x2B, 0x60, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0xAB, 0xF6, -+0x03, 0x4B, 0x2B, 0xF6, 0xE1, 0xC2, 0x0B, 0x10, -+0x00, 0xF1, 0x01, 0x5F, 0x1F, 0x60, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0xAB, 0xF7, -+0x03, 0x4B, 0x2B, 0xF6, 0xE2, 0xC2, 0xB5, 0xE6, -+0x10, 0xF0, 0x24, 0x6E, 0x00, 0x6A, 0x35, 0xF7, -+0x08, 0x9E, 0x10, 0xF0, 0x24, 0x6E, 0x04, 0xD2, -+0x05, 0xD2, 0xB5, 0xF2, 0xD8, 0x9E, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x40, 0x9A, 0xBC, 0x35, -+0x00, 0x6C, 0x15, 0xE5, 0xD9, 0xE3, 0x40, 0xEA, -+0x00, 0x6A, 0x01, 0x10, 0x0A, 0x6A, 0x07, 0x97, -+0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x01, 0x2A, 0x01, 0x6A, 0x30, 0xF0, 0x20, 0x6C, -+0xC0, 0xF1, 0x08, 0x4C, 0xCB, 0xF6, 0xDD, 0xA4, -+0x38, 0x26, 0x8D, 0xE2, 0x4B, 0xF4, 0x78, 0xA3, -+0x34, 0x23, 0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF2, -+0x7C, 0x9B, 0xFF, 0xF7, 0x1F, 0x6D, 0x01, 0x72, -+0x60, 0xAB, 0x6C, 0xED, 0x03, 0x60, 0x02, 0x72, -+0x08, 0x60, 0x27, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xAB, 0xF6, 0x03, 0x4B, 0x4B, 0xF4, 0xF9, 0xA4, -+0x06, 0x10, 0x4B, 0xF4, 0xFA, 0xA4, 0x30, 0xF0, -+0x20, 0x6B, 0xAB, 0xF7, 0x03, 0x4B, 0xE1, 0xF7, -+0x1F, 0x6A, 0xAC, 0xEA, 0x10, 0xF0, 0x24, 0x6D, -+0xB5, 0xF2, 0xB8, 0x9D, 0xD9, 0xE2, 0x00, 0x6A, -+0xB5, 0xE3, 0x10, 0xF0, 0x24, 0x6B, 0x04, 0xD2, -+0x05, 0xD2, 0x35, 0xF7, 0x68, 0x9B, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x40, 0x9A, 0xDC, 0x36, -+0x00, 0x6C, 0x79, 0xE6, 0x40, 0xEA, 0x01, 0x6A, -+0x01, 0x10, 0x00, 0x6A, 0x07, 0x97, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x4C, 0xED, -+0x4C, 0xEC, 0x4C, 0xEE, 0xEC, 0xEA, 0x05, 0x25, -+0x01, 0x75, 0x56, 0x61, 0x08, 0x6B, 0x0C, 0x6D, -+0x02, 0x10, 0x0A, 0x6B, 0x0E, 0x6D, 0x01, 0x74, -+0x1D, 0x60, 0x02, 0x74, 0x2A, 0x60, 0x26, 0x67, -+0xE1, 0x45, 0xC4, 0xED, 0x24, 0xEB, 0x82, 0x67, -+0xCD, 0xE9, 0x84, 0xEF, 0xC1, 0x43, 0x8D, 0xE9, -+0x44, 0xEE, 0x4D, 0xE9, 0x01, 0x6A, 0x02, 0x67, -+0x04, 0xEB, 0x62, 0x67, 0x64, 0xED, 0xA2, 0x67, -+0x6D, 0xE8, 0xA4, 0xEF, 0xAD, 0xE8, 0x44, 0xEE, -+0xFF, 0xF7, 0x1F, 0x6C, 0x4D, 0xE8, 0x8C, 0xE9, -+0x8C, 0xE8, 0x1E, 0x10, 0x01, 0x6B, 0x01, 0x45, -+0x22, 0x67, 0x83, 0x67, 0x24, 0xE8, 0xC4, 0xED, -+0x84, 0xE8, 0xCD, 0xE9, 0xFF, 0xF7, 0x1F, 0x6A, -+0x04, 0x67, 0x64, 0xED, 0x4C, 0xE9, 0x6D, 0xE8, -+0x0E, 0x10, 0x01, 0x6C, 0x01, 0x43, 0x22, 0x67, -+0xA4, 0x67, 0x24, 0xE8, 0xC4, 0xEB, 0xA4, 0xE8, -+0xCD, 0xE9, 0xFF, 0xF7, 0x1F, 0x6A, 0x05, 0x67, -+0x84, 0xEB, 0x4C, 0xE9, 0x8D, 0xE8, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF3, 0x4C, 0x9A, -+0x38, 0x6C, 0x0F, 0xE8, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF3, 0x40, 0x9A, 0x40, 0xEA, -+0x4C, 0xE8, 0x04, 0x92, 0x2D, 0xE8, 0xFF, 0xF7, -+0x1F, 0x6D, 0x38, 0x6C, 0x0C, 0xED, 0x40, 0xEA, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0xE8, 0xF2, 0x7C, 0xA3, 0xFF, 0x6A, 0xAC, 0xEA, -+0x01, 0x73, 0x03, 0x61, 0xAD, 0xF4, 0x00, 0x6B, -+0x04, 0x10, 0x03, 0x73, 0x04, 0x61, 0xA5, 0xF1, -+0x00, 0x6B, 0x6B, 0xEB, 0x02, 0x10, 0x60, 0xF2, -+0x00, 0x6B, 0x60, 0xCC, 0x30, 0xF0, 0x20, 0x6B, -+0xE8, 0xF2, 0x7C, 0xA3, 0x02, 0x73, 0x0A, 0x61, -+0x10, 0xF0, 0x24, 0x6B, 0x55, 0xF7, 0x74, 0x9B, -+0x74, 0x6D, 0xA0, 0xC3, 0xA0, 0xAC, 0x80, 0x6B, -+0xAD, 0xEB, 0x60, 0xCC, 0x09, 0x22, 0x60, 0xAC, -+0x00, 0xF2, 0x01, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x41, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x06, 0x10, -+0x60, 0xAC, 0x00, 0xF2, 0x00, 0x6A, 0x6D, 0xEA, -+0x40, 0x6B, 0x6D, 0xEA, 0x40, 0xCC, 0x20, 0xE8, -+0xFF, 0x63, 0x01, 0xD1, 0x00, 0xD0, 0x30, 0xF0, -+0x20, 0x6B, 0xE8, 0xF2, 0x7C, 0xA3, 0xFF, 0x6A, -+0x8C, 0xEA, 0x02, 0x73, 0x70, 0x61, 0x48, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF7, 0xF8, 0x9A, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, -+0x60, 0x9F, 0xA0, 0xF0, 0x7C, 0xDA, 0x10, 0xF0, -+0x24, 0x6B, 0x55, 0xF7, 0xDC, 0x9B, 0x60, 0x9E, -+0xA0, 0xF0, 0x70, 0xDA, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF7, 0xBC, 0x9B, 0x60, 0x9D, 0xA0, 0xF0, -+0x74, 0xDA, 0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF5, -+0x80, 0x9B, 0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF5, -+0x64, 0x9B, 0x20, 0x9C, 0xA0, 0xF0, 0x2C, 0xDA, -+0x00, 0x9B, 0xA0, 0xF0, 0x18, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF7, 0x40, 0x9A, 0x2D, 0xEA, -+0x18, 0xF0, 0x01, 0x69, 0x2B, 0xE9, 0x2C, 0xEA, -+0x10, 0xF0, 0x24, 0x69, 0xB5, 0xF6, 0x34, 0x99, -+0x0D, 0xE9, 0x02, 0xF0, 0x01, 0x68, 0x0B, 0xE8, -+0x0C, 0xE9, 0x10, 0xF0, 0x24, 0x68, 0x75, 0xF7, -+0x04, 0x98, 0x00, 0xDF, 0x04, 0x6F, 0xE0, 0xDE, -+0x10, 0xF0, 0x24, 0x6E, 0x75, 0xF7, 0xC8, 0x9E, -+0xC0, 0xDD, 0x40, 0xDC, 0x20, 0xDB, 0x27, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, -+0x10, 0xF0, 0x24, 0x6B, 0xA0, 0xF0, 0x9C, 0x9A, -+0x55, 0xF7, 0x78, 0x9B, 0x80, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xA0, 0xF0, 0x90, 0x9A, 0x55, 0xF7, -+0x7C, 0x9B, 0x80, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xA0, 0xF0, 0x94, 0x9A, 0x15, 0xF7, 0x7C, 0x9B, -+0x80, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xA0, 0xF0, -+0x8C, 0x9A, 0x95, 0xF5, 0x60, 0x9B, 0x80, 0xDB, -+0xA0, 0xF0, 0x78, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF5, 0x44, 0x9A, 0x60, 0xDA, 0x01, 0x91, -+0x00, 0x90, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF7, 0x6C, 0x9A, -+0xFF, 0x6C, 0x21, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, 0x5C, 0xA2, -+0x01, 0x72, 0x0B, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF7, 0x70, 0x9A, 0xFF, 0x6C, 0x04, 0x6D, -+0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x20, 0xE8, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0xF7, 0x1F, 0x6B, -+0xAC, 0xEB, 0x06, 0xD3, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF2, 0x7C, 0x9B, 0xFF, 0x6A, 0x8C, 0xEA, -+0x80, 0xAB, 0xE1, 0xF7, 0x1F, 0x6B, 0x00, 0x68, -+0x8C, 0xEB, 0x69, 0xE2, 0x10, 0xF0, 0x24, 0x6B, -+0x75, 0xF7, 0x94, 0x9B, 0x5C, 0x32, 0x91, 0xE2, -+0x04, 0xD4, 0x22, 0x10, 0x04, 0x92, 0x40, 0x9A, -+0x05, 0xD2, 0x0D, 0x28, 0x30, 0xF0, 0x20, 0x69, -+0xCE, 0xF4, 0x50, 0x99, 0x05, 0x96, 0x01, 0x6D, -+0x83, 0xF1, 0x18, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x99, 0x04, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x05, 0x96, -+0x01, 0x6D, 0x83, 0xF1, 0x18, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x04, 0x93, 0x01, 0x48, 0xFF, 0xF7, -+0x1F, 0x6A, 0x04, 0x4B, 0x4C, 0xE8, 0x04, 0xD3, -+0x06, 0x92, 0x43, 0xE8, 0xDB, 0x61, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xDF, 0x63, 0x41, 0x62, 0x40, 0xD0, 0x01, 0x68, -+0x00, 0x6A, 0x0B, 0xE8, 0x82, 0x67, 0x42, 0x6D, -+0xD0, 0x67, 0x04, 0xD2, 0x00, 0x18, 0x50, 0xE1, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF1, 0x64, 0x9B, -+0x4C, 0xEB, 0x36, 0x2B, 0x00, 0x6C, 0x42, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x50, 0xE1, 0x1F, 0xF4, -+0x00, 0x6B, 0x4C, 0xEB, 0x62, 0x32, 0x4A, 0x32, -+0x2E, 0x5A, 0x04, 0xD2, 0x02, 0x60, 0x2D, 0x72, -+0x16, 0x61, 0x01, 0x6A, 0x7D, 0x67, 0x4B, 0xEA, -+0x54, 0xC3, 0x1D, 0x6A, 0x56, 0xC3, 0x04, 0x6A, -+0x57, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x50, 0x9A, 0x06, 0x04, 0x04, 0x05, 0x04, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x05, 0x04, 0x40, 0xEA, 0x01, 0x68, -+0x0B, 0xE8, 0x00, 0x6C, 0x42, 0x6D, 0xD0, 0x67, -+0x00, 0x18, 0x50, 0xE1, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF1, 0xE4, 0x9B, 0x00, 0x6C, 0x42, 0x6D, -+0xD0, 0x67, 0x4D, 0xEF, 0x00, 0x18, 0x63, 0xE1, -+0x41, 0x97, 0x40, 0x90, 0x21, 0x63, 0x00, 0xEF, -+0x3B, 0x24, 0x03, 0x80, 0x51, 0x24, 0x03, 0x80, -+0x67, 0x24, 0x03, 0x80, 0x7D, 0x24, 0x03, 0x80, -+0x97, 0x24, 0x03, 0x80, 0xEF, 0x24, 0x03, 0x80, -+0x05, 0x25, 0x03, 0x80, 0x23, 0x25, 0x03, 0x80, -+0x55, 0x25, 0x03, 0x80, 0x7F, 0x25, 0x03, 0x80, -+0x27, 0x30, 0x03, 0x80, 0x2D, 0x30, 0x03, 0x80, -+0x39, 0x30, 0x03, 0x80, 0x45, 0x30, 0x03, 0x80, -+0x51, 0x30, 0x03, 0x80, 0xC1, 0x32, 0x03, 0x80, -+0xA9, 0x33, 0x03, 0x80, 0x23, 0x33, 0x03, 0x80, -+0xA9, 0x33, 0x03, 0x80, 0x69, 0x32, 0x03, 0x80, -+0xA9, 0x33, 0x03, 0x80, 0xA9, 0x33, 0x03, 0x80, -+0xA9, 0x33, 0x03, 0x80, 0x8B, 0x33, 0x03, 0x80, -+0xA9, 0x33, 0x03, 0x80, 0xA9, 0x33, 0x03, 0x80, -+0xA9, 0x33, 0x03, 0x80, 0x03, 0x32, 0x03, 0x80, -+0x57, 0x36, 0x03, 0x80, 0x61, 0x36, 0x03, 0x80, -+0x6B, 0x36, 0x03, 0x80, 0x75, 0x36, 0x03, 0x80, -+0x7F, 0x36, 0x03, 0x80, 0xDD, 0x37, 0x03, 0x80, -+0xFD, 0x37, 0x03, 0x80, 0x1D, 0x38, 0x03, 0x80, -+0x3D, 0x38, 0x03, 0x80, 0x5D, 0x38, 0x03, 0x80, -+0xF3, 0x39, 0x03, 0x80, 0x2F, 0x3A, 0x03, 0x80, -+0x75, 0x3A, 0x03, 0x80, 0xB7, 0x3A, 0x03, 0x80, -+0xFD, 0x3A, 0x03, 0x80, 0x6B, 0x3B, 0x03, 0x80, -+0x87, 0x3B, 0x03, 0x80, 0xA9, 0x3B, 0x03, 0x80, -+0xCB, 0x3B, 0x03, 0x80, 0xEF, 0x3B, 0x03, 0x80, -+0xA8, 0x06, 0x10, 0x07, 0x00, 0x16, 0x04, 0x16, -+0x08, 0x16, 0x00, 0x00, 0x9B, 0x3E, 0x03, 0x80, -+0xF7, 0x3E, 0x03, 0x80, 0x8B, 0x3F, 0x03, 0x80, -+0x1F, 0x40, 0x03, 0x80, 0xB7, 0x40, 0x03, 0x80, -+0xED, 0x44, 0x03, 0x80, 0xE7, 0x44, 0x03, 0x80, -+0xF3, 0x44, 0x03, 0x80, 0xF9, 0x44, 0x03, 0x80, -+0xFF, 0x44, 0x03, 0x80, 0x05, 0x45, 0x03, 0x80, -+0x94, 0x0C, 0x94, 0x0E, 0x94, 0x18, 0x94, 0x1A, -+0x00, 0x01, 0x02, 0x03, 0x05, 0x00, 0x00, 0x00, -+0x00, 0x01, 0x03, 0x04, 0x05, 0x00, 0x00, 0x00, -+0x09, 0x12, 0x1B, 0x24, 0xC1, 0x51, 0x10, 0x80, -+0xFF, 0x51, 0x10, 0x80, 0xC9, 0x51, 0x10, 0x80, -+0xF1, 0x51, 0x10, 0x80, 0xFF, 0x51, 0x10, 0x80, -+0xFF, 0x51, 0x10, 0x80, 0xFF, 0x51, 0x10, 0x80, -+0xD1, 0x51, 0x10, 0x80, 0xD9, 0x51, 0x10, 0x80, -+0xE1, 0x51, 0x10, 0x80, 0xFF, 0x51, 0x10, 0x80, -+0xFF, 0x51, 0x10, 0x80, 0xF9, 0x51, 0x10, 0x80, -+0xFF, 0x51, 0x10, 0x80, 0xE9, 0x51, 0x10, 0x80, -+0x04, 0x08, 0x08, 0x08, 0x08, 0x08, 0x0A, 0x0A, -+0x0A, 0x00, 0x00, 0x00, 0x00, 0x04, 0x0C, 0x14, -+0x1C, 0x24, 0x2C, 0x36, 0x40, 0x00, 0x00, 0x00, -+0x27, 0x5E, 0x10, 0x80, 0x3D, 0x5E, 0x10, 0x80, -+0x27, 0x5E, 0x10, 0x80, 0x3D, 0x5E, 0x10, 0x80, -+0x27, 0x5E, 0x10, 0x80, 0x3D, 0x5E, 0x10, 0x80, -+0x6D, 0x5E, 0x10, 0x80, 0x6D, 0x5E, 0x10, 0x80, -+0x6D, 0x5E, 0x10, 0x80, 0x2B, 0x5E, 0x10, 0x80, -+0x53, 0x5E, 0x10, 0x80, 0x53, 0x5E, 0x10, 0x80, -+0x2B, 0x5E, 0x10, 0x80, 0x85, 0x5E, 0x10, 0x80, -+0xA1, 0x5E, 0x10, 0x80, 0x71, 0x71, 0x10, 0x80, -+0xC1, 0x71, 0x10, 0x80, 0x49, 0x72, 0x10, 0x80, -+0x9F, 0x72, 0x10, 0x80, 0xC3, 0x72, 0x10, 0x80, -+0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, -+0x0F, 0x10, 0x00, 0x00, 0x12, 0x12, 0x14, 0x12, -+0x0F, 0x0F, 0x0C, 0x0C, 0x09, 0x08, 0x08, 0x07, -+0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, 0x05, 0x04, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x0A, 0x0A, 0x08, 0x08, 0x08, 0x07, 0x07, 0x06, -+0x04, 0x04, 0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, -+0x07, 0x06, 0x05, 0x04, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x05, 0x04, 0x04, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x28, 0x28, 0x32, 0x28, 0x1E, 0x19, 0x19, 0x19, -+0x18, 0x18, 0x12, 0x0F, 0x14, 0x1E, 0x19, 0x1E, -+0x18, 0x16, 0x0C, 0x0C, 0x1E, 0x1E, 0x19, 0x1E, -+0x18, 0x16, 0x0C, 0x0C, 0x1E, 0x1E, 0x19, 0x1C, -+0x18, 0x14, 0x0C, 0x0A, 0x1E, 0x1E, 0x19, 0x1E, -+0x19, 0x18, 0x0F, 0x0E, 0x14, 0x28, 0x21, 0x1E, -+0x1A, 0x16, 0x0B, 0x10, 0x0A, 0x0A, 0x2D, 0x28, -+0x21, 0x1E, 0x1A, 0x16, 0x0B, 0x10, 0x0A, 0x0A, -+0x1E, 0x1E, 0x1E, 0x1E, 0x18, 0x16, 0x0D, 0x0D, -+0x0A, 0x08, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x4A, 0x40, 0x36, 0x2C, -+0x24, 0x1C, 0x14, 0x0C, 0x04, 0x00, 0x00, 0x00, -+0x0B, 0x7E, 0x10, 0x80, 0x5F, 0x7E, 0x10, 0x80, -+0xED, 0x7E, 0x10, 0x80, 0xED, 0x7F, 0x10, 0x80, -+0x53, 0x7F, 0x10, 0x80, 0x83, 0x7F, 0x10, 0x80, -+0x63, 0x6F, 0x6E, 0x66, 0x69, 0x67, 0x5F, 0x70, -+0x68, 0x79, 0x64, 0x6D, 0x5F, 0x73, 0x77, 0x69, -+0x74, 0x63, 0x68, 0x5F, 0x62, 0x61, 0x6E, 0x64, -+0x77, 0x69, 0x64, 0x74, 0x68, 0x5F, 0x38, 0x38, -+0x32, 0x31, 0x63, 0x00, 0x63, 0x6F, 0x6E, 0x66, -+0x69, 0x67, 0x5F, 0x70, 0x68, 0x79, 0x64, 0x6D, -+0x5F, 0x73, 0x77, 0x69, 0x74, 0x63, 0x68, 0x5F, -+0x63, 0x68, 0x61, 0x6E, 0x6E, 0x65, 0x6C, 0x5F, -+0x38, 0x38, 0x32, 0x31, 0x63, 0x00, 0x00, 0x00, -+0x63, 0x6F, 0x6E, 0x66, 0x69, 0x67, 0x5F, 0x70, -+0x68, 0x79, 0x64, 0x6D, 0x5F, 0x73, 0x77, 0x69, -+0x74, 0x63, 0x68, 0x5F, 0x62, 0x61, 0x6E, 0x64, -+0x5F, 0x38, 0x38, 0x32, 0x31, 0x63, 0x00, 0x00, -+0x63, 0x6F, 0x6E, 0x66, 0x69, 0x67, 0x5F, 0x70, -+0x68, 0x79, 0x64, 0x6D, 0x5F, 0x77, 0x72, 0x69, -+0x74, 0x65, 0x5F, 0x72, 0x66, 0x5F, 0x72, 0x65, -+0x67, 0x5F, 0x38, 0x38, 0x32, 0x31, 0x63, 0x00, -+0x63, 0x6F, 0x6E, 0x66, 0x69, 0x67, 0x5F, 0x70, -+0x68, 0x79, 0x64, 0x6D, 0x5F, 0x72, 0x65, 0x61, -+0x64, 0x5F, 0x72, 0x66, 0x5F, 0x72, 0x65, 0x67, -+0x5F, 0x38, 0x38, 0x32, 0x31, 0x63, 0x00, 0x00, -+0x2D, 0x87, 0x10, 0x80, 0x47, 0x87, 0x10, 0x80, -+0x57, 0x87, 0x10, 0x80, 0x6D, 0x87, 0x10, 0x80, -+0x83, 0x87, 0x10, 0x80, 0x83, 0x87, 0x10, 0x80, -+0x9F, 0x87, 0x10, 0x80, 0x71, 0x1B, 0x03, 0x80, -+0x6D, 0x1B, 0x03, 0x80, 0x71, 0x1B, 0x03, 0x80, -+0x6D, 0x1B, 0x03, 0x80, 0x91, 0x1B, 0x03, 0x80, -+0x6D, 0x1B, 0x03, 0x80, 0x91, 0x1B, 0x03, 0x80, -+0x6D, 0x1B, 0x03, 0x80, 0xB1, 0x1B, 0x03, 0x80, -+0x6D, 0x1B, 0x03, 0x80, 0xB1, 0x1B, 0x03, 0x80, -+0x6D, 0x1B, 0x03, 0x80, 0xD1, 0x1B, 0x03, 0x80, -+0x6D, 0x1B, 0x03, 0x80, 0xD1, 0x1B, 0x03, 0x80, -+0x13, 0x63, 0x03, 0x80, 0x29, 0x63, 0x03, 0x80, -+0x53, 0x63, 0x03, 0x80, 0x53, 0x63, 0x03, 0x80, -+0x53, 0x63, 0x03, 0x80, 0x53, 0x63, 0x03, 0x80, -+0x35, 0x63, 0x03, 0x80, 0x3F, 0x63, 0x03, 0x80, -+0x49, 0x63, 0x03, 0x80, 0x53, 0x63, 0x03, 0x80, -+0x1B, 0x63, 0x03, 0x80, 0x09, 0x63, 0x03, 0x80, -+0xE3, 0x1D, 0x03, 0x80, 0xE7, 0x1D, 0x03, 0x80, -+0xEB, 0x1D, 0x03, 0x80, 0xEF, 0x1D, 0x03, 0x80, -+0xF3, 0x1D, 0x03, 0x80, 0xD5, 0x71, 0x03, 0x80, -+0xF7, 0x71, 0x03, 0x80, 0x19, 0x72, 0x03, 0x80, -+0x3B, 0x72, 0x03, 0x80, 0x5F, 0x72, 0x03, 0x80, -+0x99, 0x72, 0x03, 0x80, 0xBD, 0x72, 0x03, 0x80, -+0xE1, 0x72, 0x03, 0x80, 0x05, 0x73, 0x03, 0x80, -+0x2B, 0x73, 0x03, 0x80, 0x31, 0x75, 0x03, 0x80, -+0x47, 0x75, 0x03, 0x80, 0x69, 0x75, 0x03, 0x80, -+0x8F, 0x75, 0x03, 0x80, 0xB5, 0x75, 0x03, 0x80, -+0x91, 0x79, 0x03, 0x80, 0x91, 0x79, 0x03, 0x80, -+0x91, 0x79, 0x03, 0x80, 0xAB, 0x79, 0x03, 0x80, -+0x91, 0x79, 0x03, 0x80, 0x91, 0x79, 0x03, 0x80, -+0x91, 0x79, 0x03, 0x80, 0x8D, 0x79, 0x03, 0x80, -+0x8D, 0x79, 0x03, 0x80, 0x8D, 0x79, 0x03, 0x80, -+0x8D, 0x79, 0x03, 0x80, 0x8D, 0x79, 0x03, 0x80, -+0x09, 0x7A, 0x03, 0x80, 0x13, 0x7A, 0x03, 0x80, -+0x8D, 0x20, 0x03, 0x80, 0x8D, 0x20, 0x03, 0x80, -+0x8D, 0x20, 0x03, 0x80, 0x8D, 0x20, 0x03, 0x80, -+0xAD, 0x20, 0x03, 0x80, 0xAD, 0x20, 0x03, 0x80, -+0xAD, 0x20, 0x03, 0x80, 0xAD, 0x20, 0x03, 0x80, -+0xCD, 0x20, 0x03, 0x80, 0xCD, 0x20, 0x03, 0x80, -+0xCD, 0x20, 0x03, 0x80, 0xCD, 0x20, 0x03, 0x80, -+0xED, 0x20, 0x03, 0x80, 0xED, 0x20, 0x03, 0x80, -+0xED, 0x20, 0x03, 0x80, 0xED, 0x20, 0x03, 0x80, -+0xD3, 0x8B, 0x03, 0x80, 0xE3, 0x8B, 0x03, 0x80, -+0xED, 0x8B, 0x03, 0x80, 0xF7, 0x8B, 0x03, 0x80, -+0x09, 0x8C, 0x03, 0x80, 0x45, 0x9A, 0x03, 0x80, -+0x77, 0x9A, 0x03, 0x80, 0x59, 0x9A, 0x03, 0x80, -+0x81, 0x9A, 0x03, 0x80, 0x63, 0x9A, 0x03, 0x80, -+0x8D, 0x9A, 0x03, 0x80, 0x6D, 0x9A, 0x03, 0x80, -+0xFC, 0x10, 0x60, 0xB8, 0xFA, 0xFA, 0xFA, 0xFA, -+0x8C, 0x04, 0x64, 0xB8, 0x90, 0x04, 0x64, 0xB8, -+0x94, 0x04, 0x64, 0xB8, 0x98, 0x04, 0x64, 0xB8, -+0x9C, 0x04, 0x64, 0xB8, 0xA0, 0x04, 0x64, 0xB8, -+0x01, 0x06, 0x64, 0xB8, 0x00, 0x00, 0x68, 0x18, -+0x48, 0x00, 0x68, 0x18, 0x48, 0x04, 0x68, 0x18, -+0x00, 0x00, 0x60, 0xB8, 0x00, 0x00, 0x64, 0xB8, -+0x54, 0x05, 0x64, 0xB8, 0x50, 0x05, 0x64, 0xB8, -+0x51, 0x05, 0x64, 0xB8, 0x78, 0x05, 0x64, 0xB8, -+0x79, 0x05, 0x64, 0xB8, 0x7A, 0x05, 0x64, 0xB8, -+0xFF, 0xFF, 0xFF, 0x8F, 0x60, 0x05, 0x60, 0xB8, -+0x60, 0x05, 0x64, 0xB8, 0x00, 0x00, 0x00, 0x10, -+0x00, 0x00, 0x00, 0x20, 0x00, 0x00, 0x00, 0x30, -+0x00, 0x00, 0x00, 0x40, 0xBF, 0x01, 0x64, 0xB8, -+0x89, 0x00, 0x60, 0xB8, 0x8A, 0x00, 0x60, 0xB8, -+0x1A, 0x04, 0x64, 0xB8, 0x1B, 0x04, 0x64, 0xB8, -+0x87, 0x02, 0x64, 0xB8, 0x96, 0x02, 0x64, 0xB8, -+0x86, 0x02, 0x64, 0xB8, 0xF8, 0x10, 0x60, 0xB8, -+0x00, 0x00, 0x40, 0x00, 0xF0, 0x11, 0x64, 0xB8, -+0x58, 0x05, 0x64, 0xB8, 0x01, 0x00, 0x60, 0xB8, -+0x01, 0x00, 0x64, 0xB8, 0x57, 0x01, 0x64, 0xB8, -+0x3C, 0x01, 0x64, 0xB8, 0x22, 0x05, 0x64, 0xB8, -+0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x02, 0x00, -+0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x08, 0x00, -+0x0A, 0x06, 0x64, 0xB8, 0x5B, 0x01, 0x64, 0xB8, -+0xFE, 0x11, 0x64, 0xB8, 0xA8, 0x06, 0x64, 0xB8, -+0x10, 0x07, 0x64, 0xB8, 0x00, 0x16, 0x64, 0xB8, -+0x04, 0x16, 0x64, 0xB8, 0x08, 0x16, 0x64, 0xB8, -+0xAB, 0x06, 0x64, 0xB8, 0xAA, 0x06, 0x64, 0xB8, -+0x13, 0x07, 0x64, 0xB8, 0x12, 0x07, 0x64, 0xB8, -+0x03, 0x16, 0x64, 0xB8, 0x02, 0x16, 0x64, 0xB8, -+0x07, 0x16, 0x64, 0xB8, 0x06, 0x16, 0x64, 0xB8, -+0x0B, 0x16, 0x64, 0xB8, 0x0A, 0x16, 0x64, 0xB8, -+0xFC, 0x11, 0x64, 0xB8, 0x00, 0x00, 0x1E, 0x00, -+0x00, 0x00, 0x06, 0x00, 0x00, 0x00, 0x03, 0x00, -+0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x00, 0x03, -+0xB1, 0x05, 0x64, 0xB8, 0x22, 0x00, 0x60, 0xB8, -+0x04, 0x06, 0x64, 0xB8, 0xFF, 0xFF, 0xFF, 0xFE, -+0x00, 0x00, 0x00, 0x01, 0x60, 0x16, 0x64, 0xB8, -+0x09, 0x00, 0x78, 0xB8, 0x31, 0x00, 0x78, 0xB8, -+0x14, 0x00, 0x78, 0xB8, 0x1D, 0x04, 0x64, 0xB8, -+0x7A, 0x04, 0x64, 0xB8, 0x24, 0x04, 0x64, 0xB8, -+0x4D, 0x01, 0x64, 0xB8, 0x00, 0x01, 0x64, 0xB8, -+0x04, 0x02, 0x64, 0xB8, 0x08, 0x02, 0x64, 0xB8, -+0x56, 0x04, 0x64, 0xB8, 0x04, 0x00, 0x70, 0xB8, -+0x0A, 0x00, 0x70, 0xB8, 0x34, 0x00, 0x78, 0xB8, -+0x18, 0x11, 0x64, 0xB8, 0x55, 0x00, 0x78, 0xB8, -+0x56, 0x00, 0x78, 0xB8, 0x40, 0x00, 0x78, 0xB8, -+0x1C, 0x04, 0x64, 0xB8, 0x10, 0x00, 0x70, 0xB8, -+0x4C, 0x04, 0x64, 0xB8, 0x4D, 0x04, 0x64, 0xB8, -+0x16, 0x00, 0x70, 0xB8, 0x4E, 0x04, 0x64, 0xB8, -+0x17, 0x00, 0x70, 0xB8, 0x4F, 0x04, 0x64, 0xB8, -+0xC7, 0x01, 0x64, 0xB8, 0xA4, 0x01, 0x64, 0xB8, -+0x1C, 0x01, 0x64, 0xB8, 0xFF, 0xFF, 0x03, 0x00, -+0x84, 0x02, 0x64, 0xB8, 0x52, 0x05, 0x64, 0xB8, -+0x20, 0x04, 0x64, 0xB8, 0xFF, 0xFF, 0xEF, 0xFF, -+0x5F, 0x11, 0x64, 0xB8, 0x88, 0x00, 0x60, 0xB8, -+0x8B, 0x00, 0x60, 0xB8, 0x84, 0x00, 0x60, 0xB8, -+0x00, 0x00, 0x00, 0x02, 0xCB, 0x01, 0x64, 0xB8, -+0x00, 0x00, 0x00, 0x60, 0xE0, 0x00, 0x60, 0xB8, -+0xE1, 0x00, 0x60, 0xB8, 0xE8, 0x12, 0x64, 0xB8, -+0x00, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00, 0x04, -+0xFF, 0xFF, 0xFF, 0xFB, 0xFF, 0xFF, 0xFF, 0xDF, -+0xFF, 0xFF, 0xFF, 0x1F, 0x04, 0x00, 0x60, 0xB8, -+0x04, 0x00, 0x64, 0xB8, 0x08, 0x00, 0x60, 0xB8, -+0x08, 0x00, 0x64, 0xB8, 0x24, 0x00, 0x60, 0xB8, -+0x80, 0x00, 0x60, 0xB8, 0xFF, 0xFF, 0xFD, 0xFF, -+0xCC, 0x07, 0x64, 0xB8, 0x82, 0x10, 0x60, 0xB8, -+0x42, 0x34, 0x00, 0xB8, 0x00, 0x0C, 0x01, 0x00, -+0x08, 0x00, 0x00, 0xF8, 0x08, 0x70, 0x0A, 0xF8, -+0x08, 0x50, 0x01, 0xF8, 0x00, 0x00, 0x1F, 0x00, -+0x00, 0x00, 0x00, 0xC0, 0x1A, 0x15, 0x64, 0xB8, -+0x77, 0x77, 0x77, 0x77, 0x17, 0x11, 0x17, 0x77, -+0x00, 0x00, 0x00, 0x3E, 0x00, 0x00, 0xE0, 0xFF, -+0x00, 0x1C, 0x01, 0x88, 0x01, 0x00, 0x00, 0xE0, -+0x00, 0x00, 0xFF, 0x0F, 0x21, 0x00, 0x00, 0xE0, -+0x00, 0x00, 0x00, 0xFF, 0x08, 0x00, 0x45, 0x01, -+0x88, 0x0C, 0x46, 0x01, 0xFF, 0xFF, 0x0F, 0x00, -+0xBA, 0xCB, 0x08, 0x00, 0x18, 0x80, 0x0A, 0x00, -+0x68, 0x10, 0x46, 0x01, 0xF3, 0x10, 0x05, 0x00, -+0x00, 0x9C, 0x0A, 0x00, 0x08, 0x00, 0x45, 0x00, -+0x68, 0x14, 0x46, 0x00, 0x08, 0x00, 0x84, 0x00, -+0xBA, 0xCB, 0x0B, 0x00, 0x18, 0xC0, 0x0A, 0x00, -+0x08, 0x00, 0x44, 0x01, 0xF3, 0x0E, 0x05, 0x00, -+0x18, 0xDC, 0x0A, 0x00, 0xC8, 0x0E, 0x05, 0x00, -+0x18, 0x9C, 0x0A, 0x00, 0x00, 0x00, 0xF0, 0x0F, -+0x00, 0x00, 0x00, 0x0F, 0x02, 0x00, 0x60, 0xB8, -+0x62, 0x06, 0x64, 0xB8, 0xB4, 0x06, 0x64, 0xB8, -+0x06, 0x00, 0x00, 0x89, 0x00, 0x00, 0x00, 0x50, -+0x40, 0x00, 0x0F, 0x70, 0x02, 0x04, 0x00, 0xD8, -+0x20, 0x01, 0x00, 0xD1, 0x40, 0x80, 0x0B, 0x70, -+0x02, 0x04, 0x02, 0xD8, 0x20, 0x01, 0x00, 0xDE, -+0x03, 0x29, 0x29, 0x00, 0x48, 0x00, 0x46, 0x01, -+0x60, 0x10, 0x05, 0x00, 0xDE, 0x0F, 0x0E, 0x00, -+0xCE, 0xEF, 0x0D, 0x00, 0xCE, 0xEF, 0x05, 0x00, -+0xFF, 0x3F, 0x0E, 0x00, 0x1F, 0xFF, 0x0F, 0x00, -+0xE7, 0x0E, 0x05, 0x00, 0xE8, 0x0E, 0x05, 0x00, -+0x45, 0x23, 0x01, 0x00, 0x08, 0x08, 0x00, 0xF8, -+0x08, 0x07, 0x00, 0xF8, 0x08, 0x02, 0x00, 0xF8, -+0x08, 0x03, 0x00, 0xF8, 0x18, 0x00, 0x00, 0xF8, -+0xDE, 0xBC, 0x0A, 0x00, 0x01, 0x00, 0x66, 0xB8, -+0x00, 0x00, 0x66, 0xB8, 0xCD, 0x9B, 0x78, 0x56, -+0x00, 0x1C, 0x66, 0xB8, 0x04, 0x1C, 0x66, 0xB8, -+0xFF, 0xFF, 0x3F, 0x00, 0x1F, 0x00, 0x60, 0xB8, -+0x04, 0xEA, 0xEF, 0xFD, 0x07, 0xEA, 0xEF, 0xFD, -+0x08, 0xEA, 0xEF, 0xFD, 0x09, 0xEA, 0xEF, 0xFD, -+0x0A, 0xEA, 0xEF, 0xFD, 0x53, 0x04, 0x64, 0xB8, -+0xF0, 0x10, 0x60, 0xB8, 0xCA, 0x04, 0x64, 0xB8, -+0xCF, 0x04, 0x64, 0xB8, 0xF1, 0x10, 0x60, 0xB8, -+0x06, 0x00, 0x66, 0xB8, 0x52, 0x04, 0x64, 0xB8, -+0x50, 0x04, 0x64, 0xB8, 0x51, 0x04, 0x64, 0xB8, -+0x01, 0x1C, 0x66, 0xB8, 0x02, 0x1C, 0x66, 0xB8, -+0x03, 0x1C, 0x66, 0xB8, 0x05, 0x1C, 0x66, 0xB8, -+0x06, 0x1C, 0x66, 0xB8, 0x07, 0x1C, 0x66, 0xB8, -+0x02, 0x10, 0x66, 0xB8, 0x08, 0x10, 0x66, 0xB8, -+0x03, 0x10, 0x66, 0xB8, 0x09, 0x10, 0x66, 0xB8, -+0x04, 0x10, 0x66, 0xB8, 0x05, 0x10, 0x66, 0xB8, -+0x0C, 0x10, 0x66, 0xB8, 0x0D, 0x10, 0x66, 0xB8, -+0x06, 0x10, 0x66, 0xB8, 0xFF, 0xFF, 0x0B, 0xFF, -+0x00, 0x00, 0x70, 0x00, 0xFF, 0xFF, 0x7A, 0xFF, -+0x00, 0x00, 0xD0, 0x00, 0xFF, 0xFF, 0xDA, 0xFF, -+0xFF, 0xFF, 0xFF, 0x0F, 0x00, 0xFC, 0xCF, 0xFF, -+0x00, 0x00, 0x01, 0x10, 0x00, 0xF3, 0x3F, 0xFF, -+0x01, 0x00, 0x02, 0x20, 0x00, 0xCF, 0xFF, 0xFC, -+0x02, 0x00, 0x04, 0x40, 0x00, 0xFC, 0xCE, 0xEF, -+0x40, 0x02, 0x20, 0x00, 0x80, 0x03, 0x30, 0x00, -+0x00, 0xFF, 0xF9, 0xFF, 0x00, 0x00, 0xFE, 0x1F, -+0x1C, 0x0C, 0xB8, 0x64, 0x67, 0x56, 0x23, 0x01, -+0xFF, 0xFF, 0xF7, 0xFF, 0xFF, 0xFC, 0xFE, 0xFF, -+0x00, 0x01, 0x01, 0x00, 0x00, 0x00, 0x80, 0x01, -+0xCC, 0x06, 0x64, 0xB8, 0x68, 0x05, 0x64, 0xB8, -+0x40, 0x42, 0x0F, 0x00, 0x00, 0x04, 0x64, 0xB8, -+0x04, 0x04, 0x64, 0xB8, 0x08, 0x04, 0x64, 0xB8, -+0x0C, 0x04, 0x64, 0xB8, 0x68, 0x04, 0x64, 0xB8, -+0x6C, 0x04, 0x64, 0xB8, 0x70, 0x04, 0x64, 0xB8, -+0x74, 0x04, 0x64, 0xB8, 0x00, 0x00, 0x3C, 0x00, -+0x6B, 0x01, 0x64, 0xB8, 0x00, 0x00, 0x70, 0xB8, -+0x18, 0x00, 0x70, 0xB8, 0x0B, 0x00, 0x70, 0xB8, -+0x02, 0x00, 0x70, 0xB8, 0x94, 0x02, 0x64, 0xB8, -+0x97, 0x02, 0x64, 0xB8, 0x54, 0x02, 0x64, 0xB8, -+0x50, 0x02, 0x64, 0xB8, 0x4C, 0x02, 0x64, 0xB8, -+0x00, 0x00, 0x78, 0xB8, 0x04, 0x00, 0x78, 0xB8, -+0x48, 0x02, 0x64, 0xB8, 0x44, 0x02, 0x64, 0xB8, -+0xCC, 0x01, 0x64, 0xB8, 0xF4, 0x11, 0x64, 0xB8, -+0xF5, 0x11, 0x64, 0xB8, 0xD4, 0x04, 0x60, 0xB8, -+0xD4, 0x04, 0x64, 0xB8, 0x84, 0x04, 0x60, 0xB8, -+0x84, 0x04, 0x64, 0xB8, 0xC8, 0x04, 0x60, 0xB8, -+0xC8, 0x04, 0x64, 0xB8, 0x78, 0x04, 0x60, 0xB8, -+0x78, 0x04, 0x64, 0xB8, 0xCF, 0x01, 0x64, 0xB8, -+0x34, 0x01, 0x64, 0xB8, 0x64, 0x05, 0x64, 0xB8, -+0x44, 0x00, 0x60, 0xB8, 0x60, 0x00, 0x60, 0xB8, -+0xBE, 0x05, 0x64, 0xB8, 0x01, 0xEA, 0xEF, 0xFD, -+0x02, 0xEA, 0xEF, 0xFD, 0xC8, 0x01, 0x64, 0xB8, -+0xC9, 0x01, 0x64, 0xB8, 0xA0, 0x01, 0x64, 0xB8, -+0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x05, -+0x64, 0x01, 0x64, 0xB8, 0x53, 0x05, 0x64, 0xB8, -+0x77, 0x05, 0x64, 0xB8, 0x94, 0x01, 0x64, 0xB8, -+0x00, 0x10, 0x66, 0xB8, 0x54, 0x00, 0x60, 0xB8, -+0x50, 0x00, 0x60, 0xB8, 0x9A, 0x01, 0x64, 0xB8, -+0x99, 0x01, 0x64, 0xB8, 0xC6, 0x01, 0x64, 0xB8, -+0x30, 0x01, 0x64, 0xB8, 0x24, 0x01, 0x64, 0xB8, -+0x20, 0x01, 0x64, 0xB8, 0x24, 0x11, 0x64, 0xB8, -+0x20, 0x11, 0x64, 0xB8, 0x2C, 0x11, 0x64, 0xB8, -+0x28, 0x11, 0x64, 0xB8, 0x34, 0x11, 0x64, 0xB8, -+0x30, 0x11, 0x64, 0xB8, 0x38, 0x01, 0x64, 0xB8, -+0x3C, 0x11, 0x64, 0xB8, 0x38, 0x11, 0x64, 0xB8, -+0xE4, 0x11, 0x64, 0xB8, 0xE0, 0x11, 0x64, 0xB8, -+0x00, 0x40, 0xE0, 0x03, 0x01, 0x60, 0x00, 0x03, -+0xE0, 0x04, 0x64, 0xB8, 0xE3, 0x04, 0x64, 0xB8, -+0xE0, 0x12, 0x64, 0xB8, 0x02, 0x01, 0x64, 0xB8, -+0x21, 0x05, 0x64, 0xB8, 0x40, 0x11, 0x64, 0xB8, -+0x44, 0x11, 0x64, 0xB8, 0x48, 0x11, 0x64, 0xB8, -+0x4C, 0x11, 0x64, 0xB8, 0x2F, 0x01, 0x64, 0xB8, -+0x00, 0x28, 0x64, 0xB8, 0x00, 0x2C, 0x64, 0xB8, -+0x00, 0x38, 0x64, 0xB8, 0x00, 0x3C, 0x64, 0xB8, -+0xF8, 0x05, 0x64, 0xB8, 0xF9, 0x05, 0x64, 0xB8, -+0xFA, 0x05, 0x64, 0xB8, 0xFB, 0x05, 0x64, 0xB8, -+0x83, 0x00, 0x60, 0xB8, 0x08, 0x01, 0x64, 0xB8, -+0x90, 0x00, 0x60, 0xB8, 0x92, 0x00, 0x60, 0xB8, -+0x92, 0x06, 0x64, 0xB8, 0xF1, 0x11, 0x64, 0xB8, -+0x20, 0x00, 0x78, 0xB8, 0x10, 0x00, 0x78, 0xB8, -+0x03, 0x00, 0x78, 0xB8, 0xFF, 0xFF, 0x01, 0xFF, -+0x05, 0x00, 0x78, 0xB8, 0x12, 0x05, 0x64, 0xB8, -+0x10, 0x05, 0x64, 0xB8, 0xB8, 0x05, 0x64, 0xB8, -+0xBC, 0x05, 0x64, 0xB8, 0x00, 0x00, 0x80, 0x00, -+0x6F, 0x01, 0x64, 0xB8, 0xFE, 0xFF, 0xFF, 0x7F, -+0x30, 0x00, 0x78, 0x18, 0x40, 0x00, 0x00, 0xB5, -+0x44, 0x00, 0x00, 0xB5, 0x48, 0x00, 0x00, 0xB5, -+0x4C, 0x00, 0x00, 0xB5, 0x00, 0x00, 0x10, 0x00, -+0xA4, 0x04, 0x64, 0xB8, 0xA8, 0x04, 0x64, 0xB8, -+0xC0, 0x01, 0x64, 0xB8, 0xAF, 0x01, 0x64, 0xB8, -+0x00, 0x00, 0x20, 0x00, 0x7E, 0x04, 0x64, 0xB8, -+0x7D, 0x04, 0x64, 0xB8, 0x7C, 0x04, 0x64, 0xB8, -+0x98, 0x01, 0x64, 0xB8, 0xFF, 0xFF, 0xC0, 0xFF, -+0x40, 0x01, 0x00, 0x80, 0x00, 0x98, 0x00, 0x80, -+0x7B, 0x05, 0x64, 0xB8, 0x73, 0x05, 0x64, 0xB8, -+0x01, 0x01, 0x64, 0xB8, 0xB7, 0x06, 0x64, 0xB8, -+0x68, 0x06, 0x64, 0xB8, 0xFF, 0xFF, 0xCF, 0xFF, -+0x5C, 0x05, 0x64, 0xB8, 0x38, 0x06, 0x64, 0xB8, -+0x08, 0x06, 0x64, 0xB8, 0xA0, 0x06, 0x64, 0xB8, -+0xAA, 0x00, 0x60, 0xB8, 0xA8, 0x00, 0x60, 0xB8, -+0x00, 0x00, 0x02, 0x80, 0x4C, 0x00, 0x60, 0xB8, -+0xFF, 0xFF, 0x7F, 0xFE, 0x70, 0x00, 0x60, 0xB8, -+0x00, 0x00, 0x78, 0x18, 0xE4, 0x00, 0x60, 0xB8, -+0xE8, 0x00, 0x60, 0xB8, 0xE9, 0x00, 0x60, 0xB8, -+0xEA, 0x00, 0x60, 0xB8, 0xEB, 0x00, 0x60, 0xB8, -+0xE5, 0x00, 0x60, 0xB8, 0x44, 0x00, 0x02, 0x00, -+0xA0, 0x07, 0x64, 0xB8, 0xFF, 0xFF, 0xFF, 0x7F, -+0xF4, 0x00, 0x60, 0xB8, 0x91, 0x00, 0x60, 0xB8, -+0x64, 0x00, 0x60, 0xB8, 0x40, 0x00, 0x60, 0xB8, -+0x00, 0x00, 0xC0, 0x00, 0x00, 0x10, 0x24, 0x00, -+0x82, 0x82, 0x62, 0x00, 0x90, 0x06, 0x64, 0xB8, -+0x80, 0x34, 0x00, 0xB8, 0x30, 0x00, 0x78, 0xB8, -+0x43, 0x6C, 0x65, 0x61, 0x72, 0x50, 0x57, 0x54, -+0x00, 0x00, 0x00, 0x00, 0x41, 0x20, 0x4D, 0x69, -+0x78, 0x4D, 0x6F, 0x64, 0x65, 0x20, 0x41, 0x47, -+0x43, 0x3D, 0x30, 0x78, 0x25, 0x62, 0x58, 0x20, -+0x42, 0x42, 0x53, 0x3D, 0x30, 0x78, 0x25, 0x62, -+0x58, 0x00, 0x00, 0x00, 0x42, 0x20, 0x4D, 0x69, -+0x78, 0x4D, 0x6F, 0x64, 0x65, 0x20, 0x41, 0x47, -+0x43, 0x3D, 0x30, 0x78, 0x25, 0x62, 0x58, 0x20, -+0x42, 0x42, 0x53, 0x3D, 0x30, 0x78, 0x25, 0x62, -+0x58, 0x00, 0x00, 0x00, 0x5B, 0x49, 0x51, 0x4B, -+0x5D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3E, 0x50, -+0x48, 0x59, 0x5F, 0x49, 0x51, 0x43, 0x61, 0x6C, -+0x69, 0x62, 0x72, 0x61, 0x74, 0x65, 0x5F, 0x49, -+0x6E, 0x69, 0x74, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x63, 0x61, 0x6C, 0x69, 0x62, 0x72, 0x61, 0x74, -+0x69, 0x6F, 0x6E, 0x20, 0x74, 0x69, 0x6D, 0x65, -+0x6F, 0x75, 0x74, 0x21, 0x21, 0x21, 0x0A, 0x00, -+0x64, 0x65, 0x6C, 0x61, 0x79, 0x20, 0x63, 0x6F, -+0x75, 0x6E, 0x74, 0x20, 0x3D, 0x20, 0x30, 0x78, -+0x25, 0x78, 0x21, 0x21, 0x21, 0x0A, 0x00, 0x00, -+0x64, 0x65, 0x6C, 0x61, 0x79, 0x5F, 0x63, 0x6F, -+0x75, 0x6E, 0x74, 0x20, 0x3D, 0x20, 0x30, 0x78, -+0x25, 0x78, 0x0A, 0x00, 0x49, 0x51, 0x4B, 0x73, -+0x74, 0x65, 0x70, 0x20, 0x3D, 0x20, 0x30, 0x78, -+0x25, 0x62, 0x78, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x49, 0x51, 0x4B, 0x5D, 0x50, 0x61, 0x74, -+0x68, 0x41, 0x5F, 0x4C, 0x4F, 0x4B, 0x5F, 0x6E, -+0x6F, 0x74, 0x72, 0x65, 0x61, 0x64, 0x79, 0x20, -+0x3D, 0x20, 0x25, 0x64, 0x0A, 0x00, 0x00, 0x00, -+0x5B, 0x49, 0x51, 0x4B, 0x5D, 0x50, 0x61, 0x74, -+0x68, 0x41, 0x5F, 0x54, 0x58, 0x49, 0x51, 0x4B, -+0x5F, 0x66, 0x61, 0x69, 0x6C, 0x20, 0x3D, 0x20, -+0x25, 0x64, 0x0A, 0x00, 0x5B, 0x49, 0x51, 0x4B, -+0x5D, 0x50, 0x61, 0x74, 0x68, 0x41, 0x5F, 0x52, -+0x58, 0x49, 0x51, 0x4B, 0x5F, 0x66, 0x61, 0x69, -+0x6C, 0x20, 0x3D, 0x20, 0x25, 0x64, 0x0A, 0x00, -+0x5B, 0x49, 0x51, 0x4B, 0x5D, 0x50, 0x61, 0x74, -+0x68, 0x41, 0x5F, 0x54, 0x58, 0x49, 0x51, 0x4B, -+0x5F, 0x72, 0x65, 0x74, 0x72, 0x79, 0x20, 0x3D, -+0x20, 0x25, 0x64, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x49, 0x51, 0x4B, 0x5D, 0x50, 0x61, 0x74, -+0x68, 0x41, 0x5F, 0x52, 0x58, 0x4B, 0x31, 0x5F, -+0x72, 0x65, 0x74, 0x72, 0x79, 0x20, 0x3D, 0x20, -+0x25, 0x64, 0x2C, 0x20, 0x50, 0x61, 0x74, 0x68, -+0x41, 0x5F, 0x52, 0x58, 0x4B, 0x32, 0x5F, 0x72, -+0x65, 0x74, 0x72, 0x79, 0x20, 0x3D, 0x20, 0x25, -+0x64, 0x0A, 0x00, 0x00, 0x5B, 0x49, 0x51, 0x4B, -+0x5D, 0x50, 0x61, 0x74, 0x68, 0x41, 0x5F, 0x47, -+0x53, 0x31, 0x5F, 0x72, 0x65, 0x74, 0x72, 0x79, -+0x20, 0x3D, 0x20, 0x25, 0x64, 0x2C, 0x20, 0x50, -+0x61, 0x74, 0x68, 0x41, 0x5F, 0x47, 0x53, 0x32, -+0x5F, 0x72, 0x65, 0x74, 0x72, 0x79, 0x20, 0x3D, -+0x20, 0x25, 0x64, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x46, 0x57, 0x49, 0x51, 0x4B, 0x20, 0x73, 0x74, -+0x61, 0x72, 0x74, 0x20, 0x76, 0x31, 0x38, 0x21, -+0x21, 0x21, 0x00, 0x00, 0x30, 0x31, 0x32, 0x33, -+0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x41, 0x42, -+0x43, 0x44, 0x45, 0x46, 0x00, 0x00, 0x00, 0x00, -+0x53, 0x65, 0x74, 0x5F, 0x43, 0x61, 0x6E, 0x64, -+0x69, 0x5F, 0x33, 0x3A, 0x20, 0x5B, 0x31, 0x5D, -+0x3D, 0x30, 0x78, 0x25, 0x62, 0x58, 0x2C, 0x20, -+0x20, 0x5B, 0x32, 0x5D, 0x3D, 0x30, 0x78, 0x25, -+0x62, 0x58, 0x2C, 0x20, 0x20, 0x5B, 0x33, 0x5D, -+0x3D, 0x30, 0x78, 0x25, 0x62, 0x58, 0x00, 0x00, -+0x53, 0x65, 0x74, 0x5F, 0x43, 0x61, 0x6E, 0x64, -+0x69, 0x5F, 0x32, 0x3A, 0x20, 0x5B, 0x31, 0x5D, -+0x3D, 0x30, 0x78, 0x25, 0x62, 0x58, 0x2C, 0x20, -+0x20, 0x5B, 0x32, 0x5D, 0x3D, 0x30, 0x78, 0x25, -+0x62, 0x58, 0x20, 0x00, 0x50, 0x45, 0x52, 0x20, -+0x52, 0x50, 0x54, 0x3A, 0x20, 0x6D, 0x69, 0x64, -+0x25, 0x62, 0x58, 0x2C, 0x52, 0x3A, 0x25, 0x62, -+0x78, 0x2C, 0x72, 0x74, 0x3A, 0x25, 0x62, 0x78, -+0x2C, 0x62, 0x77, 0x3A, 0x25, 0x62, 0x78, 0x00, -+0x50, 0x45, 0x52, 0x20, 0x52, 0x50, 0x54, 0x3A, -+0x20, 0x6D, 0x69, 0x64, 0x25, 0x62, 0x58, 0x2C, -+0x54, 0x54, 0x3A, 0x25, 0x77, 0x78, 0x00, 0x00, -+0x50, 0x45, 0x52, 0x20, 0x52, 0x50, 0x54, 0x3A, -+0x20, 0x25, 0x62, 0x58, 0x2C, 0x25, 0x62, 0x78, -+0x2C, 0x25, 0x62, 0x78, 0x2C, 0x25, 0x62, 0x78, -+0x2C, 0x25, 0x62, 0x58, 0x2C, 0x25, 0x62, 0x78, -+0x2C, 0x25, 0x62, 0x78, 0x2C, 0x25, 0x62, 0x78, -+0x2C, 0x25, 0x62, 0x58, 0x2C, 0x25, 0x62, 0x78, -+0x2C, 0x25, 0x62, 0x78, 0x2C, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x52, 0x65, 0x71, 0x20, -+0x50, 0x45, 0x52, 0x20, 0x43, 0x4D, 0x44, 0x3A, -+0x20, 0x47, 0x72, 0x3A, 0x25, 0x62, 0x58, 0x2C, -+0x20, 0x54, 0x59, 0x50, 0x3A, 0x25, 0x62, 0x78, -+0x2C, 0x20, 0x62, 0x74, 0x6D, 0x70, 0x3A, 0x25, -+0x78, 0x00, 0x00, 0x00, 0x52, 0x65, 0x71, 0x20, -+0x50, 0x45, 0x52, 0x20, 0x43, 0x4D, 0x44, 0x3A, -+0x20, 0x49, 0x64, 0x78, 0x3A, 0x25, 0x62, 0x78, -+0x2C, 0x20, 0x6D, 0x69, 0x64, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x52, 0x65, 0x71, 0x20, -+0x50, 0x45, 0x52, 0x20, 0x43, 0x4D, 0x44, 0x3A, -+0x20, 0x49, 0x64, 0x78, 0x3A, 0x25, 0x62, 0x78, -+0x2C, 0x20, 0x4D, 0x69, 0x64, 0x3A, 0x25, 0x62, -+0x78, 0x2C, 0x20, 0x25, 0x62, 0x78, 0x2C, 0x20, -+0x25, 0x62, 0x78, 0x00, 0x53, 0x65, 0x74, 0x5F, -+0x52, 0x41, 0x5F, 0x55, 0x70, 0x5F, 0x72, 0x61, -+0x74, 0x69, 0x6F, 0x5F, 0x66, 0x6F, 0x72, 0x5F, -+0x52, 0x41, 0x5F, 0x64, 0x65, 0x62, 0x75, 0x67, -+0x00, 0x00, 0x00, 0x00, 0x53, 0x65, 0x74, 0x5F, -+0x44, 0x6F, 0x77, 0x6E, 0x5F, 0x72, 0x61, 0x74, -+0x69, 0x6F, 0x00, 0x00, 0x76, 0x61, 0x6C, 0x75, -+0x65, 0x38, 0x3D, 0x30, 0x78, 0x25, 0x62, 0x58, -+0x2C, 0x20, 0x76, 0x61, 0x6C, 0x75, 0x65, 0x31, -+0x36, 0x3D, 0x30, 0x78, 0x25, 0x77, 0x78, 0x2C, -+0x20, 0x76, 0x61, 0x6C, 0x75, 0x65, 0x33, 0x32, -+0x3D, 0x30, 0x78, 0x25, 0x78, 0x00, 0x00, 0x00, -+0x49, 0x44, 0x3D, 0x25, 0x62, 0x78, 0x2C, 0x44, -+0x69, 0x73, 0x52, 0x41, 0x3D, 0x25, 0x62, 0x78, -+0x2C, 0x44, 0x69, 0x73, 0x50, 0x54, 0x3D, 0x25, -+0x62, 0x78, 0x2C, 0x52, 0x74, 0x49, 0x44, 0x3D, -+0x25, 0x62, 0x78, 0x00, 0x42, 0x57, 0x3D, 0x25, -+0x62, 0x78, 0x2C, 0x42, 0x57, 0x4D, 0x3D, 0x25, -+0x62, 0x78, 0x2C, 0x4E, 0x6F, 0x55, 0x70, 0x42, -+0x77, 0x3D, 0x25, 0x62, 0x78, 0x2C, 0x53, 0x47, -+0x49, 0x3D, 0x25, 0x62, 0x78, 0x2C, 0x56, 0x48, -+0x54, 0x3D, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x50, 0x45, 0x52, 0x3A, 0x25, 0x62, 0x78, 0x20, -+0x43, 0x75, 0x72, 0x3A, 0x25, 0x62, 0x78, 0x20, -+0x4F, 0x3A, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x4D, 0x61, 0x70, 0x3A, 0x25, 0x62, 0x78, 0x20, -+0x44, 0x69, 0x66, 0x3A, 0x25, 0x62, 0x78, 0x20, -+0x6F, 0x66, 0x74, 0x3A, 0x25, 0x62, 0x78, 0x00, -+0x56, 0x61, 0x72, 0x3A, 0x20, 0x25, 0x62, 0x78, -+0x2D, 0x3E, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x44, 0x65, 0x63, 0x5F, 0x6F, 0x66, 0x73, 0x74, -+0x7B, 0x50, 0x2C, 0x4E, 0x7D, 0x3A, 0x20, 0x25, -+0x62, 0x78, 0x2C, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x4D, 0x74, 0x42, 0x77, 0x20, 0x55, 0x70, 0x44, -+0x77, 0x25, 0x62, 0x78, 0x20, 0x42, 0x57, 0x25, -+0x62, 0x78, 0x20, 0x52, 0x74, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x48, 0x69, 0x74, 0x25, -+0x62, 0x78, 0x20, 0x52, 0x74, 0x30, 0x3D, 0x25, -+0x77, 0x78, 0x20, 0x52, 0x74, 0x31, 0x3D, 0x25, -+0x77, 0x78, 0x00, 0x00, 0x72, 0x25, 0x62, 0x78, -+0x20, 0x4C, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x52, 0x53, 0x53, 0x49, 0x20, 0x52, 0x6C, 0x73, -+0x4C, 0x6D, 0x74, 0x00, 0x52, 0x53, 0x53, 0x49, -+0x20, 0x55, 0x70, 0x4C, 0x6D, 0x74, 0x00, 0x00, -+0x55, 0x70, 0x4C, 0x6D, 0x74, 0x3A, 0x25, 0x62, -+0x78, 0x20, 0x25, 0x62, 0x78, 0x20, 0x25, 0x62, -+0x78, 0x20, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x48, 0x52, 0x3A, 0x25, 0x62, 0x78, 0x2C, 0x4C, -+0x52, 0x3A, 0x25, 0x62, 0x78, 0x2C, 0x4D, 0x53, -+0x3A, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x46, 0x69, 0x78, 0x20, 0x69, 0x64, 0x3D, 0x25, -+0x62, 0x78, 0x20, 0x42, 0x77, 0x3D, 0x25, 0x62, -+0x78, 0x20, 0x52, 0x74, 0x3D, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x52, 0x61, 0x4F, 0x63, -+0x63, 0x4E, 0x75, 0x6D, 0x25, 0x62, 0x78, 0x00, -+0x52, 0x61, 0x44, 0x77, 0x54, 0x79, 0x20, 0x52, -+0x74, 0x3D, 0x25, 0x62, 0x78, 0x2C, 0x42, 0x77, -+0x25, 0x62, 0x78, 0x00, 0x55, 0x70, 0x52, 0x61, -+0x74, 0x65, 0x25, 0x62, 0x78, 0x20, 0x42, 0x57, -+0x25, 0x62, 0x78, 0x20, 0x4D, 0x61, 0x78, 0x42, -+0x57, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x30, 0x55, 0x70, 0x64, 0x74, 0x5F, 0x42, 0x57, -+0x3D, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x53, 0x47, 0x49, 0x5F, 0x52, 0x61, 0x74, 0x65, -+0x3D, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x33, 0x72, 0x61, 0x74, 0x65, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x34, 0x72, 0x61, 0x74, -+0x65, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x35, 0x72, 0x61, 0x74, 0x65, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x30, 0x52, 0x74, 0x25, -+0x62, 0x78, 0x20, 0x25, 0x62, 0x78, 0x20, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x31, 0x52, 0x74, 0x25, -+0x62, 0x78, 0x20, 0x25, 0x62, 0x78, 0x20, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x4E, 0x6F, 0x20, 0x55, -+0x70, 0x20, 0x52, 0x61, 0x74, 0x65, 0x00, 0x00, -+0x32, 0x52, 0x74, 0x3A, 0x25, 0x62, 0x78, 0x20, -+0x25, 0x62, 0x78, 0x20, 0x25, 0x62, 0x78, 0x2C, -+0x20, 0x54, 0x72, 0x79, 0x3D, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x44, 0x6E, 0x52, 0x61, -+0x74, 0x65, 0x25, 0x62, 0x78, 0x20, 0x42, 0x57, -+0x25, 0x62, 0x78, 0x20, 0x4D, 0x61, 0x78, 0x42, -+0x57, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x44, 0x5F, 0x52, 0x74, 0x25, 0x62, 0x78, 0x20, -+0x42, 0x77, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x50, 0x6B, 0x74, 0x20, 0x54, 0x72, 0x79, 0x69, -+0x6E, 0x67, 0x00, 0x00, 0x44, 0x72, 0x6F, 0x70, -+0x00, 0x00, 0x00, 0x00, 0x6F, 0x72, 0x69, 0x5F, -+0x50, 0x25, 0x62, 0x78, 0x2C, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x4B, 0x25, 0x62, 0x78, -+0x20, 0x54, 0x25, 0x62, 0x78, 0x20, 0x44, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x42, 0x77, 0x3D, 0x25, -+0x62, 0x78, 0x2C, 0x20, 0x42, 0x77, 0x32, 0x3D, -+0x25, 0x62, 0x78, 0x20, 0x52, 0x74, 0x3D, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x30, 0x55, 0x70, 0x25, -+0x62, 0x78, 0x2C, 0x44, 0x77, 0x6E, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x31, 0x55, 0x70, 0x25, -+0x62, 0x78, 0x2C, 0x44, 0x77, 0x6E, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x32, 0x55, 0x70, 0x25, -+0x62, 0x78, 0x2C, 0x44, 0x77, 0x6E, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x46, 0x77, 0x20, 0x46, -+0x69, 0x78, 0x20, 0x52, 0x61, 0x74, 0x65, 0x00, -+0x46, 0x6F, 0x72, 0x63, 0x65, 0x52, 0x61, 0x74, -+0x65, 0x44, 0x77, 0x00, 0x52, 0x74, 0x44, 0x77, -+0x6E, 0x43, 0x6E, 0x74, 0x3D, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x52, 0x61, 0x74, 0x65, -+0x44, 0x6F, 0x77, 0x6E, 0x00, 0x00, 0x00, 0x00, -+0x52, 0x74, 0x55, 0x70, 0x43, 0x6E, 0x74, 0x3D, -+0x25, 0x62, 0x78, 0x00, 0x52, 0x61, 0x74, 0x65, -+0x55, 0x50, 0x00, 0x00, 0x52, 0x61, 0x74, 0x65, -+0x53, 0x74, 0x61, 0x79, 0x00, 0x00, 0x00, 0x00, -+0x54, 0x72, 0x79, 0x53, 0x75, 0x63, 0x63, 0x65, -+0x73, 0x73, 0x00, 0x00, 0x54, 0x72, 0x79, 0x66, -+0x61, 0x69, 0x6C, 0x00, 0x4D, 0x74, 0x54, 0x72, -+0x79, 0x3D, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x42, 0x57, 0x25, 0x62, 0x78, 0x20, 0x52, 0x74, -+0x25, 0x62, 0x78, 0x00, 0x6F, 0x6B, 0x25, 0x62, -+0x78, 0x20, 0x74, 0x74, 0x25, 0x62, 0x78, 0x20, -+0x64, 0x70, 0x25, 0x62, 0x78, 0x20, 0x6F, 0x61, -+0x25, 0x62, 0x78, 0x00, 0x5B, 0x54, 0x52, 0x59, -+0x5D, 0x20, 0x50, 0x25, 0x62, 0x78, 0x2C, 0x25, -+0x62, 0x78, 0x20, 0x42, 0x77, 0x3D, 0x25, 0x62, -+0x78, 0x20, 0x52, 0x74, 0x3D, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x50, 0x72, 0x20, 0x25, -+0x62, 0x78, 0x20, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x52, 0x74, 0x20, 0x25, 0x62, 0x78, 0x20, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x54, 0x70, 0x25, 0x77, -+0x78, 0x20, 0x25, 0x77, 0x78, 0x00, 0x00, 0x00, -+0x55, 0x70, 0x46, 0x61, 0x69, 0x6C, 0x00, 0x00, -+0x54, 0x79, 0x53, 0x75, 0x63, 0x52, 0x74, 0x20, -+0x25, 0x62, 0x78, 0x00, 0x72, 0x61, 0x5F, 0x69, -+0x64, 0x78, 0x25, 0x62, 0x78, 0x2C, 0x63, 0x74, -+0x72, 0x6C, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x31, 0x52, 0x74, 0x3D, 0x25, 0x62, 0x78, 0x2D, -+0x3E, 0x25, 0x62, 0x78, 0x20, 0x52, 0x5B, 0x25, -+0x62, 0x78, 0x5D, 0x4F, 0x6B, 0x3A, 0x25, 0x62, -+0x78, 0x2B, 0x44, 0x70, 0x3A, 0x25, 0x62, 0x78, -+0x3D, 0x54, 0x3A, 0x25, 0x62, 0x78, 0x20, 0x54, -+0x61, 0x6C, 0x6C, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x43, 0x25, 0x62, 0x78, 0x20, 0x4E, 0x25, 0x62, -+0x78, 0x20, 0x50, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x43, 0x32, 0x48, 0x50, 0x6B, 0x74, 0x3A, 0x25, -+0x62, 0x78, 0x20, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x54, 0x62, 0x74, 0x74, 0x52, 0x41, 0x20, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x32, 0x52, 0x74, 0x3D, -+0x25, 0x62, 0x78, 0x2D, 0x3E, 0x25, 0x62, 0x78, -+0x20, 0x52, 0x5B, 0x25, 0x62, 0x78, 0x5D, 0x4F, -+0x6B, 0x3A, 0x25, 0x62, 0x78, 0x2B, 0x44, 0x70, -+0x3A, 0x25, 0x62, 0x78, 0x21, 0x54, 0x3A, 0x25, -+0x62, 0x78, 0x20, 0x54, 0x61, 0x6C, 0x6C, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x44, 0x69, 0x73, 0x52, -+0x61, 0x49, 0x44, 0x20, 0x25, 0x62, 0x78, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x75, 0x6E, -+0x73, 0x75, 0x70, 0x70, 0x6F, 0x72, 0x74, 0x65, -+0x64, 0x20, 0x70, 0x61, 0x74, 0x68, 0x20, 0x28, -+0x25, 0x64, 0x29, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x52, 0x46, -+0x2D, 0x25, 0x64, 0x20, 0x30, 0x78, 0x25, 0x78, -+0x20, 0x3D, 0x20, 0x30, 0x78, 0x25, 0x78, 0x2C, -+0x20, 0x62, 0x69, 0x74, 0x20, 0x6D, 0x61, 0x73, -+0x6B, 0x20, 0x3D, 0x20, 0x30, 0x78, 0x25, 0x78, -+0x0A, 0x00, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x57, 0x72, 0x69, 0x74, 0x65, 0x20, -+0x66, 0x61, 0x69, 0x6C, 0x2C, 0x20, 0x52, 0x46, -+0x20, 0x69, 0x73, 0x20, 0x64, 0x69, 0x73, 0x61, -+0x62, 0x6C, 0x65, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x52, 0x46, -+0x2D, 0x25, 0x64, 0x20, 0x30, 0x78, 0x25, 0x78, -+0x20, 0x3D, 0x20, 0x30, 0x78, 0x25, 0x78, 0x20, -+0x28, 0x6F, 0x72, 0x69, 0x67, 0x69, 0x6E, 0x61, -+0x6C, 0x3A, 0x20, 0x30, 0x78, 0x25, 0x78, 0x29, -+0x2C, 0x20, 0x62, 0x69, 0x74, 0x20, 0x6D, 0x61, -+0x73, 0x6B, 0x20, 0x3D, 0x20, 0x30, 0x78, 0x25, -+0x78, 0x0A, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3E, 0x0A, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x64, 0x69, -+0x73, 0x61, 0x62, 0x6C, 0x65, 0x20, 0x50, 0x48, -+0x59, 0x20, 0x41, 0x50, 0x49, 0x20, 0x66, 0x6F, -+0x72, 0x20, 0x64, 0x65, 0x62, 0x75, 0x67, 0x21, -+0x21, 0x0A, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x46, 0x61, 0x69, 0x6C, 0x20, 0x74, -+0x6F, 0x20, 0x73, 0x77, 0x69, 0x74, 0x63, 0x68, -+0x20, 0x62, 0x61, 0x6E, 0x64, 0x77, 0x69, 0x64, -+0x74, 0x68, 0x20, 0x28, 0x62, 0x77, 0x3A, 0x20, -+0x25, 0x64, 0x2C, 0x20, 0x70, 0x72, 0x69, 0x6D, -+0x61, 0x72, 0x79, 0x20, 0x63, 0x68, 0x3A, 0x20, -+0x25, 0x64, 0x29, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x62, 0x61, 0x6E, -+0x64, 0x77, 0x69, 0x64, 0x74, 0x68, 0x20, 0x28, -+0x62, 0x77, 0x3A, 0x20, 0x25, 0x64, 0x2C, 0x20, -+0x70, 0x72, 0x69, 0x6D, 0x61, 0x72, 0x79, 0x20, -+0x63, 0x68, 0x3A, 0x20, 0x25, 0x64, 0x29, 0x2C, -+0x20, 0x62, 0x65, 0x63, 0x61, 0x75, 0x73, 0x65, -+0x20, 0x77, 0x72, 0x69, 0x74, 0x69, 0x6E, 0x67, -+0x20, 0x52, 0x46, 0x20, 0x72, 0x65, 0x67, 0x69, -+0x73, 0x74, 0x65, 0x72, 0x20, 0x69, 0x73, 0x20, -+0x66, 0x61, 0x69, 0x6C, 0x0A, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x53, 0x75, -+0x63, 0x63, 0x65, 0x73, 0x73, 0x20, 0x74, 0x6F, -+0x20, 0x73, 0x77, 0x69, 0x74, 0x63, 0x68, 0x20, -+0x62, 0x61, 0x6E, 0x64, 0x77, 0x69, 0x64, 0x74, -+0x68, 0x20, 0x28, 0x62, 0x77, 0x3A, 0x20, 0x25, -+0x64, 0x2C, 0x20, 0x70, 0x72, 0x69, 0x6D, 0x61, -+0x72, 0x79, 0x20, 0x63, 0x68, 0x3A, 0x20, 0x25, -+0x64, 0x29, 0x0A, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3E, 0x0A, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x63, 0x68, 0x61, -+0x6E, 0x6E, 0x65, 0x6C, 0x20, 0x28, 0x52, 0x46, -+0x31, 0x38, 0x29, 0x20, 0x28, 0x63, 0x68, 0x3A, -+0x20, 0x25, 0x64, 0x29, 0x0A, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x63, 0x68, 0x61, -+0x6E, 0x6E, 0x65, 0x6C, 0x20, 0x28, 0x41, 0x47, -+0x43, 0x29, 0x20, 0x28, 0x63, 0x68, 0x3A, 0x20, -+0x25, 0x64, 0x29, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x63, 0x68, 0x61, -+0x6E, 0x6E, 0x65, 0x6C, 0x20, 0x28, 0x66, 0x63, -+0x5F, 0x61, 0x72, 0x65, 0x61, 0x29, 0x20, 0x28, -+0x63, 0x68, 0x3A, 0x20, 0x25, 0x64, 0x29, 0x0A, -+0x00, 0x00, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x46, 0x61, 0x69, 0x6C, 0x20, 0x74, -+0x6F, 0x20, 0x73, 0x77, 0x69, 0x74, 0x63, 0x68, -+0x20, 0x62, 0x61, 0x6E, 0x64, 0x20, 0x28, 0x63, -+0x68, 0x3A, 0x20, 0x25, 0x64, 0x29, 0x0A, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x63, 0x68, 0x61, -+0x6E, 0x6E, 0x65, 0x6C, 0x20, 0x28, 0x63, 0x68, -+0x3A, 0x20, 0x25, 0x64, 0x29, 0x2C, 0x20, 0x62, -+0x65, 0x63, 0x61, 0x75, 0x73, 0x65, 0x20, 0x77, -+0x72, 0x69, 0x74, 0x69, 0x6E, 0x67, 0x20, 0x52, -+0x46, 0x20, 0x72, 0x65, 0x67, 0x69, 0x73, 0x74, -+0x65, 0x72, 0x20, 0x69, 0x73, 0x20, 0x66, 0x61, -+0x69, 0x6C, 0x0A, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x53, 0x75, 0x63, 0x63, 0x65, 0x73, -+0x73, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, 0x69, -+0x74, 0x63, 0x68, 0x20, 0x63, 0x68, 0x61, 0x6E, -+0x6E, 0x65, 0x6C, 0x20, 0x28, 0x63, 0x68, 0x3A, -+0x20, 0x25, 0x64, 0x29, 0x0A, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3E, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x62, 0x61, 0x6E, -+0x64, 0x20, 0x28, 0x63, 0x68, 0x3A, 0x20, 0x25, -+0x64, 0x29, 0x2C, 0x20, 0x62, 0x65, 0x63, 0x61, -+0x75, 0x73, 0x65, 0x20, 0x77, 0x72, 0x69, 0x74, -+0x69, 0x6E, 0x67, 0x20, 0x52, 0x46, 0x20, 0x72, -+0x65, 0x67, 0x69, 0x73, 0x74, 0x65, 0x72, 0x20, -+0x69, 0x73, 0x20, 0x66, 0x61, 0x69, 0x6C, 0x0A, -+0x00, 0x00, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x53, 0x75, 0x63, 0x63, 0x65, 0x73, -+0x73, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, 0x69, -+0x74, 0x63, 0x68, 0x20, 0x62, 0x61, 0x6E, 0x64, -+0x20, 0x28, 0x63, 0x68, 0x3A, 0x20, 0x25, 0x64, -+0x29, 0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x4E, 0xE1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x10, 0xF0, 0x23, 0x6A, 0x40, 0xF2, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x00, 0xF4, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xA0, 0xF4, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x20, 0xF5, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x44, 0xF1, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x64, 0xF2, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x44, 0xF1, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF5, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF4, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF2, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x60, 0xF5, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA0, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA0, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF1, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x61, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF5, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF1, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF6, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x62, 0xF1, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA2, 0xF0, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF6, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF5, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x60, 0xF0, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x7F, 0xF6, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC2, 0xF5, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x5F, 0xF6, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF7, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x42, 0xF6, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF6, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x24, 0xF1, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xFF, 0xF7, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xBF, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF0, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE0, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF3, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF3, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF1, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x62, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC2, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x41, 0xF4, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF2, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF7, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x61, 0xF0, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF0, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF7, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF1, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x22, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x82, 0xF7, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA2, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x1F, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x63, 0xF0, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA3, 0xF0, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC3, 0xF0, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF3, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x83, 0xF3, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC3, 0xF3, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x03, 0xF4, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF4, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x63, 0xF4, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA3, 0xF6, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE3, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF7, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA4, 0xF0, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x04, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x64, 0xF1, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x84, 0xF3, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE4, 0xF3, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x04, 0xF4, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x44, 0xF4, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x5C, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x2F, 0xF7, 0x13, 0x4C, -+0x00, 0x6D, 0x07, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0x70, 0x6E, 0x28, 0xF5, 0x1C, 0x4C, 0x00, 0x6D, -+0x30, 0xF0, 0x20, 0x68, 0x40, 0xEA, 0xC0, 0xF1, -+0x08, 0x48, 0x02, 0x6A, 0x68, 0xF3, 0x56, 0xC0, -+0x10, 0x6A, 0x88, 0xF3, 0x44, 0xC0, 0x05, 0x6A, -+0x88, 0xF3, 0x4A, 0xC8, 0x88, 0xF3, 0x5B, 0xA0, -+0x00, 0x6C, 0x01, 0x69, 0x04, 0x4A, 0x88, 0xF3, -+0x56, 0xC0, 0xA4, 0x67, 0x10, 0x6A, 0x88, 0xF3, -+0x57, 0xC0, 0x88, 0xF3, 0x22, 0xC0, 0x88, 0xF3, -+0x23, 0xC0, 0x00, 0x18, 0x73, 0xC9, 0x02, 0x6C, -+0x0C, 0x6D, 0x00, 0x18, 0x73, 0xC9, 0x01, 0x6C, -+0x0C, 0x6D, 0x00, 0x18, 0x73, 0xC9, 0x30, 0xF0, -+0x20, 0x6C, 0x48, 0xF5, 0x10, 0x4C, 0x00, 0x6D, -+0x00, 0x18, 0x53, 0xE8, 0xE8, 0xF3, 0x66, 0xA0, -+0x0F, 0x6A, 0xE8, 0xF3, 0x45, 0xC0, 0x01, 0x6A, -+0x6C, 0xEA, 0x28, 0x6B, 0x6D, 0xEA, 0xE8, 0xF3, -+0x46, 0xC0, 0x07, 0x6A, 0xE8, 0xF3, 0x47, 0xC0, -+0x88, 0xF3, 0x5B, 0xA0, 0x00, 0x6C, 0xA4, 0x67, -+0x04, 0x4A, 0x88, 0xF3, 0x56, 0xC0, 0x10, 0x6A, -+0x88, 0xF3, 0x57, 0xC0, 0xE8, 0xF3, 0x24, 0xC0, -+0x00, 0x18, 0x93, 0xCF, 0x01, 0x6C, 0x00, 0x6D, -+0x00, 0x18, 0x93, 0xCF, 0x02, 0x6C, 0x00, 0x6D, -+0x00, 0x18, 0x93, 0xCF, 0x03, 0x6C, 0x00, 0x6D, -+0x00, 0x18, 0x93, 0xCF, 0x04, 0x6C, 0x00, 0x6D, -+0x00, 0x18, 0x93, 0xCF, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF1, 0x70, 0x9A, 0xF8, 0x6A, 0x00, 0x6D, -+0x80, 0xA3, 0xC5, 0x67, 0x8C, 0xEA, 0x40, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0xFF, 0x6C, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0x00, 0x6B, 0xC1, 0xF6, 0x62, 0xC2, 0xC1, 0xF6, -+0x63, 0xC2, 0xC1, 0xF6, 0x64, 0xC2, 0xC1, 0xF6, -+0x65, 0xC2, 0x20, 0xE8, 0x10, 0xF0, 0x23, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x64, 0xF2, 0x15, 0x4B, -+0x40, 0xF1, 0x68, 0xDA, 0x10, 0xF0, 0x23, 0x6B, -+0x40, 0xF1, 0x08, 0x4A, 0x40, 0xF5, 0x09, 0x4B, -+0x61, 0xDA, 0x10, 0xF0, 0x23, 0x6B, 0xC0, 0xF5, -+0x05, 0x4B, 0x62, 0xDA, 0x10, 0xF0, 0x23, 0x6B, -+0xA0, 0xF5, 0x15, 0x4B, 0x63, 0xDA, 0x10, 0xF0, -+0x23, 0x6B, 0xA0, 0xF5, 0x05, 0x4B, 0x64, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0x80, 0xF5, 0x15, 0x4B, -+0x65, 0xDA, 0x10, 0xF0, 0x23, 0x6B, 0x80, 0xF5, -+0x05, 0x4B, 0x66, 0xDA, 0x10, 0xF0, 0x23, 0x6B, -+0x60, 0xF5, 0x15, 0x4B, 0x67, 0xDA, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xA8, 0xF4, 0x17, 0x4A, -+0x67, 0x42, 0x09, 0x4B, 0x00, 0x6C, 0x80, 0xC2, -+0x01, 0x4A, 0x6A, 0xEA, 0xFB, 0x61, 0x42, 0xF4, -+0x10, 0x6A, 0x1F, 0xF7, 0x00, 0x6B, 0x4C, 0xEB, -+0x02, 0xF0, 0x00, 0x73, 0x01, 0x60, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF1, 0x60, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF1, -+0x64, 0x9B, 0x6D, 0xE2, 0x04, 0x4A, 0x00, 0x6C, -+0x62, 0xF4, 0x00, 0x72, 0x80, 0xDB, 0xE9, 0x61, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x2F, 0xF5, 0x18, 0x4C, -+0x00, 0x6D, 0x03, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF2, 0x5C, 0x9A, -+0x03, 0x6D, 0xFF, 0x6B, 0x80, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF2, 0x40, 0x9A, 0x00, 0xF5, -+0x82, 0x34, 0xAC, 0xEC, 0x40, 0x9A, 0x01, 0x74, -+0x42, 0x32, 0x52, 0x32, 0xAC, 0xEA, 0x06, 0x60, -+0x0A, 0x2C, 0x02, 0x5A, 0x28, 0x6C, 0x0D, 0x60, -+0x50, 0x6C, 0x0B, 0x10, 0x02, 0x5A, 0x14, 0x6C, -+0x08, 0x60, 0x28, 0x6C, 0x04, 0x10, 0x02, 0x5A, -+0x0A, 0x6C, 0x03, 0x60, 0x14, 0x6C, 0x84, 0xEA, -+0x6C, 0xEC, 0x80, 0x18, 0xAD, 0x06, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0x00, 0x6B, -+0x00, 0xF2, 0x62, 0xC2, 0x10, 0xF0, 0x24, 0x6B, -+0x55, 0xF1, 0x7C, 0x9B, 0x00, 0x6A, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF0, 0x70, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF2, -+0x7C, 0x9B, 0x40, 0xC3, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0x4E, 0xF2, 0x4C, 0x98, 0x30, 0xF0, 0x20, 0x69, -+0xC0, 0xF1, 0x08, 0x49, 0x91, 0x67, 0x00, 0x6D, -+0x4C, 0xF7, 0x14, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0x04, 0xD2, -+0x04, 0x94, 0x4E, 0xF2, 0x4C, 0x98, 0x00, 0x6D, -+0x20, 0xF6, 0x18, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0x05, 0xD2, -+0x05, 0x94, 0x4E, 0xF2, 0x4C, 0x98, 0x00, 0x6D, -+0xC1, 0xF7, 0x08, 0x6E, 0x40, 0xEA, 0x80, 0x18, -+0x76, 0x05, 0x05, 0x92, 0x00, 0x68, 0x80, 0xF0, -+0x0C, 0xD9, 0x40, 0xF0, 0x00, 0xC2, 0x80, 0x18, -+0x7D, 0x05, 0x01, 0x6A, 0xE9, 0xF0, 0x44, 0xC1, -+0x00, 0x18, 0x24, 0xDB, 0x04, 0x92, 0x30, 0xF0, -+0x20, 0x6C, 0xED, 0xF0, 0x16, 0x4C, 0x00, 0xF2, -+0x03, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xED, 0xF0, -+0x06, 0x4A, 0x00, 0x6B, 0x60, 0xC2, 0x70, 0xC2, -+0x01, 0x4A, 0x62, 0x67, 0x8E, 0xEB, 0xF9, 0x2B, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x28, 0xF1, 0x73, 0xC2, 0x2C, 0xF7, 0x7E, 0xC2, -+0x2C, 0xF7, 0x7F, 0xC2, 0x28, 0xF1, 0x72, 0xC2, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x80, 0x18, 0x94, 0x05, 0x80, 0x18, -+0x26, 0x06, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x58, 0x9A, 0x01, 0x68, 0x0B, 0xE8, 0x40, 0xEA, -+0x80, 0x18, 0xBE, 0x10, 0x80, 0x18, 0x37, 0x05, -+0x80, 0x18, 0x2F, 0x05, 0x00, 0x18, 0x05, 0xC4, -+0x00, 0x18, 0xEF, 0xCA, 0x00, 0x18, 0x1E, 0xD5, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, 0x44, 0x9A, -+0x40, 0xEA, 0x80, 0x18, 0xBE, 0x06, 0x00, 0x18, -+0x43, 0xE3, 0x00, 0x6A, 0x10, 0xF0, 0x24, 0x6C, -+0xF0, 0x67, 0x91, 0xF3, 0x1D, 0x4C, 0xA2, 0x67, -+0x64, 0x6E, 0x04, 0xD2, 0x00, 0x18, 0xAB, 0xE3, -+0xD0, 0x67, 0x00, 0x6C, 0x42, 0x6D, 0x00, 0x18, -+0x50, 0xE1, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF1, -+0xE4, 0x9B, 0xD0, 0x67, 0x00, 0x6C, 0x4D, 0xEF, -+0x42, 0x6D, 0x00, 0x18, 0x63, 0xE1, 0x10, 0xF0, -+0x24, 0x6C, 0xF0, 0x67, 0x94, 0xF3, 0x01, 0x4C, -+0x00, 0x6D, 0x64, 0x6E, 0x01, 0x6A, 0x04, 0xD2, -+0x00, 0x18, 0xAB, 0xE3, 0x00, 0x18, 0x67, 0xE3, -+0x07, 0x97, 0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0x6B, 0x2F, 0xF5, -+0x18, 0x4A, 0xA0, 0xF0, 0x64, 0xC2, 0xA0, 0xF0, -+0x65, 0xC2, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0x40, 0xF0, 0x60, 0xC2, 0x40, 0xF0, -+0x61, 0xC2, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF5, 0x48, 0x9A, 0x01, 0x6B, 0x60, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF5, 0x8C, 0x9A, 0xFF, 0x6B, 0x20, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF5, -+0x90, 0x9A, 0x08, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF5, 0x74, 0x9A, -+0xFD, 0x6A, 0xFF, 0x6C, 0xA0, 0xA3, 0xAC, 0xEA, -+0x40, 0xC3, 0x40, 0xA3, 0x01, 0x6D, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF3, 0x18, 0x9A, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, 0x90, 0x67, -+0x00, 0x6D, 0x02, 0xF0, 0x00, 0x6E, 0x40, 0xEA, -+0x04, 0x6A, 0x40, 0xC0, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF5, 0x58, 0x9A, 0x20, 0x48, 0x0E, 0xEA, -+0xF7, 0x2A, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0x15, 0xF4, 0x80, 0x9B, 0x4E, 0xF2, -+0x4C, 0x9A, 0x00, 0x6D, 0x00, 0xF4, 0x00, 0x6E, -+0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF6, 0xA8, 0x9A, 0x1F, 0xF4, 0x0E, 0x6E, -+0x30, 0xF0, 0x20, 0x6B, 0xCB, 0xEE, 0xC0, 0xF1, -+0xC8, 0xDB, 0xE1, 0xF7, 0x1F, 0x6A, 0xC0, 0xF1, -+0x08, 0x4B, 0x00, 0x6C, 0x42, 0xDB, 0x43, 0xDB, -+0xA1, 0xDB, 0x84, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF5, 0x70, 0x9B, 0xC0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF5, 0x78, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF5, 0x60, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF5, -+0x68, 0x9B, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF5, 0x50, 0x9A, 0x80, 0xDA, 0x20, 0xE8, -+0x80, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x58, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF5, -+0x60, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF6, 0x8C, 0x9B, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xE6, 0x6D, 0xFF, 0x6B, 0xAE, 0xDA, 0x8F, 0xDA, -+0x70, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF5, -+0x54, 0x9A, 0xA0, 0xDA, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF5, 0x5C, 0x9A, 0x80, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF6, 0x44, 0x9A, 0x60, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0x4D, 0x07, -+0x30, 0xF0, 0x20, 0x6B, 0xE8, 0xF2, 0x5C, 0xC3, -+0x80, 0x18, 0x3E, 0x06, 0x00, 0x18, 0xAB, 0xE6, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF6, 0x58, 0x9A, -+0x3F, 0x6B, 0x60, 0xC2, 0x80, 0x18, 0x2F, 0x06, -+0x80, 0x18, 0x33, 0x06, 0x80, 0x18, 0xB3, 0x06, -+0x80, 0x18, 0x46, 0x06, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0x00, 0x6A, -+0xC0, 0xF1, 0x08, 0x48, 0x01, 0x6C, 0x02, 0x6D, -+0x00, 0x6E, 0x40, 0xF0, 0x50, 0xC8, 0x00, 0x18, -+0xFA, 0xD0, 0x40, 0xF0, 0xD0, 0xA8, 0x01, 0x6C, -+0x03, 0x6D, 0xC2, 0x36, 0x00, 0x18, 0xFA, 0xD0, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x10, 0xDD, -+0x00, 0x18, 0x2F, 0xDD, 0x80, 0x18, 0x5B, 0x06, -+0x80, 0x18, 0x78, 0x06, 0x80, 0x18, 0x72, 0x06, -+0x80, 0x18, 0x97, 0x06, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x5D, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x54, 0x9A, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x81, 0xF4, 0x10, 0x6B, -+0x28, 0xF1, 0x78, 0xDA, 0x00, 0xF2, 0x00, 0x4B, -+0x28, 0xF1, 0x7C, 0xDA, 0x01, 0xF2, 0x00, 0x4B, -+0x48, 0xF1, 0x60, 0xDA, 0x00, 0xF2, 0x00, 0x4B, -+0x48, 0xF1, 0x64, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF6, 0x4C, 0x9A, 0xE0, 0xF1, 0x1B, 0x6B, -+0x6B, 0xEB, 0x60, 0xCA, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF2, 0x68, 0x9A, 0xFB, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x23, 0x6A, 0xA9, 0xF2, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xC9, 0xF2, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF3, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x54, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0xE3, 0xF2, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x58, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xF3, 0xF1, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, 0x50, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x8E, 0xF4, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, 0x54, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x53, 0xF1, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xF1, 0xF1, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, 0x58, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x91, 0xF2, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x6B, 0xF3, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xA8, 0xF4, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x48, 0xF4, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x44, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xB0, 0xF3, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xAD, 0xF7, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xED, 0xF7, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x50, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x12, 0xF7, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x54, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x23, 0xF6, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x48, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xF3, 0xF7, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF5, 0x4C, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x53, 0xF7, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF5, 0x44, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x53, 0xF5, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x50, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xD3, 0xF5, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x0A, 0xF7, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x2B, 0xF1, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x50, 0xF6, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF2, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x24, 0xF0, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF2, 0x44, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xA6, 0xF1, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x48, 0xF1, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xC8, 0xF1, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x54, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x50, 0xF4, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x49, 0xF2, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x69, 0xF2, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x49, 0xF2, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x4F, 0xF1, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF7, 0x50, 0x9A, 0x60, 0x9A, 0x03, 0x6A, -+0x62, 0x33, 0x72, 0x33, 0x4C, 0xEB, 0x02, 0x6A, -+0x04, 0x23, 0x01, 0x73, 0x01, 0x6A, 0x01, 0x60, -+0x03, 0x6A, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0xE8, 0xF2, 0x5C, 0xA2, 0xFF, 0x68, 0x24, 0x67, -+0x02, 0x72, 0x0C, 0xE9, 0x03, 0x61, 0x01, 0x71, -+0x10, 0x61, 0x1D, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF2, 0x44, 0x9A, 0x01, 0x6B, 0x6B, 0xEB, -+0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x64, 0x6C, 0x40, 0xEA, 0x00, 0x18, -+0xAE, 0xE8, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF2, -+0x60, 0x9A, 0x80, 0x6C, 0x8B, 0xEC, 0x40, 0xA3, -+0x0C, 0xEA, 0x8E, 0xEA, 0x0C, 0xEA, 0x40, 0xC3, -+0x91, 0x67, 0x00, 0x18, 0x92, 0xDB, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x05, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x10, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x15, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x15, 0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0xFF, 0xFF, 0xFF, 0x03, 0x00, 0x00, -+0x15, 0xF0, 0xFF, 0xFF, 0x0F, 0x00, 0x00, 0x00, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF6, 0x78, 0x9B, -+0xFF, 0x6A, 0x8C, 0xEA, 0x60, 0x9B, 0x80, 0xF1, -+0x01, 0x6C, 0x8B, 0xEC, 0x8C, 0xEB, 0x10, 0xF0, -+0x24, 0x6C, 0xD5, 0xF2, 0x9C, 0x9C, 0x01, 0x72, -+0x80, 0x9C, 0x05, 0x60, 0x02, 0x72, 0x05, 0x61, -+0xFF, 0x6A, 0x01, 0x4A, 0x01, 0x10, 0x80, 0x6A, -+0x4D, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF6, -+0x58, 0x9A, 0x60, 0xDA, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF6, 0x5C, 0x9A, 0x10, 0xF0, 0x24, 0x6B, -+0xD5, 0xF2, 0x7C, 0x9B, 0x8C, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF7, 0x60, 0x9B, -+0x50, 0x6A, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF7, 0x64, 0x9B, 0x40, 0xC3, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF7, 0x50, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x15, 0xF7, 0x98, 0x9C, -+0x60, 0xAA, 0xEF, 0xF7, 0x1F, 0x6A, 0x6C, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF5, 0x58, 0xCB, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF7, 0x74, 0x9A, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x20, 0xE8, -+0xFF, 0x6A, 0x4C, 0xEC, 0x03, 0x6B, 0x8C, 0xEB, -+0x4C, 0xEE, 0x3C, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF7, 0x6C, 0x9B, 0x80, 0xC3, 0x0F, 0x6B, -+0xCC, 0xEB, 0x34, 0x23, 0x01, 0x6C, 0x6C, 0xEC, -+0x06, 0x24, 0x10, 0xF0, 0x24, 0x6C, 0x35, 0xF7, -+0x90, 0x9C, 0xAC, 0xEA, 0x40, 0xC4, 0x02, 0x6A, -+0x6C, 0xEA, 0x08, 0x22, 0xFF, 0x6C, 0xA2, 0x32, -+0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6C, 0x35, 0xF7, -+0x94, 0x9C, 0x40, 0xC4, 0x04, 0x6A, 0x6C, 0xEA, -+0x09, 0x22, 0xA2, 0x32, 0xFF, 0x6C, 0x42, 0x32, -+0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6C, 0x35, 0xF7, -+0x98, 0x9C, 0x40, 0xC4, 0x6E, 0x32, 0x07, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF7, 0x5C, 0x9A, -+0x00, 0xF6, 0xA2, 0x35, 0xA0, 0xC2, 0x20, 0x6A, -+0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x55, 0xF7, -+0x60, 0x9B, 0x40, 0xC3, 0x00, 0x6A, 0x40, 0xC3, -+0x01, 0x6A, 0x20, 0xE8, 0x00, 0x6A, 0x20, 0xE8, -+0xFF, 0x6A, 0x8C, 0xEA, 0x03, 0x6B, 0x4C, 0xEB, -+0x03, 0x23, 0x01, 0x6A, 0x4B, 0xEA, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6C, 0x35, 0xF7, 0x8C, 0x9C, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF7, -+0x80, 0x9A, 0x30, 0x6A, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF7, 0x50, 0x9A, 0x40, 0x9A, -+0x60, 0xC4, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF7, 0xA4, 0x9A, -+0xE0, 0xF3, 0x10, 0x6C, 0x0F, 0x6E, 0x80, 0x18, -+0xB2, 0x07, 0xE0, 0xF3, 0x0C, 0x6C, 0x80, 0x18, -+0xD4, 0x07, 0xFF, 0x6B, 0x4C, 0xEB, 0x0B, 0x73, -+0x0B, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF7, -+0x68, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x55, 0xF7, -+0x8C, 0x9C, 0x40, 0x9B, 0x8C, 0xEA, 0x40, 0xDB, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x05, 0x6B, 0x65, 0xF4, 0x64, 0xDA, 0x00, 0x6B, -+0x65, 0xF4, 0x60, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0xE5, 0x63, 0x35, 0x62, 0x34, 0xD1, 0x33, 0xD0, -+0x10, 0xF0, 0x24, 0x6D, 0x07, 0x04, 0x34, 0xF6, -+0x10, 0x4D, 0x54, 0x6E, 0x00, 0x18, 0x50, 0xD2, -+0x10, 0xF0, 0x24, 0x6D, 0x1C, 0x04, 0xD4, 0xF5, -+0x1C, 0x4D, 0x54, 0x6E, 0x00, 0x18, 0x50, 0xD2, -+0x10, 0xF0, 0x24, 0x6A, 0xD4, 0xF5, 0x70, 0x9A, -+0xD4, 0xF5, 0x10, 0x4A, 0x00, 0x69, 0x04, 0xD3, -+0x61, 0x9A, 0x44, 0xAA, 0x05, 0xD3, 0x7D, 0x67, -+0x4C, 0xCB, 0x52, 0x68, 0x18, 0xE9, 0x30, 0xF0, -+0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, 0x61, 0x6F, -+0xEB, 0xEF, 0x00, 0x6C, 0x01, 0x49, 0x12, 0xE8, -+0x01, 0xE2, 0x3F, 0x6A, 0x20, 0xF0, 0x65, 0xA0, -+0xFA, 0x65, 0x40, 0xC0, 0x09, 0x6A, 0x44, 0xC0, -+0x0D, 0x6A, 0x4B, 0xEA, 0x20, 0xF0, 0xA6, 0xA0, -+0x6C, 0xEA, 0x04, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, -+0x04, 0x6B, 0xAD, 0xEB, 0x31, 0x6D, 0xAB, 0xED, -+0xAC, 0xEA, 0x40, 0x6D, 0xAD, 0xEA, 0x80, 0x4D, -+0x20, 0xF0, 0xC7, 0xA0, 0xC0, 0x4D, 0xAD, 0xEA, -+0x20, 0xF0, 0xB5, 0xA0, 0x20, 0xF0, 0x45, 0xC0, -+0x03, 0x6A, 0x1E, 0x65, 0x4B, 0xEA, 0xD8, 0x67, -+0xAC, 0xEA, 0x41, 0x6D, 0xAB, 0xED, 0xCC, 0xEF, -+0x20, 0xF0, 0xE7, 0xC0, 0xAC, 0xEB, 0x20, 0xF0, -+0xE0, 0xA0, 0x20, 0xF0, 0x66, 0xC0, 0x08, 0x6B, -+0x6B, 0xEB, 0xEC, 0xEB, 0x20, 0xF0, 0x60, 0xC0, -+0x01, 0x6B, 0x6B, 0xEB, 0x68, 0xC0, 0x21, 0x6B, -+0xAC, 0xEA, 0x6B, 0xEB, 0x6C, 0xEA, 0x20, 0xF0, -+0x55, 0xC0, 0x40, 0xF0, 0x61, 0xA0, 0x5F, 0x67, -+0x47, 0xC0, 0x40, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x00, 0x6F, 0xAC, 0xEA, 0x81, 0xC0, 0x83, 0xC0, -+0x20, 0xF0, 0x94, 0xC0, 0x20, 0xF0, 0x81, 0xC0, -+0xF6, 0xC8, 0xE9, 0xC0, 0x40, 0xF0, 0x82, 0xC0, -+0x40, 0xF0, 0x41, 0xC0, 0x30, 0xF0, 0x20, 0x6E, -+0x4E, 0xF2, 0x4C, 0x9E, 0x87, 0x40, 0x3E, 0x4C, -+0xFF, 0x6D, 0x02, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6F, 0x4E, 0xF2, 0x4C, 0x9F, 0x87, 0x40, -+0xFF, 0x68, 0x40, 0x4C, 0x00, 0x6D, 0x02, 0x6E, -+0x0C, 0xE9, 0x40, 0xEA, 0x80, 0x71, 0x8D, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0x6B, 0xC0, 0xF1, -+0x08, 0x4A, 0xE5, 0xF2, 0x76, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF5, 0x48, 0x9A, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF5, 0x54, 0x9A, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF4, -+0x48, 0x9A, 0x32, 0x6B, 0x30, 0xF0, 0x20, 0x6C, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF4, -+0x4C, 0x9A, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF4, -+0x70, 0x9B, 0x40, 0xA2, 0x05, 0xF4, 0x10, 0x4C, -+0x1C, 0x05, 0x0C, 0xEA, 0xFF, 0x4A, 0x0C, 0xEA, -+0x40, 0xC3, 0x30, 0xF0, 0x20, 0x68, 0x4E, 0xF2, -+0x50, 0x98, 0x54, 0x6E, 0x40, 0xEA, 0x4E, 0xF2, -+0x50, 0x98, 0x30, 0xF0, 0x20, 0x6C, 0x65, 0xF4, -+0x04, 0x4C, 0x07, 0x05, 0x54, 0x6E, 0x40, 0xEA, -+0x4E, 0xF2, 0x50, 0x98, 0x30, 0xF0, 0x20, 0x6C, -+0x05, 0xF6, 0x1A, 0x4C, 0x04, 0x05, 0x0A, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xC5, 0xF4, 0x0A, 0x4A, 0x65, 0xF5, -+0x12, 0x4B, 0x0A, 0x6C, 0x80, 0xCA, 0x00, 0x6C, -+0xA0, 0xF0, 0x88, 0xCA, 0x02, 0x4A, 0x6A, 0xEA, -+0xF8, 0x61, 0x35, 0x97, 0x34, 0x91, 0x33, 0x90, -+0x1B, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, -+0x06, 0xD4, 0x09, 0xD7, 0x07, 0xD5, 0x08, 0xD6, -+0x06, 0x04, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x46, 0x67, 0x01, 0x4A, -+0x05, 0x67, 0x0C, 0xD6, 0x27, 0x67, 0x1F, 0x22, -+0x1F, 0xF7, 0x00, 0x6A, 0xAC, 0xEA, 0x02, 0xF0, -+0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x40, 0x9A, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF1, 0x44, 0x9A, -+0x49, 0xE0, 0x40, 0x9A, 0x0C, 0x94, 0x04, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, 0x50, 0x9A, -+0x40, 0xEA, 0x0C, 0x93, 0x24, 0xEA, 0x6F, 0xEA, -+0x04, 0x93, 0x6C, 0xEA, 0x4D, 0xE9, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x40, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x44, 0x9A, 0x41, 0xE0, -+0x20, 0xD8, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x1F, 0xF7, 0x00, 0x6A, -+0xAC, 0xEA, 0x02, 0xF0, 0x00, 0x72, 0x26, 0x67, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x40, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x44, 0x9A, 0x55, 0xE5, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0x9D, 0xAE, 0xF4, -+0x50, 0x9A, 0x91, 0x67, 0x2C, 0xE8, 0x40, 0xEA, -+0x06, 0xEA, 0x50, 0x67, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0xEE, 0xF3, 0x54, 0x98, 0x00, 0x6C, -+0xA4, 0x67, 0xE4, 0x67, 0x01, 0x6E, 0x40, 0xEA, -+0xEE, 0xF3, 0x54, 0x98, 0x01, 0x6D, 0xE5, 0x67, -+0x00, 0x6C, 0xC5, 0x67, 0x40, 0xEA, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, 0x20, 0x68, -+0xF5, 0xF2, 0x18, 0x4B, 0xCE, 0xF4, 0x50, 0x98, -+0xC0, 0x9B, 0x03, 0xF3, 0x00, 0x69, 0x01, 0x6D, -+0x91, 0x67, 0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, 0xF5, 0xF2, -+0xDC, 0x9B, 0x01, 0x6D, 0x91, 0x67, 0xAB, 0xED, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x15, 0xF3, 0xC0, 0x9B, 0x01, 0x6D, -+0x91, 0x67, 0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF2, 0x18, 0x4B, 0xCE, 0xF4, -+0x50, 0x98, 0xC0, 0x9B, 0x01, 0x6D, 0x91, 0x67, -+0xAB, 0xED, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x00, 0x6A, 0x0B, 0xD7, 0xE0, 0xAE, 0x1F, 0xF7, -+0x00, 0x6B, 0xEC, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x09, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xE0, 0xAE, 0x15, 0xF1, 0x60, 0x9B, 0x6D, 0xE7, -+0xE0, 0xA4, 0xE0, 0xC3, 0x07, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x15, 0xF1, 0x64, 0x9B, 0x7D, 0xE7, -+0x60, 0xA4, 0x60, 0xC7, 0x01, 0x4A, 0xFF, 0x6B, -+0x6C, 0xEA, 0x04, 0x72, 0x02, 0x4E, 0x01, 0x4C, -+0xE1, 0x61, 0x25, 0x67, 0x00, 0x68, 0x0B, 0x92, -+0xC0, 0x99, 0x01, 0x6D, 0x0D, 0xE2, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x80, 0xAB, -+0xAB, 0xED, 0x02, 0x48, 0x40, 0xEA, 0x16, 0x70, -+0x04, 0x49, 0xF1, 0x61, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, 0x5C, 0x9A, -+0x7F, 0x6B, 0xFF, 0x6C, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF1, 0x4C, 0x9A, 0x14, 0x6B, -+0x01, 0x6D, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x50, 0x9A, 0x10, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF3, 0x6C, 0x9A, 0x01, 0x6E, 0x81, 0xF4, -+0x14, 0x69, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0x8C, 0xEA, 0x40, 0xC3, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0xF0, 0x0D, 0x4C, 0xEF, 0xF7, 0x1F, 0x4D, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0x91, 0x67, 0xC5, 0x67, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x91, 0x67, 0x01, 0xF4, 0x00, 0x6D, -+0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x01, 0xF4, 0x00, 0x6C, 0xAB, 0xED, -+0x04, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xFF, 0x6D, 0x01, 0xF3, 0x00, 0x6C, 0x01, 0x4D, -+0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF1, 0xAC, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0xF0, 0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0x21, 0xF0, 0x18, 0x6C, -+0x0E, 0x6D, 0x07, 0x6E, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x1E, 0x22, 0x30, 0xF0, -+0x20, 0x68, 0x10, 0xF0, 0x24, 0x6B, 0x15, 0xF3, -+0xD0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x69, -+0x2B, 0xE9, 0xA1, 0xF4, 0x10, 0x6C, 0xB1, 0x67, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0xA1, 0xF4, -+0x14, 0x6C, 0xB1, 0x67, 0x6E, 0xF7, 0x17, 0x6E, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0xA1, 0xF4, -+0x1C, 0x6C, 0xB1, 0x67, 0x21, 0xF0, 0x1B, 0x6E, -+0x1D, 0x10, 0x30, 0xF0, 0x20, 0x68, 0x10, 0xF0, -+0x24, 0x6B, 0x15, 0xF3, 0xD4, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x69, 0x2B, 0xE9, 0xA1, 0xF4, -+0x10, 0x6C, 0xB1, 0x67, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0xA1, 0xF4, 0x14, 0x6C, 0xB1, 0x67, -+0x62, 0xF1, 0x17, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0xA1, 0xF4, 0x1C, 0x6C, 0xB1, 0x67, -+0x00, 0xF4, 0x04, 0x6E, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFF, 0x63, 0x01, 0xD0, 0xFF, 0x6B, 0x3F, 0x68, -+0x6C, 0xED, 0xB7, 0xE0, 0x6C, 0xED, 0x00, 0x68, -+0x06, 0x92, 0x00, 0xC7, 0x05, 0x67, 0x6C, 0xED, -+0x6C, 0xEC, 0x00, 0xF6, 0xC0, 0x36, 0x10, 0x5D, -+0x00, 0xF6, 0xC3, 0x36, 0x80, 0xC2, 0x01, 0x61, -+0x0F, 0x68, 0xFF, 0x6B, 0x00, 0x56, 0x0C, 0xEB, -+0x04, 0x61, 0xC2, 0xEB, 0x02, 0x61, 0xC0, 0xC7, -+0x15, 0x10, 0xC2, 0xEB, 0x0D, 0x60, 0xA7, 0x44, -+0xD1, 0xE4, 0x60, 0xC7, 0x6F, 0xE4, 0x60, 0xC2, -+0x60, 0xA2, 0x03, 0x4D, 0xFF, 0x68, 0x0C, 0xED, -+0x63, 0xED, 0x0B, 0x60, 0xA0, 0xC2, 0x09, 0x10, -+0xCB, 0xED, 0x00, 0x6B, 0x82, 0xED, 0x60, 0xC7, -+0x03, 0x60, 0xD1, 0xE4, 0x80, 0xC2, 0x01, 0x10, -+0x60, 0xC2, 0x01, 0x90, 0x01, 0x6A, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0xF8, 0x63, 0x0F, 0x62, -+0x0E, 0xD1, 0x0D, 0xD0, 0x00, 0x6A, 0x07, 0xD2, -+0x08, 0xD2, 0x09, 0xD2, 0x0A, 0xD2, 0x0B, 0xD2, -+0xA2, 0x9C, 0x3D, 0x67, 0x1C, 0xA1, 0x01, 0x6E, -+0xE5, 0x67, 0xFE, 0x4A, 0xCC, 0xEF, 0x0C, 0xEA, -+0xED, 0xEA, 0x03, 0x68, 0xA6, 0x37, 0x0B, 0xE8, -+0xCC, 0xEF, 0xE4, 0x37, 0x0C, 0xEA, 0xED, 0xEA, -+0xAA, 0x37, 0xFE, 0x48, 0xCC, 0xEF, 0xE8, 0x37, -+0x0C, 0xEA, 0xED, 0xEA, 0xAE, 0x37, 0xFC, 0x48, -+0xCC, 0xEF, 0xEC, 0x37, 0x0C, 0xEA, 0xED, 0xEA, -+0x07, 0x68, 0xB2, 0x37, 0x71, 0x69, 0x2B, 0xE9, -+0x0C, 0xEF, 0xF0, 0x37, 0x2C, 0xEA, 0x07, 0x03, -+0xED, 0xEA, 0xA2, 0x35, 0xFD, 0x67, 0x5C, 0xC7, -+0xA1, 0xC3, 0x23, 0x9C, 0xCC, 0xEA, 0x24, 0xC3, -+0xE4, 0x9C, 0x22, 0x31, 0xE8, 0xC3, 0xA5, 0x9C, -+0xE2, 0x37, 0xAC, 0xC3, 0x86, 0x9C, 0xA2, 0x35, -+0x25, 0xC3, 0x1C, 0x65, 0x90, 0xC3, 0x98, 0x67, -+0x82, 0x34, 0xE9, 0xC3, 0xAD, 0xC3, 0x91, 0xC3, -+0x22, 0x31, 0xE2, 0x37, 0xA2, 0x35, 0x82, 0x34, -+0x26, 0xC3, 0xEA, 0xC3, 0xAE, 0xC3, 0x92, 0xC3, -+0xA0, 0xF0, 0x11, 0x22, 0xBD, 0x67, 0x5C, 0xA5, -+0xFF, 0x6B, 0x52, 0x32, 0x0C, 0xEA, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x72, 0x42, 0x60, 0xA7, 0x10, -+0x10, 0xF0, 0x24, 0x6E, 0x30, 0xF0, 0x20, 0x68, -+0x15, 0xF3, 0x18, 0x4E, 0xCE, 0xF4, 0x50, 0x98, -+0xA0, 0x9E, 0x81, 0xF4, 0x14, 0x6C, 0x00, 0x6E, -+0x40, 0xEA, 0xFD, 0x67, 0x7D, 0xA7, 0x30, 0xF0, -+0x20, 0x69, 0x6F, 0xF0, 0x14, 0x49, 0x64, 0x33, -+0x10, 0xF0, 0x24, 0x6E, 0x2D, 0xE3, 0x15, 0xF3, -+0x1C, 0x4E, 0xCE, 0xF4, 0x50, 0x98, 0xA0, 0x9E, -+0xC0, 0xAB, 0x01, 0xF4, 0x1C, 0x6C, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6F, 0x15, 0xF3, 0x18, 0x4F, -+0xA0, 0x9F, 0xCE, 0xF4, 0x50, 0x98, 0x81, 0xF6, -+0x14, 0x6C, 0x00, 0x6E, 0x40, 0xEA, 0x7D, 0x67, -+0x5D, 0xA3, 0x10, 0xF0, 0x24, 0x6E, 0x15, 0xF3, -+0x1C, 0x4E, 0x44, 0x32, 0x25, 0xE2, 0xA0, 0x9E, -+0xCE, 0xF4, 0x50, 0x98, 0xC0, 0xA9, 0x01, 0xF6, -+0x1C, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6C, -+0x75, 0xF7, 0x18, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x66, 0x10, 0xFD, 0x67, 0x9D, 0xA7, 0x20, 0xF0, -+0xA0, 0xA7, 0x20, 0xF0, 0xC1, 0x87, 0x00, 0xF0, -+0x19, 0x01, 0x06, 0x07, 0x04, 0xD1, 0x80, 0x18, -+0x42, 0x09, 0x5D, 0x67, 0xB8, 0xA2, 0xD9, 0xA2, -+0x10, 0xF0, 0x24, 0x6C, 0x95, 0xF7, 0x04, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x10, 0xF0, 0x24, 0x6B, -+0x30, 0xF0, 0x20, 0x68, 0xFD, 0x67, 0x15, 0xF3, -+0x18, 0x4B, 0xD8, 0xA7, 0xA0, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x81, 0xF4, 0x14, 0x6C, 0x30, 0xF0, -+0x20, 0x69, 0x40, 0xEA, 0x5D, 0x67, 0x79, 0xA2, -+0x6F, 0xF0, 0x14, 0x49, 0x10, 0xF0, 0x24, 0x6E, -+0x64, 0x33, 0x2D, 0xE3, 0x15, 0xF3, 0x1C, 0x4E, -+0xA0, 0x9E, 0xCE, 0xF4, 0x50, 0x98, 0xC0, 0xAB, -+0x01, 0xF4, 0x1C, 0x6C, 0x40, 0xEA, 0xFD, 0x67, -+0x9D, 0xA7, 0x20, 0xF0, 0xA4, 0xA7, 0x20, 0xF0, -+0xC5, 0x87, 0x00, 0xF0, 0x19, 0x02, 0x06, 0x07, -+0x04, 0xD2, 0x80, 0x18, 0x42, 0x09, 0x7D, 0x67, -+0xB8, 0xA3, 0xD9, 0xA3, 0x10, 0xF0, 0x24, 0x6C, -+0xB5, 0xF7, 0x04, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x10, 0xF0, 0x24, 0x6E, 0x15, 0xF3, 0x18, 0x4E, -+0xFD, 0x67, 0xA0, 0x9E, 0xCE, 0xF4, 0x50, 0x98, -+0xD8, 0xA7, 0x81, 0xF6, 0x14, 0x6C, 0x40, 0xEA, -+0x7D, 0x67, 0x59, 0xA3, 0x10, 0xF0, 0x24, 0x6E, -+0x15, 0xF3, 0x1C, 0x4E, 0x44, 0x32, 0x25, 0xE2, -+0xA0, 0x9E, 0xCE, 0xF4, 0x50, 0x98, 0xC0, 0xA9, -+0x01, 0xF6, 0x1C, 0x6C, 0x40, 0xEA, 0x0F, 0x97, -+0x0E, 0x91, 0x0D, 0x90, 0x00, 0x6A, 0x08, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x28, 0xF1, 0x4C, 0xA0, -+0x69, 0x2A, 0x10, 0xF0, 0x24, 0x6C, 0xD5, 0xF7, -+0x04, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x01, 0x6A, -+0xA7, 0xF6, 0x46, 0xC0, 0x30, 0xF0, 0x21, 0x6A, -+0x50, 0xF3, 0x0E, 0x4A, 0x30, 0xF0, 0x20, 0x6F, -+0x30, 0xF0, 0x20, 0x6E, 0x30, 0xF0, 0x20, 0x6C, -+0xA8, 0xF0, 0x0C, 0x4F, 0xA8, 0xF2, 0x14, 0x4E, -+0xA4, 0x42, 0xC8, 0xF0, 0x04, 0x4C, 0x00, 0x6B, -+0x1A, 0x65, 0x00, 0x6A, 0x18, 0x67, 0x40, 0xDF, -+0x40, 0xC8, 0x40, 0xDE, 0xD0, 0xF7, 0x05, 0x43, -+0x30, 0xF0, 0x20, 0x6A, 0x0C, 0x30, 0xC0, 0xF1, -+0x08, 0x4A, 0x09, 0xE2, 0x0A, 0x4A, 0x05, 0xD2, -+0x58, 0x67, 0x04, 0xD4, 0x00, 0x69, 0xFA, 0x65, -+0x05, 0x90, 0x01, 0x6A, 0x09, 0xD3, 0x40, 0xC0, -+0x6C, 0x30, 0x01, 0xE1, 0x18, 0x65, 0x10, 0x32, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x49, 0xE0, 0xE7, 0xF6, 0x0C, 0x4A, 0x08, 0xD2, -+0x58, 0x67, 0x50, 0x32, 0x41, 0xE0, 0x08, 0x92, -+0xE7, 0xF7, 0x0C, 0x48, 0x06, 0xD0, 0x06, 0x93, -+0x00, 0x68, 0x00, 0xCA, 0x00, 0xCB, 0x02, 0x4B, -+0x06, 0xD3, 0x04, 0x93, 0x02, 0x4A, 0x6A, 0xEA, -+0xF6, 0x61, 0x05, 0x92, 0x01, 0x49, 0x02, 0x71, -+0x01, 0x4A, 0x05, 0xD2, 0x04, 0x92, 0x09, 0x93, -+0x10, 0x4A, 0x04, 0xD2, 0xD5, 0x61, 0x00, 0xC5, -+0x01, 0xC5, 0x02, 0xC5, 0x01, 0x4B, 0x1F, 0x67, -+0x02, 0x6A, 0x02, 0x48, 0x7F, 0x4C, 0x6E, 0xEA, -+0x04, 0x4F, 0x10, 0x4E, 0x18, 0x65, 0x03, 0x4D, -+0x01, 0x4C, 0xB3, 0x2A, 0x10, 0xF0, 0x24, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, -+0x35, 0xF3, 0xC0, 0x9B, 0x01, 0x6D, 0x03, 0xF3, -+0x10, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x00, 0x6B, 0x0B, 0xD7, 0xE0, 0xAE, 0x1F, 0xF7, -+0x00, 0x6A, 0xEC, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x08, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xE0, 0xAE, 0x15, 0xF1, 0x40, 0x9A, 0x49, 0xE7, -+0xE0, 0xA2, 0x06, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF1, 0x44, 0x9A, 0x5D, 0xE7, 0xE0, 0xA7, -+0xFF, 0x6A, 0xEC, 0xEA, 0x7D, 0xE4, 0x01, 0x4B, -+0x04, 0x73, 0x40, 0xC7, 0x02, 0x4E, 0xE2, 0x61, -+0x25, 0x67, 0x00, 0x68, 0x0B, 0x93, 0x01, 0x6D, -+0xAB, 0xED, 0x09, 0xE3, 0x80, 0xAA, 0x02, 0x48, -+0x00, 0x18, 0x05, 0xE1, 0x16, 0x70, 0x40, 0xD9, -+0x04, 0x49, 0xF4, 0x61, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xFF, 0x69, 0xF5, 0xF2, -+0x78, 0x9B, 0x30, 0xF0, 0x20, 0x68, 0x2C, 0xEC, -+0xCE, 0xF4, 0x50, 0x98, 0xAC, 0xE9, 0x24, 0x36, -+0x01, 0x6D, 0x04, 0xD4, 0xAB, 0xED, 0x03, 0xF3, -+0x00, 0x6C, 0x6D, 0xEE, 0x40, 0xEA, 0x04, 0x92, -+0x08, 0x2A, 0xCE, 0xF4, 0x50, 0x98, 0x03, 0xF3, -+0x0C, 0x6C, 0x06, 0xF0, 0x00, 0x6D, 0x03, 0x6E, -+0x07, 0x10, 0xCE, 0xF4, 0x50, 0x98, 0x03, 0xF3, -+0x0C, 0x6C, 0x06, 0xF0, 0x00, 0x6D, 0x01, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x15, 0xF3, -+0xA4, 0x9B, 0xC3, 0xF3, 0x14, 0x6C, 0x10, 0x6E, -+0x40, 0xEA, 0x04, 0x94, 0x24, 0x31, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xE4, 0x30, 0x33, 0xC0, 0xF1, -+0x08, 0x4A, 0x30, 0x31, 0x6D, 0xE2, 0x29, 0xE2, -+0xE7, 0xF7, 0x0C, 0x4A, 0x04, 0xD2, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0x24, 0x9A, 0xE7, 0xF6, -+0x0C, 0x4B, 0x05, 0xD3, 0x30, 0xF0, 0x20, 0x68, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0xD1, 0x67, -+0xC3, 0xF3, 0x18, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x01, 0x6D, 0xE3, 0xF3, 0x1C, 0x6C, 0xAB, 0xED, -+0x00, 0x18, 0x05, 0xE1, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF3, 0x68, 0x9B, 0x05, 0x94, 0x04, 0x49, -+0x4C, 0xEB, 0x62, 0x33, 0x62, 0x33, 0x60, 0xCC, -+0xE1, 0xF7, 0x1F, 0x6B, 0x4C, 0xEB, 0x04, 0x92, -+0x02, 0x4C, 0x05, 0xD4, 0x60, 0xCA, 0x02, 0x4A, -+0x04, 0xD2, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, -+0x4C, 0x9A, 0x2E, 0xEA, 0xD7, 0x2A, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0xC3, 0xF3, 0x18, 0x6C, -+0xAB, 0xED, 0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x03, 0xF3, 0x0C, 0x6C, 0x06, 0xF0, -+0x00, 0x6D, 0x00, 0x6E, 0x40, 0xEA, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, 0x40, 0xA2, -+0xFF, 0x69, 0x8C, 0xE9, 0x53, 0x22, 0x10, 0xF0, -+0x24, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0xF5, 0xF2, -+0x78, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x24, 0x36, -+0x01, 0x6D, 0x6D, 0xEE, 0x03, 0xF3, 0x00, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF3, 0xB0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x23, 0xF3, 0x08, 0x6C, 0x80, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0xC3, 0xF3, -+0x0C, 0x6C, 0xAB, 0xED, 0x09, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, -+0x35, 0xF3, 0xD4, 0x9B, 0x01, 0x6D, 0x23, 0xF3, -+0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x35, 0xF3, 0xD8, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0x23, 0xF3, 0x04, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF3, 0x1C, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x55, 0xF3, 0xE0, 0x9A, 0x00, 0x6C, 0x78, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x63, 0xE1, 0x00, 0x6C, -+0x5C, 0x6D, 0xD0, 0x67, 0x20, 0xF3, 0x00, 0x6F, -+0x00, 0x18, 0x63, 0xE1, 0x10, 0xF0, 0x24, 0x6A, -+0x00, 0x6C, 0x8F, 0x6D, 0xD0, 0x67, 0x55, 0xF3, -+0xE4, 0x9A, 0x79, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0xF5, 0xF2, 0x78, 0x9B, 0x30, 0xF0, 0x20, 0x68, -+0xCE, 0xF4, 0x50, 0x98, 0x24, 0x36, 0x01, 0x6D, -+0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, 0x6D, 0xEE, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF0, -+0x54, 0xA2, 0x03, 0x22, 0x01, 0x72, 0x28, 0x60, -+0x64, 0x10, 0xCE, 0xF4, 0x50, 0x98, 0xC3, 0xF3, -+0x0C, 0x6C, 0xFF, 0x6D, 0x12, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF3, 0xB0, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x23, 0xF3, 0x08, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF3, 0xD4, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x23, 0xF3, 0x00, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x01, 0x6D, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x98, 0x23, 0xF3, 0x04, 0x6C, -+0xAB, 0xED, 0x55, 0xF3, 0xC8, 0x9B, 0x26, 0x10, -+0xCE, 0xF4, 0x50, 0x98, 0xC3, 0xF3, 0x0C, 0x6C, -+0xFF, 0x6D, 0x09, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x35, 0xF3, 0xB0, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x23, 0xF3, 0x08, 0x6C, 0x00, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x55, 0xF3, -+0xD4, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0x23, 0xF3, 0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, -+0x55, 0xF3, 0xD8, 0x9B, 0x01, 0x6D, 0x23, 0xF3, -+0x04, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0x1C, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF3, 0xEC, 0x9A, 0x91, 0x67, -+0x56, 0x6D, 0xD0, 0x67, 0x00, 0x18, 0x63, 0xE1, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF3, 0xF0, 0x9A, -+0x91, 0x67, 0x8F, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x63, 0xE1, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x21, 0x6A, -+0x70, 0xF3, 0x40, 0xA2, 0xFF, 0x6E, 0x8C, 0xEE, -+0x48, 0x22, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0xF5, 0xF2, 0x78, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x69, 0x2B, 0xE9, 0xC4, 0x36, -+0x6D, 0xEE, 0xB1, 0x67, 0x03, 0xF3, 0x00, 0x6C, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, -+0xC3, 0xF3, 0x0C, 0x6C, 0x1B, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x55, 0xF3, 0xDC, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, 0x23, 0xF3, -+0x00, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF3, 0x3C, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF3, 0xE0, 0x9A, 0x00, 0x6C, 0x78, 0x6D, -+0xD1, 0x67, 0x00, 0x18, 0x63, 0xE1, 0x00, 0x6C, -+0x5C, 0x6D, 0xD1, 0x67, 0x28, 0xF3, 0x00, 0x6F, -+0x00, 0x18, 0x63, 0xE1, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF3, 0xE4, 0x9A, 0x00, 0x6C, 0x8F, 0x6D, -+0xD1, 0x67, 0x00, 0x18, 0x63, 0xE1, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, 0x23, 0xF3, -+0x08, 0x6C, 0x35, 0xF3, 0xB0, 0x9B, 0x80, 0x6E, -+0x5D, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF2, -+0x78, 0x9B, 0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x69, 0x2B, 0xE9, 0xC4, 0x36, -+0x6D, 0xEE, 0x03, 0xF3, 0x00, 0x6C, 0xB1, 0x67, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0xC3, 0xF3, -+0x0C, 0x6C, 0xB1, 0x67, 0x09, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, -+0x75, 0xF3, 0xC8, 0x9B, 0x23, 0xF3, 0x00, 0x6C, -+0xB1, 0x67, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF0, 0x54, 0xA2, 0x03, 0x22, 0x01, 0x72, -+0x16, 0x60, 0x35, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF3, 0x3C, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF3, 0xEC, 0x9A, 0x00, 0x6C, 0x56, 0x6D, -+0xD1, 0x67, 0x00, 0x18, 0x63, 0xE1, 0x10, 0xF0, -+0x24, 0x6A, 0x00, 0x6C, 0x8F, 0x6D, 0xD1, 0x67, -+0x75, 0xF3, 0xF0, 0x9A, 0x14, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0x3C, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF3, 0xF4, 0x9A, 0x00, 0x6C, -+0x56, 0x6D, 0xD1, 0x67, 0x00, 0x18, 0x63, 0xE1, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF3, 0xF8, 0x9A, -+0x00, 0x6C, 0x8F, 0x6D, 0xD1, 0x67, 0x00, 0x18, -+0x63, 0xE1, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x35, 0xF3, 0xB0, 0x9B, 0x23, 0xF3, -+0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0x00, 0x6A, -+0x7D, 0x67, 0x4C, 0xCB, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF3, 0xDC, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF1, 0xE0, 0x9A, 0x00, 0x6C, 0xA4, 0x67, -+0x00, 0x18, 0x63, 0xE1, 0x30, 0xF0, 0x20, 0x68, -+0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF3, 0xBC, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0xE1, 0xF0, 0x18, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0xE1, 0xF0, 0x1C, 0x6C, 0xAB, 0xED, -+0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x07, 0x6D, 0xC5, 0x67, 0x83, 0xF1, 0x0C, 0x6C, -+0x40, 0xEA, 0x06, 0x02, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF4, 0x54, 0x9A, 0xA1, 0xF3, -+0x18, 0x6F, 0xA1, 0xF7, 0x00, 0x6C, 0x08, 0x6D, -+0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0xF0, 0x08, 0x6C, 0xFF, 0x6D, 0x00, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x95, 0xF3, 0xA0, 0x9B, 0x01, 0xF2, -+0x04, 0x6C, 0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF3, 0x64, 0x9A, 0xFF, 0x6A, -+0x80, 0xA3, 0x8C, 0xEA, 0xFE, 0x6C, 0x4C, 0xEC, -+0x80, 0xC3, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF3, 0x48, 0x9A, 0x60, 0xA2, 0x01, 0x6A, -+0x6C, 0xEA, 0x09, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF3, 0x70, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF3, 0x4C, 0x9A, 0x60, 0xDA, 0x09, 0x97, -+0x08, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x37, 0x22, 0x30, 0xF0, -+0x20, 0x68, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x95, 0xF3, 0xD4, 0x9B, 0x01, 0x69, -+0x2B, 0xE9, 0xB1, 0x67, 0x61, 0xF4, 0x00, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x95, 0xF3, 0xD8, 0x9B, 0xB1, 0x67, -+0x61, 0xF4, 0x00, 0x6C, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, 0x95, 0xF3, -+0xDC, 0x9B, 0xB1, 0x67, 0x41, 0xF4, 0x18, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF3, -+0xC0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, -+0x41, 0xF4, 0x1C, 0x6C, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x61, 0xF4, 0x0C, 0x6C, 0xB1, 0x67, -+0x01, 0xF2, 0x15, 0x6E, 0x40, 0xEA, 0x80, 0x18, -+0x50, 0x0B, 0x34, 0x10, 0x30, 0xF0, 0x20, 0x68, -+0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF3, 0xD4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x69, 0x2B, 0xE9, -+0x61, 0xF4, 0x00, 0x6C, 0xB1, 0x67, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF3, 0xC4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x61, 0xF4, 0x00, 0x6C, -+0xB1, 0x67, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xB5, 0xF3, 0xC8, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x41, 0xF4, 0x18, 0x6C, 0xB1, 0x67, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, -+0xB5, 0xF3, 0xCC, 0x9B, 0x41, 0xF4, 0x1C, 0x6C, -+0xB1, 0x67, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x61, 0xF4, 0x0C, 0x6C, 0xB1, 0x67, 0x22, 0xF2, -+0x0A, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, -+0xB5, 0xF2, 0xB8, 0x9B, 0xA1, 0xF1, 0x04, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x68, 0x8C, 0xE8, 0x00, 0x69, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0x1C, 0x4A, 0xC0, 0x9A, -+0x90, 0x67, 0xEF, 0x6D, 0x00, 0x6F, 0x00, 0x18, -+0x63, 0xE1, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF3, -+0x1C, 0x4B, 0xC0, 0x9B, 0x90, 0x67, 0x08, 0x6D, -+0x00, 0x6F, 0x00, 0x18, 0x63, 0xE1, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0x1C, 0x4A, 0xC0, 0x9A, -+0x90, 0x67, 0x08, 0x6D, 0x00, 0x18, 0x50, 0xE1, -+0x07, 0x22, 0x01, 0x49, 0xFF, 0xF7, 0x1F, 0x6A, -+0x4C, 0xE9, 0x2E, 0xF5, 0x10, 0x71, 0xDB, 0x61, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, 0xDC, 0x9A, -+0x00, 0x6C, 0x18, 0x6D, 0x00, 0x18, 0x50, 0xE1, -+0x30, 0xF0, 0x20, 0x6B, 0x01, 0xF4, 0x00, 0x6C, -+0xC0, 0xF1, 0x08, 0x4B, 0x4C, 0xEC, 0x87, 0xF6, -+0x50, 0xDB, 0x82, 0x32, 0x4A, 0x32, 0x02, 0x72, -+0x0A, 0x60, 0x03, 0x6C, 0x4E, 0xEC, 0x04, 0x24, -+0x01, 0x72, 0x02, 0x6A, 0x05, 0x60, 0x06, 0x10, -+0x87, 0xF6, 0x8D, 0xC3, 0x03, 0x10, 0x01, 0x6A, -+0x87, 0xF6, 0x4D, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6B, -+0x95, 0xF1, 0x60, 0x9B, 0x87, 0xF6, 0x90, 0x9A, -+0x8C, 0xEB, 0x62, 0x33, 0x62, 0x33, 0x87, 0xF6, -+0x6C, 0xC2, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x6A, -+0x4C, 0xEC, 0x05, 0x67, 0x01, 0x74, 0x4C, 0xE8, -+0x5D, 0x60, 0x03, 0x24, 0x04, 0x5C, 0x71, 0x60, -+0x6B, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xE7, 0xF6, 0x64, 0x9A, 0x30, 0xF0, -+0x20, 0x6C, 0xC8, 0xF0, 0x04, 0x4C, 0xE7, 0xF6, -+0x68, 0xDA, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, -+0x18, 0x4A, 0x00, 0xF6, 0x76, 0xAA, 0x00, 0x6D, -+0x00, 0xF6, 0x78, 0xCA, 0x20, 0xF6, 0x64, 0xA2, -+0x20, 0xF6, 0x65, 0xC2, 0x30, 0xF0, 0x20, 0x6B, -+0x68, 0xF0, 0x1A, 0x4B, 0x40, 0xA3, 0xB0, 0x36, -+0x48, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC9, 0xE2, 0xE7, 0xF6, 0x0C, 0x4A, -+0xC0, 0xAA, 0x80, 0xF0, 0xC0, 0xCA, 0x00, 0xF1, -+0xC0, 0xAA, 0x80, 0xF1, 0xC0, 0xCA, 0x02, 0x4A, -+0x8A, 0xEA, 0xF6, 0x61, 0x01, 0x4D, 0x02, 0x75, -+0x01, 0x4B, 0x10, 0x4C, 0xE7, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0x78, 0x67, -+0x20, 0xF6, 0x64, 0xC2, 0x78, 0x67, 0x00, 0xF6, -+0x76, 0xCA, 0x30, 0xF0, 0x20, 0x6B, 0x00, 0x6C, -+0xC0, 0xF1, 0x08, 0x4B, 0x20, 0xF6, 0x80, 0xC2, -+0x20, 0xF6, 0x81, 0xC2, 0x00, 0xF6, 0x9A, 0xC2, -+0x00, 0xF6, 0x9B, 0xC2, 0x00, 0xF6, 0x9C, 0xC2, -+0x87, 0xF6, 0x50, 0x9B, 0x01, 0x6D, 0xA7, 0xF6, -+0xB2, 0xC3, 0xA7, 0xF6, 0xB3, 0xC3, 0xE7, 0xF6, -+0x44, 0xDB, 0x17, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF3, 0xDC, 0x9A, 0x00, 0x6C, 0x58, 0x6D, -+0x00, 0x18, 0x50, 0xE1, 0x22, 0xF0, 0x1A, 0x48, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x08, 0x30, 0x0D, 0xE3, 0x41, 0xDB, 0x05, 0x10, -+0xFE, 0x4C, 0x4C, 0xEC, 0xB0, 0x67, 0x80, 0x18, -+0x42, 0x0A, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, 0x56, 0xA2, -+0x0C, 0x2A, 0x01, 0x6C, 0x00, 0x6D, 0x80, 0x18, -+0xFC, 0x0B, 0x02, 0x6C, 0x00, 0x6D, 0x80, 0x18, -+0xFC, 0x0B, 0x03, 0x6C, 0x00, 0x6D, 0x80, 0x18, -+0xFC, 0x0B, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x00, 0x68, 0x09, 0xD5, 0x24, 0x67, 0x09, 0x93, -+0x00, 0x6C, 0x09, 0xE3, 0xA0, 0xA2, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0xDC, 0x9A, 0x01, 0x48, -+0x00, 0x18, 0x50, 0xE1, 0x05, 0x70, 0x40, 0xD9, -+0x04, 0x49, 0xF1, 0x61, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x0C, 0xD6, 0xFF, 0x68, -+0x35, 0xF3, 0xDC, 0x9A, 0xFF, 0xF7, 0x1F, 0x69, -+0x0C, 0x97, 0x8C, 0xE8, 0xAC, 0xE9, 0x90, 0x67, -+0xB1, 0x67, 0x00, 0x18, 0x63, 0xE1, 0x00, 0x6A, -+0x04, 0xD2, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF3, -+0x1C, 0x4B, 0xC0, 0x9B, 0x90, 0x67, 0xB1, 0x67, -+0x00, 0x18, 0x50, 0xE1, 0x0C, 0x93, 0x6E, 0xEA, -+0x16, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0x1C, 0x4A, 0xC0, 0x9A, -+0x0C, 0x97, 0x90, 0x67, 0xB1, 0x67, 0x00, 0x18, -+0x63, 0xE1, 0x04, 0x93, 0x01, 0x4B, 0xE0, 0xF3, -+0x08, 0x73, 0x04, 0xD3, 0xDE, 0x61, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xFF, 0x6A, 0x24, 0x67, -+0x2F, 0xF5, 0x18, 0x48, 0x4C, 0xED, 0x4C, 0xE9, -+0x20, 0xF6, 0x48, 0xA0, 0x04, 0xD5, 0x60, 0x22, -+0x06, 0x25, 0x12, 0x6A, 0x00, 0xF6, 0x4D, 0xC0, -+0x02, 0x6A, 0x00, 0xF6, 0x50, 0xD8, 0x10, 0xF0, -+0x24, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0xF5, 0xF2, -+0x78, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x24, 0x36, -+0x01, 0x6D, 0x6D, 0xEE, 0x03, 0xF3, 0x00, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF3, 0xB0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x23, 0xF3, 0x08, 0x6C, 0x80, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x21, 0x6B, 0x50, 0xF3, 0xC5, 0xA3, -+0xCE, 0xF4, 0x50, 0x98, 0xC3, 0xF3, 0x0C, 0x6C, -+0xFF, 0x6D, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xB5, 0xF3, 0xD0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x03, 0xF3, 0x18, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF3, -+0xD4, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0x23, 0xF3, 0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x55, 0xF3, 0xD8, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0x23, 0xF3, -+0x04, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF3, 0xC0, 0x9A, 0x91, 0x67, -+0x78, 0x6D, 0x80, 0x18, 0x56, 0x0C, 0x91, 0x67, -+0x5C, 0x6D, 0x20, 0xF3, 0x00, 0x6E, 0x80, 0x18, -+0x56, 0x0C, 0x10, 0xF0, 0x24, 0x6A, 0x91, 0x67, -+0x8F, 0x6D, 0x55, 0xF3, 0xC4, 0x9A, 0xB2, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF2, 0x78, 0x9B, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, -+0x24, 0x36, 0x01, 0x6D, 0x03, 0xF3, 0x00, 0x6C, -+0xAB, 0xED, 0x6D, 0xEE, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF0, 0x54, 0xA2, 0x03, 0x22, -+0x01, 0x72, 0x4B, 0x60, 0x9D, 0x10, 0x04, 0x92, -+0x06, 0x22, 0x12, 0x6A, 0x00, 0xF6, 0x4D, 0xC0, -+0x02, 0x6A, 0x00, 0xF6, 0x50, 0xD8, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0x2F, 0xF5, -+0x18, 0x4B, 0x00, 0xF6, 0xCD, 0xA3, 0xCE, 0xF4, -+0x50, 0x98, 0x04, 0xD3, 0xC3, 0xF3, 0x0C, 0x6C, -+0xFF, 0x6D, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF3, 0xB0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x23, 0xF3, 0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF3, 0xD4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0x23, 0xF3, -+0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x04, 0x94, -+0x10, 0xF0, 0x24, 0x6A, 0x14, 0xF5, 0x18, 0x4A, -+0x00, 0xF6, 0x70, 0x9C, 0x01, 0x6D, 0x23, 0xF3, -+0x04, 0x6C, 0x49, 0xE3, 0xC0, 0xA2, 0x10, 0xF0, -+0x24, 0x6B, 0xB5, 0xF3, 0x74, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0xC0, 0x36, 0xC8, 0x36, 0xAB, 0xED, -+0x6D, 0xEE, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x91, 0x67, 0x56, 0x6D, 0x55, 0xF3, 0xCC, 0x9A, -+0x49, 0x10, 0x04, 0x92, 0x06, 0x22, 0x1B, 0x6A, -+0x00, 0xF6, 0x4D, 0xC0, 0x02, 0x6A, 0x00, 0xF6, -+0x50, 0xD8, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0x2F, 0xF5, 0x18, 0x4B, 0x00, 0xF6, -+0xCD, 0xA3, 0xCE, 0xF4, 0x50, 0x98, 0x04, 0xD3, -+0xC3, 0xF3, 0x0C, 0x6C, 0xFF, 0x6D, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF3, 0xB0, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x23, 0xF3, 0x08, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x55, 0xF3, 0xD4, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x23, 0xF3, 0x00, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x04, 0x94, 0x10, 0xF0, 0x24, 0x6A, -+0x34, 0xF5, 0x00, 0x4A, 0x00, 0xF6, 0x70, 0x9C, -+0x01, 0x6D, 0x23, 0xF3, 0x04, 0x6C, 0x49, 0xE3, -+0xC0, 0xA2, 0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF3, -+0x74, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0xC0, 0x36, -+0xC8, 0x36, 0xAB, 0xED, 0x6D, 0xEE, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF3, 0xD8, 0x9A, -+0x91, 0x67, 0x56, 0x6D, 0x80, 0x18, 0x56, 0x0C, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF3, 0xD0, 0x9A, -+0x91, 0x67, 0x8F, 0x6D, 0x80, 0x18, 0x56, 0x0C, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF3, 0x3C, 0x9A, 0x08, 0xD4, 0x00, 0x6C, -+0x05, 0x67, 0xD1, 0x67, 0xE4, 0x67, 0xEF, 0x6D, -+0x00, 0x18, 0x63, 0xE1, 0x00, 0x6C, 0xE4, 0x67, -+0xD1, 0x67, 0xEE, 0x6D, 0x00, 0x18, 0x63, 0xE1, -+0xC0, 0x98, 0x11, 0x6A, 0x4B, 0xEA, 0x4C, 0xEE, -+0x00, 0x6C, 0xDF, 0x6D, 0x80, 0x18, 0x56, 0x0C, -+0xC1, 0x98, 0x11, 0x6A, 0x4B, 0xEA, 0x4C, 0xEE, -+0x00, 0x6C, 0xDE, 0x6D, 0x80, 0x18, 0x56, 0x0C, -+0x08, 0x92, 0xE2, 0x98, 0xD1, 0x67, 0xA2, 0xA2, -+0x00, 0x6C, 0x00, 0x18, 0x63, 0xE1, 0x08, 0x92, -+0xE3, 0x98, 0xD1, 0x67, 0xA3, 0xA2, 0x00, 0x6C, -+0x00, 0x18, 0x63, 0xE1, 0x44, 0x98, 0x02, 0x6F, -+0xEB, 0xEF, 0xD1, 0x67, 0x4C, 0xEF, 0x00, 0x6C, -+0x01, 0x6D, 0x00, 0x18, 0x63, 0xE1, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, 0x20, 0x68, -+0xF5, 0xF2, 0xD8, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x69, 0x2B, 0xE9, 0x03, 0xF3, 0x00, 0x6C, -+0xB1, 0x67, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xA3, 0xF3, 0x18, 0x6C, 0xB1, 0x67, 0x00, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, -+0x1C, 0x9A, 0x00, 0x6C, 0xDF, 0x6D, 0xD0, 0x67, -+0x00, 0x18, 0x50, 0xE1, 0x01, 0xF0, 0x13, 0x6B, -+0x6B, 0xEB, 0x4C, 0xEB, 0x01, 0xF0, 0x02, 0x6E, -+0x00, 0x6C, 0xDF, 0x6D, 0x6D, 0xEE, 0x80, 0x18, -+0x56, 0x0C, 0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, -+0x40, 0xA2, 0x10, 0x22, 0x00, 0x6C, 0xDE, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x50, 0xE1, 0x10, 0xF0, -+0x11, 0x6B, 0x6B, 0xEB, 0x4C, 0xEB, 0x10, 0xF0, -+0x00, 0x6E, 0x00, 0x6C, 0xDE, 0x6D, 0x6D, 0xEE, -+0x80, 0x18, 0x56, 0x0C, 0x30, 0xF0, 0x21, 0x6A, -+0x70, 0xF3, 0x40, 0xA2, 0x5C, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x95, 0xF1, 0x0C, 0x9A, 0x00, 0x6C, -+0xEF, 0x6D, 0xD0, 0x67, 0x80, 0x18, 0x56, 0x0C, -+0x00, 0x6C, 0x33, 0x6D, 0x24, 0x6E, 0x80, 0x18, -+0x56, 0x0C, 0x00, 0x6C, 0x3E, 0x6D, 0x3F, 0x6E, -+0x80, 0x18, 0x56, 0x0C, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF3, 0xDC, 0x9A, 0x00, 0x6C, 0x3F, 0x6D, -+0x80, 0x18, 0x56, 0x0C, 0x00, 0x6C, 0xEF, 0x6D, -+0xC4, 0x67, 0x80, 0x18, 0x56, 0x0C, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF0, 0x54, 0xA2, 0x01, 0x72, -+0x17, 0x61, 0x01, 0x6F, 0x00, 0x6C, 0xEF, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x63, 0xE1, 0x00, 0x6C, -+0x33, 0x6D, 0x26, 0x6E, 0x80, 0x18, 0x56, 0x0C, -+0x00, 0x6C, 0x3E, 0x6D, 0x37, 0x6E, 0x80, 0x18, -+0x56, 0x0C, 0x10, 0xF0, 0x24, 0x6A, 0x00, 0x6C, -+0x3F, 0x6D, 0xD5, 0xF3, 0xC0, 0x9A, 0x16, 0x10, -+0x01, 0x6F, 0x00, 0x6C, 0xEF, 0x6D, 0xD0, 0x67, -+0x00, 0x18, 0x63, 0xE1, 0x00, 0x6C, 0x33, 0x6D, -+0x26, 0x6E, 0x80, 0x18, 0x56, 0x0C, 0x00, 0x6C, -+0x3E, 0x6D, 0x37, 0x6E, 0x80, 0x18, 0x56, 0x0C, -+0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF3, 0xC4, 0x9A, -+0x00, 0x6C, 0x3F, 0x6D, 0x80, 0x18, 0x56, 0x0C, -+0x00, 0x6C, 0xEF, 0x6D, 0xD0, 0x67, 0xE4, 0x67, -+0x00, 0x18, 0x63, 0xE1, 0x16, 0x10, 0x00, 0x6C, -+0xEE, 0x6D, 0x02, 0xF0, 0x00, 0x6E, 0x80, 0x18, -+0x56, 0x0C, 0x00, 0x6C, 0x33, 0x6D, 0x04, 0x6E, -+0x80, 0x18, 0x56, 0x0C, 0x00, 0x6C, 0x3F, 0x6D, -+0xC3, 0xF6, 0x01, 0x6E, 0x80, 0x18, 0x56, 0x0C, -+0x00, 0x6C, 0xEE, 0x6D, 0xC4, 0x67, 0x80, 0x18, -+0x56, 0x0C, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x68, 0xFF, 0xF7, -+0x1F, 0x69, 0x8C, 0xE8, 0xAC, 0xE9, 0x90, 0x67, -+0xB1, 0x67, 0x0C, 0xD6, 0x0D, 0xD7, 0x00, 0x18, -+0x63, 0xE1, 0x00, 0x6A, 0x04, 0xD2, 0x0C, 0x96, -+0x90, 0x67, 0xB1, 0x67, 0x00, 0x18, 0x50, 0xE1, -+0x0D, 0x93, 0x6E, 0xEA, 0x12, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, -+0x40, 0xEA, 0x0C, 0x96, 0x0D, 0x97, 0x90, 0x67, -+0xB1, 0x67, 0x00, 0x18, 0x63, 0xE1, 0x04, 0x92, -+0x01, 0x4A, 0xE0, 0xF3, 0x08, 0x72, 0x04, 0xD2, -+0xE6, 0x61, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x24, 0x67, -+0x4C, 0xED, 0x4C, 0xE9, 0x30, 0xF0, 0x21, 0x6A, -+0x70, 0xF3, 0x40, 0xA2, 0x04, 0xD5, 0x56, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x68, -+0xF5, 0xF2, 0x58, 0x9A, 0xCE, 0xF4, 0x70, 0x98, -+0x24, 0x36, 0x01, 0x6D, 0x4D, 0xEE, 0x03, 0xF3, -+0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEB, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0xC3, 0xF3, 0x0C, 0x6C, -+0xAB, 0xED, 0x1B, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x35, 0xF3, 0x10, 0x4B, 0xCE, 0xF4, -+0x50, 0x98, 0xA0, 0x9B, 0x23, 0xF3, 0x00, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF3, 0x10, 0x4B, 0xCE, 0xF4, 0x50, 0x98, -+0xA0, 0x9B, 0x23, 0xF3, 0x08, 0x6C, 0x80, 0x6E, -+0x40, 0xEA, 0x04, 0x93, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF3, 0x1C, 0x9A, 0x60, 0x32, 0x10, 0xF0, -+0x24, 0x6B, 0xD5, 0xF3, 0x68, 0x9B, 0x58, 0x32, -+0x91, 0x67, 0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x75, 0xF3, 0xE0, 0x9B, 0x78, 0x6D, 0xD0, 0x67, -+0x4C, 0xEF, 0x00, 0x18, 0x63, 0xE1, 0x91, 0x67, -+0x5C, 0x6D, 0xD0, 0x67, 0x2A, 0xF3, 0x00, 0x6F, -+0x00, 0x18, 0x63, 0xE1, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF3, 0xE4, 0x9A, 0x91, 0x67, 0x8F, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x63, 0xE1, 0x00, 0x6C, -+0xEE, 0x6D, 0x55, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x68, 0xF5, 0xF2, 0x58, 0x9A, -+0xCE, 0xF4, 0x70, 0x98, 0x24, 0x36, 0x01, 0x6D, -+0x4D, 0xEE, 0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, -+0x40, 0xEB, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0xC3, 0xF3, 0x0C, 0x6C, 0xAB, 0xED, 0x09, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF3, -+0x10, 0x4B, 0xCE, 0xF4, 0x50, 0x98, 0xA0, 0x9B, -+0x23, 0xF3, 0x00, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF0, 0x54, 0xA2, -+0x03, 0x22, 0x01, 0x72, 0x35, 0x60, 0x69, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF3, 0x10, 0x4B, -+0xCE, 0xF4, 0x50, 0x98, 0xA0, 0x9B, 0x23, 0xF3, -+0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, 0x04, 0x93, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, 0x1C, 0x9A, -+0x74, 0x32, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF3, -+0x6C, 0x9B, 0x00, 0x6C, 0x56, 0x6D, 0x6D, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF3, 0xF0, 0x9B, -+0xD0, 0x67, 0x4C, 0xEF, 0x00, 0x18, 0x63, 0xE1, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF3, 0xF0, 0x9A, -+0x00, 0x6C, 0x8F, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x63, 0xE1, 0x00, 0x6C, 0xEF, 0x6D, 0x10, 0x6E, -+0x01, 0x6F, 0x80, 0x18, 0x89, 0x0D, 0x00, 0x6C, -+0x33, 0x6D, 0x08, 0x6E, 0xE4, 0x67, 0x33, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF3, 0x10, 0x4B, -+0xCE, 0xF4, 0x50, 0x98, 0xA0, 0x9B, 0x23, 0xF3, -+0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, 0x04, 0x93, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, 0x1C, 0x9A, -+0x74, 0x32, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF3, -+0x6C, 0x9B, 0x00, 0x6C, 0x56, 0x6D, 0x6D, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF3, 0xF4, 0x9B, -+0xD0, 0x67, 0x4C, 0xEF, 0x00, 0x18, 0x63, 0xE1, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF3, 0xF0, 0x9A, -+0x00, 0x6C, 0x8F, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x63, 0xE1, 0x00, 0x6C, 0xEF, 0x6D, 0x10, 0x6E, -+0x01, 0x6F, 0x80, 0x18, 0x89, 0x0D, 0x00, 0x6C, -+0x33, 0x6D, 0x08, 0x6E, 0x01, 0x6F, 0x00, 0x18, -+0x63, 0xE1, 0x04, 0x97, 0x91, 0x67, 0x33, 0x6D, -+0x07, 0x6E, 0x00, 0x18, 0x63, 0xE1, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x00, 0x6A, 0x7D, 0x67, 0x4C, 0xCB, 0x2E, 0xF5, -+0x10, 0x6A, 0xFF, 0x68, 0x04, 0xD2, 0x06, 0x02, -+0x0C, 0xEC, 0x05, 0xD2, 0x10, 0xF0, 0x24, 0x6A, -+0x08, 0xD4, 0x35, 0xF3, 0xDC, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x08, 0x94, 0xD5, 0xF3, 0xF8, 0x9A, -+0x0C, 0xED, 0x09, 0xD5, 0x08, 0x6D, 0x00, 0x18, -+0x7D, 0xE1, 0x0E, 0x22, 0x09, 0x92, 0x00, 0x69, -+0x12, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF2, -+0xBC, 0x9A, 0x03, 0xF3, 0x08, 0x6C, 0x00, 0x18, -+0x05, 0xE1, 0x22, 0x67, 0x0C, 0xE9, 0x07, 0x10, -+0x10, 0xF0, 0x24, 0x6C, 0xF5, 0xF7, 0x08, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x01, 0x69, 0x08, 0x94, -+0x80, 0x18, 0xC8, 0x0B, 0x7D, 0x67, 0xAC, 0xAB, -+0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF0, 0x00, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x51, 0x67, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0xFF, 0x6A, 0x24, 0x67, 0x4C, 0xED, 0x4C, 0xE9, -+0x05, 0xD5, 0x06, 0x2D, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF0, 0x15, 0xA2, 0x04, 0x48, 0x22, 0x10, -+0x05, 0x92, 0x01, 0x72, 0x16, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF0, 0x55, 0xA2, 0x02, 0x72, -+0x08, 0x61, 0x44, 0x41, 0x01, 0x68, 0x04, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF3, 0x5C, 0x9A, -+0x1A, 0x10, 0x44, 0x41, 0x01, 0x68, 0x04, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF3, 0x40, 0x9A, -+0x12, 0x10, 0x05, 0x93, 0x00, 0x68, 0x02, 0x73, -+0x0F, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF0, -+0x15, 0xA2, 0x09, 0x48, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF2, 0x58, 0x9A, 0x00, 0x30, 0x64, 0x41, -+0x4D, 0xE8, 0x01, 0x6A, 0x44, 0xEB, 0x4D, 0xE8, -+0x80, 0x18, 0xA8, 0x08, 0x30, 0xF0, 0x20, 0x6C, -+0xCE, 0xF4, 0x50, 0x9C, 0x01, 0x6D, 0xD0, 0x67, -+0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x01, 0x6D, 0xC1, 0x40, 0xAB, 0xED, 0x03, 0xF3, -+0x00, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x58, 0x9A, 0x02, 0x6C, 0x30, 0xF0, -+0x20, 0x68, 0x40, 0xEA, 0x91, 0x67, 0x01, 0x6D, -+0x80, 0x18, 0x22, 0x0E, 0x04, 0xD2, 0x2F, 0xF5, -+0x18, 0x48, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF3, -+0x48, 0x9A, 0x20, 0xF6, 0xAC, 0x98, 0x38, 0x6C, -+0x40, 0xEA, 0x24, 0x34, 0x30, 0xF0, 0x20, 0x6A, -+0x06, 0xD4, 0xCE, 0xF4, 0x70, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF2, 0xD8, 0x9A, 0x06, 0x92, -+0x01, 0x6D, 0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, -+0x4D, 0xEE, 0x40, 0xEB, 0x05, 0x93, 0x16, 0x2B, -+0x04, 0x94, 0x0F, 0x24, 0x06, 0x94, 0x10, 0xF0, -+0x24, 0x6A, 0x14, 0xF5, 0x10, 0x4A, 0x4D, 0xE4, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x50, 0x9C, -+0x80, 0xAB, 0x01, 0x6D, 0x00, 0x6E, 0x40, 0xEA, -+0x7C, 0x10, 0x02, 0x6C, 0xB1, 0x67, 0x80, 0x18, -+0xFC, 0x0B, 0x77, 0x10, 0x05, 0x92, 0x02, 0x72, -+0x62, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, -+0xDC, 0x9A, 0x91, 0x67, 0x00, 0x6D, 0x00, 0x18, -+0x50, 0xE1, 0x56, 0x32, 0xFF, 0x6C, 0x8C, 0xEA, -+0x00, 0xF6, 0x8D, 0xA0, 0x00, 0xF3, 0x68, 0x41, -+0x64, 0x33, 0x80, 0x34, 0x8D, 0xEA, 0x0D, 0xE3, -+0x43, 0xCB, 0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, -+0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF1, -+0xD0, 0x9B, 0x01, 0x6D, 0x23, 0xF3, 0x18, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x04, 0x94, 0x10, 0x24, -+0x06, 0x94, 0x10, 0xF0, 0x24, 0x6A, 0x14, 0xF5, -+0x10, 0x4A, 0x4D, 0xE4, 0x30, 0xF0, 0x20, 0x6C, -+0xCE, 0xF4, 0x50, 0x9C, 0x80, 0xAB, 0x01, 0xF4, -+0x00, 0x6D, 0x00, 0x6E, 0x40, 0xEA, 0x2F, 0x10, -+0x03, 0x6C, 0xB1, 0x67, 0x80, 0x18, 0xFC, 0x0B, -+0x2A, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x14, 0xF5, -+0x10, 0x4A, 0x24, 0x33, 0x4D, 0xE3, 0x01, 0x6D, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, -+0x80, 0xAB, 0xC5, 0x67, 0x0D, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x14, 0xF5, 0x10, 0x4A, 0x24, 0x33, -+0x4D, 0xE3, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x80, 0xAB, 0x01, 0x6D, 0x00, 0x6E, -+0x40, 0xEA, 0x7D, 0x67, 0x87, 0x43, 0x09, 0x4C, -+0x30, 0xF0, 0x20, 0x6A, 0x43, 0xF7, 0x14, 0x49, -+0x60, 0xA4, 0x24, 0x31, 0xC0, 0xF1, 0x08, 0x4A, -+0x49, 0xE1, 0x6A, 0xC2, 0x0C, 0x10, 0x7D, 0x67, -+0x87, 0x43, 0x09, 0x4C, 0x30, 0xF0, 0x20, 0x6A, -+0x60, 0xA4, 0x24, 0x31, 0xC0, 0xF1, 0x08, 0x4A, -+0x49, 0xE1, 0xA7, 0xF6, 0x73, 0xC2, 0x04, 0x92, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x04, 0x94, 0xC2, 0x24, 0xCF, 0x17, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x69, 0x8C, 0xE9, 0x44, 0x41, 0x01, 0x68, -+0x04, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF2, -+0x58, 0x9A, 0x4D, 0xE8, 0x80, 0x18, 0xA8, 0x08, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x01, 0x6D, 0xD0, 0x67, 0x03, 0xF3, 0x00, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x01, 0x6D, 0xC1, 0x40, -+0xAB, 0xED, 0x03, 0xF3, 0x00, 0x6C, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x58, 0x9A, -+0x01, 0x6C, 0x40, 0xEA, 0x91, 0x67, 0x00, 0x6D, -+0x80, 0x18, 0x22, 0x0E, 0x02, 0x67, 0x30, 0xF0, -+0x21, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0x70, 0xF3, -+0xA4, 0x9B, 0xEE, 0xF3, 0x48, 0x9A, 0x38, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF0, -+0x18, 0x4C, 0x00, 0x6D, 0x80, 0x18, 0xFE, 0x11, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x45, 0xE1, 0x00, 0x6C, 0xA7, 0xF6, 0x06, 0xC1, -+0xE4, 0x67, 0xEF, 0x6D, 0x10, 0x6E, 0x00, 0x18, -+0x63, 0xE1, 0x50, 0x67, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0xFF, 0x6A, 0x4C, 0xEC, 0x4C, 0xED, 0x30, 0xF0, -+0x21, 0x6A, 0x50, 0xF3, 0x45, 0xA2, 0x04, 0xD4, -+0x06, 0xD5, 0x09, 0x72, 0x00, 0x68, 0x0C, 0x60, -+0x12, 0x72, 0x01, 0x68, 0x09, 0x60, 0x1B, 0x72, -+0x02, 0x68, 0x06, 0x60, 0x24, 0x68, 0x4E, 0xE8, -+0x01, 0x58, 0x18, 0x67, 0x04, 0x6A, 0x03, 0xE2, -+0x04, 0x92, 0x30, 0xF0, 0x20, 0x69, 0xCE, 0xF4, -+0x70, 0x99, 0x44, 0x36, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF2, 0x58, 0x9A, 0x01, 0x6D, 0x03, 0xF3, -+0x00, 0x6C, 0x4D, 0xEE, 0xAB, 0xED, 0x40, 0xEB, -+0x30, 0xF0, 0x21, 0x6B, 0x50, 0xF3, 0xC5, 0xA3, -+0xCE, 0xF4, 0x50, 0x99, 0x01, 0x6D, 0xC3, 0xF3, -+0x0C, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x06, 0x93, -+0x01, 0x73, 0x09, 0x61, 0x04, 0x92, 0x01, 0x69, -+0x04, 0x4A, 0x24, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF3, 0x44, 0x9A, 0x08, 0x10, 0x04, 0x92, -+0x01, 0x69, 0x04, 0x4A, 0x24, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF3, 0x48, 0x9A, 0x4D, 0xE9, -+0x80, 0x18, 0xA8, 0x08, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x01, 0x6D, 0xD1, 0x67, -+0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x01, 0x6D, 0xC1, 0x41, 0xAB, 0xED, 0x03, 0xF3, -+0x00, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x58, 0x9A, 0x02, 0x6C, 0x30, 0xF0, -+0x20, 0x69, 0x40, 0xEA, 0x04, 0x94, 0x01, 0x6D, -+0x2F, 0xF5, 0x18, 0x49, 0x80, 0x18, 0x22, 0x0E, -+0x05, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF3, -+0x48, 0x9A, 0x20, 0xF6, 0xAC, 0x99, 0x38, 0x6C, -+0x40, 0xEA, 0x06, 0x92, 0x02, 0x72, 0x80, 0xF0, -+0x02, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x04, 0x94, -+0x35, 0xF3, 0xDC, 0x9A, 0x00, 0x6D, 0x00, 0x18, -+0x50, 0xE1, 0xE3, 0xF7, 0x00, 0x6B, 0x4C, 0xEB, -+0x76, 0x32, 0x1F, 0x6B, 0x6C, 0xEA, 0x02, 0x5A, -+0x0D, 0x60, 0x00, 0xF6, 0x70, 0x99, 0x02, 0x23, -+0xFF, 0x4B, 0x15, 0x10, 0x03, 0x70, 0x01, 0x48, -+0x0A, 0x61, 0x01, 0x6B, 0x20, 0xF6, 0x66, 0xC1, -+0x03, 0x68, 0x13, 0x10, 0x0A, 0x5A, 0x00, 0x6C, -+0x11, 0x61, 0x04, 0x20, 0xFF, 0x48, 0xFF, 0x6B, -+0x6C, 0xE8, 0x0B, 0x10, 0x00, 0xF6, 0x70, 0x99, -+0x04, 0x73, 0x04, 0x60, 0x01, 0x4B, 0x00, 0xF6, -+0x70, 0xD9, 0x03, 0x10, 0x01, 0x6B, 0x20, 0xF6, -+0x66, 0xC1, 0x01, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0x34, 0xF5, 0x08, 0x4D, 0xB5, 0xE0, 0xA0, 0xA5, -+0x30, 0xF0, 0x20, 0x6B, 0x2F, 0xF5, 0x18, 0x4B, -+0x03, 0x70, 0x00, 0xF6, 0xAD, 0xC3, 0x0D, 0x61, -+0x01, 0x72, 0x0B, 0x61, 0x00, 0xF6, 0x50, 0x9B, -+0x08, 0x2A, 0x01, 0x6D, 0x20, 0xF6, 0xA7, 0xC3, -+0x20, 0xF6, 0xA6, 0xC3, 0x1B, 0x6D, 0x00, 0xF6, -+0xAD, 0xC3, 0x30, 0xF0, 0x20, 0x68, 0x2F, 0xF5, -+0x18, 0x48, 0x20, 0xF6, 0x46, 0xA0, 0x01, 0x72, -+0x2C, 0x60, 0x2B, 0x24, 0x04, 0x93, 0x30, 0xF0, -+0x20, 0x69, 0xCE, 0xF4, 0x50, 0x99, 0x64, 0x36, -+0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF2, 0x78, 0x9B, -+0x01, 0x6D, 0x03, 0xF3, 0x00, 0x6C, 0x6D, 0xEE, -+0xAB, 0xED, 0x40, 0xEA, 0xCE, 0xF4, 0x30, 0x99, -+0x01, 0x6D, 0xAB, 0xED, 0x04, 0xD1, 0x23, 0xF3, -+0x04, 0x69, 0x91, 0x67, 0x00, 0x18, 0x05, 0xE1, -+0x00, 0xF6, 0xD0, 0x98, 0x07, 0xF4, 0x01, 0x6B, -+0x6B, 0xEB, 0x4C, 0xEB, 0xC0, 0x36, 0x04, 0x92, -+0xC8, 0x36, 0x01, 0x6D, 0x6D, 0xEE, 0x91, 0x67, -+0xAB, 0xED, 0x40, 0xEA, 0x01, 0x6B, 0x05, 0xD3, -+0x02, 0x10, 0x00, 0x6A, 0x05, 0xD2, 0x05, 0x92, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x18, 0x4A, 0x04, 0xD2, 0x00, 0xF6, -+0x4C, 0xA2, 0x02, 0x68, 0xFF, 0x69, 0x4E, 0xE8, -+0x8C, 0xE9, 0x24, 0x20, 0x03, 0x5A, 0x03, 0x60, -+0x01, 0x72, 0x07, 0x60, 0x04, 0x10, 0x03, 0x72, -+0x37, 0x60, 0x04, 0x72, 0x50, 0x60, 0x01, 0x6A, -+0x76, 0x10, 0x91, 0x67, 0x80, 0x18, 0x86, 0x0A, -+0x91, 0x67, 0x01, 0x6D, 0x80, 0x18, 0xF4, 0x0E, -+0x65, 0x22, 0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF3, -+0x8C, 0x41, 0x84, 0x34, 0x2F, 0xF5, 0x18, 0x4B, -+0x71, 0xE4, 0xA8, 0xA4, 0x02, 0x5D, 0x03, 0x60, -+0x01, 0x4D, 0xA8, 0xC4, 0xED, 0x17, 0x65, 0xE1, -+0x00, 0x6C, 0x50, 0x10, 0x91, 0x67, 0x01, 0x6D, -+0x80, 0x18, 0x74, 0x0C, 0x04, 0x93, 0x20, 0xF6, -+0x06, 0xC3, 0x91, 0x67, 0x02, 0x6D, 0x80, 0x18, -+0xF4, 0x0E, 0x48, 0x22, 0x30, 0xF0, 0x20, 0x6B, -+0x24, 0x34, 0x2F, 0xF5, 0x18, 0x4B, 0x6D, 0xE4, -+0x20, 0xF6, 0x81, 0xA3, 0x0A, 0x5C, 0x3E, 0x60, -+0x01, 0x4C, 0x20, 0xF6, 0x81, 0xC3, 0xED, 0x17, -+0x91, 0x67, 0x80, 0x18, 0x86, 0x0A, 0x91, 0x67, -+0x01, 0x6D, 0x80, 0x18, 0x44, 0x0E, 0x32, 0x22, -+0x03, 0x6C, 0x98, 0xE9, 0x30, 0xF0, 0x20, 0x6B, -+0x2F, 0xF5, 0x18, 0x4B, 0x12, 0xEC, 0x71, 0xE4, -+0x00, 0xF6, 0xBB, 0xA4, 0x02, 0x5D, 0x04, 0x60, -+0x01, 0x4D, 0x00, 0xF6, 0xBB, 0xC4, 0xEB, 0x17, -+0x65, 0xE1, 0x01, 0x6C, 0x1B, 0x10, 0x91, 0x67, -+0x00, 0x6D, 0x80, 0x18, 0x74, 0x0C, 0x91, 0x67, -+0x02, 0x6D, 0x80, 0x18, 0x44, 0x0E, 0x16, 0x22, -+0x03, 0x6C, 0x98, 0xE9, 0x30, 0xF0, 0x20, 0x6B, -+0x2F, 0xF5, 0x18, 0x4B, 0x12, 0xEC, 0x71, 0xE4, -+0x00, 0xF6, 0xBC, 0xA4, 0x02, 0x5D, 0x04, 0x60, -+0x01, 0x4D, 0x00, 0xF6, 0xBC, 0xC4, 0xEB, 0x17, -+0x65, 0xE1, 0x02, 0x6C, 0x20, 0xF6, 0x84, 0xC1, -+0x05, 0x6C, 0x07, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0x2F, 0xF5, 0x18, 0x4B, 0x00, 0xF6, 0x8C, 0xA3, -+0x01, 0x4C, 0x00, 0xF6, 0x8C, 0xC3, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0xFF, 0x69, 0x87, 0xF6, 0xB4, 0xA0, 0x8C, 0xE9, -+0x10, 0xF0, 0x24, 0x6C, 0x36, 0xF0, 0x0C, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x87, 0xF6, 0x4D, 0xA0, -+0x02, 0x72, 0x02, 0x6A, 0x04, 0xD2, 0x02, 0x60, -+0x04, 0x6B, 0x04, 0xD3, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF0, 0xBC, 0xA2, 0x10, 0xF0, 0x24, 0x6C, -+0x36, 0xF0, 0x0C, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x87, 0xF6, 0x54, 0xA0, 0x02, 0x72, 0x10, 0x60, -+0x03, 0x72, 0x31, 0x60, 0x01, 0x72, 0x00, 0x68, -+0x4A, 0x61, 0xB0, 0x67, 0x00, 0x6C, 0x80, 0x18, -+0xA1, 0x0D, 0x01, 0x48, 0x00, 0x6C, 0x80, 0x18, -+0xCA, 0x0E, 0x08, 0x70, 0xF6, 0x61, 0x19, 0x10, -+0x00, 0x6C, 0x80, 0x18, 0xF5, 0x0A, 0x00, 0x6C, -+0xA4, 0x67, 0x80, 0x18, 0x44, 0x0E, 0x87, 0xF6, -+0x75, 0xA0, 0x01, 0x4B, 0x87, 0xF6, 0x75, 0xC0, -+0x0C, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, -+0x18, 0x4A, 0x00, 0xF6, 0x7A, 0xA2, 0x03, 0x5B, -+0x04, 0x60, 0x01, 0x4B, 0x00, 0xF6, 0x7A, 0xC2, -+0x26, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x87, 0xF6, 0x74, 0xA2, 0x01, 0x4B, -+0x87, 0xF6, 0x74, 0xC2, 0x1C, 0x10, 0x00, 0x6C, -+0x80, 0x18, 0x77, 0x0F, 0x30, 0xF0, 0x20, 0x6B, -+0x2F, 0xF5, 0x18, 0x4B, 0x00, 0xF6, 0x4C, 0xA3, -+0x05, 0x72, 0xF5, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x87, 0xF6, 0x94, 0xA2, -+0x01, 0x4C, 0x87, 0xF6, 0x94, 0xC2, 0x01, 0x6C, -+0x00, 0xF6, 0x8C, 0xC3, 0x87, 0xF6, 0x75, 0xA2, -+0x01, 0x4B, 0x87, 0xF6, 0x75, 0xC2, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x87, 0xF6, -+0x54, 0xA0, 0x04, 0x72, 0x6B, 0x61, 0xA7, 0xF6, -+0xA6, 0xA0, 0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF0, -+0x00, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0xA7, 0xF6, -+0xB2, 0xA0, 0x10, 0xF0, 0x24, 0x6C, 0x76, 0xF0, -+0x00, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0xA7, 0xF6, -+0xB3, 0xA0, 0x10, 0xF0, 0x24, 0x6C, 0x30, 0xF0, -+0x20, 0x68, 0x2F, 0xF5, 0x18, 0x48, 0x76, 0xF0, -+0x1C, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x00, 0xF6, -+0xBA, 0xA0, 0x10, 0xF0, 0x24, 0x6C, 0x96, 0xF0, -+0x18, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x00, 0xF6, -+0xBB, 0xA0, 0x00, 0xF6, 0xDC, 0xA0, 0x10, 0xF0, -+0x24, 0x6C, 0xB6, 0xF0, 0x18, 0x4C, 0x80, 0x18, -+0xFE, 0x11, 0x20, 0xF6, 0xA1, 0xA0, 0x20, 0xF6, -+0xC2, 0xA0, 0x10, 0xF0, 0x24, 0x6C, 0xF6, 0xF0, -+0x0C, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x30, 0xF0, -+0x20, 0x68, 0x10, 0xF0, 0x24, 0x6B, 0xF5, 0xF3, -+0xCC, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x69, -+0x2B, 0xE9, 0xB1, 0x67, 0x03, 0xF3, 0x00, 0x6C, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, -+0x23, 0xF3, 0x0C, 0x6C, 0x07, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, 0xC3, 0xF3, -+0x0C, 0x6C, 0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x35, 0xF1, 0x10, 0x4B, 0xCE, 0xF4, -+0x50, 0x98, 0xC0, 0x9B, 0xB1, 0x67, 0x23, 0xF3, -+0x18, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF1, 0x10, 0x4B, 0xCE, 0xF4, 0x50, 0x98, -+0xC0, 0x9B, 0x23, 0xF3, 0x1C, 0x6C, 0xB1, 0x67, -+0x40, 0xEA, 0x09, 0x10, 0x01, 0x71, 0x3F, 0xF7, -+0x13, 0x61, 0x87, 0xF6, 0x55, 0xA0, 0x04, 0x93, -+0x6E, 0xEA, 0x3F, 0xF7, 0x0D, 0x2A, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, 0x20, 0x68, -+0xF5, 0xF2, 0xD8, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0xFF, 0x69, 0x01, 0x6D, 0xAB, 0xED, 0x8C, 0xE9, -+0x03, 0xF3, 0x00, 0x6C, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0xA3, 0xF3, 0x18, 0x6C, -+0xAB, 0xED, 0x00, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x21, 0x6A, 0x70, 0xF3, 0x40, 0xA2, 0x11, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, 0x1C, 0x9A, -+0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x50, 0xE1, 0x2E, 0x6B, 0x6B, 0xEB, 0x4C, 0xEB, -+0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, 0x25, 0x6F, -+0x10, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, -+0x1C, 0x9A, 0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, -+0x00, 0x18, 0x50, 0xE1, 0x2E, 0x6B, 0x6B, 0xEB, -+0x4C, 0xEB, 0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, -+0x05, 0x6F, 0x6D, 0xEF, 0x00, 0x18, 0x63, 0xE1, -+0x91, 0x67, 0x80, 0x18, 0xC2, 0x0F, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xF2, 0x63, 0x1B, 0x62, 0x1A, 0xD1, 0x19, 0xD0, -+0x88, 0xA4, 0x02, 0x6A, 0x30, 0xF0, 0x20, 0x68, -+0x8C, 0xEA, 0x46, 0x32, 0x16, 0xD4, 0x17, 0xD2, -+0x80, 0x18, 0xE3, 0x09, 0x80, 0x18, 0xE1, 0x0B, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, 0xA0, 0x9A, -+0xA1, 0xF4, 0x18, 0x6C, 0x2F, 0xF5, 0x18, 0x48, -+0x00, 0x18, 0x05, 0xE1, 0x20, 0xF6, 0x48, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, 0x5C, 0x9A, -+0x38, 0x6C, 0x01, 0x69, 0x40, 0xEA, 0x16, 0x94, -+0x00, 0x6D, 0x20, 0xF6, 0x4C, 0xD8, 0x2C, 0xEC, -+0x00, 0x18, 0x5D, 0xD3, 0x16, 0xD2, 0x72, 0x2A, -+0x10, 0xF0, 0x24, 0x6C, 0x36, 0xF1, 0x00, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x28, 0xF1, 0x6C, 0xA2, -+0x9D, 0x67, 0x87, 0xF6, 0x34, 0xC2, 0x01, 0x4B, -+0x28, 0xF1, 0x6C, 0xC2, 0x67, 0x44, 0x51, 0x4B, -+0x80, 0xA3, 0x28, 0xF1, 0x2E, 0xC2, 0x00, 0xF6, -+0x2C, 0xC0, 0x87, 0xF6, 0x95, 0xC2, 0x00, 0x6C, -+0xA4, 0x67, 0x80, 0x18, 0xFC, 0x0B, 0x30, 0xF0, -+0x20, 0x6E, 0x30, 0xF0, 0x20, 0x6F, 0x04, 0x04, -+0x0A, 0x05, 0xCF, 0xF0, 0x00, 0x4E, 0xCF, 0xF0, -+0x08, 0x4F, 0x80, 0x18, 0x26, 0x0A, 0x30, 0xF0, -+0x20, 0x6D, 0x05, 0x04, 0xEF, 0xF0, 0x00, 0x4D, -+0x80, 0x18, 0x48, 0x0C, 0x80, 0x18, 0xEE, 0x08, -+0x01, 0x6C, 0x80, 0x18, 0x86, 0x0B, 0x00, 0x6C, -+0x80, 0x18, 0x1E, 0x09, 0x80, 0x18, 0xB4, 0x08, -+0x80, 0x18, 0x2A, 0x0D, 0x17, 0x94, 0x80, 0x18, -+0x40, 0x10, 0x00, 0x6C, 0x80, 0x18, 0x86, 0x0B, -+0x30, 0xF0, 0x20, 0x6E, 0x30, 0xF0, 0x20, 0x6F, -+0x04, 0x04, 0x0A, 0x05, 0xCF, 0xF0, 0x00, 0x4E, -+0xCF, 0xF0, 0x08, 0x4F, 0x80, 0x18, 0xD0, 0x08, -+0x30, 0xF0, 0x20, 0x6C, 0xEF, 0xF0, 0x00, 0x4C, -+0x05, 0x05, 0x80, 0x18, 0x09, 0x0D, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x87, 0xF6, -+0x74, 0xA2, 0x04, 0x73, 0x0A, 0x60, 0x00, 0x6B, -+0x87, 0xF6, 0x75, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x58, 0x9A, 0x32, 0x6C, 0x40, 0xEA, -+0xC9, 0x17, 0x17, 0x92, 0x04, 0x22, 0x00, 0x6C, -+0x01, 0x6D, 0x00, 0x18, 0xEC, 0xD2, 0x00, 0x6C, -+0x00, 0x18, 0xB7, 0xD2, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF3, 0xDC, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF3, 0xF0, 0x9A, 0x00, 0x6C, 0x08, 0x6D, -+0x00, 0x18, 0x63, 0xE1, 0x1B, 0x97, 0x1A, 0x91, -+0x19, 0x90, 0x00, 0x6A, 0x0E, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF3, 0x74, 0x9B, 0x54, 0x34, -+0x01, 0x4A, 0x71, 0xE4, 0xA0, 0xA4, 0xF8, 0x6B, -+0xAC, 0xEB, 0x60, 0xC4, 0xFF, 0x6B, 0x6C, 0xEA, -+0x80, 0x72, 0xF1, 0x61, 0x80, 0x18, 0xF2, 0x07, -+0x80, 0x18, 0xF8, 0x07, 0x80, 0x18, 0xD3, 0x1C, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0xD1, 0x08, 0xD0, 0x0A, 0xD4, -+0x44, 0x67, 0x82, 0x10, 0x25, 0x73, 0x04, 0x60, -+0x60, 0xA5, 0x60, 0xC2, 0x01, 0x4A, 0x7B, 0x10, -+0x61, 0x85, 0x62, 0x73, 0x7D, 0x67, 0x20, 0x61, -+0x62, 0x85, 0x78, 0x73, 0x03, 0x60, 0x58, 0x73, -+0x7D, 0x67, 0x1A, 0x61, 0x82, 0x85, 0x60, 0xA6, -+0x78, 0x6F, 0xEE, 0xEC, 0x10, 0xF0, 0x24, 0x6F, -+0x72, 0x30, 0x36, 0xF1, 0x14, 0x4F, 0xE1, 0xE0, -+0x00, 0xA0, 0x01, 0x5C, 0x98, 0x67, 0x94, 0x34, -+0x8D, 0xE8, 0x3D, 0x67, 0x00, 0xC1, 0x0F, 0x68, -+0x6C, 0xE8, 0xFD, 0xE0, 0x60, 0xA7, 0x02, 0x4D, -+0x8D, 0xEB, 0x61, 0xC1, 0x00, 0xF0, 0x02, 0x03, -+0x81, 0x85, 0x77, 0x74, 0x26, 0x61, 0x82, 0x85, -+0x78, 0x74, 0x02, 0x60, 0x58, 0x74, 0x21, 0x61, -+0x80, 0xAE, 0x06, 0xD3, 0x07, 0xD4, 0x82, 0x85, -+0x78, 0x74, 0xF8, 0x67, 0x01, 0x5F, 0x18, 0x67, -+0x14, 0x30, 0x18, 0x65, 0x0C, 0x6C, 0x07, 0x97, -+0x0F, 0x68, 0x10, 0xF0, 0x24, 0x69, 0xE7, 0xEC, -+0x0C, 0xEF, 0x36, 0xF1, 0x14, 0x49, 0x3D, 0xE7, -+0xE0, 0xA7, 0x06, 0x90, 0x38, 0x67, 0x2D, 0xEF, -+0xFC, 0x4C, 0xE0, 0xC0, 0x01, 0x48, 0xE4, 0x44, -+0x06, 0xD0, 0xED, 0x2F, 0x04, 0x4B, 0x02, 0x4D, -+0x25, 0x10, 0x81, 0x85, 0x78, 0x74, 0x02, 0x60, -+0x58, 0x74, 0x20, 0x61, 0x81, 0x85, 0x20, 0x9E, -+0x06, 0xD3, 0x78, 0x74, 0x98, 0x67, 0x01, 0x5C, -+0xF8, 0x67, 0xF4, 0x37, 0x07, 0xD1, 0x1F, 0x65, -+0x1C, 0x6C, 0x07, 0x97, 0x0F, 0x68, 0x10, 0xF0, -+0x24, 0x69, 0xE6, 0xEC, 0x0C, 0xEF, 0x36, 0xF1, -+0x14, 0x49, 0x3D, 0xE7, 0xE0, 0xA7, 0x06, 0x91, -+0x18, 0x67, 0x0D, 0xEF, 0xFC, 0x4C, 0xE0, 0xC1, -+0x01, 0x49, 0xE4, 0x44, 0x06, 0xD1, 0xED, 0x2F, -+0x08, 0x4B, 0x01, 0x4D, 0x9D, 0x67, 0x04, 0x10, -+0xE0, 0xA4, 0x01, 0x4C, 0xE0, 0xC2, 0x01, 0x4A, -+0x63, 0xEC, 0xFA, 0x61, 0x04, 0x4E, 0x01, 0x4D, -+0x60, 0x85, 0x7F, 0xF7, 0x1B, 0x2B, 0x0A, 0x94, -+0x01, 0x24, 0x60, 0xC2, 0x0A, 0x97, 0x09, 0x91, -+0x08, 0x90, 0xEB, 0xE2, 0x05, 0x63, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0x01, 0x6B, 0x2F, 0xF5, -+0x18, 0x4A, 0x6B, 0xEB, 0x00, 0xF6, 0x64, 0xC2, -+0x00, 0xF6, 0x65, 0xC2, 0x00, 0xF6, 0x66, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD0, 0x60, 0xA4, 0x41, 0xA4, 0x82, 0xA4, -+0x00, 0xF0, 0x12, 0x06, 0x00, 0xF0, 0x1E, 0x07, -+0x00, 0x6D, 0xA0, 0xC6, 0x01, 0x4E, 0xA6, 0x67, -+0xEE, 0xED, 0xFA, 0x2D, 0x01, 0x6E, 0xE4, 0x67, -+0xCC, 0xEF, 0x1D, 0x27, 0x81, 0x5B, 0x1B, 0x61, -+0x81, 0x5A, 0x19, 0x61, 0x5D, 0x67, 0xD2, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x87, 0xF1, 0x68, 0x9A, 0x9D, 0x67, 0xDD, 0x67, -+0x73, 0xC4, 0x62, 0x34, 0x00, 0xF6, 0x62, 0x33, -+0x76, 0xC6, 0x0D, 0x6B, 0x94, 0xC6, 0x70, 0xC6, -+0x82, 0x34, 0x05, 0x6B, 0x95, 0xC6, 0x6F, 0xCE, -+0x87, 0xF1, 0xA8, 0xDA, 0xA0, 0x10, 0x02, 0x6E, -+0xA4, 0x67, 0xCC, 0xED, 0x44, 0x25, 0xFD, 0x67, -+0x81, 0x5B, 0xD2, 0xC7, 0x18, 0x60, 0x43, 0xF5, -+0xA4, 0x43, 0x30, 0xF0, 0x20, 0x6C, 0xC3, 0xF4, -+0x04, 0x4B, 0xC0, 0xF1, 0x08, 0x4C, 0x64, 0x33, -+0xA4, 0x35, 0x95, 0xE5, 0x91, 0xE3, 0x62, 0xAC, -+0xC2, 0xAD, 0x75, 0xC7, 0x62, 0x33, 0xD3, 0xC7, -+0x76, 0xC7, 0xC2, 0x36, 0x00, 0x6B, 0x62, 0xCD, -+0xD4, 0xC7, 0x62, 0xCC, 0x04, 0x10, 0x16, 0x6B, -+0x6B, 0xEB, 0x1D, 0x67, 0x73, 0xC0, 0x81, 0x5A, -+0x19, 0x60, 0x43, 0xF5, 0x84, 0x42, 0x30, 0xF0, -+0x20, 0x6B, 0xC3, 0xF4, 0x04, 0x4A, 0xC0, 0xF1, -+0x08, 0x4B, 0x44, 0x32, 0x84, 0x34, 0x71, 0xE4, -+0x6D, 0xE2, 0x42, 0xAB, 0xA2, 0xAC, 0xDD, 0x67, -+0x59, 0xC6, 0x42, 0x32, 0xB7, 0xC6, 0x5A, 0xC6, -+0xA2, 0x35, 0x00, 0x6A, 0x42, 0xCC, 0xB8, 0xC6, -+0x42, 0xCB, 0x04, 0x10, 0x16, 0x6A, 0x4B, 0xEA, -+0xFD, 0x67, 0x57, 0xC7, 0x0D, 0x6A, 0x1D, 0x67, -+0x50, 0xC0, 0x09, 0x6A, 0x52, 0x10, 0x53, 0x2C, -+0x81, 0x5B, 0x22, 0x60, 0xBD, 0x67, 0x72, 0xC5, -+0xC3, 0xF3, 0xC4, 0x43, 0x30, 0xF0, 0x20, 0x6D, -+0xC0, 0xF1, 0x08, 0x4D, 0xC4, 0x36, 0xB9, 0xE6, -+0xE0, 0xAE, 0x1D, 0x67, 0xF3, 0xC0, 0xE2, 0x37, -+0xF4, 0xC0, 0x43, 0xF4, 0xE4, 0x43, 0xE4, 0x37, -+0xB5, 0xE7, 0xE0, 0xAD, 0x74, 0x33, 0xF5, 0xC0, -+0xE2, 0x37, 0xF6, 0xC0, 0x10, 0xF0, 0x24, 0x6F, -+0xF5, 0xF3, 0xF8, 0x9F, 0xED, 0xE3, 0x60, 0xA3, -+0x80, 0xCE, 0x80, 0xCD, 0x77, 0xC0, 0x02, 0x10, -+0x9D, 0x67, 0x72, 0xC4, 0x81, 0x5A, 0x23, 0x60, -+0xC3, 0xF3, 0x84, 0x42, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x84, 0x34, 0x71, 0xE4, -+0xBD, 0x67, 0x58, 0xC5, 0xA0, 0xAC, 0xDD, 0x67, -+0xB9, 0xC6, 0xA2, 0x35, 0xBA, 0xC6, 0x43, 0xF4, -+0xA4, 0x42, 0xA4, 0x35, 0x6D, 0xE5, 0xA0, 0xAB, -+0x54, 0x32, 0xBB, 0xC6, 0xA2, 0x35, 0xBC, 0xC6, -+0x10, 0xF0, 0x24, 0x6D, 0xF5, 0xF3, 0xB8, 0x9D, -+0xA9, 0xE2, 0x40, 0xA2, 0x5D, 0xC6, 0x00, 0x6A, -+0x40, 0xCC, 0x40, 0xCB, 0x02, 0x10, 0xFD, 0x67, -+0x58, 0xC7, 0x04, 0x6A, 0x1D, 0x67, 0x50, 0xC0, -+0x0C, 0x6A, 0x4F, 0xC8, 0x04, 0x10, 0x7D, 0x67, -+0x04, 0x6A, 0x50, 0xC3, 0xAF, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, -+0x40, 0xEA, 0x09, 0x97, 0x08, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x60, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC5, 0xF6, 0x71, 0xC2, 0x61, 0xA4, -+0x65, 0xF4, 0x6A, 0xC2, 0x62, 0xA4, 0xC5, 0xF6, -+0x70, 0xC2, 0xA3, 0xA4, 0x0F, 0x6B, 0xAC, 0xEB, -+0xC5, 0xF6, 0x74, 0xC2, 0x63, 0xA4, 0x72, 0x33, -+0xC5, 0xF6, 0x75, 0xC2, 0x80, 0x18, 0xBA, 0x21, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x68, 0xA4, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC5, 0xF6, -+0x71, 0xC2, 0x69, 0xA4, 0x65, 0xF4, 0x6A, 0xC2, -+0x6A, 0xA4, 0xC5, 0xF6, 0x70, 0xC2, 0xAB, 0xA4, -+0x0F, 0x6B, 0xAC, 0xEB, 0xC5, 0xF6, 0x74, 0xC2, -+0x6B, 0xA4, 0x72, 0x33, 0xC5, 0xF6, 0x75, 0xC2, -+0x80, 0x18, 0xBA, 0x21, 0x05, 0x97, 0x00, 0x6A, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x0F, 0x72, 0x08, 0x60, -+0x11, 0x72, 0x0A, 0x60, 0x0E, 0x72, 0x0C, 0x61, -+0x85, 0x67, 0x80, 0x18, 0x66, 0x10, 0x14, 0x10, -+0x85, 0x67, 0x80, 0x18, 0x5F, 0x09, 0x10, 0x10, -+0x85, 0x67, 0x80, 0x18, 0x9A, 0x11, 0x0C, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF1, 0x7C, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x95, 0xF1, 0x84, 0x9C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0xFF, 0x6A, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF8, 0x63, 0x0F, 0x62, 0x0E, 0xD1, 0x0D, 0xD0, -+0x00, 0x6A, 0x10, 0xD4, 0x01, 0x68, 0x62, 0x67, -+0xA0, 0xA4, 0x0E, 0x25, 0xFF, 0x6D, 0x01, 0x4B, -+0xAC, 0xEB, 0x01, 0x4A, 0x0B, 0x73, 0xAC, 0xEA, -+0x03, 0x61, 0x01, 0x48, 0xAC, 0xE8, 0x00, 0x6B, -+0x37, 0x72, 0x01, 0x4C, 0xF1, 0x61, 0x37, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0xE5, 0xF2, 0x97, 0xA3, 0x0F, 0x5C, 0x01, 0x4C, -+0x01, 0x61, 0x00, 0x6C, 0xE5, 0xF2, 0x97, 0xC3, -+0x30, 0xF0, 0x20, 0x6B, 0xA5, 0xF4, 0x7F, 0xA3, -+0x0B, 0x6D, 0x2F, 0x40, 0x70, 0x33, 0x0A, 0xD3, -+0x0A, 0x94, 0xFF, 0x6B, 0x6C, 0xE9, 0x6C, 0xEC, -+0x0A, 0xD4, 0x01, 0x6C, 0x13, 0xE4, 0xB8, 0xEC, -+0x12, 0xEC, 0x91, 0xE2, 0x6C, 0xEC, 0x09, 0xD4, -+0x00, 0x6A, 0x01, 0x4C, 0x0B, 0xD4, 0x08, 0xD2, -+0x3C, 0x10, 0x08, 0x94, 0x0B, 0x6B, 0x0A, 0x95, -+0x78, 0xEC, 0x9D, 0x67, 0x12, 0xEB, 0x4C, 0xEB, -+0x0F, 0x6A, 0x2C, 0xEA, 0xAD, 0xEA, 0x08, 0x95, -+0x52, 0xC4, 0x4F, 0x40, 0xAE, 0xEA, 0x07, 0x22, -+0x10, 0x92, 0x00, 0xF0, 0x1E, 0x04, 0x6D, 0xE2, -+0x00, 0xF0, 0x13, 0x02, 0x0F, 0x10, 0x10, 0x94, -+0x09, 0x95, 0x00, 0xF0, 0x13, 0x02, 0x6D, 0xE4, -+0xB1, 0xE2, 0x04, 0x10, 0xA0, 0xA3, 0x01, 0x4B, -+0xA0, 0xC2, 0x01, 0x4A, 0x8A, 0xEA, 0xFA, 0x61, -+0x0B, 0x92, 0x07, 0x10, 0xA0, 0xA3, 0x01, 0x4B, -+0xA0, 0xC2, 0x01, 0x4A, 0x8A, 0xEA, 0xFA, 0x61, -+0x0C, 0x6A, 0x9D, 0x67, 0x00, 0x6B, 0x4F, 0xCC, -+0x70, 0xC4, 0x05, 0x95, 0x04, 0x94, 0x06, 0x96, -+0x07, 0x97, 0xFF, 0x49, 0x80, 0x18, 0x6D, 0x08, -+0x08, 0x95, 0xFF, 0x6A, 0x4C, 0xE9, 0x01, 0x4D, -+0x08, 0xD5, 0x08, 0x93, 0xFF, 0x6A, 0x4C, 0xEB, -+0x03, 0xEB, 0xBF, 0x61, 0x0F, 0x97, 0x0E, 0x91, -+0x0D, 0x90, 0x08, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0xC5, 0xF4, 0x40, 0xAA, 0x07, 0xD5, -+0x08, 0xD6, 0x01, 0x72, 0x09, 0xD7, 0x06, 0xD4, -+0x0C, 0x61, 0x30, 0xF0, 0x21, 0x68, 0x06, 0x95, -+0x90, 0xF3, 0x08, 0x48, 0x90, 0x67, 0x07, 0x06, -+0x80, 0x18, 0xCC, 0x10, 0x90, 0x67, 0x80, 0x18, -+0xBC, 0x11, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x60, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xE5, 0xF2, 0x73, 0xC2, 0xA1, 0xA4, -+0x03, 0x73, 0xE5, 0xF2, 0xB4, 0xC2, 0x1C, 0x61, -+0x62, 0xA4, 0xE5, 0xF2, 0x70, 0xC2, 0x63, 0xA4, -+0xE5, 0xF2, 0x71, 0xC2, 0x64, 0xA4, 0x65, 0xF4, -+0x80, 0x9A, 0xE5, 0xF2, 0x72, 0xC2, 0x04, 0xF0, -+0x00, 0x6B, 0x8C, 0xEB, 0x29, 0x23, 0xE5, 0xF2, -+0xB0, 0xA2, 0xE5, 0xF2, 0xD1, 0xA2, 0xE5, 0xF2, -+0xF2, 0xA2, 0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF1, -+0x08, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x1C, 0x10, -+0x02, 0x73, 0x1A, 0x61, 0x62, 0xA4, 0xE5, 0xF2, -+0x70, 0xC2, 0x63, 0xA4, 0x65, 0xF4, 0x80, 0x9A, -+0xE5, 0xF2, 0x71, 0xC2, 0x01, 0x6B, 0x6B, 0xEB, -+0xE5, 0xF2, 0x72, 0xC2, 0x04, 0xF0, 0x00, 0x6B, -+0x8C, 0xEB, 0x0A, 0x23, 0xE5, 0xF2, 0xB0, 0xA2, -+0xE5, 0xF2, 0xD1, 0xA2, 0x10, 0xF0, 0x24, 0x6C, -+0x76, 0xF1, 0x18, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x30, 0xF0, 0x20, 0x6A, 0x05, 0x97, 0xC0, 0xF1, -+0x08, 0x4A, 0x01, 0x6B, 0xE5, 0xF2, 0x76, 0xC2, -+0x00, 0x6B, 0xE5, 0xF2, 0x75, 0xC2, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF3, 0x63, 0x19, 0x62, -+0x18, 0xD1, 0x17, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, -+0x14, 0xD2, 0x40, 0xF0, 0x06, 0x03, 0x20, 0xF0, -+0x1A, 0x02, 0x00, 0x6C, 0x80, 0xC2, 0x01, 0x4A, -+0x6A, 0xEA, 0xFB, 0x61, 0x30, 0xF0, 0x21, 0x6B, -+0x30, 0xF3, 0x1C, 0x4B, 0x00, 0x68, 0x12, 0xD3, -+0x13, 0xD0, 0x65, 0x10, 0x12, 0x93, 0x20, 0xA3, -+0xFF, 0x71, 0x0A, 0x61, 0x7D, 0x67, 0x09, 0xE3, -+0x01, 0x6B, 0x6B, 0xEB, 0x20, 0xF0, 0x7A, 0xC2, -+0x01, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0x5B, 0x10, -+0x52, 0x6A, 0x58, 0xE9, 0x30, 0xF0, 0x20, 0x6B, -+0x0E, 0x04, 0x11, 0xE4, 0x60, 0xF2, 0x08, 0x4B, -+0x22, 0xC4, 0x03, 0x6D, 0x04, 0x48, 0x12, 0xEA, -+0x49, 0xE3, 0x76, 0xAA, 0x63, 0xC4, 0x63, 0xA2, -+0x64, 0xC4, 0x20, 0xF0, 0x65, 0xA2, 0x6A, 0x33, -+0xAC, 0xEB, 0x30, 0xF0, 0x20, 0x6D, 0x25, 0xF6, -+0xA8, 0x9D, 0x65, 0xC4, 0xFF, 0x6C, 0x8C, 0xE8, -+0x07, 0xF7, 0x01, 0x4C, 0xAC, 0xEC, 0x0A, 0x24, -+0xD6, 0xAA, 0xE3, 0xA2, 0x10, 0xF0, 0x24, 0x6C, -+0x96, 0xF1, 0x1C, 0x4C, 0xB1, 0x67, 0x04, 0xD3, -+0x80, 0x18, 0xFE, 0x11, 0x14, 0x93, 0x02, 0x6A, -+0x4E, 0xEB, 0x21, 0x2B, 0x30, 0xF0, 0x20, 0x6A, -+0x2C, 0x34, 0x2F, 0xF7, 0x1C, 0x4A, 0x89, 0xE2, -+0xA3, 0xAA, 0x0E, 0x04, 0x11, 0xE4, 0xA2, 0xC4, -+0xA3, 0xAA, 0x02, 0x48, 0xA2, 0x35, 0xA3, 0xC4, -+0x63, 0xCA, 0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, -+0x68, 0x9B, 0xFF, 0x6A, 0x4C, 0xE8, 0x07, 0xF7, -+0x01, 0x4A, 0x6C, 0xEA, 0x08, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF1, 0x00, 0x4C, 0xB1, 0x67, -+0x00, 0x6E, 0x80, 0x18, 0xFE, 0x11, 0x13, 0x93, -+0xFF, 0x6A, 0x01, 0x4B, 0x4C, 0xEB, 0x12, 0x92, -+0x13, 0xD3, 0x01, 0x4A, 0x12, 0xD2, 0x13, 0x93, -+0x14, 0x92, 0x43, 0xEB, 0x97, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, 0x08, 0xF0, -+0x00, 0x6A, 0x6C, 0xEA, 0x28, 0x22, 0x7D, 0x67, -+0x20, 0xF0, 0x5D, 0xA3, 0x20, 0xF0, 0xBA, 0xA3, -+0x20, 0xF0, 0xDB, 0xA3, 0x20, 0xF0, 0xFC, 0xA3, -+0x04, 0xD2, 0x20, 0xF0, 0x5E, 0xA3, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF1, 0x18, 0x4C, 0x05, 0xD2, -+0x20, 0xF0, 0x5F, 0xA3, 0x06, 0xD2, 0x40, 0xF0, -+0x40, 0xA3, 0x07, 0xD2, 0x40, 0xF0, 0x41, 0xA3, -+0x08, 0xD2, 0x40, 0xF0, 0x42, 0xA3, 0x09, 0xD2, -+0x40, 0xF0, 0x43, 0xA3, 0x0A, 0xD2, 0x40, 0xF0, -+0x44, 0xA3, 0x0B, 0xD2, 0x40, 0xF0, 0x45, 0xA3, -+0x0C, 0xD2, 0x80, 0x18, 0xFE, 0x11, 0x7D, 0x67, -+0x2C, 0x6A, 0x40, 0xF0, 0x06, 0xCB, 0x20, 0xF0, -+0x58, 0xC3, 0x11, 0x97, 0x0E, 0x94, 0x0F, 0x95, -+0x10, 0x96, 0x80, 0x18, 0x6D, 0x08, 0x19, 0x97, -+0x18, 0x91, 0x17, 0x90, 0x0D, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x43, 0xA4, 0x62, 0xA4, 0xC0, 0xA4, 0x40, 0x32, -+0x40, 0x32, 0x60, 0x33, 0x4D, 0xE3, 0x41, 0xA4, -+0x0F, 0x6D, 0xCC, 0xED, 0x4D, 0xE3, 0x44, 0xA4, -+0xD2, 0x36, 0x01, 0x5E, 0x00, 0xF6, 0x40, 0x32, -+0x49, 0xE3, 0x08, 0xD2, 0xB4, 0x32, 0x06, 0xD2, -+0x06, 0x93, 0xFF, 0x6A, 0x4C, 0xEB, 0x06, 0xD3, -+0x03, 0x6A, 0x78, 0x67, 0x6F, 0xE2, 0x07, 0xD3, -+0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, -+0xE7, 0xF7, 0x1D, 0x4A, 0x6C, 0xEA, 0x07, 0x22, -+0x08, 0x97, 0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF2, -+0x14, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x80, 0x18, -+0x16, 0x11, 0x00, 0x68, 0x06, 0x91, 0x4A, 0x10, -+0x08, 0x93, 0x01, 0x6A, 0x44, 0xE9, 0x6C, 0xEA, -+0x1A, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, -+0x18, 0x4A, 0x30, 0xF0, 0x20, 0x6B, 0x49, 0xE0, -+0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF6, 0x24, 0xC2, -+0x01, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0x07, 0xF7, -+0x01, 0x4A, 0x6C, 0xEA, 0x08, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x36, 0xF2, 0x1C, 0x4C, 0xB0, 0x67, -+0xD1, 0x67, 0x80, 0x18, 0xFE, 0x11, 0x07, 0x92, -+0x4A, 0xE8, 0x04, 0x60, 0x06, 0x92, 0x1F, 0x4A, -+0x2E, 0xEA, 0x21, 0x2A, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x08, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x12, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x18, 0x4A, 0x00, 0xF6, 0xC4, 0xA2, -+0x00, 0xF6, 0xE5, 0xA2, 0x00, 0xF6, 0x46, 0xA2, -+0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF2, 0x1C, 0x4C, -+0xB0, 0x67, 0x04, 0xD2, 0x80, 0x18, 0xFE, 0x11, -+0x0D, 0x20, 0x07, 0x94, 0x00, 0x68, 0x80, 0x18, -+0x37, 0x12, 0x80, 0x18, 0x16, 0x11, 0x01, 0x49, -+0xFF, 0x6A, 0x4C, 0xE9, 0x06, 0x92, 0x20, 0x4A, -+0x42, 0xE9, 0xB2, 0x61, 0x0D, 0x97, 0x0C, 0x91, -+0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF6, 0x63, 0x13, 0x62, 0x12, 0xD1, 0x11, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xFF, 0x6A, 0x8C, 0xEA, -+0x74, 0xF5, 0x94, 0x9B, 0x74, 0xF5, 0x14, 0x4B, -+0x08, 0x72, 0x04, 0xD4, 0x81, 0x9B, 0x68, 0xA3, -+0x05, 0xD4, 0x9D, 0x67, 0x78, 0xC4, 0x10, 0xF0, -+0x24, 0x6B, 0x74, 0xF5, 0x88, 0x9B, 0x74, 0xF5, -+0x08, 0x4B, 0x07, 0xD4, 0x81, 0x9B, 0x68, 0xA3, -+0x08, 0xD4, 0x9D, 0x67, 0x20, 0xF0, 0x64, 0xC4, -+0x37, 0x61, 0x20, 0xF0, 0x05, 0x02, 0x07, 0x00, -+0x04, 0x01, 0x0E, 0xD2, 0x40, 0xA0, 0x0B, 0x5A, -+0x01, 0x61, 0x0A, 0x6A, 0xFF, 0x6B, 0x4C, 0xEB, -+0x9D, 0x67, 0x42, 0x43, 0x5B, 0xCC, 0x0E, 0x6A, -+0x20, 0xF0, 0x48, 0xC4, 0x08, 0x6A, 0x20, 0xF0, -+0x4A, 0xC4, 0x40, 0xA1, 0x20, 0xF0, 0x4B, 0xC4, -+0x00, 0x6A, 0x0E, 0x10, 0x9D, 0x67, 0x55, 0xE4, -+0xC0, 0xA1, 0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, -+0x08, 0x4C, 0x91, 0xE2, 0xD1, 0xE4, 0x45, 0xF2, -+0x88, 0xA4, 0x01, 0x4A, 0x20, 0xF0, 0x8C, 0xC5, -+0xFF, 0x6C, 0x4C, 0xEC, 0x63, 0xEC, 0xEE, 0x61, -+0x0A, 0x94, 0x0B, 0x95, 0x0C, 0x96, 0x0D, 0x97, -+0x01, 0x48, 0x01, 0x49, 0x80, 0x18, 0x6D, 0x08, -+0x0E, 0x92, 0x4A, 0xE8, 0xCF, 0x61, 0x38, 0x10, -+0x09, 0x72, 0x36, 0x61, 0x20, 0xF0, 0x05, 0x04, -+0x07, 0x00, 0x04, 0x01, 0x0F, 0xD4, 0x40, 0xA0, -+0x0B, 0x5A, 0x01, 0x61, 0x0A, 0x6A, 0xFF, 0x6B, -+0x4C, 0xEB, 0x9D, 0x67, 0x42, 0x43, 0x5B, 0xCC, -+0x0E, 0x6A, 0x20, 0xF0, 0x48, 0xC4, 0x09, 0x6A, -+0x20, 0xF0, 0x4A, 0xC4, 0x40, 0xA1, 0x20, 0xF0, -+0x4B, 0xC4, 0x00, 0x6A, 0x0E, 0x10, 0x9D, 0x67, -+0x55, 0xE4, 0xC0, 0xA1, 0x30, 0xF0, 0x20, 0x6C, -+0xC0, 0xF1, 0x08, 0x4C, 0x91, 0xE2, 0xD1, 0xE4, -+0x85, 0xF2, 0x9C, 0xA4, 0x01, 0x4A, 0x20, 0xF0, -+0x8C, 0xC5, 0xFF, 0x6C, 0x4C, 0xEC, 0x63, 0xEC, -+0xEE, 0x61, 0x0A, 0x94, 0x0B, 0x95, 0x0C, 0x96, -+0x0D, 0x97, 0x01, 0x48, 0x01, 0x49, 0x80, 0x18, -+0x6D, 0x08, 0x0F, 0x92, 0x4A, 0xE8, 0xCF, 0x61, -+0x13, 0x97, 0x12, 0x91, 0x11, 0x90, 0x0A, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x44, 0x67, 0x65, 0xA2, -+0x02, 0x6D, 0x81, 0xA4, 0xAC, 0xEB, 0x03, 0x23, -+0x80, 0x18, 0xDC, 0x12, 0x34, 0x10, 0x04, 0xA2, -+0x22, 0xA2, 0x43, 0xA2, 0x10, 0x30, 0x08, 0x74, -+0x4D, 0xE8, 0x0E, 0x61, 0x10, 0xF0, 0x24, 0x6C, -+0x96, 0xF2, 0x04, 0x4C, 0x80, 0x18, 0xBC, 0x11, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x45, 0xE1, 0x45, 0xF2, 0x08, 0xC1, 0x1F, 0x10, -+0x09, 0x74, 0x0E, 0x61, 0x10, 0xF0, 0x24, 0x6C, -+0xB6, 0xF2, 0x04, 0x4C, 0x80, 0x18, 0xBC, 0x11, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x45, 0xE1, 0x85, 0xF2, 0x1C, 0xC1, 0x0F, 0x10, -+0x0A, 0x74, 0x0D, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF3, 0xFC, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0xB6, 0xF2, 0x14, 0x4C, 0xF9, 0x6D, 0x28, 0xF3, -+0x01, 0x6E, 0x80, 0x18, 0xFE, 0x11, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x52, 0x6B, 0x78, 0xEC, 0x30, 0xF0, 0x20, 0x6E, -+0x60, 0xF2, 0x08, 0x4E, 0xAC, 0xEA, 0x05, 0x6D, -+0x12, 0xEB, 0x6D, 0xE6, 0xDD, 0x67, 0xAF, 0xCE, -+0x0F, 0x6D, 0xB0, 0xC6, 0x92, 0xC6, 0x53, 0xC6, -+0x20, 0xF0, 0x5D, 0xA3, 0x07, 0x97, 0x04, 0x94, -+0x54, 0xC6, 0x20, 0xF0, 0x5E, 0xA3, 0x55, 0xC6, -+0x20, 0xF0, 0x5F, 0xA3, 0x56, 0xC6, 0x05, 0x95, -+0x06, 0x96, 0x80, 0x18, 0x6D, 0x08, 0x09, 0x97, -+0x05, 0x63, 0x00, 0xEF, 0xF8, 0x63, 0x0F, 0x62, -+0x0E, 0xD1, 0x0D, 0xD0, 0x14, 0x92, 0x15, 0x93, -+0x16, 0x90, 0x0A, 0xD2, 0xFF, 0x6A, 0x1A, 0x65, -+0xAC, 0xEA, 0x08, 0xD2, 0x58, 0x67, 0xCC, 0xEA, -+0x17, 0x91, 0x1A, 0x65, 0x0A, 0x92, 0xFF, 0xF7, -+0x1F, 0x6D, 0xAC, 0xEF, 0xAC, 0xEA, 0xAC, 0xEB, -+0xAC, 0xE8, 0xAC, 0xE9, 0x30, 0xF0, 0x20, 0x6D, -+0xC0, 0xF1, 0x08, 0x4D, 0x65, 0xF4, 0xC0, 0x9D, -+0x0A, 0xD2, 0x8C, 0xEE, 0x30, 0x26, 0x65, 0xF4, -+0x84, 0x9D, 0x05, 0x6A, 0x4E, 0xEC, 0x2B, 0x2C, -+0xE5, 0xF2, 0x98, 0xAD, 0x01, 0x6A, 0x4E, 0xEC, -+0x26, 0x2C, 0x9D, 0x67, 0x47, 0x44, 0x19, 0x4A, -+0x40, 0xA2, 0xF4, 0xC4, 0xE2, 0x37, 0x52, 0xC4, -+0x58, 0x67, 0x53, 0xC4, 0x47, 0x44, 0x21, 0x4A, -+0x40, 0xA2, 0xF5, 0xC4, 0x56, 0xC4, 0x0A, 0x94, -+0x82, 0x32, 0x9D, 0x67, 0x57, 0xC4, 0x02, 0x6A, -+0x4B, 0xEA, 0x78, 0xC4, 0x1A, 0xC4, 0x3C, 0xC4, -+0x50, 0xC4, 0x62, 0x33, 0x02, 0x30, 0x22, 0x31, -+0x0C, 0x6A, 0x79, 0xC4, 0x1B, 0xC4, 0x3D, 0xC4, -+0x4F, 0xCC, 0x05, 0x95, 0x04, 0x94, 0x06, 0x96, -+0x07, 0x97, 0x80, 0x18, 0x6D, 0x08, 0x0F, 0x97, -+0x0E, 0x91, 0x0D, 0x90, 0x08, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x20, 0xA4, 0x52, 0x68, 0x30, 0xF0, 0x20, 0x6A, -+0x18, 0xE9, 0x60, 0xF2, 0x08, 0x4A, 0x21, 0x6B, -+0x20, 0x6E, 0x6B, 0xEB, 0x12, 0xE8, 0x01, 0xE2, -+0x20, 0xF0, 0x52, 0xA0, 0x04, 0xD2, 0x42, 0xA4, -+0x20, 0xF0, 0xF5, 0xA0, 0x20, 0xF0, 0x52, 0xC0, -+0xA3, 0xA4, 0xEC, 0xEB, 0x01, 0x6A, 0xCC, 0xED, -+0xAD, 0xEB, 0x20, 0xF0, 0x75, 0xC0, 0xA3, 0xA4, -+0xAC, 0xEA, 0x02, 0x6D, 0xAB, 0xED, 0x6C, 0xED, -+0x4D, 0xED, 0x20, 0xF0, 0xB5, 0xC0, 0x43, 0xA4, -+0x02, 0x6B, 0x6C, 0xEA, 0xFB, 0x4B, 0xAC, 0xEB, -+0x4D, 0xEB, 0x20, 0xF0, 0x75, 0xC0, 0xA3, 0xA4, -+0x40, 0x6A, 0x4C, 0xED, 0x80, 0x4A, 0xFF, 0x4A, -+0x6C, 0xEA, 0xAD, 0xEA, 0x20, 0xF0, 0x55, 0xC0, -+0x64, 0xA4, 0xCC, 0xEA, 0x40, 0xF0, 0x60, 0xC0, -+0x0F, 0x22, 0x91, 0x67, 0x80, 0x18, 0xF4, 0x1C, -+0x20, 0xF0, 0xC5, 0xA0, 0x03, 0x6A, 0x20, 0xF0, -+0xB2, 0xA0, 0xCA, 0x36, 0x4C, 0xEE, 0xFF, 0x6A, -+0x91, 0x67, 0x4C, 0xEE, 0x80, 0x18, 0x3E, 0x1C, -+0x20, 0xF0, 0xF5, 0xA0, 0x20, 0xF0, 0xD2, 0xA0, -+0x04, 0x95, 0x01, 0x6A, 0xF6, 0x37, 0x91, 0x67, -+0x4C, 0xEF, 0x80, 0x18, 0x9F, 0x16, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x03, 0xA4, -+0x44, 0xA4, 0xC0, 0xA4, 0x00, 0x30, 0x00, 0x30, -+0x00, 0xF6, 0x40, 0x32, 0xA5, 0xA4, 0xE6, 0xA4, -+0x0D, 0xEA, 0x01, 0xA4, 0x82, 0xA4, 0x30, 0xF0, -+0x20, 0x6B, 0x0D, 0xEA, 0x80, 0x34, 0xC0, 0xF1, -+0x08, 0x4B, 0x8D, 0xEA, 0x65, 0xF4, 0x40, 0xDB, -+0xE5, 0xF2, 0xD8, 0xC3, 0x0A, 0x26, 0x01, 0x6C, -+0x4C, 0xEC, 0x07, 0x24, 0xE5, 0xF2, 0xB9, 0xC3, -+0xE5, 0xF2, 0xFA, 0xC3, 0x02, 0x25, 0x80, 0x18, -+0x4C, 0x1C, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x20, 0xA4, 0x52, 0x68, -+0x62, 0xA4, 0x18, 0xE9, 0x08, 0x6A, 0x6C, 0xEA, -+0x4E, 0x32, 0x06, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0x60, 0xF2, 0x08, 0x4A, 0x7E, 0x33, 0x7C, 0x33, -+0x12, 0xE8, 0x01, 0xE2, 0x20, 0xF0, 0xA5, 0xA0, -+0x7F, 0x6A, 0xAC, 0xEA, 0x6D, 0xEA, 0x20, 0xF0, -+0x45, 0xC0, 0xA2, 0xA4, 0x40, 0x6B, 0x6C, 0xED, -+0x80, 0x4B, 0xFF, 0x4B, 0x4C, 0xEB, 0xAD, 0xEB, -+0x20, 0xF0, 0x65, 0xC0, 0xA1, 0xA4, 0x1F, 0x6A, -+0xAC, 0xEA, 0x44, 0xC0, 0x41, 0xA4, 0x03, 0x6D, -+0x07, 0xD2, 0xC2, 0xA4, 0x04, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0xAC, 0xEE, 0xCD, 0xEA, 0x20, 0xF0, -+0x45, 0xC0, 0x06, 0x93, 0x09, 0x2B, 0x62, 0xA4, -+0x6C, 0xED, 0x0D, 0x6B, 0x6B, 0xEB, 0xA8, 0x35, -+0x4C, 0xEB, 0xAD, 0xEB, 0x20, 0xF0, 0x65, 0xC0, -+0x61, 0xA4, 0x20, 0xF0, 0xA6, 0xA0, 0x05, 0x6A, -+0x7E, 0x33, 0x4B, 0xEA, 0x68, 0x33, 0xAC, 0xEA, -+0x6D, 0xEA, 0x20, 0xF0, 0x46, 0xC0, 0x62, 0xA4, -+0x20, 0xF0, 0xA5, 0xA0, 0x30, 0x6A, 0x4C, 0xEB, -+0x9F, 0x4A, 0xAC, 0xEA, 0x6D, 0xEA, 0x20, 0xF0, -+0x45, 0xC0, 0x10, 0xF0, 0x24, 0x6D, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF4, 0x40, 0x9A, 0x15, 0xF4, -+0xA4, 0x9D, 0x2C, 0x33, 0x49, 0xE3, 0x03, 0x4C, -+0xAD, 0xE3, 0xA0, 0xA4, 0x01, 0x4C, 0xA0, 0xC2, -+0x01, 0x4A, 0x6A, 0xEA, 0xFA, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x0F, 0x22, 0x20, 0xF0, 0xC5, 0xA0, -+0x44, 0xA0, 0x10, 0xF0, 0x24, 0x6C, 0xDA, 0x37, -+0x04, 0xD2, 0x01, 0x6A, 0xF6, 0xF2, 0x00, 0x4C, -+0xB1, 0x67, 0xDE, 0x36, 0x4C, 0xEF, 0x80, 0x18, -+0xFE, 0x11, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x16, 0x22, -+0x20, 0xF0, 0x66, 0xA0, 0x20, 0xF0, 0xC5, 0xA0, -+0x01, 0x6C, 0x6A, 0x33, 0x8C, 0xEB, 0x06, 0x97, -+0x03, 0x6A, 0xCA, 0x35, 0x04, 0xD3, 0x10, 0xF0, -+0x24, 0x6C, 0xD2, 0x33, 0x4C, 0xEB, 0x16, 0xF3, -+0x04, 0x4C, 0x4C, 0xED, 0x4C, 0xEE, 0x05, 0xD3, -+0x80, 0x18, 0xFE, 0x11, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF4, 0x40, 0x9A, 0x2C, 0x33, 0x49, 0xE3, -+0x60, 0x9A, 0x30, 0xF0, 0x20, 0x6A, 0xCC, 0xF1, -+0x56, 0xA2, 0x01, 0x72, 0x16, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF4, 0x48, 0x9A, 0x63, 0xEA, -+0x10, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF4, -+0x4C, 0x9A, 0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF4, 0x70, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF0, 0x50, 0x9A, 0x60, 0xDA, -+0xF0, 0x17, 0x20, 0xF0, 0x45, 0xA0, 0x03, 0x6B, -+0x4A, 0x32, 0x6C, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCC, 0xF1, 0x74, 0xA3, 0x05, 0x73, 0x11, 0x61, -+0x38, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF4, -+0x4C, 0x9A, 0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF4, 0x74, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF0, 0x50, 0x9A, 0x60, 0xDA, -+0xF0, 0x17, 0x06, 0x73, 0x12, 0x61, 0x02, 0x5A, -+0x24, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF4, -+0x4C, 0x9A, 0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF4, 0x78, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF0, 0x50, 0x9A, 0x60, 0xDA, -+0xF0, 0x17, 0x07, 0x73, 0x12, 0x61, 0x03, 0x72, -+0x10, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF4, -+0x4C, 0x9A, 0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF4, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF0, 0x50, 0x9A, 0x60, 0xDA, -+0xF0, 0x17, 0x30, 0xF0, 0x20, 0x6A, 0xCC, 0xF1, -+0x57, 0xA2, 0x02, 0x72, 0x16, 0x61, 0x20, 0xF0, -+0x45, 0xA0, 0x03, 0x6B, 0x52, 0x32, 0x6C, 0xEA, -+0x10, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x15, 0xF4, -+0x4C, 0x9A, 0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF4, 0x60, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xD5, 0xF0, 0x50, 0x9A, 0x60, 0xDA, -+0xF0, 0x17, 0x07, 0x93, 0x60, 0x6A, 0x91, 0x67, -+0x6C, 0xEA, 0x56, 0x32, 0x06, 0xD2, 0x80, 0x18, -+0x7D, 0x17, 0x06, 0x92, 0x10, 0x22, 0x06, 0x93, -+0x20, 0xF0, 0xC5, 0xA0, 0x04, 0x6A, 0x6B, 0xE2, -+0x09, 0x6D, 0xA4, 0xEA, 0xCA, 0x36, 0x03, 0x6A, -+0x4C, 0xEE, 0xFF, 0x6A, 0x91, 0x67, 0x4C, 0xED, -+0x4C, 0xEE, 0x80, 0x18, 0x3E, 0x1C, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0xC0, 0x4C, 0x4C, 0xEC, 0x0F, 0x5C, 0x27, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, 0x34, 0xF5, -+0x0C, 0x4A, 0x89, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x85, 0x67, 0x80, 0x18, 0xCB, 0x13, 0x1B, 0x10, -+0x85, 0x67, 0x80, 0x18, 0x88, 0x13, 0x17, 0x10, -+0x85, 0x67, 0x80, 0x18, 0x27, 0x13, 0x13, 0x10, -+0x85, 0x67, 0x80, 0x18, 0x0D, 0x12, 0x0F, 0x10, -+0x85, 0x67, 0x80, 0x18, 0xB6, 0x13, 0x0B, 0x10, -+0x85, 0x67, 0x80, 0x18, 0x98, 0x12, 0x07, 0x10, -+0x85, 0x67, 0x80, 0x18, 0x1D, 0x11, 0x03, 0x10, -+0x85, 0x67, 0x80, 0x18, 0x8B, 0x11, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0xFF, 0x6B, 0x8C, 0xEB, 0x94, 0xF6, 0x84, 0x9A, -+0xFE, 0x63, 0x94, 0xF6, 0x04, 0x4A, 0x00, 0xD4, -+0x81, 0x9A, 0x44, 0xAA, 0x00, 0xF0, 0x0A, 0x05, -+0x01, 0xD4, 0x9D, 0x67, 0x44, 0xCC, 0x40, 0xA4, -+0x43, 0xEB, 0x05, 0x61, 0x01, 0x4B, 0x4B, 0xE3, -+0xFF, 0x6B, 0x6C, 0xEA, 0x04, 0x10, 0x01, 0x4C, -+0xAA, 0xEC, 0xF5, 0x61, 0x00, 0x6A, 0x02, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x04, 0x67, 0x4C, 0xE8, -+0xAC, 0xEA, 0x7F, 0x6B, 0x82, 0x67, 0x6C, 0xEC, -+0x80, 0x18, 0x81, 0x14, 0x14, 0x6C, 0x98, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x40, 0x48, 0x0C, 0x30, -+0x2F, 0xF5, 0x18, 0x4B, 0x6D, 0xE0, 0x12, 0xEA, -+0x48, 0xC3, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x63, 0x01, 0xD1, -+0x00, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, 0x05, 0x67, -+0x30, 0xF0, 0x20, 0x69, 0x43, 0xF4, 0xA4, 0x42, -+0xC0, 0xF1, 0x08, 0x49, 0xA4, 0x35, 0x06, 0x93, -+0x35, 0xE5, 0xFF, 0xF7, 0x1F, 0x6C, 0x20, 0xAD, -+0x8C, 0xEE, 0x8C, 0xEF, 0x8C, 0xEB, 0xD3, 0xE4, -+0x22, 0xEC, 0x03, 0x61, 0x39, 0xE6, 0xC0, 0xCD, -+0x03, 0x10, 0x01, 0x6C, 0x8B, 0xEC, 0x80, 0xCD, -+0x30, 0xF0, 0x20, 0x6D, 0xC3, 0xF3, 0x84, 0x42, -+0xC0, 0xF1, 0x08, 0x4D, 0x84, 0x34, 0xB1, 0xE4, -+0xA0, 0xAC, 0xFF, 0xF7, 0x1F, 0x6E, 0xFB, 0xE6, -+0xA2, 0xEE, 0x03, 0x61, 0xBD, 0xE7, 0xE0, 0xCC, -+0x03, 0x10, 0x01, 0x6D, 0xAB, 0xED, 0xA0, 0xCC, -+0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, -+0x87, 0xF1, 0xA8, 0x9C, 0x6F, 0xEE, 0xA3, 0xEE, -+0xAD, 0xE3, 0x02, 0x60, 0x01, 0x6B, 0x6B, 0xEB, -+0x87, 0xF1, 0x68, 0xDC, 0x30, 0xF0, 0x20, 0x6C, -+0xC3, 0xF4, 0x64, 0x42, 0xC0, 0xF1, 0x08, 0x4C, -+0x64, 0x33, 0x07, 0x96, 0x8D, 0xE3, 0x82, 0xAB, -+0xFF, 0xF7, 0x1F, 0x6D, 0xD7, 0xE5, 0x83, 0xED, -+0x91, 0xE6, 0x02, 0x60, 0x01, 0x6C, 0x8B, 0xEC, -+0x82, 0xCB, 0x43, 0xF5, 0x04, 0x4A, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x44, 0x32, -+0x69, 0xE2, 0x62, 0xAA, 0xFF, 0xF7, 0x1F, 0x6C, -+0x13, 0xE4, 0x63, 0xEC, 0x03, 0x61, 0x61, 0xE0, -+0x02, 0xCA, 0x03, 0x10, 0x01, 0x6B, 0x6B, 0xEB, -+0x62, 0xCA, 0x01, 0x91, 0x00, 0x90, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF4, 0xA4, 0x9A, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xA5, 0xE5, 0xF2, -+0xDB, 0xA2, 0x10, 0x6B, 0x8C, 0xEB, 0x02, 0x6C, -+0x8B, 0xEC, 0x72, 0x33, 0xCC, 0xEC, 0x6D, 0xEC, -+0xE5, 0xF2, 0x9B, 0xC2, 0xC0, 0xA5, 0x20, 0x6B, -+0xCC, 0xEB, 0x77, 0x33, 0x68, 0x36, 0x05, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0xCD, 0xEB, 0xE5, 0xF2, -+0x7B, 0xC2, 0xA0, 0xA5, 0x40, 0x6C, 0xAC, 0xEC, -+0x9A, 0x34, 0x84, 0x35, 0x03, 0x6C, 0x8B, 0xEC, -+0x6C, 0xEC, 0xAD, 0xEC, 0xE5, 0xF2, 0x9B, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xF8, 0x63, 0x0F, 0x62, -+0x0E, 0xD1, 0x0D, 0xD0, 0xFF, 0x6A, 0x4C, 0xEE, -+0x52, 0x68, 0x18, 0xEE, 0x30, 0xF0, 0x20, 0x6B, -+0x60, 0xF2, 0x08, 0x4B, 0x4C, 0xEC, 0x4C, 0xEF, -+0x4C, 0xED, 0x0A, 0xD6, 0x06, 0xD7, 0x12, 0xE8, -+0x01, 0xE3, 0x7F, 0x6B, 0x6C, 0xEC, 0x1D, 0x2D, -+0x0C, 0x5C, 0x05, 0x60, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF0, 0x18, 0x4A, 0x1C, 0x10, 0x06, 0x93, -+0xF4, 0x4C, 0x4C, 0xEC, 0x08, 0x2B, 0x03, 0x6A, -+0x58, 0xEC, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF2, -+0x10, 0x4A, 0x12, 0xEC, 0x36, 0x10, 0xE0, 0x4C, -+0x4C, 0xEC, 0x03, 0x6A, 0x58, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0x6F, 0xF2, 0x14, 0x4A, 0x12, 0xEC, -+0x2C, 0x10, 0x0C, 0x5C, 0x15, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0x0F, 0xF1, 0x04, 0x4A, 0x91, 0xE2, -+0x30, 0xF0, 0x20, 0x6A, 0x80, 0xA4, 0x4E, 0xF5, -+0x58, 0x9A, 0x0A, 0x95, 0x06, 0x96, 0x40, 0xEA, -+0x20, 0xF0, 0x86, 0xA0, 0x19, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x20, 0xF0, 0x66, 0xC0, 0xB5, 0x10, -+0x06, 0x93, 0xF4, 0x4C, 0x4C, 0xEC, 0x08, 0x2B, -+0x03, 0x6A, 0x58, 0xEC, 0x30, 0xF0, 0x20, 0x6A, -+0x6F, 0xF3, 0x14, 0x4A, 0x12, 0xEC, 0x09, 0x10, -+0xE0, 0x4C, 0x4C, 0xEC, 0x03, 0x6A, 0x58, 0xEC, -+0x30, 0xF0, 0x20, 0x6A, 0x0F, 0xF3, 0x18, 0x4A, -+0x12, 0xEC, 0x91, 0xE2, 0x01, 0x6A, 0x4B, 0xEA, -+0x7D, 0x67, 0x09, 0xD4, 0x00, 0x6C, 0x50, 0xC3, -+0x51, 0xC3, 0x52, 0xC3, 0x07, 0xD4, 0x24, 0x67, -+0x08, 0xD4, 0x0B, 0xD0, 0x09, 0x96, 0x00, 0xA6, -+0x2C, 0x70, 0x04, 0x61, 0x06, 0x92, 0x2C, 0x68, -+0x01, 0x2A, 0x0C, 0x68, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF5, 0x58, 0x9A, 0x0A, 0x95, 0x06, 0x96, -+0x90, 0x67, 0x01, 0x49, 0x40, 0xEA, 0xFF, 0x72, -+0xFF, 0x6B, 0x6C, 0xE9, 0x07, 0x61, 0x46, 0x70, -+0x11, 0x60, 0x08, 0x94, 0x91, 0xE1, 0x6C, 0xEC, -+0x08, 0xD4, 0x07, 0x10, 0x07, 0x96, 0xBD, 0x67, -+0xD1, 0xE5, 0x01, 0x4E, 0x6C, 0xEE, 0x50, 0xC4, -+0x07, 0xD6, 0x09, 0x92, 0x03, 0x71, 0x01, 0x4A, -+0x09, 0xD2, 0xD8, 0x61, 0x07, 0x92, 0x0B, 0x90, -+0x03, 0x6C, 0xFF, 0x4A, 0x8C, 0xEA, 0x20, 0xF0, -+0xA6, 0xA0, 0x4C, 0x33, 0x19, 0x6A, 0x4B, 0xEA, -+0xAC, 0xEA, 0x6D, 0xEA, 0x20, 0xF0, 0x46, 0xC0, -+0x08, 0x93, 0xFF, 0x6A, 0x06, 0x5B, 0x59, 0x60, -+0x20, 0xF0, 0x67, 0xA0, 0x02, 0x6A, 0x76, 0x33, -+0x8C, 0xEB, 0x20, 0xF0, 0x95, 0xA0, 0x8C, 0xEA, -+0x18, 0x22, 0x06, 0x94, 0x05, 0x24, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x1C, 0x4A, 0x04, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x14, 0x4A, -+0xAF, 0x43, 0x01, 0x6C, 0xA3, 0xEC, 0x09, 0x61, -+0xDD, 0x67, 0xB1, 0xA6, 0x40, 0x9A, 0x84, 0xED, -+0x4C, 0xEC, 0x03, 0x24, 0x50, 0xA6, 0xB0, 0xC6, -+0x51, 0xC6, 0x20, 0xF0, 0x95, 0xA0, 0x40, 0x6A, -+0x8C, 0xEA, 0x19, 0x22, 0x06, 0x92, 0x05, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0x0F, 0xF5, 0x0C, 0x4A, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x0F, 0xF5, -+0x04, 0x4A, 0xFF, 0x4B, 0x01, 0x6C, 0x63, 0xEC, -+0x0A, 0x61, 0xBD, 0x67, 0x71, 0xA5, 0x40, 0x9A, -+0x84, 0xEB, 0x4C, 0xEC, 0x04, 0x24, 0x01, 0x6A, -+0x4B, 0xEA, 0x70, 0xC5, 0x51, 0xC5, 0xDD, 0x67, -+0x71, 0xA6, 0xFF, 0x73, 0x05, 0x60, 0x52, 0xA6, -+0xFF, 0x72, 0x02, 0x60, 0x66, 0xC0, 0x0E, 0x10, -+0x7D, 0x67, 0x51, 0xA3, 0xFF, 0x72, 0x03, 0x60, -+0x72, 0xA3, 0xFF, 0x73, 0x07, 0x60, 0x9D, 0x67, -+0x51, 0xA4, 0xFF, 0x72, 0x04, 0x61, 0x52, 0xA4, -+0xFF, 0x72, 0x01, 0x60, 0x45, 0xC0, 0xBD, 0x67, -+0x50, 0xA5, 0x0F, 0x97, 0x0E, 0x91, 0x0D, 0x90, -+0x08, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x4C, 0xEE, 0x52, 0x6A, 0x58, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, 0xFF, 0xF7, -+0x1F, 0x6B, 0x6C, 0xED, 0x0F, 0xD7, 0x04, 0xD5, -+0x05, 0xD6, 0x12, 0xEC, 0x89, 0xE2, 0x86, 0x67, -+0x06, 0xD2, 0x62, 0xF5, 0x1C, 0x4C, 0x30, 0xF0, -+0x20, 0x6A, 0x84, 0x34, 0xC0, 0xF1, 0x08, 0x4A, -+0x49, 0xE4, 0x05, 0xAA, 0x03, 0xED, 0x0B, 0xE5, -+0x02, 0x60, 0x04, 0x94, 0x8B, 0xE0, 0x6C, 0xEA, -+0xFF, 0x4A, 0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEA, -+0x07, 0x5A, 0x1B, 0x60, 0x04, 0x92, 0x03, 0xEA, -+0x0C, 0x60, 0x05, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x62, 0xF5, 0x1C, 0x4B, -+0x64, 0x33, 0x49, 0xE3, 0x65, 0xAA, 0xFF, 0x4B, -+0x1A, 0x10, 0x05, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x62, 0xF5, 0x1C, 0x4B, -+0x64, 0x33, 0x49, 0xE3, 0x65, 0xAA, 0x01, 0x4B, -+0x0E, 0x10, 0x05, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x62, 0xF5, 0x1C, 0x4B, -+0x64, 0x33, 0x04, 0x94, 0x49, 0xE3, 0x0C, 0x33, -+0x0F, 0xE3, 0x8D, 0xE3, 0x6F, 0x33, 0x65, 0xCA, -+0x05, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x62, 0xF5, 0x1C, 0x4B, 0x64, 0x33, -+0x4D, 0xE3, 0x65, 0xAB, 0x65, 0xF4, 0x40, 0x9A, -+0x07, 0xD3, 0x02, 0x6B, 0x6C, 0xEA, 0x09, 0x22, -+0x07, 0x95, 0x04, 0x96, 0x10, 0xF0, 0x24, 0x6C, -+0x36, 0xF3, 0x10, 0x4C, 0xF0, 0x67, 0x80, 0x18, -+0xFE, 0x11, 0x04, 0x92, 0x43, 0xE8, 0x17, 0x61, -+0x06, 0x94, 0x43, 0xE0, 0xFF, 0xF7, 0x1F, 0x6A, -+0x20, 0xF0, 0x64, 0xA4, 0x4C, 0xE8, 0x0F, 0x6C, -+0x6E, 0x32, 0x8C, 0xEA, 0x44, 0x32, 0x01, 0x6D, -+0xAD, 0xEA, 0x8C, 0xEA, 0x80, 0x4C, 0xF8, 0x4C, -+0x4C, 0x32, 0x6C, 0xEC, 0x4D, 0xEC, 0x06, 0x92, -+0x20, 0xF0, 0x84, 0xC2, 0x15, 0x10, 0x04, 0x93, -+0x06, 0x94, 0xFF, 0xF7, 0x1F, 0x6A, 0x03, 0xE3, -+0x20, 0xF0, 0x64, 0xA4, 0x4C, 0xE8, 0x0F, 0x6C, -+0x6E, 0x32, 0x8C, 0xEA, 0x44, 0x32, 0x8C, 0xEA, -+0x4C, 0x34, 0x79, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x06, 0x93, 0x8D, 0xEA, 0x20, 0xF0, 0x44, 0xC3, -+0x05, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0x06, 0x94, -+0xC2, 0xF5, 0x10, 0x4B, 0x64, 0x33, 0xC0, 0xF1, -+0x08, 0x4A, 0x49, 0xE3, 0x25, 0xAA, 0x20, 0xF0, -+0x44, 0xA4, 0x03, 0x6B, 0x4E, 0x32, 0x6C, 0xEA, -+0xFF, 0x4A, 0x02, 0x5A, 0x03, 0x61, 0x03, 0x58, -+0x08, 0x61, 0x3E, 0x10, 0x09, 0x58, 0x09, 0x6A, -+0x01, 0x60, 0x50, 0x67, 0xFF, 0xF7, 0x1F, 0x68, -+0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x65, 0xF4, 0x60, 0x9A, 0x02, 0x6C, -+0x8C, 0xEB, 0x10, 0x23, 0x06, 0x93, 0x49, 0xE0, -+0x45, 0xF4, 0xF2, 0xA2, 0x20, 0xF0, 0xA4, 0xA3, -+0x10, 0xF0, 0x24, 0x6C, 0x0F, 0x6B, 0xAE, 0x35, -+0x56, 0xF3, 0x08, 0x4C, 0x6C, 0xED, 0xD0, 0x67, -+0x80, 0x18, 0xFE, 0x11, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x41, 0xE0, 0x45, 0xF4, -+0x52, 0xA0, 0xFF, 0xF7, 0x1F, 0x6B, 0x49, 0xE1, -+0x6C, 0xEA, 0x0A, 0x5A, 0x00, 0x69, 0x06, 0x61, -+0x28, 0x42, 0xFE, 0x49, 0x6C, 0xE9, 0x1F, 0x59, -+0x01, 0x61, 0x1E, 0x69, 0x05, 0x93, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC2, 0xF5, -+0x10, 0x4B, 0x64, 0x33, 0x49, 0xE3, 0x25, 0xCA, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x65, 0xF4, 0x60, 0x9A, 0x02, 0x6C, 0x8C, 0xEB, -+0x0D, 0x23, 0x05, 0x93, 0x10, 0xF0, 0x24, 0x6C, -+0x76, 0xF3, 0x00, 0x4C, 0xC2, 0xF5, 0x10, 0x4B, -+0x64, 0x33, 0x49, 0xE3, 0xA5, 0xAA, 0xD1, 0x67, -+0x80, 0x18, 0xFE, 0x11, 0x07, 0x92, 0x11, 0x67, -+0x0B, 0x5A, 0x10, 0x61, 0x15, 0x59, 0x01, 0x6A, -+0x06, 0x60, 0x0B, 0x59, 0x58, 0x67, 0x01, 0x5A, -+0x58, 0x67, 0x03, 0x6B, 0x4B, 0xE3, 0x07, 0x90, -+0xF6, 0x48, 0x07, 0xEA, 0x01, 0xE1, 0xFF, 0xF7, -+0x1F, 0x6A, 0x4C, 0xE8, 0x28, 0x58, 0x01, 0x61, -+0x28, 0x68, 0x03, 0x59, 0x00, 0x69, 0x02, 0x60, -+0x04, 0x92, 0x4A, 0x31, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x08, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x76, 0xF3, -+0x10, 0x4C, 0xB1, 0x67, 0xD0, 0x67, 0x80, 0x18, -+0xFE, 0x11, 0x10, 0x92, 0x20, 0xCA, 0x0F, 0x93, -+0x00, 0xCB, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x52, 0x68, 0x18, 0xEC, 0x4C, 0xEF, 0x30, 0xF0, -+0x20, 0x6B, 0x0E, 0xD6, 0x06, 0xD4, 0x0D, 0xD5, -+0x05, 0xD7, 0x60, 0xF2, 0x08, 0x4B, 0x20, 0xA5, -+0x12, 0xE8, 0x01, 0xE3, 0x60, 0xA6, 0x04, 0xD3, -+0x20, 0xF0, 0xA5, 0xA0, 0x03, 0x6B, 0x04, 0x96, -+0xAC, 0xEB, 0x83, 0x67, 0x4C, 0xEC, 0xC2, 0xEC, -+0x03, 0x60, 0x0E, 0x92, 0x60, 0xC2, 0xB0, 0x10, -+0xA0, 0xF0, 0x0E, 0x24, 0x2F, 0x59, 0xA0, 0xF0, -+0x0B, 0x60, 0x30, 0x6B, 0xAC, 0xEB, 0x4C, 0xEB, -+0xA0, 0xF0, 0x06, 0x23, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x09, 0x22, 0x05, 0x95, 0x04, 0x96, 0x10, 0xF0, -+0x24, 0x6C, 0x96, 0xF3, 0x08, 0x4C, 0xF1, 0x67, -+0x80, 0x18, 0xFE, 0x11, 0x05, 0x93, 0x01, 0x73, -+0x03, 0x60, 0x05, 0x6B, 0x01, 0x6A, 0x53, 0x10, -+0x04, 0x6B, 0x00, 0x6A, 0x50, 0x10, 0x05, 0x94, -+0x01, 0x74, 0x02, 0x61, 0x01, 0x4A, 0x01, 0x10, -+0xFF, 0x4A, 0xFF, 0x6B, 0x6C, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0x48, 0x34, 0x6F, 0xF2, 0x00, 0x4B, -+0x6D, 0xE4, 0xC0, 0xAB, 0xFF, 0x6C, 0x03, 0x6D, -+0x66, 0x67, 0x8C, 0xEB, 0x04, 0xD3, 0xC2, 0x33, -+0x8C, 0xEB, 0x20, 0xF0, 0x85, 0xA0, 0x00, 0x69, -+0xE4, 0x67, 0xAC, 0xEF, 0x62, 0xEF, 0x09, 0x61, -+0x0D, 0x6F, 0x6C, 0xED, 0xEB, 0xEF, 0xA8, 0x35, -+0x8C, 0xEF, 0xAD, 0xEF, 0x20, 0xF0, 0xE5, 0xC0, -+0x01, 0x69, 0x30, 0xF0, 0x20, 0x6C, 0x6F, 0xF2, -+0x00, 0x4C, 0x48, 0x32, 0x49, 0xE4, 0xE1, 0xAA, -+0x20, 0xF0, 0xA5, 0xA0, 0x03, 0x6C, 0xE2, 0x32, -+0xAC, 0xEC, 0x42, 0xEC, 0x3F, 0x61, 0xE5, 0xC0, -+0x06, 0x95, 0x30, 0xF0, 0x20, 0x6C, 0x2F, 0xF5, -+0x18, 0x4C, 0x40, 0x4D, 0xAC, 0x35, 0x91, 0xE5, -+0x46, 0xC4, 0x45, 0xA0, 0xFF, 0x72, 0x32, 0x60, -+0x20, 0xF0, 0x86, 0xA0, 0x19, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x08, 0x6C, 0x8D, 0xEA, 0x20, 0xF0, -+0x46, 0xC0, 0x28, 0x10, 0x01, 0x4A, 0xFF, 0x6C, -+0x8C, 0xEA, 0x63, 0xEA, 0x44, 0x60, 0x30, 0xF0, -+0x20, 0x6C, 0x48, 0x35, 0x6F, 0xF2, 0x00, 0x4C, -+0x91, 0xE5, 0xA0, 0xAC, 0xFF, 0x6C, 0xC5, 0x67, -+0x8C, 0xEE, 0x2E, 0xEE, 0x05, 0x2E, 0xA2, 0x35, -+0x8C, 0xED, 0x04, 0x94, 0x8E, 0xED, 0x9F, 0x25, -+0x30, 0xF0, 0x20, 0x6C, 0x48, 0x35, 0x6F, 0xF2, -+0x00, 0x4C, 0xB1, 0xE4, 0xA1, 0xAC, 0xFF, 0x6C, -+0xC5, 0x67, 0x8C, 0xEE, 0x2E, 0xEE, 0xDE, 0x2E, -+0x04, 0x96, 0xA2, 0x35, 0x8C, 0xED, 0xCE, 0xED, -+0xD9, 0x2D, 0x8D, 0x17, 0x00, 0x68, 0x09, 0x21, -+0x5D, 0x67, 0x87, 0x42, 0x09, 0x4C, 0x0D, 0x92, -+0x80, 0xA4, 0x01, 0x68, 0x80, 0xC2, 0x0E, 0x92, -+0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x09, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0xB6, 0xF3, 0x04, 0x4C, -+0xB0, 0x67, 0x80, 0x18, 0xFE, 0x11, 0x01, 0x10, -+0x00, 0x68, 0x50, 0x67, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, 0x00, 0x68, -+0xF0, 0x67, 0xD0, 0x67, 0xE6, 0x17, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x68, 0x0C, 0xEC, 0xAC, 0xE8, 0xFF, 0x70, -+0x3A, 0x60, 0x52, 0x6A, 0x58, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, 0x7F, 0x69, -+0x0C, 0xE9, 0x12, 0xEC, 0x89, 0xE2, 0x04, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF5, 0x48, 0x9A, -+0x91, 0x67, 0x40, 0xEA, 0x4B, 0xEB, 0x4D, 0xEB, -+0x04, 0x92, 0xC0, 0xF7, 0x62, 0x33, 0x7F, 0x6C, -+0x6D, 0xE2, 0x40, 0xF0, 0x65, 0xA3, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x04, 0xD3, -+0x8C, 0xEB, 0x05, 0xD3, 0x04, 0x6B, 0x6C, 0xEA, -+0x08, 0x22, 0x04, 0x96, 0x10, 0xF0, 0x24, 0x6C, -+0xB6, 0xF3, 0x1C, 0x4C, 0xB0, 0x67, 0x80, 0x18, -+0xFE, 0x11, 0x05, 0x92, 0x23, 0xEA, 0x0B, 0x61, -+0x4E, 0xE9, 0x0A, 0x29, 0x04, 0x94, 0x80, 0x6B, -+0x80, 0x6A, 0x6B, 0xEB, 0x0C, 0xEA, 0x8C, 0xEB, -+0x4E, 0xEB, 0x01, 0x23, 0x01, 0x22, 0xFF, 0x68, -+0x50, 0x67, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6A, 0x4C, 0xEE, -+0x4C, 0xED, 0x62, 0x46, 0xA2, 0xEB, 0x4C, 0xEC, -+0xEC, 0xEA, 0x04, 0x61, 0xFE, 0x4E, 0xC2, 0xED, -+0x01, 0x61, 0x25, 0x22, 0x52, 0x69, 0x38, 0xEC, -+0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x68, 0xFF, 0x6D, 0x02, 0x6E, -+0x12, 0xE9, 0x25, 0xE2, 0x4E, 0xF2, 0x4C, 0x98, -+0x87, 0x41, 0x3E, 0x4C, 0x40, 0xEA, 0x4E, 0xF2, -+0x4C, 0x98, 0x87, 0x41, 0x40, 0x4C, 0x00, 0x6D, -+0x02, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF4, 0x00, 0x6A, -+0x6C, 0xEA, 0x13, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0xD6, 0xF3, 0x08, 0x4C, 0x0C, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF4, -+0x00, 0x6A, 0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF3, 0x14, 0x4C, 0x80, 0x18, -+0xFE, 0x11, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x00, 0x68, 0x52, 0x6A, 0x58, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0x60, 0xF2, 0x08, 0x4B, -+0x12, 0xEA, 0x49, 0xE3, 0x20, 0xF0, 0x85, 0xA2, -+0x80, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xFF, 0x6C, -+0x8C, 0xEB, 0x3D, 0x2B, 0x40, 0xF0, 0x85, 0xA2, -+0xFF, 0x74, 0x0E, 0x60, 0x40, 0xF0, 0x87, 0xA2, -+0x63, 0x5C, 0x04, 0x60, 0x01, 0x4C, 0x40, 0xF0, -+0x87, 0xC2, 0x06, 0x10, 0x40, 0xF0, 0x67, 0xC2, -+0x01, 0x6B, 0x6B, 0xEB, 0x40, 0xF0, 0x65, 0xC2, -+0x40, 0xF0, 0x66, 0xA2, 0xFF, 0x73, 0x0F, 0x60, -+0x40, 0xF0, 0x68, 0xA2, 0x63, 0x5B, 0x08, 0x61, -+0x00, 0x6B, 0x40, 0xF0, 0x68, 0xC2, 0x01, 0x6B, -+0x6B, 0xEB, 0x40, 0xF0, 0x66, 0xC2, 0x03, 0x10, -+0x01, 0x4B, 0x40, 0xF0, 0x68, 0xC2, 0x17, 0x28, -+0x30, 0xF0, 0x20, 0x6C, 0x25, 0xF6, 0x88, 0x9C, -+0x00, 0xF4, 0x00, 0x6B, 0x8C, 0xEB, 0x0F, 0x23, -+0x40, 0xF0, 0xA5, 0xA2, 0x40, 0xF0, 0xC6, 0xA2, -+0x40, 0xF0, 0xE7, 0xA2, 0x40, 0xF0, 0x48, 0xA2, -+0x10, 0xF0, 0x24, 0x6C, 0xF6, 0xF3, 0x00, 0x4C, -+0x04, 0xD2, 0x80, 0x18, 0xFE, 0x11, 0x01, 0x48, -+0xFF, 0x6A, 0x4C, 0xE8, 0x80, 0x70, 0xAE, 0x61, -+0x07, 0x97, 0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0xFF, 0x6B, 0x6C, 0xEE, 0x52, 0x68, 0x18, 0xEE, -+0x12, 0x91, 0x13, 0x92, 0x6C, 0xEF, 0x6C, 0xE9, -+0x6C, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0x60, 0xF2, -+0x08, 0x4B, 0x08, 0xD7, 0x12, 0xE8, 0x01, 0xE3, -+0x20, 0xF0, 0x73, 0xA0, 0xEE, 0xEB, 0x06, 0x2B, -+0x7E, 0xA0, 0x03, 0x6C, 0x6A, 0x33, 0x8C, 0xEB, -+0x2E, 0xEB, 0x25, 0x23, 0x7D, 0x67, 0x87, 0x43, -+0x19, 0x4C, 0x80, 0xA4, 0x55, 0xC3, 0x00, 0x6A, -+0xD3, 0xC3, 0x92, 0xC3, 0x56, 0xC3, 0x56, 0xA8, -+0x38, 0xC3, 0x06, 0x96, 0x57, 0xC3, 0x0C, 0x6A, -+0x50, 0xC3, 0x07, 0x6A, 0x4F, 0xCB, 0x04, 0x94, -+0x05, 0x95, 0x07, 0x97, 0x80, 0x18, 0x6D, 0x08, -+0x7D, 0x67, 0x87, 0x43, 0x19, 0x4C, 0x60, 0xA4, -+0x03, 0x6A, 0x2C, 0xEA, 0x9E, 0xA0, 0x20, 0xF0, -+0x73, 0xC0, 0x48, 0x33, 0x0D, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x6D, 0xEA, 0x5E, 0xC0, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xF8, 0x63, 0x0F, 0x62, 0x0E, 0xD1, 0x0D, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0xFF, 0x6B, 0x06, 0xD2, -+0x6C, 0xED, 0xFF, 0x6C, 0x7F, 0x6A, 0xEC, 0xEC, -+0xAC, 0xEA, 0x0A, 0xD4, 0x07, 0xD2, 0xCC, 0xEB, -+0x06, 0x94, 0x10, 0xF0, 0x24, 0x6A, 0x0B, 0xD3, -+0xF5, 0xF3, 0x54, 0x9A, 0x80, 0x6B, 0xAC, 0xEB, -+0x09, 0xD3, 0x94, 0x33, 0x49, 0xE3, 0x40, 0xA2, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF5, 0x4C, 0x9A, -+0x07, 0x95, 0x09, 0x96, 0x0A, 0x97, 0x40, 0xEA, -+0xFF, 0x72, 0x22, 0x67, 0xA0, 0xF0, 0x05, 0x60, -+0x06, 0x92, 0x52, 0x68, 0x06, 0x95, 0x18, 0xEA, -+0x05, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF2, -+0x08, 0x4A, 0x12, 0xE8, 0x01, 0xE2, 0x30, 0xF0, -+0x20, 0x6A, 0x78, 0xED, 0xC0, 0xF1, 0x08, 0x4A, -+0xFF, 0x6D, 0x12, 0xEC, 0x49, 0xE4, 0x07, 0xF4, -+0x4C, 0xA2, 0x07, 0x6C, 0x4C, 0xEC, 0x0B, 0x92, -+0xAC, 0xEC, 0x08, 0xD4, 0x29, 0x2A, 0x63, 0xA0, -+0x5F, 0xA0, 0x6E, 0xEA, 0x0C, 0x22, 0x06, 0x94, -+0x30, 0xF0, 0x20, 0x6A, 0xBD, 0x67, 0x8C, 0x33, -+0x2F, 0xF7, 0x1C, 0x4A, 0x69, 0xE2, 0x67, 0x45, -+0x25, 0x4B, 0xA0, 0xAB, 0xA3, 0xCA, 0x20, 0xF0, -+0x66, 0xA0, 0x41, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x20, 0xF0, 0x46, 0xC0, 0x23, 0xC0, 0x06, 0x94, -+0xB1, 0x67, 0x80, 0x18, 0x91, 0x14, 0x0A, 0x93, -+0x06, 0x96, 0x00, 0x6A, 0x82, 0x67, 0xA2, 0x67, -+0xF1, 0x67, 0x05, 0xD2, 0x04, 0xD3, 0x80, 0x18, -+0xF0, 0x16, 0x00, 0x6C, 0x44, 0x67, 0x29, 0x10, -+0x20, 0xF0, 0x86, 0xA0, 0x40, 0x6A, 0x23, 0xC0, -+0x8D, 0xEA, 0x20, 0xF0, 0x46, 0xC0, 0x0A, 0x95, -+0x06, 0x96, 0x00, 0x6C, 0x04, 0xD5, 0xF1, 0x67, -+0xA4, 0x67, 0x05, 0xD3, 0x80, 0x18, 0xF0, 0x16, -+0x07, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF1, -+0x18, 0x4A, 0x49, 0xE3, 0x40, 0xA2, 0x30, 0xF0, -+0x20, 0x6B, 0xAF, 0xF3, 0x1C, 0x4B, 0x20, 0xF0, -+0x48, 0xC0, 0x07, 0x94, 0x6D, 0xE4, 0x60, 0xA3, -+0x20, 0xF0, 0x92, 0xA0, 0x63, 0xEC, 0x03, 0x60, -+0x04, 0x4A, 0x20, 0xF0, 0x48, 0xC0, 0x40, 0x6C, -+0x01, 0x6A, 0x0A, 0x95, 0xAC, 0x33, 0x08, 0x95, -+0x6D, 0xE5, 0x8D, 0xEB, 0x00, 0xF6, 0x60, 0x33, -+0xFF, 0x6C, 0x00, 0xF6, 0x63, 0x33, 0x8C, 0xEB, -+0x06, 0x94, 0x03, 0x5C, 0x0A, 0x60, 0x10, 0xF0, -+0x24, 0x6C, 0x35, 0xF4, 0x88, 0x9C, 0x20, 0xC4, -+0x10, 0xF0, 0x24, 0x6C, 0x35, 0xF4, 0x94, 0x9C, -+0x60, 0xC4, 0x30, 0xF0, 0x20, 0x6C, 0xC5, 0xF4, -+0xA3, 0xA4, 0x04, 0x6C, 0xAC, 0xEC, 0x05, 0x24, -+0x07, 0x94, 0x09, 0x91, 0x8D, 0xE9, 0xFF, 0x6C, -+0x8C, 0xE9, 0x06, 0x95, 0xB4, 0x34, 0x10, 0xF0, -+0x24, 0x6D, 0xF5, 0xF3, 0xB8, 0x9D, 0xB5, 0xE4, -+0x20, 0xC5, 0x10, 0xF0, 0x24, 0x6D, 0xF5, 0xF3, -+0xB4, 0x9D, 0xB5, 0xE4, 0x60, 0xC5, 0x10, 0xF0, -+0x24, 0x6B, 0x35, 0xF4, 0x78, 0x9B, 0x71, 0xE4, -+0x40, 0xC4, 0x0F, 0x97, 0x0E, 0x91, 0x0D, 0x90, -+0x08, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x69, 0x8C, 0xE9, -+0x52, 0x68, 0x18, 0xE9, 0x30, 0xF0, 0x20, 0x6A, -+0x60, 0xF2, 0x08, 0x4A, 0x12, 0xE8, 0x01, 0xE2, -+0x84, 0xA0, 0x0F, 0x5C, 0x53, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x88, 0x33, 0x94, 0xF5, 0x00, 0x4A, -+0x69, 0xE2, 0x40, 0x9A, 0x00, 0xEA, 0x1B, 0x6A, -+0x2E, 0x10, 0x3D, 0x6A, 0x20, 0xF0, 0x60, 0xA0, -+0x47, 0xC0, 0x08, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x02, 0x6B, 0x3A, 0x10, 0x20, 0xF0, 0x60, 0xA0, -+0x13, 0x6A, 0x47, 0xC0, 0x08, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x01, 0x6B, 0x6D, 0xEA, 0x20, 0xF0, -+0x40, 0xC0, 0x20, 0xF0, 0x60, 0xA0, 0x33, 0x6A, -+0x47, 0xC0, 0x08, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x01, 0x6B, 0x6D, 0xEA, 0x20, 0xF0, 0x40, 0xC0, -+0x04, 0x6D, 0x30, 0x10, 0x20, 0xF0, 0x60, 0xA0, -+0x0B, 0x6A, 0x47, 0xC0, 0x08, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x03, 0x6E, 0x20, 0xF0, 0x40, 0xC0, -+0x04, 0xD6, 0x25, 0x10, 0x47, 0x6A, 0x20, 0xF0, -+0x60, 0xA0, 0x47, 0xC0, 0x08, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x03, 0x6B, 0x6D, 0xEA, 0x20, 0xF0, -+0x40, 0xC0, 0x05, 0x6A, 0x04, 0xD2, 0x17, 0x10, -+0x23, 0x6A, 0x20, 0xF0, 0x60, 0xA0, 0x47, 0xC0, -+0x08, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x03, 0x6B, -+0x6D, 0xEA, 0x05, 0x6B, 0x20, 0xF0, 0x40, 0xC0, -+0x04, 0xD3, 0x09, 0x10, 0x20, 0xF0, 0x60, 0xA0, -+0x08, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x20, 0xF0, -+0x40, 0xC0, 0x03, 0x6D, 0x04, 0xD5, 0x10, 0xF0, -+0x24, 0x6A, 0x15, 0xF4, 0x40, 0x9A, 0x2C, 0x35, -+0x8C, 0x34, 0x55, 0xE5, 0x10, 0xF0, 0x30, 0x6A, -+0xA3, 0xF5, 0x18, 0x4A, 0x91, 0xE2, 0xE5, 0x67, -+0xFD, 0x65, 0x00, 0x6A, 0x05, 0xD5, 0x05, 0x96, -+0x48, 0x33, 0x20, 0xF0, 0xA5, 0xA0, 0xCD, 0xE3, -+0x60, 0x9B, 0xC0, 0x9C, 0x1D, 0x65, 0xB8, 0x67, -+0xCC, 0xEB, 0x03, 0x6E, 0xAC, 0xEE, 0x02, 0x76, -+0x07, 0x61, 0xFF, 0x6E, 0x4C, 0xEE, 0x01, 0x76, -+0x03, 0x61, 0x41, 0x6E, 0xCB, 0xEE, 0xCC, 0xEB, -+0x48, 0x36, 0xF5, 0xE6, 0x60, 0xDD, 0x01, 0x4A, -+0x7F, 0x67, 0x79, 0xE6, 0x02, 0x72, 0x60, 0x9E, -+0x04, 0x4C, 0xE1, 0x61, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF4, 0x60, 0x9B, 0x2C, 0x32, 0x91, 0x67, -+0x6D, 0xE2, 0xA0, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0x15, 0xF4, 0x64, 0x9B, 0x69, 0xE2, 0xC0, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF3, 0x58, 0x9A, -+0x34, 0x33, 0x49, 0xE3, 0x40, 0xA2, 0xFF, 0x6B, -+0x4C, 0xEB, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, -+0x40, 0x9A, 0x05, 0xD3, 0x40, 0xEA, 0x05, 0x96, -+0x20, 0xF0, 0xE5, 0xA0, 0x80, 0x6D, 0xAB, 0xED, -+0xCC, 0xED, 0x4D, 0xED, 0xEA, 0x37, 0x03, 0x6A, -+0x4C, 0xEF, 0xFF, 0x6A, 0x4C, 0xEF, 0x4C, 0xED, -+0x00, 0x6E, 0x91, 0x67, 0x80, 0x18, 0x14, 0x17, -+0x7D, 0x67, 0xA7, 0x43, 0x09, 0x4D, 0x60, 0xA5, -+0x30, 0xF0, 0x20, 0x6A, 0x91, 0x67, 0x62, 0xC0, -+0x6E, 0xF5, 0x44, 0x9A, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF5, 0x48, 0x9A, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x01, 0x6B, 0x6C, 0xEA, 0x09, 0x22, 0xA0, 0xA0, -+0xC1, 0xA0, 0xE2, 0xA0, 0x10, 0xF0, 0x24, 0x6C, -+0xF6, 0xF3, 0x18, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF4, 0x5C, 0x9A, 0x00, 0x68, 0x60, 0xA2, -+0xFF, 0x6A, 0x83, 0x67, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF4, 0x64, 0x9B, 0x4C, 0xEC, 0x06, 0xD4, -+0x60, 0xA3, 0x01, 0x6C, 0x6C, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x56, 0x32, -+0x8C, 0xEA, 0xE5, 0xF2, 0xBB, 0xA3, 0x48, 0x34, -+0x05, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0x8D, 0xEA, -+0xE5, 0xF2, 0x5B, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF5, 0x58, 0x9A, 0x90, 0x67, 0x40, 0xEA, -+0x69, 0x22, 0x52, 0x69, 0x38, 0xE8, 0x30, 0xF0, -+0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, 0x04, 0x6B, -+0xFF, 0x6C, 0x12, 0xE9, 0x25, 0xE2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xE5, 0xF2, -+0xBB, 0xA2, 0xAC, 0xEB, 0x26, 0x23, 0x06, 0x93, -+0x0A, 0xEB, 0x23, 0x61, 0x10, 0xF0, 0x24, 0x6B, -+0x55, 0xF4, 0x60, 0x9B, 0x65, 0xF4, 0x40, 0x9A, -+0x60, 0xA3, 0xA3, 0x67, 0x10, 0xF0, 0x24, 0x6B, -+0x55, 0xF4, 0x64, 0x9B, 0x8C, 0xED, 0x04, 0xD5, -+0x60, 0xA3, 0x6C, 0xEC, 0x10, 0x6B, 0x6C, 0xEA, -+0x05, 0xD4, 0x09, 0x22, 0x05, 0x96, 0x04, 0x97, -+0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF4, 0x10, 0x4C, -+0xB0, 0x67, 0x80, 0x18, 0xFE, 0x11, 0x04, 0x95, -+0x05, 0x97, 0x90, 0x67, 0x00, 0x6E, 0x80, 0x18, -+0x14, 0x17, 0x67, 0x40, 0x30, 0xF0, 0x20, 0x6A, -+0x39, 0x4B, 0x6C, 0x33, 0x2F, 0xF5, 0x18, 0x4A, -+0x49, 0xE3, 0x45, 0xA2, 0x05, 0x2A, 0x20, 0xF0, -+0x67, 0xA1, 0x80, 0x4A, 0x6D, 0xEA, 0x04, 0x10, -+0x20, 0xF0, 0x67, 0xA1, 0x7F, 0x6A, 0x6C, 0xEA, -+0x20, 0xF0, 0x47, 0xC1, 0x11, 0x28, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x10, 0x6B, -+0x6C, 0xEA, 0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF7, 0xBD, 0xA2, 0x10, 0xF0, 0x24, 0x6C, -+0x36, 0xF4, 0x0C, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x67, 0x40, 0x30, 0xF0, 0x20, 0x6A, 0x39, 0x4B, -+0x6C, 0x33, 0x2F, 0xF5, 0x18, 0x4A, 0x49, 0xE3, -+0x00, 0x6B, 0x65, 0xC2, 0x01, 0x48, 0xFF, 0x6A, -+0x4C, 0xE8, 0x80, 0x70, 0x8B, 0x61, 0x80, 0x18, -+0xC3, 0x16, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF5, -+0x48, 0x9A, 0x40, 0xEA, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x52, 0x68, 0x18, 0xEA, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF2, -+0x08, 0x4A, 0x03, 0x6B, 0x12, 0xE8, 0x01, 0xE2, -+0x20, 0xF0, 0x86, 0xA0, 0x20, 0xF0, 0xA5, 0xA0, -+0x3F, 0xA0, 0x8C, 0xEB, 0x68, 0x34, 0x0D, 0x6B, -+0x6B, 0xEB, 0xAC, 0xEB, 0x8D, 0xEB, 0x40, 0xA0, -+0x20, 0xF0, 0x65, 0xC0, 0x7F, 0x6B, 0x2C, 0xEB, -+0x63, 0xEA, 0x01, 0x60, 0x22, 0x67, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x04, 0x6B, -+0x6C, 0xEA, 0x0C, 0x22, 0x20, 0xF0, 0xC5, 0xA0, -+0x10, 0xF0, 0x24, 0x6C, 0x03, 0x6A, 0xCA, 0x36, -+0x36, 0xF4, 0x18, 0x4C, 0xB1, 0x67, 0x4C, 0xEE, -+0x80, 0x18, 0xFE, 0x11, 0x5F, 0xA0, 0x80, 0x6D, -+0xAB, 0xED, 0x4C, 0xED, 0x20, 0xF0, 0xE5, 0xA0, -+0x2D, 0xED, 0x00, 0xF6, 0xA0, 0x35, 0x04, 0x94, -+0xFF, 0x6A, 0x00, 0xF6, 0xA3, 0x35, 0x4C, 0xED, -+0xEA, 0x37, 0x03, 0x6A, 0x4C, 0xEF, 0x00, 0x6E, -+0x80, 0x18, 0x14, 0x17, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF6, 0x63, 0x13, 0x62, 0x12, 0xD1, 0x11, 0xD0, -+0xFF, 0x6F, 0xEC, 0xEC, 0x52, 0x68, 0x18, 0xEC, -+0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, -+0x94, 0x33, 0xEC, 0xED, 0x09, 0xD4, 0x0C, 0xD5, -+0x7F, 0x69, 0x12, 0xE8, 0x01, 0xE2, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF3, 0x58, 0x9A, 0x49, 0xE3, -+0x40, 0xA2, 0x7D, 0x67, 0x58, 0xC3, 0x98, 0xA3, -+0x03, 0x6B, 0x1B, 0x65, 0x08, 0xD4, 0xA0, 0xA0, -+0x8C, 0xE9, 0x98, 0x67, 0x0A, 0xD5, 0x20, 0xF0, -+0xC5, 0xA0, 0xBD, 0x67, 0xD2, 0x32, 0x6C, 0xEA, -+0xEC, 0xEA, 0x0B, 0xD2, 0x47, 0x45, 0xCA, 0x33, -+0x19, 0x4A, 0x40, 0xA2, 0x8C, 0xEB, 0x79, 0xC5, -+0x20, 0xF0, 0x86, 0xA0, 0x5F, 0xC0, 0x04, 0x6A, -+0x4B, 0xEA, 0x8C, 0xEA, 0x6D, 0xEA, 0x01, 0x6B, -+0x6B, 0xEB, 0x65, 0xC0, 0x66, 0xC0, 0x09, 0x95, -+0x30, 0xF0, 0x20, 0x6C, 0x2F, 0xF5, 0x18, 0x4C, -+0x40, 0x4D, 0xAC, 0x35, 0x95, 0xE5, 0x66, 0xC5, -+0x09, 0x95, 0xAC, 0x35, 0x91, 0xE5, 0x0E, 0xD5, -+0x00, 0xF2, 0x67, 0xC4, 0x20, 0xF0, 0x87, 0xA0, -+0x11, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x20, 0xF0, -+0x67, 0xC0, 0x80, 0x6B, 0x6B, 0xEB, 0x6D, 0xEA, -+0x67, 0x4B, 0x6C, 0xEA, 0x20, 0xF0, 0x46, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x0C, 0x22, 0x58, 0x67, -+0x7D, 0x67, 0xCC, 0xEA, 0x08, 0x95, 0xD9, 0xA3, -+0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF4, 0x0C, 0x4C, -+0x4C, 0xEF, 0x80, 0x18, 0xFE, 0x11, 0x0A, 0x94, -+0x83, 0xE9, 0x79, 0x60, 0x09, 0x94, 0x06, 0x05, -+0x00, 0xF0, 0x19, 0x06, 0x01, 0x6F, 0x80, 0x18, -+0x0B, 0x16, 0xA0, 0xF0, 0x09, 0x2A, 0xBD, 0x67, -+0x20, 0xF0, 0x45, 0xA0, 0x99, 0xA5, 0x03, 0x6B, -+0xA3, 0x67, 0x4C, 0xED, 0xA2, 0xEC, 0x1A, 0x60, -+0xDD, 0x67, 0x01, 0x4C, 0x0D, 0x6D, 0x99, 0xC6, -+0xAB, 0xED, 0x6C, 0xEC, 0x4C, 0xED, 0x88, 0x34, -+0x8D, 0xED, 0x38, 0xC6, 0x30, 0xF0, 0x20, 0x6A, -+0x20, 0xF0, 0xA5, 0xC0, 0x25, 0xF6, 0x48, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x07, 0x22, 0xB9, 0xA6, -+0x10, 0xF0, 0x24, 0x6C, 0x76, 0xF4, 0x08, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0xDD, 0x67, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF5, 0x4C, 0x9A, 0x09, 0x94, -+0xB8, 0xA6, 0x40, 0xEA, 0xFF, 0x72, 0x08, 0xD2, -+0x08, 0x61, 0x47, 0x41, 0x4C, 0x4A, 0x08, 0xD2, -+0x08, 0x93, 0xFF, 0x6A, 0x4C, 0xEB, 0x08, 0xD3, -+0x17, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, 0x07, 0x22, -+0x08, 0x95, 0x10, 0xF0, 0x24, 0x6C, 0x76, 0xF4, -+0x18, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x9D, 0x67, -+0xA7, 0x44, 0x19, 0x4D, 0xA0, 0xA5, 0xB8, 0xC4, -+0x5F, 0x10, 0x01, 0x49, 0xFF, 0x6A, 0x4C, 0xE9, -+0x09, 0x96, 0x0B, 0x97, 0x91, 0x67, 0x00, 0x6D, -+0x80, 0x18, 0xEB, 0x14, 0xDD, 0x67, 0x58, 0xC6, -+0x58, 0xA6, 0xFF, 0x72, 0x08, 0x61, 0x0A, 0x92, -+0x43, 0xE9, 0x02, 0x61, 0x58, 0xC6, 0x03, 0x10, -+0x08, 0x94, 0x8A, 0xE9, 0xEA, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x04, 0x6B, -+0x6C, 0xEA, 0x42, 0x22, 0xDD, 0x67, 0xB8, 0xA6, -+0x10, 0xF0, 0x24, 0x6C, 0x96, 0xF4, 0x08, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x39, 0x10, 0x0A, 0x92, -+0x4E, 0xE9, 0x21, 0x29, 0x20, 0xF0, 0x46, 0xA0, -+0x04, 0x6B, 0x6C, 0xEA, 0xE0, 0xF0, 0x0C, 0x22, -+0x08, 0x92, 0x80, 0x6C, 0x8B, 0xEC, 0x8C, 0xEA, -+0xFF, 0x6D, 0xAC, 0xEA, 0xE0, 0xF0, 0x04, 0x2A, -+0x30, 0xF0, 0x20, 0x6A, 0x0A, 0x95, 0x25, 0xF6, -+0x48, 0x9A, 0xDD, 0x67, 0xAD, 0xEC, 0x6C, 0xEA, -+0x98, 0xC6, 0xA0, 0xF0, 0x1F, 0x22, 0xB8, 0xA6, -+0x10, 0xF0, 0x24, 0x6C, 0x96, 0xF4, 0x14, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0xB7, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x04, 0x6B, -+0x6C, 0xEA, 0x08, 0x22, 0x5D, 0x67, 0xB8, 0xA2, -+0x10, 0xF0, 0x24, 0x6C, 0xB6, 0xF4, 0x00, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x7D, 0x67, 0x87, 0x43, -+0x21, 0x4C, 0x80, 0xA4, 0x98, 0xC3, 0x9F, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x0A, 0x22, 0xDD, 0x67, -+0xB8, 0xA6, 0xE6, 0xA0, 0xC5, 0xA0, 0x10, 0xF0, -+0x24, 0x6C, 0xB6, 0xF4, 0x0C, 0x4C, 0x80, 0x18, -+0xFE, 0x11, 0x5D, 0x67, 0x09, 0x94, 0xB8, 0xA2, -+0x80, 0x18, 0x7A, 0x16, 0x7D, 0x67, 0x58, 0xC3, -+0x09, 0x94, 0xA5, 0xA0, 0x80, 0x18, 0x7A, 0x16, -+0x45, 0xC0, 0x09, 0x94, 0xA6, 0xA0, 0x80, 0x18, -+0x7A, 0x16, 0x46, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, -+0x0A, 0x22, 0xDD, 0x67, 0xB8, 0xA6, 0xE6, 0xA0, -+0xC5, 0xA0, 0x10, 0xF0, 0x24, 0x6C, 0xB6, 0xF4, -+0x1C, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x46, 0xA0, -+0xFF, 0x6B, 0x85, 0xA0, 0x4E, 0xEB, 0x01, 0x5B, -+0x78, 0x67, 0xFF, 0x74, 0x05, 0x61, 0x45, 0xC0, -+0x01, 0x6A, 0x4B, 0xEA, 0x46, 0xC0, 0x01, 0x4B, -+0x9D, 0x67, 0x58, 0xA4, 0xFF, 0x72, 0x09, 0x61, -+0x45, 0xA0, 0x01, 0x4B, 0x58, 0xC4, 0x01, 0x6A, -+0x4B, 0xEA, 0x45, 0xC0, 0xFF, 0x6A, 0x4C, 0xEB, -+0x08, 0x10, 0x07, 0x2B, 0x20, 0xF0, 0x66, 0xA0, -+0x19, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x10, 0x6B, -+0x08, 0x10, 0x01, 0x73, 0x08, 0x61, 0x20, 0xF0, -+0x66, 0xA0, 0x19, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x08, 0x6B, 0x6D, 0xEA, 0x07, 0x10, 0x02, 0x73, -+0x0F, 0x61, 0x20, 0xF0, 0x66, 0xA0, 0x19, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x20, 0xF0, 0x46, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x33, 0x22, 0x22, 0x10, -+0x20, 0xF0, 0x66, 0xA0, 0x19, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x20, 0xF0, 0x46, 0xC0, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x04, 0x6B, -+0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0xD6, 0xF4, 0x0C, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x20, 0xF0, 0x66, 0xA0, 0x03, 0x6A, 0x20, 0xF0, -+0x85, 0xA0, 0x6C, 0xEA, 0x48, 0x33, 0x0D, 0x6A, -+0x4B, 0xEA, 0x8C, 0xEA, 0x6D, 0xEA, 0x20, 0xF0, -+0x45, 0xC0, 0x2A, 0x10, 0x20, 0xF0, 0x46, 0xA0, -+0xDD, 0x67, 0xB8, 0xA6, 0xE6, 0xA0, 0xC5, 0xA0, -+0x4E, 0x32, 0x03, 0x6B, 0x10, 0xF0, 0x24, 0x6C, -+0x6C, 0xEA, 0xD6, 0xF4, 0x18, 0x4C, 0x04, 0xD2, -+0x80, 0x18, 0xFE, 0x11, 0x0C, 0x92, 0x01, 0x6E, -+0x01, 0x72, 0x08, 0x61, 0x20, 0xF0, 0x66, 0xA0, -+0x19, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x20, 0xF0, -+0x46, 0xC0, 0x00, 0x6E, 0x20, 0xF0, 0x63, 0xA0, -+0x0F, 0x6A, 0x6C, 0xEA, 0x10, 0x6B, 0x6D, 0xEA, -+0x20, 0xF0, 0x43, 0xC0, 0x7D, 0x67, 0x09, 0x94, -+0xB8, 0xA3, 0xF9, 0xA3, 0x80, 0x18, 0x14, 0x17, -+0x13, 0x97, 0x12, 0x91, 0x11, 0x90, 0x0A, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF7, 0x63, 0x11, 0x62, -+0x10, 0xD1, 0x0F, 0xD0, 0xFF, 0x6F, 0xEC, 0xEC, -+0x52, 0x68, 0x18, 0xEC, 0x30, 0xF0, 0x20, 0x6A, -+0x60, 0xF2, 0x08, 0x4A, 0x94, 0x33, 0xEC, 0xED, -+0xEC, 0xEE, 0x08, 0xD4, 0x0C, 0xD6, 0x07, 0xD5, -+0x7F, 0x69, 0x12, 0xE8, 0x01, 0xE2, 0x10, 0xF0, -+0x24, 0x6A, 0xF5, 0xF3, 0x58, 0x9A, 0x49, 0xE3, -+0x40, 0xA2, 0x7D, 0x67, 0x50, 0xC3, 0x40, 0xA0, -+0xD0, 0xA3, 0x06, 0xD2, 0x61, 0xA0, 0xFE, 0x65, -+0xCC, 0xE9, 0x0A, 0xD3, 0x20, 0xF0, 0xC5, 0xA0, -+0xD2, 0x32, 0x09, 0xD2, 0x09, 0x93, 0x03, 0x6A, -+0xCA, 0x34, 0x4C, 0xEB, 0x0B, 0xD6, 0x4C, 0xEC, -+0xEC, 0xEB, 0xDD, 0x67, 0x09, 0xD3, 0x91, 0xC6, -+0x20, 0xF0, 0xA6, 0xA0, 0x04, 0x6B, 0x6B, 0xEB, -+0xAC, 0xEB, 0x8D, 0xEB, 0x01, 0x6C, 0x8B, 0xEC, -+0x85, 0xC0, 0x86, 0xC0, 0x08, 0x96, 0x30, 0xF0, -+0x20, 0x6D, 0x2F, 0xF5, 0x18, 0x4D, 0x40, 0x4E, -+0xCC, 0x36, 0xB9, 0xE6, 0x86, 0xC6, 0x08, 0x96, -+0xCC, 0x36, 0xB5, 0xE6, 0x00, 0xF2, 0x87, 0xC5, -+0x20, 0xF0, 0xA7, 0xA0, 0x11, 0x6C, 0x8B, 0xEC, -+0xAC, 0xEC, 0x20, 0xF0, 0x87, 0xC0, 0x80, 0x6C, -+0x8B, 0xEC, 0x8D, 0xEB, 0x67, 0x4C, 0x8C, 0xEB, -+0x20, 0xF0, 0x66, 0xC0, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x08, 0x6C, 0x8C, 0xEB, -+0x0C, 0x23, 0x0B, 0x93, 0x10, 0xF0, 0x24, 0x6C, -+0xF6, 0xF4, 0x14, 0x4C, 0x6C, 0xEA, 0x7D, 0x67, -+0xD1, 0xA3, 0xBF, 0x67, 0x4C, 0xEF, 0x80, 0x18, -+0xFE, 0x11, 0x06, 0x96, 0x23, 0xEE, 0x02, 0x60, -+0x5D, 0x67, 0xD0, 0xC2, 0x07, 0x92, 0x00, 0x6E, -+0x06, 0xD6, 0x50, 0x22, 0x7D, 0x67, 0x50, 0xA3, -+0x04, 0x05, 0x00, 0xF0, 0x11, 0x06, 0x5F, 0xC0, -+0x08, 0x94, 0x02, 0x6F, 0x80, 0x18, 0x0B, 0x16, -+0x43, 0x2A, 0xDD, 0x67, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF5, 0x48, 0x9A, 0x08, 0x94, 0xB0, 0xA6, -+0x40, 0xEA, 0xFF, 0x72, 0x08, 0x60, 0x07, 0x96, -+0x7D, 0x67, 0x50, 0xC3, 0xFF, 0x4E, 0xFF, 0x6A, -+0x4C, 0xEE, 0x07, 0xD6, 0x31, 0x26, 0x0A, 0x92, -+0x00, 0x6B, 0x06, 0xD3, 0x23, 0xEA, 0x22, 0x61, -+0xDD, 0x67, 0x47, 0x46, 0x21, 0x4A, 0x40, 0xA2, -+0x50, 0xC6, 0x28, 0x10, 0x08, 0x96, 0x09, 0x97, -+0x91, 0x67, 0x01, 0x6D, 0x80, 0x18, 0xEB, 0x14, -+0xDD, 0x67, 0x50, 0xC6, 0x0A, 0x92, 0x23, 0xEA, -+0x02, 0x61, 0x50, 0xC6, 0x0A, 0x10, 0xDD, 0x67, -+0x50, 0xA6, 0xFF, 0x72, 0x06, 0x61, 0xFF, 0x6A, -+0xFF, 0x49, 0x4C, 0xE9, 0x0B, 0x92, 0x4A, 0xE9, -+0xE9, 0x61, 0x06, 0x93, 0xFF, 0x6A, 0x01, 0x4B, -+0x4C, 0xEB, 0x06, 0xD3, 0x06, 0x96, 0x07, 0x92, -+0x43, 0xEE, 0x06, 0x60, 0x68, 0x41, 0xB4, 0x4B, -+0xFF, 0x6A, 0x4C, 0xEB, 0x0B, 0xD3, 0xDA, 0x17, -+0x01, 0x6E, 0x06, 0xD6, 0x0C, 0x92, 0x01, 0x72, -+0x09, 0x61, 0x20, 0xF0, 0x66, 0xA0, 0x19, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x00, 0x6B, 0x20, 0xF0, -+0x46, 0xC0, 0x06, 0xD3, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x08, 0x6B, 0x6C, 0xEA, -+0x09, 0x22, 0xDD, 0x67, 0xB0, 0xA6, 0xD1, 0xA6, -+0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF5, 0x10, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x20, 0xF0, 0x63, 0xA0, -+0x0F, 0x6A, 0x6C, 0xEA, 0x20, 0x6B, 0x6D, 0xEA, -+0x20, 0xF0, 0x43, 0xC0, 0x5D, 0x67, 0xF1, 0xA2, -+0x08, 0x94, 0xB0, 0xA2, 0x06, 0x96, 0x80, 0x18, -+0x14, 0x17, 0x11, 0x97, 0x10, 0x91, 0x0F, 0x90, -+0x09, 0x63, 0x00, 0xEF, 0xF6, 0x63, 0x13, 0x62, -+0x12, 0xD1, 0x11, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x52, 0x68, 0x18, 0xEC, 0x30, 0xF0, 0x20, 0x6B, -+0x60, 0xF2, 0x08, 0x4B, 0x09, 0xD4, 0x9D, 0x67, -+0x12, 0xE8, 0x01, 0xE3, 0x00, 0x6B, 0x6C, 0xCC, -+0x6D, 0xCC, 0x20, 0xF0, 0x86, 0xA0, 0x40, 0x6B, -+0x8C, 0xEB, 0x4C, 0xEB, 0x0D, 0x23, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x20, 0xF2, 0x11, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x36, 0xF5, 0x00, 0x4C, 0x2A, 0x12, -+0x09, 0x95, 0x10, 0xF0, 0x24, 0x6C, 0xF5, 0xF3, -+0x98, 0x9C, 0xB4, 0x33, 0x7F, 0x6E, 0x91, 0xE3, -+0x20, 0xA4, 0x80, 0x6C, 0x4C, 0xE9, 0x2C, 0xEE, -+0x2C, 0xEC, 0x0A, 0xD6, 0x0E, 0xD4, 0x20, 0xF0, -+0x85, 0xA0, 0x40, 0xF0, 0x24, 0xC0, 0x0A, 0x95, -+0x8A, 0x34, 0x0C, 0xD4, 0x0C, 0x96, 0x03, 0x6C, -+0x8C, 0xEE, 0x10, 0xF0, 0x24, 0x6C, 0xF5, 0xF3, -+0x94, 0x9C, 0x4C, 0xEE, 0x0C, 0xD6, 0x8D, 0xE3, -+0x60, 0xA3, 0x83, 0x67, 0x4C, 0xEC, 0x0F, 0xD4, -+0x60, 0xA0, 0xA3, 0xEB, 0x08, 0x60, 0x0E, 0x96, -+0x0A, 0xD3, 0x23, 0x67, 0x04, 0x26, 0x80, 0x69, -+0x2B, 0xE9, 0x6D, 0xE9, 0x4C, 0xE9, 0x09, 0x93, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xA2, 0xF7, 0x14, 0x4B, 0x64, 0x33, 0x4D, 0xE3, -+0x60, 0xAB, 0xE0, 0xF1, 0x11, 0x23, 0x09, 0x93, -+0x23, 0xF0, 0x14, 0x4B, 0x64, 0x33, 0x4D, 0xE3, -+0x60, 0xAB, 0x03, 0x5B, 0x0B, 0x61, 0x65, 0xF4, -+0x40, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x06, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x36, 0xF5, 0x0C, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x30, 0xF0, 0x20, 0x6A, -+0x08, 0xD2, 0x09, 0x92, 0x08, 0x93, 0x30, 0xF0, -+0x20, 0x6E, 0xA2, 0xF7, 0x14, 0x4A, 0xC0, 0xF1, -+0x08, 0x4B, 0x44, 0x32, 0x69, 0xE2, 0xA0, 0xAA, -+0x09, 0x92, 0x08, 0xD3, 0xA3, 0xF0, 0x14, 0x4A, -+0x44, 0x32, 0x69, 0xE2, 0x80, 0xAA, 0x0B, 0xD2, -+0x4E, 0xF5, 0x40, 0x9E, 0x93, 0xE5, 0x40, 0xEA, -+0x0D, 0xD2, 0x09, 0x92, 0x08, 0x93, 0x0B, 0x96, -+0x23, 0xF1, 0x14, 0x4A, 0x44, 0x32, 0x69, 0xE2, -+0xA0, 0xAA, 0x30, 0xF0, 0x20, 0x6B, 0x80, 0xAE, -+0x4E, 0xF5, 0x40, 0x9B, 0x93, 0xE5, 0x40, 0xEA, -+0x9D, 0x67, 0xA7, 0x44, 0x2D, 0x4D, 0x80, 0xAD, -+0x0B, 0xD2, 0x02, 0x6B, 0x96, 0xC8, 0x08, 0x95, -+0x65, 0xF4, 0x40, 0x9D, 0x6C, 0xEA, 0x08, 0x22, -+0x0D, 0x95, 0x0B, 0x96, 0x10, 0xF0, 0x24, 0x6C, -+0x36, 0xF5, 0x14, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, -+0x65, 0xF4, 0x40, 0x9C, 0x02, 0x6B, 0x6C, 0xEA, -+0x18, 0x22, 0x09, 0x92, 0x09, 0x96, 0x09, 0x93, -+0xA3, 0xF0, 0x14, 0x4A, 0xA2, 0xF7, 0x14, 0x4E, -+0x23, 0xF0, 0x14, 0x4B, 0x44, 0x32, 0xC4, 0x36, -+0x64, 0x33, 0x89, 0xE2, 0x99, 0xE6, 0x8D, 0xE3, -+0xA0, 0xAA, 0xC0, 0xAE, 0xE0, 0xAB, 0x10, 0xF0, -+0x24, 0x6C, 0x56, 0xF5, 0x04, 0x4C, 0x80, 0x18, -+0xFE, 0x11, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x0C, 0x22, -+0x0F, 0x96, 0x18, 0x6D, 0x10, 0xF0, 0x24, 0x6C, -+0xCC, 0xED, 0x0C, 0x96, 0x56, 0xF5, 0x14, 0x4C, -+0xAE, 0x35, 0xF1, 0x67, 0x80, 0x18, 0xFE, 0x11, -+0x09, 0x94, 0x0D, 0x95, 0x0A, 0x96, 0x00, 0xF0, -+0x1A, 0x02, 0x06, 0x07, 0x04, 0xD2, 0x80, 0x18, -+0x6D, 0x15, 0x0E, 0x93, 0x0A, 0x6A, 0x08, 0x2B, -+0x0A, 0x94, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x49, 0xE4, 0x85, 0xF2, 0x5C, 0xA2, -+0xBD, 0x67, 0x8C, 0xAD, 0xDD, 0x67, 0x6D, 0xAE, -+0xA3, 0x44, 0x55, 0xE5, 0xA2, 0xEB, 0x00, 0x69, -+0x05, 0x60, 0x23, 0x44, 0x67, 0xE1, 0x25, 0xE2, -+0xFF, 0x6A, 0x4C, 0xE9, 0x0A, 0x93, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x49, 0xE3, -+0xBD, 0x67, 0x45, 0xF2, 0x48, 0xA2, 0x8C, 0xAD, -+0xDD, 0x67, 0x6D, 0xAE, 0x95, 0xE2, 0xA2, 0xEB, -+0x00, 0x6D, 0x08, 0xD5, 0x05, 0x60, 0x6F, 0xE4, -+0x4D, 0xE3, 0xFF, 0x6A, 0x4C, 0xEB, 0x08, 0xD3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x65, 0xF4, 0x60, 0x9A, 0x02, 0x6C, 0x8C, 0xEB, -+0x0C, 0x23, 0x0A, 0x96, 0x10, 0xF0, 0x24, 0x6C, -+0x76, 0xF5, 0x0C, 0x4C, 0x49, 0xE6, 0x45, 0xF2, -+0xA8, 0xA2, 0x85, 0xF2, 0xDC, 0xA2, 0x80, 0x18, -+0xFE, 0x11, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x08, 0x22, -+0x08, 0x95, 0x10, 0xF0, 0x24, 0x6C, 0x76, 0xF5, -+0x1C, 0x4C, 0xD1, 0x67, 0x80, 0x18, 0xFE, 0x11, -+0x40, 0xF0, 0x40, 0xA0, 0x3F, 0x6B, 0x6C, 0xEA, -+0x40, 0xF0, 0x60, 0x80, 0x00, 0x53, 0x13, 0x60, -+0x43, 0xE9, 0x02, 0x60, 0x00, 0x69, 0x03, 0x10, -+0x47, 0xE1, 0xFF, 0x6B, 0x6C, 0xE9, 0x08, 0x93, -+0x43, 0xEB, 0x03, 0x60, 0x00, 0x6C, 0x08, 0xD4, -+0x0E, 0x10, 0x08, 0x95, 0x57, 0xE5, 0xFF, 0x6A, -+0x4C, 0xED, 0x08, 0xD5, 0x08, 0x10, 0x07, 0x22, -+0x08, 0x96, 0xFF, 0x6B, 0x45, 0xE1, 0x59, 0xE6, -+0x6C, 0xEE, 0x6C, 0xE9, 0x08, 0xD6, 0x5B, 0x59, -+0x51, 0x67, 0x01, 0x61, 0x5A, 0x6A, 0xFF, 0x6B, -+0x82, 0x67, 0x6C, 0xEC, 0x0A, 0xD4, 0x08, 0x94, -+0xBD, 0x67, 0xC7, 0x45, 0x8C, 0xEB, 0x19, 0x4E, -+0x42, 0x5B, 0x40, 0xA6, 0x01, 0x61, 0x41, 0x6A, -+0xFF, 0x69, 0x4C, 0xE9, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x08, 0x22, 0x0A, 0x96, 0x10, 0xF0, 0x24, 0x6C, -+0x96, 0xF5, 0x0C, 0x4C, 0xB1, 0x67, 0x80, 0x18, -+0xFE, 0x11, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xE5, 0xF2, 0x9B, 0xA2, 0x04, 0x6B, -+0x8C, 0xEB, 0x0B, 0x23, 0x65, 0xF4, 0x40, 0x9A, -+0x02, 0x6B, 0x6C, 0xEA, 0xA0, 0xF0, 0x1C, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x96, 0xF5, 0x1C, 0x4C, -+0xB5, 0x10, 0x0D, 0x95, 0x0A, 0x96, 0xC3, 0xED, -+0x03, 0x60, 0x0B, 0x93, 0x1E, 0x5B, 0x59, 0x61, -+0x0B, 0x94, 0x50, 0x5C, 0x1D, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0xB6, 0xF5, 0x08, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x09, 0x94, 0x01, 0x6D, 0xC5, 0x67, 0x80, 0x18, -+0x61, 0x19, 0x20, 0xF0, 0x60, 0xA0, 0x39, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x20, 0xF0, 0x40, 0xC0, -+0x00, 0x6A, 0x20, 0xF0, 0x41, 0xC0, 0x90, 0x10, -+0x20, 0xF0, 0x80, 0xA0, 0x07, 0x6A, 0x8E, 0x33, -+0x4C, 0xEB, 0x01, 0x4B, 0x4C, 0xEB, 0x6C, 0x35, -+0x39, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xAD, 0xEB, -+0x20, 0xF0, 0x60, 0xC0, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x02, 0x6C, 0x8C, 0xEB, -+0x0A, 0x23, 0x20, 0xF0, 0xA0, 0xA0, 0x10, 0xF0, -+0x24, 0x6C, 0xB6, 0xF5, 0x14, 0x4C, 0xAE, 0x35, -+0x4C, 0xED, 0x80, 0x18, 0xFE, 0x11, 0x20, 0xF0, -+0x40, 0xA0, 0x07, 0x6B, 0x4E, 0x32, 0x6C, 0xEA, -+0x02, 0x52, 0x6A, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0xD6, 0xF5, -+0x04, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x09, 0x94, -+0x01, 0x6D, 0x00, 0x6E, 0x80, 0x18, 0x61, 0x19, -+0x2A, 0x10, 0x0D, 0x95, 0x23, 0xED, 0x32, 0x60, -+0x20, 0xF0, 0x61, 0xA0, 0x01, 0x4B, 0x20, 0xF0, -+0x61, 0xC0, 0x65, 0xF4, 0x40, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x08, 0x22, 0x20, 0xF0, 0xA1, 0xA0, -+0x10, 0xF0, 0x24, 0x6C, 0xD6, 0xF5, 0x10, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x20, 0xF0, 0x41, 0xA0, -+0x03, 0x5A, 0x3E, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0xD6, 0xF5, -+0x1C, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x09, 0x94, -+0x00, 0x6D, 0x80, 0x18, 0x70, 0x18, 0x00, 0x6A, -+0x20, 0xF0, 0x60, 0xA0, 0x20, 0xF0, 0x41, 0xC0, -+0x39, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x20, 0xF0, -+0x40, 0xC0, 0x22, 0x10, 0x20, 0xF0, 0x41, 0xA0, -+0x03, 0x22, 0xFF, 0x4A, 0x20, 0xF0, 0x41, 0xC0, -+0x20, 0xF0, 0x60, 0xA0, 0x07, 0x6C, 0x6E, 0x32, -+0x8C, 0xEA, 0x09, 0x22, 0xFF, 0x4A, 0x8C, 0xEA, -+0x4C, 0x34, 0x39, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x8D, 0xEA, 0x20, 0xF0, 0x40, 0xC0, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0xF6, 0xF5, 0x04, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x09, 0x94, 0x80, 0x18, 0x02, 0x1D, 0x13, 0x97, -+0x12, 0x91, 0x11, 0x90, 0x0A, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x4C, 0xEC, 0x52, 0x68, 0x18, 0xEC, -+0x30, 0xF0, 0x20, 0x6B, 0x60, 0xF2, 0x08, 0x4B, -+0x04, 0xD4, 0x4C, 0xED, 0x12, 0xE8, 0x01, 0xE3, -+0x94, 0x33, 0x10, 0xF0, 0x24, 0x6C, 0xF5, 0xF3, -+0x98, 0x9C, 0x91, 0xE3, 0x80, 0xA4, 0xC4, 0x67, -+0x10, 0xF0, 0x24, 0x6C, 0x4C, 0xEE, 0xF5, 0xF3, -+0x94, 0x9C, 0x05, 0xD6, 0x20, 0xF0, 0xC6, 0xA0, -+0x8D, 0xE3, 0x80, 0xA3, 0x40, 0x6B, 0xCC, 0xEB, -+0x4C, 0xEB, 0x4C, 0xEC, 0xA0, 0xF0, 0x01, 0x23, -+0x18, 0x69, 0x8C, 0xE9, 0x2F, 0x31, 0x01, 0x75, -+0x4C, 0xE9, 0x23, 0x61, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF1, 0x01, 0x4A, -+0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0xF6, 0xF5, 0x10, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x20, 0xF0, 0x63, 0xA0, 0x10, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x20, 0xF0, 0x43, 0xC0, 0x04, 0x94, -+0x05, 0x95, 0x00, 0x6E, 0xF1, 0x67, 0x80, 0x18, -+0x14, 0x17, 0x20, 0xF0, 0x66, 0xA0, 0x19, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x20, 0xF0, 0x46, 0xC0, -+0x78, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, -+0x68, 0x9B, 0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, -+0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0xF6, 0xF5, -+0x1C, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x20, 0xF0, -+0x83, 0xA0, 0x0F, 0x6A, 0x20, 0xF0, 0xA6, 0xA0, -+0x64, 0x67, 0x4C, 0xEB, 0x01, 0x4B, 0x4C, 0xEB, -+0xE1, 0x4A, 0x8C, 0xEA, 0x6D, 0xEA, 0xAE, 0x35, -+0x03, 0x6B, 0x6C, 0xED, 0x20, 0xF0, 0x43, 0xC0, -+0x43, 0x45, 0x6C, 0xEA, 0x02, 0x5A, 0x52, 0x60, -+0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, -+0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, 0x08, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0xFF, 0x6A, 0x16, 0xF6, -+0x04, 0x4C, 0x4C, 0xED, 0x80, 0x18, 0xFE, 0x11, -+0x20, 0xF0, 0xA6, 0xA0, 0x03, 0x6C, 0xFF, 0x6E, -+0xAE, 0x32, 0x8C, 0xEA, 0x6F, 0x42, 0xCC, 0xEB, -+0x79, 0xE0, 0xC5, 0xA6, 0x03, 0x4A, 0x8C, 0xEA, -+0x05, 0xD6, 0x4C, 0x36, 0x19, 0x6A, 0x4B, 0xEA, -+0xAC, 0xEA, 0xCD, 0xEA, 0x20, 0xF0, 0x46, 0xC0, -+0x04, 0x96, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, -+0x18, 0x4A, 0xCC, 0x35, 0x49, 0xE5, 0x6D, 0xE2, -+0x00, 0xF2, 0x46, 0xA3, 0xFF, 0x72, 0x0B, 0x60, -+0x20, 0xF0, 0x65, 0xA0, 0x4C, 0xEC, 0x22, 0x67, -+0x0D, 0x6A, 0x4B, 0xEA, 0x88, 0x34, 0x6C, 0xEA, -+0x8D, 0xEA, 0x20, 0xF0, 0x45, 0xC0, 0x30, 0xF0, -+0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF2, -+0x00, 0x6A, 0x6C, 0xEA, 0x08, 0x22, 0x05, 0x96, -+0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF6, 0x10, 0x4C, -+0xB1, 0x67, 0x80, 0x18, 0xFE, 0x11, 0x04, 0x94, -+0x05, 0x95, 0x01, 0x6E, 0xF1, 0x67, 0x80, 0x18, -+0x14, 0x17, 0x03, 0x10, 0x04, 0x94, 0x80, 0x18, -+0x48, 0x18, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xF6, 0x63, 0x13, 0x62, -+0x12, 0xD1, 0x11, 0xD0, 0xFF, 0x6A, 0x24, 0x67, -+0x4C, 0xE9, 0x52, 0x68, 0x18, 0xE9, 0x30, 0xF0, -+0x20, 0x6B, 0x60, 0xF2, 0x08, 0x4B, 0x7F, 0x6E, -+0x12, 0xE8, 0x01, 0xE3, 0x76, 0xA8, 0x83, 0x67, -+0x4C, 0xEC, 0x0D, 0xD4, 0x10, 0xF0, 0x24, 0x6C, -+0xF5, 0xF3, 0x98, 0x9C, 0x34, 0x33, 0x91, 0xE3, -+0x80, 0xA4, 0x8C, 0xEA, 0x09, 0xD2, 0xCC, 0xEA, -+0x08, 0xD2, 0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF3, -+0x54, 0x9A, 0x4D, 0xE3, 0x60, 0xA3, 0x18, 0x6A, -+0x6C, 0xEA, 0x4E, 0x32, 0x0C, 0xD2, 0x33, 0xF0, -+0x64, 0x41, 0x30, 0xF0, 0x20, 0x6A, 0x64, 0x33, -+0xC0, 0xF1, 0x08, 0x4A, 0x4D, 0xE3, 0x60, 0xAB, -+0x03, 0x5B, 0x15, 0x61, 0x65, 0xF4, 0x40, 0x9A, -+0x00, 0xF2, 0x00, 0x6B, 0x4C, 0xEB, 0x06, 0x23, -+0x10, 0xF0, 0x24, 0x6C, 0x36, 0xF5, 0x0C, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x01, 0x6D, 0x91, 0x67, -+0xC5, 0x67, 0x80, 0x18, 0x61, 0x19, 0x91, 0x67, -+0x00, 0x6D, 0x80, 0x18, 0x08, 0x1B, 0x30, 0xF0, -+0x20, 0x6F, 0x33, 0xF2, 0x44, 0x41, 0xC0, 0xF1, -+0x08, 0x4F, 0x44, 0x32, 0xE9, 0xE2, 0xA0, 0xAA, -+0x0E, 0xD2, 0xB3, 0xF1, 0x44, 0x41, 0x44, 0x32, -+0xE9, 0xE2, 0x30, 0xF0, 0x20, 0x6B, 0x80, 0xAA, -+0x07, 0xD2, 0x4E, 0xF5, 0x40, 0x9B, 0x93, 0xE5, -+0x06, 0xD7, 0x40, 0xEA, 0x06, 0x94, 0x0B, 0xD2, -+0x07, 0x96, 0x33, 0xF3, 0x44, 0x41, 0x44, 0x32, -+0x89, 0xE2, 0xA0, 0xAA, 0x80, 0xAE, 0x30, 0xF0, -+0x20, 0x6F, 0x0F, 0xD2, 0x4E, 0xF5, 0x40, 0x9F, -+0x93, 0xE5, 0x40, 0xEA, 0x06, 0x94, 0x0A, 0xD2, -+0x00, 0xF2, 0x00, 0x6A, 0x65, 0xF4, 0x60, 0x9C, -+0x6C, 0xEA, 0x12, 0x22, 0x07, 0x96, 0x0E, 0x97, -+0xB3, 0xF2, 0x44, 0x41, 0x0F, 0x93, 0x44, 0x32, -+0x89, 0xE2, 0xA0, 0xAE, 0xC0, 0xAF, 0xE0, 0xAA, -+0x40, 0xAB, 0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF6, -+0x1C, 0x4C, 0x04, 0xD2, 0x80, 0x18, 0xFE, 0x11, -+0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, -+0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, 0x0B, 0x22, -+0x09, 0x94, 0x0B, 0x95, 0x0A, 0x96, 0x0C, 0x97, -+0x04, 0xD4, 0x10, 0xF0, 0x24, 0x6C, 0x36, 0xF6, -+0x14, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x09, 0x96, -+0xDE, 0x32, 0x12, 0x22, 0x08, 0x97, 0x30, 0xF0, -+0x20, 0x6A, 0x0F, 0xF4, 0x10, 0x4A, 0xE4, 0x33, -+0x49, 0xE3, 0x60, 0xAA, 0x72, 0x34, 0x76, 0x32, -+0x49, 0xE4, 0x49, 0xE3, 0x7E, 0x33, 0x69, 0xE2, -+0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEA, 0x08, 0x10, -+0x08, 0x94, 0x30, 0xF0, 0x20, 0x6A, 0x0F, 0xF4, -+0x10, 0x4A, 0x84, 0x33, 0x49, 0xE3, 0x40, 0xAA, -+0x40, 0xF0, 0x64, 0x80, 0x00, 0x53, 0x15, 0x60, -+0x40, 0xF0, 0x84, 0xA0, 0x7F, 0x6B, 0x6C, 0xEC, -+0x30, 0xF0, 0x20, 0x6B, 0x0F, 0xF4, 0x10, 0x4B, -+0x84, 0x34, 0x71, 0xE4, 0x80, 0xAC, 0x92, 0x35, -+0x96, 0x33, 0x6D, 0xE5, 0x6D, 0xE4, 0x9E, 0x34, -+0x8D, 0xE3, 0xFF, 0xF7, 0x1F, 0x6C, 0x8C, 0xEB, -+0x0B, 0x10, 0x40, 0xF0, 0x84, 0xA0, 0x7F, 0x6D, -+0x30, 0xF0, 0x20, 0x6B, 0xAC, 0xEC, 0x0F, 0xF4, -+0x10, 0x4B, 0x84, 0x34, 0x71, 0xE4, 0x60, 0xAC, -+0x20, 0xF0, 0xA3, 0xA0, 0x10, 0x6C, 0x8B, 0xEC, -+0xAC, 0xEC, 0xFF, 0x6D, 0xAC, 0xEC, 0x10, 0x6D, -+0x8E, 0xED, 0x01, 0x5D, 0x0D, 0x97, 0xB8, 0x67, -+0xAB, 0xED, 0x05, 0x6C, 0xAC, 0xEC, 0x64, 0x6D, -+0xFB, 0xE5, 0xD8, 0xEB, 0x64, 0x4C, 0x0B, 0x97, -+0x12, 0xEB, 0x98, 0xEB, 0x20, 0xF0, 0x86, 0xA0, -+0x03, 0x6B, 0x8C, 0xEB, 0x0C, 0x94, 0x12, 0xEE, -+0xC4, 0xEB, 0xEF, 0xE5, 0xB8, 0xEB, 0x07, 0xD6, -+0x12, 0xED, 0x58, 0xED, 0x00, 0xF2, 0x00, 0x6A, -+0x12, 0xEB, 0x64, 0xEC, 0x06, 0xD3, 0x30, 0xF0, -+0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, 0x6C, 0xEA, -+0x08, 0x22, 0x0D, 0x95, 0x10, 0xF0, 0x24, 0x6C, -+0x56, 0xF6, 0x14, 0x4C, 0xC7, 0x67, 0x80, 0x18, -+0xFE, 0x11, 0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, -+0x68, 0x9B, 0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, -+0x09, 0x22, 0x40, 0xF0, 0xA4, 0xA0, 0x08, 0x96, -+0x10, 0xF0, 0x24, 0x6C, 0x76, 0xF6, 0x00, 0x4C, -+0x80, 0x18, 0xFE, 0x11, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x0C, 0x22, 0x07, 0x96, 0x06, 0x97, -+0x10, 0xF0, 0x24, 0x6C, 0xC2, 0x35, 0xE2, 0x36, -+0x76, 0xF6, 0x0C, 0x4C, 0xAA, 0x35, 0xCA, 0x36, -+0x80, 0x18, 0xFE, 0x11, 0x06, 0x92, 0x07, 0x93, -+0x63, 0xEA, 0x03, 0x61, 0x0A, 0x94, 0x1E, 0x5C, -+0x2F, 0x61, 0x20, 0xF0, 0x63, 0xA0, 0x10, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x10, 0x72, 0x4C, 0x61, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0x76, 0xF6, 0x18, 0x4C, 0x80, 0x18, 0xFE, 0x11, -+0x0A, 0x96, 0x1E, 0x5E, 0x3B, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF5, 0x48, 0x9A, 0x08, 0x94, -+0x40, 0xEA, 0x07, 0x22, 0xFD, 0x67, 0x47, 0x47, -+0x1D, 0x4A, 0xE0, 0xA2, 0x40, 0xF0, 0xE6, 0xC0, -+0x2D, 0x10, 0x5D, 0x67, 0x67, 0x42, 0x1D, 0x4B, -+0x40, 0xA3, 0x40, 0xF0, 0x45, 0xC0, 0x26, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, -+0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, 0x07, 0x22, -+0x09, 0x95, 0x10, 0xF0, 0x24, 0x6C, 0x96, 0xF6, -+0x00, 0x4C, 0x80, 0x18, 0xFE, 0x11, 0x00, 0x6A, -+0x20, 0xF0, 0x63, 0xA0, 0x40, 0xF0, 0x42, 0xC0, -+0x10, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x10, 0x72, 0x01, 0x6D, 0x0B, 0x61, -+0x20, 0xF0, 0x60, 0xA0, 0x39, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x08, 0x6B, 0x6D, 0xEA, 0x20, 0xF0, -+0x40, 0xC0, 0x01, 0x10, 0x00, 0x6D, 0x91, 0x67, -+0x80, 0x18, 0x08, 0x1B, 0x13, 0x97, 0x12, 0x91, -+0x11, 0x90, 0x0A, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xFF, 0x6B, 0x04, 0x67, -+0x26, 0x67, 0x4E, 0xF5, 0x5C, 0x9A, 0x6C, 0xE8, -+0x6C, 0xE9, 0x6C, 0xED, 0x90, 0x67, 0xD1, 0x67, -+0x40, 0xEA, 0xA2, 0x67, 0x90, 0x67, 0xF1, 0x67, -+0x00, 0x6E, 0x80, 0x18, 0x14, 0x17, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xE5, 0xF2, 0x9A, 0xA3, -+0x52, 0x6A, 0xE5, 0xF2, 0x79, 0xA3, 0x58, 0xEC, -+0x30, 0xF0, 0x20, 0x6D, 0x60, 0xF2, 0x08, 0x4D, -+0xFF, 0x4B, 0x12, 0xEA, 0x49, 0xE5, 0xFF, 0x6D, -+0xAC, 0xEB, 0x05, 0x5B, 0xE0, 0xF0, 0x13, 0x60, -+0x10, 0xF0, 0x24, 0x6D, 0x68, 0x33, 0xB4, 0xF5, -+0x1C, 0x4D, 0x75, 0xE5, 0x60, 0x9D, 0x00, 0xEB, -+0x0C, 0x6B, 0x9D, 0x67, 0x6F, 0xCC, 0xBD, 0x67, -+0x0E, 0x6C, 0x90, 0xC5, 0x72, 0xC5, 0x20, 0xF0, -+0x72, 0xA2, 0x03, 0x6C, 0xDD, 0x67, 0x73, 0xC5, -+0x63, 0xA2, 0x74, 0xC5, 0x20, 0xF0, 0x65, 0xA2, -+0x6A, 0x35, 0x8C, 0xED, 0xB5, 0xC6, 0xA3, 0x67, -+0x8C, 0xED, 0xB6, 0xC6, 0xA5, 0xA2, 0xB7, 0xC6, -+0xA6, 0xA2, 0xB8, 0xC6, 0x7E, 0x35, 0x72, 0x33, -+0x8C, 0xEB, 0x7A, 0xC6, 0xB9, 0xC6, 0x20, 0xF0, -+0x46, 0xA2, 0x01, 0x6B, 0x4A, 0x32, 0x6C, 0xEA, -+0x5B, 0xC6, 0x00, 0x6A, 0x5C, 0xC6, 0x6D, 0x10, -+0xBD, 0x67, 0x0C, 0x6B, 0x6F, 0xCD, 0x0E, 0x6B, -+0x70, 0xC5, 0x0D, 0x6B, 0x72, 0xC5, 0x64, 0xA2, -+0x8C, 0x34, 0x73, 0xC5, 0x60, 0xA2, 0x74, 0xC5, -+0x41, 0xA2, 0x55, 0xC5, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF4, 0x40, 0x9A, 0x49, 0xE4, 0x40, 0xA2, -+0x56, 0xC5, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF4, -+0x48, 0x9A, 0x49, 0xE4, 0x40, 0xA2, 0x57, 0xC5, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF4, 0x4C, 0x9A, -+0x49, 0xE4, 0x40, 0xA2, 0x58, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF4, 0x50, 0x9A, 0x49, 0xE4, -+0x40, 0xA2, 0x59, 0xC5, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF4, 0x44, 0x9A, 0x49, 0xE4, 0x40, 0xA2, -+0x5A, 0xC5, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF4, -+0x54, 0x9A, 0x49, 0xE4, 0x40, 0xA2, 0x5B, 0xC5, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF4, 0x58, 0x9A, -+0x49, 0xE4, 0x40, 0xA2, 0x5C, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF4, 0x5C, 0x9A, 0x76, 0x10, -+0xDD, 0x67, 0x0C, 0x6A, 0x4F, 0xCE, 0x0E, 0x6A, -+0x50, 0xC6, 0x52, 0xC6, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x45, 0xF4, 0x72, 0xA2, -+0x73, 0xC6, 0x45, 0xF4, 0x73, 0xA2, 0x74, 0xC6, -+0x45, 0xF4, 0x74, 0xA2, 0x75, 0xC6, 0x45, 0xF4, -+0x75, 0xA2, 0x76, 0xC6, 0x45, 0xF4, 0x76, 0xA2, -+0x77, 0xC6, 0x45, 0xF4, 0x77, 0xA2, 0x78, 0xC6, -+0x45, 0xF4, 0x78, 0xA2, 0x79, 0xC6, 0x45, 0xF4, -+0x79, 0xA2, 0x7A, 0xC6, 0x45, 0xF4, 0x7A, 0xA2, -+0x45, 0xF4, 0x5B, 0xA2, 0x7B, 0xC6, 0x5C, 0xC6, -+0x00, 0x6A, 0x5D, 0xC6, 0x4E, 0x10, 0x7D, 0x67, -+0x03, 0x6A, 0x4F, 0xCB, 0x0E, 0x6A, 0x50, 0xC3, -+0x0F, 0x6A, 0x52, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x74, 0xA2, 0x2F, 0xF5, 0x14, 0x4A, -+0x41, 0xA2, 0x9D, 0x67, 0x73, 0xC4, 0x54, 0xC4, -+0x3C, 0x10, 0xBD, 0x67, 0x0C, 0x6B, 0x6F, 0xCD, -+0x0E, 0x6B, 0x70, 0xC5, 0x10, 0x6B, 0x72, 0xC5, -+0x40, 0xF0, 0x64, 0xA2, 0x8C, 0x34, 0x73, 0xC5, -+0x77, 0xAA, 0x04, 0x4B, 0x6F, 0x33, 0x74, 0xC5, -+0x76, 0xAA, 0x04, 0x4B, 0x6F, 0x33, 0x75, 0xC5, -+0x60, 0xA2, 0x76, 0xC5, 0x65, 0xA2, 0x77, 0xC5, -+0x46, 0xA2, 0x58, 0xC5, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF4, 0x40, 0x9A, 0x49, 0xE4, 0x40, 0xA2, -+0x59, 0xC5, 0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF4, -+0x48, 0x9A, 0x49, 0xE4, 0x40, 0xA2, 0x5A, 0xC5, -+0x10, 0xF0, 0x24, 0x6A, 0x55, 0xF4, 0x4C, 0x9A, -+0x49, 0xE4, 0x40, 0xA2, 0x5B, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0x55, 0xF4, 0x50, 0x9A, 0x49, 0xE4, -+0x40, 0xA2, 0x5C, 0xC5, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF4, 0x44, 0x9A, 0x51, 0xE4, 0x40, 0xA4, -+0x5D, 0xC5, 0x04, 0x94, 0x05, 0x95, 0x06, 0x96, -+0x07, 0x97, 0x80, 0x18, 0x6D, 0x08, 0x09, 0x97, -+0x05, 0x63, 0x00, 0xEF, 0x00, 0x6A, 0xB3, 0xF0, -+0xA4, 0x42, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0xA4, 0x35, 0x00, 0x6C, 0x75, 0xE5, -+0x80, 0xCD, 0x33, 0xF0, 0xA4, 0x42, 0xA4, 0x35, -+0x75, 0xE5, 0x80, 0xCD, 0xB2, 0xF7, 0xA4, 0x42, -+0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, 0xB3, 0xF1, -+0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, -+0x33, 0xF2, 0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, -+0x80, 0xCD, 0xB3, 0xF2, 0xA4, 0x42, 0xA4, 0x35, -+0x75, 0xE5, 0x80, 0xCD, 0x43, 0xF4, 0xA4, 0x42, -+0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, 0xC3, 0xF3, -+0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, -+0xC3, 0xF4, 0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, -+0x82, 0xCD, 0x43, 0xF5, 0xA4, 0x42, 0xA4, 0x35, -+0x75, 0xE5, 0x82, 0xCD, 0x01, 0x4A, 0xFF, 0x6C, -+0x8C, 0xEA, 0x80, 0x72, 0xC4, 0x61, 0x58, 0x67, -+0x87, 0xF1, 0x48, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x8C, 0xEA, 0x43, 0xF4, 0xA4, 0x42, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0xA4, 0x35, 0x00, 0x6C, 0x75, 0xE5, 0x80, 0xCD, -+0xC3, 0xF3, 0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, -+0x80, 0xCD, 0xC3, 0xF4, 0xA4, 0x42, 0x43, 0xF5, -+0x04, 0x4A, 0xA4, 0x35, 0x44, 0x32, 0x75, 0xE5, -+0x6D, 0xE2, 0x82, 0xCD, 0x82, 0xCB, 0x20, 0xE8, -+0xFF, 0x6A, 0x8C, 0xEA, 0xB3, 0xF0, 0xA4, 0x42, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0xA4, 0x35, 0x00, 0x6C, 0x75, 0xE5, 0x80, 0xCD, -+0x33, 0xF1, 0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, -+0x80, 0xCD, 0x33, 0xF0, 0xA4, 0x42, 0xA2, 0xF7, -+0x14, 0x4A, 0xA4, 0x35, 0x44, 0x32, 0x75, 0xE5, -+0x6D, 0xE2, 0x80, 0xCD, 0x80, 0xCB, 0x20, 0xE8, -+0xFF, 0x6A, 0x8C, 0xEA, 0xB3, 0xF1, 0xA4, 0x42, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0xA4, 0x35, 0x00, 0x6C, 0x75, 0xE5, 0x80, 0xCD, -+0x33, 0xF3, 0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, -+0x80, 0xCD, 0x33, 0xF2, 0xA4, 0x42, 0xA4, 0x35, -+0x75, 0xE5, 0x80, 0xCD, 0xB3, 0xF2, 0xA4, 0x42, -+0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, 0x52, 0x6C, -+0x98, 0xEA, 0x80, 0x4C, 0xEE, 0x4C, 0x12, 0xEA, -+0x6D, 0xE2, 0xE0, 0xF0, 0x41, 0xA3, 0x4C, 0xEC, -+0xE0, 0xF0, 0x81, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0xF4, 0x63, 0x17, 0x62, 0x16, 0xD1, 0x15, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xFF, 0x6A, 0x75, 0xF4, -+0x60, 0x9B, 0x4C, 0xEC, 0x90, 0x34, 0x6D, 0xE4, -+0x00, 0xA3, 0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF4, -+0x64, 0x9B, 0x4C, 0xE8, 0x6D, 0xE4, 0xA0, 0xA3, -+0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF4, 0x68, 0x9B, -+0x4C, 0xED, 0x6D, 0xE4, 0x60, 0xA3, 0xC3, 0x67, -+0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF4, 0x6C, 0x9B, -+0x4C, 0xEE, 0x0F, 0xD6, 0x6D, 0xE4, 0x60, 0xA3, -+0xE3, 0x67, 0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF4, -+0xD0, 0x9B, 0x4C, 0xEF, 0x10, 0xD7, 0xD9, 0xE4, -+0x60, 0xA6, 0xE3, 0x67, 0x10, 0xF0, 0x24, 0x6B, -+0x75, 0xF4, 0x74, 0x9B, 0x4C, 0xEF, 0x09, 0xD7, -+0x6D, 0xE4, 0x60, 0xA3, 0xE3, 0x67, 0x10, 0xF0, -+0x24, 0x6B, 0x75, 0xF4, 0x78, 0x9B, 0x4C, 0xEF, -+0x0B, 0xD7, 0x6D, 0xE4, 0xE0, 0xA3, 0x4C, 0xEF, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF4, 0x5C, 0x9A, -+0x49, 0xE4, 0x40, 0xA2, 0x10, 0xF0, 0x24, 0x6A, -+0x95, 0xF4, 0x40, 0x9A, 0x51, 0xE4, 0x60, 0xA4, -+0x01, 0x6A, 0x4C, 0xEB, 0xA0, 0xF2, 0x06, 0x2B, -+0x52, 0x69, 0x38, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0x60, 0xF2, 0x08, 0x4B, 0x12, 0xE9, 0x25, 0xE3, -+0x60, 0xA6, 0x00, 0xF6, 0x60, 0x33, 0x00, 0xF6, -+0x63, 0x33, 0x00, 0x53, 0x00, 0x6B, 0x0E, 0xD3, -+0x05, 0x60, 0x20, 0xF0, 0x66, 0xA1, 0x7A, 0x33, -+0x4C, 0xEB, 0x0E, 0xD3, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF3, 0x58, 0x9A, 0x14, 0x33, 0x0F, 0x94, -+0x49, 0xE3, 0xC0, 0xA2, 0xFF, 0x6B, 0x6C, 0xEE, -+0xCA, 0xEC, 0x10, 0x60, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x01, 0x6B, 0x6C, 0xEA, -+0x60, 0xF2, 0x1C, 0x22, 0x0F, 0x95, 0x10, 0xF0, -+0x24, 0x6C, 0x96, 0xF6, 0x0C, 0x4C, 0x80, 0x18, -+0xFE, 0x11, 0x74, 0x12, 0x20, 0xF0, 0x85, 0xA1, -+0x80, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, 0x6C, 0xEA, -+0x40, 0xF2, 0x1E, 0x2A, 0x0E, 0x96, 0x19, 0x26, -+0x30, 0xF0, 0x20, 0x6A, 0xB3, 0xF1, 0x64, 0x40, -+0xC0, 0xF1, 0x08, 0x4A, 0x64, 0x33, 0x4D, 0xE3, -+0x60, 0xAB, 0x0A, 0xD3, 0x33, 0xF3, 0x64, 0x40, -+0x64, 0x33, 0x4D, 0xE3, 0x60, 0xAB, 0x11, 0xD3, -+0xB3, 0xF2, 0x64, 0x40, 0x64, 0x33, 0x4D, 0xE3, -+0x60, 0xAB, 0x12, 0xD3, 0x33, 0xF2, 0x64, 0x40, -+0x18, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xB3, 0xF0, -+0x64, 0x40, 0xC0, 0xF1, 0x08, 0x4A, 0x64, 0x33, -+0x4D, 0xE3, 0x60, 0xAB, 0x0A, 0xD3, 0x33, 0xF1, -+0x64, 0x40, 0x64, 0x33, 0x4D, 0xE3, 0x60, 0xAB, -+0x11, 0xD3, 0x33, 0xF0, 0x64, 0x40, 0x64, 0x33, -+0x4D, 0xE3, 0x60, 0xAB, 0x12, 0xD3, 0xB2, 0xF7, -+0x64, 0x40, 0x64, 0x33, 0x49, 0xE3, 0x40, 0xAA, -+0x08, 0xD2, 0x40, 0xF0, 0x61, 0xA1, 0x40, 0x6A, -+0x6C, 0xEA, 0x05, 0x22, 0x40, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x40, 0xF0, 0x41, 0xC1, 0x09, 0x93, -+0x0B, 0x94, 0x7F, 0x6A, 0xAC, 0xEA, 0x0D, 0xD2, -+0x3F, 0x6A, 0x4C, 0xEB, 0x4C, 0xEC, 0x4C, 0xEF, -+0x69, 0xE4, 0xEE, 0xEA, 0x09, 0xD3, 0x0B, 0xD4, -+0x0C, 0xD7, 0x40, 0xF1, 0x1D, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x65, 0xF4, -+0x60, 0x9A, 0x01, 0x6C, 0x8C, 0xEB, 0x14, 0x23, -+0x09, 0x95, 0x0B, 0x96, 0xB2, 0xF7, 0x64, 0x40, -+0x64, 0x33, 0x04, 0xD5, 0x05, 0xD6, 0x06, 0xD7, -+0x49, 0xE3, 0x40, 0xAA, 0x0F, 0x95, 0x10, 0x96, -+0x0D, 0x97, 0x10, 0xF0, 0x24, 0x6C, 0xB6, 0xF6, -+0x00, 0x4C, 0x07, 0xD2, 0x80, 0x18, 0xFE, 0x11, -+0x10, 0x92, 0x0F, 0x97, 0xEE, 0xEA, 0x26, 0x22, -+0x0E, 0x92, 0x05, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xC5, 0xF4, 0x68, 0xA2, 0x04, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC5, 0xF4, 0x67, 0xA2, 0x40, 0xF0, -+0x81, 0xA1, 0x3F, 0x6A, 0x01, 0x6D, 0x8C, 0xEA, -+0x62, 0xEA, 0x03, 0x60, 0x57, 0xE3, 0xFF, 0x6A, -+0x4C, 0xED, 0x40, 0xF0, 0x61, 0xA1, 0x40, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x4D, 0xFF, 0x6A, -+0x4C, 0xED, 0x0C, 0x92, 0x6F, 0x45, 0x08, 0x94, -+0x78, 0xEA, 0xFF, 0xF7, 0x1F, 0x6A, 0x12, 0xEB, -+0x6D, 0xE4, 0x1F, 0x10, 0x40, 0xF0, 0xC1, 0xA1, -+0x0D, 0x97, 0x3F, 0x6B, 0x40, 0x6A, 0xFF, 0x6C, -+0xCC, 0xEB, 0xCC, 0xEA, 0x77, 0xE7, 0x8C, 0xEA, -+0x8C, 0xED, 0x03, 0x22, 0x01, 0x4D, 0x8C, 0xED, -+0x04, 0x10, 0x0D, 0x92, 0x42, 0xEB, 0x01, 0x61, -+0x01, 0x6D, 0x0A, 0x93, 0x09, 0x94, 0xFF, 0xF7, -+0x1F, 0x6A, 0x08, 0x96, 0x8D, 0xE3, 0x0C, 0x94, -+0x4C, 0xEB, 0x0A, 0xD3, 0x98, 0xED, 0x12, 0xEB, -+0x6D, 0xE6, 0x4C, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x01, 0x6E, 0x08, 0xD3, -+0xCC, 0xEA, 0x0C, 0x22, 0x40, 0xF0, 0x41, 0xA1, -+0x10, 0xF0, 0x24, 0x6C, 0x3F, 0x6F, 0x5A, 0x33, -+0xD6, 0xF6, 0x10, 0x4C, 0x6C, 0xEE, 0x4C, 0xEF, -+0x80, 0x18, 0xFE, 0x11, 0x0B, 0x92, 0x09, 0x94, -+0x12, 0x97, 0x11, 0x93, 0x5D, 0xE7, 0x8D, 0xE3, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xEB, 0x4C, 0xEF, -+0x0B, 0xD7, 0x09, 0xD3, 0x40, 0xF0, 0x61, 0xA1, -+0x40, 0x6A, 0x6D, 0xEA, 0x40, 0xF0, 0x41, 0xC1, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x08, 0x95, 0x01, 0x6B, 0x6C, 0xEA, 0x0C, 0xD5, -+0x08, 0x22, 0x08, 0x96, 0x10, 0xF0, 0x24, 0x6C, -+0xF6, 0xF6, 0x00, 0x4C, 0xB0, 0x67, 0x80, 0x18, -+0xFE, 0x11, 0x09, 0x96, 0x0A, 0x97, 0x08, 0x94, -+0x0B, 0x95, 0xEB, 0xE6, 0xFF, 0xF7, 0x1F, 0x6B, -+0x6C, 0xEA, 0x04, 0xD2, 0xCB, 0xE4, 0xAB, 0xE2, -+0x0B, 0x96, 0x0C, 0x95, 0x09, 0x97, 0x90, 0x67, -+0x05, 0xD2, 0x80, 0x18, 0x9F, 0x14, 0x0E, 0x96, -+0x38, 0x26, 0xFD, 0x67, 0x87, 0x47, 0x21, 0x4C, -+0xE0, 0xAC, 0x30, 0xF0, 0x20, 0x6A, 0x9D, 0x67, -+0xB3, 0xF1, 0x64, 0x40, 0xC0, 0xF1, 0x08, 0x4A, -+0xA7, 0x44, 0x64, 0x33, 0x4D, 0xE3, 0x1D, 0x4D, -+0xE0, 0xCB, 0x80, 0xAD, 0x33, 0xF3, 0x64, 0x40, -+0xBD, 0x67, 0xC7, 0x45, 0x64, 0x33, 0x4D, 0xE3, -+0x25, 0x4E, 0x80, 0xCB, 0xA0, 0xAE, 0xB3, 0xF2, -+0x64, 0x40, 0xDD, 0x67, 0xE7, 0x46, 0x64, 0x33, -+0x4D, 0xE3, 0x19, 0x4F, 0xA0, 0xCB, 0xC0, 0xAF, -+0x33, 0xF2, 0x64, 0x40, 0x64, 0x33, 0x49, 0xE3, -+0xC0, 0xCA, 0x20, 0xF0, 0x48, 0xA1, 0x08, 0x93, -+0xFF, 0xF7, 0x1F, 0x6F, 0xEC, 0xEA, 0x43, 0xEB, -+0x00, 0xF1, 0x1E, 0x61, 0x90, 0x67, 0x80, 0x18, -+0x6F, 0x1B, 0x90, 0x67, 0x80, 0x18, 0x10, 0x1D, -+0x17, 0x11, 0xBD, 0x67, 0xC7, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF7, 0x1C, 0x4A, 0x21, 0x4E, -+0x0C, 0x34, 0xA0, 0xAE, 0x91, 0xE2, 0xDD, 0x67, -+0x30, 0xF0, 0x20, 0x6A, 0xB3, 0xF0, 0x64, 0x40, -+0xC0, 0xF1, 0x08, 0x4A, 0xE7, 0x46, 0x64, 0x33, -+0x4D, 0xE3, 0x1D, 0x4F, 0xA0, 0xCB, 0xC0, 0xAF, -+0x33, 0xF1, 0x64, 0x40, 0xFD, 0x67, 0xA7, 0x47, -+0x64, 0x33, 0x4D, 0xE3, 0x25, 0x4D, 0xC0, 0xCB, -+0xE0, 0xAD, 0x33, 0xF0, 0x64, 0x40, 0x64, 0x33, -+0x4D, 0xE3, 0xE0, 0xCB, 0xB2, 0xF7, 0x64, 0x40, -+0x64, 0x33, 0x49, 0xE3, 0x7D, 0x67, 0xA7, 0x43, -+0x19, 0x4D, 0x60, 0xAD, 0x08, 0x96, 0xFF, 0xF7, -+0x1F, 0x6D, 0x60, 0xCA, 0x43, 0xAC, 0xCF, 0xE5, -+0x62, 0xEA, 0x02, 0x60, 0x49, 0xE6, 0x43, 0xCC, -+0xA7, 0x40, 0x30, 0xF0, 0x20, 0x6B, 0x39, 0x4D, -+0x30, 0xF0, 0x20, 0x6A, 0xB2, 0xF7, 0x84, 0x40, -+0xAC, 0x35, 0x2F, 0xF5, 0x18, 0x4B, 0x6D, 0xE5, -+0x84, 0x34, 0xC0, 0xF1, 0x08, 0x4A, 0x51, 0xE4, -+0x0A, 0xD3, 0x80, 0xAC, 0x68, 0xA3, 0x63, 0xEC, -+0x08, 0x61, 0x90, 0x67, 0x80, 0x18, 0xDB, 0x19, -+0x0A, 0x97, 0x45, 0xA7, 0x01, 0x4A, 0x45, 0xC7, -+0xC3, 0x10, 0x20, 0xF0, 0x87, 0xA1, 0x80, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0xFF, 0x6C, 0x8C, 0xEB, -+0xA0, 0xF0, 0x1A, 0x23, 0x65, 0xF4, 0x40, 0x9A, -+0x01, 0x6B, 0x6C, 0xEA, 0x07, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0xF6, 0xF6, 0x10, 0x4C, 0xB0, 0x67, -+0x80, 0x18, 0xFE, 0x11, 0x90, 0x67, 0x80, 0x18, -+0xDB, 0x19, 0x20, 0xF0, 0x67, 0xA1, 0x7F, 0x6A, -+0x6C, 0xEA, 0x20, 0xF0, 0x47, 0xC1, 0xA4, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x65, 0xF4, 0x60, 0x9A, 0x01, 0x6C, 0x8C, 0xEB, -+0x15, 0x23, 0x09, 0x93, 0x0B, 0x94, 0x0C, 0x95, -+0x04, 0xD3, 0xB2, 0xF7, 0x64, 0x40, 0x64, 0x33, -+0x05, 0xD4, 0x06, 0xD5, 0x49, 0xE3, 0x40, 0xAA, -+0x0F, 0x95, 0x10, 0x96, 0x0D, 0x97, 0x10, 0xF0, -+0x24, 0x6C, 0xF6, 0xF6, 0x1C, 0x4C, 0x07, 0xD2, -+0x80, 0x18, 0xFE, 0x11, 0x10, 0x92, 0x0F, 0x96, -+0x00, 0x6D, 0xCE, 0xEA, 0x21, 0x2A, 0x40, 0xF0, -+0xC1, 0xA1, 0x0D, 0x97, 0x3F, 0x6B, 0x40, 0x6A, -+0xFF, 0x6C, 0xCC, 0xEB, 0xCC, 0xEA, 0x77, 0xE7, -+0x8C, 0xEA, 0x8C, 0xED, 0x03, 0x22, 0x01, 0x4D, -+0x8C, 0xED, 0x04, 0x10, 0x0D, 0x92, 0x42, 0xEB, -+0x01, 0x61, 0x01, 0x6D, 0x0A, 0x93, 0x09, 0x94, -+0xFF, 0xF7, 0x1F, 0x6A, 0x08, 0x96, 0x8D, 0xE3, -+0x0C, 0x94, 0x4C, 0xEB, 0x0A, 0xD3, 0x98, 0xED, -+0x12, 0xEB, 0x79, 0xE6, 0x4C, 0xEE, 0x08, 0xD6, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x01, 0x6E, 0xCC, 0xEA, 0x0C, 0x22, 0x40, 0xF0, -+0x41, 0xA1, 0x10, 0xF0, 0x24, 0x6C, 0x3F, 0x6F, -+0x5A, 0x33, 0xD6, 0xF6, 0x10, 0x4C, 0x6C, 0xEE, -+0x4C, 0xEF, 0x80, 0x18, 0xFE, 0x11, 0x12, 0x97, -+0x0B, 0x93, 0x11, 0x95, 0x09, 0x96, 0x69, 0xE7, -+0xFF, 0xF7, 0x1F, 0x6C, 0xCD, 0xE5, 0x40, 0xF0, -+0xA1, 0xA1, 0x8C, 0xEA, 0x8C, 0xEB, 0x41, 0x6C, -+0x8B, 0xEC, 0xAC, 0xEC, 0x40, 0xF0, 0x81, 0xC1, -+0x0E, 0x97, 0x1A, 0x27, 0xDD, 0x67, 0xE7, 0x46, -+0x21, 0x4F, 0xB3, 0xF1, 0xA4, 0x40, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xAF, 0xC0, 0xF1, 0x08, 0x4C, -+0xA4, 0x35, 0x95, 0xE5, 0xC0, 0xCD, 0x33, 0xF3, -+0xA4, 0x40, 0xA4, 0x35, 0x95, 0xE5, 0x60, 0xCD, -+0xB3, 0xF2, 0x64, 0x40, 0x64, 0x33, 0x8D, 0xE3, -+0x40, 0xCB, 0x23, 0xF2, 0x14, 0x48, 0x19, 0x10, -+0xDD, 0x67, 0xE7, 0x46, 0x21, 0x4F, 0xB3, 0xF0, -+0xA4, 0x40, 0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xAF, -+0xC0, 0xF1, 0x08, 0x4C, 0xA4, 0x35, 0x95, 0xE5, -+0xC0, 0xCD, 0x33, 0xF1, 0xA4, 0x40, 0xA4, 0x35, -+0x95, 0xE5, 0x60, 0xCD, 0x33, 0xF0, 0x64, 0x40, -+0x64, 0x33, 0x8D, 0xE3, 0x40, 0xCB, 0xA2, 0xF7, -+0x14, 0x48, 0xFD, 0x67, 0x47, 0x47, 0x19, 0x4A, -+0xE0, 0xAA, 0x04, 0x30, 0x91, 0xE0, 0xE0, 0xCC, -+0x0D, 0x92, 0x40, 0xF0, 0x81, 0xA1, 0x3F, 0x6B, -+0x4C, 0xEB, 0x40, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0x6D, 0xEA, 0x40, 0xF0, 0x41, 0xC1, 0x0E, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x01, 0x6B, 0x6C, 0xEA, 0x07, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x36, 0xF7, 0x0C, 0x4C, 0xB0, 0x67, -+0x80, 0x18, 0xFE, 0x11, 0x17, 0x97, 0x16, 0x91, -+0x15, 0x90, 0x0C, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x01, 0x6A, 0x20, 0xE8, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x01, 0x75, 0x1F, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF1, 0x34, 0x9A, 0x30, 0xF0, 0x20, 0x68, -+0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, 0x41, 0xF1, -+0x08, 0x6C, 0x02, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0xB1, 0x67, 0x41, 0xF1, 0x0C, 0x6C, -+0x02, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0xB5, 0xF2, 0x38, 0x9A, 0x21, 0xF4, 0x00, 0x6C, -+0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, 0x00, 0x6E, -+0x46, 0x10, 0x02, 0x75, 0x26, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF1, 0x34, 0x9A, 0x30, 0xF0, -+0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, -+0x41, 0xF1, 0x08, 0x6C, 0x02, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, 0x41, 0xF1, -+0x0C, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0xB5, 0xF2, 0x38, 0x9A, 0xCE, 0xF4, -+0x50, 0x98, 0x21, 0xF4, 0x00, 0x6C, 0xB1, 0x67, -+0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xE1, 0xF0, 0x10, 0x6C, 0xB1, 0x67, 0x01, 0x6E, -+0x25, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF1, -+0x34, 0x9A, 0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, -+0x50, 0x98, 0xB1, 0x67, 0x41, 0xF1, 0x08, 0x6C, -+0x02, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x41, 0xF1, 0x0C, 0x6C, 0x02, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF2, -+0x38, 0x9A, 0xCE, 0xF4, 0x50, 0x98, 0x21, 0xF4, -+0x00, 0x6C, 0xB1, 0x67, 0x01, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xE1, 0xF0, 0x10, 0x6C, -+0xB1, 0x67, 0x00, 0x6E, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x0C, 0xD4, 0x45, 0x67, 0x1A, 0x25, 0x10, 0xF0, -+0x24, 0x6B, 0x75, 0xF1, 0x60, 0x9B, 0x80, 0x9C, -+0x8C, 0xEB, 0x04, 0x2B, 0x01, 0x6A, 0x4B, 0xEA, -+0x06, 0xD2, 0x34, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0x10, 0xF0, 0x24, 0x6D, 0x36, 0xF7, 0x18, 0x4C, -+0x34, 0xF7, 0x10, 0x4D, 0xC2, 0x67, 0x80, 0x18, -+0xFE, 0x11, 0x01, 0x6C, 0x8B, 0xEC, 0x06, 0xD4, -+0x25, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, -+0x1C, 0x9A, 0xFF, 0x69, 0xCC, 0xE9, 0xEC, 0xE8, -+0x28, 0x34, 0xB0, 0x67, 0x05, 0xF0, 0x00, 0x4C, -+0x00, 0x18, 0x05, 0xE1, 0x0C, 0x95, 0x06, 0xD2, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, -+0x60, 0x9D, 0x6C, 0xEA, 0x0F, 0x22, 0x06, 0x92, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0x56, 0xF7, 0x18, 0x4C, 0x34, 0xF7, 0x10, 0x4D, -+0x00, 0x6E, 0xF1, 0x67, 0x04, 0xD2, 0x05, 0xD0, -+0x80, 0x18, 0xFE, 0x11, 0x06, 0x92, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x0E, 0xD4, 0x45, 0x67, 0x12, 0x91, 0x13, 0x25, -+0x10, 0xF0, 0x24, 0x6B, 0x75, 0xF1, 0x60, 0x9B, -+0x80, 0x9C, 0x8C, 0xEB, 0x7F, 0x23, 0x10, 0xF0, -+0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, 0x36, 0xF7, -+0x18, 0x4C, 0x14, 0xF7, 0x10, 0x4D, 0xC2, 0x67, -+0x80, 0x18, 0xFE, 0x11, 0x73, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0x5C, 0x9A, 0xFF, 0x68, -+0x00, 0x6B, 0x4C, 0xEF, 0x4A, 0xEF, 0xCC, 0xE8, -+0x08, 0xD7, 0x09, 0xD3, 0x30, 0x60, 0x0E, 0x94, -+0xA3, 0x67, 0xD0, 0x67, 0xE2, 0x67, 0x80, 0x18, -+0xE2, 0x1E, 0x09, 0xD2, 0x01, 0x4A, 0x13, 0x2A, -+0x0E, 0x94, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, -+0x40, 0x9A, 0x60, 0x9C, 0x6C, 0xEA, 0x56, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0x96, 0xF7, 0x04, 0x4C, 0x14, 0xF7, 0x10, 0x4D, -+0x80, 0x18, 0xFE, 0x11, 0x4B, 0x10, 0x00, 0x6B, -+0x43, 0x67, 0x08, 0x94, 0x01, 0x6D, 0x86, 0xEB, -+0xAC, 0xEC, 0x07, 0x2C, 0x01, 0x4A, 0xFF, 0x6C, -+0x8C, 0xEA, 0x14, 0x72, 0x01, 0x4B, 0xF5, 0x61, -+0x14, 0x6A, 0x08, 0x95, 0x09, 0x93, 0x24, 0xEA, -+0xAF, 0xEA, 0x6C, 0xEA, 0x4D, 0xE9, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0x5C, 0x9A, 0x00, 0xF5, -+0x00, 0x33, 0x01, 0x6D, 0x2C, 0xEA, 0x6D, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0xF0, 0x9B, -+0x10, 0xF0, 0x24, 0x6B, 0x95, 0xF4, 0xD8, 0x9B, -+0x81, 0xF4, 0x10, 0x6C, 0xAB, 0xED, 0x4C, 0xEE, -+0x40, 0xEF, 0x0E, 0x94, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x40, 0x9A, 0x60, 0x9C, 0x6C, 0xEA, -+0x11, 0x22, 0x09, 0x95, 0x08, 0x92, 0x10, 0xF0, -+0x24, 0x6C, 0x05, 0xD5, 0x10, 0xF0, 0x24, 0x6D, -+0xB6, 0xF7, 0x08, 0x4C, 0x14, 0xF7, 0x10, 0x4D, -+0x00, 0x6E, 0xF0, 0x67, 0x04, 0xD1, 0x06, 0xD2, -+0x80, 0x18, 0xFE, 0x11, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0D, 0x6C, 0x40, 0xEA, -+0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0xFF, 0x6A, 0xAC, 0xEA, 0x06, 0xD2, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, 0x60, 0x9C, -+0x04, 0x67, 0x26, 0x67, 0x6C, 0xEA, 0x0A, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0xF6, 0xF7, 0x04, 0x4C, 0xB4, 0xF6, 0x08, 0x4D, -+0x80, 0x18, 0xFE, 0x11, 0x4B, 0xA0, 0x13, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, -+0x60, 0x98, 0x6C, 0xEA, 0x80, 0xF1, 0x01, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0x17, 0xF0, 0x00, 0x4C, 0xB4, 0xF6, 0x08, 0x4D, -+0x80, 0x18, 0xFE, 0x11, 0x76, 0x11, 0x06, 0x59, -+0x0A, 0x60, 0x01, 0x71, 0x03, 0x61, 0x06, 0x93, -+0x03, 0x5B, 0x04, 0x10, 0x02, 0x71, 0x10, 0x61, -+0x06, 0x94, 0x05, 0x5C, 0x0D, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, 0x60, 0x98, -+0x6C, 0xEA, 0x60, 0xF1, 0x04, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x37, 0xF0, 0x04, 0x4C, 0x3D, 0x11, -+0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF4, 0x34, 0xDA, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, 0xFC, 0x9A, -+0x90, 0x67, 0x00, 0x6D, 0x18, 0x6E, 0x80, 0x18, -+0xE2, 0x1E, 0x06, 0x59, 0x07, 0xD2, 0xE0, 0xF0, -+0x19, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x28, 0x33, -+0x94, 0xF6, 0x10, 0x4A, 0x69, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x18, 0x05, 0xE1, 0x10, 0xF0, -+0x24, 0x6B, 0x95, 0xF4, 0x7C, 0x9B, 0x01, 0x6D, -+0xA1, 0xF0, 0x0C, 0x6C, 0x4C, 0xEB, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0xF0, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xB5, 0xF4, 0xC0, 0x9A, 0xAB, 0xED, -+0x6D, 0xEE, 0x40, 0xEF, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF1, 0xB8, 0x9B, 0xC1, 0xF0, 0x04, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x07, 0x94, 0x01, 0xF4, -+0x00, 0x6A, 0x8D, 0xEA, 0xDC, 0x10, 0x06, 0x92, -+0x01, 0x72, 0x09, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0x01, 0xF2, 0x00, 0x6C, -+0x10, 0x6D, 0x01, 0x6E, 0x08, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x01, 0xF2, -+0x00, 0x6C, 0x10, 0x6D, 0x00, 0x6E, 0x40, 0xEA, -+0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, 0xAB, 0xED, -+0x00, 0x18, 0x05, 0xE1, 0x10, 0xF0, 0x24, 0x6B, -+0xB5, 0xF4, 0x64, 0x9B, 0x06, 0x94, 0x0F, 0x6E, -+0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF4, -+0x48, 0x9A, 0x8C, 0xEE, 0xC8, 0x36, 0x30, 0xF0, -+0x20, 0x6C, 0x4D, 0xEE, 0xCE, 0xF4, 0x50, 0x9C, -+0x01, 0x6D, 0x6D, 0xEE, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF1, 0xB8, 0x9B, 0xC1, 0xF0, 0x04, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x07, 0x94, 0x01, 0xF4, -+0x01, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, 0x01, 0xF0, -+0x00, 0x6B, 0x31, 0x10, 0x01, 0x6D, 0xA1, 0xF0, -+0x0C, 0x6C, 0xAB, 0xED, 0x00, 0x18, 0x05, 0xE1, -+0x10, 0xF0, 0x24, 0x6B, 0xB5, 0xF4, 0x6C, 0x9B, -+0x0F, 0x6E, 0x30, 0xF0, 0x20, 0x6C, 0x4C, 0xEB, -+0x06, 0x92, 0x01, 0x6D, 0xAB, 0xED, 0x4C, 0xEE, -+0x10, 0xF0, 0x24, 0x6A, 0xB5, 0xF4, 0x50, 0x9A, -+0xC8, 0x36, 0x4D, 0xEE, 0xCE, 0xF4, 0x50, 0x9C, -+0x6D, 0xEE, 0xA1, 0xF0, 0x0C, 0x6C, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF1, 0xB8, 0x9B, -+0xC1, 0xF0, 0x04, 0x6C, 0x01, 0x6E, 0x40, 0xEA, -+0x07, 0x94, 0x01, 0xF4, 0x01, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x00, 0xF4, 0x00, 0x6B, 0x6D, 0xEA, -+0x62, 0x10, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x18, 0x05, 0xE1, 0x10, 0xF0, -+0x24, 0x6B, 0xB5, 0xF4, 0x74, 0x9B, 0x01, 0x6D, -+0xA1, 0xF0, 0x0C, 0x6C, 0x4C, 0xEB, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0xF0, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xAB, 0xED, 0xB5, 0xF4, 0xD8, 0x9A, -+0x17, 0x10, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x18, 0x05, 0xE1, 0x10, 0xF0, -+0x24, 0x6B, 0xB5, 0xF4, 0x74, 0x9B, 0x30, 0xF0, -+0x20, 0x6C, 0x01, 0x6D, 0x4C, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0xB5, 0xF4, 0xDC, 0x9A, 0xCE, 0xF4, -+0xF0, 0x9C, 0xAB, 0xED, 0xA1, 0xF0, 0x0C, 0x6C, -+0x6D, 0xEE, 0x40, 0xEF, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF1, 0xB8, 0x9B, 0xC1, 0xF0, 0x04, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x50, 0x9C, -+0xB5, 0xF2, 0xB8, 0x9B, 0xC1, 0xF0, 0x08, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x01, 0xF4, 0x00, 0x6A, -+0x07, 0x93, 0xB1, 0x17, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x60, 0x9A, 0x40, 0x98, 0x4C, 0xEB, -+0x07, 0x92, 0x0D, 0x23, 0x06, 0x97, 0x10, 0xF0, -+0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, 0x37, 0xF0, -+0x04, 0x4C, 0xB4, 0xF6, 0x08, 0x4D, 0xD1, 0x67, -+0x80, 0x18, 0xFE, 0x11, 0x07, 0x92, 0x04, 0xD2, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, 0xFC, 0x9A, -+0x90, 0x67, 0x00, 0x6D, 0x18, 0x6E, 0x80, 0x18, -+0x08, 0x1F, 0x07, 0x93, 0x00, 0x6C, 0x01, 0x4B, -+0x01, 0x23, 0x01, 0x6C, 0xFF, 0x6B, 0x4C, 0xEB, -+0x8C, 0xEB, 0x14, 0x2B, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x40, 0x9A, 0x60, 0x98, 0x6C, 0xEA, -+0x26, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x77, 0xF0, -+0x00, 0x4C, 0x06, 0x97, 0x10, 0xF0, 0x24, 0x6D, -+0xB4, 0xF6, 0x08, 0x4D, 0xD1, 0x67, 0x80, 0x18, -+0xFE, 0x11, 0x19, 0x10, 0x90, 0x67, 0xB1, 0x67, -+0x80, 0x18, 0xA6, 0x1E, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x40, 0x9A, 0x60, 0x98, 0x6C, 0xEA, -+0x0C, 0x22, 0x06, 0x97, 0x10, 0xF0, 0x24, 0x6C, -+0x10, 0xF0, 0x24, 0x6D, 0xD7, 0xF0, 0x00, 0x4C, -+0xB4, 0xF6, 0x08, 0x4D, 0xD1, 0x67, 0x80, 0x18, -+0xFE, 0x11, 0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x40, 0x9A, 0x60, 0x9C, 0xFF, 0x68, -+0x24, 0x67, 0x6C, 0xEA, 0xAC, 0xE8, 0x0A, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0xF7, 0xF0, 0x1C, 0x4C, 0xD4, 0xF6, 0x0C, 0x4D, -+0x80, 0x18, 0xFE, 0x11, 0x4B, 0xA1, 0x13, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, -+0x60, 0x99, 0x6C, 0xEA, 0xC0, 0xF1, 0x1A, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0x17, 0xF0, 0x00, 0x4C, 0xD4, 0xF6, 0x0C, 0x4D, -+0x80, 0x18, 0xFE, 0x11, 0xCF, 0x11, 0x30, 0xF0, -+0x21, 0x6A, 0x90, 0xF4, 0x18, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x35, 0xF3, 0xFC, 0x9A, 0x91, 0x67, -+0x00, 0x6D, 0x18, 0x6E, 0x80, 0x18, 0xE2, 0x1E, -+0x09, 0xD2, 0x09, 0x93, 0x00, 0x6A, 0x01, 0x4B, -+0x01, 0x23, 0x01, 0x6A, 0x01, 0x6B, 0x4C, 0xEB, -+0x07, 0xD3, 0x60, 0xF2, 0x50, 0xA1, 0x00, 0x6B, -+0x08, 0xD3, 0x12, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF3, 0xFC, 0x9A, 0xA3, 0x67, 0x91, 0x67, -+0xB8, 0x6E, 0x80, 0x18, 0xE2, 0x1E, 0x08, 0xD2, -+0x08, 0x93, 0x00, 0x6A, 0x01, 0x4B, 0x01, 0x23, -+0x01, 0x6A, 0x07, 0x93, 0x4C, 0xEB, 0x07, 0xD3, -+0x0F, 0x58, 0x71, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF4, 0x40, 0x9A, 0x09, 0x93, 0x01, 0xF4, -+0x1C, 0x6C, 0x01, 0xF7, 0x00, 0x6D, 0x4C, 0xEB, -+0x0D, 0xEB, 0x06, 0xD3, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x00, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF4, 0xA4, 0x9B, -+0x61, 0xF0, 0x00, 0x6C, 0x61, 0xF1, 0x0A, 0x6E, -+0x40, 0xEA, 0x60, 0xF2, 0x50, 0xA1, 0x07, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x08, 0x93, 0x95, 0xF1, -+0x4C, 0x9A, 0x4D, 0xEB, 0x08, 0xD3, 0x0E, 0x70, -+0x20, 0x61, 0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, -+0x50, 0x9B, 0x01, 0x6D, 0x21, 0xF2, 0x04, 0x6C, -+0xAB, 0xED, 0x17, 0xF0, 0x1C, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x21, 0xF2, 0x08, 0x6C, 0xFF, 0xF7, 0x1F, 0x6D, -+0x00, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x01, 0x6D, 0xCE, 0xF4, 0x50, 0x9B, 0xA1, 0xF2, -+0x0C, 0x6C, 0xAB, 0xED, 0x66, 0xF6, 0x07, 0x6E, -+0x24, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x70, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF4, -+0xC8, 0x9A, 0x01, 0x6D, 0x21, 0xF2, 0x04, 0x6C, -+0xAB, 0xED, 0x40, 0xEB, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x21, 0xF2, 0x08, 0x6C, -+0xFF, 0xF7, 0x1F, 0x6D, 0x11, 0xF0, 0x10, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, -+0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, 0xD5, 0xF4, -+0xCC, 0x9B, 0x01, 0x6D, 0xA1, 0xF2, 0x0C, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0xE5, 0x10, 0x24, 0x58, -+0xC0, 0xF0, 0x16, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF4, 0x40, 0x9A, 0x09, 0x93, 0x4C, 0xEB, -+0x0D, 0xEB, 0x06, 0xD3, 0x68, 0x40, 0xE4, 0x4B, -+0xFF, 0x6A, 0x4C, 0xEB, 0x1D, 0x5B, 0x21, 0x61, -+0x68, 0x40, 0xA4, 0x4B, 0x4C, 0xEB, 0x29, 0x5B, -+0x05, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, -+0x44, 0x9A, 0x06, 0x10, 0x8D, 0x58, 0x08, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, 0x48, 0x9A, -+0x06, 0x93, 0x4D, 0xEB, 0x06, 0xD3, 0x0D, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, -+0x60, 0x99, 0x6C, 0xEA, 0x00, 0xF1, 0x04, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x17, 0xF1, 0x18, 0x4C, -+0xE3, 0x10, 0x68, 0x40, 0xE4, 0x4B, 0xFF, 0x6A, -+0x4C, 0xEB, 0x1D, 0x5B, 0x0A, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x01, 0xF4, -+0x1C, 0x6C, 0x01, 0xF7, 0x00, 0x6D, 0x01, 0x6E, -+0x1A, 0x10, 0x68, 0x40, 0xA4, 0x4B, 0x4C, 0xEB, -+0x2D, 0x5B, 0x0A, 0x60, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0x01, 0xF4, 0x1C, 0x6C, -+0x01, 0xF7, 0x00, 0x6D, 0x02, 0x6E, 0x0B, 0x10, -+0x95, 0x58, 0x11, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0x01, 0xF4, 0x1C, 0x6C, -+0x01, 0xF7, 0x00, 0x6D, 0x03, 0x6E, 0x40, 0xEA, -+0x68, 0x40, 0xE4, 0x4B, 0xFF, 0x6A, 0x4C, 0xEB, -+0x0D, 0x5B, 0x1B, 0x60, 0x0D, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, 0x60, 0x99, -+0x6C, 0xEA, 0xC0, 0xF0, 0x05, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x57, 0xF1, 0x08, 0x4C, 0xA4, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x9A, 0x61, 0xF0, 0x00, 0x6C, -+0xD5, 0xF4, 0xA4, 0x9B, 0x80, 0xF4, 0x14, 0x6E, -+0x35, 0x10, 0x68, 0x40, 0xD4, 0x4B, 0x4C, 0xEB, -+0x0D, 0x5B, 0x0D, 0x60, 0x30, 0xF0, 0x20, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x9A, -+0x61, 0xF0, 0x00, 0x6C, 0xD5, 0xF4, 0xA4, 0x9B, -+0x40, 0xF4, 0x13, 0x6E, 0x23, 0x10, 0x68, 0x40, -+0xA4, 0x4B, 0x4C, 0xEB, 0x11, 0x5B, 0x0D, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x9A, 0x61, 0xF0, 0x00, 0x6C, -+0xD5, 0xF4, 0xA4, 0x9B, 0x40, 0xF4, 0x12, 0x6E, -+0x11, 0x10, 0x68, 0x40, 0x92, 0x4B, 0x4C, 0xEB, -+0x3C, 0x5B, 0x11, 0x60, 0x30, 0xF0, 0x20, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x9A, -+0xD5, 0xF4, 0xA4, 0x9B, 0x61, 0xF0, 0x00, 0x6C, -+0x00, 0xF4, 0x12, 0x6E, 0x40, 0xEA, 0x60, 0xF2, -+0x50, 0xA1, 0x2E, 0x2A, 0x0C, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, 0x60, 0x99, -+0x6C, 0xEA, 0x72, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0x77, 0xF1, 0x18, 0x4C, 0x51, 0x10, 0x48, 0x40, -+0xCF, 0x4A, 0xFF, 0x6B, 0x6C, 0xEA, 0x13, 0x5A, -+0x07, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF4, -+0x50, 0x9A, 0x08, 0x93, 0x4C, 0xEB, 0x06, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x95, 0xF1, 0x4C, 0x9A, -+0x08, 0x93, 0x4D, 0xEB, 0x08, 0xD3, 0x0C, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, -+0x60, 0x99, 0x6C, 0xEA, 0x51, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0xB7, 0xF1, 0x0C, 0x4C, 0x30, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x35, 0xF3, 0x1C, 0x4B, -+0x06, 0x92, 0xE0, 0x9B, 0x91, 0x67, 0x00, 0x6D, -+0x18, 0x6E, 0x04, 0xD2, 0x80, 0x18, 0x08, 0x1F, -+0x07, 0x93, 0x4C, 0xEB, 0x07, 0xD3, 0x60, 0xF2, -+0x50, 0xA1, 0x11, 0x2A, 0x10, 0xF0, 0x24, 0x6B, -+0x35, 0xF3, 0x1C, 0x4B, 0x08, 0x92, 0xE0, 0x9B, -+0x91, 0x67, 0x00, 0x6D, 0xB8, 0x6E, 0x04, 0xD2, -+0x80, 0x18, 0x08, 0x1F, 0x07, 0x93, 0x4C, 0xEB, -+0xFF, 0x6A, 0x4C, 0xEB, 0x07, 0xD3, 0x07, 0x92, -+0x13, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, -+0x40, 0x9A, 0x60, 0x99, 0x6C, 0xEA, 0x20, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0xD7, 0xF1, 0x10, 0x4C, -+0x10, 0xF0, 0x24, 0x6D, 0xD4, 0xF6, 0x0C, 0x4D, -+0xD0, 0x67, 0x80, 0x18, 0xFE, 0x11, 0x14, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, -+0x60, 0x99, 0x6C, 0xEA, 0x0B, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, 0x17, 0xF2, -+0x1C, 0x4C, 0xD4, 0xF6, 0x0C, 0x4D, 0xD0, 0x67, -+0x80, 0x18, 0xFE, 0x11, 0x01, 0x6A, 0x01, 0x10, -+0x00, 0x6A, 0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, -+0x07, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0x6A, 0xAC, 0xEA, -+0x06, 0xD2, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, -+0x40, 0x9A, 0x60, 0x9C, 0x04, 0x67, 0x6C, 0xEA, -+0x0A, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, -+0x24, 0x6D, 0x57, 0xF2, 0x08, 0x4C, 0xF4, 0xF6, -+0x10, 0x4D, 0x80, 0x18, 0xFE, 0x11, 0x4B, 0xA0, -+0x13, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, -+0x40, 0x9A, 0x60, 0x98, 0x6C, 0xEA, 0xC0, 0xF0, -+0x13, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, -+0x24, 0x6D, 0x17, 0xF0, 0x00, 0x4C, 0xF4, 0xF6, -+0x10, 0x4D, 0x80, 0x18, 0xFE, 0x11, 0xC8, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, 0xFC, 0x9A, -+0x90, 0x67, 0x00, 0x6D, 0x18, 0x6E, 0x80, 0x18, -+0xE2, 0x1E, 0x07, 0xD2, 0x06, 0x92, 0x0F, 0x5A, -+0x48, 0x60, 0x30, 0xF0, 0x20, 0x69, 0x10, 0xF0, -+0x24, 0x6B, 0x35, 0xF1, 0xAC, 0x9B, 0xCE, 0xF4, -+0x50, 0x99, 0x01, 0xF0, 0x08, 0x6C, 0x01, 0x6E, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x99, 0x40, 0xF4, -+0x14, 0x6C, 0x80, 0x6D, 0x00, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x99, -+0x95, 0xF1, 0xA8, 0x9B, 0x81, 0xF2, 0x00, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x99, -+0x01, 0xF0, 0x14, 0x6C, 0x1F, 0xF4, 0x00, 0x6D, -+0x0F, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0xD5, 0xF4, 0x34, 0x9A, 0x07, 0x92, 0x4C, 0xE9, -+0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, 0x4D, 0xA2, -+0x03, 0x22, 0x90, 0x67, 0x00, 0x6D, 0x02, 0x10, -+0x90, 0x67, 0x01, 0x6D, 0x00, 0x18, 0x7B, 0xC6, -+0x10, 0xF0, 0x24, 0x6A, 0x35, 0xF3, 0xFC, 0x9A, -+0x90, 0x67, 0x00, 0x6D, 0x18, 0x6E, 0x04, 0xD1, -+0x80, 0x18, 0x08, 0x1F, 0x06, 0x95, 0x90, 0x67, -+0x22, 0x67, 0x80, 0x18, 0xA2, 0x1E, 0x43, 0x2A, -+0x71, 0x10, 0x06, 0x92, 0x24, 0x5A, 0x33, 0x61, -+0x30, 0xF0, 0x20, 0x69, 0x10, 0xF0, 0x24, 0x6B, -+0x95, 0xF1, 0xA8, 0x9B, 0xCE, 0xF4, 0x50, 0x99, -+0x81, 0xF2, 0x00, 0x6C, 0x01, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x99, 0x40, 0xF4, 0x14, 0x6C, -+0x80, 0x6D, 0x01, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x99, 0x35, 0xF1, -+0xAC, 0x9B, 0x01, 0xF0, 0x08, 0x6C, 0x00, 0x6E, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x99, 0x01, 0xF0, -+0x14, 0x6C, 0x1F, 0xF4, 0x00, 0x6D, 0x0F, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF4, -+0x34, 0x9A, 0x07, 0x92, 0x90, 0x67, 0x02, 0x6D, -+0x4C, 0xE9, 0x10, 0xF0, 0x24, 0x6A, 0xD5, 0xF4, -+0x58, 0x9A, 0x4D, 0xE9, 0xB7, 0x17, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, 0x60, 0x98, -+0x6C, 0xEA, 0x34, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0xB7, 0xF1, 0x0C, 0x4C, 0x14, 0x10, 0x07, 0x92, -+0x00, 0x6B, 0x01, 0x4A, 0x01, 0x22, 0x01, 0x6B, -+0xFF, 0x6A, 0x2C, 0xEA, 0x6C, 0xEA, 0x13, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, -+0x60, 0x98, 0x6C, 0xEA, 0x1F, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x77, 0xF2, 0x08, 0x4C, 0x06, 0x96, -+0x10, 0xF0, 0x24, 0x6D, 0xF4, 0xF6, 0x10, 0x4D, -+0x80, 0x18, 0xFE, 0x11, 0x13, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x75, 0xF1, 0x40, 0x9A, 0x60, 0x98, -+0x6C, 0xEA, 0x0E, 0x22, 0x06, 0x96, 0x10, 0xF0, -+0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, 0xB7, 0xF2, -+0x14, 0x4C, 0xF4, 0xF6, 0x10, 0x4D, 0x80, 0x18, -+0xFE, 0x11, 0x02, 0x10, 0x00, 0x6A, 0x01, 0x10, -+0x01, 0x6A, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x68, 0x0C, 0xED, -+0x24, 0x67, 0x0D, 0xD7, 0x04, 0xD5, 0xCC, 0xE8, -+0x80, 0x18, 0x2B, 0x21, 0x0F, 0x22, 0x04, 0x95, -+0x91, 0x67, 0x80, 0x18, 0x29, 0x20, 0x0A, 0x22, -+0x0D, 0x96, 0x91, 0x67, 0xB0, 0x67, 0x80, 0x18, -+0x52, 0x1F, 0x4B, 0xEB, 0x4D, 0xEB, 0xC0, 0xF7, -+0x62, 0x32, 0x01, 0x10, 0x00, 0x6A, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6B, 0x86, 0xF0, 0x99, 0xA3, -+0x30, 0xF0, 0x20, 0x6A, 0x1F, 0x6B, 0x8C, 0xEB, -+0x2F, 0xF5, 0x18, 0x4A, 0x20, 0xF6, 0x70, 0xC2, -+0xFF, 0x6D, 0xFF, 0x4B, 0xAC, 0xEB, 0x00, 0x6C, -+0x07, 0x5B, 0x20, 0xF6, 0x93, 0xC2, 0x08, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x68, 0x33, 0x54, 0xF7, -+0x10, 0x4A, 0x69, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x01, 0x6B, 0x20, 0xF6, 0x71, 0xC2, 0x20, 0xF6, -+0x92, 0xC2, 0x0A, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x18, 0x4A, 0x01, 0x6B, 0x20, 0xF6, -+0x71, 0xC2, 0x20, 0xF6, 0x72, 0xC2, 0x00, 0x6C, -+0x20, 0xF6, 0x95, 0xC2, 0x38, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0x01, 0x6B, -+0x20, 0xF6, 0x71, 0xC2, 0x08, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x01, 0x6B, 0x2F, 0xF5, 0x18, 0x4A, -+0x20, 0xF6, 0x71, 0xC2, 0x00, 0x6B, 0x20, 0xF6, -+0x72, 0xC2, 0x23, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF5, 0x18, 0x4A, 0x01, 0x6C, 0x00, 0x6B, -+0x20, 0xF6, 0x91, 0xC2, 0x20, 0xF6, 0x72, 0xC2, -+0xDF, 0x17, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF5, -+0x18, 0x4A, 0x00, 0x6B, 0x02, 0x6C, 0x20, 0xF6, -+0x71, 0xC2, 0x20, 0xF6, 0x75, 0xC2, 0x20, 0xF6, -+0x92, 0xC2, 0x01, 0x6B, 0x0C, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF5, 0x18, 0x4A, 0x01, 0x6B, -+0x00, 0x6C, 0x20, 0xF6, 0x71, 0xC2, 0x20, 0xF6, -+0x92, 0xC2, 0x20, 0xF6, 0x75, 0xC2, 0x20, 0xF6, -+0x74, 0xC2, 0x20, 0xE8, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xFF, 0x6A, 0x2F, 0xF5, 0x18, 0x4B, 0x8C, 0xEA, -+0x20, 0xF6, 0x91, 0xA3, 0x4F, 0x24, 0x20, 0xF6, -+0x73, 0xA3, 0x00, 0x69, 0x01, 0x23, 0x01, 0x69, -+0x30, 0xF0, 0x21, 0x6B, 0x70, 0xF3, 0x6C, 0xA3, -+0x02, 0x2B, 0x01, 0x6B, 0x6E, 0xE9, 0x05, 0x2A, -+0x3B, 0x10, 0x01, 0x6A, 0x4E, 0xE9, 0x04, 0xD2, -+0x02, 0x10, 0x00, 0x6A, 0x04, 0xD2, 0x10, 0xF0, -+0x24, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0xD5, 0xF4, -+0xBC, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x4C, 0x6C, -+0x02, 0x6E, 0x40, 0xEA, 0x04, 0x93, 0x14, 0x2B, -+0xCE, 0xF4, 0x50, 0x98, 0xA1, 0xF4, 0x14, 0x6C, -+0xFF, 0x6D, 0x77, 0x6E, 0x40, 0xEA, 0x01, 0x59, -+0x38, 0x67, 0x10, 0xF0, 0x24, 0x6B, 0x02, 0x6E, -+0xCE, 0xF4, 0x50, 0x98, 0xA1, 0xF4, 0x14, 0x6C, -+0x35, 0xF1, 0xB4, 0x9B, 0x3B, 0xE6, 0x12, 0x10, -+0xCE, 0xF4, 0x50, 0x98, 0xA1, 0xF4, 0x14, 0x6C, -+0xFF, 0x6D, 0x66, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x01, 0x59, 0xCE, 0xF4, 0x50, 0x98, -+0x35, 0xF1, 0xB4, 0x9B, 0xD8, 0x67, 0xA1, 0xF4, -+0x14, 0x6C, 0x01, 0x4E, 0x40, 0xEA, 0x06, 0x10, -+0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, 0x4D, 0xA2, -+0xC0, 0x22, 0xC3, 0x17, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0x6A, 0x4C, 0xEC, 0x0F, 0x5C, 0x09, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF4, 0x60, 0x9A, -+0xFC, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x20, 0xE8, 0x24, 0x5C, 0x0A, 0x61, 0x10, 0xF0, -+0x24, 0x6B, 0xF5, 0xF4, 0x80, 0x9B, 0x03, 0x6D, -+0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, -+0x60, 0xC4, 0x20, 0xE8, 0x10, 0xF0, 0x21, 0x6A, -+0x84, 0xF4, 0x08, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x8E, 0xF6, 0x48, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0x24, 0xF5, 0x00, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x8E, 0xF6, 0x4C, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0xC4, 0xF5, 0x14, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x8E, 0xF6, 0x50, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0x24, 0xF6, 0x08, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x8E, 0xF6, 0x54, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0x64, 0xF6, 0x04, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x8E, 0xF6, 0x58, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0xE4, 0xF6, 0x00, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x8E, 0xF6, 0x5C, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0xE4, 0xF7, 0x18, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF6, 0x40, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0x65, 0xF1, 0x14, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF6, 0x44, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0x45, 0xF2, 0x14, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF6, 0x48, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0x45, 0xF3, 0x08, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF6, 0x4C, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0xC5, 0xF5, 0x10, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF6, 0x50, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0xA5, 0xF7, 0x14, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF6, 0x54, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0xA5, 0xF7, 0x18, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF6, 0x58, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0x06, 0xF1, 0x18, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF6, 0x5C, 0xDB, 0x10, 0xF0, 0x21, 0x6A, -+0xC6, 0xF1, 0x0C, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF6, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0x99, 0x45, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+}; -+ -+u32 array_length_mp_8821c_fw_ap = 115224; -+ -+#endif /*defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ -+u8 array_mp_8821c_fw_nic[] = { -+0x21, 0x88, 0x00, 0x00, 0x18, 0x00, 0x05, 0x00, -+0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, -+0x09, 0x06, 0x0F, 0x12, 0xE3, 0x07, 0x00, 0x00, -+0x18, 0x00, 0x00, 0x00, 0x0C, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x20, 0x80, 0xE8, 0x7C, 0x00, 0x00, -+0x00, 0x00, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x58, 0xF1, 0x00, 0x00, 0x10, 0xAC, 0x00, 0x00, -+0x00, 0x00, 0x10, 0x80, 0x00, 0x00, 0x03, 0x80, -+0x00, 0x00, 0x04, 0x04, 0x08, 0x08, 0x08, 0x08, -+0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, -+0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, -+0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x03, 0x00, 0x01, 0xFE, 0x03, 0x01, 0x01, 0xFE, -+0x03, 0x02, 0x01, 0xFE, 0x03, 0x03, 0x01, 0xFE, -+0x03, 0x04, 0x01, 0xFE, 0x03, 0x05, 0x01, 0xFE, -+0x03, 0x06, 0x01, 0xFE, 0x03, 0x07, 0x01, 0xFE, -+0x06, 0x00, 0x00, 0x00, 0x05, 0x00, 0x00, 0x00, -+0x01, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, -+0x00, 0x01, 0x10, 0x00, 0x01, 0x00, 0x03, 0x80, -+0x9D, 0x01, 0x03, 0x80, 0x9D, 0x01, 0x03, 0x80, -+0xE5, 0x4F, 0x03, 0x80, 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, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x95, 0x4F, 0x03, 0x80, 0x01, 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, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x94, 0x83, 0x20, 0x80, 0x22, 0x05, 0x50, 0x05, -+0x51, 0x05, 0x1A, 0x15, 0x08, 0x08, 0x0C, 0x09, -+0x00, 0x0C, 0xB0, 0x0C, 0xB4, 0x0C, 0xBC, 0x0C, -+0x90, 0x19, 0xA4, 0x09, 0x04, 0x0A, 0x00, 0x0B, -+0x38, 0x08, 0x00, 0x00, 0xDF, 0xDE, 0x8F, 0x00, -+0x01, 0x00, 0x00, 0x00, 0x06, 0x09, 0x0C, 0x12, -+0x18, 0x24, 0x30, 0x36, 0x01, 0x02, 0x05, 0x0B, -+0x00, 0x00, 0x00, 0x00, 0x01, 0x02, 0x03, 0x06, -+0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x2C, -+0xFF, 0x00, 0x01, 0x02, 0x02, 0x04, 0x05, 0x06, -+0x07, 0x08, 0x09, 0x0A, 0x28, 0x28, 0x32, 0x28, -+0x1E, 0x19, 0x19, 0x19, 0x18, 0x18, 0x12, 0x0F, -+0x1E, 0x1E, 0x19, 0x1E, 0x18, 0x16, 0x0C, 0x0C, -+0x1E, 0x1E, 0x19, 0x1E, 0x18, 0x16, 0x0C, 0x0C, -+0x1E, 0x1E, 0x19, 0x1C, 0x18, 0x14, 0x0C, 0x0A, -+0x1E, 0x1E, 0x19, 0x1E, 0x19, 0x18, 0x0F, 0x0E, -+0x1E, 0x1E, 0x1E, 0x1E, 0x1C, 0x16, 0x14, 0x12, -+0x0C, 0x0A, 0x1E, 0x1E, 0x1E, 0x1E, 0x1A, 0x16, -+0x12, 0x10, 0x0C, 0x0A, 0x1E, 0x1E, 0x1E, 0x1E, -+0x18, 0x16, 0x0D, 0x0E, 0x0C, 0x0A, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x12, 0x12, 0x14, 0x12, 0x0F, 0x0F, 0x0C, 0x0C, -+0x09, 0x08, 0x08, 0x07, 0x0A, 0x0A, 0x09, 0x07, -+0x07, 0x06, 0x05, 0x04, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x0A, 0x0A, 0x08, 0x08, -+0x08, 0x07, 0x07, 0x06, 0x04, 0x04, 0x0C, 0x0C, -+0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, 0x05, 0x04, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x05, 0x04, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x02, 0x02, 0x02, 0x04, -+0x02, 0x04, 0x06, 0x06, 0x08, 0x08, 0x09, 0x09, -+0x04, 0x08, 0x08, 0x08, 0x0C, 0x10, 0x10, 0x18, -+0x04, 0x08, 0x08, 0x08, 0x0C, 0x10, 0x10, 0x18, -+0x05, 0x08, 0x08, 0x09, 0x10, 0x14, 0x1C, 0x20, -+0x04, 0x06, 0x08, 0x0A, 0x10, 0x18, 0x18, 0x20, -+0x03, 0x05, 0x08, 0x09, 0x10, 0x14, 0x1C, 0x24, -+0x2A, 0x2C, 0x05, 0x07, 0x09, 0x0A, 0x10, 0x14, -+0x1C, 0x28, 0x2C, 0x30, 0x06, 0x08, 0x0A, 0x0C, -+0x12, 0x18, 0x1E, 0x30, 0x38, 0x42, 0x0A, 0x0C, -+0x0C, 0x12, 0x16, 0x1C, 0x20, 0x24, 0x24, 0x30, -+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, 0x2C, 0x00, 0x04, 0x00, -+0x2D, 0x00, 0x2C, 0x01, 0x2D, 0x01, 0x2C, 0x02, -+0x2E, 0x01, 0xFF, 0x00, 0x2D, 0x02, 0xFF, 0x00, -+0x36, 0x2D, 0xFF, 0x36, 0x2E, 0xFF, 0x37, 0x2F, -+0xFF, 0x41, 0x38, 0x30, 0x39, 0x42, 0x31, 0x42, -+0x3A, 0x32, 0x43, 0x3A, 0x33, 0x43, 0x3A, 0x34, -+0x3A, 0x44, 0x35, 0x44, 0x3B, 0xFF, 0x37, 0x2E, -+0x40, 0x38, 0x30, 0x41, 0x39, 0x42, 0x31, 0x3A, -+0x43, 0x32, 0x3B, 0x43, 0x35, 0x3C, 0x44, 0xFF, -+0x3D, 0x45, 0xFF, 0x3E, 0x45, 0xFF, 0x45, 0x3F, -+0xFF, 0x46, 0xFF, 0xFF, 0x37, 0x41, 0x2F, 0x39, -+0x42, 0x31, 0x43, 0x3A, 0x33, 0x44, 0x3B, 0x35, -+0x45, 0x3D, 0xFF, 0x46, 0x47, 0x3E, 0x47, 0xFF, -+0xFF, 0x48, 0xFF, 0xFF, 0x49, 0xFF, 0xFF, 0xFF, -+0xFF, 0xFF, 0x00, 0x00, 0x0D, 0x14, 0xFF, 0x15, -+0x0E, 0xFF, 0x15, 0x0F, 0xFF, 0x16, 0x10, 0xFF, -+0x17, 0x1E, 0x11, 0x1E, 0x18, 0x12, 0x1F, 0x18, -+0x13, 0x18, 0x1F, 0xFF, 0x15, 0x0E, 0xFF, 0x16, -+0x1D, 0x10, 0x17, 0x1E, 0x10, 0x18, 0x1E, 0x11, -+0x19, 0x1F, 0xFF, 0x1A, 0x20, 0xFF, 0x21, 0x1B, -+0xFF, 0x21, 0xFF, 0xFF, 0x15, 0x13, 0x0F, 0x17, -+0x1E, 0x11, 0x18, 0x1F, 0x13, 0x20, 0x19, 0xFF, -+0x21, 0x1B, 0xFF, 0x22, 0xFF, 0xFF, 0x23, 0xFF, -+0xFF, 0xFF, 0xFF, 0xFF, 0x04, 0x04, 0x04, 0x36, -+0x2C, 0xFF, 0x2D, 0xFF, 0xFF, 0x2E, 0x37, 0xFF, -+0x38, 0x41, 0x2F, 0x39, 0x42, 0x30, 0x43, 0x39, -+0x31, 0x42, 0x39, 0x32, 0x43, 0x3A, 0x33, 0x43, -+0x3A, 0x34, 0x2D, 0x2C, 0xFF, 0x36, 0x2E, 0xFF, -+0x37, 0x2F, 0x40, 0x38, 0x30, 0x41, 0x42, 0x33, -+0x39, 0x43, 0x35, 0x3A, 0x3B, 0x43, 0x34, 0x44, -+0x3C, 0x3B, 0x45, 0x3D, 0x3C, 0x45, 0x3E, 0x3D, -+0x37, 0x2E, 0xFF, 0x38, 0x2F, 0x40, 0x39, 0x31, -+0x41, 0x3A, 0x42, 0xFF, 0x43, 0x3B, 0xFF, 0x44, -+0x3C, 0xFF, 0x45, 0x3D, 0x3C, 0x46, 0x3F, 0x45, -+0x47, 0x46, 0x45, 0x48, 0x47, 0x47, 0x00, 0x00, -+0x04, 0xFF, 0xFF, 0x0C, 0xFF, 0xFF, 0x0D, 0x14, -+0xFF, 0x0E, 0x15, 0xFF, 0x16, 0x0F, 0xFF, 0x17, -+0x10, 0xFF, 0x17, 0x11, 0xFF, 0x17, 0x12, 0xFF, -+0x0D, 0x0C, 0xFF, 0x14, 0x0E, 0xFF, 0x15, 0x0F, -+0xFF, 0x16, 0x1D, 0x10, 0x17, 0x1E, 0x12, 0x18, -+0x1F, 0x13, 0x19, 0x20, 0x19, 0x20, 0x1A, 0x19, -+0x14, 0x0E, 0xFF, 0x15, 0x1C, 0xFF, 0x17, 0x1D, -+0x11, 0x18, 0x1E, 0x13, 0x19, 0x1F, 0x1E, 0x20, -+0x1A, 0x1F, 0x21, 0x1B, 0x20, 0x22, 0x21, 0x1B, -+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, 0x30, 0x00, 0x00, 0x00, 0x00, -+0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, -+0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, -+0x24, 0x28, 0x2A, 0x2C, 0x2E, 0x30, 0x00, 0x00, -+0x00, 0x00, 0x26, 0x29, 0x2B, 0x2D, 0x2F, 0x31, -+0x00, 0x00, 0x00, 0x00, 0x28, 0x2A, 0x2C, 0x2E, -+0x30, 0x32, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, -+0x28, 0x2A, 0x2A, 0x2A, 0x01, 0x00, 0x02, 0x00, -+0x05, 0x00, 0x0B, 0x00, 0x06, 0x00, 0x09, 0x00, -+0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, -+0x30, 0x00, 0x36, 0x00, 0x0E, 0x00, 0x1B, 0x00, -+0x29, 0x00, 0x36, 0x00, 0x51, 0x00, 0x6C, 0x00, -+0x7A, 0x00, 0x87, 0x00, 0x1B, 0x00, 0x36, 0x00, -+0x51, 0x00, 0x6C, 0x00, 0xA2, 0x00, 0xD8, 0x00, -+0xF3, 0x00, 0x0E, 0x01, 0x29, 0x00, 0x51, 0x00, -+0x7A, 0x00, 0xA2, 0x00, 0xF3, 0x00, 0x44, 0x01, -+0x6D, 0x01, 0x95, 0x01, 0x36, 0x00, 0x6C, 0x00, -+0xA2, 0x00, 0xD8, 0x00, 0x44, 0x01, 0xB0, 0x01, -+0xE6, 0x01, 0x1C, 0x02, 0x0E, 0x00, 0x1B, 0x00, -+0x29, 0x00, 0x36, 0x00, 0x51, 0x00, 0x6C, 0x00, -+0x7A, 0x00, 0x87, 0x00, 0xA2, 0x00, 0xB4, 0x00, -+0x1B, 0x00, 0x36, 0x00, 0x51, 0x00, 0x6C, 0x00, -+0xA2, 0x00, 0xD8, 0x00, 0xF3, 0x00, 0xFF, 0x00, -+0x23, 0x01, 0x44, 0x01, 0x29, 0x00, 0x51, 0x00, -+0x7A, 0x00, 0xA2, 0x00, 0xF3, 0x00, 0x44, 0x01, -+0x64, 0x01, 0x64, 0x01, 0xB5, 0x01, 0xE6, 0x01, -+0x36, 0x00, 0x6C, 0x00, 0xA2, 0x00, 0xD8, 0x00, -+0x44, 0x01, 0xB0, 0x01, 0xE6, 0x01, 0x1C, 0x02, -+0x88, 0x02, 0xD0, 0x02, 0x14, 0x14, 0x15, 0x15, -+0x16, 0x17, 0x17, 0x18, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1D, 0x1D, 0x1E, 0x1E, 0x1C, 0x1C, 0x1D, 0x1E, -+0x1F, 0x20, 0x20, 0x20, 0x36, 0x36, 0x37, 0x37, -+0x38, 0x39, 0x39, 0x3A, 0x3A, 0x3A, 0x00, 0x00, -+0x40, 0x40, 0x40, 0x40, 0x41, 0x41, 0x42, 0x42, -+0x43, 0x43, 0x00, 0x00, 0x40, 0x40, 0x41, 0x42, -+0x43, 0x44, 0x44, 0x44, 0x45, 0x46, 0x00, 0x00, -+0x00, 0xF0, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x03, 0x00, 0x00, 0x00, 0x00, 0x30, 0xC0, -+0xE0, 0x00, 0x00, 0x00, 0x00, 0x0C, 0x0E, 0x38, -+0x18, 0x00, 0x00, 0x00, 0x00, 0x83, 0x01, 0x06, -+0x80, 0x03, 0x00, 0x00, 0x00, 0x00, 0x70, 0xE0, -+0x00, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x9A, 0x44, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x30, 0xF0, 0x21, 0x6C, 0x18, 0xF0, 0x00, 0x4C, -+0xBC, 0x65, 0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x77, 0xF0, -+0x20, 0x6C, 0x80, 0xF0, 0x80, 0x9C, 0x80, 0xF0, -+0x20, 0x6E, 0xCC, 0xEC, 0x1E, 0x24, 0x30, 0xF0, -+0x21, 0x6C, 0xF4, 0xF7, 0x1C, 0x4C, 0x80, 0x9C, -+0xBC, 0x65, 0x30, 0xF0, 0x21, 0x6C, 0xF4, 0xF7, -+0x18, 0x4C, 0x80, 0x9C, 0xFC, 0x65, 0x9F, 0x67, -+0x77, 0xF0, 0x24, 0x6D, 0xE0, 0xF2, 0x90, 0xDD, -+0x9D, 0x67, 0x77, 0xF0, 0x24, 0x6D, 0xE0, 0xF2, -+0x94, 0xDD, 0x9D, 0x67, 0x85, 0x9C, 0x77, 0xF0, -+0x24, 0x6D, 0xE0, 0xF2, 0x98, 0xDD, 0x20, 0xE8, -+0x00, 0x65, 0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, -+0x08, 0x4C, 0x00, 0x6E, 0x30, 0xF0, 0x20, 0x6F, -+0x2F, 0xF0, 0x08, 0x4F, 0xC0, 0xDC, 0x04, 0x4C, -+0xE3, 0xEC, 0xB8, 0x67, 0xFB, 0x2D, 0x30, 0xF0, -+0x21, 0x6C, 0x90, 0xF3, 0x14, 0x4C, 0x00, 0x6E, -+0x30, 0xF0, 0x21, 0x6F, 0xF0, 0xF4, 0x00, 0x4F, -+0xC0, 0xDC, 0x04, 0x4C, 0xE3, 0xEC, 0xB8, 0x67, -+0xFB, 0x2D, 0x30, 0xF0, 0x21, 0x6C, 0x15, 0xF0, -+0x00, 0x4C, 0x00, 0x6E, 0x30, 0xF0, 0x21, 0x6F, -+0x18, 0xF0, 0x00, 0x4F, 0xC0, 0xDC, 0x04, 0x4C, -+0xE3, 0xEC, 0xB8, 0x67, 0xFB, 0x2D, 0x10, 0xF0, -+0x23, 0x6C, 0xC0, 0xF0, 0x01, 0x4C, 0x00, 0xEC, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0xC0, 0xF0, 0x01, 0x4A, 0x40, 0xDB, -+0x00, 0x1C, 0x94, 0x00, 0x80, 0x18, 0x20, 0x07, -+0x80, 0x18, 0xFE, 0x05, 0x80, 0x18, 0x20, 0x06, -+0x80, 0x18, 0xE0, 0x06, 0x80, 0x18, 0x4C, 0x06, -+0x80, 0x18, 0xFC, 0x06, 0x80, 0x18, 0x34, 0x04, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF7, 0x54, 0x9A, -+0x30, 0xF0, 0x20, 0x68, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6C, 0x30, 0xF0, 0x21, 0x6A, 0x80, 0xF1, -+0x08, 0x4C, 0x15, 0xF0, 0x00, 0x4A, 0x43, 0xDC, -+0xCE, 0xF7, 0x40, 0x98, 0x00, 0x6D, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x2D, 0xF1, 0x50, 0xDB, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF7, 0x50, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x6F, 0xF0, 0x08, 0x4C, -+0x01, 0x6D, 0x40, 0xEA, 0x30, 0xF0, 0x21, 0x6B, -+0xD0, 0xF4, 0x54, 0xDB, 0x30, 0xF0, 0x20, 0x6C, -+0x30, 0xF0, 0x21, 0x6A, 0x2F, 0xF0, 0x08, 0x4C, -+0x15, 0xF4, 0x00, 0x4A, 0x43, 0xDC, 0xCE, 0xF7, -+0x40, 0x98, 0x00, 0x6D, 0x40, 0xEA, 0x30, 0xF0, -+0x21, 0x6B, 0xD0, 0xF4, 0x4C, 0xDB, 0x00, 0x18, -+0x9A, 0xE0, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF0, -+0x7C, 0x9A, 0xFF, 0xF7, 0x1F, 0x6C, 0x10, 0xF0, -+0x00, 0x6D, 0x40, 0xAB, 0xAB, 0xED, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF7, 0x58, 0x9A, 0x40, 0xEA, -+0x00, 0x1C, 0x95, 0x45, 0xFF, 0x17, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x6D, 0xB8, 0x00, 0x65, -+0x00, 0xF0, 0x20, 0x6A, 0x7C, 0x4A, 0x6C, 0xEA, -+0x1C, 0x22, 0x00, 0xF0, 0x20, 0x6B, 0x28, 0x4B, -+0x6A, 0xEA, 0x0B, 0x61, 0x4E, 0xB8, 0x00, 0x65, -+0x00, 0xF0, 0x20, 0x6B, 0x01, 0x4B, 0x6B, 0xE2, -+0x60, 0xAA, 0xBF, 0xF6, 0x1A, 0x6A, 0x6A, 0xEA, -+0x31, 0x60, 0x77, 0xF0, 0x24, 0x6A, 0xA0, 0xF1, -+0x1C, 0x4A, 0x1D, 0xF4, 0x00, 0x6B, 0x60, 0xDA, -+0x10, 0xF0, 0x23, 0x6A, 0x24, 0xF0, 0x19, 0x4A, -+0x00, 0xEA, 0x00, 0xF0, 0x20, 0x6A, 0x1F, 0xF7, -+0x00, 0x6A, 0x4C, 0xEB, 0x4C, 0xB8, 0x00, 0x65, -+0x6C, 0xEA, 0x42, 0x32, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF0, 0x00, 0x4B, 0x49, 0xE3, 0x40, 0xA2, -+0x30, 0xF0, 0x20, 0x6B, 0x40, 0xF1, 0x08, 0x4B, -+0x69, 0xE2, 0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, -+0x08, 0x4B, 0x60, 0x9B, 0x05, 0x2B, 0x10, 0xF0, -+0x23, 0x6B, 0x80, 0xF3, 0x01, 0x4B, 0x00, 0xEB, -+0x10, 0xF0, 0x23, 0x6B, 0x00, 0xF4, 0x15, 0x4B, -+0x00, 0xEB, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0x0D, 0xF1, 0x1C, 0x4A, 0x00, 0xF0, 0x20, 0x6B, -+0x01, 0x6B, 0x60, 0xDA, 0x10, 0xF0, 0x23, 0x6B, -+0x40, 0xF2, 0x09, 0x4B, 0x00, 0xEB, 0x00, 0x65, -+0x5A, 0xB8, 0x00, 0x65, 0x7B, 0xB8, 0x00, 0x65, -+0x40, 0xE8, 0x5A, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x7B, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, 0x0D, 0xF1, -+0x1C, 0x4A, 0x00, 0xF0, 0x20, 0x6B, 0x60, 0xDA, -+0x30, 0xF0, 0x20, 0x6A, 0x2D, 0xF1, 0x18, 0x4A, -+0x60, 0x9A, 0x41, 0x9A, 0x6A, 0xEA, 0x0D, 0x61, -+0x6E, 0xB8, 0x00, 0x65, 0x62, 0x43, 0xCB, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x5A, 0xB8, -+0x00, 0x65, 0x7B, 0xB8, 0x00, 0x65, 0x00, 0xBA, -+0x00, 0x65, 0x36, 0x23, 0xDF, 0xF7, 0x00, 0x03, -+0x86, 0xDB, 0xA7, 0xDB, 0xC8, 0xDB, 0xE9, 0xDB, -+0x0A, 0xDB, 0x2B, 0xDB, 0x98, 0x67, 0x8C, 0xDB, -+0x9F, 0x67, 0x8E, 0xDB, 0x12, 0xEC, 0x10, 0xED, -+0x82, 0xDB, 0xA3, 0xDB, 0x9A, 0xB8, 0x00, 0x65, -+0x84, 0xDB, 0x9B, 0xB8, 0x00, 0x65, 0x85, 0xDB, -+0x8E, 0xB8, 0x00, 0x65, 0x82, 0x44, 0x81, 0xDB, -+0x8C, 0xB8, 0x00, 0x65, 0x80, 0xDB, 0x30, 0xF0, -+0x20, 0x6B, 0x2D, 0xF1, 0x18, 0x4B, 0x60, 0x9B, -+0x9D, 0x67, 0x89, 0xDB, 0x6A, 0x9B, 0xCF, 0xF7, -+0x80, 0x44, 0x62, 0xEC, 0x0D, 0x60, 0x77, 0xF0, -+0x24, 0x6C, 0xA0, 0xF1, 0x1C, 0x4C, 0x1D, 0xF4, -+0x01, 0x6B, 0x60, 0xDC, 0x10, 0xF0, 0x23, 0x6C, -+0x24, 0xF0, 0x19, 0x4C, 0x00, 0xEC, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6B, 0x2D, 0xF1, 0x18, 0x4B, -+0x41, 0x9B, 0x40, 0xDB, 0x89, 0x9A, 0xBC, 0x65, -+0x7D, 0x67, 0xDF, 0xF7, 0x00, 0x03, 0x4C, 0xB8, -+0x00, 0x65, 0x00, 0xF0, 0x20, 0x6D, 0x05, 0x4D, -+0xAF, 0xED, 0xAC, 0xEA, 0xA0, 0x9B, 0x04, 0x6C, -+0x8C, 0xED, 0xAD, 0xEA, 0x82, 0x9B, 0xA3, 0x9B, -+0x32, 0xEC, 0x30, 0xED, 0x8E, 0x9B, 0xFC, 0x65, -+0x8C, 0x9B, 0x1C, 0x65, 0x84, 0x9B, 0x5C, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x85, 0x9B, -+0x7C, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x2B, 0x9B, 0x0A, 0x9B, 0xE9, 0x9B, 0xC8, 0x9B, -+0xA7, 0x9B, 0x86, 0x9B, 0x61, 0x9B, 0xCB, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x8A, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x7B, 0xB8, -+0x00, 0x65, 0x5A, 0xB8, 0x00, 0x65, 0x00, 0xBA, -+0xDF, 0xF7, 0x00, 0x03, 0x86, 0xDB, 0xA7, 0xDB, -+0xC8, 0xDB, 0xE9, 0xDB, 0x0A, 0xDB, 0x2B, 0xDB, -+0x98, 0x67, 0x8C, 0xDB, 0x9F, 0x67, 0x8E, 0xDB, -+0x12, 0xEC, 0x10, 0xED, 0x82, 0xDB, 0xA3, 0xDB, -+0x9A, 0xB8, 0x00, 0x65, 0x84, 0xDB, 0x9B, 0xB8, -+0x00, 0x65, 0x85, 0xDB, 0x7D, 0x67, 0x5B, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x40, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0xAD, 0xF1, 0x08, 0x4C, -+0x00, 0xF4, 0x00, 0x4C, 0xBC, 0x65, 0x82, 0x67, -+0x40, 0xEA, 0x00, 0x65, 0x7A, 0xB8, 0x00, 0x65, -+0xBB, 0x65, 0xDF, 0xF7, 0x00, 0x03, 0x82, 0x9B, -+0xA3, 0x9B, 0x32, 0xEC, 0x30, 0xED, 0x8E, 0x9B, -+0xFC, 0x65, 0x8C, 0x9B, 0x1C, 0x65, 0x84, 0x9B, -+0x5C, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x85, 0x9B, 0x7C, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x2B, 0x9B, 0x0A, 0x9B, 0xE9, 0x9B, -+0xC8, 0x9B, 0xA7, 0x9B, 0x86, 0x9B, 0x5A, 0xB8, -+0x00, 0x65, 0x7B, 0xB8, 0x00, 0x65, 0x00, 0xBA, -+0x00, 0x65, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0x0D, 0xF1, 0x1C, 0x4B, 0x40, 0xDB, 0xDF, 0xF7, -+0x00, 0x03, 0x86, 0xDB, 0xA7, 0xDB, 0xC8, 0xDB, -+0xE9, 0xDB, 0x0A, 0xDB, 0x2B, 0xDB, 0x98, 0x67, -+0x8C, 0xDB, 0x9F, 0x67, 0x8E, 0xDB, 0x12, 0xEC, -+0x10, 0xED, 0x82, 0xDB, 0xA3, 0xDB, 0x9A, 0xB8, -+0x00, 0x65, 0x84, 0xDB, 0x9B, 0xB8, 0x00, 0x65, -+0x85, 0xDB, 0x8E, 0xB8, 0x00, 0x65, 0x81, 0xDB, -+0x8C, 0xB8, 0x00, 0x65, 0x80, 0xDB, 0x30, 0xF0, -+0x20, 0x6B, 0x2D, 0xF1, 0x18, 0x4B, 0x60, 0x9B, -+0x9D, 0x67, 0x89, 0xDB, 0x6A, 0x9B, 0xCF, 0xF7, -+0x80, 0x44, 0x62, 0xEC, 0x0D, 0x60, 0x77, 0xF0, -+0x24, 0x6C, 0xA0, 0xF1, 0x1C, 0x4C, 0x1D, 0xF4, -+0x01, 0x6B, 0x60, 0xDC, 0x10, 0xF0, 0x23, 0x6C, -+0x24, 0xF0, 0x19, 0x4C, 0x00, 0xEC, 0x00, 0x65, -+0x40, 0x9A, 0x30, 0xF0, 0x20, 0x6C, 0xAD, 0xF1, -+0x08, 0x4C, 0x00, 0xF4, 0x00, 0x4C, 0xBC, 0x65, -+0x82, 0x67, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6C, -+0x0D, 0xF1, 0x1C, 0x4C, 0x00, 0xF0, 0x20, 0x6D, -+0xA0, 0xDC, 0x30, 0xF0, 0x20, 0x6A, 0x2D, 0xF1, -+0x18, 0x4A, 0x10, 0xF0, 0x23, 0x6B, 0xA0, 0xF4, -+0x1D, 0x4B, 0x00, 0xEB, 0x61, 0x9A, 0x60, 0xDA, -+0x49, 0x9B, 0xBA, 0x65, 0xDF, 0xF7, 0x00, 0x03, -+0x4C, 0xB8, 0x00, 0x65, 0x00, 0xF0, 0x20, 0x6D, -+0x05, 0x4D, 0xAF, 0xED, 0xAC, 0xEA, 0xA0, 0x9B, -+0x00, 0xF0, 0x20, 0x6C, 0x04, 0x4C, 0x8C, 0xED, -+0xAD, 0xEA, 0x82, 0x9B, 0xA3, 0x9B, 0x32, 0xEC, -+0x30, 0xED, 0x8E, 0x9B, 0xFC, 0x65, 0x8C, 0x9B, -+0x1C, 0x65, 0x84, 0x9B, 0x5C, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x85, 0x9B, 0x7C, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x2B, 0x9B, -+0x0A, 0x9B, 0xE9, 0x9B, 0xC8, 0x9B, 0xA7, 0x9B, -+0x86, 0x9B, 0x61, 0x9B, 0xCB, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x8A, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x7B, 0xB8, 0x00, 0x65, -+0x5A, 0xB8, 0x00, 0x65, 0x00, 0xBA, 0x00, 0x65, -+0x5F, 0x67, 0x5A, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x18, 0x66, 0xC0, 0x00, 0x1C, -+0xA9, 0x41, 0x5A, 0xB8, 0x00, 0x65, 0x00, 0xEA, -+0x6D, 0xB8, 0x00, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x00, 0x4A, 0x4F, 0xEA, 0x4C, 0xEB, 0xAB, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x5F, 0x67, -+0x5A, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x1C, 0x6C, 0x41, 0x5A, 0xB8, 0x00, 0x65, -+0x00, 0xEA, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x88, 0xC1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x7B, 0xC1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xB6, 0xC1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xFB, 0xC2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x18, 0xC3, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x75, 0xC1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xC0, 0xF5, 0x15, 0x4A, 0x40, 0xDB, 0x01, 0x4A, -+0x40, 0xDB, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x9B, 0xF6, 0x2C, 0x9A, 0x10, 0xF0, 0x23, 0x68, -+0xE0, 0xF5, 0x0D, 0x48, 0x00, 0xD9, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF3, 0x40, 0x9A, 0x01, 0x48, -+0x40, 0xEA, 0x00, 0xD9, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, 0x6C, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0x20, 0xF6, 0x01, 0x4A, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF4, -+0x58, 0x9A, 0xC0, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x7C, 0xF4, 0x5C, 0x9A, 0xA0, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF4, 0x40, 0x9A, 0x80, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF4, 0x44, 0x9A, -+0x40, 0x9A, 0x33, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x6C, 0x9A, 0x10, 0xF0, 0x24, 0x6F, -+0x1C, 0xF0, 0xE8, 0x9F, 0x40, 0x9B, 0xED, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF4, -+0x48, 0x9A, 0xFF, 0x6B, 0xC0, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF4, 0x4C, 0x9A, 0xA0, 0xDA, -+0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF4, 0x50, 0x9A, -+0x10, 0x6D, 0xAB, 0xED, 0x80, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF4, 0x94, 0x9A, 0x40, 0xA4, -+0x6C, 0xEA, 0xAC, 0xEA, 0x02, 0x6D, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF0, 0x9C, 0x9A, 0x80, 0x6D, 0xAB, 0xED, -+0x40, 0xA4, 0x6C, 0xEA, 0xAE, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, -+0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x20, 0xF6, -+0x02, 0x4A, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xC0, 0xF6, 0x19, 0x4A, 0x40, 0xDB, 0x00, 0x18, -+0x0C, 0xE3, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x6C, 0x9A, 0x6C, 0x23, 0x01, 0x6A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x3D, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x1E, 0xE6, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0x05, 0xE6, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x4C, 0x9A, 0x08, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x3E, 0xE3, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x4C, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x3F, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, 0x20, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x40, 0xE3, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, -+0x40, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0x41, 0xE3, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x4C, 0x9A, 0x80, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x01, 0xE6, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x6C, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xF9, 0xE5, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, 0x6C, 0x9B, -+0x04, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x42, 0xE3, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x6C, 0x9B, 0x08, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x43, 0xE3, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, 0x6C, 0x9B, -+0x10, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x44, 0xE3, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x70, 0x9A, 0xA0, 0xF1, 0x08, 0x23, -+0x01, 0x6A, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0xDF, 0xE5, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x50, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x45, 0xE3, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x50, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0xF4, 0xE3, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x5B, 0xF7, 0x40, 0x9A, 0x00, 0xF2, 0x74, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0xF4, 0xE3, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x1C, 0xF0, 0x48, 0x9A, 0x00, 0xF2, -+0x74, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, -+0x00, 0x18, 0xF4, 0xE3, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0xDB, 0xF7, 0x40, 0x9A, -+0x00, 0xF2, 0x74, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0xF4, 0xE3, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xFB, 0xF6, -+0x48, 0x9A, 0x00, 0xF2, 0x74, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, 0xF4, 0xE3, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x50, 0x9A, -+0x08, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0x46, 0xE3, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x5B, 0xF7, 0x44, 0x9A, -+0x00, 0xF2, 0x74, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0x46, 0xE3, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x9C, 0xF4, -+0x58, 0x9A, 0x00, 0xF2, 0x74, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x46, 0xE3, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x1C, 0xF0, 0x58, 0x9A, 0x00, 0xF2, 0x74, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, -+0x46, 0xE3, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xFB, 0xF6, 0x4C, 0x9A, 0x00, 0xF2, -+0x74, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0x46, 0xE3, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x50, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0x4C, 0xE3, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x5B, 0xF7, 0x48, 0x9A, 0x00, 0xF2, 0x74, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0x4C, 0xE3, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x3B, 0xF7, 0x50, 0x9A, 0x00, 0xF2, -+0x74, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, -+0x00, 0x18, 0x4C, 0xE3, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x3C, 0xF0, 0x58, 0x9A, -+0x00, 0xF2, 0x74, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0x4C, 0xE3, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xFB, 0xF6, -+0x54, 0x9A, 0x00, 0xF2, 0x74, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, 0x4C, 0xE3, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x50, 0x9A, -+0x20, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0x4D, 0xE3, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x5B, 0xF7, 0x4C, 0x9A, -+0x00, 0xF2, 0x74, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0x4D, 0xE3, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x7C, 0xF4, -+0x48, 0x9A, 0x00, 0xF2, 0x70, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x4D, 0xE3, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x9C, 0xF4, 0x5C, 0x9A, 0x00, 0xF2, 0x74, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, -+0x4D, 0xE3, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x54, 0x9A, 0x00, 0x52, 0x03, 0x60, 0x04, 0x6C, -+0x00, 0x18, 0x4D, 0xE3, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x70, 0x9B, 0x04, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, -+0xDE, 0xE4, 0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, -+0x70, 0x9B, 0x08, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0xF6, 0xE4, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, 0x70, 0x9B, -+0x10, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x04, 0x22, -+0x00, 0x18, 0x63, 0xE3, 0x00, 0x18, 0xDC, 0xEF, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x5B, 0xF7, 0x40, 0x9A, 0x00, 0xF2, 0x70, 0x9B, -+0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0x6B, 0xE3, -+0x00, 0x18, 0xE4, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x5B, 0xF7, 0x44, 0x9A, -+0x00, 0xF2, 0x70, 0x9B, 0x6C, 0xEA, 0x04, 0x22, -+0x00, 0x18, 0x73, 0xE3, 0x00, 0x18, 0xEC, 0xEF, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x50, 0x9A, -+0x40, 0x6B, 0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, -+0xBF, 0xE5, 0x00, 0x18, 0x69, 0xF5, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x50, 0x9A, 0x80, 0x6B, -+0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0x64, 0xE5, -+0x00, 0x18, 0x4C, 0xF2, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x70, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, -+0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0x9F, 0xE5, -+0x00, 0x18, 0x65, 0xF5, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x70, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0x49, 0xE5, -+0x00, 0x18, 0x48, 0xF2, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x70, 0x9B, 0x00, 0xF4, 0x00, 0x6A, -+0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0x7F, 0xE5, -+0x00, 0x18, 0x61, 0xF5, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x70, 0x9B, 0x01, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0x2E, 0xE5, -+0x00, 0x18, 0x44, 0xF2, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x70, 0x9B, 0x02, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x4E, 0xE3, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0xDB, 0xF7, 0x40, 0x9A, 0x00, 0xF2, 0x70, 0x9B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x7C, 0xE3, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x1C, 0xF0, 0x58, 0x9A, 0x00, 0xF2, 0x70, 0x9B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xDA, 0xE4, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x74, 0x9A, -+0x55, 0x23, 0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0xDE, 0xE4, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0xF6, 0xE4, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x54, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x02, 0x6C, 0x00, 0x18, 0xDE, 0xE4, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, 0x08, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, -+0xF6, 0xE4, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x54, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0xDE, 0xE4, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, 0x20, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, -+0xF6, 0xE4, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x54, 0x9A, 0x40, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x04, 0x6C, 0x00, 0x18, 0xDE, 0xE4, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, 0x80, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, -+0xF6, 0xE4, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, -+0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0xC0, 0xF6, -+0x1A, 0x4A, 0x40, 0xDB, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, -+0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0xE1, 0xF3, -+0x0D, 0x4A, 0x40, 0xDB, 0x00, 0x18, 0xDC, 0xE2, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x5C, 0x9A, -+0x22, 0x22, 0x00, 0x68, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x7C, 0x9B, 0x02, 0xF0, 0x00, 0x6A, -+0x44, 0xE8, 0x6C, 0xEA, 0x03, 0x22, 0x90, 0x67, -+0x00, 0x18, 0x29, 0xE6, 0x01, 0x48, 0x10, 0x70, -+0xF1, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x5C, 0x9A, 0x80, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x69, 0xE6, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xE1, 0xF3, 0x0E, 0x4A, 0x40, 0xDB, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0x61, 0xF4, 0x01, 0x4A, 0x40, 0xDB, 0x00, 0x18, -+0xE3, 0xE2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x7C, 0x9A, 0x61, 0x23, 0x08, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0xA0, 0xE3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x5C, 0x9A, -+0x02, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0x20, 0xE3, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x5C, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x65, 0xE6, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x5C, 0x9A, 0x20, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x61, 0xE6, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x5C, 0x9A, 0x40, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x25, 0xE3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x5C, 0x9A, -+0x80, 0x6B, 0x6C, 0xEA, 0x05, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x50, 0x9A, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x7C, 0x9B, -+0xFF, 0x6A, 0x01, 0x4A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x5D, 0xE6, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x7C, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x59, 0xE6, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0xBC, 0xF4, 0x40, 0x9A, 0xC0, 0xF1, 0x7C, 0x9B, -+0x6C, 0xEA, 0x0D, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF7, 0x40, 0x9A, 0x6C, 0xEA, 0x04, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0x7C, 0xE4, 0x03, 0x10, -+0x00, 0x6C, 0x00, 0x18, 0x82, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x60, 0x9A, 0x7D, 0x23, -+0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF4, 0x58, 0x9A, -+0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, -+0x1F, 0xE4, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x3B, 0xF7, 0x50, 0x9A, 0xE0, 0xF1, -+0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0x1F, 0xE4, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x7C, 0xF4, 0x48, 0x9A, -+0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x02, 0x6C, 0x00, 0x18, 0x1F, 0xE4, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xDB, 0xF7, -+0x40, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0x1F, 0xE4, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x1C, 0xF0, 0x58, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, -+0x1F, 0xE4, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x5B, 0xF7, 0x44, 0x9A, 0xE0, 0xF1, -+0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0x83, 0xE3, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x5B, 0xF7, 0x48, 0x9A, -+0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0xD3, 0xE3, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x5B, 0xF7, -+0x4C, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0xFE, 0xE3, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x1C, 0xF0, 0x48, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, -+0xBB, 0xE3, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x5B, 0xF7, 0x40, 0x9A, 0xE0, 0xF1, -+0x60, 0x9B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0x4E, 0xE6, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x64, 0x9A, 0x78, 0x23, 0x01, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0xC5, 0xE6, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x44, 0x9A, -+0x02, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x10, 0x6C, -+0x00, 0x18, 0x76, 0xE6, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x44, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x20, 0x6C, 0x00, 0x18, 0x76, 0xE6, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x44, 0x9A, -+0x08, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x30, 0x6C, -+0x00, 0x18, 0x76, 0xE6, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x44, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x40, 0x6C, 0x00, 0x18, 0x76, 0xE6, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x44, 0x9A, -+0x20, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x50, 0x6C, -+0x00, 0x18, 0x76, 0xE6, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x44, 0x9A, 0x40, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x60, 0x6C, 0x00, 0x18, 0x76, 0xE6, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x44, 0x9A, -+0x80, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x70, 0x6C, -+0x00, 0x18, 0x76, 0xE6, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x64, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0xC5, 0xE6, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x64, 0x9B, 0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0xC5, 0xE6, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x64, 0x9B, -+0x00, 0xF4, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0xC5, 0xE6, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x64, 0x9B, 0x01, 0xF0, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0xC5, 0xE6, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x68, 0x9A, 0xA0, 0xF0, 0x13, 0x23, -+0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0x37, 0xE6, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x10, 0x6C, 0x00, 0x18, 0x2E, 0xE6, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x48, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x20, 0x6C, -+0x00, 0x18, 0x2E, 0xE6, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x48, 0x9A, 0x08, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x30, 0x6C, 0x00, 0x18, 0x2E, 0xE6, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x48, 0x9A, -+0x10, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x40, 0x6C, -+0x00, 0x18, 0x2E, 0xE6, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x48, 0x9A, 0x20, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x50, 0x6C, 0x00, 0x18, 0x2E, 0xE6, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x48, 0x9A, -+0x40, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x60, 0x6C, -+0x00, 0x18, 0x2E, 0xE6, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x48, 0x9A, 0x80, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x70, 0x6C, 0x00, 0x18, 0x2E, 0xE6, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x68, 0x9B, -+0xFF, 0x6A, 0x01, 0x4A, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0x37, 0xE6, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x68, 0x9B, 0x00, 0xF2, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, -+0x00, 0x18, 0x37, 0xE6, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x68, 0x9B, 0x00, 0xF4, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, -+0x37, 0xE6, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x68, 0x9B, 0x01, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, 0x37, 0xE6, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x68, 0x9B, -+0x10, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0x6C, 0xC7, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xFB, 0xF6, -+0x48, 0x9A, 0xE0, 0xF1, 0x68, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, 0x6C, 0xC7, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0xFB, 0xF6, 0x4C, 0x9A, 0xE0, 0xF1, 0x68, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, -+0x6C, 0xC7, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xFB, 0xF6, 0x54, 0x9A, 0xE0, 0xF1, -+0x68, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, -+0x00, 0x18, 0x6C, 0xC7, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x48, 0x9A, 0x00, 0x52, 0x03, 0x60, -+0x04, 0x6C, 0x00, 0x18, 0x6C, 0xC7, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x6C, 0x9A, 0xC0, 0xF0, -+0x18, 0x23, 0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0x83, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0xD3, 0xE3, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x4C, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0xFE, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, 0x08, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0xBB, 0xE3, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x4C, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x02, 0x6C, 0x00, 0x18, 0x83, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, 0x20, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, -+0xD3, 0xE3, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x4C, 0x9A, 0x40, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x02, 0x6C, 0x00, 0x18, 0xFE, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, 0x80, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, -+0xBB, 0xE3, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x6C, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0x83, 0xE3, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, -+0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0xD3, 0xE3, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, 0x00, 0xF4, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, -+0x00, 0x18, 0xFE, 0xE3, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x6C, 0x9B, 0x01, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, -+0xBB, 0xE3, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x6C, 0x9B, 0x02, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, 0x83, 0xE3, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, -+0x04, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x04, 0x6C, 0x00, 0x18, 0xD3, 0xE3, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, 0x08, 0xF0, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0xFE, 0xE3, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x6C, 0x9B, 0x10, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, -+0xBB, 0xE3, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x5B, 0xF7, 0x40, 0x9A, 0xE0, 0xF1, -+0x6C, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0xA0, 0xE3, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x5B, 0xF7, 0x44, 0x9A, -+0xE0, 0xF1, 0x6C, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x02, 0x6C, 0x00, 0x18, 0xA0, 0xE3, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x5B, 0xF7, -+0x48, 0x9A, 0xE0, 0xF1, 0x6C, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0xA0, 0xE3, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x5B, 0xF7, 0x4C, 0x9A, 0xE0, 0xF1, 0x6C, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, -+0xA0, 0xE3, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, -+0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x61, 0xF4, -+0x02, 0x4A, 0x40, 0xDB, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0xC8, 0xF4, 0x12, 0x4C, -+0x00, 0x6D, 0x01, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, -+0x8A, 0xA2, 0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x08, 0xF3, 0x6A, 0xC2, 0x00, 0x6B, 0x08, 0xF3, -+0x6B, 0xC2, 0x08, 0xF3, 0x6C, 0xC2, 0x08, 0xF3, -+0x6D, 0xC2, 0x0C, 0x6B, 0x08, 0xF3, 0x6E, 0xC2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0x9B, 0xF7, 0x58, 0x9A, 0x60, 0xA2, -+0x42, 0x23, 0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x58, 0x9A, 0x02, 0x6B, -+0x30, 0xF0, 0x20, 0x68, 0x60, 0xC2, 0xC0, 0xF1, -+0x08, 0x48, 0x68, 0xF3, 0x79, 0xA0, 0x02, 0x6A, -+0xFF, 0x6C, 0x6C, 0xEA, 0x8C, 0xEA, 0x0B, 0x22, -+0x03, 0x6A, 0x4B, 0xEA, 0x4C, 0xEB, 0x68, 0xF3, -+0x79, 0xC0, 0x68, 0xF3, 0x7D, 0xA0, 0x6C, 0xEA, -+0x68, 0xF3, 0x5D, 0xC0, 0x24, 0x10, 0x88, 0xF3, -+0x45, 0xA0, 0x68, 0xF3, 0x7D, 0xA0, 0x01, 0x4A, -+0x88, 0xF3, 0x45, 0xC0, 0x11, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x68, 0xF3, 0x5D, 0xC0, 0x88, 0xF3, -+0x65, 0xA0, 0xE8, 0xF3, 0x44, 0xA0, 0x63, 0xEA, -+0x12, 0x60, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, 0xEF, 0xF6, -+0x81, 0xA3, 0x40, 0xEA, 0x01, 0x72, 0x07, 0x61, -+0x68, 0xF3, 0x79, 0xA0, 0x21, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x68, 0xF3, 0x59, 0xC0, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0x6A, 0x4C, 0xEC, 0x1F, 0x6B, 0x8C, 0xEB, -+0x96, 0x34, 0x4C, 0xEC, 0x01, 0x74, 0x0B, 0x60, -+0x05, 0x24, 0x02, 0x74, 0x0D, 0x60, 0x03, 0x74, -+0x10, 0x60, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0xFB, 0xF7, 0x88, 0x9A, 0x0E, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF7, 0x8C, 0x9A, 0x09, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF7, 0x90, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF7, -+0x94, 0x9A, 0xA0, 0x9C, 0x01, 0x6A, 0x44, 0xEB, -+0xAD, 0xEA, 0x40, 0xDC, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x4C, 0xEC, 0x1F, 0x6B, 0x8C, 0xEB, -+0x96, 0x34, 0x4C, 0xEC, 0x01, 0x74, 0x0B, 0x60, -+0x05, 0x24, 0x02, 0x74, 0x0D, 0x60, 0x03, 0x74, -+0x10, 0x60, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0xFB, 0xF7, 0x88, 0x9A, 0x0E, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF7, 0x8C, 0x9A, 0x09, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF7, 0x90, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF7, -+0x94, 0x9A, 0xA0, 0x9C, 0x01, 0x6A, 0x44, 0xEB, -+0x4F, 0xEA, 0xAC, 0xEA, 0x40, 0xDC, 0x20, 0xE8, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x05, 0x5A, 0x00, 0x68, -+0x24, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x48, 0x34, -+0x1B, 0xF2, 0x00, 0x4B, 0x8D, 0xE3, 0x60, 0x9B, -+0x00, 0xEB, 0x10, 0xF0, 0x24, 0x6B, 0x5B, 0xF7, -+0x78, 0x9B, 0x13, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x5B, 0xF7, 0x7C, 0x9B, 0x0E, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x7B, 0xF7, 0x60, 0x9B, 0x09, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x7B, 0xF7, 0x64, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x7B, 0xF7, -+0x68, 0x9B, 0x60, 0xAB, 0xFF, 0xF7, 0x1F, 0x68, -+0x6C, 0xE8, 0x18, 0xF0, 0x00, 0x6B, 0x0C, 0xEB, -+0x0F, 0x2B, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0x9D, 0xA3, 0x02, 0x6A, -+0x4B, 0xEA, 0x8C, 0xEA, 0x03, 0x6C, 0x8B, 0xEC, -+0x8C, 0xEA, 0x68, 0xF3, 0x5D, 0xC3, 0x79, 0x10, -+0x08, 0xF0, 0x00, 0x6B, 0x0C, 0xEB, 0x42, 0x23, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x68, 0xF3, 0xD4, 0xA3, 0x7F, 0x6D, 0xFF, 0x6C, -+0xCC, 0xED, 0x02, 0x75, 0x1F, 0x61, 0x68, 0xF3, -+0x57, 0xA3, 0x01, 0x6D, 0xAC, 0xEA, 0x8C, 0xEA, -+0x06, 0x2A, 0x68, 0xF3, 0x5D, 0xA3, 0x4D, 0xED, -+0x68, 0xF3, 0xBD, 0xC3, 0x21, 0x10, 0x68, 0xF3, -+0xB5, 0xA3, 0x10, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, -+0x8C, 0xEA, 0x10, 0x72, 0x2E, 0x61, 0x68, 0xF3, -+0x9D, 0xA3, 0x04, 0x6A, 0x00, 0x6D, 0x8D, 0xEA, -+0x68, 0xF3, 0x5D, 0xC3, 0x01, 0x6C, 0x00, 0x18, -+0x30, 0xD2, 0x23, 0x10, 0x68, 0xF3, 0xDD, 0xA3, -+0x01, 0x6D, 0xCD, 0xED, 0x68, 0xF3, 0xBD, 0xC3, -+0x68, 0xF3, 0xB5, 0xA3, 0x10, 0x6B, 0x6B, 0xEB, -+0xAC, 0xEB, 0x8C, 0xEB, 0x20, 0x73, 0x06, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0x0F, 0x10, 0x82, 0x67, 0x00, 0x18, -+0x58, 0xCE, 0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x9D, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, -+0x7D, 0xC2, 0x02, 0x30, 0x1E, 0x30, 0x1A, 0x20, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x5D, 0xA0, 0x02, 0x69, 0xE8, 0xF3, -+0xC5, 0xA0, 0x2D, 0xEA, 0x68, 0xF3, 0x5D, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, -+0xFF, 0x6C, 0x55, 0x4C, 0x00, 0x6D, 0x40, 0xEA, -+0x68, 0xF3, 0x59, 0xA0, 0x4D, 0xE9, 0x68, 0xF3, -+0x39, 0xC0, 0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x9D, 0xA2, -+0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, -+0x7D, 0xC2, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x68, 0x8C, 0xE8, 0x00, 0x18, -+0x0B, 0xC9, 0x03, 0x2A, 0x90, 0x67, 0x00, 0x18, -+0x4F, 0xCE, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xCA, 0xEF, 0x01, 0x72, 0x01, 0x6C, -+0x01, 0x60, 0x02, 0x6C, 0x00, 0x18, 0x55, 0xF3, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF6, 0x7E, 0xAB, -+0xFF, 0x6A, 0x4C, 0xEC, 0x71, 0xE4, 0x4C, 0xEC, -+0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF7, 0x44, 0x9A, -+0x80, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF7, -+0x58, 0x9A, 0x80, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0xA4, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0xCF, 0xF6, 0x18, 0x4C, 0x05, 0x6E, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x5B, 0xF7, 0x00, 0x4B, -+0x30, 0xF0, 0x20, 0x69, 0xFF, 0x68, 0xAC, 0xE8, -+0xCE, 0xF4, 0x50, 0x99, 0xA0, 0x9B, 0x82, 0xF0, -+0x00, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x3C, 0xF0, 0xB8, 0x9B, 0xCE, 0xF4, -+0x50, 0x99, 0x00, 0x6C, 0x01, 0x6E, 0x40, 0xEA, -+0x01, 0x6D, 0xA1, 0xF4, 0x18, 0x6C, 0xAB, 0xED, -+0x00, 0x18, 0xE4, 0xE6, 0x01, 0x70, 0x0F, 0x60, -+0x03, 0x20, 0x02, 0x70, 0x16, 0x60, 0x1F, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x5B, 0xF7, 0x00, 0x4B, -+0x60, 0x9B, 0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xFC, 0xF1, 0x7C, 0x9B, 0x13, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x1C, 0xF2, 0x60, 0x9B, 0x6D, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF2, 0x64, 0x9B, -+0x09, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF2, -+0x68, 0x9B, 0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x1C, 0xF2, 0x6C, 0x9B, 0x6C, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xCE, 0xF4, 0x70, 0x9B, 0x01, 0x6D, -+0xA1, 0xF4, 0x18, 0x6C, 0xAB, 0xED, 0xC2, 0x67, -+0x40, 0xEB, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFF, 0x6A, 0x4C, 0xED, -+0xFF, 0x75, 0x4C, 0xEC, 0xCC, 0xEA, 0x06, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x71, 0xE4, 0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x71, 0xE4, 0x0C, 0xF7, -+0x7E, 0xA4, 0xAC, 0xEA, 0xAF, 0xED, 0x6C, 0xED, -+0xAD, 0xEA, 0x0C, 0xF7, 0x5E, 0xC4, 0x20, 0xE8, -+0xF7, 0x63, 0x11, 0x62, 0x10, 0xD1, 0x0F, 0xD0, -+0x40, 0xA4, 0x08, 0xD2, 0x08, 0x93, 0x1F, 0x6A, -+0x4C, 0xEB, 0x08, 0xD3, 0x42, 0xA4, 0x61, 0xA4, -+0x0B, 0xD2, 0x43, 0xA4, 0x84, 0xA4, 0x09, 0xD4, -+0x08, 0x94, 0x08, 0x5C, 0x80, 0xF0, 0x11, 0x60, -+0x84, 0x30, 0x09, 0x94, 0x01, 0x2C, 0x28, 0x22, -+0xFF, 0x69, 0x2C, 0xEA, 0x2C, 0xEB, 0xA2, 0x67, -+0xC3, 0x67, 0x90, 0x67, 0x0C, 0xD2, 0x0D, 0xD3, -+0x00, 0x18, 0xB1, 0xC5, 0x0B, 0x94, 0x09, 0x93, -+0x41, 0x40, 0x2C, 0xEC, 0x0B, 0xD4, 0x0B, 0x96, -+0x2C, 0xEA, 0x2C, 0xEB, 0x82, 0x67, 0xA3, 0x67, -+0x30, 0xF0, 0x20, 0x69, 0x0A, 0xD2, 0x09, 0xD3, -+0x00, 0x18, 0xB1, 0xC5, 0xCE, 0xF2, 0x44, 0x99, -+0x0C, 0x95, 0x0D, 0x96, 0x90, 0x67, 0x01, 0x6F, -+0x40, 0xEA, 0xCE, 0xF2, 0x44, 0x99, 0x0A, 0x94, -+0x09, 0x95, 0x0B, 0x96, 0x02, 0x6F, 0x40, 0xEA, -+0x0F, 0x58, 0x08, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x08, 0x33, 0x1B, 0xF5, 0x1C, 0x4A, 0x69, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x00, 0x6A, 0x44, 0x10, -+0xD0, 0xF4, 0x44, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF2, 0x58, 0x9A, 0x34, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF7, 0x48, 0x9A, 0x2F, 0x10, -+0x80, 0xF4, 0x44, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF2, 0x5C, 0x9A, 0x24, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF7, 0x54, 0x9A, 0x1F, 0x10, -+0xC0, 0xF4, 0x48, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF2, 0x40, 0x9A, 0x14, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFC, 0xF2, 0x44, 0x9A, 0x0F, 0x10, -+0x70, 0xF4, 0x48, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF2, 0x48, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFC, 0xF2, 0x4C, 0x9A, 0x49, 0xE0, -+0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x6A, 0x6C, 0xEA, -+0x7D, 0x67, 0x53, 0xC3, 0x42, 0x32, 0x54, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x41, 0xE0, 0x0C, 0xF7, 0x5E, 0xA0, 0x55, 0xC3, -+0x0C, 0xF7, 0x5F, 0xA0, 0x56, 0xC3, 0x2C, 0xF7, -+0x4E, 0xA0, 0x57, 0xC3, 0x2C, 0xF7, 0x4F, 0xA0, -+0x58, 0xC3, 0x9D, 0x67, 0x21, 0x6A, 0x50, 0xC4, -+0x07, 0x6A, 0x4F, 0xCC, 0x47, 0x44, 0x19, 0x4A, -+0x40, 0xA2, 0x52, 0xC4, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, 0x40, 0xEA, -+0x11, 0x97, 0x10, 0x91, 0x0F, 0x90, 0x09, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0xFF, 0x74, 0xAC, 0xEA, 0x05, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0x0D, 0xF1, 0x46, 0xC3, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x2C, 0xF7, 0xBE, 0xA3, 0x8C, 0xEA, 0x8F, 0xEC, -+0xAC, 0xEC, 0x8D, 0xEA, 0x2C, 0xF7, 0x5E, 0xC3, -+0x20, 0xE8, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x01, 0xA4, 0x20, 0xA4, -+0x0C, 0x20, 0x90, 0x67, 0xB1, 0x67, 0x00, 0x18, -+0x1B, 0xC6, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x90, 0x67, 0xB1, 0x67, 0x53, 0x6E, -+0x40, 0xEA, 0x7D, 0x67, 0x20, 0x6A, 0x50, 0xC3, -+0x03, 0x6A, 0x4F, 0xCB, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x5C, 0x9A, 0x9D, 0x67, 0x40, 0xA2, -+0x52, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x2C, 0xF7, 0x7E, 0xA2, 0x2C, 0xF7, -+0x5F, 0xA2, 0x73, 0xC4, 0x54, 0xC4, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, -+0x40, 0xEA, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA4, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0xEF, 0xF6, -+0x00, 0x4C, 0x07, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF6, 0x40, 0xA2, 0x05, 0x5A, -+0x13, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, -+0x5B, 0xF5, 0x18, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, -+0x00, 0xEA, 0x00, 0x6C, 0x07, 0x10, 0x01, 0x6C, -+0x05, 0x10, 0x02, 0x6C, 0x03, 0x10, 0x03, 0x6C, -+0x01, 0x10, 0x04, 0x6C, 0x00, 0x18, 0xCA, 0xE1, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x69, 0xF3, 0x48, 0xA3, 0x1F, 0x6C, 0x01, 0x6D, -+0x4A, 0x32, 0x8C, 0xEA, 0x30, 0xF0, 0x20, 0x6C, -+0xEF, 0xF6, 0x80, 0xA4, 0x47, 0xEC, 0xAC, 0xEA, -+0x03, 0x22, 0x69, 0xF3, 0x89, 0xC3, 0x04, 0x10, -+0x01, 0x6A, 0x4B, 0xEA, 0x69, 0xF3, 0x49, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x1C, 0x23, 0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x69, 0xF3, 0x68, 0xC2, 0x00, 0x18, 0xE1, 0xE8, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x04, 0x93, -+0xCF, 0xF5, 0x58, 0x9A, 0x6E, 0xEA, 0x03, 0x22, -+0x04, 0x94, 0x00, 0x18, 0x02, 0xE9, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF3, -+0x88, 0xA2, 0x02, 0x6B, 0x8D, 0xEB, 0x69, 0xF3, -+0x68, 0xC2, 0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0xA4, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0xAF, 0xF5, 0x0C, 0x4C, 0x04, 0x6E, -+0x40, 0xEA, 0x00, 0x18, 0xC0, 0xCB, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF3, 0x04, 0x9A, 0x0A, 0xD4, 0xFF, 0x69, -+0x40, 0xA0, 0x0A, 0x95, 0x30, 0xF0, 0x20, 0x6C, -+0x62, 0x67, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x50, 0x9A, 0x2C, 0xEB, 0x05, 0xD3, 0xC8, 0xF4, -+0x12, 0x4C, 0x01, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF3, 0x68, 0x9A, 0xF8, 0x6A, -+0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF3, 0x4C, 0x9A, 0x02, 0x6B, -+0x00, 0x6C, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6B, -+0x1C, 0xF3, 0x70, 0x9B, 0x80, 0xC3, 0x10, 0xF0, -+0x24, 0x6B, 0x1C, 0xF3, 0x74, 0x9B, 0x20, 0x6C, -+0x80, 0xC3, 0x40, 0xA2, 0x10, 0xF0, 0x24, 0x6B, -+0x1C, 0xF3, 0x78, 0x9B, 0x2C, 0xEA, 0x50, 0x32, -+0x01, 0x4A, 0x2C, 0xEA, 0x40, 0xC3, 0x0A, 0x94, -+0x02, 0x6B, 0x40, 0xA4, 0x6C, 0xEA, 0x2C, 0xEA, -+0xA0, 0xF0, 0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6C, -+0xC0, 0xF1, 0x08, 0x4C, 0x04, 0xD4, 0x08, 0xF3, -+0x6A, 0xA4, 0x01, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x80, 0xF0, 0x13, 0x22, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x54, 0x9B, 0x01, 0x6C, 0xC0, 0x6D, -+0x40, 0xEA, 0x04, 0x92, 0x05, 0x94, 0x20, 0x68, -+0x08, 0xF3, 0x6A, 0xA2, 0x04, 0x6A, 0x8D, 0xE8, -+0x6C, 0xEA, 0x2C, 0xEA, 0x2C, 0xE8, 0x1A, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, 0x5C, 0x9A, -+0x01, 0x6C, 0x10, 0xF0, 0x00, 0x6D, 0x60, 0xA2, -+0x2C, 0xEB, 0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x54, 0x9B, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x68, 0x9A, 0x02, 0x6C, -+0x40, 0xA3, 0x2C, 0xEA, 0x8D, 0xEA, 0x2C, 0xEA, -+0x40, 0xC3, 0x0A, 0x10, 0x04, 0x93, 0x01, 0x6C, -+0x10, 0xF0, 0x00, 0x6D, 0x08, 0xF3, 0x4B, 0xC3, -+0x08, 0xF3, 0x4C, 0xC3, 0x00, 0x18, 0x42, 0xE1, -+0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, 0x92, 0xA2, -+0x08, 0x6A, 0xFF, 0x6B, 0x8C, 0xEA, 0x0D, 0x22, -+0x02, 0x6A, 0x4D, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x88, 0x9A, 0x01, 0x6D, 0x6C, 0xE8, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, -+0x92, 0xA2, 0x10, 0x6A, 0xFF, 0x6B, 0x8C, 0xEA, -+0x0D, 0x22, 0x04, 0x6A, 0x4D, 0xE8, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x88, 0x9A, 0x01, 0x6D, -+0x6C, 0xE8, 0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x30, 0xF0, 0x20, 0x6A, -+0xC8, 0xF4, 0x72, 0xA2, 0x20, 0x6A, 0x6C, 0xEA, -+0x05, 0x22, 0x80, 0x6A, 0x4B, 0xEA, 0x4D, 0xE8, -+0xFF, 0x6A, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xC8, 0xF4, 0x72, 0xA2, 0x40, 0x6A, 0x4C, 0xEB, -+0x03, 0x2B, 0x4D, 0xE8, 0xFF, 0x6A, 0x4C, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, 0x44, 0x9A, -+0x00, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, -+0x55, 0xA2, 0x03, 0x2A, 0x01, 0x6C, 0x00, 0x18, -+0x55, 0xF3, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, -+0x72, 0xA2, 0x40, 0x6A, 0x04, 0x6C, 0x6C, 0xEA, -+0x05, 0x2A, 0x00, 0x18, 0xCA, 0xEF, 0x01, 0x6C, -+0x01, 0x2A, 0x02, 0x6C, 0x00, 0x18, 0x55, 0xF3, -+0xA9, 0x10, 0x40, 0xC0, 0x04, 0x94, 0x08, 0xF3, -+0x4D, 0xA4, 0x04, 0x72, 0xC0, 0xF0, 0x0F, 0x61, -+0x00, 0x6C, 0x00, 0x18, 0x55, 0xF3, 0xCB, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x04, 0xD2, 0x08, 0xF3, 0x4A, 0xA2, 0x01, 0x6B, -+0x6C, 0xEA, 0x2C, 0xEA, 0x80, 0xF0, 0x19, 0x22, -+0x30, 0xF0, 0x20, 0x6C, 0x4E, 0xF2, 0x54, 0x9C, -+0xC0, 0x6D, 0x83, 0x67, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xDB, 0xF6, 0x08, 0x4B, 0x05, 0x92, -+0x60, 0x9B, 0x20, 0x68, 0x4D, 0xE8, 0x40, 0xA3, -+0x01, 0x6C, 0x2C, 0xE8, 0x2C, 0xEA, 0x8D, 0xEA, -+0x2C, 0xEA, 0x40, 0xC3, 0x04, 0x94, 0x04, 0x6A, -+0x08, 0xF3, 0x6A, 0xA4, 0x6C, 0xEA, 0x2C, 0xEA, -+0x1B, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, -+0x5C, 0x9A, 0x01, 0x6C, 0x10, 0xF0, 0x00, 0x6D, -+0x60, 0xA2, 0x2C, 0xEB, 0x60, 0xC2, 0x30, 0xF0, -+0x20, 0x6B, 0x4E, 0xF2, 0x54, 0x9B, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6C, 0xDB, 0xF6, 0x08, 0x4C, -+0x80, 0x9C, 0x02, 0x6B, 0x40, 0xA4, 0x2C, 0xEA, -+0x6D, 0xEA, 0x2C, 0xEA, 0x40, 0xC4, 0x05, 0x10, -+0x01, 0x6C, 0x10, 0xF0, 0x00, 0x6D, 0x00, 0x18, -+0x42, 0xE1, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, -+0x72, 0xA2, 0x08, 0x6A, 0x6C, 0xEA, 0x04, 0x22, -+0x02, 0x6A, 0x4D, 0xE8, 0xFF, 0x6A, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, 0x72, 0xA2, -+0x10, 0x6A, 0x6C, 0xEA, 0x04, 0x22, 0x04, 0x6A, -+0x4D, 0xE8, 0xFF, 0x6A, 0x4C, 0xE8, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF3, 0x64, 0x9A, 0x40, 0x6D, -+0xFF, 0x6C, 0x00, 0xC3, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x08, 0xF3, 0x4A, 0xA0, -+0xAC, 0xEA, 0x0B, 0x22, 0x08, 0xF3, 0x4E, 0xA0, -+0x02, 0x72, 0x2C, 0x60, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x02, 0x6C, 0x00, 0x6D, -+0x1E, 0x10, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0x8C, 0xEA, 0x40, 0xC3, 0x08, 0xF3, 0x4E, 0xA0, -+0x02, 0x72, 0x18, 0x61, 0x00, 0x18, 0xC2, 0xCC, -+0x00, 0x18, 0xCA, 0xEF, 0x01, 0x72, 0x09, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x68, 0xF3, 0x98, 0xA0, 0x01, 0x6D, 0x00, 0x6E, -+0x07, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x00, 0x6C, 0xA4, 0x67, 0xC5, 0x67, -+0x40, 0xEA, 0x04, 0x10, 0x68, 0xF3, 0x5C, 0xA0, -+0x08, 0xF3, 0x4E, 0xC0, 0x10, 0xF0, 0x24, 0x6A, -+0x3C, 0xF3, 0x40, 0x9A, 0x22, 0x6B, 0x60, 0xC2, -+0x26, 0x10, 0x40, 0xC0, 0x04, 0x93, 0x08, 0xF3, -+0x4E, 0xA3, 0x02, 0x72, 0x06, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x04, 0x6C, -+0x07, 0x10, 0x08, 0x72, 0x08, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x0C, 0x6C, -+0x01, 0x6D, 0x00, 0x6E, 0x40, 0xEA, 0x00, 0x6C, -+0x00, 0x18, 0x65, 0xC5, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x48, 0xF5, 0x80, 0xA3, 0x01, 0x6D, 0x00, 0x6E, -+0x40, 0xEA, 0x00, 0x18, 0xA3, 0xC4, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x64, 0x67, -+0x4C, 0xEB, 0x87, 0x67, 0x01, 0x73, 0x4C, 0xED, -+0x4C, 0xEE, 0x4C, 0xEC, 0x06, 0x61, 0x01, 0x75, -+0x02, 0x61, 0x01, 0x76, 0x07, 0x60, 0x00, 0x6D, -+0x0A, 0x10, 0x01, 0x75, 0x06, 0x61, 0x01, 0x76, -+0x01, 0x6D, 0x05, 0x60, 0x00, 0x18, 0xF6, 0xDE, -+0x04, 0x10, 0x01, 0x5B, 0xB8, 0x67, 0x00, 0x18, -+0xEB, 0xDE, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x68, -+0x8C, 0xE8, 0x90, 0x67, 0x00, 0x18, 0x20, 0xCC, -+0x90, 0x67, 0x00, 0x18, 0x14, 0xEC, 0x01, 0x6C, -+0x00, 0x18, 0x33, 0xCA, 0x90, 0x67, 0x00, 0x18, -+0xE4, 0xCB, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0xE0, 0xF1, 0x7F, 0xA2, 0x0B, 0x2B, -+0xC0, 0xF0, 0x79, 0xA2, 0x07, 0x6A, 0x6C, 0xEA, -+0x4E, 0xE8, 0x05, 0x28, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF3, 0x5C, 0x9A, 0x40, 0xEA, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x6A, 0x27, 0x67, 0x4C, 0xE9, 0x6F, 0x41, -+0x4C, 0xEB, 0x04, 0x67, 0x02, 0x5B, 0x4C, 0xE8, -+0x4C, 0xED, 0x4C, 0xEE, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0x31, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x49, 0xE0, 0x0C, 0xF7, -+0x7E, 0xA2, 0x2C, 0xF7, 0x4E, 0xA2, 0x10, 0x58, -+0x6D, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x49, 0x60, -+0x10, 0xF0, 0x24, 0x6B, 0x08, 0x34, 0xFB, 0xF5, -+0x00, 0x4B, 0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, -+0xD0, 0xF4, 0x64, 0x40, 0x1F, 0xF7, 0x00, 0x6C, -+0x8C, 0xEB, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xDC, 0xF2, 0x78, 0x9B, 0x34, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xFB, 0xF7, 0x68, 0x9B, 0x2F, 0x10, -+0x80, 0xF4, 0x64, 0x40, 0x1F, 0xF7, 0x00, 0x6C, -+0x8C, 0xEB, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xDC, 0xF2, 0x7C, 0x9B, 0x24, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xFB, 0xF7, 0x74, 0x9B, 0x1F, 0x10, -+0xC0, 0xF4, 0x68, 0x40, 0x1F, 0xF7, 0x00, 0x6C, -+0x8C, 0xEB, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xFC, 0xF2, 0x60, 0x9B, 0x14, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xFC, 0xF2, 0x64, 0x9B, 0x0F, 0x10, -+0x70, 0xF4, 0x68, 0x40, 0x1F, 0xF7, 0x00, 0x6C, -+0x8C, 0xEB, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xFC, 0xF2, 0x68, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xFC, 0xF2, 0x6C, 0x9B, 0x61, 0xE0, -+0x40, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, -+0x3B, 0xC2, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x4C, 0x9A, -+0x42, 0xF1, 0x18, 0x6C, 0x01, 0x6D, 0x02, 0x6E, -+0x40, 0xEA, 0x05, 0x97, 0x05, 0x6A, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0x03, 0xF7, 0x05, 0x4A, 0x40, 0xDB, 0x01, 0x4A, -+0x40, 0xDB, 0xF4, 0x17, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x9B, 0xF6, 0x70, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x9B, 0xF6, 0x4C, 0x9A, 0x01, 0x6C, 0xA4, 0x67, -+0x60, 0xDA, 0x00, 0x18, 0x18, 0xD3, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF1, 0x00, 0x4A, 0x10, 0xF0, -+0x24, 0x6B, 0xEF, 0x9A, 0x9B, 0xF6, 0x74, 0x9B, -+0x8C, 0x9A, 0xCE, 0x9A, 0xAD, 0x9A, 0xE0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, 0x78, 0x9B, -+0x00, 0x68, 0xC0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x7C, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xBB, 0xF6, 0x60, 0x9B, 0x80, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x89, 0x9A, 0xBB, 0xF6, -+0x64, 0x9B, 0x80, 0xDB, 0x68, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF6, 0x48, 0x9A, 0x60, 0xDA, -+0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF1, 0x48, 0xAA, -+0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0x08, 0x34, -+0x2E, 0xF2, 0x0C, 0x4B, 0x6D, 0xE4, 0x60, 0x9B, -+0x05, 0x23, 0x01, 0x48, 0xFF, 0x6B, 0x6C, 0xE8, -+0x43, 0xE8, 0xF3, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF6, 0x6C, 0x9A, 0x7F, 0x6A, 0x00, 0x69, -+0x80, 0xA3, 0x20, 0xF0, 0x20, 0x6D, 0x00, 0xF1, -+0x00, 0x4D, 0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6B, 0xAE, 0xF2, 0x40, 0x9B, 0x10, 0xF0, -+0x24, 0x6B, 0xBB, 0xF6, 0xD0, 0x9B, 0x91, 0x67, -+0x48, 0x6F, 0x04, 0xD1, 0x05, 0xD1, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x40, 0x9B, -+0x10, 0xF0, 0x24, 0x6B, 0xBB, 0xF6, 0xD4, 0x9B, -+0x20, 0xF0, 0x20, 0x6D, 0x91, 0x67, 0xAD, 0xF1, -+0x08, 0x4D, 0x00, 0xF4, 0x00, 0x6F, 0x04, 0xD1, -+0x05, 0xD1, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x40, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0xBB, 0xF6, 0xD8, 0x9B, 0x20, 0xF0, 0x21, 0x6D, -+0x00, 0x37, 0x91, 0x67, 0x15, 0xF0, 0x00, 0x4D, -+0xE8, 0x37, 0x04, 0xD1, 0x05, 0xD1, 0x40, 0xEA, -+0x00, 0x1C, 0x96, 0x45, 0xFF, 0x17, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF1, 0x00, 0x4A, -+0x60, 0xDA, 0x81, 0xDA, 0xA2, 0xDA, 0xC3, 0xDA, -+0xE4, 0xDA, 0x05, 0xDA, 0x26, 0xDA, 0x78, 0x67, -+0x67, 0xDA, 0x7D, 0x67, 0x68, 0xDA, 0x7F, 0x67, -+0x69, 0xDA, 0x12, 0xEB, 0x6A, 0xDA, 0x10, 0xEB, -+0x6B, 0xDA, 0x6D, 0xB8, 0x00, 0x65, 0x6C, 0xDA, -+0x68, 0xB8, 0x00, 0x65, 0x6D, 0xDA, 0x6C, 0xB8, -+0x00, 0x65, 0x6E, 0xDA, 0x6E, 0xB8, 0x00, 0x65, -+0x6F, 0xDA, 0x10, 0xF0, 0x23, 0x6A, 0x03, 0xF7, -+0x1D, 0x4A, 0x00, 0xEA, 0x00, 0x65, 0x00, 0x65, -+0xFF, 0x63, 0x01, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x4C, 0xED, 0x8E, 0x37, 0x4C, 0xEF, 0x07, 0x6E, -+0x01, 0x75, 0x8C, 0xEE, 0x52, 0xF4, 0x60, 0x47, -+0x59, 0x61, 0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, -+0x08, 0x4D, 0xBD, 0xE7, 0xE8, 0xF2, 0xAF, 0xA7, -+0x01, 0x68, 0x04, 0xEE, 0x0D, 0xED, 0xE8, 0xF2, -+0xAF, 0xC7, 0x1F, 0xF7, 0x00, 0x6D, 0x6C, 0xED, -+0x02, 0xF0, 0x00, 0x75, 0x01, 0x60, 0x25, 0x2D, -+0x1F, 0xF7, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0xF0, -+0x00, 0x72, 0x01, 0x60, 0x07, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF6, 0xBC, 0x9A, 0xB5, 0xE3, -+0x60, 0xA5, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF6, 0xBC, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x40, 0x9A, 0xB5, 0xE3, 0x4D, 0xE3, -+0x60, 0xA3, 0x01, 0x6A, 0x00, 0xF6, 0x60, 0x33, -+0x44, 0xEE, 0x00, 0xF6, 0x63, 0x33, 0x4F, 0xEA, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x40, 0xC5, -+0x0E, 0x10, 0x10, 0xF0, 0x24, 0x6D, 0xDB, 0xF6, -+0xA0, 0x9D, 0x0F, 0xE8, 0xAD, 0xE3, 0xA0, 0xA3, -+0x00, 0xF6, 0xA0, 0x35, 0x00, 0xF6, 0xA3, 0x35, -+0x0C, 0xED, 0x4C, 0xED, 0xA0, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF6, 0x41, 0xA2, 0x4E, 0xEC, -+0x52, 0x2C, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0x44, 0x9A, 0x60, 0x9A, 0x30, 0xF0, 0x20, 0x6A, -+0x70, 0x33, 0x00, 0xF5, 0x62, 0x33, 0x48, 0xF5, -+0x68, 0xCA, 0x45, 0x10, 0x30, 0xF0, 0x20, 0x6C, -+0xC0, 0xF1, 0x08, 0x4C, 0x9D, 0xE7, 0xE8, 0xF2, -+0x0F, 0xA7, 0x01, 0x6D, 0xA4, 0xEE, 0xAF, 0xEC, -+0x0C, 0xEC, 0xE8, 0xF2, 0x8F, 0xC7, 0x1F, 0xF7, -+0x00, 0x6C, 0x6C, 0xEC, 0x02, 0xF0, 0x00, 0x74, -+0x01, 0x60, 0x24, 0x2C, 0x1F, 0xF7, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, -+0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF6, -+0x9C, 0x9A, 0x91, 0xE3, 0x60, 0xA4, 0x0B, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF6, 0x9C, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, 0x40, 0x9A, -+0x91, 0xE3, 0x4D, 0xE3, 0x60, 0xA3, 0x00, 0xF6, -+0x60, 0x33, 0x01, 0x6A, 0x00, 0xF6, 0x63, 0x33, -+0x44, 0xEE, 0x6D, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x40, 0xC4, 0x0D, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0xDB, 0xF6, 0x80, 0x9C, 0x8D, 0xE3, 0x80, 0xA3, -+0x00, 0xF6, 0x80, 0x34, 0x00, 0xF6, 0x83, 0x34, -+0xAD, 0xEC, 0x4C, 0xEC, 0x80, 0xC3, 0x01, 0x90, -+0x01, 0x63, 0x20, 0xE8, 0xFF, 0x6A, 0x4C, 0xEC, -+0x05, 0x5C, 0xAC, 0xEA, 0x4B, 0x60, 0x10, 0xF0, -+0x24, 0x6B, 0x88, 0x34, 0x3B, 0xF1, 0x00, 0x4B, -+0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, 0x05, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, 0x68, 0x9A, -+0x2D, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0x68, 0x9A, 0x20, 0x10, 0x05, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x6C, 0x9A, 0x22, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, 0x6C, 0x9A, -+0x15, 0x10, 0x05, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x70, 0x9A, 0x17, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x70, 0x9A, 0x0A, 0x10, -+0x05, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0x74, 0x9A, 0x0C, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x74, 0x9A, 0x80, 0xA3, 0xF7, 0x6A, -+0x0A, 0x10, 0x0C, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x78, 0x9A, 0x40, 0xA3, 0xFF, 0x6C, -+0x08, 0x6D, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x78, 0x9A, 0xF7, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x4C, 0xEC, 0x01, 0x6B, 0xAC, 0xEA, -+0x6E, 0xEA, 0x01, 0x5A, 0x58, 0x67, 0x05, 0x5C, -+0x48, 0x32, 0x08, 0x60, 0x10, 0xF0, 0x24, 0x6B, -+0x88, 0x34, 0x3B, 0xF1, 0x14, 0x4B, 0x8D, 0xE3, -+0x60, 0x9B, 0x00, 0xEB, 0x01, 0x6A, 0x4B, 0xEA, -+0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF6, -+0x84, 0x9B, 0x10, 0xF0, 0x24, 0x6D, 0xDB, 0xF6, -+0xBC, 0x9D, 0x60, 0x9C, 0xAC, 0xEB, 0x1E, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF6, 0x84, 0x9B, -+0x10, 0xF0, 0x24, 0x6D, 0xDB, 0xF6, 0xBC, 0x9D, -+0x60, 0x9C, 0xAC, 0xEB, 0x10, 0xF0, 0x24, 0x6D, -+0xFB, 0xF6, 0xA8, 0x9D, 0x0E, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xDB, 0xF6, 0x84, 0x9B, 0x10, 0xF0, -+0x24, 0x6D, 0xDB, 0xF6, 0xBC, 0x9D, 0x60, 0x9C, -+0xAC, 0xEB, 0x10, 0xF0, 0x24, 0x6D, 0xFB, 0xF6, -+0xAC, 0x9D, 0xAD, 0xEB, 0x60, 0xDC, 0x60, 0xF5, -+0x60, 0x42, 0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xEB, -+0x02, 0xF0, 0x00, 0x73, 0x10, 0x61, 0x2E, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF6, 0x84, 0x9B, -+0x10, 0xF0, 0x24, 0x6D, 0xDB, 0xF6, 0xBC, 0x9D, -+0x60, 0x9C, 0xAC, 0xEB, 0x10, 0xF0, 0x24, 0x6D, -+0xFB, 0xF6, 0xB0, 0x9D, 0xE6, 0x17, 0x1E, 0x23, -+0x10, 0xF0, 0x24, 0x6B, 0xFB, 0xF6, 0x64, 0x9B, -+0x1D, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF6, -+0x84, 0x9B, 0x10, 0xF0, 0x24, 0x6D, 0xDB, 0xF6, -+0xBC, 0x9D, 0x60, 0x9C, 0xAC, 0xEB, 0x10, 0xF0, -+0x24, 0x6D, 0xFB, 0xF6, 0xB4, 0x9D, 0xAD, 0xEB, -+0x60, 0xDC, 0x60, 0xF5, 0x60, 0x42, 0x1F, 0xF7, -+0x00, 0x6C, 0x8C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x07, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xFB, 0xF6, 0x60, 0x9B, 0x69, 0xE2, 0x40, 0x9A, -+0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6B, 0xFB, 0xF6, -+0x64, 0x9B, 0x69, 0xE2, 0x40, 0x9A, 0x20, 0xE8, -+0xFF, 0x6A, 0x4C, 0xEC, 0x01, 0x74, 0xAC, 0xEA, -+0x13, 0x60, 0x03, 0x24, 0x02, 0x74, 0x15, 0x60, -+0x18, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0xD9, 0xA3, 0x01, 0x6D, -+0x4C, 0xED, 0x02, 0x6A, 0x4B, 0xEA, 0xCC, 0xEA, -+0xAD, 0xEA, 0x68, 0xF3, 0x59, 0xC3, 0x09, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0x48, 0xF5, 0x44, 0xC3, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0x48, 0xF5, -+0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF6, -+0x58, 0x9A, 0x60, 0xA2, 0x10, 0x6A, 0x6C, 0xEA, -+0x24, 0x22, 0x02, 0x5C, 0x03, 0x61, 0x02, 0x74, -+0x17, 0x60, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, 0x99, 0xA3, -+0x01, 0x6A, 0x8C, 0xEA, 0x68, 0xF3, 0x9C, 0xA3, -+0x7F, 0x6B, 0x5C, 0x32, 0x8C, 0xEB, 0x6D, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xFB, 0xF6, 0x7C, 0x9B, 0x40, 0xC3, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x60, 0xA2, -+0x10, 0xF0, 0x24, 0x6A, 0x1B, 0xF7, 0x40, 0x9A, -+0x60, 0xC2, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0x1B, 0xF7, 0x44, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0xFF, 0x72, 0x00, 0x6A, 0x0B, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x1B, 0xF7, 0x48, 0x9A, -+0x60, 0xA2, 0x07, 0x6A, 0x6C, 0xEA, 0x07, 0x6B, -+0x6E, 0xEA, 0x01, 0x5A, 0x58, 0x67, 0x20, 0xE8, -+0xFF, 0x6A, 0x4C, 0xEC, 0x01, 0x74, 0xAC, 0xEA, -+0x03, 0x60, 0x02, 0x74, 0x09, 0x60, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x02, 0x6B, 0x88, 0xF3, 0x62, 0xC2, 0x15, 0x10, -+0x09, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xE8, 0xF3, 0x67, 0xA2, 0x88, 0xF3, -+0x62, 0xC2, 0x05, 0x10, 0xFF, 0x4A, 0x30, 0xF0, -+0x20, 0x6B, 0x48, 0xF5, 0x4A, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x62, 0xA2, 0x68, 0xF3, 0x99, 0xA2, 0x88, 0xF3, -+0x63, 0xC2, 0x40, 0x6B, 0x8D, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x0B, 0xC9, 0x01, 0x72, 0x0E, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x99, 0xA2, 0x04, 0x6B, 0x8C, 0xEB, -+0x05, 0x2B, 0x68, 0xF3, 0x58, 0xA2, 0x05, 0x5A, -+0x58, 0x67, 0x01, 0x10, 0x00, 0x6A, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFF, 0x63, 0x01, 0xD1, -+0x00, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x69, 0x1B, 0xF7, 0xEC, 0x9B, 0xEF, 0xF4, -+0x68, 0x99, 0xFF, 0x6A, 0x4C, 0xEC, 0xEC, 0xEB, -+0xEE, 0xEB, 0x4C, 0xED, 0x4C, 0xEE, 0x80, 0xF0, -+0x1E, 0x23, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0x1A, 0xA3, 0x20, 0x6F, -+0x0C, 0xEF, 0x4C, 0xEF, 0x80, 0xF0, 0x0F, 0x2F, -+0xEF, 0xF4, 0x08, 0xA1, 0x01, 0x6F, 0xEC, 0xE8, -+0x4C, 0xE8, 0x61, 0x28, 0x68, 0xF3, 0x19, 0xA3, -+0x0C, 0xEF, 0x4C, 0xEF, 0x09, 0x27, 0x88, 0xF3, -+0x5B, 0xA3, 0xE4, 0x42, 0x03, 0x4A, 0x88, 0xF3, -+0xF3, 0xC3, 0x88, 0xF3, 0x52, 0xC3, 0x08, 0x10, -+0x05, 0x6F, 0x88, 0xF3, 0xF3, 0xC3, 0x05, 0x4E, -+0x04, 0x6F, 0x88, 0xF3, 0xF2, 0xC3, 0x4C, 0xEE, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0xF1, 0xA2, 0x88, 0xF3, 0x72, 0xA2, -+0xE3, 0xEB, 0x09, 0x61, 0x88, 0xF3, 0x73, 0xA2, -+0x88, 0xF3, 0xC4, 0xC2, 0x71, 0xE4, 0xB7, 0xE4, -+0x88, 0xF3, 0xB6, 0xC2, 0x09, 0x10, 0x88, 0xF3, -+0x93, 0xA2, 0x77, 0xE5, 0xB9, 0xE6, 0x6F, 0xE4, -+0x88, 0xF3, 0xC4, 0xC2, 0x88, 0xF3, 0x76, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x73, 0xA2, 0x88, 0xF3, 0x96, 0xA2, -+0x0A, 0x4B, 0x82, 0xEB, 0x02, 0x60, 0x88, 0xF3, -+0x76, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x88, 0xF3, 0x76, 0xA2, 0x88, 0xF3, -+0x84, 0xA2, 0x23, 0x4B, 0x82, 0xEB, 0x02, 0x60, -+0x88, 0xF3, 0x64, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0x76, 0xA2, -+0x68, 0xF3, 0x97, 0xA2, 0x88, 0xF3, 0x6A, 0xCA, -+0x18, 0x6B, 0x8C, 0xEB, 0x10, 0x73, 0x07, 0x61, -+0xC8, 0xF3, 0x79, 0xA2, 0x03, 0x6C, 0x76, 0x33, -+0x8C, 0xEB, 0x88, 0xF3, 0x64, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x1B, 0xF7, 0x50, 0x9A, 0x60, 0xA2, -+0x07, 0x23, 0x60, 0xA2, 0xFF, 0x6A, 0x4C, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x72, 0xCA, -+0x10, 0xF0, 0x24, 0x6A, 0x1B, 0xF7, 0x54, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x48, 0xF5, 0x92, 0xAC, -+0xA0, 0xA2, 0xFF, 0x6B, 0x6C, 0xED, 0x8E, 0xED, -+0x02, 0x25, 0x8C, 0xEB, 0x60, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x9A, 0xA2, 0x41, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x68, 0xF3, 0x7A, 0xC2, 0x04, 0x10, 0x40, 0x6A, -+0x0D, 0xEA, 0x68, 0xF3, 0x5A, 0xC3, 0x01, 0x91, -+0x00, 0x90, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0x65, 0xA2, -+0xE8, 0xF3, 0x84, 0xA2, 0x63, 0xEC, 0x22, 0x60, -+0x88, 0xF3, 0x98, 0xA2, 0x01, 0x4C, 0x88, 0xF3, -+0x98, 0xC2, 0x88, 0xF3, 0xB8, 0xA2, 0xE8, 0xF3, -+0x81, 0xA2, 0xA3, 0xEC, 0x17, 0x61, 0x03, 0x6D, -+0xB8, 0xEB, 0x88, 0xF3, 0x90, 0xA2, 0x88, 0xF3, -+0xB1, 0xA2, 0x04, 0x6F, 0x01, 0x4C, 0x88, 0xF3, -+0x90, 0xC2, 0x88, 0xF3, 0x84, 0xA2, 0xFE, 0x4C, -+0x12, 0xEB, 0x6D, 0xE4, 0x88, 0xF3, 0x77, 0xC2, -+0x88, 0xF3, 0x90, 0xA2, 0x88, 0xF3, 0xD7, 0xA2, -+0x00, 0x18, 0x39, 0xC9, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0x68, 0xF5, 0x04, 0x4B, 0xFF, 0x6A, 0xA7, 0x43, -+0x8C, 0xEA, 0x26, 0x4D, 0x00, 0x6C, 0x80, 0xC3, -+0x01, 0x4B, 0x83, 0x67, 0xAE, 0xEC, 0xFA, 0x2C, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x88, 0xF3, 0x94, 0xC3, 0x88, 0xF3, 0x98, 0xC3, -+0x88, 0xF3, 0x90, 0xC3, 0x01, 0x6C, 0x8E, 0xEA, -+0x05, 0x2A, 0x2D, 0x6C, 0x88, 0xF3, 0x99, 0xC3, -+0x88, 0xF3, 0x5A, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0xA8, 0xA3, 0x01, 0x6B, 0xFF, 0x6A, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x10, 0x23, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x74, 0xA2, 0x01, 0x4B, 0x88, 0xF3, -+0x74, 0xC2, 0x88, 0xF3, 0x74, 0xA2, 0xC8, 0xF3, -+0x5E, 0xAA, 0x43, 0xEB, 0xA0, 0xF0, 0x1E, 0x60, -+0x00, 0x6D, 0x00, 0x18, 0xA2, 0xC8, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0xC8, 0xF3, -+0x94, 0x9B, 0xC8, 0xF3, 0x50, 0xDB, 0x83, 0xEA, -+0x31, 0x61, 0x68, 0xF3, 0xF9, 0xA3, 0x01, 0x6D, -+0xFF, 0x6E, 0xEC, 0xED, 0x0E, 0x25, 0x88, 0xF3, -+0xFB, 0xA3, 0x88, 0xF3, 0xB6, 0xA3, 0x93, 0xE2, -+0x0E, 0x4F, 0xBF, 0xE7, 0xC8, 0xF3, 0xBC, 0xA3, -+0x82, 0x34, 0x8A, 0x34, 0xAF, 0xE7, 0x89, 0xE3, -+0x0B, 0x10, 0xC8, 0xF3, 0xFD, 0xA3, 0x88, 0xF3, -+0xB6, 0xA3, 0x8B, 0xE2, 0xEB, 0xEF, 0xAF, 0xE7, -+0x42, 0x32, 0x0A, 0x4B, 0x4A, 0x32, 0x49, 0xE3, -+0xCC, 0xEA, 0x2D, 0x5A, 0x0F, 0x60, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x69, 0xE2, -+0x88, 0xF3, 0x9C, 0xA2, 0x01, 0x4C, 0x88, 0xF3, -+0x9C, 0xC2, 0x88, 0xF3, 0x54, 0xA3, 0x01, 0x4A, -+0x88, 0xF3, 0x54, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0x94, 0xA2, -+0xC8, 0xF3, 0x7E, 0xAA, 0x63, 0xEC, 0x7A, 0x60, -+0x82, 0x10, 0xA0, 0xA4, 0xAD, 0xE3, 0xFF, 0x6D, -+0xAC, 0xEB, 0x63, 0xEE, 0x02, 0x60, 0xC2, 0x67, -+0x06, 0x10, 0x01, 0x4A, 0xAC, 0xEA, 0x2D, 0x72, -+0x01, 0x4C, 0xF3, 0x61, 0x00, 0x6E, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC8, 0xF3, -+0xFE, 0xAA, 0xE8, 0xF3, 0x40, 0xA2, 0x30, 0xF0, -+0x20, 0x6D, 0x00, 0x6C, 0x5F, 0xE7, 0x68, 0xF5, -+0x04, 0x4D, 0x64, 0x67, 0x40, 0xA5, 0x51, 0xE4, -+0xFF, 0x6A, 0x4C, 0xEC, 0x82, 0xEF, 0x06, 0x61, -+0x01, 0x4B, 0x4C, 0xEB, 0x2D, 0x73, 0x01, 0x4D, -+0xF5, 0x61, 0x00, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0xD9, 0xC2, -+0x88, 0xF3, 0x7A, 0xC2, 0x88, 0xF3, 0x79, 0xA2, -+0x0A, 0x5B, 0x05, 0x61, 0xF6, 0x4B, 0x88, 0xF3, -+0x71, 0xC2, 0x00, 0x6B, 0x05, 0x10, 0x00, 0x6C, -+0x88, 0xF3, 0x91, 0xC2, 0x0A, 0x6C, 0x6F, 0xE4, -+0x88, 0xF3, 0x70, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0x79, 0xA2, -+0x88, 0xF3, 0x9A, 0xA2, 0x68, 0xF3, 0xB9, 0xA2, -+0x73, 0xE4, 0x01, 0x6B, 0xAC, 0xEB, 0x03, 0x23, -+0xC8, 0xF3, 0x7C, 0xA2, 0x02, 0x10, 0xC8, 0xF3, -+0x7D, 0xA2, 0x71, 0xE4, 0x01, 0x4C, 0x88, 0xF3, -+0x97, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x88, 0xF3, 0x77, 0xA2, 0x10, 0x5B, -+0x03, 0x60, 0x10, 0x6B, 0x88, 0xF3, 0x77, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x77, 0xA2, 0x88, 0xF3, 0x90, 0xA2, -+0x88, 0xF3, 0xB1, 0xA2, 0x02, 0x4B, 0x88, 0xF3, -+0x77, 0xC2, 0x88, 0xF3, 0xD7, 0xA2, 0x03, 0x6F, -+0x00, 0x18, 0x39, 0xC9, 0x00, 0x6C, 0x00, 0x18, -+0xAD, 0xC9, 0x09, 0x10, 0x30, 0xF0, 0x20, 0x6C, -+0x00, 0x6B, 0xE8, 0xF3, 0xC0, 0xA2, 0x68, 0xF5, -+0x04, 0x4C, 0x43, 0x67, 0x7E, 0x17, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0x28, 0xF5, 0xBF, 0xA3, -+0x04, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x0C, 0x23, 0x7D, 0x67, 0x1E, 0x6A, -+0x50, 0xC3, 0x01, 0x6A, 0x4F, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x92, 0xC3, -+0x04, 0x04, 0x40, 0xEA, 0x09, 0x97, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x24, 0x67, 0x6E, 0xF5, -+0x58, 0x9A, 0xEF, 0xF6, 0x81, 0xA3, 0xFF, 0x68, -+0x0C, 0xE9, 0x40, 0xEA, 0x01, 0x72, 0x35, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x68, 0xF3, 0x94, 0xA3, 0x7F, 0x6A, 0x8C, 0xEA, -+0x0C, 0xEA, 0x2B, 0x22, 0x68, 0xF3, 0x75, 0xA3, -+0x0F, 0x6A, 0x6C, 0xEA, 0x01, 0x72, 0x25, 0x61, -+0x05, 0x59, 0x03, 0x61, 0xA0, 0xF6, 0x08, 0x6A, -+0x07, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x24, 0x31, -+0xFB, 0xF1, 0x00, 0x4A, 0x49, 0xE1, 0x40, 0xAA, -+0x61, 0x42, 0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xEB, -+0x02, 0xF0, 0x00, 0x73, 0x01, 0x60, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x1B, 0xF7, 0x78, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x1B, 0xF7, -+0x7C, 0x9B, 0x69, 0xE2, 0x60, 0xA2, 0x20, 0x6A, -+0x6C, 0xEA, 0x4B, 0xEA, 0xC0, 0xF7, 0x42, 0x32, -+0x01, 0x10, 0x01, 0x6A, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0x28, 0xF5, 0x7C, 0xA2, -+0x7F, 0x6A, 0x6C, 0xEA, 0x01, 0x5A, 0x58, 0x67, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0xAF, 0xF5, 0x0C, 0x4C, -+0x00, 0x6D, 0x07, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0xAF, 0xF5, 0x4C, 0xA2, 0x01, 0x6B, 0x46, 0x32, -+0x6C, 0xEA, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x75, 0xCA, 0x14, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x40, 0x9A, 0x40, 0xA2, -+0x1E, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x44, 0x9A, 0x40, 0xA2, 0x18, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x48, 0x9A, 0x60, 0xA2, -+0x02, 0x6A, 0x6C, 0xEA, 0x10, 0x22, 0x00, 0x18, -+0x0B, 0xC9, 0x01, 0x72, 0x01, 0x6A, 0x0C, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x6C, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x3B, 0xF7, 0x90, 0x9C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF5, 0x6C, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0x20, 0xE8, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF5, 0x4C, 0xA2, -+0xFF, 0x6B, 0x56, 0x32, 0x8E, 0xEA, 0x6C, 0xEA, -+0x01, 0x5A, 0x58, 0x67, 0x6C, 0xEA, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x90, 0xCA, -+0x00, 0x6B, 0x06, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xAF, 0xF5, 0x76, 0xA2, 0x01, 0x6A, 0x4C, 0xEB, -+0x05, 0x97, 0x43, 0x67, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0xA9, 0xF0, 0x68, 0xA0, 0x01, 0x6A, 0xFF, 0x69, -+0x4C, 0xEB, 0x0B, 0x23, 0xC9, 0xF0, 0x65, 0xA0, -+0x6C, 0xEA, 0x2C, 0xEA, 0x26, 0x2A, 0x68, 0xF3, -+0x58, 0xA0, 0x23, 0x2A, 0xE8, 0xF3, 0x52, 0xA0, -+0x1D, 0x10, 0x00, 0x18, 0x0B, 0xC9, 0x01, 0x72, -+0x1C, 0x61, 0x68, 0xF3, 0x7D, 0xA0, 0x03, 0x6A, -+0x6C, 0xEA, 0x17, 0x2A, 0x68, 0xF3, 0x58, 0xA0, -+0x14, 0x2A, 0x04, 0x6A, 0x6C, 0xEA, 0x11, 0x2A, -+0x10, 0x6A, 0x6C, 0xEA, 0x0E, 0x2A, 0x68, 0xF3, -+0x79, 0xA0, 0x20, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x08, 0x22, 0xE8, 0xF3, 0x52, 0xA0, 0x05, 0x2A, -+0x00, 0x18, 0x9A, 0xCA, 0x01, 0x5A, 0x58, 0x67, -+0x01, 0x10, 0x00, 0x6A, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x30, 0xF0, 0x20, 0x68, 0x4C, 0xEC, -+0xC0, 0xF1, 0x08, 0x48, 0x04, 0xD4, 0x68, 0xF3, -+0x9D, 0xA0, 0x10, 0x6B, 0x30, 0xF0, 0x20, 0x69, -+0x8D, 0xEB, 0x68, 0xF3, 0x7D, 0xC0, 0xEF, 0xF4, -+0x88, 0xA1, 0x01, 0x6B, 0x8C, 0xEB, 0x4C, 0xEB, -+0x29, 0x23, 0xEF, 0xF4, 0x08, 0x49, 0x42, 0xA1, -+0xFF, 0x72, 0x54, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x54, 0x9A, 0x00, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x58, 0x9A, 0x04, 0x6B, 0xFF, 0x6C, -+0x60, 0xC2, 0xAE, 0xF2, 0x50, 0x98, 0x59, 0x4C, -+0x00, 0x6D, 0x05, 0x6E, 0x40, 0xEA, 0xC2, 0xA1, -+0xAE, 0xF2, 0x50, 0x98, 0xFF, 0x6C, 0x55, 0x4C, -+0x00, 0x6D, 0x05, 0x4E, 0x40, 0xEA, 0x00, 0x18, -+0x90, 0xCA, 0x34, 0x2A, 0x04, 0x94, 0x00, 0x18, -+0x3A, 0xEC, 0x30, 0x10, 0x88, 0xF3, 0x65, 0xA0, -+0x02, 0x5B, 0x13, 0x60, 0x88, 0xF3, 0xC4, 0xA0, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, -+0xFF, 0x6C, 0xD9, 0xE3, 0x55, 0x4C, 0x00, 0x6D, -+0x40, 0xEA, 0x88, 0xF3, 0x65, 0xA0, 0x88, 0xF3, -+0x44, 0xA0, 0x49, 0xE3, 0x88, 0xF3, 0x57, 0xC0, -+0x19, 0x10, 0x03, 0x69, 0x38, 0xEB, 0x88, 0xF3, -+0xC4, 0xA0, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x50, 0x9A, 0xFE, 0x4E, 0xFF, 0x6C, 0x55, 0x4C, -+0x00, 0x6D, 0x12, 0xEB, 0x79, 0xE6, 0x40, 0xEA, -+0x88, 0xF3, 0x65, 0xA0, 0x88, 0xF3, 0x44, 0xA0, -+0x38, 0xEB, 0xFE, 0x4A, 0x12, 0xE9, 0x25, 0xE2, -+0x88, 0xF3, 0x37, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x04, 0x6B, 0x6C, 0xEA, -+0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x04, 0x96, 0x83, 0x67, 0x01, 0x6D, -+0x40, 0xEA, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x30, 0xF0, 0x20, 0x69, 0x04, 0xD4, 0xEF, 0xF4, -+0x08, 0x49, 0xC0, 0xF0, 0x84, 0xA1, 0x04, 0x6B, -+0x8C, 0xEB, 0x4C, 0xEB, 0x32, 0x23, 0xC0, 0xF0, -+0x06, 0xA1, 0xC0, 0xF0, 0x45, 0xA1, 0x58, 0xE8, -+0x12, 0xE8, 0xC0, 0xF0, 0x0C, 0xC1, 0x00, 0x18, -+0x68, 0xCA, 0x03, 0x22, 0xC0, 0xF0, 0x0D, 0xC1, -+0x03, 0x10, 0x01, 0x6A, 0xC0, 0xF0, 0x4D, 0xC1, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF5, 0x15, 0xA2, -+0x02, 0x58, 0x11, 0x61, 0x00, 0x18, 0x68, 0xCA, -+0x06, 0x22, 0x04, 0x94, 0x00, 0x18, 0x41, 0xEC, -+0x04, 0x94, 0x00, 0x18, 0x3A, 0xEC, 0x04, 0x94, -+0x00, 0x18, 0x0A, 0xEC, 0x04, 0x94, 0xB0, 0x67, -+0x00, 0x18, 0xD9, 0xEC, 0x13, 0x10, 0x01, 0x70, -+0x04, 0x61, 0x04, 0x94, 0x00, 0x18, 0x14, 0xEC, -+0x0D, 0x10, 0x00, 0x18, 0x68, 0xCA, 0x0A, 0x22, -+0x03, 0x10, 0x04, 0x94, 0x00, 0x18, 0x30, 0xEC, -+0x04, 0x94, 0x00, 0x18, 0x41, 0xEC, 0x04, 0x94, -+0x00, 0x18, 0x3A, 0xEC, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD0, 0xFF, 0x6A, -+0x4C, 0xEC, 0x12, 0x2C, 0x10, 0xF0, 0x23, 0x6C, -+0xE5, 0xF7, 0x19, 0x4C, 0x00, 0x18, 0x8B, 0xE9, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0xC0, 0xF0, 0x8E, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xC0, 0xF0, 0x6E, 0xC2, 0x1F, 0x10, -+0x30, 0xF0, 0x20, 0x68, 0xEF, 0xF4, 0x08, 0x48, -+0xC0, 0xF0, 0x84, 0xA0, 0x04, 0x6B, 0x8C, 0xEB, -+0x4C, 0xEB, 0x15, 0x23, 0xC0, 0xF0, 0xC7, 0xA0, -+0x00, 0x6A, 0x04, 0xD2, 0xA2, 0x67, 0x0A, 0x6A, -+0x58, 0xEE, 0x10, 0xF0, 0x23, 0x6C, 0xE5, 0xF7, -+0x19, 0x4C, 0x01, 0x6F, 0x12, 0xEE, 0x00, 0x18, -+0x9E, 0xE9, 0xC0, 0xF0, 0x6E, 0xA0, 0x01, 0x6A, -+0x6D, 0xEA, 0xC0, 0xF0, 0x4E, 0xC0, 0x07, 0x97, -+0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x21, 0x6A, -+0x70, 0xF3, 0x78, 0xA2, 0x80, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x02, 0x2A, -+0x00, 0x18, 0x11, 0xED, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0x08, 0x4B, 0x80, 0xF6, 0x90, 0xA3, -+0x80, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, 0xFF, 0x6C, -+0x8C, 0xEA, 0x05, 0x22, 0x80, 0xF6, 0x93, 0xA3, -+0x00, 0x18, 0xF2, 0xC4, 0x08, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, -+0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, 0x0C, 0x6D, -+0x01, 0x6C, 0x00, 0x18, 0xE4, 0xC8, 0x0C, 0x6C, -+0x00, 0x18, 0x92, 0xF1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x68, 0x8C, 0xE8, 0x00, 0x18, -+0x11, 0xED, 0x08, 0x20, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, 0xFF, 0x6C, -+0xC5, 0x67, 0x40, 0xEA, 0x04, 0x6D, 0x01, 0x6C, -+0x00, 0x18, 0xE4, 0xC8, 0x04, 0x6C, 0x00, 0x18, -+0x92, 0xF1, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xFF, 0x69, 0x30, 0xF0, 0x20, 0x6A, 0x8C, 0xE9, -+0x6E, 0xF5, 0x58, 0x9A, 0xEF, 0xF6, 0x81, 0xA3, -+0x40, 0xEA, 0x01, 0x72, 0x2C, 0x61, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, -+0x7A, 0xA0, 0x09, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x68, 0xF3, 0x5A, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0x6F, 0x6D, -+0x2C, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x50, 0x9A, 0xC8, 0xF2, 0x9F, 0xA0, -+0x01, 0x6D, 0x08, 0x6E, 0xF1, 0x67, 0x40, 0xEA, -+0x01, 0x72, 0x0D, 0x61, 0x68, 0xF3, 0x7A, 0xA0, -+0x02, 0x6A, 0x01, 0x6C, 0x6D, 0xEA, 0x0E, 0x6D, -+0x68, 0xF3, 0x5A, 0xC0, 0x00, 0x18, 0xE4, 0xC8, -+0x0E, 0x6C, 0x00, 0x18, 0x92, 0xF1, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0x08, 0x4B, 0x80, 0xF6, 0x90, 0xA3, -+0x80, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, 0xFF, 0x6C, -+0x8C, 0xEA, 0x05, 0x22, 0x80, 0xF6, 0x93, 0xA3, -+0x00, 0x18, 0xDE, 0xC4, 0x08, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, -+0xA4, 0x67, 0x2F, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF2, 0x40, 0x9A, 0x40, 0xEA, -+0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, 0x78, 0xA2, -+0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x02, 0x2A, 0x00, 0x18, 0xE4, 0xEC, -+0x08, 0x6D, 0x01, 0x6C, 0x00, 0x18, 0xE4, 0xC8, -+0x08, 0x6C, 0x00, 0x18, 0x92, 0xF1, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x69, 0x04, 0x67, -+0x2C, 0xE8, 0xAC, 0xE9, 0x00, 0x18, 0x68, 0xCA, -+0x07, 0x22, 0x03, 0x28, 0x00, 0x18, 0x94, 0xCB, -+0x0D, 0x10, 0x00, 0x18, 0x4C, 0xCB, 0x0A, 0x10, -+0x01, 0x70, 0x08, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x04, 0x6C, 0x01, 0x6D, -+0xD1, 0x67, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0xAF, 0xF5, 0x0C, 0xA2, 0x00, 0x6C, -+0x00, 0x18, 0x2E, 0xCB, 0x00, 0x18, 0x90, 0xCA, -+0x16, 0x30, 0x01, 0x6C, 0x04, 0x22, 0x90, 0x67, -+0x00, 0x18, 0x05, 0xCB, 0x00, 0x6C, 0xB0, 0x67, -+0x00, 0x18, 0xAF, 0xCB, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, -+0x08, 0x4B, 0x04, 0x67, 0xC0, 0xF0, 0x84, 0xA3, -+0xFF, 0x6A, 0x4C, 0xE8, 0x96, 0x34, 0x0E, 0xEC, -+0xAC, 0xEA, 0x19, 0x2C, 0xC0, 0xF0, 0xAC, 0xA3, -+0x43, 0xED, 0x04, 0x61, 0x4B, 0xE5, 0xC0, 0xF0, -+0x4C, 0xC3, 0x02, 0x10, 0xC0, 0xF0, 0x8C, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF5, 0x54, 0xA2, -+0x0A, 0x2A, 0x90, 0x67, 0x00, 0x18, 0x05, 0xCB, -+0x01, 0x6C, 0xB0, 0x67, 0x00, 0x18, 0xAF, 0xCB, -+0x01, 0x6C, 0x00, 0x18, 0x2E, 0xCB, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x68, -+0x8C, 0xE8, 0x00, 0x18, 0x90, 0xCA, 0x0E, 0x22, -+0x90, 0x67, 0x00, 0x18, 0x94, 0xCA, 0x0A, 0x22, -+0x00, 0x18, 0x68, 0xCA, 0x07, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xAF, 0xF5, 0xB5, 0xA2, 0x90, 0x67, -+0x00, 0x18, 0xCD, 0xCB, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x68, 0x8C, 0xE8, 0x00, 0x18, -+0x90, 0xCA, 0x0E, 0x22, 0x90, 0x67, 0x00, 0x18, -+0x94, 0xCA, 0x0A, 0x22, 0x00, 0x18, 0x68, 0xCA, -+0x07, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF5, -+0xB5, 0xA2, 0x90, 0x67, 0x00, 0x18, 0xCD, 0xCB, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0xC0, 0xF0, 0x8E, 0xA2, -+0xC0, 0xF0, 0xA4, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xB6, 0x35, 0x00, 0x6C, 0xC0, 0xF0, -+0x6E, 0xC2, 0x00, 0x18, 0xAF, 0xCB, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xFF, 0x68, 0x8C, 0xE8, 0x68, 0xF3, -+0x99, 0xA2, 0x03, 0x6B, 0x6B, 0xEB, 0x41, 0x6D, -+0x8C, 0xEB, 0xAB, 0xED, 0xAC, 0xEB, 0x68, 0xF3, -+0xBA, 0xA2, 0x68, 0xF3, 0x79, 0xC2, 0x11, 0x6B, -+0x00, 0x6C, 0x6B, 0xEB, 0x88, 0xF3, 0x85, 0xC2, -+0x68, 0xF3, 0x9D, 0xC2, 0xAC, 0xEB, 0x88, 0xF3, -+0x86, 0xC2, 0x90, 0x67, 0x68, 0xF3, 0x7A, 0xC2, -+0x00, 0x18, 0x1B, 0xEC, 0x90, 0x67, 0x00, 0x18, -+0x14, 0xEC, 0x90, 0x67, 0x00, 0x18, 0x30, 0xEC, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x30, 0xF0, 0x20, 0x68, -+0x04, 0xD2, 0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, -+0x74, 0xA0, 0x00, 0x6A, 0xE8, 0xF3, 0x42, 0xC0, -+0x7F, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x47, 0x22, 0x30, 0xF0, 0x20, 0x69, 0xEF, 0xF4, -+0x08, 0x49, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, -+0x58, 0x9A, 0xE0, 0xF1, 0x99, 0xA1, 0x40, 0xEA, -+0x01, 0x72, 0x78, 0x67, 0x05, 0xD3, 0x38, 0x2B, -+0x04, 0x94, 0x88, 0xF3, 0xA2, 0xA0, 0x00, 0x18, -+0xD9, 0xEC, 0x04, 0x94, 0x00, 0x6D, 0x00, 0x18, -+0xA2, 0xC8, 0x68, 0xF3, 0x7A, 0xA0, 0xC8, 0xF3, -+0x54, 0xD8, 0x20, 0x6A, 0x6D, 0xEA, 0x9D, 0x67, -+0x68, 0xF3, 0x5A, 0xC0, 0x47, 0x44, 0x0D, 0x4A, -+0x80, 0xA2, 0x08, 0xF3, 0x6A, 0xA0, 0x01, 0x6A, -+0x88, 0xF3, 0x83, 0xC0, 0x4C, 0xEB, 0xFF, 0x6C, -+0x8C, 0xEB, 0x05, 0x2B, 0x80, 0xF6, 0x70, 0xA1, -+0x6C, 0xEA, 0x8C, 0xEA, 0x12, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xC8, 0xF4, 0x56, 0xA2, 0x00, 0x68, -+0x02, 0x72, 0x07, 0x60, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF3, 0x53, 0xA2, 0x02, 0x72, 0x01, 0x60, -+0x01, 0x68, 0x00, 0x18, 0xCA, 0xEF, 0x04, 0x22, -+0x03, 0x20, 0x04, 0x94, 0x00, 0x18, 0xC2, 0xCA, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x74, 0xA0, -+0x00, 0x6A, 0xE8, 0xF3, 0x42, 0xC0, 0x7F, 0x6A, -+0xFF, 0x69, 0x6C, 0xEA, 0x2C, 0xEC, 0x2C, 0xEA, -+0x04, 0xD4, 0x47, 0x22, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, -+0xEF, 0xF6, 0x81, 0xA3, 0x40, 0xEA, 0x01, 0x72, -+0x3C, 0x61, 0x04, 0x94, 0x00, 0x6D, 0x00, 0x18, -+0xA2, 0xC8, 0x68, 0xF3, 0x7A, 0xA0, 0xC8, 0xF3, -+0x54, 0xD8, 0x20, 0x6A, 0x6D, 0xEA, 0x68, 0xF3, -+0x75, 0xA0, 0x68, 0xF3, 0x5A, 0xC0, 0x0F, 0x6A, -+0x6C, 0xEA, 0x2C, 0xEA, 0x01, 0x69, 0x06, 0x22, -+0x68, 0xF3, 0x3A, 0xA0, 0x01, 0x6A, 0x32, 0x31, -+0x4E, 0xE9, 0x4C, 0xE9, 0x30, 0xF0, 0x20, 0x6A, -+0xC8, 0xF4, 0x72, 0xA2, 0x01, 0x6A, 0x4C, 0xEB, -+0x08, 0x2B, 0x30, 0xF0, 0x21, 0x6B, 0x70, 0xF3, -+0x78, 0xA3, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x10, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, -+0x56, 0xA2, 0x02, 0x72, 0x06, 0x60, 0x30, 0xF0, -+0x21, 0x6A, 0x90, 0xF3, 0x53, 0xA2, 0x02, 0x72, -+0x01, 0x61, 0x00, 0x69, 0x00, 0x18, 0xCA, 0xEF, -+0x04, 0x22, 0x03, 0x21, 0x04, 0x94, 0x00, 0x18, -+0xC2, 0xCA, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x08, 0xF3, 0xAA, 0xA3, 0xC4, 0x67, 0x01, 0x6C, -+0xFF, 0x6A, 0x8C, 0xED, 0x4C, 0xED, 0x4C, 0xEE, -+0x07, 0x2D, 0x30, 0xF0, 0x21, 0x6D, 0x70, 0xF3, -+0xB8, 0xA5, 0xAC, 0xEC, 0x4C, 0xEC, 0x07, 0x24, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x80, 0xA2, -+0x00, 0x18, 0xE1, 0xF0, 0x08, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x68, 0xF3, -+0x98, 0xA3, 0x01, 0x6D, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xF0, 0x6D, 0x01, 0x6C, 0x00, 0x18, 0xE4, 0xC8, -+0x00, 0x6C, 0x00, 0x18, 0xBC, 0xF5, 0x00, 0x18, -+0xDD, 0xE7, 0x00, 0x18, 0x14, 0xE8, 0x01, 0x6C, -+0x00, 0x18, 0xBC, 0xF5, 0x01, 0x6C, 0x00, 0x6D, -+0x00, 0x18, 0xE4, 0xC8, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x02, 0x22, 0x08, 0x72, 0x06, 0x61, 0x00, 0x18, -+0x79, 0xCA, 0x01, 0x72, 0x02, 0x61, 0x00, 0x18, -+0x95, 0xCC, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0xB9, 0xA2, -+0x01, 0x6B, 0xFF, 0x6C, 0x6C, 0xED, 0x21, 0x25, -+0x08, 0xF3, 0x4A, 0xA2, 0x6C, 0xEA, 0x8C, 0xEA, -+0x07, 0x2A, 0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, -+0x58, 0xA2, 0x4C, 0xEB, 0x8C, 0xEB, 0x13, 0x23, -+0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, 0x72, 0xA2, -+0x02, 0x6A, 0x4C, 0xEB, 0x08, 0x2B, 0x30, 0xF0, -+0x21, 0x6B, 0x70, 0xF3, 0x78, 0xA3, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, -+0xD1, 0xF0, 0x01, 0x72, 0x02, 0x61, 0x00, 0x18, -+0xA1, 0xCC, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, -+0xC5, 0x67, 0xFF, 0x6C, 0x40, 0xEA, 0x04, 0x6D, -+0x01, 0x6C, 0x00, 0x18, 0xE4, 0xC8, 0x30, 0xF0, -+0x21, 0x6A, 0x70, 0xF3, 0x1A, 0xA2, 0x90, 0x67, -+0x00, 0x18, 0xAE, 0xEF, 0x40, 0x6B, 0x4D, 0xEB, -+0xFF, 0x6D, 0x90, 0x67, 0x6C, 0xED, 0x00, 0x18, -+0xA1, 0xEF, 0x04, 0x6C, 0x00, 0x18, 0x92, 0xF1, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x2E, 0x6E, -+0xFF, 0x6C, 0x6F, 0x6D, 0x40, 0xEA, 0x02, 0x6D, -+0x01, 0x6C, 0x00, 0x18, 0xE4, 0xC8, 0x30, 0xF0, -+0x21, 0x6A, 0x70, 0xF3, 0x1A, 0xA2, 0x90, 0x67, -+0x00, 0x18, 0xAE, 0xEF, 0xBF, 0x6D, 0x90, 0x67, -+0x4C, 0xED, 0x00, 0x18, 0xA1, 0xEF, 0x02, 0x6C, -+0x00, 0x18, 0x92, 0xF1, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x3B, 0xF7, 0x7C, 0x9B, 0xFF, 0x6A, 0x24, 0x67, -+0x60, 0xA3, 0x4C, 0xE9, 0x30, 0xF0, 0x20, 0x68, -+0x6C, 0xEA, 0x04, 0xD2, 0x6E, 0xF2, 0x58, 0x98, -+0xFF, 0x6C, 0xA4, 0x67, 0x2D, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, 0x40, 0x9A, -+0x40, 0xEA, 0x07, 0x2A, 0x6E, 0xF2, 0x58, 0x98, -+0x04, 0x95, 0xFF, 0x6C, 0x2D, 0x6E, 0x40, 0xEA, -+0x2F, 0x10, 0x05, 0x59, 0x24, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x28, 0x31, 0x5B, 0xF1, 0x08, 0x4A, -+0x29, 0xE2, 0x40, 0x9A, 0x00, 0xEA, 0x00, 0x6C, -+0x08, 0x6D, 0x17, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x6C, 0x5B, 0xF7, 0xA0, 0x9A, 0x11, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x04, 0x6C, 0x5B, 0xF7, -+0xA4, 0x9A, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x6C, 0x5B, 0xF7, 0xA8, 0x9A, 0x05, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, 0xAC, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0xC1, 0xE0, 0x00, 0x18, -+0xE4, 0xEC, 0x01, 0x6C, 0x00, 0x6D, 0x00, 0x18, -+0xE4, 0xC8, 0x00, 0x6C, 0x00, 0x18, 0x92, 0xF1, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x7A, 0xA0, -+0x08, 0x6A, 0xFF, 0x69, 0x6C, 0xEA, 0x2C, 0xEA, -+0x2C, 0xEC, 0x05, 0x2A, 0x01, 0x6C, 0x0C, 0x6D, -+0x00, 0x18, 0xE4, 0xC8, 0x43, 0x10, 0x01, 0x6D, -+0x00, 0x18, 0x3E, 0xD1, 0x01, 0x6C, 0x04, 0x6D, -+0x00, 0x18, 0xE4, 0xC8, 0x08, 0xF3, 0x6A, 0xA0, -+0x01, 0x6A, 0x4C, 0xEB, 0x2C, 0xEB, 0x07, 0x2B, -+0x30, 0xF0, 0x21, 0x6B, 0x70, 0xF3, 0x78, 0xA3, -+0x6C, 0xEA, 0x2C, 0xEA, 0x2C, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xC8, 0xF4, 0x72, 0xA2, 0x04, 0x6A, -+0x4C, 0xEB, 0x08, 0x2B, 0x30, 0xF0, 0x21, 0x6B, -+0x70, 0xF3, 0x78, 0xA3, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x1D, 0x22, 0x30, 0xF0, 0x20, 0x68, -+0xEF, 0xF4, 0x08, 0x48, 0x80, 0xF6, 0x32, 0xA0, -+0x91, 0x67, 0x00, 0x18, 0xAE, 0xEF, 0x80, 0x6D, -+0xAB, 0xED, 0x4D, 0xED, 0xFF, 0x6A, 0x4C, 0xED, -+0x91, 0x67, 0x00, 0x18, 0xA1, 0xEF, 0x80, 0xF6, -+0x12, 0xA0, 0x90, 0x67, 0x00, 0x18, 0xAE, 0xEF, -+0x20, 0x6D, 0x4D, 0xED, 0xFF, 0x6A, 0x90, 0x67, -+0x4C, 0xED, 0x00, 0x18, 0xA1, 0xEF, 0x04, 0x6C, -+0x00, 0x18, 0x92, 0xF1, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, 0xFF, 0x6C, -+0xC5, 0x67, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0x48, 0xF5, 0xA2, 0xA3, -+0x04, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x08, 0x2B, 0x03, 0x6D, 0x00, 0x18, -+0x3E, 0xD1, 0x01, 0x6C, 0x04, 0x6D, 0x00, 0x18, -+0xE4, 0xC8, 0x22, 0x10, 0x00, 0x6D, 0x30, 0xF0, -+0x20, 0x69, 0x00, 0x18, 0x3E, 0xD1, 0xEF, 0xF4, -+0x08, 0x49, 0x0C, 0x6D, 0x01, 0x6C, 0x00, 0x18, -+0xE4, 0xC8, 0x80, 0xF6, 0x12, 0xA1, 0x90, 0x67, -+0x00, 0x18, 0xAE, 0xEF, 0x7F, 0x6D, 0x90, 0x67, -+0x4C, 0xED, 0x00, 0x18, 0xA1, 0xEF, 0x80, 0xF6, -+0x12, 0xA1, 0x90, 0x67, 0x00, 0x18, 0xAE, 0xEF, -+0xDF, 0x6D, 0x90, 0x67, 0x4C, 0xED, 0x00, 0x18, -+0xA1, 0xEF, 0x0C, 0x6C, 0x00, 0x18, 0x92, 0xF1, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x6D, 0x00, 0x18, -+0x3E, 0xD1, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x00, 0x6D, 0xC5, 0x67, 0xFF, 0x6C, -+0x40, 0xEA, 0x01, 0x6C, 0x0C, 0x6D, 0x00, 0x18, -+0xE4, 0xC8, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x69, 0x2C, 0xEC, 0xAC, 0xE9, 0x3B, 0x24, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF5, 0x58, 0x9A, 0xEF, 0xF6, 0x81, 0xA3, -+0x40, 0xEA, 0x01, 0x72, 0x30, 0x61, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, -+0x7A, 0xA0, 0x05, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x68, 0xF3, 0x5A, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0x2B, 0x6E, 0xFF, 0x6C, -+0x0F, 0x6D, 0x40, 0xEA, 0x91, 0x67, 0x02, 0x6D, -+0x00, 0x18, 0x3E, 0xD1, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x50, 0x9A, 0xC8, 0xF2, 0x9F, 0xA0, -+0x00, 0x6D, 0x08, 0x6E, 0xF1, 0x67, 0x40, 0xEA, -+0x01, 0x72, 0x0D, 0x61, 0x68, 0xF3, 0x7A, 0xA0, -+0x01, 0x6A, 0x01, 0x6C, 0x6D, 0xEA, 0x06, 0x6D, -+0x68, 0xF3, 0x5A, 0xC0, 0x00, 0x18, 0xE4, 0xC8, -+0x06, 0x6C, 0x00, 0x18, 0x92, 0xF1, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x25, 0x67, 0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, -+0x08, 0x4D, 0x06, 0x67, 0x68, 0xF3, 0xDA, 0xA5, -+0x03, 0x6B, 0xFF, 0x6A, 0xCC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x4C, 0xE9, 0x4C, 0xE8, 0xE0, 0xF0, -+0x03, 0x2B, 0x68, 0xF3, 0x5C, 0xA5, 0x8E, 0xEA, -+0xC0, 0xF0, 0x1E, 0x22, 0x0D, 0x5C, 0xC0, 0xF0, -+0x1B, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, -+0x5B, 0xF1, 0x1C, 0x4A, 0x89, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x0E, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0x11, 0xCD, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x03, 0x2A, 0x01, 0x6C, -+0x00, 0x18, 0x65, 0xCB, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x06, 0x72, 0x03, 0x61, -+0x90, 0x67, 0x00, 0x18, 0x44, 0xCD, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, 0x04, 0x72, -+0x09, 0x61, 0x05, 0x21, 0x91, 0x67, 0xB0, 0x67, -+0x00, 0x18, 0x72, 0xCD, 0x03, 0x10, 0x90, 0x67, -+0x00, 0x18, 0x67, 0xCD, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x08, 0x72, 0xA0, 0xF0, -+0x03, 0x61, 0x00, 0x18, 0x4C, 0xCB, 0xA0, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x03, 0x2A, 0x01, 0x6C, 0x00, 0x18, 0x65, 0xCB, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x06, 0x72, 0x03, 0x61, 0x90, 0x67, 0x00, 0x18, -+0x44, 0xCD, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x0E, 0x72, 0x07, 0x61, 0x00, 0x18, -+0x2D, 0xC9, 0x01, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0x11, 0xCD, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x0C, 0x72, 0x7C, 0x61, -+0x00, 0x18, 0x2D, 0xC9, 0x01, 0x72, 0x78, 0x61, -+0x90, 0x67, 0x00, 0x18, 0x73, 0xCB, 0x74, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x0E, 0x72, 0x07, 0x61, 0x00, 0x18, 0x2D, 0xC9, -+0x01, 0x72, 0x03, 0x61, 0x90, 0x67, 0x00, 0x18, -+0x11, 0xCD, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x06, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0x44, 0xCD, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x0C, 0x72, 0x07, 0x61, -+0x00, 0x18, 0x2D, 0xC9, 0x01, 0x72, 0x03, 0x61, -+0x90, 0x67, 0x00, 0x18, 0x73, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, 0x04, 0x72, -+0x4B, 0x61, 0x00, 0x18, 0xA2, 0xCA, 0x01, 0x72, -+0x47, 0x61, 0x90, 0x67, 0x00, 0x18, 0xE5, 0xCC, -+0x43, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x0E, 0x72, 0x07, 0x61, 0x00, 0x18, -+0x2D, 0xC9, 0x01, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0x11, 0xCD, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x06, 0x72, 0x03, 0x61, -+0x90, 0x67, 0x00, 0x18, 0x44, 0xCD, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, 0x0C, 0x72, -+0x07, 0x61, 0x00, 0x18, 0x2D, 0xC9, 0x01, 0x72, -+0x03, 0x61, 0x90, 0x67, 0x00, 0x18, 0x73, 0xCB, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x03, 0x2A, 0x01, 0x6C, 0x00, 0x18, 0x65, 0xCB, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x04, 0x72, 0x12, 0x61, 0x00, 0x18, 0xD4, 0xCC, -+0x0F, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0x7C, 0xA2, 0x0C, 0x73, -+0x07, 0x61, 0x68, 0xF3, 0x79, 0xA2, 0x20, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x94, 0xCB, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x48, 0xF5, 0xA1, 0xA3, 0x04, 0x6B, 0xFF, 0x6A, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x06, 0x23, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x54, 0x9A, -+0x00, 0x6B, 0x60, 0xC2, 0x02, 0x6D, 0x00, 0x18, -+0x25, 0xE8, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x58, 0x9A, 0x04, 0x69, 0x30, 0xF0, 0x20, 0x68, -+0x20, 0xDA, 0xC0, 0xF1, 0x08, 0x48, 0xE8, 0xF3, -+0xC6, 0xA0, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x50, 0x9A, 0xFF, 0x6C, 0x59, 0x4C, 0x00, 0x6D, -+0xC6, 0x36, 0x40, 0xEA, 0x68, 0xF3, 0x59, 0xA0, -+0x07, 0x97, 0x4D, 0xE9, 0x68, 0xF3, 0x39, 0xC0, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, -+0xB4, 0xA3, 0x04, 0x67, 0x7F, 0x6C, 0xFF, 0x6A, -+0xAC, 0xEC, 0x4C, 0xEC, 0x01, 0x74, 0x4C, 0xE8, -+0x1B, 0x61, 0x68, 0xF3, 0xB5, 0xA3, 0x10, 0x6C, -+0x8B, 0xEC, 0xAC, 0xEC, 0x4C, 0xEC, 0x16, 0x24, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0xD0, 0x67, 0x0C, 0x6C, 0x00, 0x6D, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, -+0x90, 0x67, 0x00, 0x18, 0x15, 0xCE, 0x0D, 0x10, -+0x02, 0x74, 0x0B, 0x61, 0x68, 0xF3, 0x5C, 0xA3, -+0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x04, 0x6C, 0x01, 0x6D, 0xD0, 0x67, -+0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0x69, 0xF2, 0xB0, 0xA3, -+0x01, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x02, 0x2B, 0x00, 0x18, 0x30, 0xCE, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x69, 0x8C, 0xE9, 0x30, 0xF0, 0x20, 0x68, -+0x91, 0x67, 0xC0, 0xF1, 0x08, 0x48, 0x00, 0x18, -+0x15, 0xCE, 0x68, 0xF3, 0x5C, 0xA0, 0x0C, 0x72, -+0x20, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x0C, 0x6C, 0x00, 0x6D, 0xD1, 0x67, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x00, 0x6D, 0xC5, 0x67, 0xFF, 0x6C, -+0x40, 0xEA, 0x68, 0xF3, 0x7A, 0xA0, 0x01, 0x6A, -+0xC8, 0xF2, 0x9F, 0xA0, 0x6D, 0xEA, 0x68, 0xF3, -+0x5A, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x50, 0x9A, 0x00, 0x6D, 0x08, 0x6E, 0xF1, 0x67, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x04, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, 0x68, 0xF3, -+0xB9, 0xA4, 0x40, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, -+0x4C, 0xEB, 0x4C, 0xE8, 0x0C, 0x23, 0x68, 0xF3, -+0x9A, 0xA4, 0x10, 0x6B, 0x8C, 0xEB, 0x4C, 0xEB, -+0x06, 0x23, 0x00, 0x18, 0x90, 0xCA, 0x03, 0x2A, -+0x90, 0x67, 0x00, 0x18, 0x3A, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x99, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, 0x10, 0x23, -+0x03, 0x6B, 0x6B, 0xEB, 0x6C, 0xEC, 0x68, 0xF3, -+0x99, 0xC2, 0x68, 0xF3, 0x9D, 0xA2, 0x8C, 0xEB, -+0x68, 0xF3, 0x7D, 0xC2, 0x68, 0xF3, 0x5D, 0xA2, -+0x07, 0x6B, 0x6C, 0xEA, 0x6A, 0x2A, 0x66, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x5B, 0xF7, 0x94, 0x9B, -+0xFF, 0xF7, 0x1F, 0x6D, 0x60, 0xAC, 0xAC, 0xEB, -+0x01, 0x4B, 0xAC, 0xEB, 0x60, 0xCC, 0x88, 0xF3, -+0x65, 0xA2, 0x68, 0xF3, 0x9D, 0xA2, 0x01, 0x4B, -+0x88, 0xF3, 0x65, 0xC2, 0x11, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x68, 0xF3, 0x7D, 0xC2, 0x88, 0xF3, -+0x65, 0xA2, 0xE8, 0xF3, 0x44, 0xA2, 0x63, 0xEA, -+0x49, 0x60, 0x30, 0xF0, 0x20, 0x69, 0x71, 0x67, -+0xEF, 0xF4, 0x08, 0x4B, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF5, 0x58, 0x9A, 0xE0, 0xF1, 0x99, 0xA3, -+0x40, 0xEA, 0x01, 0x72, 0x3E, 0x61, 0xEF, 0xF4, -+0x68, 0xA1, 0x01, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x02, 0x2A, 0x00, 0x18, 0x94, 0xC9, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x95, 0xA2, 0x10, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xFF, 0x6C, 0x8C, 0xEB, 0x07, 0x2B, -+0x68, 0xF3, 0x99, 0xA2, 0xDF, 0x4B, 0x8C, 0xEB, -+0x68, 0xF3, 0x79, 0xC2, 0x22, 0x10, 0x88, 0xF3, -+0x66, 0xA2, 0x01, 0x4B, 0x88, 0xF3, 0x66, 0xC2, -+0x88, 0xF3, 0x66, 0xA2, 0x02, 0x5B, 0x0B, 0x61, -+0x68, 0xF3, 0x99, 0xA2, 0x21, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x68, 0xF3, 0x79, 0xC2, 0x00, 0x6B, -+0x88, 0xF3, 0x66, 0xC2, 0x03, 0x10, 0x90, 0x67, -+0x00, 0x18, 0x58, 0xCE, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x00, 0x6B, 0x88, 0xF3, -+0x65, 0xC2, 0x03, 0x10, 0x90, 0x67, 0x00, 0x18, -+0x81, 0xCC, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, -+0x05, 0x5A, 0x00, 0x68, 0x24, 0x60, 0x10, 0xF0, -+0x24, 0x6B, 0x48, 0x34, 0x9B, 0xF1, 0x10, 0x4B, -+0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, 0x10, 0xF0, -+0x24, 0x6B, 0x5B, 0xF7, 0x78, 0x9B, 0x13, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x5B, 0xF7, 0x7C, 0x9B, -+0x0E, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x7B, 0xF7, -+0x60, 0x9B, 0x09, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x7B, 0xF7, 0x64, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x7B, 0xF7, 0x68, 0x9B, 0x60, 0xAB, -+0xFF, 0xF7, 0x1F, 0x68, 0x6C, 0xE8, 0x18, 0xF0, -+0x00, 0x6B, 0x0C, 0xEB, 0x13, 0x2B, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, 0x68, 0xF3, -+0xBD, 0xA4, 0xFE, 0x4B, 0xAC, 0xEB, 0x05, 0x6D, -+0xAB, 0xED, 0xAC, 0xEB, 0x02, 0x4D, 0xAC, 0xEB, -+0x68, 0xF3, 0x7D, 0xC4, 0x82, 0x67, 0x00, 0x18, -+0x81, 0xCC, 0x7D, 0x10, 0x08, 0xF0, 0x00, 0x6B, -+0x0C, 0xEB, 0x43, 0x23, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, 0xD4, 0xA3, -+0x7F, 0x6C, 0xFF, 0x6D, 0xCC, 0xEC, 0x01, 0x74, -+0x12, 0x61, 0x68, 0xF3, 0xDD, 0xA3, 0x01, 0x6C, -+0xCD, 0xEC, 0x68, 0xF3, 0x9D, 0xC3, 0x68, 0xF3, -+0x95, 0xA3, 0x10, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0xAC, 0xEB, 0x20, 0x73, 0x11, 0x61, 0x82, 0x67, -+0x00, 0x18, 0x58, 0xCE, 0x34, 0x10, 0x02, 0x74, -+0x32, 0x61, 0x68, 0xF3, 0x57, 0xA3, 0x01, 0x6C, -+0x8C, 0xEA, 0xAC, 0xEA, 0x0B, 0x2A, 0x68, 0xF3, -+0x5D, 0xA3, 0x4D, 0xEC, 0x68, 0xF3, 0x9D, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0x21, 0x10, 0x68, 0xF3, 0x95, 0xA3, -+0x10, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, 0xAC, 0xEA, -+0x10, 0x72, 0x19, 0x61, 0x68, 0xF3, 0x9D, 0xA3, -+0x04, 0x6A, 0x00, 0x6D, 0x8D, 0xEA, 0x68, 0xF3, -+0x5D, 0xC3, 0x01, 0x6C, 0x00, 0x18, 0x30, 0xD2, -+0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0x9D, 0xA3, 0x02, 0x6A, -+0x4B, 0xEA, 0x8C, 0xEA, 0x05, 0x6C, 0x8B, 0xEC, -+0x8C, 0xEA, 0x68, 0xF3, 0x5D, 0xC3, 0x02, 0x30, -+0x1E, 0x30, 0x1A, 0x20, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x5D, 0xA0, -+0x02, 0x69, 0xE8, 0xF3, 0xC5, 0xA0, 0x2D, 0xEA, -+0x68, 0xF3, 0x5D, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x50, 0x9A, 0xFF, 0x6C, 0x55, 0x4C, -+0x00, 0x6D, 0x40, 0xEA, 0x68, 0xF3, 0x59, 0xA0, -+0x4D, 0xE9, 0x68, 0xF3, 0x39, 0xC0, 0x0B, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x9D, 0xA2, 0x03, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x68, 0xF3, 0x7D, 0xC2, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x24, 0x67, 0x6E, 0xF5, 0x58, 0x9A, 0xEF, 0xF6, -+0x81, 0xA3, 0xFF, 0x68, 0x0C, 0xE9, 0x40, 0xEA, -+0x01, 0x72, 0x20, 0xF1, 0x0C, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, -+0x94, 0xA3, 0x7F, 0x6A, 0x8C, 0xEA, 0x0C, 0xEA, -+0x20, 0xF1, 0x01, 0x22, 0x68, 0xF3, 0x75, 0xA3, -+0x0F, 0x6A, 0x6C, 0xEA, 0x01, 0x72, 0x69, 0x61, -+0x05, 0x59, 0x5A, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x28, 0x33, 0xBB, 0xF1, 0x04, 0x4A, 0x69, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x7B, 0xF7, 0x4C, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x7B, 0xF7, -+0x70, 0x9B, 0x3F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x7B, 0xF7, 0x54, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x7B, 0xF7, -+0x78, 0x9B, 0x2F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x7B, 0xF7, 0x5C, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF7, -+0x60, 0x9B, 0x1F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x9B, 0xF7, 0x44, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF7, -+0x68, 0x9B, 0x0F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x9B, 0xF7, 0x4C, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF7, -+0x70, 0x9B, 0x60, 0xA3, 0x88, 0xF3, 0x62, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x63, 0xA2, 0x02, 0x2B, 0x88, 0xF3, -+0x62, 0xA2, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x6B, 0xC2, 0x91, 0x67, 0x00, 0x18, 0xBE, 0xC9, -+0x10, 0xF0, 0x24, 0x6C, 0x9B, 0xF7, 0xB4, 0x9C, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x00, 0x6B, 0x88, 0xF3, 0x65, 0xC2, 0x88, 0xF3, -+0x66, 0xC2, 0x80, 0xAD, 0xFF, 0xF7, 0x1F, 0x6E, -+0xCC, 0xEC, 0x01, 0x4C, 0xCC, 0xEC, 0x80, 0xCD, -+0x10, 0xF0, 0x24, 0x6C, 0x88, 0xF3, 0xAA, 0xA2, -+0x1B, 0xF7, 0x94, 0x9C, 0xA0, 0xC4, 0x10, 0xF0, -+0x24, 0x6C, 0x9B, 0xF7, 0x98, 0x9C, 0x60, 0xC4, -+0x10, 0xF0, 0x24, 0x6B, 0x3B, 0xF7, 0x78, 0x9B, -+0x02, 0x6C, 0x80, 0xC3, 0x68, 0xF3, 0x9D, 0xA2, -+0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x11, 0x6C, -+0x8B, 0xEC, 0x8C, 0xEB, 0x68, 0xF3, 0x7D, 0xC2, -+0x08, 0xF3, 0x6A, 0xA2, 0x01, 0x6A, 0x4C, 0xEB, -+0x08, 0x2B, 0x30, 0xF0, 0x21, 0x6B, 0x70, 0xF3, -+0x78, 0xA3, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x04, 0x22, 0x91, 0x67, 0x00, 0x18, 0x06, 0xC5, -+0x03, 0x10, 0x91, 0x67, 0x00, 0x18, 0xC5, 0xCE, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x79, 0xA0, 0x40, 0x6A, 0x6C, 0xEA, -+0x55, 0x22, 0x68, 0xF3, 0x9A, 0xA0, 0x10, 0x6B, -+0xFF, 0x6D, 0x44, 0x67, 0x6C, 0xEA, 0xAC, 0xEA, -+0x22, 0x2A, 0x88, 0xF3, 0x43, 0xA0, 0x88, 0xF3, -+0xA2, 0xA0, 0xAE, 0xEA, 0x47, 0x2A, 0x8D, 0xEB, -+0x68, 0xF3, 0x7A, 0xC0, 0x91, 0x67, 0x00, 0x18, -+0xD9, 0xEC, 0x91, 0x67, 0x00, 0x18, 0x0A, 0xEC, -+0x00, 0x18, 0x90, 0xCA, 0x06, 0x2A, 0x91, 0x67, -+0x00, 0x18, 0x41, 0xEC, 0x91, 0x67, 0x00, 0x18, -+0x3A, 0xEC, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x88, 0xF3, 0x63, 0xA2, 0xFF, 0x4B, -+0x88, 0xF3, 0x63, 0xC2, 0x2B, 0x10, 0x68, 0xF3, -+0x75, 0xA0, 0x0F, 0x6A, 0x6C, 0xEA, 0x01, 0x72, -+0x25, 0x61, 0x88, 0xF3, 0x43, 0xA0, 0x04, 0xD2, -+0x04, 0x93, 0x88, 0xF3, 0x42, 0xA0, 0x6E, 0xEA, -+0x1D, 0x22, 0x91, 0x67, 0x00, 0x18, 0xCE, 0xEC, -+0x04, 0x95, 0xAE, 0xEA, 0x17, 0x22, 0x68, 0xF3, -+0x79, 0xA0, 0x20, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x10, 0x22, 0x68, 0xF3, 0x7A, 0xA0, -+0x11, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, -+0x5A, 0xC0, 0x91, 0x67, 0x00, 0x18, 0x30, 0xEC, -+0x91, 0x67, 0x00, 0x18, 0x1B, 0xEC, 0x91, 0x67, -+0x00, 0x18, 0x14, 0xEC, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, -+0x01, 0x6B, 0xE8, 0xF3, 0x62, 0xC2, 0x20, 0x6B, -+0x8D, 0xEB, 0x68, 0xF3, 0x79, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xC8, 0xF4, 0x72, 0xA2, 0x02, 0x6A, -+0x4C, 0xEB, 0x08, 0x23, 0x30, 0xF0, 0x21, 0x6B, -+0x70, 0xF3, 0x78, 0xA3, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x0A, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, -+0x20, 0x6B, 0x8D, 0xEB, 0x68, 0xF3, 0x79, 0xC2, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xED, 0x4C, 0xEC, 0xCC, 0xEA, -+0xA0, 0xF0, 0x1D, 0x25, 0x05, 0x5C, 0xA0, 0xF0, -+0x10, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x88, 0x34, -+0xBB, 0xF1, 0x18, 0x4B, 0x8D, 0xE3, 0x60, 0x9B, -+0x00, 0xEB, 0x02, 0x72, 0x0A, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x9B, 0xF7, 0xBC, 0x9A, 0x01, 0x6C, -+0x00, 0x18, 0xC1, 0xE0, 0x00, 0x6C, 0x08, 0x6D, -+0x1D, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF7, -+0xA0, 0x9A, 0x01, 0x6C, 0x00, 0x18, 0xC1, 0xE0, -+0x00, 0x6C, 0x08, 0x6D, 0x00, 0x18, 0xC1, 0xE0, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x54, 0x9A, -+0x01, 0x6C, 0x0C, 0x6D, 0x89, 0x10, 0x02, 0x72, -+0x0C, 0x60, 0x04, 0x6C, 0x0F, 0x6D, 0x00, 0x18, -+0xC1, 0xE0, 0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, -+0xA0, 0x9A, 0x04, 0x6C, 0x00, 0x18, 0xC1, 0xE0, -+0x7C, 0x10, 0x04, 0x6C, 0x03, 0x6D, 0x00, 0x18, -+0xC1, 0xE0, 0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, -+0xA0, 0x9A, 0x04, 0x6C, 0x00, 0x18, 0xC1, 0xE0, -+0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0x4E, 0xF2, 0x54, 0x9A, 0x02, 0x6C, 0xBB, 0xF7, -+0xA4, 0x9B, 0x66, 0x10, 0x02, 0x72, 0x0A, 0x60, -+0x04, 0x6C, 0xF0, 0x6D, 0x00, 0x18, 0xC1, 0xE0, -+0x10, 0xF0, 0x24, 0x6A, 0x04, 0x6C, 0x5B, 0xF7, -+0xA4, 0x9A, 0xDC, 0x17, 0x04, 0x6C, 0x30, 0x6D, -+0x00, 0x18, 0xC1, 0xE0, 0x10, 0xF0, 0x24, 0x6A, -+0x5B, 0xF7, 0xA4, 0x9A, 0x04, 0x6C, 0x00, 0x18, -+0xC1, 0xE0, 0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0x4E, 0xF2, 0x54, 0x9A, 0x02, 0x6C, -+0xBB, 0xF7, 0xA8, 0x9B, 0x45, 0x10, 0x02, 0x72, -+0x0B, 0x60, 0x04, 0x6C, 0x01, 0xF7, 0x00, 0x6D, -+0x00, 0x18, 0xC1, 0xE0, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x6C, 0x5B, 0xF7, 0xA8, 0x9A, 0xBA, 0x17, -+0x04, 0x6C, 0x00, 0xF3, 0x00, 0x6D, 0x00, 0x18, -+0xC1, 0xE0, 0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, -+0xA8, 0x9A, 0x04, 0x6C, 0x00, 0x18, 0xC1, 0xE0, -+0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0x4E, 0xF2, 0x54, 0x9A, 0x02, 0x6C, 0xBB, 0xF7, -+0xAC, 0x9B, 0x22, 0x10, 0x02, 0x72, 0x0B, 0x60, -+0x04, 0x6C, 0x1E, 0xF0, 0x00, 0x6D, 0x00, 0x18, -+0xC1, 0xE0, 0x10, 0xF0, 0x24, 0x6A, 0x04, 0x6C, -+0x5B, 0xF7, 0xAC, 0x9A, 0x97, 0x17, 0x04, 0x6C, -+0x06, 0xF0, 0x00, 0x6D, 0x00, 0x18, 0xC1, 0xE0, -+0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, 0xAC, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0xC1, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, 0x4E, 0xF2, -+0x54, 0x9A, 0xFB, 0xF6, 0xB0, 0x9B, 0x02, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, -+0x70, 0x9A, 0xFF, 0x6C, 0x07, 0x6D, 0x40, 0xA3, -+0x8C, 0xEA, 0xAD, 0xEA, 0x65, 0x10, 0x05, 0x5C, -+0x5D, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, -+0xDB, 0xF1, 0x0C, 0x4A, 0x89, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x9B, 0xF7, -+0xBC, 0x9A, 0x01, 0x6C, 0x00, 0x18, 0xF2, 0xE0, -+0x00, 0x6C, 0x08, 0x6D, 0x00, 0x18, 0xF2, 0xE0, -+0x01, 0x6C, 0x0C, 0x6D, 0x45, 0x10, 0x04, 0x6C, -+0x0F, 0x6D, 0x00, 0x18, 0xF2, 0xE0, 0x10, 0xF0, -+0x24, 0x6A, 0x5B, 0xF7, 0xA0, 0x9A, 0x04, 0x6C, -+0x00, 0x18, 0xF2, 0xE0, 0x10, 0xF0, 0x24, 0x6A, -+0x02, 0x6C, 0xBB, 0xF7, 0xA4, 0x9A, 0x34, 0x10, -+0x04, 0x6C, 0xF0, 0x6D, 0x00, 0x18, 0xF2, 0xE0, -+0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, 0xA4, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0xF2, 0xE0, 0x10, 0xF0, -+0x24, 0x6A, 0x02, 0x6C, 0xBB, 0xF7, 0xA8, 0x9A, -+0x23, 0x10, 0x04, 0x6C, 0x01, 0xF7, 0x00, 0x6D, -+0x00, 0x18, 0xF2, 0xE0, 0x10, 0xF0, 0x24, 0x6A, -+0x5B, 0xF7, 0xA8, 0x9A, 0x04, 0x6C, 0x00, 0x18, -+0xF2, 0xE0, 0x10, 0xF0, 0x24, 0x6A, 0x02, 0x6C, -+0xBB, 0xF7, 0xAC, 0x9A, 0x11, 0x10, 0x04, 0x6C, -+0x1E, 0xF0, 0x00, 0x6D, 0x00, 0x18, 0xF2, 0xE0, -+0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, 0xAC, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0xF2, 0xE0, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF6, 0xB0, 0x9A, 0x02, 0x6C, -+0x00, 0x18, 0x42, 0xE1, 0x10, 0xF0, 0x24, 0x6A, -+0x5B, 0xF7, 0x70, 0x9A, 0xF8, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x54, 0xA0, -+0x7F, 0x6E, 0xFF, 0x69, 0x4C, 0xEE, 0x2C, 0xEC, -+0x01, 0x6D, 0x2C, 0xEE, 0x04, 0xD4, 0x00, 0x18, -+0xD7, 0xCF, 0x88, 0xF3, 0x6A, 0xA8, 0x10, 0xF0, -+0x24, 0x6A, 0x1B, 0xF7, 0x54, 0x9A, 0x2C, 0xEB, -+0x60, 0xC2, 0xC8, 0xF3, 0x99, 0xA0, 0x80, 0x6A, -+0x4B, 0xEA, 0x1F, 0x6B, 0x8C, 0xEA, 0x8C, 0xEB, -+0x2C, 0xEA, 0x2C, 0xEB, 0x11, 0x22, 0x6F, 0x32, -+0x2C, 0xEA, 0x82, 0x42, 0x01, 0x4A, 0xC8, 0xF3, -+0x5D, 0xC0, 0x07, 0x6A, 0x6C, 0xEA, 0x68, 0xF3, -+0x77, 0xA0, 0xC8, 0xF3, 0x9C, 0xC0, 0x76, 0x33, -+0x6C, 0x33, 0x6D, 0xEA, 0x2C, 0xEA, 0x06, 0x10, -+0x04, 0x6B, 0xC8, 0xF3, 0x7C, 0xC0, 0x03, 0x6B, -+0xC8, 0xF3, 0x7D, 0xC0, 0x10, 0xF0, 0x24, 0x6B, -+0xBB, 0xF7, 0x70, 0x9B, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, -+0x58, 0x9A, 0xEF, 0xF6, 0x81, 0xA3, 0x40, 0xEA, -+0x01, 0x72, 0x19, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, -+0x21, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x68, 0xF3, 0x5C, 0xA2, 0x04, 0x6B, -+0x6C, 0xEA, 0x13, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x04, 0x96, 0x83, 0x67, -+0x01, 0x6D, 0x40, 0xEA, 0x0A, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x99, 0xA2, 0x20, 0x6B, 0x8D, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x54, 0xA0, -+0x7F, 0x6E, 0xFF, 0x69, 0x4C, 0xEE, 0x2C, 0xEC, -+0x01, 0x6D, 0x2C, 0xEE, 0x04, 0xD4, 0x00, 0x18, -+0xD7, 0xCF, 0x88, 0xF3, 0x6A, 0xA8, 0x10, 0xF0, -+0x24, 0x6A, 0x1B, 0xF7, 0x54, 0x9A, 0x2C, 0xEB, -+0x60, 0xC2, 0xC8, 0xF3, 0x99, 0xA0, 0x80, 0x6A, -+0x4B, 0xEA, 0x1F, 0x6B, 0x8C, 0xEA, 0x8C, 0xEB, -+0x2C, 0xEA, 0x2C, 0xEB, 0x11, 0x22, 0x6F, 0x32, -+0x2C, 0xEA, 0x82, 0x42, 0x01, 0x4A, 0xC8, 0xF3, -+0x5D, 0xC0, 0x07, 0x6A, 0x6C, 0xEA, 0x68, 0xF3, -+0x77, 0xA0, 0xC8, 0xF3, 0x9C, 0xC0, 0x76, 0x33, -+0x6C, 0x33, 0x6D, 0xEA, 0x2C, 0xEA, 0x06, 0x10, -+0x04, 0x6B, 0xC8, 0xF3, 0x7C, 0xC0, 0x03, 0x6B, -+0xC8, 0xF3, 0x7D, 0xC0, 0x10, 0xF0, 0x24, 0x6B, -+0xBB, 0xF7, 0x70, 0x9B, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, -+0x58, 0x9A, 0xEF, 0xF6, 0x81, 0xA3, 0x40, 0xEA, -+0x01, 0x72, 0x19, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, -+0x21, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x68, 0xF3, 0x5C, 0xA2, 0x04, 0x6B, -+0x6C, 0xEA, 0x13, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x04, 0x96, 0x83, 0x67, -+0x01, 0x6D, 0x40, 0xEA, 0x0A, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x99, 0xA2, 0x20, 0x6B, 0x8D, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x25, 0x67, 0x04, 0xD4, 0x4C, 0xE9, 0x5D, 0x2C, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x74, 0xA0, 0x7F, 0x6E, 0x91, 0x67, -+0x6C, 0xEE, 0x4C, 0xEE, 0x00, 0x6D, 0x00, 0x18, -+0xD7, 0xCF, 0x7D, 0x67, 0x87, 0x43, 0x09, 0x4C, -+0x10, 0xF0, 0x24, 0x6A, 0x60, 0xA4, 0x9B, 0xF7, -+0x58, 0x9A, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x58, 0x9A, 0x02, 0x6B, 0x60, 0xDA, -+0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x6E, 0xF5, 0x58, 0x9A, 0xEF, 0xF6, 0x81, 0xA3, -+0x40, 0xEA, 0x10, 0x2A, 0x00, 0x18, 0x11, 0xED, -+0x91, 0x67, 0x00, 0x18, 0x67, 0xCD, 0x68, 0xF3, -+0x7A, 0xA0, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x03, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x68, 0xF3, -+0x5A, 0xC0, 0x08, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x0C, 0x6C, 0x01, 0x6D, -+0xD1, 0x67, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, -+0x05, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x68, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, 0x1C, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x54, 0x9A, -+0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x58, 0x9A, 0x04, 0x6B, 0x60, 0xC2, -+0x0F, 0x10, 0x04, 0x94, 0x01, 0x74, 0x06, 0x61, -+0x91, 0x67, 0x00, 0x18, 0xA9, 0xD0, 0x80, 0x18, -+0x76, 0x13, 0x06, 0x10, 0x04, 0x92, 0x02, 0x72, -+0x03, 0x61, 0x91, 0x67, 0x00, 0x18, 0x6F, 0xD0, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x69, 0x2C, 0xED, -+0x30, 0xF0, 0x20, 0x68, 0x0A, 0xD4, 0xC0, 0xF1, -+0x08, 0x48, 0x85, 0x67, 0x04, 0xD5, 0x00, 0x18, -+0x09, 0xCC, 0x68, 0xF3, 0x94, 0xA0, 0x7F, 0x6A, -+0x04, 0x95, 0x4C, 0xEC, 0x2C, 0xEC, 0x00, 0x18, -+0xE3, 0xD0, 0x68, 0xF3, 0x54, 0xA0, 0x7F, 0x6B, -+0x6C, 0xEA, 0x2C, 0xEA, 0x18, 0x22, 0x0A, 0x93, -+0x0F, 0x6C, 0x41, 0xA3, 0xA2, 0xA3, 0x4C, 0xEC, -+0x2C, 0xEC, 0x00, 0x18, 0x16, 0xC9, 0x28, 0xF1, -+0x54, 0xA0, 0x03, 0x72, 0x0C, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF7, 0x74, 0x9A, 0x40, 0xA3, -+0x4C, 0xE9, 0x02, 0x6A, 0x2C, 0xEA, 0x03, 0x22, -+0xFD, 0x6A, 0x2C, 0xEA, 0x40, 0xC3, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFF, 0x6A, 0x4C, 0xEC, 0xAC, 0xEA, 0x0B, 0x2A, -+0x10, 0xF0, 0x24, 0x6B, 0xBB, 0xF7, 0xB8, 0x9B, -+0x10, 0xF0, 0x24, 0x6E, 0xBB, 0xF7, 0xDC, 0x9E, -+0x60, 0x9D, 0xCC, 0xEB, 0x0C, 0x10, 0x01, 0x72, -+0x0B, 0x61, 0x10, 0xF0, 0x24, 0x6B, 0xBB, 0xF7, -+0xB8, 0x9B, 0x10, 0xF0, 0x24, 0x6E, 0xDB, 0xF7, -+0xC0, 0x9E, 0x60, 0x9D, 0xCD, 0xEB, 0x60, 0xDD, -+0x05, 0x5C, 0x60, 0xF1, 0x06, 0x60, 0x10, 0xF0, -+0x24, 0x6B, 0x88, 0x34, 0xFB, 0xF1, 0x0C, 0x4B, -+0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF7, 0x78, 0x9A, -+0x0D, 0x11, 0x01, 0x72, 0x10, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF7, 0x78, 0x9A, 0xFF, 0x6C, -+0x40, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0x8C, 0xEA, 0x40, 0xC3, 0x40, 0xA3, 0x80, 0x4D, -+0xC0, 0x4D, 0x8C, 0xEA, 0x14, 0x10, 0x02, 0x72, -+0x07, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF7, -+0x78, 0x9A, 0xBF, 0x6A, 0x80, 0xA3, 0xF4, 0x10, -+0x03, 0x72, 0x20, 0xF1, 0x1A, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF7, 0x78, 0x9A, 0xFF, 0x6C, -+0x40, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0xE7, 0x10, 0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF7, 0x64, 0x9A, 0xFD, 0x6A, 0x80, 0xA3, -+0xDF, 0x10, 0x01, 0x72, 0x19, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF7, 0x98, 0x9A, 0xFF, 0x6A, -+0x40, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x10, 0xF0, 0x24, 0x6B, -+0xDB, 0xF7, 0x84, 0x9B, 0x01, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x60, 0xA4, 0x02, 0x6D, 0x4C, 0xEB, 0xE1, 0x10, -+0x02, 0x72, 0x0F, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF7, 0x78, 0x9A, 0xBF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF7, 0x64, 0x9A, 0xFE, 0x6A, 0x80, 0xA3, -+0xB3, 0x10, 0x03, 0x72, 0xE0, 0xF0, 0x19, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF7, 0x98, 0x9A, -+0xFF, 0x6B, 0x40, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF7, 0x84, 0x9A, 0x01, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0x92, 0x10, 0x07, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF7, 0x64, 0x9A, -+0xF7, 0x6A, 0x80, 0xA3, 0x95, 0x10, 0x01, 0x72, -+0x19, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF7, -+0x98, 0x9A, 0xFF, 0x6A, 0x40, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF7, 0x84, 0x9B, -+0x04, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x60, 0xA4, 0x08, 0x6D, -+0x4C, 0xEB, 0x97, 0x10, 0x02, 0x72, 0x0F, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF7, 0x78, 0x9A, -+0xBF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF7, 0x64, 0x9A, -+0xFB, 0x6A, 0x80, 0xA3, 0x69, 0x10, 0x03, 0x72, -+0xA0, 0xF0, 0x0F, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF7, 0x98, 0x9A, 0xFF, 0x6B, 0x40, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF7, -+0x84, 0x9A, 0x04, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0x48, 0x10, 0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF7, 0x64, 0x9A, 0xDF, 0x6A, 0x80, 0xA3, -+0x4B, 0x10, 0x01, 0x72, 0x19, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF7, 0x98, 0x9A, 0xFF, 0x6A, -+0x40, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x10, 0xF0, 0x24, 0x6B, -+0xDB, 0xF7, 0x84, 0x9B, 0x10, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x60, 0xA4, 0x20, 0x6D, 0x4C, 0xEB, 0x4D, 0x10, -+0x02, 0x72, 0x0F, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF7, 0x78, 0x9A, 0xBF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF7, 0x64, 0x9A, 0xEF, 0x6A, 0x80, 0xA3, -+0x1F, 0x10, 0x03, 0x72, 0x66, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF7, 0x98, 0x9A, 0xFF, 0x6B, -+0x40, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF7, 0x84, 0x9A, 0x10, 0x6D, 0x40, 0xA4, -+0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x20, 0xE8, 0x09, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF7, 0x64, 0x9A, 0x80, 0xA3, 0x7F, 0x6A, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x01, 0x72, -+0x1C, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF7, -+0x98, 0x9A, 0xFF, 0x6A, 0x40, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF7, 0x84, 0x9B, -+0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, -+0x60, 0xC4, 0x60, 0xA4, 0x80, 0x4D, 0xC0, 0x4D, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x20, 0xE8, 0x02, 0x72, 0x10, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF7, 0x58, 0x9A, 0xBF, 0x6B, -+0x80, 0xA2, 0x6C, 0xEC, 0x80, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF7, 0x44, 0x9A, 0x80, 0xA2, -+0x8C, 0xEB, 0x60, 0xC2, 0x20, 0xE8, 0x03, 0x72, -+0x14, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF7, -+0x98, 0x9A, 0xFF, 0x6B, 0x40, 0x6D, 0x40, 0xA4, -+0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF7, 0x84, 0x9A, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x20, 0xE8, 0xFF, 0x63, 0x01, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF7, 0x68, 0x9B, -+0xFF, 0x6A, 0x4C, 0xEC, 0x6D, 0xE5, 0x00, 0xA3, -+0x3F, 0x6F, 0x01, 0x74, 0x0C, 0xEF, 0x4C, 0xEE, -+0xE0, 0xC3, 0x10, 0x61, 0x10, 0xF0, 0x24, 0x6C, -+0xDB, 0xF7, 0xEC, 0x9C, 0x10, 0x68, 0xFD, 0xE5, -+0x80, 0xA7, 0x4C, 0xEC, 0x0D, 0xEC, 0x4C, 0xEC, -+0x80, 0xC7, 0x80, 0xA3, 0x80, 0x6F, 0xEB, 0xEF, -+0x4C, 0xEC, 0x0D, 0x10, 0x0F, 0x2C, 0x10, 0xF0, -+0x24, 0x6C, 0xDB, 0xF7, 0xEC, 0x9C, 0xEF, 0x6C, -+0xFD, 0xE5, 0x00, 0xA7, 0x0C, 0xEC, 0x80, 0xC7, -+0x80, 0xA3, 0x40, 0x6F, 0x4C, 0xEC, 0xED, 0xEC, -+0x4C, 0xEC, 0x80, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF7, 0x50, 0x9A, 0x80, 0xF4, 0xC0, 0x36, -+0x55, 0xE5, 0x40, 0x9D, 0x4D, 0xEE, 0xC0, 0xDD, -+0x01, 0x90, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF7, 0x54, 0x9A, 0xFF, 0x6B, 0x40, 0xA2, -+0x6C, 0xEA, 0x52, 0x32, 0x6C, 0xEA, 0x11, 0x2A, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x5C, 0x9A, 0xA8, 0xF4, 0x86, 0xA3, -+0x00, 0x6D, 0x18, 0x6E, 0xE5, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF2, 0x5C, 0x9A, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x28, 0xF1, 0x70, 0xA0, 0xFF, 0x6A, 0x4C, 0xED, -+0x01, 0x4B, 0x28, 0xF1, 0x70, 0xC0, 0x10, 0xF0, -+0x24, 0x6B, 0xDB, 0xF7, 0x74, 0x9B, 0x04, 0xD5, -+0x24, 0x67, 0x60, 0xA3, 0x4C, 0xE9, 0x4C, 0xEB, -+0x72, 0x33, 0x4C, 0xEB, 0x31, 0x23, 0x10, 0xF0, -+0x24, 0x6B, 0x3B, 0xF7, 0x7C, 0x9B, 0x00, 0x6C, -+0xFF, 0x6D, 0x60, 0xA3, 0x29, 0x6E, 0x6C, 0xEA, -+0x05, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF2, 0x40, 0x9A, 0x40, 0xEA, 0x01, 0x72, -+0x12, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, -+0x80, 0xA0, 0x6E, 0xF2, 0x5C, 0x9A, 0x01, 0x6D, -+0x08, 0x6E, 0x00, 0x6F, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0x2E, 0xF4, 0x6C, 0x9B, 0x04, 0x96, -+0x91, 0x67, 0xA2, 0x67, 0x40, 0xEB, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x05, 0x95, -+0x00, 0x6C, 0x2A, 0x6E, 0x40, 0xEA, 0x12, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, 0x80, 0xA0, -+0x6E, 0xF2, 0x5C, 0x9A, 0x01, 0x6D, 0x08, 0x6E, -+0x00, 0x6F, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x2E, 0xF4, 0x6C, 0x9B, 0x04, 0x96, 0x91, 0x67, -+0xA2, 0x67, 0x40, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF2, 0x5C, 0x9A, 0x40, 0xEA, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFF, 0xF7, 0x1F, 0x6A, 0xAC, 0xEA, 0xFF, 0x6B, -+0xA2, 0x67, 0x42, 0x32, 0x6C, 0xED, 0x6C, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF7, 0x78, 0x9B, -+0x6D, 0xE4, 0xA0, 0xC3, 0x10, 0xF0, 0x24, 0x6B, -+0xDB, 0xF7, 0x7C, 0x9B, 0x71, 0xE4, 0x40, 0xC4, -+0x20, 0xE8, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0xFF, 0xF7, 0x1F, 0x68, 0xDB, 0xF7, 0x74, 0x9B, -+0x0C, 0xED, 0x04, 0xD5, 0x60, 0xA3, 0xFF, 0x6A, -+0x24, 0x67, 0x4C, 0xE9, 0x2D, 0x23, 0x10, 0xF0, -+0x24, 0x6B, 0x3B, 0xF7, 0x7C, 0x9B, 0x00, 0x6C, -+0xFF, 0x6D, 0x60, 0xA3, 0x36, 0x6E, 0x6C, 0xEA, -+0x05, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF2, 0x40, 0x9A, 0x40, 0xEA, 0x01, 0x72, -+0x0E, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x5C, 0x9A, 0x00, 0x6E, 0x91, 0x67, 0x01, 0x6D, -+0xE6, 0x67, 0x40, 0xEA, 0x04, 0x95, 0x82, 0x67, -+0x0C, 0xEC, 0x00, 0x18, 0x64, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x05, 0x95, -+0x00, 0x6C, 0x37, 0x6E, 0x40, 0xEA, 0x0E, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x5C, 0x9A, -+0x00, 0x6E, 0x91, 0x67, 0x01, 0x6D, 0xE6, 0x67, -+0x40, 0xEA, 0x04, 0x95, 0x82, 0x67, 0x0C, 0xEC, -+0x00, 0x18, 0x64, 0xD2, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x5C, 0x9A, 0x6F, 0x6D, 0x90, 0x6C, -+0x60, 0xA2, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x6C, 0xED, 0x38, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF2, 0x5C, 0x9A, -+0x40, 0xEA, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x64, 0x67, 0x4C, 0xEB, -+0x85, 0x67, 0x02, 0x5B, 0x4C, 0xEC, 0x43, 0x60, -+0x10, 0xF0, 0x24, 0x6D, 0xFB, 0xF7, 0xA0, 0x9D, -+0xFF, 0xF7, 0x1F, 0x6E, 0x30, 0xF0, 0x20, 0x68, -+0xE0, 0xAD, 0x10, 0xF0, 0x24, 0x6D, 0xFB, 0xF7, -+0xA4, 0x9D, 0xCC, 0xEF, 0xC0, 0xF1, 0x08, 0x48, -+0xA0, 0xAD, 0xAC, 0xEE, 0xD7, 0xE7, 0xC8, 0xF2, -+0xDF, 0xA0, 0x4C, 0xED, 0xCE, 0xED, 0x2B, 0x2D, -+0x68, 0xF3, 0x5C, 0xA0, 0x0E, 0x72, 0x0F, 0x61, -+0x26, 0x2B, 0x68, 0xF3, 0x7A, 0xA0, 0x03, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, -+0x00, 0x18, 0x3E, 0xD1, 0x01, 0x6C, 0x0C, 0x6D, -+0x00, 0x18, 0xE4, 0xC8, 0x10, 0x10, 0x06, 0x72, -+0x16, 0x61, 0x15, 0x23, 0x68, 0xF3, 0x7A, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x01, 0x6D, -+0x68, 0xF3, 0x5A, 0xC0, 0x00, 0x18, 0x3E, 0xD1, -+0x04, 0x6A, 0x68, 0xF3, 0x5C, 0xC0, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, -+0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xFF, 0x6A, 0xDB, 0xF7, -+0x74, 0x9B, 0x4C, 0xEE, 0x4C, 0xEF, 0x05, 0xD6, -+0x04, 0xD7, 0x60, 0xA3, 0xFF, 0xF7, 0x1F, 0x68, -+0x25, 0x67, 0x4C, 0xEB, 0x72, 0x33, 0x4C, 0xEB, -+0x8C, 0xE8, 0x4C, 0xE9, 0x34, 0x23, 0x10, 0xF0, -+0x24, 0x6B, 0x3B, 0xF7, 0x7C, 0x9B, 0x00, 0x6C, -+0xFF, 0x6D, 0x60, 0xA3, 0x26, 0x6E, 0x6C, 0xEA, -+0x06, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF2, 0x40, 0x9A, 0x40, 0xEA, 0x01, 0x72, -+0x11, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x05, 0x96, -+0x6E, 0xF2, 0x5C, 0x9A, 0x90, 0x67, 0x01, 0x6D, -+0x00, 0x6F, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x2E, 0xF4, 0x6C, 0x9B, 0x04, 0x96, 0x91, 0x67, -+0xA2, 0x67, 0x40, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0x06, 0x95, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6C, -+0x27, 0x6E, 0x40, 0xEA, 0x04, 0x95, 0x91, 0x67, -+0x00, 0x18, 0xA1, 0xD2, 0x15, 0x10, 0x04, 0x95, -+0x91, 0x67, 0x00, 0x18, 0xA1, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x05, 0x96, 0x6E, 0xF2, 0x5C, 0x9A, -+0x90, 0x67, 0x01, 0x6D, 0x00, 0x6F, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x6C, 0x9B, -+0x04, 0x96, 0x91, 0x67, 0xA2, 0x67, 0x40, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF2, 0x5C, 0x9A, -+0x40, 0xEA, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF0, 0x4C, 0x9A, 0xFF, 0x6B, 0x80, 0xA2, -+0x00, 0xF6, 0x80, 0x34, 0x00, 0xF6, 0x83, 0x34, -+0x00, 0x54, 0x24, 0x60, 0xA0, 0xA2, 0x7F, 0x6C, -+0xAC, 0xEC, 0x80, 0xC2, 0x80, 0xA2, 0x40, 0x6D, -+0x6C, 0xEC, 0xAD, 0xEC, 0x6C, 0xEC, 0x80, 0xC2, -+0x80, 0xA2, 0x10, 0xF0, 0x24, 0x6C, 0xFB, 0xF6, -+0x9C, 0x9C, 0x3F, 0x6D, 0x80, 0xA4, 0x10, 0xF0, -+0x24, 0x6C, 0x1B, 0xF7, 0x80, 0x9C, 0x80, 0xA4, -+0x10, 0xF0, 0x24, 0x6C, 0x1C, 0xF0, 0x90, 0x9C, -+0x80, 0xA4, 0x80, 0xA2, 0x6C, 0xEC, 0xAD, 0xEC, -+0x6C, 0xEC, 0x80, 0xC2, 0x80, 0xA2, 0xBF, 0x6B, -+0x8C, 0xEB, 0x60, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF0, 0x74, 0x9B, -+0xFF, 0x6A, 0x4C, 0xEC, 0xC0, 0xA3, 0x4C, 0xED, -+0x0C, 0x26, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x6C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x1C, 0xF0, -+0x98, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x20, 0xE8, 0x80, 0xC3, 0x0B, 0x25, 0x10, 0xF0, -+0x24, 0x6B, 0x1C, 0xF0, 0x9C, 0x9B, 0x80, 0x6D, -+0xAB, 0xED, 0x60, 0xA4, 0x4C, 0xEB, 0xAE, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x20, 0xE8, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0xF7, 0x1F, 0x6A, 0x0E, 0x90, 0x24, 0x67, -+0x4C, 0xE9, 0x03, 0x6B, 0x4C, 0xEF, 0x2C, 0xEB, -+0x00, 0x6A, 0x0B, 0xD5, 0x0C, 0xD6, 0x04, 0xD7, -+0x40, 0xC8, 0x00, 0x6A, 0x0A, 0x23, 0x28, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x40, 0xA8, 0x01, 0x4A, -+0x40, 0xC8, 0x1F, 0xF7, 0x00, 0x6A, 0x2C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF6, 0x5C, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0x40, 0x9A, 0x49, 0xE1, 0x0B, 0x93, 0x40, 0x9A, -+0x6C, 0xEA, 0x0C, 0x93, 0x6E, 0xEA, 0x04, 0x22, -+0x40, 0xA8, 0x04, 0x93, 0x63, 0xEA, 0xDC, 0x61, -+0x40, 0xA8, 0x04, 0x93, 0x63, 0xEA, 0x58, 0x67, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0x3C, 0xF0, 0x60, 0x9B, 0xFF, 0x6A, 0xCC, 0xEA, -+0x6D, 0xEA, 0xE0, 0xF1, 0x1F, 0x6B, 0xAC, 0xEB, -+0x10, 0xF0, 0x24, 0x6C, 0x3C, 0xF0, 0x84, 0x9C, -+0x60, 0x33, 0x60, 0x33, 0x6D, 0xEA, 0x40, 0xDC, -+0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF6, 0x4C, 0x9A, -+0x6D, 0xEA, 0x40, 0xDC, 0x20, 0xE8, 0x00, 0x65, -+0xE0, 0xF1, 0x1F, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0xFB, 0xF6, 0x6C, 0x9B, 0xAC, 0xEA, 0x40, 0x32, -+0x40, 0x32, 0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x3C, 0xF0, 0x64, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF0, 0x48, 0x9A, 0xFF, 0x6B, -+0x40, 0xA2, 0x6C, 0xEA, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x01, 0x68, 0x04, 0xEC, 0x04, 0xF7, 0x10, 0x69, -+0x13, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x01, 0x6C, 0xFF, 0x49, 0x40, 0xEA, -+0x0B, 0x29, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x6C, 0x9A, 0x08, 0xF0, 0x00, 0x6C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, 0x0B, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF0, 0x4C, 0x9A, -+0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x6A, 0x6C, 0xEA, -+0x0C, 0xEA, 0xE3, 0x2A, 0x01, 0x6A, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x0E, 0x92, 0x04, 0x67, 0x0F, 0x91, 0x04, 0xD2, -+0x04, 0x93, 0xFF, 0x6A, 0x4C, 0xE8, 0x4C, 0xEB, -+0x90, 0x67, 0x0B, 0xD5, 0x0C, 0xD6, 0x0D, 0xD7, -+0x04, 0xD3, 0x4C, 0xE9, 0x00, 0x18, 0x64, 0xD3, -+0x80, 0xF0, 0x07, 0x22, 0x06, 0x58, 0x80, 0xF0, -+0x04, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x08, 0x30, -+0x1B, 0xF2, 0x14, 0x4A, 0x09, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x02, 0xF2, 0x10, 0x6A, 0x0E, 0x10, -+0x02, 0xF2, 0x00, 0x6A, 0x0B, 0x10, 0x22, 0xF2, -+0x00, 0x6A, 0x08, 0x10, 0x22, 0xF2, 0x10, 0x6A, -+0x05, 0x10, 0x42, 0xF2, 0x00, 0x6A, 0x02, 0x10, -+0x42, 0xF2, 0x10, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0x0D, 0x94, 0x3C, 0xF0, 0x70, 0x9B, 0x8C, 0xEB, -+0x10, 0xF0, 0x24, 0x6C, 0x3C, 0xF0, 0x94, 0x9C, -+0x8D, 0xEB, 0x06, 0x21, 0x10, 0xF0, 0x24, 0x6C, -+0x3C, 0xF0, 0x98, 0x9C, 0x6D, 0xEC, 0x05, 0x10, -+0x10, 0xF0, 0x24, 0x6C, 0x3C, 0xF0, 0x9C, 0x9C, -+0x6C, 0xEC, 0x04, 0x96, 0x06, 0x26, 0x10, 0xF0, -+0x24, 0x6B, 0xFB, 0xF6, 0x6C, 0x9B, 0x8D, 0xEB, -+0x05, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x5C, 0xF0, -+0x60, 0x9B, 0x8C, 0xEB, 0x1F, 0xF7, 0x00, 0x6C, -+0x4C, 0xEC, 0x02, 0xF0, 0x00, 0x74, 0x01, 0x60, -+0x05, 0x2C, 0x10, 0xF0, 0x24, 0x6C, 0xBB, 0xF6, -+0xBC, 0x9C, 0x04, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0xDB, 0xF6, 0xA0, 0x9C, 0x10, 0xF0, 0x24, 0x6C, -+0x0B, 0x96, 0x5C, 0xF0, 0x84, 0x9C, 0xB5, 0xE2, -+0xCC, 0xEC, 0x80, 0xDD, 0x84, 0x42, 0x1F, 0xF7, -+0x00, 0x6D, 0xAC, 0xEC, 0x02, 0xF0, 0x00, 0x74, -+0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, 0x24, 0x6C, -+0x5C, 0xF0, 0xA8, 0x9C, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6C, 0x5C, 0xF0, 0xAC, 0x9C, 0x10, 0xF0, -+0x24, 0x6C, 0x0C, 0x96, 0x5C, 0xF0, 0x84, 0x9C, -+0xB5, 0xE2, 0xCC, 0xEC, 0x80, 0xDD, 0x87, 0x42, -+0x01, 0x4C, 0x1F, 0xF7, 0x00, 0x6D, 0xAC, 0xEC, -+0x02, 0xF0, 0x00, 0x74, 0x01, 0x60, 0x05, 0x2C, -+0x10, 0xF0, 0x24, 0x6C, 0x5C, 0xF0, 0x90, 0x9C, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6C, 0x5C, 0xF0, -+0x94, 0x9C, 0x89, 0xE2, 0x60, 0xDA, 0x01, 0x6A, -+0x01, 0x10, 0x00, 0x6A, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x04, 0xF7, -+0x10, 0x68, 0x13, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x05, 0x6C, 0xFF, 0x48, -+0x40, 0xEA, 0x0B, 0x28, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x6C, 0x9A, 0x08, 0xF0, 0x00, 0x6C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, -+0x09, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF0, -+0x4C, 0x9A, 0x60, 0xAA, 0x3F, 0x6A, 0x6C, 0xEA, -+0xE5, 0x2A, 0x01, 0x6A, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0x3C, 0xF0, 0x4C, 0x9A, 0x40, 0xAA, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF0, 0x4C, 0x9A, -+0x40, 0xAA, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x6A, 0x10, 0xF0, 0x24, 0x6C, 0x9B, 0xF6, -+0x8C, 0x9C, 0x10, 0xF0, 0x23, 0x6B, 0x89, 0xF7, -+0x15, 0x4B, 0x0A, 0x72, 0x60, 0xDC, 0x0C, 0x61, -+0x30, 0xF0, 0x21, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF7, 0x54, 0x9A, 0xD0, 0xF4, 0x94, 0x9B, -+0x01, 0x6D, 0xAB, 0xED, 0x40, 0xEA, 0x00, 0x6A, -+0x10, 0xF0, 0x24, 0x6C, 0xFF, 0x6B, 0x01, 0x4A, -+0x9B, 0xF6, 0x8C, 0x9C, 0x6C, 0xEA, 0x10, 0xF0, -+0x23, 0x6B, 0x89, 0xF7, 0x16, 0x4B, 0x60, 0xDC, -+0xDC, 0x17, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x00, 0x6A, 0x04, 0xD2, -+0x04, 0x92, 0x01, 0x72, 0x58, 0x67, 0x04, 0xD2, -+0x10, 0xF0, 0x23, 0x6A, 0x78, 0x67, 0xE9, 0xF7, -+0x05, 0x4A, 0x69, 0xE2, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x40, 0xDB, 0x00, 0x1C, -+0x96, 0x45, 0x00, 0x18, 0xFF, 0xD2, 0x00, 0x1C, -+0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x8C, 0x9A, 0x02, 0x6B, 0x8C, 0xEB, 0x09, 0x23, -+0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x00, 0x18, 0xF9, 0xDC, 0x00, 0x18, -+0x5B, 0xDD, 0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, -+0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, 0x04, 0x6B, -+0x8C, 0xEB, 0x09, 0x23, 0x05, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x00, 0x18, -+0x2B, 0xD9, 0x00, 0x18, 0x9C, 0xD8, 0x00, 0x1C, -+0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x94, 0xA2, 0x7F, 0x6B, 0x8C, 0xEB, 0x0D, 0x23, -+0x68, 0xF3, 0x98, 0xA2, 0x68, 0xF3, 0x7C, 0xA2, -+0x8E, 0xEB, 0x07, 0x23, 0x68, 0xF3, 0x97, 0xA2, -+0xFF, 0x6A, 0x96, 0x34, 0x4C, 0xEC, 0x00, 0x18, -+0x81, 0xCC, 0x30, 0xF0, 0x20, 0x6A, 0x40, 0xF2, -+0x54, 0x9A, 0x02, 0x2A, 0x00, 0x18, 0xAA, 0xCC, -+0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x8C, 0x9A, 0x10, 0x6B, 0x8C, 0xEB, -+0x0C, 0x23, 0x11, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF6, 0x47, 0xA2, 0x02, 0x2A, 0x80, 0x18, -+0xE1, 0x1F, 0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, -+0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, 0xFF, 0x6B, -+0x01, 0x4B, 0x8C, 0xEB, 0x08, 0x23, 0xFF, 0x6B, -+0x02, 0x4B, 0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x00, 0x18, 0x66, 0xD7, 0x00, 0x1C, -+0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x8C, 0x9A, 0x02, 0xF0, 0x00, 0x6B, 0x8C, 0xEB, -+0x08, 0x23, 0x02, 0xF0, 0x01, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x00, 0x18, -+0x4F, 0xEA, 0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, -+0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6B, 0x5B, 0xF7, -+0x64, 0x9B, 0x80, 0xF0, 0x8C, 0x9A, 0x8C, 0xEB, -+0x20, 0x23, 0x10, 0xF0, 0x24, 0x6B, 0x7C, 0xF0, -+0x60, 0x9B, 0x8C, 0xEB, 0x68, 0xF3, 0x94, 0xA2, -+0x80, 0xF0, 0x6C, 0xDA, 0x7F, 0x6B, 0x8C, 0xEB, -+0x07, 0x2B, 0x68, 0xF3, 0x5C, 0xA2, 0x0C, 0x72, -+0x03, 0x61, 0x00, 0x18, 0x93, 0xDA, 0x0D, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x10, 0xF0, 0x24, 0x6C, 0x80, 0xF0, 0x6C, 0x9A, -+0x5B, 0xF7, 0x84, 0x9C, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x00, 0x1C, 0x95, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xCC, 0xF1, 0x53, 0xA2, 0x0F, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF0, 0x44, 0x9A, -+0x01, 0x6B, 0x80, 0xA2, 0x8C, 0xEB, 0x07, 0x23, -+0x80, 0xA2, 0xFE, 0x6B, 0x8C, 0xEB, 0x60, 0xC2, -+0x03, 0x6C, 0x00, 0x18, 0x32, 0xDE, 0x30, 0xF0, -+0x20, 0x69, 0xEF, 0xF4, 0x08, 0x49, 0x00, 0xF2, -+0x00, 0xA1, 0x01, 0x6A, 0x4E, 0xE8, 0x05, 0x28, -+0x0B, 0x6C, 0x00, 0x18, 0x32, 0xDE, 0x00, 0xF2, -+0x00, 0xC1, 0x30, 0xF0, 0x21, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xD0, 0xF4, 0x94, 0x9B, 0xEE, 0xF7, -+0x58, 0x9A, 0x40, 0xEA, 0xFD, 0x16, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF0, 0x68, 0x9A, -+0xDF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0x7C, 0xF0, 0xA8, 0x9B, 0xFF, 0x6A, 0x20, 0x6E, -+0x60, 0xA5, 0x4C, 0xEC, 0x4C, 0xEB, 0xCD, 0xEB, -+0x4C, 0xEB, 0x07, 0xF7, 0x01, 0x4A, 0x4D, 0xEC, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF0, 0x4C, 0x9A, -+0x60, 0xC5, 0x80, 0xCA, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF0, 0x4C, 0x9A, -+0x68, 0xF0, 0x04, 0x6B, 0x60, 0xCA, 0x20, 0xE8, -+0x03, 0x6F, 0x8C, 0xEF, 0x64, 0x67, 0x46, 0x67, -+0x04, 0x27, 0x07, 0x10, 0xA0, 0xDB, 0xFC, 0x4A, -+0x04, 0x4B, 0x04, 0x5A, 0xFB, 0x60, 0x03, 0x6A, -+0x4C, 0xEE, 0x04, 0x26, 0xA0, 0xC4, 0xFF, 0x4E, -+0x01, 0x4C, 0xFB, 0x17, 0x00, 0x6A, 0x20, 0xE8, -+0xFF, 0x6A, 0xAC, 0xEA, 0x03, 0x10, 0x40, 0xC4, -+0xFF, 0x4E, 0x01, 0x4C, 0xFC, 0x2E, 0x00, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0x00, 0x6A, 0x07, 0x26, -+0x5D, 0xE5, 0xE0, 0xA7, 0x4D, 0xE4, 0xFF, 0x4E, -+0xE0, 0xC3, 0x01, 0x4A, 0xF8, 0x17, 0x00, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0x09, 0x10, 0x60, 0xA4, -+0x40, 0xA5, 0xFF, 0x4E, 0x4A, 0xEB, 0x02, 0x60, -+0x4B, 0xE3, 0x20, 0xE8, 0x01, 0x4C, 0x01, 0x4D, -+0xF6, 0x2E, 0x00, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0x06, 0x2C, 0x64, 0x6B, 0x30, 0xF0, 0x21, 0x6A, -+0xB0, 0xF3, 0x60, 0xDA, 0x04, 0x10, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x80, 0xDA, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x40, 0x9A, 0x28, 0x72, -+0x2D, 0x60, 0x29, 0x5A, 0x07, 0x60, 0x14, 0x72, -+0x19, 0x60, 0x19, 0x72, 0x1F, 0x60, 0x0A, 0x72, -+0x0D, 0x60, 0x20, 0xE8, 0x50, 0x72, 0x32, 0x60, -+0x51, 0x5A, 0x03, 0x60, 0x32, 0x72, 0x26, 0x60, -+0x20, 0xE8, 0x64, 0x72, 0x33, 0x60, 0xC8, 0x72, -+0x39, 0x60, 0x20, 0xE8, 0x02, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x64, 0xDA, 0xE0, 0xF7, -+0x1E, 0x4B, 0x39, 0x10, 0x03, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x64, 0xDA, 0xE1, 0xF3, -+0x1D, 0x4B, 0x31, 0x10, 0x09, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x64, 0xDA, 0xE4, 0xF3, -+0x17, 0x4B, 0x29, 0x10, 0x05, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x64, 0xDA, 0xE2, 0xF3, -+0x1B, 0x4B, 0x21, 0x10, 0x11, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x64, 0xDA, 0xE8, 0xF3, -+0x0F, 0x4B, 0x19, 0x10, 0x0A, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x64, 0xDA, 0xE4, 0xF7, -+0x16, 0x4B, 0x11, 0x10, 0x22, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x64, 0xDA, 0x11, 0xF0, -+0x00, 0x6B, 0x09, 0x10, 0x43, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x64, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF0, 0x70, 0x9A, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF3, 0x68, 0xDA, 0x20, 0xE8, -+0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, 0x40, 0x9A, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x63, 0x0C, 0x24, -+0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, 0x48, 0x9A, -+0x58, 0xEC, 0x12, 0xEC, 0x00, 0xD4, 0x00, 0x92, -+0xFF, 0x4A, 0x00, 0xD2, 0x00, 0x92, 0xFB, 0x2A, -+0x01, 0x63, 0x20, 0xE8, 0xFF, 0x63, 0x0D, 0x24, -+0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, 0x44, 0x9A, -+0x58, 0xEC, 0x12, 0xEC, 0x00, 0xD4, 0x00, 0x92, -+0x04, 0x22, 0x00, 0x92, 0xFF, 0x4A, 0x00, 0xD2, -+0xFA, 0x17, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xA7, 0xD4, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xED, -+0x00, 0x18, 0x9C, 0xD4, 0x05, 0x97, 0x00, 0x6A, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x04, 0x67, 0x4C, 0xEE, -+0x00, 0x18, 0xA1, 0xD4, 0x50, 0x67, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x05, 0xD2, 0x05, 0x93, -+0xFF, 0x68, 0x8C, 0xE8, 0xD0, 0xF7, 0x45, 0x40, -+0xC0, 0xF1, 0x08, 0x4B, 0x4C, 0x32, 0x69, 0xE2, -+0x4A, 0xA2, 0x01, 0x6C, 0x30, 0xF0, 0x20, 0x69, -+0x8C, 0xEA, 0x04, 0xD2, 0x0C, 0x32, 0x69, 0xE2, -+0xA7, 0xF6, 0xD3, 0xA2, 0xEF, 0xF4, 0x08, 0x49, -+0x29, 0xE0, 0x8C, 0xEE, 0xD0, 0x36, 0x07, 0xD6, -+0x60, 0xF6, 0xD0, 0xA2, 0x03, 0x6A, 0x05, 0xD3, -+0x4C, 0xEE, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x70, 0x9A, 0xC0, 0x36, 0x10, 0xF0, 0x24, 0x6A, -+0x06, 0xD6, 0x7C, 0xF0, 0xD4, 0x9A, 0x01, 0x6D, -+0xE3, 0xF2, 0x1F, 0x4C, 0xAB, 0xED, 0x40, 0xEB, -+0x06, 0x93, 0x07, 0x96, 0x30, 0xF0, 0x20, 0x6C, -+0xCE, 0xF4, 0x50, 0x9C, 0x6D, 0xEE, 0x04, 0x93, -+0xE3, 0xF3, 0x10, 0x6C, 0xFF, 0xF7, 0x1F, 0x6D, -+0x6D, 0xEE, 0x40, 0xEA, 0x05, 0x94, 0x30, 0xF3, -+0x40, 0x40, 0x10, 0x30, 0x01, 0xE4, 0x08, 0xF1, -+0xD0, 0x98, 0x44, 0x32, 0x29, 0xE2, 0x61, 0xAA, -+0x30, 0xF0, 0x20, 0x6C, 0x04, 0xD2, 0xC0, 0x36, -+0xCE, 0xF4, 0x50, 0x9C, 0xC0, 0x36, 0x01, 0x6D, -+0x6D, 0xEE, 0xE3, 0xF3, 0x08, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x04, 0x93, 0x41, 0xAB, 0x01, 0x72, -+0x04, 0x61, 0x01, 0x6C, 0x60, 0xF6, 0x93, 0xC1, -+0x03, 0x10, 0x00, 0x6A, 0x60, 0xF6, 0x53, 0xC1, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, -+0x04, 0xD2, 0x00, 0x69, 0x30, 0xF0, 0x20, 0x68, -+0x10, 0xF0, 0x24, 0x6B, 0x7C, 0xF0, 0xD4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0x03, 0xF3, -+0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0x23, 0xF3, 0x0C, 0x6C, -+0xAB, 0xED, 0x07, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xFB, 0xF6, 0x0C, 0x4B, 0xC0, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0x23, 0xF3, -+0x18, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xFB, 0xF6, 0x0C, 0x4B, 0xC0, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0x23, 0xF3, -+0x1C, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0xC3, 0xF3, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x6E, 0x40, 0xEA, 0xFF, 0x6A, -+0x2C, 0xEA, 0x08, 0x2A, 0xCE, 0xF4, 0x50, 0x98, -+0x03, 0xF3, 0x0C, 0x6C, 0x06, 0xF0, 0x00, 0x6D, -+0x03, 0x6E, 0x07, 0x10, 0xCE, 0xF4, 0x50, 0x98, -+0x03, 0xF3, 0x0C, 0x6C, 0x06, 0xF0, 0x00, 0x6D, -+0x01, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x9C, 0xF0, 0xA0, 0x9B, -+0xCE, 0xF4, 0x50, 0x9A, 0xC3, 0xF3, 0x14, 0x6C, -+0x10, 0x6E, 0x40, 0xEA, 0x04, 0x95, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF0, 0x44, 0x9A, 0xAC, 0x34, -+0x91, 0xE1, 0x30, 0xF0, 0x20, 0x6B, 0x90, 0x35, -+0xC0, 0xF1, 0x08, 0x4B, 0x90, 0x34, 0xB5, 0xE3, -+0x8D, 0xE3, 0x46, 0xE9, 0xE7, 0xF6, 0x0C, 0x4D, -+0xE7, 0xF7, 0x0C, 0x4B, 0x08, 0xD5, 0x07, 0xD3, -+0xA3, 0x42, 0x61, 0x42, 0x23, 0x4A, 0x05, 0xD5, -+0x06, 0xD3, 0x09, 0xD2, 0x08, 0x94, 0x05, 0x93, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xAC, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0xC0, 0x36, 0xC4, 0x36, -+0xD9, 0xE3, 0xC3, 0xF3, 0x18, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x07, 0x94, 0x06, 0x93, 0xCE, 0xF4, -+0x50, 0x98, 0xC0, 0xAC, 0x01, 0x6D, 0xC3, 0xF3, -+0x18, 0x6C, 0xC0, 0x36, 0xC4, 0x36, 0xAB, 0xED, -+0xD9, 0xE3, 0x40, 0xEA, 0x08, 0x94, 0x05, 0x95, -+0x07, 0x92, 0x02, 0x4C, 0x06, 0x93, 0x08, 0xD4, -+0x09, 0x94, 0x04, 0x4D, 0x02, 0x4A, 0x04, 0x4B, -+0x8A, 0xED, 0x05, 0xD5, 0x07, 0xD2, 0x06, 0xD3, -+0xD5, 0x61, 0xFF, 0x6A, 0x2C, 0xEA, 0x10, 0x2A, -+0x04, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC0, 0xF7, 0x15, 0x4B, 0x6C, 0x33, -+0x49, 0xE3, 0xCA, 0xA2, 0x81, 0xF4, 0x14, 0x6C, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0x0F, 0x10, -+0x04, 0x95, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xAC, 0x33, 0x49, 0xE3, 0xA7, 0xF6, -+0xD3, 0xA2, 0xCE, 0xF4, 0x50, 0x98, 0x81, 0xF4, -+0x14, 0x6C, 0x00, 0xF4, 0x00, 0x6D, 0xCF, 0xEE, -+0x01, 0x49, 0x40, 0xEA, 0x02, 0x71, 0x3F, 0xF7, -+0x1D, 0x61, 0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0xC3, 0xF3, 0x18, 0x6C, -+0xAB, 0xED, 0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x03, 0xF3, 0x0C, 0x6C, 0x06, 0xF0, -+0x00, 0x6D, 0x00, 0x6E, 0x40, 0xEA, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x30, 0xF0, 0x20, 0x68, 0x10, 0xF0, -+0x24, 0x6B, 0x4C, 0xEC, 0x4C, 0xED, 0x5B, 0xF7, -+0x00, 0x4B, 0x00, 0x6A, 0xC0, 0xF1, 0x08, 0x48, -+0x30, 0xF0, 0x20, 0x69, 0x05, 0xD5, 0x28, 0xF1, -+0x4D, 0xC0, 0xA0, 0x9B, 0xCE, 0xF4, 0x50, 0x99, -+0x04, 0xD4, 0x00, 0x6E, 0xE3, 0xF3, 0x10, 0x6C, -+0x40, 0xEA, 0x04, 0x92, 0x06, 0x22, 0x00, 0x6A, -+0xE7, 0xF6, 0x44, 0xD8, 0xE7, 0xF6, 0x48, 0xD8, -+0x51, 0x10, 0x28, 0xF1, 0x4C, 0xA0, 0x4E, 0x22, -+0x87, 0xF6, 0x70, 0x98, 0xE7, 0xF6, 0x44, 0x98, -+0x4E, 0xEB, 0x04, 0xD3, 0x1F, 0x2B, 0x05, 0x95, -+0x00, 0x6C, 0x00, 0x18, 0x3D, 0xD5, 0x00, 0x6C, -+0x00, 0x18, 0x08, 0xD5, 0x10, 0xF0, 0x24, 0x6B, -+0x5B, 0xF7, 0x00, 0x4B, 0xCE, 0xF4, 0x50, 0x99, -+0xA0, 0x9B, 0xE3, 0xF3, 0x10, 0x6C, 0x01, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x21, 0x6A, 0x50, 0xF3, -+0x5B, 0xA2, 0x05, 0x22, 0x5D, 0x67, 0x67, 0x42, -+0x09, 0x4B, 0x40, 0xA3, 0x01, 0x10, 0x01, 0x6A, -+0x28, 0xF1, 0x4D, 0xC0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x87, 0xF6, 0x30, 0x98, -+0xE7, 0xF6, 0x48, 0x98, 0x4E, 0xE9, 0x1E, 0x29, -+0x05, 0x95, 0x01, 0x6C, 0x00, 0x18, 0x3D, 0xD5, -+0x01, 0x6C, 0x00, 0x18, 0x08, 0xD5, 0x10, 0xF0, -+0x24, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x5B, 0xF7, 0xA0, 0x9B, 0xE3, 0xF3, -+0x10, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x21, 0x6A, 0x50, 0xF3, 0x5B, 0xA2, 0x04, 0x2A, -+0x01, 0x6A, 0x28, 0xF1, 0x4D, 0xC0, 0x02, 0x10, -+0x28, 0xF1, 0x2D, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0xE8, 0xF2, 0x55, 0xA2, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xE8, 0xF2, 0x56, 0xA2, 0x05, 0x22, 0x00, 0x6C, -+0x01, 0x6D, 0x00, 0x18, 0xAE, 0xD5, 0x04, 0x10, -+0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x3D, 0xD5, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x25, 0x67, 0x5B, 0xF7, -+0xA0, 0x9A, 0xFF, 0x68, 0x8C, 0xE8, 0xA1, 0xF4, -+0x18, 0x6C, 0x00, 0x18, 0xE4, 0xE6, 0x28, 0x22, -+0x27, 0x20, 0x03, 0x21, 0x01, 0x71, 0x12, 0x60, -+0x34, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, -+0x10, 0x9A, 0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, -+0x00, 0x18, 0x2F, 0xE7, 0x0E, 0x6B, 0x6B, 0xEB, -+0x4C, 0xEB, 0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, -+0x09, 0x6F, 0x10, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF0, 0x10, 0x9A, 0x00, 0x6C, 0x01, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x2F, 0xE7, 0x0E, 0x6B, -+0x6B, 0xEB, 0x4C, 0xEB, 0x00, 0x6C, 0x01, 0x6D, -+0xD0, 0x67, 0x05, 0x6F, 0x6D, 0xEF, 0x0F, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0x10, 0x9A, -+0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x2F, 0xE7, 0x02, 0x6F, 0xEB, 0xEF, 0x00, 0x6C, -+0x01, 0x6D, 0xD0, 0x67, 0x4C, 0xEF, 0x00, 0x18, -+0x42, 0xE7, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x27, 0x6A, 0x7D, 0x67, 0x50, 0xC3, 0x09, 0x6A, -+0x4F, 0xCB, 0x08, 0x6A, 0x52, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0xC0, 0xF0, -+0x7A, 0xA2, 0x9D, 0x67, 0x73, 0xC4, 0xC0, 0xF0, -+0x7B, 0xA2, 0x74, 0xC4, 0xE0, 0xF0, 0x62, 0xA2, -+0x75, 0xC4, 0xE0, 0xF0, 0x61, 0xA2, 0x76, 0xC4, -+0xE0, 0xF0, 0x60, 0xA2, 0x77, 0xC4, 0xE0, 0xF0, -+0x69, 0xA2, 0x78, 0xC4, 0xE0, 0xF0, 0x6A, 0xA2, -+0xE0, 0xF0, 0x4B, 0xA2, 0x79, 0xC4, 0x5A, 0xC4, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, -+0x04, 0x04, 0x40, 0xEA, 0x09, 0x97, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF3, 0x48, 0x9A, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF3, 0x44, 0x9A, 0xC4, 0x67, 0x01, 0x6D, -+0x23, 0x6C, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, 0x44, 0x9A, -+0xC4, 0x67, 0x01, 0x6D, 0x17, 0x6C, 0x40, 0xEA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF3, 0x44, 0x9A, 0xC4, 0x67, 0x01, 0x6D, -+0x1B, 0x6C, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xC0, 0xA4, 0xA9, 0xF0, -+0xEF, 0xA3, 0x02, 0x6A, 0x01, 0x6D, 0x4B, 0xEA, -+0xAC, 0xEE, 0xEC, 0xEA, 0xCD, 0xEA, 0xA9, 0xF0, -+0x4F, 0xC3, 0x80, 0xA4, 0x86, 0x34, 0xAC, 0xEC, -+0x84, 0x35, 0x03, 0x6C, 0x8B, 0xEC, 0x4C, 0xEC, -+0xAD, 0xEC, 0xA9, 0xF0, 0x8F, 0xC3, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF3, 0x44, 0x9A, 0xC4, 0x67, 0x03, 0x6D, -+0x11, 0x6C, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x40, 0xA4, 0x7D, 0x67, 0x07, 0x6D, 0x50, 0xC3, -+0x41, 0xA4, 0x04, 0x06, 0x51, 0xC3, 0x42, 0xA4, -+0x52, 0xC3, 0x43, 0xA4, 0x53, 0xC3, 0x44, 0xA4, -+0x30, 0x6C, 0x54, 0xC3, 0x00, 0x6A, 0x55, 0xC3, -+0x56, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, -+0x44, 0x9A, 0x40, 0xEA, 0x07, 0x97, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, 0x44, 0x9A, -+0xC4, 0x67, 0x01, 0x6D, 0x28, 0x6C, 0x40, 0xEA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x61, 0xA4, 0xBD, 0x67, -+0x40, 0xA4, 0x70, 0xC5, 0x62, 0xA4, 0x0D, 0x5A, -+0x71, 0xC5, 0x63, 0xA4, 0x72, 0xC5, 0x64, 0xA4, -+0x73, 0xC5, 0x65, 0xA4, 0x74, 0xC5, 0x66, 0xA4, -+0xFF, 0x6C, 0x75, 0xC5, 0x80, 0xF0, 0x14, 0x60, -+0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, 0xFB, 0xF4, -+0x08, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, 0x00, 0xEA, -+0x2A, 0x6C, 0x08, 0x10, 0x29, 0x6C, 0x02, 0x6D, -+0x88, 0x10, 0x31, 0x6C, 0x85, 0x10, 0x32, 0x6C, -+0x83, 0x10, 0x33, 0x6C, 0x06, 0x6D, 0x81, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, 0x50, 0x9A, -+0x04, 0x04, 0x40, 0xEA, 0x80, 0x10, 0x9D, 0x67, -+0x70, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC9, 0xF0, 0x74, 0xC2, 0x71, 0xA4, -+0xC9, 0xF0, 0x75, 0xC2, 0x72, 0xA4, 0xC9, 0xF0, -+0x76, 0xC2, 0x73, 0xA4, 0xC9, 0xF0, 0x77, 0xC2, -+0x74, 0xA4, 0xC9, 0xF0, 0x78, 0xC2, 0x6B, 0x10, -+0xBD, 0x67, 0x50, 0xA5, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0x08, 0x4B, 0x93, 0xA5, 0xC0, 0xF0, -+0x58, 0xC3, 0x54, 0xA5, 0x80, 0x34, 0x80, 0x34, -+0x00, 0xF6, 0x40, 0x32, 0x8D, 0xEA, 0x91, 0xA5, -+0x8D, 0xEA, 0x92, 0xA5, 0x80, 0x34, 0x8D, 0xEA, -+0xC0, 0xF0, 0x54, 0xDB, 0x54, 0x10, 0x00, 0x18, -+0x1F, 0xD6, 0x51, 0x10, 0x7D, 0x67, 0x90, 0xA3, -+0x30, 0xF0, 0x20, 0x6A, 0x01, 0x6B, 0x84, 0x34, -+0xEF, 0xF4, 0x08, 0x4A, 0x6D, 0xEC, 0xE0, 0xF0, -+0x83, 0xC2, 0xE0, 0xF0, 0x83, 0xA2, 0x86, 0x35, -+0x1E, 0x55, 0x05, 0x60, 0x8C, 0xEB, 0x3C, 0x6C, -+0x8D, 0xEB, 0xE0, 0xF0, 0x63, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0xE0, 0xF0, -+0x63, 0xA2, 0x66, 0x34, 0x51, 0x54, 0x33, 0x61, -+0x01, 0x6C, 0x6C, 0xEC, 0x60, 0x6B, 0x6B, 0xEB, -+0x6D, 0xEC, 0xE0, 0xF0, 0x83, 0xC2, 0x2B, 0x10, -+0x9D, 0x67, 0x70, 0xA4, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF5, 0x6C, 0xC2, 0x24, 0x10, 0xBD, 0x67, -+0x50, 0xA5, 0x3F, 0x6B, 0x4C, 0xEB, 0x68, 0x33, -+0x5A, 0x32, 0x6D, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCF, 0xF5, 0x4E, 0xC3, 0x18, 0x10, 0xBD, 0x67, -+0x50, 0xA5, 0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, -+0x08, 0x4B, 0xE0, 0xF0, 0xA7, 0xA3, 0x01, 0x6C, -+0x4C, 0xEC, 0x02, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, -+0x8D, 0xEA, 0xE0, 0xF0, 0x47, 0xC3, 0x07, 0x10, -+0x01, 0x6D, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, -+0x44, 0x9A, 0x04, 0x06, 0x40, 0xEA, 0x07, 0x97, -+0x04, 0x63, 0x00, 0xEF, 0x60, 0xA4, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0xC0, 0xF0, -+0xB9, 0xA2, 0x07, 0x6C, 0x6C, 0xEC, 0x08, 0x6B, -+0x6B, 0xEB, 0xAC, 0xEB, 0x8D, 0xEB, 0xC0, 0xF0, -+0x79, 0xC2, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, 0x44, 0x9A, -+0xC4, 0x67, 0x02, 0x6D, 0x38, 0x6C, 0x40, 0xEA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0x63, 0x01, 0xD1, 0x00, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0x60, 0xA4, 0xC0, 0xF1, 0x08, 0x4A, -+0xC9, 0xF0, 0x85, 0xA2, 0x01, 0x6E, 0x11, 0x6D, -+0xCC, 0xEB, 0xAB, 0xED, 0x70, 0x33, 0x8C, 0xED, -+0x6D, 0xED, 0x10, 0xF0, 0x24, 0x6B, 0xBB, 0xF6, -+0x64, 0x9B, 0xC9, 0xF0, 0xA5, 0xC2, 0xFE, 0x6F, -+0x80, 0xA3, 0x10, 0x68, 0xAC, 0xE8, 0xEC, 0xEC, -+0x80, 0xC3, 0xFF, 0x6C, 0x27, 0x20, 0x10, 0xF0, -+0x24, 0x6D, 0x5C, 0xF2, 0x1C, 0x9D, 0x08, 0x69, -+0x2B, 0xE9, 0xA0, 0xA0, 0x8C, 0xED, 0x2C, 0xED, -+0x05, 0x69, 0x2D, 0xED, 0x8C, 0xED, 0xA0, 0xC0, -+0x10, 0xF0, 0x24, 0x6D, 0x7C, 0xF2, 0xA0, 0x9D, -+0x00, 0xA5, 0x0F, 0x6D, 0x0C, 0xED, 0x04, 0x75, -+0x0B, 0x61, 0xC9, 0xF0, 0x04, 0xA2, 0x08, 0x6D, -+0x0C, 0xED, 0x8C, 0xED, 0x0B, 0x2D, 0xC9, 0xF0, -+0x5E, 0xAA, 0xA6, 0xF5, 0x0D, 0x72, 0x06, 0x60, -+0x40, 0xA3, 0x8C, 0xEA, 0xCD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x03, 0x10, 0x40, 0xA3, 0x4C, 0xEF, -+0xE0, 0xC3, 0x01, 0x91, 0x00, 0x90, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0x40, 0xA4, 0x0C, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF2, 0x64, 0x9A, -+0xFF, 0x6C, 0x18, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0x89, 0xF2, 0x6C, 0xA2, -+0x08, 0x6A, 0x6C, 0xEA, 0x08, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF2, 0x64, 0x9A, 0xE7, 0x6A, -+0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, -+0x80, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x01, 0x6B, 0xC9, 0xF0, 0xA5, 0xA2, -+0x8C, 0xEB, 0x6C, 0x34, 0x09, 0x6B, 0x6B, 0xEB, -+0xAC, 0xEB, 0x8D, 0xEB, 0xC9, 0xF0, 0x65, 0xC2, -+0x08, 0x6A, 0x6C, 0xEA, 0x07, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF2, 0x44, 0x9A, 0x18, 0x6B, -+0x60, 0xC2, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6B, -+0x7C, 0xF2, 0x64, 0x9B, 0x40, 0xC3, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xA0, 0xA4, 0xA9, 0xF0, -+0xDD, 0xA2, 0x02, 0x6B, 0x01, 0x6C, 0x6B, 0xEB, -+0x8C, 0xED, 0xCC, 0xEB, 0xAD, 0xEB, 0xA9, 0xF0, -+0x7D, 0xC2, 0x8C, 0xEB, 0xFF, 0x6A, 0x45, 0x23, -+0x10, 0xF0, 0x24, 0x6B, 0x7C, 0xF2, 0x88, 0x9B, -+0xE5, 0x6D, 0xAB, 0xED, 0x60, 0xA4, 0x4C, 0xEB, -+0xAC, 0xEB, 0xA4, 0x6D, 0xAD, 0xEB, 0x60, 0xDC, -+0x10, 0xF0, 0x24, 0x6B, 0x7C, 0xF2, 0x6C, 0x9B, -+0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF2, 0x50, 0x9A, 0x42, 0xF2, -+0x15, 0x6B, 0x01, 0x6C, 0x60, 0xCA, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF3, 0x44, 0x9A, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF2, 0x78, 0x9A, -+0x03, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF2, 0x74, 0x9A, -+0xFE, 0xF5, 0x1C, 0x4C, 0x40, 0x9B, 0x8C, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF2, -+0x78, 0x9A, 0x81, 0xF1, 0x00, 0x4C, 0x40, 0x9B, -+0x8C, 0xEA, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x7C, 0xF2, 0x7C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0x9C, 0xF2, 0x80, 0x9C, 0x40, 0x9B, 0x8C, 0xEA, -+0x40, 0xDB, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x01, 0x6D, -+0x04, 0x67, 0xAB, 0xED, 0x41, 0xF4, 0x18, 0x6C, -+0x00, 0x18, 0xE4, 0xE6, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xC9, 0xF0, 0x50, 0xDB, -+0x10, 0xF0, 0x24, 0x6D, 0x80, 0xA0, 0x9C, 0xF2, -+0xA4, 0x9D, 0x05, 0x97, 0x04, 0x90, 0x4C, 0xED, -+0x00, 0xF6, 0x80, 0x34, 0xAD, 0xEC, 0xC9, 0xF0, -+0x8C, 0xDB, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0xC9, 0xF0, 0x5C, 0xA0, 0x27, 0x72, 0x50, 0x60, -+0x28, 0x5A, 0x05, 0x60, 0x15, 0x72, 0x0B, 0x60, -+0x23, 0x72, 0x44, 0x60, 0xDE, 0x10, 0x34, 0x72, -+0x57, 0x60, 0x39, 0x72, 0x80, 0xF0, 0x18, 0x60, -+0x30, 0x72, 0x49, 0x60, 0xD6, 0x10, 0xC9, 0xF0, -+0x9E, 0xA0, 0x40, 0x6A, 0x8C, 0xEA, 0x0E, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF2, 0x48, 0x9A, -+0x3F, 0x6D, 0xAF, 0xEB, 0x40, 0x9A, 0x8D, 0xEB, -+0x46, 0x32, 0xAC, 0xEA, 0x49, 0xE3, 0xFF, 0x6B, -+0x6C, 0xEA, 0x0A, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x9C, 0xF2, 0x48, 0x9A, 0x60, 0x9A, 0x3F, 0x6A, -+0x66, 0x33, 0x4C, 0xEB, 0x8C, 0xEA, 0x49, 0xE3, -+0x40, 0x5A, 0x78, 0x67, 0x6B, 0xEB, 0x6C, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x5C, 0xF0, 0xB8, 0x9B, -+0x10, 0xF0, 0x24, 0x6E, 0x9C, 0xF2, 0xCC, 0x9E, -+0x80, 0x9D, 0x40, 0xF6, 0x40, 0x33, 0x44, 0x32, -+0xCC, 0xEC, 0x8D, 0xEB, 0x60, 0xDD, 0x10, 0xF0, -+0x24, 0x6B, 0x9C, 0xF2, 0x88, 0x9B, 0x7F, 0x6D, -+0xAB, 0xED, 0x60, 0x9C, 0xAC, 0xEB, 0x6D, 0xEA, -+0x40, 0xDC, 0x9B, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF3, 0x4C, 0x9A, 0x01, 0x6C, 0x05, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, 0x4C, 0x9A, -+0x02, 0x6C, 0x40, 0xEA, 0x8E, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF3, 0x54, 0x9A, 0x00, 0x6D, -+0x01, 0x6C, 0xC5, 0x67, 0x40, 0xEA, 0x85, 0x10, -+0xC9, 0xF0, 0x5E, 0xA0, 0x01, 0x6B, 0x6C, 0xEA, -+0x27, 0x22, 0xC9, 0xF0, 0x45, 0xA0, 0x10, 0x69, -+0x2C, 0xEA, 0x7B, 0x2A, 0x5D, 0x67, 0x70, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, 0x44, 0x9A, -+0xA3, 0x67, 0x34, 0x6C, 0x04, 0x06, 0x40, 0xEA, -+0x02, 0x6C, 0x00, 0x18, 0xDB, 0xED, 0xC9, 0xF0, -+0x64, 0xA0, 0x08, 0x6A, 0xFF, 0x6C, 0x6D, 0xEA, -+0x2D, 0xEA, 0x30, 0x6B, 0xC9, 0xF0, 0x44, 0xC0, -+0x10, 0xF0, 0x24, 0x6A, 0xC9, 0xF0, 0x6A, 0xC0, -+0xBB, 0xF6, 0x64, 0x9A, 0x40, 0xA3, 0x8C, 0xEA, -+0x02, 0x6C, 0x8D, 0xEA, 0xFF, 0x6C, 0x15, 0x10, -+0x03, 0x6C, 0x00, 0x18, 0xDB, 0xED, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF3, 0x50, 0x9A, 0x40, 0xEA, -+0xC9, 0xF0, 0x64, 0xA0, 0x09, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0xC9, 0xF0, 0x44, 0xC0, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF6, 0x64, 0x9A, 0xFD, 0x6A, -+0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, 0x41, 0x10, -+0xA9, 0xF0, 0x88, 0xA0, 0x01, 0x6A, 0xFF, 0x6B, -+0x8C, 0xEA, 0x3B, 0x22, 0xA9, 0xF0, 0x4C, 0xA0, -+0x04, 0x6D, 0xAC, 0xEA, 0x6C, 0xEA, 0x35, 0x22, -+0xC9, 0xF0, 0x84, 0xA0, 0x80, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x6C, 0xEA, 0x2E, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0xE0, 0xF0, -+0xC1, 0xA2, 0x01, 0x4E, 0xE0, 0xF0, 0xC1, 0xC2, -+0xA9, 0xF0, 0x4A, 0xA0, 0xAC, 0xEA, 0x0B, 0x22, -+0xC9, 0xF0, 0xA5, 0xA0, 0x20, 0x6A, 0xAC, 0xEA, -+0x6C, 0xEA, 0x05, 0x22, 0x7F, 0x6A, 0x8C, 0xEA, -+0xC9, 0xF0, 0x44, 0xC0, 0x16, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x89, 0xF2, 0x51, 0xA2, 0x02, 0x22, -+0x03, 0x72, 0x0F, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xC9, 0xF0, 0x84, 0xA2, -+0x7F, 0x6B, 0x8C, 0xEB, 0xC9, 0xF0, 0x64, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF3, 0x50, 0x9A, -+0x40, 0xEA, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x00, 0x68, 0x17, 0x10, 0xE0, 0xF3, -+0x08, 0x70, 0x0A, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x6C, 0x9A, 0x80, 0x6C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, 0x13, 0x10, -+0xFF, 0xF7, 0x1F, 0x6A, 0x01, 0x48, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x44, 0x9A, 0x60, 0xA2, 0x01, 0x6A, -+0x6C, 0xEA, 0xE1, 0x2A, 0x01, 0x6A, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x10, 0xF0, 0x24, 0x6C, 0x9C, 0xF2, -+0x70, 0x9B, 0x9C, 0xF2, 0x94, 0x9C, 0x6D, 0xE5, -+0x91, 0xE5, 0x00, 0x6E, 0xC0, 0xDB, 0x04, 0x4B, -+0x8A, 0xEB, 0xFB, 0x61, 0xE7, 0xF7, 0x1F, 0x6B, -+0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF0, -+0x54, 0x9A, 0x10, 0x6C, 0x4D, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF2, 0x50, 0x9A, 0x49, 0xE5, -+0x60, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF2, -+0x58, 0x9A, 0xFF, 0x6B, 0x55, 0xE5, 0x40, 0xA5, -+0x6C, 0xEA, 0x8D, 0xEA, 0x6C, 0xEA, 0x40, 0xC5, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x21, 0x6A, -+0xD0, 0xF4, 0x61, 0xA2, 0x08, 0xD4, 0x30, 0xF0, -+0x20, 0x69, 0x61, 0xC5, 0x01, 0x4B, 0xD0, 0xF4, -+0x61, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF2, -+0x90, 0x9B, 0x08, 0x93, 0x4E, 0xF2, 0x50, 0x99, -+0x02, 0x6E, 0x91, 0xE3, 0x05, 0x67, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF2, 0x9C, 0x9B, -+0x08, 0x93, 0xCE, 0xA0, 0x4E, 0xF2, 0x50, 0x99, -+0xA2, 0x40, 0x91, 0xE3, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x24, 0x67, 0x00, 0x18, 0xE1, 0xD7, 0x00, 0x6B, -+0x36, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF2, -+0x40, 0x9A, 0xFF, 0xF7, 0x1F, 0x6E, 0xFF, 0x6F, -+0x00, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF0, -+0x50, 0x9A, 0x10, 0x6C, 0x8B, 0xEC, 0x4C, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0xA1, 0x40, 0xBC, 0xF2, -+0x44, 0x9A, 0x65, 0x67, 0xCC, 0xEB, 0x60, 0xCA, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF2, 0x48, 0x9A, -+0x60, 0xA2, 0xFA, 0x65, 0xA2, 0x32, 0xEC, 0xEB, -+0x8C, 0xEB, 0x42, 0x32, 0x6D, 0xEA, 0xEC, 0xEA, -+0x7F, 0x67, 0x40, 0xC3, 0x87, 0xA9, 0x02, 0x4C, -+0xCC, 0xEC, 0x00, 0x18, 0xF6, 0xD7, 0x87, 0x40, -+0x12, 0x4C, 0xB1, 0x67, 0x00, 0x18, 0x0D, 0xD8, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x44, 0x9A, -+0x01, 0x6B, 0x60, 0xC2, 0x01, 0x6B, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x43, 0x67, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, 0xA4, 0x67, -+0x04, 0x6C, 0x8D, 0xEB, 0x30, 0xF0, 0x20, 0x68, -+0x80, 0xF0, 0x6C, 0xDA, 0xEF, 0xF4, 0x08, 0x48, -+0xA0, 0xF0, 0x4A, 0xA8, 0x01, 0xF1, 0x00, 0x72, -+0x07, 0x60, 0xA0, 0xF0, 0x6A, 0xA0, 0xA0, 0xF0, -+0x4B, 0xA0, 0xFF, 0x4B, 0x4E, 0xEB, 0x0A, 0x2B, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x6C, 0x9A, -+0x00, 0xF2, 0x00, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x12, 0x10, 0x50, 0x32, 0x51, 0xE0, -+0x0A, 0x4C, 0x10, 0x6E, 0x00, 0x18, 0xA1, 0xD4, -+0xA0, 0xF0, 0x4B, 0xA0, 0x0A, 0x6B, 0x01, 0x4A, -+0xA0, 0xF0, 0x4B, 0xC0, 0xA0, 0xF0, 0x4B, 0xA0, -+0x6E, 0xEA, 0x02, 0x2A, 0xA0, 0xF0, 0x4B, 0xC0, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x21, 0x6B, 0xD0, 0xF4, 0x40, 0xA3, 0xFF, 0x6F, -+0xE0, 0xF0, 0xC7, 0xA5, 0x41, 0xC5, 0x43, 0xA5, -+0xD0, 0xF4, 0x60, 0xA3, 0x03, 0x4A, 0xEC, 0xEA, -+0x09, 0x10, 0xED, 0x42, 0xFF, 0x68, 0x0C, 0xEF, -+0xFD, 0xE5, 0x64, 0xC7, 0xE6, 0xA7, 0x03, 0x4F, -+0xE9, 0xE2, 0x0C, 0xEA, 0xEF, 0x46, 0xE2, 0xEA, -+0xF4, 0x61, 0x30, 0xF0, 0x21, 0x6A, 0xD0, 0xF4, -+0x60, 0xA2, 0x01, 0x4B, 0xD0, 0xF4, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF2, 0x70, 0x9B, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x71, 0xE4, 0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x24, 0x67, 0x00, 0x18, -+0xE1, 0xD7, 0x00, 0x6B, 0x2E, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF2, 0x40, 0x9A, 0x0F, 0x6C, -+0xFF, 0xF7, 0x1F, 0x6B, 0x00, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF0, 0x50, 0x9A, 0x4C, 0xE8, -+0xA1, 0x40, 0xA2, 0x32, 0x42, 0x32, 0x8C, 0xEA, -+0x10, 0xF0, 0x24, 0x6C, 0xBC, 0xF2, 0x84, 0x9C, -+0xC5, 0x67, 0x6C, 0xEE, 0xC0, 0xCC, 0x10, 0xF0, -+0x24, 0x6C, 0xBC, 0xF2, 0x88, 0x9C, 0x40, 0xC4, -+0xE0, 0xF0, 0x87, 0xA1, 0x6C, 0xEC, 0x00, 0x18, -+0xF6, 0xD7, 0x87, 0x40, 0x12, 0x4C, 0xB1, 0x67, -+0x00, 0x18, 0x64, 0xD8, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x44, 0x9A, 0x01, 0x6B, 0x60, 0xC2, -+0x01, 0x6B, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x43, 0x67, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0x6C, 0xF2, 0x11, 0x4A, 0x10, 0xF0, -+0x30, 0x68, 0x40, 0xDB, 0x00, 0xF0, 0x00, 0x48, -+0xC1, 0xF6, 0x62, 0xA0, 0xC1, 0xF6, 0x43, 0xA0, -+0x6E, 0xEA, 0x39, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF2, 0x4C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0x5B, 0xF7, 0x88, 0x9C, 0x40, 0x9A, 0x8C, 0xEA, -+0x2E, 0x2A, 0xE8, 0x6A, 0x58, 0xEB, 0x87, 0x40, -+0x3B, 0x4C, 0x12, 0xEB, 0x71, 0xE4, 0x00, 0x18, -+0x7D, 0xD8, 0x16, 0x22, 0xC1, 0xF6, 0x42, 0xA0, -+0x10, 0x6B, 0x01, 0x4A, 0xC1, 0xF6, 0x42, 0xC0, -+0xC1, 0xF6, 0x42, 0xA0, 0x6E, 0xEA, 0x02, 0x2A, -+0xC1, 0xF6, 0x42, 0xC0, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF6, 0x82, 0xA2, -+0xC1, 0xF6, 0x63, 0xA2, 0x8E, 0xEB, 0x0B, 0x23, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x04, 0x6C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x04, 0x10, 0xC1, 0xF6, -+0x84, 0xC2, 0xC1, 0xF6, 0x65, 0xC2, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x30, 0x68, 0x00, 0xF0, 0x00, 0x48, -+0xC1, 0xF6, 0x42, 0xA8, 0xA4, 0x67, 0x01, 0xF7, -+0x00, 0x72, 0x07, 0x60, 0xC1, 0xF6, 0x42, 0xA0, -+0xC1, 0xF6, 0x83, 0xA0, 0xFF, 0x4A, 0x8E, 0xEA, -+0x09, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x6C, 0x9A, 0xFF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, -+0x40, 0xC3, 0xA7, 0x10, 0x23, 0xA5, 0xC1, 0xF6, -+0x45, 0xA0, 0xFF, 0x6B, 0x04, 0x49, 0x6C, 0xE9, -+0x1F, 0x2A, 0xE8, 0x6A, 0x58, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0x67, 0x40, 0x4E, 0xF2, 0x50, 0x9A, -+0x3B, 0x4B, 0xD1, 0x67, 0x12, 0xEC, 0x91, 0xE3, -+0x40, 0xEA, 0xC1, 0xF6, 0x43, 0xA0, 0xC1, 0xF6, -+0x62, 0xA0, 0xC1, 0xF6, 0x25, 0xC0, 0x4E, 0xEB, -+0x74, 0x2B, 0x01, 0x4A, 0xC1, 0xF6, 0x43, 0xC0, -+0xC1, 0xF6, 0x43, 0xA0, 0x10, 0x6B, 0x6E, 0xEA, -+0x6C, 0x2A, 0xC1, 0xF6, 0x43, 0xC0, 0x69, 0x10, -+0x82, 0xA5, 0x37, 0x2C, 0x51, 0xE1, 0xE3, 0x54, -+0x34, 0x60, 0xC1, 0xF6, 0x84, 0xA0, 0xE8, 0x6E, -+0xD8, 0xEC, 0x12, 0xEC, 0x11, 0xE4, 0x40, 0xF0, -+0xC4, 0xA4, 0x2B, 0x2E, 0x40, 0xF0, 0xC5, 0xA4, -+0xFC, 0x4A, 0x6C, 0xEA, 0xFF, 0x4E, 0x40, 0xF0, -+0xC5, 0xC4, 0xC1, 0xF6, 0x85, 0xA0, 0xE8, 0x6E, -+0xFF, 0x4C, 0xC1, 0xF6, 0x85, 0xC0, 0xC1, 0xF6, -+0x84, 0xA0, 0xD8, 0xEC, 0xD1, 0x67, 0x12, 0xEC, -+0x91, 0xE0, 0x51, 0xE4, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x45, 0x4C, 0x40, 0xEA, -+0xC1, 0xF6, 0x44, 0xA0, 0xE8, 0x6B, 0x78, 0xEA, -+0x12, 0xEA, 0x09, 0xE2, 0x40, 0xF0, 0x65, 0xA2, -+0x6D, 0xE1, 0x40, 0xF0, 0x65, 0xC2, 0xC1, 0xF6, -+0x45, 0xA0, 0x45, 0xE1, 0xC1, 0xF6, 0x25, 0xC0, -+0x30, 0x10, 0x10, 0xF0, 0x30, 0x68, 0x00, 0xF0, -+0x00, 0x48, 0xC1, 0xF6, 0x63, 0xA0, 0xE8, 0x6A, -+0x87, 0x40, 0x58, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x3B, 0x4C, 0xD1, 0x67, -+0x12, 0xEB, 0x71, 0xE4, 0x40, 0xEA, 0xC1, 0xF6, -+0x43, 0xA0, 0x10, 0x6B, 0xC1, 0xF6, 0x25, 0xC0, -+0x01, 0x4A, 0xC1, 0xF6, 0x43, 0xC0, 0xC1, 0xF6, -+0x43, 0xA0, 0x6E, 0xEA, 0x02, 0x2A, 0xC1, 0xF6, -+0x43, 0xC0, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF6, 0x64, 0xA2, 0x10, 0x6C, -+0x01, 0x4B, 0xC1, 0xF6, 0x64, 0xC2, 0xC1, 0xF6, -+0x64, 0xA2, 0x8E, 0xEB, 0x02, 0x2B, 0xC1, 0xF6, -+0x64, 0xC2, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF6, 0x84, 0xA2, 0xE8, 0x6B, -+0x78, 0xEC, 0x04, 0x6C, 0x12, 0xEB, 0x4D, 0xE3, -+0xC1, 0xF6, 0x45, 0xA2, 0x20, 0xF1, 0x49, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, -+0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0xAC, 0xF4, -+0x0D, 0x4A, 0x30, 0xF0, 0x20, 0x68, 0x40, 0xDB, -+0xEF, 0xF4, 0x08, 0x48, 0xA0, 0xF0, 0x8A, 0xA0, -+0xA0, 0xF0, 0x4B, 0xA0, 0x8E, 0xEA, 0x3D, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF2, 0x4C, 0x9A, -+0x10, 0xF0, 0x24, 0x6B, 0x5B, 0xF7, 0x68, 0x9B, -+0x40, 0x9A, 0x6C, 0xEA, 0x32, 0x2A, 0x47, 0x40, -+0x90, 0x34, 0x03, 0x4A, 0x91, 0xE2, 0x00, 0x18, -+0x22, 0xD8, 0x0B, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x04, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x22, 0x10, 0xA0, 0xF0, 0x4A, 0xA0, 0x01, 0x4A, -+0xA0, 0xF0, 0x4A, 0xC0, 0xA0, 0xF0, 0x6A, 0xA0, -+0xA0, 0xF0, 0x4B, 0xA0, 0x6E, 0xEA, 0x0A, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x04, 0x6C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0xA0, 0xF0, 0x6A, 0xA2, -+0x0A, 0x6C, 0x8E, 0xEB, 0x02, 0x2B, 0xA0, 0xF0, -+0x6A, 0xC2, 0x00, 0x18, 0x8E, 0xD9, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF7, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xFB, 0xF6, 0x0C, 0x9C, 0x40, 0x9B, -+0x00, 0xF4, 0x1D, 0x6C, 0x10, 0x6D, 0x0D, 0xEA, -+0x40, 0xDB, 0x06, 0x02, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF4, 0x54, 0x9A, 0x00, 0x6E, -+0x82, 0xF3, 0x08, 0x6F, 0x40, 0xEA, 0x07, 0x2A, -+0x10, 0xF0, 0x24, 0x6B, 0x3B, 0xF7, 0x8C, 0x9B, -+0x60, 0x9C, 0x0D, 0xEB, 0x60, 0xDC, 0x09, 0x97, -+0x08, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x60, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC8, 0xF2, 0x7D, 0xC2, 0x61, 0xA4, -+0xC8, 0xF2, 0x7E, 0xC2, 0x62, 0xA4, 0xC8, 0xF2, -+0x7F, 0xC2, 0x63, 0xA4, 0xE8, 0xF2, 0x60, 0xC2, -+0x64, 0xA4, 0xE8, 0xF2, 0x61, 0xC2, 0x65, 0xA4, -+0xE8, 0xF2, 0x62, 0xC2, 0x66, 0xA4, 0xE8, 0xF2, -+0x63, 0xC2, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x69, -+0x30, 0xF0, 0x20, 0x6A, 0x11, 0x67, 0x4E, 0xF2, -+0x50, 0x9A, 0xEF, 0xF4, 0x08, 0x48, 0xA4, 0x67, -+0x04, 0x6E, 0x90, 0x67, 0x40, 0xEA, 0xEF, 0xF4, -+0x68, 0xA1, 0x01, 0x6A, 0x6C, 0xEA, 0x0E, 0x22, -+0x42, 0xA0, 0xFF, 0x72, 0x0B, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x81, 0xA0, -+0x88, 0xF3, 0x7B, 0xA2, 0x6D, 0xE4, 0x04, 0x4B, -+0x88, 0xF3, 0x6A, 0xCA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF2, 0x50, 0x9A, -+0x60, 0xA2, 0x03, 0x6A, 0x6C, 0xEA, 0x10, 0x6B, -+0x64, 0xEA, 0xFF, 0x6A, 0x4C, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF2, 0x54, 0x9A, 0x04, 0xD3, -+0x40, 0x9A, 0x05, 0xD2, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF2, 0x58, 0x9A, 0x00, 0x9A, 0x05, 0x92, -+0x0A, 0xEA, 0xA0, 0xF0, 0x15, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x6C, 0x9A, 0x02, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x10, 0xF0, 0x30, 0x69, 0x00, 0xF0, -+0x00, 0x49, 0xC1, 0xF7, 0x46, 0xA9, 0x00, 0xF7, -+0x00, 0x72, 0x07, 0x60, 0xC1, 0xF7, 0x66, 0xA1, -+0xC1, 0xF7, 0x87, 0xA1, 0xAF, 0x43, 0x8E, 0xED, -+0x0A, 0x2D, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x6C, 0x9A, 0xFF, 0x6C, 0x01, 0x4C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x91, 0x10, 0x10, 0xF0, -+0x24, 0x6D, 0xBC, 0xF2, 0xBC, 0x9D, 0x7F, 0x6E, -+0xB5, 0xE0, 0xE0, 0xA5, 0xCC, 0xEF, 0x44, 0x2F, -+0x00, 0xF4, 0x00, 0x72, 0x80, 0xF0, 0x04, 0x60, -+0xAC, 0x43, 0x8E, 0xED, 0x80, 0xF0, 0x00, 0x25, -+0x00, 0xF5, 0x01, 0x72, 0x7D, 0x60, 0x00, 0xF6, -+0x02, 0x72, 0x7A, 0x60, 0x00, 0xF7, 0x03, 0x72, -+0x77, 0x60, 0x00, 0xF5, 0x00, 0x72, 0x74, 0x60, -+0xFD, 0x4B, 0x6E, 0xEC, 0x71, 0x24, 0x10, 0xF0, -+0x30, 0x69, 0x00, 0xF0, 0x00, 0x49, 0xC1, 0xF7, -+0x46, 0xA9, 0x00, 0xF6, 0x01, 0x72, 0x68, 0x60, -+0x00, 0xF7, 0x02, 0x72, 0x65, 0x60, 0x00, 0xF6, -+0x00, 0x72, 0x62, 0x60, 0xC1, 0xF7, 0x66, 0xA1, -+0xC1, 0xF7, 0x87, 0xA1, 0xFE, 0x4B, 0x8E, 0xEB, -+0x5B, 0x23, 0x00, 0xF7, 0x01, 0x72, 0x58, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF2, 0x40, 0x9A, -+0x10, 0xF0, 0x24, 0x6D, 0x76, 0x4C, 0xBC, 0xF2, -+0xBC, 0x9D, 0x49, 0xE0, 0x94, 0x34, 0x60, 0xAA, -+0x91, 0xE1, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x50, 0x9A, 0x06, 0x4C, 0xB5, 0xE0, 0x12, 0x10, -+0x40, 0xA5, 0x4C, 0xEE, 0x01, 0x76, 0x1E, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF2, 0x40, 0x9A, -+0x76, 0x4C, 0x94, 0x34, 0x49, 0xE0, 0x60, 0xAA, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x91, 0xE1, 0x06, 0x4C, 0xFF, 0x6E, 0x6C, 0xEE, -+0x40, 0xEA, 0xC1, 0xF7, 0x47, 0xA1, 0x08, 0x6B, -+0x01, 0x4A, 0xC1, 0xF7, 0x47, 0xC1, 0xC1, 0xF7, -+0x47, 0xA1, 0x6E, 0xEA, 0x0E, 0x2A, 0xC1, 0xF7, -+0x47, 0xC1, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x6C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0xDB, 0xF7, 0x80, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF2, -+0x44, 0x9A, 0x04, 0x93, 0x40, 0x9A, 0x0E, 0xEA, -+0x61, 0xE0, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF2, 0x48, 0x9A, 0x00, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF2, 0x58, 0x9A, 0x00, 0xDA, -+0x05, 0x92, 0x4A, 0xE8, 0x5F, 0xF7, 0x15, 0x61, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFE, 0x63, 0x03, 0xD1, -+0x02, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF2, -+0x4C, 0x9A, 0x0F, 0x6B, 0x40, 0xA2, 0x4C, 0xEB, -+0x0A, 0x23, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, 0x02, 0x6D, -+0xAD, 0xEC, 0x80, 0xF0, 0x8C, 0xDA, 0x10, 0xF0, -+0x30, 0x6A, 0x40, 0xF0, 0x40, 0xA2, 0xFF, 0x4A, -+0x00, 0xD2, 0xE2, 0x10, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0x40, 0xF0, 0x80, 0xAA, -+0x00, 0xF7, 0x00, 0x74, 0x05, 0x60, 0x40, 0xF0, -+0x01, 0xA2, 0x00, 0x94, 0x8A, 0xE8, 0x0A, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x6C, 0x9A, -+0xFF, 0x6C, 0x01, 0x4C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0xCC, 0x10, 0x30, 0xF0, 0x21, 0x6D, -+0xD0, 0xF4, 0x82, 0xA5, 0xC3, 0x67, 0xC7, 0xEC, -+0x86, 0x67, 0x01, 0x6E, 0xCC, 0xEC, 0xA0, 0xF0, -+0x08, 0x24, 0x0C, 0x35, 0x04, 0x4D, 0xB5, 0xE2, -+0x00, 0x6A, 0x30, 0xF0, 0x21, 0x6E, 0xD0, 0xF4, -+0xE2, 0xA6, 0xFF, 0x6C, 0x1F, 0xF7, 0x00, 0x69, -+0x8C, 0xEF, 0x74, 0x4F, 0xE8, 0x37, 0xFD, 0xE2, -+0x2C, 0xEF, 0x02, 0xF0, 0x00, 0x77, 0x08, 0x60, -+0xD0, 0xF4, 0xE2, 0xA6, 0x8C, 0xEF, 0x74, 0x4F, -+0xE8, 0x37, 0xFD, 0xE2, 0x2C, 0xEF, 0x0F, 0x2F, -+0x30, 0xF0, 0x21, 0x6C, 0xD0, 0xF4, 0x22, 0xA4, -+0xFF, 0x6C, 0x10, 0xF0, 0x24, 0x6E, 0x8C, 0xE9, -+0x74, 0x49, 0x28, 0x31, 0xE2, 0x67, 0x25, 0xE2, -+0xBB, 0xF6, 0xDC, 0x9E, 0x0B, 0x10, 0xD0, 0xF4, -+0x22, 0xA6, 0x10, 0xF0, 0x24, 0x6E, 0xDB, 0xF6, -+0xC0, 0x9E, 0x8C, 0xE9, 0x74, 0x49, 0x28, 0x31, -+0xE2, 0x67, 0x25, 0xE2, 0xD9, 0xE1, 0xC0, 0xA6, -+0x0C, 0x31, 0xFD, 0xE1, 0xCC, 0xEC, 0x10, 0xF0, -+0x30, 0x6E, 0x00, 0xF0, 0x00, 0x4E, 0xD9, 0xE7, -+0x80, 0xC6, 0x30, 0xF0, 0x21, 0x6E, 0xD0, 0xF4, -+0xE2, 0xA6, 0xFF, 0x6C, 0x1F, 0xF7, 0x00, 0x69, -+0x8C, 0xEF, 0x7C, 0x4F, 0xE8, 0x37, 0xFD, 0xE2, -+0x2C, 0xEF, 0x02, 0xF0, 0x00, 0x77, 0x08, 0x60, -+0xD0, 0xF4, 0xE2, 0xA6, 0x8C, 0xEF, 0x7C, 0x4F, -+0xE8, 0x37, 0xFD, 0xE2, 0x2C, 0xEF, 0x0E, 0x2F, -+0x30, 0xF0, 0x21, 0x6C, 0xD0, 0xF4, 0xC2, 0xA4, -+0xFF, 0x6C, 0x10, 0xF0, 0x24, 0x6F, 0x8C, 0xEE, -+0x7C, 0x4E, 0xC8, 0x36, 0xD9, 0xE2, 0xBB, 0xF6, -+0xFC, 0x9F, 0x0A, 0x10, 0xD0, 0xF4, 0xC2, 0xA6, -+0x10, 0xF0, 0x24, 0x6F, 0xDB, 0xF6, 0xE0, 0x9F, -+0x8C, 0xEE, 0x7C, 0x4E, 0xC8, 0x36, 0xD9, 0xE2, -+0xF9, 0xE6, 0xC0, 0xA6, 0x01, 0x4A, 0x04, 0x72, -+0xCC, 0xEC, 0x80, 0xC5, 0x01, 0x4D, 0x8D, 0x61, -+0x30, 0xF0, 0x21, 0x6A, 0xD0, 0xF4, 0xA2, 0xA2, -+0x01, 0x6C, 0xC4, 0x67, 0xC4, 0xED, 0xCF, 0xED, -+0xD0, 0xF4, 0xC2, 0xA2, 0xAC, 0xEB, 0xFF, 0x6D, -+0x84, 0xEE, 0x10, 0xF0, 0x24, 0x6E, 0xDC, 0xF2, -+0xCC, 0x9E, 0xAC, 0xEC, 0x80, 0xC6, 0xD0, 0xF4, -+0x82, 0xA2, 0xAC, 0xEC, 0x01, 0x4C, 0xAC, 0xEC, -+0xD0, 0xF4, 0x82, 0xC2, 0xD0, 0xF4, 0xA2, 0xA2, -+0x03, 0x6C, 0xAC, 0xEC, 0xD0, 0xF4, 0x82, 0xC2, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0x40, 0xF0, 0x81, 0xA2, 0x08, 0x6D, 0x01, 0x4C, -+0x40, 0xF0, 0x81, 0xC2, 0x40, 0xF0, 0x81, 0xA2, -+0xAE, 0xEC, 0x1A, 0x2C, 0x40, 0xF0, 0x81, 0xC2, -+0x17, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x8C, 0x9A, 0x02, 0x6E, 0x40, 0x9C, 0xCD, 0xEA, -+0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF2, -+0x50, 0x9A, 0x60, 0xC2, 0xD0, 0xF4, 0x62, 0xA5, -+0xFF, 0x6A, 0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF2, 0x54, 0x9A, 0x60, 0xC2, 0x02, 0x10, -+0x1F, 0xF7, 0x1C, 0x2B, 0x03, 0x91, 0x02, 0x90, -+0x02, 0x63, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF2, -+0x50, 0x9A, 0xFF, 0x68, 0x60, 0xA2, 0x6C, 0xE8, -+0x1D, 0x20, 0x00, 0x6B, 0x60, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x01, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF2, -+0x54, 0x9A, 0x20, 0x6B, 0x20, 0x70, 0x60, 0xC2, -+0x0D, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6C, 0x80, 0xF0, -+0x6C, 0x9A, 0x5B, 0xF7, 0x84, 0x9C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x1C, 0x96, 0x45, 0x00, 0x18, 0x61, 0xE1, -+0x05, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x18, 0xD3, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0xFF, 0x17, -+0xDE, 0x63, 0x43, 0x62, 0x42, 0xD1, 0x41, 0xD0, -+0x01, 0x6A, 0x7D, 0x67, 0x4B, 0xEA, 0x58, 0xC3, -+0x01, 0x6A, 0x5A, 0xC3, 0x08, 0x6A, 0x5B, 0xC3, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0x66, 0xA2, 0x76, 0x4B, 0x74, 0x33, -+0x49, 0xE3, 0x66, 0xA2, 0x7F, 0x6A, 0x6C, 0xEA, -+0x01, 0x72, 0x7E, 0x30, 0x80, 0xF0, 0x1C, 0x61, -+0x48, 0xA4, 0xBD, 0x67, 0x5C, 0xC5, 0x41, 0xA4, -+0x5D, 0xC5, 0x42, 0xA4, 0x5E, 0xC5, 0x46, 0xA4, -+0x20, 0xF0, 0x40, 0xC5, 0x43, 0xA4, 0x5F, 0xC5, -+0x47, 0xA4, 0x20, 0xF0, 0x41, 0xC5, 0x5C, 0xA5, -+0x80, 0xF0, 0x04, 0x2A, 0x7D, 0x67, 0x5F, 0xA3, -+0x7E, 0xA3, 0x40, 0x32, 0x6D, 0xEA, 0x03, 0x72, -+0x05, 0x60, 0x08, 0x72, 0x21, 0x60, 0x02, 0x72, -+0x37, 0x60, 0x78, 0x10, 0x06, 0x20, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x5C, 0x9A, 0x06, 0x04, -+0x40, 0xEA, 0x9D, 0x67, 0x20, 0xF0, 0xE1, 0xA4, -+0x20, 0xF0, 0x40, 0xA4, 0xFF, 0xF7, 0x1F, 0x6B, -+0xE0, 0x37, 0x5D, 0xE7, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF5, 0x50, 0x9A, 0x30, 0xF0, 0x20, 0x6D, -+0x05, 0x6C, 0xEC, 0xF6, 0x06, 0x4D, 0x00, 0xF2, -+0x00, 0x6E, 0x6C, 0xEF, 0x40, 0xEA, 0x75, 0x10, -+0xBD, 0x67, 0x30, 0xF0, 0x20, 0x6B, 0x10, 0x6A, -+0x5B, 0xC5, 0x30, 0xF0, 0x20, 0x69, 0x4E, 0xF2, -+0x50, 0x9B, 0x09, 0xF6, 0x04, 0x49, 0x09, 0x04, -+0xB1, 0x67, 0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6C, 0x4E, 0xF2, 0x50, 0x9C, 0xA4, 0x41, -+0x0A, 0x04, 0x04, 0x6E, 0x40, 0xEA, 0x42, 0x10, -+0x06, 0x20, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x06, 0x04, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0xEB, 0xF6, -+0x74, 0xA0, 0x01, 0x6A, 0x6C, 0xEA, 0x27, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, 0x50, 0x9A, -+0x40, 0xEA, 0xEB, 0xF6, 0x60, 0xA0, 0x04, 0x6A, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x18, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF2, 0x58, 0x9A, -+0xEB, 0xF6, 0xCC, 0x98, 0x00, 0x6B, 0x40, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF6, 0x44, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x35, 0xF3, 0x09, 0x4C, -+0x40, 0x9A, 0xA3, 0x67, 0x01, 0x6F, 0x5B, 0xE6, -+0x04, 0xD3, 0x00, 0x18, 0x9E, 0xE9, 0x29, 0x10, -+0x00, 0x18, 0xCA, 0xEA, 0x26, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF4, 0x54, 0x9A, 0x40, 0xEA, -+0xEB, 0xF6, 0xB2, 0xA8, 0x00, 0x6C, 0x00, 0x18, -+0x77, 0xEA, 0x1B, 0x10, 0x1A, 0x20, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x5C, 0x9A, 0x13, 0x10, -+0x14, 0x2A, 0x69, 0xA4, 0xBD, 0x67, 0x7C, 0xC5, -+0x68, 0xA4, 0x5E, 0xC5, 0x5F, 0xC5, 0x7D, 0xC5, -+0x46, 0xA4, 0x20, 0xF0, 0x40, 0xC5, 0x67, 0xA4, -+0x08, 0x20, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x20, 0xF0, 0x61, 0xC5, 0x06, 0x04, -+0x40, 0xEA, 0x43, 0x97, 0x42, 0x91, 0x41, 0x90, -+0x22, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x68, 0x44, 0xFA, 0x4B, -+0x4C, 0xEB, 0x04, 0x5B, 0x03, 0x60, 0x80, 0x18, -+0xE3, 0x18, 0x4C, 0x10, 0x09, 0x74, 0x30, 0x60, -+0x0A, 0x5C, 0x07, 0x60, 0x03, 0x74, 0x21, 0x60, -+0x08, 0x74, 0x25, 0x60, 0x02, 0x74, 0x12, 0x60, -+0x35, 0x10, 0x0C, 0x74, 0x13, 0x60, 0x0D, 0x5C, -+0x03, 0x60, 0x0A, 0x74, 0x26, 0x60, 0x2E, 0x10, -+0x0D, 0x74, 0x03, 0x60, 0x24, 0x74, 0x26, 0x60, -+0x29, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, -+0x48, 0x9A, 0x08, 0x10, 0x85, 0x67, 0x00, 0x18, -+0x8D, 0xEA, 0x2C, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF5, 0x44, 0x9A, 0x85, 0x67, 0x40, 0xEA, -+0x25, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, -+0x54, 0x9A, 0x40, 0xEA, 0x1F, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF5, 0x58, 0x9A, 0xF2, 0x17, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, 0x5C, 0x9A, -+0xED, 0x17, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, -+0x40, 0x9A, 0xE8, 0x17, 0x85, 0x67, 0x00, 0x18, -+0x9A, 0xF3, 0x0C, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x6C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0x5B, 0xF7, 0x84, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0xFF, 0x6A, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0xA0, 0xA4, 0xC7, 0xA2, -+0x02, 0x6B, 0x01, 0x68, 0x6B, 0xEB, 0x0C, 0xED, -+0xCC, 0xEB, 0xAD, 0xEB, 0x67, 0xC2, 0xA1, 0xA4, -+0x0C, 0xEB, 0xA8, 0xC2, 0x82, 0xA4, 0x89, 0xC2, -+0x49, 0xA2, 0x06, 0xD2, 0x20, 0x23, 0x01, 0x69, -+0x2B, 0xE9, 0xD1, 0x67, 0x00, 0x6C, 0x42, 0x6D, -+0x00, 0x18, 0x2F, 0xE7, 0x10, 0xF0, 0x24, 0x6B, -+0xBB, 0xF7, 0xE4, 0x9B, 0xD1, 0x67, 0x00, 0x6C, -+0x4D, 0xEF, 0x42, 0x6D, 0x00, 0x18, 0x42, 0xE7, -+0x06, 0x96, 0x64, 0x6A, 0x10, 0xF0, 0x24, 0x6C, -+0x01, 0x4E, 0x58, 0xEE, 0x7B, 0xF0, 0x1D, 0x4C, -+0x00, 0x6D, 0xF1, 0x67, 0x04, 0xD0, 0x12, 0xEE, -+0x00, 0x18, 0x9E, 0xE9, 0x06, 0x10, 0x10, 0xF0, -+0x24, 0x6C, 0x7B, 0xF0, 0x1D, 0x4C, 0x00, 0x18, -+0x8B, 0xE9, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x60, 0xA4, 0x01, 0x6A, -+0x04, 0x67, 0x4C, 0xEB, 0x68, 0x23, 0x61, 0xA4, -+0x08, 0x5B, 0x17, 0x60, 0x10, 0xF0, 0x24, 0x6C, -+0xFC, 0xF2, 0xBC, 0x9C, 0xC7, 0x43, 0x22, 0x67, -+0xE0, 0x9D, 0x10, 0x4B, 0x01, 0x4E, 0x82, 0x67, -+0x24, 0xEB, 0x84, 0xEE, 0x71, 0x67, 0xED, 0xEB, -+0x8F, 0xEC, 0x6C, 0xEC, 0x60, 0xA0, 0x66, 0x33, -+0x4C, 0xEB, 0x64, 0xEE, 0x6D, 0xEC, 0x80, 0xDD, -+0x15, 0x10, 0x10, 0xF0, 0x24, 0x6C, 0x1C, 0xF3, -+0xC0, 0x9C, 0x87, 0x43, 0x01, 0x4C, 0xA0, 0x9E, -+0xE2, 0x67, 0xE4, 0xEC, 0x87, 0x67, 0xAD, 0xEC, -+0xA2, 0x67, 0xA4, 0xEB, 0xAF, 0xED, 0xAC, 0xEC, -+0xA0, 0xA0, 0xA6, 0x35, 0x4C, 0xED, 0xA4, 0xEB, -+0xAD, 0xEC, 0x80, 0xDE, 0x41, 0xA0, 0x08, 0x5A, -+0x07, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0xFC, 0xF2, -+0x9C, 0x9B, 0x08, 0x4A, 0xA0, 0x9C, 0x05, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF3, 0x80, 0x9B, -+0xA0, 0x9C, 0x01, 0x6B, 0x64, 0xEA, 0xAE, 0xEB, -+0x60, 0xDC, 0x80, 0xA0, 0x00, 0x6D, 0x92, 0x34, -+0x00, 0x18, 0xA2, 0xC8, 0x80, 0xA0, 0x01, 0x6D, -+0x22, 0x67, 0x92, 0x34, 0x00, 0x18, 0xA2, 0xC8, -+0x9D, 0x67, 0x24, 0x6B, 0x70, 0xC4, 0x08, 0x6B, -+0x6F, 0xCC, 0x22, 0x33, 0x73, 0xC4, 0x62, 0x33, -+0x74, 0xC4, 0x56, 0xC4, 0x42, 0x33, 0x00, 0xF6, -+0x42, 0x32, 0x59, 0xC4, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x58, 0x9A, 0x32, 0xC4, 0x77, 0xC4, -+0x00, 0xF6, 0x22, 0x31, 0x62, 0x33, 0x35, 0xC4, -+0x78, 0xC4, 0x04, 0x04, 0x40, 0xEA, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x24, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0x28, 0xF5, -+0x1C, 0x4C, 0xB1, 0x67, 0x05, 0x6E, 0x30, 0xF0, -+0x20, 0x68, 0x40, 0xEA, 0xC0, 0xF1, 0x08, 0x48, -+0x46, 0xA1, 0xC8, 0xF3, 0x99, 0xA0, 0x7F, 0x6B, -+0x5E, 0x32, 0x5C, 0x32, 0x8C, 0xEB, 0x4D, 0xEB, -+0xC8, 0xF3, 0x79, 0xC0, 0x46, 0xA1, 0x1F, 0x6C, -+0x68, 0xF3, 0xB7, 0xA0, 0x4C, 0xEC, 0x20, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x8D, 0xEA, 0xC8, 0xF3, -+0x59, 0xC0, 0x66, 0xA1, 0x03, 0x6C, 0xB6, 0x35, -+0x76, 0x33, 0x8C, 0xEB, 0x74, 0x34, 0x61, 0x6B, -+0x6B, 0xEB, 0x4C, 0xEB, 0x8D, 0xEB, 0x91, 0x67, -+0xC8, 0xF3, 0x79, 0xC0, 0x00, 0x18, 0x21, 0xD1, -+0x68, 0xF3, 0x58, 0xA0, 0x0C, 0x72, 0x04, 0x61, -+0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0xF8, 0xD5, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0x2D, 0xF7, 0x0D, 0x4A, 0x08, 0xD4, 0x40, 0xDB, -+0x41, 0xA4, 0x24, 0x67, 0x06, 0xD2, 0x60, 0xA4, -+0x02, 0x6A, 0x6C, 0xEA, 0x06, 0x93, 0x07, 0xD3, -+0x02, 0x22, 0x42, 0xA4, 0x07, 0xD2, 0x06, 0x90, -+0x1C, 0x10, 0x08, 0x93, 0x01, 0x6D, 0x90, 0x67, -+0x40, 0xA3, 0x4C, 0xED, 0x00, 0x18, 0x22, 0xC8, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, -+0x90, 0x67, 0x40, 0xEA, 0x05, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF5, 0x54, 0x9A, 0x04, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x50, 0x9A, -+0x90, 0x67, 0x40, 0xEA, 0x01, 0x48, 0xFF, 0x6A, -+0x4C, 0xE8, 0x07, 0x92, 0x03, 0xEA, 0xE1, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF6, 0x81, 0xA2, -+0x06, 0x92, 0x8E, 0xEA, 0x22, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, 0x40, 0xEA, -+0x1C, 0x2A, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x00, 0x18, 0x11, 0xED, 0x68, 0xF3, -+0x97, 0xA0, 0x96, 0x34, 0x00, 0x18, 0x67, 0xCD, -+0x68, 0xF3, 0x79, 0xA0, 0x05, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x68, 0xF3, 0x7A, 0xA0, 0x68, 0xF3, -+0x59, 0xC0, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x03, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x68, 0xF3, -+0x5A, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x60, 0xA1, -+0xCC, 0xF1, 0x50, 0xA2, 0x72, 0x34, 0x15, 0x2A, -+0x04, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x10, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF1, -+0x40, 0x9A, 0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF3, 0x64, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x9B, 0xF6, 0x4C, 0x9A, 0x60, 0xDA, -+0xF0, 0x17, 0x05, 0x74, 0x15, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xCC, 0xF1, 0x52, 0xA2, 0x10, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF1, 0x40, 0x9A, -+0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x3C, 0xF3, 0x68, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x9B, 0xF6, 0x4C, 0x9A, 0x60, 0xDA, 0xF0, 0x17, -+0x63, 0xA1, 0x07, 0x6A, 0x01, 0x6C, 0x6C, 0xEA, -+0x60, 0xA1, 0x8C, 0xEB, 0x1E, 0x2B, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x69, 0xF3, -+0xC8, 0xA3, 0x84, 0xEA, 0x1F, 0x6F, 0xCA, 0x35, -+0x8F, 0xEC, 0xEC, 0xED, 0x8C, 0xED, 0x7D, 0x6C, -+0x8B, 0xEC, 0xA8, 0x35, 0xCC, 0xEC, 0xAD, 0xEC, -+0x69, 0xF3, 0x88, 0xC3, 0x30, 0xF0, 0x20, 0x6C, -+0xEF, 0xF6, 0x80, 0xA4, 0x8E, 0xEA, 0x20, 0x2A, -+0x01, 0x6A, 0x4B, 0xEA, 0x69, 0xF3, 0x49, 0xC3, -+0x1B, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x69, 0xF3, 0xC8, 0xA3, 0x1F, 0x6F, -+0x84, 0xEA, 0xCA, 0x35, 0xEC, 0xED, 0xAD, 0xEC, -+0xEC, 0xEC, 0x88, 0x35, 0x7D, 0x6C, 0x8B, 0xEC, -+0xCC, 0xEC, 0xAD, 0xEC, 0x69, 0xF3, 0x88, 0xC3, -+0x30, 0xF0, 0x20, 0x6C, 0xEF, 0xF6, 0x80, 0xA4, -+0x8E, 0xEA, 0x02, 0x2A, 0x69, 0xF3, 0x89, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x1C, 0x23, 0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x69, 0xF3, 0x68, 0xC2, 0x00, 0x18, 0xE1, 0xE8, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x04, 0x93, -+0xCF, 0xF5, 0x58, 0x9A, 0x6E, 0xEA, 0x03, 0x22, -+0x04, 0x94, 0x00, 0x18, 0x02, 0xE9, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF3, -+0x88, 0xA2, 0x02, 0x6B, 0x8D, 0xEB, 0x69, 0xF3, -+0x68, 0xC2, 0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, -+0x07, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, 0x68, 0x44, -+0xC8, 0x4B, 0x4C, 0xEB, 0x20, 0x5B, 0x05, 0x67, -+0x09, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF6, -+0x47, 0xA2, 0x40, 0xF1, 0x05, 0x2A, 0x80, 0x18, -+0x9F, 0x1B, 0x42, 0x11, 0x2F, 0x74, 0x20, 0xF1, -+0x1F, 0x60, 0x30, 0x5C, 0x48, 0x60, 0x1D, 0x74, -+0xA0, 0xF0, 0x18, 0x60, 0x1E, 0x5C, 0x1E, 0x60, -+0x15, 0x74, 0x80, 0xF0, 0x1F, 0x60, 0x16, 0x5C, -+0x0C, 0x60, 0x01, 0x74, 0x80, 0xF0, 0x0E, 0x60, -+0x80, 0xF0, 0x08, 0x24, 0x09, 0x74, 0x80, 0xF0, -+0x0D, 0x60, 0x10, 0x74, 0x80, 0xF0, 0x0E, 0x60, -+0x18, 0x11, 0x17, 0x74, 0x80, 0xF0, 0x16, 0x60, -+0x17, 0x5C, 0x80, 0xF0, 0x0F, 0x61, 0x19, 0x74, -+0x80, 0xF0, 0x14, 0x60, 0x1C, 0x74, 0x80, 0xF0, -+0x15, 0x60, 0x0B, 0x11, 0x23, 0x74, 0x00, 0xF1, -+0x17, 0x60, 0x24, 0x5C, 0x0D, 0x60, 0x1F, 0x74, -+0x80, 0xF0, 0x13, 0x60, 0x1F, 0x5C, 0x80, 0xF0, -+0x14, 0x61, 0x20, 0x74, 0x80, 0xF0, 0x15, 0x60, -+0x21, 0x74, 0x00, 0xF1, 0x09, 0x60, 0xF9, 0x10, -+0x2C, 0x74, 0x80, 0xF0, 0x1A, 0x60, 0x2D, 0x5C, -+0x07, 0x60, 0x24, 0x74, 0x80, 0xF0, 0x0D, 0x60, -+0x27, 0x74, 0x80, 0xF0, 0x0E, 0x60, 0xED, 0x10, -+0x2D, 0x74, 0x80, 0xF0, 0x12, 0x60, 0x2E, 0x74, -+0x80, 0xF0, 0x13, 0x60, 0xE6, 0x10, 0x68, 0x74, -+0xA0, 0xF0, 0x17, 0x60, 0x69, 0x5C, 0x22, 0x60, -+0x63, 0x74, 0x80, 0xF0, 0x1E, 0x60, 0x64, 0x5C, -+0x10, 0x60, 0x60, 0x74, 0x80, 0xF0, 0x0D, 0x60, -+0x61, 0x5C, 0x04, 0x60, 0x30, 0x74, 0x80, 0xF0, -+0x04, 0x60, 0xD3, 0x10, 0x61, 0x74, 0x80, 0xF0, -+0x08, 0x60, 0x62, 0x74, 0x80, 0xF0, 0x09, 0x60, -+0xCC, 0x10, 0x65, 0x74, 0x80, 0xF0, 0x11, 0x60, -+0x65, 0x5C, 0x80, 0xF0, 0x0A, 0x61, 0x66, 0x74, -+0x80, 0xF0, 0x0F, 0x60, 0x67, 0x74, 0x80, 0xF0, -+0x10, 0x60, 0xBF, 0x10, 0x70, 0x74, 0xA0, 0xF0, -+0x04, 0x60, 0x71, 0x5C, 0x10, 0x60, 0x6D, 0x74, -+0x80, 0xF0, 0x13, 0x60, 0x6E, 0x5C, 0x04, 0x60, -+0x69, 0x74, 0x80, 0xF0, 0x0A, 0x60, 0xB1, 0x10, -+0x6E, 0x74, 0x80, 0xF0, 0x0E, 0x60, 0x6F, 0x74, -+0x80, 0xF0, 0x0F, 0x60, 0xAA, 0x10, 0xC3, 0x74, -+0xA0, 0xF0, 0x03, 0x60, 0xC4, 0x5C, 0x07, 0x60, -+0x71, 0x74, 0x80, 0xF0, 0x0E, 0x60, 0xBA, 0x74, -+0x80, 0xF0, 0x0F, 0x60, 0x9E, 0x10, 0xC9, 0x74, -+0x80, 0xF0, 0x0F, 0x60, 0xCB, 0x74, 0x80, 0xF0, -+0x10, 0x60, 0x97, 0x10, 0x85, 0x67, 0x00, 0x18, -+0x6C, 0xD9, 0xA2, 0x10, 0x85, 0x67, 0x00, 0x18, -+0xCB, 0xDB, 0x9E, 0x10, 0x85, 0x67, 0x00, 0x18, -+0x7E, 0xC5, 0x9A, 0x10, 0x85, 0x67, 0x80, 0x18, -+0xE9, 0x08, 0x96, 0x10, 0x85, 0x67, 0x80, 0x18, -+0x40, 0x09, 0x92, 0x10, 0x85, 0x67, 0x80, 0x18, -+0x58, 0x09, 0x8E, 0x10, 0x85, 0x67, 0x80, 0x18, -+0xB0, 0x09, 0x8A, 0x10, 0x85, 0x67, 0x80, 0x18, -+0x64, 0x09, 0x86, 0x10, 0x85, 0x67, 0x80, 0x18, -+0x49, 0x0B, 0x82, 0x10, 0x85, 0x67, 0x80, 0x18, -+0x4A, 0x0B, 0x90, 0x67, 0x00, 0x18, 0xBE, 0xC5, -+0x7B, 0x10, 0x85, 0x67, 0x00, 0x18, 0x27, 0xC6, -+0x77, 0x10, 0x85, 0x67, 0x00, 0x18, 0xA8, 0xDB, -+0x73, 0x10, 0x85, 0x67, 0x00, 0x18, 0x7D, 0xC6, -+0x6F, 0x10, 0x85, 0x67, 0x00, 0x18, 0x74, 0xC6, -+0x6B, 0x10, 0x85, 0x67, 0x00, 0x18, 0x41, 0xC6, -+0x67, 0x10, 0x85, 0x67, 0x00, 0x18, 0x79, 0xD9, -+0x63, 0x10, 0x85, 0x67, 0x00, 0x18, 0x98, 0xDF, -+0x5F, 0x10, 0x85, 0x67, 0x00, 0x18, 0x1E, 0xE0, -+0x5B, 0x10, 0x85, 0x67, 0x00, 0x18, 0x37, 0xD6, -+0x57, 0x10, 0x85, 0x67, 0x00, 0x18, 0x3C, 0xD6, -+0x53, 0x10, 0x85, 0x67, 0x00, 0x18, 0x43, 0xD6, -+0x4F, 0x10, 0x85, 0x67, 0x00, 0x18, 0x4A, 0xD6, -+0x4B, 0x10, 0x85, 0x67, 0x00, 0x18, 0x56, 0xD7, -+0x47, 0x10, 0x85, 0x67, 0x00, 0x18, 0x51, 0xD6, -+0x43, 0x10, 0x85, 0x67, 0x00, 0x18, 0x5E, 0xD6, -+0x3F, 0x10, 0x85, 0x67, 0x00, 0x18, 0x65, 0xD6, -+0x3B, 0x10, 0x85, 0x67, 0x00, 0x18, 0x73, 0xD6, -+0x37, 0x10, 0x85, 0x67, 0x00, 0x18, 0x7A, 0xD6, -+0x33, 0x10, 0x85, 0x67, 0x00, 0x18, 0xE2, 0xD6, -+0x2F, 0x10, 0x85, 0x67, 0x00, 0x18, 0x09, 0xD7, -+0x2B, 0x10, 0x85, 0x67, 0x00, 0x18, 0x18, 0xD7, -+0x27, 0x10, 0x85, 0x67, 0x00, 0x18, 0x28, 0xD7, -+0x23, 0x10, 0x85, 0x67, 0x00, 0x18, 0xD3, 0xD6, -+0x1F, 0x10, 0x85, 0x67, 0x80, 0x18, 0x80, 0x08, -+0x1B, 0x10, 0x85, 0x67, 0x00, 0x18, 0x6D, 0xDB, -+0x17, 0x10, 0x85, 0x67, 0x00, 0x18, 0x4B, 0xDB, -+0x13, 0x10, 0x85, 0x67, 0x00, 0x18, 0x4F, 0xDE, -+0x0F, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x6C, 0x9A, 0x01, 0x6D, 0x40, 0x9B, 0xAD, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x9B, 0xF6, -+0x54, 0x9A, 0x80, 0xC2, 0x0E, 0x6A, 0x01, 0x10, -+0x00, 0x6A, 0x40, 0xC0, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, -+0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF3, -+0x05, 0x4A, 0x10, 0xF0, 0x30, 0x68, 0x40, 0xDB, -+0x00, 0xF0, 0x00, 0x48, 0x40, 0xF0, 0x40, 0xA0, -+0x40, 0xF0, 0x61, 0xA0, 0x4E, 0xEB, 0x29, 0x23, -+0x4C, 0x32, 0x0D, 0xE2, 0x80, 0xA3, 0xA1, 0x42, -+0xB5, 0xE0, 0x00, 0x18, 0x4B, 0xDC, 0x40, 0xF0, -+0x40, 0xA0, 0x01, 0x4A, 0x40, 0xF0, 0x40, 0xC0, -+0x40, 0xF0, 0x60, 0xA0, 0x40, 0xF0, 0x41, 0xA0, -+0x6E, 0xEA, 0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x02, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0x40, 0xF0, 0x60, 0xA2, 0x08, 0x6C, 0x8E, 0xEB, -+0x02, 0x2B, 0x40, 0xF0, 0x60, 0xC2, 0x00, 0x18, -+0xFB, 0xD9, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x30, 0x68, 0x00, 0xF0, -+0x00, 0x48, 0xC1, 0xF7, 0x66, 0xA0, 0x7F, 0x6C, -+0xA7, 0x43, 0x6F, 0x4D, 0xB4, 0x35, 0x15, 0xE5, -+0x46, 0xA5, 0x8C, 0xEA, 0x20, 0x2A, 0x74, 0x33, -+0x09, 0xE3, 0xC1, 0xF6, 0x8E, 0xA2, 0xA2, 0x67, -+0xC1, 0xF6, 0x0F, 0x4D, 0x00, 0x18, 0x4B, 0xDC, -+0xC1, 0xF7, 0x46, 0xA0, 0x10, 0xF0, 0x24, 0x6C, -+0x3C, 0xF3, 0x8C, 0x9C, 0x54, 0x33, 0x0D, 0xE3, -+0xC1, 0xF6, 0xAC, 0xA3, 0x76, 0x4A, 0x54, 0x32, -+0xA0, 0xC4, 0xC1, 0xF6, 0x8D, 0xA3, 0x10, 0xF0, -+0x24, 0x6B, 0x3C, 0xF3, 0x70, 0x9B, 0x41, 0xE0, -+0x80, 0xC3, 0x86, 0x40, 0x49, 0x10, 0x01, 0x72, -+0x49, 0x61, 0x74, 0x33, 0x0D, 0xE3, 0xC1, 0xF6, -+0x47, 0xA3, 0xFF, 0x72, 0x0C, 0x61, 0xC1, 0xF6, -+0x88, 0xA3, 0x06, 0x4D, 0x00, 0x18, 0x1D, 0xDB, -+0xC1, 0xF7, 0x66, 0xA0, 0x74, 0x33, 0x01, 0xE3, -+0xC1, 0xF6, 0x4E, 0xC0, 0x04, 0x10, 0x01, 0x6A, -+0x4B, 0xEA, 0xC1, 0xF6, 0x4E, 0xC3, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, -+0x66, 0xA2, 0x10, 0xF0, 0x24, 0x6D, 0x3C, 0xF3, -+0xAC, 0x9D, 0x74, 0x34, 0x51, 0xE4, 0xC1, 0xF6, -+0xCC, 0xA4, 0x76, 0x4B, 0x74, 0x33, 0xC0, 0xC5, -+0xC1, 0xF6, 0xAD, 0xA4, 0x10, 0xF0, 0x24, 0x6C, -+0x3C, 0xF3, 0x90, 0x9C, 0x49, 0xE3, 0xA0, 0xC4, -+0x46, 0x82, 0x00, 0x52, 0x0B, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x6C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xFB, 0xF6, 0x88, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, -+0x76, 0x4B, 0x74, 0x33, 0x69, 0xE2, 0x86, 0x42, -+0x00, 0x18, 0xB4, 0xDA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, -+0x6C, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF5, -+0x0D, 0x4A, 0x10, 0xF0, 0x30, 0x68, 0x40, 0xDB, -+0x00, 0xF0, 0x00, 0x48, 0xC1, 0xF7, 0x66, 0xA0, -+0xC1, 0xF7, 0x47, 0xA0, 0x6E, 0xEA, 0x4A, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0xA0, 0xF0, 0x6A, 0xAA, 0x01, 0xF0, 0x00, 0x73, -+0x10, 0x60, 0xA0, 0xF0, 0x8B, 0xA2, 0xA0, 0xF0, -+0x4A, 0xA2, 0xAE, 0x42, 0x8E, 0xED, 0x09, 0x25, -+0x01, 0xF1, 0x01, 0x73, 0x06, 0x60, 0x01, 0xF1, -+0x00, 0x73, 0x03, 0x60, 0xFF, 0x4A, 0x4E, 0xEC, -+0x0D, 0x2C, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x80, 0xF0, 0x4C, 0x9B, 0x04, 0x6C, -+0x8D, 0xEA, 0x02, 0x6C, 0x8D, 0xEA, 0x80, 0xF0, -+0x4C, 0xDB, 0x24, 0x10, 0x00, 0x18, 0x1B, 0xDD, -+0xC1, 0xF7, 0x46, 0xA0, 0x01, 0x4A, 0xC1, 0xF7, -+0x46, 0xC0, 0xC1, 0xF7, 0x66, 0xA0, 0xC1, 0xF7, -+0x47, 0xA0, 0x6E, 0xEA, 0x0A, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x6C, 0x9A, 0x02, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, 0x08, 0x6C, -+0x8E, 0xEB, 0x02, 0x2B, 0xC1, 0xF7, 0x66, 0xC2, -+0x00, 0x18, 0x8E, 0xD9, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, 0x44, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEC, 0x40, 0xEA, -+0x05, 0x2A, 0x01, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF6, 0x68, 0xC2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xE0, 0xF1, 0x14, 0x68, -+0x0A, 0xD4, 0x24, 0x67, 0x90, 0x67, 0x04, 0x05, -+0x00, 0x18, 0x8D, 0xDD, 0x7D, 0x67, 0x50, 0xA3, -+0x01, 0x48, 0xE0, 0xF1, 0x1A, 0x70, 0x40, 0xC1, -+0x01, 0x49, 0xF4, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x0C, 0xF0, 0x6D, 0xA2, -+0x0C, 0xF0, 0x8E, 0xA2, 0x6C, 0x33, 0x94, 0x34, -+0x8D, 0xEB, 0x0C, 0xF0, 0x8C, 0xA2, 0x8D, 0xEB, -+0x0A, 0x94, 0x66, 0xC4, 0x0C, 0xF0, 0x6F, 0xA2, -+0x0C, 0xF0, 0x50, 0xA2, 0x68, 0x33, 0x58, 0x32, -+0x4D, 0xEB, 0x33, 0x6A, 0x4D, 0xEB, 0x67, 0xC4, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xE0, 0xF1, 0x10, 0x68, -+0x0A, 0xD4, 0x24, 0x67, 0x90, 0x67, 0x04, 0x05, -+0x00, 0x18, 0x8D, 0xDD, 0x7D, 0x67, 0x50, 0xA3, -+0x01, 0x48, 0xE0, 0xF1, 0x14, 0x70, 0x40, 0xC1, -+0x01, 0x49, 0xF4, 0x61, 0xE0, 0xF1, 0x1C, 0x6C, -+0x04, 0x05, 0x00, 0x18, 0x8D, 0xDD, 0x7D, 0x67, -+0x50, 0xA3, 0x0A, 0x93, 0x44, 0xC3, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0x04, 0x00, -+0x90, 0x67, 0x00, 0x18, 0x97, 0xDD, 0xA0, 0xF1, -+0x02, 0x6A, 0x1F, 0xF7, 0x00, 0x6B, 0x4C, 0xEB, -+0x02, 0xF0, 0x00, 0x73, 0x01, 0x60, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0xBB, 0xF6, 0x7C, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF6, -+0x60, 0x9B, 0x80, 0xA0, 0x6D, 0xE2, 0x01, 0x4A, -+0xA0, 0xF1, 0x0A, 0x72, 0x80, 0xC3, 0x01, 0x48, -+0xE8, 0x61, 0x04, 0x00, 0x90, 0x67, 0x00, 0x18, -+0xB1, 0xDD, 0xA0, 0xF1, 0x0A, 0x6A, 0x1F, 0xF7, -+0x00, 0x6B, 0x4C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xBB, 0xF6, 0x7C, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xDB, 0xF6, 0x60, 0x9B, 0x80, 0xA0, -+0x6D, 0xE2, 0x01, 0x4A, 0xA0, 0xF1, 0x0F, 0x72, -+0x80, 0xC3, 0x01, 0x48, 0xE8, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF3, 0x54, 0x9A, 0x19, 0x6B, -+0x60, 0xC2, 0x09, 0x97, 0x08, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x0C, 0xF0, 0x4C, 0xA0, 0x0B, 0x2A, -+0xE0, 0xF1, 0x1A, 0x6C, 0x04, 0x05, 0x00, 0x18, -+0x8D, 0xDD, 0x9D, 0x67, 0x70, 0xA4, 0x07, 0x6A, -+0x6C, 0xEA, 0x0C, 0xF0, 0x4C, 0xC0, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x0C, 0xF0, -+0x4E, 0xA0, 0x0A, 0x2A, 0xE0, 0xF1, 0x1A, 0x6C, -+0x04, 0x05, 0x00, 0x18, 0x8D, 0xDD, 0x7D, 0x67, -+0x50, 0xA3, 0x56, 0x32, 0x0C, 0xF0, 0x4E, 0xC0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x0C, 0xF0, 0x4F, 0xA0, 0x0B, 0x2A, 0xE0, 0xF1, -+0x1D, 0x6C, 0x04, 0x05, 0x00, 0x18, 0x8D, 0xDD, -+0x9D, 0x67, 0x70, 0xA4, 0x03, 0x6A, 0x6C, 0xEA, -+0x0C, 0xF0, 0x4F, 0xC0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x0C, 0xF0, 0x50, 0xA0, -+0x0C, 0x2A, 0xE0, 0xF1, 0x1D, 0x6C, 0x04, 0x05, -+0x00, 0x18, 0x8D, 0xDD, 0x7D, 0x67, 0x50, 0xA3, -+0x30, 0x6B, 0x6C, 0xEA, 0x53, 0x32, 0x0C, 0xF0, -+0x50, 0xC0, 0x07, 0x97, 0x06, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0x04, 0x01, 0xC0, 0xF1, 0x08, 0x48, 0x01, 0x6A, -+0xE0, 0xF1, 0x1B, 0x6C, 0xB1, 0x67, 0x0C, 0xF0, -+0x48, 0xC0, 0x0C, 0xF0, 0x49, 0xC0, 0x0C, 0xF0, -+0x4A, 0xC0, 0x0C, 0xF0, 0x4B, 0xC0, 0x00, 0x18, -+0x8D, 0xDD, 0x9D, 0x67, 0x70, 0xA4, 0x07, 0x6A, -+0xE0, 0xF1, 0x1D, 0x6C, 0x6C, 0xEA, 0x0C, 0xF0, -+0x4C, 0xC0, 0x18, 0x6A, 0x6C, 0xEA, 0x4F, 0x32, -+0x76, 0x33, 0xB1, 0x67, 0x0C, 0xF0, 0x4D, 0xC0, -+0x0C, 0xF0, 0x6E, 0xC0, 0x00, 0x18, 0x8D, 0xDD, -+0x5D, 0x67, 0x70, 0xA2, 0x0C, 0x6A, 0x6C, 0xEA, -+0x4B, 0x32, 0x7A, 0x33, 0x0C, 0xF0, 0x4F, 0xC0, -+0x0C, 0xF0, 0x70, 0xC0, 0x00, 0x18, 0xE7, 0xDD, -+0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF3, 0x54, 0x9A, -+0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, 0xFD, 0x72, -+0x02, 0x61, 0x00, 0x18, 0xC2, 0xDD, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x22, 0x6A, 0x7D, 0x67, -+0x50, 0xC3, 0x01, 0x6A, 0x4F, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x92, 0xC3, -+0x04, 0x04, 0x40, 0xEA, 0x09, 0x97, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x1A, 0x6A, 0x7D, 0x67, 0x50, 0xC3, 0x00, 0xF0, -+0x12, 0x04, 0x05, 0x6A, 0x4F, 0xCB, 0x00, 0x18, -+0xB1, 0xDD, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x58, 0x9A, 0x04, 0x04, 0x40, 0xEA, 0x09, 0x97, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x19, 0x6A, 0x7D, 0x67, 0x50, 0xC3, 0x00, 0xF0, -+0x12, 0x04, 0x08, 0x6A, 0x4F, 0xCB, 0x00, 0x18, -+0x97, 0xDD, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x58, 0x9A, 0x04, 0x04, 0x40, 0xEA, 0x09, 0x97, -+0x05, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x40, 0xA4, 0x01, 0x72, 0x04, 0x61, 0x00, 0x18, -+0x45, 0xDE, 0x00, 0x18, 0x3B, 0xDE, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x00, 0x6B, 0x0C, 0xF5, -+0x7A, 0xC2, 0x00, 0x6B, 0x0C, 0xF5, 0x78, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x63, 0x01, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x3C, 0xF3, 0x78, 0x9B, -+0x10, 0xF0, 0x24, 0x68, 0x3C, 0xF3, 0x1C, 0x98, -+0xE0, 0x9B, 0xFF, 0x6A, 0x4C, 0xEC, 0x0C, 0xEF, -+0x08, 0x5C, 0x4C, 0xED, 0x4C, 0xEE, 0xE0, 0xDB, -+0x46, 0x60, 0xB0, 0x75, 0x2E, 0x61, 0xB2, 0x76, -+0x13, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF2, -+0xBC, 0x9A, 0x01, 0x6A, 0x44, 0xEC, 0xC0, 0x9D, -+0x00, 0xF6, 0x40, 0x34, 0xCD, 0xEC, 0x80, 0xDD, -+0xC0, 0x9D, 0x40, 0x34, 0x80, 0x34, 0x8F, 0xEC, -+0xCC, 0xEC, 0x80, 0xDD, 0x80, 0x9B, 0x4E, 0x10, -+0xB1, 0x76, 0x80, 0xF0, 0x13, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xFC, 0xF2, 0xBC, 0x9A, 0x01, 0x6A, -+0x44, 0xEC, 0xC0, 0x9D, 0x00, 0xF6, 0x40, 0x34, -+0xCD, 0xEC, 0x80, 0xDD, 0xC0, 0x9D, 0x40, 0x34, -+0x80, 0x34, 0x8F, 0xEC, 0xCC, 0xEC, 0x80, 0xDD, -+0x80, 0x9B, 0x4F, 0xEA, 0x8C, 0xEA, 0x40, 0xDB, -+0x7B, 0x10, 0xA0, 0x75, 0x7D, 0x61, 0xA1, 0x76, -+0x08, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF2, -+0x5C, 0x9A, 0x01, 0x6B, 0x64, 0xEC, 0xA0, 0x9A, -+0x51, 0x10, 0xA2, 0x76, 0x6F, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xFC, 0xF2, 0x5C, 0x9A, 0x01, 0x6B, -+0x64, 0xEC, 0xA0, 0x9A, 0x5A, 0x10, 0xE8, 0x44, -+0x4C, 0xEF, 0x08, 0x5F, 0xE0, 0x6A, 0x65, 0x60, -+0xB0, 0x75, 0x35, 0x61, 0xB2, 0x76, 0x18, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, 0x40, 0x9A, -+0x01, 0x6E, 0xA6, 0x67, 0x00, 0x9A, 0xA4, 0xEF, -+0xE5, 0x67, 0x00, 0xF6, 0xA0, 0x35, 0x0D, 0xED, -+0xA0, 0xDA, 0xA0, 0x9A, 0xE0, 0x37, 0xE0, 0x37, -+0xEF, 0xEF, 0xAC, 0xEF, 0xE0, 0xDA, 0x40, 0x9B, -+0xC4, 0xEC, 0x86, 0x67, 0x4D, 0xEC, 0x19, 0x10, -+0xB1, 0x76, 0x44, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF3, 0x40, 0x9A, 0x01, 0x6E, 0xA6, 0x67, -+0x00, 0x9A, 0xA4, 0xEF, 0xE5, 0x67, 0x00, 0xF6, -+0xA0, 0x35, 0x0D, 0xED, 0xA0, 0xDA, 0xA0, 0x9A, -+0xE0, 0x37, 0xE0, 0x37, 0xEF, 0xEF, 0xAC, 0xEF, -+0xE0, 0xDA, 0x40, 0x9B, 0xC4, 0xEC, 0xCF, 0xEC, -+0x4C, 0xEC, 0x80, 0xDB, 0x29, 0x10, 0xA0, 0x75, -+0x2B, 0x61, 0xA1, 0x76, 0x11, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF3, 0x40, 0x9A, 0x01, 0x6B, -+0x64, 0xEF, 0xA0, 0x9A, 0x00, 0xF6, 0x60, 0x34, -+0x8F, 0xEC, 0xAC, 0xEC, 0x80, 0xDA, 0x80, 0x9A, -+0x60, 0x33, 0x60, 0x33, 0x8D, 0xEB, 0x13, 0x10, -+0xA2, 0x76, 0x14, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF3, 0x40, 0x9A, 0x01, 0x6B, 0x64, 0xEF, -+0xA0, 0x9A, 0x00, 0xF6, 0x60, 0x34, 0x8F, 0xEC, -+0xAC, 0xEC, 0x80, 0xDA, 0x80, 0x9A, 0x60, 0x33, -+0x60, 0x33, 0x6F, 0xEB, 0x8C, 0xEB, 0x60, 0xDA, -+0xF0, 0x6A, 0x03, 0x10, 0xE2, 0x6A, 0x01, 0x10, -+0xE1, 0x6A, 0x01, 0x90, 0x01, 0x63, 0x20, 0xE8, -+0xFF, 0x6B, 0x6C, 0xEC, 0x08, 0x5C, 0x6C, 0xED, -+0x20, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF3, -+0x40, 0x9A, 0x01, 0x6E, 0x40, 0xA2, 0x6C, 0xEA, -+0x47, 0xEC, 0xCC, 0xEA, 0x48, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x5C, 0xF3, 0x44, 0x9A, 0xC4, 0xEC, -+0x86, 0x67, 0x40, 0xA2, 0x6C, 0xEA, 0xCC, 0xEA, -+0xCE, 0xEA, 0x3B, 0x2A, 0x05, 0x25, 0x10, 0xF0, -+0x24, 0x6A, 0x5C, 0xF3, 0xA8, 0x9A, 0x24, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF3, 0x48, 0x9A, -+0x29, 0x10, 0xF8, 0x4C, 0x6C, 0xEC, 0x08, 0x5C, -+0xE0, 0x6A, 0x2E, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF3, 0x4C, 0x9A, 0x01, 0x6E, 0x40, 0xA2, -+0x6C, 0xEA, 0x47, 0xEC, 0xCC, 0xEA, 0x23, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF3, 0x50, 0x9A, -+0xC4, 0xEC, 0x86, 0x67, 0x40, 0xA2, 0x6C, 0xEA, -+0xCC, 0xEA, 0xCE, 0xEA, 0x16, 0x2A, 0x0A, 0x25, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF3, 0xB4, 0x9A, -+0x40, 0xA5, 0x6C, 0xEA, 0x8D, 0xEA, 0x6C, 0xEA, -+0x40, 0xC5, 0x09, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF3, 0x54, 0x9A, 0xA0, 0xA2, 0x8F, 0xEC, -+0x6C, 0xEC, 0xAC, 0xEC, 0x80, 0xC2, 0xF0, 0x6A, -+0x20, 0xE8, 0xE5, 0x6A, 0x20, 0xE8, 0xE4, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x68, 0x24, 0x67, -+0x0C, 0xE9, 0x91, 0x67, 0xAC, 0xE8, 0xA1, 0x6E, -+0xA0, 0x6D, 0x00, 0x18, 0x5B, 0xDE, 0x91, 0x67, -+0xB0, 0x67, 0x00, 0x18, 0xBE, 0xDE, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6A, -+0x3C, 0xF3, 0x78, 0x9A, 0x10, 0xF0, 0x24, 0x6D, -+0x3C, 0xF3, 0xBC, 0x9D, 0x40, 0x9B, 0xA2, 0x6E, -+0xAC, 0xEA, 0x40, 0xDB, 0xFF, 0x6A, 0x4C, 0xEC, -+0xA0, 0x6D, 0x00, 0x18, 0x5B, 0xDE, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFF, 0x6B, 0x6C, 0xEC, -+0x08, 0x5C, 0x0F, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF3, 0x40, 0x9A, 0x01, 0x6D, 0x40, 0xA2, -+0x6C, 0xEA, 0x47, 0xEC, 0xAC, 0xEA, 0x1F, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF3, 0x44, 0x9A, -+0x13, 0x10, 0xF8, 0x4C, 0x6C, 0xEC, 0x08, 0x5C, -+0xE0, 0x6A, 0x16, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF3, 0x4C, 0x9A, 0x01, 0x6D, 0x40, 0xA2, -+0x6C, 0xEA, 0x47, 0xEC, 0xAC, 0xEA, 0x0B, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF3, 0x50, 0x9A, -+0x40, 0xA2, 0x4C, 0xEB, 0x67, 0xEC, 0x45, 0x67, -+0x6E, 0xEA, 0xAC, 0xEA, 0x20, 0xE8, 0x00, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x6B, 0x6C, 0xEC, -+0x08, 0x5C, 0x1A, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF3, 0x40, 0x9A, 0x01, 0x6E, 0x40, 0xA2, -+0x6C, 0xEA, 0x47, 0xEC, 0xCC, 0xEA, 0x35, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF3, 0x44, 0x9A, -+0xC4, 0xEC, 0x86, 0x67, 0xA0, 0xA2, 0x6C, 0xED, -+0xCC, 0xED, 0xCE, 0xED, 0x2A, 0x2D, 0x10, 0xF0, -+0x24, 0x6A, 0x5C, 0xF3, 0x48, 0x9A, 0x1E, 0x10, -+0xF8, 0x4C, 0x6C, 0xEC, 0x08, 0x5C, 0xE0, 0x6A, -+0x21, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF3, -+0x4C, 0x9A, 0x01, 0x6E, 0x40, 0xA2, 0x6C, 0xEA, -+0x47, 0xEC, 0xCC, 0xEA, 0x16, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x5C, 0xF3, 0x50, 0x9A, 0xC4, 0xEC, -+0x86, 0x67, 0xA0, 0xA2, 0x6C, 0xED, 0xCC, 0xED, -+0xCE, 0xED, 0x0B, 0x2D, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF3, 0x54, 0x9A, 0x40, 0xA2, 0x4C, 0xEB, -+0x8C, 0xEB, 0x6E, 0xEC, 0x01, 0x5C, 0x58, 0x67, -+0x20, 0xE8, 0x00, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x6A, -+0x04, 0x67, 0x4C, 0xE8, 0xAC, 0xEA, 0xA4, 0x72, -+0x0C, 0x61, 0x90, 0x67, 0x00, 0x18, 0x01, 0xDF, -+0x01, 0x72, 0x04, 0x61, 0x90, 0x67, 0x00, 0x18, -+0xF6, 0xDE, 0x1F, 0x10, 0x90, 0x67, 0x00, 0x6D, -+0x0D, 0x10, 0xA5, 0x72, 0x11, 0x61, 0x90, 0x67, -+0x00, 0x18, 0x01, 0xDF, 0x01, 0x72, 0x04, 0x61, -+0x90, 0x67, 0x00, 0x18, 0xF6, 0xDE, 0x18, 0x10, -+0x90, 0x67, 0x01, 0x6D, 0x00, 0x18, 0xEB, 0xDE, -+0x90, 0x67, 0x00, 0x18, 0xF6, 0xDE, 0x14, 0x10, -+0x90, 0x67, 0x00, 0x18, 0x19, 0xDF, 0x01, 0x72, -+0x07, 0x61, 0x90, 0x67, 0x01, 0x6D, 0x00, 0x18, -+0xEB, 0xDE, 0x90, 0x67, 0x00, 0x6D, 0x06, 0x10, -+0x90, 0x67, 0x00, 0x6D, 0x00, 0x18, 0xEB, 0xDE, -+0x90, 0x67, 0x01, 0x6D, 0x00, 0x18, 0xEB, 0xDE, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x01, 0x72, 0xFF, 0xF7, 0x1F, 0x6C, 0xAC, 0xEC, -+0x05, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x58, 0x9A, 0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x40, 0xF2, 0x6A, 0xA2, 0x0B, 0x23, 0x40, 0xF2, -+0x6B, 0xA2, 0x04, 0x23, 0x40, 0xF2, 0x88, 0xA2, -+0xA5, 0x6D, 0x07, 0x10, 0x40, 0xF2, 0x88, 0xA2, -+0xA4, 0x6D, 0x03, 0x10, 0x40, 0xF2, 0x88, 0xA2, -+0xA3, 0x6D, 0x00, 0x18, 0x3C, 0xDF, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x30, 0xF0, -+0x20, 0x69, 0x4C, 0xEC, 0x4C, 0xEE, 0xFF, 0xF7, -+0x1F, 0x68, 0xEF, 0xF4, 0x08, 0x49, 0x04, 0xD4, -+0xAC, 0xE8, 0x05, 0xD6, 0x00, 0x18, 0x67, 0xDF, -+0x40, 0xF2, 0x4C, 0xA1, 0x2B, 0x22, 0x04, 0x94, -+0xB0, 0x67, 0x00, 0x18, 0x5C, 0xDF, 0x00, 0x18, -+0x67, 0xDF, 0x40, 0xF2, 0x4D, 0xA1, 0x01, 0x69, -+0x1E, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF3, -+0x58, 0x9A, 0x60, 0xA2, 0x10, 0x6A, 0x6C, 0xEA, -+0x19, 0x2A, 0x04, 0x94, 0xB0, 0x67, 0x00, 0x18, -+0x5C, 0xDF, 0x00, 0x18, 0x67, 0xDF, 0xF1, 0x17, -+0x04, 0x94, 0xB0, 0x67, 0x01, 0x49, 0x00, 0x18, -+0x5C, 0xDF, 0x00, 0x18, 0x67, 0xDF, 0x04, 0x94, -+0xB0, 0x67, 0x00, 0x18, 0x5C, 0xDF, 0x00, 0x18, -+0x67, 0xDF, 0xFF, 0x6A, 0x4C, 0xE9, 0x05, 0x92, -+0x43, 0xE9, 0xEE, 0x61, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0xA4, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0xEF, 0xF6, 0x09, 0x4C, 0x07, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, -+0x08, 0x4B, 0x00, 0xF2, 0x81, 0xA3, 0x01, 0x6F, -+0xFF, 0x6A, 0xEC, 0xEC, 0x12, 0x24, 0x00, 0xF2, -+0xC1, 0xA3, 0x00, 0xF2, 0x62, 0xA3, 0xC6, 0x34, -+0xCA, 0x35, 0xCE, 0x36, 0xEC, 0xEC, 0xEC, 0xED, -+0xEC, 0xEE, 0x7F, 0x6F, 0x6C, 0xEF, 0x4C, 0xEC, -+0x4C, 0xED, 0x4C, 0xEE, 0x4C, 0xEF, 0x00, 0x18, -+0x5C, 0xC7, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0xFF, 0x6A, -+0x4C, 0xEC, 0x2F, 0x6B, 0xAC, 0xEA, 0xBD, 0x67, -+0x0D, 0xD7, 0x0C, 0xD6, 0x70, 0xC5, 0x0A, 0x6B, -+0x6F, 0xCD, 0xB2, 0xA5, 0x08, 0x6B, 0xDD, 0x67, -+0x30, 0xF0, 0x20, 0x68, 0x6B, 0xEB, 0xAC, 0xEB, -+0x53, 0xC6, 0x4E, 0xF2, 0x50, 0x98, 0x6D, 0xEC, -+0x92, 0xC6, 0x0C, 0x05, 0x05, 0x04, 0x04, 0x6E, -+0x40, 0xEA, 0x4E, 0xF2, 0x50, 0x98, 0x06, 0x04, -+0x0D, 0x05, 0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, -+0x40, 0xEA, 0x09, 0x97, 0x08, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x00, 0xF2, 0xD0, 0xA2, -+0x1F, 0x6B, 0xFF, 0x6D, 0xCC, 0xEB, 0x8E, 0xEB, -+0xAC, 0xEB, 0x80, 0xF0, 0x1B, 0x2B, 0x00, 0xF2, -+0x8F, 0xA2, 0x01, 0x6B, 0x8C, 0xEB, 0xAC, 0xEB, -+0x07, 0x23, 0x00, 0xF2, 0x78, 0x9A, 0x20, 0xF2, -+0x50, 0x9A, 0x6E, 0xEA, 0x80, 0xF0, 0x0E, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x00, 0xF2, 0x8F, 0xA2, 0x10, 0x6B, 0x8C, 0xEB, -+0x06, 0x23, 0x20, 0xF2, 0x60, 0x9A, 0x20, 0xF2, -+0x58, 0x9A, 0x6E, 0xEA, 0x7F, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x5C, 0xF3, 0x5C, 0x9A, 0x30, 0xF0, -+0x20, 0x68, 0xEF, 0xF4, 0x08, 0x48, 0x40, 0x9A, -+0xFF, 0x69, 0x07, 0xD2, 0x10, 0xF0, 0x24, 0x6A, -+0x7C, 0xF3, 0x40, 0x9A, 0x40, 0x9A, 0x06, 0xD2, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF3, 0x64, 0x9A, -+0x8F, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF6, 0x44, 0x9A, -+0x00, 0x6C, 0xA4, 0x67, 0x40, 0x9A, 0x05, 0xD2, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF2, 0x58, 0x9A, -+0x40, 0x9A, 0x04, 0xD2, 0x07, 0x96, 0x06, 0x97, -+0x00, 0x18, 0xAE, 0xDF, 0x05, 0x96, 0x04, 0x97, -+0x01, 0x6C, 0x00, 0x6D, 0x00, 0x18, 0xAE, 0xDF, -+0x00, 0xF2, 0x6F, 0xA0, 0x10, 0x6A, 0x6C, 0xEA, -+0x22, 0x22, 0x20, 0xF2, 0xC0, 0x98, 0x20, 0xF2, -+0xE4, 0x98, 0x76, 0x35, 0x02, 0x6C, 0x2C, 0xED, -+0x00, 0x18, 0xAE, 0xDF, 0x00, 0xF2, 0xAF, 0xA0, -+0x20, 0xF2, 0xC8, 0x98, 0x20, 0xF2, 0xEC, 0x98, -+0xB6, 0x35, 0x04, 0x6C, 0x2C, 0xED, 0x00, 0x18, -+0xAE, 0xDF, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x50, 0x9A, 0x30, 0xF0, 0x20, 0x6C, 0x30, 0xF0, -+0x20, 0x6D, 0x2F, 0xF7, 0x00, 0x4C, 0x0F, 0xF7, -+0x08, 0x4D, 0x10, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x00, 0xF2, -+0x8F, 0xA2, 0x01, 0x6B, 0x8C, 0xEB, 0x1E, 0x23, -+0x00, 0xF2, 0xD8, 0x9A, 0x20, 0xF2, 0x70, 0x9A, -+0xCE, 0xEB, 0x18, 0x23, 0x86, 0x35, 0x07, 0x6B, -+0x00, 0xF2, 0xFC, 0x9A, 0x6C, 0xED, 0xFF, 0x6B, -+0x03, 0x6C, 0x6C, 0xED, 0x00, 0x18, 0xAE, 0xDF, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x30, 0xF0, 0x20, 0x6D, -+0x0F, 0xF7, 0x18, 0x4C, 0x0F, 0xF7, 0x00, 0x4D, -+0x08, 0x6E, 0x40, 0xEA, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, 0xA4, 0x67, -+0x30, 0xF0, 0x20, 0x6C, 0xEF, 0xF6, 0x17, 0x4C, -+0x07, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x00, 0xF2, 0x8F, 0xA2, -+0x10, 0x6B, 0x8C, 0xEB, 0x05, 0x23, 0x96, 0x34, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0x22, 0xEC, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF6, 0x58, 0xA2, -+0x1F, 0x6C, 0xFF, 0x68, 0x4C, 0xEC, 0x0C, 0x4C, -+0x01, 0x6A, 0x44, 0xEC, 0x82, 0x67, 0x00, 0x18, -+0x80, 0xE0, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF3, -+0x68, 0x9A, 0x08, 0x6C, 0x40, 0xA3, 0x0C, 0xEA, -+0x8D, 0xEA, 0x0C, 0xEA, 0x40, 0xC3, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0xF7, 0x1F, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0x8C, 0xEA, 0x7C, 0xF3, 0x6C, 0x9B, 0x10, 0xF0, -+0x24, 0x6C, 0x7C, 0xF3, 0x90, 0x9C, 0xCC, 0xEB, -+0x40, 0xF6, 0xA0, 0x35, 0x8D, 0xEB, 0x1F, 0xF7, -+0x00, 0x6C, 0x4C, 0xEC, 0x02, 0xF0, 0x00, 0x74, -+0xAD, 0xEB, 0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, -+0x24, 0x6C, 0xBB, 0xF6, 0x9C, 0x9C, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6C, 0xDB, 0xF6, 0x80, 0x9C, -+0x89, 0xE2, 0x60, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, 0x1F, 0xF7, -+0x00, 0x6C, 0x4C, 0xEC, 0xFF, 0x6B, 0x02, 0xF0, -+0x00, 0x74, 0xAC, 0xEB, 0x01, 0x60, 0x05, 0x2C, -+0x10, 0xF0, 0x24, 0x6C, 0xBB, 0xF6, 0x9C, 0x9C, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6C, 0xDB, 0xF6, -+0x80, 0x9C, 0x91, 0xE2, 0x00, 0x6D, 0xA0, 0xDC, -+0x10, 0xF0, 0x24, 0x6C, 0x7C, 0xF3, 0x8C, 0x9C, -+0xD4, 0x36, 0x40, 0xF6, 0x60, 0x33, 0x8C, 0xEE, -+0x6D, 0xEE, 0x10, 0xF0, 0x24, 0x6B, 0x7C, 0xF3, -+0x70, 0x9B, 0x6D, 0xEE, 0x1F, 0xF7, 0x00, 0x6B, -+0x4C, 0xEB, 0x02, 0xF0, 0x00, 0x73, 0x01, 0x60, -+0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, 0xBB, 0xF6, -+0x7C, 0x9B, 0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0xDB, 0xF6, 0x60, 0x9B, 0x69, 0xE2, 0xC0, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0x0F, 0xF5, 0x00, 0x6B, -+0x78, 0xEE, 0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, -+0x10, 0xF0, 0x24, 0x6C, 0x7C, 0xF3, 0x8C, 0x9C, -+0x40, 0xF6, 0xA0, 0x35, 0x12, 0xEB, 0x8C, 0xEB, -+0x10, 0xF0, 0x24, 0x6C, 0x7C, 0xF3, 0x90, 0x9C, -+0xAD, 0xEB, 0x8D, 0xEB, 0x1F, 0xF7, 0x00, 0x6C, -+0x4C, 0xEC, 0x02, 0xF0, 0x00, 0x74, 0x01, 0x60, -+0x05, 0x2C, 0x10, 0xF0, 0x24, 0x6C, 0xBB, 0xF6, -+0x9C, 0x9C, 0x04, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0xDB, 0xF6, 0x80, 0x9C, 0x89, 0xE2, 0x60, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF3, 0x5C, 0x9A, 0x40, 0x9A, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x4C, 0x9B, 0x8D, 0xEA, 0x4C, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0x9C, 0xF3, 0x64, 0x9B, 0x80, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF3, 0x68, 0x9B, -+0x40, 0xDB, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF3, -+0x6C, 0x9A, 0xC0, 0x6A, 0xFF, 0x68, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF3, 0x50, 0x9A, -+0x01, 0x6B, 0x05, 0x97, 0x40, 0xA2, 0x0C, 0xEA, -+0x5E, 0x32, 0x6E, 0xEA, 0x6C, 0xEA, 0x0C, 0xEA, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, -+0x24, 0x6A, 0x70, 0xF2, 0x09, 0x4A, 0x40, 0xDB, -+0x00, 0x68, 0x28, 0x10, 0x82, 0xF3, 0x08, 0x70, -+0x11, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x6C, 0x9A, 0x02, 0xF0, 0x00, 0x6C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x9C, 0xF3, 0x54, 0x9A, 0x03, 0x6B, 0x6B, 0xEB, -+0x60, 0xC2, 0x18, 0x10, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x48, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x14, 0x6C, 0x40, 0xEA, -+0x33, 0x58, 0x08, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF3, 0x58, 0x9A, 0x60, 0xA2, 0x08, 0x6A, -+0x6C, 0xEA, 0x04, 0x2A, 0x00, 0x18, 0x89, 0xE0, -+0x01, 0x72, 0xD4, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x9C, 0xF3, 0x54, 0x9A, 0x02, 0x6B, 0x6B, 0xEB, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, -+0x6C, 0x9B, 0x10, 0xF0, 0x24, 0x6A, 0x70, 0xF2, -+0x0A, 0x4A, 0x40, 0xDB, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0x05, 0x5C, 0x5E, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, 0x7B, 0xF5, -+0x0C, 0x4A, 0x89, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x48, 0x9B, -+0xAD, 0xEA, 0xC0, 0xF1, 0x48, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xFC, 0xF2, 0x74, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF3, 0x78, 0x9B, -+0x32, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x41, 0x9B, 0xAD, 0xEA, 0x41, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF3, 0x7C, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF3, -+0x60, 0x9B, 0x21, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x42, 0x9B, 0xAD, 0xEA, -+0x42, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF3, -+0x64, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF3, 0x68, 0x9B, 0x10, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x43, 0x9B, -+0xAD, 0xEA, 0x43, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF3, 0x6C, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xBC, 0xF3, 0x70, 0x9B, 0x40, 0xDB, -+0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x44, 0x9B, 0xAD, 0xEA, 0x44, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF3, 0x74, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF3, -+0x78, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0x05, 0x5C, 0x63, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x88, 0x34, 0x9B, 0xF5, 0x00, 0x4A, 0x89, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x88, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, -+0xC0, 0xF1, 0x48, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0x9C, 0xF3, 0x78, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xFC, 0xF2, 0x54, 0x9A, 0x35, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x81, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x41, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF3, 0x60, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF3, -+0x5C, 0x9A, 0x23, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x82, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x42, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF3, 0x68, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF3, 0x44, 0x9A, 0x11, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x83, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x43, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF3, 0x70, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF3, -+0x4C, 0x9A, 0xA0, 0xDA, 0x20, 0xE8, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x84, 0x9B, -+0xAF, 0xEA, 0x8C, 0xEA, 0x44, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xBC, 0xF3, 0x78, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF3, 0x54, 0x9A, -+0xA0, 0xDA, 0x20, 0xE8, 0x01, 0x74, 0x15, 0x60, -+0x03, 0x24, 0x02, 0x74, 0x23, 0x60, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x4E, 0x9B, 0xAD, 0xEA, 0x4E, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0x3B, 0xF7, 0x78, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF3, 0x7C, 0x9B, -+0x21, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x4F, 0x9B, 0xAD, 0xEA, 0x4F, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF3, 0x7C, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xDC, 0xF3, -+0x60, 0x9B, 0x10, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x50, 0x9B, 0xAD, 0xEA, -+0x50, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xDC, 0xF3, -+0x64, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xDC, 0xF3, 0x68, 0x9B, 0x40, 0xDB, 0x20, 0xE8, -+0x01, 0x74, 0x16, 0x60, 0x03, 0x24, 0x02, 0x74, -+0x25, 0x60, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x8E, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x4E, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF3, 0x7C, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x58, 0x9A, 0x23, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x8F, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x4F, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xDC, 0xF3, 0x60, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, -+0x5C, 0x9A, 0x11, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x90, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x50, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xDC, 0xF3, 0x68, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF3, 0x44, 0x9A, 0xA0, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6C, -+0x9C, 0xF3, 0x98, 0x9C, 0x00, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x48, 0xDB, 0xC0, 0xF1, -+0x08, 0x4B, 0x41, 0xDB, 0x42, 0xDB, 0x43, 0xDB, -+0x44, 0xDB, 0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6C, -+0xBC, 0xF3, 0x80, 0x9C, 0x40, 0xDC, 0x10, 0xF0, -+0x24, 0x6C, 0xBC, 0xF3, 0x88, 0x9C, 0x40, 0xDC, -+0x10, 0xF0, 0x24, 0x6C, 0xBC, 0xF3, 0x90, 0x9C, -+0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6C, 0xBC, 0xF3, -+0x98, 0x9C, 0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6C, -+0xBC, 0xF3, 0x9C, 0x9C, 0x4E, 0xDB, 0x4F, 0xDB, -+0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6C, 0xDC, 0xF3, -+0x80, 0x9C, 0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6C, -+0xDC, 0xF3, 0x88, 0x9C, 0x50, 0xDB, 0x40, 0xDC, -+0x4C, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF3, -+0x68, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0xFC, 0xF2, 0x74, 0x9B, -+0x01, 0x6A, 0x4B, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0x9C, 0xF3, 0x7C, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF3, 0x64, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF3, -+0x6C, 0x9B, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0x3B, 0xF7, 0x78, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0x1C, 0xF3, 0x7C, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xDC, 0xF3, 0x68, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF3, -+0x64, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x4C, 0xEC, 0x05, 0x5C, 0x4C, 0xED, -+0x00, 0x6A, 0x61, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x88, 0x34, 0x9B, 0xF5, 0x14, 0x4A, 0x89, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x05, 0x2D, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF3, 0x54, 0x9A, 0x0A, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF3, 0x54, 0x9A, -+0x0C, 0x10, 0x07, 0x2D, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF3, 0x58, 0x9A, 0x60, 0xA2, 0x01, 0x6A, -+0x39, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF3, -+0x58, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, -+0x46, 0x32, 0x2F, 0x10, 0x09, 0x2D, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF3, 0x58, 0x9A, 0x60, 0xA2, -+0xFF, 0x6A, 0x6C, 0xEA, 0x4A, 0x32, 0x25, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF3, 0x58, 0x9A, -+0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, 0x4E, 0x32, -+0x1C, 0x10, 0x09, 0x2D, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF3, 0x58, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0x52, 0x32, 0x12, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF3, 0x58, 0x9A, 0x60, 0xA2, -+0xFF, 0x6A, 0x6C, 0xEA, 0x56, 0x32, 0x09, 0x10, -+0x0B, 0x2D, 0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF3, -+0x58, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, -+0x5A, 0x32, 0x01, 0x6B, 0x6C, 0xEA, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF3, 0x58, 0x9A, -+0x40, 0xA2, 0x00, 0xF6, 0x40, 0x32, 0x00, 0xF6, -+0x43, 0x32, 0xC0, 0xF7, 0x42, 0x32, 0x20, 0xE8, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x69, 0x8C, 0xE9, 0x00, 0x68, 0xFF, 0x6A, -+0x0C, 0xEA, 0x2E, 0xEA, 0x10, 0x2A, 0x91, 0x67, -+0x00, 0x18, 0x14, 0xEC, 0x91, 0x67, 0x00, 0x18, -+0x03, 0xEC, 0x91, 0x67, 0x00, 0x18, 0x1B, 0xEC, -+0x91, 0x67, 0x00, 0x18, 0xD5, 0xEB, 0x91, 0x67, -+0x00, 0x18, 0xE2, 0xEB, 0x0F, 0x10, 0x90, 0x67, -+0x00, 0x18, 0x3A, 0xEC, 0x90, 0x67, 0x00, 0x18, -+0x29, 0xEC, 0x90, 0x67, 0x00, 0x18, 0x41, 0xEC, -+0x90, 0x67, 0x00, 0x18, 0xF9, 0xEB, 0x90, 0x67, -+0x00, 0x18, 0xEF, 0xEB, 0x01, 0x48, 0x05, 0x70, -+0xDA, 0x61, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0xFF, 0xF7, 0x1F, 0x69, 0x8C, 0xE9, 0xFC, 0xF3, -+0x80, 0x9A, 0xFF, 0x6B, 0x8E, 0x6A, 0xA0, 0xA4, -+0x00, 0x68, 0x6C, 0xED, 0xAC, 0xEA, 0x40, 0xC4, -+0x71, 0x6A, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF3, 0x84, 0x9A, -+0x01, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x19, 0x10, 0x64, 0x70, -+0x0D, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x6C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x5B, 0xF7, -+0x88, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x00, 0x6A, 0x1C, 0x10, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x48, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF3, 0x44, 0x9A, -+0x60, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, 0xDF, 0x2A, -+0xFF, 0xF7, 0x1F, 0x6A, 0x01, 0x49, 0x4C, 0xE9, -+0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF7, 0x44, 0x9A, -+0x20, 0xCA, 0x01, 0x6A, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0xFF, 0x69, 0x4E, 0xF2, -+0x4C, 0x9B, 0x2C, 0xED, 0xFF, 0xF7, 0x1F, 0x68, -+0x11, 0xD7, 0x8C, 0xE8, 0x08, 0xD5, 0x04, 0x04, -+0x00, 0x6D, 0xCC, 0xE9, 0x04, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x4C, 0x9B, -+0x05, 0x04, 0x00, 0x6D, 0x04, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x50, 0x9B, -+0x11, 0x95, 0x04, 0x04, 0x04, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x50, 0x9B, -+0x12, 0x95, 0x06, 0x04, 0x04, 0x6E, 0x40, 0xEA, -+0x00, 0xF1, 0x00, 0x58, 0x08, 0x61, 0x0E, 0xF0, -+0x40, 0x40, 0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEA, -+0x00, 0xF1, 0x00, 0x5A, 0x39, 0x60, 0x08, 0x92, -+0x04, 0x72, 0x11, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF6, 0x5C, 0x9A, 0xFF, 0x6B, 0x49, 0xE0, -+0x40, 0xA2, 0x4C, 0xEB, 0x5F, 0x21, 0x06, 0x94, -+0x8F, 0xEA, 0x6C, 0xEA, 0x04, 0x93, 0x8C, 0xEB, -+0x6D, 0xEA, 0x04, 0xD2, 0x57, 0x10, 0x08, 0x92, -+0x05, 0x72, 0x12, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF6, 0x5C, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, -+0x49, 0xE0, 0x40, 0xAA, 0x4C, 0xEB, 0x7F, 0x21, -+0x06, 0x94, 0x8F, 0xEA, 0x6C, 0xEA, 0x04, 0x93, -+0x8C, 0xEB, 0x6D, 0xEA, 0x04, 0xD2, 0x77, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF6, 0x5C, 0x9A, -+0x49, 0xE0, 0x60, 0x9A, 0x80, 0xF0, 0x1E, 0x21, -+0x06, 0x94, 0x8F, 0xEA, 0x6C, 0xEA, 0x04, 0x93, -+0x8C, 0xEB, 0x6D, 0xEA, 0x04, 0xD2, 0x96, 0x10, -+0x01, 0xF0, 0x00, 0x58, 0x09, 0x61, 0x0D, 0xF7, -+0x40, 0x40, 0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEA, -+0x00, 0xF7, 0x00, 0x5A, 0x80, 0xF0, 0x17, 0x60, -+0x08, 0x92, 0x04, 0x72, 0x31, 0x61, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF6, 0x5C, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x40, 0x9A, 0x49, 0xE0, -+0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, 0x07, 0x21, -+0x06, 0x94, 0x8F, 0xEB, 0x4C, 0xEB, 0x04, 0x92, -+0x8C, 0xEA, 0x4D, 0xEB, 0x04, 0xD3, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF6, 0x5C, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x40, 0x9A, 0x7D, 0x67, -+0x41, 0xE0, 0x50, 0xA3, 0x40, 0xC0, 0x7E, 0x10, -+0x08, 0x92, 0x05, 0x72, 0x32, 0x61, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF6, 0x5C, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x40, 0x9A, 0x49, 0xE0, -+0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x6A, 0x6C, 0xEA, -+0x07, 0x21, 0x06, 0x94, 0x8F, 0xEB, 0x4C, 0xEB, -+0x04, 0x92, 0x8C, 0xEA, 0x4D, 0xEB, 0x04, 0xD3, -+0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, -+0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF6, 0x5C, 0x9A, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, 0x40, 0x9A, -+0x7D, 0x67, 0x41, 0xE0, 0x48, 0xAB, 0x40, 0xC8, -+0x49, 0x10, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF6, 0x5C, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0x40, 0x9A, 0x49, 0xE0, 0x60, 0x9A, 0x07, 0x21, -+0x06, 0x94, 0x8F, 0xEA, 0x6C, 0xEA, 0x04, 0x93, -+0x8C, 0xEB, 0x6D, 0xEA, 0x04, 0xD2, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF6, 0x5C, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x40, 0x9A, 0x41, 0xE0, -+0x04, 0x92, 0x40, 0xD8, 0x1B, 0x10, 0xFF, 0xF7, -+0x1C, 0x6A, 0x0C, 0xEA, 0x01, 0x6D, 0x82, 0x67, -+0xAB, 0xED, 0x08, 0xD2, 0x00, 0x18, 0xE4, 0xE6, -+0x05, 0xD2, 0x07, 0x21, 0x06, 0x94, 0x8F, 0xEB, -+0x4C, 0xEB, 0x04, 0x92, 0x8C, 0xEA, 0x4D, 0xEB, -+0x04, 0xD3, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x08, 0x94, 0x04, 0x96, 0x01, 0x6D, -+0xAB, 0xED, 0x40, 0xEA, 0x0D, 0x97, 0x0C, 0x91, -+0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x41, 0x9C, 0x61, 0xA4, 0x01, 0xAC, 0x06, 0xD2, -+0x42, 0x9C, 0xFF, 0x73, 0x07, 0xD2, 0x00, 0x6A, -+0x59, 0x60, 0x7F, 0x6D, 0x6C, 0xED, 0x4C, 0x45, -+0xFF, 0x6B, 0x6C, 0xEA, 0x0E, 0x5A, 0x08, 0x60, -+0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, 0xBB, 0xF5, -+0x08, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, 0x00, 0xEA, -+0x03, 0x6A, 0x48, 0x10, 0x61, 0xA4, 0x80, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6E, 0x07, 0x03, -+0x90, 0x67, 0x4C, 0xEE, 0x06, 0x07, 0x04, 0xD3, -+0x00, 0x18, 0x0C, 0xE2, 0x1F, 0x10, 0x81, 0xA4, -+0x80, 0x6A, 0xFF, 0x69, 0x64, 0x67, 0x4C, 0xEB, -+0x0C, 0xE9, 0x02, 0x32, 0x01, 0x6E, 0x82, 0x67, -+0xB1, 0x67, 0xCB, 0xEE, 0x08, 0xD3, 0x09, 0xD2, -+0x00, 0x18, 0x2F, 0xE7, 0x08, 0x93, 0x07, 0x23, -+0x07, 0x94, 0x8F, 0xEB, 0x4C, 0xEB, 0x06, 0x92, -+0x8C, 0xEA, 0x4D, 0xEB, 0x06, 0xD3, 0x09, 0x94, -+0x06, 0x97, 0x01, 0x6E, 0xB1, 0x67, 0xCB, 0xEE, -+0x00, 0x18, 0x42, 0xE7, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x29, 0xF4, 0x7C, 0x9A, -+0x06, 0x94, 0x61, 0xE0, 0x49, 0xF4, 0x60, 0x9A, -+0x29, 0xF4, 0x1C, 0xDA, 0x6D, 0xE4, 0x49, 0xF4, -+0x60, 0xDA, 0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x04, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x58, 0x9A, 0x90, 0x67, -+0x40, 0xEA, 0x01, 0x6A, 0x0D, 0x97, 0x0C, 0x91, -+0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF3, 0x84, 0x9A, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0xA0, 0x9C, 0x4C, 0x9B, 0xAC, 0xEA, 0x4D, 0xDB, -+0x40, 0xDC, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0xD1, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF2, -+0x34, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF3, -+0x1C, 0x4A, 0x40, 0x9A, 0x60, 0x99, 0x10, 0xF0, -+0x24, 0x6C, 0xA0, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF3, 0x44, 0x9A, 0xBC, 0xF3, 0x0C, 0x4C, -+0x80, 0x9C, 0x00, 0x9A, 0x1A, 0x65, 0x10, 0xF0, -+0x24, 0x6A, 0x80, 0x9C, 0xBC, 0xF3, 0x14, 0x4A, -+0x40, 0x9A, 0x01, 0xD4, 0x30, 0xF0, 0x20, 0x6C, -+0x40, 0x9A, 0xC0, 0xF1, 0xE8, 0x9C, 0x00, 0xD2, -+0x44, 0x67, 0xC0, 0xF1, 0x08, 0x4A, 0xC1, 0x9A, -+0x83, 0x9A, 0x6C, 0xEF, 0xAC, 0xEE, 0x01, 0x93, -+0xA2, 0x9A, 0xE5, 0xDA, 0x6C, 0xEC, 0x0C, 0xED, -+0x64, 0x9A, 0x00, 0x90, 0x88, 0xDA, 0xC6, 0xDA, -+0x0C, 0xEB, 0xA7, 0xDA, 0x69, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF3, 0x1C, 0x4A, 0x40, 0x9A, -+0xE0, 0xD9, 0x18, 0x67, 0xC0, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF3, 0x0C, 0x4A, 0x40, 0x9A, -+0xA0, 0xD8, 0x80, 0xDA, 0x10, 0xF0, 0x24, 0x6C, -+0xBC, 0xF3, 0x14, 0x4C, 0x80, 0x9C, 0x60, 0xDC, -+0x05, 0x91, 0x04, 0x90, 0x03, 0x63, 0x20, 0xE8, -+0xFF, 0x63, 0x01, 0xD1, 0x00, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x18, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF3, 0xFC, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF3, 0xC4, 0x9A, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0x98, -+0xAE, 0x9A, 0x60, 0x9F, 0x20, 0x9E, 0x8C, 0xED, -+0x8F, 0x9A, 0xB1, 0xDA, 0x6C, 0xEC, 0x70, 0x9A, -+0x92, 0xDA, 0x2C, 0xEB, 0x73, 0xDA, 0xA0, 0xD8, -+0x80, 0xDF, 0x60, 0xDE, 0x01, 0x91, 0x00, 0x90, -+0x01, 0x63, 0x20, 0xE8, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x50, 0x9A, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x4C, 0xEC, 0x07, 0x6D, 0xB8, 0xEC, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x01, 0x6E, 0x12, 0xEC, 0x71, 0xE4, 0xE9, 0xF0, -+0xA5, 0xA4, 0xCC, 0xED, 0x1D, 0x25, 0xE9, 0xF0, -+0xA6, 0xA4, 0x29, 0xF1, 0x60, 0x9B, 0xE9, 0xF0, -+0x85, 0xA4, 0x75, 0xE5, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF2, 0x7C, 0x9B, 0xBC, 0x35, 0x21, 0x4D, -+0x75, 0xE5, 0xE0, 0xA5, 0x9E, 0x33, 0x9A, 0x34, -+0xCC, 0xEC, 0x78, 0x33, 0x9C, 0x34, 0x4C, 0xEF, -+0x8D, 0xEB, 0xED, 0xEB, 0x00, 0xF6, 0x60, 0x33, -+0x00, 0xF6, 0x63, 0x33, 0x4C, 0xEB, 0x60, 0xC5, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x9D, 0xA2, 0x04, 0x6B, 0x8D, 0xEB, -+0x68, 0xF3, 0x7D, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF3, 0x48, 0x9A, -+0x40, 0xA2, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF3, -+0x4C, 0x9A, 0x40, 0xA2, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF3, 0x50, 0x9A, 0x40, 0xA2, 0x10, 0xF0, -+0x24, 0x6A, 0xFC, 0xF2, 0x58, 0x9A, 0x40, 0xA2, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF3, 0x54, 0x9A, -+0x40, 0xA2, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF3, -+0x58, 0x9A, 0x40, 0xA2, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF3, 0x5C, 0x9A, 0x40, 0xA2, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF6, 0x44, 0x9A, 0x40, 0xA2, -+0x20, 0xE8, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0x8A, 0xA2, -+0x01, 0x6B, 0x8C, 0xEB, 0x05, 0x23, 0x00, 0x6B, -+0x08, 0xF3, 0x6B, 0xC2, 0x08, 0xF3, 0x6C, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0x8A, 0xA2, -+0x01, 0x6B, 0x8C, 0xEB, 0x05, 0x23, 0x00, 0x6B, -+0x08, 0xF3, 0x6B, 0xC2, 0x08, 0xF3, 0x6C, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0x8A, 0xA2, -+0x01, 0x6B, 0x8C, 0xEB, 0x05, 0x23, 0x00, 0x6B, -+0x08, 0xF3, 0x6B, 0xC2, 0x08, 0xF3, 0x6C, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x6C, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x5B, 0xF7, 0x80, 0x9C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x20, 0xE8, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF6, 0x81, 0xA3, 0x6E, 0xF5, 0x58, 0x9A, -+0x40, 0xEA, 0x01, 0x6B, 0x6E, 0xEA, 0x1E, 0x2A, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x68, 0xF3, 0xB4, 0xA3, 0x7F, 0x6C, 0xAC, 0xEC, -+0x15, 0x24, 0x10, 0xF0, 0x24, 0x6C, 0x9B, 0xF7, -+0x98, 0x9C, 0x00, 0x6D, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x58, 0x9A, 0x02, 0x6C, -+0x80, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x50, 0x9A, 0xE8, 0xF3, 0xC5, 0xA3, 0xFF, 0x6C, -+0x55, 0x4C, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6D, -+0xC0, 0xF1, 0x08, 0x4D, 0x68, 0xF3, 0xD4, 0xA5, -+0x7F, 0x6B, 0xFF, 0x6A, 0xCC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x0D, 0x2B, 0x08, 0xF3, 0xAA, 0xA5, -+0x01, 0x6B, 0x6C, 0xED, 0x4C, 0xED, 0x07, 0x2D, -+0x30, 0xF0, 0x21, 0x6D, 0x70, 0xF3, 0xB8, 0xA5, -+0xAC, 0xEB, 0x4C, 0xEB, 0x18, 0x23, 0x30, 0xF0, -+0x20, 0x6A, 0xC8, 0xF4, 0x72, 0xA2, 0x01, 0x6A, -+0x4C, 0xEB, 0x08, 0x2B, 0x30, 0xF0, 0x21, 0x6B, -+0x70, 0xF3, 0x78, 0xA3, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x07, 0x22, 0x00, 0x18, 0xCA, 0xEF, -+0x01, 0x72, 0x05, 0x61, 0x00, 0x18, 0x9F, 0xF1, -+0x02, 0x10, 0x00, 0x18, 0x4F, 0xCE, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x24, 0x67, 0x6E, 0xF5, -+0x58, 0x9A, 0xEF, 0xF6, 0x81, 0xA3, 0xFF, 0x68, -+0x0C, 0xE9, 0x40, 0xEA, 0x01, 0x72, 0x19, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x94, 0xA2, 0x7F, 0x6B, 0x8C, 0xEB, -+0x0C, 0xEB, 0x0F, 0x23, 0x68, 0xF3, 0x9D, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, -+0x7D, 0xC2, 0x68, 0xF3, 0x5D, 0xA2, 0x07, 0x6B, -+0x6C, 0xEA, 0x03, 0x2A, 0x91, 0x67, 0x00, 0x18, -+0x81, 0xCC, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x24, 0x67, 0x6E, 0xF5, -+0x58, 0x9A, 0xEF, 0xF6, 0x81, 0xA3, 0xFF, 0x68, -+0x0C, 0xE9, 0x40, 0xEA, 0x01, 0x6B, 0x6E, 0xEA, -+0x29, 0x2A, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0xB4, 0xA3, 0x7F, 0x6C, -+0xAC, 0xEC, 0x0C, 0xEC, 0x1F, 0x24, 0x10, 0xF0, -+0x24, 0x6C, 0x9B, 0xF7, 0x98, 0x9C, 0x40, 0xC4, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x58, 0x9A, -+0x02, 0x6C, 0x80, 0xC2, 0x68, 0xF3, 0x99, 0xA3, -+0x03, 0x6A, 0x4B, 0xEA, 0x4C, 0xEC, 0x68, 0xF3, -+0x99, 0xC3, 0x68, 0xF3, 0x9D, 0xA3, 0x8C, 0xEA, -+0x68, 0xF3, 0x5D, 0xC3, 0x68, 0xF3, 0x5D, 0xA3, -+0x07, 0x6B, 0x6C, 0xEA, 0x03, 0x2A, 0x91, 0x67, -+0x00, 0x18, 0x81, 0xCC, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0xBD, 0xA2, -+0x05, 0x6B, 0x6B, 0xEB, 0xAC, 0xEB, 0x68, 0xF3, -+0x7D, 0xC2, 0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, -+0x81, 0xCC, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x24, 0x67, 0x6E, 0xF5, 0x58, 0x9A, 0xEF, 0xF6, -+0x81, 0xA3, 0xFF, 0x68, 0x0C, 0xE9, 0x40, 0xEA, -+0x01, 0x72, 0x1B, 0x61, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, 0x94, 0xA3, -+0x7F, 0x6A, 0x8C, 0xEA, 0x0C, 0xEA, 0x11, 0x22, -+0x68, 0xF3, 0x75, 0xA3, 0x10, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x0C, 0xEA, 0x20, 0x72, 0x06, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0x03, 0x10, 0x91, 0x67, 0x00, 0x18, -+0x58, 0xCE, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0xE0, 0xF1, 0x7F, 0xA2, 0x08, 0x2B, -+0xC0, 0xF0, 0x79, 0xA2, 0x07, 0x6A, 0x6C, 0xEA, -+0x4E, 0xE9, 0x02, 0x29, 0x00, 0x18, 0x84, 0xEE, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, -+0x08, 0x4B, 0x00, 0xF2, 0xAF, 0xA3, 0x04, 0x67, -+0x01, 0x6C, 0xFF, 0x6A, 0xAC, 0xEC, 0x4C, 0xEC, -+0x4C, 0xE8, 0x13, 0x24, 0xA6, 0x32, 0x07, 0x6C, -+0x8C, 0xEA, 0x0E, 0xEA, 0x0E, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF3, 0x40, 0x9A, 0x40, 0x9A, -+0x00, 0xF2, 0x5C, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF3, 0x5C, 0x9A, 0x40, 0x9A, 0x00, 0xF2, -+0x58, 0xDB, 0x90, 0x67, 0x00, 0x18, 0x41, 0xCA, -+0x80, 0xF0, 0x0E, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xC8, 0xF4, 0x72, 0xA2, 0x01, 0x6A, 0x4C, 0xEB, -+0x08, 0x2B, 0x30, 0xF0, 0x21, 0x6B, 0x70, 0xF3, -+0x78, 0xA3, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x0C, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, -+0x56, 0xA2, 0x02, 0x72, 0x36, 0x60, 0x30, 0xF0, -+0x21, 0x6A, 0x90, 0xF3, 0x53, 0xA2, 0x02, 0x72, -+0x30, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0xB4, 0xA2, 0x7F, 0x6B, -+0xFF, 0x6C, 0xAC, 0xEB, 0x0D, 0x2B, 0x08, 0xF3, -+0x6A, 0xA2, 0x01, 0x6A, 0x4C, 0xEB, 0x8C, 0xEB, -+0x07, 0x2B, 0x30, 0xF0, 0x21, 0x6B, 0x70, 0xF3, -+0x78, 0xA3, 0x6C, 0xEA, 0x8C, 0xEA, 0x09, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x02, 0x72, 0x13, 0x60, 0x90, 0x67, 0x00, 0x18, -+0x28, 0xCF, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0xE0, 0xF1, 0x7F, 0xA2, 0x09, 0x2B, -+0xC0, 0xF0, 0x79, 0xA2, 0x07, 0x6A, 0x6C, 0xEA, -+0x0E, 0xEA, 0x03, 0x2A, 0x90, 0x67, 0x80, 0x18, -+0x6B, 0x0E, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0x00, 0xF2, 0xA1, 0xA2, 0x01, 0x6C, -+0xFF, 0x6B, 0xAC, 0xEC, 0x39, 0x24, 0xB6, 0x34, -+0x8E, 0xE8, 0x36, 0x28, 0x00, 0xF2, 0xA4, 0xA2, -+0x00, 0xF2, 0xC3, 0xA2, 0x7F, 0x6C, 0x8C, 0xED, -+0x8C, 0xEE, 0x00, 0xF2, 0x84, 0xA2, 0x6C, 0xED, -+0x6C, 0xEE, 0x9E, 0x34, 0x6C, 0xEC, 0x05, 0x2C, -+0xB4, 0x35, 0xD0, 0x4D, 0xFF, 0xF7, 0x1F, 0x6A, -+0x4C, 0xED, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0x00, 0xF2, 0xE2, 0xA2, 0x7F, 0x6B, -+0xEC, 0xEB, 0x40, 0xF2, 0x68, 0xC2, 0x00, 0xF2, -+0x61, 0xA2, 0x01, 0x6F, 0x66, 0x30, 0xEC, 0xE8, -+0x40, 0xF2, 0x09, 0xC2, 0x00, 0xF2, 0x03, 0xA2, -+0x1E, 0x30, 0x40, 0xF2, 0x0C, 0xC2, 0x6A, 0x30, -+0x6E, 0x33, 0xEC, 0xEB, 0xEC, 0xE8, 0x40, 0xF2, -+0x6B, 0xC2, 0x00, 0x6B, 0x40, 0xF2, 0x0A, 0xC2, -+0x40, 0xF2, 0x6D, 0xC2, 0x00, 0x18, 0x75, 0xDF, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF4, 0x40, 0x9A, -+0xFF, 0x69, 0x8C, 0xE9, 0x60, 0xA2, 0x03, 0x6A, -+0x6C, 0xEA, 0x03, 0x72, 0x08, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF4, 0x64, 0x9A, 0x7F, 0x6A, -+0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x00, 0xF2, -+0x8F, 0xA2, 0x10, 0x6B, 0x8C, 0xEB, 0x27, 0x23, -+0x96, 0x33, 0x2E, 0xEB, 0x24, 0x2B, 0x10, 0xF0, -+0x24, 0x6B, 0x7C, 0xF3, 0x84, 0x9B, 0x8F, 0x6B, -+0xA0, 0xA4, 0xAC, 0xEB, 0x60, 0xC4, 0x10, 0xF0, -+0x24, 0x6B, 0x7C, 0xF3, 0x60, 0x9B, 0x60, 0x9B, -+0x20, 0xF2, 0x64, 0xDA, 0x10, 0xF0, 0x24, 0x6B, -+0x5C, 0xF3, 0x7C, 0x9B, 0x60, 0x9B, 0x20, 0xF2, -+0x60, 0xDA, 0x10, 0xF0, 0x24, 0x6B, 0xFC, 0xF2, -+0x78, 0x9B, 0x60, 0x9B, 0x20, 0xF2, 0x6C, 0xDA, -+0x10, 0xF0, 0x24, 0x6B, 0xFB, 0xF6, 0x64, 0x9B, -+0x60, 0x9B, 0x20, 0xF2, 0x68, 0xDA, 0x30, 0xF0, -+0x20, 0x68, 0xEF, 0xF4, 0x08, 0x48, 0x00, 0xF2, -+0x68, 0xA0, 0x01, 0x6A, 0x6C, 0xEA, 0x66, 0x22, -+0x76, 0x32, 0x2E, 0xEA, 0x63, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF6, 0x44, 0x9A, 0x7D, 0x67, -+0x00, 0xF0, 0x1A, 0x04, 0x40, 0x9A, 0x05, 0x05, -+0x04, 0x6E, 0x05, 0xD2, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF2, 0x58, 0x9A, 0x40, 0x9A, 0x04, 0xD2, -+0x2D, 0x6A, 0x58, 0xC3, 0x09, 0x6A, 0x53, 0xCB, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x50, 0x9B, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, -+0x50, 0x9B, 0x04, 0x05, 0x04, 0x6E, 0x00, 0xF0, -+0x1E, 0x04, 0x40, 0xEA, 0x5D, 0x67, 0x20, 0xF0, -+0x22, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x58, 0x9A, 0x06, 0x04, 0x40, 0xEA, 0x00, 0xF2, -+0x8B, 0xA0, 0x00, 0xF2, 0xAB, 0xA0, 0x00, 0xF2, -+0xCA, 0xA0, 0xFF, 0x6B, 0x7F, 0x6A, 0x9E, 0x34, -+0x4C, 0xED, 0x4C, 0xEE, 0x6C, 0xEC, 0x6C, 0xED, -+0x6C, 0xEE, 0x05, 0x2C, 0xB4, 0x35, 0xD0, 0x4D, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xED, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x00, 0xF2, -+0xE9, 0xA2, 0x7F, 0x6B, 0xEC, 0xEB, 0x40, 0xF2, -+0x68, 0xC2, 0x00, 0xF2, 0x68, 0xA2, 0x01, 0x6F, -+0x66, 0x30, 0xEC, 0xE8, 0x40, 0xF2, 0x09, 0xC2, -+0x00, 0xF2, 0x0A, 0xA2, 0x1E, 0x30, 0x40, 0xF2, -+0x0C, 0xC2, 0x6A, 0x30, 0x6E, 0x33, 0xEC, 0xEB, -+0xEC, 0xE8, 0x40, 0xF2, 0x6B, 0xC2, 0x00, 0x6B, -+0x40, 0xF2, 0x0A, 0xC2, 0x40, 0xF2, 0x6D, 0xC2, -+0x00, 0x18, 0x75, 0xDF, 0x0D, 0x97, 0x0C, 0x91, -+0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x8E, 0xD9, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x7A, 0xA0, 0x01, 0x6A, 0xFF, 0x69, -+0x6C, 0xEA, 0x2C, 0xEC, 0x2C, 0xEA, 0x04, 0xD4, -+0x19, 0x22, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x00, 0x6D, 0x68, 0xF3, 0x5A, 0xC0, 0x00, 0x18, -+0x96, 0xE1, 0x68, 0xF3, 0x9A, 0xA0, 0x01, 0x6B, -+0x6C, 0xEA, 0xFA, 0x4B, 0x48, 0x32, 0x8C, 0xEB, -+0x4D, 0xEB, 0x04, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x68, 0xF3, 0x7A, 0xC0, 0x03, 0x22, 0x04, 0x94, -+0x00, 0x18, 0x81, 0xCC, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x7A, 0xA0, 0x02, 0x6A, 0xFF, 0x69, -+0x6C, 0xEA, 0x2C, 0xEC, 0x2C, 0xEA, 0x04, 0xD4, -+0x20, 0x22, 0x03, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x01, 0x6D, 0x68, 0xF3, 0x5A, 0xC0, 0x00, 0x18, -+0x96, 0xE1, 0x68, 0xF3, 0x9A, 0xA0, 0x01, 0x6B, -+0x4C, 0xEB, 0x09, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0x68, 0xF3, 0x94, 0xA0, 0x6C, 0x33, 0x6D, 0xEA, -+0x7F, 0x6B, 0x8C, 0xEB, 0x2C, 0xEB, 0x68, 0xF3, -+0x5A, 0xC0, 0x07, 0x23, 0x08, 0x6B, 0x4C, 0xEB, -+0x2C, 0xEB, 0x03, 0x23, 0x04, 0x94, 0x00, 0x18, -+0x81, 0xCC, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0xA9, 0xF0, 0x68, 0xA0, 0x11, 0x6A, -+0xFF, 0x69, 0x6C, 0xEA, 0x11, 0x72, 0x27, 0x61, -+0xC9, 0xF0, 0x64, 0xA0, 0x02, 0x6A, 0x6C, 0xEA, -+0x2C, 0xEA, 0x21, 0x22, 0x04, 0x94, 0x03, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x01, 0x6D, 0xC9, 0xF0, -+0x44, 0xC0, 0x00, 0x18, 0x96, 0xE1, 0xC9, 0xF0, -+0x84, 0xA0, 0x01, 0x6B, 0x4C, 0xEB, 0x05, 0x6A, -+0x4B, 0xEA, 0x68, 0x33, 0x8C, 0xEA, 0x6D, 0xEA, -+0x04, 0x6B, 0x4C, 0xEB, 0x2C, 0xEB, 0xC9, 0xF0, -+0x44, 0xC0, 0x09, 0x23, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0xE0, 0xF0, 0x62, 0xA2, -+0x01, 0x4B, 0xE0, 0xF0, 0x62, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF6, 0x47, 0xA2, 0x03, 0x2A, -+0x04, 0x94, 0x80, 0x18, 0x94, 0x0D, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x08, 0xF3, -+0x6A, 0xA0, 0x01, 0x6A, 0x6C, 0xEA, 0x25, 0x22, -+0x08, 0xF3, 0x4D, 0xA0, 0x04, 0x72, 0x21, 0x60, -+0x08, 0xF3, 0x4E, 0xA0, 0x02, 0x72, 0x1D, 0x60, -+0x02, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x18, 0x6D, 0xC5, 0x15, 0x10, -+0x00, 0x18, 0xBE, 0xF1, 0x08, 0xF3, 0x4E, 0xA0, -+0x08, 0x72, 0x06, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x0C, 0x6C, 0x06, 0x10, -+0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x04, 0x6C, 0x00, 0x6D, 0xC5, 0x67, -+0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x08, 0xF3, 0x6A, 0xA0, 0x01, 0x6A, -+0x6C, 0xEA, 0x25, 0x22, 0x08, 0xF3, 0x4D, 0xA0, -+0x04, 0x72, 0x21, 0x60, 0x08, 0xF3, 0x4E, 0xA0, -+0x02, 0x72, 0x1D, 0x60, 0x02, 0x6A, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x18, -+0x6D, 0xC5, 0x15, 0x10, 0x00, 0x18, 0xBE, 0xF1, -+0x08, 0xF3, 0x4E, 0xA0, 0x08, 0x72, 0x06, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x0C, 0x6C, 0x06, 0x10, 0x08, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x04, 0x6C, -+0x00, 0x6D, 0xC5, 0x67, 0x40, 0xEA, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x08, 0xF3, -+0x6A, 0xA0, 0x01, 0x6A, 0x6C, 0xEA, 0x25, 0x22, -+0x08, 0xF3, 0x4D, 0xA0, 0x04, 0x72, 0x21, 0x60, -+0x08, 0xF3, 0x4E, 0xA0, 0x02, 0x72, 0x1D, 0x60, -+0x02, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x18, 0x6D, 0xC5, 0x15, 0x10, -+0x00, 0x18, 0xBE, 0xF1, 0x08, 0xF3, 0x4E, 0xA0, -+0x08, 0x72, 0x06, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x0C, 0x6C, 0x06, 0x10, -+0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x04, 0x6C, 0x00, 0x6D, 0xC5, 0x67, -+0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x08, 0xF3, 0x6A, 0xA0, 0x01, 0x6A, -+0x6C, 0xEA, 0x2F, 0x22, 0x08, 0xF3, 0x4D, 0xA0, -+0x04, 0x72, 0x2B, 0x60, 0x08, 0xF3, 0x4E, 0xA0, -+0x02, 0x72, 0x27, 0x60, 0x02, 0x6A, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x18, -+0x6D, 0xC5, 0x1F, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0xA4, 0x67, -+0xC4, 0x67, 0x40, 0xEA, 0x00, 0x18, 0xB6, 0xC4, -+0x08, 0xF3, 0x4E, 0xA0, 0x0C, 0x72, 0x07, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x08, 0x6C, 0x00, 0x6D, 0x08, 0x10, 0x04, 0x72, -+0x08, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x00, 0x6C, 0xA4, 0x67, 0xC5, 0x67, -+0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x08, 0xF3, 0x6A, 0xA0, 0x01, 0x6A, -+0x6C, 0xEA, 0x2F, 0x22, 0x08, 0xF3, 0x4D, 0xA0, -+0x04, 0x72, 0x2B, 0x60, 0x08, 0xF3, 0x4E, 0xA0, -+0x02, 0x72, 0x27, 0x60, 0x02, 0x6A, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x18, -+0x6D, 0xC5, 0x1F, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0xA4, 0x67, -+0xC4, 0x67, 0x40, 0xEA, 0x00, 0x18, 0xB6, 0xC4, -+0x08, 0xF3, 0x4E, 0xA0, 0x0C, 0x72, 0x07, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x08, 0x6C, 0x00, 0x6D, 0x08, 0x10, 0x04, 0x72, -+0x08, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x00, 0x6C, 0xA4, 0x67, 0xC5, 0x67, -+0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x08, 0xF3, 0x6A, 0xA0, 0x01, 0x6A, -+0x6C, 0xEA, 0x2F, 0x22, 0x08, 0xF3, 0x4D, 0xA0, -+0x04, 0x72, 0x2B, 0x60, 0x08, 0xF3, 0x4E, 0xA0, -+0x02, 0x72, 0x27, 0x60, 0x02, 0x6A, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x18, -+0x6D, 0xC5, 0x1F, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0xA4, 0x67, -+0xC4, 0x67, 0x40, 0xEA, 0x00, 0x18, 0xB6, 0xC4, -+0x08, 0xF3, 0x4E, 0xA0, 0x0C, 0x72, 0x07, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x08, 0x6C, 0x00, 0x6D, 0x08, 0x10, 0x04, 0x72, -+0x08, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x00, 0x6C, 0xA4, 0x67, 0xC5, 0x67, -+0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x00, 0x18, 0x97, 0xE7, 0x02, 0x67, -+0x01, 0x6A, 0x0C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x01, 0x6D, 0x02, 0x10, 0x00, 0x6C, 0xA4, 0x67, -+0x00, 0x18, 0xE4, 0xC8, 0x40, 0x6A, 0x0C, 0xEA, -+0x0F, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF4, -+0x48, 0x9A, 0x60, 0xA2, 0x00, 0xF6, 0x60, 0x33, -+0x00, 0xF6, 0x63, 0x33, 0x00, 0x53, 0x00, 0x6B, -+0x02, 0x61, 0x80, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x90, 0xA2, 0x88, 0xF3, 0xB1, 0xA2, -+0x88, 0xF3, 0xD7, 0xA2, 0x02, 0x6F, 0x00, 0x18, -+0x39, 0xC9, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x29, 0xF5, 0x70, 0xA2, -+0x02, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0xF3, 0xE9, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x4C, 0xC1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x74, 0xA0, -+0x7F, 0x6A, 0xFF, 0x69, 0x6C, 0xEA, 0x1E, 0x22, -+0x68, 0xF3, 0x97, 0xA0, 0x96, 0x34, 0x2C, 0xEC, -+0x00, 0x18, 0x2B, 0xE8, 0x02, 0x6B, 0x4C, 0xEB, -+0x2C, 0xEB, 0x07, 0x23, 0x68, 0xF3, 0x97, 0xA0, -+0x96, 0x34, 0x2C, 0xEC, 0x00, 0x18, 0x15, 0xCE, -+0x0D, 0x10, 0x68, 0xF3, 0x97, 0xA0, 0x68, 0xF3, -+0x79, 0xA0, 0x05, 0x6A, 0x4B, 0xEA, 0x96, 0x34, -+0x6C, 0xEA, 0x2C, 0xEC, 0x68, 0xF3, 0x59, 0xC0, -+0x00, 0x18, 0x81, 0xCC, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x94, 0xA2, -+0x7F, 0x6B, 0x8C, 0xEB, 0x07, 0x23, 0x68, 0xF3, -+0x97, 0xA2, 0xFF, 0x6A, 0x96, 0x34, 0x4C, 0xEC, -+0x00, 0x18, 0x73, 0xCE, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0xC5, 0xDF, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0xCF, 0xF6, 0xBD, 0xA3, 0x01, 0x6B, 0xFF, 0x6A, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x02, 0x23, -+0x80, 0x18, 0x0D, 0x08, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x68, 0x8C, 0xE8, 0x00, 0x18, -+0xE7, 0xF1, 0x90, 0x67, 0x00, 0x18, 0x51, 0xCC, -+0x00, 0x6C, 0x00, 0x18, 0x33, 0xCA, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0xE0, 0xF1, -+0x7F, 0xA2, 0x15, 0x2B, 0xC0, 0xF0, 0x79, 0xA2, -+0x07, 0x6A, 0x6C, 0xEA, 0x0E, 0xEA, 0x05, 0x2A, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF3, 0x5C, 0x9A, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF6, -+0x7D, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x90, 0x67, 0x80, 0x18, 0x0D, 0x08, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x69, 0xF2, 0x70, 0xA2, 0x01, 0x6A, 0x4C, 0xEB, -+0x0A, 0x23, 0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF5, -+0x6F, 0xA3, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x02, 0x2A, 0x80, 0x18, 0xD1, 0x0D, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xE2, 0xD3, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xDF, 0xD3, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x7D, 0xDA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xFB, 0xD9, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xBF, 0xED, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF6, 0xBD, 0xA3, -+0x01, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x02, 0x23, 0x80, 0x18, 0x57, 0x08, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x18, 0x6D, 0xE6, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x24, 0x67, 0xC0, 0xF0, -+0x99, 0xA2, 0xFF, 0x6D, 0x07, 0x6B, 0xAC, 0xE9, -+0x8C, 0xEB, 0x2E, 0xEB, 0x12, 0x2B, 0xE0, 0xF0, -+0x86, 0xA2, 0x03, 0x6B, 0x8C, 0xEB, 0xAC, 0xEB, -+0x07, 0x2B, 0xE0, 0xF0, 0xA5, 0xA2, 0x8A, 0x34, -+0x82, 0xED, 0x07, 0x61, 0xE0, 0xF0, 0x65, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF3, 0x40, 0x9A, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x00, 0x18, 0x86, 0xF1, 0x68, 0xF3, -+0x74, 0xA0, 0x7F, 0x6A, 0x6C, 0xEA, 0x32, 0x22, -+0x68, 0xF3, 0x5A, 0xA0, 0x21, 0x6B, 0x6B, 0xEB, -+0x4C, 0xEB, 0x40, 0x6A, 0x6C, 0xEA, 0x68, 0xF3, -+0x7A, 0xC0, 0xFF, 0x6B, 0x6C, 0xEA, 0x10, 0x22, -+0x88, 0xF3, 0x90, 0xA0, 0x88, 0xF3, 0xB1, 0xA0, -+0x88, 0xF3, 0xD7, 0xA0, 0x05, 0x6F, 0x00, 0x18, -+0x39, 0xC9, 0x68, 0xF3, 0x7A, 0xA0, 0x41, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x99, 0xA2, 0x40, 0x6B, 0x8C, 0xEB, -+0x0D, 0x23, 0x68, 0xF3, 0x7A, 0xA2, 0x10, 0x6A, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x06, 0x22, -+0x00, 0x18, 0x90, 0xCA, 0x03, 0x2A, 0x91, 0x67, -+0x00, 0x18, 0x3A, 0xEC, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF3, 0x69, 0xA2, -+0x2E, 0xEB, 0x11, 0x2B, 0x69, 0xF3, 0x68, 0xA2, -+0x1F, 0x6C, 0x6A, 0x32, 0x8C, 0xEA, 0x47, 0xE9, -+0x01, 0x6C, 0x8C, 0xEA, 0x08, 0x22, 0x02, 0x6A, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0xF3, 0xE9, 0x30, 0xF0, -+0x20, 0x68, 0x91, 0x67, 0xEF, 0xF4, 0x08, 0x48, -+0x00, 0x18, 0xF1, 0xCB, 0xE0, 0xF1, 0x5F, 0xA0, -+0x0B, 0x2A, 0x91, 0x67, 0x80, 0x18, 0xA2, 0x0B, -+0xE0, 0xF1, 0x75, 0xA0, 0x01, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x91, 0x67, 0x80, 0x18, 0x57, 0x08, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0x7B, 0xE6, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0x63, 0x01, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF2, 0x7C, 0x9B, 0xFF, 0x6A, 0x4C, 0xEE, -+0x6D, 0xE4, 0x08, 0x68, 0x80, 0xA3, 0xDB, 0xE0, -+0x02, 0x67, 0x4C, 0xED, 0x07, 0xEE, 0xD0, 0x67, -+0x4C, 0xEF, 0x04, 0xED, 0x4C, 0xEC, 0xCC, 0xEF, -+0x0F, 0xE8, 0x8C, 0xE8, 0xE4, 0xED, 0xED, 0xE8, -+0x4C, 0xE8, 0x00, 0xC3, 0x01, 0x90, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF2, 0x5C, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, -+0x8C, 0xEB, 0x4D, 0xE3, 0x40, 0xA3, 0xFF, 0x6C, -+0x8C, 0xEE, 0x08, 0x6B, 0xDB, 0xE3, 0x8C, 0xED, -+0x8C, 0xEA, 0x64, 0x67, 0x47, 0xED, 0x67, 0xEE, -+0x6C, 0xEA, 0x8C, 0xEA, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF6, 0x60, 0x9B, -+0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, 0x69, 0xE2, -+0x00, 0x9A, 0x41, 0x45, 0x25, 0x67, 0x08, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, 0x50, 0x9A, -+0x85, 0x67, 0x2C, 0xE8, 0x40, 0xEA, 0x06, 0xEA, -+0x50, 0x67, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0xF7, 0x1F, 0x68, -+0x41, 0x45, 0x25, 0x67, 0x0C, 0xD6, 0x8C, 0xE8, -+0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0x40, 0x9A, 0x41, 0xE0, 0xC0, 0xD8, 0x1A, 0x10, -+0x01, 0x6D, 0x90, 0x67, 0xAB, 0xED, 0x00, 0x18, -+0xE4, 0xE6, 0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF4, 0x50, 0x9A, 0x91, 0x67, 0x40, 0xEA, -+0x0C, 0x93, 0x64, 0xEA, 0x43, 0x67, 0x04, 0x93, -+0x2C, 0xEA, 0x2F, 0xE9, 0x6C, 0xE9, 0x10, 0xF0, -+0x24, 0x6B, 0xDB, 0xF6, 0x60, 0x9B, 0x2D, 0xEA, -+0x61, 0xE0, 0x40, 0xD8, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x01, 0x74, 0x0D, 0x60, 0x06, 0x24, 0x02, 0x74, -+0x10, 0x60, 0x03, 0x74, 0x00, 0x6A, 0x1C, 0x61, -+0x14, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xA8, 0x35, -+0x1C, 0xF4, 0x4C, 0x9A, 0x0B, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xA8, 0x35, 0x1C, 0xF4, 0x50, 0x9A, -+0x05, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF4, -+0x54, 0x9A, 0xA8, 0x35, 0x55, 0xE5, 0x40, 0x9D, -+0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF4, -+0x58, 0x9A, 0xA8, 0x35, 0x55, 0xE5, 0x40, 0x9D, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x08, 0xF3, 0x00, 0x4A, -+0x88, 0x34, 0x91, 0xE2, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF0, 0x70, 0x9A, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF5, 0xA0, 0x35, 0xCC, 0xEB, 0x10, 0xF0, -+0x24, 0x6E, 0x1C, 0xF2, 0xD0, 0x9E, 0xCE, 0xF4, -+0x50, 0x9A, 0x80, 0xAC, 0xAD, 0xEB, 0x01, 0x6D, -+0xAB, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6B, 0x8C, 0xEB, -+0xFF, 0xF7, 0x1F, 0x6A, 0x81, 0x46, 0x06, 0x67, -+0xAC, 0xEA, 0x06, 0x2C, 0x83, 0x67, 0xA2, 0x67, -+0x00, 0x18, 0x0C, 0xE7, 0x02, 0x67, 0x0D, 0x10, -+0x83, 0x67, 0xA2, 0x67, 0x00, 0x18, 0x0C, 0xE7, -+0x22, 0x67, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, -+0x50, 0x9A, 0x90, 0x67, 0x2C, 0xE8, 0x40, 0xEA, -+0x06, 0xEA, 0x50, 0x67, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x46, 0x67, 0xFF, 0x68, 0xFF, 0xF7, 0x1F, 0x69, -+0x01, 0x4A, 0x0C, 0xD6, 0x0D, 0xD7, 0x8C, 0xE8, -+0xAC, 0xE9, 0x04, 0x2A, 0x90, 0x67, 0xB1, 0x67, -+0xC7, 0x67, 0x15, 0x10, 0xB1, 0x67, 0x90, 0x67, -+0x00, 0x18, 0x0C, 0xE7, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x0C, 0x94, 0xAE, 0xF4, 0x50, 0x9A, -+0x40, 0xEA, 0x0D, 0x96, 0x90, 0x67, 0xB1, 0x67, -+0xC4, 0xEA, 0x0C, 0x92, 0x4C, 0xEE, 0x4F, 0xEB, -+0x04, 0x92, 0x4C, 0xEB, 0x6D, 0xEE, 0x00, 0x18, -+0x1F, 0xE7, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x0E, 0x91, 0x04, 0xD2, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xED, 0x4C, 0xE9, -+0x0C, 0xD6, 0x0D, 0xD7, 0x0F, 0x90, 0x05, 0xD5, -+0x00, 0x6A, 0x08, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, -+0x40, 0xA8, 0x01, 0x4A, 0x40, 0xC8, 0x10, 0xF0, -+0x24, 0x6A, 0x04, 0x94, 0x05, 0x95, 0xBC, 0xF0, -+0xD0, 0x9A, 0x00, 0x18, 0x2F, 0xE7, 0x0C, 0x93, -+0x6C, 0xEA, 0x0D, 0x93, 0x6E, 0xEA, 0x03, 0x22, -+0x40, 0xA8, 0x23, 0xEA, 0xE7, 0x61, 0x40, 0xA8, -+0x09, 0x97, 0x07, 0x90, 0x23, 0xEA, 0x08, 0x91, -+0x58, 0x67, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, -+0x24, 0x6A, 0xD3, 0xF5, 0x19, 0x4A, 0x40, 0xDB, -+0x00, 0x68, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF4, -+0x5C, 0x9A, 0x40, 0xA2, 0x12, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF4, 0x40, 0x9A, 0x40, 0xA2, -+0x0C, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF4, -+0x44, 0x9A, 0x40, 0xA2, 0x06, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF4, 0x48, 0x9A, 0x40, 0xA2, -+0x18, 0x22, 0xE0, 0xF3, 0x09, 0x70, 0x0A, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x6C, 0x9A, -+0x20, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x00, 0x6A, 0x0C, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x32, 0x6C, 0x01, 0x48, -+0x40, 0xEA, 0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xE8, -+0xD0, 0x17, 0x01, 0x6A, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, 0x24, 0x6A, -+0x53, 0xF6, 0x1D, 0x4A, 0x40, 0xDB, 0x00, 0x6B, -+0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF4, 0xAC, 0x9A, -+0xFF, 0x6C, 0x40, 0xA5, 0xA0, 0xA5, 0x8C, 0xEA, -+0xAC, 0xEC, 0x4E, 0xEC, 0x10, 0x24, 0x64, 0x73, -+0x09, 0x61, 0x10, 0xF0, 0x24, 0x6B, 0x3B, 0xF7, -+0x8C, 0x9B, 0x40, 0x6D, 0x60, 0x9C, 0xAD, 0xEB, -+0x60, 0xDC, 0x20, 0xE8, 0x01, 0x4B, 0xFF, 0xF7, -+0x1F, 0x6A, 0x4C, 0xEB, 0xE5, 0x17, 0x20, 0xE8, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, 0x6C, 0x9B, -+0x10, 0xF0, 0x24, 0x6A, 0xFF, 0x69, 0xB3, 0xF6, -+0x09, 0x4A, 0x8C, 0xE9, 0x40, 0xDB, 0x00, 0x68, -+0x20, 0x10, 0x82, 0xF3, 0x08, 0x70, 0x09, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x6C, 0x9A, -+0x10, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x1F, 0x10, 0xFF, 0xF7, 0x1F, 0x6A, 0x01, 0x48, -+0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x14, 0x6C, 0x40, 0xEA, 0x33, 0x58, -+0x08, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF3, -+0x58, 0x9A, 0x01, 0x6B, 0x40, 0xA2, 0x6C, 0xEA, -+0x0B, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF4, -+0x50, 0x9A, 0x01, 0x6B, 0x40, 0x9A, 0x42, 0x32, -+0x5E, 0x32, 0x6C, 0xEA, 0x2E, 0xEA, 0xD5, 0x2A, -+0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF6, 0x6C, 0x9B, -+0x10, 0xF0, 0x24, 0x6A, 0xB3, 0xF6, 0x0A, 0x4A, -+0x40, 0xDB, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, 0x24, 0x6A, -+0x33, 0xF7, 0x1D, 0x4A, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF4, 0x54, 0x9A, 0x60, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0xF8, 0x2A, 0x10, 0xF0, -+0x24, 0x6B, 0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, -+0x24, 0x6A, 0x33, 0xF7, 0x1E, 0x4A, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, 0x80, 0x6B, -+0x6B, 0xEB, 0x8D, 0xEB, 0x68, 0xF3, 0x79, 0xC2, -+0x88, 0xF3, 0x68, 0xAA, 0x10, 0xF0, 0x24, 0x6A, -+0x3C, 0xF4, 0x58, 0x9A, 0xFF, 0x68, 0x10, 0x6C, -+0x60, 0xCA, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF0, -+0x70, 0x9A, 0x40, 0xA3, 0x0C, 0xEA, 0x8D, 0xEA, -+0x0C, 0xEA, 0x40, 0xC3, 0x01, 0x6C, 0x00, 0x18, -+0xAA, 0xE7, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF3, -+0x5C, 0x9A, 0x00, 0x6B, 0x01, 0x6C, 0x60, 0xDA, -+0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF4, 0x74, 0x9A, -+0x40, 0xA3, 0x0C, 0xEA, 0x8D, 0xEA, 0x0C, 0xEA, -+0x40, 0xC3, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xCF, 0xE7, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF0, 0x70, 0x9A, -+0xEF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x00, 0x6C, 0x00, 0x18, 0xAA, 0xE7, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, -+0x24, 0x6B, 0x8E, 0x9A, 0xBC, 0xF3, 0x7C, 0x9B, -+0x80, 0xDB, 0x68, 0xF3, 0x99, 0xA2, 0x7F, 0x6B, -+0x8C, 0xEB, 0x68, 0xF3, 0x79, 0xC2, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFF, 0x6A, 0x4C, 0xEC, -+0x94, 0x34, 0x4C, 0xED, 0x4C, 0xEC, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF4, 0x5C, 0x9A, 0x80, 0xC2, -+0xA0, 0xC2, 0x20, 0xE8, 0xFF, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0x3C, 0xF4, 0x7C, 0x9B, 0x4C, 0xEC, -+0x94, 0x34, 0x4C, 0xEC, 0x80, 0xC3, 0x60, 0xA3, -+0x6C, 0xEA, 0x20, 0xE8, 0xFF, 0x6A, 0x4C, 0xED, -+0xFF, 0x75, 0x4C, 0xEC, 0xCC, 0xEA, 0x06, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x71, 0xE4, 0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x71, 0xE4, 0x2C, 0xF7, -+0x6E, 0xA4, 0xAC, 0xEA, 0xAF, 0xED, 0x6C, 0xED, -+0xAD, 0xEA, 0x2C, 0xF7, 0x4E, 0xC4, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x6B, -+0x6C, 0xEC, 0x07, 0x6A, 0x6C, 0xED, 0x8C, 0xEA, -+0x01, 0x68, 0xE6, 0x67, 0x04, 0xEA, 0xAB, 0xEE, -+0x30, 0xF0, 0x20, 0x6A, 0xAD, 0xEE, 0xCE, 0xF2, -+0x44, 0x9A, 0x6C, 0xE8, 0xC0, 0xF7, 0xC3, 0x36, -+0x8E, 0x34, 0x6C, 0xEF, 0xB0, 0x67, 0x0C, 0xEE, -+0x6C, 0xEC, 0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFF, 0x6A, 0x4C, 0xEC, -+0xFF, 0x74, 0xAC, 0xEA, 0x05, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0x0D, 0xF1, 0x47, 0xC3, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x2C, 0xF7, 0xBF, 0xA3, 0x8C, 0xEA, 0x8F, 0xEC, -+0xAC, 0xEC, 0x8D, 0xEA, 0x2C, 0xF7, 0x5F, 0xC3, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x06, 0x67, 0x4C, 0xE8, -+0x53, 0x70, 0x4C, 0xEC, 0x4C, 0xED, 0x0A, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x2C, 0xF7, 0x9F, 0xA3, 0x2C, 0xF7, 0x7E, 0xA3, -+0x8D, 0xEB, 0x06, 0x10, 0x0C, 0x2C, 0x30, 0xF0, -+0x20, 0x6B, 0x0D, 0xF1, 0x66, 0xA3, 0xAD, 0xEB, -+0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x5C, 0x9A, 0x60, 0xC2, 0x2C, 0x10, 0x47, 0x70, -+0x12, 0x60, 0x48, 0x58, 0x06, 0x60, 0x17, 0x70, -+0x0E, 0x60, 0x44, 0x70, 0x0C, 0x60, 0x01, 0x70, -+0x09, 0x10, 0x4C, 0x70, 0x08, 0x60, 0x4D, 0x58, -+0x02, 0x60, 0x49, 0x70, 0x03, 0x10, 0x4E, 0x70, -+0x02, 0x60, 0x51, 0x70, 0x06, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x0D, 0xF1, 0x46, 0xA2, 0xAD, 0xEA, -+0x0D, 0x10, 0x00, 0x18, 0x4D, 0xE8, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x2C, 0xF7, -+0x7F, 0xA2, 0x2C, 0xF7, 0x5E, 0xA2, 0x6D, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x3B, 0xF7, 0x7C, 0x9B, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xE8, 0xF2, 0x1A, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x5C, 0xF4, 0x40, 0x9A, 0x00, 0xC2, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFF, 0x63, 0x01, 0xD1, 0x00, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0xFF, 0x6A, -+0x25, 0x67, 0xA9, 0xF0, 0xA8, 0xA0, 0x08, 0xF3, -+0x10, 0xA0, 0x4C, 0xEF, 0x1F, 0x65, 0x01, 0x6F, -+0xEC, 0xED, 0x0C, 0xEF, 0x4C, 0xE9, 0x4C, 0xEE, -+0x4C, 0xED, 0x4C, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0xFB, 0xF7, 0x44, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, -+0x6C, 0xEC, 0x00, 0xAA, 0xE1, 0xF7, 0x1F, 0x6A, -+0x0C, 0xEA, 0x10, 0xF0, 0x24, 0x68, 0xFB, 0xF7, -+0x00, 0x98, 0x51, 0xE4, 0x6C, 0xEC, 0x80, 0xC8, -+0x9C, 0x32, 0x10, 0xF0, 0x24, 0x6C, 0x5C, 0xF4, -+0x84, 0x9C, 0x10, 0xF0, 0x24, 0x68, 0x5C, 0xF4, -+0x08, 0x98, 0x91, 0xE2, 0x80, 0xAC, 0x01, 0xE2, -+0x00, 0x98, 0x6C, 0xEC, 0x05, 0x21, 0x10, 0xF0, -+0x00, 0x69, 0x2B, 0xE9, 0x2D, 0xEC, 0x6C, 0xEC, -+0xD8, 0xF0, 0x00, 0x6B, 0x8C, 0xEB, 0x10, 0xF0, -+0x24, 0x6C, 0x5C, 0xF4, 0x84, 0x9C, 0x91, 0xE2, -+0x60, 0xCC, 0x10, 0xF0, 0x24, 0x6B, 0x5C, 0xF4, -+0x6C, 0x9B, 0x6D, 0xE2, 0x80, 0xA3, 0x01, 0x6B, -+0x8C, 0xEB, 0x05, 0x23, 0x03, 0xF7, 0x01, 0x6B, -+0x6B, 0xEB, 0x0C, 0xEB, 0x07, 0x10, 0x1F, 0xF7, -+0x01, 0x6B, 0x6B, 0xEB, 0x0C, 0xEB, 0x18, 0x67, -+0x00, 0x34, 0x8D, 0xEB, 0xFF, 0x76, 0x13, 0x60, -+0x10, 0xF0, 0x24, 0x6C, 0x5C, 0xF4, 0x90, 0x9C, -+0x80, 0xF4, 0xC0, 0x36, 0x6C, 0xEC, 0x10, 0xF0, -+0x24, 0x6B, 0x5B, 0xF7, 0x64, 0x9B, 0x6D, 0xEE, -+0x10, 0xF0, 0x24, 0x6B, 0x5C, 0xF4, 0x68, 0x9B, -+0x8D, 0xEE, 0x6D, 0xE2, 0xC0, 0xDB, 0x01, 0x2F, -+0x15, 0x25, 0x10, 0xF0, 0x24, 0x6B, 0x5C, 0xF4, -+0x94, 0x9B, 0xFF, 0x6D, 0x80, 0x6E, 0x91, 0xE2, -+0x60, 0xA4, 0xCB, 0xEE, 0xAC, 0xEB, 0xCD, 0xEB, -+0xAC, 0xEB, 0x60, 0xC4, 0x10, 0xF0, 0x24, 0x6B, -+0x5C, 0xF4, 0x78, 0x9B, 0x00, 0x6C, 0x80, 0xC3, -+0x00, 0x6C, 0x11, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x5C, 0xF4, 0x94, 0x9B, 0x7F, 0x6B, 0x91, 0xE2, -+0xA0, 0xA4, 0xAC, 0xEB, 0x60, 0xC4, 0x10, 0xF0, -+0x24, 0x6B, 0x5C, 0xF4, 0x78, 0x9B, 0x1C, 0x6C, -+0x80, 0xC3, 0x08, 0xF4, 0x13, 0x6C, 0x10, 0xF0, -+0x24, 0x6B, 0x5C, 0xF4, 0x7C, 0x9B, 0x80, 0xCB, -+0x10, 0xF0, 0x24, 0x6B, 0xDB, 0xF7, 0x8C, 0x9B, -+0xF7, 0x6B, 0x91, 0xE2, 0xA0, 0xA4, 0xAC, 0xEB, -+0x60, 0xC4, 0x01, 0x91, 0x00, 0x90, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x10, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0x29, 0xF5, 0x51, 0xA2, 0xFF, 0x63, 0x05, 0x5A, -+0x36, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, -+0x3B, 0xF6, 0x00, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, -+0x00, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0x44, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, 0x40, 0x9A, -+0x1A, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0x44, 0x9A, 0x09, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x7C, 0xF4, 0x40, 0x9A, 0x0D, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF4, 0x40, 0x9A, 0x40, 0x9A, -+0x50, 0x32, 0x00, 0xF5, 0x42, 0x32, 0x08, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF4, 0x44, 0x9A, -+0x40, 0x9A, 0xE1, 0xF7, 0x1F, 0x6B, 0x6C, 0xEA, -+0x00, 0xD2, 0x00, 0x93, 0xE0, 0xF3, 0x08, 0x6A, -+0x60, 0x33, 0x68, 0x33, 0x5B, 0xEB, 0x01, 0x2A, -+0xE5, 0xE8, 0x12, 0xEA, 0x01, 0x10, 0x66, 0x6A, -+0x00, 0xD2, 0x00, 0x92, 0x01, 0x63, 0x20, 0xE8, -+0xFF, 0x63, 0x01, 0xD0, 0x0C, 0x2C, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x6C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x7C, 0xF4, 0x88, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x58, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF5, 0xD8, 0x9A, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF5, 0x14, 0x4A, 0x00, 0x6D, -+0x18, 0x6F, 0xF8, 0xED, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0x08, 0x4B, 0x12, 0xEF, 0x6D, 0xE7, -+0x00, 0xF1, 0x00, 0xA3, 0x01, 0x6F, 0xEC, 0xE8, -+0x23, 0x20, 0x00, 0xF1, 0x60, 0xA3, 0x66, 0x33, -+0xEC, 0xEB, 0xFF, 0x6F, 0xEC, 0xEB, 0x1C, 0x23, -+0xFF, 0xF7, 0x78, 0x9A, 0x9B, 0xEB, 0x01, 0x2C, -+0xE5, 0xE8, 0x12, 0xEB, 0xFF, 0xF7, 0x7C, 0xDA, -+0x10, 0xEF, 0x03, 0x27, 0x01, 0x4B, 0xFF, 0xF7, -+0x7C, 0xDA, 0x60, 0x9A, 0x78, 0xEE, 0x12, 0xEB, -+0x9B, 0xEB, 0x01, 0x2C, 0xE5, 0xE8, 0x12, 0xEB, -+0x60, 0xDA, 0xFF, 0xF7, 0x7C, 0x9A, 0x04, 0x2B, -+0x01, 0x6F, 0xFF, 0xF7, 0xFC, 0xDA, 0x60, 0xDA, -+0x01, 0x4D, 0x0A, 0x75, 0x18, 0x4A, 0xCC, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0xE0, 0xF0, 0x74, 0x9A, 0xE0, 0xF0, 0x90, 0xDA, -+0x7B, 0xEC, 0x01, 0x2B, 0xE5, 0xE8, 0x12, 0xEB, -+0xE0, 0xF0, 0x78, 0xDA, 0x78, 0x67, 0xE0, 0xF0, -+0x7C, 0xDA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, -+0x8D, 0xEB, 0x69, 0xF3, 0x68, 0xC2, 0x01, 0x90, -+0x01, 0x63, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x69, 0xF3, 0x48, 0xA0, -+0x03, 0x6B, 0x4C, 0xEB, 0x00, 0x6A, 0x33, 0x2B, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF4, 0x4C, 0x9A, -+0x30, 0xF0, 0x20, 0x69, 0x30, 0xF0, 0x20, 0x6C, -+0x60, 0xC2, 0x4E, 0xF2, 0x4C, 0x99, 0x29, 0xF5, -+0x10, 0x4C, 0x00, 0x6D, 0xD4, 0x6E, 0x40, 0xEA, -+0x4E, 0xF2, 0x4C, 0x99, 0x30, 0xF0, 0x20, 0x6C, -+0xFF, 0x6E, 0xCF, 0xF5, 0x18, 0x4C, 0x00, 0x6D, -+0x01, 0x4E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x01, 0x6B, 0x66, 0x6C, -+0xE0, 0xF0, 0x74, 0xDA, 0xE0, 0xF0, 0x90, 0xDA, -+0xE0, 0xF0, 0x98, 0xDA, 0x01, 0x6A, 0x4B, 0xEA, -+0x69, 0xF3, 0x88, 0xA0, 0x69, 0xF3, 0x49, 0xC0, -+0x7D, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, 0x6D, 0xEA, -+0x69, 0xF3, 0x48, 0xC0, 0x43, 0x67, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x69, 0xF3, -+0x88, 0xA0, 0x01, 0x6B, 0x00, 0x6A, 0x8C, 0xEB, -+0x24, 0x23, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF4, -+0x4C, 0x9A, 0x00, 0x6B, 0x60, 0xC2, 0x03, 0x6A, -+0x4B, 0xEA, 0x8C, 0xEA, 0x69, 0xF3, 0x48, 0xC0, -+0x00, 0x18, 0xE1, 0xE8, 0x04, 0xD2, 0x04, 0x94, -+0x00, 0x18, 0x02, 0xE9, 0x69, 0xF3, 0x68, 0xA0, -+0x02, 0x6A, 0x42, 0xF1, 0x1C, 0x6C, 0x6D, 0xEA, -+0x69, 0xF3, 0x48, 0xC0, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, -+0xCF, 0xF5, 0xDC, 0x9B, 0x01, 0x6D, 0x40, 0xEA, -+0x01, 0x6A, 0x07, 0x97, 0x06, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x69, 0xF3, 0xA8, 0xA3, -+0x02, 0x6C, 0x00, 0x6A, 0xAC, 0xEC, 0x0C, 0x24, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF4, 0x4C, 0x9A, -+0x00, 0x6C, 0x80, 0xC2, 0x03, 0x6A, 0x4B, 0xEA, -+0xAC, 0xEA, 0x69, 0xF3, 0x48, 0xC3, 0x01, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0x00, 0x6A, 0x18, 0x6C, -+0x98, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, -+0x08, 0x4B, 0x01, 0x4A, 0x0A, 0x72, 0x12, 0xEC, -+0x71, 0xE4, 0x00, 0xF1, 0xA0, 0xA4, 0x02, 0x6B, -+0x6B, 0xEB, 0xAC, 0xEB, 0x00, 0xF1, 0x60, 0xC4, -+0xEE, 0x61, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0x29, 0xF5, 0x50, 0xA2, 0x01, 0x6B, 0x4C, 0xEB, -+0x00, 0x6A, 0x1C, 0x23, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF5, 0x18, 0x4A, 0x00, 0x6B, 0xA0, 0x9A, -+0x8E, 0xED, 0x0F, 0x2D, 0x18, 0x6E, 0xD8, 0xEB, -+0x30, 0xF0, 0x20, 0x6D, 0xEF, 0xF4, 0x08, 0x4D, -+0x12, 0xEE, 0xB9, 0xE6, 0x00, 0xF1, 0xE0, 0xA6, -+0x02, 0x6D, 0xAB, 0xED, 0xEC, 0xED, 0x00, 0xF1, -+0xA0, 0xC6, 0x01, 0x4B, 0x0A, 0x73, 0x18, 0x4A, -+0xEA, 0x61, 0x01, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x5D, 0x67, 0x20, 0xF0, 0x78, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0x0A, 0xD4, 0x29, 0xF5, 0x90, 0xA2, -+0x01, 0x6A, 0x00, 0xF6, 0xE0, 0x31, 0x8C, 0xEA, -+0x0B, 0xD5, 0x0C, 0xD6, 0x00, 0xF6, 0x23, 0x31, -+0x80, 0xF0, 0x0E, 0x22, 0x24, 0x23, 0x01, 0x73, -+0x80, 0xF0, 0x0A, 0x61, 0x0A, 0x93, 0x80, 0xF0, -+0x07, 0x23, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF4, -+0x50, 0x9A, 0xC3, 0xEA, 0x80, 0xF0, 0x00, 0x61, -+0x7F, 0x71, 0x7E, 0x60, 0xFF, 0xF7, 0x1F, 0x51, -+0x7B, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF5, -+0x18, 0x9A, 0x1B, 0xEE, 0x01, 0x28, 0xE5, 0xE8, -+0x10, 0xEA, 0x12, 0xE8, 0x02, 0x22, 0x01, 0x48, -+0x04, 0x10, 0x03, 0x28, 0x01, 0x68, 0x50, 0x67, -+0x1F, 0x10, 0x01, 0x6B, 0x20, 0x10, 0x0A, 0x95, -+0x67, 0x25, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF4, -+0x50, 0x9A, 0x0C, 0x96, 0xC3, 0xEA, 0x60, 0x61, -+0x7F, 0x71, 0x5E, 0x60, 0xFF, 0xF7, 0x1F, 0x51, -+0x5B, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF5, -+0x1C, 0x9A, 0x1B, 0xEE, 0x01, 0x28, 0xE5, 0xE8, -+0x10, 0xEA, 0x12, 0xE8, 0x02, 0x22, 0x01, 0x48, -+0x05, 0x10, 0x04, 0x28, 0x01, 0x68, 0x00, 0x6A, -+0x04, 0xD2, 0x02, 0x10, 0x00, 0x6B, 0x04, 0xD3, -+0x0A, 0x94, 0x00, 0x18, 0x8B, 0xE9, 0x00, 0x6C, -+0xFF, 0x6E, 0xA4, 0x67, 0xCC, 0xED, 0x1D, 0x65, -+0x18, 0x6D, 0xB8, 0xEC, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0x08, 0x4B, 0x01, 0x6D, 0x12, 0xEA, -+0x69, 0xE2, 0x00, 0xF1, 0x40, 0xA2, 0xAC, 0xEA, -+0xCC, 0xEA, 0x2F, 0x2A, 0xD8, 0x67, 0x18, 0x6F, -+0xF8, 0xEE, 0x04, 0x96, 0xC4, 0x36, 0x04, 0xD6, -+0x03, 0x6E, 0xCB, 0xEE, 0x12, 0xEC, 0x71, 0xE4, -+0x00, 0xF1, 0xE0, 0xA4, 0xEC, 0xEE, 0x04, 0x97, -+0xED, 0xEE, 0x00, 0xF1, 0xC0, 0xC4, 0x0A, 0x96, -+0x00, 0xF1, 0xD0, 0xDC, 0x0B, 0x97, 0x00, 0xF1, -+0xF4, 0xDC, 0x0C, 0x96, 0x18, 0x6F, 0x00, 0xF1, -+0xC4, 0xDC, 0xD8, 0x67, 0x01, 0x4E, 0xF8, 0xEE, -+0x12, 0xEE, 0xCD, 0xE3, 0xE0, 0xF0, 0x54, 0xDB, -+0xE0, 0xF0, 0x10, 0xDB, 0x00, 0xF1, 0x42, 0xC4, -+0x00, 0xF1, 0x40, 0xA4, 0x00, 0xF1, 0x23, 0xC4, -+0x4D, 0xED, 0x00, 0xF1, 0xA0, 0xC4, 0x01, 0x6A, -+0x04, 0x10, 0x01, 0x4C, 0x0A, 0x74, 0xBC, 0x61, -+0x00, 0x6A, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x06, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF5, 0x14, 0x4A, 0x00, 0x6C, -+0x4F, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF5, -+0x14, 0x4A, 0x00, 0x6B, 0x18, 0x6D, 0xB8, 0xEB, -+0x30, 0xF0, 0x20, 0x6C, 0xEF, 0xF4, 0x08, 0x4C, -+0x12, 0xED, 0x91, 0xE5, 0x00, 0xF1, 0xC0, 0xA4, -+0x01, 0x6D, 0xAC, 0xEE, 0x08, 0x26, 0x00, 0xF1, -+0x80, 0xA4, 0x86, 0x34, 0xAC, 0xEC, 0x03, 0x24, -+0x80, 0x9A, 0x01, 0x4C, 0x80, 0xDA, 0x01, 0x4B, -+0x0A, 0x73, 0x18, 0x4A, 0xE7, 0x61, 0x00, 0x18, -+0xE1, 0xE8, 0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x94, 0xA2, -+0x7F, 0x6B, 0x8C, 0xEB, 0x1A, 0x23, 0x68, 0xF3, -+0x77, 0xA2, 0x69, 0xF3, 0x89, 0xA2, 0x76, 0x33, -+0x8E, 0xEB, 0x13, 0x2B, 0x68, 0xF3, 0x95, 0xA2, -+0x0F, 0x6B, 0x8C, 0xEB, 0xFF, 0x6C, 0x8C, 0xEB, -+0x0C, 0x23, 0x88, 0xF3, 0x82, 0xA2, 0x04, 0x93, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF5, 0x58, 0x9A, -+0x78, 0xEC, 0x12, 0xEC, 0x8E, 0xEA, 0x09, 0x2A, -+0x5B, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x04, 0x93, -+0xCF, 0xF5, 0x58, 0x9A, 0x6E, 0xEA, 0x54, 0x22, -+0x04, 0x94, 0x00, 0x18, 0x02, 0xE9, 0x50, 0x10, -+0x18, 0x6D, 0xB8, 0xEC, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0x08, 0x4B, 0x12, 0xED, 0x6D, 0xE5, -+0x00, 0xF1, 0xC0, 0xA3, 0x01, 0x6D, 0xAC, 0xEE, -+0x0A, 0x26, 0x00, 0xF1, 0x60, 0xA3, 0x66, 0x33, -+0xAC, 0xEB, 0xFF, 0x6D, 0xAC, 0xEB, 0x03, 0x2B, -+0x60, 0x9A, 0x01, 0x4B, 0x60, 0xDA, 0x01, 0x4C, -+0x0A, 0x74, 0x18, 0x4A, 0xE5, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x29, 0xF5, 0x51, 0xA2, 0xFF, 0x72, -+0x2F, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0xE0, 0xF0, 0x7C, 0x9A, 0x01, 0x4B, -+0xE0, 0xF0, 0x7C, 0xDA, 0x7C, 0x4A, 0x5F, 0x9A, -+0x4E, 0xEB, 0x22, 0x2B, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF5, 0x14, 0x4A, 0x18, 0x6D, 0xB8, 0xEB, -+0x30, 0xF0, 0x20, 0x6C, 0xEF, 0xF4, 0x08, 0x4C, -+0x12, 0xED, 0x91, 0xE5, 0x00, 0xF1, 0xC0, 0xA4, -+0x01, 0x6D, 0xAC, 0xEE, 0x08, 0x26, 0x00, 0xF1, -+0x80, 0xA4, 0x86, 0x34, 0xAC, 0xEC, 0x03, 0x24, -+0x80, 0x9A, 0x01, 0x4C, 0x80, 0xDA, 0x01, 0x4B, -+0x0A, 0x73, 0x18, 0x4A, 0xE7, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x78, 0x67, 0xEF, 0xF5, 0x64, 0xDA, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x02, 0xF0, 0x00, 0x6C, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x07, 0x97, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x10, 0xF0, 0x24, 0x6A, -+0x35, 0xF1, 0x1D, 0x4A, 0x30, 0xF0, 0x20, 0x68, -+0x40, 0xDB, 0xEF, 0xF5, 0x0A, 0x48, 0x00, 0x69, -+0x18, 0x6A, 0x58, 0xE9, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0x08, 0x4B, 0x12, 0xEA, 0x69, 0xE2, -+0x00, 0xF1, 0x80, 0xA2, 0x01, 0x6B, 0x8C, 0xEB, -+0x27, 0x23, 0x00, 0xF0, 0x8A, 0x98, 0x00, 0xF0, -+0x66, 0x98, 0x63, 0xEC, 0x21, 0x61, 0x61, 0x80, -+0x81, 0x43, 0x04, 0xD4, 0x07, 0x2C, 0x00, 0xF0, -+0x4E, 0x98, 0x00, 0xF0, 0x92, 0x98, 0x40, 0xEA, -+0x04, 0x92, 0x14, 0x10, 0x80, 0xA0, 0x01, 0x4C, -+0x80, 0xC0, 0x80, 0xA0, 0x82, 0xEB, 0x08, 0x60, -+0x00, 0xF1, 0x80, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x00, 0xF1, 0x60, 0xC2, 0x08, 0x10, -+0x00, 0xF0, 0x4E, 0x98, 0x00, 0xF0, 0x92, 0x98, -+0x40, 0xEA, 0x00, 0x6A, 0x00, 0xF0, 0x4A, 0xD8, -+0x01, 0x49, 0x0A, 0x71, 0x18, 0x48, 0xC8, 0x61, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xE0, 0x63, 0x3F, 0x62, -+0xFF, 0xF7, 0x1F, 0x6A, 0xAC, 0xEA, 0xBD, 0x67, -+0x56, 0xC5, 0x01, 0x6B, 0x42, 0x32, 0x57, 0xC5, -+0x6B, 0xEB, 0x30, 0xF0, 0x20, 0x6A, 0x70, 0xC5, -+0xAE, 0xF2, 0x5C, 0x9A, 0x03, 0x6B, 0x72, 0xC5, -+0x04, 0x6B, 0x94, 0xC5, 0x73, 0xC5, 0x04, 0x04, -+0x40, 0xEA, 0x3F, 0x97, 0x20, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0xA7, 0x44, 0x30, 0xF0, -+0x20, 0x6C, 0x01, 0x4D, 0xAC, 0xF0, 0x08, 0x4C, -+0x14, 0x6E, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x24, 0x67, 0x00, 0x18, -+0x84, 0xEA, 0x47, 0xA1, 0x66, 0xA1, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x40, 0x32, -+0xEB, 0xF6, 0x80, 0xA0, 0x69, 0xE2, 0x01, 0x69, -+0xEB, 0xF6, 0x52, 0xC8, 0x51, 0x67, 0x8C, 0xEA, -+0xFF, 0x6B, 0x1C, 0x2A, 0xEB, 0xF6, 0xB4, 0xA0, -+0xFE, 0x4A, 0xAC, 0xEA, 0xEB, 0xF6, 0x54, 0xC0, -+0x02, 0x6A, 0x8C, 0xEA, 0x6C, 0xEA, 0x51, 0x22, -+0xEB, 0xF6, 0x43, 0xA0, 0x0F, 0x6D, 0xEB, 0xF6, -+0x84, 0xA0, 0x4C, 0xED, 0x52, 0x36, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, 0x6C, 0xED, -+0x6C, 0xEE, 0x40, 0xEA, 0x01, 0x72, 0x0D, 0x6A, -+0x41, 0x61, 0x3F, 0x10, 0xEB, 0xF6, 0x74, 0xA0, -+0xEB, 0xF6, 0xF0, 0xA8, 0x02, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x00, 0xF1, 0x01, 0x5F, 0xEB, 0xF6, -+0x54, 0xC0, 0x0C, 0x6A, 0x33, 0x60, 0x00, 0x6A, -+0xEB, 0xF6, 0x55, 0xC0, 0xEB, 0xF6, 0x56, 0xC0, -+0x00, 0x6A, 0xEB, 0xF6, 0x58, 0xC8, 0xEB, 0xF6, -+0x5A, 0xC8, 0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF7, -+0x44, 0x9A, 0xEB, 0xF6, 0xC1, 0xA0, 0x10, 0xF0, -+0x24, 0x6D, 0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x6A, -+0x7C, 0xF4, 0xB4, 0x9D, 0x6C, 0xEA, 0xD9, 0xE2, -+0xDC, 0x36, 0x00, 0x6A, 0xB5, 0xE6, 0x10, 0xF0, -+0x24, 0x6E, 0x04, 0xD2, 0x05, 0xD2, 0x3C, 0xF0, -+0xD4, 0x9E, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xAE, 0xF2, 0x40, 0x9A, 0xCC, 0xF0, -+0x0E, 0x4B, 0x00, 0x6C, 0xD9, 0xE3, 0x40, 0xEA, -+0xEB, 0xF6, 0x54, 0xA0, 0x4D, 0xE9, 0xEB, 0xF6, -+0x34, 0xC0, 0x00, 0x6A, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0xEB, 0xF6, -+0xB8, 0xA8, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x4E, 0xF2, 0x50, 0x9A, 0xCC, 0xF0, -+0x0E, 0x4B, 0x30, 0xF0, 0x20, 0x6C, 0xB5, 0xE3, -+0xCC, 0xF0, 0x08, 0x4C, 0x04, 0x6E, 0x40, 0xEA, -+0x0B, 0xF7, 0x63, 0xA0, 0x80, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x05, 0x2A, -+0xEB, 0xF6, 0x58, 0xA8, 0x04, 0x4A, 0xEB, 0xF6, -+0x58, 0xC8, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x0B, 0xF7, 0x61, 0xA0, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, 0x0B, 0xF7, -+0x80, 0xA0, 0x0F, 0x6D, 0x6C, 0xED, 0x72, 0x36, -+0x40, 0xEA, 0x0E, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x54, 0x9A, 0x40, 0xEA, 0xEB, 0xF6, -+0x74, 0xA0, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0xEB, 0xF6, 0x54, 0xC0, 0x01, 0x6C, 0x56, 0x10, -+0x0B, 0xF7, 0x63, 0xA0, 0x7F, 0x6A, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x18, 0x22, 0x01, 0x72, -+0x45, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, -+0x4C, 0x9A, 0x00, 0x6C, 0x40, 0xEA, 0x49, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF3, 0x50, 0x9A, -+0xCB, 0xF6, 0x9D, 0xA0, 0x00, 0x6D, 0x40, 0xEA, -+0x06, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, -+0x54, 0x9A, 0x40, 0xEA, 0x3A, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, -+0x75, 0xA2, 0x0B, 0xF7, 0x82, 0xA2, 0x01, 0x4B, -+0xEB, 0xF6, 0x75, 0xC2, 0xEB, 0xF6, 0x7A, 0xAA, -+0x6D, 0xE4, 0xEB, 0xF6, 0x7A, 0xCA, 0xEB, 0xF6, -+0x95, 0xA2, 0xEB, 0xF6, 0x62, 0xA2, 0x8E, 0xEB, -+0x09, 0x2B, 0x10, 0xF0, 0x24, 0x6C, 0x0B, 0xF7, -+0xC2, 0xA2, 0xB5, 0xF4, 0x09, 0x4C, 0x04, 0xD3, -+0x00, 0x6D, 0x09, 0x10, 0x0B, 0xF7, 0xC2, 0xA2, -+0x10, 0xF0, 0x24, 0x6C, 0x00, 0x6A, 0x04, 0xD2, -+0x95, 0xF4, 0x0D, 0x4C, 0xA2, 0x67, 0x64, 0x6A, -+0x58, 0xEE, 0x01, 0x6F, 0x12, 0xEE, 0x00, 0x18, -+0x9E, 0xE9, 0x1B, 0x10, 0xEB, 0xF6, 0x74, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xEB, 0xF6, -+0x54, 0xC0, 0x02, 0x6C, 0xEB, 0xF6, 0xB2, 0xA8, -+0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xEB, 0xF6, 0x94, 0xA2, 0x02, 0x6B, -+0x6B, 0xEB, 0xEB, 0xF6, 0xB2, 0xAA, 0x8C, 0xEB, -+0xEB, 0xF6, 0x74, 0xC2, 0x03, 0x6C, 0x00, 0x18, -+0x77, 0xEA, 0x07, 0x97, 0x06, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAC, 0xF0, 0x7C, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0xCA, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x69, 0xC0, 0xF1, 0x08, 0x49, -+0xEB, 0xF6, 0x94, 0xA1, 0x01, 0x6A, 0xFF, 0x6B, -+0x8C, 0xEA, 0x00, 0xF1, 0x0C, 0x22, 0xEB, 0xF6, -+0xA0, 0xA1, 0x03, 0x6E, 0xAE, 0x32, 0xCC, 0xEA, -+0x6C, 0xEA, 0x02, 0x72, 0x7E, 0x60, 0x06, 0x67, -+0x4E, 0xE8, 0xE0, 0xF0, 0x02, 0x20, 0x01, 0x72, -+0x25, 0x60, 0x02, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0xEB, 0xF6, 0x54, 0xC1, 0x02, 0x6A, 0xAC, 0xEA, -+0x6C, 0xEA, 0x11, 0x22, 0xEB, 0xF6, 0x43, 0xA1, -+0x0F, 0x6D, 0xEB, 0xF6, 0x84, 0xA1, 0x4C, 0xED, -+0x52, 0x36, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x54, 0x9A, 0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, -+0x01, 0x72, 0x01, 0x6C, 0x01, 0x61, 0x00, 0x6C, -+0xEB, 0xF6, 0xB2, 0xA9, 0x00, 0x18, 0x77, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0xD9, 0x10, 0x02, 0x6A, 0xAC, 0xEA, -+0x6C, 0xEA, 0x11, 0x22, 0xEB, 0xF6, 0x43, 0xA1, -+0x0F, 0x6D, 0xEB, 0xF6, 0x84, 0xA1, 0x4C, 0xED, -+0x52, 0x36, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x54, 0x9A, 0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, -+0x01, 0x72, 0xA0, 0xF0, 0x14, 0x61, 0xEB, 0xF6, -+0xB2, 0xA9, 0x00, 0x6C, 0x00, 0x18, 0x77, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xAC, 0xF0, 0x4D, 0xA2, -+0x5A, 0x33, 0x02, 0x73, 0x0D, 0x60, 0x03, 0x73, -+0x0F, 0x60, 0x01, 0x73, 0x05, 0x60, 0x3F, 0x6E, -+0x4C, 0xEE, 0xFF, 0x6A, 0x4C, 0xEE, 0x0E, 0x10, -+0x3F, 0x6B, 0x4C, 0xEB, 0x0A, 0x6E, 0x08, 0x10, -+0x3F, 0x6B, 0x4C, 0xEB, 0x64, 0x6E, 0x04, 0x10, -+0x3F, 0x6B, 0x4C, 0xEB, 0xE0, 0xF3, 0x08, 0x6E, -+0xD8, 0xEB, 0x12, 0xEE, 0x0A, 0x6A, 0x58, 0xEE, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xEB, 0xF6, 0x7A, 0xAA, 0x10, 0xF0, 0x24, 0x6C, -+0x95, 0xF4, 0x0D, 0x4C, 0x12, 0xEE, 0x7B, 0xE6, -+0x00, 0x6B, 0xEB, 0xF6, 0x75, 0xC2, 0x00, 0x6B, -+0xEB, 0xF6, 0x7A, 0xCA, 0xEB, 0xF6, 0x78, 0xCA, -+0x00, 0x6A, 0x04, 0xD2, 0xA2, 0x67, 0x64, 0x6A, -+0x62, 0x10, 0x02, 0x6A, 0xAC, 0xEA, 0x6C, 0xEA, -+0x10, 0x22, 0xEB, 0xF6, 0x43, 0xA1, 0x0F, 0x6D, -+0xEB, 0xF6, 0x84, 0xA1, 0x4C, 0xED, 0x52, 0x36, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, -+0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x01, 0x72, -+0x62, 0x61, 0xEB, 0xF6, 0xB2, 0xA9, 0x00, 0x6C, -+0x00, 0x18, 0x77, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, 0x87, 0xA2, -+0xEB, 0xF6, 0x76, 0xA2, 0xFF, 0x4C, 0x6E, 0xEC, -+0x03, 0x2C, 0xEB, 0xF6, 0x66, 0xA2, 0x05, 0x10, -+0x01, 0x4B, 0xEB, 0xF6, 0x76, 0xC2, 0xEB, 0xF6, -+0x65, 0xA2, 0x7A, 0x32, 0x02, 0x72, 0x0D, 0x60, -+0x03, 0x72, 0x0F, 0x60, 0x01, 0x72, 0x05, 0x60, -+0x3F, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x0E, 0x10, 0x3F, 0x6A, 0x6C, 0xEA, 0x0A, 0x6B, -+0x08, 0x10, 0x3F, 0x6A, 0x6C, 0xEA, 0x64, 0x6B, -+0x04, 0x10, 0x3F, 0x6A, 0x6C, 0xEA, 0xE0, 0xF3, -+0x08, 0x6B, 0x78, 0xEA, 0x12, 0xEA, 0x0A, 0x6B, -+0x78, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0xCC, 0xF0, -+0x62, 0xAB, 0x00, 0x6C, 0x64, 0x6E, 0x12, 0xEA, -+0x6B, 0xE2, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0xEB, 0xF6, 0x95, 0xC3, 0x00, 0x6C, -+0xEB, 0xF6, 0x9A, 0xCB, 0xEB, 0xF6, 0x98, 0xCB, -+0x00, 0x6B, 0x10, 0xF0, 0x24, 0x6C, 0x04, 0xD3, -+0x95, 0xF4, 0x0D, 0x4C, 0xA3, 0x67, 0xD8, 0xEA, -+0x01, 0x6F, 0x12, 0xEE, 0x00, 0x18, 0x9E, 0xE9, -+0x1E, 0x10, 0xEB, 0xF6, 0xB2, 0xA9, 0x00, 0x6C, -+0x00, 0x18, 0x77, 0xEA, 0xEB, 0xF6, 0x15, 0xC1, -+0xEB, 0xF6, 0x1A, 0xC9, 0xEB, 0xF6, 0x18, 0xC9, -+0x00, 0x18, 0x23, 0xEB, 0x10, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, -+0x94, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, 0xEB, 0xF6, -+0xB2, 0xAA, 0x8C, 0xEB, 0xEB, 0xF6, 0x74, 0xC2, -+0x01, 0x6C, 0x00, 0x18, 0x77, 0xEA, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x04, 0x67, 0x25, 0x67, 0x4C, 0xEE, -+0x4C, 0xE8, 0x4C, 0xE9, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x4C, 0x9A, 0x04, 0xD6, 0x90, 0x67, -+0xB1, 0x67, 0x40, 0xEA, 0x90, 0x67, 0x80, 0x18, -+0xB0, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF6, -+0x67, 0xA2, 0x00, 0x6A, 0x09, 0x2B, 0x04, 0x97, -+0x30, 0xF0, 0x20, 0x6C, 0x25, 0xF6, 0x08, 0x4C, -+0xB0, 0x67, 0xD1, 0x67, 0x80, 0x18, 0x39, 0x2A, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x6B, 0x6C, 0xEC, -+0x0F, 0x6A, 0x8C, 0xEA, 0x03, 0x2A, 0x92, 0x32, -+0x6C, 0xEA, 0x20, 0xE8, 0x07, 0x4A, 0x6C, 0xEA, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x08, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x54, 0x9A, 0x01, 0x6C, -+0x04, 0xF0, 0x00, 0x6D, 0x09, 0x10, 0xFF, 0x4A, -+0x44, 0x33, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x54, 0x9A, 0x01, 0x6D, 0x02, 0x6C, 0xA4, 0xEB, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x54, 0x9A, 0x01, 0x6C, 0x08, 0xF0, 0x00, 0x6D, -+0x09, 0x10, 0x44, 0x32, 0x6F, 0x42, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x54, 0x9A, 0x01, 0x6D, -+0x02, 0x6C, 0xA4, 0xEB, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x04, 0x2A, 0x01, 0x6C, -+0x08, 0xF0, 0x00, 0x6D, 0x05, 0x10, 0x44, 0x32, -+0xFF, 0x4A, 0x01, 0x6D, 0x02, 0x6C, 0xA4, 0xEA, -+0x00, 0x18, 0x42, 0xE1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x04, 0x2A, 0x01, 0x6C, -+0x04, 0xF0, 0x00, 0x6D, 0x05, 0x10, 0xFF, 0x4A, -+0x44, 0x32, 0x01, 0x6D, 0x02, 0x6C, 0xA4, 0xEA, -+0x00, 0x18, 0x42, 0xE1, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6D, 0x8C, 0xED, 0x01, 0x6C, 0x44, 0x67, -+0x15, 0x4D, 0x44, 0xED, 0xA2, 0x67, 0x00, 0x18, -+0xC1, 0xE0, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6D, 0x8C, 0xED, -+0x04, 0x2D, 0x03, 0x6C, 0x10, 0xF0, 0x00, 0x6D, -+0x05, 0x10, 0x1B, 0x4D, 0x01, 0x6A, 0x44, 0xED, -+0x03, 0x6C, 0xA2, 0x67, 0x00, 0x18, 0xC1, 0xE0, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x18, 0xCF, 0xEB, 0x01, 0x6D, 0x02, 0x6C, -+0xA4, 0xEA, 0x00, 0x18, 0xC1, 0xE0, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0xCF, 0xEB, -+0x01, 0x6D, 0x03, 0x6C, 0xA4, 0xEA, 0x00, 0x18, -+0xC1, 0xE0, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6D, 0x8C, 0xED, -+0x18, 0x4D, 0x01, 0x6A, 0x44, 0xED, 0x00, 0x6C, -+0xA2, 0x67, 0x00, 0x18, 0xC1, 0xE0, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6D, 0x8C, 0xED, 0x01, 0x6C, 0x44, 0x67, -+0x15, 0x4D, 0x44, 0xED, 0xA2, 0x67, 0x00, 0x18, -+0xF2, 0xE0, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6D, 0x8C, 0xED, -+0x04, 0x2D, 0x03, 0x6C, 0x10, 0xF0, 0x00, 0x6D, -+0x05, 0x10, 0x1B, 0x4D, 0x01, 0x6A, 0x44, 0xED, -+0x03, 0x6C, 0xA2, 0x67, 0x00, 0x18, 0xF2, 0xE0, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x18, 0xCF, 0xEB, 0x01, 0x6D, 0x02, 0x6C, -+0xA4, 0xEA, 0x00, 0x18, 0xF2, 0xE0, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0xCF, 0xEB, -+0x01, 0x6D, 0x03, 0x6C, 0xA4, 0xEA, 0x00, 0x18, -+0xF2, 0xE0, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xDE, 0x63, 0x43, 0x62, 0x42, 0xD1, 0x41, 0xD0, -+0x01, 0x6A, 0x7D, 0x67, 0x4B, 0xEA, 0x54, 0xC3, -+0x0F, 0x6A, 0x56, 0xC3, 0x10, 0x6A, 0x57, 0xC3, -+0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF3, 0x40, 0x9A, -+0xFF, 0x69, 0x8C, 0xE9, 0x30, 0x31, 0x49, 0xE1, -+0x40, 0x9A, 0x30, 0xF0, 0x20, 0x68, 0x06, 0x04, -+0x04, 0xD2, 0x4E, 0xF2, 0x50, 0x98, 0x04, 0x05, -+0x04, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF1, 0x44, 0x9A, 0x07, 0x04, 0x04, 0x05, -+0x49, 0xE1, 0x40, 0x9A, 0x04, 0x6E, 0x04, 0xD2, -+0x4E, 0xF2, 0x50, 0x98, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF1, 0x58, 0x9A, 0x08, 0x04, -+0x04, 0x05, 0x49, 0xE1, 0x40, 0x9A, 0x04, 0x6E, -+0x04, 0xD2, 0x4E, 0xF2, 0x50, 0x98, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF1, 0x4C, 0x9A, -+0x09, 0x04, 0x04, 0x05, 0x45, 0xE1, 0x40, 0x99, -+0x04, 0x6E, 0x04, 0xD2, 0x4E, 0xF2, 0x50, 0x98, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x05, 0x04, 0x40, 0xEA, 0x43, 0x97, -+0x42, 0x91, 0x41, 0x90, 0x22, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF4, 0x48, 0x9A, 0xBC, 0xF4, 0x6C, 0x9B, -+0x00, 0xA2, 0x20, 0xA3, 0xFF, 0x6A, 0x4C, 0xE8, -+0x4C, 0xE9, 0x2A, 0xE8, 0x43, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF3, 0x40, 0x9A, 0x10, 0x33, -+0x49, 0xE3, 0x40, 0xA2, 0xFF, 0x6B, 0x6C, 0xEA, -+0x56, 0x32, 0x6C, 0xEA, 0x07, 0x5A, 0x2C, 0x60, -+0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, 0x3B, 0xF6, -+0x14, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, 0x00, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF6, 0x47, 0xA2, -+0x1F, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x54, 0x9A, 0x18, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x5C, 0x9A, 0x13, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x40, 0x9A, 0x0E, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x44, 0x9A, -+0x09, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x48, 0x9A, 0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x4C, 0x9A, 0x90, 0x67, 0x40, 0xEA, -+0x01, 0x48, 0x7F, 0x6A, 0x4C, 0xE8, 0x0A, 0xE9, -+0xC2, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF4, -+0x48, 0x9A, 0x20, 0xC2, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF4, 0x74, 0x9A, -+0x02, 0x6C, 0x00, 0xF4, 0x00, 0x6D, 0x40, 0x9B, -+0x30, 0xF0, 0x20, 0x69, 0x8D, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF3, 0x60, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6C, 0x40, 0xAB, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xCB, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF4, 0x10, 0x9A, 0x10, 0xF0, -+0x24, 0x6B, 0xBC, 0xF4, 0x14, 0x4B, 0x40, 0x98, -+0x60, 0x9B, 0x0A, 0x6C, 0x6C, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x5B, 0xF7, 0x64, 0x9B, 0x6D, 0xEA, -+0x40, 0xD8, 0xCE, 0xF4, 0x5C, 0x99, 0x40, 0xEA, -+0x40, 0x98, 0xDF, 0xF7, 0x01, 0x6B, 0x6B, 0xEB, -+0x6C, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF4, -+0x78, 0x9B, 0x0A, 0x6C, 0x6D, 0xEA, 0x40, 0xD8, -+0xCE, 0xF4, 0x5C, 0x99, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6C, 0xBC, 0xF4, 0x14, 0x4C, 0x40, 0x98, -+0x80, 0x9C, 0x8C, 0xEA, 0x40, 0xD8, 0xCE, 0xF4, -+0x5C, 0x99, 0x0A, 0x6C, 0x40, 0xEA, 0x40, 0x98, -+0x1D, 0xF0, 0x01, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF4, 0x7C, 0x9B, -+0x0A, 0x6C, 0x6D, 0xEA, 0x40, 0xD8, 0xCE, 0xF4, -+0x5C, 0x99, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0xDC, 0xF4, 0xA0, 0x9B, -+0xFF, 0x6A, 0x08, 0x6E, 0x60, 0xA5, 0xCB, 0xEE, -+0x4C, 0xEC, 0x4C, 0xEB, 0xCC, 0xEB, 0x6D, 0xEC, -+0x10, 0xF0, 0x24, 0x6B, 0xDC, 0xF4, 0x64, 0x9B, -+0x4C, 0xEC, 0x80, 0xC5, 0x60, 0xA3, 0x6C, 0xEA, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0xDC, 0xF4, 0xC0, 0x9B, 0xFF, 0x6A, 0x08, 0x6F, -+0x60, 0xA6, 0xEB, 0xEF, 0x4C, 0xEC, 0x4C, 0xEB, -+0xEC, 0xEB, 0x6D, 0xEC, 0x4C, 0xED, 0x4C, 0xEC, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF4, 0x44, 0x9A, -+0x80, 0xC6, 0xA0, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x00, 0x6C, 0x00, 0x18, 0xDB, 0xED, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF2, 0x40, 0x9A, 0x01, 0x68, -+0x0B, 0xE8, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x69, -+0x01, 0xF4, 0x00, 0x6C, 0xB0, 0x67, 0x00, 0x18, -+0xE4, 0xE6, 0xCE, 0xF4, 0x70, 0x99, 0x04, 0x6E, -+0xCB, 0xEE, 0x4C, 0xEE, 0x01, 0xF4, 0x00, 0x6C, -+0xB0, 0x67, 0x40, 0xEB, 0x00, 0x6C, 0xA4, 0x67, -+0xD0, 0x67, 0x00, 0x18, 0x2F, 0xE7, 0x00, 0x6C, -+0xE4, 0x67, 0x30, 0xF0, 0x20, 0x6B, 0xA4, 0x67, -+0xD0, 0x67, 0x8F, 0xF5, 0x54, 0xCB, 0x00, 0x18, -+0x42, 0xE7, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF0, -+0x78, 0x9A, 0xFE, 0x6A, 0xB0, 0x67, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0xA1, 0xF0, 0x14, 0x6C, -+0x00, 0x18, 0xE4, 0xE6, 0xCE, 0xF4, 0x70, 0x99, -+0x40, 0x6E, 0xA1, 0xF0, 0x14, 0x6C, 0xB0, 0x67, -+0x4D, 0xEE, 0x40, 0xEB, 0x00, 0x18, 0x0B, 0xC9, -+0x01, 0x72, 0x06, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF3, 0x40, 0x9A, 0x3F, 0x6B, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF4, 0x68, 0x9A, -+0xFD, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF4, 0x68, 0x9A, 0xFF, 0x69, 0x02, 0x6C, -+0x40, 0xA3, 0x01, 0x68, 0x0B, 0xE8, 0x2C, 0xEA, -+0x8D, 0xEA, 0x2C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, -+0x24, 0x6A, 0xFC, 0xF3, 0x40, 0x9A, 0x01, 0x6B, -+0x6B, 0xEB, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF4, 0x4C, 0x9A, 0x09, 0x6B, 0xB0, 0x67, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF1, -+0x40, 0x9A, 0x7A, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, -+0xA1, 0xF0, 0x12, 0x4C, 0x00, 0x18, 0xE4, 0xE6, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x70, 0x9C, -+0x41, 0x6E, 0xCB, 0xEE, 0xB0, 0x67, 0x4C, 0xEE, -+0xA1, 0xF0, 0x14, 0x6C, 0x40, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0xFC, 0xF0, 0x78, 0x9A, 0x01, 0x6C, -+0x40, 0xA3, 0x2C, 0xEA, 0x8D, 0xEA, 0x2C, 0xEA, -+0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x01, 0xF3, 0x01, 0x49, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x8F, 0xF5, 0xF4, 0xAA, -+0x10, 0xF0, 0x24, 0x6A, 0xBB, 0xF7, 0x44, 0x9A, -+0x00, 0x6C, 0xD0, 0x67, 0x4D, 0xEF, 0xA4, 0x67, -+0x00, 0x18, 0x42, 0xE7, 0x91, 0x67, 0xB0, 0x67, -+0x00, 0x18, 0xE4, 0xE6, 0x30, 0xF0, 0x20, 0x6C, -+0xCE, 0xF4, 0x70, 0x9C, 0x03, 0x6E, 0xB0, 0x67, -+0x4D, 0xEE, 0x91, 0x67, 0x40, 0xEB, 0x01, 0x6C, -+0x00, 0x18, 0xDB, 0xED, 0x00, 0x18, 0xEE, 0xD5, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF4, 0x44, 0x9A, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x80, 0xA2, 0xEB, 0xF6, -+0xD4, 0xA3, 0xEB, 0xF6, 0x9C, 0xC3, 0xA0, 0xAA, -+0x01, 0xF0, 0x00, 0x6C, 0xAC, 0xEC, 0x83, 0x35, -+0x03, 0x6C, 0xAE, 0x35, 0x8B, 0xEC, 0xA4, 0x35, -+0xCC, 0xEC, 0xAD, 0xEC, 0xEB, 0xF6, 0x94, 0xC3, -+0x10, 0xF0, 0x24, 0x6C, 0xFC, 0xF4, 0x88, 0x9C, -+0xA0, 0xAC, 0xEB, 0xF6, 0xBE, 0xCB, 0xA0, 0xAA, -+0xBF, 0xF7, 0x1F, 0x6B, 0xAC, 0xEB, 0x60, 0xCA, -+0xA0, 0xAA, 0x7F, 0xF7, 0x1F, 0x6B, 0xAC, 0xEB, -+0x60, 0xCA, 0xC0, 0xAA, 0xFE, 0xF7, 0x1F, 0x6B, -+0xFF, 0xF7, 0x1F, 0x6D, 0xCC, 0xEB, 0x60, 0xCA, -+0x40, 0xAC, 0xFF, 0x6B, 0x21, 0x4B, 0xAC, 0xEA, -+0x6D, 0xEA, 0xAC, 0xEA, 0x40, 0xCC, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x10, 0xF0, 0x24, 0x6B, 0xEB, 0xF6, 0x9C, 0xA2, -+0xFC, 0xF4, 0x64, 0x9B, 0x01, 0x6E, 0x80, 0xC3, -+0x10, 0xF0, 0x24, 0x6C, 0xEB, 0xF6, 0xBE, 0xAA, -+0xFC, 0xF4, 0x88, 0x9C, 0xA0, 0xCC, 0xEB, 0xF6, -+0x54, 0xA2, 0x80, 0xAB, 0xFF, 0xF7, 0x1F, 0x6D, -+0x46, 0x32, 0xCC, 0xEA, 0xAC, 0xEC, 0x40, 0x32, -+0xFE, 0xF7, 0x1E, 0x4E, 0x4C, 0x32, 0xCC, 0xEC, -+0x8D, 0xEA, 0xAC, 0xEA, 0x40, 0xCB, 0x20, 0xE8, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x6A, 0x04, 0x67, 0x4C, 0xE8, 0x30, 0x70, -+0x26, 0x67, 0x4C, 0xED, 0x09, 0x61, 0x41, 0xA6, -+0x0C, 0x72, 0x06, 0x61, 0x30, 0xF0, 0x21, 0x6A, -+0xD0, 0xF4, 0x43, 0xA2, 0x00, 0x6B, 0x44, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF2, 0x7C, 0x9A, -+0xFF, 0x6C, 0x08, 0x6E, 0x40, 0xA3, 0xCB, 0xEE, -+0x8C, 0xEA, 0xCC, 0xEA, 0x05, 0x6E, 0xCD, 0xEA, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0x7C, 0xF2, 0x40, 0x9A, 0x60, 0xA2, 0x0F, 0x6A, -+0x6C, 0xEA, 0x04, 0x72, 0x1C, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF3, 0x5C, 0x9A, 0x90, 0x67, -+0xD1, 0x67, 0x40, 0xEA, 0x01, 0x72, 0x01, 0x6B, -+0x23, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, -+0x58, 0x9A, 0x83, 0x67, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x6C, 0x9A, 0x04, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x02, 0x6B, 0x11, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF3, 0x58, 0x9A, 0x02, 0x6C, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, 0x04, 0x6C, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x03, 0x6B, -+0x23, 0x70, 0x03, 0x60, 0x30, 0x70, 0x0A, 0x60, -+0x2F, 0x10, 0x03, 0x73, 0x2D, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF3, 0x4C, 0x9A, 0x00, 0x6C, -+0x40, 0xEA, 0x1C, 0x10, 0x41, 0xA1, 0x0D, 0x72, -+0x0E, 0x61, 0x01, 0x6A, 0x6E, 0xEA, 0x06, 0x2A, -+0x30, 0xF0, 0x21, 0x6B, 0xD0, 0xF4, 0x43, 0xC3, -+0x01, 0x6D, 0x09, 0x10, 0x01, 0x6C, 0x30, 0xF0, -+0x21, 0x6A, 0xD0, 0xF4, 0x83, 0xC2, 0x01, 0x6A, -+0x4E, 0xEB, 0x01, 0x5B, 0xB8, 0x67, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF3, 0x54, 0x9A, 0xC0, 0xA1, -+0x00, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x04, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF4, -+0x4C, 0x9A, 0xEF, 0xF7, 0x1F, 0x68, 0x02, 0x6B, -+0x40, 0xAA, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF5, 0x54, 0xAA, 0x0E, 0xEA, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x9E, 0xEC, 0x02, 0x6B, -+0x50, 0x67, 0x6C, 0xEA, 0x08, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF5, 0x54, 0xAA, 0x6C, 0xEA, -+0x02, 0x2A, 0x00, 0x18, 0x9E, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF5, 0x54, 0xAA, 0x80, 0x6B, -+0x0E, 0xEA, 0x6C, 0xEA, 0x06, 0x22, 0x0C, 0xEB, -+0x04, 0x2B, 0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, -+0xF8, 0xD5, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF5, -+0x14, 0xCA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x01, 0x74, 0x1C, 0x60, 0x05, 0x24, -+0x02, 0x74, 0x0E, 0x60, 0x03, 0x74, 0x51, 0x60, -+0x5B, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF4, -+0x78, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0xFC, 0xF4, -+0x9C, 0x9C, 0x40, 0x9B, 0x8C, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF5, 0x60, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x3C, 0xF0, 0x9C, 0x9C, -+0x40, 0x9B, 0x8C, 0xEA, 0x44, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFC, 0xF4, 0x78, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xFC, 0xF4, 0x9C, 0x9C, 0x40, 0x9B, -+0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6C, 0xDB, 0xF7, -+0x80, 0x9C, 0x8D, 0xEA, 0x40, 0xDB, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF5, 0x54, 0xAA, 0x80, 0x6B, -+0x6C, 0xEA, 0x1F, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x40, 0xA2, 0x05, 0x5A, 0x19, 0x60, -+0x01, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0xF8, 0xD5, -+0x0A, 0x68, 0x01, 0x6E, 0x00, 0x6C, 0x01, 0x6D, -+0xCB, 0xEE, 0x00, 0x18, 0x2F, 0xE7, 0x04, 0x6B, -+0x4C, 0xEB, 0x02, 0x23, 0x01, 0x68, 0x04, 0x10, -+0x01, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0xF8, 0xD5, -+0xFF, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0xED, 0x28, -+0x04, 0x10, 0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, -+0xF8, 0xD5, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF5, -+0x60, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x3C, 0xF0, -+0x98, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x04, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0x69, 0xF2, -+0x10, 0x4C, 0xB0, 0x67, 0x05, 0x6E, 0x40, 0xEA, -+0x40, 0xA0, 0x01, 0x69, 0x2C, 0xEA, 0x56, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, 0x44, 0x9A, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x40, 0xA2, 0xC9, 0xF0, 0x65, 0xA0, 0x04, 0x6C, -+0xC9, 0xF0, 0x48, 0xC0, 0x00, 0x6A, 0xC9, 0xF0, -+0x47, 0xC0, 0x07, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0xC9, 0xF0, 0x45, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF3, 0x5C, 0x9A, 0x40, 0xEA, 0xA9, 0xF0, -+0x68, 0xA0, 0x04, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x0E, 0x22, 0x00, 0x6A, 0xC9, 0xF0, -+0x59, 0xC0, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF5, -+0x44, 0x9A, 0xC9, 0xF0, 0x2B, 0xC0, 0x60, 0x9A, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF5, 0x78, 0xDA, -+0x30, 0xF0, 0x20, 0x6A, 0x69, 0xF2, 0x52, 0xA2, -+0x04, 0x6B, 0x6C, 0xEA, 0x13, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0xE0, 0xF0, -+0x83, 0xA2, 0x01, 0x6B, 0x8C, 0xEB, 0x05, 0x2B, -+0x64, 0x6C, 0x6D, 0xEC, 0xE0, 0xF0, 0x83, 0xC2, -+0x05, 0x10, 0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0xE0, 0xF0, 0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x1B, 0xF7, 0x54, 0x9A, 0x05, 0x6B, 0x60, 0xC2, -+0x06, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0x89, 0xF2, -+0x71, 0xC2, 0x1E, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF3, 0x58, 0x9A, 0x03, 0x6C, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF3, 0x5C, 0x9A, -+0x03, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xC9, 0xF0, 0x85, 0xA2, -+0x07, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xA9, 0xF0, -+0x8C, 0xA2, 0xC9, 0xF0, 0x65, 0xC2, 0x41, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0xA9, 0xF0, 0x6C, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xC9, 0xF0, 0x84, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, -+0x6C, 0xEC, 0xC9, 0xF0, 0x84, 0xC2, 0xC9, 0xF0, -+0x85, 0xA2, 0x8C, 0xEB, 0xC9, 0xF0, 0x65, 0xC2, -+0xA9, 0xF0, 0x6B, 0xA2, 0x80, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x06, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF3, 0x54, 0x9A, -+0x01, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xA9, 0xF0, 0x6A, 0xA2, -+0x08, 0x6C, 0x8C, 0xEB, 0x0C, 0x23, 0x30, 0xF0, -+0x20, 0x6B, 0xCF, 0xF5, 0x61, 0xA3, 0x68, 0xF3, -+0x54, 0xA2, 0x07, 0x6C, 0x7F, 0x6E, 0x6C, 0xEC, -+0x01, 0x6D, 0x4C, 0xEE, 0x0F, 0x10, 0x68, 0xF3, -+0x74, 0xA2, 0x7F, 0x6A, 0x6C, 0xEA, 0x0C, 0x2A, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF5, 0x61, 0xA2, -+0x07, 0x6A, 0xFF, 0x6C, 0x6C, 0xEA, 0x00, 0x6D, -+0x4C, 0xEC, 0xC5, 0x67, 0x00, 0x18, 0xD7, 0xCF, -+0x30, 0xF0, 0x20, 0x68, 0xEF, 0xF4, 0x08, 0x48, -+0xC0, 0xF0, 0x59, 0xA0, 0x07, 0x6C, 0x00, 0x6D, -+0x4C, 0xEC, 0x00, 0x18, 0x3E, 0xD1, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF3, 0x4C, 0x9A, 0x08, 0x6C, -+0x40, 0xEA, 0xE0, 0xF0, 0x46, 0xA0, 0x4A, 0x32, -+0xE0, 0xF0, 0x45, 0xC0, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xA9, 0xF0, 0x88, 0xA2, -+0x01, 0x6B, 0xFF, 0x6D, 0x6C, 0xEC, 0x31, 0x24, -+0xA9, 0xF0, 0x8A, 0xA2, 0x08, 0x6E, 0xCC, 0xEC, -+0x2C, 0x24, 0xC9, 0xF0, 0x85, 0xA2, 0x6C, 0xEC, -+0xAC, 0xEC, 0x05, 0x2C, 0xA9, 0xF0, 0x4B, 0xA2, -+0x4C, 0xEB, 0xAC, 0xEB, 0x17, 0x23, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0xE0, 0xF0, -+0x6C, 0xAA, 0xFF, 0x6C, 0x01, 0x4C, 0x8C, 0xEB, -+0x0D, 0x2B, 0xC0, 0xF0, 0x59, 0xA2, 0x07, 0x6C, -+0x01, 0x6D, 0x4C, 0xEC, 0x00, 0x18, 0x3E, 0xD1, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0x0B, 0x10, 0x00, 0x6A, 0x10, 0xF0, -+0x24, 0x6C, 0x01, 0x6E, 0x17, 0xF2, 0x11, 0x4C, -+0xA2, 0x67, 0xE6, 0x67, 0x04, 0xD2, 0x00, 0x18, -+0x9E, 0xE9, 0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x69, 0x2C, 0xEC, 0xAC, 0xE9, 0x21, 0x24, -+0x91, 0x67, 0x01, 0x6D, 0x30, 0xF0, 0x20, 0x68, -+0x00, 0x18, 0x3E, 0xD1, 0xC0, 0xF1, 0x08, 0x48, -+0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF2, 0x9F, 0xA0, -+0x2E, 0xF4, 0x50, 0x9A, 0x01, 0x6D, 0x08, 0x6E, -+0xF1, 0x67, 0x40, 0xEA, 0xC9, 0xF0, 0x84, 0xA0, -+0x01, 0x6B, 0x4C, 0xEB, 0x03, 0x6A, 0x4B, 0xEA, -+0x64, 0x33, 0x8C, 0xEA, 0x6D, 0xEA, 0x05, 0x6B, -+0x6B, 0xEB, 0x6C, 0xEA, 0xC9, 0xF0, 0x44, 0xC0, -+0x1A, 0x10, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0xA9, 0xF0, 0x4A, 0xA0, 0x08, 0x6B, -+0x6C, 0xEA, 0x0F, 0x2A, 0x91, 0x67, 0x00, 0x6D, -+0x00, 0x18, 0x3E, 0xD1, 0x30, 0xF0, 0x20, 0x6A, -+0xC8, 0xF2, 0x9F, 0xA0, 0x2E, 0xF4, 0x50, 0x9A, -+0x00, 0x6D, 0x08, 0x6E, 0xF1, 0x67, 0x40, 0xEA, -+0x02, 0x10, 0x00, 0x18, 0x84, 0xEE, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x01, 0x74, -+0xA0, 0xF0, 0x1B, 0x60, 0x03, 0x24, 0x02, 0x74, -+0x22, 0x60, 0xE0, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xA9, 0xF0, 0x88, 0xA2, -+0x20, 0x6B, 0xFF, 0x6D, 0x8C, 0xEB, 0xC0, 0xF0, -+0x15, 0x2B, 0x10, 0x6B, 0x8C, 0xEB, 0xAC, 0xEB, -+0xC0, 0xF0, 0x10, 0x23, 0xC9, 0xF0, 0x84, 0xA2, -+0x01, 0x6B, 0x8D, 0xEB, 0xC9, 0xF0, 0x64, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF5, 0x61, 0xA2, -+0x07, 0x6A, 0x00, 0x6C, 0x6C, 0xEA, 0x4C, 0xED, -+0x00, 0x18, 0xA4, 0xEE, 0xBF, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xA9, 0xF0, -+0x88, 0xA2, 0x20, 0x6B, 0x8C, 0xEB, 0x07, 0x2B, -+0xA9, 0xF0, 0x6C, 0xA2, 0x08, 0x6A, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x45, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC9, 0xF0, -+0x08, 0xA2, 0xA9, 0xF0, 0x49, 0xA2, 0x43, 0xE0, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xE8, 0x20, 0x58, -+0x03, 0x61, 0xEF, 0xF7, 0x1F, 0x68, 0x03, 0x10, -+0x00, 0x30, 0x08, 0x30, 0x4C, 0xE8, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0xA9, 0xF0, -+0x8C, 0xA3, 0x08, 0x6A, 0x8C, 0xEA, 0x08, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x58, 0x9A, -+0xE8, 0xF2, 0x82, 0xA3, 0xB0, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xA9, 0xF0, 0xA8, 0xA2, 0x20, 0x6C, 0xFF, 0x6B, -+0x8C, 0xED, 0x16, 0x25, 0xA9, 0xF0, 0x4C, 0xA2, -+0x8C, 0xEA, 0x6C, 0xEA, 0x11, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF5, 0x41, 0xA2, 0x07, 0x6F, -+0x02, 0x36, 0x4C, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF3, 0x48, 0x9A, 0xB0, 0x67, 0x00, 0x6C, -+0x6C, 0xED, 0x6C, 0xEE, 0x6C, 0xEF, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0xA9, 0xF0, 0xA8, 0xA3, 0x20, 0x6C, 0xFF, 0x6A, -+0xAC, 0xEC, 0x2B, 0x2C, 0x10, 0x6C, 0xAC, 0xEC, -+0x4C, 0xEC, 0x18, 0x24, 0xC9, 0xF0, 0xA4, 0xA3, -+0x02, 0x6C, 0x8B, 0xEC, 0xAC, 0xEC, 0x30, 0xF0, -+0x20, 0x68, 0xC9, 0xF0, 0x84, 0xC3, 0xEF, 0xF4, -+0x08, 0x48, 0xC0, 0xF0, 0x79, 0xA0, 0x07, 0x6D, -+0x01, 0x6C, 0x6C, 0xED, 0x4C, 0xED, 0x00, 0x18, -+0xA4, 0xEE, 0xC0, 0xF0, 0x5A, 0xA0, 0x01, 0x4A, -+0xC0, 0xF0, 0x5A, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x69, 0xF2, 0x73, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, -+0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0xFF, 0x6C, 0x6F, 0x6D, 0x06, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC9, 0xF0, 0x85, 0xA2, 0x02, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0xC9, 0xF0, 0x65, 0xC2, -+0x31, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xA9, 0xF0, 0xAB, 0xA2, 0x01, 0x6B, -+0xFF, 0x6C, 0xAC, 0xEB, 0x05, 0x23, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x1F, 0x10, -+0xA9, 0xF0, 0x68, 0xA2, 0x20, 0x6A, 0x6C, 0xEA, -+0x8C, 0xEA, 0x08, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0x6F, 0x6D, -+0x0E, 0x6E, 0x13, 0x10, 0x10, 0x6A, 0x6C, 0xEA, -+0x8C, 0xEA, 0x10, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0x6F, 0x6D, -+0x0F, 0x6E, 0x07, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0x00, 0x6D, -+0xC5, 0x67, 0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0xFB, 0xF7, -+0x64, 0x9B, 0xE9, 0xA4, 0x48, 0xA4, 0xA0, 0xAB, -+0xE0, 0x37, 0x5D, 0xE7, 0xFF, 0xF7, 0x1F, 0x6A, -+0x4C, 0xEF, 0x4C, 0xED, 0x4A, 0xA4, 0xCB, 0xA4, -+0x02, 0x5A, 0x04, 0x61, 0x02, 0x72, 0x0B, 0x6A, -+0x30, 0x61, 0x0C, 0x10, 0x00, 0xF1, 0x01, 0x5F, -+0x2B, 0x60, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xAB, 0xF6, 0x03, 0x4B, 0x2B, 0xF6, -+0xE1, 0xC2, 0x0B, 0x10, 0x00, 0xF1, 0x01, 0x5F, -+0x1F, 0x60, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xAB, 0xF7, 0x03, 0x4B, 0x2B, 0xF6, -+0xE2, 0xC2, 0xB5, 0xE6, 0x10, 0xF0, 0x24, 0x6E, -+0x00, 0x6A, 0x1C, 0xF5, 0x0C, 0x9E, 0x10, 0xF0, -+0x24, 0x6E, 0x04, 0xD2, 0x05, 0xD2, 0x3C, 0xF0, -+0xD4, 0x9E, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x40, 0x9A, 0xBC, 0x35, 0x00, 0x6C, 0x15, 0xE5, -+0xD9, 0xE3, 0x40, 0xEA, 0x00, 0x6A, 0x01, 0x10, -+0x0A, 0x6A, 0x07, 0x97, 0x06, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x01, 0x2A, 0x01, 0x6A, -+0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, -+0xCB, 0xF6, 0xDD, 0xA4, 0x38, 0x26, 0x8D, 0xE2, -+0x4B, 0xF4, 0x78, 0xA3, 0x34, 0x23, 0x10, 0xF0, -+0x24, 0x6B, 0xFB, 0xF7, 0x64, 0x9B, 0xFF, 0xF7, -+0x1F, 0x6D, 0x01, 0x72, 0x60, 0xAB, 0x6C, 0xED, -+0x03, 0x60, 0x02, 0x72, 0x08, 0x60, 0x27, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xAB, 0xF6, 0x03, 0x4B, -+0x4B, 0xF4, 0xF9, 0xA4, 0x06, 0x10, 0x4B, 0xF4, -+0xFA, 0xA4, 0x30, 0xF0, 0x20, 0x6B, 0xAB, 0xF7, -+0x03, 0x4B, 0xE1, 0xF7, 0x1F, 0x6A, 0xAC, 0xEA, -+0x10, 0xF0, 0x24, 0x6D, 0x3C, 0xF0, 0xB4, 0x9D, -+0xD9, 0xE2, 0x00, 0x6A, 0xB5, 0xE3, 0x10, 0xF0, -+0x24, 0x6B, 0x04, 0xD2, 0x05, 0xD2, 0x1C, 0xF5, -+0x6C, 0x9B, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x40, 0x9A, 0xDC, 0x36, 0x00, 0x6C, 0x79, 0xE6, -+0x40, 0xEA, 0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, -+0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, 0x21, 0x6C, -+0x70, 0xF3, 0x18, 0x4C, 0x00, 0x6D, 0x18, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0x80, 0xF6, 0x90, 0xA2, 0x03, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF6, 0x70, 0xC2, -+0x00, 0x6B, 0xA0, 0xF6, 0x68, 0xC2, 0xA0, 0xF6, -+0x69, 0xC2, 0xA0, 0xF6, 0x6A, 0xC2, 0x0C, 0x6B, -+0xA0, 0xF6, 0x6B, 0xC2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0x01, 0x74, 0xAC, 0xEA, 0x09, 0x60, 0x03, 0x24, -+0x02, 0x74, 0x0B, 0x60, 0x20, 0xE8, 0x10, 0xF0, -+0x24, 0x6B, 0x1C, 0xF3, 0x64, 0x9B, 0x09, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF5, 0x70, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF5, -+0x74, 0x9B, 0x40, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6B, 0x6C, 0xEC, 0x01, 0x74, 0x0A, 0x60, -+0x04, 0x24, 0x02, 0x74, 0x00, 0x6A, 0x13, 0x61, -+0x0C, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, -+0x44, 0x9A, 0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF5, 0x50, 0x9A, 0x40, 0xA2, 0x6C, 0xEA, -+0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF5, -+0x54, 0x9A, 0x40, 0xA2, 0x6C, 0xEA, 0x20, 0xE8, -+0xFF, 0x6B, 0x6C, 0xEC, 0x01, 0x74, 0x0A, 0x60, -+0x04, 0x24, 0x02, 0x74, 0x00, 0x6A, 0x13, 0x61, -+0x0C, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF5, -+0x58, 0x9A, 0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF5, 0x5C, 0x9A, 0x40, 0xA2, 0x6C, 0xEA, -+0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF5, -+0x40, 0x9A, 0x40, 0xA2, 0x6C, 0xEA, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xC8, 0xF4, 0x52, 0xA2, 0x01, 0x6B, 0x4C, 0xEB, -+0x00, 0x6A, 0x07, 0x23, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF5, 0x58, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, -+0x08, 0x4B, 0x80, 0xF6, 0xB0, 0xA3, 0x01, 0x6C, -+0xAC, 0xEC, 0x04, 0x24, 0x80, 0xF6, 0x92, 0xA3, -+0x00, 0x18, 0xBC, 0xEF, 0x05, 0x97, 0xFF, 0x6B, -+0x5E, 0x32, 0x6C, 0xEA, 0x03, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x80, 0xF6, 0x90, 0xA2, 0x01, 0x6B, 0x8C, 0xEB, -+0x05, 0x23, 0x00, 0x6B, 0xA0, 0xF6, 0x68, 0xC2, -+0xA0, 0xF6, 0x69, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x80, 0xF6, 0x90, 0xA2, 0x01, 0x6B, 0x8C, 0xEB, -+0x05, 0x23, 0x00, 0x6B, 0xA0, 0xF6, 0x68, 0xC2, -+0xA0, 0xF6, 0x69, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x80, 0xF6, 0x90, 0xA2, 0x01, 0x6B, 0x8C, 0xEB, -+0x05, 0x23, 0x00, 0x6B, 0xA0, 0xF6, 0x68, 0xC2, -+0xA0, 0xF6, 0x69, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0xFF, 0x6C, 0x6F, 0x6D, 0x1F, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x8A, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x0B, 0x23, 0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF3, -+0x84, 0x9B, 0xBF, 0x6B, 0xA0, 0xA4, 0xAC, 0xEB, -+0x60, 0xC4, 0x04, 0x6B, 0x08, 0xF3, 0x6D, 0xC2, -+0x30, 0xF0, 0x20, 0x69, 0xEF, 0xF4, 0x08, 0x49, -+0x80, 0xF6, 0x70, 0xA1, 0x02, 0x6A, 0x6C, 0xEA, -+0x0D, 0x22, 0x80, 0xF6, 0x12, 0xA1, 0x90, 0x67, -+0x00, 0x18, 0xAE, 0xEF, 0xBF, 0x6D, 0x4C, 0xED, -+0x90, 0x67, 0x00, 0x18, 0xA1, 0xEF, 0x04, 0x6A, -+0xA0, 0xF6, 0x4A, 0xC1, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x8A, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x0B, 0x23, 0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF3, -+0x84, 0x9B, 0xBF, 0x6B, 0xA0, 0xA4, 0xAC, 0xEB, -+0x60, 0xC4, 0x00, 0x6B, 0x08, 0xF3, 0x6D, 0xC2, -+0x30, 0xF0, 0x20, 0x69, 0xEF, 0xF4, 0x08, 0x49, -+0x80, 0xF6, 0x70, 0xA1, 0x02, 0x6A, 0x6C, 0xEA, -+0x0D, 0x22, 0x80, 0xF6, 0x12, 0xA1, 0x90, 0x67, -+0x00, 0x18, 0xAE, 0xEF, 0xBF, 0x6D, 0x4C, 0xED, -+0x90, 0x67, 0x00, 0x18, 0xA1, 0xEF, 0x00, 0x6A, -+0xA0, 0xF6, 0x4A, 0xC1, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0xA4, 0x67, -+0x21, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0x8A, 0xA2, -+0x02, 0x6B, 0x8C, 0xEB, 0x03, 0x23, 0x03, 0x6B, -+0x08, 0xF3, 0x6D, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x80, 0xF6, 0x90, 0xA2, -+0x02, 0x6B, 0x8C, 0xEB, 0x03, 0x23, 0x03, 0x6B, -+0xA0, 0xF6, 0x6A, 0xC2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0x8A, 0xA2, -+0x02, 0x6B, 0x8C, 0xEB, 0x03, 0x23, 0x01, 0x6B, -+0x08, 0xF3, 0x6D, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x80, 0xF6, 0x90, 0xA2, -+0x02, 0x6B, 0x8C, 0xEB, 0x03, 0x23, 0x01, 0x6B, -+0xA0, 0xF6, 0x6A, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x3F, 0xF0, -+0x00, 0x18, 0xF4, 0xEF, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x3F, 0xF0, 0x00, 0x18, 0x2C, 0xF0, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x08, 0xF3, 0x8A, 0xA3, 0x02, 0x6A, 0xFF, 0x6D, -+0x8C, 0xEA, 0x0D, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF3, 0x84, 0x9A, 0x40, 0x6E, 0x40, 0xA4, -+0xAC, 0xEA, 0xCD, 0xEA, 0xAC, 0xEA, 0x40, 0xC4, -+0x01, 0x6A, 0x08, 0xF3, 0x4D, 0xC3, 0x30, 0xF0, -+0x20, 0x68, 0xEF, 0xF4, 0x08, 0x48, 0x80, 0xF6, -+0x70, 0xA0, 0x02, 0x6A, 0x6C, 0xEA, 0x0F, 0x22, -+0x80, 0xF6, 0x32, 0xA0, 0x91, 0x67, 0x00, 0x18, -+0xAE, 0xEF, 0x40, 0x6B, 0x4D, 0xEB, 0xFF, 0x6D, -+0x91, 0x67, 0x6C, 0xED, 0x00, 0x18, 0xA1, 0xEF, -+0x01, 0x6A, 0xA0, 0xF6, 0x4A, 0xC0, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x56, 0xF0, -+0x00, 0x18, 0x12, 0xF0, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0xA4, 0x67, -+0x22, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x08, 0xF3, 0x8A, 0xA3, -+0x02, 0x6A, 0xFF, 0x6D, 0x8C, 0xEA, 0x0D, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, 0x84, 0x9A, -+0x40, 0x6E, 0x40, 0xA4, 0xAC, 0xEA, 0xCD, 0xEA, -+0xAC, 0xEA, 0x40, 0xC4, 0x03, 0x6A, 0x08, 0xF3, -+0x4D, 0xC3, 0x30, 0xF0, 0x20, 0x68, 0xEF, 0xF4, -+0x08, 0x48, 0x80, 0xF6, 0x70, 0xA0, 0x02, 0x6A, -+0x6C, 0xEA, 0x0F, 0x22, 0x80, 0xF6, 0x32, 0xA0, -+0x91, 0x67, 0x00, 0x18, 0xAE, 0xEF, 0x40, 0x6B, -+0x4D, 0xEB, 0xFF, 0x6D, 0x91, 0x67, 0x6C, 0xED, -+0x00, 0x18, 0xA1, 0xEF, 0x03, 0x6A, 0xA0, 0xF6, -+0x4A, 0xC0, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x8A, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x03, 0x23, 0x01, 0x6B, 0x08, 0xF3, 0x6D, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x80, 0xF6, 0x90, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x03, 0x23, 0x01, 0x6B, 0xA0, 0xF6, 0x6A, 0xC2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x9B, 0xF0, -+0x00, 0x18, 0x12, 0xF0, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0x6F, 0x6D, -+0x25, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0x8A, 0xA2, -+0x02, 0x6B, 0x8C, 0xEB, 0x0B, 0x23, 0x10, 0xF0, -+0x24, 0x6B, 0x1C, 0xF3, 0x84, 0x9B, 0xBF, 0x6B, -+0xA0, 0xA4, 0xAC, 0xEB, 0x60, 0xC4, 0x04, 0x6B, -+0x08, 0xF3, 0x6D, 0xC2, 0x30, 0xF0, 0x20, 0x69, -+0xEF, 0xF4, 0x08, 0x49, 0x80, 0xF6, 0x70, 0xA1, -+0x02, 0x6A, 0x6C, 0xEA, 0x0D, 0x22, 0x80, 0xF6, -+0x12, 0xA1, 0x90, 0x67, 0x00, 0x18, 0xAE, 0xEF, -+0xBF, 0x6D, 0x4C, 0xED, 0x90, 0x67, 0x00, 0x18, -+0xA1, 0xEF, 0x04, 0x6A, 0xA0, 0xF6, 0x4A, 0xC1, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0x8A, 0xA2, -+0x01, 0x6B, 0x8C, 0xEB, 0x05, 0x23, 0x08, 0xF3, -+0x4D, 0xA2, 0x02, 0x72, 0x00, 0x6A, 0x10, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, -+0x80, 0xF6, 0x50, 0xA3, 0x01, 0x6C, 0x4C, 0xEC, -+0x01, 0x6A, 0x06, 0x24, 0xA0, 0xF6, 0x4A, 0xA3, -+0x02, 0x6B, 0x6E, 0xEA, 0x01, 0x5A, 0x58, 0x67, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x24, 0x67, 0x08, 0xF3, -+0x8A, 0xA3, 0x01, 0x6D, 0xFF, 0x6A, 0xAC, 0xEC, -+0x4C, 0xEC, 0x4C, 0xE9, 0x00, 0x68, 0x05, 0x24, -+0x08, 0xF3, 0x0A, 0xA3, 0x1A, 0x30, 0xAC, 0xE8, -+0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0x80, 0xF6, 0x90, 0xA2, 0x01, 0x6B, -+0x6C, 0xEC, 0x06, 0x24, 0x80, 0xF6, 0x10, 0xA2, -+0xFF, 0x6A, 0x1A, 0x30, 0x6C, 0xE8, 0x4C, 0xE8, -+0x00, 0x18, 0xCA, 0xEF, 0x01, 0x72, 0x25, 0x61, -+0x24, 0x28, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, -+0x72, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, 0x08, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x91, 0x67, 0x01, 0x6D, 0x00, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, -+0x80, 0xF6, 0x50, 0xA3, 0x01, 0x6C, 0x4C, 0xEC, -+0x01, 0x6A, 0x0C, 0x24, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x80, 0xF6, 0xD1, 0xA3, -+0x91, 0x67, 0x01, 0x6D, 0x40, 0xEA, 0x01, 0x6A, -+0x01, 0x10, 0x00, 0x6A, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, 0x59, 0xA2, -+0x05, 0x5A, 0xE0, 0xF0, 0x0C, 0x60, 0x10, 0xF0, -+0x24, 0x6B, 0x48, 0x32, 0x7B, 0xF6, 0x04, 0x4B, -+0x4D, 0xE3, 0x40, 0x9B, 0x00, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, 0x80, 0xF6, -+0x90, 0xA3, 0x04, 0x6A, 0xFF, 0x6D, 0x8C, 0xEA, -+0x19, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0x88, 0x9A, 0x02, 0x6E, 0x40, 0xA4, 0xAC, 0xEA, -+0xCD, 0xEA, 0xAC, 0xEA, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF4, 0x80, 0x9A, 0xF8, 0x6A, -+0xA0, 0xA4, 0xAC, 0xEA, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0x80, 0xF6, 0x74, 0xA3, 0x3C, 0xF5, -+0x44, 0x9A, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x68, 0x9A, 0x83, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, 0x80, 0xF6, -+0xB0, 0xA3, 0x04, 0x6A, 0xFF, 0x6C, 0xAC, 0xEA, -+0x1D, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0xAC, 0x9A, 0x02, 0x6E, 0x40, 0xA5, 0x8C, 0xEA, -+0xCD, 0xEA, 0x8C, 0xEA, 0x40, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF4, 0xA0, 0x9A, 0xF6, 0x4E, -+0x40, 0xA5, 0x8C, 0xEA, 0xCC, 0xEA, 0x01, 0x6E, -+0xCD, 0xEA, 0x8C, 0xEA, 0x40, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0x80, 0xF6, 0x74, 0xA3, 0x3C, 0xF5, -+0x44, 0x9A, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x6C, 0x9A, 0x57, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, 0x80, 0xF6, -+0xB0, 0xA3, 0x04, 0x6A, 0xFF, 0x6C, 0xAC, 0xEA, -+0x1D, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0xB0, 0x9A, 0x02, 0x6E, 0x08, 0x6F, 0x40, 0xA5, -+0xEB, 0xEF, 0x8C, 0xEA, 0xCD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC5, 0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF4, -+0xA0, 0x9A, 0x40, 0xA5, 0x8C, 0xEA, 0xEC, 0xEA, -+0xCD, 0xEA, 0x8C, 0xEA, 0x40, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0x80, 0xF6, 0x74, 0xA3, 0x3C, 0xF5, -+0x44, 0x9A, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x70, 0x9A, 0x2B, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, 0x80, 0xF6, -+0xB0, 0xA3, 0x04, 0x6A, 0xFF, 0x6C, 0xAC, 0xEA, -+0x1D, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0xB4, 0x9A, 0x02, 0x6E, 0x40, 0xA5, 0x8C, 0xEA, -+0xCD, 0xEA, 0x8C, 0xEA, 0x40, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF4, 0xA0, 0x9A, 0xF6, 0x4E, -+0x40, 0xA5, 0x8C, 0xEA, 0xCC, 0xEA, 0x03, 0x6E, -+0xCD, 0xEA, 0x8C, 0xEA, 0x40, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0x80, 0xF6, 0x74, 0xA3, 0x3C, 0xF5, -+0x44, 0x9A, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x74, 0x9A, 0x40, 0xA3, 0xFF, 0x6C, -+0x01, 0x6D, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0x08, 0x4B, 0x80, 0xF6, 0x50, 0xA3, -+0x04, 0x6E, 0xFF, 0x6C, 0xCC, 0xEA, 0x1C, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, 0xB8, 0x9A, -+0x02, 0x6F, 0x40, 0xA5, 0x8C, 0xEA, 0xED, 0xEA, -+0x8C, 0xEA, 0x40, 0xC5, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF4, 0xA0, 0x9A, 0xF6, 0x4F, 0x40, 0xA5, -+0x8C, 0xEA, 0xEC, 0xEA, 0xCD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC5, 0x10, 0xF0, 0x24, 0x6A, 0x80, 0xF6, -+0x74, 0xA3, 0x3C, 0xF5, 0x44, 0x9A, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, 0x78, 0x9A, -+0xFF, 0x6C, 0x01, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x8A, 0xA2, 0x01, 0x6B, 0x6C, 0xEC, -+0x02, 0x24, 0x08, 0xF3, 0x6C, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x80, 0xF6, -+0x90, 0xA2, 0x01, 0x6B, 0x6C, 0xEC, 0x02, 0x24, -+0xA0, 0xF6, 0x69, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, 0x08, 0x4D, -+0x08, 0xF3, 0xCA, 0xA5, 0x02, 0x6B, 0xFF, 0x6A, -+0xCC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x02, 0x2B, -+0x08, 0xF3, 0x8E, 0xC5, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x80, 0xF6, 0xB0, 0xA2, -+0x02, 0x6B, 0xAC, 0xEB, 0x02, 0x2B, 0xA0, 0xF6, -+0x8B, 0xC2, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x74, 0xA0, -+0x7F, 0x6A, 0xFF, 0x69, 0x6C, 0xEA, 0x02, 0x72, -+0x2A, 0x60, 0x68, 0xF3, 0x75, 0xA0, 0x10, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x2C, 0xEA, 0x23, 0x22, -+0x00, 0x18, 0x0B, 0xC9, 0x20, 0x2A, 0x08, 0xF3, -+0x6A, 0xA0, 0x01, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x08, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x00, 0x6D, 0x0C, 0x6C, 0xC5, 0x67, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, -+0x08, 0x4B, 0x80, 0xF6, 0x90, 0xA3, 0x01, 0x6A, -+0x8C, 0xEA, 0x09, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x80, 0xF6, 0xD1, 0xA3, -+0x0C, 0x6C, 0x00, 0x6D, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x08, 0xF3, 0x4A, 0xA3, -+0x01, 0x6C, 0x8C, 0xEA, 0x02, 0x2A, 0x0C, 0x6C, -+0x08, 0x10, 0x08, 0xF3, 0x4A, 0xA3, 0x5A, 0x32, -+0x8C, 0xEA, 0xFF, 0x6C, 0x8C, 0xEA, 0x08, 0xF3, -+0x8E, 0xA3, 0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, -+0x08, 0x4B, 0x80, 0xF6, 0xD0, 0xA3, 0x01, 0x6D, -+0xAC, 0xEE, 0x08, 0x26, 0x80, 0xF6, 0x50, 0xA3, -+0xFF, 0x6C, 0x5A, 0x32, 0xAC, 0xEA, 0x8C, 0xEA, -+0xA0, 0xF6, 0x8B, 0xA3, 0x24, 0x22, 0x02, 0x74, -+0x26, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, -+0x72, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, 0x08, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x02, 0x6C, 0x01, 0x6D, 0x00, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, -+0x80, 0xF6, 0x90, 0xA3, 0x01, 0x6A, 0x8C, 0xEA, -+0x0C, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x80, 0xF6, 0xD1, 0xA3, 0x02, 0x6C, -+0x01, 0x6D, 0x40, 0xEA, 0x02, 0x10, 0x02, 0x74, -+0x02, 0x60, 0x00, 0x18, 0x9F, 0xF1, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x6A, 0xA2, 0x01, 0x6C, 0xA4, 0x67, -+0x6C, 0xED, 0x09, 0x25, 0x08, 0xF3, 0x8B, 0xC2, -+0x02, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x6D, 0xC5, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x80, 0xF6, -+0x70, 0xA2, 0x01, 0x6C, 0xA4, 0x67, 0x6C, 0xED, -+0x09, 0x25, 0xA0, 0xF6, 0x88, 0xC2, 0x02, 0x6A, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x6D, 0xC5, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xEF, 0xF4, -+0x08, 0x48, 0x80, 0xF6, 0x70, 0xA0, 0x01, 0x6A, -+0x6C, 0xEA, 0x26, 0x22, 0xA0, 0xF6, 0x4A, 0xA0, -+0x04, 0x72, 0x22, 0x60, 0xA0, 0xF6, 0x4B, 0xA0, -+0x02, 0x72, 0x1E, 0x60, 0x02, 0x6A, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x18, -+0x6D, 0xC5, 0x16, 0x10, 0x00, 0x18, 0xBE, 0xF1, -+0xA0, 0xF6, 0x4B, 0xA0, 0x08, 0x72, 0x06, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x0C, 0x6C, 0x06, 0x10, 0x09, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x04, 0x6C, -+0x80, 0xF6, 0xD1, 0xA0, 0x00, 0x6D, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, -+0xE0, 0xF1, 0x5F, 0xA3, 0x51, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, -+0xD0, 0xA2, 0x01, 0x6D, 0xFF, 0x6C, 0xAC, 0xEE, -+0x47, 0x26, 0x80, 0xF6, 0x70, 0xA3, 0xAC, 0xEB, -+0x8C, 0xEB, 0x42, 0x23, 0x10, 0xF0, 0x30, 0x6B, -+0x00, 0xF0, 0x00, 0x4B, 0xC1, 0xF7, 0xB0, 0xA3, -+0xFF, 0x75, 0x21, 0x60, 0xFF, 0x4D, 0xC1, 0xF7, -+0xB0, 0xC3, 0xC1, 0xF7, 0xD0, 0xA3, 0x1B, 0x2E, -+0xC1, 0xF7, 0xEF, 0xA3, 0x02, 0x6D, 0xAB, 0xED, -+0xEC, 0xED, 0xC1, 0xF7, 0xEE, 0xA3, 0xC1, 0xF7, -+0xAF, 0xC3, 0x71, 0x6D, 0xAB, 0xED, 0xEC, 0xED, -+0xC1, 0xF7, 0xAE, 0xC3, 0x68, 0xF3, 0xB2, 0xA2, -+0x08, 0xF3, 0xD4, 0xC2, 0x08, 0xF3, 0xB3, 0xC2, -+0xC1, 0xF7, 0x72, 0xA3, 0x0F, 0x6A, 0x6C, 0xEA, -+0x4C, 0xEC, 0x00, 0x18, 0x14, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0xC8, 0xF4, 0xB8, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x48, 0x9A, 0x0F, 0x6B, -+0xA6, 0x35, 0x02, 0x6C, 0x6C, 0xED, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x0E, 0xF6, 0x48, 0x9A, -+0x40, 0xEA, 0x06, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF5, 0x50, 0x9A, 0x06, 0x6C, 0x40, 0xEA, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xFD, 0xF1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xFD, 0xF1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xFD, 0xF1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x04, 0xD2, 0x80, 0xF6, 0x52, 0xA2, 0xFF, 0x69, -+0x04, 0x67, 0x01, 0x72, 0x2C, 0xE8, 0x31, 0x60, -+0x03, 0x22, 0x02, 0x72, 0x60, 0x60, 0xC3, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x54, 0x9B, -+0x01, 0x6C, 0xC0, 0x6D, 0x40, 0xEA, 0x20, 0x6A, -+0x4D, 0xE8, 0x04, 0x92, 0x2C, 0xE8, 0x80, 0xF6, -+0x90, 0xA2, 0x04, 0x6A, 0x8C, 0xEA, 0x2C, 0xEA, -+0x0F, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, -+0x5C, 0x9A, 0x01, 0x6C, 0x10, 0xF0, 0x00, 0x6D, -+0x60, 0xA2, 0x6C, 0xE9, 0x20, 0xC2, 0x30, 0xF0, -+0x20, 0x6B, 0x4E, 0xF2, 0x54, 0x9B, 0x61, 0x10, -+0x02, 0x6B, 0x8C, 0xEB, 0x2C, 0xEB, 0x05, 0x23, -+0x04, 0x93, 0xA0, 0xF6, 0x48, 0xC3, 0xA0, 0xF6, -+0x49, 0xC3, 0x01, 0x6C, 0x10, 0xF0, 0x00, 0x6D, -+0x64, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, -+0x54, 0x9B, 0x01, 0x6C, 0x00, 0xF3, 0x00, 0x6D, -+0x40, 0xEA, 0x20, 0x6A, 0x4D, 0xE8, 0x04, 0x92, -+0x2C, 0xE8, 0x80, 0xF6, 0x90, 0xA2, 0x04, 0x6A, -+0x8C, 0xEA, 0x2C, 0xEA, 0x11, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF3, 0x5C, 0x9A, 0x01, 0x6C, -+0x60, 0xA2, 0x6C, 0xE9, 0x20, 0xC2, 0x30, 0xF0, -+0x20, 0x6B, 0x4E, 0xF2, 0x54, 0x9B, 0x10, 0xF0, -+0x24, 0x6B, 0x5B, 0xF7, 0xA0, 0x9B, 0x31, 0x10, -+0x02, 0x6B, 0x8C, 0xEB, 0x2C, 0xEB, 0x05, 0x23, -+0x04, 0x93, 0xA0, 0xF6, 0x48, 0xC3, 0xA0, 0xF6, -+0x49, 0xC3, 0x10, 0xF0, 0x24, 0x6A, 0x01, 0x6C, -+0x5B, 0xF7, 0xA0, 0x9A, 0x32, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0x4E, 0xF2, 0x54, 0x9B, 0x01, 0x6C, -+0x01, 0xF4, 0x00, 0x6D, 0x40, 0xEA, 0x20, 0x6A, -+0x4D, 0xE8, 0x04, 0x92, 0x2C, 0xE8, 0x80, 0xF6, -+0x90, 0xA2, 0x04, 0x6A, 0x8C, 0xEA, 0x2C, 0xEA, -+0x12, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, -+0x5C, 0x9A, 0x01, 0x6C, 0x60, 0xA2, 0x6C, 0xE9, -+0x20, 0xC2, 0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, -+0x54, 0x9B, 0x10, 0xF0, 0x24, 0x6B, 0x5B, 0xF7, -+0xA4, 0x9B, 0x40, 0xEA, 0x10, 0x10, 0x02, 0x6B, -+0x8C, 0xEB, 0x2C, 0xEB, 0x05, 0x23, 0x04, 0x93, -+0xA0, 0xF6, 0x48, 0xC3, 0xA0, 0xF6, 0x49, 0xC3, -+0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, 0xA4, 0x9A, -+0x01, 0x6C, 0x00, 0x18, 0x42, 0xE1, 0x30, 0xF0, -+0x21, 0x6A, 0x70, 0xF3, 0x98, 0xA2, 0x08, 0x6A, -+0xFF, 0x6B, 0x8C, 0xEA, 0x09, 0x22, 0x10, 0x6A, -+0x8C, 0xEA, 0x6C, 0xEA, 0x02, 0x2A, 0x02, 0x6A, -+0x01, 0x10, 0x04, 0x6A, 0x4D, 0xE8, 0x6C, 0xE8, -+0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, 0x98, 0xA2, -+0x02, 0x6A, 0xFF, 0x6B, 0x8C, 0xEA, 0x08, 0x22, -+0x20, 0x6A, 0x8C, 0xEA, 0x6C, 0xEA, 0x04, 0x22, -+0x80, 0x6A, 0x4B, 0xEA, 0x4D, 0xE8, 0x6C, 0xE8, -+0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, 0xB8, 0xA2, -+0x40, 0x6C, 0x44, 0x67, 0xAC, 0xEA, 0xFF, 0x6B, -+0x06, 0x2A, 0x80, 0x4A, 0xAC, 0xEA, 0x6C, 0xEA, -+0x02, 0x2A, 0x8D, 0xE8, 0x6C, 0xE8, 0x50, 0x67, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xE4, 0xEC, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0x8A, 0xA2, -+0x02, 0x6B, 0x6C, 0xEC, 0x02, 0x24, 0x08, 0xF3, -+0x6D, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0x80, 0xF6, 0x90, 0xA2, 0x02, 0x6B, -+0x6C, 0xEC, 0x02, 0x24, 0xA0, 0xF6, 0x6A, 0xC2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0xC8, 0xF4, 0x72, 0xA2, 0x02, 0x6A, -+0xFF, 0x6C, 0x6C, 0xEA, 0x0A, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF3, 0x64, 0x9A, 0x40, 0x6D, -+0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0x80, 0xF6, 0x90, 0xA2, 0x02, 0x6B, -+0x8C, 0xEB, 0x0C, 0x23, 0x80, 0xF6, 0x12, 0xA2, -+0x90, 0x67, 0x00, 0x18, 0xAE, 0xEF, 0x40, 0x6B, -+0x4D, 0xEB, 0xFF, 0x6D, 0x90, 0x67, 0x6C, 0xED, -+0x00, 0x18, 0xA1, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0xA4, 0x67, -+0x23, 0x6E, 0x40, 0xEA, 0x00, 0x18, 0xE4, 0xEC, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x8A, 0xA2, 0x02, 0x6B, 0x6C, 0xEC, -+0x02, 0x24, 0x08, 0xF3, 0x6D, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x80, 0xF6, -+0x90, 0xA2, 0x02, 0x6B, 0x6C, 0xEC, 0x02, 0x24, -+0xA0, 0xF6, 0x6A, 0xC2, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0xFF, 0x6C, 0xA4, 0x67, 0x20, 0x6E, 0x40, 0xEA, -+0x00, 0x18, 0xE4, 0xEC, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0x8A, 0xA2, -+0x02, 0x6B, 0x6C, 0xEC, 0x02, 0x24, 0x08, 0xF3, -+0x6D, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0x80, 0xF6, 0x90, 0xA2, 0x02, 0x6B, -+0x6C, 0xEC, 0x02, 0x24, 0xA0, 0xF6, 0x6A, 0xC2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x3F, 0xF0, -+0x00, 0x18, 0xF5, 0xF2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x11, 0xED, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0x8A, 0xA2, -+0x02, 0x6B, 0x8C, 0xEB, 0x03, 0x23, 0x03, 0x6B, -+0x08, 0xF3, 0x6D, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x80, 0xF6, 0x90, 0xA2, -+0x02, 0x6B, 0x8C, 0xEB, 0x03, 0x23, 0x03, 0x6B, -+0xA0, 0xF6, 0x6A, 0xC2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x00, 0x18, 0x11, 0xED, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0xFF, 0x6C, 0x6F, 0x6D, 0x24, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x8A, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x0B, 0x23, 0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF3, -+0x84, 0x9B, 0xBF, 0x6B, 0xA0, 0xA4, 0xAC, 0xEB, -+0x60, 0xC4, 0x04, 0x6B, 0x08, 0xF3, 0x6D, 0xC2, -+0x30, 0xF0, 0x20, 0x69, 0xEF, 0xF4, 0x08, 0x49, -+0x80, 0xF6, 0x70, 0xA1, 0x02, 0x6A, 0x6C, 0xEA, -+0x0D, 0x22, 0x80, 0xF6, 0x12, 0xA1, 0x90, 0x67, -+0x00, 0x18, 0xAE, 0xEF, 0xBF, 0x6D, 0x4C, 0xED, -+0x90, 0x67, 0x00, 0x18, 0xA1, 0xEF, 0x04, 0x6A, -+0xA0, 0xF6, 0x4A, 0xC1, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x11, 0xED, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x8A, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x03, 0x23, 0x01, 0x6B, 0x08, 0xF3, 0x6D, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x80, 0xF6, 0x90, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x03, 0x23, 0x01, 0x6B, 0xA0, 0xF6, 0x6A, 0xC2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x3C, 0xF3, -+0x00, 0x18, 0x12, 0xF0, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, 0x08, 0x4D, -+0x08, 0xF3, 0xCA, 0xA5, 0x02, 0x6B, 0xFF, 0x6A, -+0xCC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x00, 0x6A, -+0x02, 0x23, 0x08, 0xF3, 0x4D, 0xA5, 0x30, 0xF0, -+0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, 0x80, 0xF6, -+0xD0, 0xA3, 0x02, 0x6D, 0xCC, 0xED, 0x02, 0x25, -+0xA0, 0xF6, 0x4A, 0xA3, 0x8A, 0xEA, 0x69, 0x60, -+0x05, 0x5C, 0x67, 0x60, 0x10, 0xF0, 0x24, 0x6B, -+0x88, 0x34, 0x7B, 0xF6, 0x18, 0x4B, 0x8D, 0xE3, -+0x60, 0x9B, 0x00, 0xEB, 0x04, 0x72, 0x03, 0x61, -+0x00, 0x18, 0x76, 0xF0, 0x5A, 0x10, 0x02, 0x72, -+0x03, 0x61, 0x00, 0x18, 0x50, 0xF3, 0x55, 0x10, -+0x03, 0x72, 0x03, 0x61, 0x00, 0x18, 0xAE, 0xF0, -+0x50, 0x10, 0x01, 0x72, 0x4E, 0x61, 0x00, 0x18, -+0x12, 0xF0, 0x4B, 0x10, 0x04, 0x72, 0x03, 0x61, -+0x00, 0x18, 0x56, 0xF0, 0x46, 0x10, 0x02, 0x72, -+0x03, 0x61, 0x00, 0x18, 0x3C, 0xF3, 0x41, 0x10, -+0x03, 0x72, 0x03, 0x61, 0x00, 0x18, 0x9B, 0xF0, -+0x3C, 0x10, 0x3B, 0x2A, 0x00, 0x18, 0x3F, 0xF0, -+0x38, 0x10, 0x04, 0x72, 0x03, 0x61, 0x00, 0x18, -+0xCE, 0xF2, 0x33, 0x10, 0x01, 0x72, 0x03, 0x61, -+0x00, 0x18, 0xF5, 0xF2, 0x2E, 0x10, 0x03, 0x72, -+0x03, 0x61, 0x00, 0x18, 0xBF, 0xF2, 0x29, 0x10, -+0x28, 0x2A, 0x00, 0x18, 0x08, 0xF3, 0x25, 0x10, -+0x04, 0x72, 0x03, 0x61, 0x00, 0x18, 0x7B, 0xF0, -+0x20, 0x10, 0x01, 0x72, 0x03, 0x61, 0x00, 0x18, -+0x2C, 0xF0, 0x1B, 0x10, 0x02, 0x72, 0x03, 0x61, -+0x00, 0x18, 0x0D, 0xF3, 0x16, 0x10, 0x15, 0x2A, -+0x00, 0x18, 0x51, 0xF0, 0x12, 0x10, 0x03, 0x72, -+0x03, 0x61, 0x00, 0x18, 0xB3, 0xF0, 0x0D, 0x10, -+0x01, 0x72, 0x03, 0x61, 0x00, 0x18, 0xF4, 0xEF, -+0x08, 0x10, 0x02, 0x72, 0x03, 0x61, 0x00, 0x18, -+0x1D, 0xF3, 0x03, 0x10, 0x02, 0x2A, 0x00, 0x18, -+0x4C, 0xF0, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA7, 0x44, 0x30, 0xF0, 0x21, 0x6C, 0x01, 0x4D, -+0x70, 0xF3, 0x18, 0x4C, 0x18, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, -+0xE0, 0xF1, 0x5F, 0xA3, 0x6A, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xC8, 0xF4, 0x98, 0xA2, 0x01, 0x6A, -+0x4C, 0xEC, 0x15, 0x24, 0x80, 0xF6, 0x90, 0xA3, -+0x8C, 0xEA, 0xFF, 0x6C, 0x8C, 0xEA, 0x0F, 0x22, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0xAF, 0xA2, 0x02, 0x6C, 0xAD, 0xEC, -+0xC1, 0xF7, 0x8F, 0xC2, 0xA0, 0xF6, 0x64, 0x9B, -+0xC1, 0xF7, 0x70, 0xC2, 0x4E, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, -+0xF0, 0xA2, 0x01, 0x6C, 0xA4, 0x67, 0xEC, 0xED, -+0xFF, 0x6B, 0x43, 0x25, 0x30, 0xF0, 0x21, 0x6D, -+0x70, 0xF3, 0xB8, 0xA5, 0x8C, 0xED, 0x6C, 0xED, -+0x3C, 0x2D, 0x10, 0xF0, 0x30, 0x6C, 0x00, 0xF0, -+0x00, 0x4C, 0xC1, 0xF7, 0x0F, 0xA4, 0x02, 0x6E, -+0xCB, 0xEE, 0x0C, 0xEE, 0xC1, 0xF7, 0x0E, 0xA4, -+0xC1, 0xF7, 0xCF, 0xC4, 0x71, 0x6E, 0xCB, 0xEE, -+0x0C, 0xEE, 0xC1, 0xF7, 0xCE, 0xC4, 0x68, 0xF3, -+0x92, 0xA2, 0x08, 0xF3, 0xB4, 0xC2, 0x08, 0xF3, -+0x93, 0xC2, 0x1E, 0x6C, 0xEC, 0xEC, 0x6C, 0xEC, -+0x18, 0x24, 0x08, 0xF3, 0xB0, 0xA2, 0x0F, 0x6A, -+0x02, 0x6C, 0xA6, 0x35, 0x4C, 0xED, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x48, 0x9A, 0x6C, 0xED, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x0E, 0xF6, -+0x48, 0x9A, 0x40, 0xEA, 0x06, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x50, 0x9A, 0x06, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x30, 0x6A, 0xC1, 0xF7, -+0x52, 0xA2, 0x0F, 0x6C, 0x4C, 0xEC, 0x00, 0x18, -+0x14, 0xEC, 0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, -+0x08, 0x4B, 0x80, 0xF6, 0x52, 0xA3, 0x01, 0x72, -+0x6C, 0x60, 0x05, 0x22, 0x02, 0x72, 0x00, 0x6C, -+0x20, 0xF1, 0x13, 0x61, 0xC9, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF3, 0x44, 0x9A, 0xFF, 0x6D, -+0x08, 0x6F, 0x80, 0xA2, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF3, 0xC8, 0x9A, 0xEB, 0xEF, 0xAC, 0xEC, -+0x40, 0xA6, 0xAC, 0xEA, 0xEC, 0xEA, 0x80, 0xF6, -+0xF1, 0xA3, 0xED, 0xEA, 0xAC, 0xEA, 0x40, 0xC6, -+0x80, 0xF6, 0x70, 0xA3, 0x08, 0x6A, 0x6C, 0xEA, -+0xAC, 0xEA, 0x00, 0xF1, 0x16, 0x22, 0x10, 0x6E, -+0x43, 0x67, 0xCC, 0xEA, 0xAC, 0xEA, 0x07, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF5, 0x68, 0x9A, -+0x8F, 0x6A, 0xA0, 0xA3, 0x0A, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF5, 0x68, 0x9A, 0x71, 0x6F, -+0xEB, 0xEF, 0x40, 0xA3, 0xAC, 0xEA, 0xEC, 0xEA, -+0xCD, 0xEA, 0xAC, 0xEA, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x10, 0xF0, -+0x24, 0x6B, 0x80, 0xF6, 0xB8, 0x9A, 0x3C, 0xF5, -+0x6C, 0x9B, 0x01, 0x6E, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0x80, 0xF6, 0xBC, 0x9A, 0x3C, 0xF5, -+0x70, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xA0, 0xF6, 0xA0, 0x9A, 0x3C, 0xF5, 0x74, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xA0, 0xF6, -+0xA4, 0x9A, 0x3C, 0xF5, 0x78, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x3C, 0xF5, 0x7C, 0x9B, -+0x80, 0xF6, 0x50, 0xA2, 0xFF, 0x6D, 0xE0, 0xA3, -+0x52, 0x32, 0xCC, 0xEA, 0xC4, 0xEA, 0xAC, 0xEF, -+0x46, 0x67, 0xED, 0xEA, 0xAC, 0xEA, 0x40, 0xC3, -+0xCC, 0x10, 0x10, 0xF0, 0x24, 0x6D, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF3, 0x08, 0x9D, 0x1C, 0xF5, -+0x50, 0x9A, 0x80, 0xF6, 0xB1, 0xA3, 0x71, 0x6E, -+0x80, 0xA2, 0xE0, 0xA0, 0xFF, 0x6A, 0xCB, 0xEE, -+0x4C, 0xEF, 0xB0, 0x35, 0xCC, 0xEF, 0xED, 0xED, -+0x4C, 0xED, 0xA0, 0xC0, 0x80, 0xF6, 0xB0, 0xA3, -+0x08, 0x6B, 0x4C, 0xEC, 0xAC, 0xEB, 0x4C, 0xEB, -+0xA0, 0xF0, 0x0F, 0x23, 0x10, 0x6B, 0xAC, 0xEB, -+0x4C, 0xEB, 0x09, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x3C, 0xF5, 0xA8, 0x9B, 0x60, 0xA5, 0x4C, 0xEB, -+0xCC, 0xEB, 0x20, 0x6E, 0x08, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x3C, 0xF5, 0xA8, 0x9B, 0x60, 0xA5, -+0x4C, 0xEB, 0xCC, 0xEB, 0x30, 0x6E, 0xCD, 0xEB, -+0x4C, 0xEB, 0x30, 0xF0, 0x20, 0x6A, 0x60, 0xC5, -+0xEF, 0xF4, 0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6B, -+0x80, 0xF6, 0xB8, 0x9A, 0x3C, 0xF5, 0x6C, 0x9B, -+0x01, 0x6F, 0xFF, 0x6E, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0x80, 0xF6, 0xBC, 0x9A, 0x3C, 0xF5, -+0x70, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xA0, 0xF6, 0xA0, 0x9A, 0x3C, 0xF5, 0x74, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xA0, 0xF6, -+0xA4, 0x9A, 0x3C, 0xF5, 0x78, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x3C, 0xF5, 0xBC, 0x9B, -+0x80, 0xF6, 0x70, 0xA2, 0x00, 0xA5, 0x72, 0x33, -+0xEC, 0xEB, 0xCC, 0xE8, 0x42, 0x43, 0x64, 0x10, -+0x10, 0xF0, 0x24, 0x6D, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF5, 0x54, 0x9A, 0x5C, 0xF5, 0xC0, 0x9D, -+0x08, 0x6F, 0x80, 0xA2, 0xA0, 0xA6, 0xFF, 0x6A, -+0xEB, 0xEF, 0x4C, 0xED, 0xEC, 0xED, 0x80, 0xF6, -+0xF1, 0xA3, 0x4C, 0xEC, 0xED, 0xED, 0x4C, 0xED, -+0xA0, 0xC6, 0x80, 0xF6, 0xB0, 0xA3, 0x08, 0x6B, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4E, 0x23, 0x10, 0x6B, -+0xAC, 0xEB, 0x4C, 0xEB, 0x0B, 0x2B, 0x10, 0xF0, -+0x24, 0x6B, 0x3C, 0xF5, 0xA8, 0x9B, 0x71, 0x6E, -+0xCB, 0xEE, 0x60, 0xA5, 0x4C, 0xEB, 0xCC, 0xEB, -+0x40, 0x6E, 0x0A, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x3C, 0xF5, 0xA8, 0x9B, 0x71, 0x6E, 0xCB, 0xEE, -+0x60, 0xA5, 0x4C, 0xEB, 0xCC, 0xEB, 0x50, 0x6E, -+0xCD, 0xEB, 0x4C, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0x60, 0xC5, 0xEF, 0xF4, 0x08, 0x4A, 0x10, 0xF0, -+0x24, 0x6B, 0x80, 0xF6, 0xB8, 0x9A, 0x3C, 0xF5, -+0x6C, 0x9B, 0x01, 0x6F, 0xFF, 0x6E, 0xA0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x80, 0xF6, 0xBC, 0x9A, -+0x3C, 0xF5, 0x70, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xA0, 0xF6, 0xA0, 0x9A, 0x3C, 0xF5, -+0x74, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xA0, 0xF6, 0xA4, 0x9A, 0x3C, 0xF5, 0x78, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x3C, 0xF5, -+0xBC, 0x9B, 0x80, 0xF6, 0x70, 0xA2, 0x00, 0xA5, -+0x72, 0x33, 0xEC, 0xEB, 0xCC, 0xE8, 0x44, 0x43, -+0xE4, 0xEA, 0x47, 0x67, 0x0D, 0xEA, 0xCC, 0xEA, -+0x40, 0xC5, 0x10, 0xF0, 0x24, 0x6A, 0x1B, 0xF7, -+0x54, 0x9A, 0xFF, 0x69, 0x00, 0x6D, 0x60, 0xA2, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, 0x4C, 0x9A, -+0x2C, 0xEB, 0x30, 0xF0, 0x20, 0x68, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF3, 0x70, 0x9B, -+0xEF, 0xF4, 0x08, 0x48, 0xA0, 0xC3, 0x10, 0xF0, -+0x24, 0x6B, 0x1C, 0xF3, 0x74, 0x9B, 0x20, 0x6D, -+0xA0, 0xC3, 0x40, 0xA2, 0x10, 0xF0, 0x24, 0x6B, -+0x1C, 0xF3, 0x78, 0x9B, 0x2C, 0xEA, 0x50, 0x32, -+0x01, 0x4A, 0x2C, 0xEA, 0x40, 0xC3, 0x80, 0xF6, -+0x70, 0xA0, 0x01, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x60, 0x22, 0x00, 0x18, 0x50, 0xF2, 0x04, 0xD2, -+0x00, 0x18, 0x0C, 0xF1, 0x80, 0xF6, 0x92, 0xA0, -+0x04, 0x95, 0x00, 0x18, 0xA1, 0xEF, 0x80, 0xF6, -+0x70, 0xA0, 0x02, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x16, 0x22, 0xA0, 0xF6, 0x4A, 0xA0, 0x03, 0x2A, -+0x01, 0x6C, 0x00, 0x18, 0x55, 0xF3, 0x30, 0xF0, -+0x21, 0x6A, 0x70, 0xF3, 0x78, 0xA2, 0x40, 0x6A, -+0x04, 0x6C, 0x6C, 0xEA, 0x05, 0x2A, 0x00, 0x18, -+0xCA, 0xEF, 0x01, 0x6C, 0x01, 0x2A, 0x02, 0x6C, -+0x00, 0x18, 0x55, 0xF3, 0x33, 0x10, 0x40, 0x6A, -+0x6C, 0xEA, 0x2C, 0xEA, 0x0B, 0x22, 0xA0, 0xF6, -+0x4B, 0xA0, 0x02, 0x72, 0x2B, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x02, 0x6C, -+0x00, 0x6D, 0x1A, 0x10, 0xA0, 0xF6, 0x4B, 0xA0, -+0x02, 0x72, 0x1A, 0x61, 0x00, 0x18, 0xC2, 0xCC, -+0x00, 0x18, 0xCA, 0xEF, 0x01, 0x72, 0x0A, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x2E, 0xF4, 0x48, 0x9A, 0x48, 0xF5, 0x80, 0xA3, -+0x01, 0x6D, 0x06, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x00, 0x6C, 0xA4, 0x67, -+0x80, 0xF6, 0xD1, 0xA0, 0x40, 0xEA, 0x06, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0xA0, 0xF6, 0x4B, 0xC0, 0x10, 0xF0, 0x24, 0x6A, -+0x3C, 0xF3, 0x40, 0x9A, 0x22, 0x6B, 0x60, 0xC2, -+0x3E, 0x10, 0x80, 0xF6, 0x92, 0xA0, 0x00, 0x6D, -+0x00, 0x18, 0xA1, 0xEF, 0x80, 0xF6, 0x70, 0xA0, -+0x02, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, 0x08, 0x22, -+0xA0, 0xF6, 0x4A, 0xA0, 0x04, 0x72, 0x2F, 0x61, -+0x00, 0x6C, 0x00, 0x18, 0x55, 0xF3, 0x2B, 0x10, -+0xA0, 0xF6, 0x4B, 0xA0, 0x02, 0x72, 0x06, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x04, 0x6C, 0x07, 0x10, 0x08, 0x72, 0x09, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x0C, 0x6C, 0x80, 0xF6, 0xD1, 0xA0, 0x01, 0x6D, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x68, 0xEF, 0xF4, -+0x08, 0x48, 0x80, 0xF6, 0x91, 0xA0, 0x00, 0x18, -+0x65, 0xC5, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x48, 0xF5, -+0x80, 0xA3, 0x80, 0xF6, 0xD1, 0xA0, 0x01, 0x6D, -+0x40, 0xEA, 0x00, 0x18, 0x8E, 0xEF, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x00, 0x6A, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x80, 0xF6, 0x70, 0xA2, -+0x01, 0x6C, 0xFF, 0x6D, 0x6C, 0xEC, 0x3D, 0x24, -+0xA0, 0xF6, 0x8A, 0xA2, 0x04, 0x74, 0x39, 0x60, -+0xA0, 0xF6, 0x8B, 0xA2, 0x02, 0x74, 0x35, 0x60, -+0x02, 0x6C, 0x6C, 0xEC, 0xAC, 0xEC, 0x03, 0x24, -+0x00, 0x18, 0x6D, 0xC5, 0x2E, 0x10, 0x80, 0x6C, -+0x8B, 0xEC, 0x6C, 0xEC, 0xAC, 0xEC, 0x05, 0x24, -+0x80, 0xF6, 0x93, 0xA2, 0x00, 0x18, 0xDE, 0xC4, -+0x08, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0xFF, 0x6C, 0xA4, 0x67, 0xC4, 0x67, -+0x40, 0xEA, 0x00, 0x18, 0xB6, 0xC4, 0x30, 0xF0, -+0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, 0xA0, 0xF6, -+0x4B, 0xA3, 0x0C, 0x72, 0x07, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x08, 0x6C, -+0x00, 0x6D, 0x08, 0x10, 0x04, 0x72, 0x09, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x00, 0x6C, 0xA4, 0x67, 0x80, 0xF6, 0xD1, 0xA3, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0xE0, 0xF1, 0x7F, 0xA2, 0xA0, 0xF0, -+0x04, 0x2B, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x08, 0xF3, 0x90, 0xA0, 0x01, 0x6B, -+0xFF, 0x69, 0x6C, 0xEC, 0x80, 0xF0, 0x19, 0x24, -+0x80, 0xF6, 0x50, 0xA2, 0x6C, 0xEA, 0x2C, 0xEA, -+0x80, 0xF0, 0x13, 0x22, 0x10, 0xF0, 0x30, 0x6C, -+0x00, 0xF0, 0x00, 0x4C, 0xC1, 0xF7, 0xAF, 0xA4, -+0x02, 0x6A, 0xAC, 0xEA, 0x2C, 0xEA, 0x48, 0x22, -+0xAD, 0xEB, 0xC1, 0xF7, 0x6F, 0xC4, 0x10, 0xF0, -+0x30, 0x6C, 0xE6, 0xF1, 0x11, 0x4C, 0x00, 0x18, -+0x8B, 0xE9, 0x30, 0xF0, 0x20, 0x6A, 0x0E, 0xF6, -+0x98, 0x9A, 0x00, 0x18, 0x8B, 0xE9, 0x08, 0xF3, -+0x52, 0xA0, 0x0F, 0x6B, 0x4C, 0xEB, 0x2C, 0xEB, -+0x00, 0x6A, 0x11, 0x10, 0x1E, 0x6D, 0xB8, 0xEA, -+0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, -+0x12, 0xED, 0x91, 0xE5, 0x08, 0xF3, 0xB9, 0xA4, -+0x07, 0x6C, 0xAC, 0xEC, 0x02, 0x74, 0x05, 0x60, -+0x01, 0x4A, 0xFF, 0x6C, 0x8C, 0xEA, 0x62, 0xEA, -+0xED, 0x61, 0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, -+0x08, 0x4D, 0x08, 0xF3, 0xD0, 0xA5, 0x0F, 0x6C, -+0x1F, 0x6B, 0x8C, 0xEA, 0x6B, 0xEB, 0x44, 0x32, -+0xCC, 0xEB, 0x4D, 0xEB, 0x10, 0xF0, 0x30, 0x68, -+0x08, 0xF3, 0x70, 0xC5, 0x00, 0xF0, 0x00, 0x48, -+0xC1, 0xF7, 0x52, 0xA0, 0x4C, 0xEC, 0x00, 0x18, -+0x3A, 0xEC, 0xC1, 0xF7, 0x6F, 0xA0, 0x03, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0xC1, 0xF7, 0x4F, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF4, 0xB8, 0xA2, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, 0x48, 0x9A, -+0x0F, 0x6B, 0xA6, 0x35, 0x02, 0x6C, 0x6C, 0xED, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x0E, 0xF6, -+0x48, 0x9A, 0x40, 0xEA, 0x06, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x50, 0x9A, 0x06, 0x6C, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6C, 0xC8, 0xF4, -+0xB8, 0xA4, 0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF3, -+0x58, 0x9A, 0x0F, 0x6C, 0xA6, 0x35, 0x8C, 0xED, -+0x10, 0xF0, 0x30, 0x6B, 0xE0, 0xF7, 0x08, 0x4D, -+0xE0, 0xA2, 0xA4, 0x35, 0x30, 0xF0, 0x21, 0x6A, -+0x00, 0xF0, 0x00, 0x4B, 0x90, 0xF3, 0x40, 0x9A, -+0x6D, 0xE5, 0x63, 0xA3, 0xFF, 0x6E, 0x42, 0x32, -+0x4A, 0x32, 0x6C, 0xEC, 0xCC, 0xEF, 0x93, 0xE2, -+0x6F, 0x47, 0x30, 0xF0, 0x20, 0x6A, 0x77, 0x33, -+0xEE, 0xF5, 0x54, 0x9A, 0x73, 0xE4, 0xCC, 0xEC, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xE3, 0xF4, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xE3, 0xF4, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xE3, 0xF4, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x4C, 0xED, -+0x4C, 0xEC, 0x4C, 0xEE, 0xEC, 0xEA, 0x05, 0x25, -+0x01, 0x75, 0x56, 0x61, 0x08, 0x6B, 0x0C, 0x6D, -+0x02, 0x10, 0x0A, 0x6B, 0x0E, 0x6D, 0x01, 0x74, -+0x1D, 0x60, 0x02, 0x74, 0x2A, 0x60, 0x26, 0x67, -+0xE1, 0x45, 0xC4, 0xED, 0x24, 0xEB, 0x82, 0x67, -+0xCD, 0xE9, 0x84, 0xEF, 0xC1, 0x43, 0x8D, 0xE9, -+0x44, 0xEE, 0x4D, 0xE9, 0x01, 0x6A, 0x02, 0x67, -+0x04, 0xEB, 0x62, 0x67, 0x64, 0xED, 0xA2, 0x67, -+0x6D, 0xE8, 0xA4, 0xEF, 0xAD, 0xE8, 0x44, 0xEE, -+0xFF, 0xF7, 0x1F, 0x6C, 0x4D, 0xE8, 0x8C, 0xE9, -+0x8C, 0xE8, 0x1E, 0x10, 0x01, 0x6B, 0x01, 0x45, -+0x22, 0x67, 0x83, 0x67, 0x24, 0xE8, 0xC4, 0xED, -+0x84, 0xE8, 0xCD, 0xE9, 0xFF, 0xF7, 0x1F, 0x6A, -+0x04, 0x67, 0x64, 0xED, 0x4C, 0xE9, 0x6D, 0xE8, -+0x0E, 0x10, 0x01, 0x6C, 0x01, 0x43, 0x22, 0x67, -+0xA4, 0x67, 0x24, 0xE8, 0xC4, 0xEB, 0xA4, 0xE8, -+0xCD, 0xE9, 0xFF, 0xF7, 0x1F, 0x6A, 0x05, 0x67, -+0x84, 0xEB, 0x4C, 0xE9, 0x8D, 0xE8, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF3, 0x4C, 0x9A, -+0x38, 0x6C, 0x0F, 0xE8, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF3, 0x40, 0x9A, 0x40, 0xEA, -+0x4C, 0xE8, 0x04, 0x92, 0x2D, 0xE8, 0xFF, 0xF7, -+0x1F, 0x6D, 0x38, 0x6C, 0x0C, 0xED, 0x40, 0xEA, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0xE8, 0xF2, 0x7C, 0xA3, 0xFF, 0x6A, 0xAC, 0xEA, -+0x01, 0x73, 0x03, 0x61, 0xAD, 0xF4, 0x00, 0x6B, -+0x04, 0x10, 0x03, 0x73, 0x04, 0x61, 0xA5, 0xF1, -+0x00, 0x6B, 0x6B, 0xEB, 0x02, 0x10, 0x60, 0xF2, -+0x00, 0x6B, 0x60, 0xCC, 0x30, 0xF0, 0x20, 0x6B, -+0xE8, 0xF2, 0x7C, 0xA3, 0x02, 0x73, 0x0A, 0x61, -+0x10, 0xF0, 0x24, 0x6B, 0x7C, 0xF5, 0x6C, 0x9B, -+0x74, 0x6D, 0xA0, 0xC3, 0xA0, 0xAC, 0x80, 0x6B, -+0xAD, 0xEB, 0x60, 0xCC, 0x09, 0x22, 0x60, 0xAC, -+0x00, 0xF2, 0x01, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x41, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x06, 0x10, -+0x60, 0xAC, 0x00, 0xF2, 0x00, 0x6A, 0x6D, 0xEA, -+0x40, 0x6B, 0x6D, 0xEA, 0x40, 0xCC, 0x20, 0xE8, -+0xFF, 0x63, 0x01, 0xD1, 0x00, 0xD0, 0x30, 0xF0, -+0x20, 0x6B, 0xE8, 0xF2, 0x7C, 0xA3, 0xFF, 0x6A, -+0x8C, 0xEA, 0x02, 0x73, 0x70, 0x61, 0x48, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF2, 0xFC, 0x9A, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x60, 0x9F, 0xC0, 0xF0, 0x60, 0xDA, 0x10, 0xF0, -+0x24, 0x6B, 0x7C, 0xF2, 0xC8, 0x9B, 0x60, 0x9E, -+0xA0, 0xF0, 0x74, 0xDA, 0x10, 0xF0, 0x24, 0x6B, -+0xFC, 0xF4, 0xB8, 0x9B, 0x60, 0x9D, 0xA0, 0xF0, -+0x78, 0xDA, 0x10, 0xF0, 0x24, 0x6B, 0xFC, 0xF2, -+0x9C, 0x9B, 0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF3, -+0x60, 0x9B, 0x20, 0x9C, 0xA0, 0xF0, 0x30, 0xDA, -+0x00, 0x9B, 0xA0, 0xF0, 0x1C, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF5, 0x50, 0x9A, 0x2D, 0xEA, -+0x18, 0xF0, 0x01, 0x69, 0x2B, 0xE9, 0x2C, 0xEA, -+0x10, 0xF0, 0x24, 0x69, 0x1C, 0xF0, 0x28, 0x99, -+0x0D, 0xE9, 0x02, 0xF0, 0x01, 0x68, 0x0B, 0xE8, -+0x0C, 0xE9, 0x10, 0xF0, 0x24, 0x68, 0x7C, 0xF5, -+0x14, 0x98, 0x00, 0xDF, 0x04, 0x6F, 0xE0, 0xDE, -+0x10, 0xF0, 0x24, 0x6E, 0x7C, 0xF5, 0xD8, 0x9E, -+0xC0, 0xDD, 0x40, 0xDC, 0x20, 0xDB, 0x27, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x10, 0xF0, 0x24, 0x6B, 0xC0, 0xF0, 0x80, 0x9A, -+0x7C, 0xF2, 0x7C, 0x9B, 0x80, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xA0, 0xF0, 0x94, 0x9A, 0x7C, 0xF2, -+0x68, 0x9B, 0x80, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xA0, 0xF0, 0x98, 0x9A, 0xFC, 0xF4, 0x78, 0x9B, -+0x80, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xA0, 0xF0, -+0x90, 0x9A, 0xFC, 0xF2, 0x7C, 0x9B, 0x80, 0xDB, -+0xA0, 0xF0, 0x7C, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF3, 0x40, 0x9A, 0x60, 0xDA, 0x01, 0x91, -+0x00, 0x90, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0xFF, 0xF7, 0x1F, 0x6B, 0xAC, 0xEB, 0x06, 0xD3, -+0x10, 0xF0, 0x24, 0x6B, 0xFB, 0xF7, 0x64, 0x9B, -+0xFF, 0x6A, 0x8C, 0xEA, 0x80, 0xAB, 0xE1, 0xF7, -+0x1F, 0x6B, 0x00, 0x68, 0x8C, 0xEB, 0x69, 0xE2, -+0x10, 0xF0, 0x24, 0x6B, 0x7C, 0xF5, 0x9C, 0x9B, -+0x5C, 0x32, 0x91, 0xE2, 0x04, 0xD4, 0x22, 0x10, -+0x04, 0x92, 0x40, 0x9A, 0x05, 0xD2, 0x0D, 0x28, -+0x30, 0xF0, 0x20, 0x69, 0xCE, 0xF4, 0x50, 0x99, -+0x05, 0x96, 0x01, 0x6D, 0x83, 0xF1, 0x18, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x99, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x05, 0x96, 0x01, 0x6D, 0x83, 0xF1, -+0x18, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x04, 0x93, -+0x01, 0x48, 0xFF, 0xF7, 0x1F, 0x6A, 0x04, 0x4B, -+0x4C, 0xE8, 0x04, 0xD3, 0x06, 0x92, 0x43, 0xE8, -+0xDB, 0x61, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xDE, 0x63, 0x43, 0x62, -+0x42, 0xD1, 0x41, 0xD0, 0x01, 0x68, 0x00, 0x6A, -+0x0B, 0xE8, 0x04, 0xD2, 0x00, 0x6C, 0x30, 0xF0, -+0x20, 0x6A, 0x42, 0x6D, 0xD0, 0x67, 0xEF, 0xF4, -+0x30, 0xA2, 0x00, 0x18, 0x2F, 0xE7, 0x10, 0xF0, -+0x24, 0x6B, 0xBB, 0xF7, 0x64, 0x9B, 0x4C, 0xEB, -+0x36, 0x2B, 0x00, 0x6C, 0x42, 0x6D, 0xD0, 0x67, -+0x00, 0x18, 0x2F, 0xE7, 0x1F, 0xF4, 0x00, 0x6B, -+0x4C, 0xEB, 0x62, 0x32, 0x4A, 0x32, 0x43, 0xE9, -+0x04, 0xD2, 0x02, 0x61, 0x4E, 0xE9, 0x16, 0x29, -+0x01, 0x6A, 0x7D, 0x67, 0x4B, 0xEA, 0x54, 0xC3, -+0x1D, 0x6A, 0x56, 0xC3, 0x04, 0x6A, 0x57, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x06, 0x04, 0x04, 0x05, 0x04, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x5C, 0x9A, -+0x05, 0x04, 0x40, 0xEA, 0x01, 0x68, 0x0B, 0xE8, -+0x00, 0x6C, 0x42, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x2F, 0xE7, 0x10, 0xF0, 0x24, 0x6B, 0xBB, 0xF7, -+0xE4, 0x9B, 0x00, 0x6C, 0x42, 0x6D, 0xD0, 0x67, -+0x4D, 0xEF, 0x00, 0x18, 0x42, 0xE7, 0x43, 0x97, -+0x42, 0x91, 0x41, 0x90, 0x22, 0x63, 0x00, 0xEF, -+0xFF, 0x21, 0x03, 0x80, 0x15, 0x22, 0x03, 0x80, -+0x2B, 0x22, 0x03, 0x80, 0x41, 0x22, 0x03, 0x80, -+0x5B, 0x22, 0x03, 0x80, 0xB3, 0x22, 0x03, 0x80, -+0xC9, 0x22, 0x03, 0x80, 0xE7, 0x22, 0x03, 0x80, -+0x19, 0x23, 0x03, 0x80, 0x43, 0x23, 0x03, 0x80, -+0xEF, 0x33, 0x03, 0x80, 0xF5, 0x33, 0x03, 0x80, -+0x01, 0x34, 0x03, 0x80, 0x0D, 0x34, 0x03, 0x80, -+0x19, 0x34, 0x03, 0x80, 0x61, 0x37, 0x03, 0x80, -+0x49, 0x38, 0x03, 0x80, 0xC3, 0x37, 0x03, 0x80, -+0x49, 0x38, 0x03, 0x80, 0x09, 0x37, 0x03, 0x80, -+0x49, 0x38, 0x03, 0x80, 0x49, 0x38, 0x03, 0x80, -+0x49, 0x38, 0x03, 0x80, 0x2B, 0x38, 0x03, 0x80, -+0x49, 0x38, 0x03, 0x80, 0x49, 0x38, 0x03, 0x80, -+0x49, 0x38, 0x03, 0x80, 0xA3, 0x36, 0x03, 0x80, -+0x37, 0x3B, 0x03, 0x80, 0x41, 0x3B, 0x03, 0x80, -+0x4B, 0x3B, 0x03, 0x80, 0x55, 0x3B, 0x03, 0x80, -+0x5F, 0x3B, 0x03, 0x80, 0xFD, 0x3C, 0x03, 0x80, -+0x1D, 0x3D, 0x03, 0x80, 0x3D, 0x3D, 0x03, 0x80, -+0x5D, 0x3D, 0x03, 0x80, 0x7D, 0x3D, 0x03, 0x80, -+0x83, 0x3F, 0x03, 0x80, 0xBF, 0x3F, 0x03, 0x80, -+0x05, 0x40, 0x03, 0x80, 0x47, 0x40, 0x03, 0x80, -+0x8D, 0x40, 0x03, 0x80, 0xFB, 0x40, 0x03, 0x80, -+0x17, 0x41, 0x03, 0x80, 0x39, 0x41, 0x03, 0x80, -+0x5B, 0x41, 0x03, 0x80, 0x7F, 0x41, 0x03, 0x80, -+0xA8, 0x06, 0x10, 0x07, 0x00, 0x16, 0x04, 0x16, -+0x08, 0x16, 0x00, 0x00, 0x47, 0x45, 0x03, 0x80, -+0xA3, 0x45, 0x03, 0x80, 0x37, 0x46, 0x03, 0x80, -+0xCB, 0x46, 0x03, 0x80, 0x63, 0x47, 0x03, 0x80, -+0x3B, 0x14, 0x03, 0x80, 0x45, 0x14, 0x03, 0x80, -+0x4F, 0x14, 0x03, 0x80, 0x59, 0x14, 0x03, 0x80, -+0x63, 0x14, 0x03, 0x80, 0x31, 0x4E, 0x03, 0x80, -+0x2B, 0x4E, 0x03, 0x80, 0x37, 0x4E, 0x03, 0x80, -+0x3D, 0x4E, 0x03, 0x80, 0x43, 0x4E, 0x03, 0x80, -+0x49, 0x4E, 0x03, 0x80, 0x94, 0x0C, 0x94, 0x0E, -+0x94, 0x18, 0x94, 0x1A, 0x00, 0x01, 0x02, 0x03, -+0x05, 0x00, 0x00, 0x00, 0x00, 0x01, 0x03, 0x04, -+0x05, 0x00, 0x00, 0x00, 0x09, 0x12, 0x1B, 0x24, -+0x9D, 0x6E, 0x10, 0x80, 0xE3, 0x6E, 0x10, 0x80, -+0xA5, 0x6E, 0x10, 0x80, 0xD5, 0x6E, 0x10, 0x80, -+0xE3, 0x6E, 0x10, 0x80, 0xE3, 0x6E, 0x10, 0x80, -+0xE3, 0x6E, 0x10, 0x80, 0xAD, 0x6E, 0x10, 0x80, -+0xB5, 0x6E, 0x10, 0x80, 0xBD, 0x6E, 0x10, 0x80, -+0xE3, 0x6E, 0x10, 0x80, 0xE3, 0x6E, 0x10, 0x80, -+0xDD, 0x6E, 0x10, 0x80, 0xCD, 0x6E, 0x10, 0x80, -+0xC5, 0x6E, 0x10, 0x80, 0x04, 0x08, 0x08, 0x08, -+0x08, 0x08, 0x0A, 0x0A, 0x0A, 0x00, 0x00, 0x00, -+0x00, 0x04, 0x0C, 0x14, 0x1C, 0x24, 0x2C, 0x36, -+0x40, 0x00, 0x00, 0x00, 0xD7, 0x7D, 0x10, 0x80, -+0xED, 0x7D, 0x10, 0x80, 0xD7, 0x7D, 0x10, 0x80, -+0xED, 0x7D, 0x10, 0x80, 0xD7, 0x7D, 0x10, 0x80, -+0xED, 0x7D, 0x10, 0x80, 0x1D, 0x7E, 0x10, 0x80, -+0x1D, 0x7E, 0x10, 0x80, 0x1D, 0x7E, 0x10, 0x80, -+0xDB, 0x7D, 0x10, 0x80, 0x03, 0x7E, 0x10, 0x80, -+0x03, 0x7E, 0x10, 0x80, 0xDB, 0x7D, 0x10, 0x80, -+0x35, 0x7E, 0x10, 0x80, 0x51, 0x7E, 0x10, 0x80, -+0x25, 0x91, 0x10, 0x80, 0x75, 0x91, 0x10, 0x80, -+0xFD, 0x91, 0x10, 0x80, 0x53, 0x92, 0x10, 0x80, -+0x77, 0x92, 0x10, 0x80, 0x07, 0x08, 0x09, 0x0A, -+0x0B, 0x0C, 0x0D, 0x0E, 0x0F, 0x10, 0x00, 0x00, -+0x12, 0x12, 0x14, 0x12, 0x0F, 0x0F, 0x0C, 0x0C, -+0x09, 0x08, 0x08, 0x07, 0x0A, 0x0A, 0x09, 0x07, -+0x07, 0x06, 0x05, 0x04, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x0A, 0x0A, 0x08, 0x08, -+0x08, 0x07, 0x07, 0x06, 0x04, 0x04, 0x0C, 0x0C, -+0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, 0x05, 0x04, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x05, -+0x04, 0x04, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x28, 0x28, 0x32, 0x28, -+0x1E, 0x19, 0x19, 0x19, 0x18, 0x18, 0x12, 0x0F, -+0x14, 0x1E, 0x19, 0x1E, 0x18, 0x16, 0x0C, 0x0C, -+0x1E, 0x1E, 0x19, 0x1E, 0x18, 0x16, 0x0C, 0x0C, -+0x1E, 0x1E, 0x19, 0x1C, 0x18, 0x14, 0x0C, 0x0A, -+0x1E, 0x1E, 0x19, 0x1E, 0x19, 0x18, 0x0F, 0x0E, -+0x14, 0x28, 0x21, 0x1E, 0x1A, 0x16, 0x0B, 0x10, -+0x0A, 0x0A, 0x2D, 0x28, 0x21, 0x1E, 0x1A, 0x16, -+0x0B, 0x10, 0x0A, 0x0A, 0x1E, 0x1E, 0x1E, 0x1E, -+0x18, 0x16, 0x0D, 0x0D, 0x0A, 0x08, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x4A, 0x40, 0x36, 0x2C, 0x24, 0x1C, 0x14, 0x0C, -+0x04, 0x00, 0x00, 0x00, 0x4B, 0xA6, 0x10, 0x80, -+0x9F, 0xA6, 0x10, 0x80, 0x2D, 0xA7, 0x10, 0x80, -+0x2D, 0xA8, 0x10, 0x80, 0x93, 0xA7, 0x10, 0x80, -+0xC3, 0xA7, 0x10, 0x80, 0x63, 0x6F, 0x6E, 0x66, -+0x69, 0x67, 0x5F, 0x70, 0x68, 0x79, 0x64, 0x6D, -+0x5F, 0x72, 0x65, 0x61, 0x64, 0x5F, 0x74, 0x78, -+0x61, 0x67, 0x63, 0x5F, 0x38, 0x38, 0x32, 0x31, -+0x63, 0x00, 0x00, 0x00, 0x63, 0x6F, 0x6E, 0x66, -+0x69, 0x67, 0x5F, 0x70, 0x68, 0x79, 0x64, 0x6D, -+0x5F, 0x77, 0x72, 0x69, 0x74, 0x65, 0x5F, 0x74, -+0x78, 0x61, 0x67, 0x63, 0x5F, 0x38, 0x38, 0x32, -+0x31, 0x63, 0x00, 0x00, 0x70, 0x68, 0x79, 0x64, -+0x6D, 0x5F, 0x77, 0x72, 0x69, 0x74, 0x65, 0x5F, -+0x74, 0x78, 0x61, 0x67, 0x63, 0x5F, 0x31, 0x62, -+0x79, 0x74, 0x65, 0x5F, 0x38, 0x38, 0x32, 0x31, -+0x63, 0x00, 0x00, 0x00, 0x63, 0x6F, 0x6E, 0x66, -+0x69, 0x67, 0x5F, 0x70, 0x68, 0x79, 0x64, 0x6D, -+0x5F, 0x73, 0x77, 0x69, 0x74, 0x63, 0x68, 0x5F, -+0x62, 0x61, 0x6E, 0x64, 0x77, 0x69, 0x64, 0x74, -+0x68, 0x5F, 0x38, 0x38, 0x32, 0x31, 0x63, 0x00, -+0x63, 0x6F, 0x6E, 0x66, 0x69, 0x67, 0x5F, 0x70, -+0x68, 0x79, 0x64, 0x6D, 0x5F, 0x73, 0x77, 0x69, -+0x74, 0x63, 0x68, 0x5F, 0x63, 0x68, 0x61, 0x6E, -+0x6E, 0x65, 0x6C, 0x5F, 0x38, 0x38, 0x32, 0x31, -+0x63, 0x00, 0x00, 0x00, 0x63, 0x6F, 0x6E, 0x66, -+0x69, 0x67, 0x5F, 0x70, 0x68, 0x79, 0x64, 0x6D, -+0x5F, 0x73, 0x77, 0x69, 0x74, 0x63, 0x68, 0x5F, -+0x62, 0x61, 0x6E, 0x64, 0x5F, 0x38, 0x38, 0x32, -+0x31, 0x63, 0x00, 0x00, 0x63, 0x6F, 0x6E, 0x66, -+0x69, 0x67, 0x5F, 0x70, 0x68, 0x79, 0x64, 0x6D, -+0x5F, 0x77, 0x72, 0x69, 0x74, 0x65, 0x5F, 0x72, -+0x66, 0x5F, 0x72, 0x65, 0x67, 0x5F, 0x38, 0x38, -+0x32, 0x31, 0x63, 0x00, 0x63, 0x6F, 0x6E, 0x66, -+0x69, 0x67, 0x5F, 0x70, 0x68, 0x79, 0x64, 0x6D, -+0x5F, 0x72, 0x65, 0x61, 0x64, 0x5F, 0x72, 0x66, -+0x5F, 0x72, 0x65, 0x67, 0x5F, 0x38, 0x38, 0x32, -+0x31, 0x63, 0x00, 0x00, 0x6D, 0xA9, 0x10, 0x80, -+0x87, 0xA9, 0x10, 0x80, 0x97, 0xA9, 0x10, 0x80, -+0xAD, 0xA9, 0x10, 0x80, 0xC3, 0xA9, 0x10, 0x80, -+0xC3, 0xA9, 0x10, 0x80, 0xDF, 0xA9, 0x10, 0x80, -+0x25, 0x5A, 0x03, 0x80, 0x21, 0x5A, 0x03, 0x80, -+0x2B, 0x5A, 0x03, 0x80, 0x2F, 0x5A, 0x03, 0x80, -+0x33, 0x5A, 0x03, 0x80, 0x39, 0x5A, 0x03, 0x80, -+0x47, 0x5A, 0x03, 0x80, 0x71, 0x5A, 0x03, 0x80, -+0x9F, 0x5A, 0x03, 0x80, 0xA5, 0x5A, 0x03, 0x80, -+0xF1, 0x5A, 0x03, 0x80, 0xFF, 0x5A, 0x03, 0x80, -+0x17, 0x5B, 0x03, 0x80, 0x91, 0x17, 0x03, 0x80, -+0x8D, 0x17, 0x03, 0x80, 0x91, 0x17, 0x03, 0x80, -+0x8D, 0x17, 0x03, 0x80, 0xB1, 0x17, 0x03, 0x80, -+0x8D, 0x17, 0x03, 0x80, 0xB1, 0x17, 0x03, 0x80, -+0x8D, 0x17, 0x03, 0x80, 0xD1, 0x17, 0x03, 0x80, -+0x8D, 0x17, 0x03, 0x80, 0xD1, 0x17, 0x03, 0x80, -+0x8D, 0x17, 0x03, 0x80, 0xF1, 0x17, 0x03, 0x80, -+0x8D, 0x17, 0x03, 0x80, 0xF1, 0x17, 0x03, 0x80, -+0x3B, 0x19, 0x03, 0x80, 0x3F, 0x19, 0x03, 0x80, -+0x43, 0x19, 0x03, 0x80, 0x47, 0x19, 0x03, 0x80, -+0x4B, 0x19, 0x03, 0x80, 0x19, 0x83, 0x03, 0x80, -+0x3B, 0x83, 0x03, 0x80, 0x5D, 0x83, 0x03, 0x80, -+0x7F, 0x83, 0x03, 0x80, 0xA3, 0x83, 0x03, 0x80, -+0xDD, 0x83, 0x03, 0x80, 0x01, 0x84, 0x03, 0x80, -+0x25, 0x84, 0x03, 0x80, 0x49, 0x84, 0x03, 0x80, -+0x6F, 0x84, 0x03, 0x80, 0x75, 0x86, 0x03, 0x80, -+0x8B, 0x86, 0x03, 0x80, 0xAD, 0x86, 0x03, 0x80, -+0xD3, 0x86, 0x03, 0x80, 0xF9, 0x86, 0x03, 0x80, -+0xD5, 0x8A, 0x03, 0x80, 0xD5, 0x8A, 0x03, 0x80, -+0xD5, 0x8A, 0x03, 0x80, 0xEF, 0x8A, 0x03, 0x80, -+0xD5, 0x8A, 0x03, 0x80, 0xD5, 0x8A, 0x03, 0x80, -+0xD5, 0x8A, 0x03, 0x80, 0xD1, 0x8A, 0x03, 0x80, -+0xD1, 0x8A, 0x03, 0x80, 0xD1, 0x8A, 0x03, 0x80, -+0xD1, 0x8A, 0x03, 0x80, 0xD1, 0x8A, 0x03, 0x80, -+0x4D, 0x8B, 0x03, 0x80, 0x57, 0x8B, 0x03, 0x80, -+0x51, 0x1E, 0x03, 0x80, 0x51, 0x1E, 0x03, 0x80, -+0x51, 0x1E, 0x03, 0x80, 0x51, 0x1E, 0x03, 0x80, -+0x71, 0x1E, 0x03, 0x80, 0x71, 0x1E, 0x03, 0x80, -+0x71, 0x1E, 0x03, 0x80, 0x71, 0x1E, 0x03, 0x80, -+0x91, 0x1E, 0x03, 0x80, 0x91, 0x1E, 0x03, 0x80, -+0x91, 0x1E, 0x03, 0x80, 0x91, 0x1E, 0x03, 0x80, -+0xB1, 0x1E, 0x03, 0x80, 0xB1, 0x1E, 0x03, 0x80, -+0xB1, 0x1E, 0x03, 0x80, 0xB1, 0x1E, 0x03, 0x80, -+0xA3, 0xA3, 0x03, 0x80, 0xB3, 0xA3, 0x03, 0x80, -+0xBD, 0xA3, 0x03, 0x80, 0xC7, 0xA3, 0x03, 0x80, -+0xD9, 0xA3, 0x03, 0x80, 0x11, 0xB2, 0x03, 0x80, -+0x43, 0xB2, 0x03, 0x80, 0x25, 0xB2, 0x03, 0x80, -+0x4D, 0xB2, 0x03, 0x80, 0x2F, 0xB2, 0x03, 0x80, -+0x59, 0xB2, 0x03, 0x80, 0x39, 0xB2, 0x03, 0x80, -+0xCB, 0x39, 0x10, 0x80, 0xD5, 0x39, 0x10, 0x80, -+0xDF, 0x39, 0x10, 0x80, 0xE9, 0x39, 0x10, 0x80, -+0xF3, 0x39, 0x10, 0x80, 0x4F, 0xC4, 0x03, 0x80, -+0x9F, 0xC4, 0x03, 0x80, 0xF7, 0xC4, 0x03, 0x80, -+0x4F, 0xC5, 0x03, 0x80, 0xB5, 0xC5, 0x03, 0x80, -+0xA5, 0xCD, 0x03, 0x80, 0xCD, 0xCD, 0x03, 0x80, -+0xF3, 0xCD, 0x03, 0x80, 0x19, 0xCE, 0x03, 0x80, -+0x3F, 0xCE, 0x03, 0x80, 0xFC, 0x10, 0x60, 0xB8, -+0xFA, 0xFA, 0xFA, 0xFA, 0x8C, 0x04, 0x64, 0xB8, -+0x90, 0x04, 0x64, 0xB8, 0x94, 0x04, 0x64, 0xB8, -+0x98, 0x04, 0x64, 0xB8, 0x9C, 0x04, 0x64, 0xB8, -+0xA0, 0x04, 0x64, 0xB8, 0x01, 0x06, 0x64, 0xB8, -+0x00, 0x00, 0x68, 0x18, 0x48, 0x00, 0x68, 0x18, -+0x48, 0x04, 0x68, 0x18, 0x00, 0x00, 0x60, 0xB8, -+0x00, 0x00, 0x64, 0xB8, 0x54, 0x05, 0x64, 0xB8, -+0x50, 0x05, 0x64, 0xB8, 0x51, 0x05, 0x64, 0xB8, -+0x78, 0x05, 0x64, 0xB8, 0x79, 0x05, 0x64, 0xB8, -+0x7A, 0x05, 0x64, 0xB8, 0xFF, 0xFF, 0xFF, 0x8F, -+0x60, 0x05, 0x60, 0xB8, 0x60, 0x05, 0x64, 0xB8, -+0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, 0x20, -+0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x40, -+0xBF, 0x01, 0x64, 0xB8, 0x89, 0x00, 0x60, 0xB8, -+0x8A, 0x00, 0x60, 0xB8, 0x1A, 0x04, 0x64, 0xB8, -+0x1B, 0x04, 0x64, 0xB8, 0x01, 0x00, 0xFF, 0x00, -+0xF0, 0x11, 0x64, 0xB8, 0x58, 0x05, 0x64, 0xB8, -+0x01, 0x00, 0x60, 0xB8, 0x01, 0x00, 0x64, 0xB8, -+0x87, 0x02, 0x64, 0xB8, 0x96, 0x02, 0x64, 0xB8, -+0x86, 0x02, 0x64, 0xB8, 0xF8, 0x10, 0x60, 0xB8, -+0x00, 0x00, 0x40, 0x00, 0x5B, 0x01, 0x64, 0xB8, -+0x3C, 0x01, 0x64, 0xB8, 0x22, 0x05, 0x64, 0xB8, -+0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x02, 0x00, -+0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x08, 0x00, -+0x0A, 0x06, 0x64, 0xB8, 0xFE, 0x11, 0x64, 0xB8, -+0xA8, 0x06, 0x64, 0xB8, 0x10, 0x07, 0x64, 0xB8, -+0x00, 0x16, 0x64, 0xB8, 0x04, 0x16, 0x64, 0xB8, -+0x08, 0x16, 0x64, 0xB8, 0xAB, 0x06, 0x64, 0xB8, -+0xAA, 0x06, 0x64, 0xB8, 0x13, 0x07, 0x64, 0xB8, -+0x12, 0x07, 0x64, 0xB8, 0x03, 0x16, 0x64, 0xB8, -+0x02, 0x16, 0x64, 0xB8, 0x07, 0x16, 0x64, 0xB8, -+0x06, 0x16, 0x64, 0xB8, 0x0B, 0x16, 0x64, 0xB8, -+0x0A, 0x16, 0x64, 0xB8, 0xFC, 0x11, 0x64, 0xB8, -+0x57, 0x01, 0x64, 0xB8, 0x00, 0x00, 0x1E, 0x00, -+0x00, 0x00, 0x06, 0x00, 0x00, 0x00, 0x03, 0x00, -+0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x00, 0x03, -+0xB1, 0x05, 0x64, 0xB8, 0x22, 0x00, 0x60, 0xB8, -+0x04, 0x06, 0x64, 0xB8, 0xFF, 0xFF, 0xFF, 0xFE, -+0x00, 0x00, 0x00, 0x01, 0x60, 0x16, 0x64, 0xB8, -+0x09, 0x00, 0x78, 0xB8, 0x31, 0x00, 0x78, 0xB8, -+0x14, 0x00, 0x78, 0xB8, 0x1D, 0x04, 0x64, 0xB8, -+0x32, 0x00, 0x78, 0xB8, 0x33, 0x00, 0x78, 0xB8, -+0x7A, 0x04, 0x64, 0xB8, 0x24, 0x04, 0x64, 0xB8, -+0xD4, 0x04, 0x64, 0xB8, 0x88, 0x04, 0x64, 0xB8, -+0xD0, 0x04, 0x64, 0xB8, 0x84, 0x04, 0x64, 0xB8, -+0x56, 0x04, 0x64, 0xB8, 0x1C, 0x04, 0x64, 0xB8, -+0x20, 0x04, 0x64, 0xB8, 0xFF, 0xFF, 0xEF, 0xFF, -+0x00, 0x00, 0x10, 0x00, 0x88, 0x00, 0x60, 0xB8, -+0x8B, 0x00, 0x60, 0xB8, 0x84, 0x00, 0x60, 0xB8, -+0x00, 0x00, 0x00, 0x02, 0xCB, 0x01, 0x64, 0xB8, -+0x00, 0x00, 0x00, 0x60, 0xE0, 0x00, 0x60, 0xB8, -+0xE1, 0x00, 0x60, 0xB8, 0xE8, 0x12, 0x64, 0xB8, -+0xFF, 0xFF, 0x03, 0x00, 0x00, 0x00, 0x00, 0x80, -+0x00, 0x00, 0x00, 0x04, 0xFF, 0xFF, 0xFF, 0xFB, -+0xFF, 0xFF, 0xFF, 0xDF, 0xFF, 0xFF, 0xFF, 0x1F, -+0x04, 0x00, 0x60, 0xB8, 0x04, 0x00, 0x64, 0xB8, -+0x08, 0x00, 0x60, 0xB8, 0x08, 0x00, 0x64, 0xB8, -+0x24, 0x00, 0x60, 0xB8, 0x80, 0x00, 0x60, 0xB8, -+0xFF, 0xFF, 0xFD, 0xFF, 0xCC, 0x07, 0x64, 0xB8, -+0x82, 0x10, 0x60, 0xB8, 0x42, 0x34, 0x00, 0xB8, -+0x00, 0x0C, 0x01, 0x00, 0x08, 0x00, 0x00, 0xF8, -+0x08, 0x70, 0x0A, 0xF8, 0x08, 0x50, 0x01, 0xF8, -+0x00, 0x00, 0x1F, 0x00, 0x00, 0x00, 0x00, 0xC0, -+0x1A, 0x15, 0x64, 0xB8, 0x77, 0x77, 0x77, 0x77, -+0x17, 0x11, 0x17, 0x77, 0x01, 0x00, 0x00, 0xE0, -+0x00, 0x00, 0xFF, 0x0F, 0x21, 0x00, 0x00, 0xE0, -+0x00, 0x1C, 0x01, 0x88, 0x00, 0x00, 0x00, 0xFF, -+0x08, 0x00, 0x45, 0x01, 0x88, 0x0C, 0x46, 0x01, -+0xFF, 0xFF, 0x0F, 0x00, 0xBA, 0xCB, 0x08, 0x00, -+0x18, 0x80, 0x0A, 0x00, 0x68, 0x10, 0x46, 0x01, -+0xF3, 0x10, 0x05, 0x00, 0x00, 0x9C, 0x0A, 0x00, -+0x08, 0x00, 0x45, 0x00, 0x68, 0x14, 0x46, 0x00, -+0x08, 0x00, 0x84, 0x00, 0xBA, 0xCB, 0x0B, 0x00, -+0x18, 0xC0, 0x0A, 0x00, 0x08, 0x00, 0x44, 0x01, -+0xF3, 0x0E, 0x05, 0x00, 0x18, 0xDC, 0x0A, 0x00, -+0xC8, 0x0E, 0x05, 0x00, 0x18, 0x9C, 0x0A, 0x00, -+0x00, 0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x0F, -+0x02, 0x00, 0x60, 0xB8, 0x62, 0x06, 0x64, 0xB8, -+0xB4, 0x06, 0x64, 0xB8, 0x06, 0x00, 0x00, 0x89, -+0x00, 0x00, 0x00, 0x50, 0x40, 0x00, 0x0F, 0x70, -+0x02, 0x04, 0x00, 0xD8, 0x20, 0x01, 0x00, 0xD1, -+0x40, 0x80, 0x0B, 0x70, 0x02, 0x04, 0x02, 0xD8, -+0x20, 0x01, 0x00, 0xDE, 0x03, 0x29, 0x29, 0x00, -+0x48, 0x00, 0x46, 0x01, 0x60, 0x10, 0x05, 0x00, -+0xDE, 0x0F, 0x0E, 0x00, 0xCE, 0xEF, 0x0D, 0x00, -+0xCE, 0xEF, 0x05, 0x00, 0xFF, 0x3F, 0x0E, 0x00, -+0x1F, 0xFF, 0x0F, 0x00, 0xE7, 0x0E, 0x05, 0x00, -+0xE8, 0x0E, 0x05, 0x00, 0x45, 0x23, 0x01, 0x00, -+0x08, 0x08, 0x00, 0xF8, 0x08, 0x07, 0x00, 0xF8, -+0x08, 0x02, 0x00, 0xF8, 0x08, 0x03, 0x00, 0xF8, -+0x18, 0x00, 0x00, 0xF8, 0xDE, 0xBC, 0x0A, 0x00, -+0x01, 0x00, 0x66, 0xB8, 0x00, 0x00, 0x66, 0xB8, -+0xCD, 0x9B, 0x78, 0x56, 0x00, 0x1C, 0x66, 0xB8, -+0x04, 0x1C, 0x66, 0xB8, 0xFF, 0xFF, 0x3F, 0x00, -+0x1F, 0x00, 0x60, 0xB8, 0x04, 0xEA, 0xEF, 0xFD, -+0x07, 0xEA, 0xEF, 0xFD, 0x08, 0xEA, 0xEF, 0xFD, -+0x09, 0xEA, 0xEF, 0xFD, 0x0A, 0xEA, 0xEF, 0xFD, -+0x53, 0x04, 0x64, 0xB8, 0xF0, 0x10, 0x60, 0xB8, -+0xCA, 0x04, 0x64, 0xB8, 0xCF, 0x04, 0x64, 0xB8, -+0xF1, 0x10, 0x60, 0xB8, 0x06, 0x00, 0x66, 0xB8, -+0x52, 0x04, 0x64, 0xB8, 0x50, 0x04, 0x64, 0xB8, -+0x51, 0x04, 0x64, 0xB8, 0x01, 0x1C, 0x66, 0xB8, -+0x02, 0x1C, 0x66, 0xB8, 0x03, 0x1C, 0x66, 0xB8, -+0x05, 0x1C, 0x66, 0xB8, 0x06, 0x1C, 0x66, 0xB8, -+0x07, 0x1C, 0x66, 0xB8, 0x02, 0x10, 0x66, 0xB8, -+0x08, 0x10, 0x66, 0xB8, 0x03, 0x10, 0x66, 0xB8, -+0x09, 0x10, 0x66, 0xB8, 0x04, 0x10, 0x66, 0xB8, -+0x05, 0x10, 0x66, 0xB8, 0x0C, 0x10, 0x66, 0xB8, -+0x0D, 0x10, 0x66, 0xB8, 0x06, 0x10, 0x66, 0xB8, -+0x00, 0x00, 0x7F, 0x00, 0xFF, 0xFF, 0x0B, 0xFF, -+0x00, 0x00, 0x70, 0x00, 0xFF, 0xFF, 0x7A, 0xFF, -+0x00, 0x00, 0xD0, 0x00, 0xFF, 0xFF, 0xDA, 0xFF, -+0xFF, 0xFF, 0xFF, 0x0F, 0x00, 0xFF, 0xF9, 0xFF, -+0x00, 0x00, 0xFE, 0x1F, 0x1C, 0x0C, 0xB8, 0x64, -+0x67, 0x56, 0x23, 0x01, 0xFF, 0xFF, 0xF7, 0xFF, -+0xFF, 0xFC, 0xFE, 0xFF, 0x00, 0x01, 0x01, 0x00, -+0x00, 0xFC, 0xCF, 0xFF, 0x00, 0x00, 0x01, 0x10, -+0x00, 0xF3, 0x3F, 0xFF, 0x01, 0x00, 0x02, 0x20, -+0x00, 0xCF, 0xFF, 0xFC, 0x02, 0x00, 0x04, 0x40, -+0x00, 0xFC, 0xCE, 0xEF, 0x40, 0x02, 0x20, 0x00, -+0x80, 0x03, 0x30, 0x00, 0x00, 0x00, 0x80, 0x01, -+0xCC, 0x06, 0x64, 0xB8, 0xA3, 0x00, 0x60, 0xB8, -+0xA0, 0x00, 0x60, 0xB8, 0x65, 0x07, 0x64, 0xB8, -+0x40, 0x00, 0x60, 0xB8, 0x68, 0x00, 0x60, 0xB8, -+0x6E, 0x07, 0x64, 0xB8, 0x64, 0x07, 0x64, 0xB8, -+0x23, 0x05, 0x64, 0xB8, 0x64, 0x00, 0x60, 0xB8, -+0xFF, 0xFF, 0x40, 0xFF, 0xFF, 0xFF, 0xFF, 0xE0, -+0x28, 0x00, 0x60, 0xB8, 0xFF, 0xFF, 0xFF, 0x81, -+0x00, 0x00, 0x70, 0xB8, 0x18, 0x00, 0x70, 0xB8, -+0x0B, 0x00, 0x70, 0xB8, 0x02, 0x00, 0x70, 0xB8, -+0x1C, 0x01, 0x64, 0xB8, 0x94, 0x02, 0x64, 0xB8, -+0x97, 0x02, 0x64, 0xB8, 0x84, 0x02, 0x64, 0xB8, -+0x54, 0x02, 0x64, 0xB8, 0x50, 0x02, 0x64, 0xB8, -+0x4C, 0x02, 0x64, 0xB8, 0x00, 0x00, 0x78, 0xB8, -+0x04, 0x00, 0x78, 0xB8, 0x48, 0x02, 0x64, 0xB8, -+0x44, 0x02, 0x64, 0xB8, 0xCC, 0x01, 0x64, 0xB8, -+0xF4, 0x11, 0x64, 0xB8, 0xF5, 0x11, 0x64, 0xB8, -+0xD4, 0x04, 0x60, 0xB8, 0x84, 0x04, 0x60, 0xB8, -+0xC8, 0x04, 0x60, 0xB8, 0xC8, 0x04, 0x64, 0xB8, -+0x78, 0x04, 0x60, 0xB8, 0x78, 0x04, 0x64, 0xB8, -+0xCF, 0x01, 0x64, 0xB8, 0x34, 0x01, 0x64, 0xB8, -+0x64, 0x05, 0x64, 0xB8, 0x44, 0x00, 0x60, 0xB8, -+0x60, 0x00, 0x60, 0xB8, 0x27, 0x05, 0x64, 0xB8, -+0xB5, 0x05, 0x64, 0xB8, 0x1D, 0x05, 0x64, 0xB8, -+0x1C, 0x05, 0x64, 0xB8, 0xB7, 0x05, 0x64, 0xB8, -+0x31, 0x05, 0x64, 0xB8, 0x3C, 0x11, 0x64, 0xB8, -+0x40, 0x05, 0x64, 0xB8, 0x01, 0xEA, 0xEF, 0xFD, -+0x02, 0xEA, 0xEF, 0xFD, 0xC8, 0x01, 0x64, 0xB8, -+0xC9, 0x01, 0x64, 0xB8, 0xA0, 0x01, 0x64, 0xB8, -+0x48, 0x00, 0x60, 0xB8, 0xFF, 0xFF, 0xFE, 0xFF, -+0x47, 0x00, 0x60, 0xB8, 0x46, 0x00, 0x60, 0xB8, -+0x45, 0x00, 0x60, 0xB8, 0x63, 0x00, 0x60, 0xB8, -+0x62, 0x00, 0x60, 0xB8, 0x61, 0x00, 0x60, 0xB8, -+0xC6, 0x01, 0x64, 0xB8, 0x68, 0x05, 0x64, 0xB8, -+0x6C, 0x05, 0x64, 0xB8, 0x57, 0x05, 0x64, 0xB8, -+0x77, 0x05, 0x64, 0xB8, 0xFF, 0xFF, 0xFF, 0x00, -+0x00, 0x00, 0x00, 0x05, 0x64, 0x01, 0x64, 0xB8, -+0x53, 0x05, 0x64, 0xB8, 0x94, 0x01, 0x64, 0xB8, -+0x00, 0x10, 0x66, 0xB8, 0x54, 0x00, 0x60, 0xB8, -+0x50, 0x00, 0x60, 0xB8, 0x9A, 0x01, 0x64, 0xB8, -+0x99, 0x01, 0x64, 0xB8, 0xC7, 0x01, 0x64, 0xB8, -+0x30, 0x01, 0x64, 0xB8, 0x24, 0x01, 0x64, 0xB8, -+0x20, 0x01, 0x64, 0xB8, 0x24, 0x11, 0x64, 0xB8, -+0x20, 0x11, 0x64, 0xB8, 0x2C, 0x11, 0x64, 0xB8, -+0x28, 0x11, 0x64, 0xB8, 0x34, 0x11, 0x64, 0xB8, -+0x30, 0x11, 0x64, 0xB8, 0x38, 0x01, 0x64, 0xB8, -+0x38, 0x11, 0x64, 0xB8, 0xE4, 0x11, 0x64, 0xB8, -+0xE0, 0x11, 0x64, 0xB8, 0x00, 0x40, 0xE0, 0x03, -+0x01, 0x70, 0x00, 0x03, 0xE0, 0x04, 0x64, 0xB8, -+0xE3, 0x04, 0x64, 0xB8, 0xE0, 0x12, 0x64, 0xB8, -+0x00, 0x01, 0x64, 0xB8, 0x08, 0x02, 0x64, 0xB8, -+0x67, 0x05, 0x64, 0xB8, 0x66, 0x05, 0x64, 0xB8, -+0x65, 0x05, 0x64, 0xB8, 0x63, 0x05, 0x64, 0xB8, -+0x62, 0x05, 0x64, 0xB8, 0x61, 0x05, 0x64, 0xB8, -+0x02, 0x01, 0x64, 0xB8, 0x21, 0x05, 0x64, 0xB8, -+0x2F, 0x01, 0x64, 0xB8, 0x00, 0x28, 0x64, 0xB8, -+0x00, 0x2C, 0x64, 0xB8, 0x00, 0x38, 0x64, 0xB8, -+0x00, 0x3C, 0x64, 0xB8, 0xF8, 0x05, 0x64, 0xB8, -+0xF9, 0x05, 0x64, 0xB8, 0xFA, 0x05, 0x64, 0xB8, -+0xFB, 0x05, 0x64, 0xB8, 0x83, 0x00, 0x60, 0xB8, -+0x08, 0x01, 0x64, 0xB8, 0x90, 0x00, 0x60, 0xB8, -+0x92, 0x00, 0x60, 0xB8, 0x92, 0x06, 0x64, 0xB8, -+0xF1, 0x11, 0x64, 0xB8, 0x20, 0x00, 0x78, 0xB8, -+0x10, 0x00, 0x78, 0xB8, 0x03, 0x00, 0x78, 0xB8, -+0xFF, 0xFF, 0x01, 0xFF, 0x05, 0x00, 0x78, 0xB8, -+0x12, 0x05, 0x64, 0xB8, 0x10, 0x05, 0x64, 0xB8, -+0xB8, 0x05, 0x64, 0xB8, 0xBC, 0x05, 0x64, 0xB8, -+0x00, 0x00, 0x80, 0x00, 0x5F, 0x11, 0x64, 0xB8, -+0xFE, 0xFF, 0xFF, 0x7F, 0x30, 0x00, 0x78, 0x18, -+0x40, 0x00, 0x00, 0xB5, 0x44, 0x00, 0x00, 0xB5, -+0x48, 0x00, 0x00, 0xB5, 0x4C, 0x00, 0x00, 0xB5, -+0xA4, 0x04, 0x64, 0xB8, 0xA8, 0x04, 0x64, 0xB8, -+0xC0, 0x01, 0x64, 0xB8, 0xAF, 0x01, 0x64, 0xB8, -+0x00, 0x00, 0x20, 0x00, 0x00, 0x00, 0x00, 0x08, -+0x00, 0x00, 0x01, 0x01, 0x7E, 0x04, 0x64, 0xB8, -+0x7D, 0x04, 0x64, 0xB8, 0x7C, 0x04, 0x64, 0xB8, -+0x98, 0x01, 0x64, 0xB8, 0xFF, 0xFF, 0xC0, 0xFF, -+0x40, 0x01, 0x00, 0x80, 0x00, 0x98, 0x00, 0x80, -+0x7B, 0x05, 0x64, 0xB8, 0x73, 0x05, 0x64, 0xB8, -+0x01, 0x01, 0x64, 0xB8, 0xB7, 0x06, 0x64, 0xB8, -+0x00, 0x00, 0x00, 0x70, 0x68, 0x06, 0x64, 0xB8, -+0xFF, 0xFF, 0xCF, 0xFF, 0x5C, 0x05, 0x64, 0xB8, -+0x38, 0x06, 0x64, 0xB8, 0x08, 0x06, 0x64, 0xB8, -+0xA0, 0x06, 0x64, 0xB8, 0xAA, 0x00, 0x60, 0xB8, -+0xA8, 0x00, 0x60, 0xB8, 0x00, 0x00, 0x02, 0x80, -+0x4C, 0x00, 0x60, 0xB8, 0xFF, 0xFF, 0x7F, 0xFE, -+0x70, 0x00, 0x60, 0xB8, 0xC4, 0x06, 0x64, 0xB8, -+0xFF, 0xFF, 0xFF, 0xEF, 0x00, 0x00, 0x78, 0x18, -+0xB2, 0x05, 0x64, 0xB8, 0xB3, 0x05, 0x64, 0xB8, -+0x43, 0x05, 0x64, 0xB8, 0x7D, 0x05, 0x64, 0xB8, -+0x7F, 0x05, 0x64, 0xB8, 0x72, 0x05, 0x64, 0xB8, -+0xCF, 0x05, 0x64, 0xB8, 0xE0, 0x05, 0x64, 0xB8, -+0xE4, 0x05, 0x64, 0xB8, 0xE8, 0x05, 0x64, 0xB8, -+0xEC, 0x05, 0x64, 0xB8, 0xF0, 0x05, 0x64, 0xB8, -+0xB6, 0x05, 0x64, 0xB8, 0xE4, 0x00, 0x60, 0xB8, -+0xE8, 0x00, 0x60, 0xB8, 0xE9, 0x00, 0x60, 0xB8, -+0xEA, 0x00, 0x60, 0xB8, 0xEB, 0x00, 0x60, 0xB8, -+0xE5, 0x00, 0x60, 0xB8, 0x44, 0x00, 0x02, 0x00, -+0xA0, 0x07, 0x64, 0xB8, 0xFF, 0xFF, 0xFF, 0x7F, -+0xF4, 0x00, 0x60, 0xB8, 0x91, 0x00, 0x60, 0xB8, -+0x00, 0x00, 0xC0, 0x00, 0x00, 0x10, 0x24, 0x00, -+0x82, 0x82, 0x62, 0x00, 0x30, 0x00, 0x78, 0xB8, -+0x5B, 0x49, 0x51, 0x4B, 0x5D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3E, 0x50, 0x48, 0x59, 0x5F, 0x49, -+0x51, 0x43, 0x61, 0x6C, 0x69, 0x62, 0x72, 0x61, -+0x74, 0x65, 0x5F, 0x49, 0x6E, 0x69, 0x74, 0x0A, -+0x00, 0x00, 0x00, 0x00, 0x63, 0x61, 0x6C, 0x69, -+0x62, 0x72, 0x61, 0x74, 0x69, 0x6F, 0x6E, 0x20, -+0x74, 0x69, 0x6D, 0x65, 0x6F, 0x75, 0x74, 0x21, -+0x21, 0x21, 0x0A, 0x00, 0x64, 0x65, 0x6C, 0x61, -+0x79, 0x20, 0x63, 0x6F, 0x75, 0x6E, 0x74, 0x20, -+0x3D, 0x20, 0x30, 0x78, 0x25, 0x78, 0x21, 0x21, -+0x21, 0x0A, 0x00, 0x00, 0x64, 0x65, 0x6C, 0x61, -+0x79, 0x5F, 0x63, 0x6F, 0x75, 0x6E, 0x74, 0x20, -+0x3D, 0x20, 0x30, 0x78, 0x25, 0x78, 0x0A, 0x00, -+0x49, 0x51, 0x4B, 0x73, 0x74, 0x65, 0x70, 0x20, -+0x3D, 0x20, 0x30, 0x78, 0x25, 0x62, 0x78, 0x0A, -+0x00, 0x00, 0x00, 0x00, 0x5B, 0x49, 0x51, 0x4B, -+0x5D, 0x50, 0x61, 0x74, 0x68, 0x41, 0x5F, 0x4C, -+0x4F, 0x4B, 0x5F, 0x6E, 0x6F, 0x74, 0x72, 0x65, -+0x61, 0x64, 0x79, 0x20, 0x3D, 0x20, 0x25, 0x64, -+0x0A, 0x00, 0x00, 0x00, 0x5B, 0x49, 0x51, 0x4B, -+0x5D, 0x50, 0x61, 0x74, 0x68, 0x41, 0x5F, 0x54, -+0x58, 0x49, 0x51, 0x4B, 0x5F, 0x66, 0x61, 0x69, -+0x6C, 0x20, 0x3D, 0x20, 0x25, 0x64, 0x0A, 0x00, -+0x5B, 0x49, 0x51, 0x4B, 0x5D, 0x50, 0x61, 0x74, -+0x68, 0x41, 0x5F, 0x52, 0x58, 0x49, 0x51, 0x4B, -+0x5F, 0x66, 0x61, 0x69, 0x6C, 0x20, 0x3D, 0x20, -+0x25, 0x64, 0x0A, 0x00, 0x5B, 0x49, 0x51, 0x4B, -+0x5D, 0x50, 0x61, 0x74, 0x68, 0x41, 0x5F, 0x54, -+0x58, 0x49, 0x51, 0x4B, 0x5F, 0x72, 0x65, 0x74, -+0x72, 0x79, 0x20, 0x3D, 0x20, 0x25, 0x64, 0x0A, -+0x00, 0x00, 0x00, 0x00, 0x5B, 0x49, 0x51, 0x4B, -+0x5D, 0x50, 0x61, 0x74, 0x68, 0x41, 0x5F, 0x52, -+0x58, 0x4B, 0x31, 0x5F, 0x72, 0x65, 0x74, 0x72, -+0x79, 0x20, 0x3D, 0x20, 0x25, 0x64, 0x2C, 0x20, -+0x50, 0x61, 0x74, 0x68, 0x41, 0x5F, 0x52, 0x58, -+0x4B, 0x32, 0x5F, 0x72, 0x65, 0x74, 0x72, 0x79, -+0x20, 0x3D, 0x20, 0x25, 0x64, 0x0A, 0x00, 0x00, -+0x5B, 0x49, 0x51, 0x4B, 0x5D, 0x50, 0x61, 0x74, -+0x68, 0x41, 0x5F, 0x47, 0x53, 0x31, 0x5F, 0x72, -+0x65, 0x74, 0x72, 0x79, 0x20, 0x3D, 0x20, 0x25, -+0x64, 0x2C, 0x20, 0x50, 0x61, 0x74, 0x68, 0x41, -+0x5F, 0x47, 0x53, 0x32, 0x5F, 0x72, 0x65, 0x74, -+0x72, 0x79, 0x20, 0x3D, 0x20, 0x25, 0x64, 0x0A, -+0x00, 0x00, 0x00, 0x00, 0x46, 0x57, 0x49, 0x51, -+0x4B, 0x20, 0x73, 0x74, 0x61, 0x72, 0x74, 0x20, -+0x76, 0x31, 0x38, 0x21, 0x21, 0x21, 0x00, 0x00, -+0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, -+0x38, 0x39, 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, -+0x00, 0x00, 0x00, 0x00, 0x53, 0x65, 0x74, 0x5F, -+0x43, 0x61, 0x6E, 0x64, 0x69, 0x5F, 0x33, 0x3A, -+0x20, 0x5B, 0x31, 0x5D, 0x3D, 0x30, 0x78, 0x25, -+0x62, 0x58, 0x2C, 0x20, 0x20, 0x5B, 0x32, 0x5D, -+0x3D, 0x30, 0x78, 0x25, 0x62, 0x58, 0x2C, 0x20, -+0x20, 0x5B, 0x33, 0x5D, 0x3D, 0x30, 0x78, 0x25, -+0x62, 0x58, 0x00, 0x00, 0x53, 0x65, 0x74, 0x5F, -+0x43, 0x61, 0x6E, 0x64, 0x69, 0x5F, 0x32, 0x3A, -+0x20, 0x5B, 0x31, 0x5D, 0x3D, 0x30, 0x78, 0x25, -+0x62, 0x58, 0x2C, 0x20, 0x20, 0x5B, 0x32, 0x5D, -+0x3D, 0x30, 0x78, 0x25, 0x62, 0x58, 0x20, 0x00, -+0x50, 0x45, 0x52, 0x20, 0x52, 0x50, 0x54, 0x3A, -+0x20, 0x6D, 0x69, 0x64, 0x25, 0x62, 0x58, 0x2C, -+0x52, 0x3A, 0x25, 0x62, 0x78, 0x2C, 0x72, 0x74, -+0x3A, 0x25, 0x62, 0x78, 0x2C, 0x62, 0x77, 0x3A, -+0x25, 0x62, 0x78, 0x00, 0x50, 0x45, 0x52, 0x20, -+0x52, 0x50, 0x54, 0x3A, 0x20, 0x6D, 0x69, 0x64, -+0x25, 0x62, 0x58, 0x2C, 0x54, 0x54, 0x3A, 0x25, -+0x77, 0x78, 0x00, 0x00, 0x50, 0x45, 0x52, 0x20, -+0x52, 0x50, 0x54, 0x3A, 0x20, 0x25, 0x62, 0x58, -+0x2C, 0x25, 0x62, 0x78, 0x2C, 0x25, 0x62, 0x78, -+0x2C, 0x25, 0x62, 0x78, 0x2C, 0x25, 0x62, 0x58, -+0x2C, 0x25, 0x62, 0x78, 0x2C, 0x25, 0x62, 0x78, -+0x2C, 0x25, 0x62, 0x78, 0x2C, 0x25, 0x62, 0x58, -+0x2C, 0x25, 0x62, 0x78, 0x2C, 0x25, 0x62, 0x78, -+0x2C, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x52, 0x65, 0x71, 0x20, 0x50, 0x45, 0x52, 0x20, -+0x43, 0x4D, 0x44, 0x3A, 0x20, 0x47, 0x72, 0x3A, -+0x25, 0x62, 0x58, 0x2C, 0x20, 0x54, 0x59, 0x50, -+0x3A, 0x25, 0x62, 0x78, 0x2C, 0x20, 0x62, 0x74, -+0x6D, 0x70, 0x3A, 0x25, 0x78, 0x00, 0x00, 0x00, -+0x52, 0x65, 0x71, 0x20, 0x50, 0x45, 0x52, 0x20, -+0x43, 0x4D, 0x44, 0x3A, 0x20, 0x49, 0x64, 0x78, -+0x3A, 0x25, 0x62, 0x78, 0x2C, 0x20, 0x6D, 0x69, -+0x64, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x52, 0x65, 0x71, 0x20, 0x50, 0x45, 0x52, 0x20, -+0x43, 0x4D, 0x44, 0x3A, 0x20, 0x49, 0x64, 0x78, -+0x3A, 0x25, 0x62, 0x78, 0x2C, 0x20, 0x4D, 0x69, -+0x64, 0x3A, 0x25, 0x62, 0x78, 0x2C, 0x20, 0x25, -+0x62, 0x78, 0x2C, 0x20, 0x25, 0x62, 0x78, 0x00, -+0x53, 0x65, 0x74, 0x5F, 0x52, 0x41, 0x5F, 0x55, -+0x70, 0x5F, 0x72, 0x61, 0x74, 0x69, 0x6F, 0x5F, -+0x66, 0x6F, 0x72, 0x5F, 0x52, 0x41, 0x5F, 0x64, -+0x65, 0x62, 0x75, 0x67, 0x00, 0x00, 0x00, 0x00, -+0x53, 0x65, 0x74, 0x5F, 0x44, 0x6F, 0x77, 0x6E, -+0x5F, 0x72, 0x61, 0x74, 0x69, 0x6F, 0x00, 0x00, -+0x76, 0x61, 0x6C, 0x75, 0x65, 0x38, 0x3D, 0x30, -+0x78, 0x25, 0x62, 0x58, 0x2C, 0x20, 0x76, 0x61, -+0x6C, 0x75, 0x65, 0x31, 0x36, 0x3D, 0x30, 0x78, -+0x25, 0x77, 0x78, 0x2C, 0x20, 0x76, 0x61, 0x6C, -+0x75, 0x65, 0x33, 0x32, 0x3D, 0x30, 0x78, 0x25, -+0x78, 0x00, 0x00, 0x00, 0x49, 0x44, 0x3D, 0x25, -+0x62, 0x78, 0x2C, 0x44, 0x69, 0x73, 0x52, 0x41, -+0x3D, 0x25, 0x62, 0x78, 0x2C, 0x44, 0x69, 0x73, -+0x50, 0x54, 0x3D, 0x25, 0x62, 0x78, 0x2C, 0x52, -+0x74, 0x49, 0x44, 0x3D, 0x25, 0x62, 0x78, 0x00, -+0x42, 0x57, 0x3D, 0x25, 0x62, 0x78, 0x2C, 0x42, -+0x57, 0x4D, 0x3D, 0x25, 0x62, 0x78, 0x2C, 0x4E, -+0x6F, 0x55, 0x70, 0x42, 0x77, 0x3D, 0x25, 0x62, -+0x78, 0x2C, 0x53, 0x47, 0x49, 0x3D, 0x25, 0x62, -+0x78, 0x2C, 0x56, 0x48, 0x54, 0x3D, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x63, 0x63, 0x78, 0x5F, -+0x68, 0x32, 0x63, 0x20, 0x25, 0x62, 0x78, 0x2C, -+0x25, 0x62, 0x78, 0x20, 0x50, 0x65, 0x72, 0x69, -+0x6F, 0x64, 0x3D, 0x25, 0x77, 0x78, 0x00, 0x00, -+0x72, 0x65, 0x61, 0x64, 0x79, 0x3D, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x43, 0x6C, 0x6D, 0x52, -+0x70, 0x74, 0x3D, 0x25, 0x77, 0x78, 0x00, 0x00, -+0x43, 0x32, 0x48, 0x20, 0x25, 0x62, 0x78, 0x20, -+0x25, 0x62, 0x78, 0x00, 0x74, 0x62, 0x74, 0x74, -+0x3D, 0x25, 0x62, 0x78, 0x2C, 0x72, 0x5F, 0x63, -+0x6E, 0x74, 0x3D, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x43, 0x4C, 0x4D, 0x5F, 0x44, 0x65, 0x63, 0x00, -+0x43, 0x4C, 0x4D, 0x5F, 0x54, 0x72, 0x69, 0x67, -+0x00, 0x00, 0x00, 0x00, 0x50, 0x45, 0x52, 0x3A, -+0x25, 0x62, 0x78, 0x20, 0x43, 0x75, 0x72, 0x3A, -+0x25, 0x62, 0x78, 0x20, 0x4F, 0x3A, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x4D, 0x61, 0x70, 0x3A, -+0x25, 0x62, 0x78, 0x20, 0x44, 0x69, 0x66, 0x3A, -+0x25, 0x62, 0x78, 0x20, 0x6F, 0x66, 0x74, 0x3A, -+0x25, 0x62, 0x78, 0x00, 0x56, 0x61, 0x72, 0x3A, -+0x20, 0x25, 0x62, 0x78, 0x2D, 0x3E, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x44, 0x65, 0x63, 0x5F, -+0x6F, 0x66, 0x73, 0x74, 0x7B, 0x50, 0x2C, 0x4E, -+0x7D, 0x3A, 0x20, 0x25, 0x62, 0x78, 0x2C, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x4D, 0x74, 0x42, 0x77, -+0x20, 0x55, 0x70, 0x44, 0x77, 0x25, 0x62, 0x78, -+0x20, 0x42, 0x57, 0x25, 0x62, 0x78, 0x20, 0x52, -+0x74, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x48, 0x69, 0x74, 0x25, 0x62, 0x78, 0x20, 0x52, -+0x74, 0x30, 0x3D, 0x25, 0x77, 0x78, 0x20, 0x52, -+0x74, 0x31, 0x3D, 0x25, 0x77, 0x78, 0x00, 0x00, -+0x72, 0x25, 0x62, 0x78, 0x20, 0x4C, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x52, 0x53, 0x53, 0x49, -+0x20, 0x52, 0x6C, 0x73, 0x4C, 0x6D, 0x74, 0x00, -+0x52, 0x53, 0x53, 0x49, 0x20, 0x55, 0x70, 0x4C, -+0x6D, 0x74, 0x00, 0x00, 0x55, 0x70, 0x4C, 0x6D, -+0x74, 0x3A, 0x25, 0x62, 0x78, 0x20, 0x25, 0x62, -+0x78, 0x20, 0x25, 0x62, 0x78, 0x20, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x48, 0x52, 0x3A, 0x25, -+0x62, 0x78, 0x2C, 0x4C, 0x52, 0x3A, 0x25, 0x62, -+0x78, 0x2C, 0x4D, 0x53, 0x3A, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x46, 0x69, 0x78, 0x20, -+0x69, 0x64, 0x3D, 0x25, 0x62, 0x78, 0x20, 0x42, -+0x77, 0x3D, 0x25, 0x62, 0x78, 0x20, 0x52, 0x74, -+0x3D, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x52, 0x61, 0x4F, 0x63, 0x63, 0x4E, 0x75, 0x6D, -+0x25, 0x62, 0x78, 0x00, 0x52, 0x61, 0x44, 0x77, -+0x54, 0x79, 0x20, 0x52, 0x74, 0x3D, 0x25, 0x62, -+0x78, 0x2C, 0x42, 0x77, 0x25, 0x62, 0x78, 0x00, -+0x55, 0x70, 0x52, 0x61, 0x74, 0x65, 0x25, 0x62, -+0x78, 0x20, 0x42, 0x57, 0x25, 0x62, 0x78, 0x20, -+0x4D, 0x61, 0x78, 0x42, 0x57, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x30, 0x55, 0x70, 0x64, -+0x74, 0x5F, 0x42, 0x57, 0x3D, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x53, 0x47, 0x49, 0x5F, -+0x52, 0x61, 0x74, 0x65, 0x3D, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x33, 0x72, 0x61, 0x74, -+0x65, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x34, 0x72, 0x61, 0x74, 0x65, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x35, 0x72, 0x61, 0x74, -+0x65, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x30, 0x52, 0x74, 0x25, 0x62, 0x78, 0x20, 0x25, -+0x62, 0x78, 0x20, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x31, 0x52, 0x74, 0x25, 0x62, 0x78, 0x20, 0x25, -+0x62, 0x78, 0x20, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x4E, 0x6F, 0x20, 0x55, 0x70, 0x20, 0x52, 0x61, -+0x74, 0x65, 0x00, 0x00, 0x32, 0x52, 0x74, 0x3A, -+0x25, 0x62, 0x78, 0x20, 0x25, 0x62, 0x78, 0x20, -+0x25, 0x62, 0x78, 0x2C, 0x20, 0x54, 0x72, 0x79, -+0x3D, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x44, 0x6E, 0x52, 0x61, 0x74, 0x65, 0x25, 0x62, -+0x78, 0x20, 0x42, 0x57, 0x25, 0x62, 0x78, 0x20, -+0x4D, 0x61, 0x78, 0x42, 0x57, 0x25, 0x62, 0x78, -+0x00, 0x00, 0x00, 0x00, 0x44, 0x5F, 0x52, 0x74, -+0x25, 0x62, 0x78, 0x20, 0x42, 0x77, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x50, 0x6B, 0x74, 0x20, -+0x54, 0x72, 0x79, 0x69, 0x6E, 0x67, 0x00, 0x00, -+0x44, 0x72, 0x6F, 0x70, 0x00, 0x00, 0x00, 0x00, -+0x6F, 0x72, 0x69, 0x5F, 0x50, 0x25, 0x62, 0x78, -+0x2C, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x4B, 0x25, 0x62, 0x78, 0x20, 0x54, 0x25, 0x62, -+0x78, 0x20, 0x44, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x42, 0x77, 0x3D, 0x25, 0x62, 0x78, 0x2C, 0x20, -+0x42, 0x77, 0x32, 0x3D, 0x25, 0x62, 0x78, 0x20, -+0x52, 0x74, 0x3D, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x30, 0x55, 0x70, 0x25, 0x62, 0x78, 0x2C, 0x44, -+0x77, 0x6E, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x31, 0x55, 0x70, 0x25, 0x62, 0x78, 0x2C, 0x44, -+0x77, 0x6E, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x32, 0x55, 0x70, 0x25, 0x62, 0x78, 0x2C, 0x44, -+0x77, 0x6E, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, -+0x46, 0x77, 0x20, 0x46, 0x69, 0x78, 0x20, 0x52, -+0x61, 0x74, 0x65, 0x00, 0x46, 0x6F, 0x72, 0x63, -+0x65, 0x52, 0x61, 0x74, 0x65, 0x44, 0x77, 0x00, -+0x52, 0x74, 0x44, 0x77, 0x6E, 0x43, 0x6E, 0x74, -+0x3D, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x52, 0x61, 0x74, 0x65, 0x44, 0x6F, 0x77, 0x6E, -+0x00, 0x00, 0x00, 0x00, 0x52, 0x74, 0x55, 0x70, -+0x43, 0x6E, 0x74, 0x3D, 0x25, 0x62, 0x78, 0x00, -+0x52, 0x61, 0x74, 0x65, 0x55, 0x50, 0x00, 0x00, -+0x52, 0x61, 0x74, 0x65, 0x53, 0x74, 0x61, 0x79, -+0x00, 0x00, 0x00, 0x00, 0x54, 0x72, 0x79, 0x53, -+0x75, 0x63, 0x63, 0x65, 0x73, 0x73, 0x00, 0x00, -+0x54, 0x72, 0x79, 0x66, 0x61, 0x69, 0x6C, 0x00, -+0x4D, 0x74, 0x54, 0x72, 0x79, 0x3D, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x42, 0x57, 0x25, 0x62, -+0x78, 0x20, 0x52, 0x74, 0x25, 0x62, 0x78, 0x00, -+0x6F, 0x6B, 0x25, 0x62, 0x78, 0x20, 0x74, 0x74, -+0x25, 0x62, 0x78, 0x20, 0x64, 0x70, 0x25, 0x62, -+0x78, 0x20, 0x6F, 0x61, 0x25, 0x62, 0x78, 0x00, -+0x5B, 0x54, 0x52, 0x59, 0x5D, 0x20, 0x50, 0x25, -+0x62, 0x78, 0x2C, 0x25, 0x62, 0x78, 0x20, 0x42, -+0x77, 0x3D, 0x25, 0x62, 0x78, 0x20, 0x52, 0x74, -+0x3D, 0x25, 0x62, 0x78, 0x00, 0x00, 0x00, 0x00, -+0x50, 0x72, 0x20, 0x25, 0x62, 0x78, 0x20, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x52, 0x74, 0x20, 0x25, -+0x62, 0x78, 0x20, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x54, 0x70, 0x25, 0x77, 0x78, 0x20, 0x25, 0x77, -+0x78, 0x00, 0x00, 0x00, 0x55, 0x70, 0x46, 0x61, -+0x69, 0x6C, 0x00, 0x00, 0x54, 0x79, 0x53, 0x75, -+0x63, 0x52, 0x74, 0x20, 0x25, 0x62, 0x78, 0x00, -+0x72, 0x61, 0x5F, 0x69, 0x64, 0x78, 0x25, 0x62, -+0x78, 0x2C, 0x63, 0x74, 0x72, 0x6C, 0x25, 0x62, -+0x78, 0x00, 0x00, 0x00, 0x31, 0x52, 0x74, 0x3D, -+0x25, 0x62, 0x78, 0x2D, 0x3E, 0x25, 0x62, 0x78, -+0x20, 0x52, 0x5B, 0x25, 0x62, 0x78, 0x5D, 0x4F, -+0x6B, 0x3A, 0x25, 0x62, 0x78, 0x2B, 0x44, 0x70, -+0x3A, 0x25, 0x62, 0x78, 0x3D, 0x54, 0x3A, 0x25, -+0x62, 0x78, 0x20, 0x54, 0x61, 0x6C, 0x6C, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x43, 0x25, 0x62, 0x78, -+0x20, 0x4E, 0x25, 0x62, 0x78, 0x20, 0x50, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x43, 0x32, 0x48, 0x50, -+0x6B, 0x74, 0x3A, 0x25, 0x62, 0x78, 0x20, 0x25, -+0x62, 0x78, 0x00, 0x00, 0x54, 0x62, 0x74, 0x74, -+0x52, 0x41, 0x20, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x32, 0x52, 0x74, 0x3D, 0x25, 0x62, 0x78, 0x2D, -+0x3E, 0x25, 0x62, 0x78, 0x20, 0x52, 0x5B, 0x25, -+0x62, 0x78, 0x5D, 0x4F, 0x6B, 0x3A, 0x25, 0x62, -+0x78, 0x2B, 0x44, 0x70, 0x3A, 0x25, 0x62, 0x78, -+0x21, 0x54, 0x3A, 0x25, 0x62, 0x78, 0x20, 0x54, -+0x61, 0x6C, 0x6C, 0x25, 0x62, 0x78, 0x00, 0x00, -+0x44, 0x69, 0x73, 0x52, 0x61, 0x49, 0x44, 0x20, -+0x25, 0x62, 0x78, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x64, 0x69, 0x73, 0x61, 0x62, 0x6C, -+0x65, 0x20, 0x50, 0x48, 0x59, 0x20, 0x41, 0x50, -+0x49, 0x20, 0x66, 0x6F, 0x72, 0x20, 0x64, 0x65, -+0x62, 0x75, 0x67, 0x21, 0x21, 0x0A, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x75, 0x6E, -+0x73, 0x75, 0x70, 0x70, 0x6F, 0x72, 0x74, 0x65, -+0x64, 0x20, 0x70, 0x61, 0x74, 0x68, 0x20, 0x28, -+0x25, 0x64, 0x29, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x50, 0x61, -+0x74, 0x68, 0x2D, 0x25, 0x64, 0x20, 0x52, 0x61, -+0x74, 0x65, 0x20, 0x69, 0x6E, 0x64, 0x65, 0x78, -+0x20, 0x30, 0x78, 0x25, 0x78, 0x20, 0x28, 0x30, -+0x78, 0x25, 0x78, 0x29, 0x20, 0x3D, 0x20, 0x30, -+0x78, 0x25, 0x78, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x50, 0x61, -+0x74, 0x68, 0x2D, 0x25, 0x64, 0x20, 0x72, 0x61, -+0x74, 0x65, 0x20, 0x69, 0x6E, 0x64, 0x65, 0x78, -+0x20, 0x30, 0x78, 0x25, 0x78, 0x20, 0x3D, 0x20, -+0x30, 0x78, 0x25, 0x78, 0x0A, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x52, 0x46, -+0x2D, 0x25, 0x64, 0x20, 0x30, 0x78, 0x25, 0x78, -+0x20, 0x3D, 0x20, 0x30, 0x78, 0x25, 0x78, 0x2C, -+0x20, 0x62, 0x69, 0x74, 0x20, 0x6D, 0x61, 0x73, -+0x6B, 0x20, 0x3D, 0x20, 0x30, 0x78, 0x25, 0x78, -+0x0A, 0x00, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x57, 0x72, 0x69, 0x74, 0x65, 0x20, -+0x66, 0x61, 0x69, 0x6C, 0x2C, 0x20, 0x52, 0x46, -+0x20, 0x69, 0x73, 0x20, 0x64, 0x69, 0x73, 0x61, -+0x62, 0x6C, 0x65, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x52, 0x46, -+0x2D, 0x25, 0x64, 0x20, 0x30, 0x78, 0x25, 0x78, -+0x20, 0x3D, 0x20, 0x30, 0x78, 0x25, 0x78, 0x20, -+0x28, 0x6F, 0x72, 0x69, 0x67, 0x69, 0x6E, 0x61, -+0x6C, 0x3A, 0x20, 0x30, 0x78, 0x25, 0x78, 0x29, -+0x2C, 0x20, 0x62, 0x69, 0x74, 0x20, 0x6D, 0x61, -+0x73, 0x6B, 0x20, 0x3D, 0x20, 0x30, 0x78, 0x25, -+0x78, 0x0A, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3E, 0x0A, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x63, 0x68, 0x61, -+0x6E, 0x6E, 0x65, 0x6C, 0x20, 0x28, 0x52, 0x46, -+0x31, 0x38, 0x29, 0x20, 0x28, 0x63, 0x68, 0x3A, -+0x20, 0x25, 0x64, 0x29, 0x0A, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x63, 0x68, 0x61, -+0x6E, 0x6E, 0x65, 0x6C, 0x20, 0x28, 0x41, 0x47, -+0x43, 0x29, 0x20, 0x28, 0x63, 0x68, 0x3A, 0x20, -+0x25, 0x64, 0x29, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x63, 0x68, 0x61, -+0x6E, 0x6E, 0x65, 0x6C, 0x20, 0x28, 0x66, 0x63, -+0x5F, 0x61, 0x72, 0x65, 0x61, 0x29, 0x20, 0x28, -+0x63, 0x68, 0x3A, 0x20, 0x25, 0x64, 0x29, 0x0A, -+0x00, 0x00, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x46, 0x61, 0x69, 0x6C, 0x20, 0x74, -+0x6F, 0x20, 0x73, 0x77, 0x69, 0x74, 0x63, 0x68, -+0x20, 0x62, 0x61, 0x6E, 0x64, 0x20, 0x28, 0x63, -+0x68, 0x3A, 0x20, 0x25, 0x64, 0x29, 0x0A, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x63, 0x68, 0x61, -+0x6E, 0x6E, 0x65, 0x6C, 0x20, 0x28, 0x63, 0x68, -+0x3A, 0x20, 0x25, 0x64, 0x29, 0x2C, 0x20, 0x62, -+0x65, 0x63, 0x61, 0x75, 0x73, 0x65, 0x20, 0x77, -+0x72, 0x69, 0x74, 0x69, 0x6E, 0x67, 0x20, 0x52, -+0x46, 0x20, 0x72, 0x65, 0x67, 0x69, 0x73, 0x74, -+0x65, 0x72, 0x20, 0x69, 0x73, 0x20, 0x66, 0x61, -+0x69, 0x6C, 0x0A, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x53, 0x75, 0x63, 0x63, 0x65, 0x73, -+0x73, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, 0x69, -+0x74, 0x63, 0x68, 0x20, 0x63, 0x68, 0x61, 0x6E, -+0x6E, 0x65, 0x6C, 0x20, 0x28, 0x63, 0x68, 0x3A, -+0x20, 0x25, 0x64, 0x29, 0x0A, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3E, 0x0A, 0x00, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x62, 0x61, 0x6E, -+0x64, 0x20, 0x28, 0x63, 0x68, 0x3A, 0x20, 0x25, -+0x64, 0x29, 0x2C, 0x20, 0x62, 0x65, 0x63, 0x61, -+0x75, 0x73, 0x65, 0x20, 0x77, 0x72, 0x69, 0x74, -+0x69, 0x6E, 0x67, 0x20, 0x52, 0x46, 0x20, 0x72, -+0x65, 0x67, 0x69, 0x73, 0x74, 0x65, 0x72, 0x20, -+0x69, 0x73, 0x20, 0x66, 0x61, 0x69, 0x6C, 0x0A, -+0x00, 0x00, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x53, 0x75, 0x63, 0x63, 0x65, 0x73, -+0x73, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, 0x69, -+0x74, 0x63, 0x68, 0x20, 0x62, 0x61, 0x6E, 0x64, -+0x20, 0x28, 0x63, 0x68, 0x3A, 0x20, 0x25, 0x64, -+0x29, 0x0A, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, 0x3D, -+0x3D, 0x3D, 0x3D, 0x3E, 0x0A, 0x00, 0x00, 0x00, -+0x5B, 0x25, 0x73, 0x5D, 0x3A, 0x20, 0x46, 0x61, -+0x69, 0x6C, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, -+0x69, 0x74, 0x63, 0x68, 0x20, 0x62, 0x61, 0x6E, -+0x64, 0x77, 0x69, 0x64, 0x74, 0x68, 0x20, 0x28, -+0x62, 0x77, 0x3A, 0x20, 0x25, 0x64, 0x2C, 0x20, -+0x70, 0x72, 0x69, 0x6D, 0x61, 0x72, 0x79, 0x20, -+0x63, 0x68, 0x3A, 0x20, 0x25, 0x64, 0x29, 0x0A, -+0x00, 0x00, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x46, 0x61, 0x69, 0x6C, 0x20, 0x74, -+0x6F, 0x20, 0x73, 0x77, 0x69, 0x74, 0x63, 0x68, -+0x20, 0x62, 0x61, 0x6E, 0x64, 0x77, 0x69, 0x64, -+0x74, 0x68, 0x20, 0x28, 0x62, 0x77, 0x3A, 0x20, -+0x25, 0x64, 0x2C, 0x20, 0x70, 0x72, 0x69, 0x6D, -+0x61, 0x72, 0x79, 0x20, 0x63, 0x68, 0x3A, 0x20, -+0x25, 0x64, 0x29, 0x2C, 0x20, 0x62, 0x65, 0x63, -+0x61, 0x75, 0x73, 0x65, 0x20, 0x77, 0x72, 0x69, -+0x74, 0x69, 0x6E, 0x67, 0x20, 0x52, 0x46, 0x20, -+0x72, 0x65, 0x67, 0x69, 0x73, 0x74, 0x65, 0x72, -+0x20, 0x69, 0x73, 0x20, 0x66, 0x61, 0x69, 0x6C, -+0x0A, 0x00, 0x00, 0x00, 0x5B, 0x25, 0x73, 0x5D, -+0x3A, 0x20, 0x53, 0x75, 0x63, 0x63, 0x65, 0x73, -+0x73, 0x20, 0x74, 0x6F, 0x20, 0x73, 0x77, 0x69, -+0x74, 0x63, 0x68, 0x20, 0x62, 0x61, 0x6E, 0x64, -+0x77, 0x69, 0x64, 0x74, 0x68, 0x20, 0x28, 0x62, -+0x77, 0x3A, 0x20, 0x25, 0x64, 0x2C, 0x20, 0x70, -+0x72, 0x69, 0x6D, 0x61, 0x72, 0x79, 0x20, 0x63, -+0x68, 0x3A, 0x20, 0x25, 0x64, 0x29, 0x0A, 0x00, -+0x44, 0x61, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x10, 0xF0, 0x23, 0x6A, 0x40, 0xF2, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x00, 0xF4, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xA0, 0xF4, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x20, 0xF5, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x03, 0xF7, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x24, 0xF0, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x03, 0xF7, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF5, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF4, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF2, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x60, 0xF5, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA0, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA0, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF1, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x61, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF5, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF1, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF6, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x62, 0xF1, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA2, 0xF0, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF6, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF5, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x60, 0xF0, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x7F, 0xF6, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC2, 0xF5, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x5F, 0xF6, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF7, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x42, 0xF6, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF6, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xE3, 0xF6, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xFF, 0xF7, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xBF, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF0, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE0, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF3, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF3, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF1, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x62, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC2, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x41, 0xF4, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF2, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF7, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x61, 0xF0, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF0, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF7, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF1, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x22, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x82, 0xF7, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA2, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x1F, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x63, 0xF0, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA3, 0xF0, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC3, 0xF0, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF3, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x83, 0xF3, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC3, 0xF3, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x03, 0xF4, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF4, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x63, 0xF4, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA3, 0xF6, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE3, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF7, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA4, 0xF0, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x04, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x64, 0xF1, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x84, 0xF3, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE4, 0xF3, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x04, 0xF4, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x44, 0xF4, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x5C, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0xEF, 0xF6, 0x00, 0x4C, -+0x00, 0x6D, 0x07, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x04, 0x6B, 0xC8, 0xF3, -+0x7C, 0xC2, 0x03, 0x6B, 0xC8, 0xF3, 0x7D, 0xC2, -+0x64, 0x6B, 0xC8, 0xF3, 0x7E, 0xCA, 0x01, 0x6B, -+0xE8, 0xF3, 0x60, 0xC2, 0x05, 0x6B, 0xE8, 0xF3, -+0x61, 0xC2, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0x70, 0x6E, 0x28, 0xF5, 0x1C, 0x4C, 0x00, 0x6D, -+0x30, 0xF0, 0x20, 0x68, 0x40, 0xEA, 0xC0, 0xF1, -+0x08, 0x48, 0x00, 0x18, 0x6D, 0xCA, 0x02, 0x6A, -+0x68, 0xF3, 0x56, 0xC0, 0x10, 0x6A, 0x88, 0xF3, -+0x44, 0xC0, 0x05, 0x6A, 0x88, 0xF3, 0x4A, 0xC8, -+0x88, 0xF3, 0x5B, 0xA0, 0x01, 0x69, 0x88, 0xF3, -+0x22, 0xC0, 0x04, 0x4A, 0x88, 0xF3, 0x56, 0xC0, -+0x10, 0x6A, 0x88, 0xF3, 0x57, 0xC0, 0x88, 0xF3, -+0x23, 0xC0, 0x80, 0x18, 0x79, 0x05, 0x00, 0x6C, -+0xA4, 0x67, 0x00, 0x18, 0xE4, 0xC8, 0x02, 0x6C, -+0x0C, 0x6D, 0x00, 0x18, 0xE4, 0xC8, 0x01, 0x6C, -+0x0C, 0x6D, 0x00, 0x18, 0xE4, 0xC8, 0x30, 0xF0, -+0x20, 0x6C, 0x00, 0x6D, 0x48, 0xF5, 0x10, 0x4C, -+0x00, 0x18, 0xA1, 0xF5, 0xE8, 0xF3, 0x66, 0xA0, -+0x0F, 0x6A, 0xE8, 0xF3, 0x45, 0xC0, 0x01, 0x6A, -+0x6C, 0xEA, 0x28, 0x6B, 0x6D, 0xEA, 0xE8, 0xF3, -+0x46, 0xC0, 0x07, 0x6A, 0xE8, 0xF3, 0x47, 0xC0, -+0x88, 0xF3, 0x5B, 0xA0, 0x01, 0x6C, 0xE8, 0xF3, -+0x24, 0xC0, 0x04, 0x4A, 0x88, 0xF3, 0x56, 0xC0, -+0x10, 0x6A, 0x88, 0xF3, 0x57, 0xC0, 0x00, 0x18, -+0xAD, 0xC9, 0x00, 0x6C, 0xA4, 0x67, 0x00, 0x18, -+0x3E, 0xD1, 0x01, 0x6C, 0x00, 0x6D, 0x00, 0x18, -+0x3E, 0xD1, 0x02, 0x6C, 0x00, 0x6D, 0x00, 0x18, -+0x3E, 0xD1, 0x03, 0x6C, 0x00, 0x6D, 0x00, 0x18, -+0x3E, 0xD1, 0x04, 0x6C, 0x00, 0x6D, 0x00, 0x18, -+0x3E, 0xD1, 0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, -+0x70, 0x9A, 0xF8, 0x6A, 0x00, 0x6D, 0x80, 0xA3, -+0xC5, 0x67, 0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0x00, 0x6B, 0xC1, 0xF6, -+0x62, 0xC2, 0xC1, 0xF6, 0x63, 0xC2, 0xC1, 0xF6, -+0x64, 0xC2, 0xC1, 0xF6, 0x65, 0xC2, 0x20, 0xE8, -+0x10, 0xF0, 0x23, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x24, 0xF0, 0x19, 0x4B, 0x40, 0xF1, 0x68, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0x40, 0xF1, 0x08, 0x4A, -+0x40, 0xF5, 0x09, 0x4B, 0x61, 0xDA, 0x10, 0xF0, -+0x23, 0x6B, 0xC0, 0xF5, 0x05, 0x4B, 0x62, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0xA0, 0xF5, 0x15, 0x4B, -+0x63, 0xDA, 0x10, 0xF0, 0x23, 0x6B, 0xA0, 0xF5, -+0x05, 0x4B, 0x64, 0xDA, 0x10, 0xF0, 0x23, 0x6B, -+0x80, 0xF5, 0x15, 0x4B, 0x65, 0xDA, 0x10, 0xF0, -+0x23, 0x6B, 0x80, 0xF5, 0x05, 0x4B, 0x66, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0x60, 0xF5, 0x15, 0x4B, -+0x67, 0xDA, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xA8, 0xF4, 0x17, 0x4A, 0x67, 0x42, 0x09, 0x4B, -+0x00, 0x6C, 0x80, 0xC2, 0x01, 0x4A, 0x6A, 0xEA, -+0xFB, 0x61, 0x42, 0xF4, 0x10, 0x6A, 0x1F, 0xF7, -+0x00, 0x6B, 0x4C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xBB, 0xF6, 0x7C, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xDB, 0xF6, 0x60, 0x9B, 0x6D, 0xE2, -+0x04, 0x4A, 0x00, 0x6C, 0x62, 0xF4, 0x00, 0x72, -+0x80, 0xDB, 0xE9, 0x61, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0xEF, 0xF4, 0x0F, 0x4C, 0x00, 0x6D, 0x03, 0x6E, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF0, 0x58, 0x9A, 0x03, 0x6D, 0xFF, 0x6B, -+0x80, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF0, -+0x5C, 0x9A, 0x00, 0xF5, 0x82, 0x34, 0xAC, 0xEC, -+0x40, 0x9A, 0x01, 0x74, 0x42, 0x32, 0x52, 0x32, -+0xAC, 0xEA, 0x06, 0x60, 0x0A, 0x2C, 0x02, 0x5A, -+0x28, 0x6C, 0x0D, 0x60, 0x50, 0x6C, 0x0B, 0x10, -+0x02, 0x5A, 0x14, 0x6C, 0x08, 0x60, 0x28, 0x6C, -+0x04, 0x10, 0x02, 0x5A, 0x0A, 0x6C, 0x03, 0x60, -+0x14, 0x6C, 0x84, 0xEA, 0x6C, 0xEC, 0x80, 0x18, -+0x05, 0x07, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0x00, 0x6B, 0xE0, 0xF1, 0x7F, 0xC2, -+0x10, 0xF0, 0x24, 0x6B, 0x3B, 0xF7, 0x6C, 0x9B, -+0x00, 0x6A, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0x9B, 0xF6, 0x6C, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0x1C, 0xF0, 0x74, 0x9B, 0x40, 0xC3, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x68, 0x04, 0xD2, 0x04, 0x94, -+0x4E, 0xF2, 0x4C, 0x98, 0x00, 0x6D, 0x4C, 0xF7, -+0x14, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x05, 0xD2, 0x05, 0x94, -+0x4E, 0xF2, 0x4C, 0x98, 0x00, 0x6D, 0xA0, 0xF6, -+0x0C, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x30, 0x69, -+0x4E, 0xF2, 0x4C, 0x98, 0x00, 0xF0, 0x00, 0x49, -+0x91, 0x67, 0x00, 0x6D, 0xC2, 0xF0, 0x10, 0x6E, -+0x40, 0xEA, 0x80, 0x18, 0xC5, 0x05, 0x04, 0x92, -+0x00, 0x68, 0x40, 0xF0, 0x00, 0xC1, 0x80, 0xF0, -+0x0C, 0xDA, 0x80, 0x18, 0xCC, 0x05, 0x00, 0x18, -+0x0F, 0xDE, 0x05, 0x92, 0x30, 0xF0, 0x20, 0x6C, -+0xED, 0xF0, 0x16, 0x4C, 0x00, 0xF2, 0x00, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xED, 0xF0, 0x06, 0x4A, -+0x00, 0x6B, 0x60, 0xC2, 0x70, 0xC2, 0x01, 0x4A, -+0x62, 0x67, 0x8E, 0xEB, 0xF9, 0x2B, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x28, 0xF1, -+0x73, 0xC2, 0x2C, 0xF7, 0x7E, 0xC2, 0x2C, 0xF7, -+0x7F, 0xC2, 0x28, 0xF1, 0x72, 0xC2, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x80, 0x18, 0xE3, 0x05, 0x80, 0x18, 0x7E, 0x06, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x58, 0x9A, -+0x30, 0xF0, 0x20, 0x68, 0xEF, 0xF4, 0x08, 0x48, -+0x40, 0xEA, 0x80, 0x18, 0xF7, 0x17, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF3, 0x58, 0x9A, 0x01, 0x69, -+0x2B, 0xE9, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0x1C, 0x6E, 0xAF, 0xF5, 0x18, 0x4C, 0x00, 0x6D, -+0x40, 0xEA, 0xC0, 0xF0, 0x79, 0xA0, 0x08, 0x6A, -+0x4B, 0xEA, 0xB1, 0x67, 0x41, 0xF4, 0x18, 0x6C, -+0x6C, 0xEA, 0xC0, 0xF0, 0x59, 0xC0, 0x00, 0x18, -+0xE4, 0xE6, 0x30, 0xF0, 0x20, 0x6B, 0x89, 0xF2, -+0x58, 0xDB, 0x1E, 0x6A, 0xE0, 0xF0, 0x44, 0xC0, -+0x04, 0x6A, 0xE0, 0xF0, 0x46, 0xC0, 0x80, 0x18, -+0x83, 0x05, 0x80, 0x18, 0x71, 0x05, 0x00, 0x18, -+0xA3, 0xC4, 0x00, 0x18, 0x8E, 0xEF, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF5, 0x44, 0x9A, 0x40, 0xEA, -+0x80, 0x18, 0x16, 0x07, 0x00, 0x18, 0x55, 0xDE, -+0x00, 0x18, 0x37, 0xE9, 0x10, 0xF0, 0x24, 0x6C, -+0xF1, 0x67, 0x74, 0xF3, 0x0D, 0x4C, 0x00, 0x6D, -+0x64, 0x6E, 0x01, 0x6A, 0x04, 0xD2, 0x00, 0x18, -+0x9E, 0xE9, 0x80, 0x18, 0xF6, 0x05, 0x00, 0x18, -+0x5A, 0xE9, 0x80, 0x18, 0x72, 0x08, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0x6B, 0xEF, 0xF4, -+0x08, 0x4A, 0xA0, 0xF0, 0x6A, 0xC2, 0xA0, 0xF0, -+0x6B, 0xC2, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0x40, 0xF0, 0x60, 0xC2, 0x40, 0xF0, -+0x61, 0xC2, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0x7C, 0xF3, 0x54, 0x9A, 0x01, 0x6B, 0x60, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0x7C, 0xF3, 0x98, 0x9A, 0xFF, 0x6B, 0x20, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF3, -+0x88, 0x9A, 0x08, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF3, 0x7C, 0x9A, -+0xFD, 0x6A, 0xFF, 0x6C, 0xA0, 0xA3, 0xAC, 0xEA, -+0x40, 0xC3, 0x40, 0xA3, 0x01, 0x6D, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF1, 0x0C, 0x9A, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, 0x90, 0x67, -+0x00, 0x6D, 0x02, 0xF0, 0x00, 0x6E, 0x40, 0xEA, -+0x04, 0x6A, 0x40, 0xC0, 0x10, 0xF0, 0x24, 0x6A, -+0x9C, 0xF3, 0x40, 0x9A, 0x20, 0x48, 0x0E, 0xEA, -+0xF7, 0x2A, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0x7C, 0xF1, 0x94, 0x9B, 0x4E, 0xF2, -+0x4C, 0x9A, 0x00, 0x6D, 0x00, 0xF4, 0x00, 0x6E, -+0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF3, 0xAC, 0x9A, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF3, 0x12, 0x6E, 0xC0, 0xF1, 0xC8, 0xDB, -+0x01, 0xF7, 0x01, 0x6A, 0xC0, 0xF1, 0x08, 0x4B, -+0x00, 0x6C, 0x42, 0xDB, 0x43, 0xDB, 0xA1, 0xDB, -+0x84, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF3, -+0x78, 0x9B, 0xC0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF3, 0x60, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xBC, 0xF3, 0x68, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF3, 0x70, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF3, -+0x58, 0x9A, 0x80, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x80, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x58, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF3, -+0x68, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0xDC, 0xF3, 0x90, 0x9B, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xC0, 0xF1, 0x06, 0x6D, 0xFF, 0x6B, 0xAE, 0xDA, -+0x8F, 0xDA, 0x70, 0xDA, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF3, 0x5C, 0x9A, 0xA0, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF3, 0x40, 0x9A, 0x80, 0xDA, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF3, 0x48, 0x9A, -+0x60, 0xDA, 0x20, 0xE8, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0x05, 0x08, -+0x30, 0xF0, 0x20, 0x6B, 0xE8, 0xF2, 0x5C, 0xC3, -+0x80, 0x18, 0x96, 0x06, 0x00, 0x18, 0x9E, 0xEC, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF3, 0x5C, 0x9A, -+0x3F, 0x6B, 0x60, 0xC2, 0x80, 0x18, 0x87, 0x06, -+0x80, 0x18, 0x8B, 0x06, 0x80, 0x18, 0x0B, 0x07, -+0x80, 0x18, 0x9E, 0x06, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0x00, 0x6A, -+0xC0, 0xF1, 0x08, 0x48, 0x01, 0x6C, 0x02, 0x6D, -+0x00, 0x6E, 0x40, 0xF0, 0x50, 0xC8, 0x00, 0x18, -+0x4B, 0xD3, 0x40, 0xF0, 0xD0, 0xA8, 0x01, 0x6C, -+0x03, 0x6D, 0xC2, 0x36, 0x00, 0x18, 0x4B, 0xD3, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x61, 0xE1, -+0x00, 0x18, 0x80, 0xE1, 0x80, 0x18, 0xB3, 0x06, -+0x80, 0x18, 0xD0, 0x06, 0x80, 0x18, 0xCA, 0x06, -+0x80, 0x18, 0xEF, 0x06, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xAE, 0xD4, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x54, 0x9A, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x81, 0xF4, 0x10, 0x6B, -+0x28, 0xF1, 0x78, 0xDA, 0x00, 0xF2, 0x00, 0x4B, -+0x28, 0xF1, 0x7C, 0xDA, 0x01, 0xF2, 0x00, 0x4B, -+0x48, 0xF1, 0x60, 0xDA, 0x00, 0xF2, 0x00, 0x4B, -+0x48, 0xF1, 0x64, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF4, 0x44, 0x9A, 0xE0, 0xF1, 0x1B, 0x6B, -+0x6B, 0xEB, 0x60, 0xCA, 0x10, 0xF0, 0x24, 0x6A, -+0x1C, 0xF0, 0x60, 0x9A, 0xFB, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x23, 0x6A, 0xEA, 0xF3, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x0A, 0xF4, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x50, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x90, 0xF4, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x54, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x43, 0xF4, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x58, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF1, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, 0x50, 0xDB, -+0x10, 0xF0, 0x31, 0x6A, 0x52, 0xF4, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, 0x54, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF1, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x74, 0xF1, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, 0x58, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x14, 0xF2, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x6C, 0xF5, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xE9, 0xF5, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x89, 0xF5, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x44, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x33, 0xF3, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x48, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xF0, 0xF0, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x4C, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF1, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x50, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xF5, 0xF6, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x54, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0xC6, 0xF6, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x48, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xB7, 0xF5, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF5, 0x4C, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x17, 0xF5, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF5, 0x44, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF5, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x50, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF5, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x0C, 0xF1, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x0C, 0xF3, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xD3, 0xF5, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF2, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x03, 0xF6, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF2, 0x44, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x57, 0xF0, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF3, 0x48, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x87, 0xF1, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF3, 0x50, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x37, 0xF3, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF3, 0x5C, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x47, 0xF5, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF3, 0x50, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x47, 0xF4, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF3, 0x58, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x46, 0xF7, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF3, 0x4C, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0xE6, 0xF7, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF3, 0x5C, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x07, 0xF2, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF3, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF5, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF3, 0x44, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0xA7, 0xF2, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF3, 0x44, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xBA, 0xF5, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF3, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x46, 0xF6, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x09, 0xF0, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x29, 0xF3, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x89, 0xF0, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xA9, 0xF1, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x58, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xD3, 0xF3, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x8A, 0xF3, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xAA, 0xF3, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x8A, 0xF3, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x58, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x91, 0xF2, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x40, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x05, 0xF6, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x05, 0xF1, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF5, 0x4C, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x86, 0xF5, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF5, 0x50, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x66, 0xF3, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF5, 0x54, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0xA6, 0xF1, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF6, 0x40, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0xC5, 0xF6, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0xA6, 0xF2, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x25, 0xF2, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x25, 0xF3, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0xC5, 0xF3, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x26, 0xF4, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF6, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0x7C, 0xF5, 0x48, 0x9A, 0x60, 0x9A, 0x03, 0x6A, -+0x62, 0x33, 0x72, 0x33, 0x4C, 0xEB, 0x02, 0x6A, -+0x04, 0x23, 0x01, 0x73, 0x01, 0x6A, 0x01, 0x60, -+0x03, 0x6A, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x20, 0x72, 0x2B, 0x60, -+0x21, 0x5A, 0x04, 0x60, 0x08, 0x22, 0x10, 0x72, -+0x16, 0x60, 0x56, 0x10, 0x30, 0x72, 0x33, 0x60, -+0x40, 0x72, 0x41, 0x60, 0x51, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF7, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xFB, 0xF6, 0x88, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF6, 0x98, 0xA2, 0x3F, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF7, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xFB, 0xF6, 0x94, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF6, 0x99, 0xA2, 0x2F, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF7, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xFB, 0xF6, 0x88, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF6, 0x9A, 0xA2, 0x1F, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF7, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xFB, 0xF6, 0x94, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF6, 0x9B, 0xA2, 0x0F, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF7, 0x7C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xFB, 0xF6, 0x88, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF6, 0x9C, 0xA2, 0x00, 0x18, 0x74, 0xC5, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xE0, 0x63, 0x3F, 0x62, 0xFF, 0x6A, 0x01, 0x6B, -+0x8C, 0xEA, 0x6B, 0xEB, 0x9D, 0x67, 0x70, 0xC4, -+0x23, 0x6B, 0x72, 0xC4, 0x20, 0x72, 0x10, 0x6B, -+0x73, 0xC4, 0x0F, 0x60, 0x21, 0x5A, 0x04, 0x60, -+0x12, 0x22, 0x10, 0x72, 0x07, 0x60, 0x11, 0x10, -+0x30, 0x72, 0x09, 0x60, 0x40, 0x72, 0x40, 0x6A, -+0x0A, 0x60, 0x0B, 0x10, 0x9D, 0x67, 0x74, 0xC4, -+0x08, 0x10, 0x20, 0x6A, 0x04, 0x10, 0x30, 0x6A, -+0x9D, 0x67, 0x54, 0xC4, 0x02, 0x10, 0x7D, 0x67, -+0x54, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x04, 0x04, 0x40, 0xEA, 0x3F, 0x97, -+0x20, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x20, 0x74, 0x17, 0x60, -+0x21, 0x5C, 0x04, 0x60, 0x08, 0x24, 0x10, 0x74, -+0x0C, 0x60, 0x27, 0x10, 0x30, 0x74, 0x15, 0x60, -+0x40, 0x74, 0x19, 0x60, 0x22, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xCF, 0xF6, 0xBD, 0xA3, 0x02, 0x6B, -+0x17, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF6, -+0xBD, 0xA3, 0x04, 0x6B, 0x11, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xCF, 0xF6, 0xBD, 0xA3, 0x08, 0x6B, -+0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF6, -+0xBD, 0xA3, 0x10, 0x6B, 0x05, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xCF, 0xF6, 0xBD, 0xA3, 0x20, 0x6B, -+0xAC, 0xEB, 0x4C, 0xEB, 0x02, 0x23, 0x80, 0x18, -+0x40, 0x08, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x69, 0x4E, 0xF2, 0x4C, 0x99, -+0x30, 0xF0, 0x20, 0x68, 0xCF, 0xF6, 0x1D, 0x48, -+0x90, 0x67, 0x00, 0x6D, 0x01, 0x6E, 0x40, 0xEA, -+0x4E, 0xF2, 0x4C, 0x99, 0x81, 0x40, 0x00, 0x6D, -+0x02, 0x6E, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0xA4, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0xCF, 0xF6, 0x1D, 0x4C, 0x01, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0xE0, 0xF1, 0x95, 0xA2, 0x01, 0x6B, -+0x8C, 0xEB, 0x39, 0x23, 0x30, 0xF0, 0x21, 0x6B, -+0x90, 0xF3, 0x7D, 0xA3, 0x0A, 0x2B, 0x10, 0xF0, -+0x24, 0x6B, 0xFB, 0xF7, 0x64, 0x9B, 0x80, 0xAB, -+0xE1, 0xF7, 0x1F, 0x6B, 0x8C, 0xEB, 0xE0, 0xF1, -+0x76, 0xCA, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x7D, 0xA2, 0x00, 0x6C, 0x01, 0x4B, 0x90, 0xF3, -+0x7D, 0xC2, 0x00, 0x18, 0x14, 0xEC, 0x10, 0x6C, -+0x00, 0x18, 0x14, 0xEC, 0x20, 0x6C, 0x00, 0x18, -+0x14, 0xEC, 0x30, 0x6C, 0x00, 0x18, 0x14, 0xEC, -+0x00, 0x6C, 0x00, 0x18, 0x1B, 0xEC, 0x10, 0x6C, -+0x00, 0x18, 0x1B, 0xEC, 0x20, 0x6C, 0x00, 0x18, -+0x1B, 0xEC, 0x30, 0x6C, 0x00, 0x18, 0x1B, 0xEC, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF0, 0x60, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x1C, 0xF0, 0x84, 0x9C, -+0x40, 0x9B, 0x8C, 0xEA, 0x42, 0x10, 0xE0, 0xF1, -+0x58, 0xA2, 0x0A, 0x2A, 0x10, 0x6C, 0x00, 0x18, -+0x3A, 0xEC, 0x20, 0x6C, 0x00, 0x18, 0x3A, 0xEC, -+0x30, 0x6C, 0x00, 0x18, 0x3A, 0xEC, 0x0F, 0x10, -+0x00, 0x6C, 0x00, 0x18, 0x3A, 0xEC, 0x10, 0x6C, -+0x00, 0x18, 0x3A, 0xEC, 0x20, 0x6C, 0x00, 0x18, -+0x3A, 0xEC, 0x30, 0x6C, 0x00, 0x18, 0x3A, 0xEC, -+0x00, 0x6C, 0x00, 0x18, 0x41, 0xEC, 0x10, 0x6C, -+0x00, 0x18, 0x41, 0xEC, 0x20, 0x6C, 0x00, 0x18, -+0x41, 0xEC, 0x30, 0x6C, 0x00, 0x18, 0x41, 0xEC, -+0x00, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x7D, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0xCF, 0xF6, 0x5E, 0xAA, 0xFB, 0xF7, -+0x64, 0x9B, 0x10, 0xF0, 0x24, 0x6C, 0x1C, 0xF0, -+0x88, 0x9C, 0x40, 0xCB, 0x10, 0xF0, 0x24, 0x6B, -+0xFB, 0xF7, 0x78, 0x9B, 0x40, 0xCB, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF0, 0x60, 0x9A, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x15, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0xF0, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, 0xFF, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x3F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x3F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0xFF, 0xFF, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, 0xFF, -+0xFF, 0x03, 0x00, 0x00, 0x15, 0xF0, 0xFF, 0xFF, -+0x0F, 0x00, 0x00, 0x00, 0xFA, 0x63, 0x0B, 0xD1, -+0x0A, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF7, -+0x44, 0x9A, 0xE1, 0xF7, 0x1F, 0x6B, 0x10, 0xF0, -+0x30, 0x6D, 0x40, 0xAA, 0x00, 0xF0, 0x00, 0x4D, -+0x0F, 0x68, 0x4C, 0xEB, 0x02, 0xD3, 0x60, 0xA4, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x7C, 0xCA, 0x61, 0xA4, 0x10, 0xF0, -+0x30, 0x6F, 0x42, 0xF0, 0x10, 0x4F, 0x28, 0xF3, -+0x7A, 0xCA, 0x62, 0xA4, 0x48, 0xF3, 0x78, 0xCA, -+0x63, 0xA4, 0xC1, 0xF7, 0xCE, 0xA5, 0x01, 0x6A, -+0x6C, 0xEA, 0x7F, 0x6B, 0x5C, 0x32, 0xCC, 0xEB, -+0x4D, 0xEB, 0xC1, 0xF7, 0x6E, 0xC5, 0xC3, 0xA4, -+0x10, 0x6A, 0x4B, 0xEA, 0xD2, 0x36, 0x6C, 0xEA, -+0xCD, 0xEA, 0x4C, 0xE8, 0xC1, 0xF7, 0x4E, 0xC5, -+0x00, 0x6E, 0x03, 0xD0, 0x6F, 0x10, 0xCD, 0xE4, -+0xA4, 0xA3, 0x02, 0x91, 0x10, 0xF0, 0x24, 0x6B, -+0xFB, 0xF7, 0x60, 0x9B, 0x35, 0xE5, 0xA0, 0xCB, -+0xBC, 0x35, 0x10, 0x2A, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF2, 0x7C, 0x9B, 0x6D, 0xE5, 0x60, 0xA3, -+0x01, 0x4D, 0x60, 0xC7, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF2, 0x7C, 0x9B, 0x08, 0xD2, 0x75, 0xE5, -+0x00, 0x6B, 0x46, 0x10, 0x01, 0x72, 0xF6, 0x61, -+0x40, 0x4D, 0xF4, 0x17, 0x40, 0xA5, 0x08, 0x91, -+0x10, 0xF0, 0x30, 0x68, 0x1A, 0x65, 0x0C, 0x6A, -+0x58, 0xE9, 0x7C, 0x6A, 0x00, 0xF0, 0x00, 0x48, -+0x12, 0xE9, 0x04, 0xD1, 0x58, 0xEE, 0x04, 0x92, -+0x12, 0xE9, 0x29, 0xE2, 0x05, 0xE2, 0x06, 0xD2, -+0x65, 0xE1, 0x58, 0x67, 0x22, 0xF0, 0x58, 0xC1, -+0x21, 0x45, 0x20, 0xA1, 0x5D, 0x67, 0x20, 0xC2, -+0x22, 0x45, 0x20, 0xA1, 0x21, 0xC2, 0x23, 0x45, -+0x20, 0xA1, 0x22, 0xC2, 0x24, 0xA5, 0x05, 0x4D, -+0x23, 0xC2, 0x1F, 0x69, 0x38, 0xEE, 0x04, 0x91, -+0x12, 0xEA, 0x29, 0xE2, 0x65, 0xE2, 0xE0, 0xF3, -+0x16, 0x49, 0x28, 0x31, 0x05, 0xE1, 0x5D, 0x67, -+0x19, 0x65, 0x22, 0xA2, 0x03, 0xA2, 0x40, 0xA2, -+0x20, 0x31, 0x20, 0x31, 0x00, 0xF6, 0x00, 0x30, -+0x2D, 0xE8, 0x3D, 0x67, 0x21, 0xA1, 0x4D, 0xE8, -+0x58, 0x67, 0x04, 0xD1, 0x20, 0x31, 0x2D, 0xE8, -+0x00, 0xDA, 0x01, 0x4B, 0xFF, 0x68, 0x0C, 0xEB, -+0x00, 0xA7, 0x03, 0xEB, 0xBB, 0x61, 0x08, 0x92, -+0xFF, 0x6B, 0x01, 0x4A, 0x6C, 0xEA, 0x03, 0x93, -+0x62, 0xEA, 0x95, 0x61, 0x01, 0x4E, 0x02, 0x76, -+0x7C, 0x4F, 0x02, 0x60, 0x00, 0x6A, 0xF7, 0x17, -+0x0B, 0x91, 0x0A, 0x90, 0x06, 0x63, 0x20, 0xE8, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x60, 0xA4, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x0F, 0x6A, 0x4C, 0xEB, 0x08, 0xF3, -+0x52, 0xA0, 0x24, 0x67, 0x0F, 0x6C, 0x70, 0x33, -+0x8C, 0xEA, 0x6D, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x08, 0xF3, 0x52, 0xC0, 0xEE, 0xF5, 0x50, 0x9B, -+0x09, 0x6C, 0x40, 0xEA, 0x60, 0xA1, 0x08, 0xF3, -+0x52, 0xA0, 0x0F, 0x6C, 0x72, 0x33, 0x70, 0x33, -+0x8C, 0xEA, 0x6D, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x08, 0xF3, 0x52, 0xC0, 0xEE, 0xF5, 0x50, 0x9B, -+0x09, 0x6C, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x60, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x08, 0xF3, 0x7A, 0xC2, 0x61, 0xA4, -+0x08, 0xF3, 0x7B, 0xC2, 0x62, 0xA4, 0x28, 0xF3, -+0x78, 0xC2, 0x63, 0xA4, 0x28, 0xF3, 0x79, 0xC2, -+0x64, 0xA4, 0x48, 0xF3, 0x76, 0xC2, 0x65, 0xA4, -+0x48, 0xF3, 0x77, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x45, 0xA4, 0x01, 0x69, 0x04, 0x67, 0x2C, 0xEA, -+0x3A, 0x22, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x69, 0xA2, 0x2D, 0xEB, -+0xC1, 0xF7, 0x69, 0xC2, 0x81, 0xA4, 0xE0, 0xF3, -+0x08, 0x6B, 0x80, 0x34, 0x88, 0x34, 0x7A, 0xEC, -+0x01, 0x2B, 0xE5, 0xE8, 0x12, 0xEB, 0xC1, 0xF7, -+0x6A, 0xC2, 0x65, 0xA0, 0x66, 0x33, 0xC1, 0xF7, -+0x6B, 0xC2, 0x82, 0xA0, 0x6F, 0xE4, 0xC1, 0xF7, -+0x6C, 0xC2, 0x62, 0xA0, 0xC1, 0xF7, 0x6D, 0xC2, -+0xC1, 0xF7, 0x6D, 0xA2, 0x64, 0x73, 0x06, 0x60, -+0x96, 0x73, 0x04, 0x61, 0x03, 0x6B, 0xC1, 0xF7, -+0x6D, 0xC2, 0x02, 0x10, 0xC1, 0xF7, 0x2D, 0xC2, -+0x30, 0xF0, 0x20, 0x6B, 0x80, 0xA0, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0xB0, 0xA3, 0x86, 0x34, -+0x01, 0x6A, 0x84, 0x34, 0xAC, 0xEA, 0x8D, 0xEA, -+0x68, 0xF3, 0x50, 0xC3, 0x3A, 0x10, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, -+0x89, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0xC1, 0xF7, 0x69, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0x28, 0xF5, 0x18, 0x4C, 0xB0, 0x67, 0x04, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0x91, 0xA2, 0xE0, 0xF3, -+0x08, 0x6B, 0x80, 0x34, 0x88, 0x34, 0x7A, 0xEC, -+0x01, 0x2B, 0xE5, 0xE8, 0x12, 0xEB, 0x68, 0xF3, -+0x71, 0xC2, 0x68, 0xF3, 0x72, 0xA2, 0x64, 0x73, -+0x06, 0x60, 0x96, 0x73, 0x04, 0x61, 0x03, 0x6B, -+0x68, 0xF3, 0x72, 0xC2, 0x02, 0x10, 0x68, 0xF3, -+0x32, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0x72, 0xA2, 0x08, 0xF3, -+0x73, 0xC2, 0x10, 0xF0, 0x30, 0x6B, 0x00, 0xF0, -+0x00, 0x4B, 0xA4, 0xA0, 0xC1, 0xF7, 0xC8, 0xA3, -+0x10, 0x6A, 0x0F, 0x6C, 0x4B, 0xEA, 0x8C, 0xED, -+0xCC, 0xEA, 0xAD, 0xEA, 0xC1, 0xF7, 0x48, 0xC3, -+0xA4, 0xA0, 0x8C, 0xEA, 0xB2, 0x35, 0xB0, 0x35, -+0xAD, 0xEA, 0xC1, 0xF7, 0x48, 0xC3, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x40, 0xA4, 0x10, 0x69, 0x04, 0x67, 0x2B, 0xE9, -+0x0F, 0x6C, 0x4C, 0xEC, 0xFF, 0x6D, 0x2C, 0xEA, -+0xFF, 0x6B, 0xAC, 0xEA, 0x8C, 0xEB, 0xF0, 0x72, -+0x04, 0xD3, 0x2C, 0x61, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x08, 0xF3, 0xB0, 0xA3, -+0x02, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0x1F, 0x6D, -+0xAB, 0xED, 0x84, 0x34, 0xAC, 0xEA, 0x8D, 0xEA, -+0x08, 0xF3, 0x50, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF5, 0x4C, 0x9A, 0x04, 0x94, 0x40, 0xEA, -+0x01, 0x72, 0x0D, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF5, 0x48, 0x9A, 0x00, 0x6C, 0xA4, 0x67, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, -+0x50, 0x9A, 0x02, 0x6C, 0x05, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x50, 0x9A, 0x04, 0x6C, -+0x40, 0xEA, 0xC9, 0x10, 0x04, 0x92, 0x1E, 0x6C, -+0x30, 0xF0, 0x20, 0x6B, 0x98, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, 0xC8, 0xF4, -+0x1E, 0x4B, 0xA1, 0x40, 0x04, 0x6E, 0x12, 0xEC, -+0x91, 0xE3, 0x40, 0xEA, 0x04, 0x92, 0x85, 0xA0, -+0x10, 0xF0, 0x30, 0x6B, 0xE0, 0xF7, 0x08, 0x4A, -+0x00, 0xF0, 0x00, 0x4B, 0x44, 0x32, 0x69, 0xE2, -+0x0F, 0x6B, 0x6C, 0xEC, 0x62, 0xA2, 0xFF, 0x6D, -+0x2C, 0xEB, 0x8D, 0xEB, 0x62, 0xC2, 0x85, 0xA0, -+0x63, 0xA2, 0x92, 0x34, 0x2C, 0xEB, 0x8D, 0xEB, -+0x0F, 0x6C, 0x6C, 0xEC, 0xAC, 0xEC, 0x63, 0xC2, -+0x04, 0x2C, 0x6C, 0xE9, 0x02, 0x6B, 0x6D, 0xE9, -+0x23, 0xC2, 0x04, 0x94, 0x1E, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0x78, 0xEC, 0xC0, 0xF1, 0x08, 0x4A, -+0xE0, 0xF3, 0x08, 0x6C, 0xFF, 0x6E, 0x12, 0xEB, -+0x4D, 0xE3, 0x08, 0xF3, 0xB8, 0xA3, 0xA0, 0x35, -+0xA8, 0x35, 0x9A, 0xED, 0x01, 0x2C, 0xE5, 0xE8, -+0x12, 0xEC, 0x08, 0xF3, 0x98, 0xC3, 0x60, 0xA0, -+0x04, 0x94, 0x72, 0x33, 0xFF, 0x4B, 0x8E, 0xEB, -+0x7E, 0x2B, 0x68, 0xF3, 0x74, 0xA2, 0x7F, 0x6F, -+0xEC, 0xEB, 0xCC, 0xEB, 0x06, 0x2B, 0x08, 0xF3, -+0x6A, 0xA2, 0x01, 0x6D, 0xAC, 0xEB, 0xCC, 0xEB, -+0x07, 0x23, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, -+0x50, 0x9A, 0x05, 0x6C, 0x40, 0xEA, 0x83, 0x10, -+0x08, 0xF3, 0x70, 0xA2, 0x1F, 0x6C, 0x8B, 0xEC, -+0x6C, 0xEC, 0x08, 0xF3, 0x90, 0xC2, 0x20, 0xA0, -+0x10, 0x6B, 0x6B, 0xEB, 0x32, 0x31, 0xF9, 0x65, -+0x08, 0xF3, 0x32, 0xA2, 0x19, 0x65, 0x38, 0x67, -+0x2C, 0xEB, 0x3F, 0x67, 0x2D, 0xEB, 0x08, 0xF3, -+0x72, 0xC2, 0x04, 0xA0, 0x61, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x10, 0xF0, 0x24, 0x6C, 0x1B, 0xF7, -+0x94, 0x9C, 0x1A, 0x30, 0x14, 0x30, 0x0D, 0xEB, -+0x02, 0x68, 0x00, 0xC4, 0x68, 0xF3, 0x90, 0xA2, -+0xAC, 0xEC, 0xCC, 0xEC, 0x0A, 0x24, 0xEC, 0xEB, -+0x08, 0xF3, 0x91, 0xA2, 0x08, 0xF3, 0x70, 0xC2, -+0x20, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xAD, 0xEB, -+0x0A, 0x10, 0x80, 0x6C, 0x8B, 0xEC, 0x6D, 0xEC, -+0x08, 0xF3, 0x90, 0xC2, 0x08, 0xF3, 0x91, 0xA2, -+0x20, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x08, 0xF3, -+0x71, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x08, 0xF3, 0x90, 0xA2, 0x01, 0x6B, -+0x10, 0xF0, 0x30, 0x68, 0x8D, 0xEB, 0x08, 0xF3, -+0x70, 0xC2, 0x00, 0x6B, 0x00, 0xF0, 0x00, 0x48, -+0x08, 0xF3, 0x74, 0xC2, 0xC1, 0xF7, 0x6F, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xC1, 0xF7, -+0x4F, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, -+0x50, 0x9A, 0x03, 0x6C, 0x0F, 0x69, 0x40, 0xEA, -+0xC1, 0xF7, 0x92, 0xA0, 0x2C, 0xEC, 0x00, 0x18, -+0x14, 0xEC, 0xC1, 0xF7, 0x92, 0xA0, 0x2C, 0xEC, -+0x00, 0x18, 0xE2, 0xEB, 0xC1, 0xF7, 0x94, 0xA0, -+0x2C, 0xEC, 0x00, 0x18, 0xE2, 0xEB, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF6, 0x80, 0x9A, 0x00, 0x18, -+0x8B, 0xE9, 0x30, 0xF0, 0x20, 0x6A, 0x0E, 0xF6, -+0x9C, 0x9A, 0x00, 0x18, 0x8B, 0xE9, 0x30, 0xF0, -+0x20, 0x6A, 0x0E, 0xF6, 0x98, 0x9A, 0x00, 0x18, -+0x8B, 0xE9, 0x10, 0xF0, 0x30, 0x6C, 0xE6, 0xF1, -+0x11, 0x4C, 0x00, 0x18, 0x8B, 0xE9, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0xFF, 0x68, 0x3B, 0xF7, -+0x5C, 0x9A, 0x0C, 0xEC, 0x04, 0xD4, 0x40, 0xA2, -+0x30, 0xF0, 0x20, 0x69, 0x90, 0x67, 0x62, 0x67, -+0x6E, 0xF2, 0x58, 0x99, 0x0C, 0xEB, 0x05, 0xD3, -+0xB0, 0x67, 0x17, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF2, 0x40, 0x9A, 0x40, 0xEA, -+0x01, 0x72, 0x4A, 0x61, 0x04, 0x93, 0x1E, 0x69, -+0x30, 0xF0, 0x20, 0x6A, 0x38, 0xEB, 0xC0, 0xF1, -+0x08, 0x4A, 0x0F, 0x6D, 0x12, 0xE9, 0x45, 0xE1, -+0x08, 0xF3, 0x57, 0xA1, 0x08, 0xF3, 0x96, 0xA1, -+0x4C, 0xED, 0x52, 0x36, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x54, 0x9A, 0x0C, 0xED, 0x0C, 0xEE, -+0x40, 0xEA, 0x08, 0xF3, 0x79, 0xA1, 0x01, 0x6C, -+0x76, 0x32, 0x8C, 0xEA, 0x0C, 0xEA, 0x23, 0x2A, -+0x07, 0x6A, 0x6C, 0xEA, 0x0C, 0xEA, 0x02, 0x22, -+0x02, 0x72, 0x1D, 0x61, 0x04, 0x93, 0x1E, 0x6C, -+0x30, 0xF0, 0x20, 0x6A, 0x98, 0xEB, 0xC0, 0xF1, -+0x08, 0x4A, 0xE0, 0xF7, 0x08, 0x4B, 0x64, 0x33, -+0x0F, 0x6F, 0x00, 0x6D, 0xFF, 0x6E, 0x12, 0xEC, -+0x51, 0xE4, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0x49, 0xE3, 0x62, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x50, 0x9A, 0x08, 0xF3, -+0x9C, 0xAC, 0x6C, 0xEF, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x48, 0x9A, 0x04, 0x95, -+0x01, 0x6C, 0x40, 0xEA, 0x01, 0x6A, 0x07, 0x10, -+0x6E, 0xF2, 0x58, 0x99, 0x05, 0x95, 0x00, 0x6C, -+0x4B, 0x6E, 0x40, 0xEA, 0x00, 0x6A, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6C, -+0xC0, 0xF1, 0x08, 0x4C, 0x08, 0xF3, 0x50, 0xA4, -+0x0F, 0x6B, 0x1E, 0x6D, 0x46, 0x32, 0x6C, 0xEA, -+0xB8, 0xEA, 0xE0, 0xF7, 0x08, 0x4A, 0x44, 0x32, -+0xFF, 0x6E, 0x12, 0xED, 0x91, 0xE5, 0x10, 0xF0, -+0x30, 0x6D, 0x00, 0xF0, 0x00, 0x4D, 0xB5, 0xE2, -+0xE2, 0xA5, 0x30, 0xF0, 0x20, 0x6A, 0x08, 0xF3, -+0x9C, 0xAC, 0x2E, 0xF4, 0x50, 0x9A, 0x6C, 0xEF, -+0x00, 0x6D, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6C, -+0xC0, 0xF1, 0x08, 0x4C, 0x08, 0xF3, 0xB0, 0xA4, -+0x01, 0x6B, 0x0F, 0x6F, 0xA6, 0x30, 0xAC, 0xEB, -+0xEC, 0xE8, 0xFF, 0x6A, 0x60, 0x23, 0x1E, 0x69, -+0x38, 0xE8, 0x07, 0x6D, 0x12, 0xEB, 0x8D, 0xE3, -+0x08, 0xF3, 0xD9, 0xA3, 0xCC, 0xED, 0x08, 0xF3, -+0xD4, 0xA4, 0x4C, 0xED, 0x02, 0x76, 0x06, 0x60, -+0x03, 0x6A, 0xCE, 0xEA, 0x4E, 0x22, 0x01, 0x76, -+0x46, 0x60, 0x4D, 0x10, 0x01, 0x75, 0x04, 0x60, -+0x2E, 0x25, 0x04, 0x5D, 0x48, 0x60, 0x2B, 0x10, -+0x08, 0xF3, 0xD2, 0xA4, 0xA1, 0x40, 0x4C, 0xED, -+0xCC, 0xEF, 0xAE, 0xEF, 0xEB, 0xEE, 0xED, 0xEE, -+0xC0, 0xF7, 0xC3, 0x36, 0xCC, 0xED, 0x38, 0xED, -+0x12, 0xE9, 0x85, 0xE1, 0x08, 0xF3, 0x98, 0xA1, -+0x20, 0x5C, 0x0A, 0x61, 0x08, 0xF3, 0x9C, 0xAB, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x78, 0x9B, -+0x4C, 0xEC, 0x0F, 0xF4, 0x00, 0x6D, 0x0E, 0x10, -+0x08, 0xF3, 0xB8, 0xA1, 0x08, 0xF3, 0x9C, 0xAB, -+0x30, 0xF0, 0x20, 0x6B, 0xA0, 0x35, 0x2E, 0xF4, -+0x78, 0x9B, 0xA8, 0x35, 0x4C, 0xEC, 0xFF, 0xF7, -+0x1F, 0x6A, 0x4C, 0xED, 0x40, 0xEB, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x48, 0x9A, 0x02, 0x6C, -+0xB0, 0x67, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x0E, 0xF6, 0x48, 0x9A, 0x40, 0xEA, 0x0F, 0x2A, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, 0x50, 0x9A, -+0x06, 0x6C, 0x40, 0xEA, 0x08, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x0E, 0xF6, 0x50, 0x9A, 0x40, 0xEA, -+0x02, 0x10, 0x08, 0xF3, 0x54, 0xC4, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x08, 0xF3, 0x70, 0xA0, 0x01, 0x6A, 0x6C, 0xEA, -+0x39, 0x22, 0x10, 0xF0, 0x30, 0x69, 0x00, 0xF0, -+0x00, 0x49, 0xC1, 0xF7, 0x6E, 0xA1, 0x07, 0x6C, -+0x72, 0x32, 0x8C, 0xEA, 0x01, 0x4A, 0x8C, 0xEA, -+0x50, 0x34, 0x71, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x8D, 0xEA, 0xC1, 0xF7, 0x4E, 0xC1, 0x30, 0xF0, -+0x20, 0x6A, 0x0E, 0xF6, 0x54, 0x9A, 0x40, 0xEA, -+0x08, 0xF3, 0x50, 0xA0, 0x0F, 0x6B, 0xFF, 0x6C, -+0x46, 0x32, 0x6C, 0xEA, 0x8C, 0xEA, 0xC1, 0xF7, -+0x8E, 0xA1, 0x07, 0x6D, 0x92, 0x34, 0xAC, 0xEC, -+0x68, 0xF3, 0xB2, 0xA0, 0x82, 0xED, 0x12, 0x61, -+0x1E, 0x6C, 0x98, 0xEA, 0xE0, 0xF7, 0x08, 0x4A, -+0x44, 0x32, 0x25, 0xE2, 0x43, 0xA1, 0x4C, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, 0x54, 0x9A, -+0x12, 0xEC, 0x01, 0xE4, 0x08, 0xF3, 0x98, 0xA0, -+0x73, 0xE4, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x90, 0xA2, 0x0F, 0x6D, 0x86, 0x33, -+0x9E, 0x34, 0xAC, 0xEB, 0x80, 0xF0, 0x1D, 0x24, -+0x08, 0xF3, 0x93, 0xA2, 0x01, 0x4C, 0x08, 0xF3, -+0x93, 0xC2, 0x08, 0xF3, 0xB3, 0xA2, 0x68, 0xF3, -+0x92, 0xA2, 0x83, 0xED, 0x80, 0xF0, 0x11, 0x61, -+0x1E, 0x6C, 0x98, 0xEB, 0x01, 0x6C, 0x12, 0xEB, -+0x4D, 0xE3, 0x08, 0xF3, 0x79, 0xA3, 0x6E, 0x33, -+0x8C, 0xEB, 0x07, 0x23, 0x08, 0xF3, 0x74, 0xA2, -+0x03, 0x6C, 0x8E, 0xEB, 0x02, 0x2B, 0x08, 0xF3, -+0x74, 0xC2, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x89, 0xA2, 0x01, 0x6B, -+0x8C, 0xEB, 0x19, 0x23, 0x02, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xC1, 0xF7, 0x8A, 0xA2, 0xC1, 0xF7, -+0x69, 0xC2, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0x91, 0xC3, 0xC1, 0xF7, -+0x8D, 0xA2, 0x68, 0xF3, 0x92, 0xC3, 0xC1, 0xF7, -+0x8B, 0xA2, 0x08, 0xF3, 0x98, 0xC3, 0xC1, 0xF7, -+0x4C, 0xA2, 0x28, 0xF3, 0x56, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, -+0xB0, 0xA2, 0x1E, 0x6B, 0xAC, 0xEB, 0x30, 0x23, -+0x08, 0xF3, 0x72, 0xA2, 0x0F, 0x6C, 0x8C, 0xEB, -+0xFF, 0x4B, 0x8C, 0xEB, 0x64, 0x36, 0x1F, 0x6B, -+0x6B, 0xEB, 0xAC, 0xEB, 0xCD, 0xEB, 0x08, 0xF3, -+0x70, 0xC2, 0x08, 0xF3, 0xB0, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x48, 0x9A, 0xA6, 0x35, -+0x8C, 0xED, 0xFF, 0x6B, 0x02, 0x6C, 0x6C, 0xED, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x0E, 0xF6, -+0x48, 0x9A, 0x40, 0xEA, 0x06, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x50, 0x9A, 0x06, 0x6C, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x08, 0xF3, 0x90, 0xA2, 0x1F, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0x08, 0xF3, 0x70, 0xC2, -+0x30, 0xF0, 0x20, 0x69, 0xC0, 0xF1, 0x08, 0x49, -+0x08, 0xF3, 0x50, 0xA1, 0x0F, 0x6B, 0x10, 0xF0, -+0x30, 0x68, 0x46, 0x32, 0x6C, 0xEA, 0xE0, 0xF7, -+0x08, 0x4A, 0x00, 0xF0, 0x00, 0x48, 0x44, 0x32, -+0x09, 0xE2, 0x43, 0xA2, 0x68, 0xF3, 0x91, 0xA1, -+0x4C, 0xEB, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, -+0x54, 0x9A, 0x73, 0xE4, 0x40, 0xEA, 0x00, 0x6A, -+0x08, 0xF3, 0x53, 0xC1, 0xC1, 0xF7, 0x6E, 0xA0, -+0x71, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xC1, 0xF7, -+0x4E, 0xC0, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0x20, 0xE8, 0x00, 0x65, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x61, 0xA4, 0x04, 0x67, -+0xAE, 0xF2, 0x54, 0x9A, 0x80, 0xA4, 0x0F, 0x6D, -+0x6C, 0xED, 0x72, 0x36, 0x40, 0xEA, 0x10, 0xF0, -+0x30, 0x6A, 0xC1, 0xF7, 0x6E, 0xA2, 0x80, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x00, 0x6B, 0x08, 0xD3, 0x28, 0x2A, 0x32, 0x10, -+0x08, 0x94, 0x0C, 0x6A, 0x08, 0x96, 0x58, 0xEC, -+0x30, 0xF0, 0x20, 0x6C, 0x25, 0xF6, 0x08, 0x4C, -+0x12, 0xEA, 0x35, 0xE2, 0xE0, 0xF3, 0x16, 0x4D, -+0x69, 0xE2, 0xA8, 0x35, 0x29, 0xE2, 0x75, 0xE5, -+0xA0, 0x9D, 0x22, 0xF0, 0xF8, 0xA2, 0x01, 0x49, -+0x80, 0x18, 0xCF, 0x26, 0xFF, 0x6A, 0x4C, 0xE9, -+0x10, 0xF0, 0x30, 0x6B, 0x00, 0xF0, 0x00, 0x4B, -+0x42, 0xF0, 0x50, 0xA3, 0x43, 0xE9, 0xE0, 0x61, -+0x08, 0x92, 0x01, 0x4A, 0x08, 0xD2, 0x08, 0x93, -+0xFF, 0x6A, 0x4C, 0xEB, 0x08, 0xD3, 0x10, 0xF0, -+0x30, 0x6A, 0xC1, 0xF7, 0x6E, 0xA2, 0x08, 0x94, -+0x0F, 0x6A, 0x6C, 0xEA, 0x42, 0xEC, 0x02, 0x60, -+0x00, 0x69, 0xE6, 0x17, 0x62, 0xA0, 0x02, 0x6A, -+0x6C, 0xEA, 0x06, 0x22, 0x80, 0x18, 0x1A, 0x13, -+0x00, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0xAE, 0xD5, -+0x7D, 0x67, 0x10, 0x6A, 0x50, 0xC3, 0x07, 0x6A, -+0x4F, 0xCB, 0x40, 0xA0, 0x9D, 0x67, 0x52, 0xC3, -+0x42, 0xA0, 0x01, 0x6B, 0x46, 0x32, 0x6C, 0xEA, -+0x73, 0xA4, 0x6D, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xE8, 0xF2, 0x75, 0xA3, 0x64, 0x33, 0x4D, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, -+0x73, 0xC4, 0x04, 0x04, 0x40, 0xEA, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0x1A, 0x13, -+0x00, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0xAE, 0xD5, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, 0x90, 0xA3, -+0x01, 0x6A, 0xFF, 0x6E, 0x8C, 0xEA, 0x1D, 0x22, -+0x08, 0xF3, 0xF1, 0xA3, 0x1F, 0x6C, 0xA7, 0x67, -+0x8C, 0xED, 0x45, 0x67, 0xCC, 0xEA, 0x15, 0x22, -+0x20, 0x6A, 0x1F, 0x4D, 0x4B, 0xEA, 0x8C, 0xED, -+0xEC, 0xEA, 0xAD, 0xEA, 0x08, 0xF3, 0x51, 0xC3, -+0x8C, 0xEA, 0xCC, 0xEA, 0x0A, 0x2A, 0x30, 0xF0, -+0x20, 0x6B, 0x2E, 0xF6, 0x80, 0x9B, 0x00, 0x6D, -+0x14, 0x6E, 0x01, 0x6F, 0x04, 0xD2, 0x00, 0x18, -+0x9E, 0xE9, 0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x30, 0x6B, -+0x00, 0xF0, 0x00, 0x4B, 0xC1, 0xF7, 0xCF, 0xA3, -+0x01, 0x6F, 0xFF, 0x6A, 0xEC, 0xEE, 0x4C, 0xEE, -+0x4C, 0xEC, 0x14, 0x2E, 0xC1, 0xF7, 0x72, 0xA3, -+0x0F, 0x6D, 0x6C, 0xED, 0x8E, 0xED, 0x0E, 0x2D, -+0x30, 0xF0, 0x20, 0x6B, 0xC8, 0xF4, 0x78, 0xA3, -+0xEC, 0xEB, 0x4C, 0xEB, 0x07, 0x23, 0x30, 0xF0, -+0x20, 0x6A, 0x0E, 0xF6, 0x5C, 0x9A, 0x40, 0xEA, -+0x80, 0x18, 0x8C, 0x0B, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF2, 0x40, 0x9A, 0x40, 0xEA, 0x00, 0x6B, -+0x40, 0xF1, 0x14, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF3, 0xB0, 0xA2, -+0x0F, 0x6C, 0xFF, 0x6F, 0xA6, 0x33, 0x8C, 0xEB, -+0xC3, 0x67, 0xEC, 0xEE, 0x07, 0xD6, 0x01, 0x4B, -+0x1F, 0x6E, 0x8C, 0xEB, 0xCB, 0xEE, 0x64, 0x33, -+0xCC, 0xED, 0x6D, 0xED, 0x08, 0xF3, 0xB0, 0xC2, -+0x08, 0xF3, 0xB0, 0xA2, 0x08, 0xF3, 0x72, 0xA2, -+0xA6, 0x30, 0x0E, 0xEB, 0x8C, 0xEB, 0xEC, 0xEB, -+0x04, 0x2B, 0x66, 0x67, 0xAC, 0xEB, 0x08, 0xF3, -+0x70, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x08, 0xF3, 0x10, 0xA2, 0x0F, 0x6B, -+0x06, 0x30, 0x6C, 0xE8, 0x1E, 0x6B, 0x78, 0xE8, -+0x12, 0xEC, 0x51, 0xE4, 0x08, 0xF3, 0x96, 0xA4, -+0x0F, 0x5C, 0x08, 0x60, 0x07, 0x94, 0x78, 0xEC, -+0x12, 0xEB, 0x49, 0xE3, 0x08, 0xF3, 0x56, 0xA2, -+0x0F, 0x5A, 0x14, 0x61, 0x1E, 0x6B, 0x78, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x12, 0xEC, 0x51, 0xE4, 0x08, 0xF3, 0x96, 0xA4, -+0x24, 0x5C, 0x12, 0x61, 0x07, 0x94, 0x78, 0xEC, -+0x12, 0xEB, 0x49, 0xE3, 0x08, 0xF3, 0x56, 0xA2, -+0x24, 0x5A, 0x0A, 0x61, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x91, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x08, 0x10, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0x91, 0xA2, 0x01, 0x6B, 0x8D, 0xEB, -+0x1E, 0x6C, 0x98, 0xE8, 0xC1, 0xF7, 0x71, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x0F, 0x6D, 0x12, 0xEC, 0x51, 0xE4, 0x08, 0xF3, -+0x77, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0x08, 0xF3, -+0x96, 0xA4, 0xAE, 0xF2, 0x54, 0x9A, 0x6C, 0xED, -+0x72, 0x36, 0x40, 0xEA, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x91, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xC1, 0xF7, -+0x71, 0xC2, 0xC1, 0xF7, 0x6E, 0xA2, 0x80, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x00, 0x6B, 0x06, 0xD3, 0x30, 0x2A, 0x3A, 0x10, -+0x1F, 0x6D, 0xB8, 0xE8, 0x06, 0x96, 0x0C, 0x6A, -+0x12, 0xED, 0x58, 0xEE, 0x12, 0xEA, 0x55, 0xE5, -+0x35, 0xE5, 0x89, 0xE2, 0xE0, 0xF3, 0x16, 0x4D, -+0x69, 0xE2, 0xA8, 0x35, 0x29, 0xE2, 0x75, 0xE5, -+0xA0, 0x9D, 0x22, 0xF0, 0xF8, 0xA2, 0x30, 0xF0, -+0x20, 0x6C, 0x25, 0xF6, 0x08, 0x4C, 0x80, 0x18, -+0xCF, 0x26, 0x01, 0x49, 0xFF, 0x6A, 0x4C, 0xE9, -+0x7C, 0x6C, 0x98, 0xE8, 0x10, 0xF0, 0x30, 0x6B, -+0x00, 0xF0, 0x00, 0x4B, 0x12, 0xEC, 0x69, 0xE4, -+0x42, 0xF0, 0x50, 0xA2, 0x43, 0xE9, 0xD8, 0x61, -+0x06, 0x92, 0x01, 0x4A, 0x06, 0xD2, 0x06, 0x93, -+0xFF, 0x6A, 0x4C, 0xEB, 0x06, 0xD3, 0x10, 0xF0, -+0x30, 0x6A, 0xC1, 0xF7, 0x6E, 0xA2, 0x06, 0x94, -+0x0F, 0x6A, 0x6C, 0xEA, 0x42, 0xEC, 0x02, 0x60, -+0x00, 0x69, 0xE2, 0x17, 0x30, 0xF0, 0x20, 0x6A, -+0x0E, 0xF6, 0x44, 0x9A, 0x90, 0x67, 0x1E, 0x69, -+0x40, 0xEA, 0x07, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x38, 0xEB, 0x02, 0x6B, -+0x6B, 0xEB, 0x12, 0xEC, 0x51, 0xE4, 0x08, 0xF3, -+0xBE, 0xA4, 0x38, 0xE8, 0xAC, 0xEB, 0x08, 0xF3, -+0x7E, 0xC4, 0xFF, 0x6B, 0x12, 0xE9, 0x45, 0xE1, -+0x08, 0xF3, 0xB9, 0xA1, 0x01, 0x6A, 0xB6, 0x34, -+0x4C, 0xEC, 0x57, 0x2C, 0x10, 0xF0, 0x30, 0x6C, -+0x00, 0xF0, 0x00, 0x4C, 0xC1, 0xF7, 0xCF, 0xA4, -+0x4C, 0xEE, 0x6C, 0xEE, 0x2C, 0x26, 0x07, 0x6A, -+0xAC, 0xEA, 0x6C, 0xEA, 0x10, 0x2A, 0xE0, 0xF7, -+0x48, 0x40, 0x44, 0x32, 0x91, 0xE2, 0x42, 0xA4, -+0x0F, 0x6F, 0x08, 0xF3, 0x9C, 0xA9, 0x4C, 0xEF, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x50, 0x9A, -+0x00, 0x6D, 0xC3, 0x67, 0x38, 0x10, 0x02, 0x6B, -+0x6E, 0xEA, 0x37, 0x2A, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0x08, 0x4B, 0x80, 0xF6, 0xDC, 0x9B, -+0x80, 0xF6, 0x78, 0x9B, 0x10, 0xF0, 0x30, 0x6C, -+0xE5, 0xF1, 0x11, 0x4C, 0x7B, 0xE6, 0xC2, 0x36, -+0x00, 0x6D, 0xCE, 0x36, 0x01, 0x6F, 0x04, 0xD2, -+0x00, 0x18, 0x9E, 0xE9, 0x22, 0x10, 0x07, 0x6A, -+0xAC, 0xEA, 0x6C, 0xEA, 0x02, 0x22, 0x02, 0x72, -+0x1C, 0x61, 0x1E, 0x6C, 0x98, 0xE8, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xE0, 0xF7, -+0x68, 0x40, 0x64, 0x33, 0x00, 0x6D, 0xFF, 0x6E, -+0x0F, 0x6F, 0x12, 0xEC, 0x51, 0xE4, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0x49, 0xE3, -+0x62, 0xA2, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x50, 0x9A, 0x08, 0xF3, 0x9C, 0xAC, 0x6C, 0xEF, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, -+0x48, 0x9A, 0x01, 0x6C, 0xB0, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0x6B, 0xC0, 0xF1, -+0x08, 0x4A, 0x08, 0xF3, 0x74, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x50, 0x9A, 0x00, 0x6C, -+0x40, 0xEA, 0x01, 0x6B, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x43, 0x67, 0x06, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x07, 0x6A, 0x7D, 0x67, -+0x58, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, -+0x50, 0x9A, 0xFF, 0xF7, 0x1F, 0x6E, 0x8C, 0xEE, -+0x00, 0x6B, 0x82, 0x67, 0x06, 0x05, 0x01, 0x6F, -+0x04, 0xD3, 0x00, 0x18, 0x9E, 0xE9, 0x09, 0x97, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xFF, 0x6E, 0x8C, 0xEE, -+0x0E, 0xF6, 0x98, 0x9A, 0x00, 0x6A, 0xA2, 0x67, -+0x01, 0x6F, 0x04, 0xD2, 0x00, 0x18, 0x9E, 0xE9, -+0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0x30, 0xA2, 0x08, 0xF3, 0x94, 0xA2, -+0x0F, 0x6B, 0x26, 0x31, 0x03, 0x74, 0x6C, 0xE9, -+0x4A, 0x60, 0x1E, 0x68, 0x18, 0xE9, 0xE0, 0xF7, -+0x88, 0x41, 0x84, 0x34, 0xFF, 0x6E, 0x01, 0x6D, -+0x12, 0xE8, 0x41, 0xE0, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0x49, 0xE4, 0xE2, 0xA2, -+0x30, 0xF0, 0x20, 0x6A, 0x08, 0xF3, 0x9C, 0xA8, -+0x6C, 0xEF, 0x2E, 0xF4, 0x70, 0x9A, 0xCC, 0xEF, -+0x40, 0xEB, 0x01, 0x72, 0x06, 0x61, 0x08, 0xF3, -+0x7E, 0xA0, 0x01, 0x6A, 0x6D, 0xEA, 0x08, 0xF3, -+0x5E, 0xC0, 0x10, 0xF0, 0x30, 0x6B, 0xE0, 0xF7, -+0x08, 0x49, 0x00, 0xF0, 0x00, 0x4B, 0x24, 0x31, -+0x65, 0xE1, 0x82, 0xA1, 0x07, 0x6D, 0x92, 0x32, -+0xAC, 0xEA, 0x01, 0x4A, 0xAC, 0xEA, 0x50, 0x35, -+0x71, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, 0xAD, 0xEA, -+0x42, 0xC1, 0xC1, 0xF7, 0x6F, 0xA3, 0x01, 0x6A, -+0x6C, 0xEA, 0x0C, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0xC8, 0xF4, 0x5C, 0xA2, 0x07, 0x2A, 0x63, 0xA1, -+0x0F, 0x6A, 0xFF, 0x6C, 0x6C, 0xEA, 0x4C, 0xEC, -+0x80, 0x18, 0x73, 0x0C, 0x01, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xC8, 0xF4, 0x7C, 0xC2, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF3, 0xB0, 0xA2, 0x0F, 0x6B, 0xA6, 0x35, -+0x6C, 0xED, 0x1E, 0x6B, 0x78, 0xED, 0x12, 0xEB, -+0x49, 0xE3, 0x08, 0xF3, 0x19, 0xA2, 0x01, 0x6A, -+0x12, 0x30, 0x4C, 0xE8, 0x1F, 0x28, 0x10, 0xF0, -+0x30, 0x6A, 0xE0, 0xF7, 0x28, 0x45, 0x00, 0xF0, -+0x00, 0x4A, 0x24, 0x31, 0x45, 0xE1, 0x42, 0xA1, -+0x07, 0x6B, 0x52, 0x32, 0x6C, 0xEA, 0x02, 0x52, -+0x11, 0x60, 0x80, 0x18, 0x7C, 0x0C, 0xC3, 0xA1, -+0x30, 0xF0, 0x20, 0x6A, 0x0E, 0xF6, 0x94, 0x9A, -+0x0F, 0x6A, 0x4C, 0xEE, 0xFF, 0x6A, 0x00, 0x6D, -+0x4C, 0xEE, 0x01, 0x6F, 0x04, 0xD0, 0x00, 0x18, -+0x9E, 0xE9, 0x24, 0x10, 0x1E, 0x6B, 0x78, 0xED, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x01, 0x6C, 0x12, 0xEB, 0x4D, 0xE3, 0x08, 0xF3, -+0x79, 0xA3, 0x6E, 0x33, 0x8C, 0xEB, 0x13, 0x2B, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, 0x48, 0x9A, -+0x02, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x0E, 0xF6, 0x48, 0x9A, 0x40, 0xEA, 0x0A, 0x2A, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, 0x50, 0x9A, -+0x06, 0x6C, 0x40, 0xEA, 0x03, 0x10, 0x03, 0x6B, -+0x08, 0xF3, 0x74, 0xC2, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x44, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, 0x08, 0xF3, -+0x70, 0xA4, 0x0F, 0x6D, 0x66, 0x33, 0xAC, 0xEB, -+0x1E, 0x6D, 0xB8, 0xEB, 0x12, 0xED, 0x91, 0xE5, -+0x08, 0xF3, 0xB9, 0xA4, 0x07, 0x6C, 0xAC, 0xEC, -+0x01, 0x74, 0x31, 0x60, 0x05, 0x24, 0x02, 0x74, -+0x03, 0x60, 0x03, 0x74, 0x2C, 0x60, 0x40, 0x10, -+0x1E, 0x6D, 0xB8, 0xEB, 0x30, 0xF0, 0x20, 0x6C, -+0xC0, 0xF1, 0x08, 0x4C, 0x01, 0x6E, 0x12, 0xED, -+0x95, 0xE5, 0x08, 0xF3, 0xB9, 0xA5, 0xB6, 0x35, -+0xCC, 0xED, 0x19, 0x2D, 0x10, 0xF0, 0x30, 0x6C, -+0xE0, 0xF7, 0x08, 0x4B, 0x00, 0xF0, 0x00, 0x4C, -+0x64, 0x33, 0x8D, 0xE3, 0xC2, 0xA3, 0x71, 0x6C, -+0x8B, 0xEC, 0xCC, 0xEC, 0x82, 0xC3, 0xFF, 0xF7, -+0x1F, 0x6E, 0x10, 0xF0, 0x30, 0x6C, 0xE6, 0xF1, -+0x11, 0x4C, 0x4C, 0xEE, 0x01, 0x6F, 0x04, 0xD5, -+0x00, 0x18, 0x9E, 0xE9, 0x19, 0x10, 0x02, 0x6D, -+0x08, 0xF3, 0xB4, 0xC4, 0x05, 0x10, 0x02, 0x6D, -+0x30, 0xF0, 0x20, 0x6C, 0xC8, 0xF4, 0xBC, 0xC4, -+0x10, 0xF0, 0x30, 0x6C, 0xE0, 0xF7, 0x08, 0x4B, -+0x64, 0x33, 0x00, 0xF0, 0x00, 0x4C, 0x91, 0xE3, -+0x63, 0xA4, 0x0F, 0x6C, 0x6C, 0xEC, 0x91, 0xE2, -+0xFF, 0x6B, 0x6C, 0xEC, 0x80, 0x18, 0x73, 0x0C, -+0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x5C, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0xFF, 0x6B, 0x40, 0xA2, -+0x10, 0xF0, 0x30, 0x68, 0x00, 0xF0, 0x00, 0x48, -+0x4C, 0xEB, 0x6E, 0xF2, 0x58, 0x9C, 0x50, 0x6E, -+0x05, 0xD3, 0x00, 0x6C, 0xFF, 0x6D, 0x40, 0xEA, -+0xC1, 0xF7, 0x48, 0xA0, 0xFF, 0x6B, 0x00, 0x6D, -+0x52, 0x32, 0xE0, 0xF7, 0x08, 0x4A, 0x44, 0x32, -+0x09, 0xE2, 0x82, 0xA2, 0x0F, 0x6A, 0x30, 0xF0, -+0x20, 0x69, 0x4C, 0xEC, 0x6C, 0xEC, 0x00, 0x18, -+0x79, 0xC8, 0xC1, 0xF7, 0x48, 0xA0, 0x0F, 0x6C, -+0xFF, 0x6B, 0x8C, 0xEA, 0xE0, 0xF7, 0x08, 0x4A, -+0x44, 0x32, 0x09, 0xE2, 0x82, 0xA2, 0x0F, 0x6A, -+0x01, 0x6D, 0x4C, 0xEC, 0x6C, 0xEC, 0x00, 0x18, -+0xA2, 0xC8, 0x04, 0xD2, 0xC1, 0xF7, 0x48, 0xA0, -+0x0F, 0x6C, 0xFF, 0x6B, 0x8C, 0xEA, 0xE0, 0xF7, -+0x08, 0x4A, 0x44, 0x32, 0x09, 0xE2, 0x82, 0xA2, -+0x0F, 0x6A, 0xC0, 0xF1, 0x08, 0x49, 0x4C, 0xEC, -+0x6C, 0xEC, 0x00, 0x6D, 0x00, 0x18, 0xA2, 0xC8, -+0x68, 0xF3, 0x70, 0xA1, 0x04, 0x94, 0x10, 0xF0, -+0x24, 0x6E, 0x66, 0x33, 0x60, 0x33, 0x68, 0x33, -+0x6D, 0xE2, 0x43, 0xEB, 0x58, 0x67, 0x51, 0xE4, -+0x04, 0xD4, 0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, -+0xA4, 0x9A, 0xC1, 0xF7, 0x48, 0xA0, 0xDC, 0xF4, -+0xD0, 0x9E, 0x80, 0x9D, 0x52, 0x32, 0xE0, 0xF7, -+0x08, 0x4A, 0x44, 0x32, 0x01, 0xE2, 0x42, 0xA0, -+0x00, 0xF7, 0x40, 0x32, 0xCC, 0xEA, 0x10, 0xF0, -+0x24, 0x6E, 0xDB, 0xF6, 0xDC, 0x9E, 0xCC, 0xEC, -+0x8D, 0xEA, 0x40, 0xDD, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x94, 0xFC, 0xF2, 0x58, 0x9A, 0x01, 0x6D, -+0x80, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF6, -+0x44, 0x9A, 0x60, 0xDA, 0x82, 0xA0, 0x0F, 0x6A, -+0xFF, 0x6B, 0x4C, 0xEC, 0x6C, 0xEC, 0x00, 0x18, -+0x79, 0xC8, 0x30, 0xF0, 0x20, 0x6C, 0x6E, 0xF2, -+0x58, 0x9C, 0x05, 0x95, 0x50, 0x6E, 0x00, 0x6C, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, -+0x50, 0x9A, 0x08, 0x6C, 0x40, 0xEA, 0x08, 0xF3, -+0x71, 0xA1, 0x20, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x14, 0x6B, 0x6D, 0xEA, 0x08, 0xF3, 0x70, 0xA1, -+0x08, 0xF3, 0x51, 0xC1, 0x80, 0x6A, 0x4B, 0xEA, -+0x6D, 0xEA, 0x08, 0xF3, 0x50, 0xC1, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0xFF, 0x6A, 0x04, 0x67, 0x4C, 0xE8, 0x6C, 0x40, -+0x4C, 0xEB, 0x03, 0x5B, 0x01, 0x6C, 0x03, 0x61, -+0x0E, 0xEC, 0x01, 0x5C, 0x98, 0x67, 0x30, 0xF0, -+0x20, 0x6A, 0xC8, 0xF4, 0x78, 0xA2, 0x60, 0x6A, -+0x6C, 0xEA, 0x40, 0x72, 0x09, 0x60, 0x20, 0x72, -+0x01, 0x61, 0x06, 0x2C, 0x03, 0x70, 0x04, 0x60, -+0x02, 0x70, 0x02, 0x60, 0x09, 0x70, 0x43, 0x61, -+0x09, 0x70, 0x06, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC8, 0xF4, 0x3A, 0xA2, 0x32, 0x31, 0x06, 0x10, -+0x10, 0xF0, 0x30, 0x6A, 0xC1, 0xF7, 0x52, 0xA2, -+0x0F, 0x69, 0x4C, 0xE9, 0x91, 0x67, 0x00, 0x6D, -+0x00, 0x18, 0xA2, 0xC8, 0x91, 0x67, 0x01, 0x6D, -+0x08, 0xD2, 0x00, 0x18, 0xA2, 0xC8, 0x9D, 0x67, -+0x17, 0x6B, 0x70, 0xC4, 0x0A, 0x6B, 0x6F, 0xCC, -+0x12, 0xC4, 0x30, 0xF0, 0x20, 0x6B, 0xC8, 0xF4, -+0x78, 0xA3, 0x0F, 0x6C, 0x66, 0x33, 0x8C, 0xEB, -+0x9D, 0x67, 0x73, 0xC4, 0x67, 0x44, 0x19, 0x4B, -+0x60, 0xA3, 0x74, 0xC4, 0x08, 0x94, 0x82, 0x33, -+0x9D, 0x67, 0x75, 0xC4, 0x62, 0x33, 0x76, 0xC4, -+0x08, 0x94, 0x00, 0xF6, 0x82, 0x33, 0x9D, 0x67, -+0x77, 0xC4, 0x58, 0xC4, 0x42, 0x33, 0x00, 0xF6, -+0x42, 0x32, 0x5B, 0xC4, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x58, 0x9A, 0x79, 0xC4, 0x62, 0x33, -+0x7A, 0xC4, 0x04, 0x04, 0x40, 0xEA, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x69, 0xC0, 0xF1, 0x08, 0x49, -+0x08, 0xF3, 0xB0, 0xA1, 0x01, 0x6B, 0xFF, 0x6A, -+0xA6, 0x30, 0x0F, 0x6E, 0x6C, 0xED, 0xCC, 0xE8, -+0x4C, 0xED, 0x4C, 0xEC, 0x4C, 0xE8, 0x2C, 0x25, -+0x08, 0xF3, 0xB4, 0xA1, 0x01, 0x75, 0x28, 0x61, -+0x10, 0xF0, 0x30, 0x6D, 0xE0, 0xF7, 0xE8, 0x40, -+0xE4, 0x37, 0x00, 0xF0, 0x00, 0x4D, 0xB5, 0xE7, -+0xA2, 0xA5, 0xAC, 0xEE, 0x8E, 0xEE, 0x1C, 0x2E, -+0x1E, 0x6D, 0xB8, 0xE8, 0x12, 0xED, 0x35, 0xE5, -+0x08, 0xF3, 0xDE, 0xA5, 0xCC, 0xEB, 0x4C, 0xEB, -+0x13, 0x23, 0xFF, 0xF6, 0x1F, 0x4A, 0xCC, 0xEA, -+0x08, 0xF3, 0x5E, 0xC5, 0x01, 0x6D, 0x00, 0x18, -+0x96, 0xE1, 0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF5, 0x48, 0x9A, 0x02, 0x6C, 0xB0, 0x67, -+0x40, 0xEA, 0x02, 0x6A, 0x08, 0xF3, 0x54, 0xC1, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0xDC, 0xF4, 0x74, 0x9B, 0xFF, 0x6A, 0x8C, 0xEA, -+0x60, 0x9B, 0x80, 0xF1, 0x01, 0x6C, 0x8B, 0xEC, -+0x8C, 0xEB, 0x10, 0xF0, 0x24, 0x6C, 0x5C, 0xF0, -+0x98, 0x9C, 0x01, 0x72, 0x80, 0x9C, 0x05, 0x60, -+0x02, 0x72, 0x05, 0x61, 0xFF, 0x6A, 0x01, 0x4A, -+0x01, 0x10, 0x80, 0x6A, 0x4D, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF4, 0x54, 0x9A, 0x60, 0xDA, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF4, 0x58, 0x9A, -+0x10, 0xF0, 0x24, 0x6B, 0x5C, 0xF0, 0x78, 0x9B, -+0x8C, 0xEA, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xDC, 0xF4, 0x7C, 0x9B, 0x50, 0x6A, 0x40, 0xC3, -+0x10, 0xF0, 0x24, 0x6B, 0xFC, 0xF4, 0x60, 0x9B, -+0x40, 0xC3, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0xE0, 0xF0, 0x68, 0xA2, -+0x01, 0x4B, 0xE0, 0xF0, 0x68, 0xC2, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x69, 0xF2, 0x74, 0xA2, 0x04, 0x6A, 0x6C, 0xEA, -+0x05, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF3, -+0x50, 0x9A, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x89, 0xF2, 0x6C, 0xA2, -+0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF3, 0x50, 0x9A, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC9, 0xF0, -+0x85, 0xA2, 0x21, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0xC9, 0xF0, 0x65, 0xC2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF4, 0x4C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0xFC, 0xF4, 0x94, 0x9C, 0x60, 0xAA, 0xEF, 0xF7, -+0x1F, 0x6A, 0x6C, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCF, 0xF5, 0x54, 0xCB, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF4, 0x70, 0x9A, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0xE0, 0xF0, 0x86, 0xA2, 0x03, 0x6B, 0x8C, 0xEB, -+0x0D, 0x2B, 0xE0, 0xF0, 0x65, 0xA2, 0x01, 0x4B, -+0xE0, 0xF0, 0x65, 0xC2, 0xE0, 0xF0, 0x65, 0xA2, -+0xE0, 0xF0, 0x46, 0xA2, 0x4A, 0x32, 0x42, 0xEB, -+0x41, 0x60, 0xB3, 0x10, 0xE0, 0xF0, 0x65, 0xA2, -+0xE0, 0xF0, 0x46, 0xA2, 0x4A, 0x32, 0x42, 0xEB, -+0x0B, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF3, -+0x80, 0x9A, 0x00, 0x6A, 0xA2, 0x67, 0x05, 0x6E, -+0x01, 0x6F, 0x04, 0xD2, 0x00, 0x18, 0x9E, 0xE9, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0xE0, 0xF0, 0x65, 0xA2, 0x22, 0x23, 0xE0, 0xF0, -+0x66, 0xA2, 0x03, 0x6A, 0x6C, 0xEA, 0x03, 0x6B, -+0x6E, 0xEA, 0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6B, -+0x8E, 0xF3, 0x9C, 0x9B, 0x04, 0xD2, 0x00, 0x6D, -+0x34, 0x6E, 0x08, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF3, 0x9C, 0x9A, 0x00, 0x6A, 0x04, 0xD2, -+0xA2, 0x67, 0x66, 0x6E, 0x01, 0x6F, 0x00, 0x18, -+0x9E, 0xE9, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0xE0, 0xF0, 0x65, 0xA2, 0xFF, 0x4B, -+0x03, 0x10, 0xE0, 0xF0, 0x66, 0xA2, 0x6A, 0x33, -+0xE0, 0xF0, 0x65, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xA9, 0xF0, 0xA8, 0xA2, -+0x01, 0x6B, 0xFF, 0x6C, 0xAC, 0xEB, 0x45, 0x23, -+0xC9, 0xF0, 0xC4, 0xA2, 0x00, 0x6B, 0xC9, 0xF0, -+0x69, 0xC2, 0x10, 0x6B, 0xCC, 0xEB, 0x8C, 0xEB, -+0x60, 0x2B, 0x80, 0x6F, 0xEB, 0xEF, 0xCD, 0xEF, -+0x04, 0x6E, 0xAC, 0xEE, 0x8C, 0xEE, 0xC9, 0xF0, -+0xE4, 0xC2, 0x1F, 0x26, 0x30, 0xF0, 0x20, 0x6C, -+0xEF, 0xF4, 0x08, 0x4C, 0xC9, 0xF0, 0xB9, 0xA2, -+0xC0, 0xF0, 0xD8, 0xA4, 0xC3, 0xED, 0x0A, 0x61, -+0xC0, 0xF0, 0xB4, 0x9C, 0x10, 0xF0, 0x24, 0x6C, -+0x1C, 0xF5, 0x84, 0x9C, 0xA0, 0xDC, 0xC9, 0xF0, -+0x79, 0xC2, 0x19, 0x10, 0x7C, 0x4C, 0x10, 0xF0, -+0x24, 0x6B, 0x95, 0x9C, 0x1C, 0xF5, 0x64, 0x9B, -+0x01, 0x4D, 0x80, 0xDB, 0xC9, 0xF0, 0xB9, 0xC2, -+0x0E, 0x10, 0xC9, 0xF0, 0x6B, 0xA2, 0x0B, 0x23, -+0x30, 0xF0, 0x20, 0x6B, 0xAF, 0xF5, 0x98, 0x9B, -+0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF5, 0x64, 0x9B, -+0x80, 0xDB, 0xC9, 0xF0, 0xCB, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF3, 0x50, 0x9A, 0x40, 0xEA, -+0x24, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF4, -+0x4C, 0x9A, 0xEF, 0xF7, 0x1F, 0x6B, 0xA0, 0xAA, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0xAC, 0xEB, 0xE0, 0xF0, 0x6C, 0xCA, 0xE0, 0xF0, -+0x4C, 0xAA, 0x10, 0x6B, 0x6C, 0xEA, 0x09, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF2, 0x78, 0x9A, -+0x03, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0x06, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF2, -+0x78, 0x9A, 0xFC, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, -+0x40, 0xC3, 0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xFF, 0x6E, 0x8C, 0xEE, 0xAE, 0xF3, 0x84, 0x9A, -+0x00, 0x6A, 0xA2, 0x67, 0x01, 0x6F, 0x04, 0xD2, -+0x00, 0x18, 0x9E, 0xE9, 0x07, 0x97, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x05, 0x5A, 0x00, 0x6B, -+0x24, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, -+0x5B, 0xF6, 0x10, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, -+0x00, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, -+0x58, 0x9A, 0x13, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x5B, 0xF7, 0x5C, 0x9A, 0x0E, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x7B, 0xF7, 0x40, 0x9A, 0x09, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x7B, 0xF7, 0x44, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x7B, 0xF7, -+0x48, 0x9A, 0x40, 0xAA, 0xFF, 0xF7, 0x1F, 0x6B, -+0x4C, 0xEB, 0x08, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x84, 0xEE, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xC9, 0xF0, 0x85, 0xA3, -+0x03, 0x6D, 0xFF, 0x69, 0x86, 0x32, 0xAC, 0xEA, -+0x02, 0x72, 0x01, 0x6A, 0x2F, 0x61, 0xC9, 0xF0, -+0x47, 0xA3, 0x03, 0x5A, 0x06, 0x60, 0xC9, 0xF0, -+0xC4, 0xA3, 0x04, 0x6D, 0xCC, 0xED, 0x2C, 0xED, -+0x0A, 0x25, 0x07, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0xC9, 0xF0, 0x45, 0xC3, 0x05, 0x6A, 0xC9, 0xF0, -+0x49, 0xC3, 0x01, 0x6A, 0x1B, 0x10, 0x01, 0x4A, -+0xC9, 0xF0, 0x47, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF3, 0x50, 0x9A, 0x30, 0xF0, 0x20, 0x68, -+0xEF, 0xF4, 0x08, 0x48, 0x03, 0x6C, 0x40, 0xEA, -+0xC0, 0xF0, 0x59, 0xA0, 0x07, 0x6D, 0x01, 0x6C, -+0x4C, 0xED, 0x2C, 0xED, 0x00, 0x18, 0xA4, 0xEE, -+0xC0, 0xF0, 0x5B, 0xA0, 0x01, 0x4A, 0xC0, 0xF0, -+0x5B, 0xC0, 0x00, 0x6A, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xA9, 0xF0, 0x08, 0xA2, 0x01, 0x6B, 0xFF, 0x6C, -+0x0C, 0xEB, 0x7C, 0x23, 0xC9, 0xF0, 0xA4, 0xA2, -+0x10, 0x6B, 0xAC, 0xEB, 0x8C, 0xEB, 0x05, 0x23, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF3, 0x4C, 0x9A, -+0x70, 0x10, 0xA9, 0xF0, 0x6C, 0xA2, 0x40, 0x6A, -+0x6C, 0xEA, 0x8C, 0xEA, 0x06, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF3, 0x40, 0x9A, 0x40, 0xEA, -+0x65, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC9, 0xF0, 0x69, 0xA2, 0x06, 0x5B, -+0x5D, 0x60, 0xC9, 0xF0, 0x69, 0x82, 0x01, 0x6A, -+0x44, 0xEB, 0x62, 0x67, 0x24, 0x6A, 0x6C, 0xEA, -+0x0C, 0x2A, 0x12, 0x6A, 0x6C, 0xEA, 0x04, 0x2A, -+0x09, 0x6A, 0x6C, 0xEA, 0x32, 0x2A, 0x4E, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF3, 0x54, 0x9A, -+0x48, 0x10, 0x30, 0x6A, 0x0C, 0xEA, 0x20, 0x72, -+0x0B, 0x60, 0x30, 0xF0, 0x20, 0x68, 0xEF, 0xF4, -+0x08, 0x48, 0xE0, 0xF0, 0x27, 0xA0, 0x01, 0x6B, -+0xFF, 0x6A, 0x6C, 0xE9, 0x4C, 0xE9, 0x05, 0x21, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF3, 0x58, 0x9A, -+0x34, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, -+0xA0, 0x9A, 0x01, 0x6C, 0x00, 0x18, 0xC1, 0xE0, -+0xE0, 0xF0, 0x47, 0xA0, 0x01, 0x6B, 0x10, 0xF0, -+0x30, 0x6C, 0x6C, 0xEA, 0xE0, 0xF0, 0x47, 0xC0, -+0xC7, 0xF3, 0x01, 0x4C, 0x00, 0x6D, 0x05, 0x6E, -+0xE3, 0x67, 0x04, 0xD1, 0x00, 0x18, 0x9E, 0xE9, -+0x1D, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF5, -+0x4F, 0xA2, 0x01, 0x6B, 0x6C, 0xEA, 0x06, 0x2A, -+0x10, 0xF0, 0x30, 0x6C, 0xC7, 0xF3, 0x01, 0x4C, -+0x00, 0x18, 0x8B, 0xE9, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xC9, 0xF0, 0x84, 0xA2, -+0x80, 0x6B, 0x6B, 0xEB, 0x8D, 0xEB, 0xC9, 0xF0, -+0x64, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF3, -+0x50, 0x9A, 0x40, 0xEA, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0xE0, 0xF0, 0x67, 0xA2, -+0x02, 0x4B, 0xE0, 0xF0, 0x67, 0xC2, 0xE0, 0xF0, -+0x68, 0xA2, 0x19, 0x23, 0xE0, 0xF0, 0x67, 0xA2, -+0x66, 0x33, 0x05, 0x53, 0x14, 0x60, 0x00, 0x6B, -+0xE0, 0xF0, 0x68, 0xC2, 0xE0, 0xF0, 0x6A, 0xA2, -+0x10, 0xF0, 0x30, 0x6C, 0xC7, 0xF3, 0x01, 0x4C, -+0x01, 0x4B, 0xE0, 0xF0, 0x6A, 0xC2, 0x00, 0x6A, -+0xA2, 0x67, 0x05, 0x6E, 0x01, 0x6F, 0x04, 0xD2, -+0x00, 0x18, 0x9E, 0xE9, 0x15, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x5B, 0xF7, 0xA0, 0x9A, 0x01, 0x6C, -+0x00, 0x18, 0xF2, 0xE0, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0xE0, 0xF0, 0x6B, 0xA2, -+0x01, 0x4B, 0xE0, 0xF0, 0x6B, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF3, 0x58, 0x9A, 0x40, 0xEA, -+0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0xE0, 0xF0, -+0x69, 0xA2, 0x01, 0x6C, 0x01, 0x4B, 0xE0, 0xF0, -+0x69, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF3, -+0x5C, 0x9A, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF3, 0x4C, 0x9A, 0x01, 0x6C, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF3, 0x58, 0x9A, -+0x01, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x69, 0xF2, 0x73, 0xA2, 0x80, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x06, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF3, 0x54, 0x9A, -+0x00, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x69, 0xF2, 0x74, 0xA2, 0x02, 0x6A, 0x6C, 0xEA, -+0x11, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF2, -+0x58, 0x9A, 0x02, 0xF0, 0x01, 0x6C, 0x8B, 0xEC, -+0x60, 0x9A, 0x8C, 0xEB, 0x60, 0xDA, 0x10, 0xF0, -+0x24, 0x6C, 0x60, 0x9A, 0x1C, 0xF5, 0x88, 0x9C, -+0x8C, 0xEB, 0x60, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x00, 0x6B, 0xC9, 0xF0, -+0x69, 0xC2, 0xA9, 0xF0, 0x6A, 0xA2, 0x04, 0x6C, -+0x8C, 0xEB, 0x1B, 0x23, 0xA9, 0xF0, 0x6C, 0xA2, -+0x6C, 0xEC, 0x17, 0x24, 0xC9, 0xF0, 0x85, 0xA2, -+0x20, 0x6B, 0x01, 0x6F, 0x8D, 0xEB, 0xC9, 0xF0, -+0x65, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF5, -+0xCB, 0xA2, 0x00, 0x6A, 0x04, 0xD2, 0xC6, 0x36, -+0x10, 0xF0, 0x30, 0x6C, 0xA2, 0x67, 0xFF, 0x6A, -+0x66, 0xF7, 0x1D, 0x4C, 0x4C, 0xEE, 0x00, 0x18, -+0x9E, 0xE9, 0x30, 0xF0, 0x20, 0x68, 0xEF, 0xF4, -+0x08, 0x48, 0xC0, 0xF0, 0x59, 0xA0, 0x07, 0x6C, -+0x00, 0x6D, 0x4C, 0xEC, 0x00, 0x18, 0xA2, 0xC8, -+0xC0, 0xF0, 0x5C, 0xD8, 0xE0, 0xF0, 0x47, 0xA0, -+0x7D, 0x67, 0x42, 0x6C, 0x46, 0x32, 0x58, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF3, 0x44, 0x9A, -+0x01, 0x6D, 0x06, 0x06, 0x40, 0xEA, 0x09, 0x97, -+0x08, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0xC9, 0xF0, -+0x65, 0xA0, 0x01, 0x6A, 0x82, 0x67, 0x6C, 0xEC, -+0x5B, 0x2C, 0x6D, 0xEA, 0xC9, 0xF0, 0x45, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF3, 0x4C, 0x9A, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF3, -+0x58, 0x9A, 0x00, 0x6C, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF3, 0x5C, 0x9A, 0x00, 0x6C, -+0x40, 0xEA, 0xA9, 0xF0, 0x6B, 0xA0, 0x80, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x06, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF3, -+0x54, 0x9A, 0x01, 0x6C, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x69, 0xF2, 0x74, 0xA2, 0x02, 0x6A, -+0x6C, 0xEA, 0x10, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF2, 0x58, 0x9A, 0x02, 0xF0, 0x00, 0x6C, -+0x60, 0x9A, 0x8D, 0xEB, 0x60, 0xDA, 0x10, 0xF0, -+0x24, 0x6C, 0x60, 0x9A, 0xFB, 0xF6, 0x88, 0x9C, -+0x8D, 0xEB, 0x60, 0xDA, 0x30, 0xF0, 0x20, 0x68, -+0xEF, 0xF4, 0x08, 0x48, 0xC0, 0xF0, 0x59, 0xA0, -+0x07, 0x6C, 0x00, 0x6D, 0x4C, 0xEC, 0x00, 0x18, -+0xA2, 0xC8, 0x30, 0xF0, 0x20, 0x6B, 0x69, 0xF2, -+0x94, 0xA3, 0x04, 0x6B, 0x8C, 0xEB, 0x10, 0x23, -+0xC0, 0xF0, 0x7C, 0x98, 0x43, 0xEB, 0x0C, 0x60, -+0xE0, 0xF0, 0x84, 0xA0, 0x6F, 0xE2, 0x80, 0x34, -+0x88, 0x34, 0x63, 0xEC, 0x05, 0x60, 0xE0, 0xF0, -+0x40, 0xA0, 0x01, 0x4A, 0xE0, 0xF0, 0x40, 0xC0, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFF, 0x6A, 0x4C, 0xEC, 0x03, 0x6B, 0x8C, 0xEB, -+0x4C, 0xEE, 0x3C, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x5C, 0xF5, 0x64, 0x9B, 0x80, 0xC3, 0x0F, 0x6B, -+0xCC, 0xEB, 0x34, 0x23, 0x01, 0x6C, 0x6C, 0xEC, -+0x06, 0x24, 0x10, 0xF0, 0x24, 0x6C, 0x5C, 0xF5, -+0x88, 0x9C, 0xAC, 0xEA, 0x40, 0xC4, 0x02, 0x6A, -+0x6C, 0xEA, 0x08, 0x22, 0xFF, 0x6C, 0xA2, 0x32, -+0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6C, 0x5C, 0xF5, -+0x8C, 0x9C, 0x40, 0xC4, 0x04, 0x6A, 0x6C, 0xEA, -+0x09, 0x22, 0xA2, 0x32, 0xFF, 0x6C, 0x42, 0x32, -+0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6C, 0x5C, 0xF5, -+0x90, 0x9C, 0x40, 0xC4, 0x6E, 0x32, 0x07, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF5, 0x54, 0x9A, -+0x00, 0xF6, 0xA2, 0x35, 0xA0, 0xC2, 0x20, 0x6A, -+0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x5C, 0xF5, -+0x78, 0x9B, 0x40, 0xC3, 0x00, 0x6A, 0x40, 0xC3, -+0x01, 0x6A, 0x20, 0xE8, 0x00, 0x6A, 0x20, 0xE8, -+0xFF, 0x6A, 0x8C, 0xEA, 0x03, 0x6B, 0x4C, 0xEB, -+0x03, 0x23, 0x01, 0x6A, 0x4B, 0xEA, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6C, 0x5C, 0xF5, 0x84, 0x9C, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF5, -+0x98, 0x9A, 0x30, 0x6A, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0x5C, 0xF5, 0x48, 0x9A, 0x40, 0x9A, -+0x60, 0xC4, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF5, 0xBC, 0x9A, -+0xE0, 0xF3, 0x10, 0x6C, 0x0F, 0x6E, 0x80, 0x18, -+0x8C, 0x0F, 0xE0, 0xF3, 0x0C, 0x6C, 0x80, 0x18, -+0xAE, 0x0F, 0xFF, 0x6B, 0x4C, 0xEB, 0x0B, 0x73, -+0x0B, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF5, -+0x60, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x7C, 0xF5, -+0x84, 0x9C, 0x40, 0x9B, 0x8C, 0xEA, 0x40, 0xDB, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x05, 0x6B, 0x65, 0xF4, 0x64, 0xDA, 0x00, 0x6B, -+0x65, 0xF4, 0x60, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0xE5, 0x63, 0x35, 0x62, 0x34, 0xD1, 0x33, 0xD0, -+0x10, 0xF0, 0x24, 0x6D, 0x07, 0x04, 0x5B, 0xF3, -+0x0C, 0x4D, 0x54, 0x6E, 0x00, 0x18, 0xA1, 0xD4, -+0x10, 0xF0, 0x24, 0x6D, 0x1C, 0x04, 0xFB, 0xF2, -+0x18, 0x4D, 0x54, 0x6E, 0x00, 0x18, 0xA1, 0xD4, -+0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF2, 0x6C, 0x9A, -+0xFB, 0xF2, 0x0C, 0x4A, 0x00, 0x69, 0x04, 0xD3, -+0x61, 0x9A, 0x44, 0xAA, 0x05, 0xD3, 0x7D, 0x67, -+0x4C, 0xCB, 0x52, 0x68, 0x18, 0xE9, 0x30, 0xF0, -+0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, 0x61, 0x6F, -+0xEB, 0xEF, 0x00, 0x6C, 0x01, 0x49, 0x12, 0xE8, -+0x01, 0xE2, 0x3F, 0x6A, 0x20, 0xF0, 0x65, 0xA0, -+0xFA, 0x65, 0x40, 0xC0, 0x09, 0x6A, 0x44, 0xC0, -+0x0D, 0x6A, 0x4B, 0xEA, 0x20, 0xF0, 0xA6, 0xA0, -+0x6C, 0xEA, 0x04, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, -+0x04, 0x6B, 0xAD, 0xEB, 0x31, 0x6D, 0xAB, 0xED, -+0xAC, 0xEA, 0x40, 0x6D, 0xAD, 0xEA, 0x80, 0x4D, -+0x20, 0xF0, 0xC7, 0xA0, 0xC0, 0x4D, 0xAD, 0xEA, -+0x20, 0xF0, 0xB5, 0xA0, 0x20, 0xF0, 0x45, 0xC0, -+0x03, 0x6A, 0x1E, 0x65, 0x4B, 0xEA, 0xD8, 0x67, -+0xAC, 0xEA, 0x41, 0x6D, 0xAB, 0xED, 0xCC, 0xEF, -+0x20, 0xF0, 0xE7, 0xC0, 0xAC, 0xEB, 0x20, 0xF0, -+0xE0, 0xA0, 0x20, 0xF0, 0x66, 0xC0, 0x08, 0x6B, -+0x6B, 0xEB, 0xEC, 0xEB, 0x20, 0xF0, 0x60, 0xC0, -+0x01, 0x6B, 0x6B, 0xEB, 0x68, 0xC0, 0x21, 0x6B, -+0xAC, 0xEA, 0x6B, 0xEB, 0x6C, 0xEA, 0x20, 0xF0, -+0x55, 0xC0, 0x40, 0xF0, 0x61, 0xA0, 0x5F, 0x67, -+0x47, 0xC0, 0x40, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x00, 0x6F, 0xAC, 0xEA, 0x81, 0xC0, 0x83, 0xC0, -+0x20, 0xF0, 0x94, 0xC0, 0x20, 0xF0, 0x81, 0xC0, -+0xF6, 0xC8, 0xE9, 0xC0, 0x40, 0xF0, 0x82, 0xC0, -+0x40, 0xF0, 0x41, 0xC0, 0x30, 0xF0, 0x20, 0x6E, -+0x4E, 0xF2, 0x4C, 0x9E, 0x87, 0x40, 0x3E, 0x4C, -+0xFF, 0x6D, 0x02, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6F, 0x4E, 0xF2, 0x4C, 0x9F, 0x87, 0x40, -+0xFF, 0x68, 0x40, 0x4C, 0x00, 0x6D, 0x02, 0x6E, -+0x0C, 0xE9, 0x40, 0xEA, 0x80, 0x71, 0x8D, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0x6B, 0xC0, 0xF1, -+0x08, 0x4A, 0xE5, 0xF2, 0x76, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF5, 0x48, 0x9A, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF5, 0x54, 0x9A, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF1, -+0x5C, 0x9A, 0x32, 0x6B, 0x30, 0xF0, 0x20, 0x6C, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF1, -+0x40, 0x9A, 0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF1, -+0x64, 0x9B, 0x40, 0xA2, 0x05, 0xF4, 0x10, 0x4C, -+0x1C, 0x05, 0x0C, 0xEA, 0xFF, 0x4A, 0x0C, 0xEA, -+0x40, 0xC3, 0x30, 0xF0, 0x20, 0x68, 0x4E, 0xF2, -+0x50, 0x98, 0x54, 0x6E, 0x40, 0xEA, 0x4E, 0xF2, -+0x50, 0x98, 0x30, 0xF0, 0x20, 0x6C, 0x65, 0xF4, -+0x04, 0x4C, 0x07, 0x05, 0x54, 0x6E, 0x40, 0xEA, -+0x4E, 0xF2, 0x50, 0x98, 0x30, 0xF0, 0x20, 0x6C, -+0x05, 0xF6, 0x1A, 0x4C, 0x04, 0x05, 0x0A, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xC5, 0xF4, 0x0A, 0x4A, 0x65, 0xF5, -+0x12, 0x4B, 0x0A, 0x6C, 0x80, 0xCA, 0x00, 0x6C, -+0xA0, 0xF0, 0x88, 0xCA, 0x02, 0x4A, 0x6A, 0xEA, -+0xF8, 0x61, 0x35, 0x97, 0x34, 0x91, 0x33, 0x90, -+0x1B, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, -+0x06, 0xD4, 0x09, 0xD7, 0x07, 0xD5, 0x08, 0xD6, -+0x06, 0x04, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x46, 0x67, 0x01, 0x4A, -+0x05, 0x67, 0x0C, 0xD6, 0x27, 0x67, 0x1F, 0x22, -+0x1F, 0xF7, 0x00, 0x6A, 0xAC, 0xEA, 0x02, 0xF0, -+0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0xBB, 0xF6, 0x5C, 0x9A, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xDB, 0xF6, 0x40, 0x9A, -+0x49, 0xE0, 0x40, 0x9A, 0x0C, 0x94, 0x04, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, 0x50, 0x9A, -+0x40, 0xEA, 0x0C, 0x93, 0x24, 0xEA, 0x6F, 0xEA, -+0x04, 0x93, 0x6C, 0xEA, 0x4D, 0xE9, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF6, 0x5C, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x40, 0x9A, 0x41, 0xE0, -+0x20, 0xD8, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x1F, 0xF7, 0x00, 0x6A, -+0xAC, 0xEA, 0x02, 0xF0, 0x00, 0x72, 0x26, 0x67, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xBB, 0xF6, 0x5C, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x40, 0x9A, 0x55, 0xE5, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0x9D, 0xAE, 0xF4, -+0x50, 0x9A, 0x91, 0x67, 0x2C, 0xE8, 0x40, 0xEA, -+0x06, 0xEA, 0x50, 0x67, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0xEE, 0xF3, 0x54, 0x98, 0x00, 0x6C, -+0xA4, 0x67, 0xE4, 0x67, 0x01, 0x6E, 0x40, 0xEA, -+0xEE, 0xF3, 0x54, 0x98, 0x01, 0x6D, 0xE5, 0x67, -+0x00, 0x6C, 0xC5, 0x67, 0x40, 0xEA, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, 0x20, 0x68, -+0x7C, 0xF0, 0x14, 0x4B, 0xCE, 0xF4, 0x50, 0x98, -+0xC0, 0x9B, 0x03, 0xF3, 0x00, 0x69, 0x01, 0x6D, -+0x91, 0x67, 0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, 0x7C, 0xF0, -+0xD8, 0x9B, 0x01, 0x6D, 0x91, 0x67, 0xAB, 0xED, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x7C, 0xF0, 0xDC, 0x9B, 0x01, 0x6D, -+0x91, 0x67, 0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x7C, 0xF0, 0x14, 0x4B, 0xCE, 0xF4, -+0x50, 0x98, 0xC0, 0x9B, 0x01, 0x6D, 0x91, 0x67, -+0xAB, 0xED, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x00, 0x6A, 0x0B, 0xD7, 0xE0, 0xAE, 0x1F, 0xF7, -+0x00, 0x6B, 0xEC, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x09, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xE0, 0xAE, 0xBB, 0xF6, 0x7C, 0x9B, 0x6D, 0xE7, -+0xE0, 0xA4, 0xE0, 0xC3, 0x07, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xDB, 0xF6, 0x60, 0x9B, 0x7D, 0xE7, -+0x60, 0xA4, 0x60, 0xC7, 0x01, 0x4A, 0xFF, 0x6B, -+0x6C, 0xEA, 0x04, 0x72, 0x02, 0x4E, 0x01, 0x4C, -+0xE1, 0x61, 0x25, 0x67, 0x00, 0x68, 0x0B, 0x92, -+0xC0, 0x99, 0x01, 0x6D, 0x0D, 0xE2, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x80, 0xAB, -+0xAB, 0xED, 0x02, 0x48, 0x40, 0xEA, 0x16, 0x70, -+0x04, 0x49, 0xF1, 0x61, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x5C, 0x9A, -+0x7F, 0x6B, 0xFF, 0x6C, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0xDB, 0xF6, 0x48, 0x9A, 0x14, 0x6B, -+0x01, 0x6D, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x4C, 0x9A, 0x10, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x9C, 0xF0, 0x68, 0x9A, 0x01, 0x6E, 0x81, 0xF4, -+0x14, 0x69, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0x8C, 0xEA, 0x40, 0xC3, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0xF0, 0x0D, 0x4C, 0xEF, 0xF7, 0x1F, 0x4D, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0x91, 0x67, 0xC5, 0x67, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x91, 0x67, 0x01, 0xF4, 0x00, 0x6D, -+0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x01, 0xF4, 0x00, 0x6C, 0xAB, 0xED, -+0x04, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xFF, 0x6D, 0x01, 0xF3, 0x00, 0x6C, 0x01, 0x4D, -+0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xFB, 0xF6, 0xA8, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0xF0, 0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0x21, 0xF0, 0x18, 0x6C, -+0x0E, 0x6D, 0x07, 0x6E, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x1E, 0x22, 0x30, 0xF0, -+0x20, 0x68, 0x10, 0xF0, 0x24, 0x6B, 0x9C, 0xF0, -+0xCC, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x69, -+0x2B, 0xE9, 0xA1, 0xF4, 0x10, 0x6C, 0xB1, 0x67, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0xA1, 0xF4, -+0x14, 0x6C, 0xB1, 0x67, 0x6E, 0xF7, 0x17, 0x6E, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0xA1, 0xF4, -+0x1C, 0x6C, 0xB1, 0x67, 0x21, 0xF0, 0x1B, 0x6E, -+0x1D, 0x10, 0x30, 0xF0, 0x20, 0x68, 0x10, 0xF0, -+0x24, 0x6B, 0x9C, 0xF0, 0xD0, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x69, 0x2B, 0xE9, 0xA1, 0xF4, -+0x10, 0x6C, 0xB1, 0x67, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0xA1, 0xF4, 0x14, 0x6C, 0xB1, 0x67, -+0x62, 0xF1, 0x17, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0xA1, 0xF4, 0x1C, 0x6C, 0xB1, 0x67, -+0x00, 0xF4, 0x04, 0x6E, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x00, 0x6B, 0x0B, 0xD7, 0xE0, 0xAE, 0x1F, 0xF7, -+0x00, 0x6A, 0xEC, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x08, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xE0, 0xAE, 0xBB, 0xF6, 0x5C, 0x9A, 0x49, 0xE7, -+0xE0, 0xA2, 0x06, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xDB, 0xF6, 0x40, 0x9A, 0x5D, 0xE7, 0xE0, 0xA7, -+0xFF, 0x6A, 0xEC, 0xEA, 0x7D, 0xE4, 0x01, 0x4B, -+0x04, 0x73, 0x40, 0xC7, 0x02, 0x4E, 0xE2, 0x61, -+0x25, 0x67, 0x00, 0x68, 0x0B, 0x93, 0x01, 0x6D, -+0xAB, 0xED, 0x09, 0xE3, 0x80, 0xAA, 0x02, 0x48, -+0x00, 0x18, 0xE4, 0xE6, 0x16, 0x70, 0x40, 0xD9, -+0x04, 0x49, 0xF4, 0x61, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xFF, 0x69, 0x7C, 0xF0, -+0x74, 0x9B, 0x30, 0xF0, 0x20, 0x68, 0x2C, 0xEC, -+0xCE, 0xF4, 0x50, 0x98, 0xAC, 0xE9, 0x24, 0x36, -+0x01, 0x6D, 0x04, 0xD4, 0xAB, 0xED, 0x03, 0xF3, -+0x00, 0x6C, 0x6D, 0xEE, 0x40, 0xEA, 0x04, 0x92, -+0x08, 0x2A, 0xCE, 0xF4, 0x50, 0x98, 0x03, 0xF3, -+0x0C, 0x6C, 0x06, 0xF0, 0x00, 0x6D, 0x03, 0x6E, -+0x07, 0x10, 0xCE, 0xF4, 0x50, 0x98, 0x03, 0xF3, -+0x0C, 0x6C, 0x06, 0xF0, 0x00, 0x6D, 0x01, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x9C, 0xF0, -+0xA0, 0x9B, 0xC3, 0xF3, 0x14, 0x6C, 0x10, 0x6E, -+0x40, 0xEA, 0x04, 0x94, 0x24, 0x31, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xE4, 0x30, 0x33, 0xC0, 0xF1, -+0x08, 0x4A, 0x30, 0x31, 0x6D, 0xE2, 0x29, 0xE2, -+0xE7, 0xF7, 0x0C, 0x4A, 0x04, 0xD2, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF0, 0x34, 0x9A, 0xE7, 0xF6, -+0x0C, 0x4B, 0x05, 0xD3, 0x30, 0xF0, 0x20, 0x68, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0xD1, 0x67, -+0xC3, 0xF3, 0x18, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x01, 0x6D, 0xE3, 0xF3, 0x1C, 0x6C, 0xAB, 0xED, -+0x00, 0x18, 0xE4, 0xE6, 0x10, 0xF0, 0x24, 0x6B, -+0x9C, 0xF0, 0x78, 0x9B, 0x05, 0x94, 0x04, 0x49, -+0x4C, 0xEB, 0x62, 0x33, 0x62, 0x33, 0x60, 0xCC, -+0xE1, 0xF7, 0x1F, 0x6B, 0x4C, 0xEB, 0x04, 0x92, -+0x02, 0x4C, 0x05, 0xD4, 0x60, 0xCA, 0x02, 0x4A, -+0x04, 0xD2, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF0, -+0x5C, 0x9A, 0x2E, 0xEA, 0xD7, 0x2A, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0xC3, 0xF3, 0x18, 0x6C, -+0xAB, 0xED, 0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x03, 0xF3, 0x0C, 0x6C, 0x06, 0xF0, -+0x00, 0x6D, 0x00, 0x6E, 0x40, 0xEA, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x28, 0xF1, 0x4C, 0xA0, 0x69, 0x2A, 0x10, 0xF0, -+0x24, 0x6C, 0x9C, 0xF5, 0x00, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x01, 0x6A, 0xA7, 0xF6, 0x46, 0xC0, -+0x30, 0xF0, 0x21, 0x6A, 0x50, 0xF3, 0x0A, 0x4A, -+0x30, 0xF0, 0x20, 0x6F, 0x30, 0xF0, 0x20, 0x6E, -+0x30, 0xF0, 0x20, 0x6C, 0xA8, 0xF0, 0x0C, 0x4F, -+0xA8, 0xF2, 0x14, 0x4E, 0xA4, 0x42, 0xC8, 0xF0, -+0x04, 0x4C, 0x00, 0x6B, 0x1A, 0x65, 0x00, 0x6A, -+0x18, 0x67, 0x40, 0xDF, 0x40, 0xC8, 0x40, 0xDE, -+0xD0, 0xF7, 0x05, 0x43, 0x30, 0xF0, 0x20, 0x6A, -+0x0C, 0x30, 0xC0, 0xF1, 0x08, 0x4A, 0x09, 0xE2, -+0x0A, 0x4A, 0x05, 0xD2, 0x58, 0x67, 0x04, 0xD4, -+0x00, 0x69, 0xFA, 0x65, 0x05, 0x90, 0x01, 0x6A, -+0x09, 0xD3, 0x40, 0xC0, 0x6C, 0x30, 0x01, 0xE1, -+0x18, 0x65, 0x10, 0x32, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x49, 0xE0, 0xE7, 0xF6, -+0x0C, 0x4A, 0x08, 0xD2, 0x58, 0x67, 0x50, 0x32, -+0x41, 0xE0, 0x08, 0x92, 0xE7, 0xF7, 0x0C, 0x48, -+0x06, 0xD0, 0x06, 0x93, 0x00, 0x68, 0x00, 0xCA, -+0x00, 0xCB, 0x02, 0x4B, 0x06, 0xD3, 0x04, 0x93, -+0x02, 0x4A, 0x6A, 0xEA, 0xF6, 0x61, 0x05, 0x92, -+0x01, 0x49, 0x02, 0x71, 0x01, 0x4A, 0x05, 0xD2, -+0x04, 0x92, 0x09, 0x93, 0x10, 0x4A, 0x04, 0xD2, -+0xD5, 0x61, 0x00, 0xC5, 0x01, 0xC5, 0x02, 0xC5, -+0x01, 0x4B, 0x1F, 0x67, 0x02, 0x6A, 0x02, 0x48, -+0x7F, 0x4C, 0x6E, 0xEA, 0x04, 0x4F, 0x10, 0x4E, -+0x18, 0x65, 0x03, 0x4D, 0x01, 0x4C, 0xB3, 0x2A, -+0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0xBC, 0xF0, 0xC0, 0x9B, -+0x01, 0x6D, 0x03, 0xF3, 0x10, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, -+0x07, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x21, 0x6A, -+0x50, 0xF3, 0x5C, 0xA2, 0xFF, 0x69, 0x8C, 0xE9, -+0x53, 0x22, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0x7C, 0xF0, 0x74, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x24, 0x36, 0x01, 0x6D, 0x6D, 0xEE, -+0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF0, 0xA4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x23, 0xF3, 0x08, 0x6C, -+0x80, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0xC3, 0xF3, 0x0C, 0x6C, 0xAB, 0xED, -+0x09, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x98, 0xBC, 0xF0, 0xC8, 0x9B, -+0x01, 0x6D, 0x23, 0xF3, 0x00, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF0, -+0xCC, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0x23, 0xF3, 0x04, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0x10, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0xF4, 0x9A, -+0x00, 0x6C, 0x78, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x42, 0xE7, 0x00, 0x6C, 0x5C, 0x6D, 0xD0, 0x67, -+0x20, 0xF3, 0x00, 0x6F, 0x00, 0x18, 0x42, 0xE7, -+0x10, 0xF0, 0x24, 0x6A, 0x00, 0x6C, 0x8F, 0x6D, -+0xD0, 0x67, 0xBC, 0xF0, 0xF8, 0x9A, 0x79, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x7C, 0xF0, 0x74, 0x9B, -+0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, -+0x24, 0x36, 0x01, 0x6D, 0x03, 0xF3, 0x00, 0x6C, -+0xAB, 0xED, 0x6D, 0xEE, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF0, 0x54, 0xA2, 0x03, 0x22, -+0x01, 0x72, 0x28, 0x60, 0x64, 0x10, 0xCE, 0xF4, -+0x50, 0x98, 0xC3, 0xF3, 0x0C, 0x6C, 0xFF, 0x6D, -+0x12, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF0, 0xA4, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x23, 0xF3, 0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF0, 0xC8, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0x23, 0xF3, -+0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x01, 0x6D, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, -+0x23, 0xF3, 0x04, 0x6C, 0xAB, 0xED, 0xBC, 0xF0, -+0xDC, 0x9B, 0x26, 0x10, 0xCE, 0xF4, 0x50, 0x98, -+0xC3, 0xF3, 0x0C, 0x6C, 0xFF, 0x6D, 0x09, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF0, -+0xA4, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x23, 0xF3, -+0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xDC, 0xF0, 0xC8, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0x23, 0xF3, 0x00, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x98, 0xDC, 0xF0, 0xCC, 0x9B, -+0x01, 0x6D, 0x23, 0xF3, 0x04, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, -+0x10, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF0, -+0xE0, 0x9A, 0x91, 0x67, 0x56, 0x6D, 0xD0, 0x67, -+0x00, 0x18, 0x42, 0xE7, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF0, 0xE4, 0x9A, 0x91, 0x67, 0x8F, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x42, 0xE7, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x21, 0x6A, 0x50, 0xF3, 0x5C, 0xA2, -+0xFF, 0x6E, 0x8C, 0xEE, 0x48, 0x22, 0x10, 0xF0, -+0x24, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0x7C, 0xF0, -+0x74, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x69, -+0x2B, 0xE9, 0xC4, 0x36, 0x6D, 0xEE, 0xB1, 0x67, -+0x03, 0xF3, 0x00, 0x6C, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0xB1, 0x67, 0xC3, 0xF3, 0x0C, 0x6C, -+0x1B, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xDC, 0xF0, 0xD0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x23, 0xF3, 0x00, 0x6C, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0x30, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF0, 0xF4, 0x9A, -+0x00, 0x6C, 0x78, 0x6D, 0xD1, 0x67, 0x00, 0x18, -+0x42, 0xE7, 0x00, 0x6C, 0x5C, 0x6D, 0xD1, 0x67, -+0x28, 0xF3, 0x00, 0x6F, 0x00, 0x18, 0x42, 0xE7, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF0, 0xF8, 0x9A, -+0x00, 0x6C, 0x8F, 0x6D, 0xD1, 0x67, 0x00, 0x18, -+0x42, 0xE7, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x23, 0xF3, 0x08, 0x6C, 0xBC, 0xF0, -+0xA4, 0x9B, 0x80, 0x6E, 0x5D, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x7C, 0xF0, 0x74, 0x9B, 0x30, 0xF0, -+0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x69, -+0x2B, 0xE9, 0xC4, 0x36, 0x6D, 0xEE, 0x03, 0xF3, -+0x00, 0x6C, 0xB1, 0x67, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0xC3, 0xF3, 0x0C, 0x6C, 0xB1, 0x67, -+0x09, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x98, 0xDC, 0xF0, 0xDC, 0x9B, -+0x23, 0xF3, 0x00, 0x6C, 0xB1, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF0, 0x54, 0xA2, -+0x03, 0x22, 0x01, 0x72, 0x16, 0x60, 0x35, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0x30, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF0, 0xE0, 0x9A, -+0x00, 0x6C, 0x56, 0x6D, 0xD1, 0x67, 0x00, 0x18, -+0x42, 0xE7, 0x10, 0xF0, 0x24, 0x6A, 0x00, 0x6C, -+0x8F, 0x6D, 0xD1, 0x67, 0xFC, 0xF0, 0xE4, 0x9A, -+0x14, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, -+0x30, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF0, -+0xE8, 0x9A, 0x00, 0x6C, 0x56, 0x6D, 0xD1, 0x67, -+0x00, 0x18, 0x42, 0xE7, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF0, 0xEC, 0x9A, 0x00, 0x6C, 0x8F, 0x6D, -+0xD1, 0x67, 0x00, 0x18, 0x42, 0xE7, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, 0xBC, 0xF0, -+0xA4, 0x9B, 0x23, 0xF3, 0x08, 0x6C, 0x00, 0x6E, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD0, 0x00, 0x6A, 0x7D, 0x67, 0x4C, 0xCB, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0xD0, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, 0xE0, 0x9A, -+0x00, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0x42, 0xE7, -+0x30, 0xF0, 0x20, 0x68, 0x10, 0xF0, 0x24, 0x6B, -+0xFC, 0xF0, 0xB0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0xE1, 0xF0, 0x18, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0xE1, 0xF0, -+0x1C, 0x6C, 0xAB, 0xED, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0x07, 0x6D, 0xC5, 0x67, -+0x83, 0xF1, 0x0C, 0x6C, 0x40, 0xEA, 0x06, 0x02, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, -+0x54, 0x9A, 0xA1, 0xF3, 0x18, 0x6F, 0xA1, 0xF7, -+0x00, 0x6C, 0x08, 0x6D, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0xF0, 0x08, 0x6C, -+0xFF, 0x6D, 0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, 0xFC, 0xF0, -+0xB4, 0x9B, 0x01, 0xF2, 0x04, 0x6C, 0x00, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF0, -+0x78, 0x9A, 0xFF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, -+0xFE, 0x6C, 0x4C, 0xEC, 0x80, 0xC3, 0x40, 0xC3, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF0, 0x5C, 0x9A, -+0x60, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, 0x09, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF1, 0x64, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF1, 0x40, 0x9A, -+0x60, 0xDA, 0x09, 0x97, 0x08, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, -+0x37, 0x22, 0x30, 0xF0, 0x20, 0x68, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, 0x1C, 0xF1, -+0xC8, 0x9B, 0x01, 0x69, 0x2B, 0xE9, 0xB1, 0x67, -+0x61, 0xF4, 0x00, 0x6C, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, 0x1C, 0xF1, -+0xCC, 0x9B, 0xB1, 0x67, 0x61, 0xF4, 0x00, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x1C, 0xF1, 0xD0, 0x9B, 0xB1, 0x67, -+0x41, 0xF4, 0x18, 0x6C, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x1C, 0xF1, 0xD4, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0xB1, 0x67, 0x41, 0xF4, 0x1C, 0x6C, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0x61, 0xF4, -+0x0C, 0x6C, 0xB1, 0x67, 0x01, 0xF2, 0x15, 0x6E, -+0x40, 0xEA, 0x80, 0x18, 0x89, 0x12, 0x34, 0x10, -+0x30, 0xF0, 0x20, 0x68, 0x10, 0xF0, 0x24, 0x6B, -+0x1C, 0xF1, 0xC8, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x69, 0x2B, 0xE9, 0x61, 0xF4, 0x00, 0x6C, -+0xB1, 0x67, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x1C, 0xF1, 0xD8, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x61, 0xF4, 0x00, 0x6C, 0xB1, 0x67, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF1, 0xDC, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x41, 0xF4, 0x18, 0x6C, -+0xB1, 0x67, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x98, 0x3C, 0xF1, 0xC0, 0x9B, -+0x41, 0xF4, 0x1C, 0x6C, 0xB1, 0x67, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0x61, 0xF4, 0x0C, 0x6C, -+0xB1, 0x67, 0x22, 0xF2, 0x0A, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0x3C, 0xF0, 0xB4, 0x9B, -+0xA1, 0xF1, 0x04, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x68, 0x8C, 0xE8, -+0x00, 0x69, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, -+0x10, 0x4A, 0xC0, 0x9A, 0x90, 0x67, 0xEF, 0x6D, -+0x00, 0x6F, 0x00, 0x18, 0x42, 0xE7, 0x10, 0xF0, -+0x24, 0x6B, 0xBC, 0xF0, 0x10, 0x4B, 0xC0, 0x9B, -+0x90, 0x67, 0x08, 0x6D, 0x00, 0x6F, 0x00, 0x18, -+0x42, 0xE7, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, -+0x10, 0x4A, 0xC0, 0x9A, 0x90, 0x67, 0x08, 0x6D, -+0x00, 0x18, 0x2F, 0xE7, 0x07, 0x22, 0x01, 0x49, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xE9, 0x2E, 0xF5, -+0x10, 0x71, 0xDB, 0x61, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF0, 0xD0, 0x9A, 0x00, 0x6C, 0x18, 0x6D, -+0x00, 0x18, 0x2F, 0xE7, 0x30, 0xF0, 0x20, 0x6B, -+0x01, 0xF4, 0x00, 0x6C, 0xC0, 0xF1, 0x08, 0x4B, -+0x4C, 0xEC, 0x87, 0xF6, 0x50, 0xDB, 0x82, 0x32, -+0x4A, 0x32, 0x02, 0x72, 0x0A, 0x60, 0x03, 0x6C, -+0x4E, 0xEC, 0x04, 0x24, 0x01, 0x72, 0x02, 0x6A, -+0x05, 0x60, 0x06, 0x10, 0x87, 0xF6, 0x8D, 0xC3, -+0x03, 0x10, 0x01, 0x6A, 0x87, 0xF6, 0x4D, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x10, 0xF0, 0x24, 0x6B, 0x5B, 0xF7, 0x60, 0x9B, -+0x87, 0xF6, 0x90, 0x9A, 0x8C, 0xEB, 0x62, 0x33, -+0x62, 0x33, 0x87, 0xF6, 0x6C, 0xC2, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, 0x05, 0x67, -+0x01, 0x74, 0x4C, 0xE8, 0x5D, 0x60, 0x03, 0x24, -+0x04, 0x5C, 0x71, 0x60, 0x6B, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xE7, 0xF6, -+0x64, 0x9A, 0x30, 0xF0, 0x20, 0x6C, 0xC8, 0xF0, -+0x04, 0x4C, 0xE7, 0xF6, 0x68, 0xDA, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x60, 0xF6, -+0x62, 0xAA, 0x00, 0x6D, 0x60, 0xF6, 0x64, 0xCA, -+0x60, 0xF6, 0x70, 0xA2, 0x60, 0xF6, 0x71, 0xC2, -+0x30, 0xF0, 0x20, 0x6B, 0x68, 0xF0, 0x1A, 0x4B, -+0x40, 0xA3, 0xB0, 0x36, 0x48, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC9, 0xE2, -+0xE7, 0xF6, 0x0C, 0x4A, 0xC0, 0xAA, 0x80, 0xF0, -+0xC0, 0xCA, 0x00, 0xF1, 0xC0, 0xAA, 0x80, 0xF1, -+0xC0, 0xCA, 0x02, 0x4A, 0x8A, 0xEA, 0xF6, 0x61, -+0x01, 0x4D, 0x02, 0x75, 0x01, 0x4B, 0x10, 0x4C, -+0xE7, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0x78, 0x67, 0x60, 0xF6, 0x70, 0xC2, -+0x78, 0x67, 0x60, 0xF6, 0x62, 0xCA, 0x30, 0xF0, -+0x20, 0x6B, 0x00, 0x6C, 0xC0, 0xF1, 0x08, 0x4B, -+0x60, 0xF6, 0x8C, 0xC2, 0x60, 0xF6, 0x8D, 0xC2, -+0x60, 0xF6, 0x86, 0xC2, 0x60, 0xF6, 0x87, 0xC2, -+0x60, 0xF6, 0x88, 0xC2, 0x87, 0xF6, 0x50, 0x9B, -+0x01, 0x6D, 0xA7, 0xF6, 0xB2, 0xC3, 0xA7, 0xF6, -+0xB3, 0xC3, 0xE7, 0xF6, 0x44, 0xDB, 0x17, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0xD0, 0x9A, -+0x00, 0x6C, 0x58, 0x6D, 0x00, 0x18, 0x2F, 0xE7, -+0x22, 0xF0, 0x1A, 0x48, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x08, 0x30, 0x0D, 0xE3, -+0x41, 0xDB, 0x05, 0x10, 0xFE, 0x4C, 0x4C, 0xEC, -+0xB0, 0x67, 0x80, 0x18, 0x38, 0x11, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xE8, 0xF2, 0x56, 0xA2, 0x0C, 0x2A, 0x01, 0x6C, -+0x00, 0x6D, 0x80, 0x18, 0x35, 0x13, 0x02, 0x6C, -+0x00, 0x6D, 0x80, 0x18, 0x35, 0x13, 0x03, 0x6C, -+0x00, 0x6D, 0x80, 0x18, 0x35, 0x13, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x00, 0x68, 0x09, 0xD5, -+0x24, 0x67, 0x09, 0x93, 0x00, 0x6C, 0x09, 0xE3, -+0xA0, 0xA2, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, -+0xD0, 0x9A, 0x01, 0x48, 0x00, 0x18, 0x2F, 0xE7, -+0x05, 0x70, 0x40, 0xD9, 0x04, 0x49, 0xF1, 0x61, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x0C, 0xD6, 0xFF, 0x68, 0xBC, 0xF0, 0xD0, 0x9A, -+0xFF, 0xF7, 0x1F, 0x69, 0x0C, 0x97, 0x8C, 0xE8, -+0xAC, 0xE9, 0x90, 0x67, 0xB1, 0x67, 0x00, 0x18, -+0x42, 0xE7, 0x00, 0x6A, 0x04, 0xD2, 0x10, 0xF0, -+0x24, 0x6B, 0xBC, 0xF0, 0x10, 0x4B, 0xC0, 0x9B, -+0x90, 0x67, 0xB1, 0x67, 0x00, 0x18, 0x2F, 0xE7, -+0x0C, 0x93, 0x6E, 0xEA, 0x16, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, -+0x10, 0x4A, 0xC0, 0x9A, 0x0C, 0x97, 0x90, 0x67, -+0xB1, 0x67, 0x00, 0x18, 0x42, 0xE7, 0x04, 0x93, -+0x01, 0x4B, 0xE0, 0xF3, 0x08, 0x73, 0x04, 0xD3, -+0xDE, 0x61, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xFF, 0x6A, 0x24, 0x67, 0xEF, 0xF4, 0x08, 0x48, -+0x4C, 0xED, 0x4C, 0xE9, 0x60, 0xF6, 0x54, 0xA0, -+0x04, 0xD5, 0x60, 0x22, 0x06, 0x25, 0x12, 0x6A, -+0x40, 0xF6, 0x59, 0xC0, 0x02, 0x6A, 0x40, 0xF6, -+0x5C, 0xD8, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0x7C, 0xF0, 0x74, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x24, 0x36, 0x01, 0x6D, 0x6D, 0xEE, -+0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF0, 0xA4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x23, 0xF3, 0x08, 0x6C, -+0x80, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x21, 0x6B, -+0x50, 0xF3, 0xC1, 0xA3, 0xCE, 0xF4, 0x50, 0x98, -+0xC3, 0xF3, 0x0C, 0x6C, 0xFF, 0x6D, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x3C, 0xF1, 0xC4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0x03, 0xF3, -+0x18, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xBC, 0xF0, 0xC8, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0x23, 0xF3, 0x00, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xDC, 0xF0, 0xCC, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x23, 0xF3, 0x04, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, -+0xD4, 0x9A, 0x91, 0x67, 0x78, 0x6D, 0x80, 0x18, -+0x8F, 0x13, 0x91, 0x67, 0x5C, 0x6D, 0x20, 0xF3, -+0x00, 0x6E, 0x80, 0x18, 0x8F, 0x13, 0x10, 0xF0, -+0x24, 0x6A, 0x91, 0x67, 0x8F, 0x6D, 0xBC, 0xF0, -+0xD8, 0x9A, 0xB2, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x7C, 0xF0, 0x74, 0x9B, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0x24, 0x36, 0x01, 0x6D, -+0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, 0x6D, 0xEE, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF0, -+0x54, 0xA2, 0x03, 0x22, 0x01, 0x72, 0x4B, 0x60, -+0x9D, 0x10, 0x04, 0x92, 0x06, 0x22, 0x12, 0x6A, -+0x40, 0xF6, 0x59, 0xC0, 0x02, 0x6A, 0x40, 0xF6, -+0x5C, 0xD8, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0xEF, 0xF4, 0x08, 0x4B, 0x40, 0xF6, -+0xD9, 0xA3, 0xCE, 0xF4, 0x50, 0x98, 0x04, 0xD3, -+0xC3, 0xF3, 0x0C, 0x6C, 0xFF, 0x6D, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF0, 0xA4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x23, 0xF3, 0x08, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF0, 0xC8, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x23, 0xF3, 0x00, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x04, 0x94, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF2, 0x14, 0x4A, 0x40, 0xF6, 0x7C, 0x9C, -+0x01, 0x6D, 0x23, 0xF3, 0x04, 0x6C, 0x49, 0xE3, -+0xC0, 0xA2, 0x10, 0xF0, 0x24, 0x6B, 0x3C, 0xF1, -+0x68, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0xC0, 0x36, -+0xC8, 0x36, 0xAB, 0xED, 0x6D, 0xEE, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x91, 0x67, 0x56, 0x6D, -+0xDC, 0xF0, 0xC0, 0x9A, 0x49, 0x10, 0x04, 0x92, -+0x06, 0x22, 0x1B, 0x6A, 0x40, 0xF6, 0x59, 0xC0, -+0x02, 0x6A, 0x40, 0xF6, 0x5C, 0xD8, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0xEF, 0xF4, -+0x08, 0x4B, 0x40, 0xF6, 0xD9, 0xA3, 0xCE, 0xF4, -+0x50, 0x98, 0x04, 0xD3, 0xC3, 0xF3, 0x0C, 0x6C, -+0xFF, 0x6D, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF0, 0xA4, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x23, 0xF3, 0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xDC, 0xF0, 0xC8, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, 0x23, 0xF3, -+0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x04, 0x94, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF2, 0x1C, 0x4A, -+0x40, 0xF6, 0x7C, 0x9C, 0x01, 0x6D, 0x23, 0xF3, -+0x04, 0x6C, 0x49, 0xE3, 0xC0, 0xA2, 0x10, 0xF0, -+0x24, 0x6B, 0x3C, 0xF1, 0x68, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0xC0, 0x36, 0xC8, 0x36, 0xAB, 0xED, -+0x6D, 0xEE, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x3C, 0xF1, 0xCC, 0x9A, 0x91, 0x67, 0x56, 0x6D, -+0x80, 0x18, 0x8F, 0x13, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF0, 0xC4, 0x9A, 0x91, 0x67, 0x8F, 0x6D, -+0x80, 0x18, 0x8F, 0x13, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0x30, 0x9A, -+0x08, 0xD4, 0x00, 0x6C, 0x05, 0x67, 0xD1, 0x67, -+0xE4, 0x67, 0xEF, 0x6D, 0x00, 0x18, 0x42, 0xE7, -+0x00, 0x6C, 0xE4, 0x67, 0xD1, 0x67, 0xEE, 0x6D, -+0x00, 0x18, 0x42, 0xE7, 0xC0, 0x98, 0x11, 0x6A, -+0x4B, 0xEA, 0x4C, 0xEE, 0x00, 0x6C, 0xDF, 0x6D, -+0x80, 0x18, 0x8F, 0x13, 0xC1, 0x98, 0x11, 0x6A, -+0x4B, 0xEA, 0x4C, 0xEE, 0x00, 0x6C, 0xDE, 0x6D, -+0x80, 0x18, 0x8F, 0x13, 0x08, 0x92, 0xE2, 0x98, -+0xD1, 0x67, 0xA2, 0xA2, 0x00, 0x6C, 0x00, 0x18, -+0x42, 0xE7, 0x08, 0x92, 0xE3, 0x98, 0xD1, 0x67, -+0xA3, 0xA2, 0x00, 0x6C, 0x00, 0x18, 0x42, 0xE7, -+0x44, 0x98, 0x02, 0x6F, 0xEB, 0xEF, 0xD1, 0x67, -+0x4C, 0xEF, 0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, -+0x42, 0xE7, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x30, 0xF0, 0x20, 0x68, 0x7C, 0xF0, 0xD4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x69, 0x2B, 0xE9, -+0x03, 0xF3, 0x00, 0x6C, 0xB1, 0x67, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xA3, 0xF3, 0x18, 0x6C, -+0xB1, 0x67, 0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF0, 0x10, 0x9A, 0x00, 0x6C, -+0xDF, 0x6D, 0xD0, 0x67, 0x00, 0x18, 0x2F, 0xE7, -+0x01, 0xF0, 0x13, 0x6B, 0x6B, 0xEB, 0x4C, 0xEB, -+0x01, 0xF0, 0x02, 0x6E, 0x00, 0x6C, 0xDF, 0x6D, -+0x6D, 0xEE, 0x80, 0x18, 0x8F, 0x13, 0x30, 0xF0, -+0x21, 0x6A, 0x50, 0xF3, 0x5C, 0xA2, 0x10, 0x22, -+0x00, 0x6C, 0xDE, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x2F, 0xE7, 0x10, 0xF0, 0x11, 0x6B, 0x6B, 0xEB, -+0x4C, 0xEB, 0x10, 0xF0, 0x00, 0x6E, 0x00, 0x6C, -+0xDE, 0x6D, 0x6D, 0xEE, 0x80, 0x18, 0x8F, 0x13, -+0x30, 0xF0, 0x21, 0x6A, 0x50, 0xF3, 0x5C, 0xA2, -+0x5C, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, -+0x0C, 0x9A, 0x00, 0x6C, 0xEF, 0x6D, 0xD0, 0x67, -+0x80, 0x18, 0x8F, 0x13, 0x00, 0x6C, 0x33, 0x6D, -+0x24, 0x6E, 0x80, 0x18, 0x8F, 0x13, 0x00, 0x6C, -+0x3E, 0x6D, 0x3F, 0x6E, 0x80, 0x18, 0x8F, 0x13, -+0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF1, 0xD0, 0x9A, -+0x00, 0x6C, 0x3F, 0x6D, 0x80, 0x18, 0x8F, 0x13, -+0x00, 0x6C, 0xEF, 0x6D, 0xC4, 0x67, 0x80, 0x18, -+0x8F, 0x13, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF0, -+0x54, 0xA2, 0x01, 0x72, 0x17, 0x61, 0x01, 0x6F, -+0x00, 0x6C, 0xEF, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x42, 0xE7, 0x00, 0x6C, 0x33, 0x6D, 0x26, 0x6E, -+0x80, 0x18, 0x8F, 0x13, 0x00, 0x6C, 0x3E, 0x6D, -+0x37, 0x6E, 0x80, 0x18, 0x8F, 0x13, 0x10, 0xF0, -+0x24, 0x6A, 0x00, 0x6C, 0x3F, 0x6D, 0x3C, 0xF1, -+0xD4, 0x9A, 0x16, 0x10, 0x01, 0x6F, 0x00, 0x6C, -+0xEF, 0x6D, 0xD0, 0x67, 0x00, 0x18, 0x42, 0xE7, -+0x00, 0x6C, 0x33, 0x6D, 0x26, 0x6E, 0x80, 0x18, -+0x8F, 0x13, 0x00, 0x6C, 0x3E, 0x6D, 0x37, 0x6E, -+0x80, 0x18, 0x8F, 0x13, 0x10, 0xF0, 0x24, 0x6A, -+0x3C, 0xF1, 0xD8, 0x9A, 0x00, 0x6C, 0x3F, 0x6D, -+0x80, 0x18, 0x8F, 0x13, 0x00, 0x6C, 0xEF, 0x6D, -+0xD0, 0x67, 0xE4, 0x67, 0x00, 0x18, 0x42, 0xE7, -+0x16, 0x10, 0x00, 0x6C, 0xEE, 0x6D, 0x02, 0xF0, -+0x00, 0x6E, 0x80, 0x18, 0x8F, 0x13, 0x00, 0x6C, -+0x33, 0x6D, 0x04, 0x6E, 0x80, 0x18, 0x8F, 0x13, -+0x00, 0x6C, 0x3F, 0x6D, 0xC3, 0xF6, 0x01, 0x6E, -+0x80, 0x18, 0x8F, 0x13, 0x00, 0x6C, 0xEE, 0x6D, -+0xC4, 0x67, 0x80, 0x18, 0x8F, 0x13, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x68, 0xFF, 0xF7, 0x1F, 0x69, 0x8C, 0xE8, -+0xAC, 0xE9, 0x90, 0x67, 0xB1, 0x67, 0x0C, 0xD6, -+0x0D, 0xD7, 0x00, 0x18, 0x42, 0xE7, 0x00, 0x6A, -+0x04, 0xD2, 0x0C, 0x96, 0x90, 0x67, 0xB1, 0x67, -+0x00, 0x18, 0x2F, 0xE7, 0x0D, 0x93, 0x6E, 0xEA, -+0x12, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, 0x0C, 0x96, -+0x0D, 0x97, 0x90, 0x67, 0xB1, 0x67, 0x00, 0x18, -+0x42, 0xE7, 0x04, 0x92, 0x01, 0x4A, 0xE0, 0xF3, -+0x08, 0x72, 0x04, 0xD2, 0xE6, 0x61, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x24, 0x67, 0x4C, 0xED, 0x4C, 0xE9, -+0x30, 0xF0, 0x21, 0x6A, 0x50, 0xF3, 0x5C, 0xA2, -+0x04, 0xD5, 0x56, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x68, 0x7C, 0xF0, 0x54, 0x9A, -+0xCE, 0xF4, 0x70, 0x98, 0x24, 0x36, 0x01, 0x6D, -+0x4D, 0xEE, 0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, -+0x40, 0xEB, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0xC3, 0xF3, 0x0C, 0x6C, 0xAB, 0xED, 0x1B, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF0, -+0x04, 0x4B, 0xCE, 0xF4, 0x50, 0x98, 0xA0, 0x9B, -+0x23, 0xF3, 0x00, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF0, 0x04, 0x4B, -+0xCE, 0xF4, 0x50, 0x98, 0xA0, 0x9B, 0x23, 0xF3, -+0x08, 0x6C, 0x80, 0x6E, 0x40, 0xEA, 0x04, 0x93, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0x10, 0x9A, -+0x60, 0x32, 0x10, 0xF0, 0x24, 0x6B, 0x3C, 0xF1, -+0x7C, 0x9B, 0x58, 0x32, 0x91, 0x67, 0x6D, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xDC, 0xF0, 0xF4, 0x9B, -+0x78, 0x6D, 0xD0, 0x67, 0x4C, 0xEF, 0x00, 0x18, -+0x42, 0xE7, 0x91, 0x67, 0x5C, 0x6D, 0xD0, 0x67, -+0x2A, 0xF3, 0x00, 0x6F, 0x00, 0x18, 0x42, 0xE7, -+0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF0, 0xF8, 0x9A, -+0x91, 0x67, 0x8F, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0x42, 0xE7, 0x00, 0x6C, 0xEE, 0x6D, 0x55, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x68, -+0x7C, 0xF0, 0x54, 0x9A, 0xCE, 0xF4, 0x70, 0x98, -+0x24, 0x36, 0x01, 0x6D, 0x4D, 0xEE, 0x03, 0xF3, -+0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEB, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x6D, 0xC3, 0xF3, 0x0C, 0x6C, -+0xAB, 0xED, 0x09, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0xBC, 0xF0, 0x04, 0x4B, 0xCE, 0xF4, -+0x50, 0x98, 0xA0, 0x9B, 0x23, 0xF3, 0x00, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF0, 0x54, 0xA2, 0x03, 0x22, 0x01, 0x72, -+0x35, 0x60, 0x69, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF0, 0x04, 0x4B, 0xCE, 0xF4, 0x50, 0x98, -+0xA0, 0x9B, 0x23, 0xF3, 0x08, 0x6C, 0x00, 0x6E, -+0x40, 0xEA, 0x04, 0x93, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF0, 0x10, 0x9A, 0x74, 0x32, 0x10, 0xF0, -+0x24, 0x6B, 0x5C, 0xF1, 0x60, 0x9B, 0x00, 0x6C, -+0x56, 0x6D, 0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x5C, 0xF1, 0xE4, 0x9B, 0xD0, 0x67, 0x4C, 0xEF, -+0x00, 0x18, 0x42, 0xE7, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF0, 0xE4, 0x9A, 0x00, 0x6C, 0x8F, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x42, 0xE7, 0x00, 0x6C, -+0xEF, 0x6D, 0x10, 0x6E, 0x01, 0x6F, 0x80, 0x18, -+0xC2, 0x14, 0x00, 0x6C, 0x33, 0x6D, 0x08, 0x6E, -+0xE4, 0x67, 0x33, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF0, 0x04, 0x4B, 0xCE, 0xF4, 0x50, 0x98, -+0xA0, 0x9B, 0x23, 0xF3, 0x08, 0x6C, 0x00, 0x6E, -+0x40, 0xEA, 0x04, 0x93, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF0, 0x10, 0x9A, 0x74, 0x32, 0x10, 0xF0, -+0x24, 0x6B, 0x5C, 0xF1, 0x60, 0x9B, 0x00, 0x6C, -+0x56, 0x6D, 0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x5C, 0xF1, 0xE8, 0x9B, 0xD0, 0x67, 0x4C, 0xEF, -+0x00, 0x18, 0x42, 0xE7, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF0, 0xE4, 0x9A, 0x00, 0x6C, 0x8F, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x42, 0xE7, 0x00, 0x6C, -+0xEF, 0x6D, 0x10, 0x6E, 0x01, 0x6F, 0x80, 0x18, -+0xC2, 0x14, 0x00, 0x6C, 0x33, 0x6D, 0x08, 0x6E, -+0x01, 0x6F, 0x00, 0x18, 0x42, 0xE7, 0x04, 0x97, -+0x91, 0x67, 0x33, 0x6D, 0x07, 0x6E, 0x00, 0x18, -+0x42, 0xE7, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x00, 0x6A, 0x7D, 0x67, -+0x4C, 0xCB, 0x2E, 0xF5, 0x10, 0x6A, 0xFF, 0x68, -+0x04, 0xD2, 0x06, 0x02, 0x0C, 0xEC, 0x05, 0xD2, -+0x10, 0xF0, 0x24, 0x6A, 0x08, 0xD4, 0xBC, 0xF0, -+0xD0, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x08, 0x94, -+0x5C, 0xF1, 0xEC, 0x9A, 0x0C, 0xED, 0x09, 0xD5, -+0x08, 0x6D, 0x00, 0x18, 0x5C, 0xE7, 0x0E, 0x22, -+0x09, 0x92, 0x00, 0x69, 0x12, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF0, 0xB8, 0x9A, 0x03, 0xF3, -+0x08, 0x6C, 0x00, 0x18, 0xE4, 0xE6, 0x22, 0x67, -+0x0C, 0xE9, 0x07, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0xBC, 0xF5, 0x04, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x01, 0x69, 0x08, 0x94, 0x80, 0x18, 0x01, 0x13, -+0x7D, 0x67, 0xAC, 0xAB, 0x10, 0xF0, 0x24, 0x6C, -+0xBC, 0xF5, 0x1C, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x51, 0x67, 0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, -+0x07, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0x6A, 0x24, 0x67, -+0x4C, 0xED, 0x4C, 0xE9, 0x05, 0xD5, 0x06, 0x2D, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF0, 0x15, 0xA2, -+0x04, 0x48, 0x22, 0x10, 0x05, 0x92, 0x01, 0x72, -+0x16, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF0, -+0x55, 0xA2, 0x02, 0x72, 0x08, 0x61, 0x44, 0x41, -+0x01, 0x68, 0x04, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF1, 0x50, 0x9A, 0x1A, 0x10, 0x44, 0x41, -+0x01, 0x68, 0x04, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x5C, 0xF1, 0x54, 0x9A, 0x12, 0x10, 0x05, 0x93, -+0x00, 0x68, 0x02, 0x73, 0x0F, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF0, 0x15, 0xA2, 0x09, 0x48, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF0, 0x54, 0x9A, -+0x00, 0x30, 0x64, 0x41, 0x4D, 0xE8, 0x01, 0x6A, -+0x44, 0xEB, 0x4D, 0xE8, 0x80, 0x18, 0x82, 0x10, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x50, 0x9C, -+0x01, 0x6D, 0xD0, 0x67, 0x03, 0xF3, 0x00, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x01, 0x6D, 0xC1, 0x40, -+0xAB, 0xED, 0x03, 0xF3, 0x00, 0x6C, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x58, 0x9A, -+0x02, 0x6C, 0x30, 0xF0, 0x20, 0x68, 0x40, 0xEA, -+0x91, 0x67, 0x01, 0x6D, 0x80, 0x18, 0x5B, 0x15, -+0x04, 0xD2, 0xEF, 0xF4, 0x08, 0x48, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF3, 0x48, 0x9A, 0x60, 0xF6, -+0xB8, 0x98, 0x38, 0x6C, 0x40, 0xEA, 0x24, 0x34, -+0x30, 0xF0, 0x20, 0x6A, 0x06, 0xD4, 0xCE, 0xF4, -+0x70, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF0, -+0xD4, 0x9A, 0x06, 0x92, 0x01, 0x6D, 0x03, 0xF3, -+0x00, 0x6C, 0xAB, 0xED, 0x4D, 0xEE, 0x40, 0xEB, -+0x05, 0x93, 0x16, 0x2B, 0x04, 0x94, 0x0F, 0x24, -+0x06, 0x94, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF2, -+0x0C, 0x4A, 0x4D, 0xE4, 0x30, 0xF0, 0x20, 0x6C, -+0xCE, 0xF4, 0x50, 0x9C, 0x80, 0xAB, 0x01, 0x6D, -+0x00, 0x6E, 0x40, 0xEA, 0x7C, 0x10, 0x02, 0x6C, -+0xB1, 0x67, 0x80, 0x18, 0x35, 0x13, 0x77, 0x10, -+0x05, 0x92, 0x02, 0x72, 0x62, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF0, 0xD0, 0x9A, 0x91, 0x67, -+0x00, 0x6D, 0x00, 0x18, 0x2F, 0xE7, 0x56, 0x32, -+0xFF, 0x6C, 0x8C, 0xEA, 0x40, 0xF6, 0x99, 0xA0, -+0x30, 0xF3, 0x60, 0x41, 0x64, 0x33, 0x80, 0x34, -+0x8D, 0xEA, 0x0D, 0xE3, 0x41, 0xCB, 0x30, 0xF0, -+0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, -+0x24, 0x6B, 0xFB, 0xF6, 0xCC, 0x9B, 0x01, 0x6D, -+0x23, 0xF3, 0x18, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x04, 0x94, 0x10, 0x24, 0x06, 0x94, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF2, 0x0C, 0x4A, 0x4D, 0xE4, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x50, 0x9C, -+0x80, 0xAB, 0x01, 0xF4, 0x00, 0x6D, 0x00, 0x6E, -+0x40, 0xEA, 0x2F, 0x10, 0x03, 0x6C, 0xB1, 0x67, -+0x80, 0x18, 0x35, 0x13, 0x2A, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF2, 0x0C, 0x4A, 0x24, 0x33, -+0x4D, 0xE3, 0x01, 0x6D, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0x80, 0xAB, 0xC5, 0x67, -+0x0D, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF2, -+0x0C, 0x4A, 0x24, 0x33, 0x4D, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x80, 0xAB, -+0x01, 0x6D, 0x00, 0x6E, 0x40, 0xEA, 0x7D, 0x67, -+0x87, 0x43, 0x09, 0x4C, 0x30, 0xF0, 0x20, 0x6A, -+0x43, 0xF7, 0x14, 0x49, 0x60, 0xA4, 0x24, 0x31, -+0xC0, 0xF1, 0x08, 0x4A, 0x49, 0xE1, 0x6A, 0xC2, -+0x0C, 0x10, 0x7D, 0x67, 0x87, 0x43, 0x09, 0x4C, -+0x30, 0xF0, 0x20, 0x6A, 0x60, 0xA4, 0x24, 0x31, -+0xC0, 0xF1, 0x08, 0x4A, 0x49, 0xE1, 0xA7, 0xF6, -+0x73, 0xC2, 0x04, 0x92, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, 0x04, 0x94, -+0xC2, 0x24, 0xCF, 0x17, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x69, 0x8C, 0xE9, -+0x44, 0x41, 0x01, 0x68, 0x04, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF0, 0x54, 0x9A, 0x4D, 0xE8, -+0x80, 0x18, 0x82, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x01, 0x6D, 0xD0, 0x67, -+0x03, 0xF3, 0x00, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x01, 0x6D, 0xC1, 0x40, 0xAB, 0xED, 0x03, 0xF3, -+0x00, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x58, 0x9A, 0x01, 0x6C, 0x40, 0xEA, -+0x91, 0x67, 0x00, 0x6D, 0x80, 0x18, 0x5B, 0x15, -+0x02, 0x67, 0x30, 0xF0, 0x21, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0x70, 0xF3, 0xA0, 0x9B, 0xEE, 0xF3, -+0x48, 0x9A, 0x38, 0x6C, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6C, 0xDC, 0xF5, 0x14, 0x4C, 0x00, 0x6D, -+0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x45, 0xE1, 0x00, 0x6C, -+0xA7, 0xF6, 0x06, 0xC1, 0xE4, 0x67, 0xEF, 0x6D, -+0x10, 0x6E, 0x00, 0x18, 0x42, 0xE7, 0x50, 0x67, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x4C, 0xED, 0x30, 0xF0, 0x21, 0x6A, 0x50, 0xF3, -+0x41, 0xA2, 0x04, 0xD4, 0x06, 0xD5, 0x09, 0x72, -+0x00, 0x68, 0x0C, 0x60, 0x12, 0x72, 0x01, 0x68, -+0x09, 0x60, 0x1B, 0x72, 0x02, 0x68, 0x06, 0x60, -+0x24, 0x68, 0x4E, 0xE8, 0x01, 0x58, 0x18, 0x67, -+0x04, 0x6A, 0x03, 0xE2, 0x04, 0x92, 0x30, 0xF0, -+0x20, 0x69, 0xCE, 0xF4, 0x70, 0x99, 0x44, 0x36, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF0, 0x54, 0x9A, -+0x01, 0x6D, 0x03, 0xF3, 0x00, 0x6C, 0x4D, 0xEE, -+0xAB, 0xED, 0x40, 0xEB, 0x30, 0xF0, 0x21, 0x6B, -+0x50, 0xF3, 0xC1, 0xA3, 0xCE, 0xF4, 0x50, 0x99, -+0x01, 0x6D, 0xC3, 0xF3, 0x0C, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x06, 0x93, 0x01, 0x73, 0x09, 0x61, -+0x04, 0x92, 0x01, 0x69, 0x04, 0x4A, 0x24, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF1, 0x58, 0x9A, -+0x08, 0x10, 0x04, 0x92, 0x01, 0x69, 0x04, 0x4A, -+0x24, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF1, -+0x5C, 0x9A, 0x4D, 0xE9, 0x80, 0x18, 0x82, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x01, 0x6D, 0xD1, 0x67, 0x03, 0xF3, 0x00, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x01, 0x6D, 0xC1, 0x41, -+0xAB, 0xED, 0x03, 0xF3, 0x00, 0x6C, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x58, 0x9A, -+0x02, 0x6C, 0x30, 0xF0, 0x20, 0x69, 0x40, 0xEA, -+0x04, 0x94, 0x01, 0x6D, 0xEF, 0xF4, 0x08, 0x49, -+0x80, 0x18, 0x5B, 0x15, 0x05, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF3, 0x48, 0x9A, 0x60, 0xF6, -+0xB8, 0x99, 0x38, 0x6C, 0x40, 0xEA, 0x06, 0x92, -+0x02, 0x72, 0x80, 0xF0, 0x02, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x04, 0x94, 0xBC, 0xF0, 0xD0, 0x9A, -+0x00, 0x6D, 0x00, 0x18, 0x2F, 0xE7, 0xE3, 0xF7, -+0x00, 0x6B, 0x4C, 0xEB, 0x76, 0x32, 0x1F, 0x6B, -+0x6C, 0xEA, 0x02, 0x5A, 0x0D, 0x60, 0x40, 0xF6, -+0x7C, 0x99, 0x02, 0x23, 0xFF, 0x4B, 0x15, 0x10, -+0x03, 0x70, 0x01, 0x48, 0x0A, 0x61, 0x01, 0x6B, -+0x60, 0xF6, 0x72, 0xC1, 0x03, 0x68, 0x13, 0x10, -+0x0A, 0x5A, 0x00, 0x6C, 0x11, 0x61, 0x04, 0x20, -+0xFF, 0x48, 0xFF, 0x6B, 0x6C, 0xE8, 0x0B, 0x10, -+0x40, 0xF6, 0x7C, 0x99, 0x04, 0x73, 0x04, 0x60, -+0x01, 0x4B, 0x40, 0xF6, 0x7C, 0xD9, 0x03, 0x10, -+0x01, 0x6B, 0x60, 0xF6, 0x72, 0xC1, 0x01, 0x6C, -+0x10, 0xF0, 0x24, 0x6D, 0x5B, 0xF2, 0x04, 0x4D, -+0xB5, 0xE0, 0xA0, 0xA5, 0x30, 0xF0, 0x20, 0x6B, -+0xEF, 0xF4, 0x08, 0x4B, 0x03, 0x70, 0x40, 0xF6, -+0xB9, 0xC3, 0x0D, 0x61, 0x01, 0x72, 0x0B, 0x61, -+0x40, 0xF6, 0x5C, 0x9B, 0x08, 0x2A, 0x01, 0x6D, -+0x60, 0xF6, 0xB3, 0xC3, 0x60, 0xF6, 0xB2, 0xC3, -+0x1B, 0x6D, 0x40, 0xF6, 0xB9, 0xC3, 0x30, 0xF0, -+0x20, 0x68, 0xEF, 0xF4, 0x08, 0x48, 0x60, 0xF6, -+0x52, 0xA0, 0x01, 0x72, 0x2C, 0x60, 0x2B, 0x24, -+0x04, 0x93, 0x30, 0xF0, 0x20, 0x69, 0xCE, 0xF4, -+0x50, 0x99, 0x64, 0x36, 0x10, 0xF0, 0x24, 0x6B, -+0x7C, 0xF0, 0x74, 0x9B, 0x01, 0x6D, 0x03, 0xF3, -+0x00, 0x6C, 0x6D, 0xEE, 0xAB, 0xED, 0x40, 0xEA, -+0xCE, 0xF4, 0x30, 0x99, 0x01, 0x6D, 0xAB, 0xED, -+0x04, 0xD1, 0x23, 0xF3, 0x04, 0x69, 0x91, 0x67, -+0x00, 0x18, 0xE4, 0xE6, 0x40, 0xF6, 0xDC, 0x98, -+0x07, 0xF4, 0x01, 0x6B, 0x6B, 0xEB, 0x4C, 0xEB, -+0xC0, 0x36, 0x04, 0x92, 0xC8, 0x36, 0x01, 0x6D, -+0x6D, 0xEE, 0x91, 0x67, 0xAB, 0xED, 0x40, 0xEA, -+0x01, 0x6B, 0x05, 0xD3, 0x02, 0x10, 0x00, 0x6A, -+0x05, 0xD2, 0x05, 0x92, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x04, 0xD2, 0x40, 0xF6, 0x58, 0xA2, 0x02, 0x68, -+0xFF, 0x69, 0x4E, 0xE8, 0x8C, 0xE9, 0x24, 0x20, -+0x03, 0x5A, 0x03, 0x60, 0x01, 0x72, 0x07, 0x60, -+0x04, 0x10, 0x03, 0x72, 0x37, 0x60, 0x04, 0x72, -+0x50, 0x60, 0x01, 0x6A, 0x76, 0x10, 0x91, 0x67, -+0x80, 0x18, 0xBF, 0x11, 0x91, 0x67, 0x01, 0x6D, -+0x80, 0x18, 0x2D, 0x16, 0x65, 0x22, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF3, 0x84, 0x41, 0x84, 0x34, -+0xEF, 0xF4, 0x08, 0x4B, 0x71, 0xE4, 0xA4, 0xA4, -+0x02, 0x5D, 0x03, 0x60, 0x01, 0x4D, 0xA4, 0xC4, -+0xED, 0x17, 0x65, 0xE1, 0x00, 0x6C, 0x50, 0x10, -+0x91, 0x67, 0x01, 0x6D, 0x80, 0x18, 0xAD, 0x13, -+0x04, 0x93, 0x60, 0xF6, 0x12, 0xC3, 0x91, 0x67, -+0x02, 0x6D, 0x80, 0x18, 0x2D, 0x16, 0x48, 0x22, -+0x30, 0xF0, 0x20, 0x6B, 0x24, 0x34, 0xEF, 0xF4, -+0x08, 0x4B, 0x6D, 0xE4, 0x60, 0xF6, 0x8D, 0xA3, -+0x0A, 0x5C, 0x3E, 0x60, 0x01, 0x4C, 0x60, 0xF6, -+0x8D, 0xC3, 0xED, 0x17, 0x91, 0x67, 0x80, 0x18, -+0xBF, 0x11, 0x91, 0x67, 0x01, 0x6D, 0x80, 0x18, -+0x7D, 0x15, 0x32, 0x22, 0x03, 0x6C, 0x98, 0xE9, -+0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, -+0x12, 0xEC, 0x71, 0xE4, 0x60, 0xF6, 0xA7, 0xA4, -+0x02, 0x5D, 0x04, 0x60, 0x01, 0x4D, 0x60, 0xF6, -+0xA7, 0xC4, 0xEB, 0x17, 0x65, 0xE1, 0x01, 0x6C, -+0x1B, 0x10, 0x91, 0x67, 0x00, 0x6D, 0x80, 0x18, -+0xAD, 0x13, 0x91, 0x67, 0x02, 0x6D, 0x80, 0x18, -+0x7D, 0x15, 0x16, 0x22, 0x03, 0x6C, 0x98, 0xE9, -+0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, -+0x12, 0xEC, 0x71, 0xE4, 0x60, 0xF6, 0xA8, 0xA4, -+0x02, 0x5D, 0x04, 0x60, 0x01, 0x4D, 0x60, 0xF6, -+0xA8, 0xC4, 0xEB, 0x17, 0x65, 0xE1, 0x02, 0x6C, -+0x60, 0xF6, 0x90, 0xC1, 0x05, 0x6C, 0x07, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, -+0x40, 0xF6, 0x98, 0xA3, 0x01, 0x4C, 0x40, 0xF6, -+0x98, 0xC3, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0xFF, 0x69, 0x87, 0xF6, -+0xB4, 0xA0, 0x8C, 0xE9, 0x10, 0xF0, 0x24, 0x6C, -+0xFC, 0xF5, 0x08, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x87, 0xF6, 0x4D, 0xA0, 0x02, 0x72, 0x02, 0x6A, -+0x04, 0xD2, 0x02, 0x60, 0x04, 0x6B, 0x04, 0xD3, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF0, 0xBC, 0xA2, -+0x10, 0xF0, 0x24, 0x6C, 0xFC, 0xF5, 0x08, 0x4C, -+0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x87, 0xF6, 0x54, 0xA0, -+0x02, 0x72, 0x10, 0x60, 0x03, 0x72, 0x31, 0x60, -+0x01, 0x72, 0x00, 0x68, 0x4A, 0x61, 0xB0, 0x67, -+0x00, 0x6C, 0x80, 0x18, 0xDA, 0x14, 0x01, 0x48, -+0x00, 0x6C, 0x80, 0x18, 0x03, 0x16, 0x08, 0x70, -+0xF6, 0x61, 0x19, 0x10, 0x00, 0x6C, 0x80, 0x18, -+0x2E, 0x12, 0x00, 0x6C, 0xA4, 0x67, 0x80, 0x18, -+0x7D, 0x15, 0x87, 0xF6, 0x75, 0xA0, 0x01, 0x4B, -+0x87, 0xF6, 0x75, 0xC0, 0x0C, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x60, 0xF6, -+0x66, 0xA2, 0x03, 0x5B, 0x04, 0x60, 0x01, 0x4B, -+0x60, 0xF6, 0x66, 0xC2, 0x26, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x87, 0xF6, -+0x74, 0xA2, 0x01, 0x4B, 0x87, 0xF6, 0x74, 0xC2, -+0x1C, 0x10, 0x00, 0x6C, 0x80, 0x18, 0xB0, 0x16, -+0x30, 0xF0, 0x20, 0x6B, 0xEF, 0xF4, 0x08, 0x4B, -+0x40, 0xF6, 0x58, 0xA3, 0x05, 0x72, 0xF5, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x87, 0xF6, 0x94, 0xA2, 0x01, 0x4C, 0x87, 0xF6, -+0x94, 0xC2, 0x01, 0x6C, 0x40, 0xF6, 0x98, 0xC3, -+0x87, 0xF6, 0x75, 0xA2, 0x01, 0x4B, 0x87, 0xF6, -+0x75, 0xC2, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x87, 0xF6, 0x54, 0xA0, 0x04, 0x72, -+0x6B, 0x61, 0xA7, 0xF6, 0xA6, 0xA0, 0x10, 0xF0, -+0x24, 0x6C, 0xFC, 0xF5, 0x1C, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0xA7, 0xF6, 0xB2, 0xA0, 0x10, 0xF0, -+0x24, 0x6C, 0x1C, 0xF6, 0x1C, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0xA7, 0xF6, 0xB3, 0xA0, 0x10, 0xF0, -+0x24, 0x6C, 0x30, 0xF0, 0x20, 0x68, 0xEF, 0xF4, -+0x08, 0x48, 0x3C, 0xF6, 0x18, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x60, 0xF6, 0xA6, 0xA0, 0x10, 0xF0, -+0x24, 0x6C, 0x5C, 0xF6, 0x14, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x60, 0xF6, 0xA7, 0xA0, 0x60, 0xF6, -+0xC8, 0xA0, 0x10, 0xF0, 0x24, 0x6C, 0x7C, 0xF6, -+0x14, 0x4C, 0x80, 0x18, 0x35, 0x19, 0x60, 0xF6, -+0xAD, 0xA0, 0x60, 0xF6, 0xCE, 0xA0, 0x10, 0xF0, -+0x24, 0x6C, 0xBC, 0xF6, 0x08, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x30, 0xF0, 0x20, 0x68, 0x10, 0xF0, -+0x24, 0x6B, 0x7C, 0xF1, 0xC0, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0x69, 0x2B, 0xE9, 0xB1, 0x67, -+0x03, 0xF3, 0x00, 0x6C, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0xB1, 0x67, 0x23, 0xF3, 0x0C, 0x6C, -+0x07, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0xC3, 0xF3, 0x0C, 0x6C, 0x00, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xFB, 0xF6, -+0x0C, 0x4B, 0xCE, 0xF4, 0x50, 0x98, 0xC0, 0x9B, -+0xB1, 0x67, 0x23, 0xF3, 0x18, 0x6C, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xFB, 0xF6, 0x0C, 0x4B, -+0xCE, 0xF4, 0x50, 0x98, 0xC0, 0x9B, 0x23, 0xF3, -+0x1C, 0x6C, 0xB1, 0x67, 0x40, 0xEA, 0x09, 0x10, -+0x01, 0x71, 0x3F, 0xF7, 0x13, 0x61, 0x87, 0xF6, -+0x55, 0xA0, 0x04, 0x93, 0x6E, 0xEA, 0x3F, 0xF7, -+0x0D, 0x2A, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x30, 0xF0, 0x20, 0x68, 0x7C, 0xF0, 0xD4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0xFF, 0x69, 0x01, 0x6D, -+0xAB, 0xED, 0x8C, 0xE9, 0x03, 0xF3, 0x00, 0x6C, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0xA3, 0xF3, 0x18, 0x6C, 0xAB, 0xED, 0x00, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x21, 0x6A, 0x50, 0xF3, -+0x5C, 0xA2, 0x11, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF0, 0x10, 0x9A, 0x00, 0x6C, 0x01, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0x2F, 0xE7, 0x2E, 0x6B, -+0x6B, 0xEB, 0x4C, 0xEB, 0x00, 0x6C, 0x01, 0x6D, -+0xD0, 0x67, 0x25, 0x6F, 0x10, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF0, 0x10, 0x9A, 0x00, 0x6C, -+0x01, 0x6D, 0xD0, 0x67, 0x00, 0x18, 0x2F, 0xE7, -+0x2E, 0x6B, 0x6B, 0xEB, 0x4C, 0xEB, 0x00, 0x6C, -+0x01, 0x6D, 0xD0, 0x67, 0x05, 0x6F, 0x6D, 0xEF, -+0x00, 0x18, 0x42, 0xE7, 0x91, 0x67, 0x80, 0x18, -+0xFB, 0x16, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xF2, 0x63, 0x1B, 0x62, -+0x1A, 0xD1, 0x19, 0xD0, 0x88, 0xA4, 0x02, 0x6A, -+0x30, 0xF0, 0x20, 0x68, 0x8C, 0xEA, 0x46, 0x32, -+0x16, 0xD4, 0x17, 0xD2, 0x80, 0x18, 0x7C, 0x11, -+0x80, 0x18, 0x1A, 0x13, 0x10, 0xF0, 0x24, 0x6A, -+0x5B, 0xF7, 0xA0, 0x9A, 0xA1, 0xF4, 0x18, 0x6C, -+0xEF, 0xF4, 0x08, 0x48, 0x00, 0x18, 0xE4, 0xE6, -+0x60, 0xF6, 0x54, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF3, 0x5C, 0x9A, 0x38, 0x6C, 0x01, 0x69, -+0x40, 0xEA, 0x16, 0x94, 0x00, 0x6D, 0x60, 0xF6, -+0x58, 0xD8, 0x2C, 0xEC, 0x00, 0x18, 0xAE, 0xD5, -+0x16, 0xD2, 0x72, 0x2A, 0x10, 0xF0, 0x24, 0x6C, -+0xDC, 0xF6, 0x1C, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x28, 0xF1, 0x6C, 0xA2, 0x9D, 0x67, 0x87, 0xF6, -+0x34, 0xC2, 0x01, 0x4B, 0x28, 0xF1, 0x6C, 0xC2, -+0x67, 0x44, 0x51, 0x4B, 0x80, 0xA3, 0x28, 0xF1, -+0x2E, 0xC2, 0x40, 0xF6, 0x38, 0xC0, 0x87, 0xF6, -+0x95, 0xC2, 0x00, 0x6C, 0xA4, 0x67, 0x80, 0x18, -+0x35, 0x13, 0x30, 0xF0, 0x20, 0x6E, 0x30, 0xF0, -+0x20, 0x6F, 0x04, 0x04, 0x0A, 0x05, 0x6F, 0xF0, -+0x0C, 0x4E, 0x6F, 0xF0, 0x14, 0x4F, 0x80, 0x18, -+0x1C, 0x11, 0x30, 0xF0, 0x20, 0x6D, 0x05, 0x04, -+0x8F, 0xF0, 0x0C, 0x4D, 0x80, 0x18, 0x81, 0x13, -+0x80, 0x18, 0xC8, 0x10, 0x01, 0x6C, 0x80, 0x18, -+0xBF, 0x12, 0x00, 0x6C, 0x80, 0x18, 0xF8, 0x10, -+0x80, 0x18, 0x8E, 0x10, 0x80, 0x18, 0x63, 0x14, -+0x17, 0x94, 0x80, 0x18, 0x79, 0x17, 0x00, 0x6C, -+0x80, 0x18, 0xBF, 0x12, 0x30, 0xF0, 0x20, 0x6E, -+0x30, 0xF0, 0x20, 0x6F, 0x04, 0x04, 0x0A, 0x05, -+0x6F, 0xF0, 0x0C, 0x4E, 0x6F, 0xF0, 0x14, 0x4F, -+0x80, 0x18, 0xAA, 0x10, 0x30, 0xF0, 0x20, 0x6C, -+0x8F, 0xF0, 0x0C, 0x4C, 0x05, 0x05, 0x80, 0x18, -+0x42, 0x14, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x87, 0xF6, 0x74, 0xA2, 0x04, 0x73, -+0x0A, 0x60, 0x00, 0x6B, 0x87, 0xF6, 0x75, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x58, 0x9A, -+0x32, 0x6C, 0x40, 0xEA, 0xC9, 0x17, 0x17, 0x92, -+0x04, 0x22, 0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, -+0x3D, 0xD5, 0x00, 0x6C, 0x00, 0x18, 0x08, 0xD5, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0xD0, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, 0xE4, 0x9A, -+0x00, 0x6C, 0x08, 0x6D, 0x00, 0x18, 0x42, 0xE7, -+0x1B, 0x97, 0x1A, 0x91, 0x19, 0x90, 0x00, 0x6A, -+0x0E, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x6A, 0x10, 0xF0, 0x24, 0x6B, 0x7C, 0xF1, -+0x68, 0x9B, 0x54, 0x34, 0x01, 0x4A, 0x71, 0xE4, -+0xA0, 0xA4, 0xF8, 0x6B, 0xAC, 0xEB, 0x60, 0xC4, -+0xFF, 0x6B, 0x6C, 0xEA, 0x80, 0x72, 0xF1, 0x61, -+0x80, 0x18, 0xCC, 0x0F, 0x80, 0x18, 0xD2, 0x0F, -+0x80, 0x18, 0xC0, 0x24, 0x80, 0x18, 0xD5, 0x1B, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0xD1, 0x08, 0xD0, 0x0A, 0xD4, -+0x44, 0x67, 0x82, 0x10, 0x25, 0x73, 0x04, 0x60, -+0x60, 0xA5, 0x60, 0xC2, 0x01, 0x4A, 0x7B, 0x10, -+0x61, 0x85, 0x62, 0x73, 0x7D, 0x67, 0x20, 0x61, -+0x62, 0x85, 0x78, 0x73, 0x03, 0x60, 0x58, 0x73, -+0x7D, 0x67, 0x1A, 0x61, 0x82, 0x85, 0x60, 0xA6, -+0x78, 0x6F, 0xEE, 0xEC, 0x10, 0xF0, 0x24, 0x6F, -+0x72, 0x30, 0xFC, 0xF6, 0x10, 0x4F, 0xE1, 0xE0, -+0x00, 0xA0, 0x01, 0x5C, 0x98, 0x67, 0x94, 0x34, -+0x8D, 0xE8, 0x3D, 0x67, 0x00, 0xC1, 0x0F, 0x68, -+0x6C, 0xE8, 0xFD, 0xE0, 0x60, 0xA7, 0x02, 0x4D, -+0x8D, 0xEB, 0x61, 0xC1, 0x00, 0xF0, 0x02, 0x03, -+0x81, 0x85, 0x77, 0x74, 0x26, 0x61, 0x82, 0x85, -+0x78, 0x74, 0x02, 0x60, 0x58, 0x74, 0x21, 0x61, -+0x80, 0xAE, 0x06, 0xD3, 0x07, 0xD4, 0x82, 0x85, -+0x78, 0x74, 0xF8, 0x67, 0x01, 0x5F, 0x18, 0x67, -+0x14, 0x30, 0x18, 0x65, 0x0C, 0x6C, 0x07, 0x97, -+0x0F, 0x68, 0x10, 0xF0, 0x24, 0x69, 0xE7, 0xEC, -+0x0C, 0xEF, 0xFC, 0xF6, 0x10, 0x49, 0x3D, 0xE7, -+0xE0, 0xA7, 0x06, 0x90, 0x38, 0x67, 0x2D, 0xEF, -+0xFC, 0x4C, 0xE0, 0xC0, 0x01, 0x48, 0xE4, 0x44, -+0x06, 0xD0, 0xED, 0x2F, 0x04, 0x4B, 0x02, 0x4D, -+0x25, 0x10, 0x81, 0x85, 0x78, 0x74, 0x02, 0x60, -+0x58, 0x74, 0x20, 0x61, 0x81, 0x85, 0x20, 0x9E, -+0x06, 0xD3, 0x78, 0x74, 0x98, 0x67, 0x01, 0x5C, -+0xF8, 0x67, 0xF4, 0x37, 0x07, 0xD1, 0x1F, 0x65, -+0x1C, 0x6C, 0x07, 0x97, 0x0F, 0x68, 0x10, 0xF0, -+0x24, 0x69, 0xE6, 0xEC, 0x0C, 0xEF, 0xFC, 0xF6, -+0x10, 0x49, 0x3D, 0xE7, 0xE0, 0xA7, 0x06, 0x91, -+0x18, 0x67, 0x0D, 0xEF, 0xFC, 0x4C, 0xE0, 0xC1, -+0x01, 0x49, 0xE4, 0x44, 0x06, 0xD1, 0xED, 0x2F, -+0x08, 0x4B, 0x01, 0x4D, 0x9D, 0x67, 0x04, 0x10, -+0xE0, 0xA4, 0x01, 0x4C, 0xE0, 0xC2, 0x01, 0x4A, -+0x63, 0xEC, 0xFA, 0x61, 0x04, 0x4E, 0x01, 0x4D, -+0x60, 0x85, 0x7F, 0xF7, 0x1B, 0x2B, 0x0A, 0x94, -+0x01, 0x24, 0x60, 0xC2, 0x0A, 0x97, 0x09, 0x91, -+0x08, 0x90, 0xEB, 0xE2, 0x05, 0x63, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0x01, 0x6B, 0xEF, 0xF4, -+0x08, 0x4A, 0x6B, 0xEB, 0x40, 0xF6, 0x70, 0xC2, -+0x40, 0xF6, 0x71, 0xC2, 0x40, 0xF6, 0x72, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD0, 0x60, 0xA4, 0x41, 0xA4, 0x82, 0xA4, -+0x00, 0xF0, 0x12, 0x06, 0x00, 0xF0, 0x1E, 0x07, -+0x00, 0x6D, 0xA0, 0xC6, 0x01, 0x4E, 0xA6, 0x67, -+0xEE, 0xED, 0xFA, 0x2D, 0x01, 0x6E, 0xE4, 0x67, -+0xCC, 0xEF, 0x1D, 0x27, 0x81, 0x5B, 0x1B, 0x61, -+0x81, 0x5A, 0x19, 0x61, 0x5D, 0x67, 0xD2, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x87, 0xF1, 0x68, 0x9A, 0x9D, 0x67, 0xDD, 0x67, -+0x73, 0xC4, 0x62, 0x34, 0x00, 0xF6, 0x62, 0x33, -+0x76, 0xC6, 0x0D, 0x6B, 0x94, 0xC6, 0x70, 0xC6, -+0x82, 0x34, 0x05, 0x6B, 0x95, 0xC6, 0x6F, 0xCE, -+0x87, 0xF1, 0xA8, 0xDA, 0xA0, 0x10, 0x02, 0x6E, -+0xA4, 0x67, 0xCC, 0xED, 0x44, 0x25, 0xFD, 0x67, -+0x81, 0x5B, 0xD2, 0xC7, 0x18, 0x60, 0x43, 0xF5, -+0xA4, 0x43, 0x30, 0xF0, 0x20, 0x6C, 0xC3, 0xF4, -+0x04, 0x4B, 0xC0, 0xF1, 0x08, 0x4C, 0x64, 0x33, -+0xA4, 0x35, 0x95, 0xE5, 0x91, 0xE3, 0x62, 0xAC, -+0xC2, 0xAD, 0x75, 0xC7, 0x62, 0x33, 0xD3, 0xC7, -+0x76, 0xC7, 0xC2, 0x36, 0x00, 0x6B, 0x62, 0xCD, -+0xD4, 0xC7, 0x62, 0xCC, 0x04, 0x10, 0x16, 0x6B, -+0x6B, 0xEB, 0x1D, 0x67, 0x73, 0xC0, 0x81, 0x5A, -+0x19, 0x60, 0x43, 0xF5, 0x84, 0x42, 0x30, 0xF0, -+0x20, 0x6B, 0xC3, 0xF4, 0x04, 0x4A, 0xC0, 0xF1, -+0x08, 0x4B, 0x44, 0x32, 0x84, 0x34, 0x71, 0xE4, -+0x6D, 0xE2, 0x42, 0xAB, 0xA2, 0xAC, 0xDD, 0x67, -+0x59, 0xC6, 0x42, 0x32, 0xB7, 0xC6, 0x5A, 0xC6, -+0xA2, 0x35, 0x00, 0x6A, 0x42, 0xCC, 0xB8, 0xC6, -+0x42, 0xCB, 0x04, 0x10, 0x16, 0x6A, 0x4B, 0xEA, -+0xFD, 0x67, 0x57, 0xC7, 0x0D, 0x6A, 0x1D, 0x67, -+0x50, 0xC0, 0x09, 0x6A, 0x52, 0x10, 0x53, 0x2C, -+0x81, 0x5B, 0x22, 0x60, 0xBD, 0x67, 0x72, 0xC5, -+0xC3, 0xF3, 0xC4, 0x43, 0x30, 0xF0, 0x20, 0x6D, -+0xC0, 0xF1, 0x08, 0x4D, 0xC4, 0x36, 0xB9, 0xE6, -+0xE0, 0xAE, 0x1D, 0x67, 0xF3, 0xC0, 0xE2, 0x37, -+0xF4, 0xC0, 0x43, 0xF4, 0xE4, 0x43, 0xE4, 0x37, -+0xB5, 0xE7, 0xE0, 0xAD, 0x74, 0x33, 0xF5, 0xC0, -+0xE2, 0x37, 0xF6, 0xC0, 0x10, 0xF0, 0x24, 0x6F, -+0x7C, 0xF1, 0xEC, 0x9F, 0xED, 0xE3, 0x60, 0xA3, -+0x80, 0xCE, 0x80, 0xCD, 0x77, 0xC0, 0x02, 0x10, -+0x9D, 0x67, 0x72, 0xC4, 0x81, 0x5A, 0x23, 0x60, -+0xC3, 0xF3, 0x84, 0x42, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x84, 0x34, 0x71, 0xE4, -+0xBD, 0x67, 0x58, 0xC5, 0xA0, 0xAC, 0xDD, 0x67, -+0xB9, 0xC6, 0xA2, 0x35, 0xBA, 0xC6, 0x43, 0xF4, -+0xA4, 0x42, 0xA4, 0x35, 0x6D, 0xE5, 0xA0, 0xAB, -+0x54, 0x32, 0xBB, 0xC6, 0xA2, 0x35, 0xBC, 0xC6, -+0x10, 0xF0, 0x24, 0x6D, 0x7C, 0xF1, 0xAC, 0x9D, -+0xA9, 0xE2, 0x40, 0xA2, 0x5D, 0xC6, 0x00, 0x6A, -+0x40, 0xCC, 0x40, 0xCB, 0x02, 0x10, 0xFD, 0x67, -+0x58, 0xC7, 0x04, 0x6A, 0x1D, 0x67, 0x50, 0xC0, -+0x0C, 0x6A, 0x4F, 0xC8, 0x04, 0x10, 0x7D, 0x67, -+0x04, 0x6A, 0x50, 0xC3, 0xAF, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, -+0x40, 0xEA, 0x09, 0x97, 0x08, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x60, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC5, 0xF6, 0x71, 0xC2, 0x61, 0xA4, -+0x65, 0xF4, 0x6A, 0xC2, 0x62, 0xA4, 0xC5, 0xF6, -+0x70, 0xC2, 0xA3, 0xA4, 0x0F, 0x6B, 0xAC, 0xEB, -+0xC5, 0xF6, 0x74, 0xC2, 0x63, 0xA4, 0x72, 0x33, -+0xC5, 0xF6, 0x75, 0xC2, 0x80, 0x18, 0x4A, 0x2A, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x68, 0xA4, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC5, 0xF6, -+0x71, 0xC2, 0x69, 0xA4, 0x65, 0xF4, 0x6A, 0xC2, -+0x6A, 0xA4, 0xC5, 0xF6, 0x70, 0xC2, 0xAB, 0xA4, -+0x0F, 0x6B, 0xAC, 0xEB, 0xC5, 0xF6, 0x74, 0xC2, -+0x6B, 0xA4, 0x72, 0x33, 0xC5, 0xF6, 0x75, 0xC2, -+0x80, 0x18, 0x4A, 0x2A, 0x05, 0x97, 0x00, 0x6A, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x0E, 0x72, 0x03, 0x60, -+0x11, 0x72, 0x05, 0x60, 0x08, 0x10, 0x85, 0x67, -+0x80, 0x18, 0x9F, 0x17, 0x10, 0x10, 0x85, 0x67, -+0x80, 0x18, 0xD4, 0x18, 0x0C, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x6C, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x5B, 0xF7, 0x84, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0xFF, 0x6A, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xF8, 0x63, 0x0F, 0x62, -+0x0E, 0xD1, 0x0D, 0xD0, 0x00, 0x6A, 0x10, 0xD4, -+0x01, 0x68, 0x62, 0x67, 0xA0, 0xA4, 0x0E, 0x25, -+0xFF, 0x6D, 0x01, 0x4B, 0xAC, 0xEB, 0x01, 0x4A, -+0x0B, 0x73, 0xAC, 0xEA, 0x03, 0x61, 0x01, 0x48, -+0xAC, 0xE8, 0x00, 0x6B, 0x37, 0x72, 0x01, 0x4C, -+0xF1, 0x61, 0x37, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xE5, 0xF2, 0x97, 0xA3, -+0x0F, 0x5C, 0x01, 0x4C, 0x01, 0x61, 0x00, 0x6C, -+0xE5, 0xF2, 0x97, 0xC3, 0x30, 0xF0, 0x20, 0x6B, -+0xA5, 0xF4, 0x7F, 0xA3, 0x0B, 0x6D, 0x2F, 0x40, -+0x70, 0x33, 0x0A, 0xD3, 0x0A, 0x94, 0xFF, 0x6B, -+0x6C, 0xE9, 0x6C, 0xEC, 0x0A, 0xD4, 0x01, 0x6C, -+0x13, 0xE4, 0xB8, 0xEC, 0x12, 0xEC, 0x91, 0xE2, -+0x6C, 0xEC, 0x09, 0xD4, 0x00, 0x6A, 0x01, 0x4C, -+0x0B, 0xD4, 0x08, 0xD2, 0x3C, 0x10, 0x08, 0x94, -+0x0B, 0x6B, 0x0A, 0x95, 0x78, 0xEC, 0x9D, 0x67, -+0x12, 0xEB, 0x4C, 0xEB, 0x0F, 0x6A, 0x2C, 0xEA, -+0xAD, 0xEA, 0x08, 0x95, 0x52, 0xC4, 0x4F, 0x40, -+0xAE, 0xEA, 0x07, 0x22, 0x10, 0x92, 0x00, 0xF0, -+0x1E, 0x04, 0x6D, 0xE2, 0x00, 0xF0, 0x13, 0x02, -+0x0F, 0x10, 0x10, 0x94, 0x09, 0x95, 0x00, 0xF0, -+0x13, 0x02, 0x6D, 0xE4, 0xB1, 0xE2, 0x04, 0x10, -+0xA0, 0xA3, 0x01, 0x4B, 0xA0, 0xC2, 0x01, 0x4A, -+0x8A, 0xEA, 0xFA, 0x61, 0x0B, 0x92, 0x07, 0x10, -+0xA0, 0xA3, 0x01, 0x4B, 0xA0, 0xC2, 0x01, 0x4A, -+0x8A, 0xEA, 0xFA, 0x61, 0x0C, 0x6A, 0x9D, 0x67, -+0x00, 0x6B, 0x4F, 0xCC, 0x70, 0xC4, 0x05, 0x95, -+0x04, 0x94, 0x06, 0x96, 0x07, 0x97, 0xFF, 0x49, -+0x80, 0x18, 0x47, 0x10, 0x08, 0x95, 0xFF, 0x6A, -+0x4C, 0xE9, 0x01, 0x4D, 0x08, 0xD5, 0x08, 0x93, -+0xFF, 0x6A, 0x4C, 0xEB, 0x03, 0xEB, 0xBF, 0x61, -+0x0F, 0x97, 0x0E, 0x91, 0x0D, 0x90, 0x08, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x6A, 0xC5, 0xF4, -+0x40, 0xAA, 0x07, 0xD5, 0x08, 0xD6, 0x01, 0x72, -+0x09, 0xD7, 0x06, 0xD4, 0x0C, 0x61, 0x30, 0xF0, -+0x21, 0x68, 0x06, 0x95, 0xB0, 0xF3, 0x0C, 0x48, -+0x90, 0x67, 0x07, 0x06, 0x80, 0x18, 0x06, 0x18, -+0x90, 0x67, 0x80, 0x18, 0xF3, 0x18, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x60, 0xA4, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xE5, 0xF2, -+0x73, 0xC2, 0xA1, 0xA4, 0x03, 0x73, 0xE5, 0xF2, -+0xB4, 0xC2, 0x1C, 0x61, 0x62, 0xA4, 0xE5, 0xF2, -+0x70, 0xC2, 0x63, 0xA4, 0xE5, 0xF2, 0x71, 0xC2, -+0x64, 0xA4, 0x65, 0xF4, 0x80, 0x9A, 0xE5, 0xF2, -+0x72, 0xC2, 0x04, 0xF0, 0x00, 0x6B, 0x8C, 0xEB, -+0x29, 0x23, 0xE5, 0xF2, 0xB0, 0xA2, 0xE5, 0xF2, -+0xD1, 0xA2, 0xE5, 0xF2, 0xF2, 0xA2, 0x10, 0xF0, -+0x24, 0x6C, 0x1C, 0xF7, 0x04, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x1C, 0x10, 0x02, 0x73, 0x1A, 0x61, -+0x62, 0xA4, 0xE5, 0xF2, 0x70, 0xC2, 0x63, 0xA4, -+0x65, 0xF4, 0x80, 0x9A, 0xE5, 0xF2, 0x71, 0xC2, -+0x01, 0x6B, 0x6B, 0xEB, 0xE5, 0xF2, 0x72, 0xC2, -+0x04, 0xF0, 0x00, 0x6B, 0x8C, 0xEB, 0x0A, 0x23, -+0xE5, 0xF2, 0xB0, 0xA2, 0xE5, 0xF2, 0xD1, 0xA2, -+0x10, 0xF0, 0x24, 0x6C, 0x3C, 0xF7, 0x14, 0x4C, -+0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, 0x20, 0x6A, -+0x05, 0x97, 0xC0, 0xF1, 0x08, 0x4A, 0x01, 0x6B, -+0xE5, 0xF2, 0x76, 0xC2, 0x00, 0x6B, 0xE5, 0xF2, -+0x75, 0xC2, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF3, 0x63, 0x19, 0x62, 0x18, 0xD1, 0x17, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x14, 0xD2, 0x40, 0xF0, -+0x06, 0x03, 0x20, 0xF0, 0x1A, 0x02, 0x00, 0x6C, -+0x80, 0xC2, 0x01, 0x4A, 0x6A, 0xEA, 0xFB, 0x61, -+0x30, 0xF0, 0x21, 0x6B, 0x30, 0xF3, 0x18, 0x4B, -+0x00, 0x68, 0x12, 0xD3, 0x13, 0xD0, 0x65, 0x10, -+0x12, 0x93, 0x20, 0xA3, 0xFF, 0x71, 0x0A, 0x61, -+0x7D, 0x67, 0x09, 0xE3, 0x01, 0x6B, 0x6B, 0xEB, -+0x20, 0xF0, 0x7A, 0xC2, 0x01, 0x48, 0xFF, 0x6A, -+0x4C, 0xE8, 0x5B, 0x10, 0x52, 0x6A, 0x58, 0xE9, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0x04, 0x11, 0xE4, -+0x60, 0xF2, 0x08, 0x4B, 0x22, 0xC4, 0x03, 0x6D, -+0x04, 0x48, 0x12, 0xEA, 0x49, 0xE3, 0x76, 0xAA, -+0x63, 0xC4, 0x63, 0xA2, 0x64, 0xC4, 0x20, 0xF0, -+0x65, 0xA2, 0x6A, 0x33, 0xAC, 0xEB, 0x30, 0xF0, -+0x20, 0x6D, 0x25, 0xF6, 0xA8, 0x9D, 0x65, 0xC4, -+0xFF, 0x6C, 0x8C, 0xE8, 0x07, 0xF7, 0x01, 0x4C, -+0xAC, 0xEC, 0x0A, 0x24, 0xD6, 0xAA, 0xE3, 0xA2, -+0x10, 0xF0, 0x24, 0x6C, 0x5C, 0xF7, 0x18, 0x4C, -+0xB1, 0x67, 0x04, 0xD3, 0x80, 0x18, 0x35, 0x19, -+0x14, 0x93, 0x02, 0x6A, 0x4E, 0xEB, 0x21, 0x2B, -+0x30, 0xF0, 0x20, 0x6A, 0x2C, 0x34, 0x2F, 0xF7, -+0x18, 0x4A, 0x89, 0xE2, 0xA3, 0xAA, 0x0E, 0x04, -+0x11, 0xE4, 0xA2, 0xC4, 0xA3, 0xAA, 0x02, 0x48, -+0xA2, 0x35, 0xA3, 0xC4, 0x63, 0xCA, 0x30, 0xF0, -+0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, 0xFF, 0x6A, -+0x4C, 0xE8, 0x07, 0xF7, 0x01, 0x4A, 0x6C, 0xEA, -+0x08, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x7C, 0xF7, -+0x1C, 0x4C, 0xB1, 0x67, 0x00, 0x6E, 0x80, 0x18, -+0x35, 0x19, 0x13, 0x93, 0xFF, 0x6A, 0x01, 0x4B, -+0x4C, 0xEB, 0x12, 0x92, 0x13, 0xD3, 0x01, 0x4A, -+0x12, 0xD2, 0x13, 0x93, 0x14, 0x92, 0x43, 0xEB, -+0x97, 0x61, 0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, -+0x68, 0x9B, 0x08, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, -+0x28, 0x22, 0x7D, 0x67, 0x20, 0xF0, 0x5D, 0xA3, -+0x20, 0xF0, 0xBA, 0xA3, 0x20, 0xF0, 0xDB, 0xA3, -+0x20, 0xF0, 0xFC, 0xA3, 0x04, 0xD2, 0x20, 0xF0, -+0x5E, 0xA3, 0x10, 0xF0, 0x24, 0x6C, 0x9C, 0xF7, -+0x14, 0x4C, 0x05, 0xD2, 0x20, 0xF0, 0x5F, 0xA3, -+0x06, 0xD2, 0x40, 0xF0, 0x40, 0xA3, 0x07, 0xD2, -+0x40, 0xF0, 0x41, 0xA3, 0x08, 0xD2, 0x40, 0xF0, -+0x42, 0xA3, 0x09, 0xD2, 0x40, 0xF0, 0x43, 0xA3, -+0x0A, 0xD2, 0x40, 0xF0, 0x44, 0xA3, 0x0B, 0xD2, -+0x40, 0xF0, 0x45, 0xA3, 0x0C, 0xD2, 0x80, 0x18, -+0x35, 0x19, 0x7D, 0x67, 0x2C, 0x6A, 0x40, 0xF0, -+0x06, 0xCB, 0x20, 0xF0, 0x58, 0xC3, 0x11, 0x97, -+0x0E, 0x94, 0x0F, 0x95, 0x10, 0x96, 0x80, 0x18, -+0x47, 0x10, 0x19, 0x97, 0x18, 0x91, 0x17, 0x90, -+0x0D, 0x63, 0x00, 0xEF, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x43, 0xA4, 0x62, 0xA4, -+0xC0, 0xA4, 0x40, 0x32, 0x40, 0x32, 0x60, 0x33, -+0x4D, 0xE3, 0x41, 0xA4, 0x0F, 0x6D, 0xCC, 0xED, -+0x4D, 0xE3, 0x44, 0xA4, 0xD2, 0x36, 0x01, 0x5E, -+0x00, 0xF6, 0x40, 0x32, 0x49, 0xE3, 0x08, 0xD2, -+0xB4, 0x32, 0x06, 0xD2, 0x06, 0x93, 0xFF, 0x6A, -+0x4C, 0xEB, 0x06, 0xD3, 0x03, 0x6A, 0x78, 0x67, -+0x6F, 0xE2, 0x07, 0xD3, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0xE7, 0xF7, 0x1D, 0x4A, -+0x6C, 0xEA, 0x07, 0x22, 0x08, 0x97, 0x10, 0xF0, -+0x24, 0x6C, 0xDC, 0xF7, 0x10, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x80, 0x18, 0x50, 0x18, 0x00, 0x68, -+0x06, 0x91, 0x4A, 0x10, 0x08, 0x93, 0x01, 0x6A, -+0x44, 0xE9, 0x6C, 0xEA, 0x1A, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x30, 0xF0, -+0x20, 0x6B, 0x49, 0xE0, 0x25, 0xF6, 0x68, 0x9B, -+0x40, 0xF6, 0x30, 0xC2, 0x01, 0x48, 0xFF, 0x6A, -+0x4C, 0xE8, 0x07, 0xF7, 0x01, 0x4A, 0x6C, 0xEA, -+0x08, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0xFC, 0xF7, -+0x18, 0x4C, 0xB0, 0x67, 0xD1, 0x67, 0x80, 0x18, -+0x35, 0x19, 0x07, 0x92, 0x4A, 0xE8, 0x04, 0x60, -+0x06, 0x92, 0x1F, 0x4A, 0x2E, 0xEA, 0x21, 0x2A, -+0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, -+0x08, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x12, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x40, 0xF6, 0xD0, 0xA2, 0x40, 0xF6, 0xF1, 0xA2, -+0x40, 0xF6, 0x52, 0xA2, 0x10, 0xF0, 0x24, 0x6C, -+0x1D, 0xF0, 0x18, 0x4C, 0xB0, 0x67, 0x04, 0xD2, -+0x80, 0x18, 0x35, 0x19, 0x0D, 0x20, 0x07, 0x94, -+0x00, 0x68, 0x80, 0x18, 0x6E, 0x19, 0x80, 0x18, -+0x50, 0x18, 0x01, 0x49, 0xFF, 0x6A, 0x4C, 0xE9, -+0x06, 0x92, 0x20, 0x4A, 0x42, 0xE9, 0xB2, 0x61, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF6, 0x63, 0x13, 0x62, -+0x12, 0xD1, 0x11, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0xFF, 0x6A, 0x8C, 0xEA, 0x9B, 0xF2, 0x90, 0x9B, -+0x9B, 0xF2, 0x10, 0x4B, 0x08, 0x72, 0x04, 0xD4, -+0x81, 0x9B, 0x68, 0xA3, 0x05, 0xD4, 0x9D, 0x67, -+0x78, 0xC4, 0x10, 0xF0, 0x24, 0x6B, 0x9B, 0xF2, -+0x84, 0x9B, 0x9B, 0xF2, 0x04, 0x4B, 0x07, 0xD4, -+0x81, 0x9B, 0x68, 0xA3, 0x08, 0xD4, 0x9D, 0x67, -+0x20, 0xF0, 0x64, 0xC4, 0x37, 0x61, 0x20, 0xF0, -+0x05, 0x02, 0x07, 0x00, 0x04, 0x01, 0x0E, 0xD2, -+0x40, 0xA0, 0x0B, 0x5A, 0x01, 0x61, 0x0A, 0x6A, -+0xFF, 0x6B, 0x4C, 0xEB, 0x9D, 0x67, 0x42, 0x43, -+0x5B, 0xCC, 0x0E, 0x6A, 0x20, 0xF0, 0x48, 0xC4, -+0x08, 0x6A, 0x20, 0xF0, 0x4A, 0xC4, 0x40, 0xA1, -+0x20, 0xF0, 0x4B, 0xC4, 0x00, 0x6A, 0x0E, 0x10, -+0x9D, 0x67, 0x55, 0xE4, 0xC0, 0xA1, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, 0x91, 0xE2, -+0xD1, 0xE4, 0x45, 0xF2, 0x88, 0xA4, 0x01, 0x4A, -+0x20, 0xF0, 0x8C, 0xC5, 0xFF, 0x6C, 0x4C, 0xEC, -+0x63, 0xEC, 0xEE, 0x61, 0x0A, 0x94, 0x0B, 0x95, -+0x0C, 0x96, 0x0D, 0x97, 0x01, 0x48, 0x01, 0x49, -+0x80, 0x18, 0x47, 0x10, 0x0E, 0x92, 0x4A, 0xE8, -+0xCF, 0x61, 0x38, 0x10, 0x09, 0x72, 0x36, 0x61, -+0x20, 0xF0, 0x05, 0x04, 0x07, 0x00, 0x04, 0x01, -+0x0F, 0xD4, 0x40, 0xA0, 0x0B, 0x5A, 0x01, 0x61, -+0x0A, 0x6A, 0xFF, 0x6B, 0x4C, 0xEB, 0x9D, 0x67, -+0x42, 0x43, 0x5B, 0xCC, 0x0E, 0x6A, 0x20, 0xF0, -+0x48, 0xC4, 0x09, 0x6A, 0x20, 0xF0, 0x4A, 0xC4, -+0x40, 0xA1, 0x20, 0xF0, 0x4B, 0xC4, 0x00, 0x6A, -+0x0E, 0x10, 0x9D, 0x67, 0x55, 0xE4, 0xC0, 0xA1, -+0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, -+0x91, 0xE2, 0xD1, 0xE4, 0x85, 0xF2, 0x9C, 0xA4, -+0x01, 0x4A, 0x20, 0xF0, 0x8C, 0xC5, 0xFF, 0x6C, -+0x4C, 0xEC, 0x63, 0xEC, 0xEE, 0x61, 0x0A, 0x94, -+0x0B, 0x95, 0x0C, 0x96, 0x0D, 0x97, 0x01, 0x48, -+0x01, 0x49, 0x80, 0x18, 0x47, 0x10, 0x0F, 0x92, -+0x4A, 0xE8, 0xCF, 0x61, 0x13, 0x97, 0x12, 0x91, -+0x11, 0x90, 0x0A, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x44, 0x67, 0x65, 0xA2, 0x02, 0x6D, 0x81, 0xA4, -+0xAC, 0xEB, 0x03, 0x23, 0x80, 0x18, 0x13, 0x1A, -+0x34, 0x10, 0x04, 0xA2, 0x22, 0xA2, 0x43, 0xA2, -+0x10, 0x30, 0x08, 0x74, 0x4D, 0xE8, 0x0E, 0x61, -+0x10, 0xF0, 0x24, 0x6C, 0x5D, 0xF0, 0x00, 0x4C, -+0x80, 0x18, 0xF3, 0x18, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x45, 0xE1, 0x45, 0xF2, -+0x08, 0xC1, 0x1F, 0x10, 0x09, 0x74, 0x0E, 0x61, -+0x10, 0xF0, 0x24, 0x6C, 0x7D, 0xF0, 0x00, 0x4C, -+0x80, 0x18, 0xF3, 0x18, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x45, 0xE1, 0x85, 0xF2, -+0x1C, 0xC1, 0x0F, 0x10, 0x0A, 0x74, 0x0D, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, 0xF0, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x7D, 0xF0, 0x10, 0x4C, -+0xF9, 0x6D, 0x28, 0xF3, 0x01, 0x6E, 0x80, 0x18, -+0x35, 0x19, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x52, 0x6B, 0x78, 0xEC, -+0x30, 0xF0, 0x20, 0x6E, 0x60, 0xF2, 0x08, 0x4E, -+0xAC, 0xEA, 0x05, 0x6D, 0x12, 0xEB, 0x6D, 0xE6, -+0xDD, 0x67, 0xAF, 0xCE, 0x0F, 0x6D, 0xB0, 0xC6, -+0x92, 0xC6, 0x53, 0xC6, 0x20, 0xF0, 0x5D, 0xA3, -+0x07, 0x97, 0x04, 0x94, 0x54, 0xC6, 0x20, 0xF0, -+0x5E, 0xA3, 0x55, 0xC6, 0x20, 0xF0, 0x5F, 0xA3, -+0x56, 0xC6, 0x05, 0x95, 0x06, 0x96, 0x80, 0x18, -+0x47, 0x10, 0x09, 0x97, 0x05, 0x63, 0x00, 0xEF, -+0xF8, 0x63, 0x0F, 0x62, 0x0E, 0xD1, 0x0D, 0xD0, -+0x14, 0x92, 0x15, 0x93, 0x16, 0x90, 0x0A, 0xD2, -+0xFF, 0x6A, 0x1A, 0x65, 0xAC, 0xEA, 0x08, 0xD2, -+0x58, 0x67, 0xCC, 0xEA, 0x17, 0x91, 0x1A, 0x65, -+0x0A, 0x92, 0xFF, 0xF7, 0x1F, 0x6D, 0xAC, 0xEF, -+0xAC, 0xEA, 0xAC, 0xEB, 0xAC, 0xE8, 0xAC, 0xE9, -+0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, 0x08, 0x4D, -+0x65, 0xF4, 0xC0, 0x9D, 0x0A, 0xD2, 0x8C, 0xEE, -+0x30, 0x26, 0x65, 0xF4, 0x84, 0x9D, 0x05, 0x6A, -+0x4E, 0xEC, 0x2B, 0x2C, 0xE5, 0xF2, 0x98, 0xAD, -+0x01, 0x6A, 0x4E, 0xEC, 0x26, 0x2C, 0x9D, 0x67, -+0x47, 0x44, 0x19, 0x4A, 0x40, 0xA2, 0xF4, 0xC4, -+0xE2, 0x37, 0x52, 0xC4, 0x58, 0x67, 0x53, 0xC4, -+0x47, 0x44, 0x21, 0x4A, 0x40, 0xA2, 0xF5, 0xC4, -+0x56, 0xC4, 0x0A, 0x94, 0x82, 0x32, 0x9D, 0x67, -+0x57, 0xC4, 0x02, 0x6A, 0x4B, 0xEA, 0x78, 0xC4, -+0x1A, 0xC4, 0x3C, 0xC4, 0x50, 0xC4, 0x62, 0x33, -+0x02, 0x30, 0x22, 0x31, 0x0C, 0x6A, 0x79, 0xC4, -+0x1B, 0xC4, 0x3D, 0xC4, 0x4F, 0xCC, 0x05, 0x95, -+0x04, 0x94, 0x06, 0x96, 0x07, 0x97, 0x80, 0x18, -+0x47, 0x10, 0x0F, 0x97, 0x0E, 0x91, 0x0D, 0x90, -+0x08, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x20, 0xA4, 0x52, 0x68, -+0x30, 0xF0, 0x20, 0x6A, 0x18, 0xE9, 0x60, 0xF2, -+0x08, 0x4A, 0x21, 0x6B, 0x20, 0x6E, 0x6B, 0xEB, -+0x12, 0xE8, 0x01, 0xE2, 0x20, 0xF0, 0x52, 0xA0, -+0x04, 0xD2, 0x42, 0xA4, 0x20, 0xF0, 0xF5, 0xA0, -+0x20, 0xF0, 0x52, 0xC0, 0xA3, 0xA4, 0xEC, 0xEB, -+0x01, 0x6A, 0xCC, 0xED, 0xAD, 0xEB, 0x20, 0xF0, -+0x75, 0xC0, 0xA3, 0xA4, 0xAC, 0xEA, 0x02, 0x6D, -+0xAB, 0xED, 0x6C, 0xED, 0x4D, 0xED, 0x20, 0xF0, -+0xB5, 0xC0, 0x43, 0xA4, 0x02, 0x6B, 0x6C, 0xEA, -+0xFB, 0x4B, 0xAC, 0xEB, 0x4D, 0xEB, 0x20, 0xF0, -+0x75, 0xC0, 0xA3, 0xA4, 0x40, 0x6A, 0x4C, 0xED, -+0x80, 0x4A, 0xFF, 0x4A, 0x6C, 0xEA, 0xAD, 0xEA, -+0x20, 0xF0, 0x55, 0xC0, 0x64, 0xA4, 0xCC, 0xEA, -+0x40, 0xF0, 0x60, 0xC0, 0x0F, 0x22, 0x91, 0x67, -+0x80, 0x18, 0xE1, 0x24, 0x20, 0xF0, 0xC5, 0xA0, -+0x03, 0x6A, 0x20, 0xF0, 0xB2, 0xA0, 0xCA, 0x36, -+0x4C, 0xEE, 0xFF, 0x6A, 0x91, 0x67, 0x4C, 0xEE, -+0x80, 0x18, 0x2B, 0x24, 0x20, 0xF0, 0xF5, 0xA0, -+0x20, 0xF0, 0xD2, 0xA0, 0x04, 0x95, 0x01, 0x6A, -+0xF6, 0x37, 0x91, 0x67, 0x4C, 0xEF, 0x80, 0x18, -+0x8B, 0x1E, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x03, 0xA4, 0x44, 0xA4, 0xC0, 0xA4, -+0x00, 0x30, 0x00, 0x30, 0x00, 0xF6, 0x40, 0x32, -+0xA5, 0xA4, 0xE6, 0xA4, 0x0D, 0xEA, 0x01, 0xA4, -+0x82, 0xA4, 0x30, 0xF0, 0x20, 0x6B, 0x0D, 0xEA, -+0x80, 0x34, 0xC0, 0xF1, 0x08, 0x4B, 0x8D, 0xEA, -+0x65, 0xF4, 0x40, 0xDB, 0xE5, 0xF2, 0xD8, 0xC3, -+0x0A, 0x26, 0x01, 0x6C, 0x4C, 0xEC, 0x07, 0x24, -+0xE5, 0xF2, 0xB9, 0xC3, 0xE5, 0xF2, 0xFA, 0xC3, -+0x02, 0x25, 0x80, 0x18, 0x39, 0x24, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x20, 0xA4, 0x52, 0x68, 0x62, 0xA4, 0x18, 0xE9, -+0x08, 0x6A, 0x6C, 0xEA, 0x4E, 0x32, 0x06, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, -+0x7E, 0x33, 0x7C, 0x33, 0x12, 0xE8, 0x01, 0xE2, -+0x20, 0xF0, 0xA5, 0xA0, 0x7F, 0x6A, 0xAC, 0xEA, -+0x6D, 0xEA, 0x20, 0xF0, 0x45, 0xC0, 0xA2, 0xA4, -+0x40, 0x6B, 0x6C, 0xED, 0x80, 0x4B, 0xFF, 0x4B, -+0x4C, 0xEB, 0xAD, 0xEB, 0x20, 0xF0, 0x65, 0xC0, -+0xA1, 0xA4, 0x1F, 0x6A, 0xAC, 0xEA, 0x44, 0xC0, -+0x41, 0xA4, 0x03, 0x6D, 0x07, 0xD2, 0xC2, 0xA4, -+0x04, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xAC, 0xEE, -+0xCD, 0xEA, 0x20, 0xF0, 0x45, 0xC0, 0x06, 0x93, -+0x09, 0x2B, 0x62, 0xA4, 0x6C, 0xED, 0x0D, 0x6B, -+0x6B, 0xEB, 0xA8, 0x35, 0x4C, 0xEB, 0xAD, 0xEB, -+0x20, 0xF0, 0x65, 0xC0, 0x61, 0xA4, 0x20, 0xF0, -+0xA6, 0xA0, 0x05, 0x6A, 0x7E, 0x33, 0x4B, 0xEA, -+0x68, 0x33, 0xAC, 0xEA, 0x6D, 0xEA, 0x20, 0xF0, -+0x46, 0xC0, 0x62, 0xA4, 0x20, 0xF0, 0xA5, 0xA0, -+0x30, 0x6A, 0x4C, 0xEB, 0x9F, 0x4A, 0xAC, 0xEA, -+0x6D, 0xEA, 0x20, 0xF0, 0x45, 0xC0, 0x10, 0xF0, -+0x24, 0x6D, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, -+0x54, 0x9A, 0x7C, 0xF1, 0xB8, 0x9D, 0x2C, 0x33, -+0x49, 0xE3, 0x03, 0x4C, 0xAD, 0xE3, 0xA0, 0xA4, -+0x01, 0x4C, 0xA0, 0xC2, 0x01, 0x4A, 0x6A, 0xEA, -+0xFA, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x0F, 0x22, -+0x20, 0xF0, 0xC5, 0xA0, 0x44, 0xA0, 0x10, 0xF0, -+0x24, 0x6C, 0xDA, 0x37, 0x04, 0xD2, 0x01, 0x6A, -+0x9D, 0xF0, 0x1C, 0x4C, 0xB1, 0x67, 0xDE, 0x36, -+0x4C, 0xEF, 0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x16, 0x22, 0x20, 0xF0, 0x66, 0xA0, -+0x20, 0xF0, 0xC5, 0xA0, 0x01, 0x6C, 0x6A, 0x33, -+0x8C, 0xEB, 0x06, 0x97, 0x03, 0x6A, 0xCA, 0x35, -+0x04, 0xD3, 0x10, 0xF0, 0x24, 0x6C, 0xD2, 0x33, -+0x4C, 0xEB, 0xDD, 0xF0, 0x00, 0x4C, 0x4C, 0xED, -+0x4C, 0xEE, 0x05, 0xD3, 0x80, 0x18, 0x35, 0x19, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, 0x54, 0x9A, -+0x2C, 0x33, 0x49, 0xE3, 0x60, 0x9A, 0x30, 0xF0, -+0x20, 0x6A, 0xCC, 0xF1, 0x56, 0xA2, 0x01, 0x72, -+0x16, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, -+0x5C, 0x9A, 0x63, 0xEA, 0x10, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF1, 0x40, 0x9A, 0x00, 0x6B, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF1, -+0x64, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x9B, 0xF6, -+0x4C, 0x9A, 0x60, 0xDA, 0xF0, 0x17, 0x20, 0xF0, -+0x45, 0xA0, 0x03, 0x6B, 0x4A, 0x32, 0x6C, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCC, 0xF1, 0x74, 0xA3, -+0x05, 0x73, 0x11, 0x61, 0x38, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF1, 0x40, 0x9A, 0x00, 0x6B, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF1, -+0x68, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x9B, 0xF6, -+0x4C, 0x9A, 0x60, 0xDA, 0xF0, 0x17, 0x06, 0x73, -+0x12, 0x61, 0x02, 0x5A, 0x24, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF1, 0x40, 0x9A, 0x00, 0x6B, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF1, -+0x6C, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x9B, 0xF6, -+0x4C, 0x9A, 0x60, 0xDA, 0xF0, 0x17, 0x07, 0x73, -+0x12, 0x61, 0x03, 0x72, 0x10, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF1, 0x40, 0x9A, 0x00, 0x6B, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF1, -+0x70, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x9B, 0xF6, -+0x4C, 0x9A, 0x60, 0xDA, 0xF0, 0x17, 0x30, 0xF0, -+0x20, 0x6A, 0xCC, 0xF1, 0x57, 0xA2, 0x02, 0x72, -+0x16, 0x61, 0x20, 0xF0, 0x45, 0xA0, 0x03, 0x6B, -+0x52, 0x32, 0x6C, 0xEA, 0x10, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x9C, 0xF1, 0x40, 0x9A, 0x00, 0x6B, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x9C, 0xF1, -+0x74, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x9B, 0xF6, -+0x4C, 0x9A, 0x60, 0xDA, 0xF0, 0x17, 0x07, 0x93, -+0x60, 0x6A, 0x91, 0x67, 0x6C, 0xEA, 0x56, 0x32, -+0x06, 0xD2, 0x80, 0x18, 0x69, 0x1F, 0x06, 0x92, -+0x10, 0x22, 0x06, 0x93, 0x20, 0xF0, 0xC5, 0xA0, -+0x04, 0x6A, 0x6B, 0xE2, 0x09, 0x6D, 0xA4, 0xEA, -+0xCA, 0x36, 0x03, 0x6A, 0x4C, 0xEE, 0xFF, 0x6A, -+0x91, 0x67, 0x4C, 0xED, 0x4C, 0xEE, 0x80, 0x18, -+0x2B, 0x24, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0xC0, 0x4C, 0x4C, 0xEC, -+0x0F, 0x5C, 0x2B, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x88, 0x34, 0x5B, 0xF2, 0x08, 0x4A, 0x89, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x85, 0x67, 0x80, 0x18, -+0x02, 0x1B, 0x1F, 0x10, 0x85, 0x67, 0x80, 0x18, -+0xBF, 0x1A, 0x1B, 0x10, 0x85, 0x67, 0x80, 0x18, -+0x5E, 0x1A, 0x17, 0x10, 0x85, 0x67, 0x80, 0x18, -+0x44, 0x19, 0x13, 0x10, 0x85, 0x67, 0x80, 0x18, -+0xED, 0x1A, 0x0F, 0x10, 0x85, 0x67, 0x80, 0x18, -+0xCF, 0x19, 0x0B, 0x10, 0x85, 0x67, 0x80, 0x18, -+0xDD, 0x1B, 0x07, 0x10, 0x85, 0x67, 0x80, 0x18, -+0x57, 0x18, 0x03, 0x10, 0x85, 0x67, 0x80, 0x18, -+0xC5, 0x18, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x21, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0x70, 0xF3, -+0xD2, 0xAB, 0xCE, 0xF4, 0x50, 0x98, 0x81, 0xF1, -+0x10, 0x6C, 0xFF, 0xF7, 0x1F, 0x6D, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xFF, 0x6D, 0x81, 0xF1, -+0x14, 0x6C, 0x01, 0x4D, 0x01, 0x6E, 0x40, 0xEA, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, -+0x81, 0xF1, 0x14, 0x69, 0x91, 0x67, 0x01, 0x6D, -+0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x01, 0x6D, 0x91, 0x67, 0xC5, 0x67, 0x40, 0xEA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x00, 0x6B, 0x80, 0xF6, -+0x67, 0xC2, 0x80, 0xF6, 0x66, 0xC2, 0x05, 0x6B, -+0x80, 0xF6, 0x65, 0xC2, 0x00, 0x6B, 0x80, 0xF6, -+0x6C, 0xDA, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x60, 0xA4, 0x80, 0x6A, -+0x30, 0xF0, 0x20, 0x68, 0x4B, 0xEA, 0xEF, 0xF4, -+0x08, 0x48, 0x6C, 0xEA, 0x80, 0xF6, 0x47, 0xC0, -+0x60, 0xA4, 0x0F, 0x6A, 0x24, 0x67, 0x6C, 0xEA, -+0x80, 0xF6, 0x44, 0xC0, 0x41, 0xA4, 0x80, 0xF6, -+0x64, 0xA0, 0x80, 0xF6, 0x45, 0xC0, 0x00, 0x6A, -+0x01, 0x4B, 0x80, 0xF6, 0x46, 0xC0, 0x01, 0x6A, -+0x44, 0xEB, 0xFF, 0x4A, 0x80, 0xF6, 0x4A, 0xC8, -+0x80, 0x18, 0xBA, 0x1B, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x10, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x0A, 0x22, 0xA1, 0xA1, 0xC0, 0xA1, -+0x80, 0xF6, 0xEA, 0xA8, 0x10, 0xF0, 0x24, 0x6C, -+0xFD, 0xF0, 0x0C, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0x5B, 0xF7, -+0xA0, 0x9A, 0xA1, 0xF7, 0x04, 0x6C, 0x00, 0x18, -+0xE4, 0xE6, 0x01, 0x22, 0x01, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, 0x02, 0x67, -+0x10, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x07, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x1D, 0xF1, 0x08, 0x4C, -+0xB0, 0x67, 0x80, 0x18, 0x35, 0x19, 0x50, 0x67, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xA1, 0xF7, 0x04, 0x6C, -+0xFF, 0xF7, 0x1F, 0x6D, 0x00, 0x18, 0xE4, 0xE6, -+0x30, 0xF0, 0x20, 0x6C, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x88, 0x9C, 0xEF, 0xF4, 0x08, 0x4B, -+0x80, 0xF6, 0x48, 0xCB, 0x10, 0xF0, 0x00, 0x6A, -+0x8C, 0xEA, 0x08, 0x22, 0x80, 0xF6, 0xA8, 0xAB, -+0x10, 0xF0, 0x24, 0x6C, 0x1D, 0xF1, 0x14, 0x4C, -+0x80, 0x18, 0x35, 0x19, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x10, 0xF0, 0x00, 0x6A, -+0xFF, 0x69, 0x04, 0x67, 0x6C, 0xEA, 0x2C, 0xE8, -+0xAC, 0xE9, 0x08, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0x3D, 0xF1, 0x00, 0x4C, 0xB0, 0x67, 0xD1, 0x67, -+0x80, 0x18, 0x35, 0x19, 0x5D, 0x67, 0x12, 0xC2, -+0x33, 0xC2, 0x7D, 0x67, 0x2A, 0x6A, 0x50, 0xC3, -+0x02, 0x6A, 0x4F, 0xCB, 0x07, 0x97, 0x04, 0x94, -+0x05, 0x95, 0x06, 0x96, 0x80, 0x18, 0x47, 0x10, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, -+0x80, 0xF6, 0x67, 0xA2, 0x68, 0x23, 0x80, 0xF6, -+0xC6, 0xA2, 0x80, 0xF6, 0x65, 0xA2, 0xC3, 0xEB, -+0x62, 0x61, 0x30, 0xF0, 0x20, 0x6C, 0x25, 0xF6, -+0x88, 0x9C, 0x10, 0xF0, 0x00, 0x6B, 0x8C, 0xEB, -+0x08, 0x23, 0x80, 0xF6, 0xAC, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x3D, 0xF1, 0x0C, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, -+0x74, 0x9A, 0x03, 0x6A, 0x5B, 0xEB, 0x01, 0x2A, -+0xE5, 0xE8, 0x10, 0xEA, 0x3F, 0x2A, 0x80, 0x18, -+0xFB, 0x1B, 0x2C, 0x22, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x10, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0x5D, 0xF1, 0x00, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x80, 0x18, 0x0C, 0x1C, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x80, 0xF6, 0x6A, 0xAA, -+0xFF, 0xF7, 0x1F, 0x73, 0x13, 0x61, 0x80, 0xF6, -+0x88, 0xAA, 0x64, 0x6B, 0x78, 0xEC, 0x8F, 0xF7, -+0x1C, 0x4B, 0x12, 0xEC, 0x71, 0xE4, 0x80, 0xF6, -+0x66, 0xA2, 0x82, 0x34, 0x82, 0x34, 0x01, 0x4B, -+0x80, 0xF6, 0x66, 0xC2, 0x80, 0xF6, 0xA6, 0xA2, -+0x80, 0x18, 0x1D, 0x1C, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x10, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0x5D, 0xF1, 0x08, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x80, 0x18, 0xC8, 0x1B, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x80, 0xF6, 0x6C, 0x9A, -+0x01, 0x4B, 0x80, 0xF6, 0x6C, 0xDA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0xFF, 0x6B, 0x8C, 0xEB, 0xBB, 0xF3, 0x80, 0x9A, -+0xFE, 0x63, 0xBB, 0xF3, 0x00, 0x4A, 0x00, 0xD4, -+0x81, 0x9A, 0x44, 0xAA, 0x00, 0xF0, 0x0A, 0x05, -+0x01, 0xD4, 0x9D, 0x67, 0x44, 0xCC, 0x40, 0xA4, -+0x43, 0xEB, 0x05, 0x61, 0x01, 0x4B, 0x4B, 0xE3, -+0xFF, 0x6B, 0x6C, 0xEA, 0x04, 0x10, 0x01, 0x4C, -+0xAA, 0xEC, 0xF5, 0x61, 0x00, 0x6A, 0x02, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x04, 0x67, 0x4C, 0xE8, -+0xAC, 0xEA, 0x7F, 0x6B, 0x82, 0x67, 0x6C, 0xEC, -+0x80, 0x18, 0x6D, 0x1C, 0x14, 0x6C, 0x98, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x4A, 0x48, 0x0C, 0x30, -+0xEF, 0xF4, 0x08, 0x4B, 0x6D, 0xE0, 0x12, 0xEA, -+0x44, 0xC3, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x63, 0x01, 0xD1, -+0x00, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, 0x05, 0x67, -+0x30, 0xF0, 0x20, 0x69, 0x43, 0xF4, 0xA4, 0x42, -+0xC0, 0xF1, 0x08, 0x49, 0xA4, 0x35, 0x06, 0x93, -+0x35, 0xE5, 0xFF, 0xF7, 0x1F, 0x6C, 0x20, 0xAD, -+0x8C, 0xEE, 0x8C, 0xEF, 0x8C, 0xEB, 0xD3, 0xE4, -+0x22, 0xEC, 0x03, 0x61, 0x39, 0xE6, 0xC0, 0xCD, -+0x03, 0x10, 0x01, 0x6C, 0x8B, 0xEC, 0x80, 0xCD, -+0x30, 0xF0, 0x20, 0x6D, 0xC3, 0xF3, 0x84, 0x42, -+0xC0, 0xF1, 0x08, 0x4D, 0x84, 0x34, 0xB1, 0xE4, -+0xA0, 0xAC, 0xFF, 0xF7, 0x1F, 0x6E, 0xFB, 0xE6, -+0xA2, 0xEE, 0x03, 0x61, 0xBD, 0xE7, 0xE0, 0xCC, -+0x03, 0x10, 0x01, 0x6D, 0xAB, 0xED, 0xA0, 0xCC, -+0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, -+0x87, 0xF1, 0xA8, 0x9C, 0x6F, 0xEE, 0xA3, 0xEE, -+0xAD, 0xE3, 0x02, 0x60, 0x01, 0x6B, 0x6B, 0xEB, -+0x87, 0xF1, 0x68, 0xDC, 0x30, 0xF0, 0x20, 0x6C, -+0xC3, 0xF4, 0x64, 0x42, 0xC0, 0xF1, 0x08, 0x4C, -+0x64, 0x33, 0x07, 0x96, 0x8D, 0xE3, 0x82, 0xAB, -+0xFF, 0xF7, 0x1F, 0x6D, 0xD7, 0xE5, 0x83, 0xED, -+0x91, 0xE6, 0x02, 0x60, 0x01, 0x6C, 0x8B, 0xEC, -+0x82, 0xCB, 0x43, 0xF5, 0x04, 0x4A, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x44, 0x32, -+0x69, 0xE2, 0x62, 0xAA, 0xFF, 0xF7, 0x1F, 0x6C, -+0x13, 0xE4, 0x63, 0xEC, 0x03, 0x61, 0x61, 0xE0, -+0x02, 0xCA, 0x03, 0x10, 0x01, 0x6B, 0x6B, 0xEB, -+0x62, 0xCA, 0x01, 0x91, 0x00, 0x90, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0x9C, 0xF1, 0xB8, 0x9A, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xA5, 0xE5, 0xF2, -+0xDB, 0xA2, 0x10, 0x6B, 0x8C, 0xEB, 0x02, 0x6C, -+0x8B, 0xEC, 0x72, 0x33, 0xCC, 0xEC, 0x6D, 0xEC, -+0xE5, 0xF2, 0x9B, 0xC2, 0xC0, 0xA5, 0x20, 0x6B, -+0xCC, 0xEB, 0x77, 0x33, 0x68, 0x36, 0x05, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0xCD, 0xEB, 0xE5, 0xF2, -+0x7B, 0xC2, 0xA0, 0xA5, 0x40, 0x6C, 0xAC, 0xEC, -+0x9A, 0x34, 0x84, 0x35, 0x03, 0x6C, 0x8B, 0xEC, -+0x6C, 0xEC, 0xAD, 0xEC, 0xE5, 0xF2, 0x9B, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xF8, 0x63, 0x0F, 0x62, -+0x0E, 0xD1, 0x0D, 0xD0, 0xFF, 0x6A, 0x4C, 0xEE, -+0x52, 0x68, 0x18, 0xEE, 0x30, 0xF0, 0x20, 0x6B, -+0x60, 0xF2, 0x08, 0x4B, 0x4C, 0xEC, 0x4C, 0xEF, -+0x4C, 0xED, 0x0A, 0xD6, 0x06, 0xD7, 0x12, 0xE8, -+0x01, 0xE3, 0x7F, 0x6B, 0x6C, 0xEC, 0x1D, 0x2D, -+0x0C, 0x5C, 0x05, 0x60, 0x30, 0xF0, 0x20, 0x6A, -+0xAF, 0xF0, 0x04, 0x4A, 0x1C, 0x10, 0x06, 0x93, -+0xF4, 0x4C, 0x4C, 0xEC, 0x08, 0x2B, 0x03, 0x6A, -+0x58, 0xEC, 0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF2, -+0x1C, 0x4A, 0x12, 0xEC, 0x36, 0x10, 0xE0, 0x4C, -+0x4C, 0xEC, 0x03, 0x6A, 0x58, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF2, 0x00, 0x4A, 0x12, 0xEC, -+0x2C, 0x10, 0x0C, 0x5C, 0x15, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0xAF, 0xF0, 0x10, 0x4A, 0x91, 0xE2, -+0x30, 0xF0, 0x20, 0x6A, 0x80, 0xA4, 0x4E, 0xF5, -+0x58, 0x9A, 0x0A, 0x95, 0x06, 0x96, 0x40, 0xEA, -+0x20, 0xF0, 0x86, 0xA0, 0x19, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x20, 0xF0, 0x66, 0xC0, 0xB5, 0x10, -+0x06, 0x93, 0xF4, 0x4C, 0x4C, 0xEC, 0x08, 0x2B, -+0x03, 0x6A, 0x58, 0xEC, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF3, 0x00, 0x4A, 0x12, 0xEC, 0x09, 0x10, -+0xE0, 0x4C, 0x4C, 0xEC, 0x03, 0x6A, 0x58, 0xEC, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF2, 0x04, 0x4A, -+0x12, 0xEC, 0x91, 0xE2, 0x01, 0x6A, 0x4B, 0xEA, -+0x7D, 0x67, 0x09, 0xD4, 0x00, 0x6C, 0x50, 0xC3, -+0x51, 0xC3, 0x52, 0xC3, 0x07, 0xD4, 0x24, 0x67, -+0x08, 0xD4, 0x0B, 0xD0, 0x09, 0x96, 0x00, 0xA6, -+0x2C, 0x70, 0x04, 0x61, 0x06, 0x92, 0x2C, 0x68, -+0x01, 0x2A, 0x0C, 0x68, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF5, 0x58, 0x9A, 0x0A, 0x95, 0x06, 0x96, -+0x90, 0x67, 0x01, 0x49, 0x40, 0xEA, 0xFF, 0x72, -+0xFF, 0x6B, 0x6C, 0xE9, 0x07, 0x61, 0x46, 0x70, -+0x11, 0x60, 0x08, 0x94, 0x91, 0xE1, 0x6C, 0xEC, -+0x08, 0xD4, 0x07, 0x10, 0x07, 0x96, 0xBD, 0x67, -+0xD1, 0xE5, 0x01, 0x4E, 0x6C, 0xEE, 0x50, 0xC4, -+0x07, 0xD6, 0x09, 0x92, 0x03, 0x71, 0x01, 0x4A, -+0x09, 0xD2, 0xD8, 0x61, 0x07, 0x92, 0x0B, 0x90, -+0x03, 0x6C, 0xFF, 0x4A, 0x8C, 0xEA, 0x20, 0xF0, -+0xA6, 0xA0, 0x4C, 0x33, 0x19, 0x6A, 0x4B, 0xEA, -+0xAC, 0xEA, 0x6D, 0xEA, 0x20, 0xF0, 0x46, 0xC0, -+0x08, 0x93, 0xFF, 0x6A, 0x06, 0x5B, 0x59, 0x60, -+0x20, 0xF0, 0x67, 0xA0, 0x02, 0x6A, 0x76, 0x33, -+0x8C, 0xEB, 0x20, 0xF0, 0x95, 0xA0, 0x8C, 0xEA, -+0x18, 0x22, 0x06, 0x94, 0x05, 0x24, 0x30, 0xF0, -+0x20, 0x6A, 0xAF, 0xF4, 0x08, 0x4A, 0x04, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, 0x00, 0x4A, -+0xAF, 0x43, 0x01, 0x6C, 0xA3, 0xEC, 0x09, 0x61, -+0xDD, 0x67, 0xB1, 0xA6, 0x40, 0x9A, 0x84, 0xED, -+0x4C, 0xEC, 0x03, 0x24, 0x50, 0xA6, 0xB0, 0xC6, -+0x51, 0xC6, 0x20, 0xF0, 0x95, 0xA0, 0x40, 0x6A, -+0x8C, 0xEA, 0x19, 0x22, 0x06, 0x92, 0x05, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, 0x18, 0x4A, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, -+0x10, 0x4A, 0xFF, 0x4B, 0x01, 0x6C, 0x63, 0xEC, -+0x0A, 0x61, 0xBD, 0x67, 0x71, 0xA5, 0x40, 0x9A, -+0x84, 0xEB, 0x4C, 0xEC, 0x04, 0x24, 0x01, 0x6A, -+0x4B, 0xEA, 0x70, 0xC5, 0x51, 0xC5, 0xDD, 0x67, -+0x71, 0xA6, 0xFF, 0x73, 0x05, 0x60, 0x52, 0xA6, -+0xFF, 0x72, 0x02, 0x60, 0x66, 0xC0, 0x0E, 0x10, -+0x7D, 0x67, 0x51, 0xA3, 0xFF, 0x72, 0x03, 0x60, -+0x72, 0xA3, 0xFF, 0x73, 0x07, 0x60, 0x9D, 0x67, -+0x51, 0xA4, 0xFF, 0x72, 0x04, 0x61, 0x52, 0xA4, -+0xFF, 0x72, 0x01, 0x60, 0x45, 0xC0, 0xBD, 0x67, -+0x50, 0xA5, 0x0F, 0x97, 0x0E, 0x91, 0x0D, 0x90, -+0x08, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x4C, 0xEE, 0x52, 0x6A, 0x58, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, 0xFF, 0xF7, -+0x1F, 0x6B, 0x6C, 0xED, 0x0F, 0xD7, 0x04, 0xD5, -+0x05, 0xD6, 0x12, 0xEC, 0x89, 0xE2, 0x86, 0x67, -+0x06, 0xD2, 0x62, 0xF5, 0x1C, 0x4C, 0x30, 0xF0, -+0x20, 0x6A, 0x84, 0x34, 0xC0, 0xF1, 0x08, 0x4A, -+0x49, 0xE4, 0x05, 0xAA, 0x03, 0xED, 0x0B, 0xE5, -+0x02, 0x60, 0x04, 0x94, 0x8B, 0xE0, 0x6C, 0xEA, -+0xFF, 0x4A, 0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEA, -+0x07, 0x5A, 0x1B, 0x60, 0x04, 0x92, 0x03, 0xEA, -+0x0C, 0x60, 0x05, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x62, 0xF5, 0x1C, 0x4B, -+0x64, 0x33, 0x49, 0xE3, 0x65, 0xAA, 0xFF, 0x4B, -+0x1A, 0x10, 0x05, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x62, 0xF5, 0x1C, 0x4B, -+0x64, 0x33, 0x49, 0xE3, 0x65, 0xAA, 0x01, 0x4B, -+0x0E, 0x10, 0x05, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x62, 0xF5, 0x1C, 0x4B, -+0x64, 0x33, 0x04, 0x94, 0x49, 0xE3, 0x0C, 0x33, -+0x0F, 0xE3, 0x8D, 0xE3, 0x6F, 0x33, 0x65, 0xCA, -+0x05, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x62, 0xF5, 0x1C, 0x4B, 0x64, 0x33, -+0x4D, 0xE3, 0x65, 0xAB, 0x65, 0xF4, 0x40, 0x9A, -+0x07, 0xD3, 0x02, 0x6B, 0x6C, 0xEA, 0x09, 0x22, -+0x07, 0x95, 0x04, 0x96, 0x10, 0xF0, 0x24, 0x6C, -+0x5D, 0xF1, 0x14, 0x4C, 0xF0, 0x67, 0x80, 0x18, -+0x35, 0x19, 0x04, 0x92, 0x43, 0xE8, 0x17, 0x61, -+0x06, 0x94, 0x43, 0xE0, 0xFF, 0xF7, 0x1F, 0x6A, -+0x20, 0xF0, 0x64, 0xA4, 0x4C, 0xE8, 0x0F, 0x6C, -+0x6E, 0x32, 0x8C, 0xEA, 0x44, 0x32, 0x01, 0x6D, -+0xAD, 0xEA, 0x8C, 0xEA, 0x80, 0x4C, 0xF8, 0x4C, -+0x4C, 0x32, 0x6C, 0xEC, 0x4D, 0xEC, 0x06, 0x92, -+0x20, 0xF0, 0x84, 0xC2, 0x15, 0x10, 0x04, 0x93, -+0x06, 0x94, 0xFF, 0xF7, 0x1F, 0x6A, 0x03, 0xE3, -+0x20, 0xF0, 0x64, 0xA4, 0x4C, 0xE8, 0x0F, 0x6C, -+0x6E, 0x32, 0x8C, 0xEA, 0x44, 0x32, 0x8C, 0xEA, -+0x4C, 0x34, 0x79, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x06, 0x93, 0x8D, 0xEA, 0x20, 0xF0, 0x44, 0xC3, -+0x05, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0x06, 0x94, -+0xC2, 0xF5, 0x10, 0x4B, 0x64, 0x33, 0xC0, 0xF1, -+0x08, 0x4A, 0x49, 0xE3, 0x25, 0xAA, 0x20, 0xF0, -+0x44, 0xA4, 0x03, 0x6B, 0x4E, 0x32, 0x6C, 0xEA, -+0xFF, 0x4A, 0x02, 0x5A, 0x03, 0x61, 0x03, 0x58, -+0x08, 0x61, 0x3E, 0x10, 0x09, 0x58, 0x09, 0x6A, -+0x01, 0x60, 0x50, 0x67, 0xFF, 0xF7, 0x1F, 0x68, -+0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x65, 0xF4, 0x60, 0x9A, 0x02, 0x6C, -+0x8C, 0xEB, 0x10, 0x23, 0x06, 0x93, 0x49, 0xE0, -+0x45, 0xF4, 0xF2, 0xA2, 0x20, 0xF0, 0xA4, 0xA3, -+0x10, 0xF0, 0x24, 0x6C, 0x0F, 0x6B, 0xAE, 0x35, -+0x7D, 0xF1, 0x0C, 0x4C, 0x6C, 0xED, 0xD0, 0x67, -+0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x41, 0xE0, 0x45, 0xF4, -+0x52, 0xA0, 0xFF, 0xF7, 0x1F, 0x6B, 0x49, 0xE1, -+0x6C, 0xEA, 0x0A, 0x5A, 0x00, 0x69, 0x06, 0x61, -+0x28, 0x42, 0xFE, 0x49, 0x6C, 0xE9, 0x1F, 0x59, -+0x01, 0x61, 0x1E, 0x69, 0x05, 0x93, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC2, 0xF5, -+0x10, 0x4B, 0x64, 0x33, 0x49, 0xE3, 0x25, 0xCA, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x65, 0xF4, 0x60, 0x9A, 0x02, 0x6C, 0x8C, 0xEB, -+0x0D, 0x23, 0x05, 0x93, 0x10, 0xF0, 0x24, 0x6C, -+0x9D, 0xF1, 0x04, 0x4C, 0xC2, 0xF5, 0x10, 0x4B, -+0x64, 0x33, 0x49, 0xE3, 0xA5, 0xAA, 0xD1, 0x67, -+0x80, 0x18, 0x35, 0x19, 0x07, 0x92, 0x11, 0x67, -+0x0B, 0x5A, 0x10, 0x61, 0x15, 0x59, 0x01, 0x6A, -+0x06, 0x60, 0x0B, 0x59, 0x58, 0x67, 0x01, 0x5A, -+0x58, 0x67, 0x03, 0x6B, 0x4B, 0xE3, 0x07, 0x90, -+0xF6, 0x48, 0x07, 0xEA, 0x01, 0xE1, 0xFF, 0xF7, -+0x1F, 0x6A, 0x4C, 0xE8, 0x28, 0x58, 0x01, 0x61, -+0x28, 0x68, 0x03, 0x59, 0x00, 0x69, 0x02, 0x60, -+0x04, 0x92, 0x4A, 0x31, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x08, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x9D, 0xF1, -+0x14, 0x4C, 0xB1, 0x67, 0xD0, 0x67, 0x80, 0x18, -+0x35, 0x19, 0x10, 0x92, 0x20, 0xCA, 0x0F, 0x93, -+0x00, 0xCB, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x52, 0x68, 0x18, 0xEC, 0x4C, 0xEF, 0x30, 0xF0, -+0x20, 0x6B, 0x0E, 0xD6, 0x06, 0xD4, 0x0D, 0xD5, -+0x05, 0xD7, 0x60, 0xF2, 0x08, 0x4B, 0x20, 0xA5, -+0x12, 0xE8, 0x01, 0xE3, 0x60, 0xA6, 0x04, 0xD3, -+0x20, 0xF0, 0xA5, 0xA0, 0x03, 0x6B, 0x04, 0x96, -+0xAC, 0xEB, 0x83, 0x67, 0x4C, 0xEC, 0xC2, 0xEC, -+0x03, 0x60, 0x0E, 0x92, 0x60, 0xC2, 0xB0, 0x10, -+0xA0, 0xF0, 0x0E, 0x24, 0x2F, 0x59, 0xA0, 0xF0, -+0x0B, 0x60, 0x30, 0x6B, 0xAC, 0xEB, 0x4C, 0xEB, -+0xA0, 0xF0, 0x06, 0x23, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x09, 0x22, 0x05, 0x95, 0x04, 0x96, 0x10, 0xF0, -+0x24, 0x6C, 0xBD, 0xF1, 0x0C, 0x4C, 0xF1, 0x67, -+0x80, 0x18, 0x35, 0x19, 0x05, 0x93, 0x01, 0x73, -+0x03, 0x60, 0x05, 0x6B, 0x01, 0x6A, 0x53, 0x10, -+0x04, 0x6B, 0x00, 0x6A, 0x50, 0x10, 0x05, 0x94, -+0x01, 0x74, 0x02, 0x61, 0x01, 0x4A, 0x01, 0x10, -+0xFF, 0x4A, 0xFF, 0x6B, 0x6C, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0x48, 0x34, 0x0F, 0xF2, 0x0C, 0x4B, -+0x6D, 0xE4, 0xC0, 0xAB, 0xFF, 0x6C, 0x03, 0x6D, -+0x66, 0x67, 0x8C, 0xEB, 0x04, 0xD3, 0xC2, 0x33, -+0x8C, 0xEB, 0x20, 0xF0, 0x85, 0xA0, 0x00, 0x69, -+0xE4, 0x67, 0xAC, 0xEF, 0x62, 0xEF, 0x09, 0x61, -+0x0D, 0x6F, 0x6C, 0xED, 0xEB, 0xEF, 0xA8, 0x35, -+0x8C, 0xEF, 0xAD, 0xEF, 0x20, 0xF0, 0xE5, 0xC0, -+0x01, 0x69, 0x30, 0xF0, 0x20, 0x6C, 0x0F, 0xF2, -+0x0C, 0x4C, 0x48, 0x32, 0x49, 0xE4, 0xE1, 0xAA, -+0x20, 0xF0, 0xA5, 0xA0, 0x03, 0x6C, 0xE2, 0x32, -+0xAC, 0xEC, 0x42, 0xEC, 0x3F, 0x61, 0xE5, 0xC0, -+0x06, 0x95, 0x30, 0xF0, 0x20, 0x6C, 0xEF, 0xF4, -+0x08, 0x4C, 0x4A, 0x4D, 0xAC, 0x35, 0x91, 0xE5, -+0x42, 0xC4, 0x45, 0xA0, 0xFF, 0x72, 0x32, 0x60, -+0x20, 0xF0, 0x86, 0xA0, 0x19, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x08, 0x6C, 0x8D, 0xEA, 0x20, 0xF0, -+0x46, 0xC0, 0x28, 0x10, 0x01, 0x4A, 0xFF, 0x6C, -+0x8C, 0xEA, 0x63, 0xEA, 0x44, 0x60, 0x30, 0xF0, -+0x20, 0x6C, 0x48, 0x35, 0x0F, 0xF2, 0x0C, 0x4C, -+0x91, 0xE5, 0xA0, 0xAC, 0xFF, 0x6C, 0xC5, 0x67, -+0x8C, 0xEE, 0x2E, 0xEE, 0x05, 0x2E, 0xA2, 0x35, -+0x8C, 0xED, 0x04, 0x94, 0x8E, 0xED, 0x9F, 0x25, -+0x30, 0xF0, 0x20, 0x6C, 0x48, 0x35, 0x0F, 0xF2, -+0x0C, 0x4C, 0xB1, 0xE4, 0xA1, 0xAC, 0xFF, 0x6C, -+0xC5, 0x67, 0x8C, 0xEE, 0x2E, 0xEE, 0xDE, 0x2E, -+0x04, 0x96, 0xA2, 0x35, 0x8C, 0xED, 0xCE, 0xED, -+0xD9, 0x2D, 0x8D, 0x17, 0x00, 0x68, 0x09, 0x21, -+0x5D, 0x67, 0x87, 0x42, 0x09, 0x4C, 0x0D, 0x92, -+0x80, 0xA4, 0x01, 0x68, 0x80, 0xC2, 0x0E, 0x92, -+0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x09, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0xDD, 0xF1, 0x08, 0x4C, -+0xB0, 0x67, 0x80, 0x18, 0x35, 0x19, 0x01, 0x10, -+0x00, 0x68, 0x50, 0x67, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, 0x00, 0x68, -+0xF0, 0x67, 0xD0, 0x67, 0xE6, 0x17, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x68, 0x0C, 0xEC, 0xAC, 0xE8, 0xFF, 0x70, -+0x3A, 0x60, 0x52, 0x6A, 0x58, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, 0x7F, 0x69, -+0x0C, 0xE9, 0x12, 0xEC, 0x89, 0xE2, 0x04, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF5, 0x48, 0x9A, -+0x91, 0x67, 0x40, 0xEA, 0x4B, 0xEB, 0x4D, 0xEB, -+0x04, 0x92, 0xC0, 0xF7, 0x62, 0x33, 0x7F, 0x6C, -+0x6D, 0xE2, 0x40, 0xF0, 0x65, 0xA3, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x04, 0xD3, -+0x8C, 0xEB, 0x05, 0xD3, 0x04, 0x6B, 0x6C, 0xEA, -+0x08, 0x22, 0x04, 0x96, 0x10, 0xF0, 0x24, 0x6C, -+0xFD, 0xF1, 0x00, 0x4C, 0xB0, 0x67, 0x80, 0x18, -+0x35, 0x19, 0x05, 0x92, 0x23, 0xEA, 0x0B, 0x61, -+0x4E, 0xE9, 0x0A, 0x29, 0x04, 0x94, 0x80, 0x6B, -+0x80, 0x6A, 0x6B, 0xEB, 0x0C, 0xEA, 0x8C, 0xEB, -+0x4E, 0xEB, 0x01, 0x23, 0x01, 0x22, 0xFF, 0x68, -+0x50, 0x67, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6A, 0x4C, 0xEE, -+0x4C, 0xED, 0x62, 0x46, 0xA2, 0xEB, 0x4C, 0xEC, -+0xEC, 0xEA, 0x04, 0x61, 0xFE, 0x4E, 0xC2, 0xED, -+0x01, 0x61, 0x25, 0x22, 0x52, 0x69, 0x38, 0xEC, -+0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x68, 0xFF, 0x6D, 0x02, 0x6E, -+0x12, 0xE9, 0x25, 0xE2, 0x4E, 0xF2, 0x4C, 0x98, -+0x87, 0x41, 0x3E, 0x4C, 0x40, 0xEA, 0x4E, 0xF2, -+0x4C, 0x98, 0x87, 0x41, 0x40, 0x4C, 0x00, 0x6D, -+0x02, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF4, 0x00, 0x6A, -+0x6C, 0xEA, 0x13, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0xFD, 0xF1, 0x0C, 0x4C, 0x0C, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF4, -+0x00, 0x6A, 0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0xFD, 0xF1, 0x18, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x00, 0x68, 0x52, 0x6A, 0x58, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0x60, 0xF2, 0x08, 0x4B, -+0x12, 0xEA, 0x49, 0xE3, 0x20, 0xF0, 0x85, 0xA2, -+0x80, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xFF, 0x6C, -+0x8C, 0xEB, 0x3D, 0x2B, 0x40, 0xF0, 0x85, 0xA2, -+0xFF, 0x74, 0x0E, 0x60, 0x40, 0xF0, 0x87, 0xA2, -+0x63, 0x5C, 0x04, 0x60, 0x01, 0x4C, 0x40, 0xF0, -+0x87, 0xC2, 0x06, 0x10, 0x40, 0xF0, 0x67, 0xC2, -+0x01, 0x6B, 0x6B, 0xEB, 0x40, 0xF0, 0x65, 0xC2, -+0x40, 0xF0, 0x66, 0xA2, 0xFF, 0x73, 0x0F, 0x60, -+0x40, 0xF0, 0x68, 0xA2, 0x63, 0x5B, 0x08, 0x61, -+0x00, 0x6B, 0x40, 0xF0, 0x68, 0xC2, 0x01, 0x6B, -+0x6B, 0xEB, 0x40, 0xF0, 0x66, 0xC2, 0x03, 0x10, -+0x01, 0x4B, 0x40, 0xF0, 0x68, 0xC2, 0x17, 0x28, -+0x30, 0xF0, 0x20, 0x6C, 0x25, 0xF6, 0x88, 0x9C, -+0x00, 0xF4, 0x00, 0x6B, 0x8C, 0xEB, 0x0F, 0x23, -+0x40, 0xF0, 0xA5, 0xA2, 0x40, 0xF0, 0xC6, 0xA2, -+0x40, 0xF0, 0xE7, 0xA2, 0x40, 0xF0, 0x48, 0xA2, -+0x10, 0xF0, 0x24, 0x6C, 0x1D, 0xF2, 0x04, 0x4C, -+0x04, 0xD2, 0x80, 0x18, 0x35, 0x19, 0x01, 0x48, -+0xFF, 0x6A, 0x4C, 0xE8, 0x80, 0x70, 0xAE, 0x61, -+0x07, 0x97, 0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0xFF, 0x6B, 0x6C, 0xEE, 0x52, 0x68, 0x18, 0xEE, -+0x12, 0x91, 0x13, 0x92, 0x6C, 0xEF, 0x6C, 0xE9, -+0x6C, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0x60, 0xF2, -+0x08, 0x4B, 0x08, 0xD7, 0x12, 0xE8, 0x01, 0xE3, -+0x20, 0xF0, 0x73, 0xA0, 0xEE, 0xEB, 0x06, 0x2B, -+0x7E, 0xA0, 0x03, 0x6C, 0x6A, 0x33, 0x8C, 0xEB, -+0x2E, 0xEB, 0x25, 0x23, 0x7D, 0x67, 0x87, 0x43, -+0x19, 0x4C, 0x80, 0xA4, 0x55, 0xC3, 0x00, 0x6A, -+0xD3, 0xC3, 0x92, 0xC3, 0x56, 0xC3, 0x56, 0xA8, -+0x38, 0xC3, 0x06, 0x96, 0x57, 0xC3, 0x0C, 0x6A, -+0x50, 0xC3, 0x07, 0x6A, 0x4F, 0xCB, 0x04, 0x94, -+0x05, 0x95, 0x07, 0x97, 0x80, 0x18, 0x47, 0x10, -+0x7D, 0x67, 0x87, 0x43, 0x19, 0x4C, 0x60, 0xA4, -+0x03, 0x6A, 0x2C, 0xEA, 0x9E, 0xA0, 0x20, 0xF0, -+0x73, 0xC0, 0x48, 0x33, 0x0D, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x6D, 0xEA, 0x5E, 0xC0, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xF8, 0x63, 0x0F, 0x62, 0x0E, 0xD1, 0x0D, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0xFF, 0x6B, 0x06, 0xD2, -+0x6C, 0xED, 0xFF, 0x6C, 0x7F, 0x6A, 0xEC, 0xEC, -+0xAC, 0xEA, 0x0A, 0xD4, 0x07, 0xD2, 0xCC, 0xEB, -+0x06, 0x94, 0x10, 0xF0, 0x24, 0x6A, 0x0B, 0xD3, -+0x7C, 0xF1, 0x48, 0x9A, 0x80, 0x6B, 0xAC, 0xEB, -+0x09, 0xD3, 0x94, 0x33, 0x49, 0xE3, 0x40, 0xA2, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF5, 0x4C, 0x9A, -+0x07, 0x95, 0x09, 0x96, 0x0A, 0x97, 0x40, 0xEA, -+0xFF, 0x72, 0x22, 0x67, 0xA0, 0xF0, 0x05, 0x60, -+0x06, 0x92, 0x52, 0x68, 0x06, 0x95, 0x18, 0xEA, -+0x05, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF2, -+0x08, 0x4A, 0x12, 0xE8, 0x01, 0xE2, 0x30, 0xF0, -+0x20, 0x6A, 0x78, 0xED, 0xC0, 0xF1, 0x08, 0x4A, -+0xFF, 0x6D, 0x12, 0xEC, 0x49, 0xE4, 0x07, 0xF4, -+0x4C, 0xA2, 0x07, 0x6C, 0x4C, 0xEC, 0x0B, 0x92, -+0xAC, 0xEC, 0x08, 0xD4, 0x29, 0x2A, 0x63, 0xA0, -+0x5F, 0xA0, 0x6E, 0xEA, 0x0C, 0x22, 0x06, 0x94, -+0x30, 0xF0, 0x20, 0x6A, 0xBD, 0x67, 0x8C, 0x33, -+0x2F, 0xF7, 0x18, 0x4A, 0x69, 0xE2, 0x67, 0x45, -+0x25, 0x4B, 0xA0, 0xAB, 0xA3, 0xCA, 0x20, 0xF0, -+0x66, 0xA0, 0x41, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x20, 0xF0, 0x46, 0xC0, 0x23, 0xC0, 0x06, 0x94, -+0xB1, 0x67, 0x80, 0x18, 0x7D, 0x1C, 0x0A, 0x93, -+0x06, 0x96, 0x00, 0x6A, 0x82, 0x67, 0xA2, 0x67, -+0xF1, 0x67, 0x05, 0xD2, 0x04, 0xD3, 0x80, 0x18, -+0xDC, 0x1E, 0x00, 0x6A, 0x82, 0x67, 0x29, 0x10, -+0x20, 0xF0, 0x86, 0xA0, 0x40, 0x6A, 0x23, 0xC0, -+0x8D, 0xEA, 0x20, 0xF0, 0x46, 0xC0, 0x0A, 0x95, -+0x06, 0x96, 0x00, 0x6C, 0x04, 0xD5, 0xF1, 0x67, -+0xA4, 0x67, 0x05, 0xD3, 0x80, 0x18, 0xDC, 0x1E, -+0x07, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF1, -+0x04, 0x4A, 0x49, 0xE3, 0x40, 0xA2, 0x30, 0xF0, -+0x20, 0x6B, 0x6F, 0xF3, 0x08, 0x4B, 0x20, 0xF0, -+0x48, 0xC0, 0x07, 0x94, 0x6D, 0xE4, 0x60, 0xA3, -+0x20, 0xF0, 0x92, 0xA0, 0x63, 0xEC, 0x03, 0x60, -+0x04, 0x4A, 0x20, 0xF0, 0x48, 0xC0, 0x01, 0x6A, -+0x40, 0x6C, 0x0A, 0x95, 0xAC, 0x33, 0x08, 0x95, -+0x6D, 0xE5, 0x8D, 0xEB, 0x00, 0xF6, 0x60, 0x33, -+0xFF, 0x6C, 0x00, 0xF6, 0x63, 0x33, 0x8C, 0xEB, -+0x06, 0x94, 0x03, 0x5C, 0x0A, 0x60, 0x10, 0xF0, -+0x24, 0x6C, 0x9C, 0xF1, 0x9C, 0x9C, 0x20, 0xC4, -+0x10, 0xF0, 0x24, 0x6C, 0xBC, 0xF1, 0x88, 0x9C, -+0x60, 0xC4, 0x30, 0xF0, 0x20, 0x6C, 0xC5, 0xF4, -+0xA3, 0xA4, 0x04, 0x6C, 0xAC, 0xEC, 0x05, 0x24, -+0x07, 0x94, 0x09, 0x91, 0x8D, 0xE9, 0xFF, 0x6C, -+0x8C, 0xE9, 0x06, 0x95, 0xB4, 0x34, 0x10, 0xF0, -+0x24, 0x6D, 0x7C, 0xF1, 0xAC, 0x9D, 0xB5, 0xE4, -+0x20, 0xC5, 0x10, 0xF0, 0x24, 0x6D, 0x7C, 0xF1, -+0xA8, 0x9D, 0xB5, 0xE4, 0x60, 0xC5, 0x10, 0xF0, -+0x24, 0x6B, 0xBC, 0xF1, 0x6C, 0x9B, 0x71, 0xE4, -+0x40, 0xC4, 0x0F, 0x97, 0x0E, 0x91, 0x0D, 0x90, -+0x08, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x69, 0x8C, 0xE9, -+0x52, 0x68, 0x18, 0xE9, 0x30, 0xF0, 0x20, 0x6A, -+0x60, 0xF2, 0x08, 0x4A, 0x12, 0xE8, 0x01, 0xE2, -+0x84, 0xA0, 0x0F, 0x5C, 0x53, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x88, 0x33, 0x9B, 0xF2, 0x1C, 0x4A, -+0x69, 0xE2, 0x40, 0x9A, 0x00, 0xEA, 0x1B, 0x6A, -+0x2E, 0x10, 0x3D, 0x6A, 0x20, 0xF0, 0x60, 0xA0, -+0x47, 0xC0, 0x08, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x02, 0x6B, 0x3A, 0x10, 0x20, 0xF0, 0x60, 0xA0, -+0x13, 0x6A, 0x47, 0xC0, 0x08, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x01, 0x6B, 0x6D, 0xEA, 0x20, 0xF0, -+0x40, 0xC0, 0x20, 0xF0, 0x60, 0xA0, 0x33, 0x6A, -+0x47, 0xC0, 0x08, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x01, 0x6B, 0x6D, 0xEA, 0x20, 0xF0, 0x40, 0xC0, -+0x04, 0x6D, 0x30, 0x10, 0x20, 0xF0, 0x60, 0xA0, -+0x0B, 0x6A, 0x47, 0xC0, 0x08, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x03, 0x6E, 0x20, 0xF0, 0x40, 0xC0, -+0x04, 0xD6, 0x25, 0x10, 0x47, 0x6A, 0x20, 0xF0, -+0x60, 0xA0, 0x47, 0xC0, 0x08, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x03, 0x6B, 0x6D, 0xEA, 0x20, 0xF0, -+0x40, 0xC0, 0x05, 0x6A, 0x04, 0xD2, 0x17, 0x10, -+0x23, 0x6A, 0x20, 0xF0, 0x60, 0xA0, 0x47, 0xC0, -+0x08, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x03, 0x6B, -+0x6D, 0xEA, 0x05, 0x6B, 0x20, 0xF0, 0x40, 0xC0, -+0x04, 0xD3, 0x09, 0x10, 0x20, 0xF0, 0x60, 0xA0, -+0x08, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x20, 0xF0, -+0x40, 0xC0, 0x03, 0x6D, 0x04, 0xD5, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF1, 0x54, 0x9A, 0x2C, 0x35, -+0x8C, 0x34, 0x55, 0xE5, 0x10, 0xF0, 0x30, 0x6A, -+0x24, 0xF3, 0x0C, 0x4A, 0x91, 0xE2, 0xE5, 0x67, -+0xFD, 0x65, 0x00, 0x6A, 0x05, 0xD5, 0x05, 0x96, -+0x48, 0x33, 0x20, 0xF0, 0xA5, 0xA0, 0xCD, 0xE3, -+0x60, 0x9B, 0xC0, 0x9C, 0x1D, 0x65, 0xB8, 0x67, -+0xCC, 0xEB, 0x03, 0x6E, 0xAC, 0xEE, 0x02, 0x76, -+0x07, 0x61, 0xFF, 0x6E, 0x4C, 0xEE, 0x01, 0x76, -+0x03, 0x61, 0x41, 0x6E, 0xCB, 0xEE, 0xCC, 0xEB, -+0x48, 0x36, 0xF5, 0xE6, 0x60, 0xDD, 0x01, 0x4A, -+0x7F, 0x67, 0x79, 0xE6, 0x02, 0x72, 0x60, 0x9E, -+0x04, 0x4C, 0xE1, 0x61, 0x10, 0xF0, 0x24, 0x6B, -+0x7C, 0xF1, 0x74, 0x9B, 0x2C, 0x32, 0x91, 0x67, -+0x6D, 0xE2, 0xA0, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0x7C, 0xF1, 0x78, 0x9B, 0x69, 0xE2, 0xC0, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, 0x4C, 0x9A, -+0x34, 0x33, 0x49, 0xE3, 0x40, 0xA2, 0xFF, 0x6B, -+0x4C, 0xEB, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, -+0x40, 0x9A, 0x05, 0xD3, 0x40, 0xEA, 0x05, 0x96, -+0x20, 0xF0, 0xE5, 0xA0, 0x80, 0x6D, 0xAB, 0xED, -+0xCC, 0xED, 0x4D, 0xED, 0xEA, 0x37, 0x03, 0x6A, -+0x4C, 0xEF, 0xFF, 0x6A, 0x4C, 0xEF, 0x4C, 0xED, -+0x00, 0x6E, 0x91, 0x67, 0x80, 0x18, 0x00, 0x1F, -+0x7D, 0x67, 0xA7, 0x43, 0x09, 0x4D, 0x60, 0xA5, -+0x30, 0xF0, 0x20, 0x6A, 0x91, 0x67, 0x62, 0xC0, -+0x6E, 0xF5, 0x44, 0x9A, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF5, 0x48, 0x9A, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x01, 0x6B, 0x6C, 0xEA, 0x09, 0x22, 0xA0, 0xA0, -+0xC1, 0xA0, 0xE2, 0xA0, 0x10, 0xF0, 0x24, 0x6C, -+0x1D, 0xF2, 0x1C, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF1, 0x50, 0x9A, 0x00, 0x68, 0x60, 0xA2, -+0xFF, 0x6A, 0x83, 0x67, 0x10, 0xF0, 0x24, 0x6B, -+0x9C, 0xF1, 0x78, 0x9B, 0x4C, 0xEC, 0x06, 0xD4, -+0x60, 0xA3, 0x01, 0x6C, 0x6C, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x56, 0x32, -+0x8C, 0xEA, 0xE5, 0xF2, 0xBB, 0xA3, 0x48, 0x34, -+0x05, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0x8D, 0xEA, -+0xE5, 0xF2, 0x5B, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF5, 0x58, 0x9A, 0x90, 0x67, 0x40, 0xEA, -+0x69, 0x22, 0x52, 0x69, 0x38, 0xE8, 0x30, 0xF0, -+0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, 0x04, 0x6B, -+0xFF, 0x6C, 0x12, 0xE9, 0x25, 0xE2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xE5, 0xF2, -+0xBB, 0xA2, 0xAC, 0xEB, 0x26, 0x23, 0x06, 0x93, -+0x0A, 0xEB, 0x23, 0x61, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF1, 0x74, 0x9B, 0x65, 0xF4, 0x40, 0x9A, -+0x60, 0xA3, 0xA3, 0x67, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF1, 0x78, 0x9B, 0x8C, 0xED, 0x04, 0xD5, -+0x60, 0xA3, 0x6C, 0xEC, 0x10, 0x6B, 0x6C, 0xEA, -+0x05, 0xD4, 0x09, 0x22, 0x05, 0x96, 0x04, 0x97, -+0x10, 0xF0, 0x24, 0x6C, 0x3D, 0xF2, 0x14, 0x4C, -+0xB0, 0x67, 0x80, 0x18, 0x35, 0x19, 0x04, 0x95, -+0x05, 0x97, 0x90, 0x67, 0x00, 0x6E, 0x80, 0x18, -+0x00, 0x1F, 0x67, 0x40, 0x30, 0xF0, 0x20, 0x6A, -+0x43, 0x4B, 0x6C, 0x33, 0xEF, 0xF4, 0x08, 0x4A, -+0x49, 0xE3, 0x41, 0xA2, 0x05, 0x2A, 0x20, 0xF0, -+0x67, 0xA1, 0x80, 0x4A, 0x6D, 0xEA, 0x04, 0x10, -+0x20, 0xF0, 0x67, 0xA1, 0x7F, 0x6A, 0x6C, 0xEA, -+0x20, 0xF0, 0x47, 0xC1, 0x11, 0x28, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x10, 0x6B, -+0x6C, 0xEA, 0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x2F, 0xF7, 0xB9, 0xA2, 0x10, 0xF0, 0x24, 0x6C, -+0x5D, 0xF2, 0x10, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x67, 0x40, 0x30, 0xF0, 0x20, 0x6A, 0x43, 0x4B, -+0x6C, 0x33, 0xEF, 0xF4, 0x08, 0x4A, 0x49, 0xE3, -+0x00, 0x6B, 0x61, 0xC2, 0x01, 0x48, 0xFF, 0x6A, -+0x4C, 0xE8, 0x80, 0x70, 0x8B, 0x61, 0x80, 0x18, -+0xAF, 0x1E, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF5, -+0x48, 0x9A, 0x40, 0xEA, 0x80, 0x18, 0x33, 0x1C, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, -+0x52, 0x68, 0x18, 0xEA, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, 0x03, 0x6B, -+0x12, 0xE8, 0x01, 0xE2, 0x20, 0xF0, 0x86, 0xA0, -+0x20, 0xF0, 0xA5, 0xA0, 0x3F, 0xA0, 0x8C, 0xEB, -+0x68, 0x34, 0x0D, 0x6B, 0x6B, 0xEB, 0xAC, 0xEB, -+0x8D, 0xEB, 0x40, 0xA0, 0x20, 0xF0, 0x65, 0xC0, -+0x7F, 0x6B, 0x2C, 0xEB, 0x63, 0xEA, 0x01, 0x60, -+0x22, 0x67, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, 0x0C, 0x22, -+0x20, 0xF0, 0xC5, 0xA0, 0x10, 0xF0, 0x24, 0x6C, -+0x03, 0x6A, 0xCA, 0x36, 0x5D, 0xF2, 0x1C, 0x4C, -+0xB1, 0x67, 0x4C, 0xEE, 0x80, 0x18, 0x35, 0x19, -+0x5F, 0xA0, 0x80, 0x6D, 0xAB, 0xED, 0x4C, 0xED, -+0x20, 0xF0, 0xE5, 0xA0, 0x2D, 0xED, 0x00, 0xF6, -+0xA0, 0x35, 0x04, 0x94, 0xFF, 0x6A, 0x00, 0xF6, -+0xA3, 0x35, 0x4C, 0xED, 0xEA, 0x37, 0x03, 0x6A, -+0x4C, 0xEF, 0x00, 0x6E, 0x80, 0x18, 0x00, 0x1F, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF6, 0x63, 0x13, 0x62, -+0x12, 0xD1, 0x11, 0xD0, 0xFF, 0x6F, 0xEC, 0xEC, -+0x52, 0x68, 0x18, 0xEC, 0x30, 0xF0, 0x20, 0x6A, -+0x60, 0xF2, 0x08, 0x4A, 0x94, 0x33, 0xEC, 0xED, -+0x09, 0xD4, 0x0C, 0xD5, 0x7F, 0x69, 0x12, 0xE8, -+0x01, 0xE2, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, -+0x4C, 0x9A, 0x49, 0xE3, 0x40, 0xA2, 0x7D, 0x67, -+0x58, 0xC3, 0x98, 0xA3, 0x03, 0x6B, 0x1B, 0x65, -+0x08, 0xD4, 0xA0, 0xA0, 0x8C, 0xE9, 0x98, 0x67, -+0x0A, 0xD5, 0x20, 0xF0, 0xC5, 0xA0, 0xBD, 0x67, -+0xD2, 0x32, 0x6C, 0xEA, 0xEC, 0xEA, 0x0B, 0xD2, -+0x47, 0x45, 0xCA, 0x33, 0x19, 0x4A, 0x40, 0xA2, -+0x8C, 0xEB, 0x79, 0xC5, 0x20, 0xF0, 0x86, 0xA0, -+0x5F, 0xC0, 0x04, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0x6D, 0xEA, 0x01, 0x6B, 0x6B, 0xEB, 0x65, 0xC0, -+0x66, 0xC0, 0x09, 0x95, 0x30, 0xF0, 0x20, 0x6C, -+0xEF, 0xF4, 0x08, 0x4C, 0x4A, 0x4D, 0xAC, 0x35, -+0x95, 0xE5, 0x62, 0xC5, 0x09, 0x95, 0xAC, 0x35, -+0x91, 0xE5, 0x0E, 0xD5, 0x40, 0xF2, 0x73, 0xC4, -+0x20, 0xF0, 0x87, 0xA0, 0x11, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x20, 0xF0, 0x67, 0xC0, 0x80, 0x6B, -+0x6B, 0xEB, 0x6D, 0xEA, 0x67, 0x4B, 0x6C, 0xEA, -+0x20, 0xF0, 0x46, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, -+0x0C, 0x22, 0x58, 0x67, 0x7D, 0x67, 0xCC, 0xEA, -+0x08, 0x95, 0xD9, 0xA3, 0x10, 0xF0, 0x24, 0x6C, -+0x7D, 0xF2, 0x10, 0x4C, 0x4C, 0xEF, 0x80, 0x18, -+0x35, 0x19, 0x0A, 0x94, 0x83, 0xE9, 0x79, 0x60, -+0x09, 0x94, 0x06, 0x05, 0x00, 0xF0, 0x19, 0x06, -+0x01, 0x6F, 0x80, 0x18, 0xF7, 0x1D, 0xA0, 0xF0, -+0x09, 0x2A, 0xBD, 0x67, 0x20, 0xF0, 0x45, 0xA0, -+0x99, 0xA5, 0x03, 0x6B, 0xA3, 0x67, 0x4C, 0xED, -+0xA2, 0xEC, 0x1A, 0x60, 0xDD, 0x67, 0x01, 0x4C, -+0x0D, 0x6D, 0x99, 0xC6, 0xAB, 0xED, 0x6C, 0xEC, -+0x4C, 0xED, 0x88, 0x34, 0x8D, 0xED, 0x38, 0xC6, -+0x30, 0xF0, 0x20, 0x6A, 0x20, 0xF0, 0xA5, 0xC0, -+0x25, 0xF6, 0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, -+0x07, 0x22, 0xB9, 0xA6, 0x10, 0xF0, 0x24, 0x6C, -+0x9D, 0xF2, 0x0C, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0xDD, 0x67, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, -+0x4C, 0x9A, 0x09, 0x94, 0xB8, 0xA6, 0x40, 0xEA, -+0xFF, 0x72, 0x08, 0xD2, 0x08, 0x61, 0x47, 0x41, -+0x4C, 0x4A, 0x08, 0xD2, 0x08, 0x93, 0xFF, 0x6A, -+0x4C, 0xEB, 0x08, 0xD3, 0x17, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x04, 0x6B, -+0x6C, 0xEA, 0x07, 0x22, 0x08, 0x95, 0x10, 0xF0, -+0x24, 0x6C, 0x9D, 0xF2, 0x1C, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x9D, 0x67, 0xA7, 0x44, 0x19, 0x4D, -+0xA0, 0xA5, 0xB8, 0xC4, 0x5F, 0x10, 0x01, 0x49, -+0xFF, 0x6A, 0x4C, 0xE9, 0x09, 0x96, 0x0B, 0x97, -+0x91, 0x67, 0x00, 0x6D, 0x80, 0x18, 0xD7, 0x1C, -+0xDD, 0x67, 0x58, 0xC6, 0x58, 0xA6, 0xFF, 0x72, -+0x08, 0x61, 0x0A, 0x92, 0x43, 0xE9, 0x02, 0x61, -+0x58, 0xC6, 0x03, 0x10, 0x08, 0x94, 0x8A, 0xE9, -+0xEA, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, 0x42, 0x22, -+0xDD, 0x67, 0xB8, 0xA6, 0x10, 0xF0, 0x24, 0x6C, -+0xBD, 0xF2, 0x0C, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x39, 0x10, 0x0A, 0x92, 0x4E, 0xE9, 0x21, 0x29, -+0x20, 0xF0, 0x46, 0xA0, 0x04, 0x6B, 0x6C, 0xEA, -+0xE0, 0xF0, 0x0C, 0x22, 0x08, 0x92, 0x80, 0x6C, -+0x8B, 0xEC, 0x8C, 0xEA, 0xFF, 0x6D, 0xAC, 0xEA, -+0xE0, 0xF0, 0x04, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0x0A, 0x95, 0x25, 0xF6, 0x48, 0x9A, 0xDD, 0x67, -+0xAD, 0xEC, 0x6C, 0xEA, 0x98, 0xC6, 0xA0, 0xF0, -+0x1F, 0x22, 0xB8, 0xA6, 0x10, 0xF0, 0x24, 0x6C, -+0xBD, 0xF2, 0x18, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0xB7, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, 0x08, 0x22, -+0x5D, 0x67, 0xB8, 0xA2, 0x10, 0xF0, 0x24, 0x6C, -+0xDD, 0xF2, 0x04, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x7D, 0x67, 0x87, 0x43, 0x21, 0x4C, 0x80, 0xA4, -+0x98, 0xC3, 0x9F, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, -+0x0A, 0x22, 0xDD, 0x67, 0xB8, 0xA6, 0xE6, 0xA0, -+0xC5, 0xA0, 0x10, 0xF0, 0x24, 0x6C, 0xDD, 0xF2, -+0x10, 0x4C, 0x80, 0x18, 0x35, 0x19, 0x5D, 0x67, -+0x09, 0x94, 0xB8, 0xA2, 0x80, 0x18, 0x66, 0x1E, -+0x7D, 0x67, 0x58, 0xC3, 0x09, 0x94, 0xA5, 0xA0, -+0x80, 0x18, 0x66, 0x1E, 0x45, 0xC0, 0x09, 0x94, -+0xA6, 0xA0, 0x80, 0x18, 0x66, 0x1E, 0x46, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x0A, 0x22, 0xDD, 0x67, -+0xB8, 0xA6, 0xE6, 0xA0, 0xC5, 0xA0, 0x10, 0xF0, -+0x24, 0x6C, 0xFD, 0xF2, 0x00, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x46, 0xA0, 0xFF, 0x6B, 0x85, 0xA0, -+0x4E, 0xEB, 0x01, 0x5B, 0x78, 0x67, 0xFF, 0x74, -+0x05, 0x61, 0x45, 0xC0, 0x01, 0x6A, 0x4B, 0xEA, -+0x46, 0xC0, 0x01, 0x4B, 0x9D, 0x67, 0x58, 0xA4, -+0xFF, 0x72, 0x09, 0x61, 0x45, 0xA0, 0x01, 0x4B, -+0x58, 0xC4, 0x01, 0x6A, 0x4B, 0xEA, 0x45, 0xC0, -+0xFF, 0x6A, 0x4C, 0xEB, 0x08, 0x10, 0x07, 0x2B, -+0x20, 0xF0, 0x66, 0xA0, 0x19, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x10, 0x6B, 0x08, 0x10, 0x01, 0x73, -+0x08, 0x61, 0x20, 0xF0, 0x66, 0xA0, 0x19, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x08, 0x6B, 0x6D, 0xEA, -+0x07, 0x10, 0x02, 0x73, 0x0F, 0x61, 0x20, 0xF0, -+0x66, 0xA0, 0x19, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x20, 0xF0, 0x46, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, -+0x33, 0x22, 0x22, 0x10, 0x20, 0xF0, 0x66, 0xA0, -+0x19, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x20, 0xF0, -+0x46, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x04, 0x6B, 0x6C, 0xEA, 0x06, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0xFD, 0xF2, 0x10, 0x4C, -+0x80, 0x18, 0x35, 0x19, 0x20, 0xF0, 0x66, 0xA0, -+0x03, 0x6A, 0x20, 0xF0, 0x85, 0xA0, 0x6C, 0xEA, -+0x48, 0x33, 0x0D, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0x6D, 0xEA, 0x20, 0xF0, 0x45, 0xC0, 0x2A, 0x10, -+0x20, 0xF0, 0x46, 0xA0, 0xDD, 0x67, 0xB8, 0xA6, -+0xE6, 0xA0, 0xC5, 0xA0, 0x4E, 0x32, 0x03, 0x6B, -+0x10, 0xF0, 0x24, 0x6C, 0x6C, 0xEA, 0xFD, 0xF2, -+0x1C, 0x4C, 0x04, 0xD2, 0x80, 0x18, 0x35, 0x19, -+0x0C, 0x92, 0x01, 0x6E, 0x01, 0x72, 0x08, 0x61, -+0x20, 0xF0, 0x66, 0xA0, 0x19, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x20, 0xF0, 0x46, 0xC0, 0x00, 0x6E, -+0x20, 0xF0, 0x63, 0xA0, 0x0F, 0x6A, 0x6C, 0xEA, -+0x10, 0x6B, 0x6D, 0xEA, 0x20, 0xF0, 0x43, 0xC0, -+0x7D, 0x67, 0x09, 0x94, 0xB8, 0xA3, 0xF9, 0xA3, -+0x80, 0x18, 0x00, 0x1F, 0x13, 0x97, 0x12, 0x91, -+0x11, 0x90, 0x0A, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF7, 0x63, 0x11, 0x62, 0x10, 0xD1, 0x0F, 0xD0, -+0xFF, 0x6F, 0xEC, 0xEC, 0x52, 0x68, 0x18, 0xEC, -+0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF2, 0x08, 0x4A, -+0x94, 0x33, 0xEC, 0xED, 0xEC, 0xEE, 0x08, 0xD4, -+0x0C, 0xD6, 0x07, 0xD5, 0x7F, 0x69, 0x12, 0xE8, -+0x01, 0xE2, 0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, -+0x4C, 0x9A, 0x49, 0xE3, 0x40, 0xA2, 0x7D, 0x67, -+0x50, 0xC3, 0x40, 0xA0, 0xD0, 0xA3, 0x06, 0xD2, -+0x61, 0xA0, 0xFE, 0x65, 0xCC, 0xE9, 0x0A, 0xD3, -+0x20, 0xF0, 0xC5, 0xA0, 0xD2, 0x32, 0x09, 0xD2, -+0x09, 0x93, 0x03, 0x6A, 0xCA, 0x34, 0x4C, 0xEB, -+0x0B, 0xD6, 0x4C, 0xEC, 0xEC, 0xEB, 0xDD, 0x67, -+0x09, 0xD3, 0x91, 0xC6, 0x20, 0xF0, 0xA6, 0xA0, -+0x04, 0x6B, 0x6B, 0xEB, 0xAC, 0xEB, 0x8D, 0xEB, -+0x01, 0x6C, 0x8B, 0xEC, 0x85, 0xC0, 0x86, 0xC0, -+0x08, 0x96, 0x30, 0xF0, 0x20, 0x6D, 0xEF, 0xF4, -+0x08, 0x4D, 0x4A, 0x4E, 0xCC, 0x36, 0xB9, 0xE6, -+0x82, 0xC6, 0x08, 0x96, 0xCC, 0x36, 0xB5, 0xE6, -+0x40, 0xF2, 0x93, 0xC5, 0x20, 0xF0, 0xA7, 0xA0, -+0x11, 0x6C, 0x8B, 0xEC, 0xAC, 0xEC, 0x20, 0xF0, -+0x87, 0xC0, 0x80, 0x6C, 0x8B, 0xEC, 0x8D, 0xEB, -+0x67, 0x4C, 0x8C, 0xEB, 0x20, 0xF0, 0x66, 0xC0, -+0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, -+0x08, 0x6C, 0x8C, 0xEB, 0x0C, 0x23, 0x0B, 0x93, -+0x10, 0xF0, 0x24, 0x6C, 0x1D, 0xF3, 0x18, 0x4C, -+0x6C, 0xEA, 0x7D, 0x67, 0xD1, 0xA3, 0xBF, 0x67, -+0x4C, 0xEF, 0x80, 0x18, 0x35, 0x19, 0x06, 0x96, -+0x23, 0xEE, 0x02, 0x60, 0x5D, 0x67, 0xD0, 0xC2, -+0x07, 0x92, 0x00, 0x6E, 0x06, 0xD6, 0x50, 0x22, -+0x7D, 0x67, 0x50, 0xA3, 0x04, 0x05, 0x00, 0xF0, -+0x11, 0x06, 0x5F, 0xC0, 0x08, 0x94, 0x02, 0x6F, -+0x80, 0x18, 0xF7, 0x1D, 0x43, 0x2A, 0xDD, 0x67, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x48, 0x9A, -+0x08, 0x94, 0xB0, 0xA6, 0x40, 0xEA, 0xFF, 0x72, -+0x08, 0x60, 0x07, 0x96, 0x7D, 0x67, 0x50, 0xC3, -+0xFF, 0x4E, 0xFF, 0x6A, 0x4C, 0xEE, 0x07, 0xD6, -+0x31, 0x26, 0x0A, 0x92, 0x00, 0x6B, 0x06, 0xD3, -+0x23, 0xEA, 0x22, 0x61, 0xDD, 0x67, 0x47, 0x46, -+0x21, 0x4A, 0x40, 0xA2, 0x50, 0xC6, 0x28, 0x10, -+0x08, 0x96, 0x09, 0x97, 0x91, 0x67, 0x01, 0x6D, -+0x80, 0x18, 0xD7, 0x1C, 0xDD, 0x67, 0x50, 0xC6, -+0x0A, 0x92, 0x23, 0xEA, 0x02, 0x61, 0x50, 0xC6, -+0x0A, 0x10, 0xDD, 0x67, 0x50, 0xA6, 0xFF, 0x72, -+0x06, 0x61, 0xFF, 0x6A, 0xFF, 0x49, 0x4C, 0xE9, -+0x0B, 0x92, 0x4A, 0xE9, 0xE9, 0x61, 0x06, 0x93, -+0xFF, 0x6A, 0x01, 0x4B, 0x4C, 0xEB, 0x06, 0xD3, -+0x06, 0x96, 0x07, 0x92, 0x43, 0xEE, 0x06, 0x60, -+0x68, 0x41, 0xB4, 0x4B, 0xFF, 0x6A, 0x4C, 0xEB, -+0x0B, 0xD3, 0xDA, 0x17, 0x01, 0x6E, 0x06, 0xD6, -+0x0C, 0x92, 0x01, 0x72, 0x09, 0x61, 0x20, 0xF0, -+0x66, 0xA0, 0x19, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x00, 0x6B, 0x20, 0xF0, 0x46, 0xC0, 0x06, 0xD3, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x08, 0x6B, 0x6C, 0xEA, 0x09, 0x22, 0xDD, 0x67, -+0xB0, 0xA6, 0xD1, 0xA6, 0x10, 0xF0, 0x24, 0x6C, -+0x3D, 0xF3, 0x14, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x20, 0xF0, 0x63, 0xA0, 0x0F, 0x6A, 0x6C, 0xEA, -+0x20, 0x6B, 0x6D, 0xEA, 0x20, 0xF0, 0x43, 0xC0, -+0x5D, 0x67, 0xF1, 0xA2, 0x08, 0x94, 0xB0, 0xA2, -+0x06, 0x96, 0x80, 0x18, 0x00, 0x1F, 0x11, 0x97, -+0x10, 0x91, 0x0F, 0x90, 0x09, 0x63, 0x00, 0xEF, -+0xF6, 0x63, 0x13, 0x62, 0x12, 0xD1, 0x11, 0xD0, -+0xFF, 0x6A, 0x4C, 0xEC, 0x52, 0x68, 0x18, 0xEC, -+0x30, 0xF0, 0x20, 0x6B, 0x60, 0xF2, 0x08, 0x4B, -+0x09, 0xD4, 0x9D, 0x67, 0x12, 0xE8, 0x01, 0xE3, -+0x00, 0x6B, 0x6C, 0xCC, 0x6D, 0xCC, 0x20, 0xF0, -+0x86, 0xA0, 0x40, 0x6B, 0x8C, 0xEB, 0x4C, 0xEB, -+0x0D, 0x23, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x20, 0xF2, -+0x11, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x5D, 0xF3, -+0x04, 0x4C, 0x2A, 0x12, 0x09, 0x95, 0x10, 0xF0, -+0x24, 0x6C, 0x7C, 0xF1, 0x8C, 0x9C, 0xB4, 0x33, -+0x7F, 0x6E, 0x91, 0xE3, 0x20, 0xA4, 0x80, 0x6C, -+0x4C, 0xE9, 0x2C, 0xEE, 0x2C, 0xEC, 0x0A, 0xD6, -+0x0E, 0xD4, 0x20, 0xF0, 0x85, 0xA0, 0x40, 0xF0, -+0x24, 0xC0, 0x0A, 0x95, 0x8A, 0x34, 0x0C, 0xD4, -+0x0C, 0x96, 0x03, 0x6C, 0x8C, 0xEE, 0x10, 0xF0, -+0x24, 0x6C, 0x7C, 0xF1, 0x88, 0x9C, 0x4C, 0xEE, -+0x0C, 0xD6, 0x8D, 0xE3, 0x60, 0xA3, 0x83, 0x67, -+0x4C, 0xEC, 0x0F, 0xD4, 0x60, 0xA0, 0xA3, 0xEB, -+0x08, 0x60, 0x0E, 0x96, 0x0A, 0xD3, 0x23, 0x67, -+0x04, 0x26, 0x80, 0x69, 0x2B, 0xE9, 0x6D, 0xE9, -+0x4C, 0xE9, 0x09, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xA2, 0xF7, 0x14, 0x4B, -+0x64, 0x33, 0x4D, 0xE3, 0x60, 0xAB, 0xE0, 0xF1, -+0x11, 0x23, 0x09, 0x93, 0x23, 0xF0, 0x14, 0x4B, -+0x64, 0x33, 0x4D, 0xE3, 0x60, 0xAB, 0x03, 0x5B, -+0x0B, 0x61, 0x65, 0xF4, 0x40, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0x5D, 0xF3, 0x10, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x30, 0xF0, 0x20, 0x6A, 0x08, 0xD2, 0x09, 0x92, -+0x08, 0x93, 0x30, 0xF0, 0x20, 0x6E, 0xA2, 0xF7, -+0x14, 0x4A, 0xC0, 0xF1, 0x08, 0x4B, 0x44, 0x32, -+0x69, 0xE2, 0xA0, 0xAA, 0x09, 0x92, 0x08, 0xD3, -+0xA3, 0xF0, 0x14, 0x4A, 0x44, 0x32, 0x69, 0xE2, -+0x80, 0xAA, 0x0B, 0xD2, 0x4E, 0xF5, 0x40, 0x9E, -+0x93, 0xE5, 0x40, 0xEA, 0x0D, 0xD2, 0x09, 0x92, -+0x08, 0x93, 0x0B, 0x96, 0x23, 0xF1, 0x14, 0x4A, -+0x44, 0x32, 0x69, 0xE2, 0xA0, 0xAA, 0x30, 0xF0, -+0x20, 0x6B, 0x80, 0xAE, 0x4E, 0xF5, 0x40, 0x9B, -+0x93, 0xE5, 0x40, 0xEA, 0x9D, 0x67, 0xA7, 0x44, -+0x2D, 0x4D, 0x80, 0xAD, 0x0B, 0xD2, 0x02, 0x6B, -+0x96, 0xC8, 0x08, 0x95, 0x65, 0xF4, 0x40, 0x9D, -+0x6C, 0xEA, 0x08, 0x22, 0x0D, 0x95, 0x0B, 0x96, -+0x10, 0xF0, 0x24, 0x6C, 0x5D, 0xF3, 0x18, 0x4C, -+0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, 0x20, 0x6C, -+0xC0, 0xF1, 0x08, 0x4C, 0x65, 0xF4, 0x40, 0x9C, -+0x02, 0x6B, 0x6C, 0xEA, 0x18, 0x22, 0x09, 0x92, -+0x09, 0x96, 0x09, 0x93, 0xA3, 0xF0, 0x14, 0x4A, -+0xA2, 0xF7, 0x14, 0x4E, 0x23, 0xF0, 0x14, 0x4B, -+0x44, 0x32, 0xC4, 0x36, 0x64, 0x33, 0x89, 0xE2, -+0x99, 0xE6, 0x8D, 0xE3, 0xA0, 0xAA, 0xC0, 0xAE, -+0xE0, 0xAB, 0x10, 0xF0, 0x24, 0x6C, 0x7D, 0xF3, -+0x08, 0x4C, 0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x0C, 0x22, 0x0F, 0x96, 0x18, 0x6D, -+0x10, 0xF0, 0x24, 0x6C, 0xCC, 0xED, 0x0C, 0x96, -+0x7D, 0xF3, 0x18, 0x4C, 0xAE, 0x35, 0xF1, 0x67, -+0x80, 0x18, 0x35, 0x19, 0x09, 0x94, 0x0D, 0x95, -+0x0A, 0x96, 0x00, 0xF0, 0x1A, 0x02, 0x06, 0x07, -+0x04, 0xD2, 0x80, 0x18, 0x59, 0x1D, 0x0E, 0x93, -+0x0A, 0x6A, 0x08, 0x2B, 0x0A, 0x94, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x49, 0xE4, -+0x85, 0xF2, 0x5C, 0xA2, 0xBD, 0x67, 0x8C, 0xAD, -+0xDD, 0x67, 0x6D, 0xAE, 0xA3, 0x44, 0x55, 0xE5, -+0xA2, 0xEB, 0x00, 0x69, 0x05, 0x60, 0x23, 0x44, -+0x67, 0xE1, 0x25, 0xE2, 0xFF, 0x6A, 0x4C, 0xE9, -+0x0A, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x49, 0xE3, 0xBD, 0x67, 0x45, 0xF2, -+0x48, 0xA2, 0x8C, 0xAD, 0xDD, 0x67, 0x6D, 0xAE, -+0x95, 0xE2, 0xA2, 0xEB, 0x00, 0x6D, 0x08, 0xD5, -+0x05, 0x60, 0x6F, 0xE4, 0x4D, 0xE3, 0xFF, 0x6A, -+0x4C, 0xEB, 0x08, 0xD3, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x65, 0xF4, 0x60, 0x9A, -+0x02, 0x6C, 0x8C, 0xEB, 0x0C, 0x23, 0x0A, 0x96, -+0x10, 0xF0, 0x24, 0x6C, 0x9D, 0xF3, 0x10, 0x4C, -+0x49, 0xE6, 0x45, 0xF2, 0xA8, 0xA2, 0x85, 0xF2, -+0xDC, 0xA2, 0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, -+0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x08, 0x22, 0x08, 0x95, 0x10, 0xF0, -+0x24, 0x6C, 0xBD, 0xF3, 0x00, 0x4C, 0xD1, 0x67, -+0x80, 0x18, 0x35, 0x19, 0x40, 0xF0, 0x40, 0xA0, -+0x3F, 0x6B, 0x6C, 0xEA, 0x40, 0xF0, 0x60, 0x80, -+0x00, 0x53, 0x13, 0x60, 0x43, 0xE9, 0x02, 0x60, -+0x00, 0x69, 0x03, 0x10, 0x47, 0xE1, 0xFF, 0x6B, -+0x6C, 0xE9, 0x08, 0x93, 0x43, 0xEB, 0x03, 0x60, -+0x00, 0x6C, 0x08, 0xD4, 0x0E, 0x10, 0x08, 0x95, -+0x57, 0xE5, 0xFF, 0x6A, 0x4C, 0xED, 0x08, 0xD5, -+0x08, 0x10, 0x07, 0x22, 0x08, 0x96, 0xFF, 0x6B, -+0x45, 0xE1, 0x59, 0xE6, 0x6C, 0xEE, 0x6C, 0xE9, -+0x08, 0xD6, 0x5B, 0x59, 0x51, 0x67, 0x01, 0x61, -+0x5A, 0x6A, 0xFF, 0x6B, 0x82, 0x67, 0x6C, 0xEC, -+0x0A, 0xD4, 0x08, 0x94, 0xBD, 0x67, 0xC7, 0x45, -+0x8C, 0xEB, 0x19, 0x4E, 0x42, 0x5B, 0x40, 0xA6, -+0x01, 0x61, 0x41, 0x6A, 0xFF, 0x69, 0x4C, 0xE9, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x02, 0x6B, 0x6C, 0xEA, 0x08, 0x22, 0x0A, 0x96, -+0x10, 0xF0, 0x24, 0x6C, 0xBD, 0xF3, 0x10, 0x4C, -+0xB1, 0x67, 0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xE5, 0xF2, -+0x9B, 0xA2, 0x04, 0x6B, 0x8C, 0xEB, 0x0B, 0x23, -+0x65, 0xF4, 0x40, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0xA0, 0xF0, 0x1C, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0xDD, 0xF3, 0x00, 0x4C, 0xB5, 0x10, 0x0D, 0x95, -+0x0A, 0x96, 0xC3, 0xED, 0x03, 0x60, 0x0B, 0x93, -+0x1E, 0x5B, 0x59, 0x61, 0x0B, 0x94, 0x50, 0x5C, -+0x1D, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x06, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0xDD, 0xF3, 0x0C, 0x4C, -+0x80, 0x18, 0x35, 0x19, 0x09, 0x94, 0x01, 0x6D, -+0xC5, 0x67, 0x80, 0x18, 0x4E, 0x21, 0x20, 0xF0, -+0x60, 0xA0, 0x39, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x20, 0xF0, 0x40, 0xC0, 0x00, 0x6A, 0x20, 0xF0, -+0x41, 0xC0, 0x90, 0x10, 0x20, 0xF0, 0x80, 0xA0, -+0x07, 0x6A, 0x8E, 0x33, 0x4C, 0xEB, 0x01, 0x4B, -+0x4C, 0xEB, 0x6C, 0x35, 0x39, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xAD, 0xEB, 0x20, 0xF0, 0x60, 0xC0, -+0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, -+0x02, 0x6C, 0x8C, 0xEB, 0x0A, 0x23, 0x20, 0xF0, -+0xA0, 0xA0, 0x10, 0xF0, 0x24, 0x6C, 0xDD, 0xF3, -+0x18, 0x4C, 0xAE, 0x35, 0x4C, 0xED, 0x80, 0x18, -+0x35, 0x19, 0x20, 0xF0, 0x40, 0xA0, 0x07, 0x6B, -+0x4E, 0x32, 0x6C, 0xEA, 0x02, 0x52, 0x6A, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x02, 0x6B, 0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0xFD, 0xF3, 0x08, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x09, 0x94, 0x01, 0x6D, 0x00, 0x6E, -+0x80, 0x18, 0x4E, 0x21, 0x2A, 0x10, 0x0D, 0x95, -+0x23, 0xED, 0x32, 0x60, 0x20, 0xF0, 0x61, 0xA0, -+0x01, 0x4B, 0x20, 0xF0, 0x61, 0xC0, 0x65, 0xF4, -+0x40, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x08, 0x22, -+0x20, 0xF0, 0xA1, 0xA0, 0x10, 0xF0, 0x24, 0x6C, -+0xFD, 0xF3, 0x14, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x20, 0xF0, 0x41, 0xA0, 0x03, 0x5A, 0x3E, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x02, 0x6B, 0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x1D, 0xF4, 0x00, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x09, 0x94, 0x00, 0x6D, 0x80, 0x18, -+0x5D, 0x20, 0x00, 0x6A, 0x20, 0xF0, 0x60, 0xA0, -+0x20, 0xF0, 0x41, 0xC0, 0x39, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x20, 0xF0, 0x40, 0xC0, 0x22, 0x10, -+0x20, 0xF0, 0x41, 0xA0, 0x03, 0x22, 0xFF, 0x4A, -+0x20, 0xF0, 0x41, 0xC0, 0x20, 0xF0, 0x60, 0xA0, -+0x07, 0x6C, 0x6E, 0x32, 0x8C, 0xEA, 0x09, 0x22, -+0xFF, 0x4A, 0x8C, 0xEA, 0x4C, 0x34, 0x39, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x8D, 0xEA, 0x20, 0xF0, -+0x40, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, -+0x48, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x06, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x1D, 0xF4, 0x08, 0x4C, -+0x80, 0x18, 0x35, 0x19, 0x09, 0x94, 0x80, 0x18, -+0xEF, 0x24, 0x13, 0x97, 0x12, 0x91, 0x11, 0x90, -+0x0A, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x52, 0x68, 0x18, 0xEC, 0x30, 0xF0, 0x20, 0x6B, -+0x60, 0xF2, 0x08, 0x4B, 0x04, 0xD4, 0x4C, 0xED, -+0x12, 0xE8, 0x01, 0xE3, 0x94, 0x33, 0x10, 0xF0, -+0x24, 0x6C, 0x7C, 0xF1, 0x8C, 0x9C, 0x91, 0xE3, -+0x80, 0xA4, 0xC4, 0x67, 0x10, 0xF0, 0x24, 0x6C, -+0x4C, 0xEE, 0x7C, 0xF1, 0x88, 0x9C, 0x05, 0xD6, -+0x20, 0xF0, 0xC6, 0xA0, 0x8D, 0xE3, 0x80, 0xA3, -+0x40, 0x6B, 0xCC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, -+0xA0, 0xF0, 0x01, 0x23, 0x18, 0x69, 0x8C, 0xE9, -+0x2F, 0x31, 0x01, 0x75, 0x4C, 0xE9, 0x23, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, -+0x00, 0xF1, 0x01, 0x4A, 0x6C, 0xEA, 0x06, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x1D, 0xF4, 0x14, 0x4C, -+0x80, 0x18, 0x35, 0x19, 0x20, 0xF0, 0x63, 0xA0, -+0x10, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x20, 0xF0, -+0x43, 0xC0, 0x04, 0x94, 0x05, 0x95, 0x00, 0x6E, -+0xF1, 0x67, 0x80, 0x18, 0x00, 0x1F, 0x20, 0xF0, -+0x66, 0xA0, 0x19, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x20, 0xF0, 0x46, 0xC0, 0x78, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF2, -+0x00, 0x6A, 0x6C, 0xEA, 0x06, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x3D, 0xF4, 0x00, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x20, 0xF0, 0x83, 0xA0, 0x0F, 0x6A, -+0x20, 0xF0, 0xA6, 0xA0, 0x64, 0x67, 0x4C, 0xEB, -+0x01, 0x4B, 0x4C, 0xEB, 0xE1, 0x4A, 0x8C, 0xEA, -+0x6D, 0xEA, 0xAE, 0x35, 0x03, 0x6B, 0x6C, 0xED, -+0x20, 0xF0, 0x43, 0xC0, 0x43, 0x45, 0x6C, 0xEA, -+0x02, 0x5A, 0x52, 0x60, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x08, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0xFF, 0x6A, 0x3D, 0xF4, 0x08, 0x4C, 0x4C, 0xED, -+0x80, 0x18, 0x35, 0x19, 0x20, 0xF0, 0xA6, 0xA0, -+0x03, 0x6C, 0xFF, 0x6E, 0xAE, 0x32, 0x8C, 0xEA, -+0x6F, 0x42, 0xCC, 0xEB, 0x79, 0xE0, 0xC5, 0xA6, -+0x03, 0x4A, 0x8C, 0xEA, 0x05, 0xD6, 0x4C, 0x36, -+0x19, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0xCD, 0xEA, -+0x20, 0xF0, 0x46, 0xC0, 0x04, 0x96, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0xCC, 0x35, -+0x49, 0xE5, 0x6D, 0xE2, 0x40, 0xF2, 0x52, 0xA3, -+0xFF, 0x72, 0x0B, 0x60, 0x20, 0xF0, 0x65, 0xA0, -+0x4C, 0xEC, 0x22, 0x67, 0x0D, 0x6A, 0x4B, 0xEA, -+0x88, 0x34, 0x6C, 0xEA, 0x8D, 0xEA, 0x20, 0xF0, -+0x45, 0xC0, 0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, -+0x68, 0x9B, 0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, -+0x08, 0x22, 0x05, 0x96, 0x10, 0xF0, 0x24, 0x6C, -+0x3D, 0xF4, 0x14, 0x4C, 0xB1, 0x67, 0x80, 0x18, -+0x35, 0x19, 0x04, 0x94, 0x05, 0x95, 0x01, 0x6E, -+0xF1, 0x67, 0x80, 0x18, 0x00, 0x1F, 0x03, 0x10, -+0x04, 0x94, 0x80, 0x18, 0x35, 0x20, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xF6, 0x63, 0x13, 0x62, 0x12, 0xD1, 0x11, 0xD0, -+0xFF, 0x6A, 0x24, 0x67, 0x4C, 0xE9, 0x52, 0x68, -+0x18, 0xE9, 0x30, 0xF0, 0x20, 0x6B, 0x60, 0xF2, -+0x08, 0x4B, 0x7F, 0x6E, 0x12, 0xE8, 0x01, 0xE3, -+0x76, 0xA8, 0x83, 0x67, 0x4C, 0xEC, 0x0D, 0xD4, -+0x10, 0xF0, 0x24, 0x6C, 0x7C, 0xF1, 0x8C, 0x9C, -+0x34, 0x33, 0x91, 0xE3, 0x80, 0xA4, 0x8C, 0xEA, -+0x09, 0xD2, 0xCC, 0xEA, 0x08, 0xD2, 0x10, 0xF0, -+0x24, 0x6A, 0x7C, 0xF1, 0x48, 0x9A, 0x4D, 0xE3, -+0x60, 0xA3, 0x18, 0x6A, 0x6C, 0xEA, 0x4E, 0x32, -+0x0C, 0xD2, 0x33, 0xF0, 0x64, 0x41, 0x30, 0xF0, -+0x20, 0x6A, 0x64, 0x33, 0xC0, 0xF1, 0x08, 0x4A, -+0x4D, 0xE3, 0x60, 0xAB, 0x03, 0x5B, 0x15, 0x61, -+0x65, 0xF4, 0x40, 0x9A, 0x00, 0xF2, 0x00, 0x6B, -+0x4C, 0xEB, 0x06, 0x23, 0x10, 0xF0, 0x24, 0x6C, -+0x5D, 0xF3, 0x10, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x01, 0x6D, 0x91, 0x67, 0xC5, 0x67, 0x80, 0x18, -+0x4E, 0x21, 0x91, 0x67, 0x00, 0x6D, 0x80, 0x18, -+0xF5, 0x22, 0x30, 0xF0, 0x20, 0x6F, 0x33, 0xF2, -+0x44, 0x41, 0xC0, 0xF1, 0x08, 0x4F, 0x44, 0x32, -+0xE9, 0xE2, 0xA0, 0xAA, 0x0E, 0xD2, 0xB3, 0xF1, -+0x44, 0x41, 0x44, 0x32, 0xE9, 0xE2, 0x30, 0xF0, -+0x20, 0x6B, 0x80, 0xAA, 0x07, 0xD2, 0x4E, 0xF5, -+0x40, 0x9B, 0x93, 0xE5, 0x06, 0xD7, 0x40, 0xEA, -+0x06, 0x94, 0x0B, 0xD2, 0x07, 0x96, 0x33, 0xF3, -+0x44, 0x41, 0x44, 0x32, 0x89, 0xE2, 0xA0, 0xAA, -+0x80, 0xAE, 0x30, 0xF0, 0x20, 0x6F, 0x0F, 0xD2, -+0x4E, 0xF5, 0x40, 0x9F, 0x93, 0xE5, 0x40, 0xEA, -+0x06, 0x94, 0x0A, 0xD2, 0x00, 0xF2, 0x00, 0x6A, -+0x65, 0xF4, 0x60, 0x9C, 0x6C, 0xEA, 0x12, 0x22, -+0x07, 0x96, 0x0E, 0x97, 0xB3, 0xF2, 0x44, 0x41, -+0x0F, 0x93, 0x44, 0x32, 0x89, 0xE2, 0xA0, 0xAE, -+0xC0, 0xAF, 0xE0, 0xAA, 0x40, 0xAB, 0x10, 0xF0, -+0x24, 0x6C, 0x5D, 0xF4, 0x00, 0x4C, 0x04, 0xD2, -+0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x0B, 0x22, 0x09, 0x94, 0x0B, 0x95, -+0x0A, 0x96, 0x0C, 0x97, 0x04, 0xD4, 0x10, 0xF0, -+0x24, 0x6C, 0x5D, 0xF4, 0x18, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x09, 0x96, 0xDE, 0x32, 0x12, 0x22, -+0x08, 0x97, 0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF3, -+0x1C, 0x4A, 0xE4, 0x33, 0x49, 0xE3, 0x60, 0xAA, -+0x72, 0x34, 0x76, 0x32, 0x49, 0xE4, 0x49, 0xE3, -+0x7E, 0x33, 0x69, 0xE2, 0xFF, 0xF7, 0x1F, 0x6B, -+0x6C, 0xEA, 0x08, 0x10, 0x08, 0x94, 0x30, 0xF0, -+0x20, 0x6A, 0xAF, 0xF3, 0x1C, 0x4A, 0x84, 0x33, -+0x49, 0xE3, 0x40, 0xAA, 0x40, 0xF0, 0x64, 0x80, -+0x00, 0x53, 0x15, 0x60, 0x40, 0xF0, 0x84, 0xA0, -+0x7F, 0x6B, 0x6C, 0xEC, 0x30, 0xF0, 0x20, 0x6B, -+0xAF, 0xF3, 0x1C, 0x4B, 0x84, 0x34, 0x71, 0xE4, -+0x80, 0xAC, 0x92, 0x35, 0x96, 0x33, 0x6D, 0xE5, -+0x6D, 0xE4, 0x9E, 0x34, 0x8D, 0xE3, 0xFF, 0xF7, -+0x1F, 0x6C, 0x8C, 0xEB, 0x0B, 0x10, 0x40, 0xF0, -+0x84, 0xA0, 0x7F, 0x6D, 0x30, 0xF0, 0x20, 0x6B, -+0xAC, 0xEC, 0xAF, 0xF3, 0x1C, 0x4B, 0x84, 0x34, -+0x71, 0xE4, 0x60, 0xAC, 0x20, 0xF0, 0xA3, 0xA0, -+0x10, 0x6C, 0x8B, 0xEC, 0xAC, 0xEC, 0xFF, 0x6D, -+0xAC, 0xEC, 0x10, 0x6D, 0x8E, 0xED, 0x01, 0x5D, -+0x0D, 0x97, 0xB8, 0x67, 0xAB, 0xED, 0x05, 0x6C, -+0xAC, 0xEC, 0x64, 0x6D, 0xFB, 0xE5, 0xD8, 0xEB, -+0x64, 0x4C, 0x0B, 0x97, 0x12, 0xEB, 0x98, 0xEB, -+0x20, 0xF0, 0x86, 0xA0, 0x03, 0x6B, 0x8C, 0xEB, -+0x0C, 0x94, 0x12, 0xEE, 0xC4, 0xEB, 0xEF, 0xE5, -+0xB8, 0xEB, 0x07, 0xD6, 0x12, 0xED, 0x58, 0xED, -+0x00, 0xF2, 0x00, 0x6A, 0x12, 0xEB, 0x64, 0xEC, -+0x06, 0xD3, 0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, -+0x68, 0x9B, 0x6C, 0xEA, 0x08, 0x22, 0x0D, 0x95, -+0x10, 0xF0, 0x24, 0x6C, 0x7D, 0xF4, 0x18, 0x4C, -+0xC7, 0x67, 0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, -+0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF2, -+0x00, 0x6A, 0x6C, 0xEA, 0x09, 0x22, 0x40, 0xF0, -+0xA4, 0xA0, 0x08, 0x96, 0x10, 0xF0, 0x24, 0x6C, -+0x9D, 0xF4, 0x04, 0x4C, 0x80, 0x18, 0x35, 0x19, -+0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, -+0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, 0x0C, 0x22, -+0x07, 0x96, 0x06, 0x97, 0x10, 0xF0, 0x24, 0x6C, -+0xC2, 0x35, 0xE2, 0x36, 0x9D, 0xF4, 0x10, 0x4C, -+0xAA, 0x35, 0xCA, 0x36, 0x80, 0x18, 0x35, 0x19, -+0x06, 0x92, 0x07, 0x93, 0x63, 0xEA, 0x03, 0x61, -+0x0A, 0x94, 0x1E, 0x5C, 0x2F, 0x61, 0x20, 0xF0, -+0x63, 0xA0, 0x10, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x10, 0x72, 0x4C, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0x25, 0xF6, 0x68, 0x9B, -+0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, 0x06, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x9D, 0xF4, 0x1C, 0x4C, -+0x80, 0x18, 0x35, 0x19, 0x0A, 0x96, 0x1E, 0x5E, -+0x3B, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF5, -+0x48, 0x9A, 0x08, 0x94, 0x40, 0xEA, 0x07, 0x22, -+0xFD, 0x67, 0x47, 0x47, 0x1D, 0x4A, 0xE0, 0xA2, -+0x40, 0xF0, 0xE6, 0xC0, 0x2D, 0x10, 0x5D, 0x67, -+0x67, 0x42, 0x1D, 0x4B, 0x40, 0xA3, 0x40, 0xF0, -+0x45, 0xC0, 0x26, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0x25, 0xF6, 0x68, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x07, 0x22, 0x09, 0x95, 0x10, 0xF0, -+0x24, 0x6C, 0xBD, 0xF4, 0x04, 0x4C, 0x80, 0x18, -+0x35, 0x19, 0x00, 0x6A, 0x20, 0xF0, 0x63, 0xA0, -+0x40, 0xF0, 0x42, 0xC0, 0x10, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x10, 0x72, -+0x01, 0x6D, 0x0B, 0x61, 0x20, 0xF0, 0x60, 0xA0, -+0x39, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x08, 0x6B, -+0x6D, 0xEA, 0x20, 0xF0, 0x40, 0xC0, 0x01, 0x10, -+0x00, 0x6D, 0x91, 0x67, 0x80, 0x18, 0xF5, 0x22, -+0x13, 0x97, 0x12, 0x91, 0x11, 0x90, 0x0A, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0xFF, 0x6B, 0x04, 0x67, 0x26, 0x67, 0x4E, 0xF5, -+0x5C, 0x9A, 0x6C, 0xE8, 0x6C, 0xE9, 0x6C, 0xED, -+0x90, 0x67, 0xD1, 0x67, 0x40, 0xEA, 0xA2, 0x67, -+0x90, 0x67, 0xF1, 0x67, 0x00, 0x6E, 0x80, 0x18, -+0x00, 0x1F, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0xE5, 0xF2, 0x9A, 0xA3, 0x52, 0x6A, 0xE5, 0xF2, -+0x79, 0xA3, 0x58, 0xEC, 0x30, 0xF0, 0x20, 0x6D, -+0x60, 0xF2, 0x08, 0x4D, 0xFF, 0x4B, 0x12, 0xEA, -+0x49, 0xE5, 0xFF, 0x6D, 0xAC, 0xEB, 0x05, 0x5B, -+0xE0, 0xF0, 0x13, 0x60, 0x10, 0xF0, 0x24, 0x6D, -+0x68, 0x33, 0xDB, 0xF2, 0x18, 0x4D, 0x75, 0xE5, -+0x60, 0x9D, 0x00, 0xEB, 0x0C, 0x6B, 0x9D, 0x67, -+0x6F, 0xCC, 0xBD, 0x67, 0x0E, 0x6C, 0x90, 0xC5, -+0x72, 0xC5, 0x20, 0xF0, 0x72, 0xA2, 0x03, 0x6C, -+0xDD, 0x67, 0x73, 0xC5, 0x63, 0xA2, 0x74, 0xC5, -+0x20, 0xF0, 0x65, 0xA2, 0x6A, 0x35, 0x8C, 0xED, -+0xB5, 0xC6, 0xA3, 0x67, 0x8C, 0xED, 0xB6, 0xC6, -+0xA5, 0xA2, 0xB7, 0xC6, 0xA6, 0xA2, 0xB8, 0xC6, -+0x7E, 0x35, 0x72, 0x33, 0x8C, 0xEB, 0x7A, 0xC6, -+0xB9, 0xC6, 0x20, 0xF0, 0x46, 0xA2, 0x01, 0x6B, -+0x4A, 0x32, 0x6C, 0xEA, 0x5B, 0xC6, 0x00, 0x6A, -+0x5C, 0xC6, 0x6D, 0x10, 0xBD, 0x67, 0x0C, 0x6B, -+0x6F, 0xCD, 0x0E, 0x6B, 0x70, 0xC5, 0x0D, 0x6B, -+0x72, 0xC5, 0x64, 0xA2, 0x8C, 0x34, 0x73, 0xC5, -+0x60, 0xA2, 0x74, 0xC5, 0x41, 0xA2, 0x55, 0xC5, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, 0x54, 0x9A, -+0x49, 0xE4, 0x40, 0xA2, 0x56, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF1, 0x5C, 0x9A, 0x49, 0xE4, -+0x40, 0xA2, 0x57, 0xC5, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF1, 0x40, 0x9A, 0x49, 0xE4, 0x40, 0xA2, -+0x58, 0xC5, 0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF1, -+0x44, 0x9A, 0x49, 0xE4, 0x40, 0xA2, 0x59, 0xC5, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, 0x58, 0x9A, -+0x49, 0xE4, 0x40, 0xA2, 0x5A, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0xDC, 0xF1, 0x48, 0x9A, 0x49, 0xE4, -+0x40, 0xA2, 0x5B, 0xC5, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF1, 0x4C, 0x9A, 0x49, 0xE4, 0x40, 0xA2, -+0x5C, 0xC5, 0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF1, -+0x50, 0x9A, 0x76, 0x10, 0xDD, 0x67, 0x0C, 0x6A, -+0x4F, 0xCE, 0x0E, 0x6A, 0x50, 0xC6, 0x52, 0xC6, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x45, 0xF4, 0x72, 0xA2, 0x73, 0xC6, 0x45, 0xF4, -+0x73, 0xA2, 0x74, 0xC6, 0x45, 0xF4, 0x74, 0xA2, -+0x75, 0xC6, 0x45, 0xF4, 0x75, 0xA2, 0x76, 0xC6, -+0x45, 0xF4, 0x76, 0xA2, 0x77, 0xC6, 0x45, 0xF4, -+0x77, 0xA2, 0x78, 0xC6, 0x45, 0xF4, 0x78, 0xA2, -+0x79, 0xC6, 0x45, 0xF4, 0x79, 0xA2, 0x7A, 0xC6, -+0x45, 0xF4, 0x7A, 0xA2, 0x45, 0xF4, 0x5B, 0xA2, -+0x7B, 0xC6, 0x5C, 0xC6, 0x00, 0x6A, 0x5D, 0xC6, -+0x4E, 0x10, 0x7D, 0x67, 0x03, 0x6A, 0x4F, 0xCB, -+0x0E, 0x6A, 0x50, 0xC3, 0x0F, 0x6A, 0x52, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, 0x60, 0xA2, -+0xEF, 0xF4, 0x00, 0x4A, 0x41, 0xA2, 0x9D, 0x67, -+0x73, 0xC4, 0x54, 0xC4, 0x3C, 0x10, 0xBD, 0x67, -+0x0C, 0x6B, 0x6F, 0xCD, 0x0E, 0x6B, 0x70, 0xC5, -+0x10, 0x6B, 0x72, 0xC5, 0x40, 0xF0, 0x64, 0xA2, -+0x8C, 0x34, 0x73, 0xC5, 0x77, 0xAA, 0x04, 0x4B, -+0x6F, 0x33, 0x74, 0xC5, 0x76, 0xAA, 0x04, 0x4B, -+0x6F, 0x33, 0x75, 0xC5, 0x60, 0xA2, 0x76, 0xC5, -+0x65, 0xA2, 0x77, 0xC5, 0x46, 0xA2, 0x58, 0xC5, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, 0x54, 0x9A, -+0x49, 0xE4, 0x40, 0xA2, 0x59, 0xC5, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF1, 0x5C, 0x9A, 0x49, 0xE4, -+0x40, 0xA2, 0x5A, 0xC5, 0x10, 0xF0, 0x24, 0x6A, -+0xDC, 0xF1, 0x40, 0x9A, 0x49, 0xE4, 0x40, 0xA2, -+0x5B, 0xC5, 0x10, 0xF0, 0x24, 0x6A, 0xDC, 0xF1, -+0x44, 0x9A, 0x49, 0xE4, 0x40, 0xA2, 0x5C, 0xC5, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, 0x58, 0x9A, -+0x51, 0xE4, 0x40, 0xA4, 0x5D, 0xC5, 0x04, 0x94, -+0x05, 0x95, 0x06, 0x96, 0x07, 0x97, 0x80, 0x18, -+0x47, 0x10, 0x09, 0x97, 0x05, 0x63, 0x00, 0xEF, -+0x00, 0x6A, 0xB3, 0xF0, 0xA4, 0x42, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0xA4, 0x35, -+0x00, 0x6C, 0x75, 0xE5, 0x80, 0xCD, 0x33, 0xF0, -+0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, -+0xB2, 0xF7, 0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, -+0x80, 0xCD, 0xB3, 0xF1, 0xA4, 0x42, 0xA4, 0x35, -+0x75, 0xE5, 0x80, 0xCD, 0x33, 0xF2, 0xA4, 0x42, -+0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, 0xB3, 0xF2, -+0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, -+0x43, 0xF4, 0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, -+0x80, 0xCD, 0xC3, 0xF3, 0xA4, 0x42, 0xA4, 0x35, -+0x75, 0xE5, 0x80, 0xCD, 0xC3, 0xF4, 0xA4, 0x42, -+0xA4, 0x35, 0x75, 0xE5, 0x82, 0xCD, 0x43, 0xF5, -+0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, 0x82, 0xCD, -+0x01, 0x4A, 0xFF, 0x6C, 0x8C, 0xEA, 0x80, 0x72, -+0xC4, 0x61, 0x58, 0x67, 0x87, 0xF1, 0x48, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x6A, 0x8C, 0xEA, -+0x43, 0xF4, 0xA4, 0x42, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xA4, 0x35, 0x00, 0x6C, -+0x75, 0xE5, 0x80, 0xCD, 0xC3, 0xF3, 0xA4, 0x42, -+0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, 0xC3, 0xF4, -+0xA4, 0x42, 0x43, 0xF5, 0x04, 0x4A, 0xA4, 0x35, -+0x44, 0x32, 0x75, 0xE5, 0x6D, 0xE2, 0x82, 0xCD, -+0x82, 0xCB, 0x20, 0xE8, 0xFF, 0x6A, 0x8C, 0xEA, -+0xB3, 0xF0, 0xA4, 0x42, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xA4, 0x35, 0x00, 0x6C, -+0x75, 0xE5, 0x80, 0xCD, 0x33, 0xF1, 0xA4, 0x42, -+0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, 0x33, 0xF0, -+0xA4, 0x42, 0xA2, 0xF7, 0x14, 0x4A, 0xA4, 0x35, -+0x44, 0x32, 0x75, 0xE5, 0x6D, 0xE2, 0x80, 0xCD, -+0x80, 0xCB, 0x20, 0xE8, 0xFF, 0x6A, 0x8C, 0xEA, -+0xB3, 0xF1, 0xA4, 0x42, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xA4, 0x35, 0x00, 0x6C, -+0x75, 0xE5, 0x80, 0xCD, 0x33, 0xF3, 0xA4, 0x42, -+0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, 0x33, 0xF2, -+0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, 0x80, 0xCD, -+0xB3, 0xF2, 0xA4, 0x42, 0xA4, 0x35, 0x75, 0xE5, -+0x80, 0xCD, 0x52, 0x6C, 0x98, 0xEA, 0x80, 0x4C, -+0xEE, 0x4C, 0x12, 0xEA, 0x6D, 0xE2, 0xE0, 0xF0, -+0x41, 0xA3, 0x4C, 0xEC, 0xE0, 0xF0, 0x81, 0xC3, -+0x20, 0xE8, 0x00, 0x65, 0xF4, 0x63, 0x17, 0x62, -+0x16, 0xD1, 0x15, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0xFF, 0x6A, 0xDC, 0xF1, 0x74, 0x9B, 0x4C, 0xEC, -+0x90, 0x34, 0x6D, 0xE4, 0x00, 0xA3, 0x10, 0xF0, -+0x24, 0x6B, 0xDC, 0xF1, 0x78, 0x9B, 0x4C, 0xE8, -+0x6D, 0xE4, 0xA0, 0xA3, 0x10, 0xF0, 0x24, 0x6B, -+0xDC, 0xF1, 0x7C, 0x9B, 0x4C, 0xED, 0x6D, 0xE4, -+0x60, 0xA3, 0xC3, 0x67, 0x10, 0xF0, 0x24, 0x6B, -+0xFC, 0xF1, 0x60, 0x9B, 0x4C, 0xEE, 0x0F, 0xD6, -+0x6D, 0xE4, 0x60, 0xA3, 0xE3, 0x67, 0x10, 0xF0, -+0x24, 0x6B, 0xFC, 0xF1, 0xC4, 0x9B, 0x4C, 0xEF, -+0x10, 0xD7, 0xD9, 0xE4, 0x60, 0xA6, 0xE3, 0x67, -+0x10, 0xF0, 0x24, 0x6B, 0xFC, 0xF1, 0x68, 0x9B, -+0x4C, 0xEF, 0x09, 0xD7, 0x6D, 0xE4, 0x60, 0xA3, -+0xE3, 0x67, 0x10, 0xF0, 0x24, 0x6B, 0xFC, 0xF1, -+0x6C, 0x9B, 0x4C, 0xEF, 0x0B, 0xD7, 0x6D, 0xE4, -+0xE0, 0xA3, 0x4C, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF1, 0x50, 0x9A, 0x49, 0xE4, 0x40, 0xA2, -+0x10, 0xF0, 0x24, 0x6A, 0xFC, 0xF1, 0x54, 0x9A, -+0x51, 0xE4, 0x60, 0xA4, 0x01, 0x6A, 0x4C, 0xEB, -+0xA0, 0xF2, 0x06, 0x2B, 0x52, 0x69, 0x38, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0x60, 0xF2, 0x08, 0x4B, -+0x12, 0xE9, 0x25, 0xE3, 0x60, 0xA6, 0x00, 0xF6, -+0x60, 0x33, 0x00, 0xF6, 0x63, 0x33, 0x00, 0x53, -+0x00, 0x6B, 0x0E, 0xD3, 0x05, 0x60, 0x20, 0xF0, -+0x66, 0xA1, 0x7A, 0x33, 0x4C, 0xEB, 0x0E, 0xD3, -+0x10, 0xF0, 0x24, 0x6A, 0x7C, 0xF1, 0x4C, 0x9A, -+0x14, 0x33, 0x0F, 0x94, 0x49, 0xE3, 0xC0, 0xA2, -+0xFF, 0x6B, 0x6C, 0xEE, 0xCA, 0xEC, 0x10, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x01, 0x6B, 0x6C, 0xEA, 0x60, 0xF2, 0x1C, 0x22, -+0x0F, 0x95, 0x10, 0xF0, 0x24, 0x6C, 0xBD, 0xF4, -+0x10, 0x4C, 0x80, 0x18, 0x35, 0x19, 0x74, 0x12, -+0x20, 0xF0, 0x85, 0xA1, 0x80, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x6C, 0xEA, 0x40, 0xF2, 0x1E, 0x2A, -+0x0E, 0x96, 0x19, 0x26, 0x30, 0xF0, 0x20, 0x6A, -+0xB3, 0xF1, 0x64, 0x40, 0xC0, 0xF1, 0x08, 0x4A, -+0x64, 0x33, 0x4D, 0xE3, 0x60, 0xAB, 0x0A, 0xD3, -+0x33, 0xF3, 0x64, 0x40, 0x64, 0x33, 0x4D, 0xE3, -+0x60, 0xAB, 0x11, 0xD3, 0xB3, 0xF2, 0x64, 0x40, -+0x64, 0x33, 0x4D, 0xE3, 0x60, 0xAB, 0x12, 0xD3, -+0x33, 0xF2, 0x64, 0x40, 0x18, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xB3, 0xF0, 0x64, 0x40, 0xC0, 0xF1, -+0x08, 0x4A, 0x64, 0x33, 0x4D, 0xE3, 0x60, 0xAB, -+0x0A, 0xD3, 0x33, 0xF1, 0x64, 0x40, 0x64, 0x33, -+0x4D, 0xE3, 0x60, 0xAB, 0x11, 0xD3, 0x33, 0xF0, -+0x64, 0x40, 0x64, 0x33, 0x4D, 0xE3, 0x60, 0xAB, -+0x12, 0xD3, 0xB2, 0xF7, 0x64, 0x40, 0x64, 0x33, -+0x49, 0xE3, 0x40, 0xAA, 0x08, 0xD2, 0x40, 0xF0, -+0x61, 0xA1, 0x40, 0x6A, 0x6C, 0xEA, 0x05, 0x22, -+0x40, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x40, 0xF0, -+0x41, 0xC1, 0x09, 0x93, 0x0B, 0x94, 0x7F, 0x6A, -+0xAC, 0xEA, 0x0D, 0xD2, 0x3F, 0x6A, 0x4C, 0xEB, -+0x4C, 0xEC, 0x4C, 0xEF, 0x69, 0xE4, 0xEE, 0xEA, -+0x09, 0xD3, 0x0B, 0xD4, 0x0C, 0xD7, 0x40, 0xF1, -+0x1D, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x65, 0xF4, 0x60, 0x9A, 0x01, 0x6C, -+0x8C, 0xEB, 0x14, 0x23, 0x09, 0x95, 0x0B, 0x96, -+0xB2, 0xF7, 0x64, 0x40, 0x64, 0x33, 0x04, 0xD5, -+0x05, 0xD6, 0x06, 0xD7, 0x49, 0xE3, 0x40, 0xAA, -+0x0F, 0x95, 0x10, 0x96, 0x0D, 0x97, 0x10, 0xF0, -+0x24, 0x6C, 0xDD, 0xF4, 0x04, 0x4C, 0x07, 0xD2, -+0x80, 0x18, 0x35, 0x19, 0x10, 0x92, 0x0F, 0x97, -+0xEE, 0xEA, 0x26, 0x22, 0x0E, 0x92, 0x05, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xC5, 0xF4, 0x68, 0xA2, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC5, 0xF4, -+0x67, 0xA2, 0x40, 0xF0, 0x81, 0xA1, 0x3F, 0x6A, -+0x01, 0x6D, 0x8C, 0xEA, 0x62, 0xEA, 0x03, 0x60, -+0x57, 0xE3, 0xFF, 0x6A, 0x4C, 0xED, 0x40, 0xF0, -+0x61, 0xA1, 0x40, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x4D, 0xFF, 0x6A, 0x4C, 0xED, 0x0C, 0x92, -+0x6F, 0x45, 0x08, 0x94, 0x78, 0xEA, 0xFF, 0xF7, -+0x1F, 0x6A, 0x12, 0xEB, 0x6D, 0xE4, 0x1F, 0x10, -+0x40, 0xF0, 0xC1, 0xA1, 0x0D, 0x97, 0x3F, 0x6B, -+0x40, 0x6A, 0xFF, 0x6C, 0xCC, 0xEB, 0xCC, 0xEA, -+0x77, 0xE7, 0x8C, 0xEA, 0x8C, 0xED, 0x03, 0x22, -+0x01, 0x4D, 0x8C, 0xED, 0x04, 0x10, 0x0D, 0x92, -+0x42, 0xEB, 0x01, 0x61, 0x01, 0x6D, 0x0A, 0x93, -+0x09, 0x94, 0xFF, 0xF7, 0x1F, 0x6A, 0x08, 0x96, -+0x8D, 0xE3, 0x0C, 0x94, 0x4C, 0xEB, 0x0A, 0xD3, -+0x98, 0xED, 0x12, 0xEB, 0x6D, 0xE6, 0x4C, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0x25, 0xF6, 0x48, 0x9A, -+0x01, 0x6E, 0x08, 0xD3, 0xCC, 0xEA, 0x0C, 0x22, -+0x40, 0xF0, 0x41, 0xA1, 0x10, 0xF0, 0x24, 0x6C, -+0x3F, 0x6F, 0x5A, 0x33, 0xFD, 0xF4, 0x14, 0x4C, -+0x6C, 0xEE, 0x4C, 0xEF, 0x80, 0x18, 0x35, 0x19, -+0x0B, 0x92, 0x09, 0x94, 0x12, 0x97, 0x11, 0x93, -+0x5D, 0xE7, 0x8D, 0xE3, 0xFF, 0xF7, 0x1F, 0x6A, -+0x4C, 0xEB, 0x4C, 0xEF, 0x0B, 0xD7, 0x09, 0xD3, -+0x40, 0xF0, 0x61, 0xA1, 0x40, 0x6A, 0x6D, 0xEA, -+0x40, 0xF0, 0x41, 0xC1, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x08, 0x95, 0x01, 0x6B, -+0x6C, 0xEA, 0x0C, 0xD5, 0x08, 0x22, 0x08, 0x96, -+0x10, 0xF0, 0x24, 0x6C, 0x1D, 0xF5, 0x04, 0x4C, -+0xB0, 0x67, 0x80, 0x18, 0x35, 0x19, 0x09, 0x96, -+0x0A, 0x97, 0x08, 0x94, 0x0B, 0x95, 0xEB, 0xE6, -+0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEA, 0x04, 0xD2, -+0xCB, 0xE4, 0xAB, 0xE2, 0x0B, 0x96, 0x0C, 0x95, -+0x09, 0x97, 0x90, 0x67, 0x05, 0xD2, 0x80, 0x18, -+0x8B, 0x1C, 0x0E, 0x96, 0x38, 0x26, 0xFD, 0x67, -+0x87, 0x47, 0x21, 0x4C, 0xE0, 0xAC, 0x30, 0xF0, -+0x20, 0x6A, 0x9D, 0x67, 0xB3, 0xF1, 0x64, 0x40, -+0xC0, 0xF1, 0x08, 0x4A, 0xA7, 0x44, 0x64, 0x33, -+0x4D, 0xE3, 0x1D, 0x4D, 0xE0, 0xCB, 0x80, 0xAD, -+0x33, 0xF3, 0x64, 0x40, 0xBD, 0x67, 0xC7, 0x45, -+0x64, 0x33, 0x4D, 0xE3, 0x25, 0x4E, 0x80, 0xCB, -+0xA0, 0xAE, 0xB3, 0xF2, 0x64, 0x40, 0xDD, 0x67, -+0xE7, 0x46, 0x64, 0x33, 0x4D, 0xE3, 0x19, 0x4F, -+0xA0, 0xCB, 0xC0, 0xAF, 0x33, 0xF2, 0x64, 0x40, -+0x64, 0x33, 0x49, 0xE3, 0xC0, 0xCA, 0x20, 0xF0, -+0x48, 0xA1, 0x08, 0x93, 0xFF, 0xF7, 0x1F, 0x6F, -+0xEC, 0xEA, 0x43, 0xEB, 0x00, 0xF1, 0x1E, 0x61, -+0x90, 0x67, 0x80, 0x18, 0x5C, 0x23, 0x90, 0x67, -+0x80, 0x18, 0xFD, 0x24, 0x17, 0x11, 0xBD, 0x67, -+0xC7, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0x2F, 0xF7, -+0x18, 0x4A, 0x21, 0x4E, 0x0C, 0x34, 0xA0, 0xAE, -+0x91, 0xE2, 0xDD, 0x67, 0x30, 0xF0, 0x20, 0x6A, -+0xB3, 0xF0, 0x64, 0x40, 0xC0, 0xF1, 0x08, 0x4A, -+0xE7, 0x46, 0x64, 0x33, 0x4D, 0xE3, 0x1D, 0x4F, -+0xA0, 0xCB, 0xC0, 0xAF, 0x33, 0xF1, 0x64, 0x40, -+0xFD, 0x67, 0xA7, 0x47, 0x64, 0x33, 0x4D, 0xE3, -+0x25, 0x4D, 0xC0, 0xCB, 0xE0, 0xAD, 0x33, 0xF0, -+0x64, 0x40, 0x64, 0x33, 0x4D, 0xE3, 0xE0, 0xCB, -+0xB2, 0xF7, 0x64, 0x40, 0x64, 0x33, 0x49, 0xE3, -+0x7D, 0x67, 0xA7, 0x43, 0x19, 0x4D, 0x60, 0xAD, -+0x08, 0x96, 0xFF, 0xF7, 0x1F, 0x6D, 0x60, 0xCA, -+0x43, 0xAC, 0xCF, 0xE5, 0x62, 0xEA, 0x02, 0x60, -+0x49, 0xE6, 0x43, 0xCC, 0xA7, 0x40, 0x30, 0xF0, -+0x20, 0x6B, 0x43, 0x4D, 0x30, 0xF0, 0x20, 0x6A, -+0xB2, 0xF7, 0x84, 0x40, 0xAC, 0x35, 0xEF, 0xF4, -+0x08, 0x4B, 0x6D, 0xE5, 0x84, 0x34, 0xC0, 0xF1, -+0x08, 0x4A, 0x51, 0xE4, 0x0A, 0xD3, 0x80, 0xAC, -+0x64, 0xA3, 0x63, 0xEC, 0x08, 0x61, 0x90, 0x67, -+0x80, 0x18, 0xC8, 0x21, 0x0A, 0x97, 0x41, 0xA7, -+0x01, 0x4A, 0x41, 0xC7, 0xC3, 0x10, 0x20, 0xF0, -+0x87, 0xA1, 0x80, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0xFF, 0x6C, 0x8C, 0xEB, 0xA0, 0xF0, 0x1A, 0x23, -+0x65, 0xF4, 0x40, 0x9A, 0x01, 0x6B, 0x6C, 0xEA, -+0x07, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x1D, 0xF5, -+0x14, 0x4C, 0xB0, 0x67, 0x80, 0x18, 0x35, 0x19, -+0x90, 0x67, 0x80, 0x18, 0xC8, 0x21, 0x20, 0xF0, -+0x67, 0xA1, 0x7F, 0x6A, 0x6C, 0xEA, 0x20, 0xF0, -+0x47, 0xC1, 0xA4, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x65, 0xF4, 0x60, 0x9A, -+0x01, 0x6C, 0x8C, 0xEB, 0x15, 0x23, 0x09, 0x93, -+0x0B, 0x94, 0x0C, 0x95, 0x04, 0xD3, 0xB2, 0xF7, -+0x64, 0x40, 0x64, 0x33, 0x05, 0xD4, 0x06, 0xD5, -+0x49, 0xE3, 0x40, 0xAA, 0x0F, 0x95, 0x10, 0x96, -+0x0D, 0x97, 0x10, 0xF0, 0x24, 0x6C, 0x3D, 0xF5, -+0x00, 0x4C, 0x07, 0xD2, 0x80, 0x18, 0x35, 0x19, -+0x10, 0x92, 0x0F, 0x96, 0x00, 0x6D, 0xCE, 0xEA, -+0x21, 0x2A, 0x40, 0xF0, 0xC1, 0xA1, 0x0D, 0x97, -+0x3F, 0x6B, 0x40, 0x6A, 0xFF, 0x6C, 0xCC, 0xEB, -+0xCC, 0xEA, 0x77, 0xE7, 0x8C, 0xEA, 0x8C, 0xED, -+0x03, 0x22, 0x01, 0x4D, 0x8C, 0xED, 0x04, 0x10, -+0x0D, 0x92, 0x42, 0xEB, 0x01, 0x61, 0x01, 0x6D, -+0x0A, 0x93, 0x09, 0x94, 0xFF, 0xF7, 0x1F, 0x6A, -+0x08, 0x96, 0x8D, 0xE3, 0x0C, 0x94, 0x4C, 0xEB, -+0x0A, 0xD3, 0x98, 0xED, 0x12, 0xEB, 0x79, 0xE6, -+0x4C, 0xEE, 0x08, 0xD6, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x01, 0x6E, 0xCC, 0xEA, -+0x0C, 0x22, 0x40, 0xF0, 0x41, 0xA1, 0x10, 0xF0, -+0x24, 0x6C, 0x3F, 0x6F, 0x5A, 0x33, 0xFD, 0xF4, -+0x14, 0x4C, 0x6C, 0xEE, 0x4C, 0xEF, 0x80, 0x18, -+0x35, 0x19, 0x12, 0x97, 0x0B, 0x93, 0x11, 0x95, -+0x09, 0x96, 0x69, 0xE7, 0xFF, 0xF7, 0x1F, 0x6C, -+0xCD, 0xE5, 0x40, 0xF0, 0xA1, 0xA1, 0x8C, 0xEA, -+0x8C, 0xEB, 0x41, 0x6C, 0x8B, 0xEC, 0xAC, 0xEC, -+0x40, 0xF0, 0x81, 0xC1, 0x0E, 0x97, 0x1A, 0x27, -+0xDD, 0x67, 0xE7, 0x46, 0x21, 0x4F, 0xB3, 0xF1, -+0xA4, 0x40, 0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xAF, -+0xC0, 0xF1, 0x08, 0x4C, 0xA4, 0x35, 0x95, 0xE5, -+0xC0, 0xCD, 0x33, 0xF3, 0xA4, 0x40, 0xA4, 0x35, -+0x95, 0xE5, 0x60, 0xCD, 0xB3, 0xF2, 0x64, 0x40, -+0x64, 0x33, 0x8D, 0xE3, 0x40, 0xCB, 0x23, 0xF2, -+0x14, 0x48, 0x19, 0x10, 0xDD, 0x67, 0xE7, 0x46, -+0x21, 0x4F, 0xB3, 0xF0, 0xA4, 0x40, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xAF, 0xC0, 0xF1, 0x08, 0x4C, -+0xA4, 0x35, 0x95, 0xE5, 0xC0, 0xCD, 0x33, 0xF1, -+0xA4, 0x40, 0xA4, 0x35, 0x95, 0xE5, 0x60, 0xCD, -+0x33, 0xF0, 0x64, 0x40, 0x64, 0x33, 0x8D, 0xE3, -+0x40, 0xCB, 0xA2, 0xF7, 0x14, 0x48, 0xFD, 0x67, -+0x47, 0x47, 0x19, 0x4A, 0xE0, 0xAA, 0x04, 0x30, -+0x91, 0xE0, 0xE0, 0xCC, 0x0D, 0x92, 0x40, 0xF0, -+0x81, 0xA1, 0x3F, 0x6B, 0x4C, 0xEB, 0x40, 0x6A, -+0x4B, 0xEA, 0x8C, 0xEA, 0x6D, 0xEA, 0x40, 0xF0, -+0x41, 0xC1, 0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x25, 0xF6, 0x48, 0x9A, 0x01, 0x6B, 0x6C, 0xEA, -+0x07, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x5D, 0xF5, -+0x10, 0x4C, 0xB0, 0x67, 0x80, 0x18, 0x35, 0x19, -+0x17, 0x97, 0x16, 0x91, 0x15, 0x90, 0x0C, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x01, 0x6A, 0x20, 0xE8, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x01, 0x75, 0x1F, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF6, 0x30, 0x9A, -+0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x41, 0xF1, 0x08, 0x6C, 0x02, 0x6E, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, -+0x41, 0xF1, 0x0C, 0x6C, 0x02, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF0, 0x34, 0x9A, -+0x21, 0xF4, 0x00, 0x6C, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x00, 0x6E, 0x46, 0x10, 0x02, 0x75, -+0x26, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xFB, 0xF6, -+0x30, 0x9A, 0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, -+0x50, 0x98, 0xB1, 0x67, 0x41, 0xF1, 0x08, 0x6C, -+0x02, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x41, 0xF1, 0x0C, 0x6C, 0x01, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF0, -+0x34, 0x9A, 0xCE, 0xF4, 0x50, 0x98, 0x21, 0xF4, -+0x00, 0x6C, 0xB1, 0x67, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xE1, 0xF0, 0x10, 0x6C, -+0xB1, 0x67, 0x01, 0x6E, 0x25, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xFB, 0xF6, 0x30, 0x9A, 0x30, 0xF0, -+0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, -+0x41, 0xF1, 0x08, 0x6C, 0x02, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, 0x41, 0xF1, -+0x0C, 0x6C, 0x02, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF0, 0x34, 0x9A, 0xCE, 0xF4, -+0x50, 0x98, 0x21, 0xF4, 0x00, 0x6C, 0xB1, 0x67, -+0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xE1, 0xF0, 0x10, 0x6C, 0xB1, 0x67, 0x00, 0x6E, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x0B, 0xD5, 0x6B, 0xA4, -+0xFF, 0x6A, 0x27, 0x67, 0x04, 0x67, 0x4C, 0xE9, -+0x12, 0x23, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x50, 0x9A, 0x60, 0x9C, 0x6C, 0xEA, 0x4B, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0x5D, 0xF5, 0x1C, 0x4C, 0xFB, 0xF3, 0x04, 0x4D, -+0x80, 0x18, 0x35, 0x19, 0x40, 0x10, 0x02, 0x2E, -+0x54, 0x59, 0x14, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x70, 0x9A, 0x40, 0x98, 0x4C, 0xEB, -+0x00, 0x6A, 0x36, 0x23, 0x10, 0xF0, 0x24, 0x6C, -+0x10, 0xF0, 0x24, 0x6D, 0x9D, 0xF5, 0x00, 0x4C, -+0xFB, 0xF3, 0x04, 0x4D, 0x80, 0x18, 0x35, 0x19, -+0x00, 0x6A, 0x2A, 0x10, 0x04, 0x6C, 0x8B, 0xEC, -+0x2C, 0xEC, 0x4C, 0xEC, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0x0B, 0x96, 0xFF, 0xF7, -+0x1F, 0x6B, 0x03, 0xF5, 0x00, 0x4C, 0x01, 0x6D, -+0x6C, 0xEC, 0xAB, 0xED, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x98, -+0x6C, 0xEA, 0x11, 0x22, 0x03, 0xF5, 0x40, 0x41, -+0x04, 0xD2, 0x0B, 0x92, 0x10, 0xF0, 0x24, 0x6C, -+0x10, 0xF0, 0x24, 0x6D, 0xBD, 0xF5, 0x00, 0x4C, -+0xFB, 0xF3, 0x04, 0x4D, 0x00, 0x6E, 0xF1, 0x67, -+0x05, 0xD2, 0x80, 0x18, 0x35, 0x19, 0x01, 0x6A, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0x69, 0x2C, 0xEE, -+0x0C, 0xD4, 0x45, 0x67, 0x06, 0xD6, 0x02, 0x2D, -+0x54, 0x5E, 0x15, 0x61, 0x0C, 0x95, 0x10, 0xF0, -+0x24, 0x6B, 0x3B, 0xF7, 0x70, 0x9B, 0x80, 0x9D, -+0xFF, 0x69, 0x8C, 0xEB, 0x54, 0x23, 0x10, 0xF0, -+0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, 0x9D, 0xF5, -+0x00, 0x4C, 0xDB, 0xF3, 0x04, 0x4D, 0xC2, 0x67, -+0x80, 0x18, 0x35, 0x19, 0x48, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0x5B, 0xF7, -+0x00, 0x4B, 0xA0, 0x9B, 0xCE, 0xF4, 0x50, 0x98, -+0x83, 0xF1, 0x18, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0x06, 0x96, 0x83, 0xF1, -+0x18, 0x6C, 0xFF, 0x6D, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x5B, 0xF7, 0x00, 0x4B, 0xA0, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6E, 0x83, 0xF1, -+0x18, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0xFC, 0xF1, 0xB8, 0x9A, 0x21, 0xF5, 0x10, 0x6C, -+0x00, 0x18, 0xE4, 0xE6, 0x10, 0xF0, 0x24, 0x6B, -+0x5B, 0xF7, 0x00, 0x4B, 0xA0, 0x9B, 0x4C, 0xE9, -+0xCE, 0xF4, 0x50, 0x98, 0x83, 0xF1, 0x18, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0x0C, 0x94, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x9C, -+0x6C, 0xEA, 0x0D, 0x22, 0x06, 0x97, 0x10, 0xF0, -+0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, 0xDD, 0xF5, -+0x10, 0x4C, 0xDB, 0xF3, 0x04, 0x4D, 0x00, 0x6E, -+0x04, 0xD1, 0x80, 0x18, 0x35, 0x19, 0x51, 0x67, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0xFF, 0x68, 0xEC, 0xE8, -+0xFC, 0x6A, 0x03, 0x6B, 0x0C, 0xEA, 0x0C, 0xEB, -+0x0E, 0xD4, 0x0F, 0xD5, 0x08, 0xD2, 0x09, 0xD3, -+0x06, 0x2E, 0x54, 0x58, 0x04, 0x60, 0x00, 0x69, -+0x07, 0xD2, 0x06, 0xD1, 0x15, 0x10, 0x0E, 0x94, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x70, 0x9A, -+0x40, 0x9C, 0x4C, 0xEB, 0x00, 0x6A, 0x4F, 0x23, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0x9D, 0xF5, 0x00, 0x4C, 0x1B, 0xF4, 0x04, 0x4D, -+0x80, 0x18, 0x35, 0x19, 0x00, 0x6A, 0x43, 0x10, -+0x09, 0x93, 0xFF, 0x6A, 0x2C, 0xEA, 0x6E, 0xEA, -+0x06, 0x22, 0x0E, 0x94, 0x07, 0x96, 0x00, 0x6D, -+0x80, 0x18, 0x01, 0x27, 0x03, 0x10, 0x0F, 0x93, -+0x3F, 0x6A, 0x6C, 0xEA, 0x06, 0x94, 0x2C, 0x33, -+0x44, 0xEB, 0x4D, 0xEC, 0x07, 0x92, 0x01, 0x49, -+0x04, 0x71, 0x01, 0x4A, 0x07, 0xD2, 0x07, 0x93, -+0xFF, 0x6A, 0x06, 0xD4, 0x4C, 0xEB, 0x07, 0xD3, -+0xE3, 0x61, 0x08, 0x94, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0x06, 0x96, 0x01, 0x6D, -+0x03, 0xF5, 0x00, 0x4C, 0xAB, 0xED, 0x40, 0xEA, -+0x0E, 0x94, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x70, 0x9A, 0x40, 0x9C, 0x4C, 0xEB, 0x01, 0x6A, -+0x12, 0x23, 0x03, 0xF5, 0x40, 0x40, 0x04, 0xD2, -+0x0F, 0x92, 0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, -+0x24, 0x6D, 0xBD, 0xF5, 0x00, 0x4C, 0x1B, 0xF4, -+0x04, 0x4D, 0x00, 0x6E, 0xF0, 0x67, 0x05, 0xD2, -+0x80, 0x18, 0x35, 0x19, 0x01, 0x6A, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x0C, 0xD4, 0x45, 0x67, 0x1A, 0x25, 0x10, 0xF0, -+0x24, 0x6B, 0x3B, 0xF7, 0x70, 0x9B, 0x80, 0x9C, -+0x8C, 0xEB, 0x04, 0x2B, 0x01, 0x6A, 0x4B, 0xEA, -+0x06, 0xD2, 0x34, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0x10, 0xF0, 0x24, 0x6D, 0x9D, 0xF5, 0x00, 0x4C, -+0xBB, 0xF4, 0x0C, 0x4D, 0xC2, 0x67, 0x80, 0x18, -+0x35, 0x19, 0x01, 0x6C, 0x8B, 0xEC, 0x06, 0xD4, -+0x25, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, -+0x10, 0x9A, 0xFF, 0x69, 0xCC, 0xE9, 0xEC, 0xE8, -+0x28, 0x34, 0xB0, 0x67, 0x05, 0xF0, 0x00, 0x4C, -+0x00, 0x18, 0xE4, 0xE6, 0x0C, 0x95, 0x06, 0xD2, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x50, 0x9A, -+0x60, 0x9D, 0x6C, 0xEA, 0x0F, 0x22, 0x06, 0x92, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0xFD, 0xF5, 0x18, 0x4C, 0xBB, 0xF4, 0x0C, 0x4D, -+0x00, 0x6E, 0xF1, 0x67, 0x04, 0xD2, 0x05, 0xD0, -+0x80, 0x18, 0x35, 0x19, 0x06, 0x92, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x0E, 0xD4, 0x45, 0x67, 0x12, 0x91, 0x13, 0x25, -+0x10, 0xF0, 0x24, 0x6B, 0x3B, 0xF7, 0x70, 0x9B, -+0x80, 0x9C, 0x8C, 0xEB, 0x7F, 0x23, 0x10, 0xF0, -+0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, 0x9D, 0xF5, -+0x00, 0x4C, 0x9B, 0xF4, 0x0C, 0x4D, 0xC2, 0x67, -+0x80, 0x18, 0x35, 0x19, 0x73, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF0, 0x50, 0x9A, 0xFF, 0x68, -+0x00, 0x6B, 0x4C, 0xEF, 0x4A, 0xEF, 0xCC, 0xE8, -+0x08, 0xD7, 0x09, 0xD3, 0x30, 0x60, 0x0E, 0x94, -+0xA3, 0x67, 0xD0, 0x67, 0xE2, 0x67, 0x80, 0x18, -+0x72, 0x27, 0x09, 0xD2, 0x01, 0x4A, 0x13, 0x2A, -+0x0E, 0x94, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x50, 0x9A, 0x60, 0x9C, 0x6C, 0xEA, 0x56, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0x3D, 0xF6, 0x04, 0x4C, 0x9B, 0xF4, 0x0C, 0x4D, -+0x80, 0x18, 0x35, 0x19, 0x4B, 0x10, 0x00, 0x6B, -+0x43, 0x67, 0x08, 0x94, 0x01, 0x6D, 0x86, 0xEB, -+0xAC, 0xEC, 0x07, 0x2C, 0x01, 0x4A, 0xFF, 0x6C, -+0x8C, 0xEA, 0x14, 0x72, 0x01, 0x4B, 0xF5, 0x61, -+0x14, 0x6A, 0x08, 0x95, 0x09, 0x93, 0x24, 0xEA, -+0xAF, 0xEA, 0x6C, 0xEA, 0x4D, 0xE9, 0x10, 0xF0, -+0x24, 0x6A, 0xBC, 0xF0, 0x50, 0x9A, 0x00, 0xF5, -+0x00, 0x33, 0x01, 0x6D, 0x2C, 0xEA, 0x6D, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0xF0, 0x9B, -+0x10, 0xF0, 0x24, 0x6B, 0x1C, 0xF2, 0xD0, 0x9B, -+0x81, 0xF4, 0x10, 0x6C, 0xAB, 0xED, 0x4C, 0xEE, -+0x40, 0xEF, 0x0E, 0x94, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x9C, 0x6C, 0xEA, -+0x11, 0x22, 0x09, 0x95, 0x08, 0x92, 0x10, 0xF0, -+0x24, 0x6C, 0x05, 0xD5, 0x10, 0xF0, 0x24, 0x6D, -+0x5D, 0xF6, 0x08, 0x4C, 0x9B, 0xF4, 0x0C, 0x4D, -+0x00, 0x6E, 0xF0, 0x67, 0x04, 0xD1, 0x06, 0xD2, -+0x80, 0x18, 0x35, 0x19, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0D, 0x6C, 0x40, 0xEA, -+0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x50, 0x9A, -+0x60, 0x9C, 0xFF, 0x68, 0x24, 0x67, 0x6C, 0xEA, -+0xAC, 0xE8, 0x0A, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0x10, 0xF0, 0x24, 0x6D, 0x9D, 0xF6, 0x04, 0x4C, -+0x5B, 0xF4, 0x08, 0x4D, 0x80, 0x18, 0x35, 0x19, -+0x4B, 0xA1, 0x13, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x99, 0x6C, 0xEA, -+0xC0, 0xF1, 0x1A, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0x10, 0xF0, 0x24, 0x6D, 0x5D, 0xF5, 0x1C, 0x4C, -+0x5B, 0xF4, 0x08, 0x4D, 0x80, 0x18, 0x35, 0x19, -+0xCF, 0x11, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF4, -+0x1C, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, -+0xF0, 0x9A, 0x91, 0x67, 0x00, 0x6D, 0x18, 0x6E, -+0x80, 0x18, 0x72, 0x27, 0x09, 0xD2, 0x09, 0x93, -+0x00, 0x6A, 0x01, 0x4B, 0x01, 0x23, 0x01, 0x6A, -+0x01, 0x6B, 0x4C, 0xEB, 0x07, 0xD3, 0x60, 0xF2, -+0x50, 0xA1, 0x00, 0x6B, 0x08, 0xD3, 0x12, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0xF0, 0x9A, -+0xA3, 0x67, 0x91, 0x67, 0xB8, 0x6E, 0x80, 0x18, -+0x72, 0x27, 0x08, 0xD2, 0x08, 0x93, 0x00, 0x6A, -+0x01, 0x4B, 0x01, 0x23, 0x01, 0x6A, 0x07, 0x93, -+0x4C, 0xEB, 0x07, 0xD3, 0x0F, 0x58, 0x71, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF2, 0x54, 0x9A, -+0x09, 0x93, 0x01, 0xF4, 0x1C, 0x6C, 0x01, 0xF7, -+0x00, 0x6D, 0x4C, 0xEB, 0x0D, 0xEB, 0x06, 0xD3, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x00, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0x1C, 0xF2, 0xB8, 0x9B, 0x61, 0xF0, 0x00, 0x6C, -+0x61, 0xF1, 0x0A, 0x6E, 0x40, 0xEA, 0x60, 0xF2, -+0x50, 0xA1, 0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x08, 0x93, 0x5B, 0xF7, 0x4C, 0x9A, 0x4D, 0xEB, -+0x08, 0xD3, 0x0E, 0x70, 0x20, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, 0x01, 0x6D, -+0x21, 0xF2, 0x04, 0x6C, 0xAB, 0xED, 0x17, 0xF0, -+0x1C, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x21, 0xF2, 0x08, 0x6C, -+0xFF, 0xF7, 0x1F, 0x6D, 0x00, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x01, 0x6D, 0xCE, 0xF4, -+0x50, 0x9B, 0xA1, 0xF2, 0x0C, 0x6C, 0xAB, 0xED, -+0x66, 0xF6, 0x07, 0x6E, 0x24, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x70, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x1C, 0xF2, 0xDC, 0x9A, 0x01, 0x6D, -+0x21, 0xF2, 0x04, 0x6C, 0xAB, 0xED, 0x40, 0xEB, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x21, 0xF2, 0x08, 0x6C, 0xFF, 0xF7, 0x1F, 0x6D, -+0x11, 0xF0, 0x10, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, -+0x24, 0x6B, 0x3C, 0xF2, 0xC0, 0x9B, 0x01, 0x6D, -+0xA1, 0xF2, 0x0C, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0xE5, 0x10, 0x24, 0x58, 0xC0, 0xF0, 0x16, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x1C, 0xF2, 0x54, 0x9A, -+0x09, 0x93, 0x4C, 0xEB, 0x0D, 0xEB, 0x06, 0xD3, -+0x68, 0x40, 0xE4, 0x4B, 0xFF, 0x6A, 0x4C, 0xEB, -+0x1D, 0x5B, 0x21, 0x61, 0x68, 0x40, 0xA4, 0x4B, -+0x4C, 0xEB, 0x29, 0x5B, 0x05, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x5B, 0xF7, 0x44, 0x9A, 0x06, 0x10, -+0x8D, 0x58, 0x08, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x5B, 0xF7, 0x48, 0x9A, 0x06, 0x93, 0x4D, 0xEB, -+0x06, 0xD3, 0x0D, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x99, 0x6C, 0xEA, -+0x00, 0xF1, 0x04, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0xBD, 0xF6, 0x00, 0x4C, 0xE3, 0x10, 0x68, 0x40, -+0xE4, 0x4B, 0xFF, 0x6A, 0x4C, 0xEB, 0x1D, 0x5B, -+0x0A, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x01, 0xF4, 0x1C, 0x6C, 0x01, 0xF7, -+0x00, 0x6D, 0x01, 0x6E, 0x1A, 0x10, 0x68, 0x40, -+0xA4, 0x4B, 0x4C, 0xEB, 0x2D, 0x5B, 0x0A, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, -+0x01, 0xF4, 0x1C, 0x6C, 0x01, 0xF7, 0x00, 0x6D, -+0x02, 0x6E, 0x0B, 0x10, 0x95, 0x58, 0x11, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, -+0x01, 0xF4, 0x1C, 0x6C, 0x01, 0xF7, 0x00, 0x6D, -+0x03, 0x6E, 0x40, 0xEA, 0x68, 0x40, 0xE4, 0x4B, -+0xFF, 0x6A, 0x4C, 0xEB, 0x0D, 0x5B, 0x1B, 0x60, -+0x0D, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x50, 0x9A, 0x60, 0x99, 0x6C, 0xEA, 0xC0, 0xF0, -+0x05, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0xDD, 0xF6, -+0x10, 0x4C, 0xA4, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x9A, -+0x61, 0xF0, 0x00, 0x6C, 0x1C, 0xF2, 0xB8, 0x9B, -+0x80, 0xF4, 0x14, 0x6E, 0x35, 0x10, 0x68, 0x40, -+0xD4, 0x4B, 0x4C, 0xEB, 0x0D, 0x5B, 0x0D, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x9A, 0x61, 0xF0, 0x00, 0x6C, -+0x1C, 0xF2, 0xB8, 0x9B, 0x40, 0xF4, 0x13, 0x6E, -+0x23, 0x10, 0x68, 0x40, 0xA4, 0x4B, 0x4C, 0xEB, -+0x11, 0x5B, 0x0D, 0x60, 0x30, 0xF0, 0x20, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x9A, -+0x61, 0xF0, 0x00, 0x6C, 0x1C, 0xF2, 0xB8, 0x9B, -+0x40, 0xF4, 0x12, 0x6E, 0x11, 0x10, 0x68, 0x40, -+0x92, 0x4B, 0x4C, 0xEB, 0x3C, 0x5B, 0x11, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x9A, 0x1C, 0xF2, 0xB8, 0x9B, -+0x61, 0xF0, 0x00, 0x6C, 0x00, 0xF4, 0x12, 0x6E, -+0x40, 0xEA, 0x60, 0xF2, 0x50, 0xA1, 0x2E, 0x2A, -+0x0C, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x50, 0x9A, 0x60, 0x99, 0x6C, 0xEA, 0x72, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x1D, 0xF7, 0x00, 0x4C, -+0x51, 0x10, 0x48, 0x40, 0xCF, 0x4A, 0xFF, 0x6B, -+0x6C, 0xEA, 0x13, 0x5A, 0x07, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF2, 0x44, 0x9A, 0x08, 0x93, -+0x4C, 0xEB, 0x06, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x5B, 0xF7, 0x4C, 0x9A, 0x08, 0x93, 0x4D, 0xEB, -+0x08, 0xD3, 0x0C, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x99, 0x6C, 0xEA, -+0x51, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x3D, 0xF7, -+0x14, 0x4C, 0x30, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0xBC, 0xF0, 0x10, 0x4B, 0x06, 0x92, 0xE0, 0x9B, -+0x91, 0x67, 0x00, 0x6D, 0x18, 0x6E, 0x04, 0xD2, -+0x80, 0x18, 0x98, 0x27, 0x07, 0x93, 0x4C, 0xEB, -+0x07, 0xD3, 0x60, 0xF2, 0x50, 0xA1, 0x11, 0x2A, -+0x10, 0xF0, 0x24, 0x6B, 0xBC, 0xF0, 0x10, 0x4B, -+0x08, 0x92, 0xE0, 0x9B, 0x91, 0x67, 0x00, 0x6D, -+0xB8, 0x6E, 0x04, 0xD2, 0x80, 0x18, 0x98, 0x27, -+0x07, 0x93, 0x4C, 0xEB, 0xFF, 0x6A, 0x4C, 0xEB, -+0x07, 0xD3, 0x07, 0x92, 0x13, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x99, -+0x6C, 0xEA, 0x20, 0x22, 0x10, 0xF0, 0x24, 0x6C, -+0x5D, 0xF7, 0x18, 0x4C, 0x10, 0xF0, 0x24, 0x6D, -+0x5B, 0xF4, 0x08, 0x4D, 0xD0, 0x67, 0x80, 0x18, -+0x35, 0x19, 0x14, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x99, 0x6C, 0xEA, -+0x0B, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, -+0x24, 0x6D, 0xBD, 0xF7, 0x04, 0x4C, 0x5B, 0xF4, -+0x08, 0x4D, 0xD0, 0x67, 0x80, 0x18, 0x35, 0x19, -+0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0xFF, 0x6A, 0xAC, 0xEA, 0x06, 0xD2, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x9C, -+0x04, 0x67, 0x6C, 0xEA, 0x0A, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, 0xDD, 0xF7, -+0x10, 0x4C, 0x7B, 0xF4, 0x0C, 0x4D, 0x80, 0x18, -+0x35, 0x19, 0x4B, 0xA0, 0x13, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x98, -+0x6C, 0xEA, 0xC0, 0xF0, 0x13, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, 0x5D, 0xF5, -+0x1C, 0x4C, 0x7B, 0xF4, 0x0C, 0x4D, 0x80, 0x18, -+0x35, 0x19, 0xC8, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF0, 0xF0, 0x9A, 0x90, 0x67, 0x00, 0x6D, -+0x18, 0x6E, 0x80, 0x18, 0x72, 0x27, 0x07, 0xD2, -+0x06, 0x92, 0x0F, 0x5A, 0x48, 0x60, 0x30, 0xF0, -+0x20, 0x69, 0x10, 0xF0, 0x24, 0x6B, 0xFB, 0xF6, -+0xA8, 0x9B, 0xCE, 0xF4, 0x50, 0x99, 0x01, 0xF0, -+0x08, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x99, 0x40, 0xF4, 0x14, 0x6C, 0x80, 0x6D, -+0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x99, 0x5B, 0xF7, 0xA8, 0x9B, -+0x81, 0xF2, 0x00, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x99, 0x01, 0xF0, 0x14, 0x6C, -+0x1F, 0xF4, 0x00, 0x6D, 0x0F, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF2, 0x28, 0x9A, -+0x07, 0x92, 0x4C, 0xE9, 0x30, 0xF0, 0x21, 0x6A, -+0x70, 0xF3, 0x49, 0xA2, 0x03, 0x22, 0x90, 0x67, -+0x00, 0x6D, 0x02, 0x10, 0x90, 0x67, 0x01, 0x6D, -+0x00, 0x18, 0x86, 0xC5, 0x10, 0xF0, 0x24, 0x6A, -+0xBC, 0xF0, 0xF0, 0x9A, 0x90, 0x67, 0x00, 0x6D, -+0x18, 0x6E, 0x04, 0xD1, 0x80, 0x18, 0x98, 0x27, -+0x06, 0x95, 0x90, 0x67, 0x22, 0x67, 0x80, 0x18, -+0x8F, 0x26, 0x43, 0x2A, 0x71, 0x10, 0x06, 0x92, -+0x24, 0x5A, 0x33, 0x61, 0x30, 0xF0, 0x20, 0x69, -+0x10, 0xF0, 0x24, 0x6B, 0x5B, 0xF7, 0xA8, 0x9B, -+0xCE, 0xF4, 0x50, 0x99, 0x81, 0xF2, 0x00, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x99, -+0x40, 0xF4, 0x14, 0x6C, 0x80, 0x6D, 0x01, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x99, 0xFB, 0xF6, 0xA8, 0x9B, 0x01, 0xF0, -+0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x99, 0x01, 0xF0, 0x14, 0x6C, 0x1F, 0xF4, -+0x00, 0x6D, 0x0F, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF2, 0x28, 0x9A, 0x07, 0x92, -+0x90, 0x67, 0x02, 0x6D, 0x4C, 0xE9, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF2, 0x4C, 0x9A, 0x4D, 0xE9, -+0xB7, 0x17, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x50, 0x9A, 0x60, 0x98, 0x6C, 0xEA, 0x34, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x3D, 0xF7, 0x14, 0x4C, -+0x14, 0x10, 0x07, 0x92, 0x00, 0x6B, 0x01, 0x4A, -+0x01, 0x22, 0x01, 0x6B, 0xFF, 0x6A, 0x2C, 0xEA, -+0x6C, 0xEA, 0x13, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x98, 0x6C, 0xEA, -+0x1F, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0xFD, 0xF7, -+0x10, 0x4C, 0x06, 0x96, 0x10, 0xF0, 0x24, 0x6D, -+0x7B, 0xF4, 0x0C, 0x4D, 0x80, 0x18, 0x35, 0x19, -+0x13, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, -+0x50, 0x9A, 0x60, 0x98, 0x6C, 0xEA, 0x0E, 0x22, -+0x06, 0x96, 0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, -+0x24, 0x6D, 0x3E, 0xF0, 0x1C, 0x4C, 0x7B, 0xF4, -+0x0C, 0x4D, 0x80, 0x18, 0x35, 0x19, 0x02, 0x10, -+0x00, 0x6A, 0x01, 0x10, 0x01, 0x6A, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0xFF, 0x6A, 0xAC, 0xEA, 0x06, 0xD2, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x9C, -+0x04, 0x67, 0x26, 0x67, 0x6C, 0xEA, 0x0A, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0x7E, 0xF0, 0x04, 0x4C, 0x3B, 0xF4, 0x04, 0x4D, -+0x80, 0x18, 0x35, 0x19, 0x4B, 0xA0, 0x13, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x3B, 0xF7, 0x50, 0x9A, -+0x60, 0x98, 0x6C, 0xEA, 0x80, 0xF1, 0x01, 0x22, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, -+0x5D, 0xF5, 0x1C, 0x4C, 0x3B, 0xF4, 0x04, 0x4D, -+0x80, 0x18, 0x35, 0x19, 0x76, 0x11, 0x06, 0x59, -+0x0A, 0x60, 0x01, 0x71, 0x03, 0x61, 0x06, 0x93, -+0x03, 0x5B, 0x04, 0x10, 0x02, 0x71, 0x10, 0x61, -+0x06, 0x94, 0x05, 0x5C, 0x0D, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x98, -+0x6C, 0xEA, 0x60, 0xF1, 0x04, 0x22, 0x10, 0xF0, -+0x24, 0x6C, 0x9E, 0xF0, 0x00, 0x4C, 0x3D, 0x11, -+0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF4, 0x38, 0xDA, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0xF0, 0x9A, -+0x90, 0x67, 0x00, 0x6D, 0x18, 0x6E, 0x80, 0x18, -+0x72, 0x27, 0x06, 0x59, 0x07, 0xD2, 0xE0, 0xF0, -+0x19, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x28, 0x33, -+0xBB, 0xF3, 0x0C, 0x4A, 0x69, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x18, 0xE4, 0xE6, 0x10, 0xF0, -+0x24, 0x6B, 0x3C, 0xF2, 0x70, 0x9B, 0x01, 0x6D, -+0xA1, 0xF0, 0x0C, 0x6C, 0x4C, 0xEB, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0xF0, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x3C, 0xF2, 0xD4, 0x9A, 0xAB, 0xED, -+0x6D, 0xEE, 0x40, 0xEF, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0xFB, 0xF6, 0xB4, 0x9B, 0xC1, 0xF0, 0x04, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x07, 0x94, 0x01, 0xF4, -+0x00, 0x6A, 0x8D, 0xEA, 0xDC, 0x10, 0x06, 0x92, -+0x01, 0x72, 0x09, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0x01, 0xF2, 0x00, 0x6C, -+0x10, 0x6D, 0x01, 0x6E, 0x08, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x01, 0xF2, -+0x00, 0x6C, 0x10, 0x6D, 0x00, 0x6E, 0x40, 0xEA, -+0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, 0xAB, 0xED, -+0x00, 0x18, 0xE4, 0xE6, 0x10, 0xF0, 0x24, 0x6B, -+0x3C, 0xF2, 0x78, 0x9B, 0x06, 0x94, 0x0F, 0x6E, -+0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0x3C, 0xF2, -+0x5C, 0x9A, 0x8C, 0xEE, 0xC8, 0x36, 0x30, 0xF0, -+0x20, 0x6C, 0x4D, 0xEE, 0xCE, 0xF4, 0x50, 0x9C, -+0x01, 0x6D, 0x6D, 0xEE, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0xFB, 0xF6, 0xB4, 0x9B, 0xC1, 0xF0, 0x04, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x07, 0x94, 0x01, 0xF4, -+0x01, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, 0x01, 0xF0, -+0x00, 0x6B, 0x31, 0x10, 0x01, 0x6D, 0xA1, 0xF0, -+0x0C, 0x6C, 0xAB, 0xED, 0x00, 0x18, 0xE4, 0xE6, -+0x10, 0xF0, 0x24, 0x6B, 0x5C, 0xF2, 0x60, 0x9B, -+0x0F, 0x6E, 0x30, 0xF0, 0x20, 0x6C, 0x4C, 0xEB, -+0x06, 0x92, 0x01, 0x6D, 0xAB, 0xED, 0x4C, 0xEE, -+0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF2, 0x44, 0x9A, -+0xC8, 0x36, 0x4D, 0xEE, 0xCE, 0xF4, 0x50, 0x9C, -+0x6D, 0xEE, 0xA1, 0xF0, 0x0C, 0x6C, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x10, 0xF0, 0x24, 0x6B, 0xFB, 0xF6, 0xB4, 0x9B, -+0xC1, 0xF0, 0x04, 0x6C, 0x01, 0x6E, 0x40, 0xEA, -+0x07, 0x94, 0x01, 0xF4, 0x01, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x00, 0xF4, 0x00, 0x6B, 0x6D, 0xEA, -+0x62, 0x10, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x18, 0xE4, 0xE6, 0x10, 0xF0, -+0x24, 0x6B, 0x5C, 0xF2, 0x68, 0x9B, 0x01, 0x6D, -+0xA1, 0xF0, 0x0C, 0x6C, 0x4C, 0xEB, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0xF0, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xAB, 0xED, 0x5C, 0xF2, 0xCC, 0x9A, -+0x17, 0x10, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x18, 0xE4, 0xE6, 0x10, 0xF0, -+0x24, 0x6B, 0x5C, 0xF2, 0x68, 0x9B, 0x30, 0xF0, -+0x20, 0x6C, 0x01, 0x6D, 0x4C, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0x5C, 0xF2, 0xD0, 0x9A, 0xCE, 0xF4, -+0xF0, 0x9C, 0xAB, 0xED, 0xA1, 0xF0, 0x0C, 0x6C, -+0x6D, 0xEE, 0x40, 0xEF, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0xFB, 0xF6, 0xB4, 0x9B, 0xC1, 0xF0, 0x04, 0x6C, -+0x00, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x50, 0x9C, -+0x3C, 0xF0, 0xB4, 0x9B, 0xC1, 0xF0, 0x08, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x01, 0xF4, 0x00, 0x6A, -+0x07, 0x93, 0xB1, 0x17, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x70, 0x9A, 0x40, 0x98, 0x4C, 0xEB, -+0x07, 0x92, 0x0D, 0x23, 0x06, 0x97, 0x10, 0xF0, -+0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6D, 0x9E, 0xF0, -+0x00, 0x4C, 0x3B, 0xF4, 0x04, 0x4D, 0xD1, 0x67, -+0x80, 0x18, 0x35, 0x19, 0x07, 0x92, 0x04, 0xD2, -+0x10, 0xF0, 0x24, 0x6A, 0xBC, 0xF0, 0xF0, 0x9A, -+0x90, 0x67, 0x00, 0x6D, 0x18, 0x6E, 0x80, 0x18, -+0x98, 0x27, 0x07, 0x93, 0x00, 0x6C, 0x01, 0x4B, -+0x01, 0x23, 0x01, 0x6C, 0xFF, 0x6B, 0x4C, 0xEB, -+0x8C, 0xEB, 0x14, 0x2B, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x98, 0x6C, 0xEA, -+0x26, 0x22, 0x10, 0xF0, 0x24, 0x6C, 0xBE, 0xF0, -+0x1C, 0x4C, 0x06, 0x97, 0x10, 0xF0, 0x24, 0x6D, -+0x3B, 0xF4, 0x04, 0x4D, 0xD1, 0x67, 0x80, 0x18, -+0x35, 0x19, 0x19, 0x10, 0x90, 0x67, 0xB1, 0x67, -+0x80, 0x18, 0x93, 0x26, 0x10, 0xF0, 0x24, 0x6A, -+0x3B, 0xF7, 0x50, 0x9A, 0x60, 0x98, 0x6C, 0xEA, -+0x0C, 0x22, 0x06, 0x97, 0x10, 0xF0, 0x24, 0x6C, -+0x10, 0xF0, 0x24, 0x6D, 0x1E, 0xF1, 0x1C, 0x4C, -+0x3B, 0xF4, 0x04, 0x4D, 0xD1, 0x67, 0x80, 0x18, -+0x35, 0x19, 0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x68, 0x0C, 0xED, -+0x24, 0x67, 0x0D, 0xD7, 0x04, 0xD5, 0xCC, 0xE8, -+0x80, 0x18, 0xE4, 0x28, 0x0F, 0x22, 0x04, 0x95, -+0x91, 0x67, 0x80, 0x18, 0xE2, 0x27, 0x0A, 0x22, -+0x0D, 0x96, 0x91, 0x67, 0xB0, 0x67, 0x80, 0x18, -+0x62, 0x29, 0x4B, 0xEB, 0x4D, 0xEB, 0xC0, 0xF7, -+0x62, 0x32, 0x01, 0x10, 0x00, 0x6A, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6B, 0x86, 0xF0, 0x99, 0xA3, -+0x30, 0xF0, 0x20, 0x6A, 0x1F, 0x6B, 0x8C, 0xEB, -+0xEF, 0xF4, 0x08, 0x4A, 0x60, 0xF6, 0x7C, 0xC2, -+0xFF, 0x6D, 0xFF, 0x4B, 0xAC, 0xEB, 0x00, 0x6C, -+0x07, 0x5B, 0x60, 0xF6, 0x9F, 0xC2, 0x08, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x68, 0x33, 0xDB, 0xF4, -+0x0C, 0x4A, 0x69, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x01, 0x6B, 0x60, 0xF6, 0x7D, 0xC2, 0x60, 0xF6, -+0x9E, 0xC2, 0x0A, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x01, 0x6B, 0x60, 0xF6, -+0x7D, 0xC2, 0x60, 0xF6, 0x7E, 0xC2, 0x00, 0x6C, -+0x80, 0xF6, 0x81, 0xC2, 0x38, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x01, 0x6B, -+0x60, 0xF6, 0x7D, 0xC2, 0x08, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x01, 0x6B, 0xEF, 0xF4, 0x08, 0x4A, -+0x60, 0xF6, 0x7D, 0xC2, 0x00, 0x6B, 0x60, 0xF6, -+0x7E, 0xC2, 0x23, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF4, 0x08, 0x4A, 0x01, 0x6C, 0x00, 0x6B, -+0x60, 0xF6, 0x9D, 0xC2, 0x60, 0xF6, 0x7E, 0xC2, -+0xDF, 0x17, 0x30, 0xF0, 0x20, 0x6A, 0xEF, 0xF4, -+0x08, 0x4A, 0x00, 0x6B, 0x02, 0x6C, 0x60, 0xF6, -+0x7D, 0xC2, 0x80, 0xF6, 0x61, 0xC2, 0x60, 0xF6, -+0x9E, 0xC2, 0x01, 0x6B, 0x0C, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xEF, 0xF4, 0x08, 0x4A, 0x01, 0x6B, -+0x00, 0x6C, 0x60, 0xF6, 0x7D, 0xC2, 0x60, 0xF6, -+0x9E, 0xC2, 0x80, 0xF6, 0x61, 0xC2, 0x80, 0xF6, -+0x60, 0xC2, 0x20, 0xE8, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xFF, 0x6A, 0xEF, 0xF4, 0x08, 0x4B, 0x8C, 0xEA, -+0x60, 0xF6, 0x9D, 0xA3, 0x4F, 0x24, 0x60, 0xF6, -+0x7F, 0xA3, 0x00, 0x69, 0x01, 0x23, 0x01, 0x69, -+0x30, 0xF0, 0x21, 0x6B, 0x70, 0xF3, 0x68, 0xA3, -+0x02, 0x2B, 0x01, 0x6B, 0x6E, 0xE9, 0x05, 0x2A, -+0x3B, 0x10, 0x01, 0x6A, 0x4E, 0xE9, 0x04, 0xD2, -+0x02, 0x10, 0x00, 0x6A, 0x04, 0xD2, 0x10, 0xF0, -+0x24, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0x5C, 0xF2, -+0xB4, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x4C, 0x6C, -+0x02, 0x6E, 0x40, 0xEA, 0x04, 0x93, 0x14, 0x2B, -+0xCE, 0xF4, 0x50, 0x98, 0xA1, 0xF4, 0x14, 0x6C, -+0xFF, 0x6D, 0x77, 0x6E, 0x40, 0xEA, 0x01, 0x59, -+0x38, 0x67, 0x10, 0xF0, 0x24, 0x6B, 0x02, 0x6E, -+0xCE, 0xF4, 0x50, 0x98, 0xA1, 0xF4, 0x14, 0x6C, -+0xFB, 0xF6, 0xB0, 0x9B, 0x3B, 0xE6, 0x12, 0x10, -+0xCE, 0xF4, 0x50, 0x98, 0xA1, 0xF4, 0x14, 0x6C, -+0xFF, 0x6D, 0x66, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x01, 0x59, 0xCE, 0xF4, 0x50, 0x98, -+0xFB, 0xF6, 0xB0, 0x9B, 0xD8, 0x67, 0xA1, 0xF4, -+0x14, 0x6C, 0x01, 0x4E, 0x40, 0xEA, 0x06, 0x10, -+0x30, 0xF0, 0x21, 0x6A, 0x70, 0xF3, 0x49, 0xA2, -+0xC0, 0x22, 0xC3, 0x17, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x30, 0x6B, -+0xC1, 0xF7, 0xB1, 0xA3, 0xFF, 0x6A, 0x4C, 0xEC, -+0x01, 0x6B, 0xAC, 0xEB, 0x0F, 0x5C, 0x4C, 0xEB, -+0x0A, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x5C, 0xF2, -+0x98, 0x9A, 0xFC, 0x6A, 0xA0, 0xA4, 0xAC, 0xEA, -+0x40, 0xC4, 0x00, 0x6C, 0x0E, 0x10, 0x24, 0x5C, -+0x00, 0x6C, 0x0B, 0x61, 0x10, 0xF0, 0x24, 0x6C, -+0x5C, 0xF2, 0xB8, 0x9C, 0x03, 0x6E, 0x80, 0xA5, -+0x4C, 0xEC, 0xCD, 0xEC, 0x4C, 0xEC, 0x80, 0xC5, -+0x01, 0x6C, 0x02, 0x23, 0x80, 0x18, 0x7F, 0x2A, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x21, 0x6A, 0x84, 0xF4, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x24, 0xF5, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC4, 0xF5, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x24, 0xF6, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x64, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE4, 0xF6, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE4, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x65, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x45, 0xF2, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x45, 0xF3, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC5, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA5, 0xF7, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA5, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x06, 0xF1, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC6, 0xF1, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x00, 0x00, 0x00, 0x00, -+0x68, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+}; -+ -+u32 array_length_mp_8821c_fw_nic = 137896; -+ -+u8 array_mp_8821c_fw_spic[] = { -+0x21, 0x88, 0x00, 0x00, 0x18, 0x00, 0x05, 0x00, -+0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, -+0x09, 0x06, 0x0F, 0x14, 0xE3, 0x07, 0x00, 0x00, -+0x18, 0x00, 0x00, 0x00, 0x0C, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x20, 0x80, 0xB8, 0x7C, 0x00, 0x00, -+0x00, 0x00, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x08, 0x75, 0x00, 0x00, 0x48, 0x2B, 0x00, 0x00, -+0x00, 0x00, 0x10, 0x80, 0x00, 0x00, 0x03, 0x80, -+0x00, 0x00, 0x04, 0x04, 0x08, 0x08, 0x08, 0x08, -+0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, -+0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, -+0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x03, 0x00, 0x01, 0xFE, 0x03, 0x01, 0x01, 0xFE, -+0x03, 0x02, 0x01, 0xFE, 0x03, 0x03, 0x01, 0xFE, -+0x03, 0x04, 0x01, 0xFE, 0x03, 0x05, 0x01, 0xFE, -+0x03, 0x06, 0x01, 0xFE, 0x03, 0x07, 0x01, 0xFE, -+0x06, 0x00, 0x00, 0x00, 0x05, 0x00, 0x00, 0x00, -+0x01, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, -+0x00, 0x01, 0x10, 0x00, 0x01, 0x00, 0x03, 0x80, -+0xA9, 0x01, 0x03, 0x80, 0xA9, 0x01, 0x03, 0x80, -+0x5D, 0x29, 0x03, 0x80, 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, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x0D, 0x29, 0x03, 0x80, 0x01, 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, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xD4, 0x88, 0x20, 0x80, 0x06, 0x09, 0x0C, 0x12, -+0x18, 0x24, 0x30, 0x36, 0x01, 0x02, 0x05, 0x0B, -+0x00, 0x00, 0x00, 0x00, 0x01, 0x02, 0x03, 0x06, -+0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x2C, -+0xFF, 0x00, 0x01, 0x02, 0x02, 0x04, 0x05, 0x06, -+0x07, 0x08, 0x09, 0x0A, 0x28, 0x28, 0x32, 0x28, -+0x1E, 0x19, 0x19, 0x19, 0x18, 0x18, 0x12, 0x0F, -+0x1E, 0x1E, 0x19, 0x1E, 0x18, 0x16, 0x0C, 0x0C, -+0x1E, 0x1E, 0x19, 0x1E, 0x18, 0x16, 0x0C, 0x0C, -+0x1E, 0x1E, 0x19, 0x1C, 0x18, 0x14, 0x0C, 0x0A, -+0x1E, 0x1E, 0x19, 0x1E, 0x19, 0x18, 0x0F, 0x0E, -+0x1E, 0x1E, 0x1E, 0x1E, 0x1C, 0x16, 0x14, 0x12, -+0x0C, 0x0A, 0x1E, 0x1E, 0x1E, 0x1E, 0x1A, 0x16, -+0x12, 0x10, 0x0C, 0x0A, 0x1E, 0x1E, 0x1E, 0x1E, -+0x18, 0x16, 0x0D, 0x0E, 0x0C, 0x0A, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x12, 0x12, 0x14, 0x12, 0x0F, 0x0F, 0x0C, 0x0C, -+0x09, 0x08, 0x08, 0x07, 0x0A, 0x0A, 0x09, 0x07, -+0x07, 0x06, 0x05, 0x04, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x0A, 0x0A, 0x08, 0x08, -+0x08, 0x07, 0x07, 0x06, 0x04, 0x04, 0x0C, 0x0C, -+0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, 0x05, 0x04, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x05, 0x04, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x02, 0x02, 0x02, 0x04, -+0x02, 0x04, 0x06, 0x06, 0x08, 0x08, 0x09, 0x09, -+0x04, 0x08, 0x08, 0x08, 0x0C, 0x10, 0x10, 0x18, -+0x04, 0x08, 0x08, 0x08, 0x0C, 0x10, 0x10, 0x18, -+0x05, 0x08, 0x08, 0x09, 0x10, 0x14, 0x1C, 0x20, -+0x04, 0x06, 0x08, 0x0A, 0x10, 0x18, 0x18, 0x20, -+0x03, 0x05, 0x08, 0x09, 0x10, 0x14, 0x1C, 0x24, -+0x2A, 0x2C, 0x05, 0x07, 0x09, 0x0A, 0x10, 0x14, -+0x1C, 0x28, 0x2C, 0x30, 0x06, 0x08, 0x0A, 0x0C, -+0x12, 0x18, 0x1E, 0x30, 0x38, 0x42, 0x0A, 0x0C, -+0x0C, 0x12, 0x16, 0x1C, 0x20, 0x24, 0x24, 0x30, -+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, 0x2C, 0x00, 0x04, 0x00, -+0x2D, 0x00, 0x2C, 0x01, 0x2D, 0x01, 0x2C, 0x02, -+0x2E, 0x01, 0xFF, 0x00, 0x2D, 0x02, 0xFF, 0x00, -+0x36, 0x2D, 0xFF, 0x36, 0x2E, 0xFF, 0x37, 0x2F, -+0xFF, 0x41, 0x38, 0x30, 0x39, 0x42, 0x31, 0x42, -+0x3A, 0x32, 0x43, 0x3A, 0x33, 0x43, 0x3A, 0x34, -+0x3A, 0x44, 0x35, 0x44, 0x3B, 0xFF, 0x37, 0x2E, -+0x40, 0x38, 0x30, 0x41, 0x39, 0x42, 0x31, 0x3A, -+0x43, 0x32, 0x3B, 0x43, 0x35, 0x3C, 0x44, 0xFF, -+0x3D, 0x45, 0xFF, 0x3E, 0x45, 0xFF, 0x45, 0x3F, -+0xFF, 0x46, 0xFF, 0xFF, 0x37, 0x41, 0x2F, 0x39, -+0x42, 0x31, 0x43, 0x3A, 0x33, 0x44, 0x3B, 0x35, -+0x45, 0x3D, 0xFF, 0x46, 0x47, 0x3E, 0x47, 0xFF, -+0xFF, 0x48, 0xFF, 0xFF, 0x49, 0xFF, 0xFF, 0xFF, -+0xFF, 0xFF, 0x00, 0x00, 0x0D, 0x14, 0xFF, 0x15, -+0x0E, 0xFF, 0x15, 0x0F, 0xFF, 0x16, 0x10, 0xFF, -+0x17, 0x1E, 0x11, 0x1E, 0x18, 0x12, 0x1F, 0x18, -+0x13, 0x18, 0x1F, 0xFF, 0x15, 0x0E, 0xFF, 0x16, -+0x1D, 0x10, 0x17, 0x1E, 0x10, 0x18, 0x1E, 0x11, -+0x19, 0x1F, 0xFF, 0x1A, 0x20, 0xFF, 0x21, 0x1B, -+0xFF, 0x21, 0xFF, 0xFF, 0x15, 0x13, 0x0F, 0x17, -+0x1E, 0x11, 0x18, 0x1F, 0x13, 0x20, 0x19, 0xFF, -+0x21, 0x1B, 0xFF, 0x22, 0xFF, 0xFF, 0x23, 0xFF, -+0xFF, 0xFF, 0xFF, 0xFF, 0x04, 0x04, 0x04, 0x36, -+0x2C, 0xFF, 0x2D, 0xFF, 0xFF, 0x2E, 0x37, 0xFF, -+0x38, 0x41, 0x2F, 0x39, 0x42, 0x30, 0x43, 0x39, -+0x31, 0x42, 0x39, 0x32, 0x43, 0x3A, 0x33, 0x43, -+0x3A, 0x34, 0x2D, 0x2C, 0xFF, 0x36, 0x2E, 0xFF, -+0x37, 0x2F, 0x40, 0x38, 0x30, 0x41, 0x42, 0x33, -+0x39, 0x43, 0x35, 0x3A, 0x3B, 0x43, 0x34, 0x44, -+0x3C, 0x3B, 0x45, 0x3D, 0x3C, 0x45, 0x3E, 0x3D, -+0x37, 0x2E, 0xFF, 0x38, 0x2F, 0x40, 0x39, 0x31, -+0x41, 0x3A, 0x42, 0xFF, 0x43, 0x3B, 0xFF, 0x44, -+0x3C, 0xFF, 0x45, 0x3D, 0x3C, 0x46, 0x3F, 0x45, -+0x47, 0x46, 0x45, 0x48, 0x47, 0x47, 0x00, 0x00, -+0x04, 0xFF, 0xFF, 0x0C, 0xFF, 0xFF, 0x0D, 0x14, -+0xFF, 0x0E, 0x15, 0xFF, 0x16, 0x0F, 0xFF, 0x17, -+0x10, 0xFF, 0x17, 0x11, 0xFF, 0x17, 0x12, 0xFF, -+0x0D, 0x0C, 0xFF, 0x14, 0x0E, 0xFF, 0x15, 0x0F, -+0xFF, 0x16, 0x1D, 0x10, 0x17, 0x1E, 0x12, 0x18, -+0x1F, 0x13, 0x19, 0x20, 0x19, 0x20, 0x1A, 0x19, -+0x14, 0x0E, 0xFF, 0x15, 0x1C, 0xFF, 0x17, 0x1D, -+0x11, 0x18, 0x1E, 0x13, 0x19, 0x1F, 0x1E, 0x20, -+0x1A, 0x1F, 0x21, 0x1B, 0x20, 0x22, 0x21, 0x1B, -+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, 0x30, 0x00, 0x00, 0x00, 0x00, -+0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, -+0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, -+0x24, 0x28, 0x2A, 0x2C, 0x2E, 0x30, 0x00, 0x00, -+0x00, 0x00, 0x26, 0x29, 0x2B, 0x2D, 0x2F, 0x31, -+0x00, 0x00, 0x00, 0x00, 0x28, 0x2A, 0x2C, 0x2E, -+0x30, 0x32, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, -+0x28, 0x2A, 0x2A, 0x2A, 0x01, 0x00, 0x02, 0x00, -+0x05, 0x00, 0x0B, 0x00, 0x06, 0x00, 0x09, 0x00, -+0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, -+0x30, 0x00, 0x36, 0x00, 0x0E, 0x00, 0x1B, 0x00, -+0x29, 0x00, 0x36, 0x00, 0x51, 0x00, 0x6C, 0x00, -+0x7A, 0x00, 0x87, 0x00, 0x1B, 0x00, 0x36, 0x00, -+0x51, 0x00, 0x6C, 0x00, 0xA2, 0x00, 0xD8, 0x00, -+0xF3, 0x00, 0x0E, 0x01, 0x29, 0x00, 0x51, 0x00, -+0x7A, 0x00, 0xA2, 0x00, 0xF3, 0x00, 0x44, 0x01, -+0x6D, 0x01, 0x95, 0x01, 0x36, 0x00, 0x6C, 0x00, -+0xA2, 0x00, 0xD8, 0x00, 0x44, 0x01, 0xB0, 0x01, -+0xE6, 0x01, 0x1C, 0x02, 0x0E, 0x00, 0x1B, 0x00, -+0x29, 0x00, 0x36, 0x00, 0x51, 0x00, 0x6C, 0x00, -+0x7A, 0x00, 0x87, 0x00, 0xA2, 0x00, 0xB4, 0x00, -+0x1B, 0x00, 0x36, 0x00, 0x51, 0x00, 0x6C, 0x00, -+0xA2, 0x00, 0xD8, 0x00, 0xF3, 0x00, 0xFF, 0x00, -+0x23, 0x01, 0x44, 0x01, 0x29, 0x00, 0x51, 0x00, -+0x7A, 0x00, 0xA2, 0x00, 0xF3, 0x00, 0x44, 0x01, -+0x64, 0x01, 0x64, 0x01, 0xB5, 0x01, 0xE6, 0x01, -+0x36, 0x00, 0x6C, 0x00, 0xA2, 0x00, 0xD8, 0x00, -+0x44, 0x01, 0xB0, 0x01, 0xE6, 0x01, 0x1C, 0x02, -+0x88, 0x02, 0xD0, 0x02, 0x14, 0x14, 0x15, 0x15, -+0x16, 0x17, 0x17, 0x18, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1D, 0x1D, 0x1E, 0x1E, 0x1C, 0x1C, 0x1D, 0x1E, -+0x1F, 0x20, 0x20, 0x20, 0x36, 0x36, 0x37, 0x37, -+0x38, 0x39, 0x39, 0x3A, 0x3A, 0x3A, 0x00, 0x00, -+0x40, 0x40, 0x40, 0x40, 0x41, 0x41, 0x42, 0x42, -+0x43, 0x43, 0x00, 0x00, 0x40, 0x40, 0x41, 0x42, -+0x43, 0x44, 0x44, 0x44, 0x45, 0x46, 0x00, 0x00, -+0x00, 0xF0, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x03, 0x00, 0x00, 0x00, 0x00, 0x30, 0xC0, -+0xE0, 0x00, 0x00, 0x00, 0x00, 0x0C, 0x0E, 0x38, -+0x18, 0x00, 0x00, 0x00, 0x00, 0x83, 0x01, 0x06, -+0x80, 0x03, 0x00, 0x00, 0x00, 0x00, 0x70, 0xE0, -+0x26, 0x9D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x30, 0xF0, 0x21, 0x6C, 0x18, 0xF0, 0x00, 0x4C, -+0xBC, 0x65, 0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x77, 0xF0, -+0x20, 0x6C, 0x80, 0xF0, 0x80, 0x9C, 0x80, 0xF0, -+0x20, 0x6E, 0xCC, 0xEC, 0x1E, 0x24, 0x30, 0xF0, -+0x21, 0x6C, 0xF4, 0xF7, 0x1C, 0x4C, 0x80, 0x9C, -+0xBC, 0x65, 0x30, 0xF0, 0x21, 0x6C, 0xF4, 0xF7, -+0x18, 0x4C, 0x80, 0x9C, 0xFC, 0x65, 0x9F, 0x67, -+0x77, 0xF0, 0x24, 0x6D, 0xE0, 0xF2, 0x90, 0xDD, -+0x9D, 0x67, 0x77, 0xF0, 0x24, 0x6D, 0xE0, 0xF2, -+0x94, 0xDD, 0x9D, 0x67, 0x85, 0x9C, 0x77, 0xF0, -+0x24, 0x6D, 0xE0, 0xF2, 0x98, 0xDD, 0x20, 0xE8, -+0x00, 0x65, 0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, -+0x08, 0x4C, 0x00, 0x6E, 0x30, 0xF0, 0x20, 0x6F, -+0x2F, 0xF0, 0x08, 0x4F, 0xC0, 0xDC, 0x04, 0x4C, -+0xE3, 0xEC, 0xB8, 0x67, 0xFB, 0x2D, 0x30, 0xF0, -+0x21, 0x6C, 0xD1, 0xF0, 0x14, 0x4C, 0x00, 0x6E, -+0x30, 0xF0, 0x21, 0x6F, 0x31, 0xF1, 0x00, 0x4F, -+0xC0, 0xDC, 0x04, 0x4C, 0xE3, 0xEC, 0xB8, 0x67, -+0xFB, 0x2D, 0x30, 0xF0, 0x21, 0x6C, 0x15, 0xF0, -+0x00, 0x4C, 0x00, 0x6E, 0x30, 0xF0, 0x21, 0x6F, -+0x18, 0xF0, 0x00, 0x4F, 0xC0, 0xDC, 0x04, 0x4C, -+0xE3, 0xEC, 0xB8, 0x67, 0xFB, 0x2D, 0x10, 0xF0, -+0x23, 0x6C, 0xC0, 0xF0, 0x01, 0x4C, 0x00, 0xEC, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0xC0, 0xF0, 0x01, 0x4A, 0x40, 0xDB, -+0x00, 0x1C, 0x94, 0x00, 0x80, 0x18, 0x6A, 0x06, -+0x80, 0x18, 0x66, 0x05, 0x80, 0x18, 0x88, 0x05, -+0x80, 0x18, 0x16, 0x06, 0x80, 0x18, 0xA6, 0x05, -+0x80, 0x18, 0x33, 0x06, 0x80, 0x18, 0xF8, 0x03, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF7, 0x54, 0x9A, -+0x30, 0xF0, 0x20, 0x68, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6C, 0x30, 0xF0, 0x21, 0x6A, 0x80, 0xF1, -+0x08, 0x4C, 0x15, 0xF0, 0x00, 0x4A, 0x43, 0xDC, -+0xCE, 0xF7, 0x40, 0x98, 0x00, 0x6D, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x2D, 0xF1, 0x50, 0xDB, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF7, 0x50, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x6F, 0xF0, 0x08, 0x4C, -+0x01, 0x6D, 0x40, 0xEA, 0x30, 0xF0, 0x21, 0x6B, -+0x11, 0xF1, 0x54, 0xDB, 0x30, 0xF0, 0x20, 0x6C, -+0x30, 0xF0, 0x21, 0x6A, 0x2F, 0xF0, 0x08, 0x4C, -+0x15, 0xF4, 0x00, 0x4A, 0x43, 0xDC, 0xCE, 0xF7, -+0x40, 0x98, 0x00, 0x6D, 0x40, 0xEA, 0x30, 0xF0, -+0x21, 0x6B, 0x11, 0xF1, 0x4C, 0xDB, 0x00, 0x18, -+0xD4, 0xCF, 0x10, 0xF0, 0x23, 0x6A, 0x0E, 0xF2, -+0x74, 0x9A, 0xFF, 0xF7, 0x1F, 0x6C, 0x10, 0xF0, -+0x00, 0x6D, 0x40, 0xAB, 0xAB, 0xED, 0x01, 0x6E, -+0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xCB, -+0x00, 0x6C, 0x7F, 0xF7, 0x1F, 0x6D, 0x00, 0x18, -+0xA9, 0xC9, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF7, -+0x58, 0x9A, 0x40, 0xEA, 0x00, 0x1C, 0x95, 0x45, -+0xFF, 0x17, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x6D, 0xB8, 0x00, 0x65, 0x00, 0xF0, 0x20, 0x6A, -+0x7C, 0x4A, 0x6C, 0xEA, 0x1C, 0x22, 0x00, 0xF0, -+0x20, 0x6B, 0x28, 0x4B, 0x6A, 0xEA, 0x0B, 0x61, -+0x4E, 0xB8, 0x00, 0x65, 0x00, 0xF0, 0x20, 0x6B, -+0x01, 0x4B, 0x6B, 0xE2, 0x60, 0xAA, 0xBF, 0xF6, -+0x1A, 0x6A, 0x6A, 0xEA, 0x31, 0x60, 0x77, 0xF0, -+0x24, 0x6A, 0xA0, 0xF1, 0x1C, 0x4A, 0x1D, 0xF4, -+0x00, 0x6B, 0x60, 0xDA, 0x10, 0xF0, 0x23, 0x6A, -+0xA3, 0xF7, 0x09, 0x4A, 0x00, 0xEA, 0x00, 0xF0, -+0x20, 0x6A, 0x1F, 0xF7, 0x00, 0x6A, 0x4C, 0xEB, -+0x4C, 0xB8, 0x00, 0x65, 0x6C, 0xEA, 0x42, 0x32, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF0, 0x00, 0x4B, -+0x49, 0xE3, 0x40, 0xA2, 0x30, 0xF0, 0x20, 0x6B, -+0x40, 0xF1, 0x08, 0x4B, 0x69, 0xE2, 0x30, 0xF0, -+0x20, 0x6B, 0x4E, 0xF2, 0x08, 0x4B, 0x60, 0x9B, -+0x05, 0x2B, 0x10, 0xF0, 0x23, 0x6B, 0x80, 0xF3, -+0x0D, 0x4B, 0x00, 0xEB, 0x10, 0xF0, 0x23, 0x6B, -+0x20, 0xF4, 0x01, 0x4B, 0x00, 0xEB, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0x0D, 0xF1, 0x1C, 0x4A, -+0x00, 0xF0, 0x20, 0x6B, 0x01, 0x6B, 0x60, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0x40, 0xF2, 0x15, 0x4B, -+0x00, 0xEB, 0x00, 0x65, 0x5A, 0xB8, 0x00, 0x65, -+0x7B, 0xB8, 0x00, 0x65, 0x40, 0xE8, 0x5A, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x7B, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x30, 0xF0, -+0x20, 0x6A, 0x0D, 0xF1, 0x1C, 0x4A, 0x00, 0xF0, -+0x20, 0x6B, 0x60, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0x2D, 0xF1, 0x18, 0x4A, 0x60, 0x9A, 0x41, 0x9A, -+0x6A, 0xEA, 0x0D, 0x61, 0x6E, 0xB8, 0x00, 0x65, -+0x62, 0x43, 0xCB, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x5A, 0xB8, 0x00, 0x65, 0x7B, 0xB8, -+0x00, 0x65, 0x00, 0xBA, 0x00, 0x65, 0x36, 0x23, -+0xDF, 0xF7, 0x00, 0x03, 0x86, 0xDB, 0xA7, 0xDB, -+0xC8, 0xDB, 0xE9, 0xDB, 0x0A, 0xDB, 0x2B, 0xDB, -+0x98, 0x67, 0x8C, 0xDB, 0x9F, 0x67, 0x8E, 0xDB, -+0x12, 0xEC, 0x10, 0xED, 0x82, 0xDB, 0xA3, 0xDB, -+0x9A, 0xB8, 0x00, 0x65, 0x84, 0xDB, 0x9B, 0xB8, -+0x00, 0x65, 0x85, 0xDB, 0x8E, 0xB8, 0x00, 0x65, -+0x82, 0x44, 0x81, 0xDB, 0x8C, 0xB8, 0x00, 0x65, -+0x80, 0xDB, 0x30, 0xF0, 0x20, 0x6B, 0x2D, 0xF1, -+0x18, 0x4B, 0x60, 0x9B, 0x9D, 0x67, 0x89, 0xDB, -+0x6A, 0x9B, 0xCF, 0xF7, 0x80, 0x44, 0x62, 0xEC, -+0x0D, 0x60, 0x77, 0xF0, 0x24, 0x6C, 0xA0, 0xF1, -+0x1C, 0x4C, 0x1D, 0xF4, 0x01, 0x6B, 0x60, 0xDC, -+0x10, 0xF0, 0x23, 0x6C, 0xA3, 0xF7, 0x09, 0x4C, -+0x00, 0xEC, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0x2D, 0xF1, 0x18, 0x4B, 0x41, 0x9B, 0x40, 0xDB, -+0x89, 0x9A, 0xBC, 0x65, 0x7D, 0x67, 0xDF, 0xF7, -+0x00, 0x03, 0x4C, 0xB8, 0x00, 0x65, 0x00, 0xF0, -+0x20, 0x6D, 0x05, 0x4D, 0xAF, 0xED, 0xAC, 0xEA, -+0xA0, 0x9B, 0x04, 0x6C, 0x8C, 0xED, 0xAD, 0xEA, -+0x82, 0x9B, 0xA3, 0x9B, 0x32, 0xEC, 0x30, 0xED, -+0x8E, 0x9B, 0xFC, 0x65, 0x8C, 0x9B, 0x1C, 0x65, -+0x84, 0x9B, 0x5C, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x85, 0x9B, 0x7C, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x2B, 0x9B, 0x0A, 0x9B, -+0xE9, 0x9B, 0xC8, 0x9B, 0xA7, 0x9B, 0x86, 0x9B, -+0x61, 0x9B, 0xCB, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x8A, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x7B, 0xB8, 0x00, 0x65, 0x5A, 0xB8, -+0x00, 0x65, 0x00, 0xBA, 0xDF, 0xF7, 0x00, 0x03, -+0x86, 0xDB, 0xA7, 0xDB, 0xC8, 0xDB, 0xE9, 0xDB, -+0x0A, 0xDB, 0x2B, 0xDB, 0x98, 0x67, 0x8C, 0xDB, -+0x9F, 0x67, 0x8E, 0xDB, 0x12, 0xEC, 0x10, 0xED, -+0x82, 0xDB, 0xA3, 0xDB, 0x9A, 0xB8, 0x00, 0x65, -+0x84, 0xDB, 0x9B, 0xB8, 0x00, 0x65, 0x85, 0xDB, -+0x7D, 0x67, 0x5B, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x40, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0xAD, 0xF1, 0x08, 0x4C, 0x00, 0xF4, 0x00, 0x4C, -+0xBC, 0x65, 0x82, 0x67, 0x40, 0xEA, 0x00, 0x65, -+0x7A, 0xB8, 0x00, 0x65, 0xBB, 0x65, 0xDF, 0xF7, -+0x00, 0x03, 0x82, 0x9B, 0xA3, 0x9B, 0x32, 0xEC, -+0x30, 0xED, 0x8E, 0x9B, 0xFC, 0x65, 0x8C, 0x9B, -+0x1C, 0x65, 0x84, 0x9B, 0x5C, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x85, 0x9B, 0x7C, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x2B, 0x9B, -+0x0A, 0x9B, 0xE9, 0x9B, 0xC8, 0x9B, 0xA7, 0x9B, -+0x86, 0x9B, 0x5A, 0xB8, 0x00, 0x65, 0x7B, 0xB8, -+0x00, 0x65, 0x00, 0xBA, 0x00, 0x65, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6B, 0x0D, 0xF1, 0x1C, 0x4B, -+0x40, 0xDB, 0xDF, 0xF7, 0x00, 0x03, 0x86, 0xDB, -+0xA7, 0xDB, 0xC8, 0xDB, 0xE9, 0xDB, 0x0A, 0xDB, -+0x2B, 0xDB, 0x98, 0x67, 0x8C, 0xDB, 0x9F, 0x67, -+0x8E, 0xDB, 0x12, 0xEC, 0x10, 0xED, 0x82, 0xDB, -+0xA3, 0xDB, 0x9A, 0xB8, 0x00, 0x65, 0x84, 0xDB, -+0x9B, 0xB8, 0x00, 0x65, 0x85, 0xDB, 0x8E, 0xB8, -+0x00, 0x65, 0x81, 0xDB, 0x8C, 0xB8, 0x00, 0x65, -+0x80, 0xDB, 0x30, 0xF0, 0x20, 0x6B, 0x2D, 0xF1, -+0x18, 0x4B, 0x60, 0x9B, 0x9D, 0x67, 0x89, 0xDB, -+0x6A, 0x9B, 0xCF, 0xF7, 0x80, 0x44, 0x62, 0xEC, -+0x0D, 0x60, 0x77, 0xF0, 0x24, 0x6C, 0xA0, 0xF1, -+0x1C, 0x4C, 0x1D, 0xF4, 0x01, 0x6B, 0x60, 0xDC, -+0x10, 0xF0, 0x23, 0x6C, 0xA3, 0xF7, 0x09, 0x4C, -+0x00, 0xEC, 0x00, 0x65, 0x40, 0x9A, 0x30, 0xF0, -+0x20, 0x6C, 0xAD, 0xF1, 0x08, 0x4C, 0x00, 0xF4, -+0x00, 0x4C, 0xBC, 0x65, 0x82, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6C, 0x0D, 0xF1, 0x1C, 0x4C, -+0x00, 0xF0, 0x20, 0x6D, 0xA0, 0xDC, 0x30, 0xF0, -+0x20, 0x6A, 0x2D, 0xF1, 0x18, 0x4A, 0x10, 0xF0, -+0x23, 0x6B, 0xC0, 0xF4, 0x09, 0x4B, 0x00, 0xEB, -+0x61, 0x9A, 0x60, 0xDA, 0x49, 0x9B, 0xBA, 0x65, -+0xDF, 0xF7, 0x00, 0x03, 0x4C, 0xB8, 0x00, 0x65, -+0x00, 0xF0, 0x20, 0x6D, 0x05, 0x4D, 0xAF, 0xED, -+0xAC, 0xEA, 0xA0, 0x9B, 0x00, 0xF0, 0x20, 0x6C, -+0x04, 0x4C, 0x8C, 0xED, 0xAD, 0xEA, 0x82, 0x9B, -+0xA3, 0x9B, 0x32, 0xEC, 0x30, 0xED, 0x8E, 0x9B, -+0xFC, 0x65, 0x8C, 0x9B, 0x1C, 0x65, 0x84, 0x9B, -+0x5C, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x85, 0x9B, 0x7C, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x2B, 0x9B, 0x0A, 0x9B, 0xE9, 0x9B, -+0xC8, 0x9B, 0xA7, 0x9B, 0x86, 0x9B, 0x61, 0x9B, -+0xCB, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x8A, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x7B, 0xB8, 0x00, 0x65, 0x5A, 0xB8, 0x00, 0x65, -+0x00, 0xBA, 0x00, 0x65, 0x5F, 0x67, 0x5A, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x18, -+0x69, 0xC0, 0x00, 0x1C, 0xA9, 0x41, 0x5A, 0xB8, -+0x00, 0x65, 0x00, 0xEA, 0x6D, 0xB8, 0x00, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x00, 0x4A, 0x4F, 0xEA, -+0x4C, 0xEB, 0xAB, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x5F, 0x67, 0x5A, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x1C, 0x6C, 0x41, -+0x5A, 0xB8, 0x00, 0x65, 0x00, 0xEA, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x84, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x7E, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xB2, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x2C, 0xC2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x4B, 0xC2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x78, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0xE0, 0xF5, 0x01, 0x4A, -+0x40, 0xDB, 0x01, 0x4A, 0x40, 0xDB, 0x20, 0xE8, -+0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0xE0, 0xF5, 0x19, 0x4A, -+0x40, 0xDB, 0x01, 0x4A, 0x40, 0xDB, 0x20, 0xE8, -+0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0x00, 0xF6, 0x11, 0x4A, -+0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, 0x2E, 0xF4, -+0x58, 0x9A, 0xC0, 0x9A, 0x10, 0xF0, 0x23, 0x6A, -+0x2E, 0xF4, 0x5C, 0x9A, 0xA0, 0x9A, 0x10, 0xF0, -+0x23, 0x6A, 0x4E, 0xF4, 0x40, 0x9A, 0x80, 0x9A, -+0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF4, 0x44, 0x9A, -+0x40, 0x9A, 0x33, 0x22, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6F, -+0x4E, 0xF4, 0xE8, 0x9F, 0x40, 0x9B, 0xED, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF4, -+0x4C, 0x9A, 0xFF, 0x6B, 0xC0, 0xDA, 0x10, 0xF0, -+0x23, 0x6A, 0x4E, 0xF4, 0x50, 0x9A, 0xA0, 0xDA, -+0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF4, 0x54, 0x9A, -+0x10, 0x6D, 0xAB, 0xED, 0x80, 0xDA, 0x10, 0xF0, -+0x23, 0x6A, 0x4E, 0xF4, 0x98, 0x9A, 0x40, 0xA4, -+0x6C, 0xEA, 0xAC, 0xEA, 0x02, 0x6D, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x90, 0x9A, 0x80, 0x6D, 0xAB, 0xED, -+0x40, 0xA4, 0x6C, 0xEA, 0xAE, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF1, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x00, 0xF6, -+0x12, 0x4A, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x23, 0x6B, -+0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xC0, 0xF6, 0x09, 0x4A, 0x40, 0xDB, 0x00, 0x18, -+0xF9, 0xD1, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x6C, 0x9A, 0x6C, 0x23, 0x01, 0x6A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x2E, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x2F, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0x30, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x4C, 0x9A, 0x08, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x31, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x4C, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x32, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, 0x20, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x33, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, -+0x40, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0x34, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x4C, 0x9A, 0x80, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x68, 0xD2, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x6C, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x4B, 0xD2, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, 0x6C, 0x9B, -+0x04, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x35, 0xD2, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x6C, 0x9B, 0x08, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x36, 0xD2, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, 0x6C, 0x9B, -+0x10, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x37, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x70, 0x9A, 0x14, 0x23, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x58, 0x9A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x3B, 0xD2, 0x10, 0xF0, -+0x23, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF1, -+0x4C, 0x9A, 0x00, 0xF2, 0x70, 0x9B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x47, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x74, 0x9A, 0x55, 0x23, -+0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0x38, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, 0x39, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, -+0x00, 0x18, 0x38, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x08, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x39, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, -+0x10, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, -+0x00, 0x18, 0x38, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x20, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0x39, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, -+0x40, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0x38, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x80, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, 0x39, 0xD2, -+0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0xC0, 0xF6, 0x0A, 0x4A, -+0x40, 0xDB, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0xA1, 0xF0, 0x11, 0x4A, 0x40, 0xDB, -+0x00, 0x18, 0x90, 0xD3, 0x00, 0x18, 0xC9, 0xD1, -+0x00, 0x18, 0xD1, 0xD3, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x5C, 0x9A, 0x23, 0x22, 0x00, 0x68, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x7C, 0x9B, -+0x02, 0xF0, 0x00, 0x6A, 0x44, 0xE8, 0x6C, 0xEA, -+0x03, 0x22, 0x90, 0x67, 0x00, 0x18, 0x2D, 0xD2, -+0x01, 0x48, 0x10, 0x70, 0xF1, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x7C, 0x9B, 0xFF, 0x6A, -+0x01, 0x4A, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0x7C, 0xD2, 0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF1, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0xA1, 0xF0, -+0x12, 0x4A, 0x40, 0xDB, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0x21, 0xF1, 0x0D, 0x4A, -+0x40, 0xDB, 0x00, 0x18, 0xD0, 0xD1, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x7C, 0x9A, 0x34, 0x23, -+0x02, 0x6A, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0x0D, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x5C, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x78, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x5C, 0x9A, 0x20, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x74, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x5C, 0x9A, 0x40, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x12, 0xD2, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x7C, 0x9B, -+0xFF, 0x6A, 0x01, 0x4A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0x70, 0xD2, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x7C, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x6C, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x64, 0x9A, -+0x32, 0x23, 0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0x63, 0xD2, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x64, 0x9B, 0xFF, 0x6A, -+0x01, 0x4A, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0x63, 0xD2, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x64, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, -+0x63, 0xD2, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x64, 0x9B, 0x00, 0xF4, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0x63, 0xD2, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x64, 0x9B, -+0x01, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x04, 0x6C, 0x00, 0x18, 0x63, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x68, 0x9A, 0x32, 0x23, -+0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0x2B, 0xD2, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x68, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0x2B, 0xD2, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x68, 0x9B, 0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x2B, 0xD2, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x68, 0x9B, -+0x00, 0xF4, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0x2B, 0xD2, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x68, 0x9B, 0x01, 0xF0, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0x2B, 0xD2, 0x10, 0xF0, 0x23, 0x6B, -+0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0x21, 0xF1, 0x0E, 0x4A, 0x40, 0xDB, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x80, 0x63, 0xFF, 0x62, -+0xFE, 0xD1, 0xFD, 0xD0, 0xF9, 0x63, 0x20, 0xF4, -+0x18, 0xD4, 0x00, 0x6D, 0x85, 0x04, 0x00, 0xF2, -+0x00, 0x6E, 0x00, 0x18, 0xBE, 0xCA, 0x00, 0x6C, -+0x0F, 0x10, 0x01, 0x6D, 0xAB, 0xED, 0xA0, 0xCB, -+0x01, 0x4A, 0xFF, 0xF7, 0x1F, 0x6D, 0xAC, 0xEA, -+0x04, 0x72, 0x02, 0x4B, 0xF6, 0x61, 0xFF, 0x6B, -+0x04, 0x4C, 0x01, 0x4B, 0x8E, 0xEB, 0x05, 0x23, -+0x84, 0x32, 0x85, 0x03, 0x4D, 0xE3, 0x00, 0x6A, -+0xEC, 0x17, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, -+0x44, 0x9A, 0x9D, 0x67, 0x72, 0xC4, 0x71, 0xC4, -+0x70, 0xC4, 0x04, 0x05, 0x00, 0x6C, 0x40, 0xEA, -+0x7D, 0x67, 0x50, 0xA3, 0x01, 0x68, 0xFF, 0x72, -+0x00, 0x6A, 0x80, 0xF0, 0x1D, 0x61, 0xCF, 0x10, -+0x1F, 0x6A, 0x2C, 0xEA, 0x0F, 0x72, 0x2C, 0x61, -+0x30, 0xF0, 0x20, 0x6C, 0xEE, 0xF4, 0x44, 0x9C, -+0x00, 0xF0, 0x11, 0x05, 0x90, 0x67, 0x40, 0xEA, -+0x5D, 0x67, 0x91, 0xA2, 0xFF, 0x74, 0x0F, 0x60, -+0x0F, 0x6B, 0x8C, 0xEB, 0x01, 0x48, 0xFF, 0xF7, -+0x1F, 0x6A, 0x0F, 0x73, 0x4C, 0xE8, 0x10, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x44, 0x9B, -+0x90, 0x67, 0x04, 0x05, 0x40, 0xEA, 0x00, 0x6D, -+0x05, 0x04, 0x00, 0xF2, 0x00, 0x6E, 0x00, 0x18, -+0xBE, 0xCA, 0x01, 0x6D, 0x00, 0x6B, 0x92, 0x10, -+0xF0, 0x6A, 0x8C, 0xEA, 0x47, 0x32, 0x36, 0x31, -+0x2D, 0xEA, 0x00, 0xF4, 0x18, 0xD3, 0x05, 0x10, -+0x0F, 0x6C, 0x2C, 0xEC, 0x32, 0x32, 0x00, 0xF4, -+0x18, 0xD4, 0x40, 0x5A, 0x00, 0x6B, 0x49, 0x60, -+0x4C, 0x32, 0x85, 0x01, 0x45, 0xE1, 0x20, 0xF4, -+0x00, 0xD1, 0x00, 0xF4, 0x1C, 0xD3, 0x00, 0xF4, -+0x1C, 0x93, 0x00, 0xF4, 0x18, 0x92, 0x47, 0xEB, -+0x01, 0x6B, 0x6C, 0xEA, 0x2C, 0x2A, 0x90, 0x67, -+0x30, 0xF0, 0x20, 0x6B, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x48, 0x4C, 0xE8, 0xEE, 0xF4, 0x44, 0x9B, -+0x00, 0xF0, 0x12, 0x05, 0x40, 0xEA, 0x9D, 0x67, -+0x52, 0xA4, 0x20, 0xF4, 0x00, 0x93, 0x00, 0xF2, -+0x00, 0x58, 0x40, 0xCB, 0x36, 0x60, 0x90, 0x67, -+0x30, 0xF0, 0x20, 0x6B, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x48, 0x4C, 0xE8, 0xEE, 0xF4, 0x44, 0x9B, -+0x00, 0xF0, 0x12, 0x05, 0x40, 0xEA, 0x9D, 0x67, -+0x52, 0xA4, 0x60, 0xA9, 0x00, 0xF2, 0x00, 0x70, -+0x40, 0x32, 0x6D, 0xEA, 0x40, 0xC9, 0x03, 0x61, -+0x00, 0xF2, 0x00, 0x68, 0x1E, 0x10, 0x00, 0xF4, -+0x1C, 0x92, 0x20, 0xF4, 0x00, 0x93, 0x02, 0x49, -+0x01, 0x4A, 0x02, 0x4B, 0x04, 0x72, 0x00, 0xF4, -+0x1C, 0xD2, 0x20, 0xF4, 0x00, 0xD3, 0xBF, 0x61, -+0x10, 0x10, 0x00, 0xF4, 0x18, 0x92, 0x01, 0x6C, -+0x47, 0xEB, 0x8C, 0xEA, 0x07, 0x2A, 0x02, 0x48, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xE8, 0x00, 0xF2, -+0x00, 0x58, 0x03, 0x60, 0x01, 0x4B, 0x04, 0x73, -+0xF0, 0x61, 0xFF, 0xF7, 0x1F, 0x6A, 0x90, 0x67, -+0x01, 0x48, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x44, 0x9A, 0x04, 0x05, 0x40, 0xEA, -+0x9D, 0x67, 0x30, 0xA4, 0xFF, 0x71, 0x7F, 0xF7, -+0x1E, 0x60, 0x00, 0xF2, 0x00, 0x58, 0x5F, 0xF7, -+0x1B, 0x61, 0x79, 0x17, 0x20, 0xAC, 0x01, 0x4A, -+0x02, 0x4C, 0x20, 0xC0, 0x20, 0xAF, 0x02, 0x48, -+0x02, 0x4F, 0x22, 0x31, 0x20, 0xC6, 0xFF, 0xF7, -+0x1F, 0x69, 0x2C, 0xEA, 0x04, 0x72, 0x02, 0x4E, -+0xF1, 0x61, 0x04, 0x4B, 0x00, 0xF1, 0x00, 0x73, -+0x08, 0x4D, 0x09, 0x60, 0x64, 0x30, 0x85, 0x04, -+0x11, 0xE4, 0x05, 0x06, 0x01, 0xE6, 0xE4, 0x67, -+0xB9, 0xE6, 0x00, 0x6A, 0xE3, 0x17, 0x7D, 0x67, -+0xA0, 0xF1, 0x54, 0xA3, 0x20, 0xF4, 0x18, 0x94, -+0x01, 0x6B, 0x40, 0xC4, 0x30, 0xF0, 0x21, 0x6A, -+0xB1, 0xF0, 0x65, 0xC2, 0x01, 0x6A, 0x07, 0x63, -+0xFF, 0x97, 0xFE, 0x91, 0xFD, 0x90, 0x00, 0xF4, -+0x00, 0x63, 0x00, 0xEF, 0x1F, 0x75, 0x0D, 0x60, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, 0x68, 0x9A, -+0x10, 0xF0, 0x23, 0x6C, 0xEE, 0xF1, 0x8C, 0x9C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, -+0x20, 0xE8, 0x10, 0xF0, 0x23, 0x6A, 0x2E, 0xF2, -+0x48, 0x9A, 0x60, 0x9C, 0x4E, 0xEB, 0x01, 0x6A, -+0x0C, 0x23, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, -+0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, 0x2E, 0xF2, -+0x8C, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x00, 0x6A, 0x20, 0xE8, 0x6D, 0xA4, 0x0F, 0x6A, -+0x6C, 0xEA, 0x0A, 0x22, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, -+0xCE, 0xF1, 0x9C, 0x9C, 0x40, 0x9B, 0x2F, 0x10, -+0x4E, 0xA4, 0x1F, 0x6B, 0x6C, 0xEA, 0x1F, 0x4A, -+0x6C, 0xEA, 0x10, 0x5A, 0x0A, 0x61, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF1, 0x68, 0x9A, 0x10, 0xF0, -+0x23, 0x6C, 0x2E, 0xF2, 0x90, 0x9C, 0x40, 0x9B, -+0x1E, 0x10, 0x4C, 0xA4, 0x0C, 0x22, 0x80, 0x72, -+0x0A, 0x60, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, -+0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, 0x2E, 0xF2, -+0x94, 0x9C, 0x40, 0x9B, 0x10, 0x10, 0x6D, 0xA4, -+0x10, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6D, -+0xAC, 0xEA, 0x0D, 0x22, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, -+0xEE, 0xF1, 0x90, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x00, 0x6A, 0x20, 0xE8, 0x4E, 0xA4, -+0x20, 0x6B, 0x6B, 0xEB, 0x4C, 0xEB, 0xAC, 0xEB, -+0x01, 0x6A, 0x0C, 0x23, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, -+0xCE, 0xF1, 0x8C, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x00, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6B, 0xAF, 0xF4, 0x18, 0x4B, -+0xE1, 0xF3, 0x4B, 0xA3, 0x04, 0x2A, 0x01, 0x6C, -+0xE1, 0xF3, 0x8B, 0xC3, 0x20, 0xE8, 0x8F, 0x42, -+0xE1, 0xF3, 0x8B, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0xA2, 0xDC, 0x20, 0xE8, 0xAC, 0xC4, 0x20, 0xE8, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x68, 0xAC, 0xE8, 0x00, 0x30, 0x30, 0xF0, -+0x21, 0x6A, 0x90, 0xF4, 0x1C, 0x4A, 0x04, 0x30, -+0x01, 0xE2, 0x24, 0x67, 0x00, 0x6D, 0x90, 0x67, -+0x00, 0xF2, 0x00, 0x6E, 0x00, 0x18, 0xBE, 0xCA, -+0x10, 0xF0, 0x23, 0x6A, 0x2E, 0xF2, 0x58, 0x9A, -+0x40, 0xD8, 0x41, 0x99, 0x41, 0xD8, 0x07, 0x97, -+0x50, 0x67, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xDB, 0x63, 0x49, 0x62, -+0x48, 0xD1, 0x47, 0xD0, 0xFF, 0x6E, 0x04, 0x67, -+0x25, 0x67, 0x04, 0x04, 0x00, 0x6D, 0x01, 0x4E, -+0x00, 0x18, 0xBE, 0xCA, 0x6E, 0x10, 0x00, 0x6A, -+0x08, 0x58, 0x44, 0xD2, 0x0A, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x5C, 0x9A, 0x91, 0x67, -+0xF8, 0x48, 0x40, 0xEA, 0x02, 0xF0, 0x00, 0x49, -+0x60, 0x10, 0xFF, 0x6E, 0x04, 0x04, 0x00, 0x6D, -+0x01, 0x4E, 0x00, 0x18, 0xBE, 0xCA, 0x44, 0x93, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF5, 0x44, 0x9A, -+0xFF, 0x6D, 0x31, 0xE3, 0x01, 0x4D, 0x04, 0x06, -+0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6B, 0x44, 0x94, -+0x2E, 0xF2, 0x7C, 0x9B, 0x04, 0x02, 0x6D, 0xE4, -+0x44, 0x04, 0xA0, 0xA2, 0x01, 0x4A, 0x8A, 0xEA, -+0xA0, 0xC3, 0x01, 0x4B, 0xFA, 0x61, 0x44, 0x92, -+0x00, 0xF1, 0x00, 0x4A, 0x02, 0xF0, 0x00, 0x72, -+0x44, 0xD2, 0xDB, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF5, 0x5C, 0x9A, 0x91, 0x67, 0x00, 0x30, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x48, 0x9A, 0x04, 0x30, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x44, 0x9A, 0x02, 0x6C, -+0x40, 0xEA, 0x2D, 0xE0, 0x44, 0xD3, 0xFF, 0x6E, -+0x04, 0x04, 0x00, 0x6D, 0x01, 0x4E, 0x00, 0x18, -+0xBE, 0xCA, 0x10, 0xF0, 0x23, 0x6A, 0x2E, 0xF2, -+0x7C, 0x9A, 0x44, 0x04, 0x04, 0x02, 0x6D, 0xE0, -+0xA0, 0xA3, 0x01, 0x4B, 0xA0, 0xC2, 0x01, 0x4A, -+0x8A, 0xEA, 0xFA, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x44, 0x94, 0xAE, 0xF5, 0x40, 0x9A, 0xFF, 0x6D, -+0x01, 0x4D, 0x04, 0x06, 0x40, 0xEA, 0x44, 0x94, -+0x00, 0xF1, 0x00, 0x48, 0x02, 0xF0, 0x00, 0x58, -+0x00, 0xF1, 0x00, 0x4C, 0x44, 0xD4, 0xDB, 0x61, -+0x00, 0x68, 0x91, 0x28, 0x49, 0x97, 0x48, 0x91, -+0x47, 0x90, 0x25, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF8, 0x63, 0x0F, 0x62, 0x0E, 0xD1, 0x0D, 0xD0, -+0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF0, 0x7C, 0x9A, -+0x4E, 0xF0, 0x1C, 0x4A, 0x41, 0x9A, 0x10, 0xF0, -+0x23, 0x6D, 0x07, 0x04, 0x4E, 0xF0, 0x0C, 0x4D, -+0x10, 0x6E, 0x05, 0xD3, 0x06, 0xD2, 0x00, 0x18, -+0xC3, 0xCA, 0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF0, -+0x48, 0x9A, 0x04, 0xD2, 0x00, 0x18, 0x6E, 0xC3, -+0x40, 0x30, 0x22, 0x67, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF4, 0x1C, 0x4A, 0x04, 0x30, 0x01, 0xE2, -+0x90, 0x67, 0x00, 0x6D, 0x00, 0xF2, 0x00, 0x6E, -+0x00, 0x18, 0xBE, 0xCA, 0x30, 0xF0, 0x21, 0x6A, -+0xB1, 0xF0, 0x45, 0xA2, 0x08, 0x2A, 0x30, 0xF0, -+0x21, 0x6C, 0xD1, 0xF0, 0x10, 0x4C, 0x00, 0x18, -+0xAB, 0xC2, 0x01, 0x72, 0x09, 0x61, 0x30, 0xF0, -+0x21, 0x6A, 0xD1, 0xF0, 0x50, 0xA2, 0x02, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x6A, 0x01, 0x10, -+0x05, 0x6A, 0x40, 0xC0, 0x80, 0x6A, 0x4B, 0xEA, -+0x41, 0xC0, 0x01, 0x6A, 0x43, 0xC0, 0x87, 0x40, -+0x1F, 0x6A, 0x05, 0x05, 0x44, 0xC0, 0x01, 0x4C, -+0x08, 0x6E, 0x00, 0x18, 0xC3, 0xCA, 0x87, 0x40, -+0x07, 0x05, 0x09, 0x4C, 0x10, 0x6E, 0x00, 0x18, -+0xC3, 0xCA, 0x87, 0x40, 0x04, 0x05, 0x19, 0x4C, -+0x04, 0x6E, 0x00, 0x18, 0xC3, 0xCA, 0x91, 0x67, -+0x24, 0x6D, 0x00, 0x6E, 0x00, 0x18, 0xE3, 0xD3, -+0x0F, 0x97, 0x0E, 0x91, 0x0D, 0x90, 0x01, 0x6A, -+0x08, 0x63, 0x00, 0xEF, 0xD4, 0x63, 0x57, 0x62, -+0x56, 0xD1, 0x55, 0xD0, 0x59, 0xD5, 0x10, 0xF0, -+0x23, 0x6D, 0x2E, 0xF0, 0x00, 0x4D, 0x28, 0x6E, -+0x24, 0x67, 0x04, 0x04, 0x00, 0x18, 0xC3, 0xCA, -+0xFF, 0x6E, 0x0E, 0x04, 0x00, 0x6D, 0x01, 0x4E, -+0x00, 0x18, 0xBE, 0xCA, 0x30, 0xF0, 0x20, 0x6A, -+0xAF, 0xF4, 0x18, 0x4A, 0x4E, 0xD2, 0xE1, 0xF3, -+0x4C, 0xA2, 0x00, 0xF6, 0x1A, 0x2A, 0x59, 0x95, -+0x91, 0x67, 0x00, 0x18, 0x31, 0xC3, 0x20, 0xF2, -+0x10, 0x22, 0x59, 0x95, 0x91, 0x67, 0x00, 0x18, -+0x43, 0xC3, 0x20, 0xF2, 0x0A, 0x22, 0x4F, 0xA1, -+0x2A, 0x72, 0x20, 0xF5, 0x07, 0x60, 0x2B, 0x5A, -+0x20, 0x60, 0x1B, 0x72, 0x00, 0xF4, 0x10, 0x60, -+0x1C, 0x5A, 0x0D, 0x60, 0x03, 0x72, 0x60, 0x60, -+0x04, 0x5A, 0x03, 0x60, 0xA0, 0xF2, 0x0E, 0x22, -+0xA2, 0x12, 0x12, 0x72, 0x37, 0x60, 0x1A, 0x72, -+0xC0, 0xF0, 0x1A, 0x60, 0x9C, 0x12, 0x23, 0x72, -+0xA0, 0xF1, 0x08, 0x60, 0x24, 0x5A, 0x04, 0x60, -+0x1E, 0x72, 0xE0, 0xF1, 0x1A, 0x60, 0x93, 0x12, -+0x25, 0x72, 0x00, 0xF2, 0x15, 0x60, 0x28, 0x72, -+0x22, 0x10, 0x51, 0x72, 0x00, 0xF3, 0x19, 0x60, -+0x52, 0x5A, 0x10, 0x60, 0x43, 0x72, 0x40, 0xF3, -+0x04, 0x60, 0x44, 0x5A, 0x04, 0x60, 0x35, 0x72, -+0xE0, 0xF1, 0x17, 0x60, 0x80, 0x12, 0x46, 0x72, -+0x20, 0xF3, 0x1B, 0x60, 0x4A, 0x72, 0xC0, 0xF2, -+0x19, 0x60, 0x79, 0x12, 0x5A, 0x72, 0x00, 0xF1, -+0x03, 0x60, 0x5B, 0x5A, 0x04, 0x60, 0x52, 0x72, -+0x20, 0xF3, 0x0F, 0x60, 0x70, 0x12, 0xA4, 0x72, -+0x80, 0xF5, 0x16, 0x60, 0xA8, 0x72, 0xE0, 0xF3, -+0x07, 0x60, 0x69, 0x12, 0x62, 0x99, 0x4E, 0xD3, -+0x00, 0x18, 0xCA, 0xC3, 0x50, 0xD2, 0x00, 0x18, -+0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, 0x4F, 0xD2, -+0x00, 0x18, 0x78, 0xC3, 0x4E, 0x94, 0x02, 0x67, -+0x24, 0x5C, 0x04, 0x61, 0x4E, 0x95, 0x82, 0x67, -+0xDC, 0x4D, 0x02, 0x10, 0x82, 0x67, 0x00, 0x6D, -+0x00, 0x18, 0x76, 0xC3, 0x50, 0x95, 0x01, 0x75, -+0xA0, 0xF2, 0x09, 0x60, 0x90, 0x67, 0x01, 0x6D, -+0x00, 0x18, 0x77, 0xC3, 0x4F, 0x94, 0x6E, 0x10, -+0x00, 0x18, 0x6E, 0xC3, 0x50, 0xD2, 0x40, 0x30, -+0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF4, 0x1C, 0x4A, -+0x04, 0x30, 0x01, 0xE2, 0x90, 0x67, 0x00, 0x6D, -+0x00, 0xF2, 0x00, 0x6E, 0x00, 0x18, 0xBE, 0xCA, -+0x42, 0x99, 0x08, 0x5A, 0x4F, 0xD2, 0x60, 0x61, -+0x70, 0x6A, 0x40, 0xC0, 0x4F, 0x92, 0xF8, 0x4A, -+0x47, 0xC0, 0x4E, 0x93, 0x01, 0xF4, 0x5A, 0xA3, -+0x01, 0x72, 0x16, 0x61, 0x05, 0x6A, 0x42, 0xC0, -+0x00, 0x6C, 0x20, 0x6A, 0x4C, 0xC0, 0x8D, 0xC0, -+0x4F, 0x92, 0x50, 0x94, 0xFF, 0xF7, 0x1F, 0x6D, -+0x4C, 0xED, 0x00, 0x6E, 0x00, 0x18, 0xE3, 0xD3, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, 0x18, 0x4A, -+0x00, 0x6B, 0x01, 0xF4, 0x7A, 0xC2, 0x29, 0x10, -+0x30, 0xF0, 0x21, 0x6A, 0xD1, 0xF0, 0x51, 0xA2, -+0x01, 0x6B, 0x4E, 0xEB, 0x06, 0x2B, 0x02, 0x6A, -+0x42, 0xC0, 0x3A, 0x6A, 0x4C, 0xC0, 0x6D, 0xC0, -+0x08, 0x10, 0x02, 0x6B, 0x6E, 0xEA, 0x0B, 0x2A, -+0x06, 0x6B, 0x62, 0xC0, 0x28, 0x6B, 0x6C, 0xC0, -+0x4D, 0xC0, 0x4F, 0x92, 0xFF, 0xF7, 0x1F, 0x6D, -+0x50, 0x94, 0x4C, 0xED, 0x0B, 0x10, 0x05, 0x6A, -+0x42, 0xC0, 0x20, 0x6A, 0x4C, 0xC0, 0x00, 0x6A, -+0x4D, 0xC0, 0x4F, 0x93, 0x50, 0x94, 0xFF, 0xF7, -+0x1F, 0x6D, 0x6C, 0xED, 0x00, 0x6E, 0x00, 0x18, -+0xE3, 0xD3, 0x00, 0x18, 0x6E, 0xC3, 0xA2, 0x67, -+0x91, 0x67, 0x4E, 0xD2, 0x00, 0x18, 0x78, 0xC3, -+0x02, 0x67, 0x90, 0x67, 0x00, 0x6D, 0x00, 0x18, -+0x76, 0xC3, 0x90, 0x67, 0x00, 0x6D, 0x00, 0x18, -+0x77, 0xC3, 0x4E, 0x94, 0x0D, 0x6D, 0x00, 0x6E, -+0x00, 0x18, 0xE3, 0xD3, 0xC0, 0xF5, 0x0A, 0x10, -+0x50, 0x94, 0x00, 0x6D, 0xC5, 0x67, 0x00, 0x18, -+0xE3, 0xD3, 0x00, 0x18, 0x6E, 0xC3, 0xA2, 0x67, -+0x91, 0x67, 0x4E, 0xD2, 0x00, 0x18, 0x78, 0xC3, -+0x02, 0x67, 0x82, 0x67, 0x4F, 0x95, 0x43, 0x11, -+0x00, 0x18, 0x6E, 0xC3, 0x4E, 0xD2, 0x40, 0x30, -+0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF4, 0x1C, 0x4A, -+0x04, 0x30, 0x01, 0xE2, 0x90, 0x67, 0x00, 0x6D, -+0x00, 0xF2, 0x00, 0x6E, 0x00, 0x18, 0xBE, 0xCA, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, 0x18, 0x4A, -+0x01, 0xF4, 0x78, 0xA2, 0x02, 0x6C, 0x8C, 0xEB, -+0x04, 0x2B, 0x01, 0xF4, 0x5B, 0xA2, 0x01, 0x72, -+0x31, 0x61, 0x03, 0x6A, 0x40, 0xC0, 0x30, 0xF0, -+0x21, 0x6A, 0xB1, 0xF0, 0x45, 0xA2, 0x08, 0x2A, -+0x30, 0xF0, 0x21, 0x6C, 0xD1, 0xF0, 0x10, 0x4C, -+0x00, 0x18, 0xAB, 0xC2, 0x01, 0x72, 0x0C, 0x61, -+0x30, 0xF0, 0x21, 0x6A, 0xD1, 0xF0, 0x70, 0xA2, -+0x02, 0x6A, 0x6C, 0xEA, 0x05, 0x22, 0x04, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x6A, 0x02, 0x10, -+0x80, 0x6A, 0x4B, 0xEA, 0x42, 0xC0, 0x4E, 0x94, -+0x04, 0x6D, 0x00, 0x6E, 0x00, 0x18, 0xE3, 0xD3, -+0x00, 0x18, 0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, -+0x4E, 0xD2, 0x00, 0x18, 0x78, 0xC3, 0xA2, 0x99, -+0x02, 0x67, 0x04, 0x5D, 0x96, 0x61, 0x82, 0x67, -+0xFC, 0x4D, 0x95, 0x17, 0x4E, 0x94, 0xE5, 0x10, -+0x00, 0x18, 0x6E, 0xC3, 0x4F, 0xD2, 0x40, 0x33, -+0x30, 0xF0, 0x21, 0x6A, 0x64, 0x33, 0x90, 0xF4, -+0x1C, 0x4A, 0x69, 0xE2, 0x82, 0x67, 0x00, 0x6D, -+0x00, 0xF2, 0x00, 0x6E, 0x51, 0xD2, 0x00, 0x18, -+0xBE, 0xCA, 0x4E, 0x95, 0x82, 0x99, 0x02, 0x6B, -+0x01, 0xF4, 0x58, 0xA5, 0x50, 0xD4, 0x6C, 0xEA, -+0x04, 0x2A, 0x01, 0xF4, 0x5B, 0xA5, 0x01, 0x72, -+0x55, 0x61, 0x16, 0xA1, 0x57, 0xA1, 0x00, 0x30, -+0x41, 0xE0, 0x50, 0x20, 0x00, 0x18, 0x6E, 0xC3, -+0xA2, 0x67, 0x91, 0x67, 0x4E, 0xD2, 0x00, 0x18, -+0x78, 0xC3, 0x29, 0x58, 0x22, 0x67, 0x06, 0x61, -+0x4F, 0x94, 0x00, 0x6D, 0xC5, 0x67, 0x00, 0x18, -+0xE3, 0xD3, 0x37, 0x13, 0x30, 0xF0, 0x21, 0x6A, -+0xB1, 0xF0, 0x45, 0xA2, 0x08, 0x2A, 0x30, 0xF0, -+0x21, 0x6C, 0xD1, 0xF0, 0x10, 0x4C, 0x00, 0x18, -+0xAB, 0xC2, 0x01, 0x72, 0x16, 0x61, 0x30, 0xF0, -+0x21, 0x6A, 0xD1, 0xF0, 0x70, 0xA2, 0x02, 0x6A, -+0x6C, 0xEA, 0x0A, 0x22, 0x04, 0x6A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x6A, 0x0C, 0x10, 0x80, 0x6A, -+0x4B, 0xEA, 0x9D, 0x67, 0x53, 0xC4, 0x09, 0x10, -+0x80, 0x6A, 0x4B, 0xEA, 0xBD, 0x67, 0x53, 0xC5, -+0x04, 0x10, 0x80, 0x6A, 0x4B, 0xEA, 0x7D, 0x67, -+0x53, 0xC3, 0x51, 0x94, 0x04, 0x05, 0x28, 0x6E, -+0x00, 0x18, 0xC3, 0xCA, 0x4F, 0x94, 0xFF, 0xF7, -+0x1F, 0x6D, 0x0C, 0xED, 0x00, 0x6E, 0x00, 0x18, -+0xE3, 0xD3, 0x50, 0x94, 0x03, 0xEC, 0x04, 0x61, -+0x50, 0x92, 0x91, 0x67, 0x17, 0xE2, 0x02, 0x10, -+0x91, 0x67, 0x00, 0x6D, 0x00, 0x18, 0x76, 0xC3, -+0x91, 0x67, 0x24, 0x17, 0x4F, 0x94, 0x00, 0x6D, -+0xC5, 0x67, 0x00, 0x18, 0xE3, 0xD3, 0x00, 0x18, -+0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, 0x4E, 0xD2, -+0x00, 0x18, 0x78, 0xC3, 0x02, 0x67, 0x82, 0x67, -+0x50, 0x95, 0x71, 0x10, 0x00, 0x18, 0x6E, 0xC3, -+0x4F, 0xD2, 0x40, 0x30, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF4, 0x1C, 0x4A, 0x04, 0x30, 0x01, 0xE2, -+0x90, 0x67, 0x00, 0x6D, 0x00, 0xF2, 0x00, 0x6E, -+0x00, 0x18, 0xBE, 0xCA, 0x4E, 0x93, 0x01, 0xF4, -+0x58, 0xA3, 0x02, 0x6B, 0x6C, 0xEA, 0x05, 0x2A, -+0x4E, 0x94, 0x01, 0xF4, 0x5B, 0xA4, 0x01, 0x72, -+0x47, 0x61, 0x08, 0x6A, 0x43, 0xC0, 0x10, 0xF0, -+0x23, 0x6B, 0x10, 0xF0, 0x30, 0x6A, 0xC1, 0xF7, -+0x58, 0x9A, 0x4E, 0xF2, 0x64, 0x9B, 0x43, 0xEB, -+0x20, 0x60, 0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF2, -+0x68, 0x9B, 0x49, 0xE3, 0xE0, 0xF1, 0x1F, 0x6B, -+0x4C, 0xEB, 0x04, 0x2B, 0x42, 0x32, 0x64, 0xC0, -+0x46, 0x32, 0x05, 0x10, 0x42, 0x32, 0x00, 0x6B, -+0x46, 0x32, 0x64, 0xC0, 0x01, 0x4A, 0x10, 0xF0, -+0x23, 0x6B, 0x4E, 0xF2, 0x6C, 0x9B, 0x4C, 0xEB, -+0x62, 0x33, 0x62, 0x33, 0x65, 0xC0, 0x1F, 0xF7, -+0x00, 0x6B, 0x4C, 0xEB, 0x62, 0x33, 0x66, 0xC0, -+0x04, 0x10, 0x00, 0x6A, 0x44, 0xC0, 0x45, 0xC0, -+0x46, 0xC0, 0x47, 0xC0, 0x02, 0x6B, 0x00, 0x6A, -+0x68, 0xC0, 0x49, 0xC0, 0x6A, 0xC0, 0x4B, 0xC0, -+0x4F, 0x94, 0x0C, 0x6D, 0x00, 0x6E, 0x00, 0x18, -+0xE3, 0xD3, 0x00, 0x18, 0x6E, 0xC3, 0xA2, 0x67, -+0x91, 0x67, 0x4E, 0xD2, 0x00, 0x18, 0x78, 0xC3, -+0x02, 0x67, 0x82, 0x67, 0xA2, 0x99, 0xAF, 0x16, -+0x4F, 0x94, 0x00, 0x6D, 0xC5, 0x67, 0x00, 0x18, -+0xE3, 0xD3, 0x00, 0x18, 0x6E, 0xC3, 0xA2, 0x67, -+0x91, 0x67, 0x4E, 0xD2, 0x00, 0x18, 0x78, 0xC3, -+0x02, 0x67, 0x82, 0x67, 0x00, 0x6D, 0x00, 0x18, -+0x76, 0xC3, 0x90, 0x67, 0x01, 0x6D, 0x9F, 0x16, -+0x00, 0x18, 0x6E, 0xC3, 0x4E, 0xD2, 0x40, 0x30, -+0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF4, 0x1C, 0x4A, -+0x04, 0x30, 0x01, 0xE2, 0x90, 0x67, 0x00, 0x6D, -+0x00, 0xF2, 0x00, 0x6E, 0x00, 0x18, 0xBE, 0xCA, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, 0x18, 0x4A, -+0x01, 0xF4, 0x78, 0xA2, 0x02, 0x6C, 0x8C, 0xEB, -+0x04, 0x2B, 0x01, 0xF4, 0x5B, 0xA2, 0x01, 0x72, -+0x59, 0x61, 0x56, 0xA1, 0x01, 0x6B, 0x6C, 0xEA, -+0x52, 0x2A, 0x71, 0xA1, 0x50, 0x2B, 0x42, 0x99, -+0x08, 0x5A, 0x4D, 0x61, 0x10, 0xF0, 0x30, 0x6A, -+0x10, 0xF0, 0x23, 0x6C, 0xC1, 0xF7, 0x58, 0x9A, -+0x4E, 0xF2, 0x90, 0x9C, 0x43, 0xEC, 0x28, 0x60, -+0x10, 0xF0, 0x23, 0x6C, 0x4E, 0xF2, 0x88, 0x9C, -+0x51, 0xE4, 0xE0, 0xF1, 0x1F, 0x6A, 0x8C, 0xEA, -+0x0D, 0x2A, 0x00, 0xF2, 0x00, 0x5C, 0x05, 0x60, -+0x40, 0xC0, 0x41, 0xC0, 0x42, 0xC0, 0x43, 0xC0, -+0x1B, 0x10, 0x82, 0x34, 0x86, 0x34, 0x40, 0xC0, -+0xFF, 0x4C, 0x03, 0x10, 0x82, 0x34, 0x60, 0xC0, -+0x86, 0x34, 0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF2, -+0x4C, 0x9A, 0x83, 0xC0, 0x8C, 0xEA, 0x42, 0x32, -+0x42, 0x32, 0x41, 0xC0, 0x1F, 0xF7, 0x00, 0x6A, -+0x8C, 0xEA, 0x42, 0x32, 0x42, 0xC0, 0x04, 0x10, -+0x60, 0xC0, 0x61, 0xC0, 0x62, 0xC0, 0x63, 0xC0, -+0x00, 0x6A, 0x02, 0x6B, 0x66, 0xC0, 0x44, 0xC0, -+0x45, 0xC0, 0x47, 0xC0, 0x4E, 0x94, 0x08, 0x6D, -+0x00, 0x6E, 0x00, 0x18, 0xE3, 0xD3, 0x00, 0x18, -+0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, 0x4E, 0xD2, -+0x00, 0x18, 0x78, 0xC3, 0xA2, 0x99, 0x02, 0x67, -+0x82, 0x67, 0xF8, 0x4D, 0x28, 0x16, 0x4E, 0x94, -+0x00, 0x6D, 0x02, 0x10, 0x00, 0x6C, 0xA4, 0x67, -+0xC5, 0x67, 0x00, 0x18, 0xE3, 0xD3, 0x00, 0x18, -+0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, 0x4E, 0xD2, -+0x00, 0x18, 0x78, 0xC3, 0x02, 0x67, 0x82, 0x67, -+0xA2, 0x99, 0x75, 0x17, 0xA2, 0x99, 0x13, 0x5D, -+0x4E, 0xD5, 0x12, 0x61, 0x00, 0x18, 0x6E, 0xC3, -+0xA2, 0x67, 0x91, 0x67, 0x4F, 0xD2, 0x00, 0x18, -+0x78, 0xC3, 0x4E, 0x95, 0x02, 0x67, 0x82, 0x67, -+0x00, 0x18, 0x76, 0xC3, 0x90, 0x67, 0x01, 0x6D, -+0x00, 0x18, 0x77, 0xC3, 0x4F, 0x94, 0x63, 0x10, -+0x30, 0xF0, 0x20, 0x68, 0xAF, 0xF4, 0x18, 0x48, -+0x01, 0xF4, 0x58, 0xA0, 0x02, 0x6B, 0x6C, 0xEA, -+0x26, 0x2A, 0x01, 0xF4, 0x5B, 0xA0, 0x23, 0x2A, -+0x00, 0x18, 0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, -+0x4F, 0xD2, 0x00, 0x18, 0x78, 0xC3, 0x4E, 0x95, -+0x22, 0x67, 0x82, 0x67, 0x00, 0x18, 0x76, 0xC3, -+0x91, 0x67, 0x01, 0x6D, 0x00, 0x18, 0x77, 0xC3, -+0x4F, 0x94, 0x0D, 0x6D, 0x00, 0x6E, 0x00, 0x18, -+0xE3, 0xD3, 0x01, 0xF4, 0x59, 0xA0, 0x01, 0x4A, -+0x01, 0xF4, 0x59, 0xC0, 0x01, 0xF4, 0x59, 0xA0, -+0x03, 0x5A, 0xA0, 0xF3, 0x0B, 0x61, 0x01, 0x6A, -+0x01, 0xF4, 0x5B, 0xC0, 0xA7, 0x13, 0x00, 0x18, -+0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, 0x4F, 0xD2, -+0x00, 0x18, 0x78, 0xC3, 0x4E, 0x95, 0x02, 0x67, -+0x82, 0x67, 0x00, 0x18, 0x76, 0xC3, 0x90, 0x67, -+0x00, 0x6D, 0x56, 0x15, 0x00, 0x18, 0x6E, 0xC3, -+0x02, 0x67, 0x40, 0x34, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF4, 0x1C, 0x4A, 0x84, 0x34, 0x91, 0xE2, -+0x00, 0x6D, 0x00, 0xF2, 0x00, 0x6E, 0x00, 0x18, -+0xBE, 0xCA, 0x00, 0x6D, 0xC5, 0x67, 0x90, 0x67, -+0x00, 0x18, 0xE3, 0xD3, 0x00, 0x18, 0x6E, 0xC3, -+0xA2, 0x67, 0x91, 0x67, 0x4E, 0xD2, 0x00, 0x18, -+0x78, 0xC3, 0xA2, 0x99, 0x02, 0x67, 0x82, 0x67, -+0x00, 0x18, 0x76, 0xC3, 0x90, 0x67, 0x01, 0x6D, -+0x00, 0x18, 0x77, 0xC3, 0x4E, 0x94, 0x0D, 0x6D, -+0x00, 0x6E, 0x00, 0x18, 0xE3, 0xD3, 0x01, 0x6B, -+0x30, 0xF0, 0x21, 0x6A, 0xD1, 0xF0, 0x72, 0xC2, -+0x69, 0x13, 0x00, 0x18, 0x6E, 0xC3, 0x02, 0x67, -+0x40, 0x34, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF4, -+0x1C, 0x4A, 0x84, 0x34, 0x91, 0xE2, 0x00, 0x6D, -+0x00, 0xF2, 0x00, 0x6E, 0x00, 0x18, 0xBE, 0xCA, -+0x42, 0x99, 0x00, 0x6D, 0xC5, 0x67, 0x90, 0x67, -+0x50, 0xD2, 0x00, 0x18, 0xE3, 0xD3, 0x00, 0x18, -+0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, 0x4F, 0xD2, -+0x00, 0x18, 0x78, 0xC3, 0x50, 0x95, 0x02, 0x67, -+0x82, 0x67, 0x00, 0x18, 0x76, 0xC3, 0x90, 0x67, -+0x01, 0x6D, 0x00, 0x18, 0x77, 0xC3, 0x4F, 0x94, -+0x0D, 0x6D, 0x00, 0x6E, 0x00, 0x18, 0xE3, 0xD3, -+0x4E, 0x93, 0x01, 0x6A, 0x01, 0xF4, 0x5A, 0xC3, -+0x39, 0x13, 0x00, 0x18, 0x6E, 0xC3, 0x4F, 0xD2, -+0x40, 0x30, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF4, -+0x1C, 0x4A, 0x04, 0x30, 0x01, 0xE2, 0x90, 0x67, -+0x00, 0x6D, 0x00, 0xF2, 0x00, 0x6E, 0x00, 0x18, -+0xBE, 0xCA, 0x30, 0xF0, 0x20, 0x6A, 0x82, 0x99, -+0xAF, 0xF4, 0x18, 0x4A, 0x01, 0xF4, 0x78, 0xA2, -+0x4E, 0xD4, 0x02, 0x6C, 0x8C, 0xEB, 0x05, 0x2B, -+0x01, 0xF4, 0x5B, 0xA2, 0x01, 0x72, 0x80, 0xF0, -+0x03, 0x61, 0x6F, 0xA1, 0x43, 0x6A, 0x6E, 0xEA, -+0x39, 0x2A, 0x12, 0x6B, 0x61, 0xC0, 0x01, 0x6B, -+0x62, 0xC0, 0x63, 0xC0, 0x66, 0xC0, 0x56, 0x6B, -+0x14, 0x6C, 0x6B, 0xEB, 0x85, 0xC0, 0x8D, 0xC0, -+0x6E, 0xC0, 0x52, 0xC0, 0x53, 0xC0, 0x58, 0xA1, -+0x40, 0x72, 0x03, 0x60, 0x51, 0xA1, 0x01, 0x72, -+0x03, 0x61, 0x0A, 0x6A, 0x41, 0xC0, 0x05, 0x10, -+0x50, 0xA1, 0x02, 0x72, 0x02, 0x61, 0x02, 0x6A, -+0x4B, 0xC0, 0x4E, 0x95, 0x15, 0x5D, 0x06, 0x60, -+0x4E, 0x92, 0xFF, 0xF7, 0x1F, 0x6D, 0x4F, 0x94, -+0x4C, 0xED, 0x02, 0x10, 0x4F, 0x94, 0x14, 0x6D, -+0x00, 0x6E, 0x00, 0x18, 0xE3, 0xD3, 0x00, 0x18, -+0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, 0x4F, 0xD2, -+0x00, 0x18, 0x78, 0xC3, 0x4E, 0x93, 0x02, 0x67, -+0x14, 0x5B, 0x47, 0x61, 0xA3, 0x67, 0x82, 0x67, -+0xEC, 0x4D, 0x3F, 0x17, 0x46, 0x73, 0x18, 0x61, -+0x4E, 0x94, 0x08, 0x5C, 0x41, 0x61, 0x04, 0x6A, -+0x43, 0xC0, 0x08, 0x6A, 0x47, 0xC0, 0x4F, 0x94, -+0x08, 0x6D, 0x00, 0x6E, 0x00, 0x18, 0xE3, 0xD3, -+0x00, 0x18, 0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, -+0x4F, 0xD2, 0x00, 0x18, 0x78, 0xC3, 0x4E, 0x95, -+0x02, 0x67, 0x82, 0x67, 0xF8, 0x4D, 0x25, 0x17, -+0x2E, 0x6A, 0x41, 0xC0, 0x01, 0x6A, 0x42, 0xC0, -+0x43, 0xC0, 0x46, 0xC0, 0x02, 0x6A, 0x47, 0xC0, -+0x10, 0x6A, 0x57, 0xC0, 0x10, 0xF0, 0x23, 0x6A, -+0x4E, 0xF2, 0x54, 0x9A, 0x04, 0x6B, 0x65, 0xC0, -+0x46, 0xD8, 0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF1, -+0x48, 0x9A, 0x20, 0x6D, 0x00, 0x6E, 0x47, 0xD8, -+0x4F, 0x94, 0x00, 0x18, 0xE3, 0xD3, 0x00, 0x18, -+0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, 0x4F, 0xD2, -+0x00, 0x18, 0x78, 0xC3, 0x4E, 0x95, 0x02, 0x67, -+0x20, 0x5D, 0x03, 0x61, 0x82, 0x67, 0xE0, 0x4D, -+0xFC, 0x16, 0x90, 0x67, 0x00, 0x6D, 0xF9, 0x16, -+0x00, 0x6D, 0x4F, 0x94, 0xC5, 0x67, 0xE5, 0x11, -+0x00, 0x18, 0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, -+0x4E, 0xD2, 0x00, 0x18, 0x78, 0xC3, 0x02, 0x67, -+0x82, 0x67, 0x00, 0x6D, 0x00, 0x18, 0x76, 0xC3, -+0x90, 0x67, 0x00, 0x6D, 0x00, 0x18, 0x77, 0xC3, -+0x4E, 0x94, 0x0D, 0x6D, 0x00, 0x6E, 0x00, 0x18, -+0xE3, 0xD3, 0x00, 0x18, 0x97, 0xD3, 0x7A, 0x12, -+0x10, 0xF0, 0x30, 0x6A, 0xC1, 0xF7, 0x58, 0x9A, -+0x02, 0x99, 0x4F, 0xD2, 0x52, 0xA1, 0x71, 0xA1, -+0x40, 0x32, 0x00, 0xF6, 0x60, 0x33, 0x40, 0x32, -+0x49, 0xE3, 0x74, 0xA1, 0x69, 0xE2, 0x73, 0xA1, -+0x60, 0x33, 0x69, 0xE2, 0x80, 0xF1, 0x00, 0x4A, -+0x40, 0x32, 0x44, 0x32, 0x4E, 0xD2, 0x00, 0xF2, -+0x01, 0x58, 0x65, 0x60, 0x4E, 0x92, 0x4F, 0x93, -+0x09, 0xE2, 0x43, 0xEB, 0x51, 0xD2, 0x23, 0x61, -+0x00, 0x18, 0x6E, 0xC3, 0x50, 0xD2, 0x40, 0x33, -+0x30, 0xF0, 0x21, 0x6A, 0x64, 0x33, 0x90, 0xF4, -+0x1C, 0x4A, 0x69, 0xE2, 0x82, 0x67, 0x00, 0x6D, -+0x00, 0xF2, 0x00, 0x6E, 0x4F, 0xD2, 0x00, 0x18, -+0xBE, 0xCA, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0x94, -+0x4F, 0x96, 0xAE, 0xF5, 0x44, 0x9A, 0xB0, 0x67, -+0x40, 0xEA, 0x50, 0x94, 0xFF, 0xF7, 0x1F, 0x6D, -+0x0C, 0xED, 0x01, 0x6E, 0x00, 0x18, 0xE3, 0xD3, -+0x80, 0xF0, 0x1E, 0x2A, 0x9A, 0x10, 0x4E, 0x94, -+0x4F, 0x95, 0xA3, 0xEC, 0x2A, 0x60, 0x00, 0x18, -+0x6E, 0xC3, 0x52, 0xD2, 0x40, 0x33, 0x30, 0xF0, -+0x21, 0x6A, 0x64, 0x33, 0x90, 0xF4, 0x1C, 0x4A, -+0x69, 0xE2, 0x82, 0x67, 0x00, 0x6D, 0x00, 0xF2, -+0x00, 0x6E, 0x50, 0xD2, 0x00, 0x18, 0xBE, 0xCA, -+0x4E, 0x93, 0x4F, 0x92, 0x50, 0x96, 0x83, 0x67, -+0x6B, 0xE2, 0x53, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0x53, 0x95, 0xAE, 0xF5, 0x44, 0x9A, 0x40, 0xEA, -+0x53, 0x92, 0x52, 0x94, 0xFF, 0xF7, 0x1F, 0x6D, -+0x4C, 0xED, 0x01, 0x6E, 0x00, 0x18, 0xE3, 0xD3, -+0x70, 0x22, 0x51, 0x93, 0x4F, 0x94, 0x83, 0xE3, -+0x69, 0x10, 0x00, 0x18, 0x6E, 0xC3, 0xA2, 0x67, -+0x91, 0x67, 0x4E, 0xD2, 0x00, 0x18, 0x78, 0xC3, -+0x22, 0x67, 0x91, 0x67, 0xB0, 0x67, 0x00, 0x18, -+0x76, 0xC3, 0x91, 0x67, 0x87, 0x15, 0x4E, 0x92, -+0x4F, 0x93, 0x00, 0xF2, 0x00, 0x4A, 0x43, 0xEB, -+0x51, 0xD2, 0x27, 0x61, 0x00, 0x18, 0x6E, 0xC3, -+0x52, 0xD2, 0x40, 0x33, 0x30, 0xF0, 0x21, 0x6A, -+0x64, 0x33, 0x90, 0xF4, 0x1C, 0x4A, 0x69, 0xE2, -+0x82, 0x67, 0x00, 0x6D, 0x00, 0xF2, 0x00, 0x6E, -+0x50, 0xD2, 0x00, 0x18, 0xBE, 0xCA, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0x94, 0x50, 0x96, 0xAE, 0xF5, -+0x44, 0x9A, 0x00, 0xF2, 0x00, 0x6D, 0x40, 0xEA, -+0x52, 0x94, 0x00, 0xF2, 0x00, 0x6D, 0x01, 0x6E, -+0x00, 0x18, 0xE3, 0xD3, 0x36, 0x22, 0x1F, 0xF6, -+0x00, 0x48, 0x36, 0x20, 0x51, 0x94, 0x4E, 0xD4, -+0x6A, 0x17, 0x4E, 0x95, 0x4F, 0x92, 0x43, 0xED, -+0xC0, 0x60, 0x00, 0x18, 0x6E, 0xC3, 0x51, 0xD2, -+0x40, 0x33, 0x30, 0xF0, 0x21, 0x6A, 0x64, 0x33, -+0x90, 0xF4, 0x1C, 0x4A, 0x69, 0xE2, 0x82, 0x67, -+0x00, 0x6D, 0x00, 0xF2, 0x00, 0x6E, 0x50, 0xD2, -+0x00, 0x18, 0xBE, 0xCA, 0x4E, 0x94, 0x4F, 0x93, -+0x30, 0xF0, 0x20, 0x6A, 0x50, 0x96, 0xAE, 0xF5, -+0x44, 0x9A, 0x8F, 0xE3, 0xA3, 0x67, 0x52, 0xD3, -+0x40, 0xEA, 0x52, 0x92, 0x51, 0x94, 0xFF, 0xF7, -+0x1F, 0x6D, 0x4C, 0xED, 0x01, 0x6E, 0x00, 0x18, -+0xE3, 0xD3, 0x07, 0x22, 0x4E, 0x93, 0x4F, 0x94, -+0x01, 0xE3, 0x83, 0xE0, 0x01, 0x6D, 0x4E, 0xD5, -+0x06, 0x10, 0x00, 0x6A, 0x4E, 0xD2, 0x03, 0x10, -+0x01, 0x6B, 0x00, 0x68, 0x4E, 0xD3, 0x00, 0x18, -+0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, 0x4F, 0xD2, -+0x00, 0x18, 0x78, 0xC3, 0x4E, 0x94, 0x22, 0x67, -+0x06, 0x24, 0x82, 0x67, 0xB0, 0x67, 0x00, 0x18, -+0x76, 0xC3, 0x91, 0x67, 0xED, 0x15, 0x82, 0x67, -+0x00, 0x6D, 0x00, 0x18, 0x76, 0xC3, 0x91, 0x67, -+0x3F, 0xF3, 0x1D, 0x10, 0x76, 0xA1, 0x57, 0xA1, -+0x82, 0x99, 0x60, 0x33, 0x49, 0xE3, 0x4E, 0xD2, -+0x4E, 0x95, 0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xED, -+0xA0, 0x32, 0x44, 0x32, 0x8E, 0xEA, 0x4E, 0xD5, -+0x7F, 0xF5, 0x19, 0x2A, 0x4C, 0xA1, 0x7F, 0xF5, -+0x16, 0x2A, 0x52, 0xA1, 0x71, 0xA1, 0x40, 0x32, -+0x40, 0x32, 0x00, 0xF6, 0x60, 0x33, 0x4D, 0xE3, -+0x54, 0xA1, 0x4D, 0xE3, 0x53, 0xA1, 0x40, 0x32, -+0x4D, 0xE3, 0x80, 0xF1, 0x40, 0x43, 0x40, 0x35, -+0xA4, 0x35, 0x91, 0xE5, 0x51, 0xD5, 0x10, 0xF0, -+0x30, 0x6D, 0xC1, 0xF7, 0xB8, 0x9D, 0x83, 0xED, -+0x5F, 0xF5, 0x1D, 0x61, 0x07, 0x68, 0x6C, 0xE8, -+0x05, 0x28, 0x4E, 0x94, 0x51, 0x95, 0x00, 0x18, -+0x89, 0xC3, 0x62, 0x10, 0x0B, 0xE2, 0x40, 0x32, -+0x44, 0x32, 0x50, 0xD2, 0x00, 0x6A, 0x4F, 0xD2, -+0xFF, 0x6E, 0x0E, 0x04, 0x00, 0x6D, 0x01, 0x4E, -+0x00, 0x18, 0xBE, 0xCA, 0x4F, 0x93, 0x50, 0x95, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF5, 0x44, 0x9A, -+0xB1, 0xE3, 0xFF, 0x6D, 0x01, 0x4D, 0x0E, 0x06, -+0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6B, 0x4F, 0x94, -+0x4E, 0xF2, 0x60, 0x9B, 0x0E, 0x02, 0x6D, 0xE4, -+0x4E, 0x04, 0xA0, 0xA2, 0x01, 0x4A, 0x8A, 0xEA, -+0xA0, 0xC3, 0x01, 0x4B, 0xFA, 0x61, 0x4F, 0x95, -+0x00, 0xF1, 0x00, 0x4D, 0x02, 0xF0, 0x00, 0x75, -+0x4F, 0xD5, 0xDA, 0x61, 0x4E, 0x92, 0x50, 0x95, -+0x51, 0xE0, 0x00, 0x18, 0x89, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x48, 0x9A, 0x00, 0x30, -+0x04, 0x30, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF5, 0x44, 0x9A, 0x02, 0x6C, 0x40, 0xEA, -+0x4F, 0xD0, 0x00, 0x68, 0xFF, 0x6E, 0x0E, 0x04, -+0x00, 0x6D, 0x01, 0x4E, 0x00, 0x18, 0xBE, 0xCA, -+0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF2, 0x60, 0x9A, -+0x4E, 0x04, 0x0E, 0x02, 0x6D, 0xE0, 0xA0, 0xA3, -+0x01, 0x4B, 0xA0, 0xC2, 0x01, 0x4A, 0x8A, 0xEA, -+0xFA, 0x61, 0x50, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF5, 0x40, 0x9A, 0xFF, 0x6D, 0x71, 0xE0, -+0x01, 0x4D, 0x0E, 0x06, 0x40, 0xEA, 0x4F, 0x94, -+0x00, 0xF1, 0x00, 0x48, 0x83, 0xE8, 0xDE, 0x61, -+0x51, 0x93, 0x4E, 0x95, 0x30, 0xF0, 0x20, 0x6A, -+0xAF, 0xF4, 0x18, 0x4A, 0x30, 0xF0, 0x21, 0x68, -+0xB1, 0xF0, 0x10, 0x48, 0xE1, 0xF3, 0x70, 0xDA, -+0x01, 0x6B, 0x90, 0x67, 0xE1, 0xF3, 0xB4, 0xDA, -+0xE1, 0xF3, 0x6C, 0xC2, 0x00, 0x6D, 0x20, 0x6E, -+0x00, 0x18, 0xBE, 0xCA, 0x90, 0x67, 0xB1, 0x67, -+0x20, 0x6E, 0x00, 0x18, 0xC3, 0xCA, 0xCE, 0x10, -+0x00, 0x18, 0x6E, 0xC3, 0x4F, 0xD2, 0x40, 0x30, -+0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF4, 0x1C, 0x4A, -+0x04, 0x30, 0x01, 0xE2, 0x90, 0x67, 0x00, 0x6D, -+0x00, 0xF2, 0x00, 0x6E, 0x00, 0x18, 0xBE, 0xCA, -+0x82, 0x99, 0x06, 0x6A, 0xFF, 0xF7, 0x1F, 0x6D, -+0x4E, 0xD4, 0x41, 0xC0, 0x25, 0x6A, 0x44, 0xC0, -+0x01, 0x6A, 0x4B, 0xEA, 0x45, 0xC0, 0x01, 0x6A, -+0x46, 0xC0, 0x4E, 0x92, 0x4F, 0x94, 0x00, 0x6E, -+0x4C, 0xED, 0x00, 0x18, 0xE3, 0xD3, 0x00, 0x18, -+0x6E, 0xC3, 0xA2, 0x67, 0x91, 0x67, 0x4F, 0xD2, -+0x00, 0x18, 0x78, 0xC3, 0x4E, 0x95, 0x82, 0x67, -+0x02, 0x67, 0x00, 0x18, 0x76, 0xC3, 0x5F, 0xF2, -+0x19, 0x10, 0x4E, 0x93, 0xE1, 0xF3, 0x14, 0x9B, -+0x24, 0x28, 0x00, 0x18, 0x6E, 0xC3, 0x30, 0xF0, -+0x21, 0x6C, 0xB1, 0xF0, 0x10, 0x4C, 0xA2, 0x67, -+0x4F, 0xD2, 0x00, 0x18, 0x78, 0xC3, 0x4E, 0x94, -+0x22, 0x67, 0xE1, 0xF3, 0xB4, 0x9C, 0x82, 0x67, -+0xA0, 0x35, 0xA4, 0x35, 0x00, 0x18, 0x76, 0xC3, -+0x91, 0x67, 0x01, 0x6D, 0x00, 0x18, 0x77, 0xC3, -+0x4F, 0x94, 0x0D, 0x6D, 0x00, 0x6E, 0x00, 0x18, -+0xE3, 0xD3, 0x4E, 0x95, 0xE1, 0xF3, 0x0C, 0xC5, -+0xE1, 0xF3, 0x10, 0xDD, 0xE1, 0xF3, 0x14, 0xDD, -+0x75, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x48, 0x9A, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF5, 0x44, 0x9A, 0x02, 0x6C, 0x40, 0xEA, -+0x59, 0x93, 0x4E, 0x94, 0xFF, 0xF7, 0x1F, 0x6A, -+0x4C, 0xEB, 0x00, 0x6D, 0x4F, 0xD3, 0xE1, 0xF3, -+0x10, 0x9C, 0x4E, 0xD5, 0x2A, 0x10, 0x4F, 0x92, -+0x00, 0xF1, 0x00, 0x5A, 0x19, 0x61, 0x4E, 0x93, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF5, 0x40, 0x9A, -+0xFF, 0x6D, 0x90, 0x67, 0x01, 0x4D, 0x79, 0xE1, -+0x40, 0xEA, 0x4F, 0x94, 0x4E, 0x95, 0xFF, 0xF7, -+0x1F, 0x6A, 0x80, 0x4C, 0x80, 0x4C, 0x00, 0xF1, -+0x00, 0x4D, 0x4C, 0xEC, 0x4C, 0xED, 0x4F, 0xD4, -+0x4E, 0xD5, 0x00, 0xF1, 0x00, 0x48, 0x0D, 0x10, -+0x4E, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0x4F, 0x95, -+0xAE, 0xF5, 0x40, 0x9A, 0x90, 0x67, 0x79, 0xE1, -+0x40, 0xEA, 0x4F, 0x94, 0x00, 0x6D, 0x4F, 0xD5, -+0x81, 0xE0, 0x4F, 0x92, 0xD4, 0x2A, 0x30, 0xF0, -+0x20, 0x68, 0xAF, 0xF4, 0x18, 0x48, 0xE1, 0xF3, -+0x50, 0x98, 0x59, 0x93, 0x49, 0xE3, 0xE1, 0xF3, -+0x50, 0xD8, 0xE1, 0xF3, 0x54, 0x98, 0xFF, 0x4A, -+0xE1, 0xF3, 0x54, 0xD8, 0x23, 0x2A, 0x00, 0x18, -+0x6E, 0xC3, 0x30, 0xF0, 0x21, 0x6C, 0xB1, 0xF0, -+0x10, 0x4C, 0xA2, 0x67, 0x4E, 0xD2, 0x00, 0x18, -+0x78, 0xC3, 0x22, 0x67, 0x82, 0x67, 0x00, 0x6D, -+0x00, 0x18, 0x76, 0xC3, 0x91, 0x67, 0x00, 0x6D, -+0x00, 0x18, 0x77, 0xC3, 0x4E, 0x94, 0x0D, 0x6D, -+0x00, 0x6E, 0x00, 0x18, 0xE3, 0xD3, 0x9D, 0x67, -+0x30, 0xF1, 0xAC, 0x44, 0x80, 0xA5, 0x4F, 0x95, -+0xE1, 0xF3, 0x8C, 0xC0, 0xE1, 0xF3, 0xB0, 0xD8, -+0xE1, 0xF3, 0xB4, 0xD8, 0x57, 0x97, 0x56, 0x91, -+0x55, 0x90, 0x2C, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF2, 0x04, 0x4B, -+0x30, 0xF0, 0x20, 0x69, 0xFF, 0x68, 0xAC, 0xE8, -+0xCE, 0xF4, 0x50, 0x99, 0xA0, 0x9B, 0x82, 0xF0, -+0x00, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x23, 0x6B, 0xEE, 0xF1, 0xB0, 0x9B, 0xCE, 0xF4, -+0x50, 0x99, 0x00, 0x6C, 0x01, 0x6E, 0x40, 0xEA, -+0x01, 0x6D, 0xA1, 0xF4, 0x18, 0x6C, 0xAB, 0xED, -+0x00, 0x18, 0x9A, 0xD2, 0x01, 0x70, 0x0F, 0x60, -+0x03, 0x20, 0x02, 0x70, 0x16, 0x60, 0x1F, 0x10, -+0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF2, 0x04, 0x4B, -+0x60, 0x9B, 0x6D, 0xEA, 0x10, 0xF0, 0x23, 0x6B, -+0x6E, 0xF2, 0x68, 0x9B, 0x13, 0x10, 0x10, 0xF0, -+0x23, 0x6B, 0x6E, 0xF2, 0x6C, 0x9B, 0x6D, 0xEA, -+0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF2, 0x70, 0x9B, -+0x09, 0x10, 0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF2, -+0x74, 0x9B, 0x6D, 0xEA, 0x10, 0xF0, 0x23, 0x6B, -+0x6E, 0xF2, 0x78, 0x9B, 0x6C, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xCE, 0xF4, 0x70, 0x9B, 0x01, 0x6D, -+0xA1, 0xF4, 0x18, 0x6C, 0xAB, 0xED, 0xC2, 0x67, -+0x40, 0xEB, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x4C, 0x9A, -+0x42, 0xF1, 0x18, 0x6C, 0x01, 0x6D, 0x02, 0x6E, -+0x40, 0xEA, 0x05, 0x97, 0x05, 0x6A, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6B, -+0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0x63, 0xF6, 0x15, 0x4A, 0x40, 0xDB, 0x01, 0x4A, -+0x40, 0xDB, 0xF4, 0x17, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x23, 0x6A, -+0x4E, 0xF1, 0x7C, 0x9A, 0x10, 0xF0, 0x23, 0x6A, -+0x4E, 0xF1, 0x58, 0x9A, 0x01, 0x6C, 0xA4, 0x67, -+0x60, 0xDA, 0x00, 0x18, 0x76, 0xC9, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF1, 0x00, 0x4A, 0x10, 0xF0, -+0x23, 0x6B, 0xEF, 0x9A, 0x6E, 0xF1, 0x60, 0x9B, -+0x8C, 0x9A, 0xCE, 0x9A, 0xAD, 0x9A, 0xE0, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF1, 0x64, 0x9B, -+0x00, 0x68, 0xC0, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x6E, 0xF1, 0x68, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0x6E, 0xF1, 0x6C, 0x9B, 0x80, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0x89, 0x9A, 0x6E, 0xF1, -+0x70, 0x9B, 0x80, 0xDB, 0x68, 0x9A, 0x10, 0xF0, -+0x23, 0x6A, 0x6E, 0xF1, 0x54, 0x9A, 0x60, 0xDA, -+0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF1, 0x48, 0xAA, -+0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0x08, 0x34, -+0x2E, 0xF2, 0x0C, 0x4B, 0x6D, 0xE4, 0x60, 0x9B, -+0x05, 0x23, 0x01, 0x48, 0xFF, 0x6B, 0x6C, 0xE8, -+0x43, 0xE8, 0xF3, 0x61, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF1, 0x78, 0x9A, 0x7F, 0x6A, 0x00, 0x69, -+0x80, 0xA3, 0x20, 0xF0, 0x20, 0x6D, 0x00, 0xF1, -+0x00, 0x4D, 0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6B, 0xAE, 0xF2, 0x40, 0x9B, 0x10, 0xF0, -+0x23, 0x6B, 0x6E, 0xF1, 0xDC, 0x9B, 0x91, 0x67, -+0x48, 0x6F, 0x04, 0xD1, 0x05, 0xD1, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x40, 0x9B, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF1, 0xC0, 0x9B, -+0x20, 0xF0, 0x20, 0x6D, 0x91, 0x67, 0xAD, 0xF1, -+0x08, 0x4D, 0x00, 0xF4, 0x00, 0x6F, 0x04, 0xD1, -+0x05, 0xD1, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x40, 0x9B, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF1, 0xC4, 0x9B, 0x20, 0xF0, 0x21, 0x6D, -+0x00, 0x37, 0x91, 0x67, 0x15, 0xF0, 0x00, 0x4D, -+0xE8, 0x37, 0x04, 0xD1, 0x05, 0xD1, 0x40, 0xEA, -+0x00, 0x1C, 0x96, 0x45, 0xFF, 0x17, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF1, 0x00, 0x4A, -+0x60, 0xDA, 0x81, 0xDA, 0xA2, 0xDA, 0xC3, 0xDA, -+0xE4, 0xDA, 0x05, 0xDA, 0x26, 0xDA, 0x78, 0x67, -+0x67, 0xDA, 0x7D, 0x67, 0x68, 0xDA, 0x7F, 0x67, -+0x69, 0xDA, 0x12, 0xEB, 0x6A, 0xDA, 0x10, 0xEB, -+0x6B, 0xDA, 0x6D, 0xB8, 0x00, 0x65, 0x6C, 0xDA, -+0x68, 0xB8, 0x00, 0x65, 0x6D, 0xDA, 0x6C, 0xB8, -+0x00, 0x65, 0x6E, 0xDA, 0x6E, 0xB8, 0x00, 0x65, -+0x6F, 0xDA, 0x10, 0xF0, 0x23, 0x6A, 0x83, 0xF6, -+0x0D, 0x4A, 0x00, 0xEA, 0x00, 0x65, 0x00, 0x65, -+0xFF, 0x63, 0x01, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x4C, 0xED, 0x8E, 0x37, 0x4C, 0xEF, 0x07, 0x6E, -+0x01, 0x75, 0x8C, 0xEE, 0x52, 0xF4, 0x60, 0x47, -+0x42, 0x61, 0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, -+0x08, 0x4C, 0x9D, 0xE7, 0xE8, 0xF2, 0x8F, 0xA7, -+0x01, 0x6D, 0xA4, 0xEE, 0xAD, 0xEC, 0xE8, 0xF2, -+0x8F, 0xC7, 0x1F, 0xF7, 0x00, 0x6C, 0x6C, 0xEC, -+0x02, 0xF0, 0x00, 0x74, 0x01, 0x60, 0x22, 0x2C, -+0x1F, 0xF7, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0xF0, -+0x00, 0x72, 0x01, 0x60, 0x07, 0x2A, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x88, 0x9A, 0x91, 0xE3, -+0x60, 0xA4, 0x0B, 0x10, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x88, 0x9A, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x4C, 0x9A, 0x91, 0xE3, 0x4D, 0xE3, -+0x60, 0xA3, 0x01, 0x6A, 0x00, 0xF6, 0x60, 0x33, -+0x44, 0xEE, 0x00, 0xF6, 0x63, 0x33, 0x4F, 0xEA, -+0x6C, 0xEA, 0x41, 0x10, 0x10, 0xF0, 0x23, 0x6C, -+0x8E, 0xF1, 0x8C, 0x9C, 0xAF, 0xED, 0x8D, 0xE3, -+0x80, 0xA3, 0x00, 0xF6, 0x80, 0x34, 0x00, 0xF6, -+0x83, 0x34, 0xAC, 0xEC, 0x43, 0x10, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, 0x9D, 0xE7, -+0xE8, 0xF2, 0x0F, 0xA7, 0x01, 0x6D, 0xA4, 0xEE, -+0xAF, 0xEC, 0x0C, 0xEC, 0xE8, 0xF2, 0x8F, 0xC7, -+0x1F, 0xF7, 0x00, 0x6C, 0x6C, 0xEC, 0x02, 0xF0, -+0x00, 0x74, 0x01, 0x60, 0x24, 0x2C, 0x1F, 0xF7, -+0x00, 0x6A, 0x6C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x07, 0x2A, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x88, 0x9A, 0x91, 0xE3, 0x60, 0xA4, -+0x0B, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x88, 0x9A, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x4C, 0x9A, 0x91, 0xE3, 0x4D, 0xE3, 0x60, 0xA3, -+0x00, 0xF6, 0x60, 0x33, 0x01, 0x6A, 0x00, 0xF6, -+0x63, 0x33, 0x44, 0xEE, 0x6D, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x40, 0xC4, 0x0D, 0x10, 0x10, 0xF0, -+0x23, 0x6C, 0x8E, 0xF1, 0x8C, 0x9C, 0x8D, 0xE3, -+0x80, 0xA3, 0x00, 0xF6, 0x80, 0x34, 0x00, 0xF6, -+0x83, 0x34, 0xAD, 0xEC, 0x4C, 0xEC, 0x80, 0xC3, -+0x01, 0x90, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x4C, 0xEC, 0xAC, 0xEA, 0x0B, 0x2A, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF1, 0xB0, 0x9B, -+0x10, 0xF0, 0x23, 0x6E, 0x8E, 0xF1, 0xD4, 0x9E, -+0x60, 0x9D, 0xCC, 0xEB, 0x0C, 0x10, 0x01, 0x72, -+0x0B, 0x61, 0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF1, -+0xB0, 0x9B, 0x10, 0xF0, 0x23, 0x6E, 0x8E, 0xF1, -+0xD8, 0x9E, 0x60, 0x9D, 0xCD, 0xEB, 0x60, 0xDD, -+0x05, 0x5C, 0x60, 0xF1, 0x06, 0x60, 0x10, 0xF0, -+0x23, 0x6B, 0x88, 0x34, 0xED, 0xF7, 0x14, 0x4B, -+0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, 0x05, 0x2A, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x70, 0x9A, -+0x0D, 0x11, 0x01, 0x72, 0x10, 0x61, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x70, 0x9A, 0xFF, 0x6C, -+0x40, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0x8C, 0xEA, 0x40, 0xC3, 0x40, 0xA3, 0x80, 0x4D, -+0xC0, 0x4D, 0x8C, 0xEA, 0x14, 0x10, 0x02, 0x72, -+0x07, 0x61, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x70, 0x9A, 0xBF, 0x6A, 0x80, 0xA3, 0xF4, 0x10, -+0x03, 0x72, 0x20, 0xF1, 0x1A, 0x61, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x70, 0x9A, 0xFF, 0x6C, -+0x40, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0xE7, 0x10, 0x07, 0x2A, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x7C, 0x9A, 0xFD, 0x6A, 0x80, 0xA3, -+0xDF, 0x10, 0x01, 0x72, 0x19, 0x61, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x90, 0x9A, 0xFF, 0x6A, -+0x40, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF1, 0x9C, 0x9B, 0x01, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x60, 0xA4, 0x02, 0x6D, 0x4C, 0xEB, 0xE1, 0x10, -+0x02, 0x72, 0x0F, 0x61, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x70, 0x9A, 0xBF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x7C, 0x9A, 0xFE, 0x6A, 0x80, 0xA3, -+0xB3, 0x10, 0x03, 0x72, 0xE0, 0xF0, 0x19, 0x61, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x90, 0x9A, -+0xFF, 0x6B, 0x40, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x9C, 0x9A, 0x01, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0x92, 0x10, 0x07, 0x2A, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x7C, 0x9A, -+0xF7, 0x6A, 0x80, 0xA3, 0x95, 0x10, 0x01, 0x72, -+0x19, 0x61, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x90, 0x9A, 0xFF, 0x6A, 0x40, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF1, 0x9C, 0x9B, -+0x04, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x60, 0xA4, 0x08, 0x6D, -+0x4C, 0xEB, 0x97, 0x10, 0x02, 0x72, 0x0F, 0x61, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x70, 0x9A, -+0xBF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x7C, 0x9A, -+0xFB, 0x6A, 0x80, 0xA3, 0x69, 0x10, 0x03, 0x72, -+0xA0, 0xF0, 0x0F, 0x61, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x90, 0x9A, 0xFF, 0x6B, 0x40, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x9C, 0x9A, 0x04, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0x48, 0x10, 0x07, 0x2A, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x7C, 0x9A, 0xDF, 0x6A, 0x80, 0xA3, -+0x4B, 0x10, 0x01, 0x72, 0x19, 0x61, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x90, 0x9A, 0xFF, 0x6A, -+0x40, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF1, 0x9C, 0x9B, 0x10, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x60, 0xA4, 0x20, 0x6D, 0x4C, 0xEB, 0x4D, 0x10, -+0x02, 0x72, 0x0F, 0x61, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x70, 0x9A, 0xBF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x7C, 0x9A, 0xEF, 0x6A, 0x80, 0xA3, -+0x1F, 0x10, 0x03, 0x72, 0x66, 0x61, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x90, 0x9A, 0xFF, 0x6B, -+0x40, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x9C, 0x9A, 0x10, 0x6D, 0x40, 0xA4, -+0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x20, 0xE8, 0x09, 0x2A, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x7C, 0x9A, 0x80, 0xA3, 0x7F, 0x6A, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x01, 0x72, -+0x1C, 0x61, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x90, 0x9A, 0xFF, 0x6A, 0x40, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF1, 0x9C, 0x9B, -+0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, -+0x60, 0xC4, 0x60, 0xA4, 0x80, 0x4D, 0xC0, 0x4D, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x20, 0xE8, 0x02, 0x72, 0x10, 0x61, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x50, 0x9A, 0xBF, 0x6B, -+0x80, 0xA2, 0x6C, 0xEC, 0x80, 0xC2, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x5C, 0x9A, 0x80, 0xA2, -+0x8C, 0xEB, 0x60, 0xC2, 0x20, 0xE8, 0x03, 0x72, -+0x14, 0x61, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x90, 0x9A, 0xFF, 0x6B, 0x40, 0x6D, 0x40, 0xA4, -+0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x9C, 0x9A, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x20, 0xE8, 0xFF, 0x63, 0x01, 0xD0, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF1, 0x60, 0x9B, -+0xFF, 0x6A, 0x4C, 0xEC, 0x6D, 0xE5, 0x00, 0xA3, -+0x3F, 0x6F, 0x01, 0x74, 0x0C, 0xEF, 0x4C, 0xEE, -+0xE0, 0xC3, 0x10, 0x61, 0x10, 0xF0, 0x23, 0x6C, -+0xAE, 0xF1, 0xE4, 0x9C, 0x10, 0x68, 0xFD, 0xE5, -+0x80, 0xA7, 0x4C, 0xEC, 0x0D, 0xEC, 0x4C, 0xEC, -+0x80, 0xC7, 0x80, 0xA3, 0x80, 0x6F, 0xEB, 0xEF, -+0x4C, 0xEC, 0x0D, 0x10, 0x0F, 0x2C, 0x10, 0xF0, -+0x23, 0x6C, 0xAE, 0xF1, 0xE4, 0x9C, 0xEF, 0x6C, -+0xFD, 0xE5, 0x00, 0xA7, 0x0C, 0xEC, 0x80, 0xC7, -+0x80, 0xA3, 0x40, 0x6F, 0x4C, 0xEC, 0xED, 0xEC, -+0x4C, 0xEC, 0x80, 0xC3, 0x10, 0xF0, 0x23, 0x6A, -+0xAE, 0xF1, 0x48, 0x9A, 0x80, 0xF4, 0xC0, 0x36, -+0x55, 0xE5, 0x40, 0x9D, 0x4D, 0xEE, 0xC0, 0xDD, -+0x01, 0x90, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x10, 0xF0, 0x23, 0x6B, 0xFF, 0x6A, 0xAE, 0xF1, -+0x6C, 0x9B, 0x4C, 0xED, 0x4C, 0xEF, 0x04, 0xD5, -+0x05, 0xD7, 0x60, 0xA3, 0xFF, 0xF7, 0x1F, 0x68, -+0x26, 0x67, 0x4C, 0xEB, 0x72, 0x33, 0x4C, 0xEB, -+0x8C, 0xE8, 0x4C, 0xE9, 0x30, 0x23, 0x10, 0xF0, -+0x23, 0x6B, 0xAE, 0xF1, 0x70, 0x9B, 0x00, 0x6C, -+0xFF, 0x6D, 0x60, 0xA3, 0x26, 0x6E, 0x6C, 0xEA, -+0x06, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF2, 0x40, 0x9A, 0x40, 0xEA, 0x01, 0x72, -+0x11, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x5C, 0x9A, 0x90, 0x67, 0x01, 0x6D, 0xD1, 0x67, -+0x00, 0x6F, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x2E, 0xF4, 0x6C, 0x9B, 0x04, 0x94, 0x05, 0x96, -+0xA2, 0x67, 0x40, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0x06, 0x95, 0x00, 0x6C, -+0x27, 0x6E, 0x40, 0xEA, 0x11, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x5C, 0x9A, 0x90, 0x67, -+0x01, 0x6D, 0xD1, 0x67, 0x00, 0x6F, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x6C, 0x9B, -+0x04, 0x94, 0x05, 0x96, 0xA2, 0x67, 0x40, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF2, 0x5C, 0x9A, -+0x40, 0xEA, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x23, 0x6A, -+0xAE, 0xF1, 0x54, 0x9A, 0xFF, 0x6B, 0x80, 0xA2, -+0x00, 0xF6, 0x80, 0x34, 0x00, 0xF6, 0x83, 0x34, -+0x00, 0x54, 0x24, 0x60, 0xA0, 0xA2, 0x7F, 0x6C, -+0xAC, 0xEC, 0x80, 0xC2, 0x80, 0xA2, 0x40, 0x6D, -+0x6C, 0xEC, 0xAD, 0xEC, 0x6C, 0xEC, 0x80, 0xC2, -+0x80, 0xA2, 0x10, 0xF0, 0x23, 0x6C, 0xAE, 0xF1, -+0x98, 0x9C, 0x3F, 0x6D, 0x80, 0xA4, 0x10, 0xF0, -+0x23, 0x6C, 0xAE, 0xF1, 0x9C, 0x9C, 0x80, 0xA4, -+0x10, 0xF0, 0x23, 0x6C, 0xCE, 0xF1, 0x80, 0x9C, -+0x80, 0xA4, 0x80, 0xA2, 0x6C, 0xEC, 0xAD, 0xEC, -+0x6C, 0xEC, 0x80, 0xC2, 0x80, 0xA2, 0xBF, 0x6B, -+0x8C, 0xEB, 0x60, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF1, 0x64, 0x9B, -+0xFF, 0x6A, 0x4C, 0xEC, 0xC0, 0xA3, 0x4C, 0xED, -+0x0C, 0x26, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, -+0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, 0xCE, 0xF1, -+0x8C, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x20, 0xE8, 0x80, 0xC3, 0x0B, 0x25, 0x10, 0xF0, -+0x23, 0x6B, 0xCE, 0xF1, 0x90, 0x9B, 0x80, 0x6D, -+0xAB, 0xED, 0x60, 0xA4, 0x4C, 0xEB, 0xAE, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x20, 0xE8, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0xF7, 0x1F, 0x6A, 0x0E, 0x90, 0x24, 0x67, -+0x4C, 0xE9, 0x03, 0x6B, 0x4C, 0xEF, 0x2C, 0xEB, -+0x00, 0x6A, 0x0B, 0xD5, 0x0C, 0xD6, 0x04, 0xD7, -+0x40, 0xC8, 0x00, 0x6A, 0x0A, 0x23, 0x28, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x40, 0xA8, 0x01, 0x4A, -+0x40, 0xC8, 0x1F, 0xF7, 0x00, 0x6A, 0x2C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x48, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x4C, 0x9A, 0x49, 0xE1, 0x0B, 0x93, 0x40, 0x9A, -+0x6C, 0xEA, 0x0C, 0x93, 0x6E, 0xEA, 0x04, 0x22, -+0x40, 0xA8, 0x04, 0x93, 0x63, 0xEA, 0xDC, 0x61, -+0x40, 0xA8, 0x04, 0x93, 0x63, 0xEA, 0x58, 0x67, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6B, -+0xCE, 0xF1, 0x74, 0x9B, 0xFF, 0x6A, 0xCC, 0xEA, -+0x6D, 0xEA, 0xE0, 0xF1, 0x1F, 0x6B, 0xAC, 0xEB, -+0x10, 0xF0, 0x23, 0x6C, 0xCE, 0xF1, 0x98, 0x9C, -+0x60, 0x33, 0x60, 0x33, 0x6D, 0xEA, 0x40, 0xDC, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, 0x5C, 0x9A, -+0x6D, 0xEA, 0x40, 0xDC, 0x20, 0xE8, 0x00, 0x65, -+0xE0, 0xF1, 0x1F, 0x6A, 0x10, 0xF0, 0x23, 0x6B, -+0xCE, 0xF1, 0x7C, 0x9B, 0xAC, 0xEA, 0x40, 0x32, -+0x40, 0x32, 0x6D, 0xEA, 0x10, 0xF0, 0x23, 0x6B, -+0xCE, 0xF1, 0x78, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6A, 0xEE, 0xF1, 0x40, 0x9A, 0xFF, 0x6B, -+0x40, 0xA2, 0x6C, 0xEA, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x01, 0x68, 0x04, 0xEC, 0x04, 0xF7, 0x10, 0x69, -+0x13, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x01, 0x6C, 0xFF, 0x49, 0x40, 0xEA, -+0x0B, 0x29, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, -+0x68, 0x9A, 0x08, 0xF0, 0x00, 0x6C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, 0x0B, 0x10, -+0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF1, 0x44, 0x9A, -+0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x6A, 0x6C, 0xEA, -+0x0C, 0xEA, 0xE3, 0x2A, 0x01, 0x6A, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x0E, 0x92, 0x04, 0x67, 0x0F, 0x91, 0x04, 0xD2, -+0x04, 0x93, 0xFF, 0x6A, 0x4C, 0xE8, 0x4C, 0xEB, -+0x90, 0x67, 0x0B, 0xD5, 0x0C, 0xD6, 0x0D, 0xD7, -+0x04, 0xD3, 0x4C, 0xE9, 0x00, 0x18, 0xC2, 0xC9, -+0x80, 0xF0, 0x07, 0x22, 0x06, 0x58, 0x80, 0xF0, -+0x04, 0x60, 0x10, 0xF0, 0x23, 0x6A, 0x08, 0x30, -+0x0E, 0xF0, 0x08, 0x4A, 0x09, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x02, 0xF2, 0x10, 0x6A, 0x0E, 0x10, -+0x02, 0xF2, 0x00, 0x6A, 0x0B, 0x10, 0x22, 0xF2, -+0x00, 0x6A, 0x08, 0x10, 0x22, 0xF2, 0x10, 0x6A, -+0x05, 0x10, 0x42, 0xF2, 0x00, 0x6A, 0x02, 0x10, -+0x42, 0xF2, 0x10, 0x6A, 0x10, 0xF0, 0x23, 0x6B, -+0x0D, 0x94, 0xEE, 0xF1, 0x68, 0x9B, 0x8C, 0xEB, -+0x10, 0xF0, 0x23, 0x6C, 0xEE, 0xF1, 0x8C, 0x9C, -+0x8D, 0xEB, 0x06, 0x21, 0x10, 0xF0, 0x23, 0x6C, -+0xEE, 0xF1, 0x90, 0x9C, 0x6D, 0xEC, 0x05, 0x10, -+0x10, 0xF0, 0x23, 0x6C, 0xEE, 0xF1, 0x94, 0x9C, -+0x6C, 0xEC, 0x04, 0x96, 0x06, 0x26, 0x10, 0xF0, -+0x23, 0x6B, 0xCE, 0xF1, 0x7C, 0x9B, 0x8D, 0xEB, -+0x05, 0x10, 0x10, 0xF0, 0x23, 0x6B, 0xEE, 0xF1, -+0x78, 0x9B, 0x8C, 0xEB, 0x1F, 0xF7, 0x00, 0x6C, -+0x4C, 0xEC, 0x02, 0xF0, 0x00, 0x74, 0x01, 0x60, -+0x05, 0x2C, 0x10, 0xF0, 0x23, 0x6C, 0x8E, 0xF1, -+0xA8, 0x9C, 0x04, 0x10, 0x10, 0xF0, 0x23, 0x6C, -+0x8E, 0xF1, 0xAC, 0x9C, 0x10, 0xF0, 0x23, 0x6C, -+0x0B, 0x96, 0xEE, 0xF1, 0x9C, 0x9C, 0xB5, 0xE2, -+0xCC, 0xEC, 0x80, 0xDD, 0x84, 0x42, 0x1F, 0xF7, -+0x00, 0x6D, 0xAC, 0xEC, 0x02, 0xF0, 0x00, 0x74, -+0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, 0x23, 0x6C, -+0x0E, 0xF2, 0xA0, 0x9C, 0x04, 0x10, 0x10, 0xF0, -+0x23, 0x6C, 0x0E, 0xF2, 0xA4, 0x9C, 0x10, 0xF0, -+0x23, 0x6C, 0x0C, 0x96, 0xEE, 0xF1, 0x9C, 0x9C, -+0xB5, 0xE2, 0xCC, 0xEC, 0x80, 0xDD, 0x87, 0x42, -+0x01, 0x4C, 0x1F, 0xF7, 0x00, 0x6D, 0xAC, 0xEC, -+0x02, 0xF0, 0x00, 0x74, 0x01, 0x60, 0x05, 0x2C, -+0x10, 0xF0, 0x23, 0x6C, 0x0E, 0xF2, 0x88, 0x9C, -+0x04, 0x10, 0x10, 0xF0, 0x23, 0x6C, 0x0E, 0xF2, -+0x8C, 0x9C, 0x89, 0xE2, 0x60, 0xDA, 0x01, 0x6A, -+0x01, 0x10, 0x00, 0x6A, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x04, 0xF7, -+0x10, 0x68, 0x13, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x05, 0x6C, 0xFF, 0x48, -+0x40, 0xEA, 0x0B, 0x28, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x68, 0x9A, 0x08, 0xF0, 0x00, 0x6C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, -+0x09, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF1, -+0x44, 0x9A, 0x60, 0xAA, 0x3F, 0x6A, 0x6C, 0xEA, -+0xE5, 0x2A, 0x01, 0x6A, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x23, 0x6A, -+0xEE, 0xF1, 0x44, 0x9A, 0x40, 0xAA, 0x20, 0xE8, -+0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF1, 0x44, 0x9A, -+0x40, 0xAA, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x6A, 0x10, 0xF0, 0x23, 0x6C, 0x4E, 0xF1, -+0x98, 0x9C, 0x10, 0xF0, 0x23, 0x6B, 0x05, 0xF1, -+0x0D, 0x4B, 0x0A, 0x72, 0x60, 0xDC, 0x0C, 0x61, -+0x30, 0xF0, 0x21, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF7, 0x54, 0x9A, 0x11, 0xF1, 0x94, 0x9B, -+0x01, 0x6D, 0xAB, 0xED, 0x40, 0xEA, 0x00, 0x6A, -+0x10, 0xF0, 0x23, 0x6C, 0xFF, 0x6B, 0x01, 0x4A, -+0x4E, 0xF1, 0x98, 0x9C, 0x6C, 0xEA, 0x10, 0xF0, -+0x23, 0x6B, 0x05, 0xF1, 0x0E, 0x4B, 0x60, 0xDC, -+0xDC, 0x17, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x00, 0x68, 0x01, 0x6A, 0x10, 0xF0, -+0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, 0x4E, 0xE8, -+0x10, 0xF0, 0x23, 0x6A, 0x45, 0xF1, 0x1D, 0x4A, -+0x09, 0xE2, 0x40, 0xDB, 0x00, 0x1C, 0x96, 0x45, -+0x00, 0x18, 0x5D, 0xC9, 0x00, 0x1C, 0x95, 0x45, -+0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, -+0x10, 0xF0, 0x00, 0x6B, 0x8C, 0xEB, 0x08, 0x23, -+0x10, 0xF0, 0x01, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x00, 0x18, 0x41, 0xD4, -+0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x8C, 0x9A, 0x02, 0x6B, 0x8C, 0xEB, -+0x09, 0x23, 0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x00, 0x18, 0xE0, 0xCE, -+0x00, 0x18, 0x42, 0xCF, 0x00, 0x1C, 0x95, 0x45, -+0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, -+0x04, 0x6B, 0x8C, 0xEB, 0x09, 0x23, 0x05, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x00, 0x18, 0x74, 0xCC, 0x00, 0x18, 0xE5, 0xCB, -+0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x8C, 0x9A, 0x02, 0xF0, 0x00, 0x6B, -+0x8C, 0xEB, 0x08, 0x23, 0x02, 0xF0, 0x01, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x00, 0x18, 0xFF, 0xD5, 0x00, 0x1C, 0x95, 0x45, -+0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, 0x23, 0x6B, -+0x0E, 0xF2, 0x78, 0x9B, 0x80, 0xF0, 0x8C, 0x9A, -+0x8C, 0xEB, 0x09, 0x23, 0x10, 0xF0, 0x23, 0x6B, -+0x0E, 0xF2, 0x7C, 0x9B, 0x8C, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x00, 0x18, 0xC6, 0xCD, 0x00, 0x1C, -+0x95, 0x45, 0x30, 0xF0, 0x21, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0x11, 0xF1, 0x94, 0x9B, 0xEE, 0xF7, -+0x58, 0x9A, 0x40, 0xEA, 0x73, 0x17, 0x00, 0x65, -+0x10, 0xF0, 0x23, 0x6A, 0x2E, 0xF2, 0x60, 0x9A, -+0xDF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6B, -+0x2E, 0xF2, 0xA0, 0x9B, 0xFF, 0x6A, 0x20, 0x6E, -+0x60, 0xA5, 0x4C, 0xEC, 0x4C, 0xEB, 0xCD, 0xEB, -+0x4C, 0xEB, 0x07, 0xF7, 0x01, 0x4A, 0x4D, 0xEC, -+0x10, 0xF0, 0x23, 0x6A, 0x2E, 0xF2, 0x44, 0x9A, -+0x60, 0xC5, 0x80, 0xCA, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x23, 0x6A, 0x2E, 0xF2, 0x44, 0x9A, -+0x68, 0xF0, 0x04, 0x6B, 0x60, 0xCA, 0x20, 0xE8, -+0x03, 0x6F, 0x8C, 0xEF, 0x64, 0x67, 0x46, 0x67, -+0x04, 0x27, 0x07, 0x10, 0xA0, 0xDB, 0xFC, 0x4A, -+0x04, 0x4B, 0x04, 0x5A, 0xFB, 0x60, 0x03, 0x6A, -+0x4C, 0xEE, 0x04, 0x26, 0xA0, 0xC4, 0xFF, 0x4E, -+0x01, 0x4C, 0xFB, 0x17, 0x00, 0x6A, 0x20, 0xE8, -+0xFF, 0x6A, 0xAC, 0xEA, 0x03, 0x10, 0x40, 0xC4, -+0xFF, 0x4E, 0x01, 0x4C, 0xFC, 0x2E, 0x00, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0x00, 0x6A, 0x07, 0x26, -+0x5D, 0xE5, 0xE0, 0xA7, 0x4D, 0xE4, 0xFF, 0x4E, -+0xE0, 0xC3, 0x01, 0x4A, 0xF8, 0x17, 0x00, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0x09, 0x10, 0x60, 0xA4, -+0x40, 0xA5, 0xFF, 0x4E, 0x4A, 0xEB, 0x02, 0x60, -+0x4B, 0xE3, 0x20, 0xE8, 0x01, 0x4C, 0x01, 0x4D, -+0xF6, 0x2E, 0x00, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0x06, 0x2C, 0x64, 0x6B, 0x30, 0xF0, 0x21, 0x6A, -+0xF1, 0xF0, 0x60, 0xDA, 0x04, 0x10, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x80, 0xDA, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x40, 0x9A, 0x28, 0x72, -+0x2D, 0x60, 0x29, 0x5A, 0x07, 0x60, 0x14, 0x72, -+0x19, 0x60, 0x19, 0x72, 0x1F, 0x60, 0x0A, 0x72, -+0x0D, 0x60, 0x20, 0xE8, 0x50, 0x72, 0x32, 0x60, -+0x51, 0x5A, 0x03, 0x60, 0x32, 0x72, 0x26, 0x60, -+0x20, 0xE8, 0x64, 0x72, 0x33, 0x60, 0xC8, 0x72, -+0x39, 0x60, 0x20, 0xE8, 0x02, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x64, 0xDA, 0xE0, 0xF7, -+0x1E, 0x4B, 0x39, 0x10, 0x03, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x64, 0xDA, 0xE1, 0xF3, -+0x1D, 0x4B, 0x31, 0x10, 0x09, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x64, 0xDA, 0xE4, 0xF3, -+0x17, 0x4B, 0x29, 0x10, 0x05, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x64, 0xDA, 0xE2, 0xF3, -+0x1B, 0x4B, 0x21, 0x10, 0x11, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x64, 0xDA, 0xE8, 0xF3, -+0x0F, 0x4B, 0x19, 0x10, 0x0A, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x64, 0xDA, 0xE4, 0xF7, -+0x16, 0x4B, 0x11, 0x10, 0x22, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x64, 0xDA, 0x11, 0xF0, -+0x00, 0x6B, 0x09, 0x10, 0x43, 0x6B, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x64, 0xDA, 0x10, 0xF0, -+0x23, 0x6A, 0x4E, 0xF2, 0x78, 0x9A, 0x30, 0xF0, -+0x21, 0x6A, 0xF1, 0xF0, 0x68, 0xDA, 0x20, 0xE8, -+0x30, 0xF0, 0x21, 0x6A, 0xF1, 0xF0, 0x40, 0x9A, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x63, 0x0C, 0x24, -+0x30, 0xF0, 0x21, 0x6A, 0xF1, 0xF0, 0x48, 0x9A, -+0x58, 0xEC, 0x12, 0xEC, 0x00, 0xD4, 0x00, 0x92, -+0xFF, 0x4A, 0x00, 0xD2, 0x00, 0x92, 0xFB, 0x2A, -+0x01, 0x63, 0x20, 0xE8, 0xFF, 0x63, 0x0D, 0x24, -+0x30, 0xF0, 0x21, 0x6A, 0xF1, 0xF0, 0x44, 0x9A, -+0x58, 0xEC, 0x12, 0xEC, 0x00, 0xD4, 0x00, 0x92, -+0x04, 0x22, 0x00, 0x92, 0xFF, 0x4A, 0x00, 0xD2, -+0xFA, 0x17, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xC9, 0xCA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xED, -+0x00, 0x18, 0xBE, 0xCA, 0x05, 0x97, 0x00, 0x6A, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x04, 0x67, 0x4C, 0xEE, -+0x00, 0x18, 0xC3, 0xCA, 0x50, 0x67, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x00, 0x68, -+0x17, 0x10, 0xE0, 0xF3, 0x08, 0x70, 0x0A, 0x61, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, 0x68, 0x9A, -+0x80, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x00, 0x6A, 0x13, 0x10, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x48, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF2, 0x50, 0x9A, -+0x60, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, 0xE1, 0x2A, -+0x01, 0x6A, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0xF7, 0x1F, 0x6A, -+0x8C, 0xEA, 0x10, 0xF0, 0x23, 0x6B, 0x10, 0xF0, -+0x23, 0x6C, 0xCE, 0xF2, 0x74, 0x9B, 0xCE, 0xF2, -+0x98, 0x9C, 0x6D, 0xE5, 0x91, 0xE5, 0x00, 0x6E, -+0xC0, 0xDB, 0x04, 0x4B, 0x8A, 0xEB, 0xFB, 0x61, -+0xE7, 0xF7, 0x1F, 0x6B, 0x4C, 0xEB, 0x10, 0xF0, -+0x23, 0x6A, 0xEE, 0xF1, 0x4C, 0x9A, 0x10, 0x6C, -+0x4D, 0xEB, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF2, -+0x54, 0x9A, 0x49, 0xE5, 0x60, 0xDA, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF2, 0x5C, 0x9A, 0xFF, 0x6B, -+0x55, 0xE5, 0x40, 0xA5, 0x6C, 0xEA, 0x8D, 0xEA, -+0x6C, 0xEA, 0x40, 0xC5, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x21, 0x6A, 0x11, 0xF1, 0x61, 0xA2, -+0x08, 0xD4, 0x30, 0xF0, 0x20, 0x69, 0x61, 0xC5, -+0x01, 0x4B, 0x11, 0xF1, 0x61, 0xC2, 0x10, 0xF0, -+0x23, 0x6B, 0xCE, 0xF2, 0x94, 0x9B, 0x08, 0x93, -+0x4E, 0xF2, 0x50, 0x99, 0x02, 0x6E, 0x91, 0xE3, -+0x05, 0x67, 0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6B, -+0xEE, 0xF2, 0x80, 0x9B, 0x08, 0x93, 0xCE, 0xA0, -+0x4E, 0xF2, 0x50, 0x99, 0xA2, 0x40, 0x91, 0xE3, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x24, 0x67, 0x00, 0x18, -+0x2A, 0xCB, 0x00, 0x6B, 0x36, 0x22, 0x10, 0xF0, -+0x23, 0x6A, 0xEE, 0xF2, 0x44, 0x9A, 0xFF, 0xF7, -+0x1F, 0x6E, 0xFF, 0x6F, 0x00, 0x9A, 0x10, 0xF0, -+0x23, 0x6A, 0xEE, 0xF1, 0x48, 0x9A, 0x10, 0x6C, -+0x8B, 0xEC, 0x4C, 0xE8, 0x10, 0xF0, 0x23, 0x6A, -+0xA1, 0x40, 0xEE, 0xF2, 0x48, 0x9A, 0x65, 0x67, -+0xCC, 0xEB, 0x60, 0xCA, 0x10, 0xF0, 0x23, 0x6A, -+0xEE, 0xF2, 0x4C, 0x9A, 0x60, 0xA2, 0xFA, 0x65, -+0xA2, 0x32, 0xEC, 0xEB, 0x8C, 0xEB, 0x42, 0x32, -+0x6D, 0xEA, 0xEC, 0xEA, 0x7F, 0x67, 0x40, 0xC3, -+0x87, 0xA9, 0x02, 0x4C, 0xCC, 0xEC, 0x00, 0x18, -+0x3F, 0xCB, 0x87, 0x40, 0x12, 0x4C, 0xB1, 0x67, -+0x00, 0x18, 0x56, 0xCB, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF2, 0x50, 0x9A, 0x01, 0x6B, 0x60, 0xC2, -+0x01, 0x6B, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x43, 0x67, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x6C, 0x9A, 0xA4, 0x67, 0x04, 0x6C, 0x8D, 0xEB, -+0x30, 0xF0, 0x20, 0x68, 0x80, 0xF0, 0x6C, 0xDA, -+0xAF, 0xF4, 0x18, 0x48, 0xA0, 0xF0, 0x40, 0xA8, -+0x01, 0xF1, 0x00, 0x72, 0x07, 0x60, 0xA0, 0xF0, -+0x40, 0xA0, 0xA0, 0xF0, 0x81, 0xA0, 0xFF, 0x4A, -+0x8E, 0xEA, 0x0A, 0x2A, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x68, 0x9A, 0x00, 0xF2, 0x00, 0x6C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x11, 0x10, -+0x90, 0x34, 0x91, 0xE0, 0x10, 0x6E, 0x00, 0x18, -+0xC3, 0xCA, 0xA0, 0xF0, 0x41, 0xA0, 0x0A, 0x6B, -+0x01, 0x4A, 0xA0, 0xF0, 0x41, 0xC0, 0xA0, 0xF0, -+0x41, 0xA0, 0x6E, 0xEA, 0x02, 0x2A, 0xA0, 0xF0, -+0x41, 0xC0, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x21, 0x6B, 0x11, 0xF1, -+0x40, 0xA3, 0xFF, 0x6F, 0xE0, 0xF0, 0xC7, 0xA5, -+0x41, 0xC5, 0x43, 0xA5, 0x11, 0xF1, 0x60, 0xA3, -+0x03, 0x4A, 0xEC, 0xEA, 0x09, 0x10, 0xED, 0x42, -+0xFF, 0x68, 0x0C, 0xEF, 0xFD, 0xE5, 0x64, 0xC7, -+0xE6, 0xA7, 0x03, 0x4F, 0xE9, 0xE2, 0x0C, 0xEA, -+0xEF, 0x46, 0xE2, 0xEA, 0xF4, 0x61, 0x30, 0xF0, -+0x21, 0x6A, 0x11, 0xF1, 0x60, 0xA2, 0x01, 0x4B, -+0x11, 0xF1, 0x60, 0xC2, 0x10, 0xF0, 0x23, 0x6B, -+0xCE, 0xF2, 0x74, 0x9B, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x71, 0xE4, 0x40, 0xEA, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x24, 0x67, 0x00, 0x18, 0x2A, 0xCB, 0x00, 0x6B, -+0x2E, 0x22, 0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF2, -+0x44, 0x9A, 0x0F, 0x6C, 0xFF, 0xF7, 0x1F, 0x6B, -+0x00, 0x9A, 0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF1, -+0x48, 0x9A, 0x4C, 0xE8, 0xA1, 0x40, 0xA2, 0x32, -+0x42, 0x32, 0x8C, 0xEA, 0x10, 0xF0, 0x23, 0x6C, -+0xEE, 0xF2, 0x88, 0x9C, 0xC5, 0x67, 0x6C, 0xEE, -+0xC0, 0xCC, 0x10, 0xF0, 0x23, 0x6C, 0xEE, 0xF2, -+0x8C, 0x9C, 0x40, 0xC4, 0xE0, 0xF0, 0x87, 0xA1, -+0x6C, 0xEC, 0x00, 0x18, 0x3F, 0xCB, 0x87, 0x40, -+0x12, 0x4C, 0xB1, 0x67, 0x00, 0x18, 0xAD, 0xCB, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF2, 0x50, 0x9A, -+0x01, 0x6B, 0x60, 0xC2, 0x01, 0x6B, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x43, 0x67, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF1, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x85, 0xF7, -+0x15, 0x4A, 0x10, 0xF0, 0x30, 0x68, 0x40, 0xDB, -+0x00, 0xF0, 0x00, 0x48, 0xC1, 0xF6, 0x62, 0xA0, -+0xC1, 0xF6, 0x43, 0xA0, 0x6E, 0xEA, 0x39, 0x22, -+0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF2, 0x50, 0x9A, -+0x10, 0xF0, 0x23, 0x6C, 0x4E, 0xF2, 0x94, 0x9C, -+0x40, 0x9A, 0x8C, 0xEA, 0x2E, 0x2A, 0xE8, 0x6A, -+0x58, 0xEB, 0x87, 0x40, 0x3B, 0x4C, 0x12, 0xEB, -+0x71, 0xE4, 0x00, 0x18, 0xC6, 0xCB, 0x16, 0x22, -+0xC1, 0xF6, 0x42, 0xA0, 0x10, 0x6B, 0x01, 0x4A, -+0xC1, 0xF6, 0x42, 0xC0, 0xC1, 0xF6, 0x42, 0xA0, -+0x6E, 0xEA, 0x02, 0x2A, 0xC1, 0xF6, 0x42, 0xC0, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF6, 0x82, 0xA2, 0xC1, 0xF6, 0x63, 0xA2, -+0x8E, 0xEB, 0x0B, 0x23, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x04, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x04, 0x10, 0xC1, 0xF6, 0x84, 0xC2, 0xC1, 0xF6, -+0x65, 0xC2, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x30, 0x68, -+0x00, 0xF0, 0x00, 0x48, 0xC1, 0xF6, 0x42, 0xA8, -+0xA4, 0x67, 0x01, 0xF7, 0x00, 0x72, 0x07, 0x60, -+0xC1, 0xF6, 0x42, 0xA0, 0xC1, 0xF6, 0x83, 0xA0, -+0xFF, 0x4A, 0x8E, 0xEA, 0x09, 0x2A, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF1, 0x68, 0x9A, 0xFF, 0x6A, -+0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, 0xA7, 0x10, -+0x23, 0xA5, 0xC1, 0xF6, 0x45, 0xA0, 0xFF, 0x6B, -+0x04, 0x49, 0x6C, 0xE9, 0x1F, 0x2A, 0xE8, 0x6A, -+0x58, 0xEC, 0x30, 0xF0, 0x20, 0x6A, 0x67, 0x40, -+0x4E, 0xF2, 0x50, 0x9A, 0x3B, 0x4B, 0xD1, 0x67, -+0x12, 0xEC, 0x91, 0xE3, 0x40, 0xEA, 0xC1, 0xF6, -+0x43, 0xA0, 0xC1, 0xF6, 0x62, 0xA0, 0xC1, 0xF6, -+0x25, 0xC0, 0x4E, 0xEB, 0x74, 0x2B, 0x01, 0x4A, -+0xC1, 0xF6, 0x43, 0xC0, 0xC1, 0xF6, 0x43, 0xA0, -+0x10, 0x6B, 0x6E, 0xEA, 0x6C, 0x2A, 0xC1, 0xF6, -+0x43, 0xC0, 0x69, 0x10, 0x82, 0xA5, 0x37, 0x2C, -+0x51, 0xE1, 0xE3, 0x54, 0x34, 0x60, 0xC1, 0xF6, -+0x84, 0xA0, 0xE8, 0x6E, 0xD8, 0xEC, 0x12, 0xEC, -+0x11, 0xE4, 0x40, 0xF0, 0xC4, 0xA4, 0x2B, 0x2E, -+0x40, 0xF0, 0xC5, 0xA4, 0xFC, 0x4A, 0x6C, 0xEA, -+0xFF, 0x4E, 0x40, 0xF0, 0xC5, 0xC4, 0xC1, 0xF6, -+0x85, 0xA0, 0xE8, 0x6E, 0xFF, 0x4C, 0xC1, 0xF6, -+0x85, 0xC0, 0xC1, 0xF6, 0x84, 0xA0, 0xD8, 0xEC, -+0xD1, 0x67, 0x12, 0xEC, 0x91, 0xE0, 0x51, 0xE4, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x45, 0x4C, 0x40, 0xEA, 0xC1, 0xF6, 0x44, 0xA0, -+0xE8, 0x6B, 0x78, 0xEA, 0x12, 0xEA, 0x09, 0xE2, -+0x40, 0xF0, 0x65, 0xA2, 0x6D, 0xE1, 0x40, 0xF0, -+0x65, 0xC2, 0xC1, 0xF6, 0x45, 0xA0, 0x45, 0xE1, -+0xC1, 0xF6, 0x25, 0xC0, 0x30, 0x10, 0x10, 0xF0, -+0x30, 0x68, 0x00, 0xF0, 0x00, 0x48, 0xC1, 0xF6, -+0x63, 0xA0, 0xE8, 0x6A, 0x87, 0x40, 0x58, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x3B, 0x4C, 0xD1, 0x67, 0x12, 0xEB, 0x71, 0xE4, -+0x40, 0xEA, 0xC1, 0xF6, 0x43, 0xA0, 0x10, 0x6B, -+0xC1, 0xF6, 0x25, 0xC0, 0x01, 0x4A, 0xC1, 0xF6, -+0x43, 0xC0, 0xC1, 0xF6, 0x43, 0xA0, 0x6E, 0xEA, -+0x02, 0x2A, 0xC1, 0xF6, 0x43, 0xC0, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF6, -+0x64, 0xA2, 0x10, 0x6C, 0x01, 0x4B, 0xC1, 0xF6, -+0x64, 0xC2, 0xC1, 0xF6, 0x64, 0xA2, 0x8E, 0xEB, -+0x02, 0x2B, 0xC1, 0xF6, 0x64, 0xC2, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF6, -+0x84, 0xA2, 0xE8, 0x6B, 0x78, 0xEC, 0x04, 0x6C, -+0x12, 0xEB, 0x4D, 0xE3, 0xC1, 0xF6, 0x45, 0xA2, -+0x20, 0xF1, 0x49, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0xC6, 0xF1, 0x11, 0x4A, 0x30, 0xF0, -+0x20, 0x68, 0x40, 0xDB, 0xAF, 0xF4, 0x18, 0x48, -+0xA0, 0xF0, 0x80, 0xA0, 0xA0, 0xF0, 0x41, 0xA0, -+0x8E, 0xEA, 0x3B, 0x22, 0x10, 0xF0, 0x23, 0x6A, -+0xEE, 0xF2, 0x50, 0x9A, 0x10, 0xF0, 0x23, 0x6B, -+0x4E, 0xF2, 0x74, 0x9B, 0x40, 0x9A, 0x6C, 0xEA, -+0x30, 0x2A, 0x90, 0x34, 0x91, 0xE0, 0x00, 0x18, -+0x6B, 0xCB, 0x0B, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x04, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x22, 0x10, 0xA0, 0xF0, 0x40, 0xA0, 0x01, 0x4A, -+0xA0, 0xF0, 0x40, 0xC0, 0xA0, 0xF0, 0x60, 0xA0, -+0xA0, 0xF0, 0x41, 0xA0, 0x6E, 0xEA, 0x0A, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x04, 0x6C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0xAF, 0xF4, 0x18, 0x4A, 0xA0, 0xF0, 0x60, 0xA2, -+0x0A, 0x6C, 0x8E, 0xEB, 0x02, 0x2B, 0xA0, 0xF0, -+0x60, 0xC2, 0x00, 0x18, 0xC1, 0xCC, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0x10, 0xF0, -+0x23, 0x6A, 0xEE, 0xF2, 0x74, 0x9A, 0x10, 0xF0, -+0x23, 0x6C, 0xCE, 0xF1, 0x1C, 0x9C, 0x40, 0x9B, -+0x00, 0xF4, 0x1D, 0x6C, 0x10, 0x6D, 0x0D, 0xEA, -+0x40, 0xDB, 0x06, 0x02, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF4, 0x54, 0x9A, 0x00, 0x6E, -+0x82, 0xF3, 0x08, 0x6F, 0x40, 0xEA, 0x07, 0x2A, -+0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF1, 0x88, 0x9B, -+0x60, 0x9C, 0x0D, 0xEB, 0x60, 0xDC, 0x09, 0x97, -+0x08, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x60, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC8, 0xF2, 0x7D, 0xC2, 0x61, 0xA4, -+0xC8, 0xF2, 0x7E, 0xC2, 0x62, 0xA4, 0xC8, 0xF2, -+0x7F, 0xC2, 0x63, 0xA4, 0xE8, 0xF2, 0x60, 0xC2, -+0x64, 0xA4, 0xE8, 0xF2, 0x61, 0xC2, 0x65, 0xA4, -+0xE8, 0xF2, 0x62, 0xC2, 0x66, 0xA4, 0xE8, 0xF2, -+0x63, 0xC2, 0x20, 0xE8, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x23, 0x6A, -+0xEE, 0xF2, 0x58, 0x9A, 0x60, 0xA2, 0x03, 0x6A, -+0x6C, 0xEA, 0x10, 0x6B, 0x64, 0xEA, 0xFF, 0x6A, -+0x4C, 0xEB, 0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF2, -+0x5C, 0x9A, 0x04, 0xD3, 0x40, 0x9A, 0x05, 0xD2, -+0x10, 0xF0, 0x23, 0x6A, 0x0E, 0xF3, 0x40, 0x9A, -+0x00, 0x9A, 0x05, 0x92, 0x0A, 0xEA, 0xA0, 0xF0, -+0x15, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, 0x02, 0x6C, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x10, 0xF0, -+0x30, 0x69, 0x00, 0xF0, 0x00, 0x49, 0xC1, 0xF7, -+0x46, 0xA9, 0x00, 0xF7, 0x00, 0x72, 0x07, 0x60, -+0xC1, 0xF7, 0x66, 0xA1, 0xC1, 0xF7, 0x87, 0xA1, -+0xAF, 0x43, 0x8E, 0xED, 0x0A, 0x2D, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF1, 0x68, 0x9A, 0xFF, 0x6C, -+0x01, 0x4C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x91, 0x10, 0x10, 0xF0, 0x23, 0x6D, 0x0E, 0xF3, -+0xA4, 0x9D, 0x7F, 0x6E, 0xB5, 0xE0, 0xE0, 0xA5, -+0xCC, 0xEF, 0x44, 0x2F, 0x00, 0xF4, 0x00, 0x72, -+0x80, 0xF0, 0x04, 0x60, 0xAC, 0x43, 0x8E, 0xED, -+0x80, 0xF0, 0x00, 0x25, 0x00, 0xF5, 0x01, 0x72, -+0x7D, 0x60, 0x00, 0xF6, 0x02, 0x72, 0x7A, 0x60, -+0x00, 0xF7, 0x03, 0x72, 0x77, 0x60, 0x00, 0xF5, -+0x00, 0x72, 0x74, 0x60, 0xFD, 0x4B, 0x6E, 0xEC, -+0x71, 0x24, 0x10, 0xF0, 0x30, 0x69, 0x00, 0xF0, -+0x00, 0x49, 0xC1, 0xF7, 0x46, 0xA9, 0x00, 0xF6, -+0x01, 0x72, 0x68, 0x60, 0x00, 0xF7, 0x02, 0x72, -+0x65, 0x60, 0x00, 0xF6, 0x00, 0x72, 0x62, 0x60, -+0xC1, 0xF7, 0x66, 0xA1, 0xC1, 0xF7, 0x87, 0xA1, -+0xFE, 0x4B, 0x8E, 0xEB, 0x5B, 0x23, 0x00, 0xF7, -+0x01, 0x72, 0x58, 0x60, 0x10, 0xF0, 0x23, 0x6A, -+0x0E, 0xF3, 0x48, 0x9A, 0x10, 0xF0, 0x23, 0x6D, -+0x76, 0x4C, 0x0E, 0xF3, 0xA4, 0x9D, 0x49, 0xE0, -+0x94, 0x34, 0x60, 0xAA, 0x91, 0xE1, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, 0x06, 0x4C, -+0xB5, 0xE0, 0x12, 0x10, 0x40, 0xA5, 0x4C, 0xEE, -+0x01, 0x76, 0x1E, 0x61, 0x10, 0xF0, 0x23, 0x6A, -+0x0E, 0xF3, 0x48, 0x9A, 0x76, 0x4C, 0x94, 0x34, -+0x49, 0xE0, 0x60, 0xAA, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x91, 0xE1, 0x06, 0x4C, -+0xFF, 0x6E, 0x6C, 0xEE, 0x40, 0xEA, 0xC1, 0xF7, -+0x47, 0xA1, 0x08, 0x6B, 0x01, 0x4A, 0xC1, 0xF7, -+0x47, 0xC1, 0xC1, 0xF7, 0x47, 0xA1, 0x6E, 0xEA, -+0x0E, 0x2A, 0xC1, 0xF7, 0x47, 0xC1, 0x0B, 0x10, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, 0x68, 0x9A, -+0x10, 0xF0, 0x23, 0x6C, 0x8E, 0xF1, 0x98, 0x9C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6A, 0x0E, 0xF3, 0x4C, 0x9A, 0x04, 0x93, -+0x40, 0x9A, 0x0E, 0xEA, 0x61, 0xE0, 0x05, 0x2A, -+0x10, 0xF0, 0x23, 0x6A, 0x0E, 0xF3, 0x50, 0x9A, -+0x00, 0x9A, 0x10, 0xF0, 0x23, 0x6A, 0x0E, 0xF3, -+0x40, 0x9A, 0x00, 0xDA, 0x05, 0x92, 0x4A, 0xE8, -+0x5F, 0xF7, 0x15, 0x61, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFE, 0x63, 0x03, 0xD1, 0x02, 0xD0, 0x10, 0xF0, -+0x23, 0x6A, 0x0E, 0xF3, 0x54, 0x9A, 0x0F, 0x6B, -+0x40, 0xA2, 0x4C, 0xEB, 0x0A, 0x23, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x8C, 0x9A, 0x02, 0x6D, 0xAD, 0xEC, 0x80, 0xF0, -+0x8C, 0xDA, 0x10, 0xF0, 0x30, 0x6A, 0x40, 0xF0, -+0x40, 0xA2, 0xFF, 0x4A, 0x00, 0xD2, 0xE2, 0x10, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0x40, 0xF0, 0x80, 0xAA, 0x00, 0xF7, 0x00, 0x74, -+0x05, 0x60, 0x40, 0xF0, 0x01, 0xA2, 0x00, 0x94, -+0x8A, 0xE8, 0x0A, 0x61, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x68, 0x9A, 0xFF, 0x6C, 0x01, 0x4C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0xCC, 0x10, -+0x30, 0xF0, 0x21, 0x6D, 0x11, 0xF1, 0x82, 0xA5, -+0xC3, 0x67, 0xC7, 0xEC, 0x86, 0x67, 0x01, 0x6E, -+0xCC, 0xEC, 0xA0, 0xF0, 0x08, 0x24, 0x0C, 0x35, -+0x04, 0x4D, 0xB5, 0xE2, 0x00, 0x6A, 0x30, 0xF0, -+0x21, 0x6E, 0x11, 0xF1, 0xE2, 0xA6, 0xFF, 0x6C, -+0x1F, 0xF7, 0x00, 0x69, 0x8C, 0xEF, 0x74, 0x4F, -+0xE8, 0x37, 0xFD, 0xE2, 0x2C, 0xEF, 0x02, 0xF0, -+0x00, 0x77, 0x08, 0x60, 0x11, 0xF1, 0xE2, 0xA6, -+0x8C, 0xEF, 0x74, 0x4F, 0xE8, 0x37, 0xFD, 0xE2, -+0x2C, 0xEF, 0x0F, 0x2F, 0x30, 0xF0, 0x21, 0x6C, -+0x11, 0xF1, 0x22, 0xA4, 0xFF, 0x6C, 0x10, 0xF0, -+0x23, 0x6E, 0x8C, 0xE9, 0x74, 0x49, 0x28, 0x31, -+0xE2, 0x67, 0x25, 0xE2, 0x8E, 0xF1, 0xC8, 0x9E, -+0x0B, 0x10, 0x11, 0xF1, 0x22, 0xA6, 0x10, 0xF0, -+0x23, 0x6E, 0x8E, 0xF1, 0xCC, 0x9E, 0x8C, 0xE9, -+0x74, 0x49, 0x28, 0x31, 0xE2, 0x67, 0x25, 0xE2, -+0xD9, 0xE1, 0xC0, 0xA6, 0x0C, 0x31, 0xFD, 0xE1, -+0xCC, 0xEC, 0x10, 0xF0, 0x30, 0x6E, 0x00, 0xF0, -+0x00, 0x4E, 0xD9, 0xE7, 0x80, 0xC6, 0x30, 0xF0, -+0x21, 0x6E, 0x11, 0xF1, 0xE2, 0xA6, 0xFF, 0x6C, -+0x1F, 0xF7, 0x00, 0x69, 0x8C, 0xEF, 0x7C, 0x4F, -+0xE8, 0x37, 0xFD, 0xE2, 0x2C, 0xEF, 0x02, 0xF0, -+0x00, 0x77, 0x08, 0x60, 0x11, 0xF1, 0xE2, 0xA6, -+0x8C, 0xEF, 0x7C, 0x4F, 0xE8, 0x37, 0xFD, 0xE2, -+0x2C, 0xEF, 0x0E, 0x2F, 0x30, 0xF0, 0x21, 0x6C, -+0x11, 0xF1, 0xC2, 0xA4, 0xFF, 0x6C, 0x10, 0xF0, -+0x23, 0x6F, 0x8C, 0xEE, 0x7C, 0x4E, 0xC8, 0x36, -+0xD9, 0xE2, 0x8E, 0xF1, 0xE8, 0x9F, 0x0A, 0x10, -+0x11, 0xF1, 0xC2, 0xA6, 0x10, 0xF0, 0x23, 0x6F, -+0x8E, 0xF1, 0xEC, 0x9F, 0x8C, 0xEE, 0x7C, 0x4E, -+0xC8, 0x36, 0xD9, 0xE2, 0xF9, 0xE6, 0xC0, 0xA6, -+0x01, 0x4A, 0x04, 0x72, 0xCC, 0xEC, 0x80, 0xC5, -+0x01, 0x4D, 0x8D, 0x61, 0x30, 0xF0, 0x21, 0x6A, -+0x11, 0xF1, 0xA2, 0xA2, 0x01, 0x6C, 0xC4, 0x67, -+0xC4, 0xED, 0xCF, 0xED, 0x11, 0xF1, 0xC2, 0xA2, -+0xAC, 0xEB, 0xFF, 0x6D, 0x84, 0xEE, 0x10, 0xF0, -+0x23, 0x6E, 0x0E, 0xF3, 0xD4, 0x9E, 0xAC, 0xEC, -+0x80, 0xC6, 0x11, 0xF1, 0x82, 0xA2, 0xAC, 0xEC, -+0x01, 0x4C, 0xAC, 0xEC, 0x11, 0xF1, 0x82, 0xC2, -+0x11, 0xF1, 0xA2, 0xA2, 0x03, 0x6C, 0xAC, 0xEC, -+0x11, 0xF1, 0x82, 0xC2, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0x40, 0xF0, 0x81, 0xA2, -+0x08, 0x6D, 0x01, 0x4C, 0x40, 0xF0, 0x81, 0xC2, -+0x40, 0xF0, 0x81, 0xA2, 0xAE, 0xEC, 0x1A, 0x2C, -+0x40, 0xF0, 0x81, 0xC2, 0x17, 0x10, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF1, 0x88, 0x9A, 0x02, 0x6E, -+0x40, 0x9C, 0xCD, 0xEA, 0x40, 0xDC, 0x10, 0xF0, -+0x23, 0x6A, 0x0E, 0xF3, 0x58, 0x9A, 0x60, 0xC2, -+0x11, 0xF1, 0x62, 0xA5, 0xFF, 0x6A, 0x4C, 0xEB, -+0x10, 0xF0, 0x23, 0x6A, 0x0E, 0xF3, 0x5C, 0x9A, -+0x60, 0xC2, 0x02, 0x10, 0x1F, 0xF7, 0x1C, 0x2B, -+0x03, 0x91, 0x02, 0x90, 0x02, 0x63, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x23, 0x6A, 0x2E, 0xF3, 0x40, 0x9A, 0xFF, 0x68, -+0x60, 0xA2, 0x6C, 0xE8, 0x1D, 0x20, 0x00, 0x6B, -+0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x01, 0x6C, 0x40, 0xEA, 0x10, 0xF0, -+0x23, 0x6A, 0x2E, 0xF3, 0x44, 0x9A, 0x20, 0x6B, -+0x20, 0x70, 0x60, 0xC2, 0x0D, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, -+0x23, 0x6C, 0x80, 0xF0, 0x6C, 0x9A, 0x0E, 0xF2, -+0x98, 0x9C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x1C, 0x96, 0x45, -+0x00, 0x18, 0x9B, 0xD0, 0x05, 0x6C, 0x01, 0x6D, -+0x00, 0x18, 0x76, 0xC9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0xFF, 0x17, 0xDE, 0x63, 0x43, 0x62, -+0x42, 0xD1, 0x41, 0xD0, 0x01, 0x6A, 0x7D, 0x67, -+0x4B, 0xEA, 0x58, 0xC3, 0x01, 0x6A, 0x5A, 0xC3, -+0x08, 0x6A, 0x5B, 0xC3, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, -+0x76, 0x4B, 0x74, 0x33, 0x49, 0xE3, 0x66, 0xA2, -+0x7F, 0x6A, 0x6C, 0xEA, 0x01, 0x72, 0x7E, 0x30, -+0x80, 0xF0, 0x1C, 0x61, 0x48, 0xA4, 0xBD, 0x67, -+0x5C, 0xC5, 0x41, 0xA4, 0x5D, 0xC5, 0x42, 0xA4, -+0x5E, 0xC5, 0x46, 0xA4, 0x20, 0xF0, 0x40, 0xC5, -+0x43, 0xA4, 0x5F, 0xC5, 0x47, 0xA4, 0x20, 0xF0, -+0x41, 0xC5, 0x5C, 0xA5, 0x80, 0xF0, 0x04, 0x2A, -+0x7D, 0x67, 0x5F, 0xA3, 0x7E, 0xA3, 0x40, 0x32, -+0x6D, 0xEA, 0x03, 0x72, 0x05, 0x60, 0x08, 0x72, -+0x21, 0x60, 0x02, 0x72, 0x37, 0x60, 0x78, 0x10, -+0x06, 0x20, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x06, 0x04, 0x40, 0xEA, 0x9D, 0x67, -+0x20, 0xF0, 0xE1, 0xA4, 0x20, 0xF0, 0x40, 0xA4, -+0xFF, 0xF7, 0x1F, 0x6B, 0xE0, 0x37, 0x5D, 0xE7, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, 0x50, 0x9A, -+0x30, 0xF0, 0x20, 0x6D, 0x05, 0x6C, 0xEC, 0xF6, -+0x06, 0x4D, 0x00, 0xF2, 0x00, 0x6E, 0x6C, 0xEF, -+0x40, 0xEA, 0x75, 0x10, 0xBD, 0x67, 0x30, 0xF0, -+0x20, 0x6B, 0x10, 0x6A, 0x5B, 0xC5, 0x30, 0xF0, -+0x20, 0x69, 0x4E, 0xF2, 0x50, 0x9B, 0x09, 0xF6, -+0x04, 0x49, 0x09, 0x04, 0xB1, 0x67, 0x04, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6C, 0x4E, 0xF2, -+0x50, 0x9C, 0xA4, 0x41, 0x0A, 0x04, 0x04, 0x6E, -+0x40, 0xEA, 0x42, 0x10, 0x06, 0x20, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x5C, 0x9A, 0x06, 0x04, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0xEB, 0xF6, 0x74, 0xA0, 0x01, 0x6A, -+0x6C, 0xEA, 0x27, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x50, 0x9A, 0x40, 0xEA, 0xEB, 0xF6, -+0x60, 0xA0, 0x04, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x18, 0x22, 0x10, 0xF0, 0x23, 0x6A, -+0x2E, 0xF3, 0x48, 0x9A, 0xEB, 0xF6, 0xCC, 0x98, -+0x00, 0x6B, 0x40, 0x9A, 0x10, 0xF0, 0x23, 0x6A, -+0x2E, 0xF3, 0x4C, 0x9A, 0x10, 0xF0, 0x23, 0x6C, -+0xEB, 0xF1, 0x09, 0x4C, 0x40, 0x9A, 0xA3, 0x67, -+0x01, 0x6F, 0x5B, 0xE6, 0x04, 0xD3, 0x00, 0x18, -+0x5F, 0xD5, 0x29, 0x10, 0x00, 0x18, 0x7A, 0xD6, -+0x26, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, -+0x54, 0x9A, 0x40, 0xEA, 0xEB, 0xF6, 0xB2, 0xA8, -+0x00, 0x6C, 0x00, 0x18, 0x27, 0xD6, 0x1B, 0x10, -+0x1A, 0x20, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x13, 0x10, 0x14, 0x2A, 0x69, 0xA4, -+0xBD, 0x67, 0x7C, 0xC5, 0x68, 0xA4, 0x5E, 0xC5, -+0x5F, 0xC5, 0x7D, 0xC5, 0x46, 0xA4, 0x20, 0xF0, -+0x40, 0xC5, 0x67, 0xA4, 0x08, 0x20, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x5C, 0x9A, 0x20, 0xF0, -+0x61, 0xC5, 0x06, 0x04, 0x40, 0xEA, 0x43, 0x97, -+0x42, 0x91, 0x41, 0x90, 0x22, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x68, 0x44, 0xFA, 0x4B, 0x4C, 0xEB, 0x04, 0x5B, -+0x03, 0x60, 0x80, 0x18, 0xE6, 0x07, 0x42, 0x10, -+0xFE, 0x4C, 0x4C, 0xEC, 0x0C, 0x5C, 0x32, 0x60, -+0x10, 0xF0, 0x23, 0x6A, 0x88, 0x34, 0x8E, 0xF0, -+0x18, 0x4A, 0x89, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, 0x48, 0x9A, -+0x08, 0x10, 0x85, 0x67, 0x00, 0x18, 0x3D, 0xD6, -+0x2D, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, -+0x44, 0x9A, 0x85, 0x67, 0x40, 0xEA, 0x26, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, 0x54, 0x9A, -+0x40, 0xEA, 0x20, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF5, 0x58, 0x9A, 0xF2, 0x17, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF5, 0x5C, 0x9A, 0xED, 0x17, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF5, 0x40, 0x9A, -+0xE8, 0x17, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF5, -+0x54, 0x9A, 0xE3, 0x17, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, -+0x0E, 0xF2, 0x98, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0xFF, 0x6A, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x10, 0xF0, 0x23, 0x6B, -+0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xE7, 0xF1, 0x05, 0x4A, 0x07, 0xD4, 0x40, 0xDB, -+0x60, 0xA4, 0x01, 0xA4, 0x02, 0x6A, 0x6C, 0xEA, -+0x24, 0x67, 0x06, 0xD0, 0x1F, 0x22, 0x42, 0xA4, -+0x06, 0xD2, 0x1C, 0x10, 0x07, 0x93, 0x01, 0x6D, -+0x90, 0x67, 0x40, 0xA3, 0x4C, 0xED, 0x00, 0x18, -+0xFE, 0xC7, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, -+0x58, 0x9A, 0x90, 0x67, 0x40, 0xEA, 0x05, 0x2A, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x54, 0x9A, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, -+0x50, 0x9A, 0x90, 0x67, 0x40, 0xEA, 0x01, 0x48, -+0xFF, 0x6A, 0x4C, 0xE8, 0x06, 0x92, 0x03, 0xEA, -+0xE1, 0x60, 0x63, 0xA1, 0x07, 0x6A, 0x01, 0x6C, -+0x6C, 0xEA, 0x60, 0xA1, 0x8C, 0xEB, 0x1E, 0x2B, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x69, 0xF3, 0xC8, 0xA3, 0x84, 0xEA, 0x1F, 0x6F, -+0xCA, 0x35, 0x8F, 0xEC, 0xEC, 0xED, 0x8C, 0xED, -+0x7D, 0x6C, 0x8B, 0xEC, 0xA8, 0x35, 0xCC, 0xEC, -+0xAD, 0xEC, 0x69, 0xF3, 0x88, 0xC3, 0x30, 0xF0, -+0x20, 0x6C, 0x4F, 0xF6, 0x9C, 0xA4, 0x8E, 0xEA, -+0x20, 0x2A, 0x01, 0x6A, 0x4B, 0xEA, 0x69, 0xF3, -+0x49, 0xC3, 0x1B, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x69, 0xF3, 0xC8, 0xA3, -+0x1F, 0x6F, 0x84, 0xEA, 0xCA, 0x35, 0xEC, 0xED, -+0xAD, 0xEC, 0xEC, 0xEC, 0x88, 0x35, 0x7D, 0x6C, -+0x8B, 0xEC, 0xCC, 0xEC, 0xAD, 0xEC, 0x69, 0xF3, -+0x88, 0xC3, 0x30, 0xF0, 0x20, 0x6C, 0x4F, 0xF6, -+0x9C, 0xA4, 0x8E, 0xEA, 0x02, 0x2A, 0x69, 0xF3, -+0x89, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, -+0x8C, 0xEB, 0x1C, 0x23, 0x03, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x69, 0xF3, 0x68, 0xC2, 0x00, 0x18, -+0xA2, 0xD4, 0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0x04, 0x93, 0x4F, 0xF5, 0x5C, 0x9A, 0x6E, 0xEA, -+0x03, 0x22, 0x04, 0x94, 0x00, 0x18, 0xC3, 0xD4, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, 0x8D, 0xEB, -+0x69, 0xF3, 0x68, 0xC2, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x6A, -+0x4C, 0xEC, 0x68, 0x44, 0xC8, 0x4B, 0x4C, 0xEB, -+0x20, 0x5B, 0x05, 0x67, 0x1B, 0x61, 0x03, 0x24, -+0x01, 0x74, 0x05, 0x60, 0x08, 0x10, 0x85, 0x67, -+0x00, 0x18, 0xB4, 0xCC, 0x13, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x79, 0xCE, 0x0F, 0x10, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF1, 0x68, 0x9A, 0x01, 0x6D, -+0x40, 0x9B, 0xAD, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6A, 0x6E, 0xF1, 0x40, 0x9A, 0x80, 0xC2, -+0x0E, 0x6A, 0x01, 0x10, 0x00, 0x6A, 0x40, 0xC0, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0x87, 0xF3, 0x01, 0x4A, 0x10, 0xF0, -+0x30, 0x68, 0x40, 0xDB, 0x00, 0xF0, 0x00, 0x48, -+0x40, 0xF0, 0x40, 0xA0, 0x40, 0xF0, 0x61, 0xA0, -+0x4E, 0xEB, 0x29, 0x23, 0x4C, 0x32, 0x0D, 0xE2, -+0x80, 0xA3, 0xA1, 0x42, 0xB5, 0xE0, 0x00, 0x18, -+0xCA, 0xCE, 0x40, 0xF0, 0x40, 0xA0, 0x01, 0x4A, -+0x40, 0xF0, 0x40, 0xC0, 0x40, 0xF0, 0x60, 0xA0, -+0x40, 0xF0, 0x41, 0xA0, 0x6E, 0xEA, 0x0A, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x02, 0x6C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0x40, 0xF0, 0x60, 0xA2, -+0x08, 0x6C, 0x8E, 0xEB, 0x02, 0x2B, 0x40, 0xF0, -+0x60, 0xC2, 0x00, 0x18, 0x2E, 0xCD, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x30, 0x68, 0x00, 0xF0, 0x00, 0x48, 0xC1, 0xF7, -+0x66, 0xA0, 0x7F, 0x6C, 0xA7, 0x43, 0x6F, 0x4D, -+0xB4, 0x35, 0x15, 0xE5, 0x46, 0xA5, 0x8C, 0xEA, -+0x20, 0x2A, 0x74, 0x33, 0x09, 0xE3, 0xC1, 0xF6, -+0x8E, 0xA2, 0xA2, 0x67, 0xC1, 0xF6, 0x0F, 0x4D, -+0x00, 0x18, 0xCA, 0xCE, 0xC1, 0xF7, 0x46, 0xA0, -+0x10, 0xF0, 0x23, 0x6C, 0x2E, 0xF3, 0x90, 0x9C, -+0x54, 0x33, 0x0D, 0xE3, 0xC1, 0xF6, 0xAC, 0xA3, -+0x76, 0x4A, 0x54, 0x32, 0xA0, 0xC4, 0xC1, 0xF6, -+0x8D, 0xA3, 0x10, 0xF0, 0x23, 0x6B, 0x2E, 0xF3, -+0x74, 0x9B, 0x41, 0xE0, 0x80, 0xC3, 0x86, 0x40, -+0x49, 0x10, 0x01, 0x72, 0x49, 0x61, 0x74, 0x33, -+0x0D, 0xE3, 0xC1, 0xF6, 0x47, 0xA3, 0xFF, 0x72, -+0x0C, 0x61, 0xC1, 0xF6, 0x88, 0xA3, 0x06, 0x4D, -+0x00, 0x18, 0x50, 0xCE, 0xC1, 0xF7, 0x66, 0xA0, -+0x74, 0x33, 0x01, 0xE3, 0xC1, 0xF6, 0x4E, 0xC0, -+0x04, 0x10, 0x01, 0x6A, 0x4B, 0xEA, 0xC1, 0xF6, -+0x4E, 0xC3, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, 0x10, 0xF0, -+0x23, 0x6D, 0x2E, 0xF3, 0xB0, 0x9D, 0x74, 0x34, -+0x51, 0xE4, 0xC1, 0xF6, 0xCC, 0xA4, 0x76, 0x4B, -+0x74, 0x33, 0xC0, 0xC5, 0xC1, 0xF6, 0xAD, 0xA4, -+0x10, 0xF0, 0x23, 0x6C, 0x2E, 0xF3, 0x94, 0x9C, -+0x49, 0xE3, 0xA0, 0xC4, 0x46, 0x82, 0x00, 0x52, -+0x0B, 0x60, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, -+0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, 0x2E, 0xF2, -+0x90, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0x66, 0xA2, 0x76, 0x4B, 0x74, 0x33, -+0x69, 0xE2, 0x86, 0x42, 0x00, 0x18, 0xE7, 0xCD, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0x07, 0xF5, 0x09, 0x4A, 0x10, 0xF0, -+0x30, 0x68, 0x40, 0xDB, 0x00, 0xF0, 0x00, 0x48, -+0xC1, 0xF7, 0x66, 0xA0, 0xC1, 0xF7, 0x47, 0xA0, -+0x6E, 0xEA, 0x4A, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xAF, 0xF4, 0x18, 0x4A, 0xA0, 0xF0, 0x60, 0xAA, -+0x01, 0xF0, 0x00, 0x73, 0x10, 0x60, 0xA0, 0xF0, -+0x81, 0xA2, 0xA0, 0xF0, 0x40, 0xA2, 0xAE, 0x42, -+0x8E, 0xED, 0x09, 0x25, 0x01, 0xF1, 0x01, 0x73, -+0x06, 0x60, 0x01, 0xF1, 0x00, 0x73, 0x03, 0x60, -+0xFF, 0x4A, 0x4E, 0xEC, 0x0D, 0x2C, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x80, 0xF0, -+0x4C, 0x9B, 0x04, 0x6C, 0x8D, 0xEA, 0x02, 0x6C, -+0x8D, 0xEA, 0x80, 0xF0, 0x4C, 0xDB, 0x24, 0x10, -+0x00, 0x18, 0x02, 0xCF, 0xC1, 0xF7, 0x46, 0xA0, -+0x01, 0x4A, 0xC1, 0xF7, 0x46, 0xC0, 0xC1, 0xF7, -+0x66, 0xA0, 0xC1, 0xF7, 0x47, 0xA0, 0x6E, 0xEA, -+0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, 0x02, 0x6C, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, -+0x66, 0xA2, 0x08, 0x6C, 0x8E, 0xEB, 0x02, 0x2B, -+0xC1, 0xF7, 0x66, 0xC2, 0x00, 0x18, 0xC1, 0xCC, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFF, 0xF7, 0x1F, 0x6A, 0x10, 0xF0, 0x23, 0x6B, -+0x8C, 0xEA, 0x2E, 0xF3, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6C, 0x2E, 0xF3, 0x9C, 0x9C, 0xCC, 0xEB, -+0x40, 0xF6, 0xA0, 0x35, 0x8D, 0xEB, 0x1F, 0xF7, -+0x00, 0x6C, 0x4C, 0xEC, 0x02, 0xF0, 0x00, 0x74, -+0xAD, 0xEB, 0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, -+0x23, 0x6C, 0x8E, 0xF1, 0x88, 0x9C, 0x04, 0x10, -+0x10, 0xF0, 0x23, 0x6C, 0x8E, 0xF1, 0x8C, 0x9C, -+0x89, 0xE2, 0x60, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, 0x1F, 0xF7, -+0x00, 0x6C, 0x4C, 0xEC, 0xFF, 0x6B, 0x02, 0xF0, -+0x00, 0x74, 0xAC, 0xEB, 0x01, 0x60, 0x05, 0x2C, -+0x10, 0xF0, 0x23, 0x6C, 0x8E, 0xF1, 0x88, 0x9C, -+0x04, 0x10, 0x10, 0xF0, 0x23, 0x6C, 0x8E, 0xF1, -+0x8C, 0x9C, 0x91, 0xE2, 0x00, 0x6D, 0xA0, 0xDC, -+0x10, 0xF0, 0x23, 0x6C, 0x2E, 0xF3, 0x98, 0x9C, -+0xD4, 0x36, 0x40, 0xF6, 0x60, 0x33, 0x8C, 0xEE, -+0x6D, 0xEE, 0x10, 0xF0, 0x23, 0x6B, 0x2E, 0xF3, -+0x7C, 0x9B, 0x6D, 0xEE, 0x1F, 0xF7, 0x00, 0x6B, -+0x4C, 0xEB, 0x02, 0xF0, 0x00, 0x73, 0x01, 0x60, -+0x05, 0x2B, 0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF1, -+0x68, 0x9B, 0x04, 0x10, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF1, 0x6C, 0x9B, 0x69, 0xE2, 0xC0, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0x0F, 0xF5, 0x00, 0x6B, -+0x78, 0xEE, 0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, -+0x10, 0xF0, 0x23, 0x6C, 0x2E, 0xF3, 0x98, 0x9C, -+0x40, 0xF6, 0xA0, 0x35, 0x12, 0xEB, 0x8C, 0xEB, -+0x10, 0xF0, 0x23, 0x6C, 0x2E, 0xF3, 0x9C, 0x9C, -+0xAD, 0xEB, 0x8D, 0xEB, 0x1F, 0xF7, 0x00, 0x6C, -+0x4C, 0xEC, 0x02, 0xF0, 0x00, 0x74, 0x01, 0x60, -+0x05, 0x2C, 0x10, 0xF0, 0x23, 0x6C, 0x8E, 0xF1, -+0x88, 0x9C, 0x04, 0x10, 0x10, 0xF0, 0x23, 0x6C, -+0x8E, 0xF1, 0x8C, 0x9C, 0x89, 0xE2, 0x60, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6A, -+0x4E, 0xF3, 0x4C, 0x9A, 0x40, 0x9A, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x4C, 0x9B, 0x8D, 0xEA, 0x4C, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0x6E, 0xF3, 0x60, 0x9B, 0x80, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF3, 0x64, 0x9B, -+0x40, 0xDB, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF3, -+0x68, 0x9A, 0xC0, 0x6A, 0xFF, 0x68, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, -+0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF3, 0x4C, 0x9A, -+0x01, 0x6B, 0x05, 0x97, 0x40, 0xA2, 0x0C, 0xEA, -+0x5E, 0x32, 0x6E, 0xEA, 0x6C, 0xEA, 0x0C, 0xEA, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0x47, 0xF7, 0x11, 0x4A, 0x40, 0xDB, -+0x00, 0x68, 0x28, 0x10, 0x82, 0xF3, 0x08, 0x70, -+0x11, 0x61, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, -+0x68, 0x9A, 0x02, 0xF0, 0x00, 0x6C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF3, 0x50, 0x9A, 0x03, 0x6B, 0x6B, 0xEB, -+0x60, 0xC2, 0x18, 0x10, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x48, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x14, 0x6C, 0x40, 0xEA, -+0x33, 0x58, 0x08, 0x61, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF3, 0x54, 0x9A, 0x60, 0xA2, 0x08, 0x6A, -+0x6C, 0xEA, 0x04, 0x2A, 0x00, 0x18, 0xC3, 0xCF, -+0x01, 0x72, 0xD4, 0x61, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF3, 0x50, 0x9A, 0x02, 0x6B, 0x6B, 0xEB, -+0x60, 0xC2, 0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF1, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x47, 0xF7, -+0x12, 0x4A, 0x40, 0xDB, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0x05, 0x5C, 0x5E, 0x60, -+0x10, 0xF0, 0x23, 0x6A, 0x88, 0x34, 0xCE, 0xF0, -+0x08, 0x4A, 0x89, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x48, 0x9B, -+0xAD, 0xEA, 0xC0, 0xF1, 0x48, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0x2E, 0xF3, 0x64, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF3, 0x78, 0x9B, -+0x32, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x41, 0x9B, 0xAD, 0xEA, 0x41, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF3, 0x7C, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF3, -+0x60, 0x9B, 0x21, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x42, 0x9B, 0xAD, 0xEA, -+0x42, 0xDB, 0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF3, -+0x64, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF3, 0x68, 0x9B, 0x10, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x43, 0x9B, -+0xAD, 0xEA, 0x43, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF3, 0x6C, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0x8E, 0xF3, 0x70, 0x9B, 0x40, 0xDB, -+0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x44, 0x9B, 0xAD, 0xEA, 0x44, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF3, 0x74, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF3, -+0x78, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0x05, 0x5C, 0x63, 0x60, 0x10, 0xF0, 0x23, 0x6A, -+0x88, 0x34, 0xCE, 0xF0, 0x1C, 0x4A, 0x89, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x88, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, -+0xC0, 0xF1, 0x48, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x6E, 0xF3, 0x78, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6A, 0x2E, 0xF3, 0x44, 0x9A, 0x35, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x81, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x41, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF3, 0x60, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF3, -+0x5C, 0x9A, 0x23, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x82, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x42, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF3, 0x68, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF3, 0x44, 0x9A, 0x11, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x83, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x43, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF3, 0x70, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF3, -+0x4C, 0x9A, 0xA0, 0xDA, 0x20, 0xE8, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x84, 0x9B, -+0xAF, 0xEA, 0x8C, 0xEA, 0x44, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0x8E, 0xF3, 0x78, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF3, 0x54, 0x9A, -+0xA0, 0xDA, 0x20, 0xE8, 0x01, 0x74, 0x15, 0x60, -+0x03, 0x24, 0x02, 0x74, 0x23, 0x60, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x4E, 0x9B, 0xAD, 0xEA, 0x4E, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0x8E, 0xF3, 0x7C, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF3, 0x60, 0x9B, -+0x21, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x4F, 0x9B, 0xAD, 0xEA, 0x4F, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF3, 0x64, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF3, -+0x68, 0x9B, 0x10, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x50, 0x9B, 0xAD, 0xEA, -+0x50, 0xDB, 0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF3, -+0x6C, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0xAE, 0xF3, 0x70, 0x9B, 0x40, 0xDB, 0x20, 0xE8, -+0x01, 0x74, 0x16, 0x60, 0x03, 0x24, 0x02, 0x74, -+0x25, 0x60, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x8E, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x4E, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0xAE, 0xF3, 0x60, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF3, 0x5C, 0x9A, 0x23, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x8F, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x4F, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF3, 0x68, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, 0xAE, 0xF3, -+0x44, 0x9A, 0x11, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x90, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x50, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0xAE, 0xF3, 0x70, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6A, 0xAE, 0xF3, 0x4C, 0x9A, 0xA0, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6C, -+0x6E, 0xF3, 0x98, 0x9C, 0x00, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x48, 0xDB, 0xC0, 0xF1, -+0x08, 0x4B, 0x41, 0xDB, 0x42, 0xDB, 0x43, 0xDB, -+0x44, 0xDB, 0x40, 0xDC, 0x10, 0xF0, 0x23, 0x6C, -+0x8E, 0xF3, 0x80, 0x9C, 0x40, 0xDC, 0x10, 0xF0, -+0x23, 0x6C, 0x8E, 0xF3, 0x88, 0x9C, 0x40, 0xDC, -+0x10, 0xF0, 0x23, 0x6C, 0x8E, 0xF3, 0x90, 0x9C, -+0x40, 0xDC, 0x10, 0xF0, 0x23, 0x6C, 0x8E, 0xF3, -+0x98, 0x9C, 0x40, 0xDC, 0x10, 0xF0, 0x23, 0x6C, -+0xAE, 0xF3, 0x80, 0x9C, 0x4E, 0xDB, 0x4F, 0xDB, -+0x40, 0xDC, 0x10, 0xF0, 0x23, 0x6C, 0xAE, 0xF3, -+0x88, 0x9C, 0x40, 0xDC, 0x10, 0xF0, 0x23, 0x6C, -+0xAE, 0xF3, 0x90, 0x9C, 0x50, 0xDB, 0x40, 0xDC, -+0x4C, 0xDB, 0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF3, -+0x64, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x23, 0x6B, 0x2E, 0xF3, 0x64, 0x9B, -+0x01, 0x6A, 0x4B, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0x6E, 0xF3, 0x7C, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF3, 0x64, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF3, -+0x6C, 0x9B, 0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF3, 0x7C, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0xAE, 0xF3, 0x64, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF3, 0x70, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF3, -+0x60, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x23, 0x6A, 0xFF, 0xF7, 0x1F, 0x69, -+0x8C, 0xE9, 0xAE, 0xF3, 0x9C, 0x9A, 0xFF, 0x6B, -+0x8E, 0x6A, 0xA0, 0xA4, 0x00, 0x68, 0x6C, 0xED, -+0xAC, 0xEA, 0x40, 0xC4, 0x71, 0x6A, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF3, 0x80, 0x9A, 0x01, 0x6D, 0x40, 0xA4, -+0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x19, 0x10, 0x64, 0x70, 0x0D, 0x61, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF1, 0x68, 0x9A, 0x10, 0xF0, -+0x23, 0x6C, 0x4E, 0xF2, 0x94, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, 0x1C, 0x10, -+0xFF, 0xF7, 0x1F, 0x6A, 0x01, 0x48, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF3, 0x40, 0x9A, 0x60, 0xA2, 0x01, 0x6A, -+0x6C, 0xEA, 0xDF, 0x2A, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x49, 0x4C, 0xE9, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF3, 0x44, 0x9A, 0x20, 0xCA, 0x01, 0x6A, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xFF, 0x69, 0x4E, 0xF2, 0x4C, 0x9B, 0x2C, 0xED, -+0xFF, 0xF7, 0x1F, 0x68, 0x11, 0xD7, 0x8C, 0xE8, -+0x08, 0xD5, 0x04, 0x04, 0x00, 0x6D, 0xCC, 0xE9, -+0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x4C, 0x9B, 0x05, 0x04, 0x00, 0x6D, -+0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x50, 0x9B, 0x11, 0x95, 0x04, 0x04, -+0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x50, 0x9B, 0x12, 0x95, 0x06, 0x04, -+0x04, 0x6E, 0x40, 0xEA, 0x00, 0xF1, 0x00, 0x58, -+0x08, 0x61, 0x0E, 0xF0, 0x40, 0x40, 0xFF, 0xF7, -+0x1F, 0x6B, 0x6C, 0xEA, 0x00, 0xF1, 0x00, 0x5A, -+0x39, 0x60, 0x08, 0x92, 0x04, 0x72, 0x11, 0x61, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x48, 0x9A, -+0xFF, 0x6B, 0x49, 0xE0, 0x40, 0xA2, 0x4C, 0xEB, -+0x5F, 0x21, 0x06, 0x94, 0x8F, 0xEA, 0x6C, 0xEA, -+0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, 0x04, 0xD2, -+0x57, 0x10, 0x08, 0x92, 0x05, 0x72, 0x12, 0x61, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x48, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6B, 0x49, 0xE0, 0x40, 0xAA, -+0x4C, 0xEB, 0x7F, 0x21, 0x06, 0x94, 0x8F, 0xEA, -+0x6C, 0xEA, 0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, -+0x04, 0xD2, 0x77, 0x10, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x48, 0x9A, 0x49, 0xE0, 0x60, 0x9A, -+0x80, 0xF0, 0x1E, 0x21, 0x06, 0x94, 0x8F, 0xEA, -+0x6C, 0xEA, 0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, -+0x04, 0xD2, 0x96, 0x10, 0x01, 0xF0, 0x00, 0x58, -+0x09, 0x61, 0x0D, 0xF7, 0x40, 0x40, 0xFF, 0xF7, -+0x1F, 0x6B, 0x6C, 0xEA, 0x00, 0xF7, 0x00, 0x5A, -+0x80, 0xF0, 0x17, 0x60, 0x08, 0x92, 0x04, 0x72, -+0x31, 0x61, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x48, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x4C, 0x9A, 0x49, 0xE0, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0x07, 0x21, 0x06, 0x94, 0x8F, 0xEB, -+0x4C, 0xEB, 0x04, 0x92, 0x8C, 0xEA, 0x4D, 0xEB, -+0x04, 0xD3, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x48, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x4C, 0x9A, 0x7D, 0x67, 0x41, 0xE0, 0x50, 0xA3, -+0x40, 0xC0, 0x7E, 0x10, 0x08, 0x92, 0x05, 0x72, -+0x32, 0x61, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x48, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x4C, 0x9A, 0x49, 0xE0, 0x60, 0xAA, 0xFF, 0xF7, -+0x1F, 0x6A, 0x6C, 0xEA, 0x07, 0x21, 0x06, 0x94, -+0x8F, 0xEB, 0x4C, 0xEB, 0x04, 0x92, 0x8C, 0xEA, -+0x4D, 0xEB, 0x04, 0xD3, 0x1F, 0xF7, 0x00, 0x6A, -+0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, -+0x05, 0x2A, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x48, 0x9A, 0x04, 0x10, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x4C, 0x9A, 0x7D, 0x67, 0x41, 0xE0, -+0x48, 0xAB, 0x40, 0xC8, 0x49, 0x10, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x48, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x4C, 0x9A, 0x49, 0xE0, -+0x60, 0x9A, 0x07, 0x21, 0x06, 0x94, 0x8F, 0xEA, -+0x6C, 0xEA, 0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, -+0x04, 0xD2, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x48, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x4C, 0x9A, 0x41, 0xE0, 0x04, 0x92, 0x40, 0xD8, -+0x1B, 0x10, 0xFF, 0xF7, 0x1C, 0x6A, 0x0C, 0xEA, -+0x01, 0x6D, 0x82, 0x67, 0xAB, 0xED, 0x08, 0xD2, -+0x00, 0x18, 0x9A, 0xD2, 0x05, 0xD2, 0x07, 0x21, -+0x06, 0x94, 0x8F, 0xEB, 0x4C, 0xEB, 0x04, 0x92, -+0x8C, 0xEA, 0x4D, 0xEB, 0x04, 0xD3, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x08, 0x94, -+0x04, 0x96, 0x01, 0x6D, 0xAB, 0xED, 0x40, 0xEA, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x41, 0x9C, 0x61, 0xA4, -+0x01, 0xAC, 0x06, 0xD2, 0x42, 0x9C, 0xFF, 0x73, -+0x07, 0xD2, 0x00, 0x6A, 0x59, 0x60, 0x7F, 0x6D, -+0x6C, 0xED, 0x4C, 0x45, 0xFF, 0x6B, 0x6C, 0xEA, -+0x0E, 0x5A, 0x08, 0x60, 0x10, 0xF0, 0x23, 0x6B, -+0x48, 0x32, 0xEE, 0xF0, 0x10, 0x4B, 0x4D, 0xE3, -+0x40, 0x9B, 0x00, 0xEA, 0x03, 0x6A, 0x48, 0x10, -+0x61, 0xA4, 0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0xFF, 0x6E, 0x07, 0x03, 0x90, 0x67, 0x4C, 0xEE, -+0x06, 0x07, 0x04, 0xD3, 0x00, 0x18, 0xF9, 0xD0, -+0x1F, 0x10, 0x81, 0xA4, 0x80, 0x6A, 0xFF, 0x69, -+0x64, 0x67, 0x4C, 0xEB, 0x0C, 0xE9, 0x02, 0x32, -+0x01, 0x6E, 0x82, 0x67, 0xB1, 0x67, 0xCB, 0xEE, -+0x08, 0xD3, 0x09, 0xD2, 0x00, 0x18, 0xE5, 0xD2, -+0x08, 0x93, 0x07, 0x23, 0x07, 0x94, 0x8F, 0xEB, -+0x4C, 0xEB, 0x06, 0x92, 0x8C, 0xEA, 0x4D, 0xEB, -+0x06, 0xD3, 0x09, 0x94, 0x06, 0x97, 0x01, 0x6E, -+0xB1, 0x67, 0xCB, 0xEE, 0x00, 0x18, 0xF8, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x29, 0xF4, 0x7C, 0x9A, 0x06, 0x94, 0x61, 0xE0, -+0x49, 0xF4, 0x60, 0x9A, 0x29, 0xF4, 0x1C, 0xDA, -+0x6D, 0xE4, 0x49, 0xF4, 0x60, 0xDA, 0x0B, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x58, 0x9A, 0x90, 0x67, 0x40, 0xEA, 0x01, 0x6A, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF3, 0x80, 0x9A, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xA0, 0x9C, 0x4C, 0x9B, -+0xAC, 0xEA, 0x4D, 0xDB, 0x40, 0xDC, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0xD1, 0x04, 0xD0, 0x10, 0xF0, -+0x23, 0x6A, 0x2E, 0xF3, 0x24, 0x9A, 0x10, 0xF0, -+0x23, 0x6A, 0x6E, 0xF3, 0x1C, 0x4A, 0x40, 0x9A, -+0x60, 0x99, 0x10, 0xF0, 0x23, 0x6C, 0xA0, 0x9A, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF3, 0x44, 0x9A, -+0x8E, 0xF3, 0x0C, 0x4C, 0x80, 0x9C, 0x00, 0x9A, -+0x1A, 0x65, 0x10, 0xF0, 0x23, 0x6A, 0x80, 0x9C, -+0x8E, 0xF3, 0x14, 0x4A, 0x40, 0x9A, 0x01, 0xD4, -+0x30, 0xF0, 0x20, 0x6C, 0x40, 0x9A, 0xC0, 0xF1, -+0xE8, 0x9C, 0x00, 0xD2, 0x44, 0x67, 0xC0, 0xF1, -+0x08, 0x4A, 0xC1, 0x9A, 0x83, 0x9A, 0x6C, 0xEF, -+0xAC, 0xEE, 0x01, 0x93, 0xA2, 0x9A, 0xE5, 0xDA, -+0x6C, 0xEC, 0x0C, 0xED, 0x64, 0x9A, 0x00, 0x90, -+0x88, 0xDA, 0xC6, 0xDA, 0x0C, 0xEB, 0xA7, 0xDA, -+0x69, 0xDA, 0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF3, -+0x1C, 0x4A, 0x40, 0x9A, 0xE0, 0xD9, 0x18, 0x67, -+0xC0, 0xDA, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF3, -+0x0C, 0x4A, 0x40, 0x9A, 0xA0, 0xD8, 0x80, 0xDA, -+0x10, 0xF0, 0x23, 0x6C, 0x8E, 0xF3, 0x14, 0x4C, -+0x80, 0x9C, 0x60, 0xDC, 0x05, 0x91, 0x04, 0x90, -+0x03, 0x63, 0x20, 0xE8, 0xFF, 0x63, 0x01, 0xD1, -+0x00, 0xD0, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF3, -+0x1C, 0x9A, 0x10, 0xF0, 0x23, 0x6A, 0xAE, 0xF3, -+0xE4, 0x9A, 0x10, 0xF0, 0x23, 0x6A, 0xAE, 0xF3, -+0xCC, 0x9A, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0x98, 0xAE, 0x9A, 0x60, 0x9F, -+0x20, 0x9E, 0x8C, 0xED, 0x8F, 0x9A, 0xB1, 0xDA, -+0x6C, 0xEC, 0x70, 0x9A, 0x92, 0xDA, 0x2C, 0xEB, -+0x73, 0xDA, 0xA0, 0xD8, 0x80, 0xDF, 0x60, 0xDE, -+0x01, 0x91, 0x00, 0x90, 0x01, 0x63, 0x20, 0xE8, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x50, 0x9A, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0x07, 0x6D, 0xB8, 0xEC, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x01, 0x6E, 0x12, 0xEC, -+0x71, 0xE4, 0xE9, 0xF0, 0xA5, 0xA4, 0xCC, 0xED, -+0x1D, 0x25, 0xE9, 0xF0, 0xA6, 0xA4, 0x29, 0xF1, -+0x60, 0x9B, 0xE9, 0xF0, 0x85, 0xA4, 0x75, 0xE5, -+0x10, 0xF0, 0x23, 0x6B, 0x0E, 0xF3, 0x64, 0x9B, -+0xBC, 0x35, 0x21, 0x4D, 0x75, 0xE5, 0xE0, 0xA5, -+0x9E, 0x33, 0x9A, 0x34, 0xCC, 0xEC, 0x78, 0x33, -+0x9C, 0x34, 0x4C, 0xEF, 0x8D, 0xEB, 0xED, 0xEB, -+0x00, 0xF6, 0x60, 0x33, 0x00, 0xF6, 0x63, 0x33, -+0x4C, 0xEB, 0x60, 0xC5, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, -+0x6E, 0xF2, 0x84, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x20, 0xE8, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xC1, 0xCC, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x29, 0xF5, 0x70, 0xA2, -+0x02, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0xB4, 0xD5, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x69, 0xF3, 0xA9, 0xA3, 0xFF, 0x6A, 0x4C, 0xEC, -+0x8E, 0xED, 0x10, 0x2D, 0x69, 0xF3, 0xA8, 0xA3, -+0x1F, 0x6E, 0xAA, 0x33, 0xCC, 0xEB, 0x67, 0xEC, -+0x01, 0x6C, 0x8C, 0xEB, 0x07, 0x23, 0x02, 0x6B, -+0xAC, 0xEB, 0x4C, 0xEB, 0x03, 0x23, 0x00, 0x6C, -+0x00, 0x18, 0xB4, 0xD5, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0x53, 0xD2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x4F, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x40, 0xCA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x3D, 0xCA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xB0, 0xCD, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x2E, 0xCD, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x7B, 0xD3, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0x63, 0x01, 0xD0, 0x10, 0xF0, 0x23, 0x6B, -+0x0E, 0xF3, 0x64, 0x9B, 0xFF, 0x6A, 0x4C, 0xEE, -+0x6D, 0xE4, 0x08, 0x68, 0x80, 0xA3, 0xDB, 0xE0, -+0x02, 0x67, 0x4C, 0xED, 0x07, 0xEE, 0xD0, 0x67, -+0x4C, 0xEF, 0x04, 0xED, 0x4C, 0xEC, 0xCC, 0xEF, -+0x0F, 0xE8, 0x8C, 0xE8, 0xE4, 0xED, 0xED, 0xE8, -+0x4C, 0xE8, 0x00, 0xC3, 0x01, 0x90, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6A, -+0x0E, 0xF3, 0x44, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, -+0x8C, 0xEB, 0x4D, 0xE3, 0x40, 0xA3, 0xFF, 0x6C, -+0x8C, 0xEE, 0x08, 0x6B, 0xDB, 0xE3, 0x8C, 0xED, -+0x8C, 0xEA, 0x64, 0x67, 0x47, 0xED, 0x67, 0xEE, -+0x6C, 0xEA, 0x8C, 0xEA, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF1, 0x6C, 0x9B, -+0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, 0x69, 0xE2, -+0x00, 0x9A, 0x41, 0x45, 0x25, 0x67, 0x08, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, 0x50, 0x9A, -+0x85, 0x67, 0x2C, 0xE8, 0x40, 0xEA, 0x06, 0xEA, -+0x50, 0x67, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0xF7, 0x1F, 0x68, -+0x41, 0x45, 0x25, 0x67, 0x0C, 0xD6, 0x8C, 0xE8, -+0x07, 0x2A, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, -+0x4C, 0x9A, 0x41, 0xE0, 0xC0, 0xD8, 0x1A, 0x10, -+0x01, 0x6D, 0x90, 0x67, 0xAB, 0xED, 0x00, 0x18, -+0x9A, 0xD2, 0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF4, 0x50, 0x9A, 0x91, 0x67, 0x40, 0xEA, -+0x0C, 0x93, 0x64, 0xEA, 0x43, 0x67, 0x04, 0x93, -+0x2C, 0xEA, 0x2F, 0xE9, 0x6C, 0xE9, 0x10, 0xF0, -+0x23, 0x6B, 0x8E, 0xF1, 0x6C, 0x9B, 0x2D, 0xEA, -+0x61, 0xE0, 0x40, 0xD8, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x01, 0x74, 0x0D, 0x60, 0x06, 0x24, 0x02, 0x74, -+0x10, 0x60, 0x03, 0x74, 0x00, 0x6A, 0x1C, 0x61, -+0x14, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0xA8, 0x35, -+0xCE, 0xF3, 0x48, 0x9A, 0x0B, 0x10, 0x10, 0xF0, -+0x23, 0x6A, 0xA8, 0x35, 0xCE, 0xF3, 0x4C, 0x9A, -+0x05, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF3, -+0x50, 0x9A, 0xA8, 0x35, 0x55, 0xE5, 0x40, 0x9D, -+0x20, 0xE8, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF3, -+0x54, 0x9A, 0xA8, 0x35, 0x55, 0xE5, 0x40, 0x9D, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x08, 0xF3, 0x00, 0x4A, -+0x88, 0x34, 0x91, 0xE2, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF2, 0x7C, 0x9A, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF5, 0xA0, 0x35, 0xCC, 0xEB, 0x10, 0xF0, -+0x23, 0x6E, 0x8E, 0xF2, 0xC0, 0x9E, 0xCE, 0xF4, -+0x50, 0x9A, 0x80, 0xAC, 0xAD, 0xEB, 0x01, 0x6D, -+0xAB, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6B, 0x8C, 0xEB, -+0xFF, 0xF7, 0x1F, 0x6A, 0x81, 0x46, 0x06, 0x67, -+0xAC, 0xEA, 0x06, 0x2C, 0x83, 0x67, 0xA2, 0x67, -+0x00, 0x18, 0xC2, 0xD2, 0x02, 0x67, 0x0D, 0x10, -+0x83, 0x67, 0xA2, 0x67, 0x00, 0x18, 0xC2, 0xD2, -+0x22, 0x67, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, -+0x50, 0x9A, 0x90, 0x67, 0x2C, 0xE8, 0x40, 0xEA, -+0x06, 0xEA, 0x50, 0x67, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x46, 0x67, 0xFF, 0x68, 0xFF, 0xF7, 0x1F, 0x69, -+0x01, 0x4A, 0x0C, 0xD6, 0x0D, 0xD7, 0x8C, 0xE8, -+0xAC, 0xE9, 0x04, 0x2A, 0x90, 0x67, 0xB1, 0x67, -+0xC7, 0x67, 0x15, 0x10, 0xB1, 0x67, 0x90, 0x67, -+0x00, 0x18, 0xC2, 0xD2, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x0C, 0x94, 0xAE, 0xF4, 0x50, 0x9A, -+0x40, 0xEA, 0x0D, 0x96, 0x90, 0x67, 0xB1, 0x67, -+0xC4, 0xEA, 0x0C, 0x92, 0x4C, 0xEE, 0x4F, 0xEB, -+0x04, 0x92, 0x4C, 0xEB, 0x6D, 0xEE, 0x00, 0x18, -+0xD5, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x0E, 0x91, 0x04, 0xD2, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xED, 0x4C, 0xE9, -+0x0C, 0xD6, 0x0D, 0xD7, 0x0F, 0x90, 0x05, 0xD5, -+0x00, 0x6A, 0x08, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, -+0x40, 0xA8, 0x01, 0x4A, 0x40, 0xC8, 0x10, 0xF0, -+0x23, 0x6A, 0x04, 0x94, 0x05, 0x95, 0x6E, 0xF2, -+0xDC, 0x9A, 0x00, 0x18, 0xE5, 0xD2, 0x0C, 0x93, -+0x6C, 0xEA, 0x0D, 0x93, 0x6E, 0xEA, 0x03, 0x22, -+0x40, 0xA8, 0x23, 0xEA, 0xE7, 0x61, 0x40, 0xA8, -+0x09, 0x97, 0x07, 0x90, 0x23, 0xEA, 0x08, 0x91, -+0x58, 0x67, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x23, 0x6B, 0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0xA9, 0xF4, 0x11, 0x4A, 0x40, 0xDB, -+0x00, 0x68, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF3, -+0x58, 0x9A, 0x40, 0xA2, 0x12, 0x2A, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF3, 0x5C, 0x9A, 0x40, 0xA2, -+0x0C, 0x2A, 0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF3, -+0x40, 0x9A, 0x40, 0xA2, 0x06, 0x2A, 0x10, 0xF0, -+0x23, 0x6A, 0xEE, 0xF3, 0x44, 0x9A, 0x40, 0xA2, -+0x18, 0x22, 0xE0, 0xF3, 0x09, 0x70, 0x0A, 0x61, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, 0x68, 0x9A, -+0x20, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x00, 0x6A, 0x0C, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x32, 0x6C, 0x01, 0x48, -+0x40, 0xEA, 0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xE8, -+0xD0, 0x17, 0x01, 0x6A, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFF, 0x6A, 0x4C, 0xEC, -+0x94, 0x34, 0x4C, 0xED, 0x4C, 0xEC, 0x10, 0xF0, -+0x23, 0x6A, 0xEE, 0xF3, 0x48, 0x9A, 0x80, 0xC2, -+0xA0, 0xC2, 0x20, 0xE8, 0xFF, 0x6A, 0x10, 0xF0, -+0x23, 0x6B, 0xEE, 0xF3, 0x68, 0x9B, 0x4C, 0xEC, -+0x94, 0x34, 0x4C, 0xEC, 0x80, 0xC3, 0x60, 0xA3, -+0x6C, 0xEA, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x68, 0x09, 0xD5, -+0x8C, 0xE8, 0x7F, 0xF7, 0x1E, 0x6D, 0x00, 0x6C, -+0x00, 0x18, 0xB6, 0xC9, 0x62, 0x67, 0x67, 0xE8, -+0x01, 0x6A, 0x4C, 0xEB, 0x00, 0x6A, 0x2D, 0x23, -+0x0A, 0x28, 0x82, 0x67, 0x9F, 0xF7, 0x00, 0x6D, -+0x00, 0x18, 0xB6, 0xC9, 0x22, 0x67, 0x00, 0x6C, -+0x9F, 0xF7, 0x01, 0x6D, 0x09, 0x10, 0x00, 0x6C, -+0x9F, 0xF7, 0x02, 0x6D, 0x00, 0x18, 0xB6, 0xC9, -+0x22, 0x67, 0x00, 0x6C, 0x9F, 0xF7, 0x03, 0x6D, -+0x00, 0x18, 0xB6, 0xC9, 0x0F, 0x6B, 0x4C, 0xEB, -+0x60, 0x32, 0x2D, 0xEA, 0xFF, 0xF7, 0x1F, 0x6B, -+0x6C, 0xEA, 0x10, 0xF0, 0x23, 0x6B, 0x0E, 0xF3, -+0x64, 0x9B, 0x00, 0x30, 0x08, 0x30, 0x61, 0xE0, -+0x51, 0xE0, 0x09, 0x93, 0x04, 0x10, 0xA0, 0xA0, -+0x01, 0x48, 0xA0, 0xC3, 0x01, 0x4B, 0x8A, 0xE8, -+0xFA, 0x61, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0x00, 0x6C, -+0x7F, 0xF7, 0x1E, 0x6D, 0xAF, 0xF4, 0x18, 0x48, -+0x00, 0x18, 0xB6, 0xC9, 0xE1, 0xF3, 0x84, 0xA0, -+0x01, 0x6B, 0x47, 0xEC, 0x6C, 0xEA, 0x13, 0x22, -+0x30, 0xF0, 0x21, 0x6D, 0x90, 0xF2, 0x1C, 0x4D, -+0x00, 0x18, 0x59, 0xD3, 0xE1, 0xF3, 0x46, 0xC8, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x10, 0xF0, 0x00, 0x6C, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x6C, 0x7F, 0xF7, -+0x1E, 0x6D, 0x00, 0x18, 0xB6, 0xC9, 0x05, 0x97, -+0x30, 0xF0, 0x21, 0x6B, 0xB1, 0xF0, 0x40, 0xC3, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x7F, 0xF7, 0x1D, 0x68, -+0xB0, 0x67, 0x00, 0x6C, 0x00, 0x18, 0xB6, 0xC9, -+0x11, 0x6E, 0xCB, 0xEE, 0x4C, 0xEE, 0x20, 0x6A, -+0x4D, 0xEE, 0xFF, 0x6A, 0x4C, 0xEE, 0xB0, 0x67, -+0x00, 0x6C, 0x01, 0x48, 0x00, 0x18, 0xA9, 0xC9, -+0xB0, 0x67, 0x00, 0x6C, 0x00, 0x18, 0xB6, 0xC9, -+0xB0, 0x67, 0x00, 0x6C, 0x00, 0x18, 0xB6, 0xC9, -+0x60, 0x6E, 0xCB, 0xEE, 0x4D, 0xEE, 0xFF, 0x6A, -+0x4C, 0xEE, 0xB0, 0x67, 0x00, 0x6C, 0x00, 0x18, -+0xA9, 0xC9, 0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF3, -+0x6C, 0x9A, 0xFD, 0x6A, 0x30, 0xF0, 0x20, 0x69, -+0x80, 0xA3, 0x9F, 0xF6, 0x12, 0x48, 0x8C, 0xEA, -+0x40, 0xC3, 0xCE, 0xF4, 0x58, 0x99, 0x28, 0x6C, -+0x40, 0xEA, 0xB0, 0x67, 0x00, 0x6C, 0x00, 0x18, -+0xB6, 0xC9, 0xFE, 0x6E, 0x4C, 0xEE, 0xB0, 0x67, -+0x00, 0x6C, 0x00, 0x18, 0xA9, 0xC9, 0xCE, 0xF4, -+0x58, 0x99, 0xE0, 0xF3, 0x08, 0x6C, 0x40, 0xEA, -+0xB0, 0x67, 0x00, 0x6C, 0x00, 0x18, 0xB6, 0xC9, -+0x01, 0x6E, 0x4D, 0xEE, 0xFF, 0x6A, 0xB0, 0x67, -+0x00, 0x6C, 0x4C, 0xEE, 0x00, 0x18, 0xA9, 0xC9, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xAF, 0xF4, -+0x18, 0x48, 0xE1, 0xF3, 0x64, 0xA0, 0x01, 0x6A, -+0xFF, 0x6E, 0x44, 0xEB, 0x4C, 0xEE, 0x00, 0x6C, -+0x7F, 0xF7, 0x1E, 0x6D, 0x00, 0x18, 0xA9, 0xC9, -+0xE1, 0xF3, 0x44, 0xA0, 0x01, 0x6B, 0x05, 0x97, -+0x6E, 0xEA, 0xE1, 0xF3, 0x44, 0xC0, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, 0x18, 0x4A, -+0xE1, 0xF3, 0x6A, 0xA2, 0x01, 0x6C, 0x8E, 0xEB, -+0x05, 0x2B, 0xE1, 0xF3, 0x6A, 0xC2, 0x00, 0x18, -+0xC3, 0xD3, 0x10, 0x10, 0xE1, 0xF3, 0xC8, 0xA2, -+0xE1, 0xF3, 0x84, 0xA2, 0x01, 0x6B, 0xA6, 0x67, -+0xA7, 0xEC, 0x6C, 0xED, 0x07, 0x25, 0x6E, 0xEC, -+0xC7, 0xEC, 0x86, 0x67, 0x6C, 0xEC, 0x02, 0x24, -+0xE1, 0xF3, 0x69, 0xC2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0xF7, 0x1F, 0x6B, -+0x05, 0x67, 0x6C, 0xE8, 0xFF, 0x6A, 0x35, 0x58, -+0x4C, 0xEC, 0x40, 0x60, 0x0A, 0x35, 0x6C, 0xED, -+0x80, 0x36, 0x30, 0xF0, 0x20, 0x6B, 0xAF, 0xF4, -+0x18, 0x4B, 0xC4, 0x36, 0xD9, 0xE3, 0xAC, 0xEA, -+0xE0, 0xF7, 0x04, 0x4E, 0x00, 0x6B, 0x11, 0x10, -+0x30, 0xF0, 0x21, 0x6F, 0x91, 0xF0, 0xFD, 0xA7, -+0x10, 0xF0, 0x23, 0x69, 0xCE, 0xF2, 0x34, 0x99, -+0xE0, 0x37, 0xE8, 0x37, 0x3D, 0xE7, 0x68, 0x31, -+0x3D, 0xE7, 0x20, 0x9E, 0x01, 0x4B, 0x04, 0x4E, -+0x20, 0xDF, 0xFF, 0x6F, 0x23, 0x67, 0xEC, 0xE9, -+0x43, 0xE9, 0xEA, 0x61, 0x03, 0x6A, 0x0C, 0xEA, -+0xEC, 0xED, 0x3F, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xAF, 0xF4, 0x18, 0x4A, 0xE1, 0xF3, 0x65, 0xA2, -+0x10, 0xF0, 0x23, 0x6E, 0xCE, 0xF2, 0xD4, 0x9E, -+0x60, 0x33, 0x68, 0x33, 0x9C, 0x34, 0xCD, 0xE3, -+0xA8, 0x36, 0xB5, 0xE4, 0xE0, 0xF1, 0x18, 0x4D, -+0xA8, 0x35, 0xA9, 0xE2, 0x41, 0x9A, 0xCD, 0xE3, -+0x40, 0xDB, 0x27, 0x10, 0x80, 0x34, 0x30, 0xF0, -+0x21, 0x6A, 0x10, 0xF0, 0x23, 0x6B, 0xEE, 0xF3, -+0x70, 0x9B, 0x84, 0x34, 0x90, 0xF4, 0x1C, 0x4A, -+0x95, 0xE2, 0x30, 0xF0, 0x21, 0x6A, 0x91, 0xF0, -+0xDD, 0xA2, 0x6C, 0xED, 0x00, 0x6A, 0x10, 0xF0, -+0x23, 0x6B, 0x04, 0xD2, 0x05, 0xD2, 0xEE, 0xF3, -+0x74, 0x9B, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0x36, -+0xAE, 0xF2, 0x40, 0x9A, 0xC8, 0x36, 0x00, 0x6C, -+0x79, 0xE6, 0xF0, 0x67, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x44, 0x9A, 0x00, 0x6C, -+0x40, 0xEA, 0xFF, 0x69, 0xD0, 0x67, 0x00, 0x6C, -+0x7F, 0xF7, 0x1C, 0x6D, 0x2C, 0xEE, 0x00, 0x18, -+0xA9, 0xC9, 0x02, 0x36, 0x00, 0x6C, 0x7F, 0xF7, -+0x1D, 0x6D, 0x2C, 0xEE, 0x00, 0x18, 0xA9, 0xC9, -+0x30, 0xF0, 0x21, 0x6A, 0x91, 0xF0, 0x5D, 0xA2, -+0x01, 0x6E, 0x00, 0x6C, 0x02, 0x4A, 0xC4, 0xEA, -+0x7F, 0xF7, 0x1E, 0x6D, 0x2C, 0xEE, 0x00, 0x18, -+0xA9, 0xC9, 0x00, 0x68, 0x12, 0x10, 0x01, 0x6A, -+0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xE8, 0x4E, 0xF1, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x89, 0xF7, -+0x0D, 0x4A, 0x09, 0xE2, 0x40, 0xDB, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x01, 0x6C, -+0x40, 0xEA, 0x00, 0x6C, 0x7F, 0xF7, 0x1E, 0x6D, -+0x00, 0x18, 0xB6, 0xC9, 0x30, 0xF0, 0x20, 0x6B, -+0xAF, 0xF4, 0x18, 0x4B, 0xE1, 0xF3, 0x85, 0xA3, -+0xA2, 0x44, 0x47, 0xED, 0x01, 0x6D, 0xAC, 0xEA, -+0xDE, 0x2A, 0xAE, 0xEC, 0xE1, 0xF3, 0x85, 0xC3, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x45, 0x67, -+0x05, 0x63, 0x00, 0xEF, 0xBC, 0x63, 0x87, 0x62, -+0x86, 0xD1, 0x85, 0xD0, 0x30, 0xF0, 0x20, 0x69, -+0xAF, 0xF4, 0x18, 0x49, 0xE1, 0xF3, 0xA6, 0xA9, -+0x30, 0xF0, 0x21, 0x6C, 0x90, 0xF2, 0x1C, 0x4C, -+0x00, 0x18, 0xFD, 0xC3, 0x00, 0x18, 0xC3, 0xD3, -+0xE1, 0xF3, 0x84, 0xA1, 0x04, 0x00, 0xB0, 0x67, -+0x00, 0x18, 0x59, 0xD3, 0x11, 0x22, 0x90, 0x67, -+0xA2, 0x67, 0x00, 0x18, 0xFD, 0xC3, 0xE1, 0xF3, -+0x09, 0xA1, 0x01, 0x6A, 0x4E, 0xE8, 0x05, 0x28, -+0x00, 0x18, 0xC3, 0xD3, 0xE1, 0xF3, 0x09, 0xC1, -+0x03, 0x10, 0x01, 0x6A, 0xE1, 0xF3, 0x4A, 0xC1, -+0x87, 0x97, 0x86, 0x91, 0x85, 0x90, 0x44, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6B, -+0xAE, 0xF1, 0x70, 0x9B, 0xFF, 0x6A, 0x4C, 0xED, -+0xA0, 0xC3, 0xCC, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xE8, 0xF2, 0x5A, 0xC3, 0x10, 0xF0, 0x23, 0x6B, -+0xEE, 0xF3, 0x78, 0x9B, 0x40, 0xC3, 0x20, 0xE8, -+0xFF, 0x63, 0x01, 0xD0, 0xFF, 0x6A, 0x4C, 0xED, -+0x4C, 0xEE, 0x4C, 0xEF, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF3, 0x44, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, -+0x6C, 0xEC, 0x00, 0xAA, 0xE1, 0xF7, 0x1F, 0x6A, -+0x0C, 0xEA, 0x10, 0xF0, 0x23, 0x68, 0xEE, 0xF3, -+0x1C, 0x98, 0x51, 0xE4, 0x6C, 0xEC, 0x80, 0xC8, -+0x9C, 0x32, 0x10, 0xF0, 0x23, 0x6C, 0x0E, 0xF4, -+0x80, 0x9C, 0x10, 0xF0, 0x23, 0x68, 0x0E, 0xF4, -+0x04, 0x98, 0x91, 0xE2, 0x80, 0xAC, 0x01, 0xE2, -+0x00, 0x98, 0x6C, 0xEC, 0x05, 0x25, 0x10, 0xF0, -+0x00, 0x6D, 0xAB, 0xED, 0xAD, 0xEC, 0x6C, 0xEC, -+0xD8, 0xF0, 0x00, 0x6B, 0x8C, 0xEB, 0x10, 0xF0, -+0x23, 0x6C, 0x0E, 0xF4, 0x80, 0x9C, 0x91, 0xE2, -+0x60, 0xCC, 0x10, 0xF0, 0x23, 0x6B, 0x0E, 0xF4, -+0x68, 0x9B, 0x6D, 0xE2, 0x80, 0xA3, 0x01, 0x6B, -+0x8C, 0xEB, 0x05, 0x23, 0x03, 0xF7, 0x01, 0x6B, -+0x6B, 0xEB, 0x0C, 0xEB, 0x06, 0x10, 0x1F, 0xF7, -+0x01, 0x6B, 0x6B, 0xEB, 0x0C, 0xEB, 0xE0, 0x37, -+0xED, 0xEB, 0xFF, 0x76, 0x13, 0x60, 0x10, 0xF0, -+0x23, 0x6C, 0x0E, 0xF4, 0x8C, 0x9C, 0x80, 0xF4, -+0xC0, 0x36, 0x6C, 0xEC, 0x10, 0xF0, 0x23, 0x6B, -+0x0E, 0xF2, 0x78, 0x9B, 0x6D, 0xEE, 0x10, 0xF0, -+0x23, 0x6B, 0x0E, 0xF4, 0x64, 0x9B, 0x8D, 0xEE, -+0x6D, 0xE2, 0xC0, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x0E, 0xF4, 0x90, 0x9B, 0x7F, 0x6B, 0x91, 0xE2, -+0xA0, 0xA4, 0xAC, 0xEB, 0x60, 0xC4, 0x10, 0xF0, -+0x23, 0x6B, 0x0E, 0xF4, 0x74, 0x9B, 0x1C, 0x6C, -+0x80, 0xC3, 0x10, 0xF0, 0x23, 0x6B, 0x0E, 0xF4, -+0x78, 0x9B, 0x08, 0xF4, 0x13, 0x6C, 0x80, 0xCB, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF1, 0x84, 0x9B, -+0xF7, 0x6B, 0x91, 0xE2, 0xA0, 0xA4, 0xAC, 0xEB, -+0x60, 0xC4, 0x01, 0x90, 0x01, 0x63, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0x29, 0xF5, 0x51, 0xA2, -+0xFF, 0x63, 0x05, 0x5A, 0x36, 0x60, 0x10, 0xF0, -+0x23, 0x6B, 0x48, 0x32, 0x2E, 0xF1, 0x08, 0x4B, -+0x4D, 0xE3, 0x40, 0x9B, 0x00, 0xEA, 0x10, 0xF0, -+0x23, 0x6A, 0x0E, 0xF4, 0x5C, 0x9A, 0xFF, 0xF7, -+0x1F, 0x6B, 0x40, 0x9A, 0x1A, 0x10, 0x10, 0xF0, -+0x23, 0x6A, 0x0E, 0xF4, 0x5C, 0x9A, 0x09, 0x10, -+0x10, 0xF0, 0x23, 0x6A, 0x2E, 0xF4, 0x40, 0x9A, -+0x0D, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0x2E, 0xF4, -+0x40, 0x9A, 0x40, 0x9A, 0x50, 0x32, 0x00, 0xF5, -+0x42, 0x32, 0x08, 0x10, 0x10, 0xF0, 0x23, 0x6A, -+0x2E, 0xF4, 0x44, 0x9A, 0x40, 0x9A, 0xE1, 0xF7, -+0x1F, 0x6B, 0x6C, 0xEA, 0x00, 0xD2, 0x00, 0x93, -+0xE0, 0xF3, 0x08, 0x6A, 0x60, 0x33, 0x68, 0x33, -+0x5B, 0xEB, 0x01, 0x2A, 0xE5, 0xE8, 0x12, 0xEA, -+0x01, 0x10, 0x66, 0x6A, 0x00, 0xD2, 0x00, 0x92, -+0x01, 0x63, 0x20, 0xE8, 0xFF, 0x63, 0x01, 0xD0, -+0x0C, 0x2C, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF1, -+0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, 0x2E, 0xF4, -+0x88, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x58, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x4F, 0xF5, -+0xDC, 0x9A, 0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF5, -+0x18, 0x4A, 0x00, 0x6D, 0x18, 0x6F, 0xF8, 0xED, -+0x30, 0xF0, 0x20, 0x6B, 0xAF, 0xF4, 0x18, 0x4B, -+0x12, 0xEF, 0x6D, 0xE7, 0xA0, 0xF0, 0x14, 0xA3, -+0x01, 0x6F, 0xEC, 0xE8, 0x23, 0x20, 0xA0, 0xF0, -+0x74, 0xA3, 0x66, 0x33, 0xEC, 0xEB, 0xFF, 0x6F, -+0xEC, 0xEB, 0x1C, 0x23, 0xFF, 0xF7, 0x78, 0x9A, -+0x9B, 0xEB, 0x01, 0x2C, 0xE5, 0xE8, 0x12, 0xEB, -+0xFF, 0xF7, 0x7C, 0xDA, 0x10, 0xEF, 0x03, 0x27, -+0x01, 0x4B, 0xFF, 0xF7, 0x7C, 0xDA, 0x60, 0x9A, -+0x78, 0xEE, 0x12, 0xEB, 0x9B, 0xEB, 0x01, 0x2C, -+0xE5, 0xE8, 0x12, 0xEB, 0x60, 0xDA, 0xFF, 0xF7, -+0x7C, 0x9A, 0x04, 0x2B, 0x01, 0x6F, 0xFF, 0xF7, -+0xFC, 0xDA, 0x60, 0xDA, 0x01, 0x4D, 0x0A, 0x75, -+0x18, 0x4A, 0xCC, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xAF, 0xF4, 0x18, 0x4A, 0xA0, 0xF0, 0x68, 0x9A, -+0xA0, 0xF0, 0x84, 0xDA, 0x7B, 0xEC, 0x01, 0x2B, -+0xE5, 0xE8, 0x12, 0xEB, 0xA0, 0xF0, 0x6C, 0xDA, -+0x78, 0x67, 0xA0, 0xF0, 0x70, 0xDA, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF3, -+0x88, 0xA2, 0x02, 0x6B, 0x8D, 0xEB, 0x69, 0xF3, -+0x68, 0xC2, 0x01, 0x90, 0x01, 0x63, 0x20, 0xE8, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x69, 0xF3, 0x48, 0xA0, 0x03, 0x6B, 0x4C, 0xEB, -+0x00, 0x6A, 0x33, 0x2B, 0x10, 0xF0, 0x23, 0x6A, -+0x2E, 0xF4, 0x4C, 0x9A, 0x30, 0xF0, 0x20, 0x69, -+0x30, 0xF0, 0x20, 0x6C, 0x60, 0xC2, 0x4E, 0xF2, -+0x4C, 0x99, 0x29, 0xF5, 0x10, 0x4C, 0x00, 0x6D, -+0xD4, 0x6E, 0x40, 0xEA, 0x4E, 0xF2, 0x4C, 0x99, -+0x30, 0xF0, 0x20, 0x6C, 0xFF, 0x6E, 0x4F, 0xF5, -+0x1C, 0x4C, 0x00, 0x6D, 0x01, 0x4E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, 0x18, 0x4A, -+0x01, 0x6B, 0x66, 0x6C, 0xA0, 0xF0, 0x68, 0xDA, -+0xA0, 0xF0, 0x84, 0xDA, 0xA0, 0xF0, 0x8C, 0xDA, -+0x01, 0x6A, 0x4B, 0xEA, 0x69, 0xF3, 0x88, 0xA0, -+0x69, 0xF3, 0x49, 0xC0, 0x7D, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x6D, 0xEA, 0x69, 0xF3, 0x48, 0xC0, -+0x43, 0x67, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x69, 0xF3, 0x88, 0xA0, 0x01, 0x6B, -+0x00, 0x6A, 0x8C, 0xEB, 0x24, 0x23, 0x10, 0xF0, -+0x23, 0x6A, 0x2E, 0xF4, 0x4C, 0x9A, 0x00, 0x6B, -+0x60, 0xC2, 0x03, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0x69, 0xF3, 0x48, 0xC0, 0x00, 0x18, 0xA2, 0xD4, -+0x04, 0xD2, 0x04, 0x94, 0x00, 0x18, 0xC3, 0xD4, -+0x69, 0xF3, 0x68, 0xA0, 0x02, 0x6A, 0x42, 0xF1, -+0x1C, 0x6C, 0x6D, 0xEA, 0x69, 0xF3, 0x48, 0xC0, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x50, 0x9A, 0x6F, 0xF5, 0xC0, 0x9B, -+0x01, 0x6D, 0x40, 0xEA, 0x01, 0x6A, 0x07, 0x97, -+0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x69, 0xF3, 0xA8, 0xA3, 0x02, 0x6C, 0x00, 0x6A, -+0xAC, 0xEC, 0x0C, 0x24, 0x10, 0xF0, 0x23, 0x6A, -+0x2E, 0xF4, 0x4C, 0x9A, 0x00, 0x6C, 0x80, 0xC2, -+0x03, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0x69, 0xF3, -+0x48, 0xC3, 0x01, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0x00, 0x6A, 0x18, 0x6C, 0x98, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xAF, 0xF4, 0x18, 0x4B, 0x01, 0x4A, -+0x0A, 0x72, 0x12, 0xEC, 0x71, 0xE4, 0xA0, 0xF0, -+0xB4, 0xA4, 0x02, 0x6B, 0x6B, 0xEB, 0xAC, 0xEB, -+0xA0, 0xF0, 0x74, 0xC4, 0xEE, 0x61, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0x29, 0xF5, 0x50, 0xA2, -+0x01, 0x6B, 0x4C, 0xEB, 0x00, 0x6A, 0x1C, 0x23, -+0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF5, 0x1C, 0x4A, -+0x00, 0x6B, 0xA0, 0x9A, 0x8E, 0xED, 0x0F, 0x2D, -+0x18, 0x6E, 0xD8, 0xEB, 0x30, 0xF0, 0x20, 0x6D, -+0xAF, 0xF4, 0x18, 0x4D, 0x12, 0xEE, 0xB9, 0xE6, -+0xA0, 0xF0, 0xF4, 0xA6, 0x02, 0x6D, 0xAB, 0xED, -+0xEC, 0xED, 0xA0, 0xF0, 0xB4, 0xC6, 0x01, 0x4B, -+0x0A, 0x73, 0x18, 0x4A, 0xEA, 0x61, 0x01, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x5D, 0x67, 0x20, 0xF0, -+0x78, 0xA2, 0x30, 0xF0, 0x20, 0x6A, 0x0A, 0xD4, -+0x29, 0xF5, 0x90, 0xA2, 0x01, 0x6A, 0x00, 0xF6, -+0xE0, 0x31, 0x8C, 0xEA, 0x0B, 0xD5, 0x0C, 0xD6, -+0x00, 0xF6, 0x23, 0x31, 0x80, 0xF0, 0x0E, 0x22, -+0x24, 0x23, 0x01, 0x73, 0x80, 0xF0, 0x0A, 0x61, -+0x0A, 0x93, 0x80, 0xF0, 0x07, 0x23, 0x10, 0xF0, -+0x23, 0x6A, 0x2E, 0xF4, 0x50, 0x9A, 0xC3, 0xEA, -+0x80, 0xF0, 0x00, 0x61, 0x7F, 0x71, 0x7E, 0x60, -+0xFF, 0xF7, 0x1F, 0x51, 0x7B, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x4F, 0xF5, 0x1C, 0x9A, 0x1B, 0xEE, -+0x01, 0x28, 0xE5, 0xE8, 0x10, 0xEA, 0x12, 0xE8, -+0x02, 0x22, 0x01, 0x48, 0x04, 0x10, 0x03, 0x28, -+0x01, 0x68, 0x50, 0x67, 0x1F, 0x10, 0x01, 0x6B, -+0x20, 0x10, 0x0A, 0x95, 0x67, 0x25, 0x10, 0xF0, -+0x23, 0x6A, 0x2E, 0xF4, 0x50, 0x9A, 0x0C, 0x96, -+0xC3, 0xEA, 0x60, 0x61, 0x7F, 0x71, 0x5E, 0x60, -+0xFF, 0xF7, 0x1F, 0x51, 0x5B, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x6F, 0xF5, 0x00, 0x9A, 0x1B, 0xEE, -+0x01, 0x28, 0xE5, 0xE8, 0x10, 0xEA, 0x12, 0xE8, -+0x02, 0x22, 0x01, 0x48, 0x05, 0x10, 0x04, 0x28, -+0x01, 0x68, 0x00, 0x6A, 0x04, 0xD2, 0x02, 0x10, -+0x00, 0x6B, 0x04, 0xD3, 0x0A, 0x94, 0x00, 0x18, -+0x4C, 0xD5, 0x00, 0x6C, 0xFF, 0x6E, 0xA4, 0x67, -+0xCC, 0xED, 0x1D, 0x65, 0x18, 0x6D, 0xB8, 0xEC, -+0x30, 0xF0, 0x20, 0x6B, 0xAF, 0xF4, 0x18, 0x4B, -+0x01, 0x6D, 0x12, 0xEA, 0x69, 0xE2, 0xA0, 0xF0, -+0x54, 0xA2, 0xAC, 0xEA, 0xCC, 0xEA, 0x2F, 0x2A, -+0xD8, 0x67, 0x18, 0x6F, 0xF8, 0xEE, 0x04, 0x96, -+0xC4, 0x36, 0x04, 0xD6, 0x03, 0x6E, 0xCB, 0xEE, -+0x12, 0xEC, 0x71, 0xE4, 0xA0, 0xF0, 0xF4, 0xA4, -+0xEC, 0xEE, 0x04, 0x97, 0xED, 0xEE, 0xA0, 0xF0, -+0xD4, 0xC4, 0x0A, 0x96, 0xC0, 0xF0, 0xC4, 0xDC, -+0x0B, 0x97, 0xC0, 0xF0, 0xE8, 0xDC, 0x0C, 0x96, -+0x18, 0x6F, 0xA0, 0xF0, 0xD8, 0xDC, 0xD8, 0x67, -+0x01, 0x4E, 0xF8, 0xEE, 0x12, 0xEE, 0xCD, 0xE3, -+0xA0, 0xF0, 0x48, 0xDB, 0xA0, 0xF0, 0x04, 0xDB, -+0xA0, 0xF0, 0x56, 0xC4, 0xA0, 0xF0, 0x54, 0xA4, -+0xA0, 0xF0, 0x37, 0xC4, 0x4D, 0xED, 0xA0, 0xF0, -+0xB4, 0xC4, 0x01, 0x6A, 0x04, 0x10, 0x01, 0x4C, -+0x0A, 0x74, 0xBC, 0x61, 0x00, 0x6A, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x06, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF5, -+0x18, 0x4A, 0x00, 0x6C, 0x2C, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6F, 0xF5, 0x18, 0x4A, 0x00, 0x6B, -+0x18, 0x6D, 0xB8, 0xEB, 0x30, 0xF0, 0x20, 0x6C, -+0xAF, 0xF4, 0x18, 0x4C, 0x12, 0xED, 0x91, 0xE5, -+0xA0, 0xF0, 0xD4, 0xA4, 0x01, 0x6D, 0xAC, 0xEE, -+0x08, 0x26, 0xA0, 0xF0, 0x94, 0xA4, 0x86, 0x34, -+0xAC, 0xEC, 0x03, 0x24, 0x80, 0x9A, 0x01, 0x4C, -+0x80, 0xDA, 0x01, 0x4B, 0x0A, 0x73, 0x18, 0x4A, -+0xE7, 0x61, 0x00, 0x18, 0xA2, 0xD4, 0x04, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0x04, 0x93, 0x4F, 0xF5, -+0x5C, 0x9A, 0x6E, 0xEA, 0x54, 0x22, 0x04, 0x94, -+0x00, 0x18, 0xC3, 0xD4, 0x50, 0x10, 0x18, 0x6D, -+0xB8, 0xEC, 0x30, 0xF0, 0x20, 0x6B, 0xAF, 0xF4, -+0x18, 0x4B, 0x12, 0xED, 0x6D, 0xE5, 0xA0, 0xF0, -+0xD4, 0xA3, 0x01, 0x6D, 0xAC, 0xEE, 0x0A, 0x26, -+0xA0, 0xF0, 0x74, 0xA3, 0x66, 0x33, 0xAC, 0xEB, -+0xFF, 0x6D, 0xAC, 0xEB, 0x03, 0x2B, 0x60, 0x9A, -+0x01, 0x4B, 0x60, 0xDA, 0x01, 0x4C, 0x0A, 0x74, -+0x18, 0x4A, 0xE5, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x29, 0xF5, 0x51, 0xA2, 0xFF, 0x72, 0x2F, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, 0x18, 0x4A, -+0xA0, 0xF0, 0x70, 0x9A, 0x01, 0x4B, 0xA0, 0xF0, -+0x70, 0xDA, 0x7C, 0x4A, 0x4C, 0x9A, 0x4E, 0xEB, -+0x22, 0x2B, 0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF5, -+0x18, 0x4A, 0x18, 0x6D, 0xB8, 0xEB, 0x30, 0xF0, -+0x20, 0x6C, 0xAF, 0xF4, 0x18, 0x4C, 0x12, 0xED, -+0x91, 0xE5, 0xA0, 0xF0, 0xD4, 0xA4, 0x01, 0x6D, -+0xAC, 0xEE, 0x08, 0x26, 0xA0, 0xF0, 0x94, 0xA4, -+0x86, 0x34, 0xAC, 0xEC, 0x03, 0x24, 0x80, 0x9A, -+0x01, 0x4C, 0x80, 0xDA, 0x01, 0x4B, 0x0A, 0x73, -+0x18, 0x4A, 0xE7, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x78, 0x67, 0x6F, 0xF5, 0x68, 0xDA, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x6C, 0x9A, 0x02, 0xF0, 0x00, 0x6C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x07, 0x97, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x23, 0x6B, -+0x4E, 0xF1, 0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xEA, 0xF7, 0x1D, 0x4A, 0x30, 0xF0, 0x20, 0x68, -+0x40, 0xDB, 0x6F, 0xF5, 0x0E, 0x48, 0x00, 0x69, -+0x18, 0x6A, 0x58, 0xE9, 0x30, 0xF0, 0x20, 0x6B, -+0xAF, 0xF4, 0x18, 0x4B, 0x12, 0xEA, 0x69, 0xE2, -+0xA0, 0xF0, 0x94, 0xA2, 0x01, 0x6B, 0x8C, 0xEB, -+0x27, 0x23, 0x00, 0xF0, 0x8A, 0x98, 0x00, 0xF0, -+0x66, 0x98, 0x63, 0xEC, 0x21, 0x61, 0x61, 0x80, -+0x81, 0x43, 0x04, 0xD4, 0x07, 0x2C, 0x00, 0xF0, -+0x4E, 0x98, 0x00, 0xF0, 0x92, 0x98, 0x40, 0xEA, -+0x04, 0x92, 0x14, 0x10, 0x80, 0xA0, 0x01, 0x4C, -+0x80, 0xC0, 0x80, 0xA0, 0x82, 0xEB, 0x08, 0x60, -+0xA0, 0xF0, 0x94, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xA0, 0xF0, 0x74, 0xC2, 0x08, 0x10, -+0x00, 0xF0, 0x4E, 0x98, 0x00, 0xF0, 0x92, 0x98, -+0x40, 0xEA, 0x00, 0x6A, 0x00, 0xF0, 0x4A, 0xD8, -+0x01, 0x49, 0x0A, 0x71, 0x18, 0x48, 0xC8, 0x61, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xE0, 0x63, 0x3F, 0x62, -+0xFF, 0xF7, 0x1F, 0x6A, 0xAC, 0xEA, 0xBD, 0x67, -+0x56, 0xC5, 0x01, 0x6B, 0x42, 0x32, 0x57, 0xC5, -+0x6B, 0xEB, 0x30, 0xF0, 0x20, 0x6A, 0x70, 0xC5, -+0xAE, 0xF2, 0x5C, 0x9A, 0x03, 0x6B, 0x72, 0xC5, -+0x04, 0x6B, 0x94, 0xC5, 0x73, 0xC5, 0x04, 0x04, -+0x40, 0xEA, 0x3F, 0x97, 0x20, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0xA7, 0x44, 0x30, 0xF0, -+0x20, 0x6C, 0x01, 0x4D, 0xAC, 0xF0, 0x08, 0x4C, -+0x14, 0x6E, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x24, 0x67, 0x00, 0x18, -+0x34, 0xD6, 0x47, 0xA1, 0x66, 0xA1, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x40, 0x32, -+0xEB, 0xF6, 0x80, 0xA0, 0x69, 0xE2, 0x01, 0x69, -+0xEB, 0xF6, 0x52, 0xC8, 0x51, 0x67, 0x8C, 0xEA, -+0xFF, 0x6B, 0x1C, 0x2A, 0xEB, 0xF6, 0xB4, 0xA0, -+0xFE, 0x4A, 0xAC, 0xEA, 0xEB, 0xF6, 0x54, 0xC0, -+0x02, 0x6A, 0x8C, 0xEA, 0x6C, 0xEA, 0x51, 0x22, -+0xEB, 0xF6, 0x43, 0xA0, 0x0F, 0x6D, 0xEB, 0xF6, -+0x84, 0xA0, 0x4C, 0xED, 0x52, 0x36, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, 0x6C, 0xED, -+0x6C, 0xEE, 0x40, 0xEA, 0x01, 0x72, 0x0D, 0x6A, -+0x41, 0x61, 0x3F, 0x10, 0xEB, 0xF6, 0x74, 0xA0, -+0xEB, 0xF6, 0xF0, 0xA8, 0x02, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x00, 0xF1, 0x01, 0x5F, 0xEB, 0xF6, -+0x54, 0xC0, 0x0C, 0x6A, 0x33, 0x60, 0x00, 0x6A, -+0xEB, 0xF6, 0x55, 0xC0, 0xEB, 0xF6, 0x56, 0xC0, -+0x00, 0x6A, 0xEB, 0xF6, 0x58, 0xC8, 0xEB, 0xF6, -+0x5A, 0xC8, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF3, -+0x44, 0x9A, 0xEB, 0xF6, 0xC1, 0xA0, 0x10, 0xF0, -+0x23, 0x6D, 0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x6A, -+0x2E, 0xF4, 0xB4, 0x9D, 0x6C, 0xEA, 0xD9, 0xE2, -+0xDC, 0x36, 0x00, 0x6A, 0xB5, 0xE6, 0x10, 0xF0, -+0x23, 0x6E, 0x04, 0xD2, 0x05, 0xD2, 0xEE, 0xF1, -+0xCC, 0x9E, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xAE, 0xF2, 0x40, 0x9A, 0xCC, 0xF0, -+0x0E, 0x4B, 0x00, 0x6C, 0xD9, 0xE3, 0x40, 0xEA, -+0xEB, 0xF6, 0x54, 0xA0, 0x4D, 0xE9, 0xEB, 0xF6, -+0x34, 0xC0, 0x00, 0x6A, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0xEB, 0xF6, -+0xB8, 0xA8, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x4E, 0xF2, 0x50, 0x9A, 0xCC, 0xF0, -+0x0E, 0x4B, 0x30, 0xF0, 0x20, 0x6C, 0xB5, 0xE3, -+0xCC, 0xF0, 0x08, 0x4C, 0x04, 0x6E, 0x40, 0xEA, -+0x0B, 0xF7, 0x63, 0xA0, 0x80, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x05, 0x2A, -+0xEB, 0xF6, 0x58, 0xA8, 0x04, 0x4A, 0xEB, 0xF6, -+0x58, 0xC8, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x0B, 0xF7, 0x61, 0xA0, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, 0x0B, 0xF7, -+0x80, 0xA0, 0x0F, 0x6D, 0x6C, 0xED, 0x72, 0x36, -+0x40, 0xEA, 0x0E, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x54, 0x9A, 0x40, 0xEA, 0xEB, 0xF6, -+0x74, 0xA0, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0xEB, 0xF6, 0x54, 0xC0, 0x01, 0x6C, 0x56, 0x10, -+0x0B, 0xF7, 0x63, 0xA0, 0x7F, 0x6A, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x18, 0x22, 0x01, 0x72, -+0x45, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, -+0x4C, 0x9A, 0x00, 0x6C, 0x40, 0xEA, 0x49, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF3, 0x50, 0x9A, -+0xCB, 0xF6, 0x9D, 0xA0, 0x00, 0x6D, 0x40, 0xEA, -+0x06, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, -+0x54, 0x9A, 0x40, 0xEA, 0x3A, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, -+0x75, 0xA2, 0x0B, 0xF7, 0x82, 0xA2, 0x01, 0x4B, -+0xEB, 0xF6, 0x75, 0xC2, 0xEB, 0xF6, 0x7A, 0xAA, -+0x6D, 0xE4, 0xEB, 0xF6, 0x7A, 0xCA, 0xEB, 0xF6, -+0x95, 0xA2, 0xEB, 0xF6, 0x62, 0xA2, 0x8E, 0xEB, -+0x09, 0x2B, 0x10, 0xF0, 0x23, 0x6C, 0x0B, 0xF7, -+0xC2, 0xA2, 0x6B, 0xF3, 0x09, 0x4C, 0x04, 0xD3, -+0x00, 0x6D, 0x09, 0x10, 0x0B, 0xF7, 0xC2, 0xA2, -+0x10, 0xF0, 0x23, 0x6C, 0x00, 0x6A, 0x04, 0xD2, -+0x4B, 0xF3, 0x0D, 0x4C, 0xA2, 0x67, 0x64, 0x6A, -+0x58, 0xEE, 0x01, 0x6F, 0x12, 0xEE, 0x00, 0x18, -+0x5F, 0xD5, 0x1B, 0x10, 0xEB, 0xF6, 0x74, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xEB, 0xF6, -+0x54, 0xC0, 0x02, 0x6C, 0xEB, 0xF6, 0xB2, 0xA8, -+0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xEB, 0xF6, 0x94, 0xA2, 0x02, 0x6B, -+0x6B, 0xEB, 0xEB, 0xF6, 0xB2, 0xAA, 0x8C, 0xEB, -+0xEB, 0xF6, 0x74, 0xC2, 0x03, 0x6C, 0x00, 0x18, -+0x27, 0xD6, 0x07, 0x97, 0x06, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAC, 0xF0, 0x7C, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0x7A, 0xD6, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x69, 0xC0, 0xF1, 0x08, 0x49, -+0xEB, 0xF6, 0x94, 0xA1, 0x01, 0x6A, 0xFF, 0x6B, -+0x8C, 0xEA, 0x00, 0xF1, 0x0C, 0x22, 0xEB, 0xF6, -+0xA0, 0xA1, 0x03, 0x6E, 0xAE, 0x32, 0xCC, 0xEA, -+0x6C, 0xEA, 0x02, 0x72, 0x7E, 0x60, 0x06, 0x67, -+0x4E, 0xE8, 0xE0, 0xF0, 0x02, 0x20, 0x01, 0x72, -+0x25, 0x60, 0x02, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0xEB, 0xF6, 0x54, 0xC1, 0x02, 0x6A, 0xAC, 0xEA, -+0x6C, 0xEA, 0x11, 0x22, 0xEB, 0xF6, 0x43, 0xA1, -+0x0F, 0x6D, 0xEB, 0xF6, 0x84, 0xA1, 0x4C, 0xED, -+0x52, 0x36, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x54, 0x9A, 0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, -+0x01, 0x72, 0x01, 0x6C, 0x01, 0x61, 0x00, 0x6C, -+0xEB, 0xF6, 0xB2, 0xA9, 0x00, 0x18, 0x27, 0xD6, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0xD9, 0x10, 0x02, 0x6A, 0xAC, 0xEA, -+0x6C, 0xEA, 0x11, 0x22, 0xEB, 0xF6, 0x43, 0xA1, -+0x0F, 0x6D, 0xEB, 0xF6, 0x84, 0xA1, 0x4C, 0xED, -+0x52, 0x36, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x54, 0x9A, 0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, -+0x01, 0x72, 0xA0, 0xF0, 0x14, 0x61, 0xEB, 0xF6, -+0xB2, 0xA9, 0x00, 0x6C, 0x00, 0x18, 0x27, 0xD6, -+0x30, 0xF0, 0x20, 0x6A, 0xAC, 0xF0, 0x4D, 0xA2, -+0x5A, 0x33, 0x02, 0x73, 0x0D, 0x60, 0x03, 0x73, -+0x0F, 0x60, 0x01, 0x73, 0x05, 0x60, 0x3F, 0x6E, -+0x4C, 0xEE, 0xFF, 0x6A, 0x4C, 0xEE, 0x0E, 0x10, -+0x3F, 0x6B, 0x4C, 0xEB, 0x0A, 0x6E, 0x08, 0x10, -+0x3F, 0x6B, 0x4C, 0xEB, 0x64, 0x6E, 0x04, 0x10, -+0x3F, 0x6B, 0x4C, 0xEB, 0xE0, 0xF3, 0x08, 0x6E, -+0xD8, 0xEB, 0x12, 0xEE, 0x0A, 0x6A, 0x58, 0xEE, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xEB, 0xF6, 0x7A, 0xAA, 0x10, 0xF0, 0x23, 0x6C, -+0x4B, 0xF3, 0x0D, 0x4C, 0x12, 0xEE, 0x7B, 0xE6, -+0x00, 0x6B, 0xEB, 0xF6, 0x75, 0xC2, 0x00, 0x6B, -+0xEB, 0xF6, 0x7A, 0xCA, 0xEB, 0xF6, 0x78, 0xCA, -+0x00, 0x6A, 0x04, 0xD2, 0xA2, 0x67, 0x64, 0x6A, -+0x62, 0x10, 0x02, 0x6A, 0xAC, 0xEA, 0x6C, 0xEA, -+0x10, 0x22, 0xEB, 0xF6, 0x43, 0xA1, 0x0F, 0x6D, -+0xEB, 0xF6, 0x84, 0xA1, 0x4C, 0xED, 0x52, 0x36, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, -+0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x01, 0x72, -+0x62, 0x61, 0xEB, 0xF6, 0xB2, 0xA9, 0x00, 0x6C, -+0x00, 0x18, 0x27, 0xD6, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, 0x87, 0xA2, -+0xEB, 0xF6, 0x76, 0xA2, 0xFF, 0x4C, 0x6E, 0xEC, -+0x03, 0x2C, 0xEB, 0xF6, 0x66, 0xA2, 0x05, 0x10, -+0x01, 0x4B, 0xEB, 0xF6, 0x76, 0xC2, 0xEB, 0xF6, -+0x65, 0xA2, 0x7A, 0x32, 0x02, 0x72, 0x0D, 0x60, -+0x03, 0x72, 0x0F, 0x60, 0x01, 0x72, 0x05, 0x60, -+0x3F, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x0E, 0x10, 0x3F, 0x6A, 0x6C, 0xEA, 0x0A, 0x6B, -+0x08, 0x10, 0x3F, 0x6A, 0x6C, 0xEA, 0x64, 0x6B, -+0x04, 0x10, 0x3F, 0x6A, 0x6C, 0xEA, 0xE0, 0xF3, -+0x08, 0x6B, 0x78, 0xEA, 0x12, 0xEA, 0x0A, 0x6B, -+0x78, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0xCC, 0xF0, -+0x62, 0xAB, 0x00, 0x6C, 0x64, 0x6E, 0x12, 0xEA, -+0x6B, 0xE2, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0xEB, 0xF6, 0x95, 0xC3, 0x00, 0x6C, -+0xEB, 0xF6, 0x9A, 0xCB, 0xEB, 0xF6, 0x98, 0xCB, -+0x00, 0x6B, 0x10, 0xF0, 0x23, 0x6C, 0x04, 0xD3, -+0x4B, 0xF3, 0x0D, 0x4C, 0xA3, 0x67, 0xD8, 0xEA, -+0x01, 0x6F, 0x12, 0xEE, 0x00, 0x18, 0x5F, 0xD5, -+0x1E, 0x10, 0xEB, 0xF6, 0xB2, 0xA9, 0x00, 0x6C, -+0x00, 0x18, 0x27, 0xD6, 0xEB, 0xF6, 0x15, 0xC1, -+0xEB, 0xF6, 0x1A, 0xC9, 0xEB, 0xF6, 0x18, 0xC9, -+0x00, 0x18, 0xD3, 0xD6, 0x10, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, -+0x94, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, 0xEB, 0xF6, -+0xB2, 0xAA, 0x8C, 0xEB, 0xEB, 0xF6, 0x74, 0xC2, -+0x01, 0x6C, 0x00, 0x18, 0x27, 0xD6, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x04, 0x67, 0x25, 0x67, 0x4C, 0xEE, -+0x4C, 0xE8, 0x4C, 0xE9, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x4C, 0x9A, 0x04, 0xD6, 0x90, 0x67, -+0xB1, 0x67, 0x40, 0xEA, 0x90, 0x67, 0x80, 0x18, -+0x87, 0x0A, 0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF6, -+0x63, 0xA2, 0x00, 0x6A, 0x09, 0x2B, 0x04, 0x97, -+0x30, 0xF0, 0x20, 0x6C, 0x25, 0xF6, 0x08, 0x4C, -+0xB0, 0x67, 0xD1, 0x67, 0x80, 0x18, 0x10, 0x0A, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6D, 0x8C, 0xED, 0x18, 0x4D, 0x01, 0x6A, -+0x44, 0xED, 0x00, 0x6C, 0xA2, 0x67, 0x00, 0x18, -+0xFB, 0xCF, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xDE, 0x63, 0x43, 0x62, 0x42, 0xD1, 0x41, 0xD0, -+0x01, 0x6A, 0x7D, 0x67, 0x4B, 0xEA, 0x54, 0xC3, -+0x0F, 0x6A, 0x56, 0xC3, 0x10, 0x6A, 0x57, 0xC3, -+0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF3, 0x58, 0x9A, -+0xFF, 0x69, 0x8C, 0xE9, 0x30, 0x31, 0x49, 0xE1, -+0x40, 0x9A, 0x30, 0xF0, 0x20, 0x68, 0x06, 0x04, -+0x04, 0xD2, 0x4E, 0xF2, 0x50, 0x98, 0x04, 0x05, -+0x04, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF4, 0x44, 0x9A, 0x07, 0x04, 0x04, 0x05, -+0x49, 0xE1, 0x40, 0x9A, 0x04, 0x6E, 0x04, 0xD2, -+0x4E, 0xF2, 0x50, 0x98, 0x40, 0xEA, 0x10, 0xF0, -+0x23, 0x6A, 0x6E, 0xF4, 0x48, 0x9A, 0x08, 0x04, -+0x04, 0x05, 0x49, 0xE1, 0x40, 0x9A, 0x04, 0x6E, -+0x04, 0xD2, 0x4E, 0xF2, 0x50, 0x98, 0x40, 0xEA, -+0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF4, 0x4C, 0x9A, -+0x09, 0x04, 0x04, 0x05, 0x45, 0xE1, 0x40, 0x99, -+0x04, 0x6E, 0x04, 0xD2, 0x4E, 0xF2, 0x50, 0x98, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x05, 0x04, 0x40, 0xEA, 0x43, 0x97, -+0x42, 0x91, 0x41, 0x90, 0x22, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x23, 0x6A, 0x10, 0xF0, 0x23, 0x6B, -+0x6E, 0xF4, 0x50, 0x9A, 0x6E, 0xF4, 0x74, 0x9B, -+0x00, 0xA2, 0x20, 0xA3, 0xFF, 0x6A, 0x4C, 0xE8, -+0x4C, 0xE9, 0x2A, 0xE8, 0x43, 0x60, 0x10, 0xF0, -+0x23, 0x6A, 0x4E, 0xF3, 0x58, 0x9A, 0x10, 0x33, -+0x49, 0xE3, 0x40, 0xA2, 0xFF, 0x6B, 0x6C, 0xEA, -+0x56, 0x32, 0x6C, 0xEA, 0x07, 0x5A, 0x2C, 0x60, -+0x10, 0xF0, 0x23, 0x6B, 0x48, 0x32, 0x2E, 0xF1, -+0x1C, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, 0x00, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF6, 0x43, 0xA2, -+0x1F, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x54, 0x9A, 0x18, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x5C, 0x9A, 0x13, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x40, 0x9A, 0x0E, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x44, 0x9A, -+0x09, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x48, 0x9A, 0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x4C, 0x9A, 0x90, 0x67, 0x40, 0xEA, -+0x01, 0x48, 0x7F, 0x6A, 0x4C, 0xE8, 0x0A, 0xE9, -+0xC2, 0x61, 0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF4, -+0x50, 0x9A, 0x20, 0xC2, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF4, 0x78, 0x9A, -+0x02, 0x6C, 0x00, 0xF4, 0x00, 0x6D, 0x40, 0x9B, -+0x30, 0xF0, 0x20, 0x69, 0x8D, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xAE, 0xF3, 0x7C, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6C, 0x40, 0xAB, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xCB, 0x10, 0xF0, -+0x23, 0x6A, 0x6E, 0xF4, 0x1C, 0x9A, 0x10, 0xF0, -+0x23, 0x6B, 0x8E, 0xF4, 0x00, 0x4B, 0x40, 0x98, -+0x60, 0x9B, 0x0A, 0x6C, 0x6C, 0xEA, 0x10, 0xF0, -+0x23, 0x6B, 0x0E, 0xF2, 0x78, 0x9B, 0x6D, 0xEA, -+0x40, 0xD8, 0xCE, 0xF4, 0x5C, 0x99, 0x40, 0xEA, -+0x40, 0x98, 0xDF, 0xF7, 0x01, 0x6B, 0x6B, 0xEB, -+0x6C, 0xEA, 0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF4, -+0x64, 0x9B, 0x0A, 0x6C, 0x6D, 0xEA, 0x40, 0xD8, -+0xCE, 0xF4, 0x5C, 0x99, 0x40, 0xEA, 0x10, 0xF0, -+0x23, 0x6C, 0x8E, 0xF4, 0x00, 0x4C, 0x40, 0x98, -+0x80, 0x9C, 0x8C, 0xEA, 0x40, 0xD8, 0xCE, 0xF4, -+0x5C, 0x99, 0x0A, 0x6C, 0x40, 0xEA, 0x40, 0x98, -+0x1D, 0xF0, 0x01, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF4, 0x68, 0x9B, -+0x0A, 0x6C, 0x6D, 0xEA, 0x40, 0xD8, 0xCE, 0xF4, -+0x5C, 0x99, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF4, 0x5C, 0x9A, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x80, 0xA2, 0xEB, 0xF6, 0xD4, 0xA3, 0xEB, 0xF6, -+0x9C, 0xC3, 0xA0, 0xAA, 0x01, 0xF0, 0x00, 0x6C, -+0xAC, 0xEC, 0x83, 0x35, 0x03, 0x6C, 0xAE, 0x35, -+0x8B, 0xEC, 0xA4, 0x35, 0xCC, 0xEC, 0xAD, 0xEC, -+0xEB, 0xF6, 0x94, 0xC3, 0x10, 0xF0, 0x23, 0x6C, -+0xAE, 0xF4, 0x80, 0x9C, 0xA0, 0xAC, 0xEB, 0xF6, -+0xBE, 0xCB, 0xA0, 0xAA, 0xBF, 0xF7, 0x1F, 0x6B, -+0xAC, 0xEB, 0x60, 0xCA, 0xA0, 0xAA, 0x7F, 0xF7, -+0x1F, 0x6B, 0xAC, 0xEB, 0x60, 0xCA, 0xC0, 0xAA, -+0xFE, 0xF7, 0x1F, 0x6B, 0xFF, 0xF7, 0x1F, 0x6D, -+0xCC, 0xEB, 0x60, 0xCA, 0x40, 0xAC, 0xFF, 0x6B, -+0x21, 0x4B, 0xAC, 0xEA, 0x6D, 0xEA, 0xAC, 0xEA, -+0x40, 0xCC, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, 0x23, 0x6B, -+0xEB, 0xF6, 0x9C, 0xA2, 0x8E, 0xF4, 0x7C, 0x9B, -+0x01, 0x6E, 0x80, 0xC3, 0x10, 0xF0, 0x23, 0x6C, -+0xEB, 0xF6, 0xBE, 0xAA, 0xAE, 0xF4, 0x80, 0x9C, -+0xA0, 0xCC, 0xEB, 0xF6, 0x54, 0xA2, 0x80, 0xAB, -+0xFF, 0xF7, 0x1F, 0x6D, 0x46, 0x32, 0xCC, 0xEA, -+0xAC, 0xEC, 0x40, 0x32, 0xFE, 0xF7, 0x1E, 0x4E, -+0x4C, 0x32, 0xCC, 0xEC, 0x8D, 0xEA, 0xAC, 0xEA, -+0x40, 0xCB, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF3, -+0x64, 0x9B, 0xE9, 0xA4, 0x48, 0xA4, 0xA0, 0xAB, -+0xE0, 0x37, 0x5D, 0xE7, 0xFF, 0xF7, 0x1F, 0x6A, -+0x4C, 0xEF, 0x4C, 0xED, 0x4A, 0xA4, 0xCB, 0xA4, -+0x02, 0x5A, 0x04, 0x61, 0x02, 0x72, 0x0B, 0x6A, -+0x30, 0x61, 0x0C, 0x10, 0x00, 0xF1, 0x01, 0x5F, -+0x2B, 0x60, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xAB, 0xF6, 0x03, 0x4B, 0x2B, 0xF6, -+0xE1, 0xC2, 0x0B, 0x10, 0x00, 0xF1, 0x01, 0x5F, -+0x1F, 0x60, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xAB, 0xF7, 0x03, 0x4B, 0x2B, 0xF6, -+0xE2, 0xC2, 0xB5, 0xE6, 0x10, 0xF0, 0x23, 0x6E, -+0x00, 0x6A, 0xAE, 0xF4, 0x04, 0x9E, 0x10, 0xF0, -+0x23, 0x6E, 0x04, 0xD2, 0x05, 0xD2, 0xEE, 0xF1, -+0xCC, 0x9E, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x40, 0x9A, 0xBC, 0x35, 0x00, 0x6C, 0x15, 0xE5, -+0xD9, 0xE3, 0x40, 0xEA, 0x00, 0x6A, 0x01, 0x10, -+0x0A, 0x6A, 0x07, 0x97, 0x06, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x01, 0x2A, 0x01, 0x6A, -+0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, -+0xCB, 0xF6, 0xDD, 0xA4, 0x38, 0x26, 0x8D, 0xE2, -+0x4B, 0xF4, 0x78, 0xA3, 0x34, 0x23, 0x10, 0xF0, -+0x23, 0x6B, 0xCE, 0xF3, 0x64, 0x9B, 0xFF, 0xF7, -+0x1F, 0x6D, 0x01, 0x72, 0x60, 0xAB, 0x6C, 0xED, -+0x03, 0x60, 0x02, 0x72, 0x08, 0x60, 0x27, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xAB, 0xF6, 0x03, 0x4B, -+0x4B, 0xF4, 0xF9, 0xA4, 0x06, 0x10, 0x4B, 0xF4, -+0xFA, 0xA4, 0x30, 0xF0, 0x20, 0x6B, 0xAB, 0xF7, -+0x03, 0x4B, 0xE1, 0xF7, 0x1F, 0x6A, 0xAC, 0xEA, -+0x10, 0xF0, 0x23, 0x6D, 0xEE, 0xF1, 0xAC, 0x9D, -+0xD9, 0xE2, 0x00, 0x6A, 0xB5, 0xE3, 0x10, 0xF0, -+0x23, 0x6B, 0x04, 0xD2, 0x05, 0xD2, 0xAE, 0xF4, -+0x64, 0x9B, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x40, 0x9A, 0xDC, 0x36, 0x00, 0x6C, 0x79, 0xE6, -+0x40, 0xEA, 0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, -+0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0x69, 0xA2, 0xFF, 0x6C, 0xFF, 0x4B, -+0x8C, 0xEB, 0xFE, 0x5B, 0x7D, 0x60, 0xC1, 0xF7, -+0x69, 0xA2, 0x20, 0x6C, 0x6E, 0xEC, 0x02, 0x2C, -+0x04, 0x6B, 0x4E, 0x10, 0xC2, 0x6C, 0x6E, 0xEC, -+0x11, 0x2C, 0x02, 0x6B, 0xC1, 0xF7, 0x6C, 0xC2, -+0xC1, 0xF7, 0xAB, 0xA2, 0x08, 0x6B, 0xC1, 0xF7, -+0x74, 0xC2, 0x01, 0x6B, 0xC1, 0xF7, 0x6D, 0xC2, -+0x01, 0x6B, 0x64, 0xED, 0xC1, 0xF7, 0x70, 0xDA, -+0x6C, 0x33, 0x47, 0x10, 0xEF, 0x73, 0x34, 0x61, -+0x03, 0x6B, 0xC1, 0xF7, 0x6C, 0xC2, 0xC1, 0xF7, -+0x6A, 0xA2, 0x0F, 0x6D, 0x01, 0x6C, 0xAC, 0xEB, -+0x01, 0x73, 0xC1, 0xF7, 0x94, 0xC2, 0x0B, 0x61, -+0xC1, 0xF7, 0x8B, 0xA2, 0x02, 0x6B, 0xC1, 0xF7, -+0x6D, 0xC2, 0x01, 0x6B, 0x64, 0xEC, 0xC1, 0xF7, -+0x70, 0xDA, 0x64, 0x33, 0x08, 0x10, 0xC1, 0xF7, -+0x8D, 0xC2, 0xC1, 0xF7, 0x8B, 0xA2, 0x01, 0x6B, -+0x64, 0xEC, 0xC1, 0xF7, 0x70, 0xDA, 0xC1, 0xF7, -+0x78, 0xDA, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF1, -+0x78, 0x9B, 0xC1, 0xF7, 0x90, 0x9A, 0x83, 0xEB, -+0x01, 0x6B, 0x01, 0x61, 0x00, 0x6B, 0xC1, 0xF7, -+0x7C, 0xC2, 0xC1, 0xF7, 0x7D, 0xC2, 0x20, 0xE8, -+0x1C, 0x6C, 0x6E, 0xEC, 0x15, 0x2C, 0x05, 0x6B, -+0xC1, 0xF7, 0xAB, 0xA2, 0xC1, 0xF7, 0x6C, 0xC2, -+0x01, 0x6B, 0xC1, 0xF7, 0x74, 0xC2, 0xC1, 0xF7, -+0x6D, 0xC2, 0x01, 0x6B, 0x64, 0xED, 0xC1, 0xF7, -+0x70, 0xDA, 0xC1, 0xF7, 0x78, 0xDA, 0xC1, 0xF7, -+0x9C, 0xC2, 0xC1, 0xF7, 0x9D, 0xC2, 0x20, 0xE8, -+0xC1, 0xF7, 0x8B, 0xA2, 0x01, 0x6B, 0xC1, 0xF7, -+0x6C, 0xC2, 0xC1, 0xF7, 0x74, 0xC2, 0xC1, 0xF7, -+0x6D, 0xC2, 0x01, 0x6B, 0x64, 0xEC, 0xC1, 0xF7, -+0x70, 0xDA, 0xC1, 0xF7, 0x78, 0xDA, 0x00, 0x6B, -+0xC1, 0xF7, 0x7C, 0xC2, 0xC1, 0xF7, 0x7D, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x23, 0x6A, 0xAE, 0xF4, -+0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, 0x8E, 0xF2, -+0x8C, 0x9C, 0x40, 0x9B, 0x00, 0x6D, 0x10, 0xF0, -+0x23, 0x6F, 0x8D, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6A, 0xAE, 0xF4, 0x8C, 0x9A, 0x10, 0xF0, -+0x23, 0x6B, 0xAE, 0xF4, 0x70, 0x9B, 0x00, 0x6A, -+0x40, 0xC4, 0x01, 0x6A, 0x40, 0xC3, 0x10, 0xF0, -+0x23, 0x6B, 0xAE, 0xF4, 0x74, 0x9B, 0x4E, 0xF2, -+0xE4, 0x9F, 0x10, 0xF0, 0x30, 0x68, 0x40, 0xC3, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF4, 0x78, 0x9B, -+0xC1, 0xF7, 0x08, 0x48, 0xA0, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0xAE, 0xF4, 0xDC, 0x9B, 0x60, 0x9E, -+0xED, 0xEB, 0x60, 0xDE, 0x10, 0xF0, 0x23, 0x6B, -+0xCE, 0xF4, 0x60, 0x9B, 0x18, 0x6E, 0xA0, 0xC3, -+0x40, 0xC4, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x4C, 0x9A, 0x90, 0x67, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x50, 0x9A, 0x81, 0x40, -+0x40, 0xEA, 0x01, 0x72, 0x21, 0x61, 0x00, 0x18, -+0x86, 0xD8, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0x10, 0xF0, 0x23, 0x6B, 0xC1, 0xF7, -+0x90, 0x9A, 0x8E, 0xF1, 0x78, 0x9B, 0x83, 0xEB, -+0x09, 0x60, 0xC1, 0xF7, 0x7D, 0xA2, 0x06, 0x2B, -+0xC1, 0xF7, 0x6D, 0xA2, 0x00, 0xF6, 0x60, 0x33, -+0xC1, 0xF7, 0x78, 0xDA, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x88, 0xA2, -+0x01, 0x6B, 0x8D, 0xEB, 0xC1, 0xF7, 0x68, 0xC2, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0x10, 0xF0, 0x23, 0x6B, 0xFF, 0x6A, 0x8C, 0xEA, -+0xAE, 0xF4, 0x8C, 0x9B, 0x10, 0xF0, 0x23, 0x6B, -+0xCE, 0xF4, 0xC4, 0x9B, 0x00, 0x6D, 0xA0, 0xC4, -+0x60, 0x9E, 0x00, 0xF3, 0x01, 0x6F, 0xEB, 0xEF, -+0xEC, 0xEB, 0x60, 0xDE, 0x10, 0xF0, 0x23, 0x6E, -+0xCE, 0xF4, 0xC8, 0x9E, 0x01, 0x6B, 0x60, 0xC6, -+0x10, 0xF0, 0x23, 0x6E, 0xCE, 0xF4, 0xCC, 0x9E, -+0xA0, 0xC6, 0x10, 0xF0, 0x23, 0x6D, 0xCE, 0xF4, -+0xB0, 0x9D, 0x40, 0xC5, 0x60, 0xC4, 0x20, 0xE8, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF4, 0xAC, 0x9B, -+0x00, 0x6B, 0xFF, 0x6A, 0x60, 0xC5, 0x10, 0xF0, -+0x23, 0x6B, 0x8C, 0xEA, 0xCE, 0xF4, 0x84, 0x9B, -+0x00, 0xF3, 0x00, 0x6E, 0x10, 0xF0, 0x23, 0x6F, -+0x60, 0x9C, 0xCE, 0xF4, 0xF8, 0x9F, 0xCD, 0xEB, -+0x60, 0xDC, 0x10, 0xF0, 0x23, 0x6C, 0xCE, 0xF4, -+0x88, 0x9C, 0x01, 0x6B, 0x60, 0xC4, 0x10, 0xF0, -+0x23, 0x6C, 0xCE, 0xF4, 0x94, 0x9C, 0x60, 0xC4, -+0x10, 0xF0, 0x23, 0x6C, 0xCE, 0xF4, 0x8C, 0x9C, -+0x60, 0xC4, 0x10, 0xF0, 0x23, 0x6C, 0xAE, 0xF4, -+0xDC, 0x9C, 0x80, 0x9E, 0xEC, 0xEC, 0x80, 0xDE, -+0x10, 0xF0, 0x23, 0x6C, 0xCE, 0xF4, 0x90, 0x9C, -+0x40, 0xC4, 0x60, 0xC5, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x60, 0xA2, 0x01, 0x6A, -+0x6C, 0xEA, 0xF8, 0x2A, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF4, 0x50, 0x9A, 0xFF, 0x6B, 0x40, 0xA2, -+0x6C, 0xEA, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x05, 0x6C, 0x00, 0x18, 0x14, 0xD9, 0x01, 0x6B, -+0x4C, 0xEB, 0xFA, 0x2B, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x06, 0x6C, 0x00, 0x18, 0x02, 0xD9, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x60, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0xF8, 0x2A, 0x00, 0x18, -+0x35, 0xD9, 0x05, 0x97, 0x01, 0x6A, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6A, -+0xAE, 0xF4, 0xAC, 0x9A, 0x00, 0x6A, 0x00, 0xF3, -+0x00, 0x6E, 0x40, 0xC5, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF4, 0x64, 0x9A, 0x10, 0xF0, 0x23, 0x6F, -+0xCE, 0xF4, 0xF8, 0x9F, 0x40, 0x9B, 0xCD, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF4, -+0x68, 0x9B, 0x01, 0x6A, 0x03, 0x6E, 0x40, 0xC3, -+0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF4, 0x74, 0x9B, -+0xC0, 0xC3, 0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF4, -+0x6C, 0x9B, 0x40, 0xC3, 0x10, 0xF0, 0x23, 0x6B, -+0xAE, 0xF4, 0xDC, 0x9B, 0x60, 0x9E, 0xEC, 0xEB, -+0x60, 0xDE, 0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF4, -+0x70, 0x9B, 0x61, 0x6E, 0xCB, 0xEE, 0xC0, 0xC3, -+0x40, 0xC5, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x60, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, -+0xF8, 0x2A, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x60, 0xA2, 0x60, 0xC4, 0x60, 0xA2, -+0x61, 0xC4, 0x40, 0xA2, 0x42, 0xC4, 0x01, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0x8E, 0xF5, 0x48, 0x98, 0x24, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, 0x44, 0x9A, -+0x02, 0x6C, 0x40, 0xEA, 0x8E, 0xF5, 0x48, 0x98, -+0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6A, 0xAE, 0xF4, -+0xAC, 0x9A, 0x00, 0x6A, 0x00, 0xF3, 0x01, 0x6C, -+0x40, 0xC5, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, -+0x64, 0x9A, 0x8B, 0xEC, 0x01, 0x6E, 0x40, 0x9B, -+0x22, 0x37, 0x8C, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF4, 0x48, 0x9A, 0x03, 0x6B, -+0xE2, 0x34, 0xC0, 0xC2, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF4, 0x4C, 0x9A, 0x60, 0xC2, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x52, 0x6B, -+0x60, 0xC2, 0xFF, 0x6B, 0x6C, 0xEC, 0x6C, 0xEF, -+0x6C, 0xE9, 0x80, 0xC2, 0xE0, 0xC2, 0x20, 0xC2, -+0xC0, 0xC5, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x60, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, -+0xF8, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x40, 0x9A, 0x40, 0xEA, 0x01, 0x6B, 0x4C, 0xEB, -+0xF8, 0x2B, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x48, 0x9A, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF5, 0x44, 0x9A, 0x3E, 0x6C, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, 0x4C, 0x9A, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x01, 0x6A, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0x8E, 0xF5, 0x48, 0x98, -+0x24, 0x67, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF5, 0x44, 0x9A, 0x02, 0x6C, 0x40, 0xEA, -+0x8E, 0xF5, 0x48, 0x98, 0x40, 0xEA, 0x10, 0xF0, -+0x23, 0x6A, 0xAE, 0xF4, 0xAC, 0x9A, 0x00, 0x6A, -+0x00, 0xF3, 0x01, 0x6C, 0x40, 0xC5, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF4, 0x64, 0x9A, 0x8B, 0xEC, -+0x01, 0x6E, 0x40, 0x9B, 0x22, 0x37, 0x8C, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, -+0x48, 0x9A, 0x03, 0x6B, 0xE2, 0x34, 0xC0, 0xC2, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, -+0x60, 0xC2, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x20, 0x6B, 0x60, 0xC2, 0xFF, 0x6B, -+0x6C, 0xEC, 0x6C, 0xEF, 0x6C, 0xE9, 0x80, 0xC2, -+0xE0, 0xC2, 0x20, 0xC2, 0xC0, 0xC5, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x60, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0xF8, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x40, 0x9A, 0x40, 0xEA, -+0x01, 0x6B, 0x4C, 0xEB, 0xF8, 0x2B, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x48, 0x9A, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, 0x44, 0x9A, -+0x3E, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF5, 0x4C, 0x9A, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x01, 0x6A, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x63, 0x01, 0xD1, -+0x00, 0xD0, 0x00, 0x6A, 0x04, 0xD6, 0x62, 0x67, -+0x6C, 0x10, 0x10, 0xF0, 0x23, 0x6E, 0xAE, 0xF4, -+0xCC, 0x9E, 0x00, 0x6F, 0x10, 0xF0, 0x23, 0x68, -+0xE0, 0xC6, 0x10, 0xF0, 0x23, 0x6E, 0xCE, 0xF4, -+0xE4, 0x9E, 0x4E, 0xF4, 0x08, 0x98, 0x0C, 0x5D, -+0xC0, 0x9F, 0x0C, 0xEE, 0x00, 0xF3, 0x00, 0x68, -+0x0D, 0xEE, 0xC0, 0xDF, 0x10, 0xF0, 0x23, 0x6E, -+0xCE, 0xF4, 0xC8, 0x9E, 0x01, 0x6F, 0x10, 0xF0, -+0x23, 0x68, 0xE0, 0xC6, 0x10, 0xF0, 0x23, 0x6E, -+0xAE, 0xF4, 0xFC, 0x9E, 0xCE, 0xF4, 0x18, 0x98, -+0xC0, 0x9F, 0x0C, 0xEE, 0xC0, 0xDF, 0x08, 0x61, -+0x10, 0xF0, 0x23, 0x6E, 0xCE, 0xF4, 0xD4, 0x9E, -+0x0B, 0x6F, 0x0B, 0x4A, 0xE0, 0xC6, 0x08, 0x10, -+0x10, 0xF0, 0x23, 0x6F, 0xCE, 0xF4, 0xF4, 0x9F, -+0xFF, 0x6E, 0xAC, 0xEE, 0xC0, 0xC7, 0xA9, 0xE2, -+0x10, 0xF0, 0x23, 0x6E, 0xCE, 0xF4, 0xCC, 0x9E, -+0x03, 0x6F, 0x82, 0x31, 0xE0, 0xC6, 0x10, 0xF0, -+0x23, 0x6E, 0xCE, 0xF4, 0xD0, 0x9E, 0x22, 0x30, -+0xE0, 0xC6, 0xFF, 0x6F, 0xEC, 0xE8, 0xEC, 0xE9, -+0x8C, 0xEF, 0x00, 0xC6, 0x20, 0xC6, 0xE0, 0xC6, -+0x10, 0xF0, 0x23, 0x6E, 0xAE, 0xF4, 0xCC, 0x9E, -+0x01, 0x6F, 0xE0, 0xC6, 0x10, 0xF0, 0x23, 0x6E, -+0xCE, 0xF4, 0xDC, 0x9E, 0xE0, 0xA6, 0x01, 0x6E, -+0xEC, 0xEE, 0xF8, 0x2E, 0x04, 0x97, 0x79, 0xE7, -+0x08, 0x10, 0x10, 0xF0, 0x23, 0x6F, 0xCE, 0xF4, -+0xF0, 0x9F, 0x01, 0x4B, 0xE0, 0xA7, 0xE0, 0xC6, -+0x01, 0x4E, 0x43, 0xEB, 0xF6, 0x61, 0x0C, 0x5D, -+0x02, 0x60, 0x00, 0x6D, 0x02, 0x10, 0x0B, 0x4C, -+0xF5, 0x4D, 0x93, 0x2D, 0x01, 0x91, 0x00, 0x90, -+0x01, 0x6A, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, 0x48, 0x9A, -+0x0A, 0xD4, 0x0C, 0xD6, 0x05, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, 0x44, 0x9A, -+0x02, 0x6C, 0x00, 0x69, 0x40, 0xEA, 0x04, 0xD1, -+0x66, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x48, 0x9A, 0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6A, -+0xAE, 0xF4, 0x4C, 0x9A, 0x00, 0x6B, 0x00, 0xF3, -+0x01, 0x6C, 0x60, 0xC2, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF4, 0x64, 0x9A, 0x8B, 0xEC, 0x0C, 0x58, -+0x40, 0x9B, 0x8C, 0xEA, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF4, 0x48, 0x9A, 0x01, 0x6B, -+0x60, 0xC2, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, -+0x4C, 0x9A, 0x03, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x02, 0x6B, -+0x60, 0xC2, 0x0A, 0x93, 0x62, 0x35, 0xA2, 0x34, -+0xFF, 0x6B, 0x6C, 0xEC, 0x6C, 0xED, 0x80, 0xC2, -+0xA0, 0xC2, 0x0A, 0x94, 0x8C, 0xEB, 0x60, 0xC2, -+0x05, 0x61, 0x0B, 0x49, 0x0C, 0x93, 0x04, 0x94, -+0x89, 0xE3, 0x0C, 0x10, 0x05, 0xE1, 0xFA, 0x17, -+0x10, 0xF0, 0x23, 0x6B, 0x80, 0xA2, 0xCE, 0xF4, -+0x70, 0x9B, 0x01, 0x4A, 0x80, 0xC3, 0x04, 0x93, -+0x01, 0x4B, 0x04, 0xD3, 0x04, 0x94, 0x23, 0xEC, -+0xF3, 0x61, 0x10, 0xF0, 0x23, 0x6A, 0xAE, 0xF4, -+0x4C, 0x9A, 0x01, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x23, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x60, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0xF8, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x40, 0x9A, 0x40, 0xEA, -+0x01, 0x6B, 0x4C, 0xEB, 0xF8, 0x2B, 0x0C, 0x58, -+0x02, 0x60, 0x00, 0x68, 0x04, 0x10, 0x0A, 0x92, -+0xF5, 0x48, 0x0B, 0x4A, 0x0A, 0xD2, 0x99, 0x28, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, 0x48, 0x9A, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x44, 0x9A, 0x3E, 0x6C, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x4C, 0x9A, 0x40, 0xEA, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x01, 0x6A, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0x8E, 0xF5, 0x48, 0x98, 0xFF, 0x69, 0x8C, 0xE9, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x44, 0x9A, 0x02, 0x6C, 0x40, 0xEA, 0x8E, 0xF5, -+0x48, 0x98, 0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6A, -+0xAE, 0xF4, 0x6C, 0x9A, 0x00, 0x6A, 0x00, 0xF3, -+0x01, 0x6D, 0x40, 0xC3, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF4, 0x84, 0x9A, 0xAB, 0xED, 0x40, 0x9C, -+0xAC, 0xEA, 0x40, 0xDC, 0x10, 0xF0, 0x23, 0x6C, -+0xCE, 0xF4, 0x88, 0x9C, 0x01, 0x6A, 0x3E, 0x6D, -+0x40, 0xC4, 0x10, 0xF0, 0x23, 0x6C, 0xCE, 0xF4, -+0x8C, 0x9C, 0xAB, 0xED, 0x40, 0xC4, 0x10, 0xF0, -+0x23, 0x6C, 0xCE, 0xF4, 0x90, 0x9C, 0xA0, 0xC4, -+0x20, 0xC4, 0x40, 0xC3, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x60, 0xA2, 0x01, 0x6A, -+0x6C, 0xEA, 0xF8, 0x2A, 0x00, 0x18, 0x35, 0xD9, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, 0x40, 0x9A, -+0x40, 0xEA, 0x01, 0x6B, 0x4C, 0xEB, 0xF8, 0x2B, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, 0x48, 0x9A, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x44, 0x9A, 0x3E, 0x6C, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x4C, 0x9A, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x58, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x01, 0x6A, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0x8E, 0xF5, 0x48, 0x98, -+0xFF, 0x69, 0x8C, 0xE9, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x44, 0x9A, 0x02, 0x6C, -+0x40, 0xEA, 0x8E, 0xF5, 0x48, 0x98, 0x40, 0xEA, -+0x10, 0xF0, 0x23, 0x6A, 0xAE, 0xF4, 0x6C, 0x9A, -+0x00, 0x6A, 0x00, 0xF3, 0x01, 0x6D, 0x40, 0xC3, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, 0x84, 0x9A, -+0xAB, 0xED, 0x40, 0x9C, 0xAC, 0xEA, 0x40, 0xDC, -+0x10, 0xF0, 0x23, 0x6C, 0xCE, 0xF4, 0x88, 0x9C, -+0x01, 0x6A, 0x3B, 0x6D, 0x40, 0xC4, 0x10, 0xF0, -+0x23, 0x6C, 0xCE, 0xF4, 0x8C, 0x9C, 0xAB, 0xED, -+0x40, 0xC4, 0x10, 0xF0, 0x23, 0x6C, 0xCE, 0xF4, -+0x90, 0x9C, 0xA0, 0xC4, 0x20, 0xC4, 0x40, 0xC3, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x60, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, 0xF8, 0x2A, -+0x00, 0x18, 0x35, 0xD9, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF5, 0x40, 0x9A, 0x40, 0xEA, 0x01, 0x6B, -+0x4C, 0xEB, 0xF8, 0x2B, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF5, 0x48, 0x9A, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x44, 0x9A, 0x3E, 0x6C, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x4C, 0x9A, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x01, 0x6A, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x10, 0xF0, 0x30, 0x6B, 0x00, 0xF0, -+0x00, 0x4B, 0xEC, 0xEA, 0x05, 0xD2, 0xC1, 0xF7, -+0x50, 0x9B, 0x04, 0x67, 0x0B, 0xD5, 0xC1, 0xF7, -+0x8D, 0xA3, 0x0C, 0xD6, 0x62, 0x67, 0x00, 0x69, -+0x06, 0x10, 0x01, 0x49, 0xFF, 0x6D, 0xAC, 0xE9, -+0x23, 0xEC, 0x01, 0x61, 0x63, 0xE0, 0x43, 0xE8, -+0xF8, 0x60, 0x10, 0xF0, 0x30, 0x6B, 0x00, 0xF0, -+0x00, 0x4B, 0xC1, 0xF7, 0x4E, 0xA3, 0x04, 0xD3, -+0x2E, 0xEA, 0x06, 0x22, 0x91, 0x67, 0x00, 0x18, -+0x55, 0xDA, 0x04, 0x92, 0xC1, 0xF7, 0x2E, 0xC2, -+0x10, 0xF0, 0x30, 0x6A, 0xC1, 0xF7, 0x5D, 0xA2, -+0x01, 0x72, 0x08, 0x61, 0x10, 0xF0, 0x23, 0x6A, -+0x2E, 0xF3, 0x58, 0x9A, 0x00, 0xF6, 0x02, 0x31, -+0x4C, 0xE8, 0x08, 0x10, 0x10, 0xF0, 0x23, 0x6A, -+0x2E, 0xF3, 0x58, 0x9A, 0x00, 0x69, 0x03, 0xEA, -+0x51, 0x67, 0x33, 0x61, 0x10, 0xF0, 0x30, 0x6B, -+0x00, 0xF0, 0x00, 0x4B, 0xC1, 0xF7, 0x4F, 0xA3, -+0x04, 0xD3, 0x2E, 0xEA, 0x06, 0x22, 0x91, 0x67, -+0x00, 0x18, 0x88, 0xDA, 0x04, 0x92, 0xC1, 0xF7, -+0x2F, 0xC2, 0x05, 0x93, 0x06, 0x2B, 0x0B, 0x95, -+0x0C, 0x96, 0x90, 0x67, 0x00, 0x18, 0xCF, 0xD9, -+0x1C, 0x10, 0x05, 0x92, 0x01, 0x72, 0x06, 0x61, -+0x0B, 0x95, 0x0C, 0x96, 0x90, 0x67, 0x00, 0x18, -+0x0C, 0xDA, 0x13, 0x10, 0x05, 0x93, 0x02, 0x73, -+0x04, 0x61, 0x90, 0x67, 0x00, 0x18, 0x9C, 0xD9, -+0x0C, 0x10, 0x05, 0x92, 0x03, 0x72, 0x04, 0x61, -+0x90, 0x67, 0x00, 0x18, 0x69, 0xD9, 0x05, 0x10, -+0x05, 0x93, 0x00, 0x6A, 0x04, 0x73, 0x01, 0x60, -+0x01, 0x6A, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xDB, 0xEC, 0x01, 0x2E, -+0xE5, 0xE8, 0x10, 0xEA, 0xAD, 0xE2, 0x63, 0xEE, -+0x78, 0x67, 0x4B, 0xE6, 0x6B, 0xEB, 0x6C, 0xEA, -+0x20, 0xE8, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x10, 0xF0, -+0x30, 0x6B, 0xEC, 0xEA, 0x00, 0xF0, 0x00, 0x4B, -+0x04, 0xD2, 0xC1, 0xF7, 0x58, 0x9B, 0x0A, 0xD4, -+0x91, 0xE5, 0x83, 0xEA, 0x0B, 0xD5, 0x0C, 0xD6, -+0x00, 0x6A, 0x45, 0x61, 0x0A, 0x94, 0xC1, 0xF7, -+0xD0, 0x9B, 0x00, 0x18, 0xF5, 0xDA, 0x22, 0x67, -+0x1A, 0x22, 0xA2, 0x67, 0x10, 0xF0, 0x23, 0x6A, -+0x0A, 0x94, 0x8E, 0xF1, 0xD8, 0x9A, 0x00, 0x18, -+0xF5, 0xDA, 0x02, 0x67, 0x07, 0x22, 0x0A, 0x94, -+0x0C, 0x96, 0x04, 0x97, 0xA2, 0x67, 0x00, 0x18, -+0xB8, 0xDA, 0x2C, 0x22, 0x0A, 0x93, 0x0C, 0x92, -+0x04, 0x97, 0x71, 0xE0, 0x17, 0xE1, 0x19, 0xE2, -+0x00, 0x18, 0xB8, 0xDA, 0x23, 0x22, 0x0B, 0x92, -+0x0A, 0x93, 0x37, 0xE2, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0xD8, 0x9A, 0x6D, 0xE1, 0x83, 0x67, -+0x05, 0xD3, 0x00, 0x18, 0xF5, 0xDA, 0x02, 0x67, -+0x08, 0x22, 0x0C, 0x93, 0x05, 0x94, 0x04, 0x97, -+0xA2, 0x67, 0x39, 0xE3, 0x00, 0x18, 0xB8, 0xDA, -+0x0D, 0x22, 0x0A, 0x92, 0x0B, 0x93, 0x04, 0x97, -+0x51, 0xE1, 0x0C, 0x92, 0x37, 0xE3, 0x39, 0xE0, -+0x11, 0xE4, 0x17, 0xE5, 0xD9, 0xE2, 0x00, 0x18, -+0xB8, 0xDA, 0x01, 0x10, 0x00, 0x6A, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x6D, 0xC5, 0x67, -+0x03, 0x6F, 0x00, 0x18, 0xFB, 0xDA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x6D, 0xC5, 0x67, 0x02, 0x6F, 0x00, 0x18, -+0xFB, 0xDA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x6F, 0x00, 0x18, -+0xFB, 0xDA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x01, 0x6F, 0x00, 0x18, -+0xFB, 0xDA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xDB, 0x63, 0x49, 0x62, 0x48, 0xD1, 0x47, 0xD0, -+0x52, 0xA4, 0x33, 0xA4, 0x6A, 0xA4, 0x40, 0x32, -+0x40, 0x32, 0x00, 0xF6, 0x20, 0x31, 0x45, 0xE1, -+0x50, 0xA4, 0x60, 0x33, 0x0F, 0xA4, 0x45, 0xE1, -+0x51, 0xA4, 0x00, 0xF6, 0x00, 0x30, 0x40, 0x32, -+0x45, 0xE1, 0x49, 0xA4, 0x4D, 0xE3, 0x4E, 0xA4, -+0x40, 0x32, 0x40, 0x32, 0x41, 0xE0, 0x4C, 0xA4, -+0x41, 0xE0, 0x4D, 0xA4, 0x40, 0x32, 0x41, 0xE0, -+0x48, 0xA4, 0x20, 0x72, 0x17, 0x60, 0x21, 0x5A, -+0x05, 0x60, 0x02, 0x72, 0x1A, 0x60, 0x03, 0x72, -+0x65, 0x60, 0x9A, 0x10, 0x52, 0x72, 0x09, 0x60, -+0x60, 0x72, 0x80, 0xF0, 0x15, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF5, 0x54, 0x9A, 0x40, 0xEA, -+0x8F, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x58, 0x9A, 0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF5, 0x5C, 0x9A, 0x91, 0x67, 0x40, 0xEA, -+0x83, 0x10, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF3, -+0x44, 0x9A, 0x80, 0xAA, 0xFF, 0xF7, 0x1F, 0x6A, -+0x8C, 0xEA, 0x49, 0xE3, 0x5C, 0x32, 0x30, 0x4A, -+0x45, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF5, -+0x48, 0x9A, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF5, 0x44, 0x9A, 0x02, 0x6C, 0x40, 0xEA, -+0x33, 0x10, 0xFF, 0x6A, 0x2C, 0xEA, 0x0C, 0x22, -+0x00, 0xF1, 0x00, 0x58, 0x04, 0x60, 0x0D, 0xE2, -+0x00, 0xF1, 0x00, 0x5B, 0x0C, 0x61, 0xFF, 0x6B, -+0x01, 0x4B, 0x4F, 0xE3, 0x44, 0xD3, 0x08, 0x10, -+0x00, 0xF1, 0x00, 0x58, 0x04, 0x61, 0xFF, 0x6A, -+0x01, 0x4A, 0x44, 0xD2, 0x01, 0x10, 0x44, 0xD0, -+0x10, 0xF0, 0x23, 0x6A, 0x0E, 0xF3, 0x64, 0x9A, -+0x45, 0x94, 0x00, 0x6A, 0x6D, 0xE4, 0xA0, 0xA3, -+0x04, 0x06, 0x51, 0xE6, 0xA0, 0xC4, 0x44, 0x95, -+0x01, 0x4A, 0x01, 0x4B, 0xA3, 0xEA, 0xF7, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF5, 0x40, 0x9A, -+0x91, 0x67, 0x40, 0xEA, 0x44, 0x92, 0x45, 0x93, -+0x43, 0xE0, 0x4D, 0xE3, 0x45, 0xD3, 0x45, 0xE1, -+0xCC, 0x28, 0x36, 0x10, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF3, 0x44, 0x9A, 0x02, 0xF0, 0x01, 0x58, -+0x80, 0xAA, 0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, -+0x4D, 0xE3, 0x7C, 0x33, 0x45, 0xD3, 0x27, 0x61, -+0x02, 0xF0, 0x00, 0x68, 0x24, 0x10, 0x00, 0xF1, -+0x00, 0x58, 0x44, 0xD0, 0x03, 0x61, 0xFF, 0x6C, -+0x01, 0x4C, 0x44, 0xD4, 0x30, 0xF0, 0x20, 0x6A, -+0x44, 0x95, 0xAE, 0xF5, 0x44, 0x9A, 0x91, 0x67, -+0x04, 0x06, 0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6A, -+0x0E, 0xF3, 0x64, 0x9A, 0x45, 0x95, 0x00, 0x6A, -+0x6D, 0xE5, 0xBD, 0x67, 0x51, 0xE5, 0x90, 0xA4, -+0x01, 0x4A, 0x80, 0xC3, 0x44, 0x94, 0x01, 0x4B, -+0x83, 0xEA, 0xF7, 0x61, 0x45, 0x95, 0x83, 0xE0, -+0x85, 0xE1, 0x95, 0xE5, 0x45, 0xD5, 0xDB, 0x28, -+0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF4, 0x74, 0x9A, -+0x02, 0x6C, 0x8B, 0xEC, 0x40, 0x9B, 0x8C, 0xEA, -+0x40, 0xDB, 0x49, 0x97, 0x48, 0x91, 0x47, 0x90, -+0x01, 0x6A, 0x25, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x4C, 0xED, 0x4C, 0xEC, 0x4C, 0xEE, -+0xEC, 0xEA, 0x05, 0x25, 0x01, 0x75, 0x56, 0x61, -+0x08, 0x6B, 0x0C, 0x6D, 0x02, 0x10, 0x0A, 0x6B, -+0x0E, 0x6D, 0x01, 0x74, 0x1D, 0x60, 0x02, 0x74, -+0x2A, 0x60, 0x26, 0x67, 0xE1, 0x45, 0xC4, 0xED, -+0x24, 0xEB, 0x82, 0x67, 0xCD, 0xE9, 0x84, 0xEF, -+0xC1, 0x43, 0x8D, 0xE9, 0x44, 0xEE, 0x4D, 0xE9, -+0x01, 0x6A, 0x02, 0x67, 0x04, 0xEB, 0x62, 0x67, -+0x64, 0xED, 0xA2, 0x67, 0x6D, 0xE8, 0xA4, 0xEF, -+0xAD, 0xE8, 0x44, 0xEE, 0xFF, 0xF7, 0x1F, 0x6C, -+0x4D, 0xE8, 0x8C, 0xE9, 0x8C, 0xE8, 0x1E, 0x10, -+0x01, 0x6B, 0x01, 0x45, 0x22, 0x67, 0x83, 0x67, -+0x24, 0xE8, 0xC4, 0xED, 0x84, 0xE8, 0xCD, 0xE9, -+0xFF, 0xF7, 0x1F, 0x6A, 0x04, 0x67, 0x64, 0xED, -+0x4C, 0xE9, 0x6D, 0xE8, 0x0E, 0x10, 0x01, 0x6C, -+0x01, 0x43, 0x22, 0x67, 0xA4, 0x67, 0x24, 0xE8, -+0xC4, 0xEB, 0xA4, 0xE8, 0xCD, 0xE9, 0xFF, 0xF7, -+0x1F, 0x6A, 0x05, 0x67, 0x84, 0xEB, 0x4C, 0xE9, -+0x8D, 0xE8, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF3, 0x4C, 0x9A, 0x38, 0x6C, 0x0F, 0xE8, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF3, -+0x40, 0x9A, 0x40, 0xEA, 0x4C, 0xE8, 0x04, 0x92, -+0x2D, 0xE8, 0xFF, 0xF7, 0x1F, 0x6D, 0x38, 0x6C, -+0x0C, 0xED, 0x40, 0xEA, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0xFF, 0xF7, 0x1F, 0x6B, 0xAC, 0xEB, 0x06, 0xD3, -+0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF3, 0x64, 0x9B, -+0xFF, 0x6A, 0x8C, 0xEA, 0x80, 0xAB, 0xE1, 0xF7, -+0x1F, 0x6B, 0x00, 0x68, 0x8C, 0xEB, 0x69, 0xE2, -+0x10, 0xF0, 0x23, 0x6B, 0x0E, 0xF5, 0x84, 0x9B, -+0x5C, 0x32, 0x91, 0xE2, 0x04, 0xD4, 0x22, 0x10, -+0x04, 0x92, 0x40, 0x9A, 0x05, 0xD2, 0x0D, 0x28, -+0x30, 0xF0, 0x20, 0x69, 0xCE, 0xF4, 0x50, 0x99, -+0x05, 0x96, 0x01, 0x6D, 0x83, 0xF1, 0x18, 0x6C, -+0xAB, 0xED, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x99, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x05, 0x96, 0x01, 0x6D, 0x83, 0xF1, -+0x18, 0x6C, 0xAB, 0xED, 0x40, 0xEA, 0x04, 0x93, -+0x01, 0x48, 0xFF, 0xF7, 0x1F, 0x6A, 0x04, 0x4B, -+0x4C, 0xE8, 0x04, 0xD3, 0x06, 0x92, 0x43, 0xE8, -+0xDB, 0x61, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0x77, 0x21, 0x03, 0x80, -+0xD3, 0x21, 0x03, 0x80, 0x67, 0x22, 0x03, 0x80, -+0xFB, 0x22, 0x03, 0x80, 0x93, 0x23, 0x03, 0x80, -+0xA9, 0x27, 0x03, 0x80, 0xA3, 0x27, 0x03, 0x80, -+0xAF, 0x27, 0x03, 0x80, 0xB5, 0x27, 0x03, 0x80, -+0xBB, 0x27, 0x03, 0x80, 0xC1, 0x27, 0x03, 0x80, -+0x00, 0x20, 0x41, 0x80, 0x00, 0x00, 0x00, 0x00, -+0x2A, 0x18, 0x3F, 0x00, 0x71, 0x73, 0x29, 0x23, -+0x2B, 0x48, 0x01, 0x00, 0x01, 0x00, 0x2B, 0x48, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x31, 0x2E, 0x30, 0x30, 0x44, 0x72, 0x69, 0x76, -+0x65, 0x72, 0x20, 0x53, 0x74, 0x6F, 0x72, 0x61, -+0x67, 0x65, 0x20, 0x20, 0x52, 0x65, 0x61, 0x6C, -+0x74, 0x65, 0x6B, 0x20, 0x47, 0x26, 0x10, 0x80, -+0x8B, 0x26, 0x10, 0x80, 0x13, 0x27, 0x10, 0x80, -+0x43, 0x26, 0x10, 0x80, 0x75, 0x27, 0x10, 0x80, -+0xA5, 0x27, 0x10, 0x80, 0xC9, 0x28, 0x10, 0x80, -+0xE3, 0x28, 0x10, 0x80, 0xF3, 0x28, 0x10, 0x80, -+0x09, 0x29, 0x10, 0x80, 0x1F, 0x29, 0x10, 0x80, -+0x1F, 0x29, 0x10, 0x80, 0x3B, 0x29, 0x10, 0x80, -+0x7B, 0x39, 0x03, 0x80, 0x91, 0x39, 0x03, 0x80, -+0xC5, 0x39, 0x03, 0x80, 0xC5, 0x39, 0x03, 0x80, -+0xC5, 0x39, 0x03, 0x80, 0xC5, 0x39, 0x03, 0x80, -+0x9D, 0x39, 0x03, 0x80, 0xA7, 0x39, 0x03, 0x80, -+0xB1, 0x39, 0x03, 0x80, 0xBB, 0x39, 0x03, 0x80, -+0x83, 0x39, 0x03, 0x80, 0x71, 0x39, 0x03, 0x80, -+0x01, 0x40, 0x03, 0x80, 0x23, 0x40, 0x03, 0x80, -+0x45, 0x40, 0x03, 0x80, 0x67, 0x40, 0x03, 0x80, -+0x8B, 0x40, 0x03, 0x80, 0xC5, 0x40, 0x03, 0x80, -+0xE9, 0x40, 0x03, 0x80, 0x0D, 0x41, 0x03, 0x80, -+0x31, 0x41, 0x03, 0x80, 0x57, 0x41, 0x03, 0x80, -+0x89, 0x46, 0x03, 0x80, 0x89, 0x46, 0x03, 0x80, -+0x89, 0x46, 0x03, 0x80, 0xA3, 0x46, 0x03, 0x80, -+0x89, 0x46, 0x03, 0x80, 0x89, 0x46, 0x03, 0x80, -+0x89, 0x46, 0x03, 0x80, 0x85, 0x46, 0x03, 0x80, -+0x85, 0x46, 0x03, 0x80, 0x85, 0x46, 0x03, 0x80, -+0x85, 0x46, 0x03, 0x80, 0x85, 0x46, 0x03, 0x80, -+0x01, 0x47, 0x03, 0x80, 0x0B, 0x47, 0x03, 0x80, -+0xA7, 0x52, 0x03, 0x80, 0xB7, 0x52, 0x03, 0x80, -+0xC1, 0x52, 0x03, 0x80, 0xCB, 0x52, 0x03, 0x80, -+0xDD, 0x52, 0x03, 0x80, 0x09, 0x5F, 0x03, 0x80, -+0x3B, 0x5F, 0x03, 0x80, 0x1D, 0x5F, 0x03, 0x80, -+0x45, 0x5F, 0x03, 0x80, 0x27, 0x5F, 0x03, 0x80, -+0x51, 0x5F, 0x03, 0x80, 0x31, 0x5F, 0x03, 0x80, -+0xFC, 0x10, 0x60, 0xB8, 0xFA, 0xFA, 0xFA, 0xFA, -+0x8C, 0x04, 0x64, 0xB8, 0x90, 0x04, 0x64, 0xB8, -+0x94, 0x04, 0x64, 0xB8, 0x98, 0x04, 0x64, 0xB8, -+0x9C, 0x04, 0x64, 0xB8, 0xA0, 0x04, 0x64, 0xB8, -+0x01, 0x06, 0x64, 0xB8, 0x00, 0x00, 0x68, 0x18, -+0x48, 0x00, 0x68, 0x18, 0x48, 0x04, 0x68, 0x18, -+0x00, 0x00, 0x60, 0xB8, 0x00, 0x00, 0x64, 0xB8, -+0x04, 0x06, 0x64, 0xB8, 0xFF, 0xFF, 0xFF, 0xFE, -+0x00, 0x00, 0x00, 0x01, 0x60, 0x16, 0x64, 0xB8, -+0x09, 0x00, 0x78, 0xB8, 0x31, 0x00, 0x78, 0xB8, -+0x14, 0x00, 0x78, 0xB8, 0x1D, 0x04, 0x64, 0xB8, -+0x22, 0x05, 0x64, 0xB8, 0x88, 0x00, 0x60, 0xB8, -+0x89, 0x00, 0x60, 0xB8, 0x8A, 0x00, 0x60, 0xB8, -+0x8B, 0x00, 0x60, 0xB8, 0x84, 0x00, 0x60, 0xB8, -+0xF8, 0x10, 0x60, 0xB8, 0x00, 0x00, 0x00, 0x02, -+0xCB, 0x01, 0x64, 0xB8, 0x00, 0x00, 0x00, 0x60, -+0xE0, 0x00, 0x60, 0xB8, 0x00, 0x00, 0x00, 0x20, -+0xE1, 0x00, 0x60, 0xB8, 0xE8, 0x12, 0x64, 0xB8, -+0xFF, 0xFF, 0x03, 0x00, 0x00, 0x00, 0x00, 0x80, -+0x00, 0x00, 0x00, 0x04, 0xFF, 0xFF, 0xFF, 0xFB, -+0xFF, 0xFF, 0xFF, 0xDF, 0xFF, 0xFF, 0xFF, 0x1F, -+0x04, 0x00, 0x60, 0xB8, 0x04, 0x00, 0x64, 0xB8, -+0x08, 0x00, 0x60, 0xB8, 0x08, 0x00, 0x64, 0xB8, -+0x24, 0x00, 0x60, 0xB8, 0x80, 0x00, 0x60, 0xB8, -+0x00, 0x00, 0x02, 0x00, 0xFF, 0xFF, 0xFD, 0xFF, -+0x82, 0x10, 0x60, 0xB8, 0x42, 0x34, 0x00, 0xB8, -+0x55, 0x53, 0x42, 0x43, 0x00, 0x00, 0x00, 0x40, -+0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, 0x08, -+0x55, 0x53, 0x42, 0x53, 0x00, 0x20, 0x78, 0xB8, -+0x00, 0x10, 0x78, 0xB8, 0x00, 0x00, 0x03, 0x00, -+0x00, 0x00, 0xFD, 0xFF, 0x00, 0x00, 0xFF, 0x00, -+0xFF, 0xFF, 0x02, 0x00, 0x00, 0x00, 0x04, 0x00, -+0x00, 0x0C, 0x01, 0x00, 0x01, 0x00, 0x66, 0xB8, -+0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x01, 0x00, -+0xFF, 0xFF, 0x0B, 0xFF, 0x00, 0x00, 0x70, 0x00, -+0xFF, 0xFF, 0x7A, 0xFF, 0x00, 0x00, 0xD0, 0x00, -+0xFF, 0xFF, 0xDA, 0xFF, 0xFF, 0xFF, 0x0F, 0x00, -+0xFF, 0xFF, 0xFF, 0x0F, 0x00, 0xFF, 0xF9, 0xFF, -+0x00, 0x00, 0xFE, 0x1F, 0x00, 0x00, 0x08, 0x00, -+0x1C, 0x0C, 0xB8, 0x64, 0x67, 0x56, 0x23, 0x01, -+0xFF, 0xFF, 0xF7, 0xFF, 0xFF, 0xFC, 0xFE, 0xFF, -+0x00, 0x01, 0x01, 0x00, 0x00, 0xFC, 0xCF, 0xFF, -+0x00, 0x00, 0x01, 0x10, 0x00, 0xF3, 0x3F, 0xFF, -+0x01, 0x00, 0x02, 0x20, 0x00, 0xCF, 0xFF, 0xFC, -+0x02, 0x00, 0x04, 0x40, 0x00, 0xFC, 0xCE, 0xEF, -+0x40, 0x02, 0x20, 0x00, 0x80, 0x03, 0x30, 0x00, -+0x00, 0x00, 0x80, 0x01, 0xCC, 0x06, 0x64, 0xB8, -+0x96, 0x02, 0x64, 0xB8, 0x00, 0x00, 0x70, 0xB8, -+0x18, 0x00, 0x70, 0xB8, 0x0B, 0x00, 0x70, 0xB8, -+0x02, 0x00, 0x70, 0xB8, 0x1C, 0x01, 0x64, 0xB8, -+0x94, 0x02, 0x64, 0xB8, 0x97, 0x02, 0x64, 0xB8, -+0x84, 0x02, 0x64, 0xB8, 0x1C, 0x04, 0x64, 0xB8, -+0x54, 0x02, 0x64, 0xB8, 0x50, 0x02, 0x64, 0xB8, -+0x4C, 0x02, 0x64, 0xB8, 0x00, 0x00, 0x78, 0xB8, -+0x04, 0x00, 0x78, 0xB8, 0x48, 0x02, 0x64, 0xB8, -+0x44, 0x02, 0x64, 0xB8, 0xCC, 0x01, 0x64, 0xB8, -+0xF4, 0x11, 0x64, 0xB8, 0xF5, 0x11, 0x64, 0xB8, -+0xCF, 0x01, 0x64, 0xB8, 0x34, 0x01, 0x64, 0xB8, -+0x64, 0x05, 0x64, 0xB8, 0x60, 0x05, 0x64, 0xB8, -+0xC8, 0x01, 0x64, 0xB8, 0xC9, 0x01, 0x64, 0xB8, -+0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x05, -+0x64, 0x01, 0x64, 0xB8, 0x53, 0x05, 0x64, 0xB8, -+0x77, 0x05, 0x64, 0xB8, 0x68, 0x05, 0x64, 0xB8, -+0x94, 0x01, 0x64, 0xB8, 0x00, 0x00, 0x66, 0xB8, -+0x00, 0x10, 0x66, 0xB8, 0x00, 0x1C, 0x66, 0xB8, -+0x54, 0x00, 0x60, 0xB8, 0x50, 0x00, 0x60, 0xB8, -+0x9A, 0x01, 0x64, 0xB8, 0x99, 0x01, 0x64, 0xB8, -+0xC7, 0x01, 0x64, 0xB8, 0xC6, 0x01, 0x64, 0xB8, -+0x30, 0x01, 0x64, 0xB8, 0x24, 0x01, 0x64, 0xB8, -+0x20, 0x01, 0x64, 0xB8, 0x24, 0x11, 0x64, 0xB8, -+0x20, 0x11, 0x64, 0xB8, 0x2C, 0x11, 0x64, 0xB8, -+0x28, 0x11, 0x64, 0xB8, 0x34, 0x11, 0x64, 0xB8, -+0x30, 0x11, 0x64, 0xB8, 0x3C, 0x01, 0x64, 0xB8, -+0x38, 0x01, 0x64, 0xB8, 0x3C, 0x11, 0x64, 0xB8, -+0x38, 0x11, 0x64, 0xB8, 0xE4, 0x11, 0x64, 0xB8, -+0xE0, 0x11, 0x64, 0xB8, 0x00, 0x00, 0x00, 0x03, -+0xE0, 0x12, 0x64, 0xB8, 0x00, 0x01, 0x64, 0xB8, -+0x08, 0x02, 0x64, 0xB8, 0x24, 0x04, 0x64, 0xB8, -+0x00, 0x28, 0x64, 0xB8, 0x00, 0x2C, 0x64, 0xB8, -+0x00, 0x38, 0x64, 0xB8, 0x00, 0x3C, 0x64, 0xB8, -+0xF8, 0x05, 0x64, 0xB8, 0xF9, 0x05, 0x64, 0xB8, -+0xFA, 0x05, 0x64, 0xB8, 0xFB, 0x05, 0x64, 0xB8, -+0x92, 0x06, 0x64, 0xB8, 0x70, 0x00, 0x60, 0xB8, -+0xFF, 0xFF, 0xFF, 0x7F, 0x00, 0x00, 0x70, 0x18, -+0xF1, 0x11, 0x64, 0xB8, 0x7A, 0x04, 0x64, 0xB8, -+0x20, 0x00, 0x78, 0xB8, 0x10, 0x00, 0x78, 0xB8, -+0x03, 0x00, 0x78, 0xB8, 0xFF, 0xFF, 0x01, 0xFF, -+0x05, 0x00, 0x78, 0xB8, 0x12, 0x05, 0x64, 0xB8, -+0x10, 0x05, 0x64, 0xB8, 0x54, 0x05, 0x64, 0xB8, -+0xB8, 0x05, 0x64, 0xB8, 0xBC, 0x05, 0x64, 0xB8, -+0x00, 0x00, 0x80, 0x00, 0x5F, 0x11, 0x64, 0xB8, -+0xFE, 0xFF, 0xFF, 0x7F, 0x30, 0x00, 0x78, 0x18, -+0x40, 0x00, 0x00, 0xB5, 0x44, 0x00, 0x00, 0xB5, -+0x48, 0x00, 0x00, 0xB5, 0x4C, 0x00, 0x00, 0xB5, -+0x00, 0x00, 0x10, 0x00, 0xA4, 0x04, 0x64, 0xB8, -+0xA8, 0x04, 0x64, 0xB8, 0xC0, 0x01, 0x64, 0xB8, -+0xAF, 0x01, 0x64, 0xB8, 0x7E, 0x04, 0x64, 0xB8, -+0x20, 0x04, 0x64, 0xB8, 0x04, 0x10, 0x66, 0xB8, -+0x08, 0x10, 0x66, 0xB8, 0x0C, 0x10, 0x66, 0xB8, -+0x7D, 0x04, 0x64, 0xB8, 0x7C, 0x04, 0x64, 0xB8, -+0x90, 0x00, 0x60, 0xB8, 0x98, 0x01, 0x64, 0xB8, -+0xFF, 0xFF, 0xC0, 0xFF, 0x40, 0x01, 0x00, 0x80, -+0x00, 0x98, 0x00, 0x80, 0x68, 0x06, 0x64, 0xB8, -+0xFF, 0xFF, 0xCF, 0xFF, 0x5C, 0x05, 0x64, 0xB8, -+0x38, 0x06, 0x64, 0xB8, 0x08, 0x06, 0x64, 0xB8, -+0xA0, 0x06, 0x64, 0xB8, 0x00, 0x00, 0x78, 0x18, -+0x40, 0x00, 0x60, 0xB8, 0x08, 0x90, 0x00, 0xB8, -+0x14, 0x90, 0x00, 0xB8, 0x14, 0x91, 0x00, 0xB8, -+0x20, 0x91, 0x00, 0xB8, 0x1C, 0x91, 0x00, 0xB8, -+0x2C, 0x90, 0x00, 0xB8, 0x00, 0x90, 0x00, 0xB8, -+0x10, 0x90, 0x00, 0xB8, 0x18, 0x91, 0x00, 0xB8, -+0x60, 0x90, 0x00, 0xB8, 0x04, 0x90, 0x00, 0xB8, -+0x00, 0x00, 0xFF, 0xFF, 0x28, 0x90, 0x00, 0xB8, -+0xE4, 0x00, 0x60, 0xB8, 0xE8, 0x00, 0x60, 0xB8, -+0xE9, 0x00, 0x60, 0xB8, 0xEA, 0x00, 0x60, 0xB8, -+0xEB, 0x00, 0x60, 0xB8, 0xE5, 0x00, 0x60, 0xB8, -+0x44, 0x00, 0x02, 0x00, 0xA0, 0x07, 0x64, 0xB8, -+0xF4, 0x00, 0x60, 0xB8, 0x30, 0x00, 0x78, 0xB8, -+0x8E, 0x6A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x10, 0xF0, 0x23, 0x6A, 0x40, 0xF2, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x20, 0xF4, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xC0, 0xF4, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x20, 0xF5, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x83, 0xF6, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xA3, 0xF7, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x63, 0xF6, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF5, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF4, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF2, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x60, 0xF5, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA0, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA0, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF1, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x61, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF5, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF1, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF6, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x62, 0xF1, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA2, 0xF0, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF6, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF5, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x60, 0xF0, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x7F, 0xF6, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC2, 0xF5, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x5F, 0xF6, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF7, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x42, 0xF6, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF6, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x43, 0xF6, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xFF, 0xF7, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xBF, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF0, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE0, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF3, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF3, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF1, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x62, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC2, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x41, 0xF4, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF2, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF7, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x61, 0xF0, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF0, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF7, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF1, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x22, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x82, 0xF7, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA2, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x1F, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x63, 0xF0, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA3, 0xF0, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC3, 0xF0, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF3, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x83, 0xF3, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC3, 0xF3, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x03, 0xF4, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF4, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x63, 0xF4, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA3, 0xF6, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE3, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF7, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA4, 0xF0, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x04, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x64, 0xF1, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x84, 0xF3, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE4, 0xF3, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x04, 0xF4, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x44, 0xF4, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x5C, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0x00, 0x6B, 0xC1, 0xF6, -+0x62, 0xC2, 0xC1, 0xF6, 0x63, 0xC2, 0xC1, 0xF6, -+0x64, 0xC2, 0xC1, 0xF6, 0x65, 0xC2, 0x20, 0xE8, -+0x10, 0xF0, 0x23, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xA3, 0xF7, 0x09, 0x4B, 0x40, 0xF1, 0x68, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0x40, 0xF1, 0x08, 0x4A, -+0x40, 0xF5, 0x15, 0x4B, 0x61, 0xDA, 0x10, 0xF0, -+0x23, 0x6B, 0xC0, 0xF5, 0x11, 0x4B, 0x62, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0xC0, 0xF5, 0x01, 0x4B, -+0x63, 0xDA, 0x10, 0xF0, 0x23, 0x6B, 0xA0, 0xF5, -+0x11, 0x4B, 0x64, 0xDA, 0x10, 0xF0, 0x23, 0x6B, -+0xA0, 0xF5, 0x01, 0x4B, 0x65, 0xDA, 0x10, 0xF0, -+0x23, 0x6B, 0x80, 0xF5, 0x11, 0x4B, 0x66, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0x80, 0xF5, 0x01, 0x4B, -+0x67, 0xDA, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xA8, 0xF4, 0x17, 0x4A, 0x67, 0x42, 0x09, 0x4B, -+0x00, 0x6C, 0x80, 0xC2, 0x01, 0x4A, 0x6A, 0xEA, -+0xFB, 0x61, 0x42, 0xF4, 0x10, 0x6A, 0x1F, 0xF7, -+0x00, 0x6B, 0x4C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF1, 0x68, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x23, 0x6B, 0x8E, 0xF1, 0x6C, 0x9B, 0x6D, 0xE2, -+0x04, 0x4A, 0x00, 0x6C, 0x62, 0xF4, 0x00, 0x72, -+0x80, 0xDB, 0xE9, 0x61, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x23, 0x6A, -+0x0E, 0xF2, 0x50, 0x9A, 0x03, 0x6D, 0xFF, 0x6B, -+0x80, 0x9A, 0x10, 0xF0, 0x23, 0x6A, 0x0E, 0xF2, -+0x54, 0x9A, 0x00, 0xF5, 0x82, 0x34, 0xAC, 0xEC, -+0x40, 0x9A, 0x01, 0x74, 0x42, 0x32, 0x52, 0x32, -+0xAC, 0xEA, 0x06, 0x60, 0x0A, 0x2C, 0x02, 0x5A, -+0x28, 0x6C, 0x0D, 0x60, 0x50, 0x6C, 0x0B, 0x10, -+0x02, 0x5A, 0x14, 0x6C, 0x08, 0x60, 0x28, 0x6C, -+0x04, 0x10, 0x02, 0x5A, 0x0A, 0x6C, 0x03, 0x60, -+0x14, 0x6C, 0x84, 0xEA, 0x6C, 0xEC, 0x80, 0x18, -+0x3C, 0x06, 0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, -+0x18, 0x4A, 0x00, 0x6B, 0xA0, 0xF1, 0x6B, 0xC2, -+0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF1, 0x68, 0x9B, -+0x00, 0x6A, 0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x4E, 0xF1, 0x78, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0xCE, 0xF1, 0x64, 0x9B, 0x40, 0xC3, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x68, 0x04, 0xD2, 0x04, 0x94, -+0x4E, 0xF2, 0x4C, 0x98, 0x00, 0x6D, 0x4C, 0xF7, -+0x14, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xAF, 0xF4, 0x18, 0x4A, 0x05, 0xD2, 0x05, 0x94, -+0x4E, 0xF2, 0x4C, 0x98, 0x00, 0x6D, 0x01, 0xF4, -+0x1C, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x30, 0x69, -+0x4E, 0xF2, 0x4C, 0x98, 0x00, 0xF0, 0x00, 0x49, -+0x91, 0x67, 0x00, 0x6D, 0xE1, 0xF7, 0x00, 0x6E, -+0x40, 0xEA, 0x80, 0x18, 0x35, 0x05, 0x04, 0x92, -+0x00, 0x68, 0x40, 0xF0, 0x00, 0xC1, 0x80, 0xF0, -+0x0C, 0xDA, 0x80, 0x18, 0x3C, 0x05, 0x05, 0x92, -+0xA0, 0xF1, 0x0C, 0xC2, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0x53, 0x05, -+0x80, 0x18, 0xB1, 0x05, 0x80, 0x18, 0xBC, 0x07, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, 0x44, 0x9A, -+0x40, 0xEA, 0x80, 0x18, 0x60, 0x06, 0x00, 0x18, -+0xF8, 0xD4, 0x00, 0x18, 0x1B, 0xD5, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0x6B, 0xAF, 0xF4, 0x18, 0x4A, 0xA0, 0xF0, -+0x60, 0xC2, 0xA0, 0xF0, 0x61, 0xC2, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0x40, 0xF0, -+0x60, 0xC2, 0x40, 0xF0, 0x61, 0xC2, 0x20, 0xE8, -+0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF3, 0x40, 0x9A, -+0x01, 0x6B, 0x60, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF3, 0x84, 0x9A, -+0xFF, 0x6B, 0x20, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, -+0x23, 0x6A, 0x4E, 0xF3, 0x88, 0x9A, 0x08, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x20, 0xE8, 0x10, 0xF0, 0x23, 0x6A, -+0x4E, 0xF3, 0x70, 0x9A, 0xFD, 0x6A, 0xFF, 0x6C, -+0xA0, 0xA3, 0xAC, 0xEA, 0x40, 0xC3, 0x40, 0xA3, -+0x01, 0x6D, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF3, -+0x14, 0x9A, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x4C, 0x9A, 0x90, 0x67, 0x00, 0x6D, 0x02, 0xF0, -+0x00, 0x6E, 0x40, 0xEA, 0x04, 0x6A, 0x40, 0xC0, -+0x10, 0xF0, 0x23, 0x6A, 0x4E, 0xF3, 0x58, 0x9A, -+0x20, 0x48, 0x0E, 0xEA, 0xF7, 0x2A, 0x10, 0xF0, -+0x23, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF3, -+0x9C, 0x9B, 0x4E, 0xF2, 0x4C, 0x9A, 0x00, 0x6D, -+0x00, 0xF4, 0x00, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF3, 0x12, 0x6E, -+0xC0, 0xF1, 0xC8, 0xDB, 0x01, 0xF7, 0x01, 0x6A, -+0xC0, 0xF1, 0x08, 0x4B, 0x08, 0xF0, 0x00, 0x6D, -+0x00, 0x6C, 0x42, 0xDB, 0x43, 0xDB, 0xA1, 0xDB, -+0x84, 0xDB, 0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF3, -+0x78, 0x9B, 0xC0, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF3, 0x60, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x23, 0x6B, 0x8E, 0xF3, 0x68, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF3, 0x70, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF3, -+0x58, 0x9A, 0x80, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x01, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x58, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x6E, 0xF3, 0x64, 0x9B, 0x40, 0xDB, 0x20, 0xE8, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF3, 0x94, 0x9B, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF1, 0x06, 0x6D, 0xFF, 0x6B, 0xAE, 0xDA, -+0x8F, 0xDA, 0x70, 0xDA, 0x10, 0xF0, 0x23, 0x6A, -+0xAE, 0xF3, 0x40, 0x9A, 0xA0, 0xDA, 0x10, 0xF0, -+0x23, 0x6A, 0xAE, 0xF3, 0x48, 0x9A, 0x80, 0xDA, -+0x10, 0xF0, 0x23, 0x6A, 0xAE, 0xF3, 0x50, 0x9A, -+0x60, 0xDA, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x5C, 0x9A, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0xFB, 0x06, -+0x30, 0xF0, 0x20, 0x6B, 0xE8, 0xF2, 0x5C, 0xC3, -+0x80, 0x18, 0xC9, 0x05, 0x00, 0x18, 0xDC, 0xD7, -+0x80, 0x18, 0x11, 0x06, 0x10, 0xF0, 0x23, 0x6A, -+0xAE, 0xF3, 0x58, 0x9A, 0x3F, 0x6B, 0x60, 0xC2, -+0x80, 0x18, 0xBA, 0x05, 0x80, 0x18, 0xBE, 0x05, -+0x80, 0x18, 0xD1, 0x05, 0x80, 0x18, 0x4D, 0x06, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0x00, 0x6A, 0xC0, 0xF1, 0x08, 0x48, -+0x01, 0x6C, 0x02, 0x6D, 0x00, 0x6E, 0x40, 0xF0, -+0x50, 0xC8, 0x00, 0x18, 0xA9, 0xC9, 0x40, 0xF0, -+0xD0, 0xA8, 0x01, 0x6C, 0x03, 0x6D, 0xC2, 0x36, -+0x00, 0x18, 0xA9, 0xC9, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x9B, 0xD0, 0x00, 0x18, 0xBA, 0xD0, -+0x80, 0x18, 0xE6, 0x05, 0x80, 0x18, 0x02, 0x06, -+0x80, 0x18, 0xFC, 0x05, 0x80, 0x18, 0x26, 0x06, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xD0, 0xCA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x81, 0xF4, 0x10, 0x6B, 0x28, 0xF1, 0x78, 0xDA, -+0x00, 0xF2, 0x00, 0x4B, 0x28, 0xF1, 0x7C, 0xDA, -+0x01, 0xF2, 0x00, 0x4B, 0x48, 0xF1, 0x60, 0xDA, -+0x00, 0xF2, 0x00, 0x4B, 0x48, 0xF1, 0x64, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x6C, 0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, -+0x18, 0x4A, 0x00, 0x6B, 0xC4, 0x67, 0x9F, 0xF7, -+0x00, 0x6D, 0xE1, 0xF3, 0x64, 0xC2, 0xE1, 0xF3, -+0x65, 0xC2, 0x00, 0x18, 0xA9, 0xC9, 0x00, 0x6C, -+0xC4, 0x67, 0x9F, 0xF7, 0x01, 0x6D, 0x00, 0x18, -+0xA9, 0xC9, 0x00, 0x6C, 0xC4, 0x67, 0x9F, 0xF7, -+0x02, 0x6D, 0x00, 0x18, 0xA9, 0xC9, 0x00, 0x6C, -+0x9F, 0xF7, 0x03, 0x6D, 0xC4, 0x67, 0x00, 0x18, -+0xA9, 0xC9, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6A, -+0x4E, 0xF4, 0x5C, 0x9A, 0xE0, 0xF1, 0x1B, 0x6B, -+0x6B, 0xEB, 0x60, 0xCA, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF4, 0x60, 0x9A, 0xFB, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x23, 0x6A, 0x65, 0xF4, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x85, 0xF4, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x68, 0xF1, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x54, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x83, 0xF1, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x0B, 0xF6, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x6A, 0xF1, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x8A, 0xF1, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x86, 0xF2, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x64, 0xF7, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x04, 0xF7, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x44, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x09, 0xF2, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xC7, 0xF5, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x07, 0xF6, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xAB, 0xF5, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x54, 0xDB, -+0x10, 0xF0, 0x30, 0x6A, 0x83, 0xF4, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x8C, 0xF1, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF5, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xEC, 0xF0, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF5, 0x44, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x2C, 0xF0, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xAC, 0xF0, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x25, 0xF6, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x26, 0xF0, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xA9, 0xF4, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF2, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x24, 0xF4, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xA4, 0xF4, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x05, 0xF4, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x45, 0xF4, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x25, 0xF4, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x48, 0xF6, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF4, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x2C, 0xF3, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF5, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xEC, 0xF4, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF5, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x0C, 0xF5, 0x15, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF5, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xAD, 0xF4, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF5, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xAD, 0xF4, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF5, 0x5C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xCD, 0xF4, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF5, 0x44, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xED, 0xF4, 0x01, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF5, 0x40, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xED, 0xF4, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF5, 0x54, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6A, -+0x0E, 0xF5, 0x40, 0x9A, 0x60, 0x9A, 0x03, 0x6A, -+0x62, 0x33, 0x72, 0x33, 0x4C, 0xEB, 0x02, 0x6A, -+0x04, 0x23, 0x01, 0x73, 0x01, 0x6A, 0x01, 0x60, -+0x03, 0x6A, 0x20, 0xE8, 0x15, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0xF0, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, 0xFF, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x3F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x3F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0xFF, 0xFF, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, 0xFF, -+0xFF, 0x03, 0x00, 0x00, 0x15, 0xF0, 0xFF, 0xFF, -+0x0F, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF4, 0x6C, 0x9B, 0xFF, 0x6A, 0x8C, 0xEA, -+0x60, 0x9B, 0x80, 0xF1, 0x01, 0x6C, 0x8B, 0xEC, -+0x8C, 0xEB, 0x10, 0xF0, 0x23, 0x6C, 0x0E, 0xF2, -+0x90, 0x9C, 0x01, 0x72, 0x80, 0x9C, 0x05, 0x60, -+0x02, 0x72, 0x05, 0x61, 0xFF, 0x6A, 0x01, 0x4A, -+0x01, 0x10, 0x80, 0x6A, 0x4D, 0xEB, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF4, 0x4C, 0x9A, 0x60, 0xDA, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF4, 0x50, 0x9A, -+0x10, 0xF0, 0x23, 0x6B, 0x0E, 0xF2, 0x70, 0x9B, -+0x8C, 0xEA, 0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6B, -+0x8E, 0xF4, 0x74, 0x9B, 0x50, 0x6A, 0x40, 0xC3, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF4, 0x78, 0x9B, -+0x40, 0xC3, 0x20, 0xE8, 0xFF, 0x6A, 0x4C, 0xEC, -+0x03, 0x6B, 0x8C, 0xEB, 0x4C, 0xEE, 0x3C, 0x2B, -+0x10, 0xF0, 0x23, 0x6B, 0xEE, 0xF4, 0x60, 0x9B, -+0x80, 0xC3, 0x0F, 0x6B, 0xCC, 0xEB, 0x34, 0x23, -+0x01, 0x6C, 0x6C, 0xEC, 0x06, 0x24, 0x10, 0xF0, -+0x23, 0x6C, 0xEE, 0xF4, 0x84, 0x9C, 0xAC, 0xEA, -+0x40, 0xC4, 0x02, 0x6A, 0x6C, 0xEA, 0x08, 0x22, -+0xFF, 0x6C, 0xA2, 0x32, 0x8C, 0xEA, 0x10, 0xF0, -+0x23, 0x6C, 0xEE, 0xF4, 0x88, 0x9C, 0x40, 0xC4, -+0x04, 0x6A, 0x6C, 0xEA, 0x09, 0x22, 0xA2, 0x32, -+0xFF, 0x6C, 0x42, 0x32, 0x8C, 0xEA, 0x10, 0xF0, -+0x23, 0x6C, 0xEE, 0xF4, 0x8C, 0x9C, 0x40, 0xC4, -+0x6E, 0x32, 0x07, 0x22, 0x10, 0xF0, 0x23, 0x6A, -+0xEE, 0xF4, 0x50, 0x9A, 0x00, 0xF6, 0xA2, 0x35, -+0xA0, 0xC2, 0x20, 0x6A, 0x6D, 0xEA, 0x10, 0xF0, -+0x23, 0x6B, 0xEE, 0xF4, 0x74, 0x9B, 0x40, 0xC3, -+0x00, 0x6A, 0x40, 0xC3, 0x01, 0x6A, 0x20, 0xE8, -+0x00, 0x6A, 0x20, 0xE8, 0xFF, 0x6A, 0x8C, 0xEA, -+0x03, 0x6B, 0x4C, 0xEB, 0x03, 0x23, 0x01, 0x6A, -+0x4B, 0xEA, 0x20, 0xE8, 0x10, 0xF0, 0x23, 0x6C, -+0xEE, 0xF4, 0x80, 0x9C, 0x40, 0xC4, 0x10, 0xF0, -+0x23, 0x6A, 0xEE, 0xF4, 0x94, 0x9A, 0x30, 0x6A, -+0x40, 0xC4, 0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF4, -+0x44, 0x9A, 0x40, 0x9A, 0x60, 0xC4, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x23, 0x6A, -+0xEE, 0xF4, 0xB8, 0x9A, 0xE0, 0xF3, 0x10, 0x6C, -+0x0F, 0x6E, 0x80, 0x18, 0x3B, 0x07, 0xE0, 0xF3, -+0x0C, 0x6C, 0x80, 0x18, 0x5D, 0x07, 0xFF, 0x6B, -+0x4C, 0xEB, 0x0B, 0x73, 0x0B, 0x61, 0x10, 0xF0, -+0x23, 0x6A, 0xEE, 0xF4, 0x7C, 0x9A, 0x10, 0xF0, -+0x23, 0x6C, 0xEE, 0xF3, 0x90, 0x9C, 0x40, 0x9B, -+0x8C, 0xEA, 0x40, 0xDB, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x05, 0x6B, 0x65, 0xF4, -+0x64, 0xDA, 0x00, 0x6B, 0x65, 0xF4, 0x60, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, -+0x06, 0xD4, 0x09, 0xD7, 0x07, 0xD5, 0x08, 0xD6, -+0x06, 0x04, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x46, 0x67, 0x01, 0x4A, -+0x05, 0x67, 0x0C, 0xD6, 0x27, 0x67, 0x1F, 0x22, -+0x1F, 0xF7, 0x00, 0x6A, 0xAC, 0xEA, 0x02, 0xF0, -+0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x48, 0x9A, 0x04, 0x10, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF1, 0x4C, 0x9A, -+0x49, 0xE0, 0x40, 0x9A, 0x0C, 0x94, 0x04, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, 0x50, 0x9A, -+0x40, 0xEA, 0x0C, 0x93, 0x24, 0xEA, 0x6F, 0xEA, -+0x04, 0x93, 0x6C, 0xEA, 0x4D, 0xE9, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x48, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x4C, 0x9A, 0x41, 0xE0, -+0x20, 0xD8, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x1F, 0xF7, 0x00, 0x6A, -+0xAC, 0xEA, 0x02, 0xF0, 0x00, 0x72, 0x26, 0x67, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x23, 0x6A, -+0x8E, 0xF1, 0x48, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF1, 0x4C, 0x9A, 0x55, 0xE5, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0x9D, 0xAE, 0xF4, -+0x50, 0x9A, 0x91, 0x67, 0x2C, 0xE8, 0x40, 0xEA, -+0x06, 0xEA, 0x50, 0x67, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x6A, 0x10, 0xF0, -+0x23, 0x6B, 0x4E, 0xF2, 0x7C, 0x9B, 0x54, 0x34, -+0x01, 0x4A, 0x71, 0xE4, 0xA0, 0xA4, 0xF8, 0x6B, -+0xAC, 0xEB, 0x60, 0xC4, 0xFF, 0x6B, 0x6C, 0xEA, -+0x80, 0x72, 0xF1, 0x61, 0x80, 0x18, 0x7B, 0x07, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x60, 0xA4, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC5, 0xF6, -+0x71, 0xC2, 0x61, 0xA4, 0x65, 0xF4, 0x6A, 0xC2, -+0x62, 0xA4, 0xC5, 0xF6, 0x70, 0xC2, 0xA3, 0xA4, -+0x0F, 0x6B, 0xAC, 0xEB, 0xC5, 0xF6, 0x74, 0xC2, -+0x63, 0xA4, 0x72, 0x33, 0xC5, 0xF6, 0x75, 0xC2, -+0x80, 0x18, 0x21, 0x0A, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x68, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC5, 0xF6, 0x71, 0xC2, 0x69, 0xA4, -+0x65, 0xF4, 0x6A, 0xC2, 0x6A, 0xA4, 0xC5, 0xF6, -+0x70, 0xC2, 0xAB, 0xA4, 0x0F, 0x6B, 0xAC, 0xEB, -+0xC5, 0xF6, 0x74, 0xC2, 0x6B, 0xA4, 0x72, 0x33, -+0xC5, 0xF6, 0x75, 0xC2, 0x80, 0x18, 0x21, 0x0A, -+0x05, 0x97, 0x00, 0x6A, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x11, 0x72, 0x04, 0x61, 0x85, 0x67, 0x80, 0x18, -+0xD7, 0x07, 0x0C, 0x10, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF1, 0x68, 0x9A, 0x10, 0xF0, 0x23, 0x6C, -+0x0E, 0xF2, 0x98, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0xFF, 0x6A, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x01, 0x6A, 0x20, 0xE8, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x01, 0x75, 0x1F, 0x61, -+0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF2, 0x20, 0x9A, -+0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x41, 0xF1, 0x08, 0x6C, 0x02, 0x6E, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, -+0x41, 0xF1, 0x0C, 0x6C, 0x02, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF1, 0x2C, 0x9A, -+0x21, 0xF4, 0x00, 0x6C, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x00, 0x6E, 0x46, 0x10, 0x02, 0x75, -+0x26, 0x61, 0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF2, -+0x20, 0x9A, 0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, -+0x50, 0x98, 0xB1, 0x67, 0x41, 0xF1, 0x08, 0x6C, -+0x02, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x41, 0xF1, 0x0C, 0x6C, 0x01, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6A, 0xEE, 0xF1, -+0x2C, 0x9A, 0xCE, 0xF4, 0x50, 0x98, 0x21, 0xF4, -+0x00, 0x6C, 0xB1, 0x67, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xE1, 0xF0, 0x10, 0x6C, -+0xB1, 0x67, 0x01, 0x6E, 0x25, 0x10, 0x10, 0xF0, -+0x23, 0x6A, 0x6E, 0xF2, 0x20, 0x9A, 0x30, 0xF0, -+0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, -+0x41, 0xF1, 0x08, 0x6C, 0x02, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, 0x41, 0xF1, -+0x0C, 0x6C, 0x02, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x23, 0x6A, 0xEE, 0xF1, 0x2C, 0x9A, 0xCE, 0xF4, -+0x50, 0x98, 0x21, 0xF4, 0x00, 0x6C, 0xB1, 0x67, -+0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xE1, 0xF0, 0x10, 0x6C, 0xB1, 0x67, 0x00, 0x6E, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x03, 0x25, 0x01, 0x6A, 0x4B, 0xEA, 0x0C, 0x10, -+0x10, 0xF0, 0x23, 0x6A, 0xFF, 0x6C, 0x6E, 0xF2, -+0xBC, 0x9A, 0xCC, 0xEC, 0x88, 0x34, 0x05, 0xF0, -+0x00, 0x4C, 0xEC, 0xED, 0x00, 0x18, 0x9A, 0xD2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x0E, 0x90, 0x41, 0x2D, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF2, 0x5C, 0x9A, 0xFF, 0x69, 0xCC, 0xE9, -+0x4C, 0xEF, 0x4A, 0xEF, 0x04, 0xD7, 0x19, 0x60, -+0xD1, 0x67, 0xE2, 0x67, 0x80, 0x18, 0x33, 0x08, -+0x61, 0x42, 0x31, 0x23, 0x00, 0x6C, 0x64, 0x67, -+0x04, 0x95, 0x01, 0x6E, 0xA6, 0xEC, 0xCC, 0xED, -+0x07, 0x2D, 0x01, 0x4B, 0xFF, 0x6D, 0xAC, 0xEB, -+0x14, 0x73, 0x01, 0x4C, 0xF5, 0x61, 0x14, 0x6B, -+0x04, 0x94, 0x04, 0xEB, 0x8F, 0xEB, 0x4C, 0xEB, -+0x6D, 0xE8, 0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF2, -+0x7C, 0x9A, 0x10, 0xF0, 0x23, 0x6E, 0x8E, 0xF2, -+0xC0, 0x9E, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x0C, 0xEB, 0x00, 0xF5, 0x20, 0x31, -+0x2D, 0xEB, 0x01, 0x6D, 0x81, 0xF4, 0x10, 0x6C, -+0xAB, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x0D, 0x6C, -+0x40, 0xEA, 0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x0E, 0xD4, 0x6B, 0xA4, -+0xFF, 0x68, 0xAC, 0xE8, 0x01, 0x6A, 0x60, 0xF1, -+0x0B, 0x2B, 0x30, 0xF0, 0x21, 0x6A, 0xF1, 0xF0, -+0x1C, 0xC2, 0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF2, -+0xFC, 0x9A, 0x00, 0x6D, 0x18, 0x6E, 0x80, 0x18, -+0x33, 0x08, 0x08, 0xD2, 0x08, 0x93, 0x00, 0x6A, -+0x01, 0x4B, 0x01, 0x23, 0x01, 0x6A, 0x01, 0x6B, -+0x4C, 0xEB, 0x07, 0xD3, 0x0E, 0x93, 0x60, 0xF2, -+0x50, 0xA3, 0x00, 0x6B, 0x06, 0xD3, 0x12, 0x2A, -+0x10, 0xF0, 0x23, 0x6A, 0x0E, 0x94, 0x6E, 0xF2, -+0xFC, 0x9A, 0xA3, 0x67, 0xB8, 0x6E, 0x80, 0x18, -+0x33, 0x08, 0x06, 0xD2, 0x06, 0x93, 0x00, 0x6A, -+0x01, 0x4B, 0x01, 0x23, 0x01, 0x6A, 0x07, 0x93, -+0x4C, 0xEB, 0x07, 0xD3, 0x0F, 0x58, 0x69, 0x60, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF2, 0x24, 0x9A, -+0x08, 0x92, 0x30, 0xF0, 0x20, 0x6B, 0x01, 0xF4, -+0x1C, 0x6C, 0x4C, 0xE9, 0xCE, 0xF4, 0x50, 0x9B, -+0x01, 0xF7, 0x00, 0x6D, 0x00, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x10, 0xF0, 0x23, 0x6B, 0x8E, 0xF2, 0xA8, 0x9B, -+0x61, 0xF0, 0x00, 0x6C, 0x61, 0xF1, 0x0A, 0x6E, -+0x40, 0xEA, 0x0E, 0x93, 0x0D, 0xE9, 0x60, 0xF2, -+0x50, 0xA3, 0x07, 0x2A, 0x10, 0xF0, 0x23, 0x6A, -+0x06, 0x93, 0x8E, 0xF2, 0x4C, 0x9A, 0x4D, 0xEB, -+0x06, 0xD3, 0x0E, 0x70, 0x1C, 0x61, 0x30, 0xF0, -+0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0x21, 0xF2, 0x04, 0x6C, 0xAB, 0xED, 0x17, 0xF0, -+0x1C, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x21, 0xF2, 0x08, 0x6C, 0xFF, 0xF7, 0x1F, 0x6D, -+0x00, 0x6E, 0x40, 0xEA, 0x01, 0x6D, 0xCE, 0xF4, -+0x50, 0x98, 0xA1, 0xF2, 0x0C, 0x6C, 0xAB, 0xED, -+0x66, 0xF6, 0x07, 0x6E, 0x20, 0x10, 0x30, 0xF0, -+0x20, 0x68, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, -+0x70, 0x98, 0x8E, 0xF2, 0xD0, 0x9A, 0x01, 0x6D, -+0x21, 0xF2, 0x04, 0x6C, 0xAB, 0xED, 0x40, 0xEB, -+0xCE, 0xF4, 0x50, 0x98, 0x21, 0xF2, 0x08, 0x6C, -+0xFF, 0xF7, 0x1F, 0x6D, 0x11, 0xF0, 0x10, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x8E, 0xF2, 0xD4, 0x9B, 0x01, 0x6D, -+0xA1, 0xF2, 0x0C, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0xAE, 0x10, 0x24, 0x58, 0xC0, 0xF0, 0x0F, 0x61, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF2, 0x24, 0x9A, -+0x08, 0x92, 0x68, 0x40, 0xE4, 0x4B, 0x4C, 0xE9, -+0xFF, 0x6A, 0x4C, 0xEB, 0x1D, 0x5B, 0x0D, 0xE9, -+0x12, 0x61, 0x68, 0x40, 0xA4, 0x4B, 0x4C, 0xEB, -+0x29, 0x5B, 0x05, 0x60, 0x10, 0xF0, 0x23, 0x6A, -+0x0E, 0xF2, 0x58, 0x9A, 0x07, 0x10, 0x8D, 0x58, -+0xA0, 0xF0, 0x15, 0x61, 0x10, 0xF0, 0x23, 0x6A, -+0x4E, 0xF2, 0x54, 0x9A, 0x4D, 0xE9, 0x68, 0x40, -+0xE4, 0x4B, 0xFF, 0x6A, 0x4C, 0xEB, 0x1D, 0x5B, -+0x0A, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x01, 0xF4, 0x1C, 0x6C, 0x01, 0xF7, -+0x00, 0x6D, 0x01, 0x6E, 0x1B, 0x10, 0x68, 0x40, -+0xA4, 0x4B, 0x4C, 0xEB, 0x2D, 0x5B, 0x0A, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, -+0x01, 0xF4, 0x1C, 0x6C, 0x01, 0xF7, 0x00, 0x6D, -+0x02, 0x6E, 0x0C, 0x10, 0x95, 0x58, 0x80, 0xF0, -+0x0E, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x01, 0xF4, 0x1C, 0x6C, 0x01, 0xF7, -+0x00, 0x6D, 0x03, 0x6E, 0x40, 0xEA, 0x68, 0x40, -+0xE4, 0x4B, 0xFF, 0x6A, 0x4C, 0xEB, 0x0D, 0x5B, -+0x0D, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, -+0x23, 0x6B, 0xCE, 0xF4, 0x50, 0x9A, 0x61, 0xF0, -+0x00, 0x6C, 0x8E, 0xF2, 0xA8, 0x9B, 0x80, 0xF4, -+0x14, 0x6E, 0x35, 0x10, 0x68, 0x40, 0xD4, 0x4B, -+0x4C, 0xEB, 0x0D, 0x5B, 0x0D, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF4, -+0x50, 0x9A, 0x61, 0xF0, 0x00, 0x6C, 0x8E, 0xF2, -+0xA8, 0x9B, 0x40, 0xF4, 0x13, 0x6E, 0x23, 0x10, -+0x68, 0x40, 0xA4, 0x4B, 0x4C, 0xEB, 0x11, 0x5B, -+0x0D, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, -+0x23, 0x6B, 0xCE, 0xF4, 0x50, 0x9A, 0x61, 0xF0, -+0x00, 0x6C, 0x8E, 0xF2, 0xA8, 0x9B, 0x40, 0xF4, -+0x12, 0x6E, 0x11, 0x10, 0x68, 0x40, 0x92, 0x4B, -+0x4C, 0xEB, 0x3C, 0x5B, 0x48, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF4, -+0x50, 0x9A, 0x8E, 0xF2, 0xA8, 0x9B, 0x61, 0xF0, -+0x00, 0x6C, 0x00, 0xF4, 0x12, 0x6E, 0x40, 0xEA, -+0x0E, 0x93, 0x60, 0xF2, 0x50, 0xA3, 0x13, 0x2A, -+0xC7, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0x13, 0x58, -+0x07, 0x60, 0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF2, -+0x58, 0x9A, 0x06, 0x93, 0x4C, 0xEB, 0x06, 0x10, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF2, 0x4C, 0x9A, -+0x06, 0x93, 0x4D, 0xEB, 0x06, 0xD3, 0x10, 0xF0, -+0x23, 0x6A, 0x6E, 0xF2, 0x1C, 0x4A, 0x0E, 0x94, -+0xE0, 0x9A, 0x00, 0x6D, 0x18, 0x6E, 0x04, 0xD1, -+0x80, 0x18, 0x3E, 0x08, 0x07, 0x90, 0x0E, 0x93, -+0x4C, 0xE8, 0x60, 0xF2, 0x50, 0xA3, 0x0F, 0x2A, -+0x83, 0x67, 0x10, 0xF0, 0x23, 0x6B, 0x6E, 0xF2, -+0x1C, 0x4B, 0x06, 0x92, 0xE0, 0x9B, 0x00, 0x6D, -+0xB8, 0x6E, 0x04, 0xD2, 0x80, 0x18, 0x3E, 0x08, -+0x4C, 0xE8, 0xFF, 0x6A, 0x4C, 0xE8, 0x0B, 0xE8, -+0xC0, 0xF7, 0x02, 0x32, 0x01, 0x10, 0x00, 0x6A, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0x6A, 0xAC, 0xEA, -+0x06, 0xD2, 0x6B, 0xA4, 0x24, 0x67, 0x01, 0x6A, -+0x80, 0xF0, 0x16, 0x2B, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF2, 0xFC, 0x9A, 0x00, 0x6D, 0x18, 0x6E, -+0x80, 0x18, 0x33, 0x08, 0x07, 0xD2, 0x06, 0x92, -+0x0F, 0x5A, 0x36, 0x60, 0x30, 0xF0, 0x20, 0x68, -+0x10, 0xF0, 0x23, 0x6B, 0x2E, 0xF2, 0xB0, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0xF0, 0x08, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x40, 0xF4, 0x14, 0x6C, 0x80, 0x6D, 0x00, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x4E, 0xF2, 0xB4, 0x9B, 0x81, 0xF2, -+0x00, 0x6C, 0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0xF0, 0x14, 0x6C, 0x1F, 0xF4, -+0x00, 0x6D, 0x0F, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x23, 0x6A, 0x8E, 0xF2, 0x1C, 0x9A, 0x07, 0x92, -+0x4C, 0xE8, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF2, -+0x59, 0xA2, 0x03, 0x22, 0x91, 0x67, 0x00, 0x6D, -+0x38, 0x10, 0x91, 0x67, 0x01, 0x6D, 0x35, 0x10, -+0x06, 0x92, 0x24, 0x5A, 0x50, 0x61, 0x30, 0xF0, -+0x20, 0x68, 0x10, 0xF0, 0x23, 0x6B, 0x4E, 0xF2, -+0xB4, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x81, 0xF2, -+0x00, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x40, 0xF4, 0x14, 0x6C, 0x80, 0x6D, -+0x01, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6B, -+0xCE, 0xF4, 0x50, 0x98, 0x2E, 0xF2, 0xB0, 0x9B, -+0x01, 0xF0, 0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0xF0, 0x14, 0x6C, -+0x1F, 0xF4, 0x00, 0x6D, 0x0F, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x23, 0x6A, 0x8E, 0xF2, 0x1C, 0x9A, -+0x07, 0x92, 0x91, 0x67, 0x02, 0x6D, 0x4C, 0xE8, -+0x10, 0xF0, 0x23, 0x6A, 0xAE, 0xF2, 0x40, 0x9A, -+0x4D, 0xE8, 0x00, 0x18, 0x6A, 0xC7, 0x10, 0xF0, -+0x23, 0x6A, 0x6E, 0xF2, 0xFC, 0x9A, 0x91, 0x67, -+0x00, 0x6D, 0x18, 0x6E, 0x04, 0xD0, 0x80, 0x18, -+0x3E, 0x08, 0x06, 0x95, 0x91, 0x67, 0x02, 0x67, -+0x80, 0x18, 0xF3, 0x07, 0x0C, 0x22, 0x07, 0x92, -+0x00, 0x6C, 0x01, 0x4A, 0x01, 0x22, 0x01, 0x6C, -+0xFF, 0x6B, 0x0C, 0xEB, 0x8C, 0xEB, 0x00, 0x6A, -+0x03, 0x23, 0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x0A, 0xD4, 0x0C, 0xD6, -+0x6B, 0xA4, 0xFF, 0x68, 0xAC, 0xE8, 0x01, 0x6A, -+0x20, 0xF1, 0x01, 0x2B, 0x06, 0x5E, 0x00, 0xF1, -+0x1D, 0x60, 0x01, 0x76, 0x02, 0x61, 0x03, 0x58, -+0x04, 0x10, 0x0C, 0x93, 0x02, 0x73, 0x03, 0x61, -+0x05, 0x58, 0x00, 0xF1, 0x13, 0x60, 0x0C, 0x93, -+0x30, 0xF0, 0x21, 0x6A, 0x0A, 0x94, 0xF1, 0xF0, -+0x78, 0xDA, 0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF2, -+0xFC, 0x9A, 0x00, 0x6D, 0x18, 0x6E, 0x80, 0x18, -+0x33, 0x08, 0x22, 0x67, 0x0C, 0x92, 0x06, 0x5A, -+0x08, 0x60, 0x48, 0x33, 0x10, 0xF0, 0x23, 0x6A, -+0x6E, 0xF0, 0x04, 0x4A, 0x69, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x51, 0x67, 0xDF, 0x10, 0x01, 0x6D, -+0xA1, 0xF0, 0x0C, 0x6C, 0xAB, 0xED, 0x00, 0x18, -+0x9A, 0xD2, 0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF2, -+0x64, 0x9B, 0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, -+0xF0, 0x98, 0x4C, 0xEB, 0x10, 0xF0, 0x23, 0x6A, -+0xAE, 0xF2, 0xC8, 0x9A, 0x01, 0x6D, 0xA1, 0xF0, -+0x0C, 0x6C, 0xAB, 0xED, 0x6D, 0xEE, 0x40, 0xEF, -+0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF4, 0x50, 0x98, -+0xC1, 0xF0, 0x04, 0x6C, 0x2E, 0xF2, 0xAC, 0x9B, -+0xB8, 0x10, 0x01, 0x70, 0x09, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x01, 0xF2, -+0x00, 0x6C, 0x10, 0x6D, 0x01, 0x6E, 0x08, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, -+0x01, 0xF2, 0x00, 0x6C, 0x10, 0x6D, 0x00, 0x6E, -+0x40, 0xEA, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x18, 0x9A, 0xD2, 0x10, 0xF0, -+0x23, 0x6B, 0xAE, 0xF2, 0xEC, 0x9B, 0x0F, 0x6E, -+0x0C, 0xEE, 0x4C, 0xEF, 0x10, 0xF0, 0x23, 0x6A, -+0xAE, 0xF2, 0x50, 0x9A, 0xC8, 0x36, 0x01, 0x6D, -+0x4D, 0xEE, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x70, 0x9A, 0xED, 0xEE, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x40, 0xEB, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x23, 0x6B, -+0x2E, 0xF2, 0xAC, 0x9B, 0xC1, 0xF0, 0x04, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x01, 0xF4, 0x01, 0x6A, -+0x4B, 0xEA, 0x2C, 0xEA, 0x01, 0xF0, 0x00, 0x6B, -+0x2F, 0x10, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x18, 0x9A, 0xD2, 0x10, 0xF0, -+0x23, 0x6B, 0xAE, 0xF2, 0xF4, 0x9B, 0x0F, 0x6E, -+0x0C, 0xEE, 0x4C, 0xEF, 0x10, 0xF0, 0x23, 0x6A, -+0xAE, 0xF2, 0x58, 0x9A, 0xC8, 0x36, 0x01, 0x6D, -+0x4D, 0xEE, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x70, 0x9A, 0xED, 0xEE, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x40, 0xEB, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x23, 0x6B, -+0x2E, 0xF2, 0xAC, 0x9B, 0xC1, 0xF0, 0x04, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x01, 0xF4, 0x01, 0x6A, -+0x4B, 0xEA, 0x2C, 0xEA, 0x00, 0xF4, 0x00, 0x6B, -+0x6D, 0xEA, 0x48, 0x10, 0x01, 0x6D, 0xA1, 0xF0, -+0x0C, 0x6C, 0xAB, 0xED, 0x00, 0x18, 0x9A, 0xD2, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF2, 0x7C, 0x9B, -+0x30, 0xF0, 0x20, 0x68, 0x01, 0x6D, 0x4C, 0xEB, -+0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF4, 0xF0, 0x98, -+0xA1, 0xF0, 0x0C, 0x6C, 0xAB, 0xED, 0xCE, 0xF2, -+0xC0, 0x9A, 0x17, 0x10, 0x01, 0x6D, 0xA1, 0xF0, -+0x0C, 0x6C, 0xAB, 0xED, 0x00, 0x18, 0x9A, 0xD2, -+0x10, 0xF0, 0x23, 0x6B, 0xAE, 0xF2, 0x7C, 0x9B, -+0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, 0xF0, 0x98, -+0x4C, 0xEB, 0x10, 0xF0, 0x23, 0x6A, 0xCE, 0xF2, -+0xC4, 0x9A, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x6D, 0xEE, 0x40, 0xEF, 0x10, 0xF0, -+0x23, 0x6B, 0x2E, 0xF2, 0xAC, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0xC1, 0xF0, 0x04, 0x6C, 0x00, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0xEE, 0xF1, 0xAC, 0x9B, 0xC1, 0xF0, -+0x08, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0x01, 0xF4, -+0x00, 0x6A, 0x2D, 0xEA, 0x04, 0xD2, 0x10, 0xF0, -+0x23, 0x6A, 0x0A, 0x94, 0x6E, 0xF2, 0xFC, 0x9A, -+0x00, 0x6D, 0x18, 0x6E, 0x01, 0x49, 0x80, 0x18, -+0x3E, 0x08, 0x00, 0x6C, 0x01, 0x21, 0x01, 0x6C, -+0xFF, 0x6B, 0x4C, 0xEB, 0x8C, 0xEB, 0x06, 0x23, -+0x0A, 0x94, 0x0C, 0x95, 0x80, 0x18, 0xF7, 0x07, -+0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x68, 0x0C, 0xED, 0x24, 0x67, 0x0D, 0xD7, -+0x04, 0xD5, 0xCC, 0xE8, 0x80, 0x18, 0x23, 0x09, -+0x0F, 0x22, 0x04, 0x95, 0x91, 0x67, 0x80, 0x18, -+0x65, 0x08, 0x0A, 0x22, 0x0D, 0x96, 0x91, 0x67, -+0xB0, 0x67, 0x80, 0x18, 0x77, 0x09, 0x4B, 0xEB, -+0x4D, 0xEB, 0xC0, 0xF7, 0x62, 0x32, 0x01, 0x10, -+0x00, 0x6A, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6B, -+0x86, 0xF0, 0x99, 0xA3, 0x30, 0xF0, 0x20, 0x6A, -+0x1F, 0x6B, 0x8C, 0xEB, 0xAF, 0xF4, 0x18, 0x4A, -+0xC0, 0xF5, 0x7C, 0xC2, 0xFF, 0x6D, 0xFF, 0x4B, -+0xAC, 0xEB, 0x00, 0x6C, 0x07, 0x5B, 0xC0, 0xF5, -+0x9F, 0xC2, 0x08, 0x60, 0x10, 0xF0, 0x23, 0x6A, -+0x68, 0x33, 0x6E, 0xF0, 0x1C, 0x4A, 0x69, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x01, 0x6B, 0xC0, 0xF5, -+0x7D, 0xC2, 0xC0, 0xF5, 0x9E, 0xC2, 0x0A, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, 0x18, 0x4A, -+0x01, 0x6B, 0xC0, 0xF5, 0x7D, 0xC2, 0xC0, 0xF5, -+0x7E, 0xC2, 0x00, 0x6C, 0xE0, 0xF5, 0x81, 0xC2, -+0x38, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, -+0x18, 0x4A, 0x01, 0x6B, 0xC0, 0xF5, 0x7D, 0xC2, -+0x08, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x01, 0x6B, -+0xAF, 0xF4, 0x18, 0x4A, 0xC0, 0xF5, 0x7D, 0xC2, -+0x00, 0x6B, 0xC0, 0xF5, 0x7E, 0xC2, 0x23, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, 0x18, 0x4A, -+0x01, 0x6C, 0x00, 0x6B, 0xC0, 0xF5, 0x9D, 0xC2, -+0xC0, 0xF5, 0x7E, 0xC2, 0xDF, 0x17, 0x30, 0xF0, -+0x20, 0x6A, 0xAF, 0xF4, 0x18, 0x4A, 0x00, 0x6B, -+0x02, 0x6C, 0xC0, 0xF5, 0x7D, 0xC2, 0xE0, 0xF5, -+0x61, 0xC2, 0xC0, 0xF5, 0x9E, 0xC2, 0x01, 0x6B, -+0x0C, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xAF, 0xF4, -+0x18, 0x4A, 0x01, 0x6B, 0x00, 0x6C, 0xC0, 0xF5, -+0x7D, 0xC2, 0xC0, 0xF5, 0x9E, 0xC2, 0xE0, 0xF5, -+0x61, 0xC2, 0xE0, 0xF5, 0x60, 0xC2, 0x20, 0xE8, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0xFF, 0x6A, 0xAF, 0xF4, -+0x18, 0x4B, 0x8C, 0xEA, 0xC0, 0xF5, 0x9D, 0xA3, -+0x4F, 0x24, 0xC0, 0xF5, 0x7F, 0xA3, 0x00, 0x69, -+0x01, 0x23, 0x01, 0x69, 0x30, 0xF0, 0x21, 0x6B, -+0x90, 0xF2, 0x78, 0xA3, 0x02, 0x2B, 0x01, 0x6B, -+0x6E, 0xE9, 0x05, 0x2A, 0x3B, 0x10, 0x01, 0x6A, -+0x4E, 0xE9, 0x04, 0xD2, 0x02, 0x10, 0x00, 0x6A, -+0x04, 0xD2, 0x10, 0xF0, 0x23, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0xCE, 0xF2, 0xA8, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x4C, 0x6C, 0x02, 0x6E, 0x40, 0xEA, -+0x04, 0x93, 0x14, 0x2B, 0xCE, 0xF4, 0x50, 0x98, -+0xA1, 0xF4, 0x14, 0x6C, 0xFF, 0x6D, 0x77, 0x6E, -+0x40, 0xEA, 0x01, 0x59, 0x38, 0x67, 0x10, 0xF0, -+0x23, 0x6B, 0x02, 0x6E, 0xCE, 0xF4, 0x50, 0x98, -+0xA1, 0xF4, 0x14, 0x6C, 0x6E, 0xF2, 0xA0, 0x9B, -+0x3B, 0xE6, 0x12, 0x10, 0xCE, 0xF4, 0x50, 0x98, -+0xA1, 0xF4, 0x14, 0x6C, 0xFF, 0x6D, 0x66, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x23, 0x6B, 0x01, 0x59, -+0xCE, 0xF4, 0x50, 0x98, 0x6E, 0xF2, 0xA0, 0x9B, -+0xD8, 0x67, 0xA1, 0xF4, 0x14, 0x6C, 0x01, 0x4E, -+0x40, 0xEA, 0x06, 0x10, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF2, 0x59, 0xA2, 0xC0, 0x22, 0xC3, 0x17, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0x0F, 0x5C, 0x09, 0x60, 0x10, 0xF0, 0x23, 0x6A, -+0xCE, 0xF2, 0x6C, 0x9A, 0xFC, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x24, 0x5C, -+0x0A, 0x61, 0x10, 0xF0, 0x23, 0x6B, 0xCE, 0xF2, -+0x8C, 0x9B, 0x03, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, -+0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, 0x20, 0xE8, -+0x10, 0xF0, 0x21, 0x6A, 0x84, 0xF4, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x24, 0xF5, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC4, 0xF5, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x24, 0xF6, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x64, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE4, 0xF6, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE4, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x65, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x45, 0xF2, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x45, 0xF3, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC5, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA5, 0xF7, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA5, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x06, 0xF1, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC6, 0xF1, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x00, 0x00, 0x00, 0x00, -+0xE7, 0x91, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+}; -+ -+u32 array_length_mp_8821c_fw_spic = 73056; -+ -+#ifdef CONFIG_WOWLAN -+ -+u8 array_mp_8821c_fw_wowlan[] = { -+0x21, 0x88, 0x00, 0x00, 0x18, 0x00, 0x05, 0x00, -+0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, -+0x09, 0x06, 0x0F, 0x14, 0xE3, 0x07, 0x00, 0x00, -+0x18, 0x00, 0x00, 0x00, 0x0C, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x20, 0x80, 0xC0, 0x7C, 0x00, 0x00, -+0x00, 0x00, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x50, 0xB8, 0x00, 0x00, 0x68, 0x5B, 0x00, 0x00, -+0x00, 0x00, 0x10, 0x80, 0x00, 0x00, 0x03, 0x80, -+0x00, 0x00, 0x04, 0x04, 0x08, 0x08, 0x08, 0x08, -+0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, -+0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, -+0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x03, 0x00, 0x01, 0xFE, 0x03, 0x01, 0x01, 0xFE, -+0x03, 0x02, 0x01, 0xFE, 0x03, 0x03, 0x01, 0xFE, -+0x03, 0x04, 0x01, 0xFE, 0x03, 0x05, 0x01, 0xFE, -+0x03, 0x06, 0x01, 0xFE, 0x03, 0x07, 0x01, 0xFE, -+0x06, 0x00, 0x00, 0x00, 0x05, 0x00, 0x00, 0x00, -+0x01, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, -+0x00, 0x01, 0x10, 0x00, 0x01, 0x00, 0x03, 0x80, -+0x99, 0x01, 0x03, 0x80, 0x99, 0x01, 0x03, 0x80, -+0xD9, 0x56, 0x03, 0x80, 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, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xCD, 0x58, 0x03, 0x80, 0x01, 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, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x94, 0x83, 0x20, 0x80, 0x00, 0x50, 0xF2, 0x01, -+0x06, 0x09, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x36, -+0x01, 0x02, 0x05, 0x0B, 0x00, 0x00, 0x00, 0x00, -+0x01, 0x02, 0x03, 0x06, 0x05, 0x06, 0x07, 0x08, -+0x09, 0x0A, 0x0B, 0x2C, 0xFF, 0x00, 0x01, 0x02, -+0x02, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, -+0x28, 0x28, 0x32, 0x28, 0x1E, 0x19, 0x19, 0x19, -+0x18, 0x18, 0x12, 0x0F, 0x1E, 0x1E, 0x19, 0x1E, -+0x18, 0x16, 0x0C, 0x0C, 0x1E, 0x1E, 0x19, 0x1E, -+0x18, 0x16, 0x0C, 0x0C, 0x1E, 0x1E, 0x19, 0x1C, -+0x18, 0x14, 0x0C, 0x0A, 0x1E, 0x1E, 0x19, 0x1E, -+0x19, 0x18, 0x0F, 0x0E, 0x1E, 0x1E, 0x1E, 0x1E, -+0x1C, 0x16, 0x14, 0x12, 0x0C, 0x0A, 0x1E, 0x1E, -+0x1E, 0x1E, 0x1A, 0x16, 0x12, 0x10, 0x0C, 0x0A, -+0x1E, 0x1E, 0x1E, 0x1E, 0x18, 0x16, 0x0D, 0x0E, -+0x0C, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x12, 0x12, 0x14, 0x12, -+0x0F, 0x0F, 0x0C, 0x0C, 0x09, 0x08, 0x08, 0x07, -+0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, 0x05, 0x04, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, 0x07, 0x06, -+0x0A, 0x0A, 0x08, 0x08, 0x08, 0x07, 0x07, 0x06, -+0x04, 0x04, 0x0C, 0x0C, 0x0A, 0x0A, 0x09, 0x07, -+0x07, 0x06, 0x05, 0x04, 0x0C, 0x0C, 0x0A, 0x0A, -+0x09, 0x07, 0x07, 0x06, 0x05, 0x04, 0x0A, 0x0A, -+0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, 0x0A, -+0x02, 0x02, 0x02, 0x04, 0x02, 0x04, 0x06, 0x06, -+0x08, 0x08, 0x09, 0x09, 0x04, 0x08, 0x08, 0x08, -+0x0C, 0x10, 0x10, 0x18, 0x04, 0x08, 0x08, 0x08, -+0x0C, 0x10, 0x10, 0x18, 0x05, 0x08, 0x08, 0x09, -+0x10, 0x14, 0x1C, 0x20, 0x04, 0x06, 0x08, 0x0A, -+0x10, 0x18, 0x18, 0x20, 0x03, 0x05, 0x08, 0x09, -+0x10, 0x14, 0x1C, 0x24, 0x2A, 0x2C, 0x05, 0x07, -+0x09, 0x0A, 0x10, 0x14, 0x1C, 0x28, 0x2C, 0x30, -+0x06, 0x08, 0x0A, 0x0C, 0x12, 0x18, 0x1E, 0x30, -+0x38, 0x42, 0x0A, 0x0C, 0x0C, 0x12, 0x16, 0x1C, -+0x20, 0x24, 0x24, 0x30, 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, -+0x2C, 0x00, 0x04, 0x00, 0x2D, 0x00, 0x2C, 0x01, -+0x2D, 0x01, 0x2C, 0x02, 0x2E, 0x01, 0xFF, 0x00, -+0x2D, 0x02, 0xFF, 0x00, 0x36, 0x2D, 0xFF, 0x36, -+0x2E, 0xFF, 0x37, 0x2F, 0xFF, 0x41, 0x38, 0x30, -+0x39, 0x42, 0x31, 0x42, 0x3A, 0x32, 0x43, 0x3A, -+0x33, 0x43, 0x3A, 0x34, 0x3A, 0x44, 0x35, 0x44, -+0x3B, 0xFF, 0x37, 0x2E, 0x40, 0x38, 0x30, 0x41, -+0x39, 0x42, 0x31, 0x3A, 0x43, 0x32, 0x3B, 0x43, -+0x35, 0x3C, 0x44, 0xFF, 0x3D, 0x45, 0xFF, 0x3E, -+0x45, 0xFF, 0x45, 0x3F, 0xFF, 0x46, 0xFF, 0xFF, -+0x37, 0x41, 0x2F, 0x39, 0x42, 0x31, 0x43, 0x3A, -+0x33, 0x44, 0x3B, 0x35, 0x45, 0x3D, 0xFF, 0x46, -+0x47, 0x3E, 0x47, 0xFF, 0xFF, 0x48, 0xFF, 0xFF, -+0x49, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, -+0x0D, 0x14, 0xFF, 0x15, 0x0E, 0xFF, 0x15, 0x0F, -+0xFF, 0x16, 0x10, 0xFF, 0x17, 0x1E, 0x11, 0x1E, -+0x18, 0x12, 0x1F, 0x18, 0x13, 0x18, 0x1F, 0xFF, -+0x15, 0x0E, 0xFF, 0x16, 0x1D, 0x10, 0x17, 0x1E, -+0x10, 0x18, 0x1E, 0x11, 0x19, 0x1F, 0xFF, 0x1A, -+0x20, 0xFF, 0x21, 0x1B, 0xFF, 0x21, 0xFF, 0xFF, -+0x15, 0x13, 0x0F, 0x17, 0x1E, 0x11, 0x18, 0x1F, -+0x13, 0x20, 0x19, 0xFF, 0x21, 0x1B, 0xFF, 0x22, -+0xFF, 0xFF, 0x23, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, -+0x04, 0x04, 0x04, 0x36, 0x2C, 0xFF, 0x2D, 0xFF, -+0xFF, 0x2E, 0x37, 0xFF, 0x38, 0x41, 0x2F, 0x39, -+0x42, 0x30, 0x43, 0x39, 0x31, 0x42, 0x39, 0x32, -+0x43, 0x3A, 0x33, 0x43, 0x3A, 0x34, 0x2D, 0x2C, -+0xFF, 0x36, 0x2E, 0xFF, 0x37, 0x2F, 0x40, 0x38, -+0x30, 0x41, 0x42, 0x33, 0x39, 0x43, 0x35, 0x3A, -+0x3B, 0x43, 0x34, 0x44, 0x3C, 0x3B, 0x45, 0x3D, -+0x3C, 0x45, 0x3E, 0x3D, 0x37, 0x2E, 0xFF, 0x38, -+0x2F, 0x40, 0x39, 0x31, 0x41, 0x3A, 0x42, 0xFF, -+0x43, 0x3B, 0xFF, 0x44, 0x3C, 0xFF, 0x45, 0x3D, -+0x3C, 0x46, 0x3F, 0x45, 0x47, 0x46, 0x45, 0x48, -+0x47, 0x47, 0x00, 0x00, 0x04, 0xFF, 0xFF, 0x0C, -+0xFF, 0xFF, 0x0D, 0x14, 0xFF, 0x0E, 0x15, 0xFF, -+0x16, 0x0F, 0xFF, 0x17, 0x10, 0xFF, 0x17, 0x11, -+0xFF, 0x17, 0x12, 0xFF, 0x0D, 0x0C, 0xFF, 0x14, -+0x0E, 0xFF, 0x15, 0x0F, 0xFF, 0x16, 0x1D, 0x10, -+0x17, 0x1E, 0x12, 0x18, 0x1F, 0x13, 0x19, 0x20, -+0x19, 0x20, 0x1A, 0x19, 0x14, 0x0E, 0xFF, 0x15, -+0x1C, 0xFF, 0x17, 0x1D, 0x11, 0x18, 0x1E, 0x13, -+0x19, 0x1F, 0x1E, 0x20, 0x1A, 0x1F, 0x21, 0x1B, -+0x20, 0x22, 0x21, 0x1B, 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, 0x30, -+0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, -+0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, -+0x00, 0x00, 0x00, 0x00, 0x24, 0x28, 0x2A, 0x2C, -+0x2E, 0x30, 0x00, 0x00, 0x00, 0x00, 0x26, 0x29, -+0x2B, 0x2D, 0x2F, 0x31, 0x00, 0x00, 0x00, 0x00, -+0x28, 0x2A, 0x2C, 0x2E, 0x30, 0x32, 0x00, 0x00, -+0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, -+0x01, 0x00, 0x02, 0x00, 0x05, 0x00, 0x0B, 0x00, -+0x06, 0x00, 0x09, 0x00, 0x0C, 0x00, 0x12, 0x00, -+0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x36, 0x00, -+0x0E, 0x00, 0x1B, 0x00, 0x29, 0x00, 0x36, 0x00, -+0x51, 0x00, 0x6C, 0x00, 0x7A, 0x00, 0x87, 0x00, -+0x1B, 0x00, 0x36, 0x00, 0x51, 0x00, 0x6C, 0x00, -+0xA2, 0x00, 0xD8, 0x00, 0xF3, 0x00, 0x0E, 0x01, -+0x29, 0x00, 0x51, 0x00, 0x7A, 0x00, 0xA2, 0x00, -+0xF3, 0x00, 0x44, 0x01, 0x6D, 0x01, 0x95, 0x01, -+0x36, 0x00, 0x6C, 0x00, 0xA2, 0x00, 0xD8, 0x00, -+0x44, 0x01, 0xB0, 0x01, 0xE6, 0x01, 0x1C, 0x02, -+0x0E, 0x00, 0x1B, 0x00, 0x29, 0x00, 0x36, 0x00, -+0x51, 0x00, 0x6C, 0x00, 0x7A, 0x00, 0x87, 0x00, -+0xA2, 0x00, 0xB4, 0x00, 0x1B, 0x00, 0x36, 0x00, -+0x51, 0x00, 0x6C, 0x00, 0xA2, 0x00, 0xD8, 0x00, -+0xF3, 0x00, 0xFF, 0x00, 0x23, 0x01, 0x44, 0x01, -+0x29, 0x00, 0x51, 0x00, 0x7A, 0x00, 0xA2, 0x00, -+0xF3, 0x00, 0x44, 0x01, 0x64, 0x01, 0x64, 0x01, -+0xB5, 0x01, 0xE6, 0x01, 0x36, 0x00, 0x6C, 0x00, -+0xA2, 0x00, 0xD8, 0x00, 0x44, 0x01, 0xB0, 0x01, -+0xE6, 0x01, 0x1C, 0x02, 0x88, 0x02, 0xD0, 0x02, -+0x14, 0x14, 0x15, 0x15, 0x16, 0x17, 0x17, 0x18, -+0x1C, 0x1C, 0x1C, 0x1C, 0x1D, 0x1D, 0x1E, 0x1E, -+0x1C, 0x1C, 0x1D, 0x1E, 0x1F, 0x20, 0x20, 0x20, -+0x36, 0x36, 0x37, 0x37, 0x38, 0x39, 0x39, 0x3A, -+0x3A, 0x3A, 0x00, 0x00, 0x40, 0x40, 0x40, 0x40, -+0x41, 0x41, 0x42, 0x42, 0x43, 0x43, 0x00, 0x00, -+0x40, 0x40, 0x41, 0x42, 0x43, 0x44, 0x44, 0x44, -+0x45, 0x46, 0x00, 0x00, 0x00, 0xF0, 0x01, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x01, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x07, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x07, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x00, 0x00, -+0x00, 0x00, 0x30, 0xC0, 0xE0, 0x00, 0x00, 0x00, -+0x00, 0x0C, 0x0E, 0x38, 0x18, 0x00, 0x00, 0x00, -+0x00, 0x83, 0x01, 0x06, 0x80, 0x03, 0x00, 0x00, -+0x00, 0x00, 0x70, 0xE0, 0x00, 0x00, 0x00, 0x00, -+0xD0, 0xC9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x30, 0xF0, 0x21, 0x6C, 0x18, 0xF0, 0x00, 0x4C, -+0xBC, 0x65, 0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x77, 0xF0, -+0x20, 0x6C, 0x80, 0xF0, 0x80, 0x9C, 0x80, 0xF0, -+0x20, 0x6E, 0xCC, 0xEC, 0x1E, 0x24, 0x30, 0xF0, -+0x21, 0x6C, 0xF4, 0xF7, 0x1C, 0x4C, 0x80, 0x9C, -+0xBC, 0x65, 0x30, 0xF0, 0x21, 0x6C, 0xF4, 0xF7, -+0x18, 0x4C, 0x80, 0x9C, 0xFC, 0x65, 0x9F, 0x67, -+0x77, 0xF0, 0x24, 0x6D, 0xE0, 0xF2, 0x90, 0xDD, -+0x9D, 0x67, 0x77, 0xF0, 0x24, 0x6D, 0xE0, 0xF2, -+0x94, 0xDD, 0x9D, 0x67, 0x85, 0x9C, 0x77, 0xF0, -+0x24, 0x6D, 0xE0, 0xF2, 0x98, 0xDD, 0x20, 0xE8, -+0x00, 0x65, 0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, -+0x08, 0x4C, 0x00, 0x6E, 0x30, 0xF0, 0x20, 0x6F, -+0x2F, 0xF0, 0x08, 0x4F, 0xC0, 0xDC, 0x04, 0x4C, -+0xE3, 0xEC, 0xB8, 0x67, 0xFB, 0x2D, 0x30, 0xF0, -+0x21, 0x6C, 0x90, 0xF3, 0x14, 0x4C, 0x00, 0x6E, -+0x30, 0xF0, 0x21, 0x6F, 0x30, 0xF5, 0x08, 0x4F, -+0xC0, 0xDC, 0x04, 0x4C, 0xE3, 0xEC, 0xB8, 0x67, -+0xFB, 0x2D, 0x30, 0xF0, 0x21, 0x6C, 0x15, 0xF0, -+0x00, 0x4C, 0x00, 0x6E, 0x30, 0xF0, 0x21, 0x6F, -+0x18, 0xF0, 0x00, 0x4F, 0xC0, 0xDC, 0x04, 0x4C, -+0xE3, 0xEC, 0xB8, 0x67, 0xFB, 0x2D, 0x10, 0xF0, -+0x23, 0x6C, 0xC0, 0xF0, 0x01, 0x4C, 0x00, 0xEC, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0xC0, 0xF0, 0x01, 0x4A, 0x40, 0xDB, -+0x00, 0x1C, 0x94, 0x00, 0x80, 0x18, 0xBB, 0x06, -+0x80, 0x18, 0xB4, 0x05, 0x80, 0x18, 0xD6, 0x05, -+0x80, 0x18, 0x7A, 0x06, 0x80, 0x18, 0x02, 0x06, -+0x80, 0x18, 0x97, 0x06, 0x80, 0x18, 0xF2, 0x03, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF7, 0x54, 0x9A, -+0x30, 0xF0, 0x20, 0x68, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6C, 0x30, 0xF0, 0x21, 0x6A, 0x80, 0xF1, -+0x08, 0x4C, 0x15, 0xF0, 0x00, 0x4A, 0x43, 0xDC, -+0xCE, 0xF7, 0x40, 0x98, 0x00, 0x6D, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x2D, 0xF1, 0x50, 0xDB, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF7, 0x50, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x6F, 0xF0, 0x08, 0x4C, -+0x01, 0x6D, 0x40, 0xEA, 0x30, 0xF0, 0x21, 0x6B, -+0xD0, 0xF3, 0x54, 0xDB, 0x30, 0xF0, 0x20, 0x6C, -+0x30, 0xF0, 0x21, 0x6A, 0x2F, 0xF0, 0x08, 0x4C, -+0x15, 0xF4, 0x00, 0x4A, 0x43, 0xDC, 0xCE, 0xF7, -+0x40, 0x98, 0x00, 0x6D, 0x40, 0xEA, 0x30, 0xF0, -+0x21, 0x6B, 0xD0, 0xF3, 0x4C, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0x76, 0xF5, 0x68, 0x9A, 0xFF, 0xF7, -+0x1F, 0x6C, 0x10, 0xF0, 0x00, 0x6D, 0x40, 0xAB, -+0xAB, 0xED, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xCB, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF7, -+0x58, 0x9A, 0x40, 0xEA, 0x00, 0x1C, 0x95, 0x45, -+0xFF, 0x17, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x6D, 0xB8, 0x00, 0x65, 0x00, 0xF0, 0x20, 0x6A, -+0x7C, 0x4A, 0x6C, 0xEA, 0x1C, 0x22, 0x00, 0xF0, -+0x20, 0x6B, 0x28, 0x4B, 0x6A, 0xEA, 0x0B, 0x61, -+0x4E, 0xB8, 0x00, 0x65, 0x00, 0xF0, 0x20, 0x6B, -+0x01, 0x4B, 0x6B, 0xE2, 0x60, 0xAA, 0xBF, 0xF6, -+0x1A, 0x6A, 0x6A, 0xEA, 0x31, 0x60, 0x77, 0xF0, -+0x24, 0x6A, 0xA0, 0xF1, 0x1C, 0x4A, 0x1D, 0xF4, -+0x00, 0x6B, 0x60, 0xDA, 0x10, 0xF0, 0x23, 0x6A, -+0x22, 0xF5, 0x19, 0x4A, 0x00, 0xEA, 0x00, 0xF0, -+0x20, 0x6A, 0x1F, 0xF7, 0x00, 0x6A, 0x4C, 0xEB, -+0x4C, 0xB8, 0x00, 0x65, 0x6C, 0xEA, 0x42, 0x32, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF0, 0x00, 0x4B, -+0x49, 0xE3, 0x40, 0xA2, 0x30, 0xF0, 0x20, 0x6B, -+0x40, 0xF1, 0x08, 0x4B, 0x69, 0xE2, 0x30, 0xF0, -+0x20, 0x6B, 0x4E, 0xF2, 0x08, 0x4B, 0x60, 0x9B, -+0x05, 0x2B, 0x10, 0xF0, 0x23, 0x6B, 0x60, 0xF3, -+0x1D, 0x4B, 0x00, 0xEB, 0x10, 0xF0, 0x23, 0x6B, -+0x00, 0xF4, 0x11, 0x4B, 0x00, 0xEB, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0x0D, 0xF1, 0x1C, 0x4A, -+0x00, 0xF0, 0x20, 0x6B, 0x01, 0x6B, 0x60, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0x40, 0xF2, 0x05, 0x4B, -+0x00, 0xEB, 0x00, 0x65, 0x5A, 0xB8, 0x00, 0x65, -+0x7B, 0xB8, 0x00, 0x65, 0x40, 0xE8, 0x5A, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x7B, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x30, 0xF0, -+0x20, 0x6A, 0x0D, 0xF1, 0x1C, 0x4A, 0x00, 0xF0, -+0x20, 0x6B, 0x60, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0x2D, 0xF1, 0x18, 0x4A, 0x60, 0x9A, 0x41, 0x9A, -+0x6A, 0xEA, 0x0D, 0x61, 0x6E, 0xB8, 0x00, 0x65, -+0x62, 0x43, 0xCB, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x5A, 0xB8, 0x00, 0x65, 0x7B, 0xB8, -+0x00, 0x65, 0x00, 0xBA, 0x00, 0x65, 0x36, 0x23, -+0xDF, 0xF7, 0x00, 0x03, 0x86, 0xDB, 0xA7, 0xDB, -+0xC8, 0xDB, 0xE9, 0xDB, 0x0A, 0xDB, 0x2B, 0xDB, -+0x98, 0x67, 0x8C, 0xDB, 0x9F, 0x67, 0x8E, 0xDB, -+0x12, 0xEC, 0x10, 0xED, 0x82, 0xDB, 0xA3, 0xDB, -+0x9A, 0xB8, 0x00, 0x65, 0x84, 0xDB, 0x9B, 0xB8, -+0x00, 0x65, 0x85, 0xDB, 0x8E, 0xB8, 0x00, 0x65, -+0x82, 0x44, 0x81, 0xDB, 0x8C, 0xB8, 0x00, 0x65, -+0x80, 0xDB, 0x30, 0xF0, 0x20, 0x6B, 0x2D, 0xF1, -+0x18, 0x4B, 0x60, 0x9B, 0x9D, 0x67, 0x89, 0xDB, -+0x6A, 0x9B, 0xCF, 0xF7, 0x80, 0x44, 0x62, 0xEC, -+0x0D, 0x60, 0x77, 0xF0, 0x24, 0x6C, 0xA0, 0xF1, -+0x1C, 0x4C, 0x1D, 0xF4, 0x01, 0x6B, 0x60, 0xDC, -+0x10, 0xF0, 0x23, 0x6C, 0x22, 0xF5, 0x19, 0x4C, -+0x00, 0xEC, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0x2D, 0xF1, 0x18, 0x4B, 0x41, 0x9B, 0x40, 0xDB, -+0x89, 0x9A, 0xBC, 0x65, 0x7D, 0x67, 0xDF, 0xF7, -+0x00, 0x03, 0x4C, 0xB8, 0x00, 0x65, 0x00, 0xF0, -+0x20, 0x6D, 0x05, 0x4D, 0xAF, 0xED, 0xAC, 0xEA, -+0xA0, 0x9B, 0x04, 0x6C, 0x8C, 0xED, 0xAD, 0xEA, -+0x82, 0x9B, 0xA3, 0x9B, 0x32, 0xEC, 0x30, 0xED, -+0x8E, 0x9B, 0xFC, 0x65, 0x8C, 0x9B, 0x1C, 0x65, -+0x84, 0x9B, 0x5C, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x85, 0x9B, 0x7C, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x2B, 0x9B, 0x0A, 0x9B, -+0xE9, 0x9B, 0xC8, 0x9B, 0xA7, 0x9B, 0x86, 0x9B, -+0x61, 0x9B, 0xCB, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x8A, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x7B, 0xB8, 0x00, 0x65, 0x5A, 0xB8, -+0x00, 0x65, 0x00, 0xBA, 0xDF, 0xF7, 0x00, 0x03, -+0x86, 0xDB, 0xA7, 0xDB, 0xC8, 0xDB, 0xE9, 0xDB, -+0x0A, 0xDB, 0x2B, 0xDB, 0x98, 0x67, 0x8C, 0xDB, -+0x9F, 0x67, 0x8E, 0xDB, 0x12, 0xEC, 0x10, 0xED, -+0x82, 0xDB, 0xA3, 0xDB, 0x9A, 0xB8, 0x00, 0x65, -+0x84, 0xDB, 0x9B, 0xB8, 0x00, 0x65, 0x85, 0xDB, -+0x7D, 0x67, 0x5B, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x40, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0xAD, 0xF1, 0x08, 0x4C, 0x00, 0xF4, 0x00, 0x4C, -+0xBC, 0x65, 0x82, 0x67, 0x40, 0xEA, 0x00, 0x65, -+0x7A, 0xB8, 0x00, 0x65, 0xBB, 0x65, 0xDF, 0xF7, -+0x00, 0x03, 0x82, 0x9B, 0xA3, 0x9B, 0x32, 0xEC, -+0x30, 0xED, 0x8E, 0x9B, 0xFC, 0x65, 0x8C, 0x9B, -+0x1C, 0x65, 0x84, 0x9B, 0x5C, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x85, 0x9B, 0x7C, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x2B, 0x9B, -+0x0A, 0x9B, 0xE9, 0x9B, 0xC8, 0x9B, 0xA7, 0x9B, -+0x86, 0x9B, 0x5A, 0xB8, 0x00, 0x65, 0x7B, 0xB8, -+0x00, 0x65, 0x00, 0xBA, 0x00, 0x65, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6B, 0x0D, 0xF1, 0x1C, 0x4B, -+0x40, 0xDB, 0xDF, 0xF7, 0x00, 0x03, 0x86, 0xDB, -+0xA7, 0xDB, 0xC8, 0xDB, 0xE9, 0xDB, 0x0A, 0xDB, -+0x2B, 0xDB, 0x98, 0x67, 0x8C, 0xDB, 0x9F, 0x67, -+0x8E, 0xDB, 0x12, 0xEC, 0x10, 0xED, 0x82, 0xDB, -+0xA3, 0xDB, 0x9A, 0xB8, 0x00, 0x65, 0x84, 0xDB, -+0x9B, 0xB8, 0x00, 0x65, 0x85, 0xDB, 0x8E, 0xB8, -+0x00, 0x65, 0x81, 0xDB, 0x8C, 0xB8, 0x00, 0x65, -+0x80, 0xDB, 0x30, 0xF0, 0x20, 0x6B, 0x2D, 0xF1, -+0x18, 0x4B, 0x60, 0x9B, 0x9D, 0x67, 0x89, 0xDB, -+0x6A, 0x9B, 0xCF, 0xF7, 0x80, 0x44, 0x62, 0xEC, -+0x0D, 0x60, 0x77, 0xF0, 0x24, 0x6C, 0xA0, 0xF1, -+0x1C, 0x4C, 0x1D, 0xF4, 0x01, 0x6B, 0x60, 0xDC, -+0x10, 0xF0, 0x23, 0x6C, 0x22, 0xF5, 0x19, 0x4C, -+0x00, 0xEC, 0x00, 0x65, 0x40, 0x9A, 0x30, 0xF0, -+0x20, 0x6C, 0xAD, 0xF1, 0x08, 0x4C, 0x00, 0xF4, -+0x00, 0x4C, 0xBC, 0x65, 0x82, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6C, 0x0D, 0xF1, 0x1C, 0x4C, -+0x00, 0xF0, 0x20, 0x6D, 0xA0, 0xDC, 0x30, 0xF0, -+0x20, 0x6A, 0x2D, 0xF1, 0x18, 0x4A, 0x10, 0xF0, -+0x23, 0x6B, 0xA0, 0xF4, 0x19, 0x4B, 0x00, 0xEB, -+0x61, 0x9A, 0x60, 0xDA, 0x49, 0x9B, 0xBA, 0x65, -+0xDF, 0xF7, 0x00, 0x03, 0x4C, 0xB8, 0x00, 0x65, -+0x00, 0xF0, 0x20, 0x6D, 0x05, 0x4D, 0xAF, 0xED, -+0xAC, 0xEA, 0xA0, 0x9B, 0x00, 0xF0, 0x20, 0x6C, -+0x04, 0x4C, 0x8C, 0xED, 0xAD, 0xEA, 0x82, 0x9B, -+0xA3, 0x9B, 0x32, 0xEC, 0x30, 0xED, 0x8E, 0x9B, -+0xFC, 0x65, 0x8C, 0x9B, 0x1C, 0x65, 0x84, 0x9B, -+0x5C, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x85, 0x9B, 0x7C, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x2B, 0x9B, 0x0A, 0x9B, 0xE9, 0x9B, -+0xC8, 0x9B, 0xA7, 0x9B, 0x86, 0x9B, 0x61, 0x9B, -+0xCB, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x8A, 0xB9, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x7B, 0xB8, 0x00, 0x65, 0x5A, 0xB8, 0x00, 0x65, -+0x00, 0xBA, 0x00, 0x65, 0x5F, 0x67, 0x5A, 0xB9, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x18, -+0x65, 0xC0, 0x00, 0x1C, 0xA9, 0x41, 0x5A, 0xB8, -+0x00, 0x65, 0x00, 0xEA, 0x6D, 0xB8, 0x00, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x00, 0x4A, 0x4F, 0xEA, -+0x4C, 0xEB, 0xAB, 0xB9, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x5F, 0x67, 0x5A, 0xB9, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x1C, 0x6C, 0x41, -+0x5A, 0xB8, 0x00, 0x65, 0x00, 0xEA, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x80, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x7A, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xAE, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x3C, 0xC2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x59, 0xC2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x74, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0xC0, 0xF5, 0x11, 0x4A, -+0x40, 0xDB, 0x01, 0x4A, 0x40, 0xDB, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0xE0, 0xF5, 0x09, 0x4A, -+0x40, 0xDB, 0x01, 0x4A, 0x40, 0xDB, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0x00, 0xF6, 0x01, 0x4A, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF7, -+0x44, 0x9A, 0xC0, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF7, 0x48, 0x9A, 0xA0, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x76, 0xF7, 0x4C, 0x9A, 0x80, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF7, 0x50, 0x9A, -+0x40, 0x9A, 0x33, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF3, 0x78, 0x9A, 0x10, 0xF0, 0x24, 0x6F, -+0x76, 0xF7, 0xF4, 0x9F, 0x40, 0x9B, 0xED, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF7, -+0x58, 0x9A, 0xFF, 0x6B, 0xC0, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0x76, 0xF7, 0x5C, 0x9A, 0xA0, 0xDA, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF4, 0x50, 0x9A, -+0x10, 0x6D, 0xAB, 0xED, 0x80, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0x96, 0xF7, 0x80, 0x9A, 0x40, 0xA4, -+0x6C, 0xEA, 0xAC, 0xEA, 0x02, 0x6D, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF5, 0x90, 0x9A, 0x80, 0x6D, 0xAB, 0xED, -+0x40, 0xA4, 0x6C, 0xEA, 0xAE, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x00, 0xF6, -+0x02, 0x4A, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xA0, 0xF6, 0x19, 0x4A, 0x40, 0xDB, 0x00, 0x18, -+0x87, 0xE1, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x6C, 0x9A, 0x6C, 0x23, 0x01, 0x6A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0xC4, 0xE1, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, 0x02, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xD9, 0xE2, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0xC0, 0xE2, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x4C, 0x9A, 0x08, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0xC5, 0xE1, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x4C, 0x9A, 0x10, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0xC6, 0xE1, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, 0x20, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xC7, 0xE1, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x4C, 0x9A, -+0x40, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0xC8, 0xE1, 0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, -+0x4C, 0x9A, 0x80, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0xBC, 0xE2, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x6C, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xB4, 0xE2, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, 0x6C, 0x9B, -+0x04, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0xC9, 0xE1, 0x30, 0xF0, 0x20, 0x6B, -+0x00, 0xF2, 0x6C, 0x9B, 0x08, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xCA, 0xE1, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, 0x6C, 0x9B, -+0x10, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0xCB, 0xE1, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x70, 0x9A, 0x3C, 0x23, 0x01, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x9A, 0xE2, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x50, 0x9A, -+0x02, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0xCC, 0xE1, 0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, -+0x70, 0x9B, 0x04, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0x80, 0xE2, -+0x30, 0xF0, 0x20, 0x6B, 0x00, 0xF2, 0x70, 0x9B, -+0x08, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0x63, 0xE2, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xD6, 0xF3, -+0x4C, 0x9A, 0x00, 0xF2, 0x70, 0x9B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0xCE, 0xE1, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x36, 0xF5, -+0x4C, 0x9A, 0x00, 0xF2, 0x70, 0x9B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x5F, 0xE2, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF2, 0x74, 0x9A, 0x55, 0x23, -+0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0x80, 0xE2, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, 0x63, 0xE2, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, -+0x04, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, -+0x00, 0x18, 0x80, 0xE2, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x08, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0x63, 0xE2, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, -+0x10, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, -+0x00, 0x18, 0x80, 0xE2, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x20, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0x63, 0xE2, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF2, 0x54, 0x9A, -+0x40, 0x6B, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0x80, 0xE2, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF2, 0x54, 0x9A, 0x80, 0x6B, 0x6C, 0xEA, -+0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, 0x63, 0xE2, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0xA0, 0xF6, 0x1A, 0x4A, -+0x40, 0xDB, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0xE1, 0xF0, 0x11, 0x4A, 0x40, 0xDB, -+0x00, 0x18, 0x57, 0xE1, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x5C, 0x9A, 0x22, 0x22, 0x00, 0x68, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x7C, 0x9B, -+0x02, 0xF0, 0x00, 0x6A, 0x44, 0xE8, 0x6C, 0xEA, -+0x03, 0x22, 0x90, 0x67, 0x00, 0x18, 0xC3, 0xE1, -+0x01, 0x48, 0x10, 0x70, 0xF1, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x5C, 0x9A, 0x80, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xFA, 0xE2, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0xE1, 0xF0, 0x12, 0x4A, -+0x40, 0xDB, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x23, 0x6A, 0x61, 0xF1, 0x05, 0x4A, -+0x40, 0xDB, 0x00, 0x18, 0x5E, 0xE1, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x7C, 0x9A, 0x3E, 0x23, -+0x08, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0xF2, 0xE1, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x5C, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x9C, 0xE1, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x5C, 0x9A, 0x10, 0x6B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xF6, 0xE2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x5C, 0x9A, -+0x20, 0x6B, 0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, -+0xF2, 0xE2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x5C, 0x9A, 0x40, 0x6B, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0xA1, 0xE1, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x7C, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xEE, 0xE2, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x7C, 0x9B, -+0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0x22, -+0x00, 0x18, 0xEA, 0xE2, 0x30, 0xF0, 0x20, 0x6A, -+0xE0, 0xF1, 0x60, 0x9A, 0x7D, 0x23, 0x10, 0xF0, -+0x24, 0x6A, 0x96, 0xF7, 0x44, 0x9A, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0x4D, 0xE2, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x36, 0xF3, 0x5C, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0x4D, 0xE2, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x56, 0xF7, 0x54, 0x9A, 0xE0, 0xF1, -+0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, -+0x00, 0x18, 0x4D, 0xE2, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0xD6, 0xF3, 0x4C, 0x9A, -+0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0x4D, 0xE2, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x36, 0xF5, -+0x4C, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, 0x4D, 0xE2, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x56, 0xF3, 0x50, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, -+0xD5, 0xE1, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x56, 0xF3, 0x54, 0x9A, 0xE0, 0xF1, -+0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0x13, 0xE2, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x56, 0xF3, 0x58, 0x9A, -+0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0x34, 0xE2, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x76, 0xF7, -+0x54, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, 0xFB, 0xE1, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x56, 0xF3, 0x4C, 0x9A, 0xE0, 0xF1, 0x60, 0x9B, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0xB9, 0xE1, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x64, 0x9A, -+0x32, 0x23, 0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0x3D, 0xE3, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x64, 0x9B, 0xFF, 0x6A, -+0x01, 0x4A, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0x3D, 0xE3, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x64, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, -+0x3D, 0xE3, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x64, 0x9B, 0x00, 0xF4, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0x3D, 0xE3, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x64, 0x9B, -+0x01, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x04, 0x6C, 0x00, 0x18, 0x3D, 0xE3, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x68, 0x9A, 0x6D, 0x23, -+0x01, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, -+0x00, 0x18, 0xE4, 0xE2, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x68, 0x9B, 0xFF, 0x6A, 0x01, 0x4A, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0xE4, 0xE2, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x68, 0x9B, 0x00, 0xF2, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, 0xE4, 0xE2, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x68, 0x9B, -+0x00, 0xF4, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0xE4, 0xE2, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x68, 0x9B, 0x01, 0xF0, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0xE4, 0xE2, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x68, 0x9B, 0x10, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x00, 0x6C, 0x00, 0x18, -+0xB5, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xF6, 0xF2, 0x54, 0x9A, 0xE0, 0xF1, -+0x68, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, -+0x00, 0x18, 0xB5, 0xC4, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0xF6, 0xF2, 0x58, 0x9A, -+0xE0, 0xF1, 0x68, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x02, 0x6C, 0x00, 0x18, 0xB5, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x16, 0xF3, -+0x40, 0x9A, 0xE0, 0xF1, 0x68, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0xB5, 0xC4, -+0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, 0x48, 0x9A, -+0x00, 0x52, 0x03, 0x60, 0x04, 0x6C, 0x00, 0x18, -+0xB5, 0xC4, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x6C, 0x9A, 0xC0, 0xF0, 0x18, 0x23, 0x01, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0xD5, 0xE1, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x4C, 0x9A, 0x02, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0x13, 0xE2, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, 0x04, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, -+0x34, 0xE2, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x4C, 0x9A, 0x08, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x01, 0x6C, 0x00, 0x18, 0xFB, 0xE1, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, 0x10, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, -+0xD5, 0xE1, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x4C, 0x9A, 0x20, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x02, 0x6C, 0x00, 0x18, 0x13, 0xE2, 0x30, 0xF0, -+0x20, 0x6A, 0xE0, 0xF1, 0x4C, 0x9A, 0x40, 0x6B, -+0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, -+0x34, 0xE2, 0x30, 0xF0, 0x20, 0x6A, 0xE0, 0xF1, -+0x4C, 0x9A, 0x80, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x02, 0x6C, 0x00, 0x18, 0xFB, 0xE1, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, 0xFF, 0x6A, -+0x01, 0x4A, 0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, -+0x00, 0x18, 0xD5, 0xE1, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x6C, 0x9B, 0x00, 0xF2, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, -+0x13, 0xE2, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x6C, 0x9B, 0x00, 0xF4, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x03, 0x6C, 0x00, 0x18, 0x34, 0xE2, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, -+0x01, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x03, 0x6C, 0x00, 0x18, 0xFB, 0xE1, 0x30, 0xF0, -+0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, 0x02, 0xF0, -+0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, -+0x00, 0x18, 0xD5, 0xE1, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF1, 0x6C, 0x9B, 0x04, 0xF0, 0x00, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, -+0x13, 0xE2, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x6C, 0x9B, 0x08, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x04, 0x6C, 0x00, 0x18, 0x34, 0xE2, -+0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, 0x6C, 0x9B, -+0x10, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x03, 0x22, -+0x04, 0x6C, 0x00, 0x18, 0xFB, 0xE1, 0x10, 0xF0, -+0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x56, 0xF3, -+0x4C, 0x9A, 0xE0, 0xF1, 0x6C, 0x9B, 0x6C, 0xEA, -+0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, 0xF2, 0xE1, -+0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, 0x20, 0x6B, -+0x56, 0xF3, 0x50, 0x9A, 0xE0, 0xF1, 0x6C, 0x9B, -+0x6C, 0xEA, 0x03, 0x22, 0x02, 0x6C, 0x00, 0x18, -+0xF2, 0xE1, 0x10, 0xF0, 0x24, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x56, 0xF3, 0x54, 0x9A, 0xE0, 0xF1, -+0x6C, 0x9B, 0x6C, 0xEA, 0x03, 0x22, 0x03, 0x6C, -+0x00, 0x18, 0xF2, 0xE1, 0x10, 0xF0, 0x24, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x56, 0xF3, 0x58, 0x9A, -+0xE0, 0xF1, 0x6C, 0x9B, 0x6C, 0xEA, 0x03, 0x22, -+0x04, 0x6C, 0x00, 0x18, 0xF2, 0xE1, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0x61, 0xF1, 0x06, 0x4A, 0x40, 0xDB, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF3, 0x0C, 0x4B, -+0x30, 0xF0, 0x20, 0x69, 0xFF, 0x68, 0xAC, 0xE8, -+0xCE, 0xF4, 0x50, 0x99, 0xA0, 0x9B, 0x82, 0xF0, -+0x00, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF5, 0xA4, 0x9B, 0xCE, 0xF4, -+0x50, 0x99, 0x00, 0x6C, 0x01, 0x6E, 0x40, 0xEA, -+0x01, 0x6D, 0xA1, 0xF4, 0x18, 0x6C, 0xAB, 0xED, -+0x00, 0x18, 0x5C, 0xE3, 0x01, 0x70, 0x0F, 0x60, -+0x03, 0x20, 0x02, 0x70, 0x16, 0x60, 0x1F, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF3, 0x0C, 0x4B, -+0x60, 0x9B, 0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF5, 0x68, 0x9B, 0x13, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF5, 0x6C, 0x9B, 0x6D, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF5, 0x70, 0x9B, -+0x09, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF5, -+0x74, 0x9B, 0x6D, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF5, 0x78, 0x9B, 0x6C, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xCE, 0xF4, 0x70, 0x9B, 0x01, 0x6D, -+0xA1, 0xF4, 0x18, 0x6C, 0xAB, 0xED, 0xC2, 0x67, -+0x40, 0xEB, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFF, 0x6A, 0x4C, 0xED, -+0xFF, 0x75, 0x4C, 0xEC, 0xCC, 0xEA, 0x06, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x71, 0xE4, 0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x71, 0xE4, 0x0C, 0xF7, -+0x7E, 0xA4, 0xAC, 0xEA, 0xAF, 0xED, 0x6C, 0xED, -+0xAD, 0xEA, 0x0C, 0xF7, 0x5E, 0xC4, 0x20, 0xE8, -+0xF7, 0x63, 0x11, 0x62, 0x10, 0xD1, 0x0F, 0xD0, -+0x40, 0xA4, 0x08, 0xD2, 0x08, 0x93, 0x1F, 0x6A, -+0x4C, 0xEB, 0x08, 0xD3, 0x42, 0xA4, 0x61, 0xA4, -+0x0B, 0xD2, 0x43, 0xA4, 0x84, 0xA4, 0x09, 0xD4, -+0x08, 0x94, 0x08, 0x5C, 0x80, 0xF0, 0x11, 0x60, -+0x84, 0x30, 0x09, 0x94, 0x01, 0x2C, 0x28, 0x22, -+0xFF, 0x69, 0x2C, 0xEA, 0x2C, 0xEB, 0xA2, 0x67, -+0xC3, 0x67, 0x90, 0x67, 0x0C, 0xD2, 0x0D, 0xD3, -+0x00, 0x18, 0xB7, 0xC3, 0x0B, 0x94, 0x09, 0x93, -+0x41, 0x40, 0x2C, 0xEC, 0x0B, 0xD4, 0x0B, 0x96, -+0x2C, 0xEA, 0x2C, 0xEB, 0x82, 0x67, 0xA3, 0x67, -+0x30, 0xF0, 0x20, 0x69, 0x0A, 0xD2, 0x09, 0xD3, -+0x00, 0x18, 0xB7, 0xC3, 0xCE, 0xF2, 0x44, 0x99, -+0x0C, 0x95, 0x0D, 0x96, 0x90, 0x67, 0x01, 0x6F, -+0x40, 0xEA, 0xCE, 0xF2, 0x44, 0x99, 0x0A, 0x94, -+0x09, 0x95, 0x0B, 0x96, 0x02, 0x6F, 0x40, 0xEA, -+0x0F, 0x58, 0x08, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x08, 0x33, 0x36, 0xF1, 0x14, 0x4A, 0x69, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x00, 0x6A, 0x44, 0x10, -+0xD0, 0xF4, 0x44, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF6, 0x4C, 0x9A, 0x34, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF6, 0x50, 0x9A, 0x2F, 0x10, -+0x80, 0xF4, 0x44, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF6, 0x54, 0x9A, 0x24, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF6, 0x58, 0x9A, 0x1F, 0x10, -+0xC0, 0xF4, 0x48, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF6, 0x5C, 0x9A, 0x14, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF6, 0x40, 0x9A, 0x0F, 0x10, -+0x70, 0xF4, 0x48, 0x40, 0x1F, 0xF7, 0x00, 0x6B, -+0x6C, 0xEA, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF6, 0x44, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF6, 0x48, 0x9A, 0x49, 0xE0, -+0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x6A, 0x6C, 0xEA, -+0x7D, 0x67, 0x53, 0xC3, 0x42, 0x32, 0x54, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x41, 0xE0, 0x0C, 0xF7, 0x5E, 0xA0, 0x55, 0xC3, -+0x0C, 0xF7, 0x5F, 0xA0, 0x56, 0xC3, 0x2C, 0xF7, -+0x4E, 0xA0, 0x57, 0xC3, 0x2C, 0xF7, 0x4F, 0xA0, -+0x58, 0xC3, 0x9D, 0x67, 0x21, 0x6A, 0x50, 0xC4, -+0x07, 0x6A, 0x4F, 0xCC, 0x47, 0x44, 0x19, 0x4A, -+0x40, 0xA2, 0x52, 0xC4, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, 0x40, 0xEA, -+0x11, 0x97, 0x10, 0x91, 0x0F, 0x90, 0x09, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0xFF, 0x74, 0xAC, 0xEA, 0x05, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0x0D, 0xF1, 0x46, 0xC3, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x2C, 0xF7, 0xBE, 0xA3, 0x8C, 0xEA, 0x8F, 0xEC, -+0xAC, 0xEC, 0x8D, 0xEA, 0x2C, 0xF7, 0x5E, 0xC3, -+0x20, 0xE8, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x01, 0xA4, 0x20, 0xA4, -+0x0C, 0x20, 0x90, 0x67, 0xB1, 0x67, 0x00, 0x18, -+0x21, 0xC4, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x90, 0x67, 0xB1, 0x67, 0x53, 0x6E, -+0x40, 0xEA, 0x7D, 0x67, 0x20, 0x6A, 0x50, 0xC3, -+0x03, 0x6A, 0x4F, 0xCB, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF3, 0x48, 0x9A, 0x9D, 0x67, 0x40, 0xA2, -+0x52, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x2C, 0xF7, 0x7E, 0xA2, 0x2C, 0xF7, -+0x5F, 0xA2, 0x73, 0xC4, 0x54, 0xC4, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x04, 0x04, -+0x40, 0xEA, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x40, 0xA4, 0x0C, 0xF5, -+0xD8, 0xA3, 0x7F, 0x6F, 0x5E, 0x32, 0x5C, 0x32, -+0xEC, 0xEE, 0x4D, 0xEE, 0x0C, 0xF5, 0xD8, 0xC3, -+0xA0, 0xA4, 0x01, 0x6A, 0xBA, 0x35, 0x4C, 0xED, -+0xB8, 0x30, 0x41, 0x6D, 0xAB, 0xED, 0xCC, 0xED, -+0x0D, 0xED, 0x0C, 0xF5, 0xB8, 0xC3, 0xC0, 0xA4, -+0xD6, 0x36, 0x4C, 0xEE, 0xD4, 0x30, 0x21, 0x6E, -+0xCB, 0xEE, 0xAC, 0xEE, 0x0D, 0xEE, 0x0C, 0xF5, -+0xD8, 0xC3, 0xA0, 0xA4, 0xB2, 0x35, 0x4C, 0xED, -+0xB0, 0x30, 0x11, 0x6D, 0xAB, 0xED, 0xCC, 0xED, -+0x0D, 0xED, 0x0C, 0xF5, 0xB8, 0xC3, 0x20, 0xA4, -+0x10, 0x6E, 0x0F, 0x68, 0xCB, 0xEE, 0x0C, 0xE9, -+0xAC, 0xEE, 0x2D, 0xEE, 0x0C, 0xF5, 0xD8, 0xC3, -+0xA1, 0xA4, 0xAC, 0xEF, 0x0C, 0xF5, 0xB9, 0xA3, -+0x0C, 0xF5, 0xFA, 0xC3, 0xE1, 0xA4, 0x1D, 0x65, -+0x02, 0x6D, 0x38, 0x67, 0xAB, 0xED, 0xFE, 0x37, -+0x2C, 0xED, 0xED, 0xED, 0x0C, 0xF5, 0xB9, 0xC3, -+0xE2, 0xA4, 0x0C, 0xF5, 0xFB, 0xC3, 0x03, 0x6F, -+0x83, 0xA4, 0xEB, 0xEF, 0xAC, 0xEF, 0x0C, 0xF5, -+0xB8, 0xA3, 0x4C, 0xEC, 0x84, 0x34, 0xBA, 0x35, -+0x8D, 0xEF, 0x4E, 0xED, 0x86, 0x67, 0x0C, 0xEC, -+0x4C, 0xED, 0x0C, 0xF5, 0xF9, 0xC3, 0x00, 0x18, -+0x68, 0xDD, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA4, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0x4F, 0xF7, -+0x14, 0x4C, 0x07, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x4F, 0xF7, 0x54, 0xA2, 0x05, 0x5A, -+0x13, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, -+0xB6, 0xF1, 0x00, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, -+0x00, 0xEA, 0x00, 0x6C, 0x07, 0x10, 0x01, 0x6C, -+0x05, 0x10, 0x02, 0x6C, 0x03, 0x10, 0x03, 0x6C, -+0x01, 0x10, 0x04, 0x6C, 0x00, 0x18, 0x45, 0xE0, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x69, 0xF3, 0x48, 0xA3, 0x1F, 0x6C, 0x01, 0x6D, -+0x4A, 0x32, 0x8C, 0xEA, 0x30, 0xF0, 0x20, 0x6C, -+0x4F, 0xF7, 0x94, 0xA4, 0x47, 0xEC, 0xAC, 0xEA, -+0x03, 0x22, 0x69, 0xF3, 0x89, 0xC3, 0x04, 0x10, -+0x01, 0x6A, 0x4B, 0xEA, 0x69, 0xF3, 0x49, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x1C, 0x23, 0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x69, 0xF3, 0x68, 0xC2, 0x00, 0x18, 0xA9, 0xE5, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x04, 0x93, -+0x4F, 0xF6, 0x54, 0x9A, 0x6E, 0xEA, 0x03, 0x22, -+0x04, 0x94, 0x00, 0x18, 0xCA, 0xE5, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF3, -+0x88, 0xA2, 0x02, 0x6B, 0x8D, 0xEB, 0x69, 0xF3, -+0x68, 0xC2, 0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0xA4, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0x8F, 0xF5, 0x08, 0x4C, 0x04, 0x6E, -+0x40, 0xEA, 0x00, 0x18, 0x2B, 0xC9, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x68, 0x8C, 0xE8, 0x90, 0x67, -+0x00, 0x18, 0x91, 0xC8, 0x90, 0x67, 0x00, 0x18, -+0x2A, 0xE9, 0x01, 0x6C, 0x00, 0x18, 0xA5, 0xC7, -+0x90, 0x67, 0x00, 0x18, 0x4F, 0xC9, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x6A, 0x27, 0x67, 0x4C, 0xE9, 0x6F, 0x41, -+0x4C, 0xEB, 0x04, 0x67, 0x02, 0x5B, 0x4C, 0xE8, -+0x4C, 0xED, 0x4C, 0xEE, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0xB5, 0xE4, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x49, 0xE0, 0x0C, 0xF7, -+0x7E, 0xA2, 0x2C, 0xF7, 0x4E, 0xA2, 0x10, 0x58, -+0x6D, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x49, 0x60, -+0x10, 0xF0, 0x24, 0x6B, 0x08, 0x34, 0x36, 0xF2, -+0x08, 0x4B, 0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, -+0xD0, 0xF4, 0x64, 0x40, 0x1F, 0xF7, 0x00, 0x6C, -+0x8C, 0xEB, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x36, 0xF6, 0x6C, 0x9B, 0x34, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x36, 0xF6, 0x70, 0x9B, 0x2F, 0x10, -+0x80, 0xF4, 0x64, 0x40, 0x1F, 0xF7, 0x00, 0x6C, -+0x8C, 0xEB, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x36, 0xF6, 0x74, 0x9B, 0x24, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x36, 0xF6, 0x78, 0x9B, 0x1F, 0x10, -+0xC0, 0xF4, 0x68, 0x40, 0x1F, 0xF7, 0x00, 0x6C, -+0x8C, 0xEB, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x36, 0xF6, 0x7C, 0x9B, 0x14, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF6, 0x60, 0x9B, 0x0F, 0x10, -+0x70, 0xF4, 0x68, 0x40, 0x1F, 0xF7, 0x00, 0x6C, -+0x8C, 0xEB, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF6, 0x64, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF6, 0x68, 0x9B, 0x61, 0xE0, -+0x40, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, -+0x3B, 0xC2, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x4C, 0x9A, -+0x42, 0xF1, 0x18, 0x6C, 0x01, 0x6D, 0x02, 0x6E, -+0x40, 0xEA, 0x05, 0x97, 0x05, 0x6A, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0x02, 0xF4, 0x05, 0x4A, 0x40, 0xDB, 0x01, 0x4A, -+0x40, 0xDB, 0xF4, 0x17, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF2, 0x7C, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF2, 0x58, 0x9A, 0x01, 0x6C, 0xA4, 0x67, -+0x60, 0xDA, 0x00, 0x18, 0xE9, 0xD4, 0x30, 0xF0, -+0x20, 0x6A, 0x00, 0xF1, 0x00, 0x4A, 0x10, 0xF0, -+0x24, 0x6B, 0xEF, 0x9A, 0xB6, 0xF2, 0x60, 0x9B, -+0x8C, 0x9A, 0xCE, 0x9A, 0xAD, 0x9A, 0xE0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF2, 0x64, 0x9B, -+0x00, 0x68, 0xC0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xB6, 0xF2, 0x68, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xB6, 0xF2, 0x6C, 0x9B, 0x80, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x89, 0x9A, 0xB6, 0xF2, -+0x70, 0x9B, 0x80, 0xDB, 0x68, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xB6, 0xF2, 0x54, 0x9A, 0x60, 0xDA, -+0x30, 0xF0, 0x20, 0x6A, 0x60, 0xF1, 0x48, 0xAA, -+0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0x08, 0x34, -+0x2E, 0xF2, 0x0C, 0x4B, 0x6D, 0xE4, 0x60, 0x9B, -+0x05, 0x23, 0x01, 0x48, 0xFF, 0x6B, 0x6C, 0xE8, -+0x43, 0xE8, 0xF3, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xB6, 0xF2, 0x78, 0x9A, 0x7F, 0x6A, 0x00, 0x69, -+0x80, 0xA3, 0x20, 0xF0, 0x20, 0x6D, 0x00, 0xF1, -+0x00, 0x4D, 0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6B, 0xAE, 0xF2, 0x40, 0x9B, 0x10, 0xF0, -+0x24, 0x6B, 0xB6, 0xF2, 0xDC, 0x9B, 0x91, 0x67, -+0x48, 0x6F, 0x04, 0xD1, 0x05, 0xD1, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF2, 0x40, 0x9B, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF2, 0xC0, 0x9B, -+0x20, 0xF0, 0x20, 0x6D, 0x91, 0x67, 0xAD, 0xF1, -+0x08, 0x4D, 0x00, 0xF4, 0x00, 0x6F, 0x04, 0xD1, -+0x05, 0xD1, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x40, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF2, 0xC4, 0x9B, 0x20, 0xF0, 0x21, 0x6D, -+0x00, 0x37, 0x91, 0x67, 0x15, 0xF0, 0x00, 0x4D, -+0xE8, 0x37, 0x04, 0xD1, 0x05, 0xD1, 0x40, 0xEA, -+0x00, 0x1C, 0x96, 0x45, 0xFF, 0x17, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0xF1, 0x00, 0x4A, -+0x60, 0xDA, 0x81, 0xDA, 0xA2, 0xDA, 0xC3, 0xDA, -+0xE4, 0xDA, 0x05, 0xDA, 0x26, 0xDA, 0x78, 0x67, -+0x67, 0xDA, 0x7D, 0x67, 0x68, 0xDA, 0x7F, 0x67, -+0x69, 0xDA, 0x12, 0xEB, 0x6A, 0xDA, 0x10, 0xEB, -+0x6B, 0xDA, 0x6D, 0xB8, 0x00, 0x65, 0x6C, 0xDA, -+0x68, 0xB8, 0x00, 0x65, 0x6D, 0xDA, 0x6C, 0xB8, -+0x00, 0x65, 0x6E, 0xDA, 0x6E, 0xB8, 0x00, 0x65, -+0x6F, 0xDA, 0x10, 0xF0, 0x23, 0x6A, 0x02, 0xF4, -+0x1D, 0x4A, 0x00, 0xEA, 0x00, 0x65, 0x00, 0x65, -+0xFF, 0x63, 0x01, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x4C, 0xED, 0x8E, 0x37, 0x4C, 0xEF, 0x07, 0x6E, -+0x01, 0x75, 0x8C, 0xEE, 0x52, 0xF4, 0x60, 0x47, -+0x59, 0x61, 0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, -+0x08, 0x4D, 0xBD, 0xE7, 0xE8, 0xF2, 0xAF, 0xA7, -+0x01, 0x68, 0x04, 0xEE, 0x0D, 0xED, 0xE8, 0xF2, -+0xAF, 0xC7, 0x1F, 0xF7, 0x00, 0x6D, 0x6C, 0xED, -+0x02, 0xF0, 0x00, 0x75, 0x01, 0x60, 0x25, 0x2D, -+0x1F, 0xF7, 0x00, 0x6A, 0x6C, 0xEA, 0x02, 0xF0, -+0x00, 0x72, 0x01, 0x60, 0x07, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF2, 0xA8, 0x9A, 0xB5, 0xE3, -+0x60, 0xA5, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF2, 0xA8, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF2, 0x4C, 0x9A, 0xB5, 0xE3, 0x4D, 0xE3, -+0x60, 0xA3, 0x01, 0x6A, 0x00, 0xF6, 0x60, 0x33, -+0x44, 0xEE, 0x00, 0xF6, 0x63, 0x33, 0x4F, 0xEA, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x40, 0xC5, -+0x0E, 0x10, 0x10, 0xF0, 0x24, 0x6D, 0xD6, 0xF2, -+0xAC, 0x9D, 0x0F, 0xE8, 0xAD, 0xE3, 0xA0, 0xA3, -+0x00, 0xF6, 0xA0, 0x35, 0x00, 0xF6, 0xA3, 0x35, -+0x0C, 0xED, 0x4C, 0xED, 0xA0, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0x4F, 0xF7, 0x55, 0xA2, 0x4E, 0xEC, -+0x52, 0x2C, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x50, 0x9A, 0x60, 0x9A, 0x30, 0xF0, 0x20, 0x6A, -+0x70, 0x33, 0x00, 0xF5, 0x62, 0x33, 0x48, 0xF5, -+0x68, 0xCA, 0x45, 0x10, 0x30, 0xF0, 0x20, 0x6C, -+0xC0, 0xF1, 0x08, 0x4C, 0x9D, 0xE7, 0xE8, 0xF2, -+0x0F, 0xA7, 0x01, 0x6D, 0xA4, 0xEE, 0xAF, 0xEC, -+0x0C, 0xEC, 0xE8, 0xF2, 0x8F, 0xC7, 0x1F, 0xF7, -+0x00, 0x6C, 0x6C, 0xEC, 0x02, 0xF0, 0x00, 0x74, -+0x01, 0x60, 0x24, 0x2C, 0x1F, 0xF7, 0x00, 0x6A, -+0x6C, 0xEA, 0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, -+0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x88, 0x9A, 0x91, 0xE3, 0x60, 0xA4, 0x0B, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x88, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x4C, 0x9A, -+0x91, 0xE3, 0x4D, 0xE3, 0x60, 0xA3, 0x00, 0xF6, -+0x60, 0x33, 0x01, 0x6A, 0x00, 0xF6, 0x63, 0x33, -+0x44, 0xEE, 0x6D, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x40, 0xC4, 0x0D, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0xD6, 0xF2, 0x8C, 0x9C, 0x8D, 0xE3, 0x80, 0xA3, -+0x00, 0xF6, 0x80, 0x34, 0x00, 0xF6, 0x83, 0x34, -+0xAD, 0xEC, 0x4C, 0xEC, 0x80, 0xC3, 0x01, 0x90, -+0x01, 0x63, 0x20, 0xE8, 0xFF, 0x6A, 0x4C, 0xEC, -+0x05, 0x5C, 0xAC, 0xEA, 0x4B, 0x60, 0x10, 0xF0, -+0x24, 0x6B, 0x88, 0x34, 0xD5, 0xF7, 0x18, 0x4B, -+0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, 0x05, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x74, 0x9A, -+0x2D, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x74, 0x9A, 0x20, 0x10, 0x05, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF2, 0x78, 0x9A, 0x22, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x78, 0x9A, -+0x15, 0x10, 0x05, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF2, 0x7C, 0x9A, 0x17, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF2, 0x7C, 0x9A, 0x0A, 0x10, -+0x05, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF2, -+0x60, 0x9A, 0x0C, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF2, 0x60, 0x9A, 0x80, 0xA3, 0xF7, 0x6A, -+0x0A, 0x10, 0x0C, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF2, 0x64, 0x9A, 0x40, 0xA3, 0xFF, 0x6C, -+0x08, 0x6D, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF2, 0x64, 0x9A, 0xF7, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x4C, 0xEC, 0x01, 0x6B, 0xAC, 0xEA, -+0x6E, 0xEA, 0x01, 0x5A, 0x58, 0x67, 0x05, 0x5C, -+0x48, 0x32, 0x08, 0x60, 0x10, 0xF0, 0x24, 0x6B, -+0x88, 0x34, 0xF5, 0xF7, 0x0C, 0x4B, 0x8D, 0xE3, -+0x60, 0x9B, 0x00, 0xEB, 0x01, 0x6A, 0x4B, 0xEA, -+0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF2, -+0x90, 0x9B, 0x10, 0xF0, 0x24, 0x6D, 0xF6, 0xF2, -+0xA8, 0x9D, 0x60, 0x9C, 0xAC, 0xEB, 0x1E, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF2, 0x90, 0x9B, -+0x10, 0xF0, 0x24, 0x6D, 0xF6, 0xF2, 0xA8, 0x9D, -+0x60, 0x9C, 0xAC, 0xEB, 0x10, 0xF0, 0x24, 0x6D, -+0xF6, 0xF2, 0xB4, 0x9D, 0x0E, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF2, 0x90, 0x9B, 0x10, 0xF0, -+0x24, 0x6D, 0xF6, 0xF2, 0xA8, 0x9D, 0x60, 0x9C, -+0xAC, 0xEB, 0x10, 0xF0, 0x24, 0x6D, 0xF6, 0xF2, -+0xB8, 0x9D, 0xAD, 0xEB, 0x60, 0xDC, 0x60, 0xF5, -+0x60, 0x42, 0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xEB, -+0x02, 0xF0, 0x00, 0x73, 0x10, 0x61, 0x2E, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF2, 0x90, 0x9B, -+0x10, 0xF0, 0x24, 0x6D, 0xF6, 0xF2, 0xA8, 0x9D, -+0x60, 0x9C, 0xAC, 0xEB, 0x10, 0xF0, 0x24, 0x6D, -+0xF6, 0xF2, 0xBC, 0x9D, 0xE6, 0x17, 0x1E, 0x23, -+0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF2, 0x70, 0x9B, -+0x1D, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF2, -+0x90, 0x9B, 0x10, 0xF0, 0x24, 0x6D, 0xF6, 0xF2, -+0xA8, 0x9D, 0x60, 0x9C, 0xAC, 0xEB, 0x10, 0xF0, -+0x24, 0x6D, 0x16, 0xF3, 0xA0, 0x9D, 0xAD, 0xEB, -+0x60, 0xDC, 0x60, 0xF5, 0x60, 0x42, 0x1F, 0xF7, -+0x00, 0x6C, 0x8C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x07, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xF6, 0xF2, 0x6C, 0x9B, 0x69, 0xE2, 0x40, 0x9A, -+0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF2, -+0x70, 0x9B, 0x69, 0xE2, 0x40, 0x9A, 0x20, 0xE8, -+0xFF, 0x6A, 0x4C, 0xEC, 0x01, 0x74, 0xAC, 0xEA, -+0x13, 0x60, 0x03, 0x24, 0x02, 0x74, 0x15, 0x60, -+0x18, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0xD9, 0xA3, 0x01, 0x6D, -+0x4C, 0xED, 0x02, 0x6A, 0x4B, 0xEA, 0xCC, 0xEA, -+0xAD, 0xEA, 0x68, 0xF3, 0x59, 0xC3, 0x09, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0x48, 0xF5, 0x44, 0xC3, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0x48, 0xF5, -+0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF3, -+0x44, 0x9A, 0x60, 0xA2, 0x10, 0x6A, 0x6C, 0xEA, -+0x24, 0x22, 0x02, 0x5C, 0x03, 0x61, 0x02, 0x74, -+0x17, 0x60, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, 0x99, 0xA3, -+0x01, 0x6A, 0x8C, 0xEA, 0x68, 0xF3, 0x9C, 0xA3, -+0x7F, 0x6B, 0x5C, 0x32, 0x8C, 0xEB, 0x6D, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0x16, 0xF3, 0x68, 0x9B, 0x40, 0xC3, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x60, 0xA2, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF3, 0x4C, 0x9A, -+0x60, 0xC2, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF3, 0x50, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0xFF, 0x72, 0x00, 0x6A, 0x0B, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF3, 0x54, 0x9A, -+0x60, 0xA2, 0x07, 0x6A, 0x6C, 0xEA, 0x07, 0x6B, -+0x6E, 0xEA, 0x01, 0x5A, 0x58, 0x67, 0x20, 0xE8, -+0xFF, 0x6A, 0x4C, 0xEC, 0x01, 0x74, 0xAC, 0xEA, -+0x03, 0x60, 0x02, 0x74, 0x09, 0x60, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x02, 0x6B, 0x88, 0xF3, 0x62, 0xC2, 0x15, 0x10, -+0x09, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xE8, 0xF3, 0x67, 0xA2, 0x88, 0xF3, -+0x62, 0xC2, 0x05, 0x10, 0xFF, 0x4A, 0x30, 0xF0, -+0x20, 0x6B, 0x48, 0xF5, 0x4A, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x62, 0xA2, 0x68, 0xF3, 0x99, 0xA2, 0x88, 0xF3, -+0x63, 0xC2, 0x40, 0x6B, 0x8D, 0xEB, 0x68, 0xF3, -+0x79, 0xC2, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x4B, 0xC6, 0x01, 0x72, 0x0E, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x99, 0xA2, 0x04, 0x6B, 0x8C, 0xEB, -+0x05, 0x2B, 0x68, 0xF3, 0x58, 0xA2, 0x05, 0x5A, -+0x58, 0x67, 0x01, 0x10, 0x00, 0x6A, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xFF, 0x69, 0x30, 0xF0, 0x20, 0x6A, 0x8C, 0xE9, -+0x6E, 0xF5, 0x58, 0x9A, 0x4F, 0xF7, 0x95, 0xA3, -+0x40, 0xEA, 0x01, 0x72, 0x29, 0x61, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, -+0x7A, 0xA0, 0x09, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x68, 0xF3, 0x5A, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0x6F, 0x6D, -+0x2C, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x50, 0x9A, 0xC8, 0xF2, 0x9F, 0xA0, -+0x01, 0x6D, 0x08, 0x6E, 0xF1, 0x67, 0x40, 0xEA, -+0x01, 0x72, 0x0A, 0x61, 0x68, 0xF3, 0x7A, 0xA0, -+0x02, 0x6A, 0x01, 0x6C, 0x6D, 0xEA, 0x0E, 0x6D, -+0x68, 0xF3, 0x5A, 0xC0, 0x00, 0x18, 0x24, 0xC6, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x2E, 0x6E, 0xFF, 0x6C, 0x6F, 0x6D, 0x40, 0xEA, -+0x01, 0x6C, 0x02, 0x6D, 0x00, 0x18, 0x24, 0xC6, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0xFF, 0x6E, 0x30, 0xF0, 0x20, 0x6A, 0x8C, 0xEE, -+0x2E, 0xF4, 0x48, 0x9A, 0x48, 0xF5, 0x80, 0xA3, -+0x01, 0x6D, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x63, 0x01, 0xD1, -+0x00, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x69, 0x16, 0xF3, 0xF8, 0x9B, 0xCF, 0xF4, -+0x60, 0x99, 0xFF, 0x6A, 0x4C, 0xEC, 0xEC, 0xEB, -+0xEE, 0xEB, 0x4C, 0xED, 0x4C, 0xEE, 0x80, 0xF0, -+0x1E, 0x23, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0x1A, 0xA3, 0x20, 0x6F, -+0x0C, 0xEF, 0x4C, 0xEF, 0x80, 0xF0, 0x0F, 0x2F, -+0xCF, 0xF4, 0x00, 0xA1, 0x01, 0x6F, 0xEC, 0xE8, -+0x4C, 0xE8, 0x61, 0x28, 0x68, 0xF3, 0x19, 0xA3, -+0x0C, 0xEF, 0x4C, 0xEF, 0x09, 0x27, 0x88, 0xF3, -+0x5B, 0xA3, 0xE4, 0x42, 0x03, 0x4A, 0x88, 0xF3, -+0xF3, 0xC3, 0x88, 0xF3, 0x52, 0xC3, 0x08, 0x10, -+0x05, 0x6F, 0x88, 0xF3, 0xF3, 0xC3, 0x05, 0x4E, -+0x04, 0x6F, 0x88, 0xF3, 0xF2, 0xC3, 0x4C, 0xEE, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0xF1, 0xA2, 0x88, 0xF3, 0x72, 0xA2, -+0xE3, 0xEB, 0x09, 0x61, 0x88, 0xF3, 0x73, 0xA2, -+0x88, 0xF3, 0xC4, 0xC2, 0x71, 0xE4, 0xB7, 0xE4, -+0x88, 0xF3, 0xB6, 0xC2, 0x09, 0x10, 0x88, 0xF3, -+0x93, 0xA2, 0x77, 0xE5, 0xB9, 0xE6, 0x6F, 0xE4, -+0x88, 0xF3, 0xC4, 0xC2, 0x88, 0xF3, 0x76, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x73, 0xA2, 0x88, 0xF3, 0x96, 0xA2, -+0x0A, 0x4B, 0x82, 0xEB, 0x02, 0x60, 0x88, 0xF3, -+0x76, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x88, 0xF3, 0x76, 0xA2, 0x88, 0xF3, -+0x84, 0xA2, 0x23, 0x4B, 0x82, 0xEB, 0x02, 0x60, -+0x88, 0xF3, 0x64, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0x76, 0xA2, -+0x68, 0xF3, 0x97, 0xA2, 0x88, 0xF3, 0x6A, 0xCA, -+0x18, 0x6B, 0x8C, 0xEB, 0x10, 0x73, 0x07, 0x61, -+0xC8, 0xF3, 0x79, 0xA2, 0x03, 0x6C, 0x76, 0x33, -+0x8C, 0xEB, 0x88, 0xF3, 0x64, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x16, 0xF3, 0x5C, 0x9A, 0x60, 0xA2, -+0x07, 0x23, 0x60, 0xA2, 0xFF, 0x6A, 0x4C, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x72, 0xCA, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x40, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x48, 0xF5, 0x92, 0xAC, -+0xA0, 0xA2, 0xFF, 0x6B, 0x6C, 0xED, 0x8E, 0xED, -+0x02, 0x25, 0x8C, 0xEB, 0x60, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x9A, 0xA2, 0x41, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x68, 0xF3, 0x7A, 0xC2, 0x04, 0x10, 0x40, 0x6A, -+0x0D, 0xEA, 0x68, 0xF3, 0x5A, 0xC3, 0x01, 0x91, -+0x00, 0x90, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0x65, 0xA2, -+0xE8, 0xF3, 0x84, 0xA2, 0x63, 0xEC, 0x22, 0x60, -+0x88, 0xF3, 0x98, 0xA2, 0x01, 0x4C, 0x88, 0xF3, -+0x98, 0xC2, 0x88, 0xF3, 0xB8, 0xA2, 0xE8, 0xF3, -+0x81, 0xA2, 0xA3, 0xEC, 0x17, 0x61, 0x03, 0x6D, -+0xB8, 0xEB, 0x88, 0xF3, 0x90, 0xA2, 0x88, 0xF3, -+0xB1, 0xA2, 0x04, 0x6F, 0x01, 0x4C, 0x88, 0xF3, -+0x90, 0xC2, 0x88, 0xF3, 0x84, 0xA2, 0xFE, 0x4C, -+0x12, 0xEB, 0x6D, 0xE4, 0x88, 0xF3, 0x77, 0xC2, -+0x88, 0xF3, 0x90, 0xA2, 0x88, 0xF3, 0xD7, 0xA2, -+0x00, 0x18, 0xAB, 0xC6, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0x68, 0xF5, 0x04, 0x4B, 0xFF, 0x6A, 0xA7, 0x43, -+0x8C, 0xEA, 0x26, 0x4D, 0x00, 0x6C, 0x80, 0xC3, -+0x01, 0x4B, 0x83, 0x67, 0xAE, 0xEC, 0xFA, 0x2C, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x88, 0xF3, 0x94, 0xC3, 0x88, 0xF3, 0x98, 0xC3, -+0x88, 0xF3, 0x90, 0xC3, 0x01, 0x6C, 0x8E, 0xEA, -+0x05, 0x2A, 0x2D, 0x6C, 0x88, 0xF3, 0x99, 0xC3, -+0x88, 0xF3, 0x5A, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0xCF, 0xF4, 0xA0, 0xA3, 0x01, 0x6B, 0xFF, 0x6A, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x10, 0x23, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x74, 0xA2, 0x01, 0x4B, 0x88, 0xF3, -+0x74, 0xC2, 0x88, 0xF3, 0x74, 0xA2, 0xC8, 0xF3, -+0x5E, 0xAA, 0x43, 0xEB, 0xA0, 0xF0, 0x1E, 0x60, -+0x00, 0x6D, 0x00, 0x18, 0xE2, 0xC5, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0xC8, 0xF3, -+0x94, 0x9B, 0xC8, 0xF3, 0x50, 0xDB, 0x83, 0xEA, -+0x31, 0x61, 0x68, 0xF3, 0xF9, 0xA3, 0x01, 0x6D, -+0xFF, 0x6E, 0xEC, 0xED, 0x0E, 0x25, 0x88, 0xF3, -+0xFB, 0xA3, 0x88, 0xF3, 0xB6, 0xA3, 0x93, 0xE2, -+0x0E, 0x4F, 0xBF, 0xE7, 0xC8, 0xF3, 0xBC, 0xA3, -+0x82, 0x34, 0x8A, 0x34, 0xAF, 0xE7, 0x89, 0xE3, -+0x0B, 0x10, 0xC8, 0xF3, 0xFD, 0xA3, 0x88, 0xF3, -+0xB6, 0xA3, 0x8B, 0xE2, 0xEB, 0xEF, 0xAF, 0xE7, -+0x42, 0x32, 0x0A, 0x4B, 0x4A, 0x32, 0x49, 0xE3, -+0xCC, 0xEA, 0x2D, 0x5A, 0x0F, 0x60, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x69, 0xE2, -+0x88, 0xF3, 0x9C, 0xA2, 0x01, 0x4C, 0x88, 0xF3, -+0x9C, 0xC2, 0x88, 0xF3, 0x54, 0xA3, 0x01, 0x4A, -+0x88, 0xF3, 0x54, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0x94, 0xA2, -+0xC8, 0xF3, 0x7E, 0xAA, 0x63, 0xEC, 0x7A, 0x60, -+0x82, 0x10, 0xA0, 0xA4, 0xAD, 0xE3, 0xFF, 0x6D, -+0xAC, 0xEB, 0x63, 0xEE, 0x02, 0x60, 0xC2, 0x67, -+0x06, 0x10, 0x01, 0x4A, 0xAC, 0xEA, 0x2D, 0x72, -+0x01, 0x4C, 0xF3, 0x61, 0x00, 0x6E, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC8, 0xF3, -+0xFE, 0xAA, 0xE8, 0xF3, 0x40, 0xA2, 0x30, 0xF0, -+0x20, 0x6D, 0x00, 0x6C, 0x5F, 0xE7, 0x68, 0xF5, -+0x04, 0x4D, 0x64, 0x67, 0x40, 0xA5, 0x51, 0xE4, -+0xFF, 0x6A, 0x4C, 0xEC, 0x82, 0xEF, 0x06, 0x61, -+0x01, 0x4B, 0x4C, 0xEB, 0x2D, 0x73, 0x01, 0x4D, -+0xF5, 0x61, 0x00, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0xD9, 0xC2, -+0x88, 0xF3, 0x7A, 0xC2, 0x88, 0xF3, 0x79, 0xA2, -+0x0A, 0x5B, 0x05, 0x61, 0xF6, 0x4B, 0x88, 0xF3, -+0x71, 0xC2, 0x00, 0x6B, 0x05, 0x10, 0x00, 0x6C, -+0x88, 0xF3, 0x91, 0xC2, 0x0A, 0x6C, 0x6F, 0xE4, -+0x88, 0xF3, 0x70, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0x79, 0xA2, -+0x88, 0xF3, 0x9A, 0xA2, 0x68, 0xF3, 0xB9, 0xA2, -+0x73, 0xE4, 0x01, 0x6B, 0xAC, 0xEB, 0x03, 0x23, -+0xC8, 0xF3, 0x7C, 0xA2, 0x02, 0x10, 0xC8, 0xF3, -+0x7D, 0xA2, 0x71, 0xE4, 0x01, 0x4C, 0x88, 0xF3, -+0x97, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x88, 0xF3, 0x77, 0xA2, 0x10, 0x5B, -+0x03, 0x60, 0x10, 0x6B, 0x88, 0xF3, 0x77, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x77, 0xA2, 0x88, 0xF3, 0x90, 0xA2, -+0x88, 0xF3, 0xB1, 0xA2, 0x02, 0x4B, 0x88, 0xF3, -+0x77, 0xC2, 0x88, 0xF3, 0xD7, 0xA2, 0x03, 0x6F, -+0x00, 0x18, 0xAB, 0xC6, 0x00, 0x6C, 0x00, 0x18, -+0x1F, 0xC7, 0x09, 0x10, 0x30, 0xF0, 0x20, 0x6C, -+0x00, 0x6B, 0xE8, 0xF3, 0xC0, 0xA2, 0x68, 0xF5, -+0x04, 0x4C, 0x43, 0x67, 0x7E, 0x17, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0x28, 0xF5, 0xBF, 0xA3, -+0x04, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x0C, 0x23, 0x7D, 0x67, 0x1E, 0x6A, -+0x50, 0xC3, 0x01, 0x6A, 0x4F, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x92, 0xC3, -+0x04, 0x04, 0x40, 0xEA, 0x09, 0x97, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x24, 0x67, 0x6E, 0xF5, -+0x58, 0x9A, 0x4F, 0xF7, 0x95, 0xA3, 0xFF, 0x68, -+0x0C, 0xE9, 0x40, 0xEA, 0x01, 0x72, 0x35, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x68, 0xF3, 0x94, 0xA3, 0x7F, 0x6A, 0x8C, 0xEA, -+0x0C, 0xEA, 0x2B, 0x22, 0x68, 0xF3, 0x75, 0xA3, -+0x0F, 0x6A, 0x6C, 0xEA, 0x01, 0x72, 0x25, 0x61, -+0x05, 0x59, 0x03, 0x61, 0xA0, 0xF6, 0x08, 0x6A, -+0x07, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x24, 0x31, -+0x96, 0xF0, 0x18, 0x4A, 0x49, 0xE1, 0x40, 0xAA, -+0x61, 0x42, 0x1F, 0xF7, 0x00, 0x6C, 0x8C, 0xEB, -+0x02, 0xF0, 0x00, 0x73, 0x01, 0x60, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF3, 0x64, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF3, -+0x68, 0x9B, 0x69, 0xE2, 0x60, 0xA2, 0x20, 0x6A, -+0x6C, 0xEA, 0x4B, 0xEA, 0xC0, 0xF7, 0x42, 0x32, -+0x01, 0x10, 0x01, 0x6A, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0x28, 0xF5, 0x7C, 0xA2, -+0x7F, 0x6A, 0x6C, 0xEA, 0x01, 0x5A, 0x58, 0x67, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x8F, 0xF5, 0x08, 0x4C, -+0x00, 0x6D, 0x07, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0x8F, 0xF5, 0x48, 0xA2, 0x01, 0x6B, 0x46, 0x32, -+0x6C, 0xEA, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xE7, 0xC7, 0x17, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x4C, 0x9A, 0x40, 0xA2, -+0x2A, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF5, -+0x69, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x21, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF3, 0x50, 0x9A, 0x60, 0xA2, 0x02, 0x6A, -+0x6C, 0xEA, 0x19, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF3, 0x54, 0x9A, 0x60, 0xAA, 0x02, 0xF0, -+0x00, 0x6A, 0x6C, 0xEA, 0x10, 0x2A, 0x00, 0x18, -+0x4B, 0xC6, 0x01, 0x72, 0x01, 0x6A, 0x0C, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x36, 0xF3, 0x9C, 0x9C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0x8F, 0xF5, 0x68, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0x20, 0xE8, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0x8F, 0xF5, 0x48, 0xA2, -+0xFF, 0x6B, 0x56, 0x32, 0x8E, 0xEA, 0x6C, 0xEA, -+0x01, 0x5A, 0x58, 0x67, 0x6C, 0xEA, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x08, 0xC8, -+0x00, 0x6B, 0x06, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x8F, 0xF5, 0x72, 0xA2, 0x01, 0x6A, 0x4C, 0xEB, -+0x05, 0x97, 0x43, 0x67, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x4B, 0xC6, -+0x01, 0x72, 0x1F, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, 0x9D, 0xA2, -+0x03, 0x6B, 0x8C, 0xEB, 0x16, 0x2B, 0x68, 0xF3, -+0x78, 0xA2, 0x13, 0x2B, 0x04, 0x6B, 0x8C, 0xEB, -+0x10, 0x2B, 0x10, 0x6B, 0x8C, 0xEB, 0x0D, 0x2B, -+0x68, 0xF3, 0x99, 0xA2, 0x20, 0x6B, 0x8C, 0xEB, -+0x08, 0x23, 0xE8, 0xF3, 0x52, 0xA2, 0x05, 0x2A, -+0x00, 0x18, 0x12, 0xC8, 0x01, 0x5A, 0x58, 0x67, -+0x01, 0x10, 0x00, 0x6A, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x30, 0xF0, -+0x20, 0x68, 0x4C, 0xEC, 0xC0, 0xF1, 0x08, 0x48, -+0x04, 0xD4, 0x68, 0xF3, 0x9D, 0xA0, 0x10, 0x6B, -+0x30, 0xF0, 0x20, 0x69, 0x8D, 0xEB, 0x68, 0xF3, -+0x7D, 0xC0, 0xCF, 0xF4, 0x80, 0xA1, 0x01, 0x6B, -+0x8C, 0xEB, 0x4C, 0xEB, 0x29, 0x23, 0xCF, 0xF4, -+0x00, 0x49, 0x42, 0xA1, 0xFF, 0x72, 0x54, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0x40, 0x9A, -+0x00, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0x44, 0x9A, -+0x04, 0x6B, 0xFF, 0x6C, 0x60, 0xC2, 0xAE, 0xF2, -+0x50, 0x98, 0x59, 0x4C, 0x00, 0x6D, 0x05, 0x6E, -+0x40, 0xEA, 0xC2, 0xA1, 0xAE, 0xF2, 0x50, 0x98, -+0xFF, 0x6C, 0x55, 0x4C, 0x00, 0x6D, 0x05, 0x4E, -+0x40, 0xEA, 0x00, 0x18, 0x08, 0xC8, 0x34, 0x2A, -+0x04, 0x94, 0x00, 0x18, 0x50, 0xE9, 0x30, 0x10, -+0x88, 0xF3, 0x65, 0xA0, 0x02, 0x5B, 0x13, 0x60, -+0x88, 0xF3, 0xC4, 0xA0, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x50, 0x9A, 0xFF, 0x6C, 0xD9, 0xE3, -+0x55, 0x4C, 0x00, 0x6D, 0x40, 0xEA, 0x88, 0xF3, -+0x65, 0xA0, 0x88, 0xF3, 0x44, 0xA0, 0x49, 0xE3, -+0x88, 0xF3, 0x57, 0xC0, 0x19, 0x10, 0x03, 0x69, -+0x38, 0xEB, 0x88, 0xF3, 0xC4, 0xA0, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x50, 0x9A, 0xFE, 0x4E, -+0xFF, 0x6C, 0x55, 0x4C, 0x00, 0x6D, 0x12, 0xEB, -+0x79, 0xE6, 0x40, 0xEA, 0x88, 0xF3, 0x65, 0xA0, -+0x88, 0xF3, 0x44, 0xA0, 0x38, 0xEB, 0xFE, 0x4A, -+0x12, 0xE9, 0x25, 0xE2, 0x88, 0xF3, 0x37, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x04, 0x6B, 0x6C, 0xEA, 0x08, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x04, 0x96, -+0x83, 0x67, 0x01, 0x6D, 0x40, 0xEA, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x74, 0xA0, 0x00, 0x6A, 0xE8, 0xF3, -+0x42, 0xC0, 0x7F, 0x6A, 0xFF, 0x69, 0x6C, 0xEA, -+0x2C, 0xEC, 0x2C, 0xEA, 0x04, 0xD4, 0x24, 0x22, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF5, 0x58, 0x9A, 0x4F, 0xF7, 0x95, 0xA3, -+0x40, 0xEA, 0x01, 0x72, 0x19, 0x61, 0x04, 0x94, -+0x00, 0x6D, 0x00, 0x18, 0xE2, 0xC5, 0xC8, 0xF3, -+0x54, 0xD8, 0x68, 0xF3, 0x5A, 0xA0, 0x68, 0xF3, -+0x95, 0xA0, 0x20, 0x6B, 0x4D, 0xEB, 0x0F, 0x6A, -+0x8C, 0xEA, 0x2C, 0xEA, 0x68, 0xF3, 0x7A, 0xC0, -+0x04, 0x22, 0x10, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x03, 0x2A, 0x04, 0x94, 0x00, 0x18, 0x2F, 0xC8, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x24, 0x67, 0x68, 0xF3, -+0x94, 0xA0, 0x00, 0x6B, 0xE8, 0xF3, 0x62, 0xC0, -+0x7F, 0x6B, 0xFF, 0x6A, 0x8C, 0xEB, 0x4C, 0xEB, -+0x4C, 0xE9, 0x27, 0x23, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x4F, 0xF7, 0x95, 0xA3, -+0x6E, 0xF5, 0x58, 0x9A, 0x40, 0xEA, 0x01, 0x72, -+0x78, 0x67, 0x04, 0xD3, 0x1A, 0x2B, 0x88, 0xF3, -+0xA2, 0xA0, 0x91, 0x67, 0x00, 0x18, 0xEF, 0xE9, -+0x91, 0x67, 0x00, 0x6D, 0x00, 0x18, 0xE2, 0xC5, -+0x68, 0xF3, 0x7A, 0xA0, 0xC8, 0xF3, 0x54, 0xD8, -+0x20, 0x6A, 0x6D, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, -+0x5D, 0x67, 0x67, 0x42, 0x09, 0x4B, 0x40, 0xA3, -+0x91, 0x67, 0x88, 0xF3, 0x43, 0xC0, 0x00, 0x18, -+0x2F, 0xC8, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x30, 0xF0, 0x20, 0x69, 0x04, 0xD4, 0xCF, 0xF4, -+0x00, 0x49, 0xC0, 0xF0, 0x88, 0xA1, 0x04, 0x6B, -+0x8C, 0xEB, 0x4C, 0xEB, 0x32, 0x23, 0xC0, 0xF0, -+0x0A, 0xA1, 0xC0, 0xF0, 0x49, 0xA1, 0x58, 0xE8, -+0x12, 0xE8, 0xC0, 0xF0, 0x10, 0xC1, 0x00, 0x18, -+0xDA, 0xC7, 0x03, 0x22, 0xC0, 0xF0, 0x11, 0xC1, -+0x03, 0x10, 0x01, 0x6A, 0xC0, 0xF0, 0x51, 0xC1, -+0x30, 0xF0, 0x20, 0x6A, 0x8F, 0xF5, 0x11, 0xA2, -+0x02, 0x58, 0x11, 0x61, 0x00, 0x18, 0xDA, 0xC7, -+0x06, 0x22, 0x04, 0x94, 0x00, 0x18, 0x57, 0xE9, -+0x04, 0x94, 0x00, 0x18, 0x50, 0xE9, 0x04, 0x94, -+0x00, 0x18, 0x20, 0xE9, 0x04, 0x94, 0xB0, 0x67, -+0x00, 0x18, 0xEF, 0xE9, 0x13, 0x10, 0x01, 0x70, -+0x04, 0x61, 0x04, 0x94, 0x00, 0x18, 0x2A, 0xE9, -+0x0D, 0x10, 0x00, 0x18, 0xDA, 0xC7, 0x0A, 0x22, -+0x03, 0x10, 0x04, 0x94, 0x00, 0x18, 0x46, 0xE9, -+0x04, 0x94, 0x00, 0x18, 0x57, 0xE9, 0x04, 0x94, -+0x00, 0x18, 0x50, 0xE9, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD0, 0xFF, 0x6A, -+0x4C, 0xEC, 0x12, 0x2C, 0x10, 0xF0, 0x23, 0x6C, -+0xA4, 0xF5, 0x05, 0x4C, 0x00, 0x18, 0x56, 0xE6, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0xC0, 0xF0, 0x92, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xC0, 0xF0, 0x72, 0xC2, 0x1F, 0x10, -+0x30, 0xF0, 0x20, 0x68, 0xCF, 0xF4, 0x00, 0x48, -+0xC0, 0xF0, 0x88, 0xA0, 0x04, 0x6B, 0x8C, 0xEB, -+0x4C, 0xEB, 0x15, 0x23, 0xC0, 0xF0, 0xCB, 0xA0, -+0x00, 0x6A, 0x04, 0xD2, 0xA2, 0x67, 0x0A, 0x6A, -+0x58, 0xEE, 0x10, 0xF0, 0x23, 0x6C, 0xA4, 0xF5, -+0x05, 0x4C, 0x01, 0x6F, 0x12, 0xEE, 0x00, 0x18, -+0x69, 0xE6, 0xC0, 0xF0, 0x72, 0xA0, 0x01, 0x6A, -+0x6D, 0xEA, 0xC0, 0xF0, 0x52, 0xC0, 0x07, 0x97, -+0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xFA, 0xE9, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xC5, 0x67, 0xFF, 0x6C, 0x40, 0xEA, -+0x01, 0x6C, 0x0C, 0x6D, 0x00, 0x18, 0x24, 0xC6, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x68, -+0x8C, 0xE8, 0x00, 0x18, 0xFA, 0xE9, 0x08, 0x20, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, -+0x01, 0x6C, 0x04, 0x6D, 0x00, 0x18, 0x24, 0xC6, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0xA4, 0x67, -+0x2F, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF2, 0x40, 0x9A, 0x40, 0xEA, 0x00, 0x18, -+0x2F, 0xEA, 0x01, 0x6C, 0x08, 0x6D, 0x00, 0x18, -+0x24, 0xC6, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x69, 0x04, 0x67, 0x2C, 0xE8, 0xAC, 0xE9, -+0x00, 0x18, 0xDA, 0xC7, 0x07, 0x22, 0x03, 0x28, -+0x00, 0x18, 0x0E, 0xC9, 0x0D, 0x10, 0x00, 0x18, -+0xF8, 0xC8, 0x0A, 0x10, 0x01, 0x70, 0x08, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x04, 0x6C, 0x01, 0x6D, 0xD1, 0x67, 0x40, 0xEA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x6A, 0x8F, 0xF5, -+0x08, 0xA2, 0x00, 0x6C, 0x00, 0x18, 0xDA, 0xC8, -+0x00, 0x18, 0x08, 0xC8, 0x16, 0x30, 0x01, 0x6C, -+0x04, 0x22, 0x90, 0x67, 0x00, 0x18, 0xB1, 0xC8, -+0x00, 0x6C, 0xB0, 0x67, 0x00, 0x18, 0x1A, 0xC9, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6B, 0xCF, 0xF4, 0x00, 0x4B, 0x04, 0x67, -+0xC0, 0xF0, 0x88, 0xA3, 0xFF, 0x6A, 0x4C, 0xE8, -+0x96, 0x34, 0x0E, 0xEC, 0xAC, 0xEA, 0x19, 0x2C, -+0xC0, 0xF0, 0xB0, 0xA3, 0x43, 0xED, 0x04, 0x61, -+0x4B, 0xE5, 0xC0, 0xF0, 0x50, 0xC3, 0x02, 0x10, -+0xC0, 0xF0, 0x90, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0x8F, 0xF5, 0x50, 0xA2, 0x0A, 0x2A, 0x90, 0x67, -+0x00, 0x18, 0xB1, 0xC8, 0x01, 0x6C, 0xB0, 0x67, -+0x00, 0x18, 0x1A, 0xC9, 0x01, 0x6C, 0x00, 0x18, -+0xDA, 0xC8, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x68, 0x8C, 0xE8, 0x00, 0x18, -+0x08, 0xC8, 0x0E, 0x22, 0x90, 0x67, 0x00, 0x18, -+0x0C, 0xC8, 0x0A, 0x22, 0x00, 0x18, 0xDA, 0xC7, -+0x07, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x8F, 0xF5, -+0xB1, 0xA2, 0x90, 0x67, 0x00, 0x18, 0x38, 0xC9, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x68, -+0x8C, 0xE8, 0x00, 0x18, 0x08, 0xC8, 0x0E, 0x22, -+0x90, 0x67, 0x00, 0x18, 0x0C, 0xC8, 0x0A, 0x22, -+0x00, 0x18, 0xDA, 0xC7, 0x07, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x8F, 0xF5, 0xB1, 0xA2, 0x90, 0x67, -+0x00, 0x18, 0x38, 0xC9, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0xC0, 0xF0, 0x92, 0xA2, 0xC0, 0xF0, 0xA8, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xB6, 0x35, -+0x00, 0x6C, 0xC0, 0xF0, 0x72, 0xC2, 0x00, 0x18, -+0x1A, 0xC9, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xFF, 0x68, -+0x8C, 0xE8, 0x68, 0xF3, 0x99, 0xA2, 0x03, 0x6B, -+0x6B, 0xEB, 0x41, 0x6D, 0x8C, 0xEB, 0xAB, 0xED, -+0xAC, 0xEB, 0x68, 0xF3, 0xBA, 0xA2, 0x68, 0xF3, -+0x79, 0xC2, 0x11, 0x6B, 0x00, 0x6C, 0x6B, 0xEB, -+0x88, 0xF3, 0x85, 0xC2, 0x68, 0xF3, 0x9D, 0xC2, -+0xAC, 0xEB, 0x88, 0xF3, 0x86, 0xC2, 0x90, 0x67, -+0x68, 0xF3, 0x7A, 0xC2, 0x00, 0x18, 0x31, 0xE9, -+0x90, 0x67, 0x00, 0x18, 0x2A, 0xE9, 0x90, 0x67, -+0x00, 0x18, 0x46, 0xE9, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xF0, 0x6D, 0x01, 0x6C, 0x00, 0x18, 0x24, 0xC6, -+0x00, 0x6C, 0x00, 0x18, 0x76, 0xEB, 0x00, 0x18, -+0x55, 0xE4, 0x00, 0x18, 0x98, 0xE4, 0x01, 0x6C, -+0x00, 0x18, 0x76, 0xEB, 0x01, 0x6C, 0x00, 0x6D, -+0x00, 0x18, 0x24, 0xC6, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x02, 0x22, 0x08, 0x72, 0x06, 0x61, 0x00, 0x18, -+0xEB, 0xC7, 0x01, 0x72, 0x02, 0x61, 0x00, 0x18, -+0x8B, 0xC9, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x61, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x97, 0xC9, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF3, 0x68, 0x9B, 0xFF, 0x6A, 0x24, 0x67, -+0x60, 0xA3, 0x4C, 0xE9, 0x30, 0xF0, 0x20, 0x68, -+0x6C, 0xEA, 0x04, 0xD2, 0x6E, 0xF2, 0x58, 0x98, -+0xFF, 0x6C, 0xA4, 0x67, 0x2D, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, 0x40, 0x9A, -+0x40, 0xEA, 0x07, 0x2A, 0x6E, 0xF2, 0x58, 0x98, -+0x04, 0x95, 0xFF, 0x6C, 0x2D, 0x6E, 0x40, 0xEA, -+0x2C, 0x10, 0x05, 0x59, 0x24, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x28, 0x31, 0x16, 0xF0, 0x00, 0x4A, -+0x29, 0xE2, 0x40, 0x9A, 0x00, 0xEA, 0x00, 0x6C, -+0x08, 0x6D, 0x17, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x6C, 0x56, 0xF3, 0xAC, 0x9A, 0x11, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x04, 0x6C, 0x56, 0xF3, -+0xB0, 0x9A, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x6C, 0x56, 0xF3, 0xB4, 0x9A, 0x05, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0xB8, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0x3C, 0xDF, 0x00, 0x18, -+0x2F, 0xEA, 0x01, 0x6C, 0x00, 0x6D, 0x00, 0x18, -+0x24, 0xC6, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0x48, 0xF5, 0xA2, 0xA3, -+0x08, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x03, 0x2B, 0x01, 0x6C, 0x0C, 0x6D, -+0x05, 0x10, 0x01, 0x6D, 0x00, 0x18, 0x5E, 0xCD, -+0x01, 0x6C, 0x04, 0x6D, 0x00, 0x18, 0x24, 0xC6, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0x48, 0xF5, 0xA2, 0xA3, 0x04, 0x6B, 0xFF, 0x6A, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x06, 0x2B, -+0x03, 0x6D, 0x00, 0x18, 0x5E, 0xCD, 0x01, 0x6C, -+0x04, 0x6D, 0x05, 0x10, 0x00, 0x6D, 0x00, 0x18, -+0x5E, 0xCD, 0x01, 0x6C, 0x0C, 0x6D, 0x00, 0x18, -+0x24, 0xC6, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x00, 0x6D, 0xFF, 0x6C, 0xC5, 0x67, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x6D, 0x00, 0x18, 0x5E, 0xCD, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, -+0xC5, 0x67, 0xFF, 0x6C, 0x40, 0xEA, 0x01, 0x6C, -+0x0C, 0x6D, 0x00, 0x18, 0x24, 0xC6, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x69, 0x2C, 0xEC, -+0xAC, 0xE9, 0x38, 0x24, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, -+0x4F, 0xF7, 0x95, 0xA3, 0x40, 0xEA, 0x01, 0x72, -+0x2D, 0x61, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x68, 0xF3, 0x7A, 0xA0, 0x05, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, -+0x2B, 0x6E, 0xFF, 0x6C, 0x0F, 0x6D, 0x40, 0xEA, -+0x91, 0x67, 0x02, 0x6D, 0x00, 0x18, 0x5E, 0xCD, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x50, 0x9A, -+0xC8, 0xF2, 0x9F, 0xA0, 0x00, 0x6D, 0x08, 0x6E, -+0xF1, 0x67, 0x40, 0xEA, 0x01, 0x72, 0x0A, 0x61, -+0x68, 0xF3, 0x7A, 0xA0, 0x01, 0x6A, 0x01, 0x6C, -+0x6D, 0xEA, 0x06, 0x6D, 0x68, 0xF3, 0x5A, 0xC0, -+0x00, 0x18, 0x24, 0xC6, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x25, 0x67, 0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, -+0x08, 0x4D, 0x06, 0x67, 0x68, 0xF3, 0xDA, 0xA5, -+0x03, 0x6B, 0xFF, 0x6A, 0xCC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x4C, 0xE9, 0x4C, 0xE8, 0xE0, 0xF0, -+0x03, 0x2B, 0x68, 0xF3, 0x5C, 0xA5, 0x8E, 0xEA, -+0xC0, 0xF0, 0x1E, 0x22, 0x0D, 0x5C, 0xC0, 0xF0, -+0x1B, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, -+0x16, 0xF0, 0x14, 0x4A, 0x89, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x0E, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0xD1, 0xC9, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x03, 0x2A, 0x01, 0x6C, -+0x00, 0x18, 0x02, 0xC9, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x06, 0x72, 0x03, 0x61, -+0x90, 0x67, 0x00, 0x18, 0xE2, 0xC9, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, 0x04, 0x72, -+0x09, 0x61, 0x05, 0x21, 0x91, 0x67, 0xB0, 0x67, -+0x00, 0x18, 0xFF, 0xC9, 0x03, 0x10, 0x90, 0x67, -+0x00, 0x18, 0xF4, 0xC9, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x08, 0x72, 0xA0, 0xF0, -+0x03, 0x61, 0x00, 0x18, 0xF8, 0xC8, 0xA0, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x03, 0x2A, 0x01, 0x6C, 0x00, 0x18, 0x02, 0xC9, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x06, 0x72, 0x03, 0x61, 0x90, 0x67, 0x00, 0x18, -+0xE2, 0xC9, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x0E, 0x72, 0x07, 0x61, 0x00, 0x18, -+0x6D, 0xC6, 0x01, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0xD1, 0xC9, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x0C, 0x72, 0x7C, 0x61, -+0x00, 0x18, 0x6D, 0xC6, 0x01, 0x72, 0x78, 0x61, -+0x90, 0x67, 0x00, 0x18, 0x79, 0xC6, 0x74, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x0E, 0x72, 0x07, 0x61, 0x00, 0x18, 0x6D, 0xC6, -+0x01, 0x72, 0x03, 0x61, 0x90, 0x67, 0x00, 0x18, -+0xD1, 0xC9, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x06, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0xE2, 0xC9, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x0C, 0x72, 0x07, 0x61, -+0x00, 0x18, 0x6D, 0xC6, 0x01, 0x72, 0x03, 0x61, -+0x90, 0x67, 0x00, 0x18, 0x79, 0xC6, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, 0x04, 0x72, -+0x4B, 0x61, 0x00, 0x18, 0x1A, 0xC8, 0x01, 0x72, -+0x47, 0x61, 0x90, 0x67, 0x00, 0x18, 0xA7, 0xC9, -+0x43, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x44, 0xA2, 0x0E, 0x72, 0x07, 0x61, 0x00, 0x18, -+0x6D, 0xC6, 0x01, 0x72, 0x03, 0x61, 0x90, 0x67, -+0x00, 0x18, 0xD1, 0xC9, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x44, 0xA2, 0x06, 0x72, 0x03, 0x61, -+0x90, 0x67, 0x00, 0x18, 0xE2, 0xC9, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, 0x0C, 0x72, -+0x07, 0x61, 0x00, 0x18, 0x6D, 0xC6, 0x01, 0x72, -+0x03, 0x61, 0x90, 0x67, 0x00, 0x18, 0x79, 0xC6, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x03, 0x2A, 0x01, 0x6C, 0x00, 0x18, 0x02, 0xC9, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x04, 0x72, 0x12, 0x61, 0x00, 0x18, 0x99, 0xC6, -+0x0F, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0x7C, 0xA2, 0x0C, 0x73, -+0x07, 0x61, 0x68, 0xF3, 0x79, 0xA2, 0x20, 0x6A, -+0x6C, 0xEA, 0x02, 0x22, 0x00, 0x18, 0x0E, 0xC9, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x48, 0xF5, 0xA1, 0xA3, 0x04, 0x6B, 0xFF, 0x6A, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x06, 0x23, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0x40, 0x9A, -+0x00, 0x6B, 0x60, 0xC2, 0x02, 0x6D, 0x00, 0x18, -+0xA9, 0xE4, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, -+0x44, 0x9A, 0x04, 0x69, 0x30, 0xF0, 0x20, 0x68, -+0x20, 0xDA, 0xC0, 0xF1, 0x08, 0x48, 0xE8, 0xF3, -+0xC6, 0xA0, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x50, 0x9A, 0xFF, 0x6C, 0x59, 0x4C, 0x00, 0x6D, -+0xC6, 0x36, 0x40, 0xEA, 0x68, 0xF3, 0x59, 0xA0, -+0x07, 0x97, 0x4D, 0xE9, 0x68, 0xF3, 0x39, 0xC0, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, -+0xB4, 0xA3, 0x04, 0x67, 0x7F, 0x6C, 0xAC, 0xEC, -+0xFF, 0x6A, 0x01, 0x74, 0x4C, 0xE8, 0x26, 0x61, -+0x68, 0xF3, 0xB5, 0xA3, 0x10, 0x6C, 0x8B, 0xEC, -+0xAC, 0xEC, 0x4C, 0xEC, 0x14, 0x24, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0xD0, 0x67, -+0x0C, 0x6C, 0x00, 0x6D, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, -+0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, 0x90, 0x67, -+0x00, 0x18, 0xA1, 0xCA, 0x0B, 0x10, 0x68, 0xF3, -+0x5C, 0xA3, 0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x48, 0x9A, 0x04, 0x6C, 0x01, 0x6D, -+0xD0, 0x67, 0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0xBC, 0xCA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0xFF, 0x69, 0x8C, 0xE9, 0x30, 0xF0, 0x20, 0x68, -+0x91, 0x67, 0xC0, 0xF1, 0x08, 0x48, 0x00, 0x18, -+0xA1, 0xCA, 0x68, 0xF3, 0x5C, 0xA0, 0x0C, 0x72, -+0x20, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x0C, 0x6C, 0x00, 0x6D, 0xD1, 0x67, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x00, 0x6D, 0xC5, 0x67, 0xFF, 0x6C, -+0x40, 0xEA, 0x68, 0xF3, 0x7A, 0xA0, 0x01, 0x6A, -+0xC8, 0xF2, 0x9F, 0xA0, 0x6D, 0xEA, 0x68, 0xF3, -+0x5A, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x50, 0x9A, 0x00, 0x6D, 0x08, 0x6E, 0xF1, 0x67, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x04, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, 0x68, 0xF3, -+0xB9, 0xA4, 0x40, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, -+0x4C, 0xEB, 0x4C, 0xE8, 0x0C, 0x23, 0x68, 0xF3, -+0x9A, 0xA4, 0x10, 0x6B, 0x8C, 0xEB, 0x4C, 0xEB, -+0x06, 0x23, 0x00, 0x18, 0x08, 0xC8, 0x03, 0x2A, -+0x90, 0x67, 0x00, 0x18, 0x50, 0xE9, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x68, 0xF3, -+0x99, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, 0x10, 0x23, -+0x03, 0x6B, 0x6B, 0xEB, 0x6C, 0xEC, 0x68, 0xF3, -+0x99, 0xC2, 0x68, 0xF3, 0x9D, 0xA2, 0x8C, 0xEB, -+0x68, 0xF3, 0x7D, 0xC2, 0x68, 0xF3, 0x5D, 0xA2, -+0x07, 0x6B, 0x6C, 0xEA, 0x6A, 0x2A, 0x66, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF3, 0x80, 0x9B, -+0xFF, 0xF7, 0x1F, 0x6D, 0x60, 0xAC, 0xAC, 0xEB, -+0x01, 0x4B, 0xAC, 0xEB, 0x60, 0xCC, 0x88, 0xF3, -+0x65, 0xA2, 0x68, 0xF3, 0x9D, 0xA2, 0x01, 0x4B, -+0x88, 0xF3, 0x65, 0xC2, 0x11, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x68, 0xF3, 0x7D, 0xC2, 0x88, 0xF3, -+0x65, 0xA2, 0xE8, 0xF3, 0x44, 0xA2, 0x63, 0xEA, -+0x49, 0x60, 0x30, 0xF0, 0x20, 0x69, 0x71, 0x67, -+0xCF, 0xF4, 0x00, 0x4B, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF5, 0x58, 0x9A, 0x80, 0xF2, 0x95, 0xA3, -+0x40, 0xEA, 0x01, 0x72, 0x3E, 0x61, 0xCF, 0xF4, -+0x60, 0xA1, 0x01, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x02, 0x2A, 0x00, 0x18, 0x06, 0xC7, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x95, 0xA2, 0x10, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xFF, 0x6C, 0x8C, 0xEB, 0x07, 0x2B, -+0x68, 0xF3, 0x99, 0xA2, 0xDF, 0x4B, 0x8C, 0xEB, -+0x68, 0xF3, 0x79, 0xC2, 0x22, 0x10, 0x88, 0xF3, -+0x66, 0xA2, 0x01, 0x4B, 0x88, 0xF3, 0x66, 0xC2, -+0x88, 0xF3, 0x66, 0xA2, 0x02, 0x5B, 0x0B, 0x61, -+0x68, 0xF3, 0x99, 0xA2, 0x21, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x68, 0xF3, 0x79, 0xC2, 0x00, 0x6B, -+0x88, 0xF3, 0x66, 0xC2, 0x03, 0x10, 0x90, 0x67, -+0x00, 0x18, 0xDE, 0xCA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x00, 0x6B, 0x88, 0xF3, -+0x65, 0xC2, 0x03, 0x10, 0x90, 0x67, 0x00, 0x18, -+0xA2, 0xC6, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, -+0x05, 0x5A, 0x00, 0x68, 0x24, 0x60, 0x10, 0xF0, -+0x24, 0x6B, 0x48, 0x34, 0x56, 0xF0, 0x08, 0x4B, -+0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, 0x10, 0xF0, -+0x24, 0x6B, 0x76, 0xF3, 0x64, 0x9B, 0x13, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF3, 0x68, 0x9B, -+0x0E, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF3, -+0x6C, 0x9B, 0x09, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x76, 0xF3, 0x70, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x76, 0xF3, 0x74, 0x9B, 0x60, 0xAB, -+0xFF, 0xF7, 0x1F, 0x68, 0x6C, 0xE8, 0x18, 0xF0, -+0x00, 0x6B, 0x0C, 0xEB, 0x13, 0x2B, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, 0x68, 0xF3, -+0xBD, 0xA4, 0xFE, 0x4B, 0xAC, 0xEB, 0x05, 0x6D, -+0xAB, 0xED, 0xAC, 0xEB, 0x02, 0x4D, 0xAC, 0xEB, -+0x68, 0xF3, 0x7D, 0xC4, 0x82, 0x67, 0x00, 0x18, -+0xA2, 0xC6, 0x5D, 0x10, 0x08, 0xF0, 0x00, 0x6B, -+0x0C, 0xEB, 0x23, 0x23, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, 0xB4, 0xA3, -+0x7F, 0x6C, 0xAC, 0xEC, 0x01, 0x74, 0x27, 0x61, -+0x68, 0xF3, 0xBD, 0xA3, 0x01, 0x6C, 0xAD, 0xEC, -+0x68, 0xF3, 0x9D, 0xC3, 0x68, 0xF3, 0x95, 0xA3, -+0x10, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xFF, 0x6C, -+0x8C, 0xEB, 0x20, 0x73, 0x06, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x54, 0x9A, 0x40, 0xEA, -+0x12, 0x10, 0x82, 0x67, 0x00, 0x18, 0xDE, 0xCA, -+0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0x9D, 0xA3, 0x02, 0x6A, -+0x4B, 0xEA, 0x8C, 0xEA, 0x05, 0x6C, 0x8B, 0xEC, -+0x8C, 0xEA, 0x68, 0xF3, 0x5D, 0xC3, 0x02, 0x30, -+0x1E, 0x30, 0x1A, 0x20, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x5D, 0xA0, -+0x02, 0x69, 0xE8, 0xF3, 0xC5, 0xA0, 0x2D, 0xEA, -+0x68, 0xF3, 0x5D, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x50, 0x9A, 0xFF, 0x6C, 0x55, 0x4C, -+0x00, 0x6D, 0x40, 0xEA, 0x68, 0xF3, 0x59, 0xA0, -+0x4D, 0xE9, 0x68, 0xF3, 0x39, 0xC0, 0x0B, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x9D, 0xA2, 0x03, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x68, 0xF3, 0x7D, 0xC2, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x24, 0x67, 0x6E, 0xF5, 0x58, 0x9A, 0x4F, 0xF7, -+0x95, 0xA3, 0xFF, 0x68, 0x0C, 0xE9, 0x40, 0xEA, -+0x01, 0x72, 0x00, 0xF1, 0x17, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, -+0x94, 0xA3, 0x7F, 0x6A, 0x8C, 0xEA, 0x0C, 0xEA, -+0x00, 0xF1, 0x0C, 0x22, 0x68, 0xF3, 0x75, 0xA3, -+0x0F, 0x6A, 0x6C, 0xEA, 0x01, 0x72, 0x69, 0x61, -+0x05, 0x59, 0x5A, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x28, 0x33, 0x56, 0xF0, 0x1C, 0x4A, 0x69, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF3, 0x58, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF3, -+0x7C, 0x9B, 0x3F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF3, 0x40, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF3, -+0x64, 0x9B, 0x2F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF3, 0x48, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF3, -+0x6C, 0x9B, 0x1F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF3, 0x50, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF3, -+0x74, 0x9B, 0x0F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF3, 0x58, 0x9A, 0x60, 0xA2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, -+0x63, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF3, -+0x7C, 0x9B, 0x60, 0xA3, 0x88, 0xF3, 0x62, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x63, 0xA2, 0x02, 0x2B, 0x88, 0xF3, -+0x62, 0xA2, 0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, -+0x6B, 0xC2, 0x91, 0x67, 0x00, 0x18, 0x30, 0xC7, -+0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF3, 0x80, 0x9B, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x00, 0x6A, 0x88, 0xF3, 0x45, 0xC0, 0x88, 0xF3, -+0x46, 0xC0, 0x60, 0xAC, 0xFF, 0xF7, 0x1F, 0x6D, -+0xAC, 0xEB, 0x01, 0x4B, 0xAC, 0xEB, 0x60, 0xCC, -+0x10, 0xF0, 0x24, 0x6B, 0x88, 0xF3, 0x8A, 0xA0, -+0x36, 0xF3, 0x60, 0x9B, 0x80, 0xC3, 0x10, 0xF0, -+0x24, 0x6B, 0xB6, 0xF3, 0x64, 0x9B, 0x91, 0x67, -+0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, -+0x44, 0x9A, 0x02, 0x6B, 0x60, 0xC2, 0x68, 0xF3, -+0x7D, 0xA0, 0x03, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x11, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x68, 0xF3, -+0x5D, 0xC0, 0x00, 0x18, 0x4B, 0xCB, 0x68, 0xF3, -+0x79, 0xA0, 0x40, 0x6A, 0x6C, 0xEA, 0x55, 0x22, -+0x68, 0xF3, 0x9A, 0xA0, 0x10, 0x6B, 0xFF, 0x6D, -+0x44, 0x67, 0x6C, 0xEA, 0xAC, 0xEA, 0x22, 0x2A, -+0x88, 0xF3, 0x43, 0xA0, 0x88, 0xF3, 0xA2, 0xA0, -+0xAE, 0xEA, 0x47, 0x2A, 0x8D, 0xEB, 0x68, 0xF3, -+0x7A, 0xC0, 0x91, 0x67, 0x00, 0x18, 0xEF, 0xE9, -+0x91, 0x67, 0x00, 0x18, 0x20, 0xE9, 0x00, 0x18, -+0x08, 0xC8, 0x06, 0x2A, 0x91, 0x67, 0x00, 0x18, -+0x57, 0xE9, 0x91, 0x67, 0x00, 0x18, 0x50, 0xE9, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x88, 0xF3, 0x63, 0xA2, 0xFF, 0x4B, 0x88, 0xF3, -+0x63, 0xC2, 0x2B, 0x10, 0x68, 0xF3, 0x75, 0xA0, -+0x0F, 0x6A, 0x6C, 0xEA, 0x01, 0x72, 0x25, 0x61, -+0x88, 0xF3, 0x43, 0xA0, 0x04, 0xD2, 0x04, 0x93, -+0x88, 0xF3, 0x42, 0xA0, 0x6E, 0xEA, 0x1D, 0x22, -+0x91, 0x67, 0x00, 0x18, 0xE4, 0xE9, 0x04, 0x95, -+0xAE, 0xEA, 0x17, 0x22, 0x68, 0xF3, 0x79, 0xA0, -+0x20, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x10, 0x22, 0x68, 0xF3, 0x7A, 0xA0, 0x11, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, -+0x91, 0x67, 0x00, 0x18, 0x46, 0xE9, 0x91, 0x67, -+0x00, 0x18, 0x31, 0xE9, 0x91, 0x67, 0x00, 0x18, -+0x2A, 0xE9, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, 0x01, 0x6B, -+0xE8, 0xF3, 0x62, 0xC2, 0x20, 0x6B, 0x8D, 0xEB, -+0x68, 0xF3, 0x79, 0xC2, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xED, -+0x4C, 0xEC, 0xCC, 0xEA, 0xA0, 0xF0, 0x1D, 0x25, -+0x05, 0x5C, 0xA0, 0xF0, 0x10, 0x60, 0x10, 0xF0, -+0x24, 0x6B, 0x88, 0x34, 0x76, 0xF0, 0x10, 0x4B, -+0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, 0x02, 0x72, -+0x0A, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF3, -+0xA8, 0x9A, 0x01, 0x6C, 0x00, 0x18, 0x3C, 0xDF, -+0x00, 0x6C, 0x08, 0x6D, 0x1D, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xB6, 0xF3, 0xAC, 0x9A, 0x01, 0x6C, -+0x00, 0x18, 0x3C, 0xDF, 0x00, 0x6C, 0x08, 0x6D, -+0x00, 0x18, 0x3C, 0xDF, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x54, 0x9A, 0x01, 0x6C, 0x0C, 0x6D, -+0x89, 0x10, 0x02, 0x72, 0x0C, 0x60, 0x04, 0x6C, -+0x0F, 0x6D, 0x00, 0x18, 0x3C, 0xDF, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF3, 0xAC, 0x9A, 0x04, 0x6C, -+0x00, 0x18, 0x3C, 0xDF, 0x7C, 0x10, 0x04, 0x6C, -+0x03, 0x6D, 0x00, 0x18, 0x3C, 0xDF, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF3, 0xAC, 0x9A, 0x04, 0x6C, -+0x00, 0x18, 0x3C, 0xDF, 0x30, 0xF0, 0x20, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0x4E, 0xF2, 0x54, 0x9A, -+0x02, 0x6C, 0xB6, 0xF3, 0xB0, 0x9B, 0x66, 0x10, -+0x02, 0x72, 0x0A, 0x60, 0x04, 0x6C, 0xF0, 0x6D, -+0x00, 0x18, 0x3C, 0xDF, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x6C, 0x56, 0xF3, 0xB0, 0x9A, 0xDC, 0x17, -+0x04, 0x6C, 0x30, 0x6D, 0x00, 0x18, 0x3C, 0xDF, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0xB0, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0x3C, 0xDF, 0x30, 0xF0, -+0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, 0x4E, 0xF2, -+0x54, 0x9A, 0x02, 0x6C, 0xB6, 0xF3, 0xB4, 0x9B, -+0x45, 0x10, 0x02, 0x72, 0x0B, 0x60, 0x04, 0x6C, -+0x01, 0xF7, 0x00, 0x6D, 0x00, 0x18, 0x3C, 0xDF, -+0x10, 0xF0, 0x24, 0x6A, 0x04, 0x6C, 0x56, 0xF3, -+0xB4, 0x9A, 0xBA, 0x17, 0x04, 0x6C, 0x00, 0xF3, -+0x00, 0x6D, 0x00, 0x18, 0x3C, 0xDF, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF3, 0xB4, 0x9A, 0x04, 0x6C, -+0x00, 0x18, 0x3C, 0xDF, 0x30, 0xF0, 0x20, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0x4E, 0xF2, 0x54, 0x9A, -+0x02, 0x6C, 0xB6, 0xF3, 0xB8, 0x9B, 0x22, 0x10, -+0x02, 0x72, 0x0B, 0x60, 0x04, 0x6C, 0x1E, 0xF0, -+0x00, 0x6D, 0x00, 0x18, 0x3C, 0xDF, 0x10, 0xF0, -+0x24, 0x6A, 0x04, 0x6C, 0x56, 0xF3, 0xB8, 0x9A, -+0x97, 0x17, 0x04, 0x6C, 0x06, 0xF0, 0x00, 0x6D, -+0x00, 0x18, 0x3C, 0xDF, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF3, 0xB8, 0x9A, 0x04, 0x6C, 0x00, 0x18, -+0x3C, 0xDF, 0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0x4E, 0xF2, 0x54, 0x9A, 0xF6, 0xF2, -+0xBC, 0x9B, 0x02, 0x6C, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF3, 0x7C, 0x9A, 0xFF, 0x6C, -+0x07, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0x65, 0x10, 0x05, 0x5C, 0x5D, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x88, 0x34, 0x96, 0xF0, 0x04, 0x4A, -+0x89, 0xE2, 0x40, 0x9A, 0x00, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0xB6, 0xF3, 0xA8, 0x9A, 0x01, 0x6C, -+0x00, 0x18, 0x6D, 0xDF, 0x00, 0x6C, 0x08, 0x6D, -+0x00, 0x18, 0x6D, 0xDF, 0x01, 0x6C, 0x0C, 0x6D, -+0x45, 0x10, 0x04, 0x6C, 0x0F, 0x6D, 0x00, 0x18, -+0x6D, 0xDF, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, -+0xAC, 0x9A, 0x04, 0x6C, 0x00, 0x18, 0x6D, 0xDF, -+0x10, 0xF0, 0x24, 0x6A, 0x02, 0x6C, 0xB6, 0xF3, -+0xB0, 0x9A, 0x34, 0x10, 0x04, 0x6C, 0xF0, 0x6D, -+0x00, 0x18, 0x6D, 0xDF, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF3, 0xB0, 0x9A, 0x04, 0x6C, 0x00, 0x18, -+0x6D, 0xDF, 0x10, 0xF0, 0x24, 0x6A, 0x02, 0x6C, -+0xB6, 0xF3, 0xB4, 0x9A, 0x23, 0x10, 0x04, 0x6C, -+0x01, 0xF7, 0x00, 0x6D, 0x00, 0x18, 0x6D, 0xDF, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0xB4, 0x9A, -+0x04, 0x6C, 0x00, 0x18, 0x6D, 0xDF, 0x10, 0xF0, -+0x24, 0x6A, 0x02, 0x6C, 0xB6, 0xF3, 0xB8, 0x9A, -+0x11, 0x10, 0x04, 0x6C, 0x1E, 0xF0, 0x00, 0x6D, -+0x00, 0x18, 0x6D, 0xDF, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF3, 0xB8, 0x9A, 0x04, 0x6C, 0x00, 0x18, -+0x6D, 0xDF, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF2, -+0xBC, 0x9A, 0x02, 0x6C, 0x00, 0x18, 0xBD, 0xDF, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0x7C, 0x9A, -+0xFC, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x54, 0xA0, 0x7F, 0x6E, 0xFF, 0x69, -+0x4C, 0xEE, 0x2C, 0xEC, 0x01, 0x6D, 0x2C, 0xEE, -+0x04, 0xD4, 0x00, 0x18, 0x36, 0xCC, 0x88, 0xF3, -+0x6A, 0xA8, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, -+0x40, 0x9A, 0x2C, 0xEB, 0x60, 0xC2, 0xC8, 0xF3, -+0x99, 0xA0, 0x80, 0x6A, 0x4B, 0xEA, 0x1F, 0x6B, -+0x8C, 0xEA, 0x8C, 0xEB, 0x2C, 0xEA, 0x2C, 0xEB, -+0x11, 0x22, 0x6F, 0x32, 0x2C, 0xEA, 0x82, 0x42, -+0x01, 0x4A, 0xC8, 0xF3, 0x5D, 0xC0, 0x07, 0x6A, -+0x6C, 0xEA, 0x68, 0xF3, 0x77, 0xA0, 0xC8, 0xF3, -+0x9C, 0xC0, 0x76, 0x33, 0x6C, 0x33, 0x6D, 0xEA, -+0x2C, 0xEA, 0x06, 0x10, 0x04, 0x6B, 0xC8, 0xF3, -+0x7C, 0xC0, 0x03, 0x6B, 0xC8, 0xF3, 0x7D, 0xC0, -+0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF3, 0x7C, 0x9B, -+0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, 0x4F, 0xF7, -+0x95, 0xA3, 0x40, 0xEA, 0x01, 0x72, 0x19, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x99, 0xA2, 0x21, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x68, 0xF3, 0x79, 0xC2, 0x68, 0xF3, -+0x5C, 0xA2, 0x04, 0x6B, 0x6C, 0xEA, 0x13, 0x2A, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x04, 0x96, 0x83, 0x67, 0x01, 0x6D, 0x40, 0xEA, -+0x0A, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x68, 0xF3, 0x99, 0xA2, 0x20, 0x6B, -+0x8D, 0xEB, 0x68, 0xF3, 0x79, 0xC2, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x4C, 0xEC, 0x25, 0x67, 0x04, 0xD4, -+0x4C, 0xE9, 0x5D, 0x2C, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x74, 0xA0, -+0x7F, 0x6E, 0x91, 0x67, 0x6C, 0xEE, 0x4C, 0xEE, -+0x00, 0x6D, 0x00, 0x18, 0x36, 0xCC, 0x7D, 0x67, -+0x87, 0x43, 0x09, 0x4C, 0x10, 0xF0, 0x24, 0x6A, -+0x60, 0xA4, 0xB6, 0xF3, 0x44, 0x9A, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0x44, 0x9A, -+0x02, 0x6B, 0x60, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF5, 0x58, 0x9A, -+0x4F, 0xF7, 0x95, 0xA3, 0x40, 0xEA, 0x10, 0x2A, -+0x00, 0x18, 0xFA, 0xE9, 0x91, 0x67, 0x00, 0x18, -+0xF4, 0xC9, 0x68, 0xF3, 0x7A, 0xA0, 0x02, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x03, 0x6B, 0x6B, 0xEB, -+0x6C, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, 0x08, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x0C, 0x6C, 0x01, 0x6D, 0xD1, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x99, 0xA2, 0x05, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x68, 0xF3, 0x79, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF4, 0x60, 0xA2, 0x01, 0x6A, -+0x6C, 0xEA, 0x13, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF3, 0x40, 0x9A, 0x00, 0x6B, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0x44, 0x9A, -+0x04, 0x6B, 0x60, 0xC2, 0x06, 0x10, 0x04, 0x94, -+0x01, 0x74, 0x03, 0x61, 0x91, 0x67, 0x00, 0x18, -+0xCE, 0xCC, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x69, 0x2C, 0xED, -+0x30, 0xF0, 0x20, 0x68, 0x0A, 0xD4, 0xC0, 0xF1, -+0x08, 0x48, 0x85, 0x67, 0x04, 0xD5, 0x00, 0x18, -+0x74, 0xC9, 0x68, 0xF3, 0x94, 0xA0, 0x7F, 0x6A, -+0x04, 0x95, 0x4C, 0xEC, 0x2C, 0xEC, 0x00, 0x18, -+0x08, 0xCD, 0x68, 0xF3, 0x54, 0xA0, 0x7F, 0x6B, -+0x6C, 0xEA, 0x2C, 0xEA, 0x18, 0x22, 0x0A, 0x93, -+0x0F, 0x6C, 0x41, 0xA3, 0xA2, 0xA3, 0x4C, 0xEC, -+0x2C, 0xEC, 0x00, 0x18, 0x56, 0xC6, 0x28, 0xF1, -+0x54, 0xA0, 0x03, 0x72, 0x0C, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF3, 0x60, 0x9A, 0x40, 0xA3, -+0x4C, 0xE9, 0x02, 0x6A, 0x2C, 0xEA, 0x03, 0x22, -+0xFD, 0x6A, 0x2C, 0xEA, 0x40, 0xC3, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFF, 0x6A, 0x4C, 0xEC, 0xAC, 0xEA, 0x0B, 0x2A, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF3, 0xA4, 0x9B, -+0x10, 0xF0, 0x24, 0x6E, 0xD6, 0xF3, 0xC8, 0x9E, -+0x60, 0x9D, 0xCC, 0xEB, 0x0C, 0x10, 0x01, 0x72, -+0x0B, 0x61, 0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF3, -+0xA4, 0x9B, 0x10, 0xF0, 0x24, 0x6E, 0xD6, 0xF3, -+0xCC, 0x9E, 0x60, 0x9D, 0xCD, 0xEB, 0x60, 0xDD, -+0x05, 0x5C, 0x60, 0xF1, 0x06, 0x60, 0x10, 0xF0, -+0x24, 0x6B, 0x88, 0x34, 0xB6, 0xF0, 0x04, 0x4B, -+0x8D, 0xE3, 0x60, 0x9B, 0x00, 0xEB, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, 0x64, 0x9A, -+0x0D, 0x11, 0x01, 0x72, 0x10, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF3, 0x64, 0x9A, 0xFF, 0x6C, -+0x40, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0x8C, 0xEA, 0x40, 0xC3, 0x40, 0xA3, 0x80, 0x4D, -+0xC0, 0x4D, 0x8C, 0xEA, 0x14, 0x10, 0x02, 0x72, -+0x07, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, -+0x64, 0x9A, 0xBF, 0x6A, 0x80, 0xA3, 0xF4, 0x10, -+0x03, 0x72, 0x20, 0xF1, 0x1A, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF3, 0x64, 0x9A, 0xFF, 0x6C, -+0x40, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0xE7, 0x10, 0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x70, 0x9A, 0xFD, 0x6A, 0x80, 0xA3, -+0xDF, 0x10, 0x01, 0x72, 0x19, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF3, 0x84, 0x9A, 0xFF, 0x6A, -+0x40, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF3, 0x90, 0x9B, 0x01, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x60, 0xA4, 0x02, 0x6D, 0x4C, 0xEB, 0xE1, 0x10, -+0x02, 0x72, 0x0F, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x64, 0x9A, 0xBF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x70, 0x9A, 0xFE, 0x6A, 0x80, 0xA3, -+0xB3, 0x10, 0x03, 0x72, 0xE0, 0xF0, 0x19, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, 0x84, 0x9A, -+0xFF, 0x6B, 0x40, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF3, 0x90, 0x9A, 0x01, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0x92, 0x10, 0x07, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, 0x70, 0x9A, -+0xF7, 0x6A, 0x80, 0xA3, 0x95, 0x10, 0x01, 0x72, -+0x19, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, -+0x84, 0x9A, 0xFF, 0x6A, 0x40, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF3, 0x90, 0x9B, -+0x04, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x60, 0xA4, 0x08, 0x6D, -+0x4C, 0xEB, 0x97, 0x10, 0x02, 0x72, 0x0F, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, 0x64, 0x9A, -+0xBF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, 0x70, 0x9A, -+0xFB, 0x6A, 0x80, 0xA3, 0x69, 0x10, 0x03, 0x72, -+0xA0, 0xF0, 0x0F, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x84, 0x9A, 0xFF, 0x6B, 0x40, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, -+0x90, 0x9A, 0x04, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0x48, 0x10, 0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x70, 0x9A, 0xDF, 0x6A, 0x80, 0xA3, -+0x4B, 0x10, 0x01, 0x72, 0x19, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF3, 0x84, 0x9A, 0xFF, 0x6A, -+0x40, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF3, 0x90, 0x9B, 0x10, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x60, 0xA4, 0x20, 0x6D, 0x4C, 0xEB, 0x4D, 0x10, -+0x02, 0x72, 0x0F, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x64, 0x9A, 0xBF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x70, 0x9A, 0xEF, 0x6A, 0x80, 0xA3, -+0x1F, 0x10, 0x03, 0x72, 0x66, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF3, 0x84, 0x9A, 0xFF, 0x6B, -+0x40, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x90, 0x9A, 0x10, 0x6D, 0x40, 0xA4, -+0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x20, 0xE8, 0x09, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x70, 0x9A, 0x80, 0xA3, 0x7F, 0x6A, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x01, 0x72, -+0x1C, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, -+0x84, 0x9A, 0xFF, 0x6A, 0x40, 0x6D, 0x60, 0xA4, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF3, 0x90, 0x9B, -+0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, -+0x60, 0xC4, 0x60, 0xA4, 0x80, 0x4D, 0xC0, 0x4D, -+0x4C, 0xEB, 0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x20, 0xE8, 0x02, 0x72, 0x10, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF3, 0x44, 0x9A, 0xBF, 0x6B, -+0x80, 0xA2, 0x6C, 0xEC, 0x80, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF3, 0x50, 0x9A, 0x80, 0xA2, -+0x8C, 0xEB, 0x60, 0xC2, 0x20, 0xE8, 0x03, 0x72, -+0x14, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, -+0x84, 0x9A, 0xFF, 0x6B, 0x40, 0x6D, 0x40, 0xA4, -+0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, 0x90, 0x9A, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x20, 0xE8, 0xFF, 0x63, 0x01, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF3, 0x74, 0x9B, -+0xFF, 0x6A, 0x4C, 0xEC, 0x6D, 0xE5, 0x00, 0xA3, -+0x3F, 0x6F, 0x01, 0x74, 0x0C, 0xEF, 0x4C, 0xEE, -+0xE0, 0xC3, 0x15, 0x60, 0x07, 0x24, 0x30, 0xF0, -+0x20, 0x6C, 0x48, 0xF5, 0x84, 0xA4, 0x08, 0x6F, -+0xEC, 0xEC, 0x0D, 0x24, 0x10, 0xF0, 0x24, 0x6C, -+0xD6, 0xF3, 0xF8, 0x9C, 0xEF, 0x6C, 0xFD, 0xE5, -+0x00, 0xA7, 0x0C, 0xEC, 0x80, 0xC7, 0x80, 0xA3, -+0x40, 0x6F, 0x4C, 0xEC, 0x0F, 0x10, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF3, 0xF8, 0x9C, 0x10, 0x68, -+0xFD, 0xE5, 0x80, 0xA7, 0x4C, 0xEC, 0x0D, 0xEC, -+0x4C, 0xEC, 0x80, 0xC7, 0x80, 0xA3, 0x80, 0x6F, -+0xEB, 0xEF, 0x4C, 0xEC, 0xED, 0xEC, 0x4C, 0xEC, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, 0x5C, 0x9A, -+0x80, 0xC3, 0x80, 0xF4, 0xC0, 0x36, 0x55, 0xE5, -+0x40, 0x9D, 0x4D, 0xEE, 0xC0, 0xDD, 0x01, 0x90, -+0x01, 0x63, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, 0x40, 0x9A, -+0xFF, 0x6B, 0x40, 0xA2, 0x6C, 0xEA, 0x52, 0x32, -+0x6C, 0xEA, 0x11, 0x2A, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x5C, 0x9A, -+0xA8, 0xF4, 0x86, 0xA3, 0x00, 0x6D, 0x18, 0x6E, -+0xE5, 0x67, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF2, 0x5C, 0x9A, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x64, 0x67, 0x4C, 0xEB, -+0x85, 0x67, 0x02, 0x5B, 0x4C, 0xEC, 0x43, 0x60, -+0x10, 0xF0, 0x24, 0x6D, 0xF6, 0xF3, 0xA4, 0x9D, -+0xFF, 0xF7, 0x1F, 0x6E, 0x30, 0xF0, 0x20, 0x68, -+0xE0, 0xAD, 0x10, 0xF0, 0x24, 0x6D, 0xF6, 0xF3, -+0xA8, 0x9D, 0xCC, 0xEF, 0xC0, 0xF1, 0x08, 0x48, -+0xA0, 0xAD, 0xAC, 0xEE, 0xD7, 0xE7, 0xC8, 0xF2, -+0xDF, 0xA0, 0x4C, 0xED, 0xCE, 0xED, 0x2B, 0x2D, -+0x68, 0xF3, 0x5C, 0xA0, 0x0E, 0x72, 0x0F, 0x61, -+0x26, 0x2B, 0x68, 0xF3, 0x7A, 0xA0, 0x03, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, -+0x00, 0x18, 0x5E, 0xCD, 0x01, 0x6C, 0x0C, 0x6D, -+0x00, 0x18, 0x24, 0xC6, 0x10, 0x10, 0x06, 0x72, -+0x16, 0x61, 0x15, 0x23, 0x68, 0xF3, 0x7A, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x01, 0x6D, -+0x68, 0xF3, 0x5A, 0xC0, 0x00, 0x18, 0x5E, 0xCD, -+0x04, 0x6A, 0x68, 0xF3, 0x5C, 0xC0, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6D, -+0xFF, 0x6C, 0xC5, 0x67, 0x40, 0xEA, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xFF, 0x6A, 0xF6, 0xF3, -+0x60, 0x9B, 0x4C, 0xEE, 0x4C, 0xEF, 0x05, 0xD6, -+0x04, 0xD7, 0x60, 0xA3, 0xFF, 0xF7, 0x1F, 0x68, -+0x25, 0x67, 0x4C, 0xEB, 0x72, 0x33, 0x4C, 0xEB, -+0x8C, 0xE8, 0x4C, 0xE9, 0x34, 0x23, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF3, 0x68, 0x9B, 0x00, 0x6C, -+0xFF, 0x6D, 0x60, 0xA3, 0x26, 0x6E, 0x6C, 0xEA, -+0x06, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF2, 0x40, 0x9A, 0x40, 0xEA, 0x01, 0x72, -+0x11, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x05, 0x96, -+0x6E, 0xF2, 0x5C, 0x9A, 0x90, 0x67, 0x01, 0x6D, -+0x00, 0x6F, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x2E, 0xF4, 0x6C, 0x9B, 0x04, 0x96, 0x91, 0x67, -+0xA2, 0x67, 0x40, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0x06, 0x95, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6C, -+0x27, 0x6E, 0x40, 0xEA, 0x04, 0x95, 0x91, 0x67, -+0x00, 0x18, 0x53, 0xCE, 0x15, 0x10, 0x04, 0x95, -+0x91, 0x67, 0x00, 0x18, 0x53, 0xCE, 0x30, 0xF0, -+0x20, 0x6A, 0x05, 0x96, 0x6E, 0xF2, 0x5C, 0x9A, -+0x90, 0x67, 0x01, 0x6D, 0x00, 0x6F, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF4, 0x6C, 0x9B, -+0x04, 0x96, 0x91, 0x67, 0xA2, 0x67, 0x40, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF2, 0x5C, 0x9A, -+0x40, 0xEA, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, 0x4C, 0x9A, -+0x00, 0x6B, 0x00, 0x6E, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF3, 0x74, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF3, 0x50, 0x9A, 0x04, 0xF7, -+0x10, 0x6F, 0x80, 0x6D, 0x60, 0xDA, 0x06, 0x02, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, -+0x54, 0x9A, 0x80, 0xF1, 0x07, 0x6C, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0xC8, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x49, 0xF2, 0x88, 0xA2, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF4, 0x48, 0x9A, 0x90, 0x34, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF4, 0x40, 0x9A, -+0x03, 0x6C, 0x01, 0x6D, 0x40, 0xEA, 0x09, 0x97, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x50, 0x9A, 0xFF, 0x68, 0x8C, 0xE8, 0x04, 0x6E, -+0x04, 0x04, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x04, 0x93, 0xF6, 0xF3, 0x58, 0x9A, 0x01, 0x6C, -+0x60, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, -+0x5C, 0x9A, 0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF4, -+0x60, 0x9B, 0x0D, 0xEA, 0x40, 0xDB, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x40, 0xEA, -+0x07, 0x97, 0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0xFF, 0x6A, 0x30, 0xF0, 0x20, 0x68, 0x8C, 0xEA, -+0x06, 0xD2, 0xFF, 0x6B, 0x4E, 0xF2, 0x50, 0x98, -+0x04, 0x01, 0xAC, 0xEB, 0x10, 0xD6, 0xA6, 0x67, -+0x07, 0xD3, 0x04, 0x6E, 0x91, 0x67, 0x40, 0xEA, -+0x06, 0x92, 0xFF, 0x6B, 0xB1, 0x67, 0x4C, 0x34, -+0x02, 0x4C, 0x6C, 0xEC, 0x00, 0x18, 0xCD, 0xCE, -+0x10, 0x95, 0x4E, 0xF2, 0x50, 0x98, 0x04, 0x6E, -+0x91, 0x67, 0x04, 0x4D, 0x40, 0xEA, 0x06, 0x92, -+0xFF, 0x6B, 0xB1, 0x67, 0x4C, 0x32, 0x82, 0x67, -+0x03, 0x4C, 0x6C, 0xEC, 0x08, 0xD2, 0x00, 0x18, -+0xCD, 0xCE, 0x10, 0x95, 0x4E, 0xF2, 0x50, 0x98, -+0x04, 0x6E, 0x91, 0x67, 0x08, 0x4D, 0x40, 0xEA, -+0x06, 0x92, 0xFF, 0x6B, 0xB1, 0x67, 0x4C, 0x34, -+0x04, 0x4C, 0x6C, 0xEC, 0x00, 0x18, 0xCD, 0xCE, -+0x10, 0x95, 0x4E, 0xF2, 0x50, 0x98, 0x91, 0x67, -+0x0C, 0x4D, 0x04, 0x6E, 0x40, 0xEA, 0x08, 0x94, -+0xFF, 0x6A, 0xB1, 0x67, 0x05, 0x4C, 0x4C, 0xEC, -+0x00, 0x18, 0xCD, 0xCE, 0x07, 0x93, 0x48, 0x6A, -+0x02, 0x73, 0x04, 0x60, 0x07, 0x92, 0x04, 0x72, -+0x05, 0x61, 0x50, 0x6A, 0x06, 0x93, 0x6D, 0xEA, -+0x7D, 0x67, 0x50, 0xC3, 0x80, 0x6A, 0x7D, 0x67, -+0x4B, 0xEA, 0x51, 0xC3, 0x06, 0x92, 0x01, 0x68, -+0x0B, 0xE8, 0x4C, 0x31, 0xFF, 0x6C, 0x12, 0xC3, -+0x13, 0xC3, 0x2C, 0xEC, 0x04, 0x05, 0x00, 0x18, -+0xCD, 0xCE, 0x7D, 0x67, 0xFF, 0x6A, 0x81, 0x41, -+0x10, 0xC3, 0x11, 0xC3, 0x12, 0xC3, 0x13, 0xC3, -+0x4C, 0xEC, 0x04, 0x05, 0x00, 0x18, 0xCD, 0xCE, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF4, 0x44, 0x9A, -+0x00, 0x6B, 0x60, 0xC2, 0x0D, 0x97, 0x0C, 0x91, -+0x0B, 0x90, 0x07, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0x6A, 0xEC, 0xEA, 0x04, 0x72, 0x0F, 0x61, -+0x40, 0xA4, 0x40, 0xC5, 0x41, 0xA4, 0x41, 0xC5, -+0x44, 0xA4, 0x42, 0xC5, 0x45, 0xA4, 0x43, 0xC5, -+0x46, 0xA4, 0x44, 0xC5, 0x47, 0xA4, 0x45, 0xC5, -+0x43, 0xA4, 0x40, 0xC6, 0x20, 0xE8, 0x02, 0x72, -+0x0E, 0x61, 0x42, 0xA4, 0x40, 0xC5, 0x40, 0xA4, -+0x41, 0xC5, 0x44, 0xA4, 0x42, 0xC5, 0x45, 0xA4, -+0x43, 0xC5, 0x46, 0xA4, 0x44, 0xC5, 0x47, 0xA4, -+0x45, 0xC5, 0x43, 0xA4, 0x40, 0xC6, 0x20, 0xE8, -+0xFF, 0x6A, 0xEC, 0xEA, 0x04, 0x6B, 0x4E, 0xEB, -+0x06, 0x2B, 0x40, 0xA5, 0x40, 0xC4, 0x41, 0xA5, -+0x62, 0xC4, 0x41, 0xC4, 0x0C, 0x10, 0x02, 0x72, -+0x0A, 0x61, 0x41, 0xA5, 0x40, 0xC4, 0x61, 0xA5, -+0x5F, 0x6A, 0x6C, 0xEA, 0x20, 0x6B, 0x6D, 0xEA, -+0x41, 0xC4, 0x40, 0xA5, 0x42, 0xC4, 0x63, 0x44, -+0xC0, 0xA3, 0x20, 0x6A, 0xCD, 0xEA, 0x40, 0xC3, -+0x42, 0xA5, 0x44, 0xC4, 0x43, 0xA5, 0x45, 0xC4, -+0x44, 0xA5, 0x46, 0xC4, 0x45, 0xA5, 0x47, 0xC4, -+0x20, 0xE8, 0x00, 0x65, 0xF5, 0x63, 0x15, 0x62, -+0x14, 0xD1, 0x13, 0xD0, 0xFF, 0xF7, 0x1F, 0x6A, -+0x24, 0x67, 0x4C, 0xE9, 0x6F, 0x41, 0x4C, 0xEB, -+0x02, 0x5B, 0x20, 0xF1, 0x1C, 0x60, 0x30, 0xF0, -+0x21, 0x6A, 0xD0, 0xF3, 0x1C, 0x4A, 0x10, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0x28, 0xF7, 0x4E, 0xA2, -+0x30, 0xF0, 0x20, 0x68, 0x10, 0x94, 0x11, 0xD2, -+0x11, 0x96, 0x4E, 0xF2, 0x50, 0x98, 0x30, 0xF0, -+0x20, 0x6D, 0x8F, 0xF5, 0x13, 0x4D, 0x40, 0xEA, -+0x01, 0x6B, 0x6E, 0xE9, 0x31, 0x29, 0x4E, 0xF2, -+0x50, 0x98, 0x30, 0xF0, 0x20, 0x6D, 0x07, 0x04, -+0xE8, 0xF6, 0x1D, 0x4D, 0x10, 0x6E, 0x40, 0xEA, -+0x4E, 0xF2, 0x50, 0x98, 0x30, 0xF0, 0x20, 0x6D, -+0x0B, 0x04, 0x88, 0xF6, 0x1C, 0x4D, 0x10, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF4, -+0x50, 0x9A, 0x11, 0x96, 0x00, 0x6C, 0xA4, 0x67, -+0x04, 0xD1, 0x20, 0x6F, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF4, 0x40, 0x9A, 0x10, 0x95, -+0x30, 0xF0, 0x21, 0x69, 0x11, 0x97, 0x10, 0xF4, -+0x1C, 0x49, 0x07, 0x04, 0xD1, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x21, 0x6C, 0x4E, 0xF2, 0x50, 0x98, -+0x50, 0xF4, 0x1C, 0x4C, 0xB1, 0x67, 0x29, 0x10, -+0x4E, 0xF2, 0x50, 0x98, 0x30, 0xF0, 0x20, 0x6D, -+0x07, 0x04, 0x88, 0xF6, 0x1C, 0x4D, 0x10, 0x6E, -+0x40, 0xEA, 0x00, 0x6A, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF4, 0x50, 0x9A, 0x11, 0x96, -+0x00, 0x6C, 0xA4, 0x67, 0x10, 0x6F, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF4, 0x50, 0x9A, -+0x10, 0x95, 0x30, 0xF0, 0x21, 0x69, 0x11, 0x97, -+0x10, 0xF4, 0x1C, 0x49, 0x07, 0x04, 0xD1, 0x67, -+0x40, 0xEA, 0x4E, 0xF2, 0x50, 0x98, 0x30, 0xF0, -+0x21, 0x6C, 0xA7, 0x41, 0x50, 0xF4, 0x1C, 0x4C, -+0x01, 0x4D, 0x28, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF5, -+0x68, 0xA2, 0xFE, 0x73, 0x14, 0x61, 0x08, 0xF5, -+0x4A, 0xA2, 0x30, 0x6B, 0x9D, 0x67, 0x6C, 0xEA, -+0x53, 0x32, 0x58, 0xC4, 0x30, 0xF0, 0x21, 0x6D, -+0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, 0x21, 0x6C, -+0x4E, 0xF2, 0x50, 0x9A, 0x90, 0xF4, 0x04, 0x4C, -+0x50, 0xF4, 0x1C, 0x4D, 0x17, 0x10, 0xFE, 0x4B, -+0xFF, 0x6A, 0x4C, 0xEB, 0x02, 0x5B, 0x15, 0x60, -+0x30, 0xF0, 0x21, 0x6D, 0x50, 0xF4, 0x1C, 0x4D, -+0x66, 0xA5, 0x03, 0x6A, 0x30, 0xF0, 0x21, 0x6C, -+0x6C, 0xEA, 0x7D, 0x67, 0x58, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, 0x90, 0xF4, -+0x04, 0x4C, 0x08, 0x4D, 0x20, 0x6E, 0x40, 0xEA, -+0x0D, 0x10, 0x05, 0x6B, 0x9D, 0x67, 0x78, 0xC4, -+0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF4, 0x88, 0x9B, -+0x10, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x30, 0xF0, 0x20, 0x6A, -+0xEF, 0xF5, 0x10, 0x4A, 0x30, 0xF0, 0x21, 0x6B, -+0xA7, 0x42, 0x90, 0xF4, 0x04, 0x4B, 0x19, 0x4D, -+0x01, 0x6C, 0xE0, 0xA2, 0xC0, 0xA3, 0x01, 0x4A, -+0x01, 0x4B, 0xEE, 0xEE, 0x01, 0x5E, 0xD8, 0x67, -+0xCB, 0xEE, 0xAA, 0xEA, 0xCC, 0xEC, 0xF5, 0x61, -+0x01, 0x74, 0x0C, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF4, 0x68, 0x9A, 0xFF, 0x6C, 0x08, 0x6D, -+0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x61, 0x10, 0x7D, 0x67, 0x58, 0xA3, -+0x04, 0x5A, 0x4F, 0x60, 0x30, 0xF0, 0x20, 0x68, -+0xCF, 0xF4, 0x00, 0x48, 0x40, 0xF1, 0x74, 0xA0, -+0x40, 0xF1, 0x50, 0xC0, 0x02, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x40, 0xF1, 0x54, 0xC0, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, 0x30, 0xF0, -+0x20, 0x6C, 0x30, 0xF0, 0x21, 0x6D, 0xEF, 0xF5, -+0x10, 0x4C, 0x90, 0xF4, 0x04, 0x4D, 0x20, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6C, 0x80, 0xF0, -+0x6C, 0x9A, 0x56, 0xF3, 0x8C, 0x9C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x40, 0xF1, 0x50, 0xA0, -+0x01, 0x72, 0x0B, 0x60, 0x05, 0x22, 0x02, 0x72, -+0x0D, 0x60, 0x03, 0x72, 0x10, 0x60, 0x2B, 0x10, -+0x30, 0xF0, 0x20, 0x6C, 0x2F, 0xF6, 0x00, 0x4C, -+0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6C, 0x2F, 0xF6, -+0x08, 0x4C, 0x09, 0x10, 0x30, 0xF0, 0x20, 0x6C, -+0x2F, 0xF6, 0x10, 0x4C, 0x04, 0x10, 0x30, 0xF0, -+0x20, 0x6C, 0x2F, 0xF6, 0x18, 0x4C, 0x40, 0xF1, -+0xF1, 0xA0, 0x30, 0xF0, 0x20, 0x6D, 0x08, 0xF7, -+0x0D, 0x4D, 0x06, 0x06, 0x00, 0x18, 0x30, 0xCF, -+0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, -+0x00, 0x4A, 0x05, 0x6B, 0x40, 0xF1, 0x94, 0xA2, -+0x40, 0xF1, 0x70, 0xC2, 0x02, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x40, 0xF1, 0x74, 0xC2, 0x15, 0x97, -+0x14, 0x91, 0x13, 0x90, 0x0B, 0x63, 0x00, 0xEF, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0xFF, 0x6A, 0x4C, 0xEE, 0x08, 0xD6, 0x08, 0x97, -+0x4C, 0xED, 0x05, 0x00, 0x09, 0xD5, 0x04, 0x06, -+0xB0, 0x67, 0x24, 0x67, 0x00, 0x18, 0x1E, 0xCF, -+0x09, 0x92, 0x10, 0x2A, 0x60, 0xA0, 0xFF, 0x6C, -+0x8E, 0xEB, 0x07, 0x2B, 0x01, 0x4A, 0x8C, 0xEA, -+0x06, 0x72, 0x60, 0xC0, 0x01, 0x48, 0xF6, 0x61, -+0x05, 0x10, 0x04, 0x03, 0x49, 0xE3, 0x64, 0xA2, -+0x01, 0x4B, 0x64, 0xC2, 0x08, 0x97, 0x91, 0x67, -+0x05, 0x05, 0x04, 0x06, 0x00, 0x18, 0x30, 0xCF, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x24, 0x67, 0xFF, 0x68, -+0xAC, 0xE8, 0x04, 0x04, 0xB1, 0x67, 0x03, 0x6E, -+0x40, 0xEA, 0x24, 0x28, 0x5D, 0x67, 0x70, 0xA2, -+0xFF, 0x6A, 0x4E, 0xEB, 0x00, 0x6A, 0x11, 0x2B, -+0x5D, 0x67, 0x70, 0xC2, 0x71, 0xA2, 0xFF, 0x6A, -+0x4E, 0xEB, 0x01, 0x6A, 0x0A, 0x2B, 0x5D, 0x67, -+0x71, 0xC2, 0x52, 0xA2, 0xFF, 0x6B, 0x6E, 0xEA, -+0x03, 0x2A, 0x7D, 0x67, 0x52, 0xC3, 0x06, 0x10, -+0x02, 0x6A, 0x04, 0x03, 0x49, 0xE3, 0x60, 0xA2, -+0x01, 0x4B, 0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x91, 0x67, 0x04, 0x05, -+0x03, 0x6E, 0x40, 0xEA, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF9, 0x63, 0x0D, 0x62, 0x0C, 0xD1, 0x0B, 0xD0, -+0x30, 0xF0, 0x20, 0x69, 0x4E, 0xF2, 0x4C, 0x99, -+0xFF, 0x68, 0xAC, 0xE8, 0x0E, 0xD4, 0x00, 0x6D, -+0x05, 0x04, 0x08, 0x6E, 0x40, 0xEA, 0x4E, 0xF2, -+0x4C, 0x99, 0x07, 0x04, 0x00, 0x6D, 0x08, 0x6E, -+0x40, 0xEA, 0x0E, 0x94, 0x05, 0x05, 0x00, 0xF0, -+0x11, 0x06, 0xF0, 0x67, 0x00, 0x18, 0x1E, 0xCF, -+0x30, 0xF0, 0x20, 0x6C, 0xCF, 0xF5, 0x13, 0x4C, -+0x07, 0x05, 0x04, 0x06, 0xF0, 0x67, 0x00, 0x18, -+0x1E, 0xCF, 0x00, 0x6B, 0x07, 0x6A, 0x9D, 0x67, -+0x75, 0xE4, 0x85, 0x67, 0x9B, 0xA4, 0x20, 0xF0, -+0xA3, 0xA5, 0xAE, 0xEC, 0x08, 0x2C, 0xFF, 0x4A, -+0x00, 0xF6, 0x40, 0x32, 0x00, 0xF6, 0x43, 0x32, -+0x81, 0x42, 0xFF, 0x4B, 0xF0, 0x2C, 0x04, 0x03, -+0x49, 0xE3, 0x6C, 0xA2, 0x44, 0xA2, 0x0D, 0x97, -+0x0C, 0x91, 0x4B, 0xE3, 0x01, 0x52, 0x0B, 0x90, -+0x58, 0x67, 0x01, 0x6B, 0x6E, 0xEA, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0x4E, 0xF2, 0x4C, 0x98, 0x04, 0x01, 0x0A, 0xD4, -+0x00, 0x6D, 0x91, 0x67, 0x08, 0x6E, 0x40, 0xEA, -+0x4E, 0xF2, 0x4C, 0x98, 0x05, 0x04, 0x00, 0x6D, -+0x08, 0x6E, 0x30, 0xF0, 0x20, 0x68, 0x40, 0xEA, -+0x4E, 0xF2, 0x50, 0x98, 0x30, 0xF0, 0x20, 0x6D, -+0x91, 0x67, 0xCF, 0xF5, 0x13, 0x4D, 0x03, 0x6E, -+0x40, 0xEA, 0x4E, 0xF2, 0x50, 0x98, 0x0A, 0x95, -+0x05, 0x04, 0x03, 0x6E, 0x40, 0xEA, 0x5D, 0x67, -+0x72, 0xA2, 0x56, 0xA2, 0x4E, 0xEB, 0x02, 0x6A, -+0x0D, 0x2B, 0x9D, 0x67, 0x55, 0xA4, 0x71, 0xA4, -+0x4E, 0xEB, 0x01, 0x6A, 0x07, 0x2B, 0x5D, 0x67, -+0x70, 0xA2, 0x54, 0xA2, 0x6E, 0xEA, 0xFF, 0x4A, -+0xC0, 0xF7, 0x43, 0x32, 0x04, 0x03, 0x49, 0xE3, -+0x60, 0xA2, 0x44, 0xA2, 0x09, 0x97, 0x08, 0x91, -+0x4B, 0xE3, 0x01, 0x52, 0x07, 0x90, 0x58, 0x67, -+0x01, 0x6B, 0x6E, 0xEA, 0x05, 0x63, 0x00, 0xEF, -+0xF5, 0x63, 0x15, 0x62, 0x14, 0xD1, 0x13, 0xD0, -+0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, 0x10, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0xFF, 0x69, 0x4E, 0xF2, -+0x4C, 0x9A, 0x2C, 0xED, 0x30, 0xF0, 0x21, 0x6C, -+0x11, 0xD5, 0xB0, 0xF4, 0x04, 0x4C, 0x00, 0x6D, -+0x80, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF3, 0x48, 0x9A, 0x60, 0xAA, 0xE1, 0xF7, -+0x1F, 0x6A, 0x6C, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x49, 0xF2, 0x06, 0xA3, 0x10, 0x93, 0x01, 0xE2, -+0x01, 0x73, 0x1C, 0x30, 0x12, 0x61, 0x30, 0xF0, -+0x21, 0x6B, 0x90, 0xF3, 0x5C, 0xA3, 0x0D, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF4, 0x94, 0x9A, -+0x91, 0xE0, 0x40, 0xA4, 0x2C, 0xEA, 0x08, 0x4A, -+0x2C, 0xEA, 0x40, 0xC4, 0x01, 0x6A, 0x90, 0xF3, -+0x5C, 0xC3, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, -+0x58, 0x9A, 0x41, 0x6B, 0x87, 0x40, 0x49, 0xE0, -+0x60, 0xC2, 0x11, 0x95, 0x29, 0x4C, 0x80, 0x18, -+0xE9, 0x0D, 0x30, 0xF0, 0x21, 0x6A, 0x01, 0x6B, -+0xB0, 0xF4, 0x64, 0xC2, 0xB0, 0xF4, 0x04, 0x4A, -+0x03, 0x6B, 0x61, 0xC2, 0x00, 0x6B, 0x62, 0xC2, -+0x5F, 0x6B, 0x63, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xC8, 0xF6, 0x50, 0xA2, 0x87, 0x40, 0x55, 0x4C, -+0xFE, 0x72, 0xFE, 0x6D, 0x01, 0x60, 0x02, 0x6D, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF4, 0x74, 0x9A, -+0x69, 0xE4, 0xA0, 0xC2, 0xA0, 0xA2, 0x30, 0xF0, -+0x21, 0x6A, 0xB0, 0xF4, 0x04, 0x4A, 0xA4, 0xC2, -+0x10, 0x95, 0x01, 0x4C, 0x01, 0x75, 0x0A, 0x61, -+0x6D, 0xE4, 0x03, 0x6D, 0xA0, 0xC3, 0x10, 0xF0, -+0x24, 0x6B, 0x16, 0xF4, 0xD8, 0x9B, 0x01, 0x6B, -+0xD9, 0xE4, 0x09, 0x10, 0x6D, 0xE4, 0x03, 0x6D, -+0xA0, 0xC3, 0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF4, -+0xD8, 0x9B, 0x02, 0x6B, 0xD9, 0xE4, 0x60, 0xC6, -+0x66, 0xC2, 0xA5, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF5, 0x68, 0xA2, -+0x02, 0x4C, 0xFE, 0x73, 0x33, 0x61, 0x10, 0xF0, -+0x24, 0x6B, 0x16, 0xF4, 0xDC, 0x9B, 0x30, 0xF0, -+0x20, 0x6D, 0xCF, 0xF4, 0x00, 0x4D, 0xD9, 0xE4, -+0x60, 0xA6, 0x40, 0xF1, 0x30, 0xA5, 0xFF, 0x6F, -+0xEC, 0xEB, 0x30, 0x31, 0x2D, 0xEB, 0xEC, 0xEB, -+0x60, 0xC6, 0x30, 0xF0, 0x21, 0x6B, 0xB0, 0xF4, -+0x04, 0x4B, 0x40, 0xF1, 0xB0, 0xA5, 0xC6, 0xA3, -+0xB0, 0x35, 0xCD, 0xED, 0xA6, 0xC3, 0x10, 0xF0, -+0x24, 0x6D, 0x16, 0xF4, 0xB4, 0x9D, 0x08, 0xF5, -+0xCB, 0xA2, 0xB5, 0xE4, 0xC0, 0xC5, 0x10, 0xF0, -+0x24, 0x6D, 0x16, 0xF4, 0xB8, 0x9D, 0xB1, 0xE4, -+0x08, 0xF5, 0xAC, 0xA2, 0xA0, 0xC4, 0x08, 0xF5, -+0x8B, 0xA2, 0x08, 0xF5, 0x4C, 0xA2, 0x87, 0xC3, -+0x48, 0xC3, 0x13, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF4, 0x54, 0x9A, 0x00, 0x6B, 0x49, 0xE4, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF4, -+0x58, 0x9A, 0x51, 0xE4, 0x30, 0xF0, 0x21, 0x6A, -+0xB0, 0xF4, 0x04, 0x4A, 0x60, 0xC4, 0x67, 0xC2, -+0x68, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF4, -+0x90, 0x9B, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF6, -+0x15, 0x4A, 0x30, 0xF0, 0x21, 0x6B, 0xA7, 0x42, -+0x91, 0xE0, 0xB0, 0xF4, 0x0D, 0x4B, 0x01, 0x4D, -+0xC0, 0xA2, 0xC0, 0xC4, 0xC0, 0xA2, 0x01, 0x4A, -+0xAA, 0xEA, 0xC0, 0xC3, 0x01, 0x4C, 0x01, 0x4B, -+0xF7, 0x61, 0x00, 0x6A, 0x7D, 0x67, 0x51, 0xE3, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x4D, 0xE3, 0xC8, 0xF4, 0x64, 0xA3, 0x01, 0x4A, -+0x10, 0x72, 0x78, 0xC4, 0xF3, 0x61, 0x00, 0x69, -+0x10, 0xF0, 0x24, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0x16, 0xF4, 0x4C, 0x9A, 0x36, 0xF4, 0x60, 0x9B, -+0x49, 0xE0, 0x6D, 0xE0, 0x00, 0x6C, 0x80, 0xC2, -+0x01, 0x4A, 0x6A, 0xEA, 0xFB, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x64, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, -+0x64, 0x9A, 0xFB, 0x6A, 0x10, 0x6F, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF3, 0x48, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, -+0xC0, 0xAA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x69, 0xF0, 0xBF, 0xA2, 0x69, 0xF0, -+0x9E, 0xA2, 0xE1, 0xF7, 0x1F, 0x6A, 0xCC, 0xEA, -+0xA9, 0xE2, 0x50, 0x32, 0x6C, 0xEA, 0xB3, 0xE4, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x9C, 0x34, -+0x8E, 0xF4, 0x50, 0x9A, 0x58, 0x4C, 0x00, 0x6D, -+0x6C, 0xEC, 0x63, 0x6E, 0x40, 0xEA, 0x10, 0x95, -+0x01, 0x75, 0x05, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF4, 0x5C, 0x9A, 0x04, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF4, 0x58, 0x9A, 0x30, 0xF0, -+0x21, 0x6D, 0x06, 0x04, 0xB0, 0xF4, 0x04, 0x4D, -+0x0A, 0x06, 0x10, 0x6F, 0x40, 0xEA, 0x01, 0x49, -+0xFF, 0x6A, 0x4C, 0xE9, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF4, 0x44, 0x9A, 0x60, 0xA2, 0x04, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x0A, 0x71, 0xA0, 0x61, -+0x02, 0x10, 0x0A, 0x59, 0x0B, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF4, 0x68, 0x9A, 0xFF, 0x6C, -+0x20, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6B, -+0x16, 0xF4, 0x6C, 0x9B, 0x0A, 0x02, 0x61, 0xE0, -+0x0E, 0x03, 0x80, 0xA2, 0x01, 0x4A, 0x6A, 0xEA, -+0x80, 0xC0, 0x01, 0x48, 0xFA, 0x61, 0x10, 0x92, -+0x01, 0x72, 0x07, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0x49, 0xF2, 0x86, 0xA2, 0x20, 0x6D, 0x80, 0x18, -+0xF4, 0x09, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, -+0x54, 0x9A, 0x02, 0xF0, 0x00, 0x6B, 0x40, 0x9A, -+0x6C, 0xEA, 0x29, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF3, 0x48, 0x9A, 0xFF, 0x69, 0x30, 0xF0, -+0x20, 0x68, 0x40, 0xA2, 0x00, 0x6C, 0xFF, 0x6D, -+0x4C, 0xE9, 0x6E, 0xF2, 0x58, 0x98, 0x1D, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, -+0x40, 0x9A, 0x40, 0xEA, 0x01, 0x72, 0x1F, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x49, 0xF2, 0x86, 0xA3, 0x6E, 0xF2, 0x5C, 0x9A, -+0x01, 0x6D, 0x18, 0x6E, 0x00, 0x6F, 0x40, 0xEA, -+0x6E, 0xF2, 0x58, 0x98, 0x00, 0x6C, 0xB1, 0x67, -+0x1E, 0x6E, 0x40, 0xEA, 0x0C, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, -+0x5C, 0x9A, 0x49, 0xF2, 0x86, 0xA3, 0x01, 0x6D, -+0x18, 0x6E, 0x00, 0x6F, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, 0x03, 0x2A, -+0x01, 0x6C, 0x00, 0x18, 0x02, 0xC9, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF2, 0x5C, 0x9A, 0x40, 0xEA, -+0x15, 0x97, 0x14, 0x91, 0x13, 0x90, 0x0B, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0xF7, 0x1F, 0x69, -+0x8C, 0xE9, 0xFF, 0x68, 0xAC, 0xE8, 0x00, 0x18, -+0xB1, 0xCE, 0x91, 0x67, 0x00, 0x18, 0x43, 0xCF, -+0x91, 0x67, 0xB0, 0x67, 0x00, 0x18, 0x64, 0xD0, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF4, 0x64, 0x9A, 0xFF, 0x6E, 0x19, 0x6F, -+0x40, 0xA3, 0xEB, 0xEF, 0x08, 0x4C, 0xCC, 0xEA, -+0xEC, 0xEA, 0x08, 0x6F, 0xED, 0xEA, 0xCC, 0xEA, -+0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x4C, 0x9A, 0xA5, 0xE4, 0x30, 0xF0, 0x20, 0x6C, -+0x00, 0x6D, 0x84, 0x6E, 0x30, 0xF0, 0x20, 0x68, -+0xC8, 0xF6, 0x0C, 0x4C, 0x40, 0xEA, 0xCE, 0xF4, -+0x4C, 0x98, 0x81, 0x41, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x08, 0xF5, -+0x45, 0xC3, 0xCE, 0xF4, 0x4C, 0x98, 0x04, 0xD3, -+0x84, 0x41, 0x40, 0xEA, 0x04, 0x93, 0x85, 0x41, -+0x08, 0xF5, 0x48, 0xC3, 0xCE, 0xF4, 0x4C, 0x98, -+0x40, 0xEA, 0x04, 0x93, 0x86, 0x41, 0x08, 0xF5, -+0x49, 0xC3, 0xCE, 0xF4, 0x4C, 0x98, 0x40, 0xEA, -+0x04, 0x93, 0x87, 0x41, 0x08, 0xF5, 0x4A, 0xC3, -+0xCE, 0xF4, 0x4C, 0x98, 0x40, 0xEA, 0x04, 0x93, -+0x87, 0x41, 0x01, 0x4C, 0x08, 0xF5, 0x4B, 0xC3, -+0xCE, 0xF4, 0x4C, 0x98, 0x30, 0xF0, 0x20, 0x68, -+0xC8, 0xF6, 0x15, 0x48, 0x40, 0xEA, 0x04, 0x93, -+0x08, 0xF5, 0x4C, 0xC3, 0x47, 0x41, 0x30, 0xF0, -+0x20, 0x6B, 0x02, 0x4A, 0xC8, 0xF6, 0x1D, 0x4B, -+0x05, 0xD2, 0x04, 0xD3, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x4C, 0x9A, 0x05, 0x94, 0x40, 0xEA, -+0x40, 0xC0, 0x04, 0x93, 0x05, 0x92, 0x01, 0x48, -+0x6A, 0xE8, 0x01, 0x4A, 0x05, 0xD2, 0xF2, 0x61, -+0x47, 0x41, 0x2A, 0x4A, 0x30, 0xF0, 0x20, 0x68, -+0x04, 0xD2, 0xE8, 0xF6, 0x1D, 0x48, 0x30, 0xF0, -+0x20, 0x6B, 0xCE, 0xF4, 0x4C, 0x9B, 0x04, 0x94, -+0x40, 0xEA, 0x40, 0xC0, 0x04, 0x92, 0x30, 0xF0, -+0x20, 0x6B, 0x01, 0x48, 0x08, 0xF7, 0x0D, 0x4B, -+0x01, 0x4A, 0x6A, 0xE8, 0x04, 0xD2, 0xEF, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x4C, 0x9B, -+0x87, 0x41, 0x5A, 0x4C, 0x30, 0xF0, 0x20, 0x68, -+0x40, 0xEA, 0xC0, 0xF1, 0x08, 0x48, 0x30, 0xF0, -+0x20, 0x6B, 0x68, 0xF5, 0x45, 0xC0, 0xCE, 0xF4, -+0x4C, 0x9B, 0x87, 0x41, 0x5B, 0x4C, 0x40, 0xEA, -+0x68, 0xF5, 0x46, 0xC0, 0x68, 0xF5, 0x45, 0xA0, -+0x40, 0x32, 0x04, 0xD2, 0x04, 0x93, 0x68, 0xF5, -+0x46, 0xA0, 0x00, 0x68, 0x4D, 0xEB, 0x04, 0xD3, -+0x12, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x87, 0x41, -+0xCE, 0xF4, 0x4C, 0x9A, 0x5C, 0x4C, 0x11, 0xE4, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF4, -+0x00, 0x4B, 0x6D, 0xE0, 0xC0, 0xF0, 0x53, 0xC3, -+0x01, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0x04, 0x92, -+0x43, 0xE8, 0xEB, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF5, 0x69, 0xA2, -+0x08, 0xF5, 0x8A, 0xA2, 0x60, 0x33, 0x8D, 0xEB, -+0x08, 0x6C, 0x6C, 0xEC, 0x0A, 0x24, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, 0x03, 0x6B, -+0x01, 0x6C, 0x60, 0xC2, 0x80, 0x18, 0xA9, 0x0B, -+0x1E, 0x10, 0x07, 0x6C, 0x6C, 0xEC, 0xAF, 0x44, -+0xFF, 0xF7, 0x1F, 0x6E, 0xCC, 0xED, 0x02, 0x5D, -+0x16, 0x60, 0x30, 0x6D, 0x6C, 0xED, 0xB3, 0x35, -+0x88, 0xF5, 0xBE, 0xC2, 0x00, 0x6D, 0x00, 0x18, -+0x4B, 0xD1, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, -+0x64, 0x9A, 0xFF, 0x6C, 0x19, 0x6D, 0x40, 0xA3, -+0xAB, 0xED, 0x8C, 0xEA, 0xAC, 0xEA, 0x10, 0x6D, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x00, 0x6A, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, -+0x3E, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, -+0x08, 0x4A, 0x40, 0x9A, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0xA0, 0xAA, 0x69, 0xF0, -+0x5F, 0xA0, 0xE1, 0xF7, 0x1F, 0x6B, 0x6C, 0xED, -+0x55, 0xE5, 0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF4, -+0x54, 0x9A, 0xBC, 0x35, 0x30, 0xF0, 0x20, 0x6C, -+0x40, 0x6E, 0x88, 0xF6, 0x0C, 0x4C, 0x55, 0xE5, -+0x30, 0xF0, 0x20, 0x69, 0x00, 0x18, 0x74, 0xD6, -+0x6E, 0xF4, 0x40, 0x99, 0x00, 0x6D, 0x03, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, -+0x08, 0x4A, 0x40, 0x9A, 0xE1, 0xF7, 0x1F, 0x6B, -+0x80, 0xAA, 0x89, 0xF0, 0x40, 0xA0, 0x6C, 0xEC, -+0x51, 0xE4, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF4, -+0x48, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, 0x90, 0x34, -+0x6C, 0xEC, 0x40, 0xEA, 0x6E, 0xF4, 0x40, 0x99, -+0x03, 0x6C, 0x01, 0x6D, 0x40, 0xEA, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0xA4, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0x49, 0xF2, 0x18, 0x4C, 0x07, 0x6E, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xE8, 0xF3, 0x93, 0xA2, 0x11, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xE8, 0xF3, 0x73, 0xC2, 0x00, 0x6B, -+0x28, 0xF6, 0x6C, 0xC2, 0x28, 0xF6, 0x6D, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF3, 0x48, 0x9A, 0xFF, 0x6D, 0x60, 0xAA, -+0xE1, 0xF7, 0x1F, 0x6A, 0x6C, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x89, 0xF0, -+0x91, 0xA3, 0x89, 0xE2, 0x10, 0xF0, 0x24, 0x6C, -+0x16, 0xF4, 0x94, 0x9C, 0x5C, 0x32, 0xC4, 0x42, -+0x91, 0xE2, 0x80, 0xA4, 0x28, 0xF6, 0x8C, 0xC3, -+0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF4, 0x98, 0x9C, -+0x91, 0xE2, 0x80, 0xA4, 0x28, 0xF6, 0x8D, 0xC3, -+0x28, 0xF6, 0x6C, 0xA3, 0x0A, 0x2B, 0x10, 0xF0, -+0x24, 0x6B, 0xF6, 0xF4, 0x9C, 0x9B, 0x01, 0x6F, -+0x60, 0xA4, 0xAC, 0xEB, 0xED, 0xEB, 0xAC, 0xEB, -+0x60, 0xC4, 0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF4, -+0x74, 0x9B, 0x30, 0xF0, 0x20, 0x6C, 0x6D, 0xE6, -+0x60, 0x9B, 0xE8, 0xF7, 0x78, 0xDC, 0x10, 0xF0, -+0x24, 0x6C, 0x16, 0xF5, 0x80, 0x9C, 0x8E, 0xEB, -+0x0B, 0x23, 0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF4, -+0x9C, 0x9B, 0xFF, 0x6D, 0x02, 0x6E, 0x60, 0xA4, -+0xAC, 0xEB, 0xCD, 0xEB, 0xAC, 0xEB, 0x60, 0xC4, -+0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF4, 0x98, 0x9B, -+0x30, 0xF0, 0x20, 0x6B, 0x09, 0xF0, 0x04, 0x4B, -+0xA7, 0x43, 0x91, 0xE2, 0x09, 0x4D, 0xC0, 0xA4, -+0x01, 0x4C, 0xC0, 0xC3, 0x01, 0x4B, 0xAA, 0xEB, -+0xFA, 0x61, 0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF4, -+0x98, 0x9B, 0x30, 0xF0, 0x20, 0x6B, 0x09, 0xF0, -+0x14, 0x4B, 0xA7, 0x43, 0x91, 0xE2, 0x09, 0x4D, -+0xC0, 0xA4, 0x01, 0x4C, 0xC0, 0xC3, 0x01, 0x4B, -+0xAA, 0xEB, 0xFA, 0x61, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF4, 0x84, 0x9B, 0x30, 0xF0, 0x20, 0x6B, -+0x29, 0xF0, 0x14, 0x4B, 0xA7, 0x43, 0x91, 0xE2, -+0x01, 0x4D, 0xC0, 0xA4, 0x01, 0x4C, 0xC0, 0xC3, -+0x01, 0x4B, 0xAA, 0xEB, 0xFA, 0x61, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF4, 0x60, 0x9B, 0x00, 0x6C, -+0x69, 0xE2, 0x0A, 0x10, 0xE0, 0xA5, 0x01, 0x4D, -+0xCA, 0xED, 0xE0, 0xC3, 0x01, 0x4B, 0xFA, 0x61, -+0x01, 0x4C, 0x10, 0x74, 0x20, 0x4A, 0x0C, 0x60, -+0x30, 0xF0, 0x20, 0x6B, 0x94, 0x35, 0xC0, 0xF1, -+0x08, 0x4B, 0xAD, 0xE3, 0xC7, 0x42, 0x68, 0xF6, -+0x14, 0x4B, 0x19, 0x4E, 0xA2, 0x67, 0xEA, 0x17, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x0E, 0x24, 0x10, 0xF0, -+0x24, 0x6B, 0x36, 0xF4, 0x84, 0x9B, 0x80, 0x6D, -+0xAB, 0xED, 0x60, 0xA4, 0x4C, 0xEB, 0xAD, 0xEB, -+0x4C, 0xEB, 0x60, 0xC4, 0x00, 0x18, 0x07, 0xD2, -+0x1E, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x4F, 0xF7, -+0xD4, 0xA3, 0x0C, 0x6C, 0x00, 0x6D, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x99, 0xA2, 0x21, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x02, 0x6C, 0x8B, 0xEC, 0x8C, 0xEB, -+0x68, 0xF3, 0x79, 0xC2, 0xEB, 0xF6, 0x74, 0xA2, -+0x6C, 0xEC, 0xEB, 0xF6, 0x94, 0xC2, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xF5, 0x63, 0x15, 0x62, -+0x14, 0xD1, 0x13, 0xD0, 0xFF, 0xF7, 0x1F, 0x6B, -+0x6C, 0xED, 0x30, 0xF0, 0x20, 0x6A, 0xE5, 0x67, -+0x4E, 0xF3, 0x58, 0x9A, 0x0F, 0xD5, 0xDC, 0x4F, -+0x00, 0x6D, 0x16, 0xD4, 0xC5, 0x67, 0x24, 0x4C, -+0x6C, 0xEF, 0x40, 0xEA, 0x02, 0x67, 0x81, 0x42, -+0x00, 0x6A, 0x0E, 0xD2, 0x19, 0x24, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, 0x02, 0x48, -+0x00, 0x69, 0x40, 0xEA, 0x0E, 0xD2, 0x0B, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, -+0x90, 0x67, 0x01, 0x48, 0x40, 0xEA, 0x9D, 0x67, -+0x2D, 0xE4, 0x50, 0xC3, 0x01, 0x49, 0x0E, 0x93, -+0xFF, 0x6A, 0x2C, 0xEA, 0x63, 0xEA, 0xF0, 0x61, -+0x0F, 0x91, 0x16, 0x94, 0x30, 0xF0, 0x20, 0x6B, -+0xFF, 0xF7, 0x1F, 0x6A, 0xDC, 0x49, 0x4C, 0xE9, -+0x4E, 0xF3, 0x58, 0x9B, 0x24, 0x4C, 0x0D, 0xD4, -+0x00, 0x6D, 0x03, 0x6E, 0xF1, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x4C, 0x9C, -+0x16, 0x94, 0x00, 0x68, 0x22, 0x4C, 0x40, 0xEA, -+0x10, 0x6B, 0x4C, 0xEB, 0x66, 0x23, 0x30, 0xF0, -+0x20, 0x6B, 0x4E, 0xF3, 0x58, 0x9B, 0x0D, 0x94, -+0xB0, 0x67, 0xF1, 0x67, 0x30, 0x6E, 0x40, 0xEA, -+0x22, 0x67, 0x01, 0x4A, 0x01, 0x68, 0x24, 0x22, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x4C, 0x9C, -+0x87, 0x41, 0x01, 0x4C, 0x40, 0xEA, 0x0D, 0x49, -+0x0D, 0xD1, 0x10, 0xD2, 0x00, 0x69, 0x15, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, -+0x0D, 0x94, 0x40, 0xEA, 0x02, 0x72, 0x02, 0x61, -+0x20, 0x48, 0x03, 0x10, 0x04, 0x72, 0x03, 0x61, -+0x40, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0xFF, 0x6A, -+0x01, 0x49, 0x4C, 0xE9, 0x0D, 0x92, 0x04, 0x4A, -+0x0D, 0xD2, 0x10, 0x93, 0x63, 0xE9, 0xE8, 0x61, -+0x0F, 0x93, 0x16, 0x94, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF3, 0x58, 0x9A, 0xDC, 0x4B, 0xFF, 0xF7, -+0x1F, 0x6F, 0x24, 0x4C, 0x01, 0x6D, 0xDD, 0x6E, -+0x6C, 0xEF, 0x40, 0xEA, 0x22, 0x67, 0x01, 0x4A, -+0x24, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x4C, 0x9A, 0x87, 0x41, 0x05, 0x4C, 0x40, 0xEA, -+0x11, 0x49, 0x0C, 0xD1, 0x0D, 0xD2, 0x00, 0x69, -+0x15, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x4C, 0x9A, 0x0C, 0x94, 0x40, 0xEA, 0x02, 0x72, -+0x02, 0x61, 0x02, 0x48, 0x03, 0x10, 0x04, 0x72, -+0x03, 0x61, 0x04, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, -+0x0C, 0x94, 0x01, 0x49, 0xFF, 0x6A, 0x04, 0x4C, -+0x4C, 0xE9, 0x0C, 0xD4, 0x0D, 0x92, 0x43, 0xE9, -+0xE8, 0x61, 0x00, 0x6B, 0x0C, 0xD3, 0x30, 0x67, -+0x72, 0x10, 0x0C, 0x94, 0x49, 0xE4, 0x28, 0xF6, -+0x7C, 0xA2, 0x0E, 0x94, 0x8E, 0xEB, 0x66, 0x2B, -+0x48, 0xF6, 0x4C, 0xA2, 0x01, 0x2A, 0x0A, 0x21, -+0x0C, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x49, 0xE3, 0x48, 0xF6, 0x4C, 0xA2, -+0x2C, 0xEA, 0x58, 0x22, 0x0C, 0x93, 0x04, 0x02, -+0x74, 0x34, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x8D, 0xE3, 0x0E, 0x94, 0x68, 0xF6, -+0x14, 0x4B, 0x95, 0xE2, 0x01, 0x6C, 0x09, 0x10, -+0xE0, 0xA2, 0xC0, 0xA3, 0x01, 0x4A, 0x01, 0x4B, -+0xEE, 0xEE, 0x01, 0x5E, 0xD8, 0x67, 0xCB, 0xEE, -+0xCC, 0xEC, 0xAA, 0xEA, 0xF5, 0x61, 0x01, 0x74, -+0x3D, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, -+0x00, 0x4A, 0x0D, 0xD2, 0x0D, 0x93, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x80, 0xF2, -+0xD4, 0xA3, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x00, 0x6D, 0x0C, 0x6C, 0x40, 0xEA, -+0x68, 0xF3, 0x79, 0xA0, 0x21, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x02, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, -+0x68, 0xF3, 0x59, 0xC0, 0xEB, 0xF6, 0x54, 0xA0, -+0x4C, 0xEB, 0xEB, 0xF6, 0x74, 0xC0, 0x0D, 0x92, -+0x80, 0xF2, 0x94, 0xA2, 0x00, 0x18, 0x2A, 0xE9, -+0x0D, 0x93, 0x80, 0xF2, 0x94, 0xA3, 0x00, 0x18, -+0x19, 0xE9, 0x0D, 0x92, 0x80, 0xF2, 0x94, 0xA2, -+0x00, 0x18, 0x31, 0xE9, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF4, 0x4C, 0x9A, 0x55, 0x6B, 0x60, 0xC2, -+0x08, 0xF4, 0x61, 0xA0, 0x01, 0x6A, 0x6D, 0xEA, -+0x08, 0xF4, 0x41, 0xC0, 0x0C, 0x93, 0xFF, 0x6A, -+0x01, 0x4B, 0x4C, 0xEB, 0x0C, 0xD3, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x28, 0xF6, -+0x6C, 0xA2, 0x0C, 0x94, 0x63, 0xEC, 0x85, 0x61, -+0x15, 0x97, 0x14, 0x91, 0x13, 0x90, 0x0B, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xE8, 0xF3, 0x93, 0xA2, 0x41, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xE8, 0xF3, 0x73, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, -+0x20, 0x6C, 0x88, 0xF7, 0x1C, 0x4C, 0x00, 0x6D, -+0x56, 0x6E, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xA8, 0xF5, 0x7B, 0xA2, 0x40, 0x6A, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0x0B, 0xD3, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF3, 0x48, 0x9A, 0xE1, 0xF7, 0x1F, 0x6B, -+0x40, 0xAA, 0x4C, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x89, 0xF0, 0x85, 0xA2, -+0x8D, 0xE3, 0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF4, -+0x94, 0x9C, 0x7C, 0x33, 0x91, 0xE3, 0x80, 0xAC, -+0xC8, 0xF5, 0x94, 0xCA, 0x10, 0xF0, 0x24, 0x6C, -+0x16, 0xF5, 0x84, 0x9C, 0x91, 0xE3, 0x80, 0xAC, -+0xC8, 0xF5, 0x96, 0xCA, 0x10, 0xF0, 0x24, 0x6C, -+0x36, 0xF4, 0x94, 0x9C, 0x91, 0xE3, 0x80, 0xAC, -+0xC8, 0xF5, 0x98, 0xCA, 0x10, 0xF0, 0x24, 0x6C, -+0x16, 0xF5, 0x88, 0x9C, 0x91, 0xE3, 0x80, 0xAC, -+0xC8, 0xF5, 0x9A, 0xCA, 0x10, 0xF0, 0x24, 0x6C, -+0xB6, 0xF4, 0x9C, 0x9C, 0x91, 0xE3, 0x80, 0xAC, -+0xC8, 0xF5, 0x9C, 0xCA, 0xE8, 0xF3, 0x95, 0xA2, -+0x80, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, 0xFF, 0x6C, -+0x8C, 0xEA, 0x0A, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF5, 0x4C, 0x9A, 0x4D, 0xE3, 0x60, 0x9B, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF5, 0x7C, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0xA8, 0xF7, 0x42, 0xAA, 0x08, 0xD4, 0x00, 0x68, -+0x11, 0x2A, 0x28, 0x10, 0x08, 0x94, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, 0x1C, 0x4C, -+0x11, 0xE4, 0x25, 0xE0, 0x40, 0xEA, 0xE8, 0xF5, -+0x68, 0xA1, 0x6E, 0xEA, 0x1B, 0x2A, 0x01, 0x48, -+0xFF, 0x6A, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x69, -+0xC0, 0xF1, 0x08, 0x49, 0xC8, 0xF5, 0x5A, 0xA9, -+0x43, 0xE8, 0xE8, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF5, 0x70, 0x9A, 0xFF, 0x6C, 0x40, 0x6D, -+0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x00, 0x6A, 0xE8, 0xF5, 0x46, 0xC9, -+0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xC8, 0xF5, 0x7E, 0xAA, 0x01, 0x4B, 0xC8, 0xF5, -+0x7E, 0xCA, 0x10, 0xF0, 0x24, 0x6B, 0xC8, 0xF5, -+0xBE, 0xAA, 0x36, 0xF4, 0x74, 0x9B, 0xA2, 0x35, -+0x6D, 0xE4, 0xA0, 0xC3, 0x10, 0xF0, 0x24, 0x6B, -+0x36, 0xF4, 0x78, 0x9B, 0xC8, 0xF5, 0x5E, 0xA2, -+0x71, 0xE4, 0x40, 0xC4, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0x27, 0x44, 0x09, 0x49, -+0xA8, 0xF7, 0x08, 0x48, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x4C, 0x9A, 0x91, 0x67, 0x40, 0xEA, -+0x60, 0xA0, 0x6E, 0xEA, 0x02, 0x22, 0x00, 0x6A, -+0x09, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x01, 0x48, -+0xA8, 0xF7, 0x0C, 0x4A, 0x4A, 0xE8, 0x01, 0x49, -+0xED, 0x61, 0x01, 0x6A, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, 0x4C, 0x98, -+0x24, 0x67, 0x07, 0x4C, 0x10, 0x4C, 0x40, 0xEA, -+0x04, 0xD2, 0xCE, 0xF4, 0x4C, 0x98, 0x87, 0x41, -+0x0F, 0x4C, 0x40, 0xEA, 0x04, 0x94, 0x09, 0x97, -+0x08, 0x91, 0x80, 0x33, 0x4D, 0xEB, 0x30, 0xF0, -+0x20, 0x6A, 0xA8, 0xF7, 0x4C, 0xAA, 0x07, 0x90, -+0x4E, 0xEB, 0x01, 0x5B, 0x58, 0x67, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, -+0x32, 0x6B, 0x01, 0x6C, 0x60, 0xC2, 0x80, 0x18, -+0xA9, 0x0B, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x00, 0x68, 0x08, 0xD4, 0x12, 0x10, 0x08, 0x94, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, -+0x1C, 0x4C, 0x11, 0xE4, 0x25, 0xE0, 0x40, 0xEA, -+0x08, 0xF6, 0x68, 0xA1, 0x6E, 0xEA, 0x02, 0x22, -+0x00, 0x6A, 0x21, 0x10, 0x01, 0x48, 0xFF, 0x6A, -+0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x69, 0xC0, 0xF1, -+0x08, 0x49, 0xC8, 0xF5, 0x5C, 0xA9, 0x43, 0xE8, -+0xE6, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF5, -+0x70, 0x9A, 0xFF, 0x6C, 0x80, 0x6D, 0x40, 0xA3, -+0xAB, 0xED, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, -+0x4C, 0x9A, 0x30, 0x6B, 0x01, 0x6C, 0x60, 0xC2, -+0x80, 0x18, 0xA9, 0x0B, 0x01, 0x6A, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF3, 0x08, 0x4B, -+0x60, 0x9B, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x40, 0xAB, 0xE1, 0xF7, 0x1F, 0x6B, -+0xFF, 0x69, 0x6C, 0xEA, 0x89, 0xF0, 0x66, 0xA0, -+0x69, 0xE2, 0x5C, 0x32, 0x04, 0xD2, 0x10, 0xF0, -+0x24, 0x6A, 0x04, 0x93, 0x56, 0xF4, 0x4C, 0x9A, -+0x49, 0xE3, 0x80, 0xA2, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x58, 0x9A, 0x2C, 0xEC, 0x49, 0xE3, -+0xA0, 0xA2, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF4, -+0x50, 0x9A, 0x2C, 0xED, 0x49, 0xE3, 0xC0, 0xA2, -+0x2C, 0xEE, 0x80, 0x18, 0x62, 0x09, 0x04, 0x93, -+0x10, 0xF0, 0x24, 0x6C, 0x36, 0xF4, 0x98, 0x9C, -+0x38, 0x4B, 0x49, 0xE3, 0x10, 0xF0, 0x24, 0x6B, -+0x36, 0xF4, 0x74, 0x9B, 0x91, 0xE2, 0x6D, 0xE2, -+0x60, 0xA3, 0x80, 0xA4, 0x2C, 0xEB, 0x60, 0x33, -+0x8C, 0xE9, 0x65, 0xE1, 0x10, 0xF0, 0x24, 0x6B, -+0x16, 0xF5, 0x6C, 0x9B, 0xC8, 0xF5, 0x3E, 0xC8, -+0x6D, 0xE2, 0x60, 0xA3, 0xE8, 0xF5, 0x60, 0xC0, -+0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF5, 0x74, 0x9B, -+0x6D, 0xE2, 0x60, 0xA3, 0xE8, 0xF5, 0x61, 0xC0, -+0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF5, 0x78, 0x9B, -+0x6D, 0xE2, 0x60, 0xA3, 0xE8, 0xF5, 0x62, 0xC0, -+0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF5, 0x7C, 0x9B, -+0x6D, 0xE2, 0x60, 0xA3, 0xE8, 0xF5, 0x63, 0xC0, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF3, 0x7C, 0x9B, -+0x69, 0xE2, 0x40, 0xAA, 0xE1, 0xF7, 0x1F, 0x6B, -+0xE8, 0xF5, 0x44, 0xC8, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF3, 0x08, 0x4A, 0x40, 0x9A, 0x80, 0xAA, -+0x89, 0xF0, 0x47, 0xA0, 0x6C, 0xEC, 0xC8, 0xF5, -+0x7A, 0xA8, 0x51, 0xE4, 0x9C, 0x34, 0x00, 0x6A, -+0x12, 0x2B, 0x13, 0x10, 0x10, 0xF0, 0x24, 0x6D, -+0x16, 0xF4, 0xB4, 0x9D, 0xB5, 0xE4, 0x55, 0xE5, -+0xC0, 0xA5, 0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, -+0x08, 0x4D, 0xB5, 0xE2, 0xE8, 0xF5, 0xC8, 0xC5, -+0x01, 0x4A, 0xFF, 0x6D, 0xAC, 0xEA, 0x63, 0xEA, -+0xED, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, -+0x48, 0x9A, 0xE1, 0xF7, 0x1F, 0x6B, 0x40, 0xAA, -+0x4C, 0xEB, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x89, 0xF0, 0x88, 0xA2, 0x91, 0xE3, -+0x9C, 0x34, 0xC8, 0xF5, 0x7C, 0xAA, 0x00, 0x6A, -+0x11, 0x10, 0x10, 0xF0, 0x24, 0x6D, 0x16, 0xF4, -+0xB4, 0x9D, 0xB5, 0xE4, 0x55, 0xE5, 0xC0, 0xA5, -+0x30, 0xF0, 0x20, 0x6D, 0xC0, 0xF1, 0x08, 0x4D, -+0xB5, 0xE2, 0x08, 0xF6, 0xC8, 0xC5, 0x01, 0x4A, -+0xFF, 0x6D, 0xAC, 0xEA, 0x63, 0xEA, 0xED, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xA8, 0xF7, 0x64, 0xAA, -+0x00, 0x6A, 0x03, 0x10, 0x01, 0x4A, 0xFF, 0x6C, -+0x8C, 0xEA, 0x63, 0xEA, 0xFB, 0x61, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD0, 0xFF, 0x68, -+0x0C, 0xEC, 0x20, 0x24, 0x00, 0x18, 0x21, 0xD3, -+0x00, 0x18, 0xBA, 0xD3, 0x30, 0xF0, 0x20, 0x6A, -+0xA8, 0xF5, 0x7D, 0xA2, 0x80, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x0C, 0xEA, 0x19, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF5, 0x5C, 0x9A, 0xE0, 0xF3, -+0x08, 0x6E, 0x01, 0x6B, 0x58, 0xEE, 0x10, 0xF0, -+0x23, 0x6C, 0x49, 0xF6, 0x15, 0x4C, 0x00, 0x6D, -+0xE3, 0x67, 0x04, 0xD3, 0x12, 0xEE, 0x00, 0x18, -+0x69, 0xE6, 0x06, 0x10, 0x10, 0xF0, 0x23, 0x6C, -+0x49, 0xF6, 0x15, 0x4C, 0x00, 0x18, 0x56, 0xE6, -+0x07, 0x97, 0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF5, 0x70, 0x9A, -+0xFF, 0x68, 0x20, 0x6C, 0x40, 0xA3, 0x0C, 0xEA, -+0x8D, 0xEA, 0x0C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF3, 0x48, 0x9A, 0x60, 0xAA, -+0xE1, 0xF7, 0x1F, 0x6A, 0x6C, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x89, 0xF0, -+0x26, 0xA3, 0x04, 0xD3, 0x25, 0xE2, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF4, 0x4C, 0x9A, 0x3C, 0x31, -+0x49, 0xE1, 0x80, 0xA2, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF3, 0x58, 0x9A, 0x0C, 0xEC, 0x49, 0xE1, -+0xA0, 0xA2, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF4, -+0x50, 0x9A, 0x0C, 0xED, 0x49, 0xE1, 0xC0, 0xA2, -+0x0C, 0xEE, 0x80, 0x18, 0x62, 0x09, 0x87, 0x41, -+0x00, 0x6D, 0x29, 0x4C, 0x06, 0xD2, 0x80, 0x18, -+0xE9, 0x0D, 0x06, 0x92, 0x38, 0x49, 0x45, 0xE1, -+0x91, 0x67, 0x05, 0xD1, 0x00, 0x18, 0x64, 0xD3, -+0x04, 0x93, 0x30, 0xF0, 0x20, 0x69, 0x0E, 0xF5, -+0x48, 0x99, 0x89, 0xF0, 0xC6, 0xA3, 0x05, 0x95, -+0x00, 0x6C, 0x40, 0xEA, 0x04, 0x93, 0x0E, 0xF5, -+0x48, 0x99, 0x05, 0x95, 0x89, 0xF0, 0xC6, 0xA3, -+0x11, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF3, 0x54, 0x9A, 0xFF, 0x6C, 0xA4, 0x67, -+0x40, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, -+0x48, 0x9A, 0x26, 0x6E, 0x20, 0xA2, 0x0C, 0xE9, -+0x30, 0xF0, 0x20, 0x68, 0x6E, 0xF2, 0x58, 0x98, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, -+0x40, 0x9A, 0x40, 0xEA, 0x01, 0x72, 0x11, 0x61, -+0x04, 0x93, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x5C, 0x9A, 0x89, 0xF0, 0x86, 0xA3, 0x01, 0x6D, -+0x08, 0x6E, 0x00, 0x6F, 0x40, 0xEA, 0x6E, 0xF2, -+0x58, 0x98, 0x00, 0x6C, 0xB1, 0x67, 0x26, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x69, 0xF0, 0x74, 0xA2, 0x02, 0x73, -+0x07, 0x61, 0x89, 0xF0, 0x86, 0xA2, 0x06, 0x92, -+0xFF, 0x6D, 0x4C, 0xED, 0x80, 0x18, 0xF4, 0x09, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x97, 0xA0, 0x96, 0x34, 0x00, 0x18, -+0xBC, 0xCA, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF2, -+0x5C, 0x9A, 0x40, 0xEA, 0xE8, 0xF5, 0x46, 0xA8, -+0x01, 0x4A, 0xE8, 0xF5, 0x46, 0xC8, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xE8, 0xF3, 0xD3, 0xA3, -+0x40, 0x6D, 0xFF, 0x6A, 0xCC, 0xED, 0x4C, 0xED, -+0x4C, 0xEC, 0x7A, 0x25, 0x68, 0xF3, 0xD4, 0xA3, -+0x7F, 0x6D, 0xCC, 0xED, 0x4C, 0xED, 0x4A, 0x25, -+0x68, 0xF3, 0xB5, 0xA3, 0x0F, 0x6B, 0xAC, 0xEB, -+0x4C, 0xEB, 0x44, 0x23, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF3, 0x5F, 0xA2, 0x3F, 0x2A, 0x05, 0x5C, -+0x01, 0x6A, 0x23, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x88, 0x34, 0xD6, 0xF0, 0x14, 0x4A, 0x89, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF3, 0x5C, 0x9A, 0x13, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x96, 0xF3, 0x44, 0x9A, 0x0E, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF3, 0x4C, 0x9A, -+0x09, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF3, -+0x54, 0x9A, 0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF3, 0x5C, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0x7D, 0x67, 0x50, 0xC3, 0x7D, 0x67, -+0x50, 0xA3, 0x14, 0x22, 0x70, 0xA3, 0xFF, 0x6A, -+0x4C, 0xEB, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC8, 0xF5, 0x94, 0xAA, 0x7A, 0xEC, -+0x01, 0x2B, 0xE5, 0xE8, 0x12, 0xEB, 0xC8, 0xF5, -+0x74, 0xCA, 0x01, 0x6B, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF3, 0x7F, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xC8, 0xF5, 0x94, 0xAA, -+0x64, 0x6B, 0x7B, 0xEC, 0x01, 0x2B, 0xE5, 0xE8, -+0x28, 0xF6, 0x68, 0xAA, 0x12, 0xEC, 0x63, 0xEC, -+0x01, 0x4B, 0x18, 0x60, 0xE8, 0xF5, 0x66, 0xAA, -+0xC8, 0xF5, 0x58, 0xAA, 0x4E, 0xEB, 0x0B, 0x2B, -+0x0A, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, -+0x4C, 0x9A, 0x31, 0x6B, 0x01, 0x6C, 0x60, 0xC2, -+0x80, 0x18, 0xA9, 0x0B, 0x09, 0x10, 0x00, 0x18, -+0x36, 0xD4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x00, 0x6B, 0x28, 0xF6, 0x68, 0xCA, -+0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF5, 0x40, 0x9A, -+0xFF, 0x6B, 0x80, 0xA2, 0x00, 0xF6, 0x80, 0x34, -+0x00, 0xF6, 0x83, 0x34, 0x00, 0x54, 0x24, 0x60, -+0xA0, 0xA2, 0x7F, 0x6C, 0xAC, 0xEC, 0x80, 0xC2, -+0x80, 0xA2, 0x40, 0x6D, 0x6C, 0xEC, 0xAD, 0xEC, -+0x6C, 0xEC, 0x80, 0xC2, 0x80, 0xA2, 0x10, 0xF0, -+0x24, 0x6C, 0x16, 0xF3, 0x88, 0x9C, 0x3F, 0x6D, -+0x80, 0xA4, 0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF3, -+0x8C, 0x9C, 0x80, 0xA4, 0x10, 0xF0, 0x24, 0x6C, -+0x36, 0xF5, 0x84, 0x9C, 0x80, 0xA4, 0x80, 0xA2, -+0x6C, 0xEC, 0xAD, 0xEC, 0x6C, 0xEC, 0x80, 0xC2, -+0x80, 0xA2, 0xBF, 0x6B, 0x8C, 0xEB, 0x60, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0x36, 0xF5, 0x68, 0x9B, 0xFF, 0x6A, 0x4C, 0xEC, -+0xC0, 0xA3, 0x4C, 0xED, 0x0C, 0x26, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x36, 0xF5, 0x8C, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x20, 0xE8, 0x80, 0xC3, -+0x0B, 0x25, 0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF5, -+0x90, 0x9B, 0x80, 0x6D, 0xAB, 0xED, 0x60, 0xA4, -+0x4C, 0xEB, 0xAE, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, -+0x20, 0xE8, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0xF7, 0x1F, 0x6A, -+0x0E, 0x90, 0x24, 0x67, 0x4C, 0xE9, 0x03, 0x6B, -+0x4C, 0xEF, 0x2C, 0xEB, 0x00, 0x6A, 0x0B, 0xD5, -+0x0C, 0xD6, 0x04, 0xD7, 0x40, 0xC8, 0x00, 0x6A, -+0x0A, 0x23, 0x28, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, -+0x40, 0xA8, 0x01, 0x4A, 0x40, 0xC8, 0x1F, 0xF7, -+0x00, 0x6A, 0x2C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF2, 0x48, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF2, 0x4C, 0x9A, 0x49, 0xE1, -+0x0B, 0x93, 0x40, 0x9A, 0x6C, 0xEA, 0x0C, 0x93, -+0x6E, 0xEA, 0x04, 0x22, 0x40, 0xA8, 0x04, 0x93, -+0x63, 0xEA, 0xDC, 0x61, 0x40, 0xA8, 0x04, 0x93, -+0x63, 0xEA, 0x58, 0x67, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF5, 0x74, 0x9B, -+0xFF, 0x6A, 0xCC, 0xEA, 0x6D, 0xEA, 0xE0, 0xF1, -+0x1F, 0x6B, 0xAC, 0xEB, 0x10, 0xF0, 0x24, 0x6C, -+0x36, 0xF5, 0x98, 0x9C, 0x60, 0x33, 0x60, 0x33, -+0x6D, 0xEA, 0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF2, 0x58, 0x9A, 0x6D, 0xEA, 0x40, 0xDC, -+0x20, 0xE8, 0x00, 0x65, 0xE0, 0xF1, 0x1F, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF2, 0x78, 0x9B, -+0xAC, 0xEA, 0x40, 0x32, 0x40, 0x32, 0x6D, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF5, 0x78, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF5, -+0x5C, 0x9A, 0xFF, 0x6B, 0x40, 0xA2, 0x6C, 0xEA, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x01, 0x68, 0x04, 0xEC, -+0x04, 0xF7, 0x10, 0x69, 0x13, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x01, 0x6C, -+0xFF, 0x49, 0x40, 0xEA, 0x0B, 0x29, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, 0x08, 0xF0, -+0x00, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x00, 0x6A, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF5, 0x40, 0x9A, 0x60, 0xAA, 0xFF, 0xF7, -+0x1F, 0x6A, 0x6C, 0xEA, 0x0C, 0xEA, 0xE3, 0x2A, -+0x01, 0x6A, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x0E, 0x92, 0x04, 0x67, -+0x0F, 0x91, 0x04, 0xD2, 0x04, 0x93, 0xFF, 0x6A, -+0x4C, 0xE8, 0x4C, 0xEB, 0x90, 0x67, 0x0B, 0xD5, -+0x0C, 0xD6, 0x0D, 0xD7, 0x04, 0xD3, 0x4C, 0xE9, -+0x00, 0x18, 0x35, 0xD5, 0x80, 0xF0, 0x07, 0x22, -+0x06, 0x58, 0x80, 0xF0, 0x04, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x08, 0x30, 0xF6, 0xF0, 0x08, 0x4A, -+0x09, 0xE2, 0x40, 0x9A, 0x00, 0xEA, 0x02, 0xF2, -+0x10, 0x6A, 0x0E, 0x10, 0x02, 0xF2, 0x00, 0x6A, -+0x0B, 0x10, 0x22, 0xF2, 0x00, 0x6A, 0x08, 0x10, -+0x22, 0xF2, 0x10, 0x6A, 0x05, 0x10, 0x42, 0xF2, -+0x00, 0x6A, 0x02, 0x10, 0x42, 0xF2, 0x10, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0x0D, 0x94, 0xD6, 0xF4, -+0x70, 0x9B, 0x8C, 0xEB, 0x10, 0xF0, 0x24, 0x6C, -+0xF6, 0xF3, 0x94, 0x9C, 0x8D, 0xEB, 0x06, 0x21, -+0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF5, 0x84, 0x9C, -+0x6D, 0xEC, 0x05, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0x56, 0xF5, 0x88, 0x9C, 0x6C, 0xEC, 0x04, 0x96, -+0x06, 0x26, 0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF2, -+0x78, 0x9B, 0x8D, 0xEB, 0x05, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF5, 0x6C, 0x9B, 0x8C, 0xEB, -+0x1F, 0xF7, 0x00, 0x6C, 0x4C, 0xEC, 0x02, 0xF0, -+0x00, 0x74, 0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF2, 0xA8, 0x9C, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6C, 0xD6, 0xF2, 0xAC, 0x9C, -+0x10, 0xF0, 0x24, 0x6C, 0x0B, 0x96, 0x56, 0xF5, -+0x90, 0x9C, 0xB5, 0xE2, 0xCC, 0xEC, 0x80, 0xDD, -+0x84, 0x42, 0x1F, 0xF7, 0x00, 0x6D, 0xAC, 0xEC, -+0x02, 0xF0, 0x00, 0x74, 0x01, 0x60, 0x05, 0x2C, -+0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF5, 0xB4, 0x9C, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF5, -+0xB8, 0x9C, 0x10, 0xF0, 0x24, 0x6C, 0x0C, 0x96, -+0x56, 0xF5, 0x90, 0x9C, 0xB5, 0xE2, 0xCC, 0xEC, -+0x80, 0xDD, 0x87, 0x42, 0x01, 0x4C, 0x1F, 0xF7, -+0x00, 0x6D, 0xAC, 0xEC, 0x02, 0xF0, 0x00, 0x74, -+0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, 0x24, 0x6C, -+0x56, 0xF5, 0x9C, 0x9C, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6C, 0x76, 0xF5, 0x80, 0x9C, 0x89, 0xE2, -+0x60, 0xDA, 0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x04, 0xF7, 0x10, 0x68, 0x13, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x05, 0x6C, 0xFF, 0x48, 0x40, 0xEA, 0x0B, 0x28, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, -+0x08, 0xF0, 0x00, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x00, 0x6A, 0x09, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF5, 0x40, 0x9A, 0x60, 0xAA, -+0x3F, 0x6A, 0x6C, 0xEA, 0xE5, 0x2A, 0x01, 0x6A, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF5, 0x40, 0x9A, -+0x40, 0xAA, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF5, 0x40, 0x9A, 0x40, 0xAA, 0x20, 0xE8, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x00, 0x6A, 0x04, 0xD2, 0x04, 0x92, 0x01, 0x72, -+0x58, 0x67, 0x04, 0xD2, 0x10, 0xF0, 0x23, 0x6A, -+0x78, 0x67, 0xCA, 0xF6, 0x19, 0x4A, 0x69, 0xE2, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x40, 0xDB, 0x00, 0x1C, 0x96, 0x45, 0x00, 0x18, -+0xD0, 0xD4, 0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, -+0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, 0x02, 0x6B, -+0x8C, 0xEB, 0x09, 0x23, 0x03, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x00, 0x18, -+0xF7, 0xDB, 0x00, 0x18, 0x59, 0xDC, 0x00, 0x1C, -+0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x8C, 0x9A, 0x04, 0x6B, 0x8C, 0xEB, 0x09, 0x23, -+0x05, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x00, 0x18, 0x4F, 0xD8, 0x00, 0x18, -+0xBD, 0xD7, 0x00, 0x1C, 0x95, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF3, 0x6C, 0x9B, 0x80, 0xF0, -+0x8C, 0x9A, 0x8C, 0xEB, 0x13, 0x23, 0x10, 0xF0, -+0x24, 0x6B, 0x76, 0xF5, 0x6C, 0x9B, 0x69, 0xF0, -+0xB5, 0xA2, 0x30, 0xF0, 0x20, 0x6E, 0x8C, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x30, 0xF0, 0x20, 0x6B, -+0x0F, 0xF6, 0x90, 0xA3, 0xEF, 0xF5, 0x10, 0x4E, -+0x00, 0x18, 0xE0, 0xCE, 0x00, 0x1C, 0x96, 0x45, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x94, 0xA2, 0x7F, 0x6B, 0x8C, 0xEB, -+0x0D, 0x23, 0x68, 0xF3, 0x98, 0xA2, 0x68, 0xF3, -+0x7C, 0xA2, 0x8E, 0xEB, 0x07, 0x23, 0x68, 0xF3, -+0x97, 0xA2, 0xFF, 0x6A, 0x96, 0x34, 0x4C, 0xEC, -+0x00, 0x18, 0xA2, 0xC6, 0x30, 0xF0, 0x20, 0x6A, -+0x40, 0xF2, 0x54, 0x9A, 0x02, 0x2A, 0x00, 0x18, -+0xA0, 0xC9, 0x00, 0x1C, 0x95, 0x45, 0x00, 0x1C, -+0x96, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, 0x02, 0xF0, -+0x00, 0x6B, 0x8C, 0xEB, 0x08, 0x23, 0x02, 0xF0, -+0x01, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x00, 0x18, 0x1A, 0xE7, 0x00, 0x1C, -+0x95, 0x45, 0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF3, 0x70, 0x9B, 0x80, 0xF0, -+0x8C, 0x9A, 0x8C, 0xEB, 0x20, 0x23, 0x10, 0xF0, -+0x24, 0x6B, 0x76, 0xF5, 0x70, 0x9B, 0x8C, 0xEB, -+0x68, 0xF3, 0x94, 0xA2, 0x80, 0xF0, 0x6C, 0xDA, -+0x7F, 0x6B, 0x8C, 0xEB, 0x07, 0x2B, 0x68, 0xF3, -+0x5C, 0xA2, 0x0C, 0x72, 0x03, 0x61, 0x00, 0x18, -+0xE1, 0xD9, 0x0D, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6C, -+0x80, 0xF0, 0x6C, 0x9A, 0x56, 0xF3, 0x90, 0x9C, -+0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, 0x00, 0x1C, -+0x95, 0x45, 0x30, 0xF0, 0x20, 0x6A, 0xCC, 0xF1, -+0x53, 0xA2, 0x0F, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF5, 0x54, 0x9A, 0x01, 0x6B, 0x80, 0xA2, -+0x8C, 0xEB, 0x07, 0x23, 0x80, 0xA2, 0xFE, 0x6B, -+0x8C, 0xEB, 0x60, 0xC2, 0x03, 0x6C, 0x00, 0x18, -+0x30, 0xDD, 0x30, 0xF0, 0x20, 0x69, 0xCF, 0xF4, -+0x00, 0x49, 0x80, 0xF2, 0x1C, 0xA1, 0x01, 0x6A, -+0x4E, 0xE8, 0x05, 0x28, 0x0B, 0x6C, 0x00, 0x18, -+0x30, 0xDD, 0x80, 0xF2, 0x1C, 0xC1, 0x30, 0xF0, -+0x21, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0xD0, 0xF3, -+0x94, 0x9B, 0xEE, 0xF7, 0x58, 0x9A, 0x40, 0xEA, -+0x0D, 0x17, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x00, 0x68, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0xCB, 0xF0, 0x0D, 0x4A, 0x0A, 0x70, 0x40, 0xDB, -+0x0C, 0x61, 0x30, 0xF0, 0x21, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF7, 0x54, 0x9A, 0xD0, 0xF3, -+0x94, 0x9B, 0x01, 0x6D, 0xAB, 0xED, 0x40, 0xEA, -+0x00, 0x68, 0x00, 0x1C, 0x96, 0x45, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x8C, 0x9A, 0x08, 0x6B, 0x8C, 0xEB, 0x07, 0x23, -+0x09, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x80, 0x18, 0x1E, 0x11, 0x00, 0x1C, -+0x95, 0x45, 0x10, 0xF0, 0x24, 0x6B, 0xFF, 0x6A, -+0x01, 0x48, 0x96, 0xF2, 0x78, 0x9B, 0x4C, 0xE8, -+0x10, 0xF0, 0x23, 0x6A, 0xCB, 0xF0, 0x0E, 0x4A, -+0x40, 0xDB, 0xC8, 0x17, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF5, 0x78, 0x9A, 0xDF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF5, 0xB8, 0x9B, -+0xFF, 0x6A, 0x20, 0x6E, 0x60, 0xA5, 0x4C, 0xEC, -+0x4C, 0xEB, 0xCD, 0xEB, 0x4C, 0xEB, 0x07, 0xF7, -+0x01, 0x4A, 0x4D, 0xEC, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF5, 0x5C, 0x9A, 0x60, 0xC5, 0x80, 0xCA, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF5, 0x5C, 0x9A, 0x68, 0xF0, 0x04, 0x6B, -+0x60, 0xCA, 0x20, 0xE8, 0x03, 0x6F, 0x8C, 0xEF, -+0x64, 0x67, 0x46, 0x67, 0x04, 0x27, 0x07, 0x10, -+0xA0, 0xDB, 0xFC, 0x4A, 0x04, 0x4B, 0x04, 0x5A, -+0xFB, 0x60, 0x03, 0x6A, 0x4C, 0xEE, 0x04, 0x26, -+0xA0, 0xC4, 0xFF, 0x4E, 0x01, 0x4C, 0xFB, 0x17, -+0x00, 0x6A, 0x20, 0xE8, 0xFF, 0x6A, 0xAC, 0xEA, -+0x03, 0x10, 0x40, 0xC4, 0xFF, 0x4E, 0x01, 0x4C, -+0xFC, 0x2E, 0x00, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0x00, 0x6A, 0x07, 0x26, 0x5D, 0xE5, 0xE0, 0xA7, -+0x4D, 0xE4, 0xFF, 0x4E, 0xE0, 0xC3, 0x01, 0x4A, -+0xF8, 0x17, 0x00, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0x09, 0x10, 0x60, 0xA4, 0x40, 0xA5, 0xFF, 0x4E, -+0x4A, 0xEB, 0x02, 0x60, 0x4B, 0xE3, 0x20, 0xE8, -+0x01, 0x4C, 0x01, 0x4D, 0xF6, 0x2E, 0x00, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0x06, 0x2C, 0x64, 0x6B, -+0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, 0x60, 0xDA, -+0x04, 0x10, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x80, 0xDA, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x40, 0x9A, 0x28, 0x72, 0x2D, 0x60, 0x29, 0x5A, -+0x07, 0x60, 0x14, 0x72, 0x19, 0x60, 0x19, 0x72, -+0x1F, 0x60, 0x0A, 0x72, 0x0D, 0x60, 0x20, 0xE8, -+0x50, 0x72, 0x32, 0x60, 0x51, 0x5A, 0x03, 0x60, -+0x32, 0x72, 0x26, 0x60, 0x20, 0xE8, 0x64, 0x72, -+0x33, 0x60, 0xC8, 0x72, 0x39, 0x60, 0x20, 0xE8, -+0x02, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x64, 0xDA, 0xE0, 0xF7, 0x1E, 0x4B, 0x39, 0x10, -+0x03, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x64, 0xDA, 0xE1, 0xF3, 0x1D, 0x4B, 0x31, 0x10, -+0x09, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x64, 0xDA, 0xE4, 0xF3, 0x17, 0x4B, 0x29, 0x10, -+0x05, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x64, 0xDA, 0xE2, 0xF3, 0x1B, 0x4B, 0x21, 0x10, -+0x11, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x64, 0xDA, 0xE8, 0xF3, 0x0F, 0x4B, 0x19, 0x10, -+0x0A, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x64, 0xDA, 0xE4, 0xF7, 0x16, 0x4B, 0x11, 0x10, -+0x22, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x64, 0xDA, 0x11, 0xF0, 0x00, 0x6B, 0x09, 0x10, -+0x43, 0x6B, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x64, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF5, -+0x60, 0x9A, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x68, 0xDA, 0x20, 0xE8, 0x30, 0xF0, 0x21, 0x6A, -+0xB0, 0xF3, 0x40, 0x9A, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x63, 0x0C, 0x24, 0x30, 0xF0, 0x21, 0x6A, -+0xB0, 0xF3, 0x48, 0x9A, 0x58, 0xEC, 0x12, 0xEC, -+0x00, 0xD4, 0x00, 0x92, 0xFF, 0x4A, 0x00, 0xD2, -+0x00, 0x92, 0xFB, 0x2A, 0x01, 0x63, 0x20, 0xE8, -+0xFF, 0x63, 0x0D, 0x24, 0x30, 0xF0, 0x21, 0x6A, -+0xB0, 0xF3, 0x44, 0x9A, 0x58, 0xEC, 0x12, 0xEC, -+0x00, 0xD4, 0x00, 0x92, 0x04, 0x22, 0x00, 0x92, -+0xFF, 0x4A, 0x00, 0xD2, 0xFA, 0x17, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x7A, 0xD6, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xED, 0x00, 0x18, 0x6F, 0xD6, -+0x05, 0x97, 0x00, 0x6A, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x6A, -+0x04, 0x67, 0x4C, 0xEE, 0x00, 0x18, 0x74, 0xD6, -+0x50, 0x67, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x25, 0x67, 0x56, 0xF3, 0xAC, 0x9A, 0xFF, 0x68, -+0x8C, 0xE8, 0xA1, 0xF4, 0x18, 0x6C, 0x00, 0x18, -+0x5C, 0xE3, 0x28, 0x22, 0x27, 0x20, 0x03, 0x21, -+0x01, 0x71, 0x12, 0x60, 0x34, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x96, 0xF5, 0x1C, 0x9A, 0x00, 0x6C, -+0x01, 0x6D, 0xD0, 0x67, 0x00, 0x18, 0xA7, 0xE3, -+0x0E, 0x6B, 0x6B, 0xEB, 0x4C, 0xEB, 0x00, 0x6C, -+0x01, 0x6D, 0xD0, 0x67, 0x09, 0x6F, 0x10, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF5, 0x1C, 0x9A, -+0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, 0x00, 0x18, -+0xA7, 0xE3, 0x0E, 0x6B, 0x6B, 0xEB, 0x4C, 0xEB, -+0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, 0x05, 0x6F, -+0x6D, 0xEF, 0x0F, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF5, 0x1C, 0x9A, 0x00, 0x6C, 0x01, 0x6D, -+0xD0, 0x67, 0x00, 0x18, 0xA7, 0xE3, 0x02, 0x6F, -+0xEB, 0xEF, 0x00, 0x6C, 0x01, 0x6D, 0xD0, 0x67, -+0x4C, 0xEF, 0x00, 0x18, 0xBA, 0xE3, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x00, 0x68, -+0x17, 0x10, 0xE0, 0xF3, 0x08, 0x70, 0x0A, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, -+0x80, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x00, 0x6A, 0x13, 0x10, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x48, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF5, 0x4C, 0x9A, -+0x60, 0xA2, 0x01, 0x6A, 0x6C, 0xEA, 0xE1, 0x2A, -+0x01, 0x6A, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0xF7, 0x1F, 0x6A, -+0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x10, 0xF0, -+0x24, 0x6C, 0xF6, 0xF5, 0x70, 0x9B, 0xF6, 0xF5, -+0x94, 0x9C, 0x6D, 0xE5, 0x91, 0xE5, 0x00, 0x6E, -+0xC0, 0xDB, 0x04, 0x4B, 0x8A, 0xEB, 0xFB, 0x61, -+0xE7, 0xF7, 0x1F, 0x6B, 0x4C, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF3, 0x54, 0x9A, 0x10, 0x6C, -+0x4D, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF5, -+0x50, 0x9A, 0x49, 0xE5, 0x60, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF5, 0x58, 0x9A, 0xFF, 0x6B, -+0x55, 0xE5, 0x40, 0xA5, 0x6C, 0xEA, 0x8D, 0xEA, -+0x6C, 0xEA, 0x40, 0xC5, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x21, 0x6A, 0xD0, 0xF3, 0x61, 0xA2, -+0x08, 0xD4, 0x30, 0xF0, 0x20, 0x69, 0x61, 0xC5, -+0x01, 0x4B, 0xD0, 0xF3, 0x61, 0xC2, 0x10, 0xF0, -+0x24, 0x6B, 0xF6, 0xF5, 0x90, 0x9B, 0x08, 0x93, -+0x4E, 0xF2, 0x50, 0x99, 0x02, 0x6E, 0x91, 0xE3, -+0x05, 0x67, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xF6, 0xF5, 0x9C, 0x9B, 0x08, 0x93, 0xCE, 0xA0, -+0x4E, 0xF2, 0x50, 0x99, 0xA2, 0x40, 0x91, 0xE3, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x24, 0x67, 0x00, 0x18, -+0x02, 0xD7, 0x00, 0x6B, 0x36, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF4, 0x4C, 0x9A, 0xFF, 0xF7, -+0x1F, 0x6E, 0xFF, 0x6F, 0x00, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF4, 0x50, 0x9A, 0x10, 0x6C, -+0x8B, 0xEC, 0x4C, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0xA1, 0x40, 0x16, 0xF6, 0x40, 0x9A, 0x65, 0x67, -+0xCC, 0xEB, 0x60, 0xCA, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF6, 0x44, 0x9A, 0x60, 0xA2, 0xFA, 0x65, -+0xA2, 0x32, 0xEC, 0xEB, 0x8C, 0xEB, 0x42, 0x32, -+0x6D, 0xEA, 0xEC, 0xEA, 0x7F, 0x67, 0x40, 0xC3, -+0x87, 0xA9, 0x02, 0x4C, 0xCC, 0xEC, 0x00, 0x18, -+0x17, 0xD7, 0x87, 0x40, 0x12, 0x4C, 0xB1, 0x67, -+0x00, 0x18, 0x2E, 0xD7, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF5, 0x4C, 0x9A, 0x01, 0x6B, 0x60, 0xC2, -+0x01, 0x6B, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x43, 0x67, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x6C, 0x9A, 0xA4, 0x67, 0x04, 0x6C, 0x8D, 0xEB, -+0x30, 0xF0, 0x20, 0x68, 0x80, 0xF0, 0x6C, 0xDA, -+0xCF, 0xF4, 0x00, 0x48, 0xA0, 0xF0, 0x4E, 0xA8, -+0x01, 0xF1, 0x00, 0x72, 0x07, 0x60, 0xA0, 0xF0, -+0x6E, 0xA0, 0xA0, 0xF0, 0x4F, 0xA0, 0xFF, 0x4B, -+0x4E, 0xEB, 0x0A, 0x2B, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF3, 0x78, 0x9A, 0x00, 0xF2, 0x00, 0x6C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x12, 0x10, -+0x50, 0x32, 0x51, 0xE0, 0x0E, 0x4C, 0x10, 0x6E, -+0x00, 0x18, 0x74, 0xD6, 0xA0, 0xF0, 0x4F, 0xA0, -+0x0A, 0x6B, 0x01, 0x4A, 0xA0, 0xF0, 0x4F, 0xC0, -+0xA0, 0xF0, 0x4F, 0xA0, 0x6E, 0xEA, 0x02, 0x2A, -+0xA0, 0xF0, 0x4F, 0xC0, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x21, 0x6B, 0xD0, 0xF3, -+0x40, 0xA3, 0xFF, 0x6F, 0xE0, 0xF0, 0xC7, 0xA5, -+0x41, 0xC5, 0x43, 0xA5, 0xD0, 0xF3, 0x60, 0xA3, -+0x03, 0x4A, 0xEC, 0xEA, 0x09, 0x10, 0xED, 0x42, -+0xFF, 0x68, 0x0C, 0xEF, 0xFD, 0xE5, 0x64, 0xC7, -+0xE6, 0xA7, 0x03, 0x4F, 0xE9, 0xE2, 0x0C, 0xEA, -+0xEF, 0x46, 0xE2, 0xEA, 0xF4, 0x61, 0x30, 0xF0, -+0x21, 0x6A, 0xD0, 0xF3, 0x60, 0xA2, 0x01, 0x4B, -+0xD0, 0xF3, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6B, -+0xF6, 0xF5, 0x70, 0x9B, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x71, 0xE4, 0x40, 0xEA, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x24, 0x67, 0x00, 0x18, 0x02, 0xD7, 0x00, 0x6B, -+0x2E, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, -+0x4C, 0x9A, 0x0F, 0x6C, 0xFF, 0xF7, 0x1F, 0x6B, -+0x00, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, -+0x50, 0x9A, 0x4C, 0xE8, 0xA1, 0x40, 0xA2, 0x32, -+0x42, 0x32, 0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6C, -+0x16, 0xF6, 0x80, 0x9C, 0xC5, 0x67, 0x6C, 0xEE, -+0xC0, 0xCC, 0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF6, -+0x84, 0x9C, 0x40, 0xC4, 0xE0, 0xF0, 0x87, 0xA1, -+0x6C, 0xEC, 0x00, 0x18, 0x17, 0xD7, 0x87, 0x40, -+0x12, 0x4C, 0xB1, 0x67, 0x00, 0x18, 0x85, 0xD7, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF5, 0x4C, 0x9A, -+0x01, 0x6B, 0x60, 0xC2, 0x01, 0x6B, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x43, 0x67, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0xEB, 0xF6, -+0x15, 0x4A, 0x10, 0xF0, 0x30, 0x68, 0x40, 0xDB, -+0x00, 0xF0, 0x00, 0x48, 0xC1, 0xF6, 0x62, 0xA0, -+0xC1, 0xF6, 0x43, 0xA0, 0x6E, 0xEA, 0x39, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF6, 0x48, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF3, 0x94, 0x9C, -+0x40, 0x9A, 0x8C, 0xEA, 0x2E, 0x2A, 0xE8, 0x6A, -+0x58, 0xEB, 0x87, 0x40, 0x3B, 0x4C, 0x12, 0xEB, -+0x71, 0xE4, 0x00, 0x18, 0x9E, 0xD7, 0x16, 0x22, -+0xC1, 0xF6, 0x42, 0xA0, 0x10, 0x6B, 0x01, 0x4A, -+0xC1, 0xF6, 0x42, 0xC0, 0xC1, 0xF6, 0x42, 0xA0, -+0x6E, 0xEA, 0x02, 0x2A, 0xC1, 0xF6, 0x42, 0xC0, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF6, 0x82, 0xA2, 0xC1, 0xF6, 0x63, 0xA2, -+0x8E, 0xEB, 0x0B, 0x23, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x04, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x04, 0x10, 0xC1, 0xF6, 0x84, 0xC2, 0xC1, 0xF6, -+0x65, 0xC2, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF6, 0x62, 0xA2, -+0xA4, 0x67, 0x04, 0x2B, 0xC1, 0xF6, 0x43, 0xA2, -+0x0F, 0x72, 0x0B, 0x60, 0x10, 0xF0, 0x30, 0x68, -+0x00, 0xF0, 0x00, 0x48, 0xC1, 0xF6, 0x42, 0xA0, -+0xC1, 0xF6, 0x83, 0xA0, 0xFF, 0x4A, 0x8E, 0xEA, -+0x09, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, -+0x78, 0x9A, 0xFF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, -+0x40, 0xC3, 0xA7, 0x10, 0x23, 0xA5, 0xC1, 0xF6, -+0x45, 0xA0, 0xFF, 0x6B, 0x04, 0x49, 0x6C, 0xE9, -+0x1F, 0x2A, 0xE8, 0x6A, 0x58, 0xEC, 0x30, 0xF0, -+0x20, 0x6A, 0x67, 0x40, 0x4E, 0xF2, 0x50, 0x9A, -+0x3B, 0x4B, 0xD1, 0x67, 0x12, 0xEC, 0x91, 0xE3, -+0x40, 0xEA, 0xC1, 0xF6, 0x43, 0xA0, 0xC1, 0xF6, -+0x62, 0xA0, 0xC1, 0xF6, 0x25, 0xC0, 0x4E, 0xEB, -+0x74, 0x2B, 0x01, 0x4A, 0xC1, 0xF6, 0x43, 0xC0, -+0xC1, 0xF6, 0x43, 0xA0, 0x10, 0x6B, 0x6E, 0xEA, -+0x6C, 0x2A, 0xC1, 0xF6, 0x43, 0xC0, 0x69, 0x10, -+0x82, 0xA5, 0x37, 0x2C, 0x51, 0xE1, 0xE3, 0x54, -+0x34, 0x60, 0xC1, 0xF6, 0x84, 0xA0, 0xE8, 0x6E, -+0xD8, 0xEC, 0x12, 0xEC, 0x91, 0xE0, 0x40, 0xF0, -+0xC4, 0xA4, 0x2B, 0x2E, 0x40, 0xF0, 0xC5, 0xA4, -+0xFC, 0x4A, 0x6C, 0xEA, 0xFF, 0x4E, 0x40, 0xF0, -+0xC5, 0xC4, 0xC1, 0xF6, 0x85, 0xA0, 0xE8, 0x6E, -+0xFF, 0x4C, 0xC1, 0xF6, 0x85, 0xC0, 0xC1, 0xF6, -+0x84, 0xA0, 0xD8, 0xEC, 0xD1, 0x67, 0x12, 0xEC, -+0x91, 0xE0, 0x51, 0xE4, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x45, 0x4C, 0x40, 0xEA, -+0xC1, 0xF6, 0x44, 0xA0, 0xE8, 0x6B, 0x78, 0xEA, -+0x12, 0xEA, 0x49, 0xE0, 0x40, 0xF0, 0x65, 0xA2, -+0x6D, 0xE1, 0x40, 0xF0, 0x65, 0xC2, 0xC1, 0xF6, -+0x45, 0xA0, 0x45, 0xE1, 0xC1, 0xF6, 0x25, 0xC0, -+0x30, 0x10, 0x10, 0xF0, 0x30, 0x68, 0x00, 0xF0, -+0x00, 0x48, 0xC1, 0xF6, 0x63, 0xA0, 0xE8, 0x6A, -+0x87, 0x40, 0x58, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x3B, 0x4C, 0xD1, 0x67, -+0x12, 0xEB, 0x71, 0xE4, 0x40, 0xEA, 0xC1, 0xF6, -+0x43, 0xA0, 0x10, 0x6B, 0xC1, 0xF6, 0x25, 0xC0, -+0x01, 0x4A, 0xC1, 0xF6, 0x43, 0xC0, 0xC1, 0xF6, -+0x43, 0xA0, 0x6E, 0xEA, 0x02, 0x2A, 0xC1, 0xF6, -+0x43, 0xC0, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF6, 0x64, 0xA2, 0x10, 0x6C, -+0x01, 0x4B, 0xC1, 0xF6, 0x64, 0xC2, 0xC1, 0xF6, -+0x64, 0xA2, 0x8E, 0xEB, 0x02, 0x2B, 0xC1, 0xF6, -+0x64, 0xC2, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF6, 0x84, 0xA2, 0xE8, 0x6B, -+0x78, 0xEC, 0x04, 0x6C, 0x12, 0xEB, 0x6D, 0xE2, -+0xC1, 0xF6, 0x45, 0xA2, 0x20, 0xF1, 0x49, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x2C, 0xF1, -+0x1D, 0x4A, 0x30, 0xF0, 0x20, 0x68, 0x40, 0xDB, -+0xCF, 0xF4, 0x00, 0x48, 0xA0, 0xF0, 0x8E, 0xA0, -+0xA0, 0xF0, 0x4F, 0xA0, 0x8E, 0xEA, 0x3D, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF6, 0x48, 0x9A, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF3, 0x74, 0x9B, -+0x40, 0x9A, 0x6C, 0xEA, 0x32, 0x2A, 0x47, 0x40, -+0x90, 0x34, 0x07, 0x4A, 0x91, 0xE2, 0x00, 0x18, -+0x43, 0xD7, 0x0B, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x04, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x22, 0x10, 0xA0, 0xF0, 0x4E, 0xA0, 0x01, 0x4A, -+0xA0, 0xF0, 0x4E, 0xC0, 0xA0, 0xF0, 0x6E, 0xA0, -+0xA0, 0xF0, 0x4F, 0xA0, 0x6E, 0xEA, 0x0A, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF0, 0x6C, 0x9A, 0x04, 0x6C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF4, 0x00, 0x4A, 0xA0, 0xF0, 0x6E, 0xA2, -+0x0A, 0x6C, 0x8E, 0xEB, 0x02, 0x2B, 0xA0, 0xF0, -+0x6E, 0xC2, 0x00, 0x18, 0xB2, 0xD8, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x74, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xF6, 0xF2, 0x18, 0x9C, 0x40, 0x9B, -+0x00, 0xF4, 0x1D, 0x6C, 0x10, 0x6D, 0x0D, 0xEA, -+0x40, 0xDB, 0x06, 0x02, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF4, 0x54, 0x9A, 0x00, 0x6E, -+0x82, 0xF3, 0x08, 0x6F, 0x40, 0xEA, 0x07, 0x2A, -+0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF3, 0x98, 0x9B, -+0x60, 0x9C, 0x0D, 0xEB, 0x60, 0xDC, 0x09, 0x97, -+0x08, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x60, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC8, 0xF2, 0x7D, 0xC2, 0x61, 0xA4, -+0xC8, 0xF2, 0x7E, 0xC2, 0x62, 0xA4, 0xC8, 0xF2, -+0x7F, 0xC2, 0x63, 0xA4, 0xE8, 0xF2, 0x60, 0xC2, -+0x64, 0xA4, 0xE8, 0xF2, 0x61, 0xC2, 0x65, 0xA4, -+0xE8, 0xF2, 0x62, 0xC2, 0x66, 0xA4, 0xE8, 0xF2, -+0x63, 0xC2, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x69, -+0x30, 0xF0, 0x20, 0x6A, 0x11, 0x67, 0x4E, 0xF2, -+0x50, 0x9A, 0xCF, 0xF4, 0x00, 0x48, 0xA4, 0x67, -+0x04, 0x6E, 0x90, 0x67, 0x40, 0xEA, 0xCF, 0xF4, -+0x60, 0xA1, 0x01, 0x6A, 0x6C, 0xEA, 0x0E, 0x22, -+0x42, 0xA0, 0xFF, 0x72, 0x0B, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x81, 0xA0, -+0x88, 0xF3, 0x7B, 0xA2, 0x6D, 0xE4, 0x04, 0x4B, -+0x88, 0xF3, 0x6A, 0xCA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF6, 0x4C, 0x9A, -+0x60, 0xA2, 0x03, 0x6A, 0x6C, 0xEA, 0x10, 0x6B, -+0x64, 0xEA, 0xFF, 0x6A, 0x4C, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0x16, 0xF6, 0x50, 0x9A, 0x04, 0xD3, -+0x40, 0x9A, 0x05, 0xD2, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF6, 0x54, 0x9A, 0x00, 0x9A, 0x05, 0x92, -+0x0A, 0xEA, 0x00, 0xF1, 0x05, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x6C, 0x9A, 0x02, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, 0x04, 0x2B, -+0xC1, 0xF7, 0x47, 0xA2, 0x07, 0x72, 0x0B, 0x60, -+0x10, 0xF0, 0x30, 0x69, 0x00, 0xF0, 0x00, 0x49, -+0xC1, 0xF7, 0x86, 0xA1, 0xC1, 0xF7, 0x47, 0xA1, -+0x6F, 0x44, 0x4E, 0xEB, 0x0A, 0x2B, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, 0xFF, 0x6C, -+0x01, 0x4C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0xDB, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF4, -+0xB4, 0x9B, 0x7F, 0x6B, 0xB5, 0xE0, 0xC0, 0xA5, -+0x6C, 0xEE, 0x80, 0xF0, 0x0C, 0x2E, 0x03, 0x2C, -+0x04, 0x72, 0xC0, 0xF0, 0x0D, 0x60, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, -+0x67, 0xA2, 0xC1, 0xF7, 0x46, 0xA2, 0x8C, 0x42, -+0x6E, 0xEC, 0xC0, 0xF0, 0x01, 0x24, 0x01, 0x72, -+0x03, 0x61, 0x05, 0x73, 0xA0, 0xF0, 0x1C, 0x60, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0x66, 0xA2, 0x02, 0x73, 0x05, 0x61, -+0xC1, 0xF7, 0x47, 0xA2, 0x06, 0x72, 0xA0, 0xF0, -+0x0F, 0x60, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, 0x03, 0x73, -+0x05, 0x61, 0xC1, 0xF7, 0x47, 0xA2, 0x07, 0x72, -+0xA0, 0xF0, 0x02, 0x60, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, -+0x05, 0x2B, 0xC1, 0xF7, 0x47, 0xA2, 0x05, 0x72, -+0x80, 0xF0, 0x16, 0x60, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x67, 0xA2, -+0xC1, 0xF7, 0x46, 0xA2, 0x8D, 0x42, 0x6E, 0xEC, -+0x80, 0xF0, 0x0A, 0x24, 0x01, 0x72, 0x03, 0x61, -+0x06, 0x73, 0x80, 0xF0, 0x05, 0x60, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, -+0x66, 0xA2, 0x02, 0x73, 0x04, 0x61, 0xC1, 0xF7, -+0x47, 0xA2, 0x07, 0x72, 0x79, 0x60, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, -+0x66, 0xA2, 0x04, 0x2B, 0xC1, 0xF7, 0x47, 0xA2, -+0x06, 0x72, 0x6E, 0x60, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x67, 0xA2, -+0xC1, 0xF7, 0x46, 0xA2, 0x8E, 0x42, 0x6E, 0xEC, -+0x63, 0x24, 0x01, 0x72, 0x02, 0x61, 0x07, 0x73, -+0x5F, 0x60, 0x10, 0xF0, 0x30, 0x69, 0x00, 0xF0, -+0x00, 0x49, 0x10, 0xF0, 0x24, 0x6A, 0xC1, 0xF7, -+0x87, 0xA1, 0x36, 0xF4, 0x54, 0x9A, 0x10, 0xF0, -+0x24, 0x6D, 0x76, 0x4C, 0x16, 0xF4, 0xB4, 0x9D, -+0x49, 0xE0, 0x94, 0x34, 0x60, 0xAA, 0x91, 0xE1, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x06, 0x4C, 0xB5, 0xE0, 0x13, 0x10, 0x80, 0xA5, -+0x8C, 0xEB, 0x01, 0x73, 0x1F, 0x61, 0x10, 0xF0, -+0x24, 0x6B, 0x36, 0xF4, 0x74, 0x9B, 0x87, 0x42, -+0x6F, 0x4C, 0x6D, 0xE0, 0x30, 0xF0, 0x20, 0x6A, -+0x94, 0x34, 0x60, 0xAB, 0x4E, 0xF2, 0x50, 0x9A, -+0x91, 0xE1, 0x06, 0x4C, 0xFF, 0x6E, 0x6C, 0xEE, -+0x40, 0xEA, 0xC1, 0xF7, 0x47, 0xA1, 0x08, 0x6B, -+0x01, 0x4A, 0xC1, 0xF7, 0x47, 0xC1, 0xC1, 0xF7, -+0x47, 0xA1, 0x6E, 0xEA, 0x0E, 0x2A, 0xC1, 0xF7, -+0x47, 0xC1, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF3, 0x78, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0xD6, 0xF3, 0x8C, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF6, -+0x58, 0x9A, 0x04, 0x93, 0x40, 0x9A, 0x0E, 0xEA, -+0x61, 0xE0, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF6, 0x5C, 0x9A, 0x00, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x16, 0xF6, 0x54, 0x9A, 0x00, 0xDA, -+0x05, 0x92, 0x4A, 0xE8, 0x1F, 0xF7, 0x05, 0x61, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFE, 0x63, 0x03, 0xD1, -+0x02, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF6, -+0x40, 0x9A, 0x0F, 0x6B, 0x40, 0xA2, 0x4C, 0xEB, -+0x0A, 0x23, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0xF0, 0x8C, 0x9A, 0x02, 0x6D, -+0xAD, 0xEC, 0x80, 0xF0, 0x8C, 0xDA, 0x10, 0xF0, -+0x30, 0x6A, 0x40, 0xF0, 0x40, 0xA2, 0x00, 0xD2, -+0xFF, 0x4A, 0x01, 0xD2, 0xE5, 0x10, 0x00, 0x92, -+0x06, 0x2A, 0x10, 0xF0, 0x30, 0x6A, 0x40, 0xF0, -+0x41, 0xA2, 0x07, 0x72, 0x09, 0x60, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0x40, 0xF0, -+0x01, 0xA2, 0x01, 0x94, 0x8A, 0xE8, 0x0A, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, -+0xFF, 0x6C, 0x01, 0x4C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0xCC, 0x10, 0x30, 0xF0, 0x21, 0x6D, -+0xD0, 0xF3, 0x82, 0xA5, 0xC3, 0x67, 0xC7, 0xEC, -+0x86, 0x67, 0x01, 0x6E, 0xCC, 0xEC, 0xA0, 0xF0, -+0x08, 0x24, 0x0C, 0x35, 0x04, 0x4D, 0xB5, 0xE2, -+0x00, 0x6A, 0x30, 0xF0, 0x21, 0x6E, 0xD0, 0xF3, -+0xE2, 0xA6, 0xFF, 0x6C, 0x1F, 0xF7, 0x00, 0x69, -+0x8C, 0xEF, 0x74, 0x4F, 0xE8, 0x37, 0xFD, 0xE2, -+0x2C, 0xEF, 0x02, 0xF0, 0x00, 0x77, 0x08, 0x60, -+0xD0, 0xF3, 0xE2, 0xA6, 0x8C, 0xEF, 0x74, 0x4F, -+0xE8, 0x37, 0xFD, 0xE2, 0x2C, 0xEF, 0x0F, 0x2F, -+0x30, 0xF0, 0x21, 0x6C, 0xD0, 0xF3, 0x22, 0xA4, -+0xFF, 0x6C, 0x10, 0xF0, 0x24, 0x6E, 0x8C, 0xE9, -+0x74, 0x49, 0x28, 0x31, 0xE2, 0x67, 0x25, 0xE2, -+0xD6, 0xF2, 0xC8, 0x9E, 0x0B, 0x10, 0xD0, 0xF3, -+0x22, 0xA6, 0x10, 0xF0, 0x24, 0x6E, 0xD6, 0xF2, -+0xCC, 0x9E, 0x8C, 0xE9, 0x74, 0x49, 0x28, 0x31, -+0xE2, 0x67, 0x25, 0xE2, 0xD9, 0xE1, 0xC0, 0xA6, -+0x0C, 0x31, 0xFD, 0xE1, 0xCC, 0xEC, 0x10, 0xF0, -+0x30, 0x6E, 0x00, 0xF0, 0x00, 0x4E, 0xDD, 0xE7, -+0x80, 0xC7, 0x30, 0xF0, 0x21, 0x6E, 0xD0, 0xF3, -+0xE2, 0xA6, 0xFF, 0x6C, 0x1F, 0xF7, 0x00, 0x69, -+0x8C, 0xEF, 0x7C, 0x4F, 0xE8, 0x37, 0xFD, 0xE2, -+0x2C, 0xEF, 0x02, 0xF0, 0x00, 0x77, 0x08, 0x60, -+0xD0, 0xF3, 0xE2, 0xA6, 0x8C, 0xEF, 0x7C, 0x4F, -+0xE8, 0x37, 0xFD, 0xE2, 0x2C, 0xEF, 0x0E, 0x2F, -+0x30, 0xF0, 0x21, 0x6C, 0xD0, 0xF3, 0xE2, 0xA4, -+0xFF, 0x6C, 0x10, 0xF0, 0x24, 0x6E, 0x8C, 0xEF, -+0x7C, 0x4F, 0xE8, 0x37, 0xFD, 0xE2, 0xD6, 0xF2, -+0xC8, 0x9E, 0x0A, 0x10, 0xD0, 0xF3, 0xE2, 0xA6, -+0x10, 0xF0, 0x24, 0x6E, 0xD6, 0xF2, 0xCC, 0x9E, -+0x8C, 0xEF, 0x7C, 0x4F, 0xE8, 0x37, 0xFD, 0xE2, -+0xD9, 0xE7, 0xC0, 0xA6, 0x01, 0x4A, 0x04, 0x72, -+0xCC, 0xEC, 0x80, 0xC5, 0x01, 0x4D, 0x8D, 0x61, -+0x30, 0xF0, 0x21, 0x6A, 0xD0, 0xF3, 0xA2, 0xA2, -+0x01, 0x6C, 0xC4, 0x67, 0xC4, 0xED, 0xCF, 0xED, -+0xD0, 0xF3, 0xC2, 0xA2, 0xAC, 0xEB, 0xFF, 0x6D, -+0x84, 0xEE, 0x10, 0xF0, 0x24, 0x6E, 0x36, 0xF6, -+0xC0, 0x9E, 0xAC, 0xEC, 0x80, 0xC6, 0xD0, 0xF3, -+0x82, 0xA2, 0xAC, 0xEC, 0x01, 0x4C, 0xAC, 0xEC, -+0xD0, 0xF3, 0x82, 0xC2, 0xD0, 0xF3, 0xA2, 0xA2, -+0x03, 0x6C, 0xAC, 0xEC, 0xD0, 0xF3, 0x82, 0xC2, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0x40, 0xF0, 0x81, 0xA2, 0x08, 0x6D, 0x01, 0x4C, -+0x40, 0xF0, 0x81, 0xC2, 0x40, 0xF0, 0x81, 0xA2, -+0xAE, 0xEC, 0x1A, 0x2C, 0x40, 0xF0, 0x81, 0xC2, -+0x17, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, -+0x98, 0x9A, 0x02, 0x6E, 0x40, 0x9C, 0xCD, 0xEA, -+0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF6, -+0x44, 0x9A, 0x60, 0xC2, 0xD0, 0xF3, 0x62, 0xA5, -+0xFF, 0x6A, 0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF6, 0x48, 0x9A, 0x60, 0xC2, 0x02, 0x10, -+0x1F, 0xF7, 0x19, 0x2B, 0x03, 0x91, 0x02, 0x90, -+0x02, 0x63, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF6, -+0x4C, 0x9A, 0xFF, 0x68, 0x60, 0xA2, 0x6C, 0xE8, -+0x1D, 0x20, 0x00, 0x6B, 0x60, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x01, 0x6C, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF6, -+0x50, 0x9A, 0x20, 0x6B, 0x20, 0x70, 0x60, 0xC2, -+0x0D, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6C, 0x80, 0xF0, -+0x6C, 0x9A, 0x56, 0xF3, 0x90, 0x9C, 0x8D, 0xEB, -+0x80, 0xF0, 0x6C, 0xDA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x1C, 0x96, 0x45, 0x00, 0x18, 0xDC, 0xDF, -+0x05, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0xE9, 0xD4, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0xFF, 0x17, -+0xDE, 0x63, 0x43, 0x62, 0x42, 0xD1, 0x41, 0xD0, -+0x01, 0x6A, 0x7D, 0x67, 0x4B, 0xEA, 0x58, 0xC3, -+0x01, 0x6A, 0x5A, 0xC3, 0x08, 0x6A, 0x5B, 0xC3, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0xC1, 0xF7, 0x66, 0xA2, 0x76, 0x4B, 0x74, 0x33, -+0x69, 0xE2, 0x66, 0xA2, 0x7F, 0x6A, 0x6C, 0xEA, -+0x01, 0x72, 0x7E, 0x30, 0xE0, 0xF0, 0x03, 0x61, -+0x48, 0xA4, 0xBD, 0x67, 0x5C, 0xC5, 0x41, 0xA4, -+0x5D, 0xC5, 0x42, 0xA4, 0x5E, 0xC5, 0x46, 0xA4, -+0x20, 0xF0, 0x40, 0xC5, 0x43, 0xA4, 0x5F, 0xC5, -+0x47, 0xA4, 0x20, 0xF0, 0x41, 0xC5, 0x5C, 0xA5, -+0xC0, 0xF0, 0x0B, 0x2A, 0x7D, 0x67, 0x5F, 0xA3, -+0x7E, 0xA3, 0x40, 0x32, 0x6D, 0xEA, 0x03, 0x72, -+0x05, 0x60, 0x08, 0x72, 0x21, 0x60, 0x02, 0x72, -+0x37, 0x60, 0xBF, 0x10, 0x06, 0x20, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x5C, 0x9A, 0x06, 0x04, -+0x40, 0xEA, 0x9D, 0x67, 0x20, 0xF0, 0xE1, 0xA4, -+0x20, 0xF0, 0x40, 0xA4, 0xFF, 0xF7, 0x1F, 0x6B, -+0xE0, 0x37, 0x5D, 0xE7, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF5, 0x50, 0x9A, 0x30, 0xF0, 0x20, 0x6D, -+0x05, 0x6C, 0xEC, 0xF6, 0x06, 0x4D, 0x00, 0xF2, -+0x00, 0x6E, 0x6C, 0xEF, 0x40, 0xEA, 0xBC, 0x10, -+0xBD, 0x67, 0x30, 0xF0, 0x20, 0x6B, 0x10, 0x6A, -+0x5B, 0xC5, 0x30, 0xF0, 0x20, 0x69, 0x4E, 0xF2, -+0x50, 0x9B, 0x09, 0xF6, 0x04, 0x49, 0x09, 0x04, -+0xB1, 0x67, 0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6C, 0x4E, 0xF2, 0x50, 0x9C, 0xA4, 0x41, -+0x0A, 0x04, 0x04, 0x6E, 0x40, 0xEA, 0x89, 0x10, -+0x06, 0x20, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x06, 0x04, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0xEB, 0xF6, -+0x54, 0xA0, 0x01, 0x6D, 0xAC, 0xEA, 0x3C, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, 0x50, 0x9A, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, 0x4F, 0xF7, -+0xD4, 0xA3, 0x0C, 0x6C, 0x00, 0x6D, 0x40, 0xEA, -+0x68, 0xF3, 0x79, 0xA0, 0x21, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x02, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, -+0xEB, 0xF6, 0x60, 0xA0, 0x68, 0xF3, 0x59, 0xC0, -+0x04, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x18, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF6, -+0x54, 0x9A, 0xEB, 0xF6, 0xCC, 0x98, 0x00, 0x6B, -+0x40, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF2, -+0x50, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x73, 0xF6, -+0x01, 0x4C, 0x40, 0x9A, 0xA3, 0x67, 0x01, 0x6F, -+0x5B, 0xE6, 0x04, 0xD3, 0x00, 0x18, 0x69, 0xE6, -+0x5B, 0x10, 0x00, 0x18, 0x98, 0xE7, 0x58, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, 0x54, 0x9A, -+0x30, 0xF0, 0x20, 0x69, 0xCF, 0xF4, 0x00, 0x49, -+0x40, 0xEA, 0xEB, 0xF6, 0xB2, 0xA8, 0x00, 0x6C, -+0x00, 0x18, 0x42, 0xE7, 0x80, 0xF2, 0x94, 0xA1, -+0x00, 0x18, 0x50, 0xE9, 0x80, 0xF2, 0x94, 0xA1, -+0x00, 0x18, 0x3F, 0xE9, 0x80, 0xF2, 0x94, 0xA1, -+0x00, 0x18, 0x57, 0xE9, 0x68, 0xF3, 0x79, 0xA0, -+0x20, 0x6A, 0x08, 0x6C, 0x6D, 0xEA, 0x68, 0xF3, -+0x59, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x48, 0x9A, 0x80, 0xF2, 0xD4, 0xA1, 0x00, 0x6D, -+0x40, 0xEA, 0x89, 0xF0, 0x70, 0xA0, 0x02, 0x6A, -+0xFF, 0x6C, 0x6C, 0xEA, 0x8C, 0xEA, 0x05, 0x22, -+0x68, 0xF3, 0x59, 0xA0, 0x01, 0x6D, 0xAD, 0xEA, -+0x05, 0x10, 0x68, 0xF3, 0x79, 0xA0, 0x02, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x59, 0xC0, -+0x1B, 0x10, 0x1A, 0x20, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x5C, 0x9A, 0x13, 0x10, 0x14, 0x2A, -+0x69, 0xA4, 0xBD, 0x67, 0x7C, 0xC5, 0x68, 0xA4, -+0x5E, 0xC5, 0x5F, 0xC5, 0x7D, 0xC5, 0x46, 0xA4, -+0x20, 0xF0, 0x40, 0xC5, 0x67, 0xA4, 0x08, 0x20, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x5C, 0x9A, -+0x20, 0xF0, 0x61, 0xC5, 0x06, 0x04, 0x40, 0xEA, -+0x43, 0x97, 0x42, 0x91, 0x41, 0x90, 0x22, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x68, 0x44, 0xFA, 0x4B, -+0x4C, 0xEB, 0x04, 0x5B, 0x03, 0x60, 0x80, 0x18, -+0xEE, 0x13, 0x3D, 0x10, 0xFE, 0x4C, 0x4C, 0xEC, -+0x0C, 0x5C, 0x2D, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x88, 0x34, 0x76, 0xF1, 0x10, 0x4A, 0x89, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF5, 0x48, 0x9A, 0x08, 0x10, 0x85, 0x67, -+0x00, 0x18, 0x58, 0xE7, 0x28, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF5, 0x44, 0x9A, 0x85, 0x67, -+0x40, 0xEA, 0x21, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF5, 0x54, 0x9A, 0x40, 0xEA, 0x1B, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, 0x58, 0x9A, -+0xF2, 0x17, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF5, -+0x5C, 0x9A, 0xED, 0x17, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF5, 0x40, 0x9A, 0xE8, 0x17, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x56, 0xF3, 0x90, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0xFF, 0x6A, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x60, 0xA4, 0x01, 0x6A, -+0x04, 0x67, 0x4C, 0xEB, 0x68, 0x23, 0x61, 0xA4, -+0x08, 0x5B, 0x17, 0x60, 0x10, 0xF0, 0x24, 0x6C, -+0x56, 0xF6, 0xB8, 0x9C, 0xC7, 0x43, 0x22, 0x67, -+0xE0, 0x9D, 0x10, 0x4B, 0x01, 0x4E, 0x82, 0x67, -+0x24, 0xEB, 0x84, 0xEE, 0x71, 0x67, 0xED, 0xEB, -+0x8F, 0xEC, 0x6C, 0xEC, 0x60, 0xA0, 0x66, 0x33, -+0x4C, 0xEB, 0x64, 0xEE, 0x6D, 0xEC, 0x80, 0xDD, -+0x15, 0x10, 0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF6, -+0xDC, 0x9C, 0x87, 0x43, 0x01, 0x4C, 0xA0, 0x9E, -+0xE2, 0x67, 0xE4, 0xEC, 0x87, 0x67, 0xAD, 0xEC, -+0xA2, 0x67, 0xA4, 0xEB, 0xAF, 0xED, 0xAC, 0xEC, -+0xA0, 0xA0, 0xA6, 0x35, 0x4C, 0xED, 0xA4, 0xEB, -+0xAD, 0xEC, 0x80, 0xDE, 0x41, 0xA0, 0x08, 0x5A, -+0x07, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF6, -+0x98, 0x9B, 0x08, 0x4A, 0xA0, 0x9C, 0x05, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF6, 0x9C, 0x9B, -+0xA0, 0x9C, 0x01, 0x6B, 0x64, 0xEA, 0xAE, 0xEB, -+0x60, 0xDC, 0x80, 0xA0, 0x00, 0x6D, 0x92, 0x34, -+0x00, 0x18, 0xE2, 0xC5, 0x80, 0xA0, 0x01, 0x6D, -+0x22, 0x67, 0x92, 0x34, 0x00, 0x18, 0xE2, 0xC5, -+0x9D, 0x67, 0x24, 0x6B, 0x70, 0xC4, 0x08, 0x6B, -+0x6F, 0xCC, 0x22, 0x33, 0x73, 0xC4, 0x62, 0x33, -+0x74, 0xC4, 0x56, 0xC4, 0x42, 0x33, 0x00, 0xF6, -+0x42, 0x32, 0x59, 0xC4, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x58, 0x9A, 0x32, 0xC4, 0x77, 0xC4, -+0x00, 0xF6, 0x22, 0x31, 0x62, 0x33, 0x35, 0xC4, -+0x78, 0xC4, 0x04, 0x04, 0x40, 0xEA, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x24, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0x28, 0xF5, -+0x1C, 0x4C, 0xB1, 0x67, 0x05, 0x6E, 0x30, 0xF0, -+0x20, 0x68, 0x40, 0xEA, 0xC0, 0xF1, 0x08, 0x48, -+0x46, 0xA1, 0xC8, 0xF3, 0x99, 0xA0, 0x7F, 0x6B, -+0x5E, 0x32, 0x5C, 0x32, 0x8C, 0xEB, 0x4D, 0xEB, -+0xC8, 0xF3, 0x79, 0xC0, 0x46, 0xA1, 0x1F, 0x6C, -+0x68, 0xF3, 0xB7, 0xA0, 0x4C, 0xEC, 0x20, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x8D, 0xEA, 0xC8, 0xF3, -+0x59, 0xC0, 0x66, 0xA1, 0x03, 0x6C, 0xB6, 0x35, -+0x76, 0x33, 0x8C, 0xEB, 0x74, 0x34, 0x61, 0x6B, -+0x6B, 0xEB, 0x4C, 0xEB, 0x8D, 0xEB, 0x91, 0x67, -+0xC8, 0xF3, 0x79, 0xC0, 0x00, 0x18, 0x41, 0xCD, -+0x68, 0xF3, 0x58, 0xA0, 0x0C, 0x72, 0x04, 0x61, -+0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0xDB, 0xD6, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, -+0x4D, 0xF4, 0x0D, 0x4A, 0x08, 0xD4, 0x40, 0xDB, -+0x41, 0xA4, 0x24, 0x67, 0x06, 0xD2, 0x60, 0xA4, -+0x02, 0x6A, 0x6C, 0xEA, 0x06, 0x93, 0x07, 0xD3, -+0x02, 0x22, 0x42, 0xA4, 0x07, 0xD2, 0x06, 0x90, -+0x1C, 0x10, 0x08, 0x93, 0x01, 0x6D, 0x90, 0x67, -+0x40, 0xA3, 0x4C, 0xED, 0x00, 0x18, 0x62, 0xC5, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, -+0x90, 0x67, 0x40, 0xEA, 0x05, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF5, 0x54, 0x9A, 0x04, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, 0x50, 0x9A, -+0x90, 0x67, 0x40, 0xEA, 0x01, 0x48, 0xFF, 0x6A, -+0x4C, 0xE8, 0x07, 0x92, 0x03, 0xEA, 0xE1, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0x4F, 0xF7, 0x95, 0xA2, -+0x06, 0x92, 0x8E, 0xEA, 0x22, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF5, 0x58, 0x9A, 0x40, 0xEA, -+0x1C, 0x2A, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x00, 0x18, 0xFA, 0xE9, 0x68, 0xF3, -+0x97, 0xA0, 0x96, 0x34, 0x00, 0x18, 0xF4, 0xC9, -+0x68, 0xF3, 0x79, 0xA0, 0x05, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x68, 0xF3, 0x7A, 0xA0, 0x68, 0xF3, -+0x59, 0xC0, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x03, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x68, 0xF3, -+0x5A, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x60, 0xA1, -+0xCC, 0xF1, 0x50, 0xA2, 0x72, 0x34, 0x15, 0x2A, -+0x04, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x10, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF6, -+0x40, 0x9A, 0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x76, 0xF6, 0x64, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x96, 0xF2, 0x58, 0x9A, 0x60, 0xDA, -+0xF0, 0x17, 0x05, 0x74, 0x15, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xCC, 0xF1, 0x52, 0xA2, 0x10, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF6, 0x40, 0x9A, -+0x00, 0x6B, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF6, 0x68, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF2, 0x58, 0x9A, 0x60, 0xDA, 0xF0, 0x17, -+0x63, 0xA1, 0x07, 0x6A, 0x01, 0x6C, 0x6C, 0xEA, -+0x60, 0xA1, 0x8C, 0xEB, 0x1E, 0x2B, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x69, 0xF3, -+0xC8, 0xA3, 0x84, 0xEA, 0x1F, 0x6F, 0xCA, 0x35, -+0x8F, 0xEC, 0xEC, 0xED, 0x8C, 0xED, 0x7D, 0x6C, -+0x8B, 0xEC, 0xA8, 0x35, 0xCC, 0xEC, 0xAD, 0xEC, -+0x69, 0xF3, 0x88, 0xC3, 0x30, 0xF0, 0x20, 0x6C, -+0x4F, 0xF7, 0x94, 0xA4, 0x8E, 0xEA, 0x20, 0x2A, -+0x01, 0x6A, 0x4B, 0xEA, 0x69, 0xF3, 0x49, 0xC3, -+0x1B, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x69, 0xF3, 0xC8, 0xA3, 0x1F, 0x6F, -+0x84, 0xEA, 0xCA, 0x35, 0xEC, 0xED, 0xAD, 0xEC, -+0xEC, 0xEC, 0x88, 0x35, 0x7D, 0x6C, 0x8B, 0xEC, -+0xCC, 0xEC, 0xAD, 0xEC, 0x69, 0xF3, 0x88, 0xC3, -+0x30, 0xF0, 0x20, 0x6C, 0x4F, 0xF7, 0x94, 0xA4, -+0x8E, 0xEA, 0x02, 0x2A, 0x69, 0xF3, 0x89, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, 0x8C, 0xEB, -+0x1C, 0x23, 0x03, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x69, 0xF3, 0x68, 0xC2, 0x00, 0x18, 0xA9, 0xE5, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0x04, 0x93, -+0x4F, 0xF6, 0x54, 0x9A, 0x6E, 0xEA, 0x03, 0x22, -+0x04, 0x94, 0x00, 0x18, 0xCA, 0xE5, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF3, -+0x88, 0xA2, 0x02, 0x6B, 0x8D, 0xEB, 0x69, 0xF3, -+0x68, 0xC2, 0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, -+0x07, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, 0x68, 0x44, -+0xC8, 0x4B, 0x4C, 0xEB, 0x20, 0x5B, 0x05, 0x67, -+0x09, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0x4F, 0xF7, -+0x5B, 0xA2, 0xA0, 0xF0, 0x11, 0x2A, 0x80, 0x18, -+0xD9, 0x13, 0xAE, 0x10, 0x2C, 0x74, 0x69, 0x60, -+0x2D, 0x5C, 0x21, 0x60, 0x1E, 0x74, 0x59, 0x60, -+0x1F, 0x5C, 0x0D, 0x60, 0x03, 0x74, 0x45, 0x60, -+0x04, 0x5C, 0x04, 0x60, 0x3A, 0x24, 0x01, 0x74, -+0x3C, 0x60, 0x8F, 0x10, 0x04, 0x74, 0x41, 0x60, -+0x13, 0x74, 0x43, 0x60, 0x8A, 0x10, 0x21, 0x74, -+0x80, 0xF0, 0x16, 0x60, 0x22, 0x5C, 0x05, 0x60, -+0x1F, 0x74, 0x3F, 0x60, 0x20, 0x74, 0x45, 0x60, -+0x80, 0x10, 0x23, 0x74, 0x80, 0xF0, 0x0C, 0x60, -+0x27, 0x74, 0x43, 0x60, 0x7A, 0x10, 0x84, 0x74, -+0x5C, 0x60, 0x85, 0x5C, 0x0E, 0x60, 0x81, 0x74, -+0x4C, 0x60, 0x82, 0x5C, 0x05, 0x60, 0x2D, 0x74, -+0x40, 0x60, 0x80, 0x74, 0x42, 0x60, 0x6D, 0x10, -+0x82, 0x74, 0x47, 0x60, 0x83, 0x74, 0x49, 0x60, -+0x68, 0x10, 0x8C, 0x74, 0x52, 0x60, 0x8D, 0x5C, -+0x05, 0x60, 0x88, 0x74, 0x4A, 0x60, 0x89, 0x74, -+0x50, 0x60, 0x5F, 0x10, 0xC3, 0x74, 0x59, 0x60, -+0xC9, 0x74, 0x53, 0x60, 0x8F, 0x74, 0x4D, 0x60, -+0x58, 0x10, 0x85, 0x67, 0x00, 0x18, 0x90, 0xD8, -+0x63, 0x10, 0x85, 0x67, 0x00, 0x18, 0x13, 0xDB, -+0x5F, 0x10, 0x85, 0x67, 0x80, 0x18, 0x91, 0x07, -+0x5B, 0x10, 0x85, 0x67, 0x80, 0x18, 0xB5, 0x07, -+0x57, 0x10, 0x85, 0x67, 0x00, 0x18, 0x47, 0xC4, -+0x53, 0x10, 0x85, 0x67, 0x00, 0x18, 0xC4, 0xC3, -+0x4F, 0x10, 0x85, 0x67, 0x00, 0x18, 0x2D, 0xC4, -+0x4B, 0x10, 0x85, 0x67, 0x00, 0x18, 0xF0, 0xDA, -+0x47, 0x10, 0x85, 0x67, 0x00, 0x18, 0xAC, 0xC4, -+0x43, 0x10, 0x85, 0x67, 0x00, 0x18, 0x79, 0xC4, -+0x3F, 0x10, 0x85, 0x67, 0x00, 0x18, 0x9D, 0xD8, -+0x3B, 0x10, 0x85, 0x67, 0x80, 0x18, 0xF7, 0x0C, -+0x37, 0x10, 0x85, 0x67, 0x80, 0x18, 0x45, 0x0C, -+0x33, 0x10, 0x85, 0x67, 0x80, 0x18, 0x89, 0x0B, -+0x2F, 0x10, 0x85, 0x67, 0x80, 0x18, 0x8F, 0x0B, -+0x2B, 0x10, 0x85, 0x67, 0x80, 0x18, 0x97, 0x0B, -+0x27, 0x10, 0x85, 0x67, 0x80, 0x18, 0x9F, 0x0B, -+0x23, 0x10, 0x85, 0x67, 0x00, 0x18, 0xF6, 0xD1, -+0x1F, 0x10, 0x85, 0x67, 0x00, 0x18, 0x43, 0xDE, -+0x1B, 0x10, 0x85, 0x67, 0x80, 0x18, 0x67, 0x0A, -+0x17, 0x10, 0x85, 0x67, 0x00, 0x18, 0xB5, 0xDA, -+0x13, 0x10, 0x85, 0x67, 0x00, 0x18, 0x4D, 0xDD, -+0x0F, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, -+0x78, 0x9A, 0x01, 0x6D, 0x40, 0x9B, 0xAD, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF2, -+0x40, 0x9A, 0x80, 0xC2, 0x0E, 0x6A, 0x01, 0x10, -+0x00, 0x6A, 0x40, 0xC0, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0xCD, 0xF7, -+0x1D, 0x4A, 0x10, 0xF0, 0x30, 0x68, 0x40, 0xDB, -+0x00, 0xF0, 0x00, 0x48, 0x40, 0xF0, 0x40, 0xA0, -+0x40, 0xF0, 0x61, 0xA0, 0x4E, 0xEB, 0x29, 0x23, -+0x4C, 0x32, 0x0D, 0xE2, 0x80, 0xA3, 0xA1, 0x42, -+0xB5, 0xE0, 0x00, 0x18, 0x93, 0xDB, 0x40, 0xF0, -+0x40, 0xA0, 0x01, 0x4A, 0x40, 0xF0, 0x40, 0xC0, -+0x40, 0xF0, 0x60, 0xA0, 0x40, 0xF0, 0x41, 0xA0, -+0x6E, 0xEA, 0x0A, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x02, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, 0x6C, 0xDA, -+0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, -+0x40, 0xF0, 0x60, 0xA2, 0x08, 0x6C, 0x8E, 0xEB, -+0x02, 0x2B, 0x40, 0xF0, 0x60, 0xC2, 0x00, 0x18, -+0x47, 0xD9, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x30, 0x68, 0x00, 0xF0, -+0x00, 0x48, 0xC1, 0xF7, 0x66, 0xA0, 0x7F, 0x6C, -+0xA7, 0x43, 0x6F, 0x4D, 0xB4, 0x35, 0xB5, 0xE0, -+0x46, 0xA5, 0x8C, 0xEA, 0x20, 0x2A, 0x74, 0x33, -+0x69, 0xE0, 0xC1, 0xF6, 0x8E, 0xA2, 0xA2, 0x67, -+0xC1, 0xF6, 0x0F, 0x4D, 0x00, 0x18, 0x93, 0xDB, -+0xC1, 0xF7, 0x46, 0xA0, 0x10, 0xF0, 0x24, 0x6C, -+0x76, 0xF6, 0x8C, 0x9C, 0x54, 0x33, 0x6D, 0xE0, -+0xC1, 0xF6, 0xAC, 0xA3, 0x76, 0x4A, 0x54, 0x32, -+0xA0, 0xC4, 0xC1, 0xF6, 0x8D, 0xA3, 0x10, 0xF0, -+0x24, 0x6B, 0x76, 0xF6, 0x70, 0x9B, 0x41, 0xE0, -+0x80, 0xC3, 0x86, 0x40, 0x49, 0x10, 0x01, 0x72, -+0x49, 0x61, 0x74, 0x33, 0x6D, 0xE0, 0xC1, 0xF6, -+0x47, 0xA3, 0xFF, 0x72, 0x0C, 0x61, 0xC1, 0xF6, -+0x88, 0xA3, 0x06, 0x4D, 0x00, 0x18, 0x8F, 0xDA, -+0xC1, 0xF7, 0x66, 0xA0, 0x74, 0x33, 0x61, 0xE0, -+0xC1, 0xF6, 0x4E, 0xC0, 0x04, 0x10, 0x01, 0x6A, -+0x4B, 0xEA, 0xC1, 0xF6, 0x4E, 0xC3, 0x10, 0xF0, -+0x30, 0x6A, 0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, -+0x66, 0xA2, 0x10, 0xF0, 0x24, 0x6D, 0x76, 0xF6, -+0xAC, 0x9D, 0x74, 0x34, 0x91, 0xE2, 0xC1, 0xF6, -+0xCC, 0xA4, 0x76, 0x4B, 0x74, 0x33, 0xC0, 0xC5, -+0xC1, 0xF6, 0xAD, 0xA4, 0x10, 0xF0, 0x24, 0x6C, -+0x76, 0xF6, 0x90, 0x9C, 0x69, 0xE2, 0xA0, 0xC4, -+0x46, 0x82, 0x00, 0x52, 0x0B, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xF6, 0xF2, 0x94, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, -+0x76, 0x4B, 0x74, 0x33, 0x69, 0xE2, 0x86, 0x42, -+0x00, 0x18, 0x02, 0xDA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x6E, 0xF1, -+0x05, 0x4A, 0x10, 0xF0, 0x30, 0x68, 0x40, 0xDB, -+0x00, 0xF0, 0x00, 0x48, 0xC1, 0xF7, 0x66, 0xA0, -+0xC1, 0xF7, 0x47, 0xA0, 0x6E, 0xEA, 0x4A, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0xA0, 0xF0, 0x6E, 0xAA, 0x01, 0xF0, 0x00, 0x73, -+0x10, 0x60, 0xA0, 0xF0, 0x8F, 0xA2, 0xA0, 0xF0, -+0x4E, 0xA2, 0xAE, 0x42, 0x8E, 0xED, 0x09, 0x25, -+0x01, 0xF1, 0x01, 0x73, 0x06, 0x60, 0x01, 0xF1, -+0x00, 0x73, 0x03, 0x60, 0xFF, 0x4A, 0x4E, 0xEC, -+0x0D, 0x2C, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x80, 0xF0, 0x4C, 0x9B, 0x04, 0x6C, -+0x8D, 0xEA, 0x02, 0x6C, 0x8D, 0xEA, 0x80, 0xF0, -+0x4C, 0xDB, 0x24, 0x10, 0x00, 0x18, 0x19, 0xDC, -+0xC1, 0xF7, 0x46, 0xA0, 0x01, 0x4A, 0xC1, 0xF7, -+0x46, 0xC0, 0xC1, 0xF7, 0x66, 0xA0, 0xC1, 0xF7, -+0x47, 0xA0, 0x6E, 0xEA, 0x0A, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, -+0x6C, 0x9A, 0x02, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0xC1, 0xF7, 0x66, 0xA2, 0x08, 0x6C, -+0x8E, 0xEB, 0x02, 0x2B, 0xC1, 0xF7, 0x66, 0xC2, -+0x00, 0x18, 0xB2, 0xD8, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, 0x44, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEC, 0x40, 0xEA, -+0x05, 0x2A, 0x01, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x4F, 0xF7, 0x7C, 0xC2, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xE0, 0xF1, 0x14, 0x68, -+0x0A, 0xD4, 0x24, 0x67, 0x90, 0x67, 0x04, 0x05, -+0x00, 0x18, 0x8B, 0xDC, 0x7D, 0x67, 0x50, 0xA3, -+0x01, 0x48, 0xE0, 0xF1, 0x1A, 0x70, 0x40, 0xC1, -+0x01, 0x49, 0xF4, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x0C, 0xF0, 0x6D, 0xA2, -+0x0C, 0xF0, 0x8E, 0xA2, 0x6C, 0x33, 0x94, 0x34, -+0x8D, 0xEB, 0x0C, 0xF0, 0x8C, 0xA2, 0x8D, 0xEB, -+0x0A, 0x94, 0x66, 0xC4, 0x0C, 0xF0, 0x6F, 0xA2, -+0x0C, 0xF0, 0x50, 0xA2, 0x68, 0x33, 0x58, 0x32, -+0x4D, 0xEB, 0x33, 0x6A, 0x4D, 0xEB, 0x67, 0xC4, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xE0, 0xF1, 0x10, 0x68, -+0x0A, 0xD4, 0x24, 0x67, 0x90, 0x67, 0x04, 0x05, -+0x00, 0x18, 0x8B, 0xDC, 0x7D, 0x67, 0x50, 0xA3, -+0x01, 0x48, 0xE0, 0xF1, 0x14, 0x70, 0x40, 0xC1, -+0x01, 0x49, 0xF4, 0x61, 0xE0, 0xF1, 0x1C, 0x6C, -+0x04, 0x05, 0x00, 0x18, 0x8B, 0xDC, 0x7D, 0x67, -+0x50, 0xA3, 0x0A, 0x93, 0x44, 0xC3, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0x04, 0x00, -+0x90, 0x67, 0x00, 0x18, 0x95, 0xDC, 0xA0, 0xF1, -+0x02, 0x6A, 0x1F, 0xF7, 0x00, 0x6B, 0x4C, 0xEB, -+0x02, 0xF0, 0x00, 0x73, 0x01, 0x60, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF2, 0x68, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF2, -+0x6C, 0x9B, 0x80, 0xA0, 0x6D, 0xE2, 0x01, 0x4A, -+0xA0, 0xF1, 0x0A, 0x72, 0x80, 0xC3, 0x01, 0x48, -+0xE8, 0x61, 0x04, 0x00, 0x90, 0x67, 0x00, 0x18, -+0xAF, 0xDC, 0xA0, 0xF1, 0x0A, 0x6A, 0x1F, 0xF7, -+0x00, 0x6B, 0x4C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF2, 0x68, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF2, 0x6C, 0x9B, 0x80, 0xA0, -+0x6D, 0xE2, 0x01, 0x4A, 0xA0, 0xF1, 0x0F, 0x72, -+0x80, 0xC3, 0x01, 0x48, 0xE8, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x76, 0xF6, 0x54, 0x9A, 0x19, 0x6B, -+0x60, 0xC2, 0x09, 0x97, 0x08, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x0C, 0xF0, 0x4C, 0xA0, 0x0B, 0x2A, -+0xE0, 0xF1, 0x1A, 0x6C, 0x04, 0x05, 0x00, 0x18, -+0x8B, 0xDC, 0x9D, 0x67, 0x70, 0xA4, 0x07, 0x6A, -+0x6C, 0xEA, 0x0C, 0xF0, 0x4C, 0xC0, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x0C, 0xF0, -+0x4E, 0xA0, 0x0A, 0x2A, 0xE0, 0xF1, 0x1A, 0x6C, -+0x04, 0x05, 0x00, 0x18, 0x8B, 0xDC, 0x7D, 0x67, -+0x50, 0xA3, 0x56, 0x32, 0x0C, 0xF0, 0x4E, 0xC0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x0C, 0xF0, 0x4F, 0xA0, 0x0B, 0x2A, 0xE0, 0xF1, -+0x1D, 0x6C, 0x04, 0x05, 0x00, 0x18, 0x8B, 0xDC, -+0x9D, 0x67, 0x70, 0xA4, 0x03, 0x6A, 0x6C, 0xEA, -+0x0C, 0xF0, 0x4F, 0xC0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x0C, 0xF0, 0x50, 0xA0, -+0x0C, 0x2A, 0xE0, 0xF1, 0x1D, 0x6C, 0x04, 0x05, -+0x00, 0x18, 0x8B, 0xDC, 0x7D, 0x67, 0x50, 0xA3, -+0x30, 0x6B, 0x6C, 0xEA, 0x53, 0x32, 0x0C, 0xF0, -+0x50, 0xC0, 0x07, 0x97, 0x06, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0x04, 0x01, 0xC0, 0xF1, 0x08, 0x48, 0x01, 0x6A, -+0xE0, 0xF1, 0x1B, 0x6C, 0xB1, 0x67, 0x0C, 0xF0, -+0x48, 0xC0, 0x0C, 0xF0, 0x49, 0xC0, 0x0C, 0xF0, -+0x4A, 0xC0, 0x0C, 0xF0, 0x4B, 0xC0, 0x00, 0x18, -+0x8B, 0xDC, 0x9D, 0x67, 0x70, 0xA4, 0x07, 0x6A, -+0xE0, 0xF1, 0x1D, 0x6C, 0x6C, 0xEA, 0x0C, 0xF0, -+0x4C, 0xC0, 0x18, 0x6A, 0x6C, 0xEA, 0x4F, 0x32, -+0x76, 0x33, 0xB1, 0x67, 0x0C, 0xF0, 0x4D, 0xC0, -+0x0C, 0xF0, 0x6E, 0xC0, 0x00, 0x18, 0x8B, 0xDC, -+0x5D, 0x67, 0x70, 0xA2, 0x0C, 0x6A, 0x6C, 0xEA, -+0x4B, 0x32, 0x7A, 0x33, 0x0C, 0xF0, 0x4F, 0xC0, -+0x0C, 0xF0, 0x70, 0xC0, 0x00, 0x18, 0xE5, 0xDC, -+0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF6, 0x54, 0x9A, -+0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, 0xFD, 0x72, -+0x02, 0x61, 0x00, 0x18, 0xC0, 0xDC, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x22, 0x6A, 0x7D, 0x67, -+0x50, 0xC3, 0x01, 0x6A, 0x4F, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, 0x92, 0xC3, -+0x04, 0x04, 0x40, 0xEA, 0x09, 0x97, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x1A, 0x6A, 0x7D, 0x67, 0x50, 0xC3, 0x00, 0xF0, -+0x12, 0x04, 0x05, 0x6A, 0x4F, 0xCB, 0x00, 0x18, -+0xAF, 0xDC, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x58, 0x9A, 0x04, 0x04, 0x40, 0xEA, 0x09, 0x97, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x19, 0x6A, 0x7D, 0x67, 0x50, 0xC3, 0x00, 0xF0, -+0x12, 0x04, 0x08, 0x6A, 0x4F, 0xCB, 0x00, 0x18, -+0x95, 0xDC, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x58, 0x9A, 0x04, 0x04, 0x40, 0xEA, 0x09, 0x97, -+0x05, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x40, 0xA4, 0x01, 0x72, 0x04, 0x61, 0x00, 0x18, -+0x43, 0xDD, 0x00, 0x18, 0x39, 0xDD, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x00, 0x6B, 0x0C, 0xF5, -+0x7A, 0xC2, 0x00, 0x6B, 0x0C, 0xF5, 0x78, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x6A, 0x8C, 0xEA, -+0x08, 0x5A, 0x05, 0x60, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF6, 0x78, 0x9B, 0x05, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF6, 0x7C, 0x9B, 0xF8, 0x4A, -+0x01, 0x6C, 0xA0, 0x9B, 0x84, 0xEA, 0x00, 0xF6, -+0x80, 0x32, 0x4F, 0xEA, 0xAC, 0xEA, 0x40, 0xDB, -+0x40, 0x9B, 0x80, 0x34, 0x80, 0x34, 0x8F, 0xEC, -+0x4C, 0xEC, 0x80, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x4C, 0xEC, 0x08, 0x5C, 0xAC, 0xEA, -+0x05, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF6, -+0x78, 0x9B, 0x05, 0x10, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF6, 0x7C, 0x9B, 0xF8, 0x4C, 0x01, 0x6D, -+0xC0, 0x9B, 0xA4, 0xEC, 0x00, 0xF6, 0xA0, 0x34, -+0x8F, 0xEC, 0xCC, 0xEC, 0x80, 0xDB, 0xC0, 0x9B, -+0xA0, 0x35, 0xA0, 0x34, 0xCD, 0xEC, 0x80, 0xDB, -+0x04, 0x22, 0x40, 0x9B, 0xAD, 0xEA, 0x40, 0xDB, -+0x20, 0xE8, 0x40, 0x9B, 0xAF, 0xED, 0x4C, 0xED, -+0xA0, 0xDB, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6B, 0xAC, 0xEB, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x73, 0x8C, 0xEA, 0x05, 0x61, 0x30, 0xF0, -+0x20, 0x6B, 0xCE, 0xF4, 0x78, 0x9B, 0x04, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x7C, 0x9B, -+0x82, 0x67, 0x40, 0xEB, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x10, 0x92, 0xFF, 0x6B, -+0x6C, 0xED, 0x05, 0xD2, 0x04, 0xD5, 0x05, 0x95, -+0x6C, 0xEE, 0x6C, 0xEF, 0x6C, 0xED, 0x04, 0x93, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xEC, 0x06, 0xD6, -+0x07, 0xD7, 0x05, 0xD5, 0x88, 0x31, 0x03, 0x2B, -+0x94, 0x31, 0x4C, 0xE9, 0xD0, 0x49, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0xE8, 0xF3, -+0x7E, 0xA0, 0x4C, 0xE9, 0x20, 0x6A, 0x4C, 0xEB, -+0x28, 0x23, 0xE8, 0xF3, 0x7A, 0xA0, 0xFF, 0x6C, -+0x6C, 0xEA, 0x8C, 0xEA, 0x12, 0x22, 0xE8, 0xF3, -+0x9B, 0xA0, 0x7F, 0x6D, 0xFF, 0x6A, 0xAC, 0xEC, -+0x4C, 0xEC, 0x00, 0x6D, 0x00, 0x18, 0x68, 0xDD, -+0xE8, 0xF3, 0x9B, 0xA0, 0x7F, 0x6B, 0xFF, 0x6D, -+0x6C, 0xEC, 0xAC, 0xEC, 0x00, 0x18, 0x59, 0xDD, -+0x2C, 0x10, 0xE8, 0xF3, 0x9B, 0xA0, 0x7F, 0x6A, -+0xFF, 0x6B, 0x4C, 0xEC, 0x6C, 0xEC, 0x00, 0x18, -+0x59, 0xDD, 0xE8, 0xF3, 0x9B, 0xA0, 0x7F, 0x6D, -+0xFF, 0x6A, 0xAC, 0xEC, 0x4C, 0xEC, 0x00, 0x6D, -+0x1A, 0x10, 0xE8, 0xF3, 0xBA, 0xA0, 0xE8, 0xF3, -+0x9B, 0xA0, 0x01, 0x6A, 0x7F, 0x6B, 0xB6, 0x35, -+0x4E, 0xED, 0x6C, 0xEC, 0xFF, 0x6B, 0x6C, 0xEC, -+0x4C, 0xED, 0x00, 0x18, 0x68, 0xDD, 0xE8, 0xF3, -+0x9B, 0xA0, 0x7F, 0x6D, 0x01, 0x6A, 0xAC, 0xEC, -+0xE8, 0xF3, 0xBA, 0xA0, 0xFF, 0x6B, 0x6C, 0xEC, -+0xB6, 0x35, 0x4C, 0xED, 0x6C, 0xED, 0x00, 0x18, -+0x68, 0xDD, 0x07, 0x94, 0x00, 0xF1, 0x08, 0x24, -+0x04, 0x95, 0x91, 0x67, 0x00, 0x18, 0x7B, 0xDD, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xE8, 0xF3, 0xBE, 0xA2, 0x20, 0x6C, 0xFF, 0x6B, -+0x8C, 0xED, 0x14, 0x25, 0xE8, 0xF3, 0xBA, 0xA2, -+0xAC, 0xEC, 0x6C, 0xEC, 0x07, 0x24, 0xE8, 0xF3, -+0x5B, 0xA2, 0x7F, 0x6C, 0x00, 0x6D, 0x4C, 0xEC, -+0x6C, 0xEC, 0x13, 0x10, 0xE8, 0xF3, 0x5B, 0xA2, -+0x7F, 0x6C, 0x4C, 0xEC, 0x6C, 0xEC, 0x00, 0x18, -+0x59, 0xDD, 0x0D, 0x10, 0xE8, 0xF3, 0xBB, 0xA2, -+0x7F, 0x6C, 0xAC, 0xEC, 0xE8, 0xF3, 0xBA, 0xA2, -+0x01, 0x6A, 0x6C, 0xEC, 0xB6, 0x35, 0x4E, 0xED, -+0x4C, 0xED, 0x00, 0x18, 0x68, 0xDD, 0x05, 0x93, -+0x00, 0x68, 0xC0, 0xF0, 0x12, 0x23, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0xE8, 0xF3, -+0x5A, 0xA0, 0x01, 0x6C, 0x8C, 0xEA, 0xC0, 0xF0, -+0x0B, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF6, -+0x58, 0x9A, 0x60, 0xA2, 0x10, 0x6A, 0x6C, 0xEA, -+0xC0, 0xF0, 0x02, 0x2A, 0x04, 0x95, 0x91, 0x67, -+0x00, 0x18, 0x7B, 0xDD, 0xE8, 0xF3, 0x7E, 0xA0, -+0x20, 0x6A, 0xFF, 0x6D, 0x4C, 0xEB, 0xAC, 0xEB, -+0x15, 0x23, 0xE8, 0xF3, 0x7A, 0xA0, 0x6C, 0xEA, -+0xAC, 0xEA, 0x08, 0x22, 0xE8, 0xF3, 0x5B, 0xA0, -+0x7F, 0x6C, 0x4C, 0xEC, 0xAC, 0xEC, 0x00, 0x18, -+0x59, 0xDD, 0x16, 0x10, 0xE8, 0xF3, 0x5B, 0xA0, -+0x7F, 0x6C, 0x00, 0x6D, 0x4C, 0xEC, 0xFF, 0x6A, -+0x4C, 0xEC, 0x0C, 0x10, 0xE8, 0xF3, 0xBA, 0xA0, -+0xE8, 0xF3, 0x5B, 0xA0, 0x7F, 0x6C, 0xB6, 0x35, -+0x01, 0x6B, 0x4C, 0xEC, 0x6C, 0xED, 0xFF, 0x6A, -+0x4C, 0xEC, 0x4C, 0xED, 0x00, 0x18, 0x68, 0xDD, -+0x04, 0x95, 0x91, 0x67, 0x00, 0x18, 0x7B, 0xDD, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xE8, 0xF3, 0xBE, 0xA2, 0x20, 0x6C, 0xFF, 0x6B, -+0x8C, 0xED, 0x14, 0x25, 0xE8, 0xF3, 0xBA, 0xA2, -+0xAC, 0xEC, 0x6C, 0xEC, 0x07, 0x24, 0xE8, 0xF3, -+0x5B, 0xA2, 0x7F, 0x6C, 0x00, 0x6D, 0x4C, 0xEC, -+0x6C, 0xEC, 0x13, 0x10, 0xE8, 0xF3, 0x5B, 0xA2, -+0x7F, 0x6C, 0x4C, 0xEC, 0x6C, 0xEC, 0x00, 0x18, -+0x59, 0xDD, 0x9D, 0x17, 0xE8, 0xF3, 0xBB, 0xA2, -+0x7F, 0x6C, 0xAC, 0xEC, 0xE8, 0xF3, 0xBA, 0xA2, -+0x01, 0x6A, 0x6C, 0xEC, 0xB6, 0x35, 0x4E, 0xED, -+0x4C, 0xED, 0x00, 0x18, 0x68, 0xDD, 0x8F, 0x17, -+0x04, 0x95, 0x91, 0x67, 0x00, 0x18, 0x7B, 0xDD, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0xE8, 0xF3, 0xBE, 0xA3, 0x20, 0x6C, 0xFF, 0x6A, -+0x8C, 0xED, 0x14, 0x25, 0xE8, 0xF3, 0xBA, 0xA3, -+0xAC, 0xEC, 0x4C, 0xEC, 0x08, 0x24, 0xE8, 0xF3, -+0x7B, 0xA3, 0x7F, 0x6C, 0x6C, 0xEC, 0x4C, 0xEC, -+0x00, 0x18, 0x59, 0xDD, 0x14, 0x10, 0xE8, 0xF3, -+0x7B, 0xA3, 0x7F, 0x6C, 0x00, 0x6D, 0x6C, 0xEC, -+0x4C, 0xEC, 0x0B, 0x10, 0xE8, 0xF3, 0xBB, 0xA3, -+0x7F, 0x6C, 0xAC, 0xEC, 0xE8, 0xF3, 0xBA, 0xA3, -+0x01, 0x6B, 0x4C, 0xEC, 0xB6, 0x35, 0x6C, 0xED, -+0x4C, 0xED, 0x00, 0x18, 0x68, 0xDD, 0x04, 0x95, -+0x91, 0x67, 0x00, 0x18, 0x7B, 0xDD, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xE8, 0xF3, -+0xBE, 0xA2, 0x20, 0x6C, 0xFF, 0x6B, 0x8C, 0xED, -+0x14, 0x25, 0xE8, 0xF3, 0xBA, 0xA2, 0xAC, 0xEC, -+0x6C, 0xEC, 0x07, 0x24, 0xE8, 0xF3, 0x5B, 0xA2, -+0x7F, 0x6C, 0x00, 0x6D, 0x4C, 0xEC, 0x6C, 0xEC, -+0x13, 0x10, 0xE8, 0xF3, 0x5B, 0xA2, 0x7F, 0x6C, -+0x4C, 0xEC, 0x6C, 0xEC, 0x00, 0x18, 0x59, 0xDD, -+0x0D, 0x10, 0xE8, 0xF3, 0xBB, 0xA2, 0x7F, 0x6C, -+0xAC, 0xEC, 0xE8, 0xF3, 0xBA, 0xA2, 0x01, 0x6A, -+0x6C, 0xEC, 0xB6, 0x35, 0x4E, 0xED, 0x4C, 0xED, -+0x00, 0x18, 0x68, 0xDD, 0x01, 0x48, 0xFF, 0x6A, -+0x4C, 0xE8, 0x06, 0x93, 0x63, 0xE8, 0x9C, 0x61, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA4, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0x4F, 0xF6, -+0x00, 0x4C, 0x07, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x69, -+0x36, 0xF4, 0x2C, 0x99, 0x0E, 0x93, 0xFF, 0x6A, -+0x20, 0xA1, 0x4C, 0xED, 0x4C, 0xEE, 0x19, 0x65, -+0x38, 0x67, 0x4C, 0xEF, 0x4C, 0xEB, 0x2C, 0xEA, -+0x30, 0xF0, 0x20, 0x69, 0x4F, 0xF6, 0x21, 0xA1, -+0xFF, 0xF7, 0x1F, 0x68, 0x0C, 0xEC, 0x2E, 0xEA, -+0x06, 0x2A, 0x03, 0x6A, 0x58, 0xEC, 0x04, 0xD3, -+0x12, 0xEC, 0x0C, 0xEC, 0x01, 0x10, 0x04, 0xD3, -+0x00, 0x18, 0x87, 0xDD, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD0, 0x30, 0xF0, -+0x20, 0x6B, 0xCF, 0xF4, 0x00, 0x4B, 0x80, 0xF1, -+0xA0, 0xA3, 0x3F, 0x6C, 0xFF, 0x6A, 0xAC, 0xEC, -+0x01, 0x74, 0x80, 0xF0, 0x16, 0x60, 0x02, 0x74, -+0x1C, 0x61, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0xE8, 0xF3, 0xBC, 0xA3, 0x7F, 0x6C, -+0xE8, 0xF3, 0x1D, 0xA3, 0xAC, 0xEC, 0xE8, 0xF3, -+0xBE, 0xA3, 0xE8, 0xF3, 0x7C, 0xA3, 0x01, 0x6F, -+0xAA, 0x35, 0xEC, 0xED, 0x06, 0x36, 0x0C, 0xEF, -+0x7E, 0x33, 0x4C, 0xEC, 0x4C, 0xED, 0x4C, 0xEE, -+0x4C, 0xEF, 0x04, 0xD3, 0x00, 0x18, 0x4B, 0xDE, -+0x78, 0x10, 0x3F, 0x74, 0x1A, 0x61, 0x10, 0xF0, -+0x24, 0x6C, 0x36, 0xF4, 0x8C, 0x9C, 0x80, 0xF1, -+0xA1, 0xA3, 0x80, 0xA4, 0x4C, 0xEC, 0xAE, 0xEC, -+0x51, 0x2C, 0x80, 0xF1, 0xA2, 0xA3, 0x7F, 0x6C, -+0x80, 0xF1, 0x03, 0xA3, 0xAC, 0xEC, 0x80, 0xF1, -+0xA0, 0xA3, 0x01, 0x6F, 0x06, 0x36, 0xBA, 0x35, -+0xEC, 0xED, 0x80, 0xF1, 0x62, 0xA3, 0x0C, 0xEF, -+0x54, 0x10, 0x3E, 0x74, 0x3F, 0x61, 0x10, 0xF0, -+0x24, 0x6C, 0x36, 0xF4, 0x8C, 0x9C, 0x80, 0xF1, -+0xA1, 0xA3, 0x80, 0xA4, 0x4C, 0xEC, 0xAE, 0xEC, -+0x17, 0x2C, 0x80, 0xF1, 0xA2, 0xA3, 0x7F, 0x6C, -+0x80, 0xF1, 0x03, 0xA3, 0xAC, 0xEC, 0x80, 0xF1, -+0xA0, 0xA3, 0x80, 0xF1, 0x62, 0xA3, 0x01, 0x6F, -+0xBA, 0x35, 0xEC, 0xED, 0x06, 0x36, 0x0C, 0xEF, -+0x7E, 0x33, 0x4C, 0xEC, 0x4C, 0xED, 0x4C, 0xEE, -+0x4C, 0xEF, 0x04, 0xD3, 0x00, 0x18, 0x87, 0xDD, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, -+0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF4, 0x00, 0x4B, -+0x80, 0xA2, 0x80, 0xF1, 0xA4, 0xA3, 0xFF, 0x6A, -+0x4C, 0xEC, 0xAE, 0xEC, 0x0F, 0x2C, 0x80, 0xF1, -+0xA5, 0xA3, 0x7F, 0x6C, 0x80, 0xF1, 0x06, 0xA3, -+0xAC, 0xEC, 0x80, 0xF1, 0xA0, 0xA3, 0x01, 0x6F, -+0x06, 0x36, 0xBE, 0x35, 0x0C, 0xEF, 0x80, 0xF1, -+0x65, 0xA3, 0x13, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xE8, 0xF3, 0xBC, 0xA3, -+0x7F, 0x6C, 0xE8, 0xF3, 0x1D, 0xA3, 0xAC, 0xEC, -+0xE8, 0xF3, 0xBE, 0xA3, 0xE8, 0xF3, 0x7C, 0xA3, -+0x01, 0x6F, 0xAA, 0x35, 0xEC, 0xED, 0x06, 0x36, -+0x0C, 0xEF, 0x7E, 0x33, 0x4C, 0xEC, 0x4C, 0xED, -+0x4C, 0xEE, 0x4C, 0xEF, 0x04, 0xD3, 0x00, 0x18, -+0x87, 0xDD, 0x07, 0x97, 0x06, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0xF7, 0x1F, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0x8C, 0xEA, 0x76, 0xF6, -+0x7C, 0x9B, 0x10, 0xF0, 0x24, 0x6C, 0x96, 0xF6, -+0x80, 0x9C, 0xCC, 0xEB, 0x40, 0xF6, 0xA0, 0x35, -+0x8D, 0xEB, 0x1F, 0xF7, 0x00, 0x6C, 0x4C, 0xEC, -+0x02, 0xF0, 0x00, 0x74, 0xAD, 0xEB, 0x01, 0x60, -+0x05, 0x2C, 0x10, 0xF0, 0x24, 0x6C, 0xD6, 0xF2, -+0x88, 0x9C, 0x04, 0x10, 0x10, 0xF0, 0x24, 0x6C, -+0xD6, 0xF2, 0x8C, 0x9C, 0x89, 0xE2, 0x60, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0xF7, 0x1F, 0x6A, -+0x8C, 0xEA, 0x1F, 0xF7, 0x00, 0x6C, 0x4C, 0xEC, -+0xFF, 0x6B, 0x02, 0xF0, 0x00, 0x74, 0xAC, 0xEB, -+0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, 0x24, 0x6C, -+0xD6, 0xF2, 0x88, 0x9C, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF2, 0x8C, 0x9C, 0x91, 0xE2, -+0x00, 0x6D, 0xA0, 0xDC, 0x10, 0xF0, 0x24, 0x6C, -+0x76, 0xF6, 0x9C, 0x9C, 0xD4, 0x36, 0x40, 0xF6, -+0x60, 0x33, 0x8C, 0xEE, 0x6D, 0xEE, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF6, 0x60, 0x9B, 0x6D, 0xEE, -+0x1F, 0xF7, 0x00, 0x6B, 0x4C, 0xEB, 0x02, 0xF0, -+0x00, 0x73, 0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF2, 0x68, 0x9B, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF2, 0x6C, 0x9B, -+0x69, 0xE2, 0xC0, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x0F, 0xF5, 0x00, 0x6B, 0x78, 0xEE, 0xFF, 0xF7, -+0x1F, 0x6A, 0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6C, -+0x76, 0xF6, 0x9C, 0x9C, 0x40, 0xF6, 0xA0, 0x35, -+0x12, 0xEB, 0x8C, 0xEB, 0x10, 0xF0, 0x24, 0x6C, -+0x96, 0xF6, 0x80, 0x9C, 0xAD, 0xEB, 0x8D, 0xEB, -+0x1F, 0xF7, 0x00, 0x6C, 0x4C, 0xEC, 0x02, 0xF0, -+0x00, 0x74, 0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF2, 0x88, 0x9C, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6C, 0xD6, 0xF2, 0x8C, 0x9C, -+0x89, 0xE2, 0x60, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF6, 0x50, 0x9A, -+0x40, 0x9A, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x4C, 0x9B, 0x8D, 0xEA, -+0x4C, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF6, -+0x64, 0x9B, 0x80, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xB6, 0xF6, 0x68, 0x9B, 0x40, 0xDB, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0xB6, 0xF6, 0x6C, 0x9A, 0xC0, 0x6A, -+0xFF, 0x68, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0xB6, 0xF6, 0x50, 0x9A, 0x01, 0x6B, 0x05, 0x97, -+0x40, 0xA2, 0x0C, 0xEA, 0x5E, 0x32, 0x6E, 0xEA, -+0x6C, 0xEA, 0x0C, 0xEA, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, -+0x78, 0x9B, 0x10, 0xF0, 0x23, 0x6A, 0x4F, 0xF4, -+0x15, 0x4A, 0x40, 0xDB, 0x00, 0x68, 0x28, 0x10, -+0x82, 0xF3, 0x08, 0x70, 0x11, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, 0x02, 0xF0, -+0x00, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, -+0x03, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, 0x18, 0x10, -+0xFF, 0xF7, 0x1F, 0x6A, 0x01, 0x48, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x14, 0x6C, 0x40, 0xEA, 0x33, 0x58, 0x08, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF6, 0x58, 0x9A, -+0x60, 0xA2, 0x08, 0x6A, 0x6C, 0xEA, 0x04, 0x2A, -+0x00, 0x18, 0x04, 0xDF, 0x01, 0x72, 0xD4, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, -+0x02, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, -+0x23, 0x6A, 0x4F, 0xF4, 0x16, 0x4A, 0x40, 0xDB, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0x05, 0x5C, 0x5E, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x88, 0x34, 0xB6, 0xF1, 0x14, 0x4A, 0x89, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x48, 0x9B, 0xAD, 0xEA, 0xC0, 0xF1, -+0x48, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF6, -+0x70, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xB6, 0xF6, 0x74, 0x9B, 0x32, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x41, 0x9B, -+0xAD, 0xEA, 0x41, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF4, 0x74, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xB6, 0xF6, 0x78, 0x9B, 0x21, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x42, 0x9B, 0xAD, 0xEA, 0x42, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xB6, 0xF6, 0x7C, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF6, 0x60, 0x9B, -+0x10, 0x10, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x43, 0x9B, 0xAD, 0xEA, 0x43, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF6, 0x64, 0x9B, -+0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF6, -+0x68, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x44, 0x9B, -+0xAD, 0xEA, 0x44, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF6, 0x6C, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF6, 0x70, 0x9B, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x05, 0x5C, 0x63, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, 0xD6, 0xF1, -+0x08, 0x4A, 0x89, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x88, 0x9B, -+0xAF, 0xEA, 0x8C, 0xEA, 0xC0, 0xF1, 0x48, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF6, 0x74, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF6, -+0x50, 0x9A, 0x35, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x81, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x41, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xB6, 0xF6, 0x78, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF4, 0x54, 0x9A, 0x23, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x82, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x42, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF6, 0x60, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF6, -+0x5C, 0x9A, 0x11, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x83, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x43, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF6, 0x68, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF6, 0x44, 0x9A, 0xA0, 0xDA, -+0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x84, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, -+0x44, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF6, -+0x70, 0x9B, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF6, 0x4C, 0x9A, 0xA0, 0xDA, 0x20, 0xE8, -+0x01, 0x74, 0x15, 0x60, 0x03, 0x24, 0x02, 0x74, -+0x23, 0x60, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x4E, 0x9B, 0xAD, 0xEA, -+0x4E, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF3, -+0x64, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF6, 0x74, 0x9B, 0x21, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, 0x4F, 0x9B, -+0xAD, 0xEA, 0x4F, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF6, 0x78, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF6, 0x7C, 0x9B, 0x10, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x50, 0x9B, 0xAD, 0xEA, 0x50, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xF6, 0xF6, 0x60, 0x9B, 0xA0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF6, 0x64, 0x9B, -+0x40, 0xDB, 0x20, 0xE8, 0x01, 0x74, 0x16, 0x60, -+0x03, 0x24, 0x02, 0x74, 0x25, 0x60, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x8E, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x4E, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF6, 0x74, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, -+0x44, 0x9A, 0x23, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x8F, 0x9B, 0xAF, 0xEA, -+0x8C, 0xEA, 0x4F, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF6, 0x7C, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF6, 0x58, 0x9A, 0x11, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x90, 0x9B, 0xAF, 0xEA, 0x8C, 0xEA, 0x50, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF6, 0x64, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF6, -+0x40, 0x9A, 0xA0, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6C, 0xB6, 0xF6, 0x94, 0x9C, -+0x00, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x48, 0xDB, 0xC0, 0xF1, 0x08, 0x4B, 0x41, 0xDB, -+0x42, 0xDB, 0x43, 0xDB, 0x44, 0xDB, 0x40, 0xDC, -+0x10, 0xF0, 0x24, 0x6C, 0xB6, 0xF6, 0x98, 0x9C, -+0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6C, 0xD6, 0xF6, -+0x80, 0x9C, 0x40, 0xDC, 0x10, 0xF0, 0x24, 0x6C, -+0xD6, 0xF6, 0x88, 0x9C, 0x40, 0xDC, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF6, 0x90, 0x9C, 0x40, 0xDC, -+0x10, 0xF0, 0x24, 0x6C, 0xD6, 0xF6, 0x94, 0x9C, -+0x4E, 0xDB, 0x4F, 0xDB, 0x40, 0xDC, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF6, 0x9C, 0x9C, 0x40, 0xDC, -+0x10, 0xF0, 0x24, 0x6C, 0xF6, 0xF6, 0x84, 0x9C, -+0x50, 0xDB, 0x40, 0xDC, 0x4C, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xB6, 0xF6, 0x68, 0x9B, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF6, 0x70, 0x9B, 0x01, 0x6A, 0x4B, 0xEA, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF4, -+0x74, 0x9B, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xB6, 0xF6, 0x7C, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF6, 0x64, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF3, 0x64, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF6, -+0x78, 0x9B, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xF6, 0xF6, 0x64, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xB6, 0xF6, 0x64, 0x9B, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0x05, 0x5C, 0x4C, 0xED, 0x00, 0x6A, 0x61, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0x88, 0x34, 0xD6, 0xF1, -+0x1C, 0x4A, 0x89, 0xE2, 0x40, 0x9A, 0x00, 0xEA, -+0x05, 0x2D, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF6, -+0x50, 0x9A, 0x0A, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF6, 0x50, 0x9A, 0x0C, 0x10, 0x07, 0x2D, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF6, 0x54, 0x9A, -+0x60, 0xA2, 0x01, 0x6A, 0x39, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF6, 0x54, 0x9A, 0x60, 0xA2, -+0xFF, 0x6A, 0x6C, 0xEA, 0x46, 0x32, 0x2F, 0x10, -+0x09, 0x2D, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF6, -+0x54, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, -+0x4A, 0x32, 0x25, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF6, 0x54, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0x4E, 0x32, 0x1C, 0x10, 0x09, 0x2D, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF6, 0x54, 0x9A, -+0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, 0x52, 0x32, -+0x12, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF6, -+0x54, 0x9A, 0x60, 0xA2, 0xFF, 0x6A, 0x6C, 0xEA, -+0x56, 0x32, 0x09, 0x10, 0x0B, 0x2D, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF6, 0x54, 0x9A, 0x60, 0xA2, -+0xFF, 0x6A, 0x6C, 0xEA, 0x5A, 0x32, 0x01, 0x6B, -+0x6C, 0xEA, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF6, 0x54, 0x9A, 0x40, 0xA2, 0x00, 0xF6, -+0x40, 0x32, 0x00, 0xF6, 0x43, 0x32, 0xC0, 0xF7, -+0x42, 0x32, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x69, 0x8C, 0xE9, -+0x00, 0x68, 0xFF, 0x6A, 0x0C, 0xEA, 0x2E, 0xEA, -+0x10, 0x2A, 0x91, 0x67, 0x00, 0x18, 0x2A, 0xE9, -+0x91, 0x67, 0x00, 0x18, 0x19, 0xE9, 0x91, 0x67, -+0x00, 0x18, 0x31, 0xE9, 0x91, 0x67, 0x00, 0x18, -+0xEB, 0xE8, 0x91, 0x67, 0x00, 0x18, 0xF8, 0xE8, -+0x0F, 0x10, 0x90, 0x67, 0x00, 0x18, 0x50, 0xE9, -+0x90, 0x67, 0x00, 0x18, 0x3F, 0xE9, 0x90, 0x67, -+0x00, 0x18, 0x57, 0xE9, 0x90, 0x67, 0x00, 0x18, -+0x0F, 0xE9, 0x90, 0x67, 0x00, 0x18, 0x05, 0xE9, -+0x01, 0x48, 0x05, 0x70, 0xDA, 0x61, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0xFF, 0xF7, 0x1F, 0x69, -+0x8C, 0xE9, 0xD6, 0xF4, 0x88, 0x9A, 0xFF, 0x6B, -+0x8E, 0x6A, 0xA0, 0xA4, 0x00, 0x68, 0x6C, 0xED, -+0xAC, 0xEA, 0x40, 0xC4, 0x71, 0x6A, 0xAD, 0xEA, -+0x6C, 0xEA, 0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF6, 0x9C, 0x9A, 0x01, 0x6D, 0x40, 0xA4, -+0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, -+0x19, 0x10, 0x64, 0x70, 0x0D, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x56, 0xF3, 0x94, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x6A, 0x1C, 0x10, -+0xFF, 0xF7, 0x1F, 0x6A, 0x01, 0x48, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x0A, 0x6C, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF6, 0x5C, 0x9A, 0x60, 0xA2, 0x01, 0x6A, -+0x6C, 0xEA, 0xDF, 0x2A, 0xFF, 0xF7, 0x1F, 0x6A, -+0x01, 0x49, 0x4C, 0xE9, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF3, 0x48, 0x9A, 0x20, 0xCA, 0x01, 0x6A, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0xFF, 0x69, 0x4E, 0xF2, 0x4C, 0x9B, 0x2C, 0xED, -+0xFF, 0xF7, 0x1F, 0x68, 0x11, 0xD7, 0x8C, 0xE8, -+0x08, 0xD5, 0x04, 0x04, 0x00, 0x6D, 0xCC, 0xE9, -+0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x4C, 0x9B, 0x05, 0x04, 0x00, 0x6D, -+0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x50, 0x9B, 0x11, 0x95, 0x04, 0x04, -+0x04, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x50, 0x9B, 0x12, 0x95, 0x06, 0x04, -+0x04, 0x6E, 0x40, 0xEA, 0x00, 0xF1, 0x00, 0x58, -+0x08, 0x61, 0x0E, 0xF0, 0x40, 0x40, 0xFF, 0xF7, -+0x1F, 0x6B, 0x6C, 0xEA, 0x00, 0xF1, 0x00, 0x5A, -+0x39, 0x60, 0x08, 0x92, 0x04, 0x72, 0x11, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x48, 0x9A, -+0xFF, 0x6B, 0x49, 0xE0, 0x40, 0xA2, 0x4C, 0xEB, -+0x5F, 0x21, 0x06, 0x94, 0x8F, 0xEA, 0x6C, 0xEA, -+0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, 0x04, 0xD2, -+0x57, 0x10, 0x08, 0x92, 0x05, 0x72, 0x12, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x48, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6B, 0x49, 0xE0, 0x40, 0xAA, -+0x4C, 0xEB, 0x7F, 0x21, 0x06, 0x94, 0x8F, 0xEA, -+0x6C, 0xEA, 0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, -+0x04, 0xD2, 0x77, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF2, 0x48, 0x9A, 0x49, 0xE0, 0x60, 0x9A, -+0x80, 0xF0, 0x1E, 0x21, 0x06, 0x94, 0x8F, 0xEA, -+0x6C, 0xEA, 0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, -+0x04, 0xD2, 0x96, 0x10, 0x01, 0xF0, 0x00, 0x58, -+0x09, 0x61, 0x0D, 0xF7, 0x40, 0x40, 0xFF, 0xF7, -+0x1F, 0x6B, 0x6C, 0xEA, 0x00, 0xF7, 0x00, 0x5A, -+0x80, 0xF0, 0x17, 0x60, 0x08, 0x92, 0x04, 0x72, -+0x31, 0x61, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x48, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x4C, 0x9A, 0x49, 0xE0, 0x60, 0xA2, 0xFF, 0x6A, -+0x6C, 0xEA, 0x07, 0x21, 0x06, 0x94, 0x8F, 0xEB, -+0x4C, 0xEB, 0x04, 0x92, 0x8C, 0xEA, 0x4D, 0xEB, -+0x04, 0xD3, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x48, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x4C, 0x9A, 0x7D, 0x67, 0x41, 0xE0, 0x50, 0xA3, -+0x40, 0xC0, 0x7E, 0x10, 0x08, 0x92, 0x05, 0x72, -+0x32, 0x61, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x48, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x4C, 0x9A, 0x49, 0xE0, 0x60, 0xAA, 0xFF, 0xF7, -+0x1F, 0x6A, 0x6C, 0xEA, 0x07, 0x21, 0x06, 0x94, -+0x8F, 0xEB, 0x4C, 0xEB, 0x04, 0x92, 0x8C, 0xEA, -+0x4D, 0xEB, 0x04, 0xD3, 0x1F, 0xF7, 0x00, 0x6A, -+0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, -+0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x48, 0x9A, 0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF2, 0x4C, 0x9A, 0x7D, 0x67, 0x41, 0xE0, -+0x48, 0xAB, 0x40, 0xC8, 0x49, 0x10, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF2, 0x48, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF2, 0x4C, 0x9A, 0x49, 0xE0, -+0x60, 0x9A, 0x07, 0x21, 0x06, 0x94, 0x8F, 0xEA, -+0x6C, 0xEA, 0x04, 0x93, 0x8C, 0xEB, 0x6D, 0xEA, -+0x04, 0xD2, 0x1F, 0xF7, 0x00, 0x6A, 0x0C, 0xEA, -+0x02, 0xF0, 0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x48, 0x9A, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x4C, 0x9A, 0x41, 0xE0, 0x04, 0x92, 0x40, 0xD8, -+0x1B, 0x10, 0xFF, 0xF7, 0x1C, 0x6A, 0x0C, 0xEA, -+0x01, 0x6D, 0x82, 0x67, 0xAB, 0xED, 0x08, 0xD2, -+0x00, 0x18, 0x5C, 0xE3, 0x05, 0xD2, 0x07, 0x21, -+0x06, 0x94, 0x8F, 0xEB, 0x4C, 0xEB, 0x04, 0x92, -+0x8C, 0xEA, 0x4D, 0xEB, 0x04, 0xD3, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x08, 0x94, -+0x04, 0x96, 0x01, 0x6D, 0xAB, 0xED, 0x40, 0xEA, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x41, 0x9C, 0x61, 0xA4, -+0x01, 0xAC, 0x06, 0xD2, 0x42, 0x9C, 0xFF, 0x73, -+0x07, 0xD2, 0x00, 0x6A, 0x59, 0x60, 0x7F, 0x6D, -+0x6C, 0xED, 0x4C, 0x45, 0xFF, 0x6B, 0x6C, 0xEA, -+0x0E, 0x5A, 0x08, 0x60, 0x10, 0xF0, 0x24, 0x6B, -+0x48, 0x32, 0xF6, 0xF1, 0x10, 0x4B, 0x4D, 0xE3, -+0x40, 0x9B, 0x00, 0xEA, 0x03, 0x6A, 0x48, 0x10, -+0x61, 0xA4, 0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0xFF, 0x6E, 0x07, 0x03, 0x90, 0x67, 0x4C, 0xEE, -+0x06, 0x07, 0x04, 0xD3, 0x00, 0x18, 0x87, 0xE0, -+0x1F, 0x10, 0x81, 0xA4, 0x80, 0x6A, 0xFF, 0x69, -+0x64, 0x67, 0x4C, 0xEB, 0x0C, 0xE9, 0x02, 0x32, -+0x01, 0x6E, 0x82, 0x67, 0xB1, 0x67, 0xCB, 0xEE, -+0x08, 0xD3, 0x09, 0xD2, 0x00, 0x18, 0xA7, 0xE3, -+0x08, 0x93, 0x07, 0x23, 0x07, 0x94, 0x8F, 0xEB, -+0x4C, 0xEB, 0x06, 0x92, 0x8C, 0xEA, 0x4D, 0xEB, -+0x06, 0xD3, 0x09, 0x94, 0x06, 0x97, 0x01, 0x6E, -+0xB1, 0x67, 0xCB, 0xEE, 0x00, 0x18, 0xBA, 0xE3, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x29, 0xF4, 0x7C, 0x9A, 0x06, 0x94, 0x61, 0xE0, -+0x49, 0xF4, 0x60, 0x9A, 0x29, 0xF4, 0x1C, 0xDA, -+0x6D, 0xE4, 0x49, 0xF4, 0x60, 0xDA, 0x0B, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, -+0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x58, 0x9A, 0x90, 0x67, 0x40, 0xEA, 0x01, 0x6A, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xB6, 0xF6, 0x84, 0x9A, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xA0, 0x9C, 0x4C, 0x9B, -+0xAC, 0xEA, 0x4D, 0xDB, 0x40, 0xDC, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0xD1, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF6, 0x30, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF4, 0x14, 0x4A, 0x40, 0x9A, -+0x60, 0x99, 0x10, 0xF0, 0x24, 0x6C, 0xA0, 0x9A, -+0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF6, 0x5C, 0x9A, -+0xD6, 0xF6, 0x04, 0x4C, 0x80, 0x9C, 0x00, 0x9A, -+0x1A, 0x65, 0x10, 0xF0, 0x24, 0x6A, 0x80, 0x9C, -+0xD6, 0xF6, 0x0C, 0x4A, 0x40, 0x9A, 0x01, 0xD4, -+0x30, 0xF0, 0x20, 0x6C, 0x40, 0x9A, 0xC0, 0xF1, -+0xE8, 0x9C, 0x00, 0xD2, 0x44, 0x67, 0xC0, 0xF1, -+0x08, 0x4A, 0xC1, 0x9A, 0x83, 0x9A, 0x6C, 0xEF, -+0xAC, 0xEE, 0x01, 0x93, 0xA2, 0x9A, 0xE5, 0xDA, -+0x6C, 0xEC, 0x0C, 0xED, 0x64, 0x9A, 0x00, 0x90, -+0x88, 0xDA, 0xC6, 0xDA, 0x0C, 0xEB, 0xA7, 0xDA, -+0x69, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF4, -+0x14, 0x4A, 0x40, 0x9A, 0xE0, 0xD9, 0x18, 0x67, -+0xC0, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF6, -+0x04, 0x4A, 0x40, 0x9A, 0xA0, 0xD8, 0x80, 0xDA, -+0x10, 0xF0, 0x24, 0x6C, 0xD6, 0xF6, 0x0C, 0x4C, -+0x80, 0x9C, 0x60, 0xDC, 0x05, 0x91, 0x04, 0x90, -+0x03, 0x63, 0x20, 0xE8, 0xFF, 0x63, 0x01, 0xD1, -+0x00, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, -+0x04, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF6, -+0xF8, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF6, -+0xC0, 0x9A, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x80, 0x98, 0xAE, 0x9A, 0x60, 0x9F, -+0x20, 0x9E, 0x8C, 0xED, 0x8F, 0x9A, 0xB1, 0xDA, -+0x6C, 0xEC, 0x70, 0x9A, 0x92, 0xDA, 0x2C, 0xEB, -+0x73, 0xDA, 0xA0, 0xD8, 0x80, 0xDF, 0x60, 0xDE, -+0x01, 0x91, 0x00, 0x90, 0x01, 0x63, 0x20, 0xE8, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x50, 0x9A, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x20, 0xE8, 0x00, 0x65, -+0xFF, 0x6A, 0x4C, 0xEC, 0x07, 0x6D, 0xB8, 0xEC, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x01, 0x6E, 0x12, 0xEC, 0x71, 0xE4, 0xE9, 0xF0, -+0xA5, 0xA4, 0xCC, 0xED, 0x1D, 0x25, 0xE9, 0xF0, -+0xA6, 0xA4, 0x29, 0xF1, 0x60, 0x9B, 0xE9, 0xF0, -+0x85, 0xA4, 0x75, 0xE5, 0x10, 0xF0, 0x24, 0x6B, -+0x16, 0xF4, 0x74, 0x9B, 0xBC, 0x35, 0x21, 0x4D, -+0x75, 0xE5, 0xE0, 0xA5, 0x9E, 0x33, 0x9A, 0x34, -+0xCC, 0xEC, 0x78, 0x33, 0x9C, 0x34, 0x4C, 0xEF, -+0x8D, 0xEB, 0xED, 0xEB, 0x00, 0xF6, 0x60, 0x33, -+0x00, 0xF6, 0x63, 0x33, 0x4C, 0xEB, 0x60, 0xC5, -+0x20, 0xE8, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xE8, 0xF3, 0x93, 0xA2, -+0x01, 0x6B, 0x8C, 0xEB, 0x06, 0x23, 0x80, 0xF0, -+0x6C, 0x9A, 0x08, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x20, 0xE8, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF3, 0x8C, 0x9C, -+0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, 0x20, 0xE8, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x4F, 0xF7, 0x95, 0xA3, 0x6E, 0xF5, 0x58, 0x9A, -+0x40, 0xEA, 0x01, 0x6B, 0x6E, 0xEA, 0x1E, 0x2A, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x68, 0xF3, 0xB4, 0xA3, 0x7F, 0x6C, 0xAC, 0xEC, -+0x15, 0x24, 0x10, 0xF0, 0x24, 0x6C, 0xB6, 0xF3, -+0x84, 0x9C, 0x00, 0x6D, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF3, 0x44, 0x9A, 0x02, 0x6C, -+0x80, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x50, 0x9A, 0xE8, 0xF3, 0xC5, 0xA3, 0xFF, 0x6C, -+0x55, 0x4C, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6B, -+0x28, 0xF5, 0xBC, 0xA3, 0x7F, 0x6B, 0xFF, 0x6A, -+0xAC, 0xEB, 0x4C, 0xEB, 0x4C, 0xEC, 0x02, 0x23, -+0x00, 0x18, 0xD9, 0xCA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x24, 0x67, 0x6E, 0xF5, -+0x58, 0x9A, 0x4F, 0xF7, 0x95, 0xA3, 0xFF, 0x68, -+0x0C, 0xE9, 0x40, 0xEA, 0x01, 0x72, 0x19, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x94, 0xA2, 0x7F, 0x6B, 0x8C, 0xEB, -+0x0C, 0xEB, 0x0F, 0x23, 0x68, 0xF3, 0x9D, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x68, 0xF3, -+0x7D, 0xC2, 0x68, 0xF3, 0x5D, 0xA2, 0x07, 0x6B, -+0x6C, 0xEA, 0x03, 0x2A, 0x91, 0x67, 0x00, 0x18, -+0xA2, 0xC6, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x24, 0x67, 0x6E, 0xF5, -+0x58, 0x9A, 0x4F, 0xF7, 0x95, 0xA3, 0xFF, 0x68, -+0x0C, 0xE9, 0x40, 0xEA, 0x01, 0x6B, 0x6E, 0xEA, -+0x29, 0x2A, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x68, 0xF3, 0xB4, 0xA3, 0x7F, 0x6C, -+0xAC, 0xEC, 0x0C, 0xEC, 0x1F, 0x24, 0x10, 0xF0, -+0x24, 0x6C, 0xB6, 0xF3, 0x84, 0x9C, 0x40, 0xC4, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0x44, 0x9A, -+0x02, 0x6C, 0x80, 0xC2, 0x68, 0xF3, 0x99, 0xA3, -+0x03, 0x6A, 0x4B, 0xEA, 0x4C, 0xEC, 0x68, 0xF3, -+0x99, 0xC3, 0x68, 0xF3, 0x9D, 0xA3, 0x8C, 0xEA, -+0x68, 0xF3, 0x5D, 0xC3, 0x68, 0xF3, 0x5D, 0xA3, -+0x07, 0x6B, 0x6C, 0xEA, 0x03, 0x2A, 0x91, 0x67, -+0x00, 0x18, 0xA2, 0xC6, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x24, 0x67, 0x6E, 0xF5, 0x58, 0x9A, 0x4F, 0xF7, -+0x95, 0xA3, 0xFF, 0x68, 0x0C, 0xE9, 0x40, 0xEA, -+0x01, 0x72, 0x1B, 0x61, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x68, 0xF3, 0x94, 0xA3, -+0x7F, 0x6A, 0x8C, 0xEA, 0x0C, 0xEA, 0x11, 0x22, -+0x68, 0xF3, 0x75, 0xA3, 0x10, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x0C, 0xEA, 0x20, 0x72, 0x06, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0x03, 0x10, 0x91, 0x67, 0x00, 0x18, -+0xDE, 0xCA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0xFF, 0x68, 0x8C, 0xE8, 0x90, 0x67, -+0x00, 0x18, 0xB3, 0xC7, 0x16, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, 0x80, 0xF1, -+0x6E, 0xA2, 0x0E, 0xEB, 0x05, 0x2B, 0x80, 0xF1, -+0x6C, 0xA2, 0x01, 0x4B, 0x80, 0xF1, 0x6C, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0x48, 0xF5, 0x44, 0xA2, -+0x02, 0x72, 0x03, 0x60, 0x90, 0x67, 0x00, 0x18, -+0x9E, 0xCB, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xB2, 0xD8, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x7A, 0xA0, -+0x02, 0x6A, 0xFF, 0x69, 0x6C, 0xEA, 0x2C, 0xEC, -+0x2C, 0xEA, 0x04, 0xD4, 0x20, 0x22, 0x03, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x01, 0x6D, 0x68, 0xF3, -+0x5A, 0xC0, 0x00, 0x18, 0x11, 0xE0, 0x68, 0xF3, -+0x9A, 0xA0, 0x01, 0x6B, 0x4C, 0xEB, 0x09, 0x6A, -+0x4B, 0xEA, 0x8C, 0xEA, 0x68, 0xF3, 0x94, 0xA0, -+0x6C, 0x33, 0x6D, 0xEA, 0x7F, 0x6B, 0x8C, 0xEB, -+0x2C, 0xEB, 0x68, 0xF3, 0x5A, 0xC0, 0x07, 0x23, -+0x08, 0x6B, 0x4C, 0xEB, 0x2C, 0xEB, 0x03, 0x23, -+0x04, 0x94, 0x00, 0x18, 0xA2, 0xC6, 0x04, 0x95, -+0x01, 0x6C, 0x80, 0x18, 0x4D, 0x12, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x7A, 0xA0, 0x01, 0x6A, 0xFF, 0x69, -+0x6C, 0xEA, 0x2C, 0xEC, 0x2C, 0xEA, 0x04, 0xD4, -+0x19, 0x22, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x00, 0x6D, 0x68, 0xF3, 0x5A, 0xC0, 0x00, 0x18, -+0x11, 0xE0, 0x68, 0xF3, 0x9A, 0xA0, 0x01, 0x6B, -+0x6C, 0xEA, 0xFA, 0x4B, 0x48, 0x32, 0x8C, 0xEB, -+0x4D, 0xEB, 0x04, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x68, 0xF3, 0x7A, 0xC0, 0x03, 0x22, 0x04, 0x94, -+0x00, 0x18, 0xA2, 0xC6, 0x04, 0x95, 0x00, 0x6C, -+0x80, 0x18, 0x4D, 0x12, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x00, 0x18, -+0x0F, 0xE4, 0x02, 0x67, 0x01, 0x6A, 0x0C, 0xEA, -+0x03, 0x22, 0x00, 0x6C, 0x01, 0x6D, 0x02, 0x10, -+0x00, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0x24, 0xC6, -+0x40, 0x6A, 0x0C, 0xEA, 0x0F, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x16, 0xF7, 0x40, 0x9A, 0x60, 0xA2, -+0x00, 0xF6, 0x60, 0x33, 0x00, 0xF6, 0x63, 0x33, -+0x00, 0x53, 0x00, 0x6B, 0x02, 0x61, 0x80, 0x6B, -+0x6B, 0xEB, 0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x88, 0xF3, 0x90, 0xA2, -+0x88, 0xF3, 0xB1, 0xA2, 0x88, 0xF3, 0xD7, 0xA2, -+0x02, 0x6F, 0x00, 0x18, 0xAB, 0xC6, 0x05, 0x97, -+0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x29, 0xF5, 0x70, 0xA2, 0x02, 0x6A, 0x6C, 0xEA, -+0x03, 0x22, 0x01, 0x6C, 0x00, 0x18, 0xBE, 0xE6, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x4B, 0xC1, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x68, 0xF3, 0x74, 0xA0, 0x7F, 0x6A, 0xFF, 0x69, -+0x6C, 0xEA, 0x1E, 0x22, 0x68, 0xF3, 0x97, 0xA0, -+0x96, 0x34, 0x2C, 0xEC, 0x00, 0x18, 0xAF, 0xE4, -+0x02, 0x6B, 0x4C, 0xEB, 0x2C, 0xEB, 0x07, 0x23, -+0x68, 0xF3, 0x97, 0xA0, 0x96, 0x34, 0x2C, 0xEC, -+0x00, 0x18, 0xA1, 0xCA, 0x0D, 0x10, 0x68, 0xF3, -+0x97, 0xA0, 0x68, 0xF3, 0x79, 0xA0, 0x05, 0x6A, -+0x4B, 0xEA, 0x96, 0x34, 0x6C, 0xEA, 0x2C, 0xEC, -+0x68, 0xF3, 0x59, 0xC0, 0x00, 0x18, 0xA2, 0xC6, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x94, 0xA2, 0x7F, 0x6B, 0x8C, 0xEB, -+0x07, 0x23, 0x68, 0xF3, 0x97, 0xA2, 0xFF, 0x6A, -+0x96, 0x34, 0x4C, 0xEC, 0x00, 0x18, 0xF9, 0xCA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x18, 0x72, 0xC8, 0x00, 0x6C, 0x00, 0x18, -+0xA5, 0xC7, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xB3, 0xD5, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xB0, 0xD5, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xCB, 0xD9, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x47, 0xD9, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x8B, 0xEA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x24, 0x67, 0x68, 0xF3, 0x94, 0xA0, 0x7F, 0x6B, -+0xFF, 0x6A, 0x8C, 0xEB, 0x4C, 0xEB, 0x4C, 0xE9, -+0x31, 0x23, 0x68, 0xF3, 0x7A, 0xA0, 0x21, 0x6C, -+0x8B, 0xEC, 0x6C, 0xEC, 0x40, 0x6B, 0x8C, 0xEB, -+0x4C, 0xEB, 0x68, 0xF3, 0x9A, 0xC0, 0x10, 0x23, -+0x88, 0xF3, 0x90, 0xA0, 0x88, 0xF3, 0xB1, 0xA0, -+0x88, 0xF3, 0xD7, 0xA0, 0x05, 0x6F, 0x00, 0x18, -+0xAB, 0xC6, 0x68, 0xF3, 0x7A, 0xA0, 0x41, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x5A, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x99, 0xA2, 0x40, 0x6B, 0x8C, 0xEB, -+0x0D, 0x23, 0x68, 0xF3, 0x7A, 0xA2, 0x10, 0x6A, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x06, 0x22, -+0x00, 0x18, 0x08, 0xC8, 0x03, 0x2A, 0x91, 0x67, -+0x00, 0x18, 0x50, 0xE9, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF3, 0x69, 0xA2, -+0x2E, 0xEB, 0x11, 0x2B, 0x69, 0xF3, 0x68, 0xA2, -+0x1F, 0x6C, 0x6A, 0x32, 0x8C, 0xEA, 0x47, 0xE9, -+0x01, 0x6C, 0x8C, 0xEA, 0x08, 0x22, 0x02, 0x6A, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x03, 0x22, -+0x00, 0x6C, 0x00, 0x18, 0xBE, 0xE6, 0x30, 0xF0, -+0x20, 0x6A, 0x4F, 0xF6, 0x4E, 0xA2, 0x2E, 0xEA, -+0x03, 0x2A, 0x91, 0x67, 0x80, 0x18, 0x87, 0x12, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0x80, 0xF1, 0x07, 0xA2, 0x04, 0xD2, 0x2E, 0xE8, -+0x06, 0x28, 0x91, 0x67, 0x80, 0x18, 0x45, 0x10, -+0x04, 0x92, 0x80, 0xF1, 0x09, 0xC2, 0x91, 0x67, -+0x00, 0x18, 0x5C, 0xC9, 0x91, 0x67, 0x00, 0x18, -+0x8A, 0xD4, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0xFE, 0xE2, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFF, 0x63, 0x01, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x16, 0xF4, 0x74, 0x9B, 0xFF, 0x6A, 0x4C, 0xEE, -+0x6D, 0xE4, 0x08, 0x68, 0x80, 0xA3, 0xDB, 0xE0, -+0x02, 0x67, 0x4C, 0xED, 0x07, 0xEE, 0xD0, 0x67, -+0x4C, 0xEF, 0x04, 0xED, 0x4C, 0xEC, 0xCC, 0xEF, -+0x0F, 0xE8, 0x8C, 0xE8, 0xE4, 0xED, 0xED, 0xE8, -+0x4C, 0xE8, 0x00, 0xC3, 0x01, 0x90, 0x01, 0x63, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF4, 0x54, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, -+0x8C, 0xEB, 0x4D, 0xE3, 0x40, 0xA3, 0xFF, 0x6C, -+0x8C, 0xEE, 0x08, 0x6B, 0xDB, 0xE3, 0x8C, 0xED, -+0x8C, 0xEA, 0x64, 0x67, 0x47, 0xED, 0x67, 0xEE, -+0x6C, 0xEA, 0x8C, 0xEA, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF2, 0x6C, 0x9B, -+0xFF, 0xF7, 0x1F, 0x6A, 0x8C, 0xEA, 0x69, 0xE2, -+0x00, 0x9A, 0x41, 0x45, 0x25, 0x67, 0x08, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, 0x50, 0x9A, -+0x85, 0x67, 0x2C, 0xE8, 0x40, 0xEA, 0x06, 0xEA, -+0x50, 0x67, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0xF7, 0x1F, 0x68, -+0x41, 0x45, 0x25, 0x67, 0x0C, 0xD6, 0x8C, 0xE8, -+0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x4C, 0x9A, 0x41, 0xE0, 0xC0, 0xD8, 0x1A, 0x10, -+0x01, 0x6D, 0x90, 0x67, 0xAB, 0xED, 0x00, 0x18, -+0x5C, 0xE3, 0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF4, 0x50, 0x9A, 0x91, 0x67, 0x40, 0xEA, -+0x0C, 0x93, 0x64, 0xEA, 0x43, 0x67, 0x04, 0x93, -+0x2C, 0xEA, 0x2F, 0xE9, 0x6C, 0xE9, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF2, 0x6C, 0x9B, 0x2D, 0xEA, -+0x61, 0xE0, 0x40, 0xD8, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x01, 0x74, 0x0D, 0x60, 0x06, 0x24, 0x02, 0x74, -+0x10, 0x60, 0x03, 0x74, 0x00, 0x6A, 0x1C, 0x61, -+0x14, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xA8, 0x35, -+0x16, 0xF7, 0x44, 0x9A, 0x0B, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xA8, 0x35, 0x16, 0xF7, 0x48, 0x9A, -+0x05, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF7, -+0x4C, 0x9A, 0xA8, 0x35, 0x55, 0xE5, 0x40, 0x9D, -+0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF7, -+0x50, 0x9A, 0xA8, 0x35, 0x55, 0xE5, 0x40, 0x9D, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x08, 0xF3, 0x00, 0x4A, -+0x88, 0x34, 0x91, 0xE2, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF5, 0x7C, 0x9A, 0x30, 0xF0, 0x20, 0x6A, -+0x00, 0xF5, 0xA0, 0x35, 0xCC, 0xEB, 0x10, 0xF0, -+0x24, 0x6E, 0xB6, 0xF5, 0xC0, 0x9E, 0xCE, 0xF4, -+0x50, 0x9A, 0x80, 0xAC, 0xAD, 0xEB, 0x01, 0x6D, -+0xAB, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6B, 0x8C, 0xEB, -+0xFF, 0xF7, 0x1F, 0x6A, 0x81, 0x46, 0x06, 0x67, -+0xAC, 0xEA, 0x06, 0x2C, 0x83, 0x67, 0xA2, 0x67, -+0x00, 0x18, 0x84, 0xE3, 0x02, 0x67, 0x0D, 0x10, -+0x83, 0x67, 0xA2, 0x67, 0x00, 0x18, 0x84, 0xE3, -+0x22, 0x67, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, -+0x50, 0x9A, 0x90, 0x67, 0x2C, 0xE8, 0x40, 0xEA, -+0x06, 0xEA, 0x50, 0x67, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x46, 0x67, 0xFF, 0x68, 0xFF, 0xF7, 0x1F, 0x69, -+0x01, 0x4A, 0x0C, 0xD6, 0x0D, 0xD7, 0x8C, 0xE8, -+0xAC, 0xE9, 0x04, 0x2A, 0x90, 0x67, 0xB1, 0x67, -+0xC7, 0x67, 0x15, 0x10, 0xB1, 0x67, 0x90, 0x67, -+0x00, 0x18, 0x84, 0xE3, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x0C, 0x94, 0xAE, 0xF4, 0x50, 0x9A, -+0x40, 0xEA, 0x0D, 0x96, 0x90, 0x67, 0xB1, 0x67, -+0xC4, 0xEA, 0x0C, 0x92, 0x4C, 0xEE, 0x4F, 0xEB, -+0x04, 0x92, 0x4C, 0xEB, 0x6D, 0xEE, 0x00, 0x18, -+0x97, 0xE3, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x8C, 0xEA, 0x0E, 0x91, 0x04, 0xD2, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xED, 0x4C, 0xE9, -+0x0C, 0xD6, 0x0D, 0xD7, 0x0F, 0x90, 0x05, 0xD5, -+0x00, 0x6A, 0x08, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x0A, 0x6C, 0x40, 0xEA, -+0x40, 0xA8, 0x01, 0x4A, 0x40, 0xC8, 0x10, 0xF0, -+0x24, 0x6A, 0x04, 0x94, 0x05, 0x95, 0x96, 0xF5, -+0xDC, 0x9A, 0x00, 0x18, 0xA7, 0xE3, 0x0C, 0x93, -+0x6C, 0xEA, 0x0D, 0x93, 0x6E, 0xEA, 0x03, 0x22, -+0x40, 0xA8, 0x23, 0xEA, 0xE7, 0x61, 0x40, 0xA8, -+0x09, 0x97, 0x07, 0x90, 0x23, 0xEA, 0x08, 0x91, -+0x58, 0x67, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, -+0x24, 0x6A, 0xB1, 0xF7, 0x19, 0x4A, 0x40, 0xDB, -+0x00, 0x68, 0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF7, -+0x54, 0x9A, 0x40, 0xA2, 0x12, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x16, 0xF7, 0x58, 0x9A, 0x40, 0xA2, -+0x0C, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF7, -+0x5C, 0x9A, 0x40, 0xA2, 0x06, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF7, 0x40, 0x9A, 0x40, 0xA2, -+0x18, 0x22, 0xE0, 0xF3, 0x09, 0x70, 0x0A, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, -+0x20, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x00, 0x6A, 0x0C, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x5C, 0x9A, 0x32, 0x6C, 0x01, 0x48, -+0x40, 0xEA, 0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xE8, -+0xD0, 0x17, 0x01, 0x6A, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, 0x24, 0x6A, -+0x32, 0xF0, 0x1D, 0x4A, 0x40, 0xDB, 0x00, 0x6B, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF7, 0xA4, 0x9A, -+0xFF, 0x6C, 0x40, 0xA5, 0xA0, 0xA5, 0x8C, 0xEA, -+0xAC, 0xEC, 0x4E, 0xEC, 0x10, 0x24, 0x64, 0x73, -+0x09, 0x61, 0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF3, -+0x98, 0x9B, 0x40, 0x6D, 0x60, 0x9C, 0xAD, 0xEB, -+0x60, 0xDC, 0x20, 0xE8, 0x01, 0x4B, 0xFF, 0xF7, -+0x1F, 0x6A, 0x4C, 0xEB, 0xE5, 0x17, 0x20, 0xE8, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x24, 0x6A, 0xFF, 0x69, 0x92, 0xF0, -+0x09, 0x4A, 0x8C, 0xE9, 0x40, 0xDB, 0x00, 0x68, -+0x20, 0x10, 0x82, 0xF3, 0x08, 0x70, 0x09, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, -+0x10, 0x6C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x1F, 0x10, 0xFF, 0xF7, 0x1F, 0x6A, 0x01, 0x48, -+0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x5C, 0x9A, 0x14, 0x6C, 0x40, 0xEA, 0x33, 0x58, -+0x08, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF6, -+0x58, 0x9A, 0x01, 0x6B, 0x40, 0xA2, 0x6C, 0xEA, -+0x0B, 0x2A, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF7, -+0x48, 0x9A, 0x01, 0x6B, 0x40, 0x9A, 0x42, 0x32, -+0x5E, 0x32, 0x6C, 0xEA, 0x2E, 0xEA, 0xD5, 0x2A, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x24, 0x6A, 0x92, 0xF0, 0x0A, 0x4A, -+0x40, 0xDB, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, 0x24, 0x6A, -+0x12, 0xF1, 0x1D, 0x4A, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF7, 0x4C, 0x9A, 0x60, 0xA2, -+0x01, 0x6A, 0x6C, 0xEA, 0xF8, 0x2A, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, -+0x24, 0x6A, 0x12, 0xF1, 0x1E, 0x4A, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x68, 0xF3, 0x79, 0xA0, -+0x80, 0x6A, 0x4B, 0xEA, 0x6D, 0xEA, 0x68, 0xF3, -+0x59, 0xC0, 0x10, 0xF0, 0x24, 0x6A, 0x88, 0xF3, -+0x68, 0xA8, 0x36, 0xF7, 0x50, 0x9A, 0xFF, 0x69, -+0x10, 0x6C, 0x60, 0xCA, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF5, 0x7C, 0x9A, 0x40, 0xA3, 0x2C, 0xEA, -+0x8D, 0xEA, 0x2C, 0xEA, 0x40, 0xC3, 0x01, 0x6C, -+0x00, 0x18, 0x22, 0xE4, 0xE8, 0xF3, 0x53, 0xA0, -+0x10, 0x6B, 0x6C, 0xEA, 0x2C, 0xEA, 0x03, 0x22, -+0x7F, 0x4B, 0x71, 0x4B, 0x07, 0x10, 0xE8, 0xF3, -+0x7E, 0xA0, 0x02, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, -+0x07, 0x22, 0x08, 0x6B, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF6, 0x54, 0x9A, 0x60, 0xDA, 0x05, 0x10, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF6, 0x74, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF7, -+0x6C, 0x9A, 0xFF, 0x6C, 0x01, 0x6D, 0x40, 0xA3, -+0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x00, 0x65, -+0x00, 0x65, 0x00, 0x65, 0x00, 0x65, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x47, 0xE4, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF5, 0x7C, 0x9A, -+0xEF, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x00, 0x6C, 0x00, 0x18, 0x22, 0xE4, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, -+0x24, 0x6B, 0x8E, 0x9A, 0xD6, 0xF6, 0x74, 0x9B, -+0x80, 0xDB, 0x68, 0xF3, 0x99, 0xA2, 0x7F, 0x6B, -+0x8C, 0xEB, 0x68, 0xF3, 0x79, 0xC2, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFF, 0x6A, 0x4C, 0xEC, -+0x94, 0x34, 0x4C, 0xED, 0x4C, 0xEC, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF7, 0x54, 0x9A, 0x80, 0xC2, -+0xA0, 0xC2, 0x20, 0xE8, 0xFF, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0x36, 0xF7, 0x74, 0x9B, 0x4C, 0xEC, -+0x94, 0x34, 0x4C, 0xEC, 0x80, 0xC3, 0x60, 0xA3, -+0x6C, 0xEA, 0x20, 0xE8, 0xFF, 0x6A, 0x4C, 0xED, -+0xFF, 0x75, 0x4C, 0xEC, 0xCC, 0xEA, 0x06, 0x61, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x71, 0xE4, 0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x71, 0xE4, 0x2C, 0xF7, -+0x6E, 0xA4, 0xAC, 0xEA, 0xAF, 0xED, 0x6C, 0xED, -+0xAD, 0xEA, 0x2C, 0xF7, 0x4E, 0xC4, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x6B, -+0x6C, 0xEC, 0x07, 0x6A, 0x6C, 0xED, 0x8C, 0xEA, -+0x01, 0x68, 0xE6, 0x67, 0x04, 0xEA, 0xAB, 0xEE, -+0x30, 0xF0, 0x20, 0x6A, 0xAD, 0xEE, 0xCE, 0xF2, -+0x44, 0x9A, 0x6C, 0xE8, 0xC0, 0xF7, 0xC3, 0x36, -+0x8E, 0x34, 0x6C, 0xEF, 0xB0, 0x67, 0x0C, 0xEE, -+0x6C, 0xEC, 0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x9F, 0xE7, 0x64, 0x67, 0x36, 0xF3, 0x98, 0x9A, -+0x01, 0x4F, 0x0E, 0xD6, 0x06, 0xD7, 0x05, 0x67, -+0x10, 0xF0, 0x24, 0x6D, 0x40, 0x9C, 0x56, 0xF5, -+0xA4, 0x9D, 0x00, 0xF1, 0x00, 0x5F, 0xAD, 0xEA, -+0x40, 0xDC, 0x15, 0x61, 0x0E, 0x95, 0x00, 0x6A, -+0x04, 0xD2, 0x6D, 0xED, 0x10, 0xF0, 0x24, 0x6B, -+0x05, 0xD2, 0xD6, 0xF4, 0x7C, 0x9B, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x40, 0x9A, 0xC4, 0x40, -+0xFF, 0x6F, 0x00, 0x6C, 0x6C, 0xEE, 0x01, 0x4F, -+0x40, 0xEA, 0x00, 0x6C, 0x27, 0x10, 0x44, 0x40, -+0x07, 0xD2, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, -+0x5C, 0x9A, 0x07, 0x94, 0x30, 0xF0, 0x20, 0x6F, -+0x0E, 0x95, 0x4C, 0xEC, 0x07, 0xD4, 0xAE, 0xF2, -+0x40, 0x9F, 0x07, 0x96, 0x06, 0x97, 0x00, 0x69, -+0x6D, 0xED, 0x91, 0x67, 0x04, 0xD1, 0x05, 0xD1, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0x06, 0x97, -+0xAE, 0xF2, 0x40, 0x9B, 0x07, 0x93, 0x0E, 0x95, -+0x91, 0x67, 0x79, 0xE7, 0x06, 0x93, 0xFF, 0x6F, -+0x01, 0x4F, 0x04, 0xD1, 0x05, 0xD1, 0x7F, 0xE7, -+0x40, 0xEA, 0x91, 0x67, 0x00, 0x18, 0x35, 0xD5, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF5, 0x88, 0x9C, -+0x40, 0x9B, 0x0F, 0x6D, 0x03, 0x6E, 0x8C, 0xEA, -+0x40, 0xDB, 0x64, 0x40, 0x62, 0x32, 0x00, 0xF1, -+0x45, 0xC0, 0x42, 0x32, 0x00, 0xF1, 0x46, 0xC0, -+0x00, 0xF6, 0x62, 0x32, 0x00, 0xF1, 0x47, 0xC0, -+0x47, 0x40, 0x15, 0x4A, 0x00, 0xF1, 0x48, 0xC0, -+0x42, 0x34, 0x00, 0xF6, 0x42, 0x32, 0x00, 0xF1, -+0x64, 0xC0, 0x00, 0xF1, 0x89, 0xC0, 0x00, 0xF1, -+0x4B, 0xC0, 0x82, 0x34, 0x00, 0xF1, 0x45, 0xA0, -+0x00, 0xF1, 0x8A, 0xC0, 0x00, 0xF1, 0x84, 0xA0, -+0x40, 0x32, 0x0A, 0x91, 0x8D, 0xEA, 0x00, 0xF1, -+0x86, 0xA0, 0x80, 0x34, 0x80, 0x34, 0x4D, 0xEC, -+0x00, 0xF1, 0x47, 0xA0, 0x00, 0xF6, 0x40, 0x32, -+0x8D, 0xEA, 0xE2, 0xA2, 0x83, 0xA2, 0xAC, 0xEF, -+0x03, 0x4F, 0xEC, 0x37, 0xCC, 0xEC, 0x91, 0xE7, -+0x71, 0xE4, 0x82, 0x37, 0x00, 0xF1, 0x8C, 0xC0, -+0x00, 0xF1, 0xED, 0xC0, 0x00, 0xF6, 0x82, 0x34, -+0xE2, 0x37, 0x00, 0xF1, 0xEE, 0xC0, 0x00, 0xF1, -+0x8F, 0xC0, 0xE3, 0xA2, 0x8A, 0xA2, 0x42, 0xA2, -+0xEC, 0xEE, 0x8A, 0x34, 0x4C, 0xED, 0x03, 0x4D, -+0xD9, 0xE4, 0xAC, 0x35, 0xB9, 0xE6, 0x6D, 0xE6, -+0x62, 0x32, 0x00, 0xF1, 0x70, 0xC0, 0x00, 0xF1, -+0x51, 0xC0, 0x00, 0xF6, 0x62, 0x33, 0x42, 0x32, -+0x00, 0xF1, 0x52, 0xC0, 0x00, 0xF1, 0x73, 0xC0, -+0x0B, 0x97, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xFF, 0x6A, 0x4C, 0xEC, 0xFF, 0x74, 0xAC, 0xEA, -+0x05, 0x61, 0x30, 0xF0, 0x20, 0x6B, 0x0D, 0xF1, -+0x47, 0xC3, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x2C, 0xF7, 0xBF, 0xA3, -+0x8C, 0xEA, 0x8F, 0xEC, 0xAC, 0xEC, 0x8D, 0xEA, -+0x2C, 0xF7, 0x5F, 0xC3, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x6A, -+0x06, 0x67, 0x4C, 0xE8, 0x53, 0x70, 0x4C, 0xEC, -+0x4C, 0xED, 0x0A, 0x61, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x2C, 0xF7, 0x9F, 0xA3, -+0x2C, 0xF7, 0x7E, 0xA3, 0x8D, 0xEB, 0x06, 0x10, -+0x0C, 0x2C, 0x30, 0xF0, 0x20, 0x6B, 0x0D, 0xF1, -+0x66, 0xA3, 0xAD, 0xEB, 0x4C, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF3, 0x48, 0x9A, 0x60, 0xC2, -+0x2C, 0x10, 0x47, 0x70, 0x12, 0x60, 0x48, 0x58, -+0x06, 0x60, 0x17, 0x70, 0x0E, 0x60, 0x44, 0x70, -+0x0C, 0x60, 0x01, 0x70, 0x09, 0x10, 0x4C, 0x70, -+0x08, 0x60, 0x4D, 0x58, 0x02, 0x60, 0x49, 0x70, -+0x03, 0x10, 0x4E, 0x70, 0x02, 0x60, 0x51, 0x70, -+0x06, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x0D, 0xF1, -+0x46, 0xA2, 0xAD, 0xEA, 0x0D, 0x10, 0x00, 0x18, -+0x30, 0xE5, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x2C, 0xF7, 0x7F, 0xA2, 0x2C, 0xF7, -+0x5E, 0xA2, 0x6D, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF3, 0x68, 0x9B, -+0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF2, -+0x1A, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF7, -+0x58, 0x9A, 0x00, 0xC2, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFF, 0x63, 0x01, 0xD0, -+0xFF, 0x6A, 0x4C, 0xED, 0x4C, 0xEE, 0x4C, 0xEF, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, 0x48, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xEC, 0x00, 0xAA, -+0xE1, 0xF7, 0x1F, 0x6A, 0x0C, 0xEA, 0x10, 0xF0, -+0x24, 0x68, 0xF6, 0xF3, 0x04, 0x98, 0x51, 0xE4, -+0x6C, 0xEC, 0x80, 0xC8, 0x9C, 0x32, 0x10, 0xF0, -+0x24, 0x6C, 0xF6, 0xF4, 0x98, 0x9C, 0x10, 0xF0, -+0x24, 0x68, 0xB6, 0xF4, 0x18, 0x98, 0x91, 0xE2, -+0x80, 0xAC, 0x01, 0xE2, 0x00, 0x98, 0x6C, 0xEC, -+0x05, 0x25, 0x10, 0xF0, 0x00, 0x6D, 0xAB, 0xED, -+0xAD, 0xEC, 0x6C, 0xEC, 0xD8, 0xF0, 0x00, 0x6B, -+0x8C, 0xEB, 0x10, 0xF0, 0x24, 0x6C, 0xF6, 0xF4, -+0x98, 0x9C, 0x91, 0xE2, 0x60, 0xCC, 0x10, 0xF0, -+0x24, 0x6B, 0x36, 0xF7, 0x7C, 0x9B, 0x6D, 0xE2, -+0x80, 0xA3, 0x01, 0x6B, 0x8C, 0xEB, 0x05, 0x23, -+0x03, 0xF7, 0x01, 0x6B, 0x6B, 0xEB, 0x0C, 0xEB, -+0x06, 0x10, 0x1F, 0xF7, 0x01, 0x6B, 0x6B, 0xEB, -+0x0C, 0xEB, 0xE0, 0x37, 0xED, 0xEB, 0xFF, 0x76, -+0x13, 0x60, 0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF7, -+0x80, 0x9C, 0x80, 0xF4, 0xC0, 0x36, 0x6C, 0xEC, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF3, 0x70, 0x9B, -+0x6D, 0xEE, 0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF4, -+0x78, 0x9B, 0x8D, 0xEE, 0x6D, 0xE2, 0xC0, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF4, 0x98, 0x9B, -+0x7F, 0x6B, 0x91, 0xE2, 0xA0, 0xA4, 0xAC, 0xEB, -+0x60, 0xC4, 0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF7, -+0x64, 0x9B, 0x1C, 0x6C, 0x80, 0xC3, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF7, 0x68, 0x9B, 0x08, 0xF4, -+0x13, 0x6C, 0x80, 0xCB, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF3, 0x98, 0x9B, 0xF7, 0x6B, 0x91, 0xE2, -+0xA0, 0xA4, 0xAC, 0xEB, 0x60, 0xC4, 0x01, 0x90, -+0x01, 0x63, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0x29, 0xF5, 0x51, 0xA2, 0xFF, 0x63, 0x05, 0x5A, -+0x36, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, -+0x76, 0xF2, 0x08, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, -+0x00, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x50, 0x9A, 0xFF, 0xF7, 0x1F, 0x6B, 0x40, 0x9A, -+0x1A, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, -+0x50, 0x9A, 0x09, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF7, 0x4C, 0x9A, 0x0D, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF7, 0x4C, 0x9A, 0x40, 0x9A, -+0x50, 0x32, 0x00, 0xF5, 0x42, 0x32, 0x08, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF7, 0x50, 0x9A, -+0x40, 0x9A, 0xE1, 0xF7, 0x1F, 0x6B, 0x6C, 0xEA, -+0x00, 0xD2, 0x00, 0x93, 0xE0, 0xF3, 0x08, 0x6A, -+0x60, 0x33, 0x68, 0x33, 0x5B, 0xEB, 0x01, 0x2A, -+0xE5, 0xE8, 0x12, 0xEA, 0x01, 0x10, 0x66, 0x6A, -+0x00, 0xD2, 0x00, 0x92, 0x01, 0x63, 0x20, 0xE8, -+0xFF, 0x63, 0x01, 0xD0, 0x0C, 0x2C, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x78, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x56, 0xF7, 0x94, 0x9C, 0x40, 0x9B, -+0x8D, 0xEA, 0x40, 0xDB, 0x58, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x4F, 0xF6, 0xD4, 0x9A, 0x30, 0xF0, -+0x20, 0x6A, 0x6F, 0xF6, 0x10, 0x4A, 0x00, 0x6D, -+0x18, 0x6F, 0xF8, 0xED, 0x30, 0xF0, 0x20, 0x6B, -+0xCF, 0xF4, 0x00, 0x4B, 0x12, 0xEF, 0x6D, 0xE7, -+0xA0, 0xF1, 0x04, 0xA3, 0x01, 0x6F, 0xEC, 0xE8, -+0x23, 0x20, 0xA0, 0xF1, 0x64, 0xA3, 0x66, 0x33, -+0xEC, 0xEB, 0xFF, 0x6F, 0xEC, 0xEB, 0x1C, 0x23, -+0xFF, 0xF7, 0x78, 0x9A, 0x9B, 0xEB, 0x01, 0x2C, -+0xE5, 0xE8, 0x12, 0xEB, 0xFF, 0xF7, 0x7C, 0xDA, -+0x10, 0xEF, 0x03, 0x27, 0x01, 0x4B, 0xFF, 0xF7, -+0x7C, 0xDA, 0x60, 0x9A, 0x78, 0xEE, 0x12, 0xEB, -+0x9B, 0xEB, 0x01, 0x2C, 0xE5, 0xE8, 0x12, 0xEB, -+0x60, 0xDA, 0xFF, 0xF7, 0x7C, 0x9A, 0x04, 0x2B, -+0x01, 0x6F, 0xFF, 0xF7, 0xFC, 0xDA, 0x60, 0xDA, -+0x01, 0x4D, 0x0A, 0x75, 0x18, 0x4A, 0xCC, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0x80, 0xF1, 0x78, 0x9A, 0x80, 0xF1, 0x94, 0xDA, -+0x7B, 0xEC, 0x01, 0x2B, 0xE5, 0xE8, 0x12, 0xEB, -+0x80, 0xF1, 0x7C, 0xDA, 0x78, 0x67, 0xA0, 0xF1, -+0x60, 0xDA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x69, 0xF3, 0x88, 0xA2, 0x02, 0x6B, -+0x8D, 0xEB, 0x69, 0xF3, 0x68, 0xC2, 0x01, 0x90, -+0x01, 0x63, 0x20, 0xE8, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x69, 0xF3, 0x48, 0xA0, -+0x03, 0x6B, 0x4C, 0xEB, 0x00, 0x6A, 0x38, 0x2B, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF7, 0x58, 0x9A, -+0x30, 0xF0, 0x20, 0x69, 0x30, 0xF0, 0x20, 0x6C, -+0x60, 0xC2, 0x4E, 0xF2, 0x4C, 0x99, 0x29, 0xF5, -+0x10, 0x4C, 0x00, 0x6D, 0xD4, 0x6E, 0x40, 0xEA, -+0x4E, 0xF2, 0x4C, 0x99, 0x30, 0xF0, 0x20, 0x6C, -+0xFF, 0x6E, 0x4F, 0xF6, 0x14, 0x4C, 0x00, 0x6D, -+0x01, 0x4E, 0x40, 0xEA, 0x05, 0x6B, 0x66, 0x6C, -+0x7B, 0xEC, 0x01, 0x2B, 0xE5, 0xE8, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, 0x80, 0xF1, -+0x78, 0xDA, 0x80, 0xF1, 0x94, 0xDA, 0x12, 0xEB, -+0x80, 0xF1, 0x7C, 0xDA, 0x01, 0x6A, 0x69, 0xF3, -+0x68, 0xA0, 0x4B, 0xEA, 0x69, 0xF3, 0x49, 0xC0, -+0x7D, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x01, 0x6B, -+0x6D, 0xEA, 0x69, 0xF3, 0x48, 0xC0, 0x43, 0x67, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x69, 0xF3, 0x88, 0xA0, 0x01, 0x6B, -+0x00, 0x6A, 0x8C, 0xEB, 0x24, 0x23, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF7, 0x58, 0x9A, 0x00, 0x6B, -+0x60, 0xC2, 0x03, 0x6A, 0x4B, 0xEA, 0x8C, 0xEA, -+0x69, 0xF3, 0x48, 0xC0, 0x00, 0x18, 0xA9, 0xE5, -+0x04, 0xD2, 0x04, 0x94, 0x00, 0x18, 0xCA, 0xE5, -+0x69, 0xF3, 0x68, 0xA0, 0x02, 0x6A, 0x42, 0xF1, -+0x1C, 0x6C, 0x6D, 0xEA, 0x69, 0xF3, 0x48, 0xC0, -+0x30, 0xF0, 0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0xAE, 0xF2, 0x50, 0x9A, 0x4F, 0xF6, 0xD8, 0x9B, -+0x01, 0x6D, 0x40, 0xEA, 0x01, 0x6A, 0x07, 0x97, -+0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x69, 0xF3, 0xA8, 0xA3, 0x02, 0x6C, 0x00, 0x6A, -+0xAC, 0xEC, 0x0C, 0x24, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF7, 0x58, 0x9A, 0x00, 0x6C, 0x80, 0xC2, -+0x03, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0x69, 0xF3, -+0x48, 0xC3, 0x01, 0x6A, 0x20, 0xE8, 0x00, 0x65, -+0x00, 0x6A, 0x18, 0x6C, 0x98, 0xEA, 0x30, 0xF0, -+0x20, 0x6B, 0xCF, 0xF4, 0x00, 0x4B, 0x01, 0x4A, -+0x0A, 0x72, 0x12, 0xEC, 0x71, 0xE4, 0xA0, 0xF1, -+0xA4, 0xA4, 0x02, 0x6B, 0x6B, 0xEB, 0xAC, 0xEB, -+0xA0, 0xF1, 0x64, 0xC4, 0xEE, 0x61, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0x29, 0xF5, 0x50, 0xA2, -+0x01, 0x6B, 0x4C, 0xEB, 0x00, 0x6A, 0x1C, 0x23, -+0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF6, 0x14, 0x4A, -+0x00, 0x6B, 0xA0, 0x9A, 0x8E, 0xED, 0x0F, 0x2D, -+0x18, 0x6E, 0xD8, 0xEB, 0x30, 0xF0, 0x20, 0x6D, -+0xCF, 0xF4, 0x00, 0x4D, 0x12, 0xEE, 0xB9, 0xE6, -+0xA0, 0xF1, 0xE4, 0xA6, 0x02, 0x6D, 0xAB, 0xED, -+0xEC, 0xED, 0xA0, 0xF1, 0xA4, 0xC6, 0x01, 0x4B, -+0x0A, 0x73, 0x18, 0x4A, 0xEA, 0x61, 0x01, 0x6A, -+0x20, 0xE8, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x5D, 0x67, 0x20, 0xF0, -+0x78, 0xA2, 0x30, 0xF0, 0x20, 0x6A, 0x0A, 0xD4, -+0x29, 0xF5, 0x90, 0xA2, 0x01, 0x6A, 0x00, 0xF6, -+0xE0, 0x31, 0x8C, 0xEA, 0x0B, 0xD5, 0x0C, 0xD6, -+0x00, 0xF6, 0x23, 0x31, 0x80, 0xF0, 0x0E, 0x22, -+0x24, 0x23, 0x01, 0x73, 0x80, 0xF0, 0x0A, 0x61, -+0x0A, 0x93, 0x80, 0xF0, 0x07, 0x23, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF7, 0x5C, 0x9A, 0xC3, 0xEA, -+0x80, 0xF0, 0x00, 0x61, 0x7F, 0x71, 0x7E, 0x60, -+0xFF, 0xF7, 0x1F, 0x51, 0x7B, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x4F, 0xF6, 0x14, 0x9A, 0x1B, 0xEE, -+0x01, 0x28, 0xE5, 0xE8, 0x10, 0xEA, 0x12, 0xE8, -+0x02, 0x22, 0x01, 0x48, 0x04, 0x10, 0x03, 0x28, -+0x01, 0x68, 0x50, 0x67, 0x1F, 0x10, 0x01, 0x6B, -+0x20, 0x10, 0x0A, 0x95, 0x67, 0x25, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF7, 0x5C, 0x9A, 0x0C, 0x96, -+0xC3, 0xEA, 0x60, 0x61, 0x7F, 0x71, 0x5E, 0x60, -+0xFF, 0xF7, 0x1F, 0x51, 0x5B, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x4F, 0xF6, 0x18, 0x9A, 0x1B, 0xEE, -+0x01, 0x28, 0xE5, 0xE8, 0x10, 0xEA, 0x12, 0xE8, -+0x02, 0x22, 0x01, 0x48, 0x05, 0x10, 0x04, 0x28, -+0x01, 0x68, 0x00, 0x6A, 0x04, 0xD2, 0x02, 0x10, -+0x00, 0x6B, 0x04, 0xD3, 0x0A, 0x94, 0x00, 0x18, -+0x56, 0xE6, 0x00, 0x6C, 0xFF, 0x6E, 0xA4, 0x67, -+0xCC, 0xED, 0x1D, 0x65, 0x18, 0x6D, 0xB8, 0xEC, -+0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF4, 0x00, 0x4B, -+0x01, 0x6D, 0x12, 0xEA, 0x69, 0xE2, 0xA0, 0xF1, -+0x44, 0xA2, 0xAC, 0xEA, 0xCC, 0xEA, 0x2F, 0x2A, -+0xD8, 0x67, 0x18, 0x6F, 0xF8, 0xEE, 0x04, 0x96, -+0xC4, 0x36, 0x04, 0xD6, 0x03, 0x6E, 0xCB, 0xEE, -+0x12, 0xEC, 0x71, 0xE4, 0xA0, 0xF1, 0xE4, 0xA4, -+0xEC, 0xEE, 0x04, 0x97, 0xED, 0xEE, 0xA0, 0xF1, -+0xC4, 0xC4, 0x0A, 0x96, 0xA0, 0xF1, 0xD4, 0xDC, -+0x0B, 0x97, 0xA0, 0xF1, 0xF8, 0xDC, 0x0C, 0x96, -+0x18, 0x6F, 0xA0, 0xF1, 0xC8, 0xDC, 0xD8, 0x67, -+0x01, 0x4E, 0xF8, 0xEE, 0x12, 0xEE, 0xCD, 0xE3, -+0x80, 0xF1, 0x58, 0xDB, 0x80, 0xF1, 0x14, 0xDB, -+0xA0, 0xF1, 0x46, 0xC4, 0xA0, 0xF1, 0x44, 0xA4, -+0xA0, 0xF1, 0x27, 0xC4, 0x4D, 0xED, 0xA0, 0xF1, -+0xA4, 0xC4, 0x01, 0x6A, 0x04, 0x10, 0x01, 0x4C, -+0x0A, 0x74, 0xBC, 0x61, 0x00, 0x6A, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x06, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF6, -+0x10, 0x4A, 0x00, 0x6C, 0x4F, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6F, 0xF6, 0x10, 0x4A, 0x00, 0x6B, -+0x18, 0x6D, 0xB8, 0xEB, 0x30, 0xF0, 0x20, 0x6C, -+0xCF, 0xF4, 0x00, 0x4C, 0x12, 0xED, 0x91, 0xE5, -+0xA0, 0xF1, 0xC4, 0xA4, 0x01, 0x6D, 0xAC, 0xEE, -+0x08, 0x26, 0xA0, 0xF1, 0x84, 0xA4, 0x86, 0x34, -+0xAC, 0xEC, 0x03, 0x24, 0x80, 0x9A, 0x01, 0x4C, -+0x80, 0xDA, 0x01, 0x4B, 0x0A, 0x73, 0x18, 0x4A, -+0xE7, 0x61, 0x00, 0x18, 0xA9, 0xE5, 0x04, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x68, 0xF3, 0x94, 0xA2, 0x7F, 0x6B, 0x8C, 0xEB, -+0x1A, 0x23, 0x68, 0xF3, 0x77, 0xA2, 0x69, 0xF3, -+0x89, 0xA2, 0x76, 0x33, 0x8E, 0xEB, 0x13, 0x2B, -+0x68, 0xF3, 0x95, 0xA2, 0x0F, 0x6B, 0x8C, 0xEB, -+0xFF, 0x6C, 0x8C, 0xEB, 0x0C, 0x23, 0x88, 0xF3, -+0x82, 0xA2, 0x04, 0x93, 0x30, 0xF0, 0x20, 0x6A, -+0x4F, 0xF6, 0x54, 0x9A, 0x78, 0xEC, 0x12, 0xEC, -+0x8E, 0xEA, 0x09, 0x2A, 0x5B, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x04, 0x93, 0x4F, 0xF6, 0x54, 0x9A, -+0x6E, 0xEA, 0x54, 0x22, 0x04, 0x94, 0x00, 0x18, -+0xCA, 0xE5, 0x50, 0x10, 0x18, 0x6D, 0xB8, 0xEC, -+0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF4, 0x00, 0x4B, -+0x12, 0xED, 0x6D, 0xE5, 0xA0, 0xF1, 0xC4, 0xA3, -+0x01, 0x6D, 0xAC, 0xEE, 0x0A, 0x26, 0xA0, 0xF1, -+0x64, 0xA3, 0x66, 0x33, 0xAC, 0xEB, 0xFF, 0x6D, -+0xAC, 0xEB, 0x03, 0x2B, 0x60, 0x9A, 0x01, 0x4B, -+0x60, 0xDA, 0x01, 0x4C, 0x0A, 0x74, 0x18, 0x4A, -+0xE5, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x29, 0xF5, -+0x51, 0xA2, 0xFF, 0x72, 0x2F, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, 0xA0, 0xF1, -+0x60, 0x9A, 0x01, 0x4B, 0xA0, 0xF1, 0x60, 0xDA, -+0x80, 0xF1, 0x5C, 0x9A, 0x4E, 0xEB, 0x22, 0x2B, -+0x30, 0xF0, 0x20, 0x6A, 0x6F, 0xF6, 0x10, 0x4A, -+0x18, 0x6D, 0xB8, 0xEB, 0x30, 0xF0, 0x20, 0x6C, -+0xCF, 0xF4, 0x00, 0x4C, 0x12, 0xED, 0x91, 0xE5, -+0xA0, 0xF1, 0xC4, 0xA4, 0x01, 0x6D, 0xAC, 0xEE, -+0x08, 0x26, 0xA0, 0xF1, 0x84, 0xA4, 0x86, 0x34, -+0xAC, 0xEC, 0x03, 0x24, 0x80, 0x9A, 0x01, 0x4C, -+0x80, 0xDA, 0x01, 0x4B, 0x0A, 0x73, 0x18, 0x4A, -+0xE7, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x78, 0x67, -+0x6F, 0xF6, 0x60, 0xDA, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x80, 0xF0, 0x6C, 0x9A, -+0x02, 0xF0, 0x00, 0x6C, 0x8D, 0xEB, 0x80, 0xF0, -+0x6C, 0xDA, 0x07, 0x97, 0x04, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x24, 0x6A, 0x73, 0xF4, 0x09, 0x4A, -+0x30, 0xF0, 0x20, 0x68, 0x40, 0xDB, 0x6F, 0xF6, -+0x06, 0x48, 0x00, 0x69, 0x18, 0x6A, 0x58, 0xE9, -+0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF4, 0x00, 0x4B, -+0x12, 0xEA, 0x69, 0xE2, 0xA0, 0xF1, 0x84, 0xA2, -+0x01, 0x6B, 0x8C, 0xEB, 0x27, 0x23, 0x00, 0xF0, -+0x8A, 0x98, 0x00, 0xF0, 0x66, 0x98, 0x63, 0xEC, -+0x21, 0x61, 0x61, 0x80, 0x81, 0x43, 0x04, 0xD4, -+0x07, 0x2C, 0x00, 0xF0, 0x4E, 0x98, 0x00, 0xF0, -+0x92, 0x98, 0x40, 0xEA, 0x04, 0x92, 0x14, 0x10, -+0x80, 0xA0, 0x01, 0x4C, 0x80, 0xC0, 0x80, 0xA0, -+0x82, 0xEB, 0x08, 0x60, 0xA0, 0xF1, 0x84, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0xA0, 0xF1, -+0x64, 0xC2, 0x08, 0x10, 0x00, 0xF0, 0x4E, 0x98, -+0x00, 0xF0, 0x92, 0x98, 0x40, 0xEA, 0x00, 0x6A, -+0x00, 0xF0, 0x4A, 0xD8, 0x01, 0x49, 0x0A, 0x71, -+0x18, 0x48, 0xC8, 0x61, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xE0, 0x63, 0x3F, 0x62, 0xFF, 0xF7, 0x1F, 0x6A, -+0xAC, 0xEA, 0xBD, 0x67, 0x56, 0xC5, 0x01, 0x6B, -+0x42, 0x32, 0x57, 0xC5, 0x6B, 0xEB, 0x30, 0xF0, -+0x20, 0x6A, 0x70, 0xC5, 0xAE, 0xF2, 0x5C, 0x9A, -+0x03, 0x6B, 0x72, 0xC5, 0x04, 0x6B, 0x94, 0xC5, -+0x73, 0xC5, 0x04, 0x04, 0x40, 0xEA, 0x3F, 0x97, -+0x20, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA7, 0x44, 0x30, 0xF0, 0x20, 0x6C, 0x01, 0x4D, -+0xAC, 0xF0, 0x08, 0x4C, 0x14, 0x6E, 0x40, 0xEA, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x24, 0x67, 0x00, 0x18, 0x4F, 0xE7, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, 0x00, 0x6C, -+0x80, 0xF1, 0x8F, 0xC2, 0x47, 0xA1, 0x66, 0xA1, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x40, 0x32, 0xEB, 0xF6, 0xA0, 0xA0, 0x69, 0xE2, -+0x01, 0x69, 0xEB, 0xF6, 0x52, 0xC8, 0x51, 0x67, -+0xAC, 0xEA, 0xFF, 0x6B, 0x1C, 0x2A, 0xEB, 0xF6, -+0x94, 0xA0, 0xFE, 0x4A, 0x8C, 0xEA, 0xEB, 0xF6, -+0x54, 0xC0, 0x02, 0x6A, 0xAC, 0xEA, 0x6C, 0xEA, -+0x50, 0x22, 0xEB, 0xF6, 0x43, 0xA0, 0x0F, 0x6D, -+0xEB, 0xF6, 0x84, 0xA0, 0x4C, 0xED, 0x52, 0x36, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, -+0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x01, 0x72, -+0x0D, 0x6A, 0x40, 0x61, 0x3E, 0x10, 0xEB, 0xF6, -+0x74, 0xA0, 0xEB, 0xF6, 0xF0, 0xA8, 0x02, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x00, 0xF1, 0x01, 0x5F, -+0xEB, 0xF6, 0x54, 0xC0, 0x0C, 0x6A, 0x32, 0x60, -+0x00, 0x6A, 0xEB, 0xF6, 0x58, 0xC8, 0xEB, 0xF6, -+0x5A, 0xC8, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, -+0x48, 0x9A, 0xEB, 0xF6, 0x95, 0xC0, 0xEB, 0xF6, -+0x96, 0xC0, 0x60, 0xAA, 0xEB, 0xF6, 0xC1, 0xA0, -+0xFF, 0xF7, 0x1F, 0x6A, 0x10, 0xF0, 0x24, 0x6D, -+0x6C, 0xEA, 0x76, 0xF7, 0xA0, 0x9D, 0xD9, 0xE2, -+0xDC, 0x36, 0x00, 0x6A, 0xB5, 0xE6, 0x10, 0xF0, -+0x24, 0x6E, 0x04, 0xD2, 0x05, 0xD2, 0xF6, 0xF3, -+0xD4, 0x9E, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xAE, 0xF2, 0x40, 0x9A, 0xCC, 0xF0, -+0x0E, 0x4B, 0x00, 0x6C, 0xD9, 0xE3, 0x40, 0xEA, -+0xEB, 0xF6, 0x54, 0xA0, 0x4D, 0xE9, 0xEB, 0xF6, -+0x34, 0xC0, 0x00, 0x6A, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0xEB, 0xF6, 0xB8, 0xA8, 0x30, 0xF0, 0x20, 0x6A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF2, 0x50, 0x9A, -+0xCC, 0xF0, 0x0E, 0x4B, 0x30, 0xF0, 0x20, 0x6C, -+0xB5, 0xE3, 0xCC, 0xF0, 0x08, 0x4C, 0x04, 0x6E, -+0x40, 0xEA, 0x0B, 0xF7, 0x63, 0xA0, 0x80, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x05, 0x2A, 0xEB, 0xF6, 0x58, 0xA8, 0x04, 0x4A, -+0xEB, 0xF6, 0x58, 0xC8, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x0B, 0xF7, 0x61, 0xA0, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, -+0x0B, 0xF7, 0x80, 0xA0, 0x0F, 0x6D, 0x6C, 0xED, -+0x72, 0x36, 0xFF, 0x69, 0x40, 0xEA, 0x0E, 0x2A, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0xEB, 0xF6, 0x74, 0xA0, 0x02, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0xEB, 0xF6, 0x54, 0xC0, -+0x01, 0x6C, 0x7C, 0x10, 0x0B, 0xF7, 0x63, 0xA0, -+0x7F, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, 0x3F, 0x22, -+0x01, 0x72, 0x6C, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF5, 0x4C, 0x9A, 0x00, 0x6C, 0x40, 0xEA, -+0x70, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF3, -+0x50, 0x9A, 0xCB, 0xF6, 0x9D, 0xA0, 0x00, 0x6D, -+0x40, 0xEA, 0x06, 0xD2, 0xE8, 0xF3, 0x73, 0xA0, -+0x10, 0x6A, 0x6C, 0xEA, 0x2C, 0xEA, 0x1F, 0x22, -+0x28, 0xF6, 0x4D, 0xA0, 0x00, 0x68, 0x13, 0x2A, -+0x1A, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x58, 0x9A, 0x03, 0x6C, 0x25, 0xE0, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF3, 0x50, 0x9A, -+0x68, 0xF6, 0x8C, 0xA1, 0x00, 0x6D, 0x01, 0x48, -+0x40, 0xEA, 0xFF, 0x6A, 0x4C, 0xE8, 0x30, 0xF0, -+0x20, 0x69, 0xC0, 0xF1, 0x08, 0x49, 0x28, 0xF6, -+0x4D, 0xA1, 0x43, 0xE8, 0xE6, 0x61, 0x06, 0x92, -+0x06, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, -+0x54, 0x9A, 0x40, 0xEA, 0x3A, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, -+0x75, 0xA2, 0x0B, 0xF7, 0x82, 0xA2, 0x01, 0x4B, -+0xEB, 0xF6, 0x75, 0xC2, 0xEB, 0xF6, 0x7A, 0xAA, -+0x6D, 0xE4, 0xEB, 0xF6, 0x7A, 0xCA, 0xEB, 0xF6, -+0x95, 0xA2, 0xEB, 0xF6, 0x62, 0xA2, 0x8E, 0xEB, -+0x09, 0x2B, 0x10, 0xF0, 0x24, 0x6C, 0x0B, 0xF7, -+0xC2, 0xA2, 0x74, 0xF0, 0x15, 0x4C, 0x04, 0xD3, -+0x00, 0x6D, 0x09, 0x10, 0x0B, 0xF7, 0xC2, 0xA2, -+0x10, 0xF0, 0x24, 0x6C, 0x00, 0x6A, 0x04, 0xD2, -+0x14, 0xF0, 0x15, 0x4C, 0xA2, 0x67, 0x64, 0x6A, -+0x58, 0xEE, 0x01, 0x6F, 0x12, 0xEE, 0x00, 0x18, -+0x69, 0xE6, 0x1B, 0x10, 0xEB, 0xF6, 0x74, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xEB, 0xF6, -+0x54, 0xC0, 0x02, 0x6C, 0xEB, 0xF6, 0xB2, 0xA8, -+0x0E, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xEB, 0xF6, 0x94, 0xA2, 0x02, 0x6B, -+0x6B, 0xEB, 0xEB, 0xF6, 0xB2, 0xAA, 0x8C, 0xEB, -+0xEB, 0xF6, 0x74, 0xC2, 0x03, 0x6C, 0x00, 0x18, -+0x42, 0xE7, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0xEB, 0xF6, 0x74, 0xA0, 0x01, 0x6A, -+0x6C, 0xEA, 0x1F, 0x22, 0x30, 0xF0, 0x20, 0x6B, -+0xCF, 0xF4, 0x00, 0x4B, 0x80, 0xF1, 0x4F, 0xA3, -+0x16, 0x22, 0x00, 0x6A, 0x80, 0xF1, 0x4F, 0xC3, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x80, 0xF2, 0xD4, 0xA3, 0x0C, 0x6C, 0x00, 0x6D, -+0x40, 0xEA, 0x68, 0xF3, 0x79, 0xA0, 0x21, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x02, 0x6B, 0x6B, 0xEB, -+0x6C, 0xEA, 0x68, 0xF3, 0x59, 0xC0, 0x00, 0x18, -+0x98, 0xE7, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x69, -+0xC0, 0xF1, 0x08, 0x49, 0xEB, 0xF6, 0x54, 0xA1, -+0x01, 0x6C, 0xFF, 0x6B, 0x4C, 0xEC, 0x40, 0xF1, -+0x11, 0x24, 0xEB, 0xF6, 0xA0, 0xA1, 0x03, 0x6E, -+0xAE, 0x34, 0xCC, 0xEC, 0x6C, 0xEC, 0x02, 0x74, -+0x80, 0xF0, 0x03, 0x60, 0x06, 0x67, 0x8E, 0xE8, -+0xE0, 0xF0, 0x0D, 0x20, 0x01, 0x74, 0x25, 0x60, -+0x02, 0x6C, 0x8B, 0xEC, 0x4C, 0xEC, 0x02, 0x6A, -+0xAC, 0xEA, 0x6C, 0xEA, 0xEB, 0xF6, 0x94, 0xC1, -+0x11, 0x22, 0xEB, 0xF6, 0x43, 0xA1, 0x0F, 0x6D, -+0xEB, 0xF6, 0x84, 0xA1, 0x4C, 0xED, 0x52, 0x36, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, -+0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x01, 0x72, -+0x01, 0x6C, 0x01, 0x61, 0x00, 0x6C, 0xEB, 0xF6, -+0xB2, 0xA9, 0x00, 0x18, 0x42, 0xE7, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF4, 0x54, 0x9A, 0x40, 0xEA, -+0xD8, 0x10, 0x02, 0x6A, 0xAC, 0xEA, 0x6C, 0xEA, -+0x11, 0x22, 0xEB, 0xF6, 0x43, 0xA1, 0x0F, 0x6D, -+0xEB, 0xF6, 0x84, 0xA1, 0x4C, 0xED, 0x52, 0x36, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, -+0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x01, 0x72, -+0xE0, 0xF0, 0x18, 0x61, 0xEB, 0xF6, 0xB2, 0xA9, -+0x00, 0x6C, 0x00, 0x18, 0x42, 0xE7, 0x30, 0xF0, -+0x20, 0x6A, 0xAC, 0xF0, 0x4D, 0xA2, 0x5A, 0x33, -+0x02, 0x73, 0x0D, 0x60, 0x03, 0x73, 0x0F, 0x60, -+0x01, 0x73, 0x05, 0x60, 0x3F, 0x6E, 0x4C, 0xEE, -+0xFF, 0x6A, 0x4C, 0xEE, 0x0E, 0x10, 0x3F, 0x6B, -+0x4C, 0xEB, 0x0A, 0x6E, 0x08, 0x10, 0x3F, 0x6B, -+0x4C, 0xEB, 0x64, 0x6E, 0x04, 0x10, 0x3F, 0x6B, -+0x4C, 0xEB, 0xE0, 0xF3, 0x08, 0x6E, 0xD8, 0xEB, -+0x12, 0xEE, 0x0A, 0x6A, 0x58, 0xEE, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, -+0x7A, 0xAA, 0x01, 0x6C, 0x12, 0xEE, 0x7B, 0xE6, -+0x30, 0xF0, 0x20, 0x6B, 0x4F, 0xF6, 0x8F, 0xC3, -+0x00, 0x6B, 0xEB, 0xF6, 0x75, 0xC2, 0x00, 0x6B, -+0xEB, 0xF6, 0x7A, 0xCA, 0xEB, 0xF6, 0x78, 0xCA, -+0x10, 0xF0, 0x24, 0x6C, 0x00, 0x6A, 0x04, 0xD2, -+0xA2, 0x67, 0x14, 0xF0, 0x15, 0x4C, 0x64, 0x6A, -+0x68, 0x10, 0x02, 0x6A, 0xAC, 0xEA, 0x6C, 0xEA, -+0x11, 0x22, 0xEB, 0xF6, 0x43, 0xA1, 0x0F, 0x6D, -+0xEB, 0xF6, 0x84, 0xA1, 0x4C, 0xED, 0x52, 0x36, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x54, 0x9A, -+0x6C, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x01, 0x72, -+0xA0, 0xF0, 0x00, 0x61, 0xEB, 0xF6, 0xB2, 0xA9, -+0x00, 0x6C, 0x00, 0x18, 0x42, 0xE7, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, -+0x87, 0xA2, 0xEB, 0xF6, 0x76, 0xA2, 0xFF, 0x4C, -+0x6E, 0xEC, 0x03, 0x2C, 0xEB, 0xF6, 0x66, 0xA2, -+0x05, 0x10, 0x01, 0x4B, 0xEB, 0xF6, 0x76, 0xC2, -+0xEB, 0xF6, 0x65, 0xA2, 0x7A, 0x32, 0x02, 0x72, -+0x0D, 0x60, 0x03, 0x72, 0x0F, 0x60, 0x01, 0x72, -+0x05, 0x60, 0x3F, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x0E, 0x10, 0x3F, 0x6A, 0x6C, 0xEA, -+0x0A, 0x6B, 0x08, 0x10, 0x3F, 0x6A, 0x6C, 0xEA, -+0x64, 0x6B, 0x04, 0x10, 0x3F, 0x6A, 0x6C, 0xEA, -+0xE0, 0xF3, 0x08, 0x6B, 0x78, 0xEA, 0x12, 0xEA, -+0x0A, 0x6B, 0x78, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0xCC, 0xF0, 0x62, 0xAB, 0x01, 0x6C, 0x64, 0x6E, -+0x12, 0xEA, 0x6B, 0xE2, 0x30, 0xF0, 0x20, 0x6B, -+0x4F, 0xF6, 0x8F, 0xC3, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x00, 0x6C, 0xEB, 0xF6, -+0x95, 0xC3, 0x00, 0x6C, 0xEB, 0xF6, 0x9A, 0xCB, -+0xEB, 0xF6, 0x98, 0xCB, 0x00, 0x6B, 0x10, 0xF0, -+0x24, 0x6C, 0x04, 0xD3, 0x14, 0xF0, 0x15, 0x4C, -+0xA3, 0x67, 0xD8, 0xEA, 0x01, 0x6F, 0x12, 0xEE, -+0x00, 0x18, 0x69, 0xE6, 0x12, 0x10, 0xEB, 0xF6, -+0xB2, 0xA9, 0x00, 0x6C, 0x00, 0x18, 0x42, 0xE7, -+0x30, 0xF0, 0x20, 0x6A, 0x01, 0x6B, 0xEB, 0xF6, -+0x15, 0xC1, 0xEB, 0xF6, 0x1A, 0xC9, 0xEB, 0xF6, -+0x18, 0xC9, 0x4F, 0xF6, 0x6F, 0xC2, 0x00, 0x18, -+0x05, 0xE8, 0x30, 0xF0, 0x20, 0x69, 0xCF, 0xF4, -+0x00, 0x49, 0x80, 0xF2, 0x94, 0xA1, 0x30, 0xF0, -+0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, 0x00, 0x18, -+0x50, 0xE9, 0x80, 0xF2, 0x94, 0xA1, 0x00, 0x18, -+0x3F, 0xE9, 0x80, 0xF2, 0x94, 0xA1, 0x00, 0x18, -+0x57, 0xE9, 0x68, 0xF3, 0x79, 0xA0, 0x20, 0x6A, -+0x08, 0x6C, 0x6D, 0xEA, 0x68, 0xF3, 0x59, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x48, 0x9A, -+0x80, 0xF2, 0xD4, 0xA1, 0x00, 0x6D, 0x40, 0xEA, -+0x89, 0xF0, 0x70, 0xA0, 0x02, 0x6A, 0x6C, 0xEA, -+0x05, 0x22, 0x68, 0xF3, 0x79, 0xA0, 0x01, 0x6A, -+0x6D, 0xEA, 0x05, 0x10, 0x68, 0xF3, 0x79, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, -+0x59, 0xC0, 0x10, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, 0x94, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0xEB, 0xF6, 0xB2, 0xAA, -+0x8C, 0xEB, 0xEB, 0xF6, 0x74, 0xC2, 0x01, 0x6C, -+0x00, 0x18, 0x42, 0xE7, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0x04, 0x67, 0x25, 0x67, 0x4C, 0xEE, -+0x4C, 0xE8, 0x4C, 0xE9, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x4C, 0x9A, 0x04, 0xD6, 0x90, 0x67, -+0xB1, 0x67, 0x40, 0xEA, 0x90, 0x67, 0x80, 0x18, -+0x8F, 0x16, 0x30, 0xF0, 0x20, 0x6A, 0x4F, 0xF7, -+0x7B, 0xA2, 0x00, 0x6A, 0x09, 0x2B, 0x04, 0x97, -+0x30, 0xF0, 0x20, 0x6C, 0x25, 0xF6, 0x08, 0x4C, -+0xB0, 0x67, 0xD1, 0x67, 0x80, 0x18, 0x18, 0x16, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x6B, 0x6C, 0xEC, -+0x0F, 0x6A, 0x8C, 0xEA, 0x03, 0x2A, 0x92, 0x32, -+0x6C, 0xEA, 0x20, 0xE8, 0x07, 0x4A, 0x6C, 0xEA, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x08, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x54, 0x9A, 0x01, 0x6C, -+0x04, 0xF0, 0x00, 0x6D, 0x09, 0x10, 0xFF, 0x4A, -+0x44, 0x33, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x54, 0x9A, 0x01, 0x6D, 0x02, 0x6C, 0xA4, 0xEB, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x08, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x54, 0x9A, 0x01, 0x6C, 0x08, 0xF0, 0x00, 0x6D, -+0x09, 0x10, 0x44, 0x32, 0x6F, 0x42, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x54, 0x9A, 0x01, 0x6D, -+0x02, 0x6C, 0xA4, 0xEB, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x04, 0x2A, 0x01, 0x6C, -+0x08, 0xF0, 0x00, 0x6D, 0x05, 0x10, 0x44, 0x32, -+0xFF, 0x4A, 0x01, 0x6D, 0x02, 0x6C, 0xA4, 0xEA, -+0x00, 0x18, 0xBD, 0xDF, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x04, 0x2A, 0x01, 0x6C, -+0x04, 0xF0, 0x00, 0x6D, 0x05, 0x10, 0xFF, 0x4A, -+0x44, 0x32, 0x01, 0x6D, 0x02, 0x6C, 0xA4, 0xEA, -+0x00, 0x18, 0xBD, 0xDF, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6D, 0x8C, 0xED, 0x01, 0x6C, 0x44, 0x67, -+0x15, 0x4D, 0x44, 0xED, 0xA2, 0x67, 0x00, 0x18, -+0x3C, 0xDF, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6D, 0x8C, 0xED, -+0x04, 0x2D, 0x03, 0x6C, 0x10, 0xF0, 0x00, 0x6D, -+0x05, 0x10, 0x1B, 0x4D, 0x01, 0x6A, 0x44, 0xED, -+0x03, 0x6C, 0xA2, 0x67, 0x00, 0x18, 0x3C, 0xDF, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x18, 0xE5, 0xE8, 0x01, 0x6D, 0x02, 0x6C, -+0xA4, 0xEA, 0x00, 0x18, 0x3C, 0xDF, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0xE5, 0xE8, -+0x01, 0x6D, 0x03, 0x6C, 0xA4, 0xEA, 0x00, 0x18, -+0x3C, 0xDF, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6D, 0x8C, 0xED, -+0x18, 0x4D, 0x01, 0x6A, 0x44, 0xED, 0x00, 0x6C, -+0xA2, 0x67, 0x00, 0x18, 0x3C, 0xDF, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6D, 0x8C, 0xED, 0x01, 0x6C, 0x44, 0x67, -+0x15, 0x4D, 0x44, 0xED, 0xA2, 0x67, 0x00, 0x18, -+0x6D, 0xDF, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6D, 0x8C, 0xED, -+0x04, 0x2D, 0x03, 0x6C, 0x10, 0xF0, 0x00, 0x6D, -+0x05, 0x10, 0x1B, 0x4D, 0x01, 0x6A, 0x44, 0xED, -+0x03, 0x6C, 0xA2, 0x67, 0x00, 0x18, 0x6D, 0xDF, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEC, -+0x00, 0x18, 0xE5, 0xE8, 0x01, 0x6D, 0x02, 0x6C, -+0xA4, 0xEA, 0x00, 0x18, 0x6D, 0xDF, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x4C, 0xEC, 0x00, 0x18, 0xE5, 0xE8, -+0x01, 0x6D, 0x03, 0x6C, 0xA4, 0xEA, 0x00, 0x18, -+0x6D, 0xDF, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xDE, 0x63, 0x43, 0x62, 0x42, 0xD1, 0x41, 0xD0, -+0x01, 0x6A, 0x7D, 0x67, 0x4B, 0xEA, 0x54, 0xC3, -+0x0F, 0x6A, 0x56, 0xC3, 0x10, 0x6A, 0x57, 0xC3, -+0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF6, 0x5C, 0x9A, -+0xFF, 0x69, 0x8C, 0xE9, 0x30, 0x31, 0x49, 0xE1, -+0x40, 0x9A, 0x30, 0xF0, 0x20, 0x68, 0x06, 0x04, -+0x04, 0xD2, 0x4E, 0xF2, 0x50, 0x98, 0x04, 0x05, -+0x04, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF7, 0x50, 0x9A, 0x07, 0x04, 0x04, 0x05, -+0x49, 0xE1, 0x40, 0x9A, 0x04, 0x6E, 0x04, 0xD2, -+0x4E, 0xF2, 0x50, 0x98, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x96, 0xF7, 0x54, 0x9A, 0x08, 0x04, -+0x04, 0x05, 0x49, 0xE1, 0x40, 0x9A, 0x04, 0x6E, -+0x04, 0xD2, 0x4E, 0xF2, 0x50, 0x98, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF7, 0x58, 0x9A, -+0x09, 0x04, 0x04, 0x05, 0x45, 0xE1, 0x40, 0x99, -+0x04, 0x6E, 0x04, 0xD2, 0x4E, 0xF2, 0x50, 0x98, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, -+0x5C, 0x9A, 0x05, 0x04, 0x40, 0xEA, 0x43, 0x97, -+0x42, 0x91, 0x41, 0x90, 0x22, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF7, 0x5C, 0x9A, 0xB6, 0xF7, 0x60, 0x9B, -+0x00, 0xA2, 0x20, 0xA3, 0xFF, 0x6A, 0x4C, 0xE8, -+0x4C, 0xE9, 0x2A, 0xE8, 0x43, 0x60, 0x10, 0xF0, -+0x24, 0x6A, 0x96, 0xF6, 0x5C, 0x9A, 0x10, 0x33, -+0x49, 0xE3, 0x40, 0xA2, 0xFF, 0x6B, 0x6C, 0xEA, -+0x56, 0x32, 0x6C, 0xEA, 0x07, 0x5A, 0x2C, 0x60, -+0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, 0x76, 0xF2, -+0x1C, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, 0x00, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x4F, 0xF7, 0x5B, 0xA2, -+0x1F, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x54, 0x9A, 0x18, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x5C, 0x9A, 0x13, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x40, 0x9A, 0x0E, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, 0x44, 0x9A, -+0x09, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x48, 0x9A, 0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x4C, 0x9A, 0x90, 0x67, 0x40, 0xEA, -+0x01, 0x48, 0x7F, 0x6A, 0x4C, 0xE8, 0x0A, 0xE9, -+0xC2, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF7, -+0x5C, 0x9A, 0x20, 0xC2, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF7, 0x6C, 0x9A, -+0x02, 0x6C, 0x00, 0xF4, 0x00, 0x6D, 0x40, 0x9B, -+0x30, 0xF0, 0x20, 0x69, 0x8D, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, 0x68, 0x9A, -+0xFF, 0xF7, 0x1F, 0x6C, 0x40, 0xAB, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xCB, 0x10, 0xF0, -+0x24, 0x6A, 0xB6, 0xF7, 0x1C, 0x9A, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF7, 0x00, 0x4B, 0x40, 0x98, -+0x60, 0x9B, 0x0A, 0x6C, 0x6C, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF3, 0x70, 0x9B, 0x6D, 0xEA, -+0x40, 0xD8, 0xCE, 0xF4, 0x5C, 0x99, 0x40, 0xEA, -+0x40, 0x98, 0xDF, 0xF7, 0x01, 0x6B, 0x6B, 0xEB, -+0x6C, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF7, -+0x64, 0x9B, 0x0A, 0x6C, 0x6D, 0xEA, 0x40, 0xD8, -+0xCE, 0xF4, 0x5C, 0x99, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF7, 0x00, 0x4C, 0x40, 0x98, -+0x80, 0x9C, 0x8C, 0xEA, 0x40, 0xD8, 0xCE, 0xF4, -+0x5C, 0x99, 0x0A, 0x6C, 0x40, 0xEA, 0x40, 0x98, -+0x1D, 0xF0, 0x01, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF7, 0x68, 0x9B, -+0x0A, 0x6C, 0x6D, 0xEA, 0x40, 0xD8, 0xCE, 0xF4, -+0x5C, 0x99, 0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF7, 0xAC, 0x9B, -+0xFF, 0x6A, 0x08, 0x6E, 0x60, 0xA5, 0xCB, 0xEE, -+0x4C, 0xEC, 0x4C, 0xEB, 0xCC, 0xEB, 0x6D, 0xEC, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF7, 0x70, 0x9B, -+0x4C, 0xEC, 0x80, 0xC5, 0x60, 0xA3, 0x6C, 0xEA, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF7, 0xCC, 0x9B, 0xFF, 0x6A, 0x08, 0x6F, -+0x60, 0xA6, 0xEB, 0xEF, 0x4C, 0xEC, 0x4C, 0xEB, -+0xEC, 0xEB, 0x6D, 0xEC, 0x4C, 0xED, 0x4C, 0xEC, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF7, 0x50, 0x9A, -+0x80, 0xC6, 0xA0, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF7, 0x74, 0x9A, -+0xFF, 0x69, 0x02, 0x6C, 0x40, 0xA3, 0x01, 0x68, -+0x0B, 0xE8, 0x2C, 0xEA, 0x8D, 0xEA, 0x2C, 0xEA, -+0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, -+0x48, 0x9A, 0x01, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF7, 0x58, 0x9A, -+0x09, 0x6B, 0xB0, 0x67, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF7, 0x5C, 0x9A, 0x7A, 0x6B, -+0x6B, 0xEB, 0x60, 0xC2, 0xA1, 0xF0, 0x12, 0x4C, -+0x00, 0x18, 0x5C, 0xE3, 0x30, 0xF0, 0x20, 0x6C, -+0xCE, 0xF4, 0x70, 0x9C, 0x41, 0x6E, 0xCB, 0xEE, -+0xB0, 0x67, 0x4C, 0xEE, 0xA1, 0xF0, 0x14, 0x6C, -+0x40, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF7, -+0x60, 0x9A, 0x01, 0x6C, 0x40, 0xA3, 0x2C, 0xEA, -+0x8D, 0xEA, 0x2C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x01, 0xF3, -+0x01, 0x49, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x6F, 0xF5, 0xF0, 0xAA, 0x10, 0xF0, 0x24, 0x6A, -+0xB6, 0xF3, 0x50, 0x9A, 0x00, 0x6C, 0xD0, 0x67, -+0x4D, 0xEF, 0xA4, 0x67, 0x00, 0x18, 0xBA, 0xE3, -+0x91, 0x67, 0xB0, 0x67, 0x00, 0x18, 0x5C, 0xE3, -+0x30, 0xF0, 0x20, 0x6C, 0xCE, 0xF4, 0x70, 0x9C, -+0x03, 0x6E, 0xB0, 0x67, 0x91, 0x67, 0x4D, 0xEE, -+0x40, 0xEB, 0x01, 0x6C, 0x00, 0x18, 0xA7, 0xEA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x00, 0x6C, 0x00, 0x18, -+0xA7, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, -+0x40, 0x9A, 0x01, 0x68, 0x0B, 0xE8, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x69, 0x01, 0xF4, 0x00, 0x6C, -+0xB0, 0x67, 0x00, 0x18, 0x5C, 0xE3, 0xCE, 0xF4, -+0x70, 0x99, 0x04, 0x6E, 0xCB, 0xEE, 0x4C, 0xEE, -+0x01, 0xF4, 0x00, 0x6C, 0xB0, 0x67, 0x40, 0xEB, -+0x00, 0x6C, 0xA4, 0x67, 0xD0, 0x67, 0x00, 0x18, -+0xA7, 0xE3, 0x00, 0x6C, 0xE4, 0x67, 0x30, 0xF0, -+0x20, 0x6B, 0xA4, 0x67, 0xD0, 0x67, 0x6F, 0xF5, -+0x50, 0xCB, 0x00, 0x18, 0xBA, 0xE3, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF7, 0x60, 0x9A, 0xFE, 0x6A, -+0xB0, 0x67, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0xA1, 0xF0, 0x14, 0x6C, 0x00, 0x18, 0x5C, 0xE3, -+0xCE, 0xF4, 0x70, 0x99, 0x40, 0x6E, 0xA1, 0xF0, -+0x14, 0x6C, 0xB0, 0x67, 0x4D, 0xEE, 0x40, 0xEB, -+0x00, 0x18, 0x4B, 0xC6, 0x01, 0x72, 0x06, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, 0x48, 0x9A, -+0x3F, 0x6B, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF7, 0x74, 0x9A, 0xFD, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, 0x58, 0x9A, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x80, 0xA2, 0xEB, 0xF6, 0xD4, 0xA3, 0xEB, 0xF6, -+0x9C, 0xC3, 0xA0, 0xAA, 0x01, 0xF0, 0x00, 0x6C, -+0xAC, 0xEC, 0x83, 0x35, 0x03, 0x6C, 0xAE, 0x35, -+0x8B, 0xEC, 0xA4, 0x35, 0xCC, 0xEC, 0xAD, 0xEC, -+0xEB, 0xF6, 0x94, 0xC3, 0x10, 0xF0, 0x24, 0x6C, -+0xF6, 0xF7, 0x94, 0x9C, 0xA0, 0xAC, 0xEB, 0xF6, -+0xBE, 0xCB, 0xA0, 0xAA, 0xBF, 0xF7, 0x1F, 0x6B, -+0xAC, 0xEB, 0x60, 0xCA, 0xA0, 0xAA, 0x7F, 0xF7, -+0x1F, 0x6B, 0xAC, 0xEB, 0x60, 0xCA, 0xC0, 0xAA, -+0xFE, 0xF7, 0x1F, 0x6B, 0xFF, 0xF7, 0x1F, 0x6D, -+0xCC, 0xEB, 0x60, 0xCA, 0x40, 0xAC, 0xFF, 0x6B, -+0x21, 0x4B, 0xAC, 0xEA, 0x6D, 0xEA, 0xAC, 0xEA, -+0x40, 0xCC, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x10, 0xF0, 0x24, 0x6B, -+0xEB, 0xF6, 0x9C, 0xA2, 0xD6, 0xF4, 0x78, 0x9B, -+0x01, 0x6E, 0x80, 0xC3, 0x10, 0xF0, 0x24, 0x6C, -+0xEB, 0xF6, 0xBE, 0xAA, 0xF6, 0xF7, 0x94, 0x9C, -+0xA0, 0xCC, 0xEB, 0xF6, 0x54, 0xA2, 0x80, 0xAB, -+0xFF, 0xF7, 0x1F, 0x6D, 0x46, 0x32, 0xCC, 0xEA, -+0xAC, 0xEC, 0x40, 0x32, 0xFE, 0xF7, 0x1E, 0x4E, -+0x4C, 0x32, 0xCC, 0xEC, 0x8D, 0xEA, 0xAC, 0xEA, -+0x40, 0xCB, 0x20, 0xE8, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF7, -+0x58, 0x9A, 0xEF, 0xF7, 0x1F, 0x68, 0x02, 0x6B, -+0x40, 0xAA, 0x4C, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0x4F, 0xF6, 0x50, 0xAA, 0x0E, 0xEA, 0x6C, 0xEA, -+0x02, 0x22, 0x00, 0x18, 0xB4, 0xE9, 0x02, 0x6B, -+0x50, 0x67, 0x6C, 0xEA, 0x08, 0x2A, 0x30, 0xF0, -+0x20, 0x6A, 0x4F, 0xF6, 0x50, 0xAA, 0x6C, 0xEA, -+0x02, 0x2A, 0x00, 0x18, 0xB4, 0xE9, 0x30, 0xF0, -+0x20, 0x6A, 0x4F, 0xF6, 0x50, 0xAA, 0x80, 0x6B, -+0x0E, 0xEA, 0x6C, 0xEA, 0x06, 0x22, 0x0C, 0xEB, -+0x04, 0x2B, 0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, -+0xDB, 0xD6, 0x30, 0xF0, 0x20, 0x6A, 0x4F, 0xF6, -+0x10, 0xCA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x01, 0x74, 0x1C, 0x60, 0x05, 0x24, -+0x02, 0x74, 0x0E, 0x60, 0x03, 0x74, 0x51, 0x60, -+0x5B, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x17, 0xF0, -+0x64, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x17, 0xF0, -+0x88, 0x9C, 0x40, 0x9B, 0x8C, 0xEA, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0x17, 0xF0, 0x6C, 0x9A, -+0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF5, 0x88, 0x9C, -+0x40, 0x9B, 0x8C, 0xEA, 0x44, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0x17, 0xF0, 0x64, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0x17, 0xF0, 0x88, 0x9C, 0x40, 0x9B, -+0x8C, 0xEA, 0x10, 0xF0, 0x24, 0x6C, 0xD6, 0xF3, -+0x8C, 0x9C, 0x8D, 0xEA, 0x40, 0xDB, 0x30, 0xF0, -+0x20, 0x6A, 0x4F, 0xF6, 0x50, 0xAA, 0x80, 0x6B, -+0x6C, 0xEA, 0x1F, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0x48, 0xF5, 0x40, 0xA2, 0x05, 0x5A, 0x19, 0x60, -+0x01, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0xDB, 0xD6, -+0x0A, 0x68, 0x01, 0x6E, 0x00, 0x6C, 0x01, 0x6D, -+0xCB, 0xEE, 0x00, 0x18, 0xA7, 0xE3, 0x04, 0x6B, -+0x4C, 0xEB, 0x02, 0x23, 0x01, 0x68, 0x04, 0x10, -+0x01, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0xDB, 0xD6, -+0xFF, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0xED, 0x28, -+0x04, 0x10, 0x00, 0x6C, 0x01, 0x6D, 0x00, 0x18, -+0xDB, 0xD6, 0x10, 0xF0, 0x24, 0x6A, 0x17, 0xF0, -+0x6C, 0x9A, 0x10, 0xF0, 0x24, 0x6C, 0x56, 0xF5, -+0x84, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, 0x40, 0xDB, -+0x05, 0x97, 0x04, 0x90, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD0, 0x10, 0xF0, -+0x24, 0x6B, 0xF6, 0xF3, 0x68, 0x9B, 0xE9, 0xA4, -+0x48, 0xA4, 0xA0, 0xAB, 0xE0, 0x37, 0x5D, 0xE7, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xEF, 0x4C, 0xED, -+0x4A, 0xA4, 0xCB, 0xA4, 0x02, 0x5A, 0x04, 0x61, -+0x02, 0x72, 0x0B, 0x6A, 0x30, 0x61, 0x0C, 0x10, -+0x00, 0xF1, 0x01, 0x5F, 0x2B, 0x60, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0xAB, 0xF6, -+0x03, 0x4B, 0x2B, 0xF6, 0xE1, 0xC2, 0x0B, 0x10, -+0x00, 0xF1, 0x01, 0x5F, 0x1F, 0x60, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0xAB, 0xF7, -+0x03, 0x4B, 0x2B, 0xF6, 0xE2, 0xC2, 0xB5, 0xE6, -+0x10, 0xF0, 0x24, 0x6E, 0x00, 0x6A, 0x17, 0xF0, -+0x10, 0x9E, 0x10, 0xF0, 0x24, 0x6E, 0x04, 0xD2, -+0x05, 0xD2, 0xF6, 0xF3, 0xD4, 0x9E, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x40, 0x9A, 0xBC, 0x35, -+0x00, 0x6C, 0x15, 0xE5, 0xD9, 0xE3, 0x40, 0xEA, -+0x00, 0x6A, 0x01, 0x10, 0x0A, 0x6A, 0x07, 0x97, -+0x06, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFC, 0x63, 0x07, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x01, 0x2A, 0x01, 0x6A, 0x30, 0xF0, 0x20, 0x6C, -+0xC0, 0xF1, 0x08, 0x4C, 0xCB, 0xF6, 0xDD, 0xA4, -+0x38, 0x26, 0x8D, 0xE2, 0x4B, 0xF4, 0x78, 0xA3, -+0x34, 0x23, 0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF3, -+0x68, 0x9B, 0xFF, 0xF7, 0x1F, 0x6D, 0x01, 0x72, -+0x60, 0xAB, 0x6C, 0xED, 0x03, 0x60, 0x02, 0x72, -+0x08, 0x60, 0x27, 0x10, 0x30, 0xF0, 0x20, 0x6B, -+0xAB, 0xF6, 0x03, 0x4B, 0x4B, 0xF4, 0xF9, 0xA4, -+0x06, 0x10, 0x4B, 0xF4, 0xFA, 0xA4, 0x30, 0xF0, -+0x20, 0x6B, 0xAB, 0xF7, 0x03, 0x4B, 0xE1, 0xF7, -+0x1F, 0x6A, 0xAC, 0xEA, 0x10, 0xF0, 0x24, 0x6D, -+0xF6, 0xF3, 0xB4, 0x9D, 0xD9, 0xE2, 0x00, 0x6A, -+0xB5, 0xE3, 0x10, 0xF0, 0x24, 0x6B, 0x04, 0xD2, -+0x05, 0xD2, 0x17, 0xF0, 0x70, 0x9B, 0x30, 0xF0, -+0x20, 0x6A, 0xAE, 0xF2, 0x40, 0x9A, 0xDC, 0x36, -+0x00, 0x6C, 0x79, 0xE6, 0x40, 0xEA, 0x01, 0x6A, -+0x01, 0x10, 0x00, 0x6A, 0x07, 0x97, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x4C, 0xED, -+0x4C, 0xEC, 0x4C, 0xEE, 0xEC, 0xEA, 0x05, 0x25, -+0x01, 0x75, 0x56, 0x61, 0x08, 0x6B, 0x0C, 0x6D, -+0x02, 0x10, 0x0A, 0x6B, 0x0E, 0x6D, 0x01, 0x74, -+0x1D, 0x60, 0x02, 0x74, 0x2A, 0x60, 0x26, 0x67, -+0xE1, 0x45, 0xC4, 0xED, 0x24, 0xEB, 0x82, 0x67, -+0xCD, 0xE9, 0x84, 0xEF, 0xC1, 0x43, 0x8D, 0xE9, -+0x44, 0xEE, 0x4D, 0xE9, 0x01, 0x6A, 0x02, 0x67, -+0x04, 0xEB, 0x62, 0x67, 0x64, 0xED, 0xA2, 0x67, -+0x6D, 0xE8, 0xA4, 0xEF, 0xAD, 0xE8, 0x44, 0xEE, -+0xFF, 0xF7, 0x1F, 0x6C, 0x4D, 0xE8, 0x8C, 0xE9, -+0x8C, 0xE8, 0x1E, 0x10, 0x01, 0x6B, 0x01, 0x45, -+0x22, 0x67, 0x83, 0x67, 0x24, 0xE8, 0xC4, 0xED, -+0x84, 0xE8, 0xCD, 0xE9, 0xFF, 0xF7, 0x1F, 0x6A, -+0x04, 0x67, 0x64, 0xED, 0x4C, 0xE9, 0x6D, 0xE8, -+0x0E, 0x10, 0x01, 0x6C, 0x01, 0x43, 0x22, 0x67, -+0xA4, 0x67, 0x24, 0xE8, 0xC4, 0xEB, 0xA4, 0xE8, -+0xCD, 0xE9, 0xFF, 0xF7, 0x1F, 0x6A, 0x05, 0x67, -+0x84, 0xEB, 0x4C, 0xE9, 0x8D, 0xE8, 0x4C, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF3, 0x4C, 0x9A, -+0x38, 0x6C, 0x0F, 0xE8, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xEE, 0xF3, 0x40, 0x9A, 0x40, 0xEA, -+0x4C, 0xE8, 0x04, 0x92, 0x2D, 0xE8, 0xFF, 0xF7, -+0x1F, 0x6D, 0x38, 0x6C, 0x0C, 0xED, 0x40, 0xEA, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0xE8, 0xF2, 0x7C, 0xA3, 0xFF, 0x6A, 0xAC, 0xEA, -+0x01, 0x73, 0x03, 0x61, 0xAD, 0xF4, 0x00, 0x6B, -+0x04, 0x10, 0x03, 0x73, 0x04, 0x61, 0xA5, 0xF1, -+0x00, 0x6B, 0x6B, 0xEB, 0x02, 0x10, 0x60, 0xF2, -+0x00, 0x6B, 0x60, 0xCC, 0x30, 0xF0, 0x20, 0x6B, -+0xE8, 0xF2, 0x7C, 0xA3, 0x02, 0x73, 0x0A, 0x61, -+0x10, 0xF0, 0x24, 0x6B, 0x37, 0xF0, 0x78, 0x9B, -+0x74, 0x6D, 0xA0, 0xC3, 0xA0, 0xAC, 0x80, 0x6B, -+0xAD, 0xEB, 0x60, 0xCC, 0x09, 0x22, 0x60, 0xAC, -+0x00, 0xF2, 0x01, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x41, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x06, 0x10, -+0x60, 0xAC, 0x00, 0xF2, 0x00, 0x6A, 0x6D, 0xEA, -+0x40, 0x6B, 0x6D, 0xEA, 0x40, 0xCC, 0x20, 0xE8, -+0xFF, 0x63, 0x01, 0xD1, 0x00, 0xD0, 0x30, 0xF0, -+0x20, 0x6B, 0xE8, 0xF2, 0x7C, 0xA3, 0xFF, 0x6A, -+0x8C, 0xEA, 0x02, 0x73, 0x70, 0x61, 0x48, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x37, 0xF0, 0xFC, 0x9A, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0x60, 0x9F, 0xC0, 0xF0, 0x64, 0xDA, 0x10, 0xF0, -+0x24, 0x6B, 0x57, 0xF0, 0xC0, 0x9B, 0x60, 0x9E, -+0xA0, 0xF0, 0x78, 0xDA, 0x10, 0xF0, 0x24, 0x6B, -+0x17, 0xF0, 0xA4, 0x9B, 0x60, 0x9D, 0xA0, 0xF0, -+0x7C, 0xDA, 0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF6, -+0x98, 0x9B, 0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF6, -+0x7C, 0x9B, 0x20, 0x9C, 0xA0, 0xF0, 0x34, 0xDA, -+0x00, 0x9B, 0xC0, 0xF0, 0x00, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0x57, 0xF0, 0x44, 0x9A, 0x2D, 0xEA, -+0x18, 0xF0, 0x01, 0x69, 0x2B, 0xE9, 0x2C, 0xEA, -+0x10, 0xF0, 0x24, 0x69, 0x76, 0xF7, 0x34, 0x99, -+0x0D, 0xE9, 0x02, 0xF0, 0x01, 0x68, 0x0B, 0xE8, -+0x0C, 0xE9, 0x10, 0xF0, 0x24, 0x68, 0x57, 0xF0, -+0x08, 0x98, 0x00, 0xDF, 0x04, 0x6F, 0xE0, 0xDE, -+0x10, 0xF0, 0x24, 0x6E, 0x57, 0xF0, 0xCC, 0x9E, -+0xC0, 0xDD, 0x40, 0xDC, 0x20, 0xDB, 0x27, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0x10, 0xF0, 0x24, 0x6B, 0xC0, 0xF0, 0x84, 0x9A, -+0x37, 0xF0, 0x7C, 0x9B, 0x80, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xA0, 0xF0, 0x98, 0x9A, 0x57, 0xF0, -+0x60, 0x9B, 0x80, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xA0, 0xF0, 0x9C, 0x9A, 0x17, 0xF0, 0x64, 0x9B, -+0x80, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xA0, 0xF0, -+0x94, 0x9A, 0x56, 0xF6, 0x78, 0x9B, 0x80, 0xDB, -+0xC0, 0xF0, 0x60, 0x9A, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF6, 0x5C, 0x9A, 0x60, 0xDA, 0x01, 0x91, -+0x00, 0x90, 0x01, 0x63, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF4, 0x60, 0x9A, -+0xFF, 0x6C, 0x21, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xE8, 0xF2, 0x5C, 0xA2, 0x01, 0x72, 0x0C, 0x61, -+0x01, 0x6C, 0x10, 0x6D, 0x00, 0x18, 0x29, 0xD5, -+0x04, 0x6B, 0x4D, 0xEB, 0xFF, 0x6E, 0x01, 0x6C, -+0x10, 0x6D, 0x6C, 0xEE, 0x00, 0x18, 0x1C, 0xD5, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xE8, 0xF2, 0x5C, 0xA2, 0x01, 0x72, 0x0A, 0x61, -+0x01, 0x6C, 0x10, 0x6D, 0x00, 0x18, 0x29, 0xD5, -+0xFB, 0x6E, 0x01, 0x6C, 0x10, 0x6D, 0x4C, 0xEE, -+0x00, 0x18, 0x1C, 0xD5, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0xF7, 0x1F, 0x6B, -+0xAC, 0xEB, 0x06, 0xD3, 0x10, 0xF0, 0x24, 0x6B, -+0xF6, 0xF3, 0x68, 0x9B, 0xFF, 0x6A, 0x8C, 0xEA, -+0x80, 0xAB, 0xE1, 0xF7, 0x1F, 0x6B, 0x00, 0x68, -+0x8C, 0xEB, 0x69, 0xE2, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF4, 0x8C, 0x9B, 0x5C, 0x32, 0x91, 0xE2, -+0x04, 0xD4, 0x22, 0x10, 0x04, 0x92, 0x40, 0x9A, -+0x05, 0xD2, 0x0D, 0x28, 0x30, 0xF0, 0x20, 0x69, -+0xCE, 0xF4, 0x50, 0x99, 0x05, 0x96, 0x01, 0x6D, -+0x83, 0xF1, 0x18, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x99, 0x04, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x05, 0x96, -+0x01, 0x6D, 0x83, 0xF1, 0x18, 0x6C, 0xAB, 0xED, -+0x40, 0xEA, 0x04, 0x93, 0x01, 0x48, 0xFF, 0xF7, -+0x1F, 0x6A, 0x04, 0x4B, 0x4C, 0xE8, 0x04, 0xD3, -+0x06, 0x92, 0x43, 0xE8, 0xDB, 0x61, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xFF, 0x16, 0x03, 0x80, 0x15, 0x17, 0x03, 0x80, -+0x2B, 0x17, 0x03, 0x80, 0x41, 0x17, 0x03, 0x80, -+0x5B, 0x17, 0x03, 0x80, 0xB3, 0x17, 0x03, 0x80, -+0xC9, 0x17, 0x03, 0x80, 0xE7, 0x17, 0x03, 0x80, -+0x19, 0x18, 0x03, 0x80, 0x43, 0x18, 0x03, 0x80, -+0xF7, 0x26, 0x03, 0x80, 0xFD, 0x26, 0x03, 0x80, -+0x09, 0x27, 0x03, 0x80, 0x15, 0x27, 0x03, 0x80, -+0x21, 0x27, 0x03, 0x80, 0x91, 0x29, 0x03, 0x80, -+0x79, 0x2A, 0x03, 0x80, 0xF3, 0x29, 0x03, 0x80, -+0x79, 0x2A, 0x03, 0x80, 0x39, 0x29, 0x03, 0x80, -+0x79, 0x2A, 0x03, 0x80, 0x79, 0x2A, 0x03, 0x80, -+0x79, 0x2A, 0x03, 0x80, 0x5B, 0x2A, 0x03, 0x80, -+0x79, 0x2A, 0x03, 0x80, 0x79, 0x2A, 0x03, 0x80, -+0x79, 0x2A, 0x03, 0x80, 0xD3, 0x28, 0x03, 0x80, -+0x4F, 0x2D, 0x03, 0x80, 0x59, 0x2D, 0x03, 0x80, -+0x63, 0x2D, 0x03, 0x80, 0x6D, 0x2D, 0x03, 0x80, -+0x77, 0x2D, 0x03, 0x80, 0xD5, 0x2E, 0x03, 0x80, -+0xF5, 0x2E, 0x03, 0x80, 0x15, 0x2F, 0x03, 0x80, -+0x35, 0x2F, 0x03, 0x80, 0x55, 0x2F, 0x03, 0x80, -+0xFF, 0x30, 0x03, 0x80, 0x3B, 0x31, 0x03, 0x80, -+0x81, 0x31, 0x03, 0x80, 0xC3, 0x31, 0x03, 0x80, -+0x09, 0x32, 0x03, 0x80, 0x77, 0x32, 0x03, 0x80, -+0x93, 0x32, 0x03, 0x80, 0xB5, 0x32, 0x03, 0x80, -+0xD7, 0x32, 0x03, 0x80, 0xFB, 0x32, 0x03, 0x80, -+0xA8, 0x06, 0x10, 0x07, 0x00, 0x16, 0x04, 0x16, -+0x08, 0x16, 0x00, 0x00, 0xC7, 0x35, 0x03, 0x80, -+0x23, 0x36, 0x03, 0x80, 0xB7, 0x36, 0x03, 0x80, -+0x4B, 0x37, 0x03, 0x80, 0xE3, 0x37, 0x03, 0x80, -+0x33, 0x2A, 0x10, 0x80, 0x27, 0x2A, 0x10, 0x80, -+0x1B, 0x2A, 0x10, 0x80, 0x0F, 0x2A, 0x10, 0x80, -+0x03, 0x2A, 0x10, 0x80, 0x00, 0x04, 0x08, 0x00, -+0x08, 0x04, 0x04, 0x00, 0x7D, 0x52, 0x03, 0x80, -+0x87, 0x52, 0x03, 0x80, 0x91, 0x52, 0x03, 0x80, -+0x9B, 0x52, 0x03, 0x80, 0xA5, 0x52, 0x03, 0x80, -+0x75, 0x55, 0x03, 0x80, 0x6F, 0x55, 0x03, 0x80, -+0x7B, 0x55, 0x03, 0x80, 0x81, 0x55, 0x03, 0x80, -+0x87, 0x55, 0x03, 0x80, 0x8D, 0x55, 0x03, 0x80, -+0x67, 0x56, 0x10, 0x80, 0xAB, 0x56, 0x10, 0x80, -+0x33, 0x57, 0x10, 0x80, 0x63, 0x56, 0x10, 0x80, -+0x95, 0x57, 0x10, 0x80, 0xC5, 0x57, 0x10, 0x80, -+0xE9, 0x58, 0x10, 0x80, 0x03, 0x59, 0x10, 0x80, -+0x13, 0x59, 0x10, 0x80, 0x29, 0x59, 0x10, 0x80, -+0x3F, 0x59, 0x10, 0x80, 0x3F, 0x59, 0x10, 0x80, -+0x5B, 0x59, 0x10, 0x80, 0xA9, 0x0F, 0x03, 0x80, -+0xA5, 0x0F, 0x03, 0x80, 0xA9, 0x0F, 0x03, 0x80, -+0xA5, 0x0F, 0x03, 0x80, 0xC9, 0x0F, 0x03, 0x80, -+0xA5, 0x0F, 0x03, 0x80, 0xC9, 0x0F, 0x03, 0x80, -+0xA5, 0x0F, 0x03, 0x80, 0xE9, 0x0F, 0x03, 0x80, -+0xA5, 0x0F, 0x03, 0x80, 0xE9, 0x0F, 0x03, 0x80, -+0xA5, 0x0F, 0x03, 0x80, 0x09, 0x10, 0x03, 0x80, -+0xA5, 0x0F, 0x03, 0x80, 0x09, 0x10, 0x03, 0x80, -+0x77, 0x6A, 0x03, 0x80, 0x8D, 0x6A, 0x03, 0x80, -+0xB7, 0x6A, 0x03, 0x80, 0xB7, 0x6A, 0x03, 0x80, -+0xB7, 0x6A, 0x03, 0x80, 0xB7, 0x6A, 0x03, 0x80, -+0x99, 0x6A, 0x03, 0x80, 0xA3, 0x6A, 0x03, 0x80, -+0xAD, 0x6A, 0x03, 0x80, 0xB7, 0x6A, 0x03, 0x80, -+0x7F, 0x6A, 0x03, 0x80, 0x6D, 0x6A, 0x03, 0x80, -+0x1B, 0x12, 0x03, 0x80, 0x1F, 0x12, 0x03, 0x80, -+0x23, 0x12, 0x03, 0x80, 0x27, 0x12, 0x03, 0x80, -+0x2B, 0x12, 0x03, 0x80, 0x05, 0x7D, 0x03, 0x80, -+0x27, 0x7D, 0x03, 0x80, 0x49, 0x7D, 0x03, 0x80, -+0x6B, 0x7D, 0x03, 0x80, 0x8F, 0x7D, 0x03, 0x80, -+0xC9, 0x7D, 0x03, 0x80, 0xED, 0x7D, 0x03, 0x80, -+0x11, 0x7E, 0x03, 0x80, 0x35, 0x7E, 0x03, 0x80, -+0x5B, 0x7E, 0x03, 0x80, 0x61, 0x80, 0x03, 0x80, -+0x77, 0x80, 0x03, 0x80, 0x99, 0x80, 0x03, 0x80, -+0xBF, 0x80, 0x03, 0x80, 0xE5, 0x80, 0x03, 0x80, -+0xC1, 0x84, 0x03, 0x80, 0xC1, 0x84, 0x03, 0x80, -+0xC1, 0x84, 0x03, 0x80, 0xDB, 0x84, 0x03, 0x80, -+0xC1, 0x84, 0x03, 0x80, 0xC1, 0x84, 0x03, 0x80, -+0xC1, 0x84, 0x03, 0x80, 0xBD, 0x84, 0x03, 0x80, -+0xBD, 0x84, 0x03, 0x80, 0xBD, 0x84, 0x03, 0x80, -+0xBD, 0x84, 0x03, 0x80, 0xBD, 0x84, 0x03, 0x80, -+0x39, 0x85, 0x03, 0x80, 0x43, 0x85, 0x03, 0x80, -+0x51, 0x13, 0x03, 0x80, 0x51, 0x13, 0x03, 0x80, -+0x51, 0x13, 0x03, 0x80, 0x51, 0x13, 0x03, 0x80, -+0x71, 0x13, 0x03, 0x80, 0x71, 0x13, 0x03, 0x80, -+0x71, 0x13, 0x03, 0x80, 0x71, 0x13, 0x03, 0x80, -+0x91, 0x13, 0x03, 0x80, 0x91, 0x13, 0x03, 0x80, -+0x91, 0x13, 0x03, 0x80, 0x91, 0x13, 0x03, 0x80, -+0xB1, 0x13, 0x03, 0x80, 0xB1, 0x13, 0x03, 0x80, -+0xB1, 0x13, 0x03, 0x80, 0xB1, 0x13, 0x03, 0x80, -+0xC3, 0x96, 0x03, 0x80, 0xD3, 0x96, 0x03, 0x80, -+0xDD, 0x96, 0x03, 0x80, 0xE7, 0x96, 0x03, 0x80, -+0xF9, 0x96, 0x03, 0x80, 0x69, 0xA6, 0x03, 0x80, -+0x9B, 0xA6, 0x03, 0x80, 0x7D, 0xA6, 0x03, 0x80, -+0xA5, 0xA6, 0x03, 0x80, 0x87, 0xA6, 0x03, 0x80, -+0xB1, 0xA6, 0x03, 0x80, 0x91, 0xA6, 0x03, 0x80, -+0xFC, 0x10, 0x60, 0xB8, 0xFA, 0xFA, 0xFA, 0xFA, -+0x8C, 0x04, 0x64, 0xB8, 0x90, 0x04, 0x64, 0xB8, -+0x94, 0x04, 0x64, 0xB8, 0x98, 0x04, 0x64, 0xB8, -+0x9C, 0x04, 0x64, 0xB8, 0xA0, 0x04, 0x64, 0xB8, -+0x01, 0x06, 0x64, 0xB8, 0x00, 0x00, 0x68, 0x18, -+0x48, 0x00, 0x68, 0x18, 0x48, 0x04, 0x68, 0x18, -+0x00, 0x00, 0x60, 0xB8, 0x00, 0x00, 0x64, 0xB8, -+0x54, 0x05, 0x64, 0xB8, 0x50, 0x05, 0x64, 0xB8, -+0x51, 0x05, 0x64, 0xB8, 0x78, 0x05, 0x64, 0xB8, -+0x79, 0x05, 0x64, 0xB8, 0x7A, 0x05, 0x64, 0xB8, -+0xFF, 0xFF, 0xFF, 0x8F, 0x60, 0x05, 0x60, 0xB8, -+0x60, 0x05, 0x64, 0xB8, 0x00, 0x00, 0x00, 0x10, -+0x00, 0x00, 0x00, 0x20, 0x00, 0x00, 0x00, 0x30, -+0x00, 0x00, 0x00, 0x40, 0xBF, 0x01, 0x64, 0xB8, -+0x89, 0x00, 0x60, 0xB8, 0x8A, 0x00, 0x60, 0xB8, -+0x1A, 0x04, 0x64, 0xB8, 0x1B, 0x04, 0x64, 0xB8, -+0x01, 0x00, 0xFF, 0x00, 0xF0, 0x11, 0x64, 0xB8, -+0x58, 0x05, 0x64, 0xB8, 0x01, 0x00, 0x60, 0xB8, -+0x01, 0x00, 0x64, 0xB8, 0x87, 0x02, 0x64, 0xB8, -+0x86, 0x02, 0x64, 0xB8, 0x1C, 0x04, 0x64, 0xB8, -+0xF8, 0x10, 0x60, 0xB8, 0x00, 0x00, 0x40, 0x00, -+0x5B, 0x01, 0x64, 0xB8, 0x3C, 0x01, 0x64, 0xB8, -+0x22, 0x05, 0x64, 0xB8, 0x00, 0x00, 0x01, 0x00, -+0x00, 0x00, 0x02, 0x00, 0x00, 0x00, 0x04, 0x00, -+0x00, 0x00, 0x08, 0x00, 0x0A, 0x06, 0x64, 0xB8, -+0xFE, 0x11, 0x64, 0xB8, 0xA8, 0x06, 0x64, 0xB8, -+0x10, 0x07, 0x64, 0xB8, 0x00, 0x16, 0x64, 0xB8, -+0x04, 0x16, 0x64, 0xB8, 0x08, 0x16, 0x64, 0xB8, -+0xAB, 0x06, 0x64, 0xB8, 0xAA, 0x06, 0x64, 0xB8, -+0x13, 0x07, 0x64, 0xB8, 0x12, 0x07, 0x64, 0xB8, -+0x03, 0x16, 0x64, 0xB8, 0x02, 0x16, 0x64, 0xB8, -+0x07, 0x16, 0x64, 0xB8, 0x06, 0x16, 0x64, 0xB8, -+0x0B, 0x16, 0x64, 0xB8, 0x0A, 0x16, 0x64, 0xB8, -+0xFC, 0x11, 0x64, 0xB8, 0x57, 0x01, 0x64, 0xB8, -+0x00, 0x00, 0x1E, 0x00, 0x00, 0x00, 0x06, 0x00, -+0x00, 0x00, 0x03, 0x00, 0x00, 0x00, 0x30, 0x00, -+0x00, 0x00, 0x00, 0x03, 0xB1, 0x05, 0x64, 0xB8, -+0x22, 0x00, 0x60, 0xB8, 0x04, 0x06, 0x64, 0xB8, -+0xFF, 0xFF, 0xFF, 0xFE, 0x00, 0x00, 0x00, 0x01, -+0x60, 0x16, 0x64, 0xB8, 0x09, 0x00, 0x78, 0xB8, -+0x31, 0x00, 0x78, 0xB8, 0x14, 0x00, 0x78, 0xB8, -+0x1D, 0x04, 0x64, 0xB8, 0x7A, 0x04, 0x64, 0xB8, -+0x24, 0x04, 0x64, 0xB8, 0x80, 0x01, 0x64, 0xB8, -+0x84, 0x01, 0x64, 0xB8, 0x00, 0x00, 0x00, 0x80, -+0x74, 0x06, 0x64, 0xB8, 0x00, 0x00, 0x01, 0x80, -+0x70, 0x06, 0x64, 0xB8, 0x72, 0x06, 0x64, 0xB8, -+0xC3, 0x01, 0x64, 0xB8, 0xA9, 0x00, 0x78, 0xB8, -+0x61, 0x00, 0x78, 0xB8, 0x00, 0x00, 0x78, 0xB8, -+0x01, 0x00, 0x78, 0xB8, 0xFF, 0xFF, 0x77, 0xB8, -+0xB9, 0x00, 0x78, 0xB8, 0xC1, 0x01, 0x64, 0xB8, -+0xB9, 0x01, 0x64, 0xB8, 0xC7, 0x01, 0x64, 0xB8, -+0x00, 0x00, 0xFF, 0x00, 0x04, 0x00, 0x78, 0xB8, -+0x05, 0x00, 0x78, 0xB8, 0x46, 0x00, 0x78, 0xB8, -+0x50, 0x00, 0x78, 0xB8, 0x40, 0x00, 0x78, 0xB8, -+0x4A, 0x00, 0x78, 0xB8, 0x30, 0x00, 0x78, 0xB8, -+0x34, 0x00, 0x78, 0xB8, 0x24, 0x01, 0x64, 0xB8, -+0xB8, 0x01, 0x64, 0xB8, 0x28, 0x00, 0x78, 0xB8, -+0x90, 0x06, 0x64, 0xB8, 0x18, 0x06, 0x60, 0xB8, -+0x18, 0x06, 0x64, 0xB8, 0x10, 0x06, 0x60, 0xB8, -+0x10, 0x06, 0x64, 0xB8, 0x08, 0x07, 0x60, 0xB8, -+0x08, 0x07, 0x64, 0xB8, 0x00, 0x07, 0x60, 0xB8, -+0x00, 0x07, 0x64, 0xB8, 0x28, 0x16, 0x60, 0xB8, -+0x28, 0x16, 0x64, 0xB8, 0x20, 0x16, 0x60, 0xB8, -+0x20, 0x16, 0x64, 0xB8, 0x38, 0x16, 0x60, 0xB8, -+0x38, 0x16, 0x64, 0xB8, 0x30, 0x16, 0x60, 0xB8, -+0x30, 0x16, 0x64, 0xB8, 0x48, 0x16, 0x60, 0xB8, -+0x48, 0x16, 0x64, 0xB8, 0x40, 0x16, 0x60, 0xB8, -+0x40, 0x16, 0x64, 0xB8, 0x18, 0x00, 0x78, 0xB8, -+0x10, 0x00, 0x78, 0xB8, 0x08, 0x00, 0x78, 0xB8, -+0x0A, 0x00, 0x78, 0xB8, 0x4D, 0x01, 0x64, 0xB8, -+0x00, 0x01, 0x64, 0xB8, 0x1C, 0x01, 0x64, 0xB8, -+0xFF, 0xFF, 0x03, 0x00, 0x09, 0x06, 0x64, 0xB8, -+0x08, 0x06, 0x64, 0xB8, 0xFF, 0xFF, 0xFF, 0x7F, -+0x38, 0x00, 0x78, 0xB8, 0x7A, 0x00, 0x78, 0xB8, -+0x60, 0x00, 0x78, 0xB8, 0x54, 0x00, 0x78, 0xB8, -+0xC0, 0x01, 0x64, 0xB8, 0x18, 0x11, 0x64, 0xB8, -+0x20, 0x00, 0x78, 0xB8, 0xC4, 0x01, 0x64, 0xB8, -+0xA5, 0xA5, 0xA5, 0xA5, 0x02, 0x00, 0x78, 0xB8, -+0x06, 0x00, 0x78, 0xB8, 0x0C, 0x00, 0x78, 0xB8, -+0xC2, 0x01, 0x64, 0xB8, 0x0D, 0x00, 0x78, 0xB8, -+0x0E, 0x00, 0x78, 0xB8, 0x0F, 0x00, 0x78, 0xB8, -+0x88, 0x00, 0x60, 0xB8, 0x8B, 0x00, 0x60, 0xB8, -+0x84, 0x00, 0x60, 0xB8, 0x00, 0x00, 0x00, 0x02, -+0xCB, 0x01, 0x64, 0xB8, 0x00, 0x00, 0x00, 0x60, -+0xE0, 0x00, 0x60, 0xB8, 0xE1, 0x00, 0x60, 0xB8, -+0xE8, 0x12, 0x64, 0xB8, 0x00, 0x00, 0x00, 0x04, -+0xFF, 0xFF, 0xFF, 0xFB, 0xFF, 0xFF, 0xFF, 0xDF, -+0xFF, 0xFF, 0xFF, 0x1F, 0x04, 0x00, 0x60, 0xB8, -+0x04, 0x00, 0x64, 0xB8, 0x08, 0x00, 0x60, 0xB8, -+0x08, 0x00, 0x64, 0xB8, 0x24, 0x00, 0x60, 0xB8, -+0x80, 0x00, 0x60, 0xB8, 0xFF, 0xFF, 0xFE, 0xFF, -+0xFF, 0xFF, 0xFD, 0xFF, 0xCC, 0x07, 0x64, 0xB8, -+0x82, 0x10, 0x60, 0xB8, 0x42, 0x34, 0x00, 0xB8, -+0x00, 0x0C, 0x01, 0x00, 0x01, 0x00, 0x66, 0xB8, -+0xFF, 0xFF, 0x0B, 0xFF, 0x00, 0x00, 0x70, 0x00, -+0xFF, 0xFF, 0x7A, 0xFF, 0x00, 0x00, 0xD0, 0x00, -+0xFF, 0xFF, 0xDA, 0xFF, 0xFF, 0xFF, 0x0F, 0x00, -+0xFF, 0xFF, 0xFF, 0x0F, 0x00, 0xFF, 0xF9, 0xFF, -+0x00, 0x00, 0xFE, 0x1F, 0x1C, 0x0C, 0xB8, 0x64, -+0x67, 0x56, 0x23, 0x01, 0xFF, 0xFF, 0xF7, 0xFF, -+0xFF, 0xFC, 0xFE, 0xFF, 0x00, 0x01, 0x01, 0x00, -+0x00, 0xFC, 0xCF, 0xFF, 0x00, 0x00, 0x01, 0x10, -+0x00, 0xF3, 0x3F, 0xFF, 0x01, 0x00, 0x02, 0x20, -+0x00, 0xCF, 0xFF, 0xFC, 0x02, 0x00, 0x04, 0x40, -+0x00, 0xFC, 0xCE, 0xEF, 0x40, 0x02, 0x20, 0x00, -+0x80, 0x03, 0x30, 0x00, 0x00, 0x00, 0x80, 0x01, -+0xCC, 0x06, 0x64, 0xB8, 0x96, 0x02, 0x64, 0xB8, -+0x00, 0x00, 0x70, 0xB8, 0x18, 0x00, 0x70, 0xB8, -+0x0B, 0x00, 0x70, 0xB8, 0x02, 0x00, 0x70, 0xB8, -+0x94, 0x02, 0x64, 0xB8, 0x97, 0x02, 0x64, 0xB8, -+0x84, 0x02, 0x64, 0xB8, 0x54, 0x02, 0x64, 0xB8, -+0x50, 0x02, 0x64, 0xB8, 0x4C, 0x02, 0x64, 0xB8, -+0x48, 0x02, 0x64, 0xB8, 0x44, 0x02, 0x64, 0xB8, -+0xCC, 0x01, 0x64, 0xB8, 0xF4, 0x11, 0x64, 0xB8, -+0xF5, 0x11, 0x64, 0xB8, 0xD4, 0x04, 0x60, 0xB8, -+0xD4, 0x04, 0x64, 0xB8, 0x84, 0x04, 0x60, 0xB8, -+0x84, 0x04, 0x64, 0xB8, 0xC8, 0x04, 0x60, 0xB8, -+0xC8, 0x04, 0x64, 0xB8, 0x78, 0x04, 0x60, 0xB8, -+0x78, 0x04, 0x64, 0xB8, 0xCF, 0x01, 0x64, 0xB8, -+0x34, 0x01, 0x64, 0xB8, 0x64, 0x05, 0x64, 0xB8, -+0x44, 0x00, 0x60, 0xB8, 0x60, 0x00, 0x60, 0xB8, -+0x1F, 0x00, 0x60, 0xB8, 0x01, 0xEA, 0xEF, 0xFD, -+0x02, 0xEA, 0xEF, 0xFD, 0xC8, 0x01, 0x64, 0xB8, -+0xC9, 0x01, 0x64, 0xB8, 0xA0, 0x01, 0x64, 0xB8, -+0xC6, 0x01, 0x64, 0xB8, 0xFF, 0xFF, 0xFF, 0x00, -+0x00, 0x00, 0x00, 0x05, 0x64, 0x01, 0x64, 0xB8, -+0x53, 0x05, 0x64, 0xB8, 0x77, 0x05, 0x64, 0xB8, -+0x68, 0x05, 0x64, 0xB8, 0x94, 0x01, 0x64, 0xB8, -+0x00, 0x00, 0x66, 0xB8, 0x00, 0x10, 0x66, 0xB8, -+0x00, 0x1C, 0x66, 0xB8, 0x54, 0x00, 0x60, 0xB8, -+0x50, 0x00, 0x60, 0xB8, 0x9A, 0x01, 0x64, 0xB8, -+0x99, 0x01, 0x64, 0xB8, 0x30, 0x01, 0x64, 0xB8, -+0x20, 0x01, 0x64, 0xB8, 0x24, 0x11, 0x64, 0xB8, -+0x20, 0x11, 0x64, 0xB8, 0x2C, 0x11, 0x64, 0xB8, -+0x28, 0x11, 0x64, 0xB8, 0x34, 0x11, 0x64, 0xB8, -+0x30, 0x11, 0x64, 0xB8, 0x38, 0x01, 0x64, 0xB8, -+0x3C, 0x11, 0x64, 0xB8, 0x38, 0x11, 0x64, 0xB8, -+0xE4, 0x11, 0x64, 0xB8, 0xE0, 0x11, 0x64, 0xB8, -+0x00, 0x40, 0xE0, 0x03, 0x01, 0x60, 0x00, 0x03, -+0xE0, 0x04, 0x64, 0xB8, 0xE3, 0x04, 0x64, 0xB8, -+0xE0, 0x12, 0x64, 0xB8, 0x08, 0x02, 0x64, 0xB8, -+0x2F, 0x01, 0x64, 0xB8, 0x00, 0x28, 0x64, 0xB8, -+0x00, 0x2C, 0x64, 0xB8, 0x00, 0x38, 0x64, 0xB8, -+0x00, 0x3C, 0x64, 0xB8, 0xF8, 0x05, 0x64, 0xB8, -+0xF9, 0x05, 0x64, 0xB8, 0xFA, 0x05, 0x64, 0xB8, -+0xFB, 0x05, 0x64, 0xB8, 0x83, 0x00, 0x60, 0xB8, -+0x08, 0x01, 0x64, 0xB8, 0x90, 0x00, 0x60, 0xB8, -+0x92, 0x00, 0x60, 0xB8, 0x92, 0x06, 0x64, 0xB8, -+0xF1, 0x11, 0x64, 0xB8, 0x03, 0x00, 0x78, 0xB8, -+0xFF, 0xFF, 0x01, 0xFF, 0x12, 0x05, 0x64, 0xB8, -+0x10, 0x05, 0x64, 0xB8, 0xB8, 0x05, 0x64, 0xB8, -+0xBC, 0x05, 0x64, 0xB8, 0x00, 0x00, 0x80, 0x00, -+0x5F, 0x11, 0x64, 0xB8, 0xFE, 0xFF, 0xFF, 0x7F, -+0x30, 0x00, 0x78, 0x18, 0x40, 0x00, 0x00, 0xB5, -+0x44, 0x00, 0x00, 0xB5, 0x48, 0x00, 0x00, 0xB5, -+0x4C, 0x00, 0x00, 0xB5, 0x00, 0x00, 0x10, 0x00, -+0xA4, 0x04, 0x64, 0xB8, 0xA8, 0x04, 0x64, 0xB8, -+0xAF, 0x01, 0x64, 0xB8, 0x00, 0x00, 0x20, 0x00, -+0x7E, 0x04, 0x64, 0xB8, 0x20, 0x04, 0x64, 0xB8, -+0x04, 0x10, 0x66, 0xB8, 0x08, 0x10, 0x66, 0xB8, -+0x0C, 0x10, 0x66, 0xB8, 0x7D, 0x04, 0x64, 0xB8, -+0x7C, 0x04, 0x64, 0xB8, 0x14, 0x11, 0x64, 0xB8, -+0x16, 0x11, 0x64, 0xB8, 0x17, 0x11, 0x64, 0xB8, -+0xD4, 0x07, 0x64, 0xB8, 0x0F, 0x06, 0x64, 0xB8, -+0x02, 0x06, 0x64, 0xB8, 0x98, 0x01, 0x64, 0xB8, -+0xFF, 0xFF, 0xC0, 0xFF, 0x40, 0x01, 0x00, 0x80, -+0x00, 0x98, 0x00, 0x80, 0x7B, 0x05, 0x64, 0xB8, -+0x73, 0x05, 0x64, 0xB8, 0x01, 0x01, 0x64, 0xB8, -+0xB7, 0x06, 0x64, 0xB8, 0xB4, 0x06, 0x64, 0xB8, -+0x02, 0x00, 0x60, 0xB8, 0x68, 0x06, 0x64, 0xB8, -+0xFF, 0xFF, 0xCF, 0xFF, 0x5C, 0x05, 0x64, 0xB8, -+0x38, 0x06, 0x64, 0xB8, 0xA0, 0x06, 0x64, 0xB8, -+0xAA, 0x00, 0x60, 0xB8, 0xA8, 0x00, 0x60, 0xB8, -+0x00, 0x00, 0x02, 0x80, 0x4C, 0x00, 0x60, 0xB8, -+0xFF, 0xFF, 0x7F, 0xFE, 0x70, 0x00, 0x60, 0xB8, -+0x00, 0x00, 0x78, 0x18, 0xE4, 0x00, 0x60, 0xB8, -+0xE8, 0x00, 0x60, 0xB8, 0xE9, 0x00, 0x60, 0xB8, -+0xEA, 0x00, 0x60, 0xB8, 0xEB, 0x00, 0x60, 0xB8, -+0xE5, 0x00, 0x60, 0xB8, 0x44, 0x00, 0x02, 0x00, -+0xA0, 0x07, 0x64, 0xB8, 0xF4, 0x00, 0x60, 0xB8, -+0x91, 0x00, 0x60, 0xB8, 0x64, 0x00, 0x60, 0xB8, -+0x40, 0x00, 0x60, 0xB8, 0x00, 0x00, 0xC0, 0x00, -+0x00, 0x10, 0x24, 0x00, 0x82, 0x82, 0x62, 0x00, -+0xD3, 0x62, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x10, 0xF0, 0x23, 0x6A, 0x40, 0xF2, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x00, 0xF4, 0x11, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xA0, 0xF4, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x20, 0xF5, 0x0D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x02, 0xF4, 0x1D, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x22, 0xF5, 0x19, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0x02, 0xF4, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF5, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF4, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF2, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x60, 0xF5, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA0, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA0, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF1, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x61, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF5, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF1, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF6, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x62, 0xF1, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA2, 0xF0, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF6, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF5, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x0E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x60, 0xF0, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x7F, 0xF6, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC2, 0xF5, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x5F, 0xF6, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF7, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x42, 0xF6, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF6, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x2E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x23, 0x6A, 0xE2, 0xF3, 0x05, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xFF, 0xF7, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xBF, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF0, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE0, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x4E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF3, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x80, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF3, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x02, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE2, 0xF1, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x62, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC2, 0xF4, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA1, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x41, 0xF4, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF2, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC1, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x00, 0xF7, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x61, 0xF0, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF0, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x40, 0xF7, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x01, 0xF1, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x21, 0xF1, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x22, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x82, 0xF7, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA2, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x1F, 0xF6, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x63, 0xF0, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA3, 0xF0, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC3, 0xF0, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF3, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x83, 0xF3, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC3, 0xF3, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x03, 0xF4, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF4, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x63, 0xF4, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA3, 0xF6, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE3, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF7, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x23, 0xF7, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA4, 0xF0, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x04, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x64, 0xF1, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x84, 0xF3, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE4, 0xF3, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x04, 0xF4, 0x1C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x44, 0xF4, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xEE, 0xF7, 0x5C, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, -+0x30, 0xF0, 0x20, 0x6C, 0x4F, 0xF7, 0x14, 0x4C, -+0x00, 0x6D, 0x07, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x04, 0x6B, 0xC8, 0xF3, -+0x7C, 0xC2, 0x03, 0x6B, 0xC8, 0xF3, 0x7D, 0xC2, -+0x64, 0x6B, 0xC8, 0xF3, 0x7E, 0xCA, 0x05, 0x6B, -+0xE8, 0xF3, 0x60, 0xC2, 0xE8, 0xF3, 0x61, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0x70, 0x6E, 0x28, 0xF5, 0x1C, 0x4C, 0x00, 0x6D, -+0x30, 0xF0, 0x20, 0x68, 0x40, 0xEA, 0xC0, 0xF1, -+0x08, 0x48, 0x00, 0x18, 0xDF, 0xC7, 0x02, 0x6A, -+0x68, 0xF3, 0x56, 0xC0, 0x01, 0x6A, 0x88, 0xF3, -+0x42, 0xC0, 0x88, 0xF3, 0x43, 0xC0, 0x05, 0x6A, -+0x88, 0xF3, 0x4A, 0xC8, 0x88, 0xF3, 0x5B, 0xA0, -+0x10, 0x69, 0x88, 0xF3, 0x24, 0xC0, 0x04, 0x4A, -+0x88, 0xF3, 0x56, 0xC0, 0x88, 0xF3, 0x37, 0xC0, -+0x80, 0x18, 0x37, 0x05, 0x00, 0x6C, 0xA4, 0x67, -+0x00, 0x18, 0x24, 0xC6, 0x02, 0x6C, 0x0C, 0x6D, -+0x00, 0x18, 0x24, 0xC6, 0x01, 0x6C, 0x0C, 0x6D, -+0x00, 0x18, 0x24, 0xC6, 0x30, 0xF0, 0x20, 0x6C, -+0x00, 0x6D, 0x48, 0xF5, 0x10, 0x4C, 0x00, 0x18, -+0x5B, 0xEB, 0xE8, 0xF3, 0x66, 0xA0, 0x02, 0x6A, -+0xE8, 0xF3, 0x44, 0xC0, 0x0F, 0x6A, 0xE8, 0xF3, -+0x45, 0xC0, 0x01, 0x6A, 0x6C, 0xEA, 0x28, 0x6B, -+0x6D, 0xEA, 0xE8, 0xF3, 0x46, 0xC0, 0x07, 0x6A, -+0xE8, 0xF3, 0x47, 0xC0, 0x88, 0xF3, 0x5B, 0xA0, -+0x01, 0x6C, 0x88, 0xF3, 0x37, 0xC0, 0x04, 0x4A, -+0x88, 0xF3, 0x56, 0xC0, 0x00, 0x18, 0x1F, 0xC7, -+0x00, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0x5E, 0xCD, -+0x01, 0x6C, 0x00, 0x6D, 0x00, 0x18, 0x5E, 0xCD, -+0x02, 0x6C, 0x00, 0x6D, 0x00, 0x18, 0x5E, 0xCD, -+0x03, 0x6C, 0x00, 0x6D, 0x00, 0x18, 0x5E, 0xCD, -+0x04, 0x6C, 0x00, 0x6D, 0x00, 0x18, 0x5E, 0xCD, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0x7C, 0x9A, -+0xFC, 0x6A, 0x00, 0x6D, 0x80, 0xA3, 0xC5, 0x67, -+0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF2, 0x58, 0x9A, 0xFF, 0x6C, 0x40, 0xEA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x30, 0x6A, -+0x00, 0xF0, 0x00, 0x4A, 0x00, 0x6B, 0xC1, 0xF6, -+0x62, 0xC2, 0xC1, 0xF6, 0x63, 0xC2, 0xC1, 0xF6, -+0x64, 0xC2, 0xC1, 0xF6, 0x65, 0xC2, 0x20, 0xE8, -+0x10, 0xF0, 0x23, 0x6B, 0x30, 0xF0, 0x20, 0x6A, -+0x22, 0xF5, 0x19, 0x4B, 0x40, 0xF1, 0x68, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0x40, 0xF1, 0x08, 0x4A, -+0x40, 0xF5, 0x05, 0x4B, 0x61, 0xDA, 0x10, 0xF0, -+0x23, 0x6B, 0xC0, 0xF5, 0x01, 0x4B, 0x62, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0xA0, 0xF5, 0x11, 0x4B, -+0x63, 0xDA, 0x10, 0xF0, 0x23, 0x6B, 0xA0, 0xF5, -+0x01, 0x4B, 0x64, 0xDA, 0x10, 0xF0, 0x23, 0x6B, -+0x80, 0xF5, 0x11, 0x4B, 0x65, 0xDA, 0x10, 0xF0, -+0x23, 0x6B, 0x80, 0xF5, 0x01, 0x4B, 0x66, 0xDA, -+0x10, 0xF0, 0x23, 0x6B, 0x60, 0xF5, 0x11, 0x4B, -+0x67, 0xDA, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0xA8, 0xF4, 0x17, 0x4A, 0x67, 0x42, 0x09, 0x4B, -+0x00, 0x6C, 0x80, 0xC2, 0x01, 0x4A, 0x6A, 0xEA, -+0xFB, 0x61, 0x42, 0xF4, 0x10, 0x6A, 0x1F, 0xF7, -+0x00, 0x6B, 0x4C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF2, 0x68, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF2, 0x6C, 0x9B, 0x6D, 0xE2, -+0x04, 0x4A, 0x00, 0x6C, 0x62, 0xF4, 0x00, 0x72, -+0x80, 0xDB, 0xE9, 0x61, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF5, 0x44, 0x9A, 0x03, 0x6D, 0xFF, 0x6B, -+0x80, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF5, -+0x48, 0x9A, 0x00, 0xF5, 0x82, 0x34, 0xAC, 0xEC, -+0x40, 0x9A, 0x01, 0x74, 0x42, 0x32, 0x52, 0x32, -+0xAC, 0xEA, 0x06, 0x60, 0x0A, 0x2C, 0x02, 0x5A, -+0x28, 0x6C, 0x0D, 0x60, 0x50, 0x6C, 0x0B, 0x10, -+0x02, 0x5A, 0x14, 0x6C, 0x08, 0x60, 0x28, 0x6C, -+0x04, 0x10, 0x02, 0x5A, 0x0A, 0x6C, 0x03, 0x60, -+0x14, 0x6C, 0x84, 0xEA, 0x6C, 0xEC, 0x80, 0x18, -+0xA0, 0x06, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, -+0x00, 0x4A, 0x00, 0x6B, 0x80, 0xF2, 0x7B, 0xC2, -+0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF3, 0x78, 0x9B, -+0x00, 0x6A, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF2, 0x78, 0x9B, 0x40, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0x36, 0xF5, 0x68, 0x9B, 0x40, 0xC3, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x68, 0x04, 0xD2, 0x04, 0x94, -+0x4E, 0xF2, 0x4C, 0x98, 0x00, 0x6D, 0x4C, 0xF7, -+0x14, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF4, 0x00, 0x4A, 0x05, 0xD2, 0x05, 0x94, -+0x4E, 0xF2, 0x4C, 0x98, 0x00, 0x6D, 0xC0, 0xF6, -+0x14, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x30, 0x69, -+0x4E, 0xF2, 0x4C, 0x98, 0x00, 0xF0, 0x00, 0x49, -+0x91, 0x67, 0x00, 0x6D, 0xC1, 0xF7, 0x08, 0x6E, -+0x40, 0xEA, 0x80, 0x18, 0x83, 0x05, 0x04, 0x92, -+0x00, 0x68, 0x40, 0xF0, 0x00, 0xC1, 0x80, 0xF0, -+0x0C, 0xDA, 0x80, 0x18, 0x8A, 0x05, 0x00, 0x18, -+0x0D, 0xDD, 0x05, 0x92, 0x30, 0xF0, 0x20, 0x6C, -+0xED, 0xF0, 0x16, 0x4C, 0x80, 0xF2, 0x1C, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0xED, 0xF0, 0x06, 0x4A, -+0x00, 0x6B, 0x60, 0xC2, 0x70, 0xC2, 0x01, 0x4A, -+0x62, 0x67, 0x8E, 0xEB, 0xF9, 0x2B, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x28, 0xF1, -+0x73, 0xC2, 0x2C, 0xF7, 0x7E, 0xC2, 0x2C, 0xF7, -+0x7F, 0xC2, 0x28, 0xF1, 0x72, 0xC2, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0xA1, 0x05, -+0x80, 0x18, 0x18, 0x06, 0x80, 0x18, 0xBE, 0x13, -+0x80, 0x18, 0x41, 0x05, 0x80, 0x18, 0x2F, 0x05, -+0x80, 0x18, 0xDE, 0x0D, 0x80, 0x18, 0x82, 0x07, -+0x80, 0x18, 0xA8, 0x07, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF5, 0x44, 0x9A, 0x40, 0xEA, 0x80, 0x18, -+0xB1, 0x06, 0x00, 0x18, 0xFF, 0xE5, 0x00, 0x18, -+0x25, 0xE6, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, -+0x7C, 0x9A, 0xFF, 0x6C, 0x04, 0x6D, 0x40, 0xA3, -+0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0x6B, 0xCF, 0xF4, -+0x00, 0x4A, 0xA0, 0xF0, 0x6E, 0xC2, 0xA0, 0xF0, -+0x6F, 0xC2, 0x10, 0xF0, 0x30, 0x6A, 0x00, 0xF0, -+0x00, 0x4A, 0x40, 0xF0, 0x60, 0xC2, 0x40, 0xF0, -+0x61, 0xC2, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF6, 0x44, 0x9A, 0x01, 0x6B, 0x60, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF6, 0x88, 0x9A, 0xFF, 0x6B, 0x20, 0x6D, -+0x40, 0xA4, 0x6C, 0xEA, 0xAD, 0xEA, 0x6C, 0xEA, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF6, -+0x8C, 0x9A, 0x08, 0x6D, 0x40, 0xA4, 0x6C, 0xEA, -+0xAD, 0xEA, 0x6C, 0xEA, 0x40, 0xC4, 0x20, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF6, 0x74, 0x9A, -+0xFD, 0x6A, 0xFF, 0x6C, 0xA0, 0xA3, 0xAC, 0xEA, -+0x40, 0xC3, 0x40, 0xA3, 0x01, 0x6D, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x10, 0xF0, -+0x24, 0x6A, 0x96, 0xF6, 0x18, 0x9A, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, 0x90, 0x67, -+0x00, 0x6D, 0x02, 0xF0, 0x00, 0x6E, 0x40, 0xEA, -+0x04, 0x6A, 0x40, 0xC0, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF6, 0x5C, 0x9A, 0x20, 0x48, 0x0E, 0xEA, -+0xF7, 0x2A, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x6A, 0xB6, 0xF6, 0x80, 0x9B, 0x4E, 0xF2, -+0x4C, 0x9A, 0x00, 0x6D, 0x00, 0xF4, 0x00, 0x6E, -+0x40, 0xEA, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF6, 0xA8, 0x9A, 0x30, 0xF0, 0x20, 0x6B, -+0xE0, 0xF3, 0x12, 0x6E, 0xC0, 0xF1, 0xC8, 0xDB, -+0x01, 0xF7, 0x01, 0x6A, 0xC0, 0xF1, 0x08, 0x4B, -+0x00, 0x6C, 0x42, 0xDB, 0x43, 0xDB, 0xA1, 0xDB, -+0x84, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF6, -+0x74, 0x9B, 0xC0, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xB6, 0xF6, 0x78, 0x9B, 0xA0, 0xDB, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF6, 0x60, 0x9B, 0x40, 0xDB, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF6, 0x68, 0x9B, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF6, -+0x50, 0x9A, 0x80, 0xDA, 0x20, 0xE8, 0x00, 0x65, -+0x80, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0xE0, 0xF1, -+0x58, 0xDB, 0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF6, -+0x68, 0x9B, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF6, 0x8C, 0x9B, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xF1, 0x06, 0x6D, 0xFF, 0x6B, 0xAE, 0xDA, -+0x8F, 0xDA, 0x70, 0xDA, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF6, 0x54, 0x9A, 0xA0, 0xDA, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF6, 0x5C, 0x9A, 0x80, 0xDA, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF6, 0x44, 0x9A, -+0x60, 0xDA, 0x20, 0xE8, 0x20, 0xE8, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0x7A, 0x07, -+0x30, 0xF0, 0x20, 0x6B, 0xE8, 0xF2, 0x5C, 0xC3, -+0x80, 0x18, 0x30, 0x06, 0x00, 0x18, 0xB4, 0xE9, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF6, 0x58, 0x9A, -+0x3F, 0x6B, 0x60, 0xC2, 0x80, 0x18, 0x21, 0x06, -+0x80, 0x18, 0x25, 0x06, 0x80, 0x18, 0xA6, 0x06, -+0x80, 0x18, 0x38, 0x06, 0x80, 0x18, 0x48, 0x07, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x30, 0xF0, -+0x20, 0x68, 0x00, 0x6A, 0xC0, 0xF1, 0x08, 0x48, -+0x01, 0x6C, 0x02, 0x6D, 0x00, 0x6E, 0x40, 0xF0, -+0x50, 0xC8, 0x00, 0x18, 0x1C, 0xD5, 0x40, 0xF0, -+0xD0, 0xA8, 0x01, 0x6C, 0x03, 0x6D, 0xC2, 0x36, -+0x00, 0x18, 0x1C, 0xD5, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0xDC, 0xDF, 0x00, 0x18, 0xFB, 0xDF, -+0x80, 0x18, 0x4D, 0x06, 0x80, 0x18, 0x6A, 0x06, -+0x80, 0x18, 0x64, 0x06, 0x80, 0x18, 0x8A, 0x06, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x81, 0xD6, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x54, 0x9A, -+0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x81, 0xF4, 0x10, 0x6B, 0x28, 0xF1, 0x78, 0xDA, -+0x00, 0xF2, 0x00, 0x4B, 0x28, 0xF1, 0x7C, 0xDA, -+0x01, 0xF2, 0x00, 0x4B, 0x48, 0xF1, 0x60, 0xDA, -+0x00, 0xF2, 0x00, 0x4B, 0x48, 0xF1, 0x64, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF7, 0x48, 0x9A, -+0xE0, 0xF1, 0x1B, 0x6B, 0x6B, 0xEB, 0x60, 0xCA, -+0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF7, 0x6C, 0x9A, -+0xFB, 0x6A, 0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, -+0x20, 0xE8, 0x00, 0x65, 0x10, 0xF0, 0x23, 0x6A, -+0x2B, 0xF3, 0x1D, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x4C, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x4B, 0xF3, 0x11, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x50, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x8F, 0xF6, 0x01, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x54, 0xDB, 0x10, 0xF0, 0x30, 0x6A, -+0xC3, 0xF2, 0x09, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x58, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x74, 0xF5, 0x19, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF2, 0x5C, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0xF2, 0xF4, 0x11, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x6E, 0xF2, 0x58, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0xB2, 0xF5, 0x05, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x6E, 0xF2, 0x5C, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0xEC, 0xF1, 0x11, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x8E, 0xF2, 0x5C, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x2A, 0xF5, 0x0D, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0xCA, 0xF4, 0x15, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x44, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x11, 0xF5, 0x09, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x48, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0xCF, 0xF2, 0x15, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x4C, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x0F, 0xF3, 0x1D, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x50, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x54, 0xF3, 0x01, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x54, 0xDB, 0x10, 0xF0, 0x30, 0x6A, -+0xA9, 0xF3, 0x0D, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xEE, 0xF4, 0x48, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x15, 0xF4, 0x09, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF5, 0x4C, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF3, 0x11, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xEE, 0xF5, 0x44, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x75, 0xF1, 0x11, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xEE, 0xF4, 0x50, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0xF5, 0xF1, 0x05, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xEE, 0xF4, 0x54, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x8B, 0xF5, 0x19, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x58, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x8B, 0xF7, 0x1D, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xAE, 0xF2, 0x5C, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0xB1, 0xF7, 0x19, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF2, 0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x02, 0xF3, 0x01, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF2, 0x44, 0xDB, 0x10, 0xF0, 0x30, 0x6A, -+0x24, 0xF0, 0x19, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x0E, 0xF5, 0x48, 0xDB, 0x10, 0xF0, 0x30, 0x6A, -+0x49, 0xF5, 0x05, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x4E, 0xF3, 0x50, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0xA9, 0xF1, 0x1D, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x6E, 0xF3, 0x40, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x85, 0xF0, 0x09, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x2E, 0xF4, 0x48, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x87, 0xF0, 0x05, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x2E, 0xF4, 0x4C, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0xE7, 0xF1, 0x11, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x2E, 0xF4, 0x50, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x07, 0xF1, 0x0D, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0x2E, 0xF4, 0x54, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0xB1, 0xF5, 0x0D, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0xCB, 0xF2, 0x1D, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x54, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0x0B, 0xF3, 0x09, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x5C, 0xDB, 0x10, 0xF0, 0x23, 0x6A, -+0xEB, 0xF2, 0x09, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x58, 0xDB, 0x10, 0xF0, 0x24, 0x6A, -+0x90, 0xF4, 0x05, 0x4A, 0x30, 0xF0, 0x20, 0x6B, -+0xEE, 0xF4, 0x40, 0xDB, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF7, 0x44, 0x9A, -+0xE5, 0xF6, 0x1F, 0x6B, 0xFF, 0x6C, 0x60, 0xDA, -+0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF7, 0x48, 0x9A, -+0x10, 0x6B, 0x40, 0x6E, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0xB6, 0xF7, 0x4C, 0x9A, 0x01, 0x6B, -+0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, -+0xB8, 0x9A, 0x40, 0xA5, 0x8C, 0xEA, 0x40, 0xC5, -+0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF2, 0x78, 0x9A, -+0x40, 0xA3, 0x8C, 0xEA, 0xCD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x40, 0xA3, 0xB8, 0x4E, 0x8C, 0xEA, -+0xCC, 0xEA, 0x02, 0x6E, 0xCD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x80, 0xA3, 0xEF, 0x6A, 0x8C, 0xEA, -+0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF7, -+0x50, 0x9A, 0x00, 0xF2, 0x01, 0x6C, 0x8B, 0xEC, -+0x60, 0x9A, 0x8C, 0xEB, 0x60, 0xDA, 0x60, 0x9A, -+0x00, 0xF1, 0x00, 0x4C, 0x8C, 0xEB, 0x60, 0xDA, -+0x10, 0xF0, 0x24, 0x6B, 0x40, 0x9D, 0xF6, 0xF2, -+0x74, 0x9B, 0x6D, 0xEA, 0x40, 0xDD, 0x10, 0xF0, -+0x24, 0x6A, 0xB6, 0xF7, 0x54, 0x9A, 0x60, 0xA2, -+0x04, 0x5B, 0x02, 0x60, 0x04, 0x6B, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF2, 0x58, 0x9A, -+0x7F, 0x6B, 0x80, 0xA2, 0x8C, 0xEB, 0x60, 0xC2, -+0x80, 0xA2, 0xF7, 0x6B, 0x8C, 0xEB, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF7, 0x58, 0x9A, -+0x07, 0x6B, 0x60, 0xC2, 0x20, 0xE8, 0x00, 0x65, -+0x10, 0xF0, 0x24, 0x6A, 0x37, 0xF0, 0x54, 0x9A, -+0x60, 0x9A, 0x03, 0x6A, 0x62, 0x33, 0x72, 0x33, -+0x4C, 0xEB, 0x02, 0x6A, 0x04, 0x23, 0x01, 0x73, -+0x01, 0x6A, 0x01, 0x60, 0x03, 0x6A, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x89, 0xF0, 0x97, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x05, 0x6C, 0x8B, 0xEC, 0x8C, 0xEB, -+0x89, 0xF0, 0x77, 0xC2, 0x0A, 0x6B, 0x89, 0xF0, -+0x78, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, -+0x00, 0x4A, 0x00, 0x6B, 0x80, 0xF1, 0x68, 0xC2, -+0x80, 0xF1, 0x69, 0xC2, 0x80, 0xF1, 0x67, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xA0, 0xA4, 0x89, 0xF0, -+0xF7, 0xA3, 0x02, 0x6A, 0x01, 0x6E, 0x4B, 0xEA, -+0xCC, 0xED, 0xEC, 0xEA, 0xAD, 0xEA, 0xA2, 0x67, -+0xCC, 0xED, 0x89, 0xF0, 0x57, 0xC3, 0x1B, 0x25, -+0xA0, 0xA4, 0x07, 0x6F, 0xAE, 0x35, 0xEC, 0xED, -+0x30, 0xF0, 0x20, 0x6F, 0x4F, 0xF6, 0xA7, 0xC7, -+0xA0, 0xA4, 0xAA, 0x35, 0xCC, 0xED, 0xA8, 0x36, -+0x05, 0x6D, 0xAB, 0xED, 0x4C, 0xED, 0xCD, 0xED, -+0x89, 0xF0, 0xB7, 0xC3, 0xA0, 0xA4, 0x02, 0x6A, -+0xAC, 0xEA, 0xFF, 0x6D, 0xAC, 0xEA, 0x03, 0x22, -+0x41, 0xA4, 0x89, 0xF0, 0x58, 0xC3, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0x69, 0xF2, 0x06, 0x4C, 0x00, 0x6D, 0x07, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x08, 0x6B, 0x89, 0xF0, 0x7F, 0xC2, -+0x03, 0x6B, 0xA9, 0xF0, 0x60, 0xC2, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x04, 0x67, 0x80, 0x18, 0xA8, 0x07, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x80, 0xA0, 0x89, 0xF0, 0xDE, 0xA2, 0x02, 0x6B, -+0x01, 0x6D, 0x6B, 0xEB, 0xAC, 0xEC, 0xCC, 0xEB, -+0x8D, 0xEB, 0x83, 0x67, 0xAC, 0xEC, 0x89, 0xF0, -+0x7E, 0xC2, 0x2B, 0x24, 0x80, 0xA0, 0x07, 0x6E, -+0x92, 0x34, 0xCC, 0xEC, 0x30, 0xF0, 0x20, 0x6E, -+0x4F, 0xF6, 0x8E, 0xC6, 0xC0, 0xA0, 0x02, 0x6C, -+0xCC, 0xEC, 0xFF, 0x6E, 0xCC, 0xEC, 0x1D, 0x24, -+0x81, 0xA0, 0x89, 0xF0, 0x9F, 0xC2, 0x82, 0xA0, -+0xA9, 0xF0, 0x80, 0xC2, 0x80, 0xA0, 0x8A, 0x34, -+0xAC, 0xEC, 0x88, 0x36, 0x05, 0x6C, 0x8B, 0xEC, -+0x6C, 0xEC, 0xCD, 0xEC, 0x89, 0xF0, 0x9E, 0xC2, -+0x63, 0xA0, 0xA9, 0xF0, 0x61, 0xC2, 0x60, 0xA0, -+0x6E, 0x33, 0xAC, 0xEB, 0x6C, 0x35, 0x09, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0xAD, 0xEB, 0x89, 0xF0, -+0x7E, 0xC2, 0x05, 0x97, 0x04, 0x90, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF3, 0x68, 0x9B, -+0xFF, 0x6A, 0x8C, 0xEA, 0x60, 0xAB, 0xE1, 0xF7, -+0x1F, 0x6C, 0x30, 0xF0, 0x20, 0x6E, 0x6C, 0xEC, -+0x91, 0xE2, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x44, 0x9A, 0x9C, 0x34, 0x70, 0x6D, 0xE8, 0xF5, -+0x14, 0x4E, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x06, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0x49, 0xF2, 0x89, 0xA2, 0x80, 0x18, -+0xD9, 0x07, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x6A, 0xEC, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x68, 0x4E, 0xF2, -+0x50, 0x9B, 0x68, 0xF6, 0x04, 0x48, 0x26, 0x67, -+0x0A, 0xD4, 0x10, 0x6E, 0x90, 0x67, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6C, 0x0A, 0x95, 0x4E, 0xF2, -+0x50, 0x9C, 0x87, 0x40, 0x09, 0x4C, 0x10, 0x6E, -+0x40, 0xEA, 0x00, 0xF6, 0x22, 0x34, 0x00, 0xF6, -+0x20, 0x32, 0x8D, 0xEA, 0x1F, 0xF7, 0x00, 0x6D, -+0x22, 0x34, 0xAC, 0xEC, 0x8D, 0xEA, 0x10, 0xF0, -+0x24, 0x6C, 0x36, 0xF4, 0x90, 0x9C, 0x20, 0x31, -+0x30, 0xF0, 0x20, 0x6B, 0x8C, 0xE9, 0xC0, 0xF1, -+0x08, 0x4B, 0x2D, 0xEA, 0xA8, 0xF4, 0x5C, 0xDB, -+0x5D, 0x67, 0x87, 0x42, 0x09, 0x4C, 0x40, 0xA4, -+0xC8, 0xF4, 0x43, 0xC3, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0xFF, 0x6A, 0x4C, 0xEC, 0x11, 0x6B, 0x8E, 0xEB, -+0x05, 0x67, 0x0D, 0x23, 0x3A, 0x6A, 0x8E, 0xEA, -+0x3A, 0x22, 0x54, 0x2C, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF4, 0x54, 0x9A, 0x27, 0x45, 0x03, 0x49, -+0x49, 0xE1, 0x80, 0xCA, 0x54, 0x10, 0x87, 0x45, -+0x27, 0x45, 0x10, 0xF0, 0x24, 0x6D, 0x16, 0xF4, -+0xB4, 0x9D, 0x13, 0x49, 0x0D, 0x4C, 0xB5, 0xE1, -+0x60, 0xCD, 0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF4, -+0x74, 0x9B, 0x10, 0xF0, 0x24, 0x6D, 0x36, 0xF4, -+0xB8, 0x9D, 0x6D, 0xE4, 0x60, 0xA3, 0xB5, 0xE4, -+0xA0, 0xA5, 0x4C, 0xEB, 0x60, 0x33, 0xAC, 0xEA, -+0x6D, 0xE2, 0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xEB, -+0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, 0x5C, 0x9A, -+0xA3, 0x67, 0x06, 0xD3, 0x40, 0xEA, 0x04, 0xD2, -+0xC7, 0x40, 0x30, 0xF0, 0x20, 0x6A, 0xE7, 0x40, -+0x4E, 0xF4, 0x40, 0x9A, 0x11, 0x6C, 0x06, 0x95, -+0x05, 0x4E, 0x09, 0x4F, 0x34, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x16, 0xF4, 0x74, 0x9B, 0x27, 0x45, -+0x23, 0x49, 0x6D, 0xE1, 0x40, 0xCB, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x5C, 0x9A, 0x85, 0x67, -+0x48, 0x6D, 0x40, 0xEA, 0x42, 0x34, 0xFF, 0xF7, -+0x1F, 0x6B, 0x82, 0x34, 0x6C, 0xEA, 0x89, 0xE2, -+0x42, 0x34, 0x82, 0x34, 0x49, 0xE4, 0x4F, 0xEA, -+0x6C, 0xEA, 0x1A, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF4, 0x54, 0x9A, 0x27, 0x45, 0x03, 0x49, -+0x49, 0xE1, 0x00, 0x6B, 0x60, 0xCA, 0x30, 0xF0, -+0x20, 0x6A, 0x2E, 0xF4, 0x5C, 0x9A, 0x90, 0x67, -+0x14, 0x6D, 0x40, 0xEA, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF4, 0x40, 0x9A, 0x00, 0x6C, -+0x14, 0x6D, 0xC4, 0x67, 0xE4, 0x67, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF4, 0xB4, 0x9B, -+0xFF, 0x6C, 0x42, 0x33, 0xB5, 0xE1, 0x8C, 0xEB, -+0x60, 0xC5, 0x10, 0xF0, 0x24, 0x6B, 0x16, 0xF4, -+0x78, 0x9B, 0x8C, 0xEA, 0x65, 0xE1, 0x40, 0xC1, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x00, 0xF0, 0x16, 0x02, -+0x04, 0x44, 0x04, 0x01, 0x06, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, 0x90, 0x67, -+0x01, 0x48, 0x40, 0xEA, 0x06, 0x93, 0x40, 0xC1, -+0x01, 0x49, 0x6A, 0xE9, 0xF4, 0x61, 0x00, 0x6A, -+0x7D, 0x67, 0x51, 0xE3, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x4D, 0xE3, 0x90, 0xA4, -+0x08, 0xF4, 0x62, 0xA3, 0x8E, 0xEB, 0x02, 0x23, -+0x00, 0x6A, 0x04, 0x10, 0x01, 0x4A, 0x06, 0x72, -+0xEF, 0x61, 0x01, 0x6A, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x07, 0x44, 0x00, 0xF0, 0x16, 0x02, 0x09, 0x48, -+0x04, 0x01, 0x06, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x4C, 0x9A, 0x90, 0x67, 0x01, 0x48, -+0x40, 0xEA, 0x06, 0x93, 0x40, 0xC1, 0x01, 0x49, -+0x6A, 0xE9, 0xF4, 0x61, 0x00, 0x6A, 0x7D, 0x67, -+0x51, 0xE3, 0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, -+0x08, 0x4B, 0x4D, 0xE3, 0x90, 0xA4, 0x08, 0xF4, -+0x68, 0xA3, 0x8E, 0xEB, 0x02, 0x23, 0x00, 0x6A, -+0x04, 0x10, 0x01, 0x4A, 0x06, 0x72, 0xEF, 0x61, -+0x01, 0x6A, 0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, -+0x06, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0x08, 0x4C, 0xCE, 0xF4, 0x4C, 0x98, 0xA5, 0xE4, -+0x81, 0x41, 0x40, 0xEA, 0x10, 0x2A, 0xCE, 0xF4, -+0x4C, 0x98, 0x84, 0x41, 0x40, 0xEA, 0x01, 0x72, -+0x0A, 0x61, 0xCE, 0xF4, 0x4C, 0x98, 0x87, 0x41, -+0x01, 0x4C, 0x40, 0xEA, 0x01, 0x6B, 0x6E, 0xEA, -+0x01, 0x5A, 0x58, 0x67, 0x01, 0x10, 0x00, 0x6A, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xCE, 0xF4, 0x4C, 0x98, 0x85, 0xE5, 0x86, 0x41, -+0x40, 0xEA, 0x08, 0x72, 0x34, 0x61, 0xCE, 0xF4, -+0x4C, 0x98, 0x87, 0x41, 0x40, 0xEA, 0x2F, 0x2A, -+0x07, 0x41, 0x05, 0x02, 0x11, 0x48, 0x04, 0x01, -+0x06, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x4C, 0x9A, 0x90, 0x67, 0x01, 0x48, 0x40, 0xEA, -+0x40, 0xC1, 0x06, 0x92, 0x01, 0x49, 0x4A, 0xE9, -+0xF4, 0x61, 0x30, 0xF0, 0x20, 0x6B, 0x5D, 0x67, -+0xC0, 0xF1, 0x08, 0x4B, 0x90, 0xA2, 0x08, 0xF4, -+0x5E, 0xA3, 0x8E, 0xEA, 0x14, 0x2A, 0x5D, 0x67, -+0x91, 0xA2, 0x08, 0xF4, 0x5F, 0xA3, 0x8E, 0xEA, -+0x0E, 0x2A, 0x5D, 0x67, 0x92, 0xA2, 0x28, 0xF4, -+0x40, 0xA3, 0x8E, 0xEA, 0x08, 0x2A, 0x5D, 0x67, -+0x93, 0xA2, 0x28, 0xF4, 0x41, 0xA3, 0x8E, 0xEA, -+0x01, 0x5A, 0x58, 0x67, 0x01, 0x10, 0x00, 0x6A, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x04, 0x67, 0x25, 0x67, -+0x80, 0x18, 0x57, 0x08, 0x00, 0x6B, 0x08, 0x22, -+0x90, 0x67, 0xB1, 0x67, 0x80, 0x18, 0x97, 0x08, -+0x4B, 0xEB, 0x4D, 0xEB, 0xC0, 0xF7, 0x62, 0x33, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x43, 0x67, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x24, 0x67, 0x05, 0x67, -+0x80, 0x18, 0x57, 0x08, 0x4D, 0x22, 0x91, 0x67, -+0xB0, 0x67, 0x80, 0x18, 0x97, 0x08, 0x48, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xA8, 0xF5, 0x7C, 0xA2, -+0x10, 0x6A, 0x08, 0x49, 0x6C, 0xEA, 0x05, 0xE1, -+0x1F, 0x22, 0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, -+0x4C, 0x98, 0x87, 0x41, 0x02, 0x4C, 0x40, 0xEA, -+0x06, 0x72, 0x16, 0x61, 0xCE, 0xF4, 0x4C, 0x98, -+0x87, 0x41, 0x0D, 0x4C, 0x40, 0xEA, 0x10, 0x2A, -+0xCE, 0xF4, 0x4C, 0x98, 0x87, 0x41, 0x0E, 0x4C, -+0x40, 0xEA, 0x50, 0x72, 0x09, 0x61, 0xCE, 0xF4, -+0x4C, 0x98, 0x87, 0x41, 0x1A, 0x4C, 0x40, 0xEA, -+0x05, 0x6B, 0x4C, 0xEB, 0x01, 0x6A, 0x21, 0x2B, -+0x30, 0xF0, 0x20, 0x6A, 0xA8, 0xF5, 0x7C, 0xA2, -+0x04, 0x6A, 0x6C, 0xEA, 0x19, 0x22, 0x30, 0xF0, -+0x20, 0x68, 0xCE, 0xF4, 0x4C, 0x98, 0x87, 0x41, -+0x02, 0x4C, 0x40, 0xEA, 0x11, 0x72, 0x10, 0x61, -+0xCE, 0xF4, 0x4C, 0x98, 0x87, 0x41, 0x0F, 0x4C, -+0x40, 0xEA, 0x0A, 0x2A, 0xCE, 0xF4, 0x4C, 0x98, -+0x87, 0x41, 0x10, 0x4C, 0x40, 0xEA, 0x89, 0x6B, -+0x6E, 0xEA, 0x01, 0x5A, 0x58, 0x67, 0x01, 0x10, -+0x00, 0x6A, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF3, 0x48, 0x9A, 0x0E, 0xD4, 0x0F, 0xD5, -+0x60, 0xAA, 0xE1, 0xF7, 0x1F, 0x6A, 0x6C, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0x49, 0xF2, 0x73, 0xA3, -+0x69, 0xE2, 0x00, 0x6B, 0x5C, 0x32, 0x04, 0xD3, -+0x93, 0x10, 0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF4, -+0x98, 0x9C, 0x10, 0xF0, 0x24, 0x6D, 0x16, 0xF4, -+0xB4, 0x9D, 0x91, 0xE2, 0x80, 0xA4, 0xB5, 0xE2, -+0xA0, 0xA5, 0x6C, 0xEC, 0x80, 0x34, 0xAC, 0xEB, -+0x91, 0xE3, 0x0E, 0x91, 0xFF, 0xF7, 0x1F, 0x6B, -+0x6C, 0xEC, 0x02, 0x4A, 0x05, 0xD4, 0x91, 0xE2, -+0x04, 0x49, 0x07, 0xD2, 0x08, 0xD4, 0x00, 0x68, -+0x66, 0x10, 0x12, 0x70, 0x05, 0x61, 0x0E, 0x91, -+0x0F, 0x95, 0x06, 0x49, 0xA5, 0xE1, 0x06, 0x10, -+0x14, 0x70, 0x04, 0x61, 0x0E, 0x91, 0x0F, 0x92, -+0x08, 0x49, 0x45, 0xE1, 0x04, 0x32, 0x10, 0xF0, -+0x24, 0x6D, 0x4E, 0x33, 0x16, 0xF4, 0x14, 0x4D, -+0x09, 0xD3, 0xA0, 0x9D, 0x08, 0x93, 0x07, 0x6C, -+0x4C, 0xEC, 0xA9, 0xE3, 0x09, 0x93, 0x06, 0xD4, -+0x06, 0x95, 0x69, 0xE2, 0x60, 0xA2, 0xFF, 0x6C, -+0x01, 0x6A, 0x44, 0xED, 0x8C, 0xEB, 0x4C, 0xEB, -+0x6E, 0xEA, 0x15, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x4C, 0x9A, 0x91, 0x67, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF4, 0x14, 0x4C, -+0x07, 0x95, 0x80, 0x9C, 0x8D, 0xE5, 0x0D, 0xE3, -+0x60, 0xA3, 0xFF, 0x6D, 0xAC, 0xEB, 0x4E, 0xEB, -+0x0F, 0x6A, 0x4C, 0xEB, 0x31, 0x2B, 0x10, 0xF0, -+0x24, 0x6B, 0x16, 0xF4, 0x14, 0x4B, 0x08, 0x94, -+0x60, 0x9B, 0xFF, 0x6D, 0x69, 0xE4, 0x09, 0x94, -+0x89, 0xE2, 0x06, 0x94, 0x60, 0xA2, 0x01, 0x6A, -+0x01, 0x4C, 0x44, 0xEC, 0xAC, 0xEB, 0x4C, 0xEB, -+0x6E, 0xEA, 0x15, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x4C, 0x9A, 0x91, 0x67, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6C, 0x16, 0xF4, 0x14, 0x4C, -+0x07, 0x95, 0x80, 0x9C, 0x8D, 0xE5, 0x0D, 0xE3, -+0x60, 0xA3, 0xFF, 0x6D, 0xAC, 0xEB, 0x4E, 0xEB, -+0xF0, 0x6A, 0x4C, 0xEB, 0x09, 0x2B, 0x01, 0x48, -+0xFF, 0x6A, 0x01, 0x49, 0x4C, 0xE8, 0x05, 0x92, -+0x43, 0xE8, 0x97, 0x61, 0x01, 0x6A, 0x18, 0x10, -+0x05, 0x94, 0x08, 0x93, 0x04, 0x95, 0x84, 0x32, -+0xFF, 0x4A, 0x01, 0x4B, 0x4F, 0x32, 0x49, 0xE3, -+0x01, 0x4D, 0xFF, 0x6B, 0x6C, 0xED, 0x04, 0xD5, -+0x30, 0xF0, 0x20, 0x6B, 0xA8, 0xF5, 0xBE, 0xA3, -+0x0F, 0x6C, 0xFF, 0x6B, 0xAC, 0xEC, 0x04, 0x95, -+0x82, 0xED, 0x7F, 0xF7, 0x02, 0x61, 0x00, 0x6A, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x01, 0x6A, 0x8C, 0xEA, -+0x05, 0x2A, 0x30, 0xF0, 0x20, 0x6A, 0x29, 0xF2, -+0x7C, 0xA2, 0x04, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x29, 0xF2, 0x7D, 0xA2, 0x30, 0xF0, 0x20, 0x6A, -+0x0F, 0xF6, 0x71, 0xC2, 0x30, 0xF0, 0x20, 0x6A, -+0x0F, 0xF6, 0x71, 0xA2, 0x00, 0x6A, 0x07, 0x5B, -+0x06, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF0, -+0x0C, 0x4A, 0x4D, 0xE3, 0x40, 0xA3, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0xFF, 0x6A, -+0x04, 0x67, 0x86, 0x67, 0x4C, 0xE8, 0x4C, 0xED, -+0x4C, 0xEC, 0x40, 0x6A, 0x1E, 0x30, 0x4C, 0xED, -+0x04, 0x30, 0x00, 0x6A, 0x02, 0x25, 0x80, 0x18, -+0x53, 0x09, 0x18, 0x48, 0x09, 0xE2, 0x05, 0x97, -+0x04, 0x90, 0xFF, 0x6B, 0x6C, 0xEA, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x04, 0xD0, 0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF3, -+0x68, 0x9B, 0xFF, 0x6A, 0x4C, 0xEC, 0xA0, 0xAB, -+0xE1, 0xF7, 0x1F, 0x6B, 0xAC, 0xEB, 0x61, 0xE4, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF4, 0x6C, 0x9B, -+0x1C, 0x30, 0x6D, 0xE0, 0x80, 0xA3, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF3, 0x78, 0x9B, 0x4C, 0xEC, -+0x6D, 0xE0, 0xA0, 0xA3, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF4, 0x70, 0x9B, 0x4C, 0xED, 0x6D, 0xE0, -+0xC0, 0xA3, 0x4C, 0xEE, 0x80, 0x18, 0x62, 0x09, -+0x10, 0xF0, 0x24, 0x6C, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF4, 0x88, 0x9C, 0x56, 0xF4, 0xA4, 0x9B, -+0x30, 0xF0, 0x20, 0x6B, 0xE8, 0xF5, 0x00, 0x4B, -+0x91, 0xE0, 0xB5, 0xE0, 0x51, 0xE4, 0xC6, 0x43, -+0xE0, 0xA5, 0x01, 0x4D, 0xE0, 0xC3, 0xE0, 0xA4, -+0x01, 0x4C, 0xEA, 0xC3, 0x01, 0x4B, 0xCA, 0xEB, -+0xF7, 0x61, 0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF4, -+0x7C, 0x9B, 0x61, 0xE0, 0x30, 0xF0, 0x20, 0x6B, -+0xE8, 0xF5, 0x06, 0x4B, 0x41, 0xE0, 0x44, 0x43, -+0x80, 0xA0, 0x80, 0xC3, 0x87, 0x40, 0x03, 0x4C, -+0x80, 0xA4, 0x01, 0x48, 0x8A, 0xC3, 0x01, 0x4B, -+0x4A, 0xEB, 0xF6, 0x61, 0x05, 0x97, 0x04, 0x90, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x06, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0x49, 0xF2, 0x84, 0xA2, 0x80, 0x18, -+0x6F, 0x09, 0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, -+0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF5, 0x13, 0x4A, -+0xFF, 0x69, 0x67, 0x42, 0x2C, 0xED, 0x01, 0x4B, -+0xCC, 0xE9, 0x00, 0x6E, 0xC0, 0xC2, 0x01, 0x4A, -+0x6A, 0xEA, 0xFB, 0x61, 0x91, 0xE5, 0x30, 0xF0, -+0x20, 0x68, 0x27, 0xE4, 0xCF, 0xF5, 0x13, 0x48, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, -+0x91, 0x67, 0x01, 0x49, 0x40, 0xEA, 0x40, 0xC0, -+0x30, 0xF0, 0x20, 0x6A, 0x01, 0x48, 0xCF, 0xF5, -+0x1B, 0x4A, 0x4A, 0xE8, 0xF1, 0x61, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, -+0x30, 0xF0, 0x20, 0x6B, 0xC8, 0xF5, 0xC9, 0xA3, -+0x01, 0x6B, 0xFF, 0x6A, 0xCC, 0xEB, 0x4C, 0xEB, -+0x4C, 0xEC, 0x4C, 0xED, 0x01, 0x6A, 0x45, 0x2B, -+0x02, 0x6A, 0xAC, 0xEA, 0x12, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF4, 0x74, 0x9A, 0x10, 0xF0, -+0x00, 0x6E, 0x40, 0x9B, 0xCC, 0xEA, 0x09, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, -+0xC0, 0xDB, 0x23, 0x6B, 0x60, 0xC2, 0x01, 0x6A, -+0x01, 0x10, 0x00, 0x6A, 0x01, 0x6B, 0xAC, 0xEB, -+0x2C, 0x23, 0x40, 0x6B, 0x8C, 0xEB, 0x0C, 0x23, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, -+0x22, 0x6B, 0x60, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF4, 0x58, 0x9A, 0x80, 0xC2, 0x01, 0x6A, -+0x9E, 0x33, 0x0C, 0x23, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF4, 0x4C, 0x9A, 0x21, 0x6B, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF4, 0x58, 0x9A, -+0x80, 0xC2, 0x01, 0x6A, 0x20, 0x6B, 0x8C, 0xEB, -+0x0C, 0x23, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, -+0x4C, 0x9A, 0x23, 0x6B, 0x60, 0xC2, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF4, 0x58, 0x9A, 0x80, 0xC2, -+0x01, 0x6A, 0x20, 0xE8, 0xFF, 0x6A, 0x8C, 0xEA, -+0xA0, 0x72, 0x04, 0x6B, 0x01, 0x60, 0x08, 0x6B, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, -+0x60, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x08, 0xF4, 0x81, 0xA2, 0x01, 0x6B, -+0x8D, 0xEB, 0x08, 0xF4, 0x61, 0xC2, 0x20, 0xE8, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0x08, 0xF4, 0xA1, 0xA3, 0x01, 0x6C, 0x44, 0x67, -+0x8C, 0xED, 0x04, 0x25, 0xE8, 0xF3, 0x5A, 0xA3, -+0x52, 0x32, 0x8C, 0xEA, 0x20, 0xE8, 0x00, 0x65, -+0xF8, 0x63, 0x0F, 0x62, 0x0E, 0xD1, 0x0D, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0xFF, 0x6A, 0xF6, 0xF3, -+0x68, 0x9B, 0x4C, 0xED, 0x0B, 0xD5, 0x04, 0x67, -+0x80, 0xAB, 0xE1, 0xF7, 0x1F, 0x6B, 0x4C, 0xE8, -+0x8C, 0xEB, 0x6D, 0xE0, 0x7C, 0x33, 0x0A, 0xD3, -+0x10, 0xF0, 0x24, 0x6B, 0x0A, 0x94, 0x16, 0xF4, -+0x74, 0x9B, 0x6D, 0xE4, 0x20, 0xA3, 0x10, 0xF0, -+0x24, 0x6B, 0x16, 0xF4, 0x78, 0x9B, 0x4C, 0xE9, -+0x6D, 0xE4, 0x60, 0xA3, 0x6C, 0xEA, 0x40, 0x32, -+0x45, 0xE1, 0xE7, 0xF7, 0x1F, 0x6A, 0x4C, 0xE9, -+0x10, 0xF0, 0x24, 0x6B, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF4, 0x5C, 0x9A, 0x56, 0xF4, 0x6C, 0x9B, -+0x49, 0xE4, 0x6D, 0xE4, 0x29, 0xE2, 0x2D, 0xE3, -+0x00, 0x6C, 0x80, 0xC2, 0x01, 0x4A, 0x6A, 0xEA, -+0xFB, 0x61, 0x01, 0x6A, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF4, 0x54, 0x9A, 0x0B, 0x97, -+0xFF, 0xF7, 0x1F, 0x6B, 0xC8, 0x41, 0x0A, 0x6D, -+0x10, 0x6C, 0x6C, 0xEE, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x49, 0xF2, 0xA7, 0xA2, 0x03, 0xED, -+0x1B, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, -+0x48, 0x9A, 0xB3, 0xE0, 0x9C, 0x34, 0x60, 0xAA, -+0x0B, 0x92, 0x30, 0x4C, 0x5B, 0xE1, 0xE1, 0xF7, -+0x1F, 0x6A, 0x6C, 0xEA, 0xB5, 0xE2, 0xFF, 0xF7, -+0x1F, 0x6B, 0xB0, 0x35, 0x6C, 0xED, 0x30, 0xF0, -+0x20, 0x6A, 0x04, 0xD5, 0xF8, 0x4E, 0x8E, 0xF4, -+0x50, 0x9A, 0x6C, 0xEC, 0x38, 0x6D, 0x1F, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, 0x48, 0x9A, -+0x0B, 0x94, 0x17, 0xE5, 0x60, 0xAA, 0xE1, 0xF7, -+0x1F, 0x6A, 0xBC, 0x35, 0x6C, 0xEA, 0x49, 0xE0, -+0x5C, 0x32, 0x08, 0x6B, 0x7A, 0xEA, 0x01, 0x2B, -+0xE5, 0xE8, 0xFF, 0xF7, 0x1F, 0x6B, 0x9B, 0xE1, -+0x38, 0x4D, 0xF8, 0x4E, 0x30, 0x6C, 0x6C, 0xED, -+0x12, 0xEA, 0x6C, 0xEA, 0x04, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF4, 0x50, 0x9A, 0xFF, 0x6B, -+0x6C, 0xEE, 0x08, 0x6F, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, 0x30, 0xF0, -+0x20, 0x6D, 0x08, 0x04, 0xC8, 0xF6, 0x04, 0x4D, -+0x08, 0x6E, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF4, 0x44, 0x9A, 0x06, 0x00, 0x08, 0x04, -+0x00, 0x6D, 0xD0, 0x67, 0x08, 0x6F, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF4, 0x5C, 0x9A, -+0x0A, 0x94, 0x49, 0xE4, 0x25, 0xE2, 0x08, 0x02, -+0x60, 0xA0, 0x01, 0x48, 0x4A, 0xE8, 0x60, 0xC1, -+0x01, 0x49, 0xFA, 0x61, 0x0F, 0x97, 0x0E, 0x91, -+0x0D, 0x90, 0x08, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0x30, 0xF0, 0x20, 0x6D, 0xEF, 0xF5, 0x08, 0x4C, -+0xC8, 0xF6, 0x15, 0x4D, 0x08, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0x02, 0x6B, 0x0F, 0xF6, -+0x73, 0xC2, 0x30, 0xF0, 0x20, 0x6A, 0x49, 0xF2, -+0x52, 0xA2, 0x14, 0x22, 0x10, 0xF0, 0x24, 0x6B, -+0xF6, 0xF3, 0x68, 0x9B, 0xE1, 0xF7, 0x1F, 0x6C, -+0x30, 0xF0, 0x20, 0x6E, 0x60, 0xAB, 0x60, 0x6D, -+0xEF, 0xF5, 0x00, 0x4E, 0x6C, 0xEC, 0x51, 0xE4, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x48, 0x9A, -+0x9C, 0x34, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA4, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0xCF, 0xF4, -+0x07, 0x4C, 0x07, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF4, 0x60, 0x9A, 0xDF, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF4, 0x00, 0x4A, 0x80, 0xF1, 0x80, 0xA2, -+0x40, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x80, 0xF1, -+0x60, 0xC2, 0x20, 0xE8, 0x30, 0xF0, 0x20, 0x6A, -+0x4F, 0xF7, 0x54, 0xA2, 0x05, 0x5A, 0x40, 0xF1, -+0x1A, 0x60, 0x10, 0xF0, 0x24, 0x6B, 0x48, 0x32, -+0xB6, 0xF0, 0x18, 0x4B, 0x4D, 0xE3, 0x40, 0x9B, -+0x00, 0xEA, 0x42, 0xF6, 0x00, 0x6D, 0x42, 0xF6, -+0x08, 0x6C, 0x00, 0x6A, 0x0F, 0x11, 0x22, 0xF6, -+0x10, 0x6D, 0x22, 0xF6, 0x18, 0x6C, 0x00, 0x6A, -+0xCB, 0x10, 0x22, 0xF6, 0x00, 0x6D, 0x22, 0xF6, -+0x08, 0x6C, 0x00, 0x6A, 0x87, 0x10, 0x00, 0xF7, -+0x00, 0x6D, 0x00, 0xF7, 0x08, 0x6C, 0x00, 0x6A, -+0x43, 0x10, 0x00, 0xF6, 0x10, 0x6D, 0x00, 0xF6, -+0x18, 0x6C, 0x00, 0x6A, 0x1F, 0xF7, 0x00, 0x6B, -+0x8C, 0xEB, 0x02, 0xF0, 0x00, 0x73, 0xE2, 0x67, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x76, 0xF4, 0x64, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x76, 0xF4, 0x68, 0x9B, 0x6D, 0xE2, -+0xC0, 0xA3, 0xFF, 0x6B, 0xCC, 0xEB, 0x30, 0xF0, -+0x20, 0x6E, 0xC0, 0xF1, 0x08, 0x4E, 0xD9, 0xE7, -+0x08, 0xF4, 0x68, 0xC6, 0x1F, 0xF7, 0x00, 0x6B, -+0xAC, 0xEB, 0x02, 0xF0, 0x00, 0x73, 0xE2, 0x67, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x76, 0xF4, 0x6C, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x76, 0xF4, 0x70, 0x9B, 0x6D, 0xE2, -+0xC0, 0xA3, 0xFF, 0x6B, 0x01, 0x4A, 0xCC, 0xEB, -+0x30, 0xF0, 0x20, 0x6E, 0xC0, 0xF1, 0x08, 0x4E, -+0xD9, 0xE7, 0x06, 0x72, 0x08, 0xF4, 0x62, 0xC6, -+0x01, 0x4C, 0x01, 0x4D, 0xC3, 0x61, 0x20, 0xE8, -+0x1F, 0xF7, 0x00, 0x6B, 0x8C, 0xEB, 0x02, 0xF0, -+0x00, 0x73, 0xE2, 0x67, 0x01, 0x60, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF4, 0x74, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF4, -+0x78, 0x9B, 0x6D, 0xE2, 0xC0, 0xA3, 0xFF, 0x6B, -+0xCC, 0xEB, 0x30, 0xF0, 0x20, 0x6E, 0xC0, 0xF1, -+0x08, 0x4E, 0xD9, 0xE7, 0x08, 0xF4, 0x68, 0xC6, -+0x1F, 0xF7, 0x00, 0x6B, 0xAC, 0xEB, 0x02, 0xF0, -+0x00, 0x73, 0xE2, 0x67, 0x01, 0x60, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF4, 0x7C, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF4, -+0x60, 0x9B, 0x6D, 0xE2, 0xC0, 0xA3, 0xFF, 0x6B, -+0x01, 0x4A, 0xCC, 0xEB, 0x30, 0xF0, 0x20, 0x6E, -+0xC0, 0xF1, 0x08, 0x4E, 0xD9, 0xE7, 0x06, 0x72, -+0x08, 0xF4, 0x62, 0xC6, 0x01, 0x4C, 0x01, 0x4D, -+0xC3, 0x61, 0x20, 0xE8, 0x1F, 0xF7, 0x00, 0x6B, -+0x8C, 0xEB, 0x02, 0xF0, 0x00, 0x73, 0xE2, 0x67, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF4, 0x64, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF4, 0x68, 0x9B, 0x6D, 0xE2, -+0xC0, 0xA3, 0xFF, 0x6B, 0xCC, 0xEB, 0x30, 0xF0, -+0x20, 0x6E, 0xC0, 0xF1, 0x08, 0x4E, 0xD9, 0xE7, -+0x08, 0xF4, 0x68, 0xC6, 0x1F, 0xF7, 0x00, 0x6B, -+0xAC, 0xEB, 0x02, 0xF0, 0x00, 0x73, 0xE2, 0x67, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF4, 0x6C, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF4, 0x70, 0x9B, 0x6D, 0xE2, -+0xC0, 0xA3, 0xFF, 0x6B, 0x01, 0x4A, 0xCC, 0xEB, -+0x30, 0xF0, 0x20, 0x6E, 0xC0, 0xF1, 0x08, 0x4E, -+0xD9, 0xE7, 0x06, 0x72, 0x08, 0xF4, 0x62, 0xC6, -+0x01, 0x4C, 0x01, 0x4D, 0xC3, 0x61, 0x20, 0xE8, -+0x1F, 0xF7, 0x00, 0x6B, 0x8C, 0xEB, 0x02, 0xF0, -+0x00, 0x73, 0xE2, 0x67, 0x01, 0x60, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF4, 0x74, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF4, -+0x78, 0x9B, 0x6D, 0xE2, 0xC0, 0xA3, 0xFF, 0x6B, -+0xCC, 0xEB, 0x30, 0xF0, 0x20, 0x6E, 0xC0, 0xF1, -+0x08, 0x4E, 0xD9, 0xE7, 0x08, 0xF4, 0x68, 0xC6, -+0x1F, 0xF7, 0x00, 0x6B, 0xAC, 0xEB, 0x02, 0xF0, -+0x00, 0x73, 0xE2, 0x67, 0x01, 0x60, 0x05, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF4, 0x7C, 0x9B, -+0x04, 0x10, 0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF4, -+0x60, 0x9B, 0x6D, 0xE2, 0xC0, 0xA3, 0xFF, 0x6B, -+0x01, 0x4A, 0xCC, 0xEB, 0x30, 0xF0, 0x20, 0x6E, -+0xC0, 0xF1, 0x08, 0x4E, 0xD9, 0xE7, 0x06, 0x72, -+0x08, 0xF4, 0x62, 0xC6, 0x01, 0x4C, 0x01, 0x4D, -+0xC3, 0x61, 0x20, 0xE8, 0x1F, 0xF7, 0x00, 0x6B, -+0x8C, 0xEB, 0x02, 0xF0, 0x00, 0x73, 0xE2, 0x67, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xB6, 0xF4, 0x64, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xB6, 0xF4, 0x68, 0x9B, 0x6D, 0xE2, -+0xC0, 0xA3, 0xFF, 0x6B, 0xCC, 0xEB, 0x30, 0xF0, -+0x20, 0x6E, 0xC0, 0xF1, 0x08, 0x4E, 0xD9, 0xE7, -+0x08, 0xF4, 0x68, 0xC6, 0x1F, 0xF7, 0x00, 0x6B, -+0xAC, 0xEB, 0x02, 0xF0, 0x00, 0x73, 0xE2, 0x67, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xB6, 0xF4, 0x6C, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xB6, 0xF4, 0x70, 0x9B, 0x6D, 0xE2, -+0xC0, 0xA3, 0xFF, 0x6B, 0x01, 0x4A, 0xCC, 0xEB, -+0x30, 0xF0, 0x20, 0x6E, 0xC0, 0xF1, 0x08, 0x4E, -+0xD9, 0xE7, 0x06, 0x72, 0x08, 0xF4, 0x62, 0xC6, -+0x01, 0x4C, 0x01, 0x4D, 0xC3, 0x61, 0x20, 0xE8, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, 0x48, 0x9A, -+0xFF, 0x69, 0x2C, 0xEC, 0x60, 0xAA, 0xE1, 0xF7, -+0x1F, 0x6A, 0x30, 0xF0, 0x20, 0x6E, 0x6C, 0xEA, -+0x41, 0xE4, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x44, 0x9A, 0x1C, 0x30, 0x90, 0x67, 0x08, 0x6D, -+0xEF, 0xF5, 0x00, 0x4E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, 0x40, 0xF1, -+0x94, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0x40, 0xF1, 0x74, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0xB6, 0xF4, 0x5C, 0x9A, 0x49, 0xE0, 0x40, 0xA2, -+0x2C, 0xEA, 0xDD, 0x72, 0x80, 0xF0, 0x08, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF3, 0x54, 0x9A, -+0x49, 0xE0, 0x40, 0xA2, 0x4C, 0xE9, 0x01, 0x6A, -+0x2C, 0xEA, 0x13, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0xB6, 0xF4, 0x98, 0x9A, 0x30, 0xF0, 0x20, 0x6B, -+0x30, 0xF0, 0x20, 0x6A, 0x91, 0xE0, 0x0F, 0xF6, -+0x18, 0x4A, 0x2F, 0xF6, 0x00, 0x4B, 0xA0, 0xA4, -+0x01, 0x4C, 0xA0, 0xC2, 0x01, 0x4A, 0x6A, 0xEA, -+0xFA, 0x61, 0x02, 0x6A, 0x2C, 0xEA, 0x68, 0x22, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, 0x40, 0x9A, -+0x49, 0xE0, 0x60, 0xA2, 0x30, 0xF0, 0x20, 0x6A, -+0x0F, 0xF6, 0x70, 0xC2, 0x10, 0xF0, 0x24, 0x6A, -+0xB6, 0xF4, 0x54, 0x9A, 0x30, 0xF0, 0x20, 0x6B, -+0x2F, 0xF6, 0x08, 0x4B, 0x41, 0xE0, 0x30, 0xF0, -+0x20, 0x6A, 0x2F, 0xF6, 0x00, 0x4A, 0x80, 0xA0, -+0x80, 0xC2, 0x88, 0xA0, 0x88, 0xC2, 0x90, 0xA0, -+0x90, 0xC2, 0x98, 0xA0, 0x01, 0x48, 0x98, 0xC2, -+0x01, 0x4A, 0x6A, 0xEA, 0xF4, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x0F, 0xF6, 0x30, 0xA2, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF3, 0x54, 0x9A, 0x2C, 0x31, -+0x02, 0x49, 0x4D, 0xE9, 0x00, 0x68, 0x10, 0xF0, -+0x24, 0x6A, 0x16, 0xF4, 0x40, 0x9A, 0x2D, 0xE0, -+0x60, 0xF6, 0x13, 0x6C, 0x60, 0xDA, 0x06, 0x02, -+0x04, 0xD2, 0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, -+0x54, 0x9A, 0x80, 0x6D, 0x00, 0x6E, 0x14, 0x6F, -+0x40, 0xEA, 0x08, 0x34, 0x30, 0xF0, 0x20, 0x6A, -+0xCF, 0xF4, 0x00, 0x4A, 0x20, 0xF1, 0x10, 0x4C, -+0x91, 0xE2, 0x60, 0xF6, 0x18, 0x6A, 0x1F, 0xF7, -+0x00, 0x6B, 0x4C, 0xEB, 0x02, 0xF0, 0x00, 0x73, -+0x01, 0x60, 0x05, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF2, 0x68, 0x9B, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF2, 0x6C, 0x9B, 0x6D, 0xE2, -+0xA0, 0xA3, 0x01, 0x4A, 0xFF, 0x6B, 0xAC, 0xEB, -+0x60, 0xF6, 0x1C, 0x72, 0x60, 0xC4, 0x01, 0x4C, -+0xE6, 0x61, 0x01, 0x48, 0x04, 0x70, 0xC7, 0x61, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x60, 0xA4, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF0, -+0x74, 0xC2, 0x61, 0xA4, 0x69, 0xF0, 0x75, 0xC2, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA4, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0x49, 0xF2, -+0x03, 0x4C, 0x07, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0xA4, 0x67, 0x30, 0xF0, 0x20, 0x6C, 0x49, 0xF2, -+0x0A, 0x4C, 0x07, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, 0x30, 0x6A, -+0x65, 0xF6, 0x1D, 0x4A, 0x40, 0xDB, 0x61, 0xA4, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x89, 0xF0, 0x6A, 0xC2, 0x62, 0xA4, 0x89, 0xF0, -+0x6B, 0xC2, 0x20, 0xE8, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0x28, 0xF1, 0x54, 0xA0, -+0xFF, 0x69, 0x2C, 0xEC, 0x02, 0x72, 0x04, 0xD4, -+0x1B, 0x61, 0x01, 0x74, 0x3D, 0x61, 0x08, 0xF4, -+0x61, 0xA0, 0x01, 0x6A, 0x80, 0x6C, 0x6D, 0xEA, -+0xE8, 0xF3, 0x7B, 0xA0, 0x8B, 0xEC, 0x08, 0xF4, -+0x41, 0xC0, 0x8C, 0xEB, 0x2C, 0xEB, 0x0A, 0x23, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, 0x64, 0x9A, -+0x40, 0xA3, 0x2C, 0xEA, 0x8E, 0xEA, 0x2C, 0xEA, -+0x40, 0xC3, 0x26, 0x10, 0x01, 0x6C, 0x22, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, 0x48, 0x9A, -+0x01, 0x6B, 0x6B, 0xEB, 0x60, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x64, 0x6C, -+0x40, 0xEA, 0x08, 0xF4, 0x60, 0xA0, 0x01, 0x6A, -+0x6C, 0xEA, 0x2C, 0xEA, 0x02, 0x2A, 0x00, 0x18, -+0xB6, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, -+0x64, 0x9A, 0xFF, 0x6C, 0x80, 0x6D, 0x40, 0xA3, -+0xAB, 0xED, 0x8C, 0xEA, 0xAE, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x04, 0x94, 0x00, 0x18, 0x60, 0xDE, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x89, 0xF0, 0x9E, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0xE8, 0xF3, 0x93, 0xA2, 0x89, 0xF0, -+0x7E, 0xC2, 0x41, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, -+0xE8, 0xF3, 0x73, 0xC2, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x5C, 0x9A, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6C, 0x96, 0xF2, 0x98, 0x9C, 0x10, 0xF0, -+0x30, 0x6B, 0x65, 0xF7, 0x11, 0x4B, 0x01, 0x72, -+0x60, 0xDC, 0x19, 0x60, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0x08, 0xF4, 0xA1, 0xA3, -+0x01, 0x6C, 0x02, 0x72, 0xAD, 0xEC, 0x08, 0xF4, -+0x81, 0xC3, 0x40, 0x6B, 0x03, 0x60, 0x04, 0x72, -+0x06, 0x61, 0x41, 0x6B, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF4, 0x4C, 0x9A, 0x60, 0xC2, 0x01, 0x6C, -+0x80, 0x18, 0xA9, 0x0B, 0x18, 0x10, 0x30, 0xF0, -+0x20, 0x6B, 0x30, 0xF0, 0x20, 0x6A, 0xEE, 0xF4, -+0x58, 0x9A, 0xA8, 0xF4, 0x8C, 0x9B, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x4C, 0x9A, -+0x40, 0xA2, 0xF1, 0x2A, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, 0x30, 0x6A, -+0x65, 0xF7, 0x12, 0x4A, 0x40, 0xDB, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x1A, 0xD3, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x19, 0xD3, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0xFF, 0x6A, 0x8C, 0xEA, -+0x53, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x49, 0xF2, -+0x83, 0xA2, 0x02, 0x24, 0x80, 0x18, 0x2A, 0x0B, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, -+0x00, 0x6B, 0x30, 0xF0, 0x20, 0x68, 0x60, 0xC2, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, 0x4C, 0x9A, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF4, 0x70, 0x9B, -+0x40, 0x9A, 0xFF, 0x69, 0xB1, 0x67, 0x6C, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xA8, 0xF4, 0x4C, 0xDB, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, 0x74, 0x9A, -+0xFE, 0x6A, 0x35, 0x6E, 0x80, 0xA3, 0x8C, 0xEA, -+0x40, 0xC3, 0x6E, 0xF2, 0x58, 0x98, 0x91, 0x67, -+0x40, 0xEA, 0x00, 0x18, 0x2F, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x70, 0x9A, 0x04, 0x6C, -+0x40, 0xA3, 0x2C, 0xEA, 0x8D, 0xEA, 0x2C, 0xEA, -+0x40, 0xC3, 0x80, 0x18, 0xDC, 0x0B, 0x80, 0x18, -+0x03, 0x0C, 0x00, 0x18, 0xFA, 0xE9, 0x6E, 0xF2, -+0x58, 0x98, 0x00, 0x6D, 0x91, 0x67, 0xC5, 0x67, -+0x40, 0xEA, 0x80, 0x18, 0x79, 0x0A, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF3, 0xAC, 0x9A, 0x10, 0xF0, -+0x24, 0x6A, 0x56, 0xF4, 0x54, 0x9A, 0x01, 0x6C, -+0xA0, 0xDA, 0x00, 0x18, 0x3C, 0xDF, 0x1C, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0xAC, 0x9A, -+0x01, 0x6C, 0x00, 0x18, 0x6D, 0xDF, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x70, 0x9A, 0xFB, 0x6A, -+0x80, 0xA3, 0x8C, 0xEA, 0x40, 0xC3, 0x80, 0x18, -+0xFF, 0x0B, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, -+0x4C, 0x9A, 0x30, 0xF0, 0x20, 0x6C, 0xA8, 0xF5, -+0x1B, 0x4C, 0x00, 0x6D, 0x25, 0x6E, 0x40, 0xEA, -+0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x04, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xC0, 0xF1, 0x08, 0x48, 0xA0, 0xA4, 0xE8, 0xF3, -+0x73, 0xA0, 0x02, 0x6A, 0x01, 0x69, 0x4B, 0xEA, -+0x2C, 0xED, 0x4C, 0xEB, 0xAD, 0xEB, 0xE8, 0xF3, -+0x73, 0xC0, 0xA0, 0xA4, 0x03, 0x6E, 0xCB, 0xEE, -+0xA6, 0x35, 0x2C, 0xED, 0xA4, 0x35, 0xCC, 0xEB, -+0xAD, 0xEB, 0xE8, 0xF3, 0x73, 0xC0, 0xA0, 0xA4, -+0x05, 0x6F, 0xEB, 0xEF, 0xAA, 0x35, 0x2C, 0xED, -+0xA8, 0x35, 0xEC, 0xEB, 0xAD, 0xEB, 0xE8, 0xF3, -+0x73, 0xC0, 0xA0, 0xA4, 0xFA, 0x4E, 0xCC, 0xEB, -+0xAE, 0x35, 0x2C, 0xED, 0xAC, 0x35, 0xAD, 0xEB, -+0xE8, 0xF3, 0x73, 0xC0, 0xA0, 0xA4, 0xF4, 0x4F, -+0xEC, 0xEB, 0xB2, 0x35, 0x2C, 0xED, 0xB0, 0x35, -+0xAD, 0xEB, 0xE8, 0xF3, 0x73, 0xC0, 0xA0, 0xA4, -+0xE8, 0x4E, 0xCC, 0xEB, 0xB6, 0x35, 0x2C, 0xED, -+0xB4, 0x35, 0xAD, 0xEB, 0xE8, 0xF3, 0x73, 0xC0, -+0xA0, 0xA4, 0xE0, 0x4E, 0xCC, 0xEB, 0xBA, 0x35, -+0x2C, 0xED, 0xB8, 0x35, 0xAD, 0xEB, 0xE8, 0xF3, -+0x73, 0xC0, 0xA0, 0xA4, 0x1F, 0x65, 0xBE, 0x35, -+0xBC, 0x37, 0x7F, 0x6D, 0xAC, 0xEB, 0xED, 0xEB, -+0xE8, 0xF3, 0x73, 0xC0, 0xA2, 0xA4, 0xE8, 0xF3, -+0x75, 0xA0, 0x2C, 0xED, 0x4C, 0xEB, 0xAD, 0xEB, -+0xE8, 0xF3, 0x75, 0xC0, 0xE1, 0xA4, 0xA7, 0x67, -+0x2C, 0xED, 0xFD, 0x65, 0xE8, 0xF3, 0xB4, 0xA0, -+0xFF, 0x67, 0x4C, 0xED, 0xED, 0xED, 0xE8, 0xF3, -+0xB4, 0xC0, 0xE1, 0xA4, 0xEA, 0x37, 0x2C, 0xEF, -+0xE8, 0x37, 0xFF, 0x65, 0x05, 0x6F, 0xEB, 0xEF, -+0xEC, 0xED, 0xFF, 0x67, 0xED, 0xED, 0xE8, 0xF3, -+0xB4, 0xC0, 0xE1, 0xA4, 0xF2, 0x37, 0x2C, 0xEF, -+0xF0, 0x37, 0xFF, 0x65, 0xF8, 0x67, 0xEC, 0xED, -+0xFF, 0x67, 0xED, 0xED, 0xE8, 0xF3, 0xB4, 0xC0, -+0xE1, 0xA4, 0xEE, 0x37, 0x2C, 0xEF, 0xEC, 0x37, -+0xFF, 0x65, 0x09, 0x6F, 0xEB, 0xEF, 0xEC, 0xED, -+0xFF, 0x67, 0xED, 0xED, 0xE8, 0xF3, 0xB4, 0xC0, -+0xE1, 0xA4, 0xF6, 0x37, 0x2C, 0xEF, 0xF4, 0x37, -+0xFF, 0x65, 0x21, 0x6F, 0xEB, 0xEF, 0xEC, 0xED, -+0xFF, 0x67, 0xED, 0xED, 0xE8, 0xF3, 0xB4, 0xC0, -+0xE2, 0xA4, 0xF2, 0x37, 0x2C, 0xEF, 0xF0, 0x37, -+0xFF, 0x65, 0xF8, 0x67, 0xEC, 0xEB, 0xFF, 0x67, -+0xED, 0xEB, 0xE8, 0xF3, 0x75, 0xC0, 0xE2, 0xA4, -+0xF6, 0x37, 0x2C, 0xEF, 0xF4, 0x37, 0xFF, 0x65, -+0x21, 0x6F, 0xEB, 0xEF, 0xEC, 0xEB, 0xFF, 0x67, -+0xED, 0xEB, 0xE8, 0xF3, 0x75, 0xC0, 0xE1, 0xA4, -+0xCC, 0xEB, 0xE6, 0x37, 0x2C, 0xEF, 0xE4, 0x37, -+0x1F, 0x65, 0x03, 0x6F, 0xEB, 0xEF, 0xEC, 0xED, -+0xF8, 0x67, 0xED, 0xED, 0xE8, 0xF3, 0xB4, 0xC0, -+0xE2, 0xA4, 0xCC, 0xED, 0xFA, 0x37, 0x2C, 0xEF, -+0xF8, 0x37, 0xED, 0xEB, 0xE8, 0xF3, 0x75, 0xC0, -+0xE2, 0xA4, 0xFE, 0x37, 0xFC, 0x37, 0x1F, 0x65, -+0x7F, 0x6F, 0xEC, 0xEB, 0xF8, 0x67, 0xED, 0xEB, -+0xE8, 0xF3, 0x75, 0xC0, 0x64, 0xA4, 0xE8, 0xF3, -+0xF7, 0xA0, 0x2C, 0xEB, 0xEC, 0xEA, 0x6D, 0xEA, -+0xE8, 0xF3, 0x57, 0xC0, 0x41, 0xA4, 0x0F, 0x6B, -+0x5A, 0x32, 0x2C, 0xEA, 0x58, 0x32, 0x4D, 0xED, -+0xE8, 0xF3, 0xB4, 0xC0, 0x43, 0xA4, 0xE8, 0xF3, -+0x96, 0xA0, 0x4C, 0xEB, 0x10, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x6D, 0xEA, 0xE8, 0xF3, 0x56, 0xC0, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF4, 0x4C, 0x9A, -+0xE8, 0xF3, 0x93, 0xA0, 0x10, 0xF0, 0x24, 0x6B, -+0xD6, 0xF4, 0x70, 0x9B, 0x40, 0x9A, 0x86, 0x34, -+0x2C, 0xEC, 0x6C, 0xEA, 0xE8, 0xF2, 0x44, 0xD8, -+0x80, 0x18, 0x9B, 0x09, 0xE8, 0xF3, 0x93, 0xA0, -+0x8A, 0x34, 0x2C, 0xEC, 0x80, 0x18, 0xE7, 0x07, -+0xE8, 0xF3, 0x94, 0xA0, 0x08, 0x6A, 0xFF, 0x6B, -+0x8C, 0xEA, 0x09, 0x22, 0xE8, 0xF3, 0xB3, 0xA0, -+0x0E, 0x6A, 0x00, 0x6C, 0xAC, 0xEA, 0x6C, 0xEA, -+0x07, 0x22, 0x91, 0x67, 0x05, 0x10, 0xE8, 0xF3, -+0x93, 0xA0, 0x8E, 0x34, 0x2C, 0xEC, 0x6C, 0xEC, -+0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, 0x08, 0x48, -+0x00, 0x18, 0xD1, 0xD1, 0xE8, 0xF3, 0x93, 0xA0, -+0x01, 0x69, 0x92, 0x34, 0x2C, 0xEC, 0x00, 0x18, -+0x55, 0xD2, 0xE8, 0xF3, 0x93, 0xA0, 0x9A, 0x34, -+0x2C, 0xEC, 0x00, 0x18, 0x1E, 0xD4, 0x00, 0x18, -+0x15, 0xDF, 0xE8, 0xF3, 0x93, 0xA0, 0x2C, 0xEC, -+0x80, 0x18, 0x07, 0x0C, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6A, -+0x76, 0xF4, 0x60, 0x9A, 0xF0, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF4, 0x78, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0xD6, 0xF4, 0x9C, 0x9C, 0x40, 0x9B, 0x8C, 0xEA, -+0x40, 0xDB, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x08, 0xF4, 0x81, 0xA2, 0xA0, 0x9B, -+0x86, 0x34, 0xC0, 0xF7, 0x80, 0x34, 0xAD, 0xEC, -+0x80, 0xDB, 0x89, 0xF0, 0x8A, 0xA2, 0x80, 0x18, -+0x4E, 0x0A, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF4, -+0x54, 0x9A, 0x10, 0xF0, 0x00, 0x6B, 0x60, 0xDA, -+0x00, 0x18, 0xC8, 0xEB, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0x96, 0xF2, 0x78, 0x9B, 0x10, 0xF0, 0x30, 0x6A, -+0xC6, 0xF3, 0x1D, 0x4A, 0x40, 0xDB, 0xA0, 0xA4, -+0x01, 0x6A, 0xFF, 0x6E, 0x4C, 0xED, 0x1B, 0x2D, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0xE8, 0xF3, 0xFA, 0xA3, 0x02, 0x6C, 0x8B, 0xEC, -+0xEC, 0xEC, 0xAD, 0xEC, 0xE8, 0xF3, 0xBB, 0xA3, -+0xE8, 0xF3, 0x9A, 0xC3, 0x7F, 0x6C, 0xAC, 0xEC, -+0xE8, 0xF3, 0xBA, 0xA3, 0xCC, 0xEC, 0xB6, 0x35, -+0x4E, 0xED, 0x4C, 0xED, 0x00, 0x18, 0x68, 0xDD, -+0x80, 0x18, 0xDE, 0x0C, 0x9B, 0x11, 0x30, 0xF0, -+0x20, 0x6D, 0x05, 0x6B, 0xCF, 0xF4, 0x00, 0x4D, -+0x40, 0xF1, 0x70, 0xC5, 0x30, 0xF0, 0x20, 0x6B, -+0xC0, 0xF1, 0x08, 0x4B, 0xE8, 0xF3, 0xFA, 0xA3, -+0x00, 0xA4, 0x1F, 0x65, 0x02, 0x6F, 0x38, 0x67, -+0xEB, 0xEF, 0x4C, 0xE8, 0x2C, 0xEF, 0x0D, 0xEF, -+0xE8, 0xF3, 0xFA, 0xC3, 0x00, 0xA4, 0x06, 0x30, -+0x4C, 0xE8, 0x04, 0x31, 0x03, 0x68, 0x0B, 0xE8, -+0x18, 0x65, 0xEC, 0xE8, 0x2D, 0xE8, 0xE8, 0xF3, -+0x1A, 0xC3, 0xE0, 0xA4, 0xEA, 0x37, 0x4C, 0xEF, -+0xE8, 0x31, 0x05, 0x6F, 0xEB, 0xEF, 0x0C, 0xEF, -+0x2D, 0xEF, 0xE8, 0xF3, 0xFA, 0xC3, 0x00, 0xA4, -+0x09, 0x69, 0x2B, 0xE9, 0x0E, 0x30, 0x4C, 0xE8, -+0x0C, 0x30, 0x2C, 0xEF, 0x0D, 0xEF, 0xE8, 0xF3, -+0xFA, 0xC3, 0x00, 0xA4, 0x12, 0x30, 0x4C, 0xE8, -+0x10, 0x31, 0x11, 0x68, 0x0B, 0xE8, 0x0C, 0xEF, -+0x2D, 0xEF, 0xE8, 0xF3, 0xFA, 0xC3, 0x00, 0xA4, -+0x16, 0x30, 0x4C, 0xE8, 0x14, 0x30, 0xF8, 0x65, -+0x21, 0x68, 0x0B, 0xE8, 0x3F, 0x67, 0xEC, 0xE8, -+0x2D, 0xE8, 0xE8, 0xF3, 0x1A, 0xC3, 0xE0, 0xA4, -+0x7F, 0x69, 0xFA, 0x37, 0x4C, 0xEF, 0xF8, 0x37, -+0xFF, 0x65, 0x41, 0x6F, 0xEB, 0xEF, 0x0C, 0xEF, -+0x1F, 0x67, 0x0D, 0xEF, 0xE8, 0xF3, 0xFA, 0xC3, -+0x00, 0xA4, 0x2C, 0xEF, 0x1E, 0x30, 0x1C, 0x30, -+0x0D, 0xEF, 0xE8, 0xF3, 0xFA, 0xC3, 0x01, 0xA4, -+0x1E, 0x30, 0x1C, 0x30, 0x04, 0xD0, 0xE8, 0xF3, -+0x3B, 0xA3, 0xF9, 0x65, 0x1F, 0x67, 0x7F, 0x69, -+0x2C, 0xE8, 0x04, 0x91, 0x2D, 0xE8, 0xE8, 0xF3, -+0x1B, 0xC3, 0x04, 0xA4, 0xE8, 0xF3, 0x3E, 0xA3, -+0x06, 0x30, 0x4C, 0xE8, 0x04, 0x30, 0xF8, 0x65, -+0x18, 0x67, 0x0C, 0xE9, 0x1F, 0x67, 0x0D, 0xE9, -+0xE8, 0xF3, 0x3E, 0xC3, 0x19, 0x65, 0x24, 0xA4, -+0x18, 0x67, 0x2E, 0x31, 0x4C, 0xE9, 0x2C, 0x31, -+0xF9, 0x65, 0x09, 0x69, 0x2B, 0xE9, 0x0C, 0xE9, -+0x1F, 0x67, 0x0D, 0xE9, 0xE8, 0xF3, 0x3E, 0xC3, -+0x05, 0xA4, 0xE8, 0xF3, 0x1F, 0xC3, 0x04, 0xA4, -+0x12, 0x30, 0x4C, 0xE8, 0x10, 0x30, 0xF8, 0x65, -+0x11, 0x68, 0x0B, 0xE8, 0x0C, 0xE9, 0x1F, 0x67, -+0x0D, 0xE9, 0xE8, 0xF3, 0x3E, 0xC3, 0x26, 0xA4, -+0x7F, 0x68, 0x3E, 0x31, 0x3C, 0x31, 0xF9, 0x65, -+0x08, 0xF4, 0x20, 0xA3, 0x19, 0x65, 0x38, 0x67, -+0x2C, 0xE8, 0x3F, 0x67, 0x2D, 0xE8, 0x08, 0xF4, -+0x00, 0xC3, 0x04, 0x68, 0x0C, 0xEF, 0xCC, 0xEF, -+0x20, 0x27, 0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF4, -+0x60, 0x9B, 0xE0, 0xA3, 0x1F, 0x65, 0x38, 0x67, -+0x2F, 0x6F, 0x2C, 0xEF, 0xE0, 0xC3, 0x80, 0xF2, -+0xB4, 0xA5, 0xE0, 0xA3, 0xAC, 0xEA, 0xCC, 0xEF, -+0x50, 0x32, 0xED, 0xEA, 0xCC, 0xEA, 0x40, 0xC3, -+0xE0, 0xA3, 0x06, 0x6A, 0xAC, 0xEA, 0xCC, 0xEF, -+0x54, 0x32, 0xED, 0xEA, 0xCC, 0xEA, 0x40, 0xC3, -+0x40, 0xA3, 0xCC, 0xEA, 0x0D, 0xEA, 0xCC, 0xEA, -+0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, 0xC8, 0xF5, -+0x42, 0xA2, 0x08, 0x6E, 0xFF, 0x6D, 0xCC, 0xEA, -+0x09, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x76, 0xF4, -+0x60, 0x9A, 0x40, 0xA3, 0xAC, 0xEA, 0xCD, 0xEA, -+0xAC, 0xEA, 0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xE8, 0xF3, 0x7A, 0xA2, -+0x02, 0x6F, 0xFF, 0x6E, 0xEC, 0xEB, 0x20, 0x23, -+0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF4, 0xA0, 0x9B, -+0x60, 0xA5, 0xCC, 0xEB, 0xED, 0xEB, 0xCC, 0xEB, -+0x60, 0xC5, 0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF4, -+0xB8, 0x9B, 0x08, 0xF4, 0xE1, 0xA2, 0x03, 0x6B, -+0xC0, 0x9D, 0x6B, 0xEB, 0xEC, 0xEB, 0xC0, 0xF7, -+0xC2, 0x36, 0xC4, 0x36, 0xCD, 0xEB, 0x08, 0xF4, -+0x61, 0xC2, 0x10, 0xF0, 0x24, 0x6B, 0x40, 0x9D, -+0xF6, 0xF3, 0x74, 0x9B, 0x6D, 0xEA, 0x40, 0xDD, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x28, 0xF1, 0x74, 0xA2, 0x02, 0x73, 0x08, 0x61, -+0xE8, 0xF3, 0x7B, 0xA2, 0x80, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x74, 0x2A, -+0x30, 0xF0, 0x20, 0x6B, 0xC0, 0xF1, 0x08, 0x4B, -+0xE1, 0xA4, 0xE8, 0xF3, 0xDB, 0xA3, 0x80, 0x6A, -+0x7F, 0x6D, 0x4B, 0xEA, 0xAC, 0xEF, 0x4C, 0xEE, -+0xED, 0xEE, 0xE8, 0xF3, 0xDB, 0xC3, 0xE2, 0xA4, -+0xE8, 0xF3, 0x3C, 0xA3, 0xAC, 0xEF, 0x4C, 0xE9, -+0xED, 0xE9, 0xE8, 0xF3, 0x3C, 0xC3, 0x03, 0xA4, -+0x01, 0x6A, 0xAC, 0xE9, 0xF0, 0x67, 0x4C, 0xEF, -+0xFF, 0x65, 0xE8, 0xF3, 0xFD, 0xA3, 0x02, 0x68, -+0x0B, 0xE8, 0x18, 0x65, 0x0C, 0xEF, 0x1F, 0x67, -+0x0D, 0xEF, 0xE8, 0xF3, 0xFD, 0xC3, 0x03, 0xA4, -+0x4C, 0xEF, 0x06, 0x30, 0x04, 0x30, 0x0D, 0xEF, -+0xE8, 0xF3, 0xFD, 0xC3, 0xE4, 0xA4, 0x05, 0x68, -+0x0B, 0xE8, 0xEA, 0x37, 0x4C, 0xEF, 0xE8, 0x37, -+0x04, 0xD7, 0xE8, 0xF3, 0xFE, 0xA3, 0xFF, 0x65, -+0xFF, 0x67, 0xEC, 0xE8, 0x04, 0x97, 0xED, 0xE8, -+0xE8, 0xF3, 0x1E, 0xC3, 0xE4, 0xA4, 0xF6, 0x37, -+0x4C, 0xEF, 0xF4, 0x37, 0xFF, 0x65, 0x21, 0x6F, -+0xEB, 0xEF, 0x0C, 0xEF, 0x1F, 0x67, 0x0D, 0xEF, -+0xE8, 0xF3, 0xFE, 0xC3, 0x02, 0xA4, 0x1E, 0x30, -+0x1C, 0x30, 0x0D, 0xE9, 0xE8, 0xF3, 0x3C, 0xC3, -+0x06, 0xA4, 0x08, 0xF4, 0x80, 0xA3, 0x38, 0x67, -+0x4C, 0xE8, 0x2C, 0xEC, 0x0D, 0xEC, 0x20, 0x68, -+0x0C, 0xEF, 0x08, 0xF4, 0x80, 0xC3, 0xFF, 0x6C, -+0x08, 0x2F, 0xAC, 0xEE, 0xE8, 0xF3, 0xBA, 0xA3, -+0xCC, 0xEC, 0xB6, 0x35, 0x4E, 0xED, 0x4C, 0xED, -+0x08, 0x10, 0xE8, 0xF3, 0x5A, 0xA3, 0x0C, 0xEA, -+0x8C, 0xEA, 0x06, 0x22, 0xAC, 0xEE, 0xCC, 0xEC, -+0x00, 0x6D, 0x00, 0x18, 0x68, 0xDD, 0x04, 0x10, -+0xAC, 0xEE, 0xCC, 0xEC, 0x00, 0x18, 0x59, 0xDD, -+0x00, 0x18, 0xBC, 0xEB, 0x30, 0xF0, 0x20, 0x6A, -+0x05, 0x6B, 0x0F, 0xF6, 0x70, 0xC2, 0x30, 0xF0, -+0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, -+0x20, 0x6C, 0xC8, 0xF6, 0x15, 0x4C, 0x00, 0x6D, -+0x08, 0x6E, 0x40, 0xEA, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x4C, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0xA8, 0xF5, 0x1B, 0x4C, 0x00, 0x6D, 0x25, 0x6E, -+0x40, 0xEA, 0x80, 0x18, 0x6F, 0x0A, 0x00, 0x18, -+0x0B, 0xD3, 0x00, 0x18, 0xFE, 0xD1, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF4, 0x54, 0x9A, 0x10, 0xF0, 0x24, 0x6B, -+0x16, 0xF4, 0x78, 0x9B, 0xFF, 0x68, 0x49, 0xE4, -+0x0C, 0xED, 0x05, 0xD5, 0x04, 0xD2, 0x6D, 0xE4, -+0x40, 0xA2, 0xA0, 0xA3, 0x10, 0xF0, 0x24, 0x6B, -+0x36, 0xF4, 0x34, 0x9B, 0x0C, 0xED, 0x25, 0xE4, -+0xC0, 0xA1, 0x90, 0x67, 0x4C, 0xEC, 0x0C, 0xEE, -+0x80, 0x18, 0x62, 0x09, 0x06, 0xD2, 0x80, 0xA1, -+0x0C, 0xEC, 0x80, 0x18, 0x53, 0x09, 0x22, 0x67, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0x40, 0xF1, 0xD1, 0xA2, 0x07, 0x5E, 0x33, 0x60, -+0x40, 0xF1, 0x71, 0x82, 0x01, 0x6A, 0x44, 0xEB, -+0x14, 0x6B, 0x4C, 0xEB, 0x18, 0x2B, 0x62, 0x6B, -+0x4C, 0xEB, 0x29, 0x23, 0x30, 0xF0, 0x20, 0x68, -+0x05, 0x95, 0xEF, 0xF5, 0x00, 0x48, 0x90, 0x67, -+0x00, 0x18, 0x01, 0xD0, 0x04, 0x93, 0x06, 0x94, -+0x89, 0xE3, 0x2B, 0xE2, 0x25, 0xE0, 0x04, 0x10, -+0x60, 0xA0, 0x01, 0x48, 0x60, 0xC2, 0x01, 0x4A, -+0x2A, 0xE8, 0xFA, 0x61, 0x14, 0x10, 0x30, 0xF0, -+0x20, 0x68, 0x05, 0x95, 0xEF, 0xF5, 0x00, 0x48, -+0x90, 0x67, 0x00, 0x18, 0xEA, 0xCF, 0x04, 0x93, -+0x06, 0x94, 0x89, 0xE3, 0x2B, 0xE2, 0x25, 0xE0, -+0x04, 0x10, 0x60, 0xA0, 0x01, 0x48, 0x60, 0xC2, -+0x01, 0x4A, 0x2A, 0xE8, 0xFA, 0x61, 0x0B, 0x97, -+0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, -+0xF5, 0x63, 0x15, 0x62, 0x14, 0xD1, 0x13, 0xD0, -+0xFF, 0x6A, 0x0F, 0xD2, 0x7D, 0x67, 0x60, 0xF0, -+0x68, 0xA3, 0x18, 0xD6, 0xDD, 0x67, 0x10, 0xD3, -+0x60, 0xF0, 0xCC, 0xA6, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF3, 0x48, 0x9A, 0x16, 0xD4, 0x17, 0xD5, -+0x19, 0xD7, 0x11, 0xD6, 0x40, 0xA2, 0xFF, 0x6B, -+0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, -+0x54, 0x9A, 0x0F, 0xD3, 0x02, 0xF0, 0x00, 0x6B, -+0x40, 0x9A, 0x6C, 0xEA, 0x1C, 0x22, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6C, -+0xFF, 0x6D, 0x39, 0x6E, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF2, 0x40, 0x9A, 0x00, 0x68, -+0x40, 0xEA, 0x01, 0x72, 0x19, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, -+0x5C, 0x9A, 0x49, 0xF2, 0x85, 0xA3, 0x01, 0x6D, -+0x18, 0x6E, 0xF0, 0x67, 0x0B, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6B, 0x6E, 0xF2, -+0x5C, 0x9A, 0x49, 0xF2, 0x85, 0xA3, 0x01, 0x6D, -+0x18, 0x6E, 0x00, 0x6F, 0x40, 0xEA, 0x02, 0x67, -+0x10, 0xF0, 0x24, 0x6A, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF4, 0x4C, 0x9A, 0xD6, 0xF3, 0x78, 0x9B, -+0x49, 0xE0, 0x6D, 0xE0, 0x80, 0xA2, 0xA0, 0xA3, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF4, 0x70, 0x9B, -+0xFF, 0x6A, 0x4C, 0xEC, 0x6D, 0xE0, 0xC0, 0xA3, -+0x4C, 0xED, 0x4C, 0xEE, 0x80, 0x18, 0x62, 0x09, -+0x10, 0x95, 0x87, 0x40, 0x29, 0x4C, 0x22, 0x67, -+0x80, 0x18, 0xE9, 0x0D, 0x11, 0x96, 0x0F, 0x2E, -+0x10, 0xF0, 0x24, 0x6A, 0x10, 0xF0, 0x24, 0x6D, -+0x56, 0xF4, 0x40, 0x9A, 0xF6, 0xF4, 0xA8, 0x9D, -+0x16, 0x94, 0x49, 0xE0, 0xB5, 0xE0, 0x29, 0xE2, -+0x18, 0x93, 0x35, 0xE5, 0x09, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF4, 0x60, 0x9A, 0x0E, 0x04, -+0x04, 0x02, 0x6D, 0xE0, 0x2D, 0xE3, 0x27, 0x10, -+0xC0, 0xA4, 0x01, 0x4C, 0xC0, 0xC2, 0xE0, 0xA3, -+0xC8, 0x42, 0xF8, 0x4E, 0xE0, 0xC6, 0xC0, 0xA3, -+0x01, 0x4B, 0xD8, 0xC2, 0x01, 0x4A, 0xAA, 0xEA, -+0xF3, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF4, -+0x84, 0x9A, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF4, -+0x64, 0x9A, 0x91, 0xE0, 0x00, 0x6A, 0x6D, 0xE0, -+0x2D, 0xE3, 0x17, 0x96, 0x55, 0xE6, 0xA0, 0xA5, -+0xA0, 0xC4, 0x19, 0x96, 0x01, 0x4C, 0x55, 0xE6, -+0xA0, 0xA5, 0x01, 0x4A, 0x06, 0x72, 0xA0, 0xC3, -+0x01, 0x4B, 0xF3, 0x61, 0xD0, 0x17, 0xA0, 0xA3, -+0x01, 0x4B, 0xA0, 0xC2, 0x01, 0x4A, 0x8A, 0xEA, -+0xFA, 0x61, 0x16, 0x94, 0x18, 0x95, 0x3A, 0x6F, -+0x20, 0x6E, 0x80, 0x18, 0xEE, 0x07, 0x30, 0xF0, -+0x20, 0x6B, 0xCE, 0xF4, 0x48, 0x9B, 0x38, 0x48, -+0x21, 0xE0, 0x30, 0xF0, 0x20, 0x6E, 0x90, 0x67, -+0x0E, 0xD0, 0x28, 0x6D, 0x68, 0xF6, 0x04, 0x4E, -+0x30, 0xF0, 0x20, 0x68, 0x40, 0xEA, 0xC0, 0xF1, -+0x08, 0x48, 0x30, 0xF0, 0x20, 0x6A, 0x0E, 0xF5, -+0x48, 0x9A, 0x0E, 0x95, 0x69, 0xF0, 0xDD, 0xA0, -+0x3A, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6E, -+0xCE, 0xF4, 0x48, 0x9E, 0x0E, 0x94, 0x28, 0x6D, -+0x04, 0x06, 0x40, 0xEA, 0x69, 0xF0, 0x54, 0xA0, -+0x02, 0x72, 0x05, 0x61, 0x69, 0xF0, 0x9D, 0xA0, -+0xB1, 0x67, 0x80, 0x18, 0xF4, 0x09, 0x10, 0xF0, -+0x24, 0x6A, 0x16, 0xF4, 0x68, 0x9A, 0xFF, 0x6C, -+0x02, 0x6D, 0x40, 0xA3, 0x3A, 0x6E, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0x0F, 0x95, 0x6E, 0xF2, 0x58, 0x9A, -+0x00, 0x6C, 0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, -+0x8E, 0xF2, 0x5C, 0x9A, 0x40, 0xEA, 0x15, 0x97, -+0x14, 0x91, 0x13, 0x90, 0x0B, 0x63, 0x00, 0xEF, -+0xF1, 0x63, 0x1D, 0x62, 0x1C, 0xD1, 0x1B, 0xD0, -+0x00, 0x6A, 0x7D, 0x67, 0x1E, 0xD4, 0x1F, 0xD5, -+0x06, 0xD2, 0x4E, 0xCB, 0x08, 0xD2, 0x09, 0xD2, -+0x0A, 0xD2, 0x0B, 0xD2, 0x0C, 0xD2, 0x0D, 0xD2, -+0x0E, 0xD2, 0x0F, 0xD2, 0x30, 0xF0, 0x20, 0x6A, -+0x0E, 0xF5, 0x4C, 0x9A, 0x1E, 0x94, 0x1F, 0x95, -+0x40, 0xEA, 0x01, 0x72, 0x00, 0xF1, 0x0A, 0x61, -+0x1E, 0x94, 0x1F, 0x93, 0x30, 0xF0, 0x20, 0x68, -+0xCE, 0xF4, 0x4C, 0x98, 0x0E, 0x4C, 0x71, 0xE4, -+0x40, 0xEA, 0x3A, 0x72, 0xE0, 0xF0, 0x1E, 0x61, -+0x1E, 0x94, 0x1F, 0x93, 0xCE, 0xF4, 0x4C, 0x98, -+0x30, 0x4C, 0x71, 0xE4, 0x40, 0xEA, 0x87, 0x72, -+0xE0, 0xF0, 0x14, 0x61, 0x1E, 0x90, 0x1F, 0x92, -+0x10, 0x03, 0x38, 0x48, 0x41, 0xE0, 0x0C, 0x01, -+0x16, 0xD3, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x4C, 0x9A, 0x90, 0x67, 0x01, 0x48, 0x40, 0xEA, -+0x40, 0xC1, 0x16, 0x92, 0x01, 0x49, 0x4A, 0xE9, -+0xF4, 0x61, 0x30, 0xF0, 0x20, 0x6B, 0xE8, 0xF5, -+0x15, 0x4B, 0x12, 0xD3, 0x00, 0x68, 0x38, 0x6C, -+0x98, 0xE8, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x12, 0xEC, 0x4D, 0xE4, 0x28, 0xF4, -+0xAC, 0xA3, 0x01, 0x6B, 0xAC, 0xEB, 0xC0, 0xF0, -+0x0F, 0x23, 0x89, 0xE2, 0x28, 0xF4, 0x0E, 0x4A, -+0x13, 0xD2, 0x14, 0xD2, 0x00, 0x69, 0xBC, 0x10, -+0xE0, 0xA3, 0xC0, 0xA2, 0x01, 0x4B, 0x01, 0x4A, -+0xEE, 0xEE, 0x01, 0x5E, 0xD8, 0x67, 0xCB, 0xEE, -+0xAA, 0xEB, 0xCC, 0xEC, 0xF5, 0x61, 0x01, 0x74, -+0xA0, 0xF0, 0x00, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF4, 0x68, 0x9A, 0xFF, 0x6C, 0x06, 0x6D, -+0x40, 0xA3, 0xAB, 0xED, 0x8C, 0xEA, 0xAC, 0xEA, -+0x01, 0x6D, 0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, -+0x1E, 0x92, 0x1F, 0x93, 0x4A, 0x4A, 0x69, 0xE2, -+0x11, 0xD2, 0x00, 0xF0, 0x1E, 0x03, 0x06, 0x02, -+0x10, 0xD2, 0x17, 0xD3, 0x30, 0xF0, 0x20, 0x6A, -+0xCE, 0xF4, 0x4C, 0x9A, 0x11, 0x94, 0x40, 0xEA, -+0x10, 0x93, 0x40, 0xC3, 0x11, 0x92, 0x01, 0x4B, -+0x10, 0xD3, 0x01, 0x4A, 0x11, 0xD2, 0x17, 0x92, -+0x4A, 0xEB, 0xF0, 0x61, 0x1E, 0x92, 0x1F, 0x93, -+0x10, 0x4A, 0x69, 0xE2, 0x11, 0xD2, 0x0C, 0x03, -+0x08, 0x02, 0x10, 0xD2, 0x18, 0xD3, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, 0x11, 0x94, -+0x40, 0xEA, 0x10, 0x93, 0x40, 0xC3, 0x11, 0x92, -+0x01, 0x4B, 0x10, 0xD3, 0x01, 0x4A, 0x11, 0xD2, -+0x18, 0x92, 0x4A, 0xEB, 0xF0, 0x61, 0x38, 0x6D, -+0xB8, 0xE8, 0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, -+0x08, 0x4C, 0x01, 0x6B, 0x12, 0xED, 0x89, 0xE5, -+0x28, 0xF4, 0x4C, 0xA2, 0x46, 0x32, 0x6C, 0xEA, -+0x30, 0x22, 0x70, 0x10, 0xE0, 0xA2, 0xC0, 0xA4, -+0x01, 0x4A, 0x01, 0x4C, 0xEE, 0xEE, 0x01, 0x5E, -+0xD8, 0x67, 0xCB, 0xEE, 0xAA, 0xEA, 0xCC, 0xEB, -+0xF5, 0x61, 0x01, 0x73, 0x4E, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x69, 0xF0, -+0x74, 0xA2, 0x02, 0x73, 0x12, 0x61, 0xE8, 0xF3, -+0x94, 0xA2, 0x08, 0x6B, 0x8C, 0xEB, 0x0D, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF4, 0x6C, 0x9B, -+0x0A, 0x6C, 0x80, 0xC3, 0x08, 0xF4, 0x81, 0xA2, -+0x01, 0x6B, 0x8D, 0xEB, 0x08, 0xF4, 0x61, 0xC2, -+0x43, 0x10, 0x00, 0x6A, 0x04, 0xD2, 0x05, 0xD2, -+0x08, 0x04, 0x06, 0x05, 0x0C, 0x06, 0x14, 0x97, -+0x1E, 0x10, 0x69, 0xF0, 0x54, 0xA4, 0x02, 0x72, -+0x13, 0x61, 0xE8, 0xF3, 0xB4, 0xA4, 0x08, 0x6A, -+0xAC, 0xEA, 0xFF, 0x6D, 0xAC, 0xEA, 0x0C, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, -+0x0A, 0x6D, 0xA0, 0xC2, 0x08, 0xF4, 0x41, 0xA4, -+0x4D, 0xEB, 0x08, 0xF4, 0x61, 0xC4, 0x24, 0x10, -+0x13, 0x97, 0x00, 0x6A, 0x04, 0xD2, 0x05, 0xD2, -+0x08, 0x04, 0x06, 0x05, 0x0C, 0x06, 0x80, 0x18, -+0x1C, 0x0E, 0x0B, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF4, 0x68, 0x9A, 0xFF, 0x6C, 0x05, 0x6D, -+0x40, 0xA3, 0x8C, 0xEA, 0xAD, 0xEA, 0x8C, 0xEA, -+0x40, 0xC3, 0x01, 0x49, 0xFF, 0x6A, 0x4C, 0xE9, -+0x12, 0x93, 0x40, 0xA3, 0x43, 0xE9, 0x15, 0x61, -+0x01, 0x48, 0x38, 0x4B, 0x02, 0x70, 0x12, 0xD3, -+0x03, 0x60, 0x25, 0x17, 0x00, 0x6A, 0x01, 0x10, -+0x01, 0x6A, 0x1D, 0x97, 0x1C, 0x91, 0x1B, 0x90, -+0x0F, 0x63, 0x00, 0xEF, 0xB1, 0xE4, 0x08, 0x02, -+0x28, 0xF4, 0x14, 0x4C, 0x0C, 0x05, 0x01, 0x6B, -+0x89, 0x17, 0x38, 0x6A, 0x58, 0xE8, 0x30, 0x34, -+0x0C, 0x03, 0x10, 0x05, 0x12, 0xEA, 0x49, 0xE4, -+0x30, 0xF0, 0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, -+0x49, 0xE4, 0x48, 0xF4, 0x04, 0x4A, 0x01, 0x6C, -+0x1B, 0x17, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0xFF, 0x6A, 0x56, 0xF3, 0x68, 0x9B, 0x4C, 0xEE, -+0x4C, 0xEF, 0x0C, 0xD4, 0x0D, 0xD5, 0x06, 0xD6, -+0x04, 0xD7, 0x60, 0xA3, 0x6C, 0xEA, 0x05, 0xD2, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, 0x54, 0x9A, -+0x02, 0xF0, 0x00, 0x6B, 0x40, 0x9A, 0x6C, 0xEA, -+0x1C, 0x22, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF2, -+0x58, 0x9A, 0x00, 0x6C, 0xFF, 0x6D, 0x33, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, -+0x40, 0x9A, 0x00, 0x68, 0x40, 0xEA, 0x01, 0x72, -+0x19, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x6E, 0xF2, 0x5C, 0x9A, 0x49, 0xF2, -+0x84, 0xA3, 0x01, 0x6D, 0x18, 0x6E, 0xF0, 0x67, -+0x0B, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0x6E, 0xF2, 0x5C, 0x9A, 0x49, 0xF2, -+0x84, 0xA3, 0x01, 0x6D, 0x18, 0x6E, 0x00, 0x6F, -+0x40, 0xEA, 0x02, 0x67, 0x10, 0xF0, 0x24, 0x6A, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF4, 0x4C, 0x9A, -+0xD6, 0xF3, 0x78, 0x9B, 0x49, 0xE0, 0x6D, 0xE0, -+0x80, 0xA2, 0xA0, 0xA3, 0x10, 0xF0, 0x24, 0x6B, -+0x56, 0xF4, 0x70, 0x9B, 0xFF, 0x6A, 0x4C, 0xEC, -+0x6D, 0xE0, 0xC0, 0xA3, 0x4C, 0xED, 0x4C, 0xEE, -+0x80, 0x18, 0x62, 0x09, 0x06, 0x95, 0x87, 0x40, -+0x29, 0x4C, 0x22, 0x67, 0x80, 0x18, 0xE9, 0x0D, -+0x04, 0x92, 0x2E, 0x2A, 0x10, 0xF0, 0x24, 0x6C, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF4, 0x88, 0x9C, -+0x10, 0xF0, 0x24, 0x6D, 0x56, 0xF4, 0x44, 0x9A, -+0x36, 0xF4, 0xBC, 0x9D, 0x0D, 0x93, 0x91, 0xE0, -+0x49, 0xE0, 0x31, 0xE4, 0xB5, 0xE0, 0xC0, 0xA3, -+0xC0, 0xC2, 0xC0, 0xA3, 0x01, 0x4A, 0xAA, 0xEA, -+0xC0, 0xC4, 0x01, 0x4B, 0x01, 0x4C, 0xF7, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0x10, 0xF0, 0x24, 0x6C, -+0x56, 0xF4, 0x40, 0x9A, 0xF6, 0xF4, 0x8C, 0x9C, -+0x0C, 0x93, 0x49, 0xE0, 0x81, 0xE0, 0x29, 0xE2, -+0x21, 0xE0, 0x80, 0xA3, 0x01, 0x4B, 0x80, 0xC2, -+0x01, 0x4A, 0x0A, 0xEA, 0xFA, 0x61, 0x2D, 0x10, -+0x04, 0x92, 0x01, 0x72, 0x2A, 0x61, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF4, 0x84, 0x9B, 0x10, 0xF0, -+0x24, 0x6B, 0x56, 0xF4, 0x68, 0x9B, 0x30, 0xF0, -+0x20, 0x6A, 0xE8, 0xF5, 0x00, 0x4A, 0x6D, 0xE0, -+0x91, 0xE0, 0x2D, 0xE3, 0xA6, 0x42, 0xC0, 0xA2, -+0xC0, 0xC4, 0xCA, 0xA2, 0x01, 0x4A, 0xAA, 0xEA, -+0xC0, 0xC3, 0x01, 0x4C, 0x01, 0x4B, 0xF7, 0x61, -+0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF4, 0x60, 0x9B, -+0x30, 0xF0, 0x20, 0x6A, 0xE8, 0xF5, 0x10, 0x4A, -+0x61, 0xE0, 0x21, 0xE0, 0x64, 0x42, 0x80, 0xA2, -+0x01, 0x4A, 0x6A, 0xEA, 0x80, 0xC0, 0x01, 0x48, -+0xFA, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0x69, 0xF0, 0x74, 0xA2, 0x02, 0x73, -+0x05, 0x61, 0x69, 0xF0, 0x9C, 0xA2, 0xB1, 0x67, -+0x80, 0x18, 0xF4, 0x09, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF4, 0x70, 0x9A, 0xFF, 0x6C, 0x10, 0x6D, -+0x40, 0xA3, 0x34, 0x6E, 0x8C, 0xEA, 0xAD, 0xEA, -+0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, 0x20, 0x6A, -+0x05, 0x95, 0x6E, 0xF2, 0x58, 0x9A, 0x00, 0x6C, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0x8E, 0xF2, -+0x5C, 0x9A, 0x40, 0xEA, 0x0B, 0x97, 0x0A, 0x91, -+0x09, 0x90, 0x06, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xF6, 0x63, 0x13, 0x62, 0x12, 0xD1, 0x11, 0xD0, -+0x00, 0x6A, 0x7D, 0x67, 0x30, 0xF0, 0x20, 0x6E, -+0x08, 0xD2, 0x52, 0xCB, 0x04, 0xD2, 0xCE, 0xF4, -+0x4C, 0x9E, 0x04, 0x67, 0x06, 0x4C, 0xB1, 0xE4, -+0x25, 0x67, 0x40, 0xEA, 0x08, 0x72, 0xE0, 0xF0, -+0x05, 0x61, 0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, -+0x4C, 0x9B, 0x87, 0x40, 0x31, 0xE4, 0x40, 0xEA, -+0x06, 0x72, 0xC0, 0xF0, 0x1B, 0x61, 0x87, 0x40, -+0x03, 0x4C, 0x06, 0x06, 0x00, 0xF0, 0x1E, 0x02, -+0x0B, 0xD4, 0x0A, 0xD6, 0x0C, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0x0B, 0x94, 0xCE, 0xF4, 0x4C, 0x9A, -+0x40, 0xEA, 0x0A, 0x93, 0x0B, 0x94, 0x0C, 0x96, -+0x40, 0xC3, 0x01, 0x4B, 0x01, 0x4C, 0xCA, 0xEB, -+0x0B, 0xD4, 0x0A, 0xD3, 0xF0, 0x61, 0x00, 0x6A, -+0x01, 0x6C, 0x30, 0xF0, 0x20, 0x6D, 0x06, 0x03, -+0xC0, 0xF1, 0x08, 0x4D, 0x59, 0xE3, 0x55, 0xE5, -+0xC0, 0xA6, 0x08, 0xF4, 0xA8, 0xA5, 0x01, 0x4A, -+0xCE, 0xED, 0x01, 0x5D, 0xB8, 0x67, 0xAB, 0xED, -+0x06, 0x72, 0xAC, 0xEC, 0xEE, 0x61, 0x58, 0x67, -+0x01, 0x74, 0x05, 0xD2, 0x01, 0x6A, 0xA0, 0xF0, -+0x0A, 0x61, 0x47, 0x40, 0x19, 0x4A, 0x29, 0xE2, -+0x05, 0x04, 0x0B, 0xD2, 0x0A, 0xD4, 0x0D, 0xD3, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, -+0x0B, 0x94, 0x40, 0xEA, 0x0A, 0x96, 0x0D, 0x93, -+0x40, 0xC6, 0x0B, 0x92, 0x01, 0x4E, 0x6A, 0xEE, -+0x01, 0x4A, 0x0B, 0xD2, 0x0A, 0xD6, 0xF0, 0x61, -+0x30, 0xF0, 0x20, 0x6A, 0x9D, 0x67, 0xC0, 0xF1, -+0x08, 0x4A, 0xDD, 0x67, 0x75, 0xA6, 0xB4, 0xA4, -+0x08, 0xF4, 0x9E, 0xA2, 0x08, 0xF4, 0x5F, 0xA2, -+0x6E, 0xEA, 0x00, 0x6B, 0x04, 0x2A, 0x65, 0x67, -+0x8E, 0xEB, 0x01, 0x5B, 0x78, 0x67, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0x9D, 0x67, -+0xB6, 0xA4, 0x28, 0xF4, 0x80, 0xA2, 0xAE, 0xEC, -+0x01, 0x5C, 0x98, 0x67, 0x8B, 0xEC, 0x8C, 0xEB, -+0x9D, 0x67, 0xB7, 0xA4, 0x28, 0xF4, 0x81, 0xA2, -+0xAE, 0xEC, 0x5C, 0x2C, 0x01, 0x73, 0x5A, 0x61, -+0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF4, 0xD0, 0x9B, -+0xFF, 0x6D, 0xDE, 0x4C, 0x60, 0xA6, 0xAC, 0xEB, -+0x8C, 0xEB, 0x01, 0x6C, 0x8D, 0xEB, 0xAC, 0xEB, -+0x60, 0xC6, 0xE8, 0xF3, 0x75, 0xA2, 0x8C, 0xEB, -+0xAC, 0xEB, 0x14, 0x2B, 0x69, 0xF0, 0x74, 0xA2, -+0x02, 0x73, 0x0A, 0x60, 0x47, 0x40, 0x09, 0x4A, -+0x29, 0xE2, 0x0B, 0xD2, 0x08, 0x06, 0x20, 0xF0, -+0x06, 0x02, 0x0A, 0xD6, 0x0E, 0xD2, 0x12, 0x10, -+0xE8, 0xF3, 0xD4, 0xA2, 0x08, 0x6B, 0xCC, 0xEB, -+0xAC, 0xEB, 0xF0, 0x2B, 0x10, 0xF0, 0x24, 0x6B, -+0x36, 0xF4, 0x6C, 0x9B, 0x09, 0x6D, 0xA0, 0xC3, -+0x08, 0xF4, 0x61, 0xA2, 0x6D, 0xEC, 0x08, 0xF4, -+0x81, 0xC2, 0x36, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x0B, 0x94, 0xCE, 0xF4, 0x4C, 0x9A, 0x40, 0xEA, -+0x0A, 0x93, 0x0B, 0x94, 0x0E, 0x96, 0x40, 0xC3, -+0x01, 0x4B, 0x01, 0x4C, 0xCA, 0xEB, 0x0B, 0xD4, -+0x0A, 0xD3, 0xF0, 0x61, 0x16, 0x48, 0x05, 0x02, -+0x25, 0xE0, 0x0F, 0xD2, 0x04, 0x00, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, 0x91, 0x67, -+0x01, 0x49, 0x40, 0xEA, 0x0F, 0x93, 0x40, 0xC0, -+0x01, 0x48, 0x6A, 0xE8, 0xF4, 0x61, 0x00, 0x6E, -+0x04, 0x04, 0x08, 0x05, 0xE6, 0x67, 0x80, 0x18, -+0x3F, 0x0F, 0x0E, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF4, 0x70, 0x9A, 0xFF, 0x6C, 0x32, 0x6D, -+0x40, 0xA3, 0xAB, 0xED, 0x8C, 0xEA, 0xAC, 0xEA, -+0x21, 0x6D, 0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, -+0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, 0x13, 0x97, -+0x12, 0x91, 0x11, 0x90, 0x0A, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xE4, 0x67, 0x30, 0xF0, -+0x20, 0x6C, 0xC0, 0xF1, 0x08, 0x4C, 0x89, 0xF0, -+0xB7, 0xA4, 0x04, 0x6B, 0xFF, 0x6A, 0xAC, 0xEB, -+0x4C, 0xEB, 0x4C, 0xEF, 0x07, 0x23, 0x00, 0x6C, -+0xA4, 0x67, 0xC4, 0x67, 0x01, 0x6F, 0x80, 0x18, -+0x3F, 0x0F, 0x09, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x50, 0x9A, 0xC8, 0xF2, 0x9F, 0xA4, -+0x02, 0x6D, 0x08, 0x6E, 0x40, 0xEA, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x6B, -+0x24, 0x67, 0x49, 0xF2, 0x9F, 0xA3, 0x01, 0x6B, -+0xFF, 0x6A, 0x8C, 0xEB, 0x4C, 0xEB, 0x4C, 0xE9, -+0x34, 0x23, 0x30, 0xF0, 0x20, 0x68, 0xCF, 0xF4, -+0x00, 0x48, 0x30, 0xF0, 0x20, 0x6A, 0x6E, 0xF5, -+0x58, 0x9A, 0x80, 0xF2, 0x95, 0xA0, 0x40, 0xEA, -+0x01, 0x72, 0x27, 0x61, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF3, 0x7D, 0xA2, 0x0A, 0x6C, 0x01, 0x4B, -+0x90, 0xF3, 0x7D, 0xC2, 0x90, 0xF3, 0x7D, 0xA2, -+0x8E, 0xEB, 0x07, 0x2B, 0x80, 0xF1, 0x88, 0xA0, -+0x90, 0xF3, 0x7D, 0xC2, 0x01, 0x4C, 0x80, 0xF1, -+0x88, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6B, 0xCF, 0xF4, 0x00, 0x4A, 0x69, 0xF2, -+0x80, 0xA3, 0x80, 0xF1, 0x68, 0xA2, 0x83, 0xEB, -+0x08, 0x61, 0x80, 0xF1, 0x69, 0xA2, 0x05, 0x2B, -+0x80, 0xF1, 0x68, 0xC2, 0x91, 0x67, 0x80, 0x18, -+0x34, 0x10, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x30, 0xF0, 0x20, 0x68, -+0xCE, 0xF4, 0x4C, 0x98, 0x09, 0xD5, 0x24, 0x67, -+0x40, 0xEA, 0x0C, 0x6B, 0x4C, 0xEB, 0x08, 0x73, -+0x5E, 0x61, 0x09, 0x93, 0xCE, 0xF4, 0x4C, 0x98, -+0x86, 0x41, 0x71, 0xE4, 0x40, 0xEA, 0x88, 0x72, -+0x56, 0x61, 0x09, 0x93, 0xCE, 0xF4, 0x4C, 0x98, -+0x87, 0x41, 0x71, 0xE4, 0x40, 0xEA, 0x8E, 0x72, -+0x4E, 0x61, 0x09, 0x93, 0x87, 0x41, 0xCE, 0xF4, -+0x4C, 0x98, 0x02, 0x4C, 0x71, 0xE4, 0x40, 0xEA, -+0x03, 0x72, 0x47, 0x61, 0x09, 0x93, 0x87, 0x41, -+0xCE, 0xF4, 0x4C, 0x98, 0x07, 0x4C, 0x71, 0xE4, -+0x40, 0xEA, 0x08, 0x6B, 0x6C, 0xEA, 0x11, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0xE8, 0xF3, 0x97, 0xA2, 0x01, 0x6B, 0x6C, 0xEC, -+0x34, 0x2C, 0x10, 0xF0, 0x24, 0x6C, 0x36, 0xF4, -+0x8C, 0x9C, 0x60, 0xC4, 0x08, 0xF4, 0x81, 0xA2, -+0x26, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xE8, 0xF3, 0xB3, 0xA2, 0xFF, 0x6C, -+0x6C, 0xED, 0x0E, 0x25, 0x69, 0xF0, 0xB4, 0xA2, -+0x02, 0x75, 0x05, 0x61, 0xE8, 0xF3, 0xB4, 0xA2, -+0xAC, 0xEB, 0x8C, 0xEB, 0x0B, 0x23, 0x09, 0x95, -+0x91, 0x67, 0x00, 0x18, 0x57, 0xD1, 0x15, 0x10, -+0xE8, 0xF3, 0xBA, 0xA2, 0x40, 0x6B, 0xAC, 0xEB, -+0x8C, 0xEB, 0x0F, 0x23, 0x10, 0xF0, 0x24, 0x6B, -+0x36, 0xF4, 0x6C, 0x9B, 0x02, 0x6C, 0x80, 0xC3, -+0x08, 0xF4, 0x81, 0xA2, 0x01, 0x6B, 0x8D, 0xEB, -+0x08, 0xF4, 0x61, 0xC2, 0x02, 0x10, 0x00, 0x6A, -+0x01, 0x10, 0x01, 0x6A, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x4C, 0x9A, -+0xFF, 0x69, 0x04, 0x00, 0x8C, 0xE9, 0x00, 0x6D, -+0x90, 0x67, 0x08, 0x6E, 0x40, 0xEA, 0x01, 0x6A, -+0x2C, 0xEA, 0x12, 0x2A, 0x30, 0xF0, 0x20, 0x6A, -+0x29, 0xF2, 0x7C, 0xA2, 0x30, 0xF0, 0x20, 0x6A, -+0x30, 0xF0, 0x20, 0x6D, 0x0F, 0xF6, 0x71, 0xC2, -+0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF2, 0x50, 0x9A, -+0x90, 0x67, 0x0F, 0xF6, 0x18, 0x4D, 0x3B, 0x10, -+0x30, 0xF0, 0x20, 0x6B, 0x29, 0xF2, 0x7D, 0xA3, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0x40, 0xF1, 0x71, 0xC2, 0x40, 0xF1, 0x50, 0xA2, -+0x01, 0x72, 0x10, 0x60, 0x05, 0x22, 0x02, 0x72, -+0x17, 0x60, 0x03, 0x72, 0x1F, 0x60, 0x29, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6D, -+0x4E, 0xF2, 0x50, 0x9A, 0x90, 0x67, 0x2F, 0xF6, -+0x00, 0x4D, 0x1D, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x30, 0xF0, 0x20, 0x6D, 0x4E, 0xF2, 0x50, 0x9A, -+0x90, 0x67, 0x2F, 0xF6, 0x08, 0x4D, 0x13, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6D, -+0x4E, 0xF2, 0x50, 0x9A, 0x90, 0x67, 0x2F, 0xF6, -+0x10, 0x4D, 0x09, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x30, 0xF0, 0x20, 0x6D, -+0x90, 0x67, 0x2F, 0xF6, 0x18, 0x4D, 0x08, 0x6E, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, -+0x00, 0x4A, 0x40, 0xF1, 0xB1, 0xA2, 0x07, 0x5D, -+0x80, 0xF0, 0x07, 0x60, 0x40, 0xF1, 0x71, 0x82, -+0x01, 0x6A, 0x44, 0xEB, 0x14, 0x6B, 0x4C, 0xEB, -+0x07, 0x2B, 0x62, 0x6B, 0x4C, 0xEB, 0x7D, 0x23, -+0x04, 0x04, 0x00, 0x18, 0x41, 0xD0, 0x03, 0x10, -+0x04, 0x04, 0x00, 0x18, 0x1E, 0xD0, 0x02, 0x67, -+0x63, 0x22, 0x01, 0x6A, 0x2C, 0xEA, 0x13, 0x2A, -+0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6D, -+0x4E, 0xF2, 0x50, 0x9A, 0x0F, 0xF6, 0x18, 0x4D, -+0x85, 0x67, 0xBB, 0x4D, 0x08, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCF, 0xF5, 0x13, 0x4B, -+0x80, 0xF4, 0x0C, 0x6A, 0x34, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x0F, 0xF6, 0x50, 0xA2, 0x01, 0x72, -+0x0F, 0x60, 0x05, 0x22, 0x02, 0x72, 0x15, 0x60, -+0x03, 0x72, 0x1C, 0x60, 0xED, 0x17, 0x30, 0xF0, -+0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6C, 0x4E, 0xF2, -+0x50, 0x9A, 0x2F, 0xF6, 0x00, 0x4C, 0x1A, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, 0x20, 0x6C, -+0x4E, 0xF2, 0x50, 0x9A, 0x2F, 0xF6, 0x08, 0x4C, -+0x11, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x30, 0xF0, -+0x20, 0x6C, 0x4E, 0xF2, 0x50, 0x9A, 0x2F, 0xF6, -+0x10, 0x4C, 0x08, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x4E, 0xF2, 0x50, 0x9A, 0x30, 0xF0, 0x20, 0x6C, -+0x2F, 0xF6, 0x18, 0x4C, 0x30, 0xF0, 0x20, 0x6D, -+0xCF, 0xF5, 0x13, 0x4D, 0xC3, 0x17, 0x1F, 0xF7, -+0x00, 0x6C, 0x4C, 0xEC, 0x02, 0xF0, 0x00, 0x74, -+0x01, 0x60, 0x05, 0x2C, 0x10, 0xF0, 0x24, 0x6C, -+0xD6, 0xF2, 0x88, 0x9C, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF2, 0x8C, 0x9C, 0xA0, 0xA3, -+0x91, 0xE2, 0x01, 0x4A, 0x80, 0xF4, 0x14, 0x72, -+0xA0, 0xC4, 0x01, 0x4B, 0xE8, 0x61, 0x0B, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF4, 0x68, 0x9A, -+0xFF, 0x6C, 0x08, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x50, 0x67, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x01, 0x68, 0x8A, 0x17, 0x00, 0x65, -+0xF7, 0x63, 0x11, 0x62, 0x10, 0xD1, 0x0F, 0xD0, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x30, 0x6A, 0x68, 0xF4, 0x19, 0x4A, -+0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF4, -+0x54, 0x9A, 0x40, 0x9A, 0x05, 0xD2, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF4, 0x50, 0x9A, 0x05, 0x93, -+0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF3, -+0x4C, 0x9A, 0x05, 0xD3, 0xFF, 0x6B, 0x40, 0xA2, -+0x82, 0x67, 0x6C, 0xEC, 0x30, 0xF0, 0x20, 0x6A, -+0x0C, 0xD4, 0xA8, 0xF5, 0x9B, 0xA2, 0x01, 0x6A, -+0x8C, 0xEA, 0x6C, 0xEA, 0x20, 0xF2, 0x04, 0x22, -+0x00, 0x6D, 0x09, 0xD5, 0x08, 0xD5, 0x65, 0x67, -+0x09, 0x12, 0x30, 0xF0, 0x20, 0x69, 0x05, 0x94, -+0xCE, 0xF4, 0x4C, 0x99, 0x02, 0x4C, 0x40, 0xEA, -+0x05, 0x94, 0x02, 0x67, 0xCE, 0xF4, 0x4C, 0x99, -+0x03, 0x4C, 0x40, 0xEA, 0x03, 0x6B, 0x4C, 0xEB, -+0x0F, 0x6A, 0x05, 0x94, 0x0C, 0xEA, 0x18, 0x4B, -+0x4C, 0x32, 0x49, 0xE3, 0x81, 0xE2, 0x0B, 0xD2, -+0xCE, 0xF4, 0x4C, 0x99, 0x90, 0x67, 0x40, 0xEA, -+0x06, 0xD2, 0xCE, 0xF4, 0x4C, 0x99, 0x81, 0x40, -+0x40, 0xEA, 0x07, 0xD2, 0xCE, 0xF4, 0x4C, 0x99, -+0x84, 0x40, 0x40, 0xEA, 0x07, 0x95, 0x06, 0x94, -+0xC2, 0x67, 0x80, 0x18, 0x62, 0x09, 0x07, 0xD2, -+0xCE, 0xF4, 0x4C, 0x99, 0x90, 0x67, 0x40, 0xEA, -+0x05, 0x94, 0xFC, 0x6D, 0x4C, 0xED, 0xCE, 0xF4, -+0x4C, 0x99, 0x06, 0xD5, 0x01, 0x4C, 0x40, 0xEA, -+0x04, 0xD2, 0x05, 0x94, 0xCE, 0xF4, 0x4C, 0x99, -+0x40, 0xEA, 0x04, 0x93, 0x05, 0x94, 0x60, 0x33, -+0x4D, 0xEB, 0xE7, 0xF7, 0x1F, 0x6A, 0x4C, 0xEB, -+0xCE, 0xF4, 0x4C, 0x99, 0x04, 0xD3, 0x0F, 0x4C, -+0x40, 0xEA, 0x0D, 0xD2, 0x04, 0x95, 0x0B, 0x93, -+0x30, 0xF0, 0x20, 0x6A, 0x0E, 0xF5, 0x44, 0x9A, -+0x71, 0xE5, 0x40, 0xEA, 0x0B, 0xD2, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xEB, 0xF6, -+0xB4, 0xA2, 0x01, 0x6B, 0xFF, 0x6C, 0x6C, 0xED, -+0x14, 0x25, 0x06, 0x95, 0x50, 0x75, 0x03, 0x60, -+0x80, 0x75, 0xE0, 0xF0, 0x14, 0x61, 0x89, 0xF0, -+0x50, 0xA2, 0x4C, 0xEB, 0x8C, 0xEB, 0xE0, 0xF0, -+0x0E, 0x23, 0x30, 0xF0, 0x20, 0x6A, 0x4E, 0xF3, -+0x54, 0x9A, 0x04, 0x95, 0x90, 0x67, 0x40, 0xEA, -+0xE6, 0x10, 0x06, 0x92, 0x88, 0x72, 0x30, 0x60, -+0x89, 0x5A, 0x03, 0x60, 0x08, 0x72, 0x2C, 0x60, -+0xDE, 0x10, 0x06, 0x93, 0xA0, 0x73, 0x03, 0x60, -+0xC0, 0x73, 0xC0, 0xF0, 0x18, 0x61, 0x30, 0xF0, -+0x20, 0x69, 0xC0, 0xF1, 0x08, 0x49, 0xE8, 0xF3, -+0x7A, 0xA1, 0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0xFF, 0x6B, 0x6C, 0xEA, 0xC0, 0xF0, 0x0B, 0x22, -+0x08, 0xF4, 0x4E, 0xA1, 0x90, 0x67, 0x01, 0x4A, -+0x08, 0xF4, 0x4E, 0xC1, 0x80, 0x18, 0x57, 0x08, -+0xC0, 0xF0, 0x01, 0x22, 0x90, 0x67, 0x80, 0x18, -+0x6E, 0x08, 0xA0, 0xF0, 0x1C, 0x22, 0x06, 0x94, -+0x80, 0x18, 0xE1, 0x09, 0x08, 0xF4, 0x4F, 0xA1, -+0x01, 0x4A, 0x08, 0xF4, 0x4F, 0xC1, 0xB3, 0x10, -+0x30, 0xF0, 0x20, 0x69, 0xCE, 0xF4, 0x4C, 0x99, -+0x84, 0x40, 0x04, 0xD4, 0x40, 0xEA, 0x82, 0x67, -+0x80, 0x18, 0x53, 0x09, 0x07, 0x95, 0xC2, 0x67, -+0x90, 0x67, 0x80, 0x18, 0xA2, 0x09, 0x04, 0x94, -+0xCE, 0xF4, 0x4C, 0x99, 0x40, 0xEA, 0x82, 0x67, -+0x80, 0x18, 0xA4, 0x10, 0x80, 0xF0, 0x10, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xA8, 0xF5, 0x7B, 0xA2, -+0x40, 0x6A, 0x6C, 0xEA, 0x22, 0x22, 0x07, 0x92, -+0x08, 0x4A, 0x09, 0xE2, 0x04, 0xD2, 0x04, 0x94, -+0xCE, 0xF4, 0x4C, 0x99, 0x40, 0xEA, 0x45, 0x72, -+0x18, 0x61, 0x04, 0x94, 0x00, 0x18, 0x72, 0xD3, -+0x01, 0x72, 0x13, 0x61, 0x04, 0x94, 0x00, 0x18, -+0x84, 0xD3, 0x01, 0x72, 0x0E, 0x61, 0x04, 0x94, -+0x00, 0x18, 0x47, 0xD3, 0x04, 0x22, 0x01, 0x6D, -+0x09, 0xD5, 0x08, 0xD5, 0x06, 0x10, 0x04, 0x94, -+0x00, 0x18, 0x9C, 0xD3, 0x01, 0x6B, 0x09, 0xD3, -+0x08, 0xD3, 0x90, 0x67, 0x80, 0x18, 0x57, 0x08, -+0x08, 0x22, 0x07, 0x95, 0x90, 0x67, 0x80, 0x18, -+0x69, 0x10, 0x03, 0x22, 0x01, 0x6D, 0x09, 0xD5, -+0x08, 0xD5, 0x30, 0xF0, 0x20, 0x6A, 0xA8, 0xF5, -+0x7B, 0xA2, 0x02, 0x6A, 0x6C, 0xEA, 0x08, 0x22, -+0x07, 0x95, 0x90, 0x67, 0x80, 0x18, 0xB4, 0x0F, -+0x03, 0x22, 0x01, 0x6B, 0x09, 0xD3, 0x08, 0xD3, -+0x30, 0xF0, 0x20, 0x6A, 0xA8, 0xF5, 0x7B, 0xA2, -+0x04, 0x6A, 0x6C, 0xEA, 0x08, 0x22, 0x07, 0x95, -+0x90, 0x67, 0x80, 0x18, 0x9C, 0x0E, 0x03, 0x22, -+0x01, 0x6D, 0x09, 0xD5, 0x08, 0xD5, 0x30, 0xF0, -+0x20, 0x69, 0xC0, 0xF1, 0x08, 0x49, 0xE8, 0xF3, -+0x74, 0xA1, 0x20, 0x6A, 0x6C, 0xEA, 0x11, 0x22, -+0x07, 0x95, 0x90, 0x67, 0x80, 0x18, 0x85, 0x08, -+0x0C, 0x22, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, -+0x4C, 0x9A, 0x0B, 0x6B, 0x60, 0xC2, 0x08, 0xF4, -+0x61, 0xA1, 0x01, 0x6A, 0x6D, 0xEA, 0x08, 0xF4, -+0x41, 0xC1, 0x30, 0xF0, 0x20, 0x69, 0xC0, 0xF1, -+0x08, 0x49, 0xE8, 0xF3, 0x73, 0xA1, 0x80, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x22, 0x22, 0x08, 0x93, 0x03, 0x23, 0x01, 0x6C, -+0x08, 0xD4, 0x1D, 0x10, 0x07, 0x95, 0x90, 0x67, -+0x80, 0x18, 0xBB, 0x08, 0x18, 0x22, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, 0x22, 0x6B, -+0x60, 0xC2, 0x08, 0xF4, 0x61, 0xA1, 0x01, 0x6A, -+0x6D, 0xEA, 0x08, 0xF4, 0x41, 0xC1, 0x0B, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF4, 0x68, 0x9A, -+0xFF, 0x6C, 0x08, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x0D, 0x94, -+0x01, 0x6D, 0x80, 0x18, 0xB8, 0x09, 0x15, 0x22, -+0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, -+0x08, 0xF4, 0x81, 0xA2, 0x01, 0x6B, 0x8D, 0xEB, -+0x08, 0xF4, 0x61, 0xC2, 0x05, 0x94, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x4C, 0x9A, 0x10, 0x4C, -+0x40, 0xEA, 0x30, 0xF0, 0x20, 0x6B, 0x0F, 0xF6, -+0x52, 0xC3, 0x06, 0x95, 0x08, 0x75, 0x02, 0x60, -+0x88, 0x75, 0x48, 0x61, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0xE8, 0xF3, 0x95, 0xA2, -+0x40, 0x6B, 0x8C, 0xEB, 0x0E, 0x23, 0x09, 0x93, -+0x0C, 0x2B, 0x10, 0xF0, 0x24, 0x6B, 0x36, 0xF4, -+0x6C, 0x9B, 0x25, 0x6C, 0x80, 0xC3, 0x08, 0xF4, -+0x81, 0xA2, 0x01, 0x6B, 0x8D, 0xEB, 0x08, 0xF4, -+0x61, 0xC2, 0x07, 0x95, 0x90, 0x67, 0x80, 0x18, -+0xC7, 0x08, 0x11, 0x22, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x08, 0xF4, 0x81, 0xA2, -+0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x08, 0xF4, -+0x61, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, -+0x4C, 0x9A, 0x00, 0x6B, 0x60, 0xC2, 0x30, 0xF0, -+0x20, 0x69, 0xC0, 0xF1, 0x08, 0x49, 0xE8, 0xF3, -+0x74, 0xA1, 0x40, 0x6A, 0x6C, 0xEA, 0x12, 0x22, -+0x07, 0x95, 0x90, 0x67, 0x80, 0x18, 0xF5, 0x08, -+0x0D, 0x22, 0x08, 0xF4, 0x61, 0xA1, 0x02, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x08, 0xF4, 0x41, 0xC1, -+0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, 0x4C, 0x9A, -+0x00, 0x6B, 0x60, 0xC2, 0x05, 0x94, 0x0B, 0x95, -+0x30, 0xF0, 0x20, 0x6A, 0xA8, 0xF4, 0x4C, 0x9A, -+0xB1, 0xE4, 0x05, 0xD4, 0x83, 0xEA, 0x03, 0x60, -+0x4F, 0xEA, 0x51, 0xE4, 0x05, 0xD4, 0x30, 0xF0, -+0x20, 0x6A, 0xC8, 0xF5, 0x69, 0xA2, 0x01, 0x6A, -+0x6C, 0xEA, 0x03, 0x22, 0x01, 0x6C, 0x80, 0x18, -+0xA9, 0x0B, 0x80, 0x18, 0xEC, 0x09, 0x01, 0x72, -+0x38, 0x61, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x48, 0x08, 0xF4, 0x50, 0xA0, 0x01, 0x4A, -+0x08, 0xF4, 0x50, 0xC0, 0x30, 0xF0, 0x20, 0x6A, -+0xEE, 0xF4, 0x5C, 0x9A, 0x40, 0xEA, 0x01, 0x72, -+0x15, 0x60, 0x08, 0xF4, 0x81, 0xA0, 0x01, 0x6B, -+0x02, 0x72, 0x8D, 0xEB, 0x08, 0xF4, 0x61, 0xC0, -+0x42, 0x6B, 0x03, 0x60, 0x04, 0x72, 0x06, 0x61, -+0x43, 0x6B, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, -+0x4C, 0x9A, 0x60, 0xC2, 0x01, 0x6C, 0x80, 0x18, -+0xA9, 0x0B, 0x22, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x0E, 0xF5, 0x40, 0x9A, 0x05, 0x94, 0x40, 0xEA, -+0x0A, 0x92, 0x01, 0x4A, 0x0A, 0xD2, 0x0A, 0x93, -+0xFF, 0x6A, 0x4C, 0xEB, 0x0A, 0xD3, 0x0A, 0x94, -+0x0C, 0x95, 0xA3, 0xEC, 0xFF, 0xF5, 0x11, 0x61, -+0x0F, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xE8, 0xF3, 0x95, 0xA2, 0x20, 0x6B, -+0x8C, 0xEB, 0x06, 0x2B, 0xE8, 0xF3, 0x93, 0xA2, -+0xFE, 0x4B, 0x8C, 0xEB, 0xE8, 0xF3, 0x73, 0xC2, -+0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF2, 0x78, 0x9B, -+0x10, 0xF0, 0x30, 0x6A, 0x68, 0xF4, 0x1A, 0x4A, -+0x40, 0xDB, 0x11, 0x97, 0x10, 0x91, 0x0F, 0x90, -+0x09, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0xAC, 0xEB, 0xC0, 0xF1, 0x08, 0x48, -+0x04, 0xD3, 0x89, 0xF0, 0x7E, 0xA0, 0xFF, 0x6A, -+0x8C, 0xEA, 0x01, 0x6C, 0x8C, 0xEB, 0xFF, 0x6C, -+0x8C, 0xEB, 0x5B, 0x23, 0x30, 0xF0, 0x20, 0x69, -+0xCF, 0xF4, 0x00, 0x49, 0x80, 0xF1, 0x6B, 0xA1, -+0x54, 0x23, 0x04, 0x94, 0xA2, 0x67, 0x00, 0x18, -+0x11, 0xE0, 0x07, 0x22, 0x00, 0x6A, 0x80, 0xF1, -+0x4B, 0xC1, 0x01, 0x6A, 0x80, 0xF1, 0x4D, 0xC1, -+0x48, 0x10, 0xA9, 0xF0, 0x60, 0xA0, 0x80, 0xF1, -+0x4B, 0xA1, 0x63, 0xEA, 0x33, 0x61, 0x89, 0xF0, -+0x7E, 0xA0, 0x08, 0x6A, 0x6C, 0xEA, 0xFF, 0x6B, -+0x6C, 0xEA, 0x1B, 0x22, 0x80, 0xF2, 0x95, 0xA1, -+0x00, 0x6D, 0x00, 0x18, 0x62, 0xC5, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF5, 0x54, 0x9A, 0x80, 0xF2, -+0x95, 0xA1, 0x40, 0xEA, 0x89, 0xF0, 0x7E, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, -+0x74, 0xA0, 0x89, 0xF0, 0x5E, 0xC0, 0x80, 0x6A, -+0x4B, 0xEA, 0x6C, 0xEA, 0x68, 0xF3, 0x54, 0xC0, -+0x20, 0x10, 0x10, 0xF0, 0x24, 0x6A, 0x36, 0xF4, -+0x4C, 0x9A, 0x10, 0x6B, 0x01, 0x6C, 0x60, 0xC2, -+0x80, 0x18, 0xA9, 0x0B, 0x89, 0xF0, 0x7E, 0xA0, -+0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x89, 0xF0, -+0x5E, 0xC0, 0x0F, 0x10, 0x30, 0xF0, 0x20, 0x6A, -+0x2E, 0xF4, 0x50, 0x9A, 0xC8, 0xF2, 0x9F, 0xA0, -+0x04, 0x97, 0x02, 0x6D, 0x08, 0x6E, 0x40, 0xEA, -+0x80, 0xF1, 0x4B, 0xA1, 0x01, 0x4A, 0x80, 0xF1, -+0x4B, 0xC1, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0xFF, 0x6A, 0x4C, 0xEC, -+0x30, 0xF0, 0x20, 0x69, 0x04, 0xD4, 0xC0, 0xF1, -+0x08, 0x49, 0x89, 0xF0, 0x7E, 0xA1, 0x01, 0x6C, -+0x6C, 0xEC, 0x4C, 0xEC, 0x75, 0x24, 0x30, 0xF0, -+0x20, 0x68, 0xCF, 0xF4, 0x00, 0x48, 0x80, 0xF1, -+0x8A, 0xA0, 0x01, 0x4C, 0x80, 0xF1, 0x8A, 0xC0, -+0x80, 0xF1, 0x8D, 0xA0, 0x01, 0x74, 0x2F, 0x61, -+0x04, 0x6C, 0x6C, 0xEC, 0x4C, 0xEC, 0x2B, 0x24, -+0x80, 0xF1, 0x8C, 0xA0, 0x28, 0x2C, 0x80, 0xF1, -+0xAA, 0xA0, 0xA9, 0xF0, 0x81, 0xA1, 0x83, 0xED, -+0x22, 0x61, 0x08, 0x6C, 0x6C, 0xEC, 0x4C, 0xEC, -+0x0D, 0x24, 0x80, 0xF2, 0x95, 0xA0, 0x00, 0x6D, -+0x00, 0x18, 0x62, 0xC5, 0x30, 0xF0, 0x20, 0x6A, -+0x6E, 0xF5, 0x54, 0x9A, 0x80, 0xF2, 0x95, 0xA0, -+0x40, 0xEA, 0x09, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF4, 0x4C, 0x9A, 0x10, 0x6B, 0x01, 0x6C, -+0x60, 0xC2, 0x80, 0x18, 0xA9, 0x0B, 0x89, 0xF0, -+0x7E, 0xA1, 0x02, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x89, 0xF0, 0x5E, 0xC1, 0x39, 0x10, 0x30, 0xF0, -+0x20, 0x69, 0x30, 0xF0, 0x20, 0x68, 0xC0, 0xF1, -+0x08, 0x49, 0xCF, 0xF4, 0x00, 0x48, 0x89, 0xF0, -+0x7F, 0xA1, 0x80, 0xF1, 0x4A, 0xA0, 0x63, 0xEA, -+0x2B, 0x61, 0x04, 0x94, 0x00, 0x18, 0xAF, 0xE4, -+0x01, 0x6B, 0x4C, 0xEB, 0x18, 0x2B, 0x80, 0xF1, -+0x4C, 0xA0, 0x15, 0x2A, 0x80, 0xF1, 0x4B, 0xA0, -+0xC8, 0xF2, 0x9F, 0xA1, 0x04, 0x97, 0x01, 0x4A, -+0x80, 0xF1, 0x4B, 0xC0, 0x80, 0xF1, 0x49, 0xA0, -+0x02, 0x6D, 0x08, 0x6E, 0x01, 0x4A, 0x80, 0xF1, -+0x49, 0xC0, 0x30, 0xF0, 0x20, 0x6A, 0x2E, 0xF4, -+0x50, 0x9A, 0x40, 0xEA, 0x04, 0x10, 0x04, 0x94, -+0x01, 0x6D, 0x00, 0x18, 0xA9, 0xE4, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, 0x00, 0x6B, -+0x80, 0xF1, 0x6A, 0xC2, 0x80, 0xF1, 0x6C, 0xC2, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x15, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0xF0, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, 0xFF, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x3F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x3F, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x15, 0xF0, 0xFF, 0xFF, -+0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, 0xFF, -+0xFF, 0x03, 0x00, 0x00, 0x15, 0xF0, 0xFF, 0xFF, -+0x0F, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x24, 0x6B, -+0xF6, 0xF7, 0x64, 0x9B, 0xFF, 0x6A, 0x8C, 0xEA, -+0x60, 0x9B, 0x80, 0xF1, 0x01, 0x6C, 0x8B, 0xEC, -+0x8C, 0xEB, 0x10, 0xF0, 0x24, 0x6C, 0x76, 0xF5, -+0x84, 0x9C, 0x01, 0x72, 0x80, 0x9C, 0x05, 0x60, -+0x02, 0x72, 0x05, 0x61, 0xFF, 0x6A, 0x01, 0x4A, -+0x01, 0x10, 0x80, 0x6A, 0x4D, 0xEB, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF7, 0x44, 0x9A, 0x60, 0xDA, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF7, 0x48, 0x9A, -+0x10, 0xF0, 0x24, 0x6B, 0x76, 0xF5, 0x64, 0x9B, -+0x8C, 0xEA, 0x40, 0xDB, 0x10, 0xF0, 0x24, 0x6B, -+0xF6, 0xF7, 0x6C, 0x9B, 0x50, 0x6A, 0x40, 0xC3, -+0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF7, 0x70, 0x9B, -+0x40, 0xC3, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF7, 0x58, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0x17, 0xF0, 0x80, 0x9C, 0x60, 0xAA, 0xEF, 0xF7, -+0x1F, 0x6A, 0x6C, 0xEA, 0x30, 0xF0, 0x20, 0x6B, -+0x4F, 0xF6, 0x50, 0xCB, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF7, 0x7C, 0x9A, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0x20, 0xE8, 0xFF, 0x6A, 0x4C, 0xEC, -+0x03, 0x6B, 0x8C, 0xEB, 0x4C, 0xEE, 0x3C, 0x2B, -+0x10, 0xF0, 0x24, 0x6B, 0x17, 0xF0, 0x74, 0x9B, -+0x80, 0xC3, 0x0F, 0x6B, 0xCC, 0xEB, 0x34, 0x23, -+0x01, 0x6C, 0x6C, 0xEC, 0x06, 0x24, 0x10, 0xF0, -+0x24, 0x6C, 0x17, 0xF0, 0x98, 0x9C, 0xAC, 0xEA, -+0x40, 0xC4, 0x02, 0x6A, 0x6C, 0xEA, 0x08, 0x22, -+0xFF, 0x6C, 0xA2, 0x32, 0x8C, 0xEA, 0x10, 0xF0, -+0x24, 0x6C, 0x17, 0xF0, 0x9C, 0x9C, 0x40, 0xC4, -+0x04, 0x6A, 0x6C, 0xEA, 0x09, 0x22, 0xA2, 0x32, -+0xFF, 0x6C, 0x42, 0x32, 0x8C, 0xEA, 0x10, 0xF0, -+0x24, 0x6C, 0x37, 0xF0, 0x80, 0x9C, 0x40, 0xC4, -+0x6E, 0x32, 0x07, 0x22, 0x10, 0xF0, 0x24, 0x6A, -+0x37, 0xF0, 0x44, 0x9A, 0x00, 0xF6, 0xA2, 0x35, -+0xA0, 0xC2, 0x20, 0x6A, 0x6D, 0xEA, 0x10, 0xF0, -+0x24, 0x6B, 0x37, 0xF0, 0x68, 0x9B, 0x40, 0xC3, -+0x00, 0x6A, 0x40, 0xC3, 0x01, 0x6A, 0x20, 0xE8, -+0x00, 0x6A, 0x20, 0xE8, 0xFF, 0x6A, 0x8C, 0xEA, -+0x03, 0x6B, 0x4C, 0xEB, 0x03, 0x23, 0x01, 0x6A, -+0x4B, 0xEA, 0x20, 0xE8, 0x10, 0xF0, 0x24, 0x6C, -+0x17, 0xF0, 0x94, 0x9C, 0x40, 0xC4, 0x10, 0xF0, -+0x24, 0x6A, 0x37, 0xF0, 0x88, 0x9A, 0x30, 0x6A, -+0x40, 0xC4, 0x10, 0xF0, 0x24, 0x6A, 0x17, 0xF0, -+0x58, 0x9A, 0x40, 0x9A, 0x60, 0xC4, 0x20, 0xE8, -+0xFD, 0x63, 0x05, 0x62, 0x10, 0xF0, 0x24, 0x6A, -+0x37, 0xF0, 0xAC, 0x9A, 0xE0, 0xF3, 0x10, 0x6C, -+0x0F, 0x6E, 0x80, 0x18, 0x11, 0x13, 0xE0, 0xF3, -+0x0C, 0x6C, 0x80, 0x18, 0x33, 0x13, 0xFF, 0x6B, -+0x4C, 0xEB, 0x0B, 0x73, 0x0B, 0x61, 0x10, 0xF0, -+0x24, 0x6A, 0x37, 0xF0, 0x70, 0x9A, 0x10, 0xF0, -+0x24, 0x6C, 0xD6, 0xF4, 0x9C, 0x9C, 0x40, 0x9B, -+0x8C, 0xEA, 0x40, 0xDB, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x10, 0xF0, 0x24, 0x6B, -+0xFF, 0x6A, 0x56, 0xF3, 0x68, 0x9B, 0x4C, 0xED, -+0x04, 0xD5, 0x60, 0xA3, 0xFF, 0xF7, 0x1F, 0x68, -+0x8C, 0xE8, 0x6C, 0xEA, 0x05, 0xD2, 0x10, 0xF0, -+0x24, 0x6A, 0x36, 0xF3, 0x54, 0x9A, 0x02, 0xF0, -+0x00, 0x6B, 0x40, 0x9A, 0x6C, 0xEA, 0x1F, 0x22, -+0x30, 0xF0, 0x20, 0x69, 0x6E, 0xF2, 0x58, 0x99, -+0x00, 0x6C, 0xFF, 0x6D, 0x49, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF2, 0x40, 0x9A, -+0x40, 0xEA, 0x01, 0x72, 0x19, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0x04, 0x96, 0x6E, 0xF2, 0x5C, 0x9A, -+0x90, 0x67, 0x01, 0x6D, 0x03, 0x6F, 0x40, 0xEA, -+0x6E, 0xF2, 0x58, 0x99, 0x05, 0x95, 0x00, 0x6C, -+0x4A, 0x6E, 0x40, 0xEA, 0x09, 0x10, 0x30, 0xF0, -+0x20, 0x6A, 0x6E, 0xF2, 0x5C, 0x9A, 0x04, 0x96, -+0x90, 0x67, 0x01, 0x6D, 0x03, 0x6F, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0x16, 0xF5, 0x70, 0x9A, -+0xFF, 0x6C, 0x08, 0x6D, 0x40, 0xA3, 0x8C, 0xEA, -+0xAD, 0xEA, 0x8C, 0xEA, 0x40, 0xC3, 0x30, 0xF0, -+0x20, 0x6A, 0x8E, 0xF2, 0x5C, 0x9A, 0x40, 0xEA, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x30, 0xF0, 0x20, 0x6A, -+0xC0, 0xF1, 0x08, 0x4A, 0x05, 0x6B, 0x65, 0xF4, -+0x64, 0xDA, 0x00, 0x6B, 0x65, 0xF4, 0x60, 0xDA, -+0x20, 0xE8, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF2, 0x58, 0x9A, -+0x06, 0xD4, 0x09, 0xD7, 0x07, 0xD5, 0x08, 0xD6, -+0x06, 0x04, 0x40, 0xEA, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x46, 0x67, 0x01, 0x4A, -+0x05, 0x67, 0x0C, 0xD6, 0x27, 0x67, 0x1F, 0x22, -+0x1F, 0xF7, 0x00, 0x6A, 0xAC, 0xEA, 0x02, 0xF0, -+0x00, 0x72, 0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF2, 0x48, 0x9A, 0x04, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xD6, 0xF2, 0x4C, 0x9A, -+0x49, 0xE0, 0x40, 0x9A, 0x0C, 0x94, 0x04, 0xD2, -+0x30, 0xF0, 0x20, 0x6A, 0xAE, 0xF4, 0x50, 0x9A, -+0x40, 0xEA, 0x0C, 0x93, 0x24, 0xEA, 0x6F, 0xEA, -+0x04, 0x93, 0x6C, 0xEA, 0x4D, 0xE9, 0x1F, 0xF7, -+0x00, 0x6A, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x72, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF2, 0x48, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF2, 0x4C, 0x9A, 0x41, 0xE0, -+0x20, 0xD8, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x1F, 0xF7, 0x00, 0x6A, -+0xAC, 0xEA, 0x02, 0xF0, 0x00, 0x72, 0x26, 0x67, -+0x01, 0x60, 0x05, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF2, 0x48, 0x9A, 0x04, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xD6, 0xF2, 0x4C, 0x9A, 0x55, 0xE5, -+0x30, 0xF0, 0x20, 0x6A, 0x00, 0x9D, 0xAE, 0xF4, -+0x50, 0x9A, 0x91, 0x67, 0x2C, 0xE8, 0x40, 0xEA, -+0x06, 0xEA, 0x50, 0x67, 0x07, 0x97, 0x06, 0x91, -+0x05, 0x90, 0x04, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x00, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0x96, 0xF5, 0x64, 0x9B, 0x54, 0x34, -+0x01, 0x4A, 0x71, 0xE4, 0xA0, 0xA4, 0xF8, 0x6B, -+0xAC, 0xEB, 0x60, 0xC4, 0xFF, 0x6B, 0x6C, 0xEA, -+0x80, 0x72, 0xF1, 0x61, 0x80, 0x18, 0x7D, 0x13, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFD, 0x63, 0x05, 0x62, 0x60, 0xA4, 0x30, 0xF0, -+0x20, 0x6A, 0xC0, 0xF1, 0x08, 0x4A, 0xC5, 0xF6, -+0x71, 0xC2, 0x61, 0xA4, 0x65, 0xF4, 0x6A, 0xC2, -+0x62, 0xA4, 0xC5, 0xF6, 0x70, 0xC2, 0xA3, 0xA4, -+0x0F, 0x6B, 0xAC, 0xEB, 0xC5, 0xF6, 0x74, 0xC2, -+0x63, 0xA4, 0x72, 0x33, 0xC5, 0xF6, 0x75, 0xC2, -+0x80, 0x18, 0x29, 0x16, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFD, 0x63, 0x05, 0x62, -+0xFF, 0x6A, 0x8C, 0xEA, 0x4C, 0x72, 0x03, 0x61, -+0x85, 0x67, 0x80, 0x18, 0xCA, 0x13, 0x05, 0x97, -+0x03, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x68, 0xA4, 0x30, 0xF0, 0x20, 0x6A, 0xC0, 0xF1, -+0x08, 0x4A, 0xC5, 0xF6, 0x71, 0xC2, 0x69, 0xA4, -+0x65, 0xF4, 0x6A, 0xC2, 0x6A, 0xA4, 0xC5, 0xF6, -+0x70, 0xC2, 0xAB, 0xA4, 0x0F, 0x6B, 0xAC, 0xEB, -+0xC5, 0xF6, 0x74, 0xC2, 0x6B, 0xA4, 0x72, 0x33, -+0xC5, 0xF6, 0x75, 0xC2, 0x80, 0x18, 0x29, 0x16, -+0x05, 0x97, 0x00, 0x6A, 0x03, 0x63, 0x00, 0xEF, -+0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x8C, 0xEA, -+0x11, 0x72, 0x04, 0x61, 0x85, 0x67, 0x80, 0x18, -+0xDF, 0x13, 0x0C, 0x10, 0x10, 0xF0, 0x24, 0x6A, -+0x36, 0xF3, 0x78, 0x9A, 0x10, 0xF0, 0x24, 0x6C, -+0x56, 0xF3, 0x90, 0x9C, 0x40, 0x9B, 0x8D, 0xEA, -+0x40, 0xDB, 0xFF, 0x6A, 0x05, 0x97, 0x03, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0x01, 0x6A, 0x20, 0xE8, -+0x20, 0xE8, 0x00, 0x65, 0x20, 0xE8, 0x00, 0x65, -+0x20, 0xE8, 0x00, 0x65, 0xFC, 0x63, 0x07, 0x62, -+0x06, 0xD1, 0x05, 0xD0, 0x01, 0x75, 0x1F, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF2, 0x3C, 0x9A, -+0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x41, 0xF1, 0x08, 0x6C, 0x02, 0x6E, -+0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, -+0x41, 0xF1, 0x0C, 0x6C, 0x02, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, 0x34, 0x9A, -+0x21, 0xF4, 0x00, 0x6C, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x00, 0x6E, 0x46, 0x10, 0x02, 0x75, -+0x26, 0x61, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF2, -+0x3C, 0x9A, 0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, -+0x50, 0x98, 0xB1, 0x67, 0x41, 0xF1, 0x08, 0x6C, -+0x02, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xB1, 0x67, 0x41, 0xF1, 0x0C, 0x6C, 0x01, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF3, -+0x34, 0x9A, 0xCE, 0xF4, 0x50, 0x98, 0x21, 0xF4, -+0x00, 0x6C, 0xB1, 0x67, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xE1, 0xF0, 0x10, 0x6C, -+0xB1, 0x67, 0x01, 0x6E, 0x25, 0x10, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF2, 0x3C, 0x9A, 0x30, 0xF0, -+0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, -+0x41, 0xF1, 0x08, 0x6C, 0x02, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0xB1, 0x67, 0x41, 0xF1, -+0x0C, 0x6C, 0x02, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0xF6, 0xF3, 0x34, 0x9A, 0xCE, 0xF4, -+0x50, 0x98, 0x21, 0xF4, 0x00, 0x6C, 0xB1, 0x67, -+0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0xE1, 0xF0, 0x10, 0x6C, 0xB1, 0x67, 0x00, 0x6E, -+0x40, 0xEA, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x04, 0x63, 0x00, 0xEF, 0xFD, 0x63, 0x05, 0x62, -+0x03, 0x25, 0x01, 0x6A, 0x4B, 0xEA, 0x0C, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0xFF, 0x6C, 0x96, 0xF5, -+0xBC, 0x9A, 0xCC, 0xEC, 0x88, 0x34, 0x05, 0xF0, -+0x00, 0x4C, 0xEC, 0xED, 0x00, 0x18, 0x5C, 0xE3, -+0x05, 0x97, 0x03, 0x63, 0x00, 0xEF, 0x00, 0x65, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x0E, 0x90, 0x41, 0x2D, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF5, 0x5C, 0x9A, 0xFF, 0x69, 0xCC, 0xE9, -+0x4C, 0xEF, 0x4A, 0xEF, 0x04, 0xD7, 0x19, 0x60, -+0xD1, 0x67, 0xE2, 0x67, 0x80, 0x18, 0x3B, 0x14, -+0x61, 0x42, 0x31, 0x23, 0x00, 0x6C, 0x64, 0x67, -+0x04, 0x95, 0x01, 0x6E, 0xA6, 0xEC, 0xCC, 0xED, -+0x07, 0x2D, 0x01, 0x4B, 0xFF, 0x6D, 0xAC, 0xEB, -+0x14, 0x73, 0x01, 0x4C, 0xF5, 0x61, 0x14, 0x6B, -+0x04, 0x94, 0x04, 0xEB, 0x8F, 0xEB, 0x4C, 0xEB, -+0x6D, 0xE8, 0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF5, -+0x7C, 0x9A, 0x10, 0xF0, 0x24, 0x6E, 0xB6, 0xF5, -+0xC0, 0x9E, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x0C, 0xEB, 0x00, 0xF5, 0x20, 0x31, -+0x2D, 0xEB, 0x01, 0x6D, 0x81, 0xF4, 0x10, 0x6C, -+0xAB, 0xED, 0x6C, 0xEE, 0x40, 0xEA, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x5C, 0x9A, 0x0D, 0x6C, -+0x40, 0xEA, 0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0x0E, 0xD4, 0x6B, 0xA4, -+0xFF, 0x68, 0xAC, 0xE8, 0x01, 0x6A, 0x60, 0xF1, -+0x0B, 0x2B, 0x30, 0xF0, 0x21, 0x6A, 0xB0, 0xF3, -+0x1C, 0xC2, 0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF5, -+0xFC, 0x9A, 0x00, 0x6D, 0x18, 0x6E, 0x80, 0x18, -+0x3B, 0x14, 0x08, 0xD2, 0x08, 0x93, 0x00, 0x6A, -+0x01, 0x4B, 0x01, 0x23, 0x01, 0x6A, 0x01, 0x6B, -+0x4C, 0xEB, 0x07, 0xD3, 0x0E, 0x93, 0x60, 0xF2, -+0x50, 0xA3, 0x00, 0x6B, 0x06, 0xD3, 0x12, 0x2A, -+0x10, 0xF0, 0x24, 0x6A, 0x0E, 0x94, 0x96, 0xF5, -+0xFC, 0x9A, 0xA3, 0x67, 0xB8, 0x6E, 0x80, 0x18, -+0x3B, 0x14, 0x06, 0xD2, 0x06, 0x93, 0x00, 0x6A, -+0x01, 0x4B, 0x01, 0x23, 0x01, 0x6A, 0x07, 0x93, -+0x4C, 0xEB, 0x07, 0xD3, 0x0F, 0x58, 0x69, 0x60, -+0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF5, 0x24, 0x9A, -+0x08, 0x92, 0x30, 0xF0, 0x20, 0x6B, 0x01, 0xF4, -+0x1C, 0x6C, 0x4C, 0xE9, 0xCE, 0xF4, 0x50, 0x9B, -+0x01, 0xF7, 0x00, 0x6D, 0x00, 0x6E, 0x40, 0xEA, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF4, 0x50, 0x9B, -+0x10, 0xF0, 0x24, 0x6B, 0xB6, 0xF5, 0xA8, 0x9B, -+0x61, 0xF0, 0x00, 0x6C, 0x61, 0xF1, 0x0A, 0x6E, -+0x40, 0xEA, 0x0E, 0x93, 0x0D, 0xE9, 0x60, 0xF2, -+0x50, 0xA3, 0x07, 0x2A, 0x10, 0xF0, 0x24, 0x6A, -+0x06, 0x93, 0x56, 0xF3, 0x58, 0x9A, 0x4D, 0xEB, -+0x06, 0xD3, 0x0E, 0x70, 0x1C, 0x61, 0x30, 0xF0, -+0x20, 0x68, 0xCE, 0xF4, 0x50, 0x98, 0x01, 0x6D, -+0x21, 0xF2, 0x04, 0x6C, 0xAB, 0xED, 0x17, 0xF0, -+0x1C, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x21, 0xF2, 0x08, 0x6C, 0xFF, 0xF7, 0x1F, 0x6D, -+0x00, 0x6E, 0x40, 0xEA, 0x01, 0x6D, 0xCE, 0xF4, -+0x50, 0x98, 0xA1, 0xF2, 0x0C, 0x6C, 0xAB, 0xED, -+0x66, 0xF6, 0x07, 0x6E, 0x20, 0x10, 0x30, 0xF0, -+0x20, 0x68, 0x10, 0xF0, 0x24, 0x6A, 0xCE, 0xF4, -+0x70, 0x98, 0xB6, 0xF5, 0xCC, 0x9A, 0x01, 0x6D, -+0x21, 0xF2, 0x04, 0x6C, 0xAB, 0xED, 0x40, 0xEB, -+0xCE, 0xF4, 0x50, 0x98, 0x21, 0xF2, 0x08, 0x6C, -+0xFF, 0xF7, 0x1F, 0x6D, 0x11, 0xF0, 0x10, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0xB6, 0xF5, 0xD0, 0x9B, 0x01, 0x6D, -+0xA1, 0xF2, 0x0C, 0x6C, 0xAB, 0xED, 0x40, 0xEA, -+0xAE, 0x10, 0x24, 0x58, 0xC0, 0xF0, 0x0F, 0x61, -+0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF5, 0x24, 0x9A, -+0x08, 0x92, 0x68, 0x40, 0xE4, 0x4B, 0x4C, 0xE9, -+0xFF, 0x6A, 0x4C, 0xEB, 0x1D, 0x5B, 0x0D, 0xE9, -+0x12, 0x61, 0x68, 0x40, 0xA4, 0x4B, 0x4C, 0xEB, -+0x29, 0x5B, 0x05, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF3, 0x50, 0x9A, 0x07, 0x10, 0x8D, 0x58, -+0xA0, 0xF0, 0x15, 0x61, 0x10, 0xF0, 0x24, 0x6A, -+0x56, 0xF3, 0x54, 0x9A, 0x4D, 0xE9, 0x68, 0x40, -+0xE4, 0x4B, 0xFF, 0x6A, 0x4C, 0xEB, 0x1D, 0x5B, -+0x0A, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x01, 0xF4, 0x1C, 0x6C, 0x01, 0xF7, -+0x00, 0x6D, 0x01, 0x6E, 0x1B, 0x10, 0x68, 0x40, -+0xA4, 0x4B, 0x4C, 0xEB, 0x2D, 0x5B, 0x0A, 0x60, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, -+0x01, 0xF4, 0x1C, 0x6C, 0x01, 0xF7, 0x00, 0x6D, -+0x02, 0x6E, 0x0C, 0x10, 0x95, 0x58, 0x80, 0xF0, -+0x0E, 0x61, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x50, 0x9A, 0x01, 0xF4, 0x1C, 0x6C, 0x01, 0xF7, -+0x00, 0x6D, 0x03, 0x6E, 0x40, 0xEA, 0x68, 0x40, -+0xE4, 0x4B, 0xFF, 0x6A, 0x4C, 0xEB, 0x0D, 0x5B, -+0x0D, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x9A, 0x61, 0xF0, -+0x00, 0x6C, 0xB6, 0xF5, 0xA8, 0x9B, 0x80, 0xF4, -+0x14, 0x6E, 0x35, 0x10, 0x68, 0x40, 0xD4, 0x4B, -+0x4C, 0xEB, 0x0D, 0x5B, 0x0D, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x9A, 0x61, 0xF0, 0x00, 0x6C, 0xB6, 0xF5, -+0xA8, 0x9B, 0x40, 0xF4, 0x13, 0x6E, 0x23, 0x10, -+0x68, 0x40, 0xA4, 0x4B, 0x4C, 0xEB, 0x11, 0x5B, -+0x0D, 0x60, 0x30, 0xF0, 0x20, 0x6A, 0x10, 0xF0, -+0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x9A, 0x61, 0xF0, -+0x00, 0x6C, 0xB6, 0xF5, 0xA8, 0x9B, 0x40, 0xF4, -+0x12, 0x6E, 0x11, 0x10, 0x68, 0x40, 0x92, 0x4B, -+0x4C, 0xEB, 0x3C, 0x5B, 0x48, 0x60, 0x30, 0xF0, -+0x20, 0x6A, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x9A, 0xB6, 0xF5, 0xA8, 0x9B, 0x61, 0xF0, -+0x00, 0x6C, 0x00, 0xF4, 0x12, 0x6E, 0x40, 0xEA, -+0x0E, 0x93, 0x60, 0xF2, 0x50, 0xA3, 0x13, 0x2A, -+0xC7, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0x13, 0x58, -+0x07, 0x60, 0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF5, -+0x54, 0x9A, 0x06, 0x93, 0x4C, 0xEB, 0x06, 0x10, -+0x10, 0xF0, 0x24, 0x6A, 0x56, 0xF3, 0x58, 0x9A, -+0x06, 0x93, 0x4D, 0xEB, 0x06, 0xD3, 0x10, 0xF0, -+0x24, 0x6A, 0x96, 0xF5, 0x1C, 0x4A, 0x0E, 0x94, -+0xE0, 0x9A, 0x00, 0x6D, 0x18, 0x6E, 0x04, 0xD1, -+0x80, 0x18, 0x46, 0x14, 0x07, 0x90, 0x0E, 0x93, -+0x4C, 0xE8, 0x60, 0xF2, 0x50, 0xA3, 0x0F, 0x2A, -+0x83, 0x67, 0x10, 0xF0, 0x24, 0x6B, 0x96, 0xF5, -+0x1C, 0x4B, 0x06, 0x92, 0xE0, 0x9B, 0x00, 0x6D, -+0xB8, 0x6E, 0x04, 0xD2, 0x80, 0x18, 0x46, 0x14, -+0x4C, 0xE8, 0xFF, 0x6A, 0x4C, 0xE8, 0x0B, 0xE8, -+0xC0, 0xF7, 0x02, 0x32, 0x01, 0x10, 0x00, 0x6A, -+0x0D, 0x97, 0x0C, 0x91, 0x0B, 0x90, 0x07, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFA, 0x63, 0x0B, 0x62, -+0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0x6A, 0xAC, 0xEA, -+0x06, 0xD2, 0x6B, 0xA4, 0x24, 0x67, 0x01, 0x6A, -+0x80, 0xF0, 0x16, 0x2B, 0x10, 0xF0, 0x24, 0x6A, -+0x96, 0xF5, 0xFC, 0x9A, 0x00, 0x6D, 0x18, 0x6E, -+0x80, 0x18, 0x3B, 0x14, 0x07, 0xD2, 0x06, 0x92, -+0x0F, 0x5A, 0x36, 0x60, 0x30, 0xF0, 0x20, 0x68, -+0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF2, 0xB4, 0x9B, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0xF0, 0x08, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, 0x50, 0x98, -+0x40, 0xF4, 0x14, 0x6C, 0x80, 0x6D, 0x00, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0x56, 0xF3, 0xB4, 0x9B, 0x81, 0xF2, -+0x00, 0x6C, 0x00, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x01, 0xF0, 0x14, 0x6C, 0x1F, 0xF4, -+0x00, 0x6D, 0x0F, 0x6E, 0x40, 0xEA, 0x10, 0xF0, -+0x24, 0x6A, 0xB6, 0xF5, 0x18, 0x9A, 0x07, 0x92, -+0x4C, 0xE8, 0x30, 0xF0, 0x21, 0x6A, 0x90, 0xF3, -+0x51, 0xA2, 0x03, 0x22, 0x91, 0x67, 0x00, 0x6D, -+0x38, 0x10, 0x91, 0x67, 0x01, 0x6D, 0x35, 0x10, -+0x06, 0x92, 0x24, 0x5A, 0x50, 0x61, 0x30, 0xF0, -+0x20, 0x68, 0x10, 0xF0, 0x24, 0x6B, 0x56, 0xF3, -+0xB4, 0x9B, 0xCE, 0xF4, 0x50, 0x98, 0x81, 0xF2, -+0x00, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0xCE, 0xF4, -+0x50, 0x98, 0x40, 0xF4, 0x14, 0x6C, 0x80, 0x6D, -+0x01, 0x6E, 0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, -+0xCE, 0xF4, 0x50, 0x98, 0xF6, 0xF2, 0xB4, 0x9B, -+0x01, 0xF0, 0x08, 0x6C, 0x00, 0x6E, 0x40, 0xEA, -+0xCE, 0xF4, 0x50, 0x98, 0x01, 0xF0, 0x14, 0x6C, -+0x1F, 0xF4, 0x00, 0x6D, 0x0F, 0x6E, 0x40, 0xEA, -+0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF5, 0x18, 0x9A, -+0x07, 0x92, 0x91, 0x67, 0x02, 0x6D, 0x4C, 0xE8, -+0x10, 0xF0, 0x24, 0x6A, 0xB6, 0xF5, 0x5C, 0x9A, -+0x4D, 0xE8, 0x00, 0x18, 0x8C, 0xC3, 0x10, 0xF0, -+0x24, 0x6A, 0x96, 0xF5, 0xFC, 0x9A, 0x91, 0x67, -+0x00, 0x6D, 0x18, 0x6E, 0x04, 0xD0, 0x80, 0x18, -+0x46, 0x14, 0x06, 0x95, 0x91, 0x67, 0x02, 0x67, -+0x80, 0x18, 0xFB, 0x13, 0x0C, 0x22, 0x07, 0x92, -+0x00, 0x6C, 0x01, 0x4A, 0x01, 0x22, 0x01, 0x6C, -+0xFF, 0x6B, 0x0C, 0xEB, 0x8C, 0xEB, 0x00, 0x6A, -+0x03, 0x23, 0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x06, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x0A, 0xD4, 0x0C, 0xD6, -+0x6B, 0xA4, 0xFF, 0x68, 0xAC, 0xE8, 0x01, 0x6A, -+0x20, 0xF1, 0x01, 0x2B, 0x06, 0x5E, 0x00, 0xF1, -+0x1D, 0x60, 0x01, 0x76, 0x02, 0x61, 0x03, 0x58, -+0x04, 0x10, 0x0C, 0x93, 0x02, 0x73, 0x03, 0x61, -+0x05, 0x58, 0x00, 0xF1, 0x13, 0x60, 0x0C, 0x93, -+0x30, 0xF0, 0x21, 0x6A, 0x0A, 0x94, 0xB0, 0xF3, -+0x78, 0xDA, 0x10, 0xF0, 0x24, 0x6A, 0x96, 0xF5, -+0xFC, 0x9A, 0x00, 0x6D, 0x18, 0x6E, 0x80, 0x18, -+0x3B, 0x14, 0x22, 0x67, 0x0C, 0x92, 0x06, 0x5A, -+0x08, 0x60, 0x48, 0x33, 0x10, 0xF0, 0x24, 0x6A, -+0x16, 0xF1, 0x00, 0x4A, 0x69, 0xE2, 0x40, 0x9A, -+0x00, 0xEA, 0x51, 0x67, 0xDF, 0x10, 0x01, 0x6D, -+0xA1, 0xF0, 0x0C, 0x6C, 0xAB, 0xED, 0x00, 0x18, -+0x5C, 0xE3, 0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF5, -+0x60, 0x9B, 0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, -+0xF0, 0x98, 0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF5, 0xC4, 0x9A, 0x01, 0x6D, 0xA1, 0xF0, -+0x0C, 0x6C, 0xAB, 0xED, 0x6D, 0xEE, 0x40, 0xEF, -+0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, 0x50, 0x98, -+0xC1, 0xF0, 0x04, 0x6C, 0x16, 0xF3, 0xA0, 0x9B, -+0xB8, 0x10, 0x01, 0x70, 0x09, 0x61, 0x30, 0xF0, -+0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, 0x01, 0xF2, -+0x00, 0x6C, 0x10, 0x6D, 0x01, 0x6E, 0x08, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, 0x50, 0x9A, -+0x01, 0xF2, 0x00, 0x6C, 0x10, 0x6D, 0x00, 0x6E, -+0x40, 0xEA, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x18, 0x5C, 0xE3, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF5, 0xE8, 0x9B, 0x0F, 0x6E, -+0x0C, 0xEE, 0x4C, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF5, 0x4C, 0x9A, 0xC8, 0x36, 0x01, 0x6D, -+0x4D, 0xEE, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x70, 0x9A, 0xED, 0xEE, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x40, 0xEB, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0x16, 0xF3, 0xA0, 0x9B, 0xC1, 0xF0, 0x04, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x01, 0xF4, 0x01, 0x6A, -+0x4B, 0xEA, 0x2C, 0xEA, 0x01, 0xF0, 0x00, 0x6B, -+0x2F, 0x10, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x00, 0x18, 0x5C, 0xE3, 0x10, 0xF0, -+0x24, 0x6B, 0xD6, 0xF5, 0xF0, 0x9B, 0x0F, 0x6E, -+0x0C, 0xEE, 0x4C, 0xEF, 0x10, 0xF0, 0x24, 0x6A, -+0xD6, 0xF5, 0x54, 0x9A, 0xC8, 0x36, 0x01, 0x6D, -+0x4D, 0xEE, 0x30, 0xF0, 0x20, 0x6A, 0xCE, 0xF4, -+0x70, 0x9A, 0xED, 0xEE, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x40, 0xEB, 0x30, 0xF0, 0x20, 0x6B, -+0xCE, 0xF4, 0x50, 0x9B, 0x10, 0xF0, 0x24, 0x6B, -+0x16, 0xF3, 0xA0, 0x9B, 0xC1, 0xF0, 0x04, 0x6C, -+0x01, 0x6E, 0x40, 0xEA, 0x01, 0xF4, 0x01, 0x6A, -+0x4B, 0xEA, 0x2C, 0xEA, 0x00, 0xF4, 0x00, 0x6B, -+0x6D, 0xEA, 0x48, 0x10, 0x01, 0x6D, 0xA1, 0xF0, -+0x0C, 0x6C, 0xAB, 0xED, 0x00, 0x18, 0x5C, 0xE3, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF5, 0x78, 0x9B, -+0x30, 0xF0, 0x20, 0x68, 0x01, 0x6D, 0x4C, 0xEB, -+0x10, 0xF0, 0x24, 0x6A, 0xCE, 0xF4, 0xF0, 0x98, -+0xA1, 0xF0, 0x0C, 0x6C, 0xAB, 0xED, 0xD6, 0xF5, -+0xDC, 0x9A, 0x17, 0x10, 0x01, 0x6D, 0xA1, 0xF0, -+0x0C, 0x6C, 0xAB, 0xED, 0x00, 0x18, 0x5C, 0xE3, -+0x10, 0xF0, 0x24, 0x6B, 0xD6, 0xF5, 0x78, 0x9B, -+0x30, 0xF0, 0x20, 0x68, 0xCE, 0xF4, 0xF0, 0x98, -+0x4C, 0xEB, 0x10, 0xF0, 0x24, 0x6A, 0xF6, 0xF5, -+0xC0, 0x9A, 0x01, 0x6D, 0xA1, 0xF0, 0x0C, 0x6C, -+0xAB, 0xED, 0x6D, 0xEE, 0x40, 0xEF, 0x10, 0xF0, -+0x24, 0x6B, 0x16, 0xF3, 0xA0, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0xC1, 0xF0, 0x04, 0x6C, 0x00, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0xCE, 0xF4, -+0x50, 0x98, 0xF6, 0xF3, 0xB4, 0x9B, 0xC1, 0xF0, -+0x08, 0x6C, 0x01, 0x6E, 0x40, 0xEA, 0x01, 0xF4, -+0x00, 0x6A, 0x2D, 0xEA, 0x04, 0xD2, 0x10, 0xF0, -+0x24, 0x6A, 0x0A, 0x94, 0x96, 0xF5, 0xFC, 0x9A, -+0x00, 0x6D, 0x18, 0x6E, 0x01, 0x49, 0x80, 0x18, -+0x46, 0x14, 0x00, 0x6C, 0x01, 0x21, 0x01, 0x6C, -+0xFF, 0x6B, 0x4C, 0xEB, 0x8C, 0xEB, 0x06, 0x23, -+0x0A, 0x94, 0x0C, 0x95, 0x80, 0x18, 0xFF, 0x13, -+0x01, 0x6A, 0x01, 0x10, 0x00, 0x6A, 0x09, 0x97, -+0x08, 0x91, 0x07, 0x90, 0x05, 0x63, 0x00, 0xEF, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0xFF, 0x68, 0x0C, 0xED, 0x24, 0x67, 0x0D, 0xD7, -+0x04, 0xD5, 0xCC, 0xE8, 0x80, 0x18, 0x2B, 0x15, -+0x0F, 0x22, 0x04, 0x95, 0x91, 0x67, 0x80, 0x18, -+0x6D, 0x14, 0x0A, 0x22, 0x0D, 0x96, 0x91, 0x67, -+0xB0, 0x67, 0x80, 0x18, 0x7F, 0x15, 0x4B, 0xEB, -+0x4D, 0xEB, 0xC0, 0xF7, 0x62, 0x32, 0x01, 0x10, -+0x00, 0x6A, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x05, 0x63, 0x00, 0xEF, 0x30, 0xF0, 0x20, 0x6B, -+0x86, 0xF0, 0x99, 0xA3, 0x30, 0xF0, 0x20, 0x6A, -+0x1F, 0x6B, 0x8C, 0xEB, 0xCF, 0xF4, 0x00, 0x4A, -+0xC0, 0xF6, 0x6C, 0xC2, 0xFF, 0x6D, 0xFF, 0x4B, -+0xAC, 0xEB, 0x00, 0x6C, 0x07, 0x5B, 0xC0, 0xF6, -+0x8F, 0xC2, 0x08, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0x68, 0x33, 0x16, 0xF1, 0x18, 0x4A, 0x69, 0xE2, -+0x40, 0x9A, 0x00, 0xEA, 0x01, 0x6B, 0xC0, 0xF6, -+0x6D, 0xC2, 0xC0, 0xF6, 0x8E, 0xC2, 0x0A, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0x01, 0x6B, 0xC0, 0xF6, 0x6D, 0xC2, 0xC0, 0xF6, -+0x6E, 0xC2, 0x00, 0x6C, 0xC0, 0xF6, 0x91, 0xC2, -+0x38, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, -+0x00, 0x4A, 0x01, 0x6B, 0xC0, 0xF6, 0x6D, 0xC2, -+0x08, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0x01, 0x6B, -+0xCF, 0xF4, 0x00, 0x4A, 0xC0, 0xF6, 0x6D, 0xC2, -+0x00, 0x6B, 0xC0, 0xF6, 0x6E, 0xC2, 0x23, 0x10, -+0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, -+0x01, 0x6C, 0x00, 0x6B, 0xC0, 0xF6, 0x8D, 0xC2, -+0xC0, 0xF6, 0x6E, 0xC2, 0xDF, 0x17, 0x30, 0xF0, -+0x20, 0x6A, 0xCF, 0xF4, 0x00, 0x4A, 0x00, 0x6B, -+0x02, 0x6C, 0xC0, 0xF6, 0x6D, 0xC2, 0xC0, 0xF6, -+0x71, 0xC2, 0xC0, 0xF6, 0x8E, 0xC2, 0x01, 0x6B, -+0x0C, 0x10, 0x30, 0xF0, 0x20, 0x6A, 0xCF, 0xF4, -+0x00, 0x4A, 0x01, 0x6B, 0x00, 0x6C, 0xC0, 0xF6, -+0x6D, 0xC2, 0xC0, 0xF6, 0x8E, 0xC2, 0xC0, 0xF6, -+0x71, 0xC2, 0xC0, 0xF6, 0x70, 0xC2, 0x20, 0xE8, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x30, 0xF0, 0x20, 0x6B, 0xFF, 0x6A, 0xCF, 0xF4, -+0x00, 0x4B, 0x8C, 0xEA, 0xC0, 0xF6, 0x8D, 0xA3, -+0x4F, 0x24, 0xC0, 0xF6, 0x6F, 0xA3, 0x00, 0x69, -+0x01, 0x23, 0x01, 0x69, 0x30, 0xF0, 0x21, 0x6B, -+0x90, 0xF3, 0x70, 0xA3, 0x02, 0x2B, 0x01, 0x6B, -+0x6E, 0xE9, 0x05, 0x2A, 0x3B, 0x10, 0x01, 0x6A, -+0x4E, 0xE9, 0x04, 0xD2, 0x02, 0x10, 0x00, 0x6A, -+0x04, 0xD2, 0x10, 0xF0, 0x24, 0x6B, 0x30, 0xF0, -+0x20, 0x68, 0xF6, 0xF5, 0xA4, 0x9B, 0xCE, 0xF4, -+0x50, 0x98, 0x4C, 0x6C, 0x02, 0x6E, 0x40, 0xEA, -+0x04, 0x93, 0x14, 0x2B, 0xCE, 0xF4, 0x50, 0x98, -+0xA1, 0xF4, 0x14, 0x6C, 0xFF, 0x6D, 0x77, 0x6E, -+0x40, 0xEA, 0x01, 0x59, 0x38, 0x67, 0x10, 0xF0, -+0x24, 0x6B, 0x02, 0x6E, 0xCE, 0xF4, 0x50, 0x98, -+0xA1, 0xF4, 0x14, 0x6C, 0xF6, 0xF2, 0xBC, 0x9B, -+0x3B, 0xE6, 0x12, 0x10, 0xCE, 0xF4, 0x50, 0x98, -+0xA1, 0xF4, 0x14, 0x6C, 0xFF, 0x6D, 0x66, 0x6E, -+0x40, 0xEA, 0x10, 0xF0, 0x24, 0x6B, 0x01, 0x59, -+0xCE, 0xF4, 0x50, 0x98, 0xF6, 0xF2, 0xBC, 0x9B, -+0xD8, 0x67, 0xA1, 0xF4, 0x14, 0x6C, 0x01, 0x4E, -+0x40, 0xEA, 0x06, 0x10, 0x30, 0xF0, 0x21, 0x6A, -+0x90, 0xF3, 0x51, 0xA2, 0xC0, 0x22, 0xC3, 0x17, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x05, 0x63, -+0x00, 0xEF, 0x00, 0x65, 0xFF, 0x6A, 0x4C, 0xEC, -+0x0F, 0x5C, 0x09, 0x60, 0x10, 0xF0, 0x24, 0x6A, -+0xF6, 0xF5, 0x68, 0x9A, 0xFC, 0x6A, 0x80, 0xA3, -+0x8C, 0xEA, 0x40, 0xC3, 0x20, 0xE8, 0x24, 0x5C, -+0x0A, 0x61, 0x10, 0xF0, 0x24, 0x6B, 0xF6, 0xF5, -+0x88, 0x9B, 0x03, 0x6D, 0x60, 0xA4, 0x4C, 0xEB, -+0xAD, 0xEB, 0x4C, 0xEB, 0x60, 0xC4, 0x20, 0xE8, -+0x10, 0xF0, 0x21, 0x6A, 0x84, 0xF4, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x24, 0xF5, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC4, 0xF5, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x24, 0xF6, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x64, 0xF6, 0x04, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE4, 0xF6, 0x00, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0x8E, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xE4, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x40, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x65, 0xF1, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x44, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x45, 0xF2, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x48, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x45, 0xF3, 0x08, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x4C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC5, 0xF5, 0x10, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x50, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA5, 0xF7, 0x14, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x54, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xA5, 0xF7, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x58, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0x06, 0xF1, 0x18, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xAE, 0xF6, 0x5C, 0xDB, -+0x10, 0xF0, 0x21, 0x6A, 0xC6, 0xF1, 0x0C, 0x4A, -+0x30, 0xF0, 0x20, 0x6B, 0xCE, 0xF6, 0x40, 0xDB, -+0x20, 0xE8, 0x00, 0x65, 0x00, 0x00, 0x00, 0x00, -+0xE5, 0x29, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+}; -+ -+u32 array_length_mp_8821c_fw_wowlan = 102608; -+ -+#endif /*CONFIG_WOWLAN*/ -+ -+#endif -+ -+#endif /* end of LOAD_FW_HEADER_FROM_DRIVER */ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/hal8821c_fw.h b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/hal8821c_fw.h -new file mode 100644 -index 000000000..9c5de8132 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/hal8821c_fw.h -@@ -0,0 +1,42 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2012 - 2017 Realtek Corporation. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifdef CONFIG_RTL8821C -+ -+#ifndef _FW_HEADER_8821C_H -+#define _FW_HEADER_8821C_H -+ -+#ifdef LOAD_FW_HEADER_FROM_DRIVER -+#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) -+extern u8 array_mp_8821c_fw_ap[115224]; -+extern u32 array_length_mp_8821c_fw_ap; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+extern u8 array_mp_8821c_fw_nic[137896]; -+extern u32 array_length_mp_8821c_fw_nic; -+extern u8 array_mp_8821c_fw_spic[73056]; -+extern u32 array_length_mp_8821c_fw_spic; -+#ifdef CONFIG_WOWLAN -+extern u8 array_mp_8821c_fw_wowlan[102608]; -+extern u32 array_length_mp_8821c_fw_wowlan; -+#endif /*CONFIG_WOWLAN*/ -+#endif -+#endif /* end of LOAD_FW_HEADER_FROM_DRIVER */ -+ -+#endif -+ -+#endif -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c.h b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c.h -new file mode 100644 -index 000000000..7685758b8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c.h -@@ -0,0 +1,116 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821C_H_ -+#define _RTL8821C_H_ -+ -+#include /* PADAPTER */ -+#include /* CHANNEL_WIDTH */ -+#include /* struct pkt_attrib, struct xmit_frame */ -+#include /* struct recv_frame */ -+#include /* HAL_DEF_VARIABLE */ -+#include -+ -+#define DRIVER_EARLY_INT_TIME_8821C 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8821C 0x02 -+ -+/* rtl8821c_halinit.c */ -+u32 rtl8821c_power_on(PADAPTER); -+void rtl8821c_power_off(PADAPTER); -+u8 rtl8821c_mac_init(PADAPTER); -+u8 rtl8821c_mac_verify(PADAPTER); -+void rtl8821c_hal_init_misc(PADAPTER padapter); -+u32 rtl8821c_hal_init(PADAPTER); -+u32 rtl8821c_hal_deinit(PADAPTER); -+void rtl8821c_init_default_value(PADAPTER); -+u8 rtl8821c_phy_init(PADAPTER adapter); -+u8 rtl8821c_init_phy_parameter_mac(PADAPTER adapter); -+ -+/* rtl8821c_mac.c */ -+#ifdef CONFIG_XMIT_ACK -+u8 rtl8821c_set_mgnt_xmit_ack(_adapter *adapter); -+#endif -+u8 rtl8821c_rx_ba_ssn_appended(PADAPTER); -+u8 rtl8821c_rx_fcs_append_switch(PADAPTER, u8 enable); -+u8 rtl8821c_rx_fcs_appended(PADAPTER); -+u8 rtl8821c_rx_tsf_addr_filter_config(_adapter *adapter, u8 config); -+s32 rtl8821c_fw_dl(PADAPTER, u8 wowlan); -+s32 rtl8821c_fw_mem_dl(PADAPTER adapter, enum fw_mem mem); -+ -+#define BIT_PRETXERR_HANDLE_IMR BIT(31) -+#define BIT_PRETXERR_HANDLE_ISR BIT(31) -+ -+#ifdef CONFIG_AMPDU_PRETX_CD -+#define BIT_PRETXERR BIT(7) -+ -+void rtl8821c_pretx_cd_config(_adapter *adapter); -+#endif -+/* rtl8821c_ops.c */ -+u8 rtl8821c_read_efuse(PADAPTER); -+void rtl8821c_run_thread(PADAPTER); -+void rtl8821c_cancel_thread(PADAPTER); -+u8 rtl8821c_sethwreg(PADAPTER, u8 variable, u8 *pval); -+void rtl8821c_gethwreg(PADAPTER, u8 variable, u8 *pval); -+u8 rtl8821c_sethaldefvar(PADAPTER, HAL_DEF_VARIABLE, void *pval); -+u8 rtl8821c_gethaldefvar(PADAPTER, HAL_DEF_VARIABLE, void *pval); -+void rtl8821c_set_hal_ops(PADAPTER); -+ -+/* tx */ -+void rtl8821c_init_xmit_priv(_adapter *adapter); -+void rtl8821c_fill_txdesc_sectype(struct pkt_attrib *, u8 *ptxdesc); -+void rtl8821c_fill_txdesc_vcs(PADAPTER, struct pkt_attrib *, u8 *ptxdesc); -+void rtl8821c_fill_txdesc_phy(PADAPTER, struct pkt_attrib *, u8 *ptxdesc); -+u8 rtl8821c_bw_mapping(PADAPTER, struct pkt_attrib *); -+u8 rtl8821c_sc_mapping(PADAPTER, struct pkt_attrib *); -+void rtl8821c_cal_txdesc_chksum(PADAPTER, u8 *ptxdesc); -+void rtl8821c_update_txdesc(struct xmit_frame *, u8 *pbuf); -+void rtl8821c_dbg_dump_tx_desc(PADAPTER, int frame_tag, u8 *ptxdesc); -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); -+ -+/* rx */ -+void rtl8821c_rxdesc2attribute(struct rx_pkt_attrib *a, u8 *desc); -+void rtl8821c_query_rx_desc(union recv_frame *, u8 *pdesc); -+ -+/* rtl8821c_cmd.c */ -+s32 rtl8821c_fillh2ccmd(PADAPTER, u8 id, u32 buf_len, u8 *pbuf); -+void _rtl8821c_set_FwPwrMode_cmd(PADAPTER adapter, u8 psmode, u8 rfon_ctrl); -+void rtl8821c_set_FwPwrMode_cmd(PADAPTER adapter, u8 psmode); -+void rtl8821c_set_FwPwrMode_rfon_ctrl_cmd(PADAPTER adapter, u8 rfon_ctrl); -+void rtl8821c_set_FwPwrModeInIPS_cmd(PADAPTER adapter, u8 cmd_param); -+#ifdef CONFIG_WOWLAN -+void rtl8821c_set_fw_pwrmode_inips_cmd_wowlan(PADAPTER padapter, u8 ps_mode); -+#endif /* CONFIG_WOWLAN */ -+void c2h_handler_rtl8821c(_adapter *adapter, u8 *pbuf, u16 length); -+void c2h_pre_handler_rtl8821c(_adapter *adapter, u8 *pbuf, s32 length); -+#ifdef CONFIG_BT_COEXIST -+void rtl8821c_download_BTCoex_AP_mode_rsvd_page(PADAPTER); -+#endif /* CONFIG_BT_COEXIST */ -+ -+/* rtl8821c_phy.c */ -+u32 rtl8821c_read_bb_reg(PADAPTER, u32 addr, u32 mask); -+void rtl8821c_write_bb_reg(PADAPTER, u32 addr, u32 mask, u32 val); -+u32 rtl8821c_read_rf_reg(PADAPTER adapter, enum rf_path path, u32 addr, u32 mask); -+void rtl8821c_write_rf_reg(PADAPTER adapter, enum rf_path path, u32 addr, u32 mask, u32 val); -+void rtl8821c_set_channel_bw(PADAPTER adapter, u8 center_ch, enum channel_width, u8 offset40, u8 offset80); -+void rtl8821c_set_tx_power_level(PADAPTER, u8 channel); -+void rtl8821c_set_tx_power_index(PADAPTER adapter, u32 powerindex, enum rf_path rfpath, u8 rate); -+void rtl8821c_notch_filter_switch(PADAPTER, bool enable); -+#ifdef CONFIG_BEAMFORMING -+void rtl8821c_phy_bf_init(PADAPTER); -+void rtl8821c_phy_bf_enter(PADAPTER, struct sta_info*); -+void rtl8821c_phy_bf_leave(PADAPTER, u8 *addr); -+void rtl8821c_phy_bf_set_gid_table(PADAPTER, struct beamformer_entry*); -+#endif /* CONFIG_BEAMFORMING */ -+#endif /* _RTL8821C_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_cmd.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_cmd.c -new file mode 100644 -index 000000000..2a04ecedb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_cmd.c -@@ -0,0 +1,495 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821C_CMD_C_ -+ -+#include /* HAL_DATA_TYPE */ -+#include "../hal_halmac.h" /* HRTW_HALMAC_H2C_MAX_SIZE, CMD_ID_RSVD_PAGE and etc. */ -+#include "rtl8821c.h" -+ -+/* -+ * Below functions are for C2H -+ */ -+/***************************************** -+ * H2C Msg format : -+ *| 31 - 8 |7-5 | 4 - 0 | -+ *| h2c_msg |Class |CMD_ID | -+ *| 31-0 | -+ *| Ext msg | -+ * -+ ******************************************/ -+s32 rtl8821c_fillh2ccmd(PADAPTER adapter, u8 id, u32 buf_len, u8 *pbuf) -+{ -+ u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0}; -+#ifdef DBG_H2C_CONTENT -+ u8 msg[(RTW_HALMAC_H2C_MAX_SIZE - 1) * 5 + 1] = {0}; -+ u8 *msg_p; -+ u32 msg_size, i, n; -+#endif /* CONFIG_RTW_DEBUG */ -+ int err; -+ s32 ret = _FAIL; -+ -+ -+ if (!pbuf) -+ goto exit; -+ -+ if (buf_len > (RTW_HALMAC_H2C_MAX_SIZE - 1)) -+ goto exit; -+ -+ if (rtw_is_surprise_removed(adapter)) -+ goto exit; -+ -+#ifdef DBG_H2C_CONTENT -+ msg_p = msg; -+ msg_size = (RTW_HALMAC_H2C_MAX_SIZE - 1) * 5 + 1; -+ for (i = 0; i < buf_len; i++) { -+ n = rtw_sprintf(msg_p, msg_size, " 0x%02x", pbuf[i]); -+ msg_p += n; -+ msg_size -= n; -+ if (msg_size == 0) -+ break; -+ } -+ RTW_INFO(FUNC_ADPT_FMT ": id=0x%02x buf=%s\n", -+ FUNC_ADPT_ARG(adapter), id, msg); -+#endif /* CONFIG_RTW_DEBUG */ -+ -+ h2c[0] = id; -+ _rtw_memcpy(h2c + 1, pbuf, buf_len); -+ -+ err = rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c); -+ if (!err) -+ ret = _SUCCESS; -+ -+exit: -+ -+ return ret; -+} -+ -+#define SET_PWR_MODE_SET_BCN_RECEIVING_TIME(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 24, 5, value) -+#define SET_PWR_MODE_SET_ADOPT_BCN_RECEIVING_TIME(h2c_pkt, value) \ -+ SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 31, 1, value) -+ -+void _rtl8821c_set_FwPwrMode_cmd(PADAPTER adapter, u8 psmode, u8 rfon_ctrl) -+{ -+ u8 mode = 0, smart_ps = 0; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+#ifdef CONFIG_BCN_RECV_TIME -+ u8 bcn_recv_time; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+#endif -+#ifdef CONFIG_WMMPS_STA -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+#endif /* CONFIG_WMMPS_STA */ -+ u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0}; -+ u8 PowerState = 0, awake_intvl = 1, rlbm = 0; -+ u8 allQueueUAPSD = 0; -+ char *fw_psmode_str = "UNSPECIFIED"; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+#endif /* CONFIG_P2P */ -+ u8 hw_port = rtw_hal_get_port(adapter); -+ -+ if (pwrpriv->pwr_mode != psmode) { -+ if (pwrpriv->dtim > 0) -+ RTW_INFO(FUNC_ADPT_FMT ": dtim=%d, HW port id=%d\n", FUNC_ADPT_ARG(adapter), -+ pwrpriv->dtim, psmode == PS_MODE_ACTIVE ? pwrpriv->current_lps_hw_port_id : hw_port); -+ else -+ RTW_INFO(FUNC_ADPT_FMT ": HW port id=%d\n", FUNC_ADPT_ARG(adapter), -+ psmode == PS_MODE_ACTIVE ? pwrpriv->current_lps_hw_port_id : hw_port); -+ } -+ -+ smart_ps = pwrpriv->smart_ps; -+ switch (psmode) { -+ case PS_MODE_MIN: -+ case PS_MODE_MAX: -+ { -+#ifdef CONFIG_WMMPS_STA -+ if (rtw_is_wmmps_mode(adapter)) { -+ mode = 2; -+ -+ smart_ps = pwrpriv->wmm_smart_ps; -+ -+ /* (WMMPS) allQueueUAPSD: 0: PSPoll, 1: QosNullData (if wmm_smart_ps=1) or do nothing (if wmm_smart_ps=2) */ -+ if ((pqospriv->uapsd_tid & BIT_MASK_TID_TC) == ALL_TID_TC_SUPPORTED_UAPSD) -+ allQueueUAPSD = 1; -+ } else -+#endif /* CONFIG_WMMPS_STA */ -+ { -+ mode = 1; -+#ifdef CONFIG_WMMPS_STA -+ /* For WMMPS test case, the station must retain sleep mode to capture buffered data on LPS mechanism */ -+ if ((pqospriv->uapsd_tid & BIT_MASK_TID_TC) != 0) -+ smart_ps = 0; -+ else -+#endif /* CONFIG_WMMPS_STA */ -+ { -+ smart_ps = pwrpriv->smart_ps; -+ } -+ } -+ -+ if (psmode == PS_MODE_MIN) -+ rlbm = 0; -+ else -+ rlbm = 1; -+ } -+ break; -+ case PS_MODE_DTIM: -+ { -+ mode = 1; -+ rlbm = 2; -+ -+ /* For WOWLAN LPS, DTIM = (awake_intvl - 1) */ -+ if (pwrpriv->dtim > 0 && pwrpriv->dtim < 16) /* DTIM = (awake_intvl - 1) */ -+ awake_intvl = pwrpriv->dtim + 1; -+ else /* DTIM = 3 */ -+ awake_intvl = 4; -+ } -+ break; -+ case PS_MODE_ACTIVE: -+ default: -+ mode = 0; -+ break; -+ } -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(wdinfo, P2P_STATE_NONE)) { -+ awake_intvl = 2; -+ rlbm = 1; -+ } -+#endif /* CONFIG_P2P */ -+ -+ if (adapter->registrypriv.wifi_spec == 1) { -+ awake_intvl = 2; -+ rlbm = 1; -+ } -+ -+ if (psmode > 0) { -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBtControlLps(adapter) == _TRUE) -+ PowerState = rtw_btcoex_RpwmVal(adapter); -+ else -+#endif /* CONFIG_BT_COEXIST */ -+ { -+ if (rfon_ctrl == rf_on) -+ PowerState = 0x04; /* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ -+ else -+ PowerState = 0x00; /* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ -+ } -+ } else -+ PowerState = 0x0C; /* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ -+ -+ if (pwrpriv->pwr_mode != psmode) { -+ if (mode == 0) -+ fw_psmode_str = "ACTIVE"; -+ else if (mode == 1) -+ fw_psmode_str = "LPS"; -+ else if (mode == 2) -+ fw_psmode_str = "WMMPS"; -+ -+ RTW_INFO(FUNC_ADPT_FMT": fw ps mode = %s, drv ps mode = %d, rlbm = %d ," -+ "smart_ps = %d, allQueueUAPSD = %d, PowerState = %d\n", -+ FUNC_ADPT_ARG(adapter), fw_psmode_str, psmode, rlbm, smart_ps, -+ allQueueUAPSD, PowerState); -+ } -+ -+ SET_PWR_MODE_SET_CMD_ID(h2c, CMD_ID_SET_PWR_MODE); -+ SET_PWR_MODE_SET_CLASS(h2c, CLASS_SET_PWR_MODE); -+ SET_PWR_MODE_SET_MODE(h2c, mode); -+ SET_PWR_MODE_SET_SMART_PS(h2c, smart_ps); -+ SET_PWR_MODE_SET_RLBM(h2c, rlbm); -+ SET_PWR_MODE_SET_AWAKE_INTERVAL(h2c, awake_intvl); -+ SET_PWR_MODE_SET_B_ALL_QUEUE_UAPSD(h2c, allQueueUAPSD); -+ SET_PWR_MODE_SET_PWR_STATE(h2c, PowerState); -+ if (psmode == PS_MODE_ACTIVE) { -+ /* Leave LPS, set the same HW port ID */ -+ SET_PWR_MODE_SET_PORT_ID(h2c, pwrpriv->current_lps_hw_port_id); -+ } else { -+ /* Enter LPS, record HW port ID */ -+ SET_PWR_MODE_SET_PORT_ID(h2c, hw_port); -+ pwrpriv->current_lps_hw_port_id = hw_port; -+ } -+ -+#ifdef CONFIG_BCN_RECV_TIME -+ if (pmlmeext->bcn_rx_time) { -+ bcn_recv_time = pmlmeext->bcn_rx_time / 128; -+ if (pmlmeext->bcn_rx_time % 128) -+ bcn_recv_time += 1; -+ -+ if (bcn_recv_time >= 31) -+ bcn_recv_time = 31; -+ SET_PWR_MODE_SET_ADOPT_BCN_RECEIVING_TIME(h2c, 1); -+ SET_PWR_MODE_SET_BCN_RECEIVING_TIME(h2c, bcn_recv_time); -+ } -+#endif -+ -+ RTW_INFO("%s=> psmode:%02x, smart_ps:%02x, PowerState:%02x\n", __func__, psmode, smart_ps, PowerState); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_RecordPwrMode(adapter, h2c + 1, RTW_HALMAC_H2C_MAX_SIZE - 1); -+#endif /* CONFIG_BT_COEXIST */ -+ -+ RTW_DBG_DUMP("H2C-PwrMode Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE); -+ rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c); -+} -+ -+void rtl8821c_set_FwPwrMode_cmd(PADAPTER adapter, u8 psmode) -+{ -+ return _rtl8821c_set_FwPwrMode_cmd(adapter, psmode, rf_off); -+} -+ -+void rtl8821c_set_FwPwrMode_rfon_ctrl_cmd(PADAPTER adapter, u8 rfon_ctrl) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ -+ return _rtl8821c_set_FwPwrMode_cmd(adapter, pwrpriv->power_mgnt, rfon_ctrl); -+} -+ -+void rtl8821c_set_FwPwrModeInIPS_cmd(PADAPTER adapter, u8 cmd_param) -+{ -+ u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0}; -+ -+ INACTIVE_PS_SET_CMD_ID(h2c, CMD_ID_INACTIVE_PS); -+ INACTIVE_PS_SET_CLASS(h2c, CLASS_INACTIVE_PS); -+ -+ if (cmd_param & BIT0) -+ INACTIVE_PS_SET_ENABLE(h2c, 1); -+ if (cmd_param & BIT1) -+ INACTIVE_PS_SET_IGNORE_PS_CONDITION(h2c, 1); -+ -+ RTW_DBG_DUMP("FW_IPS Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE); -+ rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c); -+} -+ -+#ifdef CONFIG_WOWLAN -+void rtl8821c_set_fw_pwrmode_inips_cmd_wowlan(PADAPTER padapter, u8 ps_mode) -+{ -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ u8 param[H2C_INACTIVE_PS_LEN] = {0}; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ RTW_INFO("%s, ps_mode: %d\n", __func__, ps_mode); -+ if (ps_mode == PS_MODE_ACTIVE) { -+ SET_H2CCMD_INACTIVE_PS_EN(param, 0); -+ } -+ else { -+ SET_H2CCMD_INACTIVE_PS_EN(param, 1); -+ if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && !check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) -+ SET_H2CCMD_INACTIVE_DISBBRF(param, 1); -+ if(registry_par->suspend_type == FW_IPS_WRC) { -+ SET_H2CCMD_INACTIVE_PERIOD_SCAN_EN(param, 1); -+ SET_H2CCMD_INACTIVE_PS_FREQ(param, 3); -+ SET_H2CCMD_INACTIVE_PS_DURATION(param, 1); -+ SET_H2CCMD_INACTIVE_PS_PERIOD_SCAN_TIME(param, 3); -+ } -+ } -+ -+ rtl8821c_fillh2ccmd(padapter, H2C_INACTIVE_PS_, sizeof(param), param); -+} -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_BT_COEXIST -+void rtl8821c_download_BTCoex_AP_mode_rsvd_page(PADAPTER adapter) -+{ -+ rtl8821c_dl_rsvd_page(adapter, RT_MEDIA_CONNECT); -+} -+#endif /* CONFIG_BT_COEXIST */ -+ -+/* -+* Below functions are for C2H -+*/ -+static void c2h_ccx_rpt(PADAPTER adapter, u8 *pdata) -+{ -+#ifdef CONFIG_XMIT_ACK -+ u8 tx_state; -+ -+ tx_state = CCX_RPT_GET_TX_STATE(pdata); -+ -+ /* 0 means success, 1 means retry drop */ -+ if (tx_state == 0) -+ rtw_ack_tx_done(&adapter->xmitpriv, RTW_SCTX_DONE_SUCCESS); -+ else -+ rtw_ack_tx_done(&adapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL); -+#endif /* CONFIG_XMIT_ACK */ -+} -+#ifdef CONFIG_FW_HANDLE_TXBCN -+#define C2H_SUB_CMD_ID_FW_TBTT_RPT 0X23 -+#define TBTT_RPT_GET_SN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X01, 0, 8) -+#define TBTT_RPT_GET_PORT_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8) -+ -+#define TBTT_ROOT 0x00 -+#define TBTT_VAP1 0x10 -+#define TBTT_VAP2 0x20 -+#define TBTT_VAP3 0x30 -+ -+static void c2h_tbtt_rpt(PADAPTER adapter, u8 *pdata) -+{ -+ u8 ap_id, c2h_sn; -+ -+ ap_id = TBTT_RPT_GET_PORT_ID(pdata); -+ c2h_sn = TBTT_RPT_GET_SN(pdata); -+#ifdef DBG_FW_TBTT_RPT -+ if (ap_id == TBTT_ROOT) -+ RTW_INFO("== TBTT ROOT SN:%d==\n", c2h_sn); -+ else if (ap_id == TBTT_VAP1) -+ RTW_INFO("== TBTT_VAP1 SN:%d==\n", c2h_sn); -+ else if (ap_id == TBTT_VAP2) -+ RTW_INFO("== TBTT_VAP2 SN:%d==\n", c2h_sn); -+ else if (ap_id == TBTT_VAP3) -+ RTW_INFO("== TBTT_VAP3 SN:%d==\n", c2h_sn); -+ else -+ RTW_ERR("TBTT RPT INFO ERROR\n"); -+#endif -+} -+#endif -+ -+/** -+* pbuf = RXDESC + c2h packet -+* length = RXDESC_SIZE + c2h packet size -+* c2h format => ID(1B) | SN(1B) | Payload -+* C2H - 0xFF format -+* u8 CMD_ID -+* u8 CMD_SEQ -+* u8 SUB_CMD_ID -+* u8 CMD_LEN -+* u8 *pContent -+*/ -+void c2h_handler_rtl8821c(PADAPTER adapter, u8 *pbuf, u16 length) -+{ -+ u8 c2h_id, c2h_sn; -+ int c2h_len; -+ u8 *pc2h_hdr; -+ u8 *pc2h_data; -+ u8 c2h_sub_cmd_id = 0; -+ u32 desc_size = 0; -+#ifdef CONFIG_WOWLAN -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+#endif /* CONFIG_WOWLAN*/ -+ -+ rtw_halmac_get_rx_desc_size(adapter_to_dvobj(adapter), &desc_size); -+ -+#ifdef CONFIG_WOWLAN -+ if (pwrpriv->wowlan_mode == _TRUE) { -+ RTW_INFO("%s: return because wowolan_mode==TRUE! CMDID=%d\n", -+ __FUNCTION__, C2H_GET_CMD_ID(pbuf + desc_size)); -+ return; -+ } -+#endif /* CONFIG_WOWLAN*/ -+ if (pbuf == NULL) -+ return; -+ -+ if (length < desc_size) { -+ RTW_INFO("%s: [ERROR] c2h length(%d) is smaller than RXDESC_SIZE(%d)!!\n", -+ __func__, length, desc_size); -+ return; -+ } -+ -+ pc2h_hdr = pbuf + desc_size; -+ pc2h_data = pbuf + desc_size + 2; /* cmd ID not 0xFF original C2H have 2 bytes C2H header */ -+ c2h_id = C2H_GET_CMD_ID(pc2h_hdr); -+ c2h_sn = C2H_GET_SEQ(pc2h_hdr); -+ c2h_len = length - desc_size - 2; -+ -+ if (c2h_len < 0) { -+ RTW_ERR("%s: [ERROR] C2H_ID(%02x) C2H_SN(%d) warn c2h_len :%d (length:%d)\n", __func__, c2h_id, c2h_sn, c2h_len, length); -+ rtw_warn_on(1); -+ return; -+ } -+#ifdef DBG_C2H_CONTENT -+ RTW_INFO("%s "ADPT_FMT" C2H, ID=%d seq=%d len=%d\n", __func__, ADPT_ARG(adapter), c2h_id, c2h_sn, length); -+#endif -+ switch (c2h_id) { -+ case CMD_ID_C2H_SND_TXBF: -+ /*C2HTxBeamformingHandler_8821C(adapter, pc2h_data, c2h_len);*/ -+ break; -+ -+ /* FW offload C2H is 0xFF cmd according to halmac function - halmac_parse_c2h_packet */ -+ case 0xFF: -+ /* Get C2H sub cmd ID */ -+ c2h_sub_cmd_id = (u8)C2H_HDR_GET_C2H_SUB_CMD_ID(pc2h_hdr); -+ if (c2h_sub_cmd_id == C2H_SUB_CMD_ID_CCX_RPT) -+ c2h_ccx_rpt(adapter, pbuf + desc_size); -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ else if (c2h_sub_cmd_id == C2H_SUB_CMD_ID_FW_TBTT_RPT) -+ c2h_tbtt_rpt(adapter, pbuf + desc_size); -+ #endif -+ else -+ /* indicate rx desc + c2h pkt to halmac */ -+ if (rtw_halmac_c2h_handle(adapter_to_dvobj(adapter), pbuf, length) == -1) -+ RTW_ERR("%s "ADPT_FMT" C2H, ID=%d, SubID=%d seq=%d len=%d ,HALMAC not to handle\n", -+ __func__, ADPT_ARG(adapter), c2h_id, c2h_sub_cmd_id, c2h_sn, length); -+ break; -+ /* others for c2h common code */ -+ default: -+ /* shift 2 byte to remove cmd id & seq */ -+ c2h_handler(adapter, c2h_id, c2h_sn, c2h_len, pc2h_data); -+ break; -+ } -+} -+ -+ -+static inline u8 is_c2h_id_handle_directly(u8 c2h_id, u8 c2h_sub_cmd_id) -+{ -+ switch (c2h_id) { -+ case CMD_ID_C2H_CCX_RPT: -+ case C2H_IQK_FINISH: -+ case C2H_EXTEND: -+ -+ #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) -+ case C2H_BCN_EARLY_RPT: -+ case C2H_FW_CHNL_SWITCH_COMPLETE: -+ #endif -+ -+ #ifdef CONFIG_BT_COEXIST -+ case C2H_BT_MP_INFO: -+ #endif -+ -+ #ifdef CONFIG_MCC_MODE -+ case C2H_MCC: -+ #endif -+ case C2H_LPS_STATUS_RPT: -+ return _TRUE; -+ default: -+ return _FALSE; -+ } -+ -+} -+ -+/* -+* pbuf = RXDESC + c2h packet -+* length = RXDESC_SIZE + c2h packet size -+*/ -+void c2h_pre_handler_rtl8821c(_adapter *adapter, u8 *pbuf, s32 length) -+{ -+ u8 c2h_id; -+ u8 c2h_sub_cmd_id = 0; -+ u32 desc_size = 0; -+ -+ if ((length <= 0) || (!pbuf)) -+ return; -+ -+ rtw_halmac_get_rx_desc_size(adapter_to_dvobj(adapter), &desc_size); -+ -+ c2h_id = C2H_GET_CMD_ID(pbuf + desc_size); -+ -+ /* Get C2H sub cmd ID */ -+ if (c2h_id == 0xFF) -+ c2h_sub_cmd_id = (u8)C2H_HDR_GET_C2H_SUB_CMD_ID(pbuf + desc_size); -+ -+ if (is_c2h_id_handle_directly(c2h_id, c2h_sub_cmd_id)) -+ c2h_handler_rtl8821c(adapter, pbuf, length); -+ else -+ rtw_c2h_packet_wk_cmd(adapter, pbuf, length); -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_dm.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_dm.c -new file mode 100644 -index 000000000..3511768fb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_dm.c -@@ -0,0 +1,285 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 8821C dynamic mechanism -+ * -+ * -+ * ************************************************************ */ -+#define _RTL8812C_DM_C_ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ -+ */ -+ -+#include -+#include -+ -+/* ************************************************************ -+ * Global var -+ * ************************************************************ */ -+#ifdef CONFIG_SUPPORT_HW_WPS_PBC -+static void dm_CheckPbcGPIO(PADAPTER adapter) -+{ -+ u8 tmp1byte; -+ u8 bPbcPressed = _FALSE; -+ -+ if (!adapter->registrypriv.hw_wps_pbc) -+ return; -+ -+#ifdef CONFIG_USB_HCI -+ tmp1byte = rtw_read8(adapter, GPIO_IO_SEL); -+ tmp1byte |= (HAL_8192C_HW_GPIO_WPS_BIT); -+ rtw_write8(adapter, GPIO_IO_SEL, tmp1byte); /* enable GPIO[2] as output mode */ -+ -+ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT); -+ rtw_write8(adapter, GPIO_IN, tmp1byte); /* reset the floating voltage level */ -+ -+ tmp1byte = rtw_read8(adapter, GPIO_IO_SEL); -+ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT); -+ rtw_write8(adapter, GPIO_IO_SEL, tmp1byte); /* enable GPIO[2] as input mode */ -+ -+ tmp1byte = rtw_read8(adapter, GPIO_IN); -+ if (tmp1byte == 0xff) -+ return; -+ -+ if (tmp1byte & HAL_8192C_HW_GPIO_WPS_BIT) -+ bPbcPressed = _TRUE; -+#else -+ tmp1byte = rtw_read8(adapter, GPIO_IN); -+ -+ if ((tmp1byte == 0xff) || adapter->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(adapter); -+ } -+} -+#endif /* 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. -+ */ -+void dm_InterruptMigration(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal = 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 = hal->bInterruptMigration; -+ bCurrentACIntDisable = hal->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, WIFI_ASOC_STATE) == _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 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 */ -+ hal->bInterruptMigration = IntMtToSet; -+ } else { -+ /* Reset all interrupt migration settings. */ -+ rtw_write32(adapter, REG_INT_MIG, 0); -+ hal->bInterruptMigration = IntMtToSet; -+ } -+ } -+} -+#endif /* CONFIG_PCI_HCI */ -+ -+/* -+ * ============================================================ -+ * functions -+ * ============================================================ -+ */ -+static void init_phydm_cominfo(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ struct dm_struct *pDM_Odm = &hal->odmpriv; -+ -+ Init_ODM_ComInfo(adapter); -+ -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_PACKAGE_TYPE, hal->PackageType); -+ -+ RTW_INFO("%s: Fv=%d Cv=%d\n", __FUNCTION__, hal->version_id.VendorType, hal->version_id.CUTVersion); -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_FAB_VER, hal->version_id.VendorType); -+ odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_CUT_VER, hal->version_id.CUTVersion); -+ -+} -+ -+void rtl8821c_phy_init_dm_priv(PADAPTER adapter) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ -+ init_phydm_cominfo(adapter); -+ odm_init_all_timers(phydm); -+} -+ -+void rtl8821c_phy_deinit_dm_priv(PADAPTER adapter) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ -+ odm_cancel_all_timers(phydm); -+} -+ -+void rtl8821c_phy_init_haldm(PADAPTER adapter) -+{ -+ rtw_phydm_init(adapter); -+} -+ -+static void check_rxfifo_full(PADAPTER adapter) -+{ -+ struct dvobj_priv *psdpriv = adapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct registry_priv *regsty = &adapter->registrypriv; -+ u8 val8 = 0; -+ -+ if (regsty->check_hw_status == 1) { -+ /* switch counter to RX fifo */ -+ val8 = rtw_read8(adapter, REG_RXERR_RPT_8821C + 3); -+ rtw_write8(adapter, REG_RXERR_RPT_8821C + 3, (val8 | 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_8821C); -+ if (pdbgpriv->dbg_rx_fifo_curr_overflow >= pdbgpriv->dbg_rx_fifo_last_overflow) -+ pdbgpriv->dbg_rx_fifo_diff_overflow = -+ pdbgpriv->dbg_rx_fifo_curr_overflow - pdbgpriv->dbg_rx_fifo_last_overflow; -+ else -+ pdbgpriv->dbg_rx_fifo_diff_overflow = -+ (0xFFFF - pdbgpriv->dbg_rx_fifo_last_overflow) -+ + pdbgpriv->dbg_rx_fifo_curr_overflow; -+ -+ } -+} -+ -+ -+void rtl8821c_phy_haldm_watchdog(PADAPTER Adapter) -+{ -+ BOOLEAN bFwCurrentInPSMode = _FALSE; -+ u8 bFwPSAwake = _TRUE; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); -+ u8 in_lps = _FALSE; -+ PADAPTER current_lps_iface = NULL, iface = NULL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); -+ u8 i = 0; -+ -+ if (!rtw_is_hw_init_completed(Adapter)) -+ goto skip_dm; -+ -+#ifdef CONFIG_LPS -+ bFwCurrentInPSMode = pwrpriv->bFwCurrentInPSMode; -+ rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, &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)) { -+ -+ /* check rx fifo */ -+ check_rxfifo_full(Adapter); -+ -+ /* Dynamically switch RTS/CTS protection.*/ -+ } -+ -+#ifdef CONFIG_LPS -+ if (pwrpriv->bLeisurePs && bFwCurrentInPSMode && pwrpriv->pwr_mode != PS_MODE_ACTIVE) { -+ in_lps = _TRUE; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (pwrpriv->current_lps_hw_port_id == rtw_hal_get_port(iface)) { -+ current_lps_iface = iface; -+ rtw_lps_rfon_ctrl(current_lps_iface, rf_on); -+ break; -+ } -+ } -+ -+ if (!current_lps_iface) { -+ RTW_WARN("Can't find a adapter with LPS to enable RFON function !\n"); -+ goto skip_dm; -+ } -+ } -+#endif -+ -+#ifdef CONFIG_BEAMFORMING -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ if (check_fwstate(&Adapter->mlmepriv, WIFI_STATION_STATE) && -+ check_fwstate(&Adapter->mlmepriv, WIFI_ASOC_STATE)) -+ rtw_hal_beamforming_config_csirate(Adapter); -+#endif -+#endif -+ -+#ifdef CONFIG_DISABLE_ODM -+ goto skip_dm; -+#endif -+ -+ rtw_phydm_watchdog(Adapter, in_lps); -+ -+skip_dm: -+ -+#ifdef CONFIG_LPS -+ if (current_lps_iface) -+ rtw_lps_rfon_ctrl(current_lps_iface, rf_off); -+#endif -+#ifdef CONFIG_SUPPORT_HW_WPS_PBC -+ /* Check GPIO to determine current Pbc status.*/ -+ dm_CheckPbcGPIO(Adapter); -+#endif -+ return; -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_halinit.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_halinit.c -new file mode 100644 -index 000000000..ad5fc5ad5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_halinit.c -@@ -0,0 +1,353 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821C_HALINIT_C_ -+ -+#include /* PADAPTER, basic_types.h and etc. */ -+#include /* GET_HAL_SPEC(), HAL_DATA_TYPE */ -+#include "../hal_halmac.h" /* HALMAC API */ -+#include "rtl8821c.h" -+ -+void init_hal_spec_rtl8821c(PADAPTER adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ rtw_halmac_fill_hal_spec(adapter_to_dvobj(adapter), hal_spec); -+ -+ hal_spec->ic_name = "rtl8821c"; -+ hal_spec->macid_num = 128; -+ /* hal_spec->sec_cam_ent_num follow halmac setting */ -+ hal_spec->sec_cap = SEC_CAP_CHK_BMC | SEC_CAP_CHK_EXTRA_SEC; -+ hal_spec->macid_cap = MACID_DROP; -+ -+ hal_spec->rfpath_num_2g = 2; -+ hal_spec->rfpath_num_5g = 1; -+ hal_spec->rf_reg_path_num = hal_spec->rf_reg_path_avail_num = 1; -+ hal_spec->rf_reg_trx_path_bmp = 0x11; -+ hal_spec->max_tx_cnt = 1; -+ -+ hal_spec->tx_nss_num = 1; -+ hal_spec->rx_nss_num = 1; -+ hal_spec->band_cap = BAND_CAP_2G | BAND_CAP_5G; -+ hal_spec->bw_cap = BW_CAP_20M | BW_CAP_40M | BW_CAP_80M; -+ hal_spec->port_num = 5; -+ hal_spec->hci_type = 0; -+ hal_spec->proto_cap = PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N | PROTO_CAP_11AC; -+ -+ hal_spec->txgi_max = 63; -+ hal_spec->txgi_pdbm = 2; -+ -+ hal_spec->wl_func = 0 -+ | WL_FUNC_P2P -+ | WL_FUNC_MIRACAST -+ | WL_FUNC_TDLS -+ ; -+ -+ hal_spec->tx_aclt_unit_factor = 8; -+ -+ hal_spec->rx_tsf_filter = 1; -+ -+ hal_spec->pg_txpwr_saddr = 0x10; -+ hal_spec->pg_txgi_diff_factor = 1; -+ -+ rtw_macid_ctl_init_sleep_reg(adapter_to_macidctl(adapter) -+ , REG_MACID_SLEEP_8821C -+ , REG_MACID_SLEEP1_8821C -+ , REG_MACID_SLEEP2_8821C -+ , REG_MACID_SLEEP3_8821C); -+ -+ rtw_macid_ctl_init_drop_reg(adapter_to_macidctl(adapter) -+ , REG_MACID_DROP0_8821C -+ , REG_MACID_DROP1_8821C -+ , REG_MACID_DROP2_8821C -+ , REG_MACID_DROP3_8821C); -+} -+ -+u32 rtl8821c_power_on(PADAPTER adapter) -+{ -+ struct dvobj_priv *d; -+ PHAL_DATA_TYPE hal; -+ u8 bMacPwrCtrlOn; -+ int err = 0; -+ u8 ret = _SUCCESS; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ -+ bMacPwrCtrlOn = _FALSE; -+ rtw_hal_get_hwreg(adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (bMacPwrCtrlOn == _TRUE) -+ goto out; -+ -+ err = rtw_halmac_poweron(d); -+ -+ #ifdef CONFIG_POWER_STATE_UNEXPECTED_HDL -+ if ((-2) == err) { -+ RTW_ERR("%s:Power ON Fail, Try to power on again !!\n", __FUNCTION__); -+ rtw_halmac_poweroff(d); -+ rtw_msleep_os(2); -+ err = rtw_halmac_poweron(d); -+ } -+ #endif -+ -+ if (err) { -+ RTW_ERR("%s: Power ON Fail!!\n", __FUNCTION__); -+ rtw_warn_on(1); -+ ret = _FAIL; -+ goto out; -+ } -+ -+ bMacPwrCtrlOn = _TRUE; -+ rtw_hal_set_hwreg(adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ -+out: -+ return ret; -+} -+ -+void rtl8821c_power_off(PADAPTER adapter) -+{ -+ struct dvobj_priv *d; -+ u8 bMacPwrCtrlOn; -+ int err = 0; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ -+ bMacPwrCtrlOn = _FALSE; -+ rtw_hal_get_hwreg(adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (bMacPwrCtrlOn == _FALSE) -+ goto out; -+ -+ bMacPwrCtrlOn = _FALSE; -+ rtw_hal_set_hwreg(adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ GET_HAL_DATA(adapter)->bFWReady = _FALSE; -+ -+ err = rtw_halmac_poweroff(d); -+ if (err) { -+ RTW_ERR("%s: Power OFF Fail!!\n", __FUNCTION__); -+ rtw_warn_on(1); -+ goto out; -+ } -+ -+ -+ -+out: -+ return; -+} -+ -+u8 rtl8821c_hal_init_main(PADAPTER adapter) -+{ -+ struct dvobj_priv *d = adapter_to_dvobj(adapter); -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ int err; -+ s32 ret; -+ -+ hal->bFWReady = _FALSE; -+ hal->fw_ractrl = _FALSE; -+ -+#ifdef CONFIG_NO_FW -+ err = rtw_halmac_init_hal(d); -+#else -+ #ifdef CONFIG_FILE_FWIMG -+ rtw_get_phy_file_path(adapter, MAC_FILE_FW_NIC); -+ err = rtw_halmac_init_hal_fw_file(d, rtw_phy_para_file_path); -+ #else -+ err = rtw_halmac_init_hal_fw(d, array_mp_8821c_fw_nic, array_length_mp_8821c_fw_nic); -+ #endif -+ -+ if (!err) { -+ hal->bFWReady = _TRUE; -+ hal->fw_ractrl = _TRUE; -+ } -+ RTW_INFO("FW Version:%d SubVersion:%d\n", hal->firmware_version, hal->firmware_sub_version); -+#endif -+ if (err) { -+ RTW_INFO("%s: fail\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ RTW_INFO("%s: successful\n", __FUNCTION__); -+ -+ return _TRUE; -+} -+ -+u8 rtl8821c_mac_verify(PADAPTER adapter) -+{ -+ struct dvobj_priv *d; -+ int err; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ -+ err = rtw_halmac_self_verify(d); -+ if (err) { -+ RTW_INFO("%s fail\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ RTW_INFO("%s successful\n", __FUNCTION__); -+ return _TRUE; -+} -+ -+void rtl8821c_hal_init_misc(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ u8 drv_info_sz = 0; -+ u32 rcr_bits; -+ /* -+ * Sync driver status and hardware setting -+ */ -+ -+ /* initial security setting */ -+ invalidate_cam_all(adapter); -+ -+ /* enable to rx ps-poll ,disable Control frame filter*/ -+ rtw_write16(adapter, REG_RXFLTMAP1_8821C, 0x0400); -+ /* Accept all data frames */ -+ rtw_write16(adapter, REG_RXFLTMAP2_8821C, 0xFFFF); -+ -+ /* Accept all management frames */ -+ rtw_write16(adapter, REG_RXFLTMAP0_8821C, 0xFFFF); -+ -+ /*RCR setting - Sync driver status with hardware setting */ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr_bits); -+ -+ rcr_bits &= ~(BIT_AICV_8821C | BIT_ACRC32_8821C | BIT_APP_FCS_8821C | BIT_APWRMGT_8821C); -+ -+ rtw_halmac_get_rx_drv_info_sz(adapter_to_dvobj(adapter), &drv_info_sz); -+ if (drv_info_sz) -+ rcr_bits |= BIT_APP_PHYSTS_8821C; -+ -+#ifdef CONFIG_RX_PACKET_APPEND_FCS -+ rcr_bits |= BIT_APP_FCS_8821C; -+#endif -+ -+#ifdef CONFIG_RX_PACKET_APPEND_ICV_ERROR -+ rcr_bits |= BIT_AICV_8821C; -+#endif -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr_bits); -+ -+#ifdef CONFIG_XMIT_ACK -+ rtl8821c_set_mgnt_xmit_ack(adapter); -+#endif /*CONFIG_XMIT_ACK*/ -+ -+ /*Disable BAR, suggested by Scott */ -+ rtw_write32(adapter, REG_BAR_MODE_CTRL_8821C, 0x01ffff|rtw_read8(adapter,REG_RA_TRY_RATE_AGG_LMT_8821C)<<24); -+ /*Disable secondary CCA 20M,40M?*/ -+ rtw_write8(adapter, REG_MISC_CTRL_8821C, 0x03); -+ -+ /*Enable MAC security engine*/ -+ rtw_write16(adapter, REG_CR, (rtw_read16(adapter, REG_CR) | BIT_MAC_SEC_EN)); -+ -+ rtl8821c_rx_tsf_addr_filter_config(adapter, BIT_CHK_TSF_EN_8821C | BIT_CHK_TSF_CBSSID_8821C); -+ -+ /*for 1212 module - 5G RX issue*/ -+ if (hal_data->rfe_type == 2) -+ rtw_write8(adapter, REG_PAD_CTRL1 + 3, 0x36); -+#ifdef CONFIG_AMPDU_PRETX_CD -+ rtl8821c_pretx_cd_config(adapter); -+#endif -+} -+ -+u32 rtl8821c_hal_init(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ if (_FALSE == rtl8821c_hal_init_main(adapter)) -+ return _FAIL; -+ -+ rtl8821c_hal_init_misc(adapter); -+ -+ rtl8821c_phy_init_haldm(adapter); -+#ifdef CONFIG_BEAMFORMING -+ rtl8821c_phy_bf_init(adapter); -+#endif -+ -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ /*HW / FW init*/ -+ rtw_hal_set_default_port_id_cmd(adapter, 0); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ /* Init BT hw config. */ -+ if (_TRUE == hal->EEPROMBluetoothCoexist) { -+ rtw_btcoex_HAL_Initialize(adapter, _FALSE); -+ #ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ rtw_hal_set_wifi_btc_port_id_cmd(adapter); -+ #endif -+ } else -+#endif /* CONFIG_BT_COEXIST */ -+ rtw_btcoex_wifionly_hw_config(adapter); -+ -+ return _SUCCESS; -+} -+ -+u32 rtl8821c_hal_deinit(PADAPTER adapter) -+{ -+ struct dvobj_priv *d; -+ PHAL_DATA_TYPE hal; -+ int err; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ hal = GET_HAL_DATA(adapter); -+ -+ hal->bFWReady = _FALSE; -+ hal->fw_ractrl = _FALSE; -+ -+ err = rtw_halmac_deinit_hal(d); -+ if (err) -+ return _FAIL; -+ -+ return _SUCCESS; -+} -+ -+void rtl8821c_init_default_value(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ u8 i; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ -+ /* init default value */ -+ hal->fw_ractrl = _FALSE; -+ -+ /* init phydm default value */ -+ hal->bIQKInitialized = _FALSE; -+ -+ /* init Efuse variables */ -+ hal->EfuseUsedBytes = 0; -+ hal->EfuseUsedPercentage = 0; -+#ifdef HAL_EFUSE_MEMORY -+ hal->EfuseHal.fakeEfuseBank = 0; -+ hal->EfuseHal.fakeEfuseUsedBytes = 0; -+ _rtw_memset(hal->EfuseHal.fakeEfuseContent, 0xFF, EFUSE_MAX_HW_SIZE); -+ _rtw_memset(hal->EfuseHal.fakeEfuseInitMap, 0xFF, EFUSE_MAX_MAP_LEN); -+ _rtw_memset(hal->EfuseHal.fakeEfuseModifiedMap, 0xFF, EFUSE_MAX_MAP_LEN); -+ hal->EfuseHal.BTEfuseUsedBytes = 0; -+ hal->EfuseHal.BTEfuseUsedPercentage = 0; -+ _rtw_memset(hal->EfuseHal.BTEfuseContent, 0xFF, EFUSE_MAX_BT_BANK * EFUSE_MAX_HW_SIZE); -+ _rtw_memset(hal->EfuseHal.BTEfuseInitMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+ _rtw_memset(hal->EfuseHal.BTEfuseModifiedMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+ hal->EfuseHal.fakeBTEfuseUsedBytes = 0; -+ _rtw_memset(hal->EfuseHal.fakeBTEfuseContent, 0xFF, EFUSE_MAX_BT_BANK * EFUSE_MAX_HW_SIZE); -+ _rtw_memset(hal->EfuseHal.fakeBTEfuseInitMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+ _rtw_memset(hal->EfuseHal.fakeBTEfuseModifiedMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_mac.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_mac.c -new file mode 100644 -index 000000000..f21fe1077 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_mac.c -@@ -0,0 +1,182 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821C_MAC_C_ -+ -+#include /* PADAPTER, basic_types.h and etc. */ -+#include /* HAL_DATA_TYPE */ -+#include "../hal_halmac.h" /* Register Definition and etc. */ -+ -+#ifdef CONFIG_XMIT_ACK -+inline u8 rtl8821c_set_mgnt_xmit_ack(_adapter *adapter) -+{ -+ int err; -+ -+ /*ack for xmit mgmt frames.*/ -+ err = rtw_write32(adapter, REG_FWHW_TXQ_CTRL_8821C, rtw_read32(adapter, REG_FWHW_TXQ_CTRL_8821C) | BIT(12)); -+ if (err == _FAIL) -+ return _FAIL; -+ -+ return _SUCCESS; -+} -+#endif -+ -+inline u8 rtl8821c_rx_ba_ssn_appended(PADAPTER p) -+{ -+ return rtw_hal_rcr_check(p, BIT_APP_BASSN_8821C); -+} -+ -+inline u8 rtl8821c_rx_fcs_append_switch(PADAPTER p, u8 enable) -+{ -+ u32 rcr_bit; -+ u8 ret = _TRUE; -+ -+ rcr_bit = BIT_APP_FCS_8821C; -+ if (_TRUE == enable) -+ ret = rtw_hal_rcr_add(p, rcr_bit); -+ else -+ ret = rtw_hal_rcr_clear(p, rcr_bit); -+ -+ return ret; -+} -+ -+inline u8 rtl8821c_rx_fcs_appended(PADAPTER p) -+{ -+ return rtw_hal_rcr_check(p, BIT_APP_FCS_8821C); -+} -+ -+u8 rtl8821c_rx_tsf_addr_filter_config(_adapter *adapter, u8 config) -+{ -+ u8 v8; -+ int err; -+ -+ v8 = GET_HAL_DATA(adapter)->rx_tsf_addr_filter_config; -+ -+ if (v8 != config) { -+ -+ err = rtw_write8(adapter, REG_NAN_RX_TSF_FILTER_8821C, config); -+ if (_FAIL == err) -+ return _FALSE; -+ } -+ -+ GET_HAL_DATA(adapter)->rx_tsf_addr_filter_config = config; -+ return _TRUE; -+} -+ -+/* -+ * Return: -+ * _SUCCESS Download Firmware OK. -+ * _FAIL Download Firmware FAIL! -+ */ -+s32 rtl8821c_fw_dl(PADAPTER adapter, u8 wowlan) -+{ -+ struct dvobj_priv *d = adapter_to_dvobj(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int err; -+ u8 fw_bin = _TRUE; -+ -+#ifdef CONFIG_FILE_FWIMG -+ fw_bin = _TRUE; -+ if (_TRUE == wowlan) { -+ rtw_get_phy_file_path(adapter, MAC_FILE_FW_WW_IMG); -+ err = rtw_halmac_dlfw_from_file(d, rtw_phy_para_file_path); -+ } else { -+ rtw_get_phy_file_path(adapter, MAC_FILE_FW_NIC); -+ err = rtw_halmac_dlfw_from_file(d, rtw_phy_para_file_path); -+ } -+#else -+ fw_bin = _FALSE; -+ #ifdef CONFIG_WOWLAN -+ if (_TRUE == wowlan) -+ err = rtw_halmac_dlfw(d, array_mp_8821c_fw_wowlan, array_length_mp_8821c_fw_wowlan); -+ else -+ #endif -+ err = rtw_halmac_dlfw(d, array_mp_8821c_fw_nic, array_length_mp_8821c_fw_nic); -+#endif -+ -+ if (!err) { -+ hal_data->bFWReady = _TRUE; -+ hal_data->fw_ractrl = _TRUE; -+ RTW_INFO("%s Download Firmware from %s success\n", __func__, (fw_bin) ? "file" : "array"); -+ RTW_INFO("%s FW Version:%d SubVersion:%d\n", (wowlan) ? "WOW" : "NIC", hal_data->firmware_version, hal_data->firmware_sub_version); -+ -+ return _SUCCESS; -+ } else { -+ RTW_ERR("%s Download Firmware from %s failed\n", __func__, (fw_bin) ? "file" : "array"); -+ return _FAIL; -+ } -+} -+/* -+ * Return: -+ * _SUCCESS Download Firmware MEM OK. -+ * _FAIL Download Firmware MEM FAIL! -+ */ -+s32 rtl8821c_fw_mem_dl(PADAPTER adapter, enum fw_mem mem) -+{ -+ struct dvobj_priv *d = adapter_to_dvobj(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int err = 0; -+ u8 fw_bin = _TRUE; -+ -+#ifdef CONFIG_FILE_FWIMG -+ fw_bin = _TRUE; -+ rtw_get_phy_file_path(adapter, MAC_FILE_FW_NIC); -+ err = rtw_halmac_dlfw_mem_from_file(d, rtw_phy_para_file_path, mem); -+#else -+ fw_bin = _FALSE; -+ err = rtw_halmac_dlfw_mem(d, array_mp_8821c_fw_nic, array_length_mp_8821c_fw_nic, mem); -+#endif -+ -+ if (err) { -+ RTW_ERR("%s Download Firmware MEM from %s failed\n", __func__, (fw_bin) ? "file" : "array"); -+ return _FAIL; -+ } -+ -+ RTW_INFO("%s Download Firmware MEM from %s success\n", __func__, (fw_bin) ? "file" : "array"); -+ return _SUCCESS; -+ -+} -+#ifdef CONFIG_AMPDU_PRETX_CD -+#include "rtl8821c.h" -+#define AMPDU_NUMBER 0x3F3F /*MAX AMPDU Number = 63*/ -+#define REG_PRECNT_CTRL_8821C 0x04E5 -+#define BIT_EN_PRECNT_8821C BIT(11) -+#define PRECNT_TH 0x1E4 /*6.05us*/ -+ -+/* pre-tx count-down mechanism */ -+void rtl8821c_pretx_cd_config(_adapter *adapter) -+{ -+ u8 burst_mode; -+ u16 pre_cnt = PRECNT_TH | BIT_EN_PRECNT_8821C; -+ -+ /*Enable AMPDU PRE-TX, Reg0x4BC[6] = 1*/ -+ burst_mode = rtw_read8(adapter, REG_SW_AMPDU_BURST_MODE_CTRL_8821C); -+ if (!(burst_mode & BIT_PRE_TX_CMD_8821C)) { -+ burst_mode |= BIT_PRE_TX_CMD_8821C; -+ rtw_write8(adapter, REG_SW_AMPDU_BURST_MODE_CTRL_8821C, burst_mode); -+ } -+ -+ /*MAX AMPDU Number = 63, Reg0x4C8[21:16] = 0x3F*/ -+ rtw_write16(adapter, REG_PROT_MODE_CTRL_8821C + 2, AMPDU_NUMBER); -+ -+ /*Reg0x4E5[11] = 1, Reg0x4E5[10:0] = 0x1E4 */ -+ rtw_write8(adapter, REG_PRECNT_CTRL_8821C, (u8)(pre_cnt & 0xFF)); -+ rtw_write8(adapter, (REG_PRECNT_CTRL_8821C + 1), (u8)(pre_cnt >> 8)); -+ -+ #if (defined(DBG_PRE_TX_HANG) && (defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI))) -+ rtw_write32(adapter, REG_HIMR1_8821C , -+ (rtw_read32(adapter, REG_HIMR1_8821C) | BIT_PRETXERR_HANDLE_IMR)); -+ #endif -+} -+#endif /*CONFIG_AMPDU_PRETX_CD*/ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_ops.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_ops.c -new file mode 100755 -index 000000000..e93d84356 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_ops.c -@@ -0,0 +1,3678 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821C_OPS_C_ -+ -+#include /* basic_types.h, rtw_io.h and etc. */ -+#include /* struct xmit_priv */ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ #include -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+#include /* PHAL_DATA_TYPE, GET_HAL_DATA() */ -+#include /* dump_chip_info() and etc. */ -+#include "../hal_halmac.h" /* GET_RX_DESC_XXX_8821C() */ -+#include "rtl8821c.h" -+#ifdef CONFIG_PCI_HCI -+ #include "rtl8821ce_hal.h" -+#endif -+#include "rtl8821c_dm.h" -+#ifdef CONFIG_SDIO_HCI -+#include "sdio/rtl8821cs.h" -+#endif -+ -+static void read_chip_version(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ u32 value32; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ value32 = rtw_read32(adapter, REG_SYS_CFG1_8821C); -+ hal->version_id.ICType = CHIP_8821C; -+ hal->version_id.ChipType = ((value32 & BIT_RTL_ID_8821C) ? TEST_CHIP : NORMAL_CHIP); -+ hal->version_id.CUTVersion = BIT_GET_CHIP_VER_8821C(value32); -+ hal->version_id.VendorType = BIT_GET_VENDOR_ID_8821C(value32); -+ hal->version_id.VendorType >>= 2; -+ switch (hal->version_id.VendorType) { -+ case 0: -+ hal->version_id.VendorType = CHIP_VENDOR_TSMC; -+ break; -+ case 1: -+ hal->version_id.VendorType = CHIP_VENDOR_SMIC; -+ break; -+ case 2: -+ hal->version_id.VendorType = CHIP_VENDOR_UMC; -+ break; -+ } -+ hal->version_id.RFType = ((value32 & BIT_RF_TYPE_ID_8821C) ? RF_TYPE_2T2R : RF_TYPE_1T1R); -+ hal->RegulatorMode = ((value32 & BIT_SPSLDO_SEL_8821C) ? RT_LDO_REGULATOR : RT_SWITCHING_REGULATOR); -+ -+ value32 = rtw_read32(adapter, REG_SYS_STATUS1_8821C); -+ hal->version_id.ROMVer = BIT_GET_RF_RL_ID_8821C(value32); -+ -+ /* For multi-function consideration. */ -+ hal->MultiFunc = RT_MULTI_FUNC_NONE; -+ value32 = rtw_read32(adapter, REG_WL_BT_PWR_CTRL_8821C); -+ hal->MultiFunc |= ((value32 & BIT_WL_FUNC_EN_8821C) ? RT_MULTI_FUNC_WIFI : 0); -+ hal->MultiFunc |= ((value32 & BIT_BT_FUNC_EN_8821C) ? RT_MULTI_FUNC_BT : 0); -+ hal->PolarityCtl = ((value32 & BIT_WL_HWPDN_SL_8821C) ? RT_POLARITY_HIGH_ACT : RT_POLARITY_LOW_ACT); -+ -+ dump_chip_info(hal->version_id); -+} -+ -+/* -+ * Return: -+ * _TRUE valid ID -+ * _FALSE invalid ID -+ */ -+static u8 Hal_EfuseParseIDCode(PADAPTER adapter, u8 *map) -+{ -+ u16 EEPROMId; -+ -+ -+ /* Check 0x8129 again for making sure autoload status!! */ -+ EEPROMId = le16_to_cpu(*(u16 *)map); -+ RTW_INFO("EEPROM ID = 0x%04x\n", EEPROMId); -+ if (EEPROMId == RTL_EEPROM_ID) -+ return _TRUE; -+ -+ RTW_INFO(" EEPROM ID is invalid!!\n"); -+ return _FALSE; -+} -+ -+static void Hal_EfuseParseEEPROMVer(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ -+ if (_TRUE == mapvalid) -+ hal->EEPROMVersion = map[EEPROM_VERSION_8821C]; -+ else -+ hal->EEPROMVersion = 1; -+ -+ RTW_INFO("EEPROM Version = %d\n", hal->EEPROMVersion); -+} -+ -+static void Hal_EfuseParseTxPowerInfo(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ hal->txpwr_pg_mode = TXPWR_PG_WITH_PWR_IDX; -+ -+ if ((_TRUE == mapvalid) && (map[EEPROM_RF_BOARD_OPTION_8821C] != 0xFF)) -+ hal->EEPROMRegulatory = map[EEPROM_RF_BOARD_OPTION_8821C] & 0x7; /* bit0~2 */ -+ else -+ hal->EEPROMRegulatory = EEPROM_DEFAULT_BOARD_OPTION & 0x7; /* bit0~2 */ -+ RTW_INFO("EEPROM Regulatory=0x%02x\n", hal->EEPROMRegulatory); -+} -+ -+static void Hal_EfuseParseBoardType(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ -+ if ((_TRUE == mapvalid) && (map[EEPROM_RF_BOARD_OPTION_8821C] != 0xFF)) -+ hal->InterfaceSel = (map[EEPROM_RF_BOARD_OPTION_8821C] & 0xE0) >> 5; -+ else -+ hal->InterfaceSel = (EEPROM_DEFAULT_BOARD_OPTION & 0xE0) >> 5; -+ -+ RTW_INFO("EEPROM Board Type=0x%02x\n", hal->InterfaceSel); -+} -+ -+static void Hal_EfuseParseBTCoexistInfo(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ u8 setting; -+ u32 tmpu4; -+ u32 tmp_u32; -+ -+ if ((mapvalid == _TRUE) && (map[EEPROM_RF_BOARD_OPTION_8821C] != 0xFF)) { -+ -+ tmp_u32 = rtw_read32(adapter, REG_WL_BT_PWR_CTRL_8821C); -+ /* 0xc1[7:5] = 0x01 (Combo card) */ -+ if ((((map[EEPROM_RF_BOARD_OPTION_8821C] & 0xe0) >> 5) == 0x01) && (tmp_u32 & BIT_BT_FUNC_EN_8821C)) -+ hal->EEPROMBluetoothCoexist = _TRUE; -+ else -+ hal->EEPROMBluetoothCoexist = _FALSE; -+ } else -+ hal->EEPROMBluetoothCoexist = _FALSE; -+ -+ hal->EEPROMBluetoothType = BT_RTL8821C; -+ -+ setting = map[EEPROM_RF_BT_SETTING_8821C]; -+ if ((_TRUE == mapvalid) && (setting != 0xFF)) { -+ /* Bit[0]: Total antenna number -+ * 0: 2-Antenna (WL BT not share Ant, concurrent mode) -+ * 1: 1-Antenna (WL BT share Ant, TDMA mode) -+ */ -+ hal->EEPROMBluetoothAntNum = setting & BIT(0); -+ /* -+ * Bit[6]: One-Ant structure use Ant2(aux.) path or Ant1(main) path -+ * 0: Ant2(aux.) -+ * 1: Ant1(main), default -+ */ -+ hal->ant_path = (setting & BIT(6)) ? RF_PATH_B : RF_PATH_A; -+ } else { -+ hal->EEPROMBluetoothAntNum = Ant_x1; -+ hal->ant_path = RF_PATH_A; -+ } -+ -+ RTW_INFO("EEPROM %s BT-coex, ant_num=%d\n", -+ hal->EEPROMBluetoothCoexist == _TRUE ? "Enable" : "Disable", -+ hal->EEPROMBluetoothAntNum == Ant_x2 ? 2 : 1); -+} -+ -+static void Hal_EfuseParseChnlPlan(PADAPTER adapter, u8 *map, u8 autoloadfail) -+{ -+ hal_com_config_channel_plan( -+ adapter, -+ map ? &map[EEPROM_COUNTRY_CODE_8821C] : NULL, -+ map ? map[EEPROM_CHANNEL_PLAN_8821C] : 0xFF, -+ RTW_CHPLAN_6G_NULL, -+ autoloadfail -+ ); -+} -+ -+static void Hal_EfuseParseXtal(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ -+ if ((_TRUE == mapvalid) && map[EEPROM_XTAL_8821C] != 0xFF) -+ hal->crystal_cap = map[EEPROM_XTAL_8821C]; -+ else -+ hal->crystal_cap = EEPROM_Default_CrystalCap; -+ -+ RTW_INFO("EEPROM crystal_cap=0x%02x\n", hal->crystal_cap); -+} -+ -+static void Hal_EfuseParseThermalMeter(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ -+ /* ThermalMeter from EEPROM */ -+ if ((_TRUE == mapvalid) && (map[EEPROM_THERMAL_METER_8821C] != 0xFF)) -+ hal->eeprom_thermal_meter = map[EEPROM_THERMAL_METER_8821C]; -+ else { -+ hal->eeprom_thermal_meter = EEPROM_Default_ThermalMeter; -+ hal->odmpriv.rf_calibrate_info.is_apk_thermal_meter_ignore = _TRUE; -+ } -+ -+ RTW_INFO("EEPROM ThermalMeter=0x%02x\n", hal->eeprom_thermal_meter); -+} -+ -+static void Hal_EfuseParseAntennaDiversity(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ struct registry_priv *registry_par = &adapter->registrypriv; -+ -+ -+ if (hal->EEPROMBluetoothCoexist == _TRUE && hal->EEPROMBluetoothAntNum == Ant_x1) -+ hal->AntDivCfg = 0; -+ else { -+ if (registry_par->antdiv_cfg == 2)/* 0:OFF , 1:ON, 2:By EFUSE */ -+ hal->AntDivCfg = (map[EEPROM_RF_BOARD_OPTION_8821C] & BIT3) ? _TRUE : _FALSE; -+ else -+ hal->AntDivCfg = registry_par->antdiv_cfg; -+ } -+ /*hal->TRxAntDivType = S0S1_TRX_HW_ANTDIV;*/ -+ hal->with_extenal_ant_switch = ((map[EEPROM_RF_BT_SETTING_8821C] & BIT7) >> 7); -+ -+ RTW_INFO("%s:EEPROM AntDivCfg=%d, AntDivType=%d, external_ant_switch:%d\n", -+ __func__, hal->AntDivCfg, hal->TRxAntDivType, hal->with_extenal_ant_switch); -+#endif /* CONFIG_ANTENNA_DIVERSITY */ -+} -+ -+static void Hal_EfuseTxBBSwing(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ -+ if (_TRUE == mapvalid) { -+ hal_data->tx_bbswing_24G = map[EEPROM_TX_BBSWING_2G_8821C]; -+ if (0xFF == hal_data->tx_bbswing_24G) -+ hal_data->tx_bbswing_24G = 0; -+ hal_data->tx_bbswing_5G = map[EEPROM_TX_BBSWING_5G_8821C]; -+ if (0xFF == hal_data->tx_bbswing_5G) -+ hal_data->tx_bbswing_5G = 0; -+ } else { -+ hal_data->tx_bbswing_24G = 0; -+ hal_data->tx_bbswing_5G = 0; -+ } -+ RTW_INFO("EEPROM tx_bbswing_24G =0x%02x\n", hal_data->tx_bbswing_24G); -+ RTW_INFO("EEPROM tx_bbswing_5G =0x%02x\n", hal_data->tx_bbswing_5G); -+} -+ -+static void Hal_EfuseParseCustomerID(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ -+ if (_TRUE == mapvalid) -+ hal->EEPROMCustomerID = map[EEPROM_CUSTOMER_ID_8821C]; -+ else -+ hal->EEPROMCustomerID = 0; -+ RTW_INFO("EEPROM Customer ID=0x%02x\n", hal->EEPROMCustomerID); -+} -+ -+static void Hal_DetectWoWMode(PADAPTER adapter) -+{ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ adapter_to_pwrctl(adapter)->bSupportRemoteWakeup = _TRUE; -+#else /* !(CONFIG_WOWLAN || CONFIG_AP_WOWLAN) */ -+ adapter_to_pwrctl(adapter)->bSupportRemoteWakeup = _FALSE; -+#endif /* !(CONFIG_WOWLAN || CONFIG_AP_WOWLAN) */ -+ -+ RTW_INFO("EEPROM SupportRemoteWakeup=%d\n", adapter_to_pwrctl(adapter)->bSupportRemoteWakeup); -+} -+ -+static void hal_ReadPAType(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ -+ if (mapvalid) { -+ /* AUTO - Get INFO from eFuse*/ -+ if (GetRegAmplifierType2G(adapter) == 0) { -+ switch (hal_data->rfe_type) { -+ default: -+ hal_data->PAType_2G = 0; -+ hal_data->LNAType_2G = 0; -+ hal_data->ExternalPA_2G = 0; -+ hal_data->ExternalLNA_2G = 0; -+ break; -+ } -+ } else { -+ hal_data->ExternalPA_2G = (GetRegAmplifierType2G(adapter) & ODM_BOARD_EXT_PA) ? 1 : 0; -+ hal_data->ExternalLNA_2G = (GetRegAmplifierType2G(adapter) & ODM_BOARD_EXT_LNA) ? 1 : 0; -+ } -+ -+ /* AUTO */ -+ if (GetRegAmplifierType5G(adapter) == 0) { -+ switch (hal_data->rfe_type) { -+ default: -+ hal_data->PAType_5G = 0; -+ hal_data->LNAType_5G = 0; -+ hal_data->external_pa_5g = 0; -+ hal_data->external_lna_5g = 0; -+ break; -+ } -+ } else { -+ hal_data->external_pa_5g = (GetRegAmplifierType5G(adapter) & ODM_BOARD_EXT_PA_5G) ? 1 : 0; -+ hal_data->external_lna_5g = (GetRegAmplifierType5G(adapter) & ODM_BOARD_EXT_LNA_5G) ? 1 : 0; -+ } -+ } else { -+ /*Get INFO from registry*/ -+ hal_data->ExternalPA_2G = EEPROM_Default_PAType; -+ hal_data->external_pa_5g = 0xFF; -+ hal_data->ExternalLNA_2G = EEPROM_Default_LNAType; -+ hal_data->external_lna_5g = 0xFF; -+ -+ if (GetRegAmplifierType2G(adapter) == 0) { -+ hal_data->ExternalPA_2G = 0; -+ hal_data->ExternalLNA_2G = 0; -+ } else { -+ hal_data->ExternalPA_2G = (GetRegAmplifierType2G(adapter) & ODM_BOARD_EXT_PA) ? 1 : 0; -+ hal_data->ExternalLNA_2G = (GetRegAmplifierType2G(adapter) & ODM_BOARD_EXT_LNA) ? 1 : 0; -+ } -+ -+ if (GetRegAmplifierType5G(adapter) == 0) { -+ hal_data->external_pa_5g = 0; -+ hal_data->external_lna_5g = 0; -+ } else { -+ hal_data->external_pa_5g = (GetRegAmplifierType5G(adapter) & ODM_BOARD_EXT_PA_5G) ? 1 : 0; -+ hal_data->external_lna_5g = (GetRegAmplifierType5G(adapter) & ODM_BOARD_EXT_LNA_5G) ? 1 : 0; -+ } -+ } -+ -+ RTW_INFO("EEPROM PAType_2G is 0x%x, ExternalPA_2G = %d\n", hal_data->PAType_2G, hal_data->ExternalPA_2G); -+ RTW_INFO("EEPROM PAType_5G is 0x%x, external_pa_5g = %d\n", hal_data->PAType_5G, hal_data->external_pa_5g); -+ RTW_INFO("EEPROM LNAType_2G is 0x%x, ExternalLNA_2G = %d\n", hal_data->LNAType_2G, hal_data->ExternalLNA_2G); -+ RTW_INFO("EEPROM LNAType_5G is 0x%x, external_lna_5g = %d\n", hal_data->LNAType_5G, hal_data->external_lna_5g); -+} -+ -+static void Hal_ReadAmplifierType(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ -+ if (hal_data->rfe_type < 8) { /*According to RF-EFUSE DOC : R15]*/ -+ RTW_INFO("WIFI Module is iPA/iLNA\n"); -+ return; -+ } -+ -+ hal_ReadPAType(adapter, map, mapvalid); -+ -+ /* [2.4G] extPA */ -+ hal_data->TypeGPA = hal_data->PAType_2G; -+ -+ /* [5G] extPA */ -+ hal_data->TypeAPA = hal_data->PAType_5G; -+ -+ /* [2.4G] extLNA */ -+ hal_data->TypeGLNA = hal_data->LNAType_2G; -+ -+ /* [5G] extLNA */ -+ hal_data->TypeALNA = hal_data->LNAType_5G; -+ -+ RTW_INFO("EEPROM TypeGPA = 0x%X\n", hal_data->TypeGPA); -+ RTW_INFO("EEPROM TypeAPA = 0x%X\n", hal_data->TypeAPA); -+ RTW_INFO("EEPROM TypeGLNA = 0x%X\n", hal_data->TypeGLNA); -+ RTW_INFO("EEPROM TypeALNA = 0x%X\n", hal_data->TypeALNA); -+} -+ -+static u8 Hal_ReadRFEType(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ /* [20160-06-22 -R15] -+ Type 0 - (2-Ant, DPDT), (2G_WLG, iPA, iLNA, iSW), (5G, iPA, iLNA, iSW) -+ Type 1 - (1-Ant, SPDT@Ant1), (2G_WLG, iPA, iLNA, iSW), (5G, iPA, iLNA, iSW) -+ Type 2 -(1-Ant, SPDT@Ant1) , (2G_BTG, iPA, iLNA, iSW), (5G, iPA, iLNA, iSW) -+ Type 3 - (1-Ant, DPDT@Ant2), (2G_WLG, iPA, iLNA, iSW), (5G, iPA, iLNA, iSW) -+ Type 4 - (1-Ant, DPDT@Ant2), (2G_BTG, iPA, iLNA, iSW), (5G, iPA, iLNA, iSW) -+ Type 5 - (2-Ant), (2G_WLG, iPA, iLNA, iSW), (5G, iPA, iLNA, iSW) -+ Type 6 - (2-Ant), (2G_WLG, iPA, iLNA, iSW), (5G, iPA, iLNA, iSW) -+ Type 7 - (1-Ant), (2G_BTG, iPA, iLNA, iSW), (5G, iPA, iLNA, iSW) -+ */ -+ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ /* check registry valye */ -+ if (GetRegRFEType(adapter) != CONFIG_RTW_RFE_TYPE) { -+ hal->rfe_type = GetRegRFEType(adapter); -+ goto exit; -+ } -+ -+ if (mapvalid) { -+ /* check efuse map */ -+ hal->rfe_type = map[EEPROM_RFE_OPTION_8821C]; -+ if (0xFF != hal->rfe_type) -+ goto exit; -+ } -+ -+ /* error handle */ -+ hal->rfe_type = 0; -+ RTW_ERR("\n\nEmpty EFUSE with unknown REF type!!\n\n"); -+ RTW_ERR("please program efuse or specify correct RFE type.\n"); -+ RTW_ERR("cmd: insmod rtl8821cx.ko rtw_RFE_type=\n\n"); -+ return _FAIL; -+ -+exit: -+ RTW_INFO("EEPROM rfe_type=0x%x\n", hal->rfe_type); -+ return _SUCCESS; -+} -+ -+ -+static void Hal_EfuseParsePackageType(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+} -+ -+#ifdef CONFIG_USB_HCI -+static void Hal_ReadUsbModeSwitch(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ if (_TRUE == mapvalid) -+ /* check efuse 0x06 bit7 */ -+ hal->EEPROMUsbSwitch = (map[EEPROM_USB_MODE_8821CU] & BIT7) >> 7; -+ else -+ hal->EEPROMUsbSwitch = _FALSE; -+ -+ RTW_INFO("EEPROM USB Switch=%d\n", hal->EEPROMUsbSwitch); -+} -+ -+static void hal_read_usb_pid_vid(PADAPTER adapter, u8 *map, u8 mapvalid) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ if (mapvalid == _TRUE) { -+ /* VID, PID */ -+ hal->EEPROMVID = ReadLE2Byte(&map[EEPROM_VID_8821CU]); -+ hal->EEPROMPID = ReadLE2Byte(&map[EEPROM_PID_8821CU]); -+ } else { -+ hal->EEPROMVID = EEPROM_Default_VID; -+ hal->EEPROMPID = EEPROM_Default_PID; -+ } -+ -+ RTW_INFO("EEPROM VID = 0x%04X, PID = 0x%04X\n", hal->EEPROMVID, hal->EEPROMPID); -+} -+ -+#endif /* CONFIG_USB_HCI */ -+ -+/* -+ * Description: -+ * Collect all information from efuse or files. -+ * This function will do -+ * 1. Read registers to check hardware efuse available or not -+ * 2. Read Efuse/EEPROM -+ * 3. Read file if necessary -+ * 4. Parsing Efuse data -+ */ -+u8 rtl8821c_read_efuse(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ u8 val8; -+ u8 *efuse_map = NULL; -+ u8 valid; -+ u8 ret = _FAIL; -+ -+ hal = GET_HAL_DATA(adapter); -+ efuse_map = hal->efuse_eeprom_data; -+ -+ /* 1. Read registers to check hardware eFuse available or not */ -+ val8 = rtw_read8(adapter, REG_SYS_EEPROM_CTRL_8821C); -+ hal->bautoload_fail_flag = (val8 & BIT_AUTOLOAD_SUS_8821C) ? _FALSE : _TRUE; -+ /* -+ * In 8821C, bautoload_fail_flag is used to present eFuse map is valid -+ * or not, no matter the map comes from hardware or files. -+ */ -+ -+ /* 2. Read eFuse */ -+ EFUSE_ShadowMapUpdate(adapter, EFUSE_WIFI, 0); -+ -+ /* 3. Read Efuse file if necessary */ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ if (check_phy_efuse_tx_power_info_valid(adapter) == _FALSE) -+ if (Hal_readPGDataFromConfigFile(adapter) != _SUCCESS) -+ RTW_INFO("%s: invalid phy efuse and read from file fail, will use driver default!!\n", __FUNCTION__); -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+ -+ /* 4. Parse Efuse data */ -+ valid = Hal_EfuseParseIDCode(adapter, efuse_map); -+ if (_TRUE == valid) -+ hal->bautoload_fail_flag = _FALSE; -+ else -+ hal->bautoload_fail_flag = _TRUE; -+ -+ Hal_EfuseParseEEPROMVer(adapter, efuse_map, valid); -+ hal_config_macaddr(adapter, hal->bautoload_fail_flag); -+ Hal_EfuseParseTxPowerInfo(adapter, efuse_map, valid); -+ Hal_EfuseParseBoardType(adapter, efuse_map, valid); -+ Hal_EfuseParseBTCoexistInfo(adapter, efuse_map, valid); -+ Hal_EfuseParseChnlPlan(adapter, efuse_map, hal->bautoload_fail_flag); -+ Hal_EfuseParseXtal(adapter, efuse_map, valid); -+ Hal_EfuseParseThermalMeter(adapter, efuse_map, valid); -+ Hal_EfuseParseAntennaDiversity(adapter, efuse_map, valid); -+ Hal_EfuseParseCustomerID(adapter, efuse_map, valid); -+ Hal_DetectWoWMode(adapter); -+ if (Hal_ReadRFEType(adapter, efuse_map, valid) != _SUCCESS) -+ goto exit; -+ Hal_ReadAmplifierType(adapter, efuse_map, valid); -+ Hal_EfuseTxBBSwing(adapter, efuse_map, valid); -+ -+ /* Data out of Efuse Map */ -+ Hal_EfuseParsePackageType(adapter, efuse_map, valid); -+ -+#ifdef CONFIG_USB_HCI -+ Hal_ReadUsbModeSwitch(adapter, efuse_map, valid); -+ hal_read_usb_pid_vid(adapter, efuse_map, valid); -+#endif /* CONFIG_USB_HCI */ -+ -+ /* set coex. ant info once efuse parsing is done */ -+ rtw_btcoex_set_ant_info(adapter); -+ -+ if (hal_read_mac_hidden_rpt(adapter) != _SUCCESS) -+ goto exit; -+ { -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ if (hal_spec->hci_type <= 3 && hal_spec->hci_type >= 1) { -+ hal->EEPROMBluetoothCoexist = _FALSE; -+ RTW_INFO("EEPROM Disable BT-coex by hal_spec\n"); -+ rtw_btcoex_wifionly_AntInfoSetting(adapter); -+ } -+ } -+ -+ rtw_phydm_read_efuse(adapter); -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+void rtl8821c_run_thread(PADAPTER adapter) -+{ -+} -+ -+void rtl8821c_cancel_thread(PADAPTER adapter) -+{ -+} -+ -+/* -+ * Description: -+ * Using 0x100 to check the power status of FW. -+ */ -+static u8 check_ips_status(PADAPTER adapter) -+{ -+ u8 val8; -+ -+ -+ RTW_INFO(FUNC_ADPT_FMT ": Read 0x100=0x%02x 0x86=0x%02x\n", -+ FUNC_ADPT_ARG(adapter), -+ rtw_read8(adapter, 0x100), rtw_read8(adapter, 0x86)); -+ -+ val8 = rtw_read8(adapter, 0x100); -+ if (val8 == 0xEA) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+static void xmit_status_check(PADAPTER p) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(p); -+ struct sreset_priv *psrtpriv = &hal->srestpriv; -+ struct xmit_priv *pxmitpriv = &p->xmitpriv; -+ systime current_time = 0; -+ unsigned int diff_time = 0; -+ u32 txdma_status = 0; -+ -+ txdma_status = rtw_read32(p, REG_TXDMA_STATUS_8821C); -+ if (txdma_status != 0x00) { -+ RTW_INFO("%s REG_TXDMA_STATUS:0x%08x\n", __FUNCTION__, txdma_status); -+ psrtpriv->tx_dma_status_cnt++; -+ psrtpriv->self_dect_case = 4; -+ rtw_hal_sreset_reset(p); -+ } -+ #ifdef DBG_PRE_TX_HANG -+ #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) -+ { -+ u8 hisr = rtw_read8(p, REG_HISR1_8821C + 3); -+ if (hisr & BIT_PRETXERR) { -+ RTW_ERR("PRE_TX_HANG\n"); -+ rtw_write8(p, REG_HISR1_8821C + 3, BIT_PRETXERR); -+ } -+ } -+ #endif -+ #endif/*DBG_PRE_TX_HANG*/ -+ -+#ifdef CONFIG_USB_HCI -+ 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) { -+ -+ RTW_INFO("%s tx hang %s\n", __FUNCTION__, -+ !adapter_to_rfctl(p)->adaptivity_en ? "" : -+ rtw_edcca_mode_str(rtw_get_edcca_mode(adapter_to_dvobj(p), hal->current_band_type))); -+ -+ if (!adapter_to_rfctl(p)->adaptivity_en) { -+ psrtpriv->self_dect_tx_cnt++; -+ psrtpriv->self_dect_case = 1; -+ rtw_hal_sreset_reset(p); -+ } -+ } -+ } -+ } -+ } -+ -+#endif /* CONFIG_USB_HCI */ -+ -+ if (psrtpriv->dbg_trigger_point == SRESET_TGP_XMIT_STATUS) { -+ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; -+ rtw_hal_sreset_reset(p); -+ return; -+ } -+} -+ -+#ifdef CONFIG_USB_HCI -+static void check_rx_count(PADAPTER p) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(p); -+ struct sreset_priv *psrtpriv = &hal->srestpriv; -+ u16 cur_mac_rxff_ptr; -+ -+ cur_mac_rxff_ptr = rtw_read16(p, REG_RXFF_PTR_V1_8821C); -+ -+#if 0 -+ RTW_INFO("%s,psrtpriv->last_mac_rxff_ptr = %d , cur_mac_rxff_ptr = %d\n", __func__, psrtpriv->last_mac_rxff_ptr, cur_mac_rxff_ptr); -+#endif -+ -+ if (psrtpriv->last_mac_rxff_ptr == cur_mac_rxff_ptr) { -+ psrtpriv->rx_cnt++; -+#if 0 -+ RTW_INFO("%s,MAC case rx_cnt=%d\n", __func__, psrtpriv->rx_cnt); -+#endif -+ goto exit; -+ } -+ -+ psrtpriv->rx_cnt = 0; -+ -+exit: -+ -+ psrtpriv->last_mac_rxff_ptr = cur_mac_rxff_ptr; -+ -+ if (psrtpriv->rx_cnt > 3) { -+ psrtpriv->self_dect_case = 2; -+ psrtpriv->self_dect_rx_cnt++; -+ rtw_hal_sreset_reset(p); -+ } -+} -+#endif/*#ifdef CONFIG_USB_HCI*/ -+ -+static void linked_status_check(PADAPTER p) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(p); -+ struct sreset_priv *psrtpriv = &hal->srestpriv; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(p); -+ u32 rx_dma_status = 0; -+ -+ rx_dma_status = rtw_read32(p, REG_RXDMA_STATUS_8821C); -+ if (rx_dma_status != 0x00) { -+ RTW_INFO("%s REG_RXDMA_STATUS:0x%08x\n", __FUNCTION__, rx_dma_status); -+ psrtpriv->rx_dma_status_cnt++; -+ psrtpriv->self_dect_case = 5; -+#ifdef CONFIG_USB_HCI -+ rtw_hal_sreset_reset(p); -+#endif /* CONFIG_USB_HCI */ -+ } -+ -+ if (psrtpriv->self_dect_fw) { -+ psrtpriv->self_dect_case = 3; -+#ifdef CONFIG_USB_HCI -+ rtw_hal_sreset_reset(p); -+#endif /* CONFIG_USB_HCI */ -+ } -+ -+#ifdef CONFIG_USB_HCI -+ check_rx_count(p); -+#endif /* CONFIG_USB_HCI */ -+ -+ if (psrtpriv->dbg_trigger_point == SRESET_TGP_LINK_STATUS) { -+ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; -+ rtw_hal_sreset_reset(p); -+ return; -+ } -+} -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+static const struct hw_port_reg port_cfg[] = { -+ /*port 0*/ -+ { -+ .net_type = (REG_CR_8821C + 2), -+ .net_type_shift = 0, -+ .macaddr = REG_MACID, -+ .bssid = REG_BSSID, -+ .bcn_ctl = REG_BCN_CTRL, -+ .tsf_rst = REG_DUAL_TSF_RST, -+ .tsf_rst_bit = BIT_TSFTR_RST, -+ .bcn_space = REG_MBSSID_BCN_SPACE, -+ .bcn_space_shift = 0, -+ .bcn_space_mask = 0xffff, -+ .ps_aid = REG_BCN_PSR_RPT_8821C, -+ .ta = REG_TRANSMIT_ADDRSS_0_8821C, -+ }, -+ /*port 1*/ -+ { -+ .net_type = (REG_CR_8821C + 2), -+ .net_type_shift = 2, -+ .macaddr = REG_MACID1, -+ .bssid = REG_BSSID1, -+ .bcn_ctl = REG_BCN_CTRL_CLINT0, -+ .tsf_rst = REG_DUAL_TSF_RST, -+ .tsf_rst_bit = BIT_TSFTR_CLI0_RST, -+ .bcn_space = REG_MBSSID_BCN_SPACE, -+ .bcn_space_shift = 16, -+ .bcn_space_mask = 0xfff, -+ .ps_aid = REG_BCN_PSR_RPT1_8821C, -+ .ta = REG_TRANSMIT_ADDRSS_1_8821C, -+ }, -+ /*port 2*/ -+ { -+ .net_type = REG_CR_EXT_8821C, -+ .net_type_shift = 0, -+ .macaddr = REG_MACID2, -+ .bssid = REG_BSSID2, -+ .bcn_ctl = REG_BCN_CTRL_CLINT1, -+ .tsf_rst = REG_DUAL_TSF_RST, -+ .tsf_rst_bit = BIT_TSFTR_CLI1_RST, -+ .bcn_space = REG_MBSSID_BCN_SPACE2, -+ .bcn_space_shift = 0, -+ .bcn_space_mask = 0xfff, -+ .ps_aid = REG_BCN_PSR_RPT2_8821C, -+ .ta = REG_TRANSMIT_ADDRSS_2_8821C, -+ }, -+ /*port 3*/ -+ { -+ .net_type = REG_CR_EXT_8821C, -+ .net_type_shift = 2, -+ .macaddr = REG_MACID3, -+ .bssid = REG_BSSID3, -+ .bcn_ctl = REG_BCN_CTRL_CLINT2, -+ .tsf_rst = REG_DUAL_TSF_RST, -+ .tsf_rst_bit = BIT_TSFTR_CLI2_RST, -+ .bcn_space = REG_MBSSID_BCN_SPACE2, -+ .bcn_space_shift = 16, -+ .bcn_space_mask = 0xfff, -+ .ps_aid = REG_BCN_PSR_RPT3_8821C, -+ .ta = REG_TRANSMIT_ADDRSS_3_8821C, -+ }, -+ /*port 4*/ -+ { -+ .net_type = REG_CR_EXT_8821C, -+ .net_type_shift = 4, -+ .macaddr = REG_MACID4, -+ .bssid = REG_BSSID4, -+ .bcn_ctl = REG_BCN_CTRL_CLINT3, -+ .tsf_rst = REG_DUAL_TSF_RST, -+ .tsf_rst_bit = BIT_TSFTR_CLI3_RST, -+ .bcn_space = REG_MBSSID_BCN_SPACE3, -+ .bcn_space_shift = 0, -+ .bcn_space_mask = 0xfff, -+ .ps_aid = REG_BCN_PSR_RPT4_8821C, -+ .ta = REG_TRANSMIT_ADDRSS_4_8821C, -+ }, -+}; -+ -+static u32 hw_bcn_ctrl_addr(_adapter *adapter, u8 hw_port) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u32 addr = 0; -+ -+ if (hw_port >= hal_spec->port_num) { -+ RTW_ERR(FUNC_ADPT_FMT" HW Port(%d) invalid\n", FUNC_ADPT_ARG(adapter), hw_port); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ addr = port_cfg[hw_port].bcn_ctl; -+ -+exit: -+ return addr; -+} -+ -+static void hw_bcn_ctrl_set(_adapter *adapter, u8 hw_port, u8 bcn_ctl_val) -+{ -+ u32 bcn_ctl_addr = 0; -+ -+ if (hw_port >= MAX_HW_PORT) { -+ RTW_ERR(FUNC_ADPT_FMT" HW Port(%d) invalid\n", FUNC_ADPT_ARG(adapter), hw_port); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ bcn_ctl_addr = port_cfg[hw_port].bcn_ctl; -+ rtw_write8(adapter, bcn_ctl_addr, bcn_ctl_val); -+} -+ -+static void hw_bcn_ctrl_add(_adapter *adapter, u8 hw_port, u8 bcn_ctl_val) -+{ -+ u32 bcn_ctl_addr = 0; -+ u8 val8 = 0; -+ -+ if (hw_port >= MAX_HW_PORT) { -+ RTW_ERR(FUNC_ADPT_FMT" HW Port(%d) invalid\n", FUNC_ADPT_ARG(adapter), hw_port); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ bcn_ctl_addr = port_cfg[hw_port].bcn_ctl; -+ val8 = rtw_read8(adapter, bcn_ctl_addr) | bcn_ctl_val; -+ rtw_write8(adapter, bcn_ctl_addr, val8); -+} -+ -+static void hw_bcn_ctrl_clr(_adapter *adapter, u8 hw_port, u8 bcn_ctl_val) -+{ -+ u32 bcn_ctl_addr = 0; -+ u8 val8 = 0; -+ -+ if (hw_port >= MAX_HW_PORT) { -+ RTW_ERR(FUNC_ADPT_FMT" HW Port(%d) invalid\n", FUNC_ADPT_ARG(adapter), hw_port); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ bcn_ctl_addr = port_cfg[hw_port].bcn_ctl; -+ val8 = rtw_read8(adapter, bcn_ctl_addr); -+ val8 &= ~bcn_ctl_val; -+ rtw_write8(adapter, bcn_ctl_addr, val8); -+} -+ -+ -+static void hw_bcn_func(_adapter *adapter, u8 enable) -+{ -+ if (enable) -+ hw_bcn_ctrl_add(adapter, get_hw_port(adapter), BIT_EN_BCN_FUNCTION); -+ else -+ hw_bcn_ctrl_clr(adapter, get_hw_port(adapter), BIT_EN_BCN_FUNCTION); -+} -+ -+void hw_port0_tsf_sync(_adapter *adapter) -+{ -+ rtw_write8(adapter, REG_SCHEDULER_RST, rtw_read8(adapter, REG_SCHEDULER_RST) | BIT_SYNC_CLI_ONCE_BY_TBTT_8821C); -+} -+ -+void hw_tsf_reset(_adapter *adapter) -+{ -+ u8 hw_port = rtw_hal_get_port(adapter); -+ u32 tsf_rst_addr = 0; -+ u8 tsf_rst_bit = 0; -+ -+ if (hw_port >= MAX_HW_PORT) { -+ RTW_ERR(FUNC_ADPT_FMT" HW Port(%d) invalid\n", FUNC_ADPT_ARG(adapter), hw_port); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ tsf_rst_addr = port_cfg[hw_port].tsf_rst; -+ tsf_rst_bit = port_cfg[hw_port].tsf_rst_bit; -+ rtw_write8(adapter, tsf_rst_addr, tsf_rst_bit); -+} -+ -+static void hw_var_set_monitor(PADAPTER adapter) -+{ -+#ifdef CONFIG_WIFI_MONITOR -+ u8 tmp_8bit; -+ u32 tmp_32bit; -+ struct net_device *ndev = adapter->pnetdev; -+ struct mon_reg_backup *mon = &GET_HAL_DATA(adapter)->mon_backup; -+ -+ mon->known_rcr = 1; -+ rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)& mon->rcr); -+ -+ /* Receive all type */ -+ tmp_32bit = BIT_AAP_8821C | BIT_APP_PHYSTS_8821C; -+ -+ if (ndev->type == ARPHRD_IEEE80211_RADIOTAP) { -+ /* Append FCS */ -+ tmp_32bit |= BIT_APP_FCS_8821C; -+ } -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_RCR, (u8 *)& tmp_32bit); -+ -+ if (1) -+ rtw_halmac_config_rx_info(adapter_to_dvobj(adapter), -+ HALMAC_DRV_INFO_PHY_SNIFFER); -+ else -+ rtw_halmac_config_rx_info(adapter_to_dvobj(adapter), -+ HALMAC_DRV_INFO_PHY_PLCP); -+ -+ tmp_8bit = rtw_read8(adapter, REG_RX_DRVINFO_SZ_8821C); -+ rtw_write8(adapter, REG_RX_DRVINFO_SZ_8821C, (tmp_8bit | 0x80)); -+ -+ /* Receive all data frames */ -+ mon->known_rxfilter = 1; -+ mon->rxfilter0 = rtw_read16(adapter, REG_RXFLTMAP0_8821C); -+ mon->rxfilter1 = rtw_read16(adapter, REG_RXFLTMAP1_8821C); -+ mon->rxfilter2 = rtw_read16(adapter, REG_RXFLTMAP2_8821C); -+ rtw_write16(adapter, REG_RXFLTMAP0_8821C, 0xFFFF); -+ rtw_write16(adapter, REG_RXFLTMAP1_8821C, 0xFFFF); -+ rtw_write16(adapter, REG_RXFLTMAP2_8821C, 0xFFFF); -+#endif /* CONFIG_WIFI_MONITOR */ -+} -+ -+void hw_set_ta(_adapter *adapter, u8 hw_port, u8 *val) -+{ -+ u8 idx = 0; -+ u32 reg = port_cfg[hw_port].ta; -+ -+ for (idx = 0 ; idx < ETH_ALEN; idx++) -+ rtw_write8(adapter, (reg + idx), val[idx]); -+ -+ RTW_INFO("%s("ADPT_FMT") hw port -%d TA: "MAC_FMT"\n", -+ __func__, ADPT_ARG(adapter), hw_port, MAC_ARG(val)); -+} -+void hw_set_aid(_adapter *adapter, u8 hw_port, u8 aid) -+{ -+ rtw_write16(adapter, port_cfg[hw_port].ps_aid, (0xF800 | aid)); -+ RTW_INFO("%s("ADPT_FMT") hw port -%d AID: %d\n", -+ __func__, ADPT_ARG(adapter), hw_port, aid); -+} -+#ifdef CONFIG_CLIENT_PORT_CFG -+void rtw_hw_client_port_cfg(_adapter *adapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 clt_port = get_clt_port(adapter); -+ -+ if (clt_port == CLT_PORT_INVALID) -+ return; -+ RTW_INFO("%s ("ADPT_FMT")\n", __func__, ADPT_ARG(adapter)); -+ -+ /*Network type*/ -+ rtw_halmac_set_network_type(adapter_to_dvobj(adapter), clt_port, _HW_STATE_STATION_); -+ /*A1*/ -+ rtw_halmac_set_mac_address(adapter_to_dvobj(adapter), clt_port, adapter_mac_addr(adapter)); -+ /*A2*/ -+ hw_set_ta(adapter, clt_port, pmlmeinfo->network.MacAddress); -+ /*A3*/ -+ rtw_halmac_set_bssid(adapter_to_dvobj(adapter), clt_port, pmlmeinfo->network.MacAddress); -+ /*Beacon space*/ -+ rtw_halmac_set_bcn_interval(adapter_to_dvobj(adapter), clt_port, pmlmeinfo->bcn_interval); -+ /*AID*/ -+ hw_set_aid(adapter, clt_port, pmlmeinfo->aid); -+ /*Beacon control*/ -+ hw_bcn_ctrl_set(adapter, clt_port, (BIT_P0_EN_RXBCN_RPT | BIT_EN_BCN_FUNCTION)); -+ -+ RTW_INFO("%s ("ADPT_FMT") clt_port:%d\n", __func__, ADPT_ARG(adapter), clt_port); -+} -+ -+/*#define DBG_TSF_MONITOR*/ -+void rtw_hw_client_port_clr(_adapter *adapter) -+{ -+ u8 null_addr[ETH_ALEN] = {0}; -+ u8 clt_port = get_clt_port(adapter); -+ -+ if (clt_port == CLT_PORT_INVALID) -+ return; -+ RTW_INFO("%s ("ADPT_FMT") ==> \n", __func__, ADPT_ARG(adapter)); -+ #ifdef DBG_TSF_MONITOR -+ /*Beacon control*/ -+ hw_bcn_ctrl_clr(adapter, clt_port, BIT_EN_BCN_FUNCTION); -+ hw_tsf_reset(adapter); -+ #endif -+ /*Network type*/ -+ rtw_halmac_set_network_type(adapter_to_dvobj(adapter), clt_port, _HW_STATE_NOLINK_); -+ /*A1*/ -+ rtw_halmac_set_mac_address(adapter_to_dvobj(adapter), clt_port, null_addr); -+ /*A2*/ -+ hw_set_ta(adapter, clt_port, null_addr); -+ /*A3*/ -+ rtw_halmac_set_bssid(adapter_to_dvobj(adapter), clt_port, null_addr); -+ #ifdef DBG_TSF_MONITOR -+ if (0) -+ #endif -+ /*Beacon control*/ -+ hw_bcn_ctrl_set(adapter, clt_port, (BIT_DIS_TSF_UDT | BIT_EN_BCN_FUNCTION)); -+ /*AID*/ -+ hw_set_aid(adapter, clt_port, 0); -+ RTW_INFO("%s("ADPT_FMT") clt_port:%d\n", __func__, ADPT_ARG(adapter), clt_port); -+} -+#endif -+ -+static void hw_var_set_opmode(PADAPTER Adapter, u8 *val) -+{ -+ u8 mode = *((u8 *)val); -+ static u8 isMonitor = _FALSE; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if (isMonitor == _TRUE) { -+#ifdef CONFIG_WIFI_MONITOR -+ struct mon_reg_backup *backup = &GET_HAL_DATA(Adapter)->mon_backup; -+ -+ if (backup->known_rcr) { -+ backup->known_rcr = 0; -+ rtw_hal_set_hwreg(Adapter, HW_VAR_RCR, (u8 *)&backup->rcr); -+ -+ if (!!(backup->rcr &= BIT_APP_PHYSTS_8821C)) -+ rtw_halmac_config_rx_info(adapter_to_dvobj(Adapter), -+ HALMAC_DRV_INFO_PHY_STATUS); -+ else -+ rtw_halmac_config_rx_info(adapter_to_dvobj(Adapter), -+ HALMAC_DRV_INFO_NONE); -+ -+ rtw_hal_rcr_set_chk_bssid(Adapter, MLME_ACTION_NONE); -+ } -+ if (backup->known_rxfilter) { -+ backup->known_rxfilter = 0; -+ rtw_write16(Adapter, REG_RXFLTMAP0_8821C, backup->rxfilter0); -+ rtw_write16(Adapter, REG_RXFLTMAP1_8821C, backup->rxfilter1); -+ rtw_write16(Adapter, REG_RXFLTMAP2_8821C, backup->rxfilter2); -+ } -+#endif /* CONFIG_WIFI_MONITOR */ -+ isMonitor = _FALSE; -+ } -+ -+ if (mode == _HW_STATE_MONITOR_) { -+ isMonitor = _TRUE; -+ -+ /* set net_type */ -+ Set_MSR(Adapter, _HW_STATE_NOLINK_); -+ hw_var_set_monitor(Adapter); -+ return; -+ } -+ -+ rtw_hal_set_hwreg(Adapter, HW_VAR_MAC_ADDR, adapter_mac_addr(Adapter)); /* set mac addr to mac register */ -+ RTW_INFO(ADPT_FMT ": hw_port(%d) set mode=%d\n", ADPT_ARG(Adapter), get_hw_port(Adapter), mode); -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM /*For Port0 - MBSS CAM*/ -+ if (Adapter->hw_port != HW_PORT0) { -+ RTW_ERR(ADPT_FMT ": Configure MBSSID cam on HW_PORT%d\n", ADPT_ARG(Adapter), Adapter->hw_port); -+ rtw_warn_on(1); -+ } else -+ hw_var_set_opmode_mbid(Adapter, mode); -+#else -+ -+ rtw_iface_disable_tsf_update(Adapter); -+ -+ /* set net_type */ -+ Set_MSR(Adapter, mode); -+ -+ if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ if (!rtw_mi_get_ap_num(Adapter) && !rtw_mi_get_mesh_num(Adapter)) { -+ /*CONFIG_INTERRUPT_BASED_TXBCN*/ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ rtw_write8(Adapter, REG_DRVERLYINT, 0x05);/* restore early int time to 5ms */ -+ #if defined(CONFIG_SDIO_HCI) -+ rtl8821cs_update_interrupt_mask(Adapter, 0, SDIO_HIMR_BCNERLY_INT_MSK); -+ #endif -+ #endif/* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ #if defined(CONFIG_SDIO_HCI) -+ rtl8821cs_update_interrupt_mask(Adapter, 0, (SDIO_HIMR_TXBCNOK_MSK | SDIO_HIMR_TXBCNERR_MSK)); -+ #endif -+ #endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ -+ } -+ #endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+ -+ if (!rtw_mi_get_ap_num(Adapter) && !rtw_mi_get_mesh_num(Adapter)) -+ StopTxBeacon(Adapter); -+ hw_bcn_ctrl_set(Adapter, get_hw_port(Adapter), BIT_EN_BCN_FUNCTION_8821C | BIT_DIS_TSF_UDT_8821C); -+ -+ } else if (mode == _HW_STATE_ADHOC_) { -+ ResumeTxBeacon(Adapter); -+ hw_bcn_ctrl_set(Adapter, get_hw_port(Adapter), BIT_EN_BCN_FUNCTION_8821C | BIT_DIS_TSF_UDT_8821C); -+ -+ } else if (mode == _HW_STATE_AP_) { -+ -+ if (Adapter->hw_port == HW_PORT0) { -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ #if defined(CONFIG_SDIO_HCI) -+ rtl8821cs_update_interrupt_mask(Adapter, SDIO_HIMR_BCNERLY_INT_MSK, 0); -+ #endif -+ #endif/* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ #if defined(CONFIG_SDIO_HCI) -+ rtl8821cs_update_interrupt_mask(Adapter, (SDIO_HIMR_TXBCNOK_MSK | SDIO_HIMR_TXBCNERR_MSK), 0); -+ #endif -+ #endif/* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ -+ #endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+ -+ /* enable to rx data frame */ -+ rtw_write16(Adapter, REG_RXFLTMAP2_8821C, 0xFFFF); -+ -+ /* Beacon Control related register for first time */ -+ rtw_write8(Adapter, REG_BCNDMATIM_8821C, 0x02); /* 2ms */ -+ -+ rtw_write8(Adapter, REG_ATIMWND_8821C, 0x0c); /* ATIM:12ms */ -+ -+ /*rtw_write16(Adapter, REG_TSFTR_SYN_OFFSET_8821C, 0x7fff);*//* +32767 (~32ms) */ -+ hw_tsf_reset(Adapter); -+ /* don't enable update TSF0 for if1 (due to TSF update when beacon/probe rsp are received) */ -+ #if defined(CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR) -+ hw_bcn_ctrl_set(Adapter, get_hw_port(Adapter), BIT_EN_BCN_FUNCTION_8821C | BIT_DIS_TSF_UDT_8821C | BIT_P0_EN_TXBCN_RPT_8821C); -+ #else -+ hw_bcn_ctrl_set(Adapter, get_hw_port(Adapter), BIT_EN_BCN_FUNCTION_8821C | BIT_DIS_TSF_UDT_8821C); -+ #endif -+ } else { -+ RTW_ERR(ADPT_FMT ": set AP mode on HW_PORT%d\n", ADPT_ARG(Adapter), Adapter->hw_port); -+ rtw_warn_on(1); -+ } -+ } -+#endif -+} -+ -+#ifdef CONFIG_AP_PORT_SWAP -+void rtw_hal_port_reconfig(_adapter *adapter, u8 port) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u32 bssid_offset = 0; -+ u8 bssid[6] = {0}; -+ u8 vnet_type = 0; -+ u8 vbcn_ctrl = 0; -+ u8 i; -+ -+ 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); -+ -+ /*backup*/ -+ vnet_type = (rtw_read8(adapter, port_cfg[adapter->hw_port].net_type) >> port_cfg[adapter->hw_port].net_type_shift) & 0x03; -+ vbcn_ctrl = rtw_read8(adapter, port_cfg[adapter->hw_port].bcn_ctl); -+ if (is_client_associated_to_ap(adapter)) { -+ RTW_INFO("port0-iface is STA mode and linked\n"); -+ bssid_offset = port_cfg[adapter->hw_port].bssid; -+ for (i = 0; i < 6; i++) -+ bssid[i] = rtw_read8(adapter, bssid_offset + i); -+ } -+ /*reconfigure*/ -+ adapter->hw_port = port; -+ rtw_hal_set_hwreg(adapter, HW_VAR_MAC_ADDR, adapter_mac_addr(adapter)); -+ Set_MSR(adapter, vnet_type); -+ -+ if (is_client_associated_to_ap(adapter)) { -+ rtw_hal_set_hwreg(adapter, HW_VAR_BSSID, bssid); -+ hw_tsf_reset(adapter); -+ #ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ rtw_set_default_port_id(adapter); -+ #endif -+ } -+#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) -+ if (GET_HAL_DATA(adapter)->EEPROMBluetoothCoexist == _TRUE) -+ rtw_hal_set_wifi_btc_port_id_cmd(adapter); -+#endif -+ -+ rtw_write8(adapter, port_cfg[adapter->hw_port].bcn_ctl, vbcn_ctrl); -+} -+static void rtl8821c_ap_port_switch(_adapter *adapter, u8 mode) -+{ -+ u8 hw_port = get_hw_port(adapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 ap_nums = 0; -+ _adapter *if_port0 = NULL; -+ int i; -+ -+ RTW_INFO(ADPT_FMT ": hw_port(%d) will set mode to %d\n", ADPT_ARG(adapter), hw_port, mode); -+#if 0 -+ #ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(&adapter->wdinfo, P2P_STATE_NONE)) { -+ RTW_INFO("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, -+ rtw_p2p_role(&adapter->wdinfo), rtw_p2p_state(&adapter->wdinfo), rtw_p2p_pre_state(&adapter->wdinfo)); -+ } -+ #endif -+#endif -+ -+ if (mode != _HW_STATE_AP_) -+ return; -+ -+ if ((mode == _HW_STATE_AP_) && (hw_port == HW_PORT0)) -+ return; -+ -+ /*check and prepare switch port to port0 for AP mode's BCN function*/ -+ ap_nums = rtw_mi_get_ap_num(adapter); -+ if (ap_nums > 0) { -+ RTW_ERR("SortAP mode numbers:%d, must move setting to MBSSID CAM, not support yet\n", ap_nums); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ /*Get iface of port-0*/ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (get_hw_port(dvobj->padapters[i]) == HW_PORT0) { -+ if_port0 = dvobj->padapters[i]; -+ break; -+ } -+ } -+ -+ if (if_port0 == NULL) { -+ RTW_ERR("%s if_port0 == NULL\n", __func__); -+ rtw_warn_on(1); -+ return; -+ } -+ rtw_hal_port_reconfig(if_port0, hw_port); -+ -+ adapter->hw_port = HW_PORT0; -+ RTW_INFO(ADPT_FMT ": Cfg SoftAP mode to hw_port(%d) done\n", ADPT_ARG(adapter), adapter->hw_port); -+ -+} -+#endif -+static void hw_var_hw_port_cfg(_adapter *adapter, u8 enable) -+{ -+ if (enable) -+ hw_bcn_ctrl_add(adapter, get_hw_port(adapter), (BIT_P0_EN_RXBCN_RPT | BIT_DIS_TSF_UDT | BIT_EN_BCN_FUNCTION)); -+ else -+ hw_bcn_ctrl_clr(adapter, get_hw_port(adapter), BIT_EN_BCN_FUNCTION); -+} -+static void hw_var_set_bcn_func(PADAPTER adapter, u8 enable) -+{ -+ u8 val8; -+ -+ if (enable) { -+ /* enable TX BCN report -+ * Reg REG_FWHW_TXQ_CTRL_8821C[2] = 1 -+ * Reg REG_BCN_CTRL_8821C[3][5] = 1 -+ */ -+ val8 = rtw_read8(adapter, REG_FWHW_TXQ_CTRL_8821C); -+ val8 |= BIT_EN_BCN_TRXRPT_V1_8821C; -+ rtw_write8(adapter, REG_FWHW_TXQ_CTRL_8821C, val8); -+ -+ if (adapter->hw_port == HW_PORT0) -+ hw_bcn_ctrl_add(adapter, get_hw_port(adapter), BIT_EN_BCN_FUNCTION_8821C | BIT_P0_EN_TXBCN_RPT_8821C); -+ else -+ hw_bcn_ctrl_add(adapter, get_hw_port(adapter), BIT_EN_BCN_FUNCTION_8821C); -+ } else { -+ if (adapter->hw_port == HW_PORT0) { -+ val8 = BIT_EN_BCN_FUNCTION_8821C | BIT_P0_EN_TXBCN_RPT_8821C; -+ -+ #ifdef CONFIG_BT_COEXIST -+ /* Always enable port0 beacon function for PSTDMA */ -+ if (GET_HAL_DATA(adapter)->EEPROMBluetoothCoexist) -+ val8 = BIT_P0_EN_TXBCN_RPT_8821C; -+ #endif -+ hw_bcn_ctrl_clr(adapter, get_hw_port(adapter), val8); -+ } else -+ hw_bcn_ctrl_clr(adapter, get_hw_port(adapter), BIT_EN_BCN_FUNCTION_8821C); -+ } -+} -+ -+static void hw_var_set_mlme_disconnect(PADAPTER adapter) -+{ -+ u8 val8; -+ -+#ifdef DBG_IFACE_STATUS -+ DBG_IFACE_STATUS_DUMP(adapter); -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(adapter, MI_LINKED) == _FALSE) -+#endif -+ /* reject all data frames under not link state */ -+ rtw_write16(adapter, REG_RXFLTMAP2_8821C, 0); -+ -+ /* reset TSF*/ -+ hw_tsf_reset(adapter); -+ -+ /* disable update TSF*/ -+ rtw_iface_disable_tsf_update(adapter); -+ -+ #ifdef CONFIG_CLIENT_PORT_CFG -+ if (MLME_IS_STA(adapter)) -+ rtw_hw_client_port_clr(adapter); -+ #endif -+} -+ -+static void hw_var_set_mlme_sitesurvey(PADAPTER adapter, u8 enable) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u16 value_rxfltmap2; -+ u8 val8; -+ PHAL_DATA_TYPE hal; -+ struct mlme_priv *pmlmepriv; -+ int i; -+ _adapter *iface; -+ -+ -+#ifdef DBG_IFACE_STATUS -+ DBG_IFACE_STATUS_DUMP(adapter); -+#endif -+ -+ hal = GET_HAL_DATA(adapter); -+ pmlmepriv = &adapter->mlmepriv; -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ /* Receive all data frames */ -+ value_rxfltmap2 = 0xFFFF; -+#else -+ /* not to receive data frame */ -+ value_rxfltmap2 = 0; -+#endif -+ -+ if (enable) { -+ /* -+ * 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(adapter, REG_RXFLTMAP2_8821C, value_rxfltmap2); -+ -+ rtw_hal_rcr_set_chk_bssid(adapter, MLME_SCAN_ENTER); -+ -+ if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) -+ StopTxBeacon(adapter); -+ } else { -+ /* sitesurvey done -+ * 1. enable rx data frame -+ * 2. config RCR not to receive different BSSID BCN or probe rsp -+ * 3. can enable TSF update & buddy TSF right now due to HW support(IC before 8821C not support ex:8812A/8814A/8192E...) -+ */ -+ if (rtw_mi_check_fwstate(adapter, WIFI_ASOC_STATE | WIFI_AP_STATE | WIFI_MESH_STATE))/* enable to rx data frame */ -+ rtw_write16(adapter, REG_RXFLTMAP2_8821C, 0xFFFF); -+ -+ rtw_hal_rcr_set_chk_bssid(adapter, MLME_SCAN_DONE); -+ -+ #ifdef CONFIG_AP_MODE -+ if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) { -+ ResumeTxBeacon(adapter); -+ rtw_mi_tx_beacon_hdl(adapter); -+ } -+ #endif -+ } -+} -+static void hw_var_set_mlme_join(PADAPTER adapter, u8 type) -+{ -+ u8 val8; -+ u16 val16; -+ u32 val32; -+ u8 RetryLimit; -+ PHAL_DATA_TYPE hal; -+ struct mlme_priv *pmlmepriv; -+ -+ RetryLimit = RL_VAL_STA; -+ hal = GET_HAL_DATA(adapter); -+ pmlmepriv = &adapter->mlmepriv; -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (type == 0) { -+ /* prepare to join */ -+ if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) -+ StopTxBeacon(adapter); -+ -+ /* enable to rx data frame.Accept all data frame */ -+ rtw_write16(adapter, REG_RXFLTMAP2_8821C, 0xFFFF); -+ -+ hw_bcn_func(adapter, _TRUE); -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ RetryLimit = (hal->CustomerID == RT_CID_CCX) ? RL_VAL_AP : RL_VAL_STA; -+ else /* Ad-hoc Mode */ -+ RetryLimit = RL_VAL_AP; -+ #ifdef CONFIG_CLIENT_PORT_CFG -+ rtw_hw_client_port_cfg(adapter); -+ #endif -+ -+ rtw_iface_enable_tsf_update(adapter); -+ -+ } else if (type == 1) { -+ /* joinbss_event call back when join res < 0 */ -+ if (rtw_mi_check_status(adapter, MI_LINKED) == _FALSE) -+ rtw_write16(adapter, REG_RXFLTMAP2_8821C, 0x00); -+ -+ rtw_iface_disable_tsf_update(adapter); -+ -+ if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) { -+ ResumeTxBeacon(adapter); -+ -+ /* reset TSF 1/2 after resume_tx_beacon */ -+ val8 = BIT_TSFTR_RST_8821C | BIT_TSFTR_CLI0_RST_8821C; -+ rtw_write8(adapter, REG_DUAL_TSF_RST_8821C, val8); -+ } -+ #ifdef CONFIG_CLIENT_PORT_CFG -+ if (MLME_IS_STA(adapter)) -+ rtw_hw_client_port_clr(adapter); -+ #endif -+ } else if (type == 2) { -+ /* sta add event callback */ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { -+ rtw_write8(adapter, 0x542, 0x02); -+ RetryLimit = RL_VAL_AP; -+ } -+ -+ if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) { -+ ResumeTxBeacon(adapter); -+ -+ /* reset TSF 1/2 after resume_tx_beacon */ -+ rtw_write8(adapter, REG_DUAL_TSF_RST_8821C, BIT_TSFTR_RST_8821C | BIT_TSFTR_CLI0_RST_8821C); -+ } -+ } -+ -+ val16 = BIT_LRL_8821C(RetryLimit) | BIT_SRL_8821C(RetryLimit); -+ rtw_write16(adapter, REG_RETRY_LIMIT_8821C, val16); -+#else /* !CONFIG_CONCURRENT_MODE */ -+ if (type == 0) { -+ /* prepare to join */ -+ -+ /* enable to rx data frame.Accept all data frame */ -+ rtw_write16(adapter, REG_RXFLTMAP2_8821C, 0xFFFF); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ RetryLimit = (hal->CustomerID == RT_CID_CCX) ? RL_VAL_AP : RL_VAL_STA; -+ else /* Ad-hoc Mode */ -+ RetryLimit = RL_VAL_AP; -+ hw_bcn_func(adapter, _TRUE); -+ -+ rtw_iface_enable_tsf_update(adapter); -+ -+ } else if (type == 1) { -+ /* joinbss_event call back when join res < 0 */ -+ rtw_write16(adapter, REG_RXFLTMAP2_8821C, 0x00); -+ -+ rtw_iface_disable_tsf_update(adapter); -+ -+ } else if (type == 2) { -+ /* sta add event callback */ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) -+ RetryLimit = RL_VAL_AP; -+ } -+ -+ val16 = BIT_LRL_8821C(RetryLimit) | BIT_SRL_8821C(RetryLimit); -+ rtw_write16(adapter, REG_RETRY_LIMIT_8821C, val16); -+#endif /* !CONFIG_CONCURRENT_MODE */ -+} -+ -+static void hw_var_set_acm_ctrl(PADAPTER adapter, u8 ctrl) -+{ -+ u8 hwctrl = 0; -+ -+ if (ctrl) { -+ hwctrl |= BIT_ACMHWEN_8821C; -+ -+ if (ctrl & BIT(1)) /* BE */ -+ hwctrl |= BIT_BEQ_ACM_EN_8821C; -+ else -+ hwctrl &= (~BIT_BEQ_ACM_EN_8821C); -+ -+ if (ctrl & BIT(2)) /* VI */ -+ hwctrl |= BIT_VIQ_ACM_EN_8821C; -+ else -+ hwctrl &= (~BIT_VIQ_ACM_EN_8821C); -+ -+ if (ctrl & BIT(3)) /* VO */ -+ hwctrl |= BIT_VOQ_ACM_EN_8821C; -+ else -+ hwctrl &= (~BIT_VOQ_ACM_EN_8821C); -+ } -+ -+ RTW_INFO("[HW_VAR_ACM_CTRL] Write 0x%02X\n", hwctrl); -+ rtw_write8(adapter, REG_ACMHWCTRL_8821C, hwctrl); -+} -+ -+void hw_var_lps_rfon_chk(_adapter *adapter, u8 rfon_ctrl) -+{ -+#ifdef CONFIG_LPS_ACK -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ -+ if (rfon_ctrl == rf_on) { -+ if (rtw_sctx_wait(&pwrpriv->lps_ack_sctx, __func__)) { -+ if (pwrpriv->lps_ack_status > 0) -+ RTW_INFO(FUNC_ADPT_FMT" RF_ON function is not ready !!!\n", FUNC_ADPT_ARG(adapter)); -+ } else { -+ RTW_WARN("LPS RFON sctx query timeout, operation abort!!\n"); -+ } -+ pwrpriv->lps_ack_status = -1; -+ } -+#endif -+} -+ -+static void hw_var_set_sec_cfg(PADAPTER adapter, u8 cfg) -+{ -+ u16 reg_scr_ori; -+ u16 reg_scr; -+ -+ reg_scr = reg_scr_ori = rtw_read16(adapter, REG_SECCFG_8821C); -+ reg_scr |= (BIT_CHK_KEYID_8821C | BIT_RXDEC_8821C | BIT_TXENC_8821C); -+ -+ if (_rtw_camctl_chk_cap(adapter, SEC_CAP_CHK_BMC)) -+ reg_scr |= BIT_CHK_BMC_8821C; -+ -+ if (_rtw_camctl_chk_flags(adapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH)) -+ reg_scr |= BIT_NOSKMC_8821C; -+ -+ if (reg_scr != reg_scr_ori) -+ rtw_write16(adapter, REG_SECCFG_8821C, reg_scr); -+ -+ RTW_INFO("%s: [HW_VAR_SEC_CFG] 0x%x=0x%x\n", __FUNCTION__, -+ REG_SECCFG_8821C, rtw_read32(adapter, REG_SECCFG_8821C)); -+} -+ -+static void hw_var_set_sec_dk_cfg(PADAPTER adapter, u8 enable) -+{ -+ struct security_priv *sec = &adapter->securitypriv; -+ u8 reg_scr = rtw_read8(adapter, REG_SECCFG_8821C); -+ -+ if (enable) { -+ /* Enable default key related setting */ -+ reg_scr |= BIT_TXBCUSEDK_8821C; -+ if (sec->dot11AuthAlgrthm != dot11AuthAlgrthm_8021X) -+ reg_scr |= BIT_RXUHUSEDK_8821C | BIT_TXUHUSEDK_8821C; -+ } else { -+ /* Disable default key related setting */ -+ reg_scr &= ~(BIT_RXBCUSEDK_8821C | BIT_TXBCUSEDK_8821C | BIT_RXUHUSEDK_8821C | BIT_TXUHUSEDK_8821C); -+ } -+ -+ rtw_write8(adapter, REG_SECCFG_8821C, reg_scr); -+ -+ RTW_INFO("%s: [HW_VAR_SEC_DK_CFG] 0x%x=0x%08x\n", __FUNCTION__, -+ REG_SECCFG_8821C, rtw_read32(adapter, REG_SECCFG_8821C)); -+} -+ -+static void hw_var_set_bcn_valid(PADAPTER adapter) -+{ -+ u8 val8 = 0; -+ -+ /* only port 0 can TX BCN */ -+ val8 = rtw_read8(adapter, REG_FIFOPAGE_CTRL_2_8821C + 1); -+ val8 = val8 | BIT(7); -+ rtw_write8(adapter, REG_FIFOPAGE_CTRL_2_8821C + 1, val8); -+} -+ -+static void hw_var_set_ack_preamble(PADAPTER adapter, u8 bShortPreamble) -+{ -+ u8 val8 = 0; -+ -+ -+ val8 = rtw_read8(adapter, REG_WMAC_TRXPTCL_CTL_8821C + 2); -+ val8 |= BIT(4) | BIT(5); -+ -+ if (bShortPreamble) -+ val8 |= BIT1; -+ else -+ val8 &= (~BIT1); -+ -+ rtw_write8(adapter, REG_WMAC_TRXPTCL_CTL_8821C + 2, val8); -+} -+ -+void rtl8821c_dl_rsvd_page(PADAPTER adapter, u8 mstatus) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ BOOLEAN bcn_valid = _FALSE; -+ u8 DLBcnCount = 0; -+ u32 poll = 0; -+ u8 val8, org_bcn, org_cr; -+ u8 hw_port = rtw_hal_get_port(adapter); -+ -+ RTW_INFO(FUNC_ADPT_FMT ":+ hw_port=%d mstatus(%x)\n", -+ FUNC_ADPT_ARG(adapter), hw_port, mstatus); -+ -+ if (mstatus == RT_MEDIA_CONNECT) { -+#if 0 -+ BOOLEAN bRecover = _FALSE; -+#endif -+ u8 v8; -+ -+ /* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 8821C -bit 10:0 */ -+ rtw_write16(adapter, port_cfg[hw_port].ps_aid, (0xF800 | pmlmeinfo->aid)); -+ -+ /* Enable SW TX beacon - Set REG_CR bit 8. DMA beacon by SW */ -+ v8 = rtw_read8(adapter, REG_CR_8821C + 1); -+ org_cr = v8; -+ v8 |= (BIT_ENSWBCN_8821C >> 8); -+ rtw_write8(adapter, REG_CR_8821C + 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. -+ */ -+ val8 = rtw_read8(adapter, REG_BCN_CTRL_8821C); -+ org_bcn = val8; -+ val8 &= ~BIT_EN_BCN_FUNCTION_8821C; -+ val8 |= BIT_DIS_TSF_UDT_8821C; -+ rtw_write8(adapter, REG_BCN_CTRL_8821C, val8); -+ -+#if 0 -+ /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ -+ RegFwHwTxQCtrl = rtw_read8(adapter, REG_FWHW_TXQ_CTRL_8821C + 2); -+ -+ if (RegFwHwTxQCtrl & BIT(6)) -+ bRecover = _TRUE; -+ -+ /* To tell Hw the packet is not a real beacon frame. */ -+ RegFwHwTxQCtrl &= ~BIT(6); -+ rtw_write8(adapter, REG_FWHW_TXQ_CTRL_8821C + 2, RegFwHwTxQCtrl); -+#endif -+ -+ /* Clear beacon valid check bit. */ -+ rtw_hal_set_hwreg(adapter, HW_VAR_BCN_VALID, NULL); -+ -+ DLBcnCount = 0; -+ poll = 0; -+ do { -+ /* download rsvd page. */ -+ rtw_hal_set_fw_rsvd_page(adapter, _FALSE); -+ DLBcnCount++; -+ do { -+ rtw_yield_os(); -+ -+ /* check rsvd page download OK. */ -+ rtw_hal_get_hwreg(adapter, HW_VAR_BCN_VALID, (u8 *)(&bcn_valid)); -+ poll++; -+ } while (!bcn_valid && (poll % 10) != 0 && !RTW_CANNOT_RUN(adapter)); -+ -+ } while (!bcn_valid && DLBcnCount <= 100 && !RTW_CANNOT_RUN(adapter)); -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ ; -+ else if (!bcn_valid) -+ RTW_ERR(FUNC_ADPT_FMT ": DL RSVD page failed! DLBcnCount:%u, poll:%u\n", -+ FUNC_ADPT_ARG(adapter), DLBcnCount, poll); -+ else { -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ -+ pwrctl->fw_psmode_iface_id = adapter->iface_id; -+ rtw_hal_set_fw_rsvd_page(adapter, _TRUE); -+ RTW_INFO(ADPT_FMT ": DL RSVD page success! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(adapter), DLBcnCount, poll); -+ } -+ -+ rtw_write8(adapter, REG_CR_8821C + 1, org_cr); -+ rtw_write8(adapter, REG_BCN_CTRL_8821C, org_bcn); -+#if 0 -+ /* -+ * 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. -+ */ -+ if (bRecover) { -+ RegFwHwTxQCtrl |= BIT(6); -+ rtw_write8(adapter, REG_FWHW_TXQ_CTRL_8821C + 2, RegFwHwTxQCtrl); -+ } -+#endif -+#ifndef CONFIG_PCI_HCI -+ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ -+ v8 = rtw_read8(adapter, REG_CR_8821C + 1); -+ v8 &= ~BIT(0); /* ~ENSWBCN */ -+ rtw_write8(adapter, REG_CR_8821C + 1, v8); -+#endif /* !CONFIG_PCI_HCI */ -+ } -+ -+} -+ -+static void rtl8821c_set_h2c_fw_joinbssrpt(PADAPTER adapter, u8 mstatus) -+{ -+ if (mstatus == RT_MEDIA_CONNECT) -+ rtl8821c_dl_rsvd_page(adapter, RT_MEDIA_CONNECT); -+} -+ -+#ifdef CONFIG_WOWLAN -+static void hw_var_vendor_wow_mode(_adapter *adapter, u8 en) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *iface = NULL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 igi = 0, mac_addr[ETH_ALEN]; -+ -+ RTW_INFO("%s: en(%d)--->\n", __func__, en); -+ if (en) { -+ rtw_hal_get_hwreg(adapter, HW_VAR_MAC_ADDR, mac_addr); -+ /* RTW_INFO("suspend mac addr: "MAC_FMT"\n", MAC_ARG(mac_addr)); */ -+ rtw_halmac_set_bssid(dvobj, HW_PORT4, mac_addr); -+ dvobj->rxfltmap2_bf_suspend = rtw_read16(adapter, REG_RXFLTMAP2); -+ dvobj->bcn_ctrl_clint3_bf_suspend = rtw_read8(adapter, REG_BCN_CTRL_CLINT3); -+ dvobj->rcr_bf_suspend = rtw_read32(adapter, REG_RCR); -+ dvobj->cr_ext_bf_suspend = rtw_read32(adapter, REG_CR_EXT); -+ /*RTW_INFO("RCR: 0x%02x, REG_CR_EXT: 0x%02x , REG_BCN_CTRL_CLINT3: 0x%02x, REG_RXFLTMAP2:0x%02x, REG_MACID_DROP0_8822B:0x%02x\n" -+ , rtw_read32(adapter, REG_RCR), rtw_read8(adapter, REG_CR_EXT), rtw_read8(adapter, REG_BCN_CTRL_CLINT3) -+ , rtw_read32(adapter, REG_RXFLTMAP2), rtw_read8(adapter, REG_MACID_DROP0_8822B)); */ -+ rtw_write32(adapter, REG_RCR, (rtw_read32(adapter, REG_RCR) & (~(RCR_AM))) | RCR_CBSSID_DATA | RCR_CBSSID_BCN); -+ /* set PORT4 to ad hoc mode to filter not necessary Beacons */ -+ rtw_write8(adapter, REG_CR_EXT, (rtw_read8(adapter, REG_CR_EXT)& (~BIT5)) | BIT4); -+ rtw_write8(adapter, REG_BCN_CTRL_CLINT3, rtw_read8(adapter, REG_BCN_CTRL_CLINT3) | BIT3); -+ rtw_write16(adapter, REG_RXFLTMAP2, 0xffff); -+ /* RTW_INFO("RCR: 0x%02x, REG_CR_EXT: 0x%02x , REG_BCN_CTRL_CLINT3: 0x%02x, REG_RXFLTMAP2:0x%02x, REG_MACID_DROP0_8822B:0x%02x\n" -+ , rtw_read32(adapter, REG_RCR), rtw_read8(adapter, REG_CR_EXT), rtw_read8(adapter, REG_BCN_CTRL_CLINT3) -+ , rtw_read32(adapter, REG_RXFLTMAP2), rtw_read8(adapter, REG_MACID_DROP0_8822B)); */ -+ -+ /* The WRC's RSSI is weak. Set the IGI to lower */ -+ odm_write_dig(adapter_to_phydm(adapter), 0x24); -+ } else { -+ /* restore the rcr, port ctrol setting */ -+ rtw_write32(adapter, REG_CR_EXT, dvobj->cr_ext_bf_suspend); -+ rtw_write32(adapter, REG_RCR, dvobj->rcr_bf_suspend); -+ rtw_write8(adapter, REG_BCN_CTRL_CLINT3, dvobj->bcn_ctrl_clint3_bf_suspend); -+ rtw_write16(adapter, REG_RXFLTMAP2, dvobj->rxfltmap2_bf_suspend); -+ -+ /* RTW_INFO("RCR: 0x%02x, REG_CR_EXT: 0x%02x , REG_BCN_CTRL_CLINT3: 0x%02x, REG_RXFLTMAP2:0x%02x, REG_MACID_DROP0_8822B:0x%02x\n" -+ , rtw_read32(adapter, REG_RCR), rtw_read8(adapter, REG_CR_EXT), rtw_read8(adapter, REG_BCN_CTRL_CLINT3) -+ , rtw_read32(adapter, REG_RXFLTMAP2), rtw_read8(adapter, REG_MACID_DROP0_8822B)); */ -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+} -+#endif /* CONFIG_WOWLAN */ -+ -+/* -+ * Parameters: -+ * adapter -+ * enable _TRUE: enable; _FALSE: disable -+ */ -+static u8 rx_agg_switch(PADAPTER adapter, u8 enable) -+{ -+ /* if (rtl8821c_config_rx_agg(adapter, enable)) */ -+ return _SUCCESS; -+ -+ return _FAIL; -+} -+ -+u8 rtl8821c_sethwreg(PADAPTER adapter, u8 variable, u8 *val) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ u8 ret = _SUCCESS; -+ u8 val8; -+ u16 val16; -+ u32 val32; -+ -+ -+ switch (variable) { -+ case HW_VAR_SET_OPMODE: -+ hw_var_set_opmode(adapter, val); -+ break; -+ /* -+ case HW_VAR_INIT_RTS_RATE: -+ break; -+ */ -+ case HW_VAR_BASIC_RATE: -+ rtw_var_set_basic_rate(adapter, val); -+ break; -+ -+ case HW_VAR_TXPAUSE: -+ rtw_write8(adapter, REG_TXPAUSE_8821C, *val); -+ break; -+ -+ case HW_VAR_BCN_FUNC: -+ hw_var_set_bcn_func(adapter, *val); -+ break; -+ -+ case HW_VAR_PORT_CFG: -+ hw_var_hw_port_cfg(adapter, *val); -+ break; -+ -+ case HW_VAR_MLME_DISCONNECT: -+ hw_var_set_mlme_disconnect(adapter); -+ break; -+ -+ case HW_VAR_MLME_SITESURVEY: -+ hw_var_set_mlme_sitesurvey(adapter, *val); -+#ifdef CONFIG_BT_COEXIST -+ if (hal->EEPROMBluetoothCoexist) -+ rtw_btcoex_ScanNotify(adapter, *val ? _TRUE : _FALSE); -+ else -+#endif /* CONFIG_BT_COEXIST */ -+ rtw_btcoex_wifionly_scan_notify(adapter); -+ break; -+ -+ case HW_VAR_MLME_JOIN: -+ hw_var_set_mlme_join(adapter, *val); -+ break; -+ -+ case HW_VAR_SLOT_TIME: -+ rtw_write8(adapter, REG_SLOT_8821C, *val); -+ break; -+ -+ case HW_VAR_RESP_SIFS: -+ /* RESP_SIFS for CCK */ -+ rtw_write8(adapter, REG_RESP_SIFS_CCK_8821C, 0x08); -+ rtw_write8(adapter, REG_RESP_SIFS_CCK_8821C + 1, 0x08); -+ /* RESP_SIFS for OFDM */ -+ rtw_write8(adapter, REG_RESP_SIFS_OFDM_8821C, 0x0a); -+ rtw_write8(adapter, REG_RESP_SIFS_OFDM_8821C + 1, 0x0a); -+ break; -+ -+ case HW_VAR_ACK_PREAMBLE: -+ hw_var_set_ack_preamble(adapter, *val); -+ break; -+ -+ case HW_VAR_SEC_CFG: -+ hw_var_set_sec_cfg(adapter, *val); -+ break; -+ -+ case HW_VAR_SEC_DK_CFG: -+ if (val) -+ hw_var_set_sec_dk_cfg(adapter, _TRUE); -+ else -+ hw_var_set_sec_dk_cfg(adapter, _FALSE); -+ break; -+ -+ case HW_VAR_BCN_VALID: -+ hw_var_set_bcn_valid(adapter); -+ break; -+ -+ case HW_VAR_CAM_INVALID_ALL: -+ val32 = BIT_SECCAM_POLLING_8821C | BIT_SECCAM_CLR_8821C; -+ rtw_write32(adapter, REG_CAMCMD_8821C, val32); -+ break; -+ -+ case HW_VAR_AC_PARAM_VO: -+ rtw_write32(adapter, REG_EDCA_VO_PARAM_8821C, *(u32 *)val); -+ break; -+ -+ case HW_VAR_AC_PARAM_VI: -+ rtw_write32(adapter, REG_EDCA_VI_PARAM_8821C, *(u32 *)val); -+ break; -+ -+ case HW_VAR_AC_PARAM_BE: -+ hal->ac_param_be = *(u32 *)val; -+ rtw_write32(adapter, REG_EDCA_BE_PARAM_8821C, *(u32 *)val); -+ break; -+ -+ case HW_VAR_AC_PARAM_BK: -+ rtw_write32(adapter, REG_EDCA_BK_PARAM_8821C, *(u32 *)val); -+ break; -+ -+ case HW_VAR_ACM_CTRL: -+ hw_var_set_acm_ctrl(adapter, *val); -+ break; -+ /* -+ case HW_VAR_AMPDU_MIN_SPACE: -+ break; -+ */ -+#ifdef CONFIG_80211N_HT -+ case HW_VAR_AMPDU_FACTOR: { -+ u32 AMPDULen = *val; /* enum AGGRE_SIZE */ -+ -+ AMPDULen = (0x2000 << AMPDULen) - 1; -+ rtw_write32(adapter, REG_AMPDU_MAX_LENGTH_8821C, AMPDULen); -+ } -+ break; -+#endif /* CONFIG_80211N_HT */ -+ case HW_VAR_RXDMA_AGG_PG_TH: -+ /* -+ * TH=1 => invalidate RX DMA aggregation -+ * TH=0 => validate RX DMA aggregation, use init value. -+ */ -+ if (*val == 0) -+ /* enable RXDMA aggregation */ -+ rx_agg_switch(adapter, _TRUE); -+ else -+ /* disable RXDMA aggregation */ -+ rx_agg_switch(adapter, _FALSE); -+ break; -+ -+ case HW_VAR_H2C_FW_PWRMODE: -+ rtl8821c_set_FwPwrMode_cmd(adapter, *val); -+ break; -+ -+ case HW_VAR_H2C_FW_PWRMODE_RFON_CTRL: -+ rtl8821c_set_FwPwrMode_rfon_ctrl_cmd(adapter, *val); -+ break; -+ -+ case HW_VAR_LPS_RFON_CHK : -+ hw_var_lps_rfon_chk(adapter, *val); -+ break; -+ /* -+ case HW_VAR_H2C_PS_TUNE_PARAM: -+ break; -+ */ -+ case HW_VAR_H2C_FW_JOINBSSRPT: -+ rtl8821c_set_h2c_fw_joinbssrpt(adapter, *val); -+ break; -+ case HW_VAR_H2C_INACTIVE_IPS: -+#ifdef CONFIG_WOWLAN -+ rtl8821c_set_fw_pwrmode_inips_cmd_wowlan(adapter, *val); -+#endif /* CONFIG_WOWLAN */ -+#ifdef CONFIG_WOWLAN -+ case HW_VAR_VENDOR_WOW_MODE: -+ hw_var_vendor_wow_mode(adapter, *(u8 *)val); -+ break; -+#endif /* CONFIG_WOWLAN */ -+ case HW_VAR_DL_RSVD_PAGE: -+ #ifdef CONFIG_BT_COEXIST -+ if (check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ rtl8821c_download_BTCoex_AP_mode_rsvd_page(adapter); -+ #endif -+ break; -+#ifdef CONFIG_P2P -+ case HW_VAR_H2C_FW_P2P_PS_OFFLOAD: -+ #ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ if (*val == P2P_PS_ENABLE) -+ rtw_set_default_port_id(adapter); -+ #endif -+ rtw_set_p2p_ps_offload_cmd(adapter, *val); -+ break; -+#endif -+ -+ /* -+ case HW_VAR_TRIGGER_GPIO_0: -+ case HW_VAR_BT_SET_COEXIST: -+ case HW_VAR_BT_ISSUE_DELBA: -+ break; -+ */ -+ -+ /* -+ case HW_VAR_SWITCH_EPHY_WoWLAN: -+ case HW_VAR_EFUSE_USAGE: -+ case HW_VAR_EFUSE_BYTES: -+ case HW_VAR_EFUSE_BT_USAGE: -+ case HW_VAR_EFUSE_BT_BYTES: -+ break; -+ */ -+ case HW_VAR_FIFO_CLEARN_UP: { -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ u8 trycnt = 100; -+ u32 reg_hw_ssn; -+ -+ /* pause tx */ -+ rtw_write8(adapter, REG_TXPAUSE_8821C, 0xff); -+ -+ /* keep hw sn */ -+ if (adapter->xmitpriv.hw_ssn_seq_no == 1) -+ reg_hw_ssn = REG_HW_SEQ1_8821C; -+ else if (adapter->xmitpriv.hw_ssn_seq_no == 2) -+ reg_hw_ssn = REG_HW_SEQ2_8821C; -+ else if (adapter->xmitpriv.hw_ssn_seq_no == 3) -+ reg_hw_ssn = REG_HW_SEQ3_8821C; -+ else -+ reg_hw_ssn = REG_HW_SEQ0_8821C; -+ -+ adapter->xmitpriv.nqos_ssn = rtw_read16(adapter, reg_hw_ssn); -+ -+ if (pwrpriv->bkeepfwalive != _TRUE) { -+ /* RX DMA stop */ -+ val32 = rtw_read32(adapter, REG_RXPKT_NUM_8821C); -+ val32 |= BIT_RW_RELEASE_EN; -+ rtw_write32(adapter, REG_RXPKT_NUM_8821C, val32); -+ do { -+ val32 = rtw_read32(adapter, REG_RXPKT_NUM_8821C); -+ val32 &= BIT_RXDMA_IDLE_8821C; -+ if (val32) -+ break; -+ -+ RTW_INFO("[HW_VAR_FIFO_CLEARN_UP] val=%x times:%d\n", val32, trycnt); -+ rtw_yield_os(); -+ } while (--trycnt); -+ if (trycnt == 0) -+ RTW_INFO("[HW_VAR_FIFO_CLEARN_UP] Stop RX DMA failed!\n"); -+#if 0 -+ /* RQPN Load 0 */ -+ rtw_write16(adapter, REG_RQPN_NPQ, 0); -+ rtw_write32(adapter, REG_RQPN, 0x80000000); -+ rtw_mdelay_os(2); -+#endif -+ } -+ } -+ break; -+ -+ case HW_VAR_RESTORE_HW_SEQ: { -+ /* restore Sequence No. */ -+ u32 reg_hw_ssn; -+ -+ if (adapter->xmitpriv.hw_ssn_seq_no == 1) -+ reg_hw_ssn = REG_HW_SEQ1_8821C; -+ else if (adapter->xmitpriv.hw_ssn_seq_no == 2) -+ reg_hw_ssn = REG_HW_SEQ2_8821C; -+ else if (adapter->xmitpriv.hw_ssn_seq_no == 3) -+ reg_hw_ssn = REG_HW_SEQ3_8821C; -+ else -+ reg_hw_ssn = REG_HW_SEQ0_8821C; -+ -+ rtw_write8(adapter, reg_hw_ssn, adapter->xmitpriv.nqos_ssn); -+ } -+ break; -+ -+ case HW_VAR_CHECK_TXBUF: { -+ u16 rtylmtorg; -+ u8 RetryLimit = 0x01; -+ systime start; -+ u32 passtime; -+ u32 timelmt = 2000; /* ms */ -+ u32 waittime = 10; /* ms */ -+ u32 high, low, normal, extra, publc; -+ u16 rsvd, available; -+ u8 empty; -+ -+ -+ rtylmtorg = rtw_read16(adapter, REG_RETRY_LIMIT_8821C); -+ -+ val16 = BIT_LRL_8821C(RetryLimit) | BIT_SRL_8821C(RetryLimit); -+ rtw_write16(adapter, REG_RETRY_LIMIT_8821C, val16); -+ -+ /* Check TX FIFO empty or not */ -+ empty = _FALSE; -+ high = 0; -+ low = 0; -+ normal = 0; -+ extra = 0; -+ publc = 0; -+ start = rtw_get_current_time(); -+ while ((rtw_get_passing_time_ms(start) < timelmt) -+ && !RTW_CANNOT_RUN(adapter)) { -+ high = rtw_read32(adapter, REG_FIFOPAGE_INFO_1_8821C); -+ low = rtw_read32(adapter, REG_FIFOPAGE_INFO_2_8821C); -+ normal = rtw_read32(adapter, REG_FIFOPAGE_INFO_3_8821C); -+ extra = rtw_read32(adapter, REG_FIFOPAGE_INFO_4_8821C); -+ publc = rtw_read32(adapter, REG_FIFOPAGE_INFO_5_8821C); -+ -+ rsvd = BIT_GET_HPQ_V1_8821C(high); -+ available = BIT_GET_HPQ_AVAL_PG_V1_8821C(high); -+ if (rsvd != available) { -+ rtw_msleep_os(waittime); -+ continue; -+ } -+ -+ rsvd = BIT_GET_LPQ_V1_8821C(low); -+ available = BIT_GET_LPQ_AVAL_PG_V1_8821C(low); -+ if (rsvd != available) { -+ rtw_msleep_os(waittime); -+ continue; -+ } -+ -+ rsvd = BIT_GET_NPQ_V1_8821C(normal); -+ available = BIT_GET_NPQ_AVAL_PG_V1_8821C(normal); -+ if (rsvd != available) { -+ rtw_msleep_os(waittime); -+ continue; -+ } -+ -+ rsvd = BIT_GET_EXQ_V1_8821C(extra); -+ available = BIT_GET_EXQ_AVAL_PG_V1_8821C(extra); -+ if (rsvd != available) { -+ rtw_msleep_os(waittime); -+ continue; -+ } -+ -+ rsvd = BIT_GET_PUBQ_V1_8821C(publc); -+ available = BIT_GET_PUBQ_AVAL_PG_V1_8821C(publc); -+ if (rsvd != available) { -+ rtw_msleep_os(waittime); -+ continue; -+ } -+ -+ empty = _TRUE; -+ break; -+ } -+ -+ passtime = rtw_get_passing_time_ms(start); -+ if (_TRUE == empty) -+ RTW_INFO("[HW_VAR_CHECK_TXBUF] Empty in %d ms\n", passtime); -+ else if (RTW_CANNOT_RUN(adapter)) -+ RTW_INFO("[HW_VAR_CHECK_TXBUF] bDriverStopped or bSurpriseRemoved\n"); -+ else { -+ RTW_INFO("[HW_VAR_CHECK_TXBUF] NOT empty in %d ms\n", passtime); -+ RTW_INFO("[HW_VAR_CHECK_TXBUF] 0x230=0x%08x 0x234=0x%08x 0x238=0x%08x 0x23c=0x%08x 0x240=0x%08x\n", -+ high, low, normal, extra, publc); -+ -+ } -+ -+ rtw_write16(adapter, REG_RETRY_LIMIT_8821C, rtylmtorg); -+ } -+ break; -+ /* -+ case HW_VAR_PCIE_STOP_TX_DMA: -+ break; -+ */ -+ -+ /* -+ case HW_VAR_SYS_CLKR: -+ break; -+ */ -+#ifdef CONFIG_GPIO_WAKEUP -+ case HW_SET_GPIO_WL_CTRL: { -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ u8 enable = *val; -+ u8 value = 0; -+ u8 addr = REG_PAD_CTRL1_8821C + 3; -+ -+ if (pwrpriv->wowlan_gpio_index == 6) { -+ value = rtw_read8(adapter, addr); -+ -+ if (enable == _TRUE && (value & BIT(1))) -+ /* set 0x64[25] = 0 to control GPIO 6 */ -+ rtw_write8(adapter, addr, value & (~BIT(1))); -+ else if (enable == _FALSE) -+ rtw_write8(adapter, addr, value | BIT(1)); -+ -+ RTW_INFO("[HW_SET_GPIO_WL_CTRL] 0x%02X=0x%02X\n", -+ addr, rtw_read8(adapter, addr)); -+ } -+ } -+ break; -+#endif -+ case HW_VAR_NAV_UPPER: { -+#define HAL_NAV_UPPER_UNIT 128 /* micro-second */ -+ u32 usNavUpper = *(u32 *)val; -+ -+ if (usNavUpper > HAL_NAV_UPPER_UNIT * 0xFF) { -+ RTW_INFO(FUNC_ADPT_FMT ": [HW_VAR_NAV_UPPER] value(0x%08X us) is larger than (%d * 0xFF)!!!\n", -+ FUNC_ADPT_ARG(adapter), usNavUpper, HAL_NAV_UPPER_UNIT); -+ break; -+ } -+ -+ usNavUpper = (usNavUpper + HAL_NAV_UPPER_UNIT - 1) / HAL_NAV_UPPER_UNIT; -+ rtw_write8(adapter, REG_NAV_CTRL_8821C + 2, (u8)usNavUpper); -+ } -+ break; -+ -+ /* -+ case HW_VAR_RPT_TIMER_SETTING: -+ case HW_VAR_TX_RPT_MAX_MACID: -+ case HW_VAR_CHK_HI_QUEUE_EMPTY: -+ break; -+ */ -+ -+ /* -+ case HW_VAR_AMPDU_MAX_TIME: -+ case HW_VAR_USB_MODE: -+ break; -+ */ -+#ifdef CONFIG_AP_PORT_SWAP -+ case HW_VAR_PORT_SWITCH: -+ { -+ u8 mode = *((u8 *)val); -+ -+ rtl8821c_ap_port_switch(adapter, mode); -+ } -+ break; -+#endif -+ -+ /* -+ case HW_VAR_SOUNDING_RATE: -+ case HW_VAR_SOUNDING_STATUS: -+ case HW_VAR_SOUNDING_FW_NDPA: -+ case HW_VAR_SOUNDING_CLK: -+ break; -+ */ -+#ifdef CONFIG_BEAMFORMING -+ case HW_VAR_SOUNDING_ENTER: -+ rtl8821c_phy_bf_enter(adapter, (struct sta_info*)val); -+ break; -+ -+ case HW_VAR_SOUNDING_LEAVE: -+ rtl8821c_phy_bf_leave(adapter, val); -+ break; -+ -+ case HW_VAR_SOUNDING_SET_GID_TABLE: -+ rtl8821c_phy_bf_set_gid_table(adapter, (struct beamformer_entry*)val); -+ break; -+#endif -+ case HW_VAR_FREECNT: -+ -+ val8 = *((u8*)val); -+ -+ if (val8 == 0) { -+ /* disable free run counter set 0x577[3]=0 */ -+ rtw_write8(adapter, REG_MISC_CTRL, -+ rtw_read8(adapter, REG_MISC_CTRL)&(~BIT_EN_FREECNT)); -+ -+ /* reset FREE_RUN_COUNTER set 0x553[5]=1 */ -+ val8 = rtw_read8(adapter, REG_DUAL_TSF_RST); -+ val8 |= BIT_FREECNT_RST; -+ rtw_write8(adapter, REG_DUAL_TSF_RST, val8); -+ -+ } else if (val8 == 1){ -+ -+ /* enable free run counter */ -+ -+ /* disable first set 0x577[3]=0 */ -+ rtw_write8(adapter, REG_MISC_CTRL, -+ rtw_read8(adapter, REG_MISC_CTRL)&(~BIT_EN_FREECNT)); -+ -+ /* reset FREE_RUN_COUNTER set 0x553[5]=1 */ -+ val8 = rtw_read8(adapter, REG_DUAL_TSF_RST); -+ val8 |= BIT_FREECNT_RST; -+ rtw_write8(adapter, REG_DUAL_TSF_RST, val8); -+ -+ /* enable free run counter 0x577[3]=1 */ -+ rtw_write8(adapter, REG_MISC_CTRL, -+ rtw_read8(adapter, REG_MISC_CTRL)|BIT_EN_FREECNT); -+ } -+ break; -+ -+ default: -+ ret = SetHwReg(adapter, variable, val); -+ break; -+ } -+ -+ return ret; -+} -+ -+#ifdef CONFIG_PROC_DEBUG -+struct qinfo { -+ u32 head:11; -+ u32 tail:11; -+ u32 empty:1; -+ u32 ac:2; -+ u32 macid:7; -+}; -+ -+struct bcn_qinfo { -+ u16 head:12; -+ u16 rsvd:4; -+}; -+ -+static void dump_qinfo(void *sel, struct qinfo *info, u32 pkt_num, const char *tag) -+{ -+ RTW_PRINT_SEL(sel, "%shead:0x%02x, tail:0x%02x, pkt_num:%u, macid:%u, ac:%u\n", -+ tag ? tag : "", info->head, info->tail, pkt_num, info->macid, info->ac); -+} -+ -+static void dump_bcn_qinfo(void *sel, struct bcn_qinfo *info, u32 pkt_num, const char *tag) -+{ -+ RTW_PRINT_SEL(sel, "%shead:0x%02x, pkt_num:%u\n", -+ tag ? tag : "", info->head, pkt_num); -+} -+ -+static void dump_mac_qinfo(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; -+ u32 q0_q1_info; -+ u32 q2_q3_info; -+ u32 q4_q5_info; -+ u32 q6_q7_info; -+ u32 mg_hi_q_info; -+ u32 cmd_bcn_q_info; -+ -+ -+ q0_info = rtw_read32(adapter, REG_Q0_INFO_8821C); -+ q1_info = rtw_read32(adapter, REG_Q1_INFO_8821C); -+ q2_info = rtw_read32(adapter, REG_Q2_INFO_8821C); -+ q3_info = rtw_read32(adapter, REG_Q3_INFO_8821C); -+ q4_info = rtw_read32(adapter, REG_Q4_INFO_8821C); -+ q5_info = rtw_read32(adapter, REG_Q5_INFO_8821C); -+ q6_info = rtw_read32(adapter, REG_Q6_INFO_8821C); -+ q7_info = rtw_read32(adapter, REG_Q7_INFO_8821C); -+ mg_q_info = rtw_read32(adapter, REG_MGQ_INFO_8821C); -+ hi_q_info = rtw_read32(adapter, REG_HIQ_INFO_8821C); -+ bcn_q_info = rtw_read16(adapter, REG_BCNQ_INFO_8821C); -+ -+ q0_q1_info = rtw_read32(adapter, REG_Q0_Q1_INFO_8821C); -+ q2_q3_info = rtw_read32(adapter, REG_Q2_Q3_INFO_8821C); -+ q4_q5_info = rtw_read32(adapter, REG_Q4_Q5_INFO_8821C); -+ q6_q7_info = rtw_read32(adapter, REG_Q6_Q7_INFO_8821C); -+ mg_hi_q_info = rtw_read32(adapter, REG_MGQ_HIQ_INFO_8821C); -+ cmd_bcn_q_info = rtw_read32(adapter, REG_CMDQ_BCNQ_INFO_8821C); -+ -+ dump_qinfo(sel, (struct qinfo *)&q0_info, q0_q1_info&0xFFF, "Q0 "); -+ dump_qinfo(sel, (struct qinfo *)&q1_info, (q0_q1_info>>15)&0xFFF, "Q1 "); -+ dump_qinfo(sel, (struct qinfo *)&q2_info, q2_q3_info&0xFFF, "Q2 "); -+ dump_qinfo(sel, (struct qinfo *)&q3_info, (q2_q3_info>>15)&0xFFF, "Q3 "); -+ dump_qinfo(sel, (struct qinfo *)&q4_info, q4_q5_info&0xFFF, "Q4 "); -+ dump_qinfo(sel, (struct qinfo *)&q5_info, (q4_q5_info>>15)&0xFFF, "Q5 "); -+ dump_qinfo(sel, (struct qinfo *)&q6_info, q6_q7_info&0xFFF, "Q6 "); -+ dump_qinfo(sel, (struct qinfo *)&q7_info, (q6_q7_info>>15)&0xFFF, "Q7 "); -+ dump_qinfo(sel, (struct qinfo *)&mg_q_info, mg_hi_q_info&0xFFF, "MG "); -+ dump_qinfo(sel, (struct qinfo *)&hi_q_info, (mg_hi_q_info>>15)&0xFFF, "HI "); -+ dump_bcn_qinfo(sel, (struct bcn_qinfo *)&bcn_q_info, cmd_bcn_q_info&0xFFF, "BCN "); -+ -+} -+ -+static void dump_mac_txfifo(void *sel, _adapter *adapter) -+{ -+ u32 hpq, lpq, npq, epq, pubq; -+ -+ hpq = rtw_read32(adapter, REG_FIFOPAGE_INFO_1_8821C); -+ lpq = rtw_read32(adapter, REG_FIFOPAGE_INFO_2_8821C); -+ npq = rtw_read32(adapter, REG_FIFOPAGE_INFO_3_8821C); -+ epq = rtw_read32(adapter, REG_FIFOPAGE_INFO_4_8821C); -+ pubq = rtw_read32(adapter, REG_FIFOPAGE_INFO_5_8821C); -+ -+ hpq = (hpq & 0xFFF0000)>>16; -+ lpq = (lpq & 0xFFF0000)>>16; -+ npq = (npq & 0xFFF0000)>>16; -+ epq = (epq & 0xFFF0000)>>16; -+ pubq = (pubq & 0xFFF0000)>>16; -+ -+ RTW_PRINT_SEL(sel, "Tx: available page num: "); -+ if ((hpq == 0xAEA) && (hpq == lpq) && (hpq == pubq)) -+ RTW_PRINT_SEL(sel, "N/A (reg val = 0xea)\n"); -+ else -+ RTW_PRINT_SEL(sel, "HPQ: %d, LPQ: %d, NPQ: %d, EPQ: %d, PUBQ: %d\n" -+ , hpq, lpq, npq, epq, pubq); -+} -+#endif -+ -+static u8 hw_var_get_bcn_valid(PADAPTER adapter) -+{ -+ u8 val8 = 0; -+ u8 ret = _FALSE; -+ -+ /* only port 0 can TX BCN */ -+ val8 = rtw_read8(adapter, REG_FIFOPAGE_CTRL_2_8821C + 1); -+ ret = (BIT(7) & val8) ? _TRUE : _FALSE; -+ -+ return ret; -+} -+ -+void rtl8821c_read_wmmedca_reg(PADAPTER adapter, u16 *vo_params, u16 *vi_params, u16 *be_params, u16 *bk_params) -+{ -+ u8 vo_reg_params[4]; -+ u8 vi_reg_params[4]; -+ u8 be_reg_params[4]; -+ u8 bk_reg_params[4]; -+ -+ rtl8821c_gethwreg(adapter, HW_VAR_AC_PARAM_VO, vo_reg_params); -+ rtl8821c_gethwreg(adapter, HW_VAR_AC_PARAM_VI, vi_reg_params); -+ rtl8821c_gethwreg(adapter, HW_VAR_AC_PARAM_BE, be_reg_params); -+ rtl8821c_gethwreg(adapter, HW_VAR_AC_PARAM_BK, bk_reg_params); -+ -+ vo_params[0] = vo_reg_params[0]; -+ vo_params[1] = vo_reg_params[1] & 0x0F; -+ vo_params[2] = (vo_reg_params[1] & 0xF0) >> 4; -+ vo_params[3] = ((vo_reg_params[3] << 8) | (vo_reg_params[2])) * 32; -+ -+ vi_params[0] = vi_reg_params[0]; -+ vi_params[1] = vi_reg_params[1] & 0x0F; -+ vi_params[2] = (vi_reg_params[1] & 0xF0) >> 4; -+ vi_params[3] = ((vi_reg_params[3] << 8) | (vi_reg_params[2])) * 32; -+ -+ be_params[0] = be_reg_params[0]; -+ be_params[1] = be_reg_params[1] & 0x0F; -+ be_params[2] = (be_reg_params[1] & 0xF0) >> 4; -+ be_params[3] = ((be_reg_params[3] << 8) | (be_reg_params[2])) * 32; -+ -+ bk_params[0] = bk_reg_params[0]; -+ bk_params[1] = bk_reg_params[1] & 0x0F; -+ bk_params[2] = (bk_reg_params[1] & 0xF0) >> 4; -+ bk_params[3] = ((bk_reg_params[3] << 8) | (bk_reg_params[2])) * 32; -+ -+ vo_params[1] = (1 << vo_params[1]) - 1; -+ vo_params[2] = (1 << vo_params[2]) - 1; -+ vi_params[1] = (1 << vi_params[1]) - 1; -+ vi_params[2] = (1 << vi_params[2]) - 1; -+ be_params[1] = (1 << be_params[1]) - 1; -+ be_params[2] = (1 << be_params[2]) - 1; -+ bk_params[1] = (1 << bk_params[1]) - 1; -+ bk_params[2] = (1 << bk_params[2]) - 1; -+} -+ -+void rtl8821c_gethwreg(PADAPTER adapter, u8 variable, u8 *val) -+{ -+ PHAL_DATA_TYPE hal; -+ u8 val8; -+ u16 val16; -+ u32 val32; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ switch (variable) { -+ /* -+ case HW_VAR_INIT_RTS_RATE: -+ case HW_VAR_BASIC_RATE: -+ break; -+ */ -+ case HW_VAR_TXPAUSE: -+ *val = rtw_read8(adapter, REG_TXPAUSE_8821C); -+ break; -+ /* -+ case HW_VAR_BCN_FUNC: -+ case HW_VAR_MLME_DISCONNECT: -+ case HW_VAR_MLME_SITESURVEY: -+ case HW_VAR_MLME_JOIN: -+ case HW_VAR_BEACON_INTERVAL: -+ case HW_VAR_SLOT_TIME: -+ case HW_VAR_RESP_SIFS: -+ case HW_VAR_ACK_PREAMBLE: -+ case HW_VAR_SEC_CFG: -+ case HW_VAR_SEC_DK_CFG: -+ break; -+ */ -+ case HW_VAR_BCN_VALID: -+ *val = hw_var_get_bcn_valid(adapter); -+ break; -+ /* -+ case HW_VAR_CAM_INVALID_ALL: -+ */ -+ case HW_VAR_AC_PARAM_VO: -+ val32 = rtw_read32(adapter, REG_EDCA_VO_PARAM); -+ val[0] = val32 & 0xFF; -+ val[1] = (val32 >> 8) & 0xFF; -+ val[2] = (val32 >> 16) & 0xFF; -+ val[3] = (val32 >> 24) & 0x07; -+ break; -+ -+ case HW_VAR_AC_PARAM_VI: -+ val32 = rtw_read32(adapter, REG_EDCA_VI_PARAM); -+ val[0] = val32 & 0xFF; -+ val[1] = (val32 >> 8) & 0xFF; -+ val[2] = (val32 >> 16) & 0xFF; -+ val[3] = (val32 >> 24) & 0x07; -+ break; -+ -+ case HW_VAR_AC_PARAM_BE: -+ val32 = rtw_read32(adapter, REG_EDCA_BE_PARAM); -+ val[0] = val32 & 0xFF; -+ val[1] = (val32 >> 8) & 0xFF; -+ val[2] = (val32 >> 16) & 0xFF; -+ val[3] = (val32 >> 24) & 0x07; -+ break; -+ -+ case HW_VAR_AC_PARAM_BK: -+ val32 = rtw_read32(adapter, REG_EDCA_BK_PARAM); -+ val[0] = val32 & 0xFF; -+ val[1] = (val32 >> 8) & 0xFF; -+ val[2] = (val32 >> 16) & 0xFF; -+ val[3] = (val32 >> 24) & 0x07; -+ break; -+ /* -+ case HW_VAR_ACM_CTRL: -+ case HW_VAR_AMPDU_MIN_SPACE: -+ case HW_VAR_AMPDU_FACTOR: -+ case HW_VAR_RXDMA_AGG_PG_TH: -+ case HW_VAR_H2C_FW_PWRMODE: -+ case HW_VAR_H2C_PS_TUNE_PARAM: -+ case HW_VAR_H2C_FW_JOINBSSRPT: -+ break; -+ */ -+ /* -+ case HW_VAR_H2C_FW_P2P_PS_OFFLOAD: -+ case HW_VAR_TRIGGER_GPIO_0: -+ case HW_VAR_BT_SET_COEXIST: -+ case HW_VAR_BT_ISSUE_DELBA: -+ break; -+ */ -+ -+ /* -+ case HW_VAR_ANTENNA_DIVERSITY_SELECT: -+ case HW_VAR_SWITCH_EPHY_WoWLAN: -+ case HW_VAR_EFUSE_USAGE: -+ case HW_VAR_EFUSE_BYTES: -+ case HW_VAR_EFUSE_BT_USAGE: -+ case HW_VAR_EFUSE_BT_BYTES: -+ case HW_VAR_FIFO_CLEARN_UP: -+ case HW_VAR_RESTORE_HW_SEQ: -+ case HW_VAR_CHECK_TXBUF: -+ case HW_VAR_PCIE_STOP_TX_DMA: -+ break; -+ */ -+ -+ -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ case HW_VAR_SYS_CLKR: -+ *val = rtw_read8(adapter, REG_SYS_CLK_CTRL_8821C); -+ break; -+#endif -+ /* -+ case HW_VAR_NAV_UPPER: -+ case HW_VAR_RPT_TIMER_SETTING: -+ case HW_VAR_TX_RPT_MAX_MACID: -+ break; -+ */ -+ case HW_VAR_CHK_HI_QUEUE_EMPTY: -+ val16 = rtw_read16(adapter, REG_TXPKT_EMPTY_8821C); -+ *val = (val16 & BIT_HQQ_EMPTY_8821C) ? _TRUE : _FALSE; -+ break; -+ case HW_VAR_CHK_MGQ_CPU_EMPTY: -+ val16 = rtw_read16(adapter, REG_TXPKT_EMPTY_8821C); -+ *val = (val16 & BIT_MGQ_CPU_EMPTY_8821C) ? _TRUE : _FALSE; -+ break; -+ /* -+ case HW_VAR_AMPDU_MAX_TIME: -+ case HW_VAR_USB_MODE: -+ case HW_VAR_DO_IQK: -+ case HW_VAR_SOUNDING_ENTER: -+ case HW_VAR_SOUNDING_LEAVE: -+ case HW_VAR_SOUNDING_RATE: -+ case HW_VAR_SOUNDING_STATUS: -+ case HW_VAR_SOUNDING_FW_NDPA: -+ case HW_VAR_SOUNDING_CLK: -+ break; -+ */ -+ case HW_VAR_FW_PS_STATE: -+ /* driver read REG_SYS_CFG5 - BIT_LPS_STATUS REG_1070[3] to get hw ps state */ -+ *((u16 *)val) = rtw_read8(adapter, REG_SYS_CFG5); -+ break; -+#ifdef CONFIG_PROC_DEBUG -+ case HW_VAR_DUMP_MAC_QUEUE_INFO: -+ dump_mac_qinfo(val, adapter); -+ break; -+ -+ case HW_VAR_DUMP_MAC_TXFIFO: -+ dump_mac_txfifo(val, adapter); -+ break; -+#endif -+ /* -+ case HW_VAR_ASIX_IOT: -+ case HW_VAR_H2C_BT_MP_OPER: -+ break; -+ */ -+ -+ case HW_VAR_BCN_CTRL_ADDR: -+ *((u32 *)val) = hw_bcn_ctrl_addr(adapter, adapter->hw_port); -+ break; -+ -+ case HW_VAR_FREECNT: -+ *val = rtw_read8(adapter, REG_MISC_CTRL)&BIT_EN_FREECNT; -+ break; -+ -+ default: -+ GetHwReg(adapter, variable, val); -+ break; -+ } -+} -+ -+/* -+ * Description: -+ * Change default setting of specified variable. -+ */ -+u8 rtl8821c_sethaldefvar(PADAPTER adapter, HAL_DEF_VARIABLE variable, void *pval) -+{ -+ PHAL_DATA_TYPE hal; -+ u8 bResult, val8; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ bResult = _SUCCESS; -+ -+ switch (variable) { -+ /* -+ case HAL_DEF_UNDERCORATEDSMOOTHEDPWDB: -+ case HAL_DEF_IS_SUPPORT_ANT_DIV: -+ case HAL_DEF_DRVINFO_SZ: -+ case HAL_DEF_MAX_RECVBUF_SZ: -+ case HAL_DEF_RX_PACKET_OFFSET: -+ case HAL_DEF_RX_DMA_SZ_WOW: -+ case HAL_DEF_RX_DMA_SZ: -+ case HAL_DEF_RX_PAGE_SIZE: -+ case HAL_DEF_DBG_DUMP_RXPKT: -+ case HAL_DEF_RA_DECISION_RATE: -+ case HAL_DEF_RA_SGI: -+ case HAL_DEF_PT_PWR_STATUS: -+ case HW_VAR_MAX_RX_AMPDU_FACTOR: -+ case HAL_DEF_DBG_DUMP_TXPKT: -+ case HAL_DEF_TX_PAGE_BOUNDARY: -+ case HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN: -+ case HAL_DEF_ANT_DETECT: -+ case HAL_DEF_PCI_SUUPORT_L1_BACKDOOR: -+ case HAL_DEF_PCI_AMD_L1_SUPPORT: -+ case HAL_DEF_PCI_ASPM_OSC: -+ case HAL_DEF_EFUSE_USAGE: -+ case HAL_DEF_EFUSE_BYTES: -+ case HW_VAR_BEST_AMPDU_DENSITY: -+ break; -+ */ -+ -+ default: -+ bResult = SetHalDefVar(adapter, variable, pval); -+ break; -+ } -+ -+ return bResult; -+} -+ -+void rtl8821c_ra_info_dump(_adapter *padapter, void *sel) -+{ -+ u8 mac_id; -+ struct sta_info *psta; -+ u32 rate_mask1, rate_mask2; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ -+ for (mac_id = 0; mac_id < macid_ctl->num; mac_id++) { -+ if (rtw_macid_is_used(macid_ctl, mac_id) && !rtw_macid_is_bmc(macid_ctl, mac_id)) { -+ psta = macid_ctl->sta[mac_id]; -+ if (!psta) -+ continue; -+ -+ dump_sta_info(sel, psta); -+ rate_mask1 = macid_ctl->rate_bmp0[mac_id]; -+ rate_mask2 = macid_ctl->rate_bmp1[mac_id]; -+ _RTW_PRINT_SEL(sel, "rate_mask2:0x%08x, rate_mask1:0x%08x\n", rate_mask2, rate_mask1); -+ } -+ } -+} -+ -+/* -+ * Description: -+ * Query setting of specified variable. -+ */ -+u8 rtl8821c_gethaldefvar(PADAPTER adapter, HAL_DEF_VARIABLE variable, void *pval) -+{ -+ PHAL_DATA_TYPE hal; -+ u8 bResult; -+ u8 val8 = 0; -+ u32 val32 = 0; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ bResult = _SUCCESS; -+ -+ switch (variable) { -+ /* -+ case HAL_DEF_UNDERCORATEDSMOOTHEDPWDB: -+ break; -+ */ -+ case HAL_DEF_IS_SUPPORT_ANT_DIV: -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ *(u8 *)pval = _TRUE; -+#else -+ *(u8 *)pval = _FALSE; -+#endif -+ break; -+ case HAL_DEF_MAX_RECVBUF_SZ: -+ *((u32 *)pval) = MAX_RECVBUF_SZ; -+ break; -+ case HAL_DEF_RX_PACKET_OFFSET: -+ rtw_halmac_get_rx_desc_size(adapter_to_dvobj(adapter), &val32); -+ rtw_halmac_get_rx_drv_info_sz(adapter_to_dvobj(adapter), &val8); -+ *((u32 *)pval) = val32 + val8; -+ break; -+ /* -+ case HAL_DEF_DRVINFO_SZ: -+ rtw_halmac_get_rx_drv_info_sz(adapter_to_dvobj(adapter), &val8); -+ *((u32 *)pval) = val8; -+ break; -+ case HAL_DEF_RX_DMA_SZ_WOW: -+ case HAL_DEF_RX_DMA_SZ: -+ case HAL_DEF_RX_PAGE_SIZE: -+ case HAL_DEF_DBG_DUMP_RXPKT: -+ case HAL_DEF_RA_DECISION_RATE: -+ case HAL_DEF_RA_SGI: -+ break; -+ */ -+ /* only for 8188E */ -+ case HAL_DEF_PT_PWR_STATUS: -+ break; -+ -+ case HAL_DEF_TX_LDPC: -+ *(u8 *)pval = ((hal->phy_spec.ldpc_cap >> 8) & 0xFF) ? _TRUE : _FALSE; -+ break; -+ -+ case HAL_DEF_RX_LDPC: -+ *(u8 *)pval = (hal->phy_spec.ldpc_cap & 0xFF) ? _TRUE : _FALSE; -+ break; -+ -+ case HAL_DEF_TX_STBC: -+ *(u8 *)pval = (((hal->phy_spec.stbc_cap >> 8) & 0xFF) && hal->max_tx_cnt > 1) ? _TRUE : _FALSE; -+ break; -+ -+ /* support 1RX for STBC */ -+ case HAL_DEF_RX_STBC: -+ *(u8 *)pval = hal->phy_spec.stbc_cap & 0xFF; -+ break; -+ -+ /* support Explicit TxBF for HT/VHT */ -+ case HAL_DEF_EXPLICIT_BEAMFORMER: -+#ifdef CONFIG_BEAMFORMING -+ *(u8 *)pval = ((hal->phy_spec.txbf_cap >> 20)& 0xF) ? _TRUE : _FALSE; -+#else -+ *(u8 *)pval = _FALSE; -+#endif -+ break; -+ -+ case HAL_DEF_EXPLICIT_BEAMFORMEE: -+#ifdef CONFIG_BEAMFORMING -+ *(u8 *)pval = ((hal->phy_spec.txbf_cap >> 16) & 0xF) ? _TRUE : _FALSE; -+#else -+ *(u8 *)pval = _FALSE; -+#endif -+ break; -+ -+ -+ case HAL_DEF_VHT_MU_BEAMFORMER: -+#ifdef CONFIG_BEAMFORMING -+ *(u8 *)pval = ((hal->phy_spec.txbf_cap >> 28)& 0xF) ? _TRUE : _FALSE; -+#else -+ *(u8 *)pval = _FALSE; -+#endif -+ break; -+ -+ case HAL_DEF_VHT_MU_BEAMFORMEE: -+#ifdef CONFIG_BEAMFORMING -+ *(u8 *)pval = ((hal->phy_spec.txbf_cap >> 24)& 0xF) ? _TRUE : _FALSE; -+#else -+ *(u8 *)pval = _FALSE; -+#endif -+ break; -+ -+ case HAL_DEF_BEAMFORMER_CAP: -+ *(u8 *)pval = (hal->phy_spec.txbf_param >> 24)& 0xFF ; -+ break; -+ -+ case HAL_DEF_BEAMFORMEE_CAP: -+ *(u8 *)pval = (hal->phy_spec.txbf_param >> 16) & 0xFF ; -+ break; -+ -+ case HW_DEF_RA_INFO_DUMP: -+ rtl8821c_ra_info_dump(adapter, pval); -+ break; -+ /* -+ case HAL_DEF_DBG_DUMP_TXPKT: -+ case HAL_DEF_TX_PAGE_SIZE: -+ break; -+ */ -+ case HAL_DEF_TX_PAGE_BOUNDARY: -+ rtw_halmac_get_rsvd_drv_pg_bndy(adapter_to_dvobj(adapter), (u16 *)pval); -+ break; -+ /* case HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN: -+ case HAL_DEF_ANT_DETECT: -+ case HAL_DEF_PCI_SUUPORT_L1_BACKDOOR: -+ case HAL_DEF_PCI_AMD_L1_SUPPORT: -+ case HAL_DEF_PCI_ASPM_OSC: -+ case HAL_DEF_EFUSE_USAGE: -+ case HAL_DEF_EFUSE_BYTES: -+ break; -+ */ -+ case HW_VAR_BEST_AMPDU_DENSITY: -+ *((u32 *)pval) = AMPDU_DENSITY_VALUE_4; -+ break; -+ -+ default: -+ bResult = GetHalDefVar(adapter, variable, pval); -+ break; -+ } -+ -+ return bResult; -+} -+ -+/* xmit section */ -+void rtl8821c_init_xmit_priv(_adapter *adapter) -+{ -+ struct xmit_priv *pxmitpriv = &adapter->xmitpriv; -+ -+ pxmitpriv->hw_ssn_seq_no = rtw_get_hwseq_no(adapter); -+ pxmitpriv->nqos_ssn = 0; -+} -+ -+ -+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_8821C(ptxdesc, 1); -+ SET_TX_DESC_MACID_8821C(ptxdesc, pattrib->bmc_camid); -+ } -+} -+ -+void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ SET_TX_DESC_USE_RATE_8821C(ptxdesc, 1); -+ SET_TX_DESC_DATARATE_8821C(ptxdesc, MRateToHwRate(pattrib->rate)); -+ SET_TX_DESC_DISDATAFB_8821C(ptxdesc, 1); -+} -+ -+void rtl8821c_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ if ((pattrib->encrypt > 0) && !pattrib->bswenc) { -+ /* SEC_TYPE : 0:NO_ENC,1:WEP40/TKIP,2:WAPI,3:AES */ -+ switch (pattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ case _TKIP_: -+ case _TKIP_WTMIC_: -+ SET_TX_DESC_SEC_TYPE_8821C(ptxdesc, 0x1); -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ SET_TX_DESC_SEC_TYPE_8821C(ptxdesc, 0x2); -+ break; -+#endif -+ case _AES_: -+ SET_TX_DESC_SEC_TYPE_8821C(ptxdesc, 0x3); -+ break; -+ case _CCMP_256_: -+ case _GCMP_: -+ case _GCMP_256_: -+ SET_TX_DESC_SEC_TYPE_8821C(ptxdesc, 0x2); -+ break; -+ case _NO_PRIVACY_: -+ default: -+ SET_TX_DESC_SEC_TYPE_8821C(ptxdesc, 0x0); -+ break; -+ } -+ } -+} -+ -+void rtl8821c_fill_txdesc_vcs(PADAPTER adapter, struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ if (pattrib->vcs_mode) { -+ switch (pattrib->vcs_mode) { -+ case RTS_CTS: -+ SET_TX_DESC_RTSEN_8821C(ptxdesc, 1); -+ break; -+ case CTS_TO_SELF: -+ SET_TX_DESC_CTS2SELF_8821C(ptxdesc, 1); -+ break; -+ case NONE_VCS: -+ default: -+ break; -+ } -+ -+ if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT) -+ SET_TX_DESC_RTS_SHORT_8821C(ptxdesc, 1); -+ -+ SET_TX_DESC_RTSRATE_8821C(ptxdesc, 0x8);/* RTS Rate=24M */ -+ SET_TX_DESC_RTS_RTY_LOWEST_RATE_8821C(ptxdesc, 0xf); -+ } -+} -+ -+u8 rtl8821c_bw_mapping(PADAPTER adapter, struct pkt_attrib *pattrib) -+{ -+ u8 BWSettingOfDesc = 0; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ -+ if (hal->current_channel_bw == 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 (hal->current_channel_bw == 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 rtl8821c_sc_mapping(PADAPTER adapter, struct pkt_attrib *pattrib) -+{ -+ u8 SCSettingOfDesc = 0; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ -+ if (hal->current_channel_bw == CHANNEL_WIDTH_80) { -+ if (pattrib->bwmode == CHANNEL_WIDTH_80) -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ else if (pattrib->bwmode == CHANNEL_WIDTH_40) { -+ if (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOfDesc = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if (hal->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 ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ else if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (hal->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 (hal->current_channel_bw == CHANNEL_WIDTH_40) { -+ if (pattrib->bwmode == CHANNEL_WIDTH_40) -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ else if (pattrib->bwmode == CHANNEL_WIDTH_20) { -+ if (hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if (hal->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; -+} -+ -+void rtl8821c_fill_txdesc_phy(PADAPTER adapter, struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ if (pattrib->ht_en) { -+ /* Set Bandwidth and sub-channel settings. */ -+ SET_TX_DESC_DATA_BW_8821C(ptxdesc, rtl8821c_bw_mapping(adapter, pattrib)); -+ SET_TX_DESC_DATA_SC_8821C(ptxdesc, rtl8821c_sc_mapping(adapter, pattrib)); -+ } -+} -+ -+void rtl8821c_cal_txdesc_chksum(PADAPTER adapter, u8 *ptxdesc) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ -+ -+ halmac = adapter_to_halmac(adapter); -+ api = HALMAC_GET_API(halmac); -+ -+ api->halmac_fill_txdesc_checksum(halmac, ptxdesc); -+} -+ -+ -+#ifdef CONFIG_MP_INCLUDED -+void rtl8821c_prepare_mp_txdesc(PADAPTER adapter, struct mp_priv *pmp_priv) -+{ -+ u32 desc_size = 0; -+ u8 *desc; -+ struct pkt_attrib *attrib; -+ u32 pkt_size; -+ s32 bmcast; -+ u8 data_rate, pwr_status, offset; -+ -+ rtw_halmac_get_tx_desc_size(adapter_to_dvobj(adapter), &desc_size); -+ -+ desc = pmp_priv->tx.desc; -+ attrib = &pmp_priv->tx.attrib; -+ pkt_size = attrib->last_txcmdsz; -+ bmcast = IS_MCAST(attrib->ra); -+ -+ SET_TX_DESC_LS_8821C(desc, 1); -+ SET_TX_DESC_TXPKTSIZE_8821C(desc, pkt_size); -+ -+ offset = desc_size; -+ SET_TX_DESC_OFFSET_8821C(desc, offset); -+ -+#if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) -+ SET_TX_DESC_PKT_OFFSET_8821C(desc, 0); /* Don't need to set PACKET Offset bit,it's no use 512bytes of length */ -+#else -+ SET_TX_DESC_PKT_OFFSET_8821C(desc, 1); -+#endif -+ -+ if (bmcast) -+ SET_TX_DESC_BMC_8821C(desc, 1); -+ -+ SET_TX_DESC_MACID_8821C(desc, attrib->mac_id); -+ SET_TX_DESC_RATE_ID_8821C(desc, attrib->raid); -+ SET_TX_DESC_QSEL_8821C(desc, attrib->qsel); -+ -+ if (pmp_priv->preamble) -+ SET_TX_DESC_DATA_SHORT_8821C(desc, 1); -+ -+ if (!attrib->qos_en) -+ SET_TX_DESC_EN_HWSEQ_8821C(desc, 1); -+ else -+ SET_TX_DESC_SW_SEQ_8821C(desc, attrib->seqnum); -+ -+ if (pmp_priv->bandwidth <= CHANNEL_WIDTH_160) -+ SET_TX_DESC_DATA_BW_8821C(desc, pmp_priv->bandwidth); -+ else { -+ RTW_INFO("%s: unknown bandwidth %d, use 20M\n", -+ __FUNCTION__, pmp_priv->bandwidth); -+ SET_TX_DESC_DATA_BW_8821C(desc, CHANNEL_WIDTH_20); -+ } -+ -+ SET_TX_DESC_DISDATAFB_8821C(desc, 1); -+ SET_TX_DESC_USE_RATE_8821C(desc, 1); -+ SET_TX_DESC_DATARATE_8821C(desc, pmp_priv->rateidx); -+} -+#endif /* CONFIG_MP_INCLUDED */ -+ -+#define OFFSET_SZ 0 -+static void fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf) -+{ -+ PADAPTER adapter = pxmitframe->padapter; -+ HAL_DATA_TYPE *phal_data = GET_HAL_DATA(adapter); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ u32 desc_size = 0; -+ u8 offset, pkt_offset = 0; -+#define RA_SW_DEFINE_CONT 0x01 -+ u8 drv_fixed_reate = _FALSE; -+ u8 hw_port = rtw_hal_get_port(adapter); -+ -+#if 0 -+#ifndef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ if (adapter->registrypriv.mp_mode == 0) { -+ if ((PACKET_OFFSET_SZ != 0) && (!bagg_pkt) && -+ (rtw_usb_bulk_size_boundary(adapter, TXDESC_SIZE + pattrib->last_txcmdsz) == _FALSE)) { -+ ptxdesc = (pmem + PACKET_OFFSET_SZ); -+ /* RTW_INFO("==> non-agg-pkt,shift pointer...\n"); */ -+ pull = 1; -+ } -+ } -+#endif /* CONFIG_USE_USB_BUFFER_ALLOC_TX*/ -+#endif -+ rtw_halmac_get_tx_desc_size(adapter_to_dvobj(adapter), &desc_size); -+ -+ _rtw_memset(pbuf, 0, desc_size); -+ -+ /*SET_TX_DESC_LS_8821C(pbuf, 1);*/ /*for USB only*/ -+ -+ SET_TX_DESC_TXPKTSIZE_8821C(pbuf, pattrib->last_txcmdsz); -+ -+ offset = desc_size + OFFSET_SZ; -+ -+#ifdef CONFIG_TX_EARLY_MODE -+ if (pxmitframe->frame_tag == DATA_FRAMETAG) -+ if (bagg_pkt) -+ offset += EARLY_MODE_INFO_SIZE ;/*0x28 */ -+ pkt_offset = pxmitframe->pkt_offset = 0x01; -+#endif -+ SET_TX_DESC_OFFSET_8821C(pbuf, offset); -+ -+ if (bmcst) -+ SET_TX_DESC_BMC_8821C(pbuf, 1); -+ -+#if 0 -+#ifndef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ if (adapter->registrypriv.mp_mode == 0) { -+ if ((PACKET_OFFSET_SZ != 0) && (!bagg_pkt)) { -+ if ((pull) && (pxmitframe->pkt_offset > 0)) { -+ pxmitframe->pkt_offset = pxmitframe->pkt_offset - 1; -+ pkt_offset = pxmitframe->pkt_offset; -+ } -+ } -+ } -+ /*RTW_INFO("%s, pkt_offset=0x%02x\n", __func__, pxmitframe->pkt_offset);*/ -+#endif -+#endif -+ -+ /* pkt_offset, unit:8 bytes padding*/ -+ if (pkt_offset > 0) -+ SET_TX_DESC_PKT_OFFSET_8821C(pbuf, pkt_offset); -+ -+ -+ SET_TX_DESC_MACID_8821C(pbuf, pattrib->mac_id); -+ SET_TX_DESC_RATE_ID_8821C(pbuf, pattrib->raid); -+ SET_TX_DESC_QSEL_8821C(pbuf, pattrib->qsel); -+ -+ /* 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. -+ */ -+ -+ /* HW sequence, to fix to use 0 queue. todo: 4AC packets to use auto queue select */ -+ if (!pattrib->qos_en) { -+ SET_TX_DESC_DISQSELSEQ_8821C(pbuf, 1); -+ SET_TX_DESC_EN_HWSEQ_8821C(pbuf, 1); -+ SET_TX_DESC_HW_SSN_SEL_8821C(pbuf, pattrib->hw_ssn_sel); -+ SET_TX_DESC_EN_HWEXSEQ_8821C(pbuf, 0); -+ } else -+ SET_TX_DESC_SW_SEQ_8821C(pbuf, pattrib->seqnum); -+ -+ if (pxmitframe->frame_tag == DATA_FRAMETAG) { -+ -+ rtl8821c_fill_txdesc_sectype(pattrib, pbuf); -+ -+ if (bmcst) -+ fill_txdesc_force_bmc_camid(pattrib, pbuf); -+ -+#if defined(CONFIG_USB_TX_AGGREGATION) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ if (pxmitframe->agg_num > 1) { -+ /*RTW_INFO("%s agg_num:%d\n",__func__,pxmitframe->agg_num );*/ -+ SET_TX_DESC_DMA_TXAGG_NUM_8821C(pbuf, pxmitframe->agg_num); -+ } -+#endif /*CONFIG_USB_TX_AGGREGATION*/ -+ -+ rtl8821c_fill_txdesc_vcs(adapter, pattrib, pbuf); -+ -+#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR -+ rtw_phydm_set_dyntxpwr(adapter, pbuf, pattrib->mac_id); -+#endif -+ if ((pattrib->ether_type != 0x888e) && -+ (pattrib->ether_type != 0x0806) && -+ (pattrib->ether_type != 0x88B4) && -+ (pattrib->dhcp_pkt != 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_EN_8821C(pbuf, 1); -+ SET_TX_DESC_MAX_AGG_NUM_8821C(pbuf, 0x1F); -+ SET_TX_DESC_AMPDU_DENSITY_8821C(pbuf, pattrib->ampdu_spacing); -+ } else -+ SET_TX_DESC_BK_8821C(pbuf, 1); -+ -+ if (adapter->fix_bw != 0xFF) -+ pattrib->bwmode = adapter->fix_bw; -+ -+ rtl8821c_fill_txdesc_phy(adapter, pattrib, pbuf); -+ -+ if (phal_data->current_band_type == BAND_ON_5G)/*Data Rate Fallback Limit rate*/ -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE_8821C(pbuf, 4); -+ else -+ SET_TX_DESC_DATA_RTY_LOWEST_RATE_8821C(pbuf, 0); -+ -+ if (bmcst) { -+ drv_fixed_reate = _TRUE; -+ fill_txdesc_bmc_tx_rate(pattrib, pbuf); -+ } -+ -+ /* modify data rate by iwpriv*/ -+ if (adapter->fix_rate != 0xFF) { -+ drv_fixed_reate = _TRUE; -+ SET_TX_DESC_USE_RATE_8821C(pbuf, 1); -+ -+ if (adapter->fix_rate & BIT(7)) -+ SET_TX_DESC_DATA_SHORT_8821C(pbuf, 1); -+ SET_TX_DESC_DATARATE_8821C(pbuf, adapter->fix_rate & 0x7F); -+ if (!adapter->data_fb) -+ SET_TX_DESC_DISDATAFB_8821C(pbuf, 1); -+ } -+ -+ if (pattrib->ldpc) -+ SET_TX_DESC_DATA_LDPC_8821C(pbuf, 1); -+ if (pattrib->stbc) -+ SET_TX_DESC_DATA_STBC_8821C(pbuf, 1); -+ -+#ifdef CONFIG_CMCC_TEST -+ SET_TX_DESC_DATA_SHORT_8821C(pbuf, 1); /* use cck short premble */ -+#endif -+ -+#ifdef CONFIG_WMMPS_STA -+ if (pattrib->trigger_frame) -+ SET_TX_DESC_TRI_FRAME_8821C (pbuf, 1); -+#endif /* CONFIG_WMMPS_STA */ -+ } 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_8821C(pbuf, 1); -+ drv_fixed_reate = _TRUE; -+ SET_TX_DESC_USE_RATE_8821C(pbuf, 1); -+ -+ /* HW will ignore this setting if the transmission rate is legacy OFDM.*/ -+ if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT) -+ SET_TX_DESC_DATA_SHORT_8821C(pbuf, 1); -+#ifdef CONFIG_IP_R_MONITOR -+ if((pattrib->ether_type == ETH_P_ARP) && -+ (IsSupportedTxOFDM(adapter->registrypriv.wireless_mode))) -+ SET_TX_DESC_DATARATE_8821C(pbuf, MRateToHwRate(IEEE80211_OFDM_RATE_6MB)); -+ else -+#endif/*CONFIG_IP_R_MONITOR*/ -+ SET_TX_DESC_DATARATE_8821C(pbuf, MRateToHwRate(pmlmeext->tx_rate)); -+ -+ RTW_INFO(FUNC_ADPT_FMT ": SP Packet(0x%04X) rate=0x%x SeqNum = %d\n", -+ FUNC_ADPT_ARG(adapter), pattrib->ether_type, MRateToHwRate(pmlmeext->tx_rate), pattrib->seqnum); -+ } -+#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_SPE_RPT_8821C(pbuf, 1); -+ } -+#endif /* CONFIG_XMIT_ACK */ -+#endif -+ -+ } else if (pxmitframe->frame_tag == MGNT_FRAMETAG) { -+ SET_TX_DESC_MBSSID_8821C(pbuf, pattrib->mbssid & 0xF); -+ SET_TX_DESC_USE_RATE_8821C(pbuf, 1); -+ drv_fixed_reate = _TRUE; -+ -+ SET_TX_DESC_DATARATE_8821C(pbuf, MRateToHwRate(pattrib->rate)); -+ -+ /* VHT NDPA or HT NDPA Packet for Beamformer.*/ -+#ifdef CONFIG_BEAMFORMING -+ if ((pattrib->subtype == WIFI_NDPA) || -+ ((pattrib->subtype == WIFI_ACTION_NOACK) && (pattrib->order == 1))) { -+ SET_TX_DESC_NAVUSEHDR_8821C(pbuf, 1); -+ -+ SET_TX_DESC_DATA_BW_8821C(pbuf, rtl8821c_bw_mapping(adapter, pattrib)); -+ /*SET_TX_DESC_DATA_SC_8821C(pbuf, rtl8821c_sc_mapping(adapter, pattrib));*/ -+ SET_TX_DESC_SIGNALING_TA_PKT_SC_8821C(pbuf, rtl8821c_sc_mapping(adapter,pattrib)); -+ -+ SET_TX_DESC_RTY_LMT_EN_8821C(pbuf, 1); -+ SET_TX_DESC_RTS_DATA_RTY_LMT_8821C(pbuf, 5); -+ SET_TX_DESC_DISDATAFB_8821C(pbuf, 1); -+ -+ /*if(pattrib->rts_cca) -+ SET_TX_DESC_NDPA_8821C(ptxdesc, 2); -+ else*/ -+ SET_TX_DESC_NDPA_8821C(pbuf, 1); -+ } else -+#endif -+ { -+ SET_TX_DESC_RTY_LMT_EN_8821C(pbuf, 1); -+ if (pattrib->retry_ctrl == _TRUE) -+ SET_TX_DESC_RTS_DATA_RTY_LMT_8821C(pbuf, 6); -+ else -+ SET_TX_DESC_RTS_DATA_RTY_LMT_8821C(pbuf, 12); -+ } -+ -+#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_SPE_RPT_8821C(pbuf, 1); -+ } -+#endif /* CONFIG_XMIT_ACK */ -+ } else if (pxmitframe->frame_tag == TXAGG_FRAMETAG) -+ RTW_INFO("%s: TXAGG_FRAMETAG\n", __func__); -+#ifdef CONFIG_MP_INCLUDED -+ else if (pxmitframe->frame_tag == MP_FRAMETAG) { -+ RTW_INFO("%s: MP_FRAMETAG\n", __func__); -+ fill_txdesc_for_mp(adapter, pbuf); -+ } -+#endif -+ else { -+ RTW_INFO("%s: frame_tag=0x%x\n", __func__, pxmitframe->frame_tag); -+ -+ SET_TX_DESC_USE_RATE_8821C(pbuf, 1); -+ drv_fixed_reate = _TRUE; -+ SET_TX_DESC_DATARATE_8821C(pbuf, MRateToHwRate(pmlmeext->tx_rate)); -+ } -+ -+ if (drv_fixed_reate == _TRUE) -+ SET_TX_DESC_SW_DEFINE_8821C(pbuf, RA_SW_DEFINE_CONT); -+ -+ if (adapter->power_offset != 0) -+ SET_TX_DESC_TXPWR_OFSET_8821C(pbuf, adapter->power_offset); -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ if (!bmcst && pattrib->psta) -+ odm_set_tx_ant_by_tx_info(adapter_to_phydm(adapter), pbuf, pattrib->psta->cmn.mac_id); -+#endif -+ -+#ifdef CONFIG_BEAMFORMING -+ SET_TX_DESC_G_ID_8821C(pbuf, pattrib->txbf_g_id); -+ SET_TX_DESC_P_AID_8821C(pbuf, pattrib->txbf_p_aid); -+#endif -+ -+ SET_TX_DESC_PORT_ID_8821C(pbuf, hw_port); -+ SET_TX_DESC_MULTIPLE_PORT_8821C(pbuf, hw_port); -+} -+ -+void rtl8821c_dbg_dump_tx_desc(PADAPTER adapter, int frame_tag, u8 *ptxdesc) -+{ -+ u8 bDumpTxPkt; -+ u8 bDumpTxDesc = _FALSE; -+ -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_TXPKT, &bDumpTxPkt); -+ -+ /* 1 for data frame, 2 for mgnt frame */ -+ if (bDumpTxPkt == 1) { -+ RTW_INFO("dump tx_desc for data frame\n"); -+ if ((frame_tag & 0x0f) == DATA_FRAMETAG) -+ bDumpTxDesc = _TRUE; -+ } else if (bDumpTxPkt == 2) { -+ RTW_INFO("dump tx_desc for mgnt frame\n"); -+ if ((frame_tag & 0x0f) == MGNT_FRAMETAG) -+ bDumpTxDesc = _TRUE; -+ } -+ -+ /* 8821C TX SIZE = 48(HALMAC_TX_DESC_SIZE_8821C) */ -+ if (_TRUE == bDumpTxDesc) { -+ 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("Offset40(0x%08x)\n", *((u32 *)(ptxdesc + 40))); -+ RTW_INFO("Offset44(0x%08x)\n", *((u32 *)(ptxdesc + 44))); -+ RTW_INFO("=====================================\n"); -+ } -+} -+ -+/* -+ * Description: -+ * -+ * Parameters: -+ * pxmitframe xmitframe -+ * pbuf where to fill tx desc -+ */ -+void rtl8821c_update_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf) -+{ -+ fill_default_txdesc(pxmitframe, pbuf); -+ rtl8821c_cal_txdesc_chksum(pxmitframe->padapter, pbuf); -+ rtl8821c_dbg_dump_tx_desc(pxmitframe->padapter, pxmitframe->frame_tag, pbuf); -+} -+ -+/* -+ * 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 directly. -+ */ -+static void fill_fake_txdesc(PADAPTER adapter, u8 *pDesc, u32 BufferLen, -+ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct xmit_priv *pxmitpriv = &adapter->xmitpriv; -+ u32 desc_size = 0; -+ u8 hw_port = rtw_hal_get_port(adapter); -+ -+ rtw_halmac_get_tx_desc_size(adapter_to_dvobj(adapter), &desc_size); -+ -+ /* Clear all status */ -+ _rtw_memset(pDesc, 0, desc_size); -+ -+ SET_TX_DESC_LS_8821C(pDesc, 1); -+ -+ SET_TX_DESC_OFFSET_8821C(pDesc, desc_size); -+ -+ SET_TX_DESC_TXPKTSIZE_8821C(pDesc, BufferLen); -+ SET_TX_DESC_QSEL_8821C(pDesc, QSLT_MGNT); /* Fixed queue of Mgnt queue */ -+ -+ if (pmlmeext->cur_wireless_mode & WIRELESS_11B) -+ SET_TX_DESC_RATE_ID_8821C(pDesc, RATEID_IDX_B); -+ else -+ SET_TX_DESC_RATE_ID_8821C(pDesc, RATEID_IDX_G); -+ -+ /* Set NAVUSEHDR to prevent Ps-poll AId filed to be changed to error vlaue by HW */ -+ if (_TRUE == IsPsPoll) -+ SET_TX_DESC_NAVUSEHDR_8821C(pDesc, 1); -+ else { -+ SET_TX_DESC_DISQSELSEQ_8821C(pDesc, 1); -+ SET_TX_DESC_EN_HWSEQ_8821C(pDesc, 1); -+ SET_TX_DESC_HW_SSN_SEL_8821C(pDesc, pxmitpriv->hw_ssn_seq_no);/*pattrib->hw_ssn_sel*/ -+ SET_TX_DESC_EN_HWEXSEQ_8821C(pDesc, 0); -+ } -+ -+ if (_TRUE == IsBTQosNull) -+ SET_TX_DESC_BT_NULL_8821C(pDesc, 1); -+ -+ SET_TX_DESC_USE_RATE_8821C(pDesc, 1); -+ SET_TX_DESC_DATARATE_8821C(pDesc, MRateToHwRate(pmlmeext->tx_rate)); -+ -+#ifdef CONFIG_MCC_MODE -+ /* config Null data retry number */ -+ if (IsPsPoll == _FALSE && IsBTQosNull == _FALSE && bDataFrame == _FALSE) { -+ if (rtw_hal_check_mcc_status(adapter, MCC_STATUS_PROCESS_MCC_START_SETTING)) { -+ u8 rty_num = adapter->mcc_adapterpriv.null_rty_num; -+ if (rty_num != 0) { -+ SET_TX_DESC_RTY_LMT_EN_8821C(pDesc, 1); -+ SET_TX_DESC_RTS_DATA_RTY_LMT_8821C(pDesc, rty_num); -+ } -+ } -+ } -+#endif -+ -+ /* -+ * Encrypt the data frame if under security mode excepct null data. -+ */ -+ if (_TRUE == bDataFrame) { -+ u32 EncAlg; -+ -+ EncAlg = adapter->securitypriv.dot11PrivacyAlgrthm; -+ switch (EncAlg) { -+ case _NO_PRIVACY_: -+ SET_TX_DESC_SEC_TYPE_8821C(pDesc, 0x0); -+ break; -+ case _WEP40_: -+ case _WEP104_: -+ case _TKIP_: -+ SET_TX_DESC_SEC_TYPE_8821C(pDesc, 0x1); -+ break; -+ case _SMS4_: -+ SET_TX_DESC_SEC_TYPE_8821C(pDesc, 0x2); -+ break; -+ case _AES_: -+ SET_TX_DESC_SEC_TYPE_8821C(pDesc, 0x3); -+ break; -+ case _CCMP_256_: -+ case _GCMP_: -+ case _GCMP_256_: -+ SET_TX_DESC_SEC_TYPE_8821C(pDesc, 0x2); -+ break; -+ default: -+ SET_TX_DESC_SEC_TYPE_8821C(pDesc, 0x0); -+ break; -+ } -+ } -+ SET_TX_DESC_PORT_ID_8821C(pDesc, hw_port); -+ SET_TX_DESC_MULTIPLE_PORT_8821C(pDesc, hw_port); -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_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.). -+ */ -+ rtl8821c_cal_txdesc_chksum(adapter, pDesc); -+#endif -+} -+ -+void rtl8821c_rxdesc2attribute(struct rx_pkt_attrib *pattrib, u8 *desc) -+{ -+ /* initial value */ -+ _rtw_memset(pattrib, 0, sizeof(struct rx_pkt_attrib)); -+ -+ pattrib->pkt_len = (u16)GET_RX_DESC_PKT_LEN_8821C(desc); -+ pattrib->pkt_rpt_type = (GET_RX_DESC_C2H_8821C(desc)) ? C2H_PACKET : NORMAL_RX; -+ -+ if (pattrib->pkt_rpt_type == NORMAL_RX) { -+ /* Get from RX DESC */ -+ pattrib->crc_err = (u8)GET_RX_DESC_CRC32_8821C(desc); -+ pattrib->icv_err = (u8)GET_RX_DESC_ICV_ERR_8821C(desc); -+ -+ pattrib->drvinfo_sz = (u8)GET_RX_DESC_DRV_INFO_SIZE_8821C(desc) << 3; -+ pattrib->encrypt = (u8)GET_RX_DESC_SECURITY_8821C(desc); -+ pattrib->qos = (u8)GET_RX_DESC_QOS_8821C(desc); -+ pattrib->shift_sz = (u8)GET_RX_DESC_SHIFT_8821C(desc); -+ pattrib->physt = (u8)GET_RX_DESC_PHYST_8821C(desc); -+ pattrib->bdecrypted = (u8)GET_RX_DESC_SWDEC_8821C(desc) ? 0 : 1; -+ -+ pattrib->priority = (u8)GET_RX_DESC_TID_8821C(desc); -+ pattrib->amsdu = (u8)GET_RX_DESC_AMSDU_8821C(desc); -+ pattrib->mdata = (u8)GET_RX_DESC_MD_8821C(desc); -+ pattrib->mfrag = (u8)GET_RX_DESC_MF_8821C(desc); -+ -+ pattrib->seq_num = (u16)GET_RX_DESC_SEQ_8821C(desc); -+ pattrib->frag_num = (u8)GET_RX_DESC_FRAG_8821C(desc); -+ pattrib->ampdu = (u8)GET_RX_DESC_PAGGR_8821C(desc); -+ pattrib->ampdu_eof = (u8)GET_RX_DESC_RX_EOF_8821C(desc); -+ pattrib->ppdu_cnt = (u8)GET_RX_DESC_PPDU_CNT_8821C(desc); -+ pattrib->free_cnt = (u32)GET_RX_DESC_TSFL_8821C(desc); -+ -+ pattrib->bw = CHANNEL_WIDTH_MAX; -+ pattrib->data_rate = (u8)GET_RX_DESC_RX_RATE_8821C(desc); -+ } -+} -+ -+void rtl8821c_query_rx_desc(union recv_frame *precvframe, u8 *pdesc) -+{ -+ rtl8821c_rxdesc2attribute(&precvframe->u.hdr.attrib, pdesc); -+} -+ -+static void InitBeaconParameters(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ /* TBTT setup time */ -+ rtw_write8(adapter, REG_TBTT_PROHIBIT_8821C, TBTT_PROHIBIT_SETUP_TIME); -+ -+ /* TBTT hold time: 0x540[19:8] */ -+ rtw_write8(adapter, REG_TBTT_PROHIBIT_8821C + 1, TBTT_PROHIBIT_HOLD_TIME_STOP_BCN & 0xFF); -+ rtw_write8(adapter, REG_TBTT_PROHIBIT_8821C + 2, -+ (rtw_read8(adapter, REG_TBTT_PROHIBIT_8821C + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME_STOP_BCN >> 8)); -+ -+ rtw_write8(adapter, REG_DRVERLYINT_8821C, DRIVER_EARLY_INT_TIME_8821C); /* 5ms */ -+ rtw_write8(adapter, REG_BCNDMATIM_8821C, BCN_DMA_ATIME_INT_TIME_8821C); /* 2ms */ -+ -+ /* -+ * Suggested by designer timchen. Change beacon AIFS to the largest number -+ * beacause test chip does not contension before sending beacon. -+ */ -+ rtw_write16(adapter, REG_BCNTCFG_8821C, 0x4413); -+} -+ -+static void beacon_function_enable(PADAPTER adapter, u8 Enable, u8 Linked) -+{ -+ hw_bcn_ctrl_add(adapter, get_hw_port(adapter), BIT_DIS_TSF_UDT_8821C | BIT_EN_BCN_FUNCTION_8821C); -+} -+ -+static void set_beacon_related_registers(PADAPTER adapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ /* reset TSF, enable update TSF, correcting TSF On Beacon */ -+#if 0 -+ /* * REG_MBSSID_BCN_SPACE */ -+ /* * REG_BCNDMATIM */ -+ /* * REG_ATIMWND */ -+ /* * REG_TBTT_PROHIBIT */ -+ /* * REG_DRVERLYINT */ -+ /* * REG_BCN_MAX_ERR */ -+ /* * REG_BCNTCFG (0x510) */ -+ /* * REG_DUAL_TSF_RST */ -+ /* * REG_BCN_CTRL (0x550) */ -+#endif -+ -+ /* ATIM window */ -+ rtw_write16(adapter, REG_ATIMWND_8821C, 2); -+ -+ /* Beacon interval (in unit of TU). */ -+ rtw_hal_set_hwreg(adapter, HW_VAR_BEACON_INTERVAL, (u8 *)&pmlmeinfo->bcn_interval); -+ -+ InitBeaconParameters(adapter); -+ -+ rtw_write8(adapter, REG_SLOT_8821C, 0x09); -+ -+ /* Reset TSF Timer to zero */ -+ hw_tsf_reset(adapter); -+ -+ rtw_write8(adapter, REG_RXTSF_OFFSET_CCK_8821C, 0x50); -+ rtw_write8(adapter, REG_RXTSF_OFFSET_OFDM_8821C, 0x50); -+ -+ beacon_function_enable(adapter, _TRUE, _TRUE); -+ -+ ResumeTxBeacon(adapter); -+} -+ -+void rtl8821c_set_hal_ops(PADAPTER adapter) -+{ -+ struct hal_ops *ops_func = &adapter->hal_func; -+ -+ /*** initialize section ***/ -+ ops_func->read_chip_version = read_chip_version; -+ /* -+ ops->init_default_value = NULL; -+ */ -+ ops_func->read_adapter_info = rtl8821c_read_efuse; -+ ops_func->hal_power_on = rtl8821c_power_on; -+ ops_func->hal_power_off = rtl8821c_power_off; -+ -+ ops_func->dm_init = rtl8821c_phy_init_dm_priv; -+ ops_func->dm_deinit = rtl8821c_phy_deinit_dm_priv; -+ -+ /*** xmit section ***/ -+ /* -+ ops->init_xmit_priv = NULL; -+ ops->free_xmit_priv = NULL; -+ ops->hal_xmit = NULL; -+ ops->mgnt_xmit = NULL; -+ ops->hal_xmitframe_enqueue = NULL; -+ #ifdef CONFIG_XMIT_THREAD_MODE -+ ops->xmit_thread_handler = NULL; -+ #endif -+ */ -+ /* -+ ops_func->run_thread = rtl8821c_run_thread; -+ ops_func->cancel_thread = rtl8821c_cancel_thread; -+ */ -+ /*** recv section ***/ -+ /* -+ ops->init_recv_priv = NULL; -+ ops->free_recv_priv = NULL; -+ #if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+ ops->inirp_init = NULL; -+ ops->inirp_deinit = NULL; -+ #endif -+ */ -+ /*** interrupt hdl section ***/ -+ /* -+ ops->enable_interrupt = NULL; -+ ops->disable_interrupt = NULL; -+ */ -+ ops_func->check_ips_status = check_ips_status; -+ /* -+ #if defined(CONFIG_PCI_HCI) -+ ops->interrupt_handler = NULL; -+ #endif -+ #if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) -+ ops->interrupt_handler = NULL; -+ #endif -+ #if defined(CONFIG_PCI_HCI) -+ ops->irp_reset = NULL; -+ #endif -+ */ -+ -+ /*** DM section ***/ -+ ops_func->set_chnl_bw_handler = rtl8821c_set_channel_bw; -+ -+ ops_func->set_tx_power_level_handler = rtl8821c_set_tx_power_level; -+ ops_func->set_tx_power_index_handler = rtl8821c_set_tx_power_index; -+ ops_func->get_tx_power_index_handler = hal_com_get_txpwr_idx; -+ -+ ops_func->hal_dm_watchdog = rtl8821c_phy_haldm_watchdog; -+ -+ ops_func->GetHalODMVarHandler = GetHalODMVar; -+ ops_func->SetHalODMVarHandler = SetHalODMVar; -+ -+ ops_func->SetBeaconRelatedRegistersHandler = set_beacon_related_registers; -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ /* -+ ops->AntDivBeforeLinkHandler = NULL; -+ ops->AntDivCompareHandler = NULL; -+ */ -+#endif -+ /* -+ ops->interface_ps_func = NULL; -+ */ -+ -+ ops_func->read_bbreg = rtl8821c_read_bb_reg; -+ ops_func->write_bbreg = rtl8821c_write_bb_reg; -+ ops_func->read_rfreg = rtl8821c_read_rf_reg; -+ ops_func->write_rfreg = rtl8821c_write_rf_reg; -+ ops_func->read_wmmedca_reg = rtl8821c_read_wmmedca_reg; -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ /* -+ ops->hostap_mgnt_xmit_entry = NULL; -+ */ -+#endif -+ /* -+ ops->EfusePowerSwitch = NULL; -+ ops->BTEfusePowerSwitch = NULL; -+ ops->ReadEFuse = NULL; -+ ops->EFUSEGetEfuseDefinition = NULL; -+ ops->EfuseGetCurrentSize = NULL; -+ ops->Efuse_PgPacketRead = NULL; -+ ops->Efuse_PgPacketWrite = NULL; -+ ops->Efuse_WordEnableDataWrite = NULL; -+ ops->Efuse_PgPacketWrite_BT = NULL; -+ */ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ ops_func->sreset_init_value = sreset_init_value; -+ ops_func->sreset_reset_value = sreset_reset_value; -+ ops_func->silentreset = sreset_reset; -+ ops_func->sreset_xmit_status_check = xmit_status_check; -+ ops_func->sreset_linked_status_check = linked_status_check; -+ ops_func->sreset_get_wifi_status = sreset_get_wifi_status; -+ ops_func->sreset_inprogress = sreset_inprogress; -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+#ifdef CONFIG_IOL -+ /* -+ ops->IOL_exec_cmds_sync = NULL; -+ */ -+#endif -+ -+ ops_func->hal_notch_filter = rtl8821c_notch_filter_switch; -+ ops_func->hal_mac_c2h_handler = c2h_handler_rtl8821c; -+ ops_func->fill_h2c_cmd = rtl8821c_fillh2ccmd; -+ ops_func->fill_fake_txdesc = fill_fake_txdesc; -+ ops_func->fw_dl = rtl8821c_fw_dl; -+ -+#ifdef CONFIG_LPS_PG -+ ops_func->fw_mem_dl = rtl8821c_fw_mem_dl; -+#endif -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ /* -+ ops->clear_interrupt = NULL; -+ */ -+#endif -+ /* -+ ops_func->hal_get_tx_buff_rsvd_page_num = NULL; -+ */ -+#ifdef CONFIG_GPIO_API -+ /* -+ ops->update_hisr_hsisr_ind = NULL; -+ */ -+#endif -+ -+ /* HALMAC related functions */ -+ ops_func->init_mac_register = rtl8821c_init_phy_parameter_mac; -+ ops_func->init_phy = rtl8821c_phy_init; -+ -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_phy.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_phy.c -new file mode 100755 -index 000000000..a97c697cb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/rtl8821c_phy.c -@@ -0,0 +1,1379 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821C_PHY_C_ -+ -+#include /* HAL_DATA_TYPE */ -+#include "../hal_halmac.h" /* REG_CCK_CHECK_8821C */ -+#include "rtl8821c.h" -+ -+ -+/* -+ * Description: -+ * Initialize Register definition offset for Radio Path A/B/C/D -+ * The initialization value is constant and it should never be changes -+ */ -+static void bb_rf_register_definition(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ -+ /* RF Interface Sowrtware Control */ -+ hal->PHYRegDef[RF_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW; -+ hal->PHYRegDef[RF_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW; -+ -+ /* RF Interface Output (and Enable) */ -+ hal->PHYRegDef[RF_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE; -+ hal->PHYRegDef[RF_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE; -+ -+ /* RF Interface (Output and) Enable */ -+ hal->PHYRegDef[RF_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE; -+ hal->PHYRegDef[RF_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE; -+ -+ hal->PHYRegDef[RF_PATH_A].rf3wireOffset = rA_LSSIWrite_Jaguar; -+ hal->PHYRegDef[RF_PATH_B].rf3wireOffset = rB_LSSIWrite_Jaguar; -+ -+ hal->PHYRegDef[RF_PATH_A].rfHSSIPara2 = rHSSIRead_Jaguar; -+ hal->PHYRegDef[RF_PATH_B].rfHSSIPara2 = rHSSIRead_Jaguar; -+ -+ /* Tranceiver Readback LSSI/HSPI mode */ -+ hal->PHYRegDef[RF_PATH_A].rfLSSIReadBack = rA_SIRead_Jaguar; -+ hal->PHYRegDef[RF_PATH_B].rfLSSIReadBack = rB_SIRead_Jaguar; -+ hal->PHYRegDef[RF_PATH_A].rfLSSIReadBackPi = rA_PIRead_Jaguar; -+ hal->PHYRegDef[RF_PATH_B].rfLSSIReadBackPi = rB_PIRead_Jaguar; -+} -+ -+static void init_bb_rf(PADAPTER adapter) -+{ -+ u8 val8; -+ u16 val16; -+ -+ -+ /* Enable BB and RF */ -+ val8 = rtw_read8(adapter, REG_SYS_FUNC_EN_8821C); -+ if (IS_HARDWARE_TYPE_8821CU(adapter)) -+ val8 |= BIT_FEN_USBA_8821C; -+ else if (IS_HARDWARE_TYPE_8821CE(adapter)) -+ val8 |= BIT_FEN_PCIEA_8821C; -+ rtw_write8(adapter, REG_SYS_FUNC_EN_8821C, val8); -+ -+ /* -+ * 8821C MP Chip => Reset BB/RF ?? -+ * Need to set BBRSTB and GLB_RSTB = 1->0->1 to generate a postive edge and negtive edge for BB -+ */ -+ val8 |= BIT_FEN_BB_GLB_RSTN_8821C | BIT_FEN_BBRSTB_8821C; -+ rtw_write8(adapter, REG_SYS_FUNC_EN_8821C, val8); -+ val8 &= ~(BIT_FEN_BB_GLB_RSTN_8821C | BIT_FEN_BBRSTB_8821C); -+ rtw_write8(adapter, REG_SYS_FUNC_EN_8821C, val8); -+ val8 |= BIT_FEN_BB_GLB_RSTN_8821C | BIT_FEN_BBRSTB_8821C; -+ rtw_write8(adapter, REG_SYS_FUNC_EN_8821C, val8); -+ -+ val8 = BIT_RF_EN_8821C | BIT_RF_RSTB_8821C | BIT_RF_SDMRSTB_8821C; -+ /* 0x1F[7:0] = 0x07 PathA RF Power On */ -+ rtw_write8(adapter, REG_RF_CTRL_8821C, val8); -+ rtw_usleep_os(10); -+ -+ /*0xEC [31:24],BIT_WLRF1_CTRL, For WLRF1 control*/ -+ /* 0xEF[7:0] = 0x07 for RFE Type=2,BTG RF Power On*/ -+ rtw_write8(adapter, REG_WLRF1_8821C + 3, val8); -+ rtw_usleep_os(10); -+ -+} -+ -+u8 rtl8821c_init_phy_parameter_mac(PADAPTER adapter) -+{ -+ u8 ret = _FAIL; -+ PHAL_DATA_TYPE hal; -+ -+ hal = GET_HAL_DATA(adapter); -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ ret = phy_ConfigMACWithParaFile(adapter, PHY_FILE_MAC_REG); -+ if (ret == _FAIL) -+#endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ -+ { -+ odm_config_mac_with_header_file(&hal->odmpriv); -+ ret = _SUCCESS; -+ } -+ -+ return ret; -+} -+ -+static u8 _init_phy_parameter_bb(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(Adapter); -+ u8 ret = _TRUE; -+ int res; -+ enum hal_status status; -+ -+ -+ /* -+ * 1. Read PHY_REG.TXT BB INIT!! -+ */ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ res = phy_ConfigBBWithParaFile(Adapter, PHY_FILE_PHY_REG, CONFIG_BB_PHY_REG); -+ if (res == _FAIL) -+#endif -+ { -+ ret = _FALSE; -+ status = odm_config_bb_with_header_file(&hal->odmpriv, CONFIG_BB_PHY_REG); -+ if (HAL_STATUS_SUCCESS == status) -+ ret = _TRUE; -+ } -+ -+ if (ret != _TRUE) { -+ RTW_INFO("%s: Write BB Reg Fail!!", __FUNCTION__); -+ goto exit; -+ } -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (Adapter->registrypriv.mp_mode == 1) { -+ /* -+ * 1.1 Read PHY_REG_MP.TXT BB INIT!! -+ */ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ res = phy_ConfigBBWithMpParaFile(Adapter, PHY_FILE_PHY_REG_MP); -+ if (res == _FAIL) -+#endif -+ { -+ ret = _FALSE; -+ status = odm_config_bb_with_header_file(&hal->odmpriv, CONFIG_BB_PHY_REG_MP); -+ if (HAL_STATUS_SUCCESS == status) -+ ret = _TRUE; -+ } -+ -+ if (ret != _TRUE) { -+ RTW_INFO("%s : Write BB Reg MP Fail!!", __FUNCTION__); -+ goto exit; -+ } -+ } -+#endif /* CONFIG_MP_INCLUDED */ -+ -+ /* -+ * 2. Read BB AGC table Initialization -+ */ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ res = phy_ConfigBBWithParaFile(Adapter, PHY_FILE_AGC_TAB, CONFIG_BB_AGC_TAB); -+ if (res == _FAIL) -+#endif -+ { -+ ret = _FALSE; -+ status = odm_config_bb_with_header_file(&hal->odmpriv, CONFIG_BB_AGC_TAB); -+ if (HAL_STATUS_SUCCESS == status) -+ ret = _TRUE; -+ } -+ -+ if (ret != _TRUE) { -+ RTW_INFO("%s: AGC Table Fail\n", __FUNCTION__); -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+static u8 init_bb_reg(PADAPTER adapter) -+{ -+ u8 ret = _TRUE; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ -+ /* -+ * Config BB and AGC -+ */ -+ ret = _init_phy_parameter_bb(adapter); -+ -+ if (rtw_phydm_set_crystal_cap(adapter, hal->crystal_cap) == _FALSE) { -+ RTW_ERR("Init crystal_cap failed\n"); -+ rtw_warn_on(1); -+ ret = _FALSE; -+ } -+ -+ phy_set_bb_reg(adapter, rCCK0_FalseAlarmReport, BIT18 | BIT22, 0); -+ return ret; -+} -+ -+static u8 _init_phy_parameter_rf(PADAPTER adapter) -+{ -+ u32 val32 = 0; -+ enum rf_path eRFPath; -+ PBB_REGISTER_DEFINITION_T pPhyReg; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ enum hal_status status; -+ int res; -+ u8 ret = _TRUE; -+ -+ -+ /* -+ * Initialize RF -+ */ -+ for (eRFPath = RF_PATH_A; eRFPath < hal_spec->rf_reg_path_num; eRFPath++) { -+ pPhyReg = &hal->PHYRegDef[eRFPath]; -+ -+ /* Initialize RF from configuration file */ -+ switch (eRFPath) { -+ case RF_PATH_A: -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ res = PHY_ConfigRFWithParaFile(adapter, PHY_FILE_RADIO_A, eRFPath); -+ if (res == _FAIL) -+#endif -+ { -+ ret = _FALSE; -+ status = odm_config_rf_with_header_file(&hal->odmpriv, CONFIG_RF_RADIO, eRFPath); -+ if (HAL_STATUS_SUCCESS == status) -+ ret = _TRUE; -+ } -+ break; -+ case RF_PATH_B: -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ res = PHY_ConfigRFWithParaFile(adapter, PHY_FILE_RADIO_B, eRFPath); -+ if (res == _FAIL) -+#endif -+ { -+ ret = _FALSE; -+ status = odm_config_rf_with_header_file(&hal->odmpriv, CONFIG_RF_RADIO, eRFPath); -+ if (HAL_STATUS_SUCCESS == status) -+ ret = _TRUE; -+ } -+ break; -+ default: -+ RTW_INFO("Unknown RF path!! %d\r\n", eRFPath); -+ break; -+ } -+ -+ if (ret != _TRUE) -+ goto exit; -+ } -+ -+ /* -+ * Configuration of Tx Power Tracking -+ */ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ res = PHY_ConfigRFWithTxPwrTrackParaFile(adapter, PHY_FILE_TXPWR_TRACK); -+ if (res == _FAIL) -+#endif -+ { -+ ret = _FALSE; -+ status = odm_config_rf_with_tx_pwr_track_header_file(&hal->odmpriv); -+ if (HAL_STATUS_SUCCESS == status) -+ ret = _TRUE; -+ } -+ if (ret != _TRUE) -+ goto exit; -+ -+exit: -+ return ret; -+} -+ -+static u8 init_rf_reg(PADAPTER adapter) -+{ -+ u8 ret = _TRUE; -+ -+ -+ ret = _init_phy_parameter_rf(adapter); -+ -+ return ret; -+} -+u8 rtl8821c_phy_init(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ struct dm_struct *phydm = &hal->odmpriv; -+ -+ bb_rf_register_definition(adapter); -+ -+ init_bb_rf(adapter); -+ -+ if (_FALSE == config_phydm_parameter_init_8821c(phydm, ODM_PRE_SETTING)) -+ return _FALSE; -+ -+ if (_FALSE == init_bb_reg(adapter)) -+ return _FALSE; -+ -+ if (_FALSE == init_rf_reg(adapter)) -+ return _FALSE; -+ -+ if (_FALSE == config_phydm_parameter_init_8821c(phydm, ODM_POST_SETTING)) -+ return _FALSE; -+ -+ hal->phy_spec.trx_cap = query_phydm_trx_capability(phydm); -+ hal->phy_spec.stbc_cap = query_phydm_stbc_capability(phydm); -+ hal->phy_spec.ldpc_cap = query_phydm_ldpc_capability(phydm); -+ hal->phy_spec.txbf_param = query_phydm_txbf_parameters(phydm); -+ hal->phy_spec.txbf_cap = query_phydm_txbf_capability(phydm); -+ /*rtw_dump_phy_cap(RTW_DBGDUMP, adapter);*/ -+ return _TRUE; -+} -+ -+static u32 phy_calculatebitshift(u32 mask) -+{ -+ u32 i; -+ -+ -+ for (i = 0; i <= 31; i++) -+ if (mask & BIT(i)) -+ break; -+ -+ return i; -+} -+ -+u32 rtl8821c_read_bb_reg(PADAPTER adapter, u32 addr, u32 mask) -+{ -+ u32 val = 0, val_org, shift; -+ -+ -+#if (DISABLE_BB_RF == 1) -+ return 0; -+#endif -+ -+ val_org = rtw_read32(adapter, addr); -+ shift = phy_calculatebitshift(mask); -+ val = (val_org & mask) >> shift; -+ -+ return val; -+} -+ -+void rtl8821c_write_bb_reg(PADAPTER adapter, u32 addr, u32 mask, u32 val) -+{ -+ u32 val_org, shift; -+ -+ -+#if (DISABLE_BB_RF == 1) -+ return; -+#endif -+ -+ if (mask != 0xFFFFFFFF) { -+ /* not "double word" write */ -+ val_org = rtw_read32(adapter, addr); -+ shift = phy_calculatebitshift(mask); -+ val = ((val_org & (~mask)) | ((val << shift) & mask)); -+ } -+ -+ rtw_write32(adapter, addr, val); -+} -+ -+u32 rtl8821c_read_rf_reg(PADAPTER adapter, enum rf_path path, u32 addr, u32 mask) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ u32 val = 0; -+ -+ val = config_phydm_read_rf_reg_8821c(phydm, path, addr, mask); -+ if (!config_phydm_read_rf_check_8821c(val)) -+ RTW_INFO(FUNC_ADPT_FMT ": read RF reg path=%d addr=0x%x mask=0x%x FAIL!\n", -+ FUNC_ADPT_ARG(adapter), path, addr, mask); -+ return val; -+} -+ -+void rtl8821c_write_rf_reg(PADAPTER adapter, enum rf_path path, u32 addr, u32 mask, u32 val) -+{ -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ u8 ret; -+ -+ ret = config_phydm_write_rf_reg_8821c(phydm, path, addr, mask, val); -+ if (_FALSE == ret) -+ RTW_INFO(FUNC_ADPT_FMT ": write RF reg path=%d addr=0x%x mask=0x%x val=0x%x FAIL!\n", -+ FUNC_ADPT_ARG(adapter), path, addr, mask, val); -+ -+} -+ -+void rtl8821c_set_tx_power_level(PADAPTER adapter, u8 channel) -+{ -+ u8 path = RF_PATH_A; -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ u8 under_survey_ch = phy_check_under_survey_ch(adapter); -+ u8 under_24g = (hal->current_band_type == BAND_ON_2_4G); -+ -+ /*((hal->RFEType == 2) || (hal->RFEType == 4) || (hal->RFEType == 7))*/ -+ if ((channel <= 14) && (SWITCH_TO_BTG == query_phydm_default_rf_set_8821c(phydm))) -+ path = RF_PATH_B; -+ -+ /*if (adapter->registrypriv.mp_mode == 1)*/ -+ if (under_24g) -+ phy_set_tx_power_index_by_rate_section(adapter, path, channel, CCK); -+ -+ phy_set_tx_power_index_by_rate_section(adapter, path, channel, OFDM); -+ if (!under_survey_ch) { -+ phy_set_tx_power_index_by_rate_section(adapter, path, channel, HT_MCS0_MCS7); -+ phy_set_tx_power_index_by_rate_section(adapter, path, channel, VHT_1SSMCS0_1SSMCS9); -+ } -+} -+ -+/* -+ * Parameters: -+ * padatper -+ * powerindex power index for rate -+ * rfpath Antenna(RF) path, type "enum rf_path" -+ * rate data rate, type "enum MGN_RATE" -+ */ -+void rtl8821c_set_tx_power_index(PADAPTER adapter, u32 powerindex, enum rf_path rfpath, u8 rate) -+{ -+ HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); -+ struct dm_struct *phydm = adapter_to_phydm(adapter); -+ u8 reg_path; -+ u8 shift = 0; -+ boolean write_ret; -+ -+ if (!IS_1T_RATE(rate)) { -+ RTW_ERR(FUNC_ADPT_FMT" invalid rate(%s)\n", FUNC_ADPT_ARG(adapter), MGN_RATE_STR(rate)); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ /* For phydm error handling we have to pass RF_PATH_A to the phydm API, -+ * although some RFE types of 2.4G use RF_PATH_B. -+ */ -+ reg_path = RF_PATH_A; -+ rate = MRateToHwRate(rate); -+ -+ /* -+ * For 8821C, phydm api use 4 bytes txagc value -+ * driver must combine every four 1 byte to one 4 byte and send to phydm api -+ */ -+ shift = rate % 4; -+ hal->txagc_set_buf |= ((powerindex & 0xff) << (shift * 8)); -+ -+ if (shift != 3 && rate != DESC_RATEVHTSS1MCS9) -+ goto exit; -+ -+ rate = rate & 0xFC; -+ write_ret = config_phydm_write_txagc_8821c(phydm, hal->txagc_set_buf, reg_path, rate); -+ -+ if (write_ret == true && !DBG_TX_POWER_IDX) -+ goto clear_buf; -+ -+ RTW_INFO(FUNC_ADPT_FMT" (index:0x%08x, %c, rate:%s(0x%02x), disable api:%d) from %c %s\n" -+ , FUNC_ADPT_ARG(adapter), hal->txagc_set_buf, rf_path_char(reg_path) -+ , HDATA_RATE(rate), rate, phydm->is_disable_phy_api -+ , rf_path_char(rfpath) -+ , write_ret == true ? "OK" : "FAIL"); -+ -+ rtw_warn_on(write_ret != true); -+ -+clear_buf: -+ hal->txagc_set_buf = 0; -+ -+exit: -+ return; -+} -+ -+/* -+ * Description: -+ * Check need to switch band or not -+ * Parameters: -+ * channelToSW channel wiii be switch to -+ * Return: -+ * _TRUE need to switch band -+ * _FALSE not need to switch band -+ */ -+static u8 need_switch_band(PADAPTER adapter, u8 channelToSW) -+{ -+ u8 u1tmp = 0; -+ u8 ret_value = _TRUE; -+ u8 Band = BAND_ON_5G, BandToSW = BAND_ON_5G; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ Band = hal->current_band_type; -+ -+ /* Use current swich 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) { -+ /* record current band type for other hal use */ -+ hal->current_band_type = (BAND_TYPE)BandToSW; -+ ret_value = _TRUE; -+ } else -+ ret_value = _FALSE; -+ -+ return ret_value; -+} -+ -+static u8 get_pri_ch_id(PADAPTER adapter) -+{ -+ u8 pri_ch_idx = 0; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ if (hal->current_channel_bw == CHANNEL_WIDTH_80) { -+ /* primary channel is at lower subband of 80MHz & 40MHz */ -+ if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ pri_ch_idx = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ /* primary channel is at lower subband of 80MHz & upper subband of 40MHz */ -+ else if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ pri_ch_idx = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ /* primary channel is at upper subband of 80MHz & lower subband of 40MHz */ -+ else if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ pri_ch_idx = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ /* primary channel is at upper subband of 80MHz & upper subband of 40MHz */ -+ else if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ pri_ch_idx = VHT_DATA_SC_20_UPPERST_OF_80MHZ; -+ else { -+ if (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ pri_ch_idx = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ pri_ch_idx = VHT_DATA_SC_40_UPPER_OF_80MHZ; -+ else -+ RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); -+ } -+ } else if (hal->current_channel_bw == CHANNEL_WIDTH_40) { -+ /* primary channel is at upper subband of 40MHz */ -+ if (hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ pri_ch_idx = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ /* primary channel is at lower subband of 40MHz */ -+ else if (hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ pri_ch_idx = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else -+ RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); -+ } -+ -+ return pri_ch_idx; -+} -+ -+static void mac_switch_bandwidth(PADAPTER adapter, u8 pri_ch_idx) -+{ -+ u8 channel = 0, bw = 0; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ int err; -+ -+ channel = hal->current_channel; -+ bw = hal->current_channel_bw; -+ err = rtw_halmac_set_bandwidth(adapter_to_dvobj(adapter), channel, pri_ch_idx, bw); -+ if (err) { -+ RTW_INFO(FUNC_ADPT_FMT ": (channel=%d, pri_ch_idx=%d, bw=%d) fail\n", -+ FUNC_ADPT_ARG(adapter), channel, pri_ch_idx, bw); -+ } -+} -+u32 phy_get_tx_bbswing_8821c(_adapter *adapter, BAND_TYPE band, u8 rf_path) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); -+ 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->bb_swing_diff_2g = 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->bb_swing_diff_2g = -3; -+ out = 0x16A; -+ } else { -+ pRFCalibrateInfo->bb_swing_diff_2g = 0; -+ out = 0x200; -+ } -+ } -+ } else if (band == BAND_ON_5G) { -+ pRFCalibrateInfo->bb_swing_diff_5g = 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->external_pa_5g) { -+ pRFCalibrateInfo->bb_swing_diff_5g = -3; -+ out = 0x16A; -+ } else { -+ pRFCalibrateInfo->bb_swing_diff_5g = 0; -+ out = 0x200; -+ } -+ } -+ } else { -+ pRFCalibrateInfo->bb_swing_diff_2g = -3; -+ pRFCalibrateInfo->bb_swing_diff_5g = -3; -+ out = 0x16A; /* -3 dB */ -+ } -+ } else { -+ u32 swing = 0, onePathSwing = 0; -+ -+ if (band == BAND_ON_2_4G) { -+ if (GetRegTxBBSwing_2G(adapter) == AUTO) -+ swing = pHalData->tx_bbswing_24G; -+ else if (bbSwing_2G == 0) -+ swing = 0x00; /* 0 dB */ -+ else if (bbSwing_2G == -3) -+ swing = 0x55; /* -3 dB */ -+ else if (bbSwing_2G == -6) -+ swing = 0xAA; /* -6 dB */ -+ else if (bbSwing_2G == -9) -+ swing = 0xFF; /* -9 dB */ -+ else -+ swing = 0x00; -+ } else { -+ if (GetRegTxBBSwing_5G(adapter) == AUTO) -+ swing = pHalData->tx_bbswing_5G; -+ else if (bbSwing_5G == 0) -+ swing = 0x00; /* 0 dB */ -+ else if (bbSwing_5G == -3) -+ swing = 0x55; /* -3 dB */ -+ else if (bbSwing_5G == -6) -+ swing = 0xAA; /* -6 dB */ -+ else if (bbSwing_5G == -9) -+ swing = 0xFF; /* -9 dB */ -+ else -+ swing = 0x00; -+ } -+ -+ if (rf_path == RF_PATH_A) -+ onePathSwing = (swing & 0x3) >> 0; /* 0xC6/C7[1:0] */ -+ -+ if (onePathSwing == 0x0) { -+ if (band == BAND_ON_2_4G) -+ pRFCalibrateInfo->bb_swing_diff_2g = 0; -+ else -+ pRFCalibrateInfo->bb_swing_diff_5g = 0; -+ out = 0x200; /* 0 dB */ -+ } else if (onePathSwing == 0x1) { -+ if (band == BAND_ON_2_4G) -+ pRFCalibrateInfo->bb_swing_diff_2g = -3; -+ else -+ pRFCalibrateInfo->bb_swing_diff_5g = -3; -+ out = 0x16A; /* -3 dB */ -+ } else if (onePathSwing == 0x2) { -+ if (band == BAND_ON_2_4G) -+ pRFCalibrateInfo->bb_swing_diff_2g = -6; -+ else -+ pRFCalibrateInfo->bb_swing_diff_5g = -6; -+ out = 0x101; /* -6 dB */ -+ } else if (onePathSwing == 0x3) { -+ if (band == BAND_ON_2_4G) -+ pRFCalibrateInfo->bb_swing_diff_2g = -9; -+ else -+ pRFCalibrateInfo->bb_swing_diff_5g = -9; -+ out = 0x0B6; /* -9 dB */ -+ } -+ } -+ -+ /* RTW_INFO("<=== PHY_GetTxBBSwing_8812C, out = 0x%X\n", out); */ -+ -+ return out; -+} -+ -+void phy_set_bb_swing_by_band_8821c(_adapter *adapter, u8 band, u8 previous_band) -+{ -+ s8 BBDiffBetweenBand = 0; -+ struct dm_struct *pDM_Odm = adapter_to_phydm(adapter); -+ struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); -+ -+ phy_set_bb_reg(adapter, rA_TxScale_Jaguar, 0xFFE00000, -+ phy_get_tx_bbswing_8821c(adapter, (BAND_TYPE)band, RF_PATH_A)); /* 0xC1C[31:21] */ -+ -+ /* 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 != previous_band) { -+ BBDiffBetweenBand = (pRFCalibrateInfo->bb_swing_diff_2g - pRFCalibrateInfo->bb_swing_diff_5g); -+ BBDiffBetweenBand = (band == BAND_ON_2_4G) ? BBDiffBetweenBand : (-1 * BBDiffBetweenBand); -+ pRFCalibrateInfo->default_ofdm_index += BBDiffBetweenBand * 2; -+ } -+ -+ odm_clear_txpowertracking_state(pDM_Odm); -+ } -+ -+} -+ -+void phy_switch_wireless_band_8821c(_adapter *adapter) -+{ -+ u8 ret = 0; -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ struct dm_struct *pDM_Odm = &hal_data->odmpriv; -+ u8 current_band = hal_data->current_band_type; -+ -+ if (need_switch_band(adapter, hal_data->current_channel) == _TRUE) { -+#ifdef CONFIG_BT_COEXIST -+ if (hal_data->EEPROMBluetoothCoexist) { -+ struct mlme_ext_priv *mlmeext; -+ -+ /* switch band under site survey or not, must notify to BT COEX */ -+ mlmeext = &adapter->mlmeextpriv; -+ if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE) -+ rtw_btcoex_switchband_notify(_TRUE, hal_data->current_band_type); -+ else -+ rtw_btcoex_switchband_notify(_FALSE, hal_data->current_band_type); -+ } else -+ rtw_btcoex_wifionly_switchband_notify(adapter); -+#else /* !CONFIG_BT_COEXIST */ -+ rtw_btcoex_wifionly_switchband_notify(adapter); -+#endif /* CONFIG_BT_COEXIST */ -+ -+ /* hal->current_channel is center channel of pmlmeext->cur_channel(primary channel) */ -+ ret = config_phydm_switch_band_8821c(pDM_Odm, hal_data->current_channel); -+ -+ if (!ret) { -+ RTW_ERR("%s: config_phydm_switch_band_8821c fail\n", __func__); -+ rtw_warn_on(1); -+ return; -+ } -+ phy_set_bb_swing_by_band_8821c(adapter, hal_data->current_band_type, current_band); -+ } -+} -+ -+/* -+ * Description: -+ * Set channel & bandwidth & offset -+ */ -+void rtl8821c_switch_chnl_and_set_bw(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ struct dm_struct *pDM_Odm = &hal->odmpriv; -+ u8 center_ch = 0, ret = 0; -+ -+ if (adapter->bNotifyChannelChange) { -+ RTW_INFO("[%s] bSwChnl=%d, ch=%d, bSetChnlBW=%d, bw=%d\n", -+ __FUNCTION__, -+ hal->bSwChnl, -+ hal->current_channel, -+ hal->bSetChnlBW, -+ hal->current_channel_bw); -+ } -+ -+ if (RTW_CANNOT_RUN(adapter)) { -+ hal->bSwChnlAndSetBWInProgress = _FALSE; -+ return; -+ } -+ -+ /* set channel & Bandwidth register */ -+ /* 1. set switch band register if need to switch band */ -+ phy_switch_wireless_band_8821c(adapter); -+ -+ /* 2. set channel register */ -+ if (hal->bSwChnl) { -+ ret = config_phydm_switch_channel_8821c(pDM_Odm, hal->current_channel); -+ hal->bSwChnl = _FALSE; -+ -+ if (!ret) { -+ RTW_INFO("%s: config_phydm_switch_channel_8821c fail\n", __FUNCTION__); -+ rtw_warn_on(1); -+ return; -+ } -+ } -+ phydm_config_kfree(pDM_Odm, hal->current_channel); -+ -+ /* 3. set Bandwidth register */ -+ if (hal->bSetChnlBW) { -+ /* get primary channel index */ -+ u8 pri_ch_idx = get_pri_ch_id(adapter); -+ -+ /* 3.1 set MAC register */ -+ mac_switch_bandwidth(adapter, pri_ch_idx); -+ -+ /* 3.2 set BB/RF registet */ -+ ret = config_phydm_switch_bandwidth_8821c(pDM_Odm, pri_ch_idx, hal->current_channel_bw); -+ hal->bSetChnlBW = _FALSE; -+ -+ if (!ret) { -+ RTW_INFO("%s: config_phydm_switch_bandwidth_8821c fail\n", __FUNCTION__); -+ rtw_warn_on(1); -+ return; -+ } -+ } -+ -+ /* TX Power Setting */ -+ /* odm_clear_txpowertracking_state(pDM_Odm); */ -+ rtw_hal_set_tx_power_level(adapter, hal->current_channel); -+ -+ /* IQK */ -+ if ((hal->bNeedIQK == _TRUE) -+ || (adapter->registrypriv.mp_mode == 1)) { -+ #ifdef CONFIG_IQK_MONITOR -+ systime iqk_start_time = rtw_get_current_time(); -+ #endif -+ -+ /*phy_iq_calibrate_8821c(pDM_Odm, _FALSE);*/ -+ rtw_phydm_iqk_trigger(adapter); -+ -+ #ifdef CONFIG_IQK_MONITOR -+ RTW_INFO(ADPT_FMT" switch CH(%d) DO IQK : %d ms\n", -+ ADPT_ARG(adapter), hal->current_channel, rtw_get_passing_time_ms(iqk_start_time)); -+ #endif -+ hal->bNeedIQK = _FALSE; -+ } -+} -+ -+/* -+ * Description: -+ * Store channel setting to hal date -+ * Parameters: -+ * bSwitchChannel swith channel or not -+ * bSetBandWidth set band or not -+ * ChannelNum center channel -+ * ChnlWidth bandwidth -+ * ChnlOffsetOf40MHz channel offset for 40MHz Bandwidth -+ * ChnlOffsetOf80MHz channel offset for 80MHz Bandwidth -+ * CenterFrequencyIndex1 center channel index -+ */ -+ -+void rtl8821c_handle_sw_chnl_and_set_bw( -+ PADAPTER Adapter, u8 bSwitchChannel, u8 bSetBandWidth, -+ u8 ChannelNum, enum channel_width ChnlWidth, u8 ChnlOffsetOf40MHz, -+ u8 ChnlOffsetOf80MHz, u8 CenterFrequencyIndex1) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(Adapter); -+ u8 tmpChannel = hal->current_channel; -+ enum channel_width tmpBW = hal->current_channel_bw; -+ u8 tmpnCur40MhzPrimeSC = hal->nCur40MhzPrimeSC; -+ u8 tmpnCur80MhzPrimeSC = hal->nCur80MhzPrimeSC; -+ u8 tmpCenterFrequencyIndex1 = hal->CurrentCenterFrequencyIndex1; -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ -+ -+ /* check swchnl or setbw */ -+ if (!bSwitchChannel && !bSetBandWidth) { -+ RTW_INFO("%s: not switch channel and not set bandwidth\n", __FUNCTION__); -+ return; -+ } -+ -+ /* skip switch channel operation for current channel & ChannelNum(will be switch) are the same */ -+ if (bSwitchChannel) { -+ if (hal->current_channel != ChannelNum) { -+ if (HAL_IsLegalChannel(Adapter, ChannelNum)) -+ hal->bSwChnl = _TRUE; -+ else -+ return; -+ } -+ } -+ -+ /* check set BandWidth */ -+ if (bSetBandWidth) { -+ /* initial channel bw setting */ -+ if (hal->bChnlBWInitialized == _FALSE) { -+ hal->bChnlBWInitialized = _TRUE; -+ hal->bSetChnlBW = _TRUE; -+ } else if ((hal->current_channel_bw != ChnlWidth) || /* check whether need set band or not */ -+ (hal->nCur40MhzPrimeSC != ChnlOffsetOf40MHz) || -+ (hal->nCur80MhzPrimeSC != ChnlOffsetOf80MHz) || -+ (hal->CurrentCenterFrequencyIndex1 != CenterFrequencyIndex1)) -+ hal->bSetChnlBW = _TRUE; -+ } -+ -+ /* return if not need set bandwidth nor channel after check*/ -+ if (!hal->bSetChnlBW && !hal->bSwChnl && hal->bNeedIQK != _TRUE) -+ return; -+ -+ /* set channel number to hal data */ -+ if (hal->bSwChnl) { -+ hal->current_channel = ChannelNum; -+ hal->CurrentCenterFrequencyIndex1 = ChannelNum; -+ } -+ -+ /* set bandwidth info to hal data */ -+ if (hal->bSetChnlBW) { -+ hal->current_channel_bw = ChnlWidth; -+ hal->nCur40MhzPrimeSC = ChnlOffsetOf40MHz; -+ hal->nCur80MhzPrimeSC = ChnlOffsetOf80MHz; -+ hal->CurrentCenterFrequencyIndex1 = CenterFrequencyIndex1; -+ } -+ -+ /* switch channel & bandwidth */ -+ if (!RTW_CANNOT_RUN(Adapter)) -+ rtl8821c_switch_chnl_and_set_bw(Adapter); -+ else { -+ if (hal->bSwChnl) { -+ hal->current_channel = tmpChannel; -+ hal->CurrentCenterFrequencyIndex1 = tmpChannel; -+ } -+ -+ if (hal->bSetChnlBW) { -+ hal->current_channel_bw = tmpBW; -+ hal->nCur40MhzPrimeSC = tmpnCur40MhzPrimeSC; -+ hal->nCur80MhzPrimeSC = tmpnCur80MhzPrimeSC; -+ hal->CurrentCenterFrequencyIndex1 = tmpCenterFrequencyIndex1; -+ } -+ } -+} -+ -+/* -+ * Description: -+ * Change channel, bandwidth & offset -+ * Parameters: -+ * center_ch center channel -+ * bw bandwidth -+ * offset40 channel offset for 40MHz Bandwidth -+ * offset80 channel offset for 80MHz Bandwidth -+ */ -+void rtl8821c_set_channel_bw(PADAPTER adapter, u8 center_ch, enum channel_width bw, u8 offset40, u8 offset80) -+{ -+ rtl8821c_handle_sw_chnl_and_set_bw(adapter, _TRUE, _TRUE, center_ch, bw, offset40, offset80, center_ch); -+} -+ -+void rtl8821c_notch_filter_switch(PADAPTER adapter, bool enable) -+{ -+ if (enable) -+ RTW_INFO("%s: Enable notch filter\n", __FUNCTION__); -+ else -+ RTW_INFO("%s: Disable notch filter\n", __FUNCTION__); -+} -+#ifdef CONFIG_BEAMFORMING -+#ifdef RTW_BEAMFORMING_VERSION_2 -+/* REG_TXBF_CTRL (Offset 0x42C) */ -+#define BITS_R_TXBF1_AID_8821C (BIT_MASK_R_TXBF1_AID_8821C << BIT_SHIFT_R_TXBF1_AID_8821C) -+#define BIT_CLEAR_R_TXBF1_AID_8821C(x) ((x) & (~BITS_R_TXBF1_AID_8821C)) -+#define BIT_SET_R_TXBF1_AID_8821C(x, v) (BIT_CLEAR_R_TXBF1_AID_8821C(x) | BIT_R_TXBF1_AID_8821C(v)) -+ -+#define BITS_R_TXBF0_AID_8821C (BIT_MASK_R_TXBF0_AID_8821C << BIT_SHIFT_R_TXBF0_AID_8821C) -+#define BIT_CLEAR_R_TXBF0_AID_8821C(x) ((x) & (~BITS_R_TXBF0_AID_8821C)) -+#define BIT_SET_R_TXBF0_AID_8821C(x, v) (BIT_CLEAR_R_TXBF0_AID_8821C(x) | BIT_R_TXBF0_AID_8821C(v)) -+ -+/* REG_NDPA_OPT_CTRL (Offset 0x45F) */ -+#define BITS_R_NDPA_BW_8821C (BIT_MASK_R_NDPA_BW_8821C << BIT_SHIFT_R_NDPA_BW_8821C) -+#define BIT_CLEAR_R_NDPA_BW_8821C(x) ((x) & (~BITS_R_NDPA_BW_8821C)) -+#define BIT_SET_R_NDPA_BW_8821C(x, v) (BIT_CLEAR_R_NDPA_BW_8821C(x) | BIT_R_NDPA_BW_8821C(v)) -+ -+/* REG_ASSOCIATED_BFMEE_SEL (Offset 0x714) */ -+#define BITS_AID1_8821C (BIT_MASK_AID1_8821C << BIT_SHIFT_AID1_8821C) -+#define BIT_CLEAR_AID1_8821C(x) ((x) & (~BITS_AID1_8821C)) -+#define BIT_SET_AID1_8821C(x, v) (BIT_CLEAR_AID1_8821C(x) | BIT_AID1_8821C(v)) -+ -+#define BITS_AID0_8821C (BIT_MASK_AID0_8821C << BIT_SHIFT_AID0_8821C) -+#define BIT_CLEAR_AID0_8821C(x) ((x) & (~BITS_AID0_8821C)) -+#define BIT_SET_AID0_8821C(x, v) (BIT_CLEAR_AID0_8821C(x) | BIT_AID0_8821C(v)) -+ -+/* REG_MU_TX_CTL (Offset 0x14C0) */ -+#define BIT_R_MU_P1_WAIT_STATE_EN_8821C BIT(16) -+ -+#define BIT_SHIFT_R_MU_RL_8821C 12 -+#define BITS_R_MU_RL_8821C (BIT_MASK_R_MU_RL_8821C << BIT_SHIFT_R_MU_RL_8821C) -+#define BIT_R_MU_RL_8821C(x) (((x) & BIT_MASK_R_MU_RL_8821C) << BIT_SHIFT_R_MU_RL_8821C) -+#define BIT_CLEAR_R_MU_RL_8821C(x) ((x) & (~BITS_R_MU_RL_8821C)) -+#define BIT_SET_R_MU_RL_8821C(x, v) (BIT_CLEAR_R_MU_RL_8821C(x) | BIT_R_MU_RL_8821C(v)) -+ -+#define BIT_SHIFT_R_MU_TAB_SEL_8821C 8 -+#define BIT_MASK_R_MU_TAB_SEL_8821C 0x7 -+#define BITS_R_MU_TAB_SEL_8821C (BIT_MASK_R_MU_TAB_SEL_8821C << BIT_SHIFT_R_MU_TAB_SEL_8821C) -+#define BIT_R_MU_TAB_SEL_8821C(x) (((x) & BIT_MASK_R_MU_TAB_SEL_8821C) << BIT_SHIFT_R_MU_TAB_SEL_8821C) -+#define BIT_CLEAR_R_MU_TAB_SEL_8821C(x) ((x) & (~BITS_R_MU_TAB_SEL_8821C)) -+#define BIT_SET_R_MU_TAB_SEL_8821C(x, v) (BIT_CLEAR_R_MU_TAB_SEL_8821C(x) | BIT_R_MU_TAB_SEL_8821C(v)) -+ -+#define BIT_R_EN_MU_MIMO_8821C BIT(7) -+ -+#define BITS_R_MU_TABLE_VALID_8821C (BIT_MASK_R_MU_TABLE_VALID_8821C << BIT_SHIFT_R_MU_TABLE_VALID_8821C) -+#define BIT_CLEAR_R_MU_TABLE_VALID_8821C(x) ((x) & (~BITS_R_MU_TABLE_VALID_8821C)) -+#define BIT_SET_R_MU_TABLE_VALID_8821C(x, v) (BIT_CLEAR_R_MU_TABLE_VALID_8821C(x) | BIT_R_MU_TABLE_VALID_8821C(v)) -+ -+/* REG_WMAC_MU_BF_CTL (Offset 0x1680) */ -+#define BITS_WMAC_MU_BFRPTSEG_SEL_8821C (BIT_MASK_WMAC_MU_BFRPTSEG_SEL_8821C << BIT_SHIFT_WMAC_MU_BFRPTSEG_SEL_8821C) -+#define BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8821C(x) ((x) & (~BITS_WMAC_MU_BFRPTSEG_SEL_8821C)) -+#define BIT_SET_WMAC_MU_BFRPTSEG_SEL_8821C(x, v) (BIT_CLEAR_WMAC_MU_BFRPTSEG_SEL_8821C(x) | BIT_WMAC_MU_BFRPTSEG_SEL_8821C(v)) -+ -+#define BITS_WMAC_MU_BF_MYAID_8821C (BIT_MASK_WMAC_MU_BF_MYAID_8821C << BIT_SHIFT_WMAC_MU_BF_MYAID_8821C) -+#define BIT_CLEAR_WMAC_MU_BF_MYAID_8821C(x) ((x) & (~BITS_WMAC_MU_BF_MYAID_8821C)) -+#define BIT_SET_WMAC_MU_BF_MYAID_8821C(x, v) (BIT_CLEAR_WMAC_MU_BF_MYAID_8821C(x) | BIT_WMAC_MU_BF_MYAID_8821C(v)) -+ -+/* REG_WMAC_ASSOCIATED_MU_BFMEE7 (Offset 0x168E) */ -+#define BIT_STATUS_BFEE7_8821C BIT(10) -+ -+ -+static u8 _bf_get_nrx(PADAPTER adapter) -+{ -+ u8 nrx = 0; -+ -+ nrx = GET_HAL_RX_NSS(adapter); -+ return (nrx - 1); -+} -+ -+ -+static void _config_beamformer_su(PADAPTER adapter, struct beamformer_entry *bfer) -+{ -+ /* Beamforming */ -+ u8 nc_index = 0, nr_index = 0; -+ u8 grouping = 0, codebookinfo = 0, coefficientsize = 0; -+ u32 addr_bfer_info, addr_csi_rpt; -+ u32 csi_param; -+ /* Misc */ -+ u8 i; -+ -+ -+ RTW_INFO("%s: Config SU BFer entry HW setting\n", __FUNCTION__); -+ -+ if (bfer->su_reg_index == 0) { -+ addr_bfer_info = REG_ASSOCIATED_BFMER0_INFO_8821C; -+ addr_csi_rpt = REG_TX_CSI_RPT_PARAM_BW20_8821C; -+ } else { -+ addr_bfer_info = REG_ASSOCIATED_BFMER1_INFO_8821C; -+ addr_csi_rpt = REG_TX_CSI_RPT_PARAM_BW20_8821C + 2; -+ } -+ -+ /* Sounding protocol control */ -+ rtw_write8(adapter, REG_SND_PTCL_CTRL_8821C, 0xDB); -+ -+ /* MAC address/Partial AID of Beamformer */ -+ for (i = 0; i < ETH_ALEN; i++) -+ rtw_write8(adapter, addr_bfer_info+i, bfer->mac_addr[i]); -+ -+ /* CSI report parameters of Beamformer */ -+ nc_index = _bf_get_nrx(adapter); -+ /* -+ * 0x718[7] = 1 use Nsts -+ * 0x718[7] = 0 use reg setting -+ * As Bfee, we use Nsts, so nr_index don't care -+ */ -+ nr_index = bfer->NumofSoundingDim; -+ grouping = 0; -+ /* for ac = 1, for n = 3 */ -+ if (TEST_FLAG(bfer->cap, BEAMFORMER_CAP_VHT_SU)) -+ codebookinfo = 1; -+ else if (TEST_FLAG(bfer->cap, BEAMFORMER_CAP_HT_EXPLICIT)) -+ codebookinfo = 3; -+ coefficientsize = 3; -+ csi_param = (u16)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(nr_index<<3)|(nc_index)); -+ rtw_write16(adapter, addr_csi_rpt, csi_param); -+ RTW_INFO("%s: nc=%d nr=%d group=%d codebookinfo=%d coefficientsize=%d\n", -+ __FUNCTION__, nc_index, nr_index, grouping, codebookinfo, coefficientsize); -+ RTW_INFO("%s: csi=0x%04x\n", __FUNCTION__, csi_param); -+ -+ /* ndp_rx_standby_timer */ -+ rtw_write8(adapter, REG_SND_PTCL_CTRL_8821C+3, 0x70); -+} -+ -+static void _config_beamformer_mu(PADAPTER adapter, struct beamformer_entry *bfer) -+{ -+ /* General */ -+ PHAL_DATA_TYPE hal; -+ /* Beamforming */ -+ struct beamforming_info *bf_info; -+ u8 nc_index = 0, nr_index = 0; -+ u8 grouping = 0, codebookinfo = 0, coefficientsize = 0; -+ u32 csi_param; -+ /* Misc */ -+ u8 i, val8; -+ u16 val16; -+ -+ RTW_INFO("%s: Config MU BFer entry HW setting\n", __FUNCTION__); -+ -+ hal = GET_HAL_DATA(adapter); -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ /* Reset GID table */ -+ for (i = 0; i < 8; i++) -+ bfer->gid_valid[i] = 0; -+ for (i = 0; i < 16; i++) -+ bfer->user_position[i] = 0; -+ -+ /* CSI report parameters of Beamformer */ -+ nc_index = _bf_get_nrx(adapter); -+ 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 = (u16)((coefficientsize<<10)|(codebookinfo<<8)| -+ (grouping<<6)|(nr_index<<3)|(nc_index)); -+ -+ RTW_INFO("%s: nc=%d nr=%d group=%d codebookinfo=%d coefficientsize=%d\n", -+ __func__, nc_index, nr_index, grouping, codebookinfo, -+ coefficientsize); -+ RTW_INFO("%s: csi=0x%04x\n", __func__, csi_param); -+ -+ rtw_halmac_bf_add_mu_bfer(adapter_to_dvobj(adapter), bfer->p_aid, -+ csi_param, bfer->aid & 0xfff, HAL_CSI_SEG_4K, -+ bfer->mac_addr); -+ -+ bf_info->cur_csi_rpt_rate = HALMAC_OFDM6; -+ rtw_halmac_bf_cfg_sounding(adapter_to_dvobj(adapter), HAL_BFEE, -+ bf_info->cur_csi_rpt_rate); -+ -+ /* Set 0x6A0[14] = 1 to accept action_no_ack */ -+ val8 = rtw_read8(adapter, REG_RXFLTMAP0_8821C+1); -+ val8 |= (BIT_MGTFLT14EN_8821C >> 8); -+ rtw_write8(adapter, REG_RXFLTMAP0_8821C+1, val8); -+ -+ /* Set 0x6A2[5:4] = 1 to NDPA and BF report poll */ -+ val8 = rtw_read8(adapter, REG_RXFLTMAP1_8821C); -+ val8 |= BIT_CTRLFLT4EN_8821C | BIT_CTRLFLT5EN_8821C; -+ rtw_write8(adapter, REG_RXFLTMAP1_8821C, val8); -+ -+ /* for B-Cut */ -+ if (IS_B_CUT(hal->version_id)) { -+ phy_set_bb_reg(adapter, REG_RXFLTMAP0_8821C, BIT(20), 0); -+ phy_set_bb_reg(adapter, REG_RXFLTMAP3_8821C, BIT(20), 0); -+ } -+} -+ -+ -+ -+static void _reset_beamformer_su(PADAPTER adapter, struct beamformer_entry *bfer) -+{ -+ /* Beamforming */ -+ struct beamforming_info *info; -+ u8 idx; -+ -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ /* SU BFer */ -+ idx = bfer->su_reg_index; -+ -+ if (idx == 0) { -+ rtw_write32(adapter, REG_ASSOCIATED_BFMER0_INFO_8821C, 0); -+ rtw_write16(adapter, REG_ASSOCIATED_BFMER0_INFO_8821C+4, 0); -+ rtw_write16(adapter, REG_TX_CSI_RPT_PARAM_BW20_8821C, 0); -+ } else { -+ rtw_write32(adapter, REG_ASSOCIATED_BFMER1_INFO_8821C, 0); -+ rtw_write16(adapter, REG_ASSOCIATED_BFMER1_INFO_8821C+4, 0); -+ rtw_write16(adapter, REG_TX_CSI_RPT_PARAM_BW20_8821C+2, 0); -+ } -+ -+ info->beamformer_su_reg_maping &= ~BIT(idx); -+ bfer->su_reg_index = 0xFF; -+ -+ RTW_INFO("%s: Clear SU BFer entry(%d) HW setting\n", __FUNCTION__, idx); -+} -+ -+static void _reset_beamformer_mu(PADAPTER adapter, struct beamformer_entry *bfer) -+{ -+ struct beamforming_info *bf_info; -+ -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ rtw_halmac_bf_del_mu_bfer(adapter_to_dvobj(adapter)); -+ -+ if (bf_info->beamformer_su_cnt == 0 && -+ bf_info->beamformer_mu_cnt == 0) -+ rtw_halmac_bf_del_sounding(adapter_to_dvobj(adapter), HAL_BFEE); -+ -+ RTW_INFO("%s: Clear MU BFer entry HW setting\n", __FUNCTION__); -+} -+ -+void rtl8821c_phy_bf_init(PADAPTER adapter) -+{ -+ u8 v8; -+ u32 v32; -+ -+ v32 = rtw_read32(adapter, REG_MU_TX_CTL_8821C); -+ /* Enable P1 aggr new packet according to P0 transfer time */ -+ v32 |= BIT_R_MU_P1_WAIT_STATE_EN_8821C; -+ /* MU Retry Limit */ -+ v32 = BIT_SET_R_MU_RL_8821C(v32, 0xA); -+ /* Disable Tx MU-MIMO until sounding done */ -+ v32 &= ~BIT_R_EN_MU_MIMO_8821C; -+ /* Clear validity of MU STAs */ -+ v32 = BIT_SET_R_MU_TABLE_VALID_8821C(v32, 0); -+ rtw_write32(adapter, REG_MU_TX_CTL_8821C, v32); -+ -+ /* MU-MIMO Option as default value */ -+ v8 = BIT_WMAC_TXMU_ACKPOLICY_8821C(3); -+ v8 |= BIT_WMAC_TXMU_ACKPOLICY_EN_8821C; -+ rtw_write8(adapter, REG_MU_BF_OPTION_8821C, v8); -+ /* MU-MIMO Control as default value */ -+ rtw_write16(adapter, REG_WMAC_MU_BF_CTL_8821C, 0); -+ -+ /* Set MU NDPA rate & BW source */ -+ /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ -+ v8 = rtw_read8(adapter, REG_TXBF_CTRL_8821C+3); -+ v8 |= (BIT_USE_NDPA_PARAMETER_8821C >> 24); -+ rtw_write8(adapter, REG_TXBF_CTRL_8821C+3, v8); -+ /* 0x45F[7:0] = 0x10 (Rate=OFDM_6M, BW20) */ -+ rtw_write8(adapter, REG_NDPA_OPT_CTRL_8821C, 0x10); -+ -+ /* Temp Settings */ -+ /* STA2's CSI rate is fixed at 6M */ -+ v8 = rtw_read8(adapter, 0x6DF); -+ v8 = (v8 & 0xC0) | 0x4; -+ rtw_write8(adapter, 0x6DF, v8); -+ /* Grouping bitmap parameters */ -+ rtw_write32(adapter, 0x1C94, 0xAFFFAFFF); -+} -+ -+void rtl8821c_phy_bf_enter(PADAPTER adapter, struct sta_info *sta) -+{ -+ struct beamforming_info *info; -+ struct beamformer_entry *bfer; -+ -+ -+ -+ RTW_INFO("+%s: " MAC_FMT "\n", __FUNCTION__, MAC_ARG(sta->cmn.mac_addr)); -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ bfer = rtw_bf_bfer_get_entry_by_addr(adapter, sta->cmn.mac_addr); -+ -+ -+ info->bSetBFHwConfigInProgess = _TRUE; -+ -+ if (bfer) { -+ bfer->state = BEAMFORM_ENTRY_HW_STATE_ADDING; -+ -+ if (TEST_FLAG(bfer->cap, BEAMFORMER_CAP_VHT_MU)) -+ _config_beamformer_mu(adapter, bfer); -+ else if (TEST_FLAG(bfer->cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) -+ _config_beamformer_su(adapter, bfer); -+ -+ bfer->state = BEAMFORM_ENTRY_HW_STATE_ADDED; -+ } -+ -+ info->bSetBFHwConfigInProgess = _FALSE; -+ -+ RTW_INFO("-%s\n", __FUNCTION__); -+} -+ -+void rtl8821c_phy_bf_leave(PADAPTER adapter, u8 *addr) -+{ -+ struct beamforming_info *info; -+ struct beamformer_entry *bfer; -+ -+ -+ -+ RTW_INFO("+%s: " MAC_FMT "\n", __FUNCTION__, MAC_ARG(addr)); -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ -+ bfer = rtw_bf_bfer_get_entry_by_addr(adapter, addr); -+ -+ -+ /* Clear P_AID of Beamformee */ -+ /* Clear MAC address of Beamformer */ -+ /* Clear Associated Bfmee Sel */ -+ if (bfer) { -+ bfer->state = BEAMFORM_ENTRY_HW_STATE_DELETING; -+ -+ rtw_write8(adapter, REG_SND_PTCL_CTRL_8821C, 0xD8); -+ -+ if (TEST_FLAG(bfer->cap, BEAMFORMER_CAP_VHT_MU)) -+ _reset_beamformer_mu(adapter, bfer); -+ else if (TEST_FLAG(bfer->cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) -+ _reset_beamformer_su(adapter, bfer); -+ -+ bfer->state = BEAMFORM_ENTRY_HW_STATE_NONE; -+ bfer->cap = BEAMFORMING_CAP_NONE; -+ bfer->used = _FALSE; -+ } -+ -+ -+ RTW_INFO("-%s\n", __FUNCTION__); -+} -+ -+void rtl8821c_phy_bf_set_gid_table(PADAPTER adapter, -+ struct beamformer_entry *bfer_info) -+{ -+ struct beamformer_entry *bfer; -+ struct beamforming_info *info; -+ u32 gid_valid[2] = {0}; -+ u32 user_position[4] = {0}; -+ int i; -+ -+ /* update bfer info */ -+ bfer = rtw_bf_bfer_get_entry_by_addr(adapter, bfer_info->mac_addr); -+ if (!bfer) { -+ RTW_INFO("%s: Cannot find BFer entry!!\n", __func__); -+ return; -+ } -+ _rtw_memcpy(bfer->gid_valid, bfer_info->gid_valid, 8); -+ _rtw_memcpy(bfer->user_position, bfer_info->user_position, 16); -+ -+ info = GET_BEAMFORM_INFO(adapter); -+ info->bSetBFHwConfigInProgess = _TRUE; -+ -+ /* For GID 0~31 */ -+ for (i = 0; i < 4; i++) -+ gid_valid[0] |= (bfer->gid_valid[i] << (i << 3)); -+ -+ for (i = 0; i < 8; i++) { -+ if (i < 4) -+ user_position[0] |= (bfer->user_position[i] << (i << 3)); -+ else -+ user_position[1] |= (bfer->user_position[i] << ((i - 4) << 3)); -+ } -+ -+ RTW_INFO("%s: STA0: gid_valid=0x%x, user_position_l=0x%x, user_position_h=0x%x\n", -+ __func__, gid_valid[0], user_position[0], user_position[1]); -+ -+ /* For GID 32~64 */ -+ for (i = 4; i < 8; i++) -+ gid_valid[1] |= (bfer->gid_valid[i] << ((i - 4) << 3)); -+ -+ for (i = 8; i < 16; i++) { -+ if (i < 12) -+ user_position[2] |= (bfer->user_position[i] << ((i - 8) << 3)); -+ else -+ user_position[3] |= (bfer->user_position[i] << ((i - 12) << 3)); -+ } -+ -+ RTW_INFO("%s: STA1: gid_valid=0x%x, user_position_l=0x%x, user_position_h=0x%x\n", -+ __func__, gid_valid[1], user_position[2], user_position[3]); -+ -+ rtw_halmac_bf_cfg_mu_bfee(adapter_to_dvobj(adapter), gid_valid, user_position); -+ -+ info->bSetBFHwConfigInProgess = _FALSE; -+} -+#endif /* RTW_BEAMFORMING_VERSION_2 */ -+#endif /* CONFIG_BEAMFORMING */ -+#ifdef CONFIG_MP_INCLUDED -+/* -+ * Description: -+ * Config RF path -+ * -+ * Parameters: -+ * adapter pointer of struct _ADAPTER -+ */ -+void rtl8821c_mp_config_rfpath(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ PMPT_CONTEXT mpt; -+ ANTENNA_PATH anttx, antrx; -+ enum rf_path rxant; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ mpt = &adapter->mppriv.mpt_ctx; -+ anttx = hal->antenna_tx_path; -+ antrx = hal->AntennaRxPath; -+ RTW_INFO("+Config RF Path, tx=0x%x rx=0x%x\n", anttx, antrx); -+ -+#if 0 /* phydm not ready */ -+ switch (anttx) { -+ case ANTENNA_A: -+ mpt->mpt_rf_path = ODM_RF_A; -+ break; -+ case ANTENNA_B: -+ mpt->mpt_rf_path = ODM_RF_B; -+ break; -+ case ANTENNA_AB: -+ default: -+ mpt->mpt_rf_path = ODM_RF_A | ODM_RF_B; -+ break; -+ } -+ -+ switch (antrx) { -+ case ANTENNA_A: -+ rxant = ODM_RF_A; -+ break; -+ case ANTENNA_B: -+ rxant = ODM_RF_B; -+ break; -+ case ANTENNA_AB: -+ default: -+ rxant = ODM_RF_A | ODM_RF_B; -+ break; -+ } -+ -+ config_phydm_trx_mode_8821c(GET_PDM_ODM(adapter), mpt->mpt_rf_path, rxant, FALSE); -+#endif -+ RTW_INFO("-Config RF Path Finish\n"); -+} -+ -+#endif /* CONFIG_MP_INCLUDED */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs.h b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs.h -new file mode 100644 -index 000000000..b44da45d7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs.h -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_H_ -+#define _RTL8821CS_H_ -+ -+#include /* PADAPTER */ -+ -+/* rtl8821cs_halinit.c */ -+u32 rtl8821cs_hal_init(PADAPTER); -+u32 rtl8821cs_hal_deinit(PADAPTER adapter); -+ -+void rtl8821cs_init_default_value(PADAPTER); -+ -+/* rtl8821cs_ops.c */ -+u32 rtl8821cs_get_interrupt(PADAPTER); -+void rtl8821cs_clear_interrupt(PADAPTER, u32 hisr); -+u32 rtl8821cs_get_himr(PADAPTER adapter); -+void rtl8821cs_update_himr(PADAPTER adapter, u32 himr); -+void rtl8821cs_update_interrupt_mask(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); -+ -+/* rtl8821cs_xmit.c */ -+ -+ -+#endif /* _RTL8821CS_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halinit.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halinit.c -new file mode 100644 -index 000000000..eec7bed72 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halinit.c -@@ -0,0 +1,303 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_HALINIT_C_ -+ -+#include /* PADAPTER, basic_types.h and etc. */ -+#include /* HAL_DATA_TYPE */ -+#include "../rtl8821c.h" /* rtl8821c_mac_init(), rtl8821c_phy_init() and etc. */ -+#include "../../hal_halmac.h" /* rtw_halmac_get_oqt_size*/ -+ -+/* -+#define HALMAC_NORMAL_HPQ_PGNUM_8821C 16 -+#define HALMAC_NORMAL_NPQ_PGNUM_8821C 16 -+#define HALMAC_NORMAL_LPQ_PGNUM_8821C 16 -+#define HALMAC_NORMAL_EXPQ_PGNUM_8821C 14 -+#define HALMAC_NORMAL_GAP_PGNUM_8821C 1 -+ -+ case HALMAC_TRX_MODE_NORMAL: -+ pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_VO] = HALMAC_DMA_MAPPING_NORMAL; -+ pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_VI] = HALMAC_DMA_MAPPING_NORMAL; -+ pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_BE] = HALMAC_DMA_MAPPING_LOW; -+ pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_BK] = HALMAC_DMA_MAPPING_LOW; -+ pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_MG] = HALMAC_DMA_MAPPING_EXTRA; -+ pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_HI] = HALMAC_DMA_MAPPING_HIGH; -+ -+*/ -+ -+static void rtl8821cs_init_xmit_info(_adapter *adapter) -+{ -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); -+ u32 page_size; -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); -+ -+ hal_data->tx_high_page = rtw_read16(adapter, REG_FIFOPAGE_INFO_1) & 0xFFF; -+ hal_data->tx_low_page = rtw_read16(adapter, REG_FIFOPAGE_INFO_2) & 0xFFF; -+ hal_data->tx_normal_page = rtw_read16(adapter, REG_FIFOPAGE_INFO_3) & 0xFFF; -+ hal_data->tx_extra_page = rtw_read16(adapter, REG_FIFOPAGE_INFO_4) & 0xFFF; -+ hal_data->tx_pub_page = rtw_read16(adapter, REG_FIFOPAGE_INFO_5) & 0xFFF; -+ -+#ifdef DBG_DUMP_RQPN -+ { -+ u32 tx_fifo_size; -+ -+ rtw_halmac_get_tx_fifo_size(adapter_to_dvobj(adapter), &tx_fifo_size); -+ RTW_INFO("%s => High Pages:%d, LOW Pages:%d, Normal Pages:%d, Extra Pages:%d, Pub Pages:%d, Total Pages:%d\n" -+ , __func__ -+ , hal_data->tx_high_page -+ , hal_data->tx_low_page -+ , hal_data->tx_normal_page -+ , hal_data->tx_extra_page -+ , hal_data->tx_pub_page -+ , (tx_fifo_size / page_size)); -+ } -+#endif -+ -+ hal_data->max_xmit_page = PageNum(MAX_XMITBUF_SZ, page_size); -+ -+ if (adapter->registrypriv.wifi_spec) { -+ /*HALMAC_TRX_MODE_WMM - VO - HQ , VI - NQ , BE - LQ , BK - NQ , MG - HQ , HI -HQ*/ -+ hal_data->max_xmit_page_vo = hal_data->tx_high_page + hal_data->tx_pub_page; -+ hal_data->max_xmit_page_vi = (hal_data->tx_normal_page + hal_data->tx_pub_page) >> 1; -+ hal_data->max_xmit_page_be = hal_data->tx_low_page + hal_data->tx_pub_page; -+ hal_data->max_xmit_page_bk = (hal_data->tx_normal_page + hal_data->tx_pub_page) >> 1; -+ } else { -+ /*HALMAC_TRX_MODE_NORMAL - VO - NQ , VI - NQ , BE - LQ , BK - LQ , MG - EXQ , HI -HQ*/ -+ #ifdef XMIT_BUF_SIZE -+ hal_data->max_xmit_size_vovi = ((hal_data->tx_normal_page + hal_data->tx_pub_page) >> 1) * page_size; -+ hal_data->max_xmit_size_bebk = ((hal_data->tx_low_page + hal_data->tx_pub_page) >> 1) * page_size; -+ #endif -+ -+ hal_data->max_xmit_page_vo = (hal_data->tx_normal_page + hal_data->tx_pub_page) >> 1; -+ hal_data->max_xmit_page_vi = (hal_data->tx_normal_page + hal_data->tx_pub_page) >> 1; -+ hal_data->max_xmit_page_be = (hal_data->tx_low_page + hal_data->tx_pub_page) >> 1; -+ hal_data->max_xmit_page_bk = (hal_data->tx_low_page + hal_data->tx_pub_page) >> 1; -+ } -+ -+#ifdef DBG_DUMP_RQPN -+ #ifdef XMIT_BUF_SIZE -+ RTW_INFO("%s => max_xmit_size_vovi:%d, max_xmit_size_bebk:%d\n", __func__, hal_data->max_xmit_size_vovi, hal_data->max_xmit_size_bebk); -+ #endif -+ -+ RTW_INFO("%s => VO max_xmit_page:%d, VI max_xmit_page:%d\n", __func__, hal_data->max_xmit_page_vo, hal_data->max_xmit_page_vi); -+ RTW_INFO("%s => BE max_xmit_page:%d, BK max_xmit_page:%d\n", __func__, hal_data->max_xmit_page_be, hal_data->max_xmit_page_bk); -+#endif -+ -+ if (rtw_halmac_get_oqt_size(adapter_to_dvobj(adapter), &hal_data->max_oqt_size)) { -+ RTW_WARN("%s: Fail to get Max OQT size! use default max-size : 32\n", __func__); -+ hal_data->max_oqt_size = 32; -+ } -+} -+ -+#ifdef CONFIG_FWLPS_IN_IPS -+u8 rtl8821cs_fw_ips_init(_adapter *padapter) -+{ -+ struct sreset_priv *psrtpriv = &GET_HAL_DATA(padapter)->srestpriv; -+ struct debug_priv *pdbgpriv = &adapter_to_dvobj(padapter)->drv_dbg; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ if (pwrctl->bips_processing == _TRUE && psrtpriv->silent_reset_inprogress == _FALSE -+ && GET_HAL_DATA(padapter)->bFWReady == _TRUE && pwrctl->pre_ips_type == 0) { -+ systime start_time; -+ u8 cpwm_orig, cpwm_now, rpwm; -+ u8 bMacPwrCtrlOn = _TRUE; -+ -+ RTW_INFO("%s: Leaving FW_IPS\n", __func__); -+ -+ /* for polling cpwm */ -+ cpwm_orig = 0; -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); -+ -+ /* set rpwm */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RPWM_TOG, &rpwm); -+ rpwm += 0x80; -+ rpwm |= PS_ACK; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); -+ -+ -+ RTW_INFO("%s: write rpwm=%02x\n", __func__, rpwm); -+ -+ pwrctl->tog = (rpwm + 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) { -+ #ifdef DBG_CHECK_FW_PS_STATE -+ RTW_INFO("%s: polling cpwm ok when leaving IPS in FWLPS state, cpwm_orig=%02x, cpwm_now=%02x, 0x100=0x%x\n" -+ , __func__, cpwm_orig, cpwm_now, rtw_read8(padapter, REG_CR)); -+ #endif /* DBG_CHECK_FW_PS_STATE */ -+ break; -+ } -+ -+ if (rtw_get_passing_time_ms(start_time) > 100) { -+ RTW_INFO("%s: polling cpwm timeout when leaving IPS in FWLPS state\n", __func__); -+ break; -+ } -+ } while (1); -+ -+ rtl8821c_set_FwPwrModeInIPS_cmd(padapter, 0); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ -+ #ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ RTW_INFO("after hal init, fw ps state in 32k\n"); -+ pdbgpriv->dbg_ips_drvopen_fail_cnt++; -+ } -+ #endif /* DBG_CHECK_FW_PS_STATE */ -+ return _SUCCESS; -+ } -+ return _FAIL; -+} -+ -+u8 rtl8821cs_fw_ips_deinit(_adapter *padapter) -+{ -+ struct sreset_priv *psrtpriv = &GET_HAL_DATA(padapter)->srestpriv; -+ struct debug_priv *pdbgpriv = &adapter_to_dvobj(padapter)->drv_dbg; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ if (pwrctl->bips_processing == _TRUE && psrtpriv->silent_reset_inprogress == _FALSE -+ && GET_HAL_DATA(padapter)->bFWReady == _TRUE && padapter->netif_up == _TRUE) { -+ int cnt = 0; -+ u8 val8 = 0, rpwm; -+ -+ RTW_INFO("%s: issue H2C to FW when entering IPS\n", __func__); -+ -+ rtl8821c_set_FwPwrModeInIPS_cmd(padapter, 0x1); -+ /* 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)); -+ -+ /* H2C done, enter 32k */ -+ if (val8 == 0) { -+ /* set rpwm to enter 32k */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RPWM_TOG, &rpwm); -+ rpwm += 0x80; -+ rpwm |= BIT_SYS_CLK_8821C; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); -+ RTW_INFO("%s: write rpwm=%02x\n", __func__, rpwm); -+ pwrctl->tog = (val8 + 0x80) & 0x80; -+ -+ cnt = val8 = 0; -+ do { -+ val8 = rtw_read8(padapter, REG_CR); -+ cnt++; -+ RTW_INFO("%s polling 0x100=0x%x, cnt=%d\n", __func__, val8, cnt); -+ rtw_mdelay_os(10); -+ } while (cnt < 100 && (val8 != 0xEA)); -+ -+ #ifdef DBG_CHECK_FW_PS_STATE -+ if (val8 != 0xEA) -+ 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, REG_HMETFR)); -+ #endif /* DBG_CHECK_FW_PS_STATE */ -+ } else { -+ 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, REG_HMETFR)); -+ } -+ -+ RTW_INFO("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)); -+ -+ pwrctl->pre_ips_type = 0; -+ -+ return _SUCCESS; -+ } -+ -+ pdbgpriv->dbg_carddisable_cnt++; -+ pwrctl->pre_ips_type = 1; -+ -+ return _FAIL; -+ -+} -+#endif /*CONFIG_FWLPS_IN_IPS*/ -+ -+#define MAX_AMPDU_NUMBER 0x1212 /*MAX AMPDU Number = 18*/ -+static void rtl8821cs_ampdu_num_cfg(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ PSDIO_DATA psdio_data = &dvobj->intf_data; -+ u16 ampdu_num = MAX_AMPDU_NUMBER; -+ -+ if (psdio_data->clock < RTW_SDIO_CLK_80M) -+ ampdu_num = 0x1F1F; -+ -+ rtw_write16(adapter, REG_PROT_MODE_CTRL_8821C + 2, ampdu_num); -+} -+ -+static void rtl8821cs_init_misc(_adapter *adapter) -+{ -+ #ifdef DBG_DL_FW_MEM -+ rtw_write8(adapter, 0xf6, 0x01); -+ rtw_write8(adapter, 0x3a, 0x28); -+ #endif -+ -+ #ifdef CONFIG_BT_WAKE_HST_OPEN_DRAIN -+ /*PAD Type control select for GPIO14 (DEV_WAKE_HST) in USB or SDIO interface -+ 0: Push-Pull , 1: Open-Drain*/ -+ rtw_write32(adapter, REG_WL_BT_PWR_CTRL, -+ rtw_read32(adapter, REG_WL_BT_PWR_CTRL) | BIT_DEVWAKE_PAD_TYPE_SEL); -+ #endif -+ -+ rtl8821cs_ampdu_num_cfg(adapter); -+} -+ -+u32 rtl8821cs_hal_init(PADAPTER adapter) -+{ -+#ifdef CONFIG_FWLPS_IN_IPS -+ if (_SUCCESS == rtl8821cs_fw_ips_init(adapter)) -+ return _SUCCESS; -+#endif -+ if (_FALSE == rtl8821c_hal_init(adapter)) -+ return _FAIL; -+ -+ rtl8821cs_init_xmit_info(adapter); -+ rtl8821cs_init_misc(adapter); -+ -+ return _SUCCESS; -+} -+u32 rtl8821cs_hal_deinit(PADAPTER adapter) -+{ -+#ifdef CONFIG_FWLPS_IN_IPS -+ if (_SUCCESS == rtl8821cs_fw_ips_deinit(adapter)) -+ return _SUCCESS; -+#endif -+ -+ return rtl8821c_hal_deinit(adapter); -+} -+ -+void rtl8821cs_init_default_value(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ rtl8821c_init_default_value(adapter); -+ -+ /* interface related variable */ -+ hal->SdioRxFIFOCnt = 0; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halinit.h b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halinit.h -new file mode 100644 -index 000000000..d82c522be ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halinit.h -@@ -0,0 +1,18 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_HALINIT_H_ -+#define _RTL8821CS_HALINIT_H_ -+ -+#endif /* _RTL8821CS_HALINIT_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halmac.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halmac.c -new file mode 100644 -index 000000000..5ce34e5f5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halmac.c -@@ -0,0 +1,107 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2018 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_HALMAC_C_ -+ -+#include /* struct dvobj_priv and etc. */ -+#include /* rtw_sdio_write_cmd53() */ -+#include "../../hal_halmac.h" -+#include "rtl8821cs_io.h" -+ -+ -+static u8 sdio_write_data_rsvd_page(void *d, u8 *pBuf, u32 size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ u32 desclen, len; -+ u8 *buf; -+ u8 ret; -+ -+ -+ halmac = dvobj_to_halmac((struct dvobj_priv *)d); -+ api = HALMAC_GET_API(halmac); -+ -+ rtw_halmac_get_tx_desc_size((struct dvobj_priv *)d, &desclen); -+ len = desclen + size; -+ buf = rtw_zmalloc(len); -+ if (!buf) -+ return 0; -+ _rtw_memcpy(buf + desclen, pBuf, size); -+ -+ SET_TX_DESC_TXPKTSIZE_8821C(buf, size); -+ SET_TX_DESC_OFFSET_8821C(buf, desclen); -+ SET_TX_DESC_QSEL_8821C(buf, HALMAC_TXDESC_QSEL_BEACON); -+ api->halmac_fill_txdesc_checksum(halmac, buf); -+ -+ ret = rtl8821cs_write_port(d, len, buf); -+ if (_SUCCESS == ret) -+ ret = 1; -+ else -+ ret = 0; -+ -+ rtw_mfree(buf, len); -+ -+ return ret; -+} -+ -+static u8 sdio_write_data_h2c(void *d, u8 *pBuf, u32 size) -+{ -+ struct halmac_adapter *halmac; -+ struct halmac_api *api; -+ u32 addr, desclen, len; -+ u8 *buf; -+ u8 ret; -+ -+ -+ halmac = dvobj_to_halmac((struct dvobj_priv *)d); -+ api = HALMAC_GET_API(halmac); -+ -+ rtw_halmac_get_tx_desc_size((struct dvobj_priv *)d, &desclen); -+ len = desclen + size; -+ buf = rtw_zmalloc(len); -+ if (!buf) -+ return 0; -+ _rtw_memcpy(buf + desclen, pBuf, size); -+ -+ SET_TX_DESC_TXPKTSIZE_8821C(buf, size); -+ SET_TX_DESC_QSEL_8821C(buf, HALMAC_TXDESC_QSEL_H2C_CMD); -+ api->halmac_fill_txdesc_checksum(halmac, buf); -+ -+ ret = rtl8821cs_write_port(d, len, buf); -+ if (_SUCCESS == ret) -+ ret = 1; -+ else -+ ret = 0; -+ -+ rtw_mfree(buf, len); -+ -+ return ret; -+} -+ -+int rtl8821cs_halmac_init_adapter(PADAPTER adapter) -+{ -+ struct dvobj_priv *d; -+ struct halmac_platform_api *api; -+ int err; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ api = &rtw_halmac_platform_api; -+ api->SEND_RSVD_PAGE = sdio_write_data_rsvd_page; -+ api->SEND_H2C_PKT = sdio_write_data_h2c; -+ -+ err = rtw_halmac_init_adapter(d, api); -+ -+ return err; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halmac.h b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halmac.h -new file mode 100644 -index 000000000..e3e4a9752 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_halmac.h -@@ -0,0 +1,22 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_HALMAC_H_ -+#define _RTL8821CS_HALMAC_H_ -+ -+#include /* PADAPTER */ -+ -+int rtl8821cs_halmac_init_adapter(PADAPTER); -+ -+#endif /* _RTL8821CS_HALMAC_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_io.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_io.c -new file mode 100644 -index 000000000..7b1f7cfcf ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_io.c -@@ -0,0 +1,769 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_IO_C_ -+ -+#include /* PADAPTER and etc. */ -+#include /* HAL_DATA_TYPE */ -+#include /* rtw_sdio_write_cmd53() */ -+#include /* SDIO_ERR_VAL8 and etc. */ -+#include "rtl8821cs.h" /* rtl8821cs_get_interrupt(), rtl8821cs_clear_interrupt() */ -+#include "rtl8821cs_recv.h" /* rtl8821cs_rxhandler() */ -+#include "../../hal_halmac.h" /* rtw_halmac_sdio_get_rx_addr and etc. */ -+ -+/*#define SDIO_DEBUG_IO 1*/ -+ -+/* -+ * For Core I/O API -+ */ -+ -+static u8 sdio_f0_read8(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ struct dvobj_priv *d; -+ u8 val = 0; -+ u8 ret; -+ -+ -+ d = pintfhdl->pintf_dev; -+ ret = rtw_sdio_f0_read(d, addr, &val, 1); -+ if (_FAIL == ret) -+ RTW_ERR("%s: Read f0 register(0x%x) FAIL!\n", -+ __FUNCTION__, addr); -+ -+ return val; -+} -+ -+/* -+ * 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 -+ * mem address to put data -+ * -+ * Return: -+ * _SUCCESS(1) Success -+ * _FAIL(0) Fail -+ */ -+/* #define CONFIG_NEW_SDIO_RP_FUNC*/ /*will cause system crash*/ -+#ifdef CONFIG_NEW_SDIO_RP_FUNC -+static s32 _sdio_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *mem) -+{ -+ struct dvobj_priv *d; -+ PHAL_DATA_TYPE hal; -+ u32 rxaddr; -+ -+ size_t buflen; -+ u32 ret; -+ -+ -+ d = pintfhdl->pintf_dev; -+ hal = GET_HAL_DATA(pintfhdl->padapter); -+ -+ cnt = _RND4(cnt); -+ rxaddr = rtw_halmac_sdio_get_rx_addr(d, &hal->SdioRxFIFOCnt); -+ -+ /* align size to guarantee I/O would be done in one command */ -+ buflen = rtw_sdio_cmd53_align_size(d, cnt); -+ -+ if (buflen >= (MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ)) { -+ RTW_INFO("%s [ERROR] buflen(%zu) > skb_len(%d), may cause memory overwrite\n" -+ , __func__, buflen, (MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ)); -+ rtw_warn_on(1); -+ buflen = MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ; -+ } -+ -+ ret = rtw_sdio_read_cmd53(d, rxaddr, mem, buflen); -+ -+ return ret; -+} -+#else -+static u32 _sdio_read_port( -+ struct intf_hdl *pintfhdl, -+ u32 addr, -+ u32 cnt, -+ u8 *mem) -+{ -+ struct dvobj_priv *d = pintfhdl->pintf_dev; -+ PADAPTER padapter = pintfhdl->padapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ s32 err; -+ -+ addr = rtw_halmac_sdio_get_rx_addr(d, &pHalData->SdioRxFIFOCnt); -+ -+ cnt = _RND4(cnt); -+ cnt = rtw_sdio_cmd53_align_size(d, cnt); -+ -+ err = _sd_read(pintfhdl, addr, cnt, mem); -+ /*err = sd_read(pintfhdl, addr, cnt, mem);*/ -+ -+ -+ -+ if (err) -+ return _FAIL; -+ return _SUCCESS; -+} -+#endif -+/* -+ * 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 -+ * mem struct recv_buf* -+ * -+ * Return: -+ * _SUCCESS(1) Success -+ * _FAIL(0) Fail -+ */ -+static u32 sdio_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *mem) -+{ -+ return _sdio_read_port(pintfhdl, addr, cnt, mem); -+#if 0 -+ RTW_INFO("SDIO can not handle recvbuf->pbuf\n"); -+ rtw_warn_on(1); -+ return _FALSE; -+ -+ struct recv_buf *recvbuf; -+ -+ recvbuf = (struct recv_buf *)mem; -+ return _sdio_read_port(pintfhdl, addr, cnt, recvbuf->pbuf); -+#endif -+} -+ -+/* -+ * Description: -+ * Write to TX FIFO -+ * Align write size to block size, -+ * and check enough FIFO size to write. -+ * -+ * Parameters: -+ * d a pointer of dvobj_priv -+ * addr not use -+ * cnt size to write -+ * mem buffer to write -+ * -+ * Return: -+ * _SUCCESS(1) Success -+ * _FAIL(0) Fail -+ */ -+u32 rtl8821cs_write_port(struct dvobj_priv *d, u32 cnt, u8 *mem) -+{ -+ u32 txaddr, txsize; -+ u32 ret = _FAIL; -+ -+ cnt = _RND4(cnt); -+ txaddr = rtw_halmac_sdio_get_tx_addr(d, mem, cnt); -+ if (!txaddr) -+ goto exit; -+ -+ /* align size to guarantee I/O would be done in one command */ -+ txsize = rtw_sdio_cmd53_align_size(d, cnt); -+ -+ ret = rtw_sdio_write_cmd53(d, txaddr, mem, txsize); -+ -+exit: -+ -+ return ret; -+} -+#ifdef CONFIG_NEW_SDIO_WP_FUNC -+/* -+ * Description: -+ * Write to TX FIFO -+ * Align write size to block size, -+ * and check enough FIFO size to write. -+ * -+ * Parameters: -+ * pintfhdl a pointer of intf_hdl -+ * addr not use -+ * cnt size to write -+ * mem struct xmit_buf* -+ * -+ * Return: -+ * _SUCCESS(1) Success -+ * _FAIL(0) Fail -+ */ -+static u32 sdio_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *mem) -+{ -+ struct dvobj_priv *d; -+ PADAPTER adapter; -+ struct xmit_buf *xmitbuf; -+ u32 txaddr, txsize; -+ u32 ret = _FAIL; -+ -+ -+ d = pintfhdl->pintf_dev; -+ adapter = pintfhdl->padapter; -+ xmitbuf = (struct xmit_buf *)mem; -+ -+#if 0 /* who will call this when hardware not be initialized? */ -+ if (!rtw_is_hw_init_completed(adapter)) { -+ RTW_INFO("%s [addr=0x%x cnt=%d] adapter->hw_init_completed == _FALSE\n", -+ __FUNCTION__, addr, cnt); -+ goto exit; -+ } -+#endif -+ -+ ret = rtl8821cs_write_port(d, cnt, xmitbuf->pdata); -+ -+ rtw_sctx_done_err(&xmitbuf->sctx, -+ (_FAIL == ret) ? RTW_SCTX_DONE_WRITE_PORT_ERR : RTW_SCTX_DONE_SUCCESS); -+ -+ return ret; -+} -+#else -+static u32 sdio_write_port( -+ struct intf_hdl *pintfhdl, -+ u32 addr, -+ u32 cnt, -+ u8 *mem) -+{ -+ PADAPTER padapter; -+ s32 err; -+ struct xmit_buf *xmitbuf = (struct xmit_buf *)mem; -+ -+ padapter = pintfhdl->padapter; -+ -+ if (!rtw_is_hw_init_completed(padapter)) { -+ RTW_INFO("%s [addr=0x%x cnt=%d] padapter->hw_init_completed == _FALSE\n", __func__, addr, cnt); -+ return _FAIL; -+ } -+ -+ cnt = _RND4(cnt); -+ addr = rtw_halmac_sdio_get_tx_addr(adapter_to_dvobj(padapter), xmitbuf->pdata, cnt); -+ if (!addr) { -+ RTW_ERR("%s, addr error=%d\n", __func__, addr); -+ -+ return _FAIL; -+ } -+ -+ cnt = rtw_sdio_cmd53_align_size(adapter_to_dvobj(padapter), 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) { -+ RTW_ERR("%s, error=%d\n", __func__, err); -+ -+ return _FAIL; -+ } -+ return _SUCCESS; -+} -+#endif -+ -+void sdio_set_intf_ops(PADAPTER adapter, struct _io_ops *pops) -+{ -+ -+ pops->_read8 = rtw_halmac_read8; -+ pops->_read16 = rtw_halmac_read16; -+ pops->_read32 = rtw_halmac_read32; -+ pops->_read_mem = rtw_halmac_read_mem; -+ pops->_read_port = sdio_read_port; -+ -+ pops->_write8 = rtw_halmac_write8; -+ pops->_write16 = rtw_halmac_write16; -+ pops->_write32 = rtw_halmac_write32; -+ pops->_writeN = NULL; -+ pops->_write_mem = NULL; -+ pops->_write_port = sdio_write_port; -+ -+ pops->_sd_f0_read8 = sdio_f0_read8; -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ pops->_sd_iread8 = rtw_halmac_iread8; -+ pops->_sd_iread16 = rtw_halmac_iread16; -+ pops->_sd_iread32 = rtw_halmac_iread32; -+ pops->_sd_iwrite8 = rtw_halmac_write8; -+ pops->_sd_iwrite16 = rtw_halmac_write16; -+ pops->_sd_iwrite32 = rtw_halmac_write32; -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+ -+} -+#ifdef CONFIG_SDIO_RX_COPY -+static u32 sd_recv_rxfifo(PADAPTER padapter, u32 size, struct recv_buf **recvbuf_ret) -+{ -+ u32 readsize, ret = _SUCCESS; -+ u8 *preadbuf; -+ struct recv_priv *precvpriv; -+ struct recv_buf *precvbuf; -+ -+ *recvbuf_ret = NULL; -+ -+ readsize = size; -+ -+ if (readsize > MAX_RECVBUF_SZ) { -+ RTW_ERR(FUNC_ADPT_FMT" %u\n", FUNC_ADPT_ARG(padapter), readsize); -+ rtw_warn_on(readsize > MAX_RECVBUF_SZ); -+ } -+ -+ /*1. alloc recvbuf*/ -+ precvpriv = &padapter->recvpriv; -+ precvbuf = rtw_dequeue_recvbuf(&precvpriv->free_recv_buf_queue); -+ if (precvbuf == NULL) { -+ /*RTW_ERR("%s: recvbuf unavailable\n", __func__);*/ -+ return RTW_RBUF_UNAVAIL; -+ } -+ -+ /* 2. alloc skb*/ -+ if (precvbuf->pskb == NULL) { -+ SIZE_PTR tmpaddr = 0; -+ SIZE_PTR alignment = 0; -+ -+ RTW_WARN("%s- [WARN] - alloc_skb for rx buffer\n", __func__); -+ -+ precvbuf->pskb = rtw_skb_alloc(MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); -+ -+ if (precvbuf->pskb == NULL) { -+ RTW_ERR("%s: alloc_skb fail! read=%d\n", __func__, MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); -+ rtw_enqueue_recvbuf(precvbuf, &precvpriv->free_recv_buf_queue); -+ return RTW_RBUF_PKT_UNAVAIL; -+ } -+ -+ 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)); -+ -+ 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->len = 0; -+ } -+ -+ } -+ -+ /*3. read data from rxfifo*/ -+ preadbuf = precvbuf->pdata; -+ ret = _sdio_read_port(&padapter->iopriv.intf, WLAN_RX0FF_DEVICE_ID, readsize, preadbuf); -+ if (ret == _FAIL) { -+ RTW_ERR("%s: sdio read port FAIL!\n", __func__); -+ rtw_enqueue_recvbuf(precvbuf, &precvpriv->free_recv_buf_queue); -+ return RTW_SDIO_READ_PORT_FAIL; -+ } -+ -+ /*4. init recvbuf*/ -+ precvbuf->len = readsize; -+ *recvbuf_ret = precvbuf; -+ -+ return ret; -+} -+static u32 sd_recv_and_drop(PADAPTER adapter, u32 size) -+{ -+ u32 readsize, buflen; -+ u8 *rbuf; -+ s32 ret = _FAIL; -+ -+ readsize = RND4(size); -+ buflen = rtw_sdio_cmd53_align_size(adapter_to_dvobj(adapter), readsize); -+ -+ if (buflen > MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ) { -+ RTW_ERR(FUNC_ADPT_FMT" %u\n", FUNC_ADPT_ARG(adapter), readsize); -+ rtw_warn_on(readsize > MAX_RECVBUF_SZ); -+ } -+ -+ rbuf = rtw_zmalloc(buflen); -+ if (rbuf) { -+ if (_sdio_read_port(&adapter->iopriv.intf, WLAN_RX0FF_DEVICE_ID, buflen, rbuf) == _FAIL) { -+ RTW_ERR("%s: sdio read port FAIL!\n", __func__); -+ ret = RTW_SDIO_READ_PORT_FAIL; -+ } else -+ ret = _SUCCESS; -+ -+ rtw_mfree(rbuf, buflen); -+ } -+ -+ return ret; -+} -+ -+#else -+static struct recv_buf *sd_recv_rxfifo(PADAPTER padapter, u32 size) -+{ -+ u32 readsize, allocsize, ret; -+ u8 *preadbuf; -+ _pkt *ppkt; -+ struct recv_priv *precvpriv; -+ struct recv_buf *precvbuf; -+ -+ -+ readsize = size; -+ -+ /*1.alloc skb*/ -+ /* align to block size*/ -+ allocsize = _RND(readsize, rtw_sdio_get_block_size(adapter_to_dvobj(padapter))); -+ -+ ppkt = rtw_skb_alloc(allocsize); -+ -+ if (ppkt == NULL) { -+ RTW_INFO("%s: alloc_skb fail! alloc=%d read=%d\n", __func__, allocsize, readsize); -+ return NULL; -+ } -+ -+ /*2. read data from rxfifo*/ -+ preadbuf = skb_put(ppkt, readsize); -+ /* rtw_read_port(padapter, WLAN_RX0FF_DEVICE_ID, readsize, preadbuf); */ -+ ret = _sdio_read_port(&padapter->iopriv.intf, WLAN_RX0FF_DEVICE_ID, readsize, preadbuf); -+ if (ret == _FAIL) { -+ rtw_skb_free(ppkt); -+ RTW_INFO("%s: read port FAIL!\n", __func__); -+ return NULL; -+ } -+ -+ /*3. alloc recvbuf*/ -+ precvpriv = &padapter->recvpriv; -+ precvbuf = rtw_dequeue_recvbuf(&precvpriv->free_recv_buf_queue); -+ if (precvbuf == NULL) { -+ rtw_skb_free(ppkt); -+ /*RTW_INFO("%s: alloc recvbuf FAIL!\n", __func__);*/ -+ return NULL; -+ } -+ -+ /*4. init recvbuf*/ -+ precvbuf->pskb = ppkt; -+ -+ precvbuf->len = ppkt->len; -+ -+ precvbuf->phead = ppkt->head; -+ precvbuf->pdata = ppkt->data; -+ precvbuf->ptail = skb_tail_pointer(precvbuf->pskb); -+ precvbuf->pend = skb_end_pointer(precvbuf->pskb); -+ -+ return precvbuf; -+} -+#endif -+ -+#if 0 -+static struct recv_buf *sd_recv_rxfifo(PADAPTER adapter, u32 size) -+{ -+ struct recv_priv *recvpriv; -+ struct recv_buf *recvbuf; -+ u32 readsz, bufsz; -+ u8 *rbuf; -+ _pkt *pkt; -+ s32 ret; -+ -+ -+ /* -+ * Patch for some SDIO Host 4 bytes issue -+ * ex. RK3188 -+ */ -+ readsz = RND4(size); -+ -+ /* round to block size */ -+ bufsz = rtw_sdio_cmd53_align_size(adapter_to_dvobj(padapter), readsz); -+ -+ /*1.alloc recvbuf*/ -+ recvpriv = &adapter->recvpriv; -+ recvbuf = rtw_dequeue_recvbuf(&recvpriv->free_recv_buf_queue); -+ if (recvbuf == NULL) { -+ RTW_INFO("%s: alloc recvbuf FAIL!\n", __FUNCTION__); -+ return NULL; -+ } -+ -+ /*2.alloc skb*/ -+ pkt = rtl8821cs_alloc_recvbuf_skb(recvbuf, bufsz); -+ if (!pkt) { -+ RTW_INFO("%s: alloc_skb fail! alloc=%d read=%d\n", __FUNCTION__, bufsz, size); -+ rtw_enqueue_recvbuf(recvbuf, &recvpriv->free_recv_buf_queue); -+ return NULL; -+ } -+ -+ /* 3.read data from rxfifo*/ -+ rbuf = skb_put(pkt, size); -+ ret = _sdio_read_port(&adapter->iopriv.intf, WLAN_RX0FF_DEVICE_ID, bufsz, rbuf); -+ if (_FAIL == ret) { -+ RTW_INFO("%s: read port FAIL!\n", __FUNCTION__); -+ rtl8821cs_free_recvbuf_skb(recvbuf); -+ rtw_enqueue_recvbuf(recvbuf, &recvpriv->free_recv_buf_queue); -+ return NULL; -+ } -+ -+ /*4.init recvbuf*/ -+ recvbuf->len = pkt->len; -+ recvbuf->phead = pkt->head; -+ recvbuf->pdata = pkt->data; -+ recvbuf->ptail = skb_tail_pointer(pkt); -+ recvbuf->pend = skb_end_pointer(pkt); -+ -+ return recvbuf; -+} -+#endif -+ -+void sd_int_dpc(PADAPTER adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ HAL_DATA_TYPE *phal_Data = GET_HAL_DATA(adapter); -+ struct intf_hdl *pintfhdl = &adapter->iopriv.intf; -+ -+ -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+ if (phal_Data->sdio_hisr & BIT_SDIO_AVAL_8821C) { -+ u32 freepage; -+ -+ freepage = rtw_read32(adapter, SDIO_REG_FREE_TXPG); -+ _rtw_up_sema(&adapter->xmitpriv.xmit_sema); -+ } -+#endif -+ if (phal_Data->sdio_hisr & BIT_SDIO_CPWM1_8821C) { -+ struct reportpwrstate_parm report; -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ _cancel_timer_ex(&pwrctl->pwr_rpwm_timer); -+#endif /* CONFIG_LPS_RPWM_TIMER */ -+ -+ report.state = rtw_read8(adapter, REG_SDIO_HCPWM1_V2_8821C); -+ -+#ifdef CONFIG_LPS_LCLK -+ _set_workitem(&(pwrctl->cpwm_event)); -+#endif -+ } -+#ifdef CONFIG_WOWLAN -+ if (phal_Data->sdio_hisr & BIT_SDIO_CPWM2_8821C) { -+ u32 value; -+ -+ value = rtw_read32(adapter, REG_SDIO_HISR_8821C); -+ -+ RTW_PRINT("Reset SDIO HISR(0x%08x) original:0x%08x\n", -+ REG_SDIO_HISR_8821C, value); -+ value |= BIT19; -+ rtw_write32(adapter, REG_SDIO_HISR_8821C, value); -+ -+ value = rtw_read8(adapter, REG_SDIO_HIMR_8821C + 2); -+ RTW_PRINT("Reset SDIO HIMR CPWM2(0x%08x) original:0x%02x\n", -+ SDIO_LOCAL_BASE + SDIO_REG_HIMR + 2, value); -+ } -+#endif -+ -+#ifdef CONFIG_ERROR_STATE_MONITOR -+ if (phal_Data->sdio_hisr & BIT_SDIO_TXERR_8821C) { -+ u32 status = 0; -+ -+ status = rtw_read32(adapter, REG_TXDMA_STATUS_8821C); -+ rtw_write32(adapter, REG_TXDMA_STATUS_8821C, status); -+ -+ RTW_ERR("[DMA ERROR] TXDMA_STATUS (0x%08x)\n", status); -+ } -+ -+ if (phal_Data->sdio_hisr & BIT_SDIO_RXERR_8821C) { -+ u32 status = 0; -+ -+ status = rtw_read32(adapter, REG_RXDMA_STATUS_8821C); -+ rtw_write32(adapter, REG_RXDMA_STATUS_8821C, status); -+ RTW_ERR("[DMA ERROR] RXDMA_STATUS (0x%08x)\n", status); -+ -+ } -+#endif -+#ifdef CONFIG_MONITOR_OVERFLOW -+ if (phal_Data->sdio_hisr & BIT_SDIO_TXFOVW_8821C) -+ RTW_ERR("%s TXFOVW\n", __func__); -+ -+ if (phal_Data->sdio_hisr & BIT_SDIO_RXFOVW_8821C) -+ RTW_ERR("%s RXFOVW\n", __func__); -+#endif -+ -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ if (phal_Data->sdio_hisr & BIT_SDIO_BCNERLY_INT_8821C) { -+ /*RTW_INFO("%s: SDIO_BCNERLY_INT\n", __func__);*/ -+ rtw_mi_set_tx_beacon_cmd(adapter); -+ } -+ #endif -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ if (phal_Data->sdio_hisr & (BIT_SDIO_TXBCNOK_8821C | BIT_SDIO_TXBCNERR_8821C)) { -+ if (phal_Data->sdio_hisr & BIT_SDIO_TXBCNOK_8821C) -+ RTW_INFO("%s: SDIO_HISR_TXBCNOK\n", __func__); -+ -+ -+ if (phal_Data->sdio_hisr & BIT_SDIO_TXBCNERR_8821C) -+ RTW_INFO("%s: SDIO_HISR_TXBCNERR\n", __func__); -+ -+ rtw_mi_set_tx_beacon_cmd(adapter); -+ } -+ #endif -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+ -+#ifdef CONFIG_C2H_EVT_INT -+ if (phal_Data->sdio_hisr & BIT_SDIO_C2HCMD_INT_8821C) { -+ -+ } -+#endif -+ if (phal_Data->sdio_hisr & BIT_RX_REQUEST_8821C) { -+ struct recv_buf *precvbuf = NULL; -+ int alloc_fail_time = 0; -+ u8 data[4] = {0}; -+ u32 ret; -+ -+ phal_Data->sdio_hisr ^= BIT_RX_REQUEST_8821C; -+ do { -+ if (phal_Data->SdioRxFIFOSize == 0) { -+ rtw_read_mem(adapter, REG_SDIO_RX_REQ_LEN_8821C, 4, data); -+ phal_Data->SdioRxFIFOSize = le16_to_cpu(*(u16 *)data); -+ } -+ -+ if (phal_Data->SdioRxFIFOSize) { -+ ret = sd_recv_rxfifo(adapter, phal_Data->SdioRxFIFOSize, &precvbuf); -+ if (precvbuf) { -+ rtl8821cs_rxhandler(adapter, precvbuf); -+ } else { -+ if (RTW_SDIO_READ_PORT_FAIL == ret) { -+ RTW_ERR("%s: sd_recv_rxfifo - SDIO read port failed\n", __func__); -+ rtw_warn_on(1); -+ break; -+ } -+ -+ alloc_fail_time++; -+ /*RTW_ERR("%s: recv fail!(time=%d)\n", __func__, alloc_fail_time);*/ -+ if (alloc_fail_time >= 10) { -+ if (sd_recv_and_drop(adapter, phal_Data->SdioRxFIFOSize) == RTW_SDIO_READ_PORT_FAIL) { -+ RTW_ERR("%s: sd_recv_and_drop - SDIO read port failed\n", __func__); -+ rtw_warn_on(1); -+ break; -+ } -+ #ifdef CONFIG_RECV_THREAD_MODE -+ alloc_fail_time = 0; -+ #else -+ break; -+ #endif -+ } else -+ rtw_msleep_os(1); -+ } -+ phal_Data->SdioRxFIFOSize = 0; -+ } else -+ break; -+ -+#ifdef CONFIG_SDIO_DISABLE_RXFIFO_POLLING_LOOP -+ } while (0); -+#else -+ } while (1); -+#endif -+ -+ if (alloc_fail_time >= 10) -+ RTW_INFO("%s: exit because recv failed more than 10 times!\n", __FUNCTION__); -+ } -+} -+ -+void sd_int_hdl(PADAPTER adapter) -+{ -+ u8 data[8] = {0}; -+ u32 v32 = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ u8 pwr; -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ return; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_APFM_ON_MAC, &pwr); -+ if (pwr != _TRUE) { -+ RTW_WARN("%s: unexpected interrupt!\n", __FUNCTION__); -+ return; -+ } -+ -+ -+ /*pHalData->sdio_hisr = rtl8821cs_get_interrupt(adapter);*/ -+ rtw_read_mem(adapter, REG_SDIO_HISR_8821C, 8, data); -+ -+ pHalData->sdio_hisr = le32_to_cpu(*(u32 *)data); -+ pHalData->SdioRxFIFOSize = le16_to_cpu(*(u16 *)&data[4]); -+ -+ -+ if (pHalData->sdio_hisr & pHalData->sdio_himr) { -+ pHalData->sdio_hisr &= pHalData->sdio_himr; -+ -+ /* clear HISR */ -+ v32 = cpu_to_le32(pHalData->sdio_hisr & MASK_SDIO_HISR_CLEAR); -+ if (v32) -+ rtl8821cs_clear_interrupt(adapter, v32); -+ -+ sd_int_dpc(adapter); -+ } -+#ifdef CONFIG_PLATFORM_INT_MONITOR -+ else { -+ RTW_INFO("%s: HISR(0x%08x) and HIMR(0x%08x) no match!\n", -+ __FUNCTION__, pHalData->sdio_hisr, pHalData->sdio_himr); -+ } -+#endif -+} -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+u8 rtw_hal_enable_cpwm2(_adapter *adapter) -+{ -+#ifdef CONFIG_GPIO_WAKEUP -+ return _SUCCESS; -+#else -+ u32 himr = 0; -+ -+ RTW_PRINT("%s\n", __func__); -+ himr = rtl8821cs_get_himr(adapter); -+ RTW_INFO("read SDIO_REG_HIMR: 0x%08x\n", himr); -+ -+ himr = BIT_SDIO_CPWM2_MSK_8821C; -+ rtl8821cs_update_himr(adapter, himr); -+ RTW_INFO("update SDIO_REG_HIMR: 0x%08x\n", himr); -+ -+ himr = rtl8821cs_get_himr(adapter); -+ RTW_INFO("read again SDIO_REG_HIMR: 0x%08x\n", himr); -+ return _SUCCESS; -+#endif -+} -+ -+u8 RecvOnePkt(PADAPTER adapter) -+{ -+ struct recv_buf *precvbuf; -+ struct dvobj_priv *psddev; -+ PSDIO_DATA psdio_data; -+ struct sdio_func *func; -+ u8 res = _TRUE; -+ u8 data[4] = {0}; -+ u16 len = 0; -+ u32 ret; -+ if (adapter == NULL) { -+ RTW_ERR("%s: adapter is NULL!\n", __func__); -+ return _FALSE; -+ } -+ psddev = adapter->dvobj; -+ psdio_data = &psddev->intf_data; -+ func = psdio_data->func; -+ -+ rtw_read_mem(adapter, REG_SDIO_RX_REQ_LEN_8821C, 4, data); -+ len = le16_to_cpu(*(u16 *)data); -+ -+ RTW_INFO("+%s: size=%d+\n", __func__, len); -+ -+ if (len) { -+ sdio_claim_host(func); -+ ret = sd_recv_rxfifo(adapter, len, &precvbuf); -+ if (precvbuf) -+ rtl8821cs_rxhandler(adapter, precvbuf); -+ else -+ res = _FALSE; -+ sdio_release_host(func); -+ } -+ RTW_INFO("-%s-\n", __func__); -+ return res; -+} -+#endif /* CONFIG_WOWLAN */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_io.h b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_io.h -new file mode 100644 -index 000000000..735f0e5fa ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_io.h -@@ -0,0 +1,22 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_IO_H_ -+#define _RTL8821CS_IO_H_ -+ -+#include /* struct dvobj_priv and etc. */ -+ -+u32 rtl8821cs_write_port(struct dvobj_priv *, u32 cnt, u8 *mem); -+ -+#endif /* _RTL8821CS_IO_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_led.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_led.c -new file mode 100644 -index 000000000..29c6297c0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_led.c -@@ -0,0 +1,100 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_LED_C_ -+ -+#include /* PADAPTER */ -+#include /* PHAL_DATA_TYPE */ -+#include /* PLED_SDIO */ -+#ifdef CONFIG_RTW_SW_LED -+ -+/* -+* ============================================================================= -+* LED object. -+* ============================================================================= -+*/ -+ -+ -+/* -+* ============================================================================= -+* Prototype of protected function. -+* ============================================================================= -+*/ -+ -+/* -+* ============================================================================= -+* LED routines. -+* ============================================================================= -+*/ -+ -+/* -+* Description: -+* Turn on LED according to LedPin specified. -+*/ -+void swledon(PADAPTER adapter, PLED_SDIO led) -+{ -+ u8 LedCfg; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ return; -+ -+ led->bLedOn = _TRUE; -+} -+ -+ -+/* -+ * Description: -+ * Turn off LED according to LedPin specified. -+*/ -+void swledoff(PADAPTER adapter, PLED_SDIO led) -+{ -+ u8 LedCfg; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ goto exit; -+ -+exit: -+ led->bLedOn = _FALSE; -+} -+ -+/* -+* ============================================================================= -+* Interface to manipulate LED objects. -+* ============================================================================= -+*/ -+ -+/* -+* ============================================================================= -+* Default LED behavior. -+* ============================================================================= -+*/ -+ -+/* -+* Description: -+* Initialize all LED_871x objects. -+*/ -+void rtl8821cs_initswleds(PADAPTER adapter) -+{ -+} -+ -+/* -+* Description: -+* DeInitialize all LED_819xUsb objects. -+*/ -+void rtl8821cs_deinitswleds(PADAPTER adapter) -+{ -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_led.h b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_led.h -new file mode 100644 -index 000000000..1c1e6945e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_led.h -@@ -0,0 +1,23 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_LED_H_ -+#define _RTL8821CS_LED_H_ -+ -+#include /* PADAPTER and etc. */ -+ -+void rtl8821cs_initswleds(PADAPTER); -+void rtl8821cs_deinitswleds(PADAPTER); -+ -+#endif /* _RTL8821CS_LED_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_ops.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_ops.c -new file mode 100644 -index 000000000..58a81daa5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_ops.c -@@ -0,0 +1,493 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_OPS_C_ -+ -+#include /* PADAPTER, basic_types.h and etc. */ -+#include /* HAL_DATA_TYPE, GET_HAL_DATA() and etc. */ -+#include /* struct hal_ops */ -+#include "../rtl8821c.h" -+#include "rtl8821cs.h" /* rtl8821cs_hal_init() */ -+#include "rtl8821cs_xmit.h" -+#include "rtl8821cs_recv.h" -+#include "rtl8821cs_io.h" -+#include "rtl8821cs_led.h" -+#include "rtl8821cs_halmac.h" -+ -+ -+static void intf_chip_configure(PADAPTER adapter) -+{ -+#if 0 -+ u8 try_cnt = 0; -+ -+ /*adjust SDIO output driving -output delay time about 8ns (SDIO SPEC must last than 7.5ns),offset 0x74[18]*/ -+ if (rtw_is_sdio30(adapter)) { -+ rtw_write8(adapter, REG_SDIO_HSUS_CTRL, rtw_read8(adapter, REG_SDIO_HSUS_CTRL) & ~BIT(0)); -+ -+ do { -+ rtw_mdelay_os(2); -+ if ((rtw_read8(adapter, REG_SDIO_HSUS_CTRL) & BIT(1))) -+ break; -+ try_cnt++; -+ } while (try_cnt <= 50); -+ -+ if (try_cnt == 10) -+ RTW_ERR("%s: SDIO active state change failed!!\n", __func__); -+ -+ rtw_write32(adapter, REG_HCI_OPT_CTRL, -+ rtw_read32(adapter, REG_HCI_OPT_CTRL) | BIT(18)); -+ } -+#endif -+} -+ -+u32 rtl8821cs_get_interrupt(PADAPTER adapter) -+{ -+ return rtw_read32(adapter, REG_SDIO_HISR_8821C); -+} -+ -+void rtl8821cs_clear_interrupt(PADAPTER adapter, u32 hisr) -+{ -+ /* Perform write one clear operation */ -+ if (hisr) -+ rtw_write32(adapter, REG_SDIO_HISR_8821C, hisr); -+} -+ -+u32 rtl8821cs_get_himr(PADAPTER adapter) -+{ -+ return rtw_read32(adapter, REG_SDIO_HIMR_8821C); -+} -+ -+void rtl8821cs_update_himr(PADAPTER adapter, u32 himr) -+{ -+ rtw_write32(adapter, REG_SDIO_HIMR_8821C, himr); -+} -+ -+void rtl8821cs_update_interrupt_mask(PADAPTER padapter,u32 AddMSR, u32 RemoveMSR) -+{ -+ HAL_DATA_TYPE *pHalData; -+ pHalData = GET_HAL_DATA(padapter); -+ -+ if (AddMSR) -+ pHalData->sdio_himr |= AddMSR; -+ -+ if (RemoveMSR) -+ pHalData->sdio_himr &= (~RemoveMSR); -+ -+ rtl8821cs_update_himr(padapter,pHalData->sdio_himr); -+} -+ -+/* -+ * Description: -+ * Initialize SDIO Host Interrupt Mask configuration variables for future use. -+ * -+ * Assumption: -+ * Using SDIO Local register ONLY for configuration. -+ */ -+void rtl8821cs_init_interrupt(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ hal->sdio_himr = (u32)(\ -+ BIT_RX_REQUEST_MSK_8821C | -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+ BIT_SDIO_AVAL_MSK_8821C | -+#endif /* CONFIG_SDIO_TX_ENABLE_AVAL_INT */ -+ -+#ifdef CONFIG_ERROR_STATE_MONITOR -+ BIT_SDIO_TXERR_MSK_8821C | -+ BIT_SDIO_RXERR_MSK_8821C | -+#endif -+#ifdef CONFIG_MONITOR_OVERFLOW -+ BIT_SDIO_TXFOVW_MSK_8821C | -+ BIT_SDIO_RXFOVW_MSK_8821C | -+#endif -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ BIT_SDIO_TXBCNOK_MSK_8821C | -+ BIT_SDIO_TXBCNERR_MSK_8821C | -+ #endif -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ BIT_SDIO_BCNERLY_INT_MSK_8821C | -+ #endif -+#endif -+#if 0 -+ BIT_SDIO_C2HCMD_INT_MSK_8821C | -+#endif -+#if defined(CONFIG_LPS_LCLK) && !defined(CONFIG_DETECT_CPWM_BY_POLLING) -+ BIT_SDIO_CPWM1_MSK_8821C | -+#if 0 -+ BIT_SDIO_CPWM2_MSK_8821C | -+#endif -+#endif /* CONFIG_LPS_LCLK && !CONFIG_DETECT_CPWM_BY_POLLING */ -+#if 0 -+ BIT_SDIO_HSISR_IND_MSK_8821C | -+ BIT_SDIO_GTINT3_MSK_8821C | -+ BIT_SDIO_GTINT4_MSK_8821C | -+ BIT_SDIO_PSTIMEOUT_MSK_8821C | -+ BIT_SDIO_OCPINT_MSK_8821C | -+ BIT_SDIIO_ATIMend_MSK_8821C | -+ BIT_SDIO_ATIMend_E_MSK_8821C | -+ BIT_SDIO_CTWend_MSK_8821C | -+ BIT_SDIO_CRCERR_MSK_8821C | -+#endif -+ 0); -+ -+} -+ -+/* -+ * Description: -+ * Clear corresponding SDIO Host ISR interrupt service. -+ * -+ * Assumption: -+ * Using SDIO Local register ONLY for configuration. -+ */ -+ #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+static void clear_interrupt_all(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ -+ -+ if (rtw_is_surprise_removed(adapter)) -+ return; -+ -+ hal = GET_HAL_DATA(adapter); -+ rtl8821cs_clear_interrupt(adapter, 0xFFFFFFFF); -+} -+#endif /*#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN)*/ -+/* -+ * Description: -+ * Enalbe SDIO Host Interrupt Mask configuration on SDIO local domain. -+ * -+ * Assumption: -+ * 1. Using SDIO Local register ONLY for configuration. -+ * 2. PASSIVE LEVEL -+ */ -+static void enable_interrupt(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ rtl8821cs_update_himr(adapter, hal->sdio_himr); -+ RTW_INFO(FUNC_ADPT_FMT ": update SDIO HIMR=0x%08X\n", -+ FUNC_ADPT_ARG(adapter), hal->sdio_himr); -+} -+ -+/* -+ * Description: -+ * Disable SDIO Host IMR configuration to mask unnecessary interrupt service. -+ * -+ * Assumption: -+ * Using SDIO Local register ONLY for configuration. -+ */ -+static void disable_interrupt(PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE hal; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ rtl8821cs_update_himr(adapter, 0); -+ RTW_INFO("%s: update SDIO HIMR=0\n", __FUNCTION__); -+} -+ -+#ifdef CONFIG_WOWLAN -+void rtl8821cs_disable_interrupt_but_cpwm2(PADAPTER adapter) -+{ -+ u32 himr, tmp; -+ -+ tmp = rtw_read32(adapter, REG_SDIO_HIMR); -+ RTW_INFO("%s: Read SDIO_REG_HIMR: 0x%08x\n", __FUNCTION__, tmp); -+ -+ himr = BIT_SDIO_CPWM2_MSK; -+ rtl8821cs_update_himr(adapter, himr); -+ -+ tmp = rtw_read32(adapter, REG_SDIO_HIMR); -+ RTW_INFO("%s: Read again SDIO_REG_HIMR: 0x%08x\n", __FUNCTION__, tmp); -+} -+#endif /* CONFIG_WOWLAN */ -+ -+static void _run_thread(PADAPTER adapter) -+{ -+#ifndef CONFIG_SDIO_TX_TASKLET -+ struct xmit_priv *xmitpriv = &adapter->xmitpriv; -+ -+ if (xmitpriv->SdioXmitThread == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT " start RTWHALXT\n", FUNC_ADPT_ARG(adapter)); -+ xmitpriv->SdioXmitThread = kthread_run(rtl8821cs_xmit_thread, adapter, "RTWHALXT"); -+ if (IS_ERR(xmitpriv->SdioXmitThread)) { -+ RTW_ERR("%s: start rtl8821cs_xmit_thread FAIL!!\n", __FUNCTION__); -+ xmitpriv->SdioXmitThread = NULL; -+ } -+ } -+#endif /* !CONFIG_SDIO_TX_TASKLET */ -+} -+ -+static void run_thread(PADAPTER adapter) -+{ -+ _run_thread(adapter); -+ rtl8821c_run_thread(adapter); -+} -+ -+static void _cancel_thread(PADAPTER adapter) -+{ -+#ifndef CONFIG_SDIO_TX_TASKLET -+ struct xmit_priv *xmitpriv = &adapter->xmitpriv; -+ -+ /* stop xmit_buf_thread */ -+ if (xmitpriv->SdioXmitThread) { -+ _rtw_up_sema(&xmitpriv->SdioXmitSema); -+ rtw_thread_stop(xmitpriv->SdioXmitThread); -+ xmitpriv->SdioXmitThread = NULL; -+ } -+#endif /* !CONFIG_SDIO_TX_TASKLET */ -+} -+ -+static void cancel_thread(PADAPTER adapter) -+{ -+ rtl8821c_cancel_thread(adapter); -+ _cancel_thread(adapter); -+} -+ -+#ifdef CONFIG_SDIO_OOB -+/* -+REG_SYS_SDIO_CTRL_8821C -+BIT_SDIO_INT - 1: Enabled (GPIO4:SDIO_INT); 0 : Disabled -+BIT_SDIO_INT_POLARITY - 0: Low Active 1: High Active -+*/ -+ -+void rtl8821cs_gpio4_sdio_int_enable(_adapter *adapter, u8 enable, u8 polarity_high) -+{ -+ u32 sdio_ctrl = 0; -+ -+ sdio_ctrl = rtw_read32(adapter, REG_SYS_SDIO_CTRL_8821C); -+ if (enable) { -+ sdio_ctrl |= BIT_SDIO_INT; -+ if (polarity_high == _TRUE) -+ sdio_ctrl |= BIT_SDIO_INT_POLARITY; -+ else -+ sdio_ctrl &= (~BIT_SDIO_INT_POLARITY); -+ } else -+ sdio_ctrl &= (~BIT_SDIO_INT); -+ rtw_write32(adapter, REG_SYS_SDIO_CTRL_8821C, sdio_ctrl); -+} -+#endif -+ -+/* -+ * If variable not handled here, -+ * some variables will be processed in rtl8821c_sethwreg() -+ */ -+static u8 sethwreg(PADAPTER adapter, u8 variable, u8 *val) -+{ -+ u8 ret = _SUCCESS; -+ -+ switch (variable) { -+ case HW_VAR_SET_RPWM: -+ { -+ /* -+ * rpwm value only use BIT0(clock bit), and BIT7(Toggle bit) -+ * BIT0 value - 1: 32k, 0:40MHz. -+ * BIT4 value - 1: enable power gated, 0: disable power gated -+ * BIT6 value - 1: report cpwm value after success set, 0:do not report. -+ * BIT7 value - Toggling Bit. -+ */ -+ u8 val8 = 0; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ -+ val8 = (*val) & 0xC1; -+ -+#ifdef CONFIG_LPS_PG -+ if ((val8 & BIT(0)) && (LPS_PG == pwrpriv->lps_level)) -+ val8 |= BIT(4); -+#endif -+ rtw_write8(adapter, REG_SDIO_HRPWM1_8821C, val8); -+ } -+ break; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ case HW_SET_GPIO_WL_CTRL: -+ { -+ } -+ break; -+#endif -+/* -+#ifdef CONFIG_SDIO_OOB -+ case HW_SET_SDIO_OOB: -+ { -+ u8 sdio_ctrl = *val; -+ u8 enable, is_high_active; -+ -+ enable = (sdio_ctrl & BIT(0)) ? _TRUE : _FALSE; -+ is_high_active = (sdio_ctrl & BIT(4)) ? _TRUE : _FALSE; -+ rtl8821cs_gpio4_sdio_int_enable(adapter, enable, is_high_active); -+ } -+ break; -+#endif -+*/ -+ default: -+ ret = rtl8821c_sethwreg(adapter, variable, val); -+ break; -+ } -+ -+ return ret; -+} -+ -+/* -+ * If variable not handled here, -+ * some variables will be processed in GetHwReg8723B() -+ */ -+static void gethwreg(PADAPTER adapter, u8 variable, u8 *val) -+{ -+ PHAL_DATA_TYPE hal; -+ -+ -+ hal = GET_HAL_DATA(adapter); -+ -+ switch (variable) { -+ case HW_VAR_CPWM: -+ *val = rtw_read8(adapter, REG_SDIO_HCPWM1_V2_8821C); -+ break; -+ -+ case HW_VAR_RPWM_TOG: -+ *val = rtw_read8(adapter, REG_SDIO_HRPWM1_8821C); -+ *val &= BIT_TOGGLE_8821C; -+ break; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ case HW_SET_GPIO_WL_CTRL: -+ -+ break; -+#endif -+ -+ default: -+ rtl8821c_gethwreg(adapter, variable, val); -+ break; -+ } -+} -+ -+/* -+ * Description: -+ * Query setting of specified variable. -+ */ -+static u8 gethaldefvar(PADAPTER adapter, HAL_DEF_VARIABLE eVariable, void *pval) -+{ -+ u8 bResult = _SUCCESS; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ PSDIO_DATA psdio_data = &dvobj->intf_data; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ -+ switch (eVariable) { -+ -+ case HW_VAR_MAX_RX_AMPDU_FACTOR: -+ { -+ if (psdio_data->clock > RTW_SDIO_CLK_40M) { -+ *(HT_CAP_AMPDU_FACTOR *)pval = MAX_AMPDU_FACTOR_32K; -+ RTW_INFO("AMPDU FACTOR - 32K\n"); -+ } else if (psdio_data->clock > RTW_SDIO_CLK_33M) { -+ *(HT_CAP_AMPDU_FACTOR *)pval = MAX_AMPDU_FACTOR_16K; -+ RTW_INFO("AMPDU FACTOR - 16K\n"); -+ } else { -+ *(HT_CAP_AMPDU_FACTOR *)pval = MAX_AMPDU_FACTOR_8K; -+ RTW_INFO("AMPDU FACTOR - 8K\n"); -+ } -+ } -+ break; -+ -+ default: -+ bResult = rtl8821c_gethaldefvar(adapter, eVariable, pval); -+ break; -+ } -+ -+ return bResult; -+} -+ -+/* -+ * Description: -+ * Change default setting of specified variable. -+ */ -+static u8 sethaldefvar(PADAPTER adapter, HAL_DEF_VARIABLE eVariable, void *pval) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ u8 bResult = _SUCCESS; -+ -+ switch (eVariable) { -+ default: -+ bResult = rtl8821c_sethaldefvar(adapter, eVariable, pval); -+ break; -+ } -+ -+ return bResult; -+} -+ -+u8 rtl8821cs_set_hal_ops(PADAPTER adapter) -+{ -+ struct hal_ops *ops_func = &adapter->hal_func; -+ -+ u8 err; -+ -+ err = rtl8821cs_halmac_init_adapter(adapter); -+ if (err) { -+ RTW_INFO("%s: [ERROR]HALMAC initialize FAIL!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ rtl8821c_set_hal_ops(adapter); -+ rtl8821cs_init_interrupt(adapter); -+ -+ ops_func->init_default_value = rtl8821cs_init_default_value; -+ ops_func->intf_chip_configure = intf_chip_configure; -+ -+ ops_func->hal_init = rtl8821cs_hal_init; -+ ops_func->hal_deinit = rtl8821cs_hal_deinit; -+ -+ ops_func->init_xmit_priv = rtl8821cs_init_xmit_priv; -+ ops_func->free_xmit_priv = rtl8821cs_free_xmit_priv; -+ ops_func->hal_xmit = rtl8821cs_hal_xmit; -+ ops_func->mgnt_xmit = rtl8821cs_mgnt_xmit; -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ ops_func->hal_mgmt_xmitframe_enqueue = rtl8821cs_hal_mgmt_xmit_enqueue; -+#endif -+ ops_func->hal_xmitframe_enqueue = rtl8821cs_hal_xmit_enqueue; -+#ifdef CONFIG_XMIT_THREAD_MODE -+ ops_func->xmit_thread_handler = rtl8821cs_xmit_buf_handler; -+#endif -+ ops_func->run_thread = run_thread; -+ ops_func->cancel_thread = cancel_thread; -+ -+ ops_func->init_recv_priv = rtl8821cs_init_recv_priv; -+ ops_func->free_recv_priv = rtl8821cs_free_recv_priv; -+#ifdef CONFIG_RECV_THREAD_MODE -+ ops_func->recv_hdl = rtl8821cs_recv_hdl; -+#endif -+ -+ ops_func->enable_interrupt = enable_interrupt; -+ ops_func->disable_interrupt = disable_interrupt; -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ ops_func->clear_interrupt = clear_interrupt_all; -+#endif -+#ifdef CONFIG_RTW_SW_LED -+ ops_func->InitSwLeds = rtl8821cs_initswleds; -+ ops_func->DeInitSwLeds = rtl8821cs_deinitswleds; -+#endif -+ ops_func->set_hw_reg_handler = sethwreg; -+ ops_func->GetHwRegHandler = gethwreg; -+ ops_func->get_hal_def_var_handler = gethaldefvar; -+ ops_func->SetHalDefVarHandler = sethaldefvar; -+ return _TRUE; -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_recv.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_recv.c -new file mode 100644 -index 000000000..89e8025fe ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_recv.c -@@ -0,0 +1,969 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_RECV_C_ -+ -+#include /* PADAPTER and etc. */ -+#include /* HAL_DATA_TYPE */ -+#include "../../hal_halmac.h" /* BIT_ACRC32_8821C and etc. */ -+#include "../rtl8821c.h" /* rtl8821c_rxdesc2attribute(), rtl8821c_c2h_handler_no_io() */ -+#include "rtl8821cs_recv.h" /* MAX_RECVBUF_SZ */ -+ -+#if 0 -+/* -+ * Return: -+ * Pointer of _pkt, otherwise NULL. -+ */ -+static _pkt *alloc_recvbuf_skb(struct recv_buf *recvbuf, u32 size) -+{ -+ _pkt *skb; -+ u32 alignsz = RECVBUFF_ALIGN_SZ; -+#ifdef PLATFORM_LINUX -+ SIZE_PTR tmpaddr = 0; -+ SIZE_PTR alignment = 0; -+#endif /* PLATFORM_LINUX */ -+ -+ -+ size += alignsz; -+ skb = rtw_skb_alloc(size); -+ if (!skb) { -+ RTW_INFO("%s: alloc_skb fail! size=%d\n", __FUNCTION__, size); -+ return NULL; -+ } -+ -+#ifdef PLATFORM_LINUX -+ skb->dev = recvbuf->adapter->pnetdev; -+ -+ tmpaddr = (SIZE_PTR)skb->data; -+ alignment = tmpaddr & (alignsz - 1); -+ skb_reserve(skb, alignsz - alignment); -+#endif /* PLATFORM_LINUX */ -+ -+ recvbuf->pskb = skb; -+ -+ return skb; -+} -+ -+/* -+ * Description: -+ * Allocate skb for recv_buf, the size is MAX_RECVBUF_SZ_8821C (24KB) -+ * -+ * Parameters: -+ * recvbuf pointer of struct recv_buf -+ * size skb size, only valid when NOT define CONFIG_SDIO_RX_COPY. -+ * If CONFIG_SDIO_RX_COPY, size always be MAX_RECVBUF_SZ_8821C. -+ * -+ * Return: -+ * Pointer of _pkt, otherwise NULL. -+ */ -+_pkt *rtl8821cs_alloc_recvbuf_skb(struct recv_buf *recvbuf, u32 size) -+{ -+ _pkt *skb; -+ -+ -+ skb = recvbuf->pskb; -+#ifdef CONFIG_SDIO_RX_COPY -+ if (skb) { -+ skb_reset_tail_pointer(skb); -+ skb->len = 0; -+ return skb; -+ } -+ -+ RTW_INFO("%s: skb not exist in recv_buf!\n", __FUNCTION__); -+ size = MAX_RECVBUF_SZ_8821C; -+#else /* !CONFIG_SDIO_RX_COPY */ -+ if (skb) { -+ RTW_INFO("%s: skb already exist in recv_buf!\n", __FUNCTION__); -+ rtl8821cs_free_recvbuf_skb(recvbuf); -+ } -+#endif /* !CONFIG_SDIO_RX_COPY */ -+ -+ skb = alloc_recvbuf_skb(recvbuf, size); -+ if (!skb) -+ return NULL; -+ -+ return skb; -+} -+ -+static void free_recvbuf_skb(struct recv_buf *recvbuf) -+{ -+ _pkt *skb; -+ -+ -+ skb = recvbuf->pskb; -+ if (!skb) -+ return; -+ recvbuf->pskb = NULL; -+ rtw_skb_free(skb); -+} -+ -+void rtl8821cs_free_recvbuf_skb(struct recv_buf *recvbuf) -+{ -+#ifndef CONFIG_SDIO_RX_COPY -+ free_recvbuf_skb(recvbuf); -+#endif /* !CONFIG_SDIO_RX_COPY */ -+} -+ -+/* -+ * Return: -+ * _SUCCESS Allocate resource OK. -+ * _FAIL Fail to allocate resource. -+ */ -+static inline s32 os_recvbuf_resource_alloc(PADAPTER adapter, struct recv_buf *recvbuf) -+{ -+ s32 ret = _SUCCESS; -+ -+#ifdef CONFIG_SDIO_RX_COPY -+ alloc_recvbuf_skb(recvbuf, MAX_RECVBUF_SZ_8821C); -+#endif /* CONFIG_SDIO_RX_COPY */ -+ -+ return ret; -+} -+ -+static inline void os_recvbuf_resource_free(PADAPTER adapter, struct recv_buf *recvbuf) -+{ -+#ifdef CONFIG_SDIO_RX_COPY -+ free_recvbuf_skb(recvbuf); -+#endif /* CONFIG_SDIO_RX_COPY */ -+} -+ -+static union recv_frame *copy_recvframe(union recv_frame *recvframe, PADAPTER adapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct recv_priv *precvpriv; -+ _queue *pfree_recv_queue; -+ struct rx_pkt_attrib *attrib = NULL; -+ union recv_frame *copyframe = NULL; -+ _pkt *copypkt = NULL; -+ -+ -+ pHalData = GET_HAL_DATA(adapter); -+ precvpriv = &adapter->recvpriv; -+ pfree_recv_queue = &precvpriv->free_recv_queue; -+ attrib = &recvframe->u.hdr.attrib; -+ -+ copyframe = rtw_alloc_recvframe(pfree_recv_queue); -+ if (!copyframe) { -+ RTW_INFO(FUNC_ADPT_FMT ": Alloc recvframe FAIL!\n", -+ FUNC_ADPT_ARG(adapter)); -+ return NULL; -+ } -+ copyframe->u.hdr.adapter = adapter; -+ _rtw_memcpy(©frame->u.hdr.attrib, attrib, sizeof(struct rx_pkt_attrib)); -+#if 0 -+ /* -+ * driver need to set skb len for skb_copy(). -+ * If skb->len is zero, skb_copy() will not copy data from original skb. -+ */ -+ skb_put(recvframe->u.hdr.pkt, attrib->pkt_len); -+#else -+ RTW_INFO(FUNC_ADPT_FMT ": skb len=%d!\n", -+ FUNC_ADPT_ARG(adapter), recvframe->u.hdr.pkt->len); -+#endif -+ -+ copypkt = rtw_skb_copy(recvframe->u.hdr.pkt); -+ if (!copypkt) { -+ if ((attrib->mfrag == 1) && (attrib->frag_num == 0)) { -+ RTW_INFO(FUNC_ADPT_FMT ": rtw_skb_copy fail for first fragment!\n", -+ FUNC_ADPT_ARG(adapter)); -+ rtw_free_recvframe(recvframe, &precvpriv->free_recv_queue); -+ return NULL; -+ } -+ -+ copypkt = rtw_skb_clone(recvframe->u.hdr.pkt); -+ if (!copypkt) { -+ RTW_INFO(FUNC_ADPT_FMT ": rtw_skb_clone fail, drop frame!\n", -+ FUNC_ADPT_ARG(adapter)); -+ rtw_free_recvframe(recvframe, &precvpriv->free_recv_queue); -+ return NULL; -+ } -+ } -+ copypkt->dev = adapter->pnetdev; -+ -+ copyframe->u.hdr.pkt = copypkt; -+ copyframe->u.hdr.len = copypkt->len; -+ copyframe->u.hdr.rx_head = copypkt->head; -+ copyframe->u.hdr.rx_data = copypkt->data; -+ copyframe->u.hdr.rx_tail = skb_tail_pointer(copypkt); -+ copyframe->u.hdr.rx_end = skb_end_pointer(copypkt); -+ -+ return copyframe; -+} -+ -+/* -+ * Return: -+ * _SUCCESS OK to send packet -+ * _FAIL FAIL to send packet -+ */ -+static s32 recv_entry(union recv_frame *recvframe, u8 *phy_status) -+{ -+ s32 ret = _SUCCESS; -+ PADAPTER adapter; -+ struct rx_pkt_attrib *attrib = NULL; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct dvobj_priv *d; -+ u8 *addr1, *macaddr; -+ u8 mcast, i; -+ union recv_frame *copyframe = NULL; -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ -+ attrib = &recvframe->u.hdr.attrib; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ d = adapter_to_dvobj(recvframe->u.hdr.adapter); -+ addr1 = GetAddr1Ptr(recvframe->u.hdr.rx_data); -+ mcast = IS_MCAST(addr1); -+ if (_TRUE == mcast) { -+ /* BC/MC packets */ -+ for (i = 1; i < d->iface_nums; i++) { -+ adapter = d->adapters[i]; -+ -+ if (rtw_if_up(adapter) == _FALSE) -+ continue; -+ -+ copyframe = copy_recvframe(recvframe, adapter); -+ if (!copyframe) -+ break; -+ -+ if (attrib->physt) -+ rx_query_phy_status(copyframe, phy_status); -+ -+ ret = rtw_recv_entry(copyframe); -+ } -+ } else { -+ /* unicast packets */ -+ for (i = 0; i < d->iface_nums; i++) { -+ adapter = d->adapters[i]; -+ -+ if (rtw_if_up(adapter) == _FALSE) -+ continue; -+ -+ macaddr = adapter_mac_addr(adapter); -+ if (_rtw_memcmp(addr1, macaddr, ETH_ALEN) == _FALSE) -+ continue; -+ -+ /* change to target interface */ -+ recvframe->u.hdr.adapter = adapter; -+ recvframe->u.hdr.pkt->dev = adapter->pnetdev; -+ break; -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ if (attrib->physt) -+ rx_query_phy_status(recvframe, phy_status); -+ -+ ret = rtw_recv_entry(recvframe); -+ -+ return ret; -+} -+ -+/* -+ * Return: -+ * _TRUE Finish preparing recv_frame -+ * _FALSE Something fail to prepare recv_frame -+ */ -+static _pkt *prepare_recvframe_pkt(struct recv_buf *recvbuf, union recv_frame *recvframe) -+{ -+ u32 desc_size; -+ _pkt *pkt = NULL; -+ struct rx_pkt_attrib *attrib; -+ u32 skb_len; -+ u8 *data; -+#ifdef CONFIG_SDIO_RX_COPY -+ u32 shift_sz, alloc_sz; -+#endif /* CONFIG_SDIO_RX_COPY */ -+ -+ rtw_halmac_get_rx_desc_size(adapter_to_dvobj(recvbuf->adapter), &desc_size); -+ -+ pkt = recvframe->u.hdr.pkt; -+ if (pkt) { -+ RTW_INFO("%s: recvframe pkt already exist!\n", __FUNCTION__); -+ return pkt; -+ } -+ -+ attrib = &recvframe->u.hdr.attrib; -+ skb_len = attrib->pkt_len; -+ if (rtl8821c_rx_fcs_appended(recvbuf->adapter)) -+ skb_len -= IEEE80211_FCS_LEN; -+ data = recvbuf->pdata + desc_size + attrib->drvinfo_sz; -+#if 0 -+ data += attrib->shift_sz; -+#endif -+ -+#ifdef CONFIG_SDIO_RX_COPY -+ /* For 8 bytes IP header alignment. */ -+ if (attrib->qos) -+ /* Qos data, wireless lan header length is 26 */ -+ shift_sz = 6; -+ else -+ shift_sz = 0; -+ -+ /* -+ * For first fragment packet, driver need allocate -+ * (1536 + drvinfo_sz + RXDESC_SIZE) to defrag packet. -+ * In 8821C, drvinfo_sz = 32, RXDESC_SIZE = 24, 1536 + 32 + 24 = 1592. -+ * And need 8 is for skb->data 8 bytes alignment. -+ * Round (1536 + 24 + 32 + shift_sz + 8) to 128 bytes alignment, -+ * and finally get 1664. -+ */ -+ if ((attrib->mfrag == 1) && (attrib->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 = rtw_skb_alloc(alloc_sz); -+ if (pkt) { -+ pkt->dev = recvframe->u.hdr.adapter->pnetdev; -+ /* force pkt->data at 8-byte alignment address */ -+ skb_reserve(pkt, 8 - ((SIZE_PTR)pkt->data & 7)); -+ /* force ip_hdr at 8-byte alignment address according to shift_sz. */ -+ skb_reserve(pkt, shift_sz); -+ _rtw_memcpy(skb_put(pkt, skb_len), data, skb_len); -+ } else if ((attrib->mfrag == 1) && (attrib->frag_num == 0)) { -+ RTW_INFO("%s: alloc_skb fail for first fragement\n", __FUNCTION__); -+ return NULL; -+ } -+#endif /* CONFIG_SDIO_RX_COPY */ -+ -+ if (!pkt) { -+ pkt = rtw_skb_clone(recvbuf->pskb); -+ if (!pkt) { -+ RTW_INFO("%s: rtw_skb_clone fail\n", __FUNCTION__); -+ return NULL; -+ } -+ pkt->data = data; -+ skb_set_tail_pointer(pkt, skb_len); -+ pkt->len = skb_len; -+ } -+ -+ recvframe->u.hdr.pkt = pkt; -+ recvframe->u.hdr.len = pkt->len; -+ recvframe->u.hdr.rx_head = pkt->head; -+ recvframe->u.hdr.rx_data = pkt->data; -+ recvframe->u.hdr.rx_tail = skb_tail_pointer(pkt); -+ recvframe->u.hdr.rx_end = skb_end_pointer(pkt); -+ -+ return pkt; -+} -+ -+/* -+ * process Normal Rx packets -+ * Return: -+ * _TRUE Finish processing recv_buf -+ * _FALSE Something fail to process recv_buf -+ */ -+static u8 recvbuf_handler(struct recv_buf *recvbuf) -+{ -+ PADAPTER p; -+ struct recv_priv *recvpriv; -+ union recv_frame *recvframe; -+ struct rx_pkt_attrib *attrib; -+ _pkt *pkt; -+ u32 desc_size; -+ u32 rx_report_sz, pkt_offset; -+ u8 *ptr; -+ u8 ret = _TRUE; -+ -+ -+ p = recvbuf->adapter; -+ recvpriv = &p->recvpriv; -+ ptr = recvbuf->pdata; -+ rtw_halmac_get_rx_desc_size(adapter_to_dvobj(p), &desc_size); -+ -+ while (ptr < recvbuf->ptail) { -+ recvframe = rtw_alloc_recvframe(&recvpriv->free_recv_queue); -+ if (!recvframe) { -+ RTW_INFO("%s: no enough recv frame!\n", __FUNCTION__); -+ ret = _FALSE; -+ break; -+ } -+ -+ /* rx desc parsing */ -+ attrib = &recvframe->u.hdr.attrib; -+ rtl8821c_rxdesc2attribute(attrib, ptr); -+ -+ rx_report_sz = desc_size + attrib->drvinfo_sz; -+ pkt_offset = rx_report_sz + attrib->shift_sz + attrib->pkt_len; -+ -+ if ((ptr + pkt_offset) > recvbuf->ptail) { -+ RTW_INFO("%s: next pkt len(%p,%d) exceed ptail(%p)!\n", -+ __FUNCTION__, ptr, pkt_offset, recvbuf->ptail); -+ rtw_free_recvframe(recvframe, &recvpriv->free_recv_queue); -+ break; -+ } -+ -+ /* fix Hardware RX data error, drop whole recv_buffer */ -+ if (!rtw_hal_rcr_check(p, BIT_ACRC32_8821C) -+ && attrib->crc_err) { -+ RTW_INFO("%s: Received unexpected CRC error packet!!\n", __FUNCTION__); -+ rtw_free_recvframe(recvframe, &recvpriv->free_recv_queue); -+ break; -+ } -+ -+ if ((attrib->crc_err) || (attrib->icv_err)) { -+#ifdef CONFIG_MP_INCLUDED -+ if (p->registrypriv.mp_mode == 1) { -+ if (check_fwstate(&p->mlmepriv, WIFI_MP_STATE) == _TRUE) { -+ if (attrib->crc_err == 1) -+ p->mppriv.rx_crcerrpktcount++; -+ } -+ } else -+#endif /* CONFIG_MP_INCLUDED */ -+ { -+ RTW_INFO("%s: crc_err=%d icv_err=%d, skip!\n", -+ __FUNCTION__, attrib->crc_err, attrib->icv_err); -+ } -+ rtw_free_recvframe(recvframe, &recvpriv->free_recv_queue); -+ } else { -+ pkt = prepare_recvframe_pkt(recvbuf, recvframe); -+ if (!pkt) { -+ rtw_free_recvframe(recvframe, &recvpriv->free_recv_queue); -+ ret = _FALSE; -+ break; -+ } -+ -+ /* move to start of PHY_STATUS */ -+ ptr += desc_size; -+ if (rtl8821c_rx_ba_ssn_appended(p)) -+ ptr += RTW_HALMAC_BA_SSN_RPT_SIZE; -+ -+ recv_entry(recvframe, ptr); -+ } -+ -+ pkt_offset = _RND8(pkt_offset); -+ recvbuf->pdata += pkt_offset; -+ ptr = recvbuf->pdata; -+ } -+ -+ return ret; -+} -+ -+static void rtl8821c_recv_tasklet(unsigned long priv) -+{ -+ PADAPTER adapter; -+ struct recv_priv *recvpriv; -+ struct recv_buf *recvbuf; -+ u8 ret = _TRUE; -+ -+ -+ adapter = (PADAPTER)priv; -+ recvpriv = &adapter->recvpriv; -+ -+ do { -+ recvbuf = rtw_dequeue_recvbuf(&recvpriv->recv_buf_pending_queue); -+ if (NULL == recvbuf) -+ break; -+ -+ -+ if (GET_RX_DESC_C2H_8821C(recvbuf->pdata)) { -+ if (GET_RX_DESC_DRV_INFO_SIZE_8821C(recvbuf->pdata)) { -+ RTW_INFO("%s [WARN] DRV_INFO_SIZE != 0\n", __func__); -+ rtw_warn_on(1); -+ } -+ -+ c2h_pre_handler_rtl8821c(adapter, recvbuf->pdata, recvbuf->len); -+ } else -+ ret = recvbuf_handler(recvbuf); -+ -+ if (_FALSE == ret) { -+ rtw_enqueue_recvbuf_to_head(recvbuf, &recvpriv->recv_buf_pending_queue); -+ rtw_msleep_os(5); -+ start_rx_handle(adapter); -+ break; -+ } -+ -+ /* free recv_buf */ -+ rtl8821cs_free_recvbuf_skb(recvbuf); -+ rtw_enqueue_recvbuf(recvbuf, &recvpriv->free_recv_buf_queue); -+ } while (1); -+} -+#endif -+ -+#ifdef CONFIG_SDIO_RX_COPY -+s32 rtl8821cs_recv_hdl(_adapter *padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct recv_priv *precvpriv; -+ struct recv_buf *precvbuf; -+ union recv_frame *precvframe; -+ struct recv_frame_hdr *phdr; -+ struct rx_pkt_attrib *pattrib; -+ u8 *ptr; -+ u32 desc_size; -+ u32 pkt_offset; -+ s32 transfer_len; -+ u8 *pphy_status = NULL; -+ u8 rx_report_sz = 0; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ precvpriv = &padapter->recvpriv; -+ -+ rtw_halmac_get_rx_desc_size(adapter_to_dvobj(padapter), &desc_size); -+ -+ do { -+ if (RTW_CANNOT_RUN(padapter)) { -+ RTW_INFO("%s => bDriverStopped or bSurpriseRemoved\n", __func__); -+ break; -+ } -+ -+ precvbuf = rtw_dequeue_recvbuf(&precvpriv->recv_buf_pending_queue); -+ if (NULL == precvbuf) -+ break; -+ -+ transfer_len = (s32)precvbuf->len; -+ ptr = precvbuf->pdata; -+ -+ do { -+ precvframe = rtw_alloc_recvframe(&precvpriv->free_recv_queue); -+ if (precvframe == NULL) { -+ rtw_enqueue_recvbuf_to_head(precvbuf, &precvpriv->recv_buf_pending_queue); -+ return RTW_RFRAME_UNAVAIL; -+ } -+ -+ /*rx desc parsing*/ -+ pattrib = &precvframe->u.hdr.attrib; -+ rtl8821c_rxdesc2attribute(pattrib, ptr); -+ -+ /* fix Hardware RX data error, drop whole recv_buffer*/ -+ if (!rtw_hal_rcr_check(padapter, BIT_ACRC32_8821C) && pattrib->crc_err) { -+ -+ if (padapter->registrypriv.mp_mode == 0) -+ RTW_INFO("%s()-%d: RX Warning! rx CRC ERROR !!\n", __func__, __LINE__); -+ -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ break; -+ } -+ -+ /*if (rtl8821c_rx_ba_ssn_appended(p))*/ -+ if (rtw_hal_rcr_check(padapter, BIT_APP_BASSN_8821C)) -+ rx_report_sz = desc_size + RTW_HALMAC_BA_SSN_RPT_SIZE + pattrib->drvinfo_sz; -+ else -+ rx_report_sz = desc_size + pattrib->drvinfo_sz; -+ -+ pkt_offset = rx_report_sz + pattrib->shift_sz + pattrib->pkt_len; -+ -+ if ((pattrib->pkt_len == 0) || (pkt_offset > transfer_len)) { -+ RTW_INFO("%s()-%d: RX Warning!, pkt_len==0 or pkt_offset(%d)> transfoer_len(%d)\n", __func__, __LINE__, pkt_offset, transfer_len); -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ break; -+ } -+ -+ if ((pattrib->crc_err) || (pattrib->icv_err)) { -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) { -+ if (check_fwstate(&padapter->mlmepriv, WIFI_MP_STATE)) { /*&&(padapter->mppriv.check_mp_pkt == 0))*/ -+ if (pattrib->crc_err == 1) -+ padapter->mppriv.rx_crcerrpktcount++; -+ } -+ } -+#endif -+ -+ RTW_INFO("%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 { -+ -+ if (pattrib->pkt_rpt_type == NORMAL_RX) { /*Normal rx packet*/ -+ -+#ifdef CONFIG_RX_PACKET_APPEND_FCS -+ if (check_fwstate(&padapter->mlmepriv, WIFI_MONITOR_STATE) == _FALSE) -+ if ((pattrib->pkt_rpt_type == NORMAL_RX) && rtw_hal_rcr_check(padapter, BIT_APP_FCS_8821C)) -+ pattrib->pkt_len -= IEEE80211_FCS_LEN; -+#endif -+ -+ if (rtw_os_alloc_recvframe(padapter, precvframe, -+ (ptr + rx_report_sz + pattrib->shift_sz), precvbuf->pskb) == _FAIL) { -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ break; -+ } -+ -+ recvframe_put(precvframe, pattrib->pkt_len); -+ /*recvframe_pull(precvframe, drvinfo_sz + RXDESC_SIZE);*/ -+ -+ -+ /* update drv info*/ -+#if 0 -+ if (rtw_hal_rcr_check(padapter, BIT_APP_BASSN_8821C)) { -+ /*rtl8821c_update_bassn(padapter, (ptr + RXDESC_SIZE));*/ -+ } -+#endif -+ -+ pre_recv_entry(precvframe, pattrib->physt ? (ptr + rx_report_sz - pattrib->drvinfo_sz) : NULL); -+ -+ } else { /* C2H_PACKET */ -+ -+ c2h_pre_handler_rtl8821c(padapter, ptr, transfer_len); -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ -+ } -+ } -+ -+ /* Page size of receive package is 128 bytes alignment =>DMA AGG*/ -+ -+ pkt_offset = _RND8(pkt_offset); -+ transfer_len -= pkt_offset; -+ ptr += pkt_offset; -+ precvframe = NULL; -+ -+ } while (transfer_len > 0); -+ -+ precvbuf->len = 0; -+ -+ rtw_enqueue_recvbuf(precvbuf, &precvpriv->free_recv_buf_queue); -+ } while (1); -+ -+#ifdef CONFIG_RTW_NAPI -+#ifdef CONFIG_RTW_NAPI_V2 -+ if (padapter->registrypriv.en_napi) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct _ADAPTER *iface; -+ u8 i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ precvpriv = &iface->recvpriv; -+ if (rtw_if_up(iface) == _TRUE -+ && skb_queue_len(&precvpriv->rx_napi_skb_queue)) -+ napi_schedule(&iface->napi); -+ } -+ } -+#endif /* CONFIG_RTW_NAPI_V2 */ -+#endif /* CONFIG_RTW_NAPI */ -+ -+ return _SUCCESS; -+ -+} -+ -+static void rtl8821c_recv_tasklet(unsigned long priv) -+{ -+ _adapter *adapter = (_adapter *)priv; -+ s32 ret; -+ -+ ret = rtl8821cs_recv_hdl(adapter); -+ if (ret == RTW_RFRAME_UNAVAIL -+ || ret == RTW_RFRAME_PKT_UNAVAIL -+ ) { -+ /* schedule again and hope recvframe/packet is available next time. */ -+ #ifdef PLATFORM_LINUX -+ tasklet_schedule(&adapter->recvpriv.recv_tasklet); -+ #endif -+ } -+} -+ -+#else -+ -+static void rtl8821c_recv_tasklet(unsigned long priv) -+{ -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ struct recv_priv *precvpriv; -+ struct recv_buf *precvbuf; -+ union recv_frame *precvframe; -+ struct recv_frame_hdr *phdr; -+ struct rx_pkt_attrib *pattrib; -+ u8 *ptr; -+ _pkt *ppkt; -+ u32 desc_size; -+ u32 pkt_offset; -+ -+ padapter = (PADAPTER)priv; -+ pHalData = GET_HAL_DATA(padapter); -+ precvpriv = &padapter->recvpriv; -+ rtw_halmac_get_rx_desc_size(adapter_to_dvobj(padapter), &desc_size); -+ -+ 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) { -+ RTW_ERR("%s: no enough recv frame!\n", __FUNCTION__); -+ rtw_enqueue_recvbuf_to_head(precvbuf, &precvpriv->recv_buf_pending_queue); -+ -+ /* The case of can't allocate recvframe should be temporary, -+ schedule again and hope recvframe is available next time.*/ -+ tasklet_schedule(&precvpriv->recv_tasklet); -+ -+ return; -+ } -+ -+ phdr = &precvframe->u.hdr; -+ pattrib = &phdr->attrib; -+ -+ /*rx desc parsing*/ -+ rtl8821c_rxdesc2attribute(pattrib, ptr); -+ -+ /* fix Hardware RX data error, drop whole recv_buffer*/ -+ if (!rtw_hal_rcr_check(padapter, BIT_ACRC32_8821C) && pattrib->crc_err) { -+ /*#if !(MP_DRIVER==1)*/ -+ if (padapter->registrypriv.mp_mode == 0) -+ RTW_INFO("%s()-%d: RX Warning! rx CRC ERROR !!\n", __FUNCTION__, __LINE__); -+ /*#endif*/ -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ break; -+ } -+ -+ pkt_offset = desc_size + pattrib->drvinfo_sz + pattrib->pkt_len; -+ -+ if ((ptr + pkt_offset) > precvbuf->ptail) { -+ RTW_INFO("%s()-%d: : next pkt len(%p,%d) exceed ptail(%p)!\n", __FUNCTION__, __LINE__, ptr, pkt_offset, precvbuf->ptail); -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ break; -+ } -+ -+ if ((pattrib->crc_err) || (pattrib->icv_err)) { -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) { -+ if (check_fwstate(&padapter->mlmepriv, WIFI_MP_STATE)) { /*&&(padapter->mppriv.check_mp_pkt == 0))*/ -+ if (pattrib->crc_err == 1) -+ padapter->mppriv.rx_crcerrpktcount++; -+ } -+ } -+#endif -+ -+ RTW_INFO("%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 { -+ ppkt = rtw_skb_clone(precvbuf->pskb); -+ if (ppkt == NULL) { -+ rtw_free_recvframe(precvframe, &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(padapter)) -+ tasklet_schedule(&precvpriv->recv_tasklet); -+ -+ return; -+ } -+ -+ phdr->pkt = ppkt; -+ phdr->len = 0; -+ phdr->rx_head = precvbuf->phead; -+ phdr->rx_data = phdr->rx_tail = precvbuf->pdata; -+ phdr->rx_end = precvbuf->pend; -+ -+ recvframe_put(precvframe, pkt_offset); -+ recvframe_pull(precvframe, desc_size + pattrib->drvinfo_sz); -+ skb_pull(ppkt, desc_size + pattrib->drvinfo_sz); -+ -+#ifdef CONFIG_RX_PACKET_APPEND_FCS -+ if (check_fwstate(&padapter->mlmepriv, WIFI_MONITOR_STATE) == _FALSE) { -+ if ((pattrib->pkt_rpt_type == NORMAL_RX) && rtw_hal_rcr_check(padapter, BIT_APP_FCS_8821C)) { -+ recvframe_pull_tail(precvframe, IEEE80211_FCS_LEN); -+ pattrib->pkt_len -= IEEE80211_FCS_LEN; -+ ppkt->len = pattrib->pkt_len; -+ } -+ } -+#endif -+ -+ /* move to drv info position*/ -+ ptr += desc_size; -+ -+ /* update drv info*/ -+ if (rtw_hal_rcr_check(padapter, BIT_APP_BASSN_8821C)) { -+ /*rtl8821cs_update_bassn(padapter, pdrvinfo);*/ -+ ptr += RTW_HALMAC_BA_SSN_RPT_SIZE; -+ } -+ -+ if (pattrib->pkt_rpt_type == NORMAL_RX) /*Normal rx packet*/ -+ pre_recv_entry(precvframe, pattrib->physt ? ptr : NULL); -+ else { /* C2H_PACKET*/ -+ c2h_pre_handler_rtl8821c(padapter, ptr, transfer_len); -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ } -+ } -+ -+ /* Page size of receive package is 128 bytes alignment =>DMA AGG*/ -+ -+ pkt_offset = _RND8(pkt_offset); -+ precvbuf->pdata += pkt_offset; -+ ptr = precvbuf->pdata; -+ -+ } -+ -+ rtw_skb_free(precvbuf->pskb); -+ precvbuf->pskb = NULL; -+ rtw_enqueue_recvbuf(precvbuf, &precvpriv->free_recv_buf_queue); -+ -+ } while (1); -+ -+} -+#endif -+ -+/* -+ * Initialize recv private variable for hardware dependent -+ * 1. recv buf -+ * 2. recv tasklet -+ */ -+s32 rtl8821cs_init_recv_priv(PADAPTER adapter) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ s32 res; -+ u32 i, n; -+ struct recv_priv *precvpriv; -+ struct recv_buf *precvbuf; -+ -+ -+ res = _SUCCESS; -+ precvpriv = &adapter->recvpriv; -+ -+ /* 1. init recv buffer */ -+ _rtw_init_queue(&precvpriv->free_recv_buf_queue); -+ _rtw_init_queue(&precvpriv->recv_buf_pending_queue); -+ -+ n = regsty->recvbuf_nr * sizeof(struct recv_buf) + 4; -+ precvpriv->pallocated_recv_buf = rtw_zmalloc(n); -+ if (precvpriv->pallocated_recv_buf == NULL) { -+ res = _FAIL; -+ 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 < regsty->recvbuf_nr; i++) { -+ res = sdio_initrecvbuf(precvbuf, adapter); -+ if (res == _FAIL) -+ break; -+ -+ res = rtw_os_recvbuf_resource_alloc(adapter, precvbuf, MAX_RECVBUF_SZ); -+ if (res == _FAIL) { -+ sdio_freerecvbuf(precvbuf); -+ break; -+ } -+ -+#if 0 -+ res = os_recvbuf_resource_alloc(adapter, precvbuf); -+ if (res == _FAIL) { -+ sdio_freerecvbuf(precvbuf); -+ break; -+ } -+#endif -+ rtw_list_insert_tail(&precvbuf->list, &precvpriv->free_recv_buf_queue.queue); -+ -+ precvbuf++; -+ } -+ precvpriv->free_recv_buf_queue_cnt = i; -+ -+ if (res == _FAIL) -+ goto initbuferror; -+ -+ /* 2. init tasklet */ -+#ifdef PLATFORM_LINUX -+ tasklet_init(&precvpriv->recv_tasklet, -+ rtl8821c_recv_tasklet, -+ (unsigned long)adapter); -+#endif -+ -+ 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++) { -+ rtw_list_delete(&precvbuf->list); -+ rtw_os_recvbuf_resource_free(adapter, precvbuf); -+ sdio_freerecvbuf(precvbuf); -+ precvbuf++; -+ } -+ precvpriv->precv_buf = NULL; -+ } -+ -+ if (precvpriv->pallocated_recv_buf) { -+ n = regsty->recvbuf_nr * sizeof(struct recv_buf) + 4; -+ rtw_mfree(precvpriv->pallocated_recv_buf, n); -+ precvpriv->pallocated_recv_buf = NULL; -+ } -+ -+exit: -+ return res; -+} -+ -+/* -+ * Free recv private variable of hardware dependent -+ * 1. recv buf -+ * 2. recv tasklet -+ */ -+void rtl8821cs_free_recv_priv(PADAPTER adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ u32 i, n; -+ struct recv_priv *precvpriv; -+ struct recv_buf *precvbuf; -+ -+ -+ precvpriv = &adapter->recvpriv; -+ -+ /* 1. kill tasklet */ -+#ifdef PLATFORM_LINUX -+ tasklet_kill(&adapter->recvpriv.recv_tasklet); -+#endif -+ -+ /* 2. free all recv buffers */ -+ precvbuf = (struct recv_buf *)precvpriv->precv_buf; -+ if (precvbuf) { -+ n = regsty->recvbuf_nr; -+ precvpriv->free_recv_buf_queue_cnt = 0; -+ for (i = 0; i < n ; i++) { -+ rtw_list_delete(&precvbuf->list); -+ rtw_os_recvbuf_resource_free(adapter, precvbuf); -+ sdio_freerecvbuf(precvbuf); -+ precvbuf++; -+ } -+ precvpriv->precv_buf = NULL; -+ } -+ -+ if (precvpriv->pallocated_recv_buf) { -+ n = regsty->recvbuf_nr * sizeof(struct recv_buf) + 4; -+ rtw_mfree(precvpriv->pallocated_recv_buf, n); -+ precvpriv->pallocated_recv_buf = NULL; -+ } -+} -+ -+void rtl8821cs_rxhandler(PADAPTER adapter, struct recv_buf *recvbuf) -+{ -+ struct recv_priv *recvpriv = &adapter->recvpriv; -+ _queue *pending_queue = &recvpriv->recv_buf_pending_queue; -+ -+ -+ /*enqueue recvbuf*/ -+ rtw_enqueue_recvbuf(recvbuf, pending_queue); -+ -+ /*schedule tasklet*/ -+#ifdef CONFIG_RECV_THREAD_MODE -+ _rtw_up_sema(&recvpriv->recv_sema); -+#else -+#ifdef PLATFORM_LINUX -+ tasklet_schedule(&recvpriv->recv_tasklet); -+#endif -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_recv.h b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_recv.h -new file mode 100644 -index 000000000..0fb89c398 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_recv.h -@@ -0,0 +1,27 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_RECV_H_ -+#define _RTL8821CS_RECV_H_ -+ -+#include /* PADAPTER and etc. */ -+ -+s32 rtl8821cs_init_recv_priv(PADAPTER); -+void rtl8821cs_free_recv_priv(PADAPTER); -+/*_pkt* rtl8821cs_alloc_recvbuf_skb(struct recv_buf*, u32 size);*/ -+/*void rtl8821cs_free_recvbuf_skb(struct recv_buf*);*/ -+void rtl8821cs_rxhandler(PADAPTER, struct recv_buf *); -+s32 rtl8821cs_recv_hdl(_adapter *adapter); -+ -+#endif /* _RTL8821CS_RECV_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_xmit.c b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_xmit.c -new file mode 100644 -index 000000000..2547256c1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_xmit.c -@@ -0,0 +1,801 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_XMIT_C_ -+ -+#include /* PADAPTER, rtw_xmit.h and etc. */ -+#include /* HAL_DATA_TYPE */ -+#include "../../hal_halmac.h" /* rtw_halmac_sdio_tx_allowed() and etc. */ -+#include "../rtl8821c.h" /* rtl8821c_update_txdesc() */ -+ -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+u8 HalQueryTxBufferStatus8821CSdio(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u32 NumOfFreePage; -+ /*_irqL irql;*/ -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ NumOfFreePage = SdioLocalCmd53Read4Byte(padapter, SDIO_REG_FREE_TXPG); -+ -+ /*_enter_critical_bh(&pHalData->SdioTxFIFOFreePageLock, &irql);*/ -+ _rtw_memcpy(pHalData->SdioTxFIFOFreePage, &NumOfFreePage, 4); -+ /*_exit_critical_bh(&pHalData->SdioTxFIFOFreePageLock, &irql);*/ -+ -+ return _TRUE; -+} -+#endif -+ -+s32 _dequeue_writeport(PADAPTER adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &adapter->xmitpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(adapter); -+ struct xmit_buf *pxmitbuf; -+ u32 polling_num = 0; -+ -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+ -+#endif -+ pxmitbuf = select_and_dequeue_pending_xmitbuf(adapter); -+ -+ if (pxmitbuf == NULL) -+ return _TRUE; -+ -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+query_free_page: -+ -+ /* Total number of page is NOT available, so update current FIFO status*/ -+ u8 bUpdatePageNum = _FALSE; -+ -+ if (!bUpdatePageNum) { -+ HalQueryTxBufferStatus8821CSdio(adapter); -+ bUpdatePageNum = _TRUE; -+ goto query_free_page; -+ } else { -+ bUpdatePageNum = _FALSE; -+ enqueue_pending_xmitbuf_to_head(pxmitpriv, pxmitbuf); -+ return _TRUE; -+ } -+#endif -+ if (_TRUE == rtw_is_xmit_blocked(adapter)) { -+ enqueue_pending_xmitbuf_to_head(pxmitpriv, pxmitbuf); -+ /*rtw_msleep_os(1);*/ -+ return _FALSE; -+ } -+ -+ /* check if hardware tx fifo page is enough */ -+ while (rtw_halmac_sdio_tx_allowed(pdvobjpriv, pxmitbuf->pdata, pxmitbuf->len)) { -+ if (RTW_CANNOT_RUN(adapter)) { -+ RTW_INFO("%s: bSurpriseRemoved(write port)\n", __func__); -+ goto free_xmitbuf; -+ } -+ -+ polling_num++; -+ /* Only polling (0x7F / 10) times here, since rtw_halmac_sdio_tx_allowed() has polled 10 times within */ -+ if ((polling_num % 6) == 0) { -+ enqueue_pending_xmitbuf_to_head(pxmitpriv, pxmitbuf); -+ rtw_msleep_os(1); -+ return _FALSE; -+ } -+ } -+ -+#ifdef CONFIG_CHECK_LEAVE_LPS -+ #ifdef CONFIG_LPS_CHK_BY_TP -+ if (!adapter_to_pwrctl(adapter)->lps_chk_by_tp) -+ #endif -+ traffic_check_for_leave_lps(adapter, _TRUE, pxmitbuf->agg_num); -+#endif -+ -+ if (_TRUE == rtw_is_xmit_blocked(adapter)) { -+ enqueue_pending_xmitbuf_to_head(pxmitpriv, pxmitbuf); -+ /*rtw_msleep_os(1);*/ -+ return _FALSE; -+ } -+ -+ rtw_write_port(adapter, 0, pxmitbuf->len, (u8 *)pxmitbuf); -+ -+free_xmitbuf: -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ -+#ifdef CONFIG_SDIO_TX_TASKLET -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+#endif -+ -+ return _FALSE; -+} -+ -+/* -+ * Description -+ * Transmit xmitbuf to hardware tx fifo -+ * -+ * Return -+ * _SUCCESS ok -+ * _FAIL something error -+ */ -+s32 rtl8821cs_xmit_buf_handler(PADAPTER adapter) -+{ -+ struct xmit_priv *pxmitpriv; -+ u8 queue_empty, queue_pending; -+ s32 ret; -+ -+ -+ pxmitpriv = &adapter->xmitpriv; -+ -+ ret = _rtw_down_sema(&pxmitpriv->xmit_sema); -+ if (_FAIL == ret) { -+ RTW_ERR("%s: down SdioXmitBufSema fail!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ if (RTW_CANNOT_RUN(adapter)) { -+ RTW_DBG(FUNC_ADPT_FMT "- bDriverStopped(%s) bSurpriseRemoved(%s)\n", -+ FUNC_ADPT_ARG(adapter), -+ rtw_is_drv_stopped(adapter) ? "True" : "False", -+ rtw_is_surprise_removed(adapter) ? "True" : "False"); -+ return _FAIL; -+ } -+ -+ if (rtw_mi_check_pending_xmitbuf(adapter) == 0) -+ return _SUCCESS; -+#ifdef CONFIG_LPS_LCLK -+ ret = rtw_register_tx_alive(adapter); -+ if (ret != _SUCCESS) -+ return _SUCCESS; -+#endif -+ -+ do { -+ queue_empty = rtw_mi_dequeue_writeport(adapter); -+ -+ } while (!queue_empty); -+ -+#ifdef CONFIG_LPS_LCLK -+ rtw_unregister_tx_alive(adapter); -+#endif -+ -+ return _SUCCESS; -+} -+ -+#ifdef XMIT_BUF_SIZE -+int rtl8821cs_get_tx_max_length(struct dvobj_priv *dvobj, u8 queue, u32 *size) -+{ -+ _adapter *padapter = dvobj_get_primary_adapter(dvobj); -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(padapter); -+ u32 fifo_size = 0; -+ -+ switch (queue) { -+ case VO_QUEUE_INX: -+ case VI_QUEUE_INX: -+ *size = (hal_data->max_xmit_size_vovi > MAX_XMITBUF_SZ) ? MAX_XMITBUF_SZ : hal_data->max_xmit_size_vovi; -+ break; -+ case BE_QUEUE_INX: -+ case BK_QUEUE_INX: -+ *size = (hal_data->max_xmit_size_bebk > MAX_XMITBUF_SZ) ? MAX_XMITBUF_SZ : hal_data->max_xmit_size_bebk; -+ break; -+ case BCN_QUEUE_INX: -+ case MGT_QUEUE_INX: -+ case HIGH_QUEUE_INX: -+ case TXCMD_QUEUE_INX: -+ default: -+ rtw_halmac_get_tx_fifo_size(dvobj, &fifo_size); -+ *size = (fifo_size / 3); -+ rtw_warn_on(1); -+ break; -+ } -+#ifdef DBG_DUMP_RQPN -+ RTW_INFO("%s => max_xmit_size:%d\n", __func__, *size); -+#endif -+ return 0; -+} -+#endif -+ -+u16 rtl8821cs_get_tx_max_page(struct dvobj_priv *dvobj, u8 queue) -+{ -+ _adapter *padapter = dvobj_get_primary_adapter(dvobj); -+ PHAL_DATA_TYPE hal_data = GET_HAL_DATA(padapter); -+ u16 page_num; -+ -+ if (VO_QUEUE_INX == queue) -+ page_num = (hal_data->max_xmit_page_vo > hal_data->max_xmit_page) ? hal_data->max_xmit_page : hal_data->max_xmit_page_vo; -+ else if (VI_QUEUE_INX == queue) -+ page_num = (hal_data->max_xmit_page_vi > hal_data->max_xmit_page) ? hal_data->max_xmit_page : hal_data->max_xmit_page_vi; -+ else if (BE_QUEUE_INX == queue) -+ page_num = (hal_data->max_xmit_page_be > hal_data->max_xmit_page) ? hal_data->max_xmit_page : hal_data->max_xmit_page_be; -+ else if (BK_QUEUE_INX == queue) -+ page_num = (hal_data->max_xmit_page_bk > hal_data->max_xmit_page) ? hal_data->max_xmit_page : hal_data->max_xmit_page_bk; -+ else -+ page_num = hal_data->max_xmit_page; -+ -+#ifdef DBG_DUMP_RQPN -+ RTW_INFO("%s => max_xmit_page:%d\n", __func__, page_num); -+#endif -+ return page_num; -+} -+ -+/* -+ * 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(PADAPTER adapter, struct xmit_priv *pxmitpriv) -+{ -+ s32 err, ret; -+ u32 agg_num = 0; -+ struct hw_xmit *hwxmits, *phwxmit; -+ u8 no_res, idx, hwentry; -+ _irqL irql; -+ struct tx_servq *ptxservq; -+ _list *sta_plist, *sta_phead, *frame_plist, *frame_phead; -+ struct xmit_frame *pxmitframe; -+ _queue *pframe_queue; -+ struct xmit_buf *pxmitbuf; -+ u32 txlen; -+ #ifdef XMIT_BUF_SIZE -+ u32 max_xmit_len; -+ #endif -+ u16 max_xmit_page; -+ u32 txdesc_size = 0; -+ u32 page_size = 0; -+ int inx[4]; -+ u8 pre_qsel = 0xFF, next_qsel = 0xFF; -+ u8 single_sta_in_queue = _FALSE; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ -+ err = 0; -+ no_res = _FALSE; -+ hwxmits = pxmitpriv->hwxmits; -+ hwentry = pxmitpriv->hwxmit_entry; -+ ptxservq = NULL; -+ pxmitframe = NULL; -+ pframe_queue = NULL; -+ pxmitbuf = NULL; -+ rtw_halmac_get_tx_desc_size(adapter_to_dvobj(adapter), &txdesc_size); -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ /* dump management frame directly */ -+ do { -+ pxmitframe = rtw_dequeue_mgmt_xframe(pxmitpriv); -+ if (pxmitframe) -+ adapter->hal_func.mgnt_xmit(adapter, pxmitframe); -+ } while (pxmitframe != NULL); -+ -+ hwentry--; -+#endif -+ -+ if (adapter->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) -+ && (adapter->mlmepriv.LinkDetectInfo.bHigherBusyTxTraffic == _TRUE)) { -+ if ((phwxmit->accnt > 0) && (phwxmit->accnt < 5)) { -+ err = -2; -+ break; -+ } -+ } -+ -+ max_xmit_page = rtl8821cs_get_tx_max_page(adapter_to_dvobj(adapter), inx[idx]); -+ #ifdef XMIT_BUF_SIZE -+ rtl8821cs_get_tx_max_length(adapter_to_dvobj(adapter), inx[idx], &max_xmit_len); -+ if (0) { -+ if (max_xmit_page != PageNum(max_xmit_len, page_size)) { -+ RTW_ERR("%s => max_xmit_page_1:%d != max_xmit_page_2:%d\n", __func__, max_xmit_page, PageNum(max_xmit_len, page_size)); -+ rtw_warn_on(1); -+ } -+ } -+ #endif -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irql); -+ -+ 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 -+ */ -+ -+ single_sta_in_queue = rtw_end_of_queue_search(sta_phead, get_next(sta_plist)); -+ -+ while (rtw_end_of_queue_search(sta_phead, sta_plist) == _FALSE) { -+ ptxservq = LIST_CONTAINOR(sta_plist, struct tx_servq, tx_pending); -+ sta_plist = get_next(sta_plist); -+ -+#ifdef DBG_XMIT_BUF -+ RTW_INFO("%s idx:%d hwxmit_pkt_num:%d ptxservq_pkt_num:%d\n", __FUNCTION__, idx, phwxmit->accnt, ptxservq->qcnt); -+ RTW_INFO("%s free_xmit_extbuf_cnt=%d free_xmitbuf_cnt=%d free_xmitframe_cnt=%d\n", -+ __FUNCTION__, 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 (rtw_is_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); -+ next_qsel = pxmitframe->attrib.qsel; -+ if ((NULL == pxmitbuf) -+ #ifdef XMIT_BUF_SIZE -+ || ((pxmitbuf->pg_num + PageNum(txlen, page_size)) > PageNum(max_xmit_len, page_size)) -+ #else -+ || ((pxmitbuf->pg_num + PageNum(txlen, page_size)) > max_xmit_page) -+ #endif -+ || (agg_num >= hal_data->max_oqt_size) -+ #ifdef SDIO_TX_AGG_MAX -+ || (agg_num >= SDIO_TX_AGG_MAX) -+ #endif -+ || ((agg_num != 0) && (_FAIL == rtw_hal_busagg_qsel_check(adapter, pre_qsel, next_qsel)))) { -+ if (pxmitbuf) { -+ if (pxmitbuf->len > 0 && pxmitbuf->priv_data) { -+ struct xmit_frame *pframe; -+ -+ pframe = (struct xmit_frame *)pxmitbuf->priv_data; -+ pframe->agg_num = agg_num; -+ pxmitbuf->agg_num = agg_num; -+ rtl8821c_update_txdesc(pframe, pframe->buf_addr); -+ rtw_free_xmitframe(pxmitpriv, pframe); -+ pxmitbuf->priv_data = NULL; -+ enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf); -+ -+ if (single_sta_in_queue == _FALSE) { -+ /* break the loop in case there is more than one sta in this ac queue */ -+ pxmitbuf = NULL; -+ err = -3; -+ break; -+ } -+ } else -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ } -+ -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ if (pxmitbuf == NULL) { -+ err = -2; -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+ _rtw_up_sema(&(GET_PRIMARY_ADAPTER(adapter)->xmitpriv.xmit_sema)); -+#endif -+ break; -+ } -+ agg_num = 0; -+ } -+ -+ /* ok to send, remove frame from queue */ -+#ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { -+ if ((pxmitframe->attrib.psta->state & WIFI_SLEEP_STATE) -+ && (pxmitframe->attrib.triggered == 0)) { -+ RTW_INFO("%s: one not triggered pkt in queue when this STA sleep," -+ " break and goto next sta\n", __FUNCTION__); -+ break; -+ } -+ } -+#endif -+ rtw_list_delete(&pxmitframe->list); -+ ptxservq->qcnt--; -+ phwxmit->accnt--; -+ -+ if (agg_num == 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(adapter, pxmitframe->pkt, pxmitframe); -+ if (ret == _FAIL) { -+ RTW_INFO("%s: coalesce FAIL!", __FUNCTION__); -+ /* Todo: error handler */ -+ } else { -+ agg_num++; -+ if (agg_num != 1) -+ rtl8821c_update_txdesc(pxmitframe, pxmitframe->buf_addr); -+ rtw_count_tx_stats(adapter, pxmitframe, pxmitframe->attrib.last_txcmdsz); -+ pre_qsel = pxmitframe->attrib.qsel; -+ txlen = txdesc_size + pxmitframe->attrib.last_txcmdsz; -+ pxmitframe->pg_num = PageNum(txlen, page_size); -+ pxmitbuf->pg_num += PageNum(txlen, page_size); -+ pxmitbuf->ptail += _RND(txlen, 8); /* round to 8 bytes alignment */ -+ pxmitbuf->len = _RND(pxmitbuf->len, 8) + txlen; -+ } -+ -+ if (agg_num != 1) -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ pxmitframe = NULL; -+ } -+#if 0 -+ /* dump xmit_buf to hw tx fifo */ -+ if (pxmitbuf && (pxmitbuf->len > 0)) { -+ struct xmit_frame *pframe; -+ -+ RTW_INFO("STA pxmitbuf->len=%d enqueue\n", pxmitbuf->len); -+ -+ pframe = (struct xmit_frame *)pxmitbuf->priv_data; -+ pframe->agg_num = k; -+ pxmitbuf->agg_num = k; -+ rtl8821c_update_txdesc(pframe, pframe->buf_addr); -+ rtw_free_xmitframe(pxmitpriv, pframe); -+ pxmitbuf->priv_data = NULL; -+ enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf); -+ -+ pxmitbuf = NULL; -+ } -+#endif -+ if (_rtw_queue_empty(pframe_queue) == _TRUE) -+ rtw_list_delete(&ptxservq->tx_pending); -+ else if (err == -3) { -+ /* 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)); -+ err = 0; -+ } -+ -+ if (err) -+ break; -+ } -+ _exit_critical_bh(&pxmitpriv->lock, &irql); -+ -+ /* dump xmit_buf to hw tx fifo */ -+ if (pxmitbuf) { -+ -+ if (pxmitbuf->len > 0) { -+ struct xmit_frame *pframe; -+ -+ pframe = (struct xmit_frame *)pxmitbuf->priv_data; -+ pframe->agg_num = agg_num; -+ pxmitbuf->agg_num = agg_num; -+ rtl8821c_update_txdesc(pframe, pframe->buf_addr); -+ rtw_free_xmitframe(pxmitpriv, pframe); -+ pxmitbuf->priv_data = NULL; -+ enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf); -+ rtw_yield_os(); -+ } else -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ pxmitbuf = NULL; -+ } -+ -+ if (err == -2) -+ break; -+ } -+ -+ return err; -+} -+ -+/* -+ * Description -+ * Transmit xmitframe from queue -+ * -+ * Return -+ * _SUCCESS ok -+ * _FAIL something error -+ */ -+static s32 rtl8821cs_xmit_handler(PADAPTER adapter) -+{ -+ struct xmit_priv *pxmitpriv = &adapter->xmitpriv; -+ s32 ret; -+ _irqL irql; -+ -+ ret = _rtw_down_sema(&pxmitpriv->SdioXmitSema); -+ if (_FAIL == ret) { -+ RTW_ERR("%s: down sema fail!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+next: -+ if (RTW_CANNOT_RUN(adapter)) { -+ RTW_DBG(FUNC_ADPT_FMT "- bDriverStopped(%s) bSurpriseRemoved(%s)\n", -+ FUNC_ADPT_ARG(adapter), -+ rtw_is_drv_stopped(adapter) ? "True" : "False", -+ rtw_is_surprise_removed(adapter) ? "True" : "False"); -+ return _FAIL; -+ } -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irql); -+ ret = rtw_txframes_pending(adapter); -+ _exit_critical_bh(&pxmitpriv->lock, &irql); -+ /* All queues are empty! */ -+ if (ret == 0) -+ return _SUCCESS; -+ -+ /* Dequeue frame and agg-tx then enqueue pending xmitbuf-queue */ -+ ret = xmit_xmitframes(adapter, pxmitpriv); -+ if (ret == -2) { -+ /* here sleep 1ms will cause big TP loss of TX */ -+ /* from 50+ to 40+ */ -+ if (adapter->registrypriv.wifi_spec) -+ rtw_msleep_os(1); -+ else -+ #ifdef CONFIG_REDUCE_TX_CPU_LOADING -+ rtw_msleep_os(1); -+ #else -+ rtw_yield_os(); -+ #endif -+ -+ goto next; -+ } -+ _enter_critical_bh(&pxmitpriv->lock, &irql); -+ ret = rtw_txframes_pending(adapter); -+ _exit_critical_bh(&pxmitpriv->lock, &irql); -+ if (ret == 1) -+ goto next; -+ -+ return _SUCCESS; -+} -+ -+thread_return rtl8821cs_xmit_thread(thread_context context) -+{ -+ s32 ret; -+ PADAPTER adapter; -+ struct xmit_priv *pxmitpriv; -+ u8 thread_name[20] = {0}; -+ -+ -+ ret = _SUCCESS; -+ adapter = (PADAPTER)context; -+ pxmitpriv = &adapter->xmitpriv; -+ -+ rtw_sprintf(thread_name, 20, "RTWHALXT-"ADPT_FMT, ADPT_ARG(adapter)); -+ thread_enter(thread_name); -+ -+ RTW_INFO("start "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ -+ do { -+ ret = rtl8821cs_xmit_handler(adapter); -+ flush_signals_thread(); -+ } while (_SUCCESS == ret); -+ -+ RTW_INFO(FUNC_ADPT_FMT " Exit\n", FUNC_ADPT_ARG(adapter)); -+ -+ rtw_thread_wait_stop(); -+ -+ return 0; -+} -+ -+/* -+ * Description: -+ * Transmit manage frame -+ * -+ * Return: -+ * _SUCCESS ok or enqueue -+ * _FAIL fail -+ */ -+s32 rtl8821cs_mgnt_xmit(PADAPTER adapter, struct xmit_frame *pmgntframe) -+{ -+ s32 ret = _SUCCESS; -+ struct dvobj_priv *pdvobjpriv; -+ struct xmit_priv *pxmitpriv; -+ struct pkt_attrib *pattrib; -+ struct xmit_buf *pxmitbuf; -+ u32 txdesc_size; -+ u32 page_size; -+ u8 *pframe; -+ -+ -+ pdvobjpriv = adapter_to_dvobj(adapter); -+ pxmitpriv = &adapter->xmitpriv; -+ pattrib = &pmgntframe->attrib; -+ pxmitbuf = pmgntframe->pxmitbuf; -+ rtw_halmac_get_tx_desc_size(pdvobjpriv, &txdesc_size); -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); -+ -+ rtl8821c_update_txdesc(pmgntframe, pmgntframe->buf_addr); -+ -+ pxmitbuf->len = txdesc_size + pattrib->last_txcmdsz; -+ pxmitbuf->pg_num = PageNum(pxmitbuf->len, page_size); -+ pxmitbuf->ptail = pmgntframe->buf_addr + pxmitbuf->len; -+ -+ pframe = pmgntframe->buf_addr + txdesc_size; -+ -+ rtw_count_tx_stats(adapter, pmgntframe, pattrib->last_txcmdsz); -+ -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ pxmitbuf->priv_data = NULL; -+ -+ if ((pattrib->subtype == WIFI_BEACON) || (get_frame_sub_type(pframe) == WIFI_BEACON)) { -+ /* dump beacon directly */ -+ ret = rtw_write_port(adapter, 0, 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: -+ * Enqueue management xmitframe -+ * -+ * Return: -+ * _TRUE enqueue ok -+ * _FALSE fail -+ */ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+s32 rtl8821cs_hal_mgmt_xmit_enqueue(PADAPTER adapter, struct xmit_frame *pxmitframe) -+{ -+ struct xmit_priv *pxmitpriv; -+ s32 ret; -+ -+ pxmitpriv = &adapter->xmitpriv; -+ -+ ret = rtw_mgmt_xmitframe_enqueue(adapter, pxmitframe); -+ if (ret != _SUCCESS) { -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ pxmitpriv->tx_drop++; -+ return _FALSE; -+ } -+ -+#ifdef CONFIG_SDIO_TX_TASKLET -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+#else -+ _rtw_up_sema(&pxmitpriv->SdioXmitSema); -+#endif -+ -+ return _TRUE; -+} -+#endif -+ -+/* -+ * Description: -+ * Enqueue xmitframe -+ * -+ * Return: -+ * _TRUE enqueue ok -+ * _FALSE fail -+ */ -+s32 rtl8821cs_hal_xmit_enqueue(PADAPTER adapter, struct xmit_frame *pxmitframe) -+{ -+ struct xmit_priv *pxmitpriv; -+ s32 ret; -+ -+ -+ pxmitpriv = &adapter->xmitpriv; -+ -+ ret = rtw_xmitframe_enqueue(adapter, pxmitframe); -+ if (ret != _SUCCESS) { -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ pxmitpriv->tx_drop++; -+ return _FALSE; -+ } -+ -+#ifdef CONFIG_SDIO_TX_TASKLET -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+#else /* !CONFIG_SDIO_TX_TASKLET */ -+ _rtw_up_sema(&pxmitpriv->SdioXmitSema); -+#endif /* !CONFIG_SDIO_TX_TASKLET */ -+ -+ return _TRUE; -+} -+ -+/* -+ * Description: -+ * Handle xmitframe(packet) come from rtw_xmit() -+ * -+ * Return: -+ * _TRUE handle packet directly, maybe ok or drop -+ * _FALSE enqueue, temporary can't transmit packets to hardware -+ */ -+s32 rtl8821cs_hal_xmit(PADAPTER adapter, struct xmit_frame *pxmitframe) -+{ -+ struct xmit_priv *pxmitpriv; -+ _irqL irql; -+ s32 err; -+ -+ -+ pxmitframe->attrib.qsel = pxmitframe->attrib.priority; -+ pxmitpriv = &adapter->xmitpriv; -+ -+#ifdef CONFIG_80211N_HT -+ 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(adapter, pxmitframe, _TRUE); -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irql); -+ err = rtw_xmitframe_enqueue(adapter, pxmitframe); -+ _exit_critical_bh(&pxmitpriv->lock, &irql); -+ if (err != _SUCCESS) { -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ pxmitpriv->tx_drop++; -+ return _TRUE; -+ } -+ -+#ifdef CONFIG_SDIO_TX_TASKLET -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+#else -+ _rtw_up_sema(&pxmitpriv->SdioXmitSema); -+#endif -+ -+ return _FALSE; -+} -+ -+/* -+ * Return -+ * _SUCCESS start thread ok -+ * _FAIL start thread fail -+ * -+ */ -+s32 rtl8821cs_init_xmit_priv(PADAPTER adapter) -+{ -+ struct xmit_priv *xmitpriv = &adapter->xmitpriv; -+ -+ _rtw_init_sema(&xmitpriv->SdioXmitSema, 0); -+ rtl8821c_init_xmit_priv(adapter); -+ -+ return _SUCCESS; -+} -+ -+void rtl8821cs_free_xmit_priv(PADAPTER adapter) -+{ -+ struct xmit_priv *pxmitpriv; -+ struct xmit_buf *pxmitbuf; -+ _queue *pqueue; -+ _list *plist, *phead; -+ _list tmplist; -+ _irqL irql; -+ -+ -+ pxmitpriv = &adapter->xmitpriv; -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ phead = get_list_head(pqueue); -+ _rtw_init_listhead(&tmplist); -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ if (_rtw_queue_empty(pqueue) == _FALSE) { -+ /* -+ * Insert tmplist to end of queue, and delete phead -+ * then tmplist become head of queue. -+ */ -+ rtw_list_insert_tail(&tmplist, phead); -+ rtw_list_delete(phead); -+ } -+ _exit_critical_bh(&pqueue->lock, &irql); -+ -+ phead = &tmplist; -+ while (rtw_is_list_empty(phead) == _FALSE) { -+ plist = get_next(phead); -+ rtw_list_delete(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 --git a/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_xmit.h b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_xmit.h -new file mode 100644 -index 000000000..60d6168b2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/hal/rtl8821c/sdio/rtl8821cs_xmit.h -@@ -0,0 +1,32 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_XMIT_H_ -+#define _RTL8821CS_XMIT_H_ -+ -+#include /* PADAPTER, rtw_xmit.h and etc. */ -+ -+s32 rtl8821cs_init_xmit_priv(PADAPTER); -+void rtl8821cs_free_xmit_priv(PADAPTER); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+s32 rtl8821cs_hal_mgmt_xmit_enqueue(PADAPTER, struct xmit_frame *); -+#endif -+s32 rtl8821cs_hal_xmit_enqueue(PADAPTER, struct xmit_frame *); -+s32 rtl8821cs_hal_xmit(PADAPTER, struct xmit_frame *); -+s32 rtl8821cs_mgnt_xmit(PADAPTER, struct xmit_frame *); -+ -+s32 rtl8821cs_xmit_buf_handler(PADAPTER); -+thread_return rtl8821cs_xmit_thread(thread_context); -+ -+#endif /* _RTL8821CS_XMIT_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/halmac.mk b/drivers/net/wireless/rtl8821cs/halmac.mk -new file mode 100644 -index 000000000..16eebc1c1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/halmac.mk -@@ -0,0 +1,77 @@ -+# All needed files would be added to _HAL_INTFS_FILES, and it would include -+# hal/hal_halmac.c and all related files in directory hal/halmac/. -+# Before include this makefile, be sure interface (CONFIG_*_HCI) and IC -+# (CONFIG_RTL*) setting are all ready! -+ -+# Base directory -+path_hm := hal/halmac -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+pci := y -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+sdio := y -+endif -+ifeq ($(CONFIG_USB_HCI), y) -+usb := y -+endif -+ -+ifeq ($(CONFIG_RTL8822B), y) -+series := 88xx -+ic := 8822b -+endif -+ -+ifeq ($(CONFIG_RTL8822C), y) -+series := 88xx -+ic := 8822c -+endif -+ -+ifeq ($(CONFIG_RTL8821C), y) -+series := 88xx -+ic := 8821c -+endif -+ -+ifeq ($(CONFIG_RTL8814B), y) -+series := 88xx_v1 -+ic := 8814b -+endif -+ -+ifeq ($(series), 88xx_v1) -+d2all := -+else -+d2all := y -+endif -+ -+halmac-y += $(path_hm)/halmac_api.o -+halmac-y += $(path_hm)/halmac_dbg.o -+ -+# Level 1 directory -+path_hm_d1 := $(path_hm)/halmac_$(series) -+halmac-y += $(path_hm_d1)/halmac_bb_rf_$(series).o \ -+ $(path_hm_d1)/halmac_cfg_wmac_$(series).o \ -+ $(path_hm_d1)/halmac_common_$(series).o \ -+ $(path_hm_d1)/halmac_efuse_$(series).o \ -+ $(path_hm_d1)/halmac_flash_$(series).o \ -+ $(path_hm_d1)/halmac_fw_$(series).o \ -+ $(path_hm_d1)/halmac_gpio_$(series).o \ -+ $(path_hm_d1)/halmac_init_$(series).o \ -+ $(path_hm_d1)/halmac_mimo_$(series).o -+halmac-$(pci) += $(path_hm_d1)/halmac_pcie_$(series).o -+halmac-$(sdio) += $(path_hm_d1)/halmac_sdio_$(series).o -+halmac-$(usb) += $(path_hm_d1)/halmac_usb_$(series).o -+ -+# Level 2 directory -+path_hm_d2 := $(path_hm_d1)/halmac_$(ic) -+halmac-$(d2all) += $(path_hm_d2)/halmac_cfg_wmac_$(ic).o \ -+ $(path_hm_d2)/halmac_common_$(ic).o -+ -+halmac-y += $(path_hm_d2)/halmac_gpio_$(ic).o \ -+ $(path_hm_d2)/halmac_init_$(ic).o \ -+ $(path_hm_d2)/halmac_phy_$(ic).o \ -+ $(path_hm_d2)/halmac_pwr_seq_$(ic).o -+halmac-$(pci) += $(path_hm_d2)/halmac_pcie_$(ic).o -+halmac-$(sdio) += $(path_hm_d2)/halmac_sdio_$(ic).o -+halmac-$(usb) += $(path_hm_d2)/halmac_usb_$(ic).o -+ -+_HAL_INTFS_FILES += hal/hal_halmac.o -+_HAL_INTFS_FILES += $(halmac-y) -diff --git a/drivers/net/wireless/rtl8821cs/ifcfg-wlan0 b/drivers/net/wireless/rtl8821cs/ifcfg-wlan0 -new file mode 100644 -index 000000000..7ecb7ae62 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/ifcfg-wlan0 -@@ -0,0 +1,4 @@ -+#DHCP client -+DEVICE=wlan0 -+BOOTPROTO=dhcp -+ONBOOT=yes -\ No newline at end of file -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8188EPhyCfg.h b/drivers/net/wireless/rtl8821cs/include/Hal8188EPhyCfg.h -new file mode 100644 -index 000000000..38983f751 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8188EPhyCfg.h -@@ -0,0 +1,249 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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(PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask); -+void PHY_SetBBReg8188E(PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data); -+u32 PHY_QueryRFReg8188E(PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask); -+void PHY_SetRFReg8188E(PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data); -+ -+/* -+ * Initialization related function -+ */ -+/* MAC/BB/RF HAL config */ -+int PHY_MACConfig8188E(PADAPTER Adapter); -+int PHY_BBConfig8188E(PADAPTER Adapter); -+int PHY_RFConfig8188E(PADAPTER Adapter); -+ -+/* RF config */ -+int rtl8188e_PHY_ConfigRFWithParaFile( PADAPTER Adapter, u8 *pFileName, enum rf_path eRFPath); -+ -+/* -+ * RF Power setting -+ */ -+/* extern BOOLEAN PHY_SetRFPowerState(PADAPTER Adapter, -+ * RT_RF_POWER_STATE eRFPowerState); */ -+ -+/* -+ * BB TX Power R/W -+ * */ -+void PHY_SetTxPowerLevel8188E(PADAPTER Adapter, -+ u8 channel); -+ -+void -+PHY_SetTxPowerIndex_8188E( -+ PADAPTER Adapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+s8 phy_get_txpwr_target_extra_bias_8188e(_adapter *adapter, enum rf_path rfpath -+ , RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch); -+ -+/* -+ * Switch bandwidth for 8192S -+ */ -+/* extern void PHY_SetBWModeCallback8192C(PRT_TIMER pTimer ); */ -+void PHY_SetBWMode8188E(PADAPTER pAdapter, -+ enum channel_width ChnlWidth, -+ unsigned char Offset); -+ -+/* -+ * Set FW CMD IO for 8192S. -+ */ -+/* extern BOOLEAN HalSetIO8192C(PADAPTER Adapter, -+ * IO_TYPE IOType); */ -+ -+/* -+ * Set A2 entry to fw for 8192S -+ * */ -+extern void FillA2Entry8192C(PADAPTER Adapter, -+ u8 index, -+ u8 *val); -+ -+ -+/* -+ * channel switch related funciton -+ */ -+/* extern void PHY_SwChnlCallback8192C(PRT_TIMER pTimer ); */ -+void PHY_SwChnl8188E(PADAPTER pAdapter, -+ u8 channel); -+ -+void -+PHY_SetSwChnlBWMode8188E( -+ PADAPTER Adapter, -+ u8 channel, -+ enum channel_width Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+void -+PHY_SetRFEReg_8188E( -+ PADAPTER Adapter -+); -+/* -+ * BB/MAC/RF other monitor API -+ * */ -+void phy_set_rf_path_switch_8188e(struct dm_struct *phydm, bool bMain); -+ -+extern void -+PHY_SwitchEphyParameter( -+ PADAPTER Adapter -+); -+ -+extern void -+PHY_EnableHostClkReq( -+ PADAPTER Adapter -+); -+ -+BOOLEAN -+SetAntennaConfig92C( -+ PADAPTER Adapter, -+ 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( PADAPTER Adapter); -+#endif -+ -+ -+#endif /* __INC_HAL8192CPHYCFG_H */ -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8188EPhyReg.h b/drivers/net/wireless/rtl8821cs/include/Hal8188EPhyReg.h -new file mode 100644 -index 000000000..2eab8313a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8188EPhyReg.h -@@ -0,0 +1,1100 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8188EPwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8188EPwrSeq.h -new file mode 100644 -index 000000000..46c61abac ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8188EPwrSeq.h -@@ -0,0 +1,170 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8188FPhyCfg.h b/drivers/net/wireless/rtl8821cs/include/Hal8188FPhyCfg.h -new file mode 100644 -index 000000000..1bc60dc52 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8188FPhyCfg.h -@@ -0,0 +1,120 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetBBReg_8188F( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+); -+ -+u32 -+PHY_QueryRFReg_8188F( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetRFReg_8188F( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ 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( -+ PADAPTER Adapter, -+ u8 *pFileName, -+ enum rf_path eRFPath -+); -+ -+void -+PHY_SetTxPowerIndex_8188F( -+ PADAPTER Adapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+void -+PHY_SetTxPowerLevel8188F( -+ PADAPTER Adapter, -+ u8 channel -+); -+ -+void rtl8188f_set_txpwr_done(_adapter *adapter); -+ -+void -+PHY_SetSwChnlBWMode8188F( -+ PADAPTER Adapter, -+ u8 channel, -+ enum channel_width Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+void phy_set_rf_path_switch_8188f( -+ struct dm_struct *phydm, -+ bool bMain -+); -+ -+void BBTurnOnBlock_8188F(_adapter *adapter); -+ -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8188FPhyReg.h b/drivers/net/wireless/rtl8821cs/include/Hal8188FPhyReg.h -new file mode 100644 -index 000000000..a831faade ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8188FPhyReg.h -@@ -0,0 +1,1165 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8188FPwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8188FPwrSeq.h -new file mode 100644 -index 000000000..5cad428fd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8188FPwrSeq.h -@@ -0,0 +1,212 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8192EPhyCfg.h b/drivers/net/wireless/rtl8821cs/include/Hal8192EPhyCfg.h -new file mode 100644 -index 000000000..021d95335 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8192EPhyCfg.h -@@ -0,0 +1,136 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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(PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask); -+void PHY_SetBBReg8192E(PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data); -+u32 PHY_QueryRFReg8192E(PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask); -+void PHY_SetRFReg8192E(PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data); -+ -+/* -+ * Initialization related function -+ * -+ * MAC/BB/RF HAL config */ -+int PHY_MACConfig8192E(PADAPTER Adapter); -+int PHY_BBConfig8192E(PADAPTER Adapter); -+int PHY_RFConfig8192E(PADAPTER Adapter); -+ -+/* RF config */ -+ -+ -+/* -+ * BB TX Power R/W -+ * */ -+void PHY_SetTxPowerLevel8192E(PADAPTER Adapter, u8 channel); -+ -+void -+PHY_SetTxPowerIndex_8192E( -+ PADAPTER Adapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+/* -+ * channel switch related funciton -+ * */ -+void -+PHY_SetSwChnlBWMode8192E( -+ PADAPTER Adapter, -+ u8 channel, -+ enum channel_width Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+void -+PHY_SetRFEReg_8192E( -+ PADAPTER Adapter -+); -+ -+void -+phy_SpurCalibration_8192E( -+ PADAPTER Adapter, -+ enum spur_cal_method method -+); -+void PHY_SpurCalibration_8192E( PADAPTER Adapter); -+ -+#ifdef CONFIG_SPUR_CAL_NBI -+void -+phy_SpurCalibration_8192E_NBI( -+ PADAPTER Adapter -+); -+#endif -+/* -+ * BB/MAC/RF other monitor API -+ * */ -+ -+void -+phy_set_rf_path_switch_8192e( -+ struct dm_struct *phydm, -+ bool bMain -+); -+ -+/*--------------------------Exported Function prototype---------------------*/ -+#endif /* __INC_HAL8192CPHYCFG_H */ -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8192EPhyReg.h b/drivers/net/wireless/rtl8821cs/include/Hal8192EPhyReg.h -new file mode 100644 -index 000000000..30b771111 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8192EPhyReg.h -@@ -0,0 +1,1146 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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) 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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8192EPwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8192EPwrSeq.h -new file mode 100644 -index 000000000..1f2ba8722 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8192EPwrSeq.h -@@ -0,0 +1,169 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8192FPhyCfg.h b/drivers/net/wireless/rtl8821cs/include/Hal8192FPhyCfg.h -new file mode 100644 -index 000000000..dd9fdcc09 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8192FPhyCfg.h -@@ -0,0 +1,115 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HAL8192FPHYCFG_H__ -+#define __INC_HAL8192FPHYCFG_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_8192F( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetBBReg_8192F( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+); -+ -+u32 -+PHY_QueryRFReg_8192F( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetRFReg_8192F( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+); -+ -+/* MAC/BB/RF HAL config */ -+int PHY_BBConfig8192F(PADAPTER Adapter ); -+ -+int PHY_RFConfig8192F(PADAPTER Adapter); -+ -+s32 PHY_MACConfig8192F(PADAPTER padapter); -+ -+int -+PHY_ConfigRFWithParaFile_8192F( -+ PADAPTER Adapter, -+ u8 *pFileName, -+ enum rf_path eRFPath -+); -+ -+void -+PHY_SetTxPowerIndex_8192F( -+ PADAPTER Adapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+void -+PHY_SetTxPowerLevel8192F( -+ PADAPTER Adapter, -+ u8 channel -+); -+ -+void -+PHY_SetSwChnlBWMode8192F( -+ PADAPTER Adapter, -+ u8 channel, -+ enum channel_width Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+void phy_set_rf_path_switch_8192f( -+ PADAPTER pAdapter, -+ bool bMain -+); -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8192FPhyReg.h b/drivers/net/wireless/rtl8821cs/include/Hal8192FPhyReg.h -new file mode 100644 -index 000000000..b82f7f986 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8192FPhyReg.h -@@ -0,0 +1,1134 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HAL8192FPHYREG_H__ -+#define __INC_HAL8192FPHYREG_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_8192F(_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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8192FPwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8192FPwrSeq.h -new file mode 100644 -index 000000000..2b0bdc7e3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8192FPwrSeq.h -@@ -0,0 +1,220 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 REALTEK_POWER_SEQUENCE_8192F -+#define REALTEK_POWER_SEQUENCE_8192F -+#define POWER_SEQUENCE_8192F_VER 04 -+/* #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 RTL8192F_TRANS_CARDEMU_TO_ACT_STEPS 38 -+#define RTL8192F_TRANS_ACT_TO_CARDEMU_STEPS 8 -+#define RTL8192F_TRANS_CARDEMU_TO_SUS_STEPS 7 -+#define RTL8192F_TRANS_SUS_TO_CARDEMU_STEPS 5 -+#define RTL8192F_TRANS_CARDEMU_TO_CARDDIS_STEPS 8 -+#define RTL8192F_TRANS_CARDDIS_TO_CARDEMU_STEPS 8 -+#define RTL8192F_TRANS_CARDEMU_TO_PDN_STEPS 4 -+#define RTL8192F_TRANS_PDN_TO_CARDEMU_STEPS 1 -+#define RTL8192F_TRANS_ACT_TO_LPS_STEPS 13 -+#define RTL8192F_TRANS_LPS_TO_ACT_STEPS 11 -+#define RTL8192F_TRANS_END_STEPS 1 -+ -+ -+#define RTL8192F_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_POLLING, (BIT1|BIT0), 0}, \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2},/* SWR OCP enable 0x10[18]=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*/ \ -+ {0x007f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x7c[31]=1,LDO has max output capability*/ \ -+ {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, 0},/*Enable GPIO9 data 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*/\ -+ {0x0068, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0},/*RF HW ON/OFF Enable*/\ -+ {0x001C, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/*Register Lock Disable*/\ -+ {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*/\ -+ {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*/\ -+ {0x007B, 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*/\ -+ {0x007B, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x07},/*enalbe RF path S0*/\ -+ {0x0097, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*AFE_Ctrl*/\ -+ {0x00DC, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xCC},/*AFE_Ctrl*/\ -+ {0x0024, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x18, 0x00},/*AFE_Ctrl 0x24[4:3]=00 for xtal gmn*/\ -+ {0x1050, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*GPIO_A[7:0] Pull down software register*/\ -+ {0x1051, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*GPIO_A[15:8] Pull down software register*/\ -+ {0x1052, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*GPIO_A[23:16] Pull down software register*/\ -+ {0x1053, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*GPIO_A[31:24] Pull down software register*/\ -+ {0x105B, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*GPIO_B[7:0] Pull down software register*/\ -+ {0x001C, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/*Register Lock Enable*/\ -+ {0x0077, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT7|BIT6), 0x3},/*set HCI Power sequence state delay time:0*/ -+ -+ -+#define RTL8192F_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, BIT0, 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, 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*/ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x10[18] = 0 to disable ocp*/ \ -+ {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 RTL8192F_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_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 USB|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 RTL8192F_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 RTL8192F_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_USB_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*/ \ -+ {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*/ \ -+ {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 RTL8192F_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*/ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x10[18] = 1 to enable ocp*/ \ -+ {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 RTL8192F_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 RTL8192F_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 RTL8192F_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 RTL8192F_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 RTL8192F_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 rtl8192F_power_on_flow[RTL8192F_TRANS_CARDEMU_TO_ACT_STEPS+RTL8192F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192F_radio_off_flow[RTL8192F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192F_card_disable_flow[RTL8192F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192F_TRANS_CARDEMU_TO_CARDDIS_STEPS+RTL8192F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192F_card_enable_flow[RTL8192F_TRANS_CARDDIS_TO_CARDEMU_STEPS+RTL8192F_TRANS_CARDEMU_TO_ACT_STEPS+RTL8192F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192F_suspend_flow[RTL8192F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192F_TRANS_CARDEMU_TO_SUS_STEPS+RTL8192F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192F_resume_flow[RTL8192F_TRANS_SUS_TO_CARDEMU_STEPS+RTL8192F_TRANS_CARDEMU_TO_ACT_STEPS+RTL8192F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192F_hwpdn_flow[RTL8192F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192F_TRANS_CARDEMU_TO_PDN_STEPS+RTL8192F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192F_enter_lps_flow[RTL8192F_TRANS_ACT_TO_LPS_STEPS+RTL8192F_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8192F_leave_lps_flow[RTL8192F_TRANS_LPS_TO_ACT_STEPS+RTL8192F_TRANS_END_STEPS]; -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8703BPhyCfg.h b/drivers/net/wireless/rtl8821cs/include/Hal8703BPhyCfg.h -new file mode 100644 -index 000000000..57a421a03 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8703BPhyCfg.h -@@ -0,0 +1,116 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetBBReg_8703B( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+); -+ -+u32 -+PHY_QueryRFReg_8703B( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetRFReg_8703B( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ 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( -+ PADAPTER Adapter, -+ u8 *pFileName, -+ enum rf_path eRFPath -+); -+ -+void -+PHY_SetTxPowerIndex_8703B( -+ PADAPTER Adapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+void -+PHY_SetTxPowerLevel8703B( -+ PADAPTER Adapter, -+ u8 channel -+); -+ -+void -+PHY_SetSwChnlBWMode8703B( -+ PADAPTER Adapter, -+ u8 channel, -+ enum channel_width Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+void phy_set_rf_path_switch_8703b( -+ struct dm_struct *phydm, -+ bool bMain -+); -+ -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8703BPhyReg.h b/drivers/net/wireless/rtl8821cs/include/Hal8703BPhyReg.h -new file mode 100644 -index 000000000..881a13cfa ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8703BPhyReg.h -@@ -0,0 +1,1133 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8703BPwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8703BPwrSeq.h -new file mode 100644 -index 000000000..0dac13ee3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8703BPwrSeq.h -@@ -0,0 +1,198 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8710BPhyCfg.h b/drivers/net/wireless/rtl8821cs/include/Hal8710BPhyCfg.h -new file mode 100644 -index 000000000..3c5808e92 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8710BPhyCfg.h -@@ -0,0 +1,111 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HAL8710BPHYCFG_H__ -+#define __INC_HAL8710BPHYCFG_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_8710B( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetBBReg_8710B( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+); -+ -+u32 -+PHY_QueryRFReg_8710B( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetRFReg_8710B( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+); -+ -+/* MAC/BB/RF HAL config */ -+int PHY_BBConfig8710B(PADAPTER Adapter); -+ -+int PHY_RFConfig8710B(PADAPTER Adapter); -+ -+s32 PHY_MACConfig8710B(PADAPTER padapter); -+ -+int -+PHY_ConfigRFWithParaFile_8710B( -+ PADAPTER Adapter, -+ u8 *pFileName, -+ enum rf_path eRFPath -+); -+ -+void -+PHY_SetTxPowerIndex_8710B( -+ PADAPTER Adapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+void -+PHY_SetTxPowerLevel8710B( -+ PADAPTER Adapter, -+ u8 channel -+); -+ -+void -+PHY_SetSwChnlBWMode8710B( -+ PADAPTER Adapter, -+ u8 channel, -+ enum channel_width Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8710BPhyReg.h b/drivers/net/wireless/rtl8821cs/include/Hal8710BPhyReg.h -new file mode 100644 -index 000000000..337e03207 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8710BPhyReg.h -@@ -0,0 +1,1134 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_HAL8710BPHYREG_H__ -+#define __INC_HAL8710BPHYREG_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_8710B(_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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8710BPwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8710BPwrSeq.h -new file mode 100644 -index 000000000..31ad29c79 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8710BPwrSeq.h -@@ -0,0 +1,167 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 REALTEK_POWER_SEQUENCE_8710B -+#define REALTEK_POWER_SEQUENCE_8710B -+ -+/* #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 RTL8710B_TRANS_CARDEMU_TO_ACT_STEPS 5 -+#define RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS 4 -+#define RTL8710B_TRANS_CARDEMU_TO_SUS_STEPS 7 -+#define RTL8710B_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8710B_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8710B_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8710B_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8710B_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8710B_TRANS_ACT_TO_SWLPS_STEPS 22 -+#define RTL8710B_TRANS_SWLPS_TO_ACT_STEPS 15 -+#define RTL8710B_TRANS_END_STEPS 1 -+ -+ -+#define RTL8710B_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x005D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*AFE power mode selection:1: LDO mode ,0: Power-cut mode*/\ -+ {0x0004, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1},\ -+ {0x0056, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x0E},\ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1},\ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ -+ -+ -+#define RTL8710B_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*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT0|BIT1|BIT2), 0},/*0x04[24:26] = 0 turn off RF*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT0|BIT1), 0},/*0x04[16:17] = 0 BB reset*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x20[1] = 1 turn off MAC by HW state machine*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x20[1] = 0 polling until return 0 to disable*/ \ -+ -+ -+#define RTL8710B_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 RTL8710B_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 RTL8710B_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ -+#define RTL8710B_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ -+ -+#define RTL8710B_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 RTL8710B_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 RTL8710B_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 RTL8710B_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 RTL8710B_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 rtl8710B_power_on_flow[RTL8710B_TRANS_CARDEMU_TO_ACT_STEPS+RTL8710B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8710B_radio_off_flow[RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8710B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8710B_card_disable_flow[RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8710B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8710B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8710B_card_enable_flow[RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8710B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8710B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8710B_suspend_flow[RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8710B_TRANS_CARDEMU_TO_SUS_STEPS+RTL8710B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8710B_resume_flow[RTL8710B_TRANS_SUS_TO_CARDEMU_STEPS+RTL8710B_TRANS_CARDEMU_TO_ACT_STEPS+RTL8710B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8710B_hwpdn_flow[RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8710B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8710B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8710B_enter_lps_flow[RTL8710B_TRANS_ACT_TO_LPS_STEPS+RTL8710B_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8710B_leave_lps_flow[RTL8710B_TRANS_LPS_TO_ACT_STEPS+RTL8710B_TRANS_END_STEPS]; -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8723BPhyCfg.h b/drivers/net/wireless/rtl8821cs/include/Hal8723BPhyCfg.h -new file mode 100644 -index 000000000..0f59b8b24 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8723BPhyCfg.h -@@ -0,0 +1,116 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetBBReg_8723B( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+); -+ -+u32 -+PHY_QueryRFReg_8723B( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetRFReg_8723B( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ 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( -+ PADAPTER Adapter, -+ u8 *pFileName, -+ enum rf_path eRFPath -+); -+ -+void -+PHY_SetTxPowerIndex_8723B( -+ PADAPTER Adapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+void -+PHY_SetTxPowerLevel8723B( -+ PADAPTER Adapter, -+ u8 channel -+); -+ -+void -+PHY_SetSwChnlBWMode8723B( -+ PADAPTER Adapter, -+ u8 channel, -+ enum channel_width Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+void phy_set_rf_path_switch_8723b( -+ struct dm_struct *phydm, -+ bool bMain -+); -+ -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8723BPhyReg.h b/drivers/net/wireless/rtl8821cs/include/Hal8723BPhyReg.h -new file mode 100644 -index 000000000..ce485c2ab ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8723BPhyReg.h -@@ -0,0 +1,1131 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8723BPwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8723BPwrSeq.h -new file mode 100644 -index 000000000..1aec885cb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8723BPwrSeq.h -@@ -0,0 +1,246 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8723DPhyCfg.h b/drivers/net/wireless/rtl8821cs/include/Hal8723DPhyCfg.h -new file mode 100644 -index 000000000..b89243551 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8723DPhyCfg.h -@@ -0,0 +1,115 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetBBReg_8723D( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+); -+ -+u32 -+PHY_QueryRFReg_8723D( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask -+); -+ -+void -+PHY_SetRFReg_8723D( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ 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( -+ PADAPTER Adapter, -+ u8 *pFileName, -+ enum rf_path eRFPath -+); -+ -+void -+PHY_SetTxPowerIndex_8723D( -+ PADAPTER Adapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+void -+PHY_SetTxPowerLevel8723D( -+ PADAPTER Adapter, -+ u8 channel -+); -+ -+void -+PHY_SetSwChnlBWMode8723D( -+ PADAPTER Adapter, -+ u8 channel, -+ enum channel_width Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+void phy_set_rf_path_switch_8723d( -+ struct dm_struct *phydm, -+ bool bMain -+); -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8723DPhyReg.h b/drivers/net/wireless/rtl8821cs/include/Hal8723DPhyReg.h -new file mode 100644 -index 000000000..036144a38 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8723DPhyReg.h -@@ -0,0 +1,1134 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8723DPwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8723DPwrSeq.h -new file mode 100644 -index 000000000..60cb53b27 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8723DPwrSeq.h -@@ -0,0 +1,206 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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*/ \ -+ {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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8723PwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8723PwrSeq.h -new file mode 100644 -index 000000000..22de83375 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8723PwrSeq.h -@@ -0,0 +1,183 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8812PhyCfg.h b/drivers/net/wireless/rtl8821cs/include/Hal8812PhyCfg.h -new file mode 100644 -index 000000000..69c70d30e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8812PhyCfg.h -@@ -0,0 +1,134 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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(PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask); -+void PHY_SetBBReg8812(PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data); -+u32 PHY_QueryRFReg8812(PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask); -+void PHY_SetRFReg8812(PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data); -+ -+/* -+ * Initialization related function -+ * -+ * MAC/BB/RF HAL config */ -+int PHY_MACConfig8812(PADAPTER Adapter); -+int PHY_BBConfig8812(PADAPTER Adapter); -+void PHY_BB8812_Config_1T(PADAPTER Adapter); -+int PHY_RFConfig8812(PADAPTER Adapter); -+ -+/* RF config */ -+ -+s32 -+PHY_SwitchWirelessBand8812( -+ PADAPTER Adapter, -+ u8 Band -+); -+ -+/* -+ * BB TX Power R/W -+ * */ -+void PHY_SetTxPowerLevel8812(PADAPTER Adapter, u8 Channel); -+ -+bool phy_get_txpwr_target_skip_by_rate_8812a(_adapter *adapter, enum MGN_RATE rate); -+ -+u32 phy_get_tx_bb_swing_8812a( -+ PADAPTER Adapter, -+ BAND_TYPE Band, -+ enum rf_path RFPath -+); -+ -+void -+PHY_SetTxPowerIndex_8812A( -+ PADAPTER Adapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+/* -+ * channel switch related funciton -+ * */ -+void -+PHY_SetSwChnlBWMode8812( -+ PADAPTER Adapter, -+ u8 channel, -+ enum channel_width Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+/* -+ * BB/MAC/RF other monitor API -+ * */ -+ -+void -+phy_set_rf_path_switch_8812a( -+ struct dm_struct *phydm, -+ bool bMain -+); -+ -+/*--------------------------Exported Function prototype---------------------*/ -+#endif /* __INC_HAL8192CPHYCFG_H */ -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8812PhyReg.h b/drivers/net/wireless/rtl8821cs/include/Hal8812PhyReg.h -new file mode 100644 -index 000000000..521ebb202 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8812PhyReg.h -@@ -0,0 +1,735 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ -+#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8812PwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8812PwrSeq.h -new file mode 100644 -index 000000000..498faf811 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8812PwrSeq.h -@@ -0,0 +1,208 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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},/**/ \ -+ {0x0024, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* 0x24[1] Choose the type of buffer after xosc: nand*/ \ -+ {0x0028, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0}, /* 0x28[33] Choose the type of buffer after xosc: nand*/ -+ -+#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*/ \ -+ {0x0024, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /* 0x24[1] Choose the type of buffer after xosc: schmitt trigger*/ \ -+ {0x0028, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /* 0x28[33] Choose the type of buffer after xosc: schmitt trigger*/ -+ -+ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8814PhyCfg.h b/drivers/net/wireless/rtl8821cs/include/Hal8814PhyCfg.h -new file mode 100644 -index 000000000..0fdc34077 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8814PhyCfg.h -@@ -0,0 +1,236 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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(PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask); -+ -+ -+void -+PHY_SetBBReg8814A(PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data); -+ -+ -+extern u32 -+PHY_QueryRFReg8814A(PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask); -+ -+ -+void -+PHY_SetRFReg8814A(PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data); -+ -+/* 1 3. Initial BB/RF config by reading MAC/BB/RF txt. */ -+s32 -+phy_BB8814A_Config_ParaFile( -+ PADAPTER Adapter -+); -+ -+void -+PHY_ConfigBB_8814A( -+ PADAPTER Adapter -+); -+ -+ -+void -+phy_ADC_CLK_8814A( -+ PADAPTER Adapter -+); -+ -+s32 -+PHY_RFConfig8814A( -+ PADAPTER Adapter -+); -+ -+/* -+ * RF Power setting -+ * -+ * BOOLEAN PHY_SetRFPowerState8814A(PADAPTER Adapter, rt_rf_power_state eRFPowerState); */ -+ -+/* 1 5. Tx Power setting API */ -+ -+void -+PHY_SetTxPowerLevel8814( -+ PADAPTER Adapter, -+ u8 Channel -+); -+ -+u8 -+phy_get_tx_power_index_8814a( -+ PADAPTER Adapter, -+ enum rf_path RFPath, -+ u8 Rate, -+ enum channel_width BandWidth, -+ u8 Channel -+); -+ -+void -+PHY_SetTxPowerIndex_8814A( -+ PADAPTER Adapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+u32 -+PHY_GetTxBBSwing_8814A( -+ PADAPTER Adapter, -+ BAND_TYPE Band, -+ enum rf_path RFPath -+); -+ -+ -+ -+/* 1 6. Channel setting API */ -+#if 0 -+void -+PHY_SwChnlTimerCallback8814A( -+ struct timer_list *p_timer -+); -+#endif -+void -+PHY_SwChnlWorkItemCallback8814A( -+ void *pContext -+); -+ -+ -+void -+HAL_HandleSwChnl8814A( -+ PADAPTER pAdapter, -+ u8 channel -+); -+ -+void -+PHY_SwChnlSynchronously8814A(PADAPTER pAdapter, -+ u8 channel); -+ -+void -+PHY_HandleSwChnlAndSetBW8814A( -+ PADAPTER Adapter, -+ BOOLEAN bSwitchChannel, -+ BOOLEAN bSetBandWidth, -+ u8 ChannelNum, -+ enum channel_width ChnlWidth, -+ u8 ChnlOffsetOf40MHz, -+ u8 ChnlOffsetOf80MHz, -+ u8 CenterFrequencyIndex1 -+); -+ -+ -+BOOLEAN -+PHY_QueryRFPathSwitch_8814A(PADAPTER pAdapter); -+ -+ -+ -+#if (USE_WORKITEM) -+void -+RtCheckForHangWorkItemCallback8814A( -+ void *pContext -+); -+#endif -+ -+BOOLEAN -+SetAntennaConfig8814A( -+ PADAPTER Adapter, -+ u8 DefaultAnt -+); -+ -+void -+PHY_SetRFEReg8814A( -+ PADAPTER Adapter, -+ BOOLEAN bInit, -+ u8 Band -+); -+ -+ -+s32 -+PHY_SwitchWirelessBand8814A( -+ PADAPTER Adapter, -+ u8 Band -+); -+ -+void -+PHY_SetIO_8814A( -+ PADAPTER pAdapter -+); -+ -+void -+PHY_SetSwChnlBWMode8814( -+ PADAPTER Adapter, -+ u8 channel, -+ enum channel_width Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+s32 PHY_MACConfig8814(PADAPTER Adapter); -+int PHY_BBConfig8814(PADAPTER Adapter); -+void PHY_Set_SecCCATH_by_RXANT_8814A(PADAPTER pAdapter, u32 ulAntennaRx); -+ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+#endif /* __INC_HAL8192CPHYCFG_H */ -diff --git a/drivers/net/wireless/rtl8821cs/include/Hal8814PhyReg.h b/drivers/net/wireless/rtl8821cs/include/Hal8814PhyReg.h -new file mode 100644 -index 000000000..21851a898 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8814PhyReg.h -@@ -0,0 +1,863 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ -+#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8814PwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8814PwrSeq.h -new file mode 100644 -index 000000000..0138850c9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8814PwrSeq.h -@@ -0,0 +1,231 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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, (u8)(~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, (u8)(~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, (u8)(~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, (u8)(~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, (u8)(~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, (u8)(~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, (u8)(~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 --git a/drivers/net/wireless/rtl8821cs/include/Hal8821APwrSeq.h b/drivers/net/wireless/rtl8821cs/include/Hal8821APwrSeq.h -new file mode 100644 -index 000000000..568b8e5fc ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/Hal8821APwrSeq.h -@@ -0,0 +1,200 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/include/HalPwrSeqCmd.h b/drivers/net/wireless/rtl8821cs/include/HalPwrSeqCmd.h -new file mode 100644 -index 000000000..f67ed22d1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/HalPwrSeqCmd.h -@@ -0,0 +1,130 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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( -+ PADAPTER padapter, -+ u8 CutVersion, -+ u8 FabVersion, -+ u8 InterfaceType, -+ WLAN_PWR_CFG PwrCfgCmd[]); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/HalVerDef.h b/drivers/net/wireless/rtl8821cs/include/HalVerDef.h -new file mode 100644 -index 000000000..d4e40670a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/HalVerDef.h -@@ -0,0 +1,209 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+#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, -+ CHIP_8710B = 16, -+ CHIP_8192F = 17, -+ CHIP_8188GTV = 18, -+ CHIP_8822C = 19, -+ CHIP_8814B = 20, -+ CHIP_8723F = 21, -+} 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_8188GTV(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188GTV) ? 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) -+#define IS_8710B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8710B) ? TRUE : FALSE) -+#define IS_8822C_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8822C) ? TRUE : FALSE) -+#define IS_8814B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8814B) ? TRUE : FALSE) -+#define IS_8723F_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723F) ? TRUE : FALSE) -+ -+#define IS_8192F_SERIES(version)\ -+ ((GET_CVID_IC_TYPE(version) == CHIP_8192F) ? 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_2T3R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_2T3R) ? TRUE : FALSE) -+#define IS_2T4R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_2T4R) ? 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)->version_id)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->version_id) >= I_CUT_VERSION) ? TRUE : FALSE) : FALSE) -+#define IS_VENDOR_8812A_TEST_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8812A_MP_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? TRUE : FALSE) : FALSE) -+#define IS_VENDOR_8812A_C_CUT(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->version_id) == C_CUT_VERSION) ? TRUE : FALSE) : FALSE) -+ -+#define IS_VENDOR_8821A_TEST_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8821A_MP_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? TRUE : FALSE) : FALSE) -+ -+#define IS_VENDOR_8192E_B_CUT(_Adapter) ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->version_id) == B_CUT_VERSION) ? TRUE : FALSE) -+ -+#define IS_VENDOR_8723B_TEST_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8723B_MP_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? TRUE : FALSE) : FALSE) -+ -+#define IS_VENDOR_8703B_TEST_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8703B_MP_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? TRUE : FALSE) : FALSE) -+#define IS_VENDOR_8814A_TEST_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8814A_MP_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? TRUE : FALSE) : FALSE) -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/autoconf.h b/drivers/net/wireless/rtl8821cs/include/autoconf.h -new file mode 100644 -index 000000000..e82be6a69 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/autoconf.h -@@ -0,0 +1,313 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 debug */ -+/*#define CONFIG_DISABLE_ODM*/ -+/*#define CONFIG_NO_FW*/ -+#define CONFIG_IQK_MONITOR -+#define DBG_C2H_MAC_HIDDEN_RPT_HANDLE 1 -+#define DBG_H2C_CONTENT -+ -+#ifndef DBG_MEM_ALLOC -+#define DBG_MEM_ALLOC -+#endif -+ -+/*#define DBG_XMIT_BLOCK*/ -+ -+/*#define DBG_RX_COUNTER_DUMP*/ -+#define CONFIG_ERROR_STATE_MONITOR -+/*#define CONFIG_MONITOR_OVERFLOW*/ -+ -+#define CONFIG_SDIO_INDIRECT_ACCESS -+#define DBG_SDIO_INDIRECT_ACCESS -+ -+/*#define CONFIG_SUPPORT_TRX_SHARED*/ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+#define DFT_TRX_SHARE_MODE 0 /*default trx share mode,mode could be 0 or 1*/ -+#endif -+#define CONFIG_IO_CHECK_IN_ANA_LOW_CLK -+ -+/* -+ * Public General Config -+ */ -+#define AUTOCONF_INCLUDED -+ -+#define RTL871X_MODULE_NAME "8821CS" -+#define DRV_NAME "rtl8821cs" -+ -+/* Set CONFIG_RTL8821C from Makefile */ -+#ifndef CONFIG_RTL8821C -+#define CONFIG_RTL8821C -+#endif -+#define CONFIG_SDIO_HCI -+#define PLATFORM_LINUX -+ -+ -+/* -+ * Wi-Fi Functions Config -+ */ -+ -+#define CONFIG_RECV_REORDERING_CTRL -+ -+#define CONFIG_80211N_HT -+#define CONFIG_80211AC_VHT -+#ifdef CONFIG_80211AC_VHT -+ #ifndef CONFIG_80211N_HT -+ #define CONFIG_80211N_HT -+ #endif -+#endif -+ -+/* Set CONFIG_IOCTL_CFG80211 from Makefile */ -+#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! -+ */ -+ /* Set RTW_USE_CFG80211_STA_EVENT from Makefile */ -+ #define CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER -+ /* #define CONFIG_DEBUG_CFG80211 */ -+ #define CONFIG_SET_SCAN_DENY_TIMER -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+#ifdef CONFIG_AP_MODE -+ #define CONFIG_INTERRUPT_BASED_TXBCN /* Tx Beacon when driver receive related interrupt*/ -+ #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 */ -+ #endif -+ #define CONFIG_NATIVEAP_MLME -+ #ifndef CONFIG_NATIVEAP_MLME -+ #define CONFIG_HOSTAPD_MLME -+ #endif -+ /*#define CONFIG_FIND_BEST_CHANNEL*/ -+#endif -+ -+#ifdef CONFIG_P2P -+ #define CONFIG_WFD /* Wi-Fi display */ -+ #define CONFIG_P2P_REMOVE_GROUP_INFO -+ /*#define CONFIG_DBG_P2P*/ -+ #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 /* CONFIG_P2P */ -+ -+/* Set CONFIG_TDLS from Makefile */ -+#ifdef CONFIG_TDLS -+ #define CONFIG_TDLS_DRIVER_SETUP -+/* #ifndef CONFIG_WFD -+ #define CONFIG_WFD -+ #endif*/ -+/* #define CONFIG_TDLS_AUTOSETUP*/ -+ #define CONFIG_TDLS_AUTOCHECKALIVE -+ /* -+ * Enable "CONFIG_TDLS_CH_SW" by default, -+ * however limit it to only work in wifi logo test mode -+ * but not in normal mode currently -+ */ -+ #define CONFIG_TDLS_CH_SW -+#endif /* CONFIG_TDLS */ -+ -+ -+/*#define CONFIG_RTW_80211K*/ -+ -+/* -+ * Hareware/Firmware Related Config -+ */ -+/* Set CONFIG_BT_COEXIST from Makefile */ -+/* Set CONFIG_ANTENNA_DIVERSITY from Makefile */ -+/*#define SUPPORT_HW_RFOFF_DETECTED*/ -+ -+/*#define CONFIG_RTW_LED*/ -+#ifdef CONFIG_RTW_LED -+ /*#define CONFIG_RTW_SW_LED*/ -+#endif /* CONFIG_RTW_LED */ -+#define CONFIG_XMIT_ACK -+#ifdef CONFIG_XMIT_ACK -+ #define CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#endif -+ -+#define DISABLE_BB_RF 0 -+#define RTW_NOTCH_FILTER 0 /* 0:Disable, 1:Enable */ -+ -+ -+/* -+ * Software feature Related Config -+ */ -+#define RTW_HALMAC /* Use HALMAC architecture, necessary for 8821C */ -+ -+ -+/* -+ * Interface Related Config -+ */ -+#define CONFIG_TX_AGGREGATION -+#define CONFIG_XMIT_THREAD_MODE /* necessary for SDIO */ -+/*#define CONFIG_SDIO_TX_ENABLE_AVAL_INT => Related MAC reg must setting => HAL-MAC ?? */ -+#define CONFIG_SDIO_RX_COPY -+ -+#define CONFIG_RECV_THREAD_MODE -+#ifdef CONFIG_RECV_THREAD_MODE -+#define RTW_RECV_THREAD_HIGH_PRIORITY -+#endif/*CONFIG_RECV_THREAD_MODE*/ -+ -+#ifdef CONFIG_RTW_NAPI -+#define CONFIG_RTW_NAPI_DYNAMIC -+#define CONFIG_RTW_NAPI_V2 -+#endif -+ -+/*#define CONFIG_BEAMFORMING*/ -+ -+#define CONFIG_REDUCE_TX_CPU_LOADING -+ -+/* -+ * Others -+ */ -+/*#define CONFIG_MAC_LOOPBACK_DRIVER*/ -+#define CONFIG_SKB_COPY /* for amsdu */ -+#define CONFIG_NEW_SIGNAL_STAT_PROCESS -+#define CONFIG_EMBEDDED_FWIMG -+/*#define CONFIG_FILE_FWIMG*/ -+#define CONFIG_LONG_DELAY_ISSUE -+/*#define CONFIG_PATCH_JOIN_WRONG_CHANNEL*/ -+#define CONFIG_RX_PACKET_APPEND_FCS -+ -+ -+/* -+ * Platform -+ */ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+#ifdef CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER -+#undef CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER -+#endif -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ -+ -+/* -+ * 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 /* CONFIG_MAC_LOOPBACK_DRIVER */ -+ -+#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 -+ #define CONFIG_CHECK_LEAVE_LPS -+ #define CONFIG_LPS_CHK_BY_TP -+ #ifdef CONFIG_LPS_CHK_BY_TP -+ #define LPS_TX_TP_TH 12 /*Mbps*/ -+ #define LPS_RX_TP_TH 12 /*Mbps*/ -+ #define LPS_BI_TP_TH 12 /*Mbps*//*TX + RX*/ -+ #define LPS_TP_CHK_CNT 5 /*10s*/ -+ #define LPS_CHK_PKTS_TX 100 -+ #define LPS_CHK_PKTS_RX 100 -+ #endif -+ #endif -+ -+ #ifdef CONFIG_LPS_LCLK -+ /*#define CONFIG_DETECT_CPWM_BY_POLLING*/ -+ #define CONFIG_LPS_RPWM_TIMER -+ #if defined(CONFIG_LPS_RPWM_TIMER) || defined(CONFIG_DETECT_CPWM_BY_POLLING) -+ #define LPS_RPWM_WAIT_MS 300 -+ #endif -+ #define CONFIG_LPS_LCLK_WD_TIMER /* Watch Dog timer in LPS LCLK */ -+ /*#define CONFIG_LPS_PG*/ -+ #endif -+ -+ #ifdef CONFIG_IPS -+ #define CONFIG_IPS_CHECK_IN_WD /* Do IPS Check in WatchDog. */ -+ /*#define CONFIG_FWLPS_IN_IPS*/ /* issue H2C command to let FW do LPS when entering IPS */ -+ #endif -+ -+ #ifdef CONFIG_LPS -+ #define CONFIG_WMMPS_STA 1 -+ #endif /* CONFIG_LPS */ -+#endif /* CONFIG_POWER_SAVING */ -+ -+#ifdef CONFIG_BT_COEXIST -+ /* necessary for PHYDM and BT-Coex */ -+ #define BT_30_SUPPORT 1 -+ -+ #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_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 10 /* WIFI Chip Side */ -+ #endif /*!WAKEUP_GPIO_IDX*/ -+#endif /* CONFIG_GPIO_WAKEUP */ -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+#define CONFIG_HW_ANTENNA_DIVERSITY -+#endif /* CONFIG_ANTENNA_DIVERSITY */ -+ -+#ifdef CONFIG_PLATFORM_RTK129X -+ #ifdef CONFIG_REDUCE_TX_CPU_LOADING -+ #undef CONFIG_REDUCE_TX_CPU_LOADING -+ #endif -+#endif -+ -+/* -+ * Debug Related Config -+ */ -+#ifdef CONFIG_RTW_DEBUG -+ #define DBG 1 /* for ODM & BTCOEX debug */ -+#else /* !CONFIG_RTW_DEBUG */ -+ #define DBG 0 /* for ODM & BTCOEX debug */ -+#endif /* CONFIG_RTW_DEBUG */ -+ -+#define DBG_CONFIG_ERROR_DETECT -+/*#define DBG_XMIT_BUF*/ -+/*#define DBG_XMIT_BUF_EXT*/ -+/*#define CONFIG_FW_C2H_DEBUG*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/basic_types.h b/drivers/net/wireless/rtl8821cs/include/basic_types.h -new file mode 100644 -index 000000000..45e513156 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/basic_types.h -@@ -0,0 +1,357 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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) -+ -+#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 -+ -+ typedef signed int sint; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 19)) -+typedef _Bool bool; -+ -+enum { -+ false = 0, -+ true = 1 -+}; -+#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) -+ -+#define NDIS_OID uint -+#endif /*PLATFORM_LINUX*/ -+ -+ -+#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; -+ -+ typedef u32 dma_addr_t; -+ -+ 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 --git a/drivers/net/wireless/rtl8821cs/include/byteorder/big_endian.h b/drivers/net/wireless/rtl8821cs/include/byteorder/big_endian.h -new file mode 100644 -index 000000000..6b1dc449e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/byteorder/big_endian.h -@@ -0,0 +1,82 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/byteorder/generic.h b/drivers/net/wireless/rtl8821cs/include/byteorder/generic.h -new file mode 100644 -index 000000000..f85114bf7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/byteorder/generic.h -@@ -0,0 +1,207 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/byteorder/little_endian.h b/drivers/net/wireless/rtl8821cs/include/byteorder/little_endian.h -new file mode 100644 -index 000000000..c4b64512f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/byteorder/little_endian.h -@@ -0,0 +1,84 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/byteorder/swab.h b/drivers/net/wireless/rtl8821cs/include/byteorder/swab.h -new file mode 100644 -index 000000000..a8dd46bd3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/byteorder/swab.h -@@ -0,0 +1,136 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/byteorder/swabb.h b/drivers/net/wireless/rtl8821cs/include/byteorder/swabb.h -new file mode 100644 -index 000000000..634519a0b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/byteorder/swabb.h -@@ -0,0 +1,151 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/circ_buf.h b/drivers/net/wireless/rtl8821cs/include/circ_buf.h -new file mode 100644 -index 000000000..7a5b8ef1a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/circ_buf.h -@@ -0,0 +1,23 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 --git a/drivers/net/wireless/rtl8821cs/include/cmd_osdep.h b/drivers/net/wireless/rtl8821cs/include/cmd_osdep.h -new file mode 100644 -index 000000000..e4ba2b6d3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/cmd_osdep.h -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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(_queue *queue, struct cmd_obj *obj, bool to_head); -+extern struct cmd_obj *_rtw_dequeue_cmd(_queue *queue); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/cmn_info/rtw_sta_info.h b/drivers/net/wireless/rtl8821cs/include/cmn_info/rtw_sta_info.h -new file mode 100644 -index 000000000..d4de0e50b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/cmn_info/rtw_sta_info.h -@@ -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. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ /*This header file is for all driver teams to use the same station info. -+If you want to change this file please make sure notify all driver teams maintainers.*/ -+ -+/*Created by YuChen 20170301*/ -+ -+#ifndef __INC_RTW_STA_INFO_H -+#define __INC_RTW_STA_INFO_H -+ -+/*--------------------Define ---------------------------------------*/ -+ -+#define STA_DM_CTRL_ACTIVE BIT(0) -+#define STA_DM_CTRL_CFO_TRACKING BIT(1) -+ -+#ifdef CONFIG_BEAMFORMING -+#define BEAMFORMING_HT_BEAMFORMER_ENABLE BIT(0) /*Declare sta support beamformer*/ -+#define BEAMFORMING_HT_BEAMFORMEE_ENABLE BIT(1) /*Declare sta support beamformee*/ -+#define BEAMFORMING_HT_BEAMFORMER_TEST BIT(2) /*Transmiting Beamforming no matter the target supports it or not*/ -+#define BEAMFORMING_HT_BEAMFORMER_STEER_NUM (BIT(4)|BIT(5)) /*Sta Bfer's capability*/ -+#define BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP (BIT(6)|BIT(7)) /*Sta BFee's capability*/ -+ -+#define BEAMFORMING_VHT_BEAMFORMER_ENABLE BIT(0) /*Declare sta support beamformer*/ -+#define BEAMFORMING_VHT_BEAMFORMEE_ENABLE BIT(1) /*Declare sta support beamformee*/ -+#define BEAMFORMING_VHT_MU_MIMO_AP_ENABLE BIT(2) /*Declare sta support MU beamformer*/ -+#define BEAMFORMING_VHT_MU_MIMO_STA_ENABLE BIT(3) /*Declare sta support MU beamformer*/ -+#define BEAMFORMING_VHT_BEAMFORMER_TEST BIT(4) /*Transmiting Beamforming no matter the target supports it or not*/ -+#define BEAMFORMING_VHT_BEAMFORMER_STS_CAP (BIT(8)|BIT(9)|BIT(10)) /*Sta BFee's capability*/ -+#define BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM (BIT(12)|BIT(13)|BIT(14)) /*Sta Bfer's capability*/ -+#endif -+ -+#define HT_STBC_EN BIT(0) -+#define VHT_STBC_EN BIT(1) -+ -+#define HT_LDPC_EN BIT(0) -+#define VHT_LDPC_EN BIT(1) -+ -+#define SM_PS_STATIC 0 -+#define SM_PS_DYNAMIC 1 -+#define SM_PS_INVALID 2 -+#define SM_PS_DISABLE 3 -+ -+ -+/*cmn_sta_info.ra_sta_info.txrx_state*/ -+#define TX_STATE 0 -+#define RX_STATE 1 -+#define BI_DIRECTION_STATE 2 -+ -+/*--------------------Define Enum-----------------------------------*/ -+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_5 = 5, -+ CHANNEL_WIDTH_10 = 6, -+ CHANNEL_WIDTH_MAX = 7, -+}; -+ -+enum rf_type { -+ RF_1T1R = 0, -+ RF_1T2R = 1, -+ RF_2T2R = 2, -+ RF_2T3R = 3, -+ RF_2T4R = 4, -+ RF_3T3R = 5, -+ RF_3T4R = 6, -+ RF_4T4R = 7, -+ RF_4T3R = 8, -+ RF_4T2R = 9, -+ RF_4T1R = 10, -+ RF_3T2R = 11, -+ RF_3T1R = 12, -+ RF_2T1R = 13, -+ RF_1T4R = 14, -+ RF_1T3R = 15, -+ RF_TYPE_MAX, -+}; -+ -+enum bb_path { -+ BB_PATH_NON = 0, -+ BB_PATH_A = 0x00000001, -+ BB_PATH_B = 0x00000002, -+ BB_PATH_C = 0x00000004, -+ BB_PATH_D = 0x00000008, -+ -+ BB_PATH_AB = (BB_PATH_A | BB_PATH_B), -+ BB_PATH_AC = (BB_PATH_A | BB_PATH_C), -+ BB_PATH_AD = (BB_PATH_A | BB_PATH_D), -+ BB_PATH_BC = (BB_PATH_B | BB_PATH_C), -+ BB_PATH_BD = (BB_PATH_B | BB_PATH_D), -+ BB_PATH_CD = (BB_PATH_C | BB_PATH_D), -+ -+ BB_PATH_ABC = (BB_PATH_A | BB_PATH_B | BB_PATH_C), -+ BB_PATH_ABD = (BB_PATH_A | BB_PATH_B | BB_PATH_D), -+ BB_PATH_ACD = (BB_PATH_A | BB_PATH_C | BB_PATH_D), -+ BB_PATH_BCD = (BB_PATH_B | BB_PATH_C | BB_PATH_D), -+ -+ BB_PATH_ABCD = (BB_PATH_A | BB_PATH_B | BB_PATH_C | BB_PATH_D), -+ BB_PATH_AUTO = 0xff /*for path diversity*/ -+}; -+ -+enum rf_path { -+ RF_PATH_A = 0, -+ RF_PATH_B = 1, -+ RF_PATH_C = 2, -+ RF_PATH_D = 3, -+ RF_PATH_AB, -+ RF_PATH_AC, -+ RF_PATH_AD, -+ RF_PATH_BC, -+ RF_PATH_BD, -+ RF_PATH_CD, -+ RF_PATH_ABC, -+ RF_PATH_ABD, -+ RF_PATH_ACD, -+ RF_PATH_BCD, -+ RF_PATH_ABCD, -+}; -+ -+enum rf_syn { -+ RF_SYN0 = 0, -+ RF_SYN1 = 1, -+}; -+ -+enum rfc_mode { -+ rfc_4x4 = 0, -+ rfc_2x2 = 1, -+}; -+ -+enum wireless_set { -+ WIRELESS_CCK = 0x00000001, -+ WIRELESS_OFDM = 0x00000002, -+ WIRELESS_HT = 0x00000004, -+ WIRELESS_VHT = 0x00000008, -+}; -+ -+/*--------------------Define MACRO---------------------------------*/ -+ -+/*--------------------Define Struct-----------------------------------*/ -+ -+#ifdef CONFIG_BEAMFORMING -+struct bf_cmn_info { -+ u8 ht_beamform_cap; /*Sta capablity*/ -+ u16 vht_beamform_cap; /*Sta capablity*/ -+ u16 p_aid; -+ u8 g_id; -+}; -+#endif -+struct rssi_info { -+ s8 rssi; -+ s8 rssi_cck; -+ s8 rssi_ofdm; -+ u8 packet_map; -+ u8 ofdm_pkt_cnt; -+ u8 cck_pkt_cnt; -+ u16 cck_sum_power; -+ u8 is_send_rssi; -+ u8 valid_bit; -+ s16 rssi_acc; /*accumulate RSSI for per packet MA sum*/ -+}; -+ -+struct ra_sta_info { -+ u8 rate_id; /*[PHYDM] ratr_idx*/ -+ u8 rssi_level; /*[PHYDM]*/ -+ u8 is_first_connect:1; /*[PHYDM] CE: ra_rpt_linked, AP: H2C_rssi_rpt*/ -+ u8 is_support_sgi:1; /*[driver]*/ -+ u8 is_vht_enable:2; /*[driver]*/ -+ u8 disable_ra:1; /*[driver]*/ -+ u8 disable_pt:1; /*[driver] remove is_disable_power_training*/ -+ u8 txrx_state:2; /*[PHYDM] 0: Tx, 1:Rx, 2:bi-direction*/ -+ u8 is_noisy:1; /*[PHYDM]*/ -+ u8 curr_tx_rate; /*[PHYDM] FW->Driver*/ -+ enum channel_width ra_bw_mode; /*[Driver] max bandwidth, for RA only*/ -+ enum channel_width curr_tx_bw; /*[PHYDM] FW->Driver*/ -+ u8 curr_retry_ratio; /*[PHYDM] FW->Driver*/ -+ u64 ramask; -+}; -+ -+struct dtp_info { -+ u8 dyn_tx_power; /*Dynamic Tx power offset*/ -+ u8 last_tx_power; -+ boolean sta_is_alive; -+ u8 sta_tx_high_power_lvl:4; -+ u8 sta_last_dtp_lvl:4; -+}; -+ -+struct cmn_sta_info { -+ u16 dm_ctrl; /*[Driver]*/ -+ enum channel_width bw_mode; /*[Driver] max support BW*/ -+ u8 mac_id; /*[Driver]*/ -+ u8 mac_addr[6]; /*[Driver]*/ -+ u16 aid; /*[Driver]*/ -+ enum rf_type mimo_type; /*[Driver] sta XTXR*/ -+ struct rssi_info rssi_stat; /*[PHYDM]*/ -+ struct ra_sta_info ra_info; /*[Driver&PHYDM]*/ -+ u16 tx_moving_average_tp; /*[Driver] tx average MBps*/ -+ u16 rx_moving_average_tp; /*[Driver] rx average MBps*/ -+ u8 stbc_en:2; /*[Driver] really transmitt STBC*/ -+ u8 ldpc_en:2; /*[Driver] really transmitt LDPC*/ -+ enum wireless_set support_wireless_set;/*[Driver]*/ -+#ifdef CONFIG_BEAMFORMING -+ struct bf_cmn_info bf_info; /*[Driver]*/ -+#endif -+ u8 sm_ps:2; /*[Driver]*/ -+ struct dtp_info dtp_stat; /*[PHYDM] Dynamic Tx power offset*/ -+ /*u8 pw2cca_over_TH_cnt;*/ -+ /*u8 total_pw2cca_cnt;*/ -+}; -+ -+struct phydm_phyinfo_fw_struct { -+ u8 rx_rssi[4]; /* RSSI in 0~100 index */ -+}; -+ -+struct phydm_phyinfo_struct { -+ boolean physts_rpt_valid; /* @if physts_rpt_valid is false, please ignore the parsing result in this structure*/ -+ u8 rx_pwdb_all; -+ u8 signal_quality; /* OFDM: signal_quality=rx_mimo_signal_quality[0], CCK: signal qualityin 0-100 index. */ -+ u8 rx_mimo_signal_strength[4]; /* RSSI in 0~100 index */ -+ s8 rx_mimo_signal_quality[4]; /* OFDM: per-path's EVM translate to 0~100% , no used for CCK*/ -+ u8 rx_mimo_evm_dbm[4]; /* per-path's original EVM (dbm) */ -+ s16 cfo_short[4]; /* per-path's cfo_short */ -+ s16 cfo_tail[4]; /* per-path's cfo_tail */ -+ s8 rx_power; /* in dBm Translate from PWdB */ -+ s8 recv_signal_power; /* Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. */ -+ u8 bt_rx_rssi_percentage; -+ u8 signal_strength; /* in 0-100 index. */ -+ s8 rx_pwr[4]; /* per-path's pwdb */ -+ s8 rx_snr[4]; /* per-path's SNR */ -+ u8 ant_idx[4]; /*per-path's antenna index*/ -+/*ODM_PHY_STATUS_NEW_TYPE_SUPPORT*/ -+ u8 rx_count:2; /* RX path counter---*/ -+ u8 band_width:3; -+ u8 rxsc:4; /* sub-channel---*/ -+ u8 channel; /* channel number---*/ -+ u8 is_mu_packet:1; /* is MU packet or not---boolean*/ -+ u8 is_beamformed:1; /* BF packet---boolean*/ -+ u8 cnt_pw2cca; -+ u8 cnt_cca2agc_rdy; -+/*ODM_PHY_STATUS_NEW_TYPE_SUPPORT*/ -+ u8 rx_cck_evm; -+}; -+ -+struct phydm_perpkt_info_struct { -+ u8 data_rate; -+ u8 station_id; -+ u8 is_cck_rate: 1; -+ u8 rate_ss:3; /*spatial stream of data rate*/ -+ u8 is_packet_match_bssid:1; /*boolean*/ -+ u8 is_packet_to_self:1; /*boolean*/ -+ u8 is_packet_beacon:1; /*boolean*/ -+ u8 is_to_self:1; /*boolean*/ -+ u8 ppdu_cnt; -+}; -+ -+/*--------------------Export global variable----------------------------*/ -+ -+/*--------------------Function declaration-----------------------------*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/custom_gpio.h b/drivers/net/wireless/rtl8821cs/include/custom_gpio.h -new file mode 100644 -index 000000000..3c67735d6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/custom_gpio.h -@@ -0,0 +1,34 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __CUSTOM_GPIO_H__ -+#define __CUSTOM_GPIO_H___ -+ -+#include -+#include -+ -+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 --git a/drivers/net/wireless/rtl8821cs/include/drv_conf.h b/drivers/net/wireless/rtl8821cs/include/drv_conf.h -new file mode 100644 -index 000000000..f89efa4be ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/drv_conf.h -@@ -0,0 +1,863 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" -+#include "hal_ic_cfg.h" -+ -+#define CONFIG_RSSI_PRIORITY -+ -+/* -+ * RTW_BUSY_DENY_SCAN control if scan would be denied by busy traffic. -+ * When this defined, BUSY_TRAFFIC_SCAN_DENY_PERIOD would be used to judge if -+ * scan request coming from scan UI. Scan request from scan UI would be -+ * exception and never be denied by busy traffic. -+ */ -+#define RTW_BUSY_DENY_SCAN -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ #ifndef CONFIG_AP -+ #define CONFIG_AP -+ #endif -+ #ifndef CONFIG_CONCURRENT_MODE -+ #define CONFIG_CONCURRENT_MODE -+ #endif -+ #ifndef CONFIG_BR_EXT -+ #define CONFIG_BR_EXT -+ #endif -+ #ifndef CONFIG_RTW_REPEATER_SON_ID -+ #define CONFIG_RTW_REPEATER_SON_ID 0x02040608 -+ #endif -+ //#define CONFIG_RTW_REPEATER_SON_ROOT -+ #ifndef CONFIG_RTW_REPEATER_SON_ROOT -+ #undef CONFIG_ROAMING_FLAG -+ #define CONFIG_ROAMING_FLAG 0x7 -+ #endif -+ #undef CONFIG_POWER_SAVING -+#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 -+ -+#ifdef CONFIG_LAYER2_ROAMING -+/*#define CONFIG_RTW_ROAM_QUICKSCAN */ /* active_roaming is required. i.e CONFIG_ROAMING_FLAG[bit2] MUST be enabled */ -+/*#define CONFIG_RTW_ROAM_QUICKSCAN_TH 60*/ -+#endif -+ -+/* Default enable single wiphy if driver ver >= 5.9 */ -+#define RTW_SINGLE_WIPHY -+ -+#ifdef CONFIG_RTW_ANDROID -+ -+ #include -+ -+ #ifndef CONFIG_IOCTL_CFG80211 -+ #define CONFIG_IOCTL_CFG80211 -+ #endif -+ -+ #ifndef RTW_USE_CFG80211_STA_EVENT -+ #define RTW_USE_CFG80211_STA_EVENT -+ #endif -+ -+ #if (CONFIG_RTW_ANDROID > 4) -+ #ifndef CONFIG_RADIO_WORK -+ #define CONFIG_RADIO_WORK -+ #endif -+ #endif -+ -+ #if (CONFIG_RTW_ANDROID <= 7) -+ #ifdef RTW_SINGLE_WIPHY -+ #undef RTW_SINGLE_WIPHY -+ #endif -+ #endif -+ -+ #if (CONFIG_RTW_ANDROID >= 8) -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,18,0)) -+ #ifndef CONFIG_RTW_WIFI_HAL -+ #define CONFIG_RTW_WIFI_HAL -+ #endif -+ #else -+ #error "Linux kernel version is too old\n" -+ #endif -+ #endif -+ -+ #if (CONFIG_RTW_ANDROID >= 11) -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5,4,0)) -+ #ifndef CONFIG_RTW_ANDROID_GKI -+ #define CONFIG_RTW_ANDROID_GKI -+ #endif -+ #endif -+ -+ #ifdef CONFIG_RTW_ANDROID_GKI -+ #ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ #undef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ #endif -+ #endif -+ #endif -+ -+ #ifdef CONFIG_RTW_WIFI_HAL -+ #ifndef CONFIG_RTW_WIFI_HAL_DEBUG -+ //#define CONFIG_RTW_WIFI_HAL_DEBUG -+ #endif -+ #if (CONFIG_RTW_ANDROID < 11) -+ #ifndef CONFIG_RTW_CFGVENDOR_LLSTATS -+ #define CONFIG_RTW_CFGVENDOR_LLSTATS -+ #endif -+ #endif -+ #if (CONFIG_RTW_ANDROID < 11) -+ #ifndef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI -+ #define CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI -+ #endif -+ #else -+ #ifndef CONFIG_RTW_SCAN_RAND -+ #define CONFIG_RTW_SCAN_RAND -+ #endif -+ #endif -+ #ifndef CONFIG_RTW_CFGVENDOR_RSSIMONITOR -+ #define CONFIG_RTW_CFGVENDOR_RSSIMONITOR -+ #endif -+ #ifndef CONFIG_RTW_CFGVENDOR_WIFI_LOGGER -+ #define CONFIG_RTW_CFGVENDOR_WIFI_LOGGER -+ #endif -+ #if (CONFIG_RTW_ANDROID >= 10) -+ #ifndef CONFIG_RTW_CFGVENDOR_WIFI_OFFLOAD -+ //#define CONFIG_RTW_CFGVENDOR_WIFI_OFFLOAD -+ #endif -+ #ifndef CONFIG_RTW_HOSTAPD_ACS -+ #define CONFIG_RTW_HOSTAPD_ACS -+ #endif -+ #ifndef CONFIG_KERNEL_PATCH_EXTERNAL_AUTH -+ #define CONFIG_KERNEL_PATCH_EXTERNAL_AUTH -+ #endif -+ #endif -+ #endif // CONFIG_RTW_WIFI_HAL -+ -+ -+ /* 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 -+ -+#else // for Linux -+ -+ #ifndef CONFIG_RTW_SCAN_RAND -+ #define CONFIG_RTW_SCAN_RAND -+ #endif -+ -+#endif // CONFIG_RTW_ANDROID -+ -+/* -+#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 -+ -+#ifdef CONFIG_WIFI_MONITOR -+ /* #define CONFIG_MONITOR_MODE_XMIT */ -+#endif -+ -+#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL -+ #ifndef CONFIG_WIFI_MONITOR -+ #define CONFIG_WIFI_MONITOR -+ #endif -+ #ifdef CONFIG_POWER_SAVING -+ #undef CONFIG_POWER_SAVING -+ #endif -+#endif -+ -+#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA -+ #ifdef CONFIG_POWER_SAVING -+ #undef CONFIG_POWER_SAVING -+ #endif -+ #ifdef CONFIG_BEAMFORMING -+ #undef CONFIG_BEAMFORMING -+ #endif -+#endif -+ -+#ifndef CONFIG_RTW_DATA_BMC_TO_UC -+#define CONFIG_RTW_DATA_BMC_TO_UC 0 -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ #define CONFIG_LIMITED_AP_NUM 1 -+ -+ #ifndef CONFIG_RTW_AP_DATA_BMC_TO_UC -+ #define CONFIG_RTW_AP_DATA_BMC_TO_UC 1 -+ #endif -+ #if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ #undef CONFIG_RTW_DATA_BMC_TO_UC -+ #define CONFIG_RTW_DATA_BMC_TO_UC 1 -+ #endif -+ #ifndef CONFIG_RTW_AP_SRC_B2U_FLAGS -+ #define CONFIG_RTW_AP_SRC_B2U_FLAGS 0x8 /* see RTW_AP_B2U_XXX */ -+ #endif -+ #ifndef CONFIG_RTW_AP_FWD_B2U_FLAGS -+ #define CONFIG_RTW_AP_FWD_B2U_FLAGS 0x8 /* see RTW_AP_B2U_XXX */ -+ #endif -+ -+ #ifndef CONFIG_ACTIVE_TPC_REPORT -+ #define CONFIG_ACTIVE_TPC_REPORT -+ #endif -+#endif -+ -+#ifdef CONFIG_RTW_MULTI_AP -+ #ifndef CONFIG_AP_MODE -+ #error "enable CONFIG_RTW_MULTI_AP without CONFIG_AP_MODE" -+ #endif -+ #ifndef CONFIG_RTW_WDS -+ #define CONFIG_RTW_WDS -+ #endif -+ #ifndef CONFIG_RTW_UNASOC_STA_MODE_OF_STYPE -+ #define CONFIG_RTW_UNASOC_STA_MODE_OF_STYPE {2, 1} /* BMC:2 for all, NMY_UC:1 for interested target */ -+ #endif -+ #ifndef CONFIG_RTW_NLRTW -+ #define CONFIG_RTW_NLRTW -+ #endif -+ #ifndef CONFIG_RTW_WNM -+ #define CONFIG_RTW_WNM -+ #endif -+ #ifndef CONFIG_RTW_80211K -+ #define CONFIG_RTW_80211K -+ #endif -+#endif -+ -+#ifdef CONFIG_RTW_MESH -+ #ifndef CONFIG_RTW_MESH_ACNODE_PREVENT -+ #define CONFIG_RTW_MESH_ACNODE_PREVENT 1 -+ #endif -+ -+ #ifndef CONFIG_RTW_MESH_OFFCH_CAND -+ #define CONFIG_RTW_MESH_OFFCH_CAND 1 -+ #endif -+ -+ #ifndef CONFIG_RTW_MESH_PEER_BLACKLIST -+ #define CONFIG_RTW_MESH_PEER_BLACKLIST 1 -+ #endif -+ -+ #ifndef CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ #define CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST 1 -+ #endif -+ #ifndef CONFIG_RTW_MESH_CTO_MGATE_CARRIER -+ #define CONFIG_RTW_MESH_CTO_MGATE_CARRIER CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ #endif -+ -+ #ifndef CONFIG_RTW_MPM_TX_IES_SYNC_BSS -+ #define CONFIG_RTW_MPM_TX_IES_SYNC_BSS 1 -+ #endif -+ #if CONFIG_RTW_MPM_TX_IES_SYNC_BSS -+ #ifndef CONFIG_RTW_MESH_AEK -+ #define CONFIG_RTW_MESH_AEK -+ #endif -+ #endif -+ -+ #ifndef CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ #define CONFIG_RTW_MESH_DATA_BMC_TO_UC 1 -+ #endif -+ #if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ #undef CONFIG_RTW_DATA_BMC_TO_UC -+ #define CONFIG_RTW_DATA_BMC_TO_UC 1 -+ #endif -+ #ifndef CONFIG_RTW_MSRC_B2U_FLAGS -+ #define CONFIG_RTW_MSRC_B2U_FLAGS 0x0 /* see RTW_MESH_B2U_XXX */ -+ #endif -+ #ifndef CONFIG_RTW_MFWD_B2U_FLAGS -+ #define CONFIG_RTW_MFWD_B2U_FLAGS 0x2 /* see RTW_MESH_B2U_XXX */ -+ #endif -+#endif -+ -+#if !defined(CONFIG_SCAN_BACKOP) && defined(CONFIG_AP_MODE) -+#define CONFIG_SCAN_BACKOP -+#endif -+ -+#define RTW_SCAN_SPARSE_MIRACAST 1 -+#define RTW_SCAN_SPARSE_BG 0 -+ -+#ifndef CONFIG_TX_AC_LIFETIME -+#define CONFIG_TX_AC_LIFETIME 1 -+#endif -+#ifndef CONFIG_TX_ACLT_FLAGS -+#define CONFIG_TX_ACLT_FLAGS 0x00 -+#endif -+#ifndef CONFIG_TX_ACLT_CONF_DEFAULT -+#define CONFIG_TX_ACLT_CONF_DEFAULT {0x0, 1024 * 1000, 1024 * 1000} -+#endif -+#ifndef CONFIG_TX_ACLT_CONF_AP_M2U -+#define CONFIG_TX_ACLT_CONF_AP_M2U {0xF, 256 * 1000, 256 * 1000} -+#endif -+#ifndef CONFIG_TX_ACLT_CONF_MESH -+#define CONFIG_TX_ACLT_CONF_MESH {0xF, 256 * 1000, 256 * 1000} -+#endif -+ -+#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_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_EXCL_CHS_6G -+ #define CONFIG_RTW_EXCL_CHS_6G {0} -+#endif -+ -+#ifndef CONFIG_RTW_COUNTRY_IE_SLAVE_EN_ROLE -+#define CONFIG_RTW_COUNTRY_IE_SLAVE_EN_ROLE 0x03 /* BIT0 for pure STA mode, BIT1 for P2P group client */ -+#endif -+ -+#ifndef CONFIG_RTW_COUNTRY_IE_SLAVE_EN_IFBMP -+#define CONFIG_RTW_COUNTRY_IE_SLAVE_EN_IFBMP 0xFF /* all iface */ -+#endif -+ -+#ifndef CONFIG_IEEE80211_BAND_5GHZ -+ #if defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8821C) \ -+ || defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C) \ -+ || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8814B) || defined(CONFIG_RTL8723F) -+ #define CONFIG_IEEE80211_BAND_5GHZ 1 -+ #else -+ #define CONFIG_IEEE80211_BAND_5GHZ 0 -+ #endif -+#endif -+ -+#ifndef CONFIG_IEEE80211_BAND_6GHZ -+#define CONFIG_IEEE80211_BAND_6GHZ 0 -+#endif -+ -+#ifndef CONFIG_DFS -+#define CONFIG_DFS 1 -+#endif -+ -+#if CONFIG_IEEE80211_BAND_5GHZ && CONFIG_DFS && defined(CONFIG_AP_MODE) -+ #if !defined(CONFIG_DFS_SLAVE_WITH_RADAR_DETECT) -+ #define CONFIG_DFS_SLAVE_WITH_RADAR_DETECT 0 -+ #endif -+ #if !defined(CONFIG_DFS_MASTER) || CONFIG_DFS_SLAVE_WITH_RADAR_DETECT -+ #define CONFIG_DFS_MASTER -+ #endif -+ #if defined(CONFIG_DFS_MASTER) && !defined(CONFIG_RTW_DFS_REGION_DOMAIN) -+ #define CONFIG_RTW_DFS_REGION_DOMAIN 0 -+ #endif -+#else -+ #undef CONFIG_DFS_MASTER -+ #undef CONFIG_RTW_DFS_REGION_DOMAIN -+ #define CONFIG_RTW_DFS_REGION_DOMAIN 0 -+ #undef CONFIG_DFS_SLAVE_WITH_RADAR_DETECT -+ #define CONFIG_DFS_SLAVE_WITH_RADAR_DETECT 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 -+ -+#ifndef CONFIG_RTW_CHPLAN -+#define CONFIG_RTW_CHPLAN 0xFFFF /* RTW_CHPLAN_IOCTL_UNSPECIFIED */ -+#endif -+ -+#ifndef CONFIG_RTW_CHPLAN_6G -+#define CONFIG_RTW_CHPLAN_6G 0xFFFF /* RTW_CHPLAN_IOCTL_UNSPECIFIED */ -+#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 -+ #ifdef CONFIG_REGD_SRC_FROM_OS -+ #error "CONFIG_REGD_SRC_FROM_OS is not supported when enable RTW_DEF_MODULE_REGULATORY_CERT" -+ #endif -+ /* 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 -+ -+#if !CONFIG_TXPWR_LIMIT && CONFIG_TXPWR_LIMIT_EN -+ #undef CONFIG_TXPWR_LIMIT -+ #define CONFIG_TXPWR_LIMIT 1 -+#endif -+ -+#ifndef CONFIG_RTW_ACTIVE_TPC_REPORT -+#define CONFIG_RTW_ACTIVE_TPC_REPORT 1 /* 0:incapable, 1:capable, 2:auto enable */ -+#endif -+ -+#ifndef CONFIG_RTW_REGD_SRC -+#define CONFIG_RTW_REGD_SRC 1 /* 0:RTK_PRIV, 1:OS */ -+#endif -+ -+#define CONFIG_IOCTL_WEXT -+ -+#ifdef CONFIG_RTW_IPCAM_APPLICATION -+ #undef CONFIG_TXPWR_BY_RATE_EN -+ #define CONFIG_TXPWR_BY_RATE_EN 1 -+ #define CONFIG_RTW_CUSTOMIZE_BEEDCA 0x0000431C -+ #define CONFIG_RTW_CUSTOMIZE_BWMODE 0x00 -+ #define CONFIG_RTW_CUSTOMIZE_RLSTA 0x30 -+ #define CONFIG_CHECK_SPECIFIC_IE_CONTENT -+ #ifdef CONFIG_CUSTOMER_EZVIZ_CHIME2 -+ #undef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ #endif -+#if defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8822B) -+ #define CONFIG_RTW_TX_NPATH_EN /* mutually incompatible with STBC_TX & Beamformer */ -+#endif -+#endif -+/* #define CONFIG_RTW_TOKEN_BASED_XMIT */ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ #define NR_TBTX_SLOT 4 -+ #define NR_MAXSTA_INSLOT 5 -+ #define TBTX_TX_DURATION 30 -+ -+ #define MAX_TXPAUSE_DURATION (TBTX_TX_DURATION*NR_TBTX_SLOT) -+#endif -+ -+/*#define CONFIG_EXTEND_LOWRATE_TXOP */ -+ -+#ifndef CONFIG_RTW_RX_AMPDU_SZ_LIMIT_1SS -+ #define CONFIG_RTW_RX_AMPDU_SZ_LIMIT_1SS {0xFF, 0xFF, 0xFF, 0xFF} -+#endif -+#ifndef CONFIG_RTW_RX_AMPDU_SZ_LIMIT_2SS -+ #define CONFIG_RTW_RX_AMPDU_SZ_LIMIT_2SS {0xFF, 0xFF, 0xFF, 0xFF} -+#endif -+#ifndef CONFIG_RTW_RX_AMPDU_SZ_LIMIT_3SS -+ #define CONFIG_RTW_RX_AMPDU_SZ_LIMIT_3SS {0xFF, 0xFF, 0xFF, 0xFF} -+#endif -+#ifndef CONFIG_RTW_RX_AMPDU_SZ_LIMIT_4SS -+ #define CONFIG_RTW_RX_AMPDU_SZ_LIMIT_4SS {0xFF, 0xFF, 0xFF, 0xFF} -+#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_ANTENNA_GAIN -+#define CONFIG_RTW_ANTENNA_GAIN 0x7FFF /* == UNSPECIFIED_MBM */ -+#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 be 0 !!" -+#endif -+ -+#if defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8188F) || \ -+defined(CONFIG_RTL8188GTV) || defined(CONFIG_RTL8192F) || \ -+defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8710B) || \ -+defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || defined(CONFIG_RTL8723D) -+#define CONFIG_HWMPCAP_GEN1 -+#elif defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) || \ -+defined(CONFIG_RTL8723F) /*|| defined(CONFIG_RTL8814A)*/ -+#define CONFIG_HWMPCAP_GEN2 -+#elif defined(CONFIG_RTL8814B) /*Address CAM - 128*/ -+#define CONFIG_HWMPCAP_GEN3 -+#endif -+ -+#if defined(CONFIG_HWMPCAP_GEN1) && (CONFIG_IFACE_NUMBER > 2) -+ #ifdef CONFIG_POWER_SAVING -+ /*#warning "Disable PS when CONFIG_IFACE_NUMBER > 2"*/ -+ #undef CONFIG_POWER_SAVING -+ #endif -+ -+ #ifdef CONFIG_WOWLAN -+ #error "This IC can't support MI and WoWLan at the same time" -+ #endif -+#endif -+ -+#if defined(CONFIG_HWMPCAP_GEN1) && (CONFIG_IFACE_NUMBER > 3) -+ #error " This IC can't support over 3 interfaces !!" -+#endif -+ -+#if (CONFIG_IFACE_NUMBER > 4) -+ #error "Not support over 4 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) -+ #ifndef CONFIG_HWMPCAP_GEN3 -+ #define CONFIG_MI_WITH_MBSSID_CAM -+ #endif -+ -+ #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 -+ #undef CONFIG_LIMITED_AP_NUM -+ #define CONFIG_LIMITED_AP_NUM 2 -+ -+ #define CONFIG_SUPPORT_MULTI_BCN -+ -+ #define CONFIG_SWTIMER_BASED_TXBCN -+ -+ #ifdef CONFIG_HWMPCAP_GEN2 /*CONFIG_RTL8822B/CONFIG_RTL8821C/CONFIG_RTL8822C*/ -+ #define CONFIG_FW_HANDLE_TXBCN -+ -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ #ifdef CONFIG_SWTIMER_BASED_TXBCN -+ #undef CONFIG_SWTIMER_BASED_TXBCN -+ #endif -+ #undef CONFIG_LIMITED_AP_NUM -+ #define CONFIG_LIMITED_AP_NUM 4 -+ #endif -+ -+ #endif /*CONFIG_HWMPCAP_GEN2*/ -+ -+ #ifdef CONFIG_HWMPCAP_GEN3 -+ #define CONFIG_PORT_BASED_TXBCN -+ #undef CONFIG_SUPPORT_MULTI_BCN -+ #undef CONFIG_SWTIMER_BASED_TXBCN -+ #undef CONFIG_LIMITED_AP_NUM -+ #define CONFIG_LIMITED_AP_NUM 4 -+ #ifdef CONFIG_PCI_HCI -+ #define CONFIG_PORT_BASED_HIQ /* 8814BU doesn't support */ -+ #endif -+ #endif -+ #endif /*CONFIG_AP_MODE*/ -+ -+ #ifdef CONFIG_HWMPCAP_GEN2 /*CONFIG_RTL8822B/CONFIG_RTL8821C/CONFIG_RTL8822C*/ -+ #define CONFIG_CLIENT_PORT_CFG -+ #define CONFIG_NEW_NETDEV_HDL -+ #endif/*CONFIG_HWMPCAP_GEN2*/ -+#endif/*(CONFIG_IFACE_NUMBER > 2)*/ -+ -+#if defined(CONFIG_MI_UNIQUE_MACADDR_BIT) -+ #if !defined(CONFIG_MI_WITH_MBSSID_CAM) -+ #error "CONFIG_MI_UNIQUE_MACADDR_BIT should not be used without multiple interface !!" -+ #endif -+ #if (CONFIG_MI_UNIQUE_MACADDR_BIT < 24) || ( 47 < CONFIG_MI_UNIQUE_MACADDR_BIT) -+ #error "CONFIG_MI_UNIQUE_MACADDR_BIT should be the bit in NIC specific mac address(BIT[24:47] !!" -+ #endif -+#endif -+ -+#define MACID_NUM_SW_LIMIT 32 -+#define SEC_CAM_ENT_NUM_SW_LIMIT 32 -+ -+#ifdef SEC_DEFAULT_KEY_SEARCH -+ #if (CONFIG_IFACE_NUMBER >= 2) -+ #error "Default Key Search only work with only one interface case!" -+ #endif -+#endif -+ -+#if defined(CONFIG_WOWLAN) && (defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B)) -+ #define CONFIG_WOW_PATTERN_HW_CAM -+#endif -+ -+#ifndef CONFIG_TSF_UPDATE_PAUSE_FACTOR -+#define CONFIG_TSF_UPDATE_PAUSE_FACTOR 200 -+#endif -+ -+#ifndef CONFIG_TSF_UPDATE_RESTORE_FACTOR -+#define CONFIG_TSF_UPDATE_RESTORE_FACTOR 5 -+#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 */ -+/*#define CONFIG_PHDYM_FW_FIXRATE */ /* Another way to fix tx rate */ -+ -+/* -+* CONFIG_RTW_SDIO_RELEASE_IRQ -+* == 0: static allocated -+* >= 1: release when suspend -+* >= 2: release when IPS -+*/ -+#ifndef CONFIG_RTW_SDIO_RELEASE_IRQ -+#define CONFIG_RTW_SDIO_RELEASE_IRQ 2 -+#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 */ -+ -+#ifdef CONFIG_RTW_HOSTAPD_ACS -+ #ifndef CONFIG_RTW_ACS -+ #define CONFIG_RTW_ACS -+ #endif -+#endif -+ -+#ifdef CONFIG_RTW_80211K -+ #ifndef CONFIG_RTW_ACS -+ #define CONFIG_RTW_ACS -+ #endif -+#endif /*CONFIG_RTW_80211K*/ -+ -+#ifdef DBG_CONFIG_ERROR_RESET -+#ifndef CONFIG_IPS -+#define CONFIG_IPS -+#endif -+#endif -+ -+/* IPS */ -+#ifndef RTW_IPS_MODE -+ #if defined(CONFIG_IPS) -+ #define RTW_IPS_MODE 1 -+ #else -+ #define RTW_IPS_MODE 0 -+ #endif -+#endif /* !RTW_IPS_MODE */ -+ -+#if (RTW_IPS_MODE > 1 || RTW_IPS_MODE < 0) -+ #error "The CONFIG_IPS_MODE value is wrong. Please follow HowTo_enable_the_power_saving_functionality.pdf.\n" -+#endif -+ -+/* LPS */ -+#ifndef RTW_LPS_MODE -+ #if defined(CONFIG_LPS_PG) || defined(CONFIG_LPS_PG_DDMA) -+ #define RTW_LPS_MODE 3 -+ #elif defined(CONFIG_LPS_LCLK) -+ #define RTW_LPS_MODE 2 -+ #elif defined(CONFIG_LPS) -+ #define RTW_LPS_MODE 1 -+ #else -+ #define RTW_LPS_MODE 0 -+ #endif -+#endif /* !RTW_LPS_MODE */ -+ -+#if (RTW_LPS_MODE > 3 || RTW_LPS_MODE < 0) -+ #error "The CONFIG_LPS_MODE value is wrong. Please follow HowTo_enable_the_power_saving_functionality.pdf.\n" -+#endif -+ -+#ifndef RTW_LPS_1T1R -+#define RTW_LPS_1T1R 0 -+#endif -+ -+#ifndef RTW_WOW_LPS_1T1R -+#define RTW_WOW_LPS_1T1R 0 -+#endif -+ -+/* WOW LPS */ -+#ifndef RTW_WOW_LPS_MODE -+ #if defined(CONFIG_LPS_PG) || defined(CONFIG_LPS_PG_DDMA) -+ #define RTW_WOW_LPS_MODE 3 -+ #elif defined(CONFIG_LPS_LCLK) -+ #define RTW_WOW_LPS_MODE 2 -+ #elif defined(CONFIG_LPS) -+ #define RTW_WOW_LPS_MODE 1 -+ #else -+ #define RTW_WOW_LPS_MODE 0 -+ #endif -+#endif /* !RTW_WOW_LPS_MODE */ -+ -+#if (RTW_WOW_LPS_MODE > 3 || RTW_WOW_LPS_MODE < 0) -+ #error "The RTW_WOW_LPS_MODE value is wrong. Please follow HowTo_enable_the_power_saving_functionality.pdf.\n" -+#endif -+ -+#ifdef RTW_REDUCE_SCAN_SWITCH_CH_TIME -+#ifndef CONFIG_RTL8822B -+ #error "Only 8822B support RTW_REDUCE_SCAN_SWITCH_CH_TIME" -+#endif -+ #ifndef RTW_CHANNEL_SWITCH_OFFLOAD -+ #define RTW_CHANNEL_SWITCH_OFFLOAD -+ #endif -+#endif -+ -+#ifdef CONFIG_WAR_OFFLOAD -+#ifndef CONFIG_WOWLAN -+ #error "WAR OFFLOAD is part of WOWLAN" -+#endif -+#endif -+ -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+#ifndef CONFIG_WOWLAN -+ #error "mDNS OFFLOAD is part of WOWLAN" -+#endif -+#ifndef CONFIG_WAR_OFFLOAD -+ #define CONFIG_WAR_OFFLOAD -+#endif -+#endif -+ -+#define CONFIG_RTW_TPT_MODE -+ -+#ifdef CONFIG_PCI_BCN_POLLING -+#define CONFIG_BCN_ICF -+#endif -+ -+#ifndef CONFIG_RTW_MGMT_QUEUE -+ #define CONFIG_RTW_MGMT_QUEUE -+#endif -+ -+#ifndef CONFIG_PCI_MSI -+#define CONFIG_RTW_PCI_MSI_DISABLE -+#endif -+ -+#if defined(CONFIG_PCI_DYNAMIC_ASPM_L1_LATENCY) || \ -+ defined(CONFIG_PCI_DYNAMIC_ASPM_LINK_CTRL) -+#define CONFIG_PCI_DYNAMIC_ASPM -+#endif -+ -+#if 0 -+/* Debug related compiler flags */ -+#define DBG_THREAD_PID /* Add thread pid to debug message prefix */ -+#define DBG_CPU_INFO /* Add CPU info to debug message prefix */ -+#endif -+ -+#endif /* __DRV_CONF_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/drv_types.h b/drivers/net/wireless/rtl8821cs/include/drv_types.h -new file mode 100644 -index 000000000..d8a035059 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/drv_types.h -@@ -0,0 +1,2150 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#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 -+#include -+#include "../core/rtw_chplan.h" -+ -+#ifdef CONFIG_80211N_HT -+ #include -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ #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 -+#ifdef CONFIG_RTW_80211R -+#include -+#endif -+#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) -+#include -+#endif -+#ifdef CONFIG_RTW_MBO -+#include -+#endif -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#ifdef CONFIG_RTW_WDS -+#include "../core/wds/rtw_wds.h" -+#endif -+#ifdef CONFIG_RTW_MESH -+#include "../core/mesh/rtw_mesh.h" -+#endif -+#ifdef CONFIG_WIFI_MONITOR -+#include "../core/monitor/rtw_radiotap.h" -+#endif -+#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_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 -+ -+#include -+#include -+ -+#ifdef CONFIG_MCC_MODE -+ #include -+#endif /*CONFIG_MCC_MODE */ -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ #include -+#endif /*CONFIG_RTW_REPEATER_SON */ -+ -+#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; -+ 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 lps_level; -+#ifdef CONFIG_LPS_1T1R -+ u8 lps_1t1r; -+#endif -+ u8 lps_chk_by_tp; -+#ifdef CONFIG_WOWLAN -+ u8 wow_power_mgnt; -+ u8 wow_lps_level; -+ #ifdef CONFIG_LPS_1T1R -+ u8 wow_lps_1t1r; -+ #endif -+#endif /* CONFIG_WOWLAN */ -+ u8 smart_ps; -+#ifdef CONFIG_WMMPS_STA -+ u8 wmm_smart_ps; -+#endif /* CONFIG_WMMPS_STA */ -+ u8 usb_rxagg_mode; -+ u8 dynamic_agg_enable; -+ u8 long_retry_lmt; -+ u8 short_retry_lmt; -+ u16 busy_thresh; -+ u16 max_bss_cnt; -+ 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 -+#ifdef CONFIG_NARROWBAND_SUPPORTING -+ u8 rtw_nb_config; -+#endif -+ u8 acm_method; -+ /* WMM */ -+ u8 wmm_enable; -+#ifdef CONFIG_WMMPS_STA -+ /* uapsd (unscheduled automatic power-save delivery) = a kind of wmmps */ -+ u8 uapsd_max_sp_len; -+ /* BIT0: AC_VO UAPSD, BIT1: AC_VI UAPSD, BIT2: AC_BK UAPSD, BIT3: AC_BE UAPSD */ -+ u8 uapsd_ac_enable; -+#endif /* CONFIG_WMMPS_STA */ -+ -+ WLAN_BSSID_EX dev_network; -+ -+#if CONFIG_TX_AC_LIFETIME -+ u8 tx_aclt_flags; -+ struct tx_aclt_conf_t tx_aclt_confs[TX_ACLT_CONF_NUM]; -+#endif -+ -+ u8 tx_bw_mode; -+#ifdef CONFIG_AP_MODE -+ u8 bmc_tx_rate; -+ #if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ u8 ap_src_b2u_flags; -+ u8 ap_fwd_b2u_flags; -+ #endif -+#endif -+ -+#ifdef CONFIG_RTW_MESH -+ #if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ u8 msrc_b2u_flags; -+ u8 mfwd_b2u_flags; -+ #endif -+#endif -+ -+#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 rx_ampdu_amsdu;/* Rx A-MPDU Supports A-MSDU is permitted */ -+ u8 tx_ampdu_amsdu;/* Tx A-MPDU Supports A-MSDU is permitted */ -+ u8 tx_quick_addba_req; -+ u8 rx_ampdu_sz_limit_by_nss_bw[4][4]; /* 1~4SS, BW20~BW160 */ -+ /* 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; -+ #if defined(CONFIG_RTW_TX_NPATH_EN) -+ u8 tx_npath; -+ #endif -+ #if defined(CONFIG_RTW_PATH_DIV) -+ u8 path_div; -+ #endif -+ /* -+ * 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 vht_24g_enable; /* 0:disable, 1:enable */ -+ u8 ampdu_factor; -+ u8 vht_rx_mcs_map[2]; -+#endif /* CONFIG_80211AC_VHT */ -+ -+ u8 low_power ; -+ -+ u8 wifi_spec;/* !turbo_mode */ -+ -+ u8 trx_path_bmp; /* [7:4]TX path bmp, [0:3]RX path bmp, 0: not specified */ -+ u8 tx_path_lmt; /* limit of TX path number, 0: not specified */ -+ u8 rx_path_lmt; /* limit of TX path number, 0: not specified */ -+ u8 tx_nss; -+ u8 rx_nss; -+ -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+ u8 active_tpc_report; -+#endif -+ -+#ifdef CONFIG_REGD_SRC_FROM_OS -+ enum regd_src_t regd_src; -+#endif -+ char alpha2[2]; -+ u8 channel_plan; -+ u8 excl_chs[MAX_CHANNEL_NUM_2G_5G]; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 channel_plan_6g; -+ u8 excl_chs_6g[MAX_CHANNEL_NUM_6G]; -+#endif -+ 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; -+ u8 single_ant_path; -+#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 country_ie_slave_en_role; -+ u8 country_ie_slave_en_ifbmp; -+#endif -+ -+ u8 ifname[16]; -+ u8 if2name[16]; -+ -+ u8 notch_filter; -+ -+ /* for pll reference clock selction */ -+ u8 pll_ref_clk_sel; -+ -+ /* define for tx power adjust */ -+#if CONFIG_TXPWR_LIMIT -+ u8 RegEnableTxPowerLimit; -+#endif -+ u8 RegEnableTxPowerByRate; -+ -+ u8 target_tx_pwr_valid; -+ s8 target_tx_pwr_2g[RF_PATH_MAX][RATE_SECTION_NUM]; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ s8 target_tx_pwr_5g[RF_PATH_MAX][RATE_SECTION_NUM - 1]; -+#endif -+ s16 antenna_gain; -+ -+ u8 tsf_update_pause_factor; -+ u8 tsf_update_restore_factor; -+ -+ 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; -+#ifdef CONFIG_P2P -+ u8 sel_p2p_iface; -+#endif -+#endif -+ u8 qos_opt_enable; -+ -+ u8 hiq_filter; -+ u8 adaptivity_en; -+ u8 adaptivity_mode; -+ s8 adaptivity_th_l2h_ini; -+ s8 adaptivity_th_edcca_hl_diff; -+ -+ u8 boffefusemask; -+ BOOLEAN bFileMaskEfuse; -+ BOOLEAN bBTFileMaskEfuse; -+#ifdef CONFIG_RTW_ACS -+ u8 acs_auto_scan; -+ u8 acs_mode; -+#endif -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ u8 nm_mode; -+#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 -+ u8 amsdu_mode; -+#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; -+ s8 rtw_mcc_policy_table_idx; -+ u8 rtw_mcc_duration; -+ u8 rtw_mcc_enable_runtime_duration; -+ u8 rtw_mcc_phydm_offload; -+#endif /* CONFIG_MCC_MODE */ -+ -+#ifdef CONFIG_RTW_NAPI -+ u8 en_napi; -+#ifdef CONFIG_RTW_NAPI_DYNAMIC -+ u32 napi_threshold; /* unit: Mbps */ -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+#ifdef CONFIG_RTW_GRO -+ u8 en_gro; -+#endif /* CONFIG_RTW_GRO */ -+#endif /* CONFIG_RTW_NAPI */ -+ -+#ifdef CONFIG_WOWLAN -+ u8 wowlan_enable; -+ u8 wakeup_event; -+ u8 suspend_type; -+#endif -+ -+ u8 recvbuf_nr; -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+ u8 trx_share_mode; -+#endif -+ u8 check_hw_status; -+ u8 wowlan_sta_mix_mode; -+ -+#ifdef CONFIG_PCI_HCI -+ u32 pci_aspm_config; -+ u32 pci_dynamic_aspm_linkctrl; -+#endif -+ -+ u8 iqk_fw_offload; -+ u8 ch_switch_offload; -+ -+#ifdef CONFIG_TDLS -+ u8 en_tdls; -+#endif -+ -+#ifdef CONFIG_ADVANCE_OTA -+ u8 adv_ota; -+#endif -+ -+#ifdef CONFIG_FW_OFFLOAD_PARAM_INIT -+ u8 fw_param_init; -+#endif -+#ifdef CONFIG_DYNAMIC_SOML -+ u8 dyn_soml_en; -+ u8 dyn_soml_train_num; -+ u8 dyn_soml_interval; -+ u8 dyn_soml_period; -+ u8 dyn_soml_delay; -+#endif -+#ifdef CONFIG_FW_HANDLE_TXBCN -+ u8 fw_tbtt_rpt; -+#endif -+ -+#ifdef DBG_LA_MODE -+ u8 la_mode_en; -+#endif -+ u32 phydm_ability; -+ u32 halrf_ability; -+#ifdef CONFIG_TDMADIG -+ u8 tdmadig_en; -+ u8 tdmadig_mode; -+ u8 tdmadig_dynamic; -+#endif/*CONFIG_TDMADIG*/ -+ u8 en_dyn_rrsr; -+ u32 set_rrsr_value; -+#ifdef CONFIG_RTW_MESH -+ u8 peer_alive_based_preq; -+#endif -+ -+#ifdef RTW_BUSY_DENY_SCAN -+ /* -+ * scan_interval_thr means scan interval threshold which is used to -+ * judge if user is in scan page or not. -+ * If scan interval < scan_interval_thr we guess user is in scan page, -+ * and driver won't deny any scan request at that time. -+ * Its default value comes from compiler flag -+ * BUSY_TRAFFIC_SCAN_DENY_PERIOD, and unit is ms. -+ */ -+ u32 scan_interval_thr; -+#endif -+ -+#ifdef CONFIG_RTL8822C_XCAP_NEW_POLICY -+ u8 rtw_8822c_xcap_overwrite; -+#endif -+#ifdef CONFIG_RTW_MULTI_AP -+ u8 unassoc_sta_mode_of_stype[UNASOC_STA_SRC_NUM]; -+ u16 max_unassoc_sta_cnt; -+#endif -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+ u8 ap_csa_cnt; -+#endif -+}; -+ -+/* 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 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 WOWLAN_IS_STA_MIX_MODE(_Adapter) (_Adapter->registrypriv.wowlan_sta_mix_mode) -+#define BSSID_OFT(field) ((u32)FIELD_OFFSET(WLAN_BSSID_EX, field)) -+#define BSSID_SZ(field) sizeof(((PWLAN_BSSID_EX) 0)->field) -+ -+#define BW_MODE_2G(bw_mode) ((bw_mode) & 0x0F) -+#define BW_MODE_5G(bw_mode) ((bw_mode) >> 4) -+#ifdef CONFIG_80211N_HT -+#define REGSTY_BW_2G(regsty) BW_MODE_2G((regsty)->bw_mode) -+#define REGSTY_BW_5G(regsty) BW_MODE_5G((regsty)->bw_mode) -+#else -+#define REGSTY_BW_2G(regsty) CHANNEL_WIDTH_20 -+#define REGSTY_BW_5G(regsty) CHANNEL_WIDTH_20 -+#endif -+#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)) -+ -+#ifdef CONFIG_80211AC_VHT -+#define REGSTY_IS_11AC_ENABLE(regsty) ((regsty)->vht_enable != 0) -+#define REGSTY_IS_11AC_AUTO(regsty) ((regsty)->vht_enable == 2) -+#define REGSTY_IS_11AC_24G_ENABLE(regsty) ((regsty)->vht_24g_enable != 0) -+#else -+#define REGSTY_IS_11AC_ENABLE(regsty) 0 -+#define REGSTY_IS_11AC_AUTO(regsty) 0 -+#define REGSTY_IS_11AC_24G_ENABLE(regsty) 0 -+#endif -+ -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+#define REGSTY_IS_ACTIVE_TPC_REPORT_CAPABLE(regsty) ((regsty)->active_tpc_report != 0) -+#define REGSTY_IS_ACTIVE_TPC_REPORT_AUTO(regsty) ((regsty)->active_tpc_report == 2) -+#else -+#define REGSTY_IS_ACTIVE_TPC_REPORT_CAPABLE(regsty) 0 -+#define REGSTY_IS_ACTIVE_TPC_REPORT_AUTO(regsty) 0 -+#endif -+ -+#ifdef CONFIG_REGD_SRC_FROM_OS -+#define REGSTY_REGD_SRC_FROM_OS(regsty) ((regsty)->regd_src == REGD_SRC_OS) -+#else -+#define REGSTY_REGD_SRC_FROM_OS(regsty) 0 -+#endif -+ -+typedef struct rtw_if_operations { -+ int __must_check (*read)(struct dvobj_priv *d, unsigned int addr, void *buf, -+ size_t len, bool fixed); -+ int __must_check (*write)(struct dvobj_priv *d, unsigned 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 -+ -+#define get_hw_port(adapter) (adapter->hw_port) -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ #define is_primary_adapter(adapter) (adapter->adapter_type == PRIMARY_ADAPTER) -+ #define is_vir_adapter(adapter) (adapter->adapter_type == VIRTUAL_ADAPTER) -+#else -+ #define is_primary_adapter(adapter) (1) -+ #define is_vir_adapter(adapter) (0) -+#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_gcmp; -+ 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; -+ u32 dbg_fw_mem_dl_error_cnt; -+ u64 dbg_rx_fifo_last_overflow; -+ u64 dbg_rx_fifo_curr_overflow; -+ u64 dbg_rx_fifo_diff_overflow; -+}; -+ -+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_CAP_CHK_EXTRA_SEC BIT1 /* 256 bit */ -+#define SEC_CAP_CHK_WRITE_CAM_NEW_RULE BIT2 -+ -+#define MACID_DROP BIT0 -+#define MACID_DROP_INDIRECT BIT1 -+ -+#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] -+ -+#define RTW_DEFAULT_MGMT_MACID 1 -+ -+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 -+}; -+ -+#ifdef CONFIG_CLIENT_PORT_CFG -+struct clt_port_t{ -+ _lock lock; -+ u8 bmp; -+ s8 num; -+}; -+#define get_clt_num(adapter) (adapter_to_dvobj(adapter)->clt_port.num) -+#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]; -+ struct macid_bmp ch_g[2]; /* 2 ch concurrency */ -+ -+ u8 iface_bmc[CONFIG_IFACE_NUMBER]; /* bmc TX macid for each iface*/ -+ -+ 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]; -+ u8 op_num[H2C_MSR_ROLE_MAX]; /* number of macid having h2c_msr's OPMODE = 1 for specific ROLE */ -+ -+ struct sta_info *sta[MACID_NUM_SW_LIMIT]; /* corresponding stainfo when macid is not shared */ -+ u8 macid_cap; -+ /* macid sleep registers */ -+#ifdef CONFIG_PROTSEL_MACSLEEP -+ u16 reg_sleep_ctrl; -+ u16 reg_sleep_info; -+ u16 reg_drop_ctrl; -+ u16 reg_drop_info; -+#else -+ u16 reg_sleep_m0; -+ u16 reg_drop_m0; -+#if (MACID_NUM_SW_LIMIT > 32) -+ u16 reg_sleep_m1; -+ u16 reg_drop_m1; -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ u16 reg_sleep_m2; -+ u16 reg_drop_m2; -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ u16 reg_sleep_m3; -+ u16 reg_drop_m3; -+#endif -+#endif -+ u16 macid_txrpt; -+ u8 macid_txrpt_pgsz; -+}; -+ -+/* 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 0x00000003FF -+#define RATE_BMP_VHT_2SS 0x00000FFC00 -+#define RATE_BMP_VHT_3SS 0x003FF00000 -+#define RATE_BMP_VHT_4SS 0xFFC0000000 -+#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_HAS_VHT_4SS(_bmp_vht) (_bmp_vht & RATE_BMP_VHT_4SS) -+#define RATE_BMP_GET_VHT_1SS(_bmp_vht) ((u16)(_bmp_vht & RATE_BMP_VHT_1SS)) -+#define RATE_BMP_GET_VHT_2SS(_bmp_vht) ((u16)((_bmp_vht & RATE_BMP_VHT_2SS) >> 10)) -+#define RATE_BMP_GET_VHT_3SS(_bmp_vht) ((u16)((_bmp_vht & RATE_BMP_VHT_3SS) >> 20)) -+#define RATE_BMP_GET_VHT_4SS(_bmp_vht) ((u16)((_bmp_vht & RATE_BMP_VHT_4SS) >> 30)) -+ -+#define TXPWR_LMT_REF_VHT_FROM_HT BIT0 -+#define TXPWR_LMT_REF_HT_FROM_VHT BIT1 -+ -+#define TXPWR_LMT_HAS_CCK_1T BIT0 -+#define TXPWR_LMT_HAS_CCK_2T BIT1 -+#define TXPWR_LMT_HAS_CCK_3T BIT2 -+#define TXPWR_LMT_HAS_CCK_4T BIT3 -+#define TXPWR_LMT_HAS_OFDM_1T BIT4 -+#define TXPWR_LMT_HAS_OFDM_2T BIT5 -+#define TXPWR_LMT_HAS_OFDM_3T BIT6 -+#define TXPWR_LMT_HAS_OFDM_4T BIT7 -+ -+#define OFFCHS_NONE 0 -+#define OFFCHS_LEAVING_OP 1 -+#define OFFCHS_LEAVE_OP 2 -+#define OFFCHS_BACKING_OP 3 -+ -+#define TPC_MODE_DISABLE 0 -+#define TPC_MODE_MANUAL 1 -+#define TPC_MODE_INVALID 2 /* keep last */ -+ -+#define TPC_MANUAL_CONSTRAINT_MAX 600 /* mB */ -+ -+#define COUNTRY_IE_SLAVE_EN_ROLE_STA BIT0 /* pure STA mode */ -+#define COUNTRY_IE_SLAVE_EN_ROLE_GC BIT1 /* P2P group client */ -+ -+#define MAX_CSA_CNT 10 -+ -+struct rf_ctl_t { -+ bool disable_sw_chplan; -+ enum regd_src_t regd_src; -+ enum rtw_regd_inr regd_inr; -+ char alpha2[2]; -+ u8 ChannelPlan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 chplan_6g; -+#endif -+ u8 edcca_mode_2g_override; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ u8 edcca_mode_5g_override; -+#endif -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 edcca_mode_6g_override; -+#endif -+#if CONFIG_TXPWR_LIMIT -+ u8 txpwr_lmt_override; -+#endif -+ -+#if defined(CONFIG_80211AX_HE) || defined(CONFIG_80211AC_VHT) -+ u8 proto_en; -+#endif -+ -+ /* initial channel plan selectors */ -+ char init_alpha2[2]; -+ u8 init_ChannelPlan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 init_chplan_6g; -+#endif -+ -+ /* channel plan selectors by user */ -+ char user_alpha2[2]; /* "\x00\x00" is not set */ -+ u8 user_ChannelPlan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 user_chplan_6g; -+#endif -+ -+#ifdef CONFIG_80211D -+ u8 country_ie_slave_en_role; -+ u8 country_ie_slave_en_ifbmp; -+ -+ struct country_ie_slave_record cisr[CONFIG_IFACE_NUMBER]; -+ u8 effected_cisr_id; -+#endif -+ -+ u8 max_chan_nums; -+ RT_CHANNEL_INFO channel_set[MAX_CHANNEL_NUM]; -+ struct op_class_pref_t **spt_op_class_ch; -+ u8 cap_spt_op_class_num; -+ u8 reg_spt_op_class_num; -+ u8 cur_spt_op_class_num; -+ struct p2p_channels channel_list; -+#ifdef CONFIG_RTW_MBO -+ struct npref_ch_rtp ch_rtp; -+#endif -+ -+ s16 antenna_gain; /* mBi */ -+ -+ u8 op_class; -+ u8 op_ch; -+ s16 op_txpwr_max; /* EIRP in mBm */ -+ u8 if_op_class[CONFIG_IFACE_NUMBER]; -+ u8 if_op_ch[CONFIG_IFACE_NUMBER]; -+ -+ _mutex offch_mutex; -+ u8 offch_state; -+ -+ /* 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 */ -+ u64 rate_bmp_vht_by_bw[4]; /* 20MHz, 40MHz, 80MHz, 160MHz. 4SS supported */ -+ -+#if CONFIG_TXPWR_LIMIT -+ u8 highest_ht_rate_bw_bmp; -+ u8 highest_vht_rate_bw_bmp; -+ -+ _mutex txpwr_lmt_mutex; -+ _list reg_exc_list; -+ u8 regd_exc_num; -+ _list txpwr_lmt_list; -+ u8 txpwr_lmt_num; -+ const char *txpwr_lmt_name[BAND_MAX]; -+ -+ u8 txpwr_lmt_2g_cck_ofdm_state; -+ #if CONFIG_IEEE80211_BAND_5GHZ -+ u8 txpwr_lmt_5g_cck_ofdm_state; -+ u8 txpwr_lmt_5g_20_40_ref; -+ #endif -+#endif -+ u8 tpc_mode; -+ u16 tpc_manual_constraint; /* mB */ -+ -+ bool ch_sel_within_same_band; -+ -+ u8 adaptivity_en; /* runtime status, hook to phydm */ -+ u8 edcca_mode_2g; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ u8 edcca_mode_5g; -+#endif -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 edcca_mode_6g; -+#endif -+ -+ u8 ap_csa_ch; -+ u8 ap_csa_switch_cnt; -+ u8 ap_csa_ch_offset; -+ u8 ap_csa_ch_width; -+ u8 ap_csa_en; -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+ u8 ap_csa_cnt_input; /* Input from proc, default value is DEFAULT_CSA_CNT */ -+#endif -+ -+#if CONFIG_DFS -+ u8 csa_ch; -+ u8 csa_switch_cnt; -+ u8 csa_ch_offset; -+ u8 csa_ch_width; -+ u8 csa_ch_freq_seg0; /* Channel Center Frequency Segment 0 */ -+ u8 csa_ch_freq_seg1; /* Channel Center Frequency Segment 1 */ -+ -+#ifdef CONFIG_DFS_MASTER -+ u8 dfs_region_domain; -+ _timer radar_detect_timer; -+ bool radar_detect_by_others; -+ u8 radar_detect_enabled; -+ bool radar_detected; -+ -+ u8 radar_detect_ch; -+ u8 radar_detect_bw; -+ u8 radar_detect_offset; -+ -+ systime cac_start_time; -+ systime cac_end_time; -+ u8 cac_force_stop; -+ -+#if CONFIG_DFS_SLAVE_WITH_RADAR_DETECT -+ u8 dfs_slave_with_rd; -+#endif -+ u8 dfs_ch_sel_e_flags; -+ u8 dfs_ch_sel_d_flags; -+ -+ u8 dbg_dfs_fake_radar_detect_cnt; -+ u8 dbg_dfs_radar_detect_trigger_non; -+ u8 dbg_dfs_choose_dfs_ch_first; -+#endif /* CONFIG_DFS_MASTER */ -+#endif /* CONFIG_DFS */ -+}; -+ -+struct wow_ctl_t { -+ u8 wow_cap; -+}; -+ -+#define WOW_CAP_TKIP_OL BIT0 -+#define WOW_CAP_HALMAC_ACCESS_PATTERN_IN_TXFIFO BIT1 -+ -+#define RFCTL_REG_WORLDWIDE(rfctl) (IS_ALPHA2_WORLDWIDE(rfctl->alpha2)) -+#define RFCTL_REG_ALPHA2_UNSPEC(rfctl) (IS_ALPHA2_UNSPEC(rfctl->alpha2)) /* ex: only domain code is specified */ -+ -+#ifdef CONFIG_80211AC_VHT -+#define RFCTL_REG_EN_11AC(rfctl) (((rfctl)->proto_en & CHPLAN_PROTO_EN_AC) ? 1 : 0) -+#else -+#define RFCTL_REG_EN_11AC(rfctl) 0 -+#endif -+ -+#ifdef CONFIG_80211AX_HE -+#define RFCTL_REG_EN_11AX(rfctl) (((rfctl)->proto_en & CHPLAN_PROTO_EN_AX) ? 1 : 0) -+#else -+#define RFCTL_REG_EN_11AX(rfctl) 0 -+#endif -+ -+#define RTW_CAC_STOPPED 0 -+#ifdef CONFIG_DFS_MASTER -+#define IS_CAC_STOPPED(rfctl) ((rfctl)->cac_end_time == RTW_CAC_STOPPED) -+#define IS_CH_WAITING(rfctl) (!IS_CAC_STOPPED(rfctl) && rtw_time_after((rfctl)->cac_end_time, rtw_get_current_time())) -+#define IS_UNDER_CAC(rfctl) (IS_CH_WAITING(rfctl) && rtw_time_after(rtw_get_current_time(), (rfctl)->cac_start_time)) -+#define IS_RADAR_DETECTED(rfctl) ((rfctl)->radar_detected) -+#else -+#define IS_CAC_STOPPED(rfctl) 1 -+#define IS_CH_WAITING(rfctl) 0 -+#define IS_UNDER_CAC(rfctl) 0 -+#define IS_RADAR_DETECTED(rfctl) 0 -+#endif /* CONFIG_DFS_MASTER */ -+ -+#if CONFIG_DFS_SLAVE_WITH_RADAR_DETECT -+#define IS_DFS_SLAVE_WITH_RD(rfctl) ((rfctl)->dfs_slave_with_rd) -+#else -+#define IS_DFS_SLAVE_WITH_RD(rfctl) 0 -+#endif -+ -+#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 */ -+#ifdef CONFIG_SDIO_HCI -+ /* -+ * Indirect Access for SDIO, -+ * 0:default, 1:enable, 2:disable -+ */ -+ u8 sdio_io_indir; -+#endif /* CONFIG_SDIO_HCI */ -+ -+ /* For asynchronous functions */ -+ struct halmac_indicator *indicator; -+ -+ /* Hardware parameters */ -+#ifdef CONFIG_SDIO_HCI -+ /* Store hardware tx queue page number setting */ -+ u16 txpage[HW_QUEUE_ENTRY]; -+#endif /* CONFIG_SDIO_HCI */ -+}; -+#endif /* RTW_HALMAC */ -+ -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+/*info for H2C-0x2C*/ -+struct dft_info { -+ u8 port_id; -+ u8 mac_id; -+}; -+#endif -+ -+#ifdef CONFIG_HW_P0_TSF_SYNC -+struct tsf_info { -+ u8 sync_port;/*port_x's tsf sync to port_0*/ -+ u8 offset; /*tsf timer offset*/ -+}; -+#endif -+ -+struct protsel { -+ _mutex mutex; /* protect this structure */ -+ ATOMIC_T refcnt; /* reference count */ -+ u32 sel; /* save the last sel port */ -+}; -+ -+#ifdef CONFIG_RTL8814B -+#define MAX_BULKOUT_NUM 7 -+#ifdef CONFIG_USB_HCI -+#define MAX_ENDPOINT_NUM 8 -+#endif -+#else -+#define MAX_BULKOUT_NUM 4 -+#ifdef CONFIG_USB_HCI -+#define MAX_ENDPOINT_NUM 6 -+#endif -+#endif -+ -+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; -+ -+ _mutex ioctrl_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 -+ -+#ifdef CONFIG_SYSON_INDIRECT_ACCESS -+ _mutex syson_indirect_access_mutex; /* System On Reg R/W */ -+#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 */ -+ systime on_oper_ch_time; -+ -+ u8 union_ch; -+ u8 union_bw; -+ u8 union_offset; -+ /* backup values when union_ch is set to 0 */ -+ u8 union_ch_bak; -+ u8 union_bw_bak; -+ u8 union_offset_bak; -+ -+ _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 -+ #ifdef CONFIG_SUPPORT_MULTI_BCN -+ u8 nr_ap_if; /* total interface number of ap /go /mesh / nan mode. */ -+ u16 inter_bcn_space; /* unit:ms */ -+ _queue ap_if_q; -+ u8 vap_map; -+ u8 fw_bcn_offload; -+ u8 vap_tbtt_rpt_map; -+ #endif /*CONFIG_SUPPORT_MULTI_BCN*/ -+ #ifdef CONFIG_RTW_REPEATER_SON -+ struct rtw_rson_struct rson_data; -+ #endif -+#endif -+#ifdef CONFIG_CLIENT_PORT_CFG -+ struct clt_port_t clt_port; -+#endif -+ -+#ifdef CONFIG_HW_P0_TSF_SYNC -+ struct tsf_info p0_tsf; -+#endif -+ systime periodic_tsf_update_etime; -+ _timer periodic_tsf_update_end_timer; -+ -+ 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 wow_ctl_t wow_ctl; -+ -+#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; -+ -+#if CONFIG_TX_AC_LIFETIME -+ struct tx_aclt_conf_t tx_aclt_force_val; -+ u8 tx_aclt_flags; -+ struct tx_aclt_conf_t tx_aclt_confs[TX_ACLT_CONF_NUM]; -+#endif -+ -+ /* In /Out Pipe information */ -+ int RtInPipe[2]; -+ int RtOutPipe[MAX_BULKOUT_NUM]; -+ u8 Queue2Pipe[HW_QUEUE_ENTRY];/* for out pipe mapping */ -+ -+ u8 irq_alloc; -+ ATOMIC_T continual_io_error; -+ -+ ATOMIC_T disable_func; -+ -+ u8 xmit_block; -+ _lock xmit_block_lock; -+ -+ 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 CONFIG_RTW_NAPI_DYNAMIC -+ u8 en_napi_dynamic; -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+ -+#ifdef RTW_HALMAC -+ void *halmac; -+ struct halmacpriv hmpriv; -+#endif /* RTW_HALMAC */ -+ -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ /*info for H2C-0x2C*/ -+ struct dft_info dft; -+#endif -+ -+#ifdef CONFIG_RTW_WIFI_HAL -+ u32 nodfs; -+#endif -+ -+ /*-------- below is for SDIO INTERFACE --------*/ -+ -+#ifdef INTF_DATA -+ INTF_DATA intf_data; -+#endif -+#ifdef INTF_OPS -+ INTF_OPS intf_ops; -+#endif -+ -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+ u8 tx_aval_int_thr_mode;/* if 0=>threhold set by reques(default) ;if 1=>fixed by proc; if 2: fixed by sdio_tx_max_len */ -+ u8 tx_aval_int_thr_value; -+#endif/*CONFIG_SDIO_TX_ENABLE_AVAL_INT*/ -+ -+ /*-------- 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[MAX_ENDPOINT_NUM]; /* 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_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 CONFIG_PLATFORM_RTK129X -+ unsigned long ctrl_start; -+ /* 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; -+ -+ u8 bdma64; -+#endif/* PLATFORM_LINUX */ -+ -+#endif/* CONFIG_PCI_HCI */ -+ -+#ifdef CONFIG_MCC_MODE -+ struct mcc_obj_priv mcc_objpriv; -+#endif /*CONFIG_MCC_MODE */ -+ -+#ifdef CONFIG_RTW_TPT_MODE -+ u8 tpt_mode; /* RTK T/P Testing Mode, 0:default mode */ -+ u32 edca_be_ul; -+ u32 edca_be_dl; -+#endif -+ /* also for RTK T/P Testing Mode */ -+ u8 scan_deny; -+ -+ /* protect sel to safely access */ -+#ifdef CONFIG_PROTSEL_PORT -+ struct protsel protsel_port; -+#endif -+#ifdef CONFIG_PROTSEL_ATIMDTIM -+ struct protsel protsel_atimdtim; -+#endif -+#ifdef CONFIG_PROTSEL_MACSLEEP -+ struct protsel protsel_macsleep; -+#endif -+#ifdef CONFIG_WOWLAN -+ u8 bcn_ctrl_clint3_bf_suspend; -+ u16 rxfltmap2_bf_suspend; -+ u8 lifetime_en; -+ u32 pkt_lifetime; -+ u32 rcr_bf_suspend; -+ u32 cr_ext_bf_suspend; -+#endif /* CONFIG_WOWLAN */ -+#if defined (CONFIG_CONCURRENT_MODE) && defined (CONFIG_TSF_SYNC) -+ u16 sync_tsfr_counter; -+#endif -+ -+ /* WPAS maintain from w1.fi */ -+#define RTW_WPAS_W1FI 0x00 -+ /* WPAS maintain from android */ -+#define RTW_WPAS_ANDROID 0x01 -+ u8 wpas_type; -+}; -+ -+#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_TDLS_LD_NUM(_dvobj) MSTATE_TDLS_LD_NUM(&((_dvobj)->iface_state)) -+#define DEV_AP_NUM(_dvobj) MSTATE_AP_NUM(&((_dvobj)->iface_state)) -+#define DEV_AP_STARTING_NUM(_dvobj) MSTATE_AP_STARTING_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_MESH_NUM(_dvobj) MSTATE_MESH_NUM(&((_dvobj)->iface_state)) -+#define DEV_MESH_LD_NUM(_dvobj) MSTATE_MESH_LD_NUM(&((_dvobj)->iface_state)) -+#define DEV_P2P_DV_NUM(_dvobj) MSTATE_P2P_DV_NUM(&((_dvobj)->iface_state)) -+#define DEV_P2P_GC_NUM(_dvobj) MSTATE_P2P_GC_NUM(&((_dvobj)->iface_state)) -+#define DEV_P2P_GO_NUM(_dvobj) MSTATE_P2P_GO_NUM(&((_dvobj)->iface_state)) -+#define DEV_SCAN_NUM(_dvobj) MSTATE_SCAN_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) ((_dvobj)->union_ch) -+#define DEV_U_BW(_dvobj) ((_dvobj)->union_bw) -+#define DEV_U_OFFSET(_dvobj) ((_dvobj)->union_offset) -+ -+#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)) -+#ifdef CONFIG_IOCTL_CFG80211 -+#ifdef RTW_SINGLE_WIPHY -+#define dvobj_to_wiphy(dvobj) ((dvobj)->wiphy) -+#else -+#define dvobj_to_wiphy(dvobj) (adapter_to_wiphy(dvobj_get_primary_adapter(dvobj))) -+#endif -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#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 inline 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, -+}; -+ -+#ifdef CONFIG_CLIENT_PORT_CFG -+enum _client_port { -+ CLT_PORT0 = HW_PORT1, -+ CLT_PORT1 = HW_PORT2, -+ CLT_PORT2 = HW_PORT3, -+ CLT_PORT3 = HW_PORT4, -+ CLT_PORT_INVALID = HW_PORT0, -+}; -+ -+#define MAX_CLIENT_PORT_NUM 4 -+#define get_clt_port(adapter) (adapter->client_port) -+#endif -+ -+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_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 -+ -+#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) -+ -+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 */ -+ -+ #if defined(CONFIG_AP_MODE) && defined(CONFIG_SUPPORT_MULTI_BCN) -+ _list list; -+ u8 vap_id; -+ #endif -+ struct dvobj_priv *dvobj; -+ struct mlme_priv mlmepriv; -+ struct mlme_ext_priv mlmeextpriv; -+ struct cmd_priv cmdpriv; -+ struct evt_priv evtpriv; -+ -+#ifdef CONFIG_RTW_80211K -+ struct rm_priv rmpriv; -+#endif -+ /* 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; -+ -+#ifdef CONFIG_RTW_NAPI -+ struct napi_struct napi; -+ u8 napi_state; -+#endif -+ -+#ifdef CONFIG_MP_INCLUDED -+ struct mp_priv mppriv; -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ struct hostapd_priv *phostapdpriv; -+#endif -+ -+#if defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE) || defined(CONFIG_IOCTL_CFG80211) -+ struct roch_info rochinfo; -+#endif -+ -+ 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_RTW_REPEATER_SON -+ u8 rtw_rson_scanstage; -+#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. */ -+ -+ void *HalData; -+ u32 hal_data_sz; -+ struct hal_ops hal_func; -+ -+ 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; -+#ifdef CONFIG_EVENT_THREAD_MODE -+ _thread_hdl_ evtThread; -+#endif -+#ifdef CONFIG_XMIT_THREAD_MODE -+ _thread_hdl_ xmitThread; -+#endif -+#ifdef CONFIG_RECV_THREAD_MODE -+ _thread_hdl_ recvThread; -+#endif -+ u8 registered; -+ -+ void (*intf_start)(_adapter *adapter); -+ void (*intf_stop)(_adapter *adapter); -+ -+#ifdef PLATFORM_LINUX -+ _nic_hdl pnetdev; -+ char old_ifname[IFNAMSIZ]; -+ 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 */ -+ -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ void *cmap_bss_status_evt; -+ u32 cmap_bss_status_evt_len; -+ u8 cmap_unassoc_sta_measure_en; -+#endif -+ -+#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 bLinkInfoDump; -+ /* Added by Albert 2012/10/26 */ -+ /* The driver will show up the desired channel number when this flag is 1. */ -+ u8 bNotifyChannelChange; -+ u8 bsta_tp_dump; -+#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 -+ -+ 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 */ -+ -+ #ifdef CONFIG_CLIENT_PORT_CFG -+ u8 client_id; -+ u8 client_port; -+ #endif -+ /*struct tsf_info tsf;*//*reserve define for 8814B*/ -+ -+ /*extend to support multi interface*/ -+ 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_MAC_LOOPBACK_DRIVER -+ PLOOPBACKDATA ploopback; -+#endif -+#ifdef CONFIG_AP_MODE -+ u8 bmc_tx_rate; -+ #if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ u8 b2u_flags_ap_src; -+ u8 b2u_flags_ap_fwd; -+ #endif -+#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 power_offset; -+ u8 driver_tx_bw_mode; -+ u8 rsvd_page_offset; -+ u8 rsvd_page_num; -+ u8 ch_clm_ratio; -+ u8 ch_nhm_ratio; -+#ifdef CONFIG_SUPPORT_FIFO_DUMP -+ u8 fifo_sel; -+ u32 fifo_addr; -+ u32 fifo_size; -+#endif -+ -+ 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 */ -+#ifdef CONFIG_TX_AMSDU -+ u8 tx_amsdu; -+ u16 tx_amsdu_rate; -+#endif -+ u8 driver_tx_max_agg_num; /*fix tx desc max agg num , 0xff: disable drv ctrl*/ -+#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 */ -+ -+#ifdef CONFIG_RTW_WDS -+ bool use_wds; /* for STA, AP mode */ -+ -+ /* for STA mode */ -+ struct rtw_wds_gptr_table *wds_gpt_records; -+ ATOMIC_T wds_gpt_record_num; -+ -+ /* for AP mode */ -+ #ifdef CONFIG_AP_MODE -+ struct rtw_wds_table *wds_paths; -+ ATOMIC_T wds_path_num; -+ #endif -+#endif /* CONFIG_RTW_WDS */ -+ -+#ifdef CONFIG_RTW_MULTI_AP -+ u8 multi_ap; -+ u8 ch_util_threshold; -+#endif -+ -+#ifdef CONFIG_RTW_MESH -+ struct rtw_mesh_cfg mesh_cfg; -+ struct rtw_mesh_info mesh_info; -+ _timer mesh_path_timer; -+ _timer mesh_path_root_timer; -+ _timer mesh_atlm_param_req_timer; /* airtime link metrics param request timer */ -+ _workitem mesh_work; -+ unsigned long wrkq_flags; -+#endif /* CONFIG_RTW_MESH */ -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ ATOMIC_T tbtx_tx_pause; -+ ATOMIC_T tbtx_remove_tx_pause; -+ u8 tbtx_capability; -+ u32 tbtx_duration; -+#endif /* CONFIG_RTW_TOKEN_BASED_XMIT */ -+ -+#ifdef RTW_SIMPLE_CONFIG -+ u8 rtw_simple_config; -+#endif -+}; -+ -+#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_to_macidctl(adapter) dvobj_to_macidctl(adapter_to_dvobj((adapter))) -+ -+#ifdef CONFIG_RTW_WDS -+#define adapter_use_wds(adapter) (adapter->use_wds) -+#define adapter_set_use_wds(adapter, en) do { \ -+ (adapter)->use_wds = (en) ? 1 : 0; \ -+ RTW_INFO(FUNC_ADPT_FMT" set use_wds=%d\n", FUNC_ADPT_ARG(adapter), (adapter)->use_wds); \ -+ } while (0) -+#else -+#define adapter_use_wds(adapter) 0 -+#endif -+ -+#define adapter_mac_addr(adapter) (adapter->mac_addr) -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+#define adapter_pno_mac_addr(adapter) \ -+ ((adapter_wdev_data(adapter))->pno_mac_addr) -+#endif -+ -+#define adapter_to_chset(adapter) (adapter_to_rfctl((adapter))->channel_set) -+ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/drv_types_ce.h b/drivers/net/wireless/rtl8821cs/include/drv_types_ce.h -new file mode 100644 -index 000000000..c00dea8e6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/drv_types_ce.h -@@ -0,0 +1,86 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/drv_types_gspi.h b/drivers/net/wireless/rtl8821cs/include/drv_types_gspi.h -new file mode 100644 -index 000000000..c22c49722 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/drv_types_gspi.h -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/drv_types_linux.h b/drivers/net/wireless/rtl8821cs/include/drv_types_linux.h -new file mode 100644 -index 000000000..91ca68b39 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/drv_types_linux.h -@@ -0,0 +1,19 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_LINUX_H__ -+#define __DRV_TYPES_LINUX_H__ -+ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/drv_types_pci.h b/drivers/net/wireless/rtl8821cs/include/drv_types_pci.h -new file mode 100644 -index 000000000..2c550ecc0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/drv_types_pci.h -@@ -0,0 +1,60 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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_VENDER_ID_REALTEK 0x10ec -+ -+enum aspm_mode { -+ ASPM_MODE_UND, -+ ASPM_MODE_PERF, -+ ASPM_MODE_PS, -+ ASPM_MODE_DEF, -+}; -+ -+struct pci_priv { -+ BOOLEAN pci_clk_req; -+ -+ u8 pciehdr_offset; -+ -+ u8 linkctrl_reg; -+ u8 pcibridge_linkctrlreg; -+ -+ u8 amd_l1_patch; -+ -+#ifdef CONFIG_PCI_DYNAMIC_ASPM -+ u8 aspm_mode; -+#endif -+}; -+ -+typedef struct _RT_ISR_CONTENT { -+ union { -+ u32 IntArray[2]; -+ u32 IntReg4Byte; -+ u16 IntReg2Byte; -+ }; -+} RT_ISR_CONTENT, *PRT_ISR_CONTENT; -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/drv_types_sdio.h b/drivers/net/wireless/rtl8821cs/include/drv_types_sdio.h -new file mode 100644 -index 000000000..29006d981 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/drv_types_sdio.h -@@ -0,0 +1,94 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 */ -+#ifdef PLATFORM_LINUX -+ #include -+ #include -+ #include -+ #include -+ -+ #ifdef CONFIG_PLATFORM_SPRD -+ #include -+ #include -+ #endif /* CONFIG_PLATFORM_SPRD */ -+#endif -+ -+#define RTW_SDIO_CLK_33M 33000000 -+#define RTW_SDIO_CLK_40M 40000000 -+#define RTW_SDIO_CLK_80M 80000000 -+#define RTW_SDIO_CLK_160M 160000000 -+ -+typedef struct sdio_data { -+ u8 func_number; -+ -+ u8 tx_block_mode; -+ u8 rx_block_mode; -+ u32 block_transfer_len; -+ -+#ifdef PLATFORM_LINUX -+ struct mmc_card *card; -+ struct sdio_func *func; -+ _thread_hdl_ sys_sdio_irq_thd; -+ unsigned int clock; -+ unsigned int timing; -+ u8 sd3_bus_mode; -+#endif -+ -+#ifdef DBG_SDIO -+#ifdef PLATFORM_LINUX -+ struct proc_dir_entry *proc_sdio_dbg; -+#endif /* PLATFORM_LINUX */ -+ -+ u32 cmd52_err_cnt; /* CMD52 I/O error count */ -+ u32 cmd53_err_cnt; /* CMD53 I/O error count */ -+ -+#if (DBG_SDIO >= 1) -+ u32 reg_dump_mark; /* reg dump at specific error count */ -+#endif /* DBG_SDIO >= 1 */ -+ -+#if (DBG_SDIO >= 2) -+ u8 *dbg_msg; /* Messages for debug */ -+ u8 dbg_msg_size; -+ u8 *reg_mac; /* Device MAC register, 0x0~0x800 */ -+ u8 *reg_mac_ext; /* Device MAC extend register, 0x1000~0x1800 */ -+ u8 *reg_local; /* Device SDIO local register, 0x0~0xFF */ -+ u8 *reg_cia; /* SDIO CIA(CCCR, FBR and etc.), 0x0~0x1FF */ -+#endif /* DBG_SDIO >= 2 */ -+ -+#if (DBG_SDIO >= 3) -+ u8 dbg_enable; /* 0/1: disable/enable debug mode */ -+ u8 err_stop; /* Stop(surprise remove) when I/O error happen */ -+ u8 err_test; /* Simulate error happen */ -+ u8 err_test_triggered; /* Simulate error already triggered */ -+#endif /* DBG_SDIO >= 3 */ -+#endif /* DBG_SDIO */ -+} 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) -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/drv_types_xp.h b/drivers/net/wireless/rtl8821cs/include/drv_types_xp.h -new file mode 100644 -index 000000000..81c45047a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/drv_types_xp.h -@@ -0,0 +1,88 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/ethernet.h b/drivers/net/wireless/rtl8821cs/include/ethernet.h -new file mode 100644 -index 000000000..ef518cc41 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/ethernet.h -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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) ((((u8 *)(_pAddr))[0]&0x01) != 0) /* !< Is Multicast Address? */ -+#define RT_ETH_IS_BROADCAST(_pAddr) (\ -+ ((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 --git a/drivers/net/wireless/rtl8821cs/include/gspi_hal.h b/drivers/net/wireless/rtl8821cs/include/gspi_hal.h -new file mode 100644 -index 000000000..6da0f071d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/gspi_hal.h -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 --git a/drivers/net/wireless/rtl8821cs/include/gspi_ops.h b/drivers/net/wireless/rtl8821cs/include/gspi_ops.h -new file mode 100644 -index 000000000..bcfaad2e0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/gspi_ops.h -@@ -0,0 +1,180 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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); -+#endif /* CONFIG_WOWLAN */ -+ -+#endif /* __GSPI_OPS_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/gspi_ops_linux.h b/drivers/net/wireless/rtl8821cs/include/gspi_ops_linux.h -new file mode 100644 -index 000000000..0ba263de8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/gspi_ops_linux.h -@@ -0,0 +1,18 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/gspi_osintf.h b/drivers/net/wireless/rtl8821cs/include/gspi_osintf.h -new file mode 100644 -index 000000000..a94e65679 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/gspi_osintf.h -@@ -0,0 +1,19 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/h2clbk.h b/drivers/net/wireless/rtl8821cs/include/h2clbk.h -new file mode 100644 -index 000000000..4df14b98d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/h2clbk.h -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _H2CLBK_H_ -+ -+ -+void _lbk_cmd(PADAPTER Adapter); -+ -+void _lbk_rsp(PADAPTER Adapter); -+ -+void _lbk_evt(PADAPTER Adapter); -+ -+void h2c_event_callback(unsigned char *dev, unsigned char *pbuf); -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_btcoex.h b/drivers/net/wireless/rtl8821cs/include/hal_btcoex.h -new file mode 100644 -index 000000000..a2e125ec8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_btcoex.h -@@ -0,0 +1,108 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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; -+ 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_AntInfoSetting(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_WLRFKNotify(PADAPTER padapter, u8 path, u8 type, 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); -+void hal_btcoex_set_policy_control(PADAPTER padapter, u8 btc_policy); -+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); -+u8 hal_btcoex_query_reduced_wl_pwr_lvl(PADAPTER padapter); -+void hal_btcoex_set_reduced_wl_pwr_lvl(PADAPTER padapter, u8 val); -+void hal_btcoex_do_reduce_wl_pwr_lvl(PADAPTER 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_pta_off_on_notify(PADAPTER padapter, u8 bBTON); -+void hal_btcoex_SetAntIsolationType(PADAPTER padapter, u8 anttype); -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ int hal_btcoex_AntIsolationConfig_ParaFile(PADAPTER Adapter, 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); -+void hal_btcoex_WlFwDbgInfoNotify(PADAPTER padapter, u8* tmpBuf, u8 length); -+void hal_btcoex_rx_rate_change_notify(PADAPTER padapter, u8 is_data_frame, u8 rate_id); -+u16 hal_btcoex_btset_testode(PADAPTER padapter, u8 type); -+ -+#ifdef CONFIG_RF4CE_COEXIST -+void hal_btcoex_set_rf4ce_link_state(u8 state); -+u8 hal_btcoex_get_rf4ce_link_state(void); -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+#include /* sdio multi coex */ -+#endif -+ -+#endif /* !__HAL_BTCOEX_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_btcoex_wifionly.h b/drivers/net/wireless/rtl8821cs/include/hal_btcoex_wifionly.h -new file mode 100644 -index 000000000..407698baa ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_btcoex_wifionly.h -@@ -0,0 +1,89 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_WIFIONLY_H__ -+#define __HALBTC_WIFIONLY_H__ -+ -+#include -+#include -+ -+/* Define the ICs that support wifi only cfg in coex. codes */ -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) \ -+|| defined(CONFIG_RTL8723F) -+#define CONFIG_BTCOEX_SUPPORT_WIFI_ONLY_CFG 1 -+#else -+#define CONFIG_BTCOEX_SUPPORT_WIFI_ONLY_CFG 0 -+#endif -+ -+/* Define the ICs that support hal btc common file structure */ -+#if defined(CONFIG_RTL8822C) || (defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8723F)&& defined(CONFIG_BT_COEXIST)) -+#define CONFIG_BTCOEX_SUPPORT_BTC_CMN 1 -+#else -+#define CONFIG_BTCOEX_SUPPORT_BTC_CMN 0 -+#endif -+ -+#if (CONFIG_BTCOEX_SUPPORT_WIFI_ONLY_CFG == 1) -+ -+typedef enum _WIFIONLY_CHIP_INTERFACE { -+ WIFIONLY_INTF_UNKNOWN = 0, -+ WIFIONLY_INTF_PCI = 1, -+ WIFIONLY_INTF_USB = 2, -+ WIFIONLY_INTF_SDIO = 3, -+ WIFIONLY_INTF_MAX -+} WIFIONLY_CHIP_INTERFACE, *PWIFIONLY_CHIP_INTERFACE; -+ -+typedef enum _WIFIONLY_CUSTOMER_ID { -+ CUSTOMER_NORMAL = 0, -+ CUSTOMER_HP_1 = 1 -+} WIFIONLY_CUSTOMER_ID, *PWIFIONLY_CUSTOMER_ID; -+ -+struct wifi_only_haldata { -+ u16 customer_id; -+ u8 efuse_pg_antnum; -+ u8 efuse_pg_antpath; -+ u8 rfe_type; -+ u8 ant_div_cfg; -+}; -+ -+struct wifi_only_cfg { -+ void *Adapter; -+ struct wifi_only_haldata haldata_info; -+ WIFIONLY_CHIP_INTERFACE chip_interface; -+}; -+ -+void halwifionly_write1byte(void *pwifionlyContext, u32 RegAddr, u8 Data); -+void halwifionly_write2byte(void *pwifionlyContext, u32 RegAddr, u16 Data); -+void halwifionly_write4byte(void *pwifionlyContext, u32 RegAddr, u32 Data); -+u8 halwifionly_read1byte(void *pwifionlyContext, u32 RegAddr); -+u16 halwifionly_read2byte(void *pwifionlyContext, u32 RegAddr); -+u32 halwifionly_read4byte(void *pwifionlyContext, u32 RegAddr); -+void halwifionly_bitmaskwrite1byte(void *pwifionlyContext, u32 regAddr, u8 bitMask, u8 data); -+void halwifionly_phy_set_rf_reg(void *pwifionlyContext, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -+void halwifionly_phy_set_bb_reg(void *pwifionlyContext, u32 RegAddr, u32 BitMask, u32 Data); -+void hal_btcoex_wifionly_switchband_notify(PADAPTER padapter); -+void hal_btcoex_wifionly_scan_notify(PADAPTER padapter); -+void hal_btcoex_wifionly_connect_notify(PADAPTER padapter); -+void hal_btcoex_wifionly_hw_config(PADAPTER padapter); -+void hal_btcoex_wifionly_initlizevariables(PADAPTER padapter); -+void hal_btcoex_wifionly_AntInfoSetting(PADAPTER padapter); -+#else -+#define hal_btcoex_wifionly_switchband_notify(padapter) -+#define hal_btcoex_wifionly_scan_notify(padapter) -+#define hal_btcoex_wifionly_connect_notify(padapter) -+#define hal_btcoex_wifionly_hw_config(padapter) -+#define hal_btcoex_wifionly_initlizevariables(padapter) -+#define hal_btcoex_wifionly_AntInfoSetting(padapter) -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_com.h b/drivers/net/wireless/rtl8821cs/include/hal_com.h -new file mode 100755 -index 000000000..a46f95ff6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_com.h -@@ -0,0 +1,758 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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" -+#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 DESC_RATE_NUM 0x54 -+ -+#define IS_CCK_HRATE(_rate) ((_rate) <= DESC_RATE11M) -+#define IS_OFDM_HRATE(_rate) ((_rate) >= DESC_RATE6M && (_rate) <= DESC_RATE54M) -+#define IS_LEGACY_HRATE(_rate) ((_rate) <= DESC_RATE54M) -+#define IS_HT_HRATE(_rate) ((_rate) >= DESC_RATEMCS0 && (_rate) <= DESC_RATEMCS31) -+#define IS_VHT_HRATE(_rate) ((_rate) >= DESC_RATEVHTSS1MCS0 && (_rate) <= DESC_RATEVHTSS4MCS9) -+ -+#define IS_HT1SS_HRATE(_rate) ((_rate) >= DESC_RATEMCS0 && (_rate) <= DESC_RATEMCS7) -+#define IS_HT2SS_HRATE(_rate) ((_rate) >= DESC_RATEMCS8 && (_rate) <= DESC_RATEMCS15) -+#define IS_HT3SS_HRATE(_rate) ((_rate) >= DESC_RATEMCS16 && (_rate) <= DESC_RATEMCS23) -+#define IS_HT4SS_HRATE(_rate) ((_rate) >= DESC_RATEMCS24 && (_rate) <= DESC_RATEMCS31) -+ -+#define IS_VHT1SS_HRATE(_rate) ((_rate) >= DESC_RATEVHTSS1MCS0 && (_rate) <= DESC_RATEVHTSS1MCS9) -+#define IS_VHT2SS_HRATE(_rate) ((_rate) >= DESC_RATEVHTSS2MCS0 && (_rate) <= DESC_RATEVHTSS2MCS9) -+#define IS_VHT3SS_HRATE(_rate) ((_rate) >= DESC_RATEVHTSS3MCS0 && (_rate) <= DESC_RATEVHTSS3MCS9) -+#define IS_VHT4SS_HRATE(_rate) ((_rate) >= DESC_RATEVHTSS4MCS0 && (_rate) <= DESC_RATEVHTSS4MCS9) -+ -+#define IS_1SS_HRATE(_rate) (IS_CCK_HRATE((_rate)) || IS_OFDM_HRATE((_rate)) || IS_HT1SS_HRATE((_rate)) || IS_VHT1SS_HRATE((_rate))) -+#define IS_2SS_HRATE(_rate) (IS_HT2SS_HRATE((_rate)) || IS_VHT2SS_HRATE((_rate))) -+#define IS_3SS_HRATE(_rate) (IS_HT3SS_HRATE((_rate)) || IS_VHT3SS_HRATE((_rate))) -+#define IS_4SS_HRATE(_rate) (IS_HT4SS_HRATE((_rate)) || IS_VHT4SS_HRATE((_rate))) -+ -+#define HRARE_SS_NUM(_rate) (IS_1SS_HRATE(_rate) ? 1 : (IS_2SS_HRATE(_rate) ? 2 : (IS_3SS_HRATE(_rate) ? 3 : (IS_4SS_HRATE(_rate) ? 4 : 0)))) -+ -+extern const char * const _HDATA_RATE[]; -+#define HDATA_RATE(rate) ((rate) >= DESC_RATE_NUM ? _HDATA_RATE[DESC_RATE_NUM] : _HDATA_RATE[rate]) -+ -+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, -+ #ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ WOW_KEEPALIVE_ACK_TIMEOUT = 0x60, -+ WOW_KEEPALIVE_WAKE = 0x61, -+ #endif/*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ AP_OFFLOAD_WAKEUP = 0x66, -+ NO_WAKE_RX_PAIRWISEKEY = 0xB0, -+ NO_WAKE_RX_GTK = 0xB1, -+ NO_WAKE_RX_DISASSOC = 0xB2, -+ NO_WAKE_RX_DEAUTH = 0xB3, -+ NO_WAKE_RX_EAPREQ_IDENTIFY = 0xB4, -+ NO_WAKE_FW_DECISION_DISCONNECT = 0xB5, -+ CLK_32K_UNLOCK = 0xFD, -+ CLK_32K_LOCK = 0xFE -+}WAKEUP_REASON; -+ -+typedef enum _BCN_EARLY_INT_CASE{ -+ TDLS_BCN_ERLY_ON, -+ TDLS_BCN_ERLY_OFF -+}BCN_EARLY_INT_CASE; -+ -+/* -+ * 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; -+}; -+ -+u8 rtw_hal_get_port(_adapter *adapter); -+ -+#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_mi_set_mbid_cam(_adapter *adapter); -+ u8 rtw_mbid_camid_alloc(_adapter *adapter, u8 *mac_addr); -+ void rtw_ap_set_mbid_num(_adapter *adapter, u8 ap_num); -+ void rtw_mbid_cam_enable(_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); -+ #ifdef CONFIG_SWTIMER_BASED_TXBCN -+ u16 rtw_hal_bcn_interval_adjust(_adapter *adapter, u16 bcn_interval); -+ #endif -+ void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode); -+#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); -+ -+#define BAND_CAP_2G BIT0 -+#define BAND_CAP_5G BIT1 -+#define BAND_CAP_6G BIT2 -+#define BAND_CAP_BIT_NUM 3 -+ -+#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 -+ -+#define TBTT_PROHIBIT_SETUP_TIME 0x04 /* 128us, unit is 32us */ -+#define TBTT_PROHIBIT_HOLD_TIME 0x80 /* 4ms, unit is 32us*/ -+#define TBTT_PROHIBIT_HOLD_TIME_STOP_BCN 0x64 /* 3.2ms unit is 32us*/ -+ -+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); -+bool hal_is_mimo_support(_adapter *adapter); -+u8 hal_largest_bw(_adapter *adapter, u8 in_bw); -+ -+bool hal_chk_wl_func(_adapter *adapter, u8 func); -+ -+void hal_com_config_channel_plan( -+ PADAPTER padapter, -+ const char *hw_alpha2, -+ u8 hw_chplan, -+ u8 hw_chplan_6g, -+ BOOLEAN AutoLoadFail -+); -+ -+int hal_config_macaddr(_adapter *adapter, bool autoload_fail); -+#ifdef RTW_HALMAC -+void rtw_hal_hw_port_enable(_adapter *adapter); -+void rtw_hal_hw_port_disable(_adapter *adapter); -+#endif -+ -+BOOLEAN -+HAL_IsLegalChannel( -+ PADAPTER Adapter, -+ u32 Channel -+); -+ -+u8 MRateToHwRate(enum MGN_RATE rate); -+ -+u8 hw_rate_to_m_rate(u8 hw_rate); -+#ifdef CONFIG_RTW_DEBUG -+void dump_hw_rate_map_test(void *sel); -+#endif -+ -+void HalSetBrateCfg( -+ PADAPTER Adapter, -+ u8 *mBratesOS, -+ u16 *pBrateCfg); -+ -+BOOLEAN -+Hal_MappingOutPipe( -+ PADAPTER pAdapter, -+ u8 NumOutPipe -+); -+ -+void rtw_dump_fw_info(void *sel, _adapter *adapter); -+void rtw_restore_hw_port_cfg(_adapter *adapter); -+void rtw_mi_set_mac_addr(_adapter *adapter);/*set mac addr when hal_init for all iface*/ -+void rtw_hal_dump_macaddr(void *sel, _adapter *adapter); -+void rtw_hal_set_hw_macaddr(PADAPTER adapter, u8 *mac_addr); -+ -+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_get_mgntframe_raid(_adapter *adapter, unsigned char network_type); -+ -+void rtw_hal_update_sta_wset(_adapter *adapter, struct sta_info *psta); -+s8 rtw_get_sta_rx_nss(_adapter *adapter, struct sta_info *psta); -+s8 rtw_get_sta_tx_nss(_adapter *adapter, struct sta_info *psta); -+void rtw_hal_update_sta_ra_info(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); -+ -+u8 rtw_hal_rcr_check(_adapter *adapter, u32 check_bit); -+ -+u8 rtw_hal_rcr_add(_adapter *adapter, u32 add); -+u8 rtw_hal_rcr_clear(_adapter *adapter, u32 clear); -+void rtw_hal_rcr_set_chk_bssid(_adapter *adapter, u8 self_action); -+void rtw_hal_rcr_set_chk_bssid_act_non(_adapter *adapter); -+ -+void rtw_iface_enable_tsf_update(_adapter *adapter); -+void rtw_iface_disable_tsf_update(_adapter *adapter); -+void rtw_hal_periodic_tsf_update_chk(_adapter *adapter); -+void rtw_hal_periodic_tsf_update_end_timer_hdl(void *ctx); -+ -+#if CONFIG_TX_AC_LIFETIME -+#define TX_ACLT_CONF_DEFAULT 0 -+#define TX_ACLT_CONF_AP_M2U 1 -+#define TX_ACLT_CONF_MESH 2 -+#define TX_ACLT_CONF_NUM 3 -+ -+extern const char *const _tx_aclt_conf_str[]; -+#define tx_aclt_conf_str(conf) (((conf) >= TX_ACLT_CONF_NUM) ? _tx_aclt_conf_str[TX_ACLT_CONF_NUM] : _tx_aclt_conf_str[(conf)]) -+ -+struct tx_aclt_conf_t { -+ u8 en; -+ u32 vo_vi; -+ u32 be_bk; -+}; -+ -+void dump_tx_aclt_force_val(void *sel, struct dvobj_priv *dvobj); -+void rtw_hal_set_tx_aclt_force_val(_adapter *adapter, struct tx_aclt_conf_t *input, u8 arg_num); -+void dump_tx_aclt_confs(void *sel, struct dvobj_priv *dvobj); -+void rtw_hal_set_tx_aclt_conf(_adapter *adapter, u8 conf_idx, struct tx_aclt_conf_t *input, u8 arg_num); -+void rtw_hal_update_tx_aclt(_adapter *adapter); -+#endif -+ -+void hw_var_port_switch(_adapter *adapter); -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+u8 rtw_hal_set_ap_bcn_imr_cmd(struct _ADAPTER *adapter, u8 enable); -+#endif -+void rtw_var_set_basic_rate(PADAPTER padapter, u8 *val); -+u8 SetHwReg(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg(PADAPTER padapter, u8 variable, u8 *val); -+void rtw_hal_check_rxfifo_full(_adapter *adapter); -+void rtw_hal_reqtxrpt(_adapter *padapter, u8 macid); -+int rtw_get_sta_tx_stat(_adapter *adapter, u8 mac_id, u8 *macaddr); -+ -+u8 SetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value); -+u8 GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value); -+ -+u32 -+MapCharToHexDigit( -+ char chTmp -+); -+ -+BOOLEAN -+GetHexValueFromString( -+ char *szStr, -+ u32 *pu4bVal, -+ u32 *pu4bMove -+); -+ -+BOOLEAN -+GetFractionValueFromString( -+ char *szStr, -+ u8 *pInteger, -+ u8 *pFraction, -+ u32 *pu4bMove -+); -+ -+BOOLEAN -+IsCommentString( -+ char *szStr -+); -+ -+BOOLEAN -+ParseQualifiedString( -+ char *In, -+ u32 *Start, -+ char *Out, -+ char LeftQualifier, -+ char RightQualifier -+); -+ -+BOOLEAN -+GetU1ByteIntegerFromStringInDecimal( -+ char *Str, -+ 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 -+u32 Hal_readPGDataFromConfigFile(PADAPTER padapter); -+u32 Hal_ReadMACAddrFromFile(PADAPTER padapter, u8 *mac_addr); -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+ -+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); -+ -+u8 rtw_get_current_tx_rate(_adapter *padapter, struct sta_info *psta); -+u8 rtw_get_current_tx_sgi(_adapter *padapter, struct sta_info *psta); -+#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA -+void rtw_hal_set_pathb_phase(_adapter *adapter, u8 phase_idx); -+#endif -+void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished); -+u8 rtw_hal_get_rsvd_page_num(struct _ADAPTER *adapter); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+int rtw_hal_reset_tsf(_adapter *adapter, u8 reset_port); -+#endif -+u64 rtw_hal_get_tsftr_by_port(_adapter *adapter, u8 port); -+ -+#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 -+#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) -+s32 rtw_hal_set_wifi_btc_port_id_cmd(_adapter *adapter); -+#endif -+ -+void rtw_lps_state_chk(_adapter *adapter, u8 ps_mode); -+ -+#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_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); -+void rtw_hal_set_input_gpio(_adapter *padapter, u8 index); -+#define GPIO_OUTPUT_LOW 0 -+#define GPIO_OUTPUT_HIGH 1 -+#endif -+ -+#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_RTS_FULL_BW -+void rtw_set_rts_bw(_adapter *padapter); -+#endif/*CONFIG_RTS_FULL_BW*/ -+ -+void ResumeTxBeacon(_adapter *padapter); -+void StopTxBeacon(_adapter *padapter); -+ -+#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 -+#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_DRV_RSVDPAGE_NUM(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x04, 8, 8, _value)/*Txbuf used page number for fw offload*/ -+#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*/ -+enum lps_pg_hdl_id { -+ LPS_PG_INFO_CFG = 0, -+ LPS_PG_REDLEMEM, -+ LPS_PG_PHYDM_DIS, -+ LPS_PG_PHYDM_EN, -+}; -+ -+u8 rtw_hal_set_lps_pg_info_cmd(_adapter *adapter); -+u8 rtw_hal_set_lps_pg_info(_adapter *adapter); -+#endif -+ -+int rtw_hal_get_rsvd_page(_adapter *adapter, u32 page_offset, u32 page_num, u8 *buffer, u32 buffer_size); -+void rtw_hal_construct_beacon(_adapter *padapter, u8 *pframe, u32 *pLength); -+void rtw_hal_construct_NullFunctionData(PADAPTER, u8 *pframe, u32 *pLength, -+ u8 bQoS, u8 AC, u8 bEosp, u8 bForcePowerSave); -+ -+bool _rtw_wow_chk_cap(_adapter *adapter, u8 cap); -+#ifdef CONFIG_WOWLAN -+struct rtl_wow_pattern { -+ u16 crc; -+ u8 type; -+ u32 mask[4]; -+}; -+void rtw_wow_pattern_cam_dump(_adapter *adapter); -+ -+void rtw_dump_wow_pattern(void *sel, struct rtl_wow_pattern *pwow_pattern, u8 idx); -+#ifdef CONFIG_WOW_PATTERN_HW_CAM -+void rtw_wow_pattern_read_cam_ent(_adapter *adapter, u8 id, struct rtl_wow_pattern *context); -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+struct pno_ssid; -+void rtw_hal_construct_ProbeReq(_adapter *padapter, u8 *pframe, -+ u32 *pLength, struct pno_ssid *ssid); -+#endif -+ -+struct rtw_ndp_info { -+ u8 enable:1; -+ u8 check_remote_ip:1; /* Need to Check Sender IP or not */ -+ u8 rsvd:6; -+ u8 num_of_target_ip; /* Number of Check IP which NA query IP */ -+ u8 target_link_addr[6]; /* DUT's MAC address */ -+ u8 remote_ipv6_addr[16]; /* Just respond IP */ -+ u8 target_ipv6_addr[16]; /* target IP */ -+}; -+#define REMOTE_INFO_CTRL_SET_VALD_EN(target, _value) \ -+ SET_BITS_TO_LE_4BYTE(target + 0, 0, 8, _value) -+#define REMOTE_INFO_CTRL_SET_PTK_EN(target, _value) \ -+ SET_BITS_TO_LE_4BYTE(target + 1, 0, 1, _value) -+#define REMOTE_INFO_CTRL_SET_GTK_EN(target, _value) \ -+ SET_BITS_TO_LE_4BYTE(target + 1, 1, 1, _value) -+#define REMOTE_INFO_CTRL_SET_GTK_IDX(target, _value) \ -+ SET_BITS_TO_LE_4BYTE(target + 2, 0, 8, _value) -+#endif /*CONFIG_WOWLAN*/ -+ -+#ifdef CONFIG_PROC_DEBUG -+void rtw_dump_phy_cap(void *sel, _adapter *adapter); -+#endif -+void rtw_dump_rsvd_page(void *sel, _adapter *adapter, u8 page_offset, u8 page_num); -+#ifdef CONFIG_SUPPORT_FIFO_DUMP -+void rtw_dump_fifo(void *sel, _adapter *adapter, u8 fifo_sel, u32 fifo_addr, u32 fifo_size); -+#endif -+ -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+s32 rtw_hal_set_default_port_id_cmd(_adapter *adapter, u8 mac_id); -+s32 rtw_set_default_port_id(_adapter *adapter); -+s32 rtw_set_ps_rsvd_page(_adapter *adapter); -+ -+#define get_dft_portid(adapter) (adapter_to_dvobj(adapter)->dft.port_id) -+#define get_dft_macid(adapter) (adapter_to_dvobj(adapter)->dft.mac_id) -+ -+/*void rtw_search_default_port(_adapter *adapter);*/ -+#endif -+ -+#ifdef CONFIG_P2P_PS -+#ifdef RTW_HALMAC -+void rtw_set_p2p_ps_offload_cmd(_adapter *adapter, u8 p2p_ps_state); -+#endif -+#endif -+ -+#ifdef RTW_CHANNEL_SWITCH_OFFLOAD -+void rtw_hal_switch_chnl_and_set_bw_offload(_adapter *adapter, u8 central_ch, u8 pri_ch_idx, u8 bw); -+#endif -+ -+s16 translate_dbm_to_percentage(s16 signal); -+ -+#ifdef CONFIG_SUPPORT_MULTI_BCN -+void rtw_ap_multi_bcn_cfg(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+#ifdef CONFIG_BCN_RECOVERY -+u8 rtw_ap_bcn_recovery(_adapter *padapter); -+#endif -+#ifdef CONFIG_BCN_XMIT_PROTECT -+u8 rtw_ap_bcn_queue_empty_check(_adapter *padapter, u32 txbcn_timer_ms); -+#endif -+#endif /*CONFIG_SWTIMER_BASED_TXBCN*/ -+ -+#ifdef CONFIG_FW_HANDLE_TXBCN -+void rtw_ap_mbid_bcn_en(_adapter *adapter, u8 mbcn_id); -+void rtw_ap_mbid_bcn_dis(_adapter *adapter, u8 mbcn_id); -+#endif -+ -+void rtw_hal_get_trx_path(struct dvobj_priv *d, enum rf_type *type, -+ enum bb_path *tx, enum bb_path *rx); -+#ifdef CONFIG_BEAMFORMING -+#ifdef RTW_BEAMFORMING_VERSION_2 -+void rtw_hal_beamforming_config_csirate(PADAPTER adapter); -+#endif -+#endif -+ -+u8 phy_get_capable_tx_num(_adapter *adapter, enum MGN_RATE rate); -+u8 phy_get_current_tx_num(_adapter *adapter, enum MGN_RATE rate); -+ -+#ifdef CONFIG_RTL8812A -+u8 * rtw_hal_set_8812a_vendor_ie(_adapter *padapter , u8 *pframe ,uint *frlen ); -+#endif -+ -+#ifdef CONFIG_PROTSEL_PORT -+void rtw_enter_protsel_port(_adapter *padapter, u8 port_sel); -+bool rtw_assert_protsel_port(_adapter *padapter, u32 addr, u8 len); -+void rtw_leave_protsel_port(_adapter *padapter); -+#else -+static inline void rtw_enter_protsel_port(_adapter *padapter, u8 port_sel) {} -+static inline bool rtw_assert_protsel_port(_adapter *padapter, u32 addr, u8 len) {return true; } -+static inline void rtw_leave_protsel_port(_adapter *padapter) {} -+#endif -+#ifdef CONFIG_PROTSEL_ATIMDTIM -+void rtw_enter_protsel_atimdtim(_adapter *padapter, u8 port_sel); -+bool rtw_assert_protsel_atimdtim(_adapter *padapter, u32 addr, u8 len); -+void rtw_leave_protsel_atimdtim(_adapter *padapter); -+#else -+static inline void rtw_enter_protsel_atimdtim(_adapter *padapter, u8 port_sel) {} -+static inline bool rtw_assert_protsel_atimdtim(_adapter *padapter, u32 addr, u8 len) {return true; } -+static inline void rtw_leave_protsel_atimdtim(_adapter *padapter) {} -+#endif -+#ifdef CONFIG_PROTSEL_MACSLEEP -+void rtw_enter_protsel_macsleep(_adapter *padapter, u8 sel); -+bool rtw_assert_protsel_macsleep(_adapter *padapter, u32 addr, u8 len); -+void rtw_leave_protsel_macsleep(_adapter *padapter); -+#else -+static inline void rtw_enter_protsel_macsleep(_adapter *padapter, u8 port_sel) {} -+static inline bool rtw_assert_protsel_macsleep(_adapter *padapter, u32 addr, u8 len) {return true; } -+static inline void rtw_leave_protsel_macsleep(_adapter *padapter) {} -+#endif -+ -+#ifndef RTW_HALMAC -+void rtw_hal_init_sifs_backup(_adapter *adapter); -+#endif -+ -+#endif /* __HAL_COMMON_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_com_h2c.h b/drivers/net/wireless/rtl8821cs/include/hal_com_h2c.h -new file mode 100755 -index 000000000..3ab2a4b05 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_com_h2c.h -@@ -0,0 +1,830 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_CUSTOMER_STR_REQ = 0x06, -+ H2C_TXPWR_IDX_OFFLOAD = 0x07, -+ 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_RQT_TSF = 0x15, -+ H2C_MCC_MACID_BITMAP = 0x16, -+ H2C_MCC_LOCATION = 0x10, -+ H2C_MCC_CTRL_V2 = 0x17, -+ H2C_MCC_CTRL = 0x18, -+ H2C_MCC_TIME_SETTING = 0x19, -+ H2C_MCC_IQK_PARAM = 0x1A, -+#endif /* CONFIG_MCC_MODE */ -+ H2C_CHNL_SWITCH_OPER_OFFLOAD = 0x1C, -+ H2C_SINGLE_CHANNELSWITCH_V2 = 0x1D, -+ -+ /* 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 -+ -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+ H2C_DEFAULT_PORT_ID = 0x2C, -+#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, -+#ifdef RTW_PER_CMD_SUPPORT_FW -+ H2C_REQ_PER_RPT = 0x4e, -+#endif -+ /* 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, -+#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) -+ H2C_BTC_WL_PORT_ID = 0x71, -+#endif -+ /* 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_GPIO_CUSTOM = 0x89, -+ H2C_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_P2P_OFFLOAD = 0x8B, -+#ifdef CONFIG_PNO_SUPPORT -+ H2C_NLO_INFO = 0x8C, /* for ICs that have HAMMAC */ -+#endif -+ H2C_WAR_OFFLOAD = 0x8D, -+ H2C_WAROFLD_RSVDPAGE1 = 0x8E, -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ H2C_UDP_KEEPALIVE = 0x90, -+#endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+#ifdef CONFIG_FW_HANDLE_TXBCN -+ H2C_FW_BCN_OFFLOAD = 0xBA, -+#endif -+#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR -+ H2C_FW_CRC5_SEARCH = 0xBB, -+#endif -+ H2C_RESET_TSF = 0xC0, -+#ifdef CONFIG_FW_CORRECT_BCN -+ H2C_BCNHWSEQ = 0xC5, -+#endif -+ H2C_CUSTOMER_STR_W1 = 0xC6, -+ H2C_CUSTOMER_STR_W2 = 0xC7, -+ H2C_CUSTOMER_STR_W3 = 0xC8, -+ H2C_BT_UNKNOWN_DEVICE_WA = 0xD1, -+ H2C_SET_AP_BCN_IMR = 0xD8, -+#ifdef DBG_FW_DEBUG_MSG_PKT -+ H2C_FW_DBG_MSG_PKT = 0xE1, -+#endif /*DBG_FW_DEBUG_MSG_PKT*/ -+ H2C_MAXID, -+}; -+ -+#define H2C_INACTIVE_PS_LEN 4 -+#define H2C_RSVDPAGE_LOC_LEN 5 -+#ifdef CONFIG_FW_MULTI_PORT_SUPPORT -+#define H2C_DEFAULT_PORT_ID_LEN 2 -+#define H2C_MEDIA_STATUS_RPT_LEN 4 -+#else -+#define H2C_MEDIA_STATUS_RPT_LEN 3 -+#endif -+#define H2C_GPIO_CUSTOM_LEN 3 -+#define H2C_KEEP_ALIVE_CTRL_LEN 2 -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+#define H2C_KEEP_ALIVE_PATTERN_LEN 7 -+#endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+#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_AP_BCN_MIR_LEN 1 -+#define H2C_PSTUNEPARAM_LEN 4 -+#define H2C_MACID_CFG_LEN 7 -+#define H2C_BTMP_OPER_LEN 5 -+#define H2C_WOWLAN_LEN 7 -+#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 3 -+#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 -+#ifdef CONFIG_PNO_SUPPORT -+#define H2C_NLO_INFO_LEN 2 -+#endif -+#ifdef CONFIG_MCC_MODE -+ #define H2C_MCC_CTRL_LEN 7 -+#ifdef CONFIG_MCC_MODE_V2 -+ #define H2C_MCC_LOCATION_LEN 7 -+#else -+ #define H2C_MCC_LOCATION_LEN 3 -+#endif -+ #define H2C_MCC_MACID_BITMAP_LEN 6 -+ #define H2C_MCC_RQT_TSF_LEN 1 -+ #define H2C_MCC_TIME_SETTING_LEN 6 -+ #define H2C_MCC_IQK_PARAM_LEN 7 -+#endif /* CONFIG_MCC_MODE */ -+#ifdef CONFIG_LPS_PG -+#ifdef CONFIG_RTL8822C -+ #define H2C_LPS_PG_INFO_LEN 4 -+#else -+ #define H2C_LPS_PG_INFO_LEN 2 -+#endif -+ #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 -+ -+#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) -+#define H2C_BTC_WL_PORT_ID_LEN 1 -+#endif -+ -+#ifdef DBG_FW_DEBUG_MSG_PKT -+ #define H2C_FW_DBG_MSG_PKT_LEN 2 -+#endif /*DBG_FW_DEBUG_MSG_PKT*/ -+ -+#define H2C_SINGLE_CHANNELSWITCH_V2_LEN 3 -+#define H2C_BT_UNKNOWN_DEVICE_WA_LEN 1 -+ -+#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR -+#define H2C_FW_CRC5_SEARCH_LEN 7 -+#endif -+ -+#ifdef CONFIG_WAR_OFFLOAD -+#define H2C_WAR_OFFLOAD_LEN 3 -+#define H2C_WAROFLD_RSVDPAGE1_LEN 6 -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+ -+#define eq_mac_addr(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 cp_mac_addr(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]) -+#define cpIpv6Addr(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], (des)[6] = (src)[6], (des)[7] = (src)[7], (des)[8] = (src)[8], (des)[9] = (src)[9], (des)[10] = (src)[10], (des)[11] = (src)[11], (des)[12] = (src)[12], (des)[13] = (src)[13], (des)[14] = (src)[14], (des)[15] = (src)[15]) -+ -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+#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) -+ -+#define FW_IPS_DISABLE_BBRF BIT(0) -+#define FW_IPS_WRC BIT(1) -+ -+#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 SET_H2CCMD_MSRRPT_PARM_PORT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)) + 3, 0, 3, (__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) -+ -+#ifdef CONFIG_WAR_OFFLOAD -+#define SET_IPHDR_VERSION(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 0, __Value) -+#define SET_IPHDR_DSCP(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 1, __Value) -+#define SET_IPHDR_TOTAL_LEN(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 2, __Value) -+#define SET_IPHDR_IDENTIFIER(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 4, __Value) -+#define SET_IPHDR_FLAGS(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 6, __Value) -+#define SET_IPHDR_FRAG_OFFSET(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 7, __Value) -+#define SET_IPHDR_TTL(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 8, __Value) -+#define SET_IPHDR_PROTOCOL(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 9, __Value) -+#define SET_IPHDR_HDR_CHECKSUM(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 10, __Value) -+#define SET_IPHDR_SRC_IP_ADDR(__pHeader, __Value) cpIpAddr(((u8 *)(__pHeader))+12, (u8 *)(__Value)) -+#define SET_IPHDR_DST_IP_ADDR(__pHeader, __Value) cpIpAddr(((u8 *)(__pHeader))+16, (u8 *)(__Value)) -+#define SET_UDP_SRC_PORT(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 0, __Value) -+#define SET_UDP_DST_PORT(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 2, __Value) -+#define SET_UDP_LEN(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 4, __Value) -+#define SET_UDP_CHECKSUM(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 6, __Value) -+ -+#define SET_MDNS_HDR_FLAG(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 2, __Value) -+ -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+#ifdef CONFIG_OFFLOAD_MDNS_V6 -+#define SET_IPHDRV6_VERSION(__pHeader, __Value) SET_BITS_TO_LE_1BYTE(__pHeader, 4, 4, __Value) -+#define SET_IPHDRV6_TRAFFIC_CLASS(__pHeader, __Value) SET_BITS_TO_LE_2BYTE(__pHeader, 4, 8, __Value) -+#define SET_IPHDRV6_FLOW_LABEL(__pHeader, __Value) SET_BITS_TO_LE_4BYTE(__pHeader, 12, 20, __Value) -+#define SET_IPHDRV6_PAYLOAD_LENGTH(__pHeader, __Value) SET_BITS_TO_LE_2BYTE(((u8 *)(__pHeader)) + 4, 0, 16, __Value) -+#define SET_IPHDRV6_NEXT_HEADER(__pHeader, __Value) SET_BITS_TO_LE_1BYTE((__pHeader) + 6, 0, 8, __Value) -+#define SET_IPHDRV6_HOP_LIMIT(__pHeader, __Value) SET_BITS_TO_LE_1BYTE((__pHeader) + 7, 0, 8, __Value) -+#define SET_IPHDRV6_SRC_IP_ADDR(__pHeader, __Value) cpIpv6Addr((u8 *)(__pHeader) + 8, (u8 *)(__Value)) -+#define SET_IPHDRV6_DST_IP_ADDR(__pHeader, __Value) cpIpv6Addr((u8 *)(__pHeader) + 24, (u8 *)(__Value)) -+#endif -+ -+ -+ -+#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_MESH 7 -+#define H2C_MSR_ROLE_MAX 8 -+ -+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_PORT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 3, __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_TRY_BCN_FAIL_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_DISCONDECISION_PARM_DISCONNECT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_H2CCMD_DISCONDECISION_PORT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 3, __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) -+#define SET_H2CCMD_DISCONDECISION_PARM_TRY_OK_BCN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/*UDP_KEEP_ALIVE 0x90*/ -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+/*data 0*/ -+#define SET_H2CCMD_UDP_KEEP_ALIVE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value); -+#define SET_H2CCMD_UDP_KEEP_ALIVE_PACKET_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 7, __Value); -+/*data 1*/ -+#define SET_H2CCMD_UDP_KEEP_ALIVE_ACK_PATTERN_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value); -+#define SET_H2CCMD_UDP_KEEP_ALIVE_ACK_PATTERN_idx(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 7, __Value); -+/*data 2*/ -+#define SET_H2CCMD_UDP_KEEP_ALIVE_WAKE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value); -+#define SET_H2CCMD_UDP_KEEP_ALIVE_WAKE_PATTERN_idx(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value); -+/*data3*/ -+#define SET_H2CCMD_UDP_KEEP_ALIVE_PERIOD_LOW_BIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value); -+/*data4*/ -+#define SET_H2CCMD_UDP_KEEP_ALIVE_PERIOD_HI_BIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value); -+/*data5*/ -+#define SET_H2CCMD_UDP_KEEP_ALIVE_RETRY_INTERVAL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value); -+/*data6*/ -+#define SET_H2CCMD_UDP_KEEP_ALIVE_RETRY_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value); -+#endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+#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 */ -+ -+#ifdef CONFIG_FW_OFFLOAD_SET_TXPWR_IDX -+#define H2C_TXPWR_IDX_OFFLOAD_LEN 4 -+#define SET_H2CCMD_TXPWR_IDX_CCK(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_TXPWR_IDX_OFDM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd + 1, 0, 8, __Value) -+#define SET_H2CCMD_TXPWR_IDX_HT1SS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd + 2, 0, 8, __Value) -+#define SET_H2CCMD_TXPWR_IDX_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd + 3, 0, 1, __Value) -+#endif -+ -+/* _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_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) -+#define SET_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+#define GET_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+/* _PWR_MOD_CMD_0x20 */ -+ -+#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_IGNORE_PS(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_INACTIVE_PERIOD_SCAN_EN(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_INACTIVE_DISBBRF(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_H2CCMD_INACTIVE_PORT_NUM(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 3, __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_FW_MULTI_PORT_SUPPORT -+/* DEFAULT PORT ID 0x2C*/ -+#define SET_H2CCMD_DFTPID_PORT_ID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 8, (__Value)) -+#define SET_H2CCMD_DFTPID_MAC_ID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)) + 1, 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) -+#define SET_H2CCMD_MCC_PWRIDX_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 3, 0, 1, __Value) -+#define SET_H2CCMD_MCC_PWRIDX_OFFLOAD_RFNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 3, 4, 4, __Value) -+#define SET_H2CCMD_MCC_PWRIDX_RSVDPAGE_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 4, 0, 8, __Value) -+ -+/* MCC RQT TSF 0x15 */ -+#define SET_H2CCMD_MCC_RQT_TSFX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_H2CCMD_MCC_RQT_TSFY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __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) -+ -+/* NEW MCC CTRL CMD 0x17 */ -+#define SET_H2CCMD_MCC_CTRL_V2_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_TOTALNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_CENTRAL_CH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_PRIMARY_CH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 4, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 4, 4, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 3, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_INCURCH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 3, 1, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_DIS_SW_RETRY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 1, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_DISTXNULL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 5, 1, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_C2HRPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 6, 2, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_TSFX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 4, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_NULL_EARLY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 4, 4, __Value) -+#define SET_H2CCMD_MCC_CTRL_V2_UPDATE_PARM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 7, 1, __Value) -+ -+ -+/* MCC CTRL CMD 0x18 */ -+#define SET_H2CCMD_MCC_CTRL_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_H2CCMD_MCC_CTRL_TOTALNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_H2CCMD_MCC_CTRL_CHIDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_MCC_CTRL_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) -+#define SET_H2CCMD_MCC_CTRL_BW40SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 2, 3, __Value) -+#define SET_H2CCMD_MCC_CTRL_BW80SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 5, 3, __Value) -+#define SET_H2CCMD_MCC_CTRL_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_MCC_CTRL_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 3, __Value) -+#define SET_H2CCMD_MCC_CTRL_INCURCH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 3, 1, __Value) -+#define SET_H2CCMD_MCC_CTRL_RSVD0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 4, __Value) -+#define SET_H2CCMD_MCC_CTRL_RSVD1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+#define SET_H2CCMD_MCC_CTRL_RFETYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 0, 4, __Value) -+#define SET_H2CCMD_MCC_CTRL_DISTXNULL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 4, 1, __Value) -+#define SET_H2CCMD_MCC_CTRL_C2HRPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 5, 2, __Value) -+#define SET_H2CCMD_MCC_CTRL_CHSCAN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 7, 1, __Value) -+ -+/* MCC Time CMD 0x19 */ -+#define SET_H2CCMD_MCC_TIME_SETTING_FW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_MCC_TIME_SETTING_TSF_SYNC_OFFSET(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 7, __Value) -+#define SET_H2CCMD_MCC_TIME_SETTING_START_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_MCC_TIME_SETTING_INTERVAL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_MCC_TIME_SETTING_EARLY_SWITCH_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_MCC_TIME_SETTING_ORDER_BASE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 4, __Value) -+#define SET_H2CCMD_MCC_TIME_SETTING_ORDER_SYNC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 4, __Value) -+#define SET_H2CCMD_MCC_TIME_SETTING_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 1, __Value) -+#define SET_H2CCMD_MCC_TIME_SETTING_ORDER0_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 1, 7, __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, 4, __Value) -+#define SET_H2CCMD_MCC_IQK_PATH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 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) -+ -+/* H2C_SINGLE_CHANNELSWITCH_V2 = 0x1D */ -+#define SET_H2CCMD_SINGLE_CH_SWITCH_V2_CENTRAL_CH_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_SINGLE_CH_SWITCH_V2_PRIMARY_CH_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 0, 4, __Value) -+#define SET_H2CCMD_SINGLE_CH_SWITCH_V2_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 4, 4, __Value) -+#define SET_H2CCMD_SINGLE_CH_SWITCH_V2_PWR_IDX_UPDATE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 2, 0, 1, __Value) -+#define SET_H2CCMD_SINGLE_CH_SWITCH_V2_IQK_UPDATE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 2, 1, 1, __Value) -+#define SET_H2CCMD_SINGLE_CH_SWITCH_V2_CH_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 2, 4, 4, __Value) -+ -+#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) -+#define SET_H2CCMD_BTC_WL_PORT_ID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __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((__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_DISABLE_UPHY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 1, __Value) -+#define SET_H2CCMD_WOWLAN_HST2DEV_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 1, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_DURATION_MS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 2, 1, __Value) -+#define SET_H2CCMD_WOWLAN_CHANGE_UNIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 2, 1, __Value) -+#define SET_H2CCMD_WOWLAN_UNIT_FOR_UPHY_DISABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 3, 1, __Value) -+#define SET_H2CCMD_WOWLAN_TAKE_PDN_UPHY_DIS_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_INPUT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 5, 1, __Value) -+#define SET_H2CCMD_WOWLAN_DEV2HST_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 7, 1, __Value) -+#define SET_H2CCMD_WOWLAN_TIME_FOR_UPHY_DISABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+#define SET_H2CCMD_WOWLAN_RISE_HST2DEV(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 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 */ -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NDP_INFO(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 0, 8, __Value) -+ -+/* AOAC_RSVDPAGE_2_0x84 */ -+ -+/* AOAC_RSVDPAGE_3_0x88 */ -+#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) -+ -+/* NLO SCAN offload for ICs that have HALMAC */ -+#define SET_H2CCMD_NLO_FUN_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 1, __Value) -+#define SET_H2CCMD_NLO_PS_32K(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 1, 1, __Value) -+#define SET_H2CCMD_NLO_LOC_NLO_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+/* _GPIO_CUSTOM_CMD_0x89 */ -+#define SET_H2CCMD_CUSTOMERID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_SPECIAL_WAKE_REASON(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_CUSTOM_WAKE_REASON(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 1, __Value) -+ -+#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*/ -+#define SET_H2CCMD_LPSPG_DPK_INFO_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value)/*Loc_LPS_PG_DPK_info*/ -+#define SET_H2CCMD_LPSPG_IQK_INFO_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 3, 0, 8, __Value)/*Loc_IQK_result*/ -+#endif -+ -+#if defined(CONFIG_RTL8822C) && defined(CONFIG_SUPPORT_DYNAMIC_TXPWR) -+#define SET_H2CCMD_FW_CRC5_SEARCH_EN(cmd, v) \ -+ SET_BITS_TO_LE_1BYTE((cmd), 0, 1, (v)); -+#define SET_H2CCMD_FW_CRC5_SEARCH_MACID(cmd, v) \ -+ SET_BITS_TO_LE_1BYTE((cmd), 1, 7, (v)); -+#define SET_H2CCMD_FW_CRC5_SEARCH_MAC(cmd, mac) \ -+ do { \ -+ int __offset = 0; \ -+ for (__offset = 0; __offset < ETH_ALEN; __offset++) \ -+ SET_BITS_TO_LE_1BYTE((u8 *)(cmd + __offset), 0, 8, *((u8 *)(mac + __offset))); \ -+ } while(0) -+#endif -+ -+#ifdef CONFIG_WAR_OFFLOAD -+/* WarOffload_Info_0x8D */ -+#define SET_H2CCMD_WAR_CFG_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_WAR_CFG_ARP_RSP_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_WAR_CFG_MDNSV4_RSP_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 2, 1, __Value) -+#define SET_H2CCMD_WAR_CFG_MDNSV6_RSP_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 3, 1, __Value) -+#define SET_H2CCMD_WAR_CFG_MDNSV4_WAKE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 6, 1, __Value) -+#define SET_H2CCMD_WAR_CFG_MDNSV6_WAKE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 7, 1, __Value) -+ -+/* H2C_WAROFLD_RSVDPAGE1 */ -+#define SET_H2CCMD_WAROFLD_RSVDPAGE1_LOC_PARM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 8, __Value) -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+ -+/* BT_UNKNOWN_DEVICE_WA_0xD1 */ -+#define SET_H2CCMD_BT_UNKNOWN_DEVICE_WA_HANG_CHK_EN(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_BT_UNKNOWN_DEVICE_WA_FORCE_IB_EN(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_BT_UNKNOWN_DEVICE_WA_HWID_CHK_EN(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_BT_UNKNOWN_DEVICE_WA_ONE_TIME_CHK(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+ -+#ifdef DBG_FW_DEBUG_MSG_PKT -+#define SET_H2CCMD_FW_DBG_MSG_PKT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value)/*sniffer_dbg_en*/ -+#define SET_H2CCMD_RSVDPAGE_LOC_FW_DBG_MSG_PKT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) /*loc_debug_packet*/ -+#endif /*DBG_FW_DEBUG_MSG_PKT*/ -+ -+#ifdef DBG_RSVD_PAGE_CFG -+#define RSVD_PAGE_CFG(ops, v1, v2, v3) \ -+ RTW_INFO("=== [RSVD][%s]-NeedPage:%d, TotalPageNum:%d TotalPacketLen:%d ===\n", \ -+ ops, v1, v2, v3) -+#else -+#define RSVD_PAGE_CFG(ops, v1, v2, v3) do {} while (0) -+#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 LocNDPInfo; -+ u8 LocAOACReport; -+#ifdef CONFIG_PNO_SUPPORT -+ u8 LocPNOInfo; -+ u8 LocScanInfo; -+ u8 LocSSIDInfo; -+ u8 LocProbePacket; -+#endif /* CONFIG_PNO_SUPPORT */ -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ u8 LocKeepAlive; -+#endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+#ifdef CONFIG_WAR_OFFLOAD -+ u8 LocIpParm; -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+ u8 LocMdnsPara; -+ u8 LocMdnsv4; -+ u8 LocMdnsv6; -+#endif /* defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) */ -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+#endif /* CONFIG_WOWLAN */ -+ u8 LocApOffloadBCN; -+#ifdef CONFIG_P2P_WOWLAN -+ u8 LocP2PBeacon; -+ u8 LocP2PProbeRsp; -+ u8 LocNegoRsp; -+ u8 LocInviteRsp; -+ u8 LocPDRsp; -+#endif /* CONFIG_P2P_WOWLAN */ -+#ifdef DBG_FW_DEBUG_MSG_PKT -+ u8 loc_fw_dbg_msg_pkt; -+#endif /*DBG_FW_DEBUG_MSG_PKT*/ -+} RSVDPAGE_LOC, *PRSVDPAGE_LOC; -+ -+struct rsvd_page_cache_t { -+ char *name; -+ u8 loc; -+ u8 page_num; -+ u8 *data; -+ u32 size; -+}; -+ -+bool rsvd_page_cache_update_all(struct rsvd_page_cache_t *cache, u8 loc -+ , u8 txdesc_len, u32 page_size, u8 *info, u32 info_len); -+bool rsvd_page_cache_update_data(struct rsvd_page_cache_t *cache, u8 *info -+ , u32 info_len); -+void rsvd_page_cache_free_data(struct rsvd_page_cache_t *cache); -+void rsvd_page_cache_free(struct rsvd_page_cache_t *cache); -+ -+#endif -+#ifdef CONFIG_WOWLAN -+void dump_TX_FIFO(PADAPTER padapter, u8 page_num, u16 page_size); -+#endif -+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 -+ -+#ifdef RTW_PER_CMD_SUPPORT_FW -+u8 rtw_hal_set_req_per_rpt_cmd(_adapter *adapter, u8 group_macid, -+ u8 rpt_type, u32 macid_bitmap); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_com_led.h b/drivers/net/wireless/rtl8821cs/include/hal_com_led.h -new file mode 100644 -index 000000000..379c4fdd1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_com_led.h -@@ -0,0 +1,437 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_LED_H_ -+#define __HAL_COMMON_LED_H_ -+ -+#define NO_LED 0 -+#define HW_LED 1 -+ -+#ifdef CONFIG_RTW_LED -+#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, /* unspecific data TX, including single & group addressed */ -+ LED_CTL_RX = 5, /* unspecific data RX, including single & group addressed */ -+ LED_CTL_UC_TX = 6, /* single addressed data TX */ -+ LED_CTL_UC_RX = 7, /* single addressed data RX */ -+ LED_CTL_BMC_TX = 8, /* group addressed data TX */ -+ LED_CTL_BMC_RX = 9, /* group addressed data RX */ -+ LED_CTL_SITE_SURVEY = 10, -+ LED_CTL_POWER_OFF = 11, -+ LED_CTL_START_TO_LINK = 12, -+ LED_CTL_START_WPS = 13, -+ LED_CTL_STOP_WPS = 14, -+ LED_CTL_START_WPS_BOTTON = 15, /* added for runtop */ -+ LED_CTL_STOP_WPS_FAIL = 16, /* added for ALPHA */ -+ LED_CTL_STOP_WPS_FAIL_OVERLAP = 17, /* added for BELKIN */ -+ LED_CTL_CONNECTION_NO_TRANSFER = 18, -+} 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 { -+ /* start from 2 */ -+ SW_LED_MODE_UC_TRX_ONLY = 2, -+ 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 */ -+} 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( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+); -+ -+void -+gen_RefreshLedState( -+ 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 { -+ /* start from 2 */ -+ SW_LED_MODE_UC_TRX_ONLY = 2, -+ 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 */ -+} 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; -+#ifdef CONFIG_RTW_SW_LED -+void -+LedControlUSB( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+); -+#endif -+ -+ -+/* ******************************************************************************** -+ * 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 { -+ /* start from 2 */ -+ SW_LED_MODE_UC_TRX_ONLY = 2, -+ 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 */ -+} 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( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+); -+ -+#endif -+ -+struct led_priv { -+ LED_STRATEGY LedStrategy; -+#ifdef CONFIG_RTW_SW_LED -+ LED_DATA SwLed0; -+ LED_DATA SwLed1; -+ LED_DATA SwLed2; -+ u8 bRegUseLed; -+ u8 iface_en_mask; -+ u32 ctl_en_mask[CONFIG_IFACE_NUMBER]; -+ void (*LedControlHandler)(_adapter *padapter, LED_CTL_MODE LedAction); -+ void (*SwLedOn)(_adapter *padapter, PLED_DATA pLed); -+ void (*SwLedOff)(_adapter *padapter, PLED_DATA pLed); -+#endif -+}; -+ -+#define SwLedOn(adapter, pLed) \ -+ do { \ -+ if (adapter_to_led(adapter)->SwLedOn) \ -+ adapter_to_led(adapter)->SwLedOn((adapter), (pLed)); \ -+ } while (0) -+ -+#define SwLedOff(adapter, pLed) \ -+ do { \ -+ if (adapter_to_led(adapter)->SwLedOff) \ -+ adapter_to_led(adapter)->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); -+void dump_led_config(void *sel, _adapter *adapter); -+void rtw_led_set_strategy(_adapter *adapter, u8 strategy); -+#endif /* CONFIG_RTW_LED */ -+ -+#if defined(CONFIG_RTW_LED) -+#define rtw_led_get_strategy(adapter) (adapter_to_led(adapter)->LedStrategy) -+#else -+#define rtw_led_get_strategy(adapter) NO_LED -+#endif -+ -+#define IS_NO_LED_STRATEGY(s) ((s) == NO_LED) -+#define IS_HW_LED_STRATEGY(s) ((s) == HW_LED) -+#define IS_SW_LED_STRATEGY(s) ((s) != NO_LED && (s) != HW_LED) -+ -+#if defined(CONFIG_RTW_LED) && defined(CONFIG_RTW_SW_LED) -+ -+#ifndef CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY -+#define CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY 0 -+#endif -+ -+#if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY -+void rtw_sw_led_blink_uc_trx_only(LED_DATA *led); -+void rtw_sw_led_ctl_mode_uc_trx_only(_adapter *adapter, LED_CTL_MODE ctl); -+#endif -+void rtw_led_control(_adapter *adapter, LED_CTL_MODE ctl); -+void rtw_led_tx_control(_adapter *adapter, const u8 *da); -+void rtw_led_rx_control(_adapter *adapter, const u8 *da); -+void rtw_led_set_iface_en(_adapter *adapter, u8 en); -+void rtw_led_set_iface_en_mask(_adapter *adapter, u8 mask); -+void rtw_led_set_ctl_en_mask(_adapter *adapter, u32 ctl_mask); -+void rtw_led_set_ctl_en_mask_primary(_adapter *adapter); -+void rtw_led_set_ctl_en_mask_virtual(_adapter *adapter); -+#else -+#define rtw_led_control(adapter, ctl) do {} while (0) -+#define rtw_led_tx_control(adapter, da) do {} while (0) -+#define rtw_led_rx_control(adapter, da) do {} while (0) -+#define rtw_led_set_iface_en(adapter, en) do {} while (0) -+#define rtw_led_set_iface_en_mask(adapter, mask) do {} while (0) -+#define rtw_led_set_ctl_en_mask(adapter, ctl_mask) do {} while (0) -+#define rtw_led_set_ctl_en_mask_primary(adapter) do {} while (0) -+#define rtw_led_set_ctl_en_mask_virtual(adapter) do {} while (0) -+#endif /* defined(CONFIG_RTW_LED) && defined(CONFIG_RTW_SW_LED) */ -+ -+#endif /*__HAL_COMMON_LED_H_*/ -+ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_com_phycfg.h b/drivers/net/wireless/rtl8821cs/include/hal_com_phycfg.h -new file mode 100755 -index 000000000..52bb80532 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_com_phycfg.h -@@ -0,0 +1,341 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+#ifndef DBG_TX_POWER_IDX -+#define DBG_TX_POWER_IDX 0 -+#endif -+ -+#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; -+ -+enum txpwr_pg_mode { -+ TXPWR_PG_WITH_PWR_IDX, -+ TXPWR_PG_WITH_TSSI_OFFSET, -+ TXPWR_PG_UNKNOWN, /* keep last */ -+}; -+ -+/*------------------------------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; -+ -+ -+/* ---------------------------------------------------------------------- */ -+ -+extern const char *const _txpwr_pg_mode_str[]; -+#define txpwr_pg_mode_str(_mode) (((_mode) >= TXPWR_PG_UNKNOWN) ? _txpwr_pg_mode_str[TXPWR_PG_UNKNOWN] : _txpwr_pg_mode_str[(_mode)]) -+ -+u8 phy_get_target_txpwr( -+ PADAPTER Adapter, -+ u8 Band, -+ u8 RfPath, -+ RATE_SECTION RateSection -+); -+ -+void -+PHY_GetRateValuesOfTxPowerByRate( -+ PADAPTER pAdapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Value, -+ u8 *Rate, -+ s8 *PwrByRateVal, -+ u8 *RateNum -+); -+ -+u8 phy_get_rate_idx_of_txpwr_by_rate(enum MGN_RATE rate); -+ -+void -+phy_set_tx_power_index_by_rate_section( -+ PADAPTER pAdapter, -+ enum rf_path RFPath, -+ u8 Channel, -+ u8 RateSection -+); -+ -+s8 phy_get_txpwr_by_rate(_adapter *adapter -+ , BAND_TYPE band, enum rf_path rfpath, RATE_SECTION rs, enum MGN_RATE rate); -+ -+s16 phy_get_txpwr_by_rate_single_mbm(_adapter *adapter -+ , BAND_TYPE band, enum rf_path rfpath, RATE_SECTION rs, enum MGN_RATE rate, bool eirp); -+s16 phy_get_txpwr_by_rate_total_mbm(_adapter *adapter -+ , BAND_TYPE band, RATE_SECTION rs, enum MGN_RATE rate, bool cap, bool eirp); -+ -+s16 phy_get_txpwr_by_rate_single_max_mbm(_adapter *adapter, BAND_TYPE band, enum rf_path rfpath, bool eirp); -+s16 phy_get_txpwr_by_rate_total_max_mbm(_adapter *adapter, BAND_TYPE band, bool cap, bool eirp); -+ -+void -+phy_set_tx_power_level_by_path( -+ PADAPTER Adapter, -+ u8 channel, -+ u8 path -+); -+ -+void -+PHY_InitTxPowerByRate( -+ PADAPTER pAdapter -+); -+ -+void -+phy_store_tx_power_by_rate( -+ PADAPTER pAdapter, -+ u32 Band, -+ u32 RfPath, -+ u32 TxNum, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+); -+ -+void -+PHY_TxPowerByRateConfiguration( -+ PADAPTER pAdapter -+); -+ -+bool phy_chk_ch_setting_consistency(_adapter *adapter, u8 ch); -+ -+#ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX -+u8 phy_get_pg_txpwr_idx(_adapter *pAdapter -+ , enum rf_path RFPath, RATE_SECTION rs, u8 ntx_idx -+ , enum channel_width BandWidth, u8 band, u8 Channel); -+#endif -+ -+#if CONFIG_TXPWR_LIMIT -+s8 phy_get_txpwr_lmt(_adapter *adapter -+ , const char *lmt_name -+ , BAND_TYPE band, enum channel_width bw -+ , u8 tlrs, u8 ntx_idx, u8 cch, u8 lock -+); -+ -+s8 phy_get_txpwr_lmt_diff(_adapter *adapter -+ , const char *lmt_name -+ , BAND_TYPE band, enum channel_width bw -+ , u8 rfpath, u8 rs, u8 tlrs, u8 ntx_idx, u8 cch, u8 lock -+); -+ -+s8 phy_get_txpwr_lmt_sub_chs(_adapter *adapter -+ , const char *lmt_name -+ , BAND_TYPE band, enum channel_width bw -+ , u8 rfpath, u8 rate, u8 ntx_idx, u8 cch, u8 opch, bool reg_max -+); -+#else -+#define phy_get_txpwr_lmt(adapter, lmt_name, band, bw, tlrs, ntx_idx, cch, lock) (GET_HAL_SPEC(adapter)->txgi_max) -+#define phy_get_txpwr_lmt_diff(adapter, lmt_name, band, bw, rfpath, rs, tlrs, ntx_idx, cch, lock) (GET_HAL_SPEC(adapter)->txgi_max) -+#define phy_get_txpwr_lmt_sub_chs(adapter, lmt_name, band, bw, rfpath, rate, ntx_idx, cch, opch, reg_max) (GET_HAL_SPEC(adapter)->txgi_max) -+#endif /* CONFIG_TXPWR_LIMIT */ -+ -+void dump_txpwr_tpc_settings(void *sel, _adapter *adapter); -+void dump_txpwr_antenna_gain(void *sel, _adapter *adapter); -+ -+s8 phy_get_txpwr_target(_adapter *adapter, u8 rfpath, RATE_SECTION rs, u8 rate, u8 ntx_idx -+ , enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch, bool reg_max, struct txpwr_idx_comp *tic); -+s8 phy_get_txpwr_amends(_adapter *adapter, u8 rfpath, RATE_SECTION rs, u8 rate, u8 ntx_idx -+ , enum channel_width bw, BAND_TYPE band, u8 cch, struct txpwr_idx_comp *tic); -+#ifdef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+s8 phy_get_tssi_txpwr_by_rate_ref(_adapter *adapter, enum rf_path path -+ , enum channel_width bw, u8 cch, u8 opch); -+#endif -+u8 hal_com_get_txpwr_idx(_adapter *adapter, enum rf_path rfpath -+ , RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch -+ , struct txpwr_idx_comp *tic); -+ -+s16 phy_get_txpwr_single_mbm(_adapter *adapter, u8 rfpath, RATE_SECTION rs, u8 rate -+ , enum channel_width bw, u8 cch, u8 opch, bool reg_max, bool eirp, struct txpwr_idx_comp *tic); -+s16 phy_get_txpwr_total_mbm(_adapter *adapter, RATE_SECTION rs, u8 rate -+ , enum channel_width bw, u8 cch, u8 opch, bool reg_max, bool eirp, struct txpwr_idx_comp *tic); -+ -+s16 phy_get_txpwr_single_max_mbm(_adapter *adapter, u8 rfpath -+ , enum channel_width bw, u8 cch, u8 opch, u16 bmp_cck_ofdm, u32 bmp_ht, u64 bmp_vht, bool reg_max, bool eirp); -+s16 phy_get_txpwr_total_max_mbm(_adapter *adapter -+ , enum channel_width bw, u8 cch, u8 opch, u16 bmp_cck_ofdm, u32 bmp_ht, u64 bmp_vht, bool reg_max, bool eirp); -+ -+s8 -+phy_get_tx_power_final_absolute_value(_adapter *adapter, u8 rfpath, u8 rate, -+ enum channel_width bw, u8 channel); -+ -+s8 -+PHY_GetTxPowerTrackingOffset( -+ PADAPTER pAdapter, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+struct txpwr_idx_comp { -+ u8 ntx_idx; -+ s8 target; -+ s8 base; -+ -+ /* for target */ -+ s8 by_rate; -+ s8 btc; -+ s8 extra; -+ s8 utarget; -+ s8 rlimit; /* regulatory limit w/o HAL consideration */ -+ s8 limit; /* limit from RTK private (regulatory limit w/ HAL consideration) */ -+ s8 ulimit; /* user limit */ -+ s8 tpc; -+ -+ /* for amends */ -+ s8 tpt; -+ s8 dpd; -+}; -+ -+u8 phy_get_tx_power_index_ex(_adapter *adapter -+ , enum rf_path rfpath, RATE_SECTION rs, enum MGN_RATE rate -+ , enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch); -+ -+u8 -+phy_get_tx_power_index( -+ PADAPTER pAdapter, -+ enum rf_path RFPath, -+ u8 Rate, -+ enum channel_width BandWidth, -+ u8 Channel -+); -+ -+void -+PHY_SetTxPowerIndex( -+ PADAPTER pAdapter, -+ u32 PowerIndex, -+ enum rf_path RFPath, -+ u8 Rate -+); -+ -+bool phy_is_txpwr_user_mbm_valid(_adapter *adapter, s16 mbm); -+bool phy_is_txpwr_user_target_specified(_adapter *adapter); -+ -+void dump_tx_power_index_inline(void *sel, _adapter *adapter, u8 rfpath -+ , enum channel_width bw, u8 cch, enum MGN_RATE rate, u8 pwr_idx, struct txpwr_idx_comp *tic); -+#ifdef CONFIG_PROC_DEBUG -+void dump_tx_power_idx_title(void *sel, _adapter *adapter -+ , enum channel_width bw, u8 cch, u8 opch); -+void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath -+ , RATE_SECTION rs, enum channel_width bw, u8 cch, u8 opch); -+void dump_tx_power_idx(void *sel, _adapter *adapter -+ , enum channel_width bw, u8 cch, u8 opch); -+void dump_txpwr_total_dbm_title(void *sel, _adapter *adapter -+ , enum channel_width bw, u8 cch, u8 opch); -+void dump_txpwr_total_dbm_by_rs(void *sel, _adapter *adapter, u8 rs -+ , enum channel_width bw, u8 cch, u8 opch); -+void dump_txpwr_total_dbm(void *sel, _adapter *adapter -+ , enum channel_width bw, u8 cch, u8 opch); -+#endif -+ -+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); -+#if CONFIG_TXPWR_LIMIT -+int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file); -+#endif -+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); -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+int check_phy_efuse_tx_power_info_valid(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX -+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); -+#endif -+ -+#ifdef CONFIG_PROC_DEBUG -+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); -+#endif -+ -+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 32768 /* 32k */ -+ -+#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(PADAPTER Adapter, char *pFileName); -+int phy_ConfigBBWithParaFile(PADAPTER Adapter, char *pFileName, u32 ConfigType); -+int phy_ConfigBBWithPgParaFile(PADAPTER Adapter, const char *pFileName); -+int phy_ConfigBBWithMpParaFile(PADAPTER Adapter, char *pFileName); -+int PHY_ConfigRFWithParaFile(PADAPTER Adapter, char *pFileName, enum rf_path eRFPath); -+int PHY_ConfigRFWithTxPwrTrackParaFile(PADAPTER Adapter, char *pFileName); -+#if CONFIG_TXPWR_LIMIT -+int PHY_ConfigRFWithPowerLimitTableParaFile(PADAPTER Adapter, const char *pFileName); -+#endif -+void phy_free_filebuf_mask(_adapter *padapter, u8 mask); -+void phy_free_filebuf(_adapter *padapter); -+#endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ -+u8 phy_check_under_survey_ch(_adapter *adapter); -+#endif /* __HAL_COMMON_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_com_reg.h b/drivers/net/wireless/rtl8821cs/include/hal_com_reg.h -new file mode 100644 -index 000000000..353a0f505 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_com_reg.h -@@ -0,0 +1,1890 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 TXREPORT_BUF_SELECT 0x7F -+#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_FE1IMR 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_TQPNT1 0x0218 -+#define REG_TQPNT2 0x021C -+#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_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_EN 0x0426 -+#define REG_MULTI_BCNQ_OFFSET 0x0427 -+#define REG_SPEC_SIFS 0x0428 -+#define REG_RETRY_LIMIT 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_LIFE_TIME 0x04C0 -+#define REG_PKT_LIFE_TIME_VO_VI 0x04C0 -+#define REG_PKT_LIFE_TIME_BE_BK 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_HW_SEQ0 0x04D8 -+#define REG_HW_SEQ1 0x04DA -+#define REG_HW_SEQ2 0x04DC -+#define REG_HW_SEQ3 0x04DE -+ -+#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_MBSSID_BCN_SPACE 0x0554 -+#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_HIQ_NO_LMT_EN 0x05A7 -+#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 -+ -+/*REG_TCR*/ -+#define BIT_PWRBIT_OW_EN BIT(7) -+ -+/* 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_WMMPS_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 -+ -+#define BIT_WKFCAM_WE BIT(16) -+#define BIT_WKFCAM_POLLING_V1 BIT(31) -+#define BIT_WKFCAM_CLR_V1 BIT(30) -+#define BIT_SHIFT_WKFCAM_ADDR_V2 8 -+#define BIT_MASK_WKFCAM_ADDR_V2 0xff -+#define BIT_WKFCAM_ADDR_V2(x) (((x) & BIT_MASK_WKFCAM_ADDR_V2) << BIT_SHIFT_WKFCAM_ADDR_V2) -+ -+/* Hardware Port 1 */ -+#define REG_MACID1 0x0700 -+#define REG_BSSID1 0x0708 -+ -+/* Enable/Disable Port 0 and Port 1 for Specific ICs (ex. 8192F)*/ -+#define REG_WLAN_ACT_MASK_CTRL_1 0x076C -+ -+/* GPIO Control */ -+#define REG_SW_GPIO_SHARE_CTRL_0 0x1038 -+#define REG_SW_GPIO_SHARE_CTRL_1 0x103C -+#define REG_SW_GPIO_A_OUT 0x1040 -+#define REG_SW_GPIO_A_OEN 0x1044 -+#define REG_SW_GPIO_B_OEN 0x1058 -+#define REG_SW_GPIO_B_OUT 0x105C -+ -+/* 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 */ -+ -+/* 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 BIT(5) /* EEPROM enable when set 1 */ -+#define CmdEERPOMSEL BIT(4) /* System EEPROM select, 0: boot from E-FUSE, 1: The EEPROM used is 9346 */ -+#define Cmd9346CR_9356SEL BIT(4) -+ -+/* ---------------------------------------------------------------------------- -+* 8192C GPIO MUX Configuration Register (offset 0x40, 4 byte) -+* ---------------------------------------------------------------------------- */ -+#define GPIOSEL_GPIO 0 -+#define GPIOSEL_ENBT BIT(5) -+ -+/* ---------------------------------------------------------------------------- -+* 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 BIT(0) -+#define HSIMR_SPS_OCP_INT_EN BIT(5) -+#define HSIMR_RON_INT_EN BIT(6) -+#define HSIMR_PDN_INT_EN BIT(7) -+#define HSIMR_GPIO9_INT_EN BIT(25) -+ -+/* ---------------------------------------------------------------------------- -+* 8723/8188E Host System Interrupt Status Register (offset 0x5C, 32 byte) -+* ---------------------------------------------------------------------------- */ -+#define HSISR_GPIO12_0_INT BIT(0) -+#define HSISR_SPS_OCP_INT BIT(5) -+#define HSISR_RON_INT BIT(6) -+#define HSISR_PDNINT BIT(7) -+#define HSISR_GPIO9_INT BIT(25) -+ -+/* ---------------------------------------------------------------------------- -+* 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 -+ -+ -+/* WOL bit information */ -+#define HAL92C_WOL_PTK_UPDATE_EVENT BIT(0) -+#define HAL92C_WOL_GTK_UPDATE_EVENT BIT(1) -+#define HAL92C_WOL_DISASSOC_EVENT BIT(2) -+#define HAL92C_WOL_DEAUTH_EVENT BIT(3) -+#define HAL92C_WOL_FW_DISCONNECT_EVENT BIT(4) -+ -+ -+/*---------------------------------------------------------------------------- -+** REG_CCK_CHECK (offset 0x454) -+------------------------------------------------------------------------------*/ -+#define BIT_BCN_PORT_SEL BIT(5) -+#define BIT_EN_BCN_PKT_REL BIT(6) -+ -+#endif /* RTW_HALMAC */ -+ -+/* ---------------------------------------------------------------------------- -+* Response Rate Set Register (offset 0x440, 24bits) -+* ---------------------------------------------------------------------------- */ -+#define RRSR_1M BIT(0) -+#define RRSR_2M BIT(1) -+#define RRSR_5_5M BIT(2) -+#define RRSR_11M BIT(3) -+#define RRSR_6M BIT(4) -+#define RRSR_9M BIT(5) -+#define RRSR_12M BIT(6) -+#define RRSR_18M BIT(7) -+#define RRSR_24M BIT(8) -+#define RRSR_36M BIT(9) -+#define RRSR_48M BIT(10) -+#define RRSR_54M BIT(11) -+#define RRSR_MCS0 BIT(12) -+#define RRSR_MCS1 BIT(13) -+#define RRSR_MCS2 BIT(14) -+#define RRSR_MCS3 BIT(15) -+#define RRSR_MCS4 BIT(16) -+#define RRSR_MCS5 BIT(17) -+#define RRSR_MCS6 BIT(18) -+#define RRSR_MCS7 BIT(19) -+ -+#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) -+ -+/* ---------------------------------------------------------------------------- -+ * 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 BIT(2) -+#define BW_OPMODE_5G BIT(1) -+ -+/* ---------------------------------------------------------------------------- -+ * CAM Config Setting (offset 0x680, 1 byte) -+ * ---------------------------------------------------------------------------- */ -+#define CAM_VALID BIT(15) -+#define CAM_NOTVALID 0x0000 -+#define CAM_USEDK BIT(5) -+ -+#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 BIT(16) -+#define CAM_READ 0x00000000 -+#define CAM_POLLINIG BIT(31) -+ -+/* -+ * 10. Power Save Control Registers -+ * */ -+#define WOW_PMEN BIT(0) /* Power management Enable. */ -+#define WOW_WOMEN BIT(1) /* WoW function on or off. */ -+#define WOW_MAGIC BIT(2) /* Magic packet */ -+#define WOW_UWF BIT(3) /* 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 BIT(31) /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5 BIT(30) /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4 BIT(29) /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3 BIT(28) /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2 BIT(27) /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1 BIT(26) /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK8 BIT(25) /* Beacon Queue DMA OK Interrupt 8 */ -+#define IMR_BCNDOK7 BIT(24) /* Beacon Queue DMA OK Interrupt 7 */ -+#define IMR_BCNDOK6 BIT(23) /* Beacon Queue DMA OK Interrupt 6 */ -+#define IMR_BCNDOK5 BIT(22) /* Beacon Queue DMA OK Interrupt 5 */ -+#define IMR_BCNDOK4 BIT(21) /* Beacon Queue DMA OK Interrupt 4 */ -+#define IMR_BCNDOK3 BIT(20) /* Beacon Queue DMA OK Interrupt 3 */ -+#define IMR_BCNDOK2 BIT(19) /* Beacon Queue DMA OK Interrupt 2 */ -+#define IMR_BCNDOK1 BIT(18) /* Beacon Queue DMA OK Interrupt 1 */ -+#define IMR_TIMEOUT2 BIT(17) /* Timeout interrupt 2 */ -+#define IMR_TIMEOUT1 BIT(16) /* Timeout interrupt 1 */ -+#define IMR_TXFOVW BIT(15) /* Transmit FIFO Overflow */ -+#define IMR_PSTIMEOUT BIT(14) /* Power save time out interrupt */ -+#define IMR_BcnInt BIT(13) /* Beacon DMA Interrupt 0 */ -+#define IMR_RXFOVW BIT(12) /* Receive FIFO Overflow */ -+#define IMR_RDU BIT(11) /* Receive Descriptor Unavailable */ -+#define IMR_ATIMEND BIT(10) /* For 92C, ATIM Window End Interrupt. For 8723 and later ICs, it also means P2P CTWin End interrupt. */ -+#define IMR_BDOK BIT(9) /* Beacon Queue DMA OK Interrupt */ -+#define IMR_HIGHDOK BIT(8) /* High Queue DMA OK Interrupt */ -+#define IMR_TBDOK BIT(7) /* Transmit Beacon OK interrupt */ -+#define IMR_MGNTDOK BIT(6) /* Management Queue DMA OK Interrupt */ -+#define IMR_TBDER BIT(5) /* For 92C, Transmit Beacon Error Interrupt */ -+#define IMR_BKDOK BIT(4) /* AC_BK DMA OK Interrupt */ -+#define IMR_BEDOK BIT(3) /* AC_BE DMA OK Interrupt */ -+#define IMR_VIDOK BIT(2) /* AC_VI DMA OK Interrupt */ -+#define IMR_VODOK BIT(1) /* AC_VO DMA Interrupt */ -+#define IMR_ROK BIT(0) /* Receive DMA OK Interrupt */ -+ -+/* 13. Host Interrupt Status Extension Register (Offset: 0x012C-012Eh) */ -+#define IMR_TSF_BIT32_TOGGLE BIT(15) -+#define IMR_BcnInt_E BIT(12) -+#define IMR_TXERR BIT(11) -+#define IMR_RXERR BIT(10) -+#define IMR_C2HCMD BIT(9) -+#define IMR_CPWM BIT(8) -+/* RSVD [2-7] */ -+#define IMR_OCPINT BIT(1) -+#define IMR_WLANOFF BIT(0) -+ -+/* ---------------------------------------------------------------------------- -+ * 8723E series PCIE Host IMR/ISR bit -+ * ---------------------------------------------------------------------------- */ -+/* IMR DW0 Bit 0-31 */ -+#define PHIMR_TIMEOUT2 BIT(31) -+#define PHIMR_TIMEOUT1 BIT(30) -+#define PHIMR_PSTIMEOUT BIT(29) -+#define PHIMR_GTINT4 BIT(28) -+#define PHIMR_GTINT3 BIT(27) -+#define PHIMR_TXBCNERR BIT(26) -+#define PHIMR_TXBCNOK BIT(25) -+#define PHIMR_TSF_BIT32_TOGGLE BIT(24) -+#define PHIMR_BCNDMAINT3 BIT(23) -+#define PHIMR_BCNDMAINT2 BIT(22) -+#define PHIMR_BCNDMAINT1 BIT(21) -+#define PHIMR_BCNDMAINT0 BIT(20) -+#define PHIMR_BCNDOK3 BIT(19) -+#define PHIMR_BCNDOK2 BIT(18) -+#define PHIMR_BCNDOK1 BIT(17) -+#define PHIMR_BCNDOK0 BIT(16) -+#define PHIMR_HSISR_IND_ON BIT(15) -+#define PHIMR_BCNDMAINT_E BIT(14) -+#define PHIMR_ATIMEND_E BIT(13) -+#define PHIMR_ATIM_CTW_END BIT(12) -+#define PHIMR_HISRE_IND BIT(11) /* RO. HISRE Indicator (HISRE & HIMRE is true, this bit is set to 1) */ -+#define PHIMR_C2HCMD BIT(10) -+#define PHIMR_CPWM2 BIT(9) -+#define PHIMR_CPWM BIT(8) -+#define PHIMR_HIGHDOK BIT(7) /* High Queue DMA OK Interrupt */ -+#define PHIMR_MGNTDOK BIT(6) /* Management Queue DMA OK Interrupt */ -+#define PHIMR_BKDOK BIT(5) /* AC_BK DMA OK Interrupt */ -+#define PHIMR_BEDOK BIT(4) /* AC_BE DMA OK Interrupt */ -+#define PHIMR_VIDOK BIT(3) /* AC_VI DMA OK Interrupt */ -+#define PHIMR_VODOK BIT(2) /* AC_VO DMA Interrupt */ -+#define PHIMR_RDU BIT(1) /* Receive Descriptor Unavailable */ -+#define PHIMR_ROK BIT(0) /* Receive DMA OK Interrupt */ -+ -+/* PCIE Host Interrupt Status Extension bit */ -+#define PHIMR_BCNDMAINT7 BIT(23) -+#define PHIMR_BCNDMAINT6 BIT(22) -+#define PHIMR_BCNDMAINT5 BIT(21) -+#define PHIMR_BCNDMAINT4 BIT(20) -+#define PHIMR_BCNDOK7 BIT(19) -+#define PHIMR_BCNDOK6 BIT(18) -+#define PHIMR_BCNDOK5 BIT(17) -+#define PHIMR_BCNDOK4 BIT(16) -+/* bit12 15: RSVD */ -+#define PHIMR_TXERR BIT(11) -+#define PHIMR_RXERR BIT(10) -+#define PHIMR_TXFOVW BIT(9) -+#define PHIMR_RXFOVW BIT(8) -+/* bit2-7: RSVD */ -+#define PHIMR_OCPINT BIT(1) -+/* bit0: RSVD */ -+ -+#define UHIMR_TIMEOUT2 BIT(31) -+#define UHIMR_TIMEOUT1 BIT(30) -+#define UHIMR_PSTIMEOUT BIT(29) -+#define UHIMR_GTINT4 BIT(28) -+#define UHIMR_GTINT3 BIT(27) -+#define UHIMR_TXBCNERR BIT(26) -+#define UHIMR_TXBCNOK BIT(25) -+#define UHIMR_TSF_BIT32_TOGGLE BIT(24) -+#define UHIMR_BCNDMAINT3 BIT(23) -+#define UHIMR_BCNDMAINT2 BIT(22) -+#define UHIMR_BCNDMAINT1 BIT(21) -+#define UHIMR_BCNDMAINT0 BIT(20) -+#define UHIMR_BCNDOK3 BIT(19) -+#define UHIMR_BCNDOK2 BIT(18) -+#define UHIMR_BCNDOK1 BIT(17) -+#define UHIMR_BCNDOK0 BIT(16) -+#define UHIMR_HSISR_IND BIT(15) -+#define UHIMR_BCNDMAINT_E BIT(14) -+/* RSVD BIT(13) */ -+#define UHIMR_CTW_END BIT(12) -+/* RSVD BIT(11) */ -+#define UHIMR_C2HCMD BIT(10) -+#define UHIMR_CPWM2 BIT(9) -+#define UHIMR_CPWM BIT(8) -+#define UHIMR_HIGHDOK BIT(7) /* High Queue DMA OK Interrupt */ -+#define UHIMR_MGNTDOK BIT(6) /* Management Queue DMA OK Interrupt */ -+#define UHIMR_BKDOK BIT(5) /* AC_BK DMA OK Interrupt */ -+#define UHIMR_BEDOK BIT(4) /* AC_BE DMA OK Interrupt */ -+#define UHIMR_VIDOK BIT(3) /* AC_VI DMA OK Interrupt */ -+#define UHIMR_VODOK BIT(2) /* AC_VO DMA Interrupt */ -+#define UHIMR_RDU BIT(1) /* Receive Descriptor Unavailable */ -+#define UHIMR_ROK BIT(0) /* Receive DMA OK Interrupt */ -+ -+/* USB Host Interrupt Status Extension bit */ -+#define UHIMR_BCNDMAINT7 BIT(23) -+#define UHIMR_BCNDMAINT6 BIT(22) -+#define UHIMR_BCNDMAINT5 BIT(21) -+#define UHIMR_BCNDMAINT4 BIT(20) -+#define UHIMR_BCNDOK7 BIT(19) -+#define UHIMR_BCNDOK6 BIT(18) -+#define UHIMR_BCNDOK5 BIT(17) -+#define UHIMR_BCNDOK4 BIT(16) -+/* bit14-15: RSVD */ -+#define UHIMR_ATIMEND_E BIT(13) -+#define UHIMR_ATIMEND BIT(12) -+#define UHIMR_TXERR BIT(11) -+#define UHIMR_RXERR BIT(10) -+#define UHIMR_TXFOVW BIT(9) -+#define UHIMR_RXFOVW BIT(8) -+/* bit2-7: RSVD */ -+#define UHIMR_OCPINT BIT(1) -+/* 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 BIT(30) /* TXRPT interrupt when CCX bit of the packet is set */ -+#define IMR_PSTIMEOUT_88E BIT(29) /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_88E BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_88E BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TBDER_88E BIT(26) /* Transmit Beacon0 Error */ -+#define IMR_TBDOK_88E BIT(25) /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_88E BIT(24) /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_88E BIT(20) /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_88E BIT(16) /* Beacon Queue DMA Error 0 */ -+#define IMR_HSISR_IND_ON_INT_88E BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_88E BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_88E BIT(12) /* CTWidnow End or ATIM Window End */ -+#define IMR_HISR1_IND_INT_88E BIT(11) /* HISR1 Indicator (HISR1 & HIMR1 is true, this bit is set to 1) */ -+#define IMR_C2HCMD_88E BIT(10) /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_88E BIT(9) /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_88E BIT(8) /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_88E BIT(7) /* High Queue DMA OK */ -+#define IMR_MGNTDOK_88E BIT(6) /* Management Queue DMA OK */ -+#define IMR_BKDOK_88E BIT(5) /* AC_BK DMA OK */ -+#define IMR_BEDOK_88E BIT(4) /* AC_BE DMA OK */ -+#define IMR_VIDOK_88E BIT(3) /* AC_VI DMA OK */ -+#define IMR_VODOK_88E BIT(2) /* AC_VO DMA OK */ -+#define IMR_RDU_88E BIT(1) /* Rx Descriptor Unavailable */ -+#define IMR_ROK_88E BIT(0) /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_88E BIT(27) /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_88E BIT(26) /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_88E BIT(25) /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_88E BIT(24) /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_88E BIT(23) /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_88E BIT(22) /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_88E BIT(21) /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_88E BIT(20) /* Beacon Queue DMA OK Interrupt 7 */ -+#define IMR_BCNDOK6_88E BIT(19) /* Beacon Queue DMA OK Interrupt 6 */ -+#define IMR_BCNDOK5_88E BIT(18) /* Beacon Queue DMA OK Interrupt 5 */ -+#define IMR_BCNDOK4_88E BIT(17) /* Beacon Queue DMA OK Interrupt 4 */ -+#define IMR_BCNDOK3_88E BIT(16) /* Beacon Queue DMA OK Interrupt 3 */ -+#define IMR_BCNDOK2_88E BIT(15) /* Beacon Queue DMA OK Interrupt 2 */ -+#define IMR_BCNDOK1_88E BIT(14) /* Beacon Queue DMA OK Interrupt 1 */ -+#define IMR_ATIMEND_E_88E BIT(13) /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_88E BIT(11) /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_88E BIT(10) /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_88E BIT(9) /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_88E BIT(8) /* 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 BIT(6) -+#define StopHigh BIT(5) -+#define StopMgt BIT(4) -+#define StopBK BIT(3) -+#define StopBE BIT(2) -+#define StopVI BIT(1) -+#define StopVO BIT(0) -+ -+/* ---------------------------------------------------------------------------- -+ * 8192C (RCR) Receive Configuration Register (Offset 0x608, 32 bits) -+ * ---------------------------------------------------------------------------- */ -+#define RCR_APPFCS BIT(31) /* WMAC append FCS after pauload */ -+#define RCR_APP_MIC BIT(30) /* MACRX will retain the MIC at the bottom of the packet. */ -+#define RCR_APP_ICV BIT(29) /* MACRX will retain the ICV at the bottom of the packet. */ -+#define RCR_APP_PHYST_RXFF BIT(28) /* PHY Status is appended before RX packet in RXFF */ -+#define RCR_APP_BA_SSN BIT(27) /* SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. */ -+#define RCR_VHT_DACK BIT(26) /* This bit to control response type for vht single mpdu data packet. 1. ACK as response 0. BA as response */ -+#define RCR_TCPOFLD_EN BIT(25) /* Enable TCP checksum offload */ -+#define RCR_ENMBID BIT(24) /* Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. */ -+#define RCR_LSIGEN BIT(23) /* Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. */ -+#define RCR_MFBEN BIT(22) /* 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 BIT(21) /* Do not check PPDU while the PPDU length is smaller than 14 byte. */ -+#define RCR_PKTCTL_DLEN BIT(20) /* While rx path dead lock occurs, reset rx path */ -+#define RCR_DISGCLK BIT(19) /* Disable macrx clock gating control (no used) */ -+#define RCR_TIM_PARSER_EN BIT(18) /* RX Beacon TIM Parser. */ -+#define RCR_BC_MD_EN BIT(17) /* Broadcast data packet more data bit check interrupt enable.*/ -+#define RCR_UC_MD_EN BIT(16) /* Unicast data packet more data bit check interrupt enable. */ -+#define RCR_RXSK_PERPKT BIT(15) /* Executing key search per MPDU */ -+#define RCR_HTC_LOC_CTRL BIT(14) /* MFC<--HTC = 1 MFC-->HTC = 0 */ -+#define RCR_AMF BIT(13) /* Accept management type frame */ -+#define RCR_ACF BIT(12) /* 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 BIT(11) /* Accept data type frame. This bit also regulates BA, BAR, and PS-Poll (AP mode only). */ -+#define RCR_DISDECMYPKT BIT(10) /* This bit determines whether hw need to do decryption.1: If A1 match, do decryption.0: Do decryption. */ -+#define RCR_AICV BIT(9) /* Accept ICV error packet */ -+#define RCR_ACRC32 BIT(8) /* Accept CRC32 error packet */ -+#define RCR_CBSSID_BCN BIT(7) /* Accept BSSID match packet (Rx beacon, probe rsp) */ -+#define RCR_CBSSID_DATA BIT(6) /* Accept BSSID match packet (Data) */ -+#define RCR_APWRMGT BIT(5) /* Accept power management packet */ -+#define RCR_ADD3 BIT(4) /* Accept address 3 match packet */ -+#define RCR_AB BIT(3) /* Accept broadcast packet */ -+#define RCR_AM BIT(2) /* Accept multicast packet */ -+#define RCR_APM BIT(1) /* Accept physical match packet */ -+#define RCR_AAP BIT(0) /* 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 REG_GPIO_INTM (Offset 0x0048) */ -+#define BIT_EXTWOL_EN BIT(16) -+ -+/* 2 REG_LED_CFG (Offset 0x004C) */ -+#define BIT_SW_SPDT_SEL BIT(22) -+ -+/* 2 REG_SW_GPIO_SHARE_CTRL_0 (Offset 0x1038) */ -+#define BIT_BTGP_WAKE_LOC (BIT(10) | BIT(11)) -+#define BIT_SW_GPIO_FUNC BIT(0) -+ -+/* 2 REG_SW_GPIO_SHARE_CTRL_1 (Offset 0x103C) */ -+#define BIT_WLMAC_DBG_LOC (BIT(9) | BIT(10)) -+#define BIT_WL_GPIO_SEL (BIT(30) | BIT(31)) -+ -+/* 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 -+#define QUEUE_EXTRA_1 4 -+#define QUEUE_EXTRA_2 5 -+ -+/* 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) -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0120h ~ 0x0123h RX DMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define BIT_FS_RXDONE_INT_EN BIT(16) -+ -+ -+/* REG_RXPKT_NUM (Offset 0x0284) */ -+#define BIT_RW_RELEASE_EN BIT(18) -+ -+/* ----------------------------------------------------- -+ * -+ * 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 BIT_SHIFT_SRL 8 -+#define BIT_MASK_SRL 0x3f -+#define BIT_SRL(x) (((x) & BIT_MASK_SRL) << BIT_SHIFT_SRL) -+ -+#define BIT_SHIFT_LRL 0 -+#define BIT_MASK_LRL 0x3f -+#define BIT_LRL(x) (((x) & BIT_MASK_LRL) << BIT_SHIFT_LRL) -+ -+#define RL_VAL_AP 7 -+#ifdef CONFIG_RTW_CUSTOMIZE_RLSTA -+#define RL_VAL_STA CONFIG_RTW_CUSTOMIZE_RLSTA -+#else -+#define RL_VAL_STA 0x30 -+#endif -+/* ----------------------------------------------------- -+ * -+ * 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 -+ -+/* 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) -+ -+/* 2 ACMHWCTRL */ -+#define AcmHw_HwEn BIT(0) -+#define AcmHw_VoqEn BIT(1) -+#define AcmHw_ViqEn BIT(2) -+#define AcmHw_BeqEn BIT(3) -+#define AcmHw_VoqStatus BIT(5) -+#define AcmHw_ViqStatus BIT(6) -+#define AcmHw_BeqStatus BIT(7) -+ -+/* 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) -+ -+/*REG_RXFLTMAP1 (Offset 0x6A2)*/ -+#define BIT_CTRLFLT10EN BIT(10) /*PS-POLL*/ -+ -+/*REG_WLAN_ACT_MASK_CTRL_1 (Offset 0x76C)*/ -+#define EN_PORT_0_FUNCTION BIT(12) -+#define EN_PORT_1_FUNCTION BIT(13) -+ -+/* ----------------------------------------------------- -+ * -+ * 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_TIMEOUT 0x0002/*SDIO status timeout*/ -+#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 BIT(0) -+#define SDIO_HIMR_AVAL_MSK BIT(1) -+#define SDIO_HIMR_TXERR_MSK BIT(2) -+#define SDIO_HIMR_RXERR_MSK BIT(3) -+#define SDIO_HIMR_TXFOVW_MSK BIT(4) -+#define SDIO_HIMR_RXFOVW_MSK BIT(5) -+#define SDIO_HIMR_TXBCNOK_MSK BIT(6) -+#define SDIO_HIMR_TXBCNERR_MSK BIT(7) -+#define SDIO_HIMR_BCNERLY_INT_MSK BIT(16) -+#define SDIO_HIMR_C2HCMD_MSK BIT(17) -+#define SDIO_HIMR_CPWM1_MSK BIT(18) -+#define SDIO_HIMR_CPWM2_MSK BIT(19) -+#define SDIO_HIMR_HSISR_IND_MSK BIT(20) -+#define SDIO_HIMR_GTINT3_IND_MSK BIT(21) -+#define SDIO_HIMR_GTINT4_IND_MSK BIT(22) -+#define SDIO_HIMR_PSTIMEOUT_MSK BIT(23) -+#define SDIO_HIMR_OCPINT_MSK BIT(24) -+#define SDIO_HIMR_ATIMEND_MSK BIT(25) -+#define SDIO_HIMR_ATIMEND_E_MSK BIT(26) -+#define SDIO_HIMR_CTWEND_MSK BIT(27) -+ -+/* RTL8188E SDIO Specific */ -+#define SDIO_HIMR_MCU_ERR_MSK BIT(28) -+#define SDIO_HIMR_TSF_BIT32_TOGGLE_MSK BIT(29) -+ -+/* SDIO Host Interrupt Service Routine */ -+#define SDIO_HISR_RX_REQUEST BIT(0) -+#define SDIO_HISR_AVAL BIT(1) -+#define SDIO_HISR_TXERR BIT(2) -+#define SDIO_HISR_RXERR BIT(3) -+#define SDIO_HISR_TXFOVW BIT(4) -+#define SDIO_HISR_RXFOVW BIT(5) -+#define SDIO_HISR_TXBCNOK BIT(6) -+#define SDIO_HISR_TXBCNERR BIT(7) -+#define SDIO_HISR_BCNERLY_INT BIT(16) -+#define SDIO_HISR_C2HCMD BIT(17) -+#define SDIO_HISR_CPWM1 BIT(18) -+#define SDIO_HISR_CPWM2 BIT(19) -+#define SDIO_HISR_HSISR_IND BIT(20) -+#define SDIO_HISR_GTINT3_IND BIT(21) -+#define SDIO_HISR_GTINT4_IND BIT(22) -+#define SDIO_HISR_PSTIMEOUT BIT(23) -+#define SDIO_HISR_OCPINT BIT(24) -+#define SDIO_HISR_ATIMEND BIT(25) -+#define SDIO_HISR_ATIMEND_E BIT(26) -+#define SDIO_HISR_CTWEND BIT(27) -+ -+/* RTL8188E SDIO Specific */ -+#define SDIO_HISR_MCU_ERR BIT(28) -+#define SDIO_HISR_TSF_BIT32_TOGGLE BIT(29) -+ -+#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 BIT(1) -+#define HCI_SUS_CTRL BIT(0) -+ -+/* 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 -+ -+/* indirect access */ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+#define SDIO_REG_INDIRECT_REG_CFG 0x40 -+#define SDIO_REG_INDIRECT_REG_DATA 0x44 -+#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) -+#endif/*CONFIG_SDIO_INDIRECT_ACCESS*/ -+ -+#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 BIT(0) /* Enable GPIO[9] as WiFi HW PDn source */ -+#define WL_HWPDN_SL BIT(1) /* WiFi HW PDn polarity control */ -+#define WL_FUNC_EN BIT(2) /* WiFi function enable */ -+#define WL_HWROF_EN BIT(3) /* Enable GPIO[9] as WiFi RF HW PDn source */ -+#define BT_HWPDN_EN BIT(16) /* Enable GPIO[11] as BT HW PDn source */ -+#define BT_HWPDN_SL BIT(17) /* BT HW PDn polarity control */ -+#define BT_FUNC_EN BIT(18) /* BT function enable */ -+#define BT_HWROF_EN BIT(19) /* Enable GPIO[11] as BT/GPS RF HW PDn source */ -+#define GPS_HWPDN_EN BIT(20) /* Enable GPIO[10] as GPS HW PDn source */ -+#define GPS_HWPDN_SL BIT(21) /* GPS HW PDn polarity control */ -+#define GPS_FUNC_EN BIT(22) /* GPS function enable */ -+ -+/* 3 REG_LIFECTRL_CTRL */ -+#define HAL92C_EN_PKT_LIFE_TIME_BK BIT(3) -+#define HAL92C_EN_PKT_LIFE_TIME_BE BIT(2) -+#define HAL92C_EN_PKT_LIFE_TIME_VI BIT(1) -+#define HAL92C_EN_PKT_LIFE_TIME_VO BIT(0) -+ -+#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 BIT(3) -+#define PARTNO_SINGLE_BAND_VS_REMARK BIT(1) -+#define PARTNO_CONCURRENT_BAND_VC (BIT3 | BIT2) -+#define PARTNO_CONCURRENT_BAND_VC_REMARK (BIT1 | BIT0) -+ -+/* ******************************************************** -+ * General definitions -+ * ******************************************************** */ -+ -+#ifdef CONFIG_USB_HCI -+ #define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E(__Adapter) (175) -+#else -+ #define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E(__Adapter) (IS_VENDOR_8188E_I_CUT_SERIES(__Adapter) ? 255 : 175) -+#endif -+#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_8188GTV 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8723D 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8710B 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8192F 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8723F 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 BIT(2) -+#define HAL_8192C_HW_GPIO_WPS_BIT BIT(2) -+#define HAL_8192EU_HW_GPIO_WPS_BIT BIT(7) -+#define HAL_8188E_HW_GPIO_WPS_BIT BIT(7) -+ -+#endif /* __HAL_COMMON_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_data.h b/drivers/net/wireless/rtl8821cs/include/hal_data.h -new file mode 100644 -index 000000000..0da9f0ccd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_data.h -@@ -0,0 +1,886 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+#if 1/* def CONFIG_SINGLE_IMG */ -+ -+#include "../hal/phydm/phydm_precomp.h" -+#ifdef CONFIG_BT_COEXIST -+ #include -+#endif -+ #include -+ -+#ifdef CONFIG_SDIO_HCI -+ #include -+#endif -+#ifdef CONFIG_GSPI_HCI -+ #include -+#endif -+ -+#if defined(CONFIG_RTW_ACS) || defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+#include "../hal/hal_dm_acs.h" -+#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 NUM_OF_TARGET_TXPWR_2G 10 /* CCK:1, OFDM:1, HT:4, VHT:4 */ -+#define NUM_OF_TARGET_TXPWR_5G 9 /* OFDM:1, HT:4, VHT:4 */ -+ -+#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 -+#ifdef CONFIG_RTL8188GTV -+ #define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8710B -+ #define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8192F -+ #define EFUSE_MAP_SIZE 512 -+#endif -+ -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8814B) -+ #define EFUSE_MAX_SIZE 1024 -+#elif defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) || defined(CONFIG_RTL8703B) || defined(CONFIG_RTL8710B) -+ #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 -+ -+#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 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]; -+ -+#if 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 wow_cap; -+ u8 macid_cap; -+ u16 macid_txrpt; -+ u8 macid_txrpt_pgsz; -+ -+ u8 rfpath_num_2g:4; /* used for tx power index path */ -+ u8 rfpath_num_5g:4; /* used for tx power index path */ -+ u8 rf_reg_path_num; -+ u8 rf_reg_path_avail_num; -+ u8 rf_reg_trx_path_bmp; /* [7:4]TX path bmp, [0:3]RX path bmp */ -+ u8 max_tx_cnt; -+ -+ u8 tx_nss_num:4; -+ u8 rx_nss_num:4; -+ -+ 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 txgi_max; /* maximum tx power gain index */ -+ u8 txgi_pdbm; /* tx power gain index per dBm */ -+ -+ u8 wl_func; /* value of WL_FUNC_XXX */ -+ -+ u8 tx_aclt_unit_factor; /* how many 32us */ -+ -+ u8 rx_tsf_filter:1; -+ -+ u8 pg_txpwr_saddr; /* starting address of PG tx power info */ -+ u8 pg_txgi_diff_factor; /* PG tx power gain index diff to tx power gain index */ -+ -+ u8 hci_type; /* value of HCI Type */ -+}; -+ -+#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) -+ -+#ifdef CONFIG_PHY_CAPABILITY_QUERY -+struct phy_spec_t { -+ u32 trx_cap; -+ u32 stbc_cap; -+ u32 ldpc_cap; -+ u32 txbf_param; -+ u32 txbf_cap; -+}; -+#endif -+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_p2p_ps_para { -+ /*DW0*/ -+ u8 offload_en:1; -+ u8 role:1; -+ u8 ctwindow_en:1; -+ u8 noa_en:1; -+ u8 noa_sel:1; -+ u8 all_sta_sleep:1; -+ u8 discovery:1; -+ u8 disable_close_rf:1; -+ u8 p2p_port_id; -+ u8 p2p_group; -+ u8 p2p_macid; -+ -+ /*DW1*/ -+ u8 ctwindow_length; -+ u8 rsvd3; -+ u8 rsvd4; -+ u8 rsvd5; -+ -+ /*DW2*/ -+ u32 noa_duration_para; -+ -+ /*DW3*/ -+ u32 noa_interval_para; -+ -+ /*DW4*/ -+ u32 noa_start_time_para; -+ -+ /*DW5*/ -+ u32 noa_count_para; -+} HAL_P2P_PS_PARA, *PHAL_P2P_PS_PARA; -+ -+#define TXPWR_LMT_RS_CCK 0 -+#define TXPWR_LMT_RS_OFDM 1 -+#define TXPWR_LMT_RS_HT 2 -+#define TXPWR_LMT_RS_VHT 3 -+#define TXPWR_LMT_RS_NUM 4 -+ -+#define TXPWR_LMT_RS_NUM_2G 4 /* CCK, OFDM, HT, VHT */ -+#define TXPWR_LMT_RS_NUM_5G 3 /* OFDM, HT, VHT */ -+ -+#if CONFIG_TXPWR_LIMIT -+extern const char *const _txpwr_lmt_rs_str[]; -+#define txpwr_lmt_rs_str(rs) (((rs) >= TXPWR_LMT_RS_NUM) ? _txpwr_lmt_rs_str[TXPWR_LMT_RS_NUM] : _txpwr_lmt_rs_str[(rs)]) -+ -+struct txpwr_lmt_ent { -+ _list list; -+ -+ s8 lmt_2g[MAX_2_4G_BANDWIDTH_NUM] -+ [TXPWR_LMT_RS_NUM_2G] -+ [CENTER_CH_2G_NUM] -+ [MAX_TX_COUNT]; -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+ s8 lmt_5g[MAX_5G_BANDWIDTH_NUM] -+ [TXPWR_LMT_RS_NUM_5G] -+ [CENTER_CH_5G_ALL_NUM] -+ [MAX_TX_COUNT]; -+#endif -+ -+ char name[0]; -+}; -+#endif /* CONFIG_TXPWR_LIMIT */ -+ -+typedef struct hal_com_data { -+ HAL_VERSION version_id; -+ 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 ******/ -+ u32 firmware_size; -+ u16 firmware_version; -+ u16 FirmwareVersionRev; -+ u16 firmware_sub_version; -+ u16 FirmwareSignature; -+ u8 RegFWOffload; -+ u8 bFWReady; -+ u8 bBTFWReady; -+ u8 fw_ractrl; -+ u8 LastHMEBoxNum; /* H2C - for host message to fw */ -+#ifdef CONFIG_LPS_1T1R -+ u8 lps_1t1r; -+#endif -+ -+ /****** current WIFI_PHY values ******/ -+ WIRELESS_MODE CurrentWirelessMode; -+ enum channel_width current_channel_bw; -+ BAND_TYPE current_band_type; /* 0:2.4G, 1:5G */ -+ u8 current_channel; -+ 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; -+ u16 BasicRateSet; -+ u32 ReceiveConfig; -+#ifdef CONFIG_WIFI_MONITOR -+ struct mon_reg_backup mon_backup; /* used for switching back from monitor mode */ -+#endif /* CONFIG_WIFI_MONITOR */ -+ u8 rx_tsf_addr_filter_config; /* for 8822B/8821C USE */ -+ BOOLEAN bSwChnl; -+ BOOLEAN bSetChnlBW; -+ BOOLEAN bSWToBW40M; -+ BOOLEAN bSWToBW80M; -+ BOOLEAN bChnlBWInitialized; -+ -+#ifdef CONFIG_RTW_ACS -+ struct auto_chan_sel acs; -+#endif -+#ifdef CONFIG_BCN_RECOVERY -+ u8 issue_bcn_fail; -+#endif /*CONFIG_BCN_RECOVERY*/ -+ -+ /****** rf_ctrl *****/ -+ u8 rf_chip; -+ -+ u8 trx_path_bmp; /* [7:4]TX path bmp, [0:3]RX path bmp */ -+ u8 rf_type; /*enum rf_type , is RF_PATH - GET_HAL_RFPATH*/ -+ u8 NumTotalRFPath; /*GET_HAL_RFPATH_NUM*/ -+ u8 max_tx_cnt; -+ u8 tx_nss; /*tx Spatial Streams - GET_HAL_TX_NSS*/ -+ u8 rx_nss; /*rx Spatial Streams - GET_HAL_RX_NSS*/ -+ u8 txpath_cap_num_nss[4]; /* capable path num for NSS TX, [0] for 1SS, [3] for 4SS */ -+ -+ u8 PackageType; -+ u8 antenna_test; -+ -+ /* runtime TRX path setting */ -+ enum bb_path txpath; /* TX path bmp */ -+ enum bb_path rxpath; /* RX path bmp */ -+ enum bb_path txpath_nss[4]; /* path bmp for NSS TX, [0] for 1SS, [3] for 4SS */ -+ u8 txpath_num_nss[4]; /* path num for NSS TX, [0] for 1SS, [3] for 4SS */ -+ -+ /****** Debug ******/ -+ u16 ForcedDataRate; /* Force Data Rate. 0: Auto, 0x02: 1M ~ 0x6C: 54M. */ -+ u8 bDumpRxPkt; -+ u8 bDumpTxPkt; -+ u8 dis_turboedca; /* 1: disable turboedca, -+ 2: disable turboedca and setting EDCA parameter based on the input parameter*/ -+ u32 edca_param_mode; -+ -+ /****** 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 eeprom_thermal_meter; -+ u8 EEPROMBluetoothCoexist; -+ u8 EEPROMBluetoothType; -+ u8 EEPROMBluetoothAntNum; -+ u8 EEPROMBluetoothAntIsolation; -+ u8 EEPROMBluetoothRadioShared; -+ u8 EEPROMMACAddr[ETH_ALEN]; -+ -+ u8 eeprom_trx_path_bmp; /* [7:4]TX path bmp, [0:3]RX path bmp. 0x00:not specified */ -+ u8 eeprom_max_tx_cnt; /* 0: not specified */ -+ -+ u8 tx_bbswing_24G; -+ u8 tx_bbswing_5G; -+ u8 efuse0x3d7; /* efuse[0x3D7] */ -+ u8 efuse0x3d8; /* efuse[0x3D8] */ -+ -+#ifdef CONFIG_RF_POWER_TRIM -+ u8 EEPROMRFGainOffset; -+ u8 EEPROMRFGainVal; -+ struct kfree_data_t kfree_data; -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+#ifdef CONFIG_RTL8814A -+ u32 BackUp_BB_REG_4_2nd_CCA[3]; -+#endif -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || \ -+ defined(CONFIG_RTL8723D) || \ -+ defined(CONFIG_RTL8192F) -+ -+ u8 adjuseVoltageVal; -+ u8 need_restore; -+#endif -+ u8 EfuseUsedPercentage; -+ u16 EfuseUsedBytes; -+ /*u8 EfuseMap[2][HWSET_MAX_SIZE_JAGUAR];*/ -+ EFUSE_HAL EfuseHal; -+ -+ u8 txpwr_pg_mode; /* enum txpwr_pg_mode */ -+ -+ /*---------------------------------------------------------------------------------*/ -+#ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ /* 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*/ -+#if 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 -+#endif /* CONFIG_TXPWR_PG_WITH_PWR_IDX */ -+ -+ u8 txpwr_by_rate_undefined_band_path[TX_PWR_BY_RATE_NUM_BAND] -+ [TX_PWR_BY_RATE_NUM_RF]; -+ -+ s8 TxPwrByRate[TX_PWR_BY_RATE_NUM_BAND] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RATE]; -+ -+ /* Store the target power for each rate section and rf path */ -+ u8 target_txpwr_2g[TX_PWR_BY_RATE_NUM_RF] -+ [NUM_OF_TARGET_TXPWR_2G]; -+ u8 target_txpwr_5g[TX_PWR_BY_RATE_NUM_RF] -+ [NUM_OF_TARGET_TXPWR_5G]; -+ -+ bool set_entire_txpwr; -+ -+#if defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8814B) \ -+ || defined(CONFIG_RTL8723F) -+ u32 txagc_set_buf; -+#endif -+ -+#ifdef CONFIG_FW_OFFLOAD_SET_TXPWR_IDX -+ u8 txpwr_idx_offload_buf[3]; /* for CCK, OFDM, HT1SS */ -+ struct submit_ctx txpwr_idx_offload_sctx; -+#endif -+ -+ u8 txpwr_by_rate_loaded:1; -+ u8 txpwr_by_rate_from_file:1; -+ u8 txpwr_limit_loaded:1; -+ u8 txpwr_limit_from_file:1; -+ -+ /* Read/write are allow for following hardware information variables */ -+ u8 crystal_cap; -+ -+ u8 PAType_2G; -+ u8 PAType_5G; -+ u8 LNAType_2G; -+ u8 LNAType_5G; -+ u8 ExternalPA_2G; -+ u8 ExternalLNA_2G; -+ u8 external_pa_5g; -+ u8 external_lna_5g; -+ u16 TypeGLNA; -+ u16 TypeGPA; -+ u16 TypeALNA; -+ u16 TypeAPA; -+ u16 rfe_type; -+ -+ u8 bLedOpenDrain; /* Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. */ -+ u32 ac_param_be; /* Original parameter for BE, use for EDCA turbo. */ -+ u8 is_turbo_edca; -+ u8 prv_traffic_idx; -+ BB_REGISTER_DEFINITION_T PHYRegDef[MAX_RF_PATH]; /* Radio A/B/C/D */ -+ -+ u32 RfRegChnlVal[MAX_RF_PATH]; -+ -+ /* RDG enable */ -+ BOOLEAN bRDGEnable; -+ -+ #if defined (CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ u32 RegRRSR; -+ #endif -+ -+ /****** 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 antenna_tx_path; /* Antenna path Tx */ -+ u32 AntennaRxPath; /* Antenna path Rx */ -+ u8 sw_antdiv_bl_state; -+ -+ /******** PHY DM & DM Section **********/ -+ _lock IQKSpinLock; -+ u8 INIDATA_RATE[MACID_NUM_SW_LIMIT]; -+ -+ struct dm_struct odmpriv; -+ u64 bk_rf_ability; -+ u8 bIQKInitialized; -+ u8 bNeedIQK; -+ u8 neediqk_24g; -+ u8 IQK_MP_Switch; -+ u8 bScanInProcess; -+ u8 phydm_init_result; /*BB and RF para match or not*/ -+ /******** PHY DM & DM Section **********/ -+ -+ -+ -+ /* 2010/08/09 MH Add CU power down mode. */ -+ BOOLEAN pwrdown; -+ -+#ifdef CONFIG_P2P -+#ifdef CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+ u16 p2p_ps_offload; -+#else -+ u8 p2p_ps_offload; -+#endif -+#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; -+ u8 ch_switch_offload; -+ struct submit_ctx chsw_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 */ -+ -+ bool intf_start; -+ -+#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 */ -+#ifdef CONFIG_RTL8192F -+ u16 SdioTxFIFOFreePage[SDIO_TX_FREE_PG_QUEUE]; -+#else -+ u8 SdioTxFIFOFreePage[SDIO_TX_FREE_PG_QUEUE]; -+#endif/*CONFIG_RTL8192F*/ -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+ u8 sdio_avail_int_en_q; -+#endif -+ _lock SdioTxFIFOFreePageLock; -+ u8 SdioTxOQTMaxFreeSpace; -+ u8 SdioTxOQTFreeSpace; -+#else /* RTW_HALMAC */ -+ u16 SdioTxOQTFreeSpace; -+#endif /* RTW_HALMAC */ -+ -+ /* */ -+ /* SDIO Rx FIFO related. */ -+ /* */ -+ u8 SdioRxFIFOCnt; -+#if defined (CONFIG_RTL8822C) || defined (CONFIG_RTL8192F) -+ u32 SdioRxFIFOSize; -+#else -+ u16 SdioRxFIFOSize; -+#endif -+ -+#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; -+ u8 max_oqt_size; -+ #ifdef XMIT_BUF_SIZE -+ u32 max_xmit_size_vovi; -+ u32 max_xmit_size_bebk; -+ #endif /*XMIT_BUF_SIZE*/ -+ u16 max_xmit_page; -+ u16 max_xmit_page_vo; -+ u16 max_xmit_page_vi; -+ u16 max_xmit_page_be; -+ u16 max_xmit_page_bk; -+ -+#endif /*#ifdef CONFIG_RTL8821C*/ -+#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]; -+ -+ u32 pci_backdoor_ctrl; -+ -+ 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_RTL8188GTV) || defined(CONFIG_RTL8723D)|| defined(CONFIG_RTL8192F) -+#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 -+ struct noise_monitor nm; -+#endif -+ -+ struct hal_spec_t hal_spec; -+#ifdef CONFIG_PHY_CAPABILITY_QUERY -+ struct phy_spec_t phy_spec; -+#endif -+ 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 -+#ifdef CONFIG_RTL8814A -+ u32 RxGainOffset[4]; /*{2G, 5G_Low, 5G_Middle, G_High}*/ -+ u8 BackUp_IG_REG_4_Chnl_Section[4]; /*{A,B,C,D}*/ -+#endif -+ struct hal_iqk_reg_backup iqk_reg_backup[MAX_IQK_INFO_BACKUP_CHNL_NUM]; -+ -+#ifdef RTW_HALMAC -+ u16 drv_rsvd_page_number; -+#endif -+ -+#ifdef CONFIG_BEAMFORMING -+ u8 backup_snd_ptcl_ctrl; -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ struct beamforming_info beamforming_info; -+#endif /* RTW_BEAMFORMING_VERSION_2 */ -+#endif /* CONFIG_BEAMFORMING */ -+ -+ u8 not_xmitframe_fw_dl; /*not use xmitframe to download fw*/ -+ u8 phydm_op_mode; -+ -+ u8 in_cta_test; -+ -+#ifdef CONFIG_RTW_LED -+ struct led_priv led; -+#endif -+ /* for multi channel case (ex: MCC/TDLS) */ -+ u8 multi_ch_switch_mode; -+ -+#ifdef CONFIG_RTL8814B -+ u8 dma_ch_map[32]; /* TXDESC qsel maximum size */ -+#endif -+ -+#ifndef RTW_HALMAC /* for SIFS initial value */ -+ u16 init_reg_0x428; -+ u32 init_reg_0x514; -+ u16 init_reg_0x63a; -+ u32 init_reg_0x63c; -+#endif -+} 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 *)(((struct _ADAPTER*)__pAdapter)->HalData)) -+#define GET_HAL_SPEC(__pAdapter) (&(GET_HAL_DATA((__pAdapter))->hal_spec)) -+#define adapter_to_led(adapter) (&(GET_HAL_DATA(adapter)->led)) -+ -+#define RT_GetInterfaceSelection(_Adapter) (GET_HAL_DATA(_Adapter)->InterfaceSel) -+ -+#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_set_hw_init_completed(adapter, cmp) (GET_HAL_DATA(adapter)->hw_init_completed = cmp) -+#define rtw_is_hw_init_completed(adapter) (GET_HAL_DATA(adapter)->hw_init_completed == _TRUE) -+ -+/* refer to (hal_data->version_id.RFType / registrypriv->rf_path / 8814a from efuse or registrypriv)*/ -+#define GET_HAL_RFPATH(adapter) (GET_HAL_DATA(adapter)->rf_type) -+#define GET_HAL_RFPATH_NUM(adapter) (GET_HAL_DATA(adapter)->NumTotalRFPath) -+#define GET_HAL_TX_PATH_BMP(adapter) ((GET_HAL_DATA(adapter)->trx_path_bmp & 0xF0) >> 4) -+#define GET_HAL_RX_PATH_BMP(adapter) (GET_HAL_DATA(adapter)->trx_path_bmp & 0x0F) -+ -+/* refer to (registrypriv-> tx_nss,rx_nss / hal_spec->tx_nss_num,rx_nss_num)*/ -+#define GET_HAL_TX_NSS(adapter) (GET_HAL_DATA(adapter)->tx_nss) -+#define GET_HAL_RX_NSS(adapter) (GET_HAL_DATA(adapter)->rx_nss) -+ -+#endif -+ -+#ifdef RTW_HALMAC -+int rtw_halmac_deinit_adapter(struct dvobj_priv *); -+#endif /* RTW_HALMAC */ -+ -+#endif /* __HAL_DATA_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_gspi.h b/drivers/net/wireless/rtl8821cs/include/hal_gspi.h -new file mode 100644 -index 000000000..51d491cdb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_gspi.h -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/hal_ic_cfg.h b/drivers/net/wireless/rtl8821cs/include/hal_ic_cfg.h -new file mode 100644 -index 000000000..b16311d3f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_ic_cfg.h -@@ -0,0 +1,723 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 RTL8723F_SUPPORT 0 -+#define RTL8192E_SUPPORT 0 -+#define RTL8192F_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 -+#define RTL8710B_SUPPORT 0 -+#define RTL8814B_SUPPORT 0 -+#define RTL8824B_SUPPORT 0 -+#define RTL8198F_SUPPORT 0 -+#define RTL8195B_SUPPORT 0 -+#define RTL8822C_SUPPORT 0 -+#define RTL8721D_SUPPORT 0 -+#define RTL8812F_SUPPORT 0 -+#define RTL8197G_SUPPORT 0 -+#define RTL8710C_SUPPORT 0 -+#define RTL8814C_SUPPORT 0 -+#define RTL8735B_SUPPORT 0 -+#define RTL8730A_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 -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ #undef RTL8812A_SUPPORT -+ #define RTL8812A_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #ifdef CONFIG_BEAMFORMING -+ #define CONFIG_BEAMFORMER_FW_NDPA -+ #define BEAMFORMING_SUPPORT 1 /*for phydm beamforming*/ -+ #define SUPPORT_MU_BF 0 -+ #endif /*CONFIG_BEAMFORMING*/ -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8821A -+ #undef RTL8821A_SUPPORT -+ #define RTL8821A_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #ifdef CONFIG_BEAMFORMING -+ #define CONFIG_BEAMFORMER_FW_NDPA -+ #define BEAMFORMING_SUPPORT 1 /*for phydm beamforming*/ -+ #define SUPPORT_MU_BF 0 -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ #undef RTL8192E_SUPPORT -+ #define RTL8192E_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8192F -+ #undef RTL8192F_SUPPORT -+ #define RTL8192F_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 CONFIG_AMPDU_PRETX_CD*/ -+ /*#define DBG_LA_MODE*/ -+ #ifdef CONFIG_P2P_PS -+ #define CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+ #endif -+ #define CONFIG_RTS_FULL_BW -+/* #define CONFIG_NARROWBAND_SUPPORTING */ -+ #ifdef CONFIG_NARROWBAND_SUPPORTING -+ #define CONFIG_NB_VALUE RTW_NB_CONFIG_NONE /*RTW_NB_CONFIG_WIDTH_10 or RTW_NB_CONFIG_WIDTH_5 */ -+ #endif -+ #ifdef CONFIG_WOWLAN -+ #define CONFIG_WOW_PATTERN_IN_TXFIFO -+ #endif -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+ #define CONFIG_STOP_RESUME_BCN_BY_TXPAUSE /*to fixed no bcn issue*/ -+ #define CONFIG_TSF_SYNC -+#endif -+ -+#ifdef CONFIG_RTL8723B -+ #undef RTL8723B_SUPPORT -+ #define RTL8723B_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #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 -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ #undef RTL8814A_SUPPORT -+ #define RTL8814A_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #define CONFIG_FW_CORRECT_BCN -+ #ifdef CONFIG_BEAMFORMING -+ #define BEAMFORMING_SUPPORT 1 /*for phydm beamforming*/ -+ #define SUPPORT_MU_BF 0 -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #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 -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #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 -+ #ifndef CONFIG_RTW_CUSTOMER_STR -+ #define CONFIG_RTW_CUSTOMER_STR -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8188GTV -+ #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 -+ #ifndef CONFIG_RTW_CUSTOMER_STR -+ #define CONFIG_RTW_CUSTOMER_STR -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+ -+ #if defined(CONFIG_USB_HCI) && !defined(CONFIG_FW_OFFLOAD_SET_TXPWR_IDX) -+ #define CONFIG_FW_OFFLOAD_SET_TXPWR_IDX -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ #undef RTL8822B_SUPPORT -+ #define RTL8822B_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif /* CONFIG_FW_C2H_PKT */ -+ #define RTW_TX_PA_BIAS /* Adjust TX PA Bias from eFuse */ -+ #define RTW_AMPDU_AGG_RETRY_AND_NEW -+ -+ #ifdef CONFIG_WOWLAN -+ #define CONFIG_GTK_OL -+ /*#define CONFIG_ARP_KEEP_ALIVE*/ -+ -+ #ifdef CONFIG_GPIO_WAKEUP -+ #ifndef WAKEUP_GPIO_IDX -+ #define WAKEUP_GPIO_IDX 6 /* WIFI Chip Side */ -+ #endif /* !WAKEUP_GPIO_IDX */ -+ #endif /* CONFIG_GPIO_WAKEUP */ -+ #endif /* CONFIG_WOWLAN */ -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ #define CONFIG_AP_PORT_SWAP -+ #define CONFIG_FW_MULTI_PORT_SUPPORT -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ -+ /* -+ * Beamforming related definition -+ */ -+ /* Only support new beamforming mechanism */ -+ #ifdef CONFIG_BEAMFORMING -+ #define RTW_BEAMFORMING_VERSION_2 -+ #endif /* CONFIG_BEAMFORMING */ -+ -+ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT -+ #define CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif /* CONFIG_RTW_MAC_HIDDEN_RPT */ -+ -+ #ifndef DBG_RX_DFRAME_RAW_DATA -+ #define DBG_RX_DFRAME_RAW_DATA -+ #endif /* DBG_RX_DFRAME_RAW_DATA */ -+ -+ #ifndef RTW_IQK_FW_OFFLOAD -+ #define RTW_IQK_FW_OFFLOAD -+ #endif /* RTW_IQK_FW_OFFLOAD */ -+ -+ /* Checksum offload feature */ -+ /*#define CONFIG_TCP_CSUM_OFFLOAD_TX*/ -+ #if defined(CONFIG_TCP_CSUM_OFFLOAD_TX) && !defined(CONFIG_RTW_NETIF_SG) -+ #define CONFIG_RTW_NETIF_SG -+ #endif -+ #define CONFIG_TCP_CSUM_OFFLOAD_RX -+ -+ #define CONFIG_ADVANCE_OTA -+ -+ #ifdef CONFIG_MCC_MODE -+ #define CONFIG_MCC_MODE_V2 -+ #define CONFIG_MCC_PHYDM_OFFLOAD -+ #endif /* CONFIG_MCC_MODE */ -+ -+ #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) -+ #define CONFIG_TDLS_CH_SW_V2 -+ #endif -+ -+ #ifndef RTW_CHANNEL_SWITCH_OFFLOAD -+ #ifdef CONFIG_TDLS_CH_SW_V2 -+ #define RTW_CHANNEL_SWITCH_OFFLOAD -+ #endif -+ #endif /* RTW_CHANNEL_SWITCH_OFFLOAD */ -+ -+ #if defined(CONFIG_RTW_MESH) && !defined(RTW_PER_CMD_SUPPORT_FW) -+ /* Supported since fw v22.1 */ -+ #define RTW_PER_CMD_SUPPORT_FW -+ #endif /* RTW_PER_CMD_SUPPORT_FW */ -+ #define CONFIG_SUPPORT_FIFO_DUMP -+ #define CONFIG_HW_P0_TSF_SYNC -+ #define CONFIG_BCN_RECV_TIME -+ #ifdef CONFIG_P2P_PS -+ #define CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifdef CONFIG_LPS -+ #define CONFIG_LPS_ACK /* Supported after FW v30 & v27.9 */ -+ #endif -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+#endif /* CONFIG_RTL8822B */ -+ -+#ifdef CONFIG_RTL8822C -+ #undef RTL8822C_SUPPORT -+ #define RTL8822C_SUPPORT 1 -+ /*#define DBG_LA_MODE*/ -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif /* CONFIG_FW_C2H_PKT */ -+ #define RTW_TX_PA_BIAS /* Adjust TX PA Bias from eFuse */ -+ -+ #ifdef CONFIG_WOWLAN -+ #define CONFIG_GTK_OL -+ /*#define CONFIG_ARP_KEEP_ALIVE*/ -+ -+ #ifdef CONFIG_GPIO_WAKEUP -+ #ifndef WAKEUP_GPIO_IDX -+ #define WAKEUP_GPIO_IDX 6 /* WIFI Chip Side */ -+ #endif /* !WAKEUP_GPIO_IDX */ -+ #endif /* CONFIG_GPIO_WAKEUP */ -+ #endif /* CONFIG_WOWLAN */ -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ #define CONFIG_AP_PORT_SWAP -+ #define CONFIG_FW_MULTI_PORT_SUPPORT -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ -+ /* -+ * Beamforming related definition -+ */ -+ /* Only support new beamforming mechanism */ -+ #ifdef CONFIG_BEAMFORMING -+ #define RTW_BEAMFORMING_VERSION_2 -+ #endif /* CONFIG_BEAMFORMING */ -+ -+ #ifdef CONFIG_NO_FW -+ #ifdef CONFIG_RTW_MAC_HIDDEN_RPT -+ #undef CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif -+ #else -+ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT -+ #define CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif -+ #endif -+ -+ #ifndef DBG_RX_DFRAME_RAW_DATA -+ #define DBG_RX_DFRAME_RAW_DATA -+ #endif /* DBG_RX_DFRAME_RAW_DATA */ -+ -+ #ifndef RTW_IQK_FW_OFFLOAD -+ /* #define RTW_IQK_FW_OFFLOAD */ -+ #endif /* RTW_IQK_FW_OFFLOAD */ -+ #define CONFIG_ADVANCE_OTA -+ -+ #ifdef CONFIG_MCC_MODE -+ #define CONFIG_MCC_MODE_V2 -+ #define CONFIG_MCC_PHYDM_OFFLOAD -+ #endif /* CONFIG_MCC_MODE */ -+ -+ #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) -+ #define CONFIG_TDLS_CH_SW_V2 -+ #endif -+ -+ #ifndef RTW_CHANNEL_SWITCH_OFFLOAD -+ #ifdef CONFIG_TDLS_CH_SW_V2 -+ #define RTW_CHANNEL_SWITCH_OFFLOAD -+ #endif -+ #endif /* RTW_CHANNEL_SWITCH_OFFLOAD */ -+ -+ #if defined(CONFIG_RTW_MESH) && !defined(RTW_PER_CMD_SUPPORT_FW) -+ /* Supported since fw v22.1 */ -+ #define RTW_PER_CMD_SUPPORT_FW -+ #endif /* RTW_PER_CMD_SUPPORT_FW */ -+ #define CONFIG_SUPPORT_FIFO_DUMP -+ #define CONFIG_HW_P0_TSF_SYNC -+ #define CONFIG_BCN_RECV_TIME -+ -+ /*#define CONFIG_TCP_CSUM_OFFLOAD_TX*/ -+ #if defined(CONFIG_TCP_CSUM_OFFLOAD_TX) && !defined(CONFIG_RTW_NETIF_SG) -+ #define CONFIG_RTW_NETIF_SG -+ #endif -+ #define CONFIG_TCP_CSUM_OFFLOAD_RX -+ -+ #ifdef CONFIG_P2P_PS -+ #define CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifdef CONFIG_LPS -+ #define CONFIG_LPS_ACK /* Supported after FW v07 */ -+ #define CONFIG_LPS_1T1R /* Supported after FW v07 */ -+ #endif -+ -+ #define CONFIG_BT_EFUSE_MASK -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+ #ifndef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+ #define CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+ #endif -+ -+ #define CONFIG_RTL8822C_XCAP_NEW_POLICY -+ -+ /*#define CONFIG_NARROWBAND_SUPPORTING*/ -+ #ifdef CONFIG_NARROWBAND_SUPPORTING -+ #define CONFIG_NB_VALUE RTW_NB_CONFIG_WIDTH_10 /* RTW_NB_CONFIG_NONE / RTW_NB_CONFIG_WIDTH_10 / RTW_NB_CONFIG_WIDTH_5 */ -+ #endif -+ #define CONFIG_SUPPORT_DYNAMIC_TXPWR -+#endif /* CONFIG_RTL8822C */ -+ -+#ifdef CONFIG_RTL8821C -+ #undef RTL8821C_SUPPORT -+ #define RTL8821C_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #ifdef CONFIG_NO_FW -+ #ifdef CONFIG_RTW_MAC_HIDDEN_RPT -+ #undef CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif -+ #else -+ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT -+ #define CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif -+ #endif -+ #define LOAD_FW_HEADER_FROM_DRIVER -+ #define CONFIG_PHY_CAPABILITY_QUERY -+ #ifdef CONFIG_CONCURRENT_MODE -+ #define CONFIG_AP_PORT_SWAP -+ #define CONFIG_FW_MULTI_PORT_SUPPORT -+ #endif -+ #define CONFIG_SUPPORT_FIFO_DUMP -+ #ifndef RTW_IQK_FW_OFFLOAD -+ #define RTW_IQK_FW_OFFLOAD -+ #endif /* RTW_IQK_FW_OFFLOAD */ -+ /*#define CONFIG_AMPDU_PRETX_CD*/ -+ /*#define DBG_PRE_TX_HANG*/ -+ -+ /* Beamforming related definition */ -+ /* Only support new beamforming mechanism */ -+ #ifdef CONFIG_BEAMFORMING -+ #define RTW_BEAMFORMING_VERSION_2 -+ #endif /* CONFIG_BEAMFORMING */ -+ #define CONFIG_HW_P0_TSF_SYNC -+ #define CONFIG_BCN_RECV_TIME -+ #ifdef CONFIG_P2P_PS -+ #define CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifdef CONFIG_LPS -+ /* #define CONFIG_LPS_ACK */ /* Supported after FW v25 */ -+ #endif -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+ -+ #define CONFIG_BT_EFUSE_MASK -+#endif /*CONFIG_RTL8821C*/ -+ -+#ifdef CONFIG_RTL8710B -+ #undef RTL8710B_SUPPORT -+ #define RTL8710B_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8814B -+ #undef RTL8814B_SUPPORT -+ #define RTL8814B_SUPPORT 1 -+ #ifdef CONFIG_RTL8814C -+ #undef RTL8814C_SUPPORT -+ #define RTL8814C_SUPPORT 1 -+ #endif -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif /* CONFIG_FW_C2H_PKT */ -+ #define RTW_TX_PA_BIAS /* Adjust TX PA Bias from eFuse */ -+ #define RTW_AMPDU_AGG_RETRY_AND_NEW -+ -+ #ifdef CONFIG_WOWLAN -+ #define CONFIG_GTK_OL -+ /*#define CONFIG_ARP_KEEP_ALIVE*/ -+ -+ #ifdef CONFIG_GPIO_WAKEUP -+ #ifndef WAKEUP_GPIO_IDX -+ #define WAKEUP_GPIO_IDX 6 /* WIFI Chip Side */ -+ #endif /* !WAKEUP_GPIO_IDX */ -+ #endif /* CONFIG_GPIO_WAKEUP */ -+ #endif /* CONFIG_WOWLAN */ -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ /*#define CONFIG_AP_PORT_SWAP*/ -+ #define CONFIG_FW_MULTI_PORT_SUPPORT -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ -+ /* -+ * Beamforming related definition -+ */ -+ /* Only support new beamforming mechanism */ -+ #ifdef CONFIG_BEAMFORMING -+ #define RTW_BEAMFORMING_VERSION_2 -+ #endif /* CONFIG_BEAMFORMING */ -+ -+ #ifndef DBG_RX_DFRAME_RAW_DATA -+ #define DBG_RX_DFRAME_RAW_DATA -+ #endif /* DBG_RX_DFRAME_RAW_DATA */ -+ -+ #ifndef RTW_IQK_FW_OFFLOAD -+ #define RTW_IQK_FW_OFFLOAD -+ #endif /* RTW_IQK_FW_OFFLOAD */ -+ -+ /* Checksum offload feature */ -+ /*#define CONFIG_TCP_CSUM_OFFLOAD_TX*/ /* not ready */ -+ #define CONFIG_TCP_CSUM_OFFLOAD_RX -+ -+ #define CONFIG_ADVANCE_OTA -+ -+ #ifdef CONFIG_MCC_MODE -+ #define CONFIG_MCC_MODE_V2 -+ #define CONFIG_MCC_PHYDM_OFFLOAD -+ #endif /* CONFIG_MCC_MODE */ -+ -+ #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) -+ #define CONFIG_TDLS_CH_SW_V2 -+ #endif -+ -+ #ifndef RTW_CHANNEL_SWITCH_OFFLOAD -+ #ifdef CONFIG_TDLS_CH_SW_V2 -+ #define RTW_CHANNEL_SWITCH_OFFLOAD -+ #endif -+ #endif /* RTW_CHANNEL_SWITCH_OFFLOAD */ -+ -+ #if defined(CONFIG_RTW_MESH) && !defined(RTW_PER_CMD_SUPPORT_FW) -+ /* Supported since fw v22.1 */ -+ #define RTW_PER_CMD_SUPPORT_FW -+ #endif /* RTW_PER_CMD_SUPPORT_FW */ -+ #define CONFIG_SUPPORT_FIFO_DUMP -+ #define CONFIG_HW_P0_TSF_SYNC -+ #define CONFIG_BCN_RECV_TIME -+ #ifdef CONFIG_P2P_PS -+ #define CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+ #endif -+ #define CONFIG_RTS_FULL_BW -+ -+ #define CONFIG_PROTSEL_PORT -+ #define CONFIG_PROTSEL_ATIMDTIM -+ #define CONFIG_PROTSEL_MACSLEEP -+ -+ #define CONFIG_HAS_HW_VAR_BCN_CTRL_ADDR -+ #define CONFIG_HAS_HW_VAR_BCN_FUNC -+ #define CONFIG_HAS_HW_VAR_MLME_DISCONNECT -+ #define CONFIG_HAS_HW_VAR_MLME_JOIN -+ #define CONFIG_HAS_HW_VAR_CORRECT_TSF -+ #define CONFIG_HAS_TX_BEACON_PAUSE -+ -+ #define CONFIG_RTW_TX_NPATH_EN /* 8814B is always 4TX */ -+ -+ #ifdef CONFIG_LPS -+ #define CONFIG_LPS_ACK /* Supported after FW v04 */ -+ #endif -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+ #ifndef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+ #define CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+ #endif -+#endif /* CONFIG_RTL8814B */ -+#ifdef CONFIG_RTL8723F -+ #undef RTL8723F_SUPPORT -+ #define RTL8723F_SUPPORT 1 -+ -+ /* Use HALMAC architecture, necessary for 8723F */ -+ #define RTW_HALMAC -+ -+ /*#define DBG_LA_MODE*/ -+ -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif /* CONFIG_FW_C2H_PKT */ -+ -+ #define RTW_TX_PA_BIAS /* Adjust TX PA Bias from eFuse */ -+ -+ #ifdef CONFIG_WOWLAN -+ #define CONFIG_WOW_PATTERN_IN_TXFIFO -+ #endif -+ -+ #ifdef CONFIG_WOWLAN -+ #define CONFIG_GTK_OL -+ /*#define CONFIG_ARP_KEEP_ALIVE*/ -+ -+ #ifdef CONFIG_GPIO_WAKEUP -+ #ifndef WAKEUP_GPIO_IDX -+ #define WAKEUP_GPIO_IDX 12 /* WIFI Chip Side */ -+ #endif /* !WAKEUP_GPIO_IDX */ -+ #endif /* CONFIG_GPIO_WAKEUP */ -+ #endif /* CONFIG_WOWLAN */ -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ #define CONFIG_AP_PORT_SWAP -+ #define CONFIG_FW_MULTI_PORT_SUPPORT -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ -+ #ifdef CONFIG_NO_FW -+ #ifdef CONFIG_RTW_MAC_HIDDEN_RPT -+ #undef CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif -+ #else -+ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT -+ #define CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif -+ #endif -+ -+ #ifndef DBG_RX_DFRAME_RAW_DATA -+ #define DBG_RX_DFRAME_RAW_DATA -+ #endif /* DBG_RX_DFRAME_RAW_DATA */ -+ -+ /*#define RTW_IQK_FW_OFFLOAD*/ -+ #define CONFIG_ADVANCE_OTA -+ -+ #ifdef CONFIG_MCC_MODE -+ #define CONFIG_MCC_MODE_V2 -+ #define CONFIG_MCC_PHYDM_OFFLOAD -+ #endif /* CONFIG_MCC_MODE */ -+ -+ #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) -+ #define CONFIG_TDLS_CH_SW_V2 -+ #endif -+ -+ #ifndef RTW_CHANNEL_SWITCH_OFFLOAD -+ #ifdef CONFIG_TDLS_CH_SW_V2 -+ #define RTW_CHANNEL_SWITCH_OFFLOAD -+ #endif -+ #endif /* RTW_CHANNEL_SWITCH_OFFLOAD */ -+ -+ #if defined(CONFIG_RTW_MESH) && !defined(RTW_PER_CMD_SUPPORT_FW) -+ /* Supported since fw v22.1 */ -+ #define RTW_PER_CMD_SUPPORT_FW -+ #endif /* RTW_PER_CMD_SUPPORT_FW */ -+ #define CONFIG_SUPPORT_FIFO_DUMP -+ #define CONFIG_HW_P0_TSF_SYNC -+ #define CONFIG_BCN_RECV_TIME -+ -+ /*#define CONFIG_TCP_CSUM_OFFLOAD_TX*/ -+ #if defined(CONFIG_TCP_CSUM_OFFLOAD_TX) && !defined(CONFIG_RTW_NETIF_SG) -+ #define CONFIG_RTW_NETIF_SG -+ #endif -+ #define CONFIG_TCP_CSUM_OFFLOAD_RX -+ -+ #ifdef CONFIG_P2P_PS -+ #define CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+ #endif -+ -+ #define CONFIG_RTS_FULL_BW -+ -+ #ifdef CONFIG_LPS -+ #define CONFIG_LPS_ACK -+ #endif -+ -+ #ifndef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #define CONFIG_TXPWR_PG_WITH_PWR_IDX -+ #endif -+ #ifndef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+ #define CONFIG_TXPWR_PG_WITH_TSSI_OFFSET -+ #endif -+ -+ #define CONFIG_BT_EFUSE_MASK -+ -+ #define CONFIG_WRITE_BCN_LEN_TO_FW -+#endif /* CONFIG_RTL8723F */ -+#endif /*__HAL_IC_CFG_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_intf.h b/drivers/net/wireless/rtl8821cs/include/hal_intf.h -new file mode 100644 -index 000000000..e1d839920 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_intf.h -@@ -0,0 +1,912 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _CHIP_TYPE { -+ -+ NULL_CHIP_TYPE, -+ RTL8188E, -+ RTL8192E, -+ RTL8812, -+ RTL8821, /* RTL8811 */ -+ RTL8723B, -+ RTL8814A, -+ RTL8703B, -+ RTL8188F, -+ RTL8188GTV, -+ RTL8822B, -+ RTL8723D, -+ RTL8821C, -+ RTL8710B, -+ RTL8192F, -+ RTL8822C, -+ RTL8814B, -+ RTL8723F, -+ MAX_CHIP_TYPE -+}; -+ -+#ifdef RTW_HALMAC -+enum fw_mem { -+ FW_EMEM, -+ FW_IMEM, -+ FW_DMEM, -+}; -+#endif -+ -+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_BCN_CTRL_ADDR, -+ HW_VAR_CORRECT_TSF, -+ HW_VAR_RCR, -+ 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_FREECNT, -+ -+ /* 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, -+#ifdef CONFIG_WMMPS_STA -+ HW_VAR_UAPSD_TID, -+#endif /* CONFIG_WMMPS_STA */ -+ HW_VAR_AMPDU_MIN_SPACE, -+#ifdef CONFIG_80211N_HT -+ HW_VAR_AMPDU_FACTOR, -+#endif /* CONFIG_80211N_HT */ -+ HW_VAR_RXDMA_AGG_PG_TH, -+ HW_VAR_SET_RPWM, -+ HW_VAR_CPWM, -+ HW_VAR_H2C_FW_PWRMODE, -+ HW_VAR_H2C_FW_PWRMODE_RFON_CTRL, -+ HW_VAR_H2C_INACTIVE_IPS, -+ 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 -+#ifdef CONFIG_LPS_PG -+ HW_VAR_LPS_PG_HANDLE, -+#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, -+#endif -+ HW_VAR_RPWM_TOG, -+#ifdef CONFIG_GPIO_WAKEUP -+ HW_VAR_WOW_OUTPUT_GPIO, -+ HW_VAR_WOW_INPUT_GPIO, -+ HW_SET_GPIO_WL_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_CHK_MGQ_CPU_EMPTY, -+ HW_VAR_DL_BCN_SEL, -+ HW_VAR_AMPDU_MAX_TIME, -+ HW_VAR_USB_MODE, -+ HW_VAR_PORT_SWITCH, -+ HW_VAR_PORT_CFG, -+ HW_VAR_DO_IQK, -+ HW_VAR_DM_IN_LPS_LCLK,/*flag CONFIG_LPS_LCLK_WD_TIMER*/ -+ 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, -+ HW_VAR_SOUNDING_CSI_REPORT, -+ /*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_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, -+ -+ HW_VAR_DBI, -+ HW_VAR_MDIO, -+ HW_VAR_L1OFF_CAPABILITY, -+ HW_VAR_L1OFF_NIC_SUPPORT, -+ HW_VAR_BCN_EARLY_C2H_RPT, -+ HW_VAR_SET_DRV_ERLY_INT, -+ HW_VAR_DUMP_MAC_TXFIFO, -+ HW_VAR_PWR_CMD, -+#ifdef CONFIG_FW_HANDLE_TXBCN -+ HW_VAR_BCN_HEAD_SEL, -+#endif -+ HW_VAR_SET_SOML_PARAM, -+ HW_VAR_ENABLE_RX_BAR, -+ HW_VAR_TSF_AUTO_SYNC, -+ HW_VAR_LPS_STATE_CHK, -+ HW_VAR_LPS_RFON_CHK, -+ #ifdef CONFIG_RTS_FULL_BW -+ HW_VAR_SET_RTS_BW, -+ #endif -+#if defined(CONFIG_PCI_HCI) -+ HW_VAR_ENSWBCN, -+#endif -+#ifdef CONFIG_WOWLAN -+ HW_VAR_VENDOR_WOW_MODE, -+#endif /* CONFIG_WOWLAN */ -+#ifdef CONFIG_WAKE_ON_BT -+ HW_VAR_WAKE_ON_BT_GPIO_SWITCH, -+#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_TX_BUFFER_LAST_ENTRY, -+ HAL_DEF_ANT_DETECT,/* to do for 8723a */ -+ HAL_DEF_PCI_ASPM_OSC, /* Support for ASPM OSC, added by Roger, 2013.03.27. */ -+ 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_INITIAL_GAIN, -+ HAL_ODM_RX_INFO_DUMP, -+ HAL_ODM_RX_Dframe_INFO, -+#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); -+ u8 (*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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32(*hal_mgmt_xmitframe_enqueue)(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ s32(*hal_xmitframe_enqueue)(_adapter *padapter, struct xmit_frame *pxmitframe); -+ #if defined (CONFIG_CONCURRENT_MODE) && defined (CONFIG_TSF_SYNC) -+ void(*tsf_sync)(_adapter *Adapter); -+ #endif -+#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); -+#ifdef CONFIG_RECV_THREAD_MODE -+ s32 (*recv_hdl)(_adapter *adapter); -+#endif -+#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); -+ void (*unmap_beacon_icf)(_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 ***/ -+#ifdef CONFIG_RTW_SW_LED -+ void (*InitSwLeds)(_adapter *padapter); -+ void (*DeInitSwLeds)(_adapter *padapter); -+#endif -+ void (*set_chnl_bw_handler)(_adapter *padapter, u8 channel, enum channel_width Bandwidth, u8 Offset40, u8 Offset80); -+ -+ void (*set_tx_power_level_handler)(_adapter *adapter, u8 channel); -+ void (*set_txpwr_done)(_adapter *adapter); -+ void (*set_tx_power_index_handler)(_adapter *adapter, u32 powerindex, enum rf_path rfpath, u8 rate); -+ -+ u8 (*get_tx_power_index_handler)(_adapter *adapter, enum rf_path rfpath, RATE_SECTION rs, enum MGN_RATE rate -+ , enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch, struct txpwr_idx_comp *tic); -+ s8 (*get_txpwr_target_extra_bias)(_adapter *adapter, enum rf_path rfpath, RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch); -+ -+ void (*hal_dm_watchdog)(_adapter *padapter); -+ -+ u8 (*set_hw_reg_handler)(_adapter *padapter, u8 variable, u8 *val); -+ -+ void (*GetHwRegHandler)(_adapter *padapter, u8 variable, u8 *val); -+ -+ -+ -+ u8 (*get_hal_def_var_handler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *pValue); -+ -+ u8(*SetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *pValue); -+ -+ void (*GetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, void *pValue2); -+ void (*SetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, BOOLEAN bSet); -+ -+ 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, enum rf_path eRFPath, u32 RegAddr, u32 BitMask); -+ void (*write_rfreg)(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -+#ifdef CONFIG_SYSON_INDIRECT_ACCESS -+ u32 (*read_syson_reg)(_adapter *padapter, u32 RegAddr, u32 BitMask); -+ void (*write_syson_reg)(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); -+#endif -+ void (*read_wmmedca_reg)(_adapter *padapter, u16 *vo_params, u16 *vi_params, u16 *be_params, u16 *bk_params); -+ -+#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); -+#if defined(CONFIG_RTL8710B) -+ BOOLEAN(*efuse_indirect_read4)(_adapter *padapter, u16 regaddr, u8 *value); -+#endif -+ -+#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 -+ void (*reqtxrpt)(_adapter *padapter, u8 macid); -+ 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); -+#ifdef RTW_HALMAC -+ s32 (*fw_mem_dl)(_adapter *adapter, enum fw_mem mem); -+#endif -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_PCI_HCI) -+ 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); -+ int (*hal_gpio_func_check)(_adapter *padapter, u8 gpio_num); -+ void (*hal_gpio_multi_func_reset)(_adapter *padapter, u8 gpio_num); -+#endif -+#ifdef CONFIG_FW_CORRECT_BCN -+ void (*fw_correct_bcn)(PADAPTER padapter); -+#endif -+ -+#ifdef RTW_HALMAC -+ u8(*init_mac_register)(PADAPTER); -+ u8(*init_phy)(PADAPTER); -+#endif /* RTW_HALMAC */ -+ -+#ifdef CONFIG_PCI_HCI -+ void (*hal_set_l1ssbackdoor_handler)(_adapter *padapter, u8 enable); -+#endif -+ -+#ifdef CONFIG_RFKILL_POLL -+ bool (*hal_radio_onoff_check)(_adapter *adapter, u8 *valid); -+#endif -+#ifdef CONFIG_PCI_TX_POLLING -+ void (*tx_poll_handler)(_adapter *adapter); -+#endif -+ void (*hci_flush)(_adapter *adapter, u32 queue); -+}; -+ -+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_RTL8188GTVU, -+ HARDWARE_TYPE_RTL8188GTVS, -+ HARDWARE_TYPE_RTL8723DE, -+ HARDWARE_TYPE_RTL8723DU, -+ HARDWARE_TYPE_RTL8723DS, -+ HARDWARE_TYPE_RTL8821CE, -+ HARDWARE_TYPE_RTL8821CU, -+ HARDWARE_TYPE_RTL8821CS, -+ HARDWARE_TYPE_RTL8710BU, -+ HARDWARE_TYPE_RTL8192FS, -+ HARDWARE_TYPE_RTL8192FU, -+ HARDWARE_TYPE_RTL8192FE, -+ HARDWARE_TYPE_RTL8822CE, -+ HARDWARE_TYPE_RTL8822CU, -+ HARDWARE_TYPE_RTL8822CS, -+ HARDWARE_TYPE_RTL8814BE, -+ HARDWARE_TYPE_RTL8814BU, -+ HARDWARE_TYPE_RTL8814BS, -+ HARDWARE_TYPE_RTL8723FU, -+ HARDWARE_TYPE_RTL8723FS, -+ 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)) -+ -+/* RTL8192F Series */ -+#define IS_HARDWARE_TYPE_8192FS(_Adapter)\ -+ (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192FS) -+#define IS_HARDWARE_TYPE_8192FU(_Adapter)\ -+ (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192FU) -+#define IS_HARDWARE_TYPE_8192FE(_Adapter)\ -+ (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192FE) -+#define IS_HARDWARE_TYPE_8192F(_Adapter)\ -+ (IS_HARDWARE_TYPE_8192FS(_Adapter) ||\ -+ IS_HARDWARE_TYPE_8192FU(_Adapter) ||\ -+ IS_HARDWARE_TYPE_8192FE(_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_8188GTVU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188GTVU) -+#define IS_HARDWARE_TYPE_8188GTVS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188GTVS) -+#define IS_HARDWARE_TYPE_8188GTV(_Adapter) \ -+ (IS_HARDWARE_TYPE_8188GTVU(_Adapter) || IS_HARDWARE_TYPE_8188GTVS(_Adapter)) -+ -+/* RTL8710B Series */ -+#define IS_HARDWARE_TYPE_8710BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8710BU) -+#define IS_HARDWARE_TYPE_8710B(_Adapter) (IS_HARDWARE_TYPE_8710BU(_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_8822CE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822CE) -+#define IS_HARDWARE_TYPE_8822CU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822CU) -+#define IS_HARDWARE_TYPE_8822CS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822CS) -+#define IS_HARDWARE_TYPE_8822C(_Adapter) \ -+ (IS_HARDWARE_TYPE_8822CE(_Adapter) || IS_HARDWARE_TYPE_8822CU(_Adapter) || IS_HARDWARE_TYPE_8822CS(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_8814BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814BE) -+#define IS_HARDWARE_TYPE_8814BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814BU) -+#define IS_HARDWARE_TYPE_8814BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814BS) -+#define IS_HARDWARE_TYPE_8814B(_Adapter) \ -+ (IS_HARDWARE_TYPE_8814BE(_Adapter) || IS_HARDWARE_TYPE_8814BU(_Adapter) || IS_HARDWARE_TYPE_8814BS(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_8723FU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723FU) -+#define IS_HARDWARE_TYPE_8723FS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723FS) -+#define IS_HARDWARE_TYPE_8723F(_Adapter) \ -+ (IS_HARDWARE_TYPE_8723FU(_Adapter) || IS_HARDWARE_TYPE_8723FS(_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)) -+ -+#define IS_HARDWARE_TYPE_JAGUAR3(_Adapter) \ -+ (IS_HARDWARE_TYPE_8814B(_Adapter) || IS_HARDWARE_TYPE_8822C(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_JAGUAR3_11N(_Adapter) IS_HARDWARE_TYPE_8723F(_Adapter) -+ -+#define IS_HARDWARE_TYPE_JAGUAR_ALL(_Adapter) \ -+ (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(_Adapter) || IS_HARDWARE_TYPE_JAGUAR3(_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); -+#ifdef CONFIG_RTW_SW_LED -+void rtw_hal_sw_led_init(_adapter *padapter); -+void rtw_hal_sw_led_deinit(_adapter *padapter); -+#endif -+u32 rtw_hal_power_on(_adapter *padapter); -+void rtw_hal_power_off(_adapter *padapter); -+ -+uint rtw_hal_init(_adapter *padapter); -+#ifdef CONFIG_NEW_NETDEV_HDL -+uint rtw_hal_iface_init(_adapter *adapter); -+#endif -+ -+enum rf_type rtw_chip_rftype_to_hal_rftype(_adapter *adapter, u8 limit); -+void dump_hal_runtime_trx_mode(void *sel, _adapter *adapter); -+void dump_hal_trx_mode(void *sel, _adapter *adapter); -+u8 rtw_hal_rfpath_init(_adapter *adapter); -+u8 rtw_hal_trxnss_init(_adapter *adapter); -+ -+uint rtw_hal_deinit(_adapter *padapter); -+void rtw_hal_stop(_adapter *padapter); -+u8 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); -+u8 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, 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, void *pValue1, BOOLEAN bSet); -+void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, void *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); -+void rtw_hal_pci_dbi_write(_adapter *padapter, u16 addr, u8 data); -+u8 rtw_hal_pci_dbi_read(_adapter *padapter, u16 addr); -+void rtw_hal_pci_mdio_write(_adapter *padapter, u8 addr, u16 data); -+u16 rtw_hal_pci_mdio_read(_adapter *padapter, u8 addr); -+u8 rtw_hal_pci_l1off_nic_support(_adapter *padapter); -+u8 rtw_hal_pci_l1off_capability(_adapter *padapter); -+#endif -+ -+u8 rtw_hal_intf_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val); -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+s32 rtw_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+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); -+ -+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, enum rf_path eRFPath, u32 RegAddr, u32 BitMask); -+void rtw_hal_write_rfreg(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -+ -+ -+#define phy_query_bb_reg(Adapter, RegAddr, BitMask) rtw_hal_read_bbreg((Adapter), (RegAddr), (BitMask)) -+#define phy_set_bb_reg(Adapter, RegAddr, BitMask, Data) rtw_hal_write_bbreg((Adapter), (RegAddr), (BitMask), (Data)) -+#define phy_query_rf_reg(Adapter, eRFPath, RegAddr, BitMask) rtw_hal_read_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask)) -+#define phy_set_rf_reg(Adapter, eRFPath, RegAddr, BitMask, Data) rtw_hal_write_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask), (Data)) -+ -+#ifdef CONFIG_SYSON_INDIRECT_ACCESS -+u32 rtw_hal_read_syson_reg(PADAPTER padapter, u32 RegAddr, u32 BitMask); -+void rtw_hal_write_syson_reg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); -+#define hal_query_syson_reg(Adapter, RegAddr, BitMask) rtw_hal_read_syson_reg((Adapter), (RegAddr), (BitMask)) -+#define hal_set_syson_reg(Adapter, RegAddr, BitMask, Data) rtw_hal_write_syson_reg((Adapter), (RegAddr), (BitMask), (Data)) -+#endif -+ -+#define phy_set_mac_reg phy_set_bb_reg -+#define phy_query_mac_reg phy_query_bb_reg -+ -+#if defined(CONFIG_PCI_HCI) -+ s32 rtw_hal_interrupt_handler(_adapter *padapter); -+ void rtw_hal_unmap_beacon_icf(_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, enum channel_width Bandwidth, u8 Offset40, u8 Offset80); -+void rtw_hal_dm_watchdog(_adapter *padapter); -+void rtw_hal_dm_watchdog_in_lps(_adapter *padapter); -+ -+#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 -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+s32 rtw_hal_recv_hdl(_adapter *adapter); -+#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_macid_sleep(_adapter *adapter, u8 macid); -+s32 rtw_hal_macid_wakeup(_adapter *adapter, u8 macid); -+s32 rtw_hal_macid_sleep_all_used(_adapter *adapter); -+s32 rtw_hal_macid_wakeup_all_used(_adapter *adapter); -+ -+s32 rtw_hal_macid_drop(_adapter *adapter, u8 macid); -+s32 rtw_hal_macid_undrop(_adapter *adapter, 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 -+#ifdef CONFIG_FW_CORRECT_BCN -+void rtw_hal_fw_correct_bcn(_adapter *padapter); -+#endif -+s32 rtw_hal_fw_dl(_adapter *padapter, u8 wowlan); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ void rtw_hal_clear_interrupt(_adapter *padapter); -+#endif -+ -+void rtw_hal_set_tx_power_level(_adapter *adapter, u8 channel); -+void rtw_hal_update_txpwr_level(_adapter *adapter); -+void rtw_hal_set_txpwr_done(_adapter *adapter); -+void rtw_hal_set_tx_power_index(_adapter *adapter, u32 powerindex -+ , enum rf_path rfpath, u8 rate); -+ -+u8 rtw_hal_get_tx_power_index(_adapter *adapter, enum rf_path rfpath -+ , RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch -+ , struct txpwr_idx_comp *tic); -+s8 rtw_hal_get_txpwr_target_extra_bias(_adapter *adapter, enum rf_path rfpath -+ , RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch); -+ -+u8 rtw_hal_ops_check(_adapter *padapter); -+ -+#ifdef RTW_HALMAC -+ u8 rtw_hal_init_mac_register(PADAPTER); -+ u8 rtw_hal_init_phy(PADAPTER); -+s32 rtw_hal_fw_mem_dl(_adapter *padapter, enum fw_mem mem); -+#endif /* RTW_HALMAC */ -+ -+#ifdef CONFIG_RFKILL_POLL -+bool rtw_hal_rfkill_poll(_adapter *adapter, u8 *valid); -+#endif -+ -+#endif /* __HAL_INTF_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_pg.h b/drivers/net/wireless/rtl8821cs/include/hal_pg.h -new file mode 100644 -index 000000000..2df6a399c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_pg.h -@@ -0,0 +1,997 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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_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 -+ -+#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 -+ * *****************************************************/ -+#define EEPROM_USB_MODE_8812 0x08 -+ -+#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_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_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 -+ -+#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 8188GTV/8188GTVS -+ ==================================================== -+ */ -+ -+#define GET_PG_KFREE_ON_8188GTV(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8188GTV(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8188GTV 0xEE -+#define PPG_THERMAL_OFFSET_8188GTV 0xEF -+ -+#define EEPROM_ChannelPlan_8188GTV 0xB8 -+#define EEPROM_XTAL_8188GTV 0xB9 -+#define EEPROM_THERMAL_METER_8188GTV 0xBA -+#define EEPROM_IQK_LCK_8188GTV 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8188GTV 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8188GTV 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8188GTV 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8188GTV 0xC1 -+#define EEPROM_FEATURE_OPTION_8188GTV 0xC2 -+#define EEPROM_RF_BT_SETTING_8188GTV 0xC3 -+#define EEPROM_VERSION_8188GTV 0xC4 -+#define EEPROM_CustomID_8188GTV 0xC5 -+#define EEPROM_TX_BBSWING_2G_8188GTV 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8188GTV 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8188GTV 0xC9 -+#define EEPROM_RFE_OPTION_8188GTV 0xCA -+#define EEPROM_COUNTRY_CODE_8188GTV 0xCB -+#define EEPROM_CUSTOMER_ID_8188GTV 0x7F -+#define EEPROM_SUBCUSTOMER_ID_8188GTV 0x59 -+ -+/* RTL8188GTVU */ -+#define EEPROM_MAC_ADDR_8188GTVU 0xD7 -+#define EEPROM_VID_8188GTVU 0xD0 -+#define EEPROM_PID_8188GTVU 0xD2 -+#define EEPROM_PA_TYPE_8188GTVU 0xBC -+#define EEPROM_LNA_TYPE_2G_8188GTVU 0xBD -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8188GTVU 0xD4 -+ -+/* RTL8188GTVS */ -+#define EEPROM_MAC_ADDR_8188GTVS 0x11A -+#define EEPROM_Voltage_ADDR_8188GTV 0x8 -+ -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8723BE/8723BU/8723BS -+ * *****************************************************/ -+#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_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 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 EEPROM_CHANNEL_PLAN_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_CUSTOMER_ID_8821C 0xC5 -+#define EEPROM_TX_BBSWING_2G_8821C 0xC6 -+#define EEPROM_TX_BBSWING_5G_8821C 0xC7 -+#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_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 PG Offset for 8822C -+ * ==================================================== -+ */ -+#define EEPROM_TX_PWR_INX_8822C 0x10 -+#define EEPROM_ChannelPlan_8822C 0xB8 -+#define EEPROM_XTAL_B9_8822C 0xB9 -+#define EEPROM_IQK_LCK_8822C 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8822C 0xBC -+/* PATH A & PATH B */ -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_AB_8822C 0xBD -+/* PATH C & PATH D */ -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_CD_8822C 0xBE -+/* PATH A & PATH B */ -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_AB_8822C 0xBF -+/* PATH C & PATH D */ -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_CD_8822C 0xC0 -+ -+#define EEPROM_RF_BOARD_OPTION_8822C 0xC1 -+#define EEPROM_FEATURE_OPTION_8822C 0xC2 -+#define EEPROM_RF_BT_SETTING_8822C 0xC3 -+#define EEPROM_VERSION_8822C 0xC4 -+#define EEPROM_CustomID_8822C 0xC5 -+#define EEPROM_TX_BBSWING_2G_8822C 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8822C 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8822C 0xC9 -+#define EEPROM_RFE_OPTION_8822C 0xCA -+#define EEPROM_COUNTRY_CODE_8822C 0xCB -+#define EEPROM_THERMAL_METER_A_8822C 0xD0 -+#define EEPROM_THERMAL_METER_B_8822C 0xD1 -+ -+#define EEPROM_XTAL_110_8822C 0x110 -+#define EEPROM_XTAL_111_8822C 0x111 -+ -+/* RTL8822CU */ -+#define EEPROM_MAC_ADDR_8822CU 0x157 -+#define EEPROM_VID_8822CU 0x100 -+#define EEPROM_PID_8822CU 0x102 -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8822CU 0x104 -+#define EEPROM_USB_MODE_8822CU 0x06 -+ -+/* RTL8822CS */ -+#define EEPROM_MAC_ADDR_8822CS 0x16A -+ -+/* RTL8822CE */ -+#define EEPROM_MAC_ADDR_8822CE 0x120 -+ -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8192F -+ * **************************************************** */ -+#define EEPROM_ChannelPlan_8192F 0xB8 -+#define EEPROM_XTAL_8192F 0xB9 -+#define EEPROM_THERMAL_METER_8192F 0xBA -+#define EEPROM_IQK_LCK_8192F 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8192F 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8192F 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8192F 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8192F 0xC1 -+#define EEPROM_FEATURE_OPTION_8192F 0xC2 -+#define EEPROM_RF_BT_SETTING_8192F 0xC3 -+#define EEPROM_VERSION_8192F 0xC4 -+#define EEPROM_CustomID_8192F 0xC5 -+#define EEPROM_TX_BBSWING_2G_8192F 0xC6 -+#define EEPROM_TX_BBSWING_5G_8192F 0xC7 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8192F 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8192F 0xC9 -+#define EEPROM_RFE_OPTION_8192F 0xCA -+#define EEPROM_COUNTRY_CODE_8192F 0xCB -+/*RTL8192FS*/ -+#define EEPROM_MAC_ADDR_8192FS 0x11A -+#define EEPROM_Voltage_ADDR_8192F 0x8 -+/* RTL8192FU */ -+#define EEPROM_MAC_ADDR_8192FU 0x107 -+#define EEPROM_VID_8192FU 0x100 -+#define EEPROM_PID_8192FU 0x102 -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8192FU 0x104 -+/* RTL8192FE */ -+#define EEPROM_MAC_ADDR_8192FE 0xD0 -+#define EEPROM_VID_8192FE 0xD6 -+#define EEPROM_DID_8192FE 0xD8 -+#define EEPROM_SVID_8192FE 0xDA -+#define EEPROM_SMID_8192FE 0xDC -+ -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8710B -+ * **************************************************** */ -+#define RTL_EEPROM_ID_8710B 0x8195 -+#define EEPROM_Default_ThermalMeter_8710B 0x1A -+ -+#define EEPROM_CHANNEL_PLAN_8710B 0xC8 -+#define EEPROM_XTAL_8710B 0xC9 -+#define EEPROM_THERMAL_METER_8710B 0xCA -+#define EEPROM_IQK_LCK_8710B 0xCB -+#define EEPROM_2G_5G_PA_TYPE_8710B 0xCC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8710B 0xCD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8710B 0xCF -+#define EEPROM_TX_KFREE_8710B 0xEE //Physical Efuse Address -+#define EEPROM_THERMAL_8710B 0xEF //Physical Efuse Address -+#define EEPROM_PACKAGE_TYPE_8710B 0xF8 //Physical Efuse Address -+ -+#define EEPROM_RF_BOARD_OPTION_8710B 0x131 -+#define EEPROM_RF_FEATURE_OPTION_8710B 0x132 -+#define EEPROM_RF_BT_SETTING_8710B 0x133 -+#define EEPROM_VERSION_8710B 0x134 -+#define EEPROM_CUSTOM_ID_8710B 0x135 -+#define EEPROM_TX_BBSWING_2G_8710B 0x136 -+#define EEPROM_TX_BBSWING_5G_8710B 0x137 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8710B 0x138 -+#define EEPROM_RF_ANTENNA_OPT_8710B 0x139 -+#define EEPROM_RFE_OPTION_8710B 0x13A -+#define EEPROM_COUNTRY_CODE_8710B 0x13B -+#define EEPROM_COUNTRY_CODE_2_8710B 0x13C -+ -+#define EEPROM_MAC_ADDR_8710B 0x11A -+#define EEPROM_VID_8710BU 0x1C0 -+#define EEPROM_PID_8710BU 0x1C2 -+ -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8814B -+ * **************************************************** */ -+ -+#define EEPROM_USB_MODE_8814BU 0x06 -+/* 0x10 ~ 0x63 = TX power area. */ -+#define EEPROM_TX_PWR_INX_8814B 0x10 -+#define EEPROM_ChannelPlan_8814B 0xB8 -+#define EEPROM_XTAL_8814B 0xB9 -+#define EEPROM_IQK_LCK_8814B 0xBB -+ -+#define EEPROM_RF_BOARD_OPTION_8814B 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_8814B 0xC2 -+#define EEPROM_RF_BT_SETTING_8814B 0xC3 -+#define EEPROM_VERSION_8814B 0xC4 -+#define EEPROM_CustomID_8814B 0xC5 -+#define EEPROM_TX_BBSWING_2G_8814B 0xC6 -+#define EEPROM_TX_BBSWING_5G_8814B 0xC7 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8814B 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8814B 0xC9 -+#define EEPROM_RFE_OPTION_8814B 0xCA -+#define EEPROM_COUNTRY_CODE_8814B 0xCB -+ -+#define EEPROM_THERMAL_METER_A_8814B 0xD0 -+#define EEPROM_THERMAL_METER_B_8814B 0xD1 -+#define EEPROM_THERMAL_METER_C_8814B 0xD2 -+#define EEPROM_THERMAL_METER_D_8814B 0xD3 -+ -+#define EEPROM_MAC_ADDR_8814BE 0x120 -+#define EEPROM_VID_8814B 0x126 -+#define EEPROM_DID_8814B 0x128 -+#define EEPROM_SVID_8814B 0x12A -+#define EEPROM_SMID_8814B 0x12C -+ -+/* RTL8814BU */ -+#define EEPROM_MAC_ADDR_8814BU 0x157 -+#define EEPROM_VID_8814BU 0x150 -+#define EEPROM_PID_8814BU 0x152 -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8814BU 0x154 -+ -+/* -+ * ==================================================== -+ * EEPROM/Efuse PG Offset for 8723F -+ * ==================================================== -+ */ -+#define EEPROM_TX_PWR_INX_8723F 0x10 -+#define EEPROM_ChannelPlan_8723F 0xB8 -+#define EEPROM_XTAL_B9_8723F 0xB9 -+#define EEPROM_THERMAL_METER_8723F 0xBA -+#define EEPROM_IQK_LCK_8723F 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8723F 0xBC -+/* PATH A & PATH B */ -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_AB_8723F 0xBD -+/* PATH C & PATH D */ -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_CD_8723F 0xBE -+/* PATH A & PATH B */ -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_AB_8723F 0xBF -+/* PATH C & PATH D */ -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_CD_8723F 0xC0 -+ -+#define EEPROM_RF_BOARD_OPTION_8723F 0xC1 -+#define EEPROM_FEATURE_OPTION_8723F 0xC2 -+#define EEPROM_RF_BT_SETTING_8723F 0xC3 -+#define EEPROM_VERSION_8723F 0xC4 -+#define EEPROM_CustomID_8723F 0xC5 -+#define EEPROM_TX_BBSWING_2G_8723F 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8723F 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8723F 0xC9 -+#define EEPROM_RFE_OPTION_8723F 0xCA -+#define EEPROM_COUNTRY_CODE_8723F 0xCB -+ -+/* RTL8723FU */ -+#define EEPROM_MAC_ADDR_8723FU 0x108 -+#define EEPROM_VID_8723FU 0x100 -+#define EEPROM_PID_8723FU 0x102 -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8723FU 0x104 -+#define EEPROM_USB_MODE_8723FU 0x03 -+ -+/* RTL8723FS */ -+#define EEPROM_MAC_ADDR_8723FS 0x11A -+ -+/* **************************************************** -+ * EEPROM/Efuse Value Type -+ * **************************************************** */ -+#define EETYPE_TX_PWR 0x0 -+#define EETYPE_MAX_RFE_8192F 0x31 -+/* **************************************************** -+ * 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_8188GTV 0x18 -+#define EEPROM_Default_ThermalMeter_8814A 0x18 -+#define EEPROM_Default_ThermalMeter_8192F 0x1A -+#define EEPROM_Default_ThermalMeter_8814B 0x20 -+ -+#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_8723F 0x3F -+#define EEPROM_Default_CrystalCap_8188F 0x20 -+#define EEPROM_Default_CrystalCap_8188GTV 0x20 -+#define EEPROM_Default_CrystalCap_8192F 0x20 -+#define EEPROM_Default_CrystalCap_B9_8822C 0x3F -+#define EEPROM_Default_CrystalCap_110_8822C 0x40 -+#define EEPROM_Default_CrystalCap_111_8822C 0x40 -+#define EEPROM_Default_CrystalCap_8814B 0x40 -+#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 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_RTL8192F = 16, -+ BT_RTL8822C = 17, -+ BT_RTL8814B = 18, -+ BT_RTL8723F = 19, -+} BT_CoType, *PBT_CoType; -+ -+typedef enum _BT_RadioShared { -+ BT_Radio_Shared = 0, -+ BT_Radio_Individual = 1, -+} BT_RadioShared, *PBT_RadioShared; -+ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_phy.h b/drivers/net/wireless/rtl8821cs/include/hal_phy.h -new file mode 100644 -index 000000000..35f901a49 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_phy.h -@@ -0,0 +1,234 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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) \ -+ (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_CHIP { -+ RF_CHIP_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_CHIP_MAX -+} RF_CHIP_E, *PRF_CHIP_E; -+ -+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; -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+u32 -+PHY_CalculateBitShift( -+ u32 BitMask -+); -+ -+#ifdef CONFIG_RF_SHADOW_RW -+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; -+ -+u32 -+PHY_RFShadowRead( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 Offset); -+ -+void -+PHY_RFShadowWrite( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 Offset, -+ u32 Data); -+ -+BOOLEAN -+PHY_RFShadowCompare( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 Offset); -+ -+void -+PHY_RFShadowRecorver( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 Offset); -+ -+void -+PHY_RFShadowCompareAll( -+ PADAPTER Adapter); -+ -+void -+PHY_RFShadowRecorverAll( -+ PADAPTER Adapter); -+ -+void -+PHY_RFShadowCompareFlagSet( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 Offset, -+ u8 Type); -+ -+void -+PHY_RFShadowRecorverFlagSet( -+ PADAPTER Adapter, -+ enum rf_path eRFPath, -+ u32 Offset, -+ u8 Type); -+ -+void -+PHY_RFShadowCompareFlagSetAll( -+ PADAPTER Adapter); -+ -+void -+PHY_RFShadowRecorverFlagSetAll( -+ PADAPTER Adapter); -+ -+void -+PHY_RFShadowRefresh( -+ PADAPTER Adapter); -+#endif /*#CONFIG_RF_SHADOW_RW*/ -+#endif /* __HAL_COMMON_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_phy_reg.h b/drivers/net/wireless/rtl8821cs/include/hal_phy_reg.h -new file mode 100644 -index 000000000..13d77ab41 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_phy_reg.h -@@ -0,0 +1,270 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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*/ -+#define bRFRegOffsetMask 0xfffff -+ -+/* alias for phydm coding style */ -+#define REG_OFDM_0_XA_TX_IQ_IMBALANCE rOFDM0_XATxIQImbalance -+#define REG_OFDM_0_ECCA_THRESHOLD rOFDM0_ECCAThreshold -+#define REG_FPGA0_XB_LSSI_READ_BACK rFPGA0_XB_LSSIReadBack -+#define REG_FPGA0_TX_GAIN_STAGE rFPGA0_TxGainStage -+#define REG_OFDM_0_XA_AGC_CORE1 rOFDM0_XAAGCCore1 -+#define REG_OFDM_0_XB_AGC_CORE1 rOFDM0_XBAGCCore1 -+#define REG_A_TX_SCALE_JAGUAR rA_TxScale_Jaguar -+#define REG_B_TX_SCALE_JAGUAR rB_TxScale_Jaguar -+ -+#define REG_FPGA0_XAB_RF_INTERFACE_SW rFPGA0_XAB_RFInterfaceSW -+#define REG_FPGA0_XAB_RF_PARAMETER rFPGA0_XAB_RFParameter -+#define REG_FPGA0_XA_HSSI_PARAMETER1 rFPGA0_XA_HSSIParameter1 -+#define REG_FPGA0_XA_LSSI_PARAMETER rFPGA0_XA_LSSIParameter -+#define REG_FPGA0_XA_RF_INTERFACE_OE rFPGA0_XA_RFInterfaceOE -+#define REG_FPGA0_XB_HSSI_PARAMETER1 rFPGA0_XB_HSSIParameter1 -+#define REG_FPGA0_XB_LSSI_PARAMETER rFPGA0_XB_LSSIParameter -+#define REG_FPGA0_XB_LSSI_READ_BACK rFPGA0_XB_LSSIReadBack -+#define REG_FPGA0_XB_RF_INTERFACE_OE rFPGA0_XB_RFInterfaceOE -+#define REG_FPGA0_XCD_RF_INTERFACE_SW rFPGA0_XCD_RFInterfaceSW -+#define REG_FPGA0_XCD_SWITCH_CONTROL rFPGA0_XCD_SwitchControl -+#define REG_FPGA1_TX_BLOCK rFPGA1_TxBlock -+#define REG_FPGA1_TX_INFO rFPGA1_TxInfo -+#define REG_IQK_AGC_CONT rIQK_AGC_Cont -+#define REG_IQK_AGC_PTS rIQK_AGC_Pts -+#define REG_IQK_AGC_RSP rIQK_AGC_Rsp -+#define REG_OFDM_0_AGC_RSSI_TABLE rOFDM0_AGCRSSITable -+#define REG_OFDM_0_ECCA_THRESHOLD rOFDM0_ECCAThreshold -+#define REG_OFDM_0_RX_IQ_EXT_ANTA rOFDM0_RxIQExtAnta -+#define REG_OFDM_0_TR_MUX_PAR rOFDM0_TRMuxPar -+#define REG_OFDM_0_TRX_PATH_ENABLE rOFDM0_TRxPathEnable -+#define REG_OFDM_0_XA_AGC_CORE1 rOFDM0_XAAGCCore1 -+#define REG_OFDM_0_XA_RX_IQ_IMBALANCE rOFDM0_XARxIQImbalance -+#define REG_OFDM_0_XA_TX_IQ_IMBALANCE rOFDM0_XATxIQImbalance -+#define REG_OFDM_0_XB_AGC_CORE1 rOFDM0_XBAGCCore1 -+#define REG_OFDM_0_XB_RX_IQ_IMBALANCE rOFDM0_XBRxIQImbalance -+#define REG_OFDM_0_XB_TX_IQ_IMBALANCE rOFDM0_XBTxIQImbalance -+#define REG_OFDM_0_XC_TX_AFE rOFDM0_XCTxAFE -+#define REG_OFDM_0_XD_TX_AFE rOFDM0_XDTxAFE -+ -+/*#define REG_A_CFO_LONG_DUMP_92E rA_CfoLongDump_92E*/ -+#define REG_A_CFO_LONG_DUMP_JAGUAR rA_CfoLongDump_Jaguar -+/*#define REG_A_CFO_SHORT_DUMP_92E rA_CfoShortDump_92E*/ -+#define REG_A_CFO_SHORT_DUMP_JAGUAR rA_CfoShortDump_Jaguar -+#define REG_A_RFE_PINMUX_JAGUAR rA_RFE_Pinmux_Jaguar -+/*#define REG_A_RSSI_DUMP_92E rA_RSSIDump_92E*/ -+#define REG_A_RSSI_DUMP_JAGUAR rA_RSSIDump_Jaguar -+/*#define REG_A_RX_SNR_DUMP_92E rA_RXsnrDump_92E*/ -+#define REG_A_RX_SNR_DUMP_JAGUAR rA_RXsnrDump_Jaguar -+/*#define REG_A_TX_AGC rA_TXAGC*/ -+#define REG_A_TX_SCALE_JAGUAR rA_TxScale_Jaguar -+#define REG_BW_INDICATION_JAGUAR rBWIndication_Jaguar -+/*#define REG_B_BBSWING rB_BBSWING*/ -+/*#define REG_B_CFO_LONG_DUMP_92E rB_CfoLongDump_92E*/ -+#define REG_B_CFO_LONG_DUMP_JAGUAR rB_CfoLongDump_Jaguar -+/*#define REG_B_CFO_SHORT_DUMP_92E rB_CfoShortDump_92E*/ -+#define REG_B_CFO_SHORT_DUMP_JAGUAR rB_CfoShortDump_Jaguar -+/*#define REG_B_RSSI_DUMP_92E rB_RSSIDump_92E*/ -+#define REG_B_RSSI_DUMP_JAGUAR rB_RSSIDump_Jaguar -+/*#define REG_B_RX_SNR_DUMP_92E rB_RXsnrDump_92E*/ -+#define REG_B_RX_SNR_DUMP_JAGUAR rB_RXsnrDump_Jaguar -+/*#define REG_B_TX_AGC rB_TXAGC*/ -+#define REG_B_TX_SCALE_JAGUAR rB_TxScale_Jaguar -+#define REG_BLUE_TOOTH rBlue_Tooth -+#define REG_CCK_0_AFE_SETTING rCCK0_AFESetting -+/*#define REG_C_BBSWING rC_BBSWING*/ -+/*#define REG_C_TX_AGC rC_TXAGC*/ -+#define REG_C_TX_SCALE_JAGUAR2 rC_TxScale_Jaguar2 -+#define REG_CONFIG_ANT_A rConfig_AntA -+#define REG_CONFIG_ANT_B rConfig_AntB -+#define REG_CONFIG_PMPD_ANT_A rConfig_Pmpd_AntA -+#define REG_CONFIG_PMPD_ANT_B rConfig_Pmpd_AntB -+#define REG_DPDT_CONTROL rDPDT_control -+/*#define REG_D_BBSWING rD_BBSWING*/ -+/*#define REG_D_TX_AGC rD_TXAGC*/ -+#define REG_D_TX_SCALE_JAGUAR2 rD_TxScale_Jaguar2 -+#define REG_FPGA0_ANALOG_PARAMETER4 rFPGA0_AnalogParameter4 -+#define REG_FPGA0_IQK rFPGA0_IQK -+#define REG_FPGA0_PSD_FUNCTION rFPGA0_PSDFunction -+#define REG_FPGA0_PSD_REPORT rFPGA0_PSDReport -+#define REG_FPGA0_RFMOD rFPGA0_RFMOD -+#define REG_FPGA0_TX_GAIN_STAGE rFPGA0_TxGainStage -+#define REG_FPGA0_XAB_RF_INTERFACE_SW rFPGA0_XAB_RFInterfaceSW -+#define REG_FPGA0_XAB_RF_PARAMETER rFPGA0_XAB_RFParameter -+#define REG_FPGA0_XA_HSSI_PARAMETER1 rFPGA0_XA_HSSIParameter1 -+#define REG_FPGA0_XA_LSSI_PARAMETER rFPGA0_XA_LSSIParameter -+#define REG_FPGA0_XA_RF_INTERFACE_OE rFPGA0_XA_RFInterfaceOE -+#define REG_FPGA0_XB_HSSI_PARAMETER1 rFPGA0_XB_HSSIParameter1 -+#define REG_FPGA0_XB_LSSI_PARAMETER rFPGA0_XB_LSSIParameter -+#define REG_FPGA0_XB_LSSI_READ_BACK rFPGA0_XB_LSSIReadBack -+#define REG_FPGA0_XB_RF_INTERFACE_OE rFPGA0_XB_RFInterfaceOE -+#define REG_FPGA0_XCD_RF_INTERFACE_SW rFPGA0_XCD_RFInterfaceSW -+#define REG_FPGA0_XCD_SWITCH_CONTROL rFPGA0_XCD_SwitchControl -+#define REG_FPGA1_TX_BLOCK rFPGA1_TxBlock -+#define REG_FPGA1_TX_INFO rFPGA1_TxInfo -+#define REG_IQK_AGC_CONT rIQK_AGC_Cont -+#define REG_IQK_AGC_PTS rIQK_AGC_Pts -+#define REG_IQK_AGC_RSP rIQK_AGC_Rsp -+#define REG_OFDM_0_AGC_RSSI_TABLE rOFDM0_AGCRSSITable -+#define REG_OFDM_0_ECCA_THRESHOLD rOFDM0_ECCAThreshold -+#define REG_OFDM_0_RX_IQ_EXT_ANTA rOFDM0_RxIQExtAnta -+#define REG_OFDM_0_TR_MUX_PAR rOFDM0_TRMuxPar -+#define REG_OFDM_0_TRX_PATH_ENABLE rOFDM0_TRxPathEnable -+#define REG_OFDM_0_XA_AGC_CORE1 rOFDM0_XAAGCCore1 -+#define REG_OFDM_0_XA_RX_IQ_IMBALANCE rOFDM0_XARxIQImbalance -+#define REG_OFDM_0_XA_TX_IQ_IMBALANCE rOFDM0_XATxIQImbalance -+#define REG_OFDM_0_XB_AGC_CORE1 rOFDM0_XBAGCCore1 -+#define REG_OFDM_0_XB_RX_IQ_IMBALANCE rOFDM0_XBRxIQImbalance -+#define REG_OFDM_0_XB_TX_IQ_IMBALANCE rOFDM0_XBTxIQImbalance -+#define REG_OFDM_0_XC_TX_AFE rOFDM0_XCTxAFE -+#define REG_OFDM_0_XD_TX_AFE rOFDM0_XDTxAFE -+#define REG_PMPD_ANAEN rPMPD_ANAEN -+#define REG_PDP_ANT_A rPdp_AntA -+#define REG_PDP_ANT_A_4 rPdp_AntA_4 -+#define REG_PDP_ANT_B rPdp_AntB -+#define REG_PDP_ANT_B_4 rPdp_AntB_4 -+#define REG_PWED_TH_JAGUAR rPwed_TH_Jaguar -+#define REG_RX_CCK rRx_CCK -+#define REG_RX_IQK rRx_IQK -+#define REG_RX_IQK_PI_A rRx_IQK_PI_A -+#define REG_RX_IQK_PI_B rRx_IQK_PI_B -+#define REG_RX_IQK_TONE_A rRx_IQK_Tone_A -+#define REG_RX_IQK_TONE_B rRx_IQK_Tone_B -+#define REG_RX_OFDM rRx_OFDM -+#define REG_RX_POWER_AFTER_IQK_A_2 rRx_Power_After_IQK_A_2 -+#define REG_RX_POWER_AFTER_IQK_B_2 rRx_Power_After_IQK_B_2 -+#define REG_RX_POWER_BEFORE_IQK_A_2 rRx_Power_Before_IQK_A_2 -+#define REG_RX_POWER_BEFORE_IQK_B_2 rRx_Power_Before_IQK_B_2 -+#define REG_RX_TO_RX rRx_TO_Rx -+#define REG_RX_WAIT_CCA rRx_Wait_CCA -+#define REG_RX_WAIT_RIFS rRx_Wait_RIFS -+#define REG_S0_S1_PATH_SWITCH rS0S1_PathSwitch -+/*#define REG_S1_RXEVM_DUMP_92E rS1_RXevmDump_92E*/ -+#define REG_S1_RXEVM_DUMP_JAGUAR rS1_RXevmDump_Jaguar -+/*#define REG_S2_RXEVM_DUMP_92E rS2_RXevmDump_92E*/ -+#define REG_S2_RXEVM_DUMP_JAGUAR rS2_RXevmDump_Jaguar -+#define REG_SYM_WLBT_PAPE_SEL rSYM_WLBT_PAPE_SEL -+#define REG_SINGLE_TONE_CONT_TX_JAGUAR rSingleTone_ContTx_Jaguar -+#define REG_SLEEP rSleep -+#define REG_STANDBY rStandby -+#define REG_TX_AGC_A_CCK_11_CCK_1_JAGUAR rTxAGC_A_CCK11_CCK1_JAguar -+#define REG_TX_AGC_A_CCK_1_MCS32 rTxAGC_A_CCK1_Mcs32 -+#define REG_TX_AGC_A_MCS11_MCS8_JAGUAR rTxAGC_A_MCS11_MCS8_JAguar -+#define REG_TX_AGC_A_MCS15_MCS12_JAGUAR rTxAGC_A_MCS15_MCS12_JAguar -+#define REG_TX_AGC_A_MCS19_MCS16_JAGUAR rTxAGC_A_MCS19_MCS16_JAguar -+#define REG_TX_AGC_A_MCS23_MCS20_JAGUAR rTxAGC_A_MCS23_MCS20_JAguar -+#define REG_TX_AGC_A_MCS3_MCS0_JAGUAR rTxAGC_A_MCS3_MCS0_JAguar -+#define REG_TX_AGC_A_MCS7_MCS4_JAGUAR rTxAGC_A_MCS7_MCS4_JAguar -+#define REG_TX_AGC_A_MCS03_MCS00 rTxAGC_A_Mcs03_Mcs00 -+#define REG_TX_AGC_A_MCS07_MCS04 rTxAGC_A_Mcs07_Mcs04 -+#define REG_TX_AGC_A_MCS11_MCS08 rTxAGC_A_Mcs11_Mcs08 -+#define REG_TX_AGC_A_MCS15_MCS12 rTxAGC_A_Mcs15_Mcs12 -+#define REG_TX_AGC_A_NSS1_INDEX3_NSS1_INDEX0_JAGUAR rTxAGC_A_Nss1Index3_Nss1Index0_JAguar -+#define REG_TX_AGC_A_NSS1_INDEX7_NSS1_INDEX4_JAGUAR rTxAGC_A_Nss1Index7_Nss1Index4_JAguar -+#define REG_TX_AGC_A_NSS2_INDEX1_NSS1_INDEX8_JAGUAR rTxAGC_A_Nss2Index1_Nss1Index8_JAguar -+#define REG_TX_AGC_A_NSS2_INDEX5_NSS2_INDEX2_JAGUAR rTxAGC_A_Nss2Index5_Nss2Index2_JAguar -+#define REG_TX_AGC_A_NSS2_INDEX9_NSS2_INDEX6_JAGUAR rTxAGC_A_Nss2Index9_Nss2Index6_JAguar -+#define REG_TX_AGC_A_NSS3_INDEX3_NSS3_INDEX0_JAGUAR rTxAGC_A_Nss3Index3_Nss3Index0_JAguar -+#define REG_TX_AGC_A_NSS3_INDEX7_NSS3_INDEX4_JAGUAR rTxAGC_A_Nss3Index7_Nss3Index4_JAguar -+#define REG_TX_AGC_A_NSS3_INDEX9_NSS3_INDEX8_JAGUAR rTxAGC_A_Nss3Index9_Nss3Index8_JAguar -+#define REG_TX_AGC_A_OFDM18_OFDM6_JAGUAR rTxAGC_A_Ofdm18_Ofdm6_JAguar -+#define REG_TX_AGC_A_OFDM54_OFDM24_JAGUAR rTxAGC_A_Ofdm54_Ofdm24_JAguar -+#define REG_TX_AGC_A_RATE18_06 rTxAGC_A_Rate18_06 -+#define REG_TX_AGC_A_RATE54_24 rTxAGC_A_Rate54_24 -+#define REG_TX_AGC_B_CCK_11_A_CCK_2_11 rTxAGC_B_CCK11_A_CCK2_11 -+#define REG_TX_AGC_B_CCK_11_CCK_1_JAGUAR rTxAGC_B_CCK11_CCK1_JAguar -+#define REG_TX_AGC_B_CCK_1_55_MCS32 rTxAGC_B_CCK1_55_Mcs32 -+#define REG_TX_AGC_B_MCS11_MCS8_JAGUAR rTxAGC_B_MCS11_MCS8_JAguar -+#define REG_TX_AGC_B_MCS15_MCS12_JAGUAR rTxAGC_B_MCS15_MCS12_JAguar -+#define REG_TX_AGC_B_MCS19_MCS16_JAGUAR rTxAGC_B_MCS19_MCS16_JAguar -+#define REG_TX_AGC_B_MCS23_MCS20_JAGUAR rTxAGC_B_MCS23_MCS20_JAguar -+#define REG_TX_AGC_B_MCS3_MCS0_JAGUAR rTxAGC_B_MCS3_MCS0_JAguar -+#define REG_TX_AGC_B_MCS7_MCS4_JAGUAR rTxAGC_B_MCS7_MCS4_JAguar -+#define REG_TX_AGC_B_MCS03_MCS00 rTxAGC_B_Mcs03_Mcs00 -+#define REG_TX_AGC_B_MCS07_MCS04 rTxAGC_B_Mcs07_Mcs04 -+#define REG_TX_AGC_B_MCS11_MCS08 rTxAGC_B_Mcs11_Mcs08 -+#define REG_TX_AGC_B_MCS15_MCS12 rTxAGC_B_Mcs15_Mcs12 -+#define REG_TX_AGC_B_NSS1_INDEX3_NSS1_INDEX0_JAGUAR rTxAGC_B_Nss1Index3_Nss1Index0_JAguar -+#define REG_TX_AGC_B_NSS1_INDEX7_NSS1_INDEX4_JAGUAR rTxAGC_B_Nss1Index7_Nss1Index4_JAguar -+#define REG_TX_AGC_B_NSS2_INDEX1_NSS1_INDEX8_JAGUAR rTxAGC_B_Nss2Index1_Nss1Index8_JAguar -+#define REG_TX_AGC_B_NSS2_INDEX5_NSS2_INDEX2_JAGUAR rTxAGC_B_Nss2Index5_Nss2Index2_JAguar -+#define REG_TX_AGC_B_NSS2_INDEX9_NSS2_INDEX6_JAGUAR rTxAGC_B_Nss2Index9_Nss2Index6_JAguar -+#define REG_TX_AGC_B_NSS3_INDEX3_NSS3_INDEX0_JAGUAR rTxAGC_B_Nss3Index3_Nss3Index0_JAguar -+#define REG_TX_AGC_B_NSS3_INDEX7_NSS3_INDEX4_JAGUAR rTxAGC_B_Nss3Index7_Nss3Index4_JAguar -+#define REG_TX_AGC_B_NSS3_INDEX9_NSS3_INDEX8_JAGUAR rTxAGC_B_Nss3Index9_Nss3Index8_JAguar -+#define REG_TX_AGC_B_OFDM18_OFDM6_JAGUAR rTxAGC_B_Ofdm18_Ofdm6_JAguar -+#define REG_TX_AGC_B_OFDM54_OFDM24_JAGUAR rTxAGC_B_Ofdm54_Ofdm24_JAguar -+#define REG_TX_AGC_B_RATE18_06 rTxAGC_B_Rate18_06 -+#define REG_TX_AGC_B_RATE54_24 rTxAGC_B_Rate54_24 -+#define REG_TX_AGC_C_CCK_11_CCK_1_JAGUAR rTxAGC_C_CCK11_CCK1_JAguar -+#define REG_TX_AGC_C_MCS11_MCS8_JAGUAR rTxAGC_C_MCS11_MCS8_JAguar -+#define REG_TX_AGC_C_MCS15_MCS12_JAGUAR rTxAGC_C_MCS15_MCS12_JAguar -+#define REG_TX_AGC_C_MCS19_MCS16_JAGUAR rTxAGC_C_MCS19_MCS16_JAguar -+#define REG_TX_AGC_C_MCS23_MCS20_JAGUAR rTxAGC_C_MCS23_MCS20_JAguar -+#define REG_TX_AGC_C_MCS3_MCS0_JAGUAR rTxAGC_C_MCS3_MCS0_JAguar -+#define REG_TX_AGC_C_MCS7_MCS4_JAGUAR rTxAGC_C_MCS7_MCS4_JAguar -+#define REG_TX_AGC_C_NSS1_INDEX3_NSS1_INDEX0_JAGUAR rTxAGC_C_Nss1Index3_Nss1Index0_JAguar -+#define REG_TX_AGC_C_NSS1_INDEX7_NSS1_INDEX4_JAGUAR rTxAGC_C_Nss1Index7_Nss1Index4_JAguar -+#define REG_TX_AGC_C_NSS2_INDEX1_NSS1_INDEX8_JAGUAR rTxAGC_C_Nss2Index1_Nss1Index8_JAguar -+#define REG_TX_AGC_C_NSS2_INDEX5_NSS2_INDEX2_JAGUAR rTxAGC_C_Nss2Index5_Nss2Index2_JAguar -+#define REG_TX_AGC_C_NSS2_INDEX9_NSS2_INDEX6_JAGUAR rTxAGC_C_Nss2Index9_Nss2Index6_JAguar -+#define REG_TX_AGC_C_NSS3_INDEX3_NSS3_INDEX0_JAGUAR rTxAGC_C_Nss3Index3_Nss3Index0_JAguar -+#define REG_TX_AGC_C_NSS3_INDEX7_NSS3_INDEX4_JAGUAR rTxAGC_C_Nss3Index7_Nss3Index4_JAguar -+#define REG_TX_AGC_C_NSS3_INDEX9_NSS3_INDEX8_JAGUAR rTxAGC_C_Nss3Index9_Nss3Index8_JAguar -+#define REG_TX_AGC_C_OFDM18_OFDM6_JAGUAR rTxAGC_C_Ofdm18_Ofdm6_JAguar -+#define REG_TX_AGC_C_OFDM54_OFDM24_JAGUAR rTxAGC_C_Ofdm54_Ofdm24_JAguar -+#define REG_TX_AGC_D_CCK_11_CCK_1_JAGUAR rTxAGC_D_CCK11_CCK1_JAguar -+#define REG_TX_AGC_D_MCS11_MCS8_JAGUAR rTxAGC_D_MCS11_MCS8_JAguar -+#define REG_TX_AGC_D_MCS15_MCS12_JAGUAR rTxAGC_D_MCS15_MCS12_JAguar -+#define REG_TX_AGC_D_MCS19_MCS16_JAGUAR rTxAGC_D_MCS19_MCS16_JAguar -+#define REG_TX_AGC_D_MCS23_MCS20_JAGUAR rTxAGC_D_MCS23_MCS20_JAguar -+#define REG_TX_AGC_D_MCS3_MCS0_JAGUAR rTxAGC_D_MCS3_MCS0_JAguar -+#define REG_TX_AGC_D_MCS7_MCS4_JAGUAR rTxAGC_D_MCS7_MCS4_JAguar -+#define REG_TX_AGC_D_NSS1_INDEX3_NSS1_INDEX0_JAGUAR rTxAGC_D_Nss1Index3_Nss1Index0_JAguar -+#define REG_TX_AGC_D_NSS1_INDEX7_NSS1_INDEX4_JAGUAR rTxAGC_D_Nss1Index7_Nss1Index4_JAguar -+#define REG_TX_AGC_D_NSS2_INDEX1_NSS1_INDEX8_JAGUAR rTxAGC_D_Nss2Index1_Nss1Index8_JAguar -+#define REG_TX_AGC_D_NSS2_INDEX5_NSS2_INDEX2_JAGUAR rTxAGC_D_Nss2Index5_Nss2Index2_JAguar -+#define REG_TX_AGC_D_NSS2_INDEX9_NSS2_INDEX6_JAGUAR rTxAGC_D_Nss2Index9_Nss2Index6_JAguar -+#define REG_TX_AGC_D_NSS3_INDEX3_NSS3_INDEX0_JAGUAR rTxAGC_D_Nss3Index3_Nss3Index0_JAguar -+#define REG_TX_AGC_D_NSS3_INDEX7_NSS3_INDEX4_JAGUAR rTxAGC_D_Nss3Index7_Nss3Index4_JAguar -+#define REG_TX_AGC_D_NSS3_INDEX9_NSS3_INDEX8_JAGUAR rTxAGC_D_Nss3Index9_Nss3Index8_JAguar -+#define REG_TX_AGC_D_OFDM18_OFDM6_JAGUAR rTxAGC_D_Ofdm18_Ofdm6_JAguar -+#define REG_TX_AGC_D_OFDM54_OFDM24_JAGUAR rTxAGC_D_Ofdm54_Ofdm24_JAguar -+#define REG_TX_PATH_JAGUAR rTxPath_Jaguar -+#define REG_TX_CCK_BBON rTx_CCK_BBON -+#define REG_TX_CCK_RFON rTx_CCK_RFON -+#define REG_TX_IQK rTx_IQK -+#define REG_TX_IQK_PI_A rTx_IQK_PI_A -+#define REG_TX_IQK_PI_B rTx_IQK_PI_B -+#define REG_TX_IQK_TONE_A rTx_IQK_Tone_A -+#define REG_TX_IQK_TONE_B rTx_IQK_Tone_B -+#define REG_TX_OFDM_BBON rTx_OFDM_BBON -+#define REG_TX_OFDM_RFON rTx_OFDM_RFON -+#define REG_TX_POWER_AFTER_IQK_A rTx_Power_After_IQK_A -+#define REG_TX_POWER_AFTER_IQK_B rTx_Power_After_IQK_B -+#define REG_TX_POWER_BEFORE_IQK_A rTx_Power_Before_IQK_A -+#define REG_TX_POWER_BEFORE_IQK_B rTx_Power_Before_IQK_B -+#define REG_TX_TO_RX rTx_To_Rx -+#define REG_TX_TO_TX rTx_To_Tx -+#define REG_APK rAPK -+#define REG_ANTSEL_SW_JAGUAR r_ANTSEL_SW_Jaguar -+ -+#define rf_welut_jaguar RF_WeLut_Jaguar -+#define rf_mode_table_addr RF_ModeTableAddr -+#define rf_mode_table_data0 RF_ModeTableData0 -+#define rf_mode_table_data1 RF_ModeTableData1 -+ -+#define RX_SMOOTH_FACTOR Rx_Smooth_Factor -+ -+#endif /* __HAL_PHY_REG_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_sdio.h b/drivers/net/wireless/rtl8821cs/include/hal_sdio.h -new file mode 100644 -index 000000000..dbdbdca43 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_sdio.h -@@ -0,0 +1,95 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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]) -+ -+#ifndef RTW_HALMAC -+extern const char *_sdio_tx_queue_str[]; -+#define sdio_tx_queue_str(_page_idx) (_page_idx >= SDIO_MAX_TX_QUEUE ? "UNKNOWN" : _sdio_tx_queue_str[_page_idx]) -+#endif -+ -+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, u8 div_num); -+u32 rtw_hal_get_sdio_tx_max_length(PADAPTER padapter, u8 queue_idx); -+bool sdio_power_on_check(PADAPTER padapter); -+ -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+#if defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) ||defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8723D) -+void rtw_hal_sdio_avail_page_threshold_init(_adapter *adapter); -+void rtw_hal_sdio_avail_page_threshold_en(_adapter *adapter, u8 qidx, u8 pg_num); -+#endif -+#endif /* CONFIG_SDIO_TX_ENABLE_AVAL_INT */ -+ -+#ifdef CONFIG_FW_C2H_REG -+void sd_c2h_hisr_hdl(_adapter *adapter); -+#endif -+ -+#if defined(CONFIG_RTL8188F) || defined (CONFIG_RTL8188GTV) || defined (CONFIG_RTL8192F) || defined(CONFIG_RTL8723D) -+#define SDIO_LOCAL_CMD_ADDR(addr) ((SDIO_LOCAL_DEVICE_ID << 13) | ((addr) & SDIO_LOCAL_MSK)) -+#endif -+ -+#ifdef CONFIG_SDIO_CHK_HCI_RESUME -+bool sdio_chk_hci_resume(struct intf_hdl *pintfhdl); -+void sdio_chk_hci_suspend(struct intf_hdl *pintfhdl); -+#else -+#define sdio_chk_hci_resume(pintfhdl) _FALSE -+#define sdio_chk_hci_suspend(pintfhdl) do {} while (0) -+#endif /* CONFIG_SDIO_CHK_HCI_RESUME */ -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+/* program indirect access register in sdio local to read/write page0 registers */ -+s32 sdio_iread(PADAPTER padapter, u32 addr, u8 size, u8 *v); -+s32 sdio_iwrite(PADAPTER padapter, u32 addr, u8 size, u8 *v); -+u8 sdio_iread8(struct intf_hdl *pintfhdl, u32 addr); -+u16 sdio_iread16(struct intf_hdl *pintfhdl, u32 addr); -+u32 sdio_iread32(struct intf_hdl *pintfhdl, u32 addr); -+s32 sdio_iwrite8(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+s32 sdio_iwrite16(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+s32 sdio_iwrite32(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+u32 cmd53_4byte_alignment(struct intf_hdl *pintfhdl, u32 addr); -+ -+#ifndef CONFIG_SDIO_TX_TASKLET -+#ifdef SDIO_FREE_XMIT_BUF_SEMA -+void _rtw_sdio_free_xmitbuf_sema_up(struct xmit_priv *xmit); -+void _rtw_sdio_free_xmitbuf_sema_down(struct xmit_priv *xmit); -+#ifdef DBG_SDIO_FREE_XMIT_BUF_SEMA -+void dbg_rtw_sdio_free_xmitbuf_sema_up(struct xmit_priv *xmit, const char *caller); -+void dbg_rtw_sdio_free_xmitbuf_sema_down(struct xmit_priv *xmit, const char *caller); -+#define rtw_sdio_free_xmitbuf_sema_up(_xmit) dbg_rtw_sdio_free_xmitbuf_sema_up(_xmit, __func__) -+#define rtw_sdio_free_xmitbuf_sema_down(_xmit) dbg_rtw_sdio_free_xmitbuf_sema_down(_xmit, __func__) -+#else -+#define rtw_sdio_free_xmitbuf_sema_up(_xmit) _rtw_sdio_free_xmitbuf_sema_up(_xmit) -+#define rtw_sdio_free_xmitbuf_sema_down(_xmit) _rtw_sdio_free_xmitbuf_sema_down(_xmit) -+#endif /* DBG_SDIO_FREE_XMIT_BUF_SEMA */ -+#endif /* SDIO_FREE_XMIT_BUF_SEMA */ -+#endif /* !CONFIG_SDIO_TX_TASKLET */ -+ -+s32 sdio_initrecvbuf(struct recv_buf *recvbuf, _adapter *adapter); -+void sdio_freerecvbuf(struct recv_buf *recvbuf); -+ -+#ifdef CONFIG_SDIO_RECVBUF_PWAIT -+void dump_recvbuf_pwait_conf(void *sel, struct recv_priv *recvpriv); -+#ifdef CONFIG_SDIO_RECVBUF_PWAIT_RUNTIME_ADJUST -+int recvbuf_pwait_config_req(struct recv_priv *recvpriv, enum rtw_pwait_type type, s32 time, s32 cnt_lmt); -+int recvbuf_pwait_config_hdl(struct recv_priv *recvpriv, struct recv_buf *rbuf); -+#endif /* CONFIG_SDIO_RECVBUF_PWAIT_RUNTIME_ADJUST */ -+#endif /* CONFIG_SDIO_RECVBUF_PWAIT */ -+ -+#endif /* __HAL_SDIO_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/hal_sdio_coex.h b/drivers/net/wireless/rtl8821cs/include/hal_sdio_coex.h -new file mode 100644 -index 000000000..ce41b9988 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/hal_sdio_coex.h -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * 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_SDIO_COEX_H__ -+#define __HAL_SDIO_COEX_H__ -+ -+#include -+ -+#ifdef CONFIG_SDIO_MULTI_FUNCTION_COEX -+ -+enum { /* for sdio multi-func. coex */ -+ SDIO_MULTI_WIFI = 0, -+ SDIO_MULTI_BT, -+ SDIO_MULTI_NUM -+}; -+ -+bool ex_hal_sdio_multi_if_bus_available(PADAPTER adapter); -+ -+#else -+ -+#define ex_hal_sdio_multi_if_bus_available(adapter) TRUE -+ -+#endif /* CONFIG_SDIO_MULTI_FUNCTION_COEX */ -+#endif /* !__HAL_SDIO_COEX_H__ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/include/ieee80211.h b/drivers/net/wireless/rtl8821cs/include/ieee80211.h -new file mode 100755 -index 000000000..87a918349 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/ieee80211.h -@@ -0,0 +1,2053 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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 (SIOCDEVPRIVATE + 2) -+ -+/* 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, -+}; -+#endif /* CONFIG_AP_MODE */ -+ -+/* 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_WDS BIT(15) -+#define WLAN_STA_MULTI_AP BIT(16) -+#define WLAN_STA_AMSDU_DISABLE BIT(17) -+#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_CIPHER_GCMP BIT(5) -+#define WPA_CIPHER_GCMP_256 BIT(6) -+#define WPA_CIPHER_CCMP_256 BIT(7) -+#define WPA_CIPHER_BIP_CMAC_128 BIT(8) -+#define WPA_CIPHER_BIP_GMAC_128 BIT(9) -+#define WPA_CIPHER_BIP_GMAC_256 BIT(10) -+#define WPA_CIPHER_BIP_CMAC_256 BIT(11) -+ -+ -+#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 RSN_CIPHER_SUITE_GCMP[]; -+extern u8 RSN_CIPHER_SUITE_GCMP_256[]; -+extern u8 RSN_CIPHER_SUITE_CCMP_256[]; -+extern u8 WPA_CIPHER_SUITE_WEP104[]; -+ -+ -+#define RSN_HEADER_LEN 4 -+#define RSN_SELECTOR_LEN 4 -+ -+extern u16 RSN_VERSION_BSD; -+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[]; -+ -+/* AKM suite type */ -+extern u8 WLAN_AKM_8021X[]; -+extern u8 WLAN_AKM_PSK[]; -+extern u8 WLAN_AKM_FT_8021X[]; -+extern u8 WLAN_AKM_FT_PSK[]; -+extern u8 WLAN_AKM_8021X_SHA256[]; -+extern u8 WLAN_AKM_PSK_SHA256[]; -+extern u8 WLAN_AKM_TDLS[]; -+extern u8 WLAN_AKM_SAE[]; -+extern u8 WLAN_AKM_FT_OVER_SAE[]; -+extern u8 WLAN_AKM_8021X_SUITE_B[]; -+extern u8 WLAN_AKM_8021X_SUITE_B_192[]; -+extern u8 WLAN_AKM_FILS_SHA256[]; -+extern u8 WLAN_AKM_FILS_SHA384[]; -+extern u8 WLAN_AKM_FT_FILS_SHA256[]; -+extern u8 WLAN_AKM_FT_FILS_SHA384[]; -+ -+#define WLAN_AKM_TYPE_8021X BIT(0) -+#define WLAN_AKM_TYPE_PSK BIT(1) -+#define WLAN_AKM_TYPE_FT_8021X BIT(2) -+#define WLAN_AKM_TYPE_FT_PSK BIT(3) -+#define WLAN_AKM_TYPE_8021X_SHA256 BIT(4) -+#define WLAN_AKM_TYPE_PSK_SHA256 BIT(5) -+#define WLAN_AKM_TYPE_TDLS BIT(6) -+#define WLAN_AKM_TYPE_SAE BIT(7) -+#define WLAN_AKM_TYPE_FT_OVER_SAE BIT(8) -+#define WLAN_AKM_TYPE_8021X_SUITE_B BIT(9) -+#define WLAN_AKM_TYPE_8021X_SUITE_B_192 BIT(10) -+#define WLAN_AKM_TYPE_FILS_SHA256 BIT(11) -+#define WLAN_AKM_TYPE_FILS_SHA384 BIT(12) -+#define WLAN_AKM_TYPE_FT_FILS_SHA256 BIT(13) -+#define WLAN_AKM_TYPE_FT_FILS_SHA384 BIT(14) -+ -+/* IEEE 802.11i */ -+#define PMKID_LEN 16 -+#define PMK_LEN 32 -+#define PMK_LEN_SUITE_B_192 48 -+#define PMK_LEN_MAX 48 -+#define WPA_REPLAY_COUNTER_LEN 8 -+#define WPA_NONCE_LEN 32 -+#define WPA_KEY_RSC_LEN 8 -+#define WPA_GMK_LEN 32 -+#define WPA_GTK_MAX_LEN 32 -+ -+/* IEEE 802.11, 8.5.2 EAPOL-Key frames */ -+#define WPA_KEY_INFO_TYPE_MASK ((u16) (BIT(0) | BIT(1) | BIT(2))) -+#define WPA_KEY_INFO_TYPE_AKM_DEFINED 0 -+#define WPA_KEY_INFO_TYPE_HMAC_MD5_RC4 BIT(0) -+#define WPA_KEY_INFO_TYPE_HMAC_SHA1_AES BIT(1) -+#define WPA_KEY_INFO_TYPE_AES_128_CMAC 3 -+#define WPA_KEY_INFO_KEY_TYPE BIT(3) /* 1 = Pairwise, 0 = Group key */ -+/* bit4..5 is used in WPA, but is reserved in IEEE 802.11i/RSN */ -+#define WPA_KEY_INFO_KEY_INDEX_MASK (BIT(4) | BIT(5)) -+#define WPA_KEY_INFO_KEY_INDEX_SHIFT 4 -+#define WPA_KEY_INFO_INSTALL BIT(6) /* pairwise */ -+#define WPA_KEY_INFO_TXRX BIT(6) /* group */ -+#define WPA_KEY_INFO_ACK BIT(7) -+#define WPA_KEY_INFO_MIC BIT(8) -+#define WPA_KEY_INFO_SECURE BIT(9) -+#define WPA_KEY_INFO_ERROR BIT(10) -+#define WPA_KEY_INFO_REQUEST BIT(11) -+#define WPA_KEY_INFO_ENCR_KEY_DATA BIT(12) /* IEEE 802.11i/RSN only */ -+#define WPA_KEY_INFO_SMK_MESSAGE BIT(13) -+ -+struct ieee802_1x_hdr { -+ u8 version; -+ u8 type; -+ u16 length; -+ /* followed by length octets of data */ -+}; -+ -+struct wpa_eapol_key { -+ u8 type; -+ /* Note: key_info, key_length, and key_data_length are unaligned */ -+ u8 key_info[2]; /* big endian */ -+ u8 key_length[2]; /* big endian */ -+ u8 replay_counter[WPA_REPLAY_COUNTER_LEN]; -+ u8 key_nonce[WPA_NONCE_LEN]; -+ u8 key_iv[16]; -+ u8 key_rsc[WPA_KEY_RSC_LEN]; -+ u8 key_id[8]; /* Reserved in IEEE 802.11i/RSN */ -+ u8 key_mic[16]; -+ u8 key_data_length[2]; /* big endian */ -+ /* followed by key_data_length bytes of key_data */ -+}; -+ -+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_BGN_4SS = 15, -+ RATEID_IDX_VHT_4SS = 16, -+} 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_11B | 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 is_supported_5g(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 is_supported_ht(NetType) ((NetType) & (WIRELESS_11_24N | WIRELESS_11_5N) ? _TRUE : _FALSE) -+ -+#define is_supported_vht(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(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)); -+ -+struct rtw_ieee80211s_hdr { -+ u8 flags; -+ u8 ttl; -+ u32 seqnum; -+ u8 eaddr1[ETH_ALEN]; -+ u8 eaddr2[ETH_ALEN]; -+} __attribute__((packed)); -+ -+/** -+ * struct rtw_ieee80211_rann_ie -+ * -+ * This structure refers to "Root Announcement information element" -+ */ -+ struct rtw_ieee80211_rann_ie { -+ u8 rann_flags; -+ u8 rann_hopcount; -+ u8 rann_ttl; -+ u8 rann_addr[ETH_ALEN]; -+ u32 rann_seq; -+ u32 rann_interval; -+ u32 rann_metric; -+} __attribute__((packed)); -+#endif -+ -+/* Some IEEE 802.11x packet types are corresponding to parsing_eapol_packet() */ -+enum eap_type { -+ EAP_PACKET = 0, -+ NON_EAPOL, -+ EAPOL_START, -+ EAPOL_LOGOFF, -+ EAPOL_KEY, -+ EAPOL_ENCAP_ASF_ALERT, -+ EAPOL_PACKET, -+ EAPOL_WPA_GROUP_KEY_1_2, -+ EAPOL_WPA_GROUP_KEY_2_2, -+ EAPOL_1_4, -+ EAPOL_2_4, -+ EAPOL_3_4, -+ EAPOL_4_4, -+}; -+ -+#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(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 -+ -+#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_SAE 3 -+ -+#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_IEEE_802_1X_AUTH_FAILED 23 -+#define WLAN_REASON_MESH_PEER_CANCELED 52 -+#define WLAN_REASON_MESH_MAX_PEERS 53 -+#define WLAN_REASON_MESH_CONFIG 54 -+#define WLAN_REASON_MESH_CLOSE 55 -+#define WLAN_REASON_MESH_MAX_RETRIES 56 -+#define WLAN_REASON_MESH_CONFIRM_TIMEOUT 57 -+#define WLAN_REASON_MESH_INVALID_GTK 58 -+#define WLAN_REASON_MESH_INCONSISTENT_PARAM 59 -+#define WLAN_REASON_MESH_INVALID_SECURITY 60 -+#define WLAN_REASON_MESH_PATH_NOPROXY 61 -+#define WLAN_REASON_MESH_PATH_NOFORWARD 62 -+#define WLAN_REASON_MESH_PATH_DEST_UNREACHABLE 63 -+#define WLAN_REASON_MAC_EXISTS_IN_MBSS 64 -+#define WLAN_REASON_MESH_CHAN_REGULATORY 65 -+#define WLAN_REASON_MESH_CHAN 66 -+#define WLAN_REASON_SA_QUERY_TIMEOUT 65532 -+#define WLAN_REASON_ACTIVE_ROAM 65533 -+#define WLAN_REASON_JOIN_WRONG_CHANNEL 65534 -+#define WLAN_REASON_EXPIRATION_CHK 65535 -+ -+#define WLAN_REASON_IS_PRIVATE(reason) ( \ -+ reason == WLAN_REASON_EXPIRATION_CHK \ -+ || reason == WLAN_REASON_JOIN_WRONG_CHANNEL \ -+ || reason == WLAN_REASON_ACTIVE_ROAM \ -+ || reason == WLAN_REASON_SA_QUERY_TIMEOUT \ -+ ) -+ -+/* 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_COUNTRY 7 -+#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_MESH_CONFIG 113 -+#define WLAN_EID_MESH_ID 114 -+#define WLAN_EID_MPM 117 -+#define WLAN_EID_RANN 126 -+#define WLAN_EID_EXT_CAP 127 -+#define WLAN_EID_PREQ 130 -+#define WLAN_EID_PREP 131 -+#define WLAN_EID_PERR 132 -+#define WLAN_EID_AMPE 139 -+#define WLAN_EID_MIC 140 -+#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_WIDE_BANDWIDTH_CHANNEL_SWITCH 194 -+#define WLAN_EID_CHANNEL_SWITCH_WRAPPER 196 -+#define WLAN_EID_VHT_OP_MODE_NOTIFY 199 -+#define WLAN_EID_RSNX 244 -+#define WLAN_EID_EXTENSION 255 -+#define WLAN_EID_EXT_OWE_DH_PARAM 32 -+ -+#define WLAN_EID_EXT_CAP_MAX_LEN 10 -+#define WLAN_EID_CSA_IE_LEN 3 -+ -+#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_PBCC_RATE_22MB 0x2C -+#define IEEE80211_FREAK_RATE_22_5MB 0x2D -+#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))) -+ -+const char *MGN_RATE_STR(enum MGN_RATE rate); -+ -+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; -+ -+RATE_SECTION mgn_rate_to_rs(enum MGN_RATE rate); -+ -+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 -+#define BIP_MAX_KEYID 5 -+#define BIP_AAD_SIZE 20 -+ -+#if defined(PLATFORM_LINUX) -+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 -+ -+/* -+ -+ 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) -+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 -+ -+ -+/* -+ * 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) -+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 -+ -+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 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_OWE_IE_LEN (128) -+#define MAX_P2P_IE_LEN (256) -+#define MAX_WFD_IE_LEN (128) -+#define MAX_RSNX_IE_LEN (16) -+ -+#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))) -+ -+#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)) -+#define is_zero_mac_addr(Addr) ((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 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_MEAS = 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_MESH = 13, -+ RTW_WLAN_CATEGORY_MULTIHOP = 14, -+ RTW_WLAN_CATEGORY_SELF_PROTECTED = 15, -+ RTW_WLAN_CATEGORY_WMM = 17, -+ RTW_WLAN_CATEGORY_VHT = 21, -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ RTW_WLAN_CATEGORY_TBTX = 25, -+#endif -+ RTW_WLAN_CATEGORY_P2P = 0x7f,/* P2P action frames */ -+}; -+ -+#define CATEGORY_IS_GROUP_PRIVACY(cat) \ -+ (cat == RTW_WLAN_CATEGORY_MESH || cat == RTW_WLAN_CATEGORY_MULTIHOP) -+ -+#define CATEGORY_IS_NON_ROBUST(cat) \ -+ (cat == RTW_WLAN_CATEGORY_PUBLIC \ -+ || cat == RTW_WLAN_CATEGORY_HT \ -+ || cat == RTW_WLAN_CATEGORY_UNPROTECTED_WNM \ -+ || cat == RTW_WLAN_CATEGORY_SELF_PROTECTED \ -+ || cat == RTW_WLAN_CATEGORY_VHT \ -+ || cat == RTW_WLAN_CATEGORY_P2P) -+ -+#define CATEGORY_IS_ROBUST(cat) !CATEGORY_IS_NON_ROBUST(cat) -+ -+/* 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, -+}; -+ -+/* SELF_PROTECTED action code */ -+enum rtw_ieee80211_self_protected_actioncode { -+ RTW_ACT_SELF_PROTECTED_RSVD = 0, -+ RTW_ACT_SELF_PROTECTED_MESH_OPEN = 1, -+ RTW_ACT_SELF_PROTECTED_MESH_CONF = 2, -+ RTW_ACT_SELF_PROTECTED_MESH_CLOSE = 3, -+ RTW_ACT_SELF_PROTECTED_MESH_GK_INFORM = 4, -+ RTW_ACT_SELF_PROTECTED_MESH_GK_ACK = 5, -+ RTW_ACT_SELF_PROTECTED_NUM, -+}; -+ -+/* MESH action code */ -+enum rtw_ieee80211_mesh_actioncode { -+ RTW_ACT_MESH_LINK_METRIC_REPORT, -+ RTW_ACT_MESH_HWMP_PATH_SELECTION, -+ RTW_ACT_MESH_GATE_ANNOUNCEMENT, -+ RTW_ACT_MESH_CONGESTION_CONTROL_NOTIFICATION, -+ RTW_ACT_MESH_MCCA_SETUP_REQUEST, -+ RTW_ACT_MESH_MCCA_SETUP_REPLY, -+ RTW_ACT_MESH_MCCA_ADVERTISEMENT_REQUEST, -+ RTW_ACT_MESH_MCCA_ADVERTISEMENT, -+ RTW_ACT_MESH_MCCA_TEARDOWN, -+ RTW_ACT_MESH_TBTT_ADJUSTMENT_REQUEST, -+ RTW_ACT_MESH_TBTT_ADJUSTMENT_RESPONSE, -+}; -+ -+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_QAB_REQ, -+ ACT_PUBLIC_QAB_RSP, -+ ACT_PUBLIC_QMF_POLICY, -+ ACT_PUBLIC_QMF_POLICY_CHANGE, -+ ACT_PUBLIC_QLOAD_REQ, -+ ACT_PUBLIC_QLOAD_REPORT, -+ ACT_PUBLIC_HCCA_TXOP_ADV, -+ ACT_PUBLIC_HCCA_TXOP_RSP, -+ ACT_PUBLIC_PUBLIC_KEY, -+ ACT_PUBLIC_CH_AVAILABILITY_QUERY, -+ ACT_PUBLIC_CH_SCHEDULE_MGMT, -+ ACT_PUBLIC_CONTACT_VERI_SIGNAL, -+ ACT_PUBLIC_GDD_ENABLE_REQ, -+ ACT_PUBLIC_GDD_ENABLE_RSP, -+ ACT_PUBLIC_NETWORK_CH_CONTROL, -+ ACT_PUBLIC_WHITE_SPACE_MAP_ANN, -+ ACT_PUBLIC_FTM_REQ, -+ ACT_PUBLIC_FTM, -+ 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, -+}; -+ -+ -+enum EXT_CAP_INFO{ -+ BSS_COEXT = 0, /* 20/40 BSS Coexistence Management Support */ -+ EXT_CH_SWITCH = 2, /* Extended Channel Switching */ -+ WNM_SLEEP_MODE = 17, /* WNM Sleep Mode */ -+ BSS_TRANSITION = 19, /* BSS Transition */ -+ MULTI_BSSID = 22, /* Multiple BSSID */ -+ TIME_MEASUREMENT = 23, /* Timing Measurement */ -+ SSID_LIST = 25, /* SSID List */ -+ TDLS_PSM = 29, /* TDLS Peer PSM Support */ -+ TDLS_CH_SWITCH = 30, /* TDLS channel switching */ -+ INTERWORKING = 31, /* Interworking */ -+ TDLS_SUPPORT = 37, /* TDLS Support */ -+ WNM_NOTIFICATION = 46, /* WNM Notification */ -+ OP_MODE_NOTIFICATION = 62, /* Operating Mode Notification */ -+ FTM_RESPONDER = 70, /* Fine Timing Measurement Responder */ -+ FTM_INITIATOR = 71, /* Fine Timing Measurement Initiator */ -+}; -+ -+#define CSA_SWITCH_MODE 0 -+#define CSA_NEW_CH 1 -+#define CSA_SWITCH_COUNT 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 -+#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) */ -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+#define OUI_REALTEK 0x00e04c /* Realtek */ -+#endif -+#define VENDOR_HT_CAPAB_OUI_TYPE 0x33 /* 00-90-4c:0x33 */ -+ -+enum rtw_ieee80211_rann_flags { -+ RTW_RANN_FLAG_IS_GATE = 1 << 0, -+}; -+ -+/** -+ * enum rtw_ieee80211_preq_flags - mesh PREQ element flags -+ * -+ * @RTW_IEEE80211_PREQ_IS_GATE_FLAG: Gate Announcement subfield -+ * @RTW_IEEE80211_PREQ_PROACTIVE_PREP_FLAG: proactive PREP subfield -+ */ -+enum rtw_ieee80211_preq_flags { -+ RTW_IEEE80211_PREQ_IS_GATE_FLAG = 1 << 0, -+ RTW_IEEE80211_PREQ_PROACTIVE_PREP_FLAG = 1 << 2, -+}; -+ -+/** -+ * enum rtw_ieee80211_preq_target_flags - mesh PREQ element per target flags -+ * -+ * @RTW_IEEE80211_PREQ_TO_FLAG: target only subfield -+ * @RTW_IEEE80211_PREQ_USN_FLAG: unknown target HWMP sequence number subfield -+ */ -+enum rtw_ieee80211_preq_target_flags { -+ RTW_IEEE80211_PREQ_TO_FLAG = 1<<0, -+ RTW_IEEE80211_PREQ_USN_FLAG = 1<<2, -+}; -+ -+/** -+ * enum rtw_ieee80211_root_mode_identifier - root mesh STA mode identifier -+ * -+ * These attribute are used by dot11MeshHWMPRootMode to set root mesh STA mode -+ * -+ * @RTW_IEEE80211_ROOTMODE_NO_ROOT: the mesh STA is not a root mesh STA (default) -+ * @RTW_IEEE80211_ROOTMODE_ROOT: the mesh STA is a root mesh STA if greater than -+ * this value -+ * @RTW_IEEE80211_PROACTIVE_PREQ_NO_PREP: the mesh STA is a root mesh STA supports -+ * the proactive PREQ with proactive PREP subfield set to 0 -+ * @RTW_IEEE80211_PROACTIVE_PREQ_WITH_PREP: the mesh STA is a root mesh STA -+ * supports the proactive PREQ with proactive PREP subfield set to 1 -+ * @RTW_IEEE80211_PROACTIVE_RANN: the mesh STA is a root mesh STA supports -+ * the proactive RANN -+ */ -+enum rtw_ieee80211_root_mode_identifier { -+ RTW_IEEE80211_ROOTMODE_NO_ROOT = 0, -+ RTW_IEEE80211_ROOTMODE_ROOT = 1, -+ RTW_IEEE80211_PROACTIVE_PREQ_NO_PREP = 2, -+ RTW_IEEE80211_PROACTIVE_PREQ_WITH_PREP = 3, -+ RTW_IEEE80211_PROACTIVE_RANN = 4, -+}; -+ -+/** -+ * 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; -+ u8 *rm_en_cap; -+ u8 rm_en_cap_len; -+#ifdef CONFIG_RTW_MESH -+ u8 *preq; -+ u8 preq_len; -+ u8 *prep; -+ u8 prep_len; -+ u8 *perr; -+ u8 perr_len; -+ u8 *rann; -+ u8 rann_len; -+#endif -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ u8 *tbtx_cap; -+ u8 tbtx_cap_len; -+#endif -+}; -+ -+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, const 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_tpc_report(u8 *buf, u32 *buf_len, u8 tx_power, u8 link_margin); -+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(const u8 *pbuf, sint index, sint *len, sint limit); -+u8 rtw_update_rate_bymode(WLAN_BSSID_EX *pbss_network, u32 mode); -+ -+u8 *rtw_get_ie_ex(const u8 *in_ie, uint in_len, u8 eid, const u8 *oui, u8 oui_len, u8 *ie, uint *ielen); -+u8 rtw_ies_update_ie(u8 *ies, uint *ies_len, uint ies_offset, u8 eid, const u8 *content, u8 content_len); -+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) ; -+ -+#define GET_RSN_CAP_MFP_OPTION(cap) LE_BITS_TO_2BYTE(((u8 *)(cap)), 6, 2) -+ -+#define MFP_NO 0 -+#define MFP_INVALID 1 -+#define MFP_OPTIONAL 2 -+#define MFP_REQUIRED 3 -+ -+/*For amsdu mode */ -+#define GET_RSN_CAP_SPP_OPT(cap) LE_BITS_TO_2BYTE(((u8 *)(cap)), 10, 2) -+#define SET_RSN_CAP_SPP(cap, spp) SET_BITS_TO_LE_2BYTE(((u8 *)(cap)), 10, 2, spp) -+#define SPP_CAP BIT(0) -+#define SPP_REQ BIT(1) -+ -+enum rtw_amsdu_mode { -+ RTW_AMSDU_MODE_NON_SPP = 0, -+ RTW_AMSDU_MODE_SPP = 1, -+ RTW_AMSDU_MODE_ALL_DROP = 2, -+}; -+ -+struct rsne_info { -+ u8 *gcs; -+ u16 pcs_cnt; -+ u8 *pcs_list; -+ u16 akm_cnt; -+ u8 *akm_list; -+ u8 *cap; -+ u16 pmkid_cnt; -+ u8 *pmkid_list; -+ u8 *gmcs; -+ -+ u8 err; -+}; -+int rtw_rsne_info_parse(const u8 *ie, uint ie_len, struct rsne_info *info); -+ -+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_rsn_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, u32 *akm); -+int rtw_parse_wpa2_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *gmcs, u32 *akm, u8 *mfp_opt, u8* spp_opt); -+ -+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, enum bss_type frame_type); -+u8 *rtw_get_wps_ie(const 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); -+ -+u8 *rtw_get_owe_ie(const u8 *in_ie, uint in_len, u8 *owe_ie, uint *owe_ielen); -+ -+void rtw_add_ext_cap_info(u8 *ext_cap_data, u8 *ext_cap_data_len, u8 cap_info); -+void rtw_remove_ext_cap_info(u8 *ext_cap_data, u8 *ext_cap_data_len, u8 cap_info); -+u8 rtw_update_ext_cap_ie(u8 *ext_cap_data, u8 ext_cap_data_len, u8 *ies, u32 *ies_len, u8 ies_offset); -+void rtw_parse_ext_cap_ie(u8 *ext_cap_data, u8 *ext_cap_data_len, u8 *ies, u32 ies_len, u8 ies_offset); -+ -+/** -+ * 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, const u8 *buf, u32 buf_len); -+#ifdef CONFIG_RTW_DEBUG -+ -+#ifdef CONFIG_80211N_HT -+#define HT_SC_OFFSET_MAX 4 -+extern const char *const _ht_sc_offset_str[]; -+#define ht_sc_offset_str(sc) (((sc) >= HT_SC_OFFSET_MAX) ? _ht_sc_offset_str[2] : _ht_sc_offset_str[(sc)]) -+ -+void dump_ht_cap_ie_content(void *sel, const u8 *buf, u32 buf_len); -+#endif -+ -+void dump_wps_ie(void *sel, const u8 *ie, u32 ie_len); -+#endif /* CONFIG_RTW_DEBUG */ -+ -+void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset, u8 ht, u8 vht); -+ -+void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset, u8 ht, u8 vht); -+ -+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); -+ -+#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); -+#ifdef CONFIG_RTW_DEBUG -+void dump_p2p_ie(void *sel, const u8 *ie, u32 ie_len); -+#endif -+u8 *rtw_get_p2p_ie(const 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); -+#endif /* CONFIG_P2P */ -+ -+uint rtw_del_wfd_ie(u8 *ies, uint ies_len_ori, const char *msg); -+void rtw_bss_ex_del_wfd_ie(WLAN_BSSID_EX *bss_ex); -+#ifdef CONFIG_WFD -+#ifdef CONFIG_RTW_DEBUG -+void dump_wfd_ie(void *sel, const u8 *ie, u32 ie_len); -+#endif -+u8 *rtw_get_wfd_ie(const 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_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_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id); -+#endif -+ -+#define MULTI_AP_SUB_ELEM_TYPE 0x06 -+#define MULTI_AP_TEAR_DOWN BIT(4) -+#define MULTI_AP_FRONTHAUL_BSS BIT(5) -+#define MULTI_AP_BACKHAUL_BSS BIT(6) -+#define MULTI_AP_BACKHAUL_STA BIT(7) -+#ifdef CONFIG_RTW_MULTI_AP -+void dump_multi_ap_ie(void *sel, const u8 *ie, u32 ie_len); -+u8 rtw_get_multi_ap_ie_ext(const u8 *ies, int ies_len); -+u8 *rtw_set_multi_ap_ie_ext(u8 *pbuf, uint *frlen, u8 val); -+#endif -+ -+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); -+uint rtw_get_cckrate_size(u8 *rate,u32 rate_length); -+int rtw_check_network_type(unsigned char *rate, int ratelen, int channel); -+ -+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_ht_mcs_rate(u8 bw_40MHz, u8 short_GI, unsigned char *MCS_rate); -+u8 rtw_ht_mcsset_to_nss(u8 *supp_mcs_set); -+u32 rtw_ht_mcs_set_to_bitmap(u8 *mcs_set, u8 nss); -+u8 rtw_ht_cap_get_rx_nss(u8 *ht_cap); -+u8 rtw_ht_cap_get_tx_nss(u8 *ht_cap); -+ -+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); -+ -+/* For amsdu mode. */ -+/*void rtw_set_spp_amsdu_mode(u8 mode, u8 *rsn_ie, int rsn_ie_len); */ -+u8 rtw_check_amsdu_disable(u8 mode, u8 spp_opt); -+ -+#endif /* IEEE80211_H */ -diff --git a/drivers/net/wireless/rtl8821cs/include/ieee80211_ext.h b/drivers/net/wireless/rtl8821cs/include/ieee80211_ext.h -new file mode 100644 -index 000000000..4965863c4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/ieee80211_ext.h -@@ -0,0 +1,312 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 -+ -+#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 -+ -+/* mgmt header + 1 byte category code */ -+#define IEEE80211_MIN_ACTION_SIZE FIELD_OFFSET(struct ieee80211_mgmt, u.action.u) -+ -+ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/if_ether.h b/drivers/net/wireless/rtl8821cs/include/if_ether.h -new file mode 100644 -index 000000000..a3007c4ab ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/if_ether.h -@@ -0,0 +1,106 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/ip.h b/drivers/net/wireless/rtl8821cs/include/ip.h -new file mode 100644 -index 000000000..4feb98fb0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/ip.h -@@ -0,0 +1,135 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#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 --git a/drivers/net/wireless/rtl8821cs/include/linux/wireless.h b/drivers/net/wireless/rtl8821cs/include/linux/wireless.h -new file mode 100644 -index 000000000..c7f4a6c9b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/linux/wireless.h -@@ -0,0 +1,87 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/mlme_osdep.h b/drivers/net/wireless/rtl8821cs/include/mlme_osdep.h -new file mode 100644 -index 000000000..131eb0925 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/mlme_osdep.h -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/nic_spec.h b/drivers/net/wireless/rtl8821cs/include/nic_spec.h -new file mode 100644 -index 000000000..913ef9ba8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/nic_spec.h -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 --git a/drivers/net/wireless/rtl8821cs/include/osdep_intf.h b/drivers/net/wireless/rtl8821cs/include/osdep_intf.h -new file mode 100644 -index 000000000..63e535ee5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/osdep_intf.h -@@ -0,0 +1,143 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 -+ -+}; -+ -+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); -+ -+u16 rtw_os_recv_select_queue(u8 *msdu, enum rtw_rx_llc_hdl llc_hdl); -+ -+int rtw_ndev_notifier_register(void); -+void rtw_ndev_notifier_unregister(void); -+void rtw_inetaddr_notifier_register(void); -+void rtw_inetaddr_notifier_unregister(void); -+ -+#include "../os_dep/linux/rtw_proc.h" -+#include "../os_dep/linux/nlrtw.h" -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+#include "../os_dep/linux/custom_multiap_intfs/custom_multiap_intfs.h" -+#endif -+ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/osdep_service.h b/drivers/net/wireless/rtl8821cs/include/osdep_service.h -new file mode 100644 -index 000000000..00c1ea404 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/osdep_service.h -@@ -0,0 +1,895 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#define RTW_RFRAME_UNAVAIL 3 -+#define RTW_RFRAME_PKT_UNAVAIL 4 -+#define RTW_RBUF_UNAVAIL 5 -+#define RTW_RBUF_PKT_UNAVAIL 6 -+#define RTW_SDIO_READ_PORT_FAIL 7 -+#define RTW_ALREADY 8 -+#define RTW_RA_RESOLVING 9 -+#define RTW_ORI_NO_NEED 10 -+#define RTW_XBUF_UNAVAIL 11 -+#define RTW_TX_BALANCE 12 -+#define RTW_TX_WAIT_MORE_FRAME 13 -+#define RTW_QUEUE_MGMT 14 -+#define RTW_NOT_SUPPORT 15 -+#define RTW_BUSY 16 -+ -+/* #define RTW_STATUS_TIMEDOUT -110 */ -+ -+#undef _TRUE -+#define _TRUE 1 -+ -+#undef _FALSE -+#define _FALSE 0 -+ -+ -+#ifdef PLATFORM_FREEBSD -+ #include -+#endif -+ -+#ifdef PLATFORM_LINUX -+ #include -+#if defined(CONFIG_RTW_ANDROID_GKI) -+ #include -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0)) -+ #include -+ #include -+#endif -+ #include -+ #include -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ #include -+ #include -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ #include -+ #include -+#endif -+ -+/* #include */ -+ -+#ifndef BIT -+ #define BIT(x) (1 << (x)) -+#endif -+#ifndef BIT_ULL -+#define BIT_ULL(x) (1ULL << (x)) -+#endif -+ -+#define CHECK_BIT(a, b) (!!((a) & (b))) -+ -+#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 -+ -+#ifndef GENMASK -+#define GENMASK(h, l) \ -+ (((~0UL) - (1UL << (l)) + 1) & (~0UL >> (BITS_PER_LONG - 1 - (h)))) -+#endif -+ -+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); -+bool match_mstat_sniff_rules(const enum mstat_f flags, const size_t size); -+void *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+void *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+void dbg_rtw_vmfree(void *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); -+void *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+void *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+void dbg_rtw_mfree(void *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) -+#define match_mstat_sniff_rules(flags, size) _FALSE -+void *_rtw_vmalloc(u32 sz); -+void *_rtw_zvmalloc(u32 sz); -+void _rtw_vmfree(void *pbuf, u32 sz); -+void *_rtw_zmalloc(u32 sz); -+void *_rtw_malloc(u32 sz); -+void _rtw_mfree(void *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); -+ -+void rtw_os_pkt_free(_pkt *pkt); -+_pkt *rtw_os_pkt_copy(_pkt *pkt); -+void *rtw_os_pkt_data(_pkt *pkt); -+u32 rtw_os_pkt_len(_pkt *pkt); -+ -+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 int _rtw_memcmp2(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); -+void rtw_list_splice(_list *list, _list *head); -+void rtw_list_splice_init(_list *list, _list *head); -+void rtw_list_splice_tail(_list *list, _list *head); -+ -+#ifndef PLATFORM_FREEBSD -+extern void rtw_list_delete(_list *plist); -+#endif /* PLATFORM_FREEBSD */ -+ -+void rtw_hlist_head_init(rtw_hlist_head *h); -+void rtw_hlist_add_head(rtw_hlist_node *n, rtw_hlist_head *h); -+void rtw_hlist_del(rtw_hlist_node *n); -+void rtw_hlist_add_head_rcu(rtw_hlist_node *n, rtw_hlist_head *h); -+void rtw_hlist_del_rcu(rtw_hlist_node *n); -+ -+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 systime _rtw_get_current_time(void); -+extern u32 _rtw_systime_to_ms(systime stime); -+extern systime _rtw_ms_to_systime(u32 ms); -+extern systime _rtw_us_to_systime(u32 us); -+extern s32 _rtw_get_passing_time_ms(systime start); -+extern s32 _rtw_get_remaining_time_ms(systime end); -+extern s32 _rtw_get_time_interval_ms(systime start, systime end); -+extern bool _rtw_time_after(systime a, systime b); -+ -+#ifdef DBG_SYSTIME -+#define rtw_get_current_time() ({systime __stime = _rtw_get_current_time(); __stime;}) -+#define rtw_systime_to_ms(stime) ({u32 __ms = _rtw_systime_to_ms(stime); typecheck(systime, stime); __ms;}) -+#define rtw_ms_to_systime(ms) ({systime __stime = _rtw_ms_to_systime(ms); __stime;}) -+#define rtw_us_to_systime(us) ({systime __stime = _rtw_us_to_systime(us); __stime;}) -+#define rtw_get_passing_time_ms(start) ({u32 __ms = _rtw_get_passing_time_ms(start); typecheck(systime, start); __ms;}) -+#define rtw_get_remaining_time_ms(end) ({u32 __ms = _rtw_get_remaining_time_ms(end); typecheck(systime, end); __ms;}) -+#define rtw_get_time_interval_ms(start, end) ({u32 __ms = _rtw_get_time_interval_ms(start, end); typecheck(systime, start); typecheck(systime, end); __ms;}) -+#define rtw_time_after(a,b) ({bool __r = _rtw_time_after(a,b); typecheck(systime, a); typecheck(systime, b); __r;}) -+#define rtw_time_before(a,b) ({bool __r = _rtw_time_after(b, a); typecheck(systime, a); typecheck(systime, b); __r;}) -+#else -+#define rtw_get_current_time() _rtw_get_current_time() -+#define rtw_systime_to_ms(stime) _rtw_systime_to_ms(stime) -+#define rtw_ms_to_systime(ms) _rtw_ms_to_systime(ms) -+#define rtw_us_to_systime(us) _rtw_us_to_systime(us) -+#define rtw_get_passing_time_ms(start) _rtw_get_passing_time_ms(start) -+#define rtw_get_remaining_time_ms(end) _rtw_get_remaining_time_ms(end) -+#define rtw_get_time_interval_ms(start, end) _rtw_get_time_interval_ms(start, end) -+#define rtw_time_after(a,b) _rtw_time_after(a,b) -+#define rtw_time_before(a,b) _rtw_time_after(b,a) -+#endif -+ -+sysptime rtw_sptime_get(void); -+sysptime rtw_sptime_set(s64 secs, const u32 nsecs); -+sysptime rtw_sptime_zero(void); -+ -+int rtw_sptime_cmp(const sysptime cmp1, const sysptime cmp2); -+bool rtw_sptime_eql(const sysptime cmp1, const sysptime cmp2); -+bool rtw_sptime_is_zero(const sysptime sptime); -+sysptime rtw_sptime_sub(const sysptime lhs, const sysptime rhs); -+sysptime rtw_sptime_add(const sysptime lhs, const sysptime rhs); -+ -+s64 rtw_sptime_to_ms(const sysptime sptime); -+sysptime rtw_ms_to_sptime(u64 ms); -+s64 rtw_sptime_to_us(const sysptime sptime); -+sysptime rtw_us_to_sptime(u64 us); -+s64 rtw_sptime_to_ns(const sysptime sptime); -+sysptime rtw_ns_to_sptime(u64 ns); -+ -+s64 rtw_sptime_diff_ms(const sysptime start, const sysptime end); -+s64 rtw_sptime_pass_ms(const sysptime start); -+s64 rtw_sptime_diff_us(const sysptime start, const sysptime end); -+s64 rtw_sptime_pass_us(const sysptime start); -+s64 rtw_sptime_diff_ns(const sysptime start, const sysptime end); -+s64 rtw_sptime_pass_ns(const sysptime start); -+ -+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); -+ -+enum rtw_pwait_type { -+ RTW_PWAIT_TYPE_MSLEEP, -+ RTW_PWAIT_TYPE_USLEEP, -+ RTW_PWAIT_TYPE_YIELD, -+ RTW_PWAIT_TYPE_MDELAY, -+ RTW_PWAIT_TYPE_UDELAY, -+ -+ RTW_PWAIT_TYPE_NUM, -+}; -+ -+#define RTW_PWAIT_TYPE_VALID(type) (type < RTW_PWAIT_TYPE_NUM) -+ -+struct rtw_pwait_conf { -+ enum rtw_pwait_type type; -+ s32 wait_time; -+ s32 wait_cnt_lmt; -+}; -+ -+struct rtw_pwait_ctx { -+ struct rtw_pwait_conf conf; -+ s32 wait_cnt; -+ void (*wait_hdl)(int us); -+}; -+ -+extern const char *_rtw_pwait_type_str[]; -+#define rtw_pwait_type_str(type) (RTW_PWAIT_TYPE_VALID(type) ? _rtw_pwait_type_str[type] : _rtw_pwait_type_str[RTW_PWAIT_TYPE_NUM]) -+ -+#define rtw_pwctx_reset(pwctx) (pwctx)->wait_cnt = 0 -+#define rtw_pwctx_wait(pwctx) do { (pwctx)->wait_hdl((pwctx)->conf.wait_time); (pwctx)->wait_cnt++; } while(0) -+#define rtw_pwctx_waited(pwctx) ((pwctx)->wait_cnt) -+#define rtw_pwctx_exceed(pwctx) ((pwctx)->conf.wait_cnt_lmt >= 0 && (pwctx)->wait_cnt >= (pwctx)->conf.wait_cnt_lmt) -+ -+int rtw_pwctx_config(struct rtw_pwait_ctx *pwctx, enum rtw_pwait_type type, s32 time, s32 cnt_lmt); -+ -+extern void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc, void *ctx); -+ -+ -+__inline static unsigned char _cancel_timer_ex(_timer *ptimer) -+{ -+ u8 bcancelled; -+ -+ _cancel_timer(ptimer, &bcancelled); -+ -+ return bcancelled; -+} -+ -+static __inline void thread_enter(char *name) -+{ -+#ifdef PLATFORM_LINUX -+ 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); -+ -+static inline bool rtw_thread_stop(_thread_hdl_ th) -+{ -+#ifdef PLATFORM_LINUX -+ return kthread_stop(th); -+#endif -+} -+static inline void rtw_thread_wait_stop(void) -+{ -+#ifdef PLATFORM_LINUX -+ #if 0 -+ while (!kthread_should_stop()) -+ rtw_msleep_os(10); -+ #else -+ set_current_state(TASK_INTERRUPTIBLE); -+ while (!kthread_should_stop()) { -+ schedule(); -+ set_current_state(TASK_INTERRUPTIBLE); -+ } -+ __set_current_state(TASK_RUNNING); -+ #endif -+#endif -+} -+ -+__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; -+ -+} -+#ifdef PLATFORM_LINUX -+#define RTW_DIV_ROUND_UP(n, d) DIV_ROUND_UP(n, d) -+#else /* !PLATFORM_LINUX */ -+#define RTW_DIV_ROUND_UP(n, d) (((n) + (d - 1)) / d) -+#endif /* !PLATFORM_LINUX */ -+ -+#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; -+} -+ -+static inline int largest_bit_64(u64 bitmask) -+{ -+ int i; -+ -+ for (i = 63; i >= 0; i--) -+ if (bitmask & BIT_ULL(i)) -+ break; -+ -+ return i; -+} -+ -+#define rtw_abs(a) ((a) < 0 ? -(a) : (a)) -+#define rtw_min(a, b) (((a) > (b)) ? (b) : (a)) -+#define rtw_max(a, b) (((a) > (b)) ? (a) : (b)) -+#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 -+ -+bool rtw_macaddr_is_larger(const u8 *a, const u8 *b); -+ -+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_traffic_suspend_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 rtw_set_bit(int nr, unsigned long *addr); -+extern void rtw_clear_bit(int nr, unsigned long *addr); -+extern int rtw_test_and_clear_bit(int nr, unsigned long *addr); -+ -+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); -+extern bool ATOMIC_INC_UNLESS(ATOMIC_T *v, int u); -+ -+/* File operation APIs, just for linux now */ -+#if !defined(CONFIG_RTW_ANDROID_GKI) -+extern int rtw_is_dir_readable(const char *path); -+extern int rtw_store_to_file(const char *path, u8 *buf, u32 sz); -+#endif /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+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_readable_file_sz_chk(const char *path, u32 sz); -+extern int rtw_retrieve_from_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])) -+#define RTW_PUT_LE64(a, val) \ -+ do { \ -+ (a)[7] = (u8) ((((u64) (val)) >> 56) & 0xff); \ -+ (a)[6] = (u8) ((((u64) (val)) >> 48) & 0xff); \ -+ (a)[5] = (u8) ((((u64) (val)) >> 40) & 0xff); \ -+ (a)[4] = (u8) ((((u64) (val)) >> 32) & 0xff); \ -+ (a)[3] = (u8) ((((u64) (val)) >> 24) & 0xff); \ -+ (a)[2] = (u8) ((((u64) (val)) >> 16) & 0xff); \ -+ (a)[1] = (u8) ((((u64) (val)) >> 8) & 0xff); \ -+ (a)[0] = (u8) (((u64) (val)) & 0xff); \ -+ } while (0) -+ -+void rtw_buf_free(u8 **buf, u32 *buf_len); -+void rtw_buf_update(u8 **buf, u32 *buf_len, const 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); -+ -+struct blacklist_ent { -+ _list list; -+ u8 addr[ETH_ALEN]; -+ systime exp_time; -+}; -+ -+#ifdef CONFIG_RTW_MESH -+int rtw_blacklist_add(_queue *blist, const u8 *addr, u32 timeout_ms); -+int rtw_blacklist_del(_queue *blist, const u8 *addr); -+int rtw_blacklist_search(_queue *blist, const u8 *addr); -+void rtw_blacklist_flush(_queue *blist); -+void dump_blacklist(void *sel, _queue *blist, const char *title); -+#endif -+ -+/* String handler */ -+ -+BOOLEAN is_null(char c); -+BOOLEAN is_all_null(char *c, int len); -+BOOLEAN is_eol(char c); -+BOOLEAN is_space(char c); -+BOOLEAN is_decimal(char chTmp); -+BOOLEAN IsHexDigit(char chTmp); -+BOOLEAN is_alpha(char chTmp); -+char alpha_to_upper(char c); -+ -+int hex2num_i(char c); -+int hex2byte_i(const char *hex); -+int hexstr2bin(const char *hex, u8 *buf, size_t len); -+ -+int hwaddr_aton_i(const char *txt, u8 *addr); -+ -+/* -+ * 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 --git a/drivers/net/wireless/rtl8821cs/include/osdep_service_bsd.h b/drivers/net/wireless/rtl8821cs/include/osdep_service_bsd.h -new file mode 100644 -index 000000000..f8f15d6fd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/osdep_service_bsd.h -@@ -0,0 +1,757 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 rtw_timer_list _timer; -+ struct list_head { -+ struct list_head *next, *prev; -+ }; -+ struct __queue { -+ struct list_head queue; -+ _lock lock; -+ }; -+ -+ 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; -+ typedef struct task _tasklet; -+ -+#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 rtw_timer_list { -+ struct callout callout; -+ void (*function)(void *); -+ 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); -+} -+ -+static inline void timer_hdl(void *ctx) -+{ -+ _timer *timer = (_timer *)ctx; -+ -+ rtw_mtx_lock(NULL); -+ if (callout_pending(&timer->callout)) { -+ /* callout was reset */ -+ rtw_mtx_unlock(NULL); -+ return; -+ } -+ -+ if (!callout_active(&timer->callout)) { -+ /* callout was stopped */ -+ rtw_mtx_unlock(NULL); -+ return; -+ } -+ -+ callout_deactivate(&timer->callout); -+ -+ timer->function(timer->arg); -+ -+ rtw_mtx_unlock(NULL); -+} -+ -+static inline 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) -+{ -+ if (ptimer->function && ptimer->arg) { -+ rtw_mtx_lock(NULL); -+ callout_reset(&ptimer->callout, delay_time, timer_hdl, ptimer); -+ rtw_mtx_unlock(NULL); -+ } -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ rtw_mtx_lock(NULL); -+ callout_drain(&ptimer->callout); -+ rtw_mtx_unlock(NULL); -+ *bcancelled = 1; /* assume an pending timer to be canceled */ -+} -+ -+__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 --git a/drivers/net/wireless/rtl8821cs/include/osdep_service_ce.h b/drivers/net/wireless/rtl8821cs/include/osdep_service_ce.h -new file mode 100644 -index 000000000..2bf65ef47 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/osdep_service_ce.h -@@ -0,0 +1,200 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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; -+ -+struct rtw_timer_list { -+ NDIS_MINIPORT_TIMER ndis_timer; -+ void (*function)(void *); -+ void *arg; -+}; -+ -+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); -+} -+ -+static inline void timer_hdl( -+ IN PVOID SystemSpecific1, -+ IN PVOID FunctionContext, -+ IN PVOID SystemSpecific2, -+ IN PVOID SystemSpecific3) -+{ -+ _timer *timer = (_timer *)FunctionContext; -+ -+ timer->function(timer->arg); -+} -+ -+static inline void _init_timer(_timer *ptimer, _nic_hdl nic_hdl, void *pfunc, void *cntx) -+{ -+ ptimer->function = pfunc; -+ ptimer->arg = cntx; -+ NdisMInitializeTimer(&ptimer->ndis_timer, nic_hdl, timer_hdl, ptimer); -+} -+ -+static inline void _set_timer(_timer *ptimer, u32 delay_time) -+{ -+ NdisMSetTimer(ptimer, delay_time); -+} -+ -+static inline 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 --git a/drivers/net/wireless/rtl8821cs/include/osdep_service_linux.h b/drivers/net/wireless/rtl8821cs/include/osdep_service_linux.h -new file mode 100755 -index 000000000..ecbf9b7c6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/osdep_service_linux.h -@@ -0,0 +1,586 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 5)) -+ #include -+#endif -+/* #include */ -+#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 -+#include /* for struct tasklet_struct */ -+#include -+#include -+#include -+#include -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 4, 0)) -+ #include -+#endif -+ -+#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 -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25) && \ -+ LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 29)) -+ #define CONFIG_IEEE80211_HT_ADDT_INFO -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ /* #include */ -+ #include -+#else -+ #ifdef CONFIG_REGD_SRC_FROM_OS -+ #error "CONFIG_REGD_SRC_FROM_OS requires CONFIG_IOCTL_CFG80211" -+ #endif -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ -+#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; -+#endif -+ -+#if defined(CONFIG_RTW_GRO) && (!defined(CONFIG_RTW_NAPI)) -+ -+ #error "Enable NAPI before enable GRO\n" -+ -+#endif -+ -+ -+#if (KERNEL_VERSION(2, 6, 29) > LINUX_VERSION_CODE && defined(CONFIG_RTW_NAPI)) -+ -+ #undef CONFIG_RTW_NAPI -+ /*#warning "Linux Kernel version too old to support NAPI (should newer than 2.6.29)\n"*/ -+ -+#endif -+ -+#if (KERNEL_VERSION(2, 6, 33) > LINUX_VERSION_CODE && defined(CONFIG_RTW_GRO)) -+ -+ #undef CONFIG_RTW_GRO -+ /*#warning "Linux Kernel version too old to support GRO(should newer than 2.6.33)\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 -+struct rtw_timer_list { -+ struct timer_list timer; -+ void (*function)(void *); -+ void *arg; -+}; -+ -+typedef struct rtw_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; -+ -+/* hlist */ -+typedef struct hlist_head rtw_hlist_head; -+typedef struct hlist_node rtw_hlist_node; -+ -+/* RCU */ -+typedef struct rcu_head rtw_rcu_head; -+#define rtw_rcu_dereference(p) rcu_dereference((p)) -+#define rtw_rcu_dereference_protected(p, c) rcu_dereference_protected(p, c) -+#define rtw_rcu_assign_pointer(p, v) rcu_assign_pointer((p), (v)) -+#define rtw_rcu_read_lock() rcu_read_lock() -+#define rtw_rcu_read_unlock() rcu_read_unlock() -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) -+#define rtw_rcu_access_pointer(p) rcu_access_pointer(p) -+#endif -+ -+/* rhashtable */ -+#include "../os_dep/linux/rtw_rhashtable.h" -+ -+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 -+ -+typedef unsigned long systime; -+typedef ktime_t sysptime; -+typedef struct tasklet_struct _tasklet; -+ -+#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 void rtw_list_delete(_list *plist) -+{ -+ list_del_init(plist); -+} -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->next; -+} -+ -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -+ -+#define rtw_list_first_entry(ptr, type, member) list_first_entry(ptr, type, member) -+ -+#define rtw_hlist_for_each_entry(pos, head, member) hlist_for_each_entry(pos, head, member) -+#define rtw_hlist_for_each_safe(pos, n, head) hlist_for_each_safe(pos, n, head) -+#define rtw_hlist_entry(ptr, type, member) hlist_entry(ptr, type, member) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+#define rtw_hlist_for_each_entry_safe(pos, np, n, head, member) hlist_for_each_entry_safe(pos, n, head, member) -+#define rtw_hlist_for_each_entry_rcu(pos, node, head, member) hlist_for_each_entry_rcu(pos, head, member) -+#else -+#define rtw_hlist_for_each_entry_safe(pos, np, n, head, member) hlist_for_each_entry_safe(pos, np, n, head, member) -+#define rtw_hlist_for_each_entry_rcu(pos, node, head, member) hlist_for_each_entry_rcu(pos, node, head, member) -+#endif -+ -+__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 void enter_critical_bh(_lock *plock) -+{ -+ spin_lock_bh(plock); -+} -+ -+__inline static void exit_critical_bh(_lock *plock) -+{ -+ 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 int _enter_critical_mutex_lock(_mutex *pmutex, _irqL *pirqL) -+{ -+ int ret = 0; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ mutex_lock(pmutex); -+#else -+ down(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 _list *get_list_head(_queue *queue) -+{ -+ return &(queue->queue); -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) -+static inline void timer_hdl(struct timer_list *in_timer) -+#else -+static inline void timer_hdl(unsigned long cntx) -+#endif -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) -+ _timer *ptimer = from_timer(ptimer, in_timer, timer); -+#else -+ _timer *ptimer = (_timer *)cntx; -+#endif -+ ptimer->function(ptimer->arg); -+} -+ -+__inline static void _init_timer(_timer *ptimer, _nic_hdl nic_hdl, void *pfunc, void *cntx) -+{ -+ ptimer->function = pfunc; -+ ptimer->arg = cntx; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) -+ timer_setup(&ptimer->timer, timer_hdl, 0); -+#else -+ /* setup_timer(ptimer, pfunc,(u32)cntx); */ -+ ptimer->timer.function = timer_hdl; -+ ptimer->timer.data = (unsigned long)ptimer; -+ init_timer(&ptimer->timer); -+#endif -+} -+ -+__inline static void _set_timer(_timer *ptimer, u32 delay_time) -+{ -+ mod_timer(&ptimer->timer , (jiffies + (delay_time * HZ / 1000))); -+} -+ -+__inline static void _cancel_timer(_timer *ptimer, u8 *bcancelled) -+{ -+ *bcancelled = del_timer_sync(&ptimer->timer) == 1 ? 1 : 0; -+} -+ -+__inline static void _cancel_timer_async(_timer *ptimer) -+{ -+ del_timer(&ptimer->timer); -+} -+ -+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_device_attach(struct net_device *pnetdev) -+{ -+ netif_device_attach(pnetdev); -+} -+static inline void rtw_netif_device_detach(struct net_device *pnetdev) -+{ -+ netif_device_detach(pnetdev); -+} -+static inline void rtw_netif_carrier_on(struct net_device *pnetdev) -+{ -+ netif_carrier_on(pnetdev); -+} -+static inline void rtw_netif_carrier_off(struct net_device *pnetdev) -+{ -+ netif_carrier_off(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 -+ -+ -+#if defined(DBG_MEM_ERR_FREE) -+void rtw_dbg_mem_init(void); -+void rtw_dbg_mem_deinit(void); -+#else -+#define rtw_dbg_mem_init() do {} while (0) -+#define rtw_dbg_mem_deinit() do {} while (0) -+#endif /* DBG_MEM_ERR_FREE */ -+ -+#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); -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) -+#define rtw_get_same_net_ndev_by_name(ndev, name) dev_get_by_name(name) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) -+#define rtw_get_same_net_ndev_by_name(ndev, name) dev_get_by_name(ndev->nd_net, name) -+#else -+#define rtw_get_same_net_ndev_by_name(ndev, name) dev_get_by_name(dev_net(ndev), name) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) -+#define rtw_get_bridge_ndev_by_name(name) dev_get_by_name(name) -+#else -+#define rtw_get_bridge_ndev_by_name(name) dev_get_by_name(&init_net, name) -+#endif -+ -+#define STRUCT_PACKED __attribute__ ((packed)) -+ -+#ifndef fallthrough -+#if __GNUC__ >= 5 || defined(__clang__) -+#ifndef __has_attribute -+#define __has_attribute(x) 0 -+#endif -+#if __has_attribute(__fallthrough__) -+#define fallthrough __attribute__((__fallthrough__)) -+#endif -+#endif -+#ifndef fallthrough -+#define fallthrough do {} while (0) /* fallthrough */ -+#endif -+#endif -+ -+#endif /* __OSDEP_LINUX_SERVICE_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/osdep_service_xp.h b/drivers/net/wireless/rtl8821cs/include/osdep_service_xp.h -new file mode 100644 -index 000000000..57e6f314e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/osdep_service_xp.h -@@ -0,0 +1,210 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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; -+ -+ struct rtw_timer_list { -+ NDIS_MINIPORT_TIMER ndis_timer; -+ void (*function)(void *); -+ void *arg; -+ }; -+ -+ 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); -+} -+ -+static inline void timer_hdl( -+ IN PVOID SystemSpecific1, -+ IN PVOID FunctionContext, -+ IN PVOID SystemSpecific2, -+ IN PVOID SystemSpecific3) -+{ -+ _timer *timer = (_timer *)FunctionContext; -+ -+ timer->function(timer->arg); -+} -+ -+static inline void _init_timer(_timer *ptimer, _nic_hdl nic_hdl, void *pfunc, void *cntx) -+{ -+ ptimer->function = pfunc; -+ ptimer->arg = cntx; -+ NdisMInitializeTimer(&ptimer->ndis_timer, nic_hdl, timer_hdl, ptimer); -+} -+ -+static inline void _set_timer(_timer *ptimer, u32 delay_time) -+{ -+ NdisMSetTimer(ptimer, delay_time); -+} -+ -+static inline 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 --git a/drivers/net/wireless/rtl8821cs/include/pci_hal.h b/drivers/net/wireless/rtl8821cs/include/pci_hal.h -new file mode 100644 -index 000000000..6eac311a1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/pci_hal.h -@@ -0,0 +1,60 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 -+ -+#if defined(CONFIG_RTL8192F) -+ void rtl8192fe_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 -+ -+#ifdef CONFIG_RTL8822C -+ void rtl8822ce_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8814B -+ void rtl8814be_set_hal_ops(PADAPTER padapter); -+#endif -+ -+u8 rtw_set_hal_ops(_adapter *padapter); -+ -+#endif /* __PCIE_HAL_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/pci_ops.h b/drivers/net/wireless/rtl8821cs/include/pci_ops.h -new file mode 100644 -index 000000000..7b95fde04 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/pci_ops.h -@@ -0,0 +1,116 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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); -+ void rtw8188ee_unmap_beacon_icf(_adapter *padapter); -+#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); -+ void rtw8812ae_unmap_beacon_icf(_adapter *padapter); -+#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); -+ void rtw8192ee_unmap_beacon_icf(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_RTL8192F -+ u32 rtl8192fe_init_desc_ring(_adapter *padapter); -+ u32 rtl8192fe_free_desc_ring(_adapter *padapter); -+ void rtl8192fe_reset_desc_ring(_adapter *padapter); -+ int rtl8192fe_interrupt(PADAPTER Adapter); -+ void rtl8192fe_recv_tasklet(void *priv); -+ void rtl8192fe_prepare_bcn_tasklet(void *priv); -+ void rtl8192fe_set_intf_ops(struct _io_ops *pops); -+ u8 check_tx_desc_resource(_adapter *padapter, int prio); -+ void rtl8192fe_unmap_beacon_icf(PADAPTER Adapter); -+#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); -+ void rtl8723be_unmap_beacon_icf(PADAPTER Adapter); -+#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); -+ void rtl8723de_unmap_beacon_icf(PADAPTER Adapter); -+#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); -+ void rtl8814ae_unmap_beacon_icf(PADAPTER Adapter); -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ void rtl8822be_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ void rtl8821ce_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#ifdef CONFIG_RTL8822C -+ void rtl8822ce_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#ifdef CONFIG_RTL8814B -+ void rtl8814be_set_intf_ops(struct _io_ops *pops); -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/pci_osintf.h b/drivers/net/wireless/rtl8821cs/include/pci_osintf.h -new file mode 100644 -index 000000000..077064a72 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/pci_osintf.h -@@ -0,0 +1,66 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __PCI_OSINTF_H -+#define __PCI_OSINTF_H -+ -+#ifdef CONFIG_PLATFORM_RTK129X -+#define PCIE_SLOT1_MEM_START 0x9804F000 -+#define PCIE_SLOT1_MEM_LEN 0x1000 -+#define PCIE_SLOT1_CTRL_START 0x9804EC00 -+ -+#define PCIE_SLOT2_MEM_START 0x9803C000 -+#define PCIE_SLOT2_MEM_LEN 0x1000 -+#define PCIE_SLOT2_CTRL_START 0x9803BC00 -+ -+#define PCIE_MASK_OFFSET 0x100 /* mask offset from CTRL_START */ -+#define PCIE_TRANSLATE_OFFSET 0x104 /* translate offset from CTRL_START */ -+#endif -+ -+#define PCI_BC_CLK_REQ BIT0 -+#define PCI_BC_ASPM_L0s BIT1 -+#define PCI_BC_ASPM_L1 BIT2 -+#define PCI_BC_ASPM_L1Off BIT3 -+//#define PCI_BC_ASPM_LTR BIT4 -+//#define PCI_BC_ASPM_OBFF BIT5 -+ -+void PlatformClearPciPMEStatus(PADAPTER Adapter); -+void rtw_pci_aspm_config(_adapter *padapter); -+void rtw_pci_aspm_config_l1off_general(_adapter *padapter, u8 eanble); -+#ifdef CONFIG_PCI_DYNAMIC_ASPM -+void rtw_pci_set_aspm_lnkctl(_adapter *padapter, u8 mode); -+void rtw_pci_set_l1_latency(_adapter *padapter, u8 mode); -+ -+static inline void rtw_pci_dynamic_aspm_set_mode(_adapter *padapter, u8 mode) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); -+ -+ if (mode == pcipriv->aspm_mode) -+ return; -+ -+ pcipriv->aspm_mode = mode; -+ -+#ifdef CONFIG_PCI_DYNAMIC_ASPM_LINK_CTRL -+ rtw_pci_set_aspm_lnkctl(padapter, mode); -+#endif -+#ifdef CONFIG_PCI_DYNAMIC_ASPM_L1_LATENCY -+ rtw_pci_set_l1_latency(padapter, mode); -+#endif -+} -+#else -+#define rtw_pci_dynamic_aspm_set_mode(adapter, mode) -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/recv_osdep.h b/drivers/net/wireless/rtl8821cs/include/recv_osdep.h -new file mode 100755 -index 000000000..43383a685 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/recv_osdep.h -@@ -0,0 +1,72 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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, _adapter *padapter); -+extern void _rtw_free_recv_priv(struct recv_priv *precvpriv); -+ -+ -+extern s32 rtw_recv_entry(union recv_frame *precv_frame); -+void rtw_rframe_set_os_pkt(union recv_frame *rframe); -+extern int rtw_recv_indicatepkt(_adapter *adapter, union recv_frame *precv_frame); -+extern void rtw_recv_returnpacket(_nic_hdl cnxt, _pkt *preturnedpkt); -+ -+#ifdef CONFIG_WIFI_MONITOR -+extern int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame); -+#endif /* CONFIG_WIFI_MONITOR */ -+ -+#ifdef CONFIG_HOSTAPD_MLME -+extern void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame); -+#endif -+ -+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, u32 size); -+int rtw_os_recvbuf_resource_free(_adapter *padapter, struct recv_buf *precvbuf); -+ -+_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, const u8 *da, const u8 *sa -+ , u8 *msdu ,u16 msdu_len, enum rtw_rx_llc_hdl llc_hdl); -+void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, union recv_frame *rframe); -+ -+void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf); -+ -+#ifdef PLATFORM_LINUX -+#ifdef CONFIG_RTW_NAPI -+#include /* struct napi_struct */ -+ -+int rtw_recv_napi_poll(struct napi_struct *, int budget); -+#ifdef CONFIG_RTW_NAPI_DYNAMIC -+void dynamic_napi_th_chk (_adapter *adapter); -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+#endif /* CONFIG_RTW_NAPI */ -+#endif /* PLATFORM_LINUX */ -+ -+void rtw_rx_dbg_monitor_ip_statistic(_adapter *padapter, _pkt *pkt); -+ -+#endif /* */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8188e_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtl8188e_cmd.h -new file mode 100644 -index 000000000..aba0bec14 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188e_cmd.h -@@ -0,0 +1,165 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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); -+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 */ -+ -+/* #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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8188e_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8188e_dm.h -new file mode 100644 -index 000000000..457ae9bca ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188e_dm.h -@@ -0,0 +1,27 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8188E_DM_H__ -+#define __RTL8188E_DM_H__ -+ -+void rtl8188e_init_dm_priv(PADAPTER Adapter); -+void rtl8188e_deinit_dm_priv(PADAPTER Adapter); -+void rtl8188e_InitHalDm(PADAPTER Adapter); -+void rtl8188e_HalDmWatchDog(PADAPTER Adapter); -+ -+/* void rtl8192c_dm_CheckTXPowerTracking(PADAPTER Adapter); */ -+ -+/* void rtl8192c_dm_RF_Saving(PADAPTER pAdapter, u8 bForceInNormal); */ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8188e_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8188e_hal.h -new file mode 100644 -index 000000000..9665896d5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188e_hal.h -@@ -0,0 +1,321 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 -+#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_CAM_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 */ -+ -+#define PAGE_SIZE_TX_88E PAGE_SIZE_128 -+/* Note: We will divide number of page equally for each queue other than public queue! -+ * 22k = 22528 bytes = 176 pages (@page = 128 bytes) -+ * BCN rsvd_page_num = MAX_BEACON_LEN / PAGE_SIZE_TX_88E -+ * 1 ps-poll / 1 null-data /1 prob_rsp /1 QOS null-data = 4 pages */ -+ -+#define BCNQ_PAGE_NUM_88E (MAX_BEACON_LEN / PAGE_SIZE_TX_88E + 4) /*0x09*/ -+ -+/* For WoWLan , more reserved page */ -+#ifdef CONFIG_WOWLAN -+ #ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ #define WOWLAN_KEEP_ALIVE_PAGE 0x02 /*for keep alive packet*/ -+ #else -+ #define WOWLAN_KEEP_ALIVE_PAGE 0x00 -+ #endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ /* 1 ArpRsp + 2 NbrAdv + 2 NDPInfo + 1 RCI + 1 AOAC = 7 pages */ -+ #define WOWLAN_PAGE_NUM_88E (0x07+ WOWLAN_KEEP_ALIVE_PAGE) -+#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) -+#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 InitBeaconParameters_8188e(_adapter *adapter); -+void SetBeaconRelatedRegisters8188E(PADAPTER padapter); -+ -+void rtl8188e_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8188e(_adapter *adapter); -+ -+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); -+ -+u8 SetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); -+ -+u8 -+GetHalDefVar8188E( -+ PADAPTER Adapter, -+ HAL_DEF_VARIABLE eVariable, -+ void *pValue -+); -+#ifdef CONFIG_GPIO_API -+int rtl8188e_GpioFuncCheck(PADAPTER adapter, u8 gpio_num); -+#endif -+#endif /* __RTL8188E_HAL_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8188e_led.h b/drivers/net/wireless/rtl8821cs/include/rtl8188e_led.h -new file mode 100644 -index 000000000..ef0546750 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188e_led.h -@@ -0,0 +1,37 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8188E_LED_H__ -+#define __RTL8188E_LED_H__ -+ -+#ifdef CONFIG_RTW_SW_LED -+ -+/* ******************************************************************************** -+ * 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 -+#endif /*CONFIG_RTW_SW_LED*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8188e_recv.h b/drivers/net/wireless/rtl8821cs/include/rtl8188e_recv.h -new file mode 100644 -index 000000000..31058c1b1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188e_recv.h -@@ -0,0 +1,156 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ -+ /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ -+ /* #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 /* !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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8188e_rf.h b/drivers/net/wireless/rtl8821cs/include/rtl8188e_rf.h -new file mode 100644 -index 000000000..8dc413e1d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188e_rf.h -@@ -0,0 +1,27 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8188E_RF_H__ -+#define __RTL8188E_RF_H__ -+ -+ -+ -+int PHY_RF6052_Config8188E(PADAPTER Adapter); -+void rtl8188e_RF_ChangeTxPath(PADAPTER Adapter, -+ u16 DataRate); -+void rtl8188e_PHY_RF6052SetBandwidth( -+ PADAPTER Adapter, -+ enum channel_width Bandwidth); -+ -+#endif/* __RTL8188E_RF_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8188e_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8188e_spec.h -new file mode 100644 -index 000000000..802659a5f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188e_spec.h -@@ -0,0 +1,159 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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_DBI_WDATA_8188E 0x0348 /* DBI Write data */ -+#define REG_DBI_RDATA_8188E 0x034C /* DBI Read data */ -+#define REG_DBI_ADDR_8188E 0x0350 /* DBI Address */ -+#define REG_DBI_FLAG_8188E 0x0352 /* DBI Read/Write Flag */ -+#define REG_MDIO_WDATA_8188E 0x0354 /* MDIO for Write PCIE PHY */ -+#define REG_MDIO_RDATA_8188E 0x0356 /* MDIO for Reads PCIE PHY */ -+#define REG_MDIO_CTL_8188E 0x0358 /* MDIO for Control */ -+ -+#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 -+ * -+ * ----------------------------------------------------- */ -+#define REG_PCIE_HRPWM_8188E 0x0361 /* PCIe RPWM */ -+#define REG_PCIE_HCPWM_8188E 0x0363 /* PCIe CPWM */ -+ -+/* ----------------------------------------------------- -+ * -+ * 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 -+ -+/* ---------------------------------------------------------------------------- -+ * 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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8188e_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtl8188e_sreset.h -new file mode 100644 -index 000000000..f4ec2d88c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188e_sreset.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8188e_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8188e_xmit.h -new file mode 100644 -index 000000000..9772f1258 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188e_xmit.h -@@ -0,0 +1,302 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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); -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8188es_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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(unsigned long 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8188eu_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ s32 rtl8188eu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8188eu_xmit_buf_handler(PADAPTER padapter); -+ void rtl8188eu_xmit_tasklet(unsigned long 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8188ee_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8188f_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtl8188f_cmd.h -new file mode 100644 -index 000000000..6f33708e9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188f_cmd.h -@@ -0,0 +1,200 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 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((u8 *)(__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_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_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 */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+void rtl8188f_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+void rtl8188f_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+ -+s32 FillH2CCmd8188F(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8188F(_adapter *padapter, bool wowlan); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8188f_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8188f_dm.h -new file mode 100644 -index 000000000..342ade9a5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188f_dm.h -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8188f_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8188f_hal.h -new file mode 100644 -index 000000000..5db99a41e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188f_hal.h -@@ -0,0 +1,260 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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_CAM_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) -+ * BCN rsvd_page_num = MAX_BEACON_LEN / PAGE_SIZE_TX_8188F, -+ * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1, CTS-2-SELF / LTE QoS Null */ -+ -+#define BCNQ_PAGE_NUM_8188F (MAX_BEACON_LEN / PAGE_SIZE_TX_8188F + 6) /*0x08*/ -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt:1 ,PNO: 6 -+ * NS offload:2 NDP info: 1 -+ */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8188F 0x0b -+#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 - 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 (34 + 1) -+ -+#define HAL_EFUSE_MEMORY -+ -+#define HWSET_MAX_SIZE_8188F 512 -+#define EFUSE_REAL_CONTENT_LEN_8188F 256 -+#define EFUSE_MAP_LEN_8188F 512 -+#define EFUSE_MAX_SECTION_8188F (EFUSE_MAP_LEN_8188F / 8) -+ -+#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); -+u8 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(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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8188f_led.h b/drivers/net/wireless/rtl8821cs/include/rtl8188f_led.h -new file mode 100644 -index 000000000..ef5d1a776 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188f_led.h -@@ -0,0 +1,45 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8188F_LED_H__ -+#define __RTL8188F_LED_H__ -+#ifdef CONFIG_RTW_SW_LED -+ -+#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 -+#endif/*CONFIG_RTW_SW_LED*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8188f_recv.h b/drivers/net/wireless/rtl8821cs/include/rtl8188f_recv.h -new file mode 100644 -index 000000000..44b51fdbb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188f_recv.h -@@ -0,0 +1,64 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8188F_RECV_H__ -+#define __RTL8188F_RECV_H__ -+ -+#if defined(CONFIG_USB_HCI) -+ #ifndef MAX_RECVBUF_SZ -+ -+ #ifdef CONFIG_MINIMAL_MEMORY_USAGE -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ #else -+ #ifdef 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 /* !MAX_RECVBUF_SZ */ -+#elif defined(CONFIG_PCI_HCI) -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+#elif defined(CONFIG_SDIO_HCI) -+ /* minmum 4K, multiple of 8-byte is required, multiple of sdio block size is prefered */ -+ #define MAX_RECVBUF_SZ _RND(RX_DMA_BOUNDARY_8188F + 1, 8) -+#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); -+s32 rtl8188fs_recv_hdl(_adapter *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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8188f_rf.h b/drivers/net/wireless/rtl8821cs/include/rtl8188f_rf.h -new file mode 100644 -index 000000000..a0338313b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188f_rf.h -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8188F_RF_H__ -+#define __RTL8188F_RF_H__ -+ -+int PHY_RF6052_Config8188F(PADAPTER Adapter); -+ -+void -+PHY_RF6052SetBandwidth8188F( -+ PADAPTER Adapter, -+ enum channel_width Bandwidth); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8188f_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8188f_spec.h -new file mode 100644 -index 000000000..d947ba800 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188f_spec.h -@@ -0,0 +1,275 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 -+ -+/* **************************************************************************** -+ * 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 BIT(5) -+ -+/* ----------------------------------------------------- -+ * -+ * 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 BIT(31) /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8188F BIT(30) /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8188F BIT(29) /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8188F BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8188F BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8188F BIT(26) /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8188F BIT(25) /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8188F BIT(24) /* TSF Timer BIT(32) toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8188F BIT(20) /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8188F BIT(16) /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8188F BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8188F BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8188F BIT(12) /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8188F BIT(10) /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8188F BIT(9) /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8188F BIT(8) /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8188F BIT(7) /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8188F BIT(6) /* Management Queue DMA OK */ -+#define IMR_BKDOK_8188F BIT(5) /* AC_BK DMA OK */ -+#define IMR_BEDOK_8188F BIT(4) /* AC_BE DMA OK */ -+#define IMR_VIDOK_8188F BIT(3) /* AC_VI DMA OK */ -+#define IMR_VODOK_8188F BIT(2) /* AC_VO DMA OK */ -+#define IMR_RDU_8188F BIT(1) /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8188F BIT(0) /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8188F BIT(27) /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8188F BIT(26) /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8188F BIT(25) /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8188F BIT(24) /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8188F BIT(23) /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8188F BIT(22) /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8188F BIT(21) /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8188F BIT(20) /* Beacon Queue DMA OK Interrupt 7 */ -+#define IMR_BCNDOK6_8188F BIT(19) /* Beacon Queue DMA OK Interrupt 6 */ -+#define IMR_BCNDOK5_8188F BIT(18) /* Beacon Queue DMA OK Interrupt 5 */ -+#define IMR_BCNDOK4_8188F BIT(17) /* Beacon Queue DMA OK Interrupt 4 */ -+#define IMR_BCNDOK3_8188F BIT(16) /* Beacon Queue DMA OK Interrupt 3 */ -+#define IMR_BCNDOK2_8188F BIT(15) /* Beacon Queue DMA OK Interrupt 2 */ -+#define IMR_BCNDOK1_8188F BIT(14) /* Beacon Queue DMA OK Interrupt 1 */ -+#define IMR_ATIMEND_E_8188F BIT(13) /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8188F BIT(11) /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8188F BIT(10) /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8188F BIT(9) /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8188F BIT(8) /* 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 -+ -+#endif /* __RTL8188F_SPEC_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8188f_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtl8188f_sreset.h -new file mode 100644 -index 000000000..fe56567e7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188f_sreset.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8188f_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8188f_xmit.h -new file mode 100644 -index 000000000..a304a0f46 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8188f_xmit.h -@@ -0,0 +1,340 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 */ -+#ifdef CONFIG_PCI_HCI -+#define SET_TX_DESC_TX_BUFFER_SIZE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) -+#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) -+#ifdef CONFIG_SDIO_HCI -+#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); -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+ -+#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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+s32 rtl8188fs_hal_mgmt_xmitframe_enqueue(PADAPTER, struct xmit_frame *); -+#endif -+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 -+#ifdef CONFIG_XMIT_THREAD_MODE -+s32 rtl8188fu_xmit_buf_handler(PADAPTER padapter); -+#define hal_xmit_handler rtl8188fu_xmit_buf_handler -+#endif -+ -+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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+s32 rtl8188fu_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+s32 rtl8188fu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+/* s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); */ -+void rtl8188fu_xmit_tasklet(unsigned long 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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8192e_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtl8192e_cmd.h -new file mode 100644 -index 000000000..a9c8be840 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192e_cmd.h -@@ -0,0 +1,141 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 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); -+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 */ -+ -+/* / 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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8192e_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8192e_dm.h -new file mode 100644 -index 000000000..0a65a1be3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192e_dm.h -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192E_DM_H__ -+#define __RTL8192E_DM_H__ -+ -+ -+void rtl8192e_init_dm_priv(PADAPTER Adapter); -+void rtl8192e_deinit_dm_priv(PADAPTER Adapter); -+void rtl8192e_InitHalDm(PADAPTER Adapter); -+void rtl8192e_HalDmWatchDog(PADAPTER Adapter); -+ -+/* void rtl8192c_dm_CheckTXPowerTracking(PADAPTER Adapter); */ -+ -+/* void rtl8192c_dm_RF_Saving(PADAPTER pAdapter, u8 bForceInNormal); */ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192e_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8192e_hal.h -new file mode 100644 -index 000000000..417147dab ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192e_hal.h -@@ -0,0 +1,330 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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_CAM_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*/ -+ -+ -+#define PAGE_SIZE_TX_92E PAGE_SIZE_256 -+ -+/* 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: MAX_BEACON_LEN / PAGE_SIZE_TX_92E -+ * PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1,CTS-2-SELF / LTE QoS Null*/ -+ -+#define RSVD_PAGE_NUM_8192E (MAX_BEACON_LEN / PAGE_SIZE_TX_92E + 6) /*0x08*/ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt: 1,PNO: 6 -+ * NS offload: 2 NDP info: 1 -+ */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8192E 0x0b -+#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 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(PADAPTER Adapter); -+void _InitQueuePriority_8192E(PADAPTER Adapter); -+void _InitTxBufferBoundary_8192E(PADAPTER Adapter, u8 txpktbuf_bndy); -+void _InitPageBoundary_8192E(PADAPTER Adapter); -+/* void _InitTransferPageSize_8192E(PADAPTER Adapter); */ -+void _InitDriverInfoSize_8192E(PADAPTER Adapter, u8 drvInfoSize); -+void _InitRDGSetting_8192E(PADAPTER Adapter); -+void _InitID_8192E(PADAPTER Adapter); -+void _InitNetworkType_8192E(PADAPTER Adapter); -+void _InitWMACSetting_8192E(PADAPTER Adapter); -+void _InitAdaptiveCtrl_8192E(PADAPTER Adapter); -+void _InitEDCA_8192E(PADAPTER Adapter); -+void _InitRetryFunction_8192E(PADAPTER Adapter); -+void _BBTurnOnBlock_8192E(PADAPTER Adapter); -+void _InitBeaconParameters_8192E(PADAPTER Adapter); -+void _InitBeaconMaxError_8192E( -+ PADAPTER Adapter, -+ BOOLEAN InfraMode -+); -+void SetBeaconRelatedRegisters8192E(PADAPTER padapter); -+void hal_ReadRFType_8192E(PADAPTER Adapter); -+/* RTL8192E-MAC Setting -+ ***********************************************************/ -+ -+u8 SetHwReg8192E(PADAPTER Adapter, u8 variable, u8 *val); -+void GetHwReg8192E(PADAPTER Adapter, u8 variable, u8 *val); -+u8 -+SetHalDefVar8192E( -+ PADAPTER Adapter, -+ HAL_DEF_VARIABLE eVariable, -+ void *pValue -+); -+u8 -+GetHalDefVar8192E( -+ PADAPTER Adapter, -+ HAL_DEF_VARIABLE eVariable, -+ void *pValue -+); -+ -+void rtl8192e_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8192e(_adapter *adapter); -+void rtl8192e_init_default_value(_adapter *padapter); -+ -+void rtl8192e_start_thread(_adapter *padapter); -+void rtl8192e_stop_thread(_adapter *padapter); -+ -+#ifdef CONFIG_PCI_HCI -+ BOOLEAN InterruptRecognized8192EE(PADAPTER Adapter); -+ u16 get_txbd_rw_reg(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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8192e_led.h b/drivers/net/wireless/rtl8821cs/include/rtl8192e_led.h -new file mode 100644 -index 000000000..3d795c405 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192e_led.h -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192E_LED_H__ -+#define __RTL8192E_LED_H__ -+ -+#ifdef CONFIG_RTW_SW_LED -+/* ******************************************************************************** -+ * 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 -+#endif/*CONFIG_RTW_SW_LED*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192e_recv.h b/drivers/net/wireless/rtl8821cs/include/rtl8192e_recv.h -new file mode 100644 -index 000000000..c19a98080 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192e_recv.h -@@ -0,0 +1,175 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192E_RECV_H__ -+#define __RTL8192E_RECV_H__ -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #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 */ -+ #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ #undef MAX_RECVBUF_SZ -+ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ -+ #endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ -+ #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 6 */ -+#define GET_RX_STATUS_DESC_SPLCP_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) -+#define GET_RX_STATUS_DESC_LDPC_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) -+#define GET_RX_STATUS_DESC_STBC_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) -+#define GET_RX_STATUS_DESC_BW_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) -+ -+ -+/* 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); -+ s32 rtl8192es_recv_hdl(_adapter *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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8192e_rf.h b/drivers/net/wireless/rtl8821cs/include/rtl8192e_rf.h -new file mode 100644 -index 000000000..77dca747e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192e_rf.h -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192E_RF_H__ -+#define __RTL8192E_RF_H__ -+ -+void -+PHY_RF6052SetBandwidth8192E( -+ PADAPTER Adapter, -+ enum channel_width Bandwidth); -+ -+ -+int -+PHY_RF6052_Config_8192E( -+ PADAPTER Adapter); -+ -+#endif/* __RTL8192E_RF_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192e_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8192e_spec.h -new file mode 100644 -index 000000000..c9b2b41e6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192e_spec.h -@@ -0,0 +1,313 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 BIT(31) /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8192E BIT(30) /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8192E BIT(29) /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8192E BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8192E BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8192E BIT(26) /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8192E BIT(25) /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8192E BIT(24) /* TSF Timer BIT(32) toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8192E BIT(20) /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8192E BIT(16) /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8192E BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8192E BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8192E BIT(12) /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8192E BIT(10) /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8192E BIT(9) /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8192E BIT(8) /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8192E BIT(7) /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8192E BIT(6) /* Management Queue DMA OK */ -+#define IMR_BKDOK_8192E BIT(5) /* AC_BK DMA OK */ -+#define IMR_BEDOK_8192E BIT(4) /* AC_BE DMA OK */ -+#define IMR_VIDOK_8192E BIT(3) /* AC_VI DMA OK */ -+#define IMR_VODOK_8192E BIT(2) /* AC_VO DMA OK */ -+#define IMR_RDU_8192E BIT(1) /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8192E BIT(0) /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8192E BIT(27) /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8192E BIT(26) /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8192E BIT(25) /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8192E BIT(24) /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8192E BIT(23) /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8192E BIT(22) /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8192E BIT(21) /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8192E BIT(20) /* Beacon Queue DMA OK Interrupt 7 */ -+#define IMR_BCNDOK6_8192E BIT(19) /* Beacon Queue DMA OK Interrupt 6 */ -+#define IMR_BCNDOK5_8192E BIT(18) /* Beacon Queue DMA OK Interrupt 5 */ -+#define IMR_BCNDOK4_8192E BIT(17) /* Beacon Queue DMA OK Interrupt 4 */ -+#define IMR_BCNDOK3_8192E BIT(16) /* Beacon Queue DMA OK Interrupt 3 */ -+#define IMR_BCNDOK2_8192E BIT(15) /* Beacon Queue DMA OK Interrupt 2 */ -+#define IMR_BCNDOK1_8192E BIT(14) /* Beacon Queue DMA OK Interrupt 1 */ -+#define IMR_ATIMEND_E_8192E BIT(13) /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8192E BIT(11) /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8192E BIT(10) /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8192E BIT(9) /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8192E BIT(8) /* 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 BIT(1) -+#define BIT_USB_RXDMA_AGG_EN BIT(31) -+ -+/* ---------------------------------------------------------------------------- -+ * 8192E REG_SYS_CFG1 (offset 0xF0, 32bits) -+ * ---------------------------------------------------------------------------- */ -+#define BIT_SPSLDO_SEL BIT(24) -+ -+ -+/* ---------------------------------------------------------------------------- -+ * 8192E REG_CCK_CHECK (offset 0x454, 8bits) -+ * ---------------------------------------------------------------------------- */ -+#define BIT_BCN_PORT_SEL BIT(5) -+ -+/* **************************************************************************** -+ * 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) -+ -+#endif /* __RTL8192E_SPEC_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192e_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtl8192e_sreset.h -new file mode 100644 -index 000000000..78109aea4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192e_sreset.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8192e_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8192e_xmit.h -new file mode 100644 -index 000000000..e0573ce82 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192e_xmit.h -@@ -0,0 +1,457 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 */ -+#ifdef CONFIG_PCI_HCI -+ #define SET_TX_DESC_TX_BUFFER_SIZE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) -+ #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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8192eu_hal_mgmt_xmitframe_enqueue(PADAPTER padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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(unsigned long 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8192ee_hal_mgmt_xmitframe_enqueue(PADAPTER padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8192es_hal_mgmt_xmitframe_enqueue(PADAPTER padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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(unsigned long 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_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_bmc_tx_rate(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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8192f_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtl8192f_cmd.h -new file mode 100644 -index 000000000..44ea6707b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192f_cmd.h -@@ -0,0 +1,213 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192F_CMD_H__ -+#define __RTL8192F_CMD_H__ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+enum h2c_cmd_8192F { -+ /* Common Class: 000 */ -+ H2C_8192F_RSVD_PAGE = 0x00, -+ H2C_8192F_MEDIA_STATUS_RPT = 0x01, -+ H2C_8192F_SCAN_ENABLE = 0x02, -+ H2C_8192F_KEEP_ALIVE = 0x03, -+ H2C_8192F_DISCON_DECISION = 0x04, -+ H2C_8192F_PSD_OFFLOAD = 0x05, -+ H2C_8192F_AP_OFFLOAD = 0x08, -+ H2C_8192F_BCN_RSVDPAGE = 0x09, -+ H2C_8192F_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_8192F_FCS_RSVDPAGE = 0x10, -+ H2C_8192F_FCS_INFO = 0x11, -+ H2C_8192F_AP_WOW_GPIO_CTRL = 0x13, -+ -+ /* PoweSave Class: 001 */ -+ H2C_8192F_SET_PWR_MODE = 0x20, -+ H2C_8192F_PS_TUNING_PARA = 0x21, -+ H2C_8192F_PS_TUNING_PARA2 = 0x22, -+ H2C_8192F_P2P_LPS_PARAM = 0x23, -+ H2C_8192F_P2P_PS_OFFLOAD = 0x24, -+ H2C_8192F_PS_SCAN_ENABLE = 0x25, -+ H2C_8192F_SAP_PS_ = 0x26, -+ H2C_8192F_INACTIVE_PS_ = 0x27,/* Inactive_PS */ -+ H2C_8192F_FWLPS_IN_IPS_ = 0x28, -+ -+ /* Dynamic Mechanism Class: 010 */ -+ H2C_8192F_MACID_CFG = 0x40, -+ H2C_8192F_TXBF = 0x41, -+ H2C_8192F_RSSI_SETTING = 0x42, -+ H2C_8192F_AP_REQ_TXRPT = 0x43, -+ H2C_8192F_INIT_RATE_COLLECT = 0x44, -+ H2C_8192F_RA_PARA_ADJUST = 0x46, -+ -+ /* BT Class: 011 */ -+ H2C_8192F_B_TYPE_TDMA = 0x60, -+ H2C_8192F_BT_INFO = 0x61, -+ H2C_8192F_FORCE_BT_TXPWR = 0x62, -+ H2C_8192F_BT_IGNORE_WLANACT = 0x63, -+ H2C_8192F_DAC_SWING_VALUE = 0x64, -+ H2C_8192F_ANT_SEL_RSV = 0x65, -+ H2C_8192F_WL_OPMODE = 0x66, -+ H2C_8192F_BT_MP_OPER = 0x67, -+ H2C_8192F_BT_CONTROL = 0x68, -+ H2C_8192F_BT_WIFI_CTRL = 0x69, -+ H2C_8192F_BT_FW_PATCH = 0x6A, -+ H2C_8192F_BT_WLAN_CALIBRATION = 0x6D, -+ -+ /* WOWLAN Class: 100 */ -+ H2C_8192F_WOWLAN = 0x80, -+ H2C_8192F_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8192F_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8192F_AOAC_RSVD_PAGE = 0x83, -+ H2C_8192F_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_8192F_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_8192F_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_8192F_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_8192F_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_8192F_P2P_OFFLOAD = 0x8B, -+ -+ H2C_8192F_RESET_TSF = 0xC0, -+ H2C_8192F_MAXID, -+}; -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- -+ * _RSVDPAGE_LOC_CMD_0x00 */ -+#define SET_8192F_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8192F_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8192F_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8192F_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8192F_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_8192F_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8192F_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8192F_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8192F_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+/* _PWR_MOD_CMD_0x20 */ -+#define SET_8192F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8192F_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8192F_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8192F_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8192F_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8192F_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) -+#define SET_8192F_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+#define GET_8192F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+/* _PS_TUNE_PARAM_CMD_0x21 */ -+#define SET_8192F_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8192F_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8192F_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) -+#define SET_8192F_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) -+#define SET_8192F_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _MACID_CFG_CMD_0x40 */ -+#define SET_8192F_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) -+#define SET_8192F_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) -+ -+/* _RSSI_SETTING_CMD_0x42 */ -+#define SET_8192F_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8192F_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) -+#define SET_8192F_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _AP_REQ_TXRPT_CMD_0x43 */ -+#define SET_8192F_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8192F_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _FORCE_BT_TXPWR_CMD_0x62 */ -+#define SET_8192F_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+ -+/* _FORCE_BT_MP_OPER_CMD_0x67 */ -+#define SET_8192F_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_8192F_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_8192F_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8192F_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_8192F_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8192F_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+ -+/* _BT_FW_PATCH_0x6A */ -+#define SET_8192F_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((u8 *)(__pH2CCmd), 0, 16, __Value) -+#define SET_8192F_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8192F_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8192F_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8192F_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 rtl8192f_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8192f_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -+/* s32 rtl8192f__set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ -+void rtl8192f_set_FwPsTuneParam_cmd(PADAPTER padapter); -+void rtl8192f_download_rsvd_page(PADAPTER padapter, u8 mstatus); -+#ifdef CONFIG_BT_COEXIST -+void rtl8192f_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif /* CONFIG_BT_COEXIST */ -+#ifdef CONFIG_P2P -+void rtl8192f_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+void rtl8192f_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+/* AP_REQ_TXREP_CMD 0x43 */ -+#define SET_8192F_H2CCMD_TXREP_PARM_STA1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8192F_H2CCMD_TXREP_PARM_STA2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8192F_H2CCMD_TXREP_PARM_RTY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) -+ -+/* C2H_AP_REQ_TXRPT */ -+#define GET_8192F_C2H_TC2H_APREQ_TXRPT_MACID1(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 8) -+#define GET_8192F_C2H_TC2H_APREQ_TXRPT_TXOK1(_Header) LE_BITS_TO_2BYTE((_Header + 1), 0, 16) -+#define GET_8192F_C2H_TC2H_APREQ_TXRPT_TXFAIL1(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) -+#define GET_8192F_C2H_TC2H_APREQ_TXRPT_INIRATE1(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) -+#define GET_8192F_C2H_TC2H_APREQ_TXRPT_MACID2(_Header) LE_BITS_TO_1BYTE((_Header + 6), 0, 8) -+#define GET_8192F_C2H_TC2H_APREQ_TXRPT_TXOK2(_Header) LE_BITS_TO_2BYTE((_Header + 7), 0, 16) -+#define GET_8192F_C2H_TC2H_APREQ_TXRPT_TXFAIL2(_Header) LE_BITS_TO_2BYTE((_Header + 9), 0, 16) -+#define GET_8192F_C2H_TC2H_APREQ_TXRPT_INIRATE2(_Header) LE_BITS_TO_1BYTE((_Header + 11), 0, 8) -+ -+/* C2H_SPC_STAT */ -+#define GET_8192F_C2H_SPC_STAT_IDX(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 8) -+ /* Tip :TYPE_A data3 is msb and data0 is lsb */ -+#define GET_8192F_C2H_SPC_STAT_TYPEA_RETRY(_Header) LE_BITS_TO_4BYTE((_Header + 1), 0, 32) -+#define GET_8192F_C2H_SPC_STAT_TYPEB_PKT1(_Header) LE_BITS_TO_2BYTE((_Header + 1), 0, 16) -+#define GET_8192F_C2H_SPC_STAT_TYPEB_RETRY1(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) -+#define GET_8192F_C2H_SPC_STAT_TYPEB_PKT2(_Header) LE_BITS_TO_2BYTE((_Header + 5), 0, 16) -+#define GET_8192F_C2H_SPC_STAT_TYPEB_RETRY2(_Header) LE_BITS_TO_2BYTE((_Header + 7), 0, 16) -+ -+void rtl8192f_req_txrpt_cmd(PADAPTER, u8 macid); -+s32 FillH2CCmd8192F(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8192F(_adapter *padapter, bool wowlan); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192f_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8192f_dm.h -new file mode 100644 -index 000000000..36ed77bb3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192f_dm.h -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192F_DM_H__ -+#define __RTL8192F_DM_H__ -+ -+void rtl8192f_init_dm_priv(PADAPTER Adapter); -+void rtl8192f_deinit_dm_priv(PADAPTER Adapter); -+void rtl8192f_InitHalDm(PADAPTER Adapter); -+void rtl8192f_HalDmWatchDog(PADAPTER Adapter); -+ -+/* void rtl8192c_dm_CheckTXPowerTracking(PADAPTER Adapter); */ -+ -+/* void rtl8192c_dm_RF_Saving(PADAPTER pAdapter, u8 bForceInNormal); */ -+#if defined (CONFIG_CONCURRENT_MODE) && defined (CONFIG_TSF_SYNC) -+void rtl8192f_sync_tsfr(_adapter *Adapter); -+#endif/*(CONFIG_CONCURRENT_MODE) && defined (CONFIG_TSF_SYNC)*/ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192f_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8192f_hal.h -new file mode 100644 -index 000000000..e7d6db52a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192f_hal.h -@@ -0,0 +1,327 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192F_HAL_H__ -+#define __RTL8192F_HAL_H__ -+ -+#include "hal_data.h" -+ -+#include "rtl8192f_spec.h" -+#include "rtl8192f_rf.h" -+#include "rtl8192f_dm.h" -+#include "rtl8192f_recv.h" -+#include "rtl8192f_xmit.h" -+#include "rtl8192f_cmd.h" -+#include "rtl8192f_led.h" -+#include "Hal8192FPwrSeq.h" -+#include "Hal8192FPhyReg.h" -+#include "Hal8192FPhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8192f_sreset.h" -+#endif -+#ifdef CONFIG_LPS_POFF -+ #include "rtl8192f_lps_poff.h" -+#endif -+ -+#define FW_8192F_SIZE 0x8000 -+#define FW_8192F_START_ADDRESS 0x4000 -+#define FW_8192F_END_ADDRESS 0x5000 /* brian_zhang@realsil.com.cn */ -+ -+#define IS_FW_HEADER_EXIST_8192F(_pFwHdr)\ -+ ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x92F0) -+ -+typedef struct _RT_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[FW_8192F_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8192F, *PRT_FIRMWARE_8192F; -+ -+/* -+ * This structure must be cared byte-ordering -+ * -+ * Added by tynli. 2009.12.04. */ -+typedef struct _RT_8192F_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_8192F_FIRMWARE_HDR, *PRT_8192F_FIRMWARE_HDR; -+#define DRIVER_EARLY_INT_TIME_8192F 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8192F 0x02 -+/* for 8192F -+ * TX 64K, RX 16K, Page size 256B for TX*/ -+#define PAGE_SIZE_TX_8192F 256 -+#define PAGE_SIZE_RX_8192F 8 -+#define TX_DMA_SIZE_8192F 0x10000/* 64K(TX) */ -+#define RX_DMA_SIZE_8192F 0x4000/* 16K(RX) */ -+#ifdef CONFIG_WOWLAN -+ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ -+#else -+ #define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8192F 0x100 /* 256B, reserved for c2h debug message */ -+#else -+ #define RX_DMA_RESERVED_SIZE_8192F 0xc0 /* 192B, reserved for tx report 24*8=192*/ -+#endif -+#define RX_DMA_BOUNDARY_8192F\ -+ (RX_DMA_SIZE_8192F - RX_DMA_RESERVED_SIZE_8192F - 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:MAX_BEACON_LEN/PAGE_SIZE_TX_8192F -+ * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ -+#define BCNQ_PAGE_NUM_8192F (MAX_BEACON_LEN/PAGE_SIZE_TX_8192F + 6) /*0x08*/ -+ -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt 1, PNO: 6 -+ * NS offload: 2 NDP info: 1 -+ */ -+#ifdef CONFIG_WOWLAN -+ #ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ #define WOWLAN_KEEP_ALIVE_PAGE 0x02 /*for keep alive packet*/ -+ #else -+ #define WOWLAN_KEEP_ALIVE_PAGE 0x00 -+ #endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ /* 7 pages for wow rsvd page + 2 pages for pattern */ -+ #define WOWLAN_PAGE_NUM_8192F (0x09 + WOWLAN_KEEP_ALIVE_PAGE) -+#else -+ #define WOWLAN_PAGE_NUM_8192F 0x00 -+#endif -+ -+#ifdef CONFIG_WOW_PATTERN_IN_TXFIFO -+ /* REG_TXBUF_WKCAM_OFFSET 0x1B1[15:0] */ -+ #define WKCAM_OFFSET_BIT_MASK 0xFFFF -+ #define WKCAM_OFFSET_BIT_MASK_OFFSET 0 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+ #undef WOWLAN_PAGE_NUM_8192F -+ #define WOWLAN_PAGE_NUM_8192F 0x15 -+#endif -+ -+#ifdef CONFIG_AP_WOWLAN -+ #define AP_WOWLAN_PAGE_NUM_8192F 0x02 -+#endif -+ -+#ifdef DBG_LA_MODE -+ #define LA_MODE_PAGE_NUM 0xE0 -+#endif -+ -+#define MAX_RX_DMA_BUFFER_SIZE_8192F (RX_DMA_SIZE_8192F - RX_DMA_RESERVED_SIZE_8192F) -+ -+#ifdef DBG_LA_MODE -+ #define TX_TOTAL_PAGE_NUMBER_8192F (0xFF - LA_MODE_PAGE_NUM) -+#else -+ #define TX_TOTAL_PAGE_NUMBER_8192F (0xFF - BCNQ_PAGE_NUM_8192F - WOWLAN_PAGE_NUM_8192F) -+#endif -+ -+#define TX_PAGE_BOUNDARY_8192F (TX_TOTAL_PAGE_NUMBER_8192F + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8192F \ -+ TX_TOTAL_PAGE_NUMBER_8192F -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8192F \ -+ (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8192F + 1) -+ -+/* For Normal Chip Setting -+ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8192F */ -+#define NORMAL_PAGE_NUM_HPQ_8192F 0x8 -+#define NORMAL_PAGE_NUM_LPQ_8192F 0x8 -+#define NORMAL_PAGE_NUM_NPQ_8192F 0x8 -+#define NORMAL_PAGE_NUM_EPQ_8192F 0x00 -+ -+/* Note: For Normal Chip Setting, modify later */ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8192F 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8192F 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8192F 0x20 -+#define WMM_NORMAL_PAGE_NUM_EPQ_8192F 0x00 -+ -+ -+#include "HalVerDef.h" -+#include "hal_com.h" -+ -+#define EFUSE_OOB_PROTECT_BYTES 56 /*0x1C8~0x1FF*/ -+ -+#define HAL_EFUSE_MEMORY -+#define HWSET_MAX_SIZE_8192F 512 -+#define EFUSE_REAL_CONTENT_LEN_8192F 512 -+#define EFUSE_MAP_LEN_8192F 512 -+#define EFUSE_MAX_SECTION_8192F 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_8192F) -+ -+#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 512 -+#define EFUSE_BT_REAL_CONTENT_LEN 1536/*512 * 3 */ -+/* (EFUSE_BT_REAL_BANK_CONTENT_LEN * BANK_NUM)*/ -+#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_QFN32, -+ PACKAGE_QFN40, -+ PACKAGE_QFN46 -+} 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 */ -+ -+/* rtl8192f_hal_init.c */ -+s32 rtl8192f_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void rtl8192f_FirmwareSelfReset(PADAPTER padapter); -+void rtl8192f_InitializeFirmwareVars(PADAPTER padapter); -+ -+void rtl8192f_InitAntenna_Selection(PADAPTER padapter); -+void rtl8192f_DeinitAntenna_Selection(PADAPTER padapter); -+void rtl8192f_CheckAntenna_Selection(PADAPTER padapter); -+void rtl8192f_init_default_value(PADAPTER padapter); -+ -+s32 rtl8192f_InitLLTTable(PADAPTER padapter); -+ -+s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); -+s32 CardDisableWithoutHWSM(PADAPTER padapter); -+ -+/* EFuse */ -+u8 GetEEPROMSize8192F(PADAPTER padapter); -+void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); -+void Hal_EfuseParseTxPowerInfo_8192F(PADAPTER padapter, -+ u8 *PROMContent, BOOLEAN AutoLoadFail); -+#ifdef CONFIG_BT_COEXIST -+void Hal_EfuseParseBTCoexistInfo_8192F(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+#endif /* CONFIG_BT_COEXIST */ -+void Hal_EfuseParseEEPROMVer_8192F(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseChnlPlan_8192F(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID_8192F(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseAntennaDiversity_8192F(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8192F(PADAPTER pAdapter, -+ u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseThermalMeter_8192F(PADAPTER padapter, -+ u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseVoltage_8192F(PADAPTER pAdapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseBoardType_8192F(PADAPTER Adapter, -+ u8 *PROMContent, BOOLEAN AutoloadFail); -+u8 Hal_ReadRFEType_8192F(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void rtl8192f_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8192f(_adapter *adapter); -+u8 SetHwReg8192F(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8192F(PADAPTER padapter, u8 variable, u8 *val); -+u8 SetHalDefVar8192F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8192F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+ -+/* register */ -+void rtl8192f_InitBeaconParameters(PADAPTER padapter); -+void rtl8192f_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); -+ -+void _InitMacAPLLSetting_8192F(PADAPTER Adapter); -+void _8051Reset8192F(PADAPTER padapter); -+#ifdef CONFIG_WOWLAN -+ void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif /* CONFIG_WOWLAN */ -+ -+void rtl8192f_start_thread(_adapter *padapter); -+void rtl8192f_stop_thread(_adapter *padapter); -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+ void rtl8192fs_init_checkbthang_workqueue(_adapter *adapter); -+ void rtl8192fs_free_checkbthang_workqueue(_adapter *adapter); -+ void rtl8192fs_cancle_checkbthang_workqueue(_adapter *adapter); -+ void rtl8192fs_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(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+#endif -+void CCX_FwC2HTxRpt_8192f(PADAPTER padapter, u8 *pdata, u8 len); -+ -+u8 MRateToHwRate8192F(u8 rate); -+u8 HwRateToMRate8192F(u8 rate); -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+ void check_bt_status_work(void *data); -+#endif -+ -+ -+void rtl8192f_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+ -+#ifdef CONFIG_AMPDU_PRETX_CD -+void rtl8192f_pretx_cd_config(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ BOOLEAN InterruptRecognized8192FE(PADAPTER Adapter); -+ void UpdateInterruptMask8192FE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+ void InitMAC_TRXBD_8192FE(PADAPTER Adapter); -+ -+ u16 get_txbd_rw_reg(u16 ff_hwaddr); -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192f_led.h b/drivers/net/wireless/rtl8821cs/include/rtl8192f_led.h -new file mode 100644 -index 000000000..0dbb27cd0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192f_led.h -@@ -0,0 +1,59 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192F_LED_H__ -+#define __RTL8192F_LED_H__ -+ -+#include -+#include -+#include -+ -+#ifdef CONFIG_RTW_SW_LED -+/* ******************************************************************************** -+ * Interface to manipulate LED objects. -+ * ******************************************************************************** */ -+#ifdef CONFIG_USB_HCI -+/** REG_LED_CFG (0x4C) **/ -+/* LED0 GPIO Enable, 0: disable, 1: enable*/ -+#define LED0_GPIO_ENABLE_8192FU (BIT21) -+/* LED0 Disabled for analog signal usage, 0:Enable (output mode), 1: disable (input mode) */ -+#define LED0_DISABLE_ANALOGSIGNAL_8192FU (BIT7) -+/* LED0 software value, 0: turn off, 1:turn on */ -+#define LED0_SW_VALUE_8192FU (BIT3) -+ -+/** REG_GPIO_MUXCFG (0x40) **/ -+/* Enable LED[1:0] for RFE CTRL[7:6], 0: BT, 1: Wi-Fi */ -+#define ENABLE_LED0_AND_LED1_CTRL_BY_WIFI_8192FU (BIT3) -+ -+/** REG_SW_GPIO_SHARE_CTRL_0 (0x1038) **/ -+/* LED Output PIN Location, 0: GPIOA_0, 1:GPIOB_4*/ -+#define LED_OUTPUT_PIN_LOCATION_8192FU (BIT16) -+ -+u8 rtl8192fu_CfgLed0Hw(PADAPTER padapter); -+void rtl8192fu_InitSwLeds(PADAPTER padapter); -+void rtl8192fu_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+void rtl8192fs_InitSwLeds(PADAPTER padapter); -+void rtl8192fs_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+void rtl8192fe_InitSwLeds(PADAPTER padapter); -+void rtl8192fe_DeInitSwLeds(PADAPTER padapter); -+#endif -+#endif /*#ifdef CONFIG_RTW_SW_LED*/ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192f_recv.h b/drivers/net/wireless/rtl8821cs/include/rtl8192f_recv.h -new file mode 100644 -index 000000000..9fb931a7f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192f_recv.h -@@ -0,0 +1,107 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192F_RECV_H__ -+#define __RTL8192F_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 -+ #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 (32768) /* 32k */ -+ #endif -+ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ -+ #else -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+#elif defined(CONFIG_PCI_HCI) -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+ #define MAX_RECVBUF_SZ (RX_DMA_BOUNDARY_8192F + 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_8192F - RX_DMA_RESERVED_SIZE_8192F) -+ #endif /* !CONFIG_SDIO_RX_COPY */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+/*-----------------------------------------------------------------*/ -+/* RTL8192F RX BUFFER DESC */ -+/*-----------------------------------------------------------------*/ -+/*DWORD 0*/ -+#define SET_RX_BUFFER_DESC_DATA_LENGTH_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_BUFFER_DESC_LS_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) -+#define SET_RX_BUFFER_DESC_FS_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 1, __Value) -+#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 15, __Value) -+ -+#define GET_RX_BUFFER_DESC_OWN_8192F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+#define GET_RX_BUFFER_DESC_LS_8192F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_BUFFER_DESC_FS_8192F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 1) -+#ifdef USING_RX_TAG -+ #define GET_RX_BUFFER_DESC_RX_TAG_8192F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 13) -+#else -+ #define GET_RX_BUFFER_DESC_TOTAL_LENGTH_8192F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) -+#endif -+ -+/*DWORD 1*/ -+#define SET_RX_BUFFER_PHYSICAL_LOW_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) -+ -+/*DWORD 2*/ -+#ifdef CONFIG_64BIT_DMA -+ #define SET_RX_BUFFER_PHYSICAL_HIGH_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) -+#else -+ #define SET_RX_BUFFER_PHYSICAL_HIGH_8192F(__pRxStatusDesc, __Value) -+#endif -+ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8192fs_init_recv_priv(PADAPTER padapter); -+ void rtl8192fs_free_recv_priv(PADAPTER padapter); -+ s32 rtl8192fs_recv_hdl(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ int rtl8192fu_init_recv_priv(_adapter *padapter); -+ void rtl8192fu_free_recv_priv(_adapter *padapter); -+ void rtl8192fu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8192fe_init_recv_priv(_adapter *padapter); -+ void rtl8192fe_free_recv_priv(_adapter *padapter); -+#endif -+ -+void rtl8192f_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8192F_RECV_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192f_rf.h b/drivers/net/wireless/rtl8821cs/include/rtl8192f_rf.h -new file mode 100644 -index 000000000..9710fb26e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192f_rf.h -@@ -0,0 +1,94 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2012 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192F_RF_H__ -+#define __RTL8192F_RF_H__ -+ -+/*default*/ -+/*#define CONFIG_8192F_DRV_DIS*/ -+/*AP*/ -+#define CONFIG_8192F_TYPE3_DRV_DIS -+#define CONFIG_8192F_TYPE4_DRV_DIS -+/*unused*/ -+#define CONFIG_8192F_TYPE21_DRV_DIS -+#define CONFIG_8192F_TYPE22_DRV_DIS -+#define CONFIG_8192F_TYPE23_DRV_DIS -+#define CONFIG_8192F_TYPE24_DRV_DIS -+#define CONFIG_8192F_TYPE25_DRV_DIS -+#define CONFIG_8192F_TYPE26_DRV_DIS -+#define CONFIG_8192F_TYPE27_DRV_DIS -+#define CONFIG_8192F_TYPE28_DRV_DIS -+#define CONFIG_8192F_TYPE29_DRV_DIS -+#define CONFIG_8192F_TYPE30_DRV_DIS -+#define CONFIG_8192F_TYPE31_DRV_DIS -+ -+ -+#ifdef CONFIG_SDIO_HCI /**/ -+/*usb*/ -+#define CONFIG_8192F_TYPE1_DRV_DIS -+#define CONFIG_8192F_TYPE5_DRV_DIS -+#define CONFIG_8192F_TYPE10_DRV_DIS -+#define CONFIG_8192F_TYPE13_DRV_DIS -+#define CONFIG_8192F_TYPE14_DRV_DIS -+/*pcie*/ -+#define CONFIG_8192F_TYPE0_DRV_DIS -+#define CONFIG_8192F_TYPE6_DRV_DIS -+#define CONFIG_8192F_TYPE7_DRV_DIS -+#define CONFIG_8192F_TYPE8_DRV_DIS -+#define CONFIG_8192F_TYPE9_DRV_DIS -+#define CONFIG_8192F_TYPE12_DRV_DIS -+#define CONFIG_8192F_TYPE15_DRV_DIS -+#define CONFIG_8192F_TYPE16_DRV_DIS -+#define CONFIG_8192F_TYPE17_DRV_DIS -+#define CONFIG_8192F_TYPE18_DRV_DIS -+#define CONFIG_8192F_TYPE19_DRV_DIS -+#define CONFIG_8192F_TYPE20_DRV_DIS -+#endif/*CONFIG_SDIO_HCI*/ -+ -+#ifdef CONFIG_USB_HCI -+/*sdio*/ -+#define CONFIG_8192F_TYPE2_DRV_DIS -+#define CONFIG_8192F_TYPE11_DRV_DIS -+/*pcie*/ -+#define CONFIG_8192F_TYPE0_DRV_DIS -+#define CONFIG_8192F_TYPE6_DRV_DIS -+#define CONFIG_8192F_TYPE7_DRV_DIS -+#define CONFIG_8192F_TYPE8_DRV_DIS -+#define CONFIG_8192F_TYPE9_DRV_DIS -+#define CONFIG_8192F_TYPE12_DRV_DIS -+#define CONFIG_8192F_TYPE15_DRV_DIS -+#define CONFIG_8192F_TYPE16_DRV_DIS -+#define CONFIG_8192F_TYPE17_DRV_DIS -+#define CONFIG_8192F_TYPE18_DRV_DIS -+#define CONFIG_8192F_TYPE19_DRV_DIS -+#define CONFIG_8192F_TYPE20_DRV_DIS -+#endif/*CONFIG_USB_HCI*/ -+ -+#ifdef CONFIG_PCI_HCI -+/*sdio*/ -+#define CONFIG_8192F_TYPE2_DRV_DIS -+#define CONFIG_8192F_TYPE11_DRV_DIS -+/*usb*/ -+#define CONFIG_8192F_TYPE1_DRV_DIS -+#define CONFIG_8192F_TYPE5_DRV_DIS -+#define CONFIG_8192F_TYPE10_DRV_DIS -+#define CONFIG_8192F_TYPE13_DRV_DIS -+#define CONFIG_8192F_TYPE14_DRV_DIS -+#endif/*CONFIG_PCI_HCI*/ -+ -+int PHY_RF6052_Config8192F(PADAPTER pdapter); -+ -+void PHY_RF6052SetBandwidth8192F(PADAPTER Adapter, enum channel_width Bandwidth); -+ -+#endif/* __RTL8192F_RF_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192f_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8192f_spec.h -new file mode 100644 -index 000000000..b34d94483 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192f_spec.h -@@ -0,0 +1,541 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192F_SPEC_H__ -+#define __RTL8192F_SPEC_H__ -+ -+#include -+ -+ -+#define HAL_NAV_UPPER_UNIT_8192F 128 /* micro-second */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0000h ~ 0x00FFh System Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_SYS_ISO_CTRL_8192F 0x0000 /* 2 Byte */ -+#define REG_SYS_FUNC_EN_8192F 0x0002 /* 2 Byte */ -+#define REG_APS_FSMCO_8192F 0x0004 /* 4 Byte */ -+#define REG_SYS_CLKR_8192F 0x0008 /* 2 Byte */ -+#define REG_9346CR_8192F 0x000A /* 2 Byte */ -+#define REG_EE_VPD_8192F 0x000C /* 2 Byte */ -+#define REG_AFE_MISC_8192F 0x0010 /* 1 Byte */ -+#define REG_SPS0_CTRL_8192F 0x0011 /* 7 Byte */ -+#define REG_SPS_OCP_CFG_8192F 0x0018 /* 4 Byte */ -+#define REG_RSV_CTRL_8192F 0x001C /* 3 Byte */ -+#define REG_RF_CTRL_8192F 0x001F /* 1 Byte */ -+#define REG_LPLDO_CTRL_8192F 0x0023 /* 1 Byte */ -+#define REG_AFE_XTAL_CTRL_8192F 0x0024 /* 4 Byte */ -+#define REG_AFE_PLL_CTRL_8192F 0x0028 /* 4 Byte */ -+#define REG_MAC_PLL_CTRL_EXT_8192F 0x002c /* 4 Byte */ -+#define REG_EFUSE_CTRL_8192F 0x0030 -+#define REG_EFUSE_TEST_8192F 0x0034 -+#define REG_PWR_DATA_8192F 0x0038 -+#define REG_CAL_TIMER_8192F 0x003C -+#define REG_ACLK_MON_8192F 0x003E -+#define REG_GPIO_MUXCFG_8192F 0x0040 -+#define REG_GPIO_IO_SEL_8192F 0x0042 -+#define REG_MAC_PINMUX_CFG_8192F 0x0043 -+#define REG_GPIO_PIN_CTRL_8192F 0x0044 -+#define REG_GPIO_INTM_8192F 0x0048 -+#define REG_LEDCFG0_8192F 0x004C -+#define REG_LEDCFG1_8192F 0x004D -+#define REG_LEDCFG2_8192F 0x004E -+#define REG_LEDCFG3_8192F 0x004F -+#define REG_FSIMR_8192F 0x0050 -+#define REG_FSISR_8192F 0x0054 -+#define REG_HSIMR_8192F 0x0058 -+#define REG_HSISR_8192F 0x005c -+#define REG_GPIO_EXT_CTRL 0x0060 -+#define REG_PAD_CTRL1_8192F 0x0064 -+#define REG_MULTI_FUNC_CTRL_8192F 0x0068 -+#define REG_GPIO_STATUS_8192F 0x006C -+#define REG_SDIO_CTRL_8192F 0x0070 -+#define REG_OPT_CTRL_8192F 0x0074 -+#define REG_AFE_CTRL_4_8192F 0x0078 -+#define REG_MCUFWDL_8192F 0x0080 -+#define REG_8051FW_CTRL_8192F 0x0080 -+#define REG_HMEBOX_DBG_0_8192F 0x0088 -+#define REG_HMEBOX_DBG_1_8192F 0x008A -+#define REG_HMEBOX_DBG_2_8192F 0x008C -+#define REG_HMEBOX_DBG_3_8192F 0x008E -+#define REG_WLLPS_CTRL 0x0090 -+#define REG_HIMR0_8192F 0x00B0 -+#define REG_HISR0_8192F 0x00B4 -+#define REG_HIMR1_8192F 0x00B8 -+#define REG_HISR1_8192F 0x00BC -+#define REG_PMC_DBG_CTRL2_8192F 0x00CC -+#define REG_EFUSE_BURN_GNT_8192F 0x00CF -+#define REG_HPON_FSM_8192F 0x00EC -+#define REG_SYS_CFG1_8192F 0x00F0 -+#define REG_SYS_CFG2_8192F 0x00FC -+#define REG_ROM_VERSION 0x00FD -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_CR_8192F 0x0100 -+#define REG_PBP_8192F 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL_8192F 0x0106 -+#define REG_TRXDMA_CTRL_8192F 0x010C -+#define REG_TRXFF_BNDY_8192F 0x0114 -+#define REG_TRXFF_STATUS_8192F 0x0118 -+#define REG_RXFF_PTR_8192F 0x011C -+#define REG_CPWM_8192F 0x012C -+#define REG_FWIMR_8192F 0x0130 -+#define REG_FWISR_8192F 0x0134 -+#define REG_FTIMR_8192F 0x0138 -+#define REG_PKTBUF_DBG_CTRL_8192F 0x0140 -+#define REG_RXPKTBUF_CTRL_8192F 0x0142 -+#define REG_PKTBUF_DBG_DATA_L_8192F 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8192F 0x0148 -+ -+#define REG_TC0_CTRL_8192F 0x0150 -+#define REG_TC1_CTRL_8192F 0x0154 -+#define REG_TC2_CTRL_8192F 0x0158 -+#define REG_TC3_CTRL_8192F 0x015C -+#define REG_TC4_CTRL_8192F 0x0160 -+#define REG_TCUNIT_BASE_8192F 0x0164 -+#define REG_RSVD3_8192F 0x0168 -+#define REG_C2HEVT_CMD_ID_8192F 0x01A0 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_8192F 0x01AE -+#define REG_C2HEVT_CLEAR_8192F 0x01AF -+#define REG_TXBUF_WKCAM_OFFSET 0x01B1 /* RTL8192F */ -+#define REG_MCUTST_1_8192F 0x01C0 -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_FMETHR_8192F 0x01C8 -+#define REG_HMETFR_8192F 0x01CC -+#define REG_HMEBOX_0_8192F 0x01D0 -+#define REG_HMEBOX_1_8192F 0x01D4 -+#define REG_HMEBOX_2_8192F 0x01D8 -+#define REG_HMEBOX_3_8192F 0x01DC -+#define REG_LLT_INIT_8192F 0x01E0 -+#define REG_HMEBOX_EXT0_8192F 0x01F0 -+#define REG_HMEBOX_EXT1_8192F 0x01F4 -+#define REG_HMEBOX_EXT2_8192F 0x01F8 -+#define REG_HMEBOX_EXT3_8192F 0x01FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RQPN_8192F 0x0200 -+#define REG_FIFOPAGE_8192F 0x0204 -+#define REG_DWBCN0_CTRL_8192F REG_TDECTRL -+#define REG_TXDMA_OFFSET_CHK_8192F 0x020C -+#define REG_TXDMA_STATUS_8192F 0x0210 -+#define REG_RQPN_NPQ_8192F 0x0214 -+#define REG_DWBCN1_CTRL_8192F 0x0228 -+#define REG_RQPN_EXQ1_EXQ2 0x0230 -+#define REG_TQPNT3_V1_8192F 0x0234 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RXDMA_AGG_PG_TH_8192F 0x0280 -+#define REG_FW_UPD_RDPTR_8192F 0x0284 /* FW shall update this register before FW write RXPKT_RELEASE_POLL to 1 */ -+#define REG_RXDMA_CONTROL_8192F 0x0286 /* Control the RX DMA. */ -+#define REG_RXDMA_STATUS_8192F 0x0288 -+#define REG_RXDMA_MODE_CTRL_8192F 0x0290 -+#define REG_EARLY_MODE_CONTROL_8192F 0x02BC -+#define REG_RSVD5_8192F 0x02F0 -+#define REG_RSVD6_8192F 0x02F4 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0300h ~ 0x03FFh PCIe -+ * -+ * ----------------------------------------------------- */ -+#define REG_PCIE_CTRL_REG_8192F 0x0300 -+#define REG_INT_MIG_8192F 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_TXBD_DESA_8192F 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_MGQ_TXBD_DESA_8192F 0x0310 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_TXBD_DESA_8192F 0x0318 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_TXBD_DESA_8192F 0x0320 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_TXBD_DESA_8192F 0x0328 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_TXBD_DESA_8192F 0x0330 /* TX BK Queue Descriptor Address */ -+#define REG_RXQ_RXBD_DESA_8192F 0x0338 /* RX Queue Descriptor Address */ -+#define REG_HI0Q_TXBD_DESA_8192F 0x0340 -+#define REG_HI1Q_TXBD_DESA_8192F 0x0348 -+#define REG_HI2Q_TXBD_DESA_8192F 0x0350 -+#define REG_HI3Q_TXBD_DESA_8192F 0x0358 -+#define REG_HI4Q_TXBD_DESA_8192F 0x0360 -+#define REG_HI5Q_TXBD_DESA_8192F 0x0368 -+#define REG_HI6Q_TXBD_DESA_8192F 0x0370 -+#define REG_HI7Q_TXBD_DESA_8192F 0x0378 -+#define REG_MGQ_TXBD_NUM_8192F 0x0380 -+#define REG_RX_RXBD_NUM_8192F 0x0382 -+#define REG_VOQ_TXBD_NUM_8192F 0x0384 -+#define REG_VIQ_TXBD_NUM_8192F 0x0386 -+#define REG_BEQ_TXBD_NUM_8192F 0x0388 -+#define REG_BKQ_TXBD_NUM_8192F 0x038A -+#define REG_HI0Q_TXBD_NUM_8192F 0x038C -+#define REG_HI1Q_TXBD_NUM_8192F 0x038E -+#define REG_HI2Q_TXBD_NUM_8192F 0x0390 -+#define REG_HI3Q_TXBD_NUM_8192F 0x0392 -+#define REG_HI4Q_TXBD_NUM_8192F 0x0394 -+#define REG_HI5Q_TXBD_NUM_8192F 0x0396 -+#define REG_HI6Q_TXBD_NUM_8192F 0x0398 -+#define REG_HI7Q_TXBD_NUM_8192F 0x039A -+#define REG_TSFTIMER_HCI_8192F 0x039C -+#define REG_BD_RW_PTR_CLR_8192F 0x039C -+ -+/* Read Write Point */ -+#define REG_VOQ_TXBD_IDX_8192F 0x03A0 -+#define REG_VIQ_TXBD_IDX_8192F 0x03A4 -+#define REG_BEQ_TXBD_IDX_8192F 0x03A8 -+#define REG_BKQ_TXBD_IDX_8192F 0x03AC -+#define REG_MGQ_TXBD_IDX_8192F 0x03B0 -+#define REG_RXQ_TXBD_IDX_8192F 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8192F 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8192F 0x03BC -+#define REG_HI2Q_TXBD_IDX_8192F 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8192F 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8192F 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8192F 0x03CC -+#define REG_HI6Q_TXBD_IDX_8192F 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8192F 0x03D4 -+#define REG_DBI_WDATA_V1_8192F 0x03E8 -+#define REG_DBI_RDATA_V1_8192F 0x03EC -+#define REG_DBI_FLAG_V1_8192F 0x03F0 -+#define REG_MDIO_V1_8192F 0x03F4 -+#define REG_HCI_MIX_CFG_8192F 0x03FC -+#define REG_PCIE_HCPWM_8192FE 0x03D8 -+#define REG_PCIE_HRPWM_8192FE 0x03DC -+#define REG_PCIE_MIX_CFG_8192F 0x03F8 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_QUEUELIST_INFO0_8192F 0x0400 -+#define REG_QUEUELIST_INFO1_8192F 0x0404 -+#define REG_QUEUELIST_INFO2_8192F 0x0414 -+#define REG_TXPKT_EMPTY_8192F 0x0418 -+ -+#define REG_FWHW_TXQ_CTRL_8192F 0x0420 -+#define REG_HWSEQ_CTRL_8192F 0x0423 -+#define REG_TXPKTBUF_BCNQ_BDNY_8192F 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8192F 0x0425 -+#define REG_LIFECTRL_CTRL_8192F 0x0426 -+#define REG_MULTI_BCNQ_OFFSET_8192F 0x0427 -+#define REG_SPEC_SIFS_8192F 0x0428 -+#define REG_RL_8192F 0x042A -+#define REG_TXBF_CTRL_8192F 0x042C -+#define REG_DARFRC_8192F 0x0430 -+#define REG_RARFRC_8192F 0x0438 -+#define REG_RRSR_8192F 0x0440 -+#define REG_ARFR0_8192F 0x0444 -+#define REG_ARFR1_8192F 0x044C -+#define REG_CCK_CHECK_8192F 0x0454 -+#define REG_AMPDU_MAX_TIME_8192F 0x0456 -+#define REG_TXPKTBUF_BCNQ_BDNY1_8192F 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8192F 0x0458 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8192F 0x045D -+#define REG_NDPA_OPT_CTRL_8192F 0x045F -+#define REG_FAST_EDCA_CTRL_8192F 0x0460 -+#define REG_RD_RESP_PKT_TH_8192F 0x0463 -+#define REG_DATA_SC_8192F 0x0483 -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_POWER_STAGE1_8192F 0x04B4 -+#define REG_POWER_STAGE2_8192F 0x04B8 -+#define REG_AMPDU_BURST_MODE_8192F 0x04BC -+#define REG_PKT_VO_VI_LIFE_TIME_8192F 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME_8192F 0x04C2 -+#define REG_STBC_SETTING_8192F 0x04C4 -+#define REG_HT_SINGLE_AMPDU_8192F 0x04C7 -+#define REG_PROT_MODE_CTRL_8192F 0x04C8 -+#define REG_MAX_AGGR_NUM_8192F 0x04CA -+#define REG_RTS_MAX_AGGR_NUM_8192F 0x04CB -+#define REG_BAR_MODE_CTRL_8192F 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8192F 0x04CF -+#define REG_MACID_PKT_DROP0_8192F 0x04D0 -+#define REG_MACID_PKT_SLEEP_8192F 0x04D4 -+#define REG_PRECNT_CTRL_8192F 0x04E5 -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_EDCA_VO_PARAM_8192F 0x0500 -+#define REG_EDCA_VI_PARAM_8192F 0x0504 -+#define REG_EDCA_BE_PARAM_8192F 0x0508 -+#define REG_EDCA_BK_PARAM_8192F 0x050C -+#define REG_BCNTCFG_8192F 0x0510 -+#define REG_PIFS_8192F 0x0512 -+#define REG_RDG_PIFS_8192F 0x0513 -+#define REG_SIFS_CTX_8192F 0x0514 -+#define REG_SIFS_TRX_8192F 0x0516 -+#define REG_AGGR_BREAK_TIME_8192F 0x051A -+#define REG_SLOT_8192F 0x051B -+#define REG_TX_PTCL_CTRL_8192F 0x0520 -+#define REG_TXPAUSE_8192F 0x0522 -+#define REG_DIS_TXREQ_CLR_8192F 0x0523 -+#define REG_RD_CTRL_8192F 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_8192F 0x0540 -+#define REG_RD_NAV_NXT_8192F 0x0544 -+#define REG_NAV_PROT_LEN_8192F 0x0546 -+#define REG_BCN_CTRL_8192F 0x0550 -+#define REG_BCN_CTRL_1_8192F 0x0551 -+#define REG_MBID_NUM_8192F 0x0552 -+#define REG_DUAL_TSF_RST_8192F 0x0553 -+#define REG_BCN_INTERVAL_8192F 0x0554 -+#define REG_DRVERLYINT_8192F 0x0558 -+#define REG_BCNDMATIM_8192F 0x0559 -+#define REG_ATIMWND_8192F 0x055A -+#define REG_USTIME_TSF_8192F 0x055C -+#define REG_BCN_MAX_ERR_8192F 0x055D -+#define REG_RXTSF_OFFSET_CCK_8192F 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8192F 0x055F -+#define REG_TSFTR_8192F 0x0560 -+#define REG_CTWND_8192F 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8192F 0x0577 -+#define REG_PSTIMER_8192F 0x0580 -+#define REG_TIMER0_8192F 0x0584 -+#define REG_TIMER1_8192F 0x0588 -+#define REG_ACMHWCTRL_8192F 0x05C0 -+#define REG_SCH_TXCMD_8192F 0x05F8 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_MAC_CR_8192F 0x0600 -+#define REG_TCR_8192F 0x0604 -+#define REG_RCR_8192F 0x0608 -+#define REG_RX_PKT_LIMIT_8192F 0x060C -+#define REG_RX_DLK_TIME_8192F 0x060D -+#define REG_RX_DRVINFO_SZ_8192F 0x060F -+ -+#define REG_MACID_8192F 0x0610 -+#define REG_BSSID_8192F 0x0618 -+#define REG_MAR_8192F 0x0620 -+#define REG_MBIDCAMCFG_8192F 0x0628 -+ -+ -+#define REG_USTIME_EDCA_8192F 0x0638 -+#define REG_MAC_SPEC_SIFS_8192F 0x063A -+#define REG_RESP_SIFP_CCK_8192F 0x063C -+#define REG_RESP_SIFS_OFDM_8192F 0x063E -+#define REG_ACKTO_8192F 0x0640 -+#define REG_CTS2TO_8192F 0x0641 -+#define REG_EIFS_8192F 0x0642 -+ -+#define REG_NAV_UPPER_8192F 0x0652 /* unit of 128*/ -+#define REG_TRXPTCL_CTL_8192F 0x0668 -+ -+/* Security*/ -+#define REG_CAMCMD_8192F 0x0670 -+#define REG_CAMWRITE_8192F 0x0674 -+#define REG_CAMREAD_8192F 0x0678 -+#define REG_CAMDBG_8192F 0x067C -+#define REG_SECCFG_8192F 0x0680 -+ -+/* Power */ -+#define REG_WOW_CTRL_8192F 0x0690 -+#define REG_PS_RX_INFO_8192F 0x0692 -+#define REG_UAPSD_TID_8192F 0x0693 -+#define REG_WKFMCAM_CMD_8192F 0x0698 -+#define REG_WKFMCAM_NUM_8192F 0x0698 -+#define REG_WKFMCAM_RWD_8192F 0x069C -+#define REG_RXFLTMAP0_8192F 0x06A0 -+#define REG_RXFLTMAP1_8192F 0x06A2 -+#define REG_RXFLTMAP2_8192F 0x06A4 -+#define REG_BCN_PSR_RPT_8192F 0x06A8 -+#define REG_BT_COEX_TABLE_8192F 0x06C0 -+#define REG_BFMER0_INFO_8192F 0x06E4 -+#define REG_BFMER1_INFO_8192F 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8192F 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8192F 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8192F 0x06FC -+ -+/* Hardware Port 2 */ -+#define REG_MACID1_8192F 0x0700 -+#define REG_BSSID1_8192F 0x0708 -+#define REG_BFMEE_SEL_8192F 0x0714 -+#define REG_SND_PTCL_CTRL_8192F 0x0718 -+ -+/* LTR */ -+#define REG_LTR_CTRL_BASIC_8192F 0x07A4 -+#define REG_LTR_IDLE_LATENCY_V1_8192F 0x0798 -+#define REG_LTR_ACTIVE_LATENCY_V1_8192F 0x079C -+ -+/* GPIO Control */ -+#define REG_SW_GPIO_SHARE_CTRL_8192F_0 0x1038 -+#define REG_SW_GPIO_SHARE_CTRL_8192F_1 0x103c -+#define REG_SW_GPIO_A_OUT_8192F 0x1040 -+#define REG_SW_GPIO_A_OEN_8192F 0x1044 -+ -+/* ************************************************************ -+ * SDIO Bus Specification -+ * ************************************************************ */ -+ -+/* ----------------------------------------------------- -+ * SDIO CMD Address Mapping -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * I/O bus domain (Host) -+ * ----------------------------------------------------- */ -+/*SDIO Host Interrupt Mask Register */ -+#define SDIO_HIMR_CRCERR_MSK BIT(31) -+/* SDIO Host Interrupt Service Routine */ -+#define SDIO_HISR_HEISR_IND_INT BIT(28) -+#define SDIO_HISR_HSISR2_IND_INT BIT(29) -+#define SDIO_HISR_HSISR3_IND_INT BIT(30) -+#define SDIO_HISR_SDIO_CRCERR BIT(31) -+/* ----------------------------------------------------- -+ * SDIO register -+ * ----------------------------------------------------- */ -+#define SDIO_REG_HCPWM1_8192F 0x038/* HCI Current Power Mode 1 */ -+#define SDIO_REG_FREE_TXPG1_8192F 0x0020 /* Free Tx Buffer Page1*/ -+#define SDIO_REG_FREE_TXPG2_8192F 0x0024 /* Free Tx Buffer Page1*/ -+#define SDIO_REG_FREE_TXPG3_8192F 0x0028 -+#define SDIO_REG_AC_OQT_FREEPG_8192F 0x002A -+#define SDIO_REG_NOAC_OQT_FREEPG_8192F 0x002B -+/* **************************************************************************** -+ * 8192F 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 -+ -+#ifdef CONFIG_AMPDU_PRETX_CD -+/*#define BIT_ERRORHDL_INT BIT(2)*/ -+/*#define BIT_MACTX_ERR_3 BIT(4)*/ -+#define BIT_PRE_TX_CMD_8192F BIT(6) -+#define BIT_EN_PRECNT_8192F BIT(11) -+#endif -+/* SDIO Host Interrupt Service Routine */ -+#define SDIO_HISR_HEISR_IND_INT BIT(28) -+#define SDIO_HISR_HSISR2_IND_INT BIT(29) -+#define SDIO_HISR_HSISR3_IND_INT BIT(30) -+#define SDIO_HISR_SDIO_CRCERR BIT(31) -+ -+/* PCIE Host Interrupt Mask Register (HIMR) */ -+#ifdef CONFIG_PCI_HCI -+/* ---------------------------------------------------------------------------- -+ * * 8192F IMR/ISR bits (offset 0xB0, 8bits) -+ * * ---------------------------------------------------------------------------- */ -+ -+#define IMR_DISABLED_8192F 0 -+/* IMR DW0(0x00B0-00B3) Bit 0-31 */ -+#define IMR_TIMER2_8192F BIT(31) /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8192F BIT(30) /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8192F BIT(29) /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8192F BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8192F BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8192F BIT(26) /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8192F BIT(25) /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8192F BIT(24) /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8192F BIT(20) /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8192F BIT(16) /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8192F BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8192F BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8192F BIT(12) /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8192F BIT(10) /* CPU to Host Command INT status, Write 1 clear */ -+#define IMR_CPWM2_8192F BIT(9) /* CPU power mode exchange INT status, Write 1 clear */ -+#define IMR_CPWM_8192F BIT(8) /* CPU power mode exchange INT status, Write 1 clear */ -+#define IMR_HIGHDOK_8192F BIT(7) /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8192F BIT(6) /* Management Queue DMA OK */ -+#define IMR_BKDOK_8192F BIT(5) /* AC_BK DMA OK */ -+#define IMR_BEDOK_8192F BIT(4) /* AC_BE DMA OK */ -+#define IMR_VIDOK_8192F BIT(3) /* AC_VI DMA OK */ -+#define IMR_VODOK_8192F BIT(2) /* AC_VO DMA OK */ -+#define IMR_RDU_8192F BIT(1) /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8192F BIT(0) /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_MCUERR_8192F BIT(28) -+#define IMR_BCNDMAINT7_8192F BIT(27) /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8192F BIT(26) /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8192F BIT(25) /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8192F BIT(24) /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8192F BIT(23) /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8192F BIT(22) /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8192F BIT(21) /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8192F BIT(20) /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_8192F BIT(19) /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_8192F BIT(18) /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_8192F BIT(17) /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_8192F BIT(16) /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_8192F BIT(15) /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_8192F BIT(14) /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_8192F BIT(13) /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8192F BIT(11) /* Tx Error Flag Interrupt status, write 1 clear. */ -+#define IMR_RXERR_8192F BIT(10) /* Rx Error Flag INT status, Write 1 clear */ -+#define IMR_TXFOVW_8192F BIT(9) /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8192F BIT(8) /* Receive FIFO Overflow */ -+ -+/* #define IMR_RX_MASK (IMR_ROK_8192F|IMR_RDU_8192F|IMR_RXFOVW_8192F) */ -+#define IMR_TX_MASK (IMR_VODOK_8192F | IMR_VIDOK_8192F | IMR_BEDOK_8192F | IMR_BKDOK_8192F | IMR_MGNTDOK_8192F | IMR_HIGHDOK_8192F) -+#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8192F | IMR_TXBCN0OK_8192F | IMR_TXBCN0ERR_8192F | IMR_BCNDERR0_8192F) -+#define RT_AC_INT_MASKS (IMR_VIDOK_8192F | IMR_VODOK_8192F | IMR_BEDOK_8192F | IMR_BKDOK_8192F) -+#endif /* CONFIG_PCI_HCI */ -+ -+/* 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) -+ -+#define _TXDMA_HIQ_MAP_8192F(x) (((x) & 0x7) << 19) -+#define _TXDMA_MGQ_MAP_8192F(x) (((x) & 0x7) << 16) -+#define _TXDMA_BKQ_MAP_8192F(x) (((x) & 0x7) << 13) -+#define _TXDMA_BEQ_MAP_8192F(x) (((x) & 0x7) << 10) -+#define _TXDMA_VIQ_MAP_8192F(x) (((x) & 0x7) << 7) -+#define _TXDMA_VOQ_MAP_8192F(x) (((x) & 0x7) << 4) -+ -+/*mac queue info*/ -+#define QUEUE_TOTAL_NUM 20/*reg414h : 0~f ac queue 0x10~0x13MGQ HIQ BCNQ CMDQ*/ -+#define QUEUE_ACQ_NUM 16 -+#define QUEUE_INDEX_MGQ 0x10 -+#define QUEUE_INDEX_HIQ 0x11 -+#define QUEUE_INDEX_BCNQ 0x12 -+#define QUEUE_INDEX_CMDQ 0x13 -+#endif /* __RTL8192F_SPEC_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192f_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtl8192f_sreset.h -new file mode 100644 -index 000000000..cf881c431 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192f_sreset.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8192F_SRESET_H_ -+#define _RTL8192F_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ extern void rtl8192f_sreset_xmit_status_check(_adapter *padapter); -+ extern void rtl8192f_sreset_linked_status_check(_adapter *padapter); -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+#endif /* _RTL8192F_SRESET_H_ */ -\ No newline at end of file -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8192f_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8192f_xmit.h -new file mode 100644 -index 000000000..e0b84c2aa ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8192f_xmit.h -@@ -0,0 +1,538 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8192F_XMIT_H__ -+#define __RTL8192F_XMIT_H__ -+ -+ -+#define MAX_TID (15) -+ -+ -+#ifndef __INC_HAL8192FDESC_H -+#define __INC_HAL8192FDESC_H -+ -+#define RX_STATUS_DESC_SIZE_8192F 24 -+#define RX_DRV_INFO_SIZE_UNIT_8192F 8 -+ -+ -+/* DWORD 0 */ -+#define SET_RX_STATUS_DESC_PKT_LEN_8192F(__pRxStatusDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8192F(__pRxStatusDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8192F(__pRxStatusDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_EOR_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+ -+/* DWORD 1 */ -+#define GET_RX_STATUS_DESC_MACID_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) -+ -+/* DWORD 2 */ -+#define GET_RX_STATUS_DESC_SEQ_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) -+#define GET_RX_STATUS_DESC_FCS_OK_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 31, 1) -+ -+/* DWORD 3 */ -+#define GET_RX_STATUS_DESC_RX_RATE_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) -+#endif -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) -+ -+/* DWORD 6 */ -+#define GET_RX_STATUS_DESC_MATCH_ID_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 7) -+ -+/* DWORD 5 */ -+#define GET_RX_STATUS_DESC_TSFL_8192F(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8192F(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+ -+ -+/* Dword 0, rsvd: bit26, bit28 */ -+#define GET_TX_DESC_OWN_8192F(__pTxDesc)\ -+ LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+#define SET_TX_DESC_PKT_SIZE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_AMSDU_PAD_EN_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+ -+/* Dword 1 */ -+#define SET_TX_DESC_MACID_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+#define SET_TX_DESC_MORE_DATA_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) -+ -+/* Dword 2 ADD HW_DIG*/ -+#define SET_TX_DESC_PAID_92F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_NULL0_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) -+#define SET_TX_DESC_NULL1_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) -+#define SET_TX_DESC_BK_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_CCX_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_HW_DIG_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 7, __Value) -+ -+/* Dword 3 */ -+#define SET_TX_DESC_HWSEQ_SEL_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_CHK_EN_92F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+/* Dword 4 */ -+#define SET_TX_DESC_TX_RATE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_TX_TRY_RATE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+#define SET_TX_DESC_PCTS_EN_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) -+#define SET_TX_DESC_PCTS_MASK_IDX_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) -+ -+/* Dword 5 */ -+#define SET_TX_DESC_DATA_SC_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_RTS_STBC_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+#define SET_TX_DESC_PORT_ID_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 21, 1, __Value) -+#define SET_TX_DESC_DROP_ID_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 22, 2, __Value) -+#define SET_TX_DESC_PATH_A_EN_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 1, __Value) -+#define SET_TX_DESC_PATH_B_EN_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 25, 1, __Value) -+#define SET_TX_DESC_TXPWR_OF_SET_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) -+ -+/* Dword 6 */ -+#define SET_TX_DESC_SW_DEFINE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_RF_SEL_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+ -+/* Dword 7 */ -+#ifdef CONFIG_PCI_HCI -+#define SET_TX_DESC_TX_BUFFER_SIZE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+ -+#ifdef CONFIG_USB_HCI -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+#define SET_TX_DESC_TX_TIMESTAMP_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 6, 18, __Value) -+#endif -+ -+#define SET_TX_DESC_USB_TXAGG_NUM_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+ -+/* Dword 8 */ -+#define SET_TX_DESC_RTS_RC_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) -+#define SET_TX_DESC_BAR_RC_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) -+#define SET_TX_DESC_DATA_RC_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) -+#define SET_TX_DESC_HWSEQ_EN_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+#define SET_TX_DESC_NEXTHEADPAGE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) -+#define SET_TX_DESC_TAILPAGE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) -+ -+/* Dword 9 */ -+#define SET_TX_DESC_PADDING_LEN_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) -+#define SET_TX_DESC_SEQ_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+#define SET_TX_DESC_FINAL_DATA_RATE_8192F(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 8, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+ -+/*-----------------------------------------------------------------*/ -+/* RTL8192F 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_8192F(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 14, __Valeu) -+#define SET_TX_BUFF_DESC_PSB_8192F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) -+#define SET_TX_BUFF_DESC_OWN_8192F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+/* Dword 1 1 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_0_8192F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) -+#define GET_TX_BUFF_DESC_ADDR_LOW_0_8192F(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) -+/* Dword 2 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_0_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 0, __Value) -+#ifdef CONFIG_64BIT_DMA -+ #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8192F(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 0, 32) -+#else -+ #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8192F(__pTxDesc) 0 -+#endif -+/* Dword 3 NA */ -+/* RESERVED 0 */ -+/* Dword 4 2 */ -+#define SET_TX_BUFF_DESC_LEN_1_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 1, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_1_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 1, __Value) -+/* Dword 5 3 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_1_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 1, __Value) -+/* Dword 6 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_1_8192F(__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_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 2, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_2_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 2, __Value) -+/* Dword 9 5 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_2_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 2, __Value) -+/* Dword 10 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_2_8192F(__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_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 3, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_3_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 3, __Value) -+/* Dword 13 7 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_3_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 3, __Value) -+/* Dword 14 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_3_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 3, __Value) -+/* Dword 15 NA */ -+/*RESERVED 0 */ -+ -+ -+#endif -+/* ----------------------------------------------------------- -+ * -+ * Rate -+ * -+ * ----------------------------------------------------------- -+ * CCK Rates, TxHT = 0 */ -+#define DESC8192F_RATE1M 0x00 -+#define DESC8192F_RATE2M 0x01 -+#define DESC8192F_RATE5_5M 0x02 -+#define DESC8192F_RATE11M 0x03 -+ -+/* OFDM Rates, TxHT = 0 */ -+#define DESC8192F_RATE6M 0x04 -+#define DESC8192F_RATE9M 0x05 -+#define DESC8192F_RATE12M 0x06 -+#define DESC8192F_RATE18M 0x07 -+#define DESC8192F_RATE24M 0x08 -+#define DESC8192F_RATE36M 0x09 -+#define DESC8192F_RATE48M 0x0a -+#define DESC8192F_RATE54M 0x0b -+ -+/* MCS Rates, TxHT = 1 */ -+#define DESC8192F_RATEMCS0 0x0c -+#define DESC8192F_RATEMCS1 0x0d -+#define DESC8192F_RATEMCS2 0x0e -+#define DESC8192F_RATEMCS3 0x0f -+#define DESC8192F_RATEMCS4 0x10 -+#define DESC8192F_RATEMCS5 0x11 -+#define DESC8192F_RATEMCS6 0x12 -+#define DESC8192F_RATEMCS7 0x13 -+#define DESC8192F_RATEMCS8 0x14 -+#define DESC8192F_RATEMCS9 0x15 -+#define DESC8192F_RATEMCS10 0x16 -+#define DESC8192F_RATEMCS11 0x17 -+#define DESC8192F_RATEMCS12 0x18 -+#define DESC8192F_RATEMCS13 0x19 -+#define DESC8192F_RATEMCS14 0x1a -+#define DESC8192F_RATEMCS15 0x1b -+#define DESC8192F_RATEVHTSS1MCS0 0x2c -+#define DESC8192F_RATEVHTSS1MCS1 0x2d -+#define DESC8192F_RATEVHTSS1MCS2 0x2e -+#define DESC8192F_RATEVHTSS1MCS3 0x2f -+#define DESC8192F_RATEVHTSS1MCS4 0x30 -+#define DESC8192F_RATEVHTSS1MCS5 0x31 -+#define DESC8192F_RATEVHTSS1MCS6 0x32 -+#define DESC8192F_RATEVHTSS1MCS7 0x33 -+#define DESC8192F_RATEVHTSS1MCS8 0x34 -+#define DESC8192F_RATEVHTSS1MCS9 0x35 -+#define DESC8192F_RATEVHTSS2MCS0 0x36 -+#define DESC8192F_RATEVHTSS2MCS1 0x37 -+#define DESC8192F_RATEVHTSS2MCS2 0x38 -+#define DESC8192F_RATEVHTSS2MCS3 0x39 -+#define DESC8192F_RATEVHTSS2MCS4 0x3a -+#define DESC8192F_RATEVHTSS2MCS5 0x3b -+#define DESC8192F_RATEVHTSS2MCS6 0x3c -+#define DESC8192F_RATEVHTSS2MCS7 0x3d -+#define DESC8192F_RATEVHTSS2MCS8 0x3e -+#define DESC8192F_RATEVHTSS2MCS9 0x3f -+ -+ -+#define RX_HAL_IS_CCK_RATE_8192F(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_RATE_8192F(pDesc) == DESC8192F_RATE1M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8192F(pDesc) == DESC8192F_RATE2M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8192F(pDesc) == DESC8192F_RATE5_5M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8192F(pDesc) == DESC8192F_RATE11M) -+ -+#ifdef CONFIG_TRX_BD_ARCH -+ struct tx_desc; -+#endif -+ -+void rtl8192f_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+void rtl8192f_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); -+void rtl8192f_fill_txdesc_sectype(struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); -+void rtl8192f_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); -+void rtl8192f_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); -+void rtl8192f_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+ -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8192fs_init_xmit_priv(PADAPTER padapter); -+ void rtl8192fs_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8192fs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8192fs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8192fs_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ s32 rtl8192fs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8192fs_xmit_buf_handler(PADAPTER padapter); -+ thread_return rtl8192fs_xmit_thread(thread_context context); -+ #define hal_xmit_handler rtl8192fs_xmit_buf_handler -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ s32 rtl8192fu_init_xmit_priv(PADAPTER padapter); -+ void rtl8192fu_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8192fu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8192fu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8192fu_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ s32 rtl8192fu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8192fu_xmit_buf_handler(PADAPTER padapter); -+ #define hal_xmit_handler rtl8192fu_xmit_buf_handler -+ void rtl8192fu_xmit_tasklet(unsigned long priv); -+ s32 rtl8192fu_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 rtl8192fe_init_xmit_priv(PADAPTER padapter); -+ void rtl8192fe_free_xmit_priv(PADAPTER padapter); -+ struct xmit_buf *rtl8192fe_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+ void rtl8192fe_xmitframe_resume(_adapter *padapter); -+ s32 rtl8192fe_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8192fe_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8192fe_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ s32 rtl8192fe_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8192fe_xmit_tasklet(void *priv); -+#endif -+ -+u8 BWMapping_8192F(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_8192F(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8703b_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtl8703b_cmd.h -new file mode 100644 -index 000000000..522a3bcb7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8703b_cmd.h -@@ -0,0 +1,199 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 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((u8 *)(__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_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_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 */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+ void rtl8703b_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+void rtl8703b_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+ -+s32 FillH2CCmd8703B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8703B(_adapter *padapter, bool wowlan); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8703b_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8703b_dm.h -new file mode 100644 -index 000000000..912c7da07 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8703b_dm.h -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8703b_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8703b_hal.h -new file mode 100644 -index 000000000..4a83abf45 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8703b_hal.h -@@ -0,0 +1,266 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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_CAM_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:MAX_BEACON_LEN/PAGE_SIZE_TX_8703B -+ * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ -+ -+#define BCNQ_PAGE_NUM_8703B (MAX_BEACON_LEN/PAGE_SIZE_TX_8703B + 6) /*0x08*/ -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt: 1 PNO: 6 -+ * NS offload: 2NDP info: 1 -+ */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8703B 0x0b -+#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 - 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); -+u8 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(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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8703b_led.h b/drivers/net/wireless/rtl8821cs/include/rtl8703b_led.h -new file mode 100644 -index 000000000..99e590d31 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8703b_led.h -@@ -0,0 +1,44 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8703B_LED_H__ -+#define __RTL8703B_LED_H__ -+ -+#include -+#include -+#include -+ -+#ifdef CONFIG_RTW_SW_LED -+/* ******************************************************************************** -+ * 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/*CONFIG_RTW_SW_LED*/ -+#endif /*__RTL8703B_LED_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8703b_recv.h b/drivers/net/wireless/rtl8821cs/include/rtl8703b_recv.h -new file mode 100644 -index 000000000..09672d238 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8703b_recv.h -@@ -0,0 +1,82 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 -+ #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 /* !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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8703b_rf.h b/drivers/net/wireless/rtl8821cs/include/rtl8703b_rf.h -new file mode 100644 -index 000000000..4148276bf ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8703b_rf.h -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8703B_RF_H__ -+#define __RTL8703B_RF_H__ -+ -+int PHY_RF6052_Config8703B(PADAPTER Adapter); -+ -+void -+PHY_RF6052SetBandwidth8703B( -+ PADAPTER Adapter, -+ enum channel_width Bandwidth); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8703b_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8703b_spec.h -new file mode 100644 -index 000000000..633b23b1b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8703b_spec.h -@@ -0,0 +1,464 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 BIT(5) -+ -+#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 BIT(31) /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8703B BIT(30) /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8703B BIT(29) /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8703B BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8703B BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8703B BIT(26) /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8703B BIT(25) /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8703B BIT(24) /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8703B BIT(20) /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8703B BIT(16) /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8703B BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8703B BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8703B BIT(12) /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8703B BIT(10) /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8703B BIT(9) /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8703B BIT(8) /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8703B BIT(7) /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8703B BIT(6) /* Management Queue DMA OK */ -+#define IMR_BKDOK_8703B BIT(5) /* AC_BK DMA OK */ -+#define IMR_BEDOK_8703B BIT(4) /* AC_BE DMA OK */ -+#define IMR_VIDOK_8703B BIT(3) /* AC_VI DMA OK */ -+#define IMR_VODOK_8703B BIT(2) /* AC_VO DMA OK */ -+#define IMR_RDU_8703B BIT(1) /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8703B BIT(0) /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8703B BIT(27) /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8703B BIT(26) /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8703B BIT(25) /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8703B BIT(24) /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8703B BIT(23) /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8703B BIT(22) /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8703B BIT(21) /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8703B BIT(20) /* Beacon Queue DMA OK Interrupt 7 */ -+#define IMR_BCNDOK6_8703B BIT(19) /* Beacon Queue DMA OK Interrupt 6 */ -+#define IMR_BCNDOK5_8703B BIT(18) /* Beacon Queue DMA OK Interrupt 5 */ -+#define IMR_BCNDOK4_8703B BIT(17) /* Beacon Queue DMA OK Interrupt 4 */ -+#define IMR_BCNDOK3_8703B BIT(16) /* Beacon Queue DMA OK Interrupt 3 */ -+#define IMR_BCNDOK2_8703B BIT(15) /* Beacon Queue DMA OK Interrupt 2 */ -+#define IMR_BCNDOK1_8703B BIT(14) /* Beacon Queue DMA OK Interrupt 1 */ -+#define IMR_ATIMEND_E_8703B BIT(13) /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8703B BIT(11) /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8703B BIT(10) /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8703B BIT(9) /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8703B BIT(8) /* 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 -+ -+#endif /* __RTL8703B_SPEC_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8703b_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtl8703b_sreset.h -new file mode 100644 -index 000000000..5fe53cf41 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8703b_sreset.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8703b_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8703b_xmit.h -new file mode 100644 -index 000000000..9ec00a66a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8703b_xmit.h -@@ -0,0 +1,342 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 */ -+ #ifdef CONFIG_PCI_HCI -+ #define SET_TX_DESC_TX_BUFFER_SIZE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+ #endif /*CONFIG_PCI_HCI*/ -+ #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) -+ #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) -+ #ifdef CONFIG_SDIO_HCI -+ #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); -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); -+ -+#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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8703bs_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8703bu_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8703be_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8710b_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtl8710b_cmd.h -new file mode 100644 -index 000000000..0237d18ea ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8710b_cmd.h -@@ -0,0 +1,169 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8710B_CMD_H__ -+#define __RTL8710B_CMD_H__ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+enum h2c_cmd_8710B { -+ /* Common Class: 000 */ -+ H2C_8710B_RSVD_PAGE = 0x00, -+ H2C_8710B_MEDIA_STATUS_RPT = 0x01, -+ H2C_8710B_SCAN_ENABLE = 0x02, -+ H2C_8710B_KEEP_ALIVE = 0x03, -+ H2C_8710B_DISCON_DECISION = 0x04, -+ H2C_8710B_PSD_OFFLOAD = 0x05, -+ H2C_8710B_AP_OFFLOAD = 0x08, -+ H2C_8710B_BCN_RSVDPAGE = 0x09, -+ H2C_8710B_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_8710B_FCS_RSVDPAGE = 0x10, -+ H2C_8710B_FCS_INFO = 0x11, -+ H2C_8710B_AP_WOW_GPIO_CTRL = 0x13, -+ -+ /* PoweSave Class: 001 */ -+ H2C_8710B_SET_PWR_MODE = 0x20, -+ H2C_8710B_PS_TUNING_PARA = 0x21, -+ H2C_8710B_PS_TUNING_PARA2 = 0x22, -+ H2C_8710B_P2P_LPS_PARAM = 0x23, -+ H2C_8710B_P2P_PS_OFFLOAD = 0x24, -+ H2C_8710B_PS_SCAN_ENABLE = 0x25, -+ H2C_8710B_SAP_PS_ = 0x26, -+ H2C_8710B_INACTIVE_PS_ = 0x27, /* Inactive_PS */ -+ H2C_8710B_FWLPS_IN_IPS_ = 0x28, -+ -+ /* Dynamic Mechanism Class: 010 */ -+ H2C_8710B_MACID_CFG = 0x40, -+ H2C_8710B_TXBF = 0x41, -+ H2C_8710B_RSSI_SETTING = 0x42, -+ H2C_8710B_AP_REQ_TXRPT = 0x43, -+ H2C_8710B_INIT_RATE_COLLECT = 0x44, -+ H2C_8710B_RA_PARA_ADJUST = 0x46, -+ -+ /* WOWLAN Class: 100 */ -+ H2C_8710B_WOWLAN = 0x80, -+ H2C_8710B_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8710B_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8710B_AOAC_RSVD_PAGE = 0x83, -+ H2C_8710B_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_8710B_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_8710B_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_8710B_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_8710B_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_8710B_P2P_OFFLOAD = 0x8B, -+ -+ H2C_8710B_RESET_TSF = 0xC0, -+ H2C_8710B_MAXID, -+}; -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- -+ * _RSVDPAGE_LOC_CMD_0x00 */ -+#define SET_8710B_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8710B_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8710B_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8710B_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8710B_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+/* _PWR_MOD_CMD_0x20 */ -+#define SET_8710B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8710B_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8710B_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8710B_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8710B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8710B_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) -+#define SET_8710B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+#define GET_8710B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+/* _PS_TUNE_PARAM_CMD_0x21 */ -+#define SET_8710B_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8710B_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8710B_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) -+#define SET_8710B_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) -+#define SET_8710B_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _MACID_CFG_CMD_0x40 */ -+#define SET_8710B_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) -+#define SET_8710B_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) -+ -+/* _RSSI_SETTING_CMD_0x42 */ -+#define SET_8710B_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8710B_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) -+#define SET_8710B_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _AP_REQ_TXRPT_CMD_0x43 */ -+#define SET_8710B_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8710B_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _FORCE_BT_TXPWR_CMD_0x62 */ -+#define SET_8710B_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+ -+/* _FORCE_BT_MP_OPER_CMD_0x67 */ -+#define SET_8710B_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_8710B_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_8710B_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8710B_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_8710B_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8710B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+ -+/* _BT_FW_PATCH_0x6A */ -+#define SET_8710B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((u8 *)(__pH2CCmd), 0, 16, __Value) -+#define SET_8710B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8710B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8710B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8710B_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 rtl8710b_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8710b_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -+/* s32 rtl8710b_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ -+void rtl8710b_set_FwPsTuneParam_cmd(PADAPTER padapter); -+void rtl8710b_download_rsvd_page(PADAPTER padapter, u8 mstatus); -+#ifdef CONFIG_BT_COEXIST -+ void rtl8710b_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif /* CONFIG_BT_COEXIST */ -+#ifdef CONFIG_P2P -+ void rtl8710b_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+ void rtl8710b_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+s32 FillH2CCmd8710B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8710B(_adapter *padapter, bool wowlan); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8710b_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8710b_dm.h -new file mode 100644 -index 000000000..9a131ba05 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8710b_dm.h -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8710B_DM_H__ -+#define __RTL8710B_DM_H__ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for 8710B dynamic mechanism only -+ * -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * structure and define -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * function prototype -+ * ************************************************************ */ -+ -+void rtl8710b_init_dm_priv(PADAPTER padapter); -+void rtl8710b_deinit_dm_priv(PADAPTER padapter); -+ -+void rtl8710b_InitHalDm(PADAPTER padapter); -+void rtl8710b_HalDmWatchDog(PADAPTER padapter); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8710b_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8710b_hal.h -new file mode 100644 -index 000000000..332112b31 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8710b_hal.h -@@ -0,0 +1,277 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8710B_HAL_H__ -+#define __RTL8710B_HAL_H__ -+ -+#include "hal_data.h" -+ -+#include "rtl8710b_spec.h" -+#include "rtl8710b_rf.h" -+#include "rtl8710b_dm.h" -+#include "rtl8710b_recv.h" -+#include "rtl8710b_xmit.h" -+#include "rtl8710b_cmd.h" -+#include "rtl8710b_led.h" -+#include "Hal8710BPwrSeq.h" -+#include "Hal8710BPhyReg.h" -+#include "Hal8710BPhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+ #include "rtl8710b_sreset.h" -+#endif -+#ifdef CONFIG_LPS_POFF -+ #include "rtl8710b_lps_poff.h" -+#endif -+ -+#define FW_8710B_SIZE 0x8000 -+#define FW_8710B_START_ADDRESS 0x1000 -+#define FW_8710B_END_ADDRESS 0x1FFF /* 0x5FFF */ -+ -+typedef struct _RT_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[FW_8710B_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8710B, *PRT_FIRMWARE_8710B; -+ -+/* -+ * This structure must be cared byte-ordering -+ * -+ * Added by tynli. 2009.12.04. */ -+typedef struct _RT_8710B_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_8710B_FIRMWARE_HDR, *PRT_8710B_FIRMWARE_HDR; -+ -+#define DRIVER_EARLY_INT_TIME_8710B 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8710B 0x02 -+ -+/* for 8710B -+ * TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ -+#define PAGE_SIZE_TX_8710B 128 -+#define PAGE_SIZE_RX_8710B 8 -+ -+#define TX_DMA_SIZE_8710B 0x8000 /* 32K(TX) */ -+#define RX_DMA_SIZE_8710B 0x4000 /* 16K(RX) */ -+ -+#ifdef CONFIG_WOWLAN -+ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ -+#else -+ #define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8710B 0x100 /* 256B, reserved for c2h debug message */ -+#else -+ #define RX_DMA_RESERVED_SIZE_8710B 0x80 /* 128B, reserved for tx report */ -+#endif -+#define RX_DMA_BOUNDARY_8710B\ -+ (RX_DMA_SIZE_8710B - RX_DMA_RESERVED_SIZE_8710B - 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:MAX_BEACON_LEN/PAGE_SIZE_TX_8710B -+ * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ -+#define BCNQ_PAGE_NUM_8710B (MAX_BEACON_LEN/PAGE_SIZE_TX_8710B + 6) /*0x08*/ -+ -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt 1, PNO: 6 -+ * NS offload: 2 NDP info: 1 -+ */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8710B 0x0b -+#else -+ #define WOWLAN_PAGE_NUM_8710B 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+ #undef WOWLAN_PAGE_NUM_8710B -+ #define WOWLAN_PAGE_NUM_8710B 0x15 -+#endif -+ -+#ifdef CONFIG_AP_WOWLAN -+ #define AP_WOWLAN_PAGE_NUM_8710B 0x02 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8710B\ -+ (0xFF - BCNQ_PAGE_NUM_8710B -WOWLAN_PAGE_NUM_8710B) -+#define TX_PAGE_BOUNDARY_8710B (TX_TOTAL_PAGE_NUMBER_8710B + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8710B TX_TOTAL_PAGE_NUMBER_8710B -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8710B\ -+ (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8710B + 1) -+ -+/* For Normal Chip Setting -+ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8710B */ -+#define NORMAL_PAGE_NUM_HPQ_8710B 0x0C -+#define NORMAL_PAGE_NUM_LPQ_8710B 0x02 -+#define NORMAL_PAGE_NUM_NPQ_8710B 0x02 -+#define NORMAL_PAGE_NUM_EPQ_8710B 0x04 -+ -+/* Note: For Normal Chip Setting, modify later */ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8710B 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8710B 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8710B 0x20 -+#define WMM_NORMAL_PAGE_NUM_EPQ_8710B 0x00 -+ -+ -+#include "HalVerDef.h" -+#include "hal_com.h" -+ -+#define EFUSE_OOB_PROTECT_BYTES (96 + 1) -+ -+#define HAL_EFUSE_MEMORY -+#define HWSET_MAX_SIZE_8710B 512 -+#define EFUSE_REAL_CONTENT_LEN_8710B 512 -+#define EFUSE_MAP_LEN_8710B 512 -+#define EFUSE_MAX_SECTION_8710B 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_8710B) -+ -+#define EFUSE_ACCESS_ON 0x69 -+#define EFUSE_ACCESS_OFF 0x00 -+ -+#define PACKAGE_QFN32_S 0 -+#define PACKAGE_QFN48M_S 1 //definiton 8188GU Dongle Package, Efuse Physical Address 0xF8 = 0xFE -+#define PACKAGE_QFN48_S 2 -+#define PACKAGE_QFN64_S 3 -+#define PACKAGE_QFN32_U 4 -+#define PACKAGE_QFN48M_U 5 //definiton 8188GU Dongle Package, Efuse Physical Address 0xF8 = 0xEE -+#define PACKAGE_QFN48_U 6 -+#define PACKAGE_QFN68_U 7 -+ -+typedef enum _PACKAGE_TYPE_E -+{ -+ PACKAGE_DEFAULT, -+ PACKAGE_QFN68, -+ PACKAGE_TFBGA90, -+ PACKAGE_TFBGA80, -+ PACKAGE_TFBGA79 -+}PACKAGE_TYPE_E; -+ -+#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 */ -+ -+/* rtl8710b_hal_init.c */ -+s32 rtl8710b_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void rtl8710b_FirmwareSelfReset(PADAPTER padapter); -+void rtl8710b_InitializeFirmwareVars(PADAPTER padapter); -+ -+void rtl8710b_InitAntenna_Selection(PADAPTER padapter); -+void rtl8710b_DeinitAntenna_Selection(PADAPTER padapter); -+void rtl8710b_CheckAntenna_Selection(PADAPTER padapter); -+void rtl8710b_init_default_value(PADAPTER padapter); -+ -+ -+u32 indirect_read32_8710b(PADAPTER padapter, u32 regaddr); -+void indirect_write32_8710b(PADAPTER padapter, u32 regaddr, u32 data); -+u32 hal_query_syson_reg_8710b(PADAPTER padapter, u32 regaddr, u32 bitmask); -+void hal_set_syson_reg_8710b(PADAPTER padapter, u32 regaddr, u32 bitmask, u32 data); -+#define HAL_SetSYSOnReg hal_set_syson_reg_8710b -+ -+ -+/* EFuse */ -+u8 GetEEPROMSize8710B(PADAPTER padapter); -+ -+#if 0 -+void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); -+void Hal_EfuseParseTxPowerInfo_8710B(PADAPTER padapter, -+ u8 *PROMContent, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseEEPROMVer_8710B(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParsePackageType_8710B(PADAPTER pAdapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseChnlPlan_8710B(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID_8710B(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseAntennaDiversity_8710B(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8710B(PADAPTER pAdapter, -+ u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseThermalMeter_8710B(PADAPTER padapter, -+ u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseBoardType_8710B(PADAPTER Adapter, -+ u8 *PROMContent, BOOLEAN AutoloadFail); -+#endif -+ -+void rtl8710b_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8710b(_adapter *adapter); -+u8 SetHwReg8710B(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8710B(PADAPTER padapter, u8 variable, u8 *val); -+u8 SetHalDefVar8710B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8710B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+ -+/* register */ -+void rtl8710b_InitBeaconParameters(PADAPTER padapter); -+void rtl8710b_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); -+void _8051Reset8710(PADAPTER padapter); -+ -+void rtl8710b_start_thread(_adapter *padapter); -+void rtl8710b_stop_thread(_adapter *padapter); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); -+#endif -+ -+void CCX_FwC2HTxRpt_8710b(PADAPTER padapter, u8 *pdata, u8 len); -+ -+u8 MRateToHwRate8710B(u8 rate); -+u8 HwRateToMRate8710B(u8 rate); -+ -+#ifdef CONFIG_USB_HCI -+ void rtl8710b_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#endif -+ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8710b_led.h b/drivers/net/wireless/rtl8821cs/include/rtl8710b_led.h -new file mode 100644 -index 000000000..8ca346d7a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8710b_led.h -@@ -0,0 +1,44 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8710B_LED_H__ -+#define __RTL8710B_LED_H__ -+ -+#include -+#include -+#include -+ -+#ifdef CONFIG_RTW_SW_LED -+/* ******************************************************************************** -+ * Interface to manipulate LED objects. -+ * ******************************************************************************** */ -+#ifdef CONFIG_USB_HCI -+ void rtl8710bu_InitSwLeds(PADAPTER padapter); -+ void rtl8710bu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+ void rtl8710bs_InitSwLeds(PADAPTER padapter); -+ void rtl8710bs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_GSPI_HCI -+ void rtl8710bs_InitSwLeds(PADAPTER padapter); -+ void rtl8710bs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+ void rtl8710be_InitSwLeds(PADAPTER padapter); -+ void rtl8710be_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif /*#ifdef CONFIG_RTW_SW_LED*/ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8710b_lps_poff.h b/drivers/net/wireless/rtl8821cs/include/rtl8710b_lps_poff.h -new file mode 100644 -index 000000000..ea9c60e8f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8710b_lps_poff.h -@@ -0,0 +1,56 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+ -+/******************************************** 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 rtl8710b_lps_poff_init(PADAPTER padapter); -+void rtl8710b_lps_poff_deinit(PADAPTER padapter); -+bool rtl8710b_lps_poff_get_txbndy_status(PADAPTER padapter); -+void rtl8710b_lps_poff_h2c_ctrl(PADAPTER padapter, u8 enable); -+void rtl8710b_lps_poff_set_ps_mode(PADAPTER padapter, bool bEnterLPS); -+bool rtl8710b_lps_poff_get_status(PADAPTER padapter); -+void rtl8710b_lps_poff_wow(PADAPTER padapter); -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8710b_recv.h b/drivers/net/wireless/rtl8821cs/include/rtl8710b_recv.h -new file mode 100644 -index 000000000..ca0b8f8e7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8710b_recv.h -@@ -0,0 +1,81 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8710B_RECV_H__ -+#define __RTL8710B_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 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 (15360) /* 15k < 16k */ -+ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ -+ /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ -+ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ -+ /* #define MAX_RECVBUF_SZ (16384) */ /* 16k - 92E RX BUF :16K */ -+ #endif -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+#endif -+ -+/* Rx smooth factor */ -+#define Rx_Smooth_Factor (20) -+ -+/*-----------------------------------------------------------------*/ -+/* RTL8710B RX BUFFER DESC */ -+/*-----------------------------------------------------------------*/ -+/*DWORD 0*/ -+#define SET_RX_BUFFER_DESC_DATA_LENGTH_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_BUFFER_DESC_LS_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) -+#define SET_RX_BUFFER_DESC_FS_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 1, __Value) -+#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 15, __Value) -+ -+#define GET_RX_BUFFER_DESC_OWN_8710B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+#define GET_RX_BUFFER_DESC_LS_8710B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_BUFFER_DESC_FS_8710B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 1) -+#ifdef USING_RX_TAG -+ #define GET_RX_BUFFER_DESC_RX_TAG_8710B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 13) -+#else -+ #define GET_RX_BUFFER_DESC_TOTAL_LENGTH_8710B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) -+#endif -+ -+/*DWORD 1*/ -+#define SET_RX_BUFFER_PHYSICAL_LOW_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) -+ -+/*DWORD 2*/ -+#ifdef CONFIG_64BIT_DMA -+ #define SET_RX_BUFFER_PHYSICAL_HIGH_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) -+#else -+ #define SET_RX_BUFFER_PHYSICAL_HIGH_8710B(__pRxStatusDesc, __Value) -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ int rtl8710bu_init_recv_priv(_adapter *padapter); -+ void rtl8710bu_free_recv_priv(_adapter *padapter); -+ void rtl8710bu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+#endif -+ -+void rtl8710b_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8710B_RECV_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8710b_rf.h b/drivers/net/wireless/rtl8821cs/include/rtl8710b_rf.h -new file mode 100644 -index 000000000..0b5cee616 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8710b_rf.h -@@ -0,0 +1,20 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8710B_RF_H__ -+#define __RTL8710B_RF_H__ -+ -+int PHY_RF6052_Config8710B(PADAPTER pdapter); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8710b_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8710b_spec.h -new file mode 100644 -index 000000000..309c3eeb4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8710b_spec.h -@@ -0,0 +1,481 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8710B_SPEC_H__ -+#define __RTL8710B_SPEC_H__ -+ -+#include -+ -+ -+#define HAL_NAV_UPPER_UNIT_8710B 128 /* micro-second */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0000h ~ 0x00FFh System Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_SYS_ISO_CTRL_8710B 0x0000 /* 2 Byte */ -+#define REG_APS_FSMCO_8710B 0x0004 /* 4 Byte */ -+#define REG_SYS_CLKR_8710B 0x0008 /* 2 Byte */ -+#define REG_9346CR_8710B 0x000A /* 2 Byte */ -+#define REG_EE_VPD_8710B 0x000C /* 2 Byte */ -+#define REG_AFE_MISC_8710B 0x0010 /* 1 Byte */ -+#define REG_SPS0_CTRL_8710B 0x0011 /* 7 Byte */ -+#define REG_SPS_OCP_CFG_8710B 0x0018 /* 4 Byte */ -+#define REG_RSV_CTRL_8710B 0x001C /* 3 Byte */ -+#define REG_RF_CTRL_8710B 0x001F /* 1 Byte */ -+#define REG_LPLDO_CTRL_8710B 0x0023 /* 1 Byte */ -+#define REG_AFE_XTAL_CTRL_8710B 0x0024 /* 4 Byte */ -+#define REG_AFE_PLL_CTRL_8710B 0x0028 /* 4 Byte */ -+#define REG_MAC_PLL_CTRL_EXT_8710B 0x002c /* 4 Byte */ -+#define REG_EFUSE_CTRL_8710B 0x0030 -+#define REG_EFUSE_TEST_8710B 0x0034 -+#define REG_PWR_DATA_8710B 0x0038 -+#define REG_CAL_TIMER_8710B 0x003C -+#define REG_ACLK_MON_8710B 0x003E -+#define REG_GPIO_MUXCFG_8710B 0x0040 -+#define REG_GPIO_IO_SEL_8710B 0x0042 -+#define REG_MAC_PINMUX_CFG_8710B 0x0043 -+#define REG_GPIO_PIN_CTRL_8710B 0x0044 -+#define REG_GPIO_INTM_8710B 0x0048 -+#define REG_LEDCFG0_8710B 0x004C -+#define REG_LEDCFG1_8710B 0x004D -+#define REG_LEDCFG2_8710B 0x004E -+#define REG_LEDCFG3_8710B 0x004F -+#define REG_FSIMR_8710B 0x0050 -+#define REG_FSISR_8710B 0x0054 -+#define REG_HSIMR_8710B 0x0058 -+#define REG_HSISR_8710B 0x005c -+#define REG_GPIO_EXT_CTRL 0x0060 -+#define REG_PAD_CTRL1_8710B 0x0064 -+#define REG_MULTI_FUNC_CTRL_8710B 0x0068 -+#define REG_GPIO_STATUS_8710B 0x006C -+#define REG_SDIO_CTRL_8710B 0x0070 -+#define REG_OPT_CTRL_8710B 0x0074 -+#define REG_AFE_CTRL_4_8710B 0x0078 -+#define REG_MCUFWDL_8710B 0x0080 -+#define REG_8051FW_CTRL_8710B 0x0080 -+#define REG_HMEBOX_DBG_0_8710B 0x0088 -+#define REG_HMEBOX_DBG_1_8710B 0x008A -+#define REG_HMEBOX_DBG_2_8710B 0x008C -+#define REG_HMEBOX_DBG_3_8710B 0x008E -+#define REG_WLLPS_CTRL 0x0090 -+ -+#define REG_PMC_DBG_CTRL2_8710B 0x00CC -+#define REG_EFUSE_BURN_GNT_8710B 0x00CF -+#define REG_HPON_FSM_8710B 0x00EC -+#define REG_SYS_CFG1_8710B 0x00F0 -+#define REG_SYS_CFG_8710B 0x00FC -+#define REG_ROM_VERSION 0x00FD -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_C2HEVT_CMD_ID_8710B 0x01A0 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_8710B 0x01AE -+#define REG_C2HEVT_CLEAR_8710B 0x01AF -+#define REG_MCUTST_1_8710B 0x01C0 -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_FMETHR_8710B 0x01C8 -+#define REG_HMETFR_8710B 0x01CC -+#define REG_HMEBOX_0_8710B 0x01D0 -+#define REG_HMEBOX_1_8710B 0x01D4 -+#define REG_HMEBOX_2_8710B 0x01D8 -+#define REG_HMEBOX_3_8710B 0x01DC -+#define REG_LLT_INIT_8710B 0x01E0 -+#define REG_HMEBOX_EXT0_8710B 0x01F0 -+#define REG_HMEBOX_EXT1_8710B 0x01F4 -+#define REG_HMEBOX_EXT2_8710B 0x01F8 -+#define REG_HMEBOX_EXT3_8710B 0x01FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RQPN_8710B 0x0200 -+#define REG_FIFOPAGE_8710B 0x0204 -+#define REG_DWBCN0_CTRL_8710B REG_TDECTRL -+#define REG_TXDMA_OFFSET_CHK_8710B 0x020C -+#define REG_TXDMA_STATUS_8710B 0x0210 -+#define REG_RQPN_NPQ_8710B 0x0214 -+#define REG_DWBCN1_CTRL_8710B 0x0228 -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RXDMA_AGG_PG_TH_8710B 0x0280 -+#define REG_FW_UPD_RDPTR_8710B 0x0284 /* FW shall update this register before FW write RXPKT_RELEASE_POLL to 1 */ -+#define REG_RXDMA_CONTROL_8710B 0x0286 /* Control the RX DMA. */ -+#define REG_RXDMA_STATUS_8710B 0x0288 -+#define REG_RXDMA_MODE_CTRL_8710B 0x0290 -+#define REG_EARLY_MODE_CONTROL_8710B 0x02BC -+#define REG_RSVD5_8710B 0x02F0 -+#define REG_RSVD6_8710B 0x02F4 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0300h ~ 0x03FFh PCIe -+ * -+ * ----------------------------------------------------- */ -+#define REG_PCIE_CTRL_REG_8710B 0x0300 -+#define REG_INT_MIG_8710B 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_TXBD_DESA_8710B 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_MGQ_TXBD_DESA_8710B 0x0310 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_TXBD_DESA_8710B 0x0318 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_TXBD_DESA_8710B 0x0320 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_TXBD_DESA_8710B 0x0328 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_TXBD_DESA_8710B 0x0330 /* TX BK Queue Descriptor Address */ -+#define REG_RXQ_RXBD_DESA_8710B 0x0338 /* RX Queue Descriptor Address */ -+#define REG_HI0Q_TXBD_DESA_8710B 0x0340 -+#define REG_HI1Q_TXBD_DESA_8710B 0x0348 -+#define REG_HI2Q_TXBD_DESA_8710B 0x0350 -+#define REG_HI3Q_TXBD_DESA_8710B 0x0358 -+#define REG_HI4Q_TXBD_DESA_8710B 0x0360 -+#define REG_HI5Q_TXBD_DESA_8710B 0x0368 -+#define REG_HI6Q_TXBD_DESA_8710B 0x0370 -+#define REG_HI7Q_TXBD_DESA_8710B 0x0378 -+#define REG_MGQ_TXBD_NUM_8710B 0x0380 -+#define REG_RX_RXBD_NUM_8710B 0x0382 -+#define REG_VOQ_TXBD_NUM_8710B 0x0384 -+#define REG_VIQ_TXBD_NUM_8710B 0x0386 -+#define REG_BEQ_TXBD_NUM_8710B 0x0388 -+#define REG_BKQ_TXBD_NUM_8710B 0x038A -+#define REG_HI0Q_TXBD_NUM_8710B 0x038C -+#define REG_HI1Q_TXBD_NUM_8710B 0x038E -+#define REG_HI2Q_TXBD_NUM_8710B 0x0390 -+#define REG_HI3Q_TXBD_NUM_8710B 0x0392 -+#define REG_HI4Q_TXBD_NUM_8710B 0x0394 -+#define REG_HI5Q_TXBD_NUM_8710B 0x0396 -+#define REG_HI6Q_TXBD_NUM_8710B 0x0398 -+#define REG_HI7Q_TXBD_NUM_8710B 0x039A -+#define REG_TSFTIMER_HCI_8710B 0x039C -+#define REG_BD_RW_PTR_CLR_8710B 0x039C -+ -+/* Read Write Point */ -+#define REG_VOQ_TXBD_IDX_8710B 0x03A0 -+#define REG_VIQ_TXBD_IDX_8710B 0x03A4 -+#define REG_BEQ_TXBD_IDX_8710B 0x03A8 -+#define REG_BKQ_TXBD_IDX_8710B 0x03AC -+#define REG_MGQ_TXBD_IDX_8710B 0x03B0 -+#define REG_RXQ_TXBD_IDX_8710B 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8710B 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8710B 0x03BC -+#define REG_HI2Q_TXBD_IDX_8710B 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8710B 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8710B 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8710B 0x03CC -+#define REG_HI6Q_TXBD_IDX_8710B 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8710B 0x03D4 -+ -+#define REG_PCIE_HCPWM_8710BE 0x03D8 /* ?????? */ -+#define REG_PCIE_HRPWM_8710BE 0x03DC /* PCIe RPWM ?????? */ -+#define REG_DBI_WDATA_V1_8710B 0x03E8 -+#define REG_DBI_RDATA_V1_8710B 0x03EC -+#define REG_DBI_FLAG_V1_8710B 0x03F0 -+#define REG_MDIO_V1_8710B 0x03F4 -+#define REG_PCIE_MIX_CFG_8710B 0x03F8 -+#define REG_HCI_MIX_CFG_8710B 0x03FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_VOQ_INFORMATION_8710B 0x0400 -+#define REG_VIQ_INFORMATION_8710B 0x0404 -+#define REG_BEQ_INFORMATION_8710B 0x0408 -+#define REG_BKQ_INFORMATION_8710B 0x040C -+#define REG_MGQ_INFORMATION_8710B 0x0410 -+#define REG_HGQ_INFORMATION_8710B 0x0414 -+#define REG_BCNQ_INFORMATION_8710B 0x0418 -+#define REG_TXPKT_EMPTY_8710B 0x041A -+ -+#define REG_FWHW_TXQ_CTRL_8710B 0x0420 -+#define REG_HWSEQ_CTRL_8710B 0x0423 -+#define REG_TXPKTBUF_BCNQ_BDNY_8710B 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8710B 0x0425 -+#define REG_LIFECTRL_CTRL_8710B 0x0426 -+#define REG_MULTI_BCNQ_OFFSET_8710B 0x0427 -+#define REG_SPEC_SIFS_8710B 0x0428 -+#define REG_RL_8710B 0x042A -+#define REG_TXBF_CTRL_8710B 0x042C -+#define REG_DARFRC_8710B 0x0430 -+#define REG_RARFRC_8710B 0x0438 -+#define REG_RRSR_8710B 0x0440 -+#define REG_ARFR0_8710B 0x0444 -+#define REG_ARFR1_8710B 0x044C -+#define REG_CCK_CHECK_8710B 0x0454 -+#define REG_AMPDU_MAX_TIME_8710B 0x0456 -+#define REG_TXPKTBUF_BCNQ_BDNY1_8710B 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8710B 0x0458 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8710B 0x045D -+#define REG_NDPA_OPT_CTRL_8710B 0x045F -+#define REG_FAST_EDCA_CTRL_8710B 0x0460 -+#define REG_RD_RESP_PKT_TH_8710B 0x0463 -+#define REG_DATA_SC_8710B 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_8710B 0x04B4 -+#define REG_POWER_STAGE2_8710B 0x04B8 -+#define REG_AMPDU_BURST_MODE_8710B 0x04BC -+#define REG_PKT_VO_VI_LIFE_TIME_8710B 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME_8710B 0x04C2 -+#define REG_STBC_SETTING_8710B 0x04C4 -+#define REG_HT_SINGLE_AMPDU_8710B 0x04C7 -+#define REG_PROT_MODE_CTRL_8710B 0x04C8 -+#define REG_MAX_AGGR_NUM_8710B 0x04CA -+#define REG_RTS_MAX_AGGR_NUM_8710B 0x04CB -+#define REG_BAR_MODE_CTRL_8710B 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8710B 0x04CF -+#define REG_MACID_PKT_DROP0_8710B 0x04D0 -+#define REG_MACID_PKT_SLEEP_8710B 0x04D4 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_EDCA_VO_PARAM_8710B 0x0500 -+#define REG_EDCA_VI_PARAM_8710B 0x0504 -+#define REG_EDCA_BE_PARAM_8710B 0x0508 -+#define REG_EDCA_BK_PARAM_8710B 0x050C -+#define REG_BCNTCFG_8710B 0x0510 -+#define REG_PIFS_8710B 0x0512 -+#define REG_RDG_PIFS_8710B 0x0513 -+#define REG_SIFS_CTX_8710B 0x0514 -+#define REG_SIFS_TRX_8710B 0x0516 -+#define REG_AGGR_BREAK_TIME_8710B 0x051A -+#define REG_SLOT_8710B 0x051B -+#define REG_TX_PTCL_CTRL_8710B 0x0520 -+#define REG_TXPAUSE_8710B 0x0522 -+#define REG_DIS_TXREQ_CLR_8710B 0x0523 -+#define REG_RD_CTRL_8710B 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_8710B 0x0540 -+#define REG_RD_NAV_NXT_8710B 0x0544 -+#define REG_NAV_PROT_LEN_8710B 0x0546 -+#define REG_BCN_CTRL_8710B 0x0550 -+#define REG_BCN_CTRL_1_8710B 0x0551 -+#define REG_MBID_NUM_8710B 0x0552 -+#define REG_DUAL_TSF_RST_8710B 0x0553 -+#define REG_BCN_INTERVAL_8710B 0x0554 -+#define REG_DRVERLYINT_8710B 0x0558 -+#define REG_BCNDMATIM_8710B 0x0559 -+#define REG_ATIMWND_8710B 0x055A -+#define REG_USTIME_TSF_8710B 0x055C -+#define REG_BCN_MAX_ERR_8710B 0x055D -+#define REG_RXTSF_OFFSET_CCK_8710B 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8710B 0x055F -+#define REG_TSFTR_8710B 0x0560 -+#define REG_CTWND_8710B 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8710B 0x0577 -+#define REG_PSTIMER_8710B 0x0580 -+#define REG_TIMER0_8710B 0x0584 -+#define REG_TIMER1_8710B 0x0588 -+#define REG_ACMHWCTRL_8710B 0x05C0 -+#define REG_SCH_TXCMD_8710B 0x05F8 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_MAC_CR_8710B 0x0600 -+#define REG_TCR_8710B 0x0604 -+#define REG_RCR_8710B 0x0608 -+#define REG_RX_PKT_LIMIT_8710B 0x060C -+#define REG_RX_DLK_TIME_8710B 0x060D -+#define REG_RX_DRVINFO_SZ_8710B 0x060F -+ -+#define REG_MACID_8710B 0x0610 -+#define REG_BSSID_8710B 0x0618 -+#define REG_MAR_8710B 0x0620 -+#define REG_MBIDCAMCFG_8710B 0x0628 -+#define REG_WOWLAN_GTK_DBG1 0x630 -+#define REG_WOWLAN_GTK_DBG2 0x634 -+ -+#define REG_USTIME_EDCA_8710B 0x0638 -+#define REG_MAC_SPEC_SIFS_8710B 0x063A -+#define REG_RESP_SIFP_CCK_8710B 0x063C -+#define REG_RESP_SIFS_OFDM_8710B 0x063E -+#define REG_ACKTO_8710B 0x0640 -+#define REG_CTS2TO_8710B 0x0641 -+#define REG_EIFS_8710B 0x0642 -+ -+#define REG_NAV_UPPER_8710B 0x0652 /* unit of 128 */ -+#define REG_TRXPTCL_CTL_8710B 0x0668 -+ -+/* Security */ -+#define REG_CAMCMD_8710B 0x0670 -+#define REG_CAMWRITE_8710B 0x0674 -+#define REG_CAMREAD_8710B 0x0678 -+#define REG_CAMDBG_8710B 0x067C -+#define REG_SECCFG_8710B 0x0680 -+ -+/* Power */ -+#define REG_WOW_CTRL_8710B 0x0690 -+#define REG_PS_RX_INFO_8710B 0x0692 -+#define REG_UAPSD_TID_8710B 0x0693 -+#define REG_WKFMCAM_CMD_8710B 0x0698 -+#define REG_WKFMCAM_NUM_8710B 0x0698 -+#define REG_WKFMCAM_RWD_8710B 0x069C -+#define REG_RXFLTMAP0_8710B 0x06A0 -+#define REG_RXFLTMAP1_8710B 0x06A2 -+#define REG_RXFLTMAP2_8710B 0x06A4 -+#define REG_BCN_PSR_RPT_8710B 0x06A8 -+#define REG_BT_COEX_TABLE_8710B 0x06C0 -+#define REG_BFMER0_INFO_8710B 0x06E4 -+#define REG_BFMER1_INFO_8710B 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8710B 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8710B 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8710B 0x06FC -+ -+/* Hardware Port 2 */ -+#define REG_MACID1_8710B 0x0700 -+#define REG_BSSID1_8710B 0x0708 -+#define REG_BFMEE_SEL_8710B 0x0714 -+#define REG_SND_PTCL_CTRL_8710B 0x0718 -+ -+/* LTR */ -+#define REG_LTR_CTRL_BASIC_8710B 0x07A4 -+#define REG_LTR_IDLE_LATENCY_V1_8710B 0x0798 -+#define REG_LTR_ACTIVE_LATENCY_V1_8710B 0x079C -+ -+/* 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 -+ -+/* Other */ -+#define REG_USB_ACCESS_TIMEOUT 0xFE4C -+ -+/* ----------------------------------------------------- -+ * SYSON_REG_SPEC -+ * ----------------------------------------------------- */ -+#define SYSON_REG_BASE_ADDR_8710B 0x40000000 -+#define REG_SYS_XTAL_CTRL0 0x0060 -+#define REG_SYS_SYSTEM_CFG0 0x1F0 -+#define REG_SYS_SYSTEM_CFG1 0x1F4 -+#define REG_SYS_SYSTEM_CFG2 0x1F8 -+#define REG_SYS_EEPROM_CTRL0 0x0E0 -+ -+ -+/* ----------------------------------------------------- -+ * Indirect_R/W_SPEC -+ * ----------------------------------------------------- */ -+#define NORMAL_REG_READ_OFFSET 0x83000000 -+#define NORMAL_REG_WRITE_OFFSET 0x84000000 -+#define EFUSE_READ_OFFSET 0x85000000 -+#define EFUSE_WRITE_OFFSET 0x86000000 -+ -+ -+/* ----------------------------------------------------- -+ * PAGE0_WLANON_REG_SPEC -+ * ----------------------------------------------------- */ -+#define PAGE0_OFFSET 0x0 // WLANON_PAGE0_REG needs to add an offset. -+ -+ -+ -+/* **************************************************************************** -+ * 8723 Regsiter Bit and Content definition -+ * **************************************************************************** */ -+ -+ /* ----------------------------------------------------- -+ * REG_SYS_SYSTEM_CFG0 -+ * ----------------------------------------------------- */ -+#define BIT_RTL_ID_8710B BIT(16) -+ -+#define BIT_MASK_CHIP_VER_8710B 0xf -+#define BIT_GET_CHIP_VER_8710B(x) ((x) & BIT_MASK_CHIP_VER_8710B) -+ -+#define BIT_SHIFT_VENDOR_ID_8710B 4 -+#define BIT_MASK_VENDOR_ID_8710B 0xf -+#define BIT_GET_VENDOR_ID_8710B(x) (((x) >> BIT_SHIFT_VENDOR_ID_8710B) & BIT_MASK_VENDOR_ID_8710B) -+ -+ /* ----------------------------------------------------- -+ * REG_SYS_SYSTEM_CFG1 -+ * ----------------------------------------------------- */ -+#define BIT_SPSLDO_SEL_8710B BIT(25) -+ -+ /* ----------------------------------------------------- -+ * REG_SYS_SYSTEM_CFG2 -+ * ----------------------------------------------------- */ -+#define BIT_MASK_RF_RL_ID_8710B 0xf -+#define BIT_GET_RF_RL_ID_8710B(x) ((x) & BIT_MASK_RF_RL_ID_8710B) -+ -+ /* ----------------------------------------------------- -+ * REG_SYS_SYSTEM_CFG2 -+ * ----------------------------------------------------- */ -+#define BIT_EERPOMSEL_8710B BIT(4) -+#define BIT_AUTOLOAD_SUS_8710B BIT(5) -+ -+ -+ /* ----------------------------------------------------- -+ * Other -+ * ----------------------------------------------------- */ -+ -+ -+#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_RTL8710B -+ #define EEPROM_RF_GAIN_OFFSET 0xC1 -+ #endif -+ -+ #define EEPROM_RF_GAIN_VAL 0x1F6 -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+#endif /* __RTL8710B_SPEC_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8710b_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtl8710b_sreset.h -new file mode 100644 -index 000000000..ac5c64edd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8710b_sreset.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8710B_SRESET_H_ -+#define _RTL8710B_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ extern void rtl8710b_sreset_xmit_status_check(_adapter *padapter); -+ extern void rtl8710b_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8710b_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8710b_xmit.h -new file mode 100644 -index 000000000..b3ec6f580 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8710b_xmit.h -@@ -0,0 +1,523 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8710B_XMIT_H__ -+#define __RTL8710B_XMIT_H__ -+ -+ -+#define MAX_TID (15) -+ -+ -+#ifndef __INC_HAL8710BDESC_H -+#define __INC_HAL8710BDESC_H -+ -+#define RX_STATUS_DESC_SIZE_8710B 24 -+#define RX_DRV_INFO_SIZE_UNIT_8710B 8 -+ -+ -+/* DWORD 0 */ -+#define SET_RX_STATUS_DESC_PKT_LEN_8710B(__pRxStatusDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8710B(__pRxStatusDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8710B(__pRxStatusDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_EOR_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+ -+/* DWORD 1 */ -+#define GET_RX_STATUS_DESC_MACID_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) -+ -+/* DWORD 2 */ -+#define GET_RX_STATUS_DESC_SEQ_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) -+#define GET_RX_STATUS_DESC_FCS_OK_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 31, 1) -+ -+/* DWORD 3 */ -+#define GET_RX_STATUS_DESC_RX_RATE_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) -+#endif -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) -+ -+/* DWORD 6 */ -+#define GET_RX_STATUS_DESC_MATCH_ID_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 7) -+ -+/* DWORD 5 */ -+#define GET_RX_STATUS_DESC_TSFL_8710B(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8710B(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+#define SET_RX_STATUS_DESC_BUFF_ADDR_8710B(__pRxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+/* Dword 0, rsvd: bit26, bit28 */ -+#define GET_TX_DESC_OWN_8710B(__pTxDesc)\ -+ LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+#define SET_TX_DESC_PKT_SIZE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_AMSDU_PAD_EN_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+ -+/* Dword 1 */ -+#define SET_TX_DESC_MACID_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+#define SET_TX_DESC_MORE_DATA_8710B(__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_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_NULL0_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) -+#define SET_TX_DESC_NULL1_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) -+#define SET_TX_DESC_BK_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_CCX_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_FTM_EN_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 30, 1, __Value) -+ -+/* Dword 3 */ -+#define SET_TX_DESC_NAV_USE_HDR_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_8710B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_PORT_ID_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 2, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+/* Dword 4 */ -+#define SET_TX_DESC_TX_RATE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_TX_TRY_RATE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+#define SET_TX_DESC_PCTS_EN_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) -+#define SET_TX_DESC_PCTS_MASK_IDX_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) -+ -+/* Dword 5 */ -+#define SET_TX_DESC_DATA_SC_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_STBC_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_RTS_STBC_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+#define SET_TX_DESC_PATH_A_EN_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 1, __Value) -+#define SET_TX_DESC_TXPWR_OF_SET_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) -+ -+/* Dword 6 */ -+#define SET_TX_DESC_SW_DEFINE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_RF_SEL_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+ -+/* Dword 7 */ -+#ifdef CONFIG_PCI_HCI -+#define SET_TX_DESC_TX_BUFFER_SIZE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+ -+#ifdef CONFIG_USB_HCI -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+#define SET_TX_DESC_TX_TIMESTAMP_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 6, 18, __Value) -+#endif -+ -+#define SET_TX_DESC_USB_TXAGG_NUM_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+ -+/* Dword 8 */ -+#define SET_TX_DESC_RTS_RC_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) -+#define SET_TX_DESC_BAR_RC_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) -+#define SET_TX_DESC_DATA_RC_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) -+#define SET_TX_DESC_HWSEQ_EN_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+#define SET_TX_DESC_NEXTHEADPAGE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) -+#define SET_TX_DESC_TAILPAGE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) -+ -+/* Dword 9 */ -+#define SET_TX_DESC_PADDING_LEN_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) -+#define SET_TX_DESC_SEQ_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+#define SET_TX_DESC_FINAL_DATA_RATE_8710B(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 8, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+ -+/*-----------------------------------------------------------------*/ -+/* RTL8710B 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_8710B(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 14, __Valeu) -+#define SET_TX_BUFF_DESC_PSB_8710B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) -+#define SET_TX_BUFF_DESC_OWN_8710B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+/* Dword 1 1 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_0_8710B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) -+#define GET_TX_BUFF_DESC_ADDR_LOW_0_8710B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) -+/* Dword 2 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_0_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 0, __Value) -+#ifdef CONFIG_64BIT_DMA -+ #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8710B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 0, 32) -+#else -+ #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8710B(__pTxDesc) 0 -+#endif -+/* Dword 3 NA */ -+/* RESERVED 0 */ -+/* Dword 4 2 */ -+#define SET_TX_BUFF_DESC_LEN_1_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 1, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_1_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 1, __Value) -+/* Dword 5 3 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_1_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 1, __Value) -+/* Dword 6 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_1_8710B(__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_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 2, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_2_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 2, __Value) -+/* Dword 9 5 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_2_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 2, __Value) -+/* Dword 10 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_2_8710B(__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_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 3, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_3_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 3, __Value) -+/* Dword 13 7 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_3_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 3, __Value) -+/* Dword 14 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_3_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 3, __Value) -+/* Dword 15 NA */ -+/*RESERVED 0 */ -+ -+ -+#endif -+/* ----------------------------------------------------------- -+ * -+ * Rate -+ * -+ * ----------------------------------------------------------- -+ * CCK Rates, TxHT = 0 */ -+#define DESC8710B_RATE1M 0x00 -+#define DESC8710B_RATE2M 0x01 -+#define DESC8710B_RATE5_5M 0x02 -+#define DESC8710B_RATE11M 0x03 -+ -+/* OFDM Rates, TxHT = 0 */ -+#define DESC8710B_RATE6M 0x04 -+#define DESC8710B_RATE9M 0x05 -+#define DESC8710B_RATE12M 0x06 -+#define DESC8710B_RATE18M 0x07 -+#define DESC8710B_RATE24M 0x08 -+#define DESC8710B_RATE36M 0x09 -+#define DESC8710B_RATE48M 0x0a -+#define DESC8710B_RATE54M 0x0b -+ -+/* MCS Rates, TxHT = 1 */ -+#define DESC8710B_RATEMCS0 0x0c -+#define DESC8710B_RATEMCS1 0x0d -+#define DESC8710B_RATEMCS2 0x0e -+#define DESC8710B_RATEMCS3 0x0f -+#define DESC8710B_RATEMCS4 0x10 -+#define DESC8710B_RATEMCS5 0x11 -+#define DESC8710B_RATEMCS6 0x12 -+#define DESC8710B_RATEMCS7 0x13 -+#define DESC8710B_RATEMCS8 0x14 -+#define DESC8710B_RATEMCS9 0x15 -+#define DESC8710B_RATEMCS10 0x16 -+#define DESC8710B_RATEMCS11 0x17 -+#define DESC8710B_RATEMCS12 0x18 -+#define DESC8710B_RATEMCS13 0x19 -+#define DESC8710B_RATEMCS14 0x1a -+#define DESC8710B_RATEMCS15 0x1b -+#define DESC8710B_RATEVHTSS1MCS0 0x2c -+#define DESC8710B_RATEVHTSS1MCS1 0x2d -+#define DESC8710B_RATEVHTSS1MCS2 0x2e -+#define DESC8710B_RATEVHTSS1MCS3 0x2f -+#define DESC8710B_RATEVHTSS1MCS4 0x30 -+#define DESC8710B_RATEVHTSS1MCS5 0x31 -+#define DESC8710B_RATEVHTSS1MCS6 0x32 -+#define DESC8710B_RATEVHTSS1MCS7 0x33 -+#define DESC8710B_RATEVHTSS1MCS8 0x34 -+#define DESC8710B_RATEVHTSS1MCS9 0x35 -+#define DESC8710B_RATEVHTSS2MCS0 0x36 -+#define DESC8710B_RATEVHTSS2MCS1 0x37 -+#define DESC8710B_RATEVHTSS2MCS2 0x38 -+#define DESC8710B_RATEVHTSS2MCS3 0x39 -+#define DESC8710B_RATEVHTSS2MCS4 0x3a -+#define DESC8710B_RATEVHTSS2MCS5 0x3b -+#define DESC8710B_RATEVHTSS2MCS6 0x3c -+#define DESC8710B_RATEVHTSS2MCS7 0x3d -+#define DESC8710B_RATEVHTSS2MCS8 0x3e -+#define DESC8710B_RATEVHTSS2MCS9 0x3f -+ -+ -+#define RX_HAL_IS_CCK_RATE_8710B(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_RATE_8710B(pDesc) == DESC8710B_RATE1M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8710B(pDesc) == DESC8710B_RATE2M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8710B(pDesc) == DESC8710B_RATE5_5M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8710B(pDesc) == DESC8710B_RATE11M) -+ -+#ifdef CONFIG_TRX_BD_ARCH -+ struct tx_desc; -+#endif -+ -+void rtl8710b_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+void rtl8710b_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); -+void rtl8710b_fill_txdesc_sectype(struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); -+void rtl8710b_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); -+void rtl8710b_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); -+void rtl8710b_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+ -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8710bs_init_xmit_priv(PADAPTER padapter); -+ void rtl8710bs_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8710bs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8710bs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8710bs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8710bs_xmit_buf_handler(PADAPTER padapter); -+ thread_return rtl8710bs_xmit_thread(thread_context context); -+ #define hal_xmit_handler rtl8710bs_xmit_buf_handler -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ s32 rtl8710bu_xmit_buf_handler(PADAPTER padapter); -+ #define hal_xmit_handler rtl8710bu_xmit_buf_handler -+ s32 rtl8710bu_init_xmit_priv(PADAPTER padapter); -+ void rtl8710bu_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8710bu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8710bu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8710bu_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ s32 rtl8710bu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8710bu_xmit_tasklet(void *priv); -+ s32 rtl8710bu_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 rtl8710be_init_xmit_priv(PADAPTER padapter); -+ void rtl8710be_free_xmit_priv(PADAPTER padapter); -+ struct xmit_buf *rtl8710be_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+ void rtl8710be_xmitframe_resume(_adapter *padapter); -+ s32 rtl8710be_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8710be_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8710be_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8710be_xmit_tasklet(void *priv); -+#endif -+ -+u8 BWMapping_8710B(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_8710B(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723b_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtl8723b_cmd.h -new file mode 100644 -index 000000000..d4da95640 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723b_cmd.h -@@ -0,0 +1,199 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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, -+ 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 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((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) -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ------------------------------------------- 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_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_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 */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+ void rtl8723b_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+void rtl8723b_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+ -+s32 FillH2CCmd8723B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8723B(_adapter *padapter, bool wowlan); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723b_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8723b_dm.h -new file mode 100644 -index 000000000..ea517175f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723b_dm.h -@@ -0,0 +1,38 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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(PADAPTER padapter); -+void rtl8723b_deinit_dm_priv(PADAPTER padapter); -+ -+void rtl8723b_InitHalDm(PADAPTER padapter); -+void rtl8723b_HalDmWatchDog(PADAPTER padapter); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723b_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8723b_hal.h -new file mode 100755 -index 000000000..848350246 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723b_hal.h -@@ -0,0 +1,274 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "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_CAM_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:MAX_BEACON_LEN/PAGE_SIZE_TX_8723B -+ * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ -+#define BCNQ_PAGE_NUM_8723B (MAX_BEACON_LEN / PAGE_SIZE_TX_8723B + 6) /*0x08*/ -+ -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt: 1,PNO: 6 -+ * NS offload: 2 NDP info: 1 -+ */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8723B 0x0b -+#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 - 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 -+#define NORMAL_PAGE_NUM_EPQ_8723B 0x04 -+ -+/* 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 -+#define WMM_NORMAL_PAGE_NUM_EPQ_8723B 0x00 -+ -+ -+#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); -+u8 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(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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8723b_led.h b/drivers/net/wireless/rtl8821cs/include/rtl8723b_led.h -new file mode 100755 -index 000000000..6b772cceb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723b_led.h -@@ -0,0 +1,44 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_LED_H__ -+#define __RTL8723B_LED_H__ -+ -+#include -+#include -+#include -+ -+#ifdef CONFIG_RTW_SW_LED -+/* ******************************************************************************** -+ * 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 -+#endif/*CONFIG_RTW_SW_LED*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723b_recv.h b/drivers/net/wireless/rtl8821cs/include/rtl8723b_recv.h -new file mode 100755 -index 000000000..5e92713a5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723b_recv.h -@@ -0,0 +1,82 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+#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 -+ #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 /* !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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8723b_rf.h b/drivers/net/wireless/rtl8821cs/include/rtl8723b_rf.h -new file mode 100644 -index 000000000..040c16647 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723b_rf.h -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+int PHY_RF6052_Config8723B(PADAPTER Adapter); -+ -+void -+PHY_RF6052SetBandwidth8723B( -+ PADAPTER Adapter, -+ enum channel_width Bandwidth); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723b_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8723b_spec.h -new file mode 100755 -index 000000000..b0fb4aa41 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723b_spec.h -@@ -0,0 +1,280 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ * -+ * ----------------------------------------------------- */ -+#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 BIT(5) -+ -+/* ----------------------------------------------------- -+ * -+ * 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 BIT(31) /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8723B BIT(30) /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8723B BIT(29) /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8723B BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8723B BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8723B BIT(26) /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8723B BIT(25) /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8723B BIT(24) /* TSF Timer BIT(32) toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8723B BIT(20) /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8723B BIT(16) /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8723B BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8723B BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8723B BIT(12) /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8723B BIT(10) /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8723B BIT(9) /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8723B BIT(8) /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8723B BIT(7) /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8723B BIT(6) /* Management Queue DMA OK */ -+#define IMR_BKDOK_8723B BIT(5) /* AC_BK DMA OK */ -+#define IMR_BEDOK_8723B BIT(4) /* AC_BE DMA OK */ -+#define IMR_VIDOK_8723B BIT(3) /* AC_VI DMA OK */ -+#define IMR_VODOK_8723B BIT(2) /* AC_VO DMA OK */ -+#define IMR_RDU_8723B BIT(1) /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8723B BIT(0) /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8723B BIT(27) /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8723B BIT(26) /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8723B BIT(25) /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8723B BIT(24) /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8723B BIT(23) /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8723B BIT(22) /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8723B BIT(21) /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8723B BIT(20) /* Beacon Queue DMA OK Interrupt 7 */ -+#define IMR_BCNDOK6_8723B BIT(19) /* Beacon Queue DMA OK Interrupt 6 */ -+#define IMR_BCNDOK5_8723B BIT(18) /* Beacon Queue DMA OK Interrupt 5 */ -+#define IMR_BCNDOK4_8723B BIT(17) /* Beacon Queue DMA OK Interrupt 4 */ -+#define IMR_BCNDOK3_8723B BIT(16) /* Beacon Queue DMA OK Interrupt 3 */ -+#define IMR_BCNDOK2_8723B BIT(15) /* Beacon Queue DMA OK Interrupt 2 */ -+#define IMR_BCNDOK1_8723B BIT(14) /* Beacon Queue DMA OK Interrupt 1 */ -+#define IMR_ATIMEND_E_8723B BIT(13) /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8723B BIT(11) /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8723B BIT(10) /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8723B BIT(9) /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8723B BIT(8) /* 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 -+ -+#endif /* __RTL8723B_SPEC_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723b_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtl8723b_sreset.h -new file mode 100644 -index 000000000..c97f2648a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723b_sreset.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8723b_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8723b_xmit.h -new file mode 100755 -index 000000000..51691e931 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723b_xmit.h -@@ -0,0 +1,342 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+ -+#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 */ -+ #ifdef CONFIG_PCI_HCI -+ #define SET_TX_DESC_TX_BUFFER_SIZE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+ #endif -+ #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) -+ #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) -+ #ifdef CONFIG_SDIO_HCI -+ #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); -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); -+ -+#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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8723bs_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8723bu_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8723be_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8723d_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtl8723d_cmd.h -new file mode 100644 -index 000000000..9c65b4b9e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723d_cmd.h -@@ -0,0 +1,183 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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) -+ -+/* _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_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) -+#define SET_8723D_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 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((u8 *)(__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); -+/* s32 rtl8723d_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ -+void rtl8723d_set_FwPsTuneParam_cmd(PADAPTER padapter); -+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 */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+ void rtl8723d_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+s32 FillH2CCmd8723D(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8723D(_adapter *padapter, bool wowlan); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723d_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8723d_dm.h -new file mode 100644 -index 000000000..0612f0620 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723d_dm.h -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723d_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8723d_hal.h -new file mode 100644 -index 000000000..d18e9abc9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723d_hal.h -@@ -0,0 +1,303 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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_CAM_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:MAX_BEACON_LEN/PAGE_SIZE_TX_8723D -+ * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ -+ -+#define BCNQ_PAGE_NUM_8723D (MAX_BEACON_LEN/PAGE_SIZE_TX_8723D + 6) /*0x08*/ -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt 1, PNO: 6 -+ * NS offload: 2 NDP info: 1 -+ */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8723D 0x0b -+#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 - 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 -+#define NORMAL_PAGE_NUM_EPQ_8723D 0x04 -+ -+/* 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 -+#define WMM_NORMAL_PAGE_NUM_EPQ_8723D 0x00 -+ -+ -+#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_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); -+u8 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 _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(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_txbd_rw_reg(u16 ff_hwaddr); -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723d_led.h b/drivers/net/wireless/rtl8821cs/include/rtl8723d_led.h -new file mode 100644 -index 000000000..1905e8bed ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723d_led.h -@@ -0,0 +1,44 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8723D_LED_H__ -+#define __RTL8723D_LED_H__ -+ -+#include -+#include -+#include -+ -+#ifdef CONFIG_RTW_SW_LED -+/* ******************************************************************************** -+ * 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 /*#ifdef CONFIG_RTW_SW_LED*/ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723d_lps_poff.h b/drivers/net/wireless/rtl8821cs/include/rtl8723d_lps_poff.h -new file mode 100644 -index 000000000..138a0ca66 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723d_lps_poff.h -@@ -0,0 +1,56 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+ -+/******************************************** 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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8723d_recv.h b/drivers/net/wireless/rtl8821cs/include/rtl8723d_recv.h -new file mode 100644 -index 000000000..f19ad6904 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723d_recv.h -@@ -0,0 +1,112 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 -+ #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 /* !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); -+ s32 rtl8723ds_recv_hdl(_adapter *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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8723d_rf.h b/drivers/net/wireless/rtl8821cs/include/rtl8723d_rf.h -new file mode 100644 -index 000000000..4a0a7cfb8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723d_rf.h -@@ -0,0 +1,21 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8723D_RF_H__ -+#define __RTL8723D_RF_H__ -+ -+int PHY_RF6052_Config8723D(PADAPTER pdapter); -+ -+void PHY_RF6052SetBandwidth8723D(PADAPTER Adapter, enum channel_width Bandwidth); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723d_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8723d_spec.h -new file mode 100644 -index 000000000..5106b23b7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723d_spec.h -@@ -0,0 +1,447 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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_CFG1_8723D 0x00F0 -+#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 -+ -+/* LTR */ -+#define REG_LTR_CTRL_BASIC_8723D 0x07A4 -+#define REG_LTR_IDLE_LATENCY_V1_8723D 0x0798 -+#define REG_LTR_ACTIVE_LATENCY_V1_8723D 0x079C -+ -+/* 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 */ -+ -+ -+/* **************************************************************************** -+ * 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 -+ -+#endif /* __RTL8723D_SPEC_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723d_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtl8723d_sreset.h -new file mode 100644 -index 000000000..db75dba73 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723d_sreset.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8723d_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8723d_xmit.h -new file mode 100644 -index 000000000..6f84515ef ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723d_xmit.h -@@ -0,0 +1,530 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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_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_NAV_USE_HDR_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __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 */ -+#ifdef CONFIG_PCI_HCI -+#define SET_TX_DESC_TX_BUFFER_SIZE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+ -+#ifdef CONFIG_USB_HCI -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+#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); -+ -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); -+ -+#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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8723ds_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8723du_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ s32 rtl8723du_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8723du_xmit_tasklet(unsigned long 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8723de_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8723f_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8723f_hal.h -new file mode 100644 -index 000000000..d39e9ac07 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723f_hal.h -@@ -0,0 +1,245 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2019 - 2021 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8723F_HAL_H_ -+#define _RTL8723F_HAL_H_ -+ -+#include /* BIT(x) */ -+#include /* PADAPTER */ -+#include "../hal/halmac-rs/halmac_api.h" /* MAC REG definition */ -+ -+#define MAX_RECVBUF_SZ 16384 /* 16KB (RX_FIFO_SIZE_8723F), TX: 32KB */ -+ -+/* -+ * MAC Register definition -+ */ -+#define REG_LEDCFG0 REG_LED_CFG_8723F /* rtw_mp.c */ -+#define MSR (REG_CR_8723F + 2) /* rtw_mp.c & hal_com.c */ -+#define MSR1 REG_CR_EXT_8723F /* 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_8723F /* hal_com.c */ -+ -+#define REG_WOWLAN_WAKE_REASON 0x01C7 /* hal_com.c */ -+#define REG_GPIO_PIN_CTRL_2 REG_GPIO_EXT_CTRL_8723F /* hal_com.c */ -+#define REG_FIFOPAGE REG_FIFOPAGE_INFO_8723F /* hal_com.c */ -+#define REG_RXPKTBUF_CTRL REG_PKTBUF_DBG_CTRL_8723F /* hal_com.c */ -+#define REG_WKFMCAM_NUM REG_WKFMCAM_CMD_8723F /* hal_com.c */ -+#define REG_RSV_CTRL REG_REG_ACCESS_CTRL_8723F /* hal_com.c */ -+#define REG_CAMCMD REG_KEYCAMCMD_8723F /* hal_com.c */ -+#define REG_CAMWRITE REG_KEYCAM_WD_8723F /* hal_com.c */ -+ -+#define BIT_AUTO_SYNC_BY_TBTT BIT_EN_TSFAUTO_SYNC_8723F /* hal_com.c */ -+#define BIT_DIS_ATIM_ROOT_8723F 23 /* REG_HIQ_NO_LMT_EN_V2[23], disable ATIM ROOT */ -+#define BIT_SECCAM_POLLING_8723F BIT_KEYCAM_POLLING_8723F /* rtl8723f_ops.c */ -+#define BIT_GET_NETYPE2 BIT_GET_P2_NETSTATE_8723F /* hal_halmac.c */ -+#define BIT_GET_NETYPE3 BIT_GET_P3_NETSTATE_8723F /* hal_halmac.c */ -+#define BIT_GET_NETYPE4 BIT_GET_P4_NETSTATE_8723F /* hal_halmac.c */ -+ -+#ifdef CONFIG_WOW_PATTERN_IN_TXFIFO -+#define WKCAM_OFFSET_BIT_MASK 0xFFF -+#define WKCAM_OFFSET_BIT_MASK_OFFSET 12 -+#define REG_TXBUF_WKCAM_OFFSET 0x1B4 //BIT_TXBUF_WKCAM_OFFSET [24:12] -+#define REG_PKT_BUFF_ACCESS_CTRL 0x106 /* hal_com.c */ -+#endif -+ -+/* 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_8723F -+#define RXERR_RPT_RST BIT_RXERR_RPT_RST_8723F -+#define _RXERR_RPT_SEL(type) (BIT_RXERR_RPT_SEL_V1_3_0_8723F(type) \ -+ | ((type & 0x10) ? BIT_RXERR_RPT_SEL_V1_4_8723F : 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 (rtl8723f_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_8723F 0x93C /* rtl8723f_phy.c */ -+#define REG_BB_TX_PATH_SEL_2_8723F 0x940 /* rtl8723f_phy.c */ -+ -+/* TX BeamForming */ -+#define REG_BB_TXBF_ANT_SET_BF1_8723F 0x19AC /* rtl8723f_phy.c */ -+#define REG_BB_TXBF_ANT_SET_BF0_8723F 0x19B4 /* rtl8723f_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 rOFDM1_LSTF 0xD00 -+#define rOFDM1_TRxPathEnable 0xD04 /* hal_mp.c */ -+#define rA_PIRead_Jaguar 0xD04 /* RF readback with PI (rtl8723f_phy.c) */ -+#define rA_SIRead_Jaguar 0xD08 /* RF readback with SI (rtl8723f_phy.c) */ -+#define rB_PIRead_Jaguar 0xD44 /* RF readback with PI (rtl8723f_phy.c) */ -+#define rB_SIRead_Jaguar 0xD48 /* RF readback with SI (rtl8723f_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) */ -+/* RFE */ -+#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ -+#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 rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ -+#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ -+#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 -+ -+/* 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 /* rtl8723f_phy.c */ -+#define RF_ModeTableAddr 0x30 /* rtl8723f_phy.c */ -+#define RF_ModeTableData0 0x31 /* rtl8723f_phy.c */ -+#define RF_ModeTableData1 0x32 /* rtl8723f_phy.c */ -+#define RF_0x52 0x52 -+#define RF_WeLut_Jaguar 0xEF /* rtl8723f_phy.c */ -+ -+/* rtw_lps_state_chk() @hal_com.c */ -+#define BIT_PWRBIT_OW_EN BIT_WMAC_TCR_PWRMGT_CTL_8723F -+ -+/* -+* General Functions -+*/ -+void rtl8723f_init_hal_spec(PADAPTER); /* hal/hal_com.c */ -+ -+#ifdef CONFIG_MP_INCLUDED -+/* MP Functions */ -+#include /* struct mp_priv */ -+void rtl8723f_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ -+void rtl8723f_mp_config_rfpath(PADAPTER); /* hal_mp.c */ -+#endif -+void hw_var_set_dl_rsvd_page(PADAPTER adapter, u8 mstatus); -+ -+#ifdef CONFIG_USB_HCI -+#include -+#elif defined(CONFIG_SDIO_HCI) -+#include -+#endif -+ -+#endif /* _RTL8723F_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723fs_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8723fs_hal.h -new file mode 100644 -index 000000000..f1b938af6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723fs_hal.h -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8723FS_HAL_H_ -+#define _RTL8723FS_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+/* rtl8723fs_ops.c */ -+void rtl8723fs_set_hal_ops(PADAPTER); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtl8723fs_disable_interrupt_but_cpwm2(PADAPTER adapter); -+#endif -+ -+/* rtl8723fs_xmit.c */ -+s32 rtl8723fs_dequeue_writeport(PADAPTER); -+#define _dequeue_writeport(a) rtl8723fs_dequeue_writeport(a) -+ -+#endif /* _RTL8723FS_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8723fu_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8723fu_hal.h -new file mode 100644 -index 000000000..69de77600 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8723fu_hal.h -@@ -0,0 +1,61 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8723FU_HAL_H_ -+#define _RTL8723FU_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 -+ -+ /* undefine MAX_RECVBUF_SZ from rtl8723f_hal.h */ -+ #ifdef MAX_RECVBUF_SZ -+ #undef MAX_RECVBUF_SZ -+ #endif -+ -+ /* recv_buffer must be large than usb agg size */ -+ #ifndef MAX_RECVBUF_SZ -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ #define MAX_RECVBUF_SZ (15360) /* 15k */ -+ #elif defined(CONFIG_PLATFORM_HISILICON) -+ /* use 16k to workaround for HISILICON platform */ -+ #define MAX_RECVBUF_SZ (16384) -+ #else -+ #define MAX_RECVBUF_SZ (32768) -+ #endif -+ #else -+ #define MAX_RECVBUF_SZ (4000) -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+ /* rtl8723fu_ops.c */ -+ void rtl8723fu_set_hal_ops(PADAPTER padapter); -+ void rtl8723fu_set_hw_type(struct dvobj_priv *pdvobj); -+ -+ /* rtl8723fu_io.c */ -+ void rtl8723fu_set_intf_ops(struct _io_ops *pops); -+ -+#endif /* CONFIG_USB_HCI */ -+ -+ -+#endif /* _RTL8723FU_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8812a_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtl8812a_cmd.h -new file mode 100644 -index 000000000..4a3473683 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8812a_cmd.h -@@ -0,0 +1,152 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 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 cmn_sta_info *cmn_sta_info, BOOLEAN bLDPC); -+ -+/* host message to firmware cmd */ -+s32 fill_h2c_cmd_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_wowlan_cmd(_adapter *padapter, u8 enable); -+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 -+ -+/* ------------------------------------ -+ * 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((u8 *)(__pH2CCmd), 0, 16, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((u8 *)(__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((u8 *)(__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((u8 *)(__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((u8 *)(__pH2CCmd)+5, 0, 8, __Value) -+ -+s32 c2h_handler_8812a(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); -+ -+#endif/* __RTL8812A_CMD_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8812a_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8812a_dm.h -new file mode 100644 -index 000000000..21a9abaa6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8812a_dm.h -@@ -0,0 +1,27 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_DM_H__ -+#define __RTL8812A_DM_H__ -+ -+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(PADAPTER Adapter); */ -+ -+/* void rtl8192c_dm_RF_Saving(PADAPTER pAdapter, u8 bForceInNormal); */ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8812a_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8812a_hal.h -new file mode 100644 -index 000000000..3082c67c9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8812a_hal.h -@@ -0,0 +1,369 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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_CAM_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 PAGE_SIZE_TX_8812A PAGE_SIZE_512 -+ -+/* Beacon:MAX_BEACON_LEN/PAGE_SIZE_TX_8812A -+ * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ -+#define BCNQ_PAGE_NUM_8812 (MAX_BEACON_LEN / PAGE_SIZE_TX_8812A + 6) /*0x07*/ -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, AOAC rpt: 1,PNO: 6 -+ * NS offload: 1 NDP info: 1 -+ */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8812 0x08 -+#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 -+ -+#ifdef DBG_FW_DEBUG_MSG_PKT -+ #define FW_DBG_MSG_PKT_PAGE_NUM_8812 0x01 -+#else -+ #define FW_DBG_MSG_PKT_PAGE_NUM_8812 0x00 -+#endif /*DBG_FW_DEBUG_MSG_PKT*/ -+ -+#define TX_TOTAL_PAGE_NUMBER_8812 (0xFF - BCNQ_PAGE_NUM_8812 - WOWLAN_PAGE_NUM_8812 - FW_NDPA_PAGE_NUM - FW_DBG_MSG_PKT_PAGE_NUM_8812) -+#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) -+ -+/* Beacon:MAX_BEACON_LEN/PAGE_SIZE_TX_8821A -+ * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ -+ -+#define BCNQ_PAGE_NUM_8821 (MAX_BEACON_LEN / PAGE_SIZE_TX_8821A + 6) /*0x08*/ -+ -+ -+/* 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 - 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 NORMAL_PAGE_NUM_EPQ_8821 0x04 -+ -+#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 WMM_NORMAL_PAGE_NUM_EPQ_8821 0x00 -+ -+#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) ) */ -+#define HAL_EFUSE_MEMORY -+ -+/* ******************************************************** -+ * EFUSE for BT definition -+ * ******************************************************** */ -+#define BANK_NUM 2 -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 -+#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) -+ -+#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); -+ -+u8 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); -+ -+u32 upload_txpktbuf_8812au(_adapter *adapter, u8 *buf, u32 buflen); -+ -+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); -+void InitTRXDescHwAddress8812AE(PADAPTER Adapter); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+void rtl8812a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); -+#endif -+ -+void -+Hal_PatchwithJaguar_8812( -+ PADAPTER Adapter, -+ RT_MEDIA_STATUS MediaStatus -+); -+ -+#endif /* __RTL8188E_HAL_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8812a_led.h b/drivers/net/wireless/rtl8821cs/include/rtl8812a_led.h -new file mode 100644 -index 000000000..30c676e52 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8812a_led.h -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+#ifdef CONFIG_RTW_LED -+#ifdef CONFIG_RTW_SW_LED -+/* ******************************************************************************** -+ * 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/*CONFIG_RTW_SW_LED*/ -+#endif/*#ifdef CONFIG_RTW_LED*/ -+ -+#ifdef CONFIG_SDIO_HCI -+void rtl8821as_init_led_circuit(PADAPTER adapter); -+#endif -+ -+#endif /*__RTL8812A_LED_H__*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8812a_recv.h b/drivers/net/wireless/rtl8821cs/include/rtl8812a_recv.h -new file mode 100644 -index 000000000..5fa06e512 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8812a_recv.h -@@ -0,0 +1,149 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #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 /* !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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8812a_rf.h b/drivers/net/wireless/rtl8821cs/include/rtl8812a_rf.h -new file mode 100644 -index 000000000..c5d9aaee3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8812a_rf.h -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+PHY_RF6052SetBandwidth8812( -+ PADAPTER Adapter, -+ enum channel_width Bandwidth); -+ -+ -+int -+PHY_RF6052_Config_8812( -+ PADAPTER Adapter); -+ -+#endif/* __RTL8188E_RF_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8812a_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8812a_spec.h -new file mode 100644 -index 000000000..37ba24722 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8812a_spec.h -@@ -0,0 +1,263 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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_HRPWM_8812A 0x0361 /* PCIe RPWM */ -+#define REG_PCIE_HCPWM_8812A 0x0363 /* PCIe CPWM */ -+ -+#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) -+ -+#endif /* __RTL8812A_SPEC_H__ */ -+ -+#ifdef CONFIG_RTL8821A -+#include "rtl8821a_spec.h" -+#endif /* CONFIG_RTL8821A */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8812a_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtl8812a_sreset.h -new file mode 100644 -index 000000000..d4bbd5867 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8812a_sreset.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8812a_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8812a_xmit.h -new file mode 100755 -index 000000000..f115d0f61 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8812a_xmit.h -@@ -0,0 +1,371 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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); -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_bmc_tx_rate(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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+s32 rtl8812au_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+s32 rtl8812au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); -+void rtl8812au_xmit_tasklet(unsigned long 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_RTW_MGMT_QUEUE -+s32 rtl8812ae_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+s32 rtl8812ae_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtl8812ae_xmit_tasklet(void *priv); -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+s32 rtl8812ae_xmit_buf_handler(_adapter *padapter); -+#endif -+ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8814a_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtl8814a_cmd.h -new file mode 100755 -index 000000000..02ed2111e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814a_cmd.h -@@ -0,0 +1,161 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 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) -+ -+/* AP_REQ_TXREP_CMD 0x43 */ -+#define SET_8814A_H2CCMD_TXREP_PARM_STA1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8814A_H2CCMD_TXREP_PARM_STA2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8814A_H2CCMD_TXREP_PARM_RTY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) -+ -+/* C2H_AP_REQ_TXRPT */ -+#define GET_8814A_C2H_TC2H_APREQ_TXRPT_MACID1(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 8) -+#define GET_8814A_C2H_TC2H_APREQ_TXRPT_TXOK1(_Header) LE_BITS_TO_2BYTE((_Header + 1), 0, 16) -+#define GET_8814A_C2H_TC2H_APREQ_TXRPT_TXFAIL1(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) -+#define GET_8814A_C2H_TC2H_APREQ_TXRPT_INIRATE1(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) -+#define GET_8814A_C2H_TC2H_APREQ_TXRPT_MACID2(_Header) LE_BITS_TO_1BYTE((_Header + 6), 0, 8) -+#define GET_8814A_C2H_TC2H_APREQ_TXRPT_TXOK2(_Header) LE_BITS_TO_2BYTE((_Header + 7), 0, 16) -+#define GET_8814A_C2H_TC2H_APREQ_TXRPT_TXFAIL2(_Header) LE_BITS_TO_2BYTE((_Header + 9), 0, 16) -+#define GET_8814A_C2H_TC2H_APREQ_TXRPT_INIRATE2(_Header) LE_BITS_TO_1BYTE((_Header + 11), 0, 8) -+ -+/* C2H_SPC_STAT */ -+#define GET_8814A_C2H_SPC_STAT_IDX(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 8) -+ /* Tip :TYPE_A data3 is msb and data0 is lsb */ -+#define GET_8814A_C2H_SPC_STAT_TYPEA_RETRY(_Header) LE_BITS_TO_4BYTE((_Header + 1), 0, 32) -+#define GET_8814A_C2H_SPC_STAT_TYPEB_PKT1(_Header) LE_BITS_TO_2BYTE((_Header + 1), 0, 16) -+#define GET_8814A_C2H_SPC_STAT_TYPEB_RETRY1(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) -+#define GET_8814A_C2H_SPC_STAT_TYPEB_PKT2(_Header) LE_BITS_TO_2BYTE((_Header + 5), 0, 16) -+#define GET_8814A_C2H_SPC_STAT_TYPEB_RETRY2(_Header) LE_BITS_TO_2BYTE((_Header + 7), 0, 16) -+ -+/*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_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); -+void rtl8814_req_txrpt_cmd(PADAPTER padapter, u8 macid); -+ -+void rtl8814a_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+ -+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_BT_COEXIST -+void rtl8814a_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif /* CONFIG_BT_COEXIST */ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8814a_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8814a_dm.h -new file mode 100644 -index 000000000..9762c1b41 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814a_dm.h -@@ -0,0 +1,23 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8814A_DM_H__ -+#define __RTL8814A_DM_H__ -+ -+void rtl8814_init_dm_priv(PADAPTER Adapter); -+void rtl8814_deinit_dm_priv(PADAPTER Adapter); -+void rtl8814_InitHalDm(PADAPTER Adapter); -+void rtl8814_HalDmWatchDog(PADAPTER Adapter); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8814a_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8814a_hal.h -new file mode 100755 -index 000000000..65552e216 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814a_hal.h -@@ -0,0 +1,331 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 -+/* BCN rsvd_page_num = MAX_BEACON_LEN / PAGE_SIZE_TX_8814 -+ * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ -+ -+#define BCNQ_PAGE_NUM_8814 (MAX_BEACON_LEN / PAGE_SIZE_TX_8814 + 6) /*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 0x06 -+#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 TX_BD_NUM /* 128 */ -+ #define RX_DESC_NUM_8814A PCI_MAX_RX_COUNT /* 128 */ -+ #ifdef CONFIG_CONCURRENT_MODE -+ #define BE_QUEUE_TX_DESC_NUM_8814A (TX_BD_NUM<<1) /* 256 */ -+ #else -+ #define BE_QUEUE_TX_DESC_NUM_8814A (TX_BD_NUM+(TX_BD_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. */ -+ -+#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 /* CONFIG_MP_INCLUDED */ -+#endif /* CONFIG_FILE_FWIMG */ -+ -+/* rtl8814_hal_init.c */ -+s32 FirmwareDownload8814A(PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); -+void InitializeFirmwareVars8814(PADAPTER padapter); -+ -+void -+Hal_InitEfuseVars_8814A( -+ PADAPTER Adapter -+); -+ -+s32 InitLLTTable8814A( -+ PADAPTER Adapter -+); -+ -+ -+void InitRDGSetting8814A(PADAPTER padapter); -+ -+/* void CheckAutoloadState8812A(PADAPTER padapter); */ -+ -+/* EFuse */ -+u8 GetEEPROMSize8814A(PADAPTER padapter); -+void hal_InitPGData_8814A( -+ PADAPTER padapter, -+ 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( -+ PADAPTER Adapter -+); -+void hal_ReadPAType_8814A( -+ PADAPTER Adapter, -+ u8 *PROMContent, -+ BOOLEAN AutoloadFail, -+ u8 *pPAType, -+ u8 *pLNAType -+); -+ -+void hal_GetRxGainOffset_8814A( -+ PADAPTER Adapter, -+ u8 *PROMContent, -+ BOOLEAN AutoloadFail -+); -+void Hal_EfuseParseKFreeData_8814A( -+ PADAPTER Adapter, -+ u8 *PROMContent, -+ 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); -+ -+u8 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); -+ -+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); -+ void InitMAC_TRXBD_8814AE(PADAPTER Adapter); -+ void rtl8814ae_reset_desc_ring(_adapter *padapter); -+ u16 get_txbd_rw_reg(u16 ff_hwaddr); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ void rtl8814a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); -+#endif -+ -+void rtl8814ae_hci_flush(PADAPTER Adapter, u32 queue); -+ -+#endif /* __RTL8188E_HAL_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8814a_led.h b/drivers/net/wireless/rtl8821cs/include/rtl8814a_led.h -new file mode 100644 -index 000000000..cc457921e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814a_led.h -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8814A_LED_H__ -+#define __RTL8814A_LED_H__ -+ -+#ifdef CONFIG_RTW_SW_LED -+/* ******************************************************************************** -+ * 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__ */ -+#endif /*CONFIG_RTW_SW_LED*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8814a_recv.h b/drivers/net/wireless/rtl8821cs/include/rtl8814a_recv.h -new file mode 100755 -index 000000000..68da63331 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814a_recv.h -@@ -0,0 +1,182 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8814A_RECV_H__ -+#define __RTL8814A_RECV_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 -+ #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 /* !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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8814a_rf.h b/drivers/net/wireless/rtl8821cs/include/rtl8814a_rf.h -new file mode 100644 -index 000000000..9bb099c92 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814a_rf.h -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8814A_RF_H__ -+#define __RTL8814A_RF_H__ -+ -+void -+PHY_RF6052SetBandwidth8814A( -+ PADAPTER Adapter, -+ enum channel_width Bandwidth); -+ -+ -+int -+PHY_RF6052_Config_8814A( -+ PADAPTER Adapter); -+ -+#endif/* __RTL8188E_RF_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8814a_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8814a_spec.h -new file mode 100755 -index 000000000..a27ab8872 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814a_spec.h -@@ -0,0 +1,653 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 -+ -+#define REG_CPU_DMEM_CON_8814A 0x1080 -+ -+/**** 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 REG_Q0_Q1_INFO_8814A 0x1400 -+#define REG_Q2_Q3_INFO_8814A 0x1404 -+#define REG_Q4_Q5_INFO_8814A 0x1408 -+#define REG_Q6_Q7_INFO_8814A 0x140C -+#define REG_MGQ_HIQ_INFO_8814A 0x1410 -+#define REG_CMDQ_BCNQ_INFO_8814A 0x1414 -+ -+#define REG_MACID_DROP0_8814A 0x1450 -+#define REG_MACID_DROP1_8814A 0x1454 -+#define REG_MACID_DROP2_8814A 0x1458 -+#define REG_MACID_DROP3_8814A 0x145C -+ -+#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 /* 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 */ -+ -+#endif /* __RTL8814A_SPEC_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8814a_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtl8814a_sreset.h -new file mode 100644 -index 000000000..d65cb98a5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814a_sreset.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8814a_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8814a_xmit.h -new file mode 100755 -index 000000000..8901fdeab ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814a_xmit.h -@@ -0,0 +1,315 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 */ -+#ifdef CONFIG_PCI_HCI -+ #define SET_TX_DESC_TX_BUFFER_SIZE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+#if defined(CONFIG_SDIO_HCI)|| defined(CONFIG_USB_HCI) -+ #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 defined(CONFIG_PCI_HCI)|| defined(CONFIG_USB_HCI) -+ #define SET_TX_DESC_NEXT_HEAD_PAGE_L_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) -+#endif -+#ifdef CONFIG_SDIO_HCI -+ #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); -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_bmc_tx_rate(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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8814au_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ 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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ s32 rtl8814ae_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ s32 rtl8814ae_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8814ae_xmit_tasklet(void *priv); -+#ifdef CONFIG_XMIT_THREAD_MODE -+ s32 rtl8814ae_xmit_buf_handler(_adapter *padapter); -+#endif -+#endif -+ -+void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, u8 *ptxdesc); -+u8 -+SCMapping_8814( -+ PADAPTER Adapter, -+ struct pkt_attrib *pattrib -+); -+ -+u8 -+BWMapping_8814( -+ PADAPTER Adapter, -+ struct pkt_attrib *pattrib -+); -+ -+ -+#endif /* __RTL8814_XMIT_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8814b_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8814b_hal.h -new file mode 100755 -index 000000000..301d1a054 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814b_hal.h -@@ -0,0 +1,239 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8814B_HAL_H_ -+#define _RTL8814B_HAL_H_ -+ -+#include /* BIT(x) */ -+#include /* PADAPTER */ -+#include "../hal/halmac/halmac_api.h" /* MAC REG definition */ -+ -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+#define MAX_RECVBUF_SZ 46080 /* 45KB, TX: (256-64)KB */ -+#else /* !CONFIG_SUPPORT_TRX_SHARED */ -+#define MAX_RECVBUF_SZ 24576 /* 24KB, TX: 256KB */ -+#endif /* !CONFIG_SUPPORT_TRX_SHARED */ -+ -+#if 0 -+/* -+ * MAC Register definition -+ */ -+#define REG_AFE_XTAL_CTRL REG_AFE_CTRL1_8814B /* hal_com.c & phydm */ -+#define REG_AFE_PLL_CTRL REG_AFE_CTRL2_8814B /* hal_com.c & phydm */ -+#define REG_MAC_PHY_CTRL REG_AFE_CTRL3_8814B /* phydm only */ -+#endif -+#define REG_LEDCFG0 REG_LED_CFG_8814B /* rtw_mp.c */ -+#if 0 -+#define MSR (REG_CR_8814B + 2) /* rtw_mp.c & hal_com.c */ -+#define MSR1 REG_CR_EXT_8814B /* rtw_mp.c & hal_com.c */ -+#endif -+#define REG_C2HEVT_MSG_NORMAL 0x1A0 /* hal_com.c */ -+#if 0 -+#define REG_C2HEVT_CLEAR 0x1AF /* hal_com.c */ -+ -+#define REG_GPIO_PIN_CTRL_2 REG_GPIO_EXT_CTRL_8814B /* hal_com.c */ -+#endif -+#define REG_WKFMCAM_NUM REG_WKFMCAM_CMD_8814B /* hal_com.c: WOWLAN */ -+#define REG_WOWLAN_WAKE_REASON 0x01C7 /* hal_com.c: WOWLAN */ -+#define REG_RXPKTBUF_CTRL (REG_PKTBUF_DBG_CTRL_8814B + 2) /* hal_com.c: WOWLAN */ -+#define REG_RXPKT_NUM REG_RXDMA_CTRL_8814B /* hal_com.c: WOWLAN */ -+ -+/* 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_8814B -+#define RXERR_RPT_RST BIT_RXERR_RPT_RST_8814B -+#define _RXERR_RPT_SEL(type) (BIT_RXERR_RPT_SEL_V1_3_0_8814B(type) \ -+ | ((type & 0x10) ? BIT_RXERR_RPT_SEL_V1_4_8814B : 0)) -+ -+/* hal_com.c:rtw_lps_state_chk() */ -+#define BIT_PWRBIT_OW_EN BIT_WMAC_TCRPWRMGT_HWDATA_EN_8814B -+ -+/* -+ * 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 (rtl8814b_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_8814B 0x93C /* rtl8814b_phy.c */ -+#define REG_BB_TX_PATH_SEL_2_8814B 0x940 /* rtl8814b_phy.c */ -+ -+/* TX BeamForming */ -+#define REG_BB_TXBF_ANT_SET_BF1_8814B 0x19AC /* rtl8814b_phy.c */ -+#define REG_BB_TXBF_ANT_SET_BF0_8814B 0x19B4 /* rtl8814b_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 (rtl8814b_phy.c) */ -+ -+#define rOFDM1_LSTF 0xD00 -+#define rOFDM1_TRxPathEnable 0xD04 /* hal_mp.c */ -+#define rA_PIRead_Jaguar 0xD04 /* RF readback with PI (rtl8814b_phy.c) */ -+#define rA_SIRead_Jaguar 0xD08 /* RF readback with SI (rtl8814b_phy.c) */ -+#define rB_PIRead_Jaguar 0xD44 /* RF readback with PI (rtl8814b_phy.c) */ -+#define rB_SIRead_Jaguar 0xD48 /* RF readback with SI (rtl8814b_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 (rtl8814b_phy.c) */ -+/* RFE */ -+#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ -+#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 rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ -+#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ -+#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 -+ -+/* 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 /* rtl8814b_phy.c */ -+#define RF_ModeTableAddr 0x30 /* rtl8814b_phy.c */ -+#define RF_ModeTableData0 0x31 /* rtl8814b_phy.c */ -+#define RF_ModeTableData1 0x32 /* rtl8814b_phy.c */ -+#define RF_0x52 0x52 -+#define RF_WeLut_Jaguar 0xEF /* rtl8814b_phy.c */ -+ -+/* General Functions */ -+void rtl8814b_init_hal_spec(PADAPTER); /* hal/hal_com.c */ -+ -+#ifdef CONFIG_MP_INCLUDED -+/* MP Functions */ -+#include /* struct mp_priv */ -+void rtl8814b_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ -+void rtl8814b_mp_config_rfpath(PADAPTER); /* hal_mp.c */ -+#endif -+void hw_var_set_dl_rsvd_page(PADAPTER adapter, u8 mstatus); -+ -+#ifdef CONFIG_USB_HCI -+#include -+#elif defined(CONFIG_PCI_HCI) -+#include -+#endif -+ -+#endif /* _RTL8814B_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8814be_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8814be_hal.h -new file mode 100644 -index 000000000..3e124cae6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814be_hal.h -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8814BE_HAL_H_ -+#define _RTL8814BE_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+#define RT_BCN_INT_MASKS (BIT_BCNDMAINT0_MSK_8814B | \ -+ BIT_TXBCN0OK_MSK_8814B | \ -+ BIT_TXBCN0ERR_MSK_8814B | \ -+ BIT_BCNDERR0_MSK_8814B) -+ -+/* rtl8814be_ops.c */ -+void UpdateInterruptMask8814BE(PADAPTER, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+u16 get_txbd_rw_reg(u16 q_idx); -+ -+ -+#endif /* _RTL8814BE_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8814bu_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8814bu_hal.h -new file mode 100755 -index 000000000..aa5cef998 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8814bu_hal.h -@@ -0,0 +1,61 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8814BU_HAL_H_ -+#define _RTL8814BU_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 -+ -+ /* undefine MAX_RECVBUF_SZ from rtl8822c_hal.h */ -+ #ifdef MAX_RECVBUF_SZ -+ #undef MAX_RECVBUF_SZ -+ #endif -+ -+ /* recv_buffer must be large than usb agg size */ -+ #ifndef MAX_RECVBUF_SZ -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ #define MAX_RECVBUF_SZ (15360) /* 15k */ -+ #elif defined(CONFIG_PLATFORM_HISILICON) -+ /* use 16k to workaround for HISILICON platform */ -+ #define MAX_RECVBUF_SZ (16384) -+ #else -+ #define MAX_RECVBUF_SZ (32768) -+ #endif -+ #else -+ #define MAX_RECVBUF_SZ (4000) -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+ /* rtl8814bu_ops.c */ -+ void rtl8814bu_set_hal_ops(PADAPTER padapter); -+ void rtl8814bu_set_hw_type(struct dvobj_priv *pdvobj); -+ -+ /* rtl8814bu_io.c */ -+ void rtl8814bu_set_intf_ops(struct _io_ops *pops); -+ -+#endif /* CONFIG_USB_HCI */ -+ -+ -+#endif /* _RTL8814BU_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8821a_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8821a_spec.h -new file mode 100644 -index 000000000..1379ffc3c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8821a_spec.h -@@ -0,0 +1,90 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 -+ * ----------------------------------------------------- */ -+#define SDIO_REG_FREE_TXPG2 0x024 -+#define SDIO_REG_HCPWM1_8821A 0x025 -+ -+/* ************************************************************ -+ * Regsiter Bit and Content definition -+ * ************************************************************ */ -+ -+#endif /* __RTL8821A_SPEC_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8821a_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtl8821a_xmit.h -new file mode 100644 -index 000000000..28323b79c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8821a_xmit.h -@@ -0,0 +1,176 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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; -+ -+#ifdef CONFIG_SDIO_HCI -+s32 InitXmitPriv8821AS(PADAPTER padapter); -+void FreeXmitPriv8821AS(PADAPTER padapter); -+s32 XmitBufHandler8821AS(PADAPTER padapter); -+s32 MgntXmit8821AS(PADAPTER padapter, struct xmit_frame *pmgntframe); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+s32 rtl8821as_hal_mgmt_xmit_enqueue(PADAPTER adapter, struct xmit_frame *pxmitframe); -+#endif -+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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8821c_dm.h b/drivers/net/wireless/rtl8821cs/include/rtl8821c_dm.h -new file mode 100644 -index 000000000..b1e4fe608 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8821c_dm.h -@@ -0,0 +1,23 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8812C_DM_H__ -+#define __RTL8812C_DM_H__ -+ -+void rtl8821c_phy_init_dm_priv(PADAPTER); -+void rtl8821c_phy_deinit_dm_priv(PADAPTER); -+void rtl8821c_phy_init_haldm(PADAPTER); -+void rtl8821c_phy_haldm_watchdog(PADAPTER); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8821c_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8821c_hal.h -new file mode 100644 -index 000000000..41d222ef3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8821c_hal.h -@@ -0,0 +1,84 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821C_HAL_H_ -+#define _RTL8821C_HAL_H_ -+ -+#include /* BIT(x) */ -+#include "../hal/halmac/halmac_api.h" /* MAC REG definition */ -+#include "hal_data.h" -+#include "rtl8821c_spec.h" -+#include "../hal/rtl8821c/hal8821c_fw.h" -+ -+#ifdef CONFIG_USB_HCI -+#include -+#endif -+#ifdef CONFIG_SDIO_HCI -+#include -+#endif -+#ifdef CONFIG_PCI_HCI -+#include -+#endif -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+#define FIFO_BLOCK_SIZE 32768 /*@Block size = 32K*/ -+#define RX_FIFO_EXPANDING (1 * FIFO_BLOCK_SIZE) -+#else -+#define RX_FIFO_EXPANDING 0 -+#endif -+ -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ /* 8821C - RX FIFO :16K ,for RX agg DMA mode = 16K, Rx agg USB mode could large than 16k*/ -+ /* #define MAX_RECVBUF_SZ (16384 + RX_FIFO_EXPANDING)*/ -+ /* For Max throughput issue , need to use USB AGG mode to replace DMA AGG mode*/ -+ #define MAX_RECVBUF_SZ (32768) -+ -+ /*#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 + RX_FIFO_EXPANDING) /* 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 + RX_FIFO_EXPANDING) /* about 4K */ -+ /*#endif*/ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ #define MAX_RECVBUF_SZ (16384 + RX_FIFO_EXPANDING) -+#endif -+ -+void init_hal_spec_rtl8821c(PADAPTER); -+/* MP Functions */ -+#ifdef CONFIG_MP_INCLUDED -+void rtl8821c_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ -+void rtl8821c_mp_config_rfpath(PADAPTER); /* hal_mp.c */ -+#endif -+void rtl8821c_dl_rsvd_page(PADAPTER adapter, u8 mstatus); -+ -+#ifdef CONFIG_PCI_HCI -+u16 get_txbd_rw_reg(u16 q_idx); -+#endif -+ -+#endif /* _RTL8821C_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8821c_spec.h b/drivers/net/wireless/rtl8821cs/include/rtl8821c_spec.h -new file mode 100644 -index 000000000..949f349b6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8821c_spec.h -@@ -0,0 +1,202 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __RTL8821C_SPEC_H__ -+#define __RTL8821C_SPEC_H__ -+ -+#define EFUSE_MAP_SIZE HALMAC_EFUSE_SIZE_8821C -+ -+/* -+ * MAC Register definition -+ */ -+#define REG_AFE_XTAL_CTRL REG_AFE_CTRL1_8821C /* hal_com.c & phydm */ -+#define REG_AFE_PLL_CTRL REG_AFE_CTRL2_8821C /* hal_com.c & phydm */ -+#define REG_MAC_PHY_CTRL REG_AFE_CTRL3_8821C /* phydm only */ -+#define REG_LEDCFG0 REG_LED_CFG_8821C /* rtw_mp.c */ -+#define MSR (REG_CR_8821C + 2) /* rtw_mp.c */ -+#define MSR1 REG_CR_EXT_8821C /* 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_8821C/* hal_com.c */ -+ -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_GPIO_PIN_CTRL_2 REG_GPIO_EXT_CTRL_8821C -+ -+/* 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_8821C -+#define RXERR_RPT_RST BIT_RXERR_RPT_RST_8821C -+#define _RXERR_RPT_SEL(type) (BIT_RXERR_RPT_SEL_V1_3_0_8821C(type) \ -+ | ((type & 0x10) ? BIT_RXERR_RPT_SEL_V1_4_8821C : 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 (rtl8821c_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 */ -+ -+#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 (rtl8821c_phy.c) */ -+/* RFE */ -+#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ -+#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 rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ -+#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ -+#define r_ANTSEL_SW_Jaguar 0x900 /* ANTSEL SW Control */ -+#define bMask_RFEInv_Jaguar 0x3FF00000 -+#define bMask_AntselPathFollow_Jaguar 0x00030000 -+ -+#define rOFDM1_LSTF 0xD00 -+#define rOFDM1_TRxPathEnable 0xD04 /* hal_mp.c */ -+#define rA_PIRead_Jaguar 0xD04 /* RF readback with PI (rtl8821c_phy.c) */ -+#define rA_SIRead_Jaguar 0xD08 /* RF readback with SI (rtl8821c_phy.c) */ -+#define rB_PIRead_Jaguar 0xD44 /* RF readback with PI (rtl8821c_phy.c) */ -+#define rB_SIRead_Jaguar 0xD48 /* RF readback with SI (rtl8821c_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 (rtl8821c_phy.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 /* rtl8821c_phy.c */ -+#define RF_0x52 0x52 -+ -+struct hw_port_reg { -+ u32 net_type; /*reg_offset*/ -+ u8 net_type_shift; -+ u32 macaddr; /*reg_offset*/ -+ u32 bssid; /*reg_offset*/ -+ u32 bcn_ctl; /*reg_offset*/ -+ u32 tsf_rst; /*reg_offset*/ -+ u8 tsf_rst_bit; -+ u32 bcn_space; /*reg_offset*/ -+ u8 bcn_space_shift; -+ u16 bcn_space_mask; -+ u32 ps_aid; /*reg_offset*/ -+ u32 ta; /*reg_offset*/ -+}; -+ -+#endif /* __RTL8192E_SPEC_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8821ce_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8821ce_hal.h -new file mode 100755 -index 000000000..426002a30 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8821ce_hal.h -@@ -0,0 +1,23 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CE_HAL_H_ -+#define _RTL8821CE_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+/* rtl8821ce_ops.c */ -+void rtl8821ce_set_hal_ops(PADAPTER); -+ -+#endif /* _RTL8821CE_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8821cs_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8821cs_hal.h -new file mode 100644 -index 000000000..ceecc15f9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8821cs_hal.h -@@ -0,0 +1,23 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8821CS_HAL_H_ -+#define _RTL8821CS_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+/* rtl8821cs_ops.c */ -+u8 rtl8821cs_set_hal_ops(PADAPTER); -+ -+#endif /* _RTL8821CS_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8821cu_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8821cu_hal.h -new file mode 100644 -index 000000000..aec437224 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8821cu_hal.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8822b_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8822b_hal.h -new file mode 100644 -index 000000000..68ad97041 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8822b_hal.h -@@ -0,0 +1,234 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8822B_HAL_H_ -+#define _RTL8822B_HAL_H_ -+ -+#include /* BIT(x) */ -+#include /* PADAPTER */ -+#include "../hal/halmac/halmac_api.h" /* MAC REG definition */ -+ -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+#define MAX_RECVBUF_SZ 46080 /* 45KB, TX: (256-64)KB */ -+#else /* !CONFIG_SUPPORT_TRX_SHARED */ -+#ifdef CONFIG_PCI_HCI -+#define MAX_RECVBUF_SZ 12288 /* 12KB */ -+#else -+#define MAX_RECVBUF_SZ 24576 /* 24KB, TX: 256KB */ -+#endif /* !CONFIG_PCI_HCI */ -+#endif /* !CONFIG_SUPPORT_TRX_SHARED */ -+ -+/* -+ * 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_WOWLAN_WAKE_REASON 0x01C7 /* hal_com.c */ -+#define REG_GPIO_PIN_CTRL_2 REG_GPIO_EXT_CTRL_8822B /* hal_com.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 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) */ -+/* RFE */ -+#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ -+#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 rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ -+#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ -+#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 -+ -+/* 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_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ -+void rtl8822b_mp_config_rfpath(PADAPTER); /* hal_mp.c */ -+#endif -+void hw_var_set_dl_rsvd_page(PADAPTER adapter, u8 mstatus); -+ -+#ifdef CONFIG_USB_HCI -+#include -+#elif defined(CONFIG_SDIO_HCI) -+#include -+#elif defined(CONFIG_PCI_HCI) -+#include -+#endif -+ -+#endif /* _RTL8822B_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8822be_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8822be_hal.h -new file mode 100755 -index 000000000..a81445fa1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8822be_hal.h -@@ -0,0 +1,27 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _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); -+u16 get_txbd_rw_reg(u16 q_idx); -+ -+ -+#endif /* _RTL8822BE_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8822bs_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8822bs_hal.h -new file mode 100644 -index 000000000..ffaddee09 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8822bs_hal.h -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8822BS_HAL_H_ -+#define _RTL8822BS_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+/* rtl8822bs_ops.c */ -+void rtl8822bs_set_hal_ops(PADAPTER); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtl8822bs_disable_interrupt_but_cpwm2(PADAPTER adapter); -+#endif -+ -+/* rtl8822bs_xmit.c */ -+s32 rtl8822bs_dequeue_writeport(PADAPTER); -+#define _dequeue_writeport(a) rtl8822bs_dequeue_writeport(a) -+ -+#endif /* _RTL8822BS_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8822bu_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8822bu_hal.h -new file mode 100644 -index 000000000..b040f3b33 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8822bu_hal.h -@@ -0,0 +1,61 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _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 -+ -+ /* undefine MAX_RECVBUF_SZ from rtl8822b_hal.h */ -+ #ifdef MAX_RECVBUF_SZ -+ #undef MAX_RECVBUF_SZ -+ #endif -+ -+ /* recv_buffer must be large than usb agg size */ -+ #ifndef MAX_RECVBUF_SZ -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ #define MAX_RECVBUF_SZ (15360) /* 15k */ -+ #elif defined(CONFIG_PLATFORM_HISILICON) || defined(CONFIG_PLATFORM_ARM_RTD299X) -+ /* use 16k to workaround for HISILICON and RTK TV platform */ -+ #define MAX_RECVBUF_SZ (16384) -+ #else -+ #define MAX_RECVBUF_SZ (32768) -+ #endif -+ #else -+ #define MAX_RECVBUF_SZ (4000) -+ #endif -+ #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 --git a/drivers/net/wireless/rtl8821cs/include/rtl8822c_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8822c_hal.h -new file mode 100755 -index 000000000..0230d934f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8822c_hal.h -@@ -0,0 +1,246 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8822C_HAL_H_ -+#define _RTL8822C_HAL_H_ -+ -+#include /* BIT(x) */ -+#include /* PADAPTER */ -+#include "../hal/halmac/halmac_api.h" /* MAC REG definition */ -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+#define DEF_RECVBUF_SZ 24576 /* RX 24K */ -+#if (DFT_TRX_SHARE_MODE == 1) -+#define RX_FIFO_EXPANDING 40960 /* RX= 24K+40K=64K , TX=256K-40K=216K */ -+#elif (DFT_TRX_SHARE_MODE == 2) -+#define RX_FIFO_EXPANDING 65536 /* RX= 24K+40K+24=88K , TX=256K-40K-24K=192K */ -+#elif (DFT_TRX_SHARE_MODE ==3) -+#define RX_FIFO_EXPANDING 106496 /* RX= 24K+40K+24+40K=128K , TX=256K-40K-24K-40K=152K */ -+#elif (DFT_TRX_SHARE_MODE ==4) -+#define RX_FIFO_EXPANDING 131072 /* RX= 24K+40K+24+40K+24K=128K , TX=256K-40K-24K-40K-24K=128K */ -+#else -+#define RX_FIFO_EXPANDING 0 -+#endif -+#define MAX_RECVBUF_SZ (DEF_RECVBUF_SZ + RX_FIFO_EXPANDING) -+#else /* !CONFIG_SUPPORT_TRX_SHARED */ -+#ifdef CONFIG_PCI_HCI -+#define MAX_RECVBUF_SZ 12288 /* 12KB */ -+#else -+#define MAX_RECVBUF_SZ 24576 /* 24KB, TX: 256KB */ -+#endif /* !CONFIG_PCI_HCI */ -+#endif /* !CONFIG_SUPPORT_TRX_SHARED */ -+ -+/* -+ * MAC Register definition -+ */ -+#define REG_AFE_XTAL_CTRL REG_AFE_CTRL1_8822C /* hal_com.c & phydm */ -+#define REG_LEDCFG0 REG_LED_CFG_8822C /* rtw_mp.c */ -+#define MSR (REG_CR_8822C + 2) /* rtw_mp.c & hal_com.c */ -+#define MSR1 REG_CR_EXT_8822C /* 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_8822C /* hal_com.c */ -+ -+#define REG_WOWLAN_WAKE_REASON 0x01C7 /* hal_com.c */ -+#define REG_GPIO_PIN_CTRL_2 REG_GPIO_EXT_CTRL_8822C /* hal_com.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_8822C -+#define RXERR_RPT_RST BIT_RXERR_RPT_RST_8822C -+#define _RXERR_RPT_SEL(type) (BIT_RXERR_RPT_SEL_V1_3_0_8822C(type) \ -+ | ((type & 0x10) ? BIT_RXERR_RPT_SEL_V1_4_8822C : 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 (rtl8822c_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_8822C 0x93C /* rtl8822c_phy.c */ -+#define REG_BB_TX_PATH_SEL_2_8822C 0x940 /* rtl8822c_phy.c */ -+ -+/* TX BeamForming */ -+#define REG_BB_TXBF_ANT_SET_BF1_8822C 0x19AC /* rtl8822c_phy.c */ -+#define REG_BB_TXBF_ANT_SET_BF0_8822C 0x19B4 /* rtl8822c_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 rOFDM1_LSTF 0xD00 -+#define rOFDM1_TRxPathEnable 0xD04 /* hal_mp.c */ -+#define rA_PIRead_Jaguar 0xD04 /* RF readback with PI (rtl8822c_phy.c) */ -+#define rA_SIRead_Jaguar 0xD08 /* RF readback with SI (rtl8822c_phy.c) */ -+#define rB_PIRead_Jaguar 0xD44 /* RF readback with PI (rtl8822c_phy.c) */ -+#define rB_SIRead_Jaguar 0xD48 /* RF readback with SI (rtl8822c_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) */ -+/* RFE */ -+#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ -+#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 rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ -+#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ -+#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 -+ -+/* 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 /* rtl8822c_phy.c */ -+#define RF_ModeTableAddr 0x30 /* rtl8822c_phy.c */ -+#define RF_ModeTableData0 0x31 /* rtl8822c_phy.c */ -+#define RF_ModeTableData1 0x32 /* rtl8822c_phy.c */ -+#define RF_0x52 0x52 -+#define RF_WeLut_Jaguar 0xEF /* rtl8822c_phy.c */ -+ -+/* rtw_lps_state_chk()@hal_com.c */ -+#define BIT_PWRBIT_OW_EN BIT_WMAC_TCRPWRMGT_HWDATA_EN_8822C -+ -+/* General Functions */ -+void rtl8822c_init_hal_spec(PADAPTER); /* hal/hal_com.c */ -+ -+#ifdef CONFIG_MP_INCLUDED -+/* MP Functions */ -+#include /* struct mp_priv */ -+void rtl8822c_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ -+void rtl8822c_mp_config_rfpath(PADAPTER); /* hal_mp.c */ -+#endif -+void hw_var_set_dl_rsvd_page(PADAPTER adapter, u8 mstatus); -+ -+#ifdef CONFIG_USB_HCI -+#include -+#elif defined(CONFIG_SDIO_HCI) -+#include -+#elif defined(CONFIG_PCI_HCI) -+#include -+#endif -+ -+#endif /* _RTL8822C_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8822ce_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8822ce_hal.h -new file mode 100755 -index 000000000..f56566e05 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8822ce_hal.h -@@ -0,0 +1,27 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8822CE_HAL_H_ -+#define _RTL8822CE_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+#define RT_BCN_INT_MASKS (BIT20 | BIT25 | BIT26 | BIT16) -+ -+/* rtl8822ce_ops.c */ -+void UpdateInterruptMask8822CE(PADAPTER, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+u16 get_txbd_rw_reg(u16 q_idx); -+ -+ -+#endif /* _RTL8822CE_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8822cs_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8822cs_hal.h -new file mode 100755 -index 000000000..3e54b2a65 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8822cs_hal.h -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8822CS_HAL_H_ -+#define _RTL8822CS_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+/* rtl8822cs_ops.c */ -+void rtl8822cs_set_hal_ops(PADAPTER); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtl8822cs_disable_interrupt_but_cpwm2(PADAPTER adapter); -+#endif -+ -+/* rtl8822cs_xmit.c */ -+s32 rtl8822cs_dequeue_writeport(PADAPTER); -+#define _dequeue_writeport(a) rtl8822cs_dequeue_writeport(a) -+ -+#endif /* _RTL8822CS_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtl8822cu_hal.h b/drivers/net/wireless/rtl8821cs/include/rtl8822cu_hal.h -new file mode 100755 -index 000000000..a0accf339 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtl8822cu_hal.h -@@ -0,0 +1,61 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _RTL8822CU_HAL_H_ -+#define _RTL8822CU_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 -+ -+ /* undefine MAX_RECVBUF_SZ from rtl8822c_hal.h */ -+ #ifdef MAX_RECVBUF_SZ -+ #undef MAX_RECVBUF_SZ -+ #endif -+ -+ /* recv_buffer must be large than usb agg size */ -+ #ifndef MAX_RECVBUF_SZ -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ #define MAX_RECVBUF_SZ (15360) /* 15k */ -+ #elif defined(CONFIG_PLATFORM_HISILICON) || defined(CONFIG_PLATFORM_ARM_RTD299X) -+ /* use 16k to workaround for HISILICON and RTK TV platform */ -+ #define MAX_RECVBUF_SZ (16384) -+ #else -+ #define MAX_RECVBUF_SZ (32768) -+ #endif -+ #else -+ #define MAX_RECVBUF_SZ (4000) -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+ /* rtl8822cu_ops.c */ -+ void rtl8822cu_set_hal_ops(PADAPTER padapter); -+ void rtl8822cu_set_hw_type(struct dvobj_priv *pdvobj); -+ -+ /* rtl8822cu_io.c */ -+ void rtl8822cu_set_intf_ops(struct _io_ops *pops); -+ -+#endif /* CONFIG_USB_HCI */ -+ -+ -+#endif /* _RTL8822CU_HAL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_android.h b/drivers/net/wireless/rtl8821cs/include/rtw_android.h -new file mode 100644 -index 000000000..9bb8e32f5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_android.h -@@ -0,0 +1,117 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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_SETSUSPENDMODE, -+ 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_SET_AEK, -+ ANDROID_WIFI_CMD_EXT_AUTH_STATUS, -+ 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); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 18, 0)) -+void *wifi_get_country_code(char *ccode, u32 flags); -+#else /* Linux kernel < 3.18 */ -+void *wifi_get_country_code(char *ccode); -+#endif /* Linux kernel < 3.18 */ -+#else -+static inline int rtw_android_wifictrl_func_add(void) -+{ -+ return 0; -+} -+static inline 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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_ap.h b/drivers/net/wireless/rtl8821cs/include/rtw_ap.h -new file mode 100644 -index 000000000..05428dbc2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_ap.h -@@ -0,0 +1,150 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+ -+#ifdef CONFIG_AP_MODE -+ -+#define AP_CSA_DISABLE 0 -+#define AP_SWITCH_CH_CSA 1 -+#define STA_RX_CSA 2 -+#define CSA_STA_JOINBSS 3 -+#define CSA_IE_REMOVE 0xff -+#define DEFAULT_CSA_CNT 3 -+ -+/* 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); -+u8 rtw_set_tim_ie(u8 dtim_cnt, u8 dtim_period -+ , const u8 *tim_bmp, u8 tim_bmp_len, u8 *tim_ie); -+/* 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, u8 flags, const char *tag); -+#define update_beacon(adapter, ie_id, oui, tx, flags) _update_beacon((adapter), (ie_id), (oui), (tx), (flags), __func__) -+/*update_beacon - (flags) can set to normal enqueue (0) and RTW_CMDF_WAIT_ACK enqueue. -+ (flags) = RTW_CMDF_DIRECTLY is not currently implemented, it will do normal enqueue.*/ -+ -+void rtw_ap_update_sta_ra_info(_adapter *padapter, struct sta_info *psta); -+ -+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_macaddr_acl_init(_adapter *adapter, u8 period); -+void rtw_macaddr_acl_deinit(_adapter *adapter, u8 period); -+void rtw_macaddr_acl_clear(_adapter *adapter, u8 period); -+void rtw_set_macaddr_acl(_adapter *adapter, u8 period, int mode); -+int rtw_acl_add_sta(_adapter *adapter, u8 period, const u8 *addr); -+int rtw_acl_remove_sta(_adapter *adapter, u8 period, const u8 *addr); -+#endif /* CONFIG_RTW_MACADDR_ACL */ -+ -+u8 rtw_ap_set_sta_key(_adapter *adapter, const u8 *addr, u8 alg, const u8 *key, u8 keyid, u8 gk); -+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); -+u8 rtw_ap_chbw_decision(_adapter *adapter, u8 ifbmp, u8 excl_ifbmp -+ , s16 req_ch, s8 req_bw, s8 req_offset, u8 *ch, u8 *bw, u8 *offset, u8 *chbw_allow, bool *set_u_ch); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+void rtw_auto_ap_rx_msg_dump(_adapter *padapter, union recv_frame *precv_frame, u8 *ehdr_pos); -+extern void rtw_start_auto_ap(_adapter *adapter); -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+void rtw_ap_parse_sta_capability(_adapter *adapter, struct sta_info *sta, u8 *cap); -+u16 rtw_ap_parse_sta_supported_rates(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len); -+u16 rtw_ap_parse_sta_security_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems); -+void rtw_ap_parse_sta_wmm_ie(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len); -+void rtw_ap_parse_sta_ht_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems); -+void rtw_ap_parse_sta_vht_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems); -+void rtw_ap_parse_sta_multi_ap_ie(_adapter *adapter, struct sta_info *sta, u8 *ies, int ies_len); -+ -+/* b2u flags */ -+#define RTW_AP_B2U_ALL BIT0 -+#define RTW_AP_B2U_GA_UCAST BIT1 /* WDS group addressed unicast frame, forward only */ -+#define RTW_AP_B2U_BCAST BIT2 -+#define RTW_AP_B2U_IP_MCAST BIT3 -+ -+#define rtw_ap_src_b2u_policy_chk(flags, da) ( \ -+ (flags & RTW_AP_B2U_ALL) \ -+ || ((flags & RTW_AP_B2U_BCAST) && is_broadcast_mac_addr(da)) \ -+ || ((flags & RTW_AP_B2U_IP_MCAST) && (IP_MCAST_MAC(da) || ICMPV6_MCAST_MAC(da))) \ -+ ) -+ -+#define rtw_ap_fwd_b2u_policy_chk(flags, da, gaucst) ( \ -+ (flags & RTW_AP_B2U_ALL) \ -+ || ((flags & RTW_AP_B2U_GA_UCAST) && gaucst) \ -+ || ((flags & RTW_AP_B2U_BCAST) && is_broadcast_mac_addr(da)) \ -+ || ((flags & RTW_AP_B2U_IP_MCAST) && (IP_MCAST_MAC(da) || ICMPV6_MCAST_MAC(da))) \ -+ ) -+ -+void dump_ap_b2u_flags(void *sel, _adapter *adapter); -+ -+int rtw_ap_addr_resolve(_adapter *adapter, u16 os_qid, struct xmit_frame *xframe, _pkt *pkt, _list *f_list); -+int rtw_ap_rx_data_validate_hdr(_adapter *adapter, union recv_frame *rframe, struct sta_info **sta); -+int rtw_ap_rx_msdu_act_check(union recv_frame *rframe -+ , const u8 *da, const u8 *sa -+ , u8 *msdu, enum rtw_rx_llc_hdl llc_hdl -+ , struct xmit_frame **fwd_frame, _list *f_list); -+ -+void update_bmc_sta(_adapter *padapter); -+ -+#ifdef CONFIG_BMC_TX_RATE_SELECT -+void rtw_update_bmc_sta_tx_rate(_adapter *adapter); -+#endif -+ -+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); -+#ifdef CONFIG_80211N_HT -+int rtw_ht_operation_update(_adapter *padapter); -+#endif /* CONFIG_80211N_HT */ -+u8 rtw_ap_sta_states_check(_adapter *adapter); -+ -+#ifdef CONFIG_FW_HANDLE_TXBCN -+#define rtw_ap_get_nums(adapter) (adapter_to_dvobj(adapter)->nr_ap_if) -+bool rtw_ap_nums_check(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+void tx_beacon_handlder(struct dvobj_priv *pdvobj); -+void tx_beacon_timer_handlder(void *ctx); -+#endif /*CONFIG_SWTIMER_BASED_TXBCN*/ -+ -+#endif /* end of CONFIG_AP_MODE */ -+#endif /*__RTW_AP_H_*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_beamforming.h b/drivers/net/wireless/rtl8821cs/include/rtw_beamforming.h -new file mode 100644 -index 000000000..4c7f006e8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_beamforming.h -@@ -0,0 +1,297 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+#ifdef CONFIG_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) -+ -+/* Need to be defined by IC */ -+#define SU_SOUNDING_TIMEOUT 5 /* unit: ms */ -+#define MU_SOUNDING_TIMEOUT 8 /* unit: ms */ -+ -+#define GET_BEAMFORM_INFO(adapter) (&GET_HAL_DATA(adapter)->beamforming_info) -+#define GetInitSoundCnt(_SoundPeriod, _MinSoundPeriod) ((_SoundPeriod)/(_MinSoundPeriod)) -+ -+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, -+ BEAMFORMING_CTRL_SET_CSI_REPORT = 7, -+}; -+ -+enum _BEAMFORMING_STATE { -+ BEAMFORMING_STATE_IDLE, -+ BEAMFORMING_STATE_START, -+ BEAMFORMING_STATE_END, -+}; -+ -+/* -+ * typedef BEAMFORMING_CAP for phydm -+ */ -+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; -+ -+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 -+}; -+ -+/* 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 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; -+ u8 g_id; -+ /* Used to fill Reg6E4 to fill Mac address of CSI report frame */ -+ u8 mac_addr[ETH_ALEN]; -+ /* Sounding BandWidth */ -+ enum channel_width sound_bw; -+ u16 sound_period; -+ -+ enum 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; -+ /* Get the result through throughput and Tx rate from BB API */ -+ u8 bApplySounding; -+ -+ /* information for sounding judgement */ -+ systime tx_timestamp; -+ u64 tx_bytes; -+ -+ u16 LogStatusFailCnt:5; /* 0~21 */ -+ u16 DefaultCSICnt:5; /* 0~21 */ -+ u8 CSIMatrix[327]; -+ u16 CSIMatrixLen; -+ -+ u8 NumofSoundingDim; -+ -+ u8 comp_steering_num_of_bfer; -+ -+ -+ /* SU-MIMO */ -+ u8 su_reg_index; -+ -+ /* MU-MIMO */ -+ u8 mu_reg_index; -+ u8 gid_valid[8]; -+ u8 user_position[16]; -+ -+ /* For 8822B C-cut workaround */ -+ /* If the flag set to _TRUE, do not sound this STA */ -+ u8 bSuspendSUCap; -+}; -+ -+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; -+ u8 g_id; -+ u8 mac_addr[ETH_ALEN]; -+ -+ enum beamforming_cap cap; -+ enum _BEAMFORM_ENTRY_HW_STATE state; -+ -+ u8 NumofSoundingDim; -+ -+ /* SU-MIMO */ -+ u8 su_reg_index; -+ -+ /* MU-MIMO */ -+ u8 gid_valid[8]; -+ u8 user_position[16]; -+ u16 aid; -+}; -+ -+struct sounding_info { -+ u8 su_sounding_list[MAX_NUM_BEAMFORMEE_SU]; -+ u8 mu_sounding_list[MAX_NUM_BEAMFORMEE_MU]; -+ -+ enum _SOUNDING_STATE state; -+ /* -+ * su_bfee_curidx is index for beamforming_info.bfee_entry[] -+ * range: 0~MAX_BEAMFORMEE_ENTRY_NUM -+ */ -+ 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; -+}; -+ -+struct _RT_CSI_INFO{ -+ u8 Nc; -+ u8 Nr; -+ u8 Ng; -+ u8 CodeBook; -+ u8 ChnlWidth; -+ u8 bVHT; -+}; -+ -+struct beamforming_info { -+ enum beamforming_cap beamforming_cap; -+ enum _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; -+ u8 cur_csi_rpt_rate; -+ -+ struct sounding_info sounding_info; -+ /* schedule regular timer for sounding */ -+ _timer sounding_timer; -+ /* moniter if soudning too long */ -+ _timer sounding_timeout_timer; -+ -+ /* For HW configuration */ -+ u8 SetHalBFEnterOnDemandCnt; -+ u8 SetHalBFLeaveOnDemandCnt; -+ u8 SetHalSoundownOnDemandCnt; -+ u8 bSetBFHwConfigInProgess; -+ -+ /* -+ * Target CSI report info. -+ * Keep the first SU CSI report info for 8822B HW bug workaround. -+ */ -+ u8 bEnableSUTxBFWorkAround; -+ struct _RT_CSI_INFO TargetCSIInfo; -+ /* Only peform sounding to the first SU BFee */ -+ struct beamformee_entry *TargetSUBFee; -+ -+ /* For debug */ -+ s8 sounding_running; -+}; -+ -+enum beamforming_cap rtw_bf_bfee_get_entry_cap_by_macid(void *mlmepriv, u8 mac_id); -+struct beamformer_entry *rtw_bf_bfer_get_entry_by_addr(PADAPTER, u8 *ra); -+struct beamformee_entry *rtw_bf_bfee_get_entry_by_addr(PADAPTER, u8 *ra); -+void rtw_bf_get_ndpa_packet(PADAPTER, union recv_frame *); -+u32 rtw_bf_get_report_packet(PADAPTER, union recv_frame *); -+u8 rtw_bf_send_vht_gid_mgnt_packet(PADAPTER, u8 *ra, u8 *gid, u8 *position); -+void rtw_bf_get_vht_gid_mgnt_packet(PADAPTER, union recv_frame *); -+void rtw_bf_init(PADAPTER); -+void rtw_bf_cmd_hdl(PADAPTER, u8 type, u8 *pbuf); -+u8 rtw_bf_cmd(PADAPTER, s32 type, u8 *pbuf, s32 size, u8 enqueue); -+void rtw_bf_update_attrib(PADAPTER, struct pkt_attrib *, struct sta_info *); -+void rtw_bf_c2h_handler(PADAPTER, u8 id, u8 *buf, u8 buf_len); -+void rtw_bf_update_traffic(PADAPTER); -+ -+/* Compatible with old function name, only for using outside rtw_beamforming.c */ -+#define beamforming_get_entry_beam_cap_by_mac_id rtw_bf_bfee_get_entry_cap_by_macid -+#define rtw_beamforming_get_ndpa_frame rtw_bf_get_ndpa_packet -+#define rtw_beamforming_get_report_frame rtw_bf_get_report_packet -+#define rtw_beamforming_get_vht_gid_mgnt_frame rtw_bf_get_vht_gid_mgnt_packet -+#define beamforming_wk_hdl rtw_bf_cmd_hdl -+#define beamforming_wk_cmd rtw_bf_cmd -+#define update_attrib_txbf_info rtw_bf_update_attrib -+ -+#define HT_BF_CAP(adapter) ((adapter)->mlmepriv.htpriv.beamform_cap) -+#define VHT_BF_CAP(adapter) ((adapter)->mlmepriv.vhtpriv.beamform_cap) -+ -+#define IS_HT_BEAMFORMEE(adapter) \ -+ (HT_BF_CAP(adapter) & \ -+ (BEAMFORMING_HT_BEAMFORMEE_ENABLE)) -+ -+#define IS_VHT_BEAMFORMEE(adapter) \ -+ (VHT_BF_CAP(adapter) & \ -+ (BEAMFORMING_VHT_BEAMFORMEE_ENABLE | \ -+ BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) -+ -+#define IS_BEAMFORMEE(adapter) (IS_HT_BEAMFORMEE(adapter) | \ -+ IS_VHT_BEAMFORMEE(adapter)) -+ -+#else /* !RTW_BEAMFORMING_VERSION_2 */ -+/*PHYDM_BF - (BEAMFORMING_SUPPORT == 1)*/ -+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 rtw_beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame); -+void rtw_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 /* !RTW_BEAMFORMING_VERSION_2 */ -+ -+#endif /*#ifdef CONFIG_BEAMFORMING */ -+ -+#endif /*__RTW_BEAMFORMING_H_*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_br_ext.h b/drivers/net/wireless/rtl8821cs/include/rtw_br_ext.h -new file mode 100644 -index 000000000..54ba75ea1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_br_ext.h -@@ -0,0 +1,69 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_bt_mp.h b/drivers/net/wireless/rtl8821cs/include/rtw_bt_mp.h -new file mode 100644 -index 000000000..93af3c8f0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_bt_mp.h -@@ -0,0 +1,288 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 { -+ u8 txrxChannel; -+ u32 txrxTxPktCnt; -+ u8 txrxTxPktInterval; -+ u8 txrxPayloadType; -+ u8 txrxPktType; -+ u16 txrxPayloadLen; -+ u32 txrxPktHeader; -+ u8 txrxWhitenCoeff; -+ u8 txrxBdaddr[6]; -+ u8 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( -+ PADAPTER Adapter, -+ u8 opCode, -+ u8 byte1, -+ u8 byte2, -+ u8 byte3 -+); -+ -+uint -+MPTBT_SendOidBT( -+ PADAPTER pAdapter, -+ void *InformationBuffer, -+ u32 InformationBufferLength, -+ u32 *BytesRead, -+ u32 *BytesNeeded -+); -+ -+void -+MPTBT_FwC2hBtMpCtrl( -+ PADAPTER Adapter, -+ u8 *tmpBuf, -+ u8 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 { -+ u8 opCodeVer:4; -+ u8 reqNum:4; -+ u8 opCode; -+ u8 buf[100]; -+} BT_H2C, *PBT_H2C; -+ -+ -+ -+typedef struct _BT_EXT_C2H { -+ u8 extendId; -+ u8 statusCode:4; -+ u8 retLen:4; -+ u8 opCodeVer:4; -+ u8 reqNum:4; -+ u8 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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_btcoex.h b/drivers/net/wireless/rtl8821cs/include/rtw_btcoex.h -new file mode 100644 -index 000000000..3361dbef8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_btcoex.h -@@ -0,0 +1,468 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+#ifdef CONFIG_BT_COEXIST -+ -+#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; -+ -+typedef enum _BTCOEX_POLICY_CONTROL { -+ BTCOEX_POLICY_CONTROL_AUTO, -+ BTCOEX_POLICY_CONTROL_FORCE_FREERUN, -+ BTCOEX_POLICY_CONTROL_FORCE_TDMA -+} BTCOEX_POLICY_CONTROL, *PBTCOEX_POLICY_CONTROL; -+ -+#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 { -+ u16 ConnectHandle; -+ u8 IncomingTrafficMode; -+ u8 OutgoingTrafficMode; -+ u8 BTProfile; -+ u8 BTCoreSpec; -+ s8 BT_RSSI; -+ u8 TrafficProfile; -+ u8 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]; -+ u8 btOperationCode; -+ u16 CurrentConnectHandle; -+ u8 CurrentIncomingTrafficMode; -+ u8 CurrentOutgoingTrafficMode; -+ -+ u8 NumberOfACL; -+ u8 NumberOfSCO; -+ u8 CurrentBTStatus; -+ u16 HCIExtensionVer; -+ -+ BOOLEAN bEnableWifiScanNotify; -+} HCI_EXT_CONFIG, *PHCI_EXT_CONFIG; -+ -+typedef struct _HCI_PHY_LINK_BSS_INFO { -+ u16 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; -+ u8 BtCurrentPhyLinkhandle; -+ u16 BtCurrentLogLinkhandle; -+ u8 CurrentConnectEntryNum; -+ u8 DisconnectEntryNum; -+ u8 CurrentBTConnectionCnt; -+ BT_CONNECT_TYPE BTCurrentConnectType; -+ BT_CONNECT_TYPE BTReceiveConnectPkt; -+ u8 BTAuthCount; -+ u8 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; -+ u8 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_AntInfoSetting(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_MediaStatusNotify(PADAPTER, u8 mediaStatus); -+void rtw_btcoex_SpecialPacketNotify(PADAPTER, u8 pktType); -+void rtw_btcoex_IQKNotify(PADAPTER padapter, u8 state); -+void rtw_btcoex_WLRFKNotify(PADAPTER padapter, u8 path, u8 type, 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_WlFwDbgInfoNotify(PADAPTER padapter, u8* tmpBuf, u8 length); -+void rtw_btcoex_rx_rate_change_notify(PADAPTER padapter, u8 is_data_frame, u8 rate_id); -+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); -+void rtw_btcoex_set_policy_control(PADAPTER, u8 btc_policy); -+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); -+u8 rtw_btcoex_query_reduced_wl_pwr_lvl(PADAPTER padapter); -+void rtw_btcoex_set_reduced_wl_pwr_lvl(PADAPTER padapter, u8 val); -+void rtw_btcoex_do_reduce_wl_pwr_lvl(PADAPTER 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_pta_off_on_notify(PADAPTER padapter, u8 bBTON); -+ -+#ifdef CONFIG_RF4CE_COEXIST -+void rtw_btcoex_SetRf4ceLinkState(PADAPTER padapter, u8 state); -+u8 rtw_btcoex_GetRf4ceLinkState(PADAPTER padapter); -+#endif -+ -+#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_reduce_wl_txpwr(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); -+u16 rtw_btcoex_btset_testmode(PADAPTER padapter, u8 type); -+ -+/* ================================================== -+ * Below Functions are called by BT-Coex -+ * ================================================== */ -+void rtw_btcoex_rx_ampdu_apply(PADAPTER padapter); -+void rtw_btcoex_LPS_Enter(PADAPTER padapter); -+u8 rtw_btcoex_LPS_Leave(PADAPTER padapter); -+ -+#endif /* __RTW_BTCOEX_H__ */ -+#endif /* CONFIG_BT_COEXIST */ -+ -+void rtw_btcoex_set_ant_info(PADAPTER padapter); -+void rtw_btcoex_connect_notify(PADAPTER, u8 join_type); -+ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_btcoex_wifionly.h b/drivers/net/wireless/rtl8821cs/include/rtw_btcoex_wifionly.h -new file mode 100644 -index 000000000..93087ebe0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_btcoex_wifionly.h -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_WIFIONLY_H__ -+#define __RTW_BTCOEX_WIFIONLY_H__ -+ -+void rtw_btcoex_wifionly_switchband_notify(PADAPTER padapter); -+void rtw_btcoex_wifionly_scan_notify(PADAPTER padapter); -+void rtw_btcoex_wifionly_connect_notify(PADAPTER padapter); -+void rtw_btcoex_wifionly_hw_config(PADAPTER padapter); -+void rtw_btcoex_wifionly_initialize(PADAPTER padapter); -+void rtw_btcoex_wifionly_AntInfoSetting(PADAPTER padapter); -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_byteorder.h b/drivers/net/wireless/rtl8821cs/include/rtw_byteorder.h -new file mode 100644 -index 000000000..8e6bb7a6d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_byteorder.h -@@ -0,0 +1,33 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ #include -+ #endif -+#elif defined (CONFIG_BIG_ENDIAN) -+ #include -+#else -+ # error "Must be LITTLE/BIG Endian Host" -+#endif -+ -+#endif /* _RTL871X_BYTEORDER_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_cmd.h b/drivers/net/wireless/rtl8821cs/include/rtw_cmd.h -new file mode 100644 -index 000000000..37a0b40ea ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_cmd.h -@@ -0,0 +1,830 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 1536 -+#define MAX_RSPSZ 512 -+#define MAX_EVTSZ 1024 -+ -+#define CMDBUFF_ALIGN_SZ 512 -+ -+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 start_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_allocated_buf; -+ u32 cmd_issued_cnt; -+ u32 cmd_done_cnt; -+ u32 rsp_cnt; -+ ATOMIC_T cmdthd_running; -+ /* u8 cmdthd_running; */ -+ -+ _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; -+ -+ _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; -+#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; -+#ifdef CONFIG_P2P_PS_NOA_USE_MACID_SLEEP -+ u8 p2p_macid:7; -+ u8 disable_close_rf:1; /*1: not close RF but just pause p2p_macid when NoA duration*/ -+#endif /* CONFIG_P2P_PS_NOA_USE_MACID_SLEEP */ -+}; -+ -+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); -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+struct rtw_roch_parm { -+ u64 cookie; -+ struct wireless_dev *wdev; -+ struct ieee80211_channel ch; -+ enum nl80211_channel_type ch_type; -+ unsigned int duration; -+}; -+ -+u8 rtw_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 rtw_cancel_roch_cmd(_adapter *adapter, u64 cookie, struct wireless_dev *wdev, u8 flags); -+ -+u8 rtw_mgnt_tx_cmd(_adapter *adapter, u8 tx_ch, u8 no_cck, const u8 *buf, size_t len, int wait_ack, u8 flags); -+struct mgnt_tx_parm { -+ u8 tx_ch; -+ u8 no_cck; -+ const u8 *buf; -+ size_t len; -+ int wait_ack; -+}; -+#endif -+ -+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 */ -+ 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, -+ BTC_REDUCE_WL_TXPWR_CID, -+ DFS_RADAR_DETECT_WK_CID, -+ DFS_RADAR_DETECT_EN_DEC_WK_CID, -+ SESSION_TRACKER_WK_CID, -+ EN_HW_UPDATE_TSF_WK_CID, -+ PERIOD_TSF_UPDATE_END_WK_CID, -+ TEST_H2C_CID, -+ MP_CMD_WK_CID, -+ CUSTOMER_STR_WK_CID, -+#ifdef CONFIG_RTW_REPEATER_SON -+ RSON_SCAN_WK_CID, -+#endif -+ ROCH_WK_CID, -+ MGNT_TX_WK_CID, -+ REQ_PER_CMD_WK_CID, -+ SSMPS_WK_CID, -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+ TXSS_WK_CID, -+#endif -+ AC_PARM_CMD_WK_CID, -+#ifdef CONFIG_AP_MODE -+ STOP_AP_WK_CID, -+#endif -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ TBTX_CONTROL_TX_WK_CID, -+#endif -+ 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, -+ LPS_CTRL_LEAVE_SET_OPTION = 11, -+}; -+ -+enum STAKEY_TYPE { -+ GROUP_KEY = 0, -+ UNICAST_KEY = 1, -+ TDLS_KEY = 2, -+}; -+ -+enum RFINTFS { -+ SWSI, -+ HWSI, -+ HWPI, -+}; -+ -+ -+/* -+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/Mesh mode now */ -+ u8 ifbmp; -+ u8 excl_ifbmp; -+ s16 req_ch; -+ s8 req_bw; -+ s8 req_offset; -+}; -+ -+ -+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]; -+ -+ u32 token; /* 80211k use it to identify caller */ -+ u16 duration; /* 0: use default, otherwise: channel scan time */ -+ u8 igi; /* 0: use defalut */ -+ u8 bw; /* 0: use default */ -+ -+ bool acs; /* aim to trigger channel selection when scan done */ -+ u8 reason; -+}; -+ -+/* -+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 set_tx; /* 1: main tx key for wep. 0: other key. */ -+ u8 key[32]; /* 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[32]; -+ u8 gk; -+}; -+ -+struct set_stakey_rsp { -+ u8 addr[ETH_ALEN]; -+ u8 keyid; -+ u8 rsvd; -+}; -+ -+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 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; -+}; -+ -+struct set_ch_parm { -+ u8 ch; -+ u8 bw; -+ u8 ch_offset; -+}; -+ -+struct SetChannelPlan_param { -+ enum regd_src_t regd_src; -+ enum rtw_regd_inr inr; -+ struct country_chplan country_ent; -+ bool has_country; -+ u8 channel_plan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 channel_plan_6g; -+#endif -+ -+#ifdef CONFIG_80211D -+ /* used for regd_src == RTK_PRIV and inr == COUNTRY_IE */ -+ struct country_ie_slave_record cisr; -+ bool has_cisr; -+#endif -+ -+#ifdef PLATFORM_LINUX -+ bool rtnl_lock_needed; -+#endif -+}; -+ -+struct get_channel_plan_param { -+ struct get_chplan_resp **chplan; -+}; -+ -+struct LedBlink_param { -+ void *pLed; -+}; -+ -+struct TDLSoption_param { -+ u8 addr[ETH_ALEN]; -+ u8 option; -+}; -+ -+struct RunInThread_param { -+ void (*func)(void *); -+ void *context; -+}; -+ -+#ifdef CONFIG_WRITE_BCN_LEN_TO_FW -+struct write_bcnlen_param { -+ u16 bcn_len; -+}; -+#endif -+ -+struct reqtxrpt_param { -+ u8 macid; -+}; -+ -+#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 -+#define H2C_CMD_FAIL 0x0A -+ -+void rtw_init_sitesurvey_parm(_adapter *padapter, struct sitesurvey_parm *pparm); -+u8 rtw_sitesurvey_cmd(_adapter *padapter, struct sitesurvey_parm *pparm); -+#ifdef CONFIG_AP_MODE -+u8 rtw_create_ibss_cmd(_adapter *adapter, int flags); -+u8 rtw_startbss_cmd(_adapter *adapter, int flags); -+#endif -+ -+#define REQ_CH_NONE -1 -+#define REQ_CH_INT_INFO -2 -+#define REQ_BW_NONE -1 -+#define REQ_BW_ORI -2 -+#define REQ_OFFSET_NONE -1 -+ -+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, int flags); -+#ifdef CONFIG_AP_MODE -+u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags -+ , u8 ifbmp, u8 excl_ifbmp, s16 req_ch, s8 req_bw, s8 req_offset); -+u8 rtw_stop_ap_cmd(_adapter *adapter, u8 flags); -+#endif -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+u8 rtw_tx_control_cmd(_adapter *adapter); -+#endif -+extern u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, u8 flags); -+ -+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, u8 lock_scanned_queue, int flags); -+extern u8 rtw_dynamic_chk_wk_cmd(_adapter *adapter); -+ -+u8 rtw_lps_ctrl_wk_cmd(_adapter *padapter, u8 lps_ctrl_type, u8 flags); -+u8 rtw_lps_ctrl_leave_set_level_cmd(_adapter *adapter, u8 lps_level, u8 flags); -+#ifdef CONFIG_LPS_1T1R -+u8 rtw_lps_ctrl_leave_set_1t1r_cmd(_adapter *adapter, u8 lps_1t1r, u8 flags); -+#endif -+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); -+ -+#if CONFIG_DFS -+void rtw_dfs_ch_switch_hdl(struct dvobj_priv *dvobj); -+#endif -+ -+#ifdef CONFIG_AP_MODE -+u8 rtw_chk_hi_queue_cmd(_adapter *padapter); -+#ifdef CONFIG_DFS_MASTER -+u8 rtw_dfs_rd_cmd(_adapter *adapter, bool enqueue); -+void rtw_dfs_rd_timer_hdl(void *ctx); -+void rtw_dfs_rd_en_decision(_adapter *adapter, u8 mlme_act, u8 excl_ifbmp); -+u8 rtw_dfs_rd_en_decision_cmd(_adapter *adapter); -+#endif /* CONFIG_DFS_MASTER */ -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_BT_COEXIST -+u8 rtw_btinfo_cmd(PADAPTER padapter, u8 *pbuf, u16 length); -+u8 rtw_btc_reduce_wl_txpwr_cmd(_adapter *adapter, u32 val); -+#endif -+ -+u8 rtw_test_h2c_cmd(_adapter *adapter, u8 *buf, u8 len); -+ -+u8 rtw_enable_hw_update_tsf_cmd(_adapter *padapter); -+u8 rtw_periodic_tsf_update_end_cmd(_adapter *adapter); -+ -+u8 rtw_set_chbw_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 flags); -+u8 rtw_iqk_cmd(_adapter *padapter, u8 flags); -+ -+u8 rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, u8 chplan_6g, enum rtw_regd_inr inr); -+u8 rtw_set_country_cmd(_adapter *adapter, int flags, const char *country_code, enum rtw_regd_inr inr); -+#ifdef CONFIG_REGD_SRC_FROM_OS -+u8 rtw_sync_os_regd_cmd(_adapter *adapter, int flags, const char *country_code, u8 dfs_region, enum rtw_regd_inr inr); -+#endif -+u8 rtw_get_chplan_cmd(_adapter *adapter, int flags, struct get_chplan_resp **chplan); -+ -+#ifdef CONFIG_80211D -+u8 rtw_apply_recv_country_ie_cmd(_adapter *adapter, int flags, BAND_TYPE band,u8 opch, const u8 *country_ie); -+#endif -+ -+extern u8 rtw_led_blink_cmd(_adapter *padapter, void *pLed); -+extern u8 rtw_set_csa_cmd(_adapter *adapter); -+extern u8 rtw_set_ap_csa_cmd(_adapter *adapter); -+extern u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option); -+ -+u8 rtw_mp_cmd(_adapter *adapter, u8 mp_cmd_id, u8 flags); -+ -+#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 -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+#define RSON_SCAN_PROCESS 10 -+#define RSON_SCAN_DISABLE 11 -+u8 rtw_rson_scan_wk_cmd(_adapter *adapter, int op); -+#endif -+ -+u8 rtw_run_in_thread_cmd(_adapter *adapter, void (*func)(void *), void *context); -+u8 rtw_run_in_thread_cmd_wait(_adapter *adapter, void (*func)(void *), void *context, s32 timeout_ms); -+ -+struct ssmps_cmd_parm { -+ struct sta_info *sta; -+ u8 smps; -+}; -+u8 rtw_ssmps_wk_cmd(_adapter *adapter, struct sta_info *sta, u8 smps, u8 enqueue); -+ -+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 set_txq_params_cmd(_adapter *adapter, u32 ac_parm, u8 ac_type); -+ -+#if defined(CONFIG_RTW_MESH) && defined(RTW_PER_CMD_SUPPORT_FW) -+u8 rtw_req_per_cmd(_adapter * adapter); -+#endif -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+u8 rtw_tbtx_chk_cmd(_adapter *adapter); -+u8 rtw_tbtx_token_dispatch_cmd(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_WRITE_BCN_LEN_TO_FW -+u8 rtw_write_bcnlen_to_fw_cmd(_adapter *padapter, u16 bcn_len); -+#endif -+ -+u8 rtw_reqtxrpt_cmd(_adapter *adapter, u8 macid); -+ -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+struct txss_cmd_parm { -+ struct sta_info *sta; -+ bool tx_1ss; -+}; -+ -+void rtw_ctrl_txss_update_mimo_type(_adapter *adapter, struct sta_info *sta); -+u8 rtw_ctrl_txss(_adapter *adapter, struct sta_info *sta, bool tx_1ss); -+void rtw_ctrl_tx_ss_by_tp(_adapter *adapter, u8 from_timer); -+ -+#ifdef DBG_CTRL_TXSS -+void dbg_ctrl_txss(_adapter *adapter, bool tx_1ss); -+#endif -+#endif -+ -+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_readtssi_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+ -+extern void rtw_setstaKey_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_getrttbl_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+ -+enum rtw_cmd_id { -+ CMD_JOINBSS, /*0*/ -+ CMD_DISCONNECT, /*1*/ -+ CMD_CREATE_BSS,/*2*/ -+ CMD_SET_OPMODE, /*3*/ -+ CMD_SITE_SURVEY, /*4*/ -+ CMD_SET_AUTH, /*5*/ -+ CMD_SET_KEY, /*6*/ -+ CMD_SET_STAKEY, /*7*/ -+ CMD_ADD_BAREQ, /*8*/ -+ CMD_SET_CHANNEL, /*9*/ -+ CMD_TX_BEACON, /*10*/ -+ CMD_SET_MLME_EVT, /*11*/ -+ CMD_SET_DRV_EXTRA, /*12*/ -+ CMD_SET_CHANPLAN, /*13*/ -+ CMD_LEDBLINK, /*14*/ -+ CMD_SET_CHANSWITCH, /*15*/ -+ CMD_TDLS, /*16*/ -+ CMD_CHK_BMCSLEEPQ, /*17*/ -+ CMD_RUN_INTHREAD, /*18*/ -+ CMD_ADD_BARSP, /*19*/ -+ CMD_RM_POST_EVENT, /*20*/ -+ CMD_SET_MESH_PLINK_STATE, /* 21 */ -+ CMD_DO_IQK, /* 22 */ -+ CMD_GET_CHANPLAN, /*23*/ -+ CMD_WRITE_BCN_LEN, /*24 */ -+ CMD_AP_CHANSWITCH, /* 25 AP switch channel */ -+ CMD_REQ_TXRPT, /* 26 */ -+ CMD_ID_MAX -+}; -+ -+#define CMD_FMT "cmd=%d,%d,%d" -+#define CMD_ARG(cmd) \ -+ (cmd)->cmdcode, \ -+ (cmd)->cmdcode == CMD_SET_DRV_EXTRA ? ((struct drvextra_cmd_parm *)(cmd)->parmbuf)->ec_id : ((cmd)->cmdcode == CMD_SET_MLME_EVT ? ((struct rtw_evt_header *)(cmd)->parmbuf)->id : 0), \ -+ (cmd)->cmdcode == CMD_SET_DRV_EXTRA ? ((struct drvextra_cmd_parm *)(cmd)->parmbuf)->type : 0 -+ -+#endif /* _CMD_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_debug.h b/drivers/net/wireless/rtl8821cs/include/rtw_debug.h -new file mode 100755 -index 000000000..d6a432824 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_debug.h -@@ -0,0 +1,734 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+/* 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_DBG_EXPR(EXPR) do {} while (0) -+ -+#define RTW_DBGDUMP 0 /* 'stream' for _dbgdump */ -+ -+ -+ -+#undef _dbgdump -+#undef _seqdump -+ -+#if defined(PLATFORM_WINDOWS) && defined(PLATFORM_OS_XP) -+ #define _dbgdump DbgPrint -+ #define KERN_CONT -+ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) -+#elif defined(PLATFORM_WINDOWS) && defined(PLATFORM_OS_CE) -+ #define _dbgdump rtl871x_cedbg -+ #define KERN_CONT -+ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) -+#elif defined PLATFORM_LINUX -+ #define _dbgdump printk -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) -+ #define KERN_CONT -+ #endif -+ #define _seqdump seq_printf -+#elif defined PLATFORM_FREEBSD -+ #define _dbgdump printf -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) -+ #define KERN_CONT -+ #endif -+ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) -+#endif -+ -+void RTW_BUF_DUMP_SEL(uint _loglevel, void *sel, u8 *_titlestring, -+ bool _idx_show, const u8 *_hexdata, int _hexdatalen); -+ -+#ifdef CONFIG_RTW_DEBUG -+ -+#ifndef _OS_INTFS_C_ -+extern uint rtw_drv_log_level; -+#endif -+ -+#if defined(_dbgdump) -+ -+#ifdef PLATFORM_LINUX -+#ifdef DBG_THREAD_PID -+#define T_PID_FMT "(%5u) " -+#define T_PID_ARG current->pid -+#else /* !DBG_THREAD_PID */ -+#define T_PID_FMT "%s" -+#define T_PID_ARG "" -+#endif /* !DBG_THREAD_PID */ -+ -+#ifdef DBG_CPU_INFO -+#define CPU_INFO_FMT "[%u] " -+#define CPU_INFO_ARG get_cpu() -+#else /* !DBG_CPU_INFO */ -+#define CPU_INFO_FMT "%s" -+#define CPU_INFO_ARG "" -+#endif /* !DBG_CPU_INFO */ -+ -+/* Extra information in prefix */ -+#define EX_INFO_FMT T_PID_FMT CPU_INFO_FMT -+#define EX_INFO_ARG T_PID_ARG, CPU_INFO_ARG -+#else /* !PLATFORM_LINUX */ -+#define EX_INFO_FMT "%s" -+#define EX_INFO_ARG "" -+#endif /* !PLATFORM_LINUX */ -+ -+#define DBG_PREFIX EX_INFO_FMT DRIVER_PREFIX -+#define DBG_PREFIX_ARG EX_INFO_ARG -+ -+/* with driver-defined prefix */ -+#undef RTW_PRINT -+#define RTW_PRINT(fmt, arg...) \ -+ do {\ -+ if (_DRV_ALWAYS_ <= rtw_drv_log_level) {\ -+ _dbgdump(DBG_PREFIX fmt, DBG_PREFIX_ARG, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef RTW_ERR -+#define RTW_ERR(fmt, arg...) \ -+ do {\ -+ if (_DRV_ERR_ <= rtw_drv_log_level) {\ -+ _dbgdump(DBG_PREFIX "ERROR " fmt, \ -+ DBG_PREFIX_ARG, ##arg);\ -+ } \ -+ } while (0) -+ -+ -+#undef RTW_WARN -+#define RTW_WARN(fmt, arg...) \ -+ do {\ -+ if (_DRV_WARNING_ <= rtw_drv_log_level) {\ -+ _dbgdump(DBG_PREFIX "WARN " fmt, \ -+ DBG_PREFIX_ARG, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef RTW_INFO -+#define RTW_INFO(fmt, arg...) \ -+ do {\ -+ if (_DRV_INFO_ <= rtw_drv_log_level) {\ -+ _dbgdump(DBG_PREFIX fmt, DBG_PREFIX_ARG, ##arg);\ -+ } \ -+ } while (0) -+ -+ -+#undef RTW_DBG -+#define RTW_DBG(fmt, arg...) \ -+ do {\ -+ if (_DRV_DEBUG_ <= rtw_drv_log_level) {\ -+ _dbgdump(DBG_PREFIX fmt, DBG_PREFIX_ARG, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef RTW_INFO_DUMP -+#define RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) \ -+ RTW_BUF_DUMP_SEL(_DRV_INFO_, RTW_DBGDUMP, _TitleString, _FALSE, _HexData, _HexDataLen) -+ -+#undef RTW_DBG_DUMP -+#define RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) \ -+ RTW_BUF_DUMP_SEL(_DRV_DEBUG_, RTW_DBGDUMP, _TitleString, _FALSE, _HexData, _HexDataLen) -+ -+ -+#undef RTW_PRINT_DUMP -+#define RTW_PRINT_DUMP(_TitleString, _HexData, _HexDataLen) \ -+ RTW_BUF_DUMP_SEL(_DRV_ALWAYS_, RTW_DBGDUMP, _TitleString, _FALSE, _HexData, _HexDataLen) -+ -+/* without driver-defined prefix */ -+#undef _RTW_PRINT -+#define _RTW_PRINT(fmt, arg...) \ -+ do {\ -+ if (_DRV_ALWAYS_ <= rtw_drv_log_level) {\ -+ _dbgdump(KERN_CONT fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef _RTW_ERR -+#define _RTW_ERR(fmt, arg...) \ -+ do {\ -+ if (_DRV_ERR_ <= rtw_drv_log_level) {\ -+ _dbgdump(KERN_CONT fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+ -+#undef _RTW_WARN -+#define _RTW_WARN(fmt, arg...) \ -+ do {\ -+ if (_DRV_WARNING_ <= rtw_drv_log_level) {\ -+ _dbgdump(KERN_CONT fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef _RTW_INFO -+#define _RTW_INFO(fmt, arg...) \ -+ do {\ -+ if (_DRV_INFO_ <= rtw_drv_log_level) {\ -+ _dbgdump(KERN_CONT fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef _RTW_DBG -+#define _RTW_DBG(fmt, arg...) \ -+ do {\ -+ if (_DRV_DEBUG_ <= rtw_drv_log_level) {\ -+ _dbgdump(KERN_CONT fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+ -+/* 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) -+ -+/* dump message to selected 'stream' */ -+#undef RTW_DUMP_SEL -+#define RTW_DUMP_SEL(sel, _HexData, _HexDataLen) \ -+ RTW_BUF_DUMP_SEL(_DRV_ALWAYS_, sel, NULL, _FALSE, _HexData, _HexDataLen) -+ -+#define RTW_MAP_DUMP_SEL(sel, _TitleString, _HexData, _HexDataLen) \ -+ RTW_BUF_DUMP_SEL(_DRV_ALWAYS_, sel, _TitleString, _TRUE, _HexData, _HexDataLen) -+#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); -+ -+#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 bb_reg_dump_ex(void *sel, _adapter *adapter); -+void rf_reg_dump(void *sel, _adapter *adapter); -+ -+void rtw_sink_rtp_seq_dbg(_adapter *adapter, u8 *ehdr_pos); -+ -+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; -+#if defined(CONFIG_RTW_DEBUG) || defined(CONFIG_PROC_DEBUG) -+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); -+#endif -+void dump_sec_cam(void *sel, _adapter *adapter); -+void dump_sec_cam_cache(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_sta_linking_test_set_start(void); -+bool rtw_sta_linking_test_wait_done(void); -+bool rtw_sta_linking_test_force_fail(void); -+#ifdef CONFIG_AP_MODE -+u16 rtw_ap_linking_test_force_auth_fail(void); -+u16 rtw_ap_linking_test_force_asoc_fail(void); -+#endif -+ -+#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); -+void dump_drv_cfg(void *sel); -+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_RTW_REPEATER_SON -+int proc_get_rson_data(struct seq_file *m, void *v); -+ssize_t proc_set_rson_data(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+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); -+#ifdef ROKU_PRIVATE -+int proc_get_infra_ap(struct seq_file *m, void *v); -+#endif /* ROKU_PRIVATE */ -+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); -+ssize_t proc_set_tx_power_offset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_tx_power_offset(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 -+ -+#ifdef CONFIG_AP_MODE -+int proc_get_bmc_tx_rate(struct seq_file *m, void *v); -+ssize_t proc_set_bmc_tx_rate(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /*CONFIG_AP_MODE*/ -+ -+int proc_get_ps_dbg_info(struct seq_file *m, void *v); -+ssize_t proc_set_ps_dbg_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, 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); -+ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_sta_linking_test(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#ifdef CONFIG_AP_MODE -+ssize_t proc_set_ap_linking_test(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+ -+int proc_get_rx_stat(struct seq_file *m, void *v); -+int proc_get_tx_stat(struct seq_file *m, void *v); -+int proc_get_sta_tx_stat(struct seq_file *m, void *v); -+ssize_t proc_set_sta_tx_stat(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); -+ -+#ifdef CONFIG_HUAWEI_PROC -+int proc_get_huawei_trx_info(struct seq_file *m, void *v); -+#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); -+ssize_t proc_set_hw_status(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_mac_rptbuf(struct seq_file *m, void *v); -+ -+#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); -+ -+void dump_regsty_rx_ampdu_size_limit(void *sel, _adapter *adapter); -+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); -+ -+void rtw_dump_dft_phy_cap(void *sel, _adapter *adapter); -+void rtw_get_dft_phy_cap(void *sel, _adapter *adapter); -+void rtw_dump_drv_phy_cap(void *sel, _adapter *adapter); -+ -+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_stbc_cap(struct seq_file *m, void *v); -+ssize_t proc_set_stbc_cap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_ldpc_cap(struct seq_file *m, void *v); -+ssize_t proc_set_ldpc_cap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#ifdef CONFIG_BEAMFORMING -+int proc_get_txbf_cap(struct seq_file *m, void *v); -+ssize_t proc_set_txbf_cap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+int proc_get_tx_aval_th(struct seq_file *m, void *v); -+ssize_t proc_set_tx_aval_th(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /*CONFIG_SDIO_TX_ENABLE_AVAL_INT*/ -+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_tx_max_agg_num(struct seq_file *m, void *v); -+ssize_t proc_set_tx_max_agg_num(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); -+ -+int proc_get_tx_quick_addba_req(struct seq_file *m, void *v); -+ssize_t proc_set_tx_quick_addba_req(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#ifdef CONFIG_TX_AMSDU -+int proc_get_tx_amsdu(struct seq_file *m, void *v); -+ssize_t proc_set_tx_amsdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_tx_amsdu_rate(struct seq_file *m, void *v); -+ssize_t proc_set_tx_amsdu_rate(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_80211AC_VHT -+int proc_get_vht_24g_enable(struct seq_file *m, void *v); -+ssize_t proc_set_vht_24g_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+ -+ssize_t proc_set_dyn_rrsr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_dyn_rrsr(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); -+#ifdef CONFIG_RF4CE_COEXIST -+int proc_get_rf4ce_state(struct seq_file *m, void *v); -+ssize_t proc_set_rf4ce_state(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+#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_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); -+int proc_get_pci_aspm(struct seq_file *m, void *v); -+int proc_get_pci_conf_space(struct seq_file *m, void *v); -+ssize_t proc_set_pci_conf_space(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_pci_bridge_conf_space(struct seq_file *m, void *v); -+ssize_t proc_set_pci_bridge_conf_space(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+ -+#ifdef DBG_TXBD_DESC_DUMP -+int proc_get_tx_ring_ext(struct seq_file *m, void *v); -+ssize_t proc_set_tx_ring_ext(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+#endif -+ -+#ifdef CONFIG_WOWLAN -+int proc_get_wow_enable(struct seq_file *m, void *v); -+ssize_t proc_set_wow_enable(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data); -+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_event(struct seq_file *m, void *v); -+ssize_t proc_set_wakeup_event(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); -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+int proc_dump_wow_keep_alive_info(struct seq_file *m, void *v); -+#endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+#endif -+ -+#ifdef CONFIG_WAR_OFFLOAD -+int proc_get_war_offload_enable(struct seq_file *m, void *v); -+ssize_t proc_set_war_offload_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_war_offload_ipv4_addr(struct seq_file *m, void *v); -+ssize_t proc_set_war_offload_ipv4_addr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_war_offload_ipv6_addr(struct seq_file *m, void *v); -+ssize_t proc_set_war_offload_ipv6_addr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_war_offload_mdns_domain_name(struct seq_file *m, void *v); -+ssize_t proc_set_war_offload_mdns_domain_name(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_war_offload_mdns_machine_name(struct seq_file *m, void *v); -+ssize_t proc_set_war_offload_mdns_machine_name(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_war_offload_mdns_txt_rsp(struct seq_file *m, void *v); -+ssize_t proc_set_war_offload_mdns_txt_rsp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_war_offload_mdns_service_info(struct seq_file *m, void *v); -+ssize_t proc_set_war_offload_mdns_service_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+ -+#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); -+ssize_t proc_set_ps_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#ifdef CONFIG_WMMPS_STA -+int proc_get_wmmps_info(struct seq_file *m, void *v); -+ssize_t proc_set_wmmps_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_WMMPS_STA */ -+#endif /* CONFIG_POWER_SAVING */ -+ -+#ifdef CONFIG_TDLS -+int proc_get_tdls_enable(struct seq_file *m, void *v); -+ssize_t proc_set_tdls_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+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 RTW_SIMPLE_CONFIG -+int proc_get_simple_config(struct seq_file *m, void *v); -+ssize_t proc_set_simple_config(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+ -+#ifdef DBG_XMIT_BLOCK -+int proc_get_xmit_block(struct seq_file *m, void *v); -+ssize_t proc_set_xmit_block(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+ -+#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_CUSTOMER01_SMART_ANTENNA -+int proc_get_pathb_phase(struct seq_file *m, void *v); -+ssize_t proc_set_pathb_phase(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+ -+#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_duration(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ssize_t proc_set_mcc_phydm_offload_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+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); -+int proc_get_mcc_policy_table(struct seq_file *m, void *v); -+#endif /* CONFIG_MCC_MODE */ -+ -+int proc_get_ack_timeout(struct seq_file *m, void *v); -+ssize_t proc_set_ack_timeout(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_fw_offload(struct seq_file *m, void *v); -+ssize_t proc_set_fw_offload(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#ifdef CONFIG_FW_HANDLE_TXBCN -+ssize_t proc_set_fw_tbtt_rpt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_fw_tbtt_rpt(struct seq_file *m, void *v); -+#endif -+ -+#ifdef CONFIG_DBG_RF_CAL -+int proc_get_iqk_info(struct seq_file *m, void *v); -+ssize_t proc_set_iqk(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_lck_info(struct seq_file *m, void *v); -+ssize_t proc_set_lck(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /*CONFIG_DBG_RF_CAL*/ -+ -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+ssize_t proc_set_txss_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_txss_tp(struct seq_file *m, void *v); -+#ifdef DBG_CTRL_TXSS -+ssize_t proc_set_txss_ctrl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_txss_ctrl(struct seq_file *m, void *v); -+#endif -+#endif -+ -+#ifdef CONFIG_LPS_CHK_BY_TP -+ssize_t proc_set_lps_chk_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_lps_chk_tp(struct seq_file *m, void *v); -+#endif -+ -+#ifdef CONFIG_SUPPORT_STATIC_SMPS -+ssize_t proc_set_smps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_smps(struct seq_file *m, void *v); -+#endif -+ -+int proc_get_defs_param(struct seq_file *m, void *v); -+ssize_t proc_set_defs_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+ssize_t proc_set_ap_csa_cnt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_ap_csa_cnt(struct seq_file *m, void *v); -+#endif -+ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_eeprom.h b/drivers/net/wireless/rtl8821cs/include/rtw_eeprom.h -new file mode 100644 -index 000000000..62304d577 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_eeprom.h -@@ -0,0 +1,116 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_efuse.h b/drivers/net/wireless/rtl8821cs/include/rtw_efuse.h -new file mode 100644 -index 000000000..b2972d6ed ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_efuse.h -@@ -0,0 +1,287 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 1024 -+ -+#define EFUSE_MAX_HW_SIZE 1024 -+#define EFUSE_MAX_SECTION_BASE 16 -+#define EFUSE_MAX_SECTION_NUM 128 -+#define EFUSE_MAX_BANK_SIZE 512 -+ -+/*RTL8822B 8821C BT EFUSE Define 1 BANK 128 size logical map 1024*/ -+#ifdef RTW_HALMAC -+#define BANK_NUM 1 -+#if defined(CONFIG_RTL8723F) -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 -+#else -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 128 -+#endif -+ -+#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) -+ -+#if defined(CONFIG_RTL8822C) -+#define EFUSE_PROTECT_BYTES_BANK 54 -+#elif defined(CONFIG_RTL8723F) -+#define EFUSE_PROTECT_BYTES_BANK 40 -+#else -+#define EFUSE_PROTECT_BYTES_BANK 16 -+#endif -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_BT_REAL_CONTENT_LEN - EFUSE_PROTECT_BYTES_BANK) -+#endif /* #ifdef RTW_HALMAC */ -+ -+#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) -+ -+#ifdef CONFIG_BT_EFUSE_MASK -+#define IS_BT_MASKED_MP(ic, txt, offset) (EFUSE_IsBTAddressMasked_MP_##ic##txt(offset)) -+#define GET_BT_MASK_ARRAY_LEN_MP(ic, txt) (EFUSE_GetBTArrayLen_MP_##ic##txt()) -+#define GET_BT_MASK_ARRAY_LEN_TC(ic, txt) (EFUSE_GetBTArrayLen_TC_##ic##txt()) -+#define GET_BT_MASK_ARRAY_MP(ic, txt, offset) (EFUSE_GetBTMaskArray_MP_##ic##txt(offset)) -+ -+#define IS_BT_MASKED(ic, txt, offset) (IS_BT_MASKED_MP(ic,txt, offset)) -+#define GET_BT_MASK_ARRAY(ic, txt, out) do { GET_BT_MASK_ARRAY_MP(ic,txt, out); } while(0) -+#define GET_BT_MASK_ARRAY_LEN(ic, txt) (GET_BT_MASK_ARRAY_LEN_MP(ic,txt)) -+#endif -+ -+/* ********************************************* -+ * 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]; -+extern u8 btmaskfileBuffer[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----------------------------*/ -+#define MAX_SEGMENT_SIZE 200 -+#define MAX_SEGMENT_NUM 200 -+#define MAX_BUF_SIZE (MAX_SEGMENT_SIZE*MAX_SEGMENT_NUM) -+#define TMP_BUF_SIZE 100 -+#define rtprintf dcmd_Store_Return_Buf -+ -+u8 efuse_bt_GetCurrentSize(PADAPTER padapter, u16 *size); -+u16 efuse_bt_GetMaxSize(PADAPTER padapter); -+u16 efuse_GetavailableSize(PADAPTER adapter); -+ -+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); -+#ifdef CONFIG_RTL8822C -+void rtw_pre_bt_efuse(PADAPTER padapter); -+#endif -+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); -+#define efuse_onebyte_read(adapter, addr, data, pseudo_test) efuse_OneByteRead((adapter), (addr), (data), (pseudo_test)) -+ -+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); -+#define efuse_logical_map_read(adapter, type, offset, value) EFUSE_ShadowRead((adapter), (type), (offset), (value)) -+ -+BOOLEAN rtw_file_efuse_IsMasked(PADAPTER pAdapter, u16 Offset, u8 *maskbuf); -+BOOLEAN efuse_IsMasked(PADAPTER pAdapter, u16 Offset); -+ -+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_bt_efuse_mask_arraylen(PADAPTER pAdapter); -+void rtw_bt_efuse_mask_array(PADAPTER pAdapter, u8 *pArray); -+u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter); -+void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray); -+void rtw_efuse_analyze(PADAPTER padapter, u8 Type, u8 Fake); -+ -+#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 *filepath, u8 *buf, u32 len); -+#if !defined(CONFIG_RTW_ANDROID_GKI) -+u8 rtw_efuse_file_store(PADAPTER padapter, u8 *filepath, u8 *buf, u32 len); -+#endif /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_event.h b/drivers/net/wireless/rtl8821cs/include/rtw_event.h -new file mode 100644 -index 000000000..13e3f5287 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_event.h -@@ -0,0 +1,95 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+#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; -+ u8 activate_ch_cnt; -+ bool acs; /* aim to trigger channel selection */ -+}; -+ -+/* -+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 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 */ -+ -+struct rtw_event { -+ u32 parmsize; -+ void (*event_callback)(_adapter *dev, u8 *pbuf); -+}; -+#endif /* _WLANEVENT_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_ft.h b/drivers/net/wireless/rtl8821cs/include/rtw_ft.h -new file mode 100755 -index 000000000..025f19e67 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_ft.h -@@ -0,0 +1,183 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_FT_H_ -+#define __RTW_FT_H_ -+ -+enum rtw_ieee80211_ft_actioncode { -+ RTW_WLAN_ACTION_FT_RESV, -+ RTW_WLAN_ACTION_FT_REQ, -+ RTW_WLAN_ACTION_FT_RSP, -+ RTW_WLAN_ACTION_FT_CONF, -+ RTW_WLAN_ACTION_FT_ACK, -+ RTW_WLAN_ACTION_FT_MAX, -+}; -+ -+enum _rtw_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 -+}; -+ -+#define RTW_FT_ACTION_REQ_LMT 4 -+ -+#define RTW_FT_MAX_IE_SZ 256 -+ -+#define rtw_ft_chk_status(a, s) \ -+ ((a)->mlmepriv.ft_roam.ft_status == (s)) -+ -+#define rtw_ft_roam_status(a, s) \ -+ ((rtw_to_roam(a) > 0) && rtw_ft_chk_status(a, s)) -+ -+#define rtw_ft_authed_sta(a) \ -+ ((rtw_ft_chk_status(a, RTW_FT_AUTHENTICATED_STA)) || \ -+ (rtw_ft_chk_status(a, RTW_FT_ASSOCIATING_STA)) || \ -+ (rtw_ft_chk_status(a, RTW_FT_ASSOCIATED_STA))) -+ -+#define rtw_ft_set_status(a, s) \ -+ do { \ -+ ((a)->mlmepriv.ft_roam.ft_status = (s)); \ -+ } while (0) -+ -+#define rtw_ft_lock_set_status(a, s, irq) \ -+ do { \ -+ _enter_critical_bh(&(a)->mlmepriv.lock, ((_irqL *)(irq))); \ -+ ((a)->mlmepriv.ft_roam.ft_status = (s)); \ -+ _exit_critical_bh(&(a)->mlmepriv.lock, ((_irqL *)(irq))); \ -+ } while (0) -+ -+#define rtw_ft_reset_status(a) \ -+ do { \ -+ ((a)->mlmepriv.ft_roam.ft_status = RTW_FT_UNASSOCIATED_STA); \ -+ } while (0) -+ -+enum rtw_ft_capability { -+ RTW_FT_EN = BIT0, -+ RTW_FT_OTD_EN = BIT1, -+ RTW_FT_PEER_EN = BIT2, -+ RTW_FT_PEER_OTD_EN = BIT3, -+ RTW_FT_BTM_ROAM = BIT4, -+ RTW_FT_TEST_RSSI_ROAM = BIT7, -+}; -+ -+#define rtw_ft_chk_flags(a, f) \ -+ ((a)->mlmepriv.ft_roam.ft_flags & (f)) -+ -+#define rtw_ft_set_flags(a, f) \ -+ do { \ -+ ((a)->mlmepriv.ft_roam.ft_flags |= (f)); \ -+ } while (0) -+ -+#define rtw_ft_clr_flags(a, f) \ -+ do { \ -+ ((a)->mlmepriv.ft_roam.ft_flags &= ~(f)); \ -+ } while (0) -+ -+#define rtw_ft_roam(a) \ -+ ((rtw_to_roam(a) > 0) && rtw_ft_chk_flags(a, RTW_FT_PEER_EN)) -+ -+#define rtw_ft_valid_akm(a, t) \ -+ ((rtw_ft_chk_flags(a, RTW_FT_EN)) && \ -+ (((t) == 3) || ((t) == 4))) -+ -+#define rtw_ft_roam_expired(a, r) \ -+ ((rtw_chk_roam_flags(a, RTW_ROAM_ON_EXPIRED)) \ -+ && (r == WLAN_REASON_ACTIVE_ROAM)) -+ -+#define rtw_ft_otd_roam_en(a) \ -+ ((rtw_ft_chk_flags(a, RTW_FT_OTD_EN)) \ -+ && ((a)->mlmepriv.ft_roam.ft_roam_on_expired == _FALSE) \ -+ && ((a)->mlmepriv.ft_roam.ft_cap & 0x01)) -+ -+#define rtw_ft_otd_roam(a) \ -+ rtw_ft_chk_flags(a, RTW_FT_PEER_OTD_EN) -+ -+#define rtw_ft_valid_otd_candidate(a, p) \ -+ ((rtw_ft_chk_flags(a, RTW_FT_OTD_EN)) \ -+ && ((rtw_ft_chk_flags(a, RTW_FT_PEER_OTD_EN) \ -+ && ((*((p)+4) & 0x01) == 0)) \ -+ || ((rtw_ft_chk_flags(a, RTW_FT_PEER_OTD_EN) == 0) \ -+ && (*((p)+4) & 0x01)))) -+ -+struct ft_roam_info { -+ u16 mdid; -+ u8 ft_cap; -+ /*b0: FT over DS, b1: Resource Req Protocol Cap, b2~b7: Reserved*/ -+ u8 updated_ft_ies[RTW_FT_MAX_IE_SZ]; -+ u16 updated_ft_ies_len; -+ u8 ft_action[RTW_FT_MAX_IE_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; -+ bool ft_updated_bcn; -+}; -+ -+void rtw_ft_info_init(struct ft_roam_info *pft); -+ -+int rtw_ft_proc_flags_get(struct seq_file *m, void *v); -+ -+ssize_t rtw_ft_proc_flags_set(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data); -+ -+u8 rtw_ft_chk_roaming_candidate( -+ _adapter *padapter, struct wlan_network *competitor); -+ -+void rtw_ft_update_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork); -+ -+void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf); -+ -+void rtw_ft_validate_akm_type(_adapter *padapter, -+ struct wlan_network *pnetwork); -+ -+void rtw_ft_update_bcn(_adapter *padapter, union recv_frame *precv_frame); -+ -+void rtw_ft_start_clnt_join(_adapter *padapter); -+ -+u8 rtw_ft_update_rsnie( -+ _adapter *padapter, u8 bwrite, -+ struct pkt_attrib *pattrib, u8 **pframe); -+ -+void rtw_ft_build_auth_req_ies(_adapter *padapter, -+ struct pkt_attrib *pattrib, u8 **pframe); -+ -+void rtw_ft_build_assoc_req_ies(_adapter *padapter, -+ u8 is_reassoc, struct pkt_attrib *pattrib, u8 **pframe); -+ -+u8 rtw_ft_update_auth_rsp_ies(_adapter *padapter, u8 *pframe, u32 len); -+ -+void rtw_ft_start_roam(_adapter *padapter, u8 *pTargetAddr); -+ -+void rtw_ft_issue_action_req(_adapter *padapter, u8 *pTargetAddr); -+ -+void rtw_ft_report_evt(_adapter *padapter); -+ -+void rtw_ft_report_reassoc_evt(_adapter *padapter, u8 *pMacAddr); -+ -+void rtw_ft_link_timer_hdl(void *ctx); -+ -+void rtw_ft_roam_timer_hdl(void *ctx); -+ -+void rtw_ft_roam_status_reset(_adapter *padapter); -+ -+#endif /* __RTW_FT_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_ht.h b/drivers/net/wireless/rtl8821cs/include/rtw_ht.h -new file mode 100644 -index 000000000..8237bbe76 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_ht.h -@@ -0,0 +1,217 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+#define HT_CAP_IE_LEN 26 -+#define HT_OP_IE_LEN 22 -+ -+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*/ -+ -+ u8 op_present:1; /* ht_op is present */ -+ -+ struct rtw_ieee80211_ht_cap ht_cap; -+ u8 ht_op[HT_OP_IE_LEN]; -+ -+}; -+ -+#ifdef ROKU_PRIVATE -+struct ht_priv_infra_ap { -+ -+ /*Infra mode, only store AP's info , not intersection of STA and AP*/ -+ u8 channel_width_infra_ap; -+ u8 sgi_20m_infra_ap; -+ u8 sgi_40m_infra_ap; -+ u8 ldpc_cap_infra_ap; -+ u8 stbc_cap_infra_ap; -+ u8 MCS_set_infra_ap[16]; -+ u8 Rx_ss_infra_ap; -+ u16 rx_highest_data_rate_infra_ap; -+}; -+#endif /* ROKU_PRIVATE */ -+ -+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; -+ -+#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 -+ -+/* ------------------------------------------------------------ -+ * 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) -+ -+#define SET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 0, 2, _val) -+#define SET_HT_CAP_ELE_MIN_MPDU_S_SPACE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 2, 3, _val) -+ -+/* 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_RX_MCS_BMP_FMT "%02x %02x %02x %02x %02x%02x%02x%02x%02x%02x" -+#define HT_RX_MCS_BMP_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] -+ -+#define HT_SUP_MCS_SET_FMT HT_RX_MCS_BMP_FMT \ -+ /* "\n%02x%02x%02x%02x%02x%02x" */\ -+ " %uMbps %s%s%s" -+#define HT_SUP_MCS_SET_ARG(x) HT_RX_MCS_BMP_ARG(x) \ -+ /*,((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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_io.h b/drivers/net/wireless/rtl8821cs/include/rtw_io.h -new file mode 100644 -index 000000000..50291e1b8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_io.h -@@ -0,0 +1,526 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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; -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt); -+ u8 *cnxt; -+}; -+ -+struct intf_hdl { -+ _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 -+u32 match_read_sniff(_adapter *adapter, u32 addr, u16 len, u32 val); -+u32 match_write_sniff(_adapter *adapter, u32 addr, u16 len, u32 val); -+bool match_rf_read_sniff_ranges(_adapter *adapter, u8 path, u32 addr, u32 mask); -+bool match_rf_write_sniff_ranges(_adapter *adapter, u8 path, u32 addr, u32 mask); -+ -+void dbg_rtw_reg_read_monitor(_adapter *adapter, u32 addr, u32 len, u32 val, const char *caller, const int line); -+void dbg_rtw_reg_write_monitor(_adapter *adapter, u32 addr, u32 len, u32 val, const char *caller, const int line); -+ -+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 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); -+ -+/* -+#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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_ioctl.h b/drivers/net/wireless/rtl8821cs/include/rtw_ioctl.h -new file mode 100644 -index 000000000..1143d9710 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_ioctl.h -@@ -0,0 +1,47 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+enum oid_type { -+ QUERY_OID, -+ SET_OID -+}; -+ -+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; -+}; -+ -+#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); -+ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+extern int rtw_vendor_ie_get_raw_data(struct net_device *, u32, char *, u32); -+extern int rtw_vendor_ie_get_data(struct net_device*, int , char*); -+extern int rtw_vendor_ie_get(struct net_device *, struct iw_request_info *, union iwreq_data *, char *); -+extern int rtw_vendor_ie_set(struct net_device*, struct iw_request_info*, union iwreq_data*, char*); -+#endif -+ -+#endif /* #ifndef __INC_CEINFO_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_ioctl_query.h b/drivers/net/wireless/rtl8821cs/include/rtw_ioctl_query.h -new file mode 100644 -index 000000000..7badcddfb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_ioctl_query.h -@@ -0,0 +1,19 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_QUERY_H_ -+#define _RTW_IOCTL_QUERY_H_ -+ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_ioctl_set.h b/drivers/net/wireless/rtl8821cs/include/rtw_ioctl_set.h -new file mode 100644 -index 000000000..aeff45352 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_ioctl_set.h -@@ -0,0 +1,40 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+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, struct sitesurvey_parm *pparm); -+#ifdef CONFIG_RTW_ACS -+u8 rtw_set_acs_sitesurvey(_adapter *adapter); -+#endif -+u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, u8 flags); -+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, u16 ch); -+ -+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, u8 chplan_6g, enum rtw_regd_inr inr); -+int rtw_set_country(_adapter *adapter, const char *country_code, enum rtw_regd_inr inr); -+int rtw_set_band(_adapter *adapter, u8 band); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_iol.h b/drivers/net/wireless/rtl8821cs/include/rtw_iol.h -new file mode 100644 -index 000000000..fa35a59c7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_iol.h -@@ -0,0 +1,131 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_mbo.h b/drivers/net/wireless/rtl8821cs/include/rtw_mbo.h -new file mode 100755 -index 000000000..9524cb6c6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_mbo.h -@@ -0,0 +1,114 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_MBO_H_ -+#define __RTW_MBO_H_ -+ -+#define rtw_mbo_wifi_logo_test(a) ((a->registrypriv.wifi_spec) == 1) -+ -+#define rtw_mbo_set_ext_cap_internw(_pEleStart, _val) \ -+ SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart))+3, 7, 1, _val) -+ -+#define rtw_mbo_wnm_notification_req(c, a) \ -+ (((c) == RTW_WLAN_CATEGORY_WNM) && \ -+ (((a) == RTW_WLAN_ACTION_WNM_NOTIF_REQ))) -+ -+/* IEEE Std 802.11-2016 Table 9-46 - Status codes */ -+#define RTW_ASSOC_DENIED_NO_MORE_STAS 17 -+#define RTW_ASSOC_REFUSED_TEMPORARILY 30 -+ -+/* MBO-OCE Information Element */ -+#define RTW_MBO_EID WLAN_EID_VENDOR_SPECIFIC -+#define RTW_MBO_OUI 0x506F9A -+#define RTW_MBO_OUI_TYPE 0x16 -+ -+/* Non-preferred Channel Report */ -+#define RTW_MBO_ATTR_NPREF_CH_RPT_ID 0x2 -+/* Cellular Data Capabilities */ -+#define RTW_MBO_ATTR_CELL_DATA_CAP_ID 0x3 -+/* Association Disallowed */ -+#define RTW_MBO_ATTR_ASSOC_DISABLED_ID 0x4 -+/* Transition Reason Code */ -+#define RTW_MBO_ATTR_TRANS_RES_ID 0x6 -+/* Transition Rejection Reason Code */ -+#define RTW_MBO_ATTR_TRANS_REJ_ID 0x7 -+/* Association Retry Delay */ -+#define RTW_MBO_ATTR_TASSOC_RETRY_ID 0x8 -+ -+#define RTW_MBO_MAX_CH_LIST_NUM MAX_CHANNEL_NUM -+ -+#define RTW_MBO_MAX_CH_RPT_NUM 32 -+ -+struct npref_ch { -+ u8 op_class; -+ u8 chs[RTW_MBO_MAX_CH_LIST_NUM]; -+ size_t nm_of_ch; -+ u8 preference; -+ u8 reason; -+}; -+ -+struct npref_ch_rtp { -+ struct npref_ch ch_rpt[RTW_MBO_MAX_CH_RPT_NUM]; -+ size_t nm_of_rpt; -+}; -+ -+void rtw_mbo_build_cell_data_cap_attr( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib); -+ -+void rtw_mbo_update_ie_data( -+ _adapter *padapter, u8 *pie, u32 ie_len); -+ -+void rtw_mbo_build_supp_op_class_elem( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib); -+ -+void rtw_mbo_build_npref_ch_rpt_attr( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib); -+ -+void rtw_mbo_build_trans_reject_reason_attr( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib, u8 *pres); -+ -+u8 rtw_mbo_disallowed_network(struct wlan_network *pnetwork); -+ -+void rtw_mbo_build_exented_cap( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib); -+ -+ssize_t rtw_mbo_proc_non_pref_chans_set( -+ struct file *pfile, const char __user *buffer, -+ size_t count, loff_t *pos, void *pdata); -+ -+int rtw_mbo_proc_non_pref_chans_get( -+ struct seq_file *m, void *v); -+ -+ssize_t rtw_mbo_proc_cell_data_set( -+ struct file *pfile, const char __user *buffer, -+ size_t count, loff_t *pos, void *pdata); -+ -+int rtw_mbo_proc_cell_data_get( -+ struct seq_file *m, void *v); -+ -+void rtw_mbo_wnm_notification_parsing( -+ _adapter *padapter, const u8 *pdata, size_t data_len); -+ -+void rtw_mbo_build_wnm_notification( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib); -+ -+void rtw_mbo_build_probe_req_ies( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib); -+ -+void rtw_mbo_build_assoc_req_ies( -+ _adapter *padapter, u8 **pframe, struct pkt_attrib *pattrib); -+ -+#endif /* __RTW_MBO_H_ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_mcc.h b/drivers/net/wireless/rtl8821cs/include/rtw_mcc.h -new file mode 100644 -index 000000000..5d2198b03 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_mcc.h -@@ -0,0 +1,315 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+#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_SWCH_FW_EARLY_TIME 10 /* ms */ -+#define MCC_EXPIRE_TIME 50 /* ms */ -+#define MCC_TOLERANCE_TIME 2 /* 2*2 = 4s */ -+#define MCC_UPDATE_PARAMETER_THRESHOLD 5 /* ms */ -+ -+#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 -+#ifdef CONFIG_RTL8822C -+#define DBG_MCC_REG_NUM 3 -+#else -+#define DBG_MCC_REG_NUM 4 -+#endif -+#define DBG_MCC_RF_REG_NUM 1 -+ -+#define MCC_STOP(adapter) (adapter->mcc_adapterpriv.mcc_tx_stop) -+#define MCC_EN(adapter) (adapter_to_dvobj(adapter)->mcc_objpriv.en_mcc) -+#define adapter_to_mccobjpriv(adapter) (&(adapter_to_dvobj(adapter)->mcc_objpriv)) -+#define SET_MCC_EN_FLAG(adapter, flag)\ -+ do { \ -+ adapter_to_dvobj(adapter)->mcc_objpriv.en_mcc = (flag); \ -+ } while (0) -+#define SET_MCC_DURATION(adapter, val)\ -+ do { \ -+ adapter_to_dvobj(adapter)->mcc_objpriv.duration = (val); \ -+ } while (0) -+#define SET_MCC_RUNTIME_DURATION(adapter, flag)\ -+ do { \ -+ adapter_to_dvobj(adapter)->mcc_objpriv.enable_runtime_duration = (flag); \ -+ } while (0) -+ -+#define SET_MCC_PHYDM_OFFLOAD(adapter, flag)\ -+ do { \ -+ adapter_to_dvobj(adapter)->mcc_objpriv.mcc_phydm_offload = (flag); \ -+ } while (0) -+ -+#ifdef CONFIG_MCC_PHYDM_OFFLOAD -+enum mcc_cfg_phydm_ops { -+ MCC_CFG_PHYDM_OFFLOAD = 0, -+ MCC_CFG_PHYDM_RF_CH, -+ MCC_CFG_PHYDM_ADD_CLIENT, -+ MCC_CFG_PHYDM_REMOVE_CLIENT, -+ MCC_CFG_PHYDM_START, -+ MCC_CFG_PHYDM_STOP, -+ MCC_CFG_PHYDM_DUMP, -+ MCC_CFG_PHYDM_MAX, -+}; -+#endif -+ -+enum rtw_mcc_cmd_id { -+ MCC_CMD_WK_CID = 0, -+ MCC_SET_DURATION_WK_CID, -+ MCC_GET_DBG_REG_WK_CID, -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ MCC_SET_PHYDM_OFFLOAD_WK_CID, -+ #endif -+}; -+ -+/* 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_UPDATE_NOA_START_TIME = 8, -+ MCC_RPT_TSF = 9, -+ 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; -+}; -+ -+enum mcc_duration_setting { -+ MCC_DURATION_MAPPING = 0, -+ MCC_DURATION_DIRECET = 1, -+}; -+ -+enum mcc_sched_mode { -+ MCC_FAIR_SCHEDULE = 0, -+ MCC_FAVOR_STA = 1, -+ MCC_FAVOR_P2P = 2, -+}; -+ -+/* mcc data for adapter */ -+struct mcc_adapter_priv { -+ u8 order; /* FW document, softap/AP must be 0 */ -+ enum mcc_role 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; -+ -+ /* use for NoA start time (unit: mircoseconds) */ -+ u32 noa_start_time; -+ -+ u8 p2p_go_noa_ie[MAX_P2P_IE_LEN]; -+ u32 p2p_go_noa_ie_len; -+ u64 tsf; -+#ifdef CONFIG_TDLS -+ u8 backup_tdls_en; -+#endif /* CONFIG_TDLS */ -+ -+ u8 null_early; -+ u8 null_rty_num; -+}; -+ -+struct mcc_obj_priv { -+ u8 en_mcc; /* enable MCC or not */ -+ u8 duration; /* store duration(%) from registry, for primary adapter */ -+ u8 interval; -+ u8 start_time; -+ 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 .... */ -+ u8 policy_index; -+ u8 mcc_stop_threshold; -+ u8 current_order; -+ u8 last_tsfdiff; -+ systime 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; -+ struct submit_ctx mcc_tsf_req_sctx; -+ _mutex mcc_tsf_req_mutex; -+ u8 mcc_tsf_req_sctx_order; /* record current order for mcc_tsf_req_sctx */ -+#ifdef CONFIG_MCC_MODE_V2 -+ u8 mcc_iqk_value_rsvd_page[3]; -+#endif /* CONFIG_MCC_MODE_V2 */ -+ u8 mcc_pwr_idx_rsvd_page[MAX_MCC_NUM]; -+ u8 enable_runtime_duration; -+ /* for LG */ -+ u8 mchan_sched_mode; -+ -+ _mutex mcc_dbg_reg_mutex; -+ u32 dbg_reg[DBG_MCC_REG_NUM]; -+ u32 dbg_reg_val[DBG_MCC_REG_NUM]; -+ u32 dbg_rf_reg[DBG_MCC_RF_REG_NUM]; -+ u32 dbg_rf_reg_val[DBG_MCC_RF_REG_NUM][MAX_RF_PATH]; -+ u8 mcc_phydm_offload; -+}; -+ -+/* backup IQK val */ -+void rtw_hal_mcc_restore_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 *total_page_num, RSVDPAGE_LOC *rsvd_page_loc, u8 *page_num); -+ -+/* 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); -+ -+u8 *rtw_hal_mcc_append_go_p2p_ie(PADAPTER padapter, u8 *pframe, u32 *len); -+ -+void rtw_hal_dump_mcc_policy_table(void *sel); -+ -+void rtw_hal_mcc_update_macid_bitmap(PADAPTER padapter, int mac_id, u8 add); -+ -+void rtw_hal_mcc_process_noa(PADAPTER padapter); -+ -+void rtw_hal_mcc_parameter_init(PADAPTER padapter); -+ -+u8 rtw_mcc_cmd_hdl(PADAPTER adapter, u8 type, const u8 *val); -+ -+u8 rtw_set_mcc_duration_cmd(_adapter *adapter, u8 type, u8 val); -+#ifdef CONFIG_MCC_PHYDM_OFFLOAD -+u8 rtw_set_mcc_phydm_offload_enable_cmd(PADAPTER adapter, u8 enable, u8 enqueue); -+#endif /* CONFIG_MCC_PHYDM_OFFLOAD */ -+#endif /* _RTW_MCC_H_ */ -+#endif /* CONFIG_MCC_MODE */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_mem.h b/drivers/net/wireless/rtl8821cs/include/rtw_mem.h -new file mode 100644 -index 000000000..9e33ed519 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_mem.h -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_MEM_H__ -+#define __RTW_MEM_H__ -+ -+#include -+#include -+#include -+ -+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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_mi.h b/drivers/net/wireless/rtl8821cs/include/rtw_mi.h -new file mode 100644 -index 000000000..e4f240e57 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_mi.h -@@ -0,0 +1,309 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_MI_H_ -+#define __RTW_MI_H_ -+ -+void rtw_mi_update_union_chan_inf(_adapter *adapter, u8 ch, u8 offset , u8 bw); -+u8 rtw_mi_stayin_union_ch_chk(_adapter *adapter); -+u8 rtw_mi_stayin_union_band_chk(_adapter *adapter); -+ -+int rtw_mi_get_ch_setting_union_by_ifbmp(struct dvobj_priv *dvobj, u8 ifbmp, u8 *ch, u8 *bw, u8 *offset); -+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_STATION_STATE */ -+ u8 ld_sta_num; /* WIFI_STATION_STATE && WIFI_ASOC_STATE */ -+ u8 lg_sta_num; /* WIFI_STATION_STATE && WIFI_UNDER_LINKING */ -+#ifdef CONFIG_TDLS -+ u8 ld_tdls_num; /* adapter.tdlsinfo.link_established */ -+#endif -+#ifdef CONFIG_AP_MODE -+ u8 ap_num; /* WIFI_AP_STATE && WIFI_ASOC_STATE */ -+ u8 starting_ap_num; /*WIFI_FW_AP_STATE*/ -+ u8 ld_ap_num; /* WIFI_AP_STATE && WIFI_ASOC_STATE && asoc_sta_count > 2 */ -+#endif -+ u8 adhoc_num; /* (WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) && WIFI_ASOC_STATE */ -+ u8 ld_adhoc_num; /* (WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) && WIFI_ASOC_STATE && asoc_sta_count > 2 */ -+#ifdef CONFIG_RTW_MESH -+ u8 mesh_num; /* WIFI_MESH_STATE && WIFI_ASOC_STATE */ -+ u8 ld_mesh_num; /* WIFI_MESH_STATE && WIFI_ASOC_STATE && asoc_sta_count > 2 */ -+#endif -+ u8 scan_num; /* WIFI_UNDER_SURVEY */ -+ u8 scan_enter_num; /* WIFI_UNDER_SURVEY && !SCAN_DISABLE && !SCAN_BACK_OP */ -+ u8 uwps_num; /* WIFI_UNDER_WPS */ -+#ifdef CONFIG_IOCTL_CFG80211 -+ u8 roch_num; -+ u8 mgmt_tx_num; -+#endif -+#ifdef CONFIG_P2P -+ u8 p2p_device_num; -+ u8 p2p_gc; -+ u8 p2p_go; -+#endif -+}; -+ -+#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) -+ -+#ifdef CONFIG_TDLS -+#define MSTATE_TDLS_LD_NUM(_mstate) ((_mstate)->ld_tdls_num) -+#else -+#define MSTATE_TDLS_LD_NUM(_mstate) 0 -+#endif -+ -+#ifdef CONFIG_AP_MODE -+#define MSTATE_AP_NUM(_mstate) ((_mstate)->ap_num) -+#define MSTATE_AP_STARTING_NUM(_mstate) ((_mstate)->starting_ap_num) -+#define MSTATE_AP_LD_NUM(_mstate) ((_mstate)->ld_ap_num) -+#else -+#define MSTATE_AP_NUM(_mstate) 0 -+#define MSTATE_AP_STARTING_NUM(_mstate) 0 -+#define MSTATE_AP_LD_NUM(_mstate) 0 -+#endif -+ -+#define MSTATE_ADHOC_NUM(_mstate) ((_mstate)->adhoc_num) -+#define MSTATE_ADHOC_LD_NUM(_mstate) ((_mstate)->ld_adhoc_num) -+ -+#ifdef CONFIG_RTW_MESH -+#define MSTATE_MESH_NUM(_mstate) ((_mstate)->mesh_num) -+#define MSTATE_MESH_LD_NUM(_mstate) ((_mstate)->ld_mesh_num) -+#else -+#define MSTATE_MESH_NUM(_mstate) 0 -+#define MSTATE_MESH_LD_NUM(_mstate) 0 -+#endif -+ -+#define MSTATE_SCAN_NUM(_mstate) ((_mstate)->scan_num) -+#define MSTATE_SCAN_ENTER_NUM(_mstate) ((_mstate)->scan_enter_num) -+#define MSTATE_WPS_NUM(_mstate) ((_mstate)->uwps_num) -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+#define MSTATE_ROCH_NUM(_mstate) ((_mstate)->roch_num) -+#else -+#define MSTATE_ROCH_NUM(_mstate) 0 -+#endif -+ -+#ifdef CONFIG_P2P -+#define MSTATE_P2P_DV_NUM(_mstate) ((_mstate)->p2p_device_num) -+#define MSTATE_P2P_GC_NUM(_mstate) ((_mstate)->p2p_gc) -+#define MSTATE_P2P_GO_NUM(_mstate) ((_mstate)->p2p_go) -+#else -+#define MSTATE_P2P_DV_NUM(_mstate) 0 -+#define MSTATE_P2P_GC_NUM(_mstate) 0 -+#define MSTATE_P2P_GO_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 rtw_mi_get_union_chan(adapter) ((adapter_to_dvobj(adapter)->union_ch) ? (adapter_to_dvobj(adapter)->union_ch) : (adapter_to_dvobj(adapter)->union_ch_bak)) -+#define rtw_mi_get_union_bw(adapter) ((adapter_to_dvobj(adapter)->union_ch) ? (adapter_to_dvobj(adapter)->union_bw) : (adapter_to_dvobj(adapter)->union_bw_bak)) -+#define rtw_mi_get_union_offset(adapter) ((adapter_to_dvobj(adapter)->union_ch) ? (adapter_to_dvobj(adapter)->union_offset) : (adapter_to_dvobj(adapter)->union_offset_bak)) -+ -+#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)) -+#define rtw_mi_get_mesh_num(adapter) DEV_MESH_NUM(adapter_to_dvobj(adapter)) -+u8 rtw_mi_get_assoc_if_num(_adapter *adapter); -+ -+/* For now, not return union_ch/bw/offset */ -+void rtw_mi_status_by_ifbmp(struct dvobj_priv *dvobj, u8 ifbmp, struct mi_state *mstate); -+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_status_no_others(_adapter *adapter, struct mi_state *mstate); -+ -+/* For now, not handle union_ch/bw/offset */ -+void rtw_mi_status_merge(struct mi_state *d, struct mi_state *a); -+ -+void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state); -+ -+u8 rtw_mi_netif_stop_queue(_adapter *padapter); -+u8 rtw_mi_buddy_netif_stop_queue(_adapter *padapter); -+ -+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); -+u8 rtw_mi_netif_carrier_off(_adapter *padapter); -+u8 rtw_mi_buddy_netif_carrier_off(_adapter *padapter); -+ -+u8 rtw_mi_netif_caroff_qstop(_adapter *padapter); -+u8 rtw_mi_buddy_netif_caroff_qstop(_adapter *padapter); -+u8 rtw_mi_netif_caron_qstart(_adapter *padapter); -+u8 rtw_mi_buddy_netif_caron_qstart(_adapter *padapter); -+ -+void rtw_mi_scan_abort(_adapter *adapter, bool bwait); -+void rtw_mi_buddy_scan_abort(_adapter *adapter, bool bwait); -+u32 rtw_mi_start_drv_threads(_adapter *adapter); -+u32 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); -+ -+#ifdef CONFIG_NEW_NETDEV_HDL -+u8 rtw_mi_hal_iface_init(_adapter *padapter); -+#endif -+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); -+ -+#ifdef CONFIG_AP_MODE -+void rtw_mi_beacon_update(_adapter *padapter); -+void rtw_mi_buddy_beacon_update(_adapter *padapter); -+void rtw_mi_update_csa(_adapter *adapter); -+#endif -+ -+#ifndef CONFIG_MI_WITH_MBSSID_CAM -+void rtw_mi_hal_dump_macaddr(void *sel, _adapter *padapter); -+void rtw_mi_buddy_hal_dump_macaddr(void *sel, _adapter *padapter); -+#endif -+ -+#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); -+u8 rtw_mi_buddy_busy_traffic_check(_adapter *padapter); -+ -+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_MESH, -+ MI_MESH_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 -+#elif defined(CONFIG_RTL8822C) -+ #include -+#elif defined(CONFIG_RTL8723F) -+ #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); -+ -+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); -+ -+#ifdef CONFIG_AP_MODE -+#if defined(DBG_CONFIG_ERROR_RESET) && defined(CONFIG_CONCURRENT_MODE) -+void rtw_mi_ap_info_restore(_adapter *adapter); -+#endif -+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); -+#endif /* CONFIG_AP_MODE */ -+ -+#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, const 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 -+ -+u8 rtw_mi_get_ld_sta_ifbmp(_adapter *adapter); -+u8 rtw_mi_get_ap_mesh_ifbmp(_adapter *adapter); -+void rtw_mi_update_ap_bmc_camid(_adapter *padapter, u8 camid_a, u8 camid_b); -+ -+_adapter *rtw_mi_get_linking_adapter(_adapter *adapter); -+#endif /*__RTW_MI_H_*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_mlme.h b/drivers/net/wireless/rtl8821cs/include/rtw_mlme.h -new file mode 100755 -index 000000000..197b4bc5e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_mlme.h -@@ -0,0 +1,1257 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 SCANQUEUE_LIFETIME 20000 /* 20sec, unit:msec */ -+ -+#define MAX_UNASSOC_STA_CNT 128 -+#define UNASSOC_STA_LIFETIME_MS 60000 -+ -+/*pmlmepriv->fw_state*/ -+#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_MESH_STATE 0x00000200 -+#define WIFI_STA_ALIVE_CHK_STATE 0x00000400 -+#define WIFI_UNDER_SURVEY 0x00000800 /* under site surveying */ -+/*#define WIFI_UNDEFINED_STATE 0x00001000*/ -+/*#define WIFI_UNDEFINED_STATE 0x00002000*/ -+/*#define WIFI_UNDEFINED_STATE 0x00004000*/ -+/*#define WIFI_UNDEFINED_STATE 0x00008000*/ -+#define WIFI_MP_STATE 0x00010000 -+/*#define WIFI_UNDEFINED_STATE 0x00020000*/ -+/*#define WIFI_UNDEFINED_STATE 0x00040000*/ -+/*#define WIFI_UNDEFINED_STATE 0x00080000*/ -+/*#define WIFI_UNDEFINED_STATE 0x00100000*/ -+/*#define WIFI_UNDEFINED_STATE 0x00200000*/ -+/*#define WIFI_UNDEFINED_STATE 0x00400000*/ -+#define WIFI_OP_CH_SWITCHING 0x00800000 -+#define WIFI_UNDER_KEY_HANDSHAKE 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_CSA_UPDATE_BEACON 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 CHK_MLME_STATE(adapter, state) check_fwstate(&((adapter)->mlmepriv), (state)) -+ -+#define MLME_IS_NULL(adapter) CHK_MLME_STATE(adapter, WIFI_NULL_STATE) -+#define MLME_IS_STA(adapter) CHK_MLME_STATE(adapter, WIFI_STATION_STATE) -+#define MLME_IS_AP(adapter) CHK_MLME_STATE(adapter, WIFI_AP_STATE) -+#define MLME_IS_ADHOC(adapter) CHK_MLME_STATE(adapter, WIFI_ADHOC_STATE) -+#define MLME_IS_ADHOC_MASTER(adapter) CHK_MLME_STATE(adapter, WIFI_ADHOC_MASTER_STATE) -+#define MLME_IS_MESH(adapter) CHK_MLME_STATE(adapter, WIFI_MESH_STATE) -+#define MLME_IS_MONITOR(adapter) CHK_MLME_STATE(adapter, WIFI_MONITOR_STATE) -+#define MLME_IS_MP(adapter) CHK_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 */ -+ -+#define MLME_IS_MSRC(adapter) rtw_chk_miracast_mode((adapter), MIRACAST_SOURCE) -+#define MLME_IS_MSINK(adapter) rtw_chk_miracast_mode((adapter), MIRACAST_SINK) -+ -+#define MLME_IS_SCAN(adapter) CHK_MLME_STATE(adapter, WIFI_UNDER_SURVEY) -+#define MLME_IS_LINKING(adapter) CHK_MLME_STATE(adapter, WIFI_UNDER_LINKING) -+#define MLME_IS_ASOC(adapter) CHK_MLME_STATE(adapter, WIFI_ASOC_STATE) -+#define MLME_IS_OPCH_SW(adapter) CHK_MLME_STATE(adapter, WIFI_OP_CH_SWITCHING) -+#define MLME_IS_WPS(adapter) CHK_MLME_STATE(adapter, WIFI_UNDER_WPS) -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+#define MLME_IS_ROCH(adapter) (rtw_cfg80211_get_is_roch(adapter) == _TRUE) -+#else -+#define MLME_IS_ROCH(adapter) 0 -+#endif -+ -+#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_MESH((adapter)) ? " MESH" : \ -+ 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_IS_SCAN((adapter)) ? " SCAN" : "", \ -+ MLME_IS_LINKING((adapter)) ? " LINKING" : "", \ -+ MLME_IS_ASOC((adapter)) ? " ASOC" : "", \ -+ MLME_IS_OPCH_SW((adapter)) ? " OPCH_SW" : "", \ -+ MLME_IS_WPS((adapter)) ? " WPS" : "", \ -+ MLME_IS_ROCH((adapter)) ? " ROCH" : "", \ -+ MLME_IS_MGMT_TX((adapter)) ? " MGMT_TX" : "", \ -+ (MLME_STATE((adapter)) & WIFI_SLEEP_STATE) ? " SLEEP" : "" -+ -+enum { -+ MLME_ACTION_UNKNOWN, -+ MLME_ACTION_NONE, -+ MLME_SCAN_ENABLE, /* WIFI_UNDER_SURVEY */ -+ MLME_SCAN_ENTER, /* WIFI_UNDER_SURVEY && !SCAN_DISABLE && !SCAN_BACK_OP */ -+ MLME_SCAN_DONE, /* WIFI_UNDER_SURVEY && (SCAN_DISABLE || SCAN_BACK_OP) */ -+ MLME_SCAN_DISABLE, /* WIFI_UNDER_SURVEY is going to be cleared */ -+ MLME_STA_CONNECTING, -+ MLME_STA_CONNECTED, -+ MLME_STA_DISCONNECTED, -+ MLME_TDLS_LINKED, -+ MLME_TDLS_NOLINK, -+ MLME_AP_STARTED, -+ MLME_AP_STOPPED, -+ MLME_ADHOC_STARTED, -+ MLME_ADHOC_STOPPED, -+ MLME_MESH_STARTED, -+ MLME_MESH_STOPPED, -+ MLME_OPCH_SWITCH, -+}; -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+enum MODE_WOW_KEEP_ALIVE_PATTERN { -+ wow_keep_alive_pattern_disable = 0, -+ wow_keep_alive_pattern_tx, -+ wow_keep_alive_pattern_trx, -+ wow_keep_alive_pattern_trx_with_ack -+}; -+#endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+enum dot11AuthAlgrthmNum { -+ dot11AuthAlgrthm_Open = 0, -+ dot11AuthAlgrthm_Shared, -+ dot11AuthAlgrthm_8021X, -+ dot11AuthAlgrthm_Auto, -+ dot11AuthAlgrthm_WAPI, -+ dot11AuthAlgrthm_MaxNum -+}; -+ -+/** -+ * enum mlme_auth_type - AuthenticationType -+ * -+ * @MLME_AUTHTYPE_OPEN_SYSTEM: Open System authentication -+ * @MLME_AUTHTYPE_SHARED_KEY: Shared Key authentication (WEP only) -+ * @MLME_AUTHTYPE_FT: Fast BSS Transition (IEEE 802.11r) -+ * @MLME_AUTHTYPE_NETWORK_EAP: Network EAP (some Cisco APs and mainly LEAP) -+ * @MLME_AUTHTYPE_SAE: Simultaneous authentication of equals -+ * @MLME_AUTHTYPE_FILS_SK: Fast Initial Link Setup shared key -+ * @MLME_AUTHTYPE_FILS_SK_PFS: Fast Initial Link Setup shared key with PFS -+ * @MLME_AUTHTYPE_FILS_PK: Fast Initial Link Setup public key -+ * @__MLME_AUTHTYPE_NUM: internal -+ * @MLME_AUTHTYPE_MAX: maximum valid auth algorithm -+ * @MLME_AUTHTYPE_AUTOMATIC: determine automatically (if necessary by trying -+ * multiple times); this is invalid in netlink -- leave out the attribute -+ * for this on CONNECT commands. -+ */ -+enum mlme_auth_type { -+ MLME_AUTHTYPE_OPEN_SYSTEM, -+ MLME_AUTHTYPE_SHARED_KEY, -+ MLME_AUTHTYPE_FT, -+ MLME_AUTHTYPE_NETWORK_EAP, -+ MLME_AUTHTYPE_SAE, -+ MLME_AUTHTYPE_FILS_SK, -+ MLME_AUTHTYPE_FILS_SK_PFS, -+ MLME_AUTHTYPE_FILS_PK, -+ -+ /* keep last */ -+ __MLME_AUTHTYPE_NUM, -+ MLME_AUTHTYPE_MAX = __MLME_AUTHTYPE_NUM - 1, -+ MLME_AUTHTYPE_AUTOMATIC -+}; -+ -+/* 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 -+ -+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_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 */ -+ -+ 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 */ -+ u16 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; -+ u8 bcn_early_reg_bkp; -+ 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 */ -+ -+ /* Let wpa_supplicant to setup*/ -+ u8 driver_setup; -+#ifdef CONFIG_WFD -+ struct wifi_display_info *wfd_info; -+#endif -+ -+ struct submit_ctx *tdls_sctx; -+}; -+ -+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, -+}; -+ -+#define UNASOC_STA_SRC_RX_BMC 0 -+#define UNASOC_STA_SRC_RX_NMY_UC 1 -+#define UNASOC_STA_SRC_NUM 2 -+ -+#define UNASOC_STA_MODE_DISABLED 0 -+#define UNASOC_STA_MODE_INTERESTED 1 -+#define UNASOC_STA_MODE_ALL 2 -+#define UNASOC_STA_MODE_NUM 3 -+ -+#define UNASOC_STA_DEL_CHK_SKIP 0 -+#define UNASOC_STA_DEL_CHK_ALIVE 1 -+#define UNASOC_STA_DEL_CHK_DELETED 2 -+ -+#ifdef CONFIG_RTW_MULTI_AP -+struct unassoc_sta_info { -+ _list list; -+ u8 addr[ETH_ALEN]; -+ u8 interested; -+ s8 recv_signal_power; -+ systime time; -+}; -+#endif -+ -+struct mlme_priv { -+ -+ _lock lock; -+ sint fw_state; /* shall we protect this variable? maybe not necessarily... */ -+ u8 to_join; /* flag */ -+ u16 join_status; -+#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; /* scan interval for active roam (Unit:2 second)*/ -+ 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; -+ systime last_roaming; -+ bool need_to_roam; -+ _lock clnt_auth_lock; /* protect the join operation in rx_tasklet & cmd_thread */ -+#endif -+ -+ u32 defs_lmt_sta; -+ u32 defs_lmt_time; -+ -+ u8 *nic_hdl; -+ u32 max_bss_cnt; /* The size of scan queue */ -+ _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]; -+ u16 assoc_ch; /* 0 reserved for no specific channel */ -+ -+ struct wlan_network cur_network; -+ struct wlan_network *cur_network_scanned; -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+ struct wlan_network candidate_network; -+#endif -+ -+ /* bcn check info */ -+ struct beacon_keys cur_beacon_keys; /* save current beacon keys */ -+#ifdef CONFIG_BCN_CNT_CONFIRM_HDL -+ struct beacon_keys new_beacon_keys; /* save new beacon keys */ -+ u8 new_beacon_cnts; /* if new_beacon_cnts >= threshold, ap beacon is changed */ -+#endif -+ u8 bcn_cnts_after_csa; -+ -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ /* for arp offload keep alive */ -+ u8 bGetGateway; -+ u8 GetGatewayTryCnt; -+ u8 gw_mac_addr[ETH_ALEN]; -+ 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. */ -+ systime 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 -+ u8 wpa_phase;/*wpa_phase after wps finished*/ -+ -+ struct qos_priv qospriv; -+ -+#ifdef CONFIG_80211D -+ u8 *recv_country_ie; -+ u32 recv_country_ie_len; -+#endif -+ -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+ bool active_tpc_report; -+#endif -+ -+#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; -+#ifdef ROKU_PRIVATE -+ /*infra mode, used to store AP's info*/ -+ struct vht_priv_infra_ap vhtpriv_infra_ap; -+#endif /* ROKU_PRIVATE */ -+#endif -+ -+#ifdef ROKU_PRIVATE -+ struct ht_priv_infra_ap htpriv_infra_ap; -+#endif /* ROKU_PRIVATE */ -+ -+#ifdef CONFIG_RTW_80211R -+ struct ft_roam_info ft_roam; -+#endif -+#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) -+ struct roam_nb_info nb_info; -+ u8 ch_cnt; -+#endif -+ -+ RT_LINK_DETECT_T LinkDetectInfo; -+ -+ u8 acm_mask; /* for wmm acm mask */ -+ 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[WLAN_EID_EXT_CAP_MAX_LEN];/*currently for ap mode only*/ -+ u8 ext_capab_ie_len; /* content length */ -+ -+#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 -+#endif /* CONFIG_AP_MODE and CONFIG_NATIVEAP_MLME */ -+ -+ u8 *assoc_req; -+ u32 assoc_req_len; -+ u8 *assoc_rsp; -+ u32 assoc_rsp_len; -+ -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ /* 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; -+ -+ u8 ap_isolate; -+#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 CONFIG_RTW_MBO -+ u8 *pcell_data_cap_ie; -+ u32 cell_data_cap_len; -+#endif -+ -+#ifdef RTK_DMP_PLATFORM -+ /* DMP kobject_hotplug function signal need in passive level */ -+ _workitem Linkup_workitem; -+ _workitem Linkdown_workitem; -+#endif -+ -+#ifdef RTW_BUSY_DENY_SCAN -+ systime lastscantime; -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 scanning_via_buddy_intf; -+#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 -+#ifdef CONFIG_RTW_MULTI_AP -+ u8 unassoc_sta_mode_of_stype[UNASOC_STA_SRC_NUM]; -+ _queue unassoc_sta_queue; -+ _queue free_unassoc_sta_queue; -+ u8 *free_unassoc_sta_buf; -+ u32 interested_unassoc_sta_cnt; -+ u32 max_unassoc_sta_cnt; -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ struct unassoc_sta_info cmap_unassoc_sta[CMAP_UNASSOC_METRICS_STA_MAX]; -+ u8 cmap_unassoc_sta_cnt; -+ _timer cmap_unassoc_sta_timer; -+#endif -+#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) -+ -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+#define MLME_ACTIVE_TPC_REPORT(mlme) (mlme->active_tpc_report) -+#else -+#define MLME_ACTIVE_TPC_REPORT(mlme) 0 -+#endif -+ -+#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 -+#define RTW_AUTO_SCAN_REASON_ROAM_ACTIVE BIT3 -+#define RTW_AUTO_SCAN_REASON_MESH_OFFCH_CAND BIT4 -+ -+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, u16 status); -+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_disc_rpt(_adapter *adapter, u8 mac_id); -+void rtw_sta_mstatus_report(_adapter *adapter); -+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 */ -+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; -+ rtw_mi_update_iface_status(pmlmepriv, state); -+} -+static inline void init_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ pmlmepriv->fw_state = state; -+ rtw_mi_update_iface_status(pmlmepriv, state); -+} -+ -+static inline void _clr_fwstate_(struct mlme_priv *pmlmepriv, sint state) -+{ -+ pmlmepriv->fw_state &= ~state; -+ 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 bool 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); -+struct wlan_network *_rtw_find_network(_queue *scanned_queue, const u8 *addr); -+struct wlan_network *rtw_find_network(_queue *scanned_queue, const 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, u8 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); -+u32 rtw_join_abort_timeout(_adapter *adapter, u32 timeout_ms); -+ -+int rtw_cached_pmkid(_adapter *Adapter, u8 *bssid); -+int rtw_rsn_sync_pmkid(_adapter *adapter, u8 *ie, uint ie_len, int i_ent); -+ -+extern int rtw_restruct_sec_ie(_adapter *adapter, u8 *out_ie); -+#ifdef CONFIG_WMMPS_STA -+void rtw_uapsd_use_default_setting(_adapter *padapter); -+bool rtw_is_wmmps_mode(_adapter *padapter); -+#endif /* CONFIG_WMMPS_STA */ -+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(void *ctx); -+extern void rtw_scan_timeout_handler(void *ctx); -+ -+extern void rtw_dynamic_check_timer_handlder(void *ctx); -+extern void rtw_iface_dynamic_check_timer_handlder(_adapter *adapter); -+ -+enum { -+ SS_DENY_MP_MODE, -+ SS_DENY_RSON_SCANING, -+ SS_DENY_BLOCK_SCAN, -+ SS_DENY_BY_DRV, -+ SS_DENY_SELF_AP_UNDER_WPS, -+ SS_DENY_SELF_AP_UNDER_LINKING, -+ SS_DENY_SELF_AP_UNDER_SURVEY, -+ /*SS_DENY_SELF_STA_UNDER_WPS,*/ -+ SS_DENY_SELF_STA_UNDER_LINKING, -+ SS_DENY_SELF_STA_UNDER_SURVEY, -+ SS_DENY_BUDDY_UNDER_LINK_WPS, -+ SS_DENY_BUDDY_UNDER_SURVEY, -+ SS_DENY_BUSY_TRAFFIC, -+ SS_ALLOW, -+#ifdef DBG_LA_MODE -+ SS_DENY_LA_MODE, -+#endif -+ SS_DENY_ADAPTIVITY, -+}; -+ -+u8 _rtw_sitesurvey_condition_check(const char *caller, _adapter *adapter, bool check_sc_interval); -+#define rtw_sitesurvey_condition_check(adapter, check_sc_interval) _rtw_sitesurvey_condition_check(__func__, adapter, check_sc_interval) -+ -+#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(void *ctx); -+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(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 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, struct country_chplan *req_chplan); -+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, u8 issue_when_busy); -+#endif -+ -+void rtw_append_extended_cap(_adapter *padapter, u8 *out_ie, uint *pout_len); -+ -+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 */ -+ -+bool rtw_adjust_chbw(_adapter *adapter, u8 req_ch, u8 *req_bw, u8 *req_offset); -+ -+struct sta_media_status_rpt_cmd_parm { -+ struct sta_info *sta; -+ bool connected; -+}; -+ -+#ifdef CONFIG_RTW_MULTI_AP -+void rtw_unassoc_sta_set_mode(_adapter *adapter, u8 stype, u8 mode); -+bool rtw_unassoc_sta_src_chk(_adapter *adapter, u8 stype); -+void dump_unassoc_sta(void *sel, _adapter *adapter); -+void rtw_del_unassoc_sta_queue(_adapter *adapter); -+void rtw_del_unassoc_sta(_adapter *adapter, u8 *addr); -+void rtw_rx_add_unassoc_sta(_adapter *adapter, u8 stype, u8 *addr, s8 recv_signal_power); -+void rtw_add_interested_unassoc_sta(_adapter *adapter, u8 *addr); -+void rtw_undo_interested_unassoc_sta(_adapter *adapter, u8 *addr); -+void rtw_undo_all_interested_unassoc_sta(_adapter *adapter); -+u8 rtw_search_unassoc_sta(_adapter *adapter, u8 *addr, struct unassoc_sta_info *ret_sta); -+#endif -+ -+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); -+void rtw_sta_traffic_info(void *sel, _adapter *adapter); -+ -+#define GET_ARP_HTYPE(_arp) BE_BITS_TO_2BYTE(((u8 *)(_arp)) + 0, 0, 16) -+#define GET_ARP_PTYPE(_arp) BE_BITS_TO_2BYTE(((u8 *)(_arp)) + 2, 0, 16) -+#define GET_ARP_HLEN(_arp) BE_BITS_TO_1BYTE(((u8 *)(_arp)) + 4, 0, 8) -+#define GET_ARP_PLEN(_arp) BE_BITS_TO_1BYTE(((u8 *)(_arp)) + 5, 0, 8) -+#define GET_ARP_OPER(_arp) BE_BITS_TO_2BYTE(((u8 *)(_arp)) + 6, 0, 16) -+ -+#define SET_ARP_HTYPE(_arp, _val) SET_BITS_TO_BE_2BYTE(((u8 *)(_arp)) + 0, 0, 16, _val) -+#define SET_ARP_PTYPE(_arp, _val) SET_BITS_TO_BE_2BYTE(((u8 *)(_arp)) + 2, 0, 16, _val) -+#define SET_ARP_HLEN(_arp, _val) SET_BITS_TO_BE_1BYTE(((u8 *)(_arp)) + 4, 0, 8, _val) -+#define SET_ARP_PLEN(_arp, _val) SET_BITS_TO_BE_1BYTE(((u8 *)(_arp)) + 5, 0, 8, _val) -+#define SET_ARP_OPER(_arp, _val) SET_BITS_TO_BE_2BYTE(((u8 *)(_arp)) + 6, 0, 16, _val) -+ -+#define ARP_SHA(_arp, _hlen, _plen) (((u8 *)(_arp)) + 8) -+#define ARP_SPA(_arp, _hlen, _plen) (((u8 *)(_arp)) + 8 + (_hlen)) -+#define ARP_THA(_arp, _hlen, _plen) (((u8 *)(_arp)) + 8 + (_hlen) + (_plen)) -+#define ARP_TPA(_arp, _hlen, _plen) (((u8 *)(_arp)) + 8 + 2 * (_hlen) + (_plen)) -+ -+#define ARP_SENDER_MAC_ADDR(_arp) ARP_SHA(_arp, ETH_ALEN, RTW_IP_ADDR_LEN) -+#define ARP_SENDER_IP_ADDR(_arp) ARP_SPA(_arp, ETH_ALEN, RTW_IP_ADDR_LEN) -+#define ARP_TARGET_MAC_ADDR(_arp) ARP_THA(_arp, ETH_ALEN, RTW_IP_ADDR_LEN) -+#define ARP_TARGET_IP_ADDR(_arp) ARP_TPA(_arp, ETH_ALEN, RTW_IP_ADDR_LEN) -+ -+#define GET_ARP_SENDER_MAC_ADDR(_arp, _val) _rtw_memcpy(_val, ARP_SENDER_MAC_ADDR(_arp), ETH_ALEN) -+#define GET_ARP_SENDER_IP_ADDR(_arp, _val) _rtw_memcpy(_val, ARP_SENDER_IP_ADDR(_arp), RTW_IP_ADDR_LEN) -+#define GET_ARP_TARGET_MAC_ADDR(_arp, _val) _rtw_memcpy(_val, ARP_TARGET_MAC_ADDR(_arp), ETH_ALEN) -+#define GET_ARP_TARGET_IP_ADDR(_arp, _val) _rtw_memcpy(_val, ARP_TARGET_IP_ADDR(_arp), RTW_IP_ADDR_LEN) -+ -+#define SET_ARP_SENDER_MAC_ADDR(_arp, _val) _rtw_memcpy(ARP_SENDER_MAC_ADDR(_arp), _val, ETH_ALEN) -+#define SET_ARP_SENDER_IP_ADDR(_arp, _val) _rtw_memcpy(ARP_SENDER_IP_ADDR(_arp), _val, RTW_IP_ADDR_LEN) -+#define SET_ARP_TARGET_MAC_ADDR(_arp, _val) _rtw_memcpy(ARP_TARGET_MAC_ADDR(_arp), _val, ETH_ALEN) -+#define SET_ARP_TARGET_IP_ADDR(_arp, _val) _rtw_memcpy(ARP_TARGET_IP_ADDR(_arp), _val, RTW_IP_ADDR_LEN) -+ -+void dump_arp_pkt(void *sel, u8 *da, u8 *sa, u8 *arp, bool tx); -+ -+#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 GET_UDP_SIG1(_udphdr) BE_BITS_TO_1BYTE(((u8 *)(_udphdr)) + 8, 0, 8) -+#define GET_UDP_SIG2(_udphdr) BE_BITS_TO_1BYTE(((u8 *)(_udphdr)) + 23, 0, 8) -+ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_mlme_ext.h b/drivers/net/wireless/rtl8821cs/include/rtw_mlme_ext.h -new file mode 100755 -index 000000000..7088ed841 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_mlme_ext.h -@@ -0,0 +1,1281 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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) -+ -+#ifdef CONFIG_GSPI_HCI -+ #define ROAMING_LIMIT 5 -+#else -+ #define ROAMING_LIMIT 8 -+#endif -+ -+/*net_type, pmlmeinfo->state*/ -+#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 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_PRE_LINK 0x00000800 -+#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) -+ -+ -+#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 MULTI_AP_OUI[]; -+ -+extern unsigned char WMM_INFO_OUI[]; -+extern unsigned char WMM_PARA_OUI[]; -+ -+typedef struct _RT_CHANNEL_PLAN { -+ unsigned char Channel[MAX_CHANNEL_NUM]; -+ unsigned char Len; -+} RT_CHANNEL_PLAN, *PRT_CHANNEL_PLAN; -+ -+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; -+ -+ -+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; -+ -+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; -+ u8 activate_ch_cnt; -+ int channel_idx; -+ u8 force_ssid_scan; -+ int scan_mode; -+ u16 scan_ch_ms; -+ u32 scan_timeout_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*/ -+ #ifdef CONFIG_AP_MODE -+ u8 backop_flags_ap; /* policy for ap mode */ -+ #endif -+ #ifdef CONFIG_RTW_MESH -+ u8 backop_flags_mesh; /* policy for mesh mode */ -+ #endif -+ u8 backop_flags; /* per backop runtime decision */ -+ u8 scan_cnt; -+ u8 scan_cnt_max; -+ systime 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]; -+ -+ u32 token; /* 0: use to identify caller */ -+ u16 duration; /* 0: use default */ -+ u8 igi; /* 0: use defalut */ -+ u8 bw; /* 0: use default */ -+ -+ bool acs; /* aim to trigger channel selection when scan done */ -+}; -+ -+#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_NO_WAIT, -+ TDLS_TEARDOWN_STA_LOCALLY, -+ TDLS_TEARDOWN_STA_LOCALLY_POST, -+ 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 -+#elseif defined(CONFIG_CUSTOMER_EZVIZ_CHIME2) -+ #define RTW_SCAN_NUM_OF_CH 1 -+ #define RTW_BACK_OP_CH_MS 200 -+#else -+ #define RTW_SCAN_NUM_OF_CH 3 -+ #define RTW_BACK_OP_CH_MS 400 -+#endif -+ -+#define RTW_IP_ADDR_LEN 4 -+#define RTW_IPv6_ADDR_LEN 16 -+ -+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 */ -+ u16 auth_status; -+ 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; -+ -+ u8 ip_addr[RTW_IP_ADDR_LEN]; -+ u8 ip6_addr[RTW_IPv6_ADDR_LEN]; -+ -+ 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 */ -+#ifdef ROKU_PRIVATE -+ /*infra mode, store supported rates from AssocRsp*/ -+ NDIS_802_11_RATES_EX SupportedRates_infra_ap; -+ u8 ht_vht_received;/*ht_vht_received used to show debug msg BIT(0):HT BIT(1):VHT */ -+#endif /* ROKU_PRIVATE */ -+ -+#ifdef CONFIG_WRITE_BCN_LEN_TO_FW -+ u16 last_bcn_len; -+#endif -+}; -+ -+enum { -+ RTW_CHF_NO_IR = BIT0, -+ RTW_CHF_DFS = BIT1, -+ RTW_CHF_LONG_CAC = BIT2, -+ RTW_CHF_NON_OCP = BIT3, -+ RTW_CHF_NO_HT40U = BIT4, -+ RTW_CHF_NO_HT40L = BIT5, -+ RTW_CHF_NO_80MHZ = BIT6, -+ RTW_CHF_NO_160MHZ = BIT7, -+}; -+ -+/* The channel information about this channel including joining, scanning, and power constraints. */ -+typedef struct _RT_CHANNEL_INFO { -+ u8 band; /* BAND_TYPE */ -+ u8 ChannelNum; /* The channel number. */ -+ -+ /* -+ * Bitmap and its usage: -+ * RTW_CHF_NO_IR, RTW_CHF_DFS: is used to check for status -+ * RTW_CHF_NO_HT40U, RTW_CHF_NO_HT40L, RTW_CHF_NO_80MHZ, RTW_CHF_NO_160MHZ: extra bandwidth limitation (ex: from regulatory) -+ * RTW_CHF_NON_OCP: is only used to record if event is reported, status check is still done using non_ocp_end_time -+ */ -+ u8 flags; -+ /* 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 -+#if CONFIG_IEEE80211_BAND_5GHZ && CONFIG_DFS -+ #ifdef CONFIG_DFS_MASTER -+ systime non_ocp_end_time; -+ #endif -+#endif -+ u8 hidden_bss_cnt; /* per scan count */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ void *os_chan; -+#endif -+} RT_CHANNEL_INFO, *PRT_CHANNEL_INFO; -+ -+#define CAC_TIME_MS (60*1000) -+#define CAC_TIME_CE_MS (10*60*1000) -+#define NON_OCP_TIME_MS (30*60*1000) -+ -+#if CONFIG_TXPWR_LIMIT -+void rtw_txpwr_init_regd(struct rf_ctl_t *rfctl); -+bool rtw_rfctl_is_current_txpwr_lmt(struct rf_ctl_t *rfctl, const char *name); -+#endif -+int rtw_rfctl_init(_adapter *adapter); -+void rtw_rfctl_deinit(_adapter *adapter); -+void rtw_rfctl_decide_init_chplan(struct rf_ctl_t *rfctl, -+ const char *hw_alpha2, u8 hw_chplan, u8 hw_chplan_6g, u8 hw_force_chplan); -+void rtw_rfctl_chplan_init(_adapter *adapter); -+bool rtw_rfctl_is_disable_sw_channel_plan(struct dvobj_priv *dvobj); -+void rtw_rfctl_update_op_mode(struct rf_ctl_t *rfctl, u8 ifbmp_mod, u8 if_op); -+ -+bool rtw_rfctl_reg_allow_beacon_hint(struct rf_ctl_t *rfctl); -+ -+u8 rtw_rfctl_get_dfs_domain(struct rf_ctl_t *rfctl); -+u8 rtw_rfctl_dfs_domain_unknown(struct rf_ctl_t *rfctl); -+ -+#ifdef CONFIG_DFS_MASTER -+struct rf_ctl_t; -+#define CH_IS_NON_OCP(rt_ch_info) (rtw_time_after((rt_ch_info)->non_ocp_end_time, rtw_get_current_time())) -+bool rtw_is_cac_reset_needed(struct rf_ctl_t *rfctl, 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_chbw_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); -+bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch); -+bool rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); -+bool rtw_chset_update_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms); -+void rtw_chset_chk_non_ocp_finish(struct rf_ctl_t *rfctl); -+u32 rtw_get_ch_waiting_ms(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, u32 *r_non_ocp_ms, u32 *r_cac_ms); -+void rtw_reset_cac(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset); -+u32 rtw_force_stop_cac(struct rf_ctl_t *rfctl, u32 timeout_ms); -+#else -+#define CH_IS_NON_OCP(rt_ch_info) 0 -+#define rtw_chset_is_chbw_non_ocp(ch_set, ch, bw, offset) _FALSE -+#define rtw_chset_is_ch_non_ocp(ch_set, ch) _FALSE -+#define rtw_rfctl_is_tx_blocked_by_ch_waiting(rfctl) _FALSE -+#endif -+ -+bool rtw_choose_shortest_waiting_ch(struct rf_ctl_t *rfctl, u8 sel_ch, u8 max_bw -+ , u8 *dec_ch, u8 *dec_bw, u8 *dec_offset -+ , u8 e_flags, u8 d_flags, u8 cur_ch, bool by_int_info, u8 mesh_only); -+ -+struct get_chplan_resp { -+ enum regd_src_t regd_src; -+ enum rtw_regd_inr regd_inr; -+ char alpha2[2]; -+ u8 channel_plan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 chplan_6g; -+#endif -+ -+#if CONFIG_TXPWR_LIMIT -+ const char *txpwr_lmt_name[BAND_MAX]; -+#endif -+ u8 edcca_mode_2g; -+#if CONFIG_IEEE80211_BAND_5GHZ -+ u8 edcca_mode_5g; -+#endif -+#if CONFIG_IEEE80211_BAND_6GHZ -+ u8 edcca_mode_6g; -+#endif -+#ifdef CONFIG_DFS_MASTER -+ u8 dfs_domain; -+#endif -+ u8 proto_en; -+ u8 chset_num; -+ RT_CHANNEL_INFO chset[0]; -+}; -+ -+#ifdef CONFIG_PROC_DEBUG -+void dump_cur_country(void *sel, struct rf_ctl_t *rfctl); -+void dump_cur_chset(void *sel, struct rf_ctl_t *rfctl); -+#endif -+ -+int rtw_chset_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch); -+int rtw_chset_search_ch_by_band(RT_CHANNEL_INFO *ch_set, BAND_TYPE band, const u32 ch); -+u8 rtw_chset_is_chbw_valid(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset -+ , bool allow_primary_passive, bool allow_passive); -+void rtw_chset_sync_chbw(RT_CHANNEL_INFO *ch_set, u8 *req_ch, u8 *req_bw, u8 *req_offset -+ , u8 *g_ch, u8 *g_bw, u8 *g_offset, bool allow_primary_passive, bool allow_passive); -+ -+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; -+#endif -+ /* 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 basicrate[NumRates]; -+ unsigned char datarate[NumRates]; -+#ifdef CONFIG_80211N_HT -+ unsigned char default_supported_mcs_set[16]; -+#endif -+ -+ struct ss_res sitesurvey_res; -+#ifdef CONFIG_RTW_ROAM_QUICKSCAN -+ u8 quickscan_next; -+ u8 roam_ch_num; -+ struct rtw_ieee80211_channel roam_ch[RTW_CHANNEL_SCAN_AMOUNT]; -+#endif -+ 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_REPEATER_SON -+ _timer rson_scan_timer; -+#endif -+#ifdef CONFIG_RTW_80211R -+ _timer ft_link_timer; -+ _timer ft_roam_timer; -+#endif -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ _timer tbtx_xmit_timer; -+ _timer tbtx_token_dispatch_timer; -+#endif -+ -+ systime last_scan_time; -+ u8 scan_abort; -+ u8 join_abort; -+ -+ u8 tx_rate; /* TXRATE when USERATE is set. */ -+ RATE_SECTION tx_rate_section; /* decided by tx_rate */ -+ -+ u32 retry; /* retry for issue probereq */ -+ -+ u64 TSFValue; -+ u32 bcn_cnt; -+ u32 last_bcn_cnt; -+ u8 cur_bcn_cnt;/*2s*/ -+ u8 dtim;/*DTIM Period*/ -+#ifdef DBG_RX_BCN -+ u8 tim[4]; -+#endif -+#ifdef CONFIG_BCN_RECV_TIME -+ u16 bcn_rx_time; -+#endif -+#ifdef CONFIG_AP_MODE -+ unsigned char bstart_bss; -+#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 -+ -+ u8 tsf_update_required:1; -+ u8 en_hw_update_tsf:1; /* set hw sync bcn tsf register or not */ -+ systime tsf_update_pause_stime; -+ u8 tsf_update_pause_factor; /* num of bcn intervals to stay TSF update pause status */ -+ u8 tsf_update_restore_factor; /* num of bcn interval to stay TSF update restore status */ -+#ifdef CONFIG_SUPPORT_STATIC_SMPS -+ u8 ssmps_en; -+ u16 ssmps_tx_tp_th;/*Mbps*/ -+ u16 ssmps_rx_tp_th;/*Mbps*/ -+ #ifdef DBG_STATIC_SMPS -+ u8 ssmps_test; -+ u8 ssmps_test_en; -+ #endif -+#endif -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+ u8 txss_ctrl_en; -+ u16 txss_tp_th;/*Mbps*/ -+ u8 txss_tp_chk_cnt;/*unit 2s*/ -+ bool txss_1ss; -+ u8 txss_momi_type_bk; -+#endif -+#ifdef CONFIG_DFS -+ _timer csa_timer; -+#endif /* CONFIG_DFS */ -+}; -+ -+struct support_rate_handler { -+ u8 rate; -+ bool basic; -+ bool existence; -+}; -+ -+static inline u8 check_mlmeinfo_state(struct mlme_ext_priv *plmeext, sint state) -+{ -+ if ((plmeext->mlmext_info.state & 0x03) == state) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+void sitesurvey_set_offch_state(_adapter *adapter, u8 scan_state); -+ -+#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_mi_update_iface_status(&((container_of(mlmeext, _adapter, mlmeextpriv)->mlmepriv)), 0); \ -+ /* RTW_INFO("set_scan_state:%s\n", scan_state_str(_state)); */ \ -+ sitesurvey_set_offch_state(container_of(mlmeext, _adapter, mlmeextpriv), _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) -+#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) -+#endif /* CONFIG_SCAN_BACKOP */ -+ -+#if defined(CONFIG_SCAN_BACKOP) && defined(CONFIG_AP_MODE) -+#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_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 /* defined(CONFIG_SCAN_BACKOP) && defined(CONFIG_AP_MODE) */ -+ -+#if defined(CONFIG_SCAN_BACKOP) && defined(CONFIG_RTW_MESH) -+#define mlmeext_scan_backop_flags_mesh(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags_mesh) -+#define mlmeext_chk_scan_backop_flags_mesh(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags_mesh & (flags)) -+#define mlmeext_assign_scan_backop_flags_mesh(mlmeext, flags) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.backop_flags_mesh = (flags)); \ -+ } while (0) -+#else -+#define mlmeext_scan_backop_flags_mesh(mlmeext) (0) -+#define mlmeext_chk_scan_backop_flags_mesh(mlmeext, flags) (0) -+#define mlmeext_assign_scan_backop_flags_mesh(mlmeext, flags) do {} while (0) -+#endif /* defined(CONFIG_SCAN_BACKOP) && defined(CONFIG_RTW_MESH) */ -+ -+u32 rtw_scan_timeout_decision(_adapter *padapter); -+ -+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 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); */ -+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); -+ -+ -+void rtw_set_external_auth_status(_adapter *padapter, const void *data, int len); -+ -+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); -+systime rtw_get_on_oper_ch_time(_adapter *adapter); -+systime rtw_get_on_cur_ch_time(_adapter *adapter); -+ -+void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode); -+ -+void csa_timer_hdl(void *FunctionContext); -+ -+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 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); -+ -+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); -+void get_assoc_AP_Vendor(char *vendor, u8 assoc_AP_vendor); -+#ifdef CONFIG_RTS_FULL_BW -+void rtw_parse_sta_vendor_ie_8812(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len); -+#endif/*CONFIG_RTS_FULL_BW*/ -+#ifdef CONFIG_80211AC_VHT -+void get_vht_bf_cap(u8 *pframe, uint len, struct vht_bf_cap *bf_cap); -+#endif -+ -+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); -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+u8 rtw_is_tbtx_capabilty(u8 *p, u8 len); -+#endif -+ -+void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+#ifdef ROKU_PRIVATE -+void HT_caps_handler_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+#endif -+void HT_info_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void HTOnAssocRsp(_adapter *padapter); -+ -+#ifdef ROKU_PRIVATE -+void Supported_rate_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void Extended_Supported_rate_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+#endif -+ -+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); -+ -+#ifdef CONFIG_CHECK_SPECIFIC_IE_CONTENT -+bool rtw_validate_value(u16 EID, u8 *p, u16 len); -+#endif /* CONFIG_CHECK_SPECIFIC_IE_CONTENT */ -+ -+bool is_hidden_ssid(char *ssid, int len); -+bool hidden_ssid_ap(WLAN_BSSID_EX *snetwork); -+void rtw_absorb_ssid_ifneed(_adapter *padapter, WLAN_BSSID_EX *bssid, u8 *pframe); -+ -+int rtw_get_bcn_keys(_adapter *adapter, u8 *whdr, u32 flen, struct beacon_keys *bcn_keys); -+int rtw_get_bcn_keys_from_bss(WLAN_BSSID_EX *bss, struct beacon_keys *bcn_keys); -+int rtw_update_bcn_keys_of_network(struct wlan_network *network); -+ -+int validate_beacon_len(u8 *pframe, uint len); -+void rtw_dump_bcn_keys(void *sel, struct beacon_keys *recv_beacon); -+void rtw_bcn_key_err_fix(struct beacon_keys *cur, struct beacon_keys *recv); -+bool rtw_bcn_key_compare(struct beacon_keys *cur, struct beacon_keys *recv); -+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); -+#if CONFIG_DFS -+void process_csa_ie(_adapter *padapter, u8 *ies, uint ies_len); -+#endif -+#ifdef CONFIG_80211D -+bool rtw_iface_accept_country_ie(_adapter *adapter); -+void process_country_ie(_adapter *adapter, u8 *ies, uint ies_len); -+#endif -+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); -+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(u64 mask); -+unsigned char get_lowest_rate_idx_ex(u64 mask, int start_bit); -+#define get_lowest_rate_idx(mask) get_lowest_rate_idx_ex(mask, 0) -+ -+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); -+ -+enum eap_type parsing_eapol_packet(_adapter *padapter, u8 *key_payload, struct sta_info *psta, u8 trx_type); -+ -+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_set(struct sec_cam_bmp *map, u8 id); -+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, u8 gk, bool ext_sec, 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; -+bool _rtw_macid_ctl_chk_cap(_adapter *adapter, u8 cap); -+void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num); -+bool rtw_macid_is_set(struct macid_bmp *map, u8 id); -+void rtw_macid_map_clr(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); -+u8 rtw_macid_get_iface_bmp(struct macid_ctl_t *macid_ctl, u8 id); -+bool rtw_macid_is_iface_shared(struct macid_ctl_t *macid_ctl, u8 id); -+bool rtw_macid_is_iface_specific(struct macid_ctl_t *macid_ctl, u8 id, _adapter *adapter); -+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); -+u8 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); -+#ifdef CONFIG_PROTSEL_MACSLEEP -+void rtw_macid_ctl_init_sleep_reg(struct macid_ctl_t *macid_ctl, u16 reg_ctrl, u16 reg_info); -+void rtw_macid_ctl_init_drop_reg(struct macid_ctl_t *macid_ctl, u16 reg_ctrl, u16 reg_info); -+#else -+void rtw_macid_ctl_init_sleep_reg(struct macid_ctl_t *macid_ctl, u16 m0, u16 m1, u16 m2, u16 m3); -+void rtw_macid_ctl_init_drop_reg(struct macid_ctl_t *macid_ctl, u16 m0, u16 m1, u16 m2, u16 m3); -+#endif -+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); -+void rtw_iface_bcmc_id_set(_adapter *padapter, u8 mac_id); -+#if defined(DBG_CONFIG_ERROR_RESET) && defined(CONFIG_CONCURRENT_MODE) -+void rtw_iface_bcmc_sec_cam_map_restore(_adapter *adapter); -+#endif -+bool rtw_bmp_is_set(const u8 *bmp, u8 bmp_len, u8 id); -+void rtw_bmp_set(u8 *bmp, u8 bmp_len, u8 id); -+void rtw_bmp_clear(u8 *bmp, u8 bmp_len, u8 id); -+bool rtw_bmp_not_empty(const u8 *bmp, u8 bmp_len); -+bool rtw_bmp_not_empty_exclude_bit0(const u8 *bmp, u8 bmp_len); -+ -+#ifdef CONFIG_AP_MODE -+bool rtw_tim_map_is_set(_adapter *padapter, const u8 *map, u8 id); -+void rtw_tim_map_set(_adapter *padapter, u8 *map, u8 id); -+void rtw_tim_map_clear(_adapter *padapter, u8 *map, u8 id); -+bool rtw_tim_map_anyone_be_set(_adapter *padapter, const u8 *map); -+bool rtw_tim_map_anyone_be_set_exclude_aid0(_adapter *padapter, const u8 *map); -+#endif /* CONFIG_AP_MODE */ -+ -+u32 report_join_res(_adapter *padapter, int aid_res, u16 status); -+void report_survey_event(_adapter *padapter, union recv_frame *precv_frame); -+void report_surveydone_event(_adapter *padapter, bool acs); -+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, u8 flags); -+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); -+#ifdef CONFIG_RTW_MGMT_QUEUE -+void update_mgntframe_subtype(_adapter *padapter, struct xmit_frame *pmgntframe); -+#endif -+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 -+int get_reg_classes_full_count(struct p2p_channels *channel_list); -+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, const NDIS_802_11_SSID *pssid, const u8 *da); -+s32 issue_probereq_ex(_adapter *padapter, const NDIS_802_11_SSID *pssid, const 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); -+int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, u8 ps, 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); -+void issue_action_BSSCoexistPacket(_adapter *padapter); -+ -+#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); -+#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); -+#ifdef CONFIG_AP_MODE -+unsigned int send_beacon(_adapter *padapter); -+#endif -+void start_clnt_assoc(_adapter *padapter); -+void start_clnt_auth(_adapter *padapter); -+void start_clnt_join(_adapter *padapter); -+void start_create_ibss(_adapter *padapter); -+ -+#if defined(CONFIG_LAYER2_ROAMING) && defined(CONFIG_RTW_80211K) -+void rtw_roam_nb_discover(_adapter *padapter, u8 bfroce); -+#endif -+ -+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_size_sta_limit(_adapter *adapter, struct sta_info *sta); -+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 on_action_rm(_adapter *padapter, union recv_frame *precv_frame); -+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_TOKEN_BASED_XMIT -+unsigned int OnAction_tbtx_token(_adapter *padapter, union recv_frame *precv_frame); -+#endif -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+void rtw_issue_action_token_req(_adapter *padapter, struct sta_info *pstat); -+void rtw_issue_action_token_rel(_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); -+ -+int rtw_get_rx_chk_limit(_adapter *adapter); -+void rtw_set_rx_chk_limit(_adapter *adapter, int limit); -+void linked_status_chk(_adapter *padapter, u8 from_timer); -+ -+#define rtw_get_bcn_cnt(adapter) (adapter->mlmeextpriv.cur_bcn_cnt) -+#define rtw_get_bcn_dtim_period(adapter) (adapter->mlmeextpriv.dtim) -+void rtw_collect_bcn_info(_adapter *adapter); -+ -+void _linked_info_dump(_adapter *padapter); -+ -+void survey_timer_hdl(void *ctx); -+#ifdef CONFIG_RTW_REPEATER_SON -+void rson_timer_hdl(void *ctx); -+#endif -+void link_timer_hdl(void *ctx); -+void addba_timer_hdl(void *ctx); -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+void rtw_tbtx_xmit_timer_hdl(void *ctx); -+void rtw_tbtx_token_dispatch_timer_hdl(void *ctx); -+#endif -+#ifdef CONFIG_IEEE80211W -+void sa_query_timer_hdl(void *ctx); -+#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) -+ -+bool rtw_is_cck_rate(u8 rate); -+bool rtw_is_ofdm_rate(u8 rate); -+bool rtw_is_basic_rate_cck(u8 rate); -+bool rtw_is_basic_rate_ofdm(u8 rate); -+bool rtw_is_basic_rate_mix(u8 rate); -+ -+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, u8 mlme_state); -+#ifdef CONFIG_BCN_RECV_TIME -+void rtw_rx_bcn_time_update(_adapter *adapter, uint bcn_len, u8 data_rate); -+#endif -+extern u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer); -+ -+void rtw_process_bar_frame(_adapter *padapter, union recv_frame *precv_frame); -+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 RTW_BUSY_DENY_SCAN -+#ifndef BUSY_TRAFFIC_SCAN_DENY_PERIOD -+#ifdef CONFIG_RTW_ANDROID -+#ifdef CONFIG_PLATFORM_ARM_SUN8I -+ #define BUSY_TRAFFIC_SCAN_DENY_PERIOD 8000 -+#else -+ #define BUSY_TRAFFIC_SCAN_DENY_PERIOD 12000 -+#endif -+#else /* !CONFIG_ANDROID */ -+#define BUSY_TRAFFIC_SCAN_DENY_PERIOD 16000 -+#endif /* !CONFIG_ANDROID */ -+#endif /* !BUSY_TRAFFIC_SCAN_DENY_PERIOD */ -+#endif /* RTW_BUSY_DENY_SCAN */ -+ -+void rtw_leave_opch(_adapter *adapter); -+void rtw_back_opch(_adapter *adapter); -+ -+u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf); -+u8 disconnect_hdl(_adapter *padapter, u8 *pbuf); -+u8 createbss_hdl(_adapter *padapter, u8 *pbuf); -+#ifdef CONFIG_AP_MODE -+u8 stop_ap_hdl(_adapter *adapter); -+#endif -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+u8 tx_control_hdl(_adapter *adapter); -+#endif -+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 chk_bmc_sleepq_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 rtw_set_chbw_hdl(_adapter *padapter, u8 *pbuf); -+u8 rtw_iqk_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 rtw_set_chplan_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 rtw_get_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 set_ap_csa_hdl(_adapter *adapter, unsigned char *pbuf); -+u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 run_in_thread_hdl(_adapter *padapter, u8 *pbuf); -+u8 rtw_write_bcnlen_hdl(_adapter *padapter, u8 *pbuf); -+u8 rtw_reqtxrpt_cmd_hdl(_adapter *adapter, u8 *pbuf); -+ -+int rtw_sae_preprocess(_adapter *adapter, const u8 *buf, u32 len, u8 tx); -+ -+u32 rtw_desc_rate_to_bitrate(u8 bw, u8 rate_idx, u8 sgi); -+ -+#ifdef CONFIG_RTW_MULTI_AP -+u8 rtw_get_ch_utilization(_adapter *adapter); -+void rtw_ch_util_rpt(_adapter *adapter); -+#endif -+ -+#define GEN_MLME_EXT_HANDLER(cmd, callback_func) {.cmd_hdl = cmd, .callback = callback_func}, -+ -+struct rtw_cmd { -+ u8(*cmd_hdl)(_adapter *padapter, u8 *pbuf); -+ void (*callback)(_adapter *padapter, struct cmd_obj *cmd); -+}; -+ -+#ifdef _RTW_CMD_C_ -+#ifdef CONFIG_RTW_MESH -+extern u8 rtw_mesh_set_plink_state_cmd_hdl(_adapter *adapter, u8 *parmbuf); -+#else -+u8 rtw_mesh_set_plink_state_cmd_hdl(_adapter *adapter, u8 *parmbuf) { return H2C_CMD_FAIL; }; -+#endif -+ -+struct rtw_cmd wlancmds[] = { -+ GEN_MLME_EXT_HANDLER(join_cmd_hdl, rtw_joinbss_cmd_callback) /*CMD_JOINBSS*/ -+ GEN_MLME_EXT_HANDLER(disconnect_hdl, rtw_disassoc_cmd_callback) /*CMD_DISCONNECT*/ -+ GEN_MLME_EXT_HANDLER(createbss_hdl, NULL) /*CMD_CREATE_BSS*/ -+ GEN_MLME_EXT_HANDLER(setopmode_hdl, NULL) /*CMD_SET_OPMODE*/ -+ GEN_MLME_EXT_HANDLER(sitesurvey_cmd_hdl, rtw_survey_cmd_callback) /*CMD_SITE_SURVEY*/ -+ GEN_MLME_EXT_HANDLER(setauth_hdl, NULL) /*CMD_SET_AUTH*/ -+ GEN_MLME_EXT_HANDLER(setkey_hdl, NULL) /*CMD_SET_KEY*/ -+ GEN_MLME_EXT_HANDLER(set_stakey_hdl, rtw_setstaKey_cmdrsp_callback) /*CMD_SET_STAKEY*/ -+ GEN_MLME_EXT_HANDLER(add_ba_hdl, NULL) /*CMD_ADD_BAREQ*/ -+ GEN_MLME_EXT_HANDLER(rtw_set_chbw_hdl, NULL) /*CMD_SET_CHANNEL*/ -+ GEN_MLME_EXT_HANDLER(tx_beacon_hdl, NULL) /*CMD_TX_BEACON*/ -+ GEN_MLME_EXT_HANDLER(mlme_evt_hdl, NULL) /*CMD_SET_MLME_EVT*/ -+ GEN_MLME_EXT_HANDLER(rtw_drvextra_cmd_hdl, NULL) /*CMD_SET_DRV_EXTRA*/ -+ GEN_MLME_EXT_HANDLER(rtw_set_chplan_hdl, NULL) /*CMD_SET_CHANPLAN*/ -+ GEN_MLME_EXT_HANDLER(led_blink_hdl, NULL) /*CMD_LEDBLINK*/ -+ GEN_MLME_EXT_HANDLER(set_csa_hdl, NULL) /*CMD_SET_CHANSWITCH*/ -+ GEN_MLME_EXT_HANDLER(tdls_hdl, NULL) /*CMD_TDLS*/ -+ GEN_MLME_EXT_HANDLER(chk_bmc_sleepq_hdl, NULL) /*CMD_CHK_BMCSLEEPQ*/ -+ GEN_MLME_EXT_HANDLER(run_in_thread_hdl, NULL) /*CMD_RUN_INTHREAD*/ -+ GEN_MLME_EXT_HANDLER(add_ba_rsp_hdl, NULL) /*CMD_ADD_BARSP*/ -+ GEN_MLME_EXT_HANDLER(rm_post_event_hdl, NULL) /*CMD_RM_POST_EVENT*/ -+ GEN_MLME_EXT_HANDLER(rtw_mesh_set_plink_state_cmd_hdl, NULL) /*CMD_SET_MESH_PLINK_STATE*/ -+ GEN_MLME_EXT_HANDLER(rtw_iqk_hdl, NULL) /*CMD_DO_IQK*/ -+ GEN_MLME_EXT_HANDLER(rtw_get_chplan_hdl, NULL) /* CMD_GET_CHANPLAN */ -+ GEN_MLME_EXT_HANDLER(rtw_write_bcnlen_hdl, NULL) /* CMD_WRITE_BCN_LEN */ -+ GEN_MLME_EXT_HANDLER(set_ap_csa_hdl, NULL) /* CMD_AP_CHANSWITCH */ -+ GEN_MLME_EXT_HANDLER(rtw_reqtxrpt_cmd_hdl, NULL) /* CMD_REQ_TXRPT */ -+}; -+#endif -+ -+struct rtw_evt_header { -+ u8 id; -+ u8 seq; -+ u16 len; -+}; -+ -+enum rtw_event_id { -+ EVT_SURVEY, /*0*/ -+ EVT_SURVEY_DONE, /*1*/ -+ EVT_JOINBSS, /*2*/ -+ EVT_ADD_STA, /*3*/ -+ EVT_DEL_STA, /*4*/ -+ EVT_WMM_UPDATE, /*5*/ -+#ifdef CONFIG_IEEE80211W -+ EVT_TIMEOUT_STA, /*6*/ -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_RTW_80211R -+ EVT_FT_REASSOC, /*7*/ -+#endif -+ EVT_ID_MAX -+}; -+#ifdef _RTW_MLME_EXT_C_ -+static struct rtw_event wlanevents[] = { -+ {sizeof(struct survey_event), &rtw_survey_event_callback}, /*EVT_SURVEY*/ -+ {sizeof(struct surveydone_event), &rtw_surveydone_event_callback}, /*EVT_SURVEY_DONE*/ -+ {sizeof(struct joinbss_event), &rtw_joinbss_event_callback}, /*EVT_JOINBSS*/ -+ {sizeof(struct stassoc_event), &rtw_stassoc_event_callback}, /*EVT_ADD_STA*/ -+ {sizeof(struct stadel_event), &rtw_stadel_event_callback}, /*EVT_DEL_STA*/ -+ {sizeof(struct wmm_event), &rtw_wmm_event_callback}, /*EVT_WMM_UPDATE*/ -+ #ifdef CONFIG_IEEE80211W -+ {sizeof(struct stadel_event), &rtw_sta_timeout_event_callback}, /*EVT_TIMEOUT_STA*/ -+ #endif /* CONFIG_IEEE80211W */ -+ #ifdef CONFIG_RTW_80211R -+ {sizeof(struct stassoc_event), &rtw_ft_reassoc_event_callback}, /*EVT_FT_REASSOC*/ -+ #endif -+}; -+#endif/* _RTW_MLME_EXT_C_ */ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_mp.h b/drivers/net/wireless/rtl8821cs/include/rtw_mp.h -new file mode 100644 -index 000000000..21689ca35 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_mp.h -@@ -0,0 +1,952 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 RTWPRIV_VER_INFO 1 -+ -+#define MAX_MP_XMITBUF_SZ 2048 -+#define NR_MP_XMITFRAME 8 -+#define MP_READ_REG_MAX_OFFSET 0x4FFF -+ -+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]; -+ 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); -+ -+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 -+ -+ -+typedef struct _RT_PMAC_PKT_INFO { -+ u8 MCS; -+ u8 Nss; -+ u8 Nsts; -+ u32 N_sym; -+ u8 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 */ -+ u16 PacketPeriod; -+ u32 PacketCount; -+ u32 PacketLength; -+ u8 PacketPattern; -+ u16 SFD; -+ u8 SignalField; -+ u8 ServiceField; -+ u16 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)(void *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. */ -+ 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 mpt_rf_path; -+ -+ -+ WIRELESS_MODE MptWirelessModeToSw; /* Wireless mode to switch. */ -+ 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 mpt_rate_index;/* 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. */ -+ u32 MptRCR; -+ /* TRUE if we only receive packets with specific pattern. */ -+ BOOLEAN 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. */ -+ /* TRUE if we have start Continuous Tx test. */ -+ BOOLEAN is_start_cont_tx; -+ -+ /* TRUE if we are in Single Carrier Tx test. */ -+ BOOLEAN bSingleCarrier; -+ /* TRUE if we are in Carrier Suppression Tx Test. */ -+ -+ BOOLEAN is_carrier_suppression; -+ -+ /* TRUE if we are in Single Tone Tx test. */ -+ -+ BOOLEAN is_single_tone; -+ -+ -+ /* ACK counter asked by K.Y.. */ -+ BOOLEAN 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 */ -+ BOOLEAN 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]; -+ 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_CHL_OFFSET, -+ 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_BT_MASK, -+ EFUSE_MASK, -+ EFUSE_FILE, -+ EFUSE_FILE_STORE, -+ MP_TX, -+ MP_RX, -+ MP_IQK, -+ MP_LCK, -+ MP_HW_TX_MODE, -+ MP_GET_TXPOWER_INX, -+ MP_CUSTOMER_STR, -+ MP_PWRLMT, -+ MP_PWRBYRATE, -+ BT_EFUSE_FILE, -+ MP_SetBT, -+ MP_SWRFPath, -+ MP_LINK, -+ MP_DPK_TRK, -+ MP_DPK, -+ MP_GET_TSSIDE, -+ MP_SET_TSSIDE, -+ MP_NULL, -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ VENDOR_IE_SET , -+ VENDOR_IE_GET , -+#endif -+#ifdef CONFIG_WOWLAN -+ MP_WOW_ENABLE, -+ MP_WOW_SET_PATTERN, -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ MP_WOW_SET_KEEP_ALIVE_PATTERN, -+#endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ MP_AP_WOW_ENABLE, -+#endif -+ MP_SD_IREAD, -+ MP_SD_IWRITE, -+ GET_IC_TYPE, -+}; -+ -+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; -+ BOOLEAN brx_filter_beacon; -+ -+ /* RF/BB relative */ -+ u8 channel; -+ u8 bandwidth; -+ u8 prime_channel_offset; -+ u8 txpoweridx; -+ s8 txpower_dbm_offset; -+ 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; -+ -+ /* RF PATH Setting for WLG WLA BTG BT */ -+ u8 rf_path_cfg; -+ -+ struct wlan_network mp_network; -+ NDIS_802_11_MAC_ADDRESS network_macaddr; -+ -+ 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; -+ BOOLEAN bloadefusemap; -+ BOOLEAN bloadBTefusemap; -+ BOOLEAN bprocess_mp_mode; -+ -+ MPT_CONTEXT mpt_ctx; -+ -+ u8 *TXradomBuffer; -+ u8 CureFuseBTCoex; -+ u8 mplink_buf[2048]; -+ u32 mplink_rx_len; -+ BOOLEAN mplink_brx; -+ BOOLEAN mplink_btx; -+ -+ bool tssitrk_on; -+ bool efuse_update_on; -+ bool efuse_update_file; -+ char efuse_file_path[128]; -+}; -+ -+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 GET_MPPRIV(__padapter) (struct mp_priv*)(&(((struct _ADAPTER*)__padapter)->mppriv)) -+#define GET_EFUSE_UPDATE_ON(_padapter) (GET_MPPRIV(_padapter)->efuse_update_on) -+ -+/* *********************************************************************** */ -+ -+#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) -+ -+typedef enum _mp_tx_pkt_payload{ -+ MP_TX_Payload_00 = 0, -+ MP_TX_Payload_a5, -+ MP_TX_Payload_5a, -+ MP_TX_Payload_ff, -+ MP_TX_Payload_prbs9, -+ MP_TX_Payload_default_random -+} mp_tx_pkt_payload; -+ -+/*************************************************************************/ -+#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); -+#ifdef CONFIG_ANTENNA_DIVERSITY -+u8 rtw_mp_set_antdiv(PADAPTER padapter, BOOLEAN bMain); -+#endif -+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 rfpath ,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 rtw_mp_trigger_dpk(PADAPTER padapter); -+u8 rtw_mp_mode_check(PADAPTER padapter); -+bool rtw_is_mp_tssitrk_on(_adapter *adapter); -+ -+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, u8 rf_path); -+void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 rfpath, 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); -+u8 mpt_ProSetPMacTx(PADAPTER Adapter); -+void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter , BOOLEAN bMain); -+void mp_phy_switch_rf_path_set(PADAPTER pAdapter , u8 *pstate); -+u8 MP_PHY_QueryRFPathSwitch(PADAPTER pAdapter); -+u32 mpt_ProQueryCalTxPower(PADAPTER pAdapter, u8 RfPath); -+void MPT_PwrCtlDM(PADAPTER padapter, u32 trk_type); -+u8 mpt_to_mgnt_rate(u32 MptRateIdx); -+u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr); -+u32 mp_join(PADAPTER padapter, u8 mode); -+u32 hal_mpt_query_phytxok(PADAPTER pAdapter); -+u32 mpt_get_tx_power_finalabs_val(PADAPTER padapter, u8 rf_path); -+void mpt_trigger_tssi_tracking(PADAPTER pAdapter, u8 rf_path); -+u32 hal_mpt_tssi_turn_target_power(PADAPTER padapter, s16 power_offset, u8 path); -+void hal_mpt_tssi_set_power_offset(PADAPTER padapter, s16 power_offset, u8 path); -+ -+ -+ -+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( -+ u32 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_ch_offset(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_switch_rf_path(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_link(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_mp_pwrlmt(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_pwrbyrate(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_dpk_track(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_dpk(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_bt_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); -+#if !defined(CONFIG_RTW_ANDROID_GKI) -+int rtw_efuse_file_map_store(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+#endif /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+int rtw_bt_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); -+int rtw_mp_get_tsside(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_set_tsside(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+#endif /* _RTW_MP_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_mp_phy_regdef.h b/drivers/net/wireless/rtl8821cs/include/rtw_mp_phy_regdef.h -new file mode 100644 -index 000000000..be627800e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_mp_phy_regdef.h -@@ -0,0 +1,1094 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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: __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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_odm.h b/drivers/net/wireless/rtl8821cs/include/rtw_odm.h -new file mode 100644 -index 000000000..21228083a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_odm.h -@@ -0,0 +1,104 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+#include "../hal/phydm/phydm_types.h" -+/* -+* This file provides utilities/wrappers for rtw driver to use ODM -+*/ -+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) -+ -+#ifdef CONFIG_RTW_ACS -+#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); \ -+ if (IS_ACS_ENABLE(adapter))\ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ODM_BB_ENV_MONITOR); \ -+ } while (0) -+#else -+#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) -+#endif -+ -+#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) -+ -+ -+static inline u32 rtw_phydm_ability_get(_adapter *adapter) -+{ -+ return rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_GET, 0); -+} -+ -+ -+void rtw_odm_init_ic_type(_adapter *adapter); -+ -+void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter); -+ -+bool rtw_odm_adaptivity_needed(_adapter *adapter); -+void rtw_odm_adaptivity_update(struct dvobj_priv *dvobj); -+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); -+void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter); -+void rtw_odm_acquirespinlock(_adapter *adapter, enum rt_spinlock_type type); -+void rtw_odm_releasespinlock(_adapter *adapter, enum rt_spinlock_type type); -+ -+struct dm_struct; -+s16 rtw_odm_get_tx_power_mbm(struct dm_struct *dm, u8 rfpath, u8 rate, u8 bw, u8 cch); -+ -+#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); -+void rtw_odm_update_dfs_region(struct dvobj_priv *dvobj); -+u8 rtw_odm_radar_detect_polling_int_ms(struct dvobj_priv *dvobj); -+#endif /* CONFIG_DFS_MASTER */ -+ -+void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys); -+ -+#if defined(CONFIG_RTL8822C) && defined(CONFIG_LPS_PG) -+void odm_lps_pg_debug_8822c(void *dm_void); -+#endif -+ -+#endif /* __RTW_ODM_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_p2p.h b/drivers/net/wireless/rtl8821cs/include/rtw_p2p.h -new file mode 100644 -index 000000000..8d929ad61 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_p2p.h -@@ -0,0 +1,167 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 -+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 -+void _rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_pwrctrl.h b/drivers/net/wireless/rtl8821cs/include/rtw_pwrctrl.h -new file mode 100755 -index 000000000..04fb617e2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_pwrctrl.h -@@ -0,0 +1,780 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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) -+#ifdef CONFIG_BT_COEXIST -+#define BTCOEX_ALIVE BIT(4) -+#endif /* CONFIG_BT_COEXIST */ -+#define LPS_ALIVE BIT(5) -+ -+#ifdef CONFIG_WOWLAN -+ #ifdef CONFIG_PLATFORM_ANDROID_INTEL_X86 -+ /* TCP/ICMP/UDP multicast with specific IP addr */ -+ #define DEFAULT_PATTERN_NUM 4 -+ #else -+ /* TCP/ICMP */ -+ #define DEFAULT_PATTERN_NUM 3 -+ #endif -+ -+#ifdef CONFIG_WOW_PATTERN_HW_CAM /* Frame Mask Cam number for pattern match */ -+#define MAX_WKFM_CAM_NUM 12 -+#else -+#define MAX_WKFM_CAM_NUM 16 -+#endif -+ -+#define MAX_WKFM_SIZE 16 /* (16 bytes for WKFM bit mask, 16*8 = 128 bits) */ -+#define MAX_WKFM_PATTERN_SIZE 128 -+#define MAX_IN_PATTERN_SIZE 512 -+ -+/* -+ * MAX_WKFM_PATTERN_STR_LEN : the max. length of wow pattern string -+ * e.g. echo 00:01:02:...:7f > /proc/net/rtl88x2bu/wlan0/wow_pattern_info -+ * - each byte of pattern is represented as 2-bytes ascii : MAX_WKFM_PATTERN_SIZE * 2 -+ * - the number of common ':' in pattern string : MAX_WKFM_PATTERN_SIZE - 1 -+ * - 1 byte '\n'(0x0a) is generated at the end when we use echo command -+ * so total max. length is (MAX_WKFM_PATTERN_SIZE * 3) -+ */ -+#define MAX_WKFM_PATTERN_STR_LEN (MAX_WKFM_PATTERN_SIZE * 3) -+ -+#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; -+ -+#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, -+}; -+ -+enum lps_level { -+ LPS_NORMAL = 0, -+ LPS_LCLK, -+ LPS_PG, -+ LPS_LEVEL_MAX, -+}; -+ -+#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_MS 1000 /* 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; -+ -+/* 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_MONITOR_MODE, -+ PS_DENY_BEAMFORMING, /* Beamforming */ -+ PS_DENY_DRV_REMOVE = 30, -+ PS_DENY_OTHERS = 31 -+} PS_DENY_REASON; -+ -+#ifdef CONFIG_WAR_OFFLOAD -+/* only support mDNS V4/V6 rsp now */ -+enum { -+ WAR_ARP_RSP_EN = 0x0000001, -+ WAR_ICMPV6_NS_RSP_EN = 0x00000002, -+ WAR_ICMPV4_ECHO_RSP_EN = 0x00000004, -+ WAR_ICMPV6_ECHO_RSP_EN = 0x00000008, -+ WAR_NETBIOS_RSP_EN = 0x00000010, -+ WAR_LLMNR_V4_RSP_EN = 0x00000020, -+ WAR_LLMNR_V6_RSP_EN = 0x00000040, -+ WAR_SNMP_V4_RSP_EN = 0x00000080, -+ WAR_SNMP_V6_RSP_EN = 0x00000100, -+ WAR_SNMP_V4_WAKEUP_EN = 0x00000200, -+ WAR_SNMP_V6_WAKEUP_EN = 0x00000400, -+ WAR_SSDP_V4_WAKEUP_EN = 0x00000800, -+ WAR_SSDP_V6_WAKEUP_EN = 0x00001000, -+ WAR_WSD_V4_WAKEUP_EN = 0x00002000, -+ WAR_WSD_V6_WAKEUP_EN = 0x00004000, -+ WAR_SLP_V4_WAKEUP_EN = 0x00008000, -+ WAR_SLP_V6_WAKEUP_EN = 0x00010000, -+ WAR_MDNS_V4_RSP_EN = 0x00020000, -+ WAR_MDNS_V6_RSP_EN = 0x00040000, -+ WAR_DESIGNATED_MAC_EN = 0x00080000, -+ WAR_LLTD_WAKEUP_EN = 0x00100000, -+ WAR_ARP_WAKEUP_EN = 0x00200000, -+ WAR_MAGIC_WAKEUP_EN = 0x00400000, -+ WAR_MDNS_V4_WAKEUP_EN = 0x000800000, -+ WAR_MDNS_V6_WAKEUP_EN = 0x001000000 -+}; -+ -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+#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[WLAN_SSID_MAXLEN]; -+} 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; -+ -+#ifndef RTW_HALMAC -+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 -+#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 aoac_report { -+ u8 iv[8]; -+ u8 replay_counter_eapol_key[8]; -+ u8 group_key[32]; -+ u8 key_index; -+ u8 security_type; -+ u8 wow_pattern_idx; -+ u8 version_info; -+ u8 rekey_ok:1; -+ u8 dummy:7; -+ u8 reserved[3]; -+ u8 rxptk_iv[8]; -+ u8 rxgtk_iv[4][8]; -+}; -+ -+#ifdef CONFIG_WAR_OFFLOAD -+ -+struct war_ipv4_fmt { -+ u32 ip_addr[4]; -+ u32 ip_subnet[4]; -+ u32 ip_gateway[4]; -+}; -+ -+struct war_ipv6_fmt { -+ u8 ipv6_addr[8][16]; -+}; -+ -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+/* limitation of mDNS parameter : length and number */ -+#define MAX_MDNS_SERVICE_NAME_LEN 15 -+#define MAX_MDNS_TRANS_LEN 4 /* _tcp or _udp */ -+#define MAX_MDNS_DOMAIN_LEN 5 /* local only for mdns */ -+#define MAX_MDNS_MACHINE_NAME_LEN (63+1) /* +1 for the length byte used by the DNS format */ -+#define MAX_MDNS_TARGET_LEN 63 -+#define MAX_MDNS_DOMAIN_NAME_LEN 63 -+#define MAX_MDNS_TXT_LEN 1536 -+#define MAX_MDNS_TXT_SINGLE_LEN 255 -+ -+ -+#define MAX_MDNS_SERVICE_NUM 10 -+#define MAX_MDNS_TXT_NUM 8 -+#define MAX_MDNS_MACHINE_NAME_NUM 3 -+ -+/* for monitor rsvd page using */ -+#define MAX_MDNS_PARA_SIZE 1700 // 14*128 = 1792 -+#define MAX_MDNS_TXT_TOTAL_SIZE 10*MAX_MDNS_TXT_LEN -+#define MAX_MDNS_RSP_PKT_SIZE 760 // 6*128 = 768 -+ -+#define RTW_MDNS_SRV_INFO(sname, sname_len, tname, tname_len, dname, dname_len, port0, port1, ttlv, tar, tar_len, idx) \ -+ { .service=sname, .service_len=sname_len, .transport=tname, .transport_len=tname_len, \ -+ .domain=dname , .domain_len=dname_len , .port[0]=port0, .port[1]=port1, .ttl=ttlv, \ -+ .target=tar, .target_len=tar_len, .txt_rsp_idx=idx } -+ -+ -+struct war_mdns_service_info { -+ u8 service[MAX_MDNS_SERVICE_NAME_LEN+1]; -+ u8 service_len; -+ u8 transport[MAX_MDNS_TRANS_LEN+1]; -+ u8 transport_len; -+ u8 domain[MAX_MDNS_DOMAIN_LEN+1]; -+ u8 domain_len; -+ u8 port[2]; -+ u32 ttl; -+ u8 target[MAX_MDNS_TARGET_LEN+1]; -+ u8 target_len; -+ s8 txt_rsp_idx; -+}; -+ -+struct war_mdns_machine_name { -+ u8 name[MAX_MDNS_MACHINE_NAME_LEN]; -+ u8 name_len; -+}; -+ -+struct war_mdns_txt_rsp { -+ u8 txt[MAX_MDNS_TXT_LEN]; -+ u16 txt_len; -+}; -+#endif -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+ -+struct rsvd_page_cache_t; -+ -+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 rpwm_retry; -+ -+ u8 pwr_mode; -+ u8 smart_ps; -+ u8 bcn_ant_mode; -+ u8 dtim; -+#ifdef CONFIG_LPS_CHK_BY_TP -+ u8 lps_chk_by_tp; -+ u16 lps_tx_tp_th;/*Mbps*/ -+ u16 lps_rx_tp_th;/*Mbps*/ -+ u16 lps_bi_tp_th;/*Mbps*//*TRX TP*/ -+ int lps_chk_cnt_th; -+ int lps_chk_cnt; -+ u32 lps_tx_pkts; -+ u32 lps_rx_pkts; -+ -+#endif -+ -+#ifdef CONFIG_WMMPS_STA -+ u8 wmm_smart_ps; -+#endif /* CONFIG_WMMPS_STA */ -+ -+ u32 alives; -+ _workitem cpwm_event; -+ _workitem dma_event; /*for handle un-synchronized tx dma*/ -+#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; -+ -+ 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; -+ systime 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; -+ systime lps_deny_time; /* will deny LPS when system time is smaller than this */ -+ s32 pnp_current_pwr_state; -+ u8 pnp_bstop_trx; -+ 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; -+ u8 wowlan_in_resume; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ u8 is_high_active; -+ u8 wowlan_gpio_index; -+ u8 wowlan_gpio_output_state; -+#endif /* CONFIG_GPIO_WAKEUP */ -+ u8 hst2dev_high_active; -+#ifdef CONFIG_WOWLAN -+ bool default_patterns_en; -+#ifdef CONFIG_IPV6 -+ u8 wowlan_ns_offload_en; -+#endif /*CONFIG_IPV6*/ -+ u8 wowlan_txpause_status; -+ u8 wowlan_pattern_idx; -+ u64 wowlan_fw_iv; -+ struct rtl_priv_pattern patterns[MAX_WKFM_CAM_NUM]; -+#ifdef CONFIG_WOW_PATTERN_IN_TXFIFO -+ u8 pattern_rsvd_page_loc; -+#endif -+#ifdef CONFIG_PNO_SUPPORT -+ u8 pno_inited; -+ pno_nlo_info_t *pnlo_info; -+ #ifndef RTW_HALMAC -+ pno_scan_info_t *pscan_info; -+ #endif -+ pno_ssid_list_t *pno_ssid_list; -+#endif /* CONFIG_PNO_SUPPORT */ -+#ifdef CONFIG_WOW_PATTERN_HW_CAM -+ _mutex wowlan_pattern_cam_mutex; -+#endif -+ u8 wowlan_aoac_rpt_loc; -+ struct aoac_report wowlan_aoac_rpt; -+ u8 wowlan_power_mgmt; -+ u8 wowlan_lps_level; -+ #ifdef CONFIG_LPS_1T1R -+ u8 wowlan_lps_1t1r; -+ #endif -+ -+ #ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ /*data 0,rsv page location*/ -+ u8 wowlan_keep_alive_mode; -+ u8 keep_alive_pattern_loc; -+ /*data 1 ,cam id, rx udp packet*/ -+ u8 wowlan_keep_alive_ack_index; -+ /*data 2 ,cam id, pattern match packet*/ -+ u8 wowlan_wake_pattern_index; -+ /*data3,unit: TBTT*/ -+ u16 wowlan_keep_alive_period; -+ /*data4,unit: TBTT*/ -+ u8 wowlan_keep_alive_retry_interval; -+ /*data5*/ -+ u8 wowlan_keep_alive_retry_counter; -+ /*from echo*/ -+ u8 keep_alive_pattern[WLAN_MAX_KEEP_ALIVE_IE_LEN]; -+ u32 keep_alive_pattern_len; -+ #endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ -+#ifdef CONFIG_WAR_OFFLOAD -+ u8 wowlan_war_offload_mode; -+ u32 wowlan_war_offload_ctrl; -+ struct war_ipv4_fmt wowlan_war_offload_ipv4; -+ struct war_ipv6_fmt wowlan_war_offload_ipv6; -+ u8 wowlan_war_offload_mac[6]; -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+ struct war_mdns_machine_name wowlan_war_offload_mdns_mnane[MAX_MDNS_MACHINE_NAME_NUM]; -+ struct war_mdns_service_info wowlan_war_offload_mdns_service[MAX_MDNS_SERVICE_NUM]; -+ struct war_mdns_txt_rsp wowlan_war_offload_mdns_txt_rsp[MAX_MDNS_TXT_NUM]; -+ u8 wowlan_war_offload_mdns_mnane_num; -+ u8 wowlan_war_offload_mdns_service_info_num; -+ u8 wowlan_war_offload_mdns_txt_rsp_num; -+ u8 wowlan_war_offload_mdns_domain_name[MAX_MDNS_DOMAIN_NAME_LEN+1]; -+ u8 wowlan_war_offload_mdns_domain_name_len; -+ u32 wowlan_war_offload_mdns_para_cur_size; -+ u32 wowlan_war_offload_mdns_rsp_cur_size; -+#endif /* CONFIG_OFFLOAD_MDNS_V4 || CONFIG_OFFLOAD_MDNS_V6 */ -+#endif /* CONFIG_WAR_OFFLOAD */ -+#endif /* CONFIG_WOWLAN */ -+ _timer pwr_state_check_timer; -+ int pwr_state_check_interval; -+ u8 pwr_state_check_cnts; -+ -+ -+ 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_LPS_POFF -+ lps_poff_info_t *plps_poff_info; -+#endif -+ u8 lps_level_bk; -+ u8 lps_level; /*LPS_NORMAL,LPA_CG,LPS_PG*/ -+#ifdef CONFIG_LPS_1T1R -+ u8 lps_1t1r_bk; -+ u8 lps_1t1r; -+#endif -+#ifdef CONFIG_LPS_PG -+ struct rsvd_page_cache_t lpspg_info; -+#ifdef CONFIG_RTL8822C -+ struct rsvd_page_cache_t lpspg_dpk_info; -+ struct rsvd_page_cache_t lpspg_iqk_info; -+#endif -+#endif -+ u8 current_lps_hw_port_id; -+ -+#ifdef CONFIG_RTW_CFGVENDOR_LLSTATS -+ systime radio_on_start_time; -+ systime pwr_saving_start_time; -+ u32 pwr_saving_time; -+ u32 on_time; -+ u32 tx_time; -+ u32 rx_time; -+#endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ -+ -+#ifdef CONFIG_LPS_ACK -+ struct submit_ctx lps_ack_sctx; -+ s8 lps_ack_status; -+ _mutex lps_ack_mutex; -+#endif /* CONFIG_LPS_ACK */ -+}; -+ -+#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); -+void rtw_set_lps_lclk(_adapter *padapter, u8 enable); -+#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 SUPPORT_HW_RFOFF_DETECTED -+rt_rf_power_state RfOnOffDetect(PADAPTER pAdapter); -+#endif -+ -+ -+#ifdef DBG_CHECK_FW_PS_STATE -+int rtw_fw_ps_state(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_LPS -+extern const char * const LPS_CTRL_PHYDM; -+void LPS_Enter(PADAPTER padapter, const char *msg); -+void LPS_Leave(PADAPTER padapter, const char *msg); -+void rtw_exec_lps(_adapter *padapter, u8 ps_mode); -+void rtw_lps_rfon_ctrl(_adapter *padapter, u8 rfon_ctrl); -+#ifdef CONFIG_CHECK_LEAVE_LPS -+#ifdef CONFIG_LPS_CHK_BY_TP -+void traffic_check_for_leave_lps_by_tp(PADAPTER padapter, u8 tx, struct sta_info *sta); -+#endif -+void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets); -+#endif /*CONFIG_CHECK_LEAVE_LPS*/ -+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); -+u8 rtw_set_rpwm(_adapter *padapter, u8 val8); -+#ifdef CONFIG_WOWLAN -+void rtw_wow_lps_level_decide(_adapter *adapter, u8 wow_en); -+#endif /* CONFIG_WOWLAN */ -+#endif /* CONFIG_LPS */ -+ -+#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); -+int rtw_pm_set_lps_level(_adapter *padapter, u8 level); -+#ifdef CONFIG_LPS_1T1R -+int rtw_pm_set_lps_1t1r(_adapter *padapter, u8 en); -+#endif -+void rtw_set_lps_deny(_adapter *adapter, u32 ms); -+#ifdef CONFIG_WOWLAN -+int rtw_pm_set_wow_lps(_adapter *padapter, u8 mode); -+int rtw_pm_set_wow_lps_level(_adapter *padapter, u8 level); -+#ifdef CONFIG_LPS_1T1R -+int rtw_pm_set_wow_lps_1t1r(_adapter *padapter, u8 en); -+#endif -+#endif /* CONFIG_WOWLAN */ -+ -+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_wowlan_parser_pattern_cmd(u8 *input, char *pattern, -+ int *pattern_len, char *bit_mask); -+void rtw_wow_pattern_sw_reset(_adapter *adapter); -+u8 rtw_set_default_pattern(_adapter *adapter); -+void rtw_wow_pattern_sw_dump(_adapter *adapter); -+#ifdef CONFIG_WAR_OFFLOAD -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+void rtw_wow_war_mdns_dump_buf(struct seq_file *m, u8 *title, u8 *buf, u32 len); -+void rtw_wow_war_mdns_dump_txt(struct seq_file *m, u8 *title, u8 *buf, u32 len); -+bool rtw_wow_war_mdns_parser_pattern(u8 *input, char *target, u32 *target_len, u32 max_len); -+void rtw_wow_war_mdns_parms_reset(_adapter *adapter, u8 is_set_default); -+#endif /* defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) */ -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+#endif /* CONFIG_WOWLAN */ -+void rtw_ssmps_enter(_adapter *adapter, struct sta_info *sta); -+void rtw_ssmps_leave(_adapter *adapter, struct sta_info *sta); -+#endif /* __RTL871X_PWRCTRL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_qos.h b/drivers/net/wireless/rtl8821cs/include/rtw_qos.h -new file mode 100644 -index 000000000..8e1d013e1 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_qos.h -@@ -0,0 +1,66 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+#define DRV_CFG_UAPSD_VO BIT0 -+#define DRV_CFG_UAPSD_VI BIT1 -+#define DRV_CFG_UAPSD_BK BIT2 -+#define DRV_CFG_UAPSD_BE BIT3 -+ -+#define WMM_IE_UAPSD_VO BIT0 -+#define WMM_IE_UAPSD_VI BIT1 -+#define WMM_IE_UAPSD_BK BIT2 -+#define WMM_IE_UAPSD_BE BIT3 -+ -+#define WMM_TID0 BIT0 -+#define WMM_TID1 BIT1 -+#define WMM_TID2 BIT2 -+#define WMM_TID3 BIT3 -+#define WMM_TID4 BIT4 -+#define WMM_TID5 BIT5 -+#define WMM_TID6 BIT6 -+#define WMM_TID7 BIT7 -+ -+#define AP_SUPPORTED_UAPSD BIT7 -+/* TC = Traffic Category, TID0~7 represents TC */ -+#define BIT_MASK_TID_TC 0xff -+/* TS = Traffic Stream, TID8~15 represents TS */ -+#define BIT_MASK_TID_TS 0xff00 -+#define ALL_TID_TC_SUPPORTED_UAPSD 0xff -+ -+struct qos_priv { -+ -+ unsigned int qos_option; /* bit mask option: u-apsd, s-apsd, ts, block ack... */ -+ -+#ifdef CONFIG_WMMPS_STA -+ /* uapsd (unscheduled automatic power-save delivery) = a kind of wmmps */ -+ u8 uapsd_max_sp_len; -+ /* declare uapsd_tid as a bitmap for the uapsd setting of TID 0~15 */ -+ u16 uapsd_tid; -+ /* declare uapsd_tid_delivery_enabled as a bitmap for the delivery-enabled setting of TID 0~7 */ -+ u8 uapsd_tid_delivery_enabled; -+ /* declare uapsd_tid_trigger_enabled as a bitmap for the trigger-enabled setting of TID 0~7 */ -+ u8 uapsd_tid_trigger_enabled; -+ /* declare uapsd_ap_supported to record whether the connected ap supports uapsd or not */ -+ u8 uapsd_ap_supported; -+#endif /* CONFIG_WMMPS_STA */ -+ -+}; -+ -+ -+#endif /* _RTL871X_QOS_H_ */ -\ No newline at end of file -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_recv.h b/drivers/net/wireless/rtl8821cs/include/rtw_recv.h -new file mode 100755 -index 000000000..188457b85 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_recv.h -@@ -0,0 +1,955 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+#define RTW_RX_MSDU_ACT_NONE 0 -+#define RTW_RX_MSDU_ACT_INDICATE BIT0 -+#define RTW_RX_MSDU_ACT_FORWARD BIT1 -+ -+#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 -+ -+ -+#if defined(CONFIG_RTL8821C) && defined(CONFIG_SDIO_HCI) && defined(CONFIG_RECV_THREAD_MODE) -+ #ifdef NR_RECVBUFF -+ #undef NR_RECVBUFF -+ #define NR_RECVBUFF (32) -+ #endif -+#endif -+ -+#define NR_RECVFRAME 256 -+ -+#define RXFRAME_ALIGN 8 -+#define RXFRAME_ALIGN_SZ (1<mesh_ctrl_len) -+#else -+#define RATTRIB_GET_MCTRL_LEN(rattrib) 0 -+#endif -+ -+/* These definition is used for Rx packet reordering. */ -+#define SN_LESS(a, b) (((a-b) & 0x800) != 0) -+#define SN_EQUAL(a, b) (a == b) -+/* #define REORDER_WIN_SIZE 128 */ -+/* #define REORDER_ENTRY_NUM 128 */ -+#define REORDER_WAIT_TIME (50) /* (ms) */ -+ -+#if defined(CONFIG_PLATFORM_RTK390X) && defined(CONFIG_USB_HCI) -+ #define RECVBUFF_ALIGN_SZ 32 -+#else -+ #define RECVBUFF_ALIGN_SZ 8 -+#endif -+ -+#ifdef CONFIG_TRX_BD_ARCH -+ #define RX_WIFI_INFO_SIZE 24 -+#elif (defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)) && defined(CONFIG_PCI_HCI) -+ #define RXBD_SIZE sizeof(struct recv_stat) -+#endif -+ -+#define RXDESC_SIZE 24 -+#define RXDESC_OFFSET RXDESC_SIZE -+ -+#ifdef CONFIG_TRX_BD_ARCH -+struct rx_buf_desc { -+ /* RX has exactly one segment */ -+#ifdef CONFIG_64BIT_DMA -+ unsigned int dword[4]; -+#else -+ unsigned int dword[2]; -+#endif -+}; -+ -+struct recv_stat { -+ unsigned int rxdw[8]; -+}; -+#else -+struct recv_stat { -+ unsigned int rxdw0; -+ -+ unsigned int rxdw1; -+ -+#if !((defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C)) && defined(CONFIG_PCI_HCI)) /* exclude 8192ee, 8814ae, 8822be, 8821ce */ -+ 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 */ -+}; -+#endif -+ -+#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 -+#ifdef CONFIG_TRX_BD_ARCH -+#define RX_BD_NUM PCI_MAX_RX_COUNT /* alias */ -+#endif -+ -+struct rtw_rx_ring { -+#ifdef CONFIG_TRX_BD_ARCH -+ struct rx_buf_desc *buf_desc; -+#else -+ struct recv_stat *desc; -+#endif -+ dma_addr_t dma; -+ unsigned int idx; -+ struct sk_buff *rx_buf[PCI_MAX_RX_COUNT]; -+}; -+#endif -+ -+struct rtw_ip_dbg_cnt_statistic { -+ u8 enabled; -+ u8 ip[4]; -+ u16 dst_port; -+ u32 ip_cnt; -+ u32 tcp_cnt; -+ u32 udp_cnt; -+ u32 frag_cnt; -+ u8 iperf_ver; /* bit7 for debug enable */ -+ u32 iperf_seq; -+ u32 iperf_err_cnt; -+ u32 iperf_out_of_order_cnt; -+ -+ u32 ip_seq_chk; -+ u16 frag_offset_chk, max_frag_offset_chk; -+ u8 defrag_done; -+ -+#define need_to_chk_iudp_cnt(p, s) \ -+ ((GET_IPV4_PROTOCOL((p)) == 0x11) && \ -+ ((((struct rtw_ip_dbg_cnt_statistic *)(s))->iperf_ver & 0x7f) > 0)) -+#define ip_cnt_inc(s) \ -+ ((struct rtw_ip_dbg_cnt_statistic *)(s))->ip_cnt++ -+#define frag_cnt_inc(s) \ -+ ((struct rtw_ip_dbg_cnt_statistic *)(s))->frag_cnt++ -+#define tcp_udp_cnt_inc(p, s) \ -+ do { \ -+ if (GET_IPV4_PROTOCOL(p) == 0x06) \ -+ ((struct rtw_ip_dbg_cnt_statistic *)(s))->tcp_cnt++; \ -+ else if (GET_IPV4_PROTOCOL(p) == 0x11) \ -+ ((struct rtw_ip_dbg_cnt_statistic *)(s))->udp_cnt++; \ -+ } while(0) -+#define iudp_err_cnt_inc(s, str) \ -+ do { \ -+ struct rtw_ip_dbg_cnt_statistic *ps = \ -+ (struct rtw_ip_dbg_cnt_statistic *)(s); \ -+ ps->iperf_err_cnt++; \ -+ if (((ps->iperf_ver & 0xf0) >> 7) > 0) \ -+ RTW_INFO("%s : %s-err iperf_err_cnt(%u), iperf_seq(%u)\n"\ -+ ,__func__, (const u8 *)(str), ps->iperf_err_cnt, ps->iperf_seq); \ -+ } while(0) -+#define iudp_err_cnt_update(s, c) \ -+ do { \ -+ struct rtw_ip_dbg_cnt_statistic *ps = \ -+ (struct rtw_ip_dbg_cnt_statistic *)(s); \ -+ ps->iperf_err_cnt += ((c - 1) - ps->iperf_seq); \ -+ if (((ps->iperf_ver & 0xf0) >> 7) > 0) \ -+ RTW_INFO("%s : iperf_err_cnt(%u), cur_iperf_seq(%u), last_iperf_seq(%u)\n"\ -+ ,__func__, ps->iperf_err_cnt, (c), ps->iperf_seq); \ -+ } while(0) -+#define iperf_out_of_order_cnt_inc(s, c) \ -+ do { \ -+ struct rtw_ip_dbg_cnt_statistic *ps = \ -+ (struct rtw_ip_dbg_cnt_statistic *)(s); \ -+ ps->iperf_out_of_order_cnt++; \ -+ if (((ps->iperf_ver & 0xf0) >> 7) > 0) \ -+ RTW_INFO("%s : iperf_out_of_order_cnt(%u), cur_iperf_seq(%u), last_iperf_seq(%u)\n"\ -+ ,__func__, ps->iperf_out_of_order_cnt, (c), ps->iperf_seq); \ -+ } while(0) -+ -+#define iudp_ip_seq_set(s, v) \ -+ (((struct rtw_ip_dbg_cnt_statistic *)(s))->iperf_seq = (v)) -+#define iudp_ip_seq_get(s) \ -+ ((struct rtw_ip_dbg_cnt_statistic *)(s))->iperf_seq -+#define iudp_defrag_done_set(s, v) \ -+ (((struct rtw_ip_dbg_cnt_statistic *)(s))->defrag_done = (v)) -+#define iudp_defrag_done_get(s) \ -+ ((struct rtw_ip_dbg_cnt_statistic *)(s))->defrag_done -+#define iudp_ip_seq_chk_set(s, v) \ -+ (((struct rtw_ip_dbg_cnt_statistic *)(s))->ip_seq_chk = (v)) -+#define iudp_ip_seq_chk_get(s) \ -+ ((struct rtw_ip_dbg_cnt_statistic *)(s))->ip_seq_chk -+#define iudp_frag_offset_chk_set(s, v) \ -+ (((struct rtw_ip_dbg_cnt_statistic *)(s))->frag_offset_chk = (v)) -+#define iudp_frag_offset_chk_get(s) \ -+ ((struct rtw_ip_dbg_cnt_statistic *)(s))->frag_offset_chk -+#define iudp_max_frag_offset_chk_set(s, v) \ -+ (((struct rtw_ip_dbg_cnt_statistic *)(s))->max_frag_offset_chk = (v)) -+#define iudp_max_frag_offset_chk_get(s) \ -+ ((struct rtw_ip_dbg_cnt_statistic *)(s))->max_frag_offset_chk -+}; /* end of struct rtw_ip_dbg_cnt_statistic */ -+ -+/* -+accesser of recv_priv: rtw_recv_entry(dispatch / passive level); recv_thread(passive) ; returnpkt(dispatch) -+; halt(passive) ; -+ -+using enter_critical section to protect -+*/ -+ -+#ifndef DBG_RX_BH_TRACKING -+#define DBG_RX_BH_TRACKING 0 -+#endif -+ -+struct recv_priv { -+ _lock lock; -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+ _sema recv_sema; -+ -+#endif -+ -+ /* _queue blk_strms[MAX_RX_NUMBLKS]; */ /* keeping the block ack frame until return ack */ -+ _queue free_recv_queue; -+ _queue recv_pending_queue; -+ _queue uc_swdec_pending_queue; -+ -+ -+ u8 *pallocated_frame_buf; -+ u8 *precv_frame_buf; -+ -+ uint free_recvframe_cnt; -+ -+ #if DBG_RX_BH_TRACKING -+ u32 rx_bh_stage; -+ u32 rx_bh_buf_dq_cnt; -+ void *rx_bh_lbuf; -+ void *rx_bh_cbuf; -+ void *rx_bh_cbuf_data; -+ u32 rx_bh_cbuf_dlen; -+ u32 rx_bh_cbuf_pos; -+ void *rx_bh_cframe; -+ #endif -+ -+ _adapter *adapter; -+ -+ u32 is_any_non_be_pkts; -+ -+ u64 rx_bytes; -+ u64 rx_pkts; -+ u64 rx_drop; -+ -+ u64 dbg_rx_drop_count; -+ 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; -+ -+ uint rx_icv_err; -+ uint rx_largepacket_crcerr; -+ uint rx_smallpacket_crcerr; -+ uint rx_middlepacket_crcerr; -+ -+ struct rtw_ip_dbg_cnt_statistic ip_statistic; -+ -+#ifdef CONFIG_USB_HCI -+ /* u8 *pallocated_urb_buf; */ -+ _sema allrxreturnevt; -+ uint ff_hwaddr; -+ ATOMIC_T rx_pending_cnt; -+#ifdef CONFIG_USB_PROTECT_RX_CLONED_SKB -+ struct sk_buff_head rx_cloned_skb_queue; -+#endif -+ -+#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) -+ _tasklet irq_prepare_beacon_tasklet; -+ _tasklet recv_tasklet; -+ -+ struct sk_buff_head free_recv_skb_queue; -+ struct sk_buff_head rx_skb_queue; -+#ifdef CONFIG_RTW_NAPI -+ struct sk_buff_head rx_napi_skb_queue; -+#endif -+#ifdef CONFIG_RX_INDICATE_QUEUE -+ _tasklet rx_indicate_tasklet; -+ struct ifqueue rx_indicate_queue; -+#endif /* CONFIG_RX_INDICATE_QUEUE */ -+ -+#endif /* defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) */ -+ -+ 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 -+ -+#if defined(CONFIG_SDIO_HCI) -+#ifdef CONFIG_SDIO_RECVBUF_PWAIT -+ struct rtw_pwait_ctx recvbuf_pwait; -+#endif -+#ifdef CONFIG_SDIO_RECVBUF_AGGREGATION -+ bool recvbuf_agg; -+#endif -+#endif /* CONFIG_SDIO_HCI */ -+ -+#ifdef CONFIG_PCI_HCI -+ /* Rx */ -+ struct rtw_rx_ring rx_ring[PCI_MAX_RX_QUEUE]; -+ int rxringcount; /* size should be PCI_MAX_RX_QUEUE */ -+ u32 rxbuffersize; -+#endif -+ -+ /* For display the phy informatiom */ -+ u8 is_signal_dbg; /* for debug */ -+ u8 signal_strength_dbg; /* for debug */ -+ -+ u8 signal_strength; -+ u8 signal_qual; -+ s8 rssi; /* translate_percentage_to_dbm(ptarget_wlan->network.PhyInfo.SignalStrength); */ -+ struct rx_raw_rssi raw_rssi_info; -+ /* s8 rxpwdb; */ -+ /* 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_SDIO_RECVBUF_AGGREGATION -+#define recv_buf_agg(recvpriv) recvpriv->recvbuf_agg -+#ifndef CONFIG_SDIO_RECVBUF_AGGREGATION_EN -+#define CONFIG_SDIO_RECVBUF_AGGREGATION_EN 1 -+#endif -+#else -+#define recv_buf_agg(recvpriv) 0 -+#endif -+ -+#define RX_BH_STG_UNKNOWN 0 -+#define RX_BH_STG_HDL_ENTER 1 -+#define RX_BH_STG_HDL_EXIT 2 -+#define RX_BH_STG_NEW_BUF 3 -+#define RX_BH_STG_NEW_FRAME 4 -+#define RX_BH_STG_NORMAL_RX 5 -+#define RX_BH_STG_NORMAL_RX_END 6 -+#define RX_BH_STG_C2H 7 -+#define RX_BH_STG_C2H_END 8 -+ -+#if DBG_RX_BH_TRACKING -+void rx_bh_tk_set_stage(struct recv_priv *recv, u32 s); -+void rx_bh_tk_set_buf(struct recv_priv *recv, void *buf, void *data, u32 dlen); -+void rx_bh_tk_set_buf_pos(struct recv_priv *recv, void *pos); -+void rx_bh_tk_set_frame(struct recv_priv *recv, void *frame); -+void dump_rx_bh_tk(void *sel, struct recv_priv *recv); -+#else -+#define rx_bh_tk_set_stage(recv, s) do {} while (0) -+#define rx_bh_tk_set_buf(recv, buf, data, dlen) do {} while (0) -+#define rx_bh_tk_set_buf_pos(recv, pos) do {} while (0) -+#define rx_bh_tk_set_frame(recv, frame) do {} while (0) -+#define dump_rx_bh_tk(sel, recv) do {} while (0) -+#endif -+ -+#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; -+ u16 bmc_tid_rxseq[16]; -+ u16 nonqos_rxseq; -+ u16 nonqos_bmc_rxseq; -+ -+ /* uint sta_rx_bytes; */ -+ /* uint sta_rx_pkts; */ -+ /* uint sta_rx_fail; */ -+ -+}; -+ -+ -+#define RBUF_TYPE_PREALLOC 0 -+#define RBUF_TYPE_TMP 1 -+#define RBUF_TYPE_PWAIT_ADJ 2 -+ -+struct recv_buf { -+ _list list; -+ -+#ifdef PLATFORM_WINDOWS -+ _lock recvbuf_lock; -+#endif -+ -+#ifdef CONFIG_SDIO_RECVBUF_PWAIT_RUNTIME_ADJUST -+ u8 type; -+#endif -+ -+ u32 ref_cnt; -+ -+ PADAPTER adapter; -+ -+ u8 *pbuf; -+ u8 *pallocated_buf; -+ -+ u32 len; -+ u8 *phead; -+ u8 *pdata; -+ u8 *ptail; -+ u8 *pend; -+ -+#ifdef CONFIG_USB_HCI -+ PURB purb; -+ dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ -+ u32 alloc_sz; -+ -+ u8 irp_pending; -+ int transfer_len; -+#endif -+ -+#if defined(PLATFORM_LINUX) -+ _pkt *pskb; -+#elif defined(PLATFORM_FREEBSD) /* skb solution */ -+ struct sk_buff *pskb; -+#endif -+}; -+ -+#ifdef CONFIG_SDIO_RECVBUF_PWAIT_RUNTIME_ADJUST -+#define RBUF_IS_PREALLOC(rbuf) ((rbuf)->type == RBUF_TYPE_PREALLOC) -+#else -+#define RBUF_IS_PREALLOC(rbuf) 1 -+#endif -+ -+/* -+ head -----> -+ -+ data -----> -+ -+ payload -+ -+ tail -----> -+ -+ -+ end -----> -+ -+ len = (unsigned int )(tail - data); -+ -+*/ -+struct recv_frame_hdr { -+ _list list; -+ _pkt *pkt; -+ -+ _adapter *adapter; -+ -+ u8 fragcnt; -+ -+ int frame_tag; -+ int keytrack; -+ 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]; */ -+ -+}; -+ -+enum rtw_rx_llc_hdl { -+ RTW_RX_LLC_KEEP = 0, -+ RTW_RX_LLC_REMOVE = 1, -+ RTW_RX_LLC_VLAN = 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 process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *psta); -+void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *psta); -+ -+#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) -+void rtw_reordering_ctrl_timeout_handler(void *pcontext); -+#endif -+ -+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); -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+thread_return rtw_recv_thread(thread_context context); -+#endif -+ -+__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; -+ -+} -+ -+#if 0 -+__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; -+ 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; -+ -+} -+#endif -+ -+ -+__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. */ -+ -+ /* Translate to dBm (x=y-100) */ -+ SignalPower = SignalStrengthIndex - 100; -+ 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); -+ -+u8 adapter_allow_bmc_data_rx(_adapter *adapter); -+s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status); -+void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info *sta); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_rf.h b/drivers/net/wireless/rtl8821cs/include/rtw_rf.h -new file mode 100644 -index 000000000..7313f3c95 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_rf.h -@@ -0,0 +1,334 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 NumRates (13) -+#define B_MODE_RATE_NUM (4) -+#define G_MODE_RATE_NUM (8) -+#define G_MODE_BASIC_RATE_NUM (3) -+/* slot time for 11g */ -+#define SHORT_SLOT_TIME 9 -+#define NON_SHORT_SLOT_TIME 20 -+ -+#define CENTER_CH_2G_NUM 14 -+#define CENTER_CH_2G_40M_NUM 9 -+ -+#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) -+ -+#define CENTER_CH_6G_20M_NUM 64 /* 20M center channels */ -+#define CENTER_CH_6G_40M_NUM 32 /* 40M center channels */ -+#define CENTER_CH_6G_80M_NUM 16 /* 80M center channels */ -+#define CENTER_CH_6G_160M_NUM 8 /* 160M center channels */ -+ -+#define MAX_CHANNEL_NUM_2G CENTER_CH_2G_NUM -+#define MAX_CHANNEL_NUM_5G CENTER_CH_5G_20M_NUM -+#define MAX_CHANNEL_NUM_6G CENTER_CH_6G_20M_NUM -+#define MAX_CHANNEL_NUM_2G_5G (MAX_CHANNEL_NUM_2G + MAX_CHANNEL_NUM_5G) -+ -+#define MAX_CHANNEL_NUM ( \ -+ MAX_CHANNEL_NUM_2G \ -+ + (CONFIG_IEEE80211_BAND_5GHZ ? MAX_CHANNEL_NUM_5G : 0) \ -+ + (CONFIG_IEEE80211_BAND_6GHZ ? MAX_CHANNEL_NUM_6G : 0) \ -+ ) -+ -+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_scch_by_cch_opch(u8 cch, u8 bw, u8 opch); -+ -+u8 rtw_get_op_chs_by_cch_bw(u8 cch, u8 bw, u8 **op_chs, u8 *op_ch_num); -+ -+u8 rtw_get_offset_by_chbw(u8 ch, u8 bw, u8 *r_offset); -+u8 rtw_get_center_ch(u8 ch, u8 bw, u8 offset); -+ -+u8 rtw_get_ch_group(u8 ch, u8 *group, u8 *cck_group); -+ -+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, -+}; -+ -+#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, -+#if CONFIG_IEEE80211_BAND_6GHZ -+ BAND_ON_6G = 2, -+#endif -+ BAND_MAX, -+} BAND_TYPE, *PBAND_TYPE; -+ -+#ifdef CONFIG_NARROWBAND_SUPPORTING -+enum nb_config { -+ RTW_NB_CONFIG_NONE = 0, -+ RTW_NB_CONFIG_WIDTH_5 = 5, -+ RTW_NB_CONFIG_WIDTH_10 = 6, -+}; -+#endif -+ -+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)]) -+ -+ -+extern const char *const _ch_width_str[]; -+#define ch_width_str(bw) (((bw) < CHANNEL_WIDTH_MAX) ? _ch_width_str[(bw)] : "CHANNEL_WIDTH_MAX") -+ -+extern const u8 _ch_width_to_bw_cap[]; -+#define ch_width_to_bw_cap(bw) (((bw) < CHANNEL_WIDTH_MAX) ? _ch_width_to_bw_cap[(bw)] : 0) -+ -+enum opc_bw { -+ OPC_BW20 = 0, -+ OPC_BW40PLUS = 1, -+ OPC_BW40MINUS = 2, -+ OPC_BW80 = 3, -+ OPC_BW160 = 4, -+ OPC_BW80P80 = 5, -+ OPC_BW_NUM, -+}; -+ -+extern const char *const _opc_bw_str[OPC_BW_NUM]; -+#define opc_bw_str(bw) (((bw) < OPC_BW_NUM) ? _opc_bw_str[(bw)] : "N/A") -+ -+extern const u8 _opc_bw_to_ch_width[OPC_BW_NUM]; -+#define opc_bw_to_ch_width(bw) (((bw) < OPC_BW_NUM) ? _opc_bw_to_ch_width[(bw)] : CHANNEL_WIDTH_MAX) -+ -+/* global op class APIs */ -+bool is_valid_global_op_class_id(u8 gid); -+s16 get_sub_op_class(u8 gid, u8 ch); -+void dump_global_op_class(void *sel); -+u8 rtw_get_op_class_by_chbw(u8 ch, u8 bw, u8 offset); -+u8 rtw_get_bw_offset_by_op_class_ch(u8 gid, u8 ch, u8 *bw, u8 *offset); -+ -+struct op_ch_t { -+ u8 ch; -+ u8 static_non_op:1; /* not in channel list */ -+ u8 no_ir:1; -+ s16 max_txpwr; /* mBm */ -+}; -+ -+struct op_class_pref_t { -+ u8 class_id; -+ BAND_TYPE band; -+ enum opc_bw bw; -+ u8 ch_num; /* number of chs */ -+ u8 op_ch_num; /* channel number which is not static non operable */ -+ u8 ir_ch_num; /* channel number which can init radiation */ -+ struct op_ch_t chs[]; -+}; -+ -+int op_class_pref_init(_adapter *adapter); -+void op_class_pref_deinit(_adapter *adapter); -+ -+#define REG_BEACON_HINT 0 -+#define REG_TXPWR_CHANGE 1 -+#define REG_CHANGE 2 -+ -+void op_class_pref_apply_regulatory(_adapter *adapter, u8 reason); -+ -+struct rf_ctl_t; -+void dump_cap_spt_op_class_ch(void *sel, struct rf_ctl_t *rfctl, bool detail); -+void dump_reg_spt_op_class_ch(void *sel, struct rf_ctl_t *rfctl, bool detail); -+void dump_cur_spt_op_class_ch(void *sel, struct rf_ctl_t *rfctl, bool detail); -+ -+/* -+ * 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; -+ -+#define RF_TYPE_VALID(rf_type) (rf_type < RF_TYPE_MAX) -+ -+extern const u8 _rf_type_to_rf_tx_cnt[]; -+#define rf_type_to_rf_tx_cnt(rf_type) (RF_TYPE_VALID(rf_type) ? _rf_type_to_rf_tx_cnt[rf_type] : 0) -+ -+extern const u8 _rf_type_to_rf_rx_cnt[]; -+#define rf_type_to_rf_rx_cnt(rf_type) (RF_TYPE_VALID(rf_type) ? _rf_type_to_rf_rx_cnt[rf_type] : 0) -+ -+extern const char *const _rf_type_to_rfpath_str[]; -+#define rf_type_to_rfpath_str(rf_type) (RF_TYPE_VALID(rf_type) ? _rf_type_to_rfpath_str[rf_type] : "UNKNOWN") -+ -+void rf_type_to_default_trx_bmp(enum rf_type rf, enum bb_path *tx, enum bb_path *rx); -+ -+enum rf_type trx_num_to_rf_type(u8 tx_num, u8 rx_num); -+enum rf_type trx_bmp_to_rf_type(u8 tx_bmp, u8 rx_bmp); -+bool rf_type_is_a_in_b(enum rf_type a, enum rf_type b); -+u8 rtw_restrict_trx_path_bmp_by_trx_num_lmt(u8 trx_path_bmp, u8 tx_num_lmt, u8 rx_num_lmt, u8 *tx_num, u8 *rx_num); -+u8 rtw_restrict_trx_path_bmp_by_rftype(u8 trx_path_bmp, enum rf_type type, u8 *tx_num, u8 *rx_num); -+void tx_path_nss_set_default(enum bb_path txpath_nss[], u8 txpath_num_nss[], u8 txpath); -+void tx_path_nss_set_full_tx(enum bb_path txpath_nss[], u8 txpath_num_nss[], u8 txpath); -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+int rtw_6gch2freq(int chan); -+#endif -+ -+int rtw_ch2freq(int chan); -+int rtw_ch2freq_by_band(BAND_TYPE band, int ch); -+int rtw_freq2ch(int freq); -+BAND_TYPE rtw_freq2band(int freq); -+bool rtw_freq_consecutive(int a, int b); -+bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo); -+ -+struct rf_ctl_t; -+ -+void txpwr_idx_get_dbm_str(s8 idx, u8 txgi_max, u8 txgi_pdbm, SIZE_T cwidth, char dbm_str[], u8 dbm_str_len); -+ -+#define MBM_PDBM 100 -+#define UNSPECIFIED_MBM 32767 /* maximum of s16 */ -+ -+void txpwr_mbm_get_dbm_str(s16 mbm, SIZE_T cwidth, char dbm_str[], u8 dbm_str_len); -+s16 mb_of_ntx(u8 ntx); -+ -+#if CONFIG_TXPWR_LIMIT -+struct regd_exc_ent { -+ _list list; -+ char country[2]; -+ u8 domain; -+ char lmt_name[0]; -+}; -+ -+void dump_regd_exc_list(void *sel, struct rf_ctl_t *rfctl); -+void rtw_regd_exc_add_with_nlen(struct rf_ctl_t *rfctl, const char *country, u8 domain, const char *lmt_name, u32 nlen); -+void rtw_regd_exc_add(struct rf_ctl_t *rfctl, const char *country, u8 domain, const char *lmt_name); -+struct regd_exc_ent *_rtw_regd_exc_search(struct rf_ctl_t *rfctl, const char *country, u8 domain); -+struct regd_exc_ent *rtw_regd_exc_search(struct rf_ctl_t *rfctl, const char *country, u8 domain); -+void rtw_regd_exc_list_free(struct rf_ctl_t *rfctl); -+ -+void dump_txpwr_lmt(void *sel, _adapter *adapter); -+void rtw_txpwr_lmt_add_with_nlen(struct rf_ctl_t *rfctl, const char *lmt_name, u32 nlen -+ , u8 band, u8 bw, u8 tlrs, u8 ntx_idx, u8 ch_idx, s8 lmt); -+void rtw_txpwr_lmt_add(struct rf_ctl_t *rfctl, const char *lmt_name -+ , u8 band, u8 bw, u8 tlrs, u8 ntx_idx, u8 ch_idx, s8 lmt); -+struct txpwr_lmt_ent *_rtw_txpwr_lmt_get_by_name(struct rf_ctl_t *rfctl, const char *lmt_name); -+struct txpwr_lmt_ent *rtw_txpwr_lmt_get_by_name(struct rf_ctl_t *rfctl, const char *lmt_name); -+void rtw_txpwr_lmt_list_free(struct rf_ctl_t *rfctl); -+#endif /* CONFIG_TXPWR_LIMIT */ -+ -+#define BB_GAIN_2G 0 -+#if 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 -+ -+#if 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); -+ -+/* only check channel ranges */ -+#define rtw_is_2g_ch(ch) (ch >= 1 && ch <= 14) -+#define rtw_is_5g_ch(ch) ((ch) >= 36 && (ch) <= 177) -+#define rtw_is_same_band(a, b) \ -+ ((rtw_is_2g_ch(a) && rtw_is_2g_ch(b)) \ -+ || (rtw_is_5g_ch(a) && rtw_is_5g_ch(b))) -+ -+#define rtw_is_5g_band1(ch) ((ch) >= 36 && (ch) <= 48) -+#define rtw_is_5g_band2(ch) ((ch) >= 52 && (ch) <= 64) -+#define rtw_is_5g_band3(ch) ((ch) >= 100 && (ch) <= 144) -+#define rtw_is_5g_band4(ch) ((ch) >= 149 && (ch) <= 177) -+#define rtw_is_same_5g_band(a, b) \ -+ ((rtw_is_5g_band1(a) && rtw_is_5g_band1(b)) \ -+ || (rtw_is_5g_band2(a) && rtw_is_5g_band2(b)) \ -+ || (rtw_is_5g_band3(a) && rtw_is_5g_band3(b)) \ -+ || (rtw_is_5g_band4(a) && rtw_is_5g_band4(b))) -+ -+#define rtw_is_6g_band1(ch) ((ch) >= 1 && (ch) <= 93) -+#define rtw_is_6g_band2(ch) ((ch) >= 97 && (ch) <= 117) -+#define rtw_is_6g_band3(ch) ((ch) >= 121 && (ch) <= 189) -+#define rtw_is_6g_band4(ch) ((ch) >= 193 && (ch) <= 237) -+ -+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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_rm.h b/drivers/net/wireless/rtl8821cs/include/rtw_rm.h -new file mode 100644 -index 000000000..f0b28838c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_rm.h -@@ -0,0 +1,111 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_RM_H_ -+#define __RTW_RM_H_ -+ -+u8 rm_post_event_hdl(_adapter *padapter, u8 *pbuf); -+ -+#define RM_TIMER_NUM 32 -+#define RM_ALL_MEAS BIT(1) -+#define RM_ID_FOR_ALL(aid) ((aid<<16)|RM_ALL_MEAS) -+ -+#define RM_CAP_ARG(x) ((u8 *)(x))[4], ((u8 *)(x))[3], ((u8 *)(x))[2], ((u8 *)(x))[1], ((u8 *)(x))[0] -+#define RM_CAP_FMT "%02x %02x%02x %02x%02x" -+ -+#ifndef MIN -+#define MIN(x, y) (((x) < (y)) ? (x) : (y)) -+#endif -+ -+/* remember to modify rm_event_name() when adding new event */ -+enum RM_EV_ID { -+ RM_EV_state_in, -+ RM_EV_busy_timer_expire, -+ RM_EV_delay_timer_expire, -+ RM_EV_meas_timer_expire, -+ RM_EV_retry_timer_expire, -+ RM_EV_repeat_delay_expire, -+ RM_EV_request_timer_expire, -+ RM_EV_wait_report, -+ RM_EV_start_meas, -+ RM_EV_survey_done, -+ RM_EV_recv_rep, -+ RM_EV_cancel, -+ RM_EV_state_out, -+ RM_EV_max -+}; -+ -+struct rm_event { -+ u32 rmid; -+ enum RM_EV_ID evid; -+ _list list; -+}; -+ -+#ifdef CONFIG_RTW_80211K -+ -+struct rm_clock { -+ struct rm_obj *prm; -+ ATOMIC_T counter; -+ enum RM_EV_ID evid; -+}; -+ -+struct rm_priv { -+ u8 enable; -+ _queue ev_queue; -+ _queue rm_queue; -+ _timer rm_timer; -+ -+ struct rm_clock clock[RM_TIMER_NUM]; -+ u8 rm_en_cap_def[5]; -+ u8 rm_en_cap_assoc[5]; -+ -+ u8 meas_token; -+ /* rm debug */ -+ void *prm_sel; -+}; -+ -+#define MAX_CH_NUM_IN_OP_CLASS 11 -+typedef struct _RT_OPERATING_CLASS { -+ int global_op_class; -+ int Len; -+ u8 Channel[MAX_CH_NUM_IN_OP_CLASS]; -+} RT_OPERATING_CLASS, *PRT_OPERATING_CLASS; -+ -+int rtw_init_rm(_adapter *padapter); -+int rtw_free_rm_priv(_adapter *padapter); -+ -+unsigned int rm_on_action(_adapter *padapter, union recv_frame *precv_frame); -+void RM_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void rtw_ap_parse_sta_rm_en_cap(_adapter *padapter, -+ struct sta_info *psta, struct rtw_ieee802_11_elems *elems); -+ -+int rm_post_event(_adapter *padapter, u32 rmid, enum RM_EV_ID evid); -+void rm_handler(_adapter *padapter, struct rm_event *pev); -+ -+u8 rm_add_nb_req(_adapter *padapter, struct sta_info *psta); -+ -+/* from ioctl */ -+int rm_send_bcn_reqs(_adapter *padapter, u8 *sta_addr, u8 op_class, u8 ch, -+ u16 measure_duration, u8 measure_mode, u8 *bssid, u8 *ssid, -+ u8 reporting_detail, -+ u8 n_ap_ch_rpt, struct _RT_OPERATING_CLASS *rpt, -+ u8 n_elem_id, u8 *elem_id_list); -+void indicate_beacon_report(u8 *sta_addr, -+ u8 n_measure_rpt, u32 elem_len, u8 *elem); -+#endif /* CONFIG_RTW_80211K */ -+ -+void rm_update_cap(u8 *frame_head, _adapter *pa, u32 pktlen, int offset); -+ -+#endif /* __RTW_RM_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_rm_fsm.h b/drivers/net/wireless/rtl8821cs/include/rtw_rm_fsm.h -new file mode 100644 -index 000000000..bbbb3d918 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_rm_fsm.h -@@ -0,0 +1,397 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_RM_FSM_H_ -+#define __RTW_RM_FSM_H_ -+ -+#ifdef CONFIG_RTW_80211K -+ -+#define RM_SUPPORT_IWPRIV_DBG 1 -+#define RM_MORE_DBG_MSG 0 -+ -+#define DBG_BCN_REQ_DETAIL 0 -+#define DBG_BCN_REQ_WILDCARD 0 -+#define DBG_BCN_REQ_SSID 0 -+#define DBG_BCN_REQ_SSID_NAME "RealKungFu" -+ -+#define RM_REQ_TIMEOUT 10000 /* 10 seconds */ -+#define RM_MEAS_TIMEOUT 10000 /* 10 seconds */ -+#define RM_REPT_SCAN_INTVL 5000 /* 5 seconds */ -+#define RM_REPT_POLL_INTVL 2000 /* 2 seconds */ -+#define RM_COND_INTVL 2000 /* 2 seconds */ -+#define RM_SCAN_DENY_TIMES 10 -+#define RM_BUSY_TRAFFIC_TIMES 10 -+#define RM_WAIT_BUSY_TIMEOUT 1000 /* 1 seconds */ -+ -+#define MEAS_REQ_MOD_PARALLEL BIT(0) -+#define MEAS_REQ_MOD_ENABLE BIT(1) -+#define MEAS_REQ_MOD_REQUEST BIT(2) -+#define MEAS_REQ_MOD_REPORT BIT(3) -+#define MEAS_REQ_MOD_DUR_MAND BIT(4) -+ -+#define MEAS_REP_MOD_LATE BIT(0) -+#define MEAS_REP_MOD_INCAP BIT(1) -+#define MEAS_REP_MOD_REFUSE BIT(2) -+ -+#define RM_MASTER BIT(0) /* STA who issue meas_req */ -+#define RM_SLAVE 0 /* STA who do measurement */ -+ -+#define CLOCK_UNIT 10 /* ms */ -+#define RTW_MAX_NB_RPT_IE_NUM 16 -+ -+#define RM_GET_AID(rmid) ((rmid&0xffff0000)>>16) -+#define RM_IS_ID_FOR_ALL(rmid) (rmid&RM_ALL_MEAS) -+ -+/* IEEE 802.11-2012 Table 8-59 Measurement Type definitions -+* for measurement request -+* modify rm_meas_type_req_name() when adding new type -+*/ -+enum meas_type_of_req { -+ basic_req, /* spectrum measurement */ -+ cca_req, -+ rpi_histo_req, -+ ch_load_req, -+ noise_histo_req, -+ bcn_req, -+ frame_req, -+ sta_statis_req, -+ lci_req, -+ meas_type_req_max, -+}; -+ -+/* IEEE 802.11-2012 Table 8-81 Measurement Type definitions -+* for measurement report -+* modify rm_type_rep_name() when adding new type -+*/ -+enum meas_type_of_rep { -+ basic_rep, /* spectrum measurement */ -+ cca_rep, -+ rpi_histo_rep, -+ ch_load_rep, /* radio measurement */ -+ noise_histo_rep, -+ bcn_rep, -+ frame_rep, -+ sta_statis_rep, /* Radio measurement and WNM */ -+ lci_rep, -+ meas_type_rep_max -+}; -+ -+/* -+* Beacon request -+*/ -+/* IEEE 802.11-2012 Table 8-64 Measurement mode for Beacon Request element */ -+enum bcn_req_meas_mode { -+ bcn_req_passive, -+ bcn_req_active, -+ bcn_req_bcn_table -+}; -+ -+/* IEEE 802.11-2012 Table 8-65 optional subelement IDs for Beacon Request */ -+enum bcn_req_opt_sub_id{ -+ bcn_req_ssid = 0, /* len 0-32 */ -+ bcn_req_rep_info = 1, /* len 2 */ -+ bcn_req_rep_detail = 2, /* len 1 */ -+ bcn_req_req = 10, /* len 0-237 */ -+ bcn_req_ap_ch_rep = 51 /* len 1-237 */ -+}; -+ -+/* IEEE 802.11-2012 Table 8-66 Reporting condition of Beacon Report */ -+enum bcn_rep_cound_id{ -+ bcn_rep_cond_immediately, /* default */ -+ bcn_req_cond_rcpi_greater, -+ bcn_req_cond_rcpi_less, -+ bcn_req_cond_rsni_greater, -+ bcn_req_cond_rsni_less, -+ bcn_req_cond_max -+}; -+ -+struct opt_rep_info { -+ u8 cond; -+ u8 threshold; -+}; -+ -+#define BCN_REQ_OPT_MAX_NUM 16 -+#define BCN_REQ_REQ_OPT_MAX_NUM 16 -+#define BCN_REQ_OPT_AP_CH_RPT_MAX_NUM 12 -+struct bcn_req_opt { -+ /* all req cmd id */ -+ u8 opt_id[BCN_REQ_OPT_MAX_NUM]; -+ u8 opt_id_num; -+ u8 req_id_num; -+ u8 req_id[BCN_REQ_REQ_OPT_MAX_NUM]; -+ u8 rep_detail; -+ NDIS_802_11_SSID ssid; -+ -+ /* bcn report condition */ -+ struct opt_rep_info rep_cond; -+ -+ u8 ap_ch_rpt_num; -+ struct _RT_OPERATING_CLASS *ap_ch_rpt[BCN_REQ_OPT_AP_CH_RPT_MAX_NUM]; -+ -+ /* 0:default(Report to be issued after each measurement) */ -+ u8 *req_start; /*id : 10 request;start */ -+ u8 req_len; /*id : 10 request;length */ -+}; -+ -+/* -+* channel load -+*/ -+/* IEEE 802.11-2012 Table 8-60 optional subelement IDs for channel load request */ -+enum ch_load_opt_sub_id{ -+ ch_load_rsvd, -+ ch_load_rep_info -+}; -+ -+/* IEEE 802.11-2012 Table 8-61 Reporting condition for channel load Report */ -+enum ch_load_cound_id{ -+ ch_load_cond_immediately, /* default */ -+ ch_load_cond_anpi_equal_greater, -+ ch_load_cond_anpi_equal_less, -+ ch_load_cond_max -+}; -+ -+/* -+* Noise histogram -+*/ -+/* IEEE 802.11-2012 Table 8-62 optional subelement IDs for noise histogram */ -+enum noise_histo_opt_sub_id{ -+ noise_histo_rsvd, -+ noise_histo_rep_info -+}; -+ -+/* IEEE 802.11-2012 Table 8-63 Reporting condition for noise historgarm Report */ -+enum noise_histo_cound_id{ -+ noise_histo_cond_immediately, /* default */ -+ noise_histo_cond_anpi_equal_greater, -+ noise_histo_cond_anpi_equal_less, -+ noise_histo_cond_max -+}; -+ -+struct meas_req_opt { -+ /* report condition */ -+ struct opt_rep_info rep_cond; -+}; -+ -+/* -+* State machine -+*/ -+ -+enum RM_STATE { -+ RM_ST_IDLE, -+ RM_ST_DO_MEAS, -+ RM_ST_WAIT_MEAS, -+ RM_ST_SEND_REPORT, -+ RM_ST_RECV_REPORT, -+ RM_ST_END, -+ RM_ST_MAX -+}; -+ -+struct rm_meas_req { -+ u8 category; -+ u8 action_code; /* T8-206 */ -+ u8 diag_token; -+ u16 rpt; -+ -+ u8 e_id; -+ u8 len; -+ u8 m_token; -+ u8 m_mode; /* req:F8-105, rep:F8-141 */ -+ u8 m_type; /* T8-59 */ -+ u8 op_class; -+ u8 ch_num; -+ u16 rand_intvl; /* units of TU */ -+ u16 meas_dur; /* units of TU */ -+ -+ u8 bssid[6]; /* for bcn_req */ -+ -+ u8 *pssid; -+ u8 *opt_s_elem_start; -+ int opt_s_elem_len; -+ -+ s8 tx_pwr_used; /* for link measurement */ -+ s8 tx_pwr_max; /* for link measurement */ -+ -+ union { -+ struct bcn_req_opt bcn; -+ struct meas_req_opt clm; -+ struct meas_req_opt nhm; -+ }opt; -+ -+ struct rtw_ieee80211_channel ch_set[RTW_CHANNEL_SCAN_AMOUNT]; -+ u8 ch_set_ch_amount; -+ s8 rx_pwr; /* in dBm */ -+ u8 rx_bw; -+ u8 rx_rate; -+ u8 rx_rsni; -+}; -+ -+struct rm_meas_rep { -+ u8 category; -+ u8 action_code; /* T8-206 */ -+ u8 diag_token; -+ -+ u8 e_id; /* T8-54, 38 request; 39 report */ -+ u8 len; -+ u8 m_token; -+ u8 m_mode; /* req:F8-105, rep:F8-141 */ -+ u8 m_type; /* T8-59 */ -+ u8 op_class; -+ u8 ch_num; -+ -+ u8 ch_load; -+ u8 anpi; -+ u8 ipi[11]; -+ -+ u16 rpt; -+ u8 bssid[6]; /* for bcn_req */ -+}; -+ -+#define MAX_BUF_NUM 128 -+struct data_buf { -+ u8 *pbuf; -+ u16 len; -+}; -+ -+struct rm_obj { -+ -+ /* aid << 16 -+ |diag_token << 8 -+ |B(1) 1/0:All_AID/UNIC -+ |B(0) 1/0:RM_MASTER/RM_SLAVE */ -+ u32 rmid; -+ -+ enum RM_STATE state; -+ struct rm_meas_req q; -+ struct rm_meas_rep p; -+ struct sta_info *psta; -+ struct rm_clock *pclock; -+ -+ /* meas report */ -+ u64 meas_start_time; -+ u64 meas_end_time; -+ int wait_busy; -+ u8 poll_mode; -+ u8 free_run_counter_valid; /* valid:_SUCCESS/invalid:_FAIL */ -+ -+ struct data_buf buf[MAX_BUF_NUM]; -+ bool from_ioctl; -+ -+ _list list; -+}; -+ -+/* -+* Measurement -+*/ -+struct opt_subelement { -+ u8 id; -+ u8 length; -+ u8 *data; -+}; -+ -+/* 802.11-2012 Table 8-206 Radio Measurment Action field */ -+enum rm_action_code { -+ RM_ACT_RADIO_MEAS_REQ, -+ RM_ACT_RADIO_MEAS_REP, -+ RM_ACT_LINK_MEAS_REQ, -+ RM_ACT_LINK_MEAS_REP, -+ RM_ACT_NB_REP_REQ, /* 4 */ -+ RM_ACT_NB_REP_RESP, -+ RM_ACT_RESV, -+ RM_ACT_MAX -+}; -+ -+/* 802.11-2012 Table 8-119 RM Enabled Capabilities definition */ -+enum rm_cap_en { -+ RM_LINK_MEAS_CAP_EN, -+ RM_NB_REP_CAP_EN, /* neighbor report */ -+ RM_PARAL_MEAS_CAP_EN, /* parallel report */ -+ RM_REPEAT_MEAS_CAP_EN, -+ RM_BCN_PASSIVE_MEAS_CAP_EN, -+ RM_BCN_ACTIVE_MEAS_CAP_EN, -+ RM_BCN_TABLE_MEAS_CAP_EN, -+ RM_BCN_MEAS_REP_COND_CAP_EN, /* conditions */ -+ -+ RM_FRAME_MEAS_CAP_EN, -+ RM_CH_LOAD_CAP_EN, -+ RM_NOISE_HISTO_CAP_EN, /* noise historgram */ -+ RM_STATIS_MEAS_CAP_EN, /* statistics */ -+ RM_LCI_MEAS_CAP_EN, /* 12 */ -+ RM_LCI_AMIMUTH_CAP_EN, -+ RM_TRANS_STREAM_CAT_MEAS_CAP_EN, -+ RM_TRIG_TRANS_STREAM_CAT_MEAS_CAP_EN, -+ -+ RM_AP_CH_REP_CAP_EN, -+ RM_RM_MIB_CAP_EN, -+ RM_OP_CH_MAX_MEAS_DUR0, /* 18-20 */ -+ RM_OP_CH_MAX_MEAS_DUR1, -+ RM_OP_CH_MAX_MEAS_DUR2, -+ RM_NONOP_CH_MAX_MEAS_DUR0, /* 21-23 */ -+ RM_NONOP_CH_MAX_MEAS_DUR1, -+ RM_NONOP_CH_MAX_MEAS_DUR2, -+ -+ RM_MEAS_PILOT_CAP0, /* 24-26 */ -+ RM_MEAS_PILOT_CAP1, -+ RM_MEAS_PILOT_CAP2, -+ RM_MEAS_PILOT_TRANS_INFO_CAP_EN, -+ RM_NB_REP_TSF_OFFSET_CAP_EN, -+ RM_RCPI_MEAS_CAP_EN, /* 29 */ -+ RM_RSNI_MEAS_CAP_EN, -+ RM_BSS_AVG_ACCESS_DELAY_CAP_EN, -+ -+ RM_AVALB_ADMIS_CAPACITY_CAP_EN, -+ RM_ANT_CAP_EN, -+ RM_RSVD, /* 34-39 */ -+ RM_MAX -+}; -+ -+char *rm_state_name(enum RM_STATE state); -+char *rm_event_name(enum RM_EV_ID evid); -+char *rm_type_req_name(u8 meas_type); -+int _rm_post_event(_adapter *padapter, u32 rmid, enum RM_EV_ID evid); -+int rm_enqueue_rmobj(_adapter *padapter, struct rm_obj *obj, bool to_head); -+ -+void rm_free_rmobj(struct rm_obj *prm); -+struct rm_obj *rm_alloc_rmobj(_adapter *padapter); -+struct rm_obj *rm_get_rmobj(_adapter *padapter, u32 rmid); -+struct sta_info *rm_get_psta(_adapter *padapter, u32 rmid); -+ -+int retrieve_radio_meas_result(struct rm_obj *prm); -+int rm_radio_meas_report_cond(struct rm_obj *prm); -+int rm_recv_radio_mens_req(_adapter *padapter, -+ union recv_frame *precv_frame,struct sta_info *psta); -+int rm_recv_radio_mens_rep(_adapter *padapter, -+ union recv_frame *precv_frame, struct sta_info *psta); -+int rm_recv_link_mens_req(_adapter *padapter, -+ union recv_frame *precv_frame,struct sta_info *psta); -+int rm_recv_link_mens_rep(_adapter *padapter, -+ union recv_frame *precv_frame, struct sta_info *psta); -+int rm_radio_mens_nb_rep(_adapter *padapter, -+ union recv_frame *precv_frame, struct sta_info *psta); -+int issue_null_reply(struct rm_obj *prm); -+int issue_beacon_rep(struct rm_obj *prm); -+int issue_nb_req(struct rm_obj *prm); -+int issue_radio_meas_req(struct rm_obj *prm); -+int issue_radio_meas_rep(struct rm_obj *prm); -+int issue_link_meas_req(struct rm_obj *prm); -+int issue_link_meas_rep(struct rm_obj *prm); -+ -+void rm_set_rep_mode(struct rm_obj *prm, u8 mode); -+ -+int ready_for_scan(struct rm_obj *prm); -+int rm_sitesurvey(struct rm_obj *prm); -+ -+#endif /*CONFIG_RTW_80211K*/ -+#endif /*__RTW_RM_FSM_H_*/ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_rm_util.h b/drivers/net/wireless/rtl8821cs/include/rtw_rm_util.h -new file mode 100644 -index 000000000..932cfb965 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_rm_util.h -@@ -0,0 +1,47 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_RM_UTIL_H_ -+#define _RTW_RM_UTIL_H_ -+/* -+ * 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} -+ */ -+#ifndef MAX -+#define MAX(x, y) (((x) > (y)) ? (x) : (y)) -+#endif -+ -+u8 rm_get_oper_class_via_ch(u8 ch); -+u8 rm_get_ch_set( struct rtw_ieee80211_channel *pch_set, u8 op_class, u8 ch_num); -+u8 rm_get_ch_set_from_bcn_req_opt( -+ struct rtw_ieee80211_channel *pch_set, struct bcn_req_opt *opt); -+u8 rm_get_bcn_rsni(struct rm_obj *prm, struct wlan_network *pnetwork); -+u8 rm_get_bcn_rcpi(struct rm_obj *prm, struct wlan_network *pnetwork); -+u8 rm_get_frame_rsni(struct rm_obj *prm, union recv_frame *pframe); -+u8 translate_percentage_to_rcpi(u32 SignalStrengthIndex); -+u8 translate_dbm_to_rcpi(s8 SignalPower); -+u8 rm_gen_dialog_token(_adapter *padapter); -+u8 rm_gen_meas_token(_adapter *padapter); -+u32 rm_gen_rmid(_adapter *padapter, struct rm_obj *prm, u8 role); -+int is_wildcard_bssid(u8 *bssid); -+ -+int rm_get_path_a_max_tx_power(_adapter *adapter, s8 *path_a); -+int rm_get_tx_power(PADAPTER adapter, enum rf_path path, enum MGN_RATE rate, s8 *pwr); -+int rm_get_rx_sensitivity(PADAPTER adapter, enum channel_width bw, enum MGN_RATE rate, s8 *pwr); -+ -+#endif /* _RTW_RM_UTIL_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_roch.h b/drivers/net/wireless/rtl8821cs/include/rtw_roch.h -new file mode 100644 -index 000000000..d3de7e299 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_roch.h -@@ -0,0 +1,61 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2020 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ROCH_H__ -+#define __RTW_ROCH_H__ -+ -+#include -+ -+struct rtw_roch_parm; -+ -+#if (defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE)) || defined(CONFIG_IOCTL_CFG80211) -+struct roch_info { -+#ifdef CONFIG_CONCURRENT_MODE -+ _timer ap_roch_ch_switch_timer; /* Used to switch the channel between legacy AP and listen state. */ -+#ifdef CONFIG_IOCTL_CFG80211 -+ u32 min_home_dur; /* min duration for traffic, home_time */ -+ u32 max_away_dur; /* max acceptable away duration, home_away_time */ -+#endif -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ _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; -+ systime last_ro_ch_time; /* this will be updated at the beginning and end of ro_ch */ -+#endif -+}; -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+u8 rtw_roch_stay_in_cur_chan(_adapter *padapter); -+#endif -+ -+#if (defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE)) || defined(CONFIG_IOCTL_CFG80211) -+s32 rtw_roch_wk_hdl(_adapter *padapter, int intCmdType, u8 *buf); -+u8 rtw_roch_wk_cmd(_adapter *padapter, int intCmdType, struct rtw_roch_parm *roch_parm, u8 flags); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+void rtw_concurrent_handler(_adapter *padapter); -+#endif -+ -+void rtw_init_roch_info(_adapter *padapter); -+#endif /* (defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE)) || defined(CONFIG_IOCTL_CFG80211) */ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_rson.h b/drivers/net/wireless/rtl8821cs/include/rtw_rson.h -new file mode 100644 -index 000000000..6996738b0 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_rson.h -@@ -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 __RTW_RSON_H_ -+#define __RTW_RSON_H_ -+ -+ -+#define RTW_RSON_VER 1 -+ -+#define RTW_RSON_SCORE_NOTSUP 0x0 -+#define RTW_RSON_SCORE_NOTCNNT 0x1 -+#define RTW_RSON_SCORE_MAX 0xFF -+#define RTW_RSON_HC_NOTREADY 0xFF -+#define RTW_RSON_HC_ROOT 0x0 -+#define RTW_RSON_ALLOWCONNECT 0x1 -+#define RTW_RSON_DENYCONNECT 0x0 -+ -+ -+ -+/* for rtw self-origanization spec 1 */ -+struct rtw_rson_struct { -+ u8 ver; -+ u32 id; -+ u8 hopcnt; -+ u8 connectible; -+ u8 loading; -+ u8 res[16]; -+} __attribute__((__packed__)); -+ -+void init_rtw_rson_data(struct dvobj_priv *dvobj); -+void rtw_rson_get_property_str(_adapter *padapter, char *rson_data_str); -+int rtw_rson_set_property(_adapter *padapter, char *field, char *value); -+int rtw_rson_choose(struct wlan_network **candidate, struct wlan_network *competitor); -+int rtw_get_rson_struct(WLAN_BSSID_EX *bssid, struct rtw_rson_struct *rson_data); -+u8 rtw_cal_rson_score(struct rtw_rson_struct *cand_rson_data, NDIS_802_11_RSSI Rssi); -+void rtw_rson_handle_ie(WLAN_BSSID_EX *bssid, u8 ie_offset); -+u32 rtw_rson_append_ie(_adapter *padapter, unsigned char *pframe, u32 *len); -+void rtw_rson_do_disconnect(_adapter *padapter); -+void rtw_rson_join_done(_adapter *padapter); -+int rtw_rson_isupdate_roamcan(struct mlme_priv *mlme, struct wlan_network **candidate, struct wlan_network *competitor); -+void rtw_rson_show_survey_info(struct seq_file *m, _list *plist, _list *phead); -+u8 rtw_rson_ap_check_sta(_adapter *padapter, u8 *pframe, uint pkt_len, unsigned short ie_offset); -+u8 rtw_rson_scan_wk_cmd(_adapter *padapter, int op); -+void rtw_rson_scan_cmd_hdl(_adapter *padapter, int op); -+#endif /* __RTW_RSON_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_sdio.h b/drivers/net/wireless/rtl8821cs/include/rtw_sdio.h -new file mode 100644 -index 000000000..7490b5481 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_sdio.h -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_security.h b/drivers/net/wireless/rtl8821cs/include/rtw_security.h -new file mode 100644 -index 000000000..8cd18a910 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_security.h -@@ -0,0 +1,424 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+enum security_type { -+ /* TYPE */ -+ _NO_PRIVACY_ = 0x00, -+ _WEP40_ = 0x01, -+ _TKIP_ = 0x02, -+ _TKIP_WTMIC_ = 0x03, -+ _AES_ = 0x04, -+ _WEP104_ = 0x05, -+ _SMS4_ = 0x06, -+ _GCMP_ = 0x07, -+ _SEC_TYPE_MAX_, -+ -+ /* EXT_SECTYPE=1 */ -+ _SEC_TYPE_256_ = 0x10, -+ _CCMP_256_ = (_AES_ | _SEC_TYPE_256_), -+ _GCMP_256_ = (_GCMP_ | _SEC_TYPE_256_), -+ -+#ifdef CONFIG_IEEE80211W -+ /* EXT_SECTYPE=0, MGNT=1, GK=0/1, KEYID=00/01 */ -+ _SEC_TYPE_BIT_ = 0x20, -+ _BIP_CMAC_128_ = (_SEC_TYPE_BIT_), -+ _BIP_GMAC_128_ = (_SEC_TYPE_BIT_ + 1), -+ _BIP_GMAC_256_ = (_SEC_TYPE_BIT_ + 2), -+ /* EXT_SECTYPE=1, MGNT=1, GK=1, KEYID=00/01 */ -+ _BIP_CMAC_256_ = (_SEC_TYPE_BIT_ + 3), -+ _BIP_MAX_, -+#endif -+}; -+ -+/* 802.11W use wrong key */ -+#define IEEE80211W_RIGHT_KEY 0x0 -+#define IEEE80211W_WRONG_KEY 0x1 -+#define IEEE80211W_NO_KEY 0x2 -+ -+#define CCMPH_2_PN(ch) ((ch) & 0x000000000000ffff) \ -+ | (((ch) & 0xffffffff00000000) >> 16) -+ -+#define is_wep_enc(alg) (((alg) == _WEP40_) || ((alg) == _WEP104_)) -+ -+const char *security_type_str(u8 value); -+#ifdef CONFIG_IEEE80211W -+u32 security_type_bip_to_gmcs(enum security_type type); -+#endif -+ -+#define _WPA_IE_ID_ 0xdd -+#define _WPA2_IE_ID_ 0x30 -+ -+#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[32]; -+}; -+ -+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[6]; /* this is only valid for def. key */ -+ u32 dot11DefKeylen[6]; -+ u8 dot11Def_camid[6]; -+ 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[6]; /* 802.1x Group Key, for inx0 and inx1 */ -+ union Keytype dot118021XGrptxmickey[6]; -+ union Keytype dot118021XGrprxmickey[6]; -+ 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 -+ enum security_type dot11wCipher; -+ 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 BIP xmit. */ -+ union pn48 dot11wBIPrxpn; /* PN48 used for BIP 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; -+ unsigned int akmp; /* An authentication and key management protocol */ -+#endif -+ u8 mfp_opt; -+ u8 dot118021x_bmc_cam_id; -+ /*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 owe_ie[MAX_OWE_IE_LEN];/* added in assoc req */ -+ int owe_ie_len; -+ -+ u8 rsnx_ie[MAX_RSNX_IE_LEN]; -+ int rsnx_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; -+ u8 bcheck_grpkey; -+ u8 bgrpkey_handshake; -+ -+ u8 auth_alg; -+ u8 auth_type; -+ u8 extauth_status; -+ /* 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; -+ -+ 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 */ -+ systime last_mic_err_time; -+ u8 btkip_countermeasure; -+ u8 btkip_wait_report; -+ systime 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; -+ -+ u64 gcmp_sw_enc_cnt_bc; -+ u64 gcmp_sw_enc_cnt_mc; -+ u64 gcmp_sw_enc_cnt_uc; -+ u64 gcmp_sw_dec_cnt_bc; -+ u64 gcmp_sw_dec_cnt_mc; -+ u64 gcmp_sw_dec_cnt_uc; -+#endif /* DBG_SW_SEC_CNT */ -+}; -+ -+#ifdef CONFIG_IEEE80211W -+#define SEC_IS_BIP_KEY_INSTALLED(sec) ((sec)->binstallBIPkey) -+#else -+#define SEC_IS_BIP_KEY_INSTALLED(sec) _FALSE -+#endif -+ -+#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 _GCMP_:\ -+ case _GCMP_256_:\ -+ iv_len = 8;\ -+ icv_len = 16;\ -+ break;\ -+ case _CCMP_256_:\ -+ iv_len = 8;\ -+ icv_len = 16;\ -+ 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 */ -+}; -+ -+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); -+ -+u32 rtw_gcmp_encrypt(_adapter *padapter, u8 *pxmitframe); -+u32 rtw_gcmp_decrypt(_adapter *padapter, u8 *precvframe); -+ -+#ifdef CONFIG_RTW_MESH_AEK -+int rtw_aes_siv_encrypt(const u8 *key, size_t key_len, -+ const u8 *pw, size_t pwlen, size_t num_elem, -+ const u8 *addr[], const size_t *len, u8 *out); -+int rtw_aes_siv_decrypt(const u8 *key, size_t key_len, -+ const u8 *iv_crypt, size_t iv_c_len, size_t num_elem, -+ const u8 *addr[], const size_t *len, u8 *out); -+#endif /* CONFIG_RTW_MESH_AEK */ -+ -+#ifdef CONFIG_IEEE80211W -+u8 rtw_calculate_bip_mic(enum security_type gmcs, u8 *whdr_pos, s32 len, -+ const u8 *key, const u8 *data, size_t data_len, u8 *mic); -+u32 rtw_bip_verify(enum security_type gmcs, u16 pkt_len, -+ u8 *whdr_pos, sint flen, const u8 *key, u16 keyid, u64 *ipn); -+#endif -+#ifdef CONFIG_TDLS -+void wpa_tdls_generate_tpk(_adapter *padapter, void *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_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*/ -+ -+#define rtw_sec_chk_auth_alg(a, s) \ -+ ((a)->securitypriv.auth_alg == (s)) -+ -+#define rtw_sec_chk_auth_type(a, s) \ -+ ((a)->securitypriv.auth_type == (s)) -+ -+#endif /* __RTL871X_SECURITY_H_ */ -+ -+u32 rtw_calc_crc32(u8 *data, size_t len); -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_sreset.h b/drivers/net/wireless/rtl8821cs/include/rtw_sreset.h -new file mode 100644 -index 000000000..1fd999a9d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_sreset.h -@@ -0,0 +1,66 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_SRESET_H_ -+#define _RTW_SRESET_H_ -+ -+/* #include */ -+ -+enum { -+ SRESET_TGP_NULL = 0, -+ SRESET_TGP_XMIT_STATUS = 1, -+ SRESET_TGP_LINK_STATUS = 2, -+ SRESET_TGP_INFO = 99, -+}; -+ -+struct sreset_priv { -+ _mutex silentreset_mutex; -+ u8 silent_reset_inprogress; -+ u8 Wifi_Error_Status; -+ systime last_tx_time; -+ systime last_tx_complete_time; -+ -+ s32 dbg_trigger_point; -+ u64 self_dect_tx_cnt; -+ u64 self_dect_rx_cnt; -+ u64 self_dect_fw_cnt; -+ u64 tx_dma_status_cnt; -+ u64 rx_dma_status_cnt; -+ u8 rx_cnt; -+ u8 self_dect_fw; -+ u8 self_dect_case; -+ u16 last_mac_rxff_ptr; -+ u8 dbg_sreset_ctrl; -+}; -+ -+ -+ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_swcrypto.h b/drivers/net/wireless/rtl8821cs/include/rtw_swcrypto.h -new file mode 100644 -index 000000000..d35ad7d04 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_swcrypto.h -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_SWCRYPTO_H_ -+#define __RTW_SWCRYPTO_H_ -+ -+#define NEW_CRYPTO 1 -+ -+int _rtw_ccmp_encrypt(_adapter *padapter, u8 *key, u32 key_len, uint hdrlen, u8 *frame, uint plen); -+int _rtw_ccmp_decrypt(_adapter *padapter, u8 *key, u32 key_len, uint hdrlen, u8 *frame, uint plen); -+ -+int _rtw_gcmp_encrypt(_adapter *padapter, u8 *key, u32 key_len, uint hdrlen, u8 *frame, uint plen); -+int _rtw_gcmp_decrypt(_adapter *padapter, u8 *key, u32 key_len, uint hdrlen, u8 *frame, uint plen); -+ -+#ifdef CONFIG_RTW_MESH_AEK -+int _aes_siv_encrypt(const u8 *key, size_t key_len, -+ const u8 *pw, size_t pwlen, -+ size_t num_elem, const u8 *addr[], const size_t *len, u8 *out); -+int _aes_siv_decrypt(const u8 *key, size_t key_len, -+ const u8 *iv_crypt, size_t iv_c_len, -+ size_t num_elem, const u8 *addr[], const size_t *len, u8 *out); -+#endif -+ -+#if defined(CONFIG_IEEE80211W) | defined(CONFIG_TDLS) -+u8 _bip_ccmp_protect(const u8 *key, size_t key_len, -+ const u8 *data, size_t data_len, u8 *mic); -+u8 _bip_gcmp_protect(u8 *whdr_pos, size_t len, -+ const u8 *key, size_t key_len, -+ const u8 *data, size_t data_len, u8 *mic); -+#endif /* CONFIG_IEEE80211W */ -+ -+#ifdef CONFIG_TDLS -+void _tdls_generate_tpk(void *sta, const u8 *own_addr, const u8 *bssid); -+#endif /* CONFIG_TDLS */ -+ -+#endif /* __RTW_SWCRYPTO_H_ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_tdls.h b/drivers/net/wireless/rtl8821cs/include/rtw_tdls.h -new file mode 100644 -index 000000000..5c23e4ea4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_tdls.h -@@ -0,0 +1,185 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 -+}; -+ -+#define TDLS_MIC_CTRL_LEN 2 -+#define TDLS_FTIE_DATA_LEN (TDLS_MIC_CTRL_LEN + TDLS_MIC_LEN + \ -+ WPA_NONCE_LEN + WPA_NONCE_LEN) -+struct wpa_tdls_ftie { -+ u8 ie_type; /* FTIE */ -+ u8 ie_len; -+ union { -+ struct { -+ u8 mic_ctrl[TDLS_MIC_CTRL_LEN]; -+ u8 mic[TDLS_MIC_LEN]; -+ u8 Anonce[WPA_NONCE_LEN]; /* Responder Nonce in TDLS */ -+ u8 Snonce[WPA_NONCE_LEN]; /* Initiator Nonce in TDLS */ -+ }; -+ struct { -+ u8 data[TDLS_FTIE_DATA_LEN]; -+ }; -+ }; -+ /* 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_set_tdls_enable(_adapter *padapter, u8 enable); -+u8 rtw_is_tdls_enabled(_adapter *padapter); -+u8 rtw_is_tdls_sta_existed(_adapter *padapter); -+u8 rtw_tdls_is_setup_allowed(_adapter *padapter); -+#ifdef CONFIG_TDLS_CH_SW -+u8 rtw_tdls_is_chsw_allowed(_adapter *padapter); -+#endif -+ -+void rtw_tdls_set_link_established(_adapter *adapter, bool en); -+void rtw_reset_tdls_info(_adapter *padapter); -+int rtw_init_tdls_info(_adapter *padapter); -+void rtw_free_tdls_info(struct tdls_info *ptdlsinfo); -+void rtw_free_all_tdls_sta(_adapter *padapter, u8 enqueue_cmd); -+void rtw_enable_tdls_func(_adapter *padapter); -+void rtw_disable_tdls_func(_adapter *padapter, u8 enqueue_cmd); -+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_cancel_tdls_timer(struct sta_info *psta); -+void rtw_tdls_teardown_pre_hdl(_adapter *padapter, struct sta_info *psta); -+void rtw_tdls_teardown_post_hdl(_adapter *padapter, struct sta_info *psta, u8 enqueue_cmd); -+ -+#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, struct sta_info *ptdls_sta); -+int On_TDLS_Setup_Rsp(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); -+int On_TDLS_Setup_Cfm(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); -+int On_TDLS_Dis_Req(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Teardown(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); -+int On_TDLS_Peer_Traffic_Indication(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); -+int On_TDLS_Peer_Traffic_Rsp(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); -+#ifdef CONFIG_TDLS_CH_SW -+sint On_TDLS_Ch_Switch_Req(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); -+sint On_TDLS_Ch_Switch_Rsp(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); -+void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); -+void rtw_build_tdls_ch_switch_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); -+#endif -+void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); -+void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); -+void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); -+void rtw_build_tdls_teardown_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); -+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, struct sta_info *ptdls_sta); -+void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); -+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 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 --git a/drivers/net/wireless/rtl8821cs/include/rtw_version.h b/drivers/net/wireless/rtl8821cs/include/rtw_version.h -new file mode 100644 -index 000000000..3504d031c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_version.h -@@ -0,0 +1,2 @@ -+#define DRIVERVERSION "v5.14.2-28-g6011b0372.20220328" -+#define BTCOEXVERSION "COEX20210319-5555" -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_vht.h b/drivers/net/wireless/rtl8821cs/include/rtw_vht.h -new file mode 100755 -index 000000000..838ebd8f9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_vht.h -@@ -0,0 +1,224 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 VHT_CAP_IE_LEN 12 -+#define VHT_OP_IE_LEN 5 -+ -+#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 BIT(0) /*Declare sta support beamformer*/ -+#define BEAMFORMING_VHT_BEAMFORMEE_ENABLE BIT(1) /*Declare sta support beamformee*/ -+#define BEAMFORMING_VHT_MU_MIMO_AP_ENABLE BIT(2) /*Declare sta support MU beamformer*/ -+#define BEAMFORMING_VHT_MU_MIMO_STA_ENABLE BIT(3) /*Declare sta support MU beamformer*/ -+#define BEAMFORMING_VHT_BEAMFORMER_TEST BIT(4) /*Transmiting Beamforming no matter the target supports it or not*/ -+#define BEAMFORMING_VHT_BEAMFORMER_STS_CAP (BIT(8)|BIT(9)|BIT(10)) /*Sta BFee's capability*/ -+#define BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM (BIT(12)|BIT(13)|BIT(14)) /*Sta Bfer's capability*/ -+ -+/* 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_SU_BFEE_STS_CAP(_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) /* B16~B18 */ -+ -+#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)+3, 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_RX_ANT_PATTERN(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+3, 4, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_TX_ANT_PATTERN(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+3, 5, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_EXT_NSS_BW(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+3, 6, 2, _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_1BYTE((_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_HTC_VHT(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 6, 1) -+#define GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+2, 7, 3) -+#define GET_VHT_CAPABILITY_ELE_LINK_ADAPTION(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+3, 2, 2) -+#define GET_VHT_CAPABILITY_ELE_RX_ANT_PATTERN(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+3, 4, 1) -+#define GET_VHT_CAPABILITY_ELE_TX_ANT_PATTERN(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+3, 5, 1) -+#define GET_VHT_CAPABILITY_ELE_EXT_NSS_BW(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+3, 6, 2) -+#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) -+#define GET_VHT_OPERATION_ELE_BASIC_MCS_SET(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+3, 0, 16) -+ -+/* 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) -+ -+#define VHT_MAX_MPDU_LEN_MAX 3 -+extern const u16 _vht_max_mpdu_len[]; -+#define vht_max_mpdu_len(val) (((val) >= VHT_MAX_MPDU_LEN_MAX) ? _vht_max_mpdu_len[VHT_MAX_MPDU_LEN_MAX] : _vht_max_mpdu_len[(val)]) -+ -+#define VHT_SUP_CH_WIDTH_SET_MAX 3 -+extern const u8 _vht_sup_ch_width_set_to_bw_cap[]; -+#define vht_sup_ch_width_set_to_bw_cap(set) (((set) >= VHT_SUP_CH_WIDTH_SET_MAX) ? _vht_sup_ch_width_set_to_bw_cap[VHT_SUP_CH_WIDTH_SET_MAX] : _vht_sup_ch_width_set_to_bw_cap[(set)]) -+#define VHT_MAX_AMPDU_LEN(f) ((1 << (13 + f)) - 1) -+ -+#ifdef CONFIG_RTW_DEBUG -+extern const char *const _vht_sup_ch_width_set_str[]; -+#define vht_sup_ch_width_set_str(set) (((set) >= VHT_SUP_CH_WIDTH_SET_MAX) ? _vht_sup_ch_width_set_str[VHT_SUP_CH_WIDTH_SET_MAX] : _vht_sup_ch_width_set_str[(set)]) -+ -+void dump_vht_cap_ie(void *sel, const u8 *ie, u32 ie_len); -+ -+#define VHT_OP_CH_WIDTH_MAX 4 -+extern const char *const _vht_op_ch_width_str[]; -+#define vht_op_ch_width_str(ch_width) (((ch_width) >= VHT_OP_CH_WIDTH_MAX) ? _vht_op_ch_width_str[VHT_OP_CH_WIDTH_MAX] : _vht_op_ch_width_str[(ch_width)]) -+ -+void dump_vht_op_ie(void *sel, const u8 *ie, u32 ie_len); -+#endif -+ -+struct vht_bf_cap { -+ u8 is_mu_bfer; -+ u8 su_sound_dim; -+}; -+ -+struct vht_priv { -+ /* VHT IE is configured by upper layer or not (hostapd or wpa_supplicant) */ -+ u8 upper_layer_setting; -+ -+ u8 vht_option; -+ -+ u8 ldpc_cap; -+ u8 stbc_cap; -+ u8 rx_stbc_nss; /* Support nss spatial stream */ -+ u16 beamform_cap; -+ u8 ap_is_mu_bfer; -+ struct vht_bf_cap ap_bf_cap; -+ u8 sgi_80m; -+ u8 sgi_160m; -+ -+ u8 ampdu_len; /* A-MPDU length exponent : 0 to 7 */ -+ -+ u8 vht_highest_rate; -+ u8 vht_mcs_map[2]; -+ -+ u8 txop_ps; /* TXOP power save mode*/ -+ u8 htc_vht; /* VHT variant HT Control*/ -+ u8 link_adap_cap; /* VHT Link Adaptation Capable */ -+ u8 tx_ant_pattern; /* Tx Antenna Pattern Consistency */ -+ u8 rx_ant_pattern; /* Rx Antenna Pattern Consistency */ -+ u8 ext_nss_bw; /* Extended NSS BW Support */ -+ -+ u8 op_present:1; /* vht_op is present */ -+ u8 notify_present:1; /* vht_op_mode_notify is present */ -+ -+ u8 vht_cap[32]; -+ u8 vht_op[VHT_OP_IE_LEN]; -+ u8 vht_op_mode_notify; -+ -+ /* Backup these two VHT IEs from hostapd/wpa_supplicant for restore usage */ -+ u8 vht_cap_ie_backup[VHT_CAP_IE_LEN]; -+ u8 vht_op_ie_backup[VHT_OP_IE_LEN]; -+}; -+ -+#ifdef ROKU_PRIVATE -+struct vht_priv_infra_ap { -+ -+ /* Infra mode, only store for AP's info, not intersection of STA and AP*/ -+ u8 ldpc_cap_infra_ap; -+ u8 stbc_cap_infra_ap; -+ u16 beamform_cap_infra_ap; -+ u8 vht_mcs_map_infra_ap[2]; -+ u8 vht_mcs_map_tx_infra_ap[2]; -+ u8 channel_width_infra_ap; -+ u8 number_of_streams_infra_ap; -+}; -+#endif /* ROKU_PRIVATE */ -+ -+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_mcs_map_to_bitmap(u8 *mcs_map, u8 nss); -+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, void *psta); -+void update_hw_vht_param(_adapter *padapter); -+void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+#ifdef ROKU_PRIVATE -+void VHT_caps_handler_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+#endif /* ROKU_PRIVATE */ -+void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, void *sta); -+u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len, struct country_chplan *req_chplan); -+void VHTOnAssocRsp(_adapter *padapter); -+u8 rtw_vht_mcsmap_to_nss(u8 *pvht_mcs_map); -+void rtw_vht_nss_to_mcsmap(u8 nss, u8 *target_mcs_map, u8 *cur_mcs_map); -+void rtw_vht_ies_attach(_adapter *padapter, WLAN_BSSID_EX *pcur_network); -+void rtw_vht_ies_detach(_adapter *padapter, WLAN_BSSID_EX *pcur_network); -+void rtw_check_for_vht20(_adapter *adapter, u8 *ies, int ies_len); -+#ifdef CONFIG_AP_MODE -+void rtw_update_drv_vht_cap(_adapter *padapter, u8 *vht_cap_ie); -+void rtw_set_vht_ext_cap(_adapter *padapter, WLAN_BSSID_EX *pnetwork); -+void rtw_check_vht_ies(_adapter *padapter, WLAN_BSSID_EX *pnetwork); -+void rtw_reattach_vht_ies(_adapter *padapter, WLAN_BSSID_EX *pnetwork); -+#endif -+#endif /* _RTW_VHT_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_wapi.h b/drivers/net/wireless/rtl8821cs/include/rtw_wapi.h -new file mode 100644 -index 000000000..fb109f837 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_wapi.h -@@ -0,0 +1,230 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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_wapi_buf(u8 *buf, u32 len) -+{ -+ u32 i; -+ printk("-----------------Len %d----------------\n", len); -+ for (i = 0; i < len; i++) -+ printk(KERN_CONT "%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_wapi_buf((buf), (len)); } \ -+ } while (0); -+ -+#define RT_WAPI_ASSERT_RET(_Exp) \ -+ if (!(_Exp)) { \ -+ printk("RTWLAN: "); \ -+ printk("Assertion failed! %s,%s, line=%d\n", \ -+ #_Exp, __FUNCTION__, __LINE__); \ -+ return; \ -+ } -+#define RT_WAPI_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_WAPI_ASSERT_RET(_Exp) do {} while (0) -+#define RT_WAPI_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, u8 *ehdr_ops); -+ -+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); -+ -+void rtw_wapi_set_set_encryption(_adapter *padapter, struct ieee_param *param); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_wnm.h b/drivers/net/wireless/rtl8821cs/include/rtw_wnm.h -new file mode 100755 -index 000000000..8d6bcb56a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_wnm.h -@@ -0,0 +1,209 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_WNM_H_ -+#define __RTW_WNM_H_ -+ -+#define RTW_RRM_NB_RPT_EN BIT(1) -+#define RTW_MAX_NB_RPT_NUM 8 -+ -+#define RTW_WNM_FEATURE_BTM_REQ_EN BIT(0) -+ -+#define rtw_roam_busy_scan(a, nb) \ -+ (((a)->mlmepriv.LinkDetectInfo.bBusyTraffic == _TRUE) && \ -+ (((a)->mlmepriv.ch_cnt) < ((nb)->nb_rpt_ch_list_num))) -+ -+#define rtw_wnm_btm_preference_cap(a) \ -+ ((a)->mlmepriv.nb_info.preference_en == _TRUE) -+ -+#define rtw_wnm_btm_roam_triggered(a) \ -+ (((a)->mlmepriv.nb_info.preference_en == _TRUE) \ -+ && (rtw_ft_chk_flags((a), RTW_FT_BTM_ROAM)) \ -+ ) -+ -+#define rtw_wnm_btm_diff_bss(a) \ -+ ((rtw_wnm_btm_preference_cap(a)) && \ -+ (is_zero_mac_addr((a)->mlmepriv.nb_info.roam_target_addr) == _FALSE) && \ -+ (_rtw_memcmp((a)->mlmepriv.nb_info.roam_target_addr,\ -+ (a)->mlmepriv.cur_network.network.MacAddress, ETH_ALEN) == _FALSE)) -+ -+#define rtw_wnm_btm_roam_candidate(a, c) \ -+ ((rtw_wnm_btm_preference_cap(a)) && \ -+ (is_zero_mac_addr((a)->mlmepriv.nb_info.roam_target_addr) == _FALSE) && \ -+ (_rtw_memcmp((a)->mlmepriv.nb_info.roam_target_addr,\ -+ (c)->network.MacAddress, ETH_ALEN))) -+ -+#define rtw_wnm_set_ext_cap_btm(_pEleStart, _val) \ -+ SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart))+2, 3, 1, _val) -+ -+#define wnm_btm_bss_term_inc(p) (*((u8 *)((p)+3)) & BSS_TERMINATION_INCLUDED) -+ -+#define wnm_btm_ess_disassoc_im(p) (*((u8 *)((p)+3)) & ESS_DISASSOC_IMMINENT) -+ -+#define wnm_btm_dialog_token(p) (*((u8 *)((p)+2))) -+ -+#define wnm_btm_req_mode(p) (*((u8 *)((p)+3))) -+ -+#define wnm_btm_disassoc_timer(p) (*((u16 *)((p)+4))) -+ -+#define wnm_btm_valid_interval(p) (*((u8 *)((p)+6))) -+ -+#define wnm_btm_term_duration_offset(p) ((p)+7) -+ -+#define wnm_btm_rsp_status(p) (*((u8 *)((p)+3))) -+ -+#define wnm_btm_rsp_term_delay(p) (*((u8 *)((p)+4))) -+ -+#define RTW_WLAN_ACTION_WNM_NB_RPT_ELEM 0x34 -+ -+enum rtw_ieee80211_wnm_actioncode { -+ RTW_WLAN_ACTION_WNM_BTM_QUERY = 6, -+ RTW_WLAN_ACTION_WNM_BTM_REQ = 7, -+ RTW_WLAN_ACTION_WNM_BTM_RSP = 8, -+ RTW_WLAN_ACTION_WNM_NOTIF_REQ = 26, -+ RTW_WLAN_ACTION_WNM_NOTIF_RSP = 27, -+}; -+ -+/*IEEE Std 80211k Figure 7-95b Neighbor Report element format*/ -+struct nb_rpt_hdr { -+ u8 id; /*0x34: Neighbor Report Element ID*/ -+ u8 len; -+ u8 bssid[ETH_ALEN]; -+ u32 bss_info; -+ u8 reg_class; -+ u8 ch_num; -+ u8 phy_type; -+}; -+ -+/*IEEE Std 80211v, Figure 7-9 BSS Termination Duration subelement field format */ -+struct btm_term_duration { -+ u8 id; -+ u8 len; -+ u64 tsf; /* value of the TSF counter when BSS termination will occur in the future */ -+ u16 duration; /* number of minutes for which the BSS is not present*/ -+}; -+ -+/*IEEE Std 80211v, Figure 7-10 BSS Transition Management Request frame body format */ -+struct btm_req_hdr { -+ u8 dialog_token; -+ u8 req_mode; -+ /* number of TBTTs until the AP sends a Disassociation frame to this STA */ -+ u16 disassoc_timer; -+ /* number of TBTTs until the BSS transition candidate list is no longer valid */ -+ u8 validity_interval; -+ struct btm_term_duration term_duration; -+}; -+ -+struct btm_rsp_hdr { -+ u8 dialog_token; -+ u8 status; -+ /* the number of minutes that -+ the responding STA requests the BSS to delay termination */ -+ u8 termination_delay; -+ u8 bssid[ETH_ALEN]; -+ u8 *pcandidates; -+ u32 candidates_num; -+}; -+ -+struct btm_rpt_cache { -+ u8 dialog_token; -+ u8 req_mode; -+ u16 disassoc_timer; -+ u8 validity_interval; -+ struct btm_term_duration term_duration; -+ -+ /* from BTM req */ -+ u32 validity_time; -+ u32 disassoc_time; -+ -+ systime req_stime; -+}; -+ -+/*IEEE Std 80211v, Table 7-43b Optional Subelement IDs for Neighbor Report*/ -+/* BSS Transition Candidate Preference */ -+#define WNM_BTM_CAND_PREF_SUBEID 0x03 -+ -+/* BSS Termination Duration */ -+#define WNM_BTM_TERM_DUR_SUBEID 0x04 -+ -+struct wnm_btm_cant { -+ struct nb_rpt_hdr nb_rpt; -+ u8 preference; /* BSS Transition Candidate Preference */ -+}; -+ -+enum rtw_btm_req_mod { -+ PREFERRED_CANDIDATE_LIST_INCLUDED = BIT0, -+ ABRIDGED = BIT1, -+ DISASSOC_IMMINENT = BIT2, -+ BSS_TERMINATION_INCLUDED = BIT3, -+ ESS_DISASSOC_IMMINENT = BIT4, -+}; -+ -+struct roam_nb_info { -+ struct nb_rpt_hdr nb_rpt[RTW_MAX_NB_RPT_NUM]; -+ struct rtw_ieee80211_channel nb_rpt_ch_list[RTW_MAX_NB_RPT_NUM]; -+ struct btm_rpt_cache btm_cache; -+ bool nb_rpt_valid; -+ u8 nb_rpt_ch_list_num; -+ u8 preference_en; -+ u8 roam_target_addr[ETH_ALEN]; -+ u32 last_nb_rpt_entries; -+ u8 nb_rpt_is_same; -+ s8 disassoc_waiting; -+ _timer roam_scan_timer; -+ _timer disassoc_chk_timer; -+ -+ u32 features; -+}; -+ -+u8 rtw_wnm_btm_reassoc_req(_adapter *padapter); -+ -+void rtw_wnm_roam_scan_hdl(void *ctx); -+ -+void rtw_wnm_disassoc_chk_hdl(void *ctx); -+ -+u8 rtw_wnm_try_btm_roam_imnt(_adapter *padapter); -+ -+void rtw_wnm_process_btm_req(_adapter *padapter, u8* pframe, u32 frame_len); -+ -+void rtw_wnm_reset_btm_candidate(struct roam_nb_info *pnb); -+ -+void rtw_wnm_reset_btm_state(_adapter *padapter); -+ -+u32 rtw_wnm_btm_rsp_candidates_sz_get( -+ _adapter *padapter, u8* pframe, u32 frame_len); -+ -+void rtw_wnm_process_btm_rsp(_adapter *padapter, -+ u8* pframe, u32 frame_len, struct btm_rsp_hdr *prsp); -+ -+void rtw_wnm_issue_btm_req(_adapter *padapter, -+ u8 *pmac, struct btm_req_hdr *phdr, u8 *purl, u32 url_len, -+ u8 *pcandidates, u8 candidate_cnt); -+ -+void rtw_wnm_reset_btm_cache(_adapter *padapter); -+ -+void rtw_wnm_issue_action(_adapter *padapter, u8 action, u8 reason, u8 dialog); -+ -+void rtw_wnm_update_reassoc_req_ie(_adapter *padapter); -+ -+void rtw_roam_nb_info_init(_adapter *padapter); -+ -+u8 rtw_roam_nb_scan_list_set(_adapter *padapter, -+ struct sitesurvey_parm *pparm); -+ -+u32 rtw_wnm_btm_candidates_survey(_adapter *padapter, -+ u8* pframe, u32 elem_len, u8 is_preference); -+#endif /* __RTW_WNM_H_ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/include/rtw_xmit.h b/drivers/net/wireless/rtl8821cs/include/rtw_xmit.h -new file mode 100644 -index 000000000..9ac1a429c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/rtw_xmit.h -@@ -0,0 +1,1083 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ #ifdef CONFIG_TX_AGGREGATION -+ #ifdef CONFIG_RTL8822C -+ #ifdef CONFIG_SDIO_TX_FORMAT_DUMMY_AUTO -+ #define MAX_XMITBUF_SZ (51200) -+ #else -+ #define MAX_XMITBUF_SZ (32764) -+ #endif -+ #else -+ #define MAX_XMITBUF_SZ (20480) /* 20k */ -+ #endif -+ /* #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) -+ #define SDIO_TX_DIV_NUM (2) -+ #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) -+#ifdef CONFIG_TX_AMSDU -+ #define MAX_XMITBUF_SZ (3500) -+#else -+ #define MAX_XMITBUF_SZ (1664) -+#endif -+#ifdef CONFIG_PCI_TX_POLLING -+ #define NR_XMITBUFF (256) -+#else -+ #define NR_XMITBUFF (128) -+#endif -+#endif -+ -+ -+#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 -+ -+ -+/* xmit extension buff defination */ -+#define MAX_XMIT_EXTBUF_SZ (1536) -+ -+#ifdef CONFIG_SINGLE_XMIT_BUF -+ #define NR_XMIT_EXTBUFF (1) -+#elif defined(CONFIG_RTW_MGMT_QUEUE) -+ #define NR_XMIT_EXTBUFF (64) -+#else -+ #define NR_XMIT_EXTBUFF (32) -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ #define MAX_CMDBUF_SZ (512 * 18) -+#elif defined(CONFIG_RTL8723D) && defined(CONFIG_LPS_POFF) -+ #define MAX_CMDBUF_SZ (128*70) /*(8960)*/ -+#elif defined(CONFIG_RTL8822C) && defined(CONFIG_WAR_OFFLOAD) -+ #define MAX_CMDBUF_SZ (128*128) /*(16k) */ -+#else -+ #define MAX_CMDBUF_SZ (5120) /* (4096) */ -+#endif -+ -+#define MAX_BEACON_LEN 512 -+ -+#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 TXCMD_QUEUE_INX 6 -+#define HIGH_QUEUE_INX 7 -+/* keep high queue to be the last one, so we can extend HIQ to port 1, 2, ... */ -+ -+#ifndef CONFIG_PORT_BASED_HIQ -+#define HW_QUEUE_ENTRY 8 -+#else -+#define HI_QUEUE_INX(n) (HIGH_QUEUE_INX + (n)) -+#define HW_QUEUE_ENTRY (8 + CONFIG_IFACE_NUMBER - 1) -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ #ifdef CONFIG_TRX_BD_ARCH -+ #define TX_BD_NUM (128+1) /* +1 result from ring buffer */ -+ #else -+ #define TXDESC_NUM 128 -+ #endif -+#endif -+ -+#define WEP_IV(pattrib_iv, dot11txpn, keyidx)\ -+ do {\ -+ dot11txpn.val = (dot11txpn.val == 0xffffff) ? 0 : (dot11txpn.val + 1);\ -+ pattrib_iv[0] = dot11txpn._byte_.TSC0;\ -+ pattrib_iv[1] = dot11txpn._byte_.TSC1;\ -+ pattrib_iv[2] = dot11txpn._byte_.TSC2;\ -+ pattrib_iv[3] = ((keyidx & 0x3)<<6);\ -+ } while (0) -+ -+ -+#define TKIP_IV(pattrib_iv, dot11txpn, keyidx)\ -+ do {\ -+ dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val + 1);\ -+ 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;\ -+ } while (0) -+ -+#define AES_IV(pattrib_iv, dot11txpn, keyidx)\ -+ do {\ -+ dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val + 1);\ -+ 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;\ -+ } while (0) -+ -+#define GCMP_IV(a, b, c) AES_IV(a, b, c) -+ -+/* Check if AMPDU Tx is supported or not. If it is supported, -+* it need to check "amsdu in ampdu" is supported or not. -+* (ampdu_en, amsdu_ampdu_en) = -+* (0, x) : AMPDU is not enable, but AMSDU is valid to send. -+* (1, 0) : AMPDU is enable, AMSDU in AMPDU is not enable. So, AMSDU is not valid to send. -+* (1, 1) : AMPDU and AMSDU in AMPDU are enable. So, AMSDU is valid to send. -+*/ -+#define IS_AMSDU_AMPDU_NOT_VALID(pattrib)\ -+ ((pattrib->ampdu_en == _TRUE) && (pattrib->amsdu_ampdu_en == _FALSE)) -+ -+#define IS_AMSDU_AMPDU_VALID(pattrib)\ -+ !((pattrib->ampdu_en == _TRUE) && (pattrib->amsdu_ampdu_en == _FALSE)) -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+#define HWXMIT_ENTRY 5 -+#else -+#define HWXMIT_ENTRY 4 -+#endif -+ -+enum DEQUEUE_TYPE { -+ UNI_BMC_DATA, -+ UNI_MGMT, -+ ALL_FRAME -+}; -+ -+/* 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_RTL8188GTV) || defined(CONFIG_RTL8723D) ||\ -+ defined(CONFIG_RTL8710B) || defined(CONFIG_RTL8192F) ||\ -+ defined(CONFIG_RTL8723F) -+ #define TXDESC_SIZE 40 -+#elif defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C) -+ #define TXDESC_SIZE 48 /* HALMAC_TX_DESC_SIZE_8822B */ -+#elif defined(CONFIG_RTL8821C) -+ #define TXDESC_SIZE 48 /* HALMAC_TX_DESC_SIZE_8821C */ -+#elif defined(CONFIG_RTL8814B) -+ #define TXDESC_SIZE (16 + 32) -+#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_RTL8822C) || 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_RTL8188GTV) || defined(CONFIG_RTL8723D) \ -+ || defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8723F) -+ #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_RTL8822C)) && 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 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 -+}; -+ -+#ifdef DBG_TXBD_DESC_DUMP -+ -+#define TX_BAK_FRMAE_CNT 10 -+#define TX_BAK_DESC_LEN 48 /* byte */ -+#define TX_BAK_DATA_LEN 30 /* byte */ -+ -+struct rtw_tx_desc_backup { -+ int tx_bak_rp; -+ int tx_bak_wp; -+ u8 tx_bak_desc[TX_BAK_DESC_LEN]; -+ u8 tx_bak_data_hdr[TX_BAK_DATA_LEN]; -+ u8 tx_desc_size; -+}; -+#endif -+#endif -+ -+struct hw_xmit { -+ /* _lock xmit_lock; */ -+ /* _list pending; */ -+ _queue *sta_queue; -+ /* struct hw_txqueue *phwtxqueue; */ -+ /* sint txcmdcnt; */ -+ int accnt; -+}; -+ -+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 */ -+ u8 bmc_camid; -+ 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]; -+#ifdef CONFIG_RTW_WDS -+ u8 wds; -+#endif -+#ifdef CONFIG_RTW_MESH -+ u8 mda[ETH_ALEN]; /* mesh da */ -+ u8 msa[ETH_ALEN]; /* mesh sa */ -+ u8 meshctrl_len; /* Length of Mesh Control field */ -+ u8 mesh_frame_mode; -+ #if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ u8 mb2u; -+ #endif -+ u8 mfwd_ttl; -+ u32 mseq; -+#endif -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ u8 hw_csum; -+#endif -+ 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 amsdu; -+ u8 amsdu_ampdu_en;/* tx amsdu in ampdu enable */ -+ 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; -+#ifdef CONFIG_WMMPS_STA -+ u8 trigger_frame; -+#endif /* CONFIG_WMMPS_STA */ -+ -+ struct sta_info *psta; -+ -+ 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; -+ u8 hipriority_pkt; /* high priority packet */ -+ -+#ifdef CONFIG_BEAMFORMING -+ u16 txbf_p_aid;/*beamforming Partial_AID*/ -+ u16 txbf_g_id;/*beamforming Group ID*/ -+ -+ /* -+ * 2'b00: Unicast NDPA -+ * 2'b01: Broadcast NDPA -+ * 2'b10: Beamforming Report Poll -+ * 2'b11: Final Beamforming Report Poll -+ */ -+ u8 bf_pkt_type; -+#endif -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ u8 ps_dontq; /* 1: this frame can't be queued at PS state */ -+#endif -+}; -+ -+#ifdef CONFIG_RTW_WDS -+#define XATTRIB_GET_WDS(xattrib) ((xattrib)->wds) -+#else -+#define XATTRIB_GET_WDS(xattrib) 0 -+#endif -+ -+#ifdef CONFIG_RTW_MESH -+#define XATTRIB_GET_MCTRL_LEN(xattrib) ((xattrib)->meshctrl_len) -+#else -+#define XATTRIB_GET_MCTRL_LEN(xattrib) 0 -+#endif -+ -+#ifdef CONFIG_TX_AMSDU -+enum { -+ RTW_AMSDU_TIMER_UNSET = 0, -+ RTW_AMSDU_TIMER_SETTING, -+ RTW_AMSDU_TIMER_TIMEOUT, -+}; -+#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 { -+ systime 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 */ -+ -+ PURB pxmit_urb[8]; -+ dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ -+ -+ 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; -+#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; -+ -+ u16 os_qid; -+ _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 */ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ struct tx_servq mgmt_q; -+#endif -+ -+ _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; -+ -+ /* _queue blk_strms[MAX_NUMBLKS]; */ -+ _queue be_pending; -+ _queue bk_pending; -+ _queue vi_pending; -+ _queue vo_pending; -+ _queue mgmt_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; -+ -+ _tasklet xmit_tasklet; -+ -+ /* 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 */ -+ _tasklet xmit_tasklet; -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifdef CONFIG_SDIO_TX_TASKLET -+ _tasklet xmit_tasklet; -+#else -+ _thread_hdl_ SdioXmitThread; -+ _sema SdioXmitSema; -+ #ifdef SDIO_FREE_XMIT_BUF_SEMA -+ _sema sdio_free_xmitbuf_sema; -+ #endif -+#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; -+#ifdef CONFIG_REMOVE_DUP_TX_STATE -+ u8 retry_count; -+#endif -+#endif -+ -+#ifdef CONFIG_TX_AMSDU -+ _timer amsdu_vo_timer; -+ u8 amsdu_vo_timeout; -+ -+ _timer amsdu_vi_timer; -+ u8 amsdu_vi_timeout; -+ -+ _timer amsdu_be_timer; -+ u8 amsdu_be_timeout; -+ -+ _timer amsdu_bk_timer; -+ u8 amsdu_bk_timeout; -+ -+ u32 amsdu_debug_set_timer; -+ u32 amsdu_debug_timeout; -+ u32 amsdu_debug_coalesce_one; -+ u32 amsdu_debug_coalesce_two; -+ -+#endif -+#ifdef DBG_TXBD_DESC_DUMP -+ BOOLEAN dump_txbd_desc; -+#endif -+#ifdef CONFIG_PCI_TX_POLLING -+ _timer tx_poll_timer; -+#endif -+#ifdef CONFIG_LAYER2_ROAMING -+ _queue rpkt_queue; -+#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) -+#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_RTL8822C) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8822ce(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8822ce(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) -+#elif defined(CONFIG_RTL8192F) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8192fe(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8192fe(p, CMDBUF_BEACON) -+#elif defined(CONFIG_RTL8812A) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8812ae(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8812ae(p, CMDBUF_BEACON) -+#elif defined(CONFIG_RTL8723D) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8723de(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8723de(p, CMDBUF_BEACON) -+#elif defined(CONFIG_RTL8723B) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8723be(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8723be(p, CMDBUF_BEACON) -+#elif defined(CONFIG_RTL8814A) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8814ae(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8814ae(p, CMDBUF_BEACON) -+#elif defined(CONFIG_RTL8814B) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8814be(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8814be(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); -+ -+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, u16 os_qid); -+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); -+ -+#ifdef CONFIG_RTW_MGMT_QUEUE -+void rtw_free_mgmt_xmitframe_queue(struct xmit_priv *pxmitpriv, _queue *mgmt_queue); -+u8 rtw_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+struct xmit_frame *rtw_dequeue_mgmt_xframe(struct xmit_priv *pxmitpriv); -+#endif /* CONFIG_RTW_MGMT_QUEUE */ -+ -+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); -+#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) -+extern s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); -+#endif -+#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 -+void rtw_xmit_dequeue_callback(_workitem *work); -+void rtw_xmit_queue_set(struct sta_info *sta); -+void rtw_xmit_queue_clear(struct sta_info *sta); -+s32 rtw_xmit_posthandle(_adapter *padapter, struct xmit_frame *pxmitframe, _pkt *pkt); -+s32 rtw_xmit(_adapter *padapter, _pkt **pkt, u16 os_qid); -+bool xmitframe_hiq_filter(struct xmit_frame *xmitframe); -+#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) -+#ifdef CONFIG_RTW_MGMT_QUEUE -+u8 mgmt_xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+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, u8 dequeue_type); -+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_update_tx_rate_bmp(struct dvobj_priv *dvobj); -+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); -+s16 rtw_adapter_get_oper_txpwr_max_mbm(_adapter *adapter, bool eirp); -+s16 rtw_rfctl_get_oper_txpwr_max_mbm(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, u8 ifbmp_mod, u8 if_op, bool eirp); -+s16 rtw_get_oper_txpwr_max_mbm(struct dvobj_priv *dvobj, bool erip); -+s16 rtw_rfctl_get_reg_max_txpwr_mbm(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, bool eirp); -+ -+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 -+ -+#ifdef CONFIG_TX_AMSDU -+extern void rtw_amsdu_vo_timeout_handler(void *FunctionContext); -+extern void rtw_amsdu_vi_timeout_handler(void *FunctionContext); -+extern void rtw_amsdu_be_timeout_handler(void *FunctionContext); -+extern void rtw_amsdu_bk_timeout_handler(void *FunctionContext); -+ -+extern u8 rtw_amsdu_get_timer_status(_adapter *padapter, u8 priority); -+extern void rtw_amsdu_set_timer_status(_adapter *padapter, u8 priority, u8 status); -+extern void rtw_amsdu_set_timer(_adapter *padapter, u8 priority); -+extern void rtw_amsdu_cancel_timer(_adapter *padapter, u8 priority); -+ -+extern s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitframe, struct xmit_frame *pxmitframe_queue); -+extern s32 check_amsdu(struct xmit_frame *pxmitframe); -+extern s32 check_amsdu_tx_support(_adapter *padapter); -+extern struct xmit_frame *rtw_get_xframe(struct xmit_priv *pxmitpriv, int *num_frame); -+#endif -+ -+#ifdef DBG_TXBD_DESC_DUMP -+void rtw_tx_desc_backup(_adapter *padapter, struct xmit_frame *pxmitframe, u8 desc_size, u8 hwq); -+void rtw_tx_desc_backup_reset(void); -+u8 rtw_get_tx_desc_backup(_adapter *padapter, u8 hwq, struct rtw_tx_desc_backup **pbak); -+#endif -+ -+#ifdef CONFIG_PCI_TX_POLLING -+void rtw_tx_poll_init(_adapter *padapter); -+void rtw_tx_poll_timeout_handler(void *FunctionContext); -+void rtw_tx_poll_timer_set(_adapter *padapter, u32 delay); -+void rtw_tx_poll_timer_cancel(_adapter *padapter); -+#endif -+ -+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 */ -+ -+enum XMIT_BLOCK_REASON { -+ XMIT_BLOCK_NONE = 0, -+ XMIT_BLOCK_REDLMEM = BIT0, /*LPS-PG*/ -+ XMIT_BLOCK_SUSPEND = BIT1, /*WOW*/ -+ XMIT_BLOCK_MAX = 0xFF, -+}; -+void rtw_init_xmit_block(_adapter *padapter); -+void rtw_deinit_xmit_block(_adapter *padapter); -+ -+#ifdef DBG_XMIT_BLOCK -+void dump_xmit_block(void *sel, _adapter *padapter); -+#endif -+void rtw_set_xmit_block(_adapter *padapter, enum XMIT_BLOCK_REASON reason); -+void rtw_clr_xmit_block(_adapter *padapter, enum XMIT_BLOCK_REASON reason); -+bool rtw_is_xmit_blocked(_adapter *padapter); -+void rtw_hci_flush(_adapter *padapter); -+ -+/* include after declaring struct xmit_buf, in order to avoid warning */ -+#include -+ -+#endif /* _RTL871X_XMIT_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/sdio_hal.h b/drivers/net/wireless/rtl8821cs/include/sdio_hal.h -new file mode 100644 -index 000000000..6e49835a4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/sdio_hal.h -@@ -0,0 +1,57 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+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 -+ -+#ifdef CONFIG_RTL8188GTV -+void rtl8188gtvs_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8192F -+void rtl8192fs_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#endif /* __SDIO_HAL_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/sdio_ops.h b/drivers/net/wireless/rtl8821cs/include/sdio_ops.h -new file mode 100644 -index 000000000..74ddeca29 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/sdio_ops.h -@@ -0,0 +1,207 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+ -+/* 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 -+ -+extern void sdio_set_intf_ops(_adapter *padapter, struct _io_ops *pops); -+void dump_sdio_card_info(void *sel, struct dvobj_priv *dvobj); -+ -+u32 sdio_init(struct dvobj_priv *dvobj); -+void sdio_deinit(struct dvobj_priv *dvobj); -+int sdio_alloc_irq(struct dvobj_priv *dvobj); -+void sdio_free_irq(struct dvobj_priv *dvobj); -+u8 sdio_get_num_of_func(struct dvobj_priv *dvobj); -+ -+#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) -+#if defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C) \ -+ || defined(CONFIG_RTL8723F) -+u8 rtw_hal_enable_cpwm2(_adapter *adapter); -+#endif -+extern u8 RecvOnePkt(PADAPTER padapter); -+#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); -+extern void ClearInterrupt8723DSdio(PADAPTER padapter); -+#endif /* CONFIG_WOWLAN */ -+#endif -+ -+#ifdef CONFIG_RTL8192F -+extern void InitInterrupt8192FSdio(PADAPTER padapter); -+extern void InitSysInterrupt8192FSdio(PADAPTER padapter); -+extern void EnableInterrupt8192FSdio(PADAPTER padapter); -+extern void DisableInterrupt8192FSdio(PADAPTER padapter); -+extern void UpdateInterruptMask8192FSdio(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); -+extern u8 HalQueryTxBufferStatus8192FSdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8192FSdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern void DisableInterruptButCpwm2192fSdio(PADAPTER padapter); -+extern void ClearInterrupt8192FSdio(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 -+ -+#ifdef CONFIG_RTL8188GTV -+extern void InitInterrupt8188GTVSdio(PADAPTER padapter); -+extern void InitSysInterrupt8188GTVSdio(PADAPTER padapter); -+extern void EnableInterrupt8188GTVSdio(PADAPTER padapter); -+extern void DisableInterrupt8188GTVSdio(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8188GTVSdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8188GTVSdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern void DisableInterruptButCpwm28188GTVSdio(PADAPTER padapter); -+extern void ClearInterrupt8188GTVSdio(PADAPTER padapter); -+#endif /* defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) */ -+#endif -+ -+/** -+ * rtw_sdio_get_block_size() - Get block size of SDIO transfer -+ * @d struct dvobj_priv* -+ * -+ * The unit of return value is byte. -+ */ -+static inline u32 rtw_sdio_get_block_size(struct dvobj_priv *d) -+{ -+ return d->intf_data.block_transfer_len; -+} -+ -+/** -+ * rtw_sdio_cmd53_align_size() - Align size to one CMD53 could complete -+ * @d struct dvobj_priv* -+ * @len length to align -+ * -+ * Adjust len to align block size, and the new size could be transfered by one -+ * CMD53. -+ * If len < block size, it would keep original value, otherwise the value -+ * would be rounded up by block size. -+ * -+ * Return adjusted length. -+ */ -+static inline size_t rtw_sdio_cmd53_align_size(struct dvobj_priv *d, size_t len) -+{ -+ u32 blk_sz; -+ -+ -+ blk_sz = rtw_sdio_get_block_size(d); -+ if (len <= blk_sz) -+ return len; -+ -+ return _RND(len, blk_sz); -+} -+ -+#endif /* !__SDIO_OPS_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/sdio_ops_ce.h b/drivers/net/wireless/rtl8821cs/include/sdio_ops_ce.h -new file mode 100644 -index 000000000..d542cb7ea ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/sdio_ops_ce.h -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/sdio_ops_linux.h b/drivers/net/wireless/rtl8821cs/include/sdio_ops_linux.h -new file mode 100644 -index 000000000..4bbd8fe7f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/sdio_ops_linux.h -@@ -0,0 +1,58 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+#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 */ -+ -+bool rtw_is_sdio30(_adapter *adapter); -+ -+/* The unit of return value is Hz */ -+static inline u32 rtw_sdio_get_clock(struct dvobj_priv *d) -+{ -+ return d->intf_data.clock; -+} -+ -+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, unsigned int addr, -+ void *buf, size_t len, bool fixed); -+int __must_check rtw_sdio_raw_write(struct dvobj_priv *d, unsigned int addr, -+ void *buf, size_t len, bool fixed); -+ -+#endif /* __SDIO_OPS_LINUX_H__ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/include/sdio_ops_xp.h b/drivers/net/wireless/rtl8821cs/include/sdio_ops_xp.h -new file mode 100644 -index 000000000..d3d8764d3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/sdio_ops_xp.h -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_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 --git a/drivers/net/wireless/rtl8821cs/include/sdio_osintf.h b/drivers/net/wireless/rtl8821cs/include/sdio_osintf.h -new file mode 100644 -index 000000000..a94e65679 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/sdio_osintf.h -@@ -0,0 +1,19 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/sta_info.h b/drivers/net/wireless/rtl8821cs/include/sta_info.h -new file mode 100755 -index 000000000..18216b95b ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/sta_info.h -@@ -0,0 +1,788 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+#include -+ -+#define IBSS_START_MAC_ID 2 -+#define NUM_STA MACID_NUM_SW_LIMIT -+ -+#ifndef CONFIG_RTW_MACADDR_ACL -+ #ifdef CONFIG_AP_MODE -+ #define CONFIG_RTW_MACADDR_ACL 1 -+ #else -+ #define CONFIG_RTW_MACADDR_ACL 0 -+ #endif -+#endif -+ -+#ifndef CONFIG_RTW_PRE_LINK_STA -+ #define CONFIG_RTW_PRE_LINK_STA 0 -+#endif -+ -+#define NUM_ACL 16 -+ -+#define RTW_ACL_PERIOD_DEV 0 -+#define RTW_ACL_PERIOD_BSS 1 -+#define RTW_ACL_PERIOD_NUM 2 -+ -+#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_period_str[RTW_ACL_PERIOD_NUM]; -+#define acl_period_str(mode) (((mode) >= RTW_ACL_PERIOD_NUM) ? "INVALID" : _acl_period_str[(mode)]) -+extern const char *const _acl_mode_str[RTW_ACL_MODE_MAX]; -+#define acl_mode_str(mode) (((mode) >= RTW_ACL_MODE_MAX) ? "INVALID" : _acl_mode_str[(mode)]) -+#endif -+ -+#ifndef RTW_PRE_LINK_STA_NUM -+ #define RTW_PRE_LINK_STA_NUM 8 -+#endif -+ -+struct pre_link_sta_node_t { -+ u8 valid; -+ u8 addr[ETH_ALEN]; -+}; -+ -+struct pre_link_sta_ctl_t { -+ _lock lock; -+ u8 num; -+ struct pre_link_sta_node_t node[RTW_PRE_LINK_STA_NUM]; -+}; -+ -+#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; -+}; -+ -+struct stainfo_stats { -+ systime last_rx_time; -+ -+ u64 rx_mgnt_pkts; -+ u64 rx_beacon_pkts; -+ u64 rx_probereq_pkts; -+ u64 rx_probersp_pkts; /* unicast to self */ -+ u64 rx_probersp_bm_pkts; -+ u64 rx_probersp_uo_pkts; /* unicast to others */ -+ u64 rx_ctrl_pkts; -+ u64 rx_data_pkts; -+ u64 rx_data_bc_pkts; -+ u64 rx_data_mc_pkts; -+ u64 rx_data_qos_pkts[TID_NUM]; /* unicast only */ -+ -+ u64 last_rx_mgnt_pkts; -+ u64 last_rx_beacon_pkts; -+ u64 last_rx_probereq_pkts; -+ u64 last_rx_probersp_pkts; /* unicast to self */ -+ u64 last_rx_probersp_bm_pkts; -+ u64 last_rx_probersp_uo_pkts; /* unicast to others */ -+ u64 last_rx_ctrl_pkts; -+ u64 last_rx_data_pkts; -+ u64 last_rx_data_bc_pkts; -+ u64 last_rx_data_mc_pkts; -+ u64 last_rx_data_qos_pkts[TID_NUM]; /* unicast only */ -+ -+#ifdef CONFIG_TDLS -+ u64 rx_tdls_disc_rsp_pkts; -+ u64 last_rx_tdls_disc_rsp_pkts; -+#endif -+ -+ u64 rx_bytes; -+ u64 rx_bc_bytes; -+ u64 rx_mc_bytes; -+ u64 last_rx_bytes; -+ u64 last_rx_bc_bytes; -+ u64 last_rx_mc_bytes; -+ u64 rx_drops; /* TBD */ -+ u32 rx_tp_kbits; -+ u32 smooth_rx_tp_kbits; -+ -+ u64 tx_pkts; -+ u64 last_tx_pkts; -+ -+ u64 tx_bytes; -+ u64 last_tx_bytes; -+ u64 tx_drops; /* TBD */ -+ u32 tx_tp_kbits; -+ u32 smooth_tx_tp_kbits; -+ -+#ifdef CONFIG_LPS_CHK_BY_TP -+ u64 acc_tx_bytes; -+ u64 acc_rx_bytes; -+#endif -+ -+ /* unicast only */ -+ u64 last_rx_data_uc_pkts; /* For Read & Clear requirement in proc_get_rx_stat() */ -+ u32 duplicate_cnt; /* Read & Clear, in proc_get_rx_stat() */ -+ u32 rxratecnt[128]; /* Read & Clear, in proc_get_rx_stat() */ -+ u32 tx_ok_cnt; /* Read & Clear, in proc_get_tx_stat() */ -+ u32 tx_fail_cnt; /* Read & Clear, in proc_get_tx_stat() */ -+ u32 tx_fail_cnt_sum; /* cumulative counts */ -+ u32 tx_retry_cnt; /* Read & Clear, in proc_get_tx_stat() */ -+ u32 tx_retry_cnt_sum; /* cumulative counts */ -+#ifdef CONFIG_RTW_MESH -+ u32 rx_hwmp_pkts; -+ u32 last_rx_hwmp_pkts; -+#endif -+}; -+ -+#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; -+ systime 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 rtw_st_ctl_rx(struct sta_info *sta, u8 *ehdr_pos); -+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 -+ -+#ifdef CONFIG_RTW_MESH -+struct mesh_plink_ent; -+struct rtw_ewma_err_rate { -+ unsigned long internal; -+}; -+ -+/* Mesh airtime link metrics parameters */ -+struct rtw_atlm_param { -+ struct rtw_ewma_err_rate err_rate; /* Now is PACKET error rate */ -+ u16 data_rate; /* The unit is 100Kbps */ -+ u16 total_pkt; -+ u16 overhead; /* Channel access overhead */ -+}; -+#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 cmn_sta_info cmn; -+ -+ 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; -+ struct sta_recv_dframe_info sta_dframe_info_bmc; -+#endif -+ _queue sleep_q; -+ unsigned int sleepq_len; -+#ifdef CONFIG_RTW_MGMT_QUEUE -+ _queue mgmt_sleep_q; -+ unsigned int mgmt_sleepq_len; -+#endif -+ -+ uint state; -+ uint qos_option; -+ u16 hwseq; -+ -+#ifdef CONFIG_RTW_80211K -+ u8 rm_en_cap[5]; -+ u8 rm_diag_token; -+#endif /* CONFIG_RTW_80211K */ -+ -+ systime resp_nonenc_eapol_key_starttime; -+ 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 */ -+ union pn48 dot11rxpn; /* PN48 used for Unicast recv. */ -+ ATOMIC_T keytrack; -+#ifdef CONFIG_RTW_MESH -+ /* peer's GTK, RX only */ -+ u8 group_privacy; -+ u8 gtk_bmp; -+ union Keytype gtk; -+ union pn48 gtk_pn; -+ #ifdef CONFIG_IEEE80211W -+ /* peer's IGTK, RX only */ -+ enum security_type dot11wCipher; -+ u8 igtk_bmp; -+ u8 igtk_id; -+ union Keytype igtk; -+ union pn48 igtk_pn; -+ #endif /* CONFIG_IEEE80211W */ -+#endif /* CONFIG_RTW_MESH */ -+#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 -+ _timer dot11w_expire_timer; -+#endif /* CONFIG_IEEE80211W */ -+ -+ u8 bssrateset[16]; -+ u32 bssratelen; -+ -+ u8 cts2self; -+ u8 rtsen; -+ -+ u8 init_rate; -+ u8 wireless_mode; /* NETWORK_TYPE */ -+ -+ 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; -+ -+ int flags; -+ -+ 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 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; -+ -+ u32 akm_suite_type; -+ -+#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 -+ -+#if !defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && defined(CONFIG_80211N_HT) -+ u8 under_exist_checking; -+#endif -+ -+ 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_RTW_MESH -+ struct mesh_plink_ent *plink; -+ -+ u8 local_mps; -+ u8 peer_mps; -+ u8 nonpeer_mps; -+ -+ struct rtw_atlm_param metrics; -+ /* The reference for nexthop_lookup */ -+ BOOLEAN alive; -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ u8 *pauth_frame; -+ u32 auth_len; -+ u8 *passoc_req; -+ u32 assoc_req_len; -+#endif -+ -+ u8 IOTPeer; /* Enum value. HT_IOT_PEER_E */ -+#ifdef CONFIG_LPS_PG -+ u8 lps_pg_rssi_lv; -+#endif -+ -+ /* To store the sequence number of received management frame */ -+ u16 RxMgmtFrameSeqNum; -+ -+ struct st_ctl_t st_ctl; -+ u8 max_agg_num_minimal_record; /*keep minimal tx desc max_agg_num setting*/ -+ u8 curr_rx_rate; -+ u8 curr_rx_rate_bmc; -+#ifdef CONFIG_RTS_FULL_BW -+ bool vendor_8812; -+#endif -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ u8 tbtx_enable; /* Does this sta_info support & enable TBTX function? */ -+// u8 tbtx_timeslot; /* This sta_info belong to which time slot. */ -+#endif -+ -+ /* -+ * Vaiables for queuing TX pkt a short period of time -+ * to wait something ready. -+ */ -+ u8 tx_q_enable; -+ struct __queue tx_queue; -+ _workitem tx_q_work; -+}; -+ -+#ifdef CONFIG_RTW_MESH -+#define STA_SET_MESH_PLINK(sta, link) (sta)->plink = link -+#else -+#define STA_SET_MESH_PLINK(sta, link) do {} while (0) -+#endif -+ -+#define sta_tx_pkts(sta) \ -+ (sta->sta_stats.tx_pkts) -+ -+#define sta_last_tx_pkts(sta) \ -+ (sta->sta_stats.last_tx_pkts) -+ -+#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_data_uc_pkts(sta) (sta->sta_stats.rx_data_pkts - sta->sta_stats.rx_data_bc_pkts - sta->sta_stats.rx_data_mc_pkts) -+#define sta_last_rx_data_uc_pkts(sta) (sta->sta_stats.last_rx_data_pkts - sta->sta_stats.last_rx_data_bc_pkts - sta->sta_stats.last_rx_data_mc_pkts) -+ -+#define sta_rx_data_qos_pkts(sta, i) \ -+ (sta->sta_stats.rx_data_qos_pkts[i]) -+ -+#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) -+ -+#ifdef CONFIG_RTW_MESH -+#define update_last_rx_hwmp_pkts(sta) \ -+ do { \ -+ sta->sta_stats.last_rx_hwmp_pkts = sta->sta_stats.rx_hwmp_pkts; \ -+ } while(0) -+#else -+#define update_last_rx_hwmp_pkts(sta) do {} while(0) -+#endif -+ -+#define sta_update_last_rx_pkts(sta) \ -+ do { \ -+ int __i; \ -+ \ -+ 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; \ -+ update_last_rx_hwmp_pkts(sta); \ -+ \ -+ sta->sta_stats.last_rx_data_pkts = sta->sta_stats.rx_data_pkts; \ -+ sta->sta_stats.last_rx_data_bc_pkts = sta->sta_stats.rx_data_bc_pkts; \ -+ sta->sta_stats.last_rx_data_mc_pkts = sta->sta_stats.rx_data_mc_pkts; \ -+ for (__i = 0; __i < TID_NUM; __i++) \ -+ sta->sta_stats.last_rx_data_qos_pkts[__i] = sta->sta_stats.rx_data_qos_pkts[__i]; \ -+ } 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)" -+ -+#define sta_rx_uc_bytes(sta) (sta->sta_stats.rx_bytes - sta->sta_stats.rx_bc_bytes - sta->sta_stats.rx_mc_bytes) -+#define sta_last_rx_uc_bytes(sta) (sta->sta_stats.last_rx_bytes - sta->sta_stats.last_rx_bc_bytes - sta->sta_stats.last_rx_mc_bytes) -+ -+#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 -+ -+#define AID_BMP_LEN(max_aid) ((max_aid + 1) / 8 + (((max_aid + 1) % 8) ? 1 : 0)) -+ -+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; -+ -+ int rx_chk_limit; -+ -+#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 -+ */ -+ struct sta_info **sta_aid; -+ u16 max_aid; -+ u16 started_aid; /* started AID for allocation search */ -+ bool rr_aid; /* round robin AID allocation, will modify started_aid */ -+ u8 aid_bmp_len; /* in byte */ -+ u8 *sta_dz_bitmap; -+ u8 *tim_bitmap; -+ -+ u16 max_num_sta; -+ -+#if CONFIG_RTW_MACADDR_ACL -+ struct wlan_acl_pool acl_list[RTW_ACL_PERIOD_NUM]; -+#endif -+ -+ #if CONFIG_RTW_PRE_LINK_STA -+ struct pre_link_sta_ctl_t pre_link_sta_ctl; -+ #endif -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ u8 tbtx_asoc_list_cnt; -+ struct sta_info *token_holder[NR_MAXSTA_INSLOT]; -+ struct sta_info *last_token_holder; -+ ATOMIC_T nr_token_keeper; -+#endif -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_ATMEL_RC_PATCH -+ u8 atmel_rc_pattern[6]; -+#endif -+ -+ /* tx report, single request allowed for now */ -+ u8 c2h_sta_mac[ETH_ALEN]; -+ u8 c2h_adapter_id; -+ struct submit_ctx *gotc2h; -+ _lock tx_rpt_lock; -+}; -+ -+ -+__inline static u32 wifi_mac_hash(const 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, const 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, const u8 *hwaddr); -+extern u32 rtw_init_bcmc_stainfo(_adapter *padapter); -+extern struct sta_info *rtw_get_bcmc_stainfo(_adapter *padapter); -+ -+#ifdef CONFIG_AP_MODE -+u16 rtw_aid_alloc(_adapter *adapter, struct sta_info *sta); -+void dump_aid_status(void *sel, _adapter *adapter); -+#endif -+ -+#if CONFIG_RTW_MACADDR_ACL -+extern u8 rtw_access_ctrl(_adapter *adapter, const u8 *mac_addr); -+void dump_macaddr_acl(void *sel, _adapter *adapter); -+#endif -+ -+bool rtw_is_pre_link_sta(struct sta_priv *stapriv, u8 *addr); -+#if CONFIG_RTW_PRE_LINK_STA -+struct sta_info *rtw_pre_link_sta_add(struct sta_priv *stapriv, u8 *hwaddr); -+void rtw_pre_link_sta_del(struct sta_priv *stapriv, u8 *hwaddr); -+void rtw_pre_link_sta_ctl_reset(struct sta_priv *stapriv); -+void rtw_pre_link_sta_ctl_init(struct sta_priv *stapriv); -+void rtw_pre_link_sta_ctl_deinit(struct sta_priv *stapriv); -+void dump_pre_link_sta_ctl(void *sel, struct sta_priv *stapriv); -+#endif /* CONFIG_RTW_PRE_LINK_STA */ -+ -+#endif /* _STA_INFO_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/usb_hal.h b/drivers/net/wireless/rtl8821cs/include/usb_hal.h -new file mode 100644 -index 000000000..2d7776f06 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/usb_hal.h -@@ -0,0 +1,71 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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_RTL8188GTV -+void rtl8188gtvu_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_RTL8710B -+void rtl8710bu_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_RTL8192F -+void rtl8192fu_set_hal_ops(_adapter *padapter); -+#endif /* CONFIG_RTL8192F */ -+ -+#endif /* __USB_HAL_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/usb_ops.h b/drivers/net/wireless/rtl8821cs/include/usb_ops.h -new file mode 100644 -index 000000000..a74152fbb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/usb_ops.h -@@ -0,0 +1,150 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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_RTL8188GTV -+void rtl8188gtvu_set_hw_type(struct dvobj_priv *pdvobj); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8188gtvu(_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); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8723du(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif /* CONFIG_SUPPORT_USB_INT */ -+#endif /* CONFIG_RTL8723D */ -+ -+#ifdef CONFIG_RTL8710B -+void rtl8710bu_set_hw_type(struct dvobj_priv *pdvobj); -+void rtl8710bu_set_intf_ops(struct _io_ops *pops); -+void rtl8710bu_recv_tasklet(void *priv); -+void rtl8710bu_xmit_tasklet(void *priv); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8710bu(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif /* CONFIG_SUPPORT_USB_INT */ -+#endif /* CONFIG_RTL8710B */ -+ -+#ifdef CONFIG_RTL8192F -+void rtl8192fu_set_hw_type(struct dvobj_priv *pdvobj); -+#ifdef CONFIG_SUPPORT_USB_INT -+void rtl8192fu_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif /* CONFIG_SUPPORT_USB_INT */ -+#endif /* CONFIG_RTL8192F */ -+ -+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; -+ else 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 --git a/drivers/net/wireless/rtl8821cs/include/usb_ops_linux.h b/drivers/net/wireless/rtl8821cs/include/usb_ops_linux.h -new file mode 100644 -index 000000000..dd4665e3c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/usb_ops_linux.h -@@ -0,0 +1,98 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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(unsigned long 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 --git a/drivers/net/wireless/rtl8821cs/include/usb_osintf.h b/drivers/net/wireless/rtl8821cs/include/usb_osintf.h -new file mode 100644 -index 000000000..48495b492 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/usb_osintf.h -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __USB_OSINTF_H -+#define __USB_OSINTF_H -+ -+#include -+ -+#define USBD_HALTED(Status) ((u32)(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 --git a/drivers/net/wireless/rtl8821cs/include/usb_vendor_req.h b/drivers/net/wireless/rtl8821cs/include/usb_vendor_req.h -new file mode 100644 -index 000000000..3e2587863 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/usb_vendor_req.h -@@ -0,0 +1,56 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 _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, u8 wIndex, void *Data, u8 DataLength, BOOLEAN isDirectionIn); -+BOOLEAN CEusbGetStatusRequest(PCE_USB_DEVICE CEdevice, u16 Op, u16 Index, void *Data); -+BOOLEAN CEusbFeatureRequest(PCE_USB_DEVICE CEdevice, u16 Op, u16 FeatureSelector, u16 Index); -+BOOLEAN CEusbGetDescriptorRequest(PCE_USB_DEVICE CEdevice, short urbLength, u8 DescriptorType, u8 Index, u16 LanguageId, void *TransferBuffer, u32 TransferBufferLength); -+#endif -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/include/wifi.h b/drivers/net/wireless/rtl8821cs/include/wifi.h -new file mode 100755 -index 000000000..4d285708f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/wifi.h -@@ -0,0 +1,1366 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_ -+ -+ -+#ifndef BIT -+#define BIT(x) (1 << (x)) -+#endif -+#ifndef BIT_ULL -+#define BIT_ULL(x) (1ULL << (x)) -+#endif -+ -+ -+#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 VENDOR_NAME_LEN 20 -+ -+#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) -+#ifdef CONFIG_P2P -+#define WIFI_P2P_PROBEREQ_VENDOR_IE_BIT BIT(5) -+#define WIFI_P2P_PROBERESP_VENDOR_IE_BIT BIT(6) -+#define WLAN_MAX_VENDOR_IE_MASK_MAX 7 -+#else -+#define WLAN_MAX_VENDOR_IE_MASK_MAX 5 -+#endif -+#endif -+ -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+#define WLAN_MAX_KEEP_ALIVE_IE_LEN 256 -+#endif/*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ -+#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_BF_REPORT_POLL = (BIT(6) | WIFI_CTRL_TYPE), -+ WIFI_NDPA = (BIT(6) | BIT(4) | WIFI_CTRL_TYPE), -+ WIFI_BAR = (BIT(7) | 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) ((GetFrDs(pframe) << 1) | GetToDs(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 get_frame_sub_type(pbuf) (cpu_to_le16(*(unsigned short *)(pbuf)) & (BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))) -+ -+ -+#define set_frame_sub_type(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 set_duration(pbuf, dur) \ -+ do { \ -+ *(unsigned short *)((SIZE_PTR)(pbuf) + 2) = cpu_to_le16(0xffff & (dur)); \ -+ } while (0) -+ -+ -+/* QoS control field */ -+#define SetPriority(qc, tid) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 0, 4, tid) -+#define SetEOSP(qc, eosp) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 4, 1, eosp) -+#define SetAckpolicy(qc, ack) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 5, 2, ack) -+#define SetAMsdu(qc, amsdu) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 7, 1, amsdu) -+ -+#define GetPriority(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 0, 4) -+#define GetEOSP(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 4, 1) -+#define GetAckpolicy(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 5, 2) -+#define GetAMsdu(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 7, 1) -+ -+/* QoS control field (MSTA only) */ -+#define set_mctrl_present(qc, p) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 8, 1, p) -+#define set_mps_lv(qc, lv) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 9, 1, lv) -+#define set_rspi(qc, rspi) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 10, 1, rspi) -+ -+#define get_mctrl_present(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 8, 1) -+#define get_mps_lv(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 9, 1) -+#define get_rspi(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 10, 1) -+ -+ -+#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 get_addr2_ptr(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(const u8 *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 = get_addr2_ptr(pframe); -+ return ta; -+} -+ -+/* can't apply to mesh mode */ -+__inline static unsigned char *get_da(unsigned char *pframe) -+{ -+ unsigned char *da; -+ unsigned int to_fr_ds = (GetFrDs(pframe) << 1) | GetToDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: /* ToDs=0, FromDs=0 */ -+ da = GetAddr1Ptr(pframe); -+ break; -+ case 0x01: /* ToDs=1, FromDs=0 */ -+ da = GetAddr3Ptr(pframe); -+ break; -+ case 0x02: /* ToDs=0, FromDs=1 */ -+ da = GetAddr1Ptr(pframe); -+ break; -+ default: /* ToDs=1, FromDs=1 */ -+ da = GetAddr3Ptr(pframe); -+ break; -+ } -+ -+ return da; -+} -+ -+/* can't apply to mesh mode */ -+__inline static unsigned char *get_sa(unsigned char *pframe) -+{ -+ unsigned char *sa; -+ unsigned int to_fr_ds = (GetFrDs(pframe) << 1) | GetToDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: /* ToDs=0, FromDs=0 */ -+ sa = get_addr2_ptr(pframe); -+ break; -+ case 0x01: /* ToDs=1, FromDs=0 */ -+ sa = get_addr2_ptr(pframe); -+ break; -+ case 0x02: /* ToDs=0, FromDs=1 */ -+ sa = GetAddr3Ptr(pframe); -+ break; -+ default: /* ToDs=1, FromDs=1 */ -+ sa = GetAddr4Ptr(pframe); -+ break; -+ } -+ -+ return sa; -+} -+ -+/* can't apply to mesh mode */ -+__inline static unsigned char *get_hdr_bssid(unsigned char *pframe) -+{ -+ unsigned char *bssid= NULL; -+ unsigned int to_fr_ds = (GetFrDs(pframe) << 1) | GetToDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: /* ToDs=0, FromDs=0 */ -+ bssid = GetAddr3Ptr(pframe); -+ break; -+ case 0x01: /* ToDs=1, FromDs=0 */ -+ bssid = GetAddr1Ptr(pframe); -+ break; -+ case 0x02: /* ToDs=0, FromDs=1 */ -+ bssid = get_addr2_ptr(pframe); -+ break; -+ case 0x03: /* ToDs=1, FromDs=1 */ -+ bssid = GetAddr1Ptr(pframe); -+ break; -+ } -+ -+ return bssid; -+} -+ -+ -+__inline static int IsFrameTypeCtrl(unsigned char *pframe) -+{ -+ if (WIFI_CTRL_TYPE == GetFrameType(pframe)) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+static inline int IsFrameTypeMgnt(unsigned char *pframe) -+{ -+ if (GetFrameType(pframe) == WIFI_MGT_TYPE) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+static inline int IsFrameTypeData(unsigned char *pframe) -+{ -+ if (GetFrameType(pframe) == WIFI_DATA_TYPE) -+ 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 _CHLGETXT_IE_ 16 -+#define _SUPPORTED_CH_IE_ 36 -+#define _MEAS_REQ_IE_ 38 -+#define _MEAS_RSP_IE_ 39 -+#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_RRM_EN_CAP_IE_ 70 -+ -+ -+/* #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 _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_TPC = 35, -+ 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 */ -+ -+ /* 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_VHTTransmitPower = 195, -+ 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) -+#define cap_APSD BIT(11) -+#define cap_RM BIT(12) -+#define cap_DSSSOFDM BIT(13) -+#define cap_DelayedBACK BIT(14) -+#define cap_ImmediateBACK BIT(15) -+ -+/*----------------------------------------------------------------------------- -+ 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 -+ -+#define _MME_IE_LENGTH_ 26 -+ -+/*----------------------------------------------------------------------------- -+ Below is the definition for WMM -+------------------------------------------------------------------------------*/ -+#define _WMM_IE_Length_ 7 /* for WMM STA */ -+ -+ -+/*----------------------------------------------------------------------------- -+ Below is the definition for 802.11n -+------------------------------------------------------------------------------*/ -+ -+/* #ifdef CONFIG_80211N_HT */ -+ -+#define set_order_bit(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) -+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(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 -+ */ -+#ifndef CONFIG_IEEE80211_HT_ADDT_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]; -+} __attribute__((packed)); -+#endif -+ -+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 -+ -+ -+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 _VHT_CAP_AMPDU_FACTOR { -+ MAX_AMPDU_FACTOR_128K = 4, -+ MAX_AMPDU_FACTOR_256K = 5, -+ MAX_AMPDU_FACTOR_512K = 6, -+ MAX_AMPDU_FACTOR_1M = 7, -+} VHT_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_HT 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, -+}; -+ -+#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 -+ -+#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)) -+ -+enum RTW_ROCH_WK_ID{ -+ ROCH_RO_CH_WK, -+ ROCH_CANCEL_RO_CH_WK, -+ ROCH_AP_ROCH_CH_SWITCH_PROCESS_WK, -+}; -+ -+#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 --git a/drivers/net/wireless/rtl8821cs/include/wlan_bssdef.h b/drivers/net/wireless/rtl8821cs/include/wlan_bssdef.h -new file mode 100644 -index 000000000..38de05ced ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/wlan_bssdef.h -@@ -0,0 +1,330 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+ -+#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[ETH_ALEN]; -+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 struct _NDIS_802_11_SSID { -+ u32 SsidLength; -+ u8 Ssid[32]; -+} NDIS_802_11_SSID, *PNDIS_802_11_SSID; -+ -+/* -+ 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 { -+ u32 Length; /* Length of structure */ -+ u32 BeaconPeriod; /* units are Kusec */ -+ u32 ATIMWindow; /* units are Kusec */ -+ u32 DSConfig; /* channel number */ -+} 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_11_mesh, -+} NDIS_802_11_NETWORK_INFRASTRUCTURE, *PNDIS_802_11_NETWORK_INFRASTRUCTURE; -+ -+typedef struct _NDIS_802_11_FIXED_IEs { -+ u8 Timestamp[8]; -+ u16 BeaconInterval; -+ u16 Capabilities; -+} NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; -+ -+typedef struct _NDIS_802_11_VARIABLE_IEs { -+ u8 ElementID; -+ u8 Length; -+ u8 data[1]; -+} NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; -+ -+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; -+ -+typedef 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 */ -+} NDIS_802_11_WEP, *PNDIS_802_11_WEP; -+ -+#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[ETH_ALEN]; -+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 struct _NDIS_802_11_SSID { -+ u32 SsidLength; -+ u8 Ssid[32]; -+} NDIS_802_11_SSID, *PNDIS_802_11_SSID; -+ -+/* -+ 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 { -+ u32 Length; /* Length of structure */ -+ u32 BeaconPeriod; /* units are Kusec */ -+ u32 ATIMWindow; /* units are Kusec */ -+ u32 DSConfig; /* channel number */ -+} 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 { -+ u8 Timestamp[8]; -+ u16 BeaconInterval; -+ u16 Capabilities; -+} NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; -+ -+typedef struct _NDIS_802_11_VARIABLE_IEs { -+ u8 ElementID; -+ u8 Length; -+ u8 data[1]; -+} NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; -+ -+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; -+ -+ -+typedef 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 */ -+} NDIS_802_11_WEP, *PNDIS_802_11_WEP; -+ -+#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 is_cck_rate; /* 1:cck_rate */ -+ s8 rx_snr[4]; -+#ifdef CONFIG_RTW_80211K -+ u32 free_cnt; /* freerun counter */ -+ u8 rm_en_cap[5]; -+#endif -+} 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; -+ -+enum bss_type { -+ BSS_TYPE_UNDEF, -+ BSS_TYPE_PROB_REQ = 1, -+ BSS_TYPE_BCN = 2, -+ BSS_TYPE_PROB_RSP = 3, -+}; -+ -+/* temporally add #pragma pack for structure alignment issue of -+* WLAN_BSSID_EX and get_WLAN_BSSID_EX_sz() -+*/ -+typedef struct _WLAN_BSSID_EX { -+ u32 Length; -+ NDIS_802_11_MAC_ADDRESS MacAddress; -+ u8 Reserved[2];/* [0]: IS beacon frame , bss_type*/ -+ NDIS_802_11_SSID Ssid; -+ NDIS_802_11_SSID mesh_id; -+ u32 Privacy; -+ NDIS_802_11_RSSI Rssi;/* (in dBM,raw data ,get from PHY) */ -+ NDIS_802_11_CONFIGURATION Configuration; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; -+ NDIS_802_11_RATES_EX SupportedRates; -+ WLAN_PHY_INFO PhyInfo; -+ u32 IELength; -+ u8 IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ -+#ifdef CONFIG_LAYER2_ROAMING -+ u64 tsf; -+#endif -+} -+__attribute__((packed)) WLAN_BSSID_EX, *PWLAN_BSSID_EX; -+ -+#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] == BSS_TYPE_PROB_REQ ? 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) -+{ -+ return sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + bss->IELength; -+} -+ -+struct beacon_keys { -+ u8 ssid[IW_ESSID_MAX_SIZE]; -+ u32 ssid_len; -+ u8 ch; -+ u8 bw; -+ u8 offset; -+ u8 proto_cap; /* PROTO_CAP_XXX */ -+ u8 rate_set[12]; -+ u8 rate_num; -+ int encryp_protocol; -+ int pairwise_cipher; -+ int group_cipher; -+ u32 akm; -+}; -+ -+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 */ -+ systime last_scanned; /* timestamp for the network */ -+ systime last_non_hidden_ssid_ap; -+#ifdef CONFIG_RTW_MESH -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+ systime acnode_stime; -+ systime acnode_notify_etime; -+#endif -+#endif -+ int aid; /* will only be valid when a BSS is joinned. */ -+ int join_res; -+ struct beacon_keys bcn_keys; -+ bool bcn_keys_valid; -+ WLAN_BSSID_EX network; /* must be the last item */ -+}; -+ -+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 -+ -+#endif /* #ifndef WLAN_BSSDEF_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/include/xmit_osdep.h b/drivers/net/wireless/rtl8821cs/include/xmit_osdep.h -new file mode 100644 -index 000000000..d253181f4 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/include/xmit_osdep.h -@@ -0,0 +1,101 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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; -+ 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( -+ _nic_hdl cnxt, -+ NDIS_PACKET *pkt, -+ u32 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); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 32)) -+extern netdev_tx_t rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); -+#else -+extern int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); -+#endif -+ -+#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_check_wakup_queue(_adapter *adapter, u16 os_qid); -+bool rtw_os_check_stop_queue(_adapter *adapter, u16 os_qid); -+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 --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/custom_gpio_linux.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/custom_gpio_linux.c -new file mode 100644 -index 000000000..23401b7d6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/custom_gpio_linux.c -@@ -0,0 +1,340 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "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 --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_cfg80211.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_cfg80211.c -new file mode 100755 -index 000000000..b6702778c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_cfg80211.c -@@ -0,0 +1,11286 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ -+#ifndef DBG_RTW_CFG80211_STA_PARAM -+#define DBG_RTW_CFG80211_STA_PARAM 0 -+#endif -+ -+#ifndef DBG_RTW_CFG80211_MESH_CONF -+#define DBG_RTW_CFG80211_MESH_CONF 0 -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+#define STATION_INFO_INACTIVE_TIME BIT(NL80211_STA_INFO_INACTIVE_TIME) -+#define STATION_INFO_RX_BYTES BIT(NL80211_STA_INFO_RX_BYTES) -+#define STATION_INFO_TX_BYTES BIT(NL80211_STA_INFO_TX_BYTES) -+#define STATION_INFO_LLID BIT(NL80211_STA_INFO_LLID) -+#define STATION_INFO_PLID BIT(NL80211_STA_INFO_PLID) -+#define STATION_INFO_PLINK_STATE BIT(NL80211_STA_INFO_PLINK_STATE) -+#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_TX_RETRIES BIT(NL80211_STA_INFO_TX_RETRIES) -+#define STATION_INFO_TX_FAILED BIT(NL80211_STA_INFO_TX_FAILED) -+#define STATION_INFO_RX_BITRATE BIT(NL80211_STA_INFO_RX_BITRATE) -+#define STATION_INFO_LOCAL_PM BIT(NL80211_STA_INFO_LOCAL_PM) -+#define STATION_INFO_PEER_PM BIT(NL80211_STA_INFO_PEER_PM) -+#define STATION_INFO_NONPEER_PM BIT(NL80211_STA_INFO_NONPEER_PM) -+#define STATION_INFO_RX_BYTES64 BIT(NL80211_STA_INFO_RX_BYTES64) -+#define STATION_INFO_TX_BYTES64 BIT(NL80211_STA_INFO_TX_BYTES64) -+#define STATION_INFO_ASSOC_REQ_IES 0 -+#endif /* Linux kernel >= 4.0.0 */ -+ -+#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 */ -+ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(4, 11, 12)) -+#ifdef CONFIG_RTW_80211R -+#define WLAN_AKM_SUITE_FT_8021X 0x000FAC03 -+#define WLAN_AKM_SUITE_FT_PSK 0x000FAC04 -+#endif -+#endif -+ -+#define WIFI_CIPHER_SUITE_GCMP 0x000FAC08 -+#define WIFI_CIPHER_SUITE_GCMP_256 0x000FAC09 -+#define WIFI_CIPHER_SUITE_CCMP_256 0x000FAC0A -+#define WIFI_CIPHER_SUITE_BIP_GMAC_128 0x000FAC0B -+#define WIFI_CIPHER_SUITE_BIP_GMAC_256 0x000FAC0C -+#define WIFI_CIPHER_SUITE_BIP_CMAC_256 0x000FAC0D -+ -+/* -+ * If customer need, defining this flag will make driver -+ * always return -EBUSY at the condition of scan deny. -+ */ -+/* #define CONFIG_NOTIFY_SCAN_ABORT_WITH_BUSY */ -+ -+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, -+ WIFI_CIPHER_SUITE_GCMP, -+ WIFI_CIPHER_SUITE_GCMP_256, -+ WIFI_CIPHER_SUITE_CCMP_256, -+ WIFI_CIPHER_SUITE_BIP_GMAC_128, -+ WIFI_CIPHER_SUITE_BIP_GMAC_256, -+ WIFI_CIPHER_SUITE_BIP_CMAC_256, -+#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 = 0, \ -+ } -+ -+#define CHAN5G(_channel, _flags) { \ -+ .band = NL80211_BAND_5GHZ, \ -+ .center_freq = 5000 + (5 * (_channel)), \ -+ .hw_value = (_channel), \ -+ .flags = (_flags), \ -+ .max_antenna_gain = 0, \ -+ .max_power = 0, \ -+ } -+ -+#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 -+ -+/* from center_ch_2g */ -+static struct ieee80211_channel rtw_2ghz_channels[MAX_CHANNEL_NUM_2G] = { -+ 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), -+}; -+ -+/* from center_ch_5g_20m */ -+static struct ieee80211_channel rtw_5ghz_a_channels[MAX_CHANNEL_NUM_5G] = { -+ CHAN5G(36, 0), CHAN5G(40, 0), CHAN5G(44, 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(144, 0), -+ -+ CHAN5G(149, 0), CHAN5G(153, 0), CHAN5G(157, 0), CHAN5G(161, 0), -+ CHAN5G(165, 0), CHAN5G(169, 0), CHAN5G(173, 0), CHAN5G(177, 0), -+}; -+ -+enum nl80211_band _rtw_band_to_nl80211_band[] = { -+ [BAND_ON_2_4G] = NL80211_BAND_2GHZ, -+ [BAND_ON_5G] = NL80211_BAND_5GHZ, -+#if CONFIG_IEEE80211_BAND_6GHZ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 4, 0)) -+ [BAND_ON_6G] = NL80211_BAND_6GHZ, -+ #else -+ [BAND_ON_6G] = NUM_NL80211_BANDS, -+ #endif -+#endif -+}; -+ -+BAND_TYPE _nl80211_band_to_rtw_band[] = { -+ [NL80211_BAND_2GHZ] = BAND_ON_2_4G, -+ [NL80211_BAND_5GHZ] = BAND_ON_5G, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ [NL80211_BAND_60GHZ] = BAND_MAX, -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 4, 0)) -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ [NL80211_BAND_6GHZ] = BAND_ON_6G, -+ #else -+ [NL80211_BAND_6GHZ] = BAND_MAX, -+ #endif -+#endif -+}; -+ -+ -+static int rtw_cfg80211_set_assocresp_ies(struct net_device *net, const u8 *buf, int len); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+static u8 rtw_chbw_to_cfg80211_chan_def(struct wiphy *wiphy, struct cfg80211_chan_def *chdef, u8 ch, u8 bw, u8 offset, u8 ht) -+{ -+ int freq, cfreq; -+ struct ieee80211_channel *chan; -+ u8 ret = _FAIL; -+ -+ _rtw_memset(chdef, 0, sizeof(*chdef)); -+ -+ freq = rtw_ch2freq(ch); -+ if (!freq) -+ goto exit; -+ -+ cfreq = rtw_get_center_ch(ch, bw, offset); -+ if (!cfreq) -+ goto exit; -+ cfreq = rtw_ch2freq(cfreq); -+ if (!cfreq) -+ goto exit; -+ -+ chan = ieee80211_get_channel(wiphy, freq); -+ if (!chan) -+ goto exit; -+ -+ if (bw == CHANNEL_WIDTH_20) -+ chdef->width = ht ? NL80211_CHAN_WIDTH_20 : NL80211_CHAN_WIDTH_20_NOHT; -+ else if (bw == CHANNEL_WIDTH_40) -+ chdef->width = NL80211_CHAN_WIDTH_40; -+ else if (bw == CHANNEL_WIDTH_80) -+ chdef->width = NL80211_CHAN_WIDTH_80; -+ else if (bw == CHANNEL_WIDTH_160) -+ chdef->width = NL80211_CHAN_WIDTH_160; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ else if (bw == CHANNEL_WIDTH_5) -+ chdef->width = NL80211_CHAN_WIDTH_5; -+ else if (bw == CHANNEL_WIDTH_10) -+ chdef->width = NL80211_CHAN_WIDTH_10; -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) */ -+ else { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ chdef->chan = chan; -+ chdef->center_freq1 = cfreq; -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+static const char *nl80211_chan_width_str(enum nl80211_chan_width cwidth) -+{ -+ switch (cwidth) { -+ case NL80211_CHAN_WIDTH_20_NOHT: -+ return "20_NOHT"; -+ case NL80211_CHAN_WIDTH_20: -+ return "20"; -+ case NL80211_CHAN_WIDTH_40: -+ return "40"; -+ case NL80211_CHAN_WIDTH_80: -+ return "80"; -+ case NL80211_CHAN_WIDTH_80P80: -+ return "80+80"; -+ case NL80211_CHAN_WIDTH_160: -+ return "160"; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ case NL80211_CHAN_WIDTH_5: -+ return "5"; -+ case NL80211_CHAN_WIDTH_10: -+ return "10"; -+#endif -+ default: -+ return "INVALID"; -+ }; -+} -+ -+static void rtw_get_chbw_from_cfg80211_chan_def(struct cfg80211_chan_def *chdef, u8 *ht, u8 *ch, u8 *bw, u8 *offset) -+{ -+ int pri_freq; -+ struct ieee80211_channel *chan = chdef->chan; -+ -+ pri_freq = rtw_ch2freq(chan->hw_value); -+ if (!pri_freq) { -+ RTW_INFO("invalid channel:%d\n", chan->hw_value); -+ rtw_warn_on(1); -+ *ch = 0; -+ return; -+ } -+ -+ switch (chdef->width) { -+ case NL80211_CHAN_WIDTH_20_NOHT: -+ *ht = 0; -+ *bw = CHANNEL_WIDTH_20; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ *ch = chan->hw_value; -+ break; -+ case NL80211_CHAN_WIDTH_20: -+ *ht = 1; -+ *bw = CHANNEL_WIDTH_20; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ *ch = chan->hw_value; -+ break; -+ case NL80211_CHAN_WIDTH_40: -+ *ht = 1; -+ *bw = CHANNEL_WIDTH_40; -+ *offset = pri_freq > chdef->center_freq1 ? HAL_PRIME_CHNL_OFFSET_UPPER : HAL_PRIME_CHNL_OFFSET_LOWER; -+ if (rtw_get_offset_by_chbw(chan->hw_value, *bw, offset)) -+ *ch = chan->hw_value; -+ break; -+ case NL80211_CHAN_WIDTH_80: -+ *ht = 1; -+ *bw = CHANNEL_WIDTH_80; -+ if (rtw_get_offset_by_chbw(chan->hw_value, *bw, offset)) -+ *ch = chan->hw_value; -+ break; -+ case NL80211_CHAN_WIDTH_160: -+ *ht = 1; -+ *bw = CHANNEL_WIDTH_160; -+ if (rtw_get_offset_by_chbw(chan->hw_value, *bw, offset)) -+ *ch = chan->hw_value; -+ break; -+ case NL80211_CHAN_WIDTH_80P80: -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ case NL80211_CHAN_WIDTH_5: -+ case NL80211_CHAN_WIDTH_10: -+ #endif -+ default: -+ *ht = 0; -+ *bw = CHANNEL_WIDTH_20; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ RTW_INFO("unsupported cwidth:%s\n", nl80211_chan_width_str(chdef->width)); -+ rtw_warn_on(1); -+ }; -+} -+ -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+static const char *nl80211_channel_type_str(enum nl80211_channel_type ctype) -+{ -+ switch (ctype) { -+ case NL80211_CHAN_NO_HT: -+ return "NO_HT"; -+ case NL80211_CHAN_HT20: -+ return "HT20"; -+ case NL80211_CHAN_HT40MINUS: -+ return "HT40-"; -+ case NL80211_CHAN_HT40PLUS: -+ return "HT40+"; -+ default: -+ return "INVALID"; -+ }; -+} -+ -+static enum nl80211_channel_type rtw_chbw_to_nl80211_channel_type(u8 ch, u8 bw, u8 offset, u8 ht) -+{ -+ rtw_warn_on(!ht && (bw >= CHANNEL_WIDTH_40 || offset != HAL_PRIME_CHNL_OFFSET_DONT_CARE)); -+ -+ if (!ht) -+ return NL80211_CHAN_NO_HT; -+ if (bw >= CHANNEL_WIDTH_40) { -+ if (offset == HAL_PRIME_CHNL_OFFSET_UPPER) -+ return NL80211_CHAN_HT40MINUS; -+ else if (offset == HAL_PRIME_CHNL_OFFSET_LOWER) -+ return NL80211_CHAN_HT40PLUS; -+ else -+ rtw_warn_on(1); -+ } -+ return NL80211_CHAN_HT20; -+} -+ -+static void rtw_get_chbw_from_nl80211_channel_type(struct ieee80211_channel *chan, enum nl80211_channel_type ctype, u8 *ht, u8 *ch, u8 *bw, u8 *offset) -+{ -+ int pri_freq; -+ -+ pri_freq = rtw_ch2freq(chan->hw_value); -+ if (!pri_freq) { -+ RTW_INFO("invalid channel:%d\n", chan->hw_value); -+ rtw_warn_on(1); -+ *ch = 0; -+ return; -+ } -+ *ch = chan->hw_value; -+ -+ switch (ctype) { -+ case NL80211_CHAN_NO_HT: -+ *ht = 0; -+ *bw = CHANNEL_WIDTH_20; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case NL80211_CHAN_HT20: -+ *ht = 1; -+ *bw = CHANNEL_WIDTH_20; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case NL80211_CHAN_HT40MINUS: -+ *ht = 1; -+ *bw = CHANNEL_WIDTH_40; -+ *offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ case NL80211_CHAN_HT40PLUS: -+ *ht = 1; -+ *bw = CHANNEL_WIDTH_40; -+ *offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ default: -+ *ht = 0; -+ *bw = CHANNEL_WIDTH_20; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ RTW_INFO("unsupported ctype:%s\n", nl80211_channel_type_str(ctype)); -+ rtw_warn_on(1); -+ }; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+bool rtw_cfg80211_allow_ch_switch_notify(_adapter *adapter) -+{ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) -+ if ((!MLME_IS_AP(adapter)) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) -+ && (!MLME_IS_ADHOC(adapter)) -+ && (!MLME_IS_ADHOC_MASTER(adapter)) -+ && (!MLME_IS_MESH(adapter)) -+#elif defined(CONFIG_RTW_MESH) -+ && (!MLME_IS_MESH(adapter)) -+#endif -+ ) -+ return 0; -+#endif -+ return 1; -+} -+ -+u8 rtw_cfg80211_ch_switch_notify(_adapter *adapter, u8 ch, u8 bw, u8 offset, -+ u8 ht, bool started) -+{ -+ struct wiphy *wiphy = adapter_to_wiphy(adapter); -+ u8 ret = _SUCCESS; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ struct cfg80211_chan_def chdef; -+ -+ ret = rtw_chbw_to_cfg80211_chan_def(wiphy, &chdef, ch, bw, offset, ht); -+ if (ret != _SUCCESS) -+ goto exit; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ if (started) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0)) -+ -+ /* --- cfg80211_ch_switch_started_notfiy() --- -+ * A new parameter, bool quiet, is added from Linux kernel v5.11, -+ * to see if block-tx was requested by the AP. since currently, -+ * the API is used for station before connected in rtw_chk_start_clnt_join() -+ * the quiet is set to false here first. May need to refine it if -+ * called by others with block-tx. -+ */ -+ -+ cfg80211_ch_switch_started_notify(adapter->pnetdev, &chdef, 0, false); -+#else -+ cfg80211_ch_switch_started_notify(adapter->pnetdev, &chdef, 0); -+#endif -+ goto exit; -+ } -+#endif -+ -+ if (!rtw_cfg80211_allow_ch_switch_notify(adapter)) -+ goto exit; -+ -+ cfg80211_ch_switch_notify(adapter->pnetdev, &chdef); -+ -+#else -+ int freq = rtw_ch2freq(ch); -+ enum nl80211_channel_type ctype; -+ -+ if (!rtw_cfg80211_allow_ch_switch_notify(adapter)) -+ goto exit; -+ -+ if (!freq) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ ctype = rtw_chbw_to_nl80211_channel_type(ch, bw, offset, ht); -+ cfg80211_ch_switch_notify(adapter->pnetdev, freq, ctype); -+#endif -+ -+exit: -+ return ret; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) */ -+ -+void rtw_2g_channels_init(struct ieee80211_channel *channels) -+{ -+ _rtw_memcpy((void *)channels, (void *)rtw_2ghz_channels, sizeof(rtw_2ghz_channels)); -+} -+ -+void rtw_5g_channels_init(struct ieee80211_channel *channels) -+{ -+ _rtw_memcpy((void *)channels, (void *)rtw_5ghz_a_channels, sizeof(rtw_5ghz_a_channels)); -+} -+ -+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(BAND_TYPE band) -+{ -+ struct ieee80211_supported_band *spt_band = NULL; -+ int n_channels, n_bitrates; -+ -+ if (rtw_band_to_nl80211_band(band) == NUM_NL80211_BANDS) -+ goto exit; -+ -+ if (band == BAND_ON_2_4G) { -+ n_channels = MAX_CHANNEL_NUM_2G; -+ n_bitrates = RTW_G_RATES_NUM; -+ } else if (band == BAND_ON_5G) { -+ n_channels = MAX_CHANNEL_NUM_5G; -+ 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 = rtw_band_to_nl80211_band(band); -+ spt_band->n_channels = n_channels; -+ spt_band->n_bitrates = n_bitrates; -+ -+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 == NL80211_BAND_2GHZ) { -+ size = sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel) * MAX_CHANNEL_NUM_2G -+ + sizeof(struct ieee80211_rate) * RTW_G_RATES_NUM; -+ } else if (spt_band->band == NL80211_BAND_5GHZ) { -+ size = sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel) * MAX_CHANNEL_NUM_5G -+ + 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_AUTH >> 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 -+#if defined(CONFIG_RTW_MESH) -+ [NL80211_IFTYPE_MESH_POINT] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) -+ | BIT(IEEE80211_STYPE_AUTH >> 4) -+ }, -+#endif -+ -+}; -+#endif -+ -+NDIS_802_11_NETWORK_INFRASTRUCTURE nl80211_iftype_to_rtw_network_type(enum nl80211_iftype type) -+{ -+ switch (type) { -+ case NL80211_IFTYPE_ADHOC: -+ return Ndis802_11IBSS; -+ -+ #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: -+ return Ndis802_11Infrastructure; -+ -+#ifdef CONFIG_AP_MODE -+ #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: -+ return Ndis802_11APMode; -+#endif -+ -+#ifdef CONFIG_RTW_MESH -+ case NL80211_IFTYPE_MESH_POINT: -+ return Ndis802_11_mesh; -+#endif -+ -+#ifdef CONFIG_WIFI_MONITOR -+ case NL80211_IFTYPE_MONITOR: -+ return Ndis802_11Monitor; -+#endif /* CONFIG_WIFI_MONITOR */ -+ -+ default: -+ return Ndis802_11InfrastructureMax; -+ } -+} -+ -+u32 nl80211_iftype_to_rtw_mlme_state(enum nl80211_iftype type) -+{ -+ switch (type) { -+ case NL80211_IFTYPE_ADHOC: -+ return WIFI_ADHOC_STATE; -+ -+ #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: -+ return WIFI_STATION_STATE; -+ -+#ifdef CONFIG_AP_MODE -+ #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: -+ return WIFI_AP_STATE; -+#endif -+ -+#ifdef CONFIG_RTW_MESH -+ case NL80211_IFTYPE_MESH_POINT: -+ return WIFI_MESH_STATE; -+#endif -+ -+ case NL80211_IFTYPE_MONITOR: -+ return WIFI_MONITOR_STATE; -+ -+ default: -+ return WIFI_NULL_STATE; -+ } -+} -+ -+static int rtw_cfg80211_sync_iftype(_adapter *adapter) -+{ -+ struct wireless_dev *rtw_wdev = adapter->rtw_wdev; -+ -+ if (!(nl80211_iftype_to_rtw_mlme_state(rtw_wdev->iftype) & MLME_STATE(adapter))) { -+ /* iftype and mlme state is not syc */ -+ NDIS_802_11_NETWORK_INFRASTRUCTURE network_type; -+ -+ network_type = nl80211_iftype_to_rtw_network_type(rtw_wdev->iftype); -+ if (network_type != Ndis802_11InfrastructureMax) { -+ if (rtw_pwr_wakeup(adapter) == _FAIL) { -+ RTW_WARN(FUNC_ADPT_FMT" call rtw_pwr_wakeup fail\n", FUNC_ADPT_ARG(adapter)); -+ return _FAIL; -+ } -+ -+ rtw_set_802_11_infrastructure_mode(adapter, network_type, 0); -+ rtw_setopmode_cmd(adapter, network_type, RTW_CMDF_WAIT_ACK); -+ } else { -+ rtw_warn_on(1); -+ RTW_WARN(FUNC_ADPT_FMT" iftype:%u is not support\n", FUNC_ADPT_ARG(adapter), rtw_wdev->iftype); -+ return _FAIL; -+ } -+ } -+ -+ return _SUCCESS; -+} -+ -+static u64 rtw_get_systime_us(void) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 20, 0)) -+ return ktime_to_us(ktime_get_boottime()); -+#elif (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) -+{ -+ 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, WIFI_ASOC_STATE) == _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] == BSS_TYPE_BCN) { /* WIFI_BEACON */ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ set_frame_sub_type(pbuf, WIFI_BEACON); -+ } else { -+ _rtw_memcpy(pwlanhdr->addr1, adapter_mac_addr(padapter), ETH_ALEN); -+ set_frame_sub_type(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] == BSS_TYPE_BCN) { /* 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; -+#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 (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)) -+ freq = rtw_ch2freq(cur_network->network.Configuration.DSConfig); -+ if (1) -+ RTW_INFO("chan: %d, freq: %d\n", cur_network->network.Configuration.DSConfig, freq); -+ 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 -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) -+ struct cfg80211_roam_info roam_info ={}; -+#endif -+ -+ 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 (!MLME_IS_STA(padapter)) -+ 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; -+ u32 freq; -+ u16 channel = cur_network->network.Configuration.DSConfig; -+ -+ freq = rtw_ch2freq(channel); -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ #endif -+ -+ #if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) -+ 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); -+ #else -+ 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); -+ #endif /*LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0)*/ -+ -+ RTW_INFO(FUNC_ADPT_FMT" call cfg80211_roamed\n", FUNC_ADPT_ARG(padapter)); -+ -+#ifdef CONFIG_RTW_80211R -+ if (rtw_ft_roam(padapter)) -+ rtw_ft_set_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 -+ -+ if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) != _TRUE) -+ 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 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" ,reason = %d\n", FUNC_ADPT_ARG(padapter), reason); -+ -+ /*always replace privated definitions with wifi reserved value 0*/ -+ if (WLAN_REASON_IS_PRIVATE(reason)) -+ 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 (!MLME_IS_STA(padapter)) -+ 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 RTW_P2P_GROUP_INTERFACE -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ if (pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT) -+ #endif -+ #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_INFO(FUNC_ADPT_FMT" call cfg80211_connect_result, reason:%d\n", FUNC_ADPT_ARG(padapter), reason); -+ rtw_cfg80211_connect_result(pwdev, NULL, NULL, 0, NULL, 0, -+ reason?reason:WLAN_STATUS_UNSPECIFIED_FAILURE, -+ GFP_ATOMIC); -+ } else if (pwdev->sme_state == CFG80211_SME_CONNECTED) { -+ RTW_INFO(FUNC_ADPT_FMT" call cfg80211_disconnected, reason:%d\n", FUNC_ADPT_ARG(padapter), reason); -+ 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, reason:%d\n", FUNC_ADPT_ARG(padapter), reason); -+ rtw_cfg80211_connect_result(pwdev, NULL, NULL, 0, NULL, 0, -+ reason?reason:WLAN_STATUS_UNSPECIFIED_FAILURE, -+ GFP_ATOMIC); -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT" call cfg80211_disconnected, reason:%d\n", FUNC_ADPT_ARG(padapter), reason); -+ 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) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len; -+ struct sta_info *psta = NULL, *pbcmc_sta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ 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'; -+ -+ if (is_broadcast_mac_addr(param->sta_addr)) { -+ if (param->u.crypt.idx >= WEP_KEYS -+ #ifdef CONFIG_IEEE80211W -+ && param->u.crypt.idx > BIP_MAX_KEYID -+ #endif -+ ) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } else { -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (!psta) { -+ ret = -EINVAL; -+ RTW_INFO(FUNC_ADPT_FMT", sta "MAC_FMT" not found\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(param->sta_addr)); -+ 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) { /* group key */ -+ if (param->u.crypt.set_tx == 0) { /* group key, TX only */ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set WEP TX GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ _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(FUNC_ADPT_FMT" set TKIP TX GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ 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)); -+ /* 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(FUNC_ADPT_FMT" set CCMP TX GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ 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 if (strcmp(param->u.crypt.alg, "GCMP") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set GCMP TX GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ psecuritypriv->dot118021XGrpPrivacy = _GCMP_; -+ _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 if (strcmp(param->u.crypt.alg, "GCMP_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set GCMP_256 TX GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ psecuritypriv->dot118021XGrpPrivacy = _GCMP_256_; -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, -+ param->u.crypt.key, -+ (param->u.crypt.key_len > 32 ? 32 : param->u.crypt.key_len)); -+ -+ } else if (strcmp(param->u.crypt.alg, "CCMP_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set CCMP_256 TX GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ psecuritypriv->dot118021XGrpPrivacy = _CCMP_256_; -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, -+ param->u.crypt.key, -+ (param->u.crypt.key_len > 32 ? 32: param->u.crypt.key_len)); -+ -+ #ifdef CONFIG_IEEE80211W -+ } else if (strcmp(param->u.crypt.alg, "BIP") == 0) { -+ psecuritypriv->dot11wCipher = _BIP_CMAC_128_; -+ RTW_INFO(FUNC_ADPT_FMT" set TX CMAC-128 IGTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ _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)); -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ psecuritypriv->dot11wBIPtxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ padapter->securitypriv.binstallBIPkey = _TRUE; -+ goto exit; -+ } else if (strcmp(param->u.crypt.alg, "BIP_GMAC_128") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set TX GMAC-128 IGTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ psecuritypriv->dot11wCipher = _BIP_GMAC_128_; -+ _rtw_memcpy(psecuritypriv->dot11wBIPKey[param->u.crypt.idx].skey, -+ param->u.crypt.key, param->u.crypt.key_len); -+ psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; -+ psecuritypriv->dot11wBIPtxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psecuritypriv->binstallBIPkey = _TRUE; -+ goto exit; -+ } else if (strcmp(param->u.crypt.alg, "BIP_GMAC_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set TX GMAC-256 IGTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ psecuritypriv->dot11wCipher = _BIP_GMAC_256_; -+ _rtw_memcpy(psecuritypriv->dot11wBIPKey[param->u.crypt.idx].skey, -+ param->u.crypt.key, param->u.crypt.key_len); -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ psecuritypriv->dot11wBIPtxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ padapter->securitypriv.binstallBIPkey = _TRUE; -+ goto exit; -+ } else if (strcmp(param->u.crypt.alg, "BIP_CMAC_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set TX CMAC-256 IGTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ psecuritypriv->dot11wCipher = _BIP_CMAC_256_; -+ _rtw_memcpy(psecuritypriv->dot11wBIPKey[param->u.crypt.idx].skey, -+ param->u.crypt.key, param->u.crypt.key_len); -+ psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; -+ psecuritypriv->dot11wBIPtxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psecuritypriv->binstallBIPkey = _TRUE; -+ goto exit; -+ #endif /* CONFIG_IEEE80211W */ -+ -+ } else if (strcmp(param->u.crypt.alg, "none") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" clear group key, idx:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx); -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } else { -+ RTW_WARN(FUNC_ADPT_FMT" set group key, not support\n" -+ , FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta) { -+ pbcmc_sta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ -+ } -+ psecuritypriv->binstallGrpkey = _TRUE; -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ } -+ -+ goto exit; -+ -+ } -+ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) { /* psk/802_1x */ -+ if (param->u.crypt.set_tx == 1) { -+ /* pairwise key */ -+ if (param->u.crypt.key_len == 32) -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, -+ param->u.crypt.key, -+ (param->u.crypt.key_len > 32 ? 32 : param->u.crypt.key_len)); -+ else -+ _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(FUNC_ADPT_FMT" set WEP PTK of "MAC_FMT" idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot118021XPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ psta->dot118021XPrivacy = _WEP104_; -+ -+ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set TKIP PTK of "MAC_FMT" idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot118021XPrivacy = _TKIP_; -+ /* 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(FUNC_ADPT_FMT" set CCMP PTK of "MAC_FMT" idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot118021XPrivacy = _AES_; -+ -+ } else if (strcmp(param->u.crypt.alg, "GCMP") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set GCMP PTK of "MAC_FMT" idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot118021XPrivacy = _GCMP_; -+ -+ } else if (strcmp(param->u.crypt.alg, "GCMP_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set GCMP_256 PTK of "MAC_FMT" idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot118021XPrivacy = _GCMP_256_; -+ -+ } else if (strcmp(param->u.crypt.alg, "CCMP_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set CCMP_256 PTK of "MAC_FMT" idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot118021XPrivacy = _CCMP_256_; -+ -+ } else if (strcmp(param->u.crypt.alg, "none") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" clear pairwise key of "MAC_FMT" idx:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx); -+ psta->dot118021XPrivacy = _NO_PRIVACY_; -+ } else { -+ RTW_WARN(FUNC_ADPT_FMT" set pairwise key of "MAC_FMT", not support\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); -+ goto exit; -+ } -+ -+ psta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psta->dot11rxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psta->ieee8021x_blocked = _FALSE; -+ -+ if (psta->dot118021XPrivacy != _NO_PRIVACY_) { -+ psta->bpairwise_key_installed = _TRUE; -+ -+ /* WPA2 key-handshake has completed */ -+ if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) -+ psta->state &= (~WIFI_UNDER_KEY_HANDSHAKE); -+ } -+ -+ rtw_ap_set_pairwise_key(padapter, psta); -+ } else { -+ /* peer's group key, RX only */ -+ #ifdef CONFIG_RTW_MESH -+ if (strcmp(param->u.crypt.alg, "CCMP") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set CCMP GTK of "MAC_FMT", idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->group_privacy = _AES_; -+ _rtw_memcpy(psta->gtk.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ psta->gtk_bmp |= BIT(param->u.crypt.idx); -+ psta->gtk_pn.val = RTW_GET_LE64(param->u.crypt.seq); -+ -+ } else if (strcmp(param->u.crypt.alg, "GCMP") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set GCMP GTK of "MAC_FMT", idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->group_privacy = _GCMP_; -+ _rtw_memcpy(psta->gtk.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ psta->gtk_bmp |= BIT(param->u.crypt.idx); -+ psta->gtk_pn.val = RTW_GET_LE64(param->u.crypt.seq); -+ -+ } else if (strcmp(param->u.crypt.alg, "CCMP_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set CCMP_256 GTK of "MAC_FMT", idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->group_privacy = _CCMP_256_; -+ _rtw_memcpy(psta->gtk.skey, param->u.crypt.key, (param->u.crypt.key_len > 32 ? 32 : param->u.crypt.key_len)); -+ psta->gtk_bmp |= BIT(param->u.crypt.idx); -+ psta->gtk_pn.val = RTW_GET_LE64(param->u.crypt.seq); -+ -+ } else if (strcmp(param->u.crypt.alg, "GCMP_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set GCMP_256 GTK of "MAC_FMT", idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->group_privacy = _GCMP_256_; -+ _rtw_memcpy(psta->gtk.skey, param->u.crypt.key, (param->u.crypt.key_len > 32 ? 32 : param->u.crypt.key_len)); -+ psta->gtk_bmp |= BIT(param->u.crypt.idx); -+ psta->gtk_pn.val = RTW_GET_LE64(param->u.crypt.seq); -+ -+ #ifdef CONFIG_IEEE80211W -+ } else if (strcmp(param->u.crypt.alg, "BIP") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set CMAC-128 IGTK of "MAC_FMT", idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot11wCipher = _BIP_CMAC_128_; -+ _rtw_memcpy(psta->igtk.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ psta->igtk_bmp |= BIT(param->u.crypt.idx); -+ psta->igtk_id = param->u.crypt.idx; -+ psta->igtk_pn.val = RTW_GET_LE64(param->u.crypt.seq); -+ goto exit; -+ -+ } else if (strcmp(param->u.crypt.alg, "BIP_GMAC_128") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set GMAC-128 IGTK of "MAC_FMT", idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot11wCipher = _BIP_GMAC_128_; -+ _rtw_memcpy(psta->igtk.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ psta->igtk_bmp |= BIT(param->u.crypt.idx); -+ psta->igtk_id = param->u.crypt.idx; -+ psta->igtk_pn.val = RTW_GET_LE64(param->u.crypt.seq); -+ goto exit; -+ -+ } else if (strcmp(param->u.crypt.alg, "BIP_CMAC_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set CMAC-256 IGTK of "MAC_FMT", idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot11wCipher = _BIP_CMAC_256_; -+ _rtw_memcpy(psta->igtk.skey, param->u.crypt.key, (param->u.crypt.key_len > 32 ? 32 : param->u.crypt.key_len)); -+ psta->igtk_bmp |= BIT(param->u.crypt.idx); -+ psta->igtk_id = param->u.crypt.idx; -+ psta->igtk_pn.val = RTW_GET_LE64(param->u.crypt.seq); -+ goto exit; -+ -+ } else if (strcmp(param->u.crypt.alg, "BIP_GMAC_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set GMAC-256 IGTK of "MAC_FMT", idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot11wCipher = _BIP_GMAC_256_; -+ _rtw_memcpy(psta->igtk.skey, param->u.crypt.key, (param->u.crypt.key_len > 32 ? 32 : param->u.crypt.key_len)); -+ psta->igtk_bmp |= BIT(param->u.crypt.idx); -+ psta->igtk_id = param->u.crypt.idx; -+ psta->igtk_pn.val = RTW_GET_LE64(param->u.crypt.seq); -+ goto exit; -+ #endif /* CONFIG_IEEE80211W */ -+ -+ } else if (strcmp(param->u.crypt.alg, "none") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" clear group key of "MAC_FMT", idx:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx); -+ psta->group_privacy = _NO_PRIVACY_; -+ psta->gtk_bmp &= ~BIT(param->u.crypt.idx); -+ } else -+ #endif /* CONFIG_RTW_MESH */ -+ { -+ RTW_WARN(FUNC_ADPT_FMT" set group key of "MAC_FMT", not support\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); -+ goto exit; -+ } -+ -+ #ifdef CONFIG_RTW_MESH -+ rtw_ap_set_sta_key(padapter, psta->cmn.mac_addr, psta->group_privacy -+ , param->u.crypt.key, param->u.crypt.idx, 1); -+ #endif -+ } -+ -+ } -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_AP_MODE */ -+ -+static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param *param) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_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 (is_broadcast_mac_addr(param->sta_addr)) { -+ if (param->u.crypt.idx >= WEP_KEYS -+ #ifdef CONFIG_IEEE80211W -+ && param->u.crypt.idx > BIP_MAX_KEYID -+ #endif -+ ) { -+ 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_ft_roam(padapter)) -+ 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(FUNC_ADPT_FMT" set %s PTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len); -+ -+ if (strcmp(param->u.crypt.alg, "GCMP_256") == 0 -+ || strcmp(param->u.crypt.alg, "CCMP_256") == 0) { -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, -+ param->u.crypt.key, -+ ((param->u.crypt.key_len > 32) ? -+ 32 : param->u.crypt.key_len)); -+ } else -+ _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 */ -+ _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; -+ } -+ psta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psta->dot11rxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psta->bpairwise_key_installed = _TRUE; -+ #ifdef CONFIG_RTW_80211R -+ psta->ft_pairwise_key_installed = _TRUE; -+ #endif -+ 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 -+ || strcmp(param->u.crypt.alg, "GCMP") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set %s GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len); -+ _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); -+ 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, "GCMP_256") == 0 -+ || strcmp(param->u.crypt.alg, "CCMP_256") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set %s GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len); -+ _rtw_memcpy( -+ padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, -+ param->u.crypt.key, -+ (param->u.crypt.key_len > 32 ? 32 : param->u.crypt.key_len)); -+ padapter->securitypriv.binstallGrpkey = _TRUE; -+ 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) { -+ psecuritypriv->dot11wCipher = _BIP_CMAC_128_; -+ RTW_INFO(FUNC_ADPT_FMT" set CMAC-128 IGTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ _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)); -+ psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; -+ psecuritypriv->dot11wBIPrxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psecuritypriv->binstallBIPkey = _TRUE; -+ } else if (strcmp(param->u.crypt.alg, "BIP_GMAC_128") == 0) { -+ psecuritypriv->dot11wCipher = _BIP_GMAC_128_; -+ RTW_INFO(FUNC_ADPT_FMT" set GMAC-128 IGTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ _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)); -+ psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; -+ psecuritypriv->dot11wBIPrxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psecuritypriv->binstallBIPkey = _TRUE; -+ } else if (strcmp(param->u.crypt.alg, "BIP_GMAC_256") == 0) { -+ psecuritypriv->dot11wCipher = _BIP_GMAC_256_; -+ RTW_INFO(FUNC_ADPT_FMT" set GMAC-256 IGTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, -+ param->u.crypt.key, -+ (param->u.crypt.key_len > 32 ? 32 : param->u.crypt.key_len)); -+ psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; -+ psecuritypriv->dot11wBIPrxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psecuritypriv->binstallBIPkey = _TRUE; -+ } else if (strcmp(param->u.crypt.alg, "BIP_CMAC_256") == 0) { -+ psecuritypriv->dot11wCipher = _BIP_CMAC_256_; -+ RTW_INFO(FUNC_ADPT_FMT" set CMAC-256 IGTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ _rtw_memcpy(psecuritypriv->dot11wBIPKey[param->u.crypt.idx].skey, -+ param->u.crypt.key, param->u.crypt.key_len); -+ psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; -+ psecuritypriv->dot11wBIPrxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psecuritypriv->binstallBIPkey = _TRUE; -+ #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 */ -+ -+ /* WPA/WPA2 key-handshake has completed */ -+ clr_fwstate(pmlmepriv, WIFI_UNDER_KEY_HANDSHAKE); -+ -+ } -+ } -+ -+ 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) -+ rtw_wapi_set_set_encryption(padapter, param); -+ #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 -+ , u8 key_index -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ , bool pairwise -+#endif -+ , const u8 *mac_addr, 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 */ -+ -+ if (mac_addr) -+ RTW_INFO(FUNC_NDEV_FMT" adding key for %pM\n", FUNC_NDEV_ARG(ndev), mac_addr); -+ RTW_INFO(FUNC_NDEV_FMT" cipher=0x%x\n", FUNC_NDEV_ARG(ndev), params->cipher); -+ RTW_INFO(FUNC_NDEV_FMT" key_len=%d, key_index=%d\n", FUNC_NDEV_ARG(ndev), params->key_len, key_index); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ RTW_INFO(FUNC_NDEV_FMT" pairwise=%d\n", FUNC_NDEV_ARG(ndev), pairwise); -+#endif -+ -+ if (rtw_cfg80211_sync_iftype(padapter) != _SUCCESS) { -+ ret = -ENOTSUPP; -+ goto addkey_end; -+ } -+ -+ param_len = sizeof(struct ieee_param) + params->key_len; -+ 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; -+ case WIFI_CIPHER_SUITE_GCMP: -+ alg_name = "GCMP"; -+ break; -+ case WIFI_CIPHER_SUITE_GCMP_256: -+ alg_name = "GCMP_256"; -+ break; -+ case WIFI_CIPHER_SUITE_CCMP_256: -+ alg_name = "CCMP_256"; -+ break; -+#ifdef CONFIG_IEEE80211W -+ case WLAN_CIPHER_SUITE_AES_CMAC: -+ alg_name = "BIP"; -+ break; -+ case WIFI_CIPHER_SUITE_BIP_GMAC_128: -+ alg_name = "BIP_GMAC_128"; -+ break; -+ case WIFI_CIPHER_SUITE_BIP_GMAC_256: -+ alg_name = "BIP_GMAC_256"; -+ break; -+ case WIFI_CIPHER_SUITE_BIP_CMAC_256: -+ alg_name = "BIP_CMAC_256"; -+ 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) -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ || !pairwise -+ #endif -+ ) { -+ 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) { -+ _rtw_memcpy(param->u.crypt.seq, (u8 *)params->seq, params->seq_len); -+ RTW_INFO(FUNC_NDEV_FMT" seq_len:%u, seq:0x%llx\n", FUNC_NDEV_ARG(ndev) -+ , params->seq_len, RTW_GET_LE64(param->u.crypt.seq)); -+ } -+ -+ 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); -+ } else if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { -+#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); -+#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); -+ } else -+ RTW_INFO("error! fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); -+ -+ -+addkey_end: -+ if (param) -+ rtw_mfree(param, param_len); -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_get_key(struct wiphy *wiphy, struct net_device *ndev -+ , u8 keyid -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ , bool pairwise -+#endif -+ , const u8 *mac_addr, void *cookie -+ , void (*callback)(void *cookie, struct key_params *)) -+{ -+#define GET_KEY_PARAM_FMT_S " keyid=%d" -+#define GET_KEY_PARAM_ARG_S , keyid -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ #define GET_KEY_PARAM_FMT_2_6_37 ", pairwise=%d" -+ #define GET_KEY_PARAM_ARG_2_6_37 , pairwise -+#else -+ #define GET_KEY_PARAM_FMT_2_6_37 "" -+ #define GET_KEY_PARAM_ARG_2_6_37 -+#endif -+#define GET_KEY_PARAM_FMT_E ", addr=%pM" -+#define GET_KEY_PARAM_ARG_E , mac_addr -+ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *sec = &adapter->securitypriv; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct sta_info *sta = NULL; -+ u32 cipher = _NO_PRIVACY_; -+ union Keytype *key = NULL; -+ u8 key_len = 0; -+ u64 *pn = NULL; -+ u8 pn_len = 0; -+ u8 pn_val[8] = {0}; -+ -+ struct key_params params; -+ int ret = -ENOENT; -+ -+ if (keyid >= WEP_KEYS -+ #ifdef CONFIG_IEEE80211W -+ && keyid > BIP_MAX_KEYID -+ #endif -+ ) -+ goto exit; -+ -+ if (!mac_addr || is_broadcast_ether_addr(mac_addr) -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ || (MLME_IS_STA(adapter) && !pairwise) -+ #endif -+ ) { -+ /* WEP key, TX GTK/IGTK, RX GTK/IGTK(for STA mode) */ -+ if (is_wep_enc(sec->dot118021XGrpPrivacy)) { -+ if (keyid >= WEP_KEYS) -+ goto exit; -+ if (!(sec->key_mask & BIT(keyid))) -+ goto exit; -+ cipher = sec->dot118021XGrpPrivacy; -+ key = &sec->dot11DefKey[keyid]; -+ } else { -+ if (keyid < WEP_KEYS) { -+ if (sec->binstallGrpkey != _TRUE) -+ goto exit; -+ cipher = sec->dot118021XGrpPrivacy; -+ key = &sec->dot118021XGrpKey[keyid]; -+ sta = rtw_get_bcmc_stainfo(adapter); -+ if (sta) -+ pn = &sta->dot11txpn.val; -+ #ifdef CONFIG_IEEE80211W -+ } else if (keyid <= BIP_MAX_KEYID) { -+ if (SEC_IS_BIP_KEY_INSTALLED(sec) != _TRUE) -+ goto exit; -+ cipher = sec->dot11wCipher; -+ key = &sec->dot11wBIPKey[keyid]; -+ pn = &sec->dot11wBIPtxpn.val; -+ #endif -+ } -+ } -+ } else { -+ /* Pairwise key, RX GTK/IGTK for specific peer */ -+ sta = rtw_get_stainfo(stapriv, mac_addr); -+ if (!sta) -+ goto exit; -+ -+ if (keyid < WEP_KEYS && pairwise) { -+ if (sta->bpairwise_key_installed != _TRUE) -+ goto exit; -+ cipher = sta->dot118021XPrivacy; -+ key = &sta->dot118021x_UncstKey; -+ #ifdef CONFIG_RTW_MESH -+ } else if (keyid < WEP_KEYS && !pairwise) { -+ if (!(sta->gtk_bmp & BIT(keyid))) -+ goto exit; -+ cipher = sta->group_privacy; -+ key = &sta->gtk; -+ #ifdef CONFIG_IEEE80211W -+ } else if (keyid <= BIP_MAX_KEYID && !pairwise) { -+ if (!(sta->igtk_bmp & BIT(keyid))) -+ goto exit; -+ cipher = sta->dot11wCipher; -+ key = &sta->igtk; -+ pn = &sta->igtk_pn.val; -+ #endif -+ #endif /* CONFIG_RTW_MESH */ -+ } -+ } -+ -+ if (!key) -+ goto exit; -+ -+ if (cipher == _WEP40_) { -+ cipher = WLAN_CIPHER_SUITE_WEP40; -+ key_len = sec->dot11DefKeylen[keyid]; -+ } else if (cipher == _WEP104_) { -+ cipher = WLAN_CIPHER_SUITE_WEP104; -+ key_len = sec->dot11DefKeylen[keyid]; -+ } else if (cipher == _TKIP_ || cipher == _TKIP_WTMIC_) { -+ cipher = WLAN_CIPHER_SUITE_TKIP; -+ key_len = 16; -+ } else if (cipher == _AES_) { -+ cipher = WLAN_CIPHER_SUITE_CCMP; -+ key_len = 16; -+#ifdef CONFIG_WAPI_SUPPORT -+ } else if (cipher == _SMS4_) { -+ cipher = WLAN_CIPHER_SUITE_SMS4; -+ key_len = 16; -+#endif -+ } else if (cipher == _GCMP_) { -+ cipher = WIFI_CIPHER_SUITE_GCMP; -+ key_len = 16; -+ } else if (cipher == _CCMP_256_) { -+ cipher = WIFI_CIPHER_SUITE_CCMP_256; -+ key_len = 32; -+ } else if (cipher == _GCMP_256_) { -+ cipher = WIFI_CIPHER_SUITE_GCMP_256; -+ key_len = 32; -+ #ifdef CONFIG_IEEE80211W -+ } else if (cipher == _BIP_CMAC_128_) { -+ cipher = WLAN_CIPHER_SUITE_AES_CMAC; -+ key_len = 16; -+ } else if (cipher == _BIP_GMAC_128_) { -+ cipher = WIFI_CIPHER_SUITE_BIP_GMAC_128; -+ key_len = 16; -+ } else if (cipher == _BIP_GMAC_256_) { -+ cipher = WIFI_CIPHER_SUITE_BIP_GMAC_256; -+ key_len = 32; -+ } else if (cipher == _BIP_CMAC_256_) { -+ cipher = WIFI_CIPHER_SUITE_BIP_CMAC_256; -+ key_len = 32; -+ #endif -+ } else { -+ RTW_WARN(FUNC_NDEV_FMT" unknown cipher:%u\n", FUNC_NDEV_ARG(ndev), cipher); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (pn) { -+ *((u64 *)pn_val) = cpu_to_le64(*pn); -+ pn_len = 6; -+ } -+ -+ ret = 0; -+ -+exit: -+ RTW_INFO(FUNC_NDEV_FMT -+ GET_KEY_PARAM_FMT_S -+ GET_KEY_PARAM_FMT_2_6_37 -+ GET_KEY_PARAM_FMT_E -+ " ret %d\n", FUNC_NDEV_ARG(ndev) -+ GET_KEY_PARAM_ARG_S -+ GET_KEY_PARAM_ARG_2_6_37 -+ GET_KEY_PARAM_ARG_E -+ , ret); -+ if (pn) -+ RTW_INFO(FUNC_NDEV_FMT " seq:0x%llx\n", FUNC_NDEV_ARG(ndev), *pn); -+ -+ if (ret == 0) { -+ _rtw_memset(¶ms, 0, sizeof(params)); -+ -+ params.cipher = cipher; -+ params.key = key->skey; -+ params.key_len = key_len; -+ if (pn) { -+ params.seq = pn_val; -+ params.seq_len = pn_len; -+ } -+ -+ callback(cookie, ¶ms); -+ } -+ -+ return ret; -+} -+ -+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, addr=%pM\n", FUNC_NDEV_ARG(ndev), key_index, mac_addr); -+ -+ 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 (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 30)) -+int cfg80211_rtw_set_default_mgmt_key(struct wiphy *wiphy, -+ struct net_device *ndev, u8 key_index) -+{ -+#define SET_DEF_KEY_PARAM_FMT " key_index=%d" -+#define SET_DEF_KEY_PARAM_ARG , key_index -+ -+ RTW_INFO(FUNC_NDEV_FMT -+ SET_DEF_KEY_PARAM_FMT -+ "\n", FUNC_NDEV_ARG(ndev) -+ SET_DEF_KEY_PARAM_ARG -+ ); -+ -+ return 0; -+} -+#endif -+ -+#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*/ -+ -+#ifdef CONFIG_RTW_MESH -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+static enum nl80211_mesh_power_mode rtw_mesh_ps_to_nl80211_mesh_power_mode(u8 ps) -+{ -+ if (ps == RTW_MESH_PS_UNKNOWN) -+ return NL80211_MESH_POWER_UNKNOWN; -+ if (ps == RTW_MESH_PS_ACTIVE) -+ return NL80211_MESH_POWER_ACTIVE; -+ if (ps == RTW_MESH_PS_LSLEEP) -+ return NL80211_MESH_POWER_LIGHT_SLEEP; -+ if (ps == RTW_MESH_PS_DSLEEP) -+ return NL80211_MESH_POWER_DEEP_SLEEP; -+ -+ rtw_warn_on(1); -+ return NL80211_MESH_POWER_UNKNOWN; -+} -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+enum nl80211_plink_state rtw_plink_state_to_nl80211_plink_state(u8 plink_state) -+{ -+ if (plink_state == RTW_MESH_PLINK_UNKNOWN) -+ return NUM_NL80211_PLINK_STATES; -+ if (plink_state == RTW_MESH_PLINK_LISTEN) -+ return NL80211_PLINK_LISTEN; -+ if (plink_state == RTW_MESH_PLINK_OPN_SNT) -+ return NL80211_PLINK_OPN_SNT; -+ if (plink_state == RTW_MESH_PLINK_OPN_RCVD) -+ return NL80211_PLINK_OPN_RCVD; -+ if (plink_state == RTW_MESH_PLINK_CNF_RCVD) -+ return NL80211_PLINK_CNF_RCVD; -+ if (plink_state == RTW_MESH_PLINK_ESTAB) -+ return NL80211_PLINK_ESTAB; -+ if (plink_state == RTW_MESH_PLINK_HOLDING) -+ return NL80211_PLINK_HOLDING; -+ if (plink_state == RTW_MESH_PLINK_BLOCKED) -+ return NL80211_PLINK_BLOCKED; -+ -+ rtw_warn_on(1); -+ return NUM_NL80211_PLINK_STATES; -+} -+ -+u8 nl80211_plink_state_to_rtw_plink_state(enum nl80211_plink_state plink_state) -+{ -+ if (plink_state == NL80211_PLINK_LISTEN) -+ return RTW_MESH_PLINK_LISTEN; -+ if (plink_state == NL80211_PLINK_OPN_SNT) -+ return RTW_MESH_PLINK_OPN_SNT; -+ if (plink_state == NL80211_PLINK_OPN_RCVD) -+ return RTW_MESH_PLINK_OPN_RCVD; -+ if (plink_state == NL80211_PLINK_CNF_RCVD) -+ return RTW_MESH_PLINK_CNF_RCVD; -+ if (plink_state == NL80211_PLINK_ESTAB) -+ return RTW_MESH_PLINK_ESTAB; -+ if (plink_state == NL80211_PLINK_HOLDING) -+ return RTW_MESH_PLINK_HOLDING; -+ if (plink_state == NL80211_PLINK_BLOCKED) -+ return RTW_MESH_PLINK_BLOCKED; -+ -+ rtw_warn_on(1); -+ return RTW_MESH_PLINK_UNKNOWN; -+} -+#endif -+ -+static void rtw_cfg80211_fill_mesh_only_sta_info(struct mesh_plink_ent *plink, struct sta_info *sta, struct station_info *sinfo) -+{ -+ sinfo->filled |= STATION_INFO_LLID; -+ sinfo->llid = plink->llid; -+ sinfo->filled |= STATION_INFO_PLID; -+ sinfo->plid = plink->plid; -+ sinfo->filled |= STATION_INFO_PLINK_STATE; -+ sinfo->plink_state = rtw_plink_state_to_nl80211_plink_state(plink->plink_state); -+ if (!sta && plink->scanned) { -+ sinfo->filled |= STATION_INFO_SIGNAL; -+ sinfo->signal = translate_percentage_to_dbm(plink->scanned->network.PhyInfo.SignalStrength); -+ sinfo->filled |= STATION_INFO_INACTIVE_TIME; -+ if (plink->plink_state == RTW_MESH_PLINK_UNKNOWN) -+ sinfo->inactive_time = 0 - 1; -+ else -+ sinfo->inactive_time = rtw_get_passing_time_ms(plink->scanned->last_scanned); -+ } -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+ if (sta) { -+ sinfo->filled |= STATION_INFO_LOCAL_PM; -+ sinfo->local_pm = rtw_mesh_ps_to_nl80211_mesh_power_mode(sta->local_mps); -+ sinfo->filled |= STATION_INFO_PEER_PM; -+ sinfo->peer_pm = rtw_mesh_ps_to_nl80211_mesh_power_mode(sta->peer_mps); -+ sinfo->filled |= STATION_INFO_NONPEER_PM; -+ sinfo->nonpeer_pm = rtw_mesh_ps_to_nl80211_mesh_power_mode(sta->nonpeer_mps); -+ } -+#endif -+} -+#endif /* CONFIG_RTW_MESH */ -+ -+static void rtw_desc_rate_to_nss_mcs(u8 rate_idx, u8 sgi, u8 *nss, u8 *mcs) -+{ -+ u8 mcs_in = 0, nss_in = 0; -+ -+ if ((DESC_RATEMCS0 <= rate_idx) && -+ (rate_idx <= DESC_RATEMCS31)) { -+ mcs_in = rate_idx - DESC_RATEMCS0; -+ } else if ((DESC_RATEVHTSS1MCS0 <= rate_idx) && -+ (rate_idx <= DESC_RATEVHTSS4MCS9)) { -+ mcs_in = (rate_idx - DESC_RATEVHTSS1MCS0) % 10; -+ nss_in = ((rate_idx - DESC_RATEVHTSS1MCS0) / 10) + 1; -+ } -+ -+ if (nss) -+ *nss = nss_in; -+ if (mcs) -+ *mcs = mcs_in; -+} -+ -+static void sta_set_rate_info(_adapter *adapter, struct rate_info *rinfo, -+ u8 rtw_rate_idx, u8 sgi, u8 bw) -+{ -+ u8 mcs = 0; -+ u8 nss = 0; -+ -+ rinfo->flags = 0; -+ rtw_desc_rate_to_nss_mcs(rtw_rate_idx, sgi, &nss, &mcs); -+ -+ if (sgi) -+ rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+ if (nss) { -+ rinfo->flags |= RATE_INFO_FLAGS_VHT_MCS; -+ rinfo->bw = bw == CHANNEL_WIDTH_160 ? RATE_INFO_BW_160 : -+ bw == CHANNEL_WIDTH_80 ? RATE_INFO_BW_80 : -+ bw == CHANNEL_WIDTH_40 ? RATE_INFO_BW_40 : RATE_INFO_BW_20; -+ rinfo->nss = nss; -+ rinfo->mcs = mcs; -+ } else if (mcs) { -+ rinfo->flags |= RATE_INFO_FLAGS_MCS; -+ rinfo->bw = bw ? RATE_INFO_BW_40 : RATE_INFO_BW_20; -+ rinfo->mcs = mcs; -+ } -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ if (nss) { -+ rinfo->flags |= RATE_INFO_FLAGS_VHT_MCS; -+ rinfo->flags |= bw == CHANNEL_WIDTH_160 ? RATE_INFO_FLAGS_160_MHZ_WIDTH : -+ bw == CHANNEL_WIDTH_80 ? RATE_INFO_FLAGS_80_MHZ_WIDTH : -+ bw == CHANNEL_WIDTH_40 ? RATE_INFO_FLAGS_40_MHZ_WIDTH : 0; -+ rinfo->nss = nss; -+ rinfo->mcs = mcs; -+ } else if (mcs) { -+ rinfo->flags |= RATE_INFO_FLAGS_MCS; -+ rinfo->flags |= bw ? RATE_INFO_FLAGS_40_MHZ_WIDTH : 0; -+ rinfo->mcs = mcs; -+ } -+#else -+ if (nss) { -+ rinfo->legacy = 0; -+ RTW_INFO("Cannot report VHT rate in current kernel version\n"); -+ } else if (mcs) { -+ rinfo->flags |= RATE_INFO_FLAGS_MCS; -+ rinfo->flags |= bw ? RATE_INFO_FLAGS_40_MHZ_WIDTH : 0; -+ rinfo->mcs = mcs; -+ } -+#endif -+ if (nss == 0 && mcs == 0) -+ rinfo->legacy = rtw_desc_rate_to_bitrate(0, rtw_rate_idx, 0); -+} -+ -+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; -+#ifdef CONFIG_RTW_MESH -+ struct mesh_plink_ent *plink = NULL; -+#endif -+ -+ 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, mac); -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ if (psta) -+ plink = psta->plink; -+ if (!plink) -+ plink = rtw_mesh_plink_get(padapter, mac); -+ } -+#endif /* CONFIG_RTW_MESH */ -+ -+ if ((!MLME_IS_MESH(padapter) && !psta) -+ #ifdef CONFIG_RTW_MESH -+ || (MLME_IS_MESH(padapter) && !plink) -+ #endif -+ ) { -+ RTW_INFO(FUNC_NDEV_FMT" no sta info for mac="MAC_FMT"\n" -+ , FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); -+ 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, WIFI_ASOC_STATE) -+ ) { -+ 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); -+ } -+ -+ if (psta) { -+ u8 rtw_rate_idx, sgi, bw; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _FALSE -+ || check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _FALSE -+ ) { -+ sinfo->filled |= STATION_INFO_SIGNAL; -+ sinfo->signal = translate_percentage_to_dbm(psta->cmn.rssi_stat.rssi); -+ } -+ sinfo->filled |= STATION_INFO_INACTIVE_TIME; -+ sinfo->inactive_time = rtw_get_passing_time_ms(psta->sta_stats.last_rx_time); -+ 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; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+ sinfo->filled |= STATION_INFO_RX_BYTES64; -+ sinfo->filled |= STATION_INFO_TX_BYTES64; -+#else -+ sinfo->filled |= STATION_INFO_RX_BYTES; -+ sinfo->filled |= STATION_INFO_TX_BYTES; -+#endif -+ sinfo->rx_bytes = psta->sta_stats.rx_bytes; -+ sinfo->tx_bytes = psta->sta_stats.tx_bytes; -+ -+ /* Although according to cfg80211.h struct station_info */ -+ /* @txrate: current unicast bitrate from this station */ -+ /* We still report sinfo->txrate as bitrate to this station */ -+ sinfo->filled |= STATION_INFO_TX_BITRATE; -+ rtw_rate_idx = rtw_get_current_tx_rate(padapter, psta); -+ sgi = rtw_get_current_tx_sgi(padapter, psta); -+ bw = psta->cmn.bw_mode; -+ sta_set_rate_info(padapter, &sinfo->txrate, rtw_rate_idx, sgi, bw); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) -+ /* Although @rxrate: current unicast bitrate to this station */ -+ /* We report sinfo->rxrate as bitrate from this station */ -+ sinfo->filled |= STATION_INFO_RX_BITRATE; -+ rtw_rate_idx = psta->curr_rx_rate & 0x7f; -+ sgi = (psta->curr_rx_rate & 0x80) >> 7; -+ bw = psta->cmn.bw_mode; -+ sta_set_rate_info(padapter, &sinfo->rxrate, rtw_rate_idx, sgi, bw); -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ if (rtw_get_sta_tx_stat(padapter, psta->cmn.mac_id, psta->cmn.mac_addr) != RTW_NOT_SUPPORT) { -+ sinfo->filled |= STATION_INFO_TX_FAILED; -+ sinfo->filled |= STATION_INFO_TX_RETRIES; -+ sinfo->tx_failed = psta->sta_stats.tx_fail_cnt_sum; -+ sinfo->tx_retries = psta->sta_stats.tx_retry_cnt_sum; -+ } -+#endif -+ } -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) -+ rtw_cfg80211_fill_mesh_only_sta_info(plink, psta, sinfo); -+#endif -+ -+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, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 12, 0)) -+ u32 *flags, -+#endif -+ 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 -+#ifdef CONFIG_MONITOR_MODE_XMIT -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+#endif -+ int ret = 0; -+ u8 change = _FALSE; -+ -+ RTW_INFO(FUNC_NDEV_FMT" type=%d, hw_port:%d\n", FUNC_NDEV_ARG(ndev), type, padapter->hw_port); -+ -+ 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; -+ -+ /* -+ * Disable Power Save in moniter mode, -+ * and enable it after leaving moniter mode. -+ */ -+ if (type == NL80211_IFTYPE_MONITOR) { -+ rtw_ps_deny(padapter, PS_DENY_MONITOR_MODE); -+ LeaveAllPowerSaveMode(padapter); -+ } else if (old_type == NL80211_IFTYPE_MONITOR) { -+ /* driver in moniter mode in last time */ -+ rtw_ps_deny_cancel(padapter, PS_DENY_MONITOR_MODE); -+ } -+ -+ switch (type) { -+ case NL80211_IFTYPE_ADHOC: -+ networkType = Ndis802_11IBSS; -+ break; -+ -+ case NL80211_IFTYPE_STATION: -+ networkType = Ndis802_11Infrastructure; -+ #ifdef CONFIG_P2P -+ if (change && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ #if !RTW_P2P_GROUP_INTERFACE -+ 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; -+ -+ case NL80211_IFTYPE_AP: -+ networkType = Ndis802_11APMode; -+ #ifdef CONFIG_P2P -+ if (change && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ #if !RTW_P2P_GROUP_INTERFACE -+ 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; -+ -+#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) -+ case NL80211_IFTYPE_P2P_CLIENT: -+ networkType = Ndis802_11Infrastructure; -+ if (change && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (!rtw_p2p_enable(padapter, P2P_ROLE_CLIENT)) { -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ } -+ break; -+ -+ case NL80211_IFTYPE_P2P_GO: -+ networkType = Ndis802_11APMode; -+ if (change && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (!rtw_p2p_enable(padapter, P2P_ROLE_GO)) { -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ } -+ break; -+#endif /* defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) */ -+ -+#ifdef CONFIG_RTW_MESH -+ case NL80211_IFTYPE_MESH_POINT: -+ networkType = Ndis802_11_mesh; -+ break; -+#endif -+ -+#ifdef CONFIG_WIFI_MONITOR -+ case NL80211_IFTYPE_MONITOR: -+ networkType = Ndis802_11Monitor; -+ -+#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL -+ ndev->type = ARPHRD_IEEE80211; /* IEEE 802.11 : 801 */ -+#else -+ ndev->type = ARPHRD_IEEE80211_RADIOTAP; /* IEEE 802.11 + radiotap header : 803 */ -+#endif -+ break; -+#endif /* CONFIG_WIFI_MONITOR */ -+ default: -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ rtw_wdev->iftype = type; -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, networkType, 0) == _FALSE) { -+ rtw_wdev->iftype = old_type; -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_WAIT_ACK); -+#ifdef CONFIG_MONITOR_MODE_XMIT -+ if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE) -+ rtw_indicate_connect(padapter); -+#endif -+ -+ #if defined(CONFIG_RTW_WDS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 33)) -+ if (params->use_4addr != -1) { -+ RTW_INFO(FUNC_NDEV_FMT" use_4addr=%d\n" -+ , FUNC_NDEV_ARG(ndev), params->use_4addr); -+ adapter_set_use_wds(padapter, params->use_4addr); -+ } -+ #endif -+ -+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, 8, 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, 8, 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; -+ systime 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); -+ rtw_cfg80211_indicate_scan_done(adapter, _TRUE); -+ } -+ -+ 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) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ RT_CHANNEL_INFO *chset = rfctl->channel_set; -+ _irqL irqL; -+ _list *plist, *phead; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ struct cfg80211_ssid target_ssid; -+ u8 target_wps_scan = 0; -+ u8 ch; -+ -+#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); -+ ch = pnetwork->network.Configuration.DSConfig; -+ -+ /* report network only if the current channel set contains the channel to which this network belongs */ -+ if (rtw_chset_search_ch(chset, ch) >= 0 -+ && rtw_mlme_band_check(padapter, ch) == _TRUE -+ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) -+ && (!IS_DFS_SLAVE_WITH_RD(rfctl) -+ || rtw_rfctl_dfs_domain_unknown(rfctl) -+ || !rtw_chset_is_ch_non_ocp(chset, ch)) -+ ) { -+ 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; -+ -+ attr_contentlen = sizeof(listen_ch_attr); -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, (u8 *)listen_ch_attr, (uint *) &attr_contentlen)) { -+ 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 */ -+ -+ #ifdef CONFIG_RTW_MBO -+ rtw_mbo_update_ie_data(padapter, buf, len); -+ #endif -+ } -+ -+ 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, WIFI_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, WIFI_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; -+ _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 (mlmepriv->scanning_via_buddy_intf == _TRUE) { -+ mlmepriv->scanning_via_buddy_intf = _FALSE; -+ clr_fwstate(mlmepriv, WIFI_UNDER_SURVEY); -+ if (wdev_priv->scan_request) -+ 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; -+ u8 _status = _FALSE; -+ int ret = 0; -+ struct sitesurvey_parm parm; -+ _irqL irqL; -+ 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; -+ u8 ssc_chk; -+ _adapter *padapter; -+ struct wireless_dev *wdev; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct mlme_priv *pmlmepriv = NULL; -+#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_RTW_SCAN_RAND -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ if (request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) { -+ get_random_mask_addr(pwdev_priv->pno_mac_addr, request->mac_addr, -+ request->mac_addr_mask); -+ print_hex_dump(KERN_DEBUG, "random mac_addr: ", -+ DUMP_PREFIX_OFFSET, 16, 1, pwdev_priv->pno_mac_addr, ETH_ALEN, 1); -+ } -+ else -+ memset(pwdev_priv->pno_mac_addr, 0xFF, ETH_ALEN); -+ -+#endif -+#endif -+ -+ -+#if 1 -+ ssc_chk = rtw_sitesurvey_condition_check(padapter, _TRUE); -+ -+ if (ssc_chk == SS_DENY_MP_MODE) -+ goto bypass_p2p_chk; -+#ifdef DBG_LA_MODE -+ if (ssc_chk == SS_DENY_LA_MODE) -+ goto bypass_p2p_chk; -+#endif -+#ifdef CONFIG_P2P -+ if (pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (request->n_ssids && ssids -+ && _rtw_memcmp(ssids[0].ssid, "DIRECT-", 7) -+ && rtw_get_p2p_ie((u8 *)request->ie, request->ie_len, NULL, NULL) -+ ) { -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ if (!rtw_p2p_enable(padapter, P2P_ROLE_DEVICE)) { -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ } 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); -+ -+bypass_p2p_chk: -+ -+ switch (ssc_chk) { -+ case SS_ALLOW : -+ break; -+ -+ case SS_DENY_MP_MODE: -+ ret = -EPERM; -+ goto exit; -+ #ifdef DBG_LA_MODE -+ case SS_DENY_LA_MODE: -+ ret = -EPERM; -+ goto exit; -+ #endif -+ #ifdef CONFIG_RTW_REPEATER_SON -+ case SS_DENY_RSON_SCANING : -+ #endif -+ case SS_DENY_BLOCK_SCAN : -+ case SS_DENY_SELF_AP_UNDER_WPS : -+ case SS_DENY_SELF_AP_UNDER_LINKING : -+ case SS_DENY_SELF_AP_UNDER_SURVEY : -+ case SS_DENY_SELF_STA_UNDER_SURVEY : -+ #ifdef CONFIG_CONCURRENT_MODE -+ case SS_DENY_BUDDY_UNDER_LINK_WPS : -+ #endif -+ case SS_DENY_BUSY_TRAFFIC : -+ case SS_DENY_ADAPTIVITY: -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ -+ case SS_DENY_BY_DRV : -+ #ifdef CONFIG_NOTIFY_SCAN_ABORT_WITH_BUSY -+ ret = -EBUSY; -+ goto exit; -+ #else -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ #endif -+ break; -+ -+ case SS_DENY_SELF_STA_UNDER_LINKING : -+ ret = -EBUSY; -+ goto check_need_indicate_scan_done; -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ case SS_DENY_BUDDY_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 -+ -+ default : -+ RTW_ERR("site survey check code (%d) unknown\n", ssc_chk); -+ 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; -+ } -+ -+#else -+ -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mp_mode_check(padapter)) { -+ RTW_INFO("MP mode block Scan request\n"); -+ ret = -EPERM; -+ goto exit; -+ } -+#endif -+ -+#ifdef CONFIG_P2P -+ if (pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (request->n_ssids && ssids -+ && _rtw_memcmp(ssids[0].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); -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ if (padapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) { -+ RTW_INFO(FUNC_ADPT_FMT" blocking scan for under rson scanning process\n", FUNC_ADPT_ARG(padapter)); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+#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; -+ } -+ -+ if (rtw_is_scan_deny(padapter)) { -+ RTW_INFO(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); -+#ifdef CONFIG_NOTIFY_SCAN_ABORT_WITH_BUSY -+ ret = -EBUSY; -+ goto exit; -+#else -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+#endif -+ } -+ -+ /* 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 | WIFI_UNDER_SURVEY | WIFI_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, WIFI_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, WIFI_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, WIFI_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, WIFI_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 */ -+ -+#ifdef RTW_BUSY_DENY_SCAN -+ /* -+ * busy traffic check -+ * Rules: -+ * 1. If (scan interval <= BUSY_TRAFFIC_SCAN_DENY_PERIOD) always allow -+ * scan, otherwise goto rule 2. -+ * 2. Deny scan if any interface is busy, otherwise allow scan. -+ */ -+ if (pmlmepriv->lastscantime -+ && (rtw_get_passing_time_ms(pmlmepriv->lastscantime) > -+ registry_par->scan_interval_thr) -+ && rtw_mi_busy_traffic_check(padapter)) { -+ RTW_WARN(FUNC_ADPT_FMT ": scan abort!! BusyTraffic\n", -+ FUNC_ADPT_ARG(padapter)); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+#endif /* RTW_BUSY_DENY_SCAN */ -+#endif -+ -+#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); -+ -+ 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_init_sitesurvey_parm(padapter, &parm); -+ -+ /* parsing request ssids, n_ssids */ -+ for (i = 0; i < request->n_ssids && 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(&parm.ssid[i].Ssid, ssids[i].ssid, ssids[i].ssid_len); -+ parm.ssid[i].SsidLength = ssids[i].ssid_len; -+ } -+ parm.ssid_num = i; -+ -+ /* no ssid entry, set the scan type as passvie */ -+ if (request->n_ssids == 0) -+ parm.scan_mode = SCAN_PASSIVE; -+ -+ /* parsing channels, n_channels */ -+ 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 -+ parm.ch[i].hw_value = request->channels[i]->hw_value; -+ parm.ch[i].flags = request->channels[i]->flags; -+ } -+ parm.ch_num = i; -+ -+ if (request->n_channels == 1) { -+ for (i = 1; i < survey_times_for_one_ch; i++) -+ _rtw_memcpy(&parm.ch[i], &parm.ch[0], sizeof(struct rtw_ieee80211_channel)); -+ parm.ch_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(&parm.ch[j * survey_times + i], &parm.ch[j], sizeof(struct rtw_ieee80211_channel)); -+ parm.ch_num = survey_times * request->n_channels; -+ } -+ -+ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _status = rtw_sitesurvey_cmd(padapter, &parm); -+ 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, 8, 0) <= LINUX_VERSION_CODE) -+ struct cfg80211_scan_info info; -+ -+ memset(&info, 0, sizeof(info)); -+ info.aborted = 0; -+#endif -+ /* the process time of scan results must be over at least 1ms in the newly Android */ -+ rtw_msleep_os(1); -+ -+ _rtw_cfg80211_surveydone_event_callback(padapter, request); -+#if (KERNEL_VERSION(4, 8, 0) <= LINUX_VERSION_CODE) -+ cfg80211_scan_done(request, &info); -+#else -+ cfg80211_scan_done(request, 0); -+#endif -+ } -+ -+ if (ps_denied == _TRUE) -+ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); -+ -+exit: -+#ifdef RTW_BUSY_DENY_SCAN -+ if (pmlmepriv) -+ pmlmepriv->lastscantime = rtw_get_current_time(); -+#endif -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 5, 0)) -+static void cfg80211_rtw_abort_scan(struct wiphy *wiphy, -+ struct wireless_dev *wdev) -+{ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ -+ RTW_INFO("=>"FUNC_ADPT_FMT" - Abort Scan\n", FUNC_ADPT_ARG(padapter)); -+ if (wdev->iftype != NL80211_IFTYPE_STATION) { -+ RTW_ERR("abort scan ignored, iftype(%d)\n", wdev->iftype); -+ return; -+ } -+ rtw_scan_abort(padapter); -+} -+#endif -+ -+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); -+ -+ if (NL80211_AUTHTYPE_MAX <= (int)MLME_AUTHTYPE_SAE) { -+ if (MLME_AUTHTYPE_SAE == psecuritypriv->auth_type) { -+ /* This case pre handle in -+ * rtw_check_connect_sae_compat() -+ */ -+ psecuritypriv->auth_alg = WLAN_AUTH_SAE; -+ return 0; -+ } -+ } else if (sme_auth_type == (int)MLME_AUTHTYPE_SAE) { -+ psecuritypriv->auth_type = MLME_AUTHTYPE_SAE; -+ psecuritypriv->auth_alg = WLAN_AUTH_SAE; -+ return 0; -+ } -+ -+ psecuritypriv->auth_type = 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; -+ case WIFI_CIPHER_SUITE_GCMP: -+ *profile_cipher = _GCMP_; -+ ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WIFI_CIPHER_SUITE_GCMP_256: -+ *profile_cipher = _GCMP_256_; -+ ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WIFI_CIPHER_SUITE_CCMP_256: -+ *profile_cipher = _CCMP_256_; -+ 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 if (key_mgt == WLAN_AKM_SUITE_SAE) { -+ psecuritypriv->rsn_akm_suite_type = 8; -+ } 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; -+ int group_cipher = 0, pairwise_cipher = 0; -+ u8 mfp_opt = MFP_NO; -+ int ret = 0; -+ int wpa_ielen = 0; -+ int wpa2_ielen = 0; -+ int rsnx_ielen = 0; -+ u8 *pwpa, *pwpa2, *prsnx; -+ 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); -+ -+ RTW_INFO("set wpa_ie(length:%zu):\n", ielen); -+ RTW_INFO_DUMP(NULL, buf, ielen); -+ -+ 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, NULL, &mfp_opt, 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); -+ } -+ -+ prsnx = rtw_get_ie(buf, WLAN_EID_RSNX, &rsnx_ielen, ielen); -+ if (prsnx && (rsnx_ielen > 0)) { -+ if ((rsnx_ielen + 2) <= MAX_RSNX_IE_LEN) { -+ _rtw_memset(padapter->securitypriv.rsnx_ie, 0, -+ MAX_RSNX_IE_LEN); -+ padapter->securitypriv.rsnx_ie_len = \ -+ (rsnx_ielen + 2); -+ _rtw_memcpy(padapter->securitypriv.rsnx_ie, -+ prsnx, -+ padapter->securitypriv.rsnx_ie_len); -+ } else -+ RTW_ERR("%s:no more buf to save RSNX Cap!\n", -+ __func__); -+ } else { -+ _rtw_memset(padapter->securitypriv.rsnx_ie, 0, -+ MAX_RSNX_IE_LEN); -+ padapter->securitypriv.rsnx_ie_len = 0; -+ } -+ } /* end of (pwpa2 && wpa2_ielen > 0) */ -+ -+ 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_GCMP: -+ padapter->securitypriv.dot118021XGrpPrivacy = _GCMP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_GCMP_256: -+ padapter->securitypriv.dot118021XGrpPrivacy = _GCMP_256_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_CCMP_256: -+ padapter->securitypriv.dot118021XGrpPrivacy = _CCMP_256_; -+ 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_GCMP: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _GCMP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_GCMP_256: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _GCMP_256_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_CCMP_256: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _CCMP_256_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ if (mfp_opt == MFP_INVALID) { -+ RTW_INFO(FUNC_ADPT_FMT" invalid MFP setting\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EINVAL; -+ goto exit; -+ } -+ padapter->securitypriv.mfp_opt = mfp_opt; -+ -+ {/* 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); -+ } -+ -+ {/* handle owe_ie */ -+ uint owe_ielen; -+ u8 *owe_ie; -+ -+ owe_ie = rtw_get_owe_ie(buf, ielen, NULL, &owe_ielen); -+ if (owe_ie && owe_ielen > 0) { -+ RTW_INFO("got owe_ie, owe_ielen:%u\n", owe_ielen); -+ padapter->securitypriv.owe_ie_len = owe_ielen < MAX_OWE_IE_LEN ? owe_ielen : MAX_OWE_IE_LEN; -+ _rtw_memcpy(padapter->securitypriv.owe_ie, owe_ie, padapter->securitypriv.owe_ie_len); -+ } -+ } -+ -+ #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 */ -+ -+ #ifdef CONFIG_RTW_MULTI_AP -+ padapter->multi_ap = rtw_get_multi_ap_ie_ext(buf, ielen) & MULTI_AP_BACKHAUL_STA; -+ if (padapter->multi_ap) -+ adapter_set_use_wds(padapter, 1); -+ #endif -+ -+ /* TKIP and AES disallow multicast packets until installing group key */ -+ if (padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _GCMP_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _GCMP_256_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _CCMP_256_) -+ /* 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_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+#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; -+ } -+ -+ 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, WIFI_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; -+ enum nl80211_iftype old_type; -+ int ret = 0; -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT) -+ rtw_wdev_set_not_indic_disco(adapter_wdev_data(padapter), 1); -+#endif -+ -+ old_type = rtw_wdev->iftype; -+ -+ rtw_set_to_roam(padapter, 0); -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) { -+ rtw_scan_abort(padapter); -+ LeaveAllPowerSaveMode(padapter); -+ -+ rtw_wdev->iftype = NL80211_IFTYPE_STATION; -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, Ndis802_11Infrastructure, 0) == _FALSE) { -+ rtw_wdev->iftype = old_type; -+ ret = -EPERM; -+ goto leave_ibss; -+ } -+ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, RTW_CMDF_WAIT_ACK); -+ } -+ -+leave_ibss: -+#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT) -+ rtw_wdev_set_not_indic_disco(adapter_wdev_data(padapter), 0); -+#endif -+ -+ return 0; -+} -+ -+bool rtw_cfg80211_is_connect_requested(_adapter *adapter) -+{ -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+ _irqL irqL; -+ bool requested; -+ -+ _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); -+ requested = pwdev_priv->connect_req ? 1 : 0; -+ _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); -+ -+ return requested; -+} -+ -+static int _rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ -+ /* if(check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) */ -+ { -+ rtw_scan_abort(padapter); -+ rtw_join_abort_timeout(padapter, 300); -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, RTW_CMDF_WAIT_ACK); -+#ifdef CONFIG_RTW_REPEATER_SON -+ rtw_rson_do_disconnect(padapter); -+#endif -+ RTW_INFO("%s...call rtw_indicate_disconnect\n", __func__); -+ -+ rtw_free_assoc_resources_cmd(padapter, _TRUE, RTW_CMDF_WAIT_ACK); -+ -+ /* indicate locally_generated = 0 when suspend */ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) -+ rtw_indicate_disconnect(padapter, 0, wiphy->dev.power.is_prepared ? _FALSE : _TRUE); -+ #else -+ /* -+ * for kernel < 4.2, DISCONNECT event is hardcoded with -+ * NL80211_ATTR_DISCONNECTED_BY_AP=1 in NL80211 layer -+ * no need to judge if under suspend -+ */ -+ rtw_indicate_disconnect(padapter, 0, _TRUE); -+ #endif -+ -+ rtw_pwr_wakeup(padapter); -+ } -+ return 0; -+} -+ -+#if (KERNEL_VERSION(4, 17, 0) > LINUX_VERSION_CODE) \ -+ && !defined(CONFIG_KERNEL_PATCH_EXTERNAL_AUTH) -+static bool rtw_check_connect_sae_compat(struct cfg80211_connect_params *sme) -+{ -+ struct rtw_ieee802_11_elems elems; -+ struct rsne_info info; -+ u8 AKM_SUITE_SAE[] = { 0x00, 0x0f, 0xac, 8 }; -+ int i; -+ -+ if (sme->auth_type != (int)MLME_AUTHTYPE_SHARED_KEY) -+ return false; -+ -+ if (rtw_ieee802_11_parse_elems((u8 *)sme->ie, sme->ie_len, &elems, 0) -+ == ParseFailed) -+ return false; -+ -+ if (!elems.rsn_ie) -+ return false; -+ -+ if (rtw_rsne_info_parse(elems.rsn_ie - 2, elems.rsn_ie_len + 2, &info) == _FAIL) -+ return false; -+ -+ for (i = 0; i < info.akm_cnt; i++) -+ if (memcmp(info.akm_list + i * RSN_SELECTOR_LEN, -+ AKM_SUITE_SAE, RSN_SELECTOR_LEN) == 0) -+ return true; -+ -+ return false; -+} -+#else -+#define rtw_check_connect_sae_compat(sme) false -+#endif -+ -+static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_connect_params *sme) -+{ -+ int ret = 0; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ NDIS_802_11_SSID ndis_ssid; -+ /* u8 matched_by_bssid=_FALSE; */ -+ /* u8 matched_by_ssid=_FALSE; */ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _irqL irqL; -+ -+#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_CONNECT) -+ rtw_wdev_set_not_indic_disco(pwdev_priv, 1); -+#endif -+ -+ 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 (rtw_check_connect_sae_compat(sme)) { -+ sme->auth_type = (int)MLME_AUTHTYPE_SAE; -+ psecuritypriv->auth_type = MLME_AUTHTYPE_SAE; -+ psecuritypriv->auth_alg = WLAN_AUTH_SAE; -+ RTW_INFO("%s set sme->auth_type for SAE compat\n", __FUNCTION__); -+ } -+ -+ if (pwdev_priv->block == _TRUE) { -+ ret = -EBUSY; -+ RTW_INFO("%s wdev_priv.block is set\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE | WIFI_UNDER_LINKING) == _TRUE) { -+ -+ _rtw_disconnect(wiphy, ndev); -+ RTW_INFO("%s disconnect before connecting! fw_state=0x%x\n", -+ __FUNCTION__, pmlmepriv->fw_state); -+ } -+ -+#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; -+ } -+ -+ rtw_mi_scan_abort(padapter, _TRUE); -+ -+ rtw_join_abort_timeout(padapter, 300); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, WIFI_UNDER_LINKING)) { -+ ret = -EINVAL; -+ goto cancel_ps_deny; -+ } -+#endif -+ -+ _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; -+ psecuritypriv->auth_alg = WLAN_AUTH_OPEN; -+ psecuritypriv->extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE; -+ -+#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); */ -+ -+#ifdef CONFIG_RTW_MBO -+ rtw_mbo_update_ie_data(padapter, (u8 *)sme->ie, sme->ie_len); -+#endif -+ -+ if (rtw_set_802_11_connect(padapter, (u8 *)sme->bssid, &ndis_ssid, \ -+ sme->channel ? sme->channel->hw_value : 0) == _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); -+ -+#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_CONNECT) -+ rtw_wdev_set_not_indic_disco(pwdev_priv, 0); -+#endif -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev, -+ u16 reason_code) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ RTW_INFO(FUNC_NDEV_FMT" - Start to Disconnect\n", FUNC_NDEV_ARG(ndev)); -+ -+#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT) -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ if (!wiphy->dev.power.is_prepared) -+ #endif -+ rtw_wdev_set_not_indic_disco(adapter_wdev_data(padapter), 1); -+#endif -+ -+ rtw_set_to_roam(padapter, 0); -+ -+ /* if(check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) */ -+ { -+ _rtw_disconnect(wiphy, ndev); -+ } -+ -+#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT) -+ rtw_wdev_set_not_indic_disco(adapter_wdev_data(padapter), 0); -+#endif -+ -+ RTW_INFO(FUNC_NDEV_FMT" return 0\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 31)) -+#ifdef CONFIG_RTW_DEBUG -+static const char *nl80211_tx_power_setting_str(int type) -+{ -+ switch (type) { -+ case NL80211_TX_POWER_AUTOMATIC: -+ return "AUTO"; -+ case NL80211_TX_POWER_LIMITED: -+ return "LIMIT"; -+ case NL80211_TX_POWER_FIXED: -+ return "FIX"; -+ default: -+ return "UNKNOWN"; -+ }; -+} -+#endif /* CONFIG_RTW_DEBUG */ -+ -+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 !((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) || defined(COMPAT_KERNEL_RELEASE)) -+ int mbm = dbm * 100; -+#endif -+ struct rtw_wiphy_data *wiphy_data = rtw_wiphy_priv(wiphy); -+ _adapter *adapter = wiphy_to_adapter(wiphy); -+ int ret = -EOPNOTSUPP; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ if (wdev) { -+ RTW_WARN(FUNC_WIPHY_FMT" wdev specific control is not supported\n", FUNC_WIPHY_ARG(wiphy)); -+ goto exit; -+ } -+#endif -+ -+ RTW_INFO(FUNC_WIPHY_FMT" type:%s(%u) mbm:%d\n", FUNC_WIPHY_ARG(wiphy) -+ , nl80211_tx_power_setting_str(type), type, mbm); -+ -+ switch (type) { -+ case NL80211_TX_POWER_AUTOMATIC: -+ wiphy_data->txpwr_total_lmt_mbm = UNSPECIFIED_MBM; -+ wiphy_data->txpwr_total_target_mbm = UNSPECIFIED_MBM; -+ ret = 0; -+ break; -+ case NL80211_TX_POWER_LIMITED: -+ if (!phy_is_txpwr_user_mbm_valid(adapter, mbm)) { -+ RTW_WARN(FUNC_WIPHY_FMT" mbm:%d not support\n", FUNC_WIPHY_ARG(wiphy), mbm); -+ goto exit; -+ } -+ wiphy_data->txpwr_total_lmt_mbm = mbm; -+ wiphy_data->txpwr_total_target_mbm = UNSPECIFIED_MBM; -+ ret = 0; -+ break; -+ case NL80211_TX_POWER_FIXED: -+ if (!phy_is_txpwr_user_mbm_valid(adapter, mbm)) { -+ RTW_WARN(FUNC_WIPHY_FMT" mbm:%d not support\n", FUNC_WIPHY_ARG(wiphy), mbm); -+ goto exit; -+ } -+ wiphy_data->txpwr_total_lmt_mbm = UNSPECIFIED_MBM; -+ wiphy_data->txpwr_total_target_mbm = mbm; -+ ret = 0; -+ break; -+ default: -+ RTW_WARN(FUNC_WIPHY_FMT" unknown type:%d\n", FUNC_WIPHY_ARG(wiphy), type); -+ } -+ -+ if (ret == 0) -+ rtw_run_in_thread_cmd_wait(adapter, ((void *)(rtw_hal_update_txpwr_level)), adapter, 2000); -+ -+exit: -+ return ret; -+} -+ -+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) -+{ -+ struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); -+ s16 mbm; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ if (wdev && wdev_to_ndev(wdev)) { -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); -+ mbm = rtw_adapter_get_oper_txpwr_max_mbm(adapter, 1); -+ RTW_INFO(FUNC_ADPT_FMT" total max: %d mbm\n", FUNC_ADPT_ARG(adapter), mbm); -+ } else -+#endif -+ { -+ mbm = rtw_get_oper_txpwr_max_mbm(dvobj, 1); -+ RTW_INFO(FUNC_WIPHY_FMT" total max: %d mbm\n", FUNC_WIPHY_ARG(wiphy), mbm); -+ } -+ -+ *dbm = mbm / MBM_PDBM; -+ -+ return 0; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 31)) */ -+ -+inline bool rtw_cfg80211_pwr_mgmt(_adapter *adapter) -+{ -+ struct rtw_wdev_priv *rtw_wdev_priv = adapter_wdev_data(adapter); -+ struct wireless_dev *wdev = rtw_wdev_priv->rtw_wdev; -+ -+ return wdev->ps; -+} -+ -+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); -+ -+ RTW_INFO(FUNC_NDEV_FMT" enabled:%u, timeout:%d\n", FUNC_NDEV_ARG(ndev), -+ enabled, timeout); -+ -+#ifdef CONFIG_LPS -+ if (!enabled) -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE_CFG80211_PWRMGMT, 0); -+#endif -+ -+ return 0; -+} -+ -+static void _rtw_set_pmksa(struct net_device *ndev, -+ u8 *bssid, u8 *pmkid) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u8 index, blInserted = _FALSE; -+ -+ /* overwrite PMKID */ -+ for (index = 0 ; index < NUM_PMKID_CACHE; index++) { -+ if (_rtw_memcmp(psecuritypriv->PMKIDList[index].Bssid, bssid, ETH_ALEN) == _TRUE) { -+ /* BSSID is matched, the same AP => rewrite with new PMKID. */ -+ RTW_INFO("BSSID("MAC_FMT") exists in the PMKList.\n", MAC_ARG(bssid)); -+ -+ _rtw_memcpy(psecuritypriv->PMKIDList[index].PMKID, pmkid, WLAN_PMKID_LEN); -+ psecuritypriv->PMKIDList[index].bUsed = _TRUE; -+ blInserted = _TRUE; -+ break; -+ } -+ } -+ -+ if (!blInserted) { -+ /* Find a new entry */ -+ RTW_INFO("Use the new entry index = %d for this PMKID.\n", -+ psecuritypriv->PMKIDIndex); -+ -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, bssid, ETH_ALEN); -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pmkid, WLAN_PMKID_LEN); -+ -+ psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = _TRUE; -+ psecuritypriv->PMKIDIndex++ ; -+ if (psecuritypriv->PMKIDIndex == 16) -+ psecuritypriv->PMKIDIndex = 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 }; -+ bool sae_auth = rtw_sec_chk_auth_type(padapter, MLME_AUTHTYPE_SAE); -+ -+ 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; -+ -+ _rtw_set_pmksa(ndev, (u8 *)pmksa->bssid, (u8 *)pmksa->pmkid); -+ -+ if (sae_auth && -+ (psecuritypriv->extauth_status == WLAN_STATUS_SUCCESS)) { -+ RTW_PRINT("SAE: auth success, start assoc\n"); -+ start_clnt_assoc(padapter); -+ } -+ -+ 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; -+} -+ -+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[ETH_ALEN]; -+ unsigned char dst_mac_addr[ETH_ALEN]; -+ struct rtw_ieee80211_hdr *dot11_hdr; -+ struct ieee80211_radiotap_header *rtap_hdr; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+#ifdef CONFIG_DFS_MASTER -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+#endif -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); -+ -+ if (IS_CH_WAITING(rfctl)) { -+ #ifdef CONFIG_DFS_MASTER -+ if (rtw_rfctl_overlap_radar_detect_ch(rfctl)) -+ goto fail; -+ #endif -+ } -+ -+ 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); -+#ifdef CONFIG_P2P -+dump: -+#endif -+ /* 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; -+ -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 2, 0)) -+static void rtw_cfg80211_monitor_if_set_multicast_list(struct net_device *ndev) -+{ -+ RTW_INFO("%s\n", __func__); -+} -+#endif -+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; -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(4, 11, 8)) -+ mon_ndev->priv_destructor = rtw_ndev_destructor; -+#else -+ mon_ndev->destructor = rtw_ndev_destructor; -+#endif -+ -+#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; -+} -+ -+#ifdef CONFIG_AP_MODE -+void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) -+{ -+#if !defined(RTW_USE_CFG80211_STA_EVENT) && !defined(COMPAT_KERNEL_RELEASE) -+ s32 freq; -+ int channel; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+#endif -+ 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 (get_frame_sub_type(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, get_addr2_ptr(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, const u8 *da, unsigned short reason) -+{ -+#if !defined(RTW_USE_CFG80211_STA_EVENT) && !defined(COMPAT_KERNEL_RELEASE) -+ 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; -+#endif -+ 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++; -+ set_frame_sub_type(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_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 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; -+ -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ if (!rtw_ap_nums_check(adapter)) { -+ RTW_ERR(FUNC_ADPT_FMT"failed, con't support over %d BCN\n", FUNC_ADPT_ARG(adapter), CONFIG_LIMITED_AP_NUM); -+ return -EINVAL; -+ } -+ #endif /*CONFIG_FW_HANDLE_TXBCN*/ -+ -+ pbuf = rtw_zmalloc(head_len + tail_len); -+ if (!pbuf) { -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ -+ /* _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 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)) { -+ -+ if (rtw_p2p_enable(adapter, P2P_ROLE_GO)) { -+ RTW_INFO("Enable P2P function for the first time\n"); -+ adapter->stapriv.expire_to = 3; /* 3x2 = 6 sec in p2p mode */ -+ } else { -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ } 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 */ -+ -+ if (adapter_to_dvobj(adapter)->wpas_type == RTW_WPAS_ANDROID) { -+ /* 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; -+ -+exit: -+ if (pbuf) -+ 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)); -+ -+ if (rtw_cfg80211_sync_iftype(adapter) != _SUCCESS) { -+ ret = -ENOTSUPP; -+ goto exit; -+ } -+ rtw_mi_scan_abort(adapter, _TRUE); -+ rtw_mi_buddy_set_scan_deny(adapter, 300); -+ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); -+ -+exit: -+ 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) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ rtw_stop_ap_cmd(adapter, RTW_CMDF_WAIT_ACK); -+ 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); -+ -+ if (rtw_cfg80211_sync_iftype(adapter) != _SUCCESS) { -+ ret = -ENOTSUPP; -+ goto exit; -+ } -+ -+ if (adapter_to_dvobj(adapter)->wpas_type == RTW_WPAS_W1FI) { -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ /* turn on the beacon send */ -+ pmlmeext->bstart_bss = _TRUE; -+ } -+ -+ /* Kernel < v5.x, the auth_type set as NL80211_AUTHTYPE_AUTOMATIC. if -+ * the AKM SAE in the RSN IE, we have to update the auth_type for SAE in -+ * rtw_check_beacon_data(). -+ * -+ * we only update auth_type when rtw_check_beacon_data() -+ */ -+ /* rtw_cfg80211_set_auth_type(&adapter->securitypriv, settings->auth_type); */ -+ -+ rtw_mi_scan_abort(adapter, _TRUE); -+ rtw_mi_buddy_set_scan_deny(adapter, 300); -+ -+ adapter->mlmeextpriv.mlmext_info.hidden_ssid_mode = settings->hidden_ssid; -+ ret = rtw_add_beacon(adapter, settings->beacon.head, settings->beacon.head_len, -+ settings->beacon.tail, settings->beacon.tail_len); -+ -+#ifdef CONFIG_RTW_80211R_AP -+ rtw_ft_update_assocresp_ies(ndev, settings); -+#endif -+ -+ if (settings->beacon.assocresp_ies && -+ settings->beacon.assocresp_ies_len > 0) { -+ rtw_cfg80211_set_assocresp_ies(ndev, -+ settings->beacon.assocresp_ies, -+ settings->beacon.assocresp_ies_len); -+ } -+ -+ 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); -+ } -+ -+exit: -+ return ret; -+} -+ -+static int rtw_cfg80211_set_assocresp_ies(struct net_device *net, const u8 *buf, int len) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ RTW_INFO("%s, ielen=%d\n", __func__, len); -+ -+ if (len <= 0) -+ goto exit; -+ -+ if (pmlmepriv->assoc_rsp) { -+ u32 free_len = pmlmepriv->assoc_rsp_len; -+ -+ pmlmepriv->assoc_rsp_len = 0; -+ rtw_mfree(pmlmepriv->assoc_rsp, free_len); -+ pmlmepriv->assoc_rsp = NULL; -+ } -+ -+ pmlmepriv->assoc_rsp = rtw_malloc(len); -+ if (pmlmepriv->assoc_rsp == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ } -+ _rtw_memcpy(pmlmepriv->assoc_rsp, buf, len); -+ pmlmepriv->assoc_rsp_len = len; -+ -+exit: -+ 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)); -+ -+#ifdef not_yet -+ /* -+ * @proberesp_ies: extra information element(s) to add into Probe Response -+ * frames or %NULL -+ * @proberesp_ies_len: length of proberesp_ies in octets -+ */ -+ if (info->proberesp_ies_len > 0) -+ rtw_cfg80211_set_proberesp_ies(ndev, info->proberesp_ies, info->proberesp_ies_len); -+#endif /* not_yet */ -+ -+ if (info->assocresp_ies_len > 0) -+ rtw_cfg80211_set_assocresp_ies(ndev, info->assocresp_ies, info->assocresp_ies_len); -+ -+ 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) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ rtw_stop_ap_cmd(adapter, RTW_CMDF_WAIT_ACK); -+ 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)); -+ rtw_macaddr_acl_clear(adapter, RTW_ACL_PERIOD_BSS); -+ 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; -+ -+ rtw_macaddr_acl_clear(adapter, RTW_ACL_PERIOD_BSS); -+ -+ rtw_set_macaddr_acl(adapter, RTW_ACL_PERIOD_BSS, acl_mode); -+ -+ for (i = 0; i < params->n_acl_entries; i++) -+ rtw_acl_add_sta(adapter, RTW_ACL_PERIOD_BSS, params->mac_addrs[i].addr); -+ -+ ret = 0; -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) */ -+ -+const char *_nl80211_sta_flags_str[] = { -+ "INVALID", -+ "AUTHORIZED", -+ "SHORT_PREAMBLE", -+ "WME", -+ "MFP", -+ "AUTHENTICATED", -+ "TDLS_PEER", -+ "ASSOCIATED", -+}; -+ -+#define nl80211_sta_flags_str(_f) ((_f <= NL80211_STA_FLAG_MAX) ? _nl80211_sta_flags_str[_f] : _nl80211_sta_flags_str[0]) -+ -+const char *_nl80211_plink_state_str[] = { -+ "LISTEN", -+ "OPN_SNT", -+ "OPN_RCVD", -+ "CNF_RCVD", -+ "ESTAB", -+ "HOLDING", -+ "BLOCKED", -+ "UNKNOWN", -+}; -+ -+#define nl80211_plink_state_str(_s) ((_s < NUM_NL80211_PLINK_STATES) ? _nl80211_plink_state_str[_s] : _nl80211_plink_state_str[NUM_NL80211_PLINK_STATES]) -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 0)) -+#define NL80211_PLINK_ACTION_NO_ACTION PLINK_ACTION_INVALID -+#define NL80211_PLINK_ACTION_OPEN PLINK_ACTION_OPEN -+#define NL80211_PLINK_ACTION_BLOCK PLINK_ACTION_BLOCK -+#define NUM_NL80211_PLINK_ACTIONS 3 -+#endif -+ -+const char *_nl80211_plink_actions_str[] = { -+ "NO_ACTION", -+ "OPEN", -+ "BLOCK", -+ "UNKNOWN", -+}; -+ -+#define nl80211_plink_actions_str(_a) ((_a < NUM_NL80211_PLINK_ACTIONS) ? _nl80211_plink_actions_str[_a] : _nl80211_plink_actions_str[NUM_NL80211_PLINK_ACTIONS]) -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+const char *_nl80211_mesh_power_mode_str[] = { -+ "UNKNOWN", -+ "ACTIVE", -+ "LIGHT_SLEEP", -+ "DEEP_SLEEP", -+}; -+ -+#define nl80211_mesh_power_mode_str(_p) ((_p <= NL80211_MESH_POWER_MAX) ? _nl80211_mesh_power_mode_str[_p] : _nl80211_mesh_power_mode_str[0]) -+#endif -+ -+void dump_station_parameters(void *sel, struct wiphy *wiphy, const struct station_parameters *params) -+{ -+#if DBG_RTW_CFG80211_STA_PARAM -+ if (params->supported_rates_len) { -+ #define SUPP_RATES_BUF_LEN (3 * RTW_G_RATES_NUM + 1) -+ int i; -+ char supp_rates_buf[SUPP_RATES_BUF_LEN] = {0}; -+ u8 cnt = 0; -+ -+ rtw_warn_on(params->supported_rates_len > RTW_G_RATES_NUM); -+ -+ for (i = 0; i < params->supported_rates_len; i++) { -+ if (i >= RTW_G_RATES_NUM) -+ break; -+ cnt += snprintf(supp_rates_buf + cnt, SUPP_RATES_BUF_LEN - cnt -1 -+ , "%02X ", params->supported_rates[i]); -+ if (cnt >= SUPP_RATES_BUF_LEN - 1) -+ break; -+ } -+ -+ RTW_PRINT_SEL(sel, "supported_rates:%s\n", supp_rates_buf); -+ } -+ -+ if (params->vlan) -+ RTW_PRINT_SEL(sel, "vlan:"NDEV_FMT"\n", NDEV_ARG(params->vlan)); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 31)) -+ if (params->sta_flags_mask) { -+ #define STA_FLAGS_BUF_LEN 128 -+ int i = 0; -+ char sta_flags_buf[STA_FLAGS_BUF_LEN] = {0}; -+ u8 cnt = 0; -+ -+ for (i = 1; i <= NL80211_STA_FLAG_MAX; i++) { -+ if (params->sta_flags_mask & BIT(i)) { -+ cnt += snprintf(sta_flags_buf + cnt, STA_FLAGS_BUF_LEN - cnt -1, "%s=%u " -+ , nl80211_sta_flags_str(i), (params->sta_flags_set & BIT(i)) ? 1 : 0); -+ if (cnt >= STA_FLAGS_BUF_LEN - 1) -+ break; -+ } -+ } -+ -+ RTW_PRINT_SEL(sel, "sta_flags:%s\n", sta_flags_buf); -+ } -+#else -+ u32 station_flags; -+ #error "TBD\n" -+#endif -+ -+ if (params->listen_interval != -1) -+ RTW_PRINT_SEL(sel, "listen_interval:%d\n", params->listen_interval); -+ -+ if (params->aid) -+ RTW_PRINT_SEL(sel, "aid:%u\n", params->aid); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0)) -+ if (params->peer_aid) -+ RTW_PRINT_SEL(sel, "peer_aid:%u\n", params->peer_aid); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)) -+ if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION) -+ RTW_PRINT_SEL(sel, "plink_action:%s\n", nl80211_plink_actions_str(params->plink_action)); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) -+ if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) -+ #endif -+ RTW_PRINT_SEL(sel, "plink_state:%s\n" -+ , nl80211_plink_state_str(params->plink_state)); -+#endif -+ -+#if 0 /* TODO */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 28)) -+ const struct ieee80211_ht_cap *ht_capa; -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ const struct ieee80211_vht_cap *vht_capa; -+#endif -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) -+ RTW_PRINT_SEL(sel, "uapsd_queues:0x%02x\n", params->uapsd_queues); -+ if (params->max_sp) -+ RTW_PRINT_SEL(sel, "max_sp:%u\n", params->max_sp); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+ if (params->local_pm != NL80211_MESH_POWER_UNKNOWN) { -+ RTW_PRINT_SEL(sel, "local_pm:%s\n" -+ , nl80211_mesh_power_mode_str(params->local_pm)); -+ } -+ -+ if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY) -+ RTW_PRINT_SEL(sel, "capability:0x%04x\n", params->capability); -+ -+#if 0 /* TODO */ -+ const u8 *ext_capab; -+ u8 ext_capab_len; -+#endif -+#endif -+ -+#if 0 /* TODO */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) -+ const u8 *supported_channels; -+ u8 supported_channels_len; -+ const u8 *supported_oper_classes; -+ u8 supported_oper_classes_len; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) -+ u8 opmode_notif; -+ bool opmode_notif_used; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 7, 0)) -+ int support_p2p_ps; -+#endif -+#endif -+#endif /* DBG_RTW_CFG80211_STA_PARAM */ -+} -+ -+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; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+#if defined(CONFIG_TDLS) || defined(CONFIG_RTW_MESH) -+ struct sta_priv *pstapriv = &padapter->stapriv; -+#endif -+#ifdef CONFIG_TDLS -+ struct sta_info *psta; -+#endif /* CONFIG_TDLS */ -+ -+ RTW_INFO(FUNC_NDEV_FMT" mac:"MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); -+ -+#if CONFIG_RTW_MACADDR_ACL -+ if (rtw_access_ctrl(padapter, mac) == _FALSE) { -+ RTW_INFO(FUNC_NDEV_FMT" deny by macaddr ACL\n", FUNC_NDEV_ARG(ndev)); -+ ret = -EINVAL; -+ goto exit; -+ } -+#endif -+ -+ dump_station_parameters(RTW_DBGDUMP, wiphy, params); -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ struct rtw_mesh_cfg *mcfg = &padapter->mesh_cfg; -+ struct rtw_mesh_info *minfo = &padapter->mesh_info; -+ struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; -+ struct mesh_plink_ent *plink = NULL; -+ struct wlan_network *scanned = NULL; -+ bool acnode = 0; -+ u8 add_new_sta = 0, probe_req = 0; -+ _irqL irqL; -+ -+ if (params->plink_state != NL80211_PLINK_LISTEN) { -+ RTW_WARN(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(ndev), nl80211_plink_state_str(params->plink_state)); -+ rtw_warn_on(1); -+ } -+ if (!params->aid || params->aid > pstapriv->max_aid) { -+ RTW_WARN(FUNC_NDEV_FMT" invalid aid:%u\n", FUNC_NDEV_ARG(ndev), params->aid); -+ rtw_warn_on(1); -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ plink = _rtw_mesh_plink_get(padapter, mac); -+ if (plink) -+ goto release_plink_ctl; -+ -+ #if CONFIG_RTW_MESH_PEER_BLACKLIST -+ if (rtw_mesh_peer_blacklist_search(padapter, mac)) { -+ RTW_INFO(FUNC_NDEV_FMT" deny by peer blacklist\n" -+ , FUNC_NDEV_ARG(ndev)); -+ ret = -EINVAL; -+ goto release_plink_ctl; -+ } -+ #endif -+ -+ scanned = rtw_find_network(&padapter->mlmepriv.scanned_queue, mac); -+ if (!scanned -+ || rtw_get_passing_time_ms(scanned->last_scanned) >= mcfg->peer_sel_policy.scanr_exp_ms -+ ) { -+ if (!scanned) -+ RTW_INFO(FUNC_NDEV_FMT" corresponding network not found\n", FUNC_NDEV_ARG(ndev)); -+ else -+ RTW_INFO(FUNC_NDEV_FMT" corresponding network too old\n", FUNC_NDEV_ARG(ndev)); -+ -+ if (adapter_to_rfctl(padapter)->offch_state == OFFCHS_NONE) -+ probe_req = 1; -+ -+ ret = -EINVAL; -+ goto release_plink_ctl; -+ } -+ -+ #if CONFIG_RTW_MESH_ACNODE_PREVENT -+ if (plink_ctl->acnode_rsvd) -+ acnode = rtw_mesh_scanned_is_acnode_confirmed(padapter, scanned); -+ #endif -+ -+ /* wpa_supplicant's auto peer will initiate peering when candidate peer is reported without max_peer_links consideration */ -+ if (plink_ctl->num >= mcfg->max_peer_links + acnode ? 1 : 0) { -+ RTW_INFO(FUNC_NDEV_FMT" exceed max_peer_links:%u%s\n" -+ , FUNC_NDEV_ARG(ndev), mcfg->max_peer_links, acnode ? " acn" : ""); -+ ret = -EINVAL; -+ goto release_plink_ctl; -+ } -+ -+ if (!rtw_bss_is_candidate_mesh_peer(padapter, &scanned->network, 1, 1)) { -+ RTW_WARN(FUNC_NDEV_FMT" corresponding network is not candidate with same ch\n" -+ , FUNC_NDEV_ARG(ndev)); -+ ret = -EINVAL; -+ goto release_plink_ctl; -+ } -+ -+ #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ if (!rtw_mesh_cto_mgate_network_filter(padapter, scanned)) { -+ RTW_INFO(FUNC_NDEV_FMT" peer filtered out by cto_mgate check\n" -+ , FUNC_NDEV_ARG(ndev)); -+ ret = -EINVAL; -+ goto release_plink_ctl; -+ } -+ #endif -+ -+ if (_rtw_mesh_plink_add(padapter, mac) == _SUCCESS) { -+ /* hook corresponding network in scan queue */ -+ plink = _rtw_mesh_plink_get(padapter, mac); -+ plink->aid = params->aid; -+ plink->scanned = scanned; -+ -+ #if CONFIG_RTW_MESH_ACNODE_PREVENT -+ if (acnode) { -+ RTW_INFO(FUNC_ADPT_FMT" acnode "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(scanned->network.MacAddress)); -+ } -+ #endif -+ -+ add_new_sta = 1; -+ } else { -+ RTW_WARN(FUNC_NDEV_FMT" rtw_mesh_plink_add not success\n" -+ , FUNC_NDEV_ARG(ndev)); -+ ret = -EINVAL; -+ } -+release_plink_ctl: -+ _exit_critical_bh(&(plink_ctl->lock), &irqL); -+ -+ if (probe_req) -+ issue_probereq(padapter, &padapter->mlmepriv.cur_network.network.mesh_id, mac); -+ -+ if (add_new_sta) { -+ struct station_info sinfo; -+ -+ #ifdef CONFIG_DFS_MASTER -+ if (IS_UNDER_CAC(adapter_to_rfctl(padapter))) -+ rtw_force_stop_cac(adapter_to_rfctl(padapter), 300); -+ #endif -+ -+ /* indicate new sta */ -+ _rtw_memset(&sinfo, 0, sizeof(sinfo)); -+ cfg80211_new_sta(ndev, mac, &sinfo, GFP_ATOMIC); -+ } -+ goto exit; -+ } -+#endif /* CONFIG_RTW_MESH */ -+ -+#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; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) -+ target_mac = mac; -+#else -+ target_mac = params->mac; -+#endif -+ -+ RTW_INFO("+"FUNC_NDEV_FMT" mac=%pM\n", FUNC_NDEV_ARG(ndev), target_mac); -+ -+ if (check_fwstate(pmlmepriv, (WIFI_ASOC_STATE | WIFI_AP_STATE | WIFI_MESH_STATE)) != _TRUE) { -+ RTW_INFO("%s, fw_state != FW_LINKED|WIFI_AP_STATE|WIFI_MESH_STATE\n", __func__); -+ return -EINVAL; -+ } -+ -+ -+ if (!target_mac) { -+ RTW_INFO("flush all sta, and cam_entry\n"); -+ -+ flush_all_cam_entry(padapter); /* clear CAM */ -+ -+#ifdef CONFIG_AP_MODE -+ ret = rtw_sta_flush(padapter, _TRUE); -+#endif -+ 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->cmn.mac_addr, ETH_ALEN)) { -+ if (psta->dot8021xalg == 1 && psta->bpairwise_key_installed == _FALSE) { -+ RTW_INFO("%s, sta's dot8021xalg = 1 and key_installed = _FALSE\n", __func__); -+ -+ #ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(padapter)) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (psta->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt--; -+ #endif -+ STA_SET_MESH_PLINK(psta, NULL); -+ -+ ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_IEEE_802_1X_AUTH_FAILED, _TRUE); -+ psta = NULL; -+ break; -+ } -+ #endif -+ } else { -+ RTW_INFO("free psta=%p, aid=%d\n", psta, psta->cmn.aid); -+ -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (psta->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt--; -+ #endif -+ STA_SET_MESH_PLINK(psta, NULL); -+ -+ /* _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ -+ if (MLME_IS_AP(padapter)) -+ 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); -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) -+ rtw_mesh_plink_del(padapter, target_mac); -+#endif -+ -+ 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) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ int ret = 0; -+ -+ RTW_INFO(FUNC_ADPT_FMT" mac:"MAC_FMT"\n", FUNC_ADPT_ARG(adapter), MAC_ARG(mac)); -+ -+ dump_station_parameters(RTW_DBGDUMP, wiphy, params); -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(adapter)) { -+ enum cfg80211_station_type sta_type = CFG80211_STA_MESH_PEER_USER; -+ u8 plink_state = nl80211_plink_state_to_rtw_plink_state(params->plink_state); -+ -+ ret = cfg80211_check_station_change(wiphy, params, sta_type); -+ if (ret) { -+ RTW_INFO("cfg80211_check_station_change return %d\n", ret); -+ goto exit; -+ } -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) -+ if (!(params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)) -+ goto exit; -+ #endif -+ -+ if (rtw_mesh_set_plink_state_cmd(adapter, mac, plink_state) != _SUCCESS) -+ ret = -ENOENT; -+ } -+ -+exit: -+#endif /* CONFIG_RTW_MESH */ -+ -+ if (ret) -+ RTW_INFO(FUNC_ADPT_FMT" mac:"MAC_FMT" ret:%d\n", FUNC_ADPT_ARG(adapter), MAC_ARG(mac), ret); -+ return ret; -+} -+ -+struct sta_info *rtw_sta_info_get_by_idx(struct sta_priv *pstapriv, const int idx, u8 *asoc_list_num) -+{ -+ _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++; -+ } -+ -+ if (asoc_list_num) -+ *asoc_list_num = i; -+ -+ return psta; -+} -+ -+static int cfg80211_rtw_dump_station(struct wiphy *wiphy, struct net_device *ndev, -+ int idx, u8 *mac, struct station_info *sinfo) -+{ -+#define DBG_DUMP_STATION 0 -+ -+ int ret = 0; -+ _irqL irqL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+#ifdef CONFIG_RTW_MESH -+ struct mesh_plink_ent *plink = NULL; -+#endif -+ u8 asoc_list_num; -+ -+ if (DBG_DUMP_STATION) -+ 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(pstapriv, idx, &asoc_list_num); -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ if (psta) -+ plink = psta->plink; -+ if (!plink) -+ plink = rtw_mesh_plink_get_no_estab_by_idx(padapter, idx - asoc_list_num); -+ } -+#endif /* CONFIG_RTW_MESH */ -+ -+ if ((!MLME_IS_MESH(padapter) && !psta) -+ #ifdef CONFIG_RTW_MESH -+ || (MLME_IS_MESH(padapter) && !plink) -+ #endif -+ ) { -+ if (DBG_DUMP_STATION) -+ RTW_INFO(FUNC_NDEV_FMT" end with idx:%d\n", FUNC_NDEV_ARG(ndev), idx); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ if (psta) -+ _rtw_memcpy(mac, psta->cmn.mac_addr, ETH_ALEN); -+ #ifdef CONFIG_RTW_MESH -+ else -+ _rtw_memcpy(mac, plink->addr, ETH_ALEN); -+ #endif -+ -+ sinfo->filled = 0; -+ -+ if (psta) { -+ sinfo->filled |= STATION_INFO_SIGNAL; -+ sinfo->signal = translate_percentage_to_dbm(psta->cmn.rssi_stat.rssi); -+ sinfo->filled |= STATION_INFO_INACTIVE_TIME; -+ sinfo->inactive_time = rtw_get_passing_time_ms(psta->sta_stats.last_rx_time); -+ } -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) -+ rtw_cfg80211_fill_mesh_only_sta_info(plink, psta, sinfo); -+#endif -+ -+exit: -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 28)) -+static int cfg80211_rtw_change_bss(struct wiphy *wiphy, struct net_device *ndev, -+ struct bss_parameters *params) -+{ -+ _adapter *adapter = rtw_netdev_priv(ndev); -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ -+if (0) { -+ if (params->use_cts_prot != -1) -+ RTW_INFO("use_cts_prot=%d\n", params->use_cts_prot); -+ if (params->use_short_preamble != -1) -+ RTW_INFO("use_short_preamble=%d\n", params->use_short_preamble); -+ if (params->use_short_slot_time != -1) -+ RTW_INFO("use_short_slot_time=%d\n", params->use_short_slot_time); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ if (params->basic_rates && params->basic_rates_len) { -+ RTW_INFO("basic_rates_len=%d\n", params->basic_rates_len); -+ RTW_INFO_DUMP("basic_rates=", params->basic_rates, params->basic_rates_len); -+ } -+#endif -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ if (params->ap_isolate != -1) { -+ RTW_INFO("ap_isolate=%d\n", params->ap_isolate); -+ adapter->mlmepriv.ap_isolate = params->ap_isolate ? 1 : 0; -+ } -+#endif -+ -+if (0) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) -+ if (params->ht_opmode != -1) -+ RTW_INFO("ht_opmode=0x%04x\n", params->ht_opmode); -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ if (params->p2p_ctwindow != -1) -+ RTW_INFO("p2p_ctwindow=%d\n", params->p2p_ctwindow); -+ if (params->p2p_opp_ps != -1) -+ RTW_INFO("p2p_opp_ps=%d\n", params->p2p_opp_ps); -+#endif -+} -+ return 0; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 28)) */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+static int cfg80211_rtw_set_txq_params(struct wiphy *wiphy -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ , struct net_device *ndev -+#endif -+ , struct ieee80211_txq_params *params) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ _adapter *padapter = rtw_netdev_priv(ndev); -+#else -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+#endif -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 ac, AIFS, ECWMin, ECWMax, aSifsTime; -+ u16 TXOP; -+ u8 shift_count = 0; -+ u32 acParm; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ ac = params->ac; -+#else -+ ac = params->queue; -+#endif -+ -+ switch (ac) { -+ case NL80211_TXQ_Q_VO: -+ ac = XMIT_VO_QUEUE; -+ break; -+ -+ case NL80211_TXQ_Q_VI: -+ ac = XMIT_VI_QUEUE; -+ break; -+ -+ case NL80211_TXQ_Q_BE: -+ ac = XMIT_BE_QUEUE; -+ break; -+ -+ case NL80211_TXQ_Q_BK: -+ ac = XMIT_BK_QUEUE; -+ break; -+ -+ default: -+ break; -+ } -+ -+#if 0 -+ RTW_INFO("ac=%d\n", ac); -+ RTW_INFO("txop=%u\n", params->txop); -+ RTW_INFO("cwmin=%u\n", params->cwmin); -+ RTW_INFO("cwmax=%u\n", params->cwmax); -+ RTW_INFO("aifs=%u\n", params->aifs); -+#endif -+ -+ if (is_supported_5g(pmlmeext->cur_wireless_mode) || -+ (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ AIFS = params->aifs * pmlmeinfo->slotTime + aSifsTime; -+ -+ while ((params->cwmin + 1) >> shift_count != 1) { -+ shift_count++; -+ if (shift_count == 15) -+ break; -+ } -+ -+ ECWMin = shift_count; -+ -+ shift_count = 0; -+ while ((params->cwmax + 1) >> shift_count != 1) { -+ shift_count++; -+ if (shift_count == 15) -+ break; -+ } -+ -+ ECWMax = shift_count; -+ -+ TXOP = le16_to_cpu(params->txop); -+ -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ -+ set_txq_params_cmd(padapter, acParm, ac); -+ -+ return 0; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) */ -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 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; -+ } -+ -+ RTW_INFO(FUNC_ADPT_FMT" ch:%d bw:%d, offset:%d\n" -+ , FUNC_ADPT_ARG(padapter), chan_target, chan_width, chan_offset); -+ -+ rtw_set_chbw_cmd(padapter, chan_target, chan_width, chan_offset, RTW_CMDF_WAIT_ACK); -+ -+ return 0; -+} -+#endif /*#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 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; -+} -+*/ -+ -+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, RTW_CMDF_WAIT_ACK); -+ -+ } -+ -+ /* 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 */ -+ attr_contentlen = sizeof(cap_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); -+ #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; -+ } -+#ifdef CONFIG_P2P -+ 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; -+ } -+#endif -+#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 */ -+ -+#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, -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 12, 0)) -+ u32 *flags, -+ #endif -+ 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: -+#ifdef CONFIG_RTW_MESH -+ case NL80211_IFTYPE_MESH_POINT: -+#endif -+ padapter = dvobj_get_unregisterd_adapter(dvobj); -+ if (!padapter) { -+ RTW_WARN("adapter pool empty!\n"); -+ ret = -ENODEV; -+ break; -+ } -+ -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_P2P) -+ #if defined(CONFIG_P2P) && ((KERNEL_VERSION(2, 6, 37) <= LINUX_VERSION_CODE) || defined(COMPAT_KERNEL_RELEASE)) -+ if ((type == NL80211_IFTYPE_P2P_CLIENT || type == NL80211_IFTYPE_P2P_GO) && (padapter->iface_id != padapter->registrypriv.sel_p2p_iface)) { -+ RTW_ERR("%s, iface_id:%d is not P2P interface!\n", __func__, padapter->iface_id); -+ ret = -EOPNOTSUPP; -+ break; -+ } -+ #endif -+ #endif -+ -+ 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: -+ 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; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+static int cfg80211_rtw_get_channel(struct wiphy *wiphy, -+ struct wireless_dev *wdev, -+ struct cfg80211_chan_def *chandef) -+{ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct mlme_ext_priv *mlmeext = &(padapter->mlmeextpriv); -+ u8 ht_option = 0; -+ u8 report = 0; -+ int retval = 1; -+ -+ if (MLME_IS_ASOC(padapter)) { -+#ifdef CONFIG_80211N_HT -+ ht_option = padapter->mlmepriv.htpriv.ht_option; -+#endif /* CONFIG_80211N_HT */ -+ report = 1; -+ } else if (MLME_IS_MONITOR(padapter)) { -+ /* monitor mode always set to HT -+ we don't support sniffer No HT */ -+ ht_option = 1; -+ report = 1; -+ } -+ -+ if (report) { -+ rtw_chbw_to_cfg80211_chan_def(wiphy, chandef, -+ mlmeext->cur_channel, mlmeext->cur_bwmode, -+ mlmeext->cur_ch_offset, ht_option); -+ retval = 0; -+ } -+ -+ return retval; -+} -+ -+static void rtw_get_chbwoff_from_cfg80211_chan_def( -+ struct cfg80211_chan_def *chandef, -+ u8 *ht, u8 *ch, u8 *bw, u8 *offset) -+{ -+ struct ieee80211_channel *chan = chandef->chan; -+ -+ *ch = chan->hw_value; -+ *ht = 1; -+ -+ switch (chandef->width) { -+ case NL80211_CHAN_WIDTH_20_NOHT: -+ *ht = 0; -+ fallthrough; -+ case NL80211_CHAN_WIDTH_20: -+ *bw = CHANNEL_WIDTH_20; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case NL80211_CHAN_WIDTH_40: -+ *bw = CHANNEL_WIDTH_40; -+ *offset = (chandef->center_freq1 > chan->center_freq) ? -+ HAL_PRIME_CHNL_OFFSET_LOWER : HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ case NL80211_CHAN_WIDTH_80: -+ *bw = CHANNEL_WIDTH_80; -+ *offset = (chandef->center_freq1 > chan->center_freq) ? -+ HAL_PRIME_CHNL_OFFSET_LOWER : HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ case NL80211_CHAN_WIDTH_160: -+ *bw = CHANNEL_WIDTH_160; -+ *offset = (chandef->center_freq1 > chan->center_freq) ? -+ HAL_PRIME_CHNL_OFFSET_LOWER : HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ case NL80211_CHAN_WIDTH_80P80: -+ *bw = CHANNEL_WIDTH_80_80; -+ *offset = (chandef->center_freq1 > chan->center_freq) ? -+ HAL_PRIME_CHNL_OFFSET_LOWER : HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ case NL80211_CHAN_WIDTH_5: -+ *bw = CHANNEL_WIDTH_5; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case NL80211_CHAN_WIDTH_10: -+ *bw = CHANNEL_WIDTH_10; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+#endif -+ default: -+ *ht = 0; -+ *bw = CHANNEL_WIDTH_20; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ RTW_INFO("unsupported cwidth:%u\n", chandef->width); -+ rtw_warn_on(1); -+ }; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 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 -+ ) -+{ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ u8 target_channal, target_offset, target_width, ht_option; -+ -+#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" -+ , chandef->chan->center_freq -+ , chandef->chan->hw_value -+ , chandef->width -+ , chandef->center_freq1 -+ , chandef->center_freq2); -+#endif /* CONFIG_DEBUG_CFG80211 */ -+ -+ rtw_get_chbwoff_from_cfg80211_chan_def(chandef, -+ &ht_option, &target_channal, &target_width, &target_offset); -+#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 */ -+ -+ rtw_get_chbw_from_nl80211_channel_type(chan, channel_type, -+ &ht_option, &target_channal, &target_width, &target_offset); -+#endif -+ RTW_INFO(FUNC_ADPT_FMT" ch:%d bw:%d, offset:%d\n", -+ FUNC_ADPT_ARG(padapter), target_channal, -+ target_width, target_offset); -+ -+ rtw_set_chbw_cmd(padapter, target_channal, target_width, -+ target_offset, RTW_CMDF_WAIT_ACK); -+ -+ return 0; -+} -+ -+void rtw_cfg80211_external_auth_request(_adapter *padapter, union recv_frame *rframe) -+{ -+ struct rtw_external_auth_params params; -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ struct net_device *netdev = wdev_to_ndev(wdev); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ u8 frame[256] = { 0 }; -+ uint frame_len = 24; -+ s32 freq = 0; -+ -+ /* rframe, in this case is null point */ -+ -+ freq = rtw_ch2freq(pmlmeext->cur_channel); -+ -+#if (KERNEL_VERSION(4, 17, 0) <= LINUX_VERSION_CODE) \ -+ || defined(CONFIG_KERNEL_PATCH_EXTERNAL_AUTH) -+ params.action = EXTERNAL_AUTH_START; -+ _rtw_memcpy(params.bssid, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ params.ssid.ssid_len = pmlmeinfo->network.Ssid.SsidLength; -+ _rtw_memcpy(params.ssid.ssid, pmlmeinfo->network.Ssid.Ssid, -+ pmlmeinfo->network.Ssid.SsidLength); -+ params.key_mgmt_suite = 0x8ac0f00; -+ -+ RTW_INFO("external auth: use kernel API: cfg80211_external_auth_request()\n"); -+ cfg80211_external_auth_request(netdev, -+ (struct cfg80211_external_auth_params *)¶ms, GFP_ATOMIC); -+#elif (KERNEL_VERSION(2, 6, 37) <= LINUX_VERSION_CODE) -+ set_frame_sub_type(frame, WIFI_AUTH); -+ -+ _rtw_memcpy(frame + 4, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ _rtw_memcpy(frame + 10, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(frame + 16, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ RTW_PUT_LE32((frame + 18), 0x8ac0f00); -+ RTW_PUT_LE32((frame + 24), 0x0003); -+ -+ if (pmlmeinfo->network.Ssid.SsidLength) { -+ *(frame + 26) = pmlmeinfo->network.Ssid.SsidLength; -+ _rtw_memcpy(frame + 27, pmlmeinfo->network.Ssid.Ssid, -+ pmlmeinfo->network.Ssid.SsidLength); -+ frame_len = 27 + pmlmeinfo->network.Ssid.SsidLength; -+ } -+ -+ RTW_INFO("external auth: with wpa_supplicant patch\n"); -+ rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); -+#endif -+} -+ -+void rtw_cfg80211_rx_probe_request(_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); -+ -+ 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), ta="MAC_FMT"\n" -+ , ch, sch, MAC_ARG(get_addr2_ptr(frame))); -+#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_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), ta="MAC_FMT"\n" -+ , ch, sch, MAC_ARG(get_addr2_ptr(frame))); -+#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); -+#ifdef CONFIG_P2P -+indicate: -+#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_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), ta="MAC_FMT"\n" -+ , ch, sch, MAC_ARG(get_addr2_ptr(frame))); -+ #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: -+ rtw_clear_scan_deny(adapter); -+ #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); -+#ifdef CONFIG_P2P -+indicate: -+#endif -+ #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; -+ 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 = -1; -+ -+ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; -+ freq = rtw_ch2freq(ch); -+ -+ RTW_INFO("RTW_Rx:ch=%d(%d), ta="MAC_FMT"\n" -+ , ch, sch, MAC_ARG(get_addr2_ptr(frame))); -+ -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(adapter)) { -+ type = rtw_mesh_check_frames_rx(adapter, frame, frame_len); -+ if (type >= 0) -+ goto indicate; -+ } -+#endif -+ rtw_action_frame_parse(frame, frame_len, &category, &action); -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) { -+ 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*/ -+ } -+ } -+#ifdef CONFIG_RTW_MESH -+indicate: -+#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 -+ -+ if (type == -1) { -+ if (msg) -+ RTW_INFO("RTW_Rx:%s\n", msg); -+ else -+ RTW_INFO("RTW_Rx:category(%u), action(%u)\n", category, action); -+ } -+} -+ -+#ifdef CONFIG_RTW_80211K -+void rtw_cfg80211_rx_rrm_action(_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); -+ -+ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; -+ freq = rtw_ch2freq(ch); -+ -+#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), ta="MAC_FMT"\n" -+ , ch, sch, MAC_ARG(get_addr2_ptr(frame))); -+} -+#endif /* CONFIG_RTW_80211K */ -+ -+void rtw_cfg80211_rx_mframe(_adapter *adapter, union recv_frame *rframe, const char *msg) -+{ -+ 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); -+ -+ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; -+ freq = rtw_ch2freq(ch); -+ -+#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), ta="MAC_FMT"\n", ch, sch, MAC_ARG(get_addr2_ptr(frame))); -+ if (!rtw_sae_preprocess(adapter, frame, frame_len, _FALSE)) { -+ if (msg) -+ RTW_INFO("RTW_Rx:%s\n", msg); -+ else -+ RTW_INFO("RTW_Rx:frame_control:0x%02x\n", le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)rframe)->frame_ctl)); -+ } -+} -+ -+#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 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); -+ wps_devicepassword_id_len = sizeof(wps_devicepassword_id); -+ 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)) { -+ -+ devinfo_contentlen = sizeof(devinfo_content); -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO, devinfo_content, &devinfo_contentlen); -+ capability_len = sizeof(capability); -+ 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++; -+ set_frame_sub_type(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; -+ struct ft_roam_info *pft_roam = 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); -+ pft_roam = &(pmlmepriv->ft_roam); -+ -+ p = (u8 *)ftie->ie; -+ if (ftie->ie_len <= sizeof(pft_roam->updated_ft_ies)) { -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _rtw_memcpy(pft_roam->updated_ft_ies, ftie->ie, ftie->ie_len); -+ pft_roam->updated_ft_ies_len = ftie->ie_len; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ } else { -+ RTW_ERR("FTIEs parsing fail!\n"); -+ return -EINVAL; -+ } -+ -+ if (rtw_ft_roam_status(padapter, RTW_FT_AUTHENTICATED_STA)) { -+ RTW_PRINT("auth success, start reassoc\n"); -+ rtw_ft_lock_set_status(padapter, RTW_FT_ASSOCIATING_STA, &irqL); -+ start_clnt_assoc(padapter); -+ } -+ -+ return 0; -+} -+#endif -+#endif /* CONFIG_P2P */ -+ -+inline void rtw_cfg80211_set_is_roch(_adapter *adapter, bool val) -+{ -+ adapter->rochinfo.is_ro_ch = val; -+ rtw_mi_update_iface_status(&(adapter->mlmepriv), 0); -+} -+ -+inline bool rtw_cfg80211_get_is_roch(_adapter *adapter) -+{ -+ return adapter->rochinfo.is_ro_ch; -+} -+ -+inline bool rtw_cfg80211_is_ro_ch_once(_adapter *adapter) -+{ -+ return adapter->rochinfo.last_ro_ch_time ? 1 : 0; -+} -+ -+inline void rtw_cfg80211_set_last_ro_ch_time(_adapter *adapter) -+{ -+ adapter->rochinfo.last_ro_ch_time = rtw_get_current_time(); -+ -+ if (!adapter->rochinfo.last_ro_ch_time) -+ adapter->rochinfo.last_ro_ch_time++; -+} -+ -+inline s32 rtw_cfg80211_get_last_ro_ch_passing_ms(_adapter *adapter) -+{ -+ return rtw_get_passing_time_ms(adapter->rochinfo.last_ro_ch_time); -+} -+ -+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); -+ _adapter *padapter = NULL; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct roch_info *prochinfo; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo; -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 is_p2p_find = _FALSE; -+#endif -+#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 -+ -+ pwdev_priv = adapter_wdev_data(padapter); -+ prochinfo = &padapter->rochinfo; -+#ifdef CONFIG_P2P -+ pwdinfo = &padapter->wdinfo; -+#ifdef CONFIG_CONCURRENT_MODE -+ is_p2p_find = (duration < (pwdinfo->ext_listen_interval)) ? _TRUE : _FALSE; -+#endif -+#endif -+ -+ *cookie = ATOMIC_INC_RETURN(&prochinfo->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_chset_search_ch(adapter_to_chset(padapter), 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_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); -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_P2P) -+ /*don't scan_abort during p2p_listen.*/ -+ if (is_p2p_find) -+ rtw_mi_buddy_scan_abort(padapter, _TRUE); -+#endif /* defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_P2P) */ -+ -+ if (rtw_cfg80211_get_is_roch(padapter) == _TRUE) { -+ _cancel_timer_ex(&padapter->rochinfo.remain_on_ch_timer); -+ rtw_cancel_roch_cmd(padapter, 0, NULL, RTW_CMDF_WAIT_ACK); -+ } -+ -+#ifdef CONFIG_P2P -+ /* 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) -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_P2P) -+ && ((padapter->iface_id == padapter->registrypriv.sel_p2p_iface)) -+ #endif -+ ) { -+ 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(rtw_get_current_time(), 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 -+ } -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+#endif /* CONFIG_P2P */ -+ -+ #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) && defined(CONFIG_P2P) -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ if (is_p2p_find) /* p2p_find , duration<1000 */ -+ duration = duration + pwdinfo->ext_listen_interval; -+ } -+#endif /* defined (RTW_ROCH_BACK_OP) && defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_P2P) */ -+ -+ rtw_cfg80211_set_is_roch(padapter, _TRUE); -+ prochinfo->ro_ch_wdev = wdev; -+ prochinfo->remain_on_ch_cookie = *cookie; -+ rtw_cfg80211_set_last_ro_ch_time(padapter); -+ _rtw_memcpy(&prochinfo->remain_on_ch_channel, channel, sizeof(struct ieee80211_channel)); -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ prochinfo->remain_on_ch_type = channel_type; -+ #endif -+ prochinfo->restore_channel = rtw_get_oper_ch(padapter); -+ -+ rtw_roch_cmd(padapter, *cookie, wdev, channel, prochinfo->remain_on_ch_type, -+ duration, RTW_CMDF_WAIT_ACK); -+ -+ 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 roch_info *prochinfo; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo; -+#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 -+ -+ pwdev_priv = adapter_wdev_data(padapter); -+ prochinfo = &padapter->rochinfo; -+#ifdef CONFIG_P2P -+ pwdinfo = &padapter->wdinfo; -+#endif -+ -+ 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->rochinfo.remain_on_ch_timer); -+ rtw_cancel_roch_cmd(padapter, cookie, wdev, RTW_CMDF_WAIT_ACK); -+ } -+ -+exit: -+ return err; -+} -+ -+#ifdef CONFIG_P2P -+inline int rtw_cfg80211_iface_has_p2p_group_cap(_adapter *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->n_ssids -+ && wdev_data->scan_request->ssids -+ && wdev_data->scan_request->ie -+ ) { -+ if (_rtw_memcmp(wdev_data->scan_request->ssids[0].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; -+#if defined(RTW_ROCH_BACK_OP) && defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE) -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+#endif -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 u_ch = rtw_mi_get_union_chan(padapter); -+ u8 leave_op = 0; -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#if defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE) -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif -+ -+ 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, WIFI_ASOC_STATE)) { -+ RTW_INFO("%s, extend ro ch time\n", __func__); -+ _set_timer(&padapter->rochinfo.remain_on_ch_timer, pwdinfo->ext_listen_period); -+ } -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ } -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) -+ /* don't set channel, issue frame directly */ -+ goto issue_mgmt_frame; -+ } -+#endif /* CONFIG_MCC_MODE */ -+ -+ if (rtw_mi_check_status(padapter, MI_LINKED) -+ && tx_ch != u_ch -+ ) { -+ rtw_leave_opch(padapter); -+ leave_op = 1; -+ } -+ -+ if (tx_ch != rtw_get_oper_ch(padapter)) -+ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+#ifdef CONFIG_MCC_MODE -+issue_mgmt_frame: -+#endif -+ /* 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 -+ if (!MLME_IS_MESH(padapter)) /* TODO: remove this sleep for all mode */ -+ 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: -+ if (rtw_cfg80211_get_is_roch(padapter) -+ && !rtw_roch_stay_in_cur_chan(padapter) -+ && prochinfo->remain_on_ch_channel.hw_value != u_ch -+ ) { -+ /* roch is ongoing, switch back to rch */ -+ if (prochinfo->remain_on_ch_channel.hw_value != tx_ch) -+ set_channel_bwmode(padapter, prochinfo->remain_on_ch_channel.hw_value -+ , HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } else if (leave_op) { -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ u8 u_bw = rtw_mi_get_union_bw(padapter); -+ u8 u_offset = rtw_mi_get_union_offset(padapter); -+ -+ set_channel_bwmode(padapter, u_ch, u_offset, u_bw); -+ } -+ rtw_back_opch(padapter); -+ } -+ -+ 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; -+ -+} -+ -+u8 rtw_mgnt_tx_handler(_adapter *adapter, u8 *buf) -+{ -+ u8 rst = H2C_CMD_FAIL; -+ struct mgnt_tx_parm *mgnt_parm = (struct mgnt_tx_parm *)buf; -+ -+ if (_cfg80211_rtw_mgmt_tx(adapter, mgnt_parm->tx_ch, mgnt_parm->no_cck, -+ mgnt_parm->buf, mgnt_parm->len, mgnt_parm->wait_ack) == _SUCCESS) -+ rst = H2C_SUCCESS; -+ -+ return rst; -+} -+ -+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; -+ const u8 *buf = params->buf; -+ size_t len = params->len; -+ bool no_cck = params->no_cck; -+#endif -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 2, 0)) -+ bool no_cck = 0; -+#endif -+ int ret = 0; -+ u8 tx_ret; -+ int wait_ack = 1; -+ const u8 *dump_buf = buf; -+ size_t dump_len = len; -+ u32 dump_limit = RTW_MAX_MGMT_TX_CNT; -+ u32 dump_cnt = 0; -+ u32 sleep_ms = 0; -+ u32 retry_guarantee_ms = 0; -+ bool ack = _TRUE; -+ u8 tx_ch; -+ u8 category, action; -+ u8 frame_styp; -+#ifdef CONFIG_P2P -+ u8 is_p2p = 0; -+#endif -+ int type = (-1); -+ systime start = rtw_get_current_time(); -+ _adapter *padapter; -+ struct dvobj_priv *dvobj; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct rf_ctl_t *rfctl; -+ -+#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; -+ } -+ -+ rfctl = adapter_to_rfctl(padapter); -+ tx_ch = (u8)ieee80211_frequency_to_channel(chan->center_freq); -+ if (IS_CH_WAITING(rfctl)) { -+ #ifdef CONFIG_DFS_MASTER -+ if (_rtw_rfctl_overlap_radar_detect_ch(rfctl, tx_ch, CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ #endif -+ } -+ -+ dvobj = adapter_to_dvobj(padapter); -+ pwdev_priv = adapter_wdev_data(padapter); -+ -+ /* cookie generation */ -+ *cookie = pwdev_priv->mgmt_tx_cookie++; -+ -+#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; -+ } -+ else if (frame_styp == RTW_IEEE80211_STYPE_AUTH) { -+ int retval = 0; -+ -+ RTW_INFO("RTW_Tx:tx_ch=%d, no_cck=%u, da="MAC_FMT"\n", tx_ch, no_cck, MAC_ARG(GetAddr1Ptr(buf))); -+ -+ retval = rtw_sae_preprocess(padapter, buf, len, _TRUE); -+ if (retval == 2) -+ goto exit; -+ if (retval == 0) -+ RTW_INFO("RTW_Tx:AUTH\n"); -+ dump_limit = 1; -+ goto dump; -+ } -+ -+ if (rtw_action_frame_parse(buf, len, &category, &action) == _FALSE) { -+ RTW_INFO(FUNC_ADPT_FMT" frame_control:0x%02x\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) { -+ is_p2p = 1; -+ no_cck = 1; /* force no CCK for P2P frames */ -+ goto dump; -+ } -+#endif -+#ifdef CONFIG_RTW_MESH -+ if (MLME_IS_MESH(padapter)) { -+ type = rtw_mesh_check_frames_tx(padapter, &dump_buf, &dump_len); -+ if (type >= 0) { -+ dump_limit = 1; -+ goto dump; -+ } -+ } -+#endif -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) { -+ RTW_INFO("RTW_Tx:%s\n", action_public_str(action)); -+ 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; -+ break; -+ } -+ } -+#ifdef CONFIG_RTW_80211K -+ else if (category == RTW_WLAN_CATEGORY_RADIO_MEAS) -+ RTW_INFO("RTW_Tx: RRM Action\n"); -+#endif -+ 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) { -+ dump_cnt++; -+ -+ rtw_mi_set_scan_deny(padapter, 1000); -+ rtw_mi_scan_abort(padapter, _TRUE); -+ tx_ret = rtw_mgnt_tx_cmd(padapter, tx_ch, no_cck, dump_buf, dump_len, wait_ack, RTW_CMDF_WAIT_ACK); -+ 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)); -+ } -+ -+#ifdef CONFIG_P2P -+ if (is_p2p) { -+ 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_clear_scan_deny(padapter); -+ 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; -+ } -+ } -+#endif /* CONFIG_P2P */ -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_MGNT_TX); -+ -+ if (dump_buf != buf) -+ rtw_mfree((u8 *)dump_buf, dump_len); -+exit: -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 8, 0)) -+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 -+ -+ switch (frame_type) { -+ case IEEE80211_STYPE_AUTH: /* 0x00B0 */ -+ if (reg > 0) -+ SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_AUTH); -+ else -+ CLR_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_AUTH); -+ break; -+ case IEEE80211_STYPE_PROBE_REQ: /* 0x0040 */ -+ if (reg > 0) -+ SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_PROBE_REQ); -+ else -+ CLR_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_PROBE_REQ); -+ break; -+#ifdef not_yet -+ case IEEE80211_STYPE_ACTION: /* 0x00D0 */ -+ if (reg > 0) -+ SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_ACTION); -+ else -+ CLR_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_ACTION); -+ break; -+#endif -+ default: -+ break; -+ } -+ -+exit: -+ return; -+} -+#else -+static void cfg80211_rtw_update_mgmt_frame_register( -+ struct wiphy *wiphy, -+ struct wireless_dev *wdev, -+ struct mgmt_frame_regs *upd) -+{ -+ struct net_device *ndev; -+ _adapter *padapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ u32 rtw_stypes_mask = 0; -+ u32 rtw_mstypes_mask = 0; -+ -+ ndev = wdev_to_ndev(wdev); -+ -+ if (ndev == NULL) -+ goto exit; -+ -+ padapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(padapter); -+ -+ /* Driver only supports Auth and Probe request */ -+ rtw_stypes_mask = BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO(FUNC_ADPT_FMT " global_stypes:0x%08x interface_stypes:0x%08x\n", -+ FUNC_ADPT_ARG(padapter), upd->global_stypes, upd->interface_stypes); -+ RTW_INFO(FUNC_ADPT_FMT " global_mcast_stypes:0x%08x interface_mcast_stypes:0x%08x\n", -+ FUNC_ADPT_ARG(padapter), upd->global_mcast_stypes, upd->interface_mcast_stypes); -+ RTW_INFO(FUNC_ADPT_FMT " old_regs:0x%08x new_regs:0x%08x\n", -+ FUNC_ADPT_ARG(padapter), pwdev_priv->mgmt_regs, -+ (upd->interface_stypes & rtw_stypes_mask)); -+#endif -+ if (pwdev_priv->mgmt_regs != -+ (upd->interface_stypes & rtw_stypes_mask)) { -+ pwdev_priv->mgmt_regs = (upd->interface_stypes & rtw_stypes_mask); -+ } -+ -+exit: -+ return; -+} -+#endif -+ -+#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_is_tdls_enabled(padapter) == _FALSE) { -+ RTW_INFO("TDLS is not enabled\n"); -+ 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; -+ } -+ -+ if (rtw_is_tdls_enabled(padapter) == _FALSE) { -+ RTW_INFO("TDLS is not enabled\n"); -+ return 0; -+ } -+ -+#ifdef CONFIG_LPS -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0); -+#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) { -+ rtw_tdls_set_link_established(padapter, _TRUE); -+ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; -+ ptdls_sta->state |= WIFI_ASOC_STATE; -+ 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_teardown_pre_hdl(padapter, ptdls_sta); -+ rtw_tdls_cmd(padapter, (u8 *)peer, TDLS_TEARDOWN_STA_LOCALLY_POST); -+ } -+ break; -+ } -+ return 0; -+} -+#endif /* CONFIG_TDLS */ -+ -+#if defined(CONFIG_RTW_MESH) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) -+ -+#if DBG_RTW_CFG80211_MESH_CONF -+#define LEGACY_RATES_STR_LEN (RTW_G_RATES_NUM * 5 + 1) -+int get_legacy_rates_str(struct wiphy *wiphy, enum nl80211_band band, u32 mask, char *buf) -+{ -+ int i; -+ int cnt = 0; -+ -+ for (i = 0; i < wiphy->bands[band]->n_bitrates; i++) { -+ if (mask & BIT(i)) { -+ cnt += snprintf(buf + cnt, LEGACY_RATES_STR_LEN - cnt -1, "%d.%d " -+ , wiphy->bands[band]->bitrates[i].bitrate / 10 -+ , wiphy->bands[band]->bitrates[i].bitrate % 10); -+ if (cnt >= LEGACY_RATES_STR_LEN - 1) -+ break; -+ } -+ } -+ -+ return cnt; -+} -+ -+void dump_mesh_setup(void *sel, struct wiphy *wiphy, const struct mesh_setup *setup) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ struct cfg80211_chan_def *chdef = (struct cfg80211_chan_def *)(&setup->chandef); -+#endif -+ struct ieee80211_channel *chan; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ chan = (struct ieee80211_channel *)chdef->chan; -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ chan = (struct ieee80211_channel *)setup->channel; -+#endif -+ -+ RTW_PRINT_SEL(sel, "mesh_id:\"%s\", len:%u\n", setup->mesh_id, setup->mesh_id_len); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ RTW_PRINT_SEL(sel, "sync_method:%u\n", setup->sync_method); -+#endif -+ RTW_PRINT_SEL(sel, "path_sel_proto:%u, path_metric:%u\n", setup->path_sel_proto, setup->path_metric); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ RTW_PRINT_SEL(sel, "auth_id:%u\n", setup->auth_id); -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ if (setup->ie && setup->ie_len) { -+ RTW_PRINT_SEL(sel, "ie:%p, len:%u\n", setup->ie, setup->ie_len); -+ dump_ies(RTW_DBGDUMP, setup->ie, setup->ie_len); -+ } -+#else -+ if (setup->vendor_ie && setup->vendor_ie_len) { -+ RTW_PRINT_SEL(sel, "ie:%p, len:%u\n", setup->vendor_ie, setup->vendor_ie_len); -+ dump_ies(RTW_DBGDUMP, setup->vendor_ie, setup->vendor_ie_len); -+ } -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ RTW_PRINT_SEL(sel, "is_authenticated:%d, is_secure:%d\n", setup->is_authenticated, setup->is_secure); -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) -+ RTW_PRINT_SEL(sel, "user_mpm:%d\n", setup->user_mpm); -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+ RTW_PRINT_SEL(sel, "dtim_period:%u, beacon_interval:%u\n", setup->dtim_period, setup->beacon_interval); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ RTW_PRINT_SEL(sel, "center_freq:%u, ch:%u, width:%s, cfreq1:%u, cfreq2:%u\n" -+ , chan->center_freq, chan->hw_value, nl80211_chan_width_str(chdef->width), chdef->center_freq1, chdef->center_freq2); -+#else -+ RTW_PRINT_SEL(sel, "center_freq:%u, ch:%u, channel_type:%s\n" -+ , chan->center_freq, chan->hw_value, nl80211_channel_type_str(setup->channel_type)); -+#endif -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+ if (setup->mcast_rate[chan->band]) { -+ RTW_PRINT_SEL(sel, "mcast_rate:%d.%d\n" -+ , wiphy->bands[chan->band]->bitrates[setup->mcast_rate[chan->band] - 1].bitrate / 10 -+ , wiphy->bands[chan->band]->bitrates[setup->mcast_rate[chan->band] - 1].bitrate % 10 -+ ); -+ } -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ if (setup->basic_rates) { -+ char buf[LEGACY_RATES_STR_LEN] = {0}; -+ -+ get_legacy_rates_str(wiphy, chan->band, setup->basic_rates, buf); -+ RTW_PRINT_SEL(sel, "basic_rates:%s\n", buf); -+ } -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)) -+ if (setup->beacon_rate.control[chan->band].legacy) { -+ char buf[LEGACY_RATES_STR_LEN] = {0}; -+ -+ get_legacy_rates_str(wiphy, chan->band, setup->beacon_rate.control[chan->band].legacy, buf); -+ RTW_PRINT_SEL(sel, "beacon_rate.legacy:%s\n", buf); -+ } -+ if (*((u32 *)&(setup->beacon_rate.control[chan->band].ht_mcs[0])) -+ || *((u32 *)&(setup->beacon_rate.control[chan->band].ht_mcs[4])) -+ || *((u16 *)&(setup->beacon_rate.control[chan->band].ht_mcs[8])) -+ ) { -+ RTW_PRINT_SEL(sel, "beacon_rate.ht_mcs:"HT_RX_MCS_BMP_FMT"\n" -+ , HT_RX_MCS_BMP_ARG(setup->beacon_rate.control[chan->band].ht_mcs)); -+ } -+ -+ if (setup->beacon_rate.control[chan->band].vht_mcs[0] -+ || setup->beacon_rate.control[chan->band].vht_mcs[1] -+ || setup->beacon_rate.control[chan->band].vht_mcs[2] -+ || setup->beacon_rate.control[chan->band].vht_mcs[3] -+ ) { -+ int i; -+ -+ for (i = 0; i < 4; i++) {/* parsing up to 4SS */ -+ u16 mcs_mask = setup->beacon_rate.control[chan->band].vht_mcs[i]; -+ -+ RTW_PRINT_SEL(sel, "beacon_rate.vht_mcs[%d]:%s\n", i -+ , mcs_mask == 0x00FF ? "0~7" : mcs_mask == 0x01FF ? "0~8" : mcs_mask == 0x03FF ? "0~9" : "invalid"); -+ } -+ } -+ -+ if (setup->beacon_rate.control[chan->band].gi) { -+ RTW_PRINT_SEL(sel, "beacon_rate.gi:%s\n" -+ , setup->beacon_rate.control[chan->band].gi == NL80211_TXRATE_FORCE_SGI ? "SGI" : -+ setup->beacon_rate.control[chan->band].gi == NL80211_TXRATE_FORCE_LGI ? "LGI" : "invalid" -+ ); -+ } -+#endif -+} -+ -+void dump_mesh_config(void *sel, const struct mesh_config *conf) -+{ -+ RTW_PRINT_SEL(sel, "dot11MeshRetryTimeout:%u\n", conf->dot11MeshRetryTimeout); -+ RTW_PRINT_SEL(sel, "dot11MeshConfirmTimeout:%u\n", conf->dot11MeshConfirmTimeout); -+ RTW_PRINT_SEL(sel, "dot11MeshHoldingTimeout:%u\n", conf->dot11MeshHoldingTimeout); -+ RTW_PRINT_SEL(sel, "dot11MeshMaxPeerLinks:%u\n", conf->dot11MeshMaxPeerLinks); -+ RTW_PRINT_SEL(sel, "dot11MeshMaxRetries:%u\n", conf->dot11MeshMaxRetries); -+ RTW_PRINT_SEL(sel, "dot11MeshTTL:%u\n", conf->dot11MeshTTL); -+ RTW_PRINT_SEL(sel, "element_ttl:%u\n", conf->element_ttl); -+ RTW_PRINT_SEL(sel, "auto_open_plinks:%d\n", conf->auto_open_plinks); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ RTW_PRINT_SEL(sel, "dot11MeshNbrOffsetMaxNeighbor:%u\n", conf->dot11MeshNbrOffsetMaxNeighbor); -+#endif -+ -+ RTW_PRINT_SEL(sel, "dot11MeshHWMPmaxPREQretries:%u\n", conf->dot11MeshHWMPmaxPREQretries); -+ RTW_PRINT_SEL(sel, "path_refresh_time:%u\n", conf->path_refresh_time); -+ RTW_PRINT_SEL(sel, "min_discovery_timeout:%u\n", conf->min_discovery_timeout); -+ RTW_PRINT_SEL(sel, "dot11MeshHWMPactivePathTimeout:%u\n", conf->dot11MeshHWMPactivePathTimeout); -+ RTW_PRINT_SEL(sel, "dot11MeshHWMPpreqMinInterval:%u\n", conf->dot11MeshHWMPpreqMinInterval); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+ RTW_PRINT_SEL(sel, "dot11MeshHWMPperrMinInterval:%u\n", conf->dot11MeshHWMPperrMinInterval); -+#endif -+ RTW_PRINT_SEL(sel, "dot11MeshHWMPnetDiameterTraversalTime:%u\n", conf->dot11MeshHWMPnetDiameterTraversalTime); -+ RTW_PRINT_SEL(sel, "dot11MeshHWMPRootMode:%u\n", conf->dot11MeshHWMPRootMode); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ RTW_PRINT_SEL(sel, "dot11MeshHWMPRannInterval:%u\n", conf->dot11MeshHWMPRannInterval); -+ RTW_PRINT_SEL(sel, "dot11MeshGateAnnouncementProtocol:%d\n", conf->dot11MeshGateAnnouncementProtocol); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) -+ RTW_PRINT_SEL(sel, "dot11MeshForwarding:%d\n", conf->dot11MeshForwarding); -+ RTW_PRINT_SEL(sel, "rssi_threshold:%d\n", conf->rssi_threshold); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ RTW_PRINT_SEL(sel, "ht_opmode:0x%04x\n", conf->ht_opmode); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ RTW_PRINT_SEL(sel, "dot11MeshHWMPactivePathToRootTimeout:%u\n", conf->dot11MeshHWMPactivePathToRootTimeout); -+ RTW_PRINT_SEL(sel, "dot11MeshHWMProotInterval:%u\n", conf->dot11MeshHWMProotInterval); -+ RTW_PRINT_SEL(sel, "dot11MeshHWMPconfirmationInterval:%u\n", conf->dot11MeshHWMPconfirmationInterval); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+ RTW_PRINT_SEL(sel, "power_mode:%s\n", nl80211_mesh_power_mode_str(conf->power_mode)); -+ RTW_PRINT_SEL(sel, "dot11MeshAwakeWindowDuration:%u\n", conf->dot11MeshAwakeWindowDuration); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ RTW_PRINT_SEL(sel, "plink_timeout:%u\n", conf->plink_timeout); -+#endif -+} -+#endif /* DBG_RTW_CFG80211_MESH_CONF */ -+ -+static void rtw_cfg80211_mesh_info_set_profile(struct rtw_mesh_info *minfo, const struct mesh_setup *setup) -+{ -+ _rtw_memcpy(minfo->mesh_id, setup->mesh_id, setup->mesh_id_len); -+ minfo->mesh_id_len = setup->mesh_id_len; -+ minfo->mesh_pp_id = setup->path_sel_proto; -+ minfo->mesh_pm_id = setup->path_metric; -+ minfo->mesh_cc_id = 0; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ minfo->mesh_sp_id = setup->sync_method; -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ minfo->mesh_auth_id = setup->auth_id; -+#else -+ if (setup->is_authenticated) { -+ u8 *rsn_ie; -+ sint rsn_ie_len; -+ struct rsne_info info; -+ u8 *akm; -+ u8 AKM_SUITE_SAE[4] = {0x00, 0x0F, 0xAC, 0x08}; -+ -+ rsn_ie = rtw_get_ie(setup->ie, WLAN_EID_RSN, &rsn_ie_len, setup->ie_len); -+ if (!rsn_ie || !rsn_ie_len) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ if (rtw_rsne_info_parse(rsn_ie, rsn_ie_len + 2, &info) != _SUCCESS) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ if (!info.akm_list || !info.akm_cnt) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ akm = info.akm_list; -+ while (akm < info.akm_list + info.akm_cnt * 4) { -+ if (_rtw_memcmp(akm, AKM_SUITE_SAE, 4) == _TRUE) { -+ minfo->mesh_auth_id = 0x01; -+ break; -+ } -+ } -+ -+ if (!minfo->mesh_auth_id) { -+ rtw_warn_on(1); -+ return; -+ } -+ } -+#endif -+} -+ -+static inline bool chk_mesh_attr(enum nl80211_meshconf_params parm, u32 mask) -+{ -+ return (mask >> (parm - 1)) & 0x1; -+} -+ -+static void rtw_cfg80211_mesh_cfg_set(_adapter *adapter, const struct mesh_config *conf, u32 mask) -+{ -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ -+#if 0 /* driver MPM */ -+ if (chk_mesh_attr(NL80211_MESHCONF_RETRY_TIMEOUT, mask)); -+ if (chk_mesh_attr(NL80211_MESHCONF_CONFIRM_TIMEOUT, mask)); -+ if (chk_mesh_attr(NL80211_MESHCONF_HOLDING_TIMEOUT, mask)); -+ if (chk_mesh_attr(NL80211_MESHCONF_MAX_PEER_LINKS, mask)); -+ if (chk_mesh_attr(NL80211_MESHCONF_MAX_RETRIES, mask)); -+#endif -+ -+ if (chk_mesh_attr(NL80211_MESHCONF_TTL, mask)) -+ mcfg->dot11MeshTTL = conf->dot11MeshTTL; -+ if (chk_mesh_attr(NL80211_MESHCONF_ELEMENT_TTL, mask)) -+ mcfg->element_ttl = conf->element_ttl; -+ -+#if 0 /* driver MPM */ -+ if (chk_mesh_attr(NL80211_MESHCONF_AUTO_OPEN_PLINKS, mask)); -+#endif -+ -+#if 0 /* TBD: synchronization */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ if (chk_mesh_attr(NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, mask)); -+#endif -+#endif -+ -+ if (chk_mesh_attr(NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, mask)) -+ mcfg->dot11MeshHWMPmaxPREQretries = conf->dot11MeshHWMPmaxPREQretries; -+ if (chk_mesh_attr(NL80211_MESHCONF_PATH_REFRESH_TIME, mask)) -+ mcfg->path_refresh_time = conf->path_refresh_time; -+ if (chk_mesh_attr(NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, mask)) -+ mcfg->min_discovery_timeout = conf->min_discovery_timeout; -+ if (chk_mesh_attr(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, mask)) -+ mcfg->dot11MeshHWMPactivePathTimeout = conf->dot11MeshHWMPactivePathTimeout; -+ if (chk_mesh_attr(NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, mask)) -+ mcfg->dot11MeshHWMPpreqMinInterval = conf->dot11MeshHWMPpreqMinInterval; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+ if (chk_mesh_attr(NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, mask)) -+ mcfg->dot11MeshHWMPperrMinInterval = conf->dot11MeshHWMPperrMinInterval; -+#endif -+ if (chk_mesh_attr(NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, mask)) -+ mcfg->dot11MeshHWMPnetDiameterTraversalTime = conf->dot11MeshHWMPnetDiameterTraversalTime; -+ -+ if (chk_mesh_attr(NL80211_MESHCONF_HWMP_ROOTMODE, mask)) -+ mcfg->dot11MeshHWMPRootMode = conf->dot11MeshHWMPRootMode; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ if (chk_mesh_attr(NL80211_MESHCONF_GATE_ANNOUNCEMENTS, mask)) -+ mcfg->dot11MeshGateAnnouncementProtocol = conf->dot11MeshGateAnnouncementProtocol; -+ /* our current gate annc implementation rides on root annc with gate annc bit in PREQ flags */ -+ if (mcfg->dot11MeshGateAnnouncementProtocol -+ && mcfg->dot11MeshHWMPRootMode <= RTW_IEEE80211_ROOTMODE_ROOT -+ ) { -+ mcfg->dot11MeshHWMPRootMode = RTW_IEEE80211_PROACTIVE_RANN; -+ RTW_INFO(ADPT_FMT" enable PROACTIVE_RANN becaue gate annc is needed\n", ADPT_ARG(adapter)); -+ } -+ if (chk_mesh_attr(NL80211_MESHCONF_HWMP_RANN_INTERVAL, mask)) -+ mcfg->dot11MeshHWMPRannInterval = conf->dot11MeshHWMPRannInterval; -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) -+ if (chk_mesh_attr(NL80211_MESHCONF_FORWARDING, mask)) -+ mcfg->dot11MeshForwarding = conf->dot11MeshForwarding; -+ -+ if (chk_mesh_attr(NL80211_MESHCONF_RSSI_THRESHOLD, mask)) -+ mcfg->rssi_threshold = conf->rssi_threshold; -+#endif -+ -+#if 0 /* controlled by driver */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ if (chk_mesh_attr(NL80211_MESHCONF_HT_OPMODE, mask)); -+#endif -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ if (chk_mesh_attr(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, mask)) -+ mcfg->dot11MeshHWMPactivePathToRootTimeout = conf->dot11MeshHWMPactivePathToRootTimeout; -+ if (chk_mesh_attr(NL80211_MESHCONF_HWMP_ROOT_INTERVAL, mask)) -+ mcfg->dot11MeshHWMProotInterval = conf->dot11MeshHWMProotInterval; -+ if (chk_mesh_attr(NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, mask)) -+ mcfg->dot11MeshHWMPconfirmationInterval = conf->dot11MeshHWMPconfirmationInterval; -+#endif -+ -+#if 0 /* TBD */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+ if (chk_mesh_attr(NL80211_MESHCONF_POWER_MODE, mask)); -+ if (chk_mesh_attr(NL80211_MESHCONF_AWAKE_WINDOW, mask)); -+#endif -+#endif -+ -+#if 0 /* driver MPM */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ if (chk_mesh_attr(NL80211_MESHCONF_PLINK_TIMEOUT, mask)); -+#endif -+#endif -+} -+ -+u8 *rtw_cfg80211_construct_mesh_beacon_ies(struct wiphy *wiphy, _adapter *adapter -+ , const struct mesh_config *conf, const struct mesh_setup *setup -+ , uint *ies_len) -+{ -+ struct rtw_mesh_info *minfo = &adapter->mesh_info; -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ struct cfg80211_chan_def *chdef = (struct cfg80211_chan_def *)(&setup->chandef); -+#endif -+ struct ieee80211_channel *chan; -+ u8 ch, bw, offset; -+#endif -+ uint len; -+ u8 n_bitrates; -+ u8 ht = 0; -+ u8 vht = 0; -+ u8 *rsn_ie = NULL; -+ sint rsn_ie_len = 0; -+ u8 *ies = NULL, *c; -+ u8 supported_rates[RTW_G_RATES_NUM] = {0}; -+ int i; -+ -+ *ies_len = 0; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ chan = (struct ieee80211_channel *)chdef->chan; -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ chan = (struct ieee80211_channel *)setup->channel; -+#endif -+ -+ n_bitrates = wiphy->bands[chan->band]->n_bitrates; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ rtw_get_chbw_from_cfg80211_chan_def(chdef, &ht, &ch, &bw, &offset); -+#else -+ rtw_get_chbw_from_nl80211_channel_type(chan, setup->channel_type, &ht, &ch, &bw, &offset); -+#endif -+ if (!ch) -+ goto exit; -+ -+#if defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ vht = ht && ch > 14 && bw >= CHANNEL_WIDTH_80; /* VHT40/VHT20? */ -+#endif -+ -+ RTW_INFO(FUNC_ADPT_FMT" => ch:%u,%u,%u, ht:%u, vht:%u\n" -+ , FUNC_ADPT_ARG(adapter), ch, bw, offset, ht, vht); -+#endif -+ -+ rsn_ie = rtw_get_ie(setup->ie, WLAN_EID_RSN, &rsn_ie_len, setup->ie_len); -+ if (rsn_ie && !rsn_ie_len) { -+ rtw_warn_on(1); -+ rsn_ie = NULL; -+ } -+ -+ len = _BEACON_IE_OFFSET_ -+ + 2 /* 0-length SSID */ -+ + (n_bitrates >= 8 ? 8 : n_bitrates) + 2 /* Supported Rates */ -+ + 3 /* DS parameter set */ -+ + 6 /* TIM */ -+ + (n_bitrates > 8 ? n_bitrates - 8 + 2 : 0) /* Extended Supported Rates */ -+ + (rsn_ie ? rsn_ie_len + 2 : 0) /* RSN */ -+ #if defined(CONFIG_80211N_HT) -+ + (ht ? HT_CAP_IE_LEN + 2 + HT_OP_IE_LEN + 2 : 0) /* HT */ -+ #endif -+ #if defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ + (vht ? VHT_CAP_IE_LEN + 2 + VHT_OP_IE_LEN + 2 : 0) /* VHT */ -+ #endif -+ + minfo->mesh_id_len + 2 /* Mesh ID */ -+ + 9 /* Mesh configuration */ -+ ; -+ -+ ies = rtw_zmalloc(len); -+ if (!ies) -+ goto exit; -+ -+ /* timestamp */ -+ c = ies + 8; -+ -+ /* beacon interval */ -+ RTW_PUT_LE16(c , setup->beacon_interval); -+ c += 2; -+ -+ /* capability */ -+ if (rsn_ie) -+ *((u16 *)c) |= cpu_to_le16(cap_Privacy); -+ c += 2; -+ -+ /* SSID */ -+ c = rtw_set_ie(c, WLAN_EID_SSID, 0, NULL, NULL); -+ -+ /* Supported Rates */ -+ for (i = 0; i < n_bitrates; i++) { -+ supported_rates[i] = wiphy->bands[chan->band]->bitrates[i].bitrate / 5; -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ if (setup->basic_rates & BIT(i)) -+ #else -+ if (rtw_is_basic_rate_mix(supported_rates[i])) -+ #endif -+ supported_rates[i] |= IEEE80211_BASIC_RATE_MASK; -+ } -+ c = rtw_set_ie(c, WLAN_EID_SUPP_RATES, (n_bitrates >= 8 ? 8 : n_bitrates), supported_rates, NULL); -+ -+ /* DS parameter set */ -+ c = rtw_set_ie(c, WLAN_EID_DS_PARAMS, 1, &ch, NULL); -+ -+ /* TIM */ -+ *c = WLAN_EID_TIM; -+ *(c + 1) = 4; -+ c += 6; -+ //c = rtw_set_ie(c, _TIM_IE_, 4, NULL, NULL); -+ -+ /* Extended Supported Rates */ -+ if (n_bitrates > 8) -+ c = rtw_set_ie(c, WLAN_EID_EXT_SUPP_RATES, n_bitrates - 8, supported_rates + 8, NULL); -+ -+ /* RSN */ -+ if (rsn_ie) -+ c = rtw_set_ie(c, WLAN_EID_RSN, rsn_ie_len, rsn_ie + 2, NULL); -+ -+#if defined(CONFIG_80211N_HT) -+ if (ht) { -+ struct ieee80211_sta_ht_cap *sta_ht_cap = &wiphy->bands[chan->band]->ht_cap; -+ u8 ht_cap[HT_CAP_IE_LEN]; -+ u8 ht_op[HT_OP_IE_LEN]; -+ -+ _rtw_memset(ht_cap, 0, HT_CAP_IE_LEN); -+ _rtw_memset(ht_op, 0, HT_OP_IE_LEN); -+ -+ /* WLAN_EID_HT_CAP */ -+ RTW_PUT_LE16(HT_CAP_ELE_CAP_INFO(ht_cap), sta_ht_cap->cap); -+ SET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(ht_cap, sta_ht_cap->ampdu_factor); -+ SET_HT_CAP_ELE_MIN_MPDU_S_SPACE(ht_cap, sta_ht_cap->ampdu_density); -+ _rtw_memcpy(HT_CAP_ELE_SUP_MCS_SET(ht_cap), &sta_ht_cap->mcs, 16); -+ c = rtw_set_ie(c, WLAN_EID_HT_CAP, HT_CAP_IE_LEN, ht_cap, NULL); -+ -+ /* WLAN_EID_HT_OPERATION */ -+ SET_HT_OP_ELE_PRI_CHL(ht_op, ch); -+ switch (offset) { -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op, SCA); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op, SCB); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: -+ default: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op, SCN); -+ break; -+ } -+ if (bw >= CHANNEL_WIDTH_40) -+ SET_HT_OP_ELE_STA_CHL_WIDTH(ht_op, 1); -+ else -+ SET_HT_OP_ELE_STA_CHL_WIDTH(ht_op, 0); -+ c = rtw_set_ie(c, WLAN_EID_HT_OPERATION, HT_OP_IE_LEN, ht_op, NULL); -+ } -+#endif /* defined(CONFIG_80211N_HT) */ -+ -+#if defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ if (vht) { -+ struct ieee80211_sta_vht_cap *sta_vht_cap = &wiphy->bands[chan->band]->vht_cap; -+ u8 vht_cap[VHT_CAP_IE_LEN]; -+ u8 vht_op[VHT_OP_IE_LEN]; -+ u8 cch = rtw_get_center_ch(ch, bw, offset); -+ -+ _rtw_memset(vht_op, 0, VHT_OP_IE_LEN); -+ -+ /* WLAN_EID_VHT_CAPABILITY */ -+ _rtw_memcpy(vht_cap, &sta_vht_cap->cap, 4); -+ _rtw_memcpy(vht_cap + 4, &sta_vht_cap->vht_mcs, 8); -+ c = rtw_set_ie(c, WLAN_EID_VHT_CAPABILITY, VHT_CAP_IE_LEN, vht_cap, NULL); -+ -+ /* WLAN_EID_VHT_OPERATION */ -+ if (bw < CHANNEL_WIDTH_80) { -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op, 0); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op, 0); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op, 0); -+ } else if (bw == CHANNEL_WIDTH_80) { -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op, 1); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op, cch); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op, 0); -+ } else { -+ RTW_ERR(FUNC_ADPT_FMT" unsupported BW:%u\n", FUNC_ADPT_ARG(adapter), bw); -+ rtw_warn_on(1); -+ rtw_mfree(ies, len); -+ goto exit; -+ } -+ -+ /* Hard code 1 stream, MCS0-7 is a min Basic VHT MCS rates */ -+ vht_op[3] = 0xfc; -+ vht_op[4] = 0xff; -+ c = rtw_set_ie(c, WLAN_EID_VHT_OPERATION, VHT_OP_IE_LEN, vht_op, NULL); -+ } -+#endif /* defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) */ -+ -+ /* Mesh ID */ -+ c = rtw_set_ie_mesh_id(c, NULL, minfo->mesh_id, minfo->mesh_id_len); -+ -+ /* Mesh configuration */ -+ c = rtw_set_ie_mesh_config(c, NULL -+ , minfo->mesh_pp_id -+ , minfo->mesh_pm_id -+ , minfo->mesh_cc_id -+ , minfo->mesh_sp_id -+ , minfo->mesh_auth_id -+ , 0, 0, 0 -+ , 1 -+ , 0, 0 -+ , mcfg->dot11MeshForwarding -+ , 0, 0, 0 -+ ); -+ -+#if DBG_RTW_CFG80211_MESH_CONF -+ RTW_INFO(FUNC_ADPT_FMT" ies_len:%u\n", FUNC_ADPT_ARG(adapter), len); -+ dump_ies(RTW_DBGDUMP, ies + _BEACON_IE_OFFSET_, len - _BEACON_IE_OFFSET_); -+#endif -+ -+exit: -+ if (ies) -+ *ies_len = len; -+ return ies; -+} -+ -+static int cfg80211_rtw_get_mesh_config(struct wiphy *wiphy, struct net_device *dev -+ , struct mesh_config *conf) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rtw_mesh_cfg *mesh_cfg = &adapter->mesh_cfg; -+ int ret = 0; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ -+ /* driver MPM */ -+ conf->dot11MeshRetryTimeout = 0; -+ conf->dot11MeshConfirmTimeout = 0; -+ conf->dot11MeshHoldingTimeout = 0; -+ conf->dot11MeshMaxPeerLinks = mesh_cfg->max_peer_links; -+ conf->dot11MeshMaxRetries = 0; -+ -+ conf->dot11MeshTTL = mesh_cfg->dot11MeshTTL; -+ conf->element_ttl = mesh_cfg->element_ttl; -+ -+ /* driver MPM */ -+ conf->auto_open_plinks = 0; -+ -+ /* TBD: synchronization */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ conf->dot11MeshNbrOffsetMaxNeighbor = 0; -+#endif -+ -+ conf->dot11MeshHWMPmaxPREQretries = mesh_cfg->dot11MeshHWMPmaxPREQretries; -+ conf->path_refresh_time = mesh_cfg->path_refresh_time; -+ conf->min_discovery_timeout = mesh_cfg->min_discovery_timeout; -+ conf->dot11MeshHWMPactivePathTimeout = mesh_cfg->dot11MeshHWMPactivePathTimeout; -+ conf->dot11MeshHWMPpreqMinInterval = mesh_cfg->dot11MeshHWMPpreqMinInterval; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+ conf->dot11MeshHWMPperrMinInterval = mesh_cfg->dot11MeshHWMPperrMinInterval; -+#endif -+ conf->dot11MeshHWMPnetDiameterTraversalTime = mesh_cfg->dot11MeshHWMPnetDiameterTraversalTime; -+ conf->dot11MeshHWMPRootMode = mesh_cfg->dot11MeshHWMPRootMode; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ conf->dot11MeshHWMPRannInterval = mesh_cfg->dot11MeshHWMPRannInterval; -+#endif -+ conf->dot11MeshGateAnnouncementProtocol = mesh_cfg->dot11MeshGateAnnouncementProtocol; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) -+ conf->dot11MeshForwarding = mesh_cfg->dot11MeshForwarding; -+ conf->rssi_threshold = mesh_cfg->rssi_threshold; -+#endif -+ -+ /* TBD */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+ conf->ht_opmode = 0xffff; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ conf->dot11MeshHWMPactivePathToRootTimeout = mesh_cfg->dot11MeshHWMPactivePathToRootTimeout; -+ conf->dot11MeshHWMProotInterval = mesh_cfg->dot11MeshHWMProotInterval; -+ conf->dot11MeshHWMPconfirmationInterval = mesh_cfg->dot11MeshHWMPconfirmationInterval; -+#endif -+ -+ /* TBD: power save */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+ conf->power_mode = NL80211_MESH_POWER_ACTIVE; -+ conf->dot11MeshAwakeWindowDuration = 0; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ conf->plink_timeout = mesh_cfg->plink_timeout; -+#endif -+ -+ return ret; -+} -+ -+static void rtw_mbss_info_change_notify(_adapter *adapter, bool minfo_changed, bool need_work) -+{ -+ if (need_work) -+ rtw_mesh_work(&adapter->mesh_work); -+} -+ -+static int cfg80211_rtw_update_mesh_config(struct wiphy *wiphy, struct net_device *dev -+ , u32 mask, const struct mesh_config *nconf) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ int ret = 0; -+ bool minfo_changed = _FALSE, need_work = _FALSE; -+ -+ RTW_INFO(FUNC_ADPT_FMT" mask:0x%08x\n", FUNC_ADPT_ARG(adapter), mask); -+ -+ rtw_cfg80211_mesh_cfg_set(adapter, nconf, mask); -+ update_beacon(adapter, WLAN_EID_MESH_CONFIG, NULL, _TRUE, 0); -+#if CONFIG_RTW_MESH_CTO_MGATE_CARRIER -+ if (rtw_mesh_cto_mgate_required(adapter)) -+ rtw_netif_carrier_off(adapter->pnetdev); -+ else -+ rtw_netif_carrier_on(adapter->pnetdev); -+#endif -+ need_work = rtw_ieee80211_mesh_root_setup(adapter); -+ -+ rtw_mbss_info_change_notify(adapter, minfo_changed, need_work); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_join_mesh(struct wiphy *wiphy, struct net_device *dev, -+ const struct mesh_config *conf, const struct mesh_setup *setup) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 *ies = NULL; -+ uint ies_len; -+ int ret = 0; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ -+#if DBG_RTW_CFG80211_MESH_CONF -+ RTW_INFO(FUNC_ADPT_FMT" mesh_setup:\n", FUNC_ADPT_ARG(adapter)); -+ dump_mesh_setup(RTW_DBGDUMP, wiphy, setup); -+ RTW_INFO(FUNC_ADPT_FMT" mesh_config:\n", FUNC_ADPT_ARG(adapter)); -+ dump_mesh_config(RTW_DBGDUMP, conf); -+#endif -+ -+ if (rtw_cfg80211_sync_iftype(adapter) != _SUCCESS) { -+ ret = -ENOTSUPP; -+ goto exit; -+ } -+ -+ /* initialization */ -+ rtw_mesh_init_mesh_info(adapter); -+ -+ /* apply cfg80211 settings*/ -+ rtw_cfg80211_mesh_info_set_profile(&adapter->mesh_info, setup); -+ rtw_cfg80211_mesh_cfg_set(adapter, conf, 0xFFFFFFFF); -+ -+ /* apply cfg80211 settings (join only) */ -+ rtw_mesh_cfg_init_max_peer_links(adapter, conf->dot11MeshMaxPeerLinks); -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ rtw_mesh_cfg_init_plink_timeout(adapter, conf->plink_timeout); -+ #endif -+ -+ rtw_ieee80211_mesh_root_setup(adapter); -+ -+ ies = rtw_cfg80211_construct_mesh_beacon_ies(wiphy, adapter, conf, setup, &ies_len); -+ if (!ies) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ /* start mbss */ -+ if (rtw_check_beacon_data(adapter, ies, ies_len) != _SUCCESS) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ rtw_mesh_work(&adapter->mesh_work); -+ -+exit: -+ if (ies) -+ rtw_mfree(ies, ies_len); -+ if (ret) -+ rtw_mesh_deinit_mesh_info(adapter); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_leave_mesh(struct wiphy *wiphy, struct net_device *dev) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ int ret = 0; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ -+ rtw_mesh_deinit_mesh_info(adapter); -+ -+ rtw_stop_ap_cmd(adapter, RTW_CMDF_WAIT_ACK); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_add_mpath(struct wiphy *wiphy, struct net_device *dev -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) -+ , const u8 *dst, const u8 *next_hop -+ #else -+ , u8 *dst, u8 *next_hop -+ #endif -+) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct sta_info *sta; -+ struct rtw_mesh_path *mpath; -+ int ret = 0; -+ -+ rtw_rcu_read_lock(); -+ -+ sta = rtw_get_stainfo(stapriv, next_hop); -+ if (!sta) { -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ mpath = rtw_mesh_path_add(adapter, dst); -+ if (!mpath) { -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ rtw_mesh_path_fix_nexthop(mpath, sta); -+ -+exit: -+ rtw_rcu_read_unlock(); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_del_mpath(struct wiphy *wiphy, struct net_device *dev -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) -+ , const u8 *dst -+ #else -+ , u8 *dst -+ #endif -+) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ int ret = 0; -+ -+ if (dst) { -+ if (rtw_mesh_path_del(adapter, dst)) { -+ ret = -ENOENT; -+ goto exit; -+ } -+ } else { -+ rtw_mesh_path_flush_by_iface(adapter); -+ } -+ -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_change_mpath(struct wiphy *wiphy, struct net_device *dev -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) -+ , const u8 *dst, const u8 *next_hop -+ #else -+ , u8 *dst, u8 *next_hop -+ #endif -+) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct sta_info *sta; -+ struct rtw_mesh_path *mpath; -+ int ret = 0; -+ -+ rtw_rcu_read_lock(); -+ -+ sta = rtw_get_stainfo(stapriv, next_hop); -+ if (!sta) { -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ mpath = rtw_mesh_path_lookup(adapter, dst); -+ if (!mpath) { -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ rtw_mesh_path_fix_nexthop(mpath, sta); -+ -+exit: -+ rtw_rcu_read_unlock(); -+ -+ return ret; -+} -+ -+static void rtw_cfg80211_mpath_set_pinfo(struct rtw_mesh_path *mpath, u8 *next_hop, struct mpath_info *pinfo) -+{ -+ struct sta_info *next_hop_sta = rtw_rcu_dereference(mpath->next_hop); -+ -+ if (next_hop_sta) -+ _rtw_memcpy(next_hop, next_hop_sta->cmn.mac_addr, ETH_ALEN); -+ else -+ _rtw_memset(next_hop, 0, ETH_ALEN); -+ -+ _rtw_memset(pinfo, 0, sizeof(*pinfo)); -+ -+ pinfo->generation = mpath->adapter->mesh_info.mesh_paths_generation; -+ -+ pinfo->filled = 0 -+ | MPATH_INFO_FRAME_QLEN -+ | MPATH_INFO_SN -+ | MPATH_INFO_METRIC -+ | MPATH_INFO_EXPTIME -+ | MPATH_INFO_DISCOVERY_TIMEOUT -+ | MPATH_INFO_DISCOVERY_RETRIES -+ | MPATH_INFO_FLAGS -+ ; -+ -+ pinfo->frame_qlen = mpath->frame_queue_len; -+ pinfo->sn = mpath->sn; -+ pinfo->metric = mpath->metric; -+ if (rtw_time_after(mpath->exp_time, rtw_get_current_time())) -+ pinfo->exptime = rtw_get_remaining_time_ms(mpath->exp_time); -+ pinfo->discovery_timeout = rtw_systime_to_ms(mpath->discovery_timeout); -+ pinfo->discovery_retries = mpath->discovery_retries; -+ if (mpath->flags & RTW_MESH_PATH_ACTIVE) -+ pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE; -+ if (mpath->flags & RTW_MESH_PATH_RESOLVING) -+ pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING; -+ if (mpath->flags & RTW_MESH_PATH_SN_VALID) -+ pinfo->flags |= NL80211_MPATH_FLAG_SN_VALID; -+ if (mpath->flags & RTW_MESH_PATH_FIXED) -+ pinfo->flags |= NL80211_MPATH_FLAG_FIXED; -+ if (mpath->flags & RTW_MESH_PATH_RESOLVED) -+ pinfo->flags |= NL80211_MPATH_FLAG_RESOLVED; -+} -+ -+static int cfg80211_rtw_get_mpath(struct wiphy *wiphy, struct net_device *dev, u8 *dst, u8 *next_hop, struct mpath_info *pinfo) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rtw_mesh_path *mpath; -+ int ret = 0; -+ -+ rtw_rcu_read_lock(); -+ -+ mpath = rtw_mesh_path_lookup(adapter, dst); -+ if (!mpath) { -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ rtw_cfg80211_mpath_set_pinfo(mpath, next_hop, pinfo); -+ -+exit: -+ rtw_rcu_read_unlock(); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_dump_mpath(struct wiphy *wiphy, struct net_device *dev, int idx, u8 *dst, u8 *next_hop, struct mpath_info *pinfo) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rtw_mesh_path *mpath; -+ int ret = 0; -+ -+ rtw_rcu_read_lock(); -+ -+ mpath = rtw_mesh_path_lookup_by_idx(adapter, idx); -+ if (!mpath) { -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ _rtw_memcpy(dst, mpath->dst, ETH_ALEN); -+ rtw_cfg80211_mpath_set_pinfo(mpath, next_hop, pinfo); -+ -+exit: -+ rtw_rcu_read_unlock(); -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+static void rtw_cfg80211_mpp_set_pinfo(struct rtw_mesh_path *mpath, u8 *mpp, struct mpath_info *pinfo) -+{ -+ _rtw_memcpy(mpp, mpath->mpp, ETH_ALEN); -+ -+ _rtw_memset(pinfo, 0, sizeof(*pinfo)); -+ pinfo->generation = mpath->adapter->mesh_info.mpp_paths_generation; -+} -+ -+static int cfg80211_rtw_get_mpp(struct wiphy *wiphy, struct net_device *dev, u8 *dst, u8 *mpp, struct mpath_info *pinfo) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rtw_mesh_path *mpath; -+ int ret = 0; -+ -+ rtw_rcu_read_lock(); -+ -+ mpath = rtw_mpp_path_lookup(adapter, dst); -+ if (!mpath) { -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ rtw_cfg80211_mpp_set_pinfo(mpath, mpp, pinfo); -+ -+exit: -+ rtw_rcu_read_unlock(); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_dump_mpp(struct wiphy *wiphy, struct net_device *dev, int idx, u8 *dst, u8 *mpp, struct mpath_info *pinfo) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rtw_mesh_path *mpath; -+ int ret = 0; -+ -+ rtw_rcu_read_lock(); -+ -+ mpath = rtw_mpp_path_lookup_by_idx(adapter, idx); -+ if (!mpath) { -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ _rtw_memcpy(dst, mpath->dst, ETH_ALEN); -+ rtw_cfg80211_mpp_set_pinfo(mpath, mpp, pinfo); -+ -+exit: -+ rtw_rcu_read_unlock(); -+ -+ return ret; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) */ -+ -+#endif /* defined(CONFIG_RTW_MESH) */ -+ -+#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); -+ struct cfg80211_ssid *ssids; -+ int n_ssids = 0; -+ int interval = 0; -+ int i = 0; -+ u8 ret; -+ -+ if (padapter->bup == _FALSE) { -+ RTW_INFO("%s: net device is down.\n", __func__); -+ return -EIO; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_SURVEY) == _TRUE || -+ check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE || -+ check_fwstate(pmlmepriv, WIFI_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; -+ } -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0) -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 4, 0) -+ interval = request->scan_plans->interval; -+#else -+ interval = request->interval; -+#endif -+ n_ssids = request->n_match_sets; -+ ssids = (struct cfg80211_ssid *)rtw_zmalloc(n_ssids * sizeof(struct cfg80211_ssid)); -+ if(ssids == NULL) { -+ RTW_ERR("Fail to allocate ssids for PNO\n"); -+ return -ENOMEM; -+ } -+ for (i=0;in_match_sets;i++) { -+ ssids[i].ssid_len = request->match_sets[i].ssid.ssid_len; -+ memcpy(ssids[i].ssid, request->match_sets[i].ssid.ssid, -+ request->match_sets[i].ssid.ssid_len); -+ } -+#else -+ interval = request->interval; -+ n_ssids = request->n_ssids; -+ ssids = request->ssids; -+#endif -+ret = rtw_android_cfg80211_pno_setup(dev, ssids, -+ n_ssids, 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 -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0)) -+ , u64 reqid -+#endif -+) -+{ -+ return rtw_android_pno_enable(dev, _FALSE); -+} -+ -+int cfg80211_rtw_suspend(struct wiphy *wiphy, struct cfg80211_wowlan *wow) { -+ RTW_DBG("==> %s\n",__func__); -+ RTW_DBG("<== %s\n",__func__); -+ return 0; -+} -+ -+int cfg80211_rtw_resume(struct wiphy *wiphy) { -+ -+ _adapter *padapter; -+ struct pwrctrl_priv *pwrpriv; -+ struct mlme_priv *pmlmepriv; -+ struct sitesurvey_parm parm; -+ int i, len; -+ -+ padapter = wiphy_to_adapter(wiphy); -+ pwrpriv = adapter_to_pwrctl(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+ -+ RTW_DBG("==> %s\n",__func__); -+ if (pwrpriv->wowlan_last_wake_reason == RX_PNO) { -+ -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ _irqL irqL; -+ int PNOWakeupScanWaitCnt = 0; -+ -+ rtw_cfg80211_disconnected(padapter->rtw_wdev, 0, NULL, 0, 1, GFP_ATOMIC); -+ -+ rtw_init_sitesurvey_parm(padapter, &parm); -+ for (i=0;ipnlo_info->ssid_num && i < RTW_SSID_SCAN_AMOUNT; i++) { -+ len = pwrpriv->pno_ssid_list->node[i].SSID_len; -+ _rtw_memcpy(&parm.ssid[i].Ssid, pwrpriv->pno_ssid_list->node[i].SSID, len); -+ parm.ssid[i].SsidLength = len; -+ } -+ parm.ssid_num = pwrpriv->pnlo_info->ssid_num; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ //This modification fix PNO wakeup reconnect issue with hidden SSID AP. -+ //rtw_sitesurvey_cmd(padapter, NULL); -+ rtw_sitesurvey_cmd(padapter, &parm); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ for (PNOWakeupScanWaitCnt = 0; PNOWakeupScanWaitCnt < 10; PNOWakeupScanWaitCnt++) { -+ if(check_fwstate(pmlmepriv, WIFI_UNDER_SURVEY) == _FALSE) -+ break; -+ rtw_msleep_os(1000); -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0)) -+ cfg80211_sched_scan_results(padapter->rtw_wdev->wiphy, 0); -+#else -+ cfg80211_sched_scan_results(padapter->rtw_wdev->wiphy); -+#endif -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ } -+ RTW_DBG("<== %s\n",__func__); -+ return 0; -+ -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+#ifdef CONFIG_80211N_HT -+static void rtw_cfg80211_init_ht_capab_ex(_adapter *padapter -+ , struct ieee80211_sta_ht_cap *ht_cap, BAND_TYPE 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 == BAND_ON_2_4G) -+ stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(0)) ? _TRUE : _FALSE; -+ if (band == BAND_ON_5G) -+ 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, BAND_TYPE band, u8 rf_type) -+{ -+ struct registry_priv *regsty = &padapter->registrypriv; -+ u8 rx_nss = 0; -+ -+ if (!regsty->ht_enable || !is_supported_ht(regsty->wireless_mode)) -+ return; -+ -+ ht_cap->ht_supported = 1; -+ -+ ht_cap->cap = IEEE80211_HT_CAP_MAX_AMSDU; -+ -+ if (TEST_FLAG(regsty->short_gi, BIT0)) -+ ht_cap->cap |= IEEE80211_HT_CAP_SGI_20; -+ if (hal_is_bw_support(padapter, CHANNEL_WIDTH_40) -+ && ((band == BAND_ON_2_4G && REGSTY_IS_BW_2G_SUPPORT(regsty, CHANNEL_WIDTH_40)) -+ || (band == BAND_ON_5G && REGSTY_IS_BW_5G_SUPPORT(regsty, CHANNEL_WIDTH_40))) -+ ) { -+ ht_cap->cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40; -+ if (band == BAND_ON_2_4G) -+ ht_cap->cap |= IEEE80211_HT_CAP_DSSSCCK40; -+ if (TEST_FLAG(regsty->short_gi, BIT1)) -+ ht_cap->cap |= IEEE80211_HT_CAP_SGI_40; -+ } -+ -+ 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; -+ -+ rx_nss = GET_HAL_RX_NSS(padapter); -+ switch (rx_nss) { -+ case 1: -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ break; -+ case 2: -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ ht_cap->mcs.rx_mask[1] = 0xFF; -+ break; -+ case 3: -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ ht_cap->mcs.rx_mask[1] = 0xFF; -+ ht_cap->mcs.rx_mask[2] = 0xFF; -+ break; -+ case 4: -+ 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_mask[3] = 0xFF; -+ break; -+ default: -+ rtw_warn_on(1); -+ RTW_INFO("%s, error rf_type=%d, rx_nss=%d\n", __func__, rf_type, rx_nss); -+ }; -+ -+ ht_cap->mcs.rx_highest = cpu_to_le16( -+ rtw_ht_mcs_rate(hal_is_bw_support(padapter, CHANNEL_WIDTH_40) -+ , hal_is_bw_support(padapter, CHANNEL_WIDTH_40) ? ht_cap->cap & IEEE80211_HT_CAP_SGI_40 : ht_cap->cap & IEEE80211_HT_CAP_SGI_20 -+ , ht_cap->mcs.rx_mask) / 10); -+} -+#endif /* CONFIG_80211N_HT */ -+ -+#if defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+static void rtw_cfg80211_init_vht_capab(_adapter *padapter -+ , struct ieee80211_sta_vht_cap *sta_vht_cap, BAND_TYPE band, u8 rf_type) -+{ -+ struct registry_priv *regsty = &padapter->registrypriv; -+ u8 vht_cap_ie[2 + 12] = {0}; -+ -+ if (!REGSTY_IS_11AC_ENABLE(regsty) || !is_supported_vht(regsty->wireless_mode)) -+ return; -+ -+ rtw_vht_use_default_setting(padapter); -+ rtw_build_vht_cap_ie(padapter, vht_cap_ie); -+ -+ sta_vht_cap->vht_supported = 1; -+ -+ _rtw_memcpy(&sta_vht_cap->cap, vht_cap_ie + 2, 4); -+ _rtw_memcpy(&sta_vht_cap->vht_mcs, vht_cap_ie + 2 + 4, 8); -+} -+#endif /* defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) */ -+ -+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 -+} -+ -+static int rtw_cfg80211_init_wiphy_band(_adapter *padapter, struct wiphy *wiphy) -+{ -+ u8 rf_type; -+ struct ieee80211_supported_band *band; -+ int ret = _FAIL; -+ -+ rf_type = GET_HAL_RFPATH(padapter); -+ RTW_INFO("%s:rf_type=%d\n", __func__, rf_type); -+ -+ if (IsSupported24G(padapter->registrypriv.wireless_mode)) { -+ band = wiphy->bands[NL80211_BAND_2GHZ] = rtw_spt_band_alloc(BAND_ON_2_4G); -+ if (!band) -+ goto exit; -+ rtw_2g_channels_init(band->channels); -+ rtw_2g_rates_init(band->bitrates); -+ #if defined(CONFIG_80211N_HT) -+ rtw_cfg80211_init_ht_capab(padapter, &band->ht_cap, BAND_ON_2_4G, rf_type); -+ #endif -+ } -+#if CONFIG_IEEE80211_BAND_5GHZ -+ if (is_supported_5g(padapter->registrypriv.wireless_mode)) { -+ band = wiphy->bands[NL80211_BAND_5GHZ] = rtw_spt_band_alloc(BAND_ON_5G); -+ if (!band) { -+ if (wiphy->bands[NL80211_BAND_2GHZ]) { -+ rtw_spt_band_free(wiphy->bands[NL80211_BAND_2GHZ]); -+ wiphy->bands[NL80211_BAND_2GHZ] = NULL; -+ } -+ goto exit; -+ } -+ rtw_5g_channels_init(band->channels); -+ rtw_5g_rates_init(band->bitrates); -+ #if defined(CONFIG_80211N_HT) -+ rtw_cfg80211_init_ht_capab(padapter, &band->ht_cap, BAND_ON_5G, rf_type); -+ #endif -+ #if defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ rtw_cfg80211_init_vht_capab(padapter, &band->vht_cap, BAND_ON_5G, rf_type); -+ #endif -+ } -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+#if !defined(CONFIG_REGD_SRC_FROM_OS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) -+void rtw_cfg80211_update_wiphy_max_txpower(_adapter *adapter, struct wiphy *wiphy) -+{ -+ struct ieee80211_supported_band *band; -+ struct ieee80211_channel *channel; -+ s16 max_txpwr; -+ int i; -+ -+ if (IsSupported24G(adapter->registrypriv.wireless_mode)) { -+ band = wiphy->bands[NL80211_BAND_2GHZ]; -+ if (band) { -+ max_txpwr = phy_get_txpwr_by_rate_total_max_mbm(adapter, BAND_ON_2_4G, 1, 1); -+ if (max_txpwr != UNSPECIFIED_MBM) { -+ for (i = 0; i < band->n_channels; i++) { -+ channel = &band->channels[i]; -+ channel->max_power = max_txpwr / MBM_PDBM; -+ } -+ } -+ } -+ } -+#if CONFIG_IEEE80211_BAND_5GHZ -+ if (is_supported_5g(adapter->registrypriv.wireless_mode)) { -+ band = wiphy->bands[NL80211_BAND_5GHZ]; -+ if (band) { -+ max_txpwr = phy_get_txpwr_by_rate_total_max_mbm(adapter, BAND_ON_5G, 1, 1); -+ if (max_txpwr != UNSPECIFIED_MBM) { -+ for (i = 0; i < band->n_channels; i++) { -+ channel = &band->channels[i]; -+ channel->max_power = max_txpwr / MBM_PDBM; -+ } -+ } -+ } -+ } -+#endif -+} -+#endif /* defined(CONFIG_REGD_SRC_FROM_OS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) && defined(RTW_SINGLE_WIPHY) && (CONFIG_IFACE_NUMBER >= 2) -+struct ieee80211_iface_limit rtw_limits[] = { -+ { -+ .max = CONFIG_IFACE_NUMBER, -+ .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 = rtw_min(CONFIG_IFACE_NUMBER, CONFIG_LIMITED_AP_NUM), -+ .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 -+ #if defined(CONFIG_RTW_MESH) -+ { -+ .max = 1, -+ .types = BIT(NL80211_IFTYPE_MESH_POINT) -+ }, -+ #endif -+}; -+ -+struct ieee80211_iface_combination rtw_combinations[] = { -+ { -+ .limits = rtw_limits, -+ .n_limits = ARRAY_SIZE(rtw_limits), -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ .max_interfaces = CONFIG_IFACE_NUMBER + 1, -+ #else -+ .max_interfaces = CONFIG_IFACE_NUMBER, -+ #endif -+ .num_different_channels = 1, -+ }, -+}; -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) */ -+ -+static int rtw_cfg80211_init_wiphy(_adapter *adapter, struct wiphy *wiphy) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ int ret = _FAIL; -+ -+ /* copy mac_addr to wiphy */ -+ _rtw_memcpy(wiphy->perm_addr, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ 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) -+ #ifdef CONFIG_AP_MODE -+ | BIT(NL80211_IFTYPE_ADHOC) /* todo : AD-HOC task group will refine it */ -+ | BIT(NL80211_IFTYPE_AP) -+ #endif -+ #ifdef CONFIG_WIFI_MONITOR -+ | 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) -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ | BIT(NL80211_IFTYPE_P2P_DEVICE) -+ #endif -+#endif -+#ifdef CONFIG_RTW_MESH -+ | BIT(NL80211_IFTYPE_MESH_POINT) /* 2.6.26 */ -+#endif -+ ; -+ -+#if !defined(RTW_SINGLE_WIPHY) && defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_P2P) -+ if (adapter->iface_id != adapter->registrypriv.sel_p2p_iface) { -+ wiphy->interface_modes &= ~(BIT(NL80211_IFTYPE_P2P_GO) | BIT(NL80211_IFTYPE_P2P_CLIENT)); -+ RTW_INFO("%s iface_id:%d- don't set p2p capability\n", __func__, adapter->iface_id); -+ } -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ wiphy->mgmt_stypes = rtw_cfg80211_default_mgmt_stypes; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ #ifdef CONFIG_WIFI_MONITOR -+ wiphy->software_iftypes |= BIT(NL80211_IFTYPE_MONITOR); -+ #endif -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) && defined(RTW_SINGLE_WIPHY) && (CONFIG_IFACE_NUMBER >= 2) -+ wiphy->iface_combinations = rtw_combinations; -+ wiphy->n_iface_combinations = ARRAY_SIZE(rtw_combinations); -+#endif -+ -+ wiphy->cipher_suites = rtw_cipher_suites; -+ -+ /* Todo refine */ -+ if (_rtw_camctl_chk_cap(adapter, SEC_CAP_CHK_EXTRA_SEC)) -+ wiphy->n_cipher_suites = ARRAY_SIZE(rtw_cipher_suites); -+ else { -+#ifdef CONFIG_IEEE80211W -+ /* remove hardware not support cipher */ -+ wiphy->n_cipher_suites = ARRAY_SIZE(rtw_cipher_suites) - 6; -+#else -+ wiphy->n_cipher_suites = ARRAY_SIZE(rtw_cipher_suites); -+#endif -+ } -+ -+ if (rtw_cfg80211_init_wiphy_band(adapter, wiphy) != _SUCCESS) { -+ RTW_ERR("rtw_cfg80211_init_wiphy_band fail\n"); -+ goto exit; -+ } -+ #if !defined(CONFIG_REGD_SRC_FROM_OS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) -+ rtw_cfg80211_update_wiphy_max_txpower(adapter, wiphy); -+ #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 (KERNEL_VERSION(3, 2, 0) <= LINUX_VERSION_CODE) -+ wiphy->flags |= WIPHY_FLAG_AP_UAPSD; -+#endif -+ -+#if defined(CONFIG_PM) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0)) -+ wiphy->max_sched_scan_reqs = 1; -+#else -+ wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; -+#endif -+#ifdef CONFIG_PNO_SUPPORT -+ wiphy->max_sched_scan_ssids = MAX_PNO_LIST_COUNT; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0) -+ wiphy->max_match_sets = MAX_PNO_LIST_COUNT; -+#endif -+#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 */ -+ -+#ifdef CONFIG_LPS -+ wiphy->flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT; -+#else -+ wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ /* wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM; */ -+#endif -+ -+#ifdef CONFIG_RTW_WDS -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 33)) -+ wiphy->flags |= WIPHY_FLAG_4ADDR_AP; -+ wiphy->flags |= WIPHY_FLAG_4ADDR_STATION; -+ #endif -+#endif -+ -+#ifdef CONFIG_RTW_MESH -+ wiphy->flags |= 0 -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ | WIPHY_FLAG_IBSS_RSN -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ | WIPHY_FLAG_MESH_AUTH -+ #endif -+ ; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+ wiphy->features |= 0 -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) -+ | NL80211_FEATURE_USERSPACE_MPM -+ #endif -+ ; -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) */ -+#endif /* CONFIG_RTW_MESH */ -+ -+#if defined(CONFIG_RTW_80211K) && (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 6, 0)) -+ wiphy_ext_feature_set(wiphy, NL80211_EXT_FEATURE_RRM); -+#endif -+ -+#if (KERNEL_VERSION(3, 8, 0) <= LINUX_VERSION_CODE) -+ wiphy->features |= NL80211_FEATURE_SAE; -+#endif -+ -+#ifdef CONFIG_RTW_SCAN_RAND -+ #if (KERNEL_VERSION(3, 19, 0) <= LINUX_VERSION_CODE) -+ wiphy->features |= NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR; -+ #endif -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+#ifdef CONFIG_WIFI_MONITOR -+ /* Currently only for Monitor debugging */ -+ wiphy->flags |= WIPHY_FLAG_SUPPORTS_5_10_MHZ; -+#endif -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 12, 0)) -+ wiphy->flags |= WIPHY_FLAG_HAS_CHANNEL_SWITCH; -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) -+ wiphy->max_num_csa_counters = MAX_CSA_CNT; -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+#ifdef CONFIG_RFKILL_POLL -+void rtw_cfg80211_init_rfkill(struct wiphy *wiphy) -+{ -+ wiphy_rfkill_set_hw_state(wiphy, 0); -+ wiphy_rfkill_start_polling(wiphy); -+} -+ -+void rtw_cfg80211_deinit_rfkill(struct wiphy *wiphy) -+{ -+ wiphy_rfkill_stop_polling(wiphy); -+} -+ -+static void cfg80211_rtw_rfkill_poll(struct wiphy *wiphy) -+{ -+ _adapter *padapter = NULL; -+ bool blocked = _FALSE; -+ u8 valid = 0; -+ -+ padapter = wiphy_to_adapter(wiphy); -+ -+ if (adapter_to_dvobj(padapter)->processing_dev_remove == _TRUE) { -+ /*RTW_INFO("cfg80211_rtw_rfkill_poll: device is removed!\n");*/ -+ return; -+ } -+ -+ blocked = rtw_hal_rfkill_poll(padapter, &valid); -+ /*RTW_INFO("cfg80211_rtw_rfkill_poll: valid=%d, blocked=%d\n", -+ valid, blocked);*/ -+ -+ if (valid) -+ wiphy_rfkill_set_hw_state(wiphy, blocked); -+} -+#endif -+ -+#if defined(CONFIG_RTW_HOSTAPD_ACS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 33)) -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && (LINUX_VERSION_CODE < KERNEL_VERSION(4, 0, 0)) -+#define SURVEY_INFO_TIME SURVEY_INFO_CHANNEL_TIME -+#define SURVEY_INFO_TIME_BUSY SURVEY_INFO_CHANNEL_TIME_BUSY -+#define SURVEY_INFO_TIME_EXT_BUSY SURVEY_INFO_CHANNEL_TIME_EXT_BUSY -+#define SURVEY_INFO_TIME_RX SURVEY_INFO_CHANNEL_TIME_RX -+#define SURVEY_INFO_TIME_TX SURVEY_INFO_CHANNEL_TIME_TX -+#endif -+ -+#ifdef CONFIG_RTW_ACS -+static void rtw_cfg80211_set_survey_info_with_clm(PADAPTER padapter, int idx, struct survey_info *pinfo) -+{ -+ s8 noise = -50; /*channel noise in dBm. This and all following fields are optional */ -+ u64 time = SURVEY_TO; /*amount of time in ms the radio was turn on (on the channel)*/ -+ u64 time_busy = 0; /*amount of time the primary channel was sensed busy*/ -+ u8 chan = (u8)idx; -+ -+ if ((idx < 0) || (pinfo == NULL)) -+ return; -+ -+ pinfo->filled = SURVEY_INFO_NOISE_DBM -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ | SURVEY_INFO_TIME | SURVEY_INFO_TIME_BUSY -+ #endif -+ ; -+ -+ time_busy = rtw_acs_get_clm_ratio_by_ch_idx(padapter, chan); -+ noise = rtw_acs_get_nhm_noise_pwr_by_ch_idx(padapter, chan); -+ /* RTW_INFO("%s: ch-idx:%d time=%llu(ms), time_busy=%llu(ms), noise=%d(dbm)\n", __func__, idx, time, time_busy, noise); */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 0, 0)) -+ pinfo->channel_time = time; -+ pinfo->channel_time_busy = time_busy; -+ #else -+ pinfo->time = time; -+ pinfo->time_busy = time_busy; -+ #endif -+#endif -+ pinfo->noise = noise; -+} -+#endif /* CONFIG_RTW_ACS */ -+ -+static int rtw_hostapd_acs_dump_survey(struct wiphy *wiphy, struct net_device *netdev, int idx, struct survey_info *info) -+{ -+ PADAPTER padapter = (_adapter *)rtw_netdev_priv(netdev); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ RT_CHANNEL_INFO *pch_set = rfctl->channel_set; -+ u8 max_chan_nums = rfctl->max_chan_nums; -+ u32 freq = 0; -+ u8 ret = 0; -+ u16 channel = 0; -+ -+ if (!netdev || !info) { -+ RTW_INFO("%s: invial parameters.\n", __func__); -+ return -EINVAL; -+ } -+ -+ _rtw_memset(info, 0, sizeof(struct survey_info)); -+ if (padapter->bup == _FALSE) { -+ RTW_INFO("%s: net device is down.\n", __func__); -+ return -EIO; -+ } -+ -+ if (idx >= max_chan_nums) -+ return -ENOENT; -+ -+ channel = pch_set[idx].ChannelNum; -+ freq = rtw_ch2freq(channel); -+ info->channel = ieee80211_get_channel(wiphy, freq); -+ /* RTW_INFO("%s: channel %d, freq %d\n", __func__, channel, freq); */ -+ -+ if (!info->channel) -+ return -EINVAL; -+ -+ if (info->channel->flags == IEEE80211_CHAN_DISABLED) -+ return ret; -+ -+#ifdef CONFIG_RTW_ACS -+ rtw_cfg80211_set_survey_info_with_clm(padapter, idx, info); -+#else -+ RTW_ERR("%s: unknown acs operation!\n", __func__); -+#endif -+ -+ return ret; -+} -+#endif /* defined(CONFIG_RTW_HOSTAPD_ACS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 33)) */ -+ -+#if (KERNEL_VERSION(4, 17, 0) <= LINUX_VERSION_CODE) \ -+ || defined(CONFIG_KERNEL_PATCH_EXTERNAL_AUTH) -+int cfg80211_rtw_external_auth(struct wiphy *wiphy, struct net_device *dev, -+ struct cfg80211_external_auth_params *params) -+{ -+ PADAPTER padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(dev)); -+ -+ rtw_cfg80211_external_auth_status(wiphy, dev, -+ (struct rtw_external_auth_params *)params); -+ -+ return 0; -+} -+#endif -+ -+void rtw_cfg80211_external_auth_status(struct wiphy *wiphy, struct net_device *dev, -+ struct rtw_external_auth_params *params) -+{ -+ PADAPTER padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ u8 *buf = NULL; -+ u32 len = 0; -+ _irqL irqL; -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(dev)); -+ -+ RTW_INFO("SAE: action: %u, status: %u\n", params->action, params->status); -+ if (params->status == WLAN_STATUS_SUCCESS) { -+ RTW_INFO("bssid: "MAC_FMT"\n", MAC_ARG(params->bssid)); -+ RTW_INFO("SSID: [%s]\n", -+ ((params->ssid.ssid_len == 0) ? "" : (char *)params->ssid.ssid)); -+ RTW_INFO("suite: 0x%08x\n", params->key_mgmt_suite); -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, params->bssid); -+ if (psta && (params->status == WLAN_STATUS_SUCCESS)) { -+#ifdef CONFIG_AP_MODE -+ /* AP mode */ -+ RTW_INFO("station match\n"); -+ -+ psta->state &= ~WIFI_FW_AUTH_NULL; -+ psta->state |= WIFI_FW_AUTH_SUCCESS; -+ psta->expire_to = padapter->stapriv.assoc_to; -+ -+ /* ToDo: Kernel v5.1 pmkid is pointer */ -+ /* RTW_INFO_DUMP("PMKID:", params->pmkid, PMKID_LEN); */ -+ _rtw_set_pmksa(dev, params->bssid, params->pmkid); -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ if ((psta->auth_len != 0) && (psta->pauth_frame != NULL)) { -+ buf = rtw_zmalloc(psta->auth_len); -+ if (buf) { -+ _rtw_memcpy(buf, psta->pauth_frame, psta->auth_len); -+ len = psta->auth_len; -+ } -+ -+ rtw_mfree(psta->pauth_frame, psta->auth_len); -+ psta->pauth_frame = NULL; -+ psta->auth_len = 0; -+ } -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ if (buf) { -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ /* send the SAE auth Confirm */ -+ -+ rtw_ps_deny(padapter, PS_DENY_MGNT_TX); -+ if (_SUCCESS == rtw_pwr_wakeup(padapter)) { -+ rtw_mi_set_scan_deny(padapter, 1000); -+ rtw_mi_scan_abort(padapter, _TRUE); -+ -+ RTW_INFO("SAE: Tx auth Confirm\n"); -+ rtw_mgnt_tx_cmd(padapter, pmlmeext->cur_channel, 1, buf, len, 0, RTW_CMDF_DIRECTLY); -+ -+ } -+ rtw_ps_deny_cancel(padapter, PS_DENY_MGNT_TX); -+ -+ rtw_mfree(buf, len); -+ buf = NULL; -+ len = 0; -+ } -+#endif -+ } else if (psta && (params->status == WLAN_STATUS_UNSPECIFIED_FAILURE)) { -+#ifdef CONFIG_AP_MODE -+ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->cmn.mac_addr, WLAN_STATUS_UNSPECIFIED_FAILURE); -+#endif -+ } else { -+ /* STA mode */ -+ psecuritypriv->extauth_status = params->status; -+ } -+} -+ -+#ifdef CONFIG_AP_MODE -+static int check_channel(_adapter* padapter,u8 ch, u8 bw, u8 offset) { -+ int ret = _SUCCESS; -+ u8 ifbmp_s = rtw_mi_get_ld_sta_ifbmp(padapter); -+ u8 u_ch, u_bw, u_offset; -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ u_ch = rtw_mi_get_union_chan(padapter); -+ u_bw = rtw_mi_get_union_bw(padapter); -+ u_offset = rtw_mi_get_union_offset(padapter); -+ -+ if (rtw_chset_search_ch(rfctl->channel_set, ch) < 0 -+ || rtw_chset_is_ch_non_ocp(rfctl->channel_set, ch)) { -+ ret = _FAIL; -+ RTW_INFO("ch not legal %d,%d,%d\n", ch, bw, offset); -+ } else if(pmlmeext->cur_channel == ch && pmlmeext->cur_bwmode == bw && pmlmeext->cur_ch_offset == offset) { -+ /* channel, bandwidth, offset doesn't change */ -+ ret = _FAIL; -+ RTW_INFO("ch same, skip switching %d,%d,%d ==> %d,%d,%d (union:%d,%d,%d)\n", -+ pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset, ch, bw, offset, u_ch, u_bw, u_offset); -+ } else if((u_ch != ch || (offset != HAL_PRIME_CHNL_OFFSET_DONT_CARE && u_offset != offset)) && ifbmp_s) { -+ ret = _FAIL; -+ RTW_INFO("must follow STA's ch, %d,%d,%d ==> %d,%d,%d (union:%d,%d,%d)\n", -+ pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset, ch, bw, offset, u_ch, u_bw, u_offset); -+ } else { -+ RTW_INFO("channel switch.%d,%d,%d ==> %d,%d,%d (union:%d,%d,%d)\n", -+ pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset, ch, bw, offset, u_ch, u_bw, u_offset); -+ } -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 12, 0)) -+static int cfg80211_rtw_channel_switch(struct wiphy *wiphy, -+ struct net_device *dev, -+ struct cfg80211_csa_settings *params) -+{ -+ _adapter *padapter = NULL; -+ struct dvobj_priv *dvobj = NULL; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 *ies; -+ u8 mode = 0, count = 0, bw = CHANNEL_WIDTH_20, ch = 0, offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE, ht = 0, vht = 0, ifbmp = 0, enable = 1; -+ u32 i, ies_len; -+ struct rf_ctl_t *rfctl; -+ -+ padapter = (_adapter *)rtw_netdev_priv(dev); -+ dvobj = adapter_to_dvobj(padapter); -+ rfctl = dvobj_to_rfctl(dvobj); -+ -+ ifbmp = rtw_mi_get_ap_mesh_ifbmp(padapter); -+ -+ if(params && params->chandef.chan) { -+ -+ rtw_get_chbw_from_cfg80211_chan_def(¶ms->chandef, &ht, &ch, &bw, &offset); -+ -+ if (check_channel(padapter, ch, bw, offset) == _FAIL) -+ return -EINVAL; -+ -+ if (!ch) { -+ RTW_INFO(" => ch:%u invalid\n", ch); -+ return -EINVAL; -+ } -+ -+ /* return error code when switch process is running */ -+ if(rfctl->ap_csa_en == AP_SWITCH_CH_CSA || rfctl->ap_csa_en == STA_RX_CSA -+ || rfctl->ap_csa_en == CSA_STA_JOINBSS) -+ return -EINVAL; -+ -+ /* todo, disable vht or something */ -+ vht = ht && ch > 14 && bw >= CHANNEL_WIDTH_80; -+ RTW_INFO(" => ch:%u,%u,%u, ht:%u, vht:%u\n", ch, bw, offset, ht, vht); -+ -+ if(params->beacon_csa.tail) { -+ /* dump_ies(RTW_DBGDUMP, (char *) params->beacon_csa.tail, params->beacon_csa.tail_len); */ -+ ies = (u8 *)params->beacon_csa.tail; -+ ies_len = params->beacon_csa.tail_len; -+ for (i = 0; i + 1 < ies_len;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(ies + i); -+ -+ switch (pIE->ElementID) { -+ case WLAN_EID_CHANNEL_SWITCH: -+ mode = *(pIE->data); -+ ch = *(pIE->data + 1); -+ count = *(pIE->data + 2); -+ RTW_INFO("CSA IE, mode=%d, ch=%d, count=%d\n", mode, ch, count); -+ break; -+ default: -+ break; -+ } -+ i += (pIE->Length + 2); -+ } -+ -+ if (count == 0) { -+ RTW_INFO("CSA count should not be 0\n"); -+ return -EINVAL; -+ } -+ -+ if (ifbmp && count > 0) { -+ rfctl->ap_csa_en = AP_SWITCH_CH_CSA; -+ rfctl->ap_csa_ch = ch; -+ rfctl->ap_csa_switch_cnt = count; -+ rfctl->ap_csa_ch_offset = offset; -+ rfctl->ap_csa_ch_width = bw; -+ rtw_set_ap_csa_cmd(padapter); -+ } -+ } -+ } -+ -+ return 0; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 12, 0)) */ -+#endif /* CONFIG_AP_MODE */ -+ -+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 (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 30)) -+ .set_default_mgmt_key = cfg80211_rtw_set_default_mgmt_key, -+#endif -+#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, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 5, 0)) -+ .abort_scan = cfg80211_rtw_abort_scan, -+#endif -+ .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, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 31)) -+ .set_tx_power = cfg80211_rtw_set_txpower, -+ .get_tx_power = cfg80211_rtw_get_txpower, -+#endif -+ .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, -+ -+#ifdef CONFIG_AP_MODE -+#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, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 28)) -+ .change_bss = cfg80211_rtw_change_bss, -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ .set_txq_params = cfg80211_rtw_set_txq_params, -+#endif -+#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 */ -+ -+#if defined(CONFIG_RTW_MESH) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) -+ .get_mesh_config = cfg80211_rtw_get_mesh_config, -+ .update_mesh_config = cfg80211_rtw_update_mesh_config, -+ .join_mesh = cfg80211_rtw_join_mesh, -+ .leave_mesh = cfg80211_rtw_leave_mesh, -+ .add_mpath = cfg80211_rtw_add_mpath, -+ .del_mpath = cfg80211_rtw_del_mpath, -+ .change_mpath = cfg80211_rtw_change_mpath, -+ .get_mpath = cfg80211_rtw_get_mpath, -+ .dump_mpath = cfg80211_rtw_dump_mpath, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ .get_mpp = cfg80211_rtw_get_mpp, -+ .dump_mpp = cfg80211_rtw_dump_mpp, -+ #endif -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ .set_monitor_channel = cfg80211_rtw_set_monitor_channel, -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ .get_channel = cfg80211_rtw_get_channel, -+#endif -+ -+ .remain_on_channel = cfg80211_rtw_remain_on_channel, -+ .cancel_remain_on_channel = cfg80211_rtw_cancel_remain_on_channel, -+ -+#if defined(CONFIG_P2P) && defined(RTW_DEDICATED_P2P_DEVICE) -+ .start_p2p_device = cfg80211_rtw_start_p2p_device, -+ .stop_p2p_device = cfg80211_rtw_stop_p2p_device, -+#endif -+ -+#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, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 8, 0)) -+ .mgmt_frame_register = cfg80211_rtw_mgmt_frame_register, -+#else -+ .update_mgmt_frame_registrations = cfg80211_rtw_update_mgmt_frame_register, -+#endif -+#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, -+ .suspend = cfg80211_rtw_suspend, -+ .resume = cfg80211_rtw_resume, -+#endif /* CONFIG_PNO_SUPPORT */ -+#ifdef CONFIG_RFKILL_POLL -+ .rfkill_poll = cfg80211_rtw_rfkill_poll, -+#endif -+#if defined(CONFIG_RTW_HOSTAPD_ACS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 33)) -+ .dump_survey = rtw_hostapd_acs_dump_survey, -+#endif -+#if (KERNEL_VERSION(4, 17, 0) <= LINUX_VERSION_CODE) \ -+ || defined(CONFIG_KERNEL_PATCH_EXTERNAL_AUTH) -+ .external_auth = cfg80211_rtw_external_auth, -+#endif -+#ifdef CONFIG_AP_MODE -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 12, 0)) -+ .channel_switch = cfg80211_rtw_channel_switch, -+#endif -+#endif /* #ifdef CONFIG_AP_MODE */ -+}; -+ -+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_ERR("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 -+ wiphy_data->txpwr_total_lmt_mbm = UNSPECIFIED_MBM; -+ wiphy_data->txpwr_total_target_mbm = UNSPECIFIED_MBM; -+ -+ rtw_regd_init(wiphy); -+ -+ if (rtw_cfg80211_init_wiphy(padapter, wiphy) != _SUCCESS) { -+ rtw_wiphy_free(wiphy); -+ wiphy = NULL; -+ goto exit; -+ } -+ -+ 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)); -+ -+ rtw_regd_deinit(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) -+{ -+ struct get_chplan_resp *chplan; -+ int ret; -+ -+ 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 -+ -+ ret = wiphy_register(wiphy); -+ if (ret != 0) { -+ RTW_INFO(FUNC_WIPHY_FMT" wiphy_register() return %d\n", FUNC_WIPHY_ARG(wiphy), ret); -+ goto exit; -+ } -+ -+ rtw_chset_hook_os_channels(dvobj_to_rfctl(wiphy_to_dvobj(wiphy))); -+ -+ if (rtw_get_chplan_cmd(wiphy_to_adapter(wiphy), RTW_CMDF_DIRECTLY, &chplan) == _SUCCESS) -+ rtw_regd_change_complete_sync(wiphy, chplan, 1); -+ else -+ rtw_warn_on(1); -+ -+exit: -+ return ret; -+} -+ -+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; -+ 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; -+ -+ _rtw_mutex_init(&pwdev_priv->roch_mutex); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); -+#endif -+ -+#ifdef CONFIG_RTW_CFGVENDOR_RSSIMONITOR -+ pwdev_priv->rssi_monitor_enable = 0; -+ pwdev_priv->rssi_monitor_max = 0; -+ pwdev_priv->rssi_monitor_min = 0; -+#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; -+ } -+ -+exit: -+#endif -+ -+ return ret; -+} -+ -+void rtw_cfg80211_ndev_res_free(_adapter *adapter) -+{ -+ rtw_wdev_free(adapter->rtw_wdev); -+ adapter->rtw_wdev = NULL; -+#if !defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_free(adapter_to_wiphy(adapter)); -+ adapter->wiphy = NULL; -+#endif -+} -+ -+ -+int rtw_cfg80211_ndev_res_register(_adapter *adapter) -+{ -+#if !defined(RTW_SINGLE_WIPHY) -+ int ret = _FAIL; -+ -+ 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; -+ } -+ -+ #ifdef CONFIG_RFKILL_POLL -+ rtw_cfg80211_init_rfkill(adapter_to_wiphy(adapter)); -+ #endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+#else -+ return _SUCCESS; -+#endif -+} -+ -+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_get_primary_adapter(dvobj), dev); -+ if (wiphy == NULL) -+ return ret; -+ -+ dvobj->wiphy = wiphy; -+#endif -+ -+ ret = _SUCCESS; -+ 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) -+ return ret; -+ -+#ifdef CONFIG_RFKILL_POLL -+ rtw_cfg80211_init_rfkill(dvobj_to_wiphy(dvobj)); -+#endif -+#endif -+ -+ ret = _SUCCESS; -+ -+ return ret; -+} -+ -+void rtw_cfg80211_dev_res_unregister(struct dvobj_priv *dvobj) -+{ -+#if defined(RTW_SINGLE_WIPHY) -+#ifdef CONFIG_RFKILL_POLL -+ rtw_cfg80211_deinit_rfkill(dvobj_to_wiphy(dvobj)); -+#endif -+ rtw_wiphy_unregister(dvobj_to_wiphy(dvobj)); -+#endif -+} -+ -+s16 rtw_cfg80211_dev_get_total_txpwr_lmt_mbm(struct dvobj_priv *dvobj) -+{ -+ struct rtw_wiphy_data *wiphy_data; -+ s16 mbm = UNSPECIFIED_MBM; -+ -+ /* TODO: input radio index to choose corresponding wiphy(s) */ -+ -+#if defined(RTW_SINGLE_WIPHY) -+ wiphy_data = rtw_wiphy_priv(dvobj_to_wiphy(dvobj)); -+ mbm = wiphy_data->txpwr_total_lmt_mbm; -+#else -+ struct wiphy *wiphy; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!dvobj->padapters[i]) -+ continue; -+ wiphy = dvobj->padapters[i]->wiphy; -+ if (!wiphy) -+ continue; -+ wiphy_data = rtw_wiphy_priv(wiphy); -+ if (wiphy_data->txpwr_total_lmt_mbm == UNSPECIFIED_MBM) -+ continue; -+ if (mbm > wiphy_data->txpwr_total_lmt_mbm) -+ mbm = wiphy_data->txpwr_total_lmt_mbm; -+ } -+#endif -+ -+ return mbm; -+} -+ -+s16 rtw_cfg80211_dev_get_total_txpwr_target_mbm(struct dvobj_priv *dvobj) -+{ -+ struct rtw_wiphy_data *wiphy_data; -+ s16 mbm = UNSPECIFIED_MBM; -+ -+ /* TODO: input radio index to choose corresponding wiphy(s) */ -+ -+#if defined(RTW_SINGLE_WIPHY) -+ wiphy_data = rtw_wiphy_priv(dvobj_to_wiphy(dvobj)); -+ mbm = wiphy_data->txpwr_total_target_mbm; -+#else -+ struct wiphy *wiphy; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!dvobj->padapters[i]) -+ continue; -+ wiphy = dvobj->padapters[i]->wiphy; -+ if (!wiphy) -+ continue; -+ wiphy_data = rtw_wiphy_priv(wiphy); -+ if (wiphy_data->txpwr_total_target_mbm == UNSPECIFIED_MBM) -+ continue; -+ if (mbm > wiphy_data->txpwr_total_target_mbm) -+ mbm = wiphy_data->txpwr_total_target_mbm; -+ } -+#endif -+ -+ return mbm; -+} -+#endif /* CONFIG_IOCTL_CFG80211 */ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_cfg80211.h b/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_cfg80211.h -new file mode 100644 -index 000000000..f3e6d791a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_cfg80211.h -@@ -0,0 +1,460 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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__ -+ -+#define RTW_CFG80211_BLOCK_DISCON_WHEN_CONNECT BIT0 -+#define RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT BIT1 -+ -+#ifndef RTW_CFG80211_BLOCK_STA_DISCON_EVENT -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) -+#define RTW_CFG80211_BLOCK_STA_DISCON_EVENT (RTW_CFG80211_BLOCK_DISCON_WHEN_CONNECT) -+#else -+#define RTW_CFG80211_BLOCK_STA_DISCON_EVENT (RTW_CFG80211_BLOCK_DISCON_WHEN_CONNECT | RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT) -+#endif -+#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 -+ -+#ifndef CONFIG_RADIO_WORK -+#define RTW_ROCH_DURATION_ENLARGE -+#define RTW_ROCH_BACK_OP -+#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 -+ -+#ifdef CONFIG_RTW_MESH -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 0)) -+ #error "CONFIG_RTW_MESH can't be enabled when kernel < 3.10.0\n" -+ #endif -+#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_BLOCK_STA_DISCON_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; -+ systime 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; -+ -+ /** -+ * mgmt_regs: bitmap of management frame subtypes registered for the -+ * given interface -+ * mcast_mgmt_regs: mcast RX is needed on this interface for these -+ * subtypes -+ */ -+ u32 mgmt_regs; -+ /* u32 mcast_mgmt_regs; */ -+ -+ u8 is_mgmt_tx; -+ u16 mgmt_tx_cookie; -+ -+ _mutex roch_mutex; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_T switch_ch_to; -+#endif -+ -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ u8 pno_mac_addr[ETH_ALEN]; -+ u16 pno_scan_seq_num; -+#endif -+ -+#ifdef CONFIG_RTW_CFGVENDOR_RSSIMONITOR -+ s8 rssi_monitor_max; -+ s8 rssi_monitor_min; -+ u8 rssi_monitor_enable; -+#endif -+ -+}; -+ -+enum external_auth_action { -+ EXTERNAL_AUTH_START, -+ EXTERNAL_AUTH_ABORT, -+}; -+ -+struct rtw_external_auth_params { -+ enum external_auth_action action; -+ u8 bssid[ETH_ALEN]__aligned(2); -+ struct cfg80211_ssid ssid; -+ unsigned int key_mgmt_suite; -+ u16 status; -+ u8 pmkid[PMKID_LEN]; -+}; -+ -+bool rtw_cfg80211_is_connect_requested(_adapter *adapter); -+ -+#if RTW_CFG80211_BLOCK_STA_DISCON_EVENT -+#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) -+#else -+#define rtw_wdev_not_indic_disco(rtw_wdev_data) 0 -+#define rtw_wdev_set_not_indic_disco(rtw_wdev_data, val) do {} 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 -+ -+ _list async_regd_change_list; -+ _mutex async_regd_change_mutex; -+ _workitem async_regd_change_work; -+ -+ s16 txpwr_total_lmt_mbm; /* EIRP */ -+ s16 txpwr_total_target_mbm; /* EIRP */ -+}; -+ -+#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_MGMT_REGS(w, t) (w |= BIT(t >> 4)) -+#define CLR_CFG80211_MGMT_REGS(w, t) (w &= (~BIT(t >> 4))) -+#define GET_CFG80211_MGMT_REGS(w, t) ((w & BIT(t >> 4)) > 0) -+ -+#define SET_CFG80211_REPORT_MGMT(w, t) (SET_CFG80211_MGMT_REGS(w->mgmt_regs, t)) -+#define CLR_CFG80211_REPORT_MGMT(w, t) (CLR_CFG80211_MGMT_REGS(w->mgmt_regs, t)) -+#define GET_CFG80211_REPORT_MGMT(w, t) (GET_CFG80211_MGMT_REGS(w->mgmt_regs, t)) -+ -+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); -+s16 rtw_cfg80211_dev_get_total_txpwr_lmt_mbm(struct dvobj_priv *dvobj); -+s16 rtw_cfg80211_dev_get_total_txpwr_target_mbm(struct dvobj_priv *dvobj); -+ -+void rtw_cfg80211_init_wdev_data(_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, const u8 *da, unsigned short reason); -+int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, int type); -+#endif /* CONFIG_AP_MODE */ -+ -+void rtw_cfg80211_set_is_roch(_adapter *adapter, bool val); -+bool rtw_cfg80211_get_is_roch(_adapter *adapter); -+bool rtw_cfg80211_is_ro_ch_once(_adapter *adapter); -+void rtw_cfg80211_set_last_ro_ch_time(_adapter *adapter); -+s32 rtw_cfg80211_get_last_ro_ch_passing_ms(_adapter *adapter); -+ -+#ifdef CONFIG_P2P -+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); -+u8 rtw_mgnt_tx_handler(_adapter *adapter, u8 *buf); -+ -+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_mframe(_adapter *adapter, union recv_frame *rframe, const char *msg); -+void rtw_cfg80211_rx_probe_request(_adapter *padapter, union recv_frame *rframe); -+ -+void rtw_cfg80211_external_auth_request(_adapter *padapter, union recv_frame *rframe); -+void rtw_cfg80211_external_auth_status(struct wiphy *wiphy, struct net_device *dev, -+ struct rtw_external_auth_params *params); -+ -+bool rtw_cfg80211_pwr_mgmt(_adapter *adapter); -+#ifdef CONFIG_RTW_80211K -+void rtw_cfg80211_rx_rrm_action(_adapter *adapter, union recv_frame *rframe); -+#endif -+ -+#ifdef CONFIG_RFKILL_POLL -+void rtw_cfg80211_init_rfkill(struct wiphy *wiphy); -+void rtw_cfg80211_deinit_rfkill(struct wiphy *wiphy); -+#endif -+ -+#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 (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 0, 0)) -+#define rtw_cfg80211_notify_new_peer_candidate(wdev, addr, ie, ie_len, sig_dbm, gfp) cfg80211_notify_new_peer_candidate(wdev_to_ndev(wdev), addr, ie, ie_len, sig_dbm, gfp) -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+#define rtw_cfg80211_notify_new_peer_candidate(wdev, addr, ie, ie_len, sig_dbm, gfp) cfg80211_notify_new_peer_candidate(wdev_to_ndev(wdev), addr, ie, ie_len, gfp) -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) -+u8 rtw_cfg80211_ch_switch_notify(_adapter *adapter, u8 ch, u8 bw, u8 offset, u8 ht, bool started); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) && (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 31)) -+#define IEEE80211_CHAN_NO_HT40PLUS IEEE80211_CHAN_NO_FAT_ABOVE -+#define IEEE80211_CHAN_NO_HT40MINUS IEEE80211_CHAN_NO_FAT_BELOW -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)) && (LINUX_VERSION_CODE < KERNEL_VERSION(4, 7, 0)) -+#define NL80211_BAND_2GHZ IEEE80211_BAND_2GHZ -+#define NL80211_BAND_5GHZ IEEE80211_BAND_5GHZ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+#define NL80211_BAND_60GHZ IEEE80211_BAND_60GHZ -+#endif -+#define NUM_NL80211_BANDS IEEE80211_NUM_BANDS -+#endif -+ -+extern enum nl80211_band _rtw_band_to_nl80211_band[]; -+#define rtw_band_to_nl80211_band(band) (((band) < BAND_MAX) ? _rtw_band_to_nl80211_band[(band)] : NUM_NL80211_BANDS) -+ -+extern BAND_TYPE _nl80211_band_to_rtw_band[]; -+#define nl80211_band_to_rtw_band(band) (((band) < NUM_NL80211_BANDS) ? _nl80211_band_to_rtw_band[(band)] : BAND_MAX) -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 36)) -+#define NL80211_TX_POWER_AUTOMATIC TX_POWER_AUTOMATIC -+#define NL80211_TX_POWER_LIMITED TX_POWER_LIMITED -+#define NL80211_TX_POWER_FIXED TX_POWER_FIXED -+#endif -+ -+#include "wifi_regd.h" -+#include "rtw_cfgvendor.h" -+ -+#endif /* __IOCTL_CFG80211_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_linux.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_linux.c -new file mode 100644 -index 000000000..57f1ca545 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_linux.c -@@ -0,0 +1,13116 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 "../../hal/phydm/phydm_precomp.h" -+#ifdef RTW_HALMAC -+#include "../../hal/hal_halmac.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) -+ -+#define SCAN_ITEM_SIZE 768 -+#define MAX_CUSTOM_LEN 64 -+#define RATE_COUNT 4 -+#define MAX_SCAN_BUFFER_LEN 65535 -+ -+#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}; -+ -+#ifdef CONFIG_RTW_ANDROID -+static void indicate_wx_custom_event(_adapter *padapter, char *msg) -+{ -+ u8 *buff; -+ 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); -+ -+} -+#endif -+ -+#if 0 -+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); -+ -+} -+#endif -+ -+#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; -+ -+ _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; -+} -+*/ -+ -+#ifdef CONFIG_IOCTL_WEXT -+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] == BSS_TYPE_PROB_REQ ? 0 : 12); /* Probe Request */ -+ -+#ifdef CONFIG_80211N_HT -+ /* parsing HT_CAP_IE */ -+ if(padapter->registrypriv.ht_enable && is_supported_ht(padapter->registrypriv.wireless_mode)) { -+ 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; -+ } -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ /* parsing VHT_CAP_IE */ -+ if(padapter->registrypriv.wireless_mode & WIRELESS_11AC) { -+ 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] == BSS_TYPE_PROB_REQ ? 0 : 12); /* Probe Request */ -+ -+ /* parsing HT_CAP_IE */ -+ if(is_supported_ht(padapter->registrypriv.wireless_mode)) { -+ 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 */ -+ if(padapter->registrypriv.wireless_mode & WIRELESS_11AC){ -+ 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] != BSS_TYPE_PROB_REQ) { /* 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] == BSS_TYPE_PROB_REQ ? 0 : 12); -+ -+ u8 *ie_ptr = pnetwork->network.IEs + ie_offset; -+ total_ielen = pnetwork->network.IELength - ie_offset; -+ -+ if (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ) { /* 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] != BSS_TYPE_PROB_REQ) { /* 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); -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ s16 noise = 0; -+#endif -+ -+ /* Add quality statistics */ -+ iwe->cmd = IWEVQUAL; -+ iwe->u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED -+#ifdef 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, WIFI_ASOC_STATE) == _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 -+ iwe->u.qual.level = (u8)ss; /* % */ -+#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 -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ if (IS_NM_ENABLE(padapter)) { -+ noise = rtw_noise_query_by_chan_num(padapter, pnetwork->network.Configuration.DSConfig); -+ #ifndef CONFIG_SIGNAL_DISPLAY_DBM -+ noise = translate_dbm_to_percentage(noise);/*percentage*/ -+ #endif -+ iwe->u.qual.noise = 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; -+ 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; -+} -+ -+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] == BSS_TYPE_PROB_REQ) /* 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; -+} -+ -+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; -+ _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); -+ -+ padapter->mlmeextpriv.mlmext_info.key_index = 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_INFO(FUNC_ADPT_FMT" set %s PTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len); -+ _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 */ -+ _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; -+ } -+ psta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psta->dot11rxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psta->bpairwise_key_installed = _TRUE; -+ 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_INFO(FUNC_ADPT_FMT" set %s GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len); -+ _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; -+ if (param->u.crypt.idx < 4) -+ _rtw_memcpy(padapter->securitypriv.iv_seq[param->u.crypt.idx], param->u.crypt.seq, 8); -+ 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) { -+ RTW_INFO(FUNC_ADPT_FMT" set IGTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ _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)); -+ psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; -+ psecuritypriv->dot11wBIPrxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psecuritypriv->binstallBIPkey = _TRUE; -+ #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 */ -+ -+ /* WPA/WPA2 key-handshake has completed */ -+ clr_fwstate(pmlmepriv, WIFI_UNDER_KEY_HANDSHAKE); -+ } -+ } -+ -+ 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) -+ rtw_wapi_set_set_encryption(padapter, param); -+#endif -+ -+exit: -+ -+ -+ return ret; -+} -+ -+static int rtw_set_wpa_ie(_adapter *padapter, char *pie, unsigned short ielen) -+{ -+ u8 *buf = NULL, *pos = NULL; -+ int group_cipher = 0, pairwise_cipher = 0; -+ u8 mfp_opt = MFP_NO; -+ 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 (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, NULL, &mfp_opt, 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; -+ } -+ -+ if (mfp_opt == MFP_INVALID) { -+ RTW_INFO(FUNC_ADPT_FMT" invalid MFP setting\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EINVAL; -+ goto exit; -+ } -+ padapter->securitypriv.mfp_opt = mfp_opt; -+ -+ _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 */ -+ } -+ } -+ } -+ -+ #ifdef CONFIG_RTW_MULTI_AP -+ padapter->multi_ap = rtw_get_multi_ap_ie_ext(buf, ielen) & MULTI_AP_BACKHAUL_STA; -+ if (padapter->multi_ap) -+ adapter_set_use_wds(padapter, 1); -+ #endif -+ } -+ -+ /* 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); -+ 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, WIFI_ASOC_STATE | WIFI_ADHOC_MASTER_STATE) == _TRUE) { -+ /* parsing HT_CAP_IE */ -+ if( is_supported_ht(padapter->registrypriv.wireless_mode)&&(padapter->registrypriv.ht_enable)) { -+ 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 ((padapter->registrypriv.wireless_mode & WIRELESS_11AC) && -+ (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 { -+ if(padapter->registrypriv.wireless_mode & WIRELESS_11G) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bg"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11b"); -+ } -+ } 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); -+ int exp = 1, freq = 0, div = 0; -+ -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ if (rtw_pwr_wakeup(padapter) == _FALSE) -+ goto exit; -+ if (wrqu->freq.m <= 1000) { -+ if (wrqu->freq.flags == IW_FREQ_AUTO) { -+ if (rtw_chset_search_ch(adapter_to_chset(padapter), 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); -+exit: -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ -+ 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, WIFI_ASOC_STATE) == _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; -+ -+ if (wrqu->mode != IW_MODE_MONITOR) { -+ rtw_ps_deny_cancel(padapter, PS_DENY_MONITOR_MODE); -+ } -+ -+ switch (wrqu->mode) { -+#ifdef CONFIG_WIFI_MONITOR -+ case IW_MODE_MONITOR: -+ networkType = Ndis802_11Monitor; -+ -+ rtw_ps_deny(padapter, PS_DENY_MONITOR_MODE); -+ LeaveAllPowerSaveMode(padapter); -+ -+#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; -+#endif /* CONFIG_WIFI_MONITOR */ -+ 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"); -+ break; -+ case IW_MODE_INFRA: -+ networkType = Ndis802_11Infrastructure; -+ RTW_INFO("set_mode = IW_MODE_INFRA\n"); -+ break; -+ -+ default: -+ ret = -EINVAL;; -+ goto exit; -+ } -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, networkType, 0) == _FALSE) { -+ -+ ret = -EPERM; -+ goto exit; -+ -+ } -+ -+ rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_WAIT_ACK); -+ -+ 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 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; -+ 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, WIFI_ASOC_STATE) == _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 rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ 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 -+ */ -+ 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 < rfctl->max_chan_nums; i++) { -+ -+ /* Include only legal frequencies for some countries */ -+ if (rfctl->channel_set[i].ChannelNum != 0) { -+ range->freq[val].i = rfctl->channel_set[i].ChannelNum; -+ range->freq[val].m = rtw_ch2freq(rfctl->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, WIFI_UNDER_SURVEY | WIFI_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, 0)) { -+ 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); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+exit: -+#endif -+ 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, WIFI_ASOC_STATE)) == _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; -+ } -+#ifdef CONFIG_RTW_REPEATER_SON -+ rtw_rson_do_disconnect(padapter); -+#endif -+ 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;*/ -+ struct sitesurvey_parm parm; -+ u8 ssc_chk; -+#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 1 -+ ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); -+ -+ #ifdef CONFIG_DOSCAN_IN_BUSYTRAFFIC -+ if ((ssc_chk != SS_ALLOW) && (ssc_chk != SS_DENY_BUSY_TRAFFIC)) -+ #else -+ /* 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 (ssc_chk != SS_ALLOW) -+ #endif -+ { -+ if (ssc_chk == SS_DENY_MP_MODE) -+ ret = -EPERM; -+ #ifdef DBG_LA_MODE -+ else if (ssc_chk == SS_DENY_LA_MODE) -+ ret = -EPERM; -+ #endif -+ else -+ indicate_wx_scan_complete_event(padapter); -+ -+ goto exit; -+ } else -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ 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; -+ } -+#else -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_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)) { -+ indicate_wx_scan_complete_event(padapter); -+ goto cancel_ps_deny; -+ } -+#endif -+#ifdef CONFIG_RTW_REPEATER_SON -+ if (padapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) { -+ RTW_INFO(FUNC_ADPT_FMT" blocking scan for under rson scanning process\n", FUNC_ADPT_ARG(padapter)); -+ 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, WIFI_UNDER_SURVEY | WIFI_UNDER_LINKING) == _TRUE) { -+ indicate_wx_scan_complete_event(padapter); -+ goto cancel_ps_deny; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, -+ WIFI_UNDER_SURVEY | WIFI_UNDER_LINKING | WIFI_UNDER_WPS)) { -+ -+ indicate_wx_scan_complete_event(padapter); -+ goto cancel_ps_deny; -+ } -+#endif -+#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 */ -+ -+#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_init_sitesurvey_parm(padapter, &parm); -+ _rtw_memcpy(&parm.ssid[0].Ssid, &req->essid, len); -+ parm.ssid[0].SsidLength = len; -+ parm.ssid_num = 1; -+ -+ 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, &parm); -+ -+ } 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__); */ -+ rtw_init_sitesurvey_parm(padapter, &parm); -+ -+ 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) { -+ -+ parm.ssid[ssid_index].SsidLength = sec_len; -+ _rtw_memcpy(&parm.ssid[ssid_index].Ssid, pos, sec_len); -+ -+ /* RTW_INFO("%s COMBO_SCAN with specific parm.ssid:%s, %d\n", __FUNCTION__ */ -+ /* , parm.ssid[ssid_index].Ssid, parm.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); */ -+ -+ } -+ parm.ssid_num = ssid_index; -+ -+ /* jeff: it has still some scan paramater to parse, we only do this now... */ -+ _status = rtw_set_802_11_bssid_list_scan(padapter, &parm); -+ -+ } else -+ -+ _status = rtw_set_802_11_bssid_list_scan(padapter, NULL); -+ -+ 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 rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ RT_CHANNEL_INFO *chset = rfctl->channel_set; -+ 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 wait_for_surveydone; -+ sint wait_status; -+ u8 ch; -+ -+#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 = WIFI_UNDER_SURVEY -+#ifndef CONFIG_RTW_ANDROID -+ | WIFI_UNDER_LINKING -+#endif -+ ; -+ -+ while (check_fwstate(pmlmepriv, wait_status) == _TRUE) -+ return -EAGAIN; -+#else -+ wait_status = WIFI_UNDER_SURVEY -+#ifndef CONFIG_RTW_ANDROID -+ | WIFI_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) { -+ if(wrqu->data.length == MAX_SCAN_BUFFER_LEN){ /*max buffer len defined by iwlist*/ -+ ret = 0; -+ RTW_INFO("%s: Scan results incomplete\n", __FUNCTION__); -+ break; -+ } -+ ret = -E2BIG; -+ break; -+ } -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ ch = pnetwork->network.Configuration.DSConfig; -+ -+ /* report network only if the current channel set contains the channel to which this network belongs */ -+ if (rtw_chset_search_ch(chset, ch) >= 0 -+ && rtw_mlme_band_check(padapter, ch) == _TRUE -+ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) -+ && (!IS_DFS_SLAVE_WITH_RD(rfctl) -+ || rtw_rfctl_dfs_domain_unknown(rfctl) -+ || !rtw_chset_is_ch_non_ocp(chset, ch)) -+ ) -+ 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; -+ 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, WIFI_UNDER_SURVEY | WIFI_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, 0) == _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, WIFI_ASOC_STATE) == _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 ret = 0; -+#if 0 -+ int i; -+ _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; -+ } -+ -+#endif -+ 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, WIFI_ASOC_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) { -+ 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); -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u32 value = param->value; -+#endif -+#endif -+ 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_RTW_ANDROID) || 1 -+ /* -+ * It's the starting point of a link layer connection using wpa_supplicant -+ */ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) { -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, RTW_CMDF_WAIT_ACK); -+ RTW_INFO("%s...call rtw_indicate_disconnect\n ", __FUNCTION__); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ rtw_free_assoc_resources_cmd(padapter, _TRUE, RTW_CMDF_WAIT_ACK); -+ } -+#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; -+ -+} -+#endif -+ -+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; -+} -+ -+#ifdef CONFIG_RTW_80211K -+extern void rm_dbg_cmd(_adapter *padapter, char *s); -+static int rtw_wx_priv_rrm(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u32 path, addr, data32; -+ -+ -+ rm_dbg_cmd(padapter, b); -+ wrqu->data.length = strlen(b); -+ -+ return 0; -+} -+#endif -+ -+#ifdef CONFIG_IOCTL_WEXT -+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; -+ -+} -+#endif -+ -+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); -+ u16 channel_plan_req = (u16)(*((int *)wrqu)); -+ -+ rtw_chplan_ioctl_input_mapping(&channel_plan_req, NULL); -+ -+ if (_SUCCESS != rtw_set_channel_plan(padapter, channel_plan_req, RTW_CHPLAN_6G_UNSPECIFIED, RTW_REGD_SET_BY_USER)) -+ 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 -+} -+ -+#ifdef MP_IOCTL_HDL -+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; -+ } -+ -+} -+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 /*MP_IOCTL_HDL*/ -+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; -+ _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, (WIFI_UNDER_SURVEY | WIFI_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(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); -+ -+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 wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ enum P2P_ROLE init_role = P2P_ROLE_DISABLE; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#endif -+ -+ 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(&prochinfo->ap_roch_ch_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 wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ RTW_INFO("[%s] ssid = %s, len = %zu\n", __FUNCTION__, extra, strlen(extra)); -+ if( strlen(extra) > WPS_MAX_DEVICE_NAME_LEN){ -+ RTW_ERR("Invalid strlen(extra): %zu\n", strlen(extra)); -+ rtw_warn_on(1); -+ return -1; -+ } -+ _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); -+ if( wrqu->data.length - 1 > WPS_MAX_DEVICE_NAME_LEN){ -+ RTW_ERR("Invalid wrqu->data.length:%d\n", wrqu->data.length - 1); -+ rtw_warn_on(1); -+ return -1; -+ } -+ _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 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 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 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 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 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 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 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 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) { -+ attr_contentlen = sizeof(attr_content); -+ 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 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 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 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); -+ attr_contentlen = sizeof(attr_content); -+ 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) { -+ dev_type_len = sizeof(dev_type); -+ 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) { -+ dev_len = sizeof(dev_name); -+ 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 = 2; -+ 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); */ -+ attr_contentlen = sizeof(attr_content); -+ 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; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ uint uintPeerChannel = 0; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#endif -+ -+ /* 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; -+ } -+ -+ 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(&prochinfo->ap_roch_ch_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); -+ -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ rtw_leave_opch(padapter); -+ } -+#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__); -+ ret = -1; -+ } -+ -+ 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 wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ int jj, kk; -+ 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 }; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 50; -+ _irqL irqL; -+ struct tx_invite_req_info *pinvite_req_info = &pwdinfo->invitereq_info; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#endif -+ -+ /* 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. */ -+ -+ attr_contentlen = sizeof(attr_content); -+ 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(&prochinfo->ap_roch_ch_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); -+ -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ rtw_leave_opch(padapter); -+ -+ } 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/*CONFIG_CONCURRENT_MODE*/ -+ -+ _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 wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ /* 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); -+ -+ return ret; -+ -+} -+ -+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 wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ int jj, kk; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 attr_content[50] = { 0x00 }; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 50; -+ _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__); -+ attr_contentlen = sizeof(attr_content); -+ 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__); -+ -+ 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 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; -+ -+ 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 wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ 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); -+ -+ 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; -+ 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 }; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 100; -+ _irqL irqL; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct roch_info *prochinfo = &padapter->rochinfo; -+#endif -+ -+ /* 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 { -+ /* 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. */ -+ attr_contentlen = sizeof(attr_content); -+ 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); -+ } -+ -+ } -+ -+ 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(&prochinfo->ap_roch_ch_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); -+ -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ rtw_leave_opch(padapter); -+ -+ } 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__); -+ } -+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); -+ -+ 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); -+ -+ 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; -+ -+} -+ -+#ifdef CONFIG_MP_INCLUDED -+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); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ -+ RTW_INFO("%s %s\n", __func__, extra); -+ if (!strcmp(extra, "1")) -+ hal_data->in_cta_test = 1; -+ else -+ hal_data->in_cta_test = 0; -+ -+ rtw_hal_rcr_set_chk_bssid(padapter, MLME_ACTION_NONE); -+ -+ return ret; -+} -+#endif -+ -+#ifdef CONFIG_IOL -+#include -+#endif -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+#include "../../hal/hal_dm_acs.h" -+#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) -+{ -+ int ret = 0; -+#ifdef CONFIG_RTW_DEBUG -+ _irqL irqL; -+ 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 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->cmn.mac_addr)); -+ 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->cmn.aid, psta->cmn.mac_id, psta->cmn.ra_info.rate_id); -+#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->cmn.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: { -+ u64 tsf = 0; -+ -+ tsf = rtw_hal_get_tsftr_by_port(padapter, extra_arg); -+ RTW_INFO(" PORT-%d TSF :%21lld\n", extra_arg, tsf); -+ } -+ 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_DUMP("sta_dz_bitmap:", pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); -+ RTW_INFO_DUMP("tim_bitmap:", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); -+#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->cmn.aid) { -+ RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); -+ 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->cmn.aid, psta->cmn.mac_id, psta->cmn.ra_info.rate_id); -+#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->cmn.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; -+ -+#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: { -+ RTW_INFO("===========================================\n"); -+ rtw_noise_measure_curchan(padapter); -+ 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 0x20: -+ { -+ if (arg == 0xAA) { -+ u8 page_offset, page_num; -+ -+ page_offset = (u8)(extra_arg >> 16); -+ page_num = (u8)(extra_arg & 0xFF); -+ rtw_dump_rsvd_page(RTW_DBGDUMP, padapter, page_offset, page_num); -+ } -+#ifdef CONFIG_SUPPORT_FIFO_DUMP -+ else { -+ u8 fifo_sel; -+ u32 addr, size; -+ -+ fifo_sel = (u8)(arg & 0x0F); -+ addr = (extra_arg >> 16) & 0xFFFF; -+ size = extra_arg & 0xFFFF; -+ rtw_dump_fifo(RTW_DBGDUMP, padapter, fifo_sel, addr, size); -+ } -+#endif -+ } -+ break; -+ -+ 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); -+ else if (extra_arg == 11) -+ bb_reg_dump_ex(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; -+ } -+ -+#endif -+ return ret; -+ -+} -+ -+#ifdef CONFIG_IOCTL_WEXT -+static int wpa_set_param(struct net_device *dev, u8 name, u32 value) -+{ -+ uint ret = 0; -+ _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; -+ } -+#ifdef CONFIG_RTW_REPEATER_SON -+ rtw_rson_do_disconnect(padapter); -+#endif -+ 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(FUNC_ADPT_FMT" set WEP TX GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ _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(FUNC_ADPT_FMT" set TKIP TX GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ 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)); -+ /* 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(FUNC_ADPT_FMT" set CCMP TX GTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ 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) { -+ RTW_INFO(FUNC_ADPT_FMT" set TX IGTK idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); -+ _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)); -+ psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; -+ psecuritypriv->dot11wBIPtxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psecuritypriv->binstallBIPkey = _TRUE; -+ goto exit; -+ #endif /* CONFIG_IEEE80211W */ -+ -+ } else if (strcmp(param->u.crypt.alg, "none") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" clear group key, idx:%u\n" -+ , FUNC_ADPT_ARG(padapter), param->u.crypt.idx); -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } else { -+ RTW_WARN(FUNC_ADPT_FMT" set group key, not support\n" -+ , FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta) { -+ pbcmc_sta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ -+ } -+ psecuritypriv->binstallGrpkey = _TRUE; -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ } -+ -+ 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(FUNC_ADPT_FMT" set WEP PTK of "MAC_FMT" idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot118021XPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ psta->dot118021XPrivacy = _WEP104_; -+ -+ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" set TKIP PTK of "MAC_FMT" idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot118021XPrivacy = _TKIP_; -+ /* 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(FUNC_ADPT_FMT" set CCMP PTK of "MAC_FMT" idx:%u, len:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx, param->u.crypt.key_len); -+ psta->dot118021XPrivacy = _AES_; -+ -+ } else if (strcmp(param->u.crypt.alg, "none") == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" clear pairwise key of "MAC_FMT" idx:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) -+ , param->u.crypt.idx); -+ psta->dot118021XPrivacy = _NO_PRIVACY_; -+ -+ } else { -+ RTW_WARN(FUNC_ADPT_FMT" set pairwise key of "MAC_FMT", not support\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); -+ goto exit; -+ } -+ -+ psta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psta->dot11rxpn.val = RTW_GET_LE64(param->u.crypt.seq); -+ psta->ieee8021x_blocked = _FALSE; -+ -+ if (psta->dot118021XPrivacy != _NO_PRIVACY_) { -+ psta->bpairwise_key_installed = _TRUE; -+ -+ /* WPA2 key-handshake has completed */ -+ if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) -+ psta->state &= (~WIFI_UNDER_KEY_HANDSHAKE); -+ } -+ -+ rtw_ap_set_pairwise_key(padapter, psta); -+ } else { -+ RTW_WARN(FUNC_ADPT_FMT" set group key of "MAC_FMT", not support\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); -+ goto exit; -+ } -+ -+ } -+ -+ } -+ -+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 */ -+#ifdef CONFIG_AP_MODE -+ ret = rtw_sta_flush(padapter, _TRUE); -+#endif -+ return ret; -+ -+} -+ -+static int rtw_add_sta(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_add_sta(aid=%d)=" MAC_FMT "\n", param->u.add_sta.aid, MAC_ARG(param->sta_addr)); -+ -+ if (check_fwstate(pmlmepriv, (WIFI_ASOC_STATE | 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->cmn.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 (padapter->registrypriv.ht_enable && -+ is_supported_ht(padapter->registrypriv.wireless_mode) && -+ (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, (WIFI_ASOC_STATE | 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->cmn.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--; -+ #ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ if (psta->tbtx_enable) -+ pstapriv->tbtx_asoc_list_cnt--; -+ #endif -+ 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, (WIFI_ASOC_STATE | 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->cmn.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 -+ if(padapter->registrypriv.ht_enable && is_supported_ht(padapter->registrypriv.wireless_mode)) -+ _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, (WIFI_ASOC_STATE | 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); -+ 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, 0); -+ -+ 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, RTW_ACL_PERIOD_BSS, 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, RTW_ACL_PERIOD_BSS, 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, RTW_ACL_PERIOD_BSS, 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 /* CONFIG_AP_MODE */ -+ -+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; -+#ifdef CONFIG_RTW_ANDROID -+ int i; -+#endif -+ -+ _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_RTW_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, WIFI_ASOC_STATE) == _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, RTW_REGD_SET_BY_USER); -+ 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; -+ -+} -+#endif /*CONFIG_IOCTL_WEXT*/ -+ -+#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; -+ int ret = 0; -+ systime start_time = rtw_get_current_time(); -+ poidparam.subcode = 0; -+ -+ RTW_INFO("+rtw_wowlan_ctrl: %s\n", extra); -+ -+ if (!check_fwstate(pmlmepriv, WIFI_ASOC_STATE) && -+ check_fwstate(pmlmepriv, WIFI_STATION_STATE) && -+ !WOWLAN_IS_STA_MIX_MODE(padapter)) { -+#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, WIFI_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)); -+ 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; -+ u8 input[MAX_IN_PATTERN_SIZE]; -+ u8 index = 0; -+ -+ poidparam.subcode = 0; -+ -+ if (!check_fwstate(pmlmepriv, WIFI_ASOC_STATE) && -+ 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) || (wrqu->data.length > MAX_IN_PATTERN_SIZE)) { -+ ret = -EFAULT; -+ RTW_INFO("ERROR: parameter length error, len=%d\n", wrqu->data.length); -+ 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) ||(strncmp(input, "ack_pattern=", 12) == 0)) { -+ if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_CAM_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) { -+ #ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ if(strncmp(input, "ack_pattern=", 12) == 0) -+ pwrpriv->wowlan_keep_alive_ack_index = index; -+ else -+ pwrpriv->wowlan_wake_pattern_index = index; -+ RTW_INFO("pwrpriv->wowlan_keep_alive_ack_index =%d\n",pwrpriv->wowlan_keep_alive_ack_index); -+ RTW_INFO("pwrpriv->wowlan_wake_pattern_index =%d\n",pwrpriv->wowlan_wake_pattern_index); -+ #endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ pwrpriv->wowlan_pattern_idx++; -+ } -+ } -+ } else if (strncmp(input, "clean", 5) == 0) { -+ poidparam.subcode = WOWLAN_PATTERN_CLEAN; -+ #ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ pwrpriv->wowlan_wake_pattern_index = 0xFF; -+ pwrpriv->wowlan_keep_alive_ack_index = 0xFF; -+ #endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ -+ rtw_hal_set_hwreg(padapter, -+ HW_VAR_WOWLAN, (u8 *)&poidparam); -+ } else if (strncmp(input, "show", 4) == 0) { -+ rtw_wow_pattern_cam_dump(padapter); -+ rtw_wow_pattern_sw_dump(padapter); -+ } else { -+ RTW_INFO("ERROR: incorrect parameter!\n"); -+ ret = -EINVAL; -+ } -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ } -+_rtw_wowlan_set_pattern_exit: -+ return ret; -+} -+ -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+static int rtw_wowlan_set_keep_alive_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); -+ -+ int ret = 0,totoal_len=0,i=0,len=0; -+ char *cp = NULL; -+ u32 mode = 0xFF; /*para1*/ -+ u16 period = 15*10; /* para2;units:100ms,default 15s*/ -+ char tx_pattern[512]; /*para3*/ -+ u32 retry_intervel = 2*10; /* para4;units:100ms,default 2s*/ -+ u32 retry_limit_count = 5; /*para5*/ -+ -+ ret = sscanf(extra, "%d %hu %s %d %d", &mode , &period, tx_pattern, &retry_intervel, &retry_limit_count); -+ pwrpriv->wowlan_keep_alive_mode = mode; -+ -+ RTW_INFO("[%s] ret =%d \n", __func__ ,ret); -+ totoal_len = strlen(tx_pattern); -+ RTW_INFO("[%s] totoal_len=%d \n", __func__ ,totoal_len); -+ -+ if (mode && (ret < 3)) -+ return -EINVAL; -+ -+ if (((mode ==2) ||(mode ==3)) && ((retry_intervel*retry_limit_count) > period)) { -+ RTW_INFO("[%s] retry_intervel*retry_limit_count need smaller than period\n", __func__ ); -+ return -EINVAL; -+ } -+ -+ switch(mode){ -+ case wow_keep_alive_pattern_disable: -+ /*disable this feature*/ -+ pwrpriv->keep_alive_pattern_loc = 0; -+ pwrpriv->keep_alive_pattern_len = 0; -+ pwrpriv->wowlan_keep_alive_period = 0; -+ pwrpriv->wowlan_keep_alive_ack_index = 0xFF; -+ pwrpriv->wowlan_wake_pattern_index = 0xFF; -+ pwrpriv->wowlan_keep_alive_retry_interval = 0; -+ pwrpriv->wowlan_keep_alive_retry_counter = 0; -+ _rtw_memset(pwrpriv->keep_alive_pattern,0,WLAN_MAX_KEEP_ALIVE_IE_LEN); -+ RTW_INFO("[%s] clear pattern \n", __func__ ); -+ ret = _SUCCESS; -+ break; -+ case wow_keep_alive_pattern_tx: -+ /*only tx udp packet*/ -+ pwrpriv->wowlan_keep_alive_period = period; -+ pwrpriv->wowlan_keep_alive_retry_interval = 0; -+ pwrpriv->wowlan_keep_alive_retry_counter = 0; -+ RTW_INFO("[%s] wow_keep_alive_pattern_tx \n", __func__ ); -+ break; -+ case wow_keep_alive_pattern_trx: -+ /*trx+no need wakeup*/ -+ pwrpriv->wowlan_keep_alive_period = period; -+ pwrpriv->wowlan_keep_alive_retry_interval = retry_intervel; -+ pwrpriv->wowlan_keep_alive_retry_counter = retry_limit_count; -+ RTW_INFO("[%s] wow_keep_alive_pattern_trx \n", __func__ ); -+ break; -+ case wow_keep_alive_pattern_trx_with_ack: -+ /*trx+need wakeup*/ -+ pwrpriv->wowlan_keep_alive_period = period; -+ pwrpriv->wowlan_keep_alive_retry_interval = retry_intervel; -+ pwrpriv->wowlan_keep_alive_retry_counter = retry_limit_count; -+ RTW_INFO("[%s] wow_keep_alive_pattern_trx_with_ack \n", __func__ ); -+ break; -+ default: -+ RTW_INFO("[%s] please setting valid mode \n", __func__ ); -+ ret = -EINVAL; -+ break; -+ -+ } -+ -+ if((mode == 0) || (mode > 4)) -+ return ret; -+ -+ totoal_len = strlen(tx_pattern); -+ RTW_INFO("[%s] totoal_len=%d \n", __func__ ,totoal_len); -+ if (totoal_len > WLAN_MAX_KEEP_ALIVE_IE_LEN*2) { -+ RTW_INFO("[%s] Fail , not support ie length extend %d\n", __func__ , WLAN_MAX_KEEP_ALIVE_IE_LEN); -+ return -EFAULT; -+ } -+ RTW_INFO("[%s] period = %hu ,ie = %s , len = %d\n", __func__ , period , tx_pattern , totoal_len); -+ -+ -+ if (totoal_len > 0) { -+ RTW_INFO("[%s] pwrpriv->keep_alive_pattern==========> \n", __func__ ); -+ for (i = 0 ; i keep_alive_pattern[len] = key_2char2num(tx_pattern[i], tx_pattern[i + 1]); -+ RTW_INFO("[0x%x] ",pwrpriv->keep_alive_pattern[len]); -+ len++; -+ } -+ RTW_INFO(" \n" ); -+ pwrpriv->keep_alive_pattern_len = len; -+ } -+ -+ return ret; -+} -+#endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ -+#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; -+ systime 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 if (_rtw_memcmp(extra, "lps_level=", 10)) { -+ if (sscanf(extra + 10, "%u", &mode) > 0) -+ ret = rtw_pm_set_lps_level(padapter, mode); -+#ifdef CONFIG_LPS_1T1R -+ } else if (_rtw_memcmp(extra, "lps_1t1r=", 9)) { -+ if (sscanf(extra + 9, "%u", &mode) > 0) -+ ret = rtw_pm_set_lps_1t1r(padapter, mode); -+#endif -+ } -+#ifdef CONFIG_WOWLAN -+ else if (_rtw_memcmp(extra, "wow_lps=", 8)) { -+ sscanf(extra + 8, "%u", &mode); -+ ret = rtw_pm_set_wow_lps(padapter, mode); -+ } else if (_rtw_memcmp(extra, "wow_lps_level=", 14)) { -+ if (sscanf(extra + 14, "%u", &mode) > 0) -+ ret = rtw_pm_set_wow_lps_level(padapter, mode); -+ #ifdef CONFIG_LPS_1T1R -+ } else if (_rtw_memcmp(extra, "wow_lps_1t1r=", 13)) { -+ if (sscanf(extra + 13, "%u", &mode) > 0) -+ ret = rtw_pm_set_wow_lps_1t1r(padapter, mode); -+ #endif -+ } -+#endif /* CONFIG_WOWLAN */ -+ else -+ ret = -EINVAL; -+ -+ return ret; -+} -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ -+int rtw_vendor_ie_get_raw_data(struct net_device *dev, u32 vendor_ie_num, -+ char *extra, u32 length) -+{ -+ int j; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u32 vendor_ie_mask = 0; -+ char *pstring; -+ -+ if (vendor_ie_num >= WLAN_MAX_VENDOR_IE_NUM) { -+ RTW_INFO("[%s] only support %d vendor ie\n", __func__ , -+ WLAN_MAX_VENDOR_IE_NUM); -+ return -EFAULT; -+ } -+ -+ if (pmlmepriv->vendor_ielen[vendor_ie_num] == 0) { -+ RTW_INFO("[%s] Fail, vendor_ie_num: %d is not set\n", __func__, -+ vendor_ie_num); -+ return -EFAULT; -+ } -+ -+ if (length < 2 * pmlmepriv->vendor_ielen[vendor_ie_num] + 5) { -+ RTW_INFO("[%s] Fail, buffer size is too small\n", __func__); -+ return -EFAULT; -+ } -+ -+ vendor_ie_mask = pmlmepriv->vendor_ie_mask[vendor_ie_num]; -+ _rtw_memset(extra, 0, length); -+ -+ pstring = extra; -+ pstring += sprintf(pstring, "%d,%x,", vendor_ie_num, vendor_ie_mask); -+ -+ for (j = 0; j < pmlmepriv->vendor_ielen[vendor_ie_num]; j++) -+ pstring += sprintf(pstring, "%02x", pmlmepriv->vendor_ie[vendor_ie_num][j]); -+ -+ length = pstring - extra; -+ return length; -+} -+ -+int rtw_vendor_ie_get_data(struct net_device *dev, int vendor_ie_num, char *extra) -+{ -+ int j; -+ char *pstring; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u32 vendor_ie_mask = 0; -+ __u16 length = 0; -+ -+ 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]"); -+#ifdef CONFIG_P2P -+ if (vendor_ie_mask & WIFI_P2P_PROBEREQ_VENDOR_IE_BIT) -+ pstring += sprintf(pstring , "[P2P_Probe Req]"); -+ if (vendor_ie_mask & WIFI_P2P_PROBERESP_VENDOR_IE_BIT) -+ pstring += sprintf(pstring , "[P2P_Probe Resp]"); -+#endif -+ -+ 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]); -+ -+ length = pstring - extra; -+ return length; -+ -+} -+ -+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, cmdlen; -+ struct iw_point *p; -+ u8 *ptmp; -+ -+ 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; -+ } -+ -+ wrqu->data.length = rtw_vendor_ie_get_data(dev, vendor_ie_num, 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 vendor_ie_mask_max = BIT(WLAN_MAX_VENDOR_IE_MASK_MAX) - 1; -+ 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 = 0x%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] Fail, 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 > vendor_ie_mask_max) { -+ RTW_INFO("[%s] Fail, not support vendor_ie_mask more than 0x%x\n", __func__ , vendor_ie_mask_max); -+ 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__); -+#ifdef CONFIG_P2P -+ if (vendor_ie_mask & WIFI_P2P_PROBEREQ_VENDOR_IE_BIT) -+ RTW_INFO("[%s] P2P Probe Req append vendor ie\n", __func__); -+ if (vendor_ie_mask & WIFI_P2P_PROBERESP_VENDOR_IE_BIT) -+ RTW_INFO("[%s] P2P Probe Resp append vendor ie\n", __func__); -+#endif -+ -+ 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_get_ic_type(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 *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ char *pstring = extra; -+ u8 regdata; -+ -+#ifdef CONFIG_RTL8822C -+ _rtw_memset(pstring, 0, wrqu->data.length); -+ -+ regdata = (rtw_read32(padapter, 0xF0) & 0xf000) >> 12; -+ RTW_INFO("%s: f0[15:12]= 0x%x\n", __FUNCTION__, regdata); -+ -+ if (regdata == 0x04) -+ pstring += sprintf(pstring , ":%s\n" ,"rtl8822c-vbs"); -+ else -+ pstring += sprintf(pstring , ":%s\n" ,"rtl8822c-vs"); -+ -+ wrqu->data.length = strlen(extra); -+#endif -+ return 0; -+} -+ -+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 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; -+ char *pextra = NULL; -+#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; -+ } -+ -+ *(extra + wrqu->length) = '\0'; -+ -+#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) { -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "0x%02x\t", shift + i); -+ for (j = 0; j < 8; j++) -+ pextra += sprintf(pextra, "%02X ", efuse[i + j]); -+ pextra += sprintf(pextra, "\t"); -+ for (; j < 16; j++) -+ pextra += sprintf(pextra, "%02X ", efuse[i + j]); -+ pextra += sprintf(pextra, "\n"); -+ } -+ if ((shift + cnt) < mapLen) -+ pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", 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) { -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "0x%02x\t", shift + i); -+ for (j = 0; j < 8; j++) -+ pextra += sprintf(pextra, "%02X ", efuse[i + j]); -+ pextra += sprintf(pextra, "\t"); -+ for (; j < 16; j++) -+ pextra += sprintf(pextra, "%02X ", efuse[i + j]); -+ pextra += sprintf(pextra, "\n"); -+ } -+ if ((shift + cnt) < mapLen) -+ pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen); -+ } 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 , (void *)&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; -+ pextra = extra; -+ for (i = 0; i < cnts; i++) { -+ /* RTW_INFO("0x%02x ", data[i]); */ -+ pextra += sprintf(pextra, "0x%02X ", data[i]); -+ } -+ /* RTW_INFO("}\n"); */ -+ } else if (strcmp(tmp[0], "realraw") == 0) { -+ static u8 raw_order = 0; -+ u32 shift, cnt; -+ u32 blksz = 0x200; /* The size of one time show, default 512 */ -+ -+ addr = 0; -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN , (void *)&mapLen, _FALSE); -+ RTW_INFO("Real content len = %d\n",mapLen ); -+ -+ if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ _rtw_memset(extra, '\0', strlen(extra)); -+ -+ shift = blksz * raw_order; -+ rawdata += shift; -+ cnt = mapLen - shift; -+ if (cnt > blksz) { -+ cnt = blksz; -+ raw_order++; -+ } else -+ raw_order = 0; -+ -+ sprintf(extra, "\n"); -+ for (i = 0; i < cnt; i += 16) { -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "0x%02x\t", shift + i); -+ for (j = 0; j < 8; j++) -+ pextra += sprintf(pextra, "%02X ", rawdata[i + j]); -+ pextra += sprintf(pextra, "\t"); -+ for (; j < 16; j++) -+ pextra += sprintf(pextra, "%02X ", rawdata[i + j]); -+ pextra += sprintf(pextra, "\n"); -+ } -+ if ((shift + cnt) < mapLen) -+ pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen); -+ -+ } else if (strcmp(tmp[0], "btrealraw") == 0) { -+ static u8 bt_raw_order = 0; -+ u32 shift, cnt; -+ u32 blksz = 0x200; /* The size of one time show, default 512 */ -+ -+ addr = 0; -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&mapLen, _FALSE); -+ RTW_INFO("Real content len = %d\n", mapLen); -+#ifdef RTW_HALMAC -+ if (rtw_efuse_bt_access(padapter, _FALSE, 0, mapLen, rawdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__); -+ err = -EFAULT; -+ goto exit; -+ } -+#else -+ rtw_write8(padapter, 0x35, 0x1); -+ -+ if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__); -+ err = -EFAULT; -+ goto exit; -+ } -+#endif -+ _rtw_memset(extra, '\0', strlen(extra)); -+ -+ shift = blksz * bt_raw_order; -+ rawdata += shift; -+ cnt = mapLen - shift; -+ if (cnt > blksz) { -+ cnt = blksz; -+ bt_raw_order++; -+ } else -+ bt_raw_order = 0; -+ -+ sprintf(extra, "\n"); -+ for (i = 0; i < cnt; i += 16) { -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "0x%02x\t", shift + i); -+ for (j = 0; j < 8; j++) -+ pextra += sprintf(pextra, "%02X ", rawdata[i + j]); -+ pextra += sprintf(pextra, "\t"); -+ for (; j < 16; j++) -+ pextra += sprintf(pextra, "%02X ", rawdata[i + j]); -+ pextra += sprintf(pextra, "\n"); -+ } -+ if ((shift + cnt) < mapLen) -+ pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen); -+ -+ } 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, (void *)&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; -+ pextra = extra; -+ for (i = 0; i < cnts; i++) { -+ /* RTW_INFO("%02X", data[i]); */ -+ pextra += sprintf(pextra, "%02X", data[i]); -+ if (i != (cnts - 1)) { -+ /* RTW_INFO(":"); */ -+ pextra += sprintf(pextra, ":"); -+ } -+ } -+ /* 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_RTL8188GTV -+ addr = EEPROM_VID_8188GTVU; -+#endif -+ -+#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, (void *)&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; -+ pextra = extra; -+ for (i = 0; i < cnts; i++) { -+ /* RTW_INFO("0x%02x", data[i]); */ -+ pextra += sprintf(pextra, "0x%02X", data[i]); -+ if (i != (cnts - 1)) { -+ /* RTW_INFO(","); */ -+ pextra += sprintf(pextra, ","); -+ } -+ } -+ /* RTW_INFO("}\n"); */ -+ } else if (strcmp(tmp[0], "ableraw") == 0) { -+#ifdef RTW_HALMAC -+ raw_maxsize = efuse_GetavailableSize(padapter); -+#else -+ efuse_GetCurrentSize(padapter, &raw_cursize); -+ raw_maxsize = efuse_GetMaxSize(padapter); -+#endif -+ 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); */ -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "0x%03x\t", i); -+ for (j = 0; j < 8; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); */ -+ pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]); -+ } -+ /* RTW_INFO("\t"); */ -+ pextra += sprintf(pextra, "\t"); -+ for (; j < 16; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); */ -+ pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]); -+ } -+ /* RTW_INFO("\n"); */ -+ pextra += sprintf(pextra, "\n"); -+ } -+ /* 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); */ -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "0x%03x\t", i); -+ for (j = 0; j < 8; j++) { -+ /* RTW_INFO("%02X ", data[i+j]); */ -+ pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]); -+ } -+ /* RTW_INFO("\t"); */ -+ pextra += sprintf(pextra, "\t"); -+ for (; j < 16; j++) { -+ /* RTW_INFO("%02X ", data[i+j]); */ -+ pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]); -+ } -+ /* RTW_INFO("\n"); */ -+ pextra += sprintf(pextra, "\n"); -+ } -+ /* RTW_INFO("\n"); */ -+ } else if (strcmp(tmp[0], "btrmap") == 0) { -+ u8 BTStatus; -+ -+ rtw_write8(padapter, 0xa3, 0x05); /* For 8723AB ,8821S ? */ -+ BTStatus = rtw_read8(padapter, 0xa0); -+ -+ RTW_INFO("%s: Check 0xa0 BT Status =0x%x\n", __FUNCTION__, BTStatus); -+ if (BTStatus != 0x04) { -+ sprintf(extra, "BT Status not Active ,can't to read BT eFuse\n"); -+ goto exit; -+ } -+ -+ 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); -+#ifndef RTW_HALMAC -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (void *)&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_read(padapter, addr, cnts, data) == _FAIL) { -+ RTW_INFO("%s: rtw_BT_efuse_map_read error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ *extra = 0; -+ pextra = extra; -+ /* RTW_INFO("%s: bt efuse data={", __FUNCTION__); */ -+ for (i = 0; i < cnts; i++) { -+ /* RTW_INFO("0x%02x ", data[i]); */ -+ pextra += sprintf(pextra, " 0x%02X ", 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); */ -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "0x%03x\t", i); -+ for (j = 0; j < 8; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ -+ pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ } -+ /* RTW_INFO("\t"); */ -+ pextra += sprintf(pextra, "\t"); -+ for (; j < 16; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ -+ pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ } -+ /* RTW_INFO("\n"); */ -+ pextra += sprintf(pextra, "\n"); -+ } -+ /* 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); */ -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "0x%03x\t", i); -+ for (j = 0; j < 8; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ -+ pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ } -+ /* RTW_INFO("\t"); */ -+ pextra += sprintf(pextra, "\t"); -+ for (; j < 16; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ -+ pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ } -+ /* RTW_INFO("\n"); */ -+ pextra += sprintf(pextra, "\n"); -+ } -+ /* 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) { -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "0x%02x\t", shift + i); -+ for (j = 0; j < 8; j++) -+ pextra += sprintf(pextra, "%02X ", efuse[i + j]); -+ pextra += sprintf(pextra, "\t"); -+ for (; j < 16; j++) -+ pextra += sprintf(pextra, "%02X ", efuse[i + j]); -+ pextra += sprintf(pextra, "\n"); -+ } -+ if ((shift + cnt) < mapLen) -+ pextra += sprintf(pextra, "\t...more\n"); -+ -+ } 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; -+ pextra = extra; -+ for (i = 0; i < cnts; i++) { -+ RTW_INFO("wlrfkrmap = 0x%02x\n", pEfuseHal->fakeEfuseModifiedMap[addr + i]); -+ pextra += sprintf(pextra, "0x%02X ", 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; -+ pextra = extra; -+ for (i = 0; i < cnts; i++) { -+ RTW_INFO("wlrfkrmap = 0x%02x\n", pEfuseHal->fakeBTEfuseModifiedMap[addr + i]); -+ pextra += sprintf(pextra, "0x%02X ", 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"); -+ pextra = extra + strlen(extra); -+ for (i = 0; i < mask_len; i++) -+ pextra += sprintf(pextra, "0x%02X\n", mask_buf[i]); -+ -+ } else if (strcmp(tmp[0], "btmask") == 0) { -+ *extra = 0; -+ mask_len = sizeof(u8) * rtw_get_bt_efuse_mask_arraylen(padapter); -+ rtw_bt_efuse_mask_array(padapter, mask_buf); -+ -+ if (padapter->registrypriv.bBTFileMaskEfuse == _TRUE) -+ _rtw_memcpy(mask_buf, btmaskfileBuffer, mask_len); -+ -+ sprintf(extra, "\n"); -+ pextra = extra + strlen(extra); -+ for (i = 0; i < mask_len; i++) -+ pextra += sprintf(pextra, "0x%02X\n", 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; -+} -+ -+ -+#ifdef CONFIG_MP_INCLUDED -+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; -+ boolean bcmpchk = _TRUE; -+ -+ -+ 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->hal_func; -+ pmp_priv = &padapter->mppriv; -+ -+ err = 0; -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+#ifdef CONFIG_RTL8822C -+ rtw_pre_bt_efuse(padapter); -+#endif -+ *(extra + wrqu->length) = '\0'; -+ -+ 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, (void *)&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, (void *)&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_RTL8188GTV -+ addr = EEPROM_VID_8188GTVU; -+#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, (void *)&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]); -+#ifndef RTW_HALMAC -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (void *)&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__); -+ sprintf(extra, "BT write FAIL !!!\n"); -+ 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; -+ } -+ if (pmp_priv->bprocess_mp_mode != _TRUE) { -+ RTW_INFO("%s: btwfake not to be exec, please first to mp_start\n", __FUNCTION__); -+ sprintf(extra, "Error, btwfake cant to be exec, please first to mp_start !!!!\n"); -+ err = 0; -+ 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) { -+#ifdef CONFIG_BT_EFUSE_MASK -+ if (padapter->registrypriv.bBTFileMaskEfuse != _TRUE && pmp_priv->bloadBTefusemap == _TRUE) { -+ RTW_INFO("%s: File BT eFuse mask file not to be loaded\n", __FUNCTION__); -+ sprintf(extra, "Not load BT eFuse mask file yet, Please advance to use [ efuse_bt_mask ], now remove the Adapter.!!!!\n"); -+ rtw_set_surprise_removed(padapter); -+ err = 0; -+ goto exit; -+ } -+#endif -+ 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; -+ } -+ if (pmp_priv->bprocess_mp_mode != _TRUE) { -+ RTW_INFO("%s: btfk2map not to be exec, please first to mp_start\n", __FUNCTION__); -+ sprintf(extra, "Error, btfk2map cant to be exec, please first to mp_start !!!!\n"); -+ err = 0; -+ 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 */ -+ -+ 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__); -+ sprintf(extra, "BT write FAIL !!!\n"); -+ 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, now remove the interface !!!!\n"); -+ rtw_set_surprise_removed(padapter); -+ err = 0; -+ goto exit; -+ } -+ -+ if (pmp_priv->bprocess_mp_mode != _TRUE) { -+ RTW_INFO("%s: wlfk2map not to be exec, please first to mp_start\n", __FUNCTION__); -+ sprintf(extra, "Error, wlfk2map cant to be exec, please first to mp_start !!!!\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) { -+ addr = 0x00; -+ err = _TRUE; -+ -+ for (i = 0; i < cnts; i++) { -+ if (padapter->registrypriv.boffefusemask == 0) { -+ if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { -+ if (rtw_file_efuse_IsMasked(padapter, addr + i, maskfileBuffer) == _TRUE) /*use file efuse mask. */ -+ bcmpchk = _FALSE; -+ } else { -+ if (efuse_IsMasked(padapter, addr + i) == _TRUE) -+ bcmpchk = _FALSE; -+ } -+ } -+ -+ if (bcmpchk == _TRUE) { -+ RTW_INFO("compare readMapWiFi[0x%02x] = %x, ModifiedMap = %x\n", addr + i, ShadowMapWiFi[ addr + i], pEfuseHal->fakeEfuseModifiedMap[addr + i]); -+ if (_rtw_memcmp((void *) &ShadowMapWiFi[addr + i], (void *)&pEfuseHal->fakeEfuseModifiedMap[addr + i], 1) == _FALSE){ -+ err = _FALSE; -+ break; -+ } -+ } -+ bcmpchk = _TRUE; -+ } -+ } -+ -+ if (err) { -+ 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; -+ } -+ if (pmp_priv->bprocess_mp_mode != _TRUE) { -+ RTW_INFO("%s: wlwfake not to be exec, please first to mp_start\n", __FUNCTION__); -+ sprintf(extra, "Error, wlwfake cant to be exec, please first to mp_start !!!!\n"); -+ err = 0; -+ 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; -+ } -+ if (pmp_priv->bprocess_mp_mode != _TRUE) { -+ RTW_INFO("%s: wfakemac not to be exec, please first to mp_start\n", __FUNCTION__); -+ sprintf(extra, "Error, wfakemac cant to be exec, please first to mp_start !!!!\n"); -+ err = 0; -+ 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) -+ if ((addr + jj) < EFUSE_MAX_MAP_LEN) -+ 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 ver3\n"); -+ -+ if (tmp[1] != 0x00) { -+ if (strcmp(tmp[1], "fake") == 0) { -+ pmp_priv->efuse_update_on = _TRUE; -+ RTW_INFO("Set efuse update without file\n"); -+ } else if (strcmp(tmp[1], "phy") == 0) { -+ pmp_priv->efuse_update_file = _FALSE; -+ pmp_priv->efuse_update_on = _FALSE; -+ RTW_INFO("Set efuse update with phy\n"); -+ } else { -+ pmp_priv->efuse_update_file = _TRUE; -+ strcpy(pmp_priv->efuse_file_path , tmp[1]); -+ RTW_INFO("Got file path %s\n", pmp_priv->efuse_file_path); -+ } -+ } -+ /*step read efuse/eeprom data and get mac_addr*/ -+ if (padapter->hal_func.read_adapter_info(padapter)) { -+ _rtw_memset(extra, '\0', strlen(extra)); -+ #ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ if (pHalData->txpwr_pg_mode == TXPWR_PG_WITH_PWR_IDX) -+ hal_load_txpwr_info(padapter); -+ #endif -+ phy_load_tx_power_ext_info(padapter, 1); -+ sprintf(extra, "eFuse Update OK\n"); -+ RTW_INFO("eFuse Update OK\n"); -+ } else { -+ _rtw_memset(extra, '\0', strlen(extra)); -+ sprintf(extra, "eFuse Update FAIL\n"); -+ RTW_INFO("eFuse Update FAIL\n"); -+ } -+ -+ RTW_INFO("To Use new eFuse map ver3 done\n"); -+ } else if (strcmp(tmp[0], "analyze") == 0) { -+ -+ rtw_efuse_analyze(padapter, EFUSE_WIFI, 0); -+ _rtw_memset(extra, '\0', strlen(extra)); -+ sprintf(extra, "eFuse Analyze OK,please to check kernel log\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_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 + 1; -+ -+ 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, wrqu->data.length)) { -+ 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; -+ -+ 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; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ int status = 0; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (!is_primary_adapter(padapter)) { -+ RTW_INFO("MP mode only primary Adapter support\n"); -+ return -EIO; -+ } -+#endif -+ -+ RTW_INFO("%s mutx in %d\n", __func__, subcmd); -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->ioctrl_mutex), NULL); -+ switch (subcmd) { -+ case CTA_TEST: -+ RTW_INFO("set CTA_TEST\n"); -+ status = rtw_cta_test_start(dev, info, wdata, extra); -+ break; -+ case MP_DISABLE_BT_COEXIST: -+ RTW_INFO("set case MP_DISABLE_BT_COEXIST\n"); -+ status = rtw_mp_disable_bt_coexist(dev, info, wdata, extra); -+ break; -+ case MP_IQK: -+ RTW_INFO("set MP_IQK\n"); -+ status = rtw_mp_iqk(dev, info, wrqu, extra); -+ break; -+ case MP_LCK: -+ RTW_INFO("set MP_LCK\n"); -+ status = rtw_mp_lck(dev, info, wrqu, extra); -+ break; -+ -+ default: -+ status = -EIO; -+ } -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->ioctrl_mutex), NULL); -+ RTW_INFO("%s mutx done %d\n", __func__, subcmd); -+ -+ return status; -+} -+ -+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; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ int status = 0; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (!is_primary_adapter(padapter)) { -+ RTW_INFO("MP mode only primary Adapter support\n"); -+ return -EIO; -+ } -+#endif -+ -+ RTW_INFO("%s mutx in %d\n", __func__, subcmd); -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->ioctrl_mutex), NULL); -+ -+ switch (subcmd) { -+ case MP_START: -+ RTW_INFO("set case mp_start\n"); -+ status = rtw_mp_start(dev, info, wrqu, extra); -+ break; -+ case MP_STOP: -+ RTW_INFO("set case mp_stop\n"); -+ status = rtw_mp_stop(dev, info, wrqu, extra); -+ break; -+ case MP_BANDWIDTH: -+ RTW_INFO("set case mp_bandwidth\n"); -+ status = rtw_mp_bandwidth(dev, info, wrqu, extra); -+ break; -+ case MP_RESET_STATS: -+ RTW_INFO("set case MP_RESET_STATS\n"); -+ status = rtw_mp_reset_stats(dev, info, wrqu, extra); -+ break; -+ case MP_SetRFPathSwh: -+ RTW_INFO("set MP_SetRFPathSwitch\n"); -+ status = rtw_mp_SetRFPath(dev, info, wrqu, extra); -+ break; -+ case WRITE_REG: -+ status = rtw_mp_write_reg(dev, info, wrqu, extra); -+ break; -+ case WRITE_RF: -+ status = rtw_mp_write_rf(dev, info, wrqu, extra); -+ break; -+ case MP_PHYPARA: -+ RTW_INFO("mp_get MP_PHYPARA\n"); -+ status = rtw_mp_phypara(dev, info, wrqu, extra); -+ break; -+ case MP_CHANNEL: -+ RTW_INFO("set case mp_channel\n"); -+ status = rtw_mp_channel(dev , info, wrqu, extra); -+ break; -+ case MP_CHL_OFFSET: -+ RTW_INFO("set case mp_ch_offset\n"); -+ status = rtw_mp_ch_offset(dev , info, wrqu, extra); -+ break; -+ case READ_REG: -+ RTW_INFO("mp_get READ_REG\n"); -+ status = rtw_mp_read_reg(dev, info, wrqu, extra); -+ break; -+ case READ_RF: -+ RTW_INFO("mp_get READ_RF\n"); -+ status = rtw_mp_read_rf(dev, info, wrqu, extra); -+ break; -+ case MP_RATE: -+ RTW_INFO("set case mp_rate\n"); -+ status = rtw_mp_rate(dev, info, wrqu, extra); -+ break; -+ case MP_TXPOWER: -+ RTW_INFO("set case MP_TXPOWER\n"); -+ status = rtw_mp_txpower(dev, info, wrqu, extra); -+ break; -+ case MP_ANT_TX: -+ RTW_INFO("set case MP_ANT_TX\n"); -+ status = rtw_mp_ant_tx(dev, info, wrqu, extra); -+ break; -+ case MP_ANT_RX: -+ RTW_INFO("set case MP_ANT_RX\n"); -+ status = rtw_mp_ant_rx(dev, info, wrqu, extra); -+ break; -+ case MP_QUERY: -+ status = rtw_mp_trx_query(dev, info, wrqu, extra); -+ break; -+ case MP_CTX: -+ RTW_INFO("set case MP_CTX\n"); -+ status = rtw_mp_ctx(dev, info, wrqu, extra); -+ break; -+ case MP_ARX: -+ RTW_INFO("set case MP_ARX\n"); -+ status = rtw_mp_arx(dev, info, wrqu, extra); -+ break; -+ case MP_DUMP: -+ RTW_INFO("set case MP_DUMP\n"); -+ status = rtw_mp_dump(dev, info, wrqu, extra); -+ break; -+ case MP_PSD: -+ RTW_INFO("set case MP_PSD\n"); -+ status = rtw_mp_psd(dev, info, wrqu, extra); -+ break; -+ case MP_THER: -+ RTW_INFO("set case MP_THER\n"); -+ status = rtw_mp_thermal(dev, info, wrqu, extra); -+ break; -+ case MP_PwrCtlDM: -+ RTW_INFO("set MP_PwrCtlDM\n"); -+ status = rtw_mp_PwrCtlDM(dev, info, wrqu, extra); -+ break; -+ case MP_QueryDrvStats: -+ RTW_INFO("mp_get MP_QueryDrvStats\n"); -+ status = rtw_mp_QueryDrv(dev, info, wdata, extra); -+ break; -+ case MP_PWRTRK: -+ RTW_INFO("set case MP_PWRTRK\n"); -+ status = rtw_mp_pwrtrk(dev, info, wrqu, extra); -+ break; -+ case MP_SET_TSSIDE: -+ RTW_INFO("set case MP_TSSI_DE\n"); -+ status = rtw_mp_set_tsside(dev, info, wrqu, extra); -+ break; -+#ifdef CONFIG_MP_INCLUDED -+ case EFUSE_SET: -+ RTW_INFO("set case efuse set\n"); -+ status = rtw_mp_efuse_set(dev, info, wdata, extra); -+ break; -+#endif -+ case EFUSE_GET: -+ RTW_INFO("efuse get EFUSE_GET\n"); -+ status = rtw_mp_efuse_get(dev, info, wdata, extra); -+ break; -+ case MP_GET_TXPOWER_INX: -+ RTW_INFO("mp_get MP_GET_TXPOWER_INX\n"); -+ status = rtw_mp_txpower_index(dev, info, wrqu, extra); -+ break; -+ case MP_GETVER: -+ RTW_INFO("mp_get MP_GETVER\n"); -+ status = rtw_mp_getver(dev, info, wdata, extra); -+ break; -+ case MP_MON: -+ RTW_INFO("mp_get MP_MON\n"); -+ status = rtw_mp_mon(dev, info, wdata, extra); -+ break; -+ case EFUSE_BT_MASK: -+ RTW_INFO("mp_get EFUSE_BT_MASK\n"); -+ status = rtw_bt_efuse_mask_file(dev, info, wdata, extra); -+ break; -+ case EFUSE_MASK: -+ RTW_INFO("mp_get EFUSE_MASK\n"); -+ status = rtw_efuse_mask_file(dev, info, wdata, extra); -+ break; -+ case EFUSE_FILE: -+ RTW_INFO("mp_get EFUSE_FILE\n"); -+ status = rtw_efuse_file_map(dev, info, wdata, extra); -+ break; -+ case EFUSE_FILE_STORE: -+#if !defined(CONFIG_RTW_ANDROID_GKI) -+ RTW_INFO("mp_get EFUSE_FILE_STORE\n"); -+ status = rtw_efuse_file_map_store(dev, info, wdata, extra); -+#else -+ RTW_ERR("Android GKI doesn't support: mp_get EFUSE_FILE_STORE\n"); -+#endif /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+ break; -+ case MP_TX: -+ RTW_INFO("mp_get MP_TX\n"); -+ status = rtw_mp_tx(dev, info, wdata, extra); -+ break; -+ case MP_RX: -+ RTW_INFO("mp_get MP_RX\n"); -+ status = rtw_mp_rx(dev, info, wdata, extra); -+ break; -+ case MP_HW_TX_MODE: -+ RTW_INFO("mp_get MP_HW_TX_MODE\n"); -+ status = rtw_mp_hwtx(dev, info, wdata, extra); -+ break; -+ case MP_GET_TSSIDE: -+ RTW_INFO("mp_get TSSI_DE\n"); -+ status = rtw_mp_get_tsside(dev, info, wrqu, extra); -+ break; -+#ifdef CONFIG_RTW_CUSTOMER_STR -+ case MP_CUSTOMER_STR: -+ RTW_INFO("customer str\n"); -+ status = rtw_mp_customer_str(dev, info, wdata, extra); -+ break; -+#endif -+ case MP_PWRLMT: -+ RTW_INFO("mp_get MP_SETPWRLMT\n"); -+ status = rtw_mp_pwrlmt(dev, info, wdata, extra); -+ break; -+ case MP_PWRBYRATE: -+ RTW_INFO("mp_get MP_SETPWRBYRATE\n"); -+ status = rtw_mp_pwrbyrate(dev, info, wdata, extra); -+ break; -+ case BT_EFUSE_FILE: -+ RTW_INFO("mp_get BT EFUSE_FILE\n"); -+ status = rtw_bt_efuse_file_map(dev, info, wdata, extra); -+ break; -+ case MP_SWRFPath: -+ RTW_INFO("mp_get MP_SWRFPath\n"); -+ status = rtw_mp_switch_rf_path(dev, info, wrqu, extra); -+ break; -+ case MP_LINK: -+ RTW_INFO("mp_get MP_LINK\n"); -+ status = rtw_mp_link(dev, info, wrqu, extra); -+ break; -+ case MP_DPK_TRK: -+ RTW_INFO("mp_get MP_DPK_TRK\n"); -+ status = rtw_mp_dpk_track(dev, info, wdata, extra); -+ break; -+ case MP_DPK: -+ RTW_INFO("set MP_DPK\n"); -+ status = rtw_mp_dpk(dev, info, wdata, extra); -+ break; -+ default: -+ status = -EIO; -+ } -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->ioctrl_mutex), NULL); -+ RTW_INFO("%s mutx done_%d\n", __func__, subcmd); -+ -+ return status; -+} -+#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; -+ #ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ case MP_WOW_SET_KEEP_ALIVE_PATTERN: -+ RTW_INFO("set case MP_WOW_SET_KEEP_ALIVE_PATTERN: %s\n", extra); -+ rtw_wowlan_set_keep_alive_pattern(dev, info, wdata, extra); -+ break; -+ #endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ -+#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); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_struct *p_dm = &pHalData->odmpriv; -+ struct dm_rf_calibration_struct *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); -+ struct dm_iqk_info *p_iqk_info = &p_dm->IQK_info; -+ u32 i = 100; -+ -+ -+ 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 -+ while (i > 1) { -+ if (p_rf_calibrate_info->is_iqk_in_progress) { -+ rtw_msleep_os(10); -+ } else { -+ p_iqk_info->rfk_forbidden = _TRUE; -+ break; -+ } -+ i--; -+ } -+ if (subcmd == MP_CHANNEL || subcmd == MP_BANDWIDTH || subcmd == MP_START || subcmd == MP_DPK) -+ p_iqk_info->rfk_forbidden = _FALSE; -+ rtw_priv_mp_get(dev, info, wdata, extra); -+ rtw_msleep_os(10); /* delay 5ms for sending pkt before exit adb shell operation */ -+ p_iqk_info->rfk_forbidden = _FALSE; -+#endif -+ } else { -+ 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 -+ case GET_IC_TYPE: -+ RTW_INFO("get IC Type\n"); -+ rtw_get_ic_type(dev , info , wdata , extra); -+ break; -+ default: -+ return -EIO; -+ } -+ } -+ -+ return 0; -+} -+ -+ -+#ifdef CONFIG_TDLS -+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_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 */ -+ -+ 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); -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ if (extra[0] == '0') -+ rtw_disable_tdls_func(padapter, _TRUE); -+ else if (extra[0] == '1') -+ rtw_enable_tdls_func(padapter); -+#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) { -+#ifdef CONFIG_TDLS_CH_SW_V2 -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_PREPARE); -+#else -+ 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->cmn.mac_addr, TDLS_CH_SW_START); -+ else -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_PREPARE); -+#endif -+ } else -+ rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, 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->cmn.mac_addr, 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->cmn.mac_addr, 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->cmn.mac_addr, 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, -+ rtw_is_tdls_enabled(padapter) -+#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); -+ -+exit: -+#endif /* CONFIG_TDLS */ -+ 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 rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; -+ -+ for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) { -+ if (rfctl->channel_set[i].ChannelNum == 1) -+ index_24G = i; -+ if (rfctl->channel_set[i].ChannelNum == 36) -+ index_5G = i; -+ } -+ -+ for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) { -+ /* 2.4G */ -+ if (rfctl->channel_set[i].ChannelNum == 6 || rfctl->channel_set[i].ChannelNum == 11) { -+ if (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_24G].rx_count) { -+ index_24G = i; -+ best_channel_24G = rfctl->channel_set[i].ChannelNum; -+ } -+ } -+ -+ /* 5G */ -+ if (rfctl->channel_set[i].ChannelNum >= 36 -+ && rfctl->channel_set[i].ChannelNum < 140) { -+ /* Find primary channel */ -+ if (((rfctl->channel_set[i].ChannelNum - 36) % 8 == 0) -+ && (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_5G].rx_count)) { -+ index_5G = i; -+ best_channel_5G = rfctl->channel_set[i].ChannelNum; -+ } -+ } -+ -+ if (rfctl->channel_set[i].ChannelNum >= 149 -+ && rfctl->channel_set[i].ChannelNum < 165) { -+ /* Find primary channel */ -+ if (((rfctl->channel_set[i].ChannelNum - 149) % 8 == 0) -+ && (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_5G].rx_count)) { -+ index_5G = i; -+ best_channel_5G = rfctl->channel_set[i].ChannelNum; -+ } -+ } -+#if 1 /* debug */ -+ RTW_INFO("The rx cnt of channel %3d = %d\n", -+ rfctl->channel_set[i].ChannelNum, -+ rfctl->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; -+ -+} -+#endif /*#ifdef CONFIG_TDLS*/ -+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 (rtw_is_tdls_enabled(padapter) == _FALSE) { -+ RTW_INFO("TDLS is not 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_MAC_LOOPBACK_DRIVER -+ -+#if defined(CONFIG_RTL8188E) -+#include -+extern void rtl8188e_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#define cal_txdesc_chksum(padapter, desc) rtl8188e_cal_txdesc_chksum(desc) -+#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(padapter, desc) rtl8723b_cal_txdesc_chksum(desc) -+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(padapter, desc) rtl8703b_cal_txdesc_chksum(desc) -+/* 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(padapter, desc) rtl8723d_cal_txdesc_chksum(desc) -+/* 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_RTL8710B) -+#define cal_txdesc_chksum(padapter, desc) rtl8710b_cal_txdesc_chksum(desc) -+#define fill_default_txdesc rtl8710b_fill_default_txdesc -+#endif /* CONFIG_RTL8710B */ -+ -+#if defined(CONFIG_RTL8192E) -+extern void rtl8192e_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#define cal_txdesc_chksum(padapter, desc) rtl8192e_cal_txdesc_chksum(desc) -+#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 */ -+ -+#if defined(CONFIG_RTL8192F) -+/* extern void rtl8192f_cal_txdesc_chksum(struct tx_desc *ptxdesc); */ -+#define cal_txdesc_chksum(padapter, desc) rtl8192f_cal_txdesc_chksum(desc) -+/* extern void rtl8192f_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); */ -+#define fill_default_txdesc rtl8192f_fill_default_txdesc -+#endif /* CONFIG_RTL8192F */ -+ -+#ifdef CONFIG_RTL8723F -+#include <../../hal/rtl8723f/rtl8723f.h> -+ -+#define REG_LOOPBACK_ENABLE 0x0103 -+#define LOOKBACK_ENABLE_VALUE 0x0b -+#define cal_txdesc_chksum(padapter, desc) rtl8723f_cal_txdesc_chksum(padapter, desc) -+#define dump_txdesc_data(padapter, desc) rtl8723f_dbg_dump_tx_desc(padapter, DATA_FRAMETAG, desc); -+#define get_rx_desc(rx_desc, rxbuf) rtl8723f_rxdesc2attribute(rx_desc, rxbuf) -+#define hal_init rtl8723f_hal_init -+#endif /* CONFIG_RTL8723F */ -+ -+void dbg_dump_pkt(char *s, u8 *buf, u8 len) -+{ -+ u8 i, j = 1; -+ -+ RTW_INFO("%s size = %u\n", s, len); -+ -+ for (i = 0; (i + 4) < len; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT("idx:%u:", i); -+ _RTW_PRINT(" 0x%02x 0x%02x 0x%02x 0x%02x", buf[i], buf[i+1], buf[i+2], buf[i+3]); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT("\n"); -+ } -+ -+ for (; i < len ; i++) { -+ _RTW_PRINT(" 0x%02x", buf[i]); -+ } -+ _RTW_PRINT("\n ================================\n"); -+} -+ -+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, 0); -+ if (err == _FALSE) -+ return _FAIL; -+ -+ err = rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_WAIT_ACK); -+ 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->cmn.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, 0); -+ 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->psta = rtw_get_bcmc_stainfo(padapter); -+ else -+ pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ -+ pattrib->mac_id = pattrib->psta->cmn.mac_id; -+ 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); -+ -+#if 0 -+ /* 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 -+#endif -+ -+ cal_txdesc_chksum(padapter, (u8*)desc); -+ /* dump_txdesc_data(padapter, (u8*)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; -+ set_frame_sub_type(&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; -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->ptail += pxmitbuf->len; -+#endif -+ -+ dbg_dump_pkt("TX packet", pxmitbuf->pbuf, 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) -+{ -+ struct rx_pkt_attrib rx_desc; -+#if 0 -+ struct recv_stat *prxstat; -+ struct recv_stat report; -+ PRXREPORT prxreport; -+#endif -+ u32 rxpktsize; -+ u8 drvinfosize; -+ u8 shiftsize; -+ u8 ret = _FALSE; -+ u8 skip_len = 4; /* Don't compare the frame control and duration field */ -+ get_rx_desc(&rx_desc, rxbuf); -+ rxpktsize = rx_desc.pkt_len; -+ drvinfosize = rx_desc.drvinfo_sz; -+ shiftsize = rx_desc.shift_sz; -+ -+#if 0 -+ 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; -+#endif -+ -+ if (rtw_hal_rcr_check(padapter, RCR_APPFCS)) -+ rxpktsize -= IEEE80211_FCS_LEN; -+ -+ if ((txsz - TXDESC_SIZE) != rxpktsize) { -+ RTW_INFO("%s: ERROR! size not match tx/rx=%d/%d !\n", -+ __func__, txsz - TXDESC_SIZE, rxpktsize); -+ ret = _FALSE; -+ } else { -+ ret = _rtw_memcmp(txbuf + TXDESC_SIZE + skip_len, \ -+ rxbuf + RXDESC_SIZE + skip_len + drvinfosize, \ -+ txsz - TXDESC_SIZE - skip_len); -+ 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); -+ dbg_dump_pkt("TX DESC", txbuf, TXDESC_SIZE); -+ dbg_dump_pkt("TX content", 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) { -+ dbg_dump_pkt("RX DESC", rxbuf, RXDESC_SIZE); -+ dbg_dump_pkt("RX drvinfo", rxbuf + RXDESC_SIZE, drvinfosize); -+ dbg_dump_pkt("RX packet content", rxbuf + RXDESC_SIZE + drvinfosize, rxpktsize); -+ } else { -+ RTW_INFO("%s: RX data size=%d\n", __func__, 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; -+ -+ thread_enter("RTW_LBK_THREAD"); -+ /* 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); -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitframe->pxmitbuf->pdata = ploopback->txbuf; -+#endif -+ rtw_write_port(padapter, ff_hwaddr, ploopback->txsize, (u8 *)pxmitframe->pxmitbuf); -+ -+ /* wait for rx pkt */ -+ RTW_INFO("%s: wait for rx packet\n", __func__); -+ _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_INFO("Free loopback, end the test.\n"); -+ _rtw_memcpy(pmsg, ploopback->msg, len + 1); -+ freeLoopback(padapter); -+ -+ return; -+ } -+ -+ /* disable dynamic algorithm */ -+#ifndef CONFIG_NO_PHYDM -+ rtw_phydm_ability_backup(padapter); -+ rtw_phydm_func_disable_all(padapter); -+#endif -+ -+ /* 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(ploopback->lbkthread)) { -+ freeLoopback(padapter); -+ ploopback->lbkthread = NULL; -+ 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 + 1); -+ 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 + 1); -+ RTW_INFO("%s: copy from user fail!\n", __func__); -+ return -EFAULT; -+ } -+ -+ pbuf[len] = '\0'; -+ -+ 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, "init") == 0) { -+ u8 status; -+ -+ rtw_clr_drv_stopped(padapter); /* should clear drv_stopped, otherwise driver can't trx */ -+ -+ status = hal_init(padapter); -+ RTW_INFO("HAL_INIT %s\n", status ? "SUCCESS" : "FAIL"); -+ -+ rtw_write8(padapter, REG_LOOPBACK_ENABLE, LOOKBACK_ENABLE_VALUE); -+ RTW_INFO("Write 0x%03x to 0x%02x, enable loopback\n", -+ REG_LOOPBACK_ENABLE, LOOKBACK_ENABLE_VALUE); -+ -+ } else 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; -+ } else if (strcmp(pch, "coex_auto") == 0) { -+ rtw_btcoex_set_policy_control(padapter, BTCOEX_POLICY_CONTROL_AUTO); -+ goto free_buf; -+ } else if (strcmp(pch, "coex_force_freerun") == 0) { -+ rtw_btcoex_set_policy_control(padapter, BTCOEX_POLICY_CONTROL_FORCE_FREERUN); -+ goto free_buf; -+ } else if (strcmp(pch, "coex_force_tdma") == 0) { -+ rtw_btcoex_set_policy_control(padapter, BTCOEX_POLICY_CONTROL_FORCE_TDMA); -+ 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; -+ } -+ -+ if (strcmp(pch, "dump_mac_reg") == 0) { -+ mac_reg_dump(RTW_DBGDUMP, padapter); -+ goto free_buf; -+ } -+ -+free_buf: -+ rtw_mfree(pbuf, len); -+ return 0; -+} -+ -+static iw_handler rtw_handlers[] = { -+#ifdef CONFIG_IOCTL_WEXT -+ 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---*/ -+#endif -+}; -+ -+ -+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" -+ }, -+#ifdef CONFIG_RTW_80211K -+ { -+ SIOCIWFIRSTPRIV + 0x17, -+ IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | 1024 , "rrm" -+ }, -+#else -+ {SIOCIWFIRSTPRIV + 0x17, IW_PRIV_TYPE_CHAR | 1024 , 0 , "NULL"}, -+#endif -+ -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ {SIOCIWFIRSTPRIV + 0x18, IW_PRIV_TYPE_CHAR | 1024 , 0 , "cmap_intfs"}, -+#else -+ {SIOCIWFIRSTPRIV + 0x18, 0, 0, "NULL"}, -+#endif -+ -+#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, "NULL"}, -+ {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" -+ }, -+ -+ { 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" }, -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ { MP_WOW_SET_KEEP_ALIVE_PATTERN ,IW_PRIV_TYPE_CHAR | 1024 , 0 , "wow_keep_alive"}, -+#endif /* defined (CONFIG_KEEP_ALIVE_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 -+ { GET_IC_TYPE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "ic_type" }, -+}; -+ -+ -+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_CHL_OFFSET , IW_PRIV_TYPE_CHAR | 1024 , IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ch_offset" }, -+ { 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_BT_MASK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_bt_mask" }, -+ { 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" }, -+ { EFUSE_FILE_STORE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_store" }, -+ { 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" }, -+ { MP_PWRLMT, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_pwrlmt" }, -+ { MP_PWRBYRATE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_pwrbyrate" }, -+ { 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"}, -+ { BT_EFUSE_FILE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "bt_efuse_file" }, -+ { MP_SWRFPath, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_swrfpath" }, -+ { MP_LINK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_link" }, -+ { MP_DPK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_dpk"}, -+ { MP_DPK_TRK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_dpk_trk" }, -+ { MP_GET_TSSIDE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_get_tsside" }, -+ { MP_SET_TSSIDE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_set_tsside" }, -+#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 */ -+ NULL, /* 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 */ -+#ifdef CONFIG_RTW_80211K -+ rtw_wx_priv_rrm, /* 0x17 */ -+#else -+ rtw_wx_priv_null, /* 0x17 */ -+#endif -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ cmap_intfs_ioctl, /* 0x18 */ -+#else -+ NULL, /* 0x18 */ -+#endif -+ rtw_wx_priv_null, /* 0x19 */ -+#ifdef CONFIG_MP_INCLUDED -+ rtw_wx_priv_null, /* 0x1A */ -+ rtw_wx_priv_null, /* 0x1B */ -+#else -+ rtw_wx_priv_null, /* 0x1A */ -+ rtw_mp_efuse_get, /* 0x1B */ -+#endif -+ NULL, /* 0x1C is reserved for hostapd */ -+ rtw_test, /* 0x1D */ -+}; -+ -+#ifdef CONFIG_WIRELESS_EXT -+#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, WIFI_ASOC_STATE) != _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 -+ tmp_level = padapter->recvpriv.signal_strength; -+#endif -+ -+ tmp_qual = padapter->recvpriv.signal_qual; -+ #ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ if (IS_NM_ENABLE(padapter)) { -+ tmp_noise = rtw_noise_measure_curchan(padapter); -+ #ifndef CONFIG_SIGNAL_DISPLAY_DBM -+ tmp_noise = translate_dbm_to_percentage(tmp_noise);/*percentage*/ -+ #endif -+ } -+ #endif -+ /* 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 -+ -+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 (input == NULL) { -+ err = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ 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); -+ RTW_DBG("%s: cmd=%s\n", __func__, cmdname); -+ -+ /* skip command string */ -+ if (cmdlen > 0) -+ cmdlen += 1; /* skip one space */ -+ ptr += cmdlen; -+ len -= cmdlen; -+ RTW_DBG("%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 (k >= num_priv_args) { -+ err = -EINVAL; -+ 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 || count >= 4096) -+ 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 || count >= 1024) -+ 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_DBG("%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; -+ union iwreq_data wrq_data; -+ int err = 0; -+ iwp = &wrq_data.data; -+ RTW_DBG("%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) { -+#ifdef CONFIG_IOCTL_WEXT -+ 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 */ -+#endif /* CONFIG_IOCTL_WEXT */ -+ 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 --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_mp.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_mp.c -new file mode 100755 -index 000000000..f014313ca ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/ioctl_mp.c -@@ -0,0 +1,3688 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+#if defined(CONFIG_MP_INCLUDED) -+ -+#include -+#include -+#include "../../hal/phydm/phydm_precomp.h" -+#include -+ -+ -+#if defined(CONFIG_RTL8723B) -+ #include -+#endif -+ -+#define RTW_IWD_MAX_LEN 128 -+inline u8 rtw_do_mp_iwdata_len_chk(const char *caller, u32 len) -+{ -+ u8 is_illegal = _FALSE; -+ if (len >= RTW_IWD_MAX_LEN) { -+ RTW_ERR("%s : iw data len(%u) > RTW_IWD_MAX_LEN(%u)", -+ caller, len, RTW_IWD_MAX_LEN); -+ is_illegal = _TRUE; -+ } -+ return is_illegal; -+} -+ -+/* -+ * 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; -+ char *width_str; -+ char width; -+ u32 addr, data; -+ int ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[RTW_IWD_MAX_LEN]; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, (wrqu->length + 1))) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ input[wrqu->length] = '\0'; -+ -+ _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); -+ -+ 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[RTW_IWD_MAX_LEN]; -+ char *pch, *pnext; -+ char *width_str; -+ char width; -+ char data[20], tmp[20]; -+ u32 addr = 0, strtout = 0; -+ u32 i = 0, j = 0, ret = 0, data32 = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char *pextra = extra; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, (wrqu->length + 1))) -+ return -EFAULT; -+ -+ if (wrqu->length > 128) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ input[wrqu->length] = '\0'; -+ _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 > MP_READ_REG_MAX_OFFSET) -+ 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); -+ pextra += sprintf(pextra, " %d", 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); -+ pextra += sprintf(pextra, " %d", 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); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ char input[RTW_IWD_MAX_LEN]; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ _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 >= hal_spec->rf_reg_path_num) -+ 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[RTW_IWD_MAX_LEN]; -+ char *pch, *pnext; -+ char data[20], tmp[20]; -+ u32 path, addr, strtou; -+ u32 ret, i = 0 , j = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ char *pextra = extra; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ 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 >= hal_spec->rf_reg_path_num) -+ return -EINVAL; -+ -+ if (addr > MP_READ_REG_MAX_OFFSET) -+ 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); -+ pextra += sprintf(pextra, " %d", 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) -+{ -+ int ret = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ LeaveAllPowerSaveMode(padapter); -+ -+ pmppriv->bprocess_mp_mode = _TRUE; -+ -+ if (rtw_mi_check_fwstate(padapter, WIFI_UNDER_SURVEY)) { -+ rtw_mi_buddy_set_scan_deny(padapter, 5000); -+ rtw_mi_scan_abort(padapter, _TRUE); -+ } -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); -+ -+ if (rtw_mp_cmd(padapter, MP_START, RTW_CMDF_WAIT_ACK) != _SUCCESS) -+ ret = -EPERM; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, "mp_start %s\n", ret == 0 ? "ok" : "fail"); -+ wrqu->length = strlen(extra); -+ -+ return ret; -+} -+ -+ -+ -+int rtw_mp_stop(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ int ret = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ -+ if (pmppriv->mode != MP_ON) -+ return -EPERM; -+ -+ if (rtw_mp_cmd(padapter, MP_STOP, RTW_CMDF_WAIT_ACK) != _SUCCESS) -+ ret = -EPERM; -+ -+ pmppriv->bprocess_mp_mode = _FALSE; -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, "mp_stop %s\n", ret == 0 ? "ok" : "fail"); -+ wrqu->length = strlen(extra); -+ -+ return ret; -+} -+ -+ -+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 err = 0; -+ u8 input[RTW_IWD_MAX_LEN]; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, (wrqu->length + 1))) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ input[wrqu->length] = '\0'; -+ rate = rtw_mpRateParseFunc(padapter, input); -+ pmppriv->rateidx = rate; -+ -+ if (rate == 0 && strcmp(input, "1M") != 0) { -+ rate = rtw_atoi(input); -+ if (rate <= MGN_VHT4SS_MCS9) -+ pmppriv->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); -+ -+ if (pmppriv->rateidx > DESC_RATEVHTSS4MCS9) { -+ sprintf(extra, "Set %s Error" , input); -+ return -EINVAL; -+ } -+ -+ if (hal_spec->tx_nss_num < 2 && MPT_IS_2SS_RATE(HwRateToMPTRate(pmppriv->rateidx))) -+ err = 1; -+ if (hal_spec->tx_nss_num < 3 && MPT_IS_3SS_RATE(HwRateToMPTRate(pmppriv->rateidx))) -+ err = 1; -+ if (hal_spec->tx_nss_num < 4 && MPT_IS_4SS_RATE(HwRateToMPTRate(pmppriv->rateidx))) -+ err = 1; -+ if (!is_supported_vht(padapter->registrypriv.wireless_mode) && MPT_IS_VHT_RATE(HwRateToMPTRate(pmppriv->rateidx))) -+ err = 1; -+ if (!is_supported_ht(padapter->registrypriv.wireless_mode) && MPT_IS_HT_RATE(HwRateToMPTRate(pmppriv->rateidx))) -+ err = 1; -+ -+ if (err == 1) { -+ sprintf(extra, "Set data rate to %s Error" , input); -+ pmppriv->rateidx = 0; -+ } else { -+ sprintf(extra, "Set data rate to %s index %d" , input, pmppriv->rateidx); -+ RTW_INFO("%s: %s rate index=%d\n", __func__, input, pmppriv->rateidx); -+ pMptCtx->mpt_rate_index = HwRateToMPTRate(pmppriv->rateidx); -+ SetDataRate(padapter); -+ } -+ wrqu->length = strlen(extra); -+ return err; -+} -+ -+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[RTW_IWD_MAX_LEN]; -+ u8 channel = 1; -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, (wrqu->length + 1))) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ input[wrqu->length] = '\0'; -+ channel = rtw_atoi(input); -+ /*RTW_INFO("%s: channel=%d\n", __func__, channel);*/ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ if (channel != pmppriv->channel) { -+ sprintf(extra, "Change channel %d to channel %d", padapter->mppriv.channel , channel); -+ pmppriv->channel = channel; -+ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); -+ rtw_adjust_chbw(padapter, channel, &pmppriv->bandwidth, &pmppriv->prime_channel_offset); -+ SetChannel(padapter); -+ pHalData->current_channel = channel; -+ } else -+ sprintf(extra, "No change current channel:%d", pmppriv->channel); -+ -+ wrqu->length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_ch_offset(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ u8 input[RTW_IWD_MAX_LEN]; -+ u32 ch_offset = 0; -+ char *pch; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, (wrqu->length + 1))) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ input[wrqu->length] = '\0'; -+ ch_offset = rtw_atoi(input); -+ /*RTW_INFO("%s: channel=%d\n", __func__, channel);*/ -+ _rtw_memset(extra, 0, wrqu->length); -+ pch = extra; -+ pch += sprintf(pch, "Change prime channel offset %d to %d", padapter->mppriv.prime_channel_offset , ch_offset); -+ padapter->mppriv.prime_channel_offset = ch_offset; -+ SetChannel(padapter); -+ -+ 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) -+{ -+ u8 bandwidth = 0, sg = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ u8 input[RTW_IWD_MAX_LEN]; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ if (sscanf(input, "40M=%hhd,shortGI=%hhd", &bandwidth, &sg) > 0) -+ RTW_INFO("%s: bw=%hhd sg=%hhd\n", __func__, bandwidth , sg); -+ -+ if (bandwidth != pmppriv->bandwidth) { -+ rtw_adjust_chbw(padapter, pmppriv->channel, &bandwidth, &pmppriv->prime_channel_offset); -+ -+ pmppriv->bandwidth = (u8)bandwidth; -+ pmppriv->preamble = sg; -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, "Change BW %d to BW %d\n", pHalData->current_channel_bw , bandwidth); -+ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); -+ SetBandwidth(padapter); -+ pHalData->current_channel_bw = bandwidth; -+ } else -+ sprintf(extra, "No change current BW %d\n", pmppriv->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); -+ HAL_DATA_TYPE *phal_data = GET_HAL_DATA(padapter); -+ char input[RTW_IWD_MAX_LEN]; -+ u32 rfpath = 0 ; -+ u32 txpower_inx = 0, tarpowerdbm = 0; -+ char *pextra = extra; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, (wrqu->length + 1))) -+ return -EFAULT; -+ -+ if (wrqu->length > 128) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ input[wrqu->length] = '\0'; -+ _rtw_memset(extra, 0, strlen(extra)); -+ -+ if (wrqu->length == 2) { -+ if (input[0] != '\0' ) { -+ rfpath = rtw_atoi(input); -+ txpower_inx = mpt_ProQueryCalTxPower(padapter, rfpath); -+ } -+ pextra += sprintf(pextra, " %d\n", txpower_inx); -+ tarpowerdbm = mpt_get_tx_power_finalabs_val(padapter, rfpath); -+ if (tarpowerdbm > 0) -+ pextra += sprintf(pextra, "\t\t dBm:%d", tarpowerdbm); -+ } else { -+ if (phal_data->ant_path == 1) -+ rfpath = 1; -+ else -+ rfpath = 0; -+ -+ txpower_inx = mpt_ProQueryCalTxPower(padapter, rfpath); -+ pextra += sprintf(pextra, "patha=%d", txpower_inx); -+ if (phal_data->rf_type > RF_1T2R) { -+ txpower_inx = mpt_ProQueryCalTxPower(padapter, 1); -+ pextra += sprintf(pextra, ",pathb=%d", txpower_inx); -+ } -+ if (phal_data->rf_type > RF_2T4R) { -+ txpower_inx = mpt_ProQueryCalTxPower(padapter, 2); -+ pextra += sprintf(pextra, ",pathc=%d", txpower_inx); -+ } -+ if (phal_data->rf_type > RF_3T4R) { -+ txpower_inx = mpt_ProQueryCalTxPower(padapter, 3); -+ pextra += sprintf(pextra, ",pathd=%d", txpower_inx); -+ } -+ -+ tarpowerdbm = mpt_get_tx_power_finalabs_val(padapter, rfpath); -+ pextra += sprintf(pextra, "\n\t\t\tpatha dBm=%d", tarpowerdbm); -+ if (phal_data->rf_type > RF_1T2R) { -+ tarpowerdbm = mpt_get_tx_power_finalabs_val(padapter, 1); -+ pextra += sprintf(pextra, ",pathb dBm=%d", tarpowerdbm); -+ } -+ if (phal_data->rf_type > RF_2T4R) { -+ tarpowerdbm = mpt_get_tx_power_finalabs_val(padapter, 2); -+ pextra += sprintf(pextra, ",pathc dBm=%d", tarpowerdbm); -+ } -+ if (phal_data->rf_type > RF_3T4R) { -+ tarpowerdbm = mpt_get_tx_power_finalabs_val(padapter, 3); -+ pextra += sprintf(pextra, ",pathd dBm=%d", tarpowerdbm); -+ } -+ } -+ 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; -+ int MsetPower = 1; -+ u8 input[RTW_IWD_MAX_LEN]; -+ char pout_str_buf[7]; -+ u8 res = 0; -+ char *pextra; -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); -+ struct mp_priv *pmppriv = &padapter ->mppriv; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ MsetPower = strncmp(input, "off", 3); -+ if (MsetPower == 0) { -+ pmppriv->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) >= 1) { -+ if (res < 1) { -+ if(isdigit(input[0])){ -+ idx_a = rtw_atoi(input); -+ RTW_INFO("direct set RF Path A Power =%d\n", idx_a); -+ } else -+ RTW_INFO("Invalid format on %s !, Get patha=%d,pathb=%d,pathc=%d,pathd=%d\n", input , idx_a , idx_b , idx_c , idx_d); -+ } -+ pmppriv->txpoweridx = (u8)idx_a; -+ pMptCtx->TxPwrLevel[RF_PATH_A] = (u8)idx_a; -+ pMptCtx->TxPwrLevel[RF_PATH_B] = (u8)idx_b; -+ pMptCtx->TxPwrLevel[RF_PATH_C] = (u8)idx_c; -+ pMptCtx->TxPwrLevel[RF_PATH_D] = (u8)idx_d; -+ padapter->mppriv.bSetTxPower = 1; -+ -+ SetTxPower(padapter); -+ } else if (sscanf(input, "a_dbm=%d", &idx_a) >= 1) { -+ s32 db_temp = 0; -+ s16 pout = 0; -+ u32 poutdbm = 0; -+ u32 poutdbm_int; -+ u32 poutdbm_dec; -+ if (idx_a < 9 || idx_a >= 22) { -+ sprintf(extra, "Error input:%d,Tune dBm range is 9-22\n", idx_a); -+ goto invalid_param_format; -+ } -+ -+ db_temp = (s16)hal_mpt_tssi_turn_target_power(padapter, pout, RF_PATH_A); -+ RTW_INFO("%s: mpt_tssi_turn_target_power db_temp=%d\n", __func__, db_temp); -+ -+ pout = idx_a*100 - db_temp; -+ poutdbm = hal_mpt_tssi_turn_target_power(padapter, pout, RF_PATH_A); -+ sprintf(extra, "Path A Set power dbm :%d\n", idx_a); -+ -+ pmppriv->bSetTxPower = 1; -+ } else if (sscanf(input, "b_dbm=%d", &idx_b) >= 1) { -+ s32 db_temp = 0; -+ s16 pout = 0; -+ u32 poutdbm = 0; -+ -+ if (idx_b < 9 || idx_b >= 22) { -+ sprintf(extra, "Error input:%d,Tune dBm range is 9-22\n", idx_b); -+ goto invalid_param_format; -+ } -+ db_temp = (s16)hal_mpt_tssi_turn_target_power(padapter, pout, RF_PATH_B); -+ RTW_INFO("%s: mpt_tssi_turn_target_power db_temp=%d\n", __func__, db_temp); -+ -+ pout = idx_b*100 - db_temp; -+ poutdbm = hal_mpt_tssi_turn_target_power(padapter, pout, RF_PATH_B); -+ sprintf(extra, "Path B Set power dbm :%d\n", idx_b); -+ -+ pmppriv->bSetTxPower = 1; -+ } else if (strncmp(input, "pwroffset", 9) == 0) {/*pwroffset patha/pathb=-9 ~ 9*/ -+ u8 signed_flag = 0; -+ u8 rfpath = 0xff; -+ int int_num = 0; -+ u32 dec_num = 0; -+ s16 pout = 0; -+ int i; -+ u32 poutdbm; -+ u8 poutdbm_int; -+ u8 poutdbm_dec; -+ -+ if (sscanf(input+10, "patha=%7s", pout_str_buf) == 1) { -+ rfpath = 0; -+ } else if (sscanf(input+10, "pathb=%7s", pout_str_buf) == 1) { -+ rfpath = 1; -+ } else { -+ sprintf(extra, "[pwroffset patha/pathb=-9.00 ~ 9.00]"); -+ goto invalid_param_format; -+ } -+ -+ if(pout_str_buf[0] == '-') -+ signed_flag = 1; -+ i = sscanf(pout_str_buf, "%d.%3u", &int_num, &dec_num); -+ pout = int_num * 100; -+ if(i == 2) { -+ dec_num = (dec_num < 10) ? dec_num * 10 : dec_num; -+ pout += ((pout < 0 || signed_flag == 1) ? -dec_num : dec_num); -+ } -+ -+ if (pout < -900 || pout > 900 || rfpath == 0xff) { -+ sprintf(extra, "CMD Format:[pwroffset patha/pathb=-9.00 ~ 9.00]\n" -+ " each scale step value must 0.25 or -0.25\n" -+ " scale limit range is -9.00 - 9.00"); -+ goto invalid_param_format; -+ } -+ -+ pmppriv->txpower_dbm_offset = pout; -+ RTW_INFO("%s: pout = %d\n", __func__, pout); -+ hal_mpt_tssi_set_power_offset(padapter, pout, rfpath); -+ sprintf(extra, "Config power offset:%d OK\n", pout); -+ } else if (strncmp(input, "dbm", 3) == 0) { -+ u8 signed_flag = 0; -+ u8 ret = 0xff; -+ int int_num = 0; -+ u32 dec_num = 0; -+ s16 pout = 0; -+ int i; -+ u32 poutdbm = 0; -+ s32 db_temp = 0; -+ s16 pset = 0; -+ u8 rfpath; -+ -+ if (sscanf(input, "dbm=%7s", pout_str_buf) == 1) { -+ ret = 0; -+ } else { -+ sprintf(extra, "[dbm =0 ~ 20.00]"); -+ goto invalid_param_format; -+ } -+ -+ if(pout_str_buf[0] == '-') -+ signed_flag = 1; -+ i = sscanf(pout_str_buf, "%d.%3u", &int_num, &dec_num); -+ -+ pset = int_num * 100; -+ if(i == 2) { -+ dec_num = (dec_num < 10) ? dec_num * 10 : dec_num; -+ pset += ((pset < 0 || signed_flag == 1) ? -dec_num : dec_num); -+ } -+ -+ if (pset < 900 || pset > 2200 || ret == 0xff) { -+ sprintf(extra, "CMD Format:[dbm= 9.00 ~ 22.00]\n" -+ " each scale step value must 0.25 or -0.25\n"); -+ goto invalid_param_format; -+ } -+ for (rfpath = 0; rfpath < hal_spec->rf_reg_path_num; rfpath++) { -+ db_temp = (s16)hal_mpt_tssi_turn_target_power(padapter, pout, rfpath); -+ pout = pset - db_temp; -+ RTW_INFO("%s: path[%d] db_temp=%d pout = %d\n", __func__, rfpath, db_temp, pout); -+ poutdbm = hal_mpt_tssi_turn_target_power(padapter, pout, rfpath); -+ } -+ poutdbm = db_temp + pout; -+ -+ sprintf(extra, "Path Set power dbm :%d.%d\n", poutdbm / 100, poutdbm % 100); -+ }else { -+ if (res > 0 || idx_a !=0) -+ 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); -+ else -+ sprintf(extra, "Invalid format on string :%s ", input); -+ } -+ } -+ -+invalid_param_format: -+ 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[RTW_IWD_MAX_LEN]; -+ u16 antenna = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, (wrqu->length + 1))) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ input[wrqu->length] = '\0'; -+ 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; -+ -+ /*RTW_INFO("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_tx);*/ -+ pHalData->antenna_tx_path = antenna; -+ if (IS_HARDWARE_TYPE_8822C(padapter) && padapter->mppriv.antenna_tx == ANTENNA_B) { -+ if (padapter->mppriv.antenna_rx == ANTENNA_A || padapter->mppriv.antenna_rx == ANTENNA_B) { -+ padapter->mppriv.antenna_rx = ANTENNA_AB; -+ pHalData->AntennaRxPath = ANTENNA_AB; -+ RTW_INFO("%s:8822C Tx-B Rx Ant to AB\n", __func__); -+ } -+ } -+ 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[RTW_IWD_MAX_LEN]; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, (wrqu->length + 1))) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ input[wrqu->length] = '\0'; -+ /*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_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, payload = 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 (padapter->registrypriv.mp_mode != 1 ) { -+ sprintf(extra, "Error: can't tx ,not in MP mode. \n"); -+ wrqu->length = strlen(extra); -+ return 0; -+ } -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ *(extra + wrqu->length) = '\0'; -+ 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); -+ payload = strncmp(extra, "payload=", 8); -+ -+ 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 (payload == 0) { -+ payload = MP_TX_Payload_default_random; -+ if (strncmp(extra, "payload=prbs9", 14) == 0) { -+ payload = MP_TX_Payload_prbs9; -+ sprintf(extra, "config payload PRBS9\n"); -+ } else { -+ if (sscanf(extra, "payload=%x", &payload) > 0){ -+ RTW_INFO("payload= %x\n", payload); -+ sprintf(extra, "config payload setting = %x\n" -+ "1. input payload=[]:\n " -+ "[0]: 00, [1]: A5, [2]: 5A, [3]: FF, [4]: PRBS-9, [5]: Random\n" -+ "2. specified a hex payload: payload=0xee\n", payload); -+ } -+ } -+ pmp_priv->tx.payload = payload; -+ wrqu->length = strlen(extra); -+ return 0; -+ } -+ -+ 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; -+ -+ } else if (pktlen != 0) { -+ sprintf(extra, "Pkt len = %d", pktlen); -+ pattrib->pktlen = pktlen; -+ wrqu->length = strlen(extra); -+ return 0; -+ -+ } else if (stop == 0) { -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ _queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; -+ _queue *pfree_xmit_queue = &pxmitpriv->free_xmit_queue; -+ -+ u32 i = 0; -+ bStartTest = 0; /* To set Stop*/ -+ pmp_priv->tx.stop = 1; -+ sprintf(extra, "Stop continuous Tx"); -+ odm_write_dig(&pHalData->odmpriv, 0x20); -+ do { -+ if (pxmitpriv->free_xmitframe_cnt == NR_XMITFRAME && pxmitpriv->free_xmitbuf_cnt == NR_XMITBUFF) -+ break; -+ else { -+ i++; -+ RTW_INFO("%s:wait queue_empty %d!!\n", __func__, i); -+ rtw_msleep_os(10); -+ } -+ } while (i < 1000); -+ } else { -+ bStartTest = 1; -+ odm_write_dig(&pHalData->odmpriv, 0x3f); -+ if (IS_HARDWARE_TYPE_8822C(padapter) && pmp_priv->antenna_tx == ANTENNA_B) { -+ if (pmp_priv->antenna_rx == ANTENNA_A || pmp_priv->antenna_rx == ANTENNA_B) { -+ pmp_priv->antenna_rx = ANTENNA_AB; -+ pHalData->AntennaRxPath = ANTENNA_AB; -+ RTW_INFO("%s:8822C Tx-B Rx Ant to AB\n", __func__); -+ SetAntenna(padapter); -+ } -+ } -+ if (pmp_priv->mode != MP_ON) { -+ if (pmp_priv->tx.stop != 1) { -+ RTW_INFO("%s:Error MP_MODE %d != ON\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); -+ -+ if (stop == 0) -+ pmp_priv->mode = MP_ON; -+ -+ 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) -+{ -+#ifdef CONFIG_BT_COEXIST -+ PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+#endif -+ u8 input[RTW_IWD_MAX_LEN]; -+ u32 bt_coexist; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, (wrqu->data.length + 1))) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ -+ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ input[wrqu->data.length] = '\0'; -+ -+ 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, bSetRxframe = 0; -+ int bmac_filter = 0, bmon = 0, bSmpCfg = 0; -+ u8 input[RTW_IWD_MAX_LEN]; -+ char *pch, *token, *tmp[2] = {0x00, 0x00}; -+ u32 i = 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 (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ 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*/ -+ bSetRxframe = (strncmp(input, "frametype", 9) == 0) ? 1 : 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 (bSetRxframe) { -+ if (strncmp(input, "frametype beacon", 16) == 0) -+ pmppriv->brx_filter_beacon = _TRUE; -+ else -+ pmppriv->brx_filter_beacon = _FALSE; -+ } -+ -+ 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"); -+#if defined(CONFIG_RTL8814B) -+ /* 1. No adhoc, 2. Enable short cut */ -+ rtw_write32(padapter, 0x100, 0x0B000EFF); -+#else -+ rtw_write32(padapter, 0x100, 0x0B0106FF); -+#endif -+ RTW_INFO("0x100 :0x%x", rtw_read32(padapter, 0x100)); -+ rtw_write16(padapter, 0x608, 0x30c); -+ RTW_INFO("0x608 :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.mpt_ctx); -+ 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); -+ u8 input[RTW_IWD_MAX_LEN]; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ 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[RTW_IWD_MAX_LEN]; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, (wrqu->length + 1))) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ input[wrqu->length] = '\0'; -+ 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[4] = {0}; -+ u8 ret = 0; -+ u16 ther_path_addr[4] = {0}; -+ u16 cnt = 1; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ int rfpath = RF_PATH_A; -+ -+#ifdef CONFIG_RTL8188E -+ ther_path_addr[0] = EEPROM_THERMAL_METER_88E; -+#endif -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8812; -+#endif -+#ifdef CONFIG_RTL8192E -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8192E; -+#endif -+#ifdef CONFIG_RTL8192F -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8192F; -+#endif -+#ifdef CONFIG_RTL8723B -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8723B; -+#endif -+#ifdef CONFIG_RTL8703B -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8703B; -+#endif -+#ifdef CONFIG_RTL8723D -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8723D; -+#endif -+#ifdef CONFIG_RTL8188F -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8188F; -+#endif -+#ifdef CONFIG_RTL8188GTV -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8188GTV; -+#endif -+#ifdef CONFIG_RTL8822B -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8822B; -+#endif -+#ifdef CONFIG_RTL8821C -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8821C; -+#endif -+#ifdef CONFIG_RTL8710B -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8710B; -+#endif -+#ifdef CONFIG_RTL8822C -+ ther_path_addr[0] = EEPROM_THERMAL_METER_A_8822C; -+ ther_path_addr[1] = EEPROM_THERMAL_METER_B_8822C; -+#endif -+#ifdef CONFIG_RTL8814B -+ ther_path_addr[0] = EEPROM_THERMAL_METER_A_8814B; -+ ther_path_addr[1] = EEPROM_THERMAL_METER_B_8814B; -+ ther_path_addr[2] = EEPROM_THERMAL_METER_C_8814B; -+ ther_path_addr[3] = EEPROM_THERMAL_METER_D_8814B; -+#endif -+#ifdef CONFIG_RTL8723F -+ ther_path_addr[0] = EEPROM_THERMAL_METER_8723F; -+#endif -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ if ((strncmp(extra, "write", 6) == 0)) { -+ int i; -+ u16 raw_cursize = 0, raw_maxsize = 0; -+#ifdef RTW_HALMAC -+ raw_maxsize = efuse_GetavailableSize(padapter); -+#else -+ efuse_GetCurrentSize(padapter, &raw_cursize); -+ raw_maxsize = efuse_GetMaxSize(padapter); -+#endif -+ RTW_INFO("[eFuse available raw size]= %d bytes\n", raw_maxsize - raw_cursize); -+ if (2 > raw_maxsize - raw_cursize) { -+ RTW_INFO("no available efuse!\n"); -+ return -EFAULT; -+ } -+ -+ for (i = 0; i < hal_spec->rf_reg_path_num; i++) { -+ GetThermalMeter(padapter, i , &val[i]); -+ if (ther_path_addr[i] != 0 && val[i] != 0) { -+ if (rtw_efuse_map_write(padapter, ther_path_addr[i], cnt, &val[i]) == _FAIL) { -+ RTW_INFO("Error efuse write thermal addr 0x%x ,val = 0x%x\n", ther_path_addr[i], val[i]); -+ return -EFAULT; -+ } -+ } else { -+ RTW_INFO("Error efuse write thermal Null addr,val \n"); -+ return -EFAULT; -+ } -+ } -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, " efuse write ok :%d", val[0]); -+ } else { -+ ret = sscanf(extra, "%d", &rfpath); -+ if (ret < 1) { -+ rfpath = RF_PATH_A; -+ RTW_INFO("default thermal of path(%d)\n", rfpath); -+ } -+ if (rfpath >= hal_spec->rf_reg_path_num) -+ return -EINVAL; -+ -+ RTW_INFO("read thermal of path(%d)\n", rfpath); -+ GetThermalMeter(padapter, rfpath, &val[0]); -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, "%d", val[0]); -+ } -+ 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; -+ 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; -+ u8 input[RTW_IWD_MAX_LEN]; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ pmp_priv = &padapter->mppriv; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ 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[RTW_IWD_MAX_LEN]; -+ u32 invalxcap = 0, ret = 0, bwrite_xcap = 0, hwxtaladdr = 0; -+ u16 pgval; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ RTW_INFO("%s:priv in=%s\n", __func__, input); -+ bwrite_xcap = (strncmp(input, "write_xcap=", 11) == 0) ? 1 : 0; -+ -+ if (bwrite_xcap == 1) { -+ ret = sscanf(input, "write_xcap=%d", &invalxcap); -+ invalxcap = invalxcap & 0x7f; /* xtal bit 0 ~6 */ -+ RTW_INFO("get crystal_cap %d\n", invalxcap); -+ -+ if (IS_HARDWARE_TYPE_8822C(padapter) && ret == 1) { -+ hwxtaladdr = 0x110; -+ pgval = invalxcap | 0x80; /* reserved default bit7 on */ -+ pgval = pgval | pgval << 8; /* xtal xi/xo efuse 0x110 0x111 */ -+ -+ RTW_INFO("Get crystal_cap 0x%x\n", pgval); -+ if (rtw_efuse_map_write(padapter, hwxtaladdr, 2, (u8*)&pgval) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_map_write xcap error!!\n", __func__); -+ sprintf(extra, "write xcap pgdata fail"); -+ ret = -EFAULT; -+ } else -+ sprintf(extra, "write xcap pgdata ok"); -+ -+ } -+ } else { -+ ret = sscanf(input, "xcap=%d", &invalxcap); -+ -+ if (ret == 1) { -+ pHalData->crystal_cap = (u8)invalxcap; -+ RTW_INFO("%s:crystal_cap=%d\n", __func__, pHalData->crystal_cap); -+ -+ if (rtw_phydm_set_crystal_cap(padapter, pHalData->crystal_cap) == _FALSE) { -+ RTW_ERR("set crystal_cap failed\n"); -+ rtw_warn_on(1); -+ } -+ sprintf(extra, "Set xcap=%d", invalxcap); -+ } -+ } -+ -+ wrqu->length = strlen(extra) + 1; -+ return ret; -+} -+ -+ -+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[RTW_IWD_MAX_LEN]; -+ int bMain = 1, bTurnoff = 1; -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ u8 ret = _TRUE; -+#endif -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ 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); -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ if (bMain == 0) -+ ret = rtw_mp_set_antdiv(padapter, _TRUE); -+ else -+ ret = rtw_mp_set_antdiv(padapter, _FALSE); -+ if (ret == _FALSE) -+ RTW_INFO("%s:ANTENNA_DIVERSITY FAIL\n", __func__); -+#endif -+ -+ 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"); -+ } else { -+ bMain = MP_PHY_QueryRFPathSwitch(padapter); -+ RTW_INFO("%s:Query RF Path = %s\n", __func__, (bMain ? "Main":"Aux")); -+ if (IS_HARDWARE_TYPE_8821C(padapter)) -+ sprintf(extra, "RF Path %s\n" , -+ (bMain ? "ANT1/S0/PathB Mode: 0":"ANT2/S1/PathA Mode: 1")); -+ else -+ sprintf(extra, "RF Path %s\n" , (bMain ? "1":"0")); -+ } -+ -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_switch_rf_path(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct mp_priv *pmp_priv; -+ char input[RTW_IWD_MAX_LEN]; -+ char *pch; -+ int bwlg = 1, bwla = 1, btg = 1, bbt=1; -+ u8 ret = 0; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ pmp_priv = &padapter->mppriv; -+ -+ RTW_INFO("%s: in=%s\n", __func__, input); -+ -+ _rtw_memset(extra, '\0', wrqu->length); -+ pch = extra; -+#ifdef CONFIG_RTL8821C /* only support for 8821c wlg/wla/btg/bt RF switch path */ -+ if ((strncmp(input, "WLG", 3) == 0) || (strncmp(input, "1", 1) == 0)) { -+ pmp_priv->rf_path_cfg = SWITCH_TO_WLG; -+ pch += sprintf(pch, "switch rf path WLG\n"); -+ -+ } else if ((strncmp(input, "WLA", 3) == 0) || (strncmp(input, "2", 1) == 0)) { -+ pmp_priv->rf_path_cfg = SWITCH_TO_WLA; -+ pch += sprintf(pch, "switch rf path WLA\n"); -+ -+ } else if ((strncmp(input, "BTG", 3) == 0) || (strncmp(input, "0", 1) == 0)) { -+ pmp_priv->rf_path_cfg = SWITCH_TO_BTG; -+ pch += sprintf(pch, "switch rf path BTG\n"); -+ -+ } else if ((strncmp(input, "BT", 3) == 0) || (strncmp(input, "3", 1) == 0)) { -+ pmp_priv->rf_path_cfg = SWITCH_TO_BT; -+ pch += sprintf(pch, "switch rf path BT\n"); -+ } else { -+ pmp_priv->rf_path_cfg = SWITCH_TO_WLG; -+ pch += sprintf(pch, "Error input, default set WLG\n"); -+ return -EFAULT; -+ } -+ -+ mp_phy_switch_rf_path_set(padapter, &pmp_priv->rf_path_cfg); -+#endif -+ wrqu->length = strlen(extra); -+ -+ return ret; -+ -+} -+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[RTW_IWD_MAX_LEN]; -+ int qAutoLoad = 1; -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->data.length)) -+ return -EFAULT; -+ -+ 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[RTW_IWD_MAX_LEN]; -+ u8 pwrtrk_state = 0; -+ u8 pwtk_type[5][25] = {"Thermal tracking off","Thermal tracking on", -+ "TSSI tracking off","TSSI tracking on","TSSI calibration"}; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ input[wrqu->length - 1] = '\0'; -+ RTW_INFO("%s: in=%s\n", __func__, input); -+ -+ if (wrqu->length == 2) { -+ if(input[0] >= '0' && input[0] <= '4') { -+ pwrtrk_state = rtw_atoi(input); -+ MPT_PwrCtlDM(padapter, pwrtrk_state); -+ sprintf(extra, "PwrCtlDM start %s\n" , pwtk_type[pwrtrk_state]); -+ } else { -+ sprintf(extra, "Error unknown number ! Please check your input number\n" -+ " 0 : Thermal tracking off\n 1 : Thermal tracking on\n 2 : TSSI tracking off\n" -+ " 3 : TSSI tracking on\n 4 : TSSI calibration\n"); -+ } -+ wrqu->length = strlen(extra); -+ -+ return 0; -+ } -+ if (strncmp(input, "start", 5) == 0 || strncmp(input, "thertrk on", 10) == 0) {/* strncmp TRUE is 0*/ -+ pwrtrk_state = 1; -+ sprintf(extra, "PwrCtlDM start %s\n" , pwtk_type[pwrtrk_state]); -+ } else if (strncmp(input, "thertrk off", 11) == 0 || strncmp(input, "stop", 5) == 0) { -+ pwrtrk_state = 0; -+ sprintf(extra, "PwrCtlDM stop %s\n" , pwtk_type[pwrtrk_state]); -+ } else if (strncmp(input, "tssitrk off", 11) == 0){ -+ pwrtrk_state = 2; -+ sprintf(extra, "PwrCtlDM stop %s\n" , pwtk_type[pwrtrk_state]); -+ } else if (strncmp(input, "tssitrk on", 10) == 0){ -+ pwrtrk_state = 3; -+ sprintf(extra, "PwrCtlDM start %s\n" , pwtk_type[pwrtrk_state]); -+ } else if (strncmp(input, "tssik", 5) == 0){ -+ pwrtrk_state = 4; -+ sprintf(extra, "PwrCtlDM start %s\n" , pwtk_type[pwrtrk_state]); -+ } else { -+ sprintf(extra, "Error input !!!\n" -+ " thertrk off : Thermal tracking off\n thertrk on : Thermal tracking on\n" -+ " tssitrk off : TSSI tracking off\n tssitrk on : TSSI tracking on\n tssik : TSSI calibration\n\n" -+ " 0 : Thermal tracking off\n 1 : Thermal tracking on\n 2 : TSSI tracking off\n" -+ " 3 : TSSI tracking on\n 4 : TSSI calibration\n"); -+ wrqu->length = strlen(extra); -+ return 0; -+ } -+ -+ MPT_PwrCtlDM(padapter, pwrtrk_state); -+ 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_dpk(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 dm_struct *pDM_Odm = &pHalData->odmpriv; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ char *pch; -+ -+ u8 ips_mode = IPS_NUM; /* init invalid value */ -+ u8 lps_mode = PS_MODE_NUM; /* init invalid value */ -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ *(extra + wrqu->data.length) = '\0'; -+ pch = extra; -+ -+ if (strncmp(extra, "off", 3) == 0 && strlen(extra) < 4) { -+ pDM_Odm->dpk_info.is_dpk_enable = 0; -+ halrf_dpk_enable_disable(pDM_Odm); -+ pch += sprintf(pch, "set dpk off\n"); -+ -+ } else if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { -+ pDM_Odm->dpk_info.is_dpk_enable = 1; -+ halrf_dpk_enable_disable(pDM_Odm); -+ pch += sprintf(pch, "set dpk on\n"); -+ } else { -+#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 -+ rtw_mp_trigger_dpk(padapter); -+ 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 */ -+ } -+ pch += sprintf(pch, "set dpk trigger\n"); -+ } -+ -+ wrqu->data.length = strlen(extra); -+ -+ return 0; -+} -+ -+int rtw_mp_get_tsside(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); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ char input[RTW_IWD_MAX_LEN]; -+ u8 rfpath; -+ u32 tssi_de; -+ -+ u8 legal_param_num = 1; -+ int param_num; -+ char pout_str_buf[7]; -+ u8 signed_flag = 0; -+ int integer_num; -+ u32 decimal_num; -+ s32 pout; -+ char *pextra; -+ int i; -+ -+ #ifdef CONFIG_RTL8723F -+ /* -+ * rtwpriv wlan0 mp_get_tsside rf_path pout -+ * rf_path : 0 ~ 1 -+ * pout : -15.000 ~ 25.000 -+ * ex : rtwpriv wlan0 mp_get_tsside 0 -12.123 -+ */ -+ legal_param_num = 2; -+ #endif -+ if (wrqu->length > 128) -+ return -EFAULT; -+ -+ _rtw_memset(input, 0, sizeof(input)); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ param_num = sscanf(input, "%hhu %7s", &rfpath, pout_str_buf); -+ -+ /* Check parameter format*/ -+ if(param_num != legal_param_num) -+ goto invalid_param_format; -+ -+ if(rfpath <0 || 3 < rfpath) -+ goto invalid_param_format; -+ -+#ifdef CONFIG_RTL8723F -+ /* Convert pout from floating-point to integer -+ * For Floating-Point Precision, pout*1000 -+ */ -+ if(pout_str_buf[0] == '-') -+ signed_flag = 1; -+ i = sscanf(pout_str_buf, "%d.%3u", &integer_num, &decimal_num); -+ pout = integer_num * 1000; -+ RTW_INFO("%s() pout1 = %d\n", __func__, pout); -+ -+ if (i == 2) { -+ /* Convert decimal number -+ * ex : 0.1 => 100, 0.01 => 10, 0.001 => 1. -+ */ -+ u8 idx = 0; -+ u32 dec = 0; -+ u8 str_len = 0; -+ char *token, *tmp[3] = {}; -+ -+ pextra = pout_str_buf; -+ while ((token = strsep (&pextra,".")) != NULL) { -+ tmp[idx] = token; -+ RTW_INFO("%s() token %d = %s strlen =%ld\n", __func__, -+ idx, tmp[idx], strlen(tmp[idx])); -+ idx++; -+ } -+ -+ str_len = strlen(tmp[1]); -+ dec = rtw_atoi(tmp[1]); -+ decimal_num = (str_len == 1) ? dec * 100: (str_len == 2) ? dec * 10: dec; -+ RTW_INFO("%s() decimal_num = %d\n", __func__, decimal_num); -+ pout += ((pout < 0 || signed_flag == 1) ? -decimal_num : decimal_num); -+ } -+ RTW_INFO("%s() pout2 = %d\n", __func__, pout); -+ if(pout < -15000 || 25000 < pout) -+ goto invalid_param_format; -+#endif -+ -+#ifdef CONFIG_RTL8723F -+ /* For Floating-Point Precision, pout */ -+ tssi_de = halrf_get_online_tssi_de(pDM_Odm, rfpath, pout); -+#else -+ tssi_de = halrf_tssi_get_de(pDM_Odm, rfpath); -+#endif -+ -+ if (rfpath == 0) -+ sprintf(extra, "patha=%d hex=%02x", tssi_de, (u8)tssi_de); -+ else if (rfpath == 1) -+ sprintf(extra, "pathb=%d hex=%02x", tssi_de, (u8)tssi_de); -+ else if (rfpath == 2) -+ sprintf(extra, "pathc=%d hex=%02x", tssi_de, (u8)tssi_de); -+ else if (rfpath == 3) -+ sprintf(extra, "pathd=%d hex=%02x", tssi_de, (u8)tssi_de); -+ -+ wrqu->length = strlen(extra); -+ return 0; -+ -+invalid_param_format: -+ sprintf(extra, "Invalid command format, please indicate RF path 0/1/2/3"); -+#ifdef CONFIG_RTL8723F -+ pextra = extra + strlen(extra); -+ sprintf(pextra, " and pout value : -15.000 ~ 25.000\n"); -+#endif -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+int rtw_mp_set_tsside(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 tsside_a = 0, tsside_b = 0, tsside_c = 0, tsside_d = 0; -+ char input[RTW_IWD_MAX_LEN]; -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_struct *pDM_Odm = &pHalData->odmpriv; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ if (sscanf(input, "patha=%d", &tsside_a) == 1) { -+ sprintf(extra, "Set TSSI DE path_A: %d", tsside_a); -+ halrf_tssi_set_de_for_tx_verify(pDM_Odm, tsside_a, RF_PATH_A); -+ mpt_trigger_tssi_tracking(padapter, RF_PATH_A); -+ -+ } else if (sscanf(input, "pathb=%d", &tsside_b) == 1) { -+ sprintf(extra, "Set TSSI DE path_B: %d", tsside_b); -+ halrf_tssi_set_de_for_tx_verify(pDM_Odm, tsside_b, RF_PATH_B); -+ mpt_trigger_tssi_tracking(padapter, RF_PATH_B); -+ -+ } else if (sscanf(input, "pathc=%d", &tsside_c) == 1) { -+ sprintf(extra, "Set TSSI DE path_C: %d", tsside_c); -+ halrf_tssi_set_de_for_tx_verify(pDM_Odm, tsside_c, RF_PATH_C); -+ mpt_trigger_tssi_tracking(padapter, RF_PATH_C); -+ -+ } else if (sscanf(input, "pathd=%d", &tsside_d) == 1) { -+ sprintf(extra, "Set TSSI DE path_D: %d", tsside_d); -+ halrf_tssi_set_de_for_tx_verify(pDM_Odm, tsside_d, RF_PATH_D); -+ mpt_trigger_tssi_tracking(padapter, RF_PATH_D); -+ -+ } else -+ sprintf(extra, "Invalid command format, please input TSSI DE value within patha/b/c/d=xyz"); -+ -+ 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->hal_func; -+ 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; -+ -+ *(extra + wrqu->data.length) = '\0'; -+ 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, 0);*/ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ rtw_disassoc_cmd(padapter, 500, 0); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ /*rtw_free_assoc_resources_cmd(padapter, _TRUE, 0);*/ -+ } -+ 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) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ char *pextra = extra; -+ -+ switch (pmp_priv->mode) { -+ -+ case MP_PACKET_TX: -+ if (bStartTest == 0) { -+ pmp_priv->tx.stop = 1; -+ pmp_priv->mode = MP_ON; -+ #ifdef CONFIG_RTL8822B -+ rtw_write8(padapter, 0x838, 0x61); -+ #endif -+ sprintf(extra, "Stop continuous Tx"); -+ } else if (pmp_priv->tx.stop == 1) { -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "\nStart continuous DA=ffffffffffff len=1500 count=%u\n", pmp_priv->tx.count); -+ pmp_priv->tx.stop = 0; -+ #ifdef CONFIG_RTL8822B -+ rtw_write8(padapter, 0x838, 0x6d); -+ #endif -+ SetPacketTx(padapter); -+ } else -+ return -EFAULT; -+ return 0; -+ case MP_SINGLE_TONE_TX: -+ if (bStartTest != 0) -+ strcat(extra, "\nStart continuous DA=ffffffffffff len=1500\n infinite=yes."); -+ SetSingleToneTx(padapter, (u8)bStartTest); -+ break; -+ case MP_CONTINUOUS_TX: -+ if (bStartTest != 0) -+ strcat(extra, "\nStart continuous DA=ffffffffffff len=1500\n infinite=yes."); -+ SetContinuousTx(padapter, (u8)bStartTest); -+ break; -+ case MP_CARRIER_SUPPRISSION_TX: -+ if (bStartTest != 0) { -+ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_11M) -+ strcat(extra, "\nStart continuous DA=ffffffffffff len=1500\n infinite=yes."); -+ else -+ strcat(extra, "\nSpecify carrier suppression but not CCK rate"); -+ } -+ SetCarrierSuppressionTx(padapter, (u8)bStartTest); -+ break; -+ case MP_SINGLE_CARRIER_TX: -+ if (bStartTest != 0) -+ strcat(extra, "\nStart continuous DA=ffffffffffff len=1500\n infinite=yes."); -+ 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 -+ if(padapter->registrypriv.ht_enable && -+ is_supported_ht(padapter->registrypriv.wireless_mode)) -+ pmp_priv->tx.attrib.ht_en = 1; -+#endif -+ if (!IS_HARDWARE_TYPE_JAGUAR3(padapter) && !IS_HARDWARE_TYPE_JAGUAR3_11N(padapter)) { -+ 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_set_bb_reg(padapter, rCCAonSec_Jaguar, BIT3, 1); -+ else -+ phy_set_bb_reg(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.mpt_ctx); -+ char *pextra = extra; -+ u32 bandwidth = 0, sg = 0, channel = 6, txpower = 40, rate = 108, ant = 0, txmode = 1, count = 0; -+ u8 bStartTest = 1, status = 0; -+#ifdef CONFIG_MP_VHT_HW_TX_MODE -+ u8 Idx = 0, tmpU1B; -+#endif -+ 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); -+ pextra += sprintf(pextra, "Current Setting :\n Channel:%d", pmp_priv->channel); -+ pextra += sprintf(pextra, "\n Bandwidth:%d", pmp_priv->bandwidth); -+ pextra += sprintf(pextra, "\n Rate index:%d", pmp_priv->rateidx); -+ pextra += sprintf(pextra, "\n TxPower index:%d", pmp_priv->txpoweridx); -+ pextra += sprintf(pextra, "\n Antenna TxPath:%d", pmp_priv->antenna_tx); -+ pextra += sprintf(pextra, "\n Antenna RxPath:%d", pmp_priv->antenna_rx); -+ pextra += sprintf(pextra, "\n MP Mode:%d", 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); -+ pextra += sprintf(pextra, "\n Please input correct format as bleow:\n"); -+ pextra += sprintf(pextra, "\t ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d\n", channel, bandwidth, rate, txpower, ant, txmode); -+ pextra += sprintf(pextra, "\n [ ch : BGN = <1~14> , A or AC = <36~165> ]"); -+ pextra += sprintf(pextra, "\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]"); -+ pextra += sprintf(pextra, "\n [ rate : CCK: 1 2 5.5 11M X 2 = < 2 4 11 22 >]"); -+ pextra += sprintf(pextra, "\n [ OFDM: 6 9 12 18 24 36 48 54M X 2 = < 12 18 24 36 48 72 96 108>"); -+ pextra += sprintf(pextra, "\n [ HT 1S2SS MCS0 ~ MCS15 : < [MCS0]=128 ~ [MCS7]=135 ~ [MCS15]=143 >"); -+ pextra += sprintf(pextra, "\n [ HT 3SS MCS16 ~ MCS32 : < [MCS16]=144 ~ [MCS23]=151 ~ [MCS32]=159 >"); -+ pextra += sprintf(pextra, "\n [ VHT 1SS MCS0 ~ MCS9 : < [MCS0]=160 ~ [MCS9]=169 >"); -+ pextra += sprintf(pextra, "\n [ txpower : 1~63 power index"); -+ pextra += sprintf(pextra, "\n [ ant : ,2T ex: AB=3 BC=6 CD=12"); -+ pextra += sprintf(pextra, "\n [ txmode : < 0 = CONTINUOUS_TX, 1 = PACKET_TX, 2 = SINGLE_TONE_TX, 3 = CARRIER_SUPPRISSION_TX, 4 = SINGLE_CARRIER_TX>\n"); -+ wrqu->data.length = strlen(extra); -+ return status; -+ -+ } else { -+ char *pextra = extra; -+ 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->current_channel = channel; -+ -+ if (bandwidth == 1) -+ bandwidth = CHANNEL_WIDTH_40; -+ else if (bandwidth == 2) -+ bandwidth = CHANNEL_WIDTH_80; -+ pextra = extra + strlen(pextra); -+ pextra += sprintf(pextra, "\nChange Current Bandwidth %d to Bandwidth %d", padapter->mppriv.bandwidth, bandwidth); -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.preamble = sg; -+ SetBandwidth(padapter); -+ pHalData->current_channel_bw = bandwidth; -+ -+ pextra += sprintf(pextra, "\nSet power level :%d", txpower); -+ padapter->mppriv.txpoweridx = (u8)txpower; -+ pMptCtx->TxPwrLevel[RF_PATH_A] = (u8)txpower; -+ pMptCtx->TxPwrLevel[RF_PATH_B] = (u8)txpower; -+ pMptCtx->TxPwrLevel[RF_PATH_C] = (u8)txpower; -+ pMptCtx->TxPwrLevel[RF_PATH_D] = (u8)txpower; -+ SetTxPower(padapter); -+ -+ 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; -+ pextra += sprintf(pextra, "\nSet data rate to %d index %d", padapter->mppriv.rateidx, rate); -+ -+ padapter->mppriv.rateidx = rate; -+ pMptCtx->mpt_rate_index = rate; -+ SetDataRate(padapter); -+ -+ pextra += sprintf(pextra, "\nSet Antenna Path :%d", 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->antenna_tx_path = 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; -+ char *pextra = extra; -+ 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); -+ pextra += sprintf(pextra, "\n Please input correct format as bleow:\n"); -+ pextra += sprintf(pextra, "\t ch=%d,bw=%d,ant=%d\n", channel, bandwidth, ant); -+ pextra += sprintf(pextra, "\n [ ch : BGN = <1~14> , A or AC = <36~165> ]"); -+ pextra += sprintf(pextra, "\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]"); -+ pextra += sprintf(pextra, "\n [ ant : ,2T ex: AB=3 BC=6 CD=12"); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ -+ } else { -+ char *pextra = extra; -+ 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->current_channel = channel; -+ -+ if (bandwidth == 1) -+ bandwidth = CHANNEL_WIDTH_40; -+ else if (bandwidth == 2) -+ bandwidth = CHANNEL_WIDTH_80; -+ pextra = extra + strlen(extra); -+ pextra += sprintf(pextra, "\nChange Current Bandwidth %d to Bandwidth %d", padapter->mppriv.bandwidth, bandwidth); -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.preamble = sg; -+ SetBandwidth(padapter); -+ pHalData->current_channel_bw = bandwidth; -+ -+ pextra += sprintf(pextra, "\nSet Antenna Path :%d", 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->antenna_tx_path = antenna; -+ SetAntenna(padapter); -+ -+ strcat(extra, "\nstart Rx"); -+ 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); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); -+ char *pch; -+ -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) \ -+ || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) || defined(CONFIG_RTL8723F) -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ *(extra + wrqu->data.length) = '\0'; -+ -+ _rtw_memset(&pMptCtx->PMacTxInfo, 0, sizeof(RT_PMAC_TX_INFO)); -+ _rtw_memcpy((void *)&pMptCtx->PMacTxInfo, (void *)extra, sizeof(RT_PMAC_TX_INFO)); -+ _rtw_memset(extra, 0, wrqu->data.length); -+ pch = extra; -+ -+ if (pMptCtx->PMacTxInfo.bEnPMacTx == 1 && pmp_priv->mode != MP_ON) { -+ pch += sprintf(pch, "MP Tx Running, Please Set PMac Tx Mode Stop\n"); -+ RTW_INFO("Error !!! MP Tx Running, Please Set PMac Tx Mode Stop\n"); -+ } else { -+ RTW_INFO("To set MAC Tx mode\n"); -+ if (mpt_ProSetPMacTx(padapter)) -+ pch += sprintf(pch, "Set PMac Tx Mode OK\n"); -+ else -+ pch += sprintf(pch, "Set PMac Tx Mode Error\n"); -+ } -+ wrqu->data.length = strlen(extra); -+#endif -+ return 0; -+ -+} -+ -+int rtw_mp_pwrlmt(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ char *pch; -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ *(extra + wrqu->data.length) = '\0'; -+ pch = extra; -+ -+#if CONFIG_TXPWR_LIMIT -+ if (strncmp(extra, "off", 3) == 0 && strlen(extra) < 4) { -+ padapter->registrypriv.RegEnableTxPowerLimit = 0; -+ pch += sprintf(pch, "Turn off Power Limit\n"); -+ -+ } else if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { -+ padapter->registrypriv.RegEnableTxPowerLimit = 1; -+ pch += sprintf(pch, "Turn on Power Limit\n"); -+ -+ } else -+#endif -+ pch += sprintf(pch, "Get Power Limit Status:%s\n", (registry_par->RegEnableTxPowerLimit == 1) ? "ON" : "OFF"); -+ -+ -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+int rtw_mp_pwrbyrate(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ *(extra + wrqu->data.length) = '\0'; -+ if (strncmp(extra, "off", 3) == 0 && strlen(extra) < 4) { -+ padapter->registrypriv.RegEnableTxPowerByRate = 0; -+ sprintf(extra, "Turn off Tx Power by Rate\n"); -+ -+ } else if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { -+ padapter->registrypriv.RegEnableTxPowerByRate = 1; -+ sprintf(extra, "Turn On Tx Power by Rate\n"); -+ -+ } else { -+ sprintf(extra, "Get Power by Rate Status:%s\n", (padapter->registrypriv.RegEnableTxPowerByRate == 1) ? "ON" : "OFF"); -+ } -+ -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_dpk_track(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 dm_struct *pDM_Odm = &pHalData->odmpriv; -+ char *pch; -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ *(extra + wrqu->data.length) = '\0'; -+ pch = extra; -+ -+ if (strncmp(extra, "off", 3) == 0 && strlen(extra) < 4) { -+ halrf_set_dpk_track(pDM_Odm, FALSE); -+ pch += sprintf(pch, "set dpk track off\n"); -+ -+ } else if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { -+ halrf_set_dpk_track(pDM_Odm, TRUE); -+ pch += sprintf(pch, "set dpk track on\n"); -+ } -+ -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_bt_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 *pch; -+ char *ptmp, tmp; -+ u8 Status; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ _rtw_memset(btmaskfileBuffer, 0x00, sizeof(btmaskfileBuffer)); -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ *(extra + wrqu->data.length) = '\0'; -+ ptmp = extra; -+ -+ if (strncmp(extra, "data,", 5) == 0) { -+ u8 count = 0; -+ u8 i = 0; -+ -+ pch = strsep(&ptmp, ","); -+ -+ if ((pch == NULL) || (strlen(pch) == 0)) { -+ RTW_INFO("%s: parameter error(no cmd)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ 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_INFO("%s: invalid 8-bit hex! input format: data,01:23:45:67:89:ab:cd:ef...\n", __func__); -+ return -EFAULT; -+ } -+ btmaskfileBuffer[count++] = tmp; -+ -+ } while (count < 64); -+ -+ _rtw_memset(extra, '\0' , strlen(extra)); -+ -+ for (i = 0; i < count; i++) -+ ptmp += sprintf(ptmp, "%02x:", btmaskfileBuffer[i]); -+ -+ padapter->registrypriv.bBTFileMaskEfuse = _TRUE; -+ -+ ptmp += sprintf(ptmp, "\nLoad BT Efuse Mask data %d hex ok\n", count); -+ 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_is_file_readable = %s! ,sizeof BT maskfileBuffer %zu\n", __func__, rtw_efuse_mask_file_path, sizeof(btmaskfileBuffer)); -+ Status = rtw_efuse_file_read(padapter, rtw_efuse_mask_file_path, btmaskfileBuffer, sizeof(btmaskfileBuffer)); -+ _rtw_memset(extra, '\0' , strlen(extra)); -+ if (Status == _TRUE) { -+ padapter->registrypriv.bBTFileMaskEfuse = _TRUE; -+ ptmp += sprintf(ptmp, "BT efuse mask file read OK\n"); -+ } else { -+ padapter->registrypriv.bBTFileMaskEfuse = _FALSE; -+ ptmp += sprintf(ptmp, "read BT efuse mask file FAIL\n"); -+ RTW_INFO("%s rtw_efuse_file_read BT mask fail!\n", __func__); -+ } -+ } else { -+ padapter->registrypriv.bBTFileMaskEfuse = _FALSE; -+ ptmp += sprintf(ptmp, "BT efuse mask file readable FAIL\n"); -+ RTW_INFO("%s rtw_is_file_readable BT Mask file fail!\n", __func__); -+ } -+ 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; -+ -+ *(extra + wrqu->data.length) = '\0'; -+ 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; -+ } -+ if (strncmp(extra, "data,", 5) == 0) { -+ u8 *pch; -+ char *ptmp, tmp; -+ u8 count = 0; -+ u8 i = 0; -+ -+ ptmp = extra; -+ pch = strsep(&ptmp, ","); -+ -+ if ((pch == NULL) || (strlen(pch) == 0)) { -+ RTW_INFO("%s: parameter error(no cmd)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ 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_INFO("%s: invalid 8-bit hex! input format: data,01:23:45:67:89:ab:cd:ef...\n", __func__); -+ return -EFAULT; -+ } -+ maskfileBuffer[count++] = tmp; -+ -+ } while (count < 64); -+ -+ _rtw_memset(extra, '\0' , strlen(extra)); -+ -+ for (i = 0; i < count; i++) -+ ptmp += sprintf(ptmp, "%02x:", maskfileBuffer[i]); -+ -+ padapter->registrypriv.bFileMaskEfuse = _TRUE; -+ -+ sprintf(ptmp, "\nLoad Efuse Mask data %d hex ok\n", count); -+ 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, "read efuse mask file FAIL\n"); -+ RTW_INFO("%s rtw_efuse_file_read mask fail!\n", __func__); -+ } -+ } 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_RTW_ANDROID_GKI) -+int rtw_efuse_file_map_store(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ char *rtw_efuse_file_map_path; -+ u8 Status; -+ u16 mapLen; -+ 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_INFO("%s rtw_is_file_readable! %s\n", __func__, rtw_efuse_file_map_path); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&mapLen, _FALSE); -+ -+ if (mapLen != 0) { -+ RTW_INFO("%s, efuse store path = %s! mapLen = %d\n", __func__, rtw_efuse_file_map_path, mapLen); -+ Status = rtw_efuse_file_store(padapter, rtw_efuse_file_map_path, pEfuseHal->fakeEfuseModifiedMap, mapLen); -+ if (Status) { -+ sprintf(extra, "efuse file restore OK\n"); -+ } else { -+ sprintf(extra, "efuse file restore FAIL\n"); -+ } -+ } else { -+ sprintf(extra, "efuse file readable FAIL\n"); -+ RTW_INFO("%s rtw_is_file_readable fail! map Len %d\n", __func__, mapLen); -+ } -+ -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+#endif /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+ -+int rtw_bt_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->fakeBTEfuseModifiedMap, 0xFF, EFUSE_BT_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->fakeBTEfuseModifiedMap, sizeof(pEfuseHal->fakeBTEfuseModifiedMap)); -+ if (Status == _TRUE) { -+ pmp_priv->bloadBTefusemap = _TRUE; -+ sprintf(extra, "BT efuse file file_read OK\n"); -+ } else { -+ pmp_priv->bloadBTefusemap = _FALSE; -+ sprintf(extra, "BT efuse file file_read FAIL\n"); -+ } -+ } else { -+ sprintf(extra, "BT efuse file readable FAIL\n"); -+ RTW_INFO("%s rtw_is_file_readable fail!\n", __func__); -+ } -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+ -+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"); -+} -+ -+int rtw_mp_link(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct mp_priv *pmp_priv; -+ char input[RTW_IWD_MAX_LEN]; -+ int bgetrxdata = 0, btxdata = 0, bsetbt = 0; -+ u8 err = 0; -+ u32 i = 0, datalen = 0,jj, kk, waittime = 0; -+ u16 val = 0x00, ret = 0; -+ char *pextra = NULL; -+ u8 *setdata = NULL; -+ char *pch, *ptmp, *token, *tmp[4] = {0x00, 0x00, 0x00}; -+ -+ pmp_priv = &padapter->mppriv; -+ -+ if (rtw_do_mp_iwdata_len_chk(__func__, wrqu->length)) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ RTW_INFO("%s: in=%s\n", __func__, input); -+ -+ bgetrxdata = (strncmp(input, "rxdata", 6) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ btxdata = (strncmp(input, "txdata", 6) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ bsetbt = (strncmp(input, "setbt", 5) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ -+ if (bgetrxdata) { -+ RTW_INFO("%s: in= 1 \n", __func__); -+ if (pmp_priv->mplink_brx == _TRUE) { -+ pch = extra; -+ while (waittime < 100 && pmp_priv->mplink_brx == _FALSE) { -+ if (pmp_priv->mplink_brx == _FALSE) -+ rtw_msleep_os(10); -+ else -+ break; -+ waittime++; -+ } -+ if (pmp_priv->mplink_brx == _TRUE) { -+ pch += sprintf(pch, "\n"); -+ -+ for (i = 0; i < pmp_priv->mplink_rx_len; i ++) { -+ pch += sprintf(pch, "%02x:", pmp_priv->mplink_buf[i]); -+ } -+ _rtw_memset(pmp_priv->mplink_buf, '\0' , sizeof(pmp_priv->mplink_buf)); -+ pmp_priv->mplink_brx = _FALSE; -+ } -+ } -+ } else if (btxdata) { -+ struct pkt_attrib *pattrib; -+ -+ pch = input; -+ setdata = rtw_zmalloc(1024); -+ if (setdata == NULL) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ i = 0; -+ while ((token = strsep(&pch, ",")) != NULL) { -+ if (i > 2) -+ break; -+ tmp[i] = token; -+ i++; -+ } -+ -+ /* tmp[0],[1],[2] */ -+ /* txdata,00e04c871200........... */ -+ if (strcmp(tmp[0], "txdata") == 0) { -+ if ((tmp[1] == NULL)) { -+ err = -EINVAL; -+ goto exit; -+ } -+ } -+ -+ datalen = strlen(tmp[1]); -+ if (datalen % 2) { -+ err = -EINVAL; -+ goto exit; -+ } -+ datalen /= 2; -+ if (datalen == 0) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: data len=%d\n", __FUNCTION__, datalen); -+ RTW_INFO("%s: tx data=%s\n", __FUNCTION__, tmp[1]); -+ -+ for (jj = 0, kk = 0; jj < datalen; jj++, kk += 2) -+ setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); -+ -+ dump_buf(setdata, datalen); -+ _rtw_memset(pmp_priv->mplink_buf, '\0' , sizeof(pmp_priv->mplink_buf)); -+ _rtw_memcpy(pmp_priv->mplink_buf, setdata, datalen); -+ -+ pattrib = &pmp_priv->tx.attrib; -+ pattrib->pktlen = datalen; -+ pmp_priv->tx.count = 1; -+ pmp_priv->tx.stop = 0; -+ pmp_priv->mplink_btx = _TRUE; -+ SetPacketTx(padapter); -+ pmp_priv->mode = MP_PACKET_TX; -+ -+ } else if (bsetbt) { -+ -+#ifdef CONFIG_BT_COEXIST -+ pch = input; -+ i = 0; -+ -+ while ((token = strsep(&pch, ",")) != NULL) { -+ if (i > 3) -+ break; -+ tmp[i] = token; -+ i++; -+ } -+ -+ if (tmp[1] == NULL) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ if (strcmp(tmp[1], "scbd") == 0) { -+ u16 org_val = 0x8002, pre_val, read_score_board_val; -+ u8 state; -+ -+ pre_val = (rtw_read16(padapter,(0xaa))) & 0x7fff; -+ -+ if (tmp[2] != NULL) { -+ state = simple_strtoul(tmp[2], &ptmp, 10); -+ -+ if (state) -+ org_val = org_val | BIT6; -+ else -+ org_val = org_val & (~BIT6); -+ -+ if (org_val != pre_val) { -+ pre_val = org_val; -+ rtw_write16(padapter, 0xaa, org_val); -+ RTW_INFO("%s,setbt scbd write org_val = 0x%x , pre_val = 0x%x\n", __func__, org_val, pre_val); -+ } else { -+ RTW_INFO("%s,setbt scbd org_val = 0x%x ,pre_val = 0x%x\n", __func__, org_val, pre_val); -+ } -+ } else { -+ read_score_board_val = (rtw_read16(padapter,(0xaa))) & 0x7fff; -+ RTW_INFO("%s,read_score_board_val = 0x%x\n", __func__, read_score_board_val); -+ } -+ goto exit; -+ -+ } else if (strcmp(tmp[1], "testmode") == 0) { -+ -+ if (tmp[2] == NULL) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ val = simple_strtoul(tmp[2], &ptmp, 16); -+ RTW_INFO("get tmp, type %s, val =0x%x!\n", tmp[1], val); -+ -+ if (tmp[2] != NULL) { -+ _rtw_memset(extra, 0, wrqu->length); -+ pch = extra; -+ ret = rtw_btcoex_btset_testmode(padapter, val); -+ if (!CHECK_STATUS_CODE_FROM_BT_MP_OPER_RET(ret, BT_STATUS_BT_OP_SUCCESS)) { -+ RTW_INFO("%s: BT_OP fail = 0x%x!\n", __FUNCTION__, val); -+ pch += sprintf(pch, "BT_OP fail 0x%x!\n", val); -+ } else -+ pch += sprintf(pch, "Set BT_OP 0x%x done!\n", val); -+ } -+ -+ } -+#endif /* CONFIG_BT_COEXIST */ -+ } -+ -+exit: -+ if (setdata) -+ rtw_mfree(setdata, 1024); -+ -+ wrqu->length = strlen(extra); -+ return err; -+ -+} -+ -+#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->hal_func; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ BT_REQ_CMD BtReq; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); -+ 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; -+ -+ *(extra + wrqu->data.length) = '\0'; -+ pch = extra; -+ -+ 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; -+ pHalData->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) { -+ pch += sprintf(pch, "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; -+ pHalData->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) -+ pch += sprintf(pch, "check TxBuf Fail.\n"); -+ else -+ pch += sprintf(pch, "download FW Fail.\n"); -+ } else { -+ pch += sprintf(pch, "download FW OK.\n"); -+ goto exit; -+ } -+ goto exit; -+ } -+ if (strncmp(extra, "dlfw", 4) == 0) { -+ pHalData->LastHMEBoxNum = 0; -+ pHalData->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) { -+ pch += sprintf(pch, "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) -+ pch += sprintf(pch, "check TxBuf Fail.\n"); -+ else -+ pch += sprintf(pch, "download FW Fail.\n"); -+ } else { -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SwitchBtTRxMask(padapter); -+#endif -+ rtw_msleep_os(200); -+ pch += sprintf(pch, "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"); -+ pHalData->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_set_mac_reg(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; -+ } -+ -+ 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 (pHalData->bBTFWReady == _FALSE) { -+ pch += sprintf(pch, "BTFWReady = FALSE.\n"); -+ goto exit; -+ } -+ -+ mptbt_BtControlProcess(padapter, &BtReq); -+ -+ if (readtherm == 0) { -+ pch += sprintf(pch, "BT thermal="); -+ for (i = 4; i < pMptCtx->mptOutLen; i++) { -+ if ((pMptCtx->mptOutBuf[i] == 0x00) && (pMptCtx->mptOutBuf[i + 1] == 0x00)) -+ goto exit; -+ -+ pch += sprintf(pch, " %d ", (pMptCtx->mptOutBuf[i] & 0x1f)); -+ } -+ } else { -+ for (i = 4; i < pMptCtx->mptOutLen; i++) -+ pch += sprintf(pch, " 0x%x ", 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 --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/mlme_linux.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/mlme_linux.c -new file mode 100644 -index 000000000..6fd24e8e2 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/mlme_linux.c -@@ -0,0 +1,444 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+ -+#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 -+ -+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); -+ -+#ifdef CONFIG_RTW_MESH -+#if CONFIG_RTW_MESH_CTO_MGATE_CARRIER -+ if (!rtw_mesh_cto_mgate_required(adapter)) -+#endif -+#endif -+ rtw_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; -+ -+ _enter_critical_bh(&adapter->security_key_mutex, &irqL); -+ -+ if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802.1x */ -+ u8 backup_sw_encrypt, backup_sw_decrypt; -+ -+ backup_sw_encrypt = adapter->securitypriv.sw_encrypt; -+ backup_sw_decrypt = adapter->securitypriv.sw_decrypt; -+ -+ /* 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; -+ _rtw_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. */ -+ _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; -+ -+ adapter->securitypriv.extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE; -+ -+ adapter->securitypriv.sw_encrypt = backup_sw_encrypt; -+ adapter->securitypriv.sw_decrypt = backup_sw_decrypt; -+ -+ } 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; -+ /* } */ -+ -+ psec_priv->extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE; -+ } -+ /* 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]; */ -+ -+ -+ rtw_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); -+ } -+ -+ -+} -+ -+#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->cmn.aid > pstapriv->max_aid) -+ return; -+ -+ if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta) -+ return; -+ -+ -+ wrqu.addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, 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->cmn.aid > pstapriv->max_aid) -+ return; -+ -+ if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta) -+ return; -+ -+ -+ wrqu.addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, 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); -+ -+ rtw_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); -+ -+ rtw_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; */ -+ -+ -+ -+ -+ 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); -+ -+ -+ rtw_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 --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/nlrtw.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/nlrtw.c -new file mode 100644 -index 000000000..14d164b7a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/nlrtw.c -@@ -0,0 +1,583 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2020 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_NLRTW_C_ -+ -+#include -+#include "nlrtw.h" -+ -+#ifdef CONFIG_RTW_NLRTW -+ -+#include -+#include -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 0)) -+#include -+#endif -+ -+ -+enum nlrtw_cmds { -+ NLRTW_CMD_UNSPEC, -+ -+ NLRTW_CMD_CHANNEL_UTILIZATION, -+ NLRTW_CMD_REG_CHANGE, -+ NLRTW_CMD_REG_BEACON_HINT, -+ NLRTW_CMD_RADAR_EVENT, -+ NLRTW_CMD_RADIO_OPMODE, -+ -+ __NLRTW_CMD_AFTER_LAST, -+ NLRTW_CMD_MAX = __NLRTW_CMD_AFTER_LAST - 1 -+}; -+ -+enum nlrtw_attrs { -+ NLRTW_ATTR_UNSPEC, -+ -+ NLRTW_ATTR_WIPHY_NAME, -+ NLRTW_ATTR_CHANNEL_UTILIZATIONS, -+ NLRTW_ATTR_CHANNEL_UTILIZATION_THRESHOLD, -+ NLRTW_ATTR_CHANNEL_CENTER, -+ NLRTW_ATTR_CHANNEL_WIDTH, -+ NLRTW_ATTR_RADAR_EVENT, -+ NLRTW_ATTR_OP_CLASS, -+ NLRTW_ATTR_OP_CHANNEL, -+ NLRTW_ATTR_OP_TXPWR_MAX, -+ NLRTW_ATTR_IF_OPMODES, -+ -+ __NLRTW_ATTR_AFTER_LAST, -+ NUM_NLRTW_ATTR = __NLRTW_ATTR_AFTER_LAST, -+ NLRTW_ATTR_MAX = __NLRTW_ATTR_AFTER_LAST - 1 -+}; -+ -+enum nlrtw_ch_util_attrs { -+ __NLRTW_ATTR_CHANNEL_UTILIZATION_INVALID, -+ -+ NLRTW_ATTR_CHANNEL_UTILIZATION_VALUE, -+ NLRTW_ATTR_CHANNEL_UTILIZATION_BSSID, -+ -+ __NLRTW_ATTR_CHANNEL_UTILIZATION_AFTER_LAST, -+ NUM_NLRTW_ATTR_CHANNEL_UTILIZATION = __NLRTW_ATTR_CHANNEL_UTILIZATION_AFTER_LAST, -+ NLRTW_ATTR_CHANNEL_UTILIZATION_MAX = __NLRTW_ATTR_CHANNEL_UTILIZATION_AFTER_LAST - 1 -+}; -+ -+enum nlrtw_radar_event { -+ NLRTW_RADAR_DETECTED, -+ NLRTW_RADAR_CAC_FINISHED, -+ NLRTW_RADAR_CAC_ABORTED, -+ NLRTW_RADAR_NOP_FINISHED, -+ NLRTW_RADAR_NOP_STARTED, /* NON_OCP started not by local radar detection */ -+}; -+ -+enum nlrtw_if_opmode_attrs { -+ NLRTW_IF_OPMODE_UNSPEC, -+ -+ NLRTW_IF_OPMODE_MACADDR, -+ NLRTW_IF_OPMODE_OP_CLASS, -+ NLRTW_IF_OPMODE_OP_CHANNEL, -+ -+ __NLRTW_IF_OPMODE_ATTR_AFTER_LAST, -+ NUM_NLRTW_IF_OPMODE_ATTR = __NLRTW_IF_OPMODE_ATTR_AFTER_LAST, -+ NLRTW_IF_OPMODE_ATTR_MAX = __NLRTW_IF_OPMODE_ATTR_AFTER_LAST - 1 -+}; -+ -+static int nlrtw_ch_util_set(struct sk_buff *skb, struct genl_info *info) -+{ -+ unsigned int msg; -+ -+ if (!info->attrs[NLRTW_ATTR_CHANNEL_UTILIZATION_THRESHOLD]) -+ return -EINVAL; -+ msg = nla_get_u8(info->attrs[NLRTW_ATTR_CHANNEL_UTILIZATION_THRESHOLD]); -+ -+ return 0; -+} -+ -+static struct nla_policy nlrtw_genl_policy[NUM_NLRTW_ATTR] = { -+ [NLRTW_ATTR_CHANNEL_UTILIZATION_THRESHOLD] = { .type = NLA_U8 }, -+}; -+ -+static struct genl_ops nlrtw_genl_ops[] = { -+ { -+ .cmd = NLRTW_CMD_CHANNEL_UTILIZATION, -+ .flags = 0, -+#if LINUX_VERSION_CODE < KERNEL_VERSION(5, 2, 0) -+ .policy = nlrtw_genl_policy, -+#endif -+ .doit = nlrtw_ch_util_set, -+ .dumpit = NULL, -+ }, -+}; -+ -+enum nlrtw_multicast_groups { -+ NLRTW_MCGRP_DEFAULT, -+}; -+static struct genl_multicast_group nlrtw_genl_mcgrp[] = { -+ [NLRTW_MCGRP_DEFAULT] = { .name = "nlrtw_default" }, -+}; -+ -+/* family definition */ -+static struct genl_family nlrtw_genl_family = { -+ .hdrsize = 0, -+ .name = "nlrtw_"DRV_NAME, -+ .version = 1, -+ .maxattr = NLRTW_ATTR_MAX, -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 2, 0) -+ .policy = nlrtw_genl_policy, -+#endif -+ .netnsok = true, -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 12) -+ .module = THIS_MODULE, -+#endif -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0) -+ .ops = nlrtw_genl_ops, -+ .n_ops = ARRAY_SIZE(nlrtw_genl_ops), -+ .mcgrps = nlrtw_genl_mcgrp, -+ .n_mcgrps = ARRAY_SIZE(nlrtw_genl_mcgrp), -+#endif -+}; -+ -+static inline int nlrtw_multicast(const struct genl_family *family, -+ struct sk_buff *skb, u32 portid, -+ unsigned int group, gfp_t flags) -+{ -+ int ret; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0) -+ ret = genlmsg_multicast(&nlrtw_genl_family, skb, portid, group, flags); -+#else -+ ret = genlmsg_multicast(skb, portid, nlrtw_genl_mcgrp[group].id, flags); -+#endif -+ return ret; -+} -+ -+int rtw_nlrtw_ch_util_rpt(_adapter *adapter, u8 n_rpts, u8 *val, u8 **mac_addr) -+{ -+ struct sk_buff *skb = NULL; -+ void *msg_header = NULL; -+ struct nlattr *nl_ch_util, *nl_ch_utils; -+ struct wiphy *wiphy; -+ u8 i; -+ int ret; -+ -+ wiphy = adapter_to_wiphy(adapter); -+ if (!wiphy) -+ return -EINVAL; -+ -+ /* allocate memory */ -+ skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); -+ if (!skb) { -+ nlmsg_free(skb); -+ return -ENOMEM; -+ } -+ -+ /* create the message headers */ -+ msg_header = genlmsg_put(skb, 0, 0, &nlrtw_genl_family, 0, -+ NLRTW_CMD_CHANNEL_UTILIZATION); -+ if (!msg_header) { -+ ret = -ENOMEM; -+ goto err_out; -+ } -+ -+ /* add attributes */ -+ ret = nla_put_string(skb, NLRTW_ATTR_WIPHY_NAME, wiphy_name(wiphy)); -+ -+ nl_ch_utils = nla_nest_start(skb, NLRTW_ATTR_CHANNEL_UTILIZATIONS); -+ if (!nl_ch_utils) { -+ ret = -EMSGSIZE; -+ goto err_out; -+ } -+ -+ for (i = 0; i < n_rpts; i++) { -+ nl_ch_util = nla_nest_start(skb, i); -+ if (!nl_ch_util) { -+ ret = -EMSGSIZE; -+ goto err_out; -+ } -+ -+ ret = nla_put(skb, NLRTW_ATTR_CHANNEL_UTILIZATION_BSSID, ETH_ALEN, *(mac_addr + i)); -+ if (ret != 0) -+ goto err_out; -+ -+ ret = nla_put_u8(skb, NLRTW_ATTR_CHANNEL_UTILIZATION_VALUE, *(val + i)); -+ if (ret != 0) -+ goto err_out; -+ -+ nla_nest_end(skb, nl_ch_util); -+ } -+ -+ nla_nest_end(skb, nl_ch_utils); -+ -+ /* finalize the message */ -+ genlmsg_end(skb, msg_header); -+ -+ ret = nlrtw_multicast(&nlrtw_genl_family, skb, 0, NLRTW_MCGRP_DEFAULT, GFP_KERNEL); -+ if (ret == -ESRCH) { -+ RTW_INFO("[%s] return ESRCH(No such process)." -+ " Maybe no process waits for this msg\n", __func__); -+ return ret; -+ } else if (ret != 0) { -+ RTW_INFO("[%s] ret = %d\n", __func__, ret); -+ return ret; -+ } -+ -+ return 0; -+err_out: -+ nlmsg_free(skb); -+ return ret; -+} -+ -+int rtw_nlrtw_reg_change_event(_adapter *adapter) -+{ -+ struct sk_buff *skb = NULL; -+ void *msg_header = NULL; -+ struct wiphy *wiphy; -+ u8 i; -+ int ret; -+ -+ wiphy = adapter_to_wiphy(adapter); -+ if (!wiphy) { -+ ret = -EINVAL; -+ goto err_out; -+ } -+ -+ /* allocate memory */ -+ skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); -+ if (!skb) { -+ ret = -ENOMEM; -+ goto err_out; -+ } -+ -+ /* create the message headers */ -+ msg_header = genlmsg_put(skb, 0, 0, &nlrtw_genl_family, 0, NLRTW_CMD_REG_CHANGE); -+ if (!msg_header) { -+ ret = -ENOMEM; -+ goto err_out; -+ } -+ -+ /* add attributes */ -+ ret = nla_put_string(skb, NLRTW_ATTR_WIPHY_NAME, wiphy_name(wiphy)); -+ if (ret) -+ goto err_out; -+ -+ /* finalize the message */ -+ genlmsg_end(skb, msg_header); -+ -+ ret = nlrtw_multicast(&nlrtw_genl_family, skb, 0, NLRTW_MCGRP_DEFAULT, GFP_KERNEL); -+ if (ret == -ESRCH) { -+ RTW_DBG(FUNC_WIPHY_FMT" return -ESRCH(No such process)." -+ " Maybe no process waits for this msg\n", FUNC_WIPHY_ARG(wiphy)); -+ return ret; -+ } else if (ret != 0) { -+ RTW_WARN(FUNC_WIPHY_FMT" return %d\n", FUNC_WIPHY_ARG(wiphy), ret); -+ return ret; -+ } -+ -+ return 0; -+ -+err_out: -+ if (skb) -+ nlmsg_free(skb); -+ return ret; -+} -+ -+int rtw_nlrtw_reg_beacon_hint_event(_adapter *adapter) -+{ -+ struct sk_buff *skb = NULL; -+ void *msg_header = NULL; -+ struct wiphy *wiphy; -+ u8 i; -+ int ret; -+ -+ wiphy = adapter_to_wiphy(adapter); -+ if (!wiphy) { -+ ret = -EINVAL; -+ goto err_out; -+ } -+ -+ /* allocate memory */ -+ skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); -+ if (!skb) { -+ ret = -ENOMEM; -+ goto err_out; -+ } -+ -+ /* create the message headers */ -+ msg_header = genlmsg_put(skb, 0, 0, &nlrtw_genl_family, 0, NLRTW_CMD_REG_BEACON_HINT); -+ if (!msg_header) { -+ ret = -ENOMEM; -+ goto err_out; -+ } -+ -+ /* add attributes */ -+ ret = nla_put_string(skb, NLRTW_ATTR_WIPHY_NAME, wiphy_name(wiphy)); -+ if (ret) -+ goto err_out; -+ -+ /* finalize the message */ -+ genlmsg_end(skb, msg_header); -+ -+ ret = nlrtw_multicast(&nlrtw_genl_family, skb, 0, NLRTW_MCGRP_DEFAULT, GFP_KERNEL); -+ if (ret == -ESRCH) { -+ RTW_DBG(FUNC_WIPHY_FMT" return -ESRCH(No such process)." -+ " Maybe no process waits for this msg\n", FUNC_WIPHY_ARG(wiphy)); -+ return ret; -+ } else if (ret != 0) { -+ RTW_WARN(FUNC_WIPHY_FMT" return %d\n", FUNC_WIPHY_ARG(wiphy), ret); -+ return ret; -+ } -+ -+ return 0; -+ -+err_out: -+ if (skb) -+ nlmsg_free(skb); -+ return ret; -+} -+ -+#ifdef CONFIG_DFS_MASTER -+static int _rtw_nlrtw_radar_event(_adapter *adapter, enum nlrtw_radar_event evt_type, u8 cch, u8 bw) -+{ -+ struct sk_buff *skb = NULL; -+ void *msg_header = NULL; -+ struct wiphy *wiphy; -+ u8 i; -+ int ret; -+ -+ wiphy = adapter_to_wiphy(adapter); -+ if (!wiphy) { -+ ret = -EINVAL; -+ goto err_out; -+ } -+ -+ /* allocate memory */ -+ skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); -+ if (!skb) { -+ ret = -ENOMEM; -+ goto err_out; -+ } -+ -+ /* create the message headers */ -+ msg_header = genlmsg_put(skb, 0, 0, &nlrtw_genl_family, 0, NLRTW_CMD_RADAR_EVENT); -+ if (!msg_header) { -+ ret = -ENOMEM; -+ goto err_out; -+ } -+ -+ /* add attributes */ -+ ret = nla_put_string(skb, NLRTW_ATTR_WIPHY_NAME, wiphy_name(wiphy)); -+ if (ret) -+ goto err_out; -+ -+ ret = nla_put_u8(skb, NLRTW_ATTR_RADAR_EVENT, (uint8_t)evt_type); -+ if (ret != 0) -+ goto err_out; -+ -+ ret = nla_put_u8(skb, NLRTW_ATTR_CHANNEL_CENTER, cch); -+ if (ret != 0) -+ goto err_out; -+ -+ ret = nla_put_u8(skb, NLRTW_ATTR_CHANNEL_WIDTH, bw); -+ if (ret != 0) -+ goto err_out; -+ -+ /* finalize the message */ -+ genlmsg_end(skb, msg_header); -+ -+ ret = nlrtw_multicast(&nlrtw_genl_family, skb, 0, NLRTW_MCGRP_DEFAULT, GFP_KERNEL); -+ if (ret == -ESRCH) { -+ RTW_DBG(FUNC_WIPHY_FMT" return -ESRCH(No such process)." -+ " Maybe no process waits for this msg\n", FUNC_WIPHY_ARG(wiphy)); -+ return ret; -+ } else if (ret != 0) { -+ RTW_WARN(FUNC_WIPHY_FMT" return %d\n", FUNC_WIPHY_ARG(wiphy), ret); -+ return ret; -+ } -+ -+ return 0; -+ -+err_out: -+ if (skb) -+ nlmsg_free(skb); -+ return ret; -+} -+ -+int rtw_nlrtw_radar_detect_event(_adapter *adapter, u8 cch, u8 bw) -+{ -+ return _rtw_nlrtw_radar_event(adapter, NLRTW_RADAR_DETECTED, cch, bw); -+} -+ -+int rtw_nlrtw_cac_finish_event(_adapter *adapter, u8 cch, u8 bw) -+{ -+ return _rtw_nlrtw_radar_event(adapter, NLRTW_RADAR_CAC_FINISHED, cch, bw); -+} -+ -+int rtw_nlrtw_cac_abort_event(_adapter *adapter, u8 cch, u8 bw) -+{ -+ return _rtw_nlrtw_radar_event(adapter, NLRTW_RADAR_CAC_ABORTED, cch, bw); -+} -+ -+int rtw_nlrtw_nop_finish_event(_adapter *adapter, u8 cch, u8 bw) -+{ -+ return _rtw_nlrtw_radar_event(adapter, NLRTW_RADAR_NOP_FINISHED, cch, bw); -+} -+ -+int rtw_nlrtw_nop_start_event(_adapter *adapter, u8 cch, u8 bw) -+{ -+ return _rtw_nlrtw_radar_event(adapter, NLRTW_RADAR_NOP_STARTED, cch, bw); -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+int rtw_nlrtw_radio_opmode_notify(struct rf_ctl_t *rfctl) -+{ -+ struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); -+ _adapter *iface; -+ struct sk_buff *skb = NULL; -+ void *msg_header = NULL; -+ struct nlattr *nl_if_opmodes, *nl_if_opmode; -+ struct wiphy *wiphy; -+ u16 op_txpwr_max_u16; -+ u8 i; -+ int ret; -+ -+ wiphy = dvobj_to_wiphy(dvobj); -+ if (!wiphy) { -+ ret = -EINVAL; -+ goto err_out; -+ } -+ -+ /* allocate memory */ -+ skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); -+ if (!skb) { -+ ret = -ENOMEM; -+ goto err_out; -+ } -+ -+ /* create the message headers */ -+ msg_header = genlmsg_put(skb, 0, 0, &nlrtw_genl_family, 0, NLRTW_CMD_RADIO_OPMODE); -+ if (!msg_header) { -+ ret = -ENOBUFS; -+ goto err_out; -+ } -+ -+ /* add attributes */ -+ ret = nla_put_string(skb, NLRTW_ATTR_WIPHY_NAME, wiphy_name(wiphy)); -+ if (ret) -+ goto err_out; -+ -+ ret = nla_put_u8(skb, NLRTW_ATTR_OP_CLASS, rfctl->op_class); -+ if (ret != 0) -+ goto err_out; -+ -+ ret = nla_put_u8(skb, NLRTW_ATTR_OP_CHANNEL, rfctl->op_ch); -+ if (ret != 0) -+ goto err_out; -+ -+ *((s16 *)&op_txpwr_max_u16) = rfctl->op_txpwr_max; -+ ret = nla_put_u16(skb, NLRTW_ATTR_OP_TXPWR_MAX, op_txpwr_max_u16); -+ if (ret != 0) -+ goto err_out; -+ -+ if (0) -+ RTW_INFO("radio: %u,%u %d\n", rfctl->op_class, rfctl->op_ch, rfctl->op_txpwr_max); -+ -+ nl_if_opmodes = nla_nest_start(skb, NLRTW_ATTR_IF_OPMODES); -+ if (!nl_if_opmodes) { -+ ret = -ENOBUFS; -+ goto err_out; -+ } -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!dvobj->padapters[i]) -+ continue; -+ iface = dvobj->padapters[i]; -+ -+ if (!rfctl->if_op_class[i] || !rfctl->if_op_ch[i]) -+ continue; -+ -+ if (0) -+ RTW_INFO(ADPT_FMT": %u,%u\n", ADPT_ARG(iface), rfctl->if_op_class[i], rfctl->if_op_ch[i]); -+ -+ nl_if_opmode = nla_nest_start(skb, i + 1); -+ if (!nl_if_opmode) { -+ ret = -ENOBUFS; -+ goto err_out; -+ } -+ -+ ret = nla_put(skb, NLRTW_IF_OPMODE_MACADDR, ETH_ALEN, adapter_mac_addr(iface)); -+ if (ret != 0) -+ goto err_out; -+ -+ ret = nla_put_u8(skb, NLRTW_IF_OPMODE_OP_CLASS, rfctl->if_op_class[i]); -+ if (ret != 0) -+ goto err_out; -+ -+ ret = nla_put_u8(skb, NLRTW_IF_OPMODE_OP_CHANNEL, rfctl->if_op_ch[i]); -+ if (ret != 0) -+ goto err_out; -+ -+ nla_nest_end(skb, nl_if_opmode); -+ } -+ -+ nla_nest_end(skb, nl_if_opmodes); -+ -+ /* finalize the message */ -+ genlmsg_end(skb, msg_header); -+ -+ ret = nlrtw_multicast(&nlrtw_genl_family, skb, 0, NLRTW_MCGRP_DEFAULT, GFP_KERNEL); -+ if (ret == -ESRCH) { -+ RTW_DBG(FUNC_WIPHY_FMT" return -ESRCH(No such process)." -+ " Maybe no process waits for this msg\n", FUNC_WIPHY_ARG(wiphy)); -+ return ret; -+ } else if (ret != 0) { -+ RTW_WARN(FUNC_WIPHY_FMT" return %d\n", FUNC_WIPHY_ARG(wiphy), ret); -+ return ret; -+ } -+ -+ return 0; -+ -+err_out: -+ if (skb) -+ nlmsg_free(skb); -+ return ret; -+} -+ -+int rtw_nlrtw_init(void) -+{ -+ int err; -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0) -+ err = genl_register_family(&nlrtw_genl_family); -+ if (err) -+ return err; -+#else -+ err = genl_register_family_with_ops(&nlrtw_genl_family, nlrtw_genl_ops, ARRAY_SIZE(nlrtw_genl_ops)); -+ if (err) -+ return err; -+ -+ err = genl_register_mc_group(&nlrtw_genl_family, &nlrtw_genl_mcgrp[0]); -+ if (err) { -+ genl_unregister_family(&nlrtw_genl_family); -+ return err; -+ } -+#endif -+ RTW_INFO("[%s] %s\n", __func__, nlrtw_genl_family.name); -+ return 0; -+} -+ -+int rtw_nlrtw_deinit(void) -+{ -+ int err; -+ -+ err = genl_unregister_family(&nlrtw_genl_family); -+ RTW_INFO("[%s] err = %d\n", __func__, err); -+ -+ return err; -+} -+#endif /* CONFIG_RTW_NLRTW */ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/nlrtw.h b/drivers/net/wireless/rtl8821cs/os_dep/linux/nlrtw.h -new file mode 100644 -index 000000000..374002a8a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/nlrtw.h -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2020 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_NLRTW_H_ -+#define __RTW_NLRTW_H_ -+ -+#ifdef CONFIG_RTW_NLRTW -+int rtw_nlrtw_init(void); -+int rtw_nlrtw_deinit(void); -+int rtw_nlrtw_ch_util_rpt(_adapter *adapter, u8 n_rpts, u8 *val, u8 **mac_addr); -+int rtw_nlrtw_reg_change_event(_adapter *adapter); -+int rtw_nlrtw_reg_beacon_hint_event(_adapter *adapter); -+int rtw_nlrtw_radio_opmode_notify(struct rf_ctl_t *rfctl); -+#else -+static inline int rtw_nlrtw_init(void) {return _FAIL;} -+static inline int rtw_nlrtw_deinit(void) {return _FAIL;} -+static inline int rtw_nlrtw_ch_util_rpt(_adapter *adapter, u8 n_rpts, u8 *val, u8 **mac_addr) {return _FAIL;} -+static inline int rtw_nlrtw_reg_change_event(_adapter *adapter) {return _FAIL;} -+static inline int rtw_nlrtw_reg_beacon_hint_event(_adapter *adapter) {return _FAIL;} -+static inline int rtw_nlrtw_radio_opmode_notify(struct rf_ctl_t *rfctl) {return _FAIL;} -+#endif /* CONFIG_RTW_NLRTW */ -+ -+#if defined(CONFIG_RTW_NLRTW) && defined(CONFIG_DFS_MASTER) -+int rtw_nlrtw_radar_detect_event(_adapter *adapter, u8 cch, u8 bw); -+int rtw_nlrtw_cac_finish_event(_adapter *adapter, u8 cch, u8 bw); -+int rtw_nlrtw_cac_abort_event(_adapter *adapter, u8 cch, u8 bw); -+int rtw_nlrtw_nop_finish_event(_adapter *adapter, u8 cch, u8 bw); -+int rtw_nlrtw_nop_start_event(_adapter *adapter, u8 cch, u8 bw); -+#else -+static inline int rtw_nlrtw_radar_detect_event(_adapter *adapter, u8 cch, u8 bw) {return _FAIL;} -+static inline int rtw_nlrtw_cac_finish_event(_adapter *adapter, u8 cch, u8 bw) {return _FAIL;} -+static inline int rtw_nlrtw_cac_abort_event(_adapter *adapter, u8 cch, u8 bw) {return _FAIL;} -+static inline int rtw_nlrtw_nop_finish_event(_adapter *adapter, u8 cch, u8 bw) {return _FAIL;} -+static inline int rtw_nlrtw_nop_start_event(_adapter *adapter, u8 cch, u8 bw) {return _FAIL;} -+#endif /* defined(CONFIG_RTW_NLRTW) && defined(CONFIG_DFS_MASTER) */ -+ -+#endif /* __RTW_NLRTW_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/os_intfs.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/os_intfs.c -new file mode 100755 -index 000000000..3f03174af ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/os_intfs.c -@@ -0,0 +1,5833 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+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; */ -+#ifdef DBG_LA_MODE -+int rtw_la_mode_en=0; -+module_param(rtw_la_mode_en, int, 0644); -+#endif -+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; -+module_param(rtw_wireless_mode, int, 0644); -+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 smart_ps = 1; */ -+#ifdef CONFIG_POWER_SAVING -+ /* IPS configuration */ -+ int rtw_ips_mode = RTW_IPS_MODE; -+ -+ /* LPS configuration */ -+/* RTW_LPS_MODE=0:disable, 1:LPS , 2:LPS with clock gating, 3: power gating */ -+#if (RTW_LPS_MODE > 0) -+ int rtw_power_mgnt = PS_MODE_MAX; -+ -+ #ifdef CONFIG_USB_HCI -+ int rtw_lps_level = LPS_NORMAL; /*USB default LPS level*/ -+ #else /*SDIO,PCIE*/ -+ int rtw_lps_level = (RTW_LPS_MODE - 1); -+ #endif/*CONFIG_USB_HCI*/ -+#else -+ int rtw_power_mgnt = PS_MODE_ACTIVE; -+ int rtw_lps_level = LPS_NORMAL; -+#endif -+ -+ int rtw_lps_chk_by_tp = 1; -+ -+ /* WOW LPS configuration */ -+#ifdef CONFIG_WOWLAN -+/* RTW_WOW_LPS_MODE=0:disable, 1:LPS , 2:LPS with clock gating, 3: power gating */ -+#if (RTW_WOW_LPS_MODE > 0) -+ int rtw_wow_power_mgnt = PS_MODE_MAX; -+ int rtw_wow_lps_level = (RTW_WOW_LPS_MODE - 1); -+#else -+ int rtw_wow_power_mgnt = PS_MODE_ACTIVE; -+ int rtw_wow_lps_level = LPS_NORMAL; -+#endif -+#endif /* CONFIG_WOWLAN */ -+ -+#else /* !CONFIG_POWER_SAVING */ -+ int rtw_ips_mode = IPS_NONE; -+ int rtw_power_mgnt = PS_MODE_ACTIVE; -+ int rtw_lps_level = LPS_NORMAL; -+ int rtw_lps_chk_by_tp = 0; -+#ifdef CONFIG_WOWLAN -+ int rtw_wow_power_mgnt = PS_MODE_ACTIVE; -+ int rtw_wow_lps_level = LPS_NORMAL; -+#endif /* CONFIG_WOWLAN */ -+#endif /* CONFIG_POWER_SAVING */ -+ -+#ifdef CONFIG_NARROWBAND_SUPPORTING -+int rtw_nb_config = CONFIG_NB_VALUE; -+module_param(rtw_nb_config, int, 0644); -+MODULE_PARM_DESC(rtw_nb_config, "5M/10M/Normal bandwidth configuration"); -+#endif -+ -+module_param(rtw_ips_mode, int, 0644); -+MODULE_PARM_DESC(rtw_ips_mode, "The default IPS mode"); -+ -+module_param(rtw_lps_level, int, 0644); -+MODULE_PARM_DESC(rtw_lps_level, "The default LPS level"); -+ -+#ifdef CONFIG_LPS_1T1R -+int rtw_lps_1t1r = RTW_LPS_1T1R; -+module_param(rtw_lps_1t1r, int, 0644); -+MODULE_PARM_DESC(rtw_lps_1t1r, "The default LPS 1T1R setting"); -+#endif -+ -+module_param(rtw_lps_chk_by_tp, int, 0644); -+ -+#ifdef CONFIG_WOWLAN -+module_param(rtw_wow_power_mgnt, int, 0644); -+MODULE_PARM_DESC(rtw_wow_power_mgnt, "The default WOW LPS mode"); -+module_param(rtw_wow_lps_level, int, 0644); -+MODULE_PARM_DESC(rtw_wow_lps_level, "The default WOW LPS level"); -+#ifdef CONFIG_LPS_1T1R -+int rtw_wow_lps_1t1r = RTW_WOW_LPS_1T1R; -+module_param(rtw_wow_lps_1t1r, int, 0644); -+MODULE_PARM_DESC(rtw_wow_lps_1t1r, "The default WOW LPS 1T1R setting"); -+#endif -+#endif /* CONFIG_WOWLAN */ -+ -+/* LPS: -+ * rtw_smart_ps = 0 => TX: pwr bit = 1, RX: PS_Poll -+ * rtw_smart_ps = 1 => TX: pwr bit = 0, RX: PS_Poll -+ * rtw_smart_ps = 2 => TX: pwr bit = 0, RX: NullData with pwr bit = 0 -+*/ -+int rtw_smart_ps = 2; -+ -+int rtw_max_bss_cnt = 0; -+module_param(rtw_max_bss_cnt, int, 0644); -+#ifdef CONFIG_WMMPS_STA -+/* WMMPS: -+ * rtw_smart_ps = 0 => Only for fw test -+ * rtw_smart_ps = 1 => Refer to Beacon's TIM Bitmap -+ * rtw_smart_ps = 2 => Don't refer to Beacon's TIM Bitmap -+*/ -+int rtw_wmm_smart_ps = 2; -+#endif /* CONFIG_WMMPS_STA */ -+ -+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); -+ -+int rtw_dynamic_agg_enable = 1; -+module_param(rtw_dynamic_agg_enable, 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 CONFIG_RTW_DEBUG -+#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"); -+#endif -+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. */ -+ -+#ifdef CONFIG_WMMPS_STA -+/* uapsd (unscheduled automatic power-save delivery) = a kind of wmmps */ -+/* 0: NO_LIMIT, 1: TWO_MSDU, 2: FOUR_MSDU, 3: SIX_MSDU */ -+int rtw_uapsd_max_sp = NO_LIMIT; -+/* BIT0: AC_VO UAPSD, BIT1: AC_VI UAPSD, BIT2: AC_BK UAPSD, BIT3: AC_BE UAPSD */ -+int rtw_uapsd_ac_enable = 0x0; -+#endif /* CONFIG_WMMPS_STA */ -+ -+#if defined(CONFIG_RTL8814A) -+ int rtw_pwrtrim_enable = 2; /* disable kfree , rename to power trim disable */ -+#elif defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C) \ -+ || defined(CONFIG_RTL8723F) -+ /*PHYDM API, must enable by default*/ -+ int rtw_pwrtrim_enable = 1; -+#else -+ int rtw_pwrtrim_enable = 0; /* Default Enalbe power trim by efuse config */ -+#endif -+ -+#if CONFIG_TX_AC_LIFETIME -+uint rtw_tx_aclt_flags = CONFIG_TX_ACLT_FLAGS; -+module_param(rtw_tx_aclt_flags, uint, 0644); -+MODULE_PARM_DESC(rtw_tx_aclt_flags, "device TX AC queue packet lifetime control flags"); -+ -+static uint rtw_tx_aclt_conf_default[3] = CONFIG_TX_ACLT_CONF_DEFAULT; -+static uint rtw_tx_aclt_conf_default_num = 0; -+module_param_array(rtw_tx_aclt_conf_default, uint, &rtw_tx_aclt_conf_default_num, 0644); -+MODULE_PARM_DESC(rtw_tx_aclt_conf_default, "device TX AC queue lifetime config for default status"); -+ -+#ifdef CONFIG_AP_MODE -+#if CONFIG_RTW_AP_DATA_BMC_TO_UC -+static uint rtw_tx_aclt_conf_ap_m2u[3] = CONFIG_TX_ACLT_CONF_AP_M2U; -+static uint rtw_tx_aclt_conf_ap_m2u_num = 0; -+module_param_array(rtw_tx_aclt_conf_ap_m2u, uint, &rtw_tx_aclt_conf_ap_m2u_num, 0644); -+MODULE_PARM_DESC(rtw_tx_aclt_conf_ap_m2u, "device TX AC queue lifetime config for AP mode M2U status"); -+#endif -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_RTW_MESH -+static uint rtw_tx_aclt_conf_mesh[3] = CONFIG_TX_ACLT_CONF_MESH; -+static uint rtw_tx_aclt_conf_mesh_num = 0; -+module_param_array(rtw_tx_aclt_conf_mesh, uint, &rtw_tx_aclt_conf_mesh_num, 0644); -+MODULE_PARM_DESC(rtw_tx_aclt_conf_mesh, "device TX AC queue lifetime config for MESH status"); -+#endif -+#endif /* CONFIG_TX_AC_LIFETIME */ -+ -+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_FW_HANDLE_TXBCN -+uint rtw_tbtt_rpt = 0; /*ROOT AP - BIT0, VAP1 - BIT1, VAP2 - BIT2, VAP3 - VAP3, FW report TBTT INT by C2H*/ -+module_param(rtw_tbtt_rpt, uint, 0644); -+#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 */ -+#ifdef CONFIG_RTW_CUSTOMIZE_BWMODE -+int rtw_bw_mode = CONFIG_RTW_CUSTOMIZE_BWMODE; -+#else -+int rtw_bw_mode = 0x21; -+#endif -+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 */ -+#if (defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8814B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C)) && defined(CONFIG_PCI_HCI) -+int rtw_rx_ampdu_amsdu = 2;/* 0: disabled, 1:enabled, 2:auto . There is an IOT issu with DLINK DIR-629 when the flag turn on */ -+#elif ((defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C)) && defined(CONFIG_SDIO_HCI)) -+int rtw_rx_ampdu_amsdu = 1; -+#else -+int rtw_rx_ampdu_amsdu;/* 0: disabled, 1:enabled, 2:auto . There is an IOT issu with DLINK DIR-629 when the flag turn on */ -+#endif -+/* -+* 2: Follow the AMSDU filed in ADDBA Resp. (Deault) -+* 0: Force the AMSDU filed in ADDBA Resp. to be disabled. -+* 1: Force the AMSDU filed in ADDBA Resp. to be enabled. -+*/ -+int rtw_tx_ampdu_amsdu = 2; -+ -+int rtw_quick_addba_req = 0; -+ -+static uint rtw_rx_ampdu_sz_limit_1ss[4] = CONFIG_RTW_RX_AMPDU_SZ_LIMIT_1SS; -+static uint rtw_rx_ampdu_sz_limit_1ss_num = 0; -+module_param_array(rtw_rx_ampdu_sz_limit_1ss, uint, &rtw_rx_ampdu_sz_limit_1ss_num, 0644); -+MODULE_PARM_DESC(rtw_rx_ampdu_sz_limit_1ss, "RX AMPDU size limit for 1SS link of each BW, 0xFF: no limitation"); -+ -+static uint rtw_rx_ampdu_sz_limit_2ss[4] = CONFIG_RTW_RX_AMPDU_SZ_LIMIT_2SS; -+static uint rtw_rx_ampdu_sz_limit_2ss_num = 0; -+module_param_array(rtw_rx_ampdu_sz_limit_2ss, uint, &rtw_rx_ampdu_sz_limit_2ss_num, 0644); -+MODULE_PARM_DESC(rtw_rx_ampdu_sz_limit_2ss, "RX AMPDU size limit for 2SS link of each BW, 0xFF: no limitation"); -+ -+static uint rtw_rx_ampdu_sz_limit_3ss[4] = CONFIG_RTW_RX_AMPDU_SZ_LIMIT_3SS; -+static uint rtw_rx_ampdu_sz_limit_3ss_num = 0; -+module_param_array(rtw_rx_ampdu_sz_limit_3ss, uint, &rtw_rx_ampdu_sz_limit_3ss_num, 0644); -+MODULE_PARM_DESC(rtw_rx_ampdu_sz_limit_3ss, "RX AMPDU size limit for 3SS link of each BW, 0xFF: no limitation"); -+ -+static uint rtw_rx_ampdu_sz_limit_4ss[4] = CONFIG_RTW_RX_AMPDU_SZ_LIMIT_4SS; -+static uint rtw_rx_ampdu_sz_limit_4ss_num = 0; -+module_param_array(rtw_rx_ampdu_sz_limit_4ss, uint, &rtw_rx_ampdu_sz_limit_4ss_num, 0644); -+MODULE_PARM_DESC(rtw_rx_ampdu_sz_limit_4ss, "RX AMPDU size limit for 4SS link of each BW, 0xFF: no limitation"); -+ -+/* 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 */ -+#ifdef CONFIG_RTL8192F -+int rtw_stbc_cap = 0x30; -+#else -+int rtw_stbc_cap = 0x13; -+#endif -+module_param(rtw_stbc_cap, int, 0644); -+/* -+* 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 */ -+module_param(rtw_vht_enable, int, 0644); -+ -+int rtw_vht_24g_enable = 1; /* 0:disable, 1:enable */ -+module_param(rtw_vht_24g_enable, int, 0644); -+ -+int rtw_ampdu_factor = 7; -+ -+uint rtw_vht_rx_mcs_map = 0xaaaa; -+module_param(rtw_vht_rx_mcs_map, uint, 0644); -+MODULE_PARM_DESC(rtw_vht_rx_mcs_map, "VHT RX MCS map"); -+#endif /* CONFIG_80211AC_VHT */ -+ -+ -+/* 0: not check in watch dog, 1: check in watch dog */ -+int rtw_check_hw_status = 0; -+ -+int rtw_low_power = 0; -+int rtw_wifi_spec = 0; -+ -+ -+int rtw_trx_path_bmp = 0x00; -+module_param(rtw_trx_path_bmp, int, 0644); /* [7:4]TX path bmp, [0:3]RX path bmp, 0: not specified */ -+ -+#ifdef CONFIG_SPECIAL_RF_PATH /* configure Nss/xTxR IC to 1ss/1T1R */ -+int rtw_tx_path_lmt = 1; -+int rtw_rx_path_lmt = 1; -+int rtw_tx_nss = 1; -+int rtw_rx_nss = 1; -+#elif defined(CONFIG_CUSTOMER01_SMART_ANTENNA) -+int rtw_tx_path_lmt = 2; -+int rtw_rx_path_lmt = 2; -+int rtw_tx_nss = 1; -+int rtw_rx_nss = 1; -+#else -+int rtw_tx_path_lmt = 0; -+int rtw_rx_path_lmt = 0; -+int rtw_tx_nss = 0; -+int rtw_rx_nss = 0; -+#endif -+module_param(rtw_tx_path_lmt, int, 0644); /* limit of TX path number, 0: not specified */ -+module_param(rtw_rx_path_lmt, int, 0644); /* limit of RX path number, 0: not specified */ -+module_param(rtw_tx_nss, int, 0644); -+module_param(rtw_rx_nss, int, 0644); -+ -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+int rtw_active_tpc_report = CONFIG_RTW_ACTIVE_TPC_REPORT; -+module_param(rtw_active_tpc_report, int, 0644); -+MODULE_PARM_DESC(rtw_active_tpc_report, "Active TPC report, 0:incapable, 1:capable, 2:auto enable"); -+#endif -+ -+#ifdef CONFIG_REGD_SRC_FROM_OS -+static uint rtw_regd_src = CONFIG_RTW_REGD_SRC; -+module_param(rtw_regd_src, uint, 0644); -+MODULE_PARM_DESC(rtw_regd_src, "The default regd source selection, 0:Realtek defined, 1: OS"); -+#endif -+ -+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)"); -+ -+uint rtw_channel_plan = CONFIG_RTW_CHPLAN; -+module_param(rtw_channel_plan, uint, 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_2G_5G] = 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 CONFIG_IEEE80211_BAND_6GHZ -+uint rtw_channel_plan_6g = CONFIG_RTW_CHPLAN_6G; -+module_param(rtw_channel_plan_6g, uint, 0644); -+MODULE_PARM_DESC(rtw_channel_plan_6g, "The default chplan_6g ID when rtw_alpha2 is not specified or valid"); -+ -+static uint rtw_excl_chs_6g[MAX_CHANNEL_NUM_6G] = CONFIG_RTW_EXCL_CHS_6G; -+static int rtw_excl_chs_6g_num = 0; -+module_param_array(rtw_excl_chs_6g, uint, &rtw_excl_chs_6g_num, 0644); -+MODULE_PARM_DESC(rtw_excl_chs_6g, "exclusive channel array"); -+#endif /* CONFIG_IEEE80211_BAND_6GHZ */ -+ -+#ifdef CONFIG_80211D -+static uint rtw_country_ie_slave_en_role = CONFIG_RTW_COUNTRY_IE_SLAVE_EN_ROLE; -+module_param(rtw_country_ie_slave_en_role, uint, 0644); -+MODULE_PARM_DESC(rtw_country_ie_slave_en_role, "802.11d country IE slave enable role: BIT0:pure STA mode, BIT1:P2P group client"); -+ -+static uint rtw_country_ie_slave_en_ifbmp = CONFIG_RTW_COUNTRY_IE_SLAVE_EN_IFBMP; -+module_param(rtw_country_ie_slave_en_ifbmp, uint, 0644); -+MODULE_PARM_DESC(rtw_country_ie_slave_en_ifbmp, "802.11d country IE slave enable iface bitmap"); -+#endif -+ -+/*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*/ -+ -+int rtw_single_ant_path; /*0:main ant , 1:aux ant , Fixed single antenna path, default main ant*/ -+ -+/* 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_PCI_ASPM -+/* CLK_REQ:BIT0 L0s:BIT1 ASPM_L1:BIT2 L1Off:BIT3*/ -+int rtw_pci_aspm_enable = 0x5; -+#else -+int rtw_pci_aspm_enable; -+#endif -+ -+/* -+ * BIT [15:12] mask of ps mode -+ * BIT [11:8] val of ps mode -+ * BIT [7:4] mask of perf mode -+ * BIT [3:0] val of perf mode -+ * -+ * L0s:BIT[+0] L1:BIT[+1] -+ * -+ * 0x0030: change value only if perf mode -+ * 0x3300: change value only if ps mode -+ * 0x3330: change value in both perf and ps mode -+ */ -+#ifdef CONFIG_PCI_DYNAMIC_ASPM -+#ifdef CONFIG_PCI_ASPM -+int rtw_pci_dynamic_aspm_linkctrl = 0x3330; -+#else -+int rtw_pci_dynamic_aspm_linkctrl = 0x0030; -+#endif -+#else -+int rtw_pci_dynamic_aspm_linkctrl = 0x0000; -+#endif -+module_param(rtw_pci_dynamic_aspm_linkctrl, int, 0644); -+ -+#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_RTW_ACS -+int rtw_acs_auto_scan = 0; /*0:disable, 1:enable*/ -+module_param(rtw_acs_auto_scan, int, 0644); -+ -+int rtw_acs = 1; -+module_param(rtw_acs, int, 0644); -+#endif -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+int rtw_nm = 1;/*noise monitor*/ -+module_param(rtw_nm, 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 -+ -+#ifdef CONFIG_P2P -+ -+ #ifdef CONFIG_SEL_P2P_IFACE -+ int rtw_sel_p2p_iface = CONFIG_SEL_P2P_IFACE; -+ #else -+ int rtw_sel_p2p_iface = IFACE_ID1; -+ #endif -+ -+ module_param(rtw_sel_p2p_iface, int, 0644); -+ -+#endif -+ -+#endif -+ -+#ifdef CONFIG_AP_MODE -+u8 rtw_bmc_tx_rate = MGN_UNKNOWN; -+ -+#if CONFIG_RTW_AP_DATA_BMC_TO_UC -+int rtw_ap_src_b2u_flags = CONFIG_RTW_AP_SRC_B2U_FLAGS; -+module_param(rtw_ap_src_b2u_flags, int, 0644); -+ -+int rtw_ap_fwd_b2u_flags = CONFIG_RTW_AP_FWD_B2U_FLAGS; -+module_param(rtw_ap_fwd_b2u_flags, int, 0644); -+#endif /* CONFIG_RTW_AP_DATA_BMC_TO_UC */ -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_RTW_MESH -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+int rtw_msrc_b2u_flags = CONFIG_RTW_MSRC_B2U_FLAGS; -+module_param(rtw_msrc_b2u_flags, int, 0644); -+ -+int rtw_mfwd_b2u_flags = CONFIG_RTW_MFWD_B2U_FLAGS; -+module_param(rtw_mfwd_b2u_flags, int, 0644); -+#endif /* CONFIG_RTW_MESH_DATA_BMC_TO_UC */ -+#endif /* CONFIG_RTW_MESH */ -+ -+#ifdef RTW_WOW_STA_MIX -+int rtw_wowlan_sta_mix_mode = 1; -+#else -+int rtw_wowlan_sta_mix_mode = 0; -+#endif -+module_param(rtw_wowlan_sta_mix_mode, int, 0644); -+module_param(rtw_pwrtrim_enable, int, 0644); -+module_param(rtw_initmac, charp, 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); -+#ifdef CONFIG_WMMPS_STA -+module_param(rtw_uapsd_max_sp, int, 0644); -+module_param(rtw_uapsd_ac_enable, int, 0644); -+module_param(rtw_wmm_smart_ps, int, 0644); -+#endif /* CONFIG_WMMPS_STA */ -+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_rx_ampdu_amsdu, int, 0644); -+module_param(rtw_tx_ampdu_amsdu, int, 0644); -+module_param(rtw_quick_addba_req, int, 0644); -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_BEAMFORMING -+module_param(rtw_beamform_cap, int, 0644); -+#endif -+ -+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_single_ant_path, 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_PCI_HCI -+module_param(rtw_pci_aspm_enable, int, 0644); -+#endif -+ -+#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_ADVANCE_OTA -+/* BIT(0): OTA continuous rotated test within low RSSI,1R CCA in path B -+ BIT(1) & BIT(2): OTA continuous rotated test with low high RSSI */ -+/* Experimental environment: shielding room with half of absorber and 2~3 rotation per minute */ -+int rtw_advnace_ota; -+module_param(rtw_advnace_ota, int, 0644); -+#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, 2:auto"); -+ -+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"); -+ -+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, "0:NONE, 1:FCC, 2:MKK, 3:ETSI"); -+#endif -+ -+uint rtw_amsdu_mode = RTW_AMSDU_MODE_NON_SPP; -+module_param(rtw_amsdu_mode, uint, 0644); -+MODULE_PARM_DESC(rtw_amsdu_mode, "0:non-spp, 1:spp, 2:all drop"); -+ -+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"); -+ -+#if CONFIG_TXPWR_LIMIT -+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"); -+#endif -+ -+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"); -+ -+#if 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 */ -+ -+int rtw_antenna_gain = CONFIG_RTW_ANTENNA_GAIN; -+module_param(rtw_antenna_gain, int, 0644); -+MODULE_PARM_DESC(rtw_antenna_gain, "Antenna gain in mBi. 0x7FFF: unspecifed"); -+ -+#ifdef CONFIG_RTW_TX_NPATH_EN -+/*0:disable ,1: 2path*/ -+int rtw_tx_npath_enable = 1; -+module_param(rtw_tx_npath_enable, int, 0644); -+MODULE_PARM_DESC(rtw_tx_npath_enable, "0:Disable, 1:TX-2PATH"); -+#endif -+ -+#ifdef CONFIG_RTW_PATH_DIV -+/*0:disable ,1: path diversity*/ -+int rtw_path_div_enable = 1; -+module_param(rtw_path_div_enable, int, 0644); -+MODULE_PARM_DESC(rtw_path_div_enable, "0:Disable, 1:Enable path diversity"); -+#endif -+ -+ -+int rtw_tsf_update_pause_factor = CONFIG_TSF_UPDATE_PAUSE_FACTOR; -+module_param(rtw_tsf_update_pause_factor, int, 0644); -+MODULE_PARM_DESC(rtw_tsf_update_pause_factor, "num of bcn intervals to stay TSF update pause status"); -+ -+int rtw_tsf_update_restore_factor = CONFIG_TSF_UPDATE_RESTORE_FACTOR; -+module_param(rtw_tsf_update_restore_factor, int, 0644); -+MODULE_PARM_DESC(rtw_tsf_update_restore_factor, "num of bcn intervals to stay TSF update restore status"); -+ -+#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 -+ -+uint rtw_recvbuf_nr = NR_RECVBUFF; -+module_param(rtw_recvbuf_nr, int, 0644); -+MODULE_PARM_DESC(rtw_recvbuf_nr, "Preallocated number of struct recv_buf"); -+ -+#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 -+ -+#ifdef CONFIG_DYNAMIC_SOML -+uint rtw_dynamic_soml_en = 1; -+module_param(rtw_dynamic_soml_en, int, 0644); -+MODULE_PARM_DESC(rtw_dynamic_soml_en, "0: disable, 1: enable with default param, 2: enable with specified param."); -+ -+uint rtw_dynamic_soml_train_num = 0; -+module_param(rtw_dynamic_soml_train_num, int, 0644); -+MODULE_PARM_DESC(rtw_dynamic_soml_train_num, "SOML training number"); -+ -+uint rtw_dynamic_soml_interval = 0; -+module_param(rtw_dynamic_soml_interval, int, 0644); -+MODULE_PARM_DESC(rtw_dynamic_soml_interval, "SOML training interval"); -+ -+uint rtw_dynamic_soml_period = 0; -+module_param(rtw_dynamic_soml_period, int, 0644); -+MODULE_PARM_DESC(rtw_dynamic_soml_period, "SOML training period"); -+ -+uint rtw_dynamic_soml_delay = 0; -+module_param(rtw_dynamic_soml_delay, int, 0644); -+MODULE_PARM_DESC(rtw_dynamic_soml_delay, "SOML training delay"); -+#endif -+ -+uint rtw_phydm_ability = 0xffffffff; -+module_param(rtw_phydm_ability, uint, 0644); -+ -+uint rtw_halrf_ability = 0xffffffff; -+module_param(rtw_halrf_ability, uint, 0644); -+ -+#ifdef CONFIG_RTW_MESH -+uint rtw_peer_alive_based_preq = 1; -+module_param(rtw_peer_alive_based_preq, uint, 0644); -+MODULE_PARM_DESC(rtw_peer_alive_based_preq, -+ "On demand PREQ will reference peer alive status. 0: Off, 1: On"); -+#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; -+int rtw_mcc_policy_table_idx = 0; -+int rtw_mcc_duration = 0; -+int rtw_mcc_enable_runtime_duration = 1; -+#ifdef CONFIG_MCC_PHYDM_OFFLOAD -+int rtw_mcc_phydm_offload = 1; -+#else -+int rtw_mcc_phydm_offload = 0; -+#endif -+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); -+module_param(rtw_mcc_policy_table_idx, int, 0644); -+module_param(rtw_mcc_duration, int, 0644); -+module_param(rtw_mcc_phydm_offload, 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_NAPI_DYNAMIC -+int rtw_napi_threshold = 100; /* unit: Mbps */ -+module_param(rtw_napi_threshold, int, 0644); -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+#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 */ -+ -+#ifdef RTW_IQK_FW_OFFLOAD -+int rtw_iqk_fw_offload = 1; -+#else -+int rtw_iqk_fw_offload; -+#endif /* RTW_IQK_FW_OFFLOAD */ -+module_param(rtw_iqk_fw_offload, int, 0644); -+ -+#ifdef RTW_CHANNEL_SWITCH_OFFLOAD -+int rtw_ch_switch_offload = 0; -+#else -+int rtw_ch_switch_offload; -+#endif /* RTW_CHANNEL_SWITCH_OFFLOAD */ -+module_param(rtw_ch_switch_offload, int, 0644); -+ -+#ifdef CONFIG_TDLS -+int rtw_en_tdls = 1; -+module_param(rtw_en_tdls, int, 0644); -+#endif -+ -+#ifdef CONFIG_FW_OFFLOAD_PARAM_INIT -+int rtw_fw_param_init = 1; -+module_param(rtw_fw_param_init, int, 0644); -+#endif -+ -+#ifdef CONFIG_TDMADIG -+int rtw_tdmadig_en = 1; -+/* -+1:MODE_PERFORMANCE -+2:MODE_COVERAGE -+*/ -+int rtw_tdmadig_mode = 1; -+int rtw_dynamic_tdmadig = 0; -+module_param(rtw_tdmadig_en, int, 0644); -+module_param(rtw_tdmadig_mode, int, 0644); -+module_param(rtw_dynamic_tdmadig, int, 0644); -+#endif/*CONFIG_TDMADIG*/ -+ -+/*dynamic RRSR default enable*/ -+int rtw_en_dyn_rrsr = 1; -+int rtw_rrsr_value = 0xFFFFFFFF; -+module_param(rtw_en_dyn_rrsr, int, 0644); -+module_param(rtw_rrsr_value, int, 0644); -+ -+#ifdef CONFIG_WOWLAN -+/* -+ * 0: disable, 1: enable -+ */ -+uint rtw_wow_enable = 1; -+module_param(rtw_wow_enable, uint, 0644); -+/* -+ * bit[0]: magic packet wake up -+ * bit[1]: unucast packet(HW/FW unuicast) -+ * bit[2]: deauth wake up -+ */ -+uint rtw_wakeup_event = RTW_WAKEUP_EVENT; -+module_param(rtw_wakeup_event, uint, 0644); -+/* -+ * 0: common WOWLAN -+ * bit[0]: disable BB RF -+ * bit[1]: For wireless remote controller with or without connection -+ */ -+uint rtw_suspend_type = RTW_SUSPEND_TYPE; -+module_param(rtw_suspend_type, uint, 0644); -+#endif -+ -+#ifdef RTW_BUSY_DENY_SCAN -+uint rtw_scan_interval_thr = BUSY_TRAFFIC_SCAN_DENY_PERIOD; -+module_param(rtw_scan_interval_thr, uint, 0644); -+MODULE_PARM_DESC(rtw_scan_interval_thr, "Threshold used to judge if scan " \ -+ "request comes from scan UI, unit is ms."); -+#endif /* RTW_BUSY_DENY_SCAN */ -+ -+#ifdef CONFIG_RTL8822C_XCAP_NEW_POLICY -+uint rtw_8822c_xcap_overwrite = 1; -+module_param(rtw_8822c_xcap_overwrite, uint, 0644); -+#endif -+ -+#ifdef CONFIG_RTW_MULTI_AP -+static int rtw_unassoc_sta_mode_of_stype[UNASOC_STA_SRC_NUM] = CONFIG_RTW_UNASOC_STA_MODE_OF_STYPE; -+static int rtw_unassoc_sta_mode_of_stype_num = 0; -+module_param_array(rtw_unassoc_sta_mode_of_stype, int, &rtw_unassoc_sta_mode_of_stype_num, 0644); -+ -+uint rtw_max_unassoc_sta_cnt = 0; -+module_param(rtw_max_unassoc_sta_cnt, uint, 0644); -+#endif -+ -+#if CONFIG_TX_AC_LIFETIME -+static void rtw_regsty_load_tx_ac_lifetime(struct registry_priv *regsty) -+{ -+ int i, j; -+ struct tx_aclt_conf_t *conf; -+ uint *parm; -+ -+ regsty->tx_aclt_flags = (u8)rtw_tx_aclt_flags; -+ -+ for (i = 0; i < TX_ACLT_CONF_NUM; i++) { -+ conf = ®sty->tx_aclt_confs[i]; -+ if (i == TX_ACLT_CONF_DEFAULT) -+ parm = rtw_tx_aclt_conf_default; -+ #ifdef CONFIG_AP_MODE -+ #if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ else if (i == TX_ACLT_CONF_AP_M2U) -+ parm = rtw_tx_aclt_conf_ap_m2u; -+ #endif -+ #endif /* CONFIG_AP_MODE */ -+ #ifdef CONFIG_RTW_MESH -+ else if (i == TX_ACLT_CONF_MESH) -+ parm = rtw_tx_aclt_conf_mesh; -+ #endif -+ else -+ parm = NULL; -+ -+ if (parm) { -+ conf->en = parm[0] & 0xF; -+ conf->vo_vi = parm[1]; -+ conf->be_bk = parm[2]; -+ } -+ } -+} -+#endif -+ -+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]; -+ } -+ -+#if 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_chplan(struct registry_priv *regsty) -+{ -+ u16 chplan = RTW_CHPLAN_UNSPECIFIED; -+ u16 chplan_6g = RTW_CHPLAN_6G_UNSPECIFIED; -+ -+ chplan = rtw_channel_plan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ chplan_6g = rtw_channel_plan_6g; -+#endif -+ -+ rtw_chplan_ioctl_input_mapping(&chplan, &chplan_6g); -+ -+ regsty->channel_plan = chplan; -+#if CONFIG_IEEE80211_BAND_6GHZ -+ regsty->channel_plan_6g = chplan_6g; -+#endif -+} -+ -+inline void rtw_regsty_load_alpha2(struct registry_priv *regsty) -+{ -+ if (strlen(rtw_country_code) != 2 -+ || (!IS_ALPHA2_WORLDWIDE(rtw_country_code) -+ && (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 or \"%s\"\n", __func__, WORLDWIDE_ALPHA2); -+ SET_UNSPEC_ALPHA2(regsty->alpha2); -+ } else -+ _rtw_memcpy(regsty->alpha2, rtw_country_code, 2); -+} -+ -+inline void rtw_regsty_load_excl_chs(struct registry_priv *regsty) -+{ -+ int i; -+ int ch_num = 0; -+ -+ for (i = 0; i < MAX_CHANNEL_NUM_2G_5G; i++) -+ if (((u8)rtw_excl_chs[i]) != 0) -+ regsty->excl_chs[ch_num++] = (u8)rtw_excl_chs[i]; -+ -+ if (ch_num < MAX_CHANNEL_NUM_2G_5G) -+ regsty->excl_chs[ch_num] = 0; -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+ ch_num = 0; -+ for (i = 0; i < MAX_CHANNEL_NUM_6G; i++) -+ if (((u8)rtw_excl_chs_6g[i]) != 0) -+ regsty->excl_chs_6g[ch_num++] = (u8)rtw_excl_chs_6g[i]; -+ -+ if (ch_num < MAX_CHANNEL_NUM_6G) -+ regsty->excl_chs_6g[ch_num] = 0; -+#endif -+} -+ -+#ifdef CONFIG_80211D -+inline void rtw_regsty_load_country_ie_slave_settings(struct registry_priv *regsty) -+{ -+ regsty->country_ie_slave_en_role = rtw_country_ie_slave_en_role; -+ regsty->country_ie_slave_en_ifbmp = rtw_country_ie_slave_en_ifbmp; -+} -+#endif -+ -+#ifdef CONFIG_80211N_HT -+inline void rtw_regsty_init_rx_ampdu_sz_limit(struct registry_priv *regsty) -+{ -+ int i, j; -+ uint *sz_limit; -+ -+ for (i = 0; i < 4; i++) { -+ if (i == 0) -+ sz_limit = rtw_rx_ampdu_sz_limit_1ss; -+ else if (i == 1) -+ sz_limit = rtw_rx_ampdu_sz_limit_2ss; -+ else if (i == 2) -+ sz_limit = rtw_rx_ampdu_sz_limit_3ss; -+ else if (i == 3) -+ sz_limit = rtw_rx_ampdu_sz_limit_4ss; -+ -+ for (j = 0; j < 4; j++) -+ regsty->rx_ampdu_sz_limit_by_nss_bw[i][j] = sz_limit[j]; -+ } -+} -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_RTW_MULTI_AP -+inline void rtw_regsty_init_unassoc_sta_param(struct registry_priv *regsty) -+{ -+ int i; -+ -+ for (i = 0; i < UNASOC_STA_SRC_NUM; i++) -+ regsty->unassoc_sta_mode_of_stype[i] = rtw_unassoc_sta_mode_of_stype[i]; -+ -+ regsty->max_unassoc_sta_cnt = (u16) rtw_max_unassoc_sta_cnt; -+} -+#endif -+ -+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; -+#ifdef CONFIG_NARROWBAND_SUPPORTING -+ if (rtw_nb_config != RTW_NB_CONFIG_NONE) -+ rtw_wireless_mode &= ~WIRELESS_11B; -+#endif -+ registry_par->wireless_mode = (u8)rtw_wireless_mode; -+ -+ if (IsSupported24G(registry_par->wireless_mode) && (!is_supported_5g(registry_par->wireless_mode)) -+ && (registry_par->channel > 14)) -+ registry_par->channel = 1; -+ else if (is_supported_5g(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->smart_ps = (u8)rtw_smart_ps; -+ registry_par->check_fw_ps = (u8)rtw_check_fw_ps; -+ #ifdef CONFIG_TDMADIG -+ registry_par->tdmadig_en = (u8)rtw_tdmadig_en; -+ registry_par->tdmadig_mode = (u8)rtw_tdmadig_mode; -+ registry_par->tdmadig_dynamic = (u8) rtw_dynamic_tdmadig; -+ registry_par->power_mgnt = PS_MODE_ACTIVE; -+ registry_par->ips_mode = IPS_NONE; -+ #else -+ registry_par->power_mgnt = (u8)rtw_power_mgnt; -+ registry_par->ips_mode = (u8)rtw_ips_mode; -+ #endif/*CONFIG_TDMADIG*/ -+ registry_par->lps_level = (u8)rtw_lps_level; -+ registry_par->en_dyn_rrsr = (u8)rtw_en_dyn_rrsr; -+ registry_par->set_rrsr_value = (u32)rtw_rrsr_value; -+#ifdef CONFIG_LPS_1T1R -+ registry_par->lps_1t1r = (u8)(rtw_lps_1t1r ? 1 : 0); -+#endif -+ registry_par->lps_chk_by_tp = (u8)rtw_lps_chk_by_tp; -+#ifdef CONFIG_WOWLAN -+ registry_par->wow_power_mgnt = (u8)rtw_wow_power_mgnt; -+ registry_par->wow_lps_level = (u8)rtw_wow_lps_level; -+ #ifdef CONFIG_LPS_1T1R -+ registry_par->wow_lps_1t1r = (u8)(rtw_wow_lps_1t1r ? 1 : 0); -+ #endif -+#endif /* CONFIG_WOWLAN */ -+ 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->max_bss_cnt = (u16)rtw_max_bss_cnt; -+ /* 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; -+ registry_par->dynamic_agg_enable = (u8)rtw_dynamic_agg_enable; -+ -+ /* WMM */ -+ registry_par->wmm_enable = (u8)rtw_wmm_enable; -+ -+#ifdef CONFIG_WMMPS_STA -+ /* UAPSD */ -+ registry_par->uapsd_max_sp_len= (u8)rtw_uapsd_max_sp; -+ registry_par->uapsd_ac_enable = (u8)rtw_uapsd_ac_enable; -+ registry_par->wmm_smart_ps = (u8)rtw_wmm_smart_ps; -+#endif /* CONFIG_WMMPS_STA */ -+ -+ registry_par->RegPwrTrimEnable = (u8)rtw_pwrtrim_enable; -+ -+#if CONFIG_TX_AC_LIFETIME -+ rtw_regsty_load_tx_ac_lifetime(registry_par); -+#endif -+ -+ registry_par->tx_bw_mode = (u8)rtw_tx_bw_mode; -+ -+#ifdef CONFIG_80211N_HT -+ registry_par->ht_enable = (u8)rtw_ht_enable; -+ if (registry_par->ht_enable && is_supported_ht(registry_par->wireless_mode)) { -+#ifdef CONFIG_NARROWBAND_SUPPORTING -+ if (rtw_nb_config != RTW_NB_CONFIG_NONE) -+ rtw_bw_mode = 0; -+#endif -+ 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->rx_ampdu_amsdu = (u8)rtw_rx_ampdu_amsdu; -+ registry_par->tx_ampdu_amsdu = (u8)rtw_tx_ampdu_amsdu; -+ registry_par->tx_quick_addba_req = (u8)rtw_quick_addba_req; -+ registry_par->short_gi = (u8)rtw_short_gi; -+ registry_par->ldpc_cap = (u8)rtw_ldpc_cap; -+#if defined(CONFIG_CUSTOMER01_SMART_ANTENNA) -+ rtw_stbc_cap = 0x0; -+#endif -+#ifdef CONFIG_RTW_TX_NPATH_EN -+ registry_par->tx_npath = (u8)rtw_tx_npath_enable; -+#endif -+#ifdef CONFIG_RTW_PATH_DIV -+ registry_par->path_div = (u8)rtw_path_div_enable; -+#endif -+ 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; -+ rtw_regsty_init_rx_ampdu_sz_limit(registry_par); -+ } -+#endif -+#ifdef DBG_LA_MODE -+ registry_par->la_mode_en = (u8)rtw_la_mode_en; -+#endif -+#ifdef CONFIG_NARROWBAND_SUPPORTING -+ registry_par->rtw_nb_config = (u8)rtw_nb_config; -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ registry_par->vht_enable = (u8)rtw_vht_enable; -+ registry_par->vht_24g_enable = (u8)rtw_vht_24g_enable; -+ registry_par->ampdu_factor = (u8)rtw_ampdu_factor; -+ registry_par->vht_rx_mcs_map[0] = (u8)(rtw_vht_rx_mcs_map & 0xFF); -+ registry_par->vht_rx_mcs_map[1] = (u8)((rtw_vht_rx_mcs_map & 0xFF00) >> 8); -+#endif -+ -+#ifdef CONFIG_TX_EARLY_MODE -+ registry_par->early_mode = (u8)rtw_early_mode; -+#endif -+ registry_par->trx_path_bmp = (u8)rtw_trx_path_bmp; -+ registry_par->tx_path_lmt = (u8)rtw_tx_path_lmt; -+ registry_par->rx_path_lmt = (u8)rtw_rx_path_lmt; -+ registry_par->tx_nss = (u8)rtw_tx_nss; -+ registry_par->rx_nss = (u8)rtw_rx_nss; -+ 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; -+ -+#ifdef CONFIG_ACTIVE_TPC_REPORT -+ registry_par->active_tpc_report = (u8)rtw_active_tpc_report; -+#endif -+ -+#ifdef CONFIG_REGD_SRC_FROM_OS -+ if (regd_src_is_valid(rtw_regd_src)) -+ registry_par->regd_src = (u8)rtw_regd_src; -+ else { -+ RTW_WARN("%s invalid rtw_regd_src(%u), use REGD_SRC_RTK_PRIV instead\n", __func__, rtw_regd_src); -+ registry_par->regd_src = REGD_SRC_RTK_PRIV; -+ } -+#endif -+ -+ rtw_regsty_load_alpha2(registry_par); -+ rtw_regsty_load_chplan(registry_par); -+ rtw_regsty_load_excl_chs(registry_par); -+#ifdef CONFIG_80211D -+ rtw_regsty_load_country_ie_slave_settings(registry_par); -+#endif -+ -+ 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; -+ registry_par->single_ant_path = (u8) rtw_single_ant_path; -+#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 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; -+#endif -+ -+#ifdef CONFIG_IOL -+ registry_par->fw_iol = rtw_fw_iol; -+#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_CONCURRENT_MODE -+ registry_par->virtual_iface_num = (u8)rtw_virtual_iface_num; -+#ifdef CONFIG_P2P -+ registry_par->sel_p2p_iface = (u8)rtw_sel_p2p_iface; -+ RTW_INFO("%s, Select P2P interface: iface_id:%d\n", __func__, registry_par->sel_p2p_iface); -+#endif -+#endif -+ registry_par->pll_ref_clk_sel = (u8)rtw_pll_ref_clk_sel; -+ -+#if CONFIG_TXPWR_LIMIT -+ registry_par->RegEnableTxPowerLimit = (u8)rtw_tx_pwr_lmt_enable; -+#endif -+ registry_par->RegEnableTxPowerByRate = (u8)rtw_tx_pwr_by_rate; -+ -+ rtw_regsty_load_target_tx_power(registry_par); -+ -+ registry_par->antenna_gain = (s16)rtw_antenna_gain; -+ -+ registry_par->tsf_update_pause_factor = (u8)rtw_tsf_update_pause_factor; -+ registry_par->tsf_update_restore_factor = (u8)rtw_tsf_update_restore_factor; -+ -+ 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_th_l2h_ini = (s8)rtw_adaptivity_th_l2h_ini; -+ registry_par->adaptivity_th_edcca_hl_diff = (s8)rtw_adaptivity_th_edcca_hl_diff; -+ -+#ifdef CONFIG_DYNAMIC_SOML -+ registry_par->dyn_soml_en = (u8)rtw_dynamic_soml_en; -+ registry_par->dyn_soml_train_num = (u8)rtw_dynamic_soml_train_num; -+ registry_par->dyn_soml_interval = (u8)rtw_dynamic_soml_interval; -+ registry_par->dyn_soml_period = (u8)rtw_dynamic_soml_period; -+ registry_par->dyn_soml_delay = (u8)rtw_dynamic_soml_delay; -+#endif -+ -+ registry_par->boffefusemask = (u8)rtw_OffEfuseMask; -+ registry_par->bFileMaskEfuse = (u8)rtw_FileMaskEfuse; -+ registry_par->bBTFileMaskEfuse = (u8)rtw_FileMaskEfuse; -+ -+#ifdef CONFIG_RTW_ACS -+ registry_par->acs_mode = (u8)rtw_acs; -+ registry_par->acs_auto_scan = (u8)rtw_acs_auto_scan; -+#endif -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ registry_par->nm_mode = (u8)rtw_nm; -+#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; -+ #ifdef CONFIG_REGD_SRC_FROM_OS -+ if (rtw_regd_src == REGD_SRC_OS && registry_par->dfs_region_domain != RTW_DFS_REGD_NONE) { -+ RTW_WARN("%s force disable radar detection capability when regd_src is OS\n", __func__); -+ registry_par->dfs_region_domain = RTW_DFS_REGD_NONE; -+ } -+ #endif -+#endif -+ -+ registry_par->amsdu_mode = (u8)rtw_amsdu_mode; -+ -+#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; -+ registry_par->rtw_mcc_policy_table_idx = rtw_mcc_policy_table_idx; -+ registry_par->rtw_mcc_duration = (u8)rtw_mcc_duration; -+ registry_par->rtw_mcc_enable_runtime_duration = rtw_mcc_enable_runtime_duration; -+ registry_par->rtw_mcc_phydm_offload = rtw_mcc_phydm_offload; -+#endif /*CONFIG_MCC_MODE */ -+ -+#ifdef CONFIG_WOWLAN -+ registry_par->wowlan_enable = rtw_wow_enable; -+ registry_par->wakeup_event = rtw_wakeup_event; -+ registry_par->suspend_type = rtw_suspend_type; -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_PREALLOC_RX_SKB_BUFFER) -+ if (rtw_recvbuf_nr != NR_RECVBUFF) { -+ RTW_WARN("CONFIG_PREALLOC_RX_SKB_BUFFER && CONFIG_SDIO_HCI, force recvbuf_nr to NR_RECVBUFF(%d)\n", NR_RECVBUFF); -+ rtw_recvbuf_nr = NR_RECVBUFF; -+ } -+#endif -+ registry_par->recvbuf_nr = rtw_recvbuf_nr; -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+ registry_par->trx_share_mode = rtw_trx_share_mode; -+#endif -+ registry_par->wowlan_sta_mix_mode = rtw_wowlan_sta_mix_mode; -+ -+#ifdef CONFIG_PCI_HCI -+ registry_par->pci_aspm_config = rtw_pci_aspm_enable; -+ registry_par->pci_dynamic_aspm_linkctrl = rtw_pci_dynamic_aspm_linkctrl; -+#endif -+ -+#ifdef CONFIG_RTW_NAPI -+ registry_par->en_napi = (u8)rtw_en_napi; -+#ifdef CONFIG_RTW_NAPI_DYNAMIC -+ registry_par->napi_threshold = (u32)rtw_napi_threshold; -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+#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 */ -+ -+ registry_par->iqk_fw_offload = (u8)rtw_iqk_fw_offload; -+ registry_par->ch_switch_offload = (u8)rtw_ch_switch_offload; -+ -+#ifdef CONFIG_TDLS -+ registry_par->en_tdls = rtw_en_tdls; -+#endif -+ -+#ifdef CONFIG_ADVANCE_OTA -+ registry_par->adv_ota = rtw_advnace_ota; -+#endif -+#ifdef CONFIG_FW_OFFLOAD_PARAM_INIT -+ registry_par->fw_param_init = rtw_fw_param_init; -+#endif -+#ifdef CONFIG_AP_MODE -+ registry_par->bmc_tx_rate = rtw_bmc_tx_rate; -+ #if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ registry_par->ap_src_b2u_flags = rtw_ap_src_b2u_flags; -+ registry_par->ap_fwd_b2u_flags = rtw_ap_fwd_b2u_flags; -+ #endif -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_RTW_MESH -+ #if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ registry_par->msrc_b2u_flags = rtw_msrc_b2u_flags; -+ registry_par->mfwd_b2u_flags = rtw_mfwd_b2u_flags; -+ #endif -+#endif /* CONFIG_RTW_MESH */ -+ -+#ifdef CONFIG_FW_HANDLE_TXBCN -+ registry_par->fw_tbtt_rpt = rtw_tbtt_rpt; -+#endif -+ registry_par->phydm_ability = rtw_phydm_ability; -+ registry_par->halrf_ability = rtw_halrf_ability; -+#ifdef CONFIG_RTW_MESH -+ registry_par->peer_alive_based_preq = rtw_peer_alive_based_preq; -+#endif -+ -+#ifdef RTW_BUSY_DENY_SCAN -+ registry_par->scan_interval_thr = rtw_scan_interval_thr; -+#endif -+ -+#ifdef CONFIG_RTL8822C_XCAP_NEW_POLICY -+ registry_par->rtw_8822c_xcap_overwrite = (u8)rtw_8822c_xcap_overwrite; -+#endif -+ -+#ifdef CONFIG_RTW_MULTI_AP -+ rtw_regsty_init_unassoc_sta_param(registry_par); -+#endif -+ -+ 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, WIFI_UNDER_LINKING) || -+ check_fwstate(pmlmepriv, WIFI_ASOC_STATE) || -+ check_fwstate(pmlmepriv, WIFI_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 */ -+ -+ rtw_hal_set_hw_macaddr(padapter, sa->sa_data); -+ -+ 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) -+ #if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 19, 0) -+ , struct net_device *sb_dev -+ #else -+ , void *accel_priv -+ #endif -+ #if ((LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) && (LINUX_VERSION_CODE < KERNEL_VERSION(5, 2, 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]; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) */ -+ -+u16 rtw_os_recv_select_queue(u8 *msdu, enum rtw_rx_llc_hdl llc_hdl) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ u32 priority = 0; -+ -+ if (llc_hdl == RTW_RX_LLC_REMOVE) { -+ u16 eth_type = RTW_GET_BE16(msdu + SNAP_SIZE); -+ -+ if (eth_type == ETH_P_IP) { -+ struct iphdr *iphdr = (struct iphdr *)(msdu + SNAP_SIZE + 2); -+ unsigned int dscp = iphdr->tos & 0xfc; -+ -+ priority = dscp >> 5; -+ } -+ } -+ -+ return rtw_1d_to_queue[priority]; -+#else -+ return 0; -+#endif -+} -+ -+static u8 is_rtw_ndev(struct net_device *ndev) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ return ndev->netdev_ops -+ && ndev->netdev_ops->ndo_do_ioctl -+ && ndev->netdev_ops->ndo_do_ioctl == rtw_ioctl; -+#else -+ return ndev->do_ioctl -+ && ndev->do_ioctl == rtw_ioctl; -+#endif -+} -+ -+static int rtw_ndev_notifier_call(struct notifier_block *nb, unsigned long state, void *ptr) -+{ -+ struct net_device *ndev; -+ -+ if (ptr == NULL) -+ return NOTIFY_DONE; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ ndev = netdev_notifier_info_to_dev(ptr); -+#else -+ ndev = ptr; -+#endif -+ -+ if (ndev == NULL) -+ return NOTIFY_DONE; -+ -+ if (!is_rtw_ndev(ndev)) -+ return NOTIFY_DONE; -+ -+ RTW_INFO(FUNC_NDEV_FMT" state:%lu\n", FUNC_NDEV_ARG(ndev), state); -+ -+ switch (state) { -+ case NETDEV_CHANGENAME: -+ rtw_adapter_proc_replace(ndev); -+ break; -+ #ifdef CONFIG_NEW_NETDEV_HDL -+ case NETDEV_PRE_UP : -+ { -+ _adapter *adapter = rtw_netdev_priv(ndev); -+ -+ rtw_pwr_wakeup(adapter); -+ } -+ break; -+ #endif -+ } -+ -+ 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) -+{ -+#ifdef CONFIG_EASY_REPLACEMENT -+ _adapter *padapter = rtw_netdev_priv(pnetdev); -+ struct net_device *TargetNetdev = NULL; -+ _adapter *TargetAdapter = NULL; -+ -+ if (padapter->bDongle == 1) { -+ TargetNetdev = rtw_get_same_net_ndev_by_name(pnetdev, "wlan0"); -+ 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"); -+ -+ rtw_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 | NETIF_F_IPV6_CSUM); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39) -+ pnetdev->hw_features |= (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM); -+#endif -+#endif -+ -+#ifdef CONFIG_RTW_NETIF_SG -+ pnetdev->features |= NETIF_F_SG; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39) -+ pnetdev->hw_features |= NETIF_F_SG; -+#endif -+#endif -+ -+ if ((pnetdev->features & NETIF_F_SG) && (pnetdev->features & NETIF_F_IP_CSUM)) { -+ pnetdev->features |= (NETIF_F_TSO | NETIF_F_GSO); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39) -+ pnetdev->hw_features |= (NETIF_F_TSO | NETIF_F_GSO); -+#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); -+ } else -+#endif -+ ret = _SUCCESS; -+ -+ 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; -+ } -+} -+ -+/* For ethtool +++ */ -+#ifdef CONFIG_IOCTL_CFG80211 -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 8)) -+static void rtw_ethtool_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) -+{ -+ struct wireless_dev *wdev = NULL; -+ _adapter *padapter = NULL; -+ HAL_DATA_TYPE *hal_data = NULL; -+ -+ wdev = dev->ieee80211_ptr; -+ if (wdev) { -+ strlcpy(info->driver, wiphy_dev(wdev->wiphy)->driver->name, -+ sizeof(info->driver)); -+ } else { -+ strlcpy(info->driver, "N/A", sizeof(info->driver)); -+ } -+ -+ strlcpy(info->version, DRIVERVERSION, sizeof(info->version)); -+ -+ padapter = (_adapter *)rtw_netdev_priv(dev); -+ if (padapter) { -+ hal_data = GET_HAL_DATA(padapter); -+ } -+ -+ if (hal_data) { -+ scnprintf(info->fw_version, sizeof(info->fw_version), "%d.%d", -+ hal_data->firmware_version, hal_data->firmware_sub_version); -+ } else { -+ strlcpy(info->fw_version, "N/A", sizeof(info->fw_version)); -+ } -+ -+ strlcpy(info->bus_info, dev_name(wiphy_dev(wdev->wiphy)), -+ sizeof(info->bus_info)); -+} -+ -+static const char rtw_ethtool_gstrings_sta_stats[][ETH_GSTRING_LEN] = { -+ "rx_packets", "rx_bytes", "rx_dropped", -+ "tx_packets", "tx_bytes", "tx_dropped", -+}; -+ -+#define RTW_ETHTOOL_STATS_LEN ARRAY_SIZE(rtw_ethtool_gstrings_sta_stats) -+ -+static int rtw_ethtool_get_sset_count(struct net_device *dev, int sset) -+{ -+ int rv = 0; -+ -+ if (sset == ETH_SS_STATS) -+ rv += RTW_ETHTOOL_STATS_LEN; -+ -+ if (rv == 0) -+ return -EOPNOTSUPP; -+ -+ return rv; -+} -+ -+static void rtw_ethtool_get_strings(struct net_device *dev, u32 sset, u8 *data) -+{ -+ int sz_sta_stats = 0; -+ -+ if (sset == ETH_SS_STATS) { -+ sz_sta_stats = sizeof(rtw_ethtool_gstrings_sta_stats); -+ memcpy(data, rtw_ethtool_gstrings_sta_stats, sz_sta_stats); -+ } -+} -+ -+static void rtw_ethtool_get_stats(struct net_device *dev, -+ struct ethtool_stats *stats, -+ u64 *data) -+{ -+ int i = 0; -+ _adapter *padapter = NULL; -+ struct xmit_priv *pxmitpriv = NULL; -+ struct recv_priv *precvpriv = NULL; -+ -+ memset(data, 0, sizeof(u64) * RTW_ETHTOOL_STATS_LEN); -+ -+ padapter = (_adapter *)rtw_netdev_priv(dev); -+ if (padapter) { -+ pxmitpriv = &(padapter->xmitpriv); -+ precvpriv = &(padapter->recvpriv); -+ -+ data[i++] = precvpriv->rx_pkts; -+ data[i++] = precvpriv->rx_bytes; -+ data[i++] = precvpriv->rx_drop; -+ -+ data[i++] = pxmitpriv->tx_pkts; -+ data[i++] = pxmitpriv->tx_bytes; -+ data[i++] = pxmitpriv->tx_drop; -+ } else { -+ data[i++] = 0; -+ data[i++] = 0; -+ data[i++] = 0; -+ -+ data[i++] = 0; -+ data[i++] = 0; -+ data[i++] = 0; -+ } -+} -+ -+static const struct ethtool_ops rtw_ethtool_ops = { -+ .get_drvinfo = rtw_ethtool_get_drvinfo, -+ .get_link = ethtool_op_get_link, -+ .get_strings = rtw_ethtool_get_strings, -+ .get_ethtool_stats = rtw_ethtool_get_stats, -+ .get_sset_count = rtw_ethtool_get_sset_count, -+}; -+#endif // LINUX_VERSION_CODE >= 3.7.8 -+#endif /* CONFIG_IOCTL_CFG80211 */ -+/* For ethtool --- */ -+ -+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; -+ } -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 8)) -+ netdev_set_default_ethtool_ops(ndev, &rtw_ethtool_ops); -+#endif /* LINUX_VERSION_CODE >= 3.7.8 */ -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) && defined(CONFIG_PCI_HCI) -+ ndev->gro_flush_timeout = 100000; -+#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 -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+exit: -+#endif -+#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) -+#ifdef CONFIG_RFKILL_POLL -+ rtw_cfg80211_deinit_rfkill(adapter_to_wiphy(adapter)); -+#endif -+ 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); -+ return _FAIL; -+ } -+#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 -+ -+ 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; -+ -+ RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(padapter)); -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+#if defined(CONFIG_SDIO_HCI) -+ if (is_primary_adapter(padapter)) -+#endif -+ { -+ if (padapter->xmitThread == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT " start RTW_XMIT_THREAD\n", FUNC_ADPT_ARG(padapter)); -+ padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD"); -+ if (IS_ERR(padapter->xmitThread)) { -+ padapter->xmitThread = NULL; -+ _status = _FAIL; -+ } -+ } -+ } -+#endif /* #ifdef CONFIG_XMIT_THREAD_MODE */ -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+ if (is_primary_adapter(padapter)) { -+ if (padapter->recvThread == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT " start RTW_RECV_THREAD\n", FUNC_ADPT_ARG(padapter)); -+ padapter->recvThread = kthread_run(rtw_recv_thread, padapter, "RTW_RECV_THREAD"); -+ if (IS_ERR(padapter->recvThread)) { -+ padapter->recvThread = NULL; -+ _status = _FAIL; -+ } -+ } -+ } -+#endif -+ -+ if (is_primary_adapter(padapter)) { -+ if (padapter->cmdThread == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT " start RTW_CMD_THREAD\n", FUNC_ADPT_ARG(padapter)); -+ padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD"); -+ if (IS_ERR(padapter->cmdThread)) { -+ padapter->cmdThread = NULL; -+ _status = _FAIL; -+ } -+ else -+ _rtw_down_sema(&padapter->cmdpriv.start_cmdthread_sema); /* wait for cmd_thread to run */ -+ } -+ } -+ -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ if (padapter->evtThread == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT " start RTW_EVENT_THREAD\n", FUNC_ADPT_ARG(padapter)); -+ padapter->evtThread = kthread_run(event_thread, padapter, "RTW_EVENT_THREAD"); -+ if (IS_ERR(padapter->evtThread)) { -+ padapter->evtThread = NULL; -+ _status = _FAIL; -+ } -+ } -+#endif -+ -+ rtw_hal_start_thread(padapter); -+ return _status; -+ -+} -+ -+void rtw_stop_drv_threads(_adapter *padapter) -+{ -+ RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(padapter)); -+ if (is_primary_adapter(padapter)) -+ rtw_stop_cmd_thread(padapter); -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ if (padapter->evtThread) { -+ _rtw_up_sema(&padapter->evtpriv.evt_notify); -+ rtw_thread_stop(padapter->evtThread); -+ padapter->evtThread = NULL; -+ } -+#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->xmitThread) { -+ _rtw_up_sema(&padapter->xmitpriv.xmit_sema); -+ rtw_thread_stop(padapter->xmitThread); -+ padapter->xmitThread = NULL; -+ } -+ } -+#endif -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+ if (is_primary_adapter(padapter) && padapter->recvThread) { -+ /* Below is to termindate rx_thread... */ -+ _rtw_up_sema(&padapter->recvpriv.recv_sema); -+ rtw_thread_stop(padapter->recvThread); -+ padapter->recvThread = NULL; -+ } -+#endif -+ -+ rtw_hal_stop_thread(padapter); -+} -+ -+u8 rtw_init_default_value(_adapter *padapter) -+{ -+ u8 ret = _SUCCESS; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ 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; -+ psecuritypriv->dot118021x_bmc_cam_id = INVALID_SEC_MAC_CAM_ID; -+ -+ -+ /* pwrctrl_priv */ -+ -+ -+ /* registry_priv */ -+ rtw_init_registrypriv_dev_network(padapter); -+ rtw_update_registrypriv_dev_network(padapter); -+ -+ -+ /* hal_priv */ -+ rtw_hal_def_value_init(padapter); -+ -+#ifdef CONFIG_MCC_MODE -+ /* MCC parameter */ -+ rtw_hal_mcc_parameter_init(padapter); -+#endif /* CONFIG_MCC_MODE */ -+ -+ /* 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->power_offset = 0; -+ padapter->rsvd_page_offset = 0; -+ padapter->rsvd_page_num = 0; -+#ifdef CONFIG_AP_MODE -+ padapter->bmc_tx_rate = pregistrypriv->bmc_tx_rate; -+ #if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ padapter->b2u_flags_ap_src = pregistrypriv->ap_src_b2u_flags; -+ padapter->b2u_flags_ap_fwd = pregistrypriv->ap_fwd_b2u_flags; -+ #endif -+#endif -+ 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 CONFIG_TX_AMSDU -+ padapter->tx_amsdu = 2; -+ padapter->tx_amsdu_rate = 400; -+#endif -+ padapter->driver_tx_max_agg_num = 0xFF; -+#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 -+ -+#ifdef CONFIG_RTW_ACS -+ if (pregistrypriv->acs_mode) -+ rtw_acs_start(padapter); -+ else -+ rtw_acs_stop(padapter); -+#endif -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ if (pregistrypriv->nm_mode) -+ rtw_nm_enable(padapter); -+ else -+ rtw_nm_disable(padapter); -+#endif -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ ATOMIC_SET(&padapter->tbtx_tx_pause, _FALSE); -+ ATOMIC_SET(&padapter->tbtx_remove_tx_pause, _FALSE); -+ padapter->tbtx_capability = _TRUE; -+#endif -+ -+ return ret; -+} -+#ifdef CONFIG_CLIENT_PORT_CFG -+extern void rtw_clt_port_init(struct clt_port_t *cltp); -+extern void rtw_clt_port_deinit(struct clt_port_t *cltp); -+#endif -+ -+struct dvobj_priv *devobj_init(void) -+{ -+ struct dvobj_priv *pdvobj = NULL; -+ -+ rtw_dbg_mem_init(); -+ -+ 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); -+ _rtw_mutex_init(&pdvobj->ioctrl_mutex); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ _rtw_mutex_init(&pdvobj->sd_indirect_access_mutex); -+#endif -+#ifdef CONFIG_SYSON_INDIRECT_ACCESS -+ _rtw_mutex_init(&pdvobj->syson_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 -+#ifdef CONFIG_PROTSEL_PORT -+ _rtw_mutex_init(&pdvobj->protsel_port.mutex); -+#endif -+#ifdef CONFIG_PROTSEL_ATIMDTIM -+ _rtw_mutex_init(&pdvobj->protsel_atimdtim.mutex); -+#endif -+#ifdef CONFIG_PROTSEL_MACSLEEP -+ _rtw_mutex_init(&pdvobj->protsel_macsleep.mutex); -+#endif -+ -+ pdvobj->processing_dev_remove = _FALSE; -+ -+ ATOMIC_SET(&pdvobj->disable_func, 0); -+ -+ rtw_macid_ctl_init(&pdvobj->macid_ctl); -+#ifdef CONFIG_CLIENT_PORT_CFG -+ rtw_clt_port_init(&pdvobj->clt_port); -+#endif -+ _rtw_spinlock_init(&pdvobj->cam_ctl.lock); -+ _rtw_mutex_init(&pdvobj->cam_ctl.sec_cam_access_mutex); -+#if defined(CONFIG_PLATFORM_RTK129X) && 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 -+ #ifdef CONFIG_SUPPORT_MULTI_BCN -+ 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); -+ pdvobj->vap_map = 0; -+ #endif /*CONFIG_SUPPORT_MULTI_BCN*/ -+ #ifdef CONFIG_SWTIMER_BASED_TXBCN -+ rtw_init_timer(&(pdvobj->txbcn_timer), NULL, tx_beacon_timer_handlder, pdvobj); -+ #endif -+#endif -+ -+ rtw_init_timer(&(pdvobj->dynamic_chk_timer), NULL, rtw_dynamic_check_timer_handlder, pdvobj); -+ rtw_init_timer(&(pdvobj->periodic_tsf_update_end_timer), NULL, rtw_hal_periodic_tsf_update_end_timer_hdl, pdvobj); -+ -+#ifdef CONFIG_MCC_MODE -+ _rtw_mutex_init(&(pdvobj->mcc_objpriv.mcc_mutex)); -+ _rtw_mutex_init(&(pdvobj->mcc_objpriv.mcc_tsf_req_mutex)); -+ _rtw_mutex_init(&(pdvobj->mcc_objpriv.mcc_dbg_reg_mutex)); -+ _rtw_spinlock_init(&pdvobj->mcc_objpriv.mcc_lock); -+#endif /* CONFIG_MCC_MODE */ -+ -+#ifdef CONFIG_RTW_NAPI_DYNAMIC -+ pdvobj->en_napi_dynamic = 0; -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+ -+ -+#ifdef CONFIG_RTW_TPT_MODE -+ pdvobj->tpt_mode = 0; -+ pdvobj->edca_be_ul = 0x5ea42b; -+ pdvobj->edca_be_dl = 0x00a42b; -+#endif -+ pdvobj->scan_deny = _FALSE; -+ -+ /* wpas type default from w1.fi */ -+ pdvobj->wpas_type = RTW_WPAS_W1FI; -+ -+ 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_mutex_free(&(pdvobj->mcc_objpriv.mcc_tsf_req_mutex)); -+ _rtw_mutex_free(&(pdvobj->mcc_objpriv.mcc_dbg_reg_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 -+#ifdef CONFIG_PROTSEL_PORT -+ _rtw_mutex_free(&pdvobj->protsel_port.mutex); -+#endif -+#ifdef CONFIG_PROTSEL_ATIMDTIM -+ _rtw_mutex_free(&pdvobj->protsel_atimdtim.mutex); -+#endif -+#ifdef CONFIG_PROTSEL_MACSLEEP -+ _rtw_mutex_free(&pdvobj->protsel_macsleep.mutex); -+#endif -+ -+ _rtw_mutex_free(&pdvobj->setch_mutex); -+ _rtw_mutex_free(&pdvobj->setbw_mutex); -+ _rtw_mutex_free(&pdvobj->rf_read_reg_mutex); -+ _rtw_mutex_free(&pdvobj->ioctrl_mutex); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ _rtw_mutex_free(&pdvobj->sd_indirect_access_mutex); -+#endif -+#ifdef CONFIG_SYSON_INDIRECT_ACCESS -+ _rtw_mutex_free(&pdvobj->syson_indirect_access_mutex); -+#endif -+ -+ rtw_macid_ctl_deinit(&pdvobj->macid_ctl); -+#ifdef CONFIG_CLIENT_PORT_CFG -+ rtw_clt_port_deinit(&pdvobj->clt_port); -+#endif -+ -+ _rtw_spinlock_free(&pdvobj->cam_ctl.lock); -+ _rtw_mutex_free(&pdvobj->cam_ctl.sec_cam_access_mutex); -+ -+#if defined(CONFIG_PLATFORM_RTK129X) && defined(CONFIG_PCI_HCI) -+ _rtw_spinlock_free(&pdvobj->io_reg_lock); -+#endif -+#ifdef CONFIG_MBSSID_CAM -+ rtw_mbid_cam_deinit(pdvobj); -+#endif -+#ifdef CONFIG_SUPPORT_MULTI_BCN -+ _rtw_spinlock_free(&(pdvobj->ap_if_q.lock)); -+#endif -+ rtw_mfree((u8 *)pdvobj, sizeof(*pdvobj)); -+ -+ rtw_dbg_mem_deinit(); -+} -+ -+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 */ -+ 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, WIFI_UNDER_SURVEY | WIFI_UNDER_LINKING); -+ -+#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; -+ -+#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+#endif -+ -+ #if defined(CONFIG_AP_MODE) && defined(CONFIG_SUPPORT_MULTI_BCN) -+ _rtw_init_listhead(&padapter->list); -+ #ifdef CONFIG_FW_HANDLE_TXBCN -+ padapter->vap_id = CONFIG_LIMITED_AP_NUM; -+ if (is_primary_adapter(padapter)) -+ adapter_to_dvobj(padapter)->vap_tbtt_rpt_map = adapter_to_regsty(padapter)->fw_tbtt_rpt; -+ #endif -+ #endif -+ -+ #ifdef CONFIG_CLIENT_PORT_CFG -+ padapter->client_id = MAX_CLIENT_PORT_NUM; -+ padapter->client_port = CLT_PORT_INVALID; -+ #endif -+ -+ if (is_primary_adapter(padapter)) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ -+ dvobj->macid_ctl.num = rtw_min(hal_spec->macid_num, MACID_NUM_SW_LIMIT); -+ dvobj->macid_ctl.macid_cap = hal_spec->macid_cap; -+ dvobj->macid_ctl.macid_txrpt = hal_spec->macid_txrpt; -+ dvobj->macid_ctl.macid_txrpt_pgsz = hal_spec->macid_txrpt_pgsz; -+ 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); -+ -+ dvobj->wow_ctl.wow_cap = hal_spec->wow_cap; -+ -+ #ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+ dvobj->tx_aval_int_thr_mode = 2; /*setting by max tx length*/ -+ dvobj->tx_aval_int_thr_value = 0; -+ #endif /*CONFIG_SDIO_TX_ENABLE_AVAL_INT*/ -+ -+ #if CONFIG_TX_AC_LIFETIME -+ { -+ struct registry_priv *regsty = adapter_to_regsty(padapter); -+ int i; -+ -+ dvobj->tx_aclt_flags = regsty->tx_aclt_flags; -+ for (i = 0; i < TX_ACLT_CONF_NUM; i++) { -+ dvobj->tx_aclt_confs[i].en = regsty->tx_aclt_confs[i].en; -+ dvobj->tx_aclt_confs[i].vo_vi -+ = regsty->tx_aclt_confs[i].vo_vi / (hal_spec->tx_aclt_unit_factor * 32); -+ if (dvobj->tx_aclt_confs[i].vo_vi > 0xFFFF) -+ dvobj->tx_aclt_confs[i].vo_vi = 0xFFFF; -+ dvobj->tx_aclt_confs[i].be_bk -+ = regsty->tx_aclt_confs[i].be_bk / (hal_spec->tx_aclt_unit_factor * 32); -+ if (dvobj->tx_aclt_confs[i].be_bk > 0xFFFF) -+ dvobj->tx_aclt_confs[i].be_bk = 0xFFFF; -+ } -+ -+ dvobj->tx_aclt_force_val.en = 0xFF; -+ } -+ #endif -+ #if defined (CONFIG_CONCURRENT_MODE) && defined (CONFIG_TSF_SYNC) -+ dvobj->sync_tsfr_counter = 0x0; -+ #endif -+ } -+ -+ 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; -+ } -+ -+ if (is_primary_adapter(padapter)) { -+ if (rtw_hal_rfpath_init(padapter) == _FAIL) { -+ ret8 = _FAIL; -+ goto exit; -+ } -+ if (rtw_hal_trxnss_init(padapter) == _FAIL) { -+ ret8 = _FAIL; -+ goto exit; -+ } -+ if (rtw_hal_runtime_trx_path_decision(padapter) == _FAIL) { -+ ret8 = _FAIL; -+ goto exit; -+ } -+ if (rtw_rfctl_init(padapter) == _FAIL) { -+ ret8 = _FAIL; -+ goto exit; -+ } -+ } -+ -+ if (rtw_init_mlme_priv(padapter) == _FAIL) { -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+#if (defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE)) || defined(CONFIG_IOCTL_CFG80211) -+ rtw_init_roch_info(padapter); -+#endif -+ -+#ifdef CONFIG_P2P -+ rtw_init_wifidirect_timers(padapter); -+ init_wifidirect_info(padapter, P2P_ROLE_DISABLE); -+ reset_global_wifidirect_info(padapter); -+#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 */ -+ -+#ifdef CONFIG_RTW_MESH -+ rtw_mesh_cfg_init(padapter); -+#endif -+ -+ 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)); */ -+ -+ if (_rtw_init_sta_priv(&padapter->stapriv) == _FAIL) { -+ RTW_INFO("Can't _rtw_init_sta_priv\n"); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ padapter->setband = WIFI_FREQUENCY_BAND_AUTO; -+ padapter->fix_rate = 0xFF; -+ padapter->power_offset = 0; -+ padapter->rsvd_page_offset = 0; -+ padapter->rsvd_page_num = 0; -+ -+ 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 -+ -+ if (is_primary_adapter(padapter)) -+ rtw_edcca_mode_update(adapter_to_dvobj(padapter)); -+ -+ rtw_hal_dm_init(padapter); -+ -+ if (is_primary_adapter(padapter)) -+ rtw_rfctl_chplan_init(padapter); -+ -+#ifdef CONFIG_RTW_SW_LED -+ rtw_hal_sw_led_init(padapter); -+#endif -+#ifdef DBG_CONFIG_ERROR_DETECT -+ rtw_hal_sreset_init(padapter); -+#endif -+ -+#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 */ -+ -+#ifdef CONFIG_BEAMFORMING -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ rtw_bf_init(padapter); -+#endif /* RTW_BEAMFORMING_VERSION_2 */ -+#endif /* CONFIG_BEAMFORMING */ -+ -+#ifdef CONFIG_RTW_REPEATER_SON -+ init_rtw_rson_data(adapter_to_dvobj(padapter)); -+#endif -+ -+#ifdef CONFIG_RTW_80211K -+ rtw_init_rm(padapter); -+#endif -+ -+#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI -+ memset(pwdev_priv->pno_mac_addr, 0xFF, ETH_ALEN); -+#endif -+ -+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); -+ -+ _cancel_timer_ex(&padapter->mlmepriv.scan_to_timer); -+ -+#ifdef CONFIG_DFS_MASTER -+ _cancel_timer_ex(&adapter_to_rfctl(padapter)->radar_detect_timer); -+#endif -+ -+ _cancel_timer_ex(&adapter_to_dvobj(padapter)->dynamic_chk_timer); -+ _cancel_timer_ex(&adapter_to_dvobj(padapter)->periodic_tsf_update_end_timer); -+#ifdef CONFIG_RTW_SW_LED -+ /* cancel sw led timer */ -+ rtw_hal_sw_led_deinit(padapter); -+#endif -+ _cancel_timer_ex(&(adapter_to_pwrctl(padapter)->pwr_state_check_timer)); -+ -+#ifdef CONFIG_TX_AMSDU -+ _cancel_timer_ex(&padapter->xmitpriv.amsdu_bk_timer); -+ _cancel_timer_ex(&padapter->xmitpriv.amsdu_be_timer); -+ _cancel_timer_ex(&padapter->xmitpriv.amsdu_vo_timer); -+ _cancel_timer_ex(&padapter->xmitpriv.amsdu_vi_timer); -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ _cancel_timer_ex(&padapter->rochinfo.remain_on_ch_timer); -+#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 -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ _cancel_timer_ex(&(adapter_to_pwrctl(padapter)->pwr_rpwm_timer)); -+#endif /* CONFIG_LPS_RPWM_TIMER */ -+ -+#ifdef CONFIG_RTW_TOKEN_BASED_XMIT -+ _cancel_timer_ex(&padapter->mlmeextpriv.tbtx_xmit_timer); -+ _cancel_timer_ex(&padapter->mlmeextpriv.tbtx_token_dispatch_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; -+ #ifdef CONFIG_CONCURRENT_MODE -+ struct roch_info *prochinfo = &padapter->rochinfo; -+ #endif -+ 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(&prochinfo->ap_roch_ch_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 */ -+ -+ free_mlme_ext_priv(&padapter->mlmeextpriv); -+ -+#ifdef CONFIG_TDLS -+ /* rtw_free_tdls_info(&padapter->tdlsinfo); */ -+#endif /* CONFIG_TDLS */ -+ -+#ifdef CONFIG_RTW_80211K -+ rtw_free_rm_priv(padapter); -+#endif -+ -+ rtw_free_cmd_priv(&padapter->cmdpriv); -+ -+ rtw_free_evt_priv(&padapter->evtpriv); -+ -+ rtw_free_mlme_priv(&padapter->mlmepriv); -+ -+ if (is_primary_adapter(padapter)) -+ rtw_rfctl_deinit(padapter); -+ -+ /* 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); -+ -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ if (padapter->cmap_bss_status_evt) { -+ cmap_intfs_mfree(padapter->cmap_bss_status_evt, padapter->cmap_bss_status_evt_len); -+ padapter->cmap_bss_status_evt = NULL; -+ } -+#endif -+ -+ /* rtw_mfree((void *)padapter, sizeof (padapter)); */ -+ -+ rtw_hal_free_data(padapter); -+ -+ return _SUCCESS; -+ -+} -+void rtw_intf_start(_adapter *adapter) -+{ -+ if (adapter->intf_start) -+ adapter->intf_start(adapter); -+ GET_HAL_DATA(adapter)->intf_start = 1; -+} -+void rtw_intf_stop(_adapter *adapter) -+{ -+ if (adapter->intf_stop) -+ adapter->intf_stop(adapter); -+ GET_HAL_DATA(adapter)->intf_start = 0; -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+#ifndef CONFIG_NEW_NETDEV_HDL -+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)) { -+#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_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 -+ -+ rtw_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; -+} -+#endif /*#ifndef CONFIG_NEW_NETDEV_HDL*/ -+ -+#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, -+ #ifdef CONFIG_NEW_NETDEV_HDL -+ .ndo_open = netdev_open, -+ .ndo_stop = netdev_close, -+ #else -+ .ndo_open = netdev_vir_if_open, -+ .ndo_stop = netdev_vir_if_close, -+ #endif -+ .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; -+ #ifdef CONFIG_NEW_NETDEV_HDL -+ ndev->open = netdev_open; -+ ndev->stop = netdev_close; -+ #else -+ ndev->open = netdev_vir_if_open; -+ ndev->stop = netdev_vir_if_close; -+ #endif -+ -+ 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]; -+#ifdef CONFIG_MI_UNIQUE_MACADDR_BIT -+ u32 mi_unique_macaddr_bit = 0; -+ u8 i; -+#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(_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; -+#elif defined(CONFIG_PORT_BASED_TXBCN) -+ padapter->hw_port = adapter_to_dvobj(padapter)->iface_nums; -+#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); -+ -+#ifdef CONFIG_MI_UNIQUE_MACADDR_BIT -+ mi_unique_macaddr_bit = BIT(CONFIG_MI_UNIQUE_MACADDR_BIT) >> 24; -+ /* Find out CONFIG_MI_UNIQUE_MACADDR_BIT in which nic specific byte */ -+ for(i=3;i<6;i++) { -+ if((mi_unique_macaddr_bit >> 8) == 0) -+ break; -+ -+ mi_unique_macaddr_bit >>= 8; -+ } -+ -+ if((mac[i] & (u8)mi_unique_macaddr_bit)== 0) { -+ RTW_INFO("%s() "MAC_FMT" : BIT%u is zero\n", __func__, MAC_ARG(mac), CONFIG_MI_UNIQUE_MACADDR_BIT); -+ /* IFACE_ID1/IFACE_ID3 : set locally administered bit */ -+ if(padapter->iface_id & BIT(0)) -+ mac[0] |= BIT(1); -+ /* IFACE_ID2/IFACE_ID3 : set bit(CONFIG_MI_UNIQUE_MACADDR_BIT) */ -+ if(padapter->iface_id >> 1) -+ mac[i] |= (u8)mi_unique_macaddr_bit; -+ } else -+#endif -+ { -+ /* -+ * 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[0] ^= ((padapter->iface_id)<<2); -+ } -+ -+ _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 -+ -+ rtw_led_set_ctl_en_mask_virtual(padapter); -+ rtw_led_set_iface_en(padapter, 1); -+ -+ 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; -+ RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(padapter)); -+ -+ pnetdev = padapter->pnetdev; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) -+ rtw_disassoc_cmd(padapter, 0, RTW_CMDF_DIRECTLY); -+ -+#ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { -+ 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); -+ #ifndef CONFIG_NEW_NETDEV_HDL -+ rtw_stop_drv_threads(padapter); -+ #endif -+ padapter->bup = _FALSE; -+ } -+ #ifdef CONFIG_NEW_NETDEV_HDL -+ rtw_stop_drv_threads(padapter); -+ #endif -+ /* 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]); -+} -+ -+ -+#endif /*end of CONFIG_CONCURRENT_MODE*/ -+ -+/* IPv4, IPv6 IP addr notifier */ -+static int rtw_inetaddr_notifier_call(struct notifier_block *nb, -+ unsigned long action, void *data) -+{ -+ struct in_ifaddr *ifa = (struct in_ifaddr *)data; -+ struct net_device *ndev; -+ struct mlme_ext_priv *pmlmeext = NULL; -+ struct mlme_ext_info *pmlmeinfo = NULL; -+ _adapter *adapter = NULL; -+ -+ if (!ifa || !ifa->ifa_dev || !ifa->ifa_dev->dev) -+ return NOTIFY_DONE; -+ -+ ndev = ifa->ifa_dev->dev; -+ -+ if (!is_rtw_ndev(ndev)) -+ return NOTIFY_DONE; -+ -+ adapter = (_adapter *)rtw_netdev_priv(ifa->ifa_dev->dev); -+ -+ if (adapter == NULL) -+ return NOTIFY_DONE; -+ -+ pmlmeext = &adapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ switch (action) { -+ case NETDEV_UP: -+ _rtw_memcpy(pmlmeinfo->ip_addr, &ifa->ifa_address, -+ RTW_IP_ADDR_LEN); -+ RTW_DBG("%s[%s]: up IP: %pI4\n", __func__, -+ ifa->ifa_label, pmlmeinfo->ip_addr); -+ break; -+ case NETDEV_DOWN: -+ _rtw_memset(pmlmeinfo->ip_addr, 0, RTW_IP_ADDR_LEN); -+ RTW_DBG("%s[%s]: down IP: %pI4\n", __func__, -+ ifa->ifa_label, pmlmeinfo->ip_addr); -+ break; -+ default: -+ RTW_DBG("%s: default action\n", __func__); -+ break; -+ } -+ return NOTIFY_DONE; -+} -+ -+#ifdef CONFIG_IPV6 -+static int rtw_inet6addr_notifier_call(struct notifier_block *nb, -+ unsigned long action, void *data) -+{ -+ struct inet6_ifaddr *inet6_ifa = data; -+ struct net_device *ndev; -+ struct pwrctrl_priv *pwrctl = NULL; -+ struct mlme_ext_priv *pmlmeext = NULL; -+ struct mlme_ext_info *pmlmeinfo = NULL; -+ _adapter *adapter = NULL; -+ -+ if (!inet6_ifa || !inet6_ifa->idev || !inet6_ifa->idev->dev) -+ return NOTIFY_DONE; -+ -+ ndev = inet6_ifa->idev->dev; -+ -+ if (!is_rtw_ndev(ndev)) -+ return NOTIFY_DONE; -+ -+ adapter = (_adapter *)rtw_netdev_priv(inet6_ifa->idev->dev); -+ -+ if (adapter == NULL) -+ return NOTIFY_DONE; -+ -+ pmlmeext = &adapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ pwrctl = adapter_to_pwrctl(adapter); -+ -+ pmlmeext = &adapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ switch (action) { -+ case NETDEV_UP: -+#ifdef CONFIG_WOWLAN -+ pwrctl->wowlan_ns_offload_en = _TRUE; -+#endif -+ _rtw_memcpy(pmlmeinfo->ip6_addr, &inet6_ifa->addr, -+ RTW_IPv6_ADDR_LEN); -+ RTW_DBG("%s: up IPv6 addrs: %pI6\n", __func__, -+ pmlmeinfo->ip6_addr); -+ break; -+ case NETDEV_DOWN: -+#ifdef CONFIG_WOWLAN -+ pwrctl->wowlan_ns_offload_en = _FALSE; -+#endif -+ _rtw_memset(pmlmeinfo->ip6_addr, 0, RTW_IPv6_ADDR_LEN); -+ RTW_DBG("%s: down IPv6 addrs: %pI6\n", __func__, -+ pmlmeinfo->ip6_addr); -+ break; -+ default: -+ RTW_DBG("%s: default action\n", __func__); -+ break; -+ } -+ return NOTIFY_DONE; -+} -+#endif -+ -+static struct notifier_block rtw_inetaddr_notifier = { -+ .notifier_call = rtw_inetaddr_notifier_call -+}; -+ -+#ifdef CONFIG_IPV6 -+static struct notifier_block rtw_inet6addr_notifier = { -+ .notifier_call = rtw_inet6addr_notifier_call -+}; -+#endif -+ -+void rtw_inetaddr_notifier_register(void) -+{ -+ RTW_INFO("%s\n", __func__); -+ register_inetaddr_notifier(&rtw_inetaddr_notifier); -+#ifdef CONFIG_IPV6 -+ register_inet6addr_notifier(&rtw_inet6addr_notifier); -+#endif -+} -+ -+void rtw_inetaddr_notifier_unregister(void) -+{ -+ RTW_INFO("%s\n", __func__); -+ unregister_inetaddr_notifier(&rtw_inetaddr_notifier); -+#ifdef CONFIG_IPV6 -+ unregister_inet6addr_notifier(&rtw_inet6addr_notifier); -+#endif -+} -+ -+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); -+ return _FAIL; -+ } -+#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 -+ 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 -+ -+ /* 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 -+ if (rcu_dereference(adapter->pnetdev->rx_handler_data)) -+ #endif -+ { -+ struct net_device *br_netdev; -+ -+ br_netdev = rtw_get_bridge_ndev_by_name(CONFIG_BR_EXT_BRNAME); -+ if (br_netdev) { -+ memcpy(adapter->br_mac, br_netdev->dev_addr, ETH_ALEN); -+ dev_put(br_netdev); -+ RTW_INFO(FUNC_NDEV_FMT" bind bridge dev "NDEV_FMT"("MAC_FMT")\n" -+ , FUNC_NDEV_ARG(netdev), NDEV_ARG(br_netdev), MAC_ARG(br_netdev->dev_addr)); -+ } else { -+ RTW_INFO(FUNC_NDEV_FMT" can't get bridge dev by name \"%s\"\n" -+ , FUNC_NDEV_ARG(netdev), CONFIG_BR_EXT_BRNAME); -+ } -+ } -+ -+ adapter->ethBrExtInfo.addPPPoETag = 1; -+ } -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ rcu_read_unlock(); -+#endif -+} -+#endif /* CONFIG_BR_EXT */ -+ -+#ifdef CONFIG_NEW_NETDEV_HDL -+int _netdev_open(struct net_device *pnetdev) -+{ -+ uint status; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ RTW_INFO(FUNC_NDEV_FMT" start\n", FUNC_NDEV_ARG(pnetdev)); -+ -+ if (!rtw_is_hw_init_completed(padapter)) { // ips -+ rtw_clr_surprise_removed(padapter); -+ rtw_clr_drv_stopped(padapter); -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) -+ goto netdev_open_error; -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ #ifndef RTW_HALMAC -+ status = rtw_mi_start_drv_threads(padapter); -+ if (status == _FAIL) { -+ RTW_ERR(FUNC_NDEV_FMT "Initialize driver thread failed!\n", FUNC_NDEV_ARG(pnetdev)); -+ goto netdev_open_error; -+ } -+ -+ rtw_intf_start(GET_PRIMARY_ADAPTER(padapter)); -+ #endif /* !RTW_HALMAC */ -+ -+ { -+ #ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ _adapter *prim_adpt = GET_PRIMARY_ADAPTER(padapter); -+ -+ if (prim_adpt && (_TRUE == prim_adpt->EEPROMBluetoothCoexist)) { -+ rtw_btcoex_init_socket(prim_adpt); -+ prim_adpt->coex_info.BtMgnt.ExtConfig.HCIExtensionVer = 0x04; -+ rtw_btcoex_SetHciVersion(prim_adpt, 0x04); -+ } -+ #endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ -+ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); -+ -+ #ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(pwrctrlpriv); -+ #endif /*CONFIG_IPS_CHECK_IN_WD*/ -+ } -+ -+ } -+ -+ /*if (padapter->bup == _FALSE) */ -+ { -+ rtw_hal_iface_init(padapter); -+ -+ #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_wdev_data(padapter); -+ #endif -+ /* rtw_netif_carrier_on(pnetdev); */ /* call this func when rtw_joinbss_event_callback return success */ -+ rtw_netif_wake_queue(pnetdev); -+ -+ #ifdef CONFIG_BR_EXT -+ if (is_primary_adapter(padapter)) -+ netdev_br_init(pnetdev); -+ #endif /* CONFIG_BR_EXT */ -+ -+ -+ padapter->bup = _TRUE; -+ padapter->net_closed = _FALSE; -+ padapter->netif_up = _TRUE; -+ pwrctrlpriv->bips_processing = _FALSE; -+ } -+ -+ RTW_INFO(FUNC_NDEV_FMT" Success (bup=%d)\n", FUNC_NDEV_ARG(pnetdev), 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 -+ -+ rtw_netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ -+ RTW_ERR(FUNC_NDEV_FMT" Failed!! (bup=%d)\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); -+ -+ return -1; -+ -+} -+ -+#else -+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 (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)); -+ -+#ifndef RTW_HALMAC -+ status = rtw_start_drv_threads(padapter); -+ if (status == _FAIL) { -+ RTW_INFO("Initialize driver software resource Failed!\n"); -+ goto netdev_open_error; -+ } -+#endif /* !RTW_HALMAC */ -+ -+#ifdef CONFIG_RTW_NAPI -+ if(padapter->napi_state == NAPI_DISABLE) { -+ napi_enable(&padapter->napi); -+ padapter->napi_state = NAPI_ENABLE; -+ } -+#endif -+ -+#ifndef RTW_HALMAC -+ rtw_intf_start(padapter); -+#endif /* !RTW_HALMAC */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ 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 -+ -+ /* rtw_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 */ -+ -+#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 -+ -+#ifdef CONFIG_RTW_CFGVENDOR_LLSTATS -+ pwrctrlpriv->radio_on_start_time = rtw_get_current_time(); -+ pwrctrlpriv->pwr_saving_start_time = rtw_get_current_time(); -+ pwrctrlpriv->pwr_saving_time = 0; -+ pwrctrlpriv->on_time = 0; -+ pwrctrlpriv->tx_time = 0; -+ pwrctrlpriv->rx_time = 0; -+#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ -+ -+ 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 -+ -+ rtw_netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ -+ RTW_INFO("-871x_drv - drv_open fail, bup=%d\n", padapter->bup); -+ -+ return -1; -+ -+} -+#endif -+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); -+#ifdef CONFIG_NEW_NETDEV_HDL -+ ret = _netdev_open(pnetdev); -+#else -+ if (is_primary_adapter(padapter)) -+ ret = _netdev_open(pnetdev); -+#ifdef CONFIG_CONCURRENT_MODE -+ else -+ ret = _netdev_vir_if_open(pnetdev); -+#endif -+#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; */ -+#ifdef CONFIG_NEW_NETDEV_HDL -+ if (!rtw_is_hw_init_completed(padapter)) { -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) { -+ goto netdev_open_error; -+ } -+ rtw_mi_hal_iface_init(padapter); -+ } -+#else -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) { -+ goto netdev_open_error; -+ } -+#endif -+#if 0 -+ rtw_mi_set_mac_addr(padapter); -+#endif -+#ifndef RTW_HALMAC -+ rtw_intf_start(padapter); -+#endif /* !RTW_HALMAC */ -+ -+#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; -+#if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) -+#ifdef DBG_CONFIG_ERROR_DETECT -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ -+#endif /* defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) */ -+ systime 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) -+{ -+ systime 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) -+{ -+#if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) -+#ifdef DBG_CONFIG_ERROR_DETECT -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ -+#endif /* defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) */ -+ 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); -+ -+} -+#ifdef CONFIG_NEW_NETDEV_HDL -+int _pm_netdev_open(_adapter *padapter) -+{ -+ uint status; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ RTW_INFO(FUNC_NDEV_FMT" start\n", FUNC_NDEV_ARG(pnetdev)); -+ -+ if (!rtw_is_hw_init_completed(padapter)) { // ips -+ rtw_clr_surprise_removed(padapter); -+ rtw_clr_drv_stopped(padapter); -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) -+ goto netdev_open_error; -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ #ifndef RTW_HALMAC -+ status = rtw_mi_start_drv_threads(padapter); -+ if (status == _FAIL) { -+ RTW_ERR(FUNC_NDEV_FMT "Initialize driver thread failed!\n", FUNC_NDEV_ARG(pnetdev)); -+ goto netdev_open_error; -+ } -+ -+ rtw_intf_start(GET_PRIMARY_ADAPTER(padapter)); -+ #endif /* !RTW_HALMAC */ -+ -+ { -+ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); -+ -+ #ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(pwrctrlpriv); -+ #endif /*CONFIG_IPS_CHECK_IN_WD*/ -+ } -+ -+ } -+ -+ /*if (padapter->bup == _FALSE) */ -+ { -+ rtw_hal_iface_init(padapter); -+ -+ padapter->bup = _TRUE; -+ padapter->net_closed = _FALSE; -+ padapter->netif_up = _TRUE; -+ pwrctrlpriv->bips_processing = _FALSE; -+ } -+ -+ RTW_INFO(FUNC_NDEV_FMT" Success (bup=%d)\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); -+ return 0; -+ -+netdev_open_error: -+ padapter->bup = _FALSE; -+ -+ rtw_netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ -+ RTW_ERR(FUNC_NDEV_FMT" Failed!! (bup=%d)\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); -+ -+ return -1; -+ -+} -+int _mi_pm_netdev_open(struct net_device *pnetdev) -+{ -+ int i; -+ int status = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface->netif_up) { -+ status = _pm_netdev_open(iface); -+ if (status == -1) { -+ RTW_ERR("%s failled\n", __func__); -+ break; -+ } -+ } -+ } -+ -+ return status; -+} -+#endif /*CONFIG_NEW_NETDEV_HDL*/ -+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); -+ #ifdef CONFIG_NEW_NETDEV_HDL -+ status = _mi_pm_netdev_open(pnetdev); -+ #else -+ status = _netdev_open(pnetdev); -+ #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; -+} -+#ifdef CONFIG_CLIENT_PORT_CFG -+extern void rtw_hw_client_port_release(_adapter *adapter); -+#endif -+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 -+ padapter->net_closed = _TRUE; -+ padapter->netif_up = _FALSE; -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; -+ -+#ifdef CONFIG_CLIENT_PORT_CFG -+ if (MLME_IS_STA(padapter)) -+ rtw_hw_client_port_release(padapter); -+#endif -+ /* 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_RTW_ANDROID -+ /* s2. */ -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, RTW_CMDF_WAIT_ACK); -+ /* s2-2. indicate disconnect to os */ -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ /* s2-3. */ -+ rtw_free_assoc_resources_cmd(padapter, _TRUE, RTW_CMDF_WAIT_ACK); -+ /* s2-4. */ -+ rtw_free_network_queue(padapter, _TRUE); -+#endif -+ } -+ -+#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 */ -+ -+ 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); -+ 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); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 7, 0)) -+ err = sock_recvmsg(sock, &msg, MSG_DONTWAIT); -+#else -+ err = sock_recvmsg(sock, &msg, PAGE_SIZE, MSG_DONTWAIT); -+#endif -+ 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, ETH_ALEN); -+ 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 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; -+#ifdef CONFIG_WAKE_ON_BT -+ u8 disable = 0; -+#endif -+ -+ if (padapter->bup == _TRUE) { -+ RTW_INFO("==> "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+#ifdef CONFIG_WOWLAN -+#ifdef CONFIG_GPIO_WAKEUP -+ /*default wake up pin change to BT*/ -+ RTW_INFO("%s:default wake up pin change to BT\n", __FUNCTION__); -+ rtw_hal_switch_gpio_wl_ctrl(padapter, pwrctl->wowlan_gpio_index, _FALSE); -+#endif /* CONFIG_GPIO_WAKEUP */ -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_WAKE_ON_BT -+ rtw_hal_set_hwreg(padapter, HW_VAR_WAKE_ON_BT_GPIO_SWITCH, (u8 *)(&disable)); -+#endif -+ -+ 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); -+ -+ rtw_stop_drv_threads(padapter); -+ -+ if (ATOMIC_READ(&(pcmdpriv->cmdthd_running)) == _TRUE) { -+ RTW_ERR("cmd_thread not stop !!\n"); -+ rtw_warn_on(1); -+ } -+ -+ /* 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("<== "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ } 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; -+#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, WIFI_ASOC_STATE) -+ #ifdef CONFIG_P2P -+ && (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -+ #if defined(CONFIG_IOCTL_CFG80211) && RTW_P2P_GROUP_INTERFACE -+ || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) -+ #endif -+ ) -+ #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, WIFI_ASOC_STATE)) { -+ rtw_disassoc_cmd(padapter, 0, RTW_CMDF_DIRECTLY); -+ /* s2-2. indicate disconnect to os */ -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ } -+#ifdef CONFIG_AP_MODE -+ else if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) -+ rtw_sta_flush(padapter, _TRUE); -+#endif -+ -+ /* s2-3. */ -+ rtw_free_assoc_resources(padapter, _TRUE); -+ -+ /* s2-4. */ -+ rtw_free_network_queue(padapter, _TRUE); -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_SURVEY)) { -+ RTW_PRINT("%s: fw_under_survey\n", __func__); -+ rtw_indicate_scan_done(padapter, 1); -+ clr_fwstate(pmlmepriv, WIFI_UNDER_SURVEY); -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_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 pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct wowlan_ioctl_param poidparam; -+ int ret = _SUCCESS; -+ u8 en = _TRUE, i; -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+#ifdef CONFIG_WAKE_ON_BT -+ u8 enable = 1; -+#endif -+ 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 -+ -+ rtw_mi_netif_stop_queue(padapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ rtw_mi_buddy_netif_carrier_off(padapter); -+ #endif -+ -+ /* 0. Power off LED */ -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ -+#ifdef CONFIG_WAKE_ON_BT -+ rtw_hal_set_hwreg(padapter, HW_VAR_WAKE_ON_BT_GPIO_SWITCH, (u8 *)(&enable)); -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ /* 2.only for SDIO disable interrupt */ -+ rtw_intf_stop(padapter); -+ -+ /* 2.1 clean interrupt */ -+ rtw_hal_clear_interrupt(padapter); -+#endif /* CONFIG_SDIO_HCI */ -+ -+ /* enable ac lifetime during scan to avoid txfifo not empty. */ -+ dvobj->lifetime_en = rtw_read8(padapter, 0x426); -+ dvobj->pkt_lifetime = rtw_read32(padapter, 0x4c0); -+ rtw_write8(padapter, 0x426, rtw_read8(padapter, 0x426) | 0x0f); -+ if(hal_spec->tx_aclt_unit_factor == 1) { -+ rtw_write16(padapter, 0x4c0, 0x1000); // unit: 32us. 131ms -+ rtw_write16(padapter, 0x4c0 + 2 , 0x1000); // unit: 32us. 131ms -+ } else { -+ rtw_write16(padapter, 0x4c0, 0x0200); // unit: 256us. 131ms -+ rtw_write16(padapter, 0x4c0 + 2 , 0x0200); // unit: 256us. 131ms -+ } -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ rtw_write_port_cancel(iface); -+ RTW_INFO(ADPT_FMT " write port cancel\n", ADPT_ARG(iface)); -+ } -+ } -+ RTW_INFO("lifetime_en=%x, pkt_lifetime=%x\n", rtw_read8(padapter, 0x426), rtw_read32(padapter, 0x4c0)); -+ rtw_msleep_os(200); -+ -+ /* 1. stop thread */ -+ rtw_set_drv_stopped(padapter); /*for stop thread*/ -+ rtw_mi_stop_drv_threads(padapter); -+ -+ 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) && (CONFIG_RTW_SDIO_RELEASE_IRQ >= 1) -+ sdio_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 -+ if(registry_par->suspend_type == FW_IPS_WRC) -+ rtw_hal_set_hwreg(padapter, HW_VAR_VENDOR_WOW_MODE, &en); -+#ifdef CONFIG_LPS -+ if (!pwrpriv->wowlan_pno_enable) { -+ if(pwrpriv->wowlan_power_mgmt != PS_MODE_ACTIVE) { -+ rtw_wow_lps_level_decide(padapter, _TRUE); -+ } -+ } -+#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, WIFI_ASOC_STATE)) { -+ 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, WIFI_UNDER_SURVEY) == _TRUE) { -+ RTW_PRINT("%s: fw_under_survey\n", __func__); -+ rtw_indicate_scan_done(padapter, 1); -+ clr_fwstate(pmlmepriv, WIFI_UNDER_SURVEY); -+ } -+ -+ 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); -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_mi_buddy_suspend_free_assoc_resource(padapter); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT); -+#endif -+ -+ if (pwrpriv->wowlan_pno_enable) { -+ RTW_PRINT("%s: pno: %d\n", __func__, pwrpriv->wowlan_pno_enable); -+#ifndef RTW_HALMAC -+#ifdef CONFIG_FWLPS_IN_IPS -+ rtw_set_fw_in_ips_mode(padapter, _TRUE); -+#endif -+#else /* RTW_HALMAC */ -+ // TODO(Owen): Controlled by wowlan lps_level -+ /* Although ICs with HALMAC can have NLO PS (and LCLK) via H2C 0x8C, -+ * we write RPWM here so that the enter/leave LCLK actions can be -+ * symmetrical. -+ */ -+#ifdef CONFIG_LPS_LCLK -+ rtw_set_lps_lclk(padapter, _TRUE); -+#endif -+#endif -+ } -+#ifdef CONFIG_LPS -+ else { -+ if(pwrpriv->wowlan_power_mgmt != PS_MODE_ACTIVE) { -+ rtw_set_ps_mode(padapter, pwrpriv->wowlan_power_mgmt, 0, 0, "WOWLAN"); -+ } -+ } -+#endif /* #ifdef CONFIG_LPS */ -+ -+ 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 pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct wowlan_ioctl_param poidparam; -+ 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); -+ -+ rtw_mi_netif_stop_queue(padapter); -+ -+ /* 0. Power off LED */ -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+#ifdef CONFIG_SDIO_HCI -+ /* 2.only for SDIO disable interrupt*/ -+ rtw_intf_stop(padapter); -+ -+ /* 2.1 clean interrupt */ -+ rtw_hal_clear_interrupt(padapter); -+#endif /* CONFIG_SDIO_HCI */ -+ -+ /* 1. stop thread */ -+ rtw_set_drv_stopped(padapter); /*for stop thread*/ -+ rtw_mi_stop_drv_threads(padapter); -+ rtw_clr_drv_stopped(padapter); /*for 32k command*/ -+ -+ #if defined(CONFIG_SDIO_HCI) && (CONFIG_RTW_SDIO_RELEASE_IRQ >= 1) -+ sdio_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 -+#ifdef CONFIG_LPS -+ if (!pwrpriv->wowlan_pno_enable) { -+ if(pwrpriv->wowlan_power_mgmt != PS_MODE_ACTIVE) { -+ rtw_wow_lps_level_decide(padapter, _TRUE); -+ } -+ } -+#endif -+ poidparam.subcode = WOWLAN_AP_ENABLE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); -+ -+ RTW_PRINT("%s: wowmode suspending\n", __func__); -+ -+ 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); -+ } -+ -+ /*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 | WIFI_MESH_STATE) == _FALSE) -+ rtw_suspend_free_assoc_resource(iface); -+ } -+ } -+ -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT); -+#endif -+ -+#ifdef CONFIG_LPS -+ if(pwrpriv->wowlan_power_mgmt != PS_MODE_ACTIVE) { -+ rtw_set_ps_mode(padapter, pwrpriv->wowlan_power_mgmt, 0, 0, "AP-WOWLAN"); -+ } -+#endif -+ -+ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif /* CONFIG_AP_WOWLAN */ -+ -+ -+int rtw_suspend_normal(_adapter *padapter) -+{ -+ int ret = _SUCCESS; -+ -+ 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_caroff_qstop(padapter); -+ -+ rtw_mi_suspend_free_assoc_resource(padapter); -+ -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ -+ 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__); -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_set_drv_stopped(padapter); /*for stop thread*/ -+ rtw_stop_cmd_thread(padapter); -+ rtw_drv_stop_vir_ifaces(adapter_to_dvobj(padapter)); -+#endif -+ rtw_dev_unload(padapter); -+ -+ #ifdef CONFIG_SDIO_HCI -+ sdio_deinit(adapter_to_dvobj(padapter)); -+ -+ #if (CONFIG_RTW_SDIO_RELEASE_IRQ >= 1) -+ sdio_free_irq(adapter_to_dvobj(padapter)); -+ #endif -+ #endif /*CONFIG_SDIO_HCI*/ -+ -+ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+ -+int rtw_suspend_common(_adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+#ifdef CONFIG_WOWLAN -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct registry_priv *registry_par = &padapter->registrypriv; -+#endif -+ -+ int ret = 0; -+ systime 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_mi_scan_abort(padapter, _TRUE); -+ rtw_ps_deny(padapter, PS_DENY_SUSPEND); -+ -+ rtw_mi_cancel_all_timer(padapter); -+ LeaveAllPowerSaveModeDirect(padapter); -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_SUSPEND); -+ -+ if (rtw_mi_check_status(padapter, MI_AP_MODE) == _FALSE) { -+#ifdef CONFIG_WOWLAN -+ if (WOWLAN_IS_STA_MIX_MODE(padapter)) -+ pwrpriv->wowlan_mode = _TRUE; -+ else if ( registry_par->wowlan_enable && check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) -+ 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 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; -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ int ret = _SUCCESS; -+ u8 en = _FALSE; -+ -+ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (padapter) { -+ 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; -+ -+ if (pwrpriv->wowlan_pno_enable) { -+ RTW_PRINT("%s: pno: %d\n", __func__, pwrpriv->wowlan_pno_enable); -+#ifndef RTW_HALMAC -+#ifdef CONFIG_FWLPS_IN_IPS -+ rtw_set_fw_in_ips_mode(padapter, _FALSE); -+#endif -+#else /* RTW_HALMAC */ -+#ifdef CONFIG_LPS_LCLK -+ // TODO(Owen): Controlled by wowlan lps_level -+ rtw_set_lps_lclk(padapter, _FALSE); -+#endif -+#endif -+ } else { -+#ifdef CONFIG_LPS -+ if(pwrpriv->wowlan_power_mgmt != PS_MODE_ACTIVE) { -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); -+ rtw_wow_lps_level_decide(padapter, _FALSE); -+ } -+#endif /* CONFIG_LPS */ -+ } -+ -+ rtw_write8(padapter, 0x426, psdpriv->lifetime_en); -+ rtw_write32(padapter, 0x4c0, psdpriv->pkt_lifetime); -+ -+ pwrpriv->bFwCurrentInPSMode = _FALSE; -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_PCI_HCI) -+ rtw_mi_intf_stop(padapter); -+ rtw_hal_clear_interrupt(padapter); -+#endif -+ -+ #if defined(CONFIG_SDIO_HCI) && (CONFIG_RTW_SDIO_RELEASE_IRQ >= 1) -+ if (sdio_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"); -+ -+ if(registry_par->suspend_type == FW_IPS_WRC) -+ rtw_hal_set_hwreg(padapter, HW_VAR_VENDOR_WOW_MODE, &en); -+ -+ rtw_mi_start_drv_threads(padapter); -+ -+ rtw_mi_intf_start(padapter); -+ -+ if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && !check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) { -+ if (!rtw_is_surprise_removed(padapter)) { -+ rtw_hal_deinit(padapter); -+ rtw_hal_init(padapter); -+ } -+ RTW_INFO("FW_IPS_DISABLE_BBRF hal deinit, hal init \n"); -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_mi_buddy_netif_carrier_on(padapter); -+#endif -+ -+ /* start netif queue */ -+ 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); -+ } -+ -+ 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, _TRUE); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ } else { -+ RTW_INFO("%s: do roaming\n", __func__); -+ rtw_roaming(padapter, NULL); -+ } -+ } -+ -+ 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_RTW_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 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) { -+ pwrpriv = adapter_to_pwrctl(padapter); -+ } else { -+ pdbgpriv->dbg_resume_error_cnt++; -+ ret = -1; -+ goto exit; -+ } -+ -+ -+#ifdef CONFIG_LPS -+ if(pwrpriv->wowlan_power_mgmt != PS_MODE_ACTIVE) { -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "AP-WOWLAN"); -+ rtw_wow_lps_level_decide(padapter, _FALSE); -+ } -+#endif /* CONFIG_LPS */ -+ -+ pwrpriv->bFwCurrentInPSMode = _FALSE; -+ -+ rtw_hal_disable_interrupt(padapter); -+ -+ rtw_hal_clear_interrupt(padapter); -+ -+ #if defined(CONFIG_SDIO_HCI) && (CONFIG_RTW_SDIO_RELEASE_IRQ >= 1) -+ if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { -+ ret = -1; -+ goto exit; -+ } -+ #endif -+ -+ /* 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 (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); -+ } -+ -+ /*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 | WIFI_MESH_STATE | WIFI_ASOC_STATE)) -+ rtw_reset_drv_sw(iface); -+ } -+ } -+ -+ } -+ rtw_mi_intf_start(padapter); -+ -+ /* start netif queue */ -+ 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 */ -+ -+ 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_RTW_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(iface), get_fwstate(pmlmepriv)); -+ -+ if (rtw_chk_roam_flags(iface, RTW_ROAM_ON_RESUME)) -+ rtw_roaming(iface, NULL); -+ -+ } -+#ifdef CONFIG_AP_MODE -+ else if (MLME_IS_AP(iface) || MLME_IS_MESH(iface)) { -+ RTW_INFO(FUNC_ADPT_FMT" %s\n", FUNC_ADPT_ARG(iface), MLME_IS_AP(iface) ? "AP" : "MESH"); -+ rtw_ap_restore_network(iface); -+ } -+#endif -+ else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) -+ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(iface), get_fwstate(pmlmepriv)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(iface), 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)); -+ -+ #ifdef CONFIG_SDIO_HCI -+ /* interface init */ -+ if (sdio_init(adapter_to_dvobj(padapter)) != _SUCCESS) { -+ ret = -1; -+ goto exit; -+ } -+ #endif/*CONFIG_SDIO_HCI*/ -+ -+ rtw_clr_surprise_removed(padapter); -+ rtw_hal_disable_interrupt(padapter); -+ -+ #if defined(CONFIG_SDIO_HCI) && (CONFIG_RTW_SDIO_RELEASE_IRQ >= 1) -+ if (sdio_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_caron_qstart(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; -+ systime start_time = rtw_get_current_time(); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+#ifdef CONFIG_WAKE_ON_BT -+ u8 disable = 0; -+#endif -+ -+ if (pwrpriv == NULL) -+ return 0; -+ -+ 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, MI_AP_MODE) == _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, MI_AP_MODE)) { -+#ifdef CONFIG_AP_WOWLAN -+ rtw_resume_process_ap_wow(padapter); -+#else -+ rtw_resume_process_normal(padapter); -+#endif /* CONFIG_AP_WOWLAN */ -+ } -+ -+#ifdef CONFIG_WAKE_ON_BT -+ rtw_hal_set_hwreg(padapter, HW_VAR_WAKE_ON_BT_GPIO_SWITCH, (u8 *)(&disable)); -+#endif -+ -+ pwrpriv->bInSuspend = _FALSE; -+ pwrpriv->wowlan_in_resume = _FALSE; -+ -+ 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 */ -+ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ -+int rtw_vendor_ie_get_api(struct net_device *dev, int ie_num, char *extra, -+ u16 extra_len) -+{ -+ int ret = 0; -+ -+ ret = rtw_vendor_ie_get_raw_data(dev, ie_num, extra, extra_len); -+ return ret; -+} -+EXPORT_SYMBOL(rtw_vendor_ie_get_api); -+ -+int rtw_vendor_ie_set_api(struct net_device *dev, char *extra) -+{ -+ return rtw_vendor_ie_set(dev, NULL, NULL, extra); -+} -+EXPORT_SYMBOL(rtw_vendor_ie_set_api); -+ -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/recv_linux.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/recv_linux.c -new file mode 100755 -index 000000000..00a69f2c3 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/recv_linux.c -@@ -0,0 +1,739 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+int rtw_os_recvframe_duplicate_skb(_adapter *padapter, union recv_frame *pcloneframe, _pkt *pskb) -+{ -+ int res = _SUCCESS; -+ _pkt *pkt_copy = NULL; -+ -+ 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) { -+ RTW_INFO("%s: rtw_skb_clone success, RX throughput may be low!\n", __FUNCTION__); -+ 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_os_pkt_free(precvframe->u.hdr.pkt); -+ 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 = 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++) { -+ rtw_os_free_recvframe(precvframe); -+ precvframe++; -+ } -+} -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#if !defined(CONFIG_RTL8822B) && !defined(CONFIG_RTL8822C) && !defined(CONFIG_RTL8723F) -+#ifdef CONFIG_SDIO_RX_COPY -+static int sdio_init_recvbuf_with_skb(struct recv_priv *recvpriv, struct recv_buf *rbuf, u32 size) -+{ -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ if (RBUF_IS_PREALLOC(rbuf)) { -+ rbuf->pskb = rtw_alloc_skb_premem(size); -+ if (!rbuf->pskb) { -+ RTW_WARN("%s: Fail to get pre-alloc skb! size=%d\n", __func__, size); -+ return _FAIL; -+ } -+ skb_set_tail_pointer(rbuf->pskb, 0); /* TODO: do this in RTKM */ -+ } else -+#else -+ { -+ SIZE_PTR tmpaddr = 0; -+ SIZE_PTR alignment = 0; -+ -+ rbuf->pskb = rtw_skb_alloc(size + RECVBUFF_ALIGN_SZ); -+ if (!rbuf->pskb) -+ return _FAIL; -+ -+ tmpaddr = (SIZE_PTR)rbuf->pskb->data; -+ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ - 1); -+ skb_reserve(rbuf->pskb, (RECVBUFF_ALIGN_SZ - alignment)); -+ } -+#endif -+ -+ rbuf->pskb->dev = recvpriv->adapter->pnetdev; -+ -+ /* init recvbuf */ -+ rbuf->phead = rbuf->pskb->head; -+ rbuf->pdata = rbuf->pskb->data; -+ rbuf->ptail = skb_tail_pointer(rbuf->pskb); -+ rbuf->pend = skb_end_pointer(rbuf->pskb); -+ rbuf->len = 0; -+ -+ return _SUCCESS; -+} -+#endif /* CONFIG_SDIO_RX_COPY */ -+#endif /* !defined(CONFIG_RTL8822B) && !defined(CONFIG_RTL8822C) && !defined(CONFIG_RTL8723F) */ -+#endif /* defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) */ -+ -+/* alloc os related resource in struct recv_buf */ -+int rtw_os_recvbuf_resource_alloc(_adapter *padapter, struct recv_buf *precvbuf, u32 size) -+{ -+ int res = _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; -+#endif -+ -+ 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)size, &precvbuf->dma_transfer_addr); -+ precvbuf->pbuf = precvbuf->pallocated_buf; -+ if (precvbuf->pallocated_buf == NULL) -+ return _FAIL; -+#endif /* CONFIG_USE_USB_BUFFER_ALLOC_RX */ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ #if !defined(CONFIG_RTL8822B) && !defined(CONFIG_RTL8822C) && !defined(CONFIG_RTL8723F) -+ #ifdef CONFIG_SDIO_RX_COPY -+ res = sdio_init_recvbuf_with_skb(&padapter->recvpriv, precvbuf, size); -+ #endif -+ #endif -+ -+#endif /* CONFIG_XXX_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, const u8 *da, const u8 *sa -+ , u8 *msdu ,u16 msdu_len, enum rtw_rx_llc_hdl llc_hdl) -+{ -+ 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(msdu_len + 14); -+ if (sub_skb) { -+ skb_reserve(sub_skb, 14); -+ data_ptr = (u8 *)skb_put(sub_skb, msdu_len); -+ _rtw_memcpy(data_ptr, msdu, msdu_len); -+ } else -+#endif /* CONFIG_SKB_COPY */ -+ { -+ sub_skb = rtw_skb_clone(prframe->u.hdr.pkt); -+ if (sub_skb) { -+ sub_skb->data = msdu; -+ sub_skb->len = msdu_len; -+ skb_set_tail_pointer(sub_skb, msdu_len); -+ } else { -+ RTW_INFO("%s(): rtw_skb_clone() Fail!!!\n", __FUNCTION__); -+ return NULL; -+ } -+ } -+ -+ if (llc_hdl) { -+ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ skb_pull(sub_skb, SNAP_SIZE); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), sa, ETH_ALEN); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), da, ETH_ALEN); -+ } else { -+ /* Leave Ethernet header part of hdr and full payload */ -+ u16 len; -+ -+ len = htons(sub_skb->len); -+ _rtw_memcpy(skb_push(sub_skb, 2), &len, 2); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), sa, ETH_ALEN); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), da, 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 -+ /* -+ cloned SKB use dataref to avoid kernel release it. -+ But dataref changed in napi_gro_receive. -+ So, we should prevent cloned SKB go into napi_gro_receive. -+ */ -+ if (pregistrypriv->en_gro && !skb_cloned(pskb)) { -+ 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) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) && defined(CONFIG_PCI_HCI) -+ napi_complete_done(napi, work_done); -+#else -+ napi_complete(napi); -+#endif -+ if (!skb_queue_empty(&precvpriv->rx_napi_skb_queue)) -+ napi_schedule(napi); -+ } -+ -+ return work_done; -+} -+ -+#ifdef CONFIG_RTW_NAPI_DYNAMIC -+void dynamic_napi_th_chk (_adapter *adapter) -+{ -+ -+ if (adapter->registrypriv.en_napi) { -+ struct dvobj_priv *dvobj; -+ struct registry_priv *registry; -+ -+ dvobj = adapter_to_dvobj(adapter); -+ registry = &adapter->registrypriv; -+ if (dvobj->traffic_stat.cur_rx_tp > registry->napi_threshold) -+ dvobj->en_napi_dynamic = 1; -+ else -+ dvobj->en_napi_dynamic = 0; -+ } -+ -+} -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+#endif /* CONFIG_RTW_NAPI */ -+ -+void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, union recv_frame *rframe) -+{ -+ 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) { -+ struct ethhdr *ehdr = (struct ethhdr *)pkt->data; -+ -+ DBG_COUNTER(padapter->rx_logs.os_indicate); -+ -+#ifdef CONFIG_BR_EXT -+ if (!adapter_use_wds(padapter) && check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE) { -+ /* Insert NAT2.5 RX here! */ -+ #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ br_port = padapter->pnetdev->br_port; -+ #else -+ rcu_read_lock(); -+ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); -+ rcu_read_unlock(); -+ #endif -+ -+ if (br_port) { -+ 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 */ -+ -+ /* 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; -+ pkt->ip_summed = CHECKSUM_NONE; /* CONFIG_TCP_CSUM_OFFLOAD_RX */ -+ -+ if (padapter->recvpriv.ip_statistic.enabled) -+ rtw_rx_dbg_monitor_ip_statistic(padapter, pkt); -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_RX -+ if ((rframe->u.hdr.attrib.csum_valid == 1) -+ && (rframe->u.hdr.attrib.csum_err == 0)) -+ pkt->ip_summed = CHECKSUM_UNNECESSARY; -+#endif /* CONFIG_TCP_CSUM_OFFLOAD_RX */ -+ -+#ifdef CONFIG_RTW_NAPI -+#ifdef CONFIG_RTW_NAPI_DYNAMIC -+ if (!skb_queue_empty(&precvpriv->rx_napi_skb_queue) -+ && !adapter_to_dvobj(padapter)->en_napi_dynamic -+ ) -+ napi_recv(padapter, RTL_NAPI_WEIGHT); -+#endif -+ -+ if (pregistrypriv->en_napi -+ #ifdef CONFIG_RTW_NAPI_DYNAMIC -+ && adapter_to_dvobj(padapter)->en_napi_dynamic -+ #endif -+ ) { -+ skb_queue_tail(&precvpriv->rx_napi_skb_queue, pkt); -+ #ifndef CONFIG_RTW_NAPI_V2 -+ napi_schedule(&padapter->napi); -+ #endif -+ 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 security_priv *psecuritypriv = &padapter->securitypriv; -+ systime 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->cmn.mac_addr, 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->cmn.mac_addr, 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 -+} -+ -+#ifdef CONFIG_HOSTAPD_MLME -+void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ _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 /* CONFIG_HOSTAPD_MLME */ -+ -+#ifdef CONFIG_WIFI_MONITOR -+/* -+ precv_frame: impossible to be NULL -+ precv_frame: free by caller -+ */ -+int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ int ret = _FAIL; -+ _pkt *skb; -+ -+ 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 */ -+ -+ /* send to kernel */ -+ rtw_netif_rx(padapter->pnetdev, skb); -+ -+ /* pointers to NULL before rtw_free_recvframe() */ -+ precv_frame->u.hdr.pkt = NULL; -+ -+ ret = _SUCCESS; -+ -+_recv_drop: -+ return ret; -+} -+#endif /* CONFIG_WIFI_MONITOR */ -+ -+inline void rtw_rframe_set_os_pkt(union recv_frame *rframe) -+{ -+ _pkt *skb = rframe->u.hdr.pkt; -+ -+ skb->data = rframe->u.hdr.rx_data; -+ skb_set_tail_pointer(skb, rframe->u.hdr.len); -+ skb->len = rframe->u.hdr.len; -+} -+ -+int rtw_recv_indicatepkt(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct recv_priv *precvpriv; -+ _queue *pfree_recv_queue; -+ -+ precvpriv = &(padapter->recvpriv); -+ pfree_recv_queue = &(precvpriv->free_recv_queue); -+ -+ if (precv_frame->u.hdr.pkt == NULL) -+ goto _recv_indicatepkt_drop; -+ -+ rtw_os_recv_indicate_pkt(padapter, precv_frame->u.hdr.pkt, precv_frame); -+ -+ precv_frame->u.hdr.pkt = NULL; -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ return _SUCCESS; -+ -+_recv_indicatepkt_drop: -+ 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) -+{ -+#ifdef CONFIG_USB_HCI -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ 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 -+ -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/rhashtable.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/rhashtable.c -new file mode 100644 -index 000000000..0163a4b07 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/rhashtable.c -@@ -0,0 +1,844 @@ -+/* -+ * Resizable, Scalable, Concurrent Hash Table -+ * -+ * Copyright (c) 2015 Herbert Xu -+ * Copyright (c) 2014-2015 Thomas Graf -+ * Copyright (c) 2008-2014 Patrick McHardy -+ * -+ * Code partially derived from nft_hash -+ * Rewritten with rehash code from br_multicast plus single list -+ * pointer as suggested by Josh Triplett -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 as -+ * published by the Free Software Foundation. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define HASH_DEFAULT_SIZE 64UL -+#define HASH_MIN_SIZE 4U -+#define BUCKET_LOCKS_PER_CPU 128UL -+ -+static u32 head_hashfn(struct rhashtable *ht, -+ const struct bucket_table *tbl, -+ const struct rhash_head *he) -+{ -+ return rht_head_hashfn(ht, tbl, he, ht->p); -+} -+ -+#ifdef CONFIG_PROVE_LOCKING -+#define ASSERT_RHT_MUTEX(HT) BUG_ON(!lockdep_rht_mutex_is_held(HT)) -+ -+int lockdep_rht_mutex_is_held(struct rhashtable *ht) -+{ -+ return (debug_locks) ? lockdep_is_held(&ht->mutex) : 1; -+} -+ -+int lockdep_rht_bucket_is_held(const struct bucket_table *tbl, u32 hash) -+{ -+ spinlock_t *lock = rht_bucket_lock(tbl, hash); -+ -+ return (debug_locks) ? lockdep_is_held(lock) : 1; -+} -+#else -+#define ASSERT_RHT_MUTEX(HT) -+#endif -+ -+ -+static int alloc_bucket_locks(struct rhashtable *ht, struct bucket_table *tbl, -+ gfp_t gfp) -+{ -+ unsigned int i, size; -+#if defined(CONFIG_PROVE_LOCKING) -+ unsigned int nr_pcpus = 2; -+#else -+ unsigned int nr_pcpus = num_possible_cpus(); -+#endif -+ -+ nr_pcpus = min_t(unsigned int, nr_pcpus, 32UL); -+ size = roundup_pow_of_two(nr_pcpus * ht->p.locks_mul); -+ -+ /* Never allocate more than 0.5 locks per bucket */ -+ size = min_t(unsigned int, size, tbl->size >> 1); -+ -+ if (sizeof(spinlock_t) != 0) { -+#ifdef CONFIG_NUMA -+ if (size * sizeof(spinlock_t) > PAGE_SIZE && -+ gfp == GFP_KERNEL) -+ tbl->locks = vmalloc(size * sizeof(spinlock_t)); -+ else -+#endif -+ tbl->locks = kmalloc_array(size, sizeof(spinlock_t), -+ gfp); -+ if (!tbl->locks) -+ return -ENOMEM; -+ for (i = 0; i < size; i++) -+ spin_lock_init(&tbl->locks[i]); -+ } -+ tbl->locks_mask = size - 1; -+ -+ return 0; -+} -+ -+static void bucket_table_free(const struct bucket_table *tbl) -+{ -+ if (tbl) -+ kvfree(tbl->locks); -+ -+ kvfree(tbl); -+} -+ -+static void bucket_table_free_rcu(struct rcu_head *head) -+{ -+ bucket_table_free(container_of(head, struct bucket_table, rcu)); -+} -+ -+static struct bucket_table *bucket_table_alloc(struct rhashtable *ht, -+ size_t nbuckets, -+ gfp_t gfp) -+{ -+ struct bucket_table *tbl = NULL; -+ size_t size; -+ int i; -+ -+ size = sizeof(*tbl) + nbuckets * sizeof(tbl->buckets[0]); -+ if (size <= (PAGE_SIZE << PAGE_ALLOC_COSTLY_ORDER) || -+ gfp != GFP_KERNEL) -+ tbl = kzalloc(size, gfp | __GFP_NOWARN | __GFP_NORETRY); -+ if (tbl == NULL && gfp == GFP_KERNEL) -+ tbl = vzalloc(size); -+ if (tbl == NULL) -+ return NULL; -+ -+ tbl->size = nbuckets; -+ -+ if (alloc_bucket_locks(ht, tbl, gfp) < 0) { -+ bucket_table_free(tbl); -+ return NULL; -+ } -+ -+ INIT_LIST_HEAD(&tbl->walkers); -+ -+ get_random_bytes(&tbl->hash_rnd, sizeof(tbl->hash_rnd)); -+ -+ for (i = 0; i < nbuckets; i++) -+ INIT_RHT_NULLS_HEAD(tbl->buckets[i], ht, i); -+ -+ return tbl; -+} -+ -+static struct bucket_table *rhashtable_last_table(struct rhashtable *ht, -+ struct bucket_table *tbl) -+{ -+ struct bucket_table *new_tbl; -+ -+ do { -+ new_tbl = tbl; -+ tbl = rht_dereference_rcu(tbl->future_tbl, ht); -+ } while (tbl); -+ -+ return new_tbl; -+} -+ -+static int rhashtable_rehash_one(struct rhashtable *ht, unsigned int old_hash) -+{ -+ struct bucket_table *old_tbl = rht_dereference(ht->tbl, ht); -+ struct bucket_table *new_tbl = rhashtable_last_table(ht, -+ rht_dereference_rcu(old_tbl->future_tbl, ht)); -+ struct rhash_head __rcu **pprev = &old_tbl->buckets[old_hash]; -+ int err = -ENOENT; -+ struct rhash_head *head, *next, *entry; -+ spinlock_t *new_bucket_lock; -+ unsigned int new_hash; -+ -+ rht_for_each(entry, old_tbl, old_hash) { -+ err = 0; -+ next = rht_dereference_bucket(entry->next, old_tbl, old_hash); -+ -+ if (rht_is_a_nulls(next)) -+ break; -+ -+ pprev = &entry->next; -+ } -+ -+ if (err) -+ goto out; -+ -+ new_hash = head_hashfn(ht, new_tbl, entry); -+ -+ new_bucket_lock = rht_bucket_lock(new_tbl, new_hash); -+ -+ spin_lock_nested(new_bucket_lock, SINGLE_DEPTH_NESTING); -+ head = rht_dereference_bucket(new_tbl->buckets[new_hash], -+ new_tbl, new_hash); -+ -+ RCU_INIT_POINTER(entry->next, head); -+ -+ rcu_assign_pointer(new_tbl->buckets[new_hash], entry); -+ spin_unlock(new_bucket_lock); -+ -+ rcu_assign_pointer(*pprev, next); -+ -+out: -+ return err; -+} -+ -+static void rhashtable_rehash_chain(struct rhashtable *ht, -+ unsigned int old_hash) -+{ -+ struct bucket_table *old_tbl = rht_dereference(ht->tbl, ht); -+ spinlock_t *old_bucket_lock; -+ -+ old_bucket_lock = rht_bucket_lock(old_tbl, old_hash); -+ -+ spin_lock_bh(old_bucket_lock); -+ while (!rhashtable_rehash_one(ht, old_hash)) -+ ; -+ old_tbl->rehash++; -+ spin_unlock_bh(old_bucket_lock); -+} -+ -+static int rhashtable_rehash_attach(struct rhashtable *ht, -+ struct bucket_table *old_tbl, -+ struct bucket_table *new_tbl) -+{ -+ /* Protect future_tbl using the first bucket lock. */ -+ spin_lock_bh(old_tbl->locks); -+ -+ /* Did somebody beat us to it? */ -+ if (rcu_access_pointer(old_tbl->future_tbl)) { -+ spin_unlock_bh(old_tbl->locks); -+ return -EEXIST; -+ } -+ -+ /* Make insertions go into the new, empty table right away. Deletions -+ * and lookups will be attempted in both tables until we synchronize. -+ */ -+ rcu_assign_pointer(old_tbl->future_tbl, new_tbl); -+ -+ /* Ensure the new table is visible to readers. */ -+ smp_wmb(); -+ -+ spin_unlock_bh(old_tbl->locks); -+ -+ return 0; -+} -+ -+static int rhashtable_rehash_table(struct rhashtable *ht) -+{ -+ struct bucket_table *old_tbl = rht_dereference(ht->tbl, ht); -+ struct bucket_table *new_tbl; -+ struct rhashtable_walker *walker; -+ unsigned int old_hash; -+ -+ new_tbl = rht_dereference(old_tbl->future_tbl, ht); -+ if (!new_tbl) -+ return 0; -+ -+ for (old_hash = 0; old_hash < old_tbl->size; old_hash++) -+ rhashtable_rehash_chain(ht, old_hash); -+ -+ /* Publish the new table pointer. */ -+ rcu_assign_pointer(ht->tbl, new_tbl); -+ -+ spin_lock(&ht->lock); -+ list_for_each_entry(walker, &old_tbl->walkers, list) -+ walker->tbl = NULL; -+ spin_unlock(&ht->lock); -+ -+ /* Wait for readers. All new readers will see the new -+ * table, and thus no references to the old table will -+ * remain. -+ */ -+ call_rcu(&old_tbl->rcu, bucket_table_free_rcu); -+ -+ return rht_dereference(new_tbl->future_tbl, ht) ? -EAGAIN : 0; -+} -+ -+/** -+ * rhashtable_expand - Expand hash table while allowing concurrent lookups -+ * @ht: the hash table to expand -+ * -+ * A secondary bucket array is allocated and the hash entries are migrated. -+ * -+ * This function may only be called in a context where it is safe to call -+ * synchronize_rcu(), e.g. not within a rcu_read_lock() section. -+ * -+ * The caller must ensure that no concurrent resizing occurs by holding -+ * ht->mutex. -+ * -+ * It is valid to have concurrent insertions and deletions protected by per -+ * bucket locks or concurrent RCU protected lookups and traversals. -+ */ -+static int rhashtable_expand(struct rhashtable *ht) -+{ -+ struct bucket_table *new_tbl, *old_tbl = rht_dereference(ht->tbl, ht); -+ int err; -+ -+ ASSERT_RHT_MUTEX(ht); -+ -+ old_tbl = rhashtable_last_table(ht, old_tbl); -+ -+ new_tbl = bucket_table_alloc(ht, old_tbl->size * 2, GFP_KERNEL); -+ if (new_tbl == NULL) -+ return -ENOMEM; -+ -+ err = rhashtable_rehash_attach(ht, old_tbl, new_tbl); -+ if (err) -+ bucket_table_free(new_tbl); -+ -+ return err; -+} -+ -+/** -+ * rhashtable_shrink - Shrink hash table while allowing concurrent lookups -+ * @ht: the hash table to shrink -+ * -+ * This function shrinks the hash table to fit, i.e., the smallest -+ * size would not cause it to expand right away automatically. -+ * -+ * The caller must ensure that no concurrent resizing occurs by holding -+ * ht->mutex. -+ * -+ * The caller must ensure that no concurrent table mutations take place. -+ * It is however valid to have concurrent lookups if they are RCU protected. -+ * -+ * It is valid to have concurrent insertions and deletions protected by per -+ * bucket locks or concurrent RCU protected lookups and traversals. -+ */ -+static int rhashtable_shrink(struct rhashtable *ht) -+{ -+ struct bucket_table *new_tbl, *old_tbl = rht_dereference(ht->tbl, ht); -+ unsigned int size; -+ int err; -+ -+ ASSERT_RHT_MUTEX(ht); -+ -+ size = roundup_pow_of_two(atomic_read(&ht->nelems) * 3 / 2); -+ if (size < ht->p.min_size) -+ size = ht->p.min_size; -+ -+ if (old_tbl->size <= size) -+ return 0; -+ -+ if (rht_dereference(old_tbl->future_tbl, ht)) -+ return -EEXIST; -+ -+ new_tbl = bucket_table_alloc(ht, size, GFP_KERNEL); -+ if (new_tbl == NULL) -+ return -ENOMEM; -+ -+ err = rhashtable_rehash_attach(ht, old_tbl, new_tbl); -+ if (err) -+ bucket_table_free(new_tbl); -+ -+ return err; -+} -+ -+static void rht_deferred_worker(struct work_struct *work) -+{ -+ struct rhashtable *ht; -+ struct bucket_table *tbl; -+ int err = 0; -+ -+ ht = container_of(work, struct rhashtable, run_work); -+ mutex_lock(&ht->mutex); -+ -+ tbl = rht_dereference(ht->tbl, ht); -+ tbl = rhashtable_last_table(ht, tbl); -+ -+ if (rht_grow_above_75(ht, tbl)) -+ rhashtable_expand(ht); -+ else if (ht->p.automatic_shrinking && rht_shrink_below_30(ht, tbl)) -+ rhashtable_shrink(ht); -+ -+ err = rhashtable_rehash_table(ht); -+ -+ mutex_unlock(&ht->mutex); -+ -+ if (err) -+ schedule_work(&ht->run_work); -+} -+ -+static bool rhashtable_check_elasticity(struct rhashtable *ht, -+ struct bucket_table *tbl, -+ unsigned int hash) -+{ -+ unsigned int elasticity = ht->elasticity; -+ struct rhash_head *head; -+ -+ rht_for_each(head, tbl, hash) -+ if (!--elasticity) -+ return true; -+ -+ return false; -+} -+ -+int rhashtable_insert_rehash(struct rhashtable *ht, -+ struct bucket_table *tbl) -+{ -+ struct bucket_table *old_tbl; -+ struct bucket_table *new_tbl; -+ unsigned int size; -+ int err; -+ -+ old_tbl = rht_dereference_rcu(ht->tbl, ht); -+ -+ size = tbl->size; -+ -+ err = -EBUSY; -+ -+ if (rht_grow_above_75(ht, tbl)) -+ size *= 2; -+ /* Do not schedule more than one rehash */ -+ else if (old_tbl != tbl) -+ goto fail; -+ -+ err = -ENOMEM; -+ -+ new_tbl = bucket_table_alloc(ht, size, GFP_ATOMIC); -+ if (new_tbl == NULL) -+ goto fail; -+ -+ err = rhashtable_rehash_attach(ht, tbl, new_tbl); -+ if (err) { -+ bucket_table_free(new_tbl); -+ if (err == -EEXIST) -+ err = 0; -+ } else -+ schedule_work(&ht->run_work); -+ -+ return err; -+ -+fail: -+ /* Do not fail the insert if someone else did a rehash. */ -+ if (likely(rcu_dereference_raw(tbl->future_tbl))) -+ return 0; -+ -+ /* Schedule async rehash to retry allocation in process context. */ -+ if (err == -ENOMEM) -+ schedule_work(&ht->run_work); -+ -+ return err; -+} -+ -+struct bucket_table *rhashtable_insert_slow(struct rhashtable *ht, -+ const void *key, -+ struct rhash_head *obj, -+ struct bucket_table *tbl) -+{ -+ struct rhash_head *head; -+ unsigned int hash; -+ int err; -+ -+ tbl = rhashtable_last_table(ht, tbl); -+ hash = head_hashfn(ht, tbl, obj); -+ spin_lock_nested(rht_bucket_lock(tbl, hash), SINGLE_DEPTH_NESTING); -+ -+ err = -EEXIST; -+ if (key && rhashtable_lookup_fast(ht, key, ht->p)) -+ goto exit; -+ -+ err = -E2BIG; -+ if (unlikely(rht_grow_above_max(ht, tbl))) -+ goto exit; -+ -+ err = -EAGAIN; -+ if (rhashtable_check_elasticity(ht, tbl, hash) || -+ rht_grow_above_100(ht, tbl)) -+ goto exit; -+ -+ err = 0; -+ -+ head = rht_dereference_bucket(tbl->buckets[hash], tbl, hash); -+ -+ RCU_INIT_POINTER(obj->next, head); -+ -+ rcu_assign_pointer(tbl->buckets[hash], obj); -+ -+ atomic_inc(&ht->nelems); -+ -+exit: -+ spin_unlock(rht_bucket_lock(tbl, hash)); -+ -+ if (err == 0) -+ return NULL; -+ else if (err == -EAGAIN) -+ return tbl; -+ else -+ return ERR_PTR(err); -+} -+ -+/** -+ * rhashtable_walk_init - Initialise an iterator -+ * @ht: Table to walk over -+ * @iter: Hash table Iterator -+ * -+ * This function prepares a hash table walk. -+ * -+ * Note that if you restart a walk after rhashtable_walk_stop you -+ * may see the same object twice. Also, you may miss objects if -+ * there are removals in between rhashtable_walk_stop and the next -+ * call to rhashtable_walk_start. -+ * -+ * For a completely stable walk you should construct your own data -+ * structure outside the hash table. -+ * -+ * This function may sleep so you must not call it from interrupt -+ * context or with spin locks held. -+ * -+ * You must call rhashtable_walk_exit if this function returns -+ * successfully. -+ */ -+int rhashtable_walk_init(struct rhashtable *ht, struct rhashtable_iter *iter) -+{ -+ iter->ht = ht; -+ iter->p = NULL; -+ iter->slot = 0; -+ iter->skip = 0; -+ -+ iter->walker = kmalloc(sizeof(*iter->walker), GFP_KERNEL); -+ if (!iter->walker) -+ return -ENOMEM; -+ -+ spin_lock(&ht->lock); -+ iter->walker->tbl = -+ rcu_dereference_protected(ht->tbl, lockdep_is_held(&ht->lock)); -+ list_add(&iter->walker->list, &iter->walker->tbl->walkers); -+ spin_unlock(&ht->lock); -+ -+ return 0; -+} -+ -+/** -+ * rhashtable_walk_exit - Free an iterator -+ * @iter: Hash table Iterator -+ * -+ * This function frees resources allocated by rhashtable_walk_init. -+ */ -+void rhashtable_walk_exit(struct rhashtable_iter *iter) -+{ -+ spin_lock(&iter->ht->lock); -+ if (iter->walker->tbl) -+ list_del(&iter->walker->list); -+ spin_unlock(&iter->ht->lock); -+ kfree(iter->walker); -+} -+ -+/** -+ * rhashtable_walk_start - Start a hash table walk -+ * @iter: Hash table iterator -+ * -+ * Start a hash table walk. Note that we take the RCU lock in all -+ * cases including when we return an error. So you must always call -+ * rhashtable_walk_stop to clean up. -+ * -+ * Returns zero if successful. -+ * -+ * Returns -EAGAIN if resize event occured. Note that the iterator -+ * will rewind back to the beginning and you may use it immediately -+ * by calling rhashtable_walk_next. -+ */ -+int rhashtable_walk_start(struct rhashtable_iter *iter) -+ __acquires(RCU) -+{ -+ struct rhashtable *ht = iter->ht; -+ -+ rcu_read_lock(); -+ -+ spin_lock(&ht->lock); -+ if (iter->walker->tbl) -+ list_del(&iter->walker->list); -+ spin_unlock(&ht->lock); -+ -+ if (!iter->walker->tbl) { -+ iter->walker->tbl = rht_dereference_rcu(ht->tbl, ht); -+ return -EAGAIN; -+ } -+ -+ return 0; -+} -+ -+/** -+ * rhashtable_walk_next - Return the next object and advance the iterator -+ * @iter: Hash table iterator -+ * -+ * Note that you must call rhashtable_walk_stop when you are finished -+ * with the walk. -+ * -+ * Returns the next object or NULL when the end of the table is reached. -+ * -+ * Returns -EAGAIN if resize event occured. Note that the iterator -+ * will rewind back to the beginning and you may continue to use it. -+ */ -+void *rhashtable_walk_next(struct rhashtable_iter *iter) -+{ -+ struct bucket_table *tbl = iter->walker->tbl; -+ struct rhashtable *ht = iter->ht; -+ struct rhash_head *p = iter->p; -+ -+ if (p) { -+ p = rht_dereference_bucket_rcu(p->next, tbl, iter->slot); -+ goto next; -+ } -+ -+ for (; iter->slot < tbl->size; iter->slot++) { -+ int skip = iter->skip; -+ -+ rht_for_each_rcu(p, tbl, iter->slot) { -+ if (!skip) -+ break; -+ skip--; -+ } -+ -+next: -+ if (!rht_is_a_nulls(p)) { -+ iter->skip++; -+ iter->p = p; -+ return rht_obj(ht, p); -+ } -+ -+ iter->skip = 0; -+ } -+ -+ iter->p = NULL; -+ -+ /* Ensure we see any new tables. */ -+ smp_rmb(); -+ -+ iter->walker->tbl = rht_dereference_rcu(tbl->future_tbl, ht); -+ if (iter->walker->tbl) { -+ iter->slot = 0; -+ iter->skip = 0; -+ return ERR_PTR(-EAGAIN); -+ } -+ -+ return NULL; -+} -+ -+/** -+ * rhashtable_walk_stop - Finish a hash table walk -+ * @iter: Hash table iterator -+ * -+ * Finish a hash table walk. -+ */ -+void rhashtable_walk_stop(struct rhashtable_iter *iter) -+ __releases(RCU) -+{ -+ struct rhashtable *ht; -+ struct bucket_table *tbl = iter->walker->tbl; -+ -+ if (!tbl) -+ goto out; -+ -+ ht = iter->ht; -+ -+ spin_lock(&ht->lock); -+ if (tbl->rehash < tbl->size) -+ list_add(&iter->walker->list, &tbl->walkers); -+ else -+ iter->walker->tbl = NULL; -+ spin_unlock(&ht->lock); -+ -+ iter->p = NULL; -+ -+out: -+ rcu_read_unlock(); -+} -+ -+static size_t rounded_hashtable_size(const struct rhashtable_params *params) -+{ -+ return max(roundup_pow_of_two(params->nelem_hint * 4 / 3), -+ (unsigned long)params->min_size); -+} -+ -+static u32 rhashtable_jhash2(const void *key, u32 length, u32 seed) -+{ -+ return jhash2(key, length, seed); -+} -+ -+/** -+ * rhashtable_init - initialize a new hash table -+ * @ht: hash table to be initialized -+ * @params: configuration parameters -+ * -+ * Initializes a new hash table based on the provided configuration -+ * parameters. A table can be configured either with a variable or -+ * fixed length key: -+ * -+ * Configuration Example 1: Fixed length keys -+ * struct test_obj { -+ * int key; -+ * void * my_member; -+ * struct rhash_head node; -+ * }; -+ * -+ * struct rhashtable_params params = { -+ * .head_offset = offsetof(struct test_obj, node), -+ * .key_offset = offsetof(struct test_obj, key), -+ * .key_len = sizeof(int), -+ * .hashfn = jhash, -+ * .nulls_base = (1U << RHT_BASE_SHIFT), -+ * }; -+ * -+ * Configuration Example 2: Variable length keys -+ * struct test_obj { -+ * [...] -+ * struct rhash_head node; -+ * }; -+ * -+ * u32 my_hash_fn(const void *data, u32 len, u32 seed) -+ * { -+ * struct test_obj *obj = data; -+ * -+ * return [... hash ...]; -+ * } -+ * -+ * struct rhashtable_params params = { -+ * .head_offset = offsetof(struct test_obj, node), -+ * .hashfn = jhash, -+ * .obj_hashfn = my_hash_fn, -+ * }; -+ */ -+int rhashtable_init(struct rhashtable *ht, -+ const struct rhashtable_params *params) -+{ -+ struct bucket_table *tbl; -+ size_t size; -+ -+ size = HASH_DEFAULT_SIZE; -+ -+ if ((!params->key_len && !params->obj_hashfn) || -+ (params->obj_hashfn && !params->obj_cmpfn)) -+ return -EINVAL; -+ -+ if (params->nulls_base && params->nulls_base < (1U << RHT_BASE_SHIFT)) -+ return -EINVAL; -+ -+ memset(ht, 0, sizeof(*ht)); -+ mutex_init(&ht->mutex); -+ spin_lock_init(&ht->lock); -+ memcpy(&ht->p, params, sizeof(*params)); -+ -+ if (params->min_size) -+ ht->p.min_size = roundup_pow_of_two(params->min_size); -+ -+ if (params->max_size) -+ ht->p.max_size = rounddown_pow_of_two(params->max_size); -+ -+ if (params->insecure_max_entries) -+ ht->p.insecure_max_entries = -+ rounddown_pow_of_two(params->insecure_max_entries); -+ else -+ ht->p.insecure_max_entries = ht->p.max_size * 2; -+ -+ ht->p.min_size = max(ht->p.min_size, HASH_MIN_SIZE); -+ -+ if (params->nelem_hint) -+ size = rounded_hashtable_size(&ht->p); -+ -+ /* The maximum (not average) chain length grows with the -+ * size of the hash table, at a rate of (log N)/(log log N). -+ * The value of 16 is selected so that even if the hash -+ * table grew to 2^32 you would not expect the maximum -+ * chain length to exceed it unless we are under attack -+ * (or extremely unlucky). -+ * -+ * As this limit is only to detect attacks, we don't need -+ * to set it to a lower value as you'd need the chain -+ * length to vastly exceed 16 to have any real effect -+ * on the system. -+ */ -+ if (!params->insecure_elasticity) -+ ht->elasticity = 16; -+ -+ if (params->locks_mul) -+ ht->p.locks_mul = roundup_pow_of_two(params->locks_mul); -+ else -+ ht->p.locks_mul = BUCKET_LOCKS_PER_CPU; -+ -+ ht->key_len = ht->p.key_len; -+ if (!params->hashfn) { -+ ht->p.hashfn = jhash; -+ -+ if (!(ht->key_len & (sizeof(u32) - 1))) { -+ ht->key_len /= sizeof(u32); -+ ht->p.hashfn = rhashtable_jhash2; -+ } -+ } -+ -+ tbl = bucket_table_alloc(ht, size, GFP_KERNEL); -+ if (tbl == NULL) -+ return -ENOMEM; -+ -+ atomic_set(&ht->nelems, 0); -+ -+ RCU_INIT_POINTER(ht->tbl, tbl); -+ -+ INIT_WORK(&ht->run_work, rht_deferred_worker); -+ -+ return 0; -+} -+ -+/** -+ * rhashtable_free_and_destroy - free elements and destroy hash table -+ * @ht: the hash table to destroy -+ * @free_fn: callback to release resources of element -+ * @arg: pointer passed to free_fn -+ * -+ * Stops an eventual async resize. If defined, invokes free_fn for each -+ * element to releasal resources. Please note that RCU protected -+ * readers may still be accessing the elements. Releasing of resources -+ * must occur in a compatible manner. Then frees the bucket array. -+ * -+ * This function will eventually sleep to wait for an async resize -+ * to complete. The caller is responsible that no further write operations -+ * occurs in parallel. -+ */ -+void rhashtable_free_and_destroy(struct rhashtable *ht, -+ void (*free_fn)(void *ptr, void *arg), -+ void *arg) -+{ -+ const struct bucket_table *tbl; -+ unsigned int i; -+ -+ cancel_work_sync(&ht->run_work); -+ -+ mutex_lock(&ht->mutex); -+ tbl = rht_dereference(ht->tbl, ht); -+ if (free_fn) { -+ for (i = 0; i < tbl->size; i++) { -+ struct rhash_head *pos, *next; -+ -+ for (pos = rht_dereference(tbl->buckets[i], ht), -+ next = !rht_is_a_nulls(pos) ? -+ rht_dereference(pos->next, ht) : NULL; -+ !rht_is_a_nulls(pos); -+ pos = next, -+ next = !rht_is_a_nulls(pos) ? -+ rht_dereference(pos->next, ht) : NULL) -+ free_fn(rht_obj(ht, pos), arg); -+ } -+ } -+ -+ bucket_table_free(tbl); -+ mutex_unlock(&ht->mutex); -+} -+ -+void rhashtable_destroy(struct rhashtable *ht) -+{ -+ return rhashtable_free_and_destroy(ht, NULL, NULL); -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/rhashtable.h b/drivers/net/wireless/rtl8821cs/os_dep/linux/rhashtable.h -new file mode 100644 -index 000000000..b47107ff6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/rhashtable.h -@@ -0,0 +1,827 @@ -+/* -+ * Resizable, Scalable, Concurrent Hash Table -+ * -+ * Copyright (c) 2015 Herbert Xu -+ * Copyright (c) 2014-2015 Thomas Graf -+ * Copyright (c) 2008-2014 Patrick McHardy -+ * -+ * Code partially derived from nft_hash -+ * Rewritten with rehash code from br_multicast plus single list -+ * pointer as suggested by Josh Triplett -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 as -+ * published by the Free Software Foundation. -+ */ -+ -+#ifndef _LINUX_RHASHTABLE_H -+#define _LINUX_RHASHTABLE_H -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/* -+ * The end of the chain is marked with a special nulls marks which has -+ * the following format: -+ * -+ * +-------+-----------------------------------------------------+-+ -+ * | Base | Hash |1| -+ * +-------+-----------------------------------------------------+-+ -+ * -+ * Base (4 bits) : Reserved to distinguish between multiple tables. -+ * Specified via &struct rhashtable_params.nulls_base. -+ * Hash (27 bits): Full hash (unmasked) of first element added to bucket -+ * 1 (1 bit) : Nulls marker (always set) -+ * -+ * The remaining bits of the next pointer remain unused for now. -+ */ -+#define RHT_BASE_BITS 4 -+#define RHT_HASH_BITS 27 -+#define RHT_BASE_SHIFT RHT_HASH_BITS -+ -+/* Base bits plus 1 bit for nulls marker */ -+#define RHT_HASH_RESERVED_SPACE (RHT_BASE_BITS + 1) -+ -+struct rhash_head { -+ struct rhash_head __rcu *next; -+}; -+ -+/** -+ * struct bucket_table - Table of hash buckets -+ * @size: Number of hash buckets -+ * @rehash: Current bucket being rehashed -+ * @hash_rnd: Random seed to fold into hash -+ * @locks_mask: Mask to apply before accessing locks[] -+ * @locks: Array of spinlocks protecting individual buckets -+ * @walkers: List of active walkers -+ * @rcu: RCU structure for freeing the table -+ * @future_tbl: Table under construction during rehashing -+ * @buckets: size * hash buckets -+ */ -+struct bucket_table { -+ unsigned int size; -+ unsigned int rehash; -+ u32 hash_rnd; -+ unsigned int locks_mask; -+ spinlock_t *locks; -+ struct list_head walkers; -+ struct rcu_head rcu; -+ -+ struct bucket_table __rcu *future_tbl; -+ -+ struct rhash_head __rcu *buckets[] ____cacheline_aligned_in_smp; -+}; -+ -+/** -+ * struct rhashtable_compare_arg - Key for the function rhashtable_compare -+ * @ht: Hash table -+ * @key: Key to compare against -+ */ -+struct rhashtable_compare_arg { -+ struct rhashtable *ht; -+ const void *key; -+}; -+ -+typedef u32 (*rht_hashfn_t)(const void *data, u32 len, u32 seed); -+typedef u32 (*rht_obj_hashfn_t)(const void *data, u32 len, u32 seed); -+typedef int (*rht_obj_cmpfn_t)(struct rhashtable_compare_arg *arg, -+ const void *obj); -+ -+struct rhashtable; -+ -+/** -+ * struct rhashtable_params - Hash table construction parameters -+ * @nelem_hint: Hint on number of elements, should be 75% of desired size -+ * @key_len: Length of key -+ * @key_offset: Offset of key in struct to be hashed -+ * @head_offset: Offset of rhash_head in struct to be hashed -+ * @insecure_max_entries: Maximum number of entries (may be exceeded) -+ * @max_size: Maximum size while expanding -+ * @min_size: Minimum size while shrinking -+ * @nulls_base: Base value to generate nulls marker -+ * @insecure_elasticity: Set to true to disable chain length checks -+ * @automatic_shrinking: Enable automatic shrinking of tables -+ * @locks_mul: Number of bucket locks to allocate per cpu (default: 128) -+ * @hashfn: Hash function (default: jhash2 if !(key_len % 4), or jhash) -+ * @obj_hashfn: Function to hash object -+ * @obj_cmpfn: Function to compare key with object -+ */ -+struct rhashtable_params { -+ size_t nelem_hint; -+ size_t key_len; -+ size_t key_offset; -+ size_t head_offset; -+ unsigned int insecure_max_entries; -+ unsigned int max_size; -+ unsigned int min_size; -+ u32 nulls_base; -+ bool insecure_elasticity; -+ bool automatic_shrinking; -+ size_t locks_mul; -+ rht_hashfn_t hashfn; -+ rht_obj_hashfn_t obj_hashfn; -+ rht_obj_cmpfn_t obj_cmpfn; -+}; -+ -+/** -+ * struct rhashtable - Hash table handle -+ * @tbl: Bucket table -+ * @nelems: Number of elements in table -+ * @key_len: Key length for hashfn -+ * @elasticity: Maximum chain length before rehash -+ * @p: Configuration parameters -+ * @run_work: Deferred worker to expand/shrink asynchronously -+ * @mutex: Mutex to protect current/future table swapping -+ * @lock: Spin lock to protect walker list -+ */ -+struct rhashtable { -+ struct bucket_table __rcu *tbl; -+ atomic_t nelems; -+ unsigned int key_len; -+ unsigned int elasticity; -+ struct rhashtable_params p; -+ struct work_struct run_work; -+ struct mutex mutex; -+ spinlock_t lock; -+}; -+ -+/** -+ * struct rhashtable_walker - Hash table walker -+ * @list: List entry on list of walkers -+ * @tbl: The table that we were walking over -+ */ -+struct rhashtable_walker { -+ struct list_head list; -+ struct bucket_table *tbl; -+}; -+ -+/** -+ * struct rhashtable_iter - Hash table iterator, fits into netlink cb -+ * @ht: Table to iterate through -+ * @p: Current pointer -+ * @walker: Associated rhashtable walker -+ * @slot: Current slot -+ * @skip: Number of entries to skip in slot -+ */ -+struct rhashtable_iter { -+ struct rhashtable *ht; -+ struct rhash_head *p; -+ struct rhashtable_walker *walker; -+ unsigned int slot; -+ unsigned int skip; -+}; -+ -+static inline unsigned long rht_marker(const struct rhashtable *ht, u32 hash) -+{ -+ return NULLS_MARKER(ht->p.nulls_base + hash); -+} -+ -+#define INIT_RHT_NULLS_HEAD(ptr, ht, hash) \ -+ ((ptr) = (typeof(ptr)) rht_marker(ht, hash)) -+ -+static inline bool rht_is_a_nulls(const struct rhash_head *ptr) -+{ -+ return ((unsigned long) ptr & 1); -+} -+ -+static inline unsigned long rht_get_nulls_value(const struct rhash_head *ptr) -+{ -+ return ((unsigned long) ptr) >> 1; -+} -+ -+static inline void *rht_obj(const struct rhashtable *ht, -+ const struct rhash_head *he) -+{ -+ return (char *)he - ht->p.head_offset; -+} -+ -+static inline unsigned int rht_bucket_index(const struct bucket_table *tbl, -+ unsigned int hash) -+{ -+ return (hash >> RHT_HASH_RESERVED_SPACE) & (tbl->size - 1); -+} -+ -+static inline unsigned int rht_key_hashfn( -+ struct rhashtable *ht, const struct bucket_table *tbl, -+ const void *key, const struct rhashtable_params params) -+{ -+ unsigned int hash; -+ -+ /* params must be equal to ht->p if it isn't constant. */ -+ if (!__builtin_constant_p(params.key_len)) -+ hash = ht->p.hashfn(key, ht->key_len, tbl->hash_rnd); -+ else if (params.key_len) { -+ unsigned int key_len = params.key_len; -+ -+ if (params.hashfn) -+ hash = params.hashfn(key, key_len, tbl->hash_rnd); -+ else if (key_len & (sizeof(u32) - 1)) -+ hash = jhash(key, key_len, tbl->hash_rnd); -+ else -+ hash = jhash2(key, key_len / sizeof(u32), -+ tbl->hash_rnd); -+ } else { -+ unsigned int key_len = ht->p.key_len; -+ -+ if (params.hashfn) -+ hash = params.hashfn(key, key_len, tbl->hash_rnd); -+ else -+ hash = jhash(key, key_len, tbl->hash_rnd); -+ } -+ -+ return rht_bucket_index(tbl, hash); -+} -+ -+static inline unsigned int rht_head_hashfn( -+ struct rhashtable *ht, const struct bucket_table *tbl, -+ const struct rhash_head *he, const struct rhashtable_params params) -+{ -+ const char *ptr = rht_obj(ht, he); -+ -+ return likely(params.obj_hashfn) ? -+ rht_bucket_index(tbl, params.obj_hashfn(ptr, params.key_len ?: -+ ht->p.key_len, -+ tbl->hash_rnd)) : -+ rht_key_hashfn(ht, tbl, ptr + params.key_offset, params); -+} -+ -+/** -+ * rht_grow_above_75 - returns true if nelems > 0.75 * table-size -+ * @ht: hash table -+ * @tbl: current table -+ */ -+static inline bool rht_grow_above_75(const struct rhashtable *ht, -+ const struct bucket_table *tbl) -+{ -+ /* Expand table when exceeding 75% load */ -+ return atomic_read(&ht->nelems) > (tbl->size / 4 * 3) && -+ (!ht->p.max_size || tbl->size < ht->p.max_size); -+} -+ -+/** -+ * rht_shrink_below_30 - returns true if nelems < 0.3 * table-size -+ * @ht: hash table -+ * @tbl: current table -+ */ -+static inline bool rht_shrink_below_30(const struct rhashtable *ht, -+ const struct bucket_table *tbl) -+{ -+ /* Shrink table beneath 30% load */ -+ return atomic_read(&ht->nelems) < (tbl->size * 3 / 10) && -+ tbl->size > ht->p.min_size; -+} -+ -+/** -+ * rht_grow_above_100 - returns true if nelems > table-size -+ * @ht: hash table -+ * @tbl: current table -+ */ -+static inline bool rht_grow_above_100(const struct rhashtable *ht, -+ const struct bucket_table *tbl) -+{ -+ return atomic_read(&ht->nelems) > tbl->size && -+ (!ht->p.max_size || tbl->size < ht->p.max_size); -+} -+ -+/** -+ * rht_grow_above_max - returns true if table is above maximum -+ * @ht: hash table -+ * @tbl: current table -+ */ -+static inline bool rht_grow_above_max(const struct rhashtable *ht, -+ const struct bucket_table *tbl) -+{ -+ return ht->p.insecure_max_entries && -+ atomic_read(&ht->nelems) >= ht->p.insecure_max_entries; -+} -+ -+/* The bucket lock is selected based on the hash and protects mutations -+ * on a group of hash buckets. -+ * -+ * A maximum of tbl->size/2 bucket locks is allocated. This ensures that -+ * a single lock always covers both buckets which may both contains -+ * entries which link to the same bucket of the old table during resizing. -+ * This allows to simplify the locking as locking the bucket in both -+ * tables during resize always guarantee protection. -+ * -+ * IMPORTANT: When holding the bucket lock of both the old and new table -+ * during expansions and shrinking, the old bucket lock must always be -+ * acquired first. -+ */ -+static inline spinlock_t *rht_bucket_lock(const struct bucket_table *tbl, -+ unsigned int hash) -+{ -+ return &tbl->locks[hash & tbl->locks_mask]; -+} -+ -+#ifdef CONFIG_PROVE_LOCKING -+int lockdep_rht_mutex_is_held(struct rhashtable *ht); -+int lockdep_rht_bucket_is_held(const struct bucket_table *tbl, u32 hash); -+#else -+static inline int lockdep_rht_mutex_is_held(struct rhashtable *ht) -+{ -+ return 1; -+} -+ -+static inline int lockdep_rht_bucket_is_held(const struct bucket_table *tbl, -+ u32 hash) -+{ -+ return 1; -+} -+#endif /* CONFIG_PROVE_LOCKING */ -+ -+int rhashtable_init(struct rhashtable *ht, -+ const struct rhashtable_params *params); -+ -+struct bucket_table *rhashtable_insert_slow(struct rhashtable *ht, -+ const void *key, -+ struct rhash_head *obj, -+ struct bucket_table *old_tbl); -+int rhashtable_insert_rehash(struct rhashtable *ht, struct bucket_table *tbl); -+ -+int rhashtable_walk_init(struct rhashtable *ht, struct rhashtable_iter *iter); -+void rhashtable_walk_exit(struct rhashtable_iter *iter); -+int rhashtable_walk_start(struct rhashtable_iter *iter) __acquires(RCU); -+void *rhashtable_walk_next(struct rhashtable_iter *iter); -+void rhashtable_walk_stop(struct rhashtable_iter *iter) __releases(RCU); -+ -+void rhashtable_free_and_destroy(struct rhashtable *ht, -+ void (*free_fn)(void *ptr, void *arg), -+ void *arg); -+void rhashtable_destroy(struct rhashtable *ht); -+ -+#define rht_dereference(p, ht) \ -+ rcu_dereference_protected(p, lockdep_rht_mutex_is_held(ht)) -+ -+#define rht_dereference_rcu(p, ht) \ -+ rcu_dereference_check(p, lockdep_rht_mutex_is_held(ht)) -+ -+#define rht_dereference_bucket(p, tbl, hash) \ -+ rcu_dereference_protected(p, lockdep_rht_bucket_is_held(tbl, hash)) -+ -+#define rht_dereference_bucket_rcu(p, tbl, hash) \ -+ rcu_dereference_check(p, lockdep_rht_bucket_is_held(tbl, hash)) -+ -+#define rht_entry(tpos, pos, member) \ -+ ({ tpos = container_of(pos, typeof(*tpos), member); 1; }) -+ -+/** -+ * rht_for_each_continue - continue iterating over hash chain -+ * @pos: the &struct rhash_head to use as a loop cursor. -+ * @head: the previous &struct rhash_head to continue from -+ * @tbl: the &struct bucket_table -+ * @hash: the hash value / bucket index -+ */ -+#define rht_for_each_continue(pos, head, tbl, hash) \ -+ for (pos = rht_dereference_bucket(head, tbl, hash); \ -+ !rht_is_a_nulls(pos); \ -+ pos = rht_dereference_bucket((pos)->next, tbl, hash)) -+ -+/** -+ * rht_for_each - iterate over hash chain -+ * @pos: the &struct rhash_head to use as a loop cursor. -+ * @tbl: the &struct bucket_table -+ * @hash: the hash value / bucket index -+ */ -+#define rht_for_each(pos, tbl, hash) \ -+ rht_for_each_continue(pos, (tbl)->buckets[hash], tbl, hash) -+ -+/** -+ * rht_for_each_entry_continue - continue iterating over hash chain -+ * @tpos: the type * to use as a loop cursor. -+ * @pos: the &struct rhash_head to use as a loop cursor. -+ * @head: the previous &struct rhash_head to continue from -+ * @tbl: the &struct bucket_table -+ * @hash: the hash value / bucket index -+ * @member: name of the &struct rhash_head within the hashable struct. -+ */ -+#define rht_for_each_entry_continue(tpos, pos, head, tbl, hash, member) \ -+ for (pos = rht_dereference_bucket(head, tbl, hash); \ -+ (!rht_is_a_nulls(pos)) && rht_entry(tpos, pos, member); \ -+ pos = rht_dereference_bucket((pos)->next, tbl, hash)) -+ -+/** -+ * rht_for_each_entry - iterate over hash chain of given type -+ * @tpos: the type * to use as a loop cursor. -+ * @pos: the &struct rhash_head to use as a loop cursor. -+ * @tbl: the &struct bucket_table -+ * @hash: the hash value / bucket index -+ * @member: name of the &struct rhash_head within the hashable struct. -+ */ -+#define rht_for_each_entry(tpos, pos, tbl, hash, member) \ -+ rht_for_each_entry_continue(tpos, pos, (tbl)->buckets[hash], \ -+ tbl, hash, member) -+ -+/** -+ * rht_for_each_entry_safe - safely iterate over hash chain of given type -+ * @tpos: the type * to use as a loop cursor. -+ * @pos: the &struct rhash_head to use as a loop cursor. -+ * @next: the &struct rhash_head to use as next in loop cursor. -+ * @tbl: the &struct bucket_table -+ * @hash: the hash value / bucket index -+ * @member: name of the &struct rhash_head within the hashable struct. -+ * -+ * This hash chain list-traversal primitive allows for the looped code to -+ * remove the loop cursor from the list. -+ */ -+#define rht_for_each_entry_safe(tpos, pos, next, tbl, hash, member) \ -+ for (pos = rht_dereference_bucket((tbl)->buckets[hash], tbl, hash), \ -+ next = !rht_is_a_nulls(pos) ? \ -+ rht_dereference_bucket(pos->next, tbl, hash) : NULL; \ -+ (!rht_is_a_nulls(pos)) && rht_entry(tpos, pos, member); \ -+ pos = next, \ -+ next = !rht_is_a_nulls(pos) ? \ -+ rht_dereference_bucket(pos->next, tbl, hash) : NULL) -+ -+/** -+ * rht_for_each_rcu_continue - continue iterating over rcu hash chain -+ * @pos: the &struct rhash_head to use as a loop cursor. -+ * @head: the previous &struct rhash_head to continue from -+ * @tbl: the &struct bucket_table -+ * @hash: the hash value / bucket index -+ * -+ * This hash chain list-traversal primitive may safely run concurrently with -+ * the _rcu mutation primitives such as rhashtable_insert() as long as the -+ * traversal is guarded by rcu_read_lock(). -+ */ -+#define rht_for_each_rcu_continue(pos, head, tbl, hash) \ -+ for (({barrier(); }), \ -+ pos = rht_dereference_bucket_rcu(head, tbl, hash); \ -+ !rht_is_a_nulls(pos); \ -+ pos = rcu_dereference_raw(pos->next)) -+ -+/** -+ * rht_for_each_rcu - iterate over rcu hash chain -+ * @pos: the &struct rhash_head to use as a loop cursor. -+ * @tbl: the &struct bucket_table -+ * @hash: the hash value / bucket index -+ * -+ * This hash chain list-traversal primitive may safely run concurrently with -+ * the _rcu mutation primitives such as rhashtable_insert() as long as the -+ * traversal is guarded by rcu_read_lock(). -+ */ -+#define rht_for_each_rcu(pos, tbl, hash) \ -+ rht_for_each_rcu_continue(pos, (tbl)->buckets[hash], tbl, hash) -+ -+/** -+ * rht_for_each_entry_rcu_continue - continue iterating over rcu hash chain -+ * @tpos: the type * to use as a loop cursor. -+ * @pos: the &struct rhash_head to use as a loop cursor. -+ * @head: the previous &struct rhash_head to continue from -+ * @tbl: the &struct bucket_table -+ * @hash: the hash value / bucket index -+ * @member: name of the &struct rhash_head within the hashable struct. -+ * -+ * This hash chain list-traversal primitive may safely run concurrently with -+ * the _rcu mutation primitives such as rhashtable_insert() as long as the -+ * traversal is guarded by rcu_read_lock(). -+ */ -+#define rht_for_each_entry_rcu_continue(tpos, pos, head, tbl, hash, member) \ -+ for (({barrier(); }), \ -+ pos = rht_dereference_bucket_rcu(head, tbl, hash); \ -+ (!rht_is_a_nulls(pos)) && rht_entry(tpos, pos, member); \ -+ pos = rht_dereference_bucket_rcu(pos->next, tbl, hash)) -+ -+/** -+ * rht_for_each_entry_rcu - iterate over rcu hash chain of given type -+ * @tpos: the type * to use as a loop cursor. -+ * @pos: the &struct rhash_head to use as a loop cursor. -+ * @tbl: the &struct bucket_table -+ * @hash: the hash value / bucket index -+ * @member: name of the &struct rhash_head within the hashable struct. -+ * -+ * This hash chain list-traversal primitive may safely run concurrently with -+ * the _rcu mutation primitives such as rhashtable_insert() as long as the -+ * traversal is guarded by rcu_read_lock(). -+ */ -+#define rht_for_each_entry_rcu(tpos, pos, tbl, hash, member) \ -+ rht_for_each_entry_rcu_continue(tpos, pos, (tbl)->buckets[hash],\ -+ tbl, hash, member) -+ -+static inline int rhashtable_compare(struct rhashtable_compare_arg *arg, -+ const void *obj) -+{ -+ struct rhashtable *ht = arg->ht; -+ const char *ptr = obj; -+ -+ return memcmp(ptr + ht->p.key_offset, arg->key, ht->p.key_len); -+} -+ -+/** -+ * rhashtable_lookup_fast - search hash table, inlined version -+ * @ht: hash table -+ * @key: the pointer to the key -+ * @params: hash table parameters -+ * -+ * Computes the hash value for the key and traverses the bucket chain looking -+ * for a entry with an identical key. The first matching entry is returned. -+ * -+ * Returns the first entry on which the compare function returned true. -+ */ -+static inline void *rhashtable_lookup_fast( -+ struct rhashtable *ht, const void *key, -+ const struct rhashtable_params params) -+{ -+ struct rhashtable_compare_arg arg = { -+ .ht = ht, -+ .key = key, -+ }; -+ const struct bucket_table *tbl; -+ struct rhash_head *he; -+ unsigned int hash; -+ -+ rcu_read_lock(); -+ -+ tbl = rht_dereference_rcu(ht->tbl, ht); -+restart: -+ hash = rht_key_hashfn(ht, tbl, key, params); -+ rht_for_each_rcu(he, tbl, hash) { -+ if (params.obj_cmpfn ? -+ params.obj_cmpfn(&arg, rht_obj(ht, he)) : -+ rhashtable_compare(&arg, rht_obj(ht, he))) -+ continue; -+ rcu_read_unlock(); -+ return rht_obj(ht, he); -+ } -+ -+ /* Ensure we see any new tables. */ -+ smp_rmb(); -+ -+ tbl = rht_dereference_rcu(tbl->future_tbl, ht); -+ if (unlikely(tbl)) -+ goto restart; -+ rcu_read_unlock(); -+ -+ return NULL; -+} -+ -+/* Internal function, please use rhashtable_insert_fast() instead */ -+static inline int __rhashtable_insert_fast( -+ struct rhashtable *ht, const void *key, struct rhash_head *obj, -+ const struct rhashtable_params params) -+{ -+ struct rhashtable_compare_arg arg = { -+ .ht = ht, -+ .key = key, -+ }; -+ struct bucket_table *tbl, *new_tbl; -+ struct rhash_head *head; -+ spinlock_t *lock; -+ unsigned int elasticity; -+ unsigned int hash; -+ int err; -+ -+restart: -+ rcu_read_lock(); -+ -+ tbl = rht_dereference_rcu(ht->tbl, ht); -+ -+ /* All insertions must grab the oldest table containing -+ * the hashed bucket that is yet to be rehashed. -+ */ -+ for (;;) { -+ hash = rht_head_hashfn(ht, tbl, obj, params); -+ lock = rht_bucket_lock(tbl, hash); -+ spin_lock_bh(lock); -+ -+ if (tbl->rehash <= hash) -+ break; -+ -+ spin_unlock_bh(lock); -+ tbl = rht_dereference_rcu(tbl->future_tbl, ht); -+ } -+ -+ new_tbl = rht_dereference_rcu(tbl->future_tbl, ht); -+ if (unlikely(new_tbl)) { -+ tbl = rhashtable_insert_slow(ht, key, obj, new_tbl); -+ if (!IS_ERR_OR_NULL(tbl)) -+ goto slow_path; -+ -+ err = PTR_ERR(tbl); -+ goto out; -+ } -+ -+ err = -E2BIG; -+ if (unlikely(rht_grow_above_max(ht, tbl))) -+ goto out; -+ -+ if (unlikely(rht_grow_above_100(ht, tbl))) { -+slow_path: -+ spin_unlock_bh(lock); -+ err = rhashtable_insert_rehash(ht, tbl); -+ rcu_read_unlock(); -+ if (err) -+ return err; -+ -+ goto restart; -+ } -+ -+ err = -EEXIST; -+ elasticity = ht->elasticity; -+ rht_for_each(head, tbl, hash) { -+ if (key && -+ unlikely(!(params.obj_cmpfn ? -+ params.obj_cmpfn(&arg, rht_obj(ht, head)) : -+ rhashtable_compare(&arg, rht_obj(ht, head))))) -+ goto out; -+ if (!--elasticity) -+ goto slow_path; -+ } -+ -+ err = 0; -+ -+ head = rht_dereference_bucket(tbl->buckets[hash], tbl, hash); -+ -+ RCU_INIT_POINTER(obj->next, head); -+ -+ rcu_assign_pointer(tbl->buckets[hash], obj); -+ -+ atomic_inc(&ht->nelems); -+ if (rht_grow_above_75(ht, tbl)) -+ schedule_work(&ht->run_work); -+ -+out: -+ spin_unlock_bh(lock); -+ rcu_read_unlock(); -+ -+ return err; -+} -+ -+/** -+ * rhashtable_insert_fast - insert object into hash table -+ * @ht: hash table -+ * @obj: pointer to hash head inside object -+ * @params: hash table parameters -+ * -+ * Will take a per bucket spinlock to protect against mutual mutations -+ * on the same bucket. Multiple insertions may occur in parallel unless -+ * they map to the same bucket lock. -+ * -+ * It is safe to call this function from atomic context. -+ * -+ * Will trigger an automatic deferred table resizing if the size grows -+ * beyond the watermark indicated by grow_decision() which can be passed -+ * to rhashtable_init(). -+ */ -+static inline int rhashtable_insert_fast( -+ struct rhashtable *ht, struct rhash_head *obj, -+ const struct rhashtable_params params) -+{ -+ return __rhashtable_insert_fast(ht, NULL, obj, params); -+} -+ -+/** -+ * rhashtable_lookup_insert_fast - lookup and insert object into hash table -+ * @ht: hash table -+ * @obj: pointer to hash head inside object -+ * @params: hash table parameters -+ * -+ * Locks down the bucket chain in both the old and new table if a resize -+ * is in progress to ensure that writers can't remove from the old table -+ * and can't insert to the new table during the atomic operation of search -+ * and insertion. Searches for duplicates in both the old and new table if -+ * a resize is in progress. -+ * -+ * This lookup function may only be used for fixed key hash table (key_len -+ * parameter set). It will BUG() if used inappropriately. -+ * -+ * It is safe to call this function from atomic context. -+ * -+ * Will trigger an automatic deferred table resizing if the size grows -+ * beyond the watermark indicated by grow_decision() which can be passed -+ * to rhashtable_init(). -+ */ -+static inline int rhashtable_lookup_insert_fast( -+ struct rhashtable *ht, struct rhash_head *obj, -+ const struct rhashtable_params params) -+{ -+ const char *key = rht_obj(ht, obj); -+ -+ BUG_ON(ht->p.obj_hashfn); -+ -+ return __rhashtable_insert_fast(ht, key + ht->p.key_offset, obj, -+ params); -+} -+ -+/** -+ * rhashtable_lookup_insert_key - search and insert object to hash table -+ * with explicit key -+ * @ht: hash table -+ * @key: key -+ * @obj: pointer to hash head inside object -+ * @params: hash table parameters -+ * -+ * Locks down the bucket chain in both the old and new table if a resize -+ * is in progress to ensure that writers can't remove from the old table -+ * and can't insert to the new table during the atomic operation of search -+ * and insertion. Searches for duplicates in both the old and new table if -+ * a resize is in progress. -+ * -+ * Lookups may occur in parallel with hashtable mutations and resizing. -+ * -+ * Will trigger an automatic deferred table resizing if the size grows -+ * beyond the watermark indicated by grow_decision() which can be passed -+ * to rhashtable_init(). -+ * -+ * Returns zero on success. -+ */ -+static inline int rhashtable_lookup_insert_key( -+ struct rhashtable *ht, const void *key, struct rhash_head *obj, -+ const struct rhashtable_params params) -+{ -+ BUG_ON(!ht->p.obj_hashfn || !key); -+ -+ return __rhashtable_insert_fast(ht, key, obj, params); -+} -+ -+/* Internal function, please use rhashtable_remove_fast() instead */ -+static inline int __rhashtable_remove_fast( -+ struct rhashtable *ht, struct bucket_table *tbl, -+ struct rhash_head *obj, const struct rhashtable_params params) -+{ -+ struct rhash_head __rcu **pprev; -+ struct rhash_head *he; -+ spinlock_t * lock; -+ unsigned int hash; -+ int err = -ENOENT; -+ -+ hash = rht_head_hashfn(ht, tbl, obj, params); -+ lock = rht_bucket_lock(tbl, hash); -+ -+ spin_lock_bh(lock); -+ -+ pprev = &tbl->buckets[hash]; -+ rht_for_each(he, tbl, hash) { -+ if (he != obj) { -+ pprev = &he->next; -+ continue; -+ } -+ -+ rcu_assign_pointer(*pprev, obj->next); -+ err = 0; -+ break; -+ } -+ -+ spin_unlock_bh(lock); -+ -+ return err; -+} -+ -+/** -+ * rhashtable_remove_fast - remove object from hash table -+ * @ht: hash table -+ * @obj: pointer to hash head inside object -+ * @params: hash table parameters -+ * -+ * Since the hash chain is single linked, the removal operation needs to -+ * walk the bucket chain upon removal. The removal operation is thus -+ * considerable slow if the hash table is not correctly sized. -+ * -+ * Will automatically shrink the table via rhashtable_expand() if the -+ * shrink_decision function specified at rhashtable_init() returns true. -+ * -+ * Returns zero on success, -ENOENT if the entry could not be found. -+ */ -+static inline int rhashtable_remove_fast( -+ struct rhashtable *ht, struct rhash_head *obj, -+ const struct rhashtable_params params) -+{ -+ struct bucket_table *tbl; -+ int err; -+ -+ rcu_read_lock(); -+ -+ tbl = rht_dereference_rcu(ht->tbl, ht); -+ -+ /* Because we have already taken (and released) the bucket -+ * lock in old_tbl, if we find that future_tbl is not yet -+ * visible then that guarantees the entry to still be in -+ * the old tbl if it exists. -+ */ -+ while ((err = __rhashtable_remove_fast(ht, tbl, obj, params)) && -+ (tbl = rht_dereference_rcu(tbl->future_tbl, ht))) -+ ; -+ -+ if (err) -+ goto out; -+ -+ atomic_dec(&ht->nelems); -+ if (unlikely(ht->p.automatic_shrinking && -+ rht_shrink_below_30(ht, tbl))) -+ schedule_work(&ht->run_work); -+ -+out: -+ rcu_read_unlock(); -+ -+ return err; -+} -+ -+#endif /* _LINUX_RHASHTABLE_H */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_android.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_android.c -new file mode 100755 -index 000000000..50dcfed96 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_android.c -@@ -0,0 +1,1349 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#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 */ -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#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", -+ "SETSUSPENDMODE", -+ "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", -+ "SET_AEK", -+ "EXT_AUTH_STATUS", -+ "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); -+ } -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0) -+ if(ssids) -+ rtw_mfree((u8 *)ssids, (n_ssids * sizeof(struct cfg80211_ssid))); -+#endif -+ 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 -+ -+ 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; -+ } -+ #ifndef RTW_HALMAC -+ if (pwrctl->pscan_info != NULL) { -+ rtw_mfree((u8 *)pwrctl->pscan_info, sizeof(pno_scan_info_t)); -+ pwrctl->pscan_info = NULL; -+ } -+ #endif -+ } -+ 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, WIFI_ASOC_STATE) == _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); -+ 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) -+{ -+ 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, RTW_REGD_SET_BY_USER); -+ -+ 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 */ -+ -+#ifdef CONFIG_RTW_MESH_AEK -+static int rtw_android_set_aek(struct net_device *ndev, char *command, int total_len) -+{ -+#define SET_AEK_DATA_LEN (ETH_ALEN + 32) -+ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ u8 *addr; -+ u8 *aek; -+ int err = 0; -+ -+ if (total_len - strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_SET_AEK]) - 1 != SET_AEK_DATA_LEN) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ addr = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_SET_AEK]) + 1; -+ aek = addr + ETH_ALEN; -+ -+ RTW_PRINT(FUNC_NDEV_FMT" addr="MAC_FMT"\n" -+ , FUNC_NDEV_ARG(ndev), MAC_ARG(addr)); -+ if (0) -+ RTW_PRINT(FUNC_NDEV_FMT" aek="KEY_FMT KEY_FMT"\n" -+ , FUNC_NDEV_ARG(ndev), KEY_ARG(aek), KEY_ARG(aek + 16)); -+ -+ if (rtw_mesh_plink_set_aek(adapter, addr, aek) != _SUCCESS) -+ err = -ENOENT; -+ -+exit: -+ return err; -+} -+#endif /* CONFIG_RTW_MESH_AEK */ -+ -+int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) -+{ -+ #define PRIVATE_COMMAND_MAX_LEN 8192 -+ 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);*/ -+ if (priv_cmd.total_len > PRIVATE_COMMAND_MAX_LEN || priv_cmd.total_len < 0) { -+ RTW_WARN("%s: invalid private command (%d)\n", __FUNCTION__, -+ priv_cmd.total_len); -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ command = rtw_zmalloc(priv_cmd.total_len+1); -+ if (!command) { -+ RTW_INFO("%s: failed to allocate memory\n", __FUNCTION__); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 0, 0)) -+ if (!access_ok(priv_cmd.buf, priv_cmd.total_len)) { -+ #else -+ if (!access_ok(VERIFY_READ, priv_cmd.buf, priv_cmd.total_len)) { -+ #endif -+ 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; -+ } -+ command[priv_cmd.total_len] = '\0'; -+ 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_SETSUSPENDMODE: -+ 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; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ #ifdef CONFIG_AP_MODE -+ 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'); -+ adapter_to_dvobj(padapter)->wpas_type = RTW_WPAS_ANDROID; -+ break; -+ } -+ #endif -+#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 */ -+ -+ 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(command)); -+ 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(command); -+ pwfd_info->wfd_device_type &= WFD_DEVINFO_DUAL; -+ } -+ break; -+ } -+#endif -+ case ANDROID_WIFI_CMD_CHANGE_DTIM: { -+#ifdef CONFIG_LPS -+ u8 dtim; -+ u8 *ptr = (u8 *) command; -+ -+ 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 CONFIG_RTW_MACADDR_ACL -+ case ANDROID_WIFI_CMD_HOSTAPD_SET_MACADDR_ACL: { -+ rtw_set_macaddr_acl(padapter, RTW_ACL_PERIOD_BSS, 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, RTW_ACL_PERIOD_BSS, 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, RTW_ACL_PERIOD_BSS, 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 -+ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); -+#endif /* CONFIG_P2P */ -+ break; -+ } -+ -+#ifdef CONFIG_RTW_MESH_AEK -+ case ANDROID_WIFI_CMD_SET_AEK: -+ bytes_written = rtw_android_set_aek(net, command, priv_cmd.total_len); -+ break; -+#endif -+ -+ case ANDROID_WIFI_CMD_EXT_AUTH_STATUS: { -+ rtw_set_external_auth_status(padapter, -+ command + strlen("EXT_AUTH_STATUS "), -+ priv_cmd.total_len - strlen("EXT_AUTH_STATUS ")); -+ 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 + 1); -+ -+ 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) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 18, 0)) -+void *wifi_get_country_code(char *ccode, u32 flags) -+#else /* Linux kernel < 3.18 */ -+void *wifi_get_country_code(char *ccode) -+#endif /* Linux kernel < 3.18 */ -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ if (!ccode) -+ return NULL; -+ if (wifi_control_data && wifi_control_data->get_country_code) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 18, 0)) -+ return wifi_control_data->get_country_code(ccode, flags); -+#else /* Linux kernel < 3.18 */ -+ return wifi_control_data->get_country_code(ccode); -+#endif /* Linux kernel < 3.18 */ -+ 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; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ 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 */ -+ RTW_INFO("%s oob_irq:%d\n", __func__, oob_irq); -+ } else if (wifi_irqres) { -+ oob_irq = wifi_irqres->start; -+ RTW_INFO("%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) */ -+ -+ up(&wifi_control_sem); -+ return 0; -+} -+ -+#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -+extern PADAPTER g_test_adapter; -+ -+static void shutdown_card(void) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(g_test_adapter); -+ 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 */ -+ -+#ifdef CONFIG_WOWLAN -+#ifdef CONFIG_GPIO_WAKEUP -+ /*default wake up pin change to BT*/ -+ RTW_INFO("%s:default wake up pin change to BT\n", __FUNCTION__); -+ rtw_hal_switch_gpio_wl_ctrl(g_test_adapter, pwrpriv->wowlan_gpio_index, _FALSE); -+#endif /* CONFIG_GPIO_WAKEUP */ -+#endif /* CONFIG_WOWLAN */ -+ -+ /* 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; -+ -+ 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) */ -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#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 --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_cfgvendor.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_cfgvendor.c -new file mode 100644 -index 000000000..f24813e93 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_cfgvendor.c -@@ -0,0 +1,2155 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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 -+ -+#ifndef MIN -+#define MIN(x,y) (((x) < (y)) ? (x) : (y)) -+#endif -+ -+#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) -+{ -+ gfp_t 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); -+} -+ -+/* Feature enums */ -+#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 WIFI_FEATURE_LINK_LAYER_STATS 0x10000 // Link layer stats collection -+#define WIFI_FEATURE_LOGGER 0x20000 // WiFi Logger -+#define WIFI_FEATURE_HAL_EPNO 0x40000 // WiFi PNO enhanced -+#define WIFI_FEATURE_RSSI_MONITOR 0x80000 // RSSI Monitor -+#define WIFI_FEATURE_MKEEP_ALIVE 0x100000 // WiFi mkeep_alive -+#define WIFI_FEATURE_CONFIG_NDO 0x200000 // ND offload configure -+#define WIFI_FEATURE_TX_TRANSMIT_POWER 0x400000 // Capture Tx transmit power levels -+#define WIFI_FEATURE_CONTROL_ROAMING 0x800000 // Enable/Disable firmware roaming -+#define WIFI_FEATURE_IE_WHITELIST 0x1000000 // Support Probe IE white listing -+#define WIFI_FEATURE_SCAN_RAND 0x2000000 // Support MAC & Probe Sequence Number randomization -+#define WIFI_FEATURE_SET_TX_POWER_LIMIT 0x4000000 // Support Tx Power Limit setting -+#define WIFI_FEATURE_USE_BODY_HEAD_SAR 0x8000000 // Support Using Body/Head Proximity for SAR -+#define WIFI_FEATURE_SET_LATENCY_MODE 0x40000000 // Support Latency mode setting -+#define WIFI_FEATURE_P2P_RAND_MAC 0x80000000 // Support Support P2P MAC randomization -+// Add more features here -+ -+#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); -+ int feature_set = 0; -+ -+ feature_set |= WIFI_FEATURE_INFRA; -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+ if (is_supported_5g(adapter_to_regsty(adapter)->wireless_mode)) -+ feature_set |= WIFI_FEATURE_INFRA_5G; -+#endif -+ -+ feature_set |= WIFI_FEATURE_P2P; -+ feature_set |= WIFI_FEATURE_SOFT_AP; -+ -+ feature_set |= WIFI_FEATURE_ADDITIONAL_STA; -+#ifdef CONFIG_RTW_CFGVENDOR_LLSTATS -+ feature_set |= WIFI_FEATURE_LINK_LAYER_STATS; -+#endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ -+ -+#ifdef CONFIG_RTW_CFGVENDOR_RSSIMONITOR -+ feature_set |= WIFI_FEATURE_RSSI_MONITOR; -+#endif -+ -+#ifdef CONFIG_RTW_CFGVENDOR_WIFI_LOGGER -+ feature_set |= WIFI_FEATURE_LOGGER; -+#endif -+ -+#ifdef CONFIG_RTW_WIFI_HAL -+ feature_set |= WIFI_FEATURE_CONFIG_NDO; -+#if defined(CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI) || defined(CONFIG_RTW_SCAN_RAND) -+ feature_set |= WIFI_FEATURE_SCAN_RAND; -+#endif -+#endif -+ -+ 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 rtw_cfgvendor_send_hotlist_event(struct wiphy *wiphy, -+ struct net_device *dev, void *data, int len, rtw_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 rtw_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 rtw_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 rtw_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 rtw_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 rtw_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 rtw_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 rtw_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 rtw_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 rtw_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 rtw_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 rtw_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 rtw_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 rtw_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 */ -+ -+#ifdef CONFIG_RTW_CFGVENDOR_LLSTATS -+enum { -+ LSTATS_SUBCMD_GET_INFO = ANDROID_NL80211_SUBCMD_LSTATS_RANGE_START, -+ LSTATS_SUBCMD_SET_INFO, -+ LSTATS_SUBCMD_CLEAR_INFO, -+}; -+static void LinkLayerStats(_adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ u32 ps_time, trx_total_time; -+ u64 tx_bytes, rx_bytes, trx_total_bytes = 0; -+ u64 tmp = 0; -+ -+ RTW_DBG("%s adapter type : %u\n", __func__, padapter->adapter_type); -+ -+ tx_bytes = 0; -+ rx_bytes = 0; -+ ps_time = 0; -+ trx_total_time = 0; -+ -+ if ( padapter->netif_up == _TRUE ) { -+ -+ pwrpriv->on_time = rtw_get_passing_time_ms(pwrpriv->radio_on_start_time); -+ -+ if (rtw_mi_check_fwstate(padapter, WIFI_ASOC_STATE)) { -+ if ( pwrpriv->bpower_saving == _TRUE ) { -+ pwrpriv->pwr_saving_time += rtw_get_passing_time_ms(pwrpriv->pwr_saving_start_time); -+ pwrpriv->pwr_saving_start_time = rtw_get_current_time(); -+ } -+ } else { -+#ifdef CONFIG_IPS -+ if ( pwrpriv->bpower_saving == _TRUE ) { -+ pwrpriv->pwr_saving_time += rtw_get_passing_time_ms(pwrpriv->pwr_saving_start_time); -+ pwrpriv->pwr_saving_start_time = rtw_get_current_time(); -+ } -+#else -+ pwrpriv->pwr_saving_time = pwrpriv->on_time; -+#endif -+ } -+ -+ ps_time = pwrpriv->pwr_saving_time; -+ -+ /* Deviation caused by caculation start time */ -+ if ( ps_time > pwrpriv->on_time ) -+ ps_time = pwrpriv->on_time; -+ -+ tx_bytes = pdvobjpriv->traffic_stat.last_tx_bytes; -+ rx_bytes = pdvobjpriv->traffic_stat.last_rx_bytes; -+ trx_total_bytes = tx_bytes + rx_bytes; -+ -+ trx_total_time = pwrpriv->on_time - ps_time; -+ -+ if ( trx_total_bytes == 0) { -+ pwrpriv->tx_time = 0; -+ pwrpriv->rx_time = 0; -+ } else { -+ -+ /* tx_time = (trx_total_time * tx_total_bytes) / trx_total_bytes; */ -+ /* rx_time = (trx_total_time * rx_total_bytes) / trx_total_bytes; */ -+ -+ tmp = (tx_bytes * trx_total_time); -+ tmp = rtw_division64(tmp, trx_total_bytes); -+ pwrpriv->tx_time = tmp; -+ -+ tmp = (rx_bytes * trx_total_time); -+ tmp = rtw_division64(tmp, trx_total_bytes); -+ pwrpriv->rx_time = tmp; -+ -+ } -+ -+ } -+ else { -+ pwrpriv->on_time = 0; -+ pwrpriv->tx_time = 0; -+ pwrpriv->rx_time = 0; -+ } -+ -+#ifdef CONFIG_RTW_WIFI_HAL_DEBUG -+ RTW_INFO("- tx_bytes : %llu rx_bytes : %llu total bytes : %llu\n", tx_bytes, rx_bytes, trx_total_bytes); -+ RTW_INFO("- netif_up = %s, on_time : %u ms\n", padapter->netif_up ? "1":"0", pwrpriv->on_time); -+ RTW_INFO("- pwr_saving_time : %u (%u) ms\n", pwrpriv->pwr_saving_time, ps_time); -+ RTW_INFO("- trx_total_time : %u ms\n", trx_total_time); -+ RTW_INFO("- tx_time : %u ms\n", pwrpriv->tx_time); -+ RTW_INFO("- rx_time : %u ms\n", pwrpriv->rx_time); -+#endif /* CONFIG_RTW_WIFI_HAL_DEBUG */ -+ -+} -+ -+#define DUMMY_TIME_STATICS 99 -+static int rtw_cfgvendor_lstats_get_info(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ wifi_radio_stat_internal *radio; -+ wifi_iface_stat *iface; -+ char *output; -+ -+ output = rtw_malloc(sizeof(wifi_radio_stat_internal) + sizeof(wifi_iface_stat)); -+ if (output == NULL) { -+ RTW_DBG("Allocate lstats info buffer fail!\n"); -+ } -+ -+ radio = (wifi_radio_stat_internal *)output; -+ -+ radio->num_channels = 0; -+ radio->radio = 1; -+ -+ /* to get on_time, tx_time, rx_time */ -+ LinkLayerStats(padapter); -+ -+ radio->on_time = pwrpriv->on_time; -+ radio->tx_time = pwrpriv->tx_time; -+ radio->rx_time = pwrpriv->rx_time; -+ radio->on_time_scan = 0; -+ radio->on_time_nbd = 0; -+ radio->on_time_gscan = 0; -+ radio->on_time_pno_scan = 0; -+ radio->on_time_hs20 = 0; -+ #ifdef CONFIG_RTW_WIFI_HAL_DEBUG -+ RTW_INFO("==== %s ====\n", __func__); -+ RTW_INFO("radio->radio : %d\n", (radio->radio)); -+ RTW_INFO("pwrpriv->on_time : %u ms\n", (pwrpriv->on_time)); -+ RTW_INFO("pwrpriv->tx_time : %u ms\n", (pwrpriv->tx_time)); -+ RTW_INFO("pwrpriv->rx_time : %u ms\n", (pwrpriv->rx_time)); -+ RTW_INFO("radio->on_time : %u ms\n", (radio->on_time)); -+ RTW_INFO("radio->tx_time : %u ms\n", (radio->tx_time)); -+ RTW_INFO("radio->rx_time : %u ms\n", (radio->rx_time)); -+ #endif /* CONFIG_RTW_WIFI_HAL_DEBUG */ -+ -+ RTW_DBG(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), -+ output, sizeof(wifi_iface_stat) + sizeof(wifi_radio_stat_internal)); -+ if (unlikely(err)) -+ RTW_ERR(FUNC_NDEV_FMT"Vendor Command reply failed ret:%d \n" -+ , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); -+ rtw_mfree(output, sizeof(wifi_iface_stat) + sizeof(wifi_radio_stat_internal)); -+ return err; -+} -+static int rtw_cfgvendor_lstats_set_info(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ RTW_INFO("%s\n", __func__); -+ return err; -+} -+static int rtw_cfgvendor_lstats_clear_info(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ RTW_INFO("%s\n", __func__); -+ return err; -+} -+#endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ -+#ifdef CONFIG_RTW_CFGVENDOR_RSSIMONITOR -+static int rtw_cfgvendor_set_rssi_monitor(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ int err = 0, rem, type; -+ const struct nlattr *iter; -+ -+ RTW_DBG(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char*)data); -+ -+ nla_for_each_attr(iter, data, len, rem) { -+ type = nla_type(iter); -+ -+ switch (type) { -+ case RSSI_MONITOR_ATTRIBUTE_MAX_RSSI: -+ pwdev_priv->rssi_monitor_max = (s8)nla_get_u32(iter);; -+ break; -+ case RSSI_MONITOR_ATTRIBUTE_MIN_RSSI: -+ pwdev_priv->rssi_monitor_min = (s8)nla_get_u32(iter); -+ break; -+ case RSSI_MONITOR_ATTRIBUTE_START: -+ pwdev_priv->rssi_monitor_enable = (u8)nla_get_u32(iter); -+ break; -+ } -+ } -+ -+ return err; -+} -+ -+void rtw_cfgvendor_rssi_monitor_evt(_adapter *padapter) { -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ struct wiphy *wiphy= wdev->wiphy; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *pcur_network = &pmlmepriv->cur_network; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ struct sk_buff *skb; -+ u32 tot_len = NLMSG_DEFAULT_SIZE; -+ gfp_t kflags; -+ rssi_monitor_evt data ; -+ s8 rssi = precvpriv->rssi; -+ -+ if (pwdev_priv->rssi_monitor_enable == 0 || check_fwstate(pmlmepriv, WIFI_ASOC_STATE) != _TRUE) -+ return; -+ -+ if (rssi < pwdev_priv->rssi_monitor_max || rssi > pwdev_priv->rssi_monitor_min) -+ return; -+ -+ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_event_alloc(wiphy, wdev, tot_len, GOOGLE_RSSI_MONITOR_EVENT, kflags); -+ if (!skb) { -+ goto exit; -+ } -+ -+ _rtw_memset(&data, 0, sizeof(data)); -+ -+ data.version = RSSI_MONITOR_EVT_VERSION; -+ data.cur_rssi = rssi; -+ _rtw_memcpy(data.BSSID, pcur_network->network.MacAddress, sizeof(mac_addr)); -+ -+ nla_append(skb, sizeof(data), &data); -+ -+ rtw_cfg80211_vendor_event(skb, kflags); -+exit: -+ return; -+} -+#endif /* CONFIG_RTW_CFGVENDOR_RSSIMONITR */ -+ -+#ifdef CONFIG_RTW_CFGVENDOR_WIFI_LOGGER -+static int rtw_cfgvendor_logger_start_logging(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int ret = 0, rem, type; -+ char ring_name[32] = {0}; -+ int log_level = 0, flags = 0, time_intval = 0, threshold = 0; -+ const struct nlattr *iter; -+ -+ nla_for_each_attr(iter, data, len, rem) { -+ type = nla_type(iter); -+ switch (type) { -+ case LOGGER_ATTRIBUTE_RING_NAME: -+ strncpy(ring_name, nla_data(iter), -+ MIN(sizeof(ring_name) -1, nla_len(iter))); -+ break; -+ case LOGGER_ATTRIBUTE_LOG_LEVEL: -+ log_level = nla_get_u32(iter); -+ break; -+ case LOGGER_ATTRIBUTE_RING_FLAGS: -+ flags = nla_get_u32(iter); -+ break; -+ case LOGGER_ATTRIBUTE_LOG_TIME_INTVAL: -+ time_intval = nla_get_u32(iter); -+ break; -+ case LOGGER_ATTRIBUTE_LOG_MIN_DATA_SIZE: -+ threshold = nla_get_u32(iter); -+ break; -+ default: -+ RTW_ERR("Unknown type: %d\n", type); -+ ret = WIFI_ERROR_INVALID_ARGS; -+ goto exit; -+ } -+ } -+ -+exit: -+ return ret; -+} -+static int rtw_cfgvendor_logger_get_feature(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ u32 supported_features = 0; -+ -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), &supported_features, sizeof(supported_features)); -+ -+ 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_logger_get_version(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); -+ HAL_DATA_TYPE *hal = GET_HAL_DATA(padapter); -+ int ret = 0, rem, type; -+ int buf_len = 1024; -+ char *buf_ptr; -+ const struct nlattr *iter; -+ gfp_t kflags; -+ -+ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; -+ buf_ptr = kzalloc(buf_len, kflags); -+ if (!buf_ptr) { -+ RTW_ERR("failed to allocate the buffer for version n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ nla_for_each_attr(iter, data, len, rem) { -+ type = nla_type(iter); -+ switch (type) { -+ case LOGGER_ATTRIBUTE_GET_DRIVER: -+ memcpy(buf_ptr, DRIVERVERSION, strlen(DRIVERVERSION)+1); -+ break; -+ case LOGGER_ATTRIBUTE_GET_FW: -+ sprintf(buf_ptr, "v%d.%d", hal->firmware_version, hal->firmware_sub_version); -+ break; -+ default: -+ RTW_ERR("Unknown type: %d\n", type); -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ if (ret < 0) { -+ RTW_ERR("failed to get the version %d\n", ret); -+ goto exit; -+ } -+ -+ -+ ret = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), buf_ptr, strlen(buf_ptr)); -+exit: -+ kfree(buf_ptr); -+ return ret; -+} -+ -+static int rtw_cfgvendor_logger_get_ring_status(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int ret = 0; -+ int ring_id; -+ char ring_buf_name[] = "RTW_RING_BUFFER"; -+ -+ struct sk_buff *skb; -+ wifi_ring_buffer_status ring_status; -+ -+ -+ _rtw_memcpy(ring_status.name, ring_buf_name, strlen(ring_buf_name)+1); -+ ring_status.ring_id = 1; -+ /* Alloc the SKB for vendor_event */ -+ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, -+ sizeof(wifi_ring_buffer_status)); -+ if (!skb) { -+ RTW_ERR("skb allocation is failed\n"); -+ ret = FAIL; -+ goto exit; -+ } -+ -+ nla_put_u32(skb, LOGGER_ATTRIBUTE_RING_NUM, 1); -+ nla_put(skb, LOGGER_ATTRIBUTE_RING_STATUS, sizeof(wifi_ring_buffer_status), -+ &ring_status); -+ ret = cfg80211_vendor_cmd_reply(skb); -+ -+ if (ret) { -+ RTW_ERR("Vendor Command reply failed ret:%d \n", ret); -+ } -+exit: -+ return ret; -+} -+ -+static int rtw_cfgvendor_logger_get_ring_data(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int ret = 0, rem, type; -+ char ring_name[32] = {0}; -+ const struct nlattr *iter; -+ -+ nla_for_each_attr(iter, data, len, rem) { -+ type = nla_type(iter); -+ switch (type) { -+ case LOGGER_ATTRIBUTE_RING_NAME: -+ strncpy(ring_name, nla_data(iter), -+ MIN(sizeof(ring_name) -1, nla_len(iter))); -+ RTW_INFO(" %s LOGGER_ATTRIBUTE_RING_NAME : %s\n", __func__, ring_name); -+ break; -+ default: -+ RTW_ERR("Unknown type: %d\n", type); -+ return ret; -+ } -+ } -+ -+ -+ return ret; -+} -+ -+static int rtw_cfgvendor_logger_get_firmware_memory_dump(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int ret = WIFI_ERROR_NOT_SUPPORTED; -+ -+ return ret; -+} -+ -+static int rtw_cfgvendor_logger_start_pkt_fate_monitoring(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int ret = WIFI_SUCCESS; -+ -+ return ret; -+} -+ -+static int rtw_cfgvendor_logger_get_tx_pkt_fates(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int ret = WIFI_SUCCESS; -+ -+ return ret; -+} -+ -+static int rtw_cfgvendor_logger_get_rx_pkt_fates(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int ret = WIFI_SUCCESS; -+ -+ return ret; -+} -+ -+#endif /* CONFIG_RTW_CFGVENDOR_WIFI_LOGGER */ -+ -+#ifdef CONFIG_RTW_WIFI_HAL -+#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI -+ -+#ifndef ETHER_ISMULTI -+#define ETHER_ISMULTI(ea) (((const u8 *)(ea))[0] & 1) -+#endif -+ -+ -+static u8 null_addr[ETH_ALEN] = {0}; -+static void rtw_hal_random_gen_mac_addr(u8 *mac_addr) -+{ -+ do { -+ get_random_bytes(&mac_addr[3], ETH_ALEN-3); -+ if (memcmp(mac_addr, null_addr, ETH_ALEN) != 0) -+ break; -+ } while(1); -+} -+ -+void rtw_hal_pno_random_gen_mac_addr(PADAPTER adapter) -+{ -+ u8 mac_addr[ETH_ALEN]; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+ -+ memcpy(mac_addr, pwdev_priv->pno_mac_addr, ETH_ALEN); -+ if (mac_addr[0] == 0xFF) return; -+ rtw_hal_random_gen_mac_addr(mac_addr); -+ memcpy(pwdev_priv->pno_mac_addr, mac_addr, ETH_ALEN); -+#ifdef CONFIG_RTW_DEBUG -+ print_hex_dump(KERN_DEBUG, "pno_mac_addr: ", -+ DUMP_PREFIX_OFFSET, 16, 1, pwdev_priv->pno_mac_addr, -+ ETH_ALEN, 1); -+#endif -+} -+ -+ -+static int rtw_cfgvendor_set_rand_mac_oui(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ PADAPTER adapter; -+ void *devaddr; -+ struct net_device *netdev; -+ int type, mac_len; -+ u8 pno_random_mac_oui[3]; -+ u8 mac_addr[ETH_ALEN] = {0}; -+ struct pwrctrl_priv *pwrctl; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ type = nla_type(data); -+ mac_len = nla_len(data); -+ if (mac_len != 3) { -+ RTW_ERR("%s oui len error %d != 3\n", __func__, mac_len); -+ return -1; -+ } -+ -+ if (type == ANDR_WIFI_ATTRIBUTE_RANDOM_MAC_OUI) { -+ memcpy(pno_random_mac_oui, nla_data(data), 3); -+ print_hex_dump(KERN_DEBUG, "pno_random_mac_oui: ", -+ DUMP_PREFIX_OFFSET, 16, 1, pno_random_mac_oui, -+ 3, 1); -+ -+ if (ETHER_ISMULTI(pno_random_mac_oui)) { -+ pr_err("%s: oui is multicast address\n", __func__); -+ return -1; -+ } -+ -+ adapter = wiphy_to_adapter(wiphy); -+ if (adapter == NULL) { -+ pr_err("%s: wiphy_to_adapter == NULL\n", __func__); -+ return -1; -+ } -+ -+ pwdev_priv = adapter_wdev_data(adapter); -+ -+ memcpy(mac_addr, pno_random_mac_oui, 3); -+ rtw_hal_random_gen_mac_addr(mac_addr); -+ memcpy(pwdev_priv->pno_mac_addr, mac_addr, ETH_ALEN); -+#ifdef CONFIG_RTW_DEBUG -+ print_hex_dump(KERN_DEBUG, "pno_mac_addr: ", -+ DUMP_PREFIX_OFFSET, 16, 1, pwdev_priv->pno_mac_addr, -+ ETH_ALEN, 1); -+#endif -+ } else { -+ RTW_ERR("%s oui type error %x != 0x2\n", __func__, type); -+ err = -1; -+ } -+ -+ -+ return err; -+} -+#endif -+ -+#ifdef CONFIG_RTW_CFGVENDOR_WIFI_OFFLOAD -+static int rtw_cfgvendor_start_mkeep_alive(struct wiphy *wiphy, struct wireless_dev *wdev, -+ const void *data, int len) -+{ -+ int ret = WIFI_SUCCESS; -+ -+ RTW_INFO("%s : TODO\n", __func__); -+ -+ return ret; -+} -+ -+static int rtw_cfgvendor_stop_mkeep_alive(struct wiphy *wiphy, struct wireless_dev *wdev, -+ const void *data, int len) -+{ -+ int ret = WIFI_SUCCESS; -+ -+ RTW_INFO("%s : TODO\n", __func__); -+ -+ return ret; -+} -+#endif -+ -+static int rtw_cfgvendor_set_nodfs_flag(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ int type; -+ u32 nodfs = 0; -+ _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); -+ -+ RTW_DBG(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char*)data); -+ -+ type = nla_type(data); -+ if (type == ANDR_WIFI_ATTRIBUTE_NODFS_SET) { -+ nodfs = nla_get_u32(data); -+ adapter_to_dvobj(padapter)->nodfs = nodfs; -+ } else { -+ err = -EINVAL; -+ } -+ -+ RTW_INFO("%s nodfs=%d, err=%d\n", __func__, nodfs, err); -+ -+ return err; -+} -+ -+static int rtw_cfgvendor_set_country(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+#define CNTRY_BUF_SZ 4 /* Country string is 3 bytes + NUL */ -+ int err = 0, rem, type; -+ char country_code[CNTRY_BUF_SZ] = {0}; -+ const struct nlattr *iter; -+ _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); -+ -+ RTW_DBG(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char*)data); -+ -+ nla_for_each_attr(iter, data, len, rem) { -+ type = nla_type(iter); -+ switch (type) { -+ case ANDR_WIFI_ATTRIBUTE_COUNTRY: -+ _rtw_memcpy(country_code, nla_data(iter), -+ MIN(nla_len(iter), CNTRY_BUF_SZ)); -+ break; -+ default: -+ RTW_ERR("Unknown type: %d\n", type); -+ return -EINVAL; -+ } -+ } -+ -+ RTW_INFO("%s country_code:\"%c%c\" \n", __func__, country_code[0], country_code[1]); -+ -+ rtw_set_country(padapter, country_code, RTW_REGD_SET_BY_USER); -+ -+ return err; -+} -+ -+static int rtw_cfgvendor_set_nd_offload(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ int type; -+ u8 nd_en = 0; -+ _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); -+ -+ RTW_DBG(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char*)data); -+ -+ type = nla_type(data); -+ if (type == ANDR_WIFI_ATTRIBUTE_ND_OFFLOAD_VALUE) { -+ nd_en = nla_get_u8(data); -+ /* ND has been enabled when wow is enabled */ -+ } else { -+ err = -EINVAL; -+ } -+ -+ RTW_INFO("%s nd_en=%d, err=%d\n", __func__, nd_en, err); -+ -+ return err; -+} -+#endif /* CONFIG_RTW_WIFI_HAL */ -+ -+static const struct wiphy_vendor_command rtw_vendor_cmds[] = { -+#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 = rtw_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 = rtw_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 = rtw_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 = rtw_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 = rtw_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 = rtw_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 = rtw_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 = rtw_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 = rtw_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 = rtw_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 = rtw_cfgvendor_rtt_cancel_config -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = RTT_SUBCMD_GETCAPABILITY -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = rtw_cfgvendor_rtt_get_capability -+ }, -+#endif /* RTT_SUPPORT */ -+#ifdef CONFIG_RTW_CFGVENDOR_LLSTATS -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LSTATS_SUBCMD_GET_INFO -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_lstats_get_info -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LSTATS_SUBCMD_SET_INFO -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_lstats_set_info -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LSTATS_SUBCMD_CLEAR_INFO -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_lstats_clear_info -+ }, -+#endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ -+#ifdef CONFIG_RTW_CFGVENDOR_RSSIMONITOR -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = WIFI_SUBCMD_SET_RSSI_MONITOR -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_set_rssi_monitor -+ }, -+#endif /* CONFIG_RTW_CFGVENDOR_RSSIMONITOR */ -+#ifdef CONFIG_RTW_CFGVENDOR_WIFI_LOGGER -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LOGGER_START_LOGGING -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_logger_start_logging -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LOGGER_GET_FEATURE -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_logger_get_feature -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LOGGER_GET_VER -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_logger_get_version -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LOGGER_GET_RING_STATUS -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_logger_get_ring_status -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LOGGER_GET_RING_DATA -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_logger_get_ring_data -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LOGGER_TRIGGER_MEM_DUMP -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_logger_get_firmware_memory_dump -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LOGGER_START_PKT_FATE_MONITORING -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_logger_start_pkt_fate_monitoring -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LOGGER_GET_TX_PKT_FATES -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_logger_get_tx_pkt_fates -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = LOGGER_GET_RX_PKT_FATES -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_logger_get_rx_pkt_fates -+ }, -+#endif /* CONFIG_RTW_CFGVENDOR_WIFI_LOGGER */ -+#ifdef CONFIG_RTW_WIFI_HAL -+#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = WIFI_SUBCMD_SET_PNO_RANDOM_MAC_OUI -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_set_rand_mac_oui -+ }, -+#endif -+#ifdef CONFIG_RTW_CFGVENDOR_WIFI_OFFLOAD -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = WIFI_OFFLOAD_SUBCMD_START_MKEEP_ALIVE -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_start_mkeep_alive -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = WIFI_OFFLOAD_SUBCMD_STOP_MKEEP_ALIVE -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_stop_mkeep_alive -+ }, -+#endif -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = WIFI_SUBCMD_NODFS_SET -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_set_nodfs_flag -+ -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = WIFI_SUBCMD_SET_COUNTRY_CODE -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_set_country -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = WIFI_SUBCMD_CONFIG_ND_OFFLOAD -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_set_nd_offload -+ }, -+#endif /* CONFIG_RTW_WIFI_HAL */ -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = WIFI_SUBCMD_GET_FEATURE_SET -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_get_feature_set -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = WIFI_SUBCMD_GET_FEATURE_SET_MATRIX -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0)) -+ .policy = VENDOR_CMD_RAW_DATA, -+#endif -+ .doit = rtw_cfgvendor_get_feature_set_matrix -+ } -+}; -+ -+static const struct nl80211_vendor_cmd_info rtw_vendor_events[] = { -+#if defined(GSCAN_SUPPORT) && 0 -+ { OUI_GOOGLE, GSCAN_EVENT_SIGNIFICANT_CHANGE_RESULTS }, -+ { OUI_GOOGLE, GSCAN_EVENT_HOTLIST_RESULTS_FOUND }, -+ { OUI_GOOGLE, GSCAN_EVENT_SCAN_RESULTS_AVAILABLE }, -+ { OUI_GOOGLE, GSCAN_EVENT_FULL_SCAN_RESULTS }, -+#endif /* GSCAN_SUPPORT */ -+#if defined(RTT_SUPPORT) && 0 -+ { OUI_GOOGLE, RTT_EVENT_COMPLETE }, -+#endif /* RTT_SUPPORT */ -+ -+#ifdef CONFIG_RTW_CFGVENDOR_RSSIMONITOR -+ { OUI_GOOGLE, GOOGLE_RSSI_MONITOR_EVENT }, -+#endif /* RTW_CFGVENDOR_RSSIMONITR */ -+ -+#if defined(GSCAN_SUPPORT) && 0 -+ { OUI_GOOGLE, GSCAN_EVENT_COMPLETE_SCAN }, -+ { OUI_GOOGLE, GSCAN_EVENT_HOTLIST_RESULTS_LOST } -+#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 --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_cfgvendor.h b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_cfgvendor.h -new file mode 100644 -index 000000000..0b758174d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_cfgvendor.h -@@ -0,0 +1,632 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_CFGVENDOR_H_ -+#define _RTW_CFGVENDOR_H_ -+ -+#define OUI_GOOGLE 0x001A11 -+#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, -+ -+ /* define all Logger related commands between 0x1400 and 0x14FF */ -+ ANDROID_NL80211_SUBCMD_DEBUG_RANGE_START = 0x1400, -+ ANDROID_NL80211_SUBCMD_DEBUG_RANGE_END = 0x14FF, -+ -+ /* define all wifi offload related commands between 0x1600 and 0x16FF */ -+ ANDROID_NL80211_SUBCMD_WIFI_OFFLOAD_RANGE_START = 0x1600, -+ ANDROID_NL80211_SUBCMD_WIFI_OFFLOAD_RANGE_END = 0x16FF, -+ -+ /* define all NAN related commands between 0x1700 and 0x17FF */ -+ ANDROID_NL80211_SUBCMD_NAN_RANGE_START = 0x1700, -+ ANDROID_NL80211_SUBCMD_NAN_RANGE_END = 0x17FF, -+ -+ /* define all Android Packet Filter related commands between 0x1800 and 0x18FF */ -+ ANDROID_NL80211_SUBCMD_PKT_FILTER_RANGE_START = 0x1800, -+ ANDROID_NL80211_SUBCMD_PKT_FILTER_RANGE_END = 0x18FF, -+ -+ /* This is reserved for future usage */ -+ -+} ANDROID_VENDOR_SUB_COMMAND; -+ -+enum rtw_vendor_subcmd { -+ GSCAN_SUBCMD_GET_CAPABILITIES = ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START, -+ -+ GSCAN_SUBCMD_SET_CONFIG, /* 0x1001 */ -+ -+ GSCAN_SUBCMD_SET_SCAN_CONFIG, /* 0x1002 */ -+ GSCAN_SUBCMD_ENABLE_GSCAN, /* 0x1003 */ -+ GSCAN_SUBCMD_GET_SCAN_RESULTS, /* 0x1004 */ -+ GSCAN_SUBCMD_SCAN_RESULTS, /* 0x1005 */ -+ -+ GSCAN_SUBCMD_SET_HOTLIST, /* 0x1006 */ -+ -+ GSCAN_SUBCMD_SET_SIGNIFICANT_CHANGE_CONFIG, /* 0x1007 */ -+ GSCAN_SUBCMD_ENABLE_FULL_SCAN_RESULTS, /* 0x1008 */ -+ GSCAN_SUBCMD_GET_CHANNEL_LIST, /* 0x1009 */ -+ -+ WIFI_SUBCMD_GET_FEATURE_SET, /* 0x100A */ -+ WIFI_SUBCMD_GET_FEATURE_SET_MATRIX, /* 0x100B */ -+ WIFI_SUBCMD_SET_PNO_RANDOM_MAC_OUI, /* 0x100C */ -+ WIFI_SUBCMD_NODFS_SET, /* 0x100D */ -+ WIFI_SUBCMD_SET_COUNTRY_CODE, /* 0x100E */ -+ /* Add more sub commands here */ -+ GSCAN_SUBCMD_SET_EPNO_SSID, /* 0x100F */ -+ -+ WIFI_SUBCMD_SET_SSID_WHITE_LIST, /* 0x1010 */ -+ WIFI_SUBCMD_SET_ROAM_PARAMS, /* 0x1011 */ -+ WIFI_SUBCMD_ENABLE_LAZY_ROAM, /* 0x1012 */ -+ WIFI_SUBCMD_SET_BSSID_PREF, /* 0x1013 */ -+ WIFI_SUBCMD_SET_BSSID_BLACKLIST, /* 0x1014 */ -+ -+ GSCAN_SUBCMD_ANQPO_CONFIG, /* 0x1015 */ -+ WIFI_SUBCMD_SET_RSSI_MONITOR, /* 0x1016 */ -+ WIFI_SUBCMD_CONFIG_ND_OFFLOAD, /* 0x1017 */ -+ /* Add more sub commands here */ -+ -+ GSCAN_SUBCMD_MAX, -+ -+ RTT_SUBCMD_SET_CONFIG = ANDROID_NL80211_SUBCMD_RTT_RANGE_START, -+ RTT_SUBCMD_CANCEL_CONFIG, -+ RTT_SUBCMD_GETCAPABILITY, -+ -+ APF_SUBCMD_GET_CAPABILITIES = ANDROID_NL80211_SUBCMD_PKT_FILTER_RANGE_START, -+ APF_SUBCMD_SET_FILTER, -+ -+ LOGGER_START_LOGGING = ANDROID_NL80211_SUBCMD_DEBUG_RANGE_START, -+ LOGGER_TRIGGER_MEM_DUMP, -+ LOGGER_GET_MEM_DUMP, -+ LOGGER_GET_VER, -+ LOGGER_GET_RING_STATUS, -+ LOGGER_GET_RING_DATA, -+ LOGGER_GET_FEATURE, -+ LOGGER_RESET_LOGGING, -+ LOGGER_TRIGGER_DRIVER_MEM_DUMP, -+ LOGGER_GET_DRIVER_MEM_DUMP, -+ LOGGER_START_PKT_FATE_MONITORING, -+ LOGGER_GET_TX_PKT_FATES, -+ LOGGER_GET_RX_PKT_FATES, -+ -+ WIFI_OFFLOAD_SUBCMD_START_MKEEP_ALIVE = ANDROID_NL80211_SUBCMD_WIFI_OFFLOAD_RANGE_START, -+ WIFI_OFFLOAD_SUBCMD_STOP_MKEEP_ALIVE, -+ -+ 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 wifi_rssi_monitor_attr { -+ RSSI_MONITOR_ATTRIBUTE_MAX_RSSI, -+ RSSI_MONITOR_ATTRIBUTE_MIN_RSSI, -+ RSSI_MONITOR_ATTRIBUTE_START, -+}; -+ -+ -+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 -+}; -+ -+enum logger_attributes { -+ LOGGER_ATTRIBUTE_GET_DRIVER, -+ LOGGER_ATTRIBUTE_GET_FW, -+ LOGGER_ATTRIBUTE_RING_ID, -+ LOGGER_ATTRIBUTE_RING_NAME, -+ LOGGER_ATTRIBUTE_RING_FLAGS, -+ LOGGER_ATTRIBUTE_LOG_LEVEL, -+ LOGGER_ATTRIBUTE_LOG_TIME_INTVAL, -+ LOGGER_ATTRIBUTE_LOG_MIN_DATA_SIZE, -+ LOGGER_ATTRIBUTE_FW_DUMP_LEN, -+ LOGGER_ATTRIBUTE_FW_DUMP_DATA, -+ LOGGERG_ATTRIBUTE_RING_DATA, -+ LOGGER_ATTRIBUTE_RING_STATUS, -+ LOGGER_ATTRIBUTE_RING_NUM -+}; -+typedef enum rtw_vendor_event { -+ RTK_RESERVED1, -+ RTK_RESERVED2, -+ GSCAN_EVENT_SIGNIFICANT_CHANGE_RESULTS , -+ GSCAN_EVENT_HOTLIST_RESULTS_FOUND, -+ GSCAN_EVENT_SCAN_RESULTS_AVAILABLE, -+ GSCAN_EVENT_FULL_SCAN_RESULTS, -+ RTT_EVENT_COMPLETE, -+ GSCAN_EVENT_COMPLETE_SCAN, -+ GSCAN_EVENT_HOTLIST_RESULTS_LOST, -+ GSCAN_EVENT_EPNO_EVENT, -+ GOOGLE_DEBUG_RING_EVENT, -+ GOOGLE_DEBUG_MEM_DUMP_EVENT, -+ GSCAN_EVENT_ANQPO_HOTSPOT_MATCH, -+ GOOGLE_RSSI_MONITOR_EVENT -+} rtw_vendor_event_t; -+ -+enum andr_wifi_feature_set_attr { -+ ANDR_WIFI_ATTRIBUTE_NUM_FEATURE_SET, -+ ANDR_WIFI_ATTRIBUTE_FEATURE_SET, -+ ANDR_WIFI_ATTRIBUTE_RANDOM_MAC_OUI, -+ ANDR_WIFI_ATTRIBUTE_NODFS_SET, -+ ANDR_WIFI_ATTRIBUTE_COUNTRY, -+ ANDR_WIFI_ATTRIBUTE_ND_OFFLOAD_VALUE -+ // Add more attribute here -+}; -+ -+typedef enum rtw_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 -+} rtw_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; -+/* wifi_hal.h */ -+/* WiFi Common definitions */ -+typedef unsigned char byte; -+typedef int wifi_request_id; -+typedef int wifi_channel; // indicates channel frequency in MHz -+typedef int wifi_rssi; -+typedef byte mac_addr[6]; -+typedef byte oui[3]; -+typedef int64_t wifi_timestamp; // In microseconds (us) -+typedef int64_t wifi_timespan; // In picoseconds (ps) -+ -+struct wifi_info; -+struct wifi_interface_info; -+typedef struct wifi_info *wifi_handle; -+typedef struct wifi_interface_info *wifi_interface_handle; -+ -+/* channel operating width */ -+typedef enum { -+ WIFI_CHAN_WIDTH_20 = 0, -+ WIFI_CHAN_WIDTH_40 = 1, -+ WIFI_CHAN_WIDTH_80 = 2, -+ WIFI_CHAN_WIDTH_160 = 3, -+ WIFI_CHAN_WIDTH_80P80 = 4, -+ WIFI_CHAN_WIDTH_5 = 5, -+ WIFI_CHAN_WIDTH_10 = 6, -+ WIFI_CHAN_WIDTH_INVALID = -1 -+} wifi_channel_width; -+ -+typedef int wifi_radio; -+ -+typedef struct { -+ wifi_channel_width width; -+ int center_frequency0; -+ int center_frequency1; -+ int primary_frequency; -+} wifi_channel_spec; -+ -+typedef enum { -+ WIFI_SUCCESS = 0, -+ WIFI_ERROR_NONE = 0, -+ WIFI_ERROR_UNKNOWN = -1, -+ WIFI_ERROR_UNINITIALIZED = -2, -+ WIFI_ERROR_NOT_SUPPORTED = -3, -+ WIFI_ERROR_NOT_AVAILABLE = -4, // Not available right now, but try later -+ WIFI_ERROR_INVALID_ARGS = -5, -+ WIFI_ERROR_INVALID_REQUEST_ID = -6, -+ WIFI_ERROR_TIMED_OUT = -7, -+ WIFI_ERROR_TOO_MANY_REQUESTS = -8, // Too many instances of this request -+ WIFI_ERROR_OUT_OF_MEMORY = -9, -+ WIFI_ERROR_BUSY = -10, -+} wifi_error; -+ -+typedef int wifi_ring_buffer_id; -+/* ring buffer params */ -+/** -+ * written_bytes and read_bytes implement a producer consumer API -+ * hence written_bytes >= read_bytes -+ * a modulo arithmetic of the buffer size has to be applied to those counters: -+ * actual offset into ring buffer = written_bytes % ring_buffer_byte_size -+ * -+ */ -+typedef struct { -+ u8 name[32]; -+ u32 flags; -+ wifi_ring_buffer_id ring_id; // unique integer representing the ring -+ u32 ring_buffer_byte_size; // total memory size allocated for the buffer -+ u32 verbose_level; // verbose level for ring buffer -+ u32 written_bytes; // number of bytes that was written to the buffer by driver, -+ // monotonously increasing integer -+ u32 read_bytes; // number of bytes that was read from the buffer by user land, -+ // monotonously increasing integer -+ u32 written_records; // number of records that was written to the buffer by driver, -+ // monotonously increasing integer -+} wifi_ring_buffer_status; -+ -+#ifdef CONFIG_RTW_CFGVENDOR_LLSTATS -+#define STATS_MAJOR_VERSION 1 -+#define STATS_MINOR_VERSION 0 -+#define STATS_MICRO_VERSION 0 -+ -+typedef enum { -+ WIFI_DISCONNECTED = 0, -+ WIFI_AUTHENTICATING = 1, -+ WIFI_ASSOCIATING = 2, -+ WIFI_ASSOCIATED = 3, -+ WIFI_EAPOL_STARTED = 4, // if done by firmware/driver -+ WIFI_EAPOL_COMPLETED = 5, // if done by firmware/driver -+} wifi_connection_state; -+ -+typedef enum { -+ WIFI_ROAMING_IDLE = 0, -+ WIFI_ROAMING_ACTIVE = 1, -+} wifi_roam_state; -+ -+typedef enum { -+ WIFI_INTERFACE_STA = 0, -+ WIFI_INTERFACE_SOFTAP = 1, -+ WIFI_INTERFACE_IBSS = 2, -+ WIFI_INTERFACE_P2P_CLIENT = 3, -+ WIFI_INTERFACE_P2P_GO = 4, -+ WIFI_INTERFACE_NAN = 5, -+ WIFI_INTERFACE_MESH = 6, -+ WIFI_INTERFACE_UNKNOWN = -1 -+ } wifi_interface_mode; -+ -+#define WIFI_CAPABILITY_QOS 0x00000001 // set for QOS association -+#define WIFI_CAPABILITY_PROTECTED 0x00000002 // set for protected association (802.11 beacon frame control protected bit set) -+#define WIFI_CAPABILITY_INTERWORKING 0x00000004 // set if 802.11 Extended Capabilities element interworking bit is set -+#define WIFI_CAPABILITY_HS20 0x00000008 // set for HS20 association -+#define WIFI_CAPABILITY_SSID_UTF8 0x00000010 // set is 802.11 Extended Capabilities element UTF-8 SSID bit is set -+#define WIFI_CAPABILITY_COUNTRY 0x00000020 // set is 802.11 Country Element is present -+ -+typedef struct { -+ wifi_interface_mode mode; // interface mode -+ u8 mac_addr[6]; // interface mac address (self) -+ wifi_connection_state state; // connection state (valid for STA, CLI only) -+ wifi_roam_state roaming; // roaming state -+ u32 capabilities; // WIFI_CAPABILITY_XXX (self) -+ u8 ssid[33]; // null terminated SSID -+ u8 bssid[6]; // bssid -+ u8 ap_country_str[3]; // country string advertised by AP -+ u8 country_str[3]; // country string for this association -+} wifi_interface_link_layer_info; -+ -+/* channel information */ -+typedef struct { -+ wifi_channel_width width; // channel width (20, 40, 80, 80+80, 160) -+ wifi_channel center_freq; // primary 20 MHz channel -+ wifi_channel center_freq0; // center frequency (MHz) first segment -+ wifi_channel center_freq1; // center frequency (MHz) second segment -+} wifi_channel_info; -+ -+/* wifi rate */ -+typedef struct { -+ u32 preamble :3; // 0: OFDM, 1:CCK, 2:HT 3:VHT 4..7 reserved -+ u32 nss :2; // 0:1x1, 1:2x2, 3:3x3, 4:4x4 -+ u32 bw :3; // 0:20MHz, 1:40Mhz, 2:80Mhz, 3:160Mhz -+ u32 rateMcsIdx :8; // OFDM/CCK rate code would be as per ieee std in the units of 0.5mbps -+ // HT/VHT it would be mcs index -+ u32 reserved :16; // reserved -+ u32 bitrate; // units of 100 Kbps -+} wifi_rate; -+ -+/* channel statistics */ -+typedef struct { -+ wifi_channel_info channel; // channel -+ u32 on_time; // msecs the radio is awake (32 bits number accruing over time) -+ u32 cca_busy_time; // msecs the CCA register is busy (32 bits number accruing over time) -+} wifi_channel_stat; -+ -+// Max number of tx power levels. The actual number vary per device and is specified by |num_tx_levels| -+#define RADIO_STAT_MAX_TX_LEVELS 256 -+ -+/* Internal radio statistics structure in the driver */ -+typedef struct { -+ wifi_radio radio; // wifi radio (if multiple radio supported) -+ u32 on_time; // msecs the radio is awake (32 bits number accruing over time) -+ u32 tx_time; // msecs the radio is transmitting (32 bits number accruing over time) -+ u32 rx_time; // msecs the radio is in active receive (32 bits number accruing over time) -+ u32 on_time_scan; // msecs the radio is awake due to all scan (32 bits number accruing over time) -+ u32 on_time_nbd; // msecs the radio is awake due to NAN (32 bits number accruing over time) -+ u32 on_time_gscan; // msecs the radio is awake due to G?scan (32 bits number accruing over time) -+ u32 on_time_roam_scan; // msecs the radio is awake due to roam?scan (32 bits number accruing over time) -+ u32 on_time_pno_scan; // msecs the radio is awake due to PNO scan (32 bits number accruing over time) -+ u32 on_time_hs20; // msecs the radio is awake due to HS2.0 scans and GAS exchange (32 bits number accruing over time) -+ u32 num_channels; // number of channels -+ wifi_channel_stat channels[]; // channel statistics -+} wifi_radio_stat_internal; -+ -+/** -+ * Packet statistics reporting by firmware is performed on MPDU basi (i.e. counters increase by 1 for each MPDU) -+ * As well, "data packet" in associated comments, shall be interpreted as 802.11 data packet, -+ * that is, 802.11 frame control subtype == 2 and excluding management and control frames. -+ * -+ * As an example, in the case of transmission of an MSDU fragmented in 16 MPDUs which are transmitted -+ * OTA in a 16 units long a-mpdu, for which a block ack is received with 5 bits set: -+ * tx_mpdu : shall increase by 5 -+ * retries : shall increase by 16 -+ * tx_ampdu : shall increase by 1 -+ * data packet counters shall not increase regardless of the number of BAR potentially sent by device for this a-mpdu -+ * data packet counters shall not increase regardless of the number of BA received by device for this a-mpdu -+ * -+ * For each subsequent retransmission of the 11 remaining non ACK'ed mpdus -+ * (regardless of the fact that they are transmitted in a-mpdu or not) -+ * retries : shall increase by 1 -+ * -+ * If no subsequent BA or ACK are received from AP, until packet lifetime expires for those 11 packet that were not ACK'ed -+ * mpdu_lost : shall increase by 11 -+ */ -+ -+/* per rate statistics */ -+typedef struct { -+ wifi_rate rate; // rate information -+ u32 tx_mpdu; // number of successfully transmitted data pkts (ACK rcvd) -+ u32 rx_mpdu; // number of received data pkts -+ u32 mpdu_lost; // number of data packet losses (no ACK) -+ u32 retries; // total number of data pkt retries -+ u32 retries_short; // number of short data pkt retries -+ u32 retries_long; // number of long data pkt retries -+} wifi_rate_stat; -+ -+/* access categories */ -+typedef enum { -+ WIFI_AC_VO = 0, -+ WIFI_AC_VI = 1, -+ WIFI_AC_BE = 2, -+ WIFI_AC_BK = 3, -+ WIFI_AC_MAX = 4, -+} wifi_traffic_ac; -+ -+/* wifi peer type */ -+typedef enum -+{ -+ WIFI_PEER_STA, -+ WIFI_PEER_AP, -+ WIFI_PEER_P2P_GO, -+ WIFI_PEER_P2P_CLIENT, -+ WIFI_PEER_NAN, -+ WIFI_PEER_TDLS, -+ WIFI_PEER_INVALID, -+} wifi_peer_type; -+ -+/* per peer statistics */ -+typedef struct { -+ wifi_peer_type type; // peer type (AP, TDLS, GO etc.) -+ u8 peer_mac_address[6]; // mac address -+ u32 capabilities; // peer WIFI_CAPABILITY_XXX -+ u32 num_rate; // number of rates -+ wifi_rate_stat rate_stats[]; // per rate statistics, number of entries = num_rate -+} wifi_peer_info; -+ -+/* Per access category statistics */ -+typedef struct { -+ wifi_traffic_ac ac; // access category (VI, VO, BE, BK) -+ u32 tx_mpdu; // number of successfully transmitted unicast data pkts (ACK rcvd) -+ u32 rx_mpdu; // number of received unicast data packets -+ u32 tx_mcast; // number of succesfully transmitted multicast data packets -+ // STA case: implies ACK received from AP for the unicast packet in which mcast pkt was sent -+ u32 rx_mcast; // number of received multicast data packets -+ u32 rx_ampdu; // number of received unicast a-mpdus; support of this counter is optional -+ u32 tx_ampdu; // number of transmitted unicast a-mpdus; support of this counter is optional -+ u32 mpdu_lost; // number of data pkt losses (no ACK) -+ u32 retries; // total number of data pkt retries -+ u32 retries_short; // number of short data pkt retries -+ u32 retries_long; // number of long data pkt retries -+ u32 contention_time_min; // data pkt min contention time (usecs) -+ u32 contention_time_max; // data pkt max contention time (usecs) -+ u32 contention_time_avg; // data pkt avg contention time (usecs) -+ u32 contention_num_samples; // num of data pkts used for contention statistics -+} wifi_wmm_ac_stat; -+ -+/* interface statistics */ -+typedef struct { -+ wifi_interface_handle iface; // wifi interface -+ wifi_interface_link_layer_info info; // current state of the interface -+ u32 beacon_rx; // access point beacon received count from connected AP -+ u64 average_tsf_offset; // average beacon offset encountered (beacon_TSF - TBTT) -+ // The average_tsf_offset field is used so as to calculate the -+ // typical beacon contention time on the channel as well may be -+ // used to debug beacon synchronization and related power consumption issue -+ u32 leaky_ap_detected; // indicate that this AP typically leaks packets beyond the driver guard time. -+ u32 leaky_ap_avg_num_frames_leaked; // average number of frame leaked by AP after frame with PM bit set was ACK'ed by AP -+ u32 leaky_ap_guard_time; // guard time currently in force (when implementing IEEE power management based on -+ // frame control PM bit), How long driver waits before shutting down the radio and -+ // after receiving an ACK for a data frame with PM bit set) -+ u32 mgmt_rx; // access point mgmt frames received count from connected AP (including Beacon) -+ u32 mgmt_action_rx; // action frames received count -+ u32 mgmt_action_tx; // action frames transmit count -+ wifi_rssi rssi_mgmt; // access Point Beacon and Management frames RSSI (averaged) -+ wifi_rssi rssi_data; // access Point Data Frames RSSI (averaged) from connected AP -+ wifi_rssi rssi_ack; // access Point ACK RSSI (averaged) from connected AP -+ wifi_wmm_ac_stat ac[WIFI_AC_MAX]; // per ac data packet statistics -+ u32 num_peers; // number of peers -+ wifi_peer_info peer_info[]; // per peer statistics -+} wifi_iface_stat; -+ -+/* configuration params */ -+typedef struct { -+ u32 mpdu_size_threshold; // threshold to classify the pkts as short or long -+ // packet size < mpdu_size_threshold => short -+ u32 aggressive_statistics_gathering; // set for field debug mode. Driver should collect all statistics regardless of performance impact. -+} wifi_link_layer_params; -+ -+/* wifi statistics bitmap */ -+#define WIFI_STATS_RADIO 0x00000001 // all radio statistics -+#define WIFI_STATS_RADIO_CCA 0x00000002 // cca_busy_time (within radio statistics) -+#define WIFI_STATS_RADIO_CHANNELS 0x00000004 // all channel statistics (within radio statistics) -+#define WIFI_STATS_RADIO_SCAN 0x00000008 // all scan statistics (within radio statistics) -+#define WIFI_STATS_IFACE 0x00000010 // all interface statistics -+#define WIFI_STATS_IFACE_TXRATE 0x00000020 // all tx rate statistics (within interface statistics) -+#define WIFI_STATS_IFACE_AC 0x00000040 // all ac statistics (within interface statistics) -+#define WIFI_STATS_IFACE_CONTENTION 0x00000080 // all contention (min, max, avg) statistics (within ac statisctics) -+ -+#endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ -+ -+ -+#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 rtw_cfgvendor_send_hotlist_event(struct wiphy *wiphy, -+ struct net_device *dev, void *data, int len, rtw_vendor_event_t event); -+#endif -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) */ -+ -+#ifdef CONFIG_RTW_CFGVENDOR_RSSIMONITOR -+void rtw_cfgvendor_rssi_monitor_evt(_adapter *padapter); -+#define RSSI_MONITOR_EVT_VERSION 1 -+typedef struct { -+ u8 version; -+ s8 cur_rssi; -+ mac_addr BSSID; -+} rssi_monitor_evt; -+#endif -+ -+#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI -+void rtw_hal_pno_random_gen_mac_addr(PADAPTER adapter); -+#endif -+ -+#endif /* _RTW_CFGVENDOR_H_ */ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_proc.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_proc.c -new file mode 100755 -index 000000000..79f9e5c27 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_proc.c -@@ -0,0 +1,6455 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 /* tolower() */ -+#include -+#include -+#include "rtw_proc.h" -+#include -+ -+#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 -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 0)) -+int single_open_size(struct file *file, int (*show)(struct seq_file *, void *), -+ void *data, size_t size) -+{ -+ char *buf = kmalloc(size, GFP_KERNEL); -+ int ret; -+ if (!buf) -+ return -ENOMEM; -+ ret = single_open(file, show, data); -+ if (ret) { -+ kfree(buf); -+ return ret; -+ } -+ ((struct seq_file *)file->private_data)->buf = buf; -+ ((struct seq_file *)file->private_data)->size = size; -+ return 0; -+} -+#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 rtw_proc_ops *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 (num == 1 && -+ 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 bool regd_info; -+static int proc_get_country_chplan_map(struct seq_file *m, void *v) -+{ -+ dump_country_chplan_map(m, regd_info); -+ return 0; -+} -+ -+static ssize_t proc_set_country_chplan_map(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[32]; -+ int regd_info_val; -+ -+ 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", ®d_info_val); -+ -+ if (num >= 1) -+ regd_info = regd_info_val ? 1 : 0; -+ } else -+ return -EFAULT; -+ -+ return count; -+} -+ -+static int proc_get_country_list(struct seq_file *m, void *v) -+{ -+ dump_country_list(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_country_list(struct seq_file *m, void *v) -+{ -+ dump_chplan_country_list(m); -+ return 0; -+} -+ -+#if CONFIG_IEEE80211_BAND_6GHZ -+static int proc_get_chplan_6g_id_list(struct seq_file *m, void *v) -+{ -+ dump_chplan_6g_id_list(m); -+ return 0; -+} -+ -+static int proc_get_chplan_6g_country_list(struct seq_file *m, void *v) -+{ -+ dump_chplan_6g_country_list(m); -+ return 0; -+} -+#endif -+ -+#ifdef CONFIG_RTW_DEBUG -+static int proc_get_chplan_test(struct seq_file *m, void *v) -+{ -+ dump_chplan_test(m); -+ return 0; -+} -+#endif -+ -+static int proc_get_chplan_ver(struct seq_file *m, void *v) -+{ -+ dump_chplan_ver(m); -+ return 0; -+} -+ -+static int proc_get_global_op_class(struct seq_file *m, void *v) -+{ -+ dump_global_op_class(m); -+ return 0; -+} -+ -+#ifdef CONFIG_RTW_DEBUG -+static int proc_get_hw_rate_map_test(struct seq_file *m, void *v) -+{ -+ dump_hw_rate_map_test(m); -+ return 0; -+} -+#endif -+ -+#ifdef RTW_HALMAC -+extern void rtw_halmac_get_version(char *str, u32 len); -+ -+static int proc_get_halmac_info(struct seq_file *m, void *v) -+{ -+ char ver[30] = {0}; -+ -+ -+ rtw_halmac_get_version(ver, 30); -+ RTW_PRINT_SEL(m, "version: %s\n", ver); -+ -+ return 0; -+} -+#endif -+ -+/* -+* 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, proc_set_country_chplan_map), -+ RTW_PROC_HDL_SSEQ("country_list", proc_get_country_list, NULL), -+ RTW_PROC_HDL_SSEQ("chplan_id_list", proc_get_chplan_id_list, NULL), -+ RTW_PROC_HDL_SSEQ("chplan_country_list", proc_get_chplan_country_list, NULL), -+#if CONFIG_IEEE80211_BAND_6GHZ -+ RTW_PROC_HDL_SSEQ("chplan_6g_id_list", proc_get_chplan_6g_id_list, NULL), -+ RTW_PROC_HDL_SSEQ("chplan_6g_country_list", proc_get_chplan_6g_country_list, NULL), -+#endif -+#ifdef CONFIG_RTW_DEBUG -+ RTW_PROC_HDL_SSEQ("chplan_test", proc_get_chplan_test, NULL), -+#endif -+ RTW_PROC_HDL_SSEQ("chplan_ver", proc_get_chplan_ver, NULL), -+ RTW_PROC_HDL_SSEQ("global_op_class", proc_get_global_op_class, NULL), -+#ifdef CONFIG_RTW_DEBUG -+ RTW_PROC_HDL_SSEQ("hw_rate_map_test", proc_get_hw_rate_map_test, NULL), -+#endif -+#ifdef RTW_HALMAC -+ RTW_PROC_HDL_SSEQ("halmac_info", proc_get_halmac_info, NULL), -+#endif /* RTW_HALMAC */ -+}; -+ -+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 if (hdl->type == RTW_PROC_HDL_TYPE_SZSEQ) { -+ int (*show)(struct seq_file *, void *) = hdl->u.sz.show ? hdl->u.sz.show : proc_get_dummy; -+ -+ return single_open_size(file, show, private, hdl->u.sz.size); -+ } 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 rtw_proc_ops rtw_drv_proc_seq_fops = { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0)) -+ .proc_open = rtw_drv_proc_open, -+ .proc_read = seq_read, -+ .proc_lseek = seq_lseek, -+ .proc_release = seq_release, -+ .proc_write = rtw_drv_proc_write, -+#else -+ .owner = THIS_MODULE, -+ .open = rtw_drv_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = seq_release, -+ .write = rtw_drv_proc_write, -+#endif -+}; -+ -+static const struct rtw_proc_ops rtw_drv_proc_sseq_fops = { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0)) -+ .proc_open = rtw_drv_proc_open, -+ .proc_read = seq_read, -+ .proc_lseek = seq_lseek, -+ .proc_release = single_release, -+ .proc_write = rtw_drv_proc_write, -+#else -+ .owner = THIS_MODULE, -+ .open = rtw_drv_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_drv_proc_write, -+#endif -+}; -+ -+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 || -+ drv_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SZSEQ) -+ 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; -+} -+static int proc_get_sdio_card_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_sdio_card_info(m, adapter_to_dvobj(adapter)); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_SDIO_RECVBUF_AGGREGATION -+int proc_get_sdio_recvbuf_aggregation(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = GET_PRIMARY_ADAPTER((_adapter *)rtw_netdev_priv(dev)); -+ struct recv_priv *recvpriv = &adapter->recvpriv; -+ -+ RTW_PRINT_SEL(m, "%d\n", recvpriv->recvbuf_agg); -+ -+ return 0; -+} -+ -+ssize_t proc_set_sdio_recvbuf_aggregation(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = GET_PRIMARY_ADAPTER((_adapter *)rtw_netdev_priv(dev)); -+ struct recv_priv *recvpriv = &adapter->recvpriv; -+ -+ char tmp[32]; -+ u8 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, "%hhu", &enable); -+ -+ if (num >= 1) -+ recvpriv->recvbuf_agg = enable ? 1 : 0; -+ } -+ -+ return count; -+} -+#endif /* CONFIG_SDIO_RECVBUF_AGGREGATION */ -+ -+#ifdef CONFIG_SDIO_RECVBUF_PWAIT -+int proc_get_sdio_recvbuf_pwait(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = GET_PRIMARY_ADAPTER((_adapter *)rtw_netdev_priv(dev)); -+ struct recv_priv *recvpriv = &adapter->recvpriv; -+ -+ dump_recvbuf_pwait_conf(m, recvpriv); -+ -+ return 0; -+} -+ -+ssize_t proc_set_sdio_recvbuf_pwait(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+#ifdef CONFIG_SDIO_RECVBUF_PWAIT_RUNTIME_ADJUST -+ struct net_device *dev = data; -+ _adapter *adapter = GET_PRIMARY_ADAPTER((_adapter *)rtw_netdev_priv(dev)); -+ struct recv_priv *recvpriv = &adapter->recvpriv; -+ -+ char tmp[64]; -+ char type[64]; -+ s32 time; -+ s32 cnt_lmt; -+ -+ if (count < 3) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%s %d %d", type, &time, &cnt_lmt); -+ int i; -+ -+ if (num < 3) -+ return -EINVAL; -+ -+ for (i = 0; i < RTW_PWAIT_TYPE_NUM; i++) -+ if (strncmp(_rtw_pwait_type_str[i], type, strlen(_rtw_pwait_type_str[i])) == 0) -+ break; -+ -+ if (i < RTW_PWAIT_TYPE_NUM && recvbuf_pwait_config_req(recvpriv, i, time, cnt_lmt) != _SUCCESS) -+ return -EINVAL; -+ } -+ return count; -+#else -+ return -EFAULT; -+#endif /* CONFIG_SDIO_RECVBUF_PWAIT_RUNTIME_ADJUST */ -+} -+#endif /* CONFIG_SDIO_RECVBUF_PWAIT */ -+ -+#ifdef DBG_SDIO -+static int proc_get_sdio_dbg(struct seq_file *m, void *v) -+{ -+ struct net_device *dev; -+ struct _ADAPTER *a; -+ struct dvobj_priv *d; -+ struct sdio_data *sdio; -+ -+ -+ dev = m->private; -+ a = (struct _ADAPTER *)rtw_netdev_priv(dev); -+ d = adapter_to_dvobj(a); -+ sdio = &d->intf_data; -+ -+ dump_sdio_card_info(m, d); -+ -+ RTW_PRINT_SEL(m, "CMD52 error cnt: %d\n", sdio->cmd52_err_cnt); -+ RTW_PRINT_SEL(m, "CMD53 error cnt: %d\n", sdio->cmd53_err_cnt); -+ -+#if (DBG_SDIO >= 3) -+ RTW_PRINT_SEL(m, "dbg: %s\n", sdio->dbg_enable?"enable":"disable"); -+ RTW_PRINT_SEL(m, "err_stop: %s\n", sdio->err_stop?"enable":"disable"); -+ RTW_PRINT_SEL(m, "err_test: %s\n", sdio->err_test?"enable":"disable"); -+ RTW_PRINT_SEL(m, "err_test_triggered: %s\n", -+ sdio->err_test_triggered?"yes":"no"); -+#endif /* DBG_SDIO >= 3 */ -+ -+#if (DBG_SDIO >= 2) -+ RTW_PRINT_SEL(m, "I/O error dump mark: %d\n", sdio->reg_dump_mark); -+ if (sdio->reg_dump_mark) { -+ if (sdio->dbg_msg) -+ RTW_PRINT_SEL(m, "debug messages: %s\n", sdio->dbg_msg); -+ if (sdio->reg_mac) -+ RTW_BUF_DUMP_SEL(_DRV_ALWAYS_, m, "MAC register:", -+ _TRUE, sdio->reg_mac, 0x800); -+ if (sdio->reg_mac_ext) -+ RTW_BUF_DUMP_SEL(_DRV_ALWAYS_, m, "MAC EXT register:", -+ _TRUE, sdio->reg_mac_ext, 0x800); -+ if (sdio->reg_local) -+ RTW_BUF_DUMP_SEL(_DRV_ALWAYS_, m, "SDIO Local register:", -+ _TRUE, sdio->reg_local, 0x100); -+ if (sdio->reg_cia) -+ RTW_BUF_DUMP_SEL(_DRV_ALWAYS_, m, "SDIO CIA register:", -+ _TRUE, sdio->reg_cia, 0x200); -+ } -+#endif /* DBG_SDIO >= 2 */ -+ -+ return 0; -+} -+ -+#if (DBG_SDIO >= 2) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+#define strnicmp strncasecmp -+#endif /* Linux kernel >= 4.0.0 */ -+void rtw_sdio_dbg_reg_free(struct dvobj_priv *d); -+#endif /* DBG_SDIO >= 2 */ -+ -+ssize_t proc_set_sdio_dbg(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data) -+{ -+#if (DBG_SDIO >= 2) -+ struct net_device *dev = data; -+ struct dvobj_priv *d; -+ struct _ADAPTER *a; -+ struct sdio_data *sdio; -+ char tmp[32], cmd[32] = {0}; -+ int num; -+ -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ a = (struct _ADAPTER *)rtw_netdev_priv(dev); -+ d = adapter_to_dvobj(a); -+ sdio = &d->intf_data; -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ num = sscanf(tmp, "%s", cmd); -+ -+ if (num >= 1) { -+ if (strnicmp(cmd, "reg_reset", 10) == 0) { -+ sdio->reg_dump_mark = 0; -+ goto exit; -+ } -+ if (strnicmp(cmd, "reg_free", 9) == 0) { -+ rtw_sdio_dbg_reg_free(d); -+ sdio->reg_dump_mark = 0; -+ goto exit; -+ } -+#if (DBG_SDIO >= 3) -+ if (strnicmp(cmd, "dbg_enable", 11) == 0) { -+ sdio->dbg_enable = 1; -+ goto exit; -+ } -+ if (strnicmp(cmd, "dbg_disable", 12) == 0) { -+ sdio->dbg_enable = 0; -+ goto exit; -+ } -+ if (strnicmp(cmd, "err_stop", 9) == 0) { -+ sdio->err_stop = 1; -+ goto exit; -+ } -+ if (strnicmp(cmd, "err_stop_disable", 16) == 0) { -+ sdio->err_stop = 0; -+ goto exit; -+ } -+ if (strnicmp(cmd, "err_test", 9) == 0) { -+ sdio->err_test_triggered = 0; -+ sdio->err_test = 1; -+ goto exit; -+ } -+#endif /* DBG_SDIO >= 3 */ -+ } -+ -+ return -EINVAL; -+ } -+ -+exit: -+#endif /* DBG_SDIO >= 2 */ -+ return count; -+} -+#endif /* DBG_SDIO */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+static int proc_get_fw_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_dump_fw_info(m, adapter); -+ return 0; -+} -+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_bb_reg_dump_ex(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ bb_reg_dump_ex(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; -+} -+ -+#ifdef CONFIG_RTW_LED -+int proc_get_led_config(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_led_config(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_led_config(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 strategy; -+ u8 iface_en_mask; -+ -+ 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 %hhx", &strategy, &iface_en_mask); -+ -+ if (num >= 1) -+ rtw_led_set_strategy(adapter, strategy); -+ if (num >= 2) -+ rtw_led_set_iface_en_mask(adapter, iface_en_mask); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RTW_LED */ -+ -+#ifdef CONFIG_AP_MODE -+int proc_get_aid_status(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_aid_status(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_aid_status(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 sta_priv *stapriv = &adapter->stapriv; -+ -+ char tmp[32]; -+ u8 rr; -+ u16 started_aid; -+ -+ 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 %hu", &rr, &started_aid); -+ -+ if (num >= 1) -+ stapriv->rr_aid = rr ? 1 : 0; -+ if (num >= 2) { -+ started_aid = started_aid % (stapriv->max_aid + 1); -+ stapriv->started_aid = started_aid ? started_aid : 1; -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_ap_isolate(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "%d\n", adapter->mlmepriv.ap_isolate); -+ -+ return 0; -+} -+ -+ssize_t proc_set_ap_isolate(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]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int ap_isolate; -+ int num = sscanf(tmp, "%d", &ap_isolate); -+ -+ if (num >= 1) -+ adapter->mlmepriv.ap_isolate = ap_isolate ? 1 : 0; -+ } -+ -+ return count; -+} -+ -+#if CONFIG_RTW_AP_DATA_BMC_TO_UC -+static int proc_get_ap_b2u_flags(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ -+ if (MLME_IS_AP(adapter)) -+ dump_ap_b2u_flags(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_ap_b2u_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ 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)) { -+ u8 src, fwd; -+ int num = sscanf(tmp, "%hhx %hhx", &src, &fwd); -+ -+ if (num >= 1) -+ adapter->b2u_flags_ap_src = src; -+ if (num >= 2) -+ adapter->b2u_flags_ap_fwd = fwd; -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RTW_AP_DATA_BMC_TO_UC */ -+#endif /* CONFIG_AP_MODE */ -+ -+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 */ -+ -+#ifdef CONFIG_SCAN_BACKOP -+static 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; -+} -+ -+static 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; -+} -+ -+#ifdef CONFIG_AP_MODE -+static 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; -+} -+ -+static 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_AP_MODE */ -+ -+#ifdef CONFIG_RTW_MESH -+static int proc_get_backop_flags_mesh(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_mesh(mlmeext)); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_backop_flags_mesh(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_mesh(mlmeext, flags); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RTW_MESH */ -+ -+#endif /* CONFIG_SCAN_BACKOP */ -+ -+#if defined(CONFIG_LPS_PG) && defined(CONFIG_RTL8822C) -+static int proc_get_lps_pg_debug(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ struct dm_struct *dm = adapter_to_phydm(adapter); -+ -+ rtw_run_in_thread_cmd(adapter, ((void *)(odm_lps_pg_debug_8822c)), dm); -+ -+ return 0; -+} -+#endif -+ -+/* 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); -+ -+ if (num == 1) -+ 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 sta_info *psta; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 null_addr[ETH_ALEN] = {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 (MLME_IS_STA(padapter)) -+ status = "station mode"; -+ else if (MLME_IS_AP(padapter)) -+ status = "AP mode"; -+ else if (MLME_IS_MESH(padapter)) -+ status = "mesh 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->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) -+ && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) != _TRUE) -+ && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(padapter), ETH_ALEN) != _TRUE)) { -+ -+ switch (psta->cmn.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); -+ current_sgi = rtw_get_current_tx_sgi(adapter, psta); -+ -+ RTW_PRINT_SEL(m, "==============================\n"); -+ _RTW_PRINT_SEL(m, "macaddr=" MAC_FMT"\n", MAC_ARG(psta->cmn.mac_addr)); -+ _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_sta_tp_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, "sta_tp_dump :%s\n", (padapter->bsta_tp_dump) ? "enable" : "disable"); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_sta_tp_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; -+ int num = 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 ", &mode); -+ -+ if (num != 1) { -+ RTW_INFO("argument number is wrong\n"); -+ return -EFAULT; -+ } -+ if (padapter) -+ padapter->bsta_tp_dump = mode; -+ } -+ return count; -+} -+ -+static int proc_get_sta_tp_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (padapter) -+ rtw_sta_traffic_info(m, padapter); -+ -+ return 0; -+} -+ -+static int proc_get_turboedca_ctrl(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ -+ if (hal_data) { -+ -+ u32 edca_param; -+ -+ if (hal_data->dis_turboedca == 0) -+ RTW_PRINT_SEL(m, "Turbo-EDCA : %s\n", "Enable"); -+ else -+ RTW_PRINT_SEL(m, "Turbo-EDCA : %s, mode=%d, edca_param_mode=0x%x\n", "Disable", hal_data->dis_turboedca, hal_data->edca_param_mode); -+ -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&edca_param)); -+ -+ _RTW_PRINT_SEL(m, "PARAM_BE:0x%x\n", edca_param); -+ -+ } -+ -+ return 0; -+} -+ -+static ssize_t proc_set_turboedca_ctrl(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); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ char tmp[32] = {0}; -+ int mode = 0, num = 0; -+ u32 param_mode = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ num = sscanf(tmp, "%d %x", &mode, ¶m_mode); -+ -+ if (num < 1 || num > 2) { -+ RTW_INFO("argument number is wrong\n"); -+ return -EFAULT; -+ } -+ -+ /* 0: enable turboedca, -+ 1: disable turboedca, -+ 2: disable turboedca and setting EDCA parameter based on the input parameter -+ > 2 : currently reset to 0 */ -+ -+ if (mode > 2) -+ mode = 0; -+ -+ hal_data->dis_turboedca = mode; -+ -+ hal_data->edca_param_mode = 0; /* init. value */ -+ -+ RTW_INFO("dis_turboedca mode = 0x%x\n", hal_data->dis_turboedca); -+ -+ if (num == 2) { -+ -+ hal_data->edca_param_mode = param_mode; -+ -+ RTW_INFO("param_mode = 0x%x\n", param_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_to_rfctl(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]; -+ u16 chplan = RTW_CHPLAN_UNSPECIFIED; -+ u16 chplan_6g = RTW_CHPLAN_6G_UNSPECIFIED; -+ -+ 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, "%hx %hx", &chplan, &chplan_6g); -+ if (num < 1) -+ return count; -+ -+ rtw_chplan_ioctl_input_mapping(&chplan, &chplan_6g); -+ } -+ -+ rtw_set_channel_plan(padapter, chplan, chplan_6g, RTW_REGD_SET_BY_USER); -+ -+ 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); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ dump_cur_country(m, rfctl); -+ -+ 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, RTW_REGD_SET_BY_USER); -+ -+exit: -+ return count; -+} -+ -+static int cap_spt_op_class_ch_detail = 0; -+ -+static int proc_get_cap_spt_op_class_ch(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_cap_spt_op_class_ch(m , adapter_to_rfctl(adapter), cap_spt_op_class_ch_detail); -+ return 0; -+} -+ -+static ssize_t proc_set_cap_spt_op_class_ch(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)) -+ goto exit; -+ -+ num = sscanf(tmp, "%d", &cap_spt_op_class_ch_detail); -+ -+exit: -+ return count; -+} -+ -+static int reg_spt_op_class_ch_detail = 0; -+ -+static int proc_get_reg_spt_op_class_ch(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_reg_spt_op_class_ch(m , adapter_to_rfctl(adapter), reg_spt_op_class_ch_detail); -+ return 0; -+} -+ -+static ssize_t proc_set_reg_spt_op_class_ch(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)) -+ goto exit; -+ -+ num = sscanf(tmp, "%d", ®_spt_op_class_ch_detail); -+ -+exit: -+ return count; -+} -+ -+static int cur_spt_op_class_ch_detail = 0; -+ -+static int proc_get_cur_spt_op_class_ch(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_cur_spt_op_class_ch(m , adapter_to_rfctl(adapter), cur_spt_op_class_ch_detail); -+ return 0; -+} -+ -+static ssize_t proc_set_cur_spt_op_class_ch(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)) -+ goto exit; -+ -+ num = sscanf(tmp, "%d", &cur_spt_op_class_ch_detail); -+ -+exit: -+ return count; -+} -+ -+#if CONFIG_RTW_MACADDR_ACL -+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); -+ char tmp[17 * NUM_ACL + 32] = {0}; -+ u8 period; -+ char cmd[32]; -+ u8 mode; -+ u8 addr[ETH_ALEN]; -+ -+#define MAC_ACL_CMD_MODE 0 -+#define MAC_ACL_CMD_ADD 1 -+#define MAC_ACL_CMD_DEL 2 -+#define MAC_ACL_CMD_CLR 3 -+#define MAC_ACL_CMD_NUM 4 -+ -+ static const char * const mac_acl_cmd_str[] = { -+ "mode", -+ "add", -+ "del", -+ "clr", -+ }; -+ u8 cmd_id = MAC_ACL_CMD_NUM; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ /* -+ * mode [] -+ * mode -+ * add [] -+ * del [] -+ * clr -+ */ -+ char *c, *next; -+ int i; -+ u8 is_bcast; -+ -+ next = tmp; -+ c = strsep(&next, " \t"); -+ if (!c || sscanf(c, "%hhu", &period) != 1) -+ goto exit; -+ -+ if (period >= RTW_ACL_PERIOD_NUM) { -+ RTW_WARN(FUNC_ADPT_FMT" invalid period:%u", FUNC_ADPT_ARG(adapter), period); -+ goto exit; -+ } -+ -+ c = strsep(&next, " \t"); -+ if (!c || sscanf(c, "%s", cmd) != 1) -+ goto exit; -+ -+ for (i = 0; i < MAC_ACL_CMD_NUM; i++) -+ if (strcmp(mac_acl_cmd_str[i], cmd) == 0) -+ cmd_id = i; -+ -+ switch (cmd_id) { -+ case MAC_ACL_CMD_MODE: -+ c = strsep(&next, " \t"); -+ if (!c || sscanf(c, "%hhu", &mode) != 1) -+ goto exit; -+ -+ if (mode >= RTW_ACL_MODE_MAX) { -+ RTW_WARN(FUNC_ADPT_FMT" invalid mode:%u", FUNC_ADPT_ARG(adapter), mode); -+ goto exit; -+ } -+ break; -+ -+ case MAC_ACL_CMD_ADD: -+ case MAC_ACL_CMD_DEL: -+ break; -+ -+ case MAC_ACL_CMD_CLR: -+ /* clear settings */ -+ rtw_macaddr_acl_clear(adapter, period); -+ goto exit; -+ -+ default: -+ RTW_WARN(FUNC_ADPT_FMT" invalid cmd:\"%s\"", FUNC_ADPT_ARG(adapter), cmd); -+ goto exit; -+ } -+ -+ /* check for macaddr list */ -+ c = strsep(&next, " \t"); -+ if (!c && cmd_id == MAC_ACL_CMD_MODE) { -+ /* set mode only */ -+ rtw_set_macaddr_acl(adapter, period, mode); -+ goto exit; -+ } -+ -+ if (cmd_id == MAC_ACL_CMD_MODE) { -+ /* set mode and entire macaddr list */ -+ rtw_macaddr_acl_clear(adapter, period); -+ rtw_set_macaddr_acl(adapter, period, mode); -+ } -+ -+ while (c != NULL) { -+ if (sscanf(c, MAC_SFMT, MAC_SARG(addr)) != 6) -+ break; -+ -+ is_bcast = is_broadcast_mac_addr(addr); -+ if (is_bcast -+ || rtw_check_invalid_mac_address(addr, 0) == _FALSE -+ ) { -+ if (cmd_id == MAC_ACL_CMD_DEL) { -+ rtw_acl_remove_sta(adapter, period, addr); -+ if (is_bcast) -+ break; -+ } else if (!is_bcast) -+ rtw_acl_add_sta(adapter, period, addr); -+ } -+ -+ c = strsep(&next, " \t"); -+ } -+ } -+ -+exit: -+ return count; -+} -+#endif /* CONFIG_RTW_MACADDR_ACL */ -+ -+#if CONFIG_RTW_PRE_LINK_STA -+static int proc_get_pre_link_sta(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_pre_link_sta_ctl(m, &adapter->stapriv); -+ return 0; -+} -+ -+ssize_t proc_set_pre_link_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_priv *mlme = &adapter->mlmepriv; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ char tmp[17 * RTW_PRE_LINK_STA_NUM + 32] = {0}; -+ char arg0[16] = {0}; -+ u8 addr[ETH_ALEN]; -+ -+#define PRE_LINK_STA_CMD_RESET 0 -+#define PRE_LINK_STA_CMD_ADD 1 -+#define PRE_LINK_STA_CMD_DEL 2 -+#define PRE_LINK_STA_CMD_NUM 3 -+ -+ static const char * const pre_link_sta_cmd_str[] = { -+ "reset", -+ "add", -+ "del" -+ }; -+ u8 cmd_id = PRE_LINK_STA_CMD_NUM; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ /* cmd [] */ -+ char *c, *next; -+ int i; -+ -+ next = tmp; -+ c = strsep(&next, " \t"); -+ -+ if (sscanf(c, "%s", arg0) != 1) -+ goto exit; -+ -+ for (i = 0; i < PRE_LINK_STA_CMD_NUM; i++) -+ if (strcmp(pre_link_sta_cmd_str[i], arg0) == 0) -+ cmd_id = i; -+ -+ switch (cmd_id) { -+ case PRE_LINK_STA_CMD_RESET: -+ rtw_pre_link_sta_ctl_reset(&adapter->stapriv); -+ goto exit; -+ case PRE_LINK_STA_CMD_ADD: -+ case PRE_LINK_STA_CMD_DEL: -+ break; -+ default: -+ goto exit; -+ } -+ -+ /* 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) { -+ if (cmd_id == PRE_LINK_STA_CMD_ADD) -+ rtw_pre_link_sta_add(&adapter->stapriv, addr); -+ else -+ rtw_pre_link_sta_del(&adapter->stapriv, addr); -+ } -+ -+ c = strsep(&next, " \t"); -+ } -+ } -+ -+exit: -+ return count; -+} -+#endif /* CONFIG_RTW_PRE_LINK_STA */ -+ -+static int proc_get_ch_sel_policy(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, "%-16s\n", "within_same_band"); -+ -+ RTW_PRINT_SEL(m, "%16d\n", rfctl->ch_sel_within_same_band); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_ch_sel_policy(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 within_sb; -+ 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, "%hhu", &within_sb); -+ if (num >= 1) -+ rfctl->ch_sel_within_same_band = within_sb ? 1 : 0; -+ -+exit: -+ return count; -+} -+ -+#ifdef CONFIG_80211D -+static int proc_get_country_ie_slave_en_conds(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, "%-4s %-5s\n", "role", "ifbmp"); -+ RTW_PRINT_SEL(m, "0x%02x 0x%02x\n" -+ , rfctl->country_ie_slave_en_role -+ , rfctl->country_ie_slave_en_ifbmp -+ ); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_country_ie_slave_en_conds(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]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ u8 role, ifbmp; -+ int num = sscanf(tmp, "%hhx %hhx", &role, &ifbmp); -+ -+ if (num >= 1) -+ rfctl->country_ie_slave_en_role = role; -+ if (num >= 2) -+ rfctl->country_ie_slave_en_ifbmp = ifbmp; -+ } -+ -+ return count; -+} -+ -+static int proc_get_country_ie_slave_records(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); -+ -+ dump_country_ie_slave_records(m, rfctl, 0); -+ -+ return 0; -+} -+#endif /* CONFIG_80211D */ -+ -+#ifdef CONFIG_DFS_MASTER -+static int proc_get_dfs_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_radar_detect_trigger_non -+ , rfctl->dbg_dfs_choose_dfs_ch_first -+ ); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_dfs_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_radar_detect_trigger_non = radar_detect_trigger_non; -+ if (num >= 2) -+ rfctl->dbg_dfs_choose_dfs_ch_first = choose_dfs_ch_first; -+ } -+ -+ return count; -+} -+ -+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 rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ char tmp[32]; -+ u8 ch, bw = CHANNEL_WIDTH_20, offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ int ms = -1; -+ bool updated = 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 %hhu %hhu %d", &ch, &bw, &offset, &ms); -+ -+ if (num < 1 || (bw != CHANNEL_WIDTH_20 && num < 3)) -+ goto exit; -+ -+ if (bw == CHANNEL_WIDTH_20) -+ updated = rtw_chset_update_non_ocp_ms(rfctl->channel_set -+ , ch, bw, HAL_PRIME_CHNL_OFFSET_DONT_CARE, ms); -+ else -+ updated = rtw_chset_update_non_ocp_ms(rfctl->channel_set -+ , ch, bw, offset, ms); -+ -+ if (updated) { -+ u8 cch = rtw_get_center_ch(ch, bw, offset); -+ -+ rtw_nlrtw_nop_start_event(adapter, cch, bw); -+ } -+ } -+ -+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_fake_radar_detect_cnt = fake_radar_detect_cnt; -+ } -+ -+exit: -+ return count; -+} -+ -+static int proc_get_dfs_ch_sel_e_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_e_flags); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_dfs_ch_sel_e_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 e_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", &e_flags); -+ if (num != 1) -+ goto exit; -+ -+ rfctl->dfs_ch_sel_e_flags = e_flags; -+ -+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; -+} -+ -+#if CONFIG_DFS_SLAVE_WITH_RADAR_DETECT -+static int proc_get_dfs_slave_with_rd(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, "%u\n", rfctl->dfs_slave_with_rd); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_dfs_slave_with_rd(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 rd; -+ 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, "%hhu", &rd); -+ if (num != 1) -+ goto exit; -+ -+ rd = rd ? 1 : 0; -+ -+ if (rfctl->dfs_slave_with_rd != rd) { -+ rfctl->dfs_slave_with_rd = rd; -+ rtw_dfs_rd_en_decision_cmd(adapter); -+ } -+ -+exit: -+ return count; -+} -+#endif /* CONFIG_DFS_SLAVE_WITH_RADAR_DETECT */ -+#endif /* CONFIG_DFS_MASTER */ -+ -+#ifdef CONFIG_80211N_HT -+int proc_get_rx_ampdu_size_limit(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_regsty_rx_ampdu_size_limit(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_ampdu_size_limit(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 registry_priv *regsty = adapter_to_regsty(adapter); -+ char tmp[32]; -+ u8 nss; -+ u8 limit_by_bw[4] = {0xFF}; -+ -+ 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; -+ int num = sscanf(tmp, "%hhu %hhu %hhu %hhu %hhu" -+ , &nss, &limit_by_bw[0], &limit_by_bw[1], &limit_by_bw[2], &limit_by_bw[3]); -+ -+ if (num < 2) -+ goto exit; -+ if (nss == 0 || nss > 4) -+ goto exit; -+ -+ for (i = 0; i < num - 1; i++) -+ regsty->rx_ampdu_sz_limit_by_nss_bw[nss - 1][i] = limit_by_bw[i]; -+ -+ rtw_rx_ampdu_apply(adapter); -+ } -+ -+exit: -+ return count; -+} -+#endif /* CONFIG_80211N_HT */ -+ -+static int proc_get_rx_chk_limit(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "Rx chk limit : %d\n", rtw_get_rx_chk_limit(padapter)); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_rx_chk_limit(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); -+ int rx_chk_limit; -+ -+ 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", &rx_chk_limit); -+ -+ rtw_set_rx_chk_limit(padapter, rx_chk_limit); -+ } -+ -+ return count; -+} -+ -+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 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 %-5s %-4s %-17s %-6s %-3s" -+ , "id", "bmc", "ifbmp", "ch_g", "macaddr", "bw", "vht"); -+ -+ if (GET_HAL_TX_NSS(adapter) > 2) -+ _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]->cmn.mac_addr; -+ else -+ macaddr = null_addr; -+ -+ RTW_PRINT_SEL(m, "%3u %3u 0x%02x %4d "MAC_FMT" %6s %3u" -+ , i -+ , rtw_macid_is_bmc(macid_ctl, i) -+ , rtw_macid_get_iface_bmp(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 (GET_HAL_TX_NSS(adapter) > 2) -+ _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]" -+ ); -+ } -+ } -+ RTW_PRINT_SEL(m, "\n"); -+ -+ for (i = 0; i < H2C_MSR_ROLE_MAX; i++) { -+ if (macid_ctl->op_num[i]) { -+ RTW_PRINT_SEL(m, "%-5s op_num:%u\n" -+ , h2c_msr_role_str(i), macid_ctl->op_num[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; -+ -+ 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; -+} -+ -+#ifdef CONFIG_AP_MODE -+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 dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int i; -+ char tmp[32]; -+ s16 ch; -+ s8 bw = REQ_BW_NONE, offset = REQ_OFFSET_NONE; -+ u8 ifbmp = 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, "%hd %hhd %hhd %hhx", &ch, &bw, &offset, &ifbmp); -+ -+ if (num < 1 || (bw != CHANNEL_WIDTH_20 && num < 3)) -+ goto exit; -+ -+ if (num < 4) -+ ifbmp = BIT(adapter->iface_id); -+ else -+ ifbmp &= (1 << dvobj->iface_nums) - 1; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) -+ continue; -+ -+ if (!CHK_MLME_STATE(dvobj->padapters[i], WIFI_AP_STATE | WIFI_MESH_STATE) -+ || !MLME_IS_ASOC(dvobj->padapters[i])) -+ ifbmp &= ~BIT(i); -+ } -+ -+ if (ifbmp) -+ rtw_change_bss_chbw_cmd(adapter, RTW_CMDF_WAIT_ACK, ifbmp, 0, ch, bw, offset); -+ } -+ -+exit: -+ return count; -+} -+#endif -+ -+#if CONFIG_TX_AC_LIFETIME -+static int proc_get_tx_aclt_force_val(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ dump_tx_aclt_force_val(m, dvobj); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_tx_aclt_force_val(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ char tmp[32] = {0}; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct tx_aclt_conf_t input; -+ int num = sscanf(tmp, "%hhx %u %u", &input.en, &input.vo_vi, &input.be_bk); -+ -+ if (num < 1) -+ return count; -+ -+ rtw_hal_set_tx_aclt_force_val(adapter, &input, num); -+ rtw_run_in_thread_cmd(adapter, ((void *)(rtw_hal_update_tx_aclt)), adapter); -+ } -+ -+ return count; -+} -+ -+static int proc_get_tx_aclt_flags(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ RTW_PRINT_SEL(m, "0x%02x\n", dvobj->tx_aclt_flags); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_tx_aclt_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ char tmp[32] = {0}; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 flags; -+ int num = sscanf(tmp, "%hhx", &flags); -+ -+ if (num < 1) -+ return count; -+ -+ if (dvobj->tx_aclt_flags == flags) -+ return count; -+ -+ dvobj->tx_aclt_flags = flags; -+ -+ rtw_run_in_thread_cmd(adapter, ((void *)(rtw_hal_update_tx_aclt)), adapter); -+ } -+ -+ return count; -+} -+ -+static int proc_get_tx_aclt_confs(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ RTW_PRINT_SEL(m, "flags:0x%02x\n", dvobj->tx_aclt_flags); -+ dump_tx_aclt_confs(m, dvobj); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_tx_aclt_confs(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ char tmp[32] = {0}; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 id; -+ struct tx_aclt_conf_t input; -+ int num = sscanf(tmp, "%hhu %hhx %u %u", &id, &input.en, &input.vo_vi, &input.be_bk); -+ -+ if (num < 2) -+ return count; -+ -+ rtw_hal_set_tx_aclt_conf(adapter, id, &input, num - 1); -+ rtw_run_in_thread_cmd(adapter, ((void *)(rtw_hal_update_tx_aclt)), adapter); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_TX_AC_LIFETIME */ -+ -+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 void rtw_set_tx_bw_mode(struct _ADAPTER *adapter, u8 bw_mode) -+{ -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; -+ u8 update = _FALSE; -+ -+ 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->cmn.mac_addr)) -+ rtw_dm_ra_mask_wk_cmd(adapter, (u8 *)sta); -+ } -+ } -+} -+ -+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); -+ 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)) { -+ -+ int num = sscanf(tmp, "%hhx", &bw_mode); -+ -+ if (num < 1 || bw_mode == adapter->driver_tx_bw_mode) -+ goto exit; -+ -+ rtw_set_tx_bw_mode(adapter, bw_mode); -+ } -+ -+exit: -+ return count; -+} -+ -+static int proc_get_hal_txpwr_info(struct seq_file *m, void *v) -+{ -+#ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ if (hal_data->txpwr_pg_mode == TXPWR_PG_WITH_PWR_IDX) { -+ if (hal_is_band_support(adapter, BAND_ON_2_4G)) -+ dump_hal_txpwr_info_2g(m, adapter, hal_spec->rfpath_num_2g, hal_data->max_tx_cnt); -+ -+ #if 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_data->max_tx_cnt); -+ #endif -+ } -+#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; -+} -+ -+#if CONFIG_TXPWR_LIMIT -+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_txpwr_lmt(m, adapter); -+ -+ return 0; -+} -+#endif /* CONFIG_TXPWR_LIMIT */ -+ -+static int proc_get_tpc_settings(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_txpwr_tpc_settings(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_tpc_settings(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] = {0}; -+ u8 mode; -+ u16 m_constraint; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu %hu", &mode, &m_constraint); -+ -+ if (num < 1) -+ return count; -+ -+ if (mode >= TPC_MODE_INVALID) -+ return count; -+ -+ if (mode == TPC_MODE_MANUAL && num >= 2) -+ rfctl->tpc_manual_constraint = rtw_min(m_constraint, TPC_MANUAL_CONSTRAINT_MAX); -+ rfctl->tpc_mode = mode; -+ -+ if (rtw_get_hw_init_completed(adapter)) -+ rtw_run_in_thread_cmd_wait(adapter, ((void *)(rtw_hal_update_txpwr_level)), adapter, 2000); -+ } -+ -+ return count; -+} -+ -+static int proc_get_antenna_gain(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_txpwr_antenna_gain(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_antenna_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); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ char tmp[32] = {0}; -+ s16 gain; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hd", &gain); -+ -+ if (num < 1) -+ return count; -+ -+ rfctl->antenna_gain = gain; -+ -+ if (rtw_get_hw_init_completed(adapter)) -+ rtw_run_in_thread_cmd_wait(adapter, ((void *)(rtw_hal_update_txpwr_level)), adapter, 2000); -+ } -+ -+ return count; -+} -+ -+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); -+ if (rtw_pwr_wakeup(adapter) == _FALSE) -+ goto clear_ps_deny; -+ -+ 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_run_in_thread_cmd_wait(adapter, ((void *)(rtw_hal_update_txpwr_level)), adapter, 2000); -+ -+clear_ps_deny: -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ } -+ -+ return count; -+} -+ -+static void *proc_start_tx_power_idx(struct seq_file *m, loff_t *pos) -+{ -+ u8 path = ((*pos) & 0xFF00) >> 8; -+ -+ if (path >= RF_PATH_MAX) -+ return NULL; -+ -+ return pos; -+} -+static void proc_stop_tx_power_idx(struct seq_file *m, void *v) -+{ -+} -+ -+static void *proc_next_tx_power_idx(struct seq_file *m, void *v, loff_t *pos) -+{ -+ 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); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u32 pos = *((loff_t *)(v)); -+ u8 path = (pos & 0xFF00) >> 8; -+ u8 rs = pos & 0xFF; -+ enum channel_width bw = hal_data->current_channel_bw; -+ u8 cch = hal_data->current_channel; -+ -+ 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, bw, cch, 0); -+ dump_tx_power_idx_by_path_rs(m, adapter, path, rs, bw, cch, 0); -+ -+ 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, -+}; -+ -+static ssize_t proc_set_tx_power_idx_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] = {0}; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ u8 ch, bw, offset; -+ u8 cch; -+ -+ int num = sscanf(tmp, "%hhu %hhu %hhu", &ch, &bw, &offset); -+ -+ if (num < 3) -+ return count; -+ -+ cch = rtw_get_center_ch(ch, bw, offset); -+ dump_tx_power_idx(RTW_DBGDUMP, adapter, bw, cch, ch); -+ } -+ -+ return count; -+} -+ -+static void *proc_start_txpwr_total_dbm(struct seq_file *m, loff_t *pos) -+{ -+ u8 rs = *pos; -+ -+ if (rs >= RATE_SECTION_NUM) -+ return NULL; -+ -+ return pos; -+} -+ -+static void proc_stop_txpwr_total_dbm(struct seq_file *m, void *v) -+{ -+} -+ -+static void *proc_next_txpwr_total_dbm(struct seq_file *m, void *v, loff_t *pos) -+{ -+ u8 rs = *pos; -+ -+ rs++; -+ if (rs >= RATE_SECTION_NUM) -+ return NULL; -+ -+ *pos = rs; -+ -+ return pos; -+} -+ -+static int proc_get_txpwr_total_dbm(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); -+ u32 pos = *((loff_t *)(v)); -+ u8 rs = pos; -+ enum channel_width bw = hal_data->current_channel_bw; -+ u8 cch = hal_data->current_channel; -+ -+ if (rs == CCK) -+ dump_txpwr_total_dbm_title(m, adapter, bw, cch, 0); -+ dump_txpwr_total_dbm_by_rs(m, adapter, rs, bw, cch, 0); -+ -+ return 0; -+} -+ -+static struct seq_operations seq_ops_txpwr_total_dbm = { -+ .start = proc_start_txpwr_total_dbm, -+ .stop = proc_stop_txpwr_total_dbm, -+ .next = proc_next_txpwr_total_dbm, -+ .show = proc_get_txpwr_total_dbm, -+}; -+ -+static ssize_t proc_set_txpwr_total_dbm_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] = {0}; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ u8 ch, bw, offset; -+ u8 cch; -+ -+ int num = sscanf(tmp, "%hhu %hhu %hhu", &ch, &bw, &offset); -+ -+ if (num < 3) -+ return count; -+ -+ cch = rtw_get_center_ch(ch, bw, offset); -+ dump_txpwr_total_dbm(RTW_DBGDUMP, adapter, bw, cch, ch); -+ } -+ -+ return count; -+} -+ -+#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); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(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: "); -+#if CONFIG_IEEE80211_BAND_5GHZ -+ switch (i) { -+ case 1: -+ _RTW_PRINT_SEL(m, "5GLB1: "); -+ break; -+ case 2: -+ _RTW_PRINT_SEL(m, "5GLB2: "); -+ break; -+ case 3: -+ _RTW_PRINT_SEL(m, "5GMB1: "); -+ break; -+ case 4: -+ _RTW_PRINT_SEL(m, "5GMB2: "); -+ break; -+ case 5: -+ _RTW_PRINT_SEL(m, "5GHB: "); -+ break; -+ } -+#endif -+ for (j = 0; j < hal_spec->rf_reg_path_num; 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); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ char tmp[BB_GAIN_NUM * RF_PATH_MAX] = {0}; -+ u8 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; -+#if 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)) { -+ 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; -+ -+ -+ 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; -+ } -+ -+ n = sizeof(btreg_type) / sizeof(btreg_type[0]); -+ for (i = 0; i < n; i++) { -+ if (!strcasecmp(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; -+} -+ -+int proc_get_btc_reduce_wl_txpwr(struct seq_file *m, void *v) -+{ -+ struct net_device *dev; -+ PADAPTER padapter; -+ u8 data; -+ -+ dev = m->private; -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ data = rtw_btcoex_get_reduce_wl_txpwr(padapter); -+ RTW_PRINT_SEL(m, "BTC reduce WL TxPwr = %d dB\n", data); -+ -+ return 0; -+} -+ -+ssize_t proc_set_btc_reduce_wl_txpwr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ PADAPTER padapter; -+ HAL_DATA_TYPE *hal_data; -+ u8 tmp[80] = {0}; -+ u32 val = 0; -+ u32 num; -+ -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ hal_data = GET_HAL_DATA(padapter); -+ -+ /* 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, "%d", &val); -+ -+ if ((IS_HARDWARE_TYPE_8822C(padapter)) && (hal_data->EEPROMBluetoothCoexist == _TRUE)) -+ rtw_btc_reduce_wl_txpwr_cmd(padapter, val); -+ -+ 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_RTW_ACS -+static int proc_get_chan_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_acs_chan_info_dump(m, adapter); -+ return 0; -+} -+ -+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); -+ -+ if (IS_ACS_ENABLE(adapter)) -+ rtw_acs_info_dump(m, adapter); -+ else -+ _RTW_PRINT_SEL(m,"ACS disabled\n"); -+ return 0; -+} -+ -+static ssize_t proc_set_acs(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+#ifdef CONFIG_RTW_ACS_DBG -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 acs_state = 0; -+ u16 scan_ch_ms= 0, acs_scan_ch_ms = 0; -+ u8 scan_type = SCAN_ACTIVE, igi= 0, bw = 0; -+ u8 acs_scan_type = SCAN_ACTIVE, acs_igi= 0, acs_bw = 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 %hhu %hu %hhx %hhu", -+ &acs_state, &scan_type, &scan_ch_ms, &igi, &bw); -+ -+ if (num < 1) -+ return -EINVAL; -+ -+ if (acs_state) -+ rtw_acs_start(padapter); -+ else -+ rtw_acs_stop(padapter); -+ num = num -1; -+ -+ if(num) { -+ if (num-- > 0) -+ acs_scan_type = scan_type; -+ if (num-- > 0) -+ acs_scan_ch_ms = scan_ch_ms; -+ if (num-- > 0) -+ acs_igi = igi; -+ if (num-- > 0) -+ acs_bw = bw; -+ rtw_acs_adv_setting(padapter, acs_scan_type, acs_scan_ch_ms, acs_igi, acs_bw); -+ } -+ } -+#endif /*CONFIG_RTW_ACS_DBG*/ -+ return count; -+} -+#endif /*CONFIG_RTW_ACS*/ -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+static int proc_get_nm(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_noise_info_dump(m, adapter); -+ return 0; -+} -+ -+static ssize_t proc_set_nm(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 nm_state = 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", &nm_state); -+ -+ if (num < 1) -+ return -EINVAL; -+ -+ if (nm_state) -+ rtw_nm_enable(padapter); -+ else -+ rtw_nm_disable(padapter); -+ -+ } -+ return count; -+} -+#endif /*CONFIG_RTW_ACS*/ -+ -+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; -+} -+ -+static int proc_get_hal_trx_mode(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ -+ dump_hal_trx_mode(m, adapter); -+ return 0; -+} -+ -+static int proc_get_phy_cap(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_dump_phy_cap(m, adapter); -+#ifdef CONFIG_80211N_HT -+ rtw_dump_drv_phy_cap(m, adapter); -+ rtw_get_dft_phy_cap(m, adapter); -+#endif /* CONFIG_80211N_HT */ -+ 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_dump_rsvd_page(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_dump_rsvd_page(m, adapter, adapter->rsvd_page_offset, adapter->rsvd_page_num); -+ return 0; -+} -+static ssize_t proc_set_rsvd_page_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); -+ char tmp[32]; -+ u8 page_offset, page_num; -+ -+ if (count < 2) -+ 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", &page_offset, &page_num); -+ -+ if (num < 2) -+ return -EINVAL; -+ padapter->rsvd_page_offset = page_offset; -+ padapter->rsvd_page_num = page_num; -+ } -+ return count; -+} -+ -+#ifdef CONFIG_SUPPORT_FIFO_DUMP -+static int proc_dump_fifo(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_dump_fifo(m, adapter, adapter->fifo_sel, adapter->fifo_addr, adapter->fifo_size); -+ return 0; -+} -+static ssize_t proc_set_fifo_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); -+ char tmp[32]; -+ u8 fifo_sel = 0; -+ u32 fifo_addr = 0; -+ u32 fifo_size = 0; -+ -+ if (count < 3) -+ 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 %x %d", &fifo_sel, &fifo_addr, &fifo_size); -+ -+ if (num < 3) -+ return -EINVAL; -+ -+ padapter->fifo_sel = fifo_sel; -+ padapter->fifo_addr = fifo_addr; -+ padapter->fifo_size = fifo_size; -+ } -+ return count; -+} -+#endif -+ -+#ifdef CONFIG_WOW_PATTERN_HW_CAM -+int proc_dump_pattern_cam(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); -+ int i; -+ struct rtl_wow_pattern context; -+ -+ for (i = 0 ; i < pwrpriv->wowlan_pattern_idx; i++) { -+ rtw_wow_pattern_read_cam_ent(padapter, i, &context); -+ rtw_dump_wow_pattern(m, &context, i); -+ } -+ -+ 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; -+ struct dvobj_priv *d; -+ d = adapter_to_dvobj(adapter); -+ -+ -+#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); -+#ifdef CONFIG_RTW_NAPI_DYNAMIC -+ RTW_PRINT_SEL(m, "Dynamaic NAPI mechanism is on, current NAPI %s\n", -+ d->en_napi_dynamic ? "enable" : "disable"); -+ RTW_PRINT_SEL(m, "Dynamaic NAPI info:\n" -+ "\ttcp_rx_threshold = %d Mbps\n" -+ "\tcur_rx_tp = %d Mbps\n", -+ pregistrypriv->napi_threshold, -+ d->traffic_stat.cur_rx_tp); -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+ } else { -+ RTW_PRINT_SEL(m, "NAPI disable\n"); -+ } -+ RTW_PRINT_SEL(m, "GRO %s\n", gro?"enable":"disable"); -+ -+ return 0; -+ -+} -+ -+#ifdef CONFIG_RTW_NAPI_DYNAMIC -+static ssize_t proc_set_napi_th(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 registry_priv *registry = &adapter->registrypriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ PADAPTER iface = NULL; -+ char tmp[32] = {0}; -+ int thrshld = 0; -+ int num = 0, i = 0; -+ -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ RTW_INFO("%s: Last threshold = %d Mbps\n", __FUNCTION__, registry->napi_threshold); -+ -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) { -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ registry = &iface->registrypriv; -+ num = sscanf(tmp, "%d", &thrshld); -+ if (num > 0) { -+ if (thrshld > 0) -+ registry->napi_threshold = thrshld; -+ } -+ } -+ } -+ } -+ RTW_INFO("%s: New threshold = %d Mbps\n", __FUNCTION__, registry->napi_threshold); -+ RTW_INFO("%s: Current RX throughput = %d Mbps\n", -+ __FUNCTION__, adapter_to_dvobj(adapter)->traffic_stat.cur_rx_tp); -+ -+ return count; -+} -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+ -+ -+ssize_t proc_set_dynamic_agg_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[32]; -+ int enable = 0, i = 0; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ PADAPTER iface = NULL; -+ int num = sscanf(tmp, "%d", &enable); -+ -+ if (num != 1) { -+ RTW_INFO("invalid parameter!\n"); -+ return count; -+ } -+ -+ RTW_INFO("dynamic_agg_enable:%d\n", enable); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) -+ iface->registrypriv.dynamic_agg_enable = enable; -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+static int proc_get_dynamic_agg_enable(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; -+ -+ RTW_PRINT_SEL(m, "dynamic_agg_enable:%d\n", pregistrypriv->dynamic_agg_enable); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_RTW_WDS -+static int proc_get_wds_en(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ -+ if (MLME_STATE(adapter) & (WIFI_AP_STATE | WIFI_STATION_STATE)) -+ RTW_PRINT_SEL(m, "%d\n", adapter_use_wds(adapter)); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_wds_en(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ if (!(MLME_STATE(adapter) & (WIFI_AP_STATE | WIFI_STATION_STATE))) -+ return -EFAULT; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ u8 enable; -+ int num = sscanf(tmp, "%hhu", &enable); -+ -+ if (num >= 1) -+ adapter_set_use_wds(adapter, enable); -+ } -+ -+ return count; -+} -+ -+static ssize_t proc_set_sta_wds_en(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ 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)) { -+ u8 enable; -+ u8 addr[ETH_ALEN]; -+ struct sta_info *sta; -+ int num = sscanf(tmp, "%hhu "MAC_SFMT, &enable, MAC_SARG(addr)); -+ -+ if (num != 7) -+ return -EINVAL; -+ -+ if (IS_MCAST(addr) || _rtw_memcmp(adapter_mac_addr(adapter), addr, ETH_ALEN)) -+ return -EINVAL; -+ -+ sta = rtw_get_stainfo(&adapter->stapriv, addr); -+ if (!sta) -+ return -EINVAL; -+ -+ if (enable) -+ sta->flags |= WLAN_STA_WDS; -+ else -+ sta->flags &= ~WLAN_STA_WDS; -+ } -+ -+ return count; -+} -+ -+static int proc_get_wds_gptr(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ -+ if (MLME_IS_STA(adapter) && MLME_IS_ASOC(adapter)) -+ dump_wgptr(m, adapter); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_AP_MODE -+static int proc_get_wds_path(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ -+ if (MLME_IS_AP(adapter) && MLME_IS_ASOC(adapter)) -+ dump_wpath(m, adapter); -+ -+ return 0; -+} -+#endif /* CONFIG_AP_MODE */ -+#endif /* CONFIG_RTW_WDS */ -+ -+#ifdef CONFIG_RTW_MULTI_AP -+static int proc_get_multi_ap_opmode(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ -+ if (MLME_STATE(adapter) & (WIFI_AP_STATE | WIFI_STATION_STATE)) -+ RTW_PRINT_SEL(m, "0x%02x\n", adapter->multi_ap); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_multi_ap_opmode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ if (!(MLME_STATE(adapter) & (WIFI_AP_STATE | WIFI_STATION_STATE))) -+ return -EFAULT; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ u8 mode; -+ int num = sscanf(tmp, "%hhx", &mode); -+ -+ if (num >= 1) { -+ if (MLME_IS_AP(adapter)) -+ adapter->multi_ap = mode & (MULTI_AP_FRONTHAUL_BSS | MULTI_AP_BACKHAUL_BSS); -+ else -+ adapter->multi_ap = mode & MULTI_AP_BACKHAUL_STA; -+ if (adapter->multi_ap & (MULTI_AP_BACKHAUL_BSS | MULTI_AP_BACKHAUL_STA)) -+ adapter_set_use_wds(adapter, 1); -+ } -+ } -+ -+ return count; -+} -+ -+static int proc_get_unassoc_sta(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = GET_PRIMARY_ADAPTER(rtw_netdev_priv(dev)); -+ -+ dump_unassoc_sta(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_unassoc_sta(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = GET_PRIMARY_ADAPTER(rtw_netdev_priv(dev)); -+ char tmp[17 * 10 + 32] = {0}; -+ char cmd[32]; -+ u8 mode; -+ u8 stype = 0; -+ u8 addr[ETH_ALEN]; -+ -+#define UNASOC_STA_CMD_MODE 0 -+#define UNASOC_STA_CMD_ADD 1 -+#define UNASOC_STA_CMD_DEL 2 -+#define UNASOC_STA_CMD_CLR 3 -+#define UNASOC_STA_CMD_UNINT 4 -+#define UNASOC_STA_CMD_NUM 5 -+ -+ static const char * const unasoc_sta_cmd_str[] = { -+ "mode", -+ "add", -+ "del", -+ "clr", -+ "uninterest", -+ }; -+ u8 cmd_id = UNASOC_STA_CMD_NUM; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ RTW_WARN(FUNC_ADPT_FMT" input string too long\n", FUNC_ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ /* -+ * mode , -+ * add [] -+ * del [] -+ * clr -+ */ -+ char *c, *next; -+ int i; -+ u8 is_bcast; -+ -+ next = tmp; -+ c = strsep(&next, " \t"); -+ if (!c || sscanf(c, "%s", cmd) != 1) -+ goto exit; -+ -+ for (i = 0; i < UNASOC_STA_CMD_NUM; i++) -+ if (strcmp(unasoc_sta_cmd_str[i], cmd) == 0) -+ cmd_id = i; -+ -+ switch (cmd_id) { -+ case UNASOC_STA_CMD_MODE: -+ c = strsep(&next, " \t"); -+ if (!c || sscanf(c, "%hhu,%hhu", &stype, &mode) != 2) { -+ RTW_WARN(FUNC_ADPT_FMT" invalid arguments of mode cmd\n", FUNC_ADPT_ARG(adapter)); -+ goto exit; -+ } -+ if (stype >= UNASOC_STA_SRC_NUM) { -+ RTW_WARN(FUNC_ADPT_FMT" invalid stype:%u\n", FUNC_ADPT_ARG(adapter), stype); -+ goto exit; -+ } -+ if (mode >= UNASOC_STA_MODE_NUM) { -+ RTW_WARN(FUNC_ADPT_FMT" invalid mode:%u\n", FUNC_ADPT_ARG(adapter), mode); -+ goto exit; -+ } -+ rtw_unassoc_sta_set_mode(adapter, stype, mode); -+ break; -+ -+ case UNASOC_STA_CMD_ADD: -+ case UNASOC_STA_CMD_DEL: -+ case UNASOC_STA_CMD_UNINT: -+ /* check for macaddr list */ -+ c = strsep(&next, " \t"); -+ while (c != NULL) { -+ if (sscanf(c, MAC_SFMT, MAC_SARG(addr)) != 6) -+ break; -+ -+ is_bcast = is_broadcast_mac_addr(addr); -+ if (is_bcast -+ || rtw_check_invalid_mac_address(addr, 0) == _FALSE -+ ) { -+ if (cmd_id == UNASOC_STA_CMD_DEL) { -+ if (is_bcast) { -+ rtw_del_unassoc_sta_queue(adapter); -+ break; -+ } else -+ rtw_del_unassoc_sta(adapter, addr); -+ } else if (cmd_id == UNASOC_STA_CMD_UNINT) { -+ if (is_bcast) { -+ rtw_undo_all_interested_unassoc_sta(adapter); -+ break; -+ } else -+ rtw_undo_interested_unassoc_sta(adapter, addr); -+ } else if (!is_bcast) -+ rtw_add_interested_unassoc_sta(adapter, addr); -+ } -+ -+ c = strsep(&next, " \t"); -+ } -+ break; -+ -+ case UNASOC_STA_CMD_CLR: -+ /* clear sta list */ -+ rtw_del_unassoc_sta_queue(adapter); -+ goto exit; -+ -+ default: -+ RTW_WARN(FUNC_ADPT_FMT" invalid cmd:\"%s\"\n", FUNC_ADPT_ARG(adapter), cmd); -+ goto exit; -+ } -+ } -+ -+exit: -+ return count; -+} -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+static u8 assoc_req_mac_addr[6]; -+int proc_get_sta_assoc_req_frame_body(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_AP(adapter)) { -+ struct sta_info *psta; -+ _irqL irqL; -+ u8 *passoc_req = NULL; -+ u32 assoc_req_len = 0; -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, assoc_req_mac_addr); -+ if (psta == NULL) { -+ RTW_PRINT(FUNC_ADPT_FMT" sta("MAC_FMT") not found\n", -+ FUNC_ADPT_ARG(adapter), MAC_ARG(assoc_req_mac_addr)); -+ return 0; -+ } -+ RTW_PRINT(FUNC_ADPT_FMT" sta("MAC_FMT") found\n", -+ FUNC_ADPT_ARG(adapter), MAC_ARG(assoc_req_mac_addr)); -+ _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); -+ } -+ } -+ _exit_critical_bh(&psta->lock, &irqL); -+ if (passoc_req && assoc_req_len > IEEE80211_3ADDR_LEN) { -+ u8 *body = passoc_req + IEEE80211_3ADDR_LEN; -+ u32 body_len = assoc_req_len - IEEE80211_3ADDR_LEN; -+ u16 i; -+ -+ for (i = 0; i < body_len; i++) -+ _RTW_PRINT_SEL(m, "%02X", body[i]); -+ _RTW_PRINT_SEL(m, "\n"); -+ } -+ if (passoc_req && assoc_req_len > 0) -+ rtw_mfree(passoc_req, assoc_req_len); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_sta_assoc_req_frame_body(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[18] = {0}; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ if (sscanf(tmp, MAC_SFMT, MAC_SARG(assoc_req_mac_addr)) != 6) { -+ _rtw_memset(assoc_req_mac_addr, 0, 6); -+ RTW_PRINT(FUNC_ADPT_FMT" Invalid format\n", -+ FUNC_ADPT_ARG(adapter)); -+ } -+ -+ } -+ -+ return count; -+} -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+static int proc_get_ch_util_threshold(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = GET_PRIMARY_ADAPTER(rtw_netdev_priv(dev)); -+ -+ RTW_PRINT_SEL(m, "%hhu\n", adapter->ch_util_threshold); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_ch_util_threshold(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = GET_PRIMARY_ADAPTER(rtw_netdev_priv(dev)); -+ char tmp[4]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ u8 threshold; -+ int num = sscanf(tmp, "%hhu", &threshold); -+ -+ if (num == 1) -+ adapter->ch_util_threshold = threshold; -+ } -+ -+ return count; -+} -+ -+static int proc_get_ch_utilization(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "%hhu\n", rtw_get_ch_utilization(adapter)); -+ -+ return 0; -+} -+#endif /* CONFIG_RTW_MULTI_AP */ -+ -+#ifdef CONFIG_RTW_MESH -+static int proc_get_mesh_peer_sel_policy(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_mesh_peer_sel_policy(m, adapter); -+ -+ return 0; -+} -+ -+#if CONFIG_RTW_MESH_ACNODE_PREVENT -+static int proc_get_mesh_acnode_prevent(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter)) -+ dump_mesh_acnode_prevent_settings(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_mesh_acnode_prevent(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]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; -+ u8 enable; -+ u32 conf_timeout_ms; -+ u32 notify_timeout_ms; -+ int num = sscanf(tmp, "%hhu %u %u", &enable, &conf_timeout_ms, ¬ify_timeout_ms); -+ -+ if (num >= 1) -+ peer_sel_policy->acnode_prevent = enable; -+ if (num >= 2) -+ peer_sel_policy->acnode_conf_timeout_ms = conf_timeout_ms; -+ if (num >= 3) -+ peer_sel_policy->acnode_notify_timeout_ms = notify_timeout_ms; -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RTW_MESH_ACNODE_PREVENT */ -+ -+#if CONFIG_RTW_MESH_OFFCH_CAND -+static int proc_get_mesh_offch_cand(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter)) -+ dump_mesh_offch_cand_settings(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_mesh_offch_cand(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]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; -+ u8 enable; -+ u32 find_int_ms; -+ int num = sscanf(tmp, "%hhu %u", &enable, &find_int_ms); -+ -+ if (num >= 1) -+ peer_sel_policy->offch_cand = enable; -+ if (num >= 2) -+ peer_sel_policy->offch_find_int_ms = find_int_ms; -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RTW_MESH_OFFCH_CAND */ -+ -+#if CONFIG_RTW_MESH_PEER_BLACKLIST -+static int proc_get_mesh_peer_blacklist(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter)) { -+ dump_mesh_peer_blacklist_settings(m, adapter); -+ if (MLME_IS_ASOC(adapter)) -+ dump_mesh_peer_blacklist(m, adapter); -+ } -+ -+ return 0; -+} -+ -+static ssize_t proc_set_mesh_peer_blacklist(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]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; -+ u32 conf_timeout_ms; -+ u32 blacklist_timeout_ms; -+ int num = sscanf(tmp, "%u %u", &conf_timeout_ms, &blacklist_timeout_ms); -+ -+ if (num >= 1) -+ peer_sel_policy->peer_conf_timeout_ms = conf_timeout_ms; -+ if (num >= 2) -+ peer_sel_policy->peer_blacklist_timeout_ms = blacklist_timeout_ms; -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RTW_MESH_PEER_BLACKLIST */ -+ -+#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+static int proc_get_mesh_cto_mgate_require(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter)) -+ RTW_PRINT_SEL(m, "%u\n", adapter->mesh_cfg.peer_sel_policy.cto_mgate_require); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_mesh_cto_mgate_require(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]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; -+ u8 require; -+ int num = sscanf(tmp, "%hhu", &require); -+ -+ if (num >= 1) { -+ peer_sel_policy->cto_mgate_require = require; -+ #if CONFIG_RTW_MESH_CTO_MGATE_CARRIER -+ if (rtw_mesh_cto_mgate_required(adapter)) -+ rtw_netif_carrier_off(adapter->pnetdev); -+ else -+ rtw_netif_carrier_on(adapter->pnetdev); -+ #endif -+ } -+ } -+ -+ return count; -+} -+ -+static int proc_get_mesh_cto_mgate_blacklist(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter)) { -+ dump_mesh_cto_mgate_blacklist_settings(m, adapter); -+ if (MLME_IS_ASOC(adapter)) -+ dump_mesh_cto_mgate_blacklist(m, adapter); -+ } -+ -+ return 0; -+} -+ -+static ssize_t proc_set_mesh_cto_mgate_blacklist(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]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; -+ u32 conf_timeout_ms; -+ u32 blacklist_timeout_ms; -+ int num = sscanf(tmp, "%u %u", &conf_timeout_ms, &blacklist_timeout_ms); -+ -+ if (num >= 1) -+ peer_sel_policy->cto_mgate_conf_timeout_ms = conf_timeout_ms; -+ if (num >= 2) -+ peer_sel_policy->cto_mgate_blacklist_timeout_ms = blacklist_timeout_ms; -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST */ -+ -+static int proc_get_mesh_networks(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_mesh_networks(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_mesh_plink_ctl(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter)) -+ dump_mesh_plink_ctl(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_mesh_mpath(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter)) -+ dump_mpath(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_mesh_mpp(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter)) -+ dump_mpp(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_mesh_known_gates(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter)) -+ dump_known_gates(m, adapter); -+ -+ return 0; -+} -+ -+#if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+static int proc_get_mesh_b2u_flags(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter)) -+ dump_mesh_b2u_flags(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_mesh_b2u_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]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ u8 msrc, mfwd; -+ int num = sscanf(tmp, "%hhx %hhx", &msrc, &mfwd); -+ -+ if (num >= 1) -+ mcfg->b2u_flags_msrc = msrc; -+ if (num >= 2) -+ mcfg->b2u_flags_mfwd = mfwd; -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RTW_MESH_DATA_BMC_TO_UC */ -+ -+static int proc_get_mesh_stats(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter)) -+ dump_mesh_stats(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_mesh_gate_timeout(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (MLME_IS_MESH(adapter)) -+ RTW_PRINT_SEL(m, "%u factor\n", -+ adapter->mesh_cfg.path_gate_timeout_factor); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_mesh_gate_timeout(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]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ u32 timeout; -+ int num = sscanf(tmp, "%u", &timeout); -+ -+ if (num < 1) -+ goto exit; -+ -+ mcfg->path_gate_timeout_factor = timeout; -+ } -+ -+exit: -+ return count; -+} -+ -+static int proc_get_mesh_gate_state(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; -+ u8 cto_mgate = 0; -+ -+ if (MLME_IS_MESH(adapter)) { -+ if (rtw_mesh_is_primary_gate(adapter)) -+ RTW_PRINT_SEL(m, "PG\n"); -+ else if (mcfg->dot11MeshGateAnnouncementProtocol) -+ RTW_PRINT_SEL(m, "G\n"); -+ else if (rtw_mesh_gate_num(adapter)) -+ RTW_PRINT_SEL(m, "C\n"); -+ else -+ RTW_PRINT_SEL(m, "N\n"); -+ } -+ -+ return 0; -+} -+ -+static int proc_get_peer_alive_based_preq(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct _ADAPTER *adapter= (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *rp = &adapter->registrypriv; -+ -+ RTW_PRINT_SEL(m, "peer_alive_based_preq = %u\n", -+ rp->peer_alive_based_preq); -+ -+ return 0; -+} -+ -+static ssize_t -+proc_set_peer_alive_based_preq(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct _ADAPTER *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *rp = &adapter->registrypriv; -+ char tmp[8]; -+ int num = 0; -+ u8 enable = 0; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (!buffer || copy_from_user(tmp, buffer, count)) -+ goto exit; -+ -+ num = sscanf(tmp, "%hhu", &enable); -+ if (num != 1) { -+ RTW_ERR("%s: invalid parameter!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ if (enable > 1) { -+ RTW_ERR("%s: invalid value!\n", __FUNCTION__); -+ goto exit; -+ } -+ rp->peer_alive_based_preq = enable; -+ -+exit: -+ return count; -+} -+#endif /* CONFIG_RTW_MESH */ -+ -+#ifdef RTW_BUSY_DENY_SCAN -+static int proc_get_scan_interval_thr(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct _ADAPTER *adapter= (struct _ADAPTER *)rtw_netdev_priv(dev); -+ struct registry_priv *rp = &adapter->registrypriv; -+ -+ -+ RTW_PRINT_SEL(m, "scan interval threshold = %u ms\n", -+ rp->scan_interval_thr); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_scan_interval_thr(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 registry_priv *rp = &adapter->registrypriv; -+ char tmp[12]; -+ int num = 0; -+ u32 thr = 0; -+ -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (!buffer || copy_from_user(tmp, buffer, count)) -+ goto exit; -+ -+ num = sscanf(tmp, "%u", &thr); -+ if (num != 1) { -+ RTW_ERR("%s: invalid parameter!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ rp->scan_interval_thr = thr; -+ -+ RTW_PRINT("%s: scan interval threshold = %u ms\n", -+ __FUNCTION__, rp->scan_interval_thr); -+ -+exit: -+ return count; -+} -+ -+#endif /* RTW_BUSY_DENY_SCAN */ -+ -+static int proc_get_scan_deny(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct _ADAPTER *adapter= (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ RTW_PRINT_SEL(m, "scan_deny is %s\n", (dvobj->scan_deny == _TRUE) ? "enable":"disable"); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_scan_deny(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct _ADAPTER *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ char tmp[8]; -+ int num = 0; -+ int enable = 0; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (!buffer || copy_from_user(tmp, buffer, count)) -+ goto exit; -+ -+ num = sscanf(tmp, "%d", &enable); -+ if (num != 1) { -+ RTW_ERR("%s: invalid parameter!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ dvobj->scan_deny = enable ? _TRUE : _FALSE; -+ -+ RTW_PRINT("%s: scan_deny is %s\n", -+ __FUNCTION__, (dvobj->scan_deny == _TRUE) ? "enable":"disable"); -+ -+exit: -+ return count; -+} -+ -+#ifdef CONFIG_RTW_TPT_MODE -+static int proc_get_tpt_mode(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct _ADAPTER *adapter= (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ RTW_PRINT_SEL(m, "current tpt_mode = %d\n", dvobj->tpt_mode); -+ -+ return 0; -+} -+ -+static void tpt_mode_default(struct _ADAPTER *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ /* 1. disable scan deny */ -+ dvobj->scan_deny = _FALSE; -+ -+ /* 2. back to original LPS mode */ -+#ifdef CONFIG_LPS -+ rtw_pm_set_lps(adapter, adapter->registrypriv.power_mgnt); -+#endif -+ -+ /* 3. back to original 2.4 tx bw mode */ -+ rtw_set_tx_bw_mode(adapter, adapter->registrypriv.tx_bw_mode); -+} -+ -+static void rtw_tpt_mode(struct _ADAPTER *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ if (dvobj->tpt_mode > 0) { -+ -+ /* when enable each tpt mode -+ 1. scan deny -+ 2. disable LPS */ -+ -+ dvobj->scan_deny = _TRUE; -+ -+#ifdef CONFIG_LPS -+ rtw_pm_set_lps(adapter, PS_MODE_ACTIVE); -+#endif -+ -+ } -+ -+ switch (dvobj->tpt_mode) { -+ case 0: /* default mode */ -+ tpt_mode_default(adapter); -+ break; -+ case 1: /* High TP*/ -+ /*tpt_mode1(adapter);*/ -+ dvobj->edca_be_ul = 0x5e431c; -+ dvobj->edca_be_dl = 0x00431c; -+ break; -+ case 2: /* noise */ -+ /* tpt_mode2(adapter); */ -+ dvobj->edca_be_ul = 0x00431c; -+ dvobj->edca_be_dl = 0x00431c; -+ -+ rtw_set_tx_bw_mode(adapter, 0x20); /* for 2.4g, fixed tx_bw_mode to 20Mhz */ -+ break; -+ case 3: /* long distance */ -+ /* tpt_mode3(adapter); */ -+ dvobj->edca_be_ul = 0x00431c; -+ dvobj->edca_be_dl = 0x00431c; -+ -+ rtw_set_tx_bw_mode(adapter, 0x20); /* for 2.4g, fixed tx_bw_mode to 20Mhz */ -+ break; -+ case 4: /* noise + long distance */ -+ /* tpt_mode4(adapter); */ -+ dvobj->edca_be_ul = 0x00431c; -+ dvobj->edca_be_dl = 0x00431c; -+ -+ rtw_set_tx_bw_mode(adapter, 0x20); /* for 2.4g, fixed tx_bw_mode to 20Mhz */ -+ break; -+ default: /* default mode */ -+ tpt_mode_default(adapter); -+ break; -+ } -+ -+} -+ -+static ssize_t proc_set_tpt_mode(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ struct _ADAPTER *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ char tmp[32]; -+ int num = 0; -+ int mode = 0; -+ -+#define MAX_TPT_MODE_NUM 4 -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (!buffer || copy_from_user(tmp, buffer, count)) -+ goto exit; -+ -+ num = sscanf(tmp, "%d", &mode); -+ if (num != 1) { -+ RTW_ERR("%s: invalid parameter!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ if (mode > MAX_TPT_MODE_NUM ) -+ mode = 0; -+ -+ RTW_PRINT("%s: previous mode = %d\n", -+ __FUNCTION__, dvobj->tpt_mode); -+ -+ RTW_PRINT("%s: enabled mode = %d\n", -+ __FUNCTION__, mode); -+ -+ dvobj->tpt_mode = mode; -+ -+ rtw_tpt_mode(adapter); -+ -+exit: -+ return count; -+ -+} -+#endif /* CONFIG_RTW_TPT_MODE */ -+ -+int proc_get_cur_beacon_keys(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ rtw_dump_bcn_keys(m, &mlme->cur_beacon_keys); -+ -+ return 0; -+} -+ -+static int proc_get_wpas_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "WPAS_INFO: %s\n", -+ (RTW_WPAS_W1FI == adapter_to_dvobj(padapter)->wpas_type) ? "w1.fi (0)" : "android (1)"); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_wpas_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); -+ char tmp[32]; -+ int val; -+ -+ 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 ", &val); -+ -+ if (RTW_WPAS_W1FI == val) -+ adapter_to_dvobj(padapter)->wpas_type = RTW_WPAS_W1FI; -+ else if (RTW_WPAS_ANDROID == val) -+ adapter_to_dvobj(padapter)->wpas_type = RTW_WPAS_ANDROID; -+ else -+ return -EFAULT; -+ } else -+ return -EFAULT; -+ -+ return count; -+} -+ -+static int proc_get_amsdu_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) { -+ if (pregpriv->amsdu_mode == RTW_AMSDU_MODE_NON_SPP) -+ RTW_PRINT_SEL(m, "amsdu mode: NON-SPP\n"); -+ else if (pregpriv->amsdu_mode == RTW_AMSDU_MODE_SPP) -+ RTW_PRINT_SEL(m, "amsdu mode: SPP\n"); -+ else if (pregpriv->amsdu_mode == RTW_AMSDU_MODE_ALL_DROP) -+ RTW_PRINT_SEL(m, "amsdu mode: ALL DROP\n"); -+ else -+ RTW_PRINT_SEL(m, "unexpected amsdu mode\n"); -+ } -+ -+ return 0; -+} -+ -+static ssize_t proc_set_amsdu_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, "%d", &mode); -+ -+ if (mode == RTW_AMSDU_MODE_NON_SPP -+ || mode == RTW_AMSDU_MODE_SPP -+ || mode == RTW_AMSDU_MODE_ALL_DROP) { -+ pregpriv->amsdu_mode = mode; -+ RTW_INFO("amsdu mode=%u\n", mode); -+ } else { -+ RTW_INFO("set unexpected mode = %d, won't apply\n", mode); -+ } -+ } -+ -+ return count; -+ -+} -+ -+/* -+* 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), -+ #ifdef CONFIG_AP_MODE -+ RTW_PROC_HDL_SSEQ("backop_flags_ap", proc_get_backop_flags_ap, proc_set_backop_flags_ap), -+ #endif -+ #ifdef CONFIG_RTW_MESH -+ RTW_PROC_HDL_SSEQ("backop_flags_mesh", proc_get_backop_flags_mesh, proc_set_backop_flags_mesh), -+ #endif -+#endif -+#ifdef CONFIG_RTW_REPEATER_SON -+ RTW_PROC_HDL_SSEQ("rson_data", proc_get_rson_data, proc_set_rson_data), -+#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), -+#ifdef ROKU_PRIVATE -+ RTW_PROC_HDL_SSEQ("infra_ap", proc_get_infra_ap, NULL), -+#endif /* ROKU_PRIVATE */ -+ RTW_PROC_HDL_SSEQ("trx_info", proc_get_trx_info, proc_reset_trx_info), -+ RTW_PROC_HDL_SSEQ("tx_power_offset", proc_get_tx_power_offset, proc_set_tx_power_offset), -+ 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("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("ps_dbg_info", proc_get_ps_dbg_info, proc_set_ps_dbg_info), -+ 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_MBO -+ RTW_PROC_HDL_SSEQ("non_pref_ch", rtw_mbo_proc_non_pref_chans_get, rtw_mbo_proc_non_pref_chans_set), -+ RTW_PROC_HDL_SSEQ("cell_data", rtw_mbo_proc_cell_data_get, rtw_mbo_proc_cell_data_set), -+#endif -+#ifdef CONFIG_RTW_80211R -+ RTW_PROC_HDL_SSEQ("ft_flags", rtw_ft_proc_flags_get, rtw_ft_proc_flags_set), -+#endif -+ RTW_PROC_HDL_SSEQ("defs_param", proc_get_defs_param, proc_set_defs_param), -+#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), -+ RTW_PROC_HDL_SSEQ("sdio_card_info", proc_get_sdio_card_info, NULL), -+ #ifdef CONFIG_SDIO_RECVBUF_AGGREGATION -+ RTW_PROC_HDL_SSEQ("sdio_recvbuf_aggregation", proc_get_sdio_recvbuf_aggregation, proc_set_sdio_recvbuf_aggregation), -+ #endif -+ #ifdef CONFIG_SDIO_RECVBUF_PWAIT -+ RTW_PROC_HDL_SSEQ("sdio_recvbuf_pwait", proc_get_sdio_recvbuf_pwait, proc_set_sdio_recvbuf_pwait), -+ #endif -+#ifdef DBG_SDIO -+ RTW_PROC_HDL_SSEQ("sdio_dbg", proc_get_sdio_dbg, proc_set_sdio_dbg), -+#endif /* DBG_SDIO */ -+#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("sta_linking_test", NULL, proc_set_sta_linking_test), -+#ifdef CONFIG_AP_MODE -+ RTW_PROC_HDL_SSEQ("ap_linking_test", NULL, proc_set_ap_linking_test), -+#endif -+ -+ 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("bb_reg_dump_ex", proc_get_bb_reg_dump_ex, NULL), -+ RTW_PROC_HDL_SSEQ("rf_reg_dump", proc_get_rf_reg_dump, NULL), -+ -+#ifdef CONFIG_RTW_LED -+ RTW_PROC_HDL_SSEQ("led_config", proc_get_led_config, proc_set_led_config), -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ RTW_PROC_HDL_SSEQ("aid_status", proc_get_aid_status, proc_set_aid_status), -+ RTW_PROC_HDL_SSEQ("ap_isolate", proc_get_ap_isolate, proc_set_ap_isolate), -+ RTW_PROC_HDL_SSEQ("all_sta_info", proc_get_all_sta_info, NULL), -+ RTW_PROC_HDL_SSEQ("bmc_tx_rate", proc_get_bmc_tx_rate, proc_set_bmc_tx_rate), -+ #if CONFIG_RTW_AP_DATA_BMC_TO_UC -+ RTW_PROC_HDL_SSEQ("ap_b2u_flags", proc_get_ap_b2u_flags, proc_set_ap_b2u_flags), -+ #endif -+#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("rx_chk_limit", proc_get_rx_chk_limit, proc_set_rx_chk_limit), -+ RTW_PROC_HDL_SSEQ("hw_info", proc_get_hw_status, proc_set_hw_status), -+ RTW_PROC_HDL_SSEQ("mac_rptbuf", proc_get_mac_rptbuf, NULL), -+#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_ampdu", proc_get_rx_ampdu, proc_set_rx_ampdu), -+ RTW_PROC_HDL_SSEQ("rx_ampdu_size_limit", proc_get_rx_ampdu_size_limit, proc_set_rx_ampdu_size_limit), -+ 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), -+ RTW_PROC_HDL_SSEQ("tx_max_agg_num", proc_get_tx_max_agg_num, proc_set_tx_max_agg_num), -+ RTW_PROC_HDL_SSEQ("tx_quick_addba_req", proc_get_tx_quick_addba_req, proc_set_tx_quick_addba_req), -+#ifdef CONFIG_TX_AMSDU -+ RTW_PROC_HDL_SSEQ("tx_amsdu", proc_get_tx_amsdu, proc_set_tx_amsdu), -+ RTW_PROC_HDL_SSEQ("tx_amsdu_rate", proc_get_tx_amsdu_rate, proc_set_tx_amsdu_rate), -+#endif -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_80211AC_VHT -+ RTW_PROC_HDL_SSEQ("vht_24g_enable", proc_get_vht_24g_enable, proc_set_vht_24g_enable), -+#endif -+ -+ #ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+ RTW_PROC_HDL_SSEQ("tx_aval_int_threshold", proc_get_tx_aval_th, proc_set_tx_aval_th), -+ #endif -+ -+ RTW_PROC_HDL_SSEQ("dynamic_rrsr", proc_get_dyn_rrsr, proc_set_dyn_rrsr), -+ RTW_PROC_HDL_SSEQ("en_fwps", proc_get_en_fwps, proc_set_en_fwps), -+ -+ /* 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), -+ RTW_PROC_HDL_SSEQ("btc_reduce_wl_txpwr", proc_get_btc_reduce_wl_txpwr, proc_set_btc_reduce_wl_txpwr), -+#ifdef CONFIG_RF4CE_COEXIST -+ RTW_PROC_HDL_SSEQ("rf4ce_state", proc_get_rf4ce_state, proc_set_rf4ce_state), -+#endif -+#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), -+ -+#ifdef CONFIG_HUAWEI_PROC -+ RTW_PROC_HDL_SSEQ("huawei_trx_info", proc_get_huawei_trx_info, NULL), -+#endif -+ RTW_PROC_HDL_SSEQ("linked_info_dump", proc_get_linked_info_dump, proc_set_linked_info_dump), -+ RTW_PROC_HDL_SSEQ("sta_tp_dump", proc_get_sta_tp_dump, proc_set_sta_tp_dump), -+ RTW_PROC_HDL_SSEQ("sta_tp_info", proc_get_sta_tp_info, NULL), -+ RTW_PROC_HDL_SSEQ("dis_turboedca", proc_get_turboedca_ctrl, proc_set_turboedca_ctrl), -+ 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), -+ -+#if defined(CONFIG_LPS_PG) && defined(CONFIG_RTL8822C) -+ RTW_PROC_HDL_SSEQ("lps_pg_debug", proc_get_lps_pg_debug, NULL), -+#endif -+ -+#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_DBG_RF_CAL -+ RTW_PROC_HDL_SSEQ("iqk", proc_get_iqk_info, proc_set_iqk), -+ RTW_PROC_HDL_SSEQ("lck", proc_get_lck_info, proc_set_lck), -+#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), -+#ifdef DBG_TXBD_DESC_DUMP -+ RTW_PROC_HDL_SSEQ("tx_ring_ext", proc_get_tx_ring_ext, proc_set_tx_ring_ext), -+#endif -+ RTW_PROC_HDL_SSEQ("pci_aspm", proc_get_pci_aspm, NULL), -+ -+ RTW_PROC_HDL_SSEQ("pci_conf_space", proc_get_pci_conf_space, proc_set_pci_conf_space), -+ -+ RTW_PROC_HDL_SSEQ("pci_bridge_conf_space", proc_get_pci_bridge_conf_space, proc_set_pci_bridge_conf_space), -+ -+#endif -+ -+#ifdef CONFIG_WOWLAN -+ RTW_PROC_HDL_SSEQ("wow_enable", proc_get_wow_enable, proc_set_wow_enable), -+ RTW_PROC_HDL_SSEQ("wow_pattern_info", proc_get_pattern_info, proc_set_pattern_info), -+ RTW_PROC_HDL_SSEQ("wow_wakeup_event", proc_get_wakeup_event, -+ proc_set_wakeup_event), -+ RTW_PROC_HDL_SSEQ("wowlan_last_wake_reason", proc_get_wakeup_reason, NULL), -+#ifdef CONFIG_WOW_PATTERN_HW_CAM -+ RTW_PROC_HDL_SSEQ("wow_pattern_cam", proc_dump_pattern_cam, NULL), -+#endif -+#ifdef CONFIG_WOW_KEEP_ALIVE_PATTERN -+ RTW_PROC_HDL_SSEQ("wow_keep_alive_info", proc_dump_wow_keep_alive_info, NULL), -+#endif /*CONFIG_WOW_KEEP_ALIVE_PATTERN*/ -+ -+#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), -+ RTW_PROC_HDL_SSEQ("cap_spt_op_class_ch", proc_get_cap_spt_op_class_ch, proc_set_cap_spt_op_class_ch), -+ RTW_PROC_HDL_SSEQ("reg_spt_op_class_ch", proc_get_reg_spt_op_class_ch, proc_set_reg_spt_op_class_ch), -+ RTW_PROC_HDL_SSEQ("cur_spt_op_class_ch", proc_get_cur_spt_op_class_ch, proc_set_cur_spt_op_class_ch), -+#if CONFIG_RTW_MACADDR_ACL -+ RTW_PROC_HDL_SSEQ("macaddr_acl", proc_get_macaddr_acl, proc_set_macaddr_acl), -+#endif -+#if CONFIG_RTW_PRE_LINK_STA -+ RTW_PROC_HDL_SSEQ("pre_link_sta", proc_get_pre_link_sta, proc_set_pre_link_sta), -+#endif -+ RTW_PROC_HDL_SSEQ("ch_sel_policy", proc_get_ch_sel_policy, proc_set_ch_sel_policy), -+#ifdef CONFIG_80211D -+ RTW_PROC_HDL_SSEQ("country_ie_slave_en_conds", proc_get_country_ie_slave_en_conds, proc_set_country_ie_slave_en_conds), -+ RTW_PROC_HDL_SSEQ("country_ie_slave_records", proc_get_country_ie_slave_records, NULL), -+#endif -+#ifdef CONFIG_DFS_MASTER -+ RTW_PROC_HDL_SSEQ("dfs_test_case", proc_get_dfs_test_case, proc_set_dfs_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_e_flags", proc_get_dfs_ch_sel_e_flags, proc_set_dfs_ch_sel_e_flags), -+ RTW_PROC_HDL_SSEQ("dfs_ch_sel_d_flags", proc_get_dfs_ch_sel_d_flags, proc_set_dfs_ch_sel_d_flags), -+ #if CONFIG_DFS_SLAVE_WITH_RADAR_DETECT -+ RTW_PROC_HDL_SSEQ("dfs_slave_with_rd", proc_get_dfs_slave_with_rd, proc_set_dfs_slave_with_rd), -+ #endif -+#endif -+#ifdef CONFIG_BCN_CNT_CONFIRM_HDL -+ RTW_PROC_HDL_SSEQ("new_bcn_max", proc_get_new_bcn_max, proc_set_new_bcn_max), -+#endif -+ 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 -+#ifdef CONFIG_AP_MODE -+ RTW_PROC_HDL_SSEQ("change_bss_chbw", NULL, proc_set_change_bss_chbw), -+#endif -+#if CONFIG_TX_AC_LIFETIME -+ RTW_PROC_HDL_SSEQ("tx_aclt_force_val", proc_get_tx_aclt_force_val, proc_set_tx_aclt_force_val), -+ RTW_PROC_HDL_SSEQ("tx_aclt_flags", proc_get_tx_aclt_flags, proc_set_tx_aclt_flags), -+ RTW_PROC_HDL_SSEQ("tx_aclt_confs", proc_get_tx_aclt_confs, proc_set_tx_aclt_confs), -+#endif -+ RTW_PROC_HDL_SSEQ("tx_bw_mode", proc_get_tx_bw_mode, proc_set_tx_bw_mode), -+ 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), -+#if CONFIG_TXPWR_LIMIT -+ RTW_PROC_HDL_SSEQ("tx_power_limit", proc_get_tx_power_limit, NULL), -+#endif -+ RTW_PROC_HDL_SSEQ("tpc_settings", proc_get_tpc_settings, proc_set_tpc_settings), -+ RTW_PROC_HDL_SSEQ("antenna_gain", proc_get_antenna_gain, proc_set_antenna_gain), -+ 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, proc_set_tx_power_idx_dump), -+ RTW_PROC_HDL_SEQ("txpwr_total_dbm", &seq_ops_txpwr_total_dbm, proc_set_txpwr_total_dbm_dump), -+#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, proc_set_ps_info), -+#ifdef CONFIG_WMMPS_STA -+ RTW_PROC_HDL_SSEQ("wmmps_info", proc_get_wmmps_info, proc_set_wmmps_info), -+#endif /* CONFIG_WMMPS_STA */ -+#endif -+#ifdef CONFIG_TDLS -+ RTW_PROC_HDL_SSEQ("tdls_info", proc_get_tdls_info, NULL), -+ RTW_PROC_HDL_SSEQ("tdls_enable", proc_get_tdls_enable, proc_set_tdls_enable), -+#endif -+ RTW_PROC_HDL_SSEQ("monitor", proc_get_monitor, proc_set_monitor), -+#ifdef RTW_SIMPLE_CONFIG -+ RTW_PROC_HDL_SSEQ("rtw_simple_config", proc_get_simple_config, proc_set_simple_config), -+#endif -+ -+#ifdef CONFIG_RTW_ACS -+ RTW_PROC_HDL_SSEQ("acs", proc_get_best_chan, proc_set_acs), -+ RTW_PROC_HDL_SSEQ("chan_info", proc_get_chan_info, NULL), -+#endif -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ RTW_PROC_HDL_SSEQ("noise_monitor", proc_get_nm, proc_set_nm), -+#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_CUSTOMER01_SMART_ANTENNA -+ RTW_PROC_HDL_SSEQ("pathb_phase", proc_get_pathb_phase, proc_set_pathb_phase), -+#endif -+ -+#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), -+ RTW_PROC_HDL_SSEQ("hal_trx_mode", proc_get_hal_trx_mode, NULL), -+ -+ RTW_PROC_HDL_SSEQ("rx_stat", proc_get_rx_stat, NULL), -+ -+ RTW_PROC_HDL_SSEQ("tx_stat", proc_get_tx_stat, NULL), -+ RTW_PROC_HDL_SSEQ("sta_tx_stat", proc_get_sta_tx_stat, proc_set_sta_tx_stat), -+ /**** PHY Capability ****/ -+ RTW_PROC_HDL_SSEQ("phy_cap", proc_get_phy_cap, NULL), -+#ifdef CONFIG_80211N_HT -+ RTW_PROC_HDL_SSEQ("rx_stbc", proc_get_rx_stbc, proc_set_rx_stbc), -+ RTW_PROC_HDL_SSEQ("stbc_cap", proc_get_stbc_cap, proc_set_stbc_cap), -+ RTW_PROC_HDL_SSEQ("ldpc_cap", proc_get_ldpc_cap, proc_set_ldpc_cap), -+#endif /* CONFIG_80211N_HT */ -+#ifdef CONFIG_BEAMFORMING -+ RTW_PROC_HDL_SSEQ("txbf_cap", proc_get_txbf_cap, proc_set_txbf_cap), -+#endif -+ -+#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), -+#ifdef CONFIG_RTW_NAPI_DYNAMIC -+ RTW_PROC_HDL_SSEQ("napi_th", proc_get_napi_info, proc_set_napi_th), -+#endif /* CONFIG_RTW_NAPI_DYNAMIC */ -+ -+ RTW_PROC_HDL_SSEQ("rsvd_page", proc_dump_rsvd_page, proc_set_rsvd_page_info), -+ -+#ifdef CONFIG_SUPPORT_FIFO_DUMP -+ RTW_PROC_HDL_SSEQ("fifo_dump", proc_dump_fifo, proc_set_fifo_info), -+#endif -+ RTW_PROC_HDL_SSEQ("fw_info", proc_get_fw_info, NULL), -+ -+#ifdef DBG_XMIT_BLOCK -+ RTW_PROC_HDL_SSEQ("xmit_block", proc_get_xmit_block, proc_set_xmit_block), -+#endif -+ -+ RTW_PROC_HDL_SSEQ("ack_timeout", proc_get_ack_timeout, proc_set_ack_timeout), -+ -+ RTW_PROC_HDL_SSEQ("dynamic_agg_enable", proc_get_dynamic_agg_enable, proc_set_dynamic_agg_enable), -+ RTW_PROC_HDL_SSEQ("fw_offload", proc_get_fw_offload, proc_set_fw_offload), -+ -+#ifdef CONFIG_RTW_WDS -+ RTW_PROC_HDL_SSEQ("wds_en", proc_get_wds_en, proc_set_wds_en), -+ RTW_PROC_HDL_SSEQ("sta_wds_en", NULL, proc_set_sta_wds_en), -+ RTW_PROC_HDL_SSEQ("wds_gptr", proc_get_wds_gptr, NULL), -+ #ifdef CONFIG_AP_MODE -+ RTW_PROC_HDL_SSEQ("wds_path", proc_get_wds_path, NULL), -+ #endif -+#endif -+ -+#ifdef CONFIG_RTW_MULTI_AP -+ RTW_PROC_HDL_SSEQ("multi_ap_opmode", proc_get_multi_ap_opmode, proc_set_multi_ap_opmode), -+ RTW_PROC_HDL_SSEQ("unassoc_sta", proc_get_unassoc_sta, proc_set_unassoc_sta), -+#ifdef CONFIG_IOCTL_CFG80211 -+ RTW_PROC_HDL_SSEQ("sta_assoc_req_frame_body", proc_get_sta_assoc_req_frame_body, proc_set_sta_assoc_req_frame_body), -+#endif -+ RTW_PROC_HDL_SSEQ("ch_util_threshold", proc_get_ch_util_threshold, proc_set_ch_util_threshold), -+ RTW_PROC_HDL_SSEQ("ch_utilization", proc_get_ch_utilization, NULL), -+#endif -+ -+#ifdef CONFIG_RTW_MESH -+ #if CONFIG_RTW_MESH_ACNODE_PREVENT -+ RTW_PROC_HDL_SSEQ("mesh_acnode_prevent", proc_get_mesh_acnode_prevent, proc_set_mesh_acnode_prevent), -+ #endif -+ #if CONFIG_RTW_MESH_OFFCH_CAND -+ RTW_PROC_HDL_SSEQ("mesh_offch_cand", proc_get_mesh_offch_cand, proc_set_mesh_offch_cand), -+ #endif -+ #if CONFIG_RTW_MESH_PEER_BLACKLIST -+ RTW_PROC_HDL_SSEQ("mesh_peer_blacklist", proc_get_mesh_peer_blacklist, proc_set_mesh_peer_blacklist), -+ #endif -+ #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST -+ RTW_PROC_HDL_SSEQ("mesh_cto_mgate_require", proc_get_mesh_cto_mgate_require, proc_set_mesh_cto_mgate_require), -+ RTW_PROC_HDL_SSEQ("mesh_cto_mgate_blacklist", proc_get_mesh_cto_mgate_blacklist, proc_set_mesh_cto_mgate_blacklist), -+ #endif -+ RTW_PROC_HDL_SSEQ("mesh_peer_sel_policy", proc_get_mesh_peer_sel_policy, NULL), -+ RTW_PROC_HDL_SSEQ("mesh_networks", proc_get_mesh_networks, NULL), -+ RTW_PROC_HDL_SSEQ("mesh_plink_ctl", proc_get_mesh_plink_ctl, NULL), -+ RTW_PROC_HDL_SSEQ("mesh_mpath", proc_get_mesh_mpath, NULL), -+ RTW_PROC_HDL_SSEQ("mesh_mpp", proc_get_mesh_mpp, NULL), -+ RTW_PROC_HDL_SSEQ("mesh_known_gates", proc_get_mesh_known_gates, NULL), -+ #if CONFIG_RTW_MESH_DATA_BMC_TO_UC -+ RTW_PROC_HDL_SSEQ("mesh_b2u_flags", proc_get_mesh_b2u_flags, proc_set_mesh_b2u_flags), -+ #endif -+ RTW_PROC_HDL_SSEQ("mesh_stats", proc_get_mesh_stats, NULL), -+ RTW_PROC_HDL_SSEQ("mesh_gate_timeout_factor", proc_get_mesh_gate_timeout, proc_set_mesh_gate_timeout), -+ RTW_PROC_HDL_SSEQ("mesh_gate_state", proc_get_mesh_gate_state, NULL), -+ RTW_PROC_HDL_SSEQ("mesh_peer_alive_based_preq", proc_get_peer_alive_based_preq, proc_set_peer_alive_based_preq), -+#endif -+#ifdef CONFIG_FW_HANDLE_TXBCN -+ RTW_PROC_HDL_SSEQ("fw_tbtt_rpt", proc_get_fw_tbtt_rpt, proc_set_fw_tbtt_rpt), -+#endif -+#ifdef CONFIG_LPS_CHK_BY_TP -+ RTW_PROC_HDL_SSEQ("lps_chk_tp", proc_get_lps_chk_tp, proc_set_lps_chk_tp), -+#endif -+#ifdef CONFIG_SUPPORT_STATIC_SMPS -+ RTW_PROC_HDL_SSEQ("smps", proc_get_smps, proc_set_smps), -+#endif -+ -+#ifdef RTW_BUSY_DENY_SCAN -+ RTW_PROC_HDL_SSEQ("scan_interval_thr", proc_get_scan_interval_thr, \ -+ proc_set_scan_interval_thr), -+#endif -+ RTW_PROC_HDL_SSEQ("scan_deny", proc_get_scan_deny, proc_set_scan_deny), -+#ifdef CONFIG_RTW_TPT_MODE -+ RTW_PROC_HDL_SSEQ("tpt_mode", proc_get_tpt_mode, proc_set_tpt_mode), -+#endif -+ -+#ifdef CONFIG_CTRL_TXSS_BY_TP -+ RTW_PROC_HDL_SSEQ("txss_tp", proc_get_txss_tp, proc_set_txss_tp), -+ #ifdef DBG_CTRL_TXSS -+ RTW_PROC_HDL_SSEQ("txss_ctrl", proc_get_txss_ctrl, proc_set_txss_ctrl), -+ #endif -+#endif -+ -+ RTW_PROC_HDL_SSEQ("cur_beacon_keys", proc_get_cur_beacon_keys, NULL), -+ -+#ifdef CONFIG_WAR_OFFLOAD -+ RTW_PROC_HDL_SSEQ("war_offload_enable", proc_get_war_offload_enable, proc_set_war_offload_enable), -+ RTW_PROC_HDL_SSEQ("war_offload_ipv4_addr", NULL, proc_set_war_offload_ipv4_addr), -+ RTW_PROC_HDL_SSEQ("war_offload_ipv6_addr", NULL, proc_set_war_offload_ipv6_addr), -+#if defined(CONFIG_OFFLOAD_MDNS_V4) || defined(CONFIG_OFFLOAD_MDNS_V6) -+ RTW_PROC_HDL_SSEQ("war_offload_mdns_domain_name", proc_get_war_offload_mdns_domain_name, proc_set_war_offload_mdns_domain_name), -+ RTW_PROC_HDL_SSEQ("war_offload_mdns_machine_name", proc_get_war_offload_mdns_machine_name, proc_set_war_offload_mdns_machine_name), -+ RTW_PROC_HDL_SSEQ("war_offload_mdns_service_info", proc_get_war_offload_mdns_service_info, proc_set_war_offload_mdns_service_info), -+ RTW_PROC_HDL_SSEQ("war_offload_mdns_service_info_txt_rsp", proc_get_war_offload_mdns_txt_rsp, proc_set_war_offload_mdns_txt_rsp), -+#endif /* CONFIG_OFFLOAD_MDNS_V4 || CONFIG_OFFLOAD_MDNS_V6 */ -+#endif /* CONFIG_WAR_OFFLOAD */ -+ -+ RTW_PROC_HDL_SSEQ("wpas_info", proc_get_wpas_info, proc_set_wpas_info), -+ RTW_PROC_HDL_SSEQ("rtw_amsdu_mode", proc_get_amsdu_mode, proc_set_amsdu_mode), -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_AP_MODE) -+ RTW_PROC_HDL_SSEQ("ap_csa_cnt", proc_get_ap_csa_cnt, proc_set_ap_csa_cnt), -+#endif -+}; -+ -+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 if (hdl->type == RTW_PROC_HDL_TYPE_SZSEQ) { -+ int (*show)(struct seq_file *, void *) = hdl->u.sz.show ? hdl->u.sz.show : proc_get_dummy; -+ -+ return single_open_size(file, show, private, hdl->u.sz.size); -+ } 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 rtw_proc_ops rtw_adapter_proc_seq_fops = { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0)) -+ .proc_open = rtw_adapter_proc_open, -+ .proc_read = seq_read, -+ .proc_lseek = seq_lseek, -+ .proc_release = seq_release, -+ .proc_write = rtw_adapter_proc_write, -+#else -+ .owner = THIS_MODULE, -+ .open = rtw_adapter_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = seq_release, -+ .write = rtw_adapter_proc_write, -+#endif -+}; -+ -+static const struct rtw_proc_ops rtw_adapter_proc_sseq_fops = { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0)) -+ .proc_open = rtw_adapter_proc_open, -+ .proc_read = seq_read, -+ .proc_lseek = seq_lseek, -+ .proc_release = single_release, -+ .proc_write = rtw_adapter_proc_write, -+#else -+ .owner = THIS_MODULE, -+ .open = rtw_adapter_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_adapter_proc_write, -+#endif -+}; -+ -+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; -+ s8 th_edcca_hl_diff; -+ -+ 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", &th_l2h_ini, &th_edcca_hl_diff); -+ -+ if (num != 2) -+ return count; -+ -+ rtw_odm_adaptivity_parm_set(padapter, (s8)th_l2h_ini, th_edcca_hl_diff); -+ } -+ -+ return count; -+} -+ -+static char *phydm_msg = NULL; -+#define PHYDM_MSG_LEN 80*24*4 -+ -+int proc_get_phydm_cmd(struct seq_file *m, void *v) -+{ -+ struct net_device *netdev; -+ PADAPTER padapter; -+ struct dm_struct *phydm; -+ -+ -+ netdev = m->private; -+ padapter = (PADAPTER)rtw_netdev_priv(netdev); -+ phydm = adapter_to_phydm(padapter); -+ -+ 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; -+ struct dm_struct *phydm; -+ char tmp[64] = {0}; -+ -+ -+ netdev = (struct net_device *)data; -+ padapter = (PADAPTER)rtw_netdev_priv(netdev); -+ phydm = adapter_to_phydm(padapter); -+ -+ 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("adaptivity", proc_get_odm_adaptivity, proc_set_odm_adaptivity), -+ RTW_PROC_HDL_SZSEQ("cmd", proc_get_phydm_cmd, proc_set_phydm_cmd, PHYDM_MSG_LEN), -+}; -+ -+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 if (hdl->type == RTW_PROC_HDL_TYPE_SZSEQ) { -+ int (*show)(struct seq_file *, void *) = hdl->u.sz.show ? hdl->u.sz.show : proc_get_dummy; -+ -+ return single_open_size(file, show, private, hdl->u.sz.size); -+ } 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 rtw_proc_ops rtw_odm_proc_seq_fops = { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0)) -+ .proc_open = rtw_odm_proc_open, -+ .proc_read = seq_read, -+ .proc_lseek = seq_lseek, -+ .proc_release = seq_release, -+ .proc_write = rtw_odm_proc_write, -+#else -+ .owner = THIS_MODULE, -+ .open = rtw_odm_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = seq_release, -+ .write = rtw_odm_proc_write, -+#endif -+}; -+ -+static const struct rtw_proc_ops rtw_odm_proc_sseq_fops = { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0)) -+ .proc_open = rtw_odm_proc_open, -+ .proc_read = seq_read, -+ .proc_lseek = seq_lseek, -+ .proc_release = single_release, -+ .proc_write = rtw_odm_proc_write, -+#else -+ .owner = THIS_MODULE, -+ .open = rtw_odm_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_odm_proc_write, -+#endif -+}; -+ -+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 || -+ odm_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SZSEQ) -+ 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_duration", proc_get_mcc_info, proc_set_mcc_duration), -+ #ifdef CONFIG_MCC_PHYDM_OFFLOAD -+ RTW_PROC_HDL_SSEQ("mcc_phydm_offload", proc_get_mcc_info, proc_set_mcc_phydm_offload_enable), -+ #endif -+ 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), -+ RTW_PROC_HDL_SSEQ("mcc_policy_table", proc_get_mcc_policy_table, NULL), -+}; -+ -+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 if (hdl->type == RTW_PROC_HDL_TYPE_SZSEQ) { -+ int (*show)(struct seq_file *, void *) = hdl->u.sz.show ? hdl->u.sz.show : proc_get_dummy; -+ -+ return single_open_size(file, show, private, hdl->u.sz.size); -+ } 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 rtw_proc_ops rtw_mcc_proc_seq_fops = { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0)) -+ .proc_open = rtw_mcc_proc_open, -+ .proc_read = seq_read, -+ .proc_lseek = seq_lseek, -+ .proc_release = seq_release, -+ .proc_write = rtw_mcc_proc_write, -+#else -+ .owner = THIS_MODULE, -+ .open = rtw_mcc_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = seq_release, -+ .write = rtw_mcc_proc_write, -+#endif -+}; -+ -+static const struct rtw_proc_ops rtw_mcc_proc_sseq_fops = { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0)) -+ .proc_open = rtw_mcc_proc_open, -+ .proc_read = seq_read, -+ .proc_lseek = seq_lseek, -+ .proc_release = single_release, -+ .proc_write = rtw_mcc_proc_write, -+#else -+ .owner = THIS_MODULE, -+ .open = rtw_mcc_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_mcc_proc_write, -+#endif -+}; -+ -+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 || -+ mcc_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SZSEQ) -+ 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); -+ 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 || -+ adapter_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SZSEQ) -+ 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 --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_proc.h b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_proc.h -new file mode 100755 -index 000000000..9247e3637 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_proc.h -@@ -0,0 +1,72 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#define RTW_PROC_HDL_TYPE_SEQ 0 -+#define RTW_PROC_HDL_TYPE_SSEQ 1 -+#define RTW_PROC_HDL_TYPE_SZSEQ 2 -+ -+struct rtw_proc_hdl { -+ char *name; -+ u8 type; -+ union { -+ int (*show)(struct seq_file *, void *); -+ struct seq_operations *seq_op; -+ struct { -+ int (*show)(struct seq_file *, void *); -+ size_t size; -+ } sz; -+ } 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} -+ -+#define RTW_PROC_HDL_SZSEQ(_name, _show, _write, _size) \ -+ { .name = _name, .type = RTW_PROC_HDL_TYPE_SZSEQ, .u.sz.show = _show, .write = _write, .u.sz.size = _size} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0)) -+#define rtw_proc_ops proc_ops -+#else -+#define rtw_proc_ops file_operations -+#endif -+ -+#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 */ -+ -+static inline int rtw_drv_proc_init(void) {return _FAIL;} -+#define rtw_drv_proc_deinit() do {} while (0) -+static inline struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev) {return 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 --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_rhashtable.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_rhashtable.c -new file mode 100644 -index 000000000..df303b237 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_rhashtable.c -@@ -0,0 +1,77 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#if defined(CONFIG_RTW_WDS) || defined(CONFIG_RTW_MESH) /* for now, only promised for kernel versions we support mesh */ -+ -+int rtw_rhashtable_walk_enter(rtw_rhashtable *ht, rtw_rhashtable_iter *iter) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)) -+ rhashtable_walk_enter((ht), (iter)); -+ return 0; -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 7, 0)) -+ return rhashtable_walk_init((ht), (iter), GFP_ATOMIC); -+#else -+ /* kernel >= 4.4.0 rhashtable_walk_init use GFP_KERNEL to alloc, spin_lock for assignment */ -+ iter->ht = ht; -+ iter->p = NULL; -+ iter->slot = 0; -+ iter->skip = 0; -+ -+ iter->walker = kmalloc(sizeof(*iter->walker), GFP_ATOMIC); -+ if (!iter->walker) -+ return -ENOMEM; -+ -+ spin_lock(&ht->lock); -+ iter->walker->tbl = -+ rcu_dereference_protected(ht->tbl, lockdep_is_held(&ht->lock)); -+ list_add(&iter->walker->list, &iter->walker->tbl->walkers); -+ spin_unlock(&ht->lock); -+ -+ return 0; -+#endif -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0)) -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0)) -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 25)) -+static inline int is_vmalloc_addr(const void *x) -+{ -+#ifdef CONFIG_MMU -+ unsigned long addr = (unsigned long)x; -+ -+ return addr >= VMALLOC_START && addr < VMALLOC_END; -+#else -+ return 0; -+#endif -+} -+#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 25)) */ -+ -+void kvfree(const void *addr) -+{ -+ if (is_vmalloc_addr(addr)) -+ vfree(addr); -+ else -+ kfree(addr); -+} -+#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0)) */ -+ -+#include "rhashtable.c" -+ -+#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0)) */ -+ -+#endif /* defined(CONFIG_RTW_WDS) || defined(CONFIG_RTW_MESH) */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_rhashtable.h b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_rhashtable.h -new file mode 100644 -index 000000000..af5ba7e4d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/rtw_rhashtable.h -@@ -0,0 +1,67 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_RHASHTABLE_H__ -+#define __RTW_RHASHTABLE_H__ -+ -+#if defined(CONFIG_RTW_WDS) || defined(CONFIG_RTW_MESH) /* for now, only promised for kernel versions we support mesh */ -+ -+/* directly reference rhashtable in kernel */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 4, 0)) -+#include -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 4, 0)) */ -+ -+/* Use rhashtable from kernel 4.4 */ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0)) -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 0, 0)) -+#define NULLS_MARKER(value) (1UL | (((long)value) << 1)) -+#endif -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) -+static inline void *kmalloc_array(size_t n, size_t size, gfp_t flags) -+{ -+ if (size != 0 && n > ULONG_MAX / size) -+ return NULL; -+ return __kmalloc(n * size, flags); -+} -+#endif -+#include "rhashtable.h" -+#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0)) */ -+ -+typedef struct rhashtable rtw_rhashtable; -+typedef struct rhash_head rtw_rhash_head; -+typedef struct rhashtable_params rtw_rhashtable_params; -+ -+#define rtw_rhashtable_init(ht, params) rhashtable_init(ht, params) -+ -+typedef struct rhashtable_iter rtw_rhashtable_iter; -+ -+int rtw_rhashtable_walk_enter(rtw_rhashtable *ht, rtw_rhashtable_iter *iter); -+#define rtw_rhashtable_walk_exit(iter) rhashtable_walk_exit(iter) -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 16, 0)) -+#define rtw_rhashtable_walk_start(iter) rhashtable_walk_start_check(iter) -+#else -+#define rtw_rhashtable_walk_start(iter) rhashtable_walk_start(iter) -+#endif -+#define rtw_rhashtable_walk_next(iter) rhashtable_walk_next(iter) -+#define rtw_rhashtable_walk_stop(iter) rhashtable_walk_stop(iter) -+ -+#define rtw_rhashtable_free_and_destroy(ht, free_fn, arg) rhashtable_free_and_destroy((ht), (free_fn), (arg)) -+#define rtw_rhashtable_lookup_fast(ht, key, params) rhashtable_lookup_fast((ht), (key), (params)) -+#define rtw_rhashtable_lookup_insert_fast(ht, obj, params) rhashtable_lookup_insert_fast((ht), (obj), (params)) -+#define rtw_rhashtable_remove_fast(ht, obj, params) rhashtable_remove_fast((ht), (obj), (params)) -+ -+#endif /* defined(CONFIG_RTW_WDS) || defined(CONFIG_RTW_MESH) */ -+ -+#endif /* __RTW_RHASHTABLE_H__ */ -+ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/sdio_intf.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/sdio_intf.c -new file mode 100644 -index 000000000..086195963 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/sdio_intf.c -@@ -0,0 +1,1431 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 CONFIG_SDIO_HCI -+#error "CONFIG_SDIO_HCI shall be on!\n" -+#endif -+ -+#ifdef CONFIG_RTL8822B -+#include /* rtl8822bs_set_hal_ops() */ -+#endif /* CONFIG_RTL8822B */ -+ -+#ifdef CONFIG_RTL8822C -+#include -+#endif /* CONFIG_RTL8822C */ -+ -+#ifdef CONFIG_RTL8723F -+#include /* rtl8723fs_set_hal_ops() */ -+#endif /* CONFIG_RTL8723F */ -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+#ifdef CONFIG_ACPI -+#include -+#include -+#include "rtw_android.h" -+#endif -+static int wlan_en_gpio = -1; -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ -+#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[] = { -+#ifdef CONFIG_RTL8723B -+ { SDIO_DEVICE(0x024c, 0xB723), .driver_data = RTL8723B}, -+#endif -+#ifdef CONFIG_RTL8188E -+ { SDIO_DEVICE(0x024c, 0x8179), .driver_data = RTL8188E}, -+#endif /* CONFIG_RTL8188E */ -+ -+#ifdef CONFIG_RTL8821A -+ { SDIO_DEVICE(0x024c, 0x8821), .driver_data = RTL8821}, -+#endif /* CONFIG_RTL8821A */ -+ -+#ifdef CONFIG_RTL8192E -+ { SDIO_DEVICE(0x024c, 0x818B), .driver_data = RTL8192E}, -+#endif /* CONFIG_RTL8192E */ -+ -+#ifdef CONFIG_RTL8703B -+ { SDIO_DEVICE(0x024c, 0xB703), .driver_data = RTL8703B}, -+#endif -+ -+#ifdef CONFIG_RTL8188F -+ {SDIO_DEVICE(0x024c, 0xF179), .driver_data = RTL8188F}, -+#endif -+ -+#ifdef CONFIG_RTL8188GTV -+ {SDIO_DEVICE(0x024c, 0x018C), .driver_data = RTL8188GTV}, -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ {SDIO_DEVICE(0x024c, 0xB822), .driver_data = RTL8822B}, -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ { SDIO_DEVICE(0x024c, 0xD723), .driver_data = RTL8723D}, -+ { SDIO_DEVICE(0x024c, 0xD724), .driver_data = RTL8723D}, -+#endif -+ -+#ifdef CONFIG_RTL8192F -+ { SDIO_DEVICE(0x024c, 0x818C), .driver_data = RTL8192F},/*A CUT*/ -+ { SDIO_DEVICE(0x024c, 0xF192), .driver_data = RTL8192F},/*B CUT*/ -+ { SDIO_DEVICE(0x024c, 0xA725), .driver_data = RTL8192F},/*8725AS*/ -+#endif /* CONFIG_RTL8192F */ -+ -+#ifdef CONFIG_RTL8821C -+ {SDIO_DEVICE(0x024C, 0xB821), .driver_data = RTL8821C}, -+ {SDIO_DEVICE(0x024C, 0xC821), .driver_data = RTL8821C}, -+ {SDIO_DEVICE(0x024C, 0x8733), .driver_data = RTL8821C}, /* 8733AS */ -+ {SDIO_DEVICE(0x024C, 0xC80C), .driver_data = RTL8821C}, /* 8821CSH-VQ */ -+#endif -+ -+#ifdef CONFIG_RTL8822C -+ {SDIO_DEVICE(0x024c, 0xC822), .class = SDIO_CLASS_WLAN, .driver_data = RTL8822C}, -+ {SDIO_DEVICE(0x024c, 0xD821), .class = SDIO_CLASS_WLAN, .driver_data = RTL8822C}, /* 8821DS */ -+#endif -+ -+#ifdef CONFIG_RTL8723F -+ {SDIO_DEVICE(0x024c, 0xB733), .class = SDIO_CLASS_WLAN, .driver_data = RTL8723F}, /* SDIO+UART */ -+ {SDIO_DEVICE(0x024c, 0xB73A), .class = SDIO_CLASS_WLAN, .driver_data = RTL8723F}, /* SDIO multi */ -+#endif -+ -+#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) /* temporarily add this to accept all sdio wlan id */ -+ { SDIO_DEVICE_CLASS(SDIO_CLASS_WLAN) }, -+#endif -+ { /* 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); -+#ifdef CONFIG_SDIO_HOOK_DEV_SHUTDOWN -+static void rtw_dev_shutdown(struct device *dev); -+#endif -+static int rtw_sdio_resume(struct device *dev); -+static int rtw_sdio_suspend(struct device *dev); -+extern void rtw_dev_unload(PADAPTER padapter); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+static const struct dev_pm_ops rtw_sdio_pm_ops = { -+ .suspend = rtw_sdio_suspend, -+ .resume = rtw_sdio_resume, -+}; -+#endif -+ -+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 = (char *)DRV_NAME, -+ .r871xs_drv.id_table = sdio_ids, -+ .r871xs_drv.drv = { -+#ifdef CONFIG_SDIO_HOOK_DEV_SHUTDOWN -+ .shutdown = rtw_dev_shutdown, -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ .pm = &rtw_sdio_pm_ops, -+#endif -+ } -+}; -+ -+static struct rtw_if_operations sdio_ops = { -+ .read = rtw_sdio_raw_read, -+ .write = rtw_sdio_raw_write, -+}; -+ -+static void sd_sync_int_hdl(struct sdio_func *func) -+{ -+ struct dvobj_priv *psdpriv; -+ -+ psdpriv = sdio_get_drvdata(func); -+ -+ if (!dvobj_get_primary_adapter(psdpriv)) { -+ RTW_INFO("%s primary adapter == NULL\n", __func__); -+ return; -+ } -+ -+ rtw_sdio_set_irq_thd(psdpriv, current); -+ sd_int_hdl(dvobj_get_primary_adapter(psdpriv)); -+ rtw_sdio_set_irq_thd(psdpriv, NULL); -+} -+ -+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 && err != -EBUSY) { -+ dvobj->drv_dbg.dbg_sdio_alloc_irq_error_cnt++; -+ RTW_PRINT("%s: sdio_claim_irq FAIL(%d)!\n", __func__, err); -+ } else if (err == -EBUSY) { -+ RTW_DBG("%s: sdio_claim_irq -EBUSY\n", __func__); -+ err = 0; -+ } else { -+ RTW_DBG("%s: sdio_claim_irq SUCCESS\n", __func__); -+ dvobj->drv_dbg.dbg_sdio_alloc_irq_cnt++; -+ dvobj->irq_alloc = 1; -+ } -+ -+ sdio_release_host(func); -+ -+ return err ? _FAIL : _SUCCESS; -+} -+ -+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++; -+ RTW_ERR("%s: sdio_release_irq FAIL(%d)!\n", __func__, err); -+ } else { -+ RTW_DBG("%s: sdio_release_irq SUCCESS\n", __func__); -+ 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; -+extern unsigned int oob_gpio; -+static irqreturn_t gpio_hostwakeup_irq_thread(int irq, void *data) -+{ -+ PADAPTER padapter = (PADAPTER)data; -+ RTW_PRINT("gpio_hostwakeup_irq_thread\n"); -+ /* Disable interrupt before calling handler */ -+ /* disable_irq_nosync(oob_irq); */ -+#ifdef CONFIG_PLATFORM_ARM_SUN6I -+ return 0; -+#else -+ return IRQ_HANDLED; -+#endif -+} -+ -+static u8 gpio_hostwakeup_alloc_irq(PADAPTER padapter) -+{ -+ int err; -+ u32 status = 0; -+ -+ if (oob_irq == 0) { -+ RTW_INFO("oob_irq ZERO!\n"); -+ return _FAIL; -+ } -+ -+ RTW_INFO("%s : oob_irq = %d\n", __func__, oob_irq); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 32)) -+ status = IRQF_NO_SUSPEND; -+#endif -+ -+ if (HIGH_ACTIVE_DEV2HST) -+ status |= IRQF_TRIGGER_RISING; -+ else -+ status |= IRQF_TRIGGER_FALLING; -+ -+ err = request_threaded_irq(oob_irq, gpio_hostwakeup_irq_thread, NULL, -+ status, "rtw_wifi_gpio_wakeup", padapter); -+ -+ if (err < 0) { -+ RTW_INFO("Oops: can't allocate gpio irq %d err:%d\n", oob_irq, err); -+ return _FALSE; -+ } else -+ RTW_INFO("allocate gpio irq %d ok\n", oob_irq); -+ -+#ifndef CONFIG_PLATFORM_ARM_SUN8I -+ enable_irq_wake(oob_irq); -+#endif -+ return _SUCCESS; -+} -+ -+static void gpio_hostwakeup_free_irq(PADAPTER padapter) -+{ -+ wifi_free_gpio(oob_gpio); -+ -+ if (oob_irq == 0) -+ return; -+ -+#ifndef CONFIG_PLATFORM_ARM_SUN8I -+ disable_irq_wake(oob_irq); -+#endif -+ free_irq(oob_irq, padapter); -+} -+#endif -+ -+void dump_sdio_card_info(void *sel, struct dvobj_priv *dvobj) -+{ -+ PSDIO_DATA psdio_data = &dvobj->intf_data; -+ struct mmc_card *card = psdio_data->card; -+ int i; -+ -+ RTW_PRINT_SEL(sel, "== SDIO Card Info ==\n"); -+ RTW_PRINT_SEL(sel, " card: %p\n", card); -+ RTW_PRINT_SEL(sel, " clock: %d Hz\n", psdio_data->clock); -+ -+ RTW_PRINT_SEL(sel, " timing spec: "); -+ switch (psdio_data->timing) { -+ case MMC_TIMING_LEGACY: -+ _RTW_PRINT_SEL(sel, "legacy"); -+ break; -+ case MMC_TIMING_MMC_HS: -+ _RTW_PRINT_SEL(sel, "mmc high-speed"); -+ break; -+ case MMC_TIMING_SD_HS: -+ _RTW_PRINT_SEL(sel, "sd high-speed"); -+ break; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0) -+ #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0) -+ case MMC_TIMING_UHS_SDR12: -+ _RTW_PRINT_SEL(sel, "sd uhs SDR12"); -+ break; -+ case MMC_TIMING_UHS_SDR25: -+ _RTW_PRINT_SEL(sel, "sd uhs SDR25"); -+ break; -+ #endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0) */ -+ -+ case MMC_TIMING_UHS_SDR50: -+ _RTW_PRINT_SEL(sel, "sd uhs SDR50"); -+ break; -+ -+ #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0) -+ case MMC_TIMING_MMC_DDR52: -+ _RTW_PRINT_SEL(sel, "mmc DDR52"); -+ break; -+ #endif -+ -+ case MMC_TIMING_UHS_SDR104: -+ _RTW_PRINT_SEL(sel, "sd uhs SDR104"); -+ break; -+ case MMC_TIMING_UHS_DDR50: -+ _RTW_PRINT_SEL(sel, "sd uhs DDR50"); -+ break; -+ -+ #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0) -+ case MMC_TIMING_MMC_HS200: -+ _RTW_PRINT_SEL(sel, "mmc HS200"); -+ break; -+ #endif -+ -+ #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0) -+ case MMC_TIMING_MMC_HS400: -+ _RTW_PRINT_SEL(sel, "mmc HS400"); -+ break; -+ #endif -+#endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0) */ -+ default: -+ _RTW_PRINT_SEL(sel, "unknown(%d)", psdio_data->timing); -+ break; -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, " sd3_bus_mode: %s\n", (psdio_data->sd3_bus_mode) ? "TRUE" : "FALSE"); -+ -+ rtw_warn_on(card->sdio_funcs != sdio_get_num_of_func(dvobj)); -+ RTW_PRINT_SEL(sel, " func num: %u\n", card->sdio_funcs); -+ for (i = 0; card->sdio_func[i]; i++) { -+ RTW_PRINT_SEL(sel, " func%u: %p%s\n" -+ , card->sdio_func[i]->num, card->sdio_func[i] -+ , psdio_data->func == card->sdio_func[i] ? " (*)" : ""); -+ } -+ -+ RTW_PRINT_SEL(sel, "================\n"); -+} -+ -+#define SDIO_CARD_INFO_DUMP(dvobj) dump_sdio_card_info(RTW_DBGDUMP, dvobj) -+ -+#ifdef DBG_SDIO -+#if (DBG_SDIO >= 2) -+void rtw_sdio_dbg_reg_free(struct dvobj_priv *d) -+{ -+ struct sdio_data *sdio; -+ u8 *buf; -+ u32 size; -+ -+ -+ sdio = &d->intf_data; -+ -+ buf = sdio->dbg_msg; -+ size = sdio->dbg_msg_size; -+ if (buf){ -+ sdio->dbg_msg = NULL; -+ sdio->dbg_msg_size = 0; -+ rtw_mfree(buf, size); -+ } -+ -+ buf = sdio->reg_mac; -+ if (buf) { -+ sdio->reg_mac = NULL; -+ rtw_mfree(buf, 0x800); -+ } -+ -+ buf = sdio->reg_mac_ext; -+ if (buf) { -+ sdio->reg_mac_ext = NULL; -+ rtw_mfree(buf, 0x800); -+ } -+ -+ buf = sdio->reg_local; -+ if (buf) { -+ sdio->reg_local = NULL; -+ rtw_mfree(buf, 0x100); -+ } -+ -+ buf = sdio->reg_cia; -+ if (buf) { -+ sdio->reg_cia = NULL; -+ rtw_mfree(buf, 0x200); -+ } -+} -+ -+void rtw_sdio_dbg_reg_alloc(struct dvobj_priv *d) -+{ -+ struct sdio_data *sdio; -+ u8 *buf; -+ -+ -+ sdio = &d->intf_data; -+ -+ buf = _rtw_zmalloc(0x800); -+ if (buf) -+ sdio->reg_mac = buf; -+ -+ buf = _rtw_zmalloc(0x800); -+ if (buf) -+ sdio->reg_mac_ext = buf; -+ -+ buf = _rtw_zmalloc(0x100); -+ if (buf) -+ sdio->reg_local = buf; -+ -+ buf = _rtw_zmalloc(0x200); -+ if (buf) -+ sdio->reg_cia = buf; -+} -+#endif /* DBG_SDIO >= 2 */ -+ -+static void sdio_dbg_init(struct dvobj_priv *d) -+{ -+ struct sdio_data *sdio; -+ -+ -+ sdio = &d->intf_data; -+ -+ sdio->cmd52_err_cnt = 0; -+ sdio->cmd53_err_cnt = 0; -+ -+#if (DBG_SDIO >= 1) -+ sdio->reg_dump_mark = 0; -+#endif /* DBG_SDIO >= 1 */ -+ -+#if (DBG_SDIO >= 3) -+ sdio->dbg_enable = 0; -+ sdio->err_stop = 0; -+ sdio->err_test = 0; -+ sdio->err_test_triggered = 0; -+#endif /* DBG_SDIO >= 3 */ -+} -+ -+static void sdio_dbg_deinit(struct dvobj_priv *d) -+{ -+#if (DBG_SDIO >= 2) -+ rtw_sdio_dbg_reg_free(d); -+#endif /* DBG_SDIO >= 2 */ -+} -+#endif /* DBG_SDIO */ -+ -+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++; -+ RTW_PRINT("%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++; -+ RTW_PRINT("%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; -+ -+ psdio_data->card = func->card; -+ psdio_data->timing = func->card->host->ios.timing; -+ psdio_data->clock = func->card->host->ios.clock; -+ psdio_data->func_number = func->card->sdio_funcs; -+ -+ psdio_data->sd3_bus_mode = _FALSE; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0) -+ if (psdio_data->timing <= MMC_TIMING_UHS_DDR50 -+ #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0) -+ && psdio_data->timing >= MMC_TIMING_UHS_SDR12 -+ #else -+ && psdio_data->timing >= MMC_TIMING_UHS_SDR50 -+ #endif -+ ) -+ psdio_data->sd3_bus_mode = _TRUE; -+#endif -+ -+#ifdef DBG_SDIO -+ sdio_dbg_init(dvobj); -+#endif /* DBG_SDIO */ -+ -+ SDIO_CARD_INFO_DUMP(dvobj); -+ -+ -+release: -+ sdio_release_host(func); -+ -+ if (err) -+ return _FAIL; -+ return _SUCCESS; -+} -+ -+void sdio_deinit(struct dvobj_priv *dvobj) -+{ -+ struct sdio_func *func; -+ int err; -+ -+ -+ -+ 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++; -+ RTW_ERR("%s: sdio_disable_func(%d)\n", __func__, err); -+ } -+ -+ sdio_release_host(func); -+ } -+ -+#ifdef DBG_SDIO -+ sdio_dbg_deinit(dvobj); -+#endif /* DBG_SDIO */ -+} -+ -+u8 sdio_get_num_of_func(struct dvobj_priv *dvobj) -+{ -+ return dvobj->intf_data.func_number; -+} -+ -+static void rtw_decide_chip_type_by_device_id(struct dvobj_priv *dvobj, const struct sdio_device_id *pdid) -+{ -+ dvobj->chip_type = pdid->driver_data; -+ -+#if defined(CONFIG_RTL8188E) -+ if (dvobj->chip_type == RTL8188E) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8188ES; -+ RTW_INFO("CHIP TYPE: RTL8188E\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8723B) -+ if (dvobj->chip_type == RTL8723B) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8723BS; -+ RTW_INFO("CHIP TYPE: RTL8723B\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8821A) -+ if (dvobj->chip_type == RTL8821) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8821S; -+ RTW_INFO("CHIP TYPE: RTL8821A\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8192E) -+ if (dvobj->chip_type == RTL8192E) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8192ES; -+ RTW_INFO("CHIP TYPE: RTL8192E\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8703B) -+ if (dvobj->chip_type == RTL8703B) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8703BS; -+ RTW_INFO("CHIP TYPE: RTL8703B\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8723D) -+ if (dvobj->chip_type == RTL8723D) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8723DS; -+ RTW_INFO("CHIP TYPE: RTL8723D\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8188F) -+ if (dvobj->chip_type == RTL8188F) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8188FS; -+ RTW_INFO("CHIP TYPE: RTL8188F\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8188GTV) -+ if (dvobj->chip_type == RTL8188GTV) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8188GTVS; -+ RTW_INFO("CHIP TYPE: RTL8188GTV\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8822B) -+ if (dvobj->chip_type == RTL8822B) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8822BS; -+ RTW_INFO("CHIP TYPE: RTL8822B\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8821C) -+ if (dvobj->chip_type == RTL8821C) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8821CS; -+ RTW_INFO("CHIP TYPE: RTL8821C\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8192F) -+ if (dvobj->chip_type == RTL8192F) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8192FS; -+ RTW_INFO("CHIP TYPE: RTL8192F\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8822C) -+ if (dvobj->chip_type == RTL8822C) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8822CS; -+ RTW_INFO("CHIP TYPE: RTL8822C\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8723F) -+ if (dvobj->chip_type == RTL8723F) { -+ dvobj->HardwareType = HARDWARE_TYPE_RTL8723FS; -+ RTW_INFO("CHIP TYPE: RTL8723F\n"); -+ } -+#endif -+} -+ -+static struct dvobj_priv *sdio_dvobj_init(struct sdio_func *func, const struct sdio_device_id *pdid) -+{ -+ int status = _FAIL; -+ struct dvobj_priv *dvobj = NULL; -+ PSDIO_DATA psdio; -+ -+ dvobj = devobj_init(); -+ if (dvobj == NULL) -+ goto exit; -+ dvobj->intf_ops = &sdio_ops; -+ -+ sdio_set_drvdata(func, dvobj); -+ -+ psdio = &dvobj->intf_data; -+ psdio->func = func; -+ -+ if (sdio_init(dvobj) != _SUCCESS) { -+ goto free_dvobj; -+ } -+ -+ dvobj->interface_type = RTW_SDIO; -+ rtw_decide_chip_type_by_device_id(dvobj, pdid); -+ -+ 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); -+ sdio_free_irq(dvobj); -+ devobj_deinit(dvobj); -+ } -+ -+ return; -+} -+ -+u8 rtw_set_hal_ops(PADAPTER padapter) -+{ -+ /* alloc memory for HAL DATA */ -+ if (rtw_hal_data_init(padapter) == _FAIL) -+ return _FAIL; -+ -+#if defined(CONFIG_RTL8188E) -+ if (rtw_get_chip_type(padapter) == RTL8188E) -+ rtl8188es_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8723B) -+ if (rtw_get_chip_type(padapter) == RTL8723B) -+ rtl8723bs_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8821A) -+ if (rtw_get_chip_type(padapter) == RTL8821) -+ rtl8821as_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8192E) -+ if (rtw_get_chip_type(padapter) == RTL8192E) -+ rtl8192es_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8703B) -+ if (rtw_get_chip_type(padapter) == RTL8703B) -+ rtl8703bs_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8723D) -+ if (rtw_get_chip_type(padapter) == RTL8723D) -+ rtl8723ds_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8188F) -+ if (rtw_get_chip_type(padapter) == RTL8188F) -+ rtl8188fs_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8188GTV) -+ if (rtw_get_chip_type(padapter) == RTL8188GTV) -+ rtl8188gtvs_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8822B) -+ if (rtw_get_chip_type(padapter) == RTL8822B) -+ rtl8822bs_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8821C) -+ if (rtw_get_chip_type(padapter) == RTL8821C) { -+ if (rtl8821cs_set_hal_ops(padapter) == _FAIL) -+ return _FAIL; -+ } -+#endif -+ -+#if defined(CONFIG_RTL8192F) -+ if (rtw_get_chip_type(padapter) == RTL8192F) -+ rtl8192fs_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8822C) -+ if (rtw_get_chip_type(padapter) == RTL8822C) -+ rtl8822cs_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8723F) -+ if (rtw_get_chip_type(padapter) == RTL8723F) -+ rtl8723fs_set_hal_ops(padapter); -+#endif -+ -+ if (rtw_hal_ops_check(padapter) == _FAIL) -+ return _FAIL; -+ -+ if (hal_spec_init(padapter) == _FAIL) -+ return _FAIL; -+ -+ return _SUCCESS; -+} -+ -+static void sd_intf_start(PADAPTER padapter) -+{ -+ if (padapter == NULL) { -+ RTW_ERR("%s: padapter is NULL!\n", __func__); -+ return; -+ } -+ -+#if (CONFIG_RTW_SDIO_RELEASE_IRQ >= 2) -+ sdio_alloc_irq(adapter_to_dvobj(padapter)); -+#endif -+ -+ /* hal dep */ -+ rtw_hal_enable_interrupt(padapter); -+} -+ -+static void sd_intf_stop(PADAPTER padapter) -+{ -+ if (padapter == NULL) { -+ RTW_ERR("%s: padapter is NULL!\n", __func__); -+ return; -+ } -+ -+ /* hal dep */ -+ rtw_hal_disable_interrupt(padapter); -+ -+#if (CONFIG_RTW_SDIO_RELEASE_IRQ >= 2) -+ sdio_free_irq(adapter_to_dvobj(padapter)); -+#endif -+} -+ -+ -+#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -+PADAPTER g_test_adapter = NULL; -+#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ -+ -+_adapter *rtw_sdio_primary_adapter_init(struct dvobj_priv *dvobj) -+{ -+ int status = _FAIL; -+ PADAPTER padapter = NULL; -+ -+ padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter)); -+ if (padapter == NULL) -+ goto exit; -+ -+ if (loadparam(padapter) != _SUCCESS) -+ goto free_adapter; -+ -+#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -+ g_test_adapter = padapter; -+#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ -+ 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 -+ -+ /* 3 3. init driver special setting, interface, OS and hardware relative */ -+ -+ /* 4 3.1 set hardware operation functions */ -+ if (rtw_set_hal_ops(padapter) == _FAIL) -+ goto free_hal_data; -+ -+ /* 3 5. initialize Chip version */ -+ padapter->intf_start = &sd_intf_start; -+ padapter->intf_stop = &sd_intf_stop; -+ -+ if (rtw_init_io_priv(padapter, sdio_set_intf_ops) == _FAIL) { -+ goto free_hal_data; -+ } -+ -+ rtw_hal_read_chip_version(padapter); -+ -+ rtw_hal_chip_configure(padapter); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_Initialize(padapter); -+#endif -+ rtw_btcoex_wifionly_initialize(padapter); -+ -+ /* 3 6. read efuse/eeprom data */ -+ if (rtw_hal_read_chip_info(padapter) == _FAIL) -+ goto free_hal_data; -+ -+ /* 3 7. init driver common data */ -+ if (rtw_init_drv_sw(padapter) == _FAIL) { -+ goto free_hal_data; -+ } -+ -+ /* 3 8. get WLan MAC address */ -+ /* set mac addr */ -+ 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); -+ -+ RTW_INFO("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" -+ , padapter->bup -+ , rtw_get_hw_init_completed(padapter) -+ ); -+ -+ status = _SUCCESS; -+ -+free_hal_data: -+ if (status != _SUCCESS && padapter->HalData) -+ rtw_hal_free_data(padapter); -+ -+free_adapter: -+ if (status != _SUCCESS && padapter) { -+ #ifdef RTW_HALMAC -+ rtw_halmac_deinit_adapter(dvobj); -+ #endif -+ rtw_vmfree((u8 *)padapter, sizeof(*padapter)); -+ padapter = NULL; -+ } -+exit: -+ return padapter; -+} -+ -+static void rtw_sdio_primary_adapter_deinit(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) -+ rtw_disassoc_cmd(padapter, 0, RTW_CMDF_DIRECTLY); -+ -+#ifdef CONFIG_AP_MODE -+ if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { -+ free_mlme_ap_info(padapter); -+ #ifdef CONFIG_HOSTAPD_MLME -+ hostapd_mode_unload(padapter); -+ #endif -+ } -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#ifdef CONFIG_PLATFORM_ARM_SUN6I -+ sw_gpio_eint_set_enable(gpio_eint_wlan, 0); -+ sw_gpio_irq_free(eint_wlan_handle); -+#else -+ gpio_hostwakeup_free_irq(padapter); -+#endif -+#endif -+ -+ /*rtw_cancel_all_timer(if1);*/ -+ -+#ifdef CONFIG_WOWLAN -+ adapter_to_pwrctl(padapter)->wowlan_mode = _FALSE; -+ RTW_PRINT("%s wowlan_mode:%d\n", __func__, adapter_to_pwrctl(padapter)->wowlan_mode); -+#endif /* CONFIG_WOWLAN */ -+ -+ rtw_dev_unload(padapter); -+ RTW_INFO("+r871xu_dev_remove, hw_init_completed=%d\n", rtw_get_hw_init_completed(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 -+ -+#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -+ g_test_adapter = NULL; -+#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ -+} -+ -+/* -+ * 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; -+#ifdef CONFIG_CONCURRENT_MODE -+ int i; -+#endif -+ PADAPTER padapter = NULL; -+ struct dvobj_priv *dvobj; -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ -+#ifdef CONFIG_ACPI -+ acpi_handle handle; -+ struct acpi_device *adev; -+#endif -+ -+#if defined(CONFIG_ACPI) && defined(CONFIG_GPIO_WAKEUP) -+ handle = ACPI_HANDLE(&func->dev); -+ -+ if (handle) { -+ /* Dont try to do acpi pm for the wifi module */ -+ if (!handle || acpi_bus_get_device(handle, &adev)) -+ RTW_INFO("Could not get acpi pointer!\n"); -+ else { -+ adev->flags.power_manageable = 0; -+ RTW_INFO("Disabling ACPI power management support!\n"); -+ } -+ oob_gpio = acpi_get_gpio_by_index(&func->dev, 0, NULL); -+ RTW_INFO("rtw_drv_init: ACPI_HANDLE found oob_gpio %d!\n", oob_gpio); -+ wifi_configure_gpio(); -+ } else -+ RTW_INFO("rtw_drv_init: ACPI_HANDLE NOT found!\n"); -+#endif -+ -+#if defined(CONFIG_ACPI) -+ if (&func->dev && ACPI_HANDLE(&func->dev)) { -+ wlan_en_gpio = acpi_get_gpio_by_index(&func->dev, 1, NULL); -+ RTW_INFO("rtw_drv_init: ACPI_HANDLE found wlan_en %d!\n", wlan_en_gpio); -+ } else -+ RTW_INFO("rtw_drv_init: ACPI_HANDLE NOT found!\n"); -+#endif -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ -+ -+ -+ dvobj = sdio_dvobj_init(func, id); -+ if (dvobj == NULL) { -+ goto exit; -+ } -+ -+ padapter = rtw_sdio_primary_adapter_init(dvobj); -+ if (padapter == NULL) { -+ RTW_INFO("rtw_init_primary_adapter Failed!\n"); -+ goto free_dvobj; -+ } -+ -+#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, sdio_set_intf_ops) == NULL) { -+ RTW_INFO("rtw_drv_add_iface failed! (%d)\n", i); -+ goto free_if_vir; -+ } -+ } -+#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 -+ -+#if (CONFIG_RTW_SDIO_RELEASE_IRQ <= 1) -+ if (sdio_alloc_irq(dvobj) != _SUCCESS) -+ goto os_ndevs_deinit; -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#ifdef CONFIG_PLATFORM_ARM_SUN6I -+ eint_wlan_handle = sw_gpio_irq_request(gpio_eint_wlan, TRIG_EDGE_NEGATIVE, (peint_handle)gpio_hostwakeup_irq_thread, NULL); -+ if (!eint_wlan_handle) { -+ RTW_INFO("%s: request irq failed\n", __func__); -+ return -1; -+ } -+#else -+ gpio_hostwakeup_alloc_irq(padapter); -+#endif -+#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 -+ -+ -+ status = _SUCCESS; -+ -+#if (CONFIG_RTW_SDIO_RELEASE_IRQ <= 1) -+os_ndevs_deinit: -+#endif -+ 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_sdio_primary_adapter_deinit(padapter); -+ -+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 pwrctrl_priv *pwrctl = dvobj_to_pwrctl(dvobj); -+ PADAPTER padapter = dvobj_get_primary_adapter(dvobj); -+ -+ -+ -+ 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 (!rtw_is_surprise_removed(padapter)) { -+ int err; -+ -+ /* test surprise remove */ -+ sdio_claim_host(func); -+ sdio_readb(func, 0, &err); -+ sdio_release_host(func); -+ if (err == -ENOMEDIUM) { -+ rtw_set_surprise_removed(padapter); -+ RTW_INFO("%s: device had been removed!\n", __func__); -+ } -+ } -+ -+#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+ rtw_unregister_early_suspend(pwrctl); -+#endif -+ -+ if (GET_HAL_DATA(padapter)->bFWReady == _TRUE) { -+ 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_set_drv_stopped(padapter); /*for stop thread*/ -+ rtw_stop_cmd_thread(padapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_drv_stop_vir_ifaces(dvobj); -+#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_sdio_primary_adapter_deinit(padapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_drv_free_vir_ifaces(dvobj); -+#endif -+ -+ sdio_dvobj_deinit(func); -+ -+ -+} -+ -+#ifdef CONFIG_SDIO_HOOK_DEV_SHUTDOWN -+static void rtw_dev_shutdown(struct device *dev) -+{ -+ struct sdio_func *func = dev_to_sdio_func(dev); -+ -+ if (func == NULL) -+ return; -+ -+ RTW_INFO("==> %s !\n", __func__); -+ -+ rtw_dev_remove(func); -+ -+ RTW_INFO("<== %s !\n", __func__); -+} -+#endif -+ -+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 = NULL; -+ struct dvobj_priv *psdpriv = NULL; -+ struct pwrctrl_priv *pwrpriv = NULL; -+ _adapter *padapter = NULL; -+ struct debug_priv *pdbgpriv = NULL; -+ int ret = 0; -+#ifdef CONFIG_RTW_SDIO_PM_KEEP_POWER -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) -+ mmc_pm_flag_t pm_flag = 0; -+#endif -+#endif -+ -+ if (dev == NULL) -+ return ret; -+ -+ func = dev_to_sdio_func(dev); -+ if(func == NULL) -+ return ret; -+ -+ psdpriv = sdio_get_drvdata(func); -+ if (psdpriv == NULL) -+ goto exit; -+ -+ pwrpriv = dvobj_to_pwrctl(psdpriv); -+ padapter = dvobj_get_primary_adapter(psdpriv); -+ pdbgpriv = &psdpriv->drv_dbg; -+ if (rtw_is_drv_stopped(padapter)) { -+ RTW_INFO("%s bDriverStopped == _TRUE\n", __func__); -+ goto exit; -+ } -+ -+ if (pwrpriv->bInSuspend == _TRUE) { -+ RTW_INFO("%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 -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) -+ /* 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 */ -+ pm_flag = sdio_get_host_pm_caps(func); -+ RTW_INFO("cmd: %s: suspend: PM flag = 0x%x\n", sdio_func_id(func), pm_flag); -+ if (!(pm_flag & MMC_PM_KEEP_POWER)) { -+ RTW_INFO("%s: cannot remain alive while host is suspended\n", sdio_func_id(func)); -+ if (pdbgpriv) -+ pdbgpriv->dbg_suspend_error_cnt++; -+ return -ENOSYS; -+ } else { -+ RTW_INFO("cmd: suspend with MMC_PM_KEEP_POWER\n"); -+ sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER); -+ } -+#endif -+#endif -+ -+ return ret; -+} -+int rtw_resume_process(_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++; -+ RTW_INFO("%s bInSuspend = %d\n", __FUNCTION__, 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); -+ _adapter *padapter = dvobj_get_primary_adapter(psdpriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ int ret = 0; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ RTW_INFO("==> %s (%s:%d)\n", __FUNCTION__, current->comm, current->pid); -+ -+ pdbgpriv->dbg_resume_cnt++; -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ if (0) -+#else -+ if (pwrpriv->wowlan_mode || pwrpriv->wowlan_ap_mode) -+#endif -+ { -+ rtw_resume_lock_suspend(); -+ ret = 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(); -+ ret = rtw_resume_process(padapter); -+ rtw_resume_unlock_suspend(); -+ } -+#endif -+ } -+ pmlmeext->last_scan_time = rtw_get_current_time(); -+ RTW_INFO("<======== %s return %d\n", __FUNCTION__, ret); -+ return ret; -+ -+} -+ -+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 */ -+ -+#ifndef CONFIG_PLATFORM_INTEL_BYT -+ rtw_android_wifictrl_func_add(); -+#endif /* !CONFIG_PLATFORM_INTEL_BYT */ -+ -+ ret = platform_wifi_power_on(); -+ if (ret) { -+ RTW_INFO("%s: power on failed!!(%d)\n", __FUNCTION__, ret); -+ ret = -1; -+ goto exit; -+ } -+ -+ sdio_drvpriv.drv_registered = _TRUE; -+ rtw_suspend_lock_init(); -+ rtw_drv_proc_init(); -+ rtw_nlrtw_init(); -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ cmap_intfs_init(); -+#endif -+ rtw_ndev_notifier_register(); -+ rtw_inetaddr_notifier_register(); -+ -+ ret = sdio_register_driver(&sdio_drvpriv.r871xs_drv); -+ if (ret != 0) { -+ sdio_drvpriv.drv_registered = _FALSE; -+ rtw_suspend_lock_uninit(); -+ rtw_drv_proc_deinit(); -+ rtw_nlrtw_deinit(); -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ cmap_intfs_deinit(); -+#endif -+ rtw_ndev_notifier_unregister(); -+ rtw_inetaddr_notifier_unregister(); -+ RTW_INFO("%s: register driver failed!!(%d)\n", __FUNCTION__, ret); -+ goto poweroff; -+ } -+ -+ goto exit; -+ -+poweroff: -+ platform_wifi_power_off(); -+ -+exit: -+ RTW_PRINT("module init ret=%d\n", ret); -+ return ret; -+} -+ -+static void __exit rtw_drv_halt(void) -+{ -+ RTW_PRINT("module exit start\n"); -+ -+ sdio_drvpriv.drv_registered = _FALSE; -+ -+ sdio_unregister_driver(&sdio_drvpriv.r871xs_drv); -+ -+ rtw_android_wifictrl_func_del(); -+ -+ platform_wifi_power_off(); -+ -+ rtw_suspend_lock_uninit(); -+ rtw_drv_proc_deinit(); -+ rtw_nlrtw_deinit(); -+#ifdef CONFIG_PLATFORM_CMAP_INTFS -+ cmap_intfs_deinit(); -+#endif -+ rtw_ndev_notifier_unregister(); -+ rtw_inetaddr_notifier_unregister(); -+ -+ RTW_PRINT("module exit success\n"); -+ -+ rtw_mstat_dump(RTW_DBGDUMP); -+} -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+int rtw_sdio_set_power(int on) -+{ -+ -+ if (wlan_en_gpio >= 0) { -+ if (on) -+ gpio_set_value(wlan_en_gpio, 1); -+ else -+ gpio_set_value(wlan_en_gpio, 0); -+ } -+ -+ return 0; -+} -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ -+module_init(rtw_drv_entry); -+module_exit(rtw_drv_halt); -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/sdio_ops_linux.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/sdio_ops_linux.c -new file mode 100644 -index 000000000..af6a9636e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/sdio_ops_linux.c -@@ -0,0 +1,1347 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2019 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+inline bool rtw_is_sdio30(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ PSDIO_DATA psdio_data = &dvobj->intf_data; -+ -+ return (psdio_data->sd3_bus_mode) ? _TRUE : _FALSE; -+} -+ -+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, _thread_hdl_ thd_hdl) -+{ -+ PSDIO_DATA sdio_data = &dvobj->intf_data; -+ -+ sdio_data->sys_sdio_irq_thd = thd_hdl; -+} -+#ifndef RTW_HALMAC -+u8 sd_f0_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x\n", __func__, *err, addr); -+ -+ -+ return v; -+} -+ -+void sd_f0_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ return; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ sdio_f0_writeb(func, v, addr, err); -+ if (claim_needed) -+ sdio_release_host(func); -+ if (err && *err) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x val=0x%02x\n", __func__, *err, addr, v); -+ -+} -+ -+/* -+ * Return: -+ * 0 Success -+ * others Fail -+ */ -+s32 _sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ return err; -+ } -+ -+ func = psdio->func; -+ -+ for (i = 0; i < cnt; i++) { -+ pdata[i] = sdio_readb(func, addr + i, &err); -+ if (err) { -+ RTW_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) -+{ -+ PADAPTER padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ int err = 0, i; -+ struct sdio_func *func; -+ bool claim_needed; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ return err; -+ } -+ -+ func = psdio->func; -+ -+ for (i = 0; i < cnt; i++) { -+ sdio_writeb(func, pdata[i], addr + i, &err); -+ if (err) { -+ RTW_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) -+{ -+ PADAPTER padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ int err = 0, i; -+ struct sdio_func *func; -+ bool claim_needed; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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) -+{ -+ PADAPTER padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ u8 v = 0; -+ struct sdio_func *func; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ return v; -+ } -+ -+ func = psdio->func; -+ -+ v = sdio_readb(func, addr, err); -+ -+ if (err && *err) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x\n", __func__, *err, addr); -+ -+ -+ return v; -+} -+ -+u8 sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x\n", __func__, *err, addr); -+ -+ -+ return v; -+} -+ -+u16 sd_read16(struct intf_hdl *pintfhdl, u32 addr, s32 *err) -+{ -+ PADAPTER padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ u16 v = 0; -+ struct sdio_func *func; -+ bool claim_needed; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ return v; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ v = sdio_readw(func, addr, err); -+ if (claim_needed) -+ sdio_release_host(func); -+ if (err && *err) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x\n", __func__, *err, addr); -+ -+ -+ return v; -+} -+ -+u32 _sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err) -+{ -+ PADAPTER padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ u32 v = 0; -+ struct sdio_func *func; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ return v; -+ } -+ -+ func = psdio->func; -+ -+ v = sdio_readl(func, addr, err); -+ -+ if (err && *err) { -+ int i; -+ -+ RTW_ERR("%s: (%d) addr=0x%05x, val=0x%x\n", __func__, *err, addr, v); -+ -+ *err = 0; -+ for (i = 0; i < SD_IO_TRY_CNT; i++) { -+ /* sdio_claim_host(func); */ -+ v = sdio_readl(func, addr, err); -+ /* sdio_release_host(func); */ -+ if (*err == 0) { -+ rtw_reset_continual_io_error(psdiodev); -+ break; -+ } else { -+ RTW_ERR("%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ if ((-ESHUTDOWN == *err) || (-ENODEV == *err)) -+ rtw_set_surprise_removed(padapter); -+ -+ if (rtw_inc_and_chk_continual_io_error(psdiodev) == _TRUE) { -+ rtw_set_surprise_removed(padapter); -+ break; -+ } -+ -+ } -+ } -+ -+ if (i == SD_IO_TRY_CNT) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ else -+ RTW_ERR("%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ -+ } -+ -+ -+ return v; -+} -+ -+u32 sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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; -+ -+ RTW_ERR("%s: (%d) addr=0x%05x, val=0x%x\n", __func__, *err, addr, v); -+ -+ *err = 0; -+ for (i = 0; i < SD_IO_TRY_CNT; i++) { -+ if (claim_needed) -+ sdio_claim_host(func); -+ v = sdio_readl(func, addr, err); -+ if (claim_needed) -+ sdio_release_host(func); -+ -+ if (*err == 0) { -+ rtw_reset_continual_io_error(psdiodev); -+ break; -+ } else { -+ RTW_ERR("%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ if ((-ESHUTDOWN == *err) || (-ENODEV == *err)) -+ rtw_set_surprise_removed(padapter); -+ -+ if (rtw_inc_and_chk_continual_io_error(psdiodev) == _TRUE) { -+ rtw_set_surprise_removed(padapter); -+ break; -+ } -+ } -+ } -+ -+ if (i == SD_IO_TRY_CNT) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ else -+ RTW_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) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x val=0x%02x\n", __func__, *err, addr, v); -+ -+} -+ -+void sd_write16(struct intf_hdl *pintfhdl, u32 addr, u16 v, s32 *err) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ return ; -+ } -+ -+ func = psdio->func; -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ sdio_writew(func, v, addr, err); -+ if (claim_needed) -+ sdio_release_host(func); -+ if (err && *err) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x val=0x%04x\n", __func__, *err, addr, v); -+ -+} -+ -+void _sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err) -+{ -+ PADAPTER padapter; -+ struct dvobj_priv *psdiodev; -+ PSDIO_DATA psdio; -+ -+ struct sdio_func *func; -+ -+ padapter = pintfhdl->padapter; -+ psdiodev = pintfhdl->pintf_dev; -+ psdio = &psdiodev->intf_data; -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ return ; -+ } -+ -+ func = psdio->func; -+ -+ sdio_writel(func, v, addr, err); -+ -+ if (err && *err) { -+ int i; -+ -+ RTW_ERR("%s: (%d) addr=0x%05x val=0x%08x\n", __func__, *err, addr, v); -+ -+ *err = 0; -+ for (i = 0; i < SD_IO_TRY_CNT; i++) { -+ sdio_writel(func, v, addr, err); -+ if (*err == 0) { -+ rtw_reset_continual_io_error(psdiodev); -+ break; -+ } else { -+ RTW_ERR("%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ if ((-ESHUTDOWN == *err) || (-ENODEV == *err)) -+ rtw_set_surprise_removed(padapter); -+ -+ if (rtw_inc_and_chk_continual_io_error(psdiodev) == _TRUE) { -+ rtw_set_surprise_removed(padapter); -+ break; -+ } -+ } -+ } -+ -+ if (i == SD_IO_TRY_CNT) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x val=0x%08x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ else -+ RTW_ERR("%s: (%d) addr=0x%05x val=0x%08x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ -+ } -+ -+} -+ -+void sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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; -+ -+ RTW_ERR("%s: (%d) addr=0x%05x val=0x%08x\n", __func__, *err, addr, v); -+ -+ *err = 0; -+ for (i = 0; i < SD_IO_TRY_CNT; i++) { -+ if (claim_needed) -+ sdio_claim_host(func); -+ sdio_writel(func, v, addr, err); -+ if (claim_needed) -+ sdio_release_host(func); -+ if (*err == 0) { -+ rtw_reset_continual_io_error(psdiodev); -+ break; -+ } else { -+ RTW_ERR("%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ if ((-ESHUTDOWN == *err) || (-ENODEV == *err)) -+ rtw_set_surprise_removed(padapter); -+ -+ if (rtw_inc_and_chk_continual_io_error(psdiodev) == _TRUE) { -+ rtw_set_surprise_removed(padapter); -+ break; -+ } -+ } -+ } -+ -+ if (i == SD_IO_TRY_CNT) -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x val=0x%08x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ else -+ RTW_ERR("%s: (%d) addr=0x%05x val=0x%08x, try_cnt=%d\n", __func__, *err, addr, v, i); -+ } -+ -+} -+#endif /* !RTW_HALMAC */ -+ -+/* -+ * 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) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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) { -+ RTW_ERR("%s: FAIL!(%d) addr=0x%05x\n", __func__, err, addr); -+ break; -+ } -+ } -+ return err; -+ } -+ -+ err = sdio_memcpy_fromio(func, pdata, addr, cnt); -+ if (err) -+ RTW_ERR("%s: FAIL(%d)! ADDR=%#x Size=%d\n", __func__, err, addr, cnt); -+ -+ if (err == (-ESHUTDOWN) || err == (-ENODEV) || err == (-ENOMEDIUM) || err == (-ETIMEDOUT)) -+ rtw_set_surprise_removed(padapter); -+ -+ -+ 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) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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) { -+ RTW_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) -+ RTW_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) -+{ -+ PADAPTER 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 (rtw_is_surprise_removed(padapter)) { -+ /* RTW_INFO(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__); */ -+ 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; -+} -+ -+#if 1 -+/*#define RTW_SDIO_DUMP*/ -+#ifdef RTW_SDIO_DUMP -+#define DUMP_LEN_LMT 0 /* buffer dump size limit */ -+ /* unit: byte, 0 for no limit */ -+#else -+#define DUMP_LEN_LMT 32 -+#endif -+#define GET_DUMP_LEN(len) (DUMP_LEN_LMT ? rtw_min(len, DUMP_LEN_LMT) : len) -+ -+#ifdef DBG_SDIO -+#if (DBG_SDIO >= 1) -+static void sdio_dump_reg_by_cmd52(struct dvobj_priv *d, -+ u32 addr, size_t len, u8 *buf) -+{ -+ struct sdio_func *func; -+ size_t i; -+ u8 val; -+ u8 str[80], used = 0; -+ u8 read_twice = 0; -+ int error; -+ -+ -+ if (buf) -+ _rtw_memset(buf, 0xAE, len); -+ func = dvobj_to_sdio_func(d); -+ /* -+ * When register is WLAN IOREG, -+ * read twice to guarantee the result is correct. -+ */ -+ if (addr & 0x10000) -+ read_twice = 1; -+ -+ _rtw_memset(str, 0, 80); -+ used = 0; -+ if (addr & 0xF) { -+ used += snprintf(str+used, (80-used), "0x%02x:\t", addr&~0xF); -+ used += snprintf(str+used, (80-used), "%*s", (addr&0xF)*5, ""); -+ } -+ for (i = 0; i < len; i++, addr++) { -+ val = sdio_readb(func, addr, &error); -+ if (read_twice) -+ val = sdio_readb(func, addr, &error); -+ if (error) -+ break; -+ -+ if (buf) -+ buf[i] = val; -+ -+ if (!(addr & 0xF)) -+ used += snprintf(str+used, (80-used), "0x%02x:\t", addr&~0xF); -+ used += snprintf(str+used, (80-used), "%02x ", val); -+ if (((i + 1) < len) && ((addr + 1) & 0xF) == 0) { -+ dev_err(&func->dev, "%s", str); -+ _rtw_memset(str, 0, 80); -+ used = 0; -+ } -+ } -+ -+ if (used) { -+ dev_err(&func->dev, "%s", str); -+ _rtw_memset(str, 0, 80); -+ used = 0; -+ } -+ -+ if (error) -+ dev_err(&func->dev, "rtw_sdio_dbg: READ 0x%02x FAIL!", addr); -+} -+ -+static void sdio_dump_cia(struct dvobj_priv *d, u32 addr, size_t len, u8 *buf) -+{ -+ struct sdio_func *func; -+ size_t i; -+ u8 val; -+ u8 str[80], used = 0; -+ int error; -+ -+ -+ if (buf) -+ _rtw_memset(buf, 0xAE, len); -+ func = dvobj_to_sdio_func(d); -+ -+ _rtw_memset(str, 0, 80); -+ used = 0; -+ if (addr & 0xF) { -+ used += snprintf(str+used, (80-used), "0x%02x:\t", addr&~0xF); -+ used += snprintf(str+used, (80-used), "%*s", (addr&0xF)*5, ""); -+ } -+ for (i = 0; i < len; i++, addr++) { -+ val = sdio_f0_readb(func, addr, &error); -+ if (error) -+ break; -+ -+ if (buf) -+ buf[i] = val; -+ -+ if (!(addr & 0xF)) -+ used += snprintf(str+used, (80-used), "0x%02x:\t", addr&~0xF); -+ used += snprintf(str+used, (80-used), "%02x ", val); -+ if (((i + 1) < len) && ((addr + 1) & 0xF) == 0) { -+ dev_err(&func->dev, "%s", str); -+ _rtw_memset(str, 0, 80); -+ used = 0; -+ } -+ } -+ -+ if (used) { -+ dev_err(&func->dev, "%s", str); -+ _rtw_memset(str, 0, 80); -+ used = 0; -+ } -+ -+ if (error) -+ dev_err(&func->dev, "rtw_sdio_dbg: READ CIA 0x%02x FAIL!", -+ addr); -+} -+ -+#if (DBG_SDIO >= 2) -+void rtw_sdio_dbg_reg_alloc(struct dvobj_priv *d); -+#endif /* DBG_SDIO >= 2 */ -+ -+/* -+ * Dump register when CMD53 fail -+ */ -+static void sdio_dump_dbg_reg(struct dvobj_priv *d, u8 write, -+ unsigned int addr, size_t len) -+{ -+ struct sdio_data *sdio; -+ struct sdio_func *func; -+ u8 *buf = NULL; -+#if (DBG_SDIO >= 2) -+ u8 *msg; -+#endif /* DBG_SDIO >= 2 */ -+ -+ -+ sdio = &d->intf_data; -+ if (sdio->reg_dump_mark) -+ return; -+ func = dvobj_to_sdio_func(d); -+ -+ sdio->reg_dump_mark = sdio->cmd53_err_cnt; -+ -+#if (DBG_SDIO >= 2) -+ if (!sdio->dbg_msg) { -+ msg = rtw_zmalloc(80); -+ if (msg) { -+ sdio->dbg_msg = msg; -+ sdio->dbg_msg_size = 80; -+ } -+ } -+ if (sdio->dbg_msg_size) { -+ snprintf(sdio->dbg_msg, sdio->dbg_msg_size, -+ "CMD53 %s 0x%05x, %zu bytes FAIL " -+ "at err_cnt=%d", -+ write?"WRITE":"READ", -+ addr, len, sdio->reg_dump_mark); -+ } -+ -+ rtw_sdio_dbg_reg_alloc(d); -+#endif /* DBG_SDIO >= 2 */ -+ -+ /* MAC register */ -+ dev_err(&func->dev, "MAC register:"); -+#if (DBG_SDIO >= 2) -+ buf = sdio->reg_mac; -+#endif /* DBG_SDIO >= 2 */ -+ sdio_dump_reg_by_cmd52(d, 0x10000, 0x800, buf); -+ dev_err(&func->dev, "MAC Extend register:"); -+#if (DBG_SDIO >= 2) -+ buf = sdio->reg_mac_ext; -+#endif /* DBG_SDIO >= 2 */ -+ sdio_dump_reg_by_cmd52(d, 0x11000, 0x800, buf); -+ -+ /* SDIO local register */ -+ dev_err(&func->dev, "SDIO Local register:"); -+#if (DBG_SDIO >= 2) -+ buf = sdio->reg_local; -+#endif /* DBG_SDIO >= 2 */ -+ sdio_dump_reg_by_cmd52(d, 0x0, 0x100, buf); -+ -+ /* F0 */ -+ dev_err(&func->dev, "f0 register:"); -+#if (DBG_SDIO >= 2) -+ buf = sdio->reg_cia; -+#endif /* DBG_SDIO >= 2 */ -+ sdio_dump_cia(d, 0x0, 0x200, buf); -+} -+#endif /* DBG_SDIO >= 1 */ -+#endif /* DBG_SDIO */ -+ -+/** -+ * Returns driver error code, -+ * 0 no error -+ * -1 Level 1 error, critical error and can't be recovered -+ * -2 Level 2 error, normal error, retry to recover is possible -+ */ -+static int linux_io_err_to_drv_err(int err) -+{ -+ if (!err) -+ return 0; -+ -+ /* critical error */ -+ if ((err == -ESHUTDOWN) || -+ (err == -ENODEV) || -+ (err == -ENOMEDIUM)) -+ return -1; -+ -+ /* other error */ -+ return -2; -+} -+ -+/** -+ * rtw_sdio_raw_read - Read from SDIO device -+ * @d: driver object private data -+ * @addr: address to read -+ * @buf: buffer to store the data -+ * @len: number of bytes to read -+ * @fixed: -+ * -+ * Reads from the address space of a SDIO device. -+ * Return value indicates if the transfer succeeded or not. -+ */ -+int __must_check rtw_sdio_raw_read(struct dvobj_priv *d, unsigned int addr, -+ void *buf, size_t len, bool fixed) -+{ -+ int error = -EPERM; -+ bool f0, cmd52; -+ struct sdio_func *func; -+ bool claim_needed; -+ u32 offset, i; -+ -+ -+ func = dvobj_to_sdio_func(d); -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ f0 = RTW_SDIO_ADDR_F0_CHK(addr); -+ cmd52 = RTW_SDIO_ADDR_CMD52_CHK(addr); -+ -+ /* -+ * Mask addr to remove driver defined bit and -+ * make sure addr is in valid range -+ */ -+ if (f0) -+ addr &= 0xFFF; -+ else -+ addr &= 0x1FFFF; -+ -+#ifdef RTW_SDIO_DUMP -+ if (f0) -+ dev_dbg(&func->dev, "rtw_sdio: READ F0\n"); -+ else if (cmd52) -+ dev_dbg(&func->dev, "rtw_sdio: READ use CMD52\n"); -+ else -+ dev_dbg(&func->dev, "rtw_sdio: READ use CMD53\n"); -+ -+ dev_dbg(&func->dev, "rtw_sdio: READ from 0x%05x\n", addr); -+#endif /* RTW_SDIO_DUMP */ -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ -+ if (f0) { -+ offset = addr; -+ for (i = 0; i < len; i++, offset++) { -+ ((u8 *)buf)[i] = sdio_f0_readb(func, offset, &error); -+ if (error) -+ break; -+#if 0 -+ dev_info(&func->dev, "%s: sdio f0 read 52 addr 0x%x, byte 0x%02x\n", -+ __func__, offset, ((u8 *)buf)[i]); -+#endif -+ } -+ } else { -+ if (cmd52) { -+#ifdef RTW_SDIO_IO_DBG -+ dev_info(&func->dev, "%s: sdio read 52 addr 0x%x, %zu bytes\n", -+ __func__, addr, len); -+#endif -+ offset = addr; -+ for (i = 0; i < len; i++) { -+ ((u8 *)buf)[i] = sdio_readb(func, offset, &error); -+ if (error) -+ break; -+#if 0 -+ dev_info(&func->dev, "%s: sdio read 52 addr 0x%x, byte 0x%02x\n", -+ __func__, offset, ((u8 *)buf)[i]); -+#endif -+ if (!fixed) -+ offset++; -+ } -+ } else { -+#ifdef RTW_SDIO_IO_DBG -+ dev_info(&func->dev, "%s: sdio read 53 addr 0x%x, %zu bytes\n", -+ __func__, addr, len); -+#endif -+ if (fixed) -+ error = sdio_readsb(func, buf, addr, len); -+ else -+ error = sdio_memcpy_fromio(func, buf, addr, len); -+ } -+ } -+ -+#ifdef DBG_SDIO -+#if (DBG_SDIO >= 3) -+ if (!error && !f0 && !cmd52 -+ && (d->intf_data.dbg_enable -+ && d->intf_data.err_test && !d->intf_data.err_test_triggered -+ && ((addr & 0x10000) -+ || (!(addr & 0xE000) -+ && !((addr >= 0x40) && (addr < 0x48)))))) { -+ d->intf_data.err_test_triggered = 1; -+ error = -ETIMEDOUT; -+ dev_warn(&func->dev, "Simulate error(%d) READ addr=0x%05x %zu bytes", -+ error, addr, len); -+ } -+#endif /* DBG_SDIO >= 3 */ -+ -+ if (error) { -+ if (f0 || cmd52) { -+ d->intf_data.cmd52_err_cnt++; -+ } else { -+ d->intf_data.cmd53_err_cnt++; -+#if (DBG_SDIO >= 1) -+ sdio_dump_dbg_reg(d, 0, addr, len); -+#endif /* DBG_SDIO >= 1 */ -+ } -+ } -+#endif /* DBG_SDIO */ -+ -+ if (claim_needed) -+ sdio_release_host(func); -+ -+#ifdef RTW_SDIO_DUMP -+ print_hex_dump(KERN_DEBUG, "rtw_sdio: READ ", -+ DUMP_PREFIX_OFFSET, 16, 1, -+ buf, GET_DUMP_LEN(len), false); -+#endif /* RTW_SDIO_DUMP */ -+ -+ if (WARN_ON(error)) { -+ dev_err(&func->dev, "%s: sdio read failed (%d)\n", __func__, error); -+#ifndef RTW_SDIO_DUMP -+ if (f0) -+ dev_err(&func->dev, "rtw_sdio: READ F0\n"); -+ if (cmd52) -+ dev_err(&func->dev, "rtw_sdio: READ use CMD52\n"); -+ else -+ dev_err(&func->dev, "rtw_sdio: READ use CMD53\n"); -+ dev_err(&func->dev, "rtw_sdio: READ from 0x%05x, %zu bytes\n", addr, len); -+ print_hex_dump(KERN_ERR, "rtw_sdio: READ ", -+ DUMP_PREFIX_OFFSET, 16, 1, -+ buf, GET_DUMP_LEN(len), false); -+#endif /* !RTW_SDIO_DUMP */ -+ } -+ -+ return linux_io_err_to_drv_err(error); -+} -+ -+/** -+ * rtw_sdio_raw_write - Write to SDIO device -+ * @d: driver object private data -+ * @addr: address to write -+ * @buf: buffer that contains the data to write -+ * @len: number of bytes to write -+ * @fixed: address is fixed(FIFO) or incremented -+ * -+ * Writes to the address space of a SDIO device. -+ * Return value indicates if the transfer succeeded or not. -+ */ -+int __must_check rtw_sdio_raw_write(struct dvobj_priv *d, unsigned int addr, -+ void *buf, size_t len, bool fixed) -+{ -+ int error = -EPERM; -+ bool f0, cmd52; -+ struct sdio_func *func; -+ bool claim_needed; -+ u32 offset, i; -+ -+ -+ func = dvobj_to_sdio_func(d); -+ claim_needed = rtw_sdio_claim_host_needed(func); -+ f0 = RTW_SDIO_ADDR_F0_CHK(addr); -+ cmd52 = RTW_SDIO_ADDR_CMD52_CHK(addr); -+ -+ /* -+ * Mask addr to remove driver defined bit and -+ * make sure addr is in valid range -+ */ -+ if (f0) -+ addr &= 0xFFF; -+ else -+ addr &= 0x1FFFF; -+ -+#ifdef RTW_SDIO_DUMP -+ if (f0) -+ dev_dbg(&func->dev, "rtw_sdio: WRITE F0\n"); -+ else if (cmd52) -+ dev_dbg(&func->dev, "rtw_sdio: WRITE use CMD52\n"); -+ else -+ dev_dbg(&func->dev, "rtw_sdio: WRITE use CMD53\n"); -+ dev_dbg(&func->dev, "rtw_sdio: WRITE to 0x%05x\n", addr); -+ print_hex_dump(KERN_DEBUG, "rtw_sdio: WRITE ", -+ DUMP_PREFIX_OFFSET, 16, 1, -+ buf, GET_DUMP_LEN(len), false); -+#endif /* RTW_SDIO_DUMP */ -+ -+ if (claim_needed) -+ sdio_claim_host(func); -+ -+ if (f0) { -+ offset = addr; -+ for (i = 0; i < len; i++, offset++) { -+ sdio_f0_writeb(func, ((u8 *)buf)[i], offset, &error); -+ if (error) -+ break; -+#if 0 -+ dev_info(&func->dev, "%s: sdio f0 write 52 addr 0x%x, byte 0x%02x\n", -+ __func__, offset, ((u8 *)buf)[i]); -+#endif -+ } -+ } else { -+ if (cmd52) { -+#ifdef RTW_SDIO_IO_DBG -+ dev_info(&func->dev, "%s: sdio write 52 addr 0x%x, %zu bytes\n", -+ __func__, addr, len); -+#endif -+ offset = addr; -+ for (i = 0; i < len; i++) { -+ sdio_writeb(func, ((u8 *)buf)[i], offset, &error); -+ if (error) -+ break; -+#if 0 -+ dev_info(&func->dev, "%s: sdio write 52 addr 0x%x, byte 0x%02x\n", -+ __func__, offset, ((u8 *)buf)[i]); -+#endif -+ if (!fixed) -+ offset++; -+ } -+ } else { -+#ifdef RTW_SDIO_IO_DBG -+ dev_info(&func->dev, "%s: sdio write 53 addr 0x%x, %zu bytes\n", -+ __func__, addr, len); -+#endif -+ if (fixed) -+ error = sdio_writesb(func, addr, buf, len); -+ else -+ error = sdio_memcpy_toio(func, addr, buf, len); -+ } -+ } -+ -+#ifdef DBG_SDIO -+ if (error) { -+ if (f0 || cmd52) { -+ d->intf_data.cmd52_err_cnt++; -+ } else { -+ d->intf_data.cmd53_err_cnt++; -+#if (DBG_SDIO >= 1) -+ sdio_dump_dbg_reg(d, 1, addr, len); -+#endif /* DBG_SDIO >= 1 */ -+ } -+ } -+#endif /* DBG_SDIO */ -+ -+ if (claim_needed) -+ sdio_release_host(func); -+ -+ if (WARN_ON(error)) { -+ dev_err(&func->dev, "%s: sdio write failed (%d)\n", __func__, error); -+#ifndef RTW_SDIO_DUMP -+ if (f0) -+ dev_err(&func->dev, "rtw_sdio: WRITE F0\n"); -+ if (cmd52) -+ dev_err(&func->dev, "rtw_sdio: WRITE use CMD52\n"); -+ else -+ dev_err(&func->dev, "rtw_sdio: WRITE use CMD53\n"); -+ dev_err(&func->dev, "rtw_sdio: WRITE to 0x%05x, %zu bytes\n", addr, len); -+ print_hex_dump(KERN_ERR, "rtw_sdio: WRITE ", -+ DUMP_PREFIX_OFFSET, 16, 1, -+ buf, GET_DUMP_LEN(len), false); -+#endif /* !RTW_SDIO_DUMP */ -+ } -+ -+ return linux_io_err_to_drv_err(error); -+} -+#endif -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/wifi_regd.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/wifi_regd.c -new file mode 100644 -index 000000000..ea45dc491 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/wifi_regd.c -@@ -0,0 +1,793 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2009-2010 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+void rtw_chset_hook_os_channels(struct rf_ctl_t *rfctl) -+{ -+ struct wiphy *wiphy = dvobj_to_wiphy(rfctl_to_dvobj(rfctl)); -+ RT_CHANNEL_INFO *channel_set = rfctl->channel_set; -+ u8 max_chan_nums = rfctl->max_chan_nums; -+ struct ieee80211_channel *ch; -+ unsigned int i; -+ u16 channel; -+ u32 freq; -+ -+ for (i = 0; i < max_chan_nums; i++) { -+ channel = channel_set[i].ChannelNum; -+ #if CONFIG_IEEE80211_BAND_6GHZ -+ if (channel_set[i].band == BAND_ON_6G) -+ continue; /* TODO: wiphy with 6G band */ -+ else -+ #endif -+ freq = rtw_ch2freq(channel); -+ ch = ieee80211_get_channel(wiphy, freq); -+ if (!ch) { -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ channel_set[i].os_chan = ch; -+ } -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+bool rtw_regd_is_wiphy_self_managed(struct wiphy *wiphy) -+{ -+ return rtw_rfctl_is_disable_sw_channel_plan(wiphy_to_dvobj(wiphy)) -+ || !REGSTY_REGD_SRC_FROM_OS(dvobj_to_regsty(wiphy_to_dvobj(wiphy))); -+} -+ -+static struct ieee80211_reg_rule rtw_get_ieee80211_reg_rule(struct get_chplan_resp *chplan, BAND_TYPE band, int last_end_freq, int start_freq, int end_freq, int next_start_freq, u32 flags) -+{ -+ struct ieee80211_reg_rule rule = REG_RULE( -+ start_freq - 10, end_freq + 10, 20, 6, 20, -+ ((flags & RTW_CHF_NO_IR) ? NL80211_RRF_NO_IR : 0) -+ //| ((flags & RTW_CHF_DFS) ? NL80211_RRF_DFS : 0) /* TODO: DFS */ -+ ); -+ -+ int regd_max_bw = 160; -+ int frange_max_bw = 160; -+ -+ if (!(chplan->proto_en & CHPLAN_PROTO_EN_AC) || band == BAND_ON_2_4G) -+ regd_max_bw = 40; -+ /* TODO: !RFCTL_REG_EN_11HT(rfctl) limit to 20MHz */ -+ -+ while ((end_freq - start_freq + 20) < frange_max_bw) { -+ frange_max_bw /= 2; -+ if (frange_max_bw == 20) -+ break; -+ } -+ rule.freq_range.max_bandwidth_khz = MHZ_TO_KHZ(rtw_min(regd_max_bw, frange_max_bw)); -+ -+ if (regd_max_bw > frange_max_bw -+ && (rtw_freq_consecutive(last_end_freq, start_freq) -+ || rtw_freq_consecutive(end_freq, next_start_freq) -+ ) -+ ) -+ rule.flags |= NL80211_RRF_AUTO_BW; -+ -+ if (regd_max_bw < 40) -+ rule.flags |= NL80211_RRF_NO_HT40; -+ if (regd_max_bw < 80) -+ rule.flags |= NL80211_RRF_NO_80MHZ; -+ if (regd_max_bw < 160) -+ rule.flags |= NL80211_RRF_NO_160MHZ; -+ -+ return rule; -+} -+ -+static int rtw_build_wiphy_regd(struct wiphy *wiphy, struct get_chplan_resp *chplan, struct ieee80211_regdomain **regd) -+{ -+ int i; -+ RT_CHANNEL_INFO *chinfo; -+ BAND_TYPE start_band, band; -+ int last_end_freq, start_freq, end_freq, freq; -+ u32 start_flags, flags; -+ struct ieee80211_regdomain *r; -+ int rule_num = 0; -+ bool build = 0; -+ -+ if (regd) -+ *regd = NULL; -+ -+loop: -+ start_band = BAND_MAX; -+ last_end_freq = 0; -+ for (i = 0; i < chplan->chset_num; i++) { -+ chinfo = &chplan->chset[i]; -+ freq = rtw_ch2freq_by_band(chinfo->band, chinfo->ChannelNum); -+ if (!freq) { -+ RTW_WARN(FUNC_WIPHY_FMT" rtw_ch2freq_by_band(%s, %u) fail\n" -+ , FUNC_WIPHY_ARG(wiphy), band_str(chinfo->band), chinfo->ChannelNum); -+ continue; -+ } -+ band = chinfo->band; -+ flags = chinfo->flags & (RTW_CHF_NO_IR | RTW_CHF_DFS); -+ -+ if (start_band == BAND_MAX) { -+ start_band = band; -+ start_freq = end_freq = freq; -+ start_flags = flags; -+ continue; -+ } -+ -+ if (start_band == band -+ && start_flags == flags -+ && rtw_freq_consecutive(end_freq, freq) -+ ) { -+ end_freq = freq; -+ continue; -+ } -+ -+ /* create rule */ -+ if (build) { -+ RTW_DBG("add rule_%02d(%s, %d, %d, 0x%x)\n" -+ , r->n_reg_rules, band_str(start_band), start_freq, end_freq, start_flags); -+ r->reg_rules[r->n_reg_rules++] = rtw_get_ieee80211_reg_rule(chplan, start_band -+ , last_end_freq, start_freq, end_freq, freq, start_flags); -+ } else -+ rule_num++; -+ -+ /* start a new rule */ -+ start_band = band; -+ last_end_freq = end_freq; -+ start_freq = end_freq = freq; -+ start_flags = flags; -+ } -+ -+ if (start_band != BAND_MAX) { -+ /* create rule */ -+ if (build) { -+ RTW_DBG("add rule_%02d(%s, %d, %d, 0x%x)\n" -+ , r->n_reg_rules, band_str(start_band), start_freq, end_freq, start_flags); -+ r->reg_rules[r->n_reg_rules++] = rtw_get_ieee80211_reg_rule(chplan, start_band -+ , last_end_freq, start_freq, end_freq, 0, start_flags); -+ } else -+ rule_num++; -+ } -+ -+ if (!build) { -+ /* switch to build phase */ -+ build = 1; -+ if (!regd) -+ goto exit; -+ -+ r = rtw_zmalloc(sizeof(**regd) + sizeof(struct ieee80211_reg_rule) * rule_num); -+ if (!r) { -+ rule_num = -1; -+ goto exit; -+ } -+ -+ _rtw_memcpy(r->alpha2, chplan->alpha2, 2); -+ r->alpha2[2] = 0; -+ r->dfs_region = NL80211_DFS_UNSET; -+ goto loop; -+ } -+ -+ *regd = r; -+ -+exit: -+ return rule_num; -+} -+ -+static void rtw_regd_disable_no_20mhz_chs(struct wiphy *wiphy) -+{ -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ unsigned int i, j; -+ -+ for (i = 0; i < NUM_NL80211_BANDS; i++) { -+ sband = wiphy->bands[i]; -+ if (!sband) -+ continue; -+ for (j = 0; j < sband->n_channels; j++) { -+ ch = &sband->channels[j]; -+ if (!ch) -+ continue; -+ if (ch->flags & IEEE80211_CHAN_NO_20MHZ) { -+ RTW_INFO(FUNC_WIPHY_FMT" disable band:%d ch:%u w/o 20MHz\n", FUNC_WIPHY_ARG(wiphy), ch->band, ch->hw_value); -+ ch->flags = IEEE80211_CHAN_DISABLED; -+ } -+ } -+ } -+} -+ -+void rtw_update_wiphy_regd(struct wiphy *wiphy, struct get_chplan_resp *chplan, bool rtnl_lock_needed) -+{ -+ struct ieee80211_regdomain *regd; -+ int ret; -+ -+ ret = rtw_build_wiphy_regd(wiphy, chplan, ®d); -+ if (ret == -1) { -+ RTW_WARN(FUNC_WIPHY_FMT" rtw_build_wiphy_regd() fail\n", FUNC_WIPHY_ARG(wiphy)); -+ return; -+ } -+ -+ if (ret == 0) { -+ RTW_WARN(FUNC_WIPHY_FMT" rtw_build_wiphy_regd() builds empty regd, bypass regd setting\n", FUNC_WIPHY_ARG(wiphy)); -+ goto free_regd; -+ } -+ -+ if (rtnl_lock_needed) -+ rtnl_lock(); -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 12, 0)) -+ ret = regulatory_set_wiphy_regd_sync(wiphy, regd); -+ #else -+ ret = regulatory_set_wiphy_regd_sync_rtnl(wiphy, regd); -+ #endif -+ -+ rtw_regd_disable_no_20mhz_chs(wiphy); -+ -+ if (rtnl_lock_needed) -+ rtnl_unlock(); -+ -+ if (ret != 0) -+ RTW_INFO(FUNC_WIPHY_FMT" regulatory_set_wiphy_regd_sync_rtnl return %d\n", FUNC_WIPHY_ARG(wiphy), ret); -+ -+free_regd: -+ rtw_mfree(regd, sizeof(*regd) + sizeof(struct ieee80211_reg_rule) * regd->n_reg_rules); -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) */ -+ -+static void rtw_regd_overide_flags(struct wiphy *wiphy, struct get_chplan_resp *chplan, bool rtnl_lock_needed) -+{ -+ RT_CHANNEL_INFO *channel_set = chplan->chset; -+ u8 max_chan_nums = chplan->chset_num; -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ unsigned int i, j; -+ -+ if (rtnl_lock_needed) -+ rtnl_lock(); -+ -+ /* all channels disable */ -+ for (i = 0; i < NUM_NL80211_BANDS; i++) { -+ sband = wiphy->bands[i]; -+ if (!sband) -+ continue; -+ for (j = 0; j < sband->n_channels; j++) { -+ ch = &sband->channels[j]; -+ if (!ch) -+ continue; -+ ch->flags = IEEE80211_CHAN_DISABLED; -+ } -+ } -+ -+ /* channels apply by channel plans. */ -+ for (i = 0; i < max_chan_nums; i++) { -+ ch = channel_set[i].os_chan; -+ if (!ch) -+ continue; -+ -+ /* enable */ -+ ch->flags = 0; -+ -+ if (channel_set[i].flags & RTW_CHF_DFS) { -+ /* -+ * before integrating with nl80211 flow -+ * bypass IEEE80211_CHAN_RADAR when configured with radar detection -+ * to prevent from hostapd blocking DFS channels -+ */ -+ #ifdef CONFIG_DFS_MASTER -+ if (chplan->dfs_domain == RTW_DFS_REGD_NONE) -+ #endif -+ ch->flags |= IEEE80211_CHAN_RADAR; -+ } -+ -+ if (channel_set[i].flags & RTW_CHF_NO_IR) { -+ #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 -+ } -+ } -+ -+ if (rtnl_lock_needed) -+ rtnl_unlock(); -+} -+ -+#ifdef CONFIG_REGD_SRC_FROM_OS -+static void rtw_regd_apply_dfs_flags(struct get_chplan_resp *chplan, bool rtnl_lock_needed) -+{ -+ RT_CHANNEL_INFO *channel_set = chplan->chset; -+ u8 max_chan_nums = chplan->chset_num; -+ unsigned int i; -+ struct ieee80211_channel *chan; -+ -+ if (rtnl_lock_needed) -+ rtnl_lock(); -+ -+ /* channels apply by channel plans. */ -+ for (i = 0; i < max_chan_nums; i++) { -+ chan = channel_set[i].os_chan; -+ if (!chan) { -+ rtw_warn_on(1); -+ continue; -+ } -+ if (channel_set[i].flags & RTW_CHF_DFS) { -+ /* -+ * before integrating with nl80211 flow -+ * clear IEEE80211_CHAN_RADAR when configured with radar detection -+ * to prevent from hostapd blocking DFS channels -+ */ -+ #ifdef CONFIG_DFS_MASTER -+ if (chplan->dfs_domain != RTW_DFS_REGD_NONE) -+ chan->flags &= ~IEEE80211_CHAN_RADAR; -+ #endif -+ } -+ } -+ -+ if (rtnl_lock_needed) -+ rtnl_unlock(); -+} -+ -+/* init_channel_set_from_wiphy */ -+u8 rtw_os_init_channel_set(_adapter *padapter, RT_CHANNEL_INFO *channel_set) -+{ -+ struct wiphy *wiphy = adapter_to_wiphy(padapter); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ struct registry_priv *regsty = adapter_to_regsty(padapter); -+ struct ieee80211_channel *chan; -+ u8 chanset_size = 0; -+ int i, j; -+ -+ _rtw_memset(channel_set, 0, sizeof(RT_CHANNEL_INFO) * MAX_CHANNEL_NUM); -+ -+ for (i = NL80211_BAND_2GHZ; i <= NL80211_BAND_5GHZ; i++) { -+ if (!wiphy->bands[i]) -+ continue; -+ for (j = 0; j < wiphy->bands[i]->n_channels; j++) { -+ chan = &wiphy->bands[i]->channels[j]; -+ if (chan->flags & IEEE80211_CHAN_DISABLED) -+ continue; -+ if (rtw_regsty_is_excl_chs(regsty, chan->hw_value)) -+ continue; -+ -+ if (chanset_size >= MAX_CHANNEL_NUM) { -+ RTW_WARN("chset size can't exceed MAX_CHANNEL_NUM(%u)\n", MAX_CHANNEL_NUM); -+ i = NL80211_BAND_5GHZ + 1; -+ break; -+ } -+ -+ channel_set[chanset_size].ChannelNum = chan->hw_value; -+ channel_set[chanset_size].band = nl80211_band_to_rtw_band(i); -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) -+ if (chan->flags & (IEEE80211_CHAN_NO_IBSS | IEEE80211_CHAN_PASSIVE_SCAN)) -+ #else -+ if (chan->flags & IEEE80211_CHAN_NO_IR) -+ #endif -+ channel_set[chanset_size].flags |= RTW_CHF_NO_IR; -+ if (chan->flags & IEEE80211_CHAN_RADAR) -+ channel_set[chanset_size].flags |= RTW_CHF_DFS; -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) -+ if (chan->flags & IEEE80211_CHAN_NO_HT40PLUS) -+ channel_set[chanset_size].flags |= RTW_CHF_NO_HT40U; -+ if (chan->flags & IEEE80211_CHAN_NO_HT40MINUS) -+ channel_set[chanset_size].flags |= RTW_CHF_NO_HT40L; -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+ if (chan->flags & IEEE80211_CHAN_NO_80MHZ) -+ channel_set[chanset_size].flags |= RTW_CHF_NO_80MHZ; -+ if (chan->flags & IEEE80211_CHAN_NO_160MHZ) -+ channel_set[chanset_size].flags |= RTW_CHF_NO_160MHZ; -+ #endif -+ channel_set[chanset_size].os_chan = chan; -+ chanset_size++; -+ } -+ } -+ -+#if CONFIG_IEEE80211_BAND_5GHZ -+ #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 (chanset_size) -+ RTW_INFO(FUNC_ADPT_FMT" ch num:%d\n" -+ , FUNC_ADPT_ARG(padapter), chanset_size); -+ else -+ RTW_WARN(FUNC_ADPT_FMT" final chset has no channel\n" -+ , FUNC_ADPT_ARG(padapter)); -+ -+ return chanset_size; -+} -+ -+s16 rtw_os_get_total_txpwr_regd_lmt_mbm(_adapter *adapter, u8 cch, enum channel_width bw) -+{ -+ struct wiphy *wiphy = adapter_to_wiphy(adapter); -+ s16 mbm = UNSPECIFIED_MBM; -+ u8 *op_chs; -+ u8 op_ch_num; -+ u8 i; -+ u32 freq; -+ struct ieee80211_channel *ch; -+ -+ 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++) { -+ freq = rtw_ch2freq(op_chs[i]); -+ ch = ieee80211_get_channel(wiphy, freq); -+ if (!ch) { -+ rtw_warn_on(1); -+ continue; -+ } -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) -+ mbm = rtw_min(mbm, ch->max_reg_power * MBM_PDBM); -+ #else -+ /* require max_power == 0 (therefore orig_mpwr set to 0) when wiphy registration */ -+ mbm = rtw_min(mbm, ch->max_power * MBM_PDBM); -+ #endif -+ } -+ -+exit: -+ return mbm; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+static enum rtw_dfs_regd nl80211_dfs_regions_to_rtw_dfs_region(enum nl80211_dfs_regions region) -+{ -+ switch (region) { -+ case NL80211_DFS_FCC: -+ return RTW_DFS_REGD_FCC; -+ case NL80211_DFS_ETSI: -+ return RTW_DFS_REGD_ETSI; -+ case NL80211_DFS_JP: -+ return RTW_DFS_REGD_MKK; -+ case NL80211_DFS_UNSET: -+ default: -+ return RTW_DFS_REGD_NONE; -+ } -+}; -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) */ -+#endif /* CONFIG_REGD_SRC_FROM_OS */ -+ -+static enum rtw_regd_inr nl80211_reg_initiator_to_rtw_regd_inr(enum nl80211_reg_initiator initiator) -+{ -+ switch (initiator) { -+ case NL80211_REGDOM_SET_BY_DRIVER: -+ return RTW_REGD_SET_BY_DRIVER; -+ case NL80211_REGDOM_SET_BY_CORE: -+ return RTW_REGD_SET_BY_CORE; -+ case NL80211_REGDOM_SET_BY_USER: -+ return RTW_REGD_SET_BY_USER; -+ case NL80211_REGDOM_SET_BY_COUNTRY_IE: -+ return RTW_REGD_SET_BY_COUNTRY_IE; -+ } -+ rtw_warn_on(1); -+ return RTW_REGD_SET_BY_NUM; -+}; -+ -+#ifdef CONFIG_RTW_DEBUG -+static const char *nl80211_reg_initiator_str(enum nl80211_reg_initiator initiator) -+{ -+ switch (initiator) { -+ case NL80211_REGDOM_SET_BY_DRIVER: -+ return "DRIVER"; -+ case NL80211_REGDOM_SET_BY_CORE: -+ return "CORE"; -+ case NL80211_REGDOM_SET_BY_USER: -+ return "USER"; -+ case NL80211_REGDOM_SET_BY_COUNTRY_IE: -+ return "COUNTRY_IE"; -+ } -+ rtw_warn_on(1); -+ return "UNKNOWN"; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+static const char *nl80211_user_reg_hint_type_str(enum nl80211_user_reg_hint_type type) -+{ -+ switch (type) { -+ case NL80211_USER_REG_HINT_USER: -+ return "USER"; -+ case NL80211_USER_REG_HINT_CELL_BASE: -+ return "CELL_BASE"; -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) -+ case NL80211_USER_REG_HINT_INDOOR: -+ return "INDOOR"; -+ #endif -+ } -+ rtw_warn_on(1); -+ return "UNKNOWN"; -+} -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+static const char *nl80211_dfs_regions_str(enum nl80211_dfs_regions region) -+{ -+ switch (region) { -+ case NL80211_DFS_UNSET: -+ return "UNSET"; -+ case NL80211_DFS_FCC: -+ return "FCC"; -+ case NL80211_DFS_ETSI: -+ return "ETSI"; -+ case NL80211_DFS_JP: -+ return "JP"; -+ } -+ rtw_warn_on(1); -+ return "UNKNOWN"; -+}; -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) */ -+ -+static const char *environment_cap_str(enum environment_cap cap) -+{ -+ switch (cap) { -+ case ENVIRON_ANY: -+ return "ANY"; -+ case ENVIRON_INDOOR: -+ return "INDOOR"; -+ case ENVIRON_OUTDOOR: -+ return "OUTDOOR"; -+ } -+ rtw_warn_on(1); -+ return "UNKNOWN"; -+} -+ -+static void dump_requlatory_request(void *sel, struct regulatory_request *request) -+{ -+ u8 alpha2_len; -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 16, 0)) -+ alpha2_len = 3; -+ #else -+ alpha2_len = 2; -+ #endif -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ RTW_PRINT_SEL(sel, "initiator:%s, wiphy_idx:%d, type:%s\n" -+ , nl80211_reg_initiator_str(request->initiator) -+ , request->wiphy_idx -+ , nl80211_user_reg_hint_type_str(request->user_reg_hint_type)); -+ #else -+ RTW_PRINT_SEL(sel, "initiator:%s, wiphy_idx:%d\n" -+ , nl80211_reg_initiator_str(request->initiator) -+ , request->wiphy_idx); -+ #endif -+ -+ RTW_PRINT_SEL(sel, "alpha2:%.*s\n", alpha2_len, request->alpha2); -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+ RTW_PRINT_SEL(sel, "dfs_region:%s\n", nl80211_dfs_regions_str(request->dfs_region)); -+ #endif -+ -+ RTW_PRINT_SEL(sel, "intersect:%d\n", request->intersect); -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) -+ RTW_PRINT_SEL(sel, "processed:%d\n", request->processed); -+ #endif -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 36)) -+ RTW_PRINT_SEL(sel, "country_ie_checksum:0x%08x\n", request->country_ie_checksum); -+ #endif -+ -+ RTW_PRINT_SEL(sel, "country_ie_env:%s\n", environment_cap_str(request->country_ie_env)); -+} -+#endif /* CONFIG_RTW_DEBUG */ -+ -+static void rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) -+{ -+ struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ enum rtw_regd_inr inr; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ rtw_set_rtnl_lock_holder(dvobj, current); -+#endif -+ -+#ifdef CONFIG_RTW_DEBUG -+ if (rtw_drv_log_level >= _DRV_INFO_) { -+ RTW_INFO(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); -+ dump_requlatory_request(RTW_DBGDUMP, request); -+ } -+#endif -+ -+ inr = nl80211_reg_initiator_to_rtw_regd_inr(request->initiator); -+ -+#ifdef CONFIG_REGD_SRC_FROM_OS -+ if (REGSTY_REGD_SRC_FROM_OS(regsty)) { -+ enum rtw_dfs_regd dfs_region = RTW_DFS_REGD_NONE; -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+ dfs_region = nl80211_dfs_regions_to_rtw_dfs_region(request->dfs_region); -+ #endif -+ -+ /* trigger command to sync regulatory form OS */ -+ rtw_sync_os_regd_cmd(wiphy_to_adapter(wiphy), RTW_CMDF_WAIT_ACK, request->alpha2, dfs_region, inr); -+ } else -+#endif -+ { -+ /* use alpha2 as input to select the corresponding channel plan settings defined by Realtek */ -+ struct get_chplan_resp *chplan; -+ -+ switch (request->initiator) { -+ case NL80211_REGDOM_SET_BY_USER: -+ rtw_set_country(wiphy_to_adapter(wiphy), request->alpha2, inr); -+ break; -+ case NL80211_REGDOM_SET_BY_DRIVER: -+ case NL80211_REGDOM_SET_BY_CORE: -+ case NL80211_REGDOM_SET_BY_COUNTRY_IE: -+ default: -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+ rtw_warn_on(rtw_regd_is_wiphy_self_managed(wiphy)); -+ #endif -+ if (rtw_get_chplan_cmd(wiphy_to_adapter(wiphy), RTW_CMDF_WAIT_ACK, &chplan) == _SUCCESS) -+ rtw_regd_change_complete_sync(wiphy, chplan, 0); -+ else -+ rtw_warn_on(1); -+ break; -+ } -+ } -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ rtw_set_rtnl_lock_holder(dvobj, NULL); -+#endif -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) -+static int rtw_reg_notifier_return(struct wiphy *wiphy, struct regulatory_request *request) -+{ -+ rtw_reg_notifier(wiphy, request); -+ return 0; -+} -+#endif -+ -+struct async_regd_change_evt { -+ _list list; /* async_regd_change_list */ -+ struct wiphy *wiphy; -+ struct get_chplan_resp *chplan; -+}; -+ -+static void async_regd_change_work_hdl(_workitem *work) -+{ -+ struct rtw_wiphy_data *wiphy_data = container_of(work, struct rtw_wiphy_data, async_regd_change_work); -+ struct async_regd_change_evt *evt; -+ _irqL irqL; -+ _list *list, *head = &wiphy_data->async_regd_change_list; -+ -+ while (1) { -+ _enter_critical_mutex(&wiphy_data->async_regd_change_mutex, &irqL); -+ list = rtw_is_list_empty(head) ? NULL : get_next(head); -+ if (list) -+ rtw_list_delete(list); -+ _exit_critical_mutex(&wiphy_data->async_regd_change_mutex, &irqL); -+ -+ if (!list) -+ break; -+ -+ evt = LIST_CONTAINOR(list, struct async_regd_change_evt, list); -+ rtw_regd_change_complete_sync(evt->wiphy, evt->chplan, 1); -+ rtw_mfree(evt, sizeof(*evt)); -+ } -+} -+ -+int rtw_regd_init(struct wiphy *wiphy) -+{ -+ struct rtw_wiphy_data *wiphy_data = rtw_wiphy_priv(wiphy); -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) -+ wiphy->reg_notifier = rtw_reg_notifier_return; -+#else -+ wiphy->reg_notifier = rtw_reg_notifier; -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) -+ wiphy->flags &= ~WIPHY_FLAG_STRICT_REGULATORY; -+ wiphy->flags &= ~WIPHY_FLAG_DISABLE_BEACON_HINTS; -+#else -+ wiphy->regulatory_flags &= ~REGULATORY_STRICT_REG; -+ wiphy->regulatory_flags &= ~REGULATORY_DISABLE_BEACON_HINTS; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ wiphy->regulatory_flags |= REGULATORY_IGNORE_STALE_KICKOFF; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+ if (rtw_regd_is_wiphy_self_managed(wiphy)) -+ wiphy->regulatory_flags |= REGULATORY_WIPHY_SELF_MANAGED; -+#endif -+ -+ _rtw_init_listhead(&wiphy_data->async_regd_change_list); -+ _rtw_mutex_init(&wiphy_data->async_regd_change_mutex); -+ _init_workitem(&wiphy_data->async_regd_change_work, async_regd_change_work_hdl, NULL); -+ -+ return 0; -+} -+ -+static void rtw_regd_async_regd_change_list_free(struct wiphy *wiphy) -+{ -+ struct rtw_wiphy_data *wiphy_data = rtw_wiphy_priv(wiphy); -+ struct async_regd_change_evt *evt; -+ struct get_chplan_resp *chplan; -+ _irqL irqL; -+ _list *cur, *head; -+ -+ _enter_critical_mutex(&wiphy_data->async_regd_change_mutex, &irqL); -+ -+ head = &wiphy_data->async_regd_change_list; -+ cur = get_next(head); -+ -+ while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { -+ evt = LIST_CONTAINOR(cur, struct async_regd_change_evt, list); -+ chplan = evt->chplan; -+ cur = get_next(cur); -+ rtw_list_delete(&evt->list); -+ rtw_vmfree(chplan, sizeof(*chplan) + sizeof(RT_CHANNEL_INFO) * chplan->chset_num); -+ rtw_mfree(evt, sizeof(*evt)); -+ } -+ -+ _exit_critical_mutex(&wiphy_data->async_regd_change_mutex, &irqL); -+} -+ -+void rtw_regd_deinit(struct wiphy *wiphy) -+{ -+ struct rtw_wiphy_data *wiphy_data = rtw_wiphy_priv(wiphy); -+ -+ _cancel_workitem_sync(&wiphy_data->async_regd_change_work); -+ rtw_regd_async_regd_change_list_free(wiphy); -+ _rtw_mutex_free(&wiphy_data->async_regd_change_mutex); -+} -+ -+void rtw_regd_change_complete_sync(struct wiphy *wiphy, struct get_chplan_resp *chplan, bool rtnl_lock_needed) -+{ -+ if (chplan->regd_src == REGD_SRC_RTK_PRIV) { -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+ if (rtw_regd_is_wiphy_self_managed(wiphy)) -+ rtw_update_wiphy_regd(wiphy, chplan, rtnl_lock_needed); -+ else -+ #endif -+ rtw_regd_overide_flags(wiphy, chplan, rtnl_lock_needed); -+ } -+#ifdef CONFIG_REGD_SRC_FROM_OS -+ else if (chplan->regd_src == REGD_SRC_OS) -+ rtw_regd_apply_dfs_flags(chplan, rtnl_lock_needed); -+#endif -+ else -+ rtw_warn_on(1); -+ -+ rtw_vmfree(chplan, sizeof(struct get_chplan_resp) + sizeof(RT_CHANNEL_INFO) * chplan->chset_num); -+} -+ -+int rtw_regd_change_complete_async(struct wiphy *wiphy, struct get_chplan_resp *chplan) -+{ -+ struct rtw_wiphy_data *wiphy_data = rtw_wiphy_priv(wiphy); -+ struct async_regd_change_evt *evt; -+ _irqL irqL; -+ -+ evt = rtw_malloc(sizeof(*evt)); -+ if (!evt) { -+ rtw_vmfree(chplan, sizeof(struct get_chplan_resp) + sizeof(RT_CHANNEL_INFO) * chplan->chset_num); -+ return _FAIL; -+ } -+ -+ _rtw_init_listhead(&evt->list); -+ evt->wiphy = wiphy; -+ evt->chplan = chplan; -+ -+ _enter_critical_mutex(&wiphy_data->async_regd_change_mutex, &irqL); -+ -+ rtw_list_insert_tail(&evt->list, &wiphy_data->async_regd_change_list); -+ -+ _exit_critical_mutex(&wiphy_data->async_regd_change_mutex, &irqL); -+ -+ _set_workitem(&wiphy_data->async_regd_change_work); -+ -+ return _SUCCESS; -+} -+#endif /* CONFIG_IOCTL_CFG80211 */ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/wifi_regd.h b/drivers/net/wireless/rtl8821cs/os_dep/linux/wifi_regd.h -new file mode 100644 -index 000000000..c7e2f2cef ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/wifi_regd.h -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2009-2010 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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_REGD_H__ -+#define __WIFI_REGD_H__ -+ -+void rtw_chset_hook_os_channels(struct rf_ctl_t *rfctl); -+void rtw_regd_change_complete_sync(struct wiphy *wiphy, struct get_chplan_resp *chplan, bool rtnl_lock_needed); -+int rtw_regd_change_complete_async(struct wiphy *wiphy, struct get_chplan_resp *chplan); -+#ifdef CONFIG_REGD_SRC_FROM_OS -+struct _RT_CHANNEL_INFO; -+u8 rtw_os_init_channel_set(_adapter *padapter, struct _RT_CHANNEL_INFO *channel_set); -+s16 rtw_os_get_total_txpwr_regd_lmt_mbm(_adapter *adapter, u8 cch, enum channel_width bw); -+#endif -+int rtw_regd_init(struct wiphy *wiphy); -+void rtw_regd_deinit(struct wiphy *wiphy); -+ -+#endif /* __WIFI_REGD_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/linux/xmit_linux.c b/drivers/net/wireless/rtl8821cs/os_dep/linux/xmit_linux.c -new file mode 100644 -index 000000000..efe11c98a ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/linux/xmit_linux.c -@@ -0,0 +1,554 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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) -+{ -+ 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; -+ struct iphdr *iph = NULL; -+ struct ipv6hdr *i6ph = NULL; -+ struct udphdr *uh = NULL; -+ struct tcphdr *th = NULL; -+ u8 protocol = 0xFF; -+ -+ if (skb->protocol == htons(ETH_P_IP)) { -+ iph = (struct iphdr *)skb_network_header(skb); -+ protocol = iph->protocol; -+ } else if (skb->protocol == htons(ETH_P_IPV6)) { -+ i6ph = (struct ipv6hdr *)skb_network_header(skb); -+ protocol = i6ph->nexthdr; -+ } else -+ {} -+ -+ /* HW unable to compute CSUM if header & payload was be encrypted by SW(cause TXDMA error) */ -+ if (pattrib->bswenc == _TRUE) { -+ if (skb->ip_summed == CHECKSUM_PARTIAL) -+ skb_checksum_help(skb); -+ return; -+ } -+ -+ /* For HW rule, clear ipv4_csum & UDP/TCP_csum if it is UDP/TCP packet */ -+ switch (protocol) { -+ case IPPROTO_UDP: -+ uh = (struct udphdr *)skb_transport_header(skb); -+ uh->check = 0; -+ if (iph) -+ iph->check = 0; -+ pattrib->hw_csum = _TRUE; -+ break; -+ case IPPROTO_TCP: -+ th = (struct tcphdr *)skb_transport_header(skb); -+ th->check = 0; -+ if (iph) -+ iph->check = 0; -+ pattrib->hw_csum = _TRUE; -+ break; -+ default: -+ break; -+ } -+#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 os_qid) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter->registrypriv.wifi_spec) { -+ if (pxmitpriv->hwxmits[os_qid].accnt < WMM_XMIT_THRESHOLD) -+ return _TRUE; -+#ifdef DBG_CONFIG_ERROR_DETECT -+#ifdef DBG_CONFIG_ERROR_RESET -+ } else if (rtw_hal_sreset_inprogress(padapter) == _TRUE) { -+ return _FALSE; -+#endif/* #ifdef DBG_CONFIG_ERROR_RESET */ -+#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ -+ } 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 os_qid) -+{ -+ 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[os_qid].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) -+{ -+ 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; -+ -+ if (!padapter) -+ return; -+ pri_adapter = GET_PRIMARY_ADAPTER(padapter); -+ -+ 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); -+ -+#if defined(CONFIG_PCI_HCI) && defined(CONFIG_XMIT_THREAD_MODE) -+ if (_rtw_queue_empty(&padapter->xmitpriv.pending_xmitbuf_queue) == _FALSE) -+ _rtw_up_sema(&padapter->xmitpriv.xmit_sema); -+#endif -+ -+ -+#endif -+} -+ -+void rtw_os_check_wakup_queue(_adapter *adapter, u16 os_qid) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ if (rtw_os_need_wake_queue(adapter, os_qid)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ RTW_INFO(FUNC_ADPT_FMT": netif_wake_subqueue[%d]\n", FUNC_ADPT_ARG(adapter), os_qid); -+ netif_wake_subqueue(adapter->pnetdev, os_qid); -+ } -+#else -+ if (rtw_os_need_wake_queue(adapter, 0)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ RTW_INFO(FUNC_ADPT_FMT": netif_wake_queue\n", FUNC_ADPT_ARG(adapter)); -+ netif_wake_queue(adapter->pnetdev); -+ } -+#endif -+} -+ -+bool rtw_os_check_stop_queue(_adapter *adapter, u16 os_qid) -+{ -+ bool busy = _FALSE; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ if (rtw_os_need_stop_queue(adapter, os_qid)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ RTW_INFO(FUNC_ADPT_FMT": netif_stop_subqueue[%d]\n", FUNC_ADPT_ARG(adapter), os_qid); -+ netif_stop_subqueue(adapter->pnetdev, os_qid); -+ busy = _TRUE; -+ } -+#else -+ if (rtw_os_need_stop_queue(adapter, 0)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ RTW_INFO(FUNC_ADPT_FMT": netif_stop_queue\n", FUNC_ADPT_ARG(adapter)); -+ rtw_netif_stop_queue(adapter->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 -+} -+ -+int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ struct sk_buff *skb = pkt; -+ struct sk_buff *segs, *nskb; -+ netdev_features_t features = padapter->pnetdev->features; -+#endif -+ u16 os_qid = 0; -+ s32 res = 0; -+ -+ 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) -+#ifdef CONFIG_LAYER2_ROAMING -+ &&(!padapter->mlmepriv.roam_network) -+#endif -+ ){ -+ 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; -+ } -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ os_qid = skb_get_queue_mapping(pkt); -+#endif -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ if (skb_shinfo(skb)->gso_size) { -+ /* split a big(65k) skb into several small(1.5k) skbs */ -+ features &= ~(NETIF_F_TSO | NETIF_F_TSO6); -+ segs = skb_gso_segment(skb, features); -+ if (IS_ERR(segs) || !segs) -+ goto drop_packet; -+ -+ do { -+ nskb = segs; -+ segs = segs->next; -+ nskb->next = NULL; -+ rtw_mstat_update( MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, nskb->truesize); -+ res = rtw_xmit(padapter, &nskb, os_qid); -+ if (res < 0) { -+ #ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s rtw_xmit fail\n", __FUNCTION__); -+ #endif -+ pxmitpriv->tx_drop++; -+ rtw_os_pkt_complete(padapter, nskb); -+ } -+ } while (segs); -+ rtw_os_pkt_complete(padapter, skb); -+ goto exit; -+ } -+#endif -+ -+ res = rtw_xmit(padapter, &pkt, os_qid); -+ 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; -+} -+ -+#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL -+int check_alibaba_meshpkt(struct sk_buff *skb) -+{ -+ u16 protocol; -+ -+ if (skb) -+ return (htons(skb->protocol) == ETH_P_ALL); -+ -+ return _FALSE; -+} -+ -+s32 rtw_alibaba_mesh_xmit_entry(_pkt *pkt, struct net_device *ndev) -+{ -+ u16 frame_ctl; -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct pkt_file pktfile; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct pkt_attrib *pattrib; -+ struct xmit_frame *pmgntframe; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ unsigned char *pframe; -+ struct sk_buff *skb = (struct sk_buff *)pkt; -+ int len = skb->len; -+ -+ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ goto fail; -+ return -1; -+ } -+ -+ 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; -+ -+ _rtw_open_pktfile(pkt, &pktfile); -+ _rtw_pktfile_read(&pktfile, pframe, len); -+ -+ pattrib->type = pframe[0] & 0x0C; -+ pattrib->subtype = pframe[0] & 0xF0; -+ pattrib->raid = rtw_get_mgntframe_raid(padapter, WIRELESS_11G); -+ pattrib->rate = MGN_24M; -+ pattrib->pktlen = len; -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ -+ RTW_DBG_DUMP("rtw_alibaba_mesh_xmit_entry payload:", skb->data, len); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+fail: -+ rtw_skb_free(skb); -+ return 0; -+} -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 32)) -+netdev_tx_t rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) -+#else -+int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) -+#endif -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ int ret = 0; -+ -+ if (pkt) { -+#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL -+ if (check_alibaba_meshpkt(pkt)) { -+ ret = rtw_alibaba_mesh_xmit_entry(pkt, pnetdev); -+ goto out; -+ } -+#endif -+ 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); -+ } -+ -+ } -+ -+#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL -+out: -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 32)) -+ return (ret == 0) ? NETDEV_TX_OK : NETDEV_TX_BUSY; -+#else -+ return ret; -+#endif -+} -diff --git a/drivers/net/wireless/rtl8821cs/os_dep/osdep_service.c b/drivers/net/wireless/rtl8821cs/os_dep/osdep_service.c -new file mode 100644 -index 000000000..2f6afb067 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/os_dep/osdep_service.c -@@ -0,0 +1,3735 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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 */ -+ -+ -+#ifdef DBG_MEM_ERR_FREE -+ -+#if (KERNEL_VERSION(3, 7, 0) <= LINUX_VERSION_CODE) -+ -+#define DBG_MEM_HASHBITS 10 -+ -+#define DBG_MEM_TYPE_PHY 0 -+#define DBG_MEM_TYPE_VIR 1 -+ -+/* -+ * DBG_MEM_ERR_FREE is only for the debug purpose. -+ * -+ * There is the limitation that this mechanism only can -+ * support one wifi device, and has problem if there -+ * are two or more wifi devices with one driver on -+ * the same system. It's because dbg_mem_ht is global -+ * variable, and if we move this dbg_mem_ht into struct -+ * dvobj_priv to support more wifi devices, the memory -+ * allocation functions, like rtw_malloc(), need to have -+ * the parameter dvobj to get relative hash table, and -+ * then it is the huge changes for the driver currently. -+ * -+ */ -+struct hlist_head dbg_mem_ht[1 << DBG_MEM_HASHBITS]; -+ -+struct hash_mem { -+ void *mem; -+ int sz; -+ int type; -+ struct hlist_node node; -+}; -+ -+#endif /* LINUX_VERSION_CODE */ -+ -+void rtw_dbg_mem_init(void) -+{ -+#if (KERNEL_VERSION(3, 7, 0) <= LINUX_VERSION_CODE) -+ hash_init(dbg_mem_ht); -+#endif /* LINUX_VERSION_CODE */ -+} -+ -+void rtw_dbg_mem_deinit(void) -+{ -+#if (KERNEL_VERSION(3, 7, 0) <= LINUX_VERSION_CODE) -+ struct hlist_head *head; -+ struct hlist_node *p; -+ int i; -+ -+ for (i = 0; i < HASH_SIZE(dbg_mem_ht); i++) { -+ head = &dbg_mem_ht[i]; -+ p = head->first; -+ while (p) { -+ struct hlist_node *prev; -+ struct hash_mem *hm; -+ -+ hm = container_of(p, struct hash_mem, node); -+ prev = p; -+ p = p->next; -+ -+ RTW_ERR("%s: memory leak - 0x%x\n", __func__, hm->mem); -+ hash_del(prev); -+ kfree(hm); -+ } -+ } -+#endif /* LINUX_VERSION_CODE */ -+} -+ -+#if (KERNEL_VERSION(3, 7, 0) <= LINUX_VERSION_CODE) -+struct hash_mem *rtw_dbg_mem_find(void *mem) -+{ -+ struct hash_mem *hm; -+ struct hlist_head *head; -+ struct hlist_node *p; -+ -+ head = &dbg_mem_ht[hash_64((u64)(mem), DBG_MEM_HASHBITS)]; -+ -+ p = head->first; -+ while (p) { -+ hm = container_of(p, struct hash_mem, node); -+ if (hm->mem == mem) -+ goto out; -+ p = p->next; -+ } -+ hm = NULL; -+out: -+ return hm; -+} -+ -+void rtw_dbg_mem_alloc(void *mem, int sz, int type) -+{ -+ struct hash_mem *hm; -+ -+ hm = rtw_dbg_mem_find(mem); -+ if (!hm) { -+ hm = (struct hash_mem *)kmalloc(sizeof(*hm), GFP_ATOMIC); -+ hm->mem = mem; -+ hm->sz = sz; -+ hm->type = type; -+ hash_add(dbg_mem_ht, &hm->node, (u64)(mem)); -+ } else { -+ RTW_ERR("%s mem(%x) is in hash already\n", __func__, mem); -+ rtw_warn_on(1); -+ } -+} -+ -+bool rtw_dbg_mem_free(void *mem, int sz, int type) -+{ -+ struct hash_mem *hm; -+ bool ret; -+ -+ hm = rtw_dbg_mem_find(mem); -+ if (!hm) { -+ RTW_ERR("%s cannot find allocated memory: %x\n", -+ __func__, mem); -+ rtw_warn_on(1); -+ return false; -+ } -+ -+ if (hm->sz != sz) { -+ RTW_ERR("%s memory (%x) size mismatch free(%d) != alloc(%d)\n", -+ __func__, mem, sz, hm->sz); -+ rtw_warn_on(1); -+ ret = false; -+ goto out; -+ } -+ -+ if (hm->type != type) { -+ RTW_ERR("%s memory (%x) type mismatch free(%d) != alloc(%d)\n", -+ __func__, mem, type, hm->type); -+ rtw_warn_on(1); -+ ret = false; -+ goto out; -+ } -+ ret = true; -+ -+out: -+ hash_del(&hm->node); -+ kfree(hm); -+ -+ return ret; -+} -+ -+#endif /* LINUX_VERSION_CODE */ -+#endif /* DBG_MEM_ERR_FREE */ -+ -+#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 void *_rtw_vmalloc(u32 sz) -+{ -+ void *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_MEM_ERR_FREE -+ if (pbuf) -+ rtw_dbg_mem_alloc(pbuf, sz, DBG_MEM_TYPE_VIR); -+#endif /* DBG_MEM_ERR_FREE */ -+ -+#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 void *_rtw_zvmalloc(u32 sz) -+{ -+ void *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(void *pbuf, u32 sz) -+{ -+#ifdef DBG_MEM_ERR_FREE -+ if (!rtw_dbg_mem_free(pbuf, sz, DBG_MEM_TYPE_VIR)) -+ return; -+#endif /* DBG_MEM_ERR_FREE */ -+ -+#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 */ -+} -+ -+void *_rtw_malloc(u32 sz) -+{ -+ void *pbuf = NULL; -+ -+#ifdef PLATFORM_LINUX -+#ifdef RTK_DMP_PLATFORM -+ if (sz > 0x4000) -+ pbuf = 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_MEM_ERR_FREE -+ if (pbuf) -+ rtw_dbg_mem_alloc(pbuf, sz, DBG_MEM_TYPE_PHY); -+#endif /* DBG_MEM_ERR_FREE */ -+ -+#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; -+ -+} -+ -+ -+void *_rtw_zmalloc(u32 sz) -+{ -+#ifdef PLATFORM_FREEBSD -+ return malloc(sz, M_DEVBUF, M_ZERO | M_NOWAIT); -+#else /* PLATFORM_FREEBSD */ -+ void *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(void *pbuf, u32 sz) -+{ -+ -+#ifdef DBG_MEM_ERR_FREE -+ if (!rtw_dbg_mem_free(pbuf, sz, DBG_MEM_TYPE_PHY)) -+ return; -+#endif /* DBG_MEM_ERR_FREE */ -+ -+#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 = _rtw_zmalloc(sizeof(struct sk_buff)); */ /* for skb->len, etc. */ -+ skb = _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(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(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 -+ -+ 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 systime 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 void *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ void *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 void *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ void *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(void *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 void *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ void *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 void *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ void *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(void *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); -+} -+ -+inline void rtw_os_pkt_free(_pkt *pkt) -+{ -+#if defined(PLATFORM_LINUX) -+ rtw_skb_free(pkt); -+#elif defined(PLATFORM_FREEBSD) -+ m_freem(pkt); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+inline _pkt *rtw_os_pkt_copy(_pkt *pkt) -+{ -+#if defined(PLATFORM_LINUX) -+ return rtw_skb_copy(pkt); -+#elif defined(PLATFORM_FREEBSD) -+ return m_dup(pkt, M_NOWAIT); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+inline void *rtw_os_pkt_data(_pkt *pkt) -+{ -+#if defined(PLATFORM_LINUX) -+ return pkt->data; -+#elif defined(PLATFORM_FREEBSD) -+ return pkt->m_data; -+#else -+ #error "TBD\n" -+#endif -+} -+ -+inline u32 rtw_os_pkt_len(_pkt *pkt) -+{ -+#if defined(PLATFORM_LINUX) -+ return pkt->len; -+#elif defined(PLATFORM_FREEBSD) -+ return pkt->m_pkthdr.len; -+#else -+ #error "TBD\n" -+#endif -+} -+ -+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 -+ #error "TBD\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 -+ -+ -+ -+} -+ -+int _rtw_memcmp2(const void *dst, const void *src, u32 sz) -+{ -+ const unsigned char *p1 = dst, *p2 = src; -+ -+ if (sz == 0) -+ return 0; -+ -+ while (*p1 == *p2) { -+ p1++; -+ p2++; -+ sz--; -+ if (sz == 0) -+ return 0; -+ } -+ -+ return *p1 - *p2; -+} -+ -+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 -+ -+} -+ -+inline void rtw_list_splice(_list *list, _list *head) -+{ -+#ifdef PLATFORM_LINUX -+ list_splice(list, head); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+inline void rtw_list_splice_init(_list *list, _list *head) -+{ -+#ifdef PLATFORM_LINUX -+ list_splice_init(list, head); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+inline void rtw_list_splice_tail(_list *list, _list *head) -+{ -+#ifdef PLATFORM_LINUX -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 27)) -+ if (!list_empty(list)) -+ __list_splice(list, head); -+ #else -+ list_splice_tail(list, head); -+ #endif -+#else -+ #error "TBD\n" -+#endif -+} -+ -+inline void rtw_hlist_head_init(rtw_hlist_head *h) -+{ -+#ifdef PLATFORM_LINUX -+ INIT_HLIST_HEAD(h); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+inline void rtw_hlist_add_head(rtw_hlist_node *n, rtw_hlist_head *h) -+{ -+#ifdef PLATFORM_LINUX -+ hlist_add_head(n, h); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+inline void rtw_hlist_del(rtw_hlist_node *n) -+{ -+#ifdef PLATFORM_LINUX -+ hlist_del(n); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+inline void rtw_hlist_add_head_rcu(rtw_hlist_node *n, rtw_hlist_head *h) -+{ -+#ifdef PLATFORM_LINUX -+ hlist_add_head_rcu(n, h); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+inline void rtw_hlist_del_rcu(rtw_hlist_node *n) -+{ -+#ifdef PLATFORM_LINUX -+ hlist_del_rcu(n); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc, void *ctx) -+{ -+ _adapter *adapter = (_adapter *)padapter; -+ -+#ifdef PLATFORM_LINUX -+ _init_timer(ptimer, adapter->pnetdev, pfunc, ctx); -+#endif -+#ifdef PLATFORM_FREEBSD -+ _init_timer(ptimer, adapter->pifp, pfunc, ctx); -+#endif -+#ifdef PLATFORM_WINDOWS -+ _init_timer(ptimer, adapter->hndis_adapter, pfunc, ctx); -+#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 -+} -+ -+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; -+} -+ -+ -+systime _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 SystemTime.LowPart;/* count of 100-nanosecond intervals */ -+#endif -+} -+ -+inline u32 _rtw_systime_to_ms(systime stime) -+{ -+#ifdef PLATFORM_LINUX -+ return jiffies_to_msecs(stime); -+#endif -+#ifdef PLATFORM_FREEBSD -+ return stime * 1000; -+#endif -+#ifdef PLATFORM_WINDOWS -+ return stime / 10000 ; -+#endif -+} -+ -+inline systime _rtw_ms_to_systime(u32 ms) -+{ -+#ifdef PLATFORM_LINUX -+ return msecs_to_jiffies(ms); -+#endif -+#ifdef PLATFORM_FREEBSD -+ return ms / 1000; -+#endif -+#ifdef PLATFORM_WINDOWS -+ return ms * 10000 ; -+#endif -+} -+ -+inline systime _rtw_us_to_systime(u32 us) -+{ -+#ifdef PLATFORM_LINUX -+ return usecs_to_jiffies(us); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+/* the input parameter start use the same unit as returned by rtw_get_current_time */ -+inline s32 _rtw_get_passing_time_ms(systime start) -+{ -+ return _rtw_systime_to_ms(_rtw_get_current_time() - start); -+} -+ -+inline s32 _rtw_get_remaining_time_ms(systime end) -+{ -+ return _rtw_systime_to_ms(end - _rtw_get_current_time()); -+} -+ -+inline s32 _rtw_get_time_interval_ms(systime start, systime end) -+{ -+ return _rtw_systime_to_ms(end - start); -+} -+ -+inline bool _rtw_time_after(systime a, systime b) -+{ -+#ifdef PLATFORM_LINUX -+ return time_after(a, b); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+sysptime rtw_sptime_get(void) -+{ -+ /* CLOCK_MONOTONIC */ -+#ifdef PLATFORM_LINUX -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0)) -+ struct timespec64 cur; -+ -+ ktime_get_ts64(&cur); -+ return timespec64_to_ktime(cur); -+ #else -+ struct timespec cur; -+ -+ ktime_get_ts(&cur); -+ return timespec_to_ktime(cur); -+ #endif -+#else -+ #error "TBD\n" -+#endif -+} -+ -+sysptime rtw_sptime_set(s64 secs, const u32 nsecs) -+{ -+#ifdef PLATFORM_LINUX -+ return ktime_set(secs, nsecs); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+sysptime rtw_sptime_zero(void) -+{ -+#ifdef PLATFORM_LINUX -+ return ktime_set(0, 0); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+/* -+ * cmp1 < cmp2: return <0 -+ * cmp1 == cmp2: return 0 -+ * cmp1 > cmp2: return >0 -+ */ -+int rtw_sptime_cmp(const sysptime cmp1, const sysptime cmp2) -+{ -+#ifdef PLATFORM_LINUX -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ return ktime_compare(cmp1, cmp2); -+ #else -+ if (cmp1.tv64 < cmp2.tv64) -+ return -1; -+ if (cmp1.tv64 > cmp2.tv64) -+ return 1; -+ return 0; -+ #endif -+#else -+ #error "TBD\n" -+#endif -+} -+ -+bool rtw_sptime_eql(const sysptime cmp1, const sysptime cmp2) -+{ -+#ifdef PLATFORM_LINUX -+ return rtw_sptime_cmp(cmp1, cmp2) == 0; -+#else -+ #error "TBD\n" -+#endif -+} -+ -+bool rtw_sptime_is_zero(const sysptime sptime) -+{ -+#ifdef PLATFORM_LINUX -+ return rtw_sptime_cmp(sptime, rtw_sptime_zero()) == 0; -+#else -+ #error "TBD\n" -+#endif -+} -+ -+/* -+ * sub = lhs - rhs, in normalized form -+ */ -+sysptime rtw_sptime_sub(const sysptime lhs, const sysptime rhs) -+{ -+#ifdef PLATFORM_LINUX -+ return ktime_sub(lhs, rhs); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+/* -+ * add = lhs + rhs, in normalized form -+ */ -+sysptime rtw_sptime_add(const sysptime lhs, const sysptime rhs) -+{ -+#ifdef PLATFORM_LINUX -+ return ktime_add(lhs, rhs); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+s64 rtw_sptime_to_ms(const sysptime sptime) -+{ -+#ifdef PLATFORM_LINUX -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ return ktime_to_ms(sptime); -+ #else -+ struct timeval tv = ktime_to_timeval(sptime); -+ -+ return (s64) tv.tv_sec * MSEC_PER_SEC + tv.tv_usec / USEC_PER_MSEC; -+ #endif -+#else -+ #error "TBD\n" -+#endif -+} -+ -+sysptime rtw_ms_to_sptime(u64 ms) -+{ -+#ifdef PLATFORM_LINUX -+ return ns_to_ktime(ms * NSEC_PER_MSEC); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+s64 rtw_sptime_to_us(const sysptime sptime) -+{ -+#ifdef PLATFORM_LINUX -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22)) -+ return ktime_to_us(sptime); -+ #else -+ struct timeval tv = ktime_to_timeval(sptime); -+ -+ return (s64) tv.tv_sec * USEC_PER_SEC + tv.tv_usec; -+ #endif -+#else -+ #error "TBD\n" -+#endif -+} -+ -+sysptime rtw_us_to_sptime(u64 us) -+{ -+#ifdef PLATFORM_LINUX -+ return ns_to_ktime(us * NSEC_PER_USEC); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+s64 rtw_sptime_to_ns(const sysptime sptime) -+{ -+#ifdef PLATFORM_LINUX -+ return ktime_to_ns(sptime); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+sysptime rtw_ns_to_sptime(u64 ns) -+{ -+#ifdef PLATFORM_LINUX -+ return ns_to_ktime(ns); -+#else -+ #error "TBD\n" -+#endif -+} -+ -+s64 rtw_sptime_diff_ms(const sysptime start, const sysptime end) -+{ -+ sysptime diff; -+ -+ diff = rtw_sptime_sub(end, start); -+ -+ return rtw_sptime_to_ms(diff); -+} -+ -+s64 rtw_sptime_pass_ms(const sysptime start) -+{ -+ sysptime cur, diff; -+ -+ cur = rtw_sptime_get(); -+ diff = rtw_sptime_sub(cur, start); -+ -+ return rtw_sptime_to_ms(diff); -+} -+ -+s64 rtw_sptime_diff_us(const sysptime start, const sysptime end) -+{ -+ sysptime diff; -+ -+ diff = rtw_sptime_sub(end, start); -+ -+ return rtw_sptime_to_us(diff); -+} -+ -+s64 rtw_sptime_pass_us(const sysptime start) -+{ -+ sysptime cur, diff; -+ -+ cur = rtw_sptime_get(); -+ diff = rtw_sptime_sub(cur, start); -+ -+ return rtw_sptime_to_us(diff); -+} -+ -+s64 rtw_sptime_diff_ns(const sysptime start, const sysptime end) -+{ -+ sysptime diff; -+ -+ diff = rtw_sptime_sub(end, start); -+ -+ return rtw_sptime_to_ns(diff); -+} -+ -+s64 rtw_sptime_pass_ns(const sysptime start) -+{ -+ sysptime cur, diff; -+ -+ cur = rtw_sptime_get(); -+ diff = rtw_sptime_sub(cur, start); -+ -+ return rtw_sptime_to_ns(diff); -+} -+ -+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); -+ schedule_timeout(delta); -+ 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 -+} -+ -+const char *_rtw_pwait_type_str[] = { -+ [RTW_PWAIT_TYPE_MSLEEP] = "MS", -+ [RTW_PWAIT_TYPE_USLEEP] = "US", -+ [RTW_PWAIT_TYPE_YIELD] = "Y", -+ [RTW_PWAIT_TYPE_MDELAY] = "MD", -+ [RTW_PWAIT_TYPE_UDELAY] = "UD", -+ [RTW_PWAIT_TYPE_NUM] = "unknown", -+}; -+ -+static void rtw_pwctx_yield(int us) -+{ -+ rtw_yield_os(); -+} -+ -+static void (*const rtw_pwait_hdl[])(int)= { -+ [RTW_PWAIT_TYPE_MSLEEP] = rtw_msleep_os, -+ [RTW_PWAIT_TYPE_USLEEP] = rtw_usleep_os, -+ [RTW_PWAIT_TYPE_YIELD] = rtw_pwctx_yield, -+ [RTW_PWAIT_TYPE_MDELAY] = rtw_mdelay_os, -+ [RTW_PWAIT_TYPE_UDELAY] = rtw_udelay_os, -+}; -+ -+int rtw_pwctx_config(struct rtw_pwait_ctx *pwctx, enum rtw_pwait_type type, s32 time, s32 cnt_lmt) -+{ -+ int ret = _FAIL; -+ -+ if (!RTW_PWAIT_TYPE_VALID(type)) -+ goto exit; -+ -+ pwctx->conf.type = type; -+ pwctx->conf.wait_time = time; -+ pwctx->conf.wait_cnt_lmt = cnt_lmt; -+ pwctx->wait_hdl = rtw_pwait_hdl[type]; -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+bool rtw_macaddr_is_larger(const u8 *a, const u8 *b) -+{ -+ u32 va, vb; -+ -+ va = be32_to_cpu(*((u32 *)a)); -+ vb = be32_to_cpu(*((u32 *)b)); -+ if (va > vb) -+ return 1; -+ else if (va < vb) -+ return 0; -+ -+ return be16_to_cpu(*((u16 *)(a + 4))) > be16_to_cpu(*((u16 *)(b + 4))); -+} -+ -+#define RTW_SUSPEND_LOCK_NAME "rtw_wifi" -+#define RTW_SUSPEND_TRAFFIC_LOCK_NAME "rtw_wifi_traffic" -+#define RTW_SUSPEND_RESUME_LOCK_NAME "rtw_wifi_resume" -+#ifdef CONFIG_WAKELOCK -+static struct wake_lock rtw_suspend_lock; -+static struct wake_lock rtw_suspend_traffic_lock; -+static struct wake_lock rtw_suspend_resume_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_traffic_lock = { -+ .name = RTW_SUSPEND_TRAFFIC_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_suspend_resume_lock = { -+ .name = RTW_SUSPEND_RESUME_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_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); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_init_suspend_lock(&rtw_suspend_lock); -+ android_init_suspend_lock(&rtw_suspend_traffic_lock); -+ android_init_suspend_lock(&rtw_suspend_resume_lock); -+#endif -+} -+ -+inline void rtw_suspend_lock_uninit(void) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_lock_destroy(&rtw_suspend_lock); -+ wake_lock_destroy(&rtw_suspend_traffic_lock); -+ wake_lock_destroy(&rtw_suspend_resume_lock); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_uninit_suspend_lock(&rtw_suspend_lock); -+ android_uninit_suspend_lock(&rtw_suspend_traffic_lock); -+ android_uninit_suspend_lock(&rtw_suspend_resume_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_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_set_bit(int nr, unsigned long *addr) -+{ -+#ifdef PLATFORM_LINUX -+ set_bit(nr, addr); -+#else -+ #error "TBD\n"; -+#endif -+} -+ -+inline void rtw_clear_bit(int nr, unsigned long *addr) -+{ -+#ifdef PLATFORM_LINUX -+ clear_bit(nr, addr); -+#else -+ #error "TBD\n"; -+#endif -+} -+ -+inline int rtw_test_and_clear_bit(int nr, unsigned long *addr) -+{ -+#ifdef PLATFORM_LINUX -+ return test_and_clear_bit(nr, addr); -+#else -+ #error "TBD\n"; -+#endif -+} -+ -+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 -+} -+ -+inline bool ATOMIC_INC_UNLESS(ATOMIC_T *v, int u) -+{ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 15)) -+ return atomic_add_unless(v, 1, u); -+#else -+ /* only make sure not exceed after this function */ -+ if (ATOMIC_INC_RETURN(v) > u) { -+ ATOMIC_DEC(v); -+ return 0; -+ } -+ return 1; -+#endif -+#else -+ #error "TBD\n" -+#endif -+} -+ -+#ifdef PLATFORM_LINUX -+#if !defined(CONFIG_RTW_ANDROID_GKI) -+/* -+* 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 (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ if (!(fp->f_mode & FMODE_CAN_READ)) -+#else -+ if (!fp->f_op || !fp->f_op->read) -+#endif -+ return -EPERM; -+ -+ while (sum < len) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) -+ rlen = kernel_read(fp, buf + sum, len - sum, &fp->f_pos); -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ rlen = __vfs_read(fp, buf + sum, len - sum, &fp->f_pos); -+#else -+ rlen = fp->f_op->read(fp, buf + sum, len - sum, &fp->f_pos); -+#endif -+ 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 (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ if (!(fp->f_mode & FMODE_CAN_WRITE)) -+#else -+ if (!fp->f_op || !fp->f_op->write) -+#endif -+ return -EPERM; -+ -+ while (sum < len) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) -+ wlen = kernel_write(fp, buf + sum, len - sum, &fp->f_pos); -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ wlen = __vfs_write(fp, buf + sum, len - sum, &fp->f_pos); -+#else -+ wlen = fp->f_op->write(fp, buf + sum, len - sum, &fp->f_pos); -+#endif -+ if (wlen > 0) -+ sum += wlen; -+ else if (0 != wlen) -+ return wlen; -+ else -+ break; -+ } -+ -+ return sum; -+ -+} -+ -+/* -+* Test if the specifi @param pathname is a direct and readable -+* If readable, @param sz is not used -+* @param pathname the name of the path to test -+* @return Linux specific error code -+*/ -+static int isDirReadable(const char *pathname, u32 *sz) -+{ -+ struct path path; -+ int error = 0; -+ -+ return kern_path(pathname, LOOKUP_FOLLOW, &path); -+} -+ -+/* -+* 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; -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ mm_segment_t oldfs; -+ #endif -+ char buf; -+ -+ fp = filp_open(path, O_RDONLY, 0); -+ if (IS_ERR(fp)) -+ ret = PTR_ERR(fp); -+ else { -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ oldfs = get_fs(); -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 1, 0)) -+ set_fs(KERNEL_DS); -+ #else -+ set_fs(get_ds()); -+ #endif -+ #endif -+ -+ 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 -+ } -+ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ set_fs(oldfs); -+ #endif -+ filp_close(fp, NULL); -+ } -+ 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; -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ mm_segment_t oldfs; -+ #endif -+ 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); -+ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ oldfs = get_fs(); -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 1, 0)) -+ set_fs(KERNEL_DS); -+ #else -+ set_fs(get_ds()); -+ #endif -+ #endif -+ -+ ret = writeFile(fp, buf, sz); -+ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ set_fs(oldfs); -+ #endif -+ 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 /* !defined(CONFIG_RTW_ANDROID_GKI)*/ -+#endif /* PLATFORM_LINUX */ -+ -+#if !defined(CONFIG_RTW_ANDROID_GKI) -+/* -+* Test if the specifi @param path is a direct and readable -+* @param path the path of the direct to test -+* @return _TRUE or _FALSE -+*/ -+int rtw_is_dir_readable(const char *path) -+{ -+#ifdef PLATFORM_LINUX -+ if (isDirReadable(path, NULL) == 0) -+ return _TRUE; -+ else -+ return _FALSE; -+#else -+ /* Todo... */ -+ return _FALSE; -+#endif -+} -+#endif /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+ -+/* -+* 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) -+{ -+#if defined(CONFIG_RTW_ANDROID_GKI) -+ int ret = -EINVAL; -+ const struct firmware *fw = NULL; -+ char* const delim = "/"; -+ char *name, *token, *cur, *path_tmp = NULL; -+ -+ -+ if (path == NULL || buf == NULL) { -+ RTW_ERR("%s() NULL pointer\n", __func__); -+ goto err; -+ } -+ -+ path_tmp = kstrdup(path, GFP_KERNEL); -+ if (path_tmp == NULL) { -+ RTW_ERR("%s() cannot copy path for parsing file name\n", __func__); -+ goto err; -+ } -+ -+ /* parsing file name from path */ -+ cur = path_tmp; -+ token = strsep(&cur, delim); -+ while (token != NULL) { -+ token = strsep(&cur, delim); -+ if(token) -+ name = token; -+ } -+ -+ if (name == NULL) { -+ RTW_ERR("%s() parsing file name fail\n", __func__); -+ goto err; -+ } -+ -+ /* request_firmware() will find file in /vendor/firmware but not in path */ -+ ret = request_firmware(&fw, name, NULL); -+ if (ret == 0) { -+ RTW_INFO("%s() Success. retrieve file : %s, file size : %zu\n", __func__, name, fw->size); -+ -+ if ((u32)fw->size < sz) { -+ _rtw_memcpy(buf, fw->data, (u32)fw->size); -+ ret = (u32)fw->size; -+ goto exit; -+ } else { -+ RTW_ERR("%s() file size : %zu exceed buf size : %u\n", __func__, fw->size, sz); -+ ret = -EFBIG; -+ goto err; -+ } -+ } else { -+ RTW_ERR("%s() Fail. retrieve file : %s, error : %d\n", __func__, name, ret); -+ goto err; -+ } -+ -+ -+ -+err: -+ RTW_ERR("%s() Fail. retrieve file : %s, error : %d\n", __func__, path, ret); -+exit: -+ if (path_tmp) -+ kfree(path_tmp); -+ if (fw) -+ release_firmware(fw); -+ return ret; -+#else /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+ int ret = -1; -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ mm_segment_t oldfs; -+ #endif -+ 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); -+ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ oldfs = get_fs(); -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 1, 0)) -+ set_fs(KERNEL_DS); -+ #else -+ set_fs(get_ds()); -+ #endif -+ #endif -+ -+ ret = readFile(fp, buf, sz); -+ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) -+ set_fs(oldfs); -+ #endif -+ 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; -+#endif /* defined(CONFIG_RTW_ANDROID_GKI) */ -+} -+ -+/* -+* 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 !defined(CONFIG_RTW_ANDROID_GKI) -+ if (isFileReadable(path, NULL) == 0) -+ return _TRUE; -+ else -+ return _FALSE; -+#else -+ RTW_INFO("%s() Android GKI prohibbit kernel_read, return _TRUE\n", __func__); -+ return _TRUE; -+#endif /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+#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 !defined(CONFIG_RTW_ANDROID_GKI) -+ if (isFileReadable(path, sz) == 0) -+ return _TRUE; -+ else -+ return _FALSE; -+#else -+ RTW_INFO("%s() Android GKI prohibbit kernel_read, return _TRUE\n", __func__); -+ *sz = 0; -+ return _TRUE; -+#endif /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+#else -+ /* Todo... */ -+ return _FALSE; -+#endif -+} -+ -+/* -+* Test if the specifi @param path is a readable file with valid size. -+* If readable, @param sz is got -+* @param path the path of the file to test -+* @return _TRUE or _FALSE -+*/ -+int rtw_readable_file_sz_chk(const char *path, u32 sz) -+{ -+ u32 fsz; -+ -+ if (rtw_is_file_readable_with_size(path, &fsz) == _FALSE) -+ return _FALSE; -+ -+ if (fsz > sz) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+/* -+* 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 -+} -+ -+#if !defined(CONFIG_RTW_ANDROID_GKI) -+/* -+* 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 -+} -+#endif /* !defined(CONFIG_RTW_ANDROID_GKI) */ -+ -+#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; -+} -+ -+#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, const 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; -+} -+ -+#ifdef CONFIG_RTW_MESH -+int rtw_blacklist_add(_queue *blist, const u8 *addr, u32 timeout_ms) -+{ -+ struct blacklist_ent *ent; -+ _list *list, *head; -+ u8 exist = _FALSE, timeout = _FALSE; -+ -+ enter_critical_bh(&blist->lock); -+ -+ head = &blist->queue; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ ent = LIST_CONTAINOR(list, struct blacklist_ent, list); -+ list = get_next(list); -+ -+ if (_rtw_memcmp(ent->addr, addr, ETH_ALEN) == _TRUE) { -+ exist = _TRUE; -+ if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) -+ timeout = _TRUE; -+ ent->exp_time = rtw_get_current_time() -+ + rtw_ms_to_systime(timeout_ms); -+ break; -+ } -+ -+ if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) { -+ rtw_list_delete(&ent->list); -+ rtw_mfree(ent, sizeof(struct blacklist_ent)); -+ } -+ } -+ -+ if (exist == _FALSE) { -+ ent = rtw_malloc(sizeof(struct blacklist_ent)); -+ if (ent) { -+ _rtw_memcpy(ent->addr, addr, ETH_ALEN); -+ ent->exp_time = rtw_get_current_time() -+ + rtw_ms_to_systime(timeout_ms); -+ rtw_list_insert_tail(&ent->list, head); -+ } -+ } -+ -+ exit_critical_bh(&blist->lock); -+ -+ return (exist == _TRUE && timeout == _FALSE) ? RTW_ALREADY : (ent ? _SUCCESS : _FAIL); -+} -+ -+int rtw_blacklist_del(_queue *blist, const u8 *addr) -+{ -+ struct blacklist_ent *ent = NULL; -+ _list *list, *head; -+ u8 exist = _FALSE; -+ -+ enter_critical_bh(&blist->lock); -+ head = &blist->queue; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ ent = LIST_CONTAINOR(list, struct blacklist_ent, list); -+ list = get_next(list); -+ -+ if (_rtw_memcmp(ent->addr, addr, ETH_ALEN) == _TRUE) { -+ rtw_list_delete(&ent->list); -+ rtw_mfree(ent, sizeof(struct blacklist_ent)); -+ exist = _TRUE; -+ break; -+ } -+ -+ if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) { -+ rtw_list_delete(&ent->list); -+ rtw_mfree(ent, sizeof(struct blacklist_ent)); -+ } -+ } -+ -+ exit_critical_bh(&blist->lock); -+ -+ return exist == _TRUE ? _SUCCESS : RTW_ALREADY; -+} -+ -+int rtw_blacklist_search(_queue *blist, const u8 *addr) -+{ -+ struct blacklist_ent *ent = NULL; -+ _list *list, *head; -+ u8 exist = _FALSE; -+ -+ enter_critical_bh(&blist->lock); -+ head = &blist->queue; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ ent = LIST_CONTAINOR(list, struct blacklist_ent, list); -+ list = get_next(list); -+ -+ if (_rtw_memcmp(ent->addr, addr, ETH_ALEN) == _TRUE) { -+ if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) { -+ rtw_list_delete(&ent->list); -+ rtw_mfree(ent, sizeof(struct blacklist_ent)); -+ } else -+ exist = _TRUE; -+ break; -+ } -+ -+ if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) { -+ rtw_list_delete(&ent->list); -+ rtw_mfree(ent, sizeof(struct blacklist_ent)); -+ } -+ } -+ -+ exit_critical_bh(&blist->lock); -+ -+ return exist; -+} -+ -+void rtw_blacklist_flush(_queue *blist) -+{ -+ struct blacklist_ent *ent; -+ _list *list, *head; -+ _list tmp; -+ -+ _rtw_init_listhead(&tmp); -+ -+ enter_critical_bh(&blist->lock); -+ rtw_list_splice_init(&blist->queue, &tmp); -+ exit_critical_bh(&blist->lock); -+ -+ head = &tmp; -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ ent = LIST_CONTAINOR(list, struct blacklist_ent, list); -+ list = get_next(list); -+ rtw_list_delete(&ent->list); -+ rtw_mfree(ent, sizeof(struct blacklist_ent)); -+ } -+} -+ -+void dump_blacklist(void *sel, _queue *blist, const char *title) -+{ -+ struct blacklist_ent *ent = NULL; -+ _list *list, *head; -+ -+ enter_critical_bh(&blist->lock); -+ head = &blist->queue; -+ list = get_next(head); -+ -+ if (rtw_end_of_queue_search(head, list) == _FALSE) { -+ if (title) -+ RTW_PRINT_SEL(sel, "%s:\n", title); -+ -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ ent = LIST_CONTAINOR(list, struct blacklist_ent, list); -+ list = get_next(list); -+ -+ if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) -+ RTW_PRINT_SEL(sel, MAC_FMT" expired\n", MAC_ARG(ent->addr)); -+ else -+ RTW_PRINT_SEL(sel, MAC_FMT" %u\n", MAC_ARG(ent->addr) -+ , rtw_get_remaining_time_ms(ent->exp_time)); -+ } -+ -+ } -+ exit_critical_bh(&blist->lock); -+} -+#endif -+ -+/** -+* 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; -+} -+ -+inline BOOLEAN is_all_null(char *c, int len) -+{ -+ for (; len > 0; len--) -+ if (c[len - 1] != '\0') -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+/** -+* 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; -+} -+ -+/** -+* is_decimal - -+* -+* Return TRUE if chTmp is represent for decimal digit -+* FALSE otherwise. -+*/ -+inline BOOLEAN is_decimal(char chTmp) -+{ -+ if ((chTmp >= '0' && chTmp <= '9')) -+ 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; -+} -+ -+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; -+} -+ -+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; -+} -+ -+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; -+} -+ -+/** -+ * 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) -+ */ -+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; -+} -+ -diff --git a/drivers/net/wireless/rtl8821cs/platform/custom_country_chplan.h b/drivers/net/wireless/rtl8821cs/platform/custom_country_chplan.h -new file mode 100644 -index 000000000..69ab5d5ba ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/custom_country_chplan.h -@@ -0,0 +1,22 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *****************************************************************************/ -+ -+#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", 0x76, 0x00, DEF , 1, 1), /* Taiwan */ -+}; -+ -diff --git a/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUN50IW1P1_sdio.c b/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUN50IW1P1_sdio.c -new file mode 100644 -index 000000000..2586455de ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUN50IW1P1_sdio.c -@@ -0,0 +1,86 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUNnI_sdio.c b/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUNnI_sdio.c -new file mode 100644 -index 000000000..8a52aa90c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUNnI_sdio.c -@@ -0,0 +1,130 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUNxI_sdio.c b/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUNxI_sdio.c -new file mode 100644 -index 000000000..795b7e7f7 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUNxI_sdio.c -@@ -0,0 +1,90 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+#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 --git a/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUNxI_usb.c b/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUNxI_usb.c -new file mode 100644 -index 000000000..9c2abc4f6 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_ARM_SUNxI_usb.c -@@ -0,0 +1,136 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/platform/platform_ARM_WMT_sdio.c b/drivers/net/wireless/rtl8821cs/platform/platform_ARM_WMT_sdio.c -new file mode 100644 -index 000000000..d85002c15 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_ARM_WMT_sdio.c -@@ -0,0 +1,46 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+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 --git a/drivers/net/wireless/rtl8821cs/platform/platform_RTK_DMP_usb.c b/drivers/net/wireless/rtl8821cs/platform/platform_RTK_DMP_usb.c -new file mode 100644 -index 000000000..cb740b2ee ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_RTK_DMP_usb.c -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+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 --git a/drivers/net/wireless/rtl8821cs/platform/platform_aml_s905_sdio.c b/drivers/net/wireless/rtl8821cs/platform/platform_aml_s905_sdio.c -new file mode 100644 -index 000000000..334ca03c9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_aml_s905_sdio.c -@@ -0,0 +1,54 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2018 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 /* pr_info(() */ -+#include /* msleep() */ -+#include "platform_aml_s905_sdio.h" /* sdio_reinit() and etc */ -+ -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) -+ ret = wifi_setup_dt(); -+ if (ret) { -+ pr_err("%s: setup dt failed!!(%d)\n", __func__, ret); -+ return -1; -+ } -+#endif /* kernel < 3.14.0 */ -+ -+#if 0 /* Seems redundancy? Already done before insert driver */ -+ pr_info("######%s:\n", __func__); -+ extern_wifi_set_enable(0); -+ msleep(500); -+ extern_wifi_set_enable(1); -+ msleep(500); -+ sdio_reinit(); -+#endif -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) -+ wifi_teardown_dt(); -+#endif /* kernel < 3.14.0 */ -+} -diff --git a/drivers/net/wireless/rtl8821cs/platform/platform_aml_s905_sdio.h b/drivers/net/wireless/rtl8821cs/platform/platform_aml_s905_sdio.h -new file mode 100644 -index 000000000..2b87576dd ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_aml_s905_sdio.h -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2018 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __PLATFORM_AML_S905_SDIO_H__ -+#define __PLATFORM_AML_S905_SDIO_H__ -+ -+#include /* Linux vresion */ -+ -+extern void sdio_reinit(void); -+extern void extern_wifi_set_enable(int is_on); -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) -+extern void wifi_teardown_dt(void); -+extern int wifi_setup_dt(void); -+#endif /* kernel < 3.14.0 */ -+ -+#endif /* __PLATFORM_AML_S905_SDIO_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/platform/platform_arm_act_sdio.c b/drivers/net/wireless/rtl8821cs/platform/platform_arm_act_sdio.c -new file mode 100644 -index 000000000..ad7b6cfed ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_arm_act_sdio.c -@@ -0,0 +1,53 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/platform/platform_hisilicon_hi3798_sdio.c b/drivers/net/wireless/rtl8821cs/platform/platform_hisilicon_hi3798_sdio.c -new file mode 100644 -index 000000000..11a08320e ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_hisilicon_hi3798_sdio.c -@@ -0,0 +1,110 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2018 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 /* mdelay() */ -+#include /* __io_address(), readl(), writel() */ -+#include "platform_hisilicon_hi3798_sdio.h" /* HI_S32() and etc. */ -+ -+typedef enum hi_GPIO_DIR_E { -+ HI_DIR_OUT = 0, -+ HI_DIR_IN = 1, -+} HI_GPIO_DIR_E; -+ -+#define RTL_REG_ON_GPIO (4*8 + 3) -+ -+#define REG_BASE_CTRL __io_address(0xf8a20008) -+ -+int gpio_wlan_reg_on = RTL_REG_ON_GPIO; -+#if 0 -+module_param(gpio_wlan_reg_on, uint, 0644); -+MODULE_PARM_DESC(gpio_wlan_reg_on, "wlan reg_on gpio num (default:gpio4_3)"); -+#endif -+ -+static int hi_gpio_set_value(u32 gpio, u32 value) -+{ -+ HI_S32 s32Status; -+ -+ s32Status = HI_DRV_GPIO_SetDirBit(gpio, HI_DIR_OUT); -+ if (s32Status != HI_SUCCESS) { -+ pr_err("gpio(%d) HI_DRV_GPIO_SetDirBit HI_DIR_OUT failed\n", -+ gpio); -+ return -1; -+ } -+ -+ s32Status = HI_DRV_GPIO_WriteBit(gpio, value); -+ if (s32Status != HI_SUCCESS) { -+ pr_err("gpio(%d) HI_DRV_GPIO_WriteBit value(%d) failed\n", -+ gpio, value); -+ return -1; -+ } -+ -+ return 0; -+} -+ -+static int hisi_wlan_set_carddetect(bool present) -+{ -+ u32 regval; -+ u32 mask; -+ -+ -+#ifndef CONFIG_HISI_SDIO_ID -+ return; -+#endif -+ pr_info("SDIO ID=%d\n", CONFIG_HISI_SDIO_ID); -+#if (CONFIG_HISI_SDIO_ID == 1) -+ mask = 1; -+#elif (CONFIG_HISI_SDIO_ID == 0) -+ mask = 2; -+#endif -+ -+ regval = readl(REG_BASE_CTRL); -+ if (present) { -+ pr_info("====== Card detection to detect SDIO card! ======\n"); -+ /* set card_detect low to detect card */ -+ regval |= mask; -+ } else { -+ pr_info("====== Card detection to remove SDIO card! ======\n"); -+ /* set card_detect high to remove card */ -+ regval &= ~(mask); -+ } -+ writel(regval, REG_BASE_CTRL); -+ -+ return 0; -+} -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+ -+ hi_gpio_set_value(gpio_wlan_reg_on, 1); -+ mdelay(100); -+ hisi_wlan_set_carddetect(1); -+ mdelay(2000); -+ pr_info("======== set_carddetect delay 2s! ========\n"); -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+ hisi_wlan_set_carddetect(0); -+ mdelay(100); -+ hi_gpio_set_value(gpio_wlan_reg_on, 0); -+} -diff --git a/drivers/net/wireless/rtl8821cs/platform/platform_hisilicon_hi3798_sdio.h b/drivers/net/wireless/rtl8821cs/platform/platform_hisilicon_hi3798_sdio.h -new file mode 100644 -index 000000000..1ad42406f ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_hisilicon_hi3798_sdio.h -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2017 - 2018 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __PLATFORM_HISILICON_HI3798_SDIO_H__ -+#define __PLATFORM_HISILICON_HI3798_SDIO_H__ -+ -+typedef unsigned int HI_U32; -+ -+typedef int HI_S32; -+ -+#define HI_SUCCESS 0 -+#define HI_FAILURE (-1) -+ -+extern HI_S32 HI_DRV_GPIO_SetDirBit(HI_U32 u32GpioNo, HI_U32 u32DirBit); -+extern HI_S32 HI_DRV_GPIO_WriteBit(HI_U32 u32GpioNo, HI_U32 u32BitValue); -+ -+#endif /* __PLATFORM_HISILICON_HI3798_SDIO_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/platform/platform_ops.c b/drivers/net/wireless/rtl8821cs/platform/platform_ops.c -new file mode 100644 -index 000000000..10766aad8 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_ops.c -@@ -0,0 +1,32 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 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 --git a/drivers/net/wireless/rtl8821cs/platform/platform_ops.h b/drivers/net/wireless/rtl8821cs/platform/platform_ops.h -new file mode 100644 -index 000000000..12caf3c85 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_ops.h -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __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 --git a/drivers/net/wireless/rtl8821cs/platform/platform_sprd_sdio.c b/drivers/net/wireless/rtl8821cs/platform/platform_sprd_sdio.c -new file mode 100644 -index 000000000..34061d05d ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_sprd_sdio.c -@@ -0,0 +1,84 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 - 2017 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 -+ -+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/drivers/net/wireless/rtl8821cs/platform/platform_zte_zx296716_sdio.c b/drivers/net/wireless/rtl8821cs/platform/platform_zte_zx296716_sdio.c -new file mode 100644 -index 000000000..472d24d85 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_zte_zx296716_sdio.c -@@ -0,0 +1,53 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2018 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 /* pr_info(() */ -+#include /* msleep() */ -+#include "platform_zte_zx296716_sdio.h" /* sdio_reinit() and etc */ -+ -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+ pr_info("######%s: disable--1--\n", __func__); -+ extern_wifi_set_enable(0); -+ /*msleep(500);*/ /* add in function:extern_wifi_set_enable */ -+ pr_info("######%s: enable--2---\n", __func__); -+ extern_wifi_set_enable(1); -+ /*msleep(500);*/ -+ sdio_reinit(); -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+ int card_val; -+ -+ pr_info("######%s:\n", __func__); -+#ifdef CONFIG_A16T03_BOARD -+ card_val = sdio_host_is_null(); -+ if (card_val) -+ remove_card(); -+#endif /* CONFIG_A16T03_BOARD */ -+ extern_wifi_set_enable(0); -+ -+ /*msleep(500);*/ -+} -diff --git a/drivers/net/wireless/rtl8821cs/platform/platform_zte_zx296716_sdio.h b/drivers/net/wireless/rtl8821cs/platform/platform_zte_zx296716_sdio.h -new file mode 100644 -index 000000000..3a4fba1a5 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/platform/platform_zte_zx296716_sdio.h -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 - 2018 Realtek Corporation. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * 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 __PLATFORM_ZTE_ZX296716_SDIO_H__ -+#define __PLATFORM_ZTE_ZX296716_SDIO_H__ -+ -+extern void sdio_reinit(void); -+extern void extern_wifi_set_enable(int val); -+#ifdef CONFIG_A16T03_BOARD -+extern int sdio_host_is_null(void); -+extern void remove_card(void); -+#endif /* CONFIG_A16T03_BOARD */ -+ -+#endif /* __PLATFORM_ZTE_ZX296716_SDIO_H__ */ -diff --git a/drivers/net/wireless/rtl8821cs/rtl8821c.mk b/drivers/net/wireless/rtl8821cs/rtl8821c.mk -new file mode 100644 -index 000000000..28e21cdc9 ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/rtl8821c.mk -@@ -0,0 +1,45 @@ -+EXTRA_CFLAGS += -DCONFIG_RTL8821C -+ -+ifeq ($(CONFIG_USB_HCI), y) -+FILE_NAME = 8821cu -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+FILE_NAME = 8821ce -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+FILE_NAME = 8821cs -+endif -+ -+_HAL_INTFS_FILES += hal/rtl8821c/rtl8821c_halinit.o \ -+ hal/rtl8821c/rtl8821c_mac.o \ -+ hal/rtl8821c/rtl8821c_cmd.o \ -+ hal/rtl8821c/rtl8821c_phy.o \ -+ hal/rtl8821c/rtl8821c_dm.o \ -+ hal/rtl8821c/rtl8821c_ops.o \ -+ hal/rtl8821c/hal8821c_fw.o -+ -+_HAL_INTFS_FILES += hal/rtl8821c/$(HCI_NAME)/rtl$(FILE_NAME)_halinit.o \ -+ hal/rtl8821c/$(HCI_NAME)/rtl$(FILE_NAME)_halmac.o \ -+ hal/rtl8821c/$(HCI_NAME)/rtl$(FILE_NAME)_io.o \ -+ hal/rtl8821c/$(HCI_NAME)/rtl$(FILE_NAME)_xmit.o \ -+ hal/rtl8821c/$(HCI_NAME)/rtl$(FILE_NAME)_recv.o \ -+ hal/rtl8821c/$(HCI_NAME)/rtl$(FILE_NAME)_led.o \ -+ hal/rtl8821c/$(HCI_NAME)/rtl$(FILE_NAME)_ops.o -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821C_SDIO.o -+endif -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821C_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821C_PCIE.o -+endif -+ -+include $(src)/halmac.mk -+ -+_BTC_FILES += hal/btc/halbtc8821cwifionly.o -+ifeq ($(CONFIG_BT_COEXIST), y) -+_BTC_FILES += hal/btc/halbtc8821c1ant.o \ -+ hal/btc/halbtc8821c2ant.o -+endif -\ No newline at end of file -diff --git a/drivers/net/wireless/rtl8821cs/runwpa b/drivers/net/wireless/rtl8821cs/runwpa -new file mode 100644 -index 000000000..f825e8bdb ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/runwpa -@@ -0,0 +1,20 @@ -+#!/bin/bash -+ -+if [ "`which iwconfig`" = "" ] ; then -+ echo "WARNING:Wireless tool not exist!" -+ echo " Please install it!" -+ exit -+else -+ if [ `uname -r | cut -d. -f2` -eq 4 ]; then -+ wpa_supplicant -D ipw -c wpa1.conf -i wlan0 -+ else -+ if [ `iwconfig -v |awk '{print $4}' | head -n 1` -lt 18 ] ; then -+ wpa_supplicant -D ipw -c wpa1.conf -i wlan0 -+ else -+ wpa_supplicant -D wext -c wpa1.conf -i wlan0 -+ fi -+ -+ fi -+fi -+ -+ -diff --git a/drivers/net/wireless/rtl8821cs/wlan0dhcp b/drivers/net/wireless/rtl8821cs/wlan0dhcp -new file mode 100644 -index 000000000..60433829c ---- /dev/null -+++ b/drivers/net/wireless/rtl8821cs/wlan0dhcp -@@ -0,0 +1,16 @@ -+#!/bin/bash -+ -+var0=`ps aux|awk '/dhclient wlan0/'|awk '$11!="awk"{print $2}'` -+ -+kill $var0 -+cp ifcfg-wlan0 /etc/sysconfig/network-scripts/ -+ -+dhclient wlan0 -+ -+var1=`ifconfig wlan0 |awk '/inet/{print $2}'|awk -F: '{print $2}'` -+ -+ -+rm -f /etc/sysconfig/network-scripts/ifcfg-wlan0 -+ -+echo "get ip: $var1" -+ -diff --git a/drivers/pci/hotplug/pciehp.h b/drivers/pci/hotplug/pciehp.h -index f1f789fe0..cd818ea56 100644 ---- a/drivers/pci/hotplug/pciehp.h -+++ b/drivers/pci/hotplug/pciehp.h -@@ -109,6 +109,11 @@ struct controller { - unsigned int ist_running; - int request_result; - wait_queue_head_t requester; -+ -+#ifdef CONFIG_ARCH_PHYTIUM -+ u32 buses; -+ u16 slot_ctrl_t; -+#endif - }; - - /** -diff --git a/drivers/pci/hotplug/pciehp_ctrl.c b/drivers/pci/hotplug/pciehp_ctrl.c -index 32baba1b7..7c6a64c93 100644 ---- a/drivers/pci/hotplug/pciehp_ctrl.c -+++ b/drivers/pci/hotplug/pciehp_ctrl.c -@@ -226,6 +226,11 @@ void pciehp_handle_presence_or_link_change(struct controller *ctrl, u32 events) - { - int present, link_active; - -+#ifdef CONFIG_ARCH_PHYTIUM -+ struct pci_dev *pdev = ctrl->pcie->port; -+ u16 slot_ctrl_val; -+#endif -+ - /* - * If the slot is on and presence or link has changed, turn it off. - * Even if it's occupied again, we cannot assume the card is the same. -@@ -244,6 +249,21 @@ void pciehp_handle_presence_or_link_change(struct controller *ctrl, u32 events) - if (events & PCI_EXP_SLTSTA_PDC) - ctrl_info(ctrl, "Slot(%s): Card not present\n", - slot_name(ctrl)); -+#ifdef CONFIG_ARCH_PHYTIUM -+ if ((ctrl->buses > 0) && (ctrl->slot_ctrl > 0)) { -+ pci_write_config_dword(pdev, PCI_PRIMARY_BUS, ctrl->buses); -+ slot_ctrl_val = ctrl->slot_ctrl_t | PCI_EXP_SLTCTL_ABPE | -+ PCI_EXP_SLTCTL_PFDE | PCI_EXP_SLTCTL_MRLSCE | -+ PCI_EXP_SLTCTL_PDCE | PCI_EXP_SLTCTL_CCIE | -+ PCI_EXP_SLTCTL_HPIE | PCI_EXP_SLTCTL_ATTN_IND_BLINK | -+ PCI_EXP_SLTCTL_PWR_IND_ON | -+ PCI_EXP_SLTCTL_DLLSCE; -+ slot_ctrl_val &= ~PCI_EXP_SLTCTL_PWR_OFF; -+ pcie_capability_write_word(pdev, PCI_EXP_SLTCTL, slot_ctrl_val); -+ ctrl_info(ctrl, "Ctrl buses=0x%x, slot_ctrl=0x%x\n", -+ ctrl->buses, slot_ctrl_val); -+ } -+#endif - pciehp_disable_slot(ctrl, SURPRISE_REMOVAL); - break; - default: -diff --git a/drivers/pci/hotplug/pciehp_hpc.c b/drivers/pci/hotplug/pciehp_hpc.c -index 75c6c72ec..ad7e9ce25 100644 ---- a/drivers/pci/hotplug/pciehp_hpc.c -+++ b/drivers/pci/hotplug/pciehp_hpc.c -@@ -597,7 +597,7 @@ static irqreturn_t pciehp_isr(int irq, void *dev_id) - * in the Slot Control register (PCIe r4.0, sec 6.7.3.4). - */ - if (pdev->current_state == PCI_D3cold || -- (!(ctrl->slot_ctrl & PCI_EXP_SLTCTL_HPIE) && !pciehp_poll_mode)) -+ (!(ctrl->slot_ctrl & PCI_EXP_SLTCTL_HPIE) && !pciehp_poll_mode)) - return IRQ_NONE; - - /* -@@ -695,7 +695,13 @@ static irqreturn_t pciehp_ist(int irq, void *dev_id) - struct controller *ctrl = (struct controller *)dev_id; - struct pci_dev *pdev = ctrl_dev(ctrl); - irqreturn_t ret; -+#ifdef CONFIG_ARCH_PHYTIUM -+ u32 events, buses; -+ u16 slot_ctrl; -+ bool link_active; -+#else - u32 events; -+#endif - - ctrl->ist_running = true; - pci_config_pm_runtime_get(pdev); -@@ -715,6 +721,23 @@ static irqreturn_t pciehp_ist(int irq, void *dev_id) - goto out; - } - -+#ifdef CONFIG_ARCH_PHYTIUM -+ if(ctrl->state == ON_STATE) { -+ pci_read_config_dword(pdev, PCI_PRIMARY_BUS, &buses); -+ pcie_capability_read_word(pdev, PCI_EXP_SLTCTL, &slot_ctrl); -+ ctrl->buses = buses; -+ ctrl->slot_ctrl_t = slot_ctrl; -+ ctrl_dbg(ctrl, "Ctrl buses=0x%x, slot_ctrl=0x%x\n", -+ ctrl->buses, ctrl->slot_ctrl_t); -+ } -+ -+ mdelay(1000); -+ -+ link_active = pciehp_check_link_active(ctrl); -+ if((ctrl->state == ON_STATE) && (link_active == false)) -+ events |= PCI_EXP_SLTSTA_DLLSC; -+#endif -+ - /* Check Attention Button Pressed */ - if (events & PCI_EXP_SLTSTA_ABP) { - ctrl_info(ctrl, "Slot(%s): Attention button pressed\n", -@@ -749,7 +772,6 @@ static irqreturn_t pciehp_ist(int irq, void *dev_id) - else if (events & (PCI_EXP_SLTSTA_PDC | PCI_EXP_SLTSTA_DLLSC)) - pciehp_handle_presence_or_link_change(ctrl, events); - up_read(&ctrl->reset_lock); -- - ret = IRQ_HANDLED; - out: - pci_config_pm_runtime_put(pdev); -diff --git a/drivers/pci/pcie/portdrv.h b/drivers/pci/pcie/portdrv.h -index 2ff5724b8..6ac559346 100644 ---- a/drivers/pci/pcie/portdrv.h -+++ b/drivers/pci/pcie/portdrv.h -@@ -123,6 +123,19 @@ void pcie_port_bus_unregister(void); - - struct pci_dev; - -+#ifdef CONFIG_HOTPLUG_PCI_PCIE -+extern bool pciehp_msi_disabled; -+ -+static inline bool pciehp_no_msi(void) -+{ -+ return pciehp_msi_disabled; -+} -+ -+#else /* !CONFIG_HOTPLUG_PCI_PCIE */ -+static inline bool pciehp_no_msi(void) { return false; } -+#endif /* !CONFIG_HOTPLUG_PCI_PCIE */ -+ -+ - #ifdef CONFIG_PCIE_PME - extern bool pcie_pme_msi_disabled; - -diff --git a/drivers/pci/pcie/portdrv_core.c b/drivers/pci/pcie/portdrv_core.c -index 3779b264d..839e43c55 100644 ---- a/drivers/pci/pcie/portdrv_core.c -+++ b/drivers/pci/pcie/portdrv_core.c -@@ -25,6 +25,17 @@ struct portdrv_service_data { - u32 service; - }; - -+bool pciehp_msi_disabled; -+ -+static int __init pciehp_setup(char *str) -+{ -+ if (!strncmp(str, "nomsi", 5)) -+ pciehp_msi_disabled = true; -+ -+ return 1; -+} -+__setup("pcie_hp=", pciehp_setup); -+ - /** - * release_pcie_device - free PCI Express port service device structure - * @dev: Port service device to release -@@ -177,6 +188,9 @@ static int pcie_init_service_irqs(struct pci_dev *dev, int *irqs, int mask) - if ((mask & PCIE_PORT_SERVICE_PME) && pcie_pme_no_msi()) - goto legacy_irq; - -+ if ((mask & PCIE_PORT_SERVICE_HP) && pciehp_no_msi()) -+ goto legacy_irq; -+ - /* Try to use MSI-X or MSI if supported */ - if (pcie_port_enable_irq_vec(dev, irqs, mask) == 0) - return 0; -diff --git a/drivers/pci/quirks.c b/drivers/pci/quirks.c -index 21661feee..5af216b4e 100644 ---- a/drivers/pci/quirks.c -+++ b/drivers/pci/quirks.c -@@ -30,6 +30,7 @@ - #include - #include - #include /* isa_dma_bridge_buggy */ -+#include - #include "pci.h" - - static ktime_t fixup_debug_start(struct pci_dev *dev, -@@ -3878,12 +3879,12 @@ static int nvme_disable_and_flr(struct pci_dev *dev, int probe) - void __iomem *bar; - u16 cmd; - u32 cfg; -- -+ printk("%s began\n", __func__); - if (dev->class != PCI_CLASS_STORAGE_EXPRESS || - !pcie_has_flr(dev) || !pci_resource_start(dev, 0)) - return -ENOTTY; - -- if (probe) -+ if (probe & !is_kdump_kernel()) - return 0; - - bar = pci_iomap(dev, 0, NVME_REG_CC + sizeof(cfg)); -@@ -3937,7 +3938,7 @@ static int nvme_disable_and_flr(struct pci_dev *dev, int probe) - pci_iounmap(dev, bar); - - pcie_flr(dev); -- -+ printk("%s finished\n", __func__); - return 0; - } - -@@ -4033,6 +4034,7 @@ static const struct pci_dev_reset_methods pci_dev_reset_methods[] = { - { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_IVB_M2_VGA, - reset_ivb_igd }, - { PCI_VENDOR_ID_SAMSUNG, 0xa804, nvme_disable_and_flr }, -+ { PCI_VENDOR_ID_SAMSUNG, 0xa809, nvme_disable_and_flr }, - { PCI_VENDOR_ID_INTEL, 0x0953, delay_250ms_after_flr }, - { PCI_VENDOR_ID_CHELSIO, PCI_ANY_ID, - reset_chelsio_generic_dev }, -@@ -4972,6 +4974,10 @@ static const struct pci_dev_acs_enabled { - { PCI_VENDOR_ID_ZHAOXIN, PCI_ANY_ID, pci_quirk_zhaoxin_pcie_ports_acs }, - /* Wangxun nics */ - { PCI_VENDOR_ID_WANGXUN, PCI_ANY_ID, pci_quirk_wangxun_nic_acs }, -+ /* Phytium Technology */ -+ { 0x10b5, PCI_ANY_ID, pci_quirk_xgene_acs }, -+ { 0x17cd, PCI_ANY_ID, pci_quirk_xgene_acs }, -+ { 0x1db7, PCI_ANY_ID, pci_quirk_xgene_acs }, - { 0 } - }; - -@@ -5355,6 +5361,7 @@ DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0142, quirk_no_ext_tags); - DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0144, quirk_no_ext_tags); - DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0420, quirk_no_ext_tags); - DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0422, quirk_no_ext_tags); -+DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_PHYTIUM, 0xdc3a, quirk_no_ext_tags); - - #ifdef CONFIG_PCI_ATS - static void quirk_no_ats(struct pci_dev *pdev) -diff --git a/drivers/pwm/Kconfig b/drivers/pwm/Kconfig -index 63be5362f..90c428634 100644 ---- a/drivers/pwm/Kconfig -+++ b/drivers/pwm/Kconfig -@@ -570,4 +570,14 @@ config PWM_ZX - To compile this driver as a module, choose M here: the module - will be called pwm-zx. - -+config PWM_PHYTIUM -+ tristate "Phytium PWM support" -+ depends on ARCH_PHYTIUM -+ help -+ Generic PWM framework driver for the PWM controller found on -+ Phytium SoCs. -+ -+ To compile this driver as a module, choose M here: the module -+ will be called pwm-phytium. -+ - endif -diff --git a/drivers/pwm/Makefile b/drivers/pwm/Makefile -index cbdcd55d6..32efa3652 100644 ---- a/drivers/pwm/Makefile -+++ b/drivers/pwm/Makefile -@@ -55,3 +55,5 @@ obj-$(CONFIG_PWM_TWL) += pwm-twl.o - obj-$(CONFIG_PWM_TWL_LED) += pwm-twl-led.o - obj-$(CONFIG_PWM_VT8500) += pwm-vt8500.o - obj-$(CONFIG_PWM_ZX) += pwm-zx.o -+ -+obj-$(CONFIG_PWM_PHYTIUM) += pwm-phytium.o -diff --git a/drivers/pwm/pwm-phytium.c b/drivers/pwm/pwm-phytium.c -new file mode 100644 -index 000000000..1eaf29295 ---- /dev/null -+++ b/drivers/pwm/pwm-phytium.c -@@ -0,0 +1,568 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium PWM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define REG_TCNT 0x00 -+#define REG_TCTRL 0x04 -+#define REG_STAT 0x08 -+ -+#define REG_TPERIOD 0x0c -+#define REG_PWMCTRL 0x10 -+#define REG_PWMCCR 0x14 -+ -+#define TCTRL_DIV_MASK 0x1ff8 -+#define TCTRL_PWMMOD_MASK 0x4 -+#define TCTRL_CAPMOD_MASK 0x3 -+#define PWM_PERIOD_MASK 0xffff -+#define PWM_DUTY_MASK 0xffff -+#define PWM_MODE_MASK 0x4 -+#define PWM_CTRL_INIT 0xc4 -+ -+#define PWM_NUM 2 -+ -+#define REG_DBCTRL 0x00 -+#define REG_DBCLY 0x04 -+#define PWM_UPDBCLY_MASK 0x3ff -+#define PWM_DWDBCLY_MASK 0xffc00 -+#define PWM_DB_POLARITY_MASK 0xc -+ -+#define PWM_N(x) ((0x400)*(x)) -+#define MAX_PARAMETER 2 -+ -+struct phytium_pwm_state { -+ int rst; -+ int cntmod; -+ int dutymod; -+ unsigned int div; -+ int db_rst; -+ unsigned int updbcly; -+ unsigned int dwdbcly; -+ unsigned int dbpolarity; -+}; -+ -+struct phytium_pwm_param { -+ int cntmod; -+ int dutymod; -+ unsigned int div; -+ unsigned int updbcly; -+ unsigned int dwdbcly; -+ unsigned int dbpolarity; -+}; -+ -+struct phytium_pwm_variant { -+ u8 rst_mask; -+ u8 div; -+ int counter_mode; -+ int periodns; -+ int duty_ns; -+ int pwm_mode; -+ u8 duty_mode; -+ int updbcly; -+ int dwdbcly; -+}; -+ -+struct phytium_pwm_channel { -+ u32 period_ns; -+ u32 duty_ns; -+ u32 tin_ns; -+}; -+ -+struct phytium_pwm_chip { -+ struct pwm_chip chip; -+ struct pwm_state state_pm[PWM_NUM]; -+ struct phytium_pwm_variant variant; -+ struct phytium_pwm_state state; -+ u8 inverter_mask; -+ u8 disabled_mask; -+ int db_init; -+ void __iomem *base; -+ void __iomem *base1; -+ struct phytium_pwm_param parameter[MAX_PARAMETER]; -+ unsigned int num_parameters; -+ -+ unsigned long clk_rate; -+ struct clk *base_clk; -+}; -+ -+static inline struct phytium_pwm_chip *to_phytium_pwm_chip(struct pwm_chip *chip) -+{ -+ return container_of(chip, struct phytium_pwm_chip, chip); -+} -+ -+ -+static void pwm_phytium_free(struct pwm_chip *chip, struct pwm_device *pwm) -+{ -+ devm_kfree(chip->dev, pwm_get_chip_data(pwm)); -+ pwm_set_chip_data(pwm, NULL); -+} -+ -+static int pwm_phytium_enable(struct pwm_chip *chip, struct pwm_device *pwm, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); -+ reg |= 0x2; -+ our_chip->state_pm[n].enabled = 1; -+ writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); -+ -+ return 0; -+} -+ -+static void pwm_phytium_disable(struct pwm_chip *chip, struct pwm_device *pwm, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); -+ reg &= 0xfffffffd; -+ our_chip->state_pm[n].enabled = 0; -+ writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); -+} -+ -+static void pwm_phytium_dutymod(struct pwm_chip *chip, int dutymod, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_PWMCTRL); -+ -+ if (dutymod == 0) -+ reg &= 0xfffffeff; -+ else if (dutymod == 1) -+ reg |= 0x100; -+ -+ writel(reg, our_chip->base + PWM_N(n) + REG_PWMCTRL); -+} -+ -+static void pwm_phytium_set_div(struct pwm_chip *chip, unsigned int div, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); -+ reg &= 0xffff; -+ reg |= (div<<16); -+ writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); -+} -+ -+static void pwm_phytium_set_tmode(struct pwm_chip *chip, int tmode, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); -+ if (tmode == 0) -+ reg &= 0xfffffffb; -+ else if (tmode == 1) -+ reg |= 0x4; -+ -+ writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); -+} -+ -+static void pwm_phytium_set_periodns(struct pwm_chip *chip, unsigned int periodns, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ int div = our_chip->state.div; -+ u64 cycles; -+ -+ cycles = our_chip->clk_rate; -+ cycles *= (periodns / (div + 1)); -+ do_div(cycles, NSEC_PER_SEC); -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_TPERIOD); -+ cycles = (cycles & PWM_PERIOD_MASK) - 0x1; -+ our_chip->state_pm[n].period = cycles; -+ -+ writel(cycles, our_chip->base + PWM_N(n) + REG_TPERIOD); -+} -+ -+static void pwm_phytium_set_duty(struct pwm_chip *chip, unsigned int duty, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ int div = our_chip->state.div; -+ u64 cycles; -+ -+ cycles = our_chip->clk_rate; -+ cycles *= (duty / (div + 1)); -+ do_div(cycles, NSEC_PER_SEC); -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_PWMCCR); -+ cycles = (cycles & PWM_DUTY_MASK) - 0x1; -+ our_chip->state_pm[n].duty_cycle = cycles; -+ -+ writel(cycles, our_chip->base + PWM_N(n) + REG_PWMCCR); -+} -+ -+static int pwm_phytium_set_dbcly(struct pwm_chip *chip, unsigned int updbcly, unsigned int dwdbcly) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ u64 dbcly, cycles, upcycles, dwcycles; -+ -+ reg = readl(our_chip->base + REG_TPERIOD); -+ cycles = our_chip->clk_rate; -+ dbcly &= 0x0; -+ if (updbcly) { -+ upcycles = cycles * updbcly; -+ do_div(upcycles, NSEC_PER_SEC); -+ -+ if (upcycles < reg) -+ dbcly |= (upcycles & PWM_UPDBCLY_MASK); -+ else -+ return -EINVAL; -+ } -+ -+ if (dwdbcly) { -+ dwcycles = cycles * dwdbcly; -+ do_div(dwcycles, NSEC_PER_SEC); -+ -+ if (dwcycles < reg) -+ dbcly |= ((dwcycles << 10) & PWM_DWDBCLY_MASK); -+ else -+ return -EINVAL; -+ } -+ -+ writel(dbcly, our_chip->base1 + REG_DBCLY); -+ -+ reg = readl(our_chip->base1 + REG_DBCTRL); -+ reg |= 0x30; -+ writel(reg, our_chip->base1 + REG_DBCTRL); -+ -+ return 0; -+} -+ -+static void pwm_phytium_set_dbpolarity(struct pwm_chip *chip, unsigned int db_polarity) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base1 + REG_DBCTRL); -+ reg &= 0x33; -+ reg |= ((db_polarity<<2) & PWM_DB_POLARITY_MASK); -+ writel(reg, our_chip->base1 + REG_DBCTRL); -+} -+ -+static int pwm_phytium_init(struct pwm_chip *chip, struct pwm_device *pwm, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ -+ writel(PWM_CTRL_INIT, our_chip->base + PWM_N(n) + REG_PWMCTRL); -+ -+ pwm_phytium_dutymod(chip, our_chip->state.dutymod, n); -+ pwm_phytium_set_div(chip, our_chip->state.div, n); -+ pwm_phytium_set_tmode(chip, our_chip->state.cntmod, n); -+ -+ return 0; -+} -+ -+static int pwm_phytium_db_init(struct pwm_chip *chip, struct pwm_device *pwm) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ -+ pwm_phytium_set_dbcly(chip, our_chip->state.updbcly, our_chip->state.dwdbcly); -+ pwm_phytium_set_dbpolarity(chip, our_chip->state.dbpolarity); -+ -+ return 0; -+} -+ -+static int __pwm_phytium_config(struct pwm_chip *chip, struct pwm_device *pwm) -+{ -+ pwm_phytium_init(chip, pwm, 0); -+ pwm_phytium_init(chip, pwm, 1); -+ return 0; -+} -+ -+static int pwm_phytium_set_polarity(struct pwm_chip *chip, enum pwm_polarity polarity, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 value; -+ -+ value = readl(our_chip->base + PWM_N(n) + REG_PWMCTRL); -+ -+ if (polarity == PWM_POLARITY_INVERSED) { -+ value &= 0xffffff0f; -+ value |= 0x30; -+ } else if (polarity == PWM_POLARITY_NORMAL) { -+ value &= 0xffffff0f; -+ value |= 0x40; -+ } -+ -+ our_chip->state_pm[n].polarity = polarity; -+ writel(value, our_chip->base + PWM_N(n) + REG_PWMCTRL); -+ -+ return 0; -+} -+ -+static int pwm_phytium_apply(struct pwm_chip *chip, struct pwm_device *pwm, -+ const struct pwm_state *state) -+{ -+ struct phytium_pwm_chip *phytium_pwm = to_phytium_pwm_chip(chip); -+ struct pwm_state cstate; -+ u32 reg; -+ int n; -+ -+ pwm_get_state(pwm, &cstate); -+ -+ n = pwm->hwpwm & BIT(0); -+ -+ if ((state->polarity != cstate.polarity) && !state->enabled) -+ pwm_phytium_set_polarity(chip, state->polarity, n); -+ -+ if (state->enabled && !cstate.enabled) -+ pwm_phytium_enable(chip, pwm, n); -+ -+ if (!state->enabled && cstate.enabled) -+ pwm_phytium_disable(chip, pwm, n); -+ -+ if (state->period != cstate.period) { -+ pwm_phytium_set_periodns(chip, state->period, n); -+ if ((phytium_pwm->db_init == 1) && (n == 0)) -+ pwm_phytium_db_init(chip, pwm); -+ } -+ -+ if (state->duty_cycle != cstate.duty_cycle) { -+ if (phytium_pwm->state.dutymod == true) { -+ reg = readl(phytium_pwm->base + PWM_N(n) + REG_STAT); -+ if ((reg & 0x8) != 0x8) -+ pwm_phytium_set_duty(chip, state->duty_cycle, n); -+ } else { -+ pwm_phytium_set_duty(chip, state->duty_cycle, n); -+ } -+ } -+ -+ return 0; -+} -+ -+static int pwm_phytium_request(struct pwm_chip *chip, struct pwm_device *pwm) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ struct phytium_pwm_channel *our_chan; -+ -+ our_chan = devm_kzalloc(chip->dev, sizeof(*our_chan), GFP_KERNEL); -+ if (!our_chan) -+ return -ENOMEM; -+ -+ pwm_set_chip_data(pwm, our_chan); -+ __pwm_phytium_config(&our_chip->chip, our_chip->chip.pwms); -+ -+ return 0; -+} -+ -+static const struct pwm_ops pwm_phytium_ops = { -+ .request = pwm_phytium_request, -+ .free = pwm_phytium_free, -+ .apply = pwm_phytium_apply, -+ .owner = THIS_MODULE, -+}; -+ -+static int phytium_pwm_set_parameter(struct phytium_pwm_chip *priv) -+{ -+ unsigned int i; -+ -+ for (i = 0; i < priv->num_parameters; i++) { -+ if (priv->parameter[i].updbcly > 0 || priv->parameter[i].dwdbcly > 0) { -+ priv->db_init = 1; -+ priv->state.db_rst = 1; -+ } -+ -+ priv->state.cntmod = priv->parameter[i].cntmod; -+ priv->state.dutymod = priv->parameter[i].dutymod; -+ priv->state.div = priv->parameter[i].div; -+ priv->state.updbcly = priv->parameter[i].updbcly; -+ priv->state.dwdbcly = priv->parameter[i].dwdbcly; -+ priv->state.dbpolarity = priv->parameter[i].dbpolarity; -+ } -+ priv->state.rst = 1; -+ -+ return 0; -+} -+ -+static int pwm_phytium_probe_parameter(struct phytium_pwm_chip *priv, -+ struct fwnode_handle *np) -+{ -+ int nb, ret, array_size; -+ unsigned int i; -+ -+ array_size = fwnode_property_read_u32_array(np, "phytium,db", NULL, 0); -+ nb = array_size / (sizeof(struct phytium_pwm_param) / sizeof(u32)); -+ if (nb <= 0 || nb > MAX_PARAMETER) -+ return -EINVAL; -+ -+ priv->num_parameters = nb; -+ ret = fwnode_property_read_u32_array(np, "phytium,db", -+ (u32 *)priv->parameter, array_size); -+ if (ret) -+ return ret; -+ -+ for (i = 0; i < priv->num_parameters; i++) { -+ if (priv->parameter[i].cntmod > 1 || -+ priv->parameter[i].dutymod > 1 || -+ priv->parameter[i].div > 4096 || -+ priv->parameter[i].dbpolarity > 3) -+ return -EINVAL; -+ } -+ -+ return phytium_pwm_set_parameter(priv); -+} -+static int pwm_phytium_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct fwnode_handle *np = dev_fwnode(dev); -+ struct phytium_pwm_chip *chip; -+ struct resource *res; -+ int ret; -+ -+ chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); -+ -+ if (chip == NULL) -+ return -ENOMEM; -+ -+ chip->chip.dev = &pdev->dev; -+ chip->chip.ops = &pwm_phytium_ops; -+ chip->chip.base = -1; -+ chip->chip.npwm = PWM_NUM; -+ chip->inverter_mask = BIT(PWM_NUM) - 1; -+ -+ if (dev->of_node) { -+ chip->chip.of_xlate = of_pwm_xlate_with_flags; -+ chip->chip.of_pwm_n_cells = 3; -+ } -+ ret = pwm_phytium_probe_parameter(chip, np); -+ if (ret) { -+ dev_err(dev, "failed to set parameter\n"); -+ return ret; -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ chip->base1 = devm_ioremap_resource(&pdev->dev, res); -+ chip->base = (chip->base1 + 0x400); -+ -+ if (IS_ERR(chip->base)) { -+ dev_err(dev, "failed to get base_addr\n"); -+ return PTR_ERR(chip->base); -+ } -+ if (dev->of_node) { -+ chip->base_clk = devm_clk_get(&pdev->dev, NULL); -+ if (IS_ERR(chip->base_clk)) { -+ dev_err(dev, "failed to get clk\n"); -+ return PTR_ERR(chip->base_clk); -+ } -+ -+ ret = clk_prepare_enable(chip->base_clk); -+ if (ret < 0) { -+ dev_err(dev, "failed to enable clk\n"); -+ return ret; -+ } -+ chip->clk_rate = clk_get_rate(chip->base_clk); -+ } else if (has_acpi_companion(dev)){ -+ if(fwnode_property_read_u32(dev_fwnode(dev),"clock-frequency", (u32 *)&(chip->clk_rate) ) <0) -+ chip->clk_rate = 50000000; -+ } -+ platform_set_drvdata(pdev, chip); -+ -+ ret = pwmchip_add(&chip->chip); -+ -+ if (ret < 0) { -+ dev_err(dev, "failed to register PWM chip\n"); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static int pwm_phytium_remove(struct platform_device *pdev) -+{ -+ struct phytium_pwm_chip *chip = platform_get_drvdata(pdev); -+ -+ pwmchip_remove(&chip->chip); -+ -+ clk_disable_unprepare(chip->base_clk); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int pwm_phytium_pm_init(struct phytium_pwm_chip *priv) -+{ -+ int i; -+ -+ __pwm_phytium_config(&priv->chip, priv->chip.pwms); -+ for (i = 0; i < priv->chip.npwm; i++) { -+ writel(priv->state_pm[i].period, priv->base + PWM_N(i) + REG_TPERIOD); -+ if ((priv->db_init == 1) && (i == 0)) -+ pwm_phytium_db_init(&priv->chip, priv->chip.pwms); -+ writel(priv->state_pm[i].duty_cycle, priv->base + PWM_N(i) + REG_PWMCTRL); -+ pwm_phytium_set_polarity(&priv->chip, priv->state_pm[i].polarity, i); -+ if (priv->state_pm[i].enabled) -+ pwm_phytium_enable(&priv->chip, priv->chip.pwms, i); -+ } -+ -+ return 0; -+} -+ -+static int pwm_phytium_suspend(struct device *dev) -+{ -+ return 0; -+} -+ -+static int pwm_phytium_resume(struct device *dev) -+{ -+ struct phytium_pwm_chip *priv = dev_get_drvdata(dev); -+ -+ pwm_phytium_pm_init(priv); -+ return 0; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_pwm_dev_pm_ops, pwm_phytium_suspend, pwm_phytium_resume); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_pwm_acpi_ids[] = { -+ { "PHYT0029", 0 }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_pwm_acpi_ids); -+#endif -+ -+static const struct of_device_id phytium_pwm_matches[] = { -+ { .compatible = "phytium,pwm" }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, phytium_pwm_matches); -+ -+static struct platform_driver pwm_phytium_driver = { -+ .driver = { -+ .name = "phytium-pwm", -+ .pm = &phytium_pwm_dev_pm_ops, -+ .of_match_table = phytium_pwm_matches, -+ .acpi_match_table = ACPI_PTR(phytium_pwm_acpi_ids), -+ }, -+ .probe = pwm_phytium_probe, -+ .remove = pwm_phytium_remove, -+}; -+module_platform_driver(pwm_phytium_driver); -+ -+MODULE_DESCRIPTION("Phytium SoC PWM driver"); -+MODULE_AUTHOR("Yang Liu "); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/pwm/sysfs.c b/drivers/pwm/sysfs.c -index b8417a8d2..5778eb5f5 100644 ---- a/drivers/pwm/sysfs.c -+++ b/drivers/pwm/sysfs.c -@@ -260,7 +260,7 @@ static int pwm_export_child(struct device *parent, struct pwm_device *pwm) - export->child.parent = parent; - export->child.devt = MKDEV(0, 0); - export->child.groups = pwm_groups; -- dev_set_name(&export->child, "pwm%u", pwm->hwpwm); -+ dev_set_name(&export->child, "pwm%u", pwm->pwm); - - ret = device_register(&export->child); - if (ret) { -diff --git a/drivers/remoteproc/Kconfig b/drivers/remoteproc/Kconfig -index d99548fb5..b714bf090 100644 ---- a/drivers/remoteproc/Kconfig -+++ b/drivers/remoteproc/Kconfig -@@ -288,6 +288,12 @@ config TI_K3_R5_REMOTEPROC - It's safe to say N here if you're not interested in utilizing - a slave processor. - -+config HOMO_REMOTEPROC -+ bool "homogeneous remoteproc support" -+ select RPMSG_VIRTIO -+ help -+ Say y here to support homogeneous processors via the remote processor framework. -+ - endif # REMOTEPROC - - endmenu -diff --git a/drivers/remoteproc/Makefile b/drivers/remoteproc/Makefile -index da2ace4ec..9a5540d9a 100644 ---- a/drivers/remoteproc/Makefile -+++ b/drivers/remoteproc/Makefile -@@ -34,3 +34,4 @@ obj-$(CONFIG_ST_SLIM_REMOTEPROC) += st_slim_rproc.o - obj-$(CONFIG_STM32_RPROC) += stm32_rproc.o - obj-$(CONFIG_TI_K3_DSP_REMOTEPROC) += ti_k3_dsp_remoteproc.o - obj-$(CONFIG_TI_K3_R5_REMOTEPROC) += ti_k3_r5_remoteproc.o -+obj-$(CONFIG_HOMO_REMOTEPROC) += homo_remoteproc.o -diff --git a/drivers/remoteproc/homo_remoteproc.c b/drivers/remoteproc/homo_remoteproc.c -new file mode 100644 -index 000000000..71f54cb79 ---- /dev/null -+++ b/drivers/remoteproc/homo_remoteproc.c -@@ -0,0 +1,349 @@ -+/* -+ * Homogeneous Remote Processor Control Driver -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * Author: Shaojun Yang -+ * -+ * This program is free software; you can redistribute it and/or modify it under the terms -+ * of the GNU General Public License version 2 as published by the Free Software Foundation. -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "remoteproc_internal.h" -+ -+#define RPROC_RESOURCE_ENTRIES 8 -+ -+#define PSCI_VERSION 0x84000000 -+#define CPU_SUSPEND 0xc4000001 -+#define CPU_OFF 0x84000002 -+#define CPU_ON 0xc4000003 -+#define AFFINITY_INFO 0xc4000004 -+#define MIGRATE 0xc4000005 -+ -+/* Resource table for the homo remote processors */ -+struct homo_resource_table { -+ unsigned int version; -+ unsigned int num; -+ unsigned int reserved[2]; -+ unsigned int offset[RPROC_RESOURCE_ENTRIES]; -+ -+ /* Note: linux kenrel 'struct fw_rsc_vdev' has no 'type' field, here add to align data structre */ -+ uint32_t type; -+ /* rpmsg vdev entry */ -+ struct fw_rsc_vdev rpmsg_vdev; -+ struct fw_rsc_vdev_vring rpmsg_vring0; -+ struct fw_rsc_vdev_vring rpmsg_vring1; -+}; -+ -+struct homo_rproc { -+ struct rproc *rproc; -+ struct homo_resource_table *rsc; -+ -+ u64 phys_addr; -+ void *addr; -+ u64 size; -+ -+ int irq; -+ int cpu; -+}; -+ -+static int homo_rproc_irq; -+static struct homo_rproc *g_priv; -+static struct work_struct workqueue; -+ -+#define MPIDR_TO_SGI_AFFINITY(cluster_id, level) (MPIDR_AFFINITY_LEVEL(cluster_id, level) << ICC_SGI1R_AFFINITY_## level ## _SHIFT) -+ -+void gicv3_ipi_send_single(int irq, u64 mpidr) -+{ -+ u16 tlist = 0; -+ u64 cluster_id; -+ u64 sgi1r; -+ -+ /* Ensure stores to Normal memory are visible to other CPUs before sending the IPI. */ -+ wmb(); -+ -+ cluster_id = mpidr & ~0xffUL; -+ tlist |= 1 << (mpidr & 0xf); -+ -+ /* Send the IPIs for the target list of this cluster */ -+ sgi1r = (MPIDR_TO_SGI_AFFINITY(cluster_id, 3) | -+ MPIDR_TO_SGI_AFFINITY(cluster_id, 2) | -+ irq << 24 | -+ MPIDR_TO_SGI_AFFINITY(cluster_id, 1) | tlist); -+ gic_write_sgi1r(sgi1r); -+ -+ /* Force the above writes to ICC_SGI1R_EL1 to be executed */ -+ isb(); -+} -+ -+static void homo_rproc_vq_irq(struct work_struct *work) -+{ -+ struct homo_rproc *priv = g_priv; -+ struct homo_resource_table *rsc = priv->rsc; -+ struct rproc *rproc = priv->rproc; -+ -+ rproc_vq_interrupt(rproc, rsc->rpmsg_vring0.notifyid); -+} -+ -+static int homo_rproc_start(struct rproc *rproc) -+{ -+ int err; -+ struct homo_rproc *priv = rproc->priv; -+ int phys_cpuid = cpu_logical_map(priv->cpu); -+ struct arm_smccc_res smc_res; -+ -+ err = psci_ops.affinity_info(phys_cpuid, 0); -+ if (err == 0) -+ remove_cpu(priv->cpu); -+ -+ INIT_WORK(&workqueue, homo_rproc_vq_irq); -+ -+ priv->rsc = (struct homo_resource_table *)rproc->table_ptr; -+ -+ /* ARMv8 requires to clean D-cache and invalidate I-cache for memory containing new instructions. */ -+ flush_icache_range((unsigned long)priv->addr, (unsigned long)(priv->addr + priv->size)); -+ -+ arm_smccc_smc(CPU_ON, phys_cpuid, (unsigned long long)priv->phys_addr, 0, 0, 0, 0, 0, &smc_res); -+ -+ return smc_res.a0; -+} -+ -+static int homo_rproc_stop(struct rproc *rproc) -+{ -+ int err; -+ struct homo_rproc *priv = rproc->priv; -+ -+ err = psci_ops.affinity_info(cpu_logical_map(priv->cpu), 0); -+ if (err == 1) -+ add_cpu(priv->cpu); -+ -+ return 0; -+} -+ -+static void *homo_rproc_da_to_va(struct rproc *rproc, u64 da, size_t len) -+{ -+ struct homo_rproc *priv = rproc->priv; -+ -+ return priv->addr + (da - rproc->bootaddr); -+} -+ -+static void homo_rproc_kick(struct rproc *rproc, int vqid) -+{ -+ struct homo_rproc *priv = rproc->priv; -+ -+ if (rproc->state == RPROC_RUNNING) -+ gicv3_ipi_send_single(priv->irq, cpu_logical_map(priv->cpu)); -+ -+ return ; -+} -+ -+static const struct rproc_ops homo_rproc_ops = { -+ .start = homo_rproc_start, -+ .stop = homo_rproc_stop, -+ .kick = homo_rproc_kick, -+ .da_to_va = homo_rproc_da_to_va, -+}; -+ -+static void __iomem *homo_ioremap_prot(phys_addr_t addr, size_t size, pgprot_t prot) -+{ -+ unsigned long offset, vaddr; -+ phys_addr_t last_addr; -+ struct vm_struct *area; -+ -+ /* Disallow wrap-around or zero size */ -+ last_addr = addr + size - 1; -+ if (!size || last_addr < addr) -+ return NULL; -+ -+ /* Page-align mappings */ -+ offset = addr & (~PAGE_MASK); -+ addr -= offset; -+ size = PAGE_ALIGN(size + offset); -+ -+ area = get_vm_area_caller(size, VM_IOREMAP, -+ __builtin_return_address(0)); -+ if (!area) -+ return NULL; -+ vaddr = (unsigned long)area->addr; -+ -+ if (ioremap_page_range(vaddr, vaddr + size, addr, prot)) { -+ free_vm_area(area); -+ return NULL; -+ } -+ -+ return (void __iomem *)(vaddr + offset); -+} -+ -+static irqreturn_t homo_rproc_irq_handler(int irq, void *data) -+{ -+ schedule_work(&workqueue); -+ return IRQ_HANDLED; -+} -+ -+static int homo_rproc_starting_cpu(unsigned int cpu) -+{ -+ enable_percpu_irq(homo_rproc_irq, irq_get_trigger_type(homo_rproc_irq)); -+ return 0; -+} -+ -+static int homo_rproc_dying_cpu(unsigned int cpu) -+{ -+ disable_percpu_irq(homo_rproc_irq); -+ return 0; -+} -+ -+static int homo_rproc_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct device_node *np = dev->of_node, *p; -+ struct device_node *np_mem; -+ struct resource res; -+ struct rproc *rproc; -+ const char *fw_name; -+ struct homo_rproc *priv; -+ int ret; -+ unsigned int ipi, cpu; -+ struct of_phandle_args oirq; -+ -+ ret = rproc_of_parse_firmware(dev, 0, &fw_name); -+ if (ret) { -+ dev_err(dev, "failed to parse firmware-name property, ret = %d\n", ret); -+ return ret; -+ } -+ -+ rproc = rproc_alloc(dev, np->name, &homo_rproc_ops, fw_name, sizeof(*priv)); -+ if (!rproc) -+ return -ENOMEM; -+ -+ rproc->auto_boot = false; -+ rproc->has_iommu = false; -+ -+ platform_set_drvdata(pdev, rproc); -+ -+ priv = g_priv = rproc->priv; -+ priv->rproc = rproc; -+ -+ /* The following values can be modified through devicetree 'homo_rproc' node */ -+ if (of_property_read_u32(np, "remote-processor", &cpu)) { -+ dev_err(dev, "not found 'remote-processor' property\n"); -+ return -EINVAL; -+ } -+ -+ if (of_property_read_u32(np, "inter-processor-interrupt", &ipi)) { -+ dev_err(dev, "not found 'inter-processor-interrupt' property\n"); -+ return -EINVAL; -+ } -+ -+ /* The gic-v3 driver has registered the 0-7 range of SGI interrupt for system purpose */ -+ if (ipi < 8) { -+ dev_err(dev, "'inter-processor-interrupt' is %d, should be between 9~15\n", ipi); -+ return -EINVAL; -+ } -+ -+ priv->cpu = cpu; -+ priv->irq = ipi; -+ -+ dev_info(dev, "remote-processor = %d, inter-processor-interrupt = %d\n", cpu, ipi); -+ -+ np_mem = of_parse_phandle(np, "memory-region", 0); -+ ret = of_address_to_resource(np_mem, 0, &res); -+ if (ret) { -+ dev_err(dev, "can't find memory-region for Baremetal\n"); -+ return ret; -+ } -+ -+ priv->rsc = NULL; -+ priv->addr = NULL; -+ -+ priv->phys_addr = res.start; -+ priv->size = resource_size(&res); -+ -+ /* Map physical memory region reserved for homo remote processor. */ -+ priv->addr = homo_ioremap_prot(priv->phys_addr, priv->size, PAGE_KERNEL_EXEC); -+ if (!priv->addr) { -+ dev_err(dev, "ioremap failed\n"); -+ return -ENOMEM; -+ } -+ dev_info(dev, "ioremap: phys_addr = %016llx, addr = %llx, size = %lld\n", -+ priv->phys_addr, (u64)(priv->addr), priv->size); -+ -+ /* Look for the interrupt parent. */ -+ p = of_irq_find_parent(np); -+ if (p == NULL) { -+ ret = -EINVAL; -+ goto err; -+ } -+ -+ oirq.np = p; -+ oirq.args_count = 1; -+ oirq.args[0] = ipi; -+ homo_rproc_irq = irq_create_of_mapping(&oirq); -+ if (homo_rproc_irq <= 0) { -+ ret = -EINVAL; -+ goto err; -+ } -+ -+ ret = request_percpu_irq(homo_rproc_irq, homo_rproc_irq_handler, "homo-rproc-ipi", &cpu_number); -+ if (ret) { -+ dev_err(dev, "failed to request percpu irq, status = %d\n", ret); -+ goto err; -+ } -+ -+ ret = cpuhp_setup_state(CPUHP_AP_HOMO_RPROC_STARTING, "remoteproc/homo_rproc:starting", homo_rproc_starting_cpu, homo_rproc_dying_cpu); -+ if (ret) { -+ dev_err(dev, "cpuhp setup state failed, status = %d\n", ret); -+ goto err; -+ } -+ -+ ret = rproc_add(rproc); -+ if (ret) { -+ dev_err(dev, "failed to add register device with remoteproc core, status = %d\n", ret); -+ goto err; -+ } -+ -+ return 0; -+ -+err: -+ vunmap((void *)((unsigned long)priv->addr & PAGE_MASK)); -+ return ret; -+} -+ -+static int homo_rproc_remove(struct platform_device *pdev) -+{ -+ struct rproc *rproc = platform_get_drvdata(pdev); -+ -+ rproc_del(rproc); -+ rproc_free(rproc); -+ -+ return 0; -+} -+ -+static const struct of_device_id homo_rproc_ids[] = { -+ { .compatible = "homo,rproc", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, homo_rproc_ids); -+ -+static struct platform_driver homo_rproc_driver = { -+ .probe = homo_rproc_probe, -+ .remove = homo_rproc_remove, -+ .driver = { -+ .name = "homo-rproc", -+ .of_match_table = of_match_ptr(homo_rproc_ids), -+ }, -+}; -+module_platform_driver(homo_rproc_driver); -+ -+MODULE_DESCRIPTION("Homogeneous Remote Processor Control Driver"); -+MODULE_AUTHOR("Shaojun Yang "); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/rtc/Kconfig b/drivers/rtc/Kconfig -old mode 100644 -new mode 100755 -index 54cf5ec8f..c1a385acd ---- a/drivers/rtc/Kconfig -+++ b/drivers/rtc/Kconfig -@@ -701,6 +701,16 @@ config RTC_DRV_S5M - This driver can also be built as a module. If so, the module - will be called rtc-s5m. - -+config RTC_DRV_SD3068 -+ tristate "ZXW Shenzhen whwave SD3068" -+ select REGMAP_I2C -+ help -+ If you say yes here you get support for the ZXW Shenzhen whwave -+ SD3068 RTC chips. -+ -+ This driver can also be built as a module. If so, the module -+ will be called rtc-sd3068 -+ - config RTC_DRV_SD3078 - tristate "ZXW Shenzhen whwave SD3078" - select REGMAP_I2C -diff --git a/drivers/rtc/Makefile b/drivers/rtc/Makefile -old mode 100644 -new mode 100755 -index bfb574641..422182033 ---- a/drivers/rtc/Makefile -+++ b/drivers/rtc/Makefile -@@ -153,6 +153,7 @@ obj-$(CONFIG_RTC_DRV_S3C) += rtc-s3c.o - obj-$(CONFIG_RTC_DRV_S5M) += rtc-s5m.o - obj-$(CONFIG_RTC_DRV_SA1100) += rtc-sa1100.o - obj-$(CONFIG_RTC_DRV_SC27XX) += rtc-sc27xx.o -+obj-$(CONFIG_RTC_DRV_SD3068) += rtc-sd3068.o - obj-$(CONFIG_RTC_DRV_SD3078) += rtc-sd3078.o - obj-$(CONFIG_RTC_DRV_SH) += rtc-sh.o - obj-$(CONFIG_RTC_DRV_SIRFSOC) += rtc-sirfsoc.o -diff --git a/drivers/rtc/rtc-sd3068.c b/drivers/rtc/rtc-sd3068.c -new file mode 100755 -index 000000000..6abd0cd85 ---- /dev/null -+++ b/drivers/rtc/rtc-sd3068.c -@@ -0,0 +1,255 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+/* -+ * rtc-sd3068.c - RTC driver for some mostly-compatible I2C chips. -+ * -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define SD3068_REG_SC 0x00 -+#define SD3068_REG_MN 0x01 -+#define SD3068_REG_HR 0x02 -+#define SD3068_REG_DW 0x03 -+#define SD3068_REG_DM 0x04 -+#define SD3068_REG_MO 0x05 -+#define SD3068_REG_YR 0x06 -+ -+#define SD3068_REG_CTRL1 0x0f -+#define SD3068_REG_CTRL2 0x10 -+#define SD3068_REG_CTRL3 0x11 -+ -+#define KEY_WRITE1 0x80 -+#define KEY_WRITE2 0x04 -+#define KEY_WRITE3 0x80 -+ -+#define NUM_TIME_REGS (SD3068_REG_YR - SD3068_REG_SC + 1) -+ -+/* -+ * The sd3068 has write protection -+ * and we can choose whether or not to use it. -+ * Write protection is turned off by default. -+ */ -+#define WRITE_PROTECT_EN 1 -+ -+struct sd3068 { -+ struct rtc_device *rtc; -+ struct regmap *regmap; -+}; -+ -+/* -+ * In order to prevent arbitrary modification of the time register, -+ * when modification of the register, -+ * the "write" bit needs to be written in a certain order. -+ * 1. set WRITE1 bit -+ * 2. set WRITE2 bit -+ * 3. set WRITE3 bit -+ */ -+static void sd3068_enable_reg_write(struct sd3068 *sd3068) -+{ -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL2, -+ KEY_WRITE1, KEY_WRITE1); -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, -+ KEY_WRITE2, KEY_WRITE2); -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, -+ KEY_WRITE3, KEY_WRITE3); -+} -+ -+#if WRITE_PROTECT_EN -+/* -+ * In order to prevent arbitrary modification of the time register, -+ * we should disable the write function. -+ * when disable write, -+ * the "write" bit needs to be clear in a certain order. -+ * 1. clear WRITE2 bit -+ * 2. clear WRITE3 bit -+ * 3. clear WRITE1 bit -+ */ -+static void sd3068_disable_reg_write(struct sd3068 *sd3068) -+{ -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, -+ KEY_WRITE2, 0); -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, -+ KEY_WRITE3, 0); -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL2, -+ KEY_WRITE1, 0); -+} -+#endif -+ -+static int sd3068_rtc_read_time(struct device *dev, struct rtc_time *tm) -+{ -+ unsigned char hour; -+ unsigned char rtc_data[NUM_TIME_REGS] = {0}; -+ struct i2c_client *client = to_i2c_client(dev); -+ struct sd3068 *sd3068 = i2c_get_clientdata(client); -+ int ret; -+ pr_debug("sd3068 read\n"); -+ -+ ret = regmap_bulk_read(sd3068->regmap, SD3068_REG_SC, rtc_data, -+ NUM_TIME_REGS); -+ if (ret < 0) { -+ dev_err(dev, "reading from RTC failed with err:%d\n", ret); -+ return ret; -+ } -+ -+ tm->tm_sec = bcd2bin(rtc_data[SD3068_REG_SC] & 0x7F); -+ tm->tm_min = bcd2bin(rtc_data[SD3068_REG_MN] & 0x7F); -+ -+ /* -+ * The sd3068 supports 12/24 hour mode. -+ * When getting time, -+ * we need to convert the 12 hour mode to the 24 hour mode. -+ */ -+ hour = rtc_data[SD3068_REG_HR]; -+ if (hour & 0x80) /* 24H MODE */ -+ tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x3F); -+ else if (hour & 0x20) /* 12H MODE PM */ -+ tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x1F) + 12; -+ else /* 12H MODE AM */ -+ tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x1F); -+ -+ tm->tm_mday = bcd2bin(rtc_data[SD3068_REG_DM] & 0x3F); -+ tm->tm_wday = rtc_data[SD3068_REG_DW] & 0x07; -+ tm->tm_mon = bcd2bin(rtc_data[SD3068_REG_MO] & 0x1F) - 1; -+ tm->tm_year = bcd2bin(rtc_data[SD3068_REG_YR]) + 100; -+ -+ return 0; -+} -+ -+static int sd3068_rtc_set_time(struct device *dev, struct rtc_time *tm) -+{ -+ unsigned char rtc_data[NUM_TIME_REGS]; -+ struct i2c_client *client = to_i2c_client(dev); -+ struct sd3068 *sd3068 = i2c_get_clientdata(client); -+ int ret; -+ pr_debug("sd3068 set\n"); -+ -+ rtc_data[SD3068_REG_SC] = bin2bcd(tm->tm_sec); -+ rtc_data[SD3068_REG_MN] = bin2bcd(tm->tm_min); -+ rtc_data[SD3068_REG_HR] = bin2bcd(tm->tm_hour) | 0x80; -+ rtc_data[SD3068_REG_DM] = bin2bcd(tm->tm_mday); -+ rtc_data[SD3068_REG_DW] = tm->tm_wday & 0x07; -+ rtc_data[SD3068_REG_MO] = bin2bcd(tm->tm_mon) + 1; -+ rtc_data[SD3068_REG_YR] = bin2bcd(tm->tm_year - 100); -+ -+#if WRITE_PROTECT_EN -+ sd3068_enable_reg_write(sd3068); -+#endif -+ -+ ret = regmap_bulk_write(sd3068->regmap, SD3068_REG_SC, rtc_data, -+ NUM_TIME_REGS); -+ if (ret < 0) { -+ dev_err(dev, "writing to RTC failed with err:%d\n", ret); -+ return ret; -+ } -+ -+#if WRITE_PROTECT_EN -+ sd3068_disable_reg_write(sd3068); -+#endif -+ -+ return 0; -+} -+ -+static const struct rtc_class_ops sd3068_rtc_ops = { -+ .read_time = sd3068_rtc_read_time, -+ .set_time = sd3068_rtc_set_time, -+}; -+ -+static const struct regmap_config regmap_config = { -+ .reg_bits = 8, -+ .val_bits = 8, -+ .max_register = 0x11, -+}; -+ -+static int sd3068_probe(struct i2c_client *client, -+ const struct i2c_device_id *id) -+{ -+ int ret; -+ struct sd3068 *sd3068; -+ unsigned char rtc_data[NUM_TIME_REGS] = {0}; -+ pr_debug("probed\n"); -+ -+ if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) -+ return -ENODEV; -+ -+ sd3068 = devm_kzalloc(&client->dev, sizeof(*sd3068), GFP_KERNEL); -+ if (!sd3068) -+ return -ENOMEM; -+ -+ sd3068->regmap = devm_regmap_init_i2c(client, ®map_config); -+ if (IS_ERR(sd3068->regmap)) { -+ dev_err(&client->dev, "regmap allocation failed\n"); -+ return PTR_ERR(sd3068->regmap); -+ } -+ -+ i2c_set_clientdata(client, sd3068); -+ -+ sd3068->rtc = devm_rtc_allocate_device(&client->dev); -+ if (IS_ERR(sd3068->rtc)) -+ return PTR_ERR(sd3068->rtc); -+ -+ sd3068->rtc->ops = &sd3068_rtc_ops; -+ sd3068->rtc->range_min = RTC_TIMESTAMP_BEGIN_2000; -+ sd3068->rtc->range_max = RTC_TIMESTAMP_END_2099; -+ -+ ret = regmap_bulk_read(sd3068->regmap, SD3068_REG_SC, rtc_data, -+ NUM_TIME_REGS); -+ if (ret < 0) { -+ dev_info(&client->dev, "can not read time data when probe\n"); -+ return ret; -+ } -+ -+ ret = rtc_register_device(sd3068->rtc); -+ if (ret) -+ return ret; -+ -+ sd3068_enable_reg_write(sd3068); -+ -+ return 0; -+} -+ -+ -+static const struct acpi_device_id ds1307_acpi_ids[] = { -+ { .id = "DS1339", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, ds1307_acpi_ids); -+ -+static const struct i2c_device_id sd3068_id[] = { -+ { "sd3068", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(i2c,sd3068_id); -+ -+static const struct of_device_id sd3068_of_match[] = { -+ { .compatible = "wave,sd3068" }, -+ { } -+}; -+ -+static struct i2c_driver sd3068_driver = { -+ .driver = { -+ .name = "rtc-sd3068", -+ .of_match_table = of_match_ptr(sd3068_of_match), -+ .acpi_match_table = ACPI_PTR(ds1307_acpi_ids), -+ }, -+ .probe = sd3068_probe, -+ .id_table = sd3068_id, -+}; -+ -+module_i2c_driver(sd3068_driver); -+MODULE_DEVICE_TABLE(of, sd3068_of_match); -+ -+MODULE_DESCRIPTION("RTC driver for SD3068 and similar chips"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/spi/Kconfig b/drivers/spi/Kconfig -index 74ea6b6b5..e4d6be4e5 100644 ---- a/drivers/spi/Kconfig -+++ b/drivers/spi/Kconfig -@@ -585,6 +585,31 @@ config SPI_ORION - This enables using the SPI master controller on the Orion - and MVEBU chips. - -+config SPI_PHYTIUM -+ tristate -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ -+config SPI_PHYTIUM_PLAT -+ tristate "Phytium SPI controller platform support" -+ select SPI_PHYTIUM -+ help -+ This selects a platform driver for Phytium SPI controller. -+ -+ If you say yes to this option, support will be included for -+ Pd1904 and pd2008 families of SPI controller. -+ -+config SPI_PHYTIUM_PCI -+ tristate "Phytium SPI controller PCI support" -+ depends on PCI -+ select SPI_PHYTIUM -+ help -+ This selects a PCI driver for Phytium SPI controller. -+ -+ If you say yes to this option, support will be included for -+ Phytium px210 chipset of SPI controller. -+ -+ If unsure, say N. -+ - config SPI_PIC32 - tristate "Microchip PIC32 series SPI" - depends on MACH_PIC32 || COMPILE_TEST -diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile -index 6fea58216..c5996a6d3 100644 ---- a/drivers/spi/Makefile -+++ b/drivers/spi/Makefile -@@ -82,6 +82,10 @@ obj-$(CONFIG_SPI_OMAP_100K) += spi-omap-100k.o - obj-$(CONFIG_SPI_OMAP24XX) += spi-omap2-mcspi.o - obj-$(CONFIG_SPI_TI_QSPI) += spi-ti-qspi.o - obj-$(CONFIG_SPI_ORION) += spi-orion.o -+obj-$(CONFIG_SPI_PHYTIUM) += spi-phytium.o spi-phytium-dma.o -+obj-$(CONFIG_SPI_PHYTIUM_PLAT) += spi-phytium-plat.o -+obj-$(CONFIG_SPI_PHYTIUM_PCI) += spi-phytium-pci.o -+obj-$(CONFIG_SPI_PHYTIUM_QSPI) += spi-phytium-qspi.o - obj-$(CONFIG_SPI_PIC32) += spi-pic32.o - obj-$(CONFIG_SPI_PIC32_SQI) += spi-pic32-sqi.o - obj-$(CONFIG_SPI_PL022) += spi-pl022.o -diff --git a/drivers/spi/spi-phytium-dma.c b/drivers/spi/spi-phytium-dma.c -new file mode 100644 -index 000000000..4f78d0659 ---- /dev/null -+++ b/drivers/spi/spi-phytium-dma.c -@@ -0,0 +1,555 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+/* -+ * Special handling for phytium DMA core -+ * -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "spi-phytium.h" -+ -+#define RX_BUSY 0 -+#define RX_BURST_LEVEL 16 -+#define TX_BUSY 1 -+#define TX_BURST_LEVEL 16 -+ -+#define DMA_MAX_BUF_SIZE 4096 -+ -+static void phytium_spi_dma_maxburst_init(struct phytium_spi *fts) -+{ -+ struct dma_slave_caps caps; -+ u32 max_burst, def_burst; -+ int ret; -+ -+ def_burst = fts->fifo_len / 2; -+ -+ ret = dma_get_slave_caps(fts->rxchan, &caps); -+ if (!ret && caps.max_burst) -+ max_burst = caps.max_burst; -+ else -+ max_burst = RX_BURST_LEVEL; -+ -+ fts->rxburst = min(max_burst, def_burst); -+ phytium_writel(fts, DMARDLR, 0x0); -+ -+ ret = dma_get_slave_caps(fts->txchan, &caps); -+ if (!ret && caps.max_burst) -+ max_burst = caps.max_burst; -+ else -+ max_burst = TX_BURST_LEVEL; -+ -+ /* -+ * Having a Rx DMA channel serviced with higher priority than a Tx DMA -+ * channel might not be enough to provide a well balanced DMA-based -+ * SPI transfer interface. There might still be moments when the Tx DMA -+ * channel is occasionally handled faster than the Rx DMA channel. -+ * That in its turn will eventually cause the SPI Rx FIFO overflow if -+ * SPI bus speed is high enough to fill the SPI Rx FIFO in before it's -+ * cleared by the Rx DMA channel. In order to fix the problem the Tx -+ * DMA activity is intentionally slowed down by limiting the SPI Tx -+ * FIFO depth with a value twice bigger than the Tx burst length. -+ */ -+ fts->txburst = min(max_burst, def_burst); -+ /* set dmatdlr to 0 + 1 */ -+ phytium_writel(fts, DMATDLR, 0); -+} -+ -+static void phytium_spi_dma_sg_burst_init(struct phytium_spi *fts) -+{ -+ struct dma_slave_caps tx = {0}, rx = {0}; -+ -+ dma_get_slave_caps(fts->txchan, &tx); -+ dma_get_slave_caps(fts->rxchan, &rx); -+ -+ if (tx.max_sg_burst > 0 && rx.max_sg_burst > 0) -+ fts->dma_sg_burst = min(tx.max_sg_burst, rx.max_sg_burst); -+ else if (tx.max_sg_burst > 0) -+ fts->dma_sg_burst = tx.max_sg_burst; -+ else if (rx.max_sg_burst > 0) -+ fts->dma_sg_burst = rx.max_sg_burst; -+ else -+ fts->dma_sg_burst = 0; -+} -+ -+static int phytium_spi_dma_init(struct device *dev, struct phytium_spi *fts) -+{ -+ fts->rxchan = dma_request_chan(dev, "rx"); -+ if (IS_ERR_OR_NULL(fts->rxchan)) -+ return -ENODEV; -+ -+ fts->txchan = dma_request_chan(dev, "tx"); -+ if (IS_ERR_OR_NULL(fts->txchan)) { -+ dev_err(dev, "can't request chan\n"); -+ dma_release_channel(fts->rxchan); -+ fts->rxchan = NULL; -+ return -ENODEV; -+ } -+ -+ fts->master->dma_rx = fts->rxchan; -+ fts->master->dma_tx = fts->txchan; -+ init_completion(&fts->dma_completion); -+ -+ phytium_spi_dma_maxburst_init(fts); -+ phytium_spi_dma_sg_burst_init(fts); -+ -+ return 0; -+} -+ -+static void phytium_spi_dma_exit(struct phytium_spi *fts) -+{ -+ if (fts->txchan) { -+ dmaengine_terminate_sync(fts->txchan); -+ dma_release_channel(fts->txchan); -+ } -+ -+ if (fts->rxchan) { -+ dmaengine_terminate_sync(fts->rxchan); -+ dma_release_channel(fts->rxchan); -+ } -+} -+ -+static irqreturn_t phytium_spi_dma_transfer_handler(struct phytium_spi *fts) -+{ -+ phytium_spi_check_status(fts, false); -+ -+ complete(&fts->dma_completion); -+ -+ return IRQ_HANDLED; -+} -+ -+static bool phytium_spi_can_dma(struct spi_controller *master, -+ struct spi_device *spi, struct spi_transfer *xfer) -+{ -+ struct phytium_spi *fts = spi_controller_get_devdata(master); -+ -+ return xfer->len > fts->fifo_len; -+} -+ -+static enum dma_slave_buswidth phytium_spi_dma_convert_width(u8 n_bytes) -+{ -+ if (n_bytes == 1) -+ return DMA_SLAVE_BUSWIDTH_1_BYTE; -+ else if (n_bytes == 2) -+ return DMA_SLAVE_BUSWIDTH_2_BYTES; -+ -+ return DMA_SLAVE_BUSWIDTH_UNDEFINED; -+} -+ -+static int phytium_spi_dma_wait(struct phytium_spi *fts, unsigned int len, -+ u32 speed) -+{ -+ unsigned long long ms; -+ -+ ms = len * MSEC_PER_SEC * BITS_PER_BYTE; -+ do_div(ms, speed); -+ ms += ms + 200; -+ -+ if (ms > UINT_MAX) -+ ms = UINT_MAX; -+ -+ ms = wait_for_completion_timeout(&fts->dma_completion, -+ msecs_to_jiffies(ms)); -+ -+ if (ms == 0) { -+ dev_err(&fts->master->cur_msg->spi->dev, -+ "DMA transaction timed out\n"); -+ return -ETIMEDOUT; -+ } -+ -+ return 0; -+} -+ -+static inline bool phytium_spi_dma_tx_busy(struct phytium_spi *fts) -+{ -+ return !(phytium_readl(fts, SR) & SR_TF_EMPT); -+} -+ -+static int phytium_spi_dma_wait_tx_done(struct phytium_spi *fts, -+ struct spi_transfer *xfer) -+{ -+ int retry = SPI_WAIT_RETRIES; -+ struct spi_delay delay; -+ u32 nents; -+ -+ nents = phytium_readl(fts, TXFLR); -+ delay.unit = SPI_DELAY_UNIT_SCK; -+ delay.value = nents * fts->n_bytes * BITS_PER_BYTE; -+ -+ while (phytium_spi_dma_tx_busy(fts) && retry--) -+ spi_delay_exec(&delay, xfer); -+ -+ if (retry < 0) { -+ dev_err(&fts->master->dev, "Tx hanged up\n"); -+ return -EIO; -+ } -+ -+ return 0; -+} -+ -+/* -+ * fts->dma_chan_busy is set before the dma transfer starts, callback for tx -+ * channel will clear a corresponding bit. -+ */ -+static void phytium_spi_dma_tx_done(void *arg) -+{ -+ struct phytium_spi *fts = arg; -+ -+ clear_bit(TX_BUSY, &fts->dma_chan_busy); -+ if (test_bit(RX_BUSY, &fts->dma_chan_busy)) -+ return; -+ -+ complete(&fts->dma_completion); -+} -+ -+static int phytium_spi_dma_config_tx(struct phytium_spi *fts) -+{ -+ struct dma_slave_config txconf; -+ -+ memset(&txconf, 0, sizeof(txconf)); -+ txconf.direction = DMA_MEM_TO_DEV; -+ txconf.dst_addr = fts->dma_addr; -+ txconf.dst_maxburst = fts->txburst; -+ txconf.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; -+ txconf.dst_addr_width = phytium_spi_dma_convert_width(fts->n_bytes); -+ txconf.device_fc = false; -+ -+ return dmaengine_slave_config(fts->txchan, &txconf); -+} -+ -+static int phytium_spi_dma_submit_tx(struct phytium_spi *fts, struct scatterlist *sgl, -+ unsigned int nents) -+{ -+ struct dma_async_tx_descriptor *txdesc; -+ dma_cookie_t cookie; -+ int ret; -+ -+ txdesc = dmaengine_prep_slave_sg(fts->txchan, sgl, nents, -+ DMA_MEM_TO_DEV, -+ DMA_PREP_INTERRUPT | DMA_CTRL_ACK); -+ if (!txdesc) -+ return -ENOMEM; -+ -+ txdesc->callback = phytium_spi_dma_tx_done; -+ txdesc->callback_param = fts; -+ -+ cookie = dmaengine_submit(txdesc); -+ ret = dma_submit_error(cookie); -+ if (ret) { -+ dmaengine_terminate_sync(fts->txchan); -+ return ret; -+ } -+ -+ set_bit(TX_BUSY, &fts->dma_chan_busy); -+ -+ return 0; -+} -+ -+static inline bool phytium_spi_dma_rx_busy(struct phytium_spi *fts) -+{ -+ return !!(phytium_readl(fts, SR) & SR_RF_NOT_EMPT); -+} -+ -+static int phytium_spi_dma_wait_rx_done(struct phytium_spi *fts) -+{ -+ int retry = SPI_WAIT_RETRIES; -+ struct spi_delay delay; -+ unsigned long ns, us; -+ u32 nents; -+ -+ /* -+ * It's unlikely that DMA engine is still doing the data fetching, but -+ * if it's let's give it some reasonable time. The timeout calculation -+ * is based on the synchronous APB/SSI reference clock rate, on a -+ * number of data entries left in the Rx FIFO, times a number of clock -+ * periods normally needed for a single APB read/write transaction -+ * without PREADY signal utilized (which is true for the phytium APB SSI -+ * controller). -+ */ -+ nents = phytium_readl(fts, RXFLR); -+ ns = 4U * NSEC_PER_SEC / fts->max_freq * nents; -+ if (ns <= NSEC_PER_USEC) { -+ delay.unit = SPI_DELAY_UNIT_NSECS; -+ delay.value = ns; -+ } else { -+ us = DIV_ROUND_UP(ns, NSEC_PER_USEC); -+ delay.unit = SPI_DELAY_UNIT_USECS; -+ delay.value = clamp_val(us, 0, USHRT_MAX); -+ } -+ -+ while (phytium_spi_dma_rx_busy(fts) && retry--) -+ spi_delay_exec(&delay, NULL); -+ -+ if (retry < 0) { -+ dev_err(&fts->master->dev, "Rx hanged up, nents = %d\n", nents); -+ return -EIO; -+ } -+ -+ return 0; -+} -+ -+/* -+ * fts->dma_chan_busy is set before the dma transfer starts, callback for rx -+ * channel will clear a corresponding bit. -+ */ -+static void phytium_spi_dma_rx_done(void *arg) -+{ -+ struct phytium_spi *fts = arg; -+ -+ clear_bit(RX_BUSY, &fts->dma_chan_busy); -+ if (test_bit(TX_BUSY, &fts->dma_chan_busy)) -+ return; -+ -+ complete(&fts->dma_completion); -+} -+ -+static int phytium_spi_dma_config_rx(struct phytium_spi *fts) -+{ -+ struct dma_slave_config rxconf; -+ -+ memset(&rxconf, 0, sizeof(rxconf)); -+ rxconf.direction = DMA_DEV_TO_MEM; -+ rxconf.src_addr = fts->dma_addr; -+ rxconf.src_maxburst = fts->rxburst; -+ rxconf.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; -+ rxconf.src_addr_width = phytium_spi_dma_convert_width(fts->n_bytes); -+ rxconf.device_fc = false; -+ -+ return dmaengine_slave_config(fts->rxchan, &rxconf); -+} -+ -+static int phytium_spi_dma_submit_rx(struct phytium_spi *fts, struct scatterlist *sgl, -+ unsigned int nents) -+{ -+ struct dma_async_tx_descriptor *rxdesc; -+ dma_cookie_t cookie; -+ int ret; -+ -+ rxdesc = dmaengine_prep_slave_sg(fts->rxchan, sgl, nents, -+ DMA_DEV_TO_MEM, -+ DMA_PREP_INTERRUPT | DMA_CTRL_ACK); -+ if (!rxdesc) -+ return -ENOMEM; -+ -+ rxdesc->callback = phytium_spi_dma_rx_done; -+ rxdesc->callback_param = fts; -+ -+ cookie = dmaengine_submit(rxdesc); -+ ret = dma_submit_error(cookie); -+ if (ret) { -+ dmaengine_terminate_sync(fts->rxchan); -+ return ret; -+ } -+ -+ set_bit(RX_BUSY, &fts->dma_chan_busy); -+ -+ return 0; -+} -+ -+static int phytium_spi_dma_setup(struct phytium_spi *fts, struct spi_transfer *xfer) -+{ -+ u16 imr, dma_ctrl; -+ int ret; -+ -+ if (!xfer->tx_buf) -+ return -EINVAL; -+ -+ /* Setup DMA channels */ -+ ret = phytium_spi_dma_config_tx(fts); -+ if (ret) -+ return ret; -+ -+ if (xfer->rx_buf) { -+ ret = phytium_spi_dma_config_rx(fts); -+ if (ret) -+ return ret; -+ } -+ -+ /* Set the DMA handshaking interface */ -+ dma_ctrl = SPI_DMA_TDMAE; -+ if (xfer->rx_buf) -+ dma_ctrl |= SPI_DMA_RDMAE; -+ phytium_writel(fts, DMACR, dma_ctrl); -+ -+ /* Set the interrupt mask */ -+ imr = INT_TXOI; -+ if (xfer->rx_buf) -+ imr |= INT_RXUI | INT_RXOI; -+ -+ spi_umask_intr(fts, imr); -+ -+ reinit_completion(&fts->dma_completion); -+ -+ fts->transfer_handler = phytium_spi_dma_transfer_handler; -+ -+ return 0; -+} -+ -+static int phytium_spi_dma_transfer_all(struct phytium_spi *fts, -+ struct spi_transfer *xfer) -+{ -+ int ret; -+ -+ /* Submit the DMA Tx transfer */ -+ ret = phytium_spi_dma_submit_tx(fts, xfer->tx_sg.sgl, xfer->tx_sg.nents); -+ if (ret) -+ goto err_clear_dmac; -+ -+ /* Submit the DMA Rx transfer if required */ -+ if (xfer->rx_buf) { -+ ret = phytium_spi_dma_submit_rx(fts, xfer->rx_sg.sgl, -+ xfer->rx_sg.nents); -+ if (ret) -+ goto err_clear_dmac; -+ -+ /* rx must be started before tx due to spi instinct */ -+ dma_async_issue_pending(fts->rxchan); -+ } -+ -+ dma_async_issue_pending(fts->txchan); -+ -+ ret = phytium_spi_dma_wait(fts, xfer->len, xfer->effective_speed_hz); -+ -+err_clear_dmac: -+ phytium_writel(fts, DMACR, 0); -+ -+ return ret; -+} -+ -+static int phytium_spi_dma_transfer_one(struct phytium_spi *fts, -+ struct spi_transfer *xfer) -+{ -+ struct scatterlist *tx_sg = NULL, *rx_sg = NULL, tx_tmp, rx_tmp; -+ unsigned int tx_len = 0, rx_len = 0; -+ unsigned int base, len; -+ int ret; -+ -+ sg_init_table(&tx_tmp, 1); -+ sg_init_table(&rx_tmp, 1); -+ -+ for (base = 0, len = 0; base < xfer->len; base += len) { -+ /* Fetch next Tx DMA data chunk */ -+ if (!tx_len) { -+ tx_sg = !tx_sg ? &xfer->tx_sg.sgl[0] : sg_next(tx_sg); -+ sg_dma_address(&tx_tmp) = sg_dma_address(tx_sg); -+ tx_len = sg_dma_len(tx_sg); -+ } -+ -+ /* Fetch next Rx DMA data chunk */ -+ if (!rx_len) { -+ rx_sg = !rx_sg ? &xfer->rx_sg.sgl[0] : sg_next(rx_sg); -+ sg_dma_address(&rx_tmp) = sg_dma_address(rx_sg); -+ rx_len = sg_dma_len(rx_sg); -+ } -+ -+ if ((base + DMA_MAX_BUF_SIZE) > xfer->len) -+ len = xfer->len - base; -+ else -+ len = DMA_MAX_BUF_SIZE; -+ -+ len = min3(len, tx_len, rx_len); -+ -+ sg_dma_len(&tx_tmp) = len; -+ sg_dma_len(&rx_tmp) = len; -+ -+ /* Submit DMA Tx transfer */ -+ ret = phytium_spi_dma_submit_tx(fts, &tx_tmp, 1); -+ if (ret) -+ break; -+ -+ /* Submit DMA Rx transfer */ -+ ret = phytium_spi_dma_submit_rx(fts, &rx_tmp, 1); -+ if (ret) -+ break; -+ -+ /* Rx must be started before Tx due to SPI instinct */ -+ dma_async_issue_pending(fts->rxchan); -+ -+ dma_async_issue_pending(fts->txchan); -+ -+ /* -+ * Here we only need to wait for the DMA transfer to be -+ * finished since SPI controller is kept enabled during the -+ * procedure this loop implements and there is no risk to lose -+ * data left in the Tx/Rx FIFOs. -+ */ -+ ret = phytium_spi_dma_wait(fts, len, xfer->effective_speed_hz); -+ if (ret) -+ break; -+ -+ reinit_completion(&fts->dma_completion); -+ -+ sg_dma_address(&tx_tmp) += len; -+ sg_dma_address(&rx_tmp) += len; -+ tx_len -= len; -+ rx_len -= len; -+ } -+ -+ phytium_writel(fts, DMACR, 0); -+ -+ return ret; -+} -+ -+static int phytium_spi_dma_transfer(struct phytium_spi *fts, struct spi_transfer *xfer) -+{ -+ unsigned int nents; -+ int ret; -+ -+ nents = max(xfer->tx_sg.nents, xfer->rx_sg.nents); -+ -+ /* -+ * large transfer length caused spi RX FIFO full event -+ * transfer 4096 bytes each time -+ */ -+ if (xfer->len <= DMA_MAX_BUF_SIZE) -+ ret = phytium_spi_dma_transfer_all(fts, xfer); -+ else -+ ret = phytium_spi_dma_transfer_one(fts, xfer); -+ if (ret) -+ return ret; -+ -+ if (fts->master->cur_msg->status == -EINPROGRESS) { -+ ret = phytium_spi_dma_wait_tx_done(fts, xfer); -+ if (ret) -+ return ret; -+ } -+ -+ if (xfer->rx_buf && fts->master->cur_msg->status == -EINPROGRESS) -+ ret = phytium_spi_dma_wait_rx_done(fts); -+ -+ return ret; -+} -+ -+static void phytium_spi_dma_stop(struct phytium_spi *fts) -+{ -+ if (test_bit(TX_BUSY, &fts->dma_chan_busy)) { -+ dmaengine_terminate_sync(fts->txchan); -+ clear_bit(TX_BUSY, &fts->dma_chan_busy); -+ } -+ if (test_bit(RX_BUSY, &fts->dma_chan_busy)) { -+ dmaengine_terminate_sync(fts->rxchan); -+ clear_bit(RX_BUSY, &fts->dma_chan_busy); -+ } -+} -+ -+static const struct phytium_spi_dma_ops phytium_spi_dma_generic_ops = { -+ .dma_init = phytium_spi_dma_init, -+ .dma_exit = phytium_spi_dma_exit, -+ .dma_setup = phytium_spi_dma_setup, -+ .can_dma = phytium_spi_can_dma, -+ .dma_transfer = phytium_spi_dma_transfer, -+ .dma_stop = phytium_spi_dma_stop, -+}; -+ -+void phytium_spi_dmaops_set(struct phytium_spi *fts) -+{ -+ fts->dma_ops = &phytium_spi_dma_generic_ops; -+} -+EXPORT_SYMBOL_GPL(phytium_spi_dmaops_set); -+ -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/spi/spi-phytium-pci.c b/drivers/spi/spi-phytium-pci.c -new file mode 100644 -index 000000000..5bc686342 ---- /dev/null -+++ b/drivers/spi/spi-phytium-pci.c -@@ -0,0 +1,122 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SPI core controller PCI driver. -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "spi-phytium.h" -+ -+#define DRIVER_NAME "phytium_spi_pci" -+ -+static int phytium_spi_pci_probe(struct pci_dev *pdev, -+ const struct pci_device_id *id) -+{ -+ struct phytium_spi *fts; -+ int pci_bar = 0; -+ int ret; -+ -+ fts = devm_kzalloc(&pdev->dev, sizeof(struct phytium_spi), -+ GFP_KERNEL); -+ if (!fts) -+ return -ENOMEM; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ ret = pcim_iomap_regions(pdev, 1 << pci_bar, pci_name(pdev)); -+ if (ret) { -+ dev_err(&pdev->dev, "pci iomap failed?\n"); -+ return ret; -+ } -+ -+ fts->regs = pcim_iomap_table(pdev)[pci_bar]; -+ if (IS_ERR(fts->regs)) { -+ dev_err(&pdev->dev, "SPI region map failed\n"); -+ return PTR_ERR(fts->regs); -+ } -+ -+ fts->irq = pdev->irq; -+ if (fts->irq < 0) { -+ dev_err(&pdev->dev, "no irq resource?\n"); -+ return fts->irq; /* -ENXIO */ -+ } -+ -+ fts->bus_num = -1; -+ -+ fts->max_freq = 48000000; -+ -+ fts->num_cs = 4; -+ -+ fts->global_cs = 1; -+ -+ ret = phytium_spi_add_host(&pdev->dev, fts); -+ if (ret) -+ return ret; -+ -+ pci_set_drvdata(pdev, fts); -+ return 0; -+} -+ -+static void phytium_spi_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_spi *fts = pci_get_drvdata(pdev); -+ -+ phytium_spi_remove_host(fts); -+} -+ -+ -+#ifdef CONFIG_PM_SLEEP -+static int spi_suspend(struct device *dev) -+{ -+ struct phytium_spi *fts = dev_get_drvdata(dev); -+ -+ return phytium_spi_suspend_host(fts); -+} -+ -+static int spi_resume(struct device *dev) -+{ -+ struct phytium_spi *fts = dev_get_drvdata(dev); -+ -+ return phytium_spi_resume_host(fts); -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_spi_pm_ops, spi_suspend, spi_resume); -+ -+static const struct pci_device_id phytium_device_pci_tbl[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc2c) }, -+ {}, -+}; -+ -+static struct pci_driver phytium_spi_pci_driver = { -+ .name = DRIVER_NAME, -+ .id_table = phytium_device_pci_tbl, -+ .probe = phytium_spi_pci_probe, -+ .remove = phytium_spi_pci_remove, -+ .driver = { -+ .pm = &phytium_spi_pm_ops, -+ } -+}; -+ -+module_pci_driver(phytium_spi_pci_driver); -+ -+MODULE_AUTHOR("Yiqun Zhang "); -+MODULE_DESCRIPTION("PCI Driver for Phytium SPI controller core"); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/spi/spi-phytium-plat.c b/drivers/spi/spi-phytium-plat.c -new file mode 100644 -index 000000000..57593cd0e ---- /dev/null -+++ b/drivers/spi/spi-phytium-plat.c -@@ -0,0 +1,204 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SPI core controller platform driver. -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "spi-phytium.h" -+ -+#define DRIVER_NAME "phytium_spi" -+ -+static int phytium_spi_probe(struct platform_device *pdev) -+{ -+ struct phytium_spi *fts; -+ struct resource *mem; -+ int ret; -+ int num_cs; -+ int cs_gpio; -+ int global_cs; -+ int i; -+ -+ fts = devm_kzalloc(&pdev->dev, sizeof(struct phytium_spi), -+ GFP_KERNEL); -+ if (!fts) -+ return -ENOMEM; -+ -+ mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ if (!mem) { -+ dev_err(&pdev->dev, "no mem resource?\n"); -+ return -EINVAL; -+ } -+ -+ fts->paddr = mem->start; -+ fts->regs = devm_ioremap_resource(&pdev->dev, mem); -+ if (IS_ERR(fts->regs)) { -+ dev_err(&pdev->dev, "SPI region map failed\n"); -+ return PTR_ERR(fts->regs); -+ } -+ -+ fts->irq = platform_get_irq(pdev, 0); -+ if (fts->irq < 0) { -+ dev_err(&pdev->dev, "no irq resource?\n"); -+ return fts->irq; /* -ENXIO */ -+ } -+ -+ if (pdev->dev.of_node) { -+ fts->clk = devm_clk_get(&pdev->dev, NULL); -+ -+ if (IS_ERR(fts->clk)) -+ return PTR_ERR(fts->clk); -+ ret = clk_prepare_enable(fts->clk); -+ if (ret) -+ return ret; -+ -+ fts->max_freq = clk_get_rate(fts->clk); -+ } else if (has_acpi_companion(&pdev->dev)) { -+ fts->max_freq = 48000000; -+ } -+ -+ fts->bus_num = pdev->id; -+ device_property_read_u32(&pdev->dev, "reg-io-width", &fts->reg_io_width); -+ -+ num_cs = 4; -+ device_property_read_u32(&pdev->dev, "num-cs", &num_cs); -+ fts->num_cs = num_cs; -+ -+ if (pdev->dev.of_node) { -+ int i; -+ -+ for (i = 0; i < fts->num_cs; i++) { -+ cs_gpio = of_get_named_gpio(pdev->dev.of_node, -+ "cs-gpios", i); -+ -+ if (cs_gpio == -EPROBE_DEFER) { -+ ret = cs_gpio; -+ goto out; -+ } -+ -+ if (gpio_is_valid(cs_gpio)) { -+ ret = devm_gpio_request(&pdev->dev, cs_gpio, -+ dev_name(&pdev->dev)); -+ if (ret) -+ goto out; -+ } -+ } -+ } else if(has_acpi_companion(&pdev->dev)) { -+ int n; -+ int *cs; -+ struct gpio_desc *gpiod; -+ -+ n = gpiod_count(&pdev->dev, "cs"); -+ -+ cs = devm_kcalloc(&pdev->dev, n, sizeof(int), GFP_KERNEL); -+ fts->cs = cs; -+ -+ for (i = 0; i < n; i++) { -+ gpiod = devm_gpiod_get_index_optional(&pdev->dev, "cs", i, -+ GPIOD_OUT_LOW); -+ -+ if (IS_ERR(gpiod)) { -+ ret = PTR_ERR(gpiod); -+ goto out; -+ } -+ -+ cs_gpio = desc_to_gpio(gpiod); -+ cs[i] = cs_gpio; -+ } -+ } -+ -+ device_property_read_u32(&pdev->dev, "global-cs", &global_cs); -+ fts->global_cs = global_cs; -+ -+ /* check is use dma transfer */ -+ if ((device_property_read_string_array(&pdev->dev, "dma-names", -+ NULL, 0) > 0) && -+ device_property_present(&pdev->dev, "dmas")) { -+ fts->dma_en = true; -+ phytium_spi_dmaops_set(fts); -+ } -+ -+ ret = phytium_spi_add_host(&pdev->dev, fts); -+ if (ret) -+ goto out; -+ -+ platform_set_drvdata(pdev, fts); -+ return 0; -+ -+out: -+ clk_disable_unprepare(fts->clk); -+ return ret; -+} -+ -+static int phytium_spi_remove(struct platform_device *pdev) -+{ -+ struct phytium_spi *fts = platform_get_drvdata(pdev); -+ -+ phytium_spi_remove_host(fts); -+ clk_disable_unprepare(fts->clk); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int spi_suspend(struct device *dev) -+{ -+ struct phytium_spi *fts = dev_get_drvdata(dev); -+ -+ return phytium_spi_suspend_host(fts); -+} -+ -+static int spi_resume(struct device *dev) -+{ -+ struct phytium_spi *fts = dev_get_drvdata(dev); -+ -+ return phytium_spi_resume_host(fts); -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_spi_pm_ops, spi_suspend, spi_resume); -+ -+static const struct of_device_id phytium_spi_of_match[] = { -+ { .compatible = "phytium,spi", .data = (void *)0 }, -+ { /* end of table */} -+}; -+MODULE_DEVICE_TABLE(of, phytium_spi_of_match); -+ -+static const struct acpi_device_id phytium_spi_acpi_match[] = { -+ {"PHYT000E", 0}, -+ {} -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_spi_acpi_match); -+ -+static struct platform_driver phytium_spi_driver = { -+ .probe = phytium_spi_probe, -+ .remove = phytium_spi_remove, -+ .driver = { -+ .name = DRIVER_NAME, -+ .of_match_table = of_match_ptr(phytium_spi_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_spi_acpi_match), -+ .pm = &phytium_spi_pm_ops, -+ }, -+}; -+module_platform_driver(phytium_spi_driver); -+ -+MODULE_AUTHOR("Yiqun Zhang "); -+MODULE_DESCRIPTION("Platform Driver for Phytium SPI controller core"); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/spi/spi-phytium-qspi.c b/drivers/spi/spi-phytium-qspi.c -new file mode 100755 -index 000000000..3ac0baee9 ---- /dev/null -+++ b/drivers/spi/spi-phytium-qspi.c -@@ -0,0 +1,801 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium Quad SPI controller driver. -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+ -+ -+#define QSPI_FLASH_CAP_REG 0x00 -+#define QSPI_FLASH_CAP_NUM_SHIFT 3 -+#define QSPI_FLASH_CAP_NUM_MASK (0x3 << QSPI_FLASH_CAP_NUM_SHIFT) -+#define QSPI_FLASH_CAP_CAP_SHIFT 0 -+#define QSPI_FLASH_CAP_CAP_MASK (0x7 << QSPI_FLASH_CAP_CAP_SHIFT) -+ -+#define QSPI_RD_CFG_REG 0x04 -+#define QSPI_RD_CFG_RD_CMD_SHIFT 24 -+#define QSPI_RD_CFG_RD_CMD_MASK (0xff << QSPI_RD_CFG_RD_CMD_SHIFT) -+#define QSPI_RD_CFG_RD_THROUGH_SHIFT 23 -+#define QSPI_RD_CFG_RD_THROUGH_MASK (0x1 << QSPI_RD_CFG_RD_THROUGH_SHIFT) -+#define QSPI_RD_CFG_RD_TRANSFER_SHIFT 20 -+#define QSPI_RD_CFG_RD_TRANSFER_MASK (0x7 << QSPI_RD_CFG_RD_TRANSFER_SHIFT) -+#define QSPI_RD_CFG_RD_ADDR_SEL_SHIFT 19 -+#define QSPI_RD_CFG_RD_ADDR_SEL_MASK (0x1 << QSPI_RD_CFG_RD_ADDR_SEL_SHIFT) -+#define QSPI_RD_CFG_RD_LATENCY_SHIFT 18 -+#define QSPI_RD_CFG_RD_LATENCY_MASK (0x1 << QSPI_RD_CFG_RD_LATENCY_SHIFT) -+#define QSPI_RD_CFG_MODE_BYTE_SHIFT 17 -+#define QSPI_RD_CFG_MODE_BYTE_MASK (0x1 << QSPI_RD_CFG_MODE_BYTE_SHIFT) -+#define QSPI_RD_CFG_CMD_SIGN_SHIFT 9 -+#define QSPI_RD_CFG_CMD_SIGN_MASK (0xff << QSPI_RD_CFG_CMD_SIGN_SHIFT) -+#define QSPI_RD_CFG_DUMMY_SHIFT 4 -+#define QSPI_RD_CFG_DUMMY_MASK (0x1f << QSPI_RD_CFG_DUMMY_SHIFT) -+#define QSPI_RD_CFG_D_BUFFER_SHIFT 3 -+#define QSPI_RD_CFG_D_BUFFER_MASK (0x1 << QSPI_RD_CFG_D_BUFFER_SHIFT) -+#define QSPI_RD_CFG_RD_SCK_SEL_SHIFT 0 -+#define QSPI_RD_CFG_RD_SCK_SEL_MASK (0x7 << QSPI_RD_CFG_RD_SCK_SEL_SHIFT) -+ -+#define QSPI_WR_CFG_REG 0x08 -+#define QSPI_WR_CFG_WR_CMD_SHIFT 24 -+#define QSPI_WR_CFG_WR_CMD_MASK (0xff << QSPI_WR_CFG_WR_CMD_SHIFT) -+#define QSPI_WR_CFG_WR_WAIT_SHIFT 9 -+#define QSPI_WR_CFG_WR_WAIT_MASK (0x01 << QSPI_WR_CFG_WR_WAIT_SHIFT) -+#define QSPI_WR_CFG_WR_THROUGH_SHIFT 8 -+#define QSPI_WR_CFG_WR_THROUGH_MASK (0x01 << QSPI_WR_CFG_WR_THROUGH_SHIFT) -+#define QSPI_WR_CFG_WR_TRANSFER_SHIFT 5 -+#define QSPI_WR_CFG_WR_TRANSFER_MASK (0X7 << QSPI_WR_CFG_WR_TRANSFER_SHIFT) -+#define QSPI_WR_CFG_WR_ADDR_SEL_SHIFT 4 -+#define QSPI_WR_CFG_WR_ADDR_SEL_MASK (0x1 << QSPI_WR_CFG_WR_ADDR_SEL_SHIFT) -+#define QSPI_WR_CFG_WR_MODE_SHIFT 3 -+#define QSPI_WR_CFG_WR_MODE_MASK (0x1 << QSPI_WR_CFG_WR_MODE_SHIFT) -+#define QSPI_WR_CFG_WR_SCK_SEL_SHIFT 0 -+#define QSPI_WR_CFG_WR_SCK_SEL_MASK (0x7 << QSPI_WR_CFG_WR_SCK_SEL_SHIFT) -+ -+#define QSPI_FLUSH_REG 0x0c -+#define QSPI_FLUSH_EN (0x1 << 0) -+ -+#define QSPI_CMD_PORT_REG 0x10 -+#define QSPI_CMD_PORT_CMD_SHIFT 24 -+#define QSPI_CMD_PORT_CMD_MASK (0xff << QSPI_CMD_PORT_CMD_SHIFT) -+#define QSPI_CMD_PORT_WAIT_SHIFT 22 -+#define QSPI_CMD_PORT_WAIT_MASK (0x1 << QSPI_CMD_PORT_WAIT_SHIFT) -+#define QSPI_CMD_PORT_THROUGH_SHIFT 21 -+#define QSPI_CMD_PORT_THROUGH_MASK (0x1 << QSPI_CMD_PORT_THROUGH_SHIFT) -+#define QSPI_CMD_PORT_CS_SHIFT 19 -+#define QSPI_CMD_PORT_CS_MASK (0x3 << QSPI_CMD_PORT_CS_SHIFT) -+#define QSPI_CMD_PORT_TRANSFER_SHIFT 16 -+#define QSPI_CMD_PORT_TRANSFER_MASK (0x7 << QSPI_CMD_PORT_TRANSFER_SHIFT) -+#define QSPI_CMD_PORT_CMD_ADDR_SHIFT 15 -+#define QSPI_CMD_PORT_CMD_ADDR_MASK (0x1 << QSPI_CMD_PORT_CMD_ADDR_SHIFT) -+#define QSPI_CMD_PORT_LATENCY_SHIFT 14 -+#define QSPI_CMD_PORT_LATENCY_MASK (0x1 << QSPI_CMD_PORT_LATENCY_SHIFT) -+#define QSPI_CMD_PORT_DATA_XFER_SHIFT 13 -+#define QSPI_CMD_PORT_DATA_XFER_MASK (0x1 << QSPI_CMD_PORT_DATA_XFER_SHIFT) -+#define QSPI_CMD_PORT_ADDR_SEL_SHIFT 12 -+#define QSPI_CMD_PORT_ADDR_SEL_MASK (0x1 << QSPI_CMD_PORT_ADDR_SEL_SHIFT) -+#define QSPI_CMD_PORT_DUMMY_SHIFT 7 -+#define QSPI_CMD_PORT_DUMMY_MASK (0x1f << QSPI_CMD_PORT_DUMMY_SHIFT) -+#define QSPI_CMD_PORT_P_BUFFER_SHIFT 6 -+#define QSPI_CMD_PORT_P_BUFFER_MASK (0x1 << QSPI_CMD_PORT_P_BUFFER_SHIFT) -+#define QSPI_CMD_PORT_RW_NUM_SHIFT 3 -+#define QSPI_CMD_PORT_RW_NUM_MASK (0x7 << QSPI_CMD_PORT_RW_NUM_SHIFT) -+#define QSPI_CMD_PORT_SCK_SEL_SHIFT 0 -+#define QSPI_CMD_PORT_SCK_SEL_MASK (0x7 << QSPI_CMD_PORT_SCK_SEL_SHIFT) -+ -+#define QSPI_ADDR_PORT_REG 0x14 -+#define QSPI_HD_PORT_REG 0x18 -+#define QSPI_LD_PORT_REG 0x1c -+ -+#define QSPI_FUN_SET_REG 0x20 -+#define QSPI_FUN_SET_HOLD_SHIFT 24 -+#define QSPI_FUN_SET_HOLD_MASK (0xff << QSPI_FUN_SET_HOLD_SHIFT) -+#define QSPI_FUN_SET_SETUP_SHIFT 16 -+#define QSPI_FUN_SET_SETUP_MASK (0xff << QSPI_FUN_SET_SETUP_SHIFT) -+#define QSPI_FUN_SET_DELAY_SHIFT 0 -+#define QSPI_FUN_SET_DELAY_MASK (0xffff << QSPI_FUN_SET_DELAY_SHIFT) -+ -+#define QSPI_WIP_REG 0x24 -+#define QSPI_WIP_W_CMD_SHIFT 24 -+#define QSPI_WIP_W_CMD_MASK (0xff << QSPI_WIP_W_CMD_SHIFT) -+#define QSPI_WIP_W_TRANSFER_SHIFT 3 -+#define QSPI_WIP_W_TRANSFER_MASK (0x3 << QSPI_WIP_W_TRANSFER_SHIFT) -+#define QSPI_WIP_W_SCK_SEL_SHIFT 0 -+#define QSPI_WIP_W_SCK_SEL_MASK (0x7 << QSPI_WIP_W_SCK_SEL_SHIFT) -+ -+#define QSPI_WP_REG 0x28 -+#define QSPI_WP_EN_SHIFT 17 -+#define QSPI_WP_EN_MASK (0x1 << QSPI_WP_EN_SHIFT) -+#define QSPI_WP_IO2_SHIFT 16 -+#define QSPI_WP_IO2_MASK (0x1 << QSPI_WP_IO2_SHIFT) -+#define QSPI_WP_HOLD_SHIFT 8 -+#define QSPI_WP_HOLD_MASK (0xff << QSPI_WP_HOLD_SHIFT) -+#define QSPI_WP_SETUP_SHIFT 0 -+#define QSPI_WP_SETUP_MASK (0xff << QSPI_WP_SETUP_SHIFT) -+ -+#define QSPI_MODE_REG 0x2c -+#define QSPI_MODE_VALID_SHIFT 8 -+#define QSPI_MODE_VALID_MASK (0xff << QSPI_MODE_VALID_SHIFT) -+#define QSPI_MODE_SHIFT 0 -+#define QSPI_MODE_MASK (0xff << QSPI_MODE_SHIFT) -+ -+#define PHYTIUM_QSPI_MAX_NORCHIP 4 -+#define PHYTIUM_QSPI_MAX_MMAP_SZ (SZ_256M * PHYTIUM_QSPI_MAX_NORCHIP) -+#define PHYTIUM_QSPI_MAX_XFER_SZ 8 -+#define PHYTIUM_QSPI_DEFAULT_SCK_SEL 5 -+ -+#define XFER_PROTO_1_1_1 0x0 -+#define XFER_PROTO_1_1_2 0x1 -+#define XFER_PROTO_1_1_4 0x2 -+#define XFER_PROTO_1_2_2 0x3 -+#define XFER_PROTO_1_4_4 0x4 -+#define XFER_PROTO_2_2_2 0x5 -+#define XFER_PROTO_4_4_4 0x6 -+ -+struct phytium_qspi_flash { -+ u32 cs; -+ u32 clk_div; -+ -+ void __iomem *base; -+ resource_size_t size; -+ struct spi_device *spi; -+}; -+ -+struct phytium_qspi { -+ struct device *dev; -+ struct spi_controller *ctrl; -+ -+ void __iomem *io_base; -+ void __iomem *mm_base; -+ resource_size_t mm_size; -+ resource_size_t used_size; -+ -+ struct clk *clk; -+ u32 clk_rate; -+ -+ struct phytium_qspi_flash flash[PHYTIUM_QSPI_MAX_NORCHIP]; -+ u8 fnum; -+ bool nodirmap; -+}; -+ -+static bool phytium_qspi_check_buswidth(u8 width) -+{ -+ switch (width) { -+ case 1: -+ case 2: -+ case 4: -+ return 0; -+ } -+ -+ return -ENOTSUPP; -+} -+ -+static uint phytium_spi_nor_clac_clk_div(int div) -+{ -+ uint clk_div = 0; -+ -+ if (div <= 2) -+ clk_div = 1; -+ else if (div <= 4) -+ clk_div = 2; -+ else if (div <= 8) -+ clk_div = 3; -+ else if (div <= 16) -+ clk_div = 4; -+ else if (div <= 32) -+ clk_div = 5; -+ else if (div <= 64) -+ clk_div = 6; -+ else if (div <= 128) -+ clk_div = 7; -+ else -+ clk_div = 65535; -+ -+ return clk_div; -+} -+ -+static int phytium_spi_nor_protocol_encode(const struct spi_mem_op *op, u32 *code) -+{ -+ int ret = 0; -+ -+ if (op->cmd.buswidth == 1 && -+ op->addr.buswidth == 1 && -+ op->data.buswidth == 1) -+ *code = XFER_PROTO_1_1_1; -+ else if (op->cmd.buswidth == 1 && -+ op->addr.buswidth == 1 && -+ op->data.buswidth == 2) -+ *code = XFER_PROTO_1_1_2; -+ else if (op->cmd.buswidth == 1 && -+ op->addr.buswidth == 1 && -+ op->data.buswidth == 4) -+ *code = XFER_PROTO_1_1_4; -+ else if (op->cmd.buswidth == 1 && -+ op->addr.buswidth == 2 && -+ op->data.buswidth == 2) -+ *code = XFER_PROTO_1_2_2; -+ else if (op->cmd.buswidth == 1 && -+ op->addr.buswidth == 4 && -+ op->data.buswidth == 4) -+ *code = XFER_PROTO_1_4_4; -+ else if (op->cmd.buswidth == 2 && -+ op->addr.buswidth == 2 && -+ op->data.buswidth == 2) -+ *code = XFER_PROTO_2_2_2; -+ else if (op->cmd.buswidth == 4 && -+ op->addr.buswidth == 4 && -+ op->data.buswidth == 4) -+ *code = XFER_PROTO_4_4_4; -+ else -+ *code = XFER_PROTO_1_1_1; -+ -+ return ret; -+} -+ -+static int phytium_qspi_flash_capacity_encode(u32 size, u32 *cap) -+{ -+ int ret = 0; -+ -+ switch (size) { -+ case SZ_4M: -+ *cap = 0x0; -+ break; -+ case SZ_8M: -+ *cap = 0x1; -+ break; -+ case SZ_16M: -+ *cap = 0x2; -+ break; -+ case SZ_32M: -+ *cap = 0x3; -+ break; -+ case SZ_64M: -+ *cap = 0x4; -+ break; -+ case SZ_128M: -+ *cap = 0x5; -+ break; -+ case SZ_256M: -+ *cap = 0x6; -+ break; -+ case SZ_512M: -+ *cap = 0x7; -+ break; -+ default: -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+static int phytium_qspi_write_port(struct phytium_qspi *qspi, -+ const u8 *buf, const size_t len) -+{ -+ u32 bouncebuf[2] = { 0 }; -+ -+ if (len > PHYTIUM_QSPI_MAX_XFER_SZ) { -+ dev_err(qspi->dev, "WRITE data exceeds 8 bytes.\n"); -+ return -EINVAL; -+ } -+ -+ memcpy(bouncebuf, buf, len); -+ -+ if (len > 4) -+ writel_relaxed(bouncebuf[1], qspi->io_base + QSPI_HD_PORT_REG); -+ writel_relaxed(bouncebuf[0], qspi->io_base + QSPI_LD_PORT_REG); -+ -+ return 0; -+} -+ -+static int phytium_qspi_read_port(struct phytium_qspi *qspi, -+ u8 *buf, size_t len) -+{ -+ u32 bouncebuf[2] = { 0 }; -+ -+ if (len > PHYTIUM_QSPI_MAX_XFER_SZ) { -+ dev_err(qspi->dev, "READ data exceeds 8 bytes.\n"); -+ return -EINVAL; -+ } -+ -+ /* Dummy write to LD_PORT register and issue READ ops*/ -+ writel_relaxed(0, qspi->io_base + QSPI_LD_PORT_REG); -+ -+ /* Read data */ -+ bouncebuf[0] = readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); -+ if (len > 4) -+ bouncebuf[1] = readl_relaxed(qspi->io_base + QSPI_HD_PORT_REG); -+ -+ memcpy(buf, bouncebuf, len); -+ -+ return 0; -+} -+ -+static int phytium_qspi_adjust_op_size(struct spi_mem *mem, -+ struct spi_mem_op *op) -+{ -+ if (op->data.nbytes > PHYTIUM_QSPI_MAX_XFER_SZ) -+ op->data.nbytes = PHYTIUM_QSPI_MAX_XFER_SZ; -+ -+ return 0; -+} -+ -+static bool phytium_qspi_supports_op(struct spi_mem *mem, -+ const struct spi_mem_op *op) -+{ -+ int ret; -+ -+ ret = phytium_qspi_check_buswidth(op->cmd.buswidth); -+ -+ if (op->addr.nbytes) -+ ret |= phytium_qspi_check_buswidth(op->addr.buswidth); -+ -+ if (op->dummy.nbytes) -+ ret |= phytium_qspi_check_buswidth(op->dummy.buswidth); -+ -+ if (op->data.nbytes) -+ ret |= phytium_qspi_check_buswidth(op->data.buswidth); -+ -+ if (ret) -+ return false; -+ -+ /* Max 32 dummy clock cycles supported */ -+ if (op->dummy.nbytes && -+ (op->dummy.nbytes * 8 / op->dummy.buswidth > 32)) -+ return false; -+ -+ return spi_mem_default_supports_op(mem, op); -+} -+ -+static int phytium_qspi_exec_op(struct spi_mem *mem, -+ const struct spi_mem_op *op) -+{ -+ struct phytium_qspi *qspi = spi_controller_get_devdata(mem->spi->master); -+ struct phytium_qspi_flash *flash = &qspi->flash[mem->spi->chip_select]; -+ u32 cmd, transfer; -+ int ret; -+ -+ dev_dbg(qspi->dev, "cmd:%#x mode: %d.%d.%d.%d addr:%#llx len:%#x\n", -+ op->cmd.opcode, op->cmd.buswidth, op->addr.buswidth, -+ op->dummy.buswidth, op->data.buswidth, op->addr.val, -+ op->data.nbytes); -+ -+ cmd = op->cmd.opcode << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ ret = phytium_spi_nor_protocol_encode(op, &transfer); -+ if (ret) { -+ dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); -+ goto out; -+ } -+ cmd |= transfer << QSPI_CMD_PORT_TRANSFER_SHIFT; -+ -+ if (op->addr.nbytes) { -+ cmd |= QSPI_CMD_PORT_CMD_ADDR_MASK; -+ if (op->addr.nbytes == 4) -+ cmd |= QSPI_CMD_PORT_ADDR_SEL_MASK; -+ -+ /* Write target address to ADDR_PORT register */ -+ writel_relaxed(op->addr.val, qspi->io_base + QSPI_ADDR_PORT_REG); -+ } -+ -+ if (op->dummy.nbytes) { -+ cmd |= QSPI_CMD_PORT_LATENCY_MASK; -+ cmd |= ((op->dummy.nbytes * 8) / op->dummy.buswidth) << -+ QSPI_CMD_PORT_LATENCY_SHIFT; -+ } -+ -+ if (op->data.nbytes) { -+ cmd |= QSPI_CMD_PORT_DATA_XFER_MASK; -+ cmd &= ~QSPI_CMD_PORT_P_BUFFER_MASK; -+ cmd |= (op->data.nbytes-1) << QSPI_CMD_PORT_RW_NUM_SHIFT; -+ } -+ -+ cmd |= flash->clk_div; -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ -+ if (op->data.dir == SPI_MEM_DATA_IN) { -+ ret = phytium_qspi_read_port(qspi, op->data.buf.in, op->data.nbytes); -+ if (ret) { -+ dev_err(qspi->dev, "Failed to read data from the port.\n"); -+ goto out; -+ } -+ } else if (op->data.dir == SPI_MEM_DATA_OUT) { -+ ret = phytium_qspi_write_port(qspi, op->data.buf.out, op->data.nbytes); -+ if (ret) { -+ dev_err(qspi->dev, "Failed to write data to the port.\n"); -+ goto out; -+ } -+ } else { -+ /* Dummy write to LD_PORT register and issue the command */ -+ writel_relaxed(0, qspi->io_base + QSPI_LD_PORT_REG); -+ } -+ -+out: -+ return ret; -+} -+ -+static int phytium_qspi_dirmap_create(struct spi_mem_dirmap_desc *desc) -+{ -+ struct spi_device *spi = desc->mem->spi; -+ struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); -+ struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; -+ struct spi_nor *nor = spi_mem_get_drvdata(desc->mem); -+ u32 cmd, transfer; -+ int ret = 0; -+ -+ if (!qspi->mm_base || !qspi->mm_size) { -+ ret = -EOPNOTSUPP; -+ goto out; -+ } -+ -+ if (!flash->base) { -+ flash->base = qspi->mm_base + qspi->used_size; -+ qspi->used_size += nor->mtd.size; -+ } -+ -+ /* Setup RD/WR_CFG register */ -+ if (desc->info.op_tmpl.data.dir == SPI_MEM_DATA_IN) { -+ cmd = desc->info.op_tmpl.cmd.opcode << QSPI_RD_CFG_RD_CMD_SHIFT; -+ ret = phytium_spi_nor_protocol_encode(&desc->info.op_tmpl, &transfer); -+ if (ret) { -+ dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); -+ goto out; -+ } -+ cmd |= transfer << QSPI_RD_CFG_RD_TRANSFER_SHIFT; -+ -+ if (desc->info.op_tmpl.addr.nbytes == 4) -+ cmd |= QSPI_RD_CFG_RD_ADDR_SEL_MASK; -+ -+ if (nor->read_dummy) { -+ cmd |= QSPI_RD_CFG_RD_LATENCY_MASK; -+ cmd |= (nor->read_dummy - 1) << QSPI_RD_CFG_DUMMY_SHIFT; -+ } -+ -+ cmd |= QSPI_RD_CFG_D_BUFFER_MASK; -+ cmd |= flash->clk_div & QSPI_RD_CFG_RD_SCK_SEL_MASK; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_RD_CFG_REG); -+ -+ dev_dbg(qspi->dev, "Create read dirmap and setup RD_CFG_REG [%#x].\n", cmd); -+ } else if (desc->info.op_tmpl.data.dir == SPI_MEM_DATA_OUT) { -+ cmd = desc->info.op_tmpl.cmd.opcode << QSPI_WR_CFG_WR_CMD_SHIFT; -+ ret = phytium_spi_nor_protocol_encode(&desc->info.op_tmpl, &transfer); -+ if (ret) { -+ dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); -+ goto out; -+ } -+ cmd |= transfer << QSPI_WR_CFG_WR_TRANSFER_SHIFT; -+ -+ if (desc->info.op_tmpl.addr.nbytes == 4) -+ cmd |= QSPI_WR_CFG_WR_ADDR_SEL_MASK; -+ -+ cmd |= QSPI_WR_CFG_WR_MODE_MASK; -+ cmd |= flash->clk_div & QSPI_WR_CFG_WR_SCK_SEL_MASK; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_WR_CFG_REG); -+ -+ dev_dbg(qspi->dev, "Create write dirmap and setup WR_CFG_REG [%#x].\n", cmd); -+ } else { -+ ret = -EINVAL; -+ } -+ -+out: -+ return ret; -+} -+ -+static ssize_t phytium_qspi_dirmap_read(struct spi_mem_dirmap_desc *desc, -+ u64 offs, size_t len, void *buf) -+{ -+ struct spi_device *spi = desc->mem->spi; -+ struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); -+ struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; -+ -+ void __iomem *src = flash->base + offs; -+ u8 *buf_rx = buf; -+ -+ memcpy_fromio(buf_rx, src, len); -+ -+ return len; -+} -+ -+static ssize_t phytium_qspi_dirmap_write(struct spi_mem_dirmap_desc *desc, -+ u64 offs, size_t len, const void *buf) -+{ -+ struct spi_device *spi = desc->mem->spi; -+ struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); -+ struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; -+ -+ void __iomem *dst = flash->base + offs; -+ void __iomem *addr; -+ int i; -+ size_t mask = 0x03; -+ u_char tmp[4] = {0}; -+ -+ if (offs & 0x03) { -+ dev_err(qspi->dev, "Addr not four-byte aligned!\n"); -+ return -EINVAL; -+ } -+ -+ for (i = 0; i < len / 4; i++) -+ writel_relaxed(*(u32 *)(buf + 4 * i), dst + 4 * i); -+ -+ if (len & mask) { -+ addr = dst + (len & ~mask); -+ memcpy(tmp, buf + (len & ~mask), len & mask); -+ writel_relaxed(*(u32 *)(tmp), addr); -+ } -+ -+ //write cache data to flash -+ writel_relaxed(QSPI_FLUSH_EN, qspi->io_base + QSPI_FLUSH_REG); -+ -+ return len; -+} -+ -+static int phytium_qspi_setup(struct spi_device *spi) -+{ -+ struct spi_controller *ctrl = spi->master; -+ struct phytium_qspi *qspi = spi_controller_get_devdata(ctrl); -+ struct phytium_qspi_flash *flash; -+ uint clk_div; -+ -+ if (ctrl->busy) -+ return -EBUSY; -+ -+ flash = &qspi->flash[spi->chip_select]; -+ -+ flash->cs = spi->chip_select; -+ flash->spi = spi; -+ if (flash->cs >= PHYTIUM_QSPI_MAX_NORCHIP) { -+ dev_err(qspi->dev, "Flash CS is out of range.\n"); -+ return -EINVAL; -+ } -+ qspi->fnum++; -+ -+ -+ if (spi->max_speed_hz) { -+ clk_div = DIV_ROUND_UP(qspi->clk_rate, spi->max_speed_hz); -+ flash->clk_div = phytium_spi_nor_clac_clk_div(clk_div); -+ if (flash->clk_div == 65535) { -+ dev_err(qspi->dev, "qspi maximum frequency setting is error.\n"); -+ return -EINVAL; -+ } -+ } else -+ flash->clk_div = PHYTIUM_QSPI_DEFAULT_SCK_SEL; -+ -+ return 0; -+} -+ -+static struct spi_controller_mem_ops phytium_qspi_mem_ops = { -+ .adjust_op_size = phytium_qspi_adjust_op_size, -+ .supports_op = phytium_qspi_supports_op, -+ .exec_op = phytium_qspi_exec_op, -+ .dirmap_create = phytium_qspi_dirmap_create, -+ .dirmap_read = phytium_qspi_dirmap_read, -+ .dirmap_write = phytium_qspi_dirmap_write, -+}; -+ -+/** -+ * Direct mapping is supported only when all flashes under the controller -+ * are of the same size and the mapping address is continuous. For those -+ * cases which flashes are of different sizes, the driver offered a non-dirmap -+ * mem_ops with which read/write ops is executed through command port. -+ */ -+static struct spi_controller_mem_ops phytium_qspi_mem_ops_nodirmap = { -+ .adjust_op_size = phytium_qspi_adjust_op_size, -+ .supports_op = phytium_qspi_supports_op, -+ .exec_op = phytium_qspi_exec_op, -+}; -+ -+/** -+ * phytium_qspi_probe - Probe method for the QSPI driver -+ * @pdev: Pointer to the platform_device structure -+ * -+ * This function initializes the driver data structures and the hardware. -+ * -+ * Return: 0 on success and error value on failure -+ */ -+static int phytium_qspi_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct spi_controller *ctrl; -+ struct resource *res; -+ struct phytium_qspi *qspi; -+ int i, ret; -+ u32 flash_cap; -+ struct spi_mem *mem; -+ struct spi_nor *nor; -+ -+ ctrl = spi_alloc_master(dev, sizeof(*qspi)); -+ if (!ctrl) -+ return -ENOMEM; -+ -+ ctrl->mode_bits = SPI_CPOL | SPI_CPHA | -+ SPI_RX_DUAL | SPI_RX_QUAD | -+ SPI_TX_DUAL | SPI_TX_QUAD; -+ ctrl->setup = phytium_qspi_setup; -+ ctrl->num_chipselect = PHYTIUM_QSPI_MAX_NORCHIP; -+ ctrl->dev.of_node = dev->of_node; -+ -+ qspi = spi_controller_get_devdata(ctrl); -+ qspi->ctrl = ctrl; -+ -+ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi"); -+ qspi->io_base = devm_ioremap_resource(dev, res); -+ if (IS_ERR(qspi->io_base)) { -+ ret = PTR_ERR(qspi->io_base); -+ goto probe_master_put; -+ } -+ -+ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi_mm"); -+ qspi->mm_base = devm_ioremap_resource(dev, res); -+ if (IS_ERR(qspi->mm_base)) { -+ ret = PTR_ERR(qspi->mm_base); -+ goto probe_master_put; -+ } -+ -+ qspi->mm_size = resource_size(res); -+ if (qspi->mm_size > PHYTIUM_QSPI_MAX_MMAP_SZ) { -+ ret = -EINVAL; -+ goto probe_master_put; -+ } -+ qspi->used_size = 0; -+ -+ qspi->clk = devm_clk_get(dev, NULL); -+ if (IS_ERR(qspi->clk)) { -+ ret = PTR_ERR(qspi->clk); -+ goto probe_master_put; -+ } -+ -+ qspi->clk_rate = clk_get_rate(qspi->clk); -+ if (!qspi->clk_rate) { -+ ret = -EINVAL; -+ goto probe_master_put; -+ } -+ -+ pm_runtime_enable(dev); -+ ret = pm_runtime_get_sync(dev); -+ if (ret < 0) { -+ pm_runtime_put_noidle(dev); -+ goto probe_master_put; -+ } -+ -+ ret = clk_prepare_enable(qspi->clk); -+ if (ret) { -+ dev_err(dev, "Failed to enable PCLK of the controller.\n"); -+ goto probe_clk_failed; -+ } -+ -+ qspi->nodirmap = device_property_present(dev, "no-direct-mapping"); -+ ctrl->mem_ops = qspi->nodirmap ? -+ &phytium_qspi_mem_ops_nodirmap : -+ &phytium_qspi_mem_ops; -+ -+ qspi->dev = dev; -+ platform_set_drvdata(pdev, qspi); -+ -+ ret = devm_spi_register_controller(dev, ctrl); -+ if (ret) { -+ dev_err(dev, "failed to register SPI controller: %d\n", ret); -+ goto probe_setup_failed; -+ } -+ -+ if (!qspi->nodirmap) { -+ /* -+ * The controller supports direct mapping access only if all -+ * flashes are of same size. -+ */ -+ -+ i = 0; -+ for (i = 0; qspi->fnum > i && i < PHYTIUM_QSPI_MAX_NORCHIP; i++) { -+ if (qspi->flash[i].spi) { -+ mem = spi_get_drvdata(qspi->flash[i].spi); -+ if (mem) { -+ nor = spi_mem_get_drvdata(mem); -+ if (nor) -+ qspi->flash[i].size = nor->mtd.size; -+ } -+ } -+ } -+ -+ for (i = 1; qspi->fnum > i && i < PHYTIUM_QSPI_MAX_NORCHIP; i++) { -+ if (qspi->flash[i].size != qspi->flash[0].size) { -+ dev_err(dev, "Flashes are of different sizes.\n"); -+ ret = -EINVAL; -+ goto probe_setup_failed; -+ } -+ } -+ -+ ret = phytium_qspi_flash_capacity_encode(qspi->flash[0].size, -+ &flash_cap); -+ if (ret) { -+ dev_err(dev, "Flash size is invalid.\n"); -+ goto probe_setup_failed; -+ } -+ -+ flash_cap |= qspi->fnum << QSPI_FLASH_CAP_NUM_SHIFT; -+ -+ writel_relaxed(flash_cap, qspi->io_base + QSPI_FLASH_CAP_REG); -+ } -+ -+ return 0; -+ -+probe_setup_failed: -+ clk_disable_unprepare(qspi->clk); -+probe_clk_failed: -+ pm_runtime_put_sync(dev); -+ pm_runtime_disable(dev); -+probe_master_put: -+ -+ return ret; -+} -+ -+/** -+ * phytium_qspi_remove - Remove method for the QSPI driver -+ * @pdev: Pointer to the platform_device structure -+ * -+ * This function is called if a device is physically removed from the system -+ * or if the driver module is being unloaded. It free all resources allocated -+ * to the device. -+ * -+ * Return: 0 on success and error value on failure -+ */ -+static int phytium_qspi_remove(struct platform_device *pdev) -+{ -+ struct phytium_qspi *qspi = platform_get_drvdata(pdev); -+ -+ clk_disable_unprepare(qspi->clk); -+ -+ pm_runtime_put_sync(&pdev->dev); -+ pm_runtime_disable(&pdev->dev); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_qspi_suspend(struct device *dev) -+{ -+ return pm_runtime_force_suspend(dev); -+} -+ -+static int __maybe_unused phytium_qspi_resume(struct device *dev) -+{ -+ return pm_runtime_force_resume(dev); -+} -+ -+static const struct dev_pm_ops phytium_qspi_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_qspi_suspend, -+ phytium_qspi_resume) -+}; -+ -+static const struct of_device_id phytium_qspi_of_match[] = { -+ { .compatible = "phytium,qspi-nor" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_qspi_of_match); -+ -+static struct platform_driver phytium_qspi_driver = { -+ .probe = phytium_qspi_probe, -+ .remove = phytium_qspi_remove, -+ .driver = { -+ .name = "phytium-qspi", -+ .of_match_table = of_match_ptr(phytium_qspi_of_match), -+ .pm = &phytium_qspi_pm_ops, -+ }, -+}; -+module_platform_driver(phytium_qspi_driver); -+ -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium Quad SPI driver"); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/spi/spi-phytium.c b/drivers/spi/spi-phytium.c -new file mode 100644 -index 000000000..4fae2cd2c ---- /dev/null -+++ b/drivers/spi/spi-phytium.c -@@ -0,0 +1,509 @@ -+ // SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SPI core controller driver. -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "spi-phytium.h" -+ -+struct phytium_spi_chip { -+ u8 poll_mode; -+ u8 type; -+ void (*cs_control)(u32 command); -+}; -+ -+struct chip_data { -+ u8 cs; -+ u8 tmode; -+ u8 type; -+ -+ u8 poll_mode; -+ -+ u16 clk_div; -+ u32 speed_hz; -+ void (*cs_control)(u32 command); -+}; -+ -+static void phytium_spi_set_cs(struct spi_device *spi, bool enable) -+{ -+ struct phytium_spi *fts = spi_master_get_devdata(spi->master); -+ struct chip_data *chip = spi_get_ctldata(spi); -+ u32 origin; -+ -+ if (chip && chip->cs_control) -+ chip->cs_control(!enable); -+ -+ if (!enable) { -+ phytium_writel(fts, SER, BIT(spi->chip_select)); -+ if (fts->global_cs) { -+ origin = phytium_readl(fts, GCSR); -+ phytium_writel(fts, GCSR, origin | (1 << spi->chip_select)); -+ } -+ } else { -+ if (fts->global_cs) { -+ origin = phytium_readl(fts, GCSR); -+ phytium_writel(fts, GCSR, origin & ~(1 << spi->chip_select)); -+ } -+ } -+} -+ -+static inline u32 tx_max(struct phytium_spi *fts) -+{ -+ u32 tx_left, tx_room, rxtx_gap; -+ -+ tx_left = (fts->tx_end - fts->tx) / fts->n_bytes; -+ tx_room = fts->fifo_len - phytium_readl(fts, TXFLR); -+ -+ rxtx_gap = ((fts->rx_end - fts->rx) - (fts->tx_end - fts->tx)) -+ / fts->n_bytes; -+ -+ return min3(tx_left, tx_room, (u32) (fts->fifo_len - rxtx_gap)); -+} -+ -+static inline u32 rx_max(struct phytium_spi *fts) -+{ -+ u32 rx_left = (fts->rx_end - fts->rx) / fts->n_bytes; -+ -+ return min_t(u32, rx_left, phytium_readl(fts, RXFLR)); -+} -+ -+static void phytium_writer(struct phytium_spi *fts) -+{ -+ u32 max = tx_max(fts); -+ u16 txw = 0; -+ -+ while (max--) { -+ if (fts->tx_end - fts->len) { -+ if (fts->n_bytes == 1) -+ txw = *(u8 *)(fts->tx); -+ else -+ txw = *(u16 *)(fts->tx); -+ } -+ phytium_write_io_reg(fts, DR, txw); -+ fts->tx += fts->n_bytes; -+ } -+} -+ -+static void phytium_reader(struct phytium_spi *fts) -+{ -+ u32 max = rx_max(fts); -+ u16 rxw; -+ -+ while (max--) { -+ rxw = phytium_read_io_reg(fts, DR); -+ if (fts->rx_end - fts->len) { -+ if (fts->n_bytes == 1) -+ *(u8 *)(fts->rx) = rxw; -+ else -+ *(u16 *)(fts->rx) = rxw; -+ } -+ fts->rx += fts->n_bytes; -+ } -+} -+ -+int phytium_spi_check_status(struct phytium_spi *fts, bool raw) -+{ -+ u32 irq_status; -+ int ret = 0; -+ -+ if (raw) -+ irq_status = phytium_readl(fts, RISR); -+ else -+ irq_status = phytium_readl(fts, ISR); -+ -+ if (irq_status & INT_RXOI) { -+ dev_err(&fts->master->dev, "RX FIFO overflow detected\n"); -+ ret = -EIO; -+ } -+ -+ if (irq_status & INT_RXUI) { -+ dev_err(&fts->master->dev, "RX FIFO underflow detected\n"); -+ ret = -EIO; -+ } -+ -+ if (irq_status & INT_TXOI) { -+ dev_err(&fts->master->dev, "TX FIFO overflow detected\n"); -+ ret = -EIO; -+ } -+ -+ /* Generically handle the erroneous situation */ -+ if (ret) { -+ spi_reset_chip(fts); -+ if (fts->master->cur_msg) -+ fts->master->cur_msg->status = ret; -+ } -+ -+ return ret; -+} -+EXPORT_SYMBOL_GPL(phytium_spi_check_status); -+ -+static void int_error_stop(struct phytium_spi *fts, const char *msg) -+{ -+ spi_reset_chip(fts); -+ -+ dev_err(&fts->master->dev, "%s\n", msg); -+ fts->master->cur_msg->status = -EIO; -+ spi_finalize_current_transfer(fts->master); -+} -+ -+static irqreturn_t interrupt_transfer(struct phytium_spi *fts) -+{ -+ u16 irq_status = phytium_readl(fts, ISR); -+ -+ if (irq_status & (INT_TXOI | INT_RXOI | INT_RXUI)) { -+ phytium_readl(fts, ICR); -+ int_error_stop(fts, "interrupt_transfer: fifo overrun/underrun"); -+ return IRQ_HANDLED; -+ } -+ -+ phytium_reader(fts); -+ if (fts->rx_end == fts->rx) { -+ spi_mask_intr(fts, INT_TXEI); -+ spi_finalize_current_transfer(fts->master); -+ return IRQ_HANDLED; -+ } -+ if (irq_status & INT_TXEI) { -+ spi_mask_intr(fts, INT_TXEI); -+ phytium_writer(fts); -+ spi_umask_intr(fts, INT_TXEI); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static irqreturn_t phytium_spi_irq(int irq, void *dev_id) -+{ -+ struct spi_master *master = dev_id; -+ struct phytium_spi *fts = spi_master_get_devdata(master); -+ u16 irq_status = phytium_readl(fts, ISR) & 0x3f; -+ -+ if (!irq_status) -+ return IRQ_NONE; -+ -+ if (!master->cur_msg) { -+ spi_mask_intr(fts, INT_TXEI); -+ return IRQ_HANDLED; -+ } -+ -+ if (fts->transfer_handler) -+ return fts->transfer_handler(fts); -+ else -+ return IRQ_HANDLED; -+} -+ -+static int poll_transfer(struct phytium_spi *fts) -+{ -+ do { -+ phytium_writer(fts); -+ phytium_reader(fts); -+ cpu_relax(); -+ } while (fts->rx_end > fts->rx); -+ -+ return 0; -+} -+ -+static int phytium_spi_transfer_one(struct spi_master *master, -+ struct spi_device *spi, struct spi_transfer *transfer) -+{ -+ struct phytium_spi *fts = spi_master_get_devdata(master); -+ struct chip_data *chip = spi_get_ctldata(spi); -+ u8 imask = 0; -+ u16 txlevel = 0; -+ u16 clk_div; -+ u32 cr0; -+ int ret = 0; -+ -+ fts->dma_mapped = 0; -+ fts->tx = (void *)transfer->tx_buf; -+ fts->tx_end = fts->tx + transfer->len; -+ fts->rx = transfer->rx_buf; -+ fts->rx_end = fts->rx + transfer->len; -+ fts->len = transfer->len; -+ -+ spi_enable_chip(fts, 0); -+ -+ if (transfer->speed_hz != fts->current_freq) { -+ if (transfer->speed_hz != chip->speed_hz) { -+ clk_div = (fts->max_freq / transfer->speed_hz + 1) & -+ 0xfffe; -+ -+ chip->speed_hz = transfer->speed_hz; -+ chip->clk_div = clk_div; -+ } -+ fts->current_freq = transfer->speed_hz; -+ spi_set_clk(fts, chip->clk_div); -+ } -+ -+ if (transfer->bits_per_word == 8) { -+ fts->n_bytes = 1; -+ } else if (transfer->bits_per_word == 16) { -+ fts->n_bytes = 2; -+ } else { -+ return -EINVAL; -+ } -+ -+ cr0 = (transfer->bits_per_word - 1) -+ | (chip->type << FRF_OFFSET) -+ | (spi->mode << MODE_OFFSET) -+ | (chip->tmode << TMOD_OFFSET); -+ -+ if (chip->cs_control) { -+ if (fts->rx && fts->tx) -+ chip->tmode = TMOD_TR; -+ else if (fts->rx) -+ chip->tmode = TMOD_RO; -+ else -+ chip->tmode = TMOD_TO; -+ -+ cr0 &= ~TMOD_MASK; -+ cr0 |= (chip->tmode << TMOD_OFFSET); -+ } -+ -+ phytium_writel(fts, CTRLR0, cr0); -+ -+ /* check if current transfer is a DMA transcation */ -+ if (master->can_dma && master->can_dma(master, spi, transfer)) -+ fts->dma_mapped = master->cur_msg_mapped; -+ -+ spi_mask_intr(fts, 0xff); -+ -+ /* DMA setup */ -+ if (fts->dma_mapped) { -+ ret = fts->dma_ops->dma_setup(fts, transfer); -+ if (ret) -+ return ret; -+ } -+ -+ /* interrupt transfer mode setup */ -+ if (!chip->poll_mode && !fts->dma_mapped) { -+ txlevel = min_t(u16, fts->fifo_len / 2, fts->len / fts->n_bytes); -+ phytium_writel(fts, TXFLTR, txlevel); -+ -+ imask |= INT_TXEI | INT_TXOI | -+ INT_RXUI | INT_RXOI; -+ spi_umask_intr(fts, imask); -+ -+ fts->transfer_handler = interrupt_transfer; -+ } -+ -+ spi_enable_chip(fts, 1); -+ -+ if (fts->dma_mapped) -+ return fts->dma_ops->dma_transfer(fts, transfer); -+ -+ if (chip->poll_mode) -+ return poll_transfer(fts); -+ -+ return 1; -+} -+ -+static void phytium_spi_handle_err(struct spi_master *master, -+ struct spi_message *msg) -+{ -+ struct phytium_spi *fts = spi_master_get_devdata(master); -+ -+ if (fts->dma_mapped) -+ fts->dma_ops->dma_stop(fts); -+ -+ spi_reset_chip(fts); -+} -+ -+static int phytium_spi_setup(struct spi_device *spi) -+{ -+ struct phytium_spi_chip *chip_info = NULL; -+ struct chip_data *chip; -+ struct spi_master *master = spi->master; -+ struct phytium_spi *fts = spi_master_get_devdata(master); -+ int ret; -+ u32 cr0; -+ -+ spi_enable_chip(fts, 0); -+ -+ chip = spi_get_ctldata(spi); -+ if (!chip) { -+ chip = kzalloc(sizeof(struct chip_data), GFP_KERNEL); -+ if (!chip) -+ return -ENOMEM; -+ spi_set_ctldata(spi, chip); -+ } -+ -+ chip_info = spi->controller_data; -+ -+ if (chip_info) { -+ if (chip_info->cs_control) -+ chip->cs_control = chip_info->cs_control; -+ -+ chip->poll_mode = chip_info->poll_mode; -+ chip->type = chip_info->type; -+ } -+ -+ chip->tmode = 0; -+ -+ cr0 = (spi->bits_per_word - 1) | (chip->type << FRF_OFFSET) | -+ (spi->mode << MODE_OFFSET) | (chip->tmode << TMOD_OFFSET); -+ -+ phytium_writel(fts, CTRLR0, cr0); -+ -+ if (gpio_is_valid(spi->cs_gpio)) { -+ ret = gpio_direction_output(spi->cs_gpio, -+ !(spi->mode & SPI_CS_HIGH)); -+ if (ret) -+ return ret; -+ } -+ -+ spi_enable_chip(fts, 1); -+ -+ return 0; -+} -+ -+static void phytium_spi_cleanup(struct spi_device *spi) -+{ -+ struct chip_data *chip = spi_get_ctldata(spi); -+ -+ kfree(chip); -+ spi_set_ctldata(spi, NULL); -+} -+ -+static void spi_hw_init(struct device *dev, struct phytium_spi *fts) -+{ -+ spi_reset_chip(fts); -+ -+ if (!fts->fifo_len) { -+ u32 fifo; -+ -+ for (fifo = 1; fifo < 256; fifo++) { -+ phytium_writel(fts, TXFLTR, fifo); -+ if (fifo != phytium_readl(fts, TXFLTR)) -+ break; -+ } -+ phytium_writel(fts, TXFLTR, 0); -+ -+ fts->fifo_len = (fifo == 1) ? 0 : fifo; -+ dev_dbg(dev, "Detected FIFO size: %u bytes\n", fts->fifo_len); -+ } -+} -+ -+int phytium_spi_add_host(struct device *dev, struct phytium_spi *fts) -+{ -+ struct spi_master *master; -+ int ret; -+ -+ BUG_ON(fts == NULL); -+ -+ master = spi_alloc_master(dev, 0); -+ if (!master) -+ return -ENOMEM; -+ -+ fts->master = master; -+ fts->dma_addr = (dma_addr_t)(fts->paddr + DR); -+ snprintf(fts->name, sizeof(fts->name), "phytium_spi%d", fts->bus_num); -+ -+ spi_hw_init(dev, fts); -+ -+ ret = request_irq(fts->irq, phytium_spi_irq, IRQF_SHARED, fts->name, master); -+ if (ret < 0) { -+ dev_err(dev, "can not get IRQ\n"); -+ goto err_free_master; -+ } -+ -+ master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_LOOP; -+ master->bits_per_word_mask = SPI_BPW_MASK(8) | SPI_BPW_MASK(16); -+ master->bus_num = fts->bus_num; -+ master->num_chipselect = fts->num_cs; -+ master->setup = phytium_spi_setup; -+ master->cleanup = phytium_spi_cleanup; -+ master->set_cs = phytium_spi_set_cs; -+ master->transfer_one = phytium_spi_transfer_one; -+ master->handle_err = phytium_spi_handle_err; -+ master->max_speed_hz = fts->max_freq; -+ master->dev.of_node = dev->of_node; -+ master->dev.fwnode = dev->fwnode; -+ master->flags = SPI_MASTER_GPIO_SS; -+ master->cs_gpios = fts->cs; -+ -+ if (fts->dma_ops && fts->dma_ops->dma_init) { -+ ret = fts->dma_ops->dma_init(dev, fts); -+ if (ret) { -+ dev_warn(dev, "DMA init failed\n"); -+ } else { -+ master->can_dma = fts->dma_ops->can_dma; -+ master->flags |= SPI_CONTROLLER_MUST_TX; -+ } -+ } -+ -+ spi_master_set_devdata(master, fts); -+ ret = devm_spi_register_master(dev, master); -+ if (ret) { -+ dev_err(&master->dev, "problem registering spi master\n"); -+ goto err_exit; -+ } -+ -+ return 0; -+ -+err_exit: -+ if (fts->dma_ops && fts->dma_ops->dma_exit) -+ fts->dma_ops->dma_exit(fts); -+ spi_enable_chip(fts, 0); -+ free_irq(fts->irq, master); -+err_free_master: -+ spi_master_put(master); -+ return ret; -+} -+EXPORT_SYMBOL_GPL(phytium_spi_add_host); -+ -+void phytium_spi_remove_host(struct phytium_spi *fts) -+{ -+ if (fts->dma_ops && fts->dma_ops->dma_exit) -+ fts->dma_ops->dma_exit(fts); -+ spi_shutdown_chip(fts); -+ -+ free_irq(fts->irq, fts->master); -+} -+EXPORT_SYMBOL_GPL(phytium_spi_remove_host); -+ -+int phytium_spi_suspend_host(struct phytium_spi *fts) -+{ -+ int ret; -+ -+ ret = spi_controller_suspend(fts->master); -+ if (ret) -+ return ret; -+ -+ spi_shutdown_chip(fts); -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_spi_suspend_host); -+ -+int phytium_spi_resume_host(struct phytium_spi *fts) -+{ -+ int ret; -+ -+ spi_hw_init(&fts->master->dev, fts); -+ ret = spi_controller_resume(fts->master); -+ if (ret) -+ dev_err(&fts->master->dev, "fail to start queue (%d)\n", ret); -+ return ret; -+} -+EXPORT_SYMBOL_GPL(phytium_spi_resume_host); -+ -+MODULE_AUTHOR("Zhu Mingshuai "); -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Driver for Phytium SPI controller core"); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/spi/spi-phytium.h b/drivers/spi/spi-phytium.h -new file mode 100644 -index 000000000..003b08f8c ---- /dev/null -+++ b/drivers/spi/spi-phytium.h -@@ -0,0 +1,213 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+#ifndef PHYTIUM_SPI_HEADER_H -+#define PHYTIUM_SPI_HEADER_H -+ -+#include -+#include -+#include -+ -+#define CTRLR0 0x00 -+#define SSIENR 0x08 -+#define SER 0x10 -+#define BAUDR 0x14 -+#define TXFLTR 0x18 -+#define TXFLR 0x20 -+#define RXFLR 0x24 -+#define SR 0x28 -+#define IMR 0x2c -+#define ISR 0x30 -+#define RISR 0x34 -+#define ICR 0x48 -+#define DMACR 0x4C -+#define DMATDLR 0x50 -+#define DMARDLR 0x54 -+#define DR 0x60 -+#define GCSR 0x100 -+ -+#define FRF_OFFSET 4 -+#define MODE_OFFSET 6 -+#define TMOD_OFFSET 8 -+ -+#define TMOD_MASK (0x3 << TMOD_OFFSET) -+#define TMOD_TR 0x0 -+#define TMOD_TO 0x1 -+#define TMOD_RO 0x2 -+ -+#define INT_TXEI (1 << 0) -+#define INT_TXOI (1 << 1) -+#define INT_RXUI (1 << 2) -+#define INT_RXOI (1 << 3) -+ -+/* Bit fields in SR, 7 bits */ -+#define SR_MASK 0x7f /* cover 7 bits */ -+#define SR_BUSY (1 << 0) -+#define SR_TF_NOT_FULL (1 << 1) -+#define SR_TF_EMPT (1 << 2) -+#define SR_RF_NOT_EMPT (1 << 3) -+#define SR_RF_FULL (1 << 4) -+#define SR_TX_ERR (1 << 5) -+#define SR_DCOL (1 << 6) -+ -+/* Bit fields in DMACR */ -+#define SPI_DMA_RDMAE (1 << 0) -+#define SPI_DMA_TDMAE (1 << 1) -+ -+#define SPI_WAIT_RETRIES 5 -+ -+struct phytium_spi; -+ -+struct phytium_spi_dma_ops { -+ int (*dma_init)(struct device *dev, struct phytium_spi *fts); -+ void (*dma_exit)(struct phytium_spi *fts); -+ int (*dma_setup)(struct phytium_spi *fts, struct spi_transfer *xfer); -+ bool (*can_dma)(struct spi_controller *master, struct spi_device *spi, -+ struct spi_transfer *xfer); -+ int (*dma_transfer)(struct phytium_spi *fts, struct spi_transfer *xfer); -+ void (*dma_stop)(struct phytium_spi *fts); -+}; -+ -+struct phytium_spi { -+ struct spi_master *master; -+ char name[16]; -+ -+ void __iomem *regs; -+ bool global_cs; -+ bool dma_en; -+ unsigned long paddr; -+ int irq; -+ u32 fifo_len; -+ u32 max_freq; -+ -+ u32 reg_io_width; -+ u16 bus_num; -+ u16 num_cs; -+ int *cs; -+ -+ size_t len; -+ void *tx; -+ void *tx_end; -+ void *rx; -+ void *rx_end; -+ u8 n_bytes; -+ int dma_mapped; -+ struct clk *clk; -+ irqreturn_t (*transfer_handler)(struct phytium_spi *fts); -+ u32 current_freq; /* frequency in hz */ -+ -+ /* DMA info */ -+ struct dma_chan *txchan; -+ u32 txburst; -+ struct dma_chan *rxchan; -+ u32 rxburst; -+ u32 dma_sg_burst; -+ unsigned long dma_chan_busy; -+ dma_addr_t dma_addr; /* phy address of the Data register */ -+ const struct phytium_spi_dma_ops *dma_ops; -+ struct completion dma_completion; -+}; -+ -+static inline u32 phytium_readl(struct phytium_spi *fts, u32 offset) -+{ -+ return __raw_readl(fts->regs + offset); -+} -+ -+static inline u16 phytium_readw(struct phytium_spi *fts, u32 offset) -+{ -+ return __raw_readw(fts->regs + offset); -+} -+ -+static inline void phytium_writel(struct phytium_spi *fts, u32 offset, u32 val) -+{ -+ __raw_writel(val, fts->regs + offset); -+} -+ -+static inline void phytium_writew(struct phytium_spi *fts, u32 offset, u16 val) -+{ -+ __raw_writew(val, fts->regs + offset); -+} -+ -+static inline u32 phytium_read_io_reg(struct phytium_spi *fts, u32 offset) -+{ -+ switch (fts->reg_io_width) { -+ case 2: -+ return phytium_readw(fts, offset); -+ case 4: -+ default: -+ return phytium_readl(fts, offset); -+ } -+} -+ -+static inline void phytium_write_io_reg(struct phytium_spi *fts, u32 offset, u32 val) -+{ -+ switch (fts->reg_io_width) { -+ case 2: -+ phytium_writew(fts, offset, val); -+ break; -+ case 4: -+ default: -+ phytium_writel(fts, offset, val); -+ break; -+ } -+} -+ -+static inline void spi_enable_chip(struct phytium_spi *fts, int enable) -+{ -+ phytium_writel(fts, SSIENR, (enable ? 1 : 0)); -+} -+ -+static inline void spi_set_clk(struct phytium_spi *fts, u16 div) -+{ -+ phytium_writel(fts, BAUDR, div); -+} -+ -+static inline void spi_mask_intr(struct phytium_spi *fts, u32 mask) -+{ -+ u32 new_mask; -+ -+ new_mask = phytium_readl(fts, IMR) & ~mask; -+ phytium_writel(fts, IMR, new_mask); -+} -+ -+static inline void spi_umask_intr(struct phytium_spi *fts, u32 mask) -+{ -+ u32 new_mask; -+ -+ new_mask = phytium_readl(fts, IMR) | mask; -+ phytium_writel(fts, IMR, new_mask); -+} -+ -+static inline void spi_global_cs(struct phytium_spi *fts) -+{ -+ u32 global_cs_en, mask, setmask; -+ -+ mask = GENMASK(fts->num_cs-1, 0) << fts->num_cs; -+ setmask = ~GENMASK(fts->num_cs-1, 0); -+ global_cs_en = (phytium_readl(fts, GCSR) | mask) & setmask; -+ -+ phytium_writel(fts, GCSR, global_cs_en); -+} -+ -+static inline void spi_reset_chip(struct phytium_spi *fts) -+{ -+ spi_enable_chip(fts, 0); -+ if (fts->global_cs) -+ spi_global_cs(fts); -+ spi_mask_intr(fts, 0xff); -+ spi_enable_chip(fts, 1); -+} -+ -+static inline void spi_shutdown_chip(struct phytium_spi *fts) -+{ -+ spi_enable_chip(fts, 0); -+ spi_set_clk(fts, 0); -+ fts->current_freq = 0; -+} -+ -+extern int phytium_spi_add_host(struct device *dev, struct phytium_spi *fts); -+extern void phytium_spi_remove_host(struct phytium_spi *fts); -+extern int phytium_spi_suspend_host(struct phytium_spi *fts); -+extern int phytium_spi_resume_host(struct phytium_spi *fts); -+extern void phytium_spi_dmaops_set(struct phytium_spi *fts); -+extern int phytium_spi_check_status(struct phytium_spi *fts, bool raw); -+ -+#endif /* PHYTIUM_SPI_HEADER_H */ -diff --git a/drivers/tee/optee/core.c b/drivers/tee/optee/core.c -index 6ea80add7..b96f8e313 100644 ---- a/drivers/tee/optee/core.c -+++ b/drivers/tee/optee/core.c -@@ -5,6 +5,7 @@ - - #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt - -+#include - #include - #include - #include -@@ -776,6 +777,14 @@ static const struct of_device_id optee_dt_match[] = { - }; - MODULE_DEVICE_TABLE(of, optee_dt_match); - -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id optee_acpi_match[] = { -+ { "PHYT8003" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, optee_acpi_match); -+#endif -+ - static struct platform_driver optee_driver = { - .probe = optee_probe, - .remove = optee_remove, -@@ -783,6 +792,7 @@ static struct platform_driver optee_driver = { - .driver = { - .name = "optee", - .of_match_table = optee_dt_match, -+ .acpi_match_table = ACPI_PTR(optee_acpi_match), - }, - }; - module_platform_driver(optee_driver); -diff --git a/drivers/tty/serial/Kconfig b/drivers/tty/serial/Kconfig -index 28f22e586..4d6ac2bc7 100644 ---- a/drivers/tty/serial/Kconfig -+++ b/drivers/tty/serial/Kconfig -@@ -73,6 +73,17 @@ config SERIAL_AMBA_PL011_CONSOLE - your boot loader (lilo or loadlin) about how to pass options to the - kernel at boot time.) - -+config SERIAL_PHYTIUM_PCI -+ tristate "Phytium PCI serial port support" -+ depends on PCI -+ select SERIAL_CORE -+ help -+ This driver supports the Phytium UART controller on PCI/PCIe adapters. -+ If you want to compile this driver into the kernel, say Y here. To -+ compile this driver as a module, choose M here. -+ -+ If unsure, say N. -+ - config SERIAL_EARLYCON_ARM_SEMIHOST - bool "Early console using ARM semihosting" - depends on ARM64 || ARM -diff --git a/drivers/tty/serial/Makefile b/drivers/tty/serial/Makefile -index caf167f0c..f215657dc 100644 ---- a/drivers/tty/serial/Makefile -+++ b/drivers/tty/serial/Makefile -@@ -91,6 +91,8 @@ obj-$(CONFIG_SERIAL_RDA) += rda-uart.o - obj-$(CONFIG_SERIAL_MILBEAUT_USIO) += milbeaut_usio.o - obj-$(CONFIG_SERIAL_SIFIVE) += sifive.o - -+obj-$(CONFIG_SERIAL_PHYTIUM_PCI) += phytium-uart.o -+ - # GPIOLIB helpers for modem control lines - obj-$(CONFIG_SERIAL_MCTRL_GPIO) += serial_mctrl_gpio.o - -diff --git a/drivers/tty/serial/phytium-uart.c b/drivers/tty/serial/phytium-uart.c -new file mode 100644 -index 000000000..928126888 ---- /dev/null -+++ b/drivers/tty/serial/phytium-uart.c -@@ -0,0 +1,922 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Driver for Phytium PCI UART controller -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define DRV_NAME "phytium_uart" -+ -+#define REG_DR 0x00 -+#define REG_FR 0x18 -+#define REG_IBRD 0x24 -+#define REG_FBRD 0x28 -+#define REG_LCRH_RX 0x2c -+#define REG_LCRH_TX 0x2c -+#define REG_CR 0x30 -+#define REG_IFLS 0x34 -+#define REG_IMSC 0x38 -+#define REG_RIS 0x3c -+#define REG_MIS 0x40 -+#define REG_ICR 0x44 -+ -+#define REG_DR_OE (1 << 11) -+#define REG_DR_BE (1 << 10) -+#define REG_DR_PE (1 << 9) -+#define REG_DR_FE (1 << 8) -+ -+#define REG_LCRH_SPS 0x80 -+#define REG_LCRH_WLEN_8 0x60 -+#define REG_LCRH_WLEN_7 0x40 -+#define REG_LCRH_WLEN_6 0x20 -+#define REG_LCRH_WLEN_5 0x00 -+#define REG_LCRH_FEN 0x10 -+#define REG_LCRH_STP2 0x08 -+#define REG_LCRH_EPS 0x04 -+#define REG_LCRH_PEN 0x02 -+#define REG_LCRH_BRK 0x01 -+ -+#define REG_FR_RI 0x100 -+#define REG_FR_TXFE 0x080 -+#define REG_FR_RXFF 0x040 -+#define REG_FR_TXFF 0x020 -+#define REG_FR_RXFE 0x010 -+#define REG_FR_BUSY 0x008 -+#define REG_FR_DCD 0x004 -+#define REG_FR_DSR 0x002 -+#define REG_FR_CTS 0x001 -+#define REG_FR_TMSK (REG_FR_TXFF + REG_FR_BUSY) -+ -+#define REG_CR_CTSEN 0x8000 /* CTS hardware flow control */ -+#define REG_CR_RTSEN 0x4000 /* RTS hardware flow control */ -+#define REG_CR_OUT2 0x2000 /* OUT2 */ -+#define REG_CR_OUT1 0x1000 /* OUT1 */ -+#define REG_CR_RTS 0x0800 /* RTS */ -+#define REG_CR_DTR 0x0400 /* DTR */ -+#define REG_CR_RXE 0x0200 /* receive enable */ -+#define REG_CR_TXE 0x0100 /* transmit enable */ -+#define REG_CR_LBE 0x0080 /* loopback enable */ -+#define REG_CR_RTIE 0x0040 -+#define REG_CR_TIE 0x0020 -+#define REG_CR_RIE 0x0010 -+#define REG_CR_MSIE 0x0008 -+#define REG_CR_IIRLP 0x0004 /* SIR low power mode */ -+#define REG_CR_SIREN 0x0002 /* SIR enable */ -+#define REG_CR_UARTEN 0x0001 /* UART enable */ -+ -+#define REG_IFLS_RX1_8 (0 << 3) -+#define REG_IFLS_RX2_8 (1 << 3) -+#define REG_IFLS_RX4_8 (2 << 3) -+#define REG_IFLS_RX6_8 (3 << 3) -+#define REG_IFLS_RX7_8 (4 << 3) -+#define REG_IFLS_TX1_8 (0 << 0) -+#define REG_IFLS_TX2_8 (1 << 0) -+#define REG_IFLS_TX4_8 (2 << 0) -+#define REG_IFLS_TX6_8 (3 << 0) -+ -+#define REG_IMSC_OEIM (1 << 10) /* overrun error interrupt mask */ -+#define REG_IMSC_BEIM (1 << 9) /* break error interrupt mask */ -+#define REG_IMSC_PEIM (1 << 8) /* parity error interrupt mask */ -+#define REG_IMSC_FEIM (1 << 7) /* framing error interrupt mask */ -+#define REG_IMSC_RTIM (1 << 6) /* receive timeout interrupt mask */ -+#define REG_IMSC_TXIM (1 << 5) /* transmit interrupt mask */ -+#define REG_IMSC_RXIM (1 << 4) /* receive interrupt mask */ -+#define REG_IMSC_DSRMIM (1 << 3) /* DSR interrupt mask */ -+#define REG_IMSC_DCDMIM (1 << 2) /* DCD interrupt mask */ -+#define REG_IMSC_CTSMIM (1 << 1) /* CTS interrupt mask */ -+#define REG_IMSC_RIMIM (1 << 0) /* RI interrupt mask */ -+ -+#define REG_ICR_OEIS (1 << 10) /* overrun error interrupt status */ -+#define REG_ICR_BEIS (1 << 9) /* break error interrupt status */ -+#define REG_ICR_PEIS (1 << 8) /* parity error interrupt status */ -+#define REG_ICR_FEIS (1 << 7) /* framing error interrupt status */ -+#define REG_ICR_RTIS (1 << 6) /* receive timeout interrupt status */ -+#define REG_ICR_TXIS (1 << 5) /* transmit interrupt status */ -+#define REG_ICR_RXIS (1 << 4) /* receive interrupt status */ -+#define REG_ICR_DSRMIS (1 << 3) /* DSR interrupt status */ -+#define REG_ICR_DCDMIS (1 << 2) /* DCD interrupt status */ -+#define REG_ICR_CTSMIS (1 << 1) /* CTS interrupt status */ -+#define REG_ICR_RIMIS (1 << 0) /* RI interrupt status */ -+ -+#define UART_NR 12 -+ -+#define UART_DR_ERROR (REG_DR_OE|REG_DR_BE|REG_DR_PE|REG_DR_FE) -+#define UART_DUMMY_DR_RX (1 << 16) -+ -+#define DEFAULT_UARTCLK 48000000 /* 48 MHz */ -+ -+/* -+ * We wrap our port structure around the generic uart_port. -+ */ -+struct phytium_uart_port { -+ struct uart_port port; -+ unsigned int im; /* interrupt mask */ -+ unsigned int old_status; -+ unsigned int old_cr; /* state during shutdown */ -+ char type[12]; -+}; -+ -+static unsigned int phytium_uart_read(const struct phytium_uart_port *pup, -+ unsigned int reg) -+{ -+ void __iomem *addr = pup->port.membase + reg; -+ -+ return readl_relaxed(addr); -+} -+ -+static void phytium_uart_write(unsigned int val, const struct phytium_uart_port *pup, -+ unsigned int reg) -+{ -+ void __iomem *addr = pup->port.membase + reg; -+ -+ writel_relaxed(val, addr); -+} -+ -+static int phytium_fifo_to_tty(struct phytium_uart_port *pup) -+{ -+ u16 status; -+ unsigned int ch, flag, fifotaken; -+ -+ for (fifotaken = 0; fifotaken < 256; fifotaken++) { -+ status = phytium_uart_read(pup, REG_FR); -+ if (status & REG_FR_RXFE) -+ break; -+ -+ /* Take chars from the FIFO and update status */ -+ ch = phytium_uart_read(pup, REG_DR) | UART_DUMMY_DR_RX; -+ flag = TTY_NORMAL; -+ pup->port.icount.rx++; -+ -+ if (unlikely(ch & UART_DR_ERROR)) { -+ if (ch & REG_DR_BE) { -+ ch &= ~(REG_DR_FE | REG_DR_PE); -+ pup->port.icount.brk++; -+ if (uart_handle_break(&pup->port)) -+ continue; -+ } else if (ch & REG_DR_PE) -+ pup->port.icount.parity++; -+ else if (ch & REG_DR_FE) -+ pup->port.icount.frame++; -+ if (ch & REG_DR_OE) -+ pup->port.icount.overrun++; -+ -+ ch &= pup->port.read_status_mask; -+ -+ if (ch & REG_DR_BE) -+ flag = TTY_BREAK; -+ else if (ch & REG_DR_PE) -+ flag = TTY_PARITY; -+ else if (ch & REG_DR_FE) -+ flag = TTY_FRAME; -+ } -+ -+ if (uart_handle_sysrq_char(&pup->port, ch & 255)) -+ continue; -+ -+ uart_insert_char(&pup->port, ch, REG_DR_OE, ch, flag); -+ } -+ -+ return fifotaken; -+} -+ -+static void phytium_rx_chars(struct phytium_uart_port *pup) -+__releases(&pup->port.lock) -+__acquires(&pup->port.lock) -+{ -+ phytium_fifo_to_tty(pup); -+ -+ spin_unlock(&pup->port.lock); -+ tty_flip_buffer_push(&pup->port.state->port); -+ spin_lock(&pup->port.lock); -+} -+ -+static void phytium_stop_tx(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ pup->im &= ~REG_IMSC_TXIM; -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+} -+ -+static bool phytium_tx_char(struct phytium_uart_port *pup, unsigned char c, -+ bool from_irq) -+{ -+ -+ if (unlikely(!from_irq) && -+ phytium_uart_read(pup, REG_FR) & REG_FR_TXFF) -+ return false; /* unable to transmit character */ -+ -+ phytium_uart_write(c, pup, REG_DR); -+ pup->port.icount.tx++; -+ -+ return true; -+} -+ -+static bool phytium_tx_chars(struct phytium_uart_port *pup, bool from_irq) -+{ -+ struct circ_buf *xmit = &pup->port.state->xmit; -+ int count = pup->port.fifosize >> 1; -+ -+ if (pup->port.x_char) { -+ if (!phytium_tx_char(pup, pup->port.x_char, from_irq)) -+ return true; -+ pup->port.x_char = 0; -+ --count; -+ } -+ if (uart_circ_empty(xmit) || uart_tx_stopped(&pup->port)) { -+ phytium_stop_tx(&pup->port); -+ return false; -+ } -+ -+ do { -+ if (likely(from_irq) && count-- == 0) -+ break; -+ -+ if (!phytium_tx_char(pup, xmit->buf[xmit->tail], from_irq)) -+ break; -+ -+ xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1); -+ } while (!uart_circ_empty(xmit)); -+ -+ if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) -+ uart_write_wakeup(&pup->port); -+ -+ if (uart_circ_empty(xmit)) { -+ phytium_stop_tx(&pup->port); -+ return false; -+ } -+ return true; -+} -+ -+static void phytium_modem_status(struct phytium_uart_port *pup) -+{ -+ unsigned int status, delta; -+ -+ status = phytium_uart_read(pup, REG_FR) & (REG_FR_DCD|REG_FR_DSR|REG_FR_CTS); -+ -+ delta = status ^ pup->old_status; -+ pup->old_status = status; -+ -+ if (!delta) -+ return; -+ -+ if (delta & REG_FR_DCD) -+ uart_handle_dcd_change(&pup->port, status & REG_FR_DCD); -+ -+ if (delta & REG_FR_DSR) -+ pup->port.icount.dsr++; -+ -+ if (delta & REG_FR_CTS) -+ uart_handle_cts_change(&pup->port, status & REG_FR_CTS); -+ -+ wake_up_interruptible(&pup->port.state->port.delta_msr_wait); -+} -+ -+static irqreturn_t phytium_uart_interrupt(int irq, void *dev_id) -+{ -+ struct phytium_uart_port *pup = dev_id; -+ unsigned long flags; -+ unsigned int status, pass_counter = 256; -+ int handled = 0; -+ -+ spin_lock_irqsave(&pup->port.lock, flags); -+ status = phytium_uart_read(pup, REG_RIS) & pup->im; -+ if (status) { -+ do { -+ phytium_uart_write(status & ~(REG_ICR_TXIS|REG_ICR_RTIS|REG_ICR_RXIS), -+ pup, REG_ICR); -+ -+ if (status & (REG_ICR_RTIS|REG_ICR_RXIS)) -+ phytium_rx_chars(pup); -+ -+ if (status & (REG_ICR_DSRMIS|REG_ICR_DCDMIS| -+ REG_ICR_CTSMIS|REG_ICR_RIMIS)) -+ phytium_modem_status(pup); -+ if (status & REG_ICR_TXIS) -+ phytium_tx_chars(pup, true); -+ -+ if (pass_counter-- == 0) -+ break; -+ -+ status = phytium_uart_read(pup, REG_RIS) & pup->im; -+ } while (status != 0); -+ handled = 1; -+ } -+ spin_unlock_irqrestore(&pup->port.lock, flags); -+ -+ return IRQ_RETVAL(handled); -+} -+ -+static unsigned int phytium_tx_empty(struct uart_port *port) -+{ -+ unsigned int status; -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ status = phytium_uart_read(pup, REG_FR) & (REG_FR_BUSY | REG_FR_TXFF); -+ -+ return status ? 0 : TIOCSER_TEMT; -+} -+ -+static void phytium_set_mctrl(struct uart_port *port, unsigned int mctrl) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ unsigned int cr; -+ -+ cr = phytium_uart_read(pup, REG_CR); -+ -+#define TIOCMBIT(tiocmbit, uartbit) \ -+ do { \ -+ if (mctrl & tiocmbit) \ -+ cr |= uartbit; \ -+ else \ -+ cr &= ~uartbit; \ -+ } while (0) -+ -+ TIOCMBIT(TIOCM_RTS, REG_CR_RTS); -+ TIOCMBIT(TIOCM_DTR, REG_CR_DTR); -+ TIOCMBIT(TIOCM_OUT1, REG_CR_OUT1); -+ TIOCMBIT(TIOCM_OUT2, REG_CR_OUT2); -+ TIOCMBIT(TIOCM_LOOP, REG_CR_LBE); -+ -+ if (port->status & UPSTAT_AUTORTS) { -+ /* We need to disable auto-RTS if we want to turn RTS off */ -+ TIOCMBIT(TIOCM_RTS, REG_CR_RTSEN); -+ } -+#undef TIOCMBIT -+ -+ phytium_uart_write(cr, pup, REG_CR); -+} -+ -+static unsigned int phytium_get_mctrl(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ unsigned int cr = 0; -+ unsigned int status = phytium_uart_read(pup, REG_FR); -+ -+#define TIOCMBIT(uartbit, tiocmbit) \ -+ do { \ -+ if (status & uartbit) \ -+ cr |= tiocmbit; \ -+ } while (0) -+ -+ TIOCMBIT(REG_FR_DCD, TIOCM_CAR); -+ TIOCMBIT(REG_FR_DSR, TIOCM_DSR); -+ TIOCMBIT(REG_FR_CTS, TIOCM_CTS); -+ TIOCMBIT(REG_FR_RI, TIOCM_RNG); -+#undef TIOCMBIT -+ return cr; -+} -+ -+static void phytium_start_tx(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ if (phytium_tx_chars(pup, false)) { -+ pup->im |= REG_IMSC_TXIM; -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+ } -+} -+ -+static void phytium_stop_rx(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ pup->im &= ~(REG_IMSC_RXIM|REG_IMSC_RTIM|REG_IMSC_FEIM| -+ REG_IMSC_PEIM|REG_IMSC_BEIM|REG_IMSC_OEIM); -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+} -+ -+static void phytium_enable_ms(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ pup->im |= REG_IMSC_RIMIM|REG_IMSC_CTSMIM|REG_IMSC_DCDMIM|REG_IMSC_DSRMIM; -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+} -+ -+static void phytium_break_ctl(struct uart_port *port, int break_state) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ unsigned long flags; -+ unsigned int lcr_h; -+ -+ spin_lock_irqsave(&pup->port.lock, flags); -+ lcr_h = phytium_uart_read(pup, REG_LCRH_TX); -+ if (break_state == -1) -+ lcr_h |= REG_LCRH_BRK; -+ else -+ lcr_h &= ~REG_LCRH_BRK; -+ phytium_uart_write(lcr_h, pup, REG_LCRH_TX); -+ spin_unlock_irqrestore(&pup->port.lock, flags); -+} -+ -+static int phytium_hwinit(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ /* XXX: more configurable setup method in future */ -+ pup->port.uartclk = DEFAULT_UARTCLK; -+ -+ /* Clear pending error and receive interrupts */ -+ phytium_uart_write(REG_ICR_OEIS | REG_ICR_BEIS | REG_ICR_PEIS | -+ REG_ICR_FEIS | REG_ICR_RTIS | REG_ICR_RXIS, -+ pup, REG_ICR); -+ -+ /* -+ * Save interrupts enable mask, and enable RX interrupts in case if -+ * the interrupt is used for NMI entry. -+ */ -+ pup->im = phytium_uart_read(pup, REG_IMSC); -+ phytium_uart_write(REG_IMSC_RTIM | REG_IMSC_RXIM, pup, REG_IMSC); -+ -+ return 0; -+} -+ -+static int phytium_uart_allocate_irq(struct phytium_uart_port *pup) -+{ -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+ -+ return request_irq(pup->port.irq, phytium_uart_interrupt, IRQF_SHARED, DRV_NAME, pup); -+} -+ -+static void phytium_enable_interrtups(struct phytium_uart_port *pup) -+{ -+ unsigned int i; -+ -+ spin_lock_irq(&pup->port.lock); -+ -+ /* Clear out any spuriously appearing RX interrupts */ -+ phytium_uart_write(REG_ICR_RTIS | REG_ICR_RXIS, pup, REG_ICR); -+ -+ /* -+ * RXIS is asserted only when the RX FIFO transitions from below -+ * to above the trigger threshold. If the RX FIFO is already -+ * full to the threashold this can't happen and RXIS will now be -+ * stuck off. Drain the RX FIFO explicitly to fix this: -+ */ -+ for (i = 0; i < pup->port.fifosize * 2; i++) { -+ if (phytium_uart_read(pup, REG_FR) & REG_FR_RXFE) -+ break; -+ -+ phytium_uart_read(pup, REG_DR); -+ } -+ -+ pup->im = REG_IMSC_RTIM | REG_IMSC_RXIM; -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+ spin_unlock_irq(&pup->port.lock); -+} -+ -+static int phytium_startup(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ unsigned int cr; -+ int ret = 0; -+ -+ ret = phytium_hwinit(port); -+ if (ret) -+ goto out; -+ -+ ret = phytium_uart_allocate_irq(pup); -+ if (ret) -+ goto out; -+ -+ phytium_uart_write(REG_IFLS_RX4_8|REG_IFLS_TX4_8, pup, REG_IFLS); -+ -+ spin_lock_irq(&pup->port.lock); -+ -+ /* restore RTS and DTR */ -+ cr = pup->old_cr & (REG_CR_RTS | REG_CR_DTR); -+ cr |= REG_CR_UARTEN | REG_CR_RXE | REG_CR_TXE; -+ phytium_uart_write(cr, pup, REG_CR); -+ -+ spin_unlock_irq(&pup->port.lock); -+ -+ /* initialise the old status of the modem signals */ -+ pup->old_status = phytium_uart_read(pup, REG_FR) & (REG_FR_DCD|REG_FR_DSR|REG_FR_CTS); -+ -+ phytium_enable_interrtups(pup); -+ -+out: -+ return ret; -+} -+ -+static void phytium_shutdown_channel(struct phytium_uart_port *pup, -+ unsigned int lcrh) -+{ -+ unsigned long val; -+ -+ val = phytium_uart_read(pup, lcrh); -+ val &= ~(REG_LCRH_BRK | REG_LCRH_FEN); -+ phytium_uart_write(val, pup, lcrh); -+} -+ -+static void phytium_disable_uart(struct phytium_uart_port *pup) -+{ -+ unsigned int cr; -+ -+ pup->port.status &= ~(UPSTAT_AUTOCTS | UPSTAT_AUTORTS); -+ spin_lock_irq(&pup->port.lock); -+ cr = phytium_uart_read(pup, REG_CR); -+ pup->old_cr = cr; -+ cr &= REG_CR_RTS | REG_CR_DTR; -+ cr |= REG_CR_UARTEN | REG_CR_TXE; -+ phytium_uart_write(cr, pup, REG_CR); -+ spin_unlock_irq(&pup->port.lock); -+ -+ /* -+ * disable break condition and fifos -+ */ -+ phytium_shutdown_channel(pup, REG_LCRH_RX); -+} -+ -+static void phytium_disable_interrupts(struct phytium_uart_port *pup) -+{ -+ spin_lock_irq(&pup->port.lock); -+ -+ /* mask all interrupts and clear all pending ones */ -+ pup->im = 0; -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+ phytium_uart_write(0xffff, pup, REG_ICR); -+ -+ spin_unlock_irq(&pup->port.lock); -+} -+ -+static void phytium_shutdown(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ phytium_disable_interrupts(pup); -+ -+ free_irq(pup->port.irq, pup); -+ -+ phytium_disable_uart(pup); -+ -+ if (pup->port.ops->flush_buffer) -+ pup->port.ops->flush_buffer(port); -+} -+ -+static void -+phytium_setup_status_masks(struct uart_port *port, struct ktermios *termios) -+{ -+ port->read_status_mask = REG_DR_OE | 255; -+ if (termios->c_iflag & INPCK) -+ port->read_status_mask |= REG_DR_FE | REG_DR_PE; -+ if (termios->c_iflag & (IGNBRK | BRKINT | PARMRK)) -+ port->read_status_mask |= REG_DR_BE; -+ -+ /* -+ * Characters to ignore -+ */ -+ port->ignore_status_mask = 0; -+ if (termios->c_iflag & IGNPAR) -+ port->ignore_status_mask |= REG_DR_FE | REG_DR_PE; -+ if (termios->c_iflag & IGNBRK) { -+ port->ignore_status_mask |= REG_DR_BE; -+ /* -+ * If we're ignoring parity and break indicators, -+ * ignore overruns too (for real raw support). -+ */ -+ if (termios->c_iflag & IGNPAR) -+ port->ignore_status_mask |= REG_DR_OE; -+ } -+ -+ /* -+ * Ignore all characters if CREAD is not set. -+ */ -+ if ((termios->c_cflag & CREAD) == 0) -+ port->ignore_status_mask |= UART_DUMMY_DR_RX; -+} -+ -+static void -+phytium_set_termios(struct uart_port *port, struct ktermios *termios, struct ktermios *old) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ unsigned int lcr_h, old_cr; -+ unsigned long flags; -+ unsigned int baud, quot; -+ -+ /* Ask the core to calculate the divisor for us. */ -+ baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16); -+ -+ if (baud > port->uartclk/16) -+ quot = DIV_ROUND_CLOSEST(port->uartclk * 8, baud); -+ else -+ quot = DIV_ROUND_CLOSEST(port->uartclk * 4, baud); -+ -+ switch (termios->c_cflag & CSIZE) { -+ case CS5: -+ lcr_h = REG_LCRH_WLEN_5; -+ break; -+ case CS6: -+ lcr_h = REG_LCRH_WLEN_6; -+ break; -+ case CS7: -+ lcr_h = REG_LCRH_WLEN_7; -+ break; -+ default: /* CS8 */ -+ lcr_h = REG_LCRH_WLEN_8; -+ break; -+ } -+ if (termios->c_cflag & CSTOPB) -+ lcr_h |= REG_LCRH_STP2; -+ if (termios->c_cflag & PARENB) { -+ lcr_h |= REG_LCRH_PEN; -+ if (!(termios->c_cflag & PARODD)) -+ lcr_h |= REG_LCRH_EPS; -+ if (termios->c_cflag & CMSPAR) -+ lcr_h |= REG_LCRH_SPS; -+ } -+ if (pup->port.fifosize > 1) -+ lcr_h |= REG_LCRH_FEN; -+ -+ spin_lock_irqsave(&port->lock, flags); -+ -+ /* -+ * Update the per-port timeout. -+ */ -+ uart_update_timeout(port, termios->c_cflag, baud); -+ -+ phytium_setup_status_masks(port, termios); -+ -+ if (UART_ENABLE_MS(port, termios->c_cflag)) -+ phytium_enable_ms(port); -+ -+ /* first, disable everything */ -+ old_cr = phytium_uart_read(pup, REG_CR); -+ phytium_uart_write(0, pup, REG_CR); -+ -+ if (termios->c_cflag & CRTSCTS) { -+ if (old_cr & REG_CR_RTS) -+ old_cr |= REG_CR_RTSEN; -+ -+ old_cr |= REG_CR_CTSEN; -+ port->status |= UPSTAT_AUTOCTS | UPSTAT_AUTORTS; -+ } else { -+ old_cr &= ~(REG_CR_CTSEN | REG_CR_RTSEN); -+ port->status &= ~(UPSTAT_AUTOCTS | UPSTAT_AUTORTS); -+ } -+ -+ /* Set baud rate */ -+ phytium_uart_write(quot & 0x3f, pup, REG_FBRD); -+ phytium_uart_write(quot >> 6, pup, REG_IBRD); -+ -+ phytium_uart_write(lcr_h, pup, REG_LCRH_RX); -+ phytium_uart_write(old_cr, pup, REG_CR); -+ -+ spin_unlock_irqrestore(&port->lock, flags); -+} -+ -+static const char *phytium_type(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ return pup->port.type == PORT_PHYTIUM ? pup->type : NULL; -+} -+ -+static void phytium_release_port(struct uart_port *port) -+{ -+ /* Nothing to release ... */ -+} -+ -+static int phytium_request_port(struct uart_port *port) -+{ -+ /* UARTs always present */ -+ return 0; -+} -+ -+static void phytium_config_port(struct uart_port *port, int flags) -+{ -+ if (flags & UART_CONFIG_TYPE) { -+ port->type = PORT_PHYTIUM; -+ phytium_request_port(port); -+ } -+} -+ -+static int phytium_verify_port(struct uart_port *port, struct serial_struct *ser) -+{ -+ int ret = 0; -+ -+ if (ser->type != PORT_UNKNOWN && ser->type != PORT_PHYTIUM) -+ ret = -EINVAL; -+ if (ser->irq < 0 || ser->irq >= nr_irqs) -+ ret = -EINVAL; -+ if (ser->baud_base < 9600) -+ ret = -EINVAL; -+ -+ return ret; -+} -+ -+static const struct uart_ops phytium_uart_ops = { -+ .tx_empty = phytium_tx_empty, -+ .set_mctrl = phytium_set_mctrl, -+ .get_mctrl = phytium_get_mctrl, -+ .stop_tx = phytium_stop_tx, -+ .start_tx = phytium_start_tx, -+ .stop_rx = phytium_stop_rx, -+ .enable_ms = phytium_enable_ms, -+ .break_ctl = phytium_break_ctl, -+ .startup = phytium_startup, -+ .shutdown = phytium_shutdown, -+ .set_termios = phytium_set_termios, -+ .type = phytium_type, -+ .release_port = phytium_release_port, -+ .request_port = phytium_request_port, -+ .config_port = phytium_config_port, -+ .verify_port = phytium_verify_port, -+}; -+ -+static struct phytium_uart_port *uart_ports[UART_NR]; -+ -+static struct uart_driver phytium_uart = { -+ .owner = THIS_MODULE, -+ .driver_name = DRV_NAME, -+ .dev_name = "ttyFTX", -+ .nr = UART_NR, -+}; -+ -+void phytium_unregister_port(struct phytium_uart_port *pup) -+{ -+ int i; -+ bool busy = false; -+ -+ for (i = 0; i < ARRAY_SIZE(uart_ports); i++) { -+ if (uart_ports[i] == pup) -+ uart_ports[i] = NULL; -+ else if (uart_ports[i]) -+ busy = true; -+ } -+ -+ if (!busy) -+ uart_unregister_driver(&phytium_uart); -+} -+ -+static int phytium_find_free_port(void) -+{ -+ int i; -+ -+ for (i = 0; i < ARRAY_SIZE(uart_ports); i++) -+ if (uart_ports[i] == NULL) -+ return i; -+ -+ return -EBUSY; -+} -+ -+static int phytium_register_port(struct phytium_uart_port *pup) -+{ -+ int rc; -+ -+ /* Ensure interrupts from this UART are masked and cleared */ -+ phytium_uart_write(0, pup, REG_IMSC); -+ phytium_uart_write(0xffff, pup, REG_ICR); -+ -+ if (!phytium_uart.state) { -+ rc = uart_register_driver(&phytium_uart); -+ if (rc < 0) { -+ dev_err(pup->port.dev, -+ "Failed to register Phytium PCI UART driver\n"); -+ return rc; -+ } -+ } -+ -+ rc = uart_add_one_port(&phytium_uart, &pup->port); -+ if (rc) -+ phytium_unregister_port(pup); -+ -+ return rc; -+} -+ -+static int phytium_uart_probe(struct pci_dev *pdev, -+ const struct pci_device_id *id) -+{ -+ struct phytium_uart_port *pup; -+ int portnr, rc; -+ -+ portnr = phytium_find_free_port(); -+ if (portnr < 0) -+ return portnr; -+ -+ pup = devm_kzalloc(&pdev->dev, sizeof(struct phytium_uart_port), -+ GFP_KERNEL); -+ if (!pup) -+ return -ENOMEM; -+ -+ rc = pcim_enable_device(pdev); -+ if (rc) -+ return rc; -+ -+ rc = pcim_iomap_regions_request_all(pdev, 0x01, pci_name(pdev)); -+ if (rc) -+ return rc; -+ -+ pup->port.iotype = UPIO_MEM32; -+ pup->port.irq = pdev->irq; -+ pup->port.mapbase = pci_resource_start(pdev, 0); -+ pup->port.membase = pcim_iomap_table(pdev)[0]; -+ pup->port.ops = &phytium_uart_ops; -+ pup->port.dev = &pdev->dev; -+ pup->port.fifosize = 32; -+ pup->port.flags = UPF_BOOT_AUTOCONF; -+ pup->port.line = portnr; -+ -+ uart_ports[portnr] = pup; -+ -+ pup->old_cr = 0; -+ snprintf(pup->type, sizeof(pup->type), "pci-uart"); -+ -+ pci_set_drvdata(pdev, pup); -+ -+ return phytium_register_port(pup); -+} -+ -+static void phytium_uart_remove(struct pci_dev *pdev) -+{ -+ struct phytium_uart_port *pup = pci_get_drvdata(pdev); -+ -+ uart_remove_one_port(&phytium_uart, &pup->port); -+ phytium_unregister_port(pup); -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_uart_suspend(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_uart_port *pup = pci_get_drvdata(pdev); -+ -+ if (pup) -+ uart_suspend_port(&phytium_uart, &pup->port); -+ -+ return 0; -+} -+ -+static int phytium_uart_resume(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_uart_port *pup = pci_get_drvdata(pdev); -+ -+ if (pup) -+ uart_resume_port(&phytium_uart, &pup->port); -+ -+ return 0; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_dev_pm_ops, phytium_uart_suspend, phytium_uart_resume); -+ -+static const struct pci_device_id pci_ids[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc2e) }, -+ { 0 } -+}; -+MODULE_DEVICE_TABLE(pci, pci_ids); -+ -+static struct pci_driver phytium_uart_pci_driver = { -+ .name = DRV_NAME, -+ .probe = phytium_uart_probe, -+ .remove = phytium_uart_remove, -+ .driver = { -+ .pm = &phytium_dev_pm_ops, -+ }, -+ .id_table = pci_ids, -+}; -+ -+static int __init phytium_uart_init(void) -+{ -+ pr_info("Serial: Phytium PCI UART driver\n"); -+ -+ return pci_register_driver(&phytium_uart_pci_driver); -+} -+ -+static void __exit phytium_uart_exit(void) -+{ -+ pci_unregister_driver(&phytium_uart_pci_driver); -+} -+ -+module_init(phytium_uart_init); -+module_exit(phytium_uart_exit); -+ -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium PCI serial port driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/usb/Kconfig b/drivers/usb/Kconfig -index 26475b409..ad99f91aa 100644 ---- a/drivers/usb/Kconfig -+++ b/drivers/usb/Kconfig -@@ -125,6 +125,8 @@ source "drivers/usb/chipidea/Kconfig" - - source "drivers/usb/isp1760/Kconfig" - -+source "drivers/usb/phytium/Kconfig" -+ - comment "USB port drivers" - - if USB -diff --git a/drivers/usb/Makefile b/drivers/usb/Makefile -index 1c1c1d659..0f2c03958 100644 ---- a/drivers/usb/Makefile -+++ b/drivers/usb/Makefile -@@ -66,3 +66,5 @@ obj-$(CONFIG_USBIP_CORE) += usbip/ - obj-$(CONFIG_TYPEC) += typec/ - - obj-$(CONFIG_USB_ROLE_SWITCH) += roles/ -+ -+obj-$(CONFIG_USB_PHYTIUM) += phytium/ -diff --git a/drivers/usb/host/xhci-pci.c b/drivers/usb/host/xhci-pci.c -index 53f832787..96be5bc21 100644 ---- a/drivers/usb/host/xhci-pci.c -+++ b/drivers/usb/host/xhci-pci.c -@@ -72,6 +72,8 @@ - #define PCI_DEVICE_ID_ASMEDIA_2142_XHCI 0x2142 - #define PCI_DEVICE_ID_ASMEDIA_3242_XHCI 0x3242 - -+#define PCI_DEVICE_ID_PHYTIUM_XHCI 0xdc27 -+ - static const char hcd_name[] = "xhci_hcd"; - - static struct hc_driver __read_mostly xhci_pci_hc_driver; -@@ -283,6 +285,9 @@ static void xhci_pci_quirks(struct device *dev, struct xhci_hcd *xhci) - if (pdev->vendor == PCI_VENDOR_ID_VIA) - xhci->quirks |= XHCI_RESET_ON_RESUME; - -+ if (pdev->vendor == PCI_VENDOR_ID_PHYTIUM || -+ pdev->device == PCI_DEVICE_ID_PHYTIUM_XHCI) -+ xhci->quirks |= XHCI_RESET_ON_RESUME; - /* See https://bugzilla.kernel.org/show_bug.cgi?id=79511 */ - if (pdev->vendor == PCI_VENDOR_ID_VIA && - pdev->device == 0x3432) -diff --git a/drivers/usb/host/xhci-plat.c b/drivers/usb/host/xhci-plat.c -index e56a1fb97..65a019a4d 100644 ---- a/drivers/usb/host/xhci-plat.c -+++ b/drivers/usb/host/xhci-plat.c -@@ -137,6 +137,10 @@ static const struct xhci_plat_priv xhci_plat_brcm = { - .quirks = XHCI_RESET_ON_RESUME | XHCI_SUSPEND_RESUME_CLKS, - }; - -+static const struct xhci_plat_priv xhci_plat_phytium_pe220x = { -+ .quirks = XHCI_RESET_ON_RESUME, -+}; -+ - static const struct of_device_id usb_xhci_of_match[] = { - { - .compatible = "generic-xhci", -@@ -178,6 +182,9 @@ static const struct of_device_id usb_xhci_of_match[] = { - }, { - .compatible = "brcm,bcm7445-xhci", - .data = &xhci_plat_brcm, -+ }, { -+ .compatible = "phytium,pe220x-xhci", -+ .data = &xhci_plat_phytium_pe220x, - }, - {}, - }; -@@ -289,6 +296,8 @@ static int xhci_plat_probe(struct platform_device *pdev) - - if (pdev->dev.of_node) - priv_match = of_device_get_match_data(&pdev->dev); -+ else if (has_acpi_companion(&pdev->dev)) -+ priv_match = acpi_device_get_match_data(&pdev->dev); - else - priv_match = dev_get_platdata(&pdev->dev); - -@@ -533,6 +542,7 @@ static const struct dev_pm_ops xhci_plat_pm_ops = { - static const struct acpi_device_id usb_xhci_acpi_match[] = { - /* XHCI-compliant USB Controller */ - { "PNP0D10", }, -+ { "PHYT0039", (kernel_ulong_t)&xhci_plat_phytium_pe220x }, - { } - }; - MODULE_DEVICE_TABLE(acpi, usb_xhci_acpi_match); -diff --git a/drivers/usb/phytium/Kconfig b/drivers/usb/phytium/Kconfig -new file mode 100644 -index 000000000..f131a3f88 ---- /dev/null -+++ b/drivers/usb/phytium/Kconfig -@@ -0,0 +1,8 @@ -+config USB_PHYTIUM -+ tristate "PHYTIUM USB Support" -+ depends on USB && USB_GADGET -+ help -+ Say Y or M here if your system has a OTG USB Controller based on PHYTIUM SOC. -+ -+ If you choose to build this driver is a dynamically linked modules, the module will -+ be called phytium-usb.ko -diff --git a/drivers/usb/phytium/Makefile b/drivers/usb/phytium/Makefile -new file mode 100644 -index 000000000..05d422d4a ---- /dev/null -+++ b/drivers/usb/phytium/Makefile -@@ -0,0 +1,5 @@ -+# SPDX-License-Identifier: GPL-2.0 -+ -+obj-$(CONFIG_USB_PHYTIUM) += phytium-usb.o -+ -+phytium-usb-y := core.o dma.o platform.o host.o gadget.o -diff --git a/drivers/usb/phytium/core.c b/drivers/usb/phytium/core.c -new file mode 100644 -index 000000000..c0182c077 ---- /dev/null -+++ b/drivers/usb/phytium/core.c -@@ -0,0 +1,44 @@ -+// SPDX-License-Identifier: GPL-2.0 -+ -+#include "core.h" -+ -+int phytium_core_reset(struct phytium_cusb *config, bool skip_wait) -+{ -+ if (!config) -+ return 0; -+ -+ spin_lock_init(&config->lock); -+ -+ return 0; -+} -+ -+uint32_t phytium_read32(uint32_t *address) -+{ -+ return readl(address); -+} -+ -+void phytium_write32(uint32_t *address, uint32_t value) -+{ -+ writel(value, address); -+} -+ -+uint16_t phytium_read16(uint16_t *address) -+{ -+ return readw(address); -+} -+ -+void phytium_write16(uint16_t *address, uint16_t value) -+{ -+ writew(value, address); -+} -+ -+uint8_t phytium_read8(uint8_t *address) -+{ -+ return readb(address); -+} -+ -+void phytium_write8(uint8_t *address, uint8_t value) -+{ -+ writeb(value, address); -+} -+ -diff --git a/drivers/usb/phytium/core.h b/drivers/usb/phytium/core.h -new file mode 100644 -index 000000000..f563672cc ---- /dev/null -+++ b/drivers/usb/phytium/core.h -@@ -0,0 +1,98 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+ -+#ifndef __PHYTIUM_CORE_H__ -+#define __PHYTIUM_CORE_H__ -+ -+#include -+#include -+#include "host_api.h" -+#include "gadget.h" -+ -+#define MAX_EPS_CHANNELS 16 -+ -+struct phytium_ep { -+ struct phytium_cusb *config; -+ u16 max_packet; -+ u8 ep_num; -+ struct GADGET_EP *gadget_ep; -+ struct list_head req_list; -+ struct usb_ep end_point; -+ char name[12]; -+ u8 is_tx; -+ const struct usb_endpoint_descriptor *desc; -+ u8 busy; -+}; -+ -+struct phytium_request { -+ struct usb_request request; -+ struct GADGET_REQ *gadget_request; -+ struct list_head list; -+ struct phytium_ep *ep; -+ struct phytium_cusb *config; -+ u8 is_tx; -+ u8 epnum; -+}; -+ -+struct phytium_cusb { -+ struct device *dev; -+ void __iomem *regs; -+ void __iomem *phy_regs; -+ int irq; -+ spinlock_t lock; -+ enum usb_dr_mode dr_mode; -+ -+ struct GADGET_OBJ *gadget_obj; -+ struct GADGET_CFG gadget_cfg; -+ struct GADGET_CALLBACKS gadget_callbacks; -+ struct GADGET_SYSREQ gadget_sysreq; -+ struct GADGET_DEV *gadget_dev; -+ void *gadget_priv; -+ -+ struct usb_gadget gadget; -+ struct usb_gadget_driver *gadget_driver; -+ struct phytium_ep endpoints_tx[MAX_EPS_CHANNELS]; -+ struct phytium_ep endpoints_rx[MAX_EPS_CHANNELS]; -+ u8 ep0_data_stage_is_tx; -+ -+ struct HOST_OBJ *host_obj; -+ struct HOST_CFG host_cfg; -+ struct HOST_CALLBACKS host_callbacks; -+ struct HOST_SYSREQ host_sysreq; -+ void *host_priv; -+ struct usb_hcd *hcd; -+ -+ struct DMA_OBJ *dma_obj; -+ struct DMA_CFG dma_cfg; -+ struct DMA_CALLBACKS dma_callbacks; -+ struct DMA_SYSREQ dma_sysreq; -+ bool isVhubHost; -+}; -+ -+int phytium_core_reset(struct phytium_cusb *config, bool skip_wait); -+ -+int phytium_host_init(struct phytium_cusb *config); -+int phytium_host_uninit(struct phytium_cusb *config); -+ -+#ifdef CONFIG_PM -+int phytium_host_resume(void *priv); -+int phytium_host_suspend(void *priv); -+int phytium_gadget_resume(void *priv); -+int phytium_gadget_suspend(void *priv); -+#endif -+ -+int phytium_gadget_init(struct phytium_cusb *config); -+int phytium_gadget_uninit(struct phytium_cusb *config); -+ -+uint32_t phytium_read32(uint32_t *address); -+ -+void phytium_write32(uint32_t *address, uint32_t value); -+ -+uint16_t phytium_read16(uint16_t *address); -+ -+void phytium_write16(uint16_t *address, uint16_t value); -+ -+uint8_t phytium_read8(uint8_t *address); -+ -+void phytium_write8(uint8_t *address, uint8_t value); -+ -+#endif -diff --git a/drivers/usb/phytium/dma.c b/drivers/usb/phytium/dma.c -new file mode 100644 -index 000000000..2e0d6df3e ---- /dev/null -+++ b/drivers/usb/phytium/dma.c -@@ -0,0 +1,786 @@ -+// SPDX-License-Identifier: GPL-2.0 -+ -+#include -+#include -+#include "core.h" -+#include "dma.h" -+#include "hw-regs.h" -+ -+#define TRB_POOL_SIZE (sizeof(struct DMA_Trb) * (NUM_OF_TRB)) -+/* burst length 'x' should be multiples of 2 */ -+#define TRB_BURST_LENGTH(x) (((x) & 0xFF) << 24) -+ -+#define BUILD_NORMAL_TRB_NO_IOC(trb, data_ptr, data_size, stream_id) { \ -+ trb.dmaAddr = data_ptr; \ -+ trb.dmaSize = data_size; \ -+ trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT; } -+ -+#define BUILD_NORMAL_TRB_NO_IOC_CHAIN(trb, data_ptr, data_size, stream_id) { \ -+ trb.dmaAddr = data_ptr; \ -+ trb.dmaSize = data_size; \ -+ trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT | TDF_CHAIN_BIT; } -+ -+#define BUILD_NORMAL_TRB(trb, data_ptr, data_size, stream_id) { \ -+ trb.dmaAddr = data_ptr; \ -+ trb.dmaSize = (data_size) | TRB_BURST_LENGTH(0x80); \ -+ trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT |\ -+ TDF_INT_ON_COMPLECTION | TDF_INT_ON_SHORT_PACKET; } -+ -+#define BUILD_LINK_TRB(trb, target_ptr) { \ -+ trb.dmaAddr = target_ptr; \ -+ trb.dmaSize = 0; \ -+ trb.ctrl = TD_TYPE_LINK | TDF_CYCLE_BIT | TDF_CHAIN_BIT; } -+ -+#define BUILD_EMPTY_TRB(trb) { \ -+ trb.dmaAddr = 0; \ -+ trb.dmaSize = 0; \ -+ trb.ctrl = 0; } -+ -+ -+uint32_t divRoundUp(uint32_t divident, uint32_t divisor) -+{ -+ return divisor ? ((divident + divisor - 1) / divisor) : 0; -+} -+ -+static inline struct DMA_TrbChainDesc *GetTrbChainDescEntry(struct list_head *list) -+{ -+ return (struct DMA_TrbChainDesc *)((uintptr_t)list - -+ (uintptr_t)&(((struct DMA_TrbChainDesc *)0)->chainNode)); -+} -+ -+static int32_t phytium_dma_probe(struct DMA_CFG *config, struct DMA_SYSREQ *sysReq) -+{ -+ if (!sysReq) -+ return -EINVAL; -+ -+ sysReq->trbMemSize = TRB_POOL_SIZE; -+ sysReq->privDataSize = sizeof(struct DMA_CONTROLLER); -+ -+ return 0; -+} -+ -+static int32_t phytium_dma_init(struct DMA_CONTROLLER *priv, -+ const struct DMA_CFG *config, struct DMA_CALLBACKS *callbacks) -+{ -+ if (!priv || !config || !callbacks) -+ return -EINVAL; -+ -+ if (!config->trbAddr || !config->trbDmaAddr) -+ return -EINVAL; -+ -+ memset((void *)priv, 0, sizeof(struct DMA_CONTROLLER)); -+ memset((void *)config->trbAddr, 0, TRB_POOL_SIZE); -+ -+ priv->trbDMAPoolAddr = config->trbDmaAddr; -+ priv->trbPoolAddr = config->trbAddr; -+ priv->regs = (struct DMARegs *)config->regBase; -+ priv->dmaCfg = *config; -+ priv->dmaDrv = DMA_GetInstance(); -+ priv->dmaCallbacks = *callbacks; -+ priv->isHostCtrlMode = 0; -+ return 0; -+} -+ -+static void phytium_dma_destroy(struct DMA_CONTROLLER *priv) -+{ -+ -+} -+ -+static int32_t phytium_dma_start(struct DMA_CONTROLLER *priv) -+{ -+ int i; -+ -+ if (!priv) -+ return -EINVAL; -+ -+ priv->dmaMode = DMA_MODE_CHANNEL_INDIVIDUAL; -+ if ((priv->dmaCfg.dmaModeRx & priv->dmaCfg.dmaModeTx) == 0xFFFF) { -+ priv->dmaMode = DMA_MODE_GLOBAL_DMULT; -+ phytium_write32(&priv->regs->conf, DMARF_DMULT); -+ } else if ((priv->dmaCfg.dmaModeRx | priv->dmaCfg.dmaModeTx)) { -+ priv->dmaMode = DMA_MODE_GLOBAL_DSING; -+ phytium_write32(&priv->regs->conf, DMARF_DSING); -+ } -+ -+ for (i = 0; i < MAX_DMA_CHANNELS; i++) { -+ if (priv->dmaCfg.dmaModeRx & (1 << i)) { -+ priv->rx[i].dmultEnabled = 1; -+ priv->rx[i].maxTrbLen = TD_DMULT_MAX_TRB_DATA_SIZE; -+ priv->rx[i].maxTdLen = TD_DMULT_MAX_TD_DATA_SIZE; -+ } else { -+ priv->rx[i].dmultEnabled = 0; -+ priv->rx[i].maxTrbLen = TD_SING_MAX_TRB_DATA_SIZE; -+ priv->rx[i].maxTdLen = TD_SING_MAX_TD_DATA_SIZE; -+ } -+ priv->rx[i].lastTransferLength = 0; -+ -+ if (priv->dmaCfg.dmaModeTx & (1 << i)) { -+ priv->tx[i].dmultEnabled = 1; -+ priv->tx[i].maxTrbLen = TD_DMULT_MAX_TRB_DATA_SIZE; -+ priv->tx[i].maxTdLen = TD_DMULT_MAX_TD_DATA_SIZE; -+ } else { -+ priv->tx[i].dmultEnabled = 0; -+ priv->tx[i].maxTrbLen = TD_SING_MAX_TRB_DATA_SIZE; -+ priv->tx[i].maxTdLen = TD_SING_MAX_TD_DATA_SIZE; -+ } -+ priv->tx[i].lastTransferLength = 0; -+ } -+ -+ return 0; -+} -+ -+static uint32_t phytium_dma_stop(struct DMA_CONTROLLER *priv) -+{ -+ -+ return 0; -+} -+ -+static int32_t updateDescBuffer(struct DMA_CONTROLLER *priv, -+ struct DMA_TrbChainDesc *trbChainDesc, uint16_t status) -+{ -+ uint32_t ep_sel, i; -+ struct DMA_Channel *channel; -+ -+ if (!priv || !trbChainDesc) -+ return -EINVAL; -+ -+ channel = trbChainDesc->channel; -+ if (!channel) -+ return -EINVAL; -+ -+ if (channel->isIsoc && trbChainDesc->lastTrbIsLink) { -+ if (channel->trbChainDescList.prev == channel->trbChainDescList.next) -+ return 0; -+ } -+ -+ for (i = 0; i < trbChainDesc->numOfTrbs; i++) { -+ if (trbChainDesc->framesDesc) { -+ if (trbChainDesc->isoError) -+ trbChainDesc->framesDesc[i].length = 0; -+ else -+ trbChainDesc->framesDesc[i].length = -+ (uint32_t)trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK; -+ } -+ -+ trbChainDesc->actualLen += -+ (uint32_t)trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK; -+ } -+ -+ if (trbChainDesc->isoError) -+ trbChainDesc->actualLen = 0; -+ -+ ep_sel = phytium_read32(&priv->regs->ep_sel); -+ channel->lastTransferLength = trbChainDesc->actualLen; -+ -+ if (!trbChainDesc->lastTrbIsLink) { -+ if (!list_empty(&trbChainDesc->chainNode)) { -+ for (i = 0; i < trbChainDesc->mapSize; i++) -+ priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; -+ -+ trbChainDesc->channel->numOfTrbChain--; -+ trbChainDesc->reserved = 0; -+ list_del(&trbChainDesc->chainNode); -+ trbChainDesc = NULL; -+ } -+ } -+ -+ if (channel->trbChainDescList.prev == &channel->trbChainDescList) -+ channel->status = DMA_STATUS_FREE; -+ -+ if (priv->dmaCallbacks.complete) -+ priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, -+ channel->isDirTx, false); -+ -+ if (channel->trbChainDescList.next != &channel->trbChainDescList) { -+ trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); -+ if (trbChainDesc && trbChainDesc->lastTrbIsLink) { -+ if (!list_empty(&trbChainDesc->chainNode)) { -+ for (i = 0; i < trbChainDesc->mapSize; i++) -+ priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; -+ -+ trbChainDesc->channel->numOfTrbChain--; -+ trbChainDesc->reserved = 0; -+ list_del(&trbChainDesc->chainNode); -+ } -+ } -+ } -+ -+ phytium_write32(&priv->regs->ep_sel, ep_sel); -+ -+ return 0; -+} -+ -+static void phytium_dma_isr(struct DMA_CONTROLLER *priv) -+{ -+ uint32_t ep_sts, ep_ists, ep_cfg; -+ int i; -+ uint8_t isDirTx, epNum; -+ struct DMA_Channel *channel; -+ struct DMA_TrbChainDesc *trbChainDesc; -+ -+ if (!priv) -+ return; -+ -+ ep_ists = phytium_read32(&priv->regs->ep_ists); -+ if (!ep_ists) { -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | -+ DMARF_EP_ISP | DMARF_EP_TRBERR); -+ return; -+ } -+ -+ for (i = 0; i < 32; i++) { -+ if (!(ep_ists & (1 << i))) -+ continue; -+ -+ isDirTx = i > 15 ? DMARD_EP_TX : 0u; -+ epNum = isDirTx ? i - 16 : i; -+ phytium_write32(&priv->regs->ep_sel, epNum | isDirTx); -+ -+ if (isDirTx) -+ channel = &priv->tx[epNum]; -+ else -+ channel = &priv->rx[epNum]; -+ -+ ep_sts = phytium_read32(&priv->regs->ep_sts); -+ -+ if (ep_sts & DMARF_EP_TRBERR) -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); -+ -+ if ((ep_sts & DMARF_EP_IOC) || (ep_sts & DMARF_EP_ISP) || (channel->dmultGuard -+ & DMARF_EP_IOC) || (channel->dmultGuard & DMARF_EP_ISP)) { -+retransmit: -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP); -+ trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); -+ if (!(ep_sts & DMARF_EP_TRBERR) && channel->dmultEnabled -+ && !trbChainDesc->lastTrbIsLink) { -+ if (!priv->isHostCtrlMode && !channel->isDirTx) { -+ channel->dmultGuard = 0; -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); -+ ep_cfg = phytium_read32(&priv->regs->ep_cfg); -+ ep_cfg &= ~DMARV_EP_ENABLED; -+ phytium_write32(&priv->regs->ep_cfg, (uint32_t)ep_cfg); -+ updateDescBuffer(priv, trbChainDesc, 0); -+ break; -+ } -+ channel->dmultGuard = ep_sts; -+ break; -+ } -+ -+ channel->dmultGuard = 0; -+ updateDescBuffer(priv, trbChainDesc, 0); -+ } -+ -+ if (ep_sts & DMARF_EP_OUTSMM) -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_OUTSMM); -+ -+ if (ep_sts & DMARF_EP_DESCMIS) -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_DESCMIS); -+ -+ if (ep_sts & DMARF_EP_ISOERR) { -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_ISOERR); -+ trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); -+ trbChainDesc->isoError = 1; -+ goto retransmit; -+ } -+ } -+} -+ -+static void phytium_dma_errIsr(struct DMA_CONTROLLER *priv, uint8_t irqNr, uint8_t isDirTx) -+{ -+ struct DMA_Channel *channel; -+ -+ if (!priv) -+ return; -+ -+ if (isDirTx) -+ channel = &priv->tx[irqNr]; -+ else -+ channel = &priv->rx[irqNr]; -+ -+ if (channel->status >= DMA_STATUS_BUSY) -+ channel->status = DMA_STATUS_ABORT; -+ -+ if (priv->dmaCallbacks.complete) { -+ if (!irqNr && priv->resubmit) { -+ priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, -+ channel->isDirTx, true); -+ priv->resubmit = false; -+ } else -+ priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, -+ channel->isDirTx, false); -+ } -+} -+ -+static void *phytium_dma_channelAlloc(struct DMA_CONTROLLER *priv, -+ uint8_t isDirTx, uint8_t hwEpNum, uint8_t isIsoc) -+{ -+ struct DMA_Channel *channel; -+ uint32_t ep_ien, ep_cfg; -+ uint16_t dmaMode; -+ -+ if (!priv || (hwEpNum >= MAX_DMA_CHANNELS)) -+ return NULL; -+ -+ if (!priv->regs) { -+ pr_err("dma regs is null\n"); -+ return NULL; -+ } -+ -+ ep_ien = phytium_read32(&priv->regs->ep_ien); -+ -+ if (isDirTx) { -+ if (priv->tx[hwEpNum].status > DMA_STATUS_FREE) -+ return NULL; -+ -+ channel = &priv->tx[hwEpNum]; -+ channel->isDirTx = 0x80; -+ ep_ien |= (0x01 << (hwEpNum + 16)); -+ dmaMode = priv->dmaCfg.dmaModeTx; -+ } else { -+ if (priv->rx[hwEpNum].status > DMA_STATUS_FREE) -+ return NULL; -+ -+ channel = &priv->rx[hwEpNum]; -+ channel->isDirTx = 0x00; -+ ep_ien |= (0x01 << hwEpNum); -+ dmaMode = priv->dmaCfg.dmaModeRx; -+ } -+ -+ channel->isIsoc = 0; -+ if (isIsoc) -+ channel->isIsoc = 1; -+ -+ INIT_LIST_HEAD(&channel->trbChainDescList); -+ channel->numOfTrbChain = 0; -+ channel->controller = priv; -+ channel->dmultGuard = 0; -+ channel->status = DMA_STATUS_FREE; -+ channel->hwUsbEppNum = hwEpNum; -+ -+ phytium_write32(&priv->regs->ep_sel, (uint32_t)hwEpNum | channel->isDirTx); -+ ep_cfg = phytium_read32(&priv->regs->ep_cfg); -+ -+ if (priv->dmaMode == DMA_MODE_CHANNEL_INDIVIDUAL) { -+ if (dmaMode & (1 << hwEpNum)) -+ ep_cfg |= DMARV_EP_DMULT; -+ else -+ ep_cfg |= DMARV_EP_DSING; -+ } -+ -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP | DMARF_EP_TRBERR); -+ phytium_write32(&priv->regs->ep_cfg, (uint32_t)DMARV_EP_ENABLED | ep_cfg); -+ phytium_write32(&priv->regs->ep_ien, ep_ien); -+ phytium_write32(&priv->regs->ep_sts_en, DMARF_EP_TRBERR); -+ -+ return channel; -+} -+ -+static int32_t phytium_dma_channelRelease(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) -+{ -+ uint32_t ep_ien, i; -+ struct DMA_TrbChainDesc *trbChainDesc; -+ -+ if (!channel || !priv) -+ return -EINVAL; -+ -+ ep_ien = phytium_read32(&priv->regs->ep_ien); -+ if (channel->isDirTx) -+ ep_ien &= ~(0x01 << (channel->hwUsbEppNum + 16)); -+ else -+ ep_ien &= ~(0x01 << channel->hwUsbEppNum); -+ -+ phytium_write32(&priv->regs->ep_sel, (uint32_t)channel->hwUsbEppNum | channel->isDirTx); -+ phytium_write32(&priv->regs->ep_cfg, (uint32_t)0); -+ phytium_write32(&priv->regs->ep_ien, ep_ien); -+ phytium_write32(&priv->regs->ep_sts_en, 0x0); -+ phytium_write32(&priv->regs->ep_cmd, DMARF_EP_EPRST); -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP | -+ DMARF_EP_TRBERR | DMARF_EP_ISOERR); -+ -+ if (channel->status >= DMA_STATUS_BUSY) -+ channel->status = DMA_STATUS_ABORT; -+ -+ priv->dmaDrv->dma_channelAbort(priv, channel); -+ -+ while (channel->trbChainDescList.next != &channel->trbChainDescList) { -+ trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); -+ if (trbChainDesc) { -+ if (!list_empty(&trbChainDesc->chainNode)) { -+ for (i = 0; i < trbChainDesc->mapSize; i++) -+ priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; -+ -+ trbChainDesc->channel->numOfTrbChain--; -+ trbChainDesc->reserved = 0; -+ list_del(&trbChainDesc->chainNode); -+ } -+ } -+ } -+ -+ channel->status = DMA_STATUS_UNKNOW; -+ -+ return 0; -+} -+ -+static void ShowTrbChain(struct DMA_TrbChainDesc *trbChainDesc) -+{ -+ int i; -+ -+ if (!trbChainDesc) -+ return; -+ pr_debug("Trb Chain %p for channel %p\n", trbChainDesc, trbChainDesc->channel); -+ pr_debug("idx | trb size | trb addr | FLAG: NORMAL LINK CHAIN ALL\n"); -+ for (i = 0; i < trbChainDesc->numOfTrbs + 2; i++) -+ pr_debug("%02d | %08x | %08x | %d %d %d %08x\n", -+ i, -+ trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK, -+ trbChainDesc->trbPool[i].dmaAddr, -+ (trbChainDesc->trbPool[i].ctrl & TD_TYPE_NORMAL) ? 1 : 0, -+ (trbChainDesc->trbPool[i].ctrl & TD_TYPE_LINK) ? 1 : 0, -+ (trbChainDesc->trbPool[i].ctrl & TDF_CHAIN_BIT) ? 1 : 0, -+ trbChainDesc->trbPool[i].ctrl); -+} -+ -+static uint32_t phytium_dma_NewTd(struct DMA_CONTROLLER *priv, -+ struct DMA_TrbChainDesc *trbChainDesc) -+{ -+ uint32_t startAddress, dataSize; -+ struct DMA_Channel *channel; -+ int i = 0; -+ uint32_t tmp = 0; -+ -+ if (!priv || !trbChainDesc) -+ return 0; -+ -+ startAddress = trbChainDesc->dwStartAddress; -+ channel = trbChainDesc->channel; -+ dataSize = channel->maxTrbLen; -+ -+ if (trbChainDesc->numOfTrbs > 1) { -+ for (i = 0; i < (trbChainDesc->numOfTrbs - 1); i++) { -+ if (channel->dmultEnabled) { -+ if (trbChainDesc->framesDesc && priv->isHostCtrlMode -+ && channel->isIsoc) { -+ BUILD_NORMAL_TRB_NO_IOC(trbChainDesc->trbPool[i], -+ trbChainDesc->dwStartAddress + -+ trbChainDesc->framesDesc[i].offset, -+ trbChainDesc->framesDesc[i].length, 0); -+ continue; -+ } else -+ BUILD_NORMAL_TRB_NO_IOC(trbChainDesc->trbPool[i], -+ startAddress, dataSize, 0); -+ } else -+ BUILD_NORMAL_TRB_NO_IOC_CHAIN(trbChainDesc->trbPool[i], -+ startAddress, dataSize, 0); -+ startAddress += dataSize; -+ tmp += dataSize; -+ } -+ } -+ -+ if (trbChainDesc->framesDesc && priv->isHostCtrlMode && channel->isIsoc) { -+ BUILD_NORMAL_TRB(trbChainDesc->trbPool[i], -+ trbChainDesc->dwStartAddress + trbChainDesc->framesDesc[i].offset, -+ trbChainDesc->framesDesc[i].length, 0); -+ } else -+ BUILD_NORMAL_TRB(trbChainDesc->trbPool[i], startAddress, -+ trbChainDesc->len - tmp, 0); -+ -+ trbChainDesc->lastTrbIsLink = 0; -+ if (channel->dmultEnabled) { -+ if (channel->isIsoc) { -+ trbChainDesc->lastTrbIsLink = 1; -+ BUILD_LINK_TRB(trbChainDesc->trbPool[i + 1], trbChainDesc->trbDMAAddr); -+ } else -+ BUILD_EMPTY_TRB(trbChainDesc->trbPool[i + 1]); -+ } -+ -+ ShowTrbChain(trbChainDesc); -+ -+ return 0; -+} -+ -+static void phytium_dma_ArmTd(struct DMA_CONTROLLER *priv, struct DMA_TrbChainDesc *trbChainDesc) -+{ -+ uint32_t ep_sts, ep_cfg, ep_cmd; -+ struct DMA_TrbChainDesc *startedChain; -+ struct DMA_Trb *lastPrevTrb; -+ struct DMA_Channel *channel; -+ -+ if (!priv || !trbChainDesc) -+ return; -+ -+ channel = trbChainDesc->channel; -+ phytium_write32(&priv->regs->ep_sel, (channel->isDirTx | channel->hwUsbEppNum)); -+ -+ ep_sts = phytium_read32(&priv->regs->ep_sts); -+ -+ if (channel->status == DMA_STATUS_FREE) { -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); -+ phytium_write32(&priv->regs->traddr, trbChainDesc->trbDMAAddr); -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); -+ -+ ep_cfg = phytium_read32(&priv->regs->ep_cfg); -+ phytium_write32(&priv->regs->ep_cmd, DMARF_EP_DRDY); -+ if (!(ep_cfg & DMARV_EP_ENABLED)) { -+ ep_cfg |= DMARV_EP_ENABLED; -+ phytium_write32(&priv->regs->ep_cfg, ep_cfg); -+ } -+ } else { -+ if (channel->trbChainDescList.prev != channel->trbChainDescList.next) { -+ startedChain = GetTrbChainDescEntry(channel->trbChainDescList.prev->prev); -+ lastPrevTrb = &startedChain->trbPool[startedChain->numOfTrbs]; -+ startedChain->lastTrbIsLink = 1; -+ BUILD_LINK_TRB((*lastPrevTrb), trbChainDesc->trbDMAAddr); -+ ep_cmd = phytium_read32(&priv->regs->ep_cmd); -+ if (!(ep_cmd & DMARF_EP_DRDY)) { -+ phytium_write32(&priv->regs->traddr, trbChainDesc->trbDMAAddr); -+ phytium_write32(&priv->regs->ep_cmd, DMARF_EP_DRDY); -+ } -+ ShowTrbChain(startedChain); -+ } -+ } -+} -+ -+static int32_t phytium_dma_TrbChainAlloc(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel, uint32_t numOfTrbs, struct DMA_TrbChainDesc **chain) -+{ -+ struct DMA_TrbChainDesc *trbChainDesc = NULL; -+ int i, j; -+ uint32_t mapcount, count = 0; -+ -+ if (!priv || !channel) -+ return -ENOMEM; -+ -+ for (i = 0; i < TAB_SIZE_OF_DMA_CHAIN; i++) { -+ if (!priv->trbChainDesc[i].reserved) { -+ trbChainDesc = &priv->trbChainDesc[i]; -+ break; -+ } -+ } -+ -+ if (!trbChainDesc) { -+ pr_err("No Free TRB Chain Descriptor\n"); -+ return -ENOMEM; -+ } -+ -+ INIT_LIST_HEAD(&trbChainDesc->chainNode); -+ *chain = NULL; -+ mapcount = (numOfTrbs + 2 + 7) >> 3; -+ -+ for (i = 0; i < TRB_MAP_SIZE; i++) { -+ if (priv->trbChainFreeMap[i] == 0x0) -+ count++; -+ else -+ count = 0; -+ -+ if (count == mapcount) -+ break; -+ } -+ -+ if (count != mapcount) { -+ pr_err("No Free TRBs count:0x%x, mapcount:0x%x\n", count, mapcount); -+ return -ENOMEM; -+ } -+ -+ trbChainDesc->reserved = 1; -+ trbChainDesc->channel = channel; -+ trbChainDesc->actualLen = 0; -+ trbChainDesc->mapSize = mapcount; -+ trbChainDesc->numOfTrbs = numOfTrbs; -+ trbChainDesc->start = (i + 1 - mapcount) << 3; -+ trbChainDesc->end = trbChainDesc->start; -+ trbChainDesc->trbPool = (struct DMA_Trb *)priv->trbPoolAddr + trbChainDesc->start; -+ trbChainDesc->trbDMAAddr = (uint32_t)(uintptr_t)((struct DMA_Trb *)priv->trbDMAPoolAddr -+ + trbChainDesc->start); -+ trbChainDesc->isoError = 0; -+ -+ list_add_tail(&trbChainDesc->chainNode, &channel->trbChainDescList); -+ -+ channel->numOfTrbChain++; -+ -+ for (j = 0; j < count; j++) -+ priv->trbChainFreeMap[i - j] = 0xFF; -+ -+ *chain = trbChainDesc; -+ -+ return 0; -+} -+ -+static int32_t phytium_dma_channelProgram(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel, uint16_t packetSize, uintptr_t dmaAddr, -+ uint32_t len, void *framesDesc, uint32_t framesNumber) -+{ -+ uint32_t numOfTrbs; -+ uint8_t retval; -+ struct DMA_TrbChainDesc *trbChainDesc; -+ -+ if (!priv || !channel) -+ return -EINVAL; -+ -+ //printk(KERN_ERR "%s %d\n",__func__,__LINE__); -+ if (framesDesc && priv->isHostCtrlMode && channel->isIsoc) -+ numOfTrbs = framesNumber; -+ else -+ numOfTrbs = divRoundUp(len, channel->maxTrbLen); -+ -+ retval = phytium_dma_TrbChainAlloc(priv, channel, numOfTrbs, &trbChainDesc); -+ if (retval) -+ return retval; -+ -+ trbChainDesc->dwStartAddress = dmaAddr; -+ trbChainDesc->len = len; -+ trbChainDesc->framesDesc = framesDesc; -+ -+ channel->wMaxPacketSize = packetSize; -+ phytium_dma_NewTd(priv, trbChainDesc); -+ channel->lastTransferLength = 0; -+ phytium_dma_ArmTd(priv, trbChainDesc); -+ -+ channel->status = DMA_STATUS_BUSY; -+ -+ return 0; -+} -+ -+static enum DMA_Status phytium_dma_getChannelStatus(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel) -+{ -+ uint32_t ep_cmd, ep_sts; -+ -+ if (!priv || !channel) -+ return DMA_STATUS_UNKNOW; -+ -+ if (channel->status >= DMA_STATUS_BUSY) { -+ phytium_write32(&priv->regs->ep_sel, channel->isDirTx | channel->hwUsbEppNum); -+ ep_cmd = phytium_read32(&priv->regs->ep_cmd); -+ ep_sts = phytium_read32(&priv->regs->ep_sts); -+ -+ if ((ep_cmd & DMARF_EP_DRDY) || (ep_sts & DMARF_EP_DBUSY)) -+ channel->status = DMA_STATUS_ARMED; -+ else -+ channel->status = DMA_STATUS_BUSY; -+ } -+ -+ return channel->status; -+} -+ -+static int32_t phytium_dma_channelAbort(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) -+{ -+ struct DMA_TrbChainDesc *trbChainDesc; -+ uint32_t ep_cfg, i; -+ -+ if (!priv || !channel) -+ return -EINVAL; -+ -+ if (phytium_dma_getChannelStatus(priv, channel) >= DMA_STATUS_BUSY) -+ phytium_write32(&priv->regs->conf, DMARF_RESET); -+ -+ phytium_write32(&priv->regs->ep_sel, (uint32_t)(channel->isDirTx | channel->hwUsbEppNum)); -+ ep_cfg = phytium_read32(&priv->regs->ep_cfg); -+ ep_cfg &= ~DMARV_EP_ENABLED; -+ phytium_write32(&priv->regs->ep_cfg, ep_cfg); -+ phytium_write32(&priv->regs->ep_sts, 0xFFFFFFFF); -+ -+ while (channel->trbChainDescList.next != &channel->trbChainDescList) { -+ trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); -+ if (trbChainDesc) { -+ if (!list_empty(&trbChainDesc->chainNode)) { -+ for (i = 0; i < trbChainDesc->mapSize; i++) -+ priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; -+ -+ trbChainDesc->channel->numOfTrbChain--; -+ trbChainDesc->reserved = 0; -+ list_del(&trbChainDesc->chainNode); -+ } -+ } -+ } -+ if (channel->status != DMA_STATUS_UNKNOW) -+ channel->status = DMA_STATUS_FREE; -+ -+ return 0; -+} -+ -+static int32_t phytium_dma_getActualLength(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) -+{ -+ if (!priv || !channel) -+ return -EINVAL; -+ -+ return channel->lastTransferLength; -+} -+ -+static int32_t phytium_dma_getMaxLength(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) -+{ -+ if (!priv || !channel) -+ return -EINVAL; -+ -+ return channel->maxTdLen; -+} -+ -+static int32_t phytium_dma_setMaxLength(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel, uint32_t val) -+{ -+ if (!priv || !channel) -+ return -EINVAL; -+ -+ if (channel->dmultEnabled) -+ channel->maxTrbLen = val; -+ else -+ channel->maxTrbLen = (val > TD_SING_MAX_TRB_DATA_SIZE) ? -+ TD_SING_MAX_TRB_DATA_SIZE : val; -+ -+ return 0; -+} -+ -+static void phytium_dma_setParentPriv(struct DMA_CONTROLLER *priv, void *parent) -+{ -+ if (!priv) -+ return; -+ -+ priv->parent = parent; -+} -+ -+void phytium_dma_controllerReset(struct DMA_CONTROLLER *priv) -+{ -+ uint32_t conf; -+ -+ if (!priv) -+ return; -+ -+ conf = phytium_read32(&priv->regs->conf); -+ conf |= DMARF_RESET; -+ phytium_write32(&priv->regs->conf, conf); -+ -+ priv->resubmit = true; -+} -+ -+void phytium_dma_setHostMode(struct DMA_CONTROLLER *priv) -+{ -+ if (!priv) -+ return; -+ -+ priv->isHostCtrlMode = 1; -+} -+ -+struct DMA_OBJ phytium_dma_Drv = { -+ .dma_probe = phytium_dma_probe, -+ .dma_init = phytium_dma_init, -+ .dma_destroy = phytium_dma_destroy, -+ .dma_start = phytium_dma_start, -+ .dma_stop = phytium_dma_stop, -+ .dma_isr = phytium_dma_isr, -+ .dma_errIsr = phytium_dma_errIsr, -+ .dma_channelAlloc = phytium_dma_channelAlloc, -+ .dma_channelRelease = phytium_dma_channelRelease, -+ .dma_channelProgram = phytium_dma_channelProgram, -+ .dma_channelAbort = phytium_dma_channelAbort, -+ .dma_getChannelStatus = phytium_dma_getChannelStatus, -+ .dma_getActualLength = phytium_dma_getActualLength, -+ .dma_getMaxLength = phytium_dma_getMaxLength, -+ .dma_setMaxLength = phytium_dma_setMaxLength, -+ .dma_setParentPriv = phytium_dma_setParentPriv, -+ .dma_controllerReset = phytium_dma_controllerReset, -+ .dma_setHostMode = phytium_dma_setHostMode, -+}; -+ -+struct DMA_OBJ *DMA_GetInstance(void) -+{ -+ return &phytium_dma_Drv; -+} -diff --git a/drivers/usb/phytium/dma.h b/drivers/usb/phytium/dma.h -new file mode 100644 -index 000000000..073a078c1 ---- /dev/null -+++ b/drivers/usb/phytium/dma.h -@@ -0,0 +1,198 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+ -+#ifndef __PHYTIUM_DMA_H__ -+#define __PHYTIUM_DMA_H__ -+ -+#include -+//#include "list.h" -+ -+#define NUM_OF_TRB 1024 -+#define TRB_MAP_SIZE ((NUM_OF_TRB + (sizeof(uint8_t) * 8) - 1) / (sizeof(uint8_t) * 8)) -+#define MAX_DMA_CHANNELS 16 -+#define TAB_SIZE_OF_DMA_CHAIN (MAX_DMA_CHANNELS * 2) -+ -+#define DMARD_EP_TX 0x80ul -+#define DMARD_EP_RX 0x00ul -+ -+#define DMARF_EP_EPRST 0x00000001ul -+#define DMARF_EP_DRDY 0x00000040ul -+#define DMARF_EP_DFLUSH 0x00000080ul -+ -+#define DMARF_EP_IOC 0x4ul -+#define DMARF_EP_ISP 0x8ul -+#define DMARF_EP_DESCMIS 0x10ul -+#define DMARF_EP_TRBERR 0x80ul -+#define DMARF_EP_DBUSY 0x200ul -+#define DMARF_EP_CCS 0x800ul -+#define DMARF_EP_OUTSMM 0x4000ul -+#define DMARF_EP_ISOERR 0x8000ul -+#define DMARF_EP_DTRANS 0x80000000ul -+ -+#define DMARV_EP_DISABLED 0ul -+#define DMARV_EP_ENABLED 1ul -+#define DMARV_EP_DSING 0x1000ul -+#define DMARV_EP_DMULT 0x2000ul -+ -+#define TD_SIZE_MASK 0x00001FFFF -+ -+#define DMARF_RESET 0x00000001ul -+#define DMARF_DSING 0x00000100ul -+#define DMARF_DMULT 0x00000200ul -+ -+#define TD_DMULT_MAX_TRB_DATA_SIZE 65536u -+#define TD_DMULT_MAX_TD_DATA_SIZE (~1u) -+#define TD_SING_MAX_TRB_DATA_SIZE 65536u -+#define TD_SING_MAX_TD_DATA_SIZE 65536u -+ -+#define TD_TYPE_NORMAL 0x400L -+#define TD_TYPE_LINK 0x1800L -+#define TDF_CYCLE_BIT 0x1L -+#define TDF_TOGGLE_CYCLE_BIT 0x2L -+#define TDF_INT_ON_SHORT_PACKET 0x4L -+#define TDF_FIFO_MODE 0x8L -+#define TDF_CHAIN_BIT 0x10L -+#define TDF_INT_ON_COMPLECTION 0x20L -+#define TDF_STREAMID_VALID 0x200L -+ -+struct DMA_Trb { -+ uint32_t dmaAddr; -+ uint32_t dmaSize; /* 0:16 transfer length; 24:31 burst length */ -+ uint32_t ctrl; -+}; -+ -+enum DMA_Status { -+ DMA_STATUS_UNKNOW, -+ DMA_STATUS_FREE, -+ DMA_STATUS_ABORT, -+ DMA_STATUS_BUSY, -+ DMA_STATUS_ARMED -+}; -+ -+struct DMA_CFG { -+ uintptr_t regBase; -+ uint16_t dmaModeTx; -+ uint16_t dmaModeRx; -+ void *trbAddr; -+ uintptr_t trbDmaAddr; -+}; -+ -+struct DMA_SYSREQ { -+ uint32_t privDataSize; -+ uint32_t trbMemSize; -+}; -+ -+struct DMA_CALLBACKS { -+ void (*complete)(void *pD, uint8_t epNum, uint8_t dir, bool resubmit); -+}; -+ -+struct DMA_CONTROLLER; -+ -+struct DMA_Channel { -+ struct DMA_CONTROLLER *controller; -+ uint16_t wMaxPacketSize; -+ uint8_t hwUsbEppNum; -+ uint8_t isDirTx; -+ uint32_t maxTdLen; -+ uint32_t maxTrbLen; -+ enum DMA_Status status; -+ void *priv; -+ uint32_t dmultGuard; -+ uint8_t dmultEnabled; -+ uint8_t numOfTrbChain; -+ struct list_head trbChainDescList; -+ uint32_t lastTransferLength; -+ uint8_t isIsoc; -+}; -+ -+struct DMA_OBJ { -+ int32_t (*dma_probe)(struct DMA_CFG *config, struct DMA_SYSREQ *sysReq); -+ -+ int32_t (*dma_init)(struct DMA_CONTROLLER *priv, const struct DMA_CFG *config, -+ struct DMA_CALLBACKS *callbacks); -+ -+ void (*dma_destroy)(struct DMA_CONTROLLER *priv); -+ -+ int32_t (*dma_start)(struct DMA_CONTROLLER *priv); -+ -+ uint32_t (*dma_stop)(struct DMA_CONTROLLER *priv); -+ -+ void (*dma_isr)(struct DMA_CONTROLLER *priv); -+ -+ void (*dma_errIsr)(struct DMA_CONTROLLER *priv, uint8_t irqNr, uint8_t isDirTx); -+ -+ void * (*dma_channelAlloc)(struct DMA_CONTROLLER *priv, -+ uint8_t isDirTx, uint8_t hwEpNum, uint8_t isIso); -+ -+ int32_t (*dma_channelRelease)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); -+ -+ int32_t (*dma_channelProgram)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel, -+ uint16_t packetSize, uintptr_t dmaAddr, -+ uint32_t len, void *framesDesc, uint32_t framesNumber); -+ -+ int32_t (*dma_channelAbort)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); -+ -+ enum DMA_Status (*dma_getChannelStatus)(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel); -+ -+ int32_t (*dma_getActualLength)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); -+ -+ int32_t (*dma_getMaxLength)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); -+ -+ int32_t (*dma_setMaxLength)(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel, uint32_t val); -+ -+ void (*dma_setParentPriv)(struct DMA_CONTROLLER *priv, void *parent); -+ -+ void (*dma_controllerReset)(struct DMA_CONTROLLER *priv); -+ -+ void (*dma_setHostMode)(struct DMA_CONTROLLER *priv); -+}; -+ -+enum DMA_Mode { -+ DMA_MODE_GLOBAL_DMULT, -+ DMA_MODE_GLOBAL_DSING, -+ DMA_MODE_CHANNEL_INDIVIDUAL, -+}; -+ -+struct DMA_TrbFrameDesc { -+ uint32_t length; -+ uint32_t offset; -+}; -+ -+struct DMA_TrbChainDesc { -+ uint8_t reserved; -+ struct DMA_Channel *channel; -+ struct DMA_Trb *trbPool; -+ uint32_t trbDMAAddr; -+ uint32_t len; -+ uint32_t dwStartAddress; -+ uint32_t actualLen; -+ uint8_t isoError; -+ uint8_t lastTrbIsLink; -+ uint32_t mapSize; -+ uint32_t numOfTrbs; -+ uint32_t start; -+ uint32_t end; -+ struct DMA_TrbFrameDesc *framesDesc; -+ struct list_head chainNode; -+}; -+ -+struct DMA_CONTROLLER { -+ struct DMARegs *regs; -+ struct DMA_OBJ *dmaDrv; -+ struct DMA_CFG dmaCfg; -+ struct DMA_CALLBACKS dmaCallbacks; -+ struct DMA_Channel rx[MAX_DMA_CHANNELS]; -+ struct DMA_Channel tx[MAX_DMA_CHANNELS]; -+ enum DMA_Mode dmaMode; -+ uint8_t isHostCtrlMode; -+ void *parent; -+ void *trbPoolAddr; -+ uintptr_t trbDMAPoolAddr; -+ uint8_t trbChainFreeMap[TRB_MAP_SIZE]; -+ struct DMA_TrbChainDesc trbChainDesc[TAB_SIZE_OF_DMA_CHAIN]; -+ bool resubmit; -+}; -+ -+struct DMA_OBJ *DMA_GetInstance(void); -+#endif -diff --git a/drivers/usb/phytium/gadget.c b/drivers/usb/phytium/gadget.c -new file mode 100644 -index 000000000..afcb846c8 ---- /dev/null -+++ b/drivers/usb/phytium/gadget.c -@@ -0,0 +1,2538 @@ -+// SPDX-License-Identifier: GPL-2.0 -+ -+#include -+#include "gadget.h" -+#include "dma.h" -+#include "core.h" -+#include "hw-regs.h" -+ -+#define DRV_NAME "phytium_gadget" -+ -+#define GADGET_PRIV_BUFFER_SIZE 64 -+#define GADGET_USB_EP_NUMBER_MASK 0xf -+#define DMA_ADDR_INVALID (~(dma_addr_t)0) -+ -+#define GADGET_ESTALL 1 -+#define GADGET_EUNHANDLED 2 -+#define GADGET_EAUTOACK 3 -+#define GADGET_ESHUTDOWN 4 -+#define GADGET_ECONNRESET 5 -+#define GADGET_EAGAIN 6 -+ -+static inline struct GadgetEp *toGadgetEp(struct GADGET_EP *gadget_Ep) -+{ -+ return (struct GadgetEp *)((uintptr_t)gadget_Ep - -+ ((uintptr_t)&((struct GadgetEp *)0)->gadgetEp)); -+} -+ -+static inline struct GadgetRequest *requestToGadgetRequest(struct GADGET_REQ *req) -+{ -+ return (struct GadgetRequest *)((uintptr_t)req - -+ ((uintptr_t)&((struct GadgetRequest *)0)->request)); -+} -+ -+static inline struct GADGET_REQ *listToGadgetRequest(struct list_head *list) -+{ -+ return (struct GADGET_REQ *)((uintptr_t)list - -+ ((uintptr_t)&((struct GADGET_REQ *)0)->list)); -+} -+ -+#define listBrowsingRequest(iterator, head, memeber) \ -+ for (iterator = listToGadgetRequest((head)->next); \ -+ &iterator->list != (head); \ -+ iterator = listToGadgetRequest(iterator->list.next)) -+ -+static inline struct GADGET_REQ *gadgetGetNextReq(struct GadgetEp *gadgetEp) -+{ -+ struct list_head *list = &gadgetEp->request; -+ -+ if (list_empty(list)) { -+ pr_debug("no request available for %s\n", gadgetEp->gadgetEp.name); -+ return NULL; -+ } -+ -+ return listToGadgetRequest(list->next); -+} -+ -+static inline struct GADGET_REQ *gadgetGetNextEp0Req(struct GADGET_CTRL *priv) -+{ -+ struct list_head *queue; -+ -+ if (!priv) -+ return NULL; -+ -+ queue = &priv->in[0].request; -+ -+ if (list_empty(queue)) -+ return NULL; -+ -+ return listToGadgetRequest(queue->next); -+} -+ -+void gadget_giveback(struct phytium_ep *phy_ep, struct usb_request *usb_req, int status) -+{ -+ struct phytium_request *phy_req; -+ struct phytium_cusb *config; -+ int busy; -+ -+ if (!phy_ep || !usb_req) -+ return; -+ -+ busy = phy_ep->busy; -+ phy_req = usb_req ? container_of(usb_req, struct phytium_request, request) : NULL; -+ config = phy_req->config; -+ -+ list_del(&phy_req->list); -+ -+ if (usb_req->status == -EINPROGRESS) { -+ if (status == GADGET_ESHUTDOWN) -+ usb_req->status = -ESHUTDOWN; -+ else if (status == GADGET_ECONNRESET) -+ usb_req->status = -ECONNRESET; -+ else -+ usb_req->status = -phy_req->gadget_request->status; -+ } -+ -+ if (usb_req->status == 0) -+ pr_debug("%s done request %p, %d/%d\n", phy_ep->end_point.name, -+ usb_req, usb_req->actual, usb_req->length); -+ else -+ pr_debug("%s request %p, %d/%d fault %d\n", phy_ep->end_point.name, -+ usb_req, usb_req->actual, usb_req->length, usb_req->status); -+ -+ usb_gadget_unmap_request(&config->gadget, &phy_req->request, phy_req->is_tx); -+ -+ busy = phy_ep->busy; -+ phy_ep->busy = 1; -+ -+ spin_unlock(&config->lock); -+ -+ if (phy_req->request.complete) -+ phy_req->request.complete(&phy_req->ep->end_point, usb_req); -+ -+ spin_lock(&config->lock); -+ -+ phy_ep->busy = busy; -+} -+ -+static void gadget_callback_complete(struct GADGET_EP *gadget_ep, struct GADGET_REQ *gadget_req) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_request *phy_req; -+ struct usb_request *usb_req; -+ -+ if (!gadget_ep || !gadget_req) -+ return; -+ -+ phy_req = gadget_req->context; -+ usb_req = &phy_req->request; -+ phy_ep = phy_req->ep; -+ usb_req->actual = gadget_req->actual; -+ usb_req->length = gadget_req->length; -+ -+ gadget_giveback(phy_ep, usb_req, gadget_req->status); -+} -+ -+static void gadgetDisconnect(struct GADGET_CTRL *priv) -+{ -+ pr_info("Disconnect USB Device Driver\n"); -+ -+ if (!priv) -+ return; -+ -+ priv->gadgetDev.speed = USB_SPEED_UNKNOWN; -+ priv->gadgetDev.state = USB_STATE_NOTATTACHED; -+ -+ if (priv->eventCallback.disconnect) -+ priv->eventCallback.disconnect(priv); -+} -+ -+static int gadget_get_frame(struct usb_gadget *gadget) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return 0; -+} -+ -+static int gadget_wakeup(struct usb_gadget *gadget) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return 0; -+} -+ -+static int gadget_vbus_session(struct usb_gadget *gadget, int is_active) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return 0; -+} -+ -+static int gadget_vbus_draw(struct usb_gadget *gadget, unsigned int mA) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return 0; -+} -+ -+static int gadget_pullup(struct usb_gadget *gadget, int is_on) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return 0; -+} -+ -+static int gadget_udc_start(struct usb_gadget *gadget, struct usb_gadget_driver *driver) -+{ -+ unsigned long flags; -+ struct phytium_cusb *config; -+ struct GADGET_CTRL *priv; -+ uint32_t gen_cfg; -+ -+ if (!gadget || !driver) -+ return -EINVAL; -+ -+ if (driver->max_speed < USB_SPEED_HIGH) -+ return -EINVAL; -+ -+ config = container_of(gadget, struct phytium_cusb, gadget); -+ -+ pr_info("registering driver %s\n", driver->function); -+ -+ spin_lock_irqsave(&config->lock, flags); -+ config->gadget_driver = driver; -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ config->gadget_obj->gadget_start(config->gadget_priv); -+ -+ priv = (struct GADGET_CTRL *)config->gadget_priv; -+ if (priv->phy_regs) { -+ gen_cfg = phytium_read32(&priv->phy_regs->gen_cfg); -+ gen_cfg = gen_cfg & (~BIT(7)); -+ phytium_write32(&priv->phy_regs->gen_cfg, gen_cfg); -+ } -+ -+ return 0; -+} -+ -+static int gadget_udc_stop(struct usb_gadget *gadget) -+{ -+ struct phytium_cusb *config; -+ unsigned long flags; -+ struct GADGET_CTRL *priv; -+ uint32_t gen_cfg; -+ -+ if (!gadget) -+ return -EINVAL; -+ -+ config = container_of(gadget, struct phytium_cusb, gadget); -+ -+ priv = (struct GADGET_CTRL *)config->gadget_priv; -+ if (priv->phy_regs) { -+ gen_cfg = phytium_read32(&priv->phy_regs->gen_cfg); -+ gen_cfg = gen_cfg | BIT(7); -+ phytium_write32(&priv->phy_regs->gen_cfg, gen_cfg); -+ } -+ spin_lock_irqsave(&config->lock, flags); -+ config->gadget_driver = NULL; -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static struct usb_gadget_ops phytium_gadget_ops = { -+ .get_frame = gadget_get_frame, -+ .wakeup = gadget_wakeup, -+ .vbus_session = gadget_vbus_session, -+ .vbus_draw = gadget_vbus_draw, -+ .pullup = gadget_pullup, -+ .udc_start = gadget_udc_start, -+ .udc_stop = gadget_udc_stop, -+}; -+ -+static int gadget_ep_enable(struct usb_ep *ls_ep, const struct usb_endpoint_descriptor *desc) -+{ -+ struct phytium_ep *phy_ep = NULL; -+ struct phytium_cusb *config; -+ unsigned long flags; -+ -+ if (!ls_ep || !desc) -+ return -EINVAL; -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ -+ if (phy_ep->desc) -+ return -EBUSY; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ phy_ep->desc = desc; -+ phy_ep->busy = 0; -+ config->gadget_obj->gadget_epEnable(config->gadget_priv, phy_ep->gadget_ep, desc); -+ -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static int gadget_ep_disable(struct usb_ep *ls_ep) -+{ -+ struct phytium_ep *phy_ep = NULL; -+ struct phytium_cusb *config; -+ unsigned long flags; -+ -+ if (!ls_ep) -+ return -EBUSY; -+ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ phy_ep->desc = NULL; -+ phy_ep->busy = 0; -+ phy_ep->end_point.desc = NULL; -+ config->gadget_obj->gadget_epDisable(config->gadget_priv, phy_ep->gadget_ep); -+ -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static struct usb_request *gadget_ep_alloc_request(struct usb_ep *ls_ep, gfp_t gfp_flags) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_cusb *config; -+ struct GADGET_EP *gadget_ep; -+ struct phytium_request *phy_request; -+ -+ if (!ls_ep) -+ return NULL; -+ -+ pr_info("%s %d\n", __func__, __LINE__); -+ phy_request = kzalloc(sizeof(*phy_request), gfp_flags); -+ if (!phy_request) { -+ pr_err("not enough momory\n"); -+ return NULL; -+ } -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ gadget_ep = phy_ep->gadget_ep; -+ -+ INIT_LIST_HEAD(&phy_request->list); -+ phy_request->request.dma = DMA_ADDR_INVALID; -+ phy_request->epnum = phy_ep->ep_num; -+ phy_request->ep = phy_ep; -+ phy_request->config = phy_ep->config; -+ -+ config->gadget_obj->gadget_reqAlloc(config->gadget_priv, gadget_ep, -+ &phy_request->gadget_request); -+ -+ return &phy_request->request; -+} -+ -+static void gadget_ep_free_request(struct usb_ep *ls_ep, struct usb_request *ls_req) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_cusb *config; -+ struct phytium_request *phy_request; -+ -+ if (!ls_ep || !ls_req) -+ return; -+ -+ pr_info("%s %d\n", __func__, __LINE__); -+ phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; -+ config = phy_request->config; -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ -+ config->gadget_obj->gadget_reqFree(config->gadget_priv, phy_ep->gadget_ep, -+ phy_request->gadget_request); -+ kfree(phy_request); -+} -+ -+static int gadget_ep_enqueue(struct usb_ep *ls_ep, struct usb_request *ls_req, gfp_t gfp_flags) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_cusb *config; -+ struct phytium_request *phy_request; -+ unsigned long flags; -+ int status = 0; -+ -+ if (!ls_ep || !ls_req) -+ return -EINVAL; -+ -+ if (!ls_req->buf) -+ return -ENODATA; -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; -+ phy_request->config = config; -+ -+ if (phy_request->ep != phy_ep) -+ return -EINVAL; -+ -+ phy_request->request.actual = 0; -+ phy_request->request.status = -EINPROGRESS; -+ phy_request->epnum = phy_ep->ep_num; -+ phy_request->is_tx = phy_ep->is_tx; -+ -+ phy_request->gadget_request->length = ls_req->length; -+ phy_request->gadget_request->status = 0; -+ phy_request->gadget_request->complete = gadget_callback_complete; -+ phy_request->gadget_request->buf = ls_req->buf; -+ phy_request->gadget_request->context = ls_req; -+ -+ status = usb_gadget_map_request(&config->gadget, &phy_request->request, phy_request->is_tx); -+ -+ if (!phy_ep->desc) { -+ pr_debug("req %p queued to %s while ep %s\n", phy_request, ls_ep->name, "disabled"); -+ status = -ESHUTDOWN; -+ usb_gadget_unmap_request(&config->gadget, &phy_request->request, -+ phy_request->is_tx); -+ return status; -+ } -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ phy_request->gadget_request->dma = phy_request->request.dma; -+ list_add_tail(&phy_request->list, &phy_ep->req_list); -+ -+ pr_debug("queue to %s (%s), length = %d\n", phy_ep->name, -+ phy_ep->is_tx ? "IN/TX" : "OUT/RX", phy_request->request.length); -+ -+ status = config->gadget_obj->gadget_reqQueue(config->gadget_priv, phy_ep->gadget_ep, -+ phy_request->gadget_request); -+ -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return status; -+} -+ -+static int gadget_ep_dequeue(struct usb_ep *ls_ep, struct usb_request *ls_req) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_cusb *config; -+ unsigned long flags; -+ int status = 0; -+ struct phytium_request *phy_request; -+ struct phytium_request *phy_next_request; -+ -+ if (!ls_ep || !ls_req) -+ return -EINVAL; -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; -+ -+ if (phy_request->ep != phy_ep) -+ return -EINVAL; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ list_for_each_entry(phy_next_request, &phy_ep->req_list, list) { -+ if (phy_next_request == phy_request) -+ break; -+ } -+ -+ if (phy_next_request != phy_request) { -+ pr_info("request %p not queued to %s\n", phy_request, ls_ep->name); -+ status = -EINVAL; -+ goto done; -+ } -+ -+ status = config->gadget_obj->gadget_reqDequeue(config->gadget_priv, phy_ep->gadget_ep, -+ phy_request->gadget_request); -+done: -+ spin_unlock_irqrestore(&config->lock, flags); -+ return status; -+} -+ -+static int gadget_ep_set_halt(struct usb_ep *ls_ep, int value) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_cusb *config; -+ struct GADGET_EP *gadget_ep = NULL; -+ unsigned long flags; -+ int status = 0; -+ -+ if (!ls_ep) -+ return -EINVAL; -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ gadget_ep = phy_ep->gadget_ep; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ status = config->gadget_obj->gadget_epSetHalt(config->gadget_priv, -+ phy_ep->gadget_ep, value); -+ if (status > 0) { -+ spin_unlock_irqrestore(&config->lock, flags); -+ return -status; -+ } -+ -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static const struct usb_ep_ops gadget_ep_ops = { -+ .enable = gadget_ep_enable, -+ .disable = gadget_ep_disable, -+ .alloc_request = gadget_ep_alloc_request, -+ .free_request = gadget_ep_free_request, -+ .queue = gadget_ep_enqueue, -+ .dequeue = gadget_ep_dequeue, -+ .set_halt = gadget_ep_set_halt, -+}; -+ -+static int gadget_ep0_enable(struct usb_ep *ep, const struct usb_endpoint_descriptor *desc) -+{ -+ return -EINVAL; -+} -+ -+static int gadget_ep0_disable(struct usb_ep *ep) -+{ -+ return -EINVAL; -+} -+ -+static int gadget_ep0_enqueue(struct usb_ep *ls_ep, struct usb_request *ls_req, gfp_t gfp_flags) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_request *phy_request; -+ struct phytium_cusb *config; -+ int status = 0; -+ unsigned long flags; -+ -+ if (!ls_ep || !ls_req) -+ return -EINVAL; -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ if (!list_empty(&phy_ep->req_list)) { -+ status = -EBUSY; -+ goto cleanup; -+ } -+ -+ phy_request->config = config; -+ phy_request->request.actual = 0; -+ phy_request->gadget_request->actual = 0; -+ phy_request->is_tx = config->ep0_data_stage_is_tx; -+ phy_request->gadget_request->length = phy_request->request.length; -+ phy_request->gadget_request->status = 0; -+ phy_request->gadget_request->complete = gadget_callback_complete; -+ phy_request->gadget_request->buf = phy_request->request.buf; -+ phy_request->gadget_request->context = phy_request; -+ -+ status = usb_gadget_map_request(&config->gadget, &phy_request->request, phy_request->is_tx); -+ if (status) { -+ pr_info("failed to map request\n"); -+ status = -EINVAL; -+ goto cleanup; -+ } -+ -+ phy_request->gadget_request->dma = phy_request->request.dma; -+ list_add_tail(&phy_request->list, &phy_ep->req_list); -+ -+ pr_debug("queue to %s (%s), length = %d\n", phy_ep->name, -+ phy_ep->is_tx ? "IN/TX" : "OUT/RX", phy_request->request.length); -+ -+ status = config->gadget_obj->gadget_reqQueue(config->gadget_priv, phy_ep->gadget_ep, -+ phy_request->gadget_request); -+ if (status > 0) { -+ status = -status; -+ usb_gadget_unmap_request(&config->gadget, &phy_request->request, -+ phy_request->is_tx); -+ list_del(&phy_request->list); -+ goto cleanup; -+ } -+ -+cleanup: -+ spin_unlock_irqrestore(&config->lock, flags); -+ return status; -+} -+ -+static int gadget_ep0_dequeue(struct usb_ep *ep, struct usb_request *ls_request) -+{ -+ return -EOPNOTSUPP; -+} -+ -+static int gadget_ep0_set_halt(struct usb_ep *ep, int value) -+{ -+ return -EINVAL; -+} -+ -+ -+static const struct usb_ep_ops gadget_ep0_ops = { -+ .enable = gadget_ep0_enable, -+ .disable = gadget_ep0_disable, -+ .alloc_request = gadget_ep_alloc_request, -+ .free_request = gadget_ep_free_request, -+ .queue = gadget_ep0_enqueue, -+ .dequeue = gadget_ep0_dequeue, -+ .set_halt = gadget_ep0_set_halt, -+}; -+ -+static int32_t gadgetWaitForBusyBit(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) -+{ -+ struct GadgetEp *gadgetEp; -+ uint8_t epNum; -+ uint8_t txcs = CS_BUSY; -+ uint8_t buf = 0; -+ uint8_t bufflag = 0; -+ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ epNum = gadgetEp->hwEpNum; -+ -+ if (gadgetEp->isInEp || gadgetEp->hwEpNum == 0) -+ return 0; -+ -+ buf = phytium_read8(&priv->regs->ep[epNum - 1].txcon) & CON_BUF; -+ -+ while ((txcs & CS_BUSY) || (bufflag == 0)) { -+ txcs = phytium_read8(&priv->regs->ep[epNum - 1].txcs); -+ -+ if (((txcs & CS_NPAK) >> CS_NPAK_OFFSET) == buf || buf == 0) -+ bufflag = 1; -+ else -+ bufflag = 0; -+ } -+ -+ return 0; -+} -+ -+static inline void gadgetEpXDataReceive(struct GADGET_CTRL *priv, -+ struct GadgetRequest *gadgetRequest) -+{ -+ struct GadgetEp *gadgetEp; -+ struct GADGET_REQ *gadgetReq; -+ uint8_t epType; -+ uint32_t requestSize, channelStatus, chMaxLen; -+ -+ if (!priv || !gadgetRequest) -+ return; -+ -+ gadgetEp = gadgetRequest->ep; -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); -+ epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ channelStatus = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, gadgetEp->channel); -+ -+ gadgetReq = &gadgetRequest->request; -+ if (gadgetReq->actual < gadgetReq->length || gadgetRequest->zlp) { -+ gadgetRequest->zlp = 0; -+ if ((gadgetReq->length - gadgetReq->actual) < chMaxLen) -+ requestSize = gadgetReq->length - gadgetReq->actual; -+ else -+ requestSize = chMaxLen; -+ -+ priv->dmaDrv->dma_channelProgram(priv->dmaController, gadgetEp->channel, -+ gadgetEp->gadgetEp.maxPacket, -+ gadgetReq->dma + gadgetReq->actual, requestSize, NULL, 0); -+ } -+} -+ -+static inline void gadgetEpXDataSend(struct GADGET_CTRL *priv, struct GadgetRequest *gadgetRequest) -+{ -+ struct GadgetEp *gadgetEp; -+ struct GADGET_REQ *gadgetReq; -+ uint8_t epType; -+ uint32_t requestSize, channelStatus, chMaxLen; -+ -+ if (!priv || !gadgetRequest) -+ return; -+ -+ gadgetEp = gadgetRequest->ep; -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); -+ epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ channelStatus = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, gadgetEp->channel); -+ -+ gadgetReq = &gadgetRequest->request; -+ if ((gadgetReq->length - gadgetReq->actual) < chMaxLen) -+ requestSize = gadgetReq->length - gadgetReq->actual; -+ else -+ requestSize = chMaxLen; -+ pr_debug("Transmit/IN %s gadgetReq %p gadgetRequest:%p requestSize:0x%x packetSize:0x%x\n", -+ gadgetEp->gadgetEp.name, gadgetReq, gadgetRequest, -+ requestSize, gadgetEp->gadgetEp.maxPacket); -+ -+ gadgetRequest->zlp = 0; -+ priv->dmaDrv->dma_channelProgram(priv->dmaController, gadgetEp->channel, -+ gadgetEp->gadgetEp.maxPacket, -+ gadgetReq->dma + gadgetReq->actual, requestSize, NULL, 0); -+} -+ -+static int32_t gadgetEpXSetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ uint8_t value) -+{ -+ struct GadgetEp *gadgetEp; -+ uint8_t epType; -+ struct GADGET_REQ *req = NULL; -+ struct GadgetRequest *gadgetRequest = NULL; -+ uint8_t epNum, txcon, rxcon; -+ uint32_t status = DMA_STATUS_ARMED; -+ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ if (epType == USB_ENDPOINT_XFER_ISOC) -+ return -EINVAL; -+ -+ pr_debug("%s: %s stall\n", gadget_Ep->name, value ? "set" : "clear"); -+ req = gadgetGetNextReq(gadgetEp); -+ -+ if (!value) -+ gadgetEp->wedged = 0; -+ -+ if (value && gadgetEp->isInEp && req && gadgetEp->state == GADGET_EP_BUSY) { -+ while (status == DMA_STATUS_ARMED) -+ status = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, -+ gadgetEp->channel); -+ -+ gadgetWaitForBusyBit(priv, gadget_Ep); -+ } -+ -+ epNum = gadgetEp->hwEpNum; -+ -+ if (gadgetEp->isInEp) { -+ txcon = phytium_read8(&priv->regs->ep[epNum - 1].txcon); -+ if (value) { -+ phytium_write8(&priv->regs->ep[epNum - 1].txcon, txcon | CON_STALL); -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, -+ ENDPRST_IO_TX | epNum | ENDPRST_FIFORST); -+ -+ } else { -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, -+ ENDPRST_IO_TX | epNum | ENDPRST_TOGRST); -+ phytium_write8(&priv->regs->ep[epNum - 1].txcon, txcon & (~CON_STALL)); -+ } -+ } else { -+ rxcon = phytium_read8(&priv->regs->ep[epNum - 1].rxcon); -+ if (value) { -+ phytium_write8(&priv->regs->ep[epNum - 1].rxcon, rxcon | CON_STALL); -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, epNum | ENDPRST_FIFORST); -+ } else { -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, -+ epNum | ENDPRST_TOGRST | ENDPRST_FIFORST); -+ phytium_write8(&priv->regs->ep[epNum - 1].rxcon, rxcon & (~CON_STALL)); -+ } -+ } -+ -+ if (gadgetEp->state != GADGET_EP_BUSY && !value && req) { -+ gadgetRequest = requestToGadgetRequest(req); -+ if (gadgetEp->isInEp) -+ gadgetEpXDataSend(priv, gadgetRequest); -+ else -+ gadgetEpXDataReceive(priv, gadgetRequest); -+ } -+ -+ return 0; -+} -+ -+static int32_t gadgetEp0SetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ uint8_t value) -+{ -+ struct GadgetEp *gadgetEp; -+ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ if (!list_empty(&gadgetEp->request)) -+ return -EBUSY; -+ -+ switch (priv->ep0State) { -+ case GADGET_EP0_STAGE_IN: -+ case GADGET_EP0_STAGE_OUT: -+ case GADGET_EP0_STAGE_ACK: -+ case GADGET_EP0_STAGE_STATUSIN: -+ case GADGET_EP0_STAGE_STATUSOUT: -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+ -+static void gadgetEp0Callback(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req, uint8_t status) -+{ -+ if (!priv || !gadgetEp || !req) -+ return; -+ -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ list_del(&req->list); -+ gadgetEp->requestsInList--; -+ -+ if (req->status == EINPROGRESS) -+ req->status = status; -+ -+ if (req->complete) -+ req->complete(&gadgetEp->gadgetEp, req); -+} -+ -+static enum usb_device_speed gadgetGetActualSpeed(struct GADGET_CTRL *priv) -+{ -+ uint8_t speedctrl; -+ -+ if (!priv) -+ return USB_SPEED_UNKNOWN; -+ -+ speedctrl = phytium_read8(&priv->regs->speedctrl) & (~SPEEDCTRL_HSDISABLE); -+ switch (speedctrl) { -+ case SPEEDCTRL_HS: -+ return USB_SPEED_HIGH; -+ case SPEEDCTRL_FS: -+ return USB_SPEED_FULL; -+ case SPEEDCTRL_LS: -+ return USB_SPEED_LOW; -+ default: -+ return USB_SPEED_UNKNOWN; -+ } -+} -+ -+static int32_t gadgetServiceSetFeatureReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) -+{ -+ uint8_t epNum, isIn; -+ struct GadgetEp *gadgetEp; -+ -+ if (!priv || !setup) -+ return 0; -+ -+ switch (setup->bRequestType & USB_RECIP_MASK) { -+ case USB_RECIP_DEVICE: -+ switch (setup->wValue) { -+ case USB_DEVICE_REMOTE_WAKEUP: -+ pr_info("set feature - remote wakup\n"); -+ priv->isRemoteWakeup = 1; -+ break; -+ case USB_DEVICE_B_HNP_ENABLE: -+ pr_info("set feature - B HNP Enable\n"); -+ pr_info("otg not implement\n"); -+ return -EINVAL; -+ case USB_DEVICE_A_HNP_SUPPORT: -+ pr_info("set feature - A HNP support\n"); -+ pr_info("otg not implete\n"); -+ return -EINVAL; -+ } -+ break; -+ case USB_RECIP_INTERFACE: -+ break; -+ case USB_RECIP_ENDPOINT: -+ epNum = setup->wIndex & 0x0f; -+ isIn = setup->wIndex & USB_DIR_IN; -+ if (epNum == 0 || epNum > 15 || setup->wValue != 0) -+ return -EINVAL; -+ -+ gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; -+ -+ gadgetEpXSetHalt(priv, &gadgetEp->gadgetEp, 1); -+ break; -+ default: -+ return -EINVAL; -+ } -+ return 0; -+} -+ -+static int32_t gadgetServiceClearFeatureReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) -+{ -+ uint8_t epNum, isIn; -+ struct GadgetEp *gadgetEp; -+ -+ if (!priv || !setup) -+ return -EINVAL; -+ -+ switch (setup->bRequestType & USB_RECIP_MASK) { -+ case USB_RECIP_DEVICE: -+ if (setup->wValue == USB_DEVICE_B_HNP_ENABLE) { -+ pr_err("otg not implement\n"); -+ return -EINVAL; -+ } -+ -+ if (setup->wValue != USB_DEVICE_REMOTE_WAKEUP) -+ return GADGET_EUNHANDLED; -+ -+ priv->isRemoteWakeup = 0; -+ return GADGET_EAUTOACK; -+ case USB_RECIP_INTERFACE: -+ break; -+ case USB_RECIP_ENDPOINT: -+ pr_info("clear feature wIndex:0x%x wValue:0x%x\n", setup->wIndex, setup->wValue); -+ epNum = setup->wIndex & 0x7f; -+ isIn = setup->wIndex & USB_DIR_IN; -+ if (epNum == 0 || epNum > 15 || setup->wValue != 0) -+ return GADGET_EUNHANDLED; -+ -+ gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; -+ if (!gadgetEp->gadgetEp.desc) -+ return -EINVAL; -+ -+ if (gadgetEp->wedged) -+ break; -+ gadgetEpXSetHalt(priv, &gadgetEp->gadgetEp, 0); -+ break; -+ default: -+ return GADGET_EUNHANDLED; -+ } -+ -+ return 0; -+} -+ -+static int32_t gadgetServiceSetupReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) -+{ -+ struct GadgetEp *gadgetEp; -+ uint8_t isIn, epNum; -+ uint8_t rxcon, txcon; -+ int len; -+ -+ if (!priv || !setup) -+ return -EINVAL; -+ -+ if ((setup->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) { -+ if (setup->bRequest != USB_REQ_GET_STATUS) -+ return GADGET_EUNHANDLED; -+ } else -+ return GADGET_EUNHANDLED; -+ -+ priv->privBuffAddr[1] = 0; -+ priv->privBuffAddr[0] = 0; -+ -+ switch (setup->bRequest & USB_RECIP_MASK) { -+ case USB_RECIP_DEVICE: -+ pr_info("wIndex:0x%x isSelfPowered:%d isRomoteWakeup:%d\n", -+ setup->wIndex, priv->isSelfPowered, priv->isRemoteWakeup); -+ -+ if (setup->wIndex == OTG_STS_SELECTOR) -+ priv->privBuffAddr[0] = priv->hostRequestFlag; -+ else { -+ priv->privBuffAddr[0] = priv->isSelfPowered ? USB_DEVICE_SELF_POWERED : 0; -+ priv->privBuffAddr[1] = priv->isRemoteWakeup ? USB_DEVICE_REMOTE_WAKEUP : 0; -+ } -+ break; -+ case USB_RECIP_INTERFACE: -+ break; -+ case USB_RECIP_ENDPOINT: -+ epNum = setup->wIndex & 0x0f; -+ if (!epNum) -+ break; -+ -+ isIn = setup->wIndex & USB_DIR_IN; -+ -+ gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; -+ if (!gadgetEp->gadgetEp.desc) -+ return -EINVAL; -+ -+ if (isIn) { -+ txcon = phytium_read8(&priv->regs->ep[epNum - 1].txcon); -+ priv->privBuffAddr[0] = (txcon & CON_STALL) ? 1 : 0; -+ } else { -+ rxcon = phytium_read8(&priv->regs->ep[epNum - 1].rxcon); -+ priv->privBuffAddr[0] = (rxcon & CON_STALL) ? 1 : 0; -+ } -+ break; -+ default: -+ return GADGET_EUNHANDLED; -+ } -+ -+ len = setup->wLength; -+ if (len > 2) -+ len = 2; -+ -+ priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->in[0].channel, -+ priv->in[0].gadgetEp.maxPacket, priv->privBuffDma, len, NULL, 0); -+ -+ return 0; -+} -+ -+static int32_t gadgetGetSetup(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) -+{ -+ int i; -+ uint8_t ep0cs; -+ struct GADGET_REQ *request = NULL; -+ struct GadgetRequest *gadgetRequest; -+ -+ if (!priv || !setup) -+ return -EINVAL; -+ -+ phytium_write8(&priv->regs->ep0cs, EP0CS_CHGSET); -+ -+ for (i = 0; i < 8; i++) -+ ((char *)setup)[i] = phytium_read8(&priv->regs->setupdat[i]); -+ -+ ep0cs = phytium_read8(&priv->regs->ep0cs); -+ if (ep0cs & EP0CS_CHGSET) { -+ pr_info("setup flags change: not error\n"); -+ return GADGET_EAUTOACK; -+ } -+ -+ phytium_write8(&priv->regs->usbirq, USBIR_SUDAV); -+ pr_debug("setup packet: req%02x.%02x v:%04x i:%04x I%d\n", setup->bRequestType, -+ setup->bRequest, setup->wValue, setup->wIndex, setup->wLength); -+ -+ request = gadgetGetNextEp0Req(priv); -+ if (request) { -+ gadgetRequest = requestToGadgetRequest(request); -+ pr_info("Previous request has not been finished but new was received\n"); -+ gadgetEp0Callback(priv, gadgetRequest->ep, request, 0); -+ } -+ -+ if (setup->wLength) { -+ if (setup->bRequestType & USB_DIR_IN) -+ priv->ep0State = GADGET_EP0_STAGE_IN; -+ else -+ priv->ep0State = GADGET_EP0_STAGE_OUT; -+ } else -+ priv->ep0State = GADGET_EP0_STAGE_ACK; -+ -+ return 0; -+} -+ -+static void gadgetEp0StageSetup(struct GADGET_CTRL *priv) -+{ -+ struct usb_ctrlrequest setup; -+ int32_t retval; -+ uint8_t ep0cs; -+ -+ if (!priv) -+ return; -+ -+ retval = gadgetGetSetup(priv, &setup); -+ -+ priv->gadgetDev.speed = gadgetGetActualSpeed(priv); -+ -+ switch (priv->ep0State) { -+ case GADGET_EP0_STAGE_ACK: -+ if ((setup.bRequestType & USB_TYPE_MASK) != USB_TYPE_STANDARD) -+ retval = GADGET_EUNHANDLED; -+ else { -+ switch (setup.bRequest) { -+ case USB_REQ_SET_ADDRESS: -+ priv->deviceAddress = setup.wValue & 0x7F; -+ priv->gadgetDev.state = USB_STATE_ADDRESS; -+ pr_info("set address: %d\n", priv->deviceAddress); -+ retval = GADGET_EAUTOACK; -+ break; -+ case USB_REQ_SET_FEATURE: -+ retval = gadgetServiceSetFeatureReq(priv, &setup); -+ break; -+ case USB_REQ_CLEAR_FEATURE: -+ retval = gadgetServiceClearFeatureReq(priv, &setup); -+ break; -+ default: -+ retval = GADGET_EUNHANDLED; -+ break; -+ } -+ } -+ -+ if (retval == GADGET_EUNHANDLED) -+ break; -+ else if (retval == 0) -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); -+ -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ break; -+ case GADGET_EP0_STAGE_IN: -+ pr_debug("setup data stage in\n"); -+ retval = gadgetServiceSetupReq(priv, &setup); -+ -+ if (retval == 0) -+ priv->ep0State = GADGET_EP0_STAGE_STATUSOUT; -+ break; -+ case GADGET_EP0_STAGE_OUT: -+ pr_debug("setup data stage out\n"); -+ phytium_write8(&priv->regs->ep0Rxbc, 0); -+ retval = GADGET_EUNHANDLED; -+ break; -+ default: -+ if (retval == GADGET_EAUTOACK) -+ return; -+ -+ pr_debug("forward request\n"); -+ retval = GADGET_EUNHANDLED; -+ break; -+ } -+ -+ if (retval == GADGET_EUNHANDLED) { -+ if (priv->eventCallback.setup) -+ retval = priv->eventCallback.setup(priv, &setup); -+ -+ if (retval == 0x7FFF) { -+ pr_debug("Respond Delayed not finished yet\n"); -+ return; -+ } -+ -+ if (retval) -+ retval = GADGET_ESTALL; -+ } -+ -+ if (retval == GADGET_EUNHANDLED || retval == GADGET_ESTALL) { -+ pr_debug("request not handled - send stall\n"); -+ ep0cs = phytium_read8(&priv->regs->ep0cs); -+ ep0cs |= EP0CS_STALL; -+ phytium_write8(&priv->regs->ep0cs, ep0cs); -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ } else if (priv->ep0State == GADGET_EP0_STAGE_ACK) { -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); -+ pr_debug("setup transfer completed\n"); -+ } -+} -+static void gadgetEp0DataSend(struct GADGET_CTRL *priv) -+{ -+ struct GADGET_REQ *request; -+ uint32_t chMaxLen, requestSize; -+ -+ if (!priv) -+ return; -+ -+ request = gadgetGetNextEp0Req(priv); -+ if (!request) { -+ pr_debug("Ep0 queue is empty\n"); -+ return; -+ } -+ -+ if (priv->dmaDrv->dma_getChannelStatus(priv->dmaController, priv->in[0].channel) -+ >= DMA_STATUS_BUSY) { -+ pr_err("transfer is pending now\n"); -+ return; -+ } -+ -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, priv->in[0].channel); -+ requestSize = (request->length < chMaxLen) ? request->length : chMaxLen; -+ pr_debug("usbRequest;%p requestSize:%d packetSize:%d\n", request, requestSize, -+ priv->in[0].gadgetEp.maxPacket); -+ priv->ep0State = GADGET_EP0_STAGE_STATUSOUT; -+ -+ priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->in[0].channel, -+ priv->in[0].gadgetEp.maxPacket, request->dma, requestSize, NULL, 0); -+} -+ -+static void gadgetEp0DataReceive(struct GADGET_CTRL *priv) -+{ -+ uint32_t chMaxLen, requestSize; -+ struct GADGET_REQ *request; -+ -+ if (!priv) -+ return; -+ -+ request = gadgetGetNextEp0Req(priv); -+ if (!request) { -+ pr_debug("Ep0 queue is empty\n"); -+ return; -+ } -+ -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, priv->out[0].channel); -+ requestSize = (request->length < chMaxLen) ? request->length : chMaxLen; -+ pr_debug("usbRequest;%p requestSize:%d packetSize:%d\n", request, requestSize, -+ priv->out[0].gadgetEp.maxPacket); -+ priv->ep0State = GADGET_EP0_STAGE_STATUSIN; -+ -+ priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->out[0].channel, -+ priv->out[0].gadgetEp.maxPacket, request->dma, requestSize, NULL, 0); -+} -+ -+static uint32_t gadgetEp0Irq(struct GADGET_CTRL *priv) -+{ -+ uint8_t usbcs; -+ struct GADGET_REQ *request; -+ -+ if (!priv) -+ return 0; -+ -+ switch (priv->ep0State) { -+ case GADGET_EP0_STAGE_IN://send data -+ pr_debug("DATA Stage IN\n"); -+ gadgetEp0DataSend(priv); -+ break; -+ case GADGET_EP0_STAGE_OUT://receive data -+ pr_debug("DATA Stage OUT\n"); -+ gadgetEp0DataReceive(priv); -+ break; -+ case GADGET_EP0_STAGE_STATUSIN: -+ pr_debug("DATA Stage STATUS IN\n"); -+ request = gadgetGetNextEp0Req(priv); -+ if (request) -+ request->actual = priv->dmaDrv->dma_getActualLength(priv->dmaController, -+ priv->out[0].channel); -+ -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); -+ gadgetEp0Callback(priv, &priv->out[0], request, 0); -+ break; -+ case GADGET_EP0_STAGE_STATUSOUT: -+ pr_debug("DATA Stage STATUS OUT\n"); -+ request = gadgetGetNextEp0Req(priv); -+ if (request) -+ request->actual = priv->dmaDrv->dma_getActualLength(priv->dmaController, -+ priv->in[0].channel); -+ -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); -+ if (request) -+ gadgetEp0Callback(priv, &priv->in[0], request, 0); -+ else -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ break; -+ case GADGET_EP0_STAGE_SETUP: -+ pr_debug("DATA Stage SETUP\n"); -+ gadgetEp0StageSetup(priv); -+ break; -+ case GADGET_EP0_STAGE_ACK: -+ pr_debug("DATA Stage ACK\n"); -+ break; -+ default: -+ pr_debug("DATA Stage UNKNOWN\n"); -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs |= EP0CS_STALL; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+ break; -+ } -+ -+ return 0; -+} -+ -+static void gadgetEpXCallback(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req, uint32_t status) -+{ -+ if (!gadgetEp || !req) -+ return; -+ -+ list_del(&req->list); -+ gadgetEp->requestsInList--; -+ req->status = status; -+ -+ if (req->complete) -+ req->complete(&gadgetEp->gadgetEp, req); -+} -+ -+static void gadgetEpXDataCallback(struct GADGET_CTRL *priv, uint8_t epNum, uint8_t epDir) -+{ -+ struct GadgetEp *gadgetEp; -+ struct GADGET_REQ *gadgetReq; -+ uint32_t actual_length = 0; -+ uint32_t chMaxLen = 0; -+ uint8_t epType; -+ -+ if (!priv) -+ return; -+ -+ pr_debug("%s %d epNum:%d epDir:%d\n", __func__, __LINE__, epNum, epDir); -+ gadgetEp = epDir ? &priv->in[epNum] : &priv->out[epNum]; -+ -+ gadgetReq = gadgetGetNextReq(gadgetEp); -+ if (!gadgetReq) { -+ pr_debug("%s queue is empty\n", gadgetEp->gadgetEp.name); -+ return; -+ } -+ -+ if (gadgetEp->channel) { -+ actual_length = priv->dmaDrv->dma_getActualLength(priv->dmaController, -+ gadgetEp->channel); -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); -+ gadgetReq->actual += actual_length; -+ } -+ -+ if (gadgetReq->actual == gadgetReq->length || actual_length < chMaxLen) { -+ gadgetEpXCallback(priv, gadgetEp, gadgetReq, 0); -+ -+ if (gadgetEp->gadgetEp.desc) { -+ epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ if (epType == USB_ENDPOINT_XFER_ISOC) -+ return; -+ -+ gadgetReq = gadgetGetNextReq(gadgetEp); -+ gadgetEp->state = GADGET_EP_ALLOCATED; -+ if (!gadgetReq) { -+ pr_debug("%s queue is empty\n", gadgetEp->gadgetEp.name); -+ return; -+ } -+ gadgetEp->state = GADGET_EP_BUSY; -+ if (epDir) -+ gadgetEpXDataSend(priv, requestToGadgetRequest(gadgetReq)); -+ else -+ gadgetEpXDataReceive(priv, requestToGadgetRequest(gadgetReq)); -+ } -+ } else { -+ if (epDir) -+ gadgetEpXDataSend(priv, requestToGadgetRequest(gadgetReq)); -+ else -+ gadgetEpXDataReceive(priv, requestToGadgetRequest(gadgetReq)); -+ } -+} -+ -+void gadget_CallbackTransfer(void *priv, uint8_t epNum, uint8_t epDir, bool resubmit) -+{ -+ if (!epNum) -+ gadgetEp0Irq(priv); -+ else -+ gadgetEpXDataCallback(priv, epNum, epDir); -+} -+ -+static void gadgetAbortEndpoint(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) -+{ -+ struct GADGET_REQ *gadgetReq; -+ -+ pr_debug("Abort Device endpoint: %s, dma channel: %p\n", gadgetEp->gadgetEp.name, -+ gadgetEp->channel); -+ -+ if (gadgetEp->channel && gadgetEp->hwEpNum != 0) { -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, gadgetEp->channel); -+ gadgetEp->channel = NULL; -+ } -+ -+ if (gadgetEp->channel && gadgetEp->hwEpNum == 0) { -+ if (priv->releaseEp0Flag == 1) { -+ priv->dmaDrv->dma_channelAbort(priv->dmaController, gadgetEp->channel); -+ priv->dmaDrv->dma_channelAlloc(priv->dmaController, gadgetEp->isInEp, -+ gadgetEp->hwEpNum, 0); -+ } -+ } -+ -+ while (gadgetEp->request.next != &gadgetEp->request) { -+ gadgetReq = listToGadgetRequest(gadgetEp->request.next); -+ pr_debug("shutdown request %p form epName:%s\n", gadgetReq, -+ gadgetEp->gadgetEp.name); -+ if (!gadgetEp->gadgetEp.address) -+ gadgetEp0Callback(priv, gadgetEp, gadgetReq, GADGET_ESHUTDOWN); -+ else -+ gadgetEpXCallback(priv, gadgetEp, gadgetReq, GADGET_ESHUTDOWN); -+ } -+ -+ gadgetEp->state = GADGET_EP_FREE; -+} -+ -+static void gadgetStopActivity(struct GADGET_CTRL *priv) -+{ -+ int i = 0; -+ struct GadgetEp *gadgetEp; -+ -+ pr_debug("USB Stop Activity\n"); -+ -+ if (!priv) -+ return; -+ -+ for (i = 0; i < 16; i++) { -+ gadgetEp = &priv->in[i]; -+ if (gadgetEp->state != GADGET_EP_NOT_IMPLEMENTED) -+ gadgetAbortEndpoint(priv, gadgetEp); -+ -+ gadgetEp = &priv->out[i]; -+ if (gadgetEp->state != GADGET_EP_NOT_IMPLEMENTED) -+ gadgetAbortEndpoint(priv, gadgetEp); -+ } -+} -+ -+ -+static int32_t gadgetEp0Enable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) -+{ -+ uint8_t txien, rxien; -+ -+ if (!priv || !gadgetEp) -+ return -EINVAL; -+ -+ if (gadgetEp->state != GADGET_EP_FREE) -+ return -EBUSY; -+ -+ if (!gadgetEp->isInEp) { -+ rxien = phytium_read16(&priv->regs->rxien); -+ rxien &= ~(1 << gadgetEp->hwEpNum); -+ phytium_write16(&priv->regs->rxien, rxien); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_IO_TX | FIFOCTRL_FIFOAUTO); -+ } else { -+ txien = phytium_read16(&priv->regs->txien); -+ txien &= ~(1 << gadgetEp->hwEpNum); -+ phytium_write16(&priv->regs->txien, txien); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO); -+ } -+ -+ gadgetEp->gadgetEp.desc = NULL; -+ gadgetEp->state = GADGET_EP_ALLOCATED; -+ gadgetEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, -+ gadgetEp->isInEp, gadgetEp->hwEpNum, 0); -+ phytium_write8(&priv->regs->ep0maxpack, 0x40); -+ -+ return 0; -+} -+ -+static int32_t gadgetEpXEnable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ const struct usb_endpoint_descriptor *desc) -+{ -+ uint32_t status = -EINVAL; -+ uint32_t payload; -+ uint16_t type, iso = 0; -+ uint8_t epNum = 0; -+ -+ if (!priv || !gadgetEp || !desc) -+ return -EINVAL; -+ -+ pr_debug("enable endpoint %s\n", gadgetEp->gadgetEp.name); -+ if (gadgetEp->state != GADGET_EP_FREE) { -+ status = -EBUSY; -+ goto fail; -+ } -+ -+ payload = desc->wMaxPacketSize & 0x7ff; -+ if (!payload) { -+ status = -EINVAL; -+ goto fail; -+ } -+ -+ epNum = gadgetEp->hwEpNum; -+ -+ type = desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ switch (type) { -+ case USB_ENDPOINT_XFER_ISOC: -+ type = CON_TYPE_ISOC; -+ switch (payload >> 11) { -+ case 0: -+ iso = CON_TYPE_ISOC_1_ISOD; -+ break; -+ case 1: -+ payload *= 2; -+ iso = CON_TYPE_ISOC_2_ISOD; -+ break; -+ case 2: -+ payload *= 3; -+ iso = CON_TYPE_ISOC_3_ISOD; -+ break; -+ } -+ break; -+ case USB_ENDPOINT_XFER_INT: -+ type = CON_TYPE_INT; -+ break; -+ case USB_ENDPOINT_XFER_BULK: -+ type = CON_TYPE_BULK; -+ break; -+ } -+ -+ if (desc->bEndpointAddress & USB_DIR_IN) { -+ if (!gadgetEp->isInEp) { -+ status = -ENODEV; -+ goto fail; -+ } -+ -+ if (payload > priv->gadgetCfg.epIN[epNum].maxPacketSize) { -+ status = -EINVAL; -+ goto fail; -+ } -+ -+ phytium_write16(&priv->regs->txmaxpack[epNum - 1], payload); -+ phytium_write8(&priv->regs->ep[epNum - 1].txcon, CON_VAL | type -+ | iso | (priv->gadgetCfg.epIN[epNum - 1].bufferingValue - 1)); -+ -+ phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum | -+ ENDPRST_FIFORST | ENDPRST_TOGRST); -+ } else { -+ if (gadgetEp->isInEp) { -+ status = -ENODEV; -+ goto fail; -+ } -+ -+ if (payload > priv->gadgetCfg.epOUT[epNum].maxPacketSize) { -+ status = -EINVAL; -+ goto fail; -+ } -+ -+ phytium_write16(&priv->regs->rxmaxpack[epNum - 1], payload); -+ phytium_write8(&priv->regs->ep[epNum - 1].rxcon, CON_VAL | type -+ | iso | (priv->gadgetCfg.epIN[epNum - 1].bufferingValue - 1)); -+ -+ phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | epNum); -+ phytium_write8(&priv->regs->endprst, epNum); -+ phytium_write8(&priv->regs->endprst, epNum | ENDPRST_FIFORST | ENDPRST_TOGRST); -+ } -+ -+ if (priv->dmaController) -+ gadgetEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, -+ gadgetEp->isInEp, epNum, (type == CON_TYPE_ISOC) ? 1 : 0); -+ -+ if (type == CON_TYPE_ISOC) { -+ if (gadgetEp->isInEp) { -+ phytium_write16(&priv->regs->isoautodump, 1 << epNum); -+ phytium_write16(&priv->regs->isodctrl, 1 << epNum); -+ } -+ -+ priv->dmaDrv->dma_setMaxLength(priv->dmaController, gadgetEp->channel, payload); -+ } -+ -+ gadgetEp->state = GADGET_EP_ALLOCATED; -+ gadgetEp->gadgetEp.desc = desc; -+fail: -+ return status; -+} -+ -+static int32_t gadgetEpEnable(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ const struct usb_endpoint_descriptor *desc) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ -+ if (!priv || !gadget_Ep || !desc) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ gadgetEp->wedged = 0; -+ -+ if (gadgetEp->hwEpNum) -+ return gadgetEpXEnable(priv, gadgetEp, desc); -+ else -+ return gadgetEp0Enable(priv, gadgetEp); -+} -+ -+static int32_t gadgetEpXDisable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) -+{ -+ uint8_t txcon, rxcon; -+ -+ if (!priv || !gadgetEp) -+ return -EINVAL; -+ -+ pr_debug("disable endpoint %s\n", gadgetEp->gadgetEp.name); -+ if (gadgetEp->isInEp) { -+ txcon = phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon); -+ txcon &= ~CON_VAL; -+ phytium_write8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon, txcon); -+ } else { -+ rxcon = phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon); -+ rxcon &= ~CON_VAL; -+ phytium_write8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon, rxcon); -+ } -+ gadgetAbortEndpoint(priv, gadgetEp); -+ gadgetEp->gadgetEp.desc = 0; -+ gadgetEp->state = GADGET_EP_FREE; -+ return 0; -+} -+ -+static int32_t gadgetEp0Disable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) -+{ -+ if (!priv || !gadgetEp) -+ return -EINVAL; -+ -+ pr_debug("disable endpoint %s\n", gadgetEp->gadgetEp.name); -+ gadgetAbortEndpoint(priv, gadgetEp); -+ -+ return 0; -+} -+ -+static int32_t gadgetEpDisable(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ if (gadget_Ep->address == 0) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ gadgetEp->wedged = 0; -+ if (gadgetEp->hwEpNum) -+ return gadgetEpXDisable(priv, gadgetEp); -+ else -+ return gadgetEp0Disable(priv, gadgetEp); -+} -+ -+static int32_t gadgetEpXQueue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetRequest *gadgetRequest; -+ -+ if (!priv || !gadgetEp || !req) -+ return -EINVAL; -+ -+ req->actual = 0; -+ req->status = EINPROGRESS; -+ -+ gadgetRequest = requestToGadgetRequest(req); -+ gadgetRequest->ep = gadgetEp; -+ -+ if (req->length == 0) -+ gadgetRequest->zlp = 1; -+ -+ if (gadgetEp->gadgetEp.desc == NULL) { -+ pr_info("%s is disabled - can not queue request %p\n", -+ gadgetEp->gadgetEp.name, req); -+ return -EINVAL; -+ } -+ -+ list_add_tail(&req->list, &gadgetEp->request); -+ pr_debug("queue to %s (%s), length:%d\n", gadgetEp->gadgetEp.name, -+ (gadgetEp->isInEp ? "IN/TX" : "OUT/RX"), req->length); -+ -+ if ((gadgetEp->state == GADGET_EP_ALLOCATED) && (&req->list == gadgetEp->request.next)) { -+ if (gadgetEp->isInEp) { -+ if (!(phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon) -+ & CON_STALL)) { -+ gadgetEp->state = GADGET_EP_BUSY; -+ gadgetEpXDataSend(priv, gadgetRequest); -+ } -+ } else { -+ if (!(phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon) -+ & CON_STALL)) { -+ gadgetEp->state = GADGET_EP_BUSY; -+ gadgetEpXDataReceive(priv, gadgetRequest); -+ } -+ } -+ } else if (gadgetEp->state == GADGET_EP_BUSY) { -+ if (usb_endpoint_xfer_isoc(gadgetEp->gadgetEp.desc)) { -+ if (gadgetEp->isInEp) -+ gadgetEpXDataSend(priv, gadgetRequest); -+ else -+ gadgetEpXDataReceive(priv, gadgetRequest); -+ } -+ } -+ -+ pr_debug("endpoint %s (%s) now is busy - transfer will be waiting in Queue\n", -+ gadgetEp->gadgetEp.name, (gadgetEp->isInEp ? "IN/TX" : "OUT/RX")); -+ -+ return 0; -+} -+ -+static int32_t gadgetEp0Queue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetRequest *gadgetRequest; -+ -+ if (!priv || !gadgetEp || !req) -+ return -EINVAL; -+ -+ req->actual = 0; -+ req->status = EINPROGRESS; -+ -+ if (!list_empty(&gadgetEp->request)) -+ return -EBUSY; -+ -+ gadgetRequest = requestToGadgetRequest(req); -+ gadgetRequest->ep = gadgetEp; -+ -+ switch (priv->ep0State) { -+ case GADGET_EP0_STAGE_OUT: -+ case GADGET_EP0_STAGE_IN: -+ case GADGET_EP0_STAGE_ACK: -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ list_add_tail(&req->list, &gadgetEp->request); -+ gadgetEp->requestsInList++; -+ -+ pr_debug("queue to %s (%s), length:%d stage:%d\n", gadgetEp->gadgetEp.name, -+ gadgetEp->isInEp ? "IN/TX" : "OUT/RX", req->length, priv->ep0State); -+ -+ switch (priv->ep0State) { -+ case GADGET_EP0_STAGE_OUT: -+ gadgetEp0DataReceive(priv); -+ break; -+ case GADGET_EP0_STAGE_IN: -+ gadgetEp0DataSend(priv); -+ break; -+ case GADGET_EP0_STAGE_ACK: -+ if (req->length) -+ return -EINVAL; -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); -+ gadgetEp0Callback(priv, gadgetRequest->ep, req, 0); -+ pr_info("control transfer completed\n"); -+ break; -+ default: -+ break; -+ } -+ -+ return 0; -+} -+ -+static int32_t gadgetEpQueue(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ -+ if (!priv || !gadget_Ep || !req) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ -+ if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) -+ return gadgetEpXQueue(priv, gadgetEp, req); -+ else -+ return gadgetEp0Queue(priv, gadgetEp, req); -+} -+ -+static int32_t gadgetEpXDequeue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetRequest *gadgetRequest; -+ struct GADGET_REQ *iterator; -+ -+ if (!priv || !gadgetEp || !req) -+ return -EINVAL; -+ -+ gadgetRequest = requestToGadgetRequest(req); -+ if (gadgetRequest->ep != gadgetEp) -+ return -EINVAL; -+ -+ pr_debug("Dequeue request %p form %s\n", req, gadgetEp->gadgetEp.name); -+ -+ listBrowsingRequest(iterator, &gadgetEp->request, list) { -+ if (req == iterator) -+ break; -+ } -+ -+ if (req != iterator) { -+ pr_info("request %p not queued to %s\n", req, gadgetEp->gadgetEp.name); -+ return -EINVAL; -+ } -+ -+ if (gadgetEp->state == GADGET_EP_BUSY) { -+ priv->dmaDrv->dma_channelAbort(priv->dmaController, gadgetEp->channel); -+ gadgetEp->state = GADGET_EP_ALLOCATED; -+ } -+ -+ gadgetEpXCallback(priv, gadgetEp, req, GADGET_ECONNRESET); -+ -+ return 0; -+} -+ -+static int32_t gadgetEp0Dequeue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req) -+{ -+ return 0; -+} -+ -+static int32_t gadgetEpDequeue(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ -+ if (!priv || !gadget_Ep || !req) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ -+ if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) -+ return gadgetEpXDequeue(priv, gadgetEp, req); -+ else -+ return gadgetEp0Dequeue(priv, gadgetEp, req); -+} -+ -+static int32_t gadgetEpSetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, uint8_t value) -+{ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) -+ return gadgetEpXSetHalt(priv, gadget_Ep, value); -+ else -+ return gadgetEp0SetHalt(priv, gadget_Ep, value); -+} -+ -+static int32_t gadgetEpSetWedge(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ gadgetEp->wedged = 1; -+ -+ return gadgetEpSetHalt(priv, gadget_Ep, 1); -+} -+ -+static int32_t gadgetEpFifoStatus(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) -+{ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ return 0; -+} -+ -+static void gadgetEpFifoFlush(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) -+{ -+ if (!priv || !gadget_Ep) -+ return; -+} -+ -+static int32_t gadgetEpAllocRequest(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ struct GADGET_REQ **req) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ struct GadgetRequest *gadgetRequest = NULL; -+ -+ if (!priv || !gadget_Ep || !req) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ if (priv->eventCallback.usbRequestMemAlloc) -+ gadgetRequest = priv->eventCallback.usbRequestMemAlloc(priv, -+ sizeof(*gadgetRequest)); -+ if (!gadgetRequest) -+ return -ENOMEM; -+ -+ memset(gadgetRequest, 0, sizeof(*gadgetRequest)); -+ *req = &gadgetRequest->request; -+ INIT_LIST_HEAD(&gadgetRequest->request.list); -+ gadgetRequest->ep = gadgetEp; -+ -+ return 0; -+} -+ -+static void gadgetEpFreeRequest(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetRequest *gadgetRequest = NULL; -+ -+ if (!priv || !gadget_Ep || !req) -+ return; -+ -+ gadgetRequest = requestToGadgetRequest(req); -+ -+ if (priv->eventCallback.usbRequestMemFree) -+ priv->eventCallback.usbRequestMemFree(priv, gadgetRequest); -+} -+ -+static struct GADGET_EP_OPS gadgetEpOps = { -+ .epEnable = gadgetEpEnable, -+ .epDisable = gadgetEpDisable, -+ .reqQueue = gadgetEpQueue, -+ .reqDequeue = gadgetEpDequeue, -+ .epSetHalt = gadgetEpSetHalt, -+ .epSetWedge = gadgetEpSetWedge, -+ .epFifoStatus = gadgetEpFifoStatus, -+ .reqAlloc = gadgetEpAllocRequest, -+ .reqFree = gadgetEpFreeRequest -+}; -+ -+static void gadgetInitDeviceEp(struct GADGET_CTRL *priv, uint8_t isInEp) -+{ -+ uint8_t num; -+ struct GadgetEp *gadgetEp; -+ struct GADGET_EP_CFG epCfg; -+ -+ if (!priv) -+ return; -+ -+ for (num = 0; num < 16; num++) { -+ gadgetEp = isInEp ? &priv->in[num] : &priv->out[num]; -+ if (num) { -+ epCfg = isInEp ? priv->gadgetCfg.epIN[num] : priv->gadgetCfg.epOUT[num]; -+ if (!epCfg.bufferingValue) { -+ gadgetEp->state = GADGET_EP_NOT_IMPLEMENTED; -+ gadgetEp->hwEpNum = num; -+ continue; -+ } -+ } -+ INIT_LIST_HEAD(&gadgetEp->gadgetEp.epList); -+ INIT_LIST_HEAD(&gadgetEp->request); -+ gadgetEp->state = GADGET_EP_FREE; -+ gadgetEp->hwEpNum = num; -+ gadgetEp->isInEp = isInEp; -+ gadgetEp->requestsInList = 0; -+ snprintf(gadgetEp->gadgetEp.name, sizeof(gadgetEp->gadgetEp.name), -+ "Ep%d%s", num, isInEp ? "in" : "out"); -+ if (!num) { -+ gadgetEp->gadgetEp.maxPacket = priv->gadgetCfg.epIN[num].maxPacketSize; -+ if (isInEp) -+ priv->gadgetDev.ep0 = &gadgetEp->gadgetEp; -+ gadgetEp->gadgetEp.ops = &gadgetEpOps; -+ gadgetEp0Enable(priv, gadgetEp); -+ continue; -+ } -+ -+ if (isInEp) { -+ if (epCfg.startBuf) -+ phytium_write16(&priv->regs->txstaddr[num - 1].addr, -+ epCfg.startBuf); -+ phytium_write8(&priv->regs->ep[num - 1].txcon, 0); -+ gadgetEp->gadgetEp.maxPacket = epCfg.maxPacketSize; -+ } else { -+ if (epCfg.startBuf) -+ phytium_write16(&priv->regs->rxstaddr[num - 1].addr, -+ epCfg.startBuf); -+ phytium_write8(&priv->regs->ep[num - 1].rxcon, 0); -+ gadgetEp->gadgetEp.maxPacket = epCfg.maxPacketSize; -+ } -+ -+ gadgetEp->gadgetEp.ops = &gadgetEpOps; -+ gadgetEp->gadgetEp.address = isInEp ? (0x80 | num) : num; -+ gadgetEp->gadgetEp.maxburst = 0; -+ gadgetEp->gadgetEp.mult = 0; -+ gadgetEp->gadgetEp.maxStreams = 0; -+ priv->endpointInList++; -+ list_add_tail(&gadgetEp->gadgetEp.epList, &priv->gadgetDev.epList); -+ } -+} -+ -+static void gadgetInitEndpoint(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return; -+ -+ gadgetInitDeviceEp(priv, 1); -+ gadgetInitDeviceEp(priv, 0); -+} -+ -+static void gadgetSetup(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return; -+ -+ INIT_LIST_HEAD(&priv->gadgetDev.epList); -+ priv->gadgetDev.state = USB_STATE_NOTATTACHED; -+ priv->gadgetDev.maxSpeed = USB_SPEED_HIGH; -+ priv->gadgetDev.speed = USB_SPEED_FULL; -+ snprintf(priv->gadgetDev.name, sizeof(priv->gadgetDev.name), "Phytium USB SD Driver"); -+ -+ gadgetInitEndpoint(priv); -+ -+ phytium_write8(&priv->regs->ep0maxpack, 0x40); -+ phytium_write16(&priv->regs->rxien, 0); -+ phytium_write16(&priv->regs->txien, 0); -+ phytium_write16(&priv->regs->rxirq, 0xFFFF); -+ phytium_write16(&priv->regs->txirq, 0xFFFF); -+ phytium_write8(&priv->regs->usbirq, 0xEF); -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); -+ priv->isReady = 1; -+} -+int32_t gadgetInit(struct GADGET_CTRL *priv, struct GADGET_CFG *config, -+ struct GADGET_CALLBACKS *callbacks, struct device *pdev) -+{ -+ struct DMA_SYSREQ dmaSysReq; -+ uint8_t usbcs; -+ -+ if (!priv || !config || !callbacks) -+ return -EINVAL; -+ -+ priv->dev = pdev; -+ priv->eventCallback = *callbacks; -+ priv->gadgetCfg = *config; -+ priv->regs = (struct HW_REGS *)config->regBase; -+ priv->phy_regs = (struct VHUB_REGS *)config->phy_regBase; -+ priv->gadgetDrv = GADGET_GetInstance(); -+ priv->dmaDrv = DMA_GetInstance(); -+ priv->dmaController = (void *)(priv + 1); -+ priv->dmaCfg.dmaModeRx = 0xFFFF; -+ priv->dmaCfg.dmaModeTx = 0xFFFF; -+ priv->dmaCfg.regBase = config->regBase + 0x400; -+ priv->dmaCfg.trbAddr = config->trbAddr; -+ priv->dmaCfg.trbDmaAddr = config->trbDmaAddr; -+ -+ priv->dmaDrv->dma_probe(NULL, &dmaSysReq); -+ priv->privBuffAddr = (uint8_t *)((uintptr_t)config->trbAddr + dmaSysReq.trbMemSize); -+ priv->privBuffDma = (uintptr_t)((uintptr_t)config->trbDmaAddr + dmaSysReq.trbMemSize); -+ priv->dmaCallback.complete = gadget_CallbackTransfer; -+ priv->dmaDrv->dma_init(priv->dmaController, &priv->dmaCfg, &priv->dmaCallback); -+ priv->dmaDrv->dma_setParentPriv(priv->dmaController, priv); -+ -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs |= USBCS_DISCON | USBCS_LPMNYET; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+ -+ gadgetSetup(priv); -+ -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs &= USBCS_DISCON; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+ -+ return 0; -+} -+ -+static void gadgetDestroy(struct GADGET_CTRL *priv) -+{ -+ pr_debug("Destroy Device Controller driver\n"); -+ -+ if (priv) -+ return; -+ gadgetDisconnect(priv); -+ -+ gadgetStopActivity(priv); -+ -+ phytium_write8(&priv->regs->usbcs, USBCS_DISCON); -+ -+ priv->isReady = 0; -+} -+ -+static void gadgetStart(struct GADGET_CTRL *priv) -+{ -+ uint8_t usbien, usbcs; -+ -+ pr_debug("Usb Device Controller start\n"); -+ if (!priv) -+ return; -+ -+ usbien = phytium_read8(&priv->regs->usbien); -+ usbien |= USBIR_URES | USBIR_SUDAV | USBIR_LPMIR; -+ phytium_write8(&priv->regs->usbien, usbien); -+ -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs &= ~USBCS_DISCON; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+ -+ priv->dmaDrv->dma_start(priv->dmaController); -+} -+ -+static void gadgetReset(struct GADGET_CTRL *priv) -+{ -+ int i = 0; -+ -+ pr_debug("Usb Disable Device Activity\n"); -+ -+ if (!priv) -+ return; -+ -+ if (priv->gadgetDev.speed != USB_SPEED_UNKNOWN) -+ gadgetDisconnect(priv); -+ -+ priv->gadgetDev.aHnpSupport = 0; -+ priv->gadgetDev.bHnpEnable = 0; -+ priv->gadgetDev.state = USB_STATE_DEFAULT; -+ priv->deviceAddress = 0; -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ -+ gadgetStopActivity(priv); -+ -+ for (i = 0; i < 1000; i++) { -+ priv->gadgetDev.speed = gadgetGetActualSpeed(priv); -+ if (priv->gadgetDev.speed == USB_SPEED_HIGH) -+ return; -+ } -+} -+ -+static void gadgetStop(struct GADGET_CTRL *priv) -+{ -+ pr_debug("Usb Device Controller stop\n"); -+ -+ if (!priv) -+ return; -+ -+ if (!priv->isReady) -+ return; -+ -+ gadgetReset(priv); -+ -+ phytium_write8(&priv->regs->usbien, 0); -+ priv->dmaDrv->dma_stop(priv->dmaController); -+ -+ priv->isReady = 0; -+} -+ -+static void gadgetIsr(struct GADGET_CTRL *priv) -+{ -+ uint8_t usbirq, usbien, usbcs; -+ -+ if (!priv) -+ return; -+ -+ usbirq = phytium_read8(&priv->regs->usbirq); -+ usbien = phytium_read8(&priv->regs->usbien); -+ -+ pr_debug("usbirq:0x%x usbien:0x%x\n", usbirq, usbien); -+ -+ usbirq = usbirq & usbien; -+ -+ if (!usbirq) -+ goto DMA_IRQ; -+ -+ if (usbirq & USBIR_LPMIR) { -+ pr_debug("USBIRQ LPM\n"); -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs &= ~USBCS_LPMNYET; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+ phytium_write8(&priv->regs->usbirq, USBIR_LPMIR); -+ } -+ -+ if (usbirq & USBIR_URES) { -+ pr_debug("USBIRQ RESET\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_URES); -+ priv->releaseEp0Flag = 1; -+ gadgetReset(priv); -+ priv->releaseEp0Flag = 0; -+ priv->gadgetDev.state = USB_STATE_DEFAULT; -+ if (priv->eventCallback.connect) -+ priv->eventCallback.connect(priv); -+ } -+ -+ if (usbirq & USBIR_HSPEED) { -+ pr_debug("USBIRQ HighSpeed\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_HSPEED); -+ priv->gadgetDev.speed = USB_SPEED_HIGH; -+ } -+ -+ if (usbirq & USBIR_SUDAV) { -+ pr_debug("USBIRQ SUDAV\n"); -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ gadgetEp0Irq(priv); -+ } -+ -+ if (usbirq & USBIR_SOF) { -+ pr_debug("USBIRQ SOF\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_SOF); -+ } -+ -+ if (usbirq & USBIR_SUTOK) { -+ pr_debug("USBIRQ SUTOK\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_SUTOK); -+ } -+ -+ if (usbirq & USBIR_SUSP) { -+ pr_debug("USBIRQ SUSPEND\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_SUSP); -+ } -+ -+ return; -+DMA_IRQ: -+ priv->dmaDrv->dma_isr(priv->dmaController); -+} -+ -+static void gadgetGetDevInstance(struct GADGET_CTRL *priv, struct GADGET_DEV **dev) -+{ -+ if (!priv || !dev) -+ return; -+ -+ *dev = &priv->gadgetDev; -+} -+ -+static int32_t gadgetGetFrame(struct GADGET_CTRL *priv, uint32_t *numOfFrame) -+{ -+ if (!priv || !numOfFrame) -+ return -EINVAL; -+ -+ *numOfFrame = phytium_read16(&priv->regs->frmnr); -+ -+ return 0; -+} -+ -+static int32_t gadgetWakeUp(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ return -ENOTSUPP; -+} -+ -+static int32_t gadgetSetSelfPowered(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ priv->isSelfPowered = 1; -+ -+ return 0; -+} -+ -+static int32_t gadgetClearSelfPowered(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ priv->isSelfPowered = 0; -+ -+ return 0; -+} -+ -+static int32_t gadgetVbusSession(struct GADGET_CTRL *priv, uint8_t isActive) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ return -ENOTSUPP; -+} -+ -+static int32_t gadgetVbusDraw(struct GADGET_CTRL *priv, uint8_t mA) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ return -ENOTSUPP; -+} -+ -+static int32_t gadgetPullUp(struct GADGET_CTRL *priv, uint8_t isOn) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ return -ENOTSUPP; -+} -+ -+struct GADGET_OBJ GadgetObj = { -+ .gadget_init = gadgetInit, -+ .gadget_destroy = gadgetDestroy, -+ .gadget_start = gadgetStart, -+ .gadget_stop = gadgetStop, -+ .gadget_isr = gadgetIsr, -+ //endpoint operation -+ .gadget_epEnable = gadgetEpEnable, -+ .gadget_epDisable = gadgetEpDisable, -+ .gadget_epSetHalt = gadgetEpSetHalt, -+ .gadget_epSetWedge = gadgetEpSetWedge, -+ .gadget_epFifoStatus = gadgetEpFifoStatus, -+ .gadget_epFifoFlush = gadgetEpFifoFlush, -+ .gadget_reqQueue = gadgetEpQueue, -+ .gadget_reqDequeue = gadgetEpDequeue, -+ .gadget_reqAlloc = gadgetEpAllocRequest, -+ .gadget_reqFree = gadgetEpFreeRequest, -+ -+ //Device operations -+ .gadget_getDevInstance = gadgetGetDevInstance, -+ .gadget_dGetFrame = gadgetGetFrame, -+ .gadget_dWakeUp = gadgetWakeUp, -+ .gadget_dSetSelfpowered = gadgetSetSelfPowered, -+ .gadget_dClearSelfpowered = gadgetClearSelfPowered, -+ .gadget_dVbusSession = gadgetVbusSession, -+ .gadget_dVbusDraw = gadgetVbusDraw, -+ .gadget_dPullUp = gadgetPullUp, -+}; -+ -+struct GADGET_OBJ *GADGET_GetInstance(void) -+{ -+ return &GadgetObj; -+} -+ -+static int phytium_gadget_set_default_cfg(struct phytium_cusb *config) -+{ -+ int index; -+ -+ config->gadget_cfg.regBase = (uintptr_t)config->regs; -+ config->gadget_cfg.phy_regBase = (uintptr_t)config->phy_regs; -+ config->gadget_cfg.dmaInterfaceWidth = GADGET_DMA_32_WIDTH; -+ -+ for (index = 0; index < 16; index++) { -+ if (index == 0) { -+ config->gadget_cfg.epIN[index].bufferingValue = 1; -+ config->gadget_cfg.epIN[index].maxPacketSize = 64; -+ config->gadget_cfg.epIN[index].startBuf = 0; -+ -+ config->gadget_cfg.epOUT[index].bufferingValue = 1; -+ config->gadget_cfg.epOUT[index].maxPacketSize = 64; -+ config->gadget_cfg.epOUT[index].startBuf = 0; -+ } else { -+ config->gadget_cfg.epIN[index].bufferingValue = 4; -+ config->gadget_cfg.epIN[index].maxPacketSize = 1024; -+ config->gadget_cfg.epIN[index].startBuf = 64 + 4096 * (index - 1); -+ -+ config->gadget_cfg.epOUT[index].bufferingValue = 4; -+ config->gadget_cfg.epOUT[index].maxPacketSize = 1024; -+ config->gadget_cfg.epOUT[index].startBuf = 64 + 4096 * (index - 1); -+ } -+ } -+ -+ return 0; -+} -+ -+void gadget_callback_connect(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return; -+} -+ -+void gadget_callback_disconnect(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return; -+} -+ -+int32_t gadget_callback_setup(struct GADGET_CTRL *priv, struct usb_ctrlrequest *ctrl) -+{ -+ struct phytium_cusb *config; -+ int ret = 0; -+ -+ if (!priv || !ctrl) -+ return -EINVAL; -+ -+ config = dev_get_drvdata(priv->dev); -+ if (!config) -+ return -1; -+ -+ if (!config->gadget_driver) -+ return -EOPNOTSUPP; -+ -+ if (ctrl->bRequestType & USB_DIR_IN) -+ config->ep0_data_stage_is_tx = 1; -+ else -+ config->ep0_data_stage_is_tx = 0; -+ -+ spin_unlock(&config->lock); -+ ret = config->gadget_driver->setup(&config->gadget, ctrl); -+ spin_lock(&config->lock); -+ -+ if (ret == 0x7FFF) -+ return ret; -+ -+ if (ret < 0) -+ return 1; -+ -+ return 0; -+} -+ -+void *gadget_callback_usbRequestMemAlloc(struct GADGET_CTRL *priv, u32 size) -+{ -+ struct GADGET_REQ *gadget_req = NULL; -+ -+ gadget_req = kzalloc(size, GFP_NOWAIT); -+ if (!gadget_req) -+ return NULL; -+ -+ return gadget_req; -+} -+ -+void gadget_callback_usbRequestMemFree(struct GADGET_CTRL *priv, void *usbReq) -+{ -+ if (!usbReq) -+ return; -+ -+ kfree(usbReq); -+} -+ -+static void init_peripheral_ep(struct phytium_cusb *config, -+ struct phytium_ep *phy_ep, struct GADGET_EP *gadget_ep, int is_tx) -+{ -+ if (!config || !phy_ep || !gadget_ep) -+ return; -+ -+ memset(phy_ep, 0, sizeof(*phy_ep)); -+ phy_ep->config = config; -+ phy_ep->is_tx = is_tx; -+ phy_ep->gadget_ep = gadget_ep; -+ phy_ep->ep_num = gadget_ep->address & 0xF; -+ phy_ep->end_point.maxpacket = gadget_ep->maxPacket; -+ phy_ep->end_point.maxpacket_limit = 1024; -+ -+ INIT_LIST_HEAD(&phy_ep->req_list); -+ sprintf(phy_ep->name, "ep%d%s", phy_ep->ep_num, is_tx ? "in" : "out"); -+ -+ switch (phy_ep->ep_num) { -+ case 0: -+ phy_ep->end_point.caps.type_control = 1; -+ break; -+ case 1: -+ phy_ep->end_point.caps.type_bulk = 1; -+ break; -+ case 2: -+ phy_ep->end_point.caps.type_int = 1; -+ break; -+ case 3: -+ phy_ep->end_point.caps.type_iso = 1; -+ break; -+ default: -+ phy_ep->end_point.caps.type_int = 1; -+ phy_ep->end_point.caps.type_bulk = 1; -+ break; -+ } -+ -+ if (is_tx) { -+ phy_ep->end_point.caps.dir_in = 1; -+ phy_ep->end_point.caps.dir_out = 0; -+ } else { -+ phy_ep->end_point.caps.dir_in = 0; -+ phy_ep->end_point.caps.dir_out = 1; -+ } -+ -+ phy_ep->end_point.name = phy_ep->name; -+ -+ INIT_LIST_HEAD(&phy_ep->end_point.ep_list); -+ -+ if (!phy_ep->ep_num) { -+ phy_ep->end_point.ops = &gadget_ep0_ops; -+ config->gadget.ep0 = &phy_ep->end_point; -+ -+ if (config->gadget_dev->maxSpeed > USB_SPEED_HIGH) -+ config->gadget.ep0->maxpacket = 9; -+ } else { -+ phy_ep->end_point.ops = &gadget_ep_ops; -+ list_add_tail(&phy_ep->end_point.ep_list, &config->gadget.ep_list); -+ } -+} -+ -+static void gadget_init_endpoint(struct phytium_cusb *config) -+{ -+ struct list_head *list; -+ struct GADGET_EP *gadget_ep; -+ -+ if (!config) -+ return; -+ -+ INIT_LIST_HEAD(&(config->gadget.ep_list)); -+ -+ init_peripheral_ep(config, &config->endpoints_tx[0], config->gadget_dev->ep0, 1); -+ init_peripheral_ep(config, &config->endpoints_rx[0], config->gadget_dev->ep0, 0); -+ -+ list_for_each(list, &config->gadget_dev->epList) { -+ gadget_ep = (struct GADGET_EP *)list; -+ if (gadget_ep->address & USB_DIR_IN) -+ init_peripheral_ep(config, &config->endpoints_tx[gadget_ep->address & 0xf], -+ gadget_ep, 1); -+ else -+ init_peripheral_ep(config, &config->endpoints_rx[gadget_ep->address & 0xf], -+ gadget_ep, 0); -+ } -+} -+ -+static int gadget_setup(struct phytium_cusb *config) -+{ -+ int ret = -1; -+ -+ config->gadget_obj->gadget_getDevInstance(config->gadget_priv, &config->gadget_dev); -+ config->gadget.ops = &phytium_gadget_ops; -+ config->gadget.max_speed = config->gadget_dev->maxSpeed; -+ config->gadget.speed = USB_SPEED_HIGH; -+ config->gadget.name = "phytium_gadget"; -+ config->gadget.is_otg = 0; -+ -+ gadget_init_endpoint(config); -+ -+ ret = usb_add_gadget_udc(config->dev, &config->gadget); -+ if (ret) -+ goto err; -+ -+ return 0; -+ -+err: -+ config->gadget.dev.parent = NULL; -+ device_unregister(&config->gadget.dev); -+ return ret; -+} -+ -+int phytium_gadget_reinit(struct phytium_cusb *config) -+{ -+ struct GADGET_CTRL *ctrl; -+ -+ if (!config) -+ return 0; -+ -+ ctrl = (struct GADGET_CTRL *)config->gadget_priv; -+ if (!ctrl) -+ return 0; -+ -+ gadgetStop(ctrl); -+ -+ config->gadget_obj->gadget_init(config->gadget_priv, &config->gadget_cfg, -+ &config->gadget_callbacks, config->dev); -+ -+ return 0; -+} -+ -+int phytium_gadget_init(struct phytium_cusb *config) -+{ -+ int ret; -+ -+ if (!config) -+ return 0; -+ -+ phytium_gadget_set_default_cfg(config); -+ config->gadget_obj = &GadgetObj; -+ -+ config->dma_cfg.regBase = config->gadget_cfg.regBase + 0x400; -+ config->dma_obj = DMA_GetInstance(); -+ config->dma_obj->dma_probe(&config->dma_cfg, &config->dma_sysreq); -+ -+ config->gadget_sysreq.privDataSize = sizeof(struct GADGET_CTRL); -+ config->gadget_sysreq.trbMemSize = config->dma_sysreq.trbMemSize + GADGET_PRIV_BUFFER_SIZE; -+ config->gadget_sysreq.privDataSize += config->dma_sysreq.privDataSize; -+ -+ config->gadget_priv = devm_kzalloc(config->dev, -+ config->gadget_sysreq.privDataSize, GFP_KERNEL); -+ if (!config->gadget_priv) { -+ ret = -ENOMEM; -+ goto err_probe; -+ } -+ config->gadget_cfg.trbAddr = dma_alloc_coherent(config->dev, -+ config->gadget_sysreq.trbMemSize, -+ (dma_addr_t *)&config->gadget_cfg.trbDmaAddr, GFP_KERNEL); -+ if (!config->gadget_cfg.trbAddr) { -+ ret = -ENOMEM; -+ goto err_dma_coherent; -+ } -+ -+ config->gadget_callbacks.connect = gadget_callback_connect; -+ config->gadget_callbacks.disconnect = gadget_callback_disconnect; -+ config->gadget_callbacks.setup = gadget_callback_setup; -+ config->gadget_callbacks.usbRequestMemAlloc = gadget_callback_usbRequestMemAlloc; -+ config->gadget_callbacks.usbRequestMemFree = gadget_callback_usbRequestMemFree; -+ -+ ret = config->gadget_obj->gadget_init(config->gadget_priv, &config->gadget_cfg, -+ &config->gadget_callbacks, config->dev); -+ if (ret) { -+ ret = -ENODEV; -+ goto err_init; -+ } -+ -+ //dev_set_drvdata(config->dev, config); -+ -+ gadget_setup(config); -+ -+ return 0; -+ -+err_init: -+ dma_free_coherent(config->dev, config->gadget_sysreq.trbMemSize, -+ config->gadget_cfg.trbAddr, config->gadget_cfg.trbDmaAddr); -+err_dma_coherent: -+err_probe: -+ dev_set_drvdata(config->dev, NULL); -+ -+ return ret; -+} -+ -+int phytium_gadget_uninit(struct phytium_cusb *config) -+{ -+ if (config) -+ usb_del_gadget_udc(&config->gadget); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM -+int phytium_gadget_resume(void *priv) -+{ -+ struct GADGET_CTRL *ctrl; -+ uint32_t gen_cfg; -+ unsigned long flags = 0; -+ struct phytium_cusb *config = (struct phytium_cusb *)priv; -+ -+ if (!config) -+ return 0; -+ -+ ctrl = (struct GADGET_CTRL *)config->gadget_priv; -+ if (!ctrl) -+ return 0; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ phytium_gadget_reinit(config); -+ -+ if (config->gadget_driver) { -+ config->gadget_obj->gadget_start(config->gadget_priv); -+ if (ctrl->phy_regs) { -+ gen_cfg = phytium_read32(&ctrl->phy_regs->gen_cfg); -+ gen_cfg = gen_cfg & (~BIT(7)); -+ phytium_write32(&ctrl->phy_regs->gen_cfg, gen_cfg); -+ } -+ } -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+int phytium_gadget_suspend(void *priv) -+{ -+ return 0; -+} -+#endif -diff --git a/drivers/usb/phytium/gadget.h b/drivers/usb/phytium/gadget.h -new file mode 100644 -index 000000000..d87b55ade ---- /dev/null -+++ b/drivers/usb/phytium/gadget.h -@@ -0,0 +1,253 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+ -+#ifndef __PHYTIUM_GADGET_H_ -+#define __PHYTIUM_GADGET_H_ -+ -+#include -+#include -+#include "dma.h" -+ -+struct GADGET_CTRL; -+struct GADGET_EP; -+struct GADGET_REQ; -+ -+enum GADGET_EP_STATE { -+ GADGET_EP_FREE, -+ GADGET_EP_ALLOCATED, -+ GADGET_EP_BUSY, -+ GADGET_EP_NOT_IMPLEMENTED -+}; -+ -+enum GADGET_EP0_STAGE { -+ GADGET_EP0_STAGE_SETUP, -+ GADGET_EP0_STAGE_IN, -+ GADGET_EP0_STAGE_OUT, -+ GADGET_EP0_STAGE_STATUSIN, -+ GADGET_EP0_STAGE_STATUSOUT, -+ GADGET_EP0_STAGE_ACK -+}; -+ -+struct GADGET_EP_OPS { -+ int32_t (*epEnable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ const struct usb_endpoint_descriptor *desc); -+ -+ int32_t (*epDisable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*epSetHalt)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, uint8_t value); -+ -+ int32_t (*epSetWedge)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*epFifoStatus)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*epFifoFlush)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*reqQueue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+ -+ int32_t (*reqDequeue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+ -+ int32_t (*reqAlloc)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ **req); -+ -+ void (*reqFree)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+}; -+ -+struct GADGET_EP { -+ struct list_head epList; -+ char name[255]; -+ struct GADGET_EP_OPS *ops; -+ uint16_t maxPacket; -+ uint16_t maxStreams; -+ uint8_t mult; -+ uint8_t maxburst; -+ uint8_t address; -+ const struct usb_endpoint_descriptor *desc; -+ const struct usb_ss_ep_comp_descriptor *compDesc; -+}; -+ -+enum GADGET_DMAInterfaceWidth { -+ GADGET_DMA_32_WIDTH = 4, -+ GADGET_DMA_64_WIDTH = 8, -+}; -+ -+struct GADGET_EP_CFG { -+ uint8_t bufferingValue; -+ uint16_t startBuf; -+ uint16_t maxPacketSize; -+}; -+ -+struct GADGET_CFG { -+ uintptr_t regBase; -+ uintptr_t phy_regBase; -+ struct GADGET_EP_CFG epIN[16]; -+ struct GADGET_EP_CFG epOUT[16]; -+ enum GADGET_DMAInterfaceWidth dmaInterfaceWidth; -+ void *trbAddr; -+ uintptr_t trbDmaAddr; -+}; -+ -+struct GADGET_SYSREQ { -+ uint32_t privDataSize; -+ uint32_t trbMemSize; -+}; -+ -+struct GadgetEp { -+ struct GADGET_EP gadgetEp; -+ enum GADGET_EP_STATE state; -+ uint8_t hwEpNum; -+ uint8_t isInEp; -+ struct list_head request; -+ uint8_t iso_flag; -+ void *channel; -+ uint32_t requestsInList; -+ uint8_t wedged; -+}; -+ -+struct GADGET_DEV { -+ struct list_head epList; -+ struct GADGET_EP *ep0; -+ unsigned int speed; -+ unsigned int maxSpeed; -+ enum usb_device_state state; -+ uint8_t sgSupported; -+ uint8_t bHnpEnable; -+ uint8_t aHnpSupport; -+ char name[255]; -+}; -+ -+struct GADGET_SgList { -+ uintptr_t link; -+ uint32_t offset; -+ uint32_t length; -+ uintptr_t dmaAddress; -+}; -+ -+struct GADGET_REQ { -+ struct list_head list; -+ void *buf; -+ uint32_t length; -+ uintptr_t dma; -+ uint32_t numOfSgs; -+ uint32_t numMappedSgs; -+ uint16_t streamId; -+ uint8_t oInterrupt; -+ uint8_t zero; -+ uint8_t shortNotOk; -+ void *context; -+ uint32_t status; -+ uint32_t actual; -+ struct GADGET_SgList *sg; -+ void (*complete)(struct GADGET_EP *ep, struct GADGET_REQ *req); -+}; -+ -+ -+struct GADGET_CALLBACKS { -+ void (*disconnect)(struct GADGET_CTRL *priv); -+ -+ void (*connect)(struct GADGET_CTRL *priv); -+ -+ int32_t (*setup)(struct GADGET_CTRL *priv, -+ struct usb_ctrlrequest *ctrl); -+ -+ void *(*usbRequestMemAlloc)(struct GADGET_CTRL *priv, -+ uint32_t requiredSize); -+ -+ void (*usbRequestMemFree)(struct GADGET_CTRL *priv, void *usbRequest); -+}; -+ -+struct GADGET_OBJ { -+ int32_t (*gadget_init)(struct GADGET_CTRL *priv, struct GADGET_CFG *config, -+ struct GADGET_CALLBACKS *callbacks, struct device *pdev); -+ -+ void (*gadget_destroy)(struct GADGET_CTRL *priv); -+ -+ void (*gadget_start)(struct GADGET_CTRL *priv); -+ -+ void (*gadget_stop)(struct GADGET_CTRL *priv); -+ -+ void (*gadget_isr)(struct GADGET_CTRL *priv); -+ -+ int32_t (*gadget_epEnable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ const struct usb_endpoint_descriptor *desc); -+ -+ int32_t (*gadget_epDisable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*gadget_epSetHalt)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, uint8_t value); -+ -+ int32_t (*gadget_epSetWedge)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*gadget_epFifoStatus)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ void (*gadget_epFifoFlush)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*gadget_reqQueue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+ -+ int32_t (*gadget_reqDequeue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+ -+ int32_t (*gadget_reqAlloc)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ **req); -+ -+ void (*gadget_reqFree)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+ -+ void (*gadget_getDevInstance)(struct GADGET_CTRL *priv, struct GADGET_DEV **dev); -+ -+ int32_t (*gadget_dGetFrame)(struct GADGET_CTRL *priv, uint32_t *numOfFrame); -+ -+ int32_t (*gadget_dWakeUp)(struct GADGET_CTRL *priv); -+ -+ int32_t (*gadget_dSetSelfpowered)(struct GADGET_CTRL *priv); -+ -+ int32_t (*gadget_dClearSelfpowered)(struct GADGET_CTRL *priv); -+ -+ int32_t (*gadget_dVbusSession)(struct GADGET_CTRL *priv, uint8_t isActive); -+ -+ int32_t (*gadget_dVbusDraw)(struct GADGET_CTRL *priv, uint8_t mA); -+ -+ int32_t (*gadget_dPullUp)(struct GADGET_CTRL *priv, uint8_t isOn); -+ -+ void (*gadget_dGetConfigParams)(struct GADGET_CTRL *priv, -+ struct usb_dcd_config_params *configParams); -+}; -+ -+struct GADGET_CTRL { -+ struct device *dev; -+ struct GADGET_DEV gadgetDev; -+ struct HW_REGS *regs; -+ struct GADGET_OBJ *gadgetDrv; -+ struct GADGET_CFG gadgetCfg; -+ struct GADGET_CALLBACKS eventCallback; -+ struct GadgetEp in[16]; -+ struct GadgetEp out[16]; -+ enum GADGET_EP0_STAGE ep0State; -+ uint8_t isRemoteWakeup; -+ uint8_t isSelfPowered; -+ uint8_t deviceAddress; -+ struct DMA_OBJ *dmaDrv; -+ void *dmaController; -+ struct DMA_CFG dmaCfg; -+ struct DMA_CALLBACKS dmaCallback; -+ uint8_t releaseEp0Flag; -+ uint8_t isReady; -+ uint8_t *privBuffAddr; -+ uintptr_t privBuffDma; -+ uint8_t endpointInList; -+ uint8_t hostRequestFlag; -+ struct VHUB_REGS *phy_regs; -+}; -+ -+struct GadgetRequest { -+ struct GADGET_REQ request; -+ struct GadgetEp *ep; -+ struct GADGET_DEV *dev; -+ uint8_t zlp; -+}; -+ -+struct GADGET_OBJ *GADGET_GetInstance(void); -+ -+#endif /* __LINUX_PHYTIUM_GADGET */ -+ -diff --git a/drivers/usb/phytium/host.c b/drivers/usb/phytium/host.c -new file mode 100644 -index 000000000..00d972487 ---- /dev/null -+++ b/drivers/usb/phytium/host.c -@@ -0,0 +1,2671 @@ -+// SPDX-License-Identifier: GPL-2.0 -+ -+#include -+#include -+#include -+#include -+//#include "list.h" -+#include "core.h" -+#include "dma.h" -+#include "hw-regs.h" -+ -+#define DRV_NAME "phytium_usb" -+ -+#define HOST_GENERIC_EP_CONTROLL 0x00 -+#define HOST_GENERIC_EP_ISOC 0x01 -+#define HOST_GENERIC_EP_BULK 0x02 -+#define HOST_GENERIC_EP_INT 0x03 -+ -+#define HOST_ESTALL 1 -+#define HOST_EUNHANDLED 2 -+#define HOST_EAUTOACK 3 -+#define HOST_ESHUTDOWN 4 -+ -+#define HOST_EP_NUM 16 -+ -+static inline struct HOST_REQ *getUsbRequestEntry(struct list_head *list) -+{ -+ return (struct HOST_REQ *)((uintptr_t)list - (uintptr_t)&(((struct HOST_REQ *)0)->list)); -+} -+ -+static inline struct HOST_EP_PRIV *getUsbHEpPrivEntry(struct list_head *list) -+{ -+ struct HOST_EP_PRIV *hostEpPriv; -+ -+ if (list_empty(list)) -+ return NULL; -+ -+ hostEpPriv = (struct HOST_EP_PRIV *)((uintptr_t)list - -+ (uintptr_t)&(((struct HOST_EP_PRIV *)0)->node)); -+ -+ return hostEpPriv; -+} -+ -+static struct HOST_REQ *getNextReq(struct HOST_EP *usbEp) -+{ -+ struct list_head *queue; -+ -+ if (!usbEp) -+ return NULL; -+ -+ queue = &usbEp->reqList; -+ -+ if (list_empty(queue)) -+ return NULL; -+ -+ return getUsbRequestEntry(queue->next); -+} -+ -+static void host_SetVbus(struct HOST_CTRL *priv, uint8_t isOn) -+{ -+ uint8_t otgctrl = phytium_read8(&priv->regs->otgctrl); -+ -+ if (isOn) { -+ if (!(otgctrl & OTGCTRL_BUSREQ) || (otgctrl & OTGCTRL_ABUSDROP)) { -+ otgctrl &= ~OTGCTRL_ABUSDROP; -+ otgctrl |= OTGCTRL_BUSREQ; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ } -+ priv->otgState = HOST_OTG_STATE_A_WAIT_BCON; -+ } else { -+ if ((otgctrl & OTGCTRL_BUSREQ) || (otgctrl & OTGCTRL_ABUSDROP)) { -+ otgctrl |= OTGCTRL_ABUSDROP; -+ otgctrl &= ~OTGCTRL_BUSREQ; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ } -+ priv->otgState = HOST_OTG_STATE_A_IDLE; -+ } -+} -+ -+static inline void disconnectHostDetect(struct HOST_CTRL *priv) -+{ -+ uint8_t otgctrl, otgstate; -+ uint32_t gen_cfg; -+ -+ if (!priv) -+ return; -+ -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ if ((otgctrl & OTGCTRL_ASETBHNPEN) && priv->otgState == HOST_OTG_STATE_A_SUSPEND) -+ pr_info("Device no Response\n"); -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); -+retry: -+ otgstate = phytium_read8(&priv->regs->otgstate); -+ if ((otgstate == HOST_OTG_STATE_A_HOST || otgstate == HOST_OTG_STATE_B_HOST)) { -+ pr_info("IRQ OTG: DisconnIrq Babble\n"); -+ goto retry; -+ } -+ -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x04); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | 0 | 0x04); -+ -+ priv->portStatus = USB_PORT_STAT_POWER; -+ priv->portStatus |= USB_PORT_STAT_C_CONNECTION << 16; -+ -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); -+ -+ if (priv->otgState == HOST_OTG_STATE_A_SUSPEND) -+ host_SetVbus(priv, 1); -+ -+ priv->otgState = HOST_OTG_STATE_A_IDLE; -+ if (priv->custom_regs) { -+ phytium_write32(&priv->custom_regs->wakeup, 1); -+ } else { -+ gen_cfg = phytium_read32(&priv->vhub_regs->gen_cfg); -+ gen_cfg |= BIT(1); -+ phytium_write32(&priv->vhub_regs->gen_cfg, gen_cfg); -+ } -+} -+ -+static inline void A_IdleDetect(struct HOST_CTRL *priv, uint8_t otgstate) -+{ -+ uint8_t otgctrl; -+ -+ if (!priv) -+ return; -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); -+ -+ if (otgstate != HOST_OTG_STATE_A_IDLE) { -+ pr_info("IRQ OTG: A_IDLE Babble\n"); -+ return; -+ } -+ -+ priv->portStatus = 0; -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ otgctrl &= ~OTGCTRL_ASETBHNPEN; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ -+ host_SetVbus(priv, 1); -+ -+ priv->otgState = HOST_OTG_STATE_A_IDLE; -+} -+ -+static inline void B_IdleDetect(struct HOST_CTRL *priv, uint8_t otgstate) -+{ -+ uint8_t otgctrl, usbcs; -+ -+ if (!priv) -+ return; -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); -+ -+ if (otgstate != HOST_OTG_STATE_B_IDLE) { -+ pr_info("IRQ OTG: B_IDLE Babble\n"); -+ return; -+ } -+ -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ otgctrl &= ~OTGCTRL_ASETBHNPEN; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ -+ host_SetVbus(priv, 0); -+ -+ priv->otgState = HOST_OTG_STATE_B_IDLE; -+ -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs &= ~USBCS_DISCON; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+} -+ -+static uint32_t waitForBusyBit(struct HOST_CTRL *priv, struct HostEp *hwEp) -+{ -+ uint8_t *csReg; -+ uint8_t flag = CS_BUSY; -+ uint8_t buf = 0; -+ uint8_t val = CS_BUSY; -+ uint8_t otgstate; -+ uint8_t bufflag = 0; -+ -+ if (!priv || !hwEp) -+ return 0; -+ -+ if (hwEp->isInEp) -+ return 0; -+ -+ if (hwEp->hwEpNum == 0) { -+ csReg = &priv->regs->ep0cs; -+ flag = EP0CS_TXBUSY_MASK; -+ buf = 0; -+ } else { -+ csReg = &priv->regs->ep[hwEp->hwEpNum - 1].txcs; -+ buf = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon) & CON_BUF; -+ } -+ -+ while ((val & flag) || bufflag == 0) { -+ otgstate = phytium_read8(&priv->regs->otgstate); -+ if (otgstate != HOST_OTG_STATE_B_HOST && otgstate != HOST_OTG_STATE_A_HOST) { -+ priv->ep0State = HOST_EP0_STAGE_IDLE; -+ return HOST_ESHUTDOWN; -+ } -+ -+ val = phytium_read8(csReg); -+ if (((val & CS_NPAK) >> CS_NPAK_OFFSET) == buf || buf == 0) -+ bufflag = 1; -+ else -+ bufflag = 0; -+ } -+ -+ return 0; -+} -+ -+static inline void connectHostDetect(struct HOST_CTRL *priv, uint8_t otgState) -+{ -+ uint32_t gen_cfg; -+ -+ if (!priv) -+ return; -+ pr_debug("otgState:0x%x pirv->otgState:0x%x\n", otgState, priv->otgState); -+ if (priv->custom_regs) { -+ phytium_write32(&priv->custom_regs->wakeup, 0); -+ } else { -+ gen_cfg = phytium_read32(&priv->vhub_regs->gen_cfg); -+ gen_cfg &= ~BIT(1); -+ phytium_write32(&priv->vhub_regs->gen_cfg, gen_cfg); -+ } -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); -+ -+ if ((otgState != HOST_OTG_STATE_A_HOST) && (otgState != HOST_OTG_STATE_B_HOST)) -+ return; -+ -+ if ((priv->otgState == HOST_OTG_STATE_A_PERIPHERAL) -+ || (priv->otgState == HOST_OTG_STATE_B_PERIPHERAL)) -+ priv->otgState = otgState; -+ -+ priv->ep0State = HOST_EP0_STAGE_IDLE; -+ -+ priv->portStatus &= ~(USB_PORT_STAT_LOW_SPEED | USB_PORT_STAT_HIGH_SPEED | -+ USB_PORT_STAT_ENABLE); -+ -+ priv->portStatus |= USB_PORT_STAT_C_CONNECTION | (USB_PORT_STAT_C_CONNECTION << 16); -+ priv->dmaDrv->dma_controllerReset(priv->dmaController); -+ priv->port_resetting = 1; -+ host_SetVbus(priv, 1); -+ -+ switch (phytium_read8(&priv->regs->speedctrl)) { -+ case SPEEDCTRL_HS: -+ priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; -+ pr_debug("detect High speed device\n"); -+ break; -+ case SPEEDCTRL_FS: -+ priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); -+ pr_debug("detect Full speed device\n"); -+ break; -+ case SPEEDCTRL_LS: -+ priv->portStatus |= USB_PORT_STAT_LOW_SPEED; -+ pr_debug("detect Low speed device\n"); -+ break; -+ } -+ -+ priv->vBusErrCnt = 0; -+ priv->dmaDrv->dma_setHostMode(priv->dmaController); -+ -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); -+ -+ priv->otgState = otgState; -+} -+ -+static void hostOtgIrq(struct HOST_CTRL *priv) -+{ -+ uint8_t otgirq, otgien; -+ uint8_t otgstatus, otgstate; -+ uint8_t otgctrl; -+ -+ if (!priv) -+ return; -+ -+ otgirq = phytium_read8(&priv->regs->otgirq); -+ otgien = phytium_read8(&priv->regs->otgien); -+ otgstatus = phytium_read8(&priv->regs->otgstatus); -+ otgstate = phytium_read8(&priv->regs->otgstate); -+ otgirq &= otgien; -+ -+ if (!otgirq) -+ return; -+ -+ if (otgirq & OTGIRQ_BSE0SRPIRQ) { -+ otgirq &= ~OTGIRQ_BSE0SRPIRQ; -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_BSE0SRPIRQ); -+ -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ otgctrl &= ~OTGIRQ_BSE0SRPIRQ; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ } -+ -+ if (otgirq & OTGIRQ_SRPDETIRQ) { -+ otgirq &= ~OTGIRQ_SRPDETIRQ; -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_SRPDETIRQ); -+ -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ otgctrl &= ~OTGIRQ_SRPDETIRQ; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ } -+ -+ if (otgirq & OTGIRQ_VBUSERRIRQ) { -+ otgirq &= ~OTGIRQ_VBUSERRIRQ; -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_VBUSERRIRQ); -+ -+ if (otgstate != HOST_OTG_STATE_A_VBUS_ERR) { -+ pr_info("IRQ OTG: VBUS ERROR Babble\n"); -+ return; -+ } -+ -+ host_SetVbus(priv, 0); -+ priv->otgState = HOST_OTG_STATE_A_VBUS_ERR; -+ if (priv->portStatus & USB_PORT_STAT_CONNECTION) { -+ priv->portStatus = USB_PORT_STAT_POWER | (USB_PORT_STAT_C_CONNECTION << 16); -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); -+ return; -+ } -+ -+ if (priv->vBusErrCnt >= 3) { -+ priv->vBusErrCnt = 0; -+ pr_info("%s %d VBUS OVER CURRENT\n", __func__, __LINE__); -+ priv->portStatus |= USB_PORT_STAT_OVERCURRENT | -+ (USB_PORT_STAT_C_OVERCURRENT << 16); -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); -+ } else { -+ priv->vBusErrCnt++; -+ host_SetVbus(priv, 1); -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); -+ } -+ } -+ -+ if (otgirq & OTGIRQ_CONIRQ) { -+ if (priv->otgState == HOST_OTG_STATE_A_HOST || -+ priv->otgState == HOST_OTG_STATE_B_HOST || -+ priv->otgState == HOST_OTG_STATE_A_SUSPEND) { -+ if (otgstate == HOST_OTG_STATE_A_WAIT_VFALL || -+ otgstate == HOST_OTG_STATE_A_WAIT_BCON || -+ otgstate == HOST_OTG_STATE_A_SUSPEND) -+ disconnectHostDetect(priv); -+ } else if (priv->otgState != HOST_OTG_STATE_A_HOST && -+ priv->otgState != HOST_OTG_STATE_B_HOST && -+ priv->otgState != HOST_OTG_STATE_A_SUSPEND) -+ connectHostDetect(priv, otgstate); -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); -+ } -+ -+ if (otgirq & OTGIRQ_IDLEIRQ) { -+ if (!(otgstatus & OTGSTATUS_ID)) -+ A_IdleDetect(priv, otgstate); -+ else -+ B_IdleDetect(priv, otgstate); -+ } -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDCHANGEIRQ | -+ OTGIRQ_SRPDETIRQ); -+} -+ -+static void hostErrorIrq(struct HOST_CTRL *priv) -+{ -+ uint16_t txerrirq, txerrien; -+ uint16_t rxerrirq, rxerrien; -+ uint16_t i, mask; -+ -+ if (!priv) -+ return; -+ -+ txerrirq = phytium_read16(&priv->regs->txerrirq); -+ txerrien = phytium_read16(&priv->regs->txerrien); -+ txerrirq &= txerrien; -+ -+ rxerrirq = phytium_read16(&priv->regs->rxerrirq); -+ rxerrien = phytium_read16(&priv->regs->rxerrien); -+ rxerrirq &= rxerrirq; -+ if (!txerrirq && !rxerrirq) -+ return; -+ -+ for (i = 0; i < HOST_EP_NUM; i++) { -+ mask = 1 << i; -+ if (rxerrirq & mask) { -+ phytium_write16(&priv->regs->rxerrirq, mask); -+ rxerrien &= ~mask; -+ phytium_write16(&priv->regs->rxerrien, rxerrien); -+ priv->dmaDrv->dma_errIsr(priv->dmaController, i, 0); -+ } -+ -+ if (txerrirq & mask) { -+ phytium_write16(&priv->regs->txerrirq, mask); -+ txerrien &= ~mask; -+ phytium_write16(&priv->regs->txerrien, txerrien); -+ priv->dmaDrv->dma_errIsr(priv->dmaController, i, 1); -+ } -+ } -+} -+ -+static uint32_t decodeErrorCode(uint8_t code) -+{ -+ uint32_t status = 0; -+ -+ switch (code) { -+ case ERR_NONE: -+ status = 0; -+ break; -+ case ERR_CRC: -+ pr_info("CRC Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ case ERR_DATA_TOGGLE_MISMATCH: -+ pr_info("Toggle MisMatch Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ case ERR_STALL: -+ pr_debug("Stall Error\n"); -+ status = HOST_ESTALL; -+ break; -+ case ERR_TIMEOUT: -+ pr_debug("Timeout Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ case ERR_PID: -+ pr_info("PID Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ case ERR_TOO_LONG_PACKET: -+ pr_info("TOO_LONG_PACKET Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ case ERR_DATA_UNDERRUN: -+ pr_info("UNDERRUN Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ } -+ -+ return status; -+} -+ -+static struct HOST_EP_PRIV *getIntTransfer(struct list_head *head) -+{ -+ struct list_head *listEntry = NULL; -+ struct HOST_EP_PRIV *usbHEpPriv = NULL; -+ struct HOST_EP_PRIV *usbHEpPrivActual = NULL; -+ -+ list_for_each(listEntry, head) { -+ usbHEpPriv = getUsbHEpPrivEntry(listEntry); -+ if (!usbHEpPrivActual) -+ usbHEpPrivActual = usbHEpPriv; -+ -+ if (usbHEpPriv->frame < usbHEpPrivActual->frame) -+ usbHEpPrivActual = usbHEpPriv; -+ } -+ -+ return usbHEpPrivActual; -+} -+ -+static void givebackRequest(struct HOST_CTRL *priv, struct HOST_REQ *usbReq, uint32_t status) -+{ -+ if (!priv || !usbReq) -+ return; -+ -+ list_del(&usbReq->list); -+ -+ if (usbReq->status == EINPROGRESS) -+ usbReq->status = status; -+ -+ if (priv->hostCallbacks.givebackRequest) -+ priv->hostCallbacks.givebackRequest(priv, usbReq, status); -+} -+ -+static void hostEpProgram(struct HOST_CTRL *priv, struct HostEp *hwEp, -+ struct HOST_REQ *usbReq, uintptr_t dmaBuff, uint32_t length) -+{ -+ struct HOST_EP *usbHEp; -+ struct HOST_EP_PRIV *usbEpPriv; -+ uint32_t chMaxLen; -+ uint8_t regCon = 0; -+ uint8_t ep0cs; -+ uint16_t txerrien = 0; -+ uint16_t rxerrien = 0; -+ uint32_t result; -+ uint8_t txsoftimer, rxsoftimer; -+ u8 retval = 0; -+ -+ if (!priv || !hwEp || !usbReq) -+ return; -+ -+ usbHEp = hwEp->scheduledUsbHEp; -+ usbEpPriv = (struct HOST_EP_PRIV *)usbHEp->hcPriv; -+ -+ if (!hwEp->channel) { -+ if (usbEpPriv->type == USB_ENDPOINT_XFER_ISOC) -+ hwEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, -+ !hwEp->isInEp, hwEp->hwEpNum, 1); -+ else -+ hwEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, -+ !hwEp->isInEp, hwEp->hwEpNum, 0); -+ } -+ -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, hwEp->channel); -+ -+ pr_debug("chMaxLen:0x%x buffLength:0x%x\n", chMaxLen, usbReq->buffLength); -+ if (usbReq->buffLength > chMaxLen) -+ length = chMaxLen; -+ -+ switch (usbEpPriv->type) { -+ case USB_ENDPOINT_XFER_CONTROL: -+ regCon = CON_TYPE_CONTROL; -+ break; -+ case USB_ENDPOINT_XFER_BULK: -+ regCon = CON_TYPE_BULK; -+ break; -+ case USB_ENDPOINT_XFER_INT: -+ regCon = CON_TYPE_INT; -+ break; -+ case USB_ENDPOINT_XFER_ISOC: -+ if (usbEpPriv->isocEpConfigured) -+ goto dma_program; -+ -+ usbEpPriv->isocEpConfigured = 1; -+ regCon = CON_TYPE_ISOC; -+ switch (usbHEp->desc.wMaxPacketSize >> 11) { -+ case 0: -+ regCon |= CON_TYPE_ISOC_1_ISOD; -+ priv->dmaDrv->dma_setMaxLength(priv->dmaController, -+ hwEp->channel, usbEpPriv->maxPacketSize); -+ break; -+ case 1: -+ regCon |= CON_TYPE_ISOC_2_ISOD; -+ priv->dmaDrv->dma_setMaxLength(priv->dmaController, -+ hwEp->channel, 2 * 1024); -+ break; -+ case 2: -+ priv->dmaDrv->dma_setMaxLength(priv->dmaController, -+ hwEp->channel, 3 * 1024); -+ regCon |= CON_TYPE_ISOC_3_ISOD; -+ break; -+ } -+ break; -+ } -+ -+ if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { -+ if (!hwEp->hwEpNum) { -+ if (phytium_read8(&priv->regs->ep0cs) & 0x4) { -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | -+ 0 | 0x4); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | -+ FIFOCTRL_IO_TX | 0 | 0x4); -+ } -+ } -+ if (waitForBusyBit(priv, hwEp) > 0) { -+ usbReq->status = HOST_ESHUTDOWN; -+ givebackRequest(priv, usbReq, HOST_ESHUTDOWN); -+ pr_info("something error happen\n"); -+ return; -+ } -+ } -+ -+ if (!hwEp->isInEp) { -+ if (hwEp->hwEpNum) { -+ regCon |= hwEp->hwBuffers - 1; -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, regCon); -+ if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { -+ retval = priv->hostCallbacks.getEpToggle(priv, -+ usbReq->usbDev, usbEpPriv->epNum, 0); -+ if (retval) { -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_IO_TX); -+ -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_TOGSETQ | ENDPRST_IO_TX | ENDPRST_FIFORST); -+ } else { -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_IO_TX); -+ -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_TOGRST | ENDPRST_IO_TX | ENDPRST_FIFORST); -+ } -+ } -+ -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, regCon | CON_VAL); -+ phytium_write16(&priv->regs->txmaxpack[hwEp->hwEpNum - 1], -+ usbEpPriv->maxPacketSize); -+ -+ phytium_write8(&priv->regs->epExt[hwEp->hwEpNum - 1].txctrl, -+ usbEpPriv->epNum); -+ -+ phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); -+ -+ // if (usbEpPriv->type == USB_ENDPOINT_XFER_INT) -+ txsoftimer = phytium_read8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl); -+ txsoftimer = txsoftimer | BIT(1); -+ phytium_write8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl, txsoftimer); -+ -+ phytium_write16(&priv->regs->txsoftimer[hwEp->hwEpNum].timer, -+ usbEpPriv->frame); -+ -+ phytium_write8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl, 0x83); -+ } else { -+ phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); -+ phytium_write8(&priv->regs->ep0maxpack, usbEpPriv->maxPacketSize); -+ phytium_write8(&priv->regs->ep0ctrl, usbEpPriv->epNum); -+ -+ if (priv->ep0State == HOST_EP0_STAGE_SETUP) { -+ ep0cs = phytium_read8(&priv->regs->ep0cs); -+ ep0cs |= EP0CS_HCSET; -+ phytium_write8(&priv->regs->ep0cs, ep0cs); -+ } -+ } -+ -+ phytium_write16(&priv->regs->txerrirq, 1 << hwEp->hwEpNum); -+ txerrien = phytium_read16(&priv->regs->txerrien); -+ txerrien |= 1 << hwEp->hwEpNum; -+ phytium_write16(&priv->regs->txerrien, txerrien); -+ } else { -+ if (hwEp->hwEpNum) { -+ regCon |= hwEp->hwBuffers - 1; -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, regCon); -+ -+ if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { -+ if (priv->hostCallbacks.getEpToggle) { -+ retval = priv->hostCallbacks.getEpToggle(priv, -+ usbReq->usbDev, usbEpPriv->epNum, 1); -+ if (retval) { -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_TOGSETQ | ENDPRST_FIFORST); -+ } else { -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_TOGRST | ENDPRST_FIFORST); -+ } -+ } -+ } -+ -+ phytium_write16(&priv->regs->rxmaxpack[hwEp->hwEpNum - 1], -+ usbEpPriv->maxPacketSize); -+ -+ phytium_write8(&priv->regs->epExt[hwEp->hwEpNum - 1].rxctrl, -+ usbEpPriv->epNum); -+ -+ phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); -+ -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); -+ -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, regCon | CON_VAL); -+ rxsoftimer = phytium_read8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl); -+ rxsoftimer = rxsoftimer | BIT(1); -+ phytium_write8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl, rxsoftimer); -+ -+ phytium_write16(&priv->regs->rxsoftimer[hwEp->hwEpNum].timer, -+ usbEpPriv->frame); -+ -+ phytium_write8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl, 0x83); -+ } else { -+ phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); -+ phytium_write8(&priv->regs->ep0maxpack, usbEpPriv->maxPacketSize); -+ phytium_write8(&priv->regs->ep0ctrl, usbEpPriv->epNum); -+ -+ if (priv->ep0State == HOST_EP0_STAGE_IN -+ || priv->ep0State == HOST_EP0_STAGE_STATUSIN) -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HCSETTOGGLE); -+ } -+ -+ phytium_write16(&priv->regs->rxerrirq, 1 << hwEp->hwEpNum); -+ rxerrien = phytium_read16(&priv->regs->rxerrien); -+ rxerrien |= 1 << hwEp->hwEpNum; -+ phytium_write16(&priv->regs->rxerrien, rxerrien); -+ } -+dma_program: -+ result = priv->dmaDrv->dma_channelProgram(priv->dmaController, hwEp->channel, -+ usbEpPriv->maxPacketSize, dmaBuff, length, -+ (void *)usbReq->isoFramesDesc, usbReq->isoFramesNumber); -+ if (result) { -+ if (!hwEp->isInEp) { -+ txerrien &= ~(1 << hwEp->hwEpNum); -+ if (hwEp->hwEpNum) -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, 0x08); -+ phytium_write16(&priv->regs->txerrien, txerrien); -+ } else { -+ rxerrien &= ~(1 << hwEp->hwEpNum); -+ if (hwEp->hwEpNum) -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, 0x08); -+ phytium_write16(&priv->regs->rxerrien, rxerrien); -+ } -+ -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); -+ hwEp->channel = NULL; -+ } -+} -+ -+static void hostStartReq(struct HOST_CTRL *priv, struct HOST_REQ *req) -+{ -+ uintptr_t dmaBuff; -+ uint32_t length; -+ struct HOST_EP *hostEp; -+ struct HOST_EP_PRIV *hostEpPriv; -+ struct HOST_EP_PRIV *hostNewEpPriv; -+ struct HOST_REQ *usbReq = NULL; -+ struct HostEp *hwEp = NULL; -+ int num; -+ -+ if (!priv || !req) -+ return; -+ -+ hostEp = req->hcPriv; -+ if (hostEp) { -+ hostEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; -+ if (hostEpPriv) { -+ hostEpPriv->genericHwEp->state = HOST_EP_BUSY; -+ switch (hostEpPriv->type) { -+ case USB_ENDPOINT_XFER_CONTROL: -+ usbReq = getNextReq(hostEp); -+ -+ priv->in[HOST_GENERIC_EP_CONTROLL].scheduledUsbHEp = hostEp; -+ priv->ep0State = HOST_EP0_STAGE_SETUP; -+ hostEpPriv->currentHwEp = hostEpPriv->genericHwEp; -+ hostEpPriv->genericHwEp->scheduledUsbHEp = hostEp; -+ dmaBuff = usbReq->setupDma; -+ length = 8; -+ pr_debug("packet info: %02x %02x %04x %04x %04x\n", -+ usbReq->setup->bRequestType, -+ usbReq->setup->bRequest, -+ usbReq->setup->wValue, -+ usbReq->setup->wIndex, -+ usbReq->setup->wLength); -+ hostEpProgram(priv, hostEpPriv->genericHwEp, -+ usbReq, dmaBuff, length); -+ break; -+ case USB_ENDPOINT_XFER_BULK: -+ hwEp = hostEpPriv->genericHwEp; -+ usbReq = getNextReq(hostEp); -+ hostEpPriv->currentHwEp = hwEp; -+ hwEp->scheduledUsbHEp = hostEp; -+ dmaBuff = usbReq->buffDma + usbReq->actualLength; -+ length = usbReq->buffLength - usbReq->actualLength; -+ hostEpProgram(priv, hwEp, usbReq, dmaBuff, length); -+ break; -+ case USB_ENDPOINT_XFER_INT: -+ if (hostEpPriv->genericHwEp->scheduledUsbHEp) -+ return; -+ -+ num = req->epNum - 1; -+ if (hostEpPriv->isIn) -+ hostNewEpPriv = getIntTransfer(&priv->intInHEpQueue[num]); -+ else -+ hostNewEpPriv = getIntTransfer(&priv->intOutHEpQueue[num]); -+ -+ hostNewEpPriv->currentHwEp = hostEpPriv->genericHwEp; -+ hostEpPriv->genericHwEp->scheduledUsbHEp = hostNewEpPriv->usbHEp; -+ usbReq = getNextReq(hostEp); -+ dmaBuff = usbReq->buffDma + usbReq->actualLength; -+ length = usbReq->buffLength - usbReq->actualLength; -+ hostEpProgram(priv, hostEpPriv->genericHwEp, -+ usbReq, dmaBuff, length); -+ break; -+ case USB_ENDPOINT_XFER_ISOC: -+ hostEpPriv->currentHwEp = hostEpPriv->genericHwEp; -+ hostEpPriv->genericHwEp->scheduledUsbHEp = hostEp; -+ dmaBuff = req->buffDma + req->actualLength; -+ length = req->buffLength - req->actualLength; -+ hostEpProgram(priv, hostEpPriv->genericHwEp, req, dmaBuff, length); -+ break; -+ } -+ } -+ } -+} -+ -+ -+static void scheduleNextTransfer(struct HOST_CTRL *priv, -+ struct HOST_REQ *usbReq, struct HostEp *hwEp) -+{ -+ struct HOST_EP *usbEp; -+ struct HOST_EP_PRIV *usbHEpPriv; -+ uint8_t endprst; -+ uint32_t status; -+ struct HOST_REQ *usbNextReq = NULL; -+ -+ if (!priv || !usbReq || !hwEp) -+ return; -+ -+ usbEp = hwEp->scheduledUsbHEp; -+ usbHEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; -+ if (!usbHEpPriv) -+ return; -+ -+ status = (usbReq->status == EINPROGRESS) ? 0 : usbReq->status; -+ switch (usbHEpPriv->type) { -+ case USB_ENDPOINT_XFER_BULK: -+ case USB_ENDPOINT_XFER_INT: -+ if (hwEp->isInEp) { -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); -+ endprst = (phytium_read8(&priv->regs->endprst) & ENDPRST_TOGSETQ) ? 1 : 0; -+ if (priv->hostCallbacks.setEpToggle) -+ priv->hostCallbacks.setEpToggle(priv, usbReq->usbDev, -+ usbHEpPriv->epNum, usbHEpPriv->isIn, endprst); -+ } else { -+ if (waitForBusyBit(priv, hwEp) > 0) { -+ usbReq->status = HOST_ESHUTDOWN; -+ givebackRequest(priv, usbReq, HOST_ESHUTDOWN); -+ return; -+ } -+ -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | ENDPRST_IO_TX); -+ endprst = (phytium_read8(&priv->regs->endprst) & ENDPRST_TOGSETQ) ? 1 : 0; -+ if (priv->hostCallbacks.setEpToggle) -+ priv->hostCallbacks.setEpToggle(priv, usbReq->usbDev, -+ usbHEpPriv->epNum, usbHEpPriv->isIn, endprst); -+ } -+ break; -+ } -+ -+ if (usbHEpPriv->transferFinished) -+ givebackRequest(priv, usbReq, status); -+ -+ if (list_empty(&usbEp->reqList)) { -+ if (usbHEpPriv->type == USB_ENDPOINT_XFER_CONTROL) -+ hwEp->state = HOST_EP_ALLOCATED; -+ else { -+ if (usbHEpPriv->genericHwEp == hwEp) -+ hwEp->state = HOST_EP_ALLOCATED; -+ else -+ hwEp->state = HOST_EP_FREE; -+ } -+ -+ usbHEpPriv->epIsReady = 0; -+ usbHEpPriv->currentHwEp = NULL; -+ hwEp->scheduledUsbHEp = NULL; -+ -+ if (hwEp->channel) { -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); -+ hwEp->channel = NULL; -+ } -+ -+ if (usb_endpoint_xfer_int(&usbEp->desc)) -+ list_del(&usbHEpPriv->node); -+ usbHEpPriv = NULL; -+ } else { -+ if (usbHEpPriv->type == USB_ENDPOINT_XFER_INT) { -+ usbHEpPriv->currentHwEp = NULL; -+ hwEp->scheduledUsbHEp = NULL; -+ } -+ -+ if (usbHEpPriv->type == USB_ENDPOINT_XFER_ISOC) -+ return; -+ } -+ -+ if (usbHEpPriv) { -+ usbNextReq = getNextReq(usbHEpPriv->usbHEp); -+ hostStartReq(priv, usbNextReq); -+ } -+} -+ -+static int32_t hostEp0Irq(struct HOST_CTRL *priv, uint8_t isIn) -+{ -+ struct HostEp *hwEp; -+ struct HOST_EP *hostEp; -+ struct HOST_REQ *usbReq = NULL; -+ struct HOST_EP_PRIV *usbHEpPriv; -+ uint32_t status, length; -+ uint8_t usbError; -+ uint8_t nextStage = 0; -+ int ret = 0; -+ -+ if (!priv) -+ return ret; -+ -+ hwEp = isIn ? &priv->in[HOST_GENERIC_EP_CONTROLL] : &priv->out[HOST_GENERIC_EP_CONTROLL]; -+ hostEp = hwEp->scheduledUsbHEp; -+ usbHEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; -+ -+ usbReq = getNextReq(hostEp); -+ if (!usbReq) -+ return 0; -+ -+ usbError = isIn ? phytium_read8(&priv->regs->rx0err) : phytium_read8(&priv->regs->tx0err); -+ usbError = (usbError & ERR_TYPE) >> 2; -+ status = decodeErrorCode(usbError); -+ if (status) { -+ usbReq->status = status; -+ -+ if (status == HOST_ESTALL) { -+ ret = 1; -+ priv->dmaDrv->dma_controllerReset(priv->dmaController); -+ } -+ -+ phytium_write16(&priv->regs->rxerrirq, 1 << hwEp->hwEpNum); -+ phytium_write16(&priv->regs->txerrirq, 1 << hwEp->hwEpNum); -+ -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x4); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | -+ FIFOCTRL_IO_TX | 0 | 0x4); -+ } -+ -+ length = priv->dmaDrv->dma_getActualLength(priv->dmaController, hwEp->channel); -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); -+ hwEp->channel = NULL; -+ -+ if (usbReq->status == EINPROGRESS && priv->ep0State < HOST_EP0_STAGE_STATUSIN) { -+ nextStage = 0; -+ switch (priv->ep0State) { -+ case HOST_EP0_STAGE_IN: -+ pr_debug("Ep0 Data IN\n"); -+ usbHEpPriv->currentHwEp = &priv->out[HOST_GENERIC_EP_CONTROLL]; -+ usbReq->actualLength = length; -+ priv->ep0State = HOST_EP0_STAGE_STATUSOUT; -+ break; -+ case HOST_EP0_STAGE_OUT: -+ pr_debug("Ep0 Data OUT\n"); -+ usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROLL]; -+ usbReq->actualLength = length; -+ priv->ep0State = HOST_EP0_STAGE_STATUSIN; -+ break; -+ case HOST_EP0_STAGE_SETUP: -+ pr_debug("Ep0 Stage Setup\n"); -+ if (!usbReq->setup->wLength) { -+ pr_debug("EP0_STAGE_STATUSIN\n"); -+ priv->ep0State = HOST_EP0_STAGE_STATUSIN; -+ usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROLL]; -+ break; -+ } else if (usbReq->setup->bRequestType & USB_DIR_IN) { -+ pr_debug("EP0_STAGE_STAGE_IN\n"); -+ priv->ep0State = HOST_EP0_STAGE_IN; -+ usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROLL]; -+ nextStage = 1; -+ break; -+ } -+ priv->ep0State = HOST_EP0_STAGE_OUT; -+ nextStage = 1; -+ break; -+ case HOST_EP0_STAGE_STATUSIN: -+ case HOST_EP0_STAGE_STATUSOUT: -+ case HOST_EP0_STAGE_ACK: -+ case HOST_EP0_STAGE_IDLE: -+ default: -+ pr_debug("EP0 STAGE is %d\n", priv->ep0State); -+ break; -+ } -+ -+ if (nextStage) { -+ length = usbReq->buffLength; -+ hostEpProgram(priv, usbHEpPriv->currentHwEp, usbReq, -+ usbReq->buffDma, length); -+ } else -+ hostEpProgram(priv, usbHEpPriv->currentHwEp, usbReq, usbReq->setupDma, 0); -+ } else -+ priv->ep0State = HOST_EP0_STAGE_IDLE; -+ -+ if (priv->ep0State == HOST_EP0_STAGE_IDLE || usbReq->status != EINPROGRESS) { -+ usbHEpPriv->transferFinished = 1; -+ scheduleNextTransfer(priv, usbReq, hwEp); -+ } -+ -+ return 0; -+} -+ -+static void updateTimeIntTransfer(struct list_head *head, struct HOST_EP_PRIV *lastFinished) -+{ -+ struct list_head *listEntry = NULL; -+ struct HOST_EP_PRIV *usbHEpPriv = NULL; -+ uint16_t time = lastFinished->frame; -+ -+ list_for_each(listEntry, head) { -+ usbHEpPriv = getUsbHEpPrivEntry(listEntry); -+ if (usbHEpPriv == lastFinished) { -+ lastFinished->frame = lastFinished->interval; -+ continue; -+ } -+ -+ if (usbHEpPriv->frame < time) -+ usbHEpPriv->frame = 0; -+ else -+ lastFinished->interval = usbHEpPriv->frame; -+ } -+} -+ -+static int32_t hostEpXIrq(struct HOST_CTRL *priv, uint8_t hwEpNum, uint8_t isIn, bool resubmit) -+{ -+ struct HostEp *hwEp; -+ struct HOST_EP *hostEp; -+ struct HOST_EP_PRIV *usbHEpPriv; -+ struct HOST_REQ *usbReq; -+ -+ uint8_t usbError, rxcon, txcon; -+ uint32_t status, length, chMaxLen; -+ -+ if (!priv) -+ return -EINVAL; -+ -+ hwEp = isIn ? &priv->in[hwEpNum] : &priv->out[hwEpNum]; -+ hostEp = hwEp->scheduledUsbHEp; -+ if (!hostEp) -+ return -EINVAL; -+ -+ usbHEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; -+ -+ usbReq = getNextReq(hostEp); -+ if (!usbReq) -+ return 0; -+ -+ if (isIn) -+ usbError = phytium_read8(&priv->regs->epExt[hwEpNum - 1].rxerr); -+ else -+ usbError = phytium_read8(&priv->regs->epExt[hwEpNum - 1].txerr); -+ -+ usbError = (usbError & ERR_TYPE) >> 2; -+ status = decodeErrorCode(usbError); -+ if (status) { -+ pr_debug("%s %d Aborting\n", __func__, __LINE__); -+ if (isIn) -+ phytium_write16(&priv->regs->rxerrirq, 1 << hwEpNum); -+ else -+ phytium_write16(&priv->regs->txerrirq, 1 << hwEpNum); -+ priv->dmaDrv->dma_channelAbort(priv->dmaController, hwEp->channel); -+ } -+ -+ length = priv->dmaDrv->dma_getActualLength(priv->dmaController, hwEp->channel); -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, hwEp->channel); -+ -+ if (status != 0) -+ usbReq->status = status; -+ -+ usbReq->actualLength += length; -+ -+ if (!resubmit) -+ usbHEpPriv->transferFinished = 1; -+ -+ if (length == chMaxLen) { -+ if ((usbReq->buffLength - usbReq->actualLength) == 0) -+ usbHEpPriv->transferFinished = 1; -+ else -+ usbHEpPriv->transferFinished = 0; -+ } -+ -+ if (usbHEpPriv->type != USB_ENDPOINT_XFER_ISOC) { -+ if (!hwEp->isInEp) { -+ txcon = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon); -+ txcon &= ~CON_VAL; -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, txcon); -+ } else { -+ rxcon = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon); -+ rxcon &= ~CON_VAL; -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, rxcon); -+ } -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); -+ hwEp->channel = NULL; -+ } -+ -+ if (usbHEpPriv->type == USB_ENDPOINT_XFER_INT) { -+ if (usbHEpPriv->isIn) -+ updateTimeIntTransfer(&priv->intInHEpQueue[hwEp->hwEpNum - 1], usbHEpPriv); -+ else -+ updateTimeIntTransfer(&priv->intOutHEpQueue[hwEp->hwEpNum - 1], usbHEpPriv); -+ } -+ -+ scheduleNextTransfer(priv, usbReq, hwEp); -+ -+ return 0; -+} -+ -+ -+static void host_CallbackTransfer(void *priv, uint8_t epNum, uint8_t isDirTx, bool resubmit) -+{ -+ struct HOST_CTRL *host_priv = (struct HOST_CTRL *)priv; -+ int i; -+ int ret = 0; -+ -+ if (!epNum) { -+ ret = hostEp0Irq(host_priv, !isDirTx); -+ if (resubmit | ret) { -+ for (i = 1; i < HOST_EP_NUM; i++) { -+ hostEpXIrq(host_priv, i, !isDirTx, true); -+ hostEpXIrq(host_priv, i, isDirTx, true); -+ } -+ } -+ } else -+ hostEpXIrq(host_priv, epNum, !isDirTx, false); -+} -+ -+static int hc_reset(struct usb_hcd *hcd) -+{ -+ hcd->speed = HCD_USB2; -+ hcd->self.root_hub->speed = USB_SPEED_HIGH; -+ -+ return 0; -+} -+ -+static int hc_start(struct usb_hcd *hcd) -+{ -+ hcd->state = HC_STATE_RUNNING; -+ return 0; -+} -+ -+static void hc_stop(struct usb_hcd *hcd) -+{ -+ struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; -+ -+ if (config) -+ config->host_obj->host_stop(config->host_priv); -+ -+ if (config->host_cfg.trbAddr) { -+ dma_free_coherent(config->dev, config->host_sysreq.trbMemSize, -+ config->host_cfg.trbAddr, config->host_cfg.trbDmaAddr); -+ config->host_cfg.trbAddr = NULL; -+ } -+ -+ if (config->host_priv) { -+ devm_kfree(config->dev, config->host_priv); -+ config->host_priv = NULL; -+ } -+ -+ hcd->state = HC_STATE_HALT; -+} -+ -+static void hc_shutdown(struct usb_hcd *hcd) -+{ -+} -+ -+static void host_endpoint_update(struct phytium_cusb *config, -+ struct HOST_USB_DEVICE *udev, struct usb_host_endpoint *ep) -+{ -+ int epnum; -+ struct HOST_EP *hostEp; -+ -+ if (!config || !udev || !ep) -+ return; -+ -+ epnum = usb_endpoint_num(&ep->desc); -+ if (epnum > MAX_INSTANCE_EP_NUM) -+ epnum = MAX_INSTANCE_EP_NUM; -+ -+ if (usb_endpoint_dir_out(&ep->desc)) { -+ if (udev->out_ep[epnum] == NULL) { -+ hostEp = kzalloc(sizeof(struct HOST_EP) + -+ config->host_obj->host_epGetPrivateDataSize(config->host_priv), -+ GFP_ATOMIC); -+ udev->out_ep[epnum] = hostEp; -+ } else -+ hostEp = udev->out_ep[epnum]; -+ } else { -+ if (udev->in_ep[epnum] == NULL) { -+ hostEp = kzalloc(sizeof(struct HOST_EP) + -+ config->host_obj->host_epGetPrivateDataSize(config->host_priv), -+ GFP_ATOMIC); -+ udev->in_ep[epnum] = hostEp; -+ } else -+ hostEp = udev->in_ep[epnum]; -+ } -+ -+ hostEp->desc = *(struct usb_endpoint_descriptor *)(&ep->desc); -+ hostEp->userExt = (void *)ep; -+ INIT_LIST_HEAD(&hostEp->reqList); -+ hostEp->hcPriv = &((uint8_t *)hostEp)[sizeof(struct HOST_EP)]; -+} -+ -+static int hc_urb_enqueue(struct usb_hcd *hcd, struct urb *urb, gfp_t mem_flags) -+{ -+ unsigned long flags; -+ u32 isoFrameSize; -+ int retval; -+ int index; -+ struct HOST_REQ *req; -+ struct HOST_CTRL *priv; -+ struct HOST_USB_DEVICE *usbDev; -+ struct usb_host_endpoint *host_ep; -+ struct usb_endpoint_descriptor *host_ep_desc; -+ struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; -+ -+ if (!config) -+ return -ENODEV; -+ -+ priv = config->host_priv; -+ if (!priv) -+ return -ENODEV; -+ -+ usbDev = priv->host_devices_table[urb->dev->slot_id]; -+ if (!usbDev) -+ return -ENODEV; -+ -+ host_ep = urb->ep; -+ host_ep_desc = &host_ep->desc; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ retval = usb_hcd_link_urb_to_ep(hcd, urb); -+ if (retval < 0) { -+ spin_unlock_irqrestore(&config->lock, flags); -+ return retval; -+ } -+ spin_unlock_irqrestore(&config->lock, flags); -+ isoFrameSize = urb->number_of_packets * sizeof(struct HOST_ISOFRAMESDESC); -+ req = kzalloc((sizeof(struct HOST_REQ) + -+ isoFrameSize), mem_flags); -+ if (!req) { -+ spin_lock_irqsave(&config->lock, flags); -+ usb_hcd_unlink_urb_from_ep(hcd, urb); -+ spin_unlock_irqrestore(&config->lock, flags); -+ return -ENOMEM; -+ } -+ -+ req->isoFramesDesc = NULL; -+ req->isoFramesNumber = urb->number_of_packets; -+ req->epNum = usb_endpoint_num(host_ep_desc); -+ if (req->epNum > MAX_INSTANCE_EP_NUM) -+ req->epNum = MAX_INSTANCE_EP_NUM; -+ -+ if (usb_endpoint_dir_in(host_ep_desc)) { -+ if (!usbDev->in_ep[req->epNum]) -+ host_endpoint_update(config, usbDev, host_ep); -+ } else { -+ if (!usbDev->out_ep[req->epNum]) -+ host_endpoint_update(config, usbDev, host_ep); -+ } -+ -+ if (usb_endpoint_xfer_isoc(host_ep_desc)) { -+ req->isoFramesDesc = (struct HOST_ISOFRAMESDESC *)(&req[1]); -+ for (index = 0; index < urb->number_of_packets; index++) { -+ req->isoFramesDesc[index].length = urb->iso_frame_desc[index].length; -+ req->isoFramesDesc[index].offset = urb->iso_frame_desc[index].offset; -+ } -+ } -+ -+ spin_lock_irqsave(&config->lock, flags); -+ INIT_LIST_HEAD(&req->list); -+ req->userExt = (void *)urb; -+ req->actualLength = urb->actual_length; -+ req->bufAddress = urb->transfer_buffer; -+ req->buffDma = urb->transfer_dma; -+ req->buffLength = urb->transfer_buffer_length; -+ req->epIsIn = usb_endpoint_dir_in(host_ep_desc); -+ req->eptype = usb_endpoint_type(host_ep_desc); -+ req->faddress = usb_pipedevice(urb->pipe); -+ req->interval = urb->interval; -+ req->reqUnlinked = 0; -+ req->setup = (struct usb_ctrlrequest *)urb->setup_packet; -+ req->setupDma = urb->setup_dma; -+ req->status = EINPROGRESS; -+ req->usbDev = &usbDev->udev; -+ req->usbEp = req->epIsIn ? usbDev->in_ep[req->epNum] : usbDev->out_ep[req->epNum]; -+ if (!req->epNum) -+ usbDev->ep0_hep.desc.wMaxPacketSize = urb->dev->ep0.desc.wMaxPacketSize; -+ -+ req->hcPriv = (void *)req->usbEp; -+ urb->hcpriv = req; -+ host_ep->hcpriv = (void *)usbDev; -+ retval = config->host_obj->host_reqQueue(config->host_priv, req); -+ if (retval) { -+ usb_hcd_unlink_urb_from_ep(hcd, urb); -+ urb->hcpriv = NULL; -+ spin_unlock_irqrestore(&config->lock, flags); -+ kfree(req); -+ return -retval; -+ } -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static int hc_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status) -+{ -+ unsigned long flags; -+ struct HOST_CTRL *priv; -+ int ret = 0; -+ struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; -+ -+ if (!config) -+ return -ENODEV; -+ -+ priv = config->host_priv; -+ if (!priv->host_devices_table[urb->dev->slot_id]) -+ return -ENODEV; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ if (usb_hcd_check_unlink_urb(hcd, urb, status)) -+ goto done; -+ -+ if (!urb->hcpriv) -+ goto err_giveback; -+ -+ ret = config->host_obj->host_reqDequeue(priv, urb->hcpriv, status); -+ kfree(urb->hcpriv); -+ urb->hcpriv = NULL; -+done: -+ spin_unlock_irqrestore(&config->lock, flags); -+ return ret; -+ -+err_giveback: -+ kfree(urb->hcpriv); -+ usb_hcd_unlink_urb_from_ep(hcd, urb); -+ spin_unlock_irqrestore(&config->lock, flags); -+ usb_hcd_giveback_urb(hcd, urb, -ESHUTDOWN); -+ return ret; -+} -+ -+static void hc_endpoint_disable(struct usb_hcd *hcd, struct usb_host_endpoint *ld_ep) -+{ -+ struct HOST_USB_DEVICE *usbDev; -+ int ep_num = usb_endpoint_num(&ld_ep->desc); -+ -+ if (ep_num > MAX_INSTANCE_EP_NUM) -+ ep_num = MAX_INSTANCE_EP_NUM; -+ -+ usbDev = (struct HOST_USB_DEVICE *)ld_ep->hcpriv; -+ if (!usbDev) -+ return; -+ -+ if (ld_ep->desc.bEndpointAddress) { -+ if (usb_endpoint_dir_in(&ld_ep->desc)) { -+ if (!usbDev->in_ep[ep_num]) { -+ usbDev->in_ep[ep_num]->userExt = NULL; -+ INIT_LIST_HEAD(&usbDev->in_ep[ep_num]->reqList); -+ kfree(usbDev->in_ep[ep_num]); -+ usbDev->in_ep[ep_num] = NULL; -+ } -+ } else { -+ if (!usbDev->out_ep[ep_num]) { -+ usbDev->out_ep[ep_num]->userExt = NULL; -+ INIT_LIST_HEAD(&usbDev->out_ep[ep_num]->reqList); -+ kfree(usbDev->out_ep[ep_num]); -+ usbDev->out_ep[ep_num] = NULL; -+ } -+ } -+ } -+} -+ -+static int hc_get_frame(struct usb_hcd *hcd) -+{ -+ return 0; -+} -+ -+static int hc_alloc_dev(struct usb_hcd *hcd, struct usb_device *udev) -+{ -+ struct HOST_USB_DEVICE *usbDev; -+ struct phytium_cusb *config; -+ struct HOST_CTRL *priv; -+ unsigned long flags = 0; -+ int index; -+ int slot = -EINVAL; -+ -+ if (!hcd || !udev) -+ return -EINVAL; -+ -+ config = *(struct phytium_cusb **)hcd->hcd_priv; -+ if (!config) -+ return 0; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ priv = config->host_priv; -+ for (index = 0; index < MAX_SUPPORTED_DEVICES; index++) { -+ if (priv->host_devices_table[index] == NULL) { -+ slot = index; -+ break; -+ } -+ } -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ if (slot < 0) -+ return -ENOMEM; -+ -+ usbDev = kzalloc((sizeof(struct HOST_USB_DEVICE) + -+ config->host_obj->host_epGetPrivateDataSize(priv)), GFP_KERNEL); -+ if (!usbDev) -+ return -ENOMEM; -+ -+ usbDev->ep0_hep.hcPriv = &((uint8_t *)usbDev)[sizeof(struct HOST_USB_DEVICE)]; -+ usbDev->udev.userExt = (void *)usbDev; -+ usbDev->ld_udev = udev; -+ usbDev->ld_udev->slot_id = slot; -+ usbDev->ep0_hep.desc.bLength = 7; -+ usbDev->ep0_hep.desc.bDescriptorType = USB_DT_ENDPOINT; -+ usbDev->in_ep[0] = &usbDev->ep0_hep; -+ usbDev->out_ep[0] = &usbDev->ep0_hep; -+ INIT_LIST_HEAD(&usbDev->ep0_hep.reqList); -+ -+ priv->host_devices_table[slot] = usbDev; -+ -+ return 1; -+} -+ -+static void hc_free_dev(struct usb_hcd *hcd, struct usb_device *udev) -+{ -+ struct HOST_CTRL *priv; -+ struct HOST_USB_DEVICE *usbDev; -+ struct phytium_cusb *config; -+ int i; -+ -+ if (!hcd || !udev) -+ return; -+ -+ config = *(struct phytium_cusb **)(hcd->hcd_priv); -+ if (!config) -+ return; -+ -+ priv = (struct HOST_CTRL *)config->host_priv; -+ usbDev = priv->host_devices_table[udev->slot_id]; -+ if (!usbDev) -+ return; -+ -+ usbDev->in_ep[0] = NULL; -+ usbDev->out_ep[0] = NULL; -+ for (i = 1; i < HOST_EP_NUM; i++) { -+ if (usbDev->in_ep[i]) -+ hc_endpoint_disable(hcd, -+ (struct usb_host_endpoint *)usbDev->in_ep[i]->userExt); -+ if (usbDev->out_ep[i]) -+ hc_endpoint_disable(hcd, -+ (struct usb_host_endpoint *)usbDev->out_ep[i]->userExt); -+ } -+ -+ priv->host_devices_table[udev->slot_id] = NULL; -+ usbDev->ld_udev->slot_id = 0; -+ usbDev->udev.userExt = (void *)NULL; -+ kfree(usbDev); -+} -+ -+static int hc_reset_device(struct usb_hcd *hcd, struct usb_device *udev) -+{ -+ struct HOST_CTRL *priv; -+ struct HOST_USB_DEVICE *usb_device; -+ struct phytium_cusb *config; -+ -+ if (!hcd || !udev) -+ return -EINVAL; -+ -+ config = *(struct phytium_cusb **)hcd->hcd_priv; -+ priv = (struct HOST_CTRL *)config->host_priv; -+ usb_device = priv->host_devices_table[udev->slot_id]; -+ if (!usb_device) -+ return -ENODEV; -+ -+ usb_device->udev.speed = usb_device->ld_udev->speed; -+ usb_device->udev.devnum = usb_device->ld_udev->devnum; -+ -+ if (USB_SPEED_HIGH == usb_device->udev.speed || USB_SPEED_FULL == usb_device->udev.speed) -+ usb_device->ep0_hep.desc.wMaxPacketSize = 64; -+ else -+ usb_device->ep0_hep.desc.wMaxPacketSize = 8; -+ -+ pr_debug("speed:%d ep0 wMaxPacketSize:%d\n", usb_device->udev.speed, -+ usb_device->ep0_hep.desc.wMaxPacketSize); -+ -+ return 0; -+} -+ -+static int hc_update_device(struct usb_hcd *hcd, struct usb_device *udev) -+{ -+ struct HOST_CTRL *priv; -+ struct HOST_USB_DEVICE *usb_device; -+ struct phytium_cusb *config; -+ -+ if (!hcd || !udev) -+ return -EINVAL; -+ -+ config = *(struct phytium_cusb **)(hcd->hcd_priv); -+ priv = (struct HOST_CTRL *)config->host_priv; -+ -+ usb_device = priv->host_devices_table[udev->slot_id]; -+ if (!usb_device) -+ return -ENODEV; -+ -+ usb_device->udev.devnum = udev->devnum; -+ -+ return 0; -+} -+ -+static int hc_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev, -+ struct usb_host_endpoint *ep) -+{ -+ return 0; -+} -+ -+static int hc_drop_endpoint(struct usb_hcd *hcd, struct usb_device *udev, -+ struct usb_host_endpoint *ep) -+{ -+ return 0; -+} -+ -+static int hc_hub_status_data(struct usb_hcd *hcd, char *buf) -+{ -+ struct HOST_CTRL *priv; -+ struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; -+ -+ if (!config) -+ return 0; -+ -+ priv = (struct HOST_CTRL *)config->host_priv; -+ if (!priv) -+ return 0; -+ -+ if (priv->portStatus & 0xffff0000) { -+ *buf = 0x02; -+ return 1; -+ } -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM -+static int hc_bus_suspend(struct usb_hcd *hcd) -+{ -+ unsigned long flags; -+ struct phytium_cusb *config = *(struct phytium_cusb **)(hcd->hcd_priv); -+ -+ if (!config) -+ return 0; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ hcd->state = HC_STATE_SUSPENDED; -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static int hc_bus_resume(struct usb_hcd *hcd) -+{ -+ unsigned long flags; -+ struct phytium_cusb *config = *(struct phytium_cusb **)(hcd->hcd_priv); -+ -+ if (!config) -+ return 0; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ hcd->state = HC_STATE_RESUMING; -+ spin_unlock_irqrestore(&config->lock, flags); -+ return 0; -+} -+#endif -+ -+static void host_giveback_request(struct HOST_CTRL *priv, -+ struct HOST_REQ *req, uint32_t status) -+{ -+ struct urb *urb_req; -+ int urb_status = 0; -+ int i = 0; -+ struct phytium_cusb *config; -+ -+ if (!priv || !req) -+ return; -+ -+ urb_req = req->userExt; -+ urb_req->actual_length = req->actualLength; -+ -+ switch (status) { -+ case HOST_ESTALL: -+ urb_status = -EPIPE; -+ break; -+ case HOST_EUNHANDLED: -+ urb_status = -EPROTO; -+ break; -+ case HOST_ESHUTDOWN: -+ urb_status = -ESHUTDOWN; -+ break; -+ default: -+ urb_status = status; -+ } -+ pr_debug("complete %p %pS (%d) dev%d ep%d%s %d/%d\n", -+ urb_req, urb_req->complete, urb_status, -+ usb_pipedevice(urb_req->pipe), -+ usb_pipeendpoint(urb_req->pipe), -+ usb_pipein(urb_req->pipe) ? "in" : "out", -+ urb_req->actual_length, -+ urb_req->transfer_buffer_length); -+ -+ if (usb_endpoint_xfer_isoc(&urb_req->ep->desc)) { -+ for (i = 0; i < urb_req->number_of_packets; i++) { -+ urb_req->iso_frame_desc[i].status = 0; -+ urb_req->iso_frame_desc[i].actual_length = req->isoFramesDesc[i].length; -+ } -+ } -+ -+ config = dev_get_drvdata(priv->dev); -+ usb_hcd_unlink_urb_from_ep(config->hcd, urb_req); -+ spin_unlock(&config->lock); -+ usb_hcd_giveback_urb(config->hcd, urb_req, urb_status); -+ kfree(req); -+ spin_lock(&config->lock); -+} -+ -+static void host_rh_port_status_change(struct HOST_CTRL *priv) -+{ -+ uint32_t statusHub; -+ char *status; -+ uint32_t retval; -+ struct usb_ctrlrequest setup; -+ struct phytium_cusb *config; -+ -+ if (!priv) -+ return; -+ -+ config = dev_get_drvdata(priv->dev); -+ if (!config) -+ return; -+ -+ status = (char *)&statusHub; -+ hc_hub_status_data(config->hcd, status); -+ -+ if (status) { -+ setup.bRequestType = USB_TYPE_CLASS | USB_RECIP_OTHER | USB_DIR_IN;//to host -+ setup.bRequest = USB_REQ_GET_STATUS; -+ setup.wValue = 0; -+ setup.wIndex = 1; -+ setup.wLength = 4; -+ retval = config->host_obj->host_vhubControl(priv, &setup, (uint8_t *)&statusHub); -+ if (retval) -+ return; -+ -+ if (status[1] & USB_PORT_STAT_C_CONNECTION) { -+ if (status[0] & USB_PORT_STAT_CONNECTION) { -+ if (config->hcd->status_urb) -+ usb_hcd_poll_rh_status(config->hcd); -+ else -+ usb_hcd_resume_root_hub(config->hcd); -+ } else { -+ usb_hcd_resume_root_hub(config->hcd); -+ usb_hcd_poll_rh_status(config->hcd); -+ } -+ } -+ } else -+ usb_hcd_resume_root_hub(config->hcd); -+} -+ -+static void host_set_ep_toggle(struct HOST_CTRL *priv, -+ struct HOST_DEVICE *udev, u8 ep_num, u8 is_in, u8 toggle) -+{ -+ struct HOST_USB_DEVICE *device; -+ -+ if (!priv || !udev) -+ return; -+ -+ device = (struct HOST_USB_DEVICE *)udev->userExt; -+ -+ usb_settoggle(device->ld_udev, ep_num, !is_in, toggle); -+} -+ -+static u8 host_get_ep_toggle(struct HOST_CTRL *priv, -+ struct HOST_DEVICE *udev, u8 ep_num, u8 is_in) -+{ -+ struct HOST_USB_DEVICE *device; -+ -+ if (!priv || !udev) -+ return 0; -+ -+ device = (struct HOST_USB_DEVICE *)udev->userExt; -+ -+ return usb_gettoggle(device->ld_udev, ep_num, !is_in); -+} -+ -+static uint32_t initEndpoints(struct HOST_CTRL *priv) -+{ -+ int epNum; -+ -+ if (!priv) -+ return 0; -+ -+ priv->hwEpInCount = 0; -+ priv->hwEpOutCount = 0; -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | 0); -+ -+ for (epNum = 0; epNum < HOST_EP_NUM; epNum++) { -+ priv->in[epNum].isInEp = 1; -+ priv->in[epNum].hwEpNum = epNum; -+ if (priv->hostCfg.epIN[epNum].bufferingValue) { -+ priv->in[epNum].hwMaxPacketSize = priv->hostCfg.epIN[epNum].maxPacketSize; -+ priv->in[epNum].hwBuffers = priv->hostCfg.epIN[epNum].bufferingValue; -+ priv->in[epNum].state = HOST_EP_FREE; -+ priv->in[epNum].channel = NULL; -+ priv->hwEpInCount++; -+ -+ if (epNum) { -+ phytium_write16(&priv->regs->rxstaddr[epNum - 1].addr, -+ priv->hostCfg.epIN[epNum].startBuf); -+ phytium_write8(&priv->regs->ep[epNum - 1].rxcon, 0x08); -+ phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | epNum); -+ phytium_write8(&priv->regs->irqmode[epNum - 1].inirqmode, 0x80); -+ } -+ } else -+ priv->in[epNum].state = HOST_EP_NOT_IMPLEMENTED; -+ -+ priv->out[epNum].isInEp = 0; -+ priv->out[epNum].hwEpNum = epNum; -+ if (priv->hostCfg.epOUT[epNum].bufferingValue) { -+ priv->out[epNum].hwMaxPacketSize = priv->hostCfg.epOUT[epNum].maxPacketSize; -+ priv->out[epNum].hwBuffers = priv->hostCfg.epOUT[epNum].bufferingValue; -+ priv->out[epNum].state = HOST_EP_FREE; -+ priv->out[epNum].channel = NULL; -+ priv->hwEpInCount++; -+ -+ if (epNum) { -+ phytium_write16(&priv->regs->txstaddr[epNum - 1].addr, -+ priv->hostCfg.epOUT[epNum].startBuf); -+ phytium_write8(&priv->regs->ep[epNum - 1].txcon, 0x08); -+ phytium_write8(&priv->regs->fifoctrl, -+ FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | epNum); -+ phytium_write8(&priv->regs->irqmode[epNum - 1].outirqmode, 0x80); -+ } -+ } else -+ priv->out[epNum].state = HOST_EP_NOT_IMPLEMENTED; -+ } -+ -+ return 0; -+} -+ -+int32_t hostInit(struct HOST_CTRL *priv, struct HOST_CFG *config, -+ struct HOST_CALLBACKS *callbacks, struct device *pdev, bool isVhubHost) -+{ -+ int index; -+ -+ if (!config || !priv || !callbacks || !pdev) -+ return -EINVAL; -+ -+ priv->dev = pdev; -+ priv->hostCallbacks = *callbacks; -+ priv->hostCfg = *config; -+ priv->regs = (struct HW_REGS *)config->regBase; -+ priv->hostDrv = HOST_GetInstance(); -+ -+ priv->dmaDrv = DMA_GetInstance(); -+ priv->dmaCfg.dmaModeRx = 0xFFFF; -+ priv->dmaCfg.dmaModeTx = 0xFFFF; -+ priv->dmaCfg.regBase = config->regBase + 0x400; -+ priv->dmaCfg.trbAddr = config->trbAddr; -+ priv->dmaCfg.trbDmaAddr = config->trbDmaAddr; -+ priv->dmaCallback.complete = host_CallbackTransfer; -+ -+ priv->dmaController = (void *)(priv + 1); -+ priv->dmaDrv->dma_init(priv->dmaController, &priv->dmaCfg, &priv->dmaCallback); -+ priv->dmaDrv->dma_setParentPriv(priv->dmaController, priv); -+ -+ INIT_LIST_HEAD(&priv->ctrlHEpQueue); -+ -+ for (index = 0; index < MAX_INSTANCE_EP_NUM; index++) { -+ INIT_LIST_HEAD(&priv->isoInHEpQueue[index]); -+ INIT_LIST_HEAD(&priv->isoOutHEpQueue[index]); -+ INIT_LIST_HEAD(&priv->intInHEpQueue[index]); -+ INIT_LIST_HEAD(&priv->intOutHEpQueue[index]); -+ INIT_LIST_HEAD(&priv->bulkInHEpQueue[index]); -+ INIT_LIST_HEAD(&priv->bulkOutHEpQueue[index]); -+ } -+ -+ phytium_write8(&priv->regs->cpuctrl, BIT(1)); -+ phytium_write8(&priv->regs->otgctrl, OTGCTRL_ABUSDROP); -+ phytium_write8(&priv->regs->ep0maxpack, 0x40); -+ -+ //disable interrupts -+ phytium_write8(&priv->regs->otgien, 0x0); -+ phytium_write8(&priv->regs->usbien, 0x0); -+ phytium_write16(&priv->regs->txerrien, 0x0); -+ phytium_write16(&priv->regs->rxerrien, 0x0); -+ -+ //clear all interrupt except otg idle irq -+ phytium_write8(&priv->regs->otgirq, 0xFE); -+ phytium_write8(&priv->regs->usbirq, 0xFF); -+ phytium_write16(&priv->regs->txerrirq, 0xFF); -+ phytium_write16(&priv->regs->rxerrirq, 0xFF); -+ -+ phytium_write8(&priv->regs->tawaitbcon, 0x80); -+ -+ initEndpoints(priv); -+ priv->otgState = HOST_OTG_STATE_B_IDLE; -+ -+ //reset all endpoint -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); -+ -+ if (isVhubHost) -+ priv->vhub_regs = (struct VHUB_REGS *)(config->phy_regBase); -+ else -+ priv->custom_regs = (struct CUSTOM_REGS *)(config->phy_regBase); -+ -+ return 0; -+} -+ -+void hostDestroy(struct HOST_CTRL *priv) -+{ -+} -+ -+void hostStart(struct HOST_CTRL *priv) -+{ -+ uint8_t otgstate, usbien; -+ -+ if (!priv) -+ return; -+ -+ priv->dmaDrv->dma_start(priv->dmaController); -+ usbien = phytium_read8(&priv->regs->usbien); -+ usbien = usbien | USBIR_URES | USBIR_SUSP; -+ phytium_write8(&priv->regs->usbien, usbien); -+retry: -+ otgstate = phytium_read8(&priv->regs->otgstate); -+ switch (otgstate) { -+ case HOST_OTG_STATE_A_IDLE: -+ priv->ep0State = HOST_EP0_STAGE_IDLE; -+ priv->otgState = HOST_OTG_STATE_A_IDLE; -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); -+ host_SetVbus(priv, 1); -+ break; -+ case HOST_OTG_STATE_B_IDLE: -+ host_SetVbus(priv, 1); -+ break; -+ case HOST_OTG_STATE_A_WAIT_VFALL: -+ goto retry; -+ } -+ -+ phytium_write8(&priv->regs->otgien, OTGIRQ_CONIRQ | -+ OTGIRQ_VBUSERRIRQ | OTGIRQ_SRPDETIRQ); -+} -+ -+void hostStop(struct HOST_CTRL *priv) -+{ -+ if (!priv) -+ return; -+ -+ phytium_write8(&priv->regs->otgien, 0x0); -+ phytium_write8(&priv->regs->usbien, 0x0); -+ phytium_write16(&priv->regs->txerrien, 0x0); -+ phytium_write16(&priv->regs->rxerrien, 0x0); -+ -+ phytium_write8(&priv->regs->otgirq, 0xFE); -+ phytium_write8(&priv->regs->usbirq, 0xFF); -+ phytium_write16(&priv->regs->txerrirq, 0xFF); -+ phytium_write16(&priv->regs->rxerrirq, 0xFF); -+ -+ host_SetVbus(priv, 0); -+ priv->dmaDrv->dma_stop(priv->dmaController); -+} -+ -+static void handleReset(struct HOST_CTRL *priv) -+{ -+ if (!priv) -+ return; -+ -+ if (priv->otgState == HOST_OTG_STATE_A_WAIT_BCON -+ || priv->otgState == HOST_OTG_STATE_B_WAIT_ACON) { -+ switch (phytium_read8(&priv->regs->speedctrl)) { -+ case SPEEDCTRL_HS: -+ priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; -+ break; -+ case SPEEDCTRL_FS: -+ priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); -+ break; -+ case SPEEDCTRL_LS: -+ priv->portStatus |= USB_PORT_STAT_LOW_SPEED; -+ break; -+ } -+ -+ priv->dmaDrv->dma_setHostMode(priv->dmaController); -+ -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); -+ -+ switch (phytium_read8(&priv->regs->otgstate)) { -+ case HOST_OTG_STATE_B_HOST: -+ priv->otgState = HOST_OTG_STATE_B_HOST; -+ break; -+ case HOST_OTG_STATE_A_HOST: -+ break; -+ default: -+ priv->otgState = HOST_OTG_STATE_A_HOST; -+ break; -+ } -+ } -+} -+ -+void hostIsr(struct HOST_CTRL *priv) -+{ -+ uint8_t usbirq, usbien; -+ -+ if (!priv) -+ return; -+ -+ usbirq = phytium_read8(&priv->regs->usbirq); -+ usbien = phytium_read8(&priv->regs->usbien); -+ pr_debug("raw usbirq:0x%x usbien:0x%x\n", usbirq, usbien); -+ usbirq = usbirq & usbien; -+ -+ hostErrorIrq(priv); -+ hostOtgIrq(priv); -+ -+ if (!usbirq) -+ goto DMA_IRQ; -+ -+ if (usbirq & USBIR_URES) { -+ phytium_write8(&priv->regs->usbirq, USBIR_URES); -+ priv->port_resetting = 0; -+ handleReset(priv); -+ } -+ -+ if (usbirq & USBIR_SOF) -+ phytium_write8(&priv->regs->usbirq, USBIR_SOF); -+ -+ if (usbirq & USBIR_SUSP) { -+ pr_debug("clear suspend irq\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_SUSP); -+ phytium_write8(&priv->regs->clkgate, 0x7); -+ } -+ -+ return; -+DMA_IRQ: -+ priv->dmaDrv->dma_isr(priv->dmaController); -+} -+ -+int32_t hostEpDisable(struct HOST_CTRL *priv, struct HOST_EP *ep) -+{ -+ return 0; -+} -+ -+unsigned int get_endpoint_interval(struct usb_endpoint_descriptor desc, -+ int speed) -+{ -+ unsigned int interval = 0; -+ -+ switch (speed) { -+ case USB_SPEED_HIGH: -+ if (usb_endpoint_xfer_control(&desc) || usb_endpoint_xfer_bulk(&desc)) { -+ if (desc.bInterval == 0) -+ return interval; -+ interval = fls(desc.bInterval) - 1; -+ interval = clamp_val(interval, 0, 15); -+ interval = 1 << interval; -+ if (interval != desc.bInterval) -+ pr_debug("rounding to %d microframes, desc %d microframes\n", -+ interval, desc.bInterval); -+ break; -+ } -+ -+ if (usb_endpoint_xfer_isoc(&desc) || usb_endpoint_xfer_int(&desc)) { -+ interval = clamp_val(desc.bInterval, 1, 16) - 1; -+ interval = 1 << interval; -+ if (interval != desc.bInterval - 1) -+ pr_debug("rounding to %d %sframes\n", interval, -+ speed == USB_SPEED_FULL ? "" : "micro"); -+ } -+ break; -+ case USB_SPEED_FULL: -+ if (usb_endpoint_xfer_isoc(&desc)) { -+ interval = clamp_val(desc.bInterval, 1, 16) - 1; -+ if (interval != desc.bInterval - 1) -+ pr_debug("rounding to %d %sframes\n", 1 << interval, -+ speed == USB_SPEED_FULL ? "" : "micro"); -+ interval += 3; -+ break; -+ } -+ /* fall through */ -+ case USB_SPEED_LOW: -+ if (usb_endpoint_xfer_int(&desc) || usb_endpoint_xfer_isoc(&desc)) { -+ interval = fls(desc.bInterval * 8) - 1; -+ interval = clamp_val(interval, 3, 10); -+ if ((1 << interval) != desc.bInterval * 8) -+ pr_debug("rounding to %d microframes, desc %d microframes\n", -+ 1 << interval, desc.bInterval); -+ } -+ } -+ -+ return interval; -+} -+ -+int32_t hostReqQueue(struct HOST_CTRL *priv, struct HOST_REQ *req) -+{ -+ struct HOST_EP_PRIV *hostEpPriv; -+ struct list_head *hEpQueue = NULL; -+ uint8_t idleQueue = 0; -+ -+ if (!priv || !req) -+ return -EINVAL; -+ -+ list_add_tail((struct list_head *)&req->list, (struct list_head *)&req->usbEp->reqList); -+ hostEpPriv = (struct HOST_EP_PRIV *)req->usbEp->hcPriv; -+ -+ if (hostEpPriv->epIsReady) { -+ if (usb_endpoint_xfer_isoc(&req->usbEp->desc)) { -+ hostEpPriv->isocEpConfigured = 1; -+ hostStartReq(priv, req); -+ } -+ return 0; -+ } -+ -+ hostEpPriv->epIsReady = 1; -+ hostEpPriv->maxPacketSize = req->usbEp->desc.wMaxPacketSize; -+ hostEpPriv->interval = req->interval; -+ hostEpPriv->epNum = req->usbEp->desc.bEndpointAddress & 0xf; -+ hostEpPriv->faddress = req->faddress; -+ hostEpPriv->usbHEp = req->usbEp; -+ hostEpPriv->isIn = req->epIsIn; -+ -+ hostEpPriv->frame = get_endpoint_interval(req->usbEp->desc, req->usbDev->speed); -+ hostEpPriv->interval = hostEpPriv->frame; -+ switch (usb_endpoint_type(&req->usbEp->desc)) { -+ case USB_ENDPOINT_XFER_CONTROL: -+ hostEpPriv->isIn = 0; -+ hEpQueue = &priv->ctrlHEpQueue; -+ hostEpPriv->type = USB_ENDPOINT_XFER_CONTROL; -+ break; -+ case USB_ENDPOINT_XFER_BULK: -+ hEpQueue = hostEpPriv->isIn ? &priv->bulkInHEpQueue[req->epNum - 1] : -+ &priv->bulkOutHEpQueue[req->epNum - 1]; -+ hostEpPriv->type = USB_ENDPOINT_XFER_BULK; -+ break; -+ case USB_ENDPOINT_XFER_INT: -+ hEpQueue = hostEpPriv->isIn ? &priv->intInHEpQueue[req->epNum - 1] : -+ &priv->intOutHEpQueue[req->epNum - 1]; -+ hostEpPriv->type = USB_ENDPOINT_XFER_INT; -+ break; -+ case USB_ENDPOINT_XFER_ISOC: -+ hEpQueue = hostEpPriv->isIn ? &priv->isoInHEpQueue[req->epNum - 1] : -+ &priv->isoOutHEpQueue[req->epNum - 1]; -+ hostEpPriv->type = USB_ENDPOINT_XFER_ISOC; -+ break; -+ default: -+ break; -+ } -+ -+ if (hostEpPriv->isIn) -+ hostEpPriv->genericHwEp = &priv->in[req->epNum]; -+ else -+ hostEpPriv->genericHwEp = &priv->out[req->epNum]; -+ -+ hostEpPriv->genericHwEp->state = HOST_EP_ALLOCATED; -+ hostEpPriv->genericHwEp->refCount++; -+ -+ if (list_empty(hEpQueue)) { -+ if (hostEpPriv->genericHwEp->state == HOST_EP_BUSY) { -+ pr_err("Error:Hardware endpoint %d is busy\n", -+ hostEpPriv->genericHwEp->hwEpNum); -+ return -EINVAL; -+ } -+ idleQueue = 1; -+ } -+ -+ if (usb_endpoint_xfer_int(&req->usbEp->desc)) -+ list_add_tail(&hostEpPriv->node, hEpQueue); -+ -+ if (idleQueue) -+ hostStartReq(priv, req); -+ -+ return 0; -+} -+ -+static int abortActuallyUsbRequest(struct HOST_CTRL *priv, -+ struct HOST_REQ *req, struct HOST_EP *usbEp) -+{ -+ struct HOST_EP_PRIV *usbEpPriv; -+ struct HostEp *hostEp; -+ uint16_t rxerrien = 0; -+ uint16_t txerrien = 0; -+ uint8_t rxcon, txcon; -+ -+ if (!priv || !req || !usbEp) -+ return -EINVAL; -+ -+ usbEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; -+ hostEp = usbEpPriv->currentHwEp; -+ -+ usbEpPriv->transferFinished = 1; -+ -+ if (hostEp->isInEp) { -+ if (hostEp->hwEpNum) { -+ rxcon = phytium_read8(&priv->regs->ep[hostEp->hwEpNum - 1].rxcon); -+ rxcon = rxcon & (~BIT(7)); -+ phytium_write8(&priv->regs->ep[hostEp->hwEpNum - 1].rxcon, rxcon); -+ } -+ rxerrien = phytium_read16(&priv->regs->rxerrien); -+ rxerrien &= ~(1 << hostEp->hwEpNum); -+ phytium_write16(&priv->regs->rxerrien, rxerrien); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | -+ ENDPRST_IO_TX | hostEp->hwEpNum); -+ } else { -+ if (hostEp->hwEpNum) { -+ txcon = phytium_read8(&priv->regs->ep[hostEp->hwEpNum - 1].txcon); -+ txcon = txcon & (~BIT(7)); -+ phytium_write8(&priv->regs->ep[hostEp->hwEpNum - 1].txcon, txcon); -+ } -+ txerrien = phytium_read16(&priv->regs->txerrien); -+ txerrien &= ~(1 << hostEp->hwEpNum); -+ phytium_write16(&priv->regs->txerrien, txerrien); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | hostEp->hwEpNum); -+ } -+ -+ scheduleNextTransfer(priv, req, hostEp); -+ -+ return 0; -+} -+ -+int32_t hostReqDequeue(struct HOST_CTRL *priv, struct HOST_REQ *req, uint32_t status) -+{ -+ struct HOST_EP *usbEp; -+ struct HOST_EP_PRIV *usbEpPriv; -+ int ret = 0; -+ -+ if (!priv || !req) -+ return -EINVAL; -+ -+ usbEp = req->usbEp; -+ usbEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; -+ -+ pr_debug("Dequeue usbReq:%p dev%d usbEp%d%s\n", req, req->faddress, req->epNum, -+ req->epIsIn ? "in" : "out"); -+ -+ if (!usbEpPriv->epIsReady) -+ return 0; -+ -+ if (!usbEpPriv->currentHwEp || req->list.prev != &usbEp->reqList) { -+ givebackRequest(priv, req, status); -+ if (list_empty(&usbEp->reqList)) { -+ usbEpPriv->epIsReady = 0; -+ usbEpPriv->currentHwEp = NULL; -+ if (usb_endpoint_xfer_int(&usbEp->desc)) -+ list_del(&usbEpPriv->node); -+ } -+ } else -+ ret = abortActuallyUsbRequest(priv, req, usbEp); -+ -+ if (usbEpPriv->isocEpConfigured) -+ usbEpPriv->isocEpConfigured = 0; -+ -+ return ret; -+} -+ -+int32_t hostVHubStatusData(struct HOST_CTRL *priv, uint8_t *status) -+{ -+ return 0; -+} -+ -+int32_t hostGetDevicePD(struct HOST_CTRL *priv) -+{ -+ return 0; -+} -+ -+int32_t hostGetPrivateDataSize(struct HOST_CTRL *priv) -+{ -+ if (!priv) -+ return 0; -+ -+ return sizeof(struct HOST_EP_PRIV); -+} -+ -+static int hub_descriptor(struct usb_hub_descriptor *buf) -+{ -+ buf->bDescLength = 9; -+ buf->bDescriptorType = 0x29; -+ buf->bNbrPorts = 1; -+ buf->wHubCharacteristics = 0x11; -+ buf->bPwrOn2PwrGood = 5; -+ buf->bHubContrCurrent = 0; -+ buf->u.hs.DeviceRemovable[0] = 0x2; -+ -+ return 0; -+} -+ -+static int HubPortSuspend(struct HOST_CTRL *priv, u16 on) -+{ -+ uint8_t otgctrl; -+ -+ if (!priv) -+ return 0; -+ -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ -+ if (on) { -+ otgctrl &= ~OTGCTRL_BUSREQ; -+ otgctrl &= ~OTGCTRL_BHNPEN; -+ -+ priv->portStatus |= USB_PORT_STAT_SUSPEND; -+ -+ switch (phytium_read8(&priv->regs->otgstate)) { -+ case HOST_OTG_STATE_A_HOST: -+ priv->otgState = HOST_OTG_STATE_A_SUSPEND; -+ otgctrl |= OTGCTRL_ASETBHNPEN; -+ break; -+ case HOST_OTG_STATE_B_HOST: -+ priv->otgState = HOST_OTG_STATE_B_HOST_2; -+ break; -+ default: -+ break; -+ } -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ } else { -+ otgctrl |= OTGCTRL_BUSREQ; -+ otgctrl &= ~OTGCTRL_ASETBHNPEN; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ priv->portStatus |= USB_PORT_STAT_RESUME; -+ } -+ return 0; -+} -+ -+static void HubPortReset(struct HOST_CTRL *priv, uint8_t on) -+{ -+ uint8_t speed; -+ -+ if (!priv) -+ return; -+ -+ if (on) { -+ phytium_write16(&priv->regs->txerrirq, 0xFFFF); -+ phytium_write16(&priv->regs->txirq, 0xFFFF); -+ phytium_write16(&priv->regs->rxerrirq, 0xFFFF); -+ phytium_write16(&priv->regs->rxirq, 0xFFFF); -+ -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | -+ ENDPRST_TOGRST | ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x04); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | -+ FIFOCTRL_IO_TX | 0 | 0x04); -+ -+ priv->portStatus |= USB_PORT_STAT_RESET; -+ priv->portStatus &= ~USB_PORT_STAT_ENABLE; -+ priv->port_resetting = 0; -+ } else { -+ speed = phytium_read8(&priv->regs->speedctrl); -+ if (speed == SPEEDCTRL_HS) -+ priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; -+ else if (speed == SPEEDCTRL_FS) -+ priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); -+ else -+ priv->portStatus |= USB_PORT_STAT_LOW_SPEED; -+ -+ priv->portStatus &= ~USB_PORT_STAT_RESET; -+ priv->portStatus |= USB_PORT_STAT_ENABLE | (USB_PORT_STAT_C_RESET << 16) -+ | (USB_PORT_STAT_C_ENABLE << 16); -+ -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); -+ } -+} -+ -+static int get_PortStatus(struct HOST_CTRL *priv, u16 wIndex, uint8_t *buff) -+{ -+ uint32_t temp = 0; -+ -+ if (!priv || !buff) -+ return 0; -+ -+ if ((wIndex & 0xff) != 1) -+ return 1; -+ -+ if (priv->portStatus & USB_PORT_STAT_RESET) { -+ if (!priv->port_resetting) -+ HubPortReset(priv, 0); -+ } -+ -+ if (priv->portStatus & USB_PORT_STAT_RESUME) { -+ priv->portStatus &= ~(USB_PORT_STAT_SUSPEND | USB_PORT_STAT_RESUME); -+ priv->portStatus |= USB_PORT_STAT_C_SUSPEND << 16; -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); -+ } -+ -+ temp = priv->portStatus & (~USB_PORT_STAT_RESUME); -+ buff[0] = temp; -+ buff[1] = temp >> 8; -+ buff[2] = temp >> 16; -+ buff[3] = temp >> 24; -+ -+ return 0; -+} -+ -+static int set_PortFeature(struct HOST_CTRL *priv, u16 wValue, u16 wIndex) -+{ -+// struct HW_Regs *regs = priv->regs; -+ -+ if ((wIndex & 0xff) != 1) -+ return 1; -+ -+ switch (wValue) { -+ case USB_PORT_FEAT_CONNECTION: -+ break; -+ case USB_PORT_FEAT_ENABLE: -+ break; -+ case USB_PORT_FEAT_SUSPEND: -+ HubPortSuspend(priv, 1); -+ break; -+ case USB_PORT_FEAT_OVER_CURRENT: -+ break; -+ case USB_PORT_FEAT_RESET: -+ HubPortReset(priv, 1); -+ break; -+ case USB_PORT_FEAT_L1: -+ break; -+ case USB_PORT_FEAT_POWER: -+ hostStart(priv); -+ break; -+ case USB_PORT_FEAT_LOWSPEED: -+ break; -+ case USB_PORT_FEAT_C_CONNECTION: -+ break; -+ case USB_PORT_FEAT_C_ENABLE: -+ break; -+ case USB_PORT_FEAT_C_SUSPEND: -+ break; -+ case USB_PORT_FEAT_C_OVER_CURRENT: -+ break; -+ case USB_PORT_FEAT_INDICATOR: -+ break; -+ case USB_PORT_FEAT_C_PORT_L1: -+ break; -+ default: -+ break; -+ } -+ priv->portStatus |= 1 << wValue; -+ -+ return 0; -+} -+ -+static int Clear_PortFeature(struct HOST_CTRL *priv, u16 wValue, u16 wIndex) -+{ -+ if ((wIndex & 0xff) != 1) -+ return 1; -+ -+ switch (wValue) { -+ case USB_PORT_FEAT_CONNECTION: -+ break; -+ case USB_PORT_FEAT_ENABLE: -+ break; -+ case USB_PORT_FEAT_SUSPEND: -+ HubPortSuspend(priv, 0); -+ break; -+ case USB_PORT_FEAT_OVER_CURRENT: -+ break; -+ case USB_PORT_FEAT_RESET: -+ break; -+ case USB_PORT_FEAT_L1: -+ break; -+ case USB_PORT_FEAT_POWER: -+ break; -+ case USB_PORT_FEAT_LOWSPEED: -+ break; -+ case USB_PORT_FEAT_C_CONNECTION: -+ break; -+ case USB_PORT_FEAT_C_ENABLE: -+ break; -+ case USB_PORT_FEAT_C_SUSPEND: -+ break; -+ case USB_PORT_FEAT_C_OVER_CURRENT: -+ break; -+ case USB_PORT_FEAT_INDICATOR: -+ break; -+ case USB_PORT_FEAT_C_PORT_L1: -+ break; -+ default: -+ break; -+ } -+ priv->portStatus &= ~(1 << wValue); -+ -+ return 0; -+} -+ -+static int hc_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue, -+ u16 wIndex, char *buf, u16 wLength) -+{ -+ unsigned long flags = 0; -+ int retval = 0; -+ struct HOST_CTRL *priv; -+ struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; -+ -+ if (!config) -+ return -EINVAL; -+ -+ if (!buf) -+ return -EINVAL; -+ -+ if (unlikely(!HCD_HW_ACCESSIBLE(hcd))) { -+ spin_unlock_irqrestore(&config->lock, flags); -+ return -ESHUTDOWN; -+ } -+ -+ priv = (struct HOST_CTRL *)config->host_priv; -+ if (!priv) -+ return -EINVAL; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ switch (typeReq) { -+ case GetHubStatus: -+ break; -+ case GetPortStatus: -+ get_PortStatus(priv, wIndex, (uint8_t *)buf); -+ break; -+ case GetHubDescriptor: -+ hub_descriptor((struct usb_hub_descriptor *)buf); -+ break; -+ case SetPortFeature: -+ set_PortFeature(priv, wValue, wIndex); -+ break; -+ case ClearPortFeature: -+ retval = Clear_PortFeature(priv, wValue, wIndex); -+ break; -+ case SetHubFeature: -+ break; -+ case ClearHubFeature: -+ break; -+ default: -+ break; -+ } -+ -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return retval; -+} -+ -+int32_t hostVHubControl(struct HOST_CTRL *priv, struct usb_ctrlrequest *setup, uint8_t *buff) -+{ -+ uint16_t request; -+ uint32_t retval = 0; -+ -+ if (!priv || !setup || !buff) -+ return -EINVAL; -+ -+ request = setup->bRequestType << 0x08 | setup->bRequest; -+ switch (request) { -+ case ClearHubFeature: -+ break; -+ case SetHubFeature: -+ break; -+ case ClearPortFeature: -+ retval = Clear_PortFeature(priv, setup->wValue, setup->wIndex); -+ break; -+ case SetPortFeature: -+ retval = set_PortFeature(priv, setup->wValue, setup->wIndex); -+ break; -+ case GetHubDescriptor: -+ retval = hub_descriptor((struct usb_hub_descriptor *)buff); -+ break; -+ case GetHubStatus: -+ break; -+ case GetPortStatus: -+ retval = get_PortStatus(priv, setup->wIndex, (uint8_t *)buff); -+ break; -+ default: -+ retval = EOPNOTSUPP; -+ break; -+ } -+ -+ return retval; -+} -+ -+struct HOST_OBJ hostDrv = { -+ .host_init = hostInit, -+ .host_destroy = hostDestroy, -+ .host_start = hostStart, -+ .host_stop = hostStop, -+ .host_isr = hostIsr, -+ -+ //endpoint operation -+ .host_epDisable = hostEpDisable, -+ .host_reqQueue = hostReqQueue, -+ .host_reqDequeue = hostReqDequeue, -+ .host_vhubStatusData = hostVHubStatusData, -+ .host_vhubControl = hostVHubControl, -+ .host_getDevicePD = hostGetDevicePD, -+ .host_epGetPrivateDataSize = hostGetPrivateDataSize, -+}; -+ -+static struct hc_driver host_driver = { -+ .description = "phytium-hcd", -+ .product_desc = "Phytium Host USB Driver", -+ .hcd_priv_size = sizeof(struct phytium_cusb *), -+ .flags = HCD_MEMORY | HCD_USB2 | HCD_DMA, -+ .reset = hc_reset, -+ .start = hc_start, -+ .stop = hc_stop, -+ .shutdown = hc_shutdown, -+ .urb_enqueue = hc_urb_enqueue, -+ .urb_dequeue = hc_urb_dequeue, -+ .endpoint_disable = hc_endpoint_disable, -+ .get_frame_number = hc_get_frame, -+ .alloc_dev = hc_alloc_dev, -+ .free_dev = hc_free_dev, -+ .reset_device = hc_reset_device, -+ .update_device = hc_update_device, -+ .add_endpoint = hc_add_endpoint, -+ .drop_endpoint = hc_drop_endpoint, -+ .hub_status_data = hc_hub_status_data, -+ .hub_control = hc_hub_control, -+#ifdef CONFIG_PM -+ .bus_suspend = hc_bus_suspend, -+ .bus_resume = hc_bus_resume, -+#endif -+}; -+ -+static int phytium_host_set_default_cfg(struct phytium_cusb *config) -+{ -+ int index; -+ -+ config->host_cfg.regBase = (uintptr_t)config->regs; -+ config->host_cfg.phy_regBase = (uintptr_t)config->phy_regs; -+ config->host_cfg.dmultEnabled = 1; -+ config->host_cfg.memoryAlignment = 0; -+ config->host_cfg.dmaSupport = 1; -+ config->host_cfg.isEmbeddedHost = 1; -+ -+ for (index = 0; index < HOST_EP_NUM; index++) { -+ if (index == 0) { -+ config->host_cfg.epIN[index].bufferingValue = 1; -+ config->host_cfg.epIN[index].maxPacketSize = 64; -+ config->host_cfg.epIN[index].startBuf = 0; -+ -+ config->host_cfg.epOUT[index].bufferingValue = 1; -+ config->host_cfg.epOUT[index].maxPacketSize = 64; -+ config->host_cfg.epOUT[index].startBuf = 0; -+ } else { -+ config->host_cfg.epIN[index].bufferingValue = 2; -+ config->host_cfg.epIN[index].maxPacketSize = 1024; -+ config->host_cfg.epIN[index].startBuf = 64 + 2 * 1024 * (index - 1); -+ -+ config->host_cfg.epOUT[index].bufferingValue = 2; -+ config->host_cfg.epOUT[index].maxPacketSize = 1024; -+ config->host_cfg.epOUT[index].startBuf = 64 + 2 * 1024 * (index - 1); -+ } -+ } -+ -+ return 0; -+} -+ -+static int phytium_host_reinit(struct phytium_cusb *config) -+{ -+ struct HOST_CTRL *ctrl; -+ -+ if (!config || !config->host_priv) -+ return 0; -+ -+ ctrl = (struct HOST_CTRL *)config->host_priv; -+ -+ usb_root_hub_lost_power(config->hcd->self.root_hub); -+ hostStop(ctrl); -+ -+ ctrl->portStatus = 0; -+ -+ config->host_obj->host_init(config->host_priv, &config->host_cfg, -+ &config->host_callbacks, config->dev, config->isVhubHost); -+ -+ return 0; -+} -+ -+int phytium_host_init(struct phytium_cusb *config) -+{ -+ int ret; -+ -+ if (!config) -+ return 0; -+ -+ phytium_host_set_default_cfg(config); -+ config->host_obj = HOST_GetInstance(); -+ config->dma_cfg.regBase = config->host_cfg.regBase + 0x400; -+ -+ config->dma_obj = DMA_GetInstance(); -+ config->dma_obj->dma_probe(&config->dma_cfg, &config->dma_sysreq); -+ -+ config->host_sysreq.privDataSize = sizeof(struct HOST_CTRL); -+ config->host_sysreq.trbMemSize = config->dma_sysreq.trbMemSize; -+ config->host_sysreq.privDataSize += config->dma_sysreq.privDataSize; -+ -+ config->host_priv = devm_kzalloc(config->dev, config->host_sysreq.privDataSize, GFP_KERNEL); -+ if (!config->host_priv) { -+ ret = -ENOMEM; -+ goto err_probe; -+ } -+ -+ config->host_cfg.trbAddr = dma_alloc_coherent(config->dev, config->host_sysreq.trbMemSize, -+ (dma_addr_t *)&config->host_cfg.trbDmaAddr, GFP_KERNEL); -+ if (!config->host_cfg.trbAddr) { -+ ret = -ENOMEM; -+ goto err_dma_coherent; -+ } -+ -+ config->host_callbacks.portStatusChange = host_rh_port_status_change; -+ config->host_callbacks.getEpToggle = host_get_ep_toggle; -+ config->host_callbacks.setEpToggle = host_set_ep_toggle; -+ config->host_callbacks.givebackRequest = host_giveback_request; -+ -+ config->host_obj->host_init(config->host_priv, &config->host_cfg, -+ &config->host_callbacks, config->dev, config->isVhubHost); -+ -+ config->hcd = usb_create_hcd(&host_driver, config->dev, dev_name(config->dev)); -+ if (!config->hcd) { -+ ret = -ENODEV; -+ goto err_host; -+ } -+ -+ *config->hcd->hcd_priv = (unsigned long)config; -+ config->hcd->self.uses_pio_for_control = 0; -+ config->hcd->uses_new_polling = 1; -+ config->hcd->has_tt = 1; -+ -+ dev_set_drvdata(config->dev, config); -+ -+ config->hcd->self.otg_port = 1; -+ config->hcd->power_budget = 500; -+ ret = usb_add_hcd(config->hcd, 0, 0); -+ if (ret < 0) -+ goto err_setup; -+ -+ return 0; -+err_setup: -+ usb_put_hcd(config->hcd); -+err_host: -+ config->host_obj->host_destroy(config->host_priv); -+ dma_free_coherent(config->dev, config->host_sysreq.trbMemSize, -+ config->host_cfg.trbAddr, config->host_cfg.trbDmaAddr); -+err_dma_coherent: -+err_probe: -+ dev_set_drvdata(config->dev, NULL); -+ return ret; -+} -+ -+int phytium_host_uninit(struct phytium_cusb *config) -+{ -+ if (!config) -+ return 0; -+ -+ if (config->hcd) { -+ usb_remove_hcd(config->hcd); -+ usb_put_hcd(config->hcd); -+ config->hcd = NULL; -+ } -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM -+int phytium_host_resume(void *priv) -+{ -+ int otgctrl; -+ struct phytium_cusb *config = (struct phytium_cusb *)priv; -+ struct HOST_CTRL *ctrl = (struct HOST_CTRL *)config->host_priv; -+ -+ if (!ctrl) -+ return -EINVAL; -+ -+ otgctrl = phytium_read8(&ctrl->regs->otgctrl); -+ otgctrl |= 1; -+ phytium_write8(&ctrl->regs->otgctrl, otgctrl); -+ -+ phytium_host_reinit(config); -+ -+ return 0; -+} -+ -+int phytium_host_suspend(void *priv) -+{ -+ int otgctrl; -+ struct phytium_cusb *config = (struct phytium_cusb *)priv; -+ struct HOST_CTRL *ctrl = (struct HOST_CTRL *)config->host_priv; -+ -+ if (!ctrl) -+ return -EINVAL; -+ -+ otgctrl = phytium_read8(&ctrl->regs->otgctrl); -+ otgctrl = otgctrl & (~1); -+ phytium_write8(&ctrl->regs->otgctrl, otgctrl); -+ -+ return 0; -+} -+#endif -+ -+struct HOST_OBJ *HOST_GetInstance(void) -+{ -+ return &hostDrv; -+} -diff --git a/drivers/usb/phytium/host_api.h b/drivers/usb/phytium/host_api.h -new file mode 100644 -index 000000000..3d4525827 ---- /dev/null -+++ b/drivers/usb/phytium/host_api.h -@@ -0,0 +1,248 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+ -+#ifndef __PHYTIUM_HOST_API_H_ -+#define __PHYTIUM_HOST_API_H_ -+ -+#include -+//#include "list.h" -+#include "dma.h" -+ -+#define MAX_SUPPORTED_DEVICES 16 -+#define USB_PORT_STAT_RESUME (1 << 31) -+#define MAX_INSTANCE_EP_NUM 6 -+ -+enum HOST_OtgState { -+ HOST_OTG_STATE_A_IDLE, -+ HOST_OTG_STATE_A_WAIT_VRISE, -+ HOST_OTG_STATE_A_WAIT_BCON, -+ HOST_OTG_STATE_A_HOST, -+ HOST_OTG_STATE_A_SUSPEND, -+ HOST_OTG_STATE_A_PERIPHERAL, -+ HOST_OTG_STATE_A_VBUS_ERR, -+ HOST_OTG_STATE_A_WAIT_VFALL, -+ HOST_OTG_STATE_B_IDLE = 0x10, -+ HOST_OTG_STATE_B_PERIPHERAL, -+ HOST_OTG_STATE_B_WAIT_ACON, -+ HOST_OTG_STATE_B_HOST, -+ HOST_OTG_STATE_B_HOST_2, -+ HOST_OTG_STATE_B_SRP_INT1, -+ HOST_OTG_STATE_B_SRP_INT2, -+ HOST_OTG_STATE_B_DISCHRG1, -+ HOST_OTG_STATE_B_DISCHRG2, -+ HOST_OTG_STATE_UNKNOWN, -+}; -+ -+enum HOST_EP0_STAGE { -+ HOST_EP0_STAGE_IDLE, -+ HOST_EP0_STAGE_SETUP, -+ HOST_EP0_STAGE_IN, -+ HOST_EP0_STAGE_OUT, -+ HOST_EP0_STAGE_STATUSIN, -+ HOST_EP0_STAGE_STATUSOUT, -+ HOST_EP0_STAGE_ACK, -+}; -+ -+enum HOST_EP_STATE { -+ HOST_EP_FREE, -+ HOST_EP_ALLOCATED, -+ HOST_EP_BUSY, -+ HOST_EP_NOT_IMPLEMENTED -+}; -+ -+struct HOST_DEVICE { -+ uint8_t devnum; -+ uint8_t hubPort; -+ unsigned int speed; -+ struct HOST_DEVICE *parent; -+ void *hcPriv; -+ void *userExt; -+}; -+ -+struct HOST_EP { -+ struct usb_endpoint_descriptor desc; -+ struct list_head reqList; -+ void *userExt; -+ uint8_t *hcPriv; -+}; -+ -+struct HOST_USB_DEVICE { -+ struct HOST_EP ep0_hep; -+ struct HOST_EP *in_ep[16]; -+ struct HOST_EP *out_ep[16]; -+ struct HOST_DEVICE udev; -+ struct usb_device *ld_udev; -+}; -+ -+struct HostEp { -+ uint8_t name[255]; -+ uint8_t hwEpNum; -+ uint8_t hwBuffers; -+ uint16_t hwMaxPacketSize; -+ uint8_t isInEp; -+ void *channel; -+ uint8_t usbEpNum; -+ uint8_t type; -+ uint8_t usbPacketSize; -+ enum HOST_EP_STATE state; -+ struct HOST_EP *scheduledUsbHEp; -+ uint8_t refCount; -+}; -+ -+struct HOST_ISOFRAMESDESC { -+ uint32_t length; -+ uint32_t offset; -+}; -+ -+struct HOST_EP_PRIV { -+ struct list_head node; -+ struct HostEp *genericHwEp; -+ struct HostEp *currentHwEp; -+ uint8_t epIsReady; -+ uint8_t isIn; -+ uint8_t type; -+ uint8_t interval; -+ uint8_t epNum; -+ uint8_t faddress; -+ uint16_t maxPacketSize; -+ uint32_t frame; -+ uint8_t hubAddress; -+ uint8_t portAddress; -+ uint8_t split; -+ struct HOST_EP *usbHEp; -+ uint8_t isocEpConfigured; -+ uint8_t transferFinished; -+}; -+ -+struct HOST_REQ { -+ struct list_head list; -+ struct HOST_EP *usbEp; -+ void *userExt; -+ void *hcPriv; -+ struct HOST_DEVICE *usbDev; -+ struct usb_ctrlrequest *setup; -+ uintptr_t setupDma; -+ void *bufAddress; -+ uintptr_t buffDma; -+ uint32_t buffLength; -+ uint32_t actualLength; -+ uint8_t epIsIn; -+ uint8_t eptype; -+ uint8_t epNum; -+ uint8_t faddress; -+ uint8_t interval; -+ uint8_t status; -+ uint8_t reqUnlinked; -+ struct HOST_ISOFRAMESDESC *isoFramesDesc; -+ uint32_t isoFramesNumber; -+}; -+ -+struct HOST_SYSREQ { -+ uint32_t privDataSize; -+ uint32_t trbMemSize; -+}; -+ -+struct HOST_EP_CFG { -+ uint8_t bufferingValue; -+ uint16_t startBuf; -+ uint16_t maxPacketSize; -+}; -+ -+struct HOST_CFG { -+ uintptr_t regBase; -+ uintptr_t phy_regBase; -+ struct HOST_EP_CFG epIN[16]; -+ struct HOST_EP_CFG epOUT[16]; -+ uint8_t dmultEnabled; -+ uint8_t memoryAlignment; -+ uint8_t dmaSupport; -+ uint8_t isEmbeddedHost; -+ void *trbAddr; -+ uintptr_t trbDmaAddr; -+}; -+ -+struct HOST_CTRL; -+ -+struct HOST_CALLBACKS { -+ void (*portStatusChange)(struct HOST_CTRL *priv); -+ -+ uint8_t (*getEpToggle)(struct HOST_CTRL *priv, -+ struct HOST_DEVICE *usbDev, uint8_t epNum, uint8_t isIn); -+ -+ void (*setEpToggle)(struct HOST_CTRL *priv, struct HOST_DEVICE *usbDev, -+ uint8_t epNum, uint8_t isIn, uint8_t toggle); -+ -+ void (*givebackRequest)(struct HOST_CTRL *priv, -+ struct HOST_REQ *usbReq, uint32_t status); -+ -+ void (*setTimer)(struct HOST_CTRL *priv, uint32_t time, uint8_t id); -+}; -+ -+struct HOST_OBJ { -+ int32_t (*host_probe)(struct HOST_CFG *config, struct HOST_SYSREQ *sysReq); -+ -+ int32_t (*host_init)(struct HOST_CTRL *priv, struct HOST_CFG *config, -+ struct HOST_CALLBACKS *callbacks, struct device *pdev, bool isVhubHost); -+ -+ void (*host_destroy)(struct HOST_CTRL *priv); -+ -+ void (*host_start)(struct HOST_CTRL *priv); -+ -+ void (*host_stop)(struct HOST_CTRL *priv); -+ -+ void (*host_isr)(struct HOST_CTRL *priv); -+ -+ int32_t (*host_epDisable)(struct HOST_CTRL *priv, struct HOST_EP *ep); -+ -+ int32_t (*host_reqQueue)(struct HOST_CTRL *priv, struct HOST_REQ *req); -+ -+ int32_t (*host_reqDequeue)(struct HOST_CTRL *priv, -+ struct HOST_REQ *req, uint32_t status); -+ -+ int32_t (*host_vhubStatusData)(struct HOST_CTRL *priv, uint8_t *status); -+ -+ int32_t (*host_vhubControl)(struct HOST_CTRL *priv, -+ struct usb_ctrlrequest *setup, uint8_t *buff); -+ -+ int32_t (*host_getDevicePD)(struct HOST_CTRL *priv); -+ -+ int32_t (*host_epGetPrivateDataSize)(struct HOST_CTRL *priv); -+}; -+ -+struct HOST_CTRL { -+ struct device *dev; -+ struct HW_REGS *regs; -+ struct HOST_OBJ *hostDrv; -+ struct HOST_CFG hostCfg; -+ struct HOST_CALLBACKS hostCallbacks; -+ struct HostEp in[16]; -+ struct HostEp out[16]; -+ uint32_t portStatus; -+ struct list_head ctrlHEpQueue; -+ struct list_head isoInHEpQueue[MAX_INSTANCE_EP_NUM]; -+ struct list_head isoOutHEpQueue[MAX_INSTANCE_EP_NUM]; -+ struct list_head intInHEpQueue[MAX_INSTANCE_EP_NUM]; -+ struct list_head intOutHEpQueue[MAX_INSTANCE_EP_NUM]; -+ struct list_head bulkInHEpQueue[MAX_INSTANCE_EP_NUM]; -+ struct list_head bulkOutHEpQueue[MAX_INSTANCE_EP_NUM]; -+ uint8_t hwEpInCount; -+ uint8_t hwEpOutCount; -+ unsigned int speed; -+ enum HOST_OtgState otgState; -+ enum HOST_EP0_STAGE ep0State; -+ uint8_t vBusErrCnt; -+ uint8_t isRemoteWakeup; -+ uint8_t isSelfPowered; -+ uint8_t deviceAddress; -+ struct DMA_OBJ *dmaDrv; -+ void *dmaController; -+ struct DMA_CFG dmaCfg; -+ struct DMA_CALLBACKS dmaCallback; -+ uint8_t port_resetting; -+ struct HOST_USB_DEVICE *host_devices_table[MAX_SUPPORTED_DEVICES]; -+ struct CUSTOM_REGS *custom_regs; -+ struct VHUB_REGS *vhub_regs; -+}; -+ -+struct HOST_OBJ *HOST_GetInstance(void); -+ -+#endif -diff --git a/drivers/usb/phytium/hw-regs.h b/drivers/usb/phytium/hw-regs.h -new file mode 100644 -index 000000000..8da9f8e9b ---- /dev/null -+++ b/drivers/usb/phytium/hw-regs.h -@@ -0,0 +1,297 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+#ifndef __LINUX_PHYTIUM_HW_REGS -+#define __LINUX_PHYTIUM_HW_REGS -+ -+#define USBIEN 0x198 -+#define USBIEN_SUDAVIE BIT(0) -+#define USBIEN_SOFIE BIT(1) -+#define USBIEN_SUTOKIE BIT(2) -+#define USBIEN_SUSPIE BIT(3) -+#define USBIEN_URESIE BIT(4) -+#define USBIEN_HSPEEDIE BIT(5) -+#define USBIEN_LPMIE BIT(7) -+ -+#define USBCS 0x1a3 -+#define USBCS_LSMODE BIT(0) -+#define USBCS_LPMNYET BIT(1) -+#define USBCS_SIGSUME BIT(5) -+#define USBCS_DISCON BIT(6) -+#define USBCS_WAKESRC BIT(7) -+ -+#define USBIR_SOF BIT(1) -+#define USBIR_SUSP BIT(3) -+#define USBIR_URES BIT(4) -+#define USBIR_HSPEED BIT(5) -+ -+#define USBIR_SUDAV BIT(0) -+#define USBIR_SUTOK BIT(2) -+#define USBIR_LPMIR BIT(7) -+ -+#define OTGIRQ_IDLEIRQ BIT(0) -+#define OTGIRQ_SRPDETIRQ BIT(1) -+#define OTGIRQ_CONIRQ BIT(2) -+#define OTGIRQ_LOCSOFIRQ BIT(2) -+#define OTGIRQ_VBUSERRIRQ BIT(3) -+#define OTGIRQ_PERIPHIRQ BIT(4) -+#define OTGIRQ_IDCHANGEIRQ BIT(5) -+#define OTGIRQ_HOSTDISCON BIT(6) -+#define OTGIRQ_BSE0SRPIRQ BIT(7) -+ -+#define OTGCTRL_BUSREQ BIT(0) -+#define OTGCTRL_ABUSDROP BIT(1) -+#define OTGCTRL_ASETBHNPEN BIT(2) -+#define OTGCTRL_BHNPEN BIT(3) -+#define OTGCTRL_SRPVBUSDETEN BIT(4) -+#define OTGCTRL_SRPDATDETEN BIT(5) -+#define OTGCTRL_FORCEBCONN BIT(7) -+ -+#define OTGSTATUS_ID BIT(6) -+ -+#define ENDPRST_EP 0x0f -+#define ENDPRST_IO_TX BIT(4) -+#define ENDPRST_TOGRST BIT(5) -+#define ENDPRST_FIFORST BIT(6) -+#define ENDPRST_TOGSETQ BIT(7) -+ -+#define FIFOCTRL_EP 0x0f -+#define FIFOCTRL_IO_TX BIT(4) -+#define FIFOCTRL_FIFOAUTO BIT(5) -+ -+#define SPEEDCTRL_LS BIT(0) -+#define SPEEDCTRL_FS BIT(1) -+#define SPEEDCTRL_HS BIT(2) -+#define SPEEDCTRL_HSDISABLE BIT(7) -+ -+#define CON_TYPE_CONTROL 0x00 -+#define CON_TYPE_ISOC 0x04 -+#define CON_TYPE_BULK 0x08 -+#define CON_TYPE_INT 0x0C -+#define CON_TYPE_ISOC_1_ISOD 0x00 -+#define CON_TYPE_ISOC_2_ISOD 0x10 -+#define CON_TYPE_ISOC_3_ISOD 0x20 -+#define CON_STALL 0x40 -+#define CON_VAL 0x80 -+ -+#define ERR_TYPE 0x1c -+#define ERR_COUNT 0x03 -+#define ERR_RESEND BIT(6) -+#define ERR_UNDERRIEN BIT(7) -+ -+#define ERR_NONE 0 -+#define ERR_CRC 1 -+#define ERR_DATA_TOGGLE_MISMATCH 2 -+#define ERR_STALL 3 -+#define ERR_TIMEOUT 4 -+#define ERR_PID 5 -+#define ERR_TOO_LONG_PACKET 6 -+#define ERR_DATA_UNDERRUN 7 -+ -+#define EP0CS_HCSETTOGGLE BIT(6) -+#define EP0CS_HCSET BIT(4) -+#define EP0CS_RXBUSY_MASK BIT(3) -+#define EP0CS_TXBUSY_MASK BIT(2) -+#define EP0CS_STALL BIT(0) -+#define EP0CS_HSNAK BIT(1) -+#define EP0CS_DSTALL BIT(4) -+#define EP0CS_CHGSET BIT(7) -+ -+#define CS_ERR 0x01 -+#define CS_BUSY 0x02 -+#define CS_NPAK 0x0c -+#define CS_NPAK_OFFSET 0x02 -+#define CS_AUTO 0x10 -+ -+#define CON_BUF_SINGLE 0x00 -+#define CON_BUF_DOUBLE 0x01 -+#define CON_BUF_TRIPLE 0x02 -+#define CON_BUF_QUAD 0x03 -+#define CON_BUF 0x03 -+ -+struct HW_REGS { -+ uint8_t ep0Rxbc; /*address 0x00*/ -+ uint8_t ep0Txbc; /*address 0x01*/ -+ uint8_t ep0cs; /*address 0x02*/ -+ int8_t reserved0; /*address 0x03*/ -+ uint8_t lpmctrll; /*address 0x04*/ -+ uint8_t lpmctrlh; /*address 0x05*/ -+ uint8_t lpmclock; -+ uint8_t ep0fifoctrl; -+ struct ep { /*address 0x08*/ -+ uint16_t rxbc; //outbc (hcinbc) -+ uint8_t rxcon; -+ uint8_t rxcs; -+ uint16_t txbc; //inbc (hcoutbc -+ uint8_t txcon; -+ uint8_t txcs; -+ } ep[15]; -+ uint8_t reserved1[4]; -+ uint32_t fifodat[15]; /*address 0x84*/ -+ uint8_t ep0ctrl; /*address 0xC0*/ -+ uint8_t tx0err; /*address 0xC1*/ -+ uint8_t reserved2; -+ uint8_t rx0err; /*address 0xC3*/ -+ struct epExt { -+ uint8_t txctrl; -+ uint8_t txerr; -+ uint8_t rxctrl; -+ uint8_t rxerr; -+ } epExt[15]; -+ uint8_t ep0datatx[64]; /*address 0x100*/ -+ uint8_t ep0datarx[64]; /*address 0x140*/ -+ uint8_t setupdat[8]; /*address 0x180*/ -+ uint16_t txirq; /*address 0x188*/ -+ uint16_t rxirq; /*address 0x18A*/ -+ uint8_t usbirq; /*address 0x18C*/ -+ uint8_t reserved4; -+ uint16_t rxpngirq; /*address 0x18E*/ -+ uint16_t txfullirq; /*address 0x190*/ -+ uint16_t rxemptirq; /*address 0x192*/ -+ uint16_t txien; /*address 0x194*/ -+ uint16_t rxien; /*address 0x196*/ -+ uint8_t usbien; /*address 0x198*/ -+ uint8_t reserved6; -+ uint16_t rxpngien; /*address 0x19A*/ -+ uint16_t txfullien; /*address 0x19C*/ -+ uint16_t rxemptien; /*address 0x19E*/ -+ uint8_t usbivect; /*address 0x1A0*/ -+ uint8_t fifoivect; /*address 0x1A1*/ -+ uint8_t endprst; /*address 0x1A2*/ -+ uint8_t usbcs; /*address 0x1A3*/ -+ uint16_t frmnr; /*address 0x1A4*/ -+ uint8_t fnaddr; /*address 0x1A6*/ -+ uint8_t clkgate; /*address 0x1A7*/ -+ uint8_t fifoctrl; /*address 0x1A8*/ -+ uint8_t speedctrl; /*address 0x1A9*/ -+ uint8_t reserved8[1]; /*address 0x1AA*/ -+ uint8_t portctrl; /*address 0x1AB*/ -+ uint16_t hcfrmnr; /*address 0x1AC*/ -+ uint16_t hcfrmremain; /*address 0x1AE*/ -+ uint8_t reserved9[4]; /*address 0x1B0*/ -+ uint16_t rxerrirq; /*address 0x1B4*/ -+ uint16_t txerrirq; /*address 0x1B6*/ -+ uint16_t rxerrien; /*address 0x1B8*/ -+ uint16_t txerrien; /*address 0x1BA*/ -+ /*OTG extension*/ -+ uint8_t otgirq; /*address 0x1BC*/ -+ uint8_t otgstate; /*address 0x1BD*/ -+ uint8_t otgctrl; /*address 0x1BE*/ -+ uint8_t otgstatus; /*address 0x1BF*/ -+ uint8_t otgien; /*address 0x1C0*/ -+ uint8_t taaidlbdis; /*address 0x1C1*/ -+ uint8_t tawaitbcon; /*address 0x1C2*/ -+ uint8_t tbvbuspls; /*address 0x1C3*/ -+ uint8_t otg2ctrl; /*address 0x1C4*/ -+ uint8_t reserved10[2]; /*address 0x1C5*/ -+ uint8_t tbvbusdispls; /*address 0x1C7*/ -+ uint8_t traddr; /*address 0x1C8*/ -+ uint8_t trwdata; /*address 0x1C9*/ -+ uint8_t trrdata; /*address 0x1CA*/ -+ uint8_t trctrl; /*address 0x1CB*/ -+ uint16_t isoautoarm; /*address 0x1CC*/ -+ uint8_t adpbc1ien; /*address 0x1CE*/ -+ uint8_t adpbc2ien; /*address 0x1CF*/ -+ uint8_t adpbcctr0; /*address 0x1D0*/ -+ uint8_t adpbcctr1; /*address 0x1D1*/ -+ uint8_t adpbcctr2; /*address 0x1D2*/ -+ uint8_t adpbc1irq; /*address 0x1D3*/ -+ uint8_t adpbc0status; /*address 0x1D4*/ -+ uint8_t adpbc1status; /*address 0x1D5*/ -+ uint8_t adpbc2status; /*address 0x1D6*/ -+ uint8_t adpbc2irq; /*address 0x1D7*/ -+ uint16_t isodctrl; /*address 0x1D8*/ -+ uint8_t reserved11[2]; -+ uint16_t isoautodump; /*address 0x1DC*/ -+ uint8_t reserved12[2]; -+ uint8_t ep0maxpack; /*address 0x1E0*/ -+ uint8_t reserved13; -+ uint16_t rxmaxpack[15]; /*address 0x1E2*/ -+ struct rxsoftimer { /*address 0x200 to 0x23F*/ -+ uint16_t timer; -+ uint8_t reserved; -+ uint8_t ctrl; -+ } rxsoftimer[16]; -+ -+ struct txsoftimer { /*address 0x240 to 0x27F*/ -+ uint16_t timer; -+ uint8_t reserved; -+ uint8_t ctrl; -+ } txsoftimer[16]; -+ uint8_t reserved14[132]; -+ struct rxstaddr { /*address 0x304*/ -+ uint16_t addr; -+ uint16_t reserved; -+ } rxstaddr[15]; -+ uint8_t reserved15[4]; -+ struct txstaddr { /*address 0x344*/ -+ uint16_t addr; -+ uint16_t reserved; -+ } txstaddr[15]; -+ int8_t reserved16[4]; /*address 0x380*/ -+ struct irqmode { /*address 0x384*/ -+ int8_t inirqmode; -+ int8_t reserved21; -+ int8_t outirqmode; -+ int8_t reserved22; -+ } irqmode[15]; -+ /*The Microprocessor control*/ -+ uint8_t cpuctrl; /*address 0x3C0*/ -+ int8_t reserved17[15]; -+ /*The debug counters and workarounds*/ -+ uint8_t debug_rx_bcl; /*address 0x3D0*/ -+ uint8_t debug_rx_bch; /*address 0x3D1*/ -+ uint8_t debug_rx_status; /*address 0x3D2*/ -+ uint8_t debug_irq; /*address 0x3D3*/ -+ uint8_t debug_tx_bcl; /*address 0x3D4*/ -+ uint8_t debug_tx_bch; /*address 0x3D5*/ -+ uint8_t debug_tx_status; /*address 0x3D6*/ -+ uint8_t debug_ien; /*address 0x3D7*/ -+ uint8_t phywa_en; /*address 0x3D8*/ -+ /*endian*/ -+ uint8_t wa1_cnt; /*address 0x3D9*/ -+ int8_t reserved18[2]; /*address 0x3DA*/ -+ uint8_t endian_sfr_cs; /*address 0x3DC*/ -+ int8_t reserved19[2]; /*address 0x3DD*/ -+ uint8_t endian_sfr_s; /*address 0x3DF*/ -+ int8_t reserved20[2]; /*address 0x3E0*/ -+ uint16_t txmaxpack[15]; /*address 0x3E2*/ -+}; -+ -+struct CUSTOM_REGS { -+ uint32_t secure_ctrl; /*address 0x80000*/ -+ uint32_t secsid_atst; /*address 0x80004*/ -+ uint32_t nsaid_smmuid; /*address 0x80008*/ -+ uint32_t ace; /*address 0x8000c*/ -+ uint32_t wakeup; /*address 0x80010*/ -+ uint32_t debug; /*address 0x80014*/ -+}; -+ -+struct VHUB_REGS { -+ uint32_t gen_cfg; /*address 0x00*/ -+ uint32_t gen_st; /*address 0x04*/ -+ uint32_t bc_cfg; /*address 0x08*/ -+ uint32_t bc_st; /*address 0x0c*/ -+ uint32_t adp_cfg; /*address 0x10*/ -+ uint32_t adp_st; /*address 0x14*/ -+ uint32_t dbg_cfg; /*address 0x18*/ -+ uint32_t dbg_st; /*address 0x1c*/ -+ uint32_t utmip_cfg; /*address 0x20*/ -+ uint32_t utmip_st; /*address 0x24*/ -+}; -+ -+struct DMARegs { -+ uint32_t conf; /*address 0x400*/ -+ uint32_t sts; /*address 0x404*/ -+ uint32_t reserved5[5]; -+ uint32_t ep_sel; /*address 0x41C*/ -+ uint32_t traddr; /*address 0x420*/ -+ uint32_t ep_cfg; /*address 0x424*/ -+ uint32_t ep_cmd; /*address 0x428*/ -+ uint32_t ep_sts; /*address 0x42c*/ -+ uint32_t ep_sts_sid;/*address 0x430*/ -+ uint32_t ep_sts_en; /*address 0x434*/ -+ uint32_t drbl; /*address 0x438*/ -+ uint32_t ep_ien; /*address 0x43C*/ -+ uint32_t ep_ists; /*address 0x440*/ -+}; -+ -+#endif -diff --git a/drivers/usb/phytium/pci.c b/drivers/usb/phytium/pci.c -new file mode 100644 -index 000000000..964fd67bf ---- /dev/null -+++ b/drivers/usb/phytium/pci.c -@@ -0,0 +1,208 @@ -+// SPDX-License-Identifier: GPL-2.0 -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "core.h" -+ -+#define PHYTIUM_OTG_USB_LOADED 3 -+ -+static bool phytium_hw_is_device(struct phytium_cusb *config) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return false; -+} -+ -+static bool phytium_hw_is_host(struct phytium_cusb *config) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return true; -+} -+ -+static int phytium_get_dr_mode(struct phytium_cusb *config) -+{ -+ enum usb_dr_mode mode; -+ -+ config->dr_mode = usb_get_dr_mode(config->dev); -+ if (config->dr_mode == USB_DR_MODE_UNKNOWN) -+ config->dr_mode = USB_DR_MODE_OTG; -+ -+ mode = config->dr_mode; -+ if (phytium_hw_is_device(config)) { -+ if (IS_ENABLED(CONFIG_USB_PHYTIUM_HOST)) { -+ dev_err(config->dev, "Controller does not support host mode.\n"); -+ return -EINVAL; -+ } -+ -+ mode = USB_DR_MODE_PERIPHERAL; -+ } else if (phytium_hw_is_host(config)) { -+ if (IS_ENABLED(CONFIG_USB_PHYTIUM_PERIPHERAL)) { -+ dev_err(config->dev, "Controller does not support device mode.\n"); -+ return -EINVAL; -+ } -+ mode = USB_DR_MODE_HOST; -+ } else { -+ if (IS_ENABLED(CONFIG_USB_PHYTIUM_HOST)) -+ mode = USB_DR_MODE_HOST; -+ else if (IS_ENABLED(CONFIG_USB_PHYTIUM_PERIPHERAL)) -+ mode = USB_DR_MODE_PERIPHERAL; -+ } -+ -+ if (mode != config->dr_mode) { -+ dev_warn(config->dev, "Configuration mismatch. dr_mode forced to %s\n", -+ mode == USB_DR_MODE_HOST ? "host" : "device"); -+ config->dr_mode = mode; -+ } -+ -+ return 0; -+} -+ -+static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) -+{ -+ struct phytium_cusb *config; -+ int retval = 0; -+ -+ if (usb_disabled()) -+ return -ENODEV; -+ -+ retval = pcim_enable_device(pdev); -+ if (retval < 0) { -+ dev_err(&pdev->dev, "pcim_enable_device failed\n"); -+ return -ENODEV; -+ } -+ pci_set_master(pdev); -+ -+ config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL); -+ if (!config) -+ return -ENOMEM; -+ -+ spin_lock_init(&config->lock); -+ config->dev = &pdev->dev; -+ -+ config->irq = pdev->irq; -+ if (config->irq <= 0) { -+ dev_err(config->dev, "getting usb irq failed\n"); -+ return config->irq; -+ } -+ -+ config->regs = pci_iomap(pdev, 0, 0); -+ if (IS_ERR(config->regs)) { -+ dev_err(config->dev, "map IOMEM resource failed\n"); -+ return -1; -+ } -+ -+ if (!pdev->dev.dma_mask) -+ pdev->dev.dma_mask = &pdev->dev.coherent_dma_mask; -+ -+ if (dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64))) -+ dev_err(&pdev->dev, "failed to set 64-bit dma\n"); -+ else if (dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32))) -+ dev_err(&pdev->dev, "failed to set 32-bit dma\n"); -+ -+ pci_enable_msi(pdev); -+ -+ phytium_get_dr_mode(config); -+ -+ phytium_core_reset(config, false); -+ -+ if (config->dr_mode == USB_DR_MODE_HOST || config->dr_mode == USB_DR_MODE_OTG) -+ phytium_host_init(config); -+ -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) -+ phytium_gadget_init(config); -+ -+ dev_set_drvdata(config->dev, config); -+ -+ return 0; -+} -+ -+static void phytium_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_cusb *config = dev_get_drvdata(&pdev->dev); -+ -+ phytium_get_dr_mode(config); -+ if (config->dr_mode == USB_DR_MODE_HOST || config->dr_mode == USB_DR_MODE_OTG) -+ phytium_host_uninit(config); -+ -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) -+ phytium_gadget_uninit(config); -+ -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) -+ usb_del_gadget_udc(&config->gadget); -+ -+ dev_set_drvdata(&pdev->dev, NULL); -+ pr_info("%s %d\n", __func__, __LINE__); -+} -+ -+static void phytium_pci_shutdown(struct pci_dev *pdev) -+{ -+ struct phytium_cusb *config; -+ -+ config = dev_get_drvdata(&pdev->dev); -+ -+ phytium_get_dr_mode(config); -+ -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) -+ usb_del_gadget_udc(&config->gadget); -+} -+ -+#ifdef CONFIG_PM -+static int phytium_pci_resume(struct pci_dev *pdev) -+{ -+ unsigned long flags = 0; -+ struct phytium_cusb *config; -+ int ret = 0; -+ -+ config = dev_get_drvdata(&pdev->dev); -+ -+ spin_lock_irqsave(&config->lock, flags); -+ ret = phytium_host_resume(config); -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return ret; -+} -+ -+static int phytium_pci_suspend(struct pci_dev *pdev, pm_message_t state) -+{ -+ unsigned long flags = 0; -+ struct phytium_cusb *config; -+ int ret; -+ -+ config = dev_get_drvdata(&pdev->dev); -+ -+ spin_lock_irqsave(&config->lock, flags); -+ ret = phytium_host_suspend(config); -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+#endif -+ -+const struct pci_device_id phytium_pci_id_table[] = { -+ {0x10ee, 0x8012, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, -+ {} -+}; -+ -+static struct pci_driver phytium_otg_driver = { -+ .name = "phytium_usb", -+ .id_table = phytium_pci_id_table, -+ .probe = phytium_pci_probe, -+ .remove = phytium_pci_remove, -+ .shutdown = phytium_pci_shutdown, -+#ifdef CONFIG_PM -+ .resume = phytium_pci_resume, -+ .suspend = phytium_pci_suspend, -+#endif -+}; -+ -+module_pci_driver(phytium_otg_driver); -+ -+MODULE_AUTHOR("Chen Zhenhua "); -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium usb pci wrapper"); -diff --git a/drivers/usb/phytium/platform.c b/drivers/usb/phytium/platform.c -new file mode 100644 -index 000000000..7d39e4b60 ---- /dev/null -+++ b/drivers/usb/phytium/platform.c -@@ -0,0 +1,216 @@ -+// SPDX-License-Identifier: GPL-3.0 -+ -+#include -+#include -+//#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "core.h" -+#include "hw-regs.h" -+ -+#define PHYTIUM_OTG_USB_LOADED 3 -+#define USB2_2_BASE_ADDRESS 0x31800000 -+ -+static const struct of_device_id phytium_otg_of_match[] = { -+ { -+ .compatible = "phytium,usb2", -+ }, -+ {}, -+}; -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_otg_acpi_match[] = { -+ { "PHYT0037", 0 }, -+ { } -+}; -+#endif -+ -+static int phytium_get_dr_mode(struct phytium_cusb *config) -+{ -+ config->dr_mode = usb_get_dr_mode(config->dev); -+ if (config->dr_mode == USB_DR_MODE_UNKNOWN) -+ config->dr_mode = USB_DR_MODE_PERIPHERAL; -+ -+ return 0; -+} -+ -+static irqreturn_t platform_usb_irq(int irq, void *dev_id) -+{ -+ unsigned long flags; -+ uint8_t otgstate; -+ -+ struct phytium_cusb *config = (struct phytium_cusb *)dev_id; -+ struct GADGET_CTRL *gadget_ctrl = config->gadget_priv; -+ struct HOST_CTRL *host_ctrl = config->host_priv; -+ -+ if (gadget_ctrl || host_ctrl) { -+ if (host_ctrl) -+ otgstate = phytium_read8(&host_ctrl->regs->otgstate); -+ else -+ otgstate = phytium_read8(&gadget_ctrl->regs->otgstate); -+ -+ spin_lock_irqsave(&config->lock, flags); -+ if (otgstate > HOST_OTG_STATE_A_WAIT_VFALL) -+ config->gadget_obj->gadget_isr(config->gadget_priv); -+ else -+ config->host_obj->host_isr(config->host_priv); -+ spin_unlock_irqrestore(&config->lock, flags); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static int phytium_driver_probe(struct platform_device *pdev) -+{ -+ struct phytium_cusb *config; -+ struct resource *res, *phy_res; -+ int retval = 0; -+ -+ config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL); -+ if (!config) -+ return -ENOMEM; -+ -+ spin_lock_init(&config->lock); -+ config->dev = &pdev->dev; -+ config->isVhubHost = false; -+ -+ config->irq = platform_get_irq(pdev, 0); -+ if (config->irq <= 0) { -+ dev_err(config->dev, "getting usb irq failed\n"); -+ return config->irq; -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ config->regs = devm_ioremap(&pdev->dev, res->start, resource_size(res)); -+ if (IS_ERR(config->regs)) { -+ dev_err(config->dev, "map IOMEM resource failed\n"); -+ return -1; -+ } -+ -+ phy_res = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ config->phy_regs = devm_ioremap(&pdev->dev, phy_res->start, resource_size(phy_res)); -+ if (IS_ERR(config->phy_regs)) { -+ dev_err(config->dev, "map IOMEM phy resource failed\n"); -+ return -1; -+ } -+ -+ phytium_get_dr_mode(config); -+ -+ phytium_core_reset(config, false); -+ -+ if (config->dr_mode == USB_DR_MODE_HOST || -+ config->dr_mode == USB_DR_MODE_OTG) { -+ if (res->start == USB2_2_BASE_ADDRESS) -+ config->isVhubHost = true; -+ -+ phytium_host_init(config); -+ } -+ -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || -+ config->dr_mode == USB_DR_MODE_OTG) -+ phytium_gadget_init(config); -+ -+ dev_set_drvdata(&pdev->dev, config); -+ -+ if (config->irq > 0) { -+ retval = devm_request_irq(config->dev, config->irq, platform_usb_irq, -+ IRQF_SHARED, "phytium_otg", config); -+ if (retval != 0) { -+ dev_err(config->dev, "request irq %d err %d\n", config->irq, retval); -+ config->irq = 0; -+ } -+ } -+ -+ return retval; -+} -+ -+static int phytium_driver_remove(struct platform_device *dev) -+{ -+ struct phytium_cusb *config = platform_get_drvdata(dev); -+ -+ if (!config) -+ return 0; -+ -+ phytium_get_dr_mode(config); -+ -+ if (config->dr_mode == USB_DR_MODE_HOST || -+ config->dr_mode == USB_DR_MODE_OTG) -+ phytium_host_uninit(config); -+ -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || -+ config->dr_mode == USB_DR_MODE_OTG) -+ phytium_gadget_uninit(config); -+ -+ dev_set_drvdata(&dev->dev, NULL); -+ return 0; -+} -+ -+static void phytium_driver_shutdown(struct platform_device *dev) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+} -+ -+#ifdef CONFIG_PM -+static int phytium_driver_suspend(struct device *dev) -+{ -+ struct phytium_cusb *config; -+ int ret = 0; -+ -+ config = dev_get_drvdata(dev); -+ -+ if (config->dr_mode == USB_DR_MODE_HOST || -+ config->dr_mode == USB_DR_MODE_OTG) -+ ret = phytium_host_suspend(config); -+ -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || -+ config->dr_mode == USB_DR_MODE_OTG) -+ ret = phytium_gadget_suspend(config); -+ -+ return ret; -+} -+ -+static int phytium_driver_resume(struct device *dev) -+{ -+ struct phytium_cusb *config; -+ int ret = 0; -+ -+ config = dev_get_drvdata(dev); -+ if (config->dr_mode == USB_DR_MODE_HOST || -+ config->dr_mode == USB_DR_MODE_OTG) -+ ret = phytium_host_resume(config); -+ -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || -+ config->dr_mode == USB_DR_MODE_OTG) -+ ret = phytium_gadget_resume(config); -+ -+ return ret; -+} -+ -+static const struct dev_pm_ops phytium_usb_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_driver_suspend, phytium_driver_resume) -+}; -+#endif -+ -+static struct platform_driver phytium_otg_driver = { -+ .driver = { -+ .name = "phytium-otg", -+ .of_match_table = of_match_ptr(phytium_otg_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_otg_acpi_match), -+#ifdef CONFIG_PM -+ .pm = &phytium_usb_pm_ops, -+#endif -+ }, -+ .probe = phytium_driver_probe, -+ .remove = phytium_driver_remove, -+ .shutdown = phytium_driver_shutdown, -+}; -+ -+module_platform_driver(phytium_otg_driver); + /** + * acpi_register_gsi() - Map a GSI to a linux IRQ number + * @dev: device for which IRQ has to be mapped +@@ -51,24 +71,7 @@ EXPORT_SYMBOL_GPL(acpi_gsi_to_irq); + int acpi_register_gsi(struct device *dev, u32 gsi, int trigger, + int polarity) + { +- struct irq_fwspec fwspec; +- unsigned int irq; +- +- if (WARN_ON(!acpi_gsi_domain_id)) { +- pr_warn("GSI: No registered irqchip, giving up\n"); +- return -EINVAL; +- } +- +- fwspec.fwnode = acpi_gsi_domain_id; +- fwspec.param[0] = gsi; +- fwspec.param[1] = acpi_dev_get_irq_type(trigger, polarity); +- fwspec.param_count = 2; +- +- irq = irq_create_fwspec_mapping(&fwspec); +- if (!irq) +- return -EINVAL; +- +- return irq; ++ return acpi_register_irq(dev, gsi, trigger, polarity, acpi_gsi_domain_id); + } + EXPORT_SYMBOL_GPL(acpi_register_gsi); + +@@ -97,7 +100,7 @@ EXPORT_SYMBOL_GPL(acpi_unregister_gsi); + * Return: + * The referenced device fwhandle or NULL on failure + */ +-static struct fwnode_handle * ++struct fwnode_handle * + acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source) + { + struct fwnode_handle *result; +diff --git a/drivers/acpi/pci_irq.c b/drivers/acpi/pci_irq.c +index 14ee631cb..5cccc0f70 100644 +--- a/drivers/acpi/pci_irq.c ++++ b/drivers/acpi/pci_irq.c +@@ -22,6 +22,8 @@ + #include + #include + ++#include "internal.h" + -+MODULE_AUTHOR("Chen Zhenhua "); -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium usb platform wrapper"); -diff --git a/drivers/w1/masters/Kconfig b/drivers/w1/masters/Kconfig -index 24b9a8e05..8c2f6e045 100644 ---- a/drivers/w1/masters/Kconfig -+++ b/drivers/w1/masters/Kconfig -@@ -74,5 +74,15 @@ config W1_MASTER_SGI - This support is also available as a module. If so, the module - will be called sgi_w1. + #define PREFIX "ACPI: " + + #define _COMPONENT ACPI_PCI_COMPONENT +@@ -410,6 +412,7 @@ int acpi_pci_irq_enable(struct pci_dev *dev) + char *link = NULL; + char link_desc[16]; + int rc; ++ struct fwnode_handle *rs_fwnode; + + pin = dev->pin; + if (!pin) { +@@ -438,7 +441,8 @@ int acpi_pci_irq_enable(struct pci_dev *dev) + gsi = acpi_pci_link_allocate_irq(entry->link, + entry->index, + &triggering, &polarity, +- &link); ++ &link, ++ &rs_fwnode); + else + gsi = entry->index; + } else +@@ -462,7 +466,7 @@ int acpi_pci_irq_enable(struct pci_dev *dev) + return 0; + } + +- rc = acpi_register_gsi(&dev->dev, gsi, triggering, polarity); ++ rc = acpi_register_irq(&dev->dev, gsi, triggering, polarity, rs_fwnode); + if (rc < 0) { + dev_warn(&dev->dev, "PCI INT %c: failed to register GSI\n", + pin_name(pin)); +diff --git a/drivers/acpi/pci_link.c b/drivers/acpi/pci_link.c +index fb4c5632a..21f3e4e30 100644 +--- a/drivers/acpi/pci_link.c ++++ b/drivers/acpi/pci_link.c +@@ -59,6 +59,7 @@ struct acpi_pci_link_irq { + u8 resource_type; + u8 possible_count; + u32 possible[ACPI_PCI_LINK_MAX_POSSIBLE]; ++ struct acpi_resource_source resource_source; + u8 initialized:1; + u8 reserved:7; + }; +@@ -120,6 +121,8 @@ static acpi_status acpi_pci_link_check_possible(struct acpi_resource *resource, + { + struct acpi_resource_extended_irq *p = + &resource->data.extended_irq; ++ struct acpi_resource_source *rs = ++ &link->irq.resource_source; + if (!p || !p->interrupt_count) { + printk(KERN_WARNING PREFIX + "Blank _PRS EXT IRQ resource\n"); +@@ -140,6 +143,12 @@ static acpi_status acpi_pci_link_check_possible(struct acpi_resource *resource, + link->irq.triggering = p->triggering; + link->irq.polarity = p->polarity; + link->irq.resource_type = ACPI_RESOURCE_TYPE_EXTENDED_IRQ; ++ if (p->resource_source.string_length) { ++ rs->index = p->resource_source.index; ++ rs->string_length = p->resource_source.string_length; ++ rs->string_ptr = kstrdup(p->resource_source.string_ptr, ++ GFP_KERNEL); ++ } + break; + } + default: +@@ -326,7 +335,8 @@ static int acpi_pci_link_set(struct acpi_pci_link *link, int irq) + resource->res.data.extended_irq.shareable = ACPI_SHARED; + resource->res.data.extended_irq.interrupt_count = 1; + resource->res.data.extended_irq.interrupts[0] = irq; +- /* ignore resource_source, it's optional */ ++ resource->res.data.extended_irq.resource_source = ++ link->irq.resource_source; + break; + default: + printk(KERN_ERR PREFIX "Invalid Resource_type %d\n", link->irq.resource_type); +@@ -612,7 +622,7 @@ static int acpi_pci_link_allocate(struct acpi_pci_link *link) + * failure: return -1 + */ + int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, +- int *polarity, char **name) ++ int *polarity, char **name, struct fwnode_handle **rs_fwnode) + { + int result; + struct acpi_device *device; +@@ -656,6 +666,8 @@ int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, + *polarity = link->irq.polarity; + if (name) + *name = acpi_device_bid(link->device); ++ if (rs_fwnode) ++ *rs_fwnode = acpi_get_irq_source_fwhandle(&link->irq.resource_source); + ACPI_DEBUG_PRINT((ACPI_DB_INFO, + "Link %s is referenced\n", + acpi_device_bid(link->device))); +diff --git a/drivers/clocksource/arm_arch_timer.c b/drivers/clocksource/arm_arch_timer.c +index f4881764b..5ebafb91c 100644 +--- a/drivers/clocksource/arm_arch_timer.c ++++ b/drivers/clocksource/arm_arch_timer.c +@@ -41,23 +41,29 @@ + #define CNTACR_RWVT BIT(4) + #define CNTACR_RWPT BIT(5) -+config W1_MASTER_PHYTIUM -+ tristate "Phytium 1-wire driver" -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ help -+ Say Y here if you want to get support for the 1-wire interface -+ on an Phytium SoC. -+ -+ This driver can also be built as a module. If so, the module -+ will be called phytium-w1. -+ - endmenu +-#define CNTVCT_LO 0x08 +-#define CNTVCT_HI 0x0c ++#define CNTVCT_LO 0x00 ++#define CNTPCT_LO 0x08 + #define CNTFRQ 0x10 +-#define CNTP_TVAL 0x28 ++#define CNTP_CVAL_LO 0x20 + #define CNTP_CTL 0x2c +-#define CNTV_TVAL 0x38 ++#define CNTV_CVAL_LO 0x30 + #define CNTV_CTL 0x3c -diff --git a/drivers/w1/masters/Makefile b/drivers/w1/masters/Makefile -index dae629b7a..43a66fd6d 100644 ---- a/drivers/w1/masters/Makefile -+++ b/drivers/w1/masters/Makefile -@@ -12,3 +12,5 @@ obj-$(CONFIG_W1_MASTER_DS1WM) += ds1wm.o - obj-$(CONFIG_W1_MASTER_GPIO) += w1-gpio.o - obj-$(CONFIG_HDQ_MASTER_OMAP) += omap_hdq.o - obj-$(CONFIG_W1_MASTER_SGI) += sgi_w1.o -+ -+obj-$(CONFIG_W1_MASTER_PHYTIUM) += phytium_w1.o -\ No newline at end of file -diff --git a/drivers/w1/masters/phytium_w1.c b/drivers/w1/masters/phytium_w1.c -new file mode 100644 -index 000000000..32e41a816 ---- /dev/null -+++ b/drivers/w1/masters/phytium_w1.c -@@ -0,0 +1,643 @@ -+// SPDX-License-Identifier: GPL-2.0 +-static unsigned arch_timers_present __initdata; +/* -+ * drivers/w1/masters/phytium_w1m.c -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. ++ * The minimum amount of time a generic counter is guaranteed to not roll over ++ * (40 years) + */ ++#define MIN_ROLLOVER_SECS (40ULL * 365 * 24 * 3600) + +-static void __iomem *arch_counter_base; ++static unsigned arch_timers_present __initdata; + + struct arch_timer { + void __iomem *base; + struct clock_event_device evt; + }; + ++static struct arch_timer *arch_timer_mem __ro_after_init; + -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define PHY_W1M_CTL 0x08 -+ -+/* Simplify mode */ -+#define PHY_W1M_CMD 0x04 -+#define PHY_W1M_PWM0_START_B 0x30 -+#define PHY_W1M_PWM0_END_B 0x34 -+#define PHY_W1M_PWM1_START_B 0x38 -+#define PHY_W1M_PWM1_END_B 0x3c -+#define PHY_W1M_SAMPLE_B 0x40 -+#define PHY_W1M_INT_EN_B 0x64 -+#define PHY_W1M_INT_STATUS_B 0x74 -+#define PHY_W1M_DATA_REG 0x70 -+ -+#define PHY_W1M_CMD_ROM_SEARCH 0xF0 -+#define PHY_W1M_CMD_WRITE_BIT 0x35 -+#define PHY_W1M_CMD_WRITE_BYTE 0x36 -+#define PHY_W1M_CMD_RESET_BUS 0x37 -+#define PHY_W1M_CMD_READ_BIT 0x3A -+#define PHY_W1M_CMD_READ_BYTE 0x3B -+#define PHY_W1M_SLAVE_ROM_ID 0x160 -+ -+#define PHY_W1M_INT_EN_TXCOMPLETE BIT(6) -+#define PHY_W1M_INT_EN_RXCOMPLETE BIT(7) -+ -+#define PHY_W1M_INT_STATUS_TXCOMPLETE BIT(6) -+#define PHY_W1M_INT_STATUS_RXCOMPLETE BIT(7) -+ -+#define W1M_MOD_W1 1 -+#define W1M_MOD_PECI 0 -+ -+#define PHY_W1M_FLAG_CLEAR 0 -+#define PHY_W1M_FLAG_SET 1 -+#define PHY_W1M_TIMEOUT (HZ/5) -+ -+#define PHY_W1M_MAX_USER 4 -+ -+static DECLARE_WAIT_QUEUE_HEAD(w1m_wait_queue); -+ -+struct w1m_data { -+ struct device *dev; -+ void __iomem *w1m_base; -+ /* lock status update */ -+ struct mutex w1m_mutex; -+ int w1m_usecount; -+ u8 w1m_irqstatus; -+ /* device lock */ -+ spinlock_t w1m_spinlock; -+ /* -+ * Used to control the call to phytium_w1m_get and phytium_w1m_put. -+ * Non-w1 Protocol: Write the CMD|REG_address first, followed by -+ * the data wrire or read. -+ */ -+ int init_trans; -+}; -+ -+/* W1 register I/O routines */ -+static inline u8 phytium_w1m_read(struct w1m_data *w1m_data, u32 offset) -+{ -+ return readl(w1m_data->w1m_base + offset); -+} -+ -+static inline void phytium_w1m_write(struct w1m_data *w1m_data, u32 offset, u8 val) -+{ -+ writel(val, w1m_data->w1m_base + offset); -+} -+ -+static inline u8 phytium_w1m_merge(struct w1m_data *w1m_data, u32 offset, -+ u8 val, u8 mask) -+{ -+ u8 new_val = (__raw_readl(w1m_data->w1m_base + offset) & ~mask) -+ | (val & mask); -+ writel(new_val, w1m_data->w1m_base + offset); -+ -+ return new_val; -+} -+ -+static void w1m_disable_interrupt(struct w1m_data *w1m_data, u32 offset, -+ u32 mask) -+{ -+ u32 ie; -+ -+ ie = readl(w1m_data->w1m_base + offset); -+ writel(ie & mask, w1m_data->w1m_base + offset); -+} -+ -+/* write out a byte or bit and fill *status with W1M_INT_STATUS */ -+static int phytium_write_data(struct w1m_data *w1m_data, u8 val, u8 *status, bool is_bit) -+{ -+ int ret; -+ unsigned long irqflags; -+ -+ *status = 0; -+ -+ spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); -+ /* clear interrupt flags via a dummy read */ -+ phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); -+ /* ISR loads it with new INT_STATUS */ -+ w1m_data->w1m_irqstatus = 0; -+ spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); -+ -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_TXCOMPLETE, -+ PHY_W1M_INT_EN_TXCOMPLETE); -+ -+ phytium_w1m_write(w1m_data, PHY_W1M_DATA_REG, val); -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, is_bit ? PHY_W1M_CMD_WRITE_BIT : PHY_W1M_CMD_WRITE_BYTE); -+ -+ /* wait for the TXCOMPLETE bit */ -+ ret = wait_event_timeout(w1m_wait_queue, -+ w1m_data->w1m_irqstatus, PHY_W1M_TIMEOUT); -+ if (ret == 0) { -+ dev_err(w1m_data->dev, "TX wait elapsed\n"); -+ ret = -ETIMEDOUT; -+ goto out; -+ } -+ -+ *status = w1m_data->w1m_irqstatus; -+ /* check irqstatus */ -+ if (!(*status & PHY_W1M_INT_STATUS_TXCOMPLETE)) { -+ dev_err(w1m_data->dev, -+ "timeout waiting for TXCOMPLETE/RXCOMPLETE, %x", *status); -+ ret = -ETIMEDOUT; -+ } -+ -+out: -+ return ret; -+} -+ -+static irqreturn_t w1m_isr(int irq, void *_w1m) -+{ -+ struct w1m_data *w1m_data = _w1m; -+ unsigned long irqflags; -+ -+ spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); -+ w1m_data->w1m_irqstatus = phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); -+ spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); -+ -+ phytium_w1m_write(w1m_data, PHY_W1M_INT_STATUS_B, 0x00); -+ if (w1m_data->w1m_irqstatus & -+ (PHY_W1M_INT_STATUS_TXCOMPLETE | PHY_W1M_INT_STATUS_RXCOMPLETE)) { -+ /* wake up sleeping process */ -+ wake_up(&w1m_wait_queue); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+ -+static int phytium_read_data(struct w1m_data *w1m_data, u8 *val, bool is_bit) -+{ -+ int ret = 0; -+ u8 status; -+ unsigned long irqflags; -+ -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ ret = -EINTR; -+ goto rtn; -+ } -+ -+ if (!w1m_data->w1m_usecount) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); -+ /* clear interrupt flags via a dummy read */ -+ phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); -+ /* ISR loads it with new INT_STATUS */ -+ w1m_data->w1m_irqstatus = 0; -+ spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); -+ -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_RXCOMPLETE, -+ PHY_W1M_INT_EN_RXCOMPLETE); -+ -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, is_bit ? PHY_W1M_CMD_READ_BIT : PHY_W1M_CMD_READ_BYTE); -+ -+ wait_event_timeout(w1m_wait_queue, -+ (w1m_data->w1m_irqstatus & PHY_W1M_INT_STATUS_RXCOMPLETE), -+ PHY_W1M_TIMEOUT); -+ -+ status = w1m_data->w1m_irqstatus; -+ /* check irqstatus */ -+ if (!(status & PHY_W1M_INT_STATUS_RXCOMPLETE)) { -+ dev_err(w1m_data->dev, "timeout waiting for RXCOMPLETE, %x", status); -+ ret = -ETIMEDOUT; -+ goto out; -+ } -+ -+ /* the data is ready. Read it in! */ -+ *val = phytium_w1m_read(w1m_data, PHY_W1M_DATA_REG); -+out: -+ mutex_unlock(&w1m_data->w1m_mutex); -+rtn: -+ return ret; -+} -+ -+ -+static int phytium_w1m_get(struct w1m_data *w1m_data) -+{ -+ int ret = 0; -+ -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ ret = -EINTR; -+ goto rtn; -+ } -+ -+ if (w1m_data->w1m_usecount == PHY_W1M_MAX_USER) { -+ dev_warn(w1m_data->dev, "attempt to exceed the max use count"); -+ ret = -EINVAL; -+ goto out; -+ } else { -+ w1m_data->w1m_usecount++; -+ try_module_get(THIS_MODULE); -+ if (w1m_data->w1m_usecount == 1) -+ pm_runtime_get_sync(w1m_data->dev); -+ } -+ -+out: -+ mutex_unlock(&w1m_data->w1m_mutex); -+rtn: -+ return ret; -+} -+ -+/* Disable clocks to the module */ -+static int phytium_w1m_put(struct w1m_data *w1m_data) -+{ -+ int ret = 0; -+ -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) -+ return -EINTR; -+ -+ if (w1m_data->w1m_usecount == 0) { -+ dev_warn(w1m_data->dev, -+ "attempt to decrement use count when it is zero"); -+ ret = -EINVAL; -+ } else { -+ w1m_data->w1m_usecount--; -+ module_put(THIS_MODULE); -+ if (w1m_data->w1m_usecount == 0) -+ pm_runtime_put_sync(w1m_data->dev); -+ } -+ mutex_unlock(&w1m_data->w1m_mutex); -+ -+ return ret; -+} -+ + #define to_arch_timer(e) container_of(e, struct arch_timer, evt) + + static u32 arch_timer_rate; +@@ -84,33 +90,58 @@ static int __init early_evtstrm_cfg(char *buf) + } + early_param("clocksource.arm_arch_timer.evtstrm", early_evtstrm_cfg); + +/* -+ * W1 triplet callback function - used for searching ROM addresses. -+ * Registered only when controller is in 1-wire mode. ++ * Makes an educated guess at a valid counter width based on the Generic Timer ++ * specification. Of note: ++ * 1) the system counter is at least 56 bits wide ++ * 2) a roll-over time of not less than 40 years ++ * ++ * See 'ARM DDI 0487G.a D11.1.2 ("The system counter")' for more details. + */ -+static u8 phytium_w1_triplet(void *_w1m, u8 bdir) -+{ -+ u8 id_bit, comp_bit; -+ int err; -+ u8 ret = 0x3; /* no slaves responded */ -+ struct w1m_data *w1m_data = _w1m; -+ -+ phytium_w1m_get(_w1m); -+ -+ err = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (err < 0) { -+ dev_err(w1m_data->dev, "Could not acquire mutex\n"); -+ goto rtn; -+ } -+ -+ w1m_data->w1m_irqstatus = 0; -+ /* read id_bit */ -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_RXCOMPLETE, -+ PHY_W1M_INT_EN_RXCOMPLETE); -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); -+ -+ err = wait_event_timeout(w1m_wait_queue, -+ (w1m_data->w1m_irqstatus -+ & PHY_W1M_INT_STATUS_RXCOMPLETE), -+ PHY_W1M_TIMEOUT); -+ if (err == 0) { -+ dev_err(w1m_data->dev, "RX wait elapsed\n"); -+ goto out; -+ } -+ id_bit = (phytium_w1m_read(_w1m, PHY_W1M_DATA_REG) & 0x01); -+ -+ w1m_data->w1m_irqstatus = 0; -+ /* read comp_bit */ -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_RXCOMPLETE, -+ PHY_W1M_INT_EN_RXCOMPLETE); -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); -+ err = wait_event_timeout(w1m_wait_queue, -+ (w1m_data->w1m_irqstatus -+ & PHY_W1M_INT_STATUS_RXCOMPLETE), -+ PHY_W1M_TIMEOUT); -+ if (err == 0) { -+ dev_err(w1m_data->dev, "RX wait elapsed\n"); -+ goto out; -+ } -+ comp_bit = (phytium_w1m_read(_w1m, PHY_W1M_DATA_REG) & 0x01); -+ -+ if (id_bit && comp_bit) { -+ ret = 0x03; /* no slaves responded */ -+ goto out; -+ } -+ if (!id_bit && !comp_bit) { -+ /* Both bits are valid, take the direction given */ -+ ret = bdir ? 0x04 : 0; -+ } else { -+ /* Only one bit is valid, take that direction */ -+ bdir = id_bit; -+ ret = id_bit ? 0x05 : 0x02; -+ } -+ -+ w1m_data->w1m_irqstatus = 0; -+ /* write bdir bit */ -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_TXCOMPLETE, -+ PHY_W1M_INT_EN_TXCOMPLETE); -+ -+ phytium_w1m_write(w1m_data, PHY_W1M_DATA_REG, bdir); -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x35); -+ -+ err = wait_event_timeout(w1m_wait_queue, -+ (w1m_data->w1m_irqstatus -+ & PHY_W1M_INT_STATUS_TXCOMPLETE), -+ PHY_W1M_TIMEOUT); -+ if (err == 0) { -+ dev_err(w1m_data->dev, "TX wait elapsed\n"); -+ goto out; -+ } -+ -+out: -+ mutex_unlock(&w1m_data->w1m_mutex); -+rtn: -+ phytium_w1m_put(_w1m); -+ return ret; -+} -+ -+static u8 phytium_w1_touch_bit(void *_w1m, u8 bit) -+{ -+ u8 result = 0; -+ int err; -+ struct w1m_data *w1m_data = _w1m; -+ -+ phytium_w1m_get(w1m_data); -+ -+ w1m_data->init_trans++; -+ -+ err = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (err < 0) { -+ dev_err(w1m_data->dev, "Could not acquired mutex\n"); -+ goto rtn; -+ } -+ -+ w1m_data->w1m_irqstatus = 0; -+ -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_RXCOMPLETE, -+ PHY_W1M_INT_EN_RXCOMPLETE); -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); -+ -+ err = wait_event_timeout(w1m_wait_queue, -+ (w1m_data->w1m_irqstatus -+ & PHY_W1M_INT_STATUS_RXCOMPLETE), -+ PHY_W1M_TIMEOUT); -+ if (err == 0) { -+ dev_info(w1m_data->dev, "Rx wait elapsed\n"); -+ goto out; -+ } -+ -+ result = (phytium_w1m_read(w1m_data, PHY_W1M_DATA_REG) & 0x01); -+ -+ w1m_data->w1m_irqstatus = 0; -+ -+out: -+ mutex_unlock(&w1m_data->w1m_mutex); -+ -+rtn: -+ phytium_w1m_put(w1m_data); -+ -+ return result; -+} -+ -+/* reset callback */ -+static u8 phytium_w1_reset_bus(void *_w1m) -+{ -+ phytium_w1m_get(_w1m); -+ phytium_w1m_write(_w1m, PHY_W1M_CMD, 0x37); -+ mdelay(1); -+ phytium_w1m_put(_w1m); -+ return 0; -+} -+ -+/* Read a byte of data from the device */ -+static u8 phytium_w1_read_data(void *_w1m, bool is_bit) -+{ -+ struct w1m_data *w1m_data = _w1m; -+ u8 val = 0; -+ int ret; -+ -+ /* First write to initialize the transfer */ -+ if (w1m_data->init_trans == 0) -+ phytium_w1m_get(w1m_data); -+ -+ w1m_data->init_trans++; -+ ret = phytium_read_data(w1m_data, &val, is_bit); -+ if (ret) { -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ dev_err(w1m_data->dev, "Could not acquire mutex\n"); -+ return -EINTR; -+ } -+ w1m_data->init_trans = 0; -+ mutex_unlock(&w1m_data->w1m_mutex); -+ phytium_w1m_put(w1m_data); -+ return -1; -+ } -+ -+ w1m_disable_interrupt(w1m_data, PHY_W1M_INT_EN_B, -+ ~((u32)PHY_W1M_INT_EN_RXCOMPLETE)); -+ -+ /* Write followed by a read, release the module */ -+ if (w1m_data->init_trans) { -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ dev_err(w1m_data->dev, "Could not acquire mutex\n"); -+ return -EINTR; -+ } -+ w1m_data->init_trans = 0; -+ mutex_unlock(&w1m_data->w1m_mutex); -+ phytium_w1m_put(w1m_data); -+ } -+ -+ return val; -+} -+ -+static u8 phytium_w1_read_bit(void *_w1m) -+{ -+ return phytium_w1_read_data(_w1m, true); -+} -+ -+static u8 phytium_w1_read_byte(void *_w1m) -+{ -+ return phytium_w1_read_data(_w1m, false); -+} -+ -+/* Write a byte of data to the device */ -+static void phytium_w1_write_data(void *_w1m, u8 byte, bool is_bit) ++static int arch_counter_get_width(void) +{ -+ struct w1m_data *w1m_data = _w1m; -+ int ret; -+ u8 status; -+ -+ /* First write to initialize the transfer */ -+ if (w1m_data->init_trans == 0) -+ phytium_w1m_get(w1m_data); -+ -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ dev_err(w1m_data->dev, "Could not acquire mutex\n"); -+ return; -+ } -+ mutex_unlock(&w1m_data->w1m_mutex); -+ -+ ret = phytium_write_data(w1m_data, byte, &status, is_bit); -+ if (ret < 0) { -+ dev_err(w1m_data->dev, "TX failure:Ctrl status %x\n", status); -+ return; -+ } ++ u64 min_cycles = MIN_ROLLOVER_SECS * arch_timer_rate; + -+ w1m_data->init_trans++; -+ w1m_disable_interrupt(w1m_data, PHY_W1M_INT_EN_B, -+ ~((u32)PHY_W1M_INT_EN_TXCOMPLETE)); -+ /* Second write, data transferred. Release the module */ -+ if (w1m_data->init_trans > 1) { -+ phytium_w1m_put(w1m_data); -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ dev_err(w1m_data->dev, "Could not acquire mutex\n"); -+ return; -+ } -+ w1m_data->init_trans = 0; -+ mutex_unlock(&w1m_data->w1m_mutex); -+ } ++ /* guarantee the returned width is within the valid range */ ++ return clamp_val(ilog2(min_cycles - 1) + 1, 56, 64); +} + -+static void phytium_w1_write_bit(void *_w1m, u8 bit) -+{ -+ phytium_w1_write_data(_w1m, bit, true); -+} + /* + * Architected system timer support. + */ + + static __always_inline +-void arch_timer_reg_write(int access, enum arch_timer_reg reg, u32 val, ++void arch_timer_reg_write(int access, enum arch_timer_reg reg, u64 val, + struct clock_event_device *clk) + { + if (access == ARCH_TIMER_MEM_PHYS_ACCESS) { + struct arch_timer *timer = to_arch_timer(clk); + switch (reg) { + case ARCH_TIMER_REG_CTRL: +- writel_relaxed(val, timer->base + CNTP_CTL); ++ writel_relaxed((u32)val, timer->base + CNTP_CTL); + break; +- case ARCH_TIMER_REG_TVAL: +- writel_relaxed(val, timer->base + CNTP_TVAL); ++ case ARCH_TIMER_REG_CVAL: ++ /* ++ * Not guaranteed to be atomic, so the timer ++ * must be disabled at this point. ++ */ ++ writeq_relaxed(val, timer->base + CNTP_CVAL_LO); + break; ++ default: ++ BUILD_BUG(); + } + } else if (access == ARCH_TIMER_MEM_VIRT_ACCESS) { + struct arch_timer *timer = to_arch_timer(clk); + switch (reg) { + case ARCH_TIMER_REG_CTRL: +- writel_relaxed(val, timer->base + CNTV_CTL); ++ writel_relaxed((u32)val, timer->base + CNTV_CTL); + break; +- case ARCH_TIMER_REG_TVAL: +- writel_relaxed(val, timer->base + CNTV_TVAL); ++ case ARCH_TIMER_REG_CVAL: ++ /* Same restriction as above */ ++ writeq_relaxed(val, timer->base + CNTV_CVAL_LO); + break; ++ default: ++ BUILD_BUG(); + } + } else { + arch_timer_reg_write_cp15(access, reg, val); +@@ -129,9 +160,8 @@ u32 arch_timer_reg_read(int access, enum arch_timer_reg reg, + case ARCH_TIMER_REG_CTRL: + val = readl_relaxed(timer->base + CNTP_CTL); + break; +- case ARCH_TIMER_REG_TVAL: +- val = readl_relaxed(timer->base + CNTP_TVAL); +- break; ++ default: ++ BUILD_BUG(); + } + } else if (access == ARCH_TIMER_MEM_VIRT_ACCESS) { + struct arch_timer *timer = to_arch_timer(clk); +@@ -139,9 +169,8 @@ u32 arch_timer_reg_read(int access, enum arch_timer_reg reg, + case ARCH_TIMER_REG_CTRL: + val = readl_relaxed(timer->base + CNTV_CTL); + break; +- case ARCH_TIMER_REG_TVAL: +- val = readl_relaxed(timer->base + CNTV_TVAL); +- break; ++ default: ++ BUILD_BUG(); + } + } else { + val = arch_timer_reg_read_cp15(access, reg); +@@ -193,13 +222,11 @@ static struct clocksource clocksource_counter = { + .name = "arch_sys_counter", + .rating = 400, + .read = arch_counter_read, +- .mask = CLOCKSOURCE_MASK(56), + .flags = CLOCK_SOURCE_IS_CONTINUOUS, + }; + + static struct cyclecounter cyclecounter __ro_after_init = { + .read = arch_counter_read_cc, +- .mask = CLOCKSOURCE_MASK(56), + }; + + struct ate_acpi_oem_info { +@@ -227,16 +254,6 @@ struct ate_acpi_oem_info { + _new; \ + }) + +-static u32 notrace fsl_a008585_read_cntp_tval_el0(void) +-{ +- return __fsl_a008585_read_reg(cntp_tval_el0); +-} +- +-static u32 notrace fsl_a008585_read_cntv_tval_el0(void) +-{ +- return __fsl_a008585_read_reg(cntv_tval_el0); +-} +- + static u64 notrace fsl_a008585_read_cntpct_el0(void) + { + return __fsl_a008585_read_reg(cntpct_el0); +@@ -273,16 +290,6 @@ static u64 notrace fsl_a008585_read_cntvct_el0(void) + _new; \ + }) + +-static u32 notrace hisi_161010101_read_cntp_tval_el0(void) +-{ +- return __hisi_161010101_read_reg(cntp_tval_el0); +-} +- +-static u32 notrace hisi_161010101_read_cntv_tval_el0(void) +-{ +- return __hisi_161010101_read_reg(cntv_tval_el0); +-} +- + static u64 notrace hisi_161010101_read_cntpct_el0(void) + { + return __hisi_161010101_read_reg(cntpct_el0); +@@ -367,16 +374,6 @@ static u64 notrace sun50i_a64_read_cntvct_el0(void) + { + return __sun50i_a64_read_reg(cntvct_el0); + } +- +-static u32 notrace sun50i_a64_read_cntp_tval_el0(void) +-{ +- return read_sysreg(cntp_cval_el0) - sun50i_a64_read_cntpct_el0(); +-} +- +-static u32 notrace sun50i_a64_read_cntv_tval_el0(void) +-{ +- return read_sysreg(cntv_cval_el0) - sun50i_a64_read_cntvct_el0(); +-} + #endif + + #ifdef CONFIG_ARM_ARCH_TIMER_OOL_WORKAROUND +@@ -385,7 +382,7 @@ EXPORT_SYMBOL_GPL(timer_unstable_counter_workaround); + + static atomic_t timer_unstable_counter_workaround_in_use = ATOMIC_INIT(0); + +-static void erratum_set_next_event_tval_generic(const int access, unsigned long evt, ++static void erratum_set_next_event_generic(const int access, unsigned long evt, + struct clock_event_device *clk) + { + unsigned long ctrl; +@@ -406,17 +403,17 @@ static void erratum_set_next_event_tval_generic(const int access, unsigned long + arch_timer_reg_write(access, ARCH_TIMER_REG_CTRL, ctrl, clk); + } + +-static __maybe_unused int erratum_set_next_event_tval_virt(unsigned long evt, ++static __maybe_unused int erratum_set_next_event_virt(unsigned long evt, + struct clock_event_device *clk) + { +- erratum_set_next_event_tval_generic(ARCH_TIMER_VIRT_ACCESS, evt, clk); ++ erratum_set_next_event_generic(ARCH_TIMER_VIRT_ACCESS, evt, clk); + return 0; + } + +-static __maybe_unused int erratum_set_next_event_tval_phys(unsigned long evt, ++static __maybe_unused int erratum_set_next_event_phys(unsigned long evt, + struct clock_event_device *clk) + { +- erratum_set_next_event_tval_generic(ARCH_TIMER_PHYS_ACCESS, evt, clk); ++ erratum_set_next_event_generic(ARCH_TIMER_PHYS_ACCESS, evt, clk); + return 0; + } + +@@ -426,12 +423,10 @@ static const struct arch_timer_erratum_workaround ool_workarounds[] = { + .match_type = ate_match_dt, + .id = "fsl,erratum-a008585", + .desc = "Freescale erratum a005858", +- .read_cntp_tval_el0 = fsl_a008585_read_cntp_tval_el0, +- .read_cntv_tval_el0 = fsl_a008585_read_cntv_tval_el0, + .read_cntpct_el0 = fsl_a008585_read_cntpct_el0, + .read_cntvct_el0 = fsl_a008585_read_cntvct_el0, +- .set_next_event_phys = erratum_set_next_event_tval_phys, +- .set_next_event_virt = erratum_set_next_event_tval_virt, ++ .set_next_event_phys = erratum_set_next_event_phys, ++ .set_next_event_virt = erratum_set_next_event_virt, + }, + #endif + #ifdef CONFIG_HISILICON_ERRATUM_161010101 +@@ -439,23 +434,19 @@ static const struct arch_timer_erratum_workaround ool_workarounds[] = { + .match_type = ate_match_dt, + .id = "hisilicon,erratum-161010101", + .desc = "HiSilicon erratum 161010101", +- .read_cntp_tval_el0 = hisi_161010101_read_cntp_tval_el0, +- .read_cntv_tval_el0 = hisi_161010101_read_cntv_tval_el0, + .read_cntpct_el0 = hisi_161010101_read_cntpct_el0, + .read_cntvct_el0 = hisi_161010101_read_cntvct_el0, +- .set_next_event_phys = erratum_set_next_event_tval_phys, +- .set_next_event_virt = erratum_set_next_event_tval_virt, ++ .set_next_event_phys = erratum_set_next_event_phys, ++ .set_next_event_virt = erratum_set_next_event_virt, + }, + { + .match_type = ate_match_acpi_oem_info, + .id = hisi_161010101_oem_info, + .desc = "HiSilicon erratum 161010101", +- .read_cntp_tval_el0 = hisi_161010101_read_cntp_tval_el0, +- .read_cntv_tval_el0 = hisi_161010101_read_cntv_tval_el0, + .read_cntpct_el0 = hisi_161010101_read_cntpct_el0, + .read_cntvct_el0 = hisi_161010101_read_cntvct_el0, +- .set_next_event_phys = erratum_set_next_event_tval_phys, +- .set_next_event_virt = erratum_set_next_event_tval_virt, ++ .set_next_event_phys = erratum_set_next_event_phys, ++ .set_next_event_virt = erratum_set_next_event_virt, + }, + #endif + #ifdef CONFIG_ARM64_ERRATUM_858921 +@@ -472,12 +463,10 @@ static const struct arch_timer_erratum_workaround ool_workarounds[] = { + .match_type = ate_match_dt, + .id = "allwinner,erratum-unknown1", + .desc = "Allwinner erratum UNKNOWN1", +- .read_cntp_tval_el0 = sun50i_a64_read_cntp_tval_el0, +- .read_cntv_tval_el0 = sun50i_a64_read_cntv_tval_el0, + .read_cntpct_el0 = sun50i_a64_read_cntpct_el0, + .read_cntvct_el0 = sun50i_a64_read_cntvct_el0, +- .set_next_event_phys = erratum_set_next_event_tval_phys, +- .set_next_event_virt = erratum_set_next_event_tval_virt, ++ .set_next_event_phys = erratum_set_next_event_phys, ++ .set_next_event_virt = erratum_set_next_event_virt, + }, + #endif + #ifdef CONFIG_ARM64_ERRATUM_1418040 +@@ -715,10 +704,18 @@ static __always_inline void set_next_event(const int access, unsigned long evt, + struct clock_event_device *clk) + { + unsigned long ctrl; ++ u64 cnt; + -+static void phytium_w1_write_byte(void *_w1m, u8 bit) -+{ -+ phytium_w1_write_data(_w1m, bit, false); -+} + ctrl = arch_timer_reg_read(access, ARCH_TIMER_REG_CTRL, clk); + ctrl |= ARCH_TIMER_CTRL_ENABLE; + ctrl &= ~ARCH_TIMER_CTRL_IT_MASK; +- arch_timer_reg_write(access, ARCH_TIMER_REG_TVAL, evt, clk); + -+static struct w1_bus_master phytium_w1_master = { -+ .read_byte = phytium_w1_read_byte, -+ .write_byte = phytium_w1_write_byte, -+ .read_bit = phytium_w1_read_bit, -+ .write_bit = phytium_w1_write_bit, -+ .reset_bus = phytium_w1_reset_bus, -+ .touch_bit = phytium_w1_touch_bit, -+}; ++ if (access == ARCH_TIMER_PHYS_ACCESS) ++ cnt = __arch_counter_get_cntpct(); ++ else ++ cnt = __arch_counter_get_cntvct(); + -+static int phytium_w1m_probe(struct platform_device *pdev) ++ arch_timer_reg_write(access, ARCH_TIMER_REG_CVAL, evt + cnt, clk); + arch_timer_reg_write(access, ARCH_TIMER_REG_CTRL, ctrl, clk); + } + +@@ -736,23 +733,79 @@ static int arch_timer_set_next_event_phys(unsigned long evt, + return 0; + } + ++static u64 arch_counter_get_cnt_mem(struct arch_timer *t, int offset_lo) +{ -+ struct device *dev = &pdev->dev; -+ struct w1m_data *w1m_data; -+ struct resource *res; -+ int ret, irq; -+ -+ w1m_data = devm_kzalloc(dev, sizeof(*w1m_data), GFP_KERNEL); -+ if (!w1m_data) -+ return -ENOMEM; -+ -+ w1m_data->dev = dev; -+ platform_set_drvdata(pdev, w1m_data); -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ w1m_data->w1m_base = devm_ioremap_resource(dev, res); -+ if (IS_ERR(w1m_data->w1m_base)) -+ return PTR_ERR(w1m_data->w1m_base); -+ -+ w1m_data->w1m_usecount = 0; -+ mutex_init(&w1m_data->w1m_mutex); -+ -+ pm_runtime_enable(&pdev->dev); -+ ret = pm_runtime_get_sync(&pdev->dev); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "pm_runtime_get_sync failed\n"); -+ goto err_w1; -+ } -+ -+ spin_lock_init(&w1m_data->w1m_spinlock); -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) { -+ dev_err(&pdev->dev, "Failed to get IRQ: %d\n", irq); -+ ret = irq; -+ goto err_irq; -+ } -+ -+ ret = devm_request_irq(dev, irq, w1m_isr, 0, "phytium-w1", w1m_data); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "could not request irq\n"); -+ goto err_irq; -+ } -+ -+ pm_runtime_put_sync(&pdev->dev); -+ -+ phytium_w1_master.triplet = phytium_w1_triplet; -+ phytium_w1m_write(w1m_data, PHY_W1M_CTL, 0x10); -+ phytium_w1m_write(w1m_data, PHY_W1M_INT_EN_B, 0x00); -+ -+ phytium_w1_master.data = w1m_data; -+ -+ ret = w1_add_master_device(&phytium_w1_master); -+ if (ret) { -+ dev_err(&pdev->dev, "Failure in registering w1 master\n"); -+ goto err_w1; -+ } -+ -+ return 0; ++ u32 cnt_lo, cnt_hi, tmp_hi; + -+err_irq: -+ pm_runtime_put_sync(&pdev->dev); -+err_w1: -+ pm_runtime_disable(&pdev->dev); ++ do { ++ cnt_hi = readl_relaxed(t->base + offset_lo + 4); ++ cnt_lo = readl_relaxed(t->base + offset_lo); ++ tmp_hi = readl_relaxed(t->base + offset_lo + 4); ++ } while (cnt_hi != tmp_hi); + -+ return ret; ++ return ((u64) cnt_hi << 32) | cnt_lo; +} + -+static int phytium_w1m_remove(struct platform_device *pdev) ++static __always_inline void set_next_event_mem(const int access, unsigned long evt, ++ struct clock_event_device *clk) +{ -+ struct w1m_data *w1m_data = platform_get_drvdata(pdev); -+ -+ mutex_lock(&w1m_data->w1m_mutex); -+ -+ if (w1m_data->w1m_usecount) { -+ dev_warn(&pdev->dev, "removed when use count is not zero\n"); -+ mutex_unlock(&w1m_data->w1m_mutex); -+ return -EBUSY; -+ } ++ struct arch_timer *timer = to_arch_timer(clk); ++ unsigned long ctrl; ++ u64 cnt; + -+ mutex_unlock(&w1m_data->w1m_mutex); ++ ctrl = arch_timer_reg_read(access, ARCH_TIMER_REG_CTRL, clk); ++ ctrl |= ARCH_TIMER_CTRL_ENABLE; ++ ctrl &= ~ARCH_TIMER_CTRL_IT_MASK; + -+ /* remove module dependency */ -+ pm_runtime_disable(&pdev->dev); ++ if (access == ARCH_TIMER_MEM_VIRT_ACCESS) ++ cnt = arch_counter_get_cnt_mem(timer, CNTVCT_LO); ++ else ++ cnt = arch_counter_get_cnt_mem(timer, CNTPCT_LO); + -+ return 0; ++ arch_timer_reg_write(access, ARCH_TIMER_REG_CVAL, evt + cnt, clk); ++ arch_timer_reg_write(access, ARCH_TIMER_REG_CTRL, ctrl, clk); +} + -+static const struct of_device_id phytium_w1m_dt_ids[] = { -+ { .compatible = "phytium,w1" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_w1m_dt_ids); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_w1m_acpi_ids[] = { -+ { "PHYT0034", 0 }, -+ { } -+}; -+#endif -+ -+static struct platform_driver phytium_w1m_driver = { -+ .probe = phytium_w1m_probe, -+ .remove = phytium_w1m_remove, -+ .driver = { -+ .name = "phytium-w1", -+ .of_match_table = phytium_w1m_dt_ids, -+ .acpi_match_table = ACPI_PTR(phytium_w1m_acpi_ids), -+ }, -+}; -+module_platform_driver(phytium_w1m_driver); -+ -+MODULE_AUTHOR("Zhu Mingshuai "); -+MODULE_DESCRIPTION("Phytium w1 bus master driver"); -+MODULE_LICENSE("GPL"); -diff --git a/include/acpi/acpi_drivers.h b/include/acpi/acpi_drivers.h -index 5eb175933..dbdcd2f51 100644 ---- a/include/acpi/acpi_drivers.h -+++ b/include/acpi/acpi_drivers.h -@@ -68,7 +68,7 @@ - - int acpi_irq_penalty_init(void); - int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, -- int *polarity, char **name); -+ int *polarity, char **name, struct fwnode_handle **rs_fwnode); - int acpi_pci_link_free_irq(acpi_handle handle); - - /* ACPI PCI Device Binding (pci_bind.c) */ -diff --git a/include/clocksource/arm_arch_timer.h b/include/clocksource/arm_arch_timer.h -index 1d68d5613..6b085710e 100644 ---- a/include/clocksource/arm_arch_timer.h -+++ b/include/clocksource/arm_arch_timer.h -@@ -24,7 +24,7 @@ - - enum arch_timer_reg { - ARCH_TIMER_REG_CTRL, -- ARCH_TIMER_REG_TVAL, -+ ARCH_TIMER_REG_CVAL, - }; + static int arch_timer_set_next_event_virt_mem(unsigned long evt, + struct clock_event_device *clk) + { +- set_next_event(ARCH_TIMER_MEM_VIRT_ACCESS, evt, clk); ++ set_next_event_mem(ARCH_TIMER_MEM_VIRT_ACCESS, evt, clk); + return 0; + } - enum arch_timer_ppi_nr { -diff --git a/include/linux/acpi.h b/include/linux/acpi.h -index 9c184dbce..5692707e0 100644 ---- a/include/linux/acpi.h -+++ b/include/linux/acpi.h -@@ -340,6 +340,16 @@ struct irq_domain *acpi_irq_create_hierarchy(unsigned int flags, - const struct irq_domain_ops *ops, - void *host_data); + static int arch_timer_set_next_event_phys_mem(unsigned long evt, + struct clock_event_device *clk) + { +- set_next_event(ARCH_TIMER_MEM_PHYS_ACCESS, evt, clk); ++ set_next_event_mem(ARCH_TIMER_MEM_PHYS_ACCESS, evt, clk); + return 0; + } -+#ifdef CONFIG_ACPI_GENERIC_GSI -+struct fwnode_handle *acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source); -+#else -+static inline -+struct fwnode_handle *acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source) ++static u64 __arch_timer_check_delta(void) +{ -+ return NULL; -+} ++#ifdef CONFIG_ARM64 ++ const struct midr_range broken_cval_midrs[] = { ++ /* ++ * XGene-1 implements CVAL in terms of TVAL, meaning ++ * that the maximum timer range is 32bit. Shame on them. ++ */ ++ MIDR_ALL_VERSIONS(MIDR_CPU_MODEL(ARM_CPU_IMP_APM, ++ APM_CPU_PART_POTENZA)), ++ {}, ++ }; ++ ++ if (is_midr_in_range_list(read_cpuid_id(), broken_cval_midrs)) { ++ pr_warn_once("Broken CNTx_CVAL_EL1, limiting width to 32bits"); ++ return CLOCKSOURCE_MASK(32); ++ } +#endif ++ return CLOCKSOURCE_MASK(arch_counter_get_width()); ++} + - #ifdef CONFIG_X86_IO_APIC - extern int acpi_get_override_irq(u32 gsi, int *trigger, int *polarity); - #else -diff --git a/include/linux/cpuhotplug.h b/include/linux/cpuhotplug.h -index 088c835ac..fff4c30ba 100644 ---- a/include/linux/cpuhotplug.h -+++ b/include/linux/cpuhotplug.h -@@ -198,6 +198,7 @@ enum cpuhp_state { - CPUHP_AP_ONLINE_DYN_END = CPUHP_AP_ONLINE_DYN + 30, - CPUHP_AP_X86_HPET_ONLINE, - CPUHP_AP_X86_KVM_CLK_ONLINE, -+ CPUHP_AP_HOMO_RPROC_STARTING, - CPUHP_AP_ACTIVE, - CPUHP_ONLINE, - }; -diff --git a/include/linux/pci_ids.h b/include/linux/pci_ids.h -index 1a41147b2..62c6786ce 100644 ---- a/include/linux/pci_ids.h -+++ b/include/linux/pci_ids.h -@@ -3141,4 +3141,6 @@ + static void __arch_timer_setup(unsigned type, + struct clock_event_device *clk) + { ++ u64 max_delta; ++ + clk->features = CLOCK_EVT_FEAT_ONESHOT; - #define PCI_VENDOR_ID_NCUBE 0x10ff + if (type == ARCH_TIMER_TYPE_CP15) { +@@ -784,6 +837,7 @@ static void __arch_timer_setup(unsigned type, + } -+#define PCI_VENDOR_ID_PHYTIUM 0x1db7 + clk->set_next_event = sne; ++ max_delta = __arch_timer_check_delta(); + } else { + clk->features |= CLOCK_EVT_FEAT_DYNIRQ; + clk->name = "arch_mem_timer"; +@@ -800,11 +854,13 @@ static void __arch_timer_setup(unsigned type, + clk->set_next_event = + arch_timer_set_next_event_phys_mem; + } + - #endif /* _LINUX_PCI_IDS_H */ -diff --git a/include/linux/phy.h b/include/linux/phy.h -old mode 100644 -new mode 100755 -index 08725a262..0336cb22b ---- a/include/linux/phy.h -+++ b/include/linux/phy.h -@@ -106,6 +106,7 @@ extern const int phy_10gbit_features_array[1]; - * @PHY_INTERFACE_MODE_TRGMII: Turbo RGMII - * @PHY_INTERFACE_MODE_1000BASEX: 1000 BaseX - * @PHY_INTERFACE_MODE_2500BASEX: 2500 BaseX -+ * @PHY_INTERFACE_MODE_5GBASER: 5G BaseR - * @PHY_INTERFACE_MODE_RXAUI: Reduced XAUI - * @PHY_INTERFACE_MODE_XAUI: 10 Gigabit Attachment Unit Interface - * @PHY_INTERFACE_MODE_10GBASER: 10G BaseR -@@ -137,6 +138,7 @@ typedef enum { - PHY_INTERFACE_MODE_TRGMII, - PHY_INTERFACE_MODE_1000BASEX, - PHY_INTERFACE_MODE_2500BASEX, -+ PHY_INTERFACE_MODE_5GBASER, - PHY_INTERFACE_MODE_RXAUI, - PHY_INTERFACE_MODE_XAUI, - /* 10GBASE-R, XFI, SFI - single lane 10G Serdes */ -@@ -207,6 +209,8 @@ static inline const char *phy_modes(phy_interface_t interface) - return "1000base-x"; - case PHY_INTERFACE_MODE_2500BASEX: - return "2500base-x"; -+ case PHY_INTERFACE_MODE_5GBASER: -+ return "5gbase-r"; - case PHY_INTERFACE_MODE_RXAUI: - return "rxaui"; - case PHY_INTERFACE_MODE_XAUI: -@@ -545,7 +549,7 @@ struct phy_device { - struct phy_driver *drv; ++ max_delta = CLOCKSOURCE_MASK(56); + } - u32 phy_id; -- -+ u32 force_mode; - struct phy_c45_device_ids c45_ids; - unsigned is_c45:1; - unsigned is_internal:1; -diff --git a/include/sound/hdaudio.h b/include/sound/hdaudio.h -index 496decb63..febaa698e 100644 ---- a/include/sound/hdaudio.h -+++ b/include/sound/hdaudio.h -@@ -340,6 +340,7 @@ struct hdac_bus { - bool align_bdle_4k:1; /* BDLE align 4K boundary */ - bool reverse_assign:1; /* assign devices in reverse order */ - bool corbrp_self_clear:1; /* CORBRP clears itself after reset */ -+ bool cmd_resend:1; /* command resend */ - bool polling_mode:1; - bool needs_damn_long_delay:1; + clk->set_state_shutdown(clk); -diff --git a/include/uapi/linux/serial_core.h b/include/uapi/linux/serial_core.h -index 851b982f8..f08747fd2 100644 ---- a/include/uapi/linux/serial_core.h -+++ b/include/uapi/linux/serial_core.h -@@ -279,4 +279,11 @@ - /* Freescale LINFlexD UART */ - #define PORT_LINFLEXUART 122 +- clockevents_config_and_register(clk, arch_timer_rate, 0xf, 0x7fffffff); ++ clockevents_config_and_register(clk, arch_timer_rate, 0xf, max_delta); + } -+ -+/* Phytium PCI UART -+ * use bigger value to aviod code confilct -+ * when update in the future. -+ */ -+#define PORT_PHYTIUM 200 -+ - #endif /* _UAPILINUX_SERIAL_CORE_H */ -diff --git a/sound/hda/hdac_controller.c b/sound/hda/hdac_controller.c -index 522d18976..a019ad892 100644 ---- a/sound/hda/hdac_controller.c -+++ b/sound/hda/hdac_controller.c -@@ -143,6 +143,9 @@ int snd_hdac_bus_send_cmd(struct hdac_bus *bus, unsigned int val) + static void arch_timer_evtstrm_enable(int divider) +@@ -974,15 +1030,7 @@ bool arch_timer_evtstrm_available(void) + + static u64 arch_counter_get_cntvct_mem(void) { - unsigned int addr = azx_command_addr(val); - unsigned int wp, rp; -+ unsigned long timeout; -+ unsigned int rirb_wp; -+ int i = 0; +- u32 vct_lo, vct_hi, tmp_hi; +- +- do { +- vct_hi = readl_relaxed(arch_counter_base + CNTVCT_HI); +- vct_lo = readl_relaxed(arch_counter_base + CNTVCT_LO); +- tmp_hi = readl_relaxed(arch_counter_base + CNTVCT_HI); +- } while (vct_hi != tmp_hi); +- +- return ((u64) vct_hi << 32) | vct_lo; ++ return arch_counter_get_cnt_mem(arch_timer_mem, CNTVCT_LO); + } - spin_lock_irq(&bus->reg_lock); + static struct arch_timer_kvm_info arch_timer_kvm_info; +@@ -995,6 +1043,7 @@ struct arch_timer_kvm_info *arch_timer_get_kvm_info(void) + static void __init arch_counter_register(unsigned type) + { + u64 start_count; ++ int width; -@@ -169,6 +172,42 @@ int snd_hdac_bus_send_cmd(struct hdac_bus *bus, unsigned int val) - bus->corb.buf[wp] = cpu_to_le32(val); - snd_hdac_chip_writew(bus, CORBWP, wp); + /* Register the CP15 based counter if we have one */ + if (type & ARCH_TIMER_TYPE_CP15) { +@@ -1019,6 +1068,10 @@ static void __init arch_counter_register(unsigned type) + arch_timer_read_counter = arch_counter_get_cntvct_mem; + } -+ if (bus->cmd_resend) { -+ timeout = jiffies + msecs_to_jiffies(1000); -+ udelay(80); -+ rirb_wp = snd_hdac_chip_readw(bus, RIRBWP); -+ while (rirb_wp == bus->rirb.wp) { -+ udelay(80); -+ rirb_wp = snd_hdac_chip_readw(bus, RIRBWP); -+ if (rirb_wp != bus->rirb.wp) -+ break; -+ if (i > 5) -+ break; -+ if (time_after(jiffies, timeout)) -+ break; -+ -+ /* add command to corb */ -+ wp = snd_hdac_chip_readw(bus, CORBWP); -+ if (wp == 0xffff) { -+ /* something wrong, controller likely turned to D3 */ -+ spin_unlock_irq(&bus->reg_lock); -+ return -EIO; -+ } -+ wp++; -+ wp %= AZX_MAX_CORB_ENTRIES; -+ -+ rp = snd_hdac_chip_readw(bus, CORBRP); -+ if (wp == rp) { -+ /* oops, it's full */ -+ spin_unlock_irq(&bus->reg_lock); -+ return -EAGAIN; -+ } -+ bus->corb.buf[wp] = cpu_to_le32(val); -+ snd_hdac_chip_writew(bus, CORBWP, wp); -+ i++; -+ } -+ } ++ width = arch_counter_get_width(); ++ clocksource_counter.mask = CLOCKSOURCE_MASK(width); ++ cyclecounter.mask = CLOCKSOURCE_MASK(width); + - spin_unlock_irq(&bus->reg_lock); - - return 0; -diff --git a/sound/hda/hdac_stream.c b/sound/hda/hdac_stream.c -index 557072245..84d5a9ca6 100644 ---- a/sound/hda/hdac_stream.c -+++ b/sound/hda/hdac_stream.c -@@ -87,7 +87,11 @@ void snd_hdac_stream_start(struct hdac_stream *azx_dev, bool fresh_start) - - trace_snd_hdac_stream_start(bus, azx_dev); + if (!arch_counter_suspend_stop) + clocksource_counter.flags |= CLOCK_SOURCE_SUSPEND_NONSTOP; + start_count = arch_timer_read_counter(); +@@ -1028,8 +1081,7 @@ static void __init arch_counter_register(unsigned type) + timecounter_init(&arch_timer_kvm_info.timecounter, + &cyclecounter, start_count); -+#ifdef CONFIG_SND_HDA_PHYTIUM -+ azx_dev->start_wallclk = snd_hdac_chip_readl(bus, WALLCLK) / 15; -+#else - azx_dev->start_wallclk = snd_hdac_chip_readl(bus, WALLCLK); -+#endif - if (!fresh_start) - azx_dev->start_wallclk -= azx_dev->period_wallclk; +- /* 56 bits minimum, so we assume worst case rollover */ +- sched_clock_register(arch_timer_read_counter, 56, arch_timer_rate); ++ sched_clock_register(arch_timer_read_counter, width, arch_timer_rate); + } -@@ -550,7 +554,11 @@ static u64 azx_cc_read(const struct cyclecounter *cc) + static void arch_timer_stop(struct clock_event_device *clk) +@@ -1170,25 +1222,25 @@ static int __init arch_timer_mem_register(void __iomem *base, unsigned int irq) { - struct hdac_stream *azx_dev = container_of(cc, struct hdac_stream, cc); - -+#ifdef CONFIG_SND_HDA_PHYTIUM -+ return snd_hdac_chip_readl(azx_dev->bus, WALLCLK) / 25; -+#else - return snd_hdac_chip_readl(azx_dev->bus, WALLCLK); -+#endif - } + int ret; + irq_handler_t func; +- struct arch_timer *t; - static void azx_timecounter_init(struct hdac_stream *azx_dev, -diff --git a/sound/pci/hda/Kconfig b/sound/pci/hda/Kconfig -index 90759391c..9cfaaa649 100644 ---- a/sound/pci/hda/Kconfig -+++ b/sound/pci/hda/Kconfig -@@ -26,6 +26,22 @@ config SND_HDA_INTEL - To compile this driver as a module, choose M here: the module - will be called snd-hda-intel. +- t = kzalloc(sizeof(*t), GFP_KERNEL); +- if (!t) ++ arch_timer_mem = kzalloc(sizeof(*arch_timer_mem), GFP_KERNEL); ++ if (!arch_timer_mem) + return -ENOMEM; -+config SND_HDA_PHYTIUM -+ tristate "PHYTIUM HD Audio" -+ depends on SOUND -+ select SND_HDA -+ select SND_HDA_ALIGNED_MMIO -+ help -+ Say Y here to support the HDA controller present in PHYTIUM -+ SoCs -+ -+ This options enables support for the HD Audio controller -+ present in some PHYTIUM SoCs, used to communicate audio -+ to the "High Definition Audio" codec. -+ -+ To compile this driver as a module, choose M here: the module -+ will be called snd-hda-phytium. -+ - config SND_HDA_TEGRA - tristate "NVIDIA Tegra HD Audio" - depends on ARCH_TEGRA -diff --git a/sound/pci/hda/Makefile b/sound/pci/hda/Makefile -index b57432f00..448ab7de3 100644 ---- a/sound/pci/hda/Makefile -+++ b/sound/pci/hda/Makefile -@@ -1,6 +1,7 @@ - # SPDX-License-Identifier: GPL-2.0 - snd-hda-intel-objs := hda_intel.o - snd-hda-tegra-objs := hda_tegra.o -+snd-hda-phytium-objs := hda_phytium.o +- t->base = base; +- t->evt.irq = irq; +- __arch_timer_setup(ARCH_TIMER_TYPE_MEM, &t->evt); ++ arch_timer_mem->base = base; ++ arch_timer_mem->evt.irq = irq; ++ __arch_timer_setup(ARCH_TIMER_TYPE_MEM, &arch_timer_mem->evt); - snd-hda-codec-y := hda_bind.o hda_codec.o hda_jack.o hda_auto_parser.o hda_sysfs.o - snd-hda-codec-y += hda_controller.o -@@ -48,3 +49,4 @@ obj-$(CONFIG_SND_HDA_CODEC_HDMI) += snd-hda-codec-hdmi.o - # when built in kernel - obj-$(CONFIG_SND_HDA_INTEL) += snd-hda-intel.o - obj-$(CONFIG_SND_HDA_TEGRA) += snd-hda-tegra.o -+obj-$(CONFIG_SND_HDA_PHYTIUM) += snd-hda-phytium.o -diff --git a/sound/pci/hda/hda_controller.c b/sound/pci/hda/hda_controller.c -index ea76395d7..9bc0b6e24 100644 ---- a/sound/pci/hda/hda_controller.c -+++ b/sound/pci/hda/hda_controller.c -@@ -17,6 +17,8 @@ - #include - #include + if (arch_timer_mem_use_virtual) + func = arch_timer_handler_virt_mem; + else + func = arch_timer_handler_phys_mem; -+#include "hda_phytium.h" -+ - #ifdef CONFIG_X86 - /* for art-tsc conversion */ - #include -@@ -157,6 +159,10 @@ static int azx_pcm_prepare(struct snd_pcm_substream *substream) - snd_hda_spdif_out_of_nid(apcm->codec, hinfo->nid); - unsigned short ctls = spdif ? spdif->ctls : 0; +- ret = request_irq(irq, func, IRQF_TIMER, "arch_mem_timer", &t->evt); ++ ret = request_irq(irq, func, IRQF_TIMER, "arch_mem_timer", &arch_timer_mem->evt); + if (ret) { + pr_err("Failed to request mem timer irq\n"); +- kfree(t); ++ kfree(arch_timer_mem); ++ arch_timer_mem = NULL; + } -+ struct hda_ft *hda; -+ hda = container_of(chip, struct hda_ft, chip); -+ hda->substream = substream; -+ - trace_azx_pcm_prepare(chip, azx_dev); - dsp_lock(azx_dev); - if (dsp_is_locked(azx_dev)) { -diff --git a/sound/pci/hda/hda_phytium.c b/sound/pci/hda/hda_phytium.c -new file mode 100644 -index 000000000..aead6f079 ---- /dev/null -+++ b/sound/pci/hda/hda_phytium.c -@@ -0,0 +1,1125 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Implementation of primary ALSA driver code for Phytium HD Audio. -+ * -+ * Copyright (c) 2018-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#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 "hda_controller.h" -+#include "hda_phytium.h" -+ -+#include "hda_intel_trace.h" -+ -+/* position fix mode */ -+enum { -+ POS_FIX_AUTO, -+ POS_FIX_LPIB, -+ POS_FIX_POSBUF, -+ POS_FIX_VIACOMBO, -+ POS_FIX_COMBO, -+}; -+ -+/* Define IN stream 0 FIFO size offset in VIA controller */ -+#define VIA_IN_STREAM0_FIFO_SIZE_OFFSET 0x90 -+ -+/* FT have 4 playback and 4 capture */ -+#define FT4C_NUM_CAPTURE 4 -+#define FT4C_NUM_PLAYBACK 4 -+ -+#define DWORD_BYTE_WIDTH 4 -+#define BYTE_BIT_WIDTH 8 -+ -+static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; -+static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; -+static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; -+static char *model[SNDRV_CARDS]; -+static int position_fix[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = 1}; -+static int bdl_pos_adj[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = -1}; -+static int probe_mask[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = -1}; -+static int probe_only[SNDRV_CARDS]; -+static int jackpoll_ms[SNDRV_CARDS]; -+static int single_cmd = -1; -+static int enable_msi = -1; -+#ifdef CONFIG_SND_HDA_INPUT_BEEP -+static bool beep_mode[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = -+ CONFIG_SND_HDA_INPUT_BEEP_MODE}; -+#endif -+ -+module_param_array(index, int, NULL, 0444); -+MODULE_PARM_DESC(index, "Index value for Intel HD audio interface."); -+module_param_array(id, charp, NULL, 0444); -+MODULE_PARM_DESC(id, "ID string for Intel HD audio interface."); -+module_param_array(enable, bool, NULL, 0444); -+MODULE_PARM_DESC(enable, "Enable Intel HD audio interface."); -+module_param_array(model, charp, NULL, 0444); -+MODULE_PARM_DESC(model, "Use the given board model."); -+module_param_array(position_fix, int, NULL, 0444); -+MODULE_PARM_DESC(position_fix, "DMA pointer read method. (-1 = system default, 0 = auto, 1 = LPIB, 2 = POSBUF, 3 = VIACOMBO, 4 = COMBO)."); -+module_param_array(bdl_pos_adj, int, NULL, 0644); -+MODULE_PARM_DESC(bdl_pos_adj, "BDL position adjustment offset."); -+module_param_array(probe_mask, int, NULL, 0444); -+MODULE_PARM_DESC(probe_mask, "Bitmask to probe codecs (default = -1)."); -+module_param_array(probe_only, int, NULL, 0444); -+MODULE_PARM_DESC(probe_only, "Only probing and no codec initialization."); -+module_param_array(jackpoll_ms, int, NULL, 0444); -+MODULE_PARM_DESC(jackpoll_ms, "Ms between polling for jack events (default = 0, using unsol events only)"); -+module_param(single_cmd, bint, 0444); -+MODULE_PARM_DESC(single_cmd, "Use single command to communicate with codecs (for debugging only)."); -+module_param(enable_msi, bint, 0444); -+MODULE_PARM_DESC(enable_msi, "Enable Message Signaled Interrupt (MSI)"); -+#ifdef CONFIG_SND_HDA_INPUT_BEEP -+module_param_array(beep_mode, bool, NULL, 0444); -+MODULE_PARM_DESC(beep_mode, "Select HDA Beep registration mode (0=off, 1=on) (default=1)."); -+#endif -+ -+#define power_save 0 -+ -+static int align_buffer_size = -1; -+module_param(align_buffer_size, bint, 0644); -+MODULE_PARM_DESC(align_buffer_size, -+ "Force buffer and period sizes to be multiple of 128 bytes."); -+ -+/* driver types */ -+enum { -+ AZX_DRIVER_ICH, -+ AZX_DRIVER_PCH, -+ AZX_DRIVER_SCH, -+ AZX_DRIVER_HDMI, -+ AZX_DRIVER_ATI, -+ AZX_DRIVER_ATIHDMI, -+ AZX_DRIVER_ATIHDMI_NS, -+ AZX_DRIVER_VIA, -+ AZX_DRIVER_SIS, -+ AZX_DRIVER_ULI, -+ AZX_DRIVER_NVIDIA, -+ AZX_DRIVER_TERA, -+ AZX_DRIVER_CTX, -+ AZX_DRIVER_CTHDA, -+ AZX_DRIVER_CMEDIA, -+ AZX_DRIVER_GENERIC, -+ AZX_DRIVER_FT, -+ AZX_NUM_DRIVERS, /* keep this as last entry */ -+}; -+ -+/* NOP for other archs */ -+static inline void mark_pages_wc(struct azx *chip, struct snd_dma_buffer *buf, -+ bool on) -+{ -+} -+ -+static inline void mark_runtime_wc(struct azx *chip, struct azx_dev *azx_dev, -+ struct snd_pcm_substream *substream, bool on) -+{ -+} -+ -+static int azx_acquire_irq(struct azx *chip, int do_disconnect); -+ -+/* calculate runtime delay from LPIB */ -+static int azx_get_delay_from_lpib(struct azx *chip, struct azx_dev *azx_dev, -+ unsigned int pos) -+{ -+ struct snd_pcm_substream *substream = azx_dev->core.substream; -+ int stream = substream->stream; -+ unsigned int lpib_pos = azx_get_pos_lpib(chip, azx_dev); -+ int delay; -+ -+ if (stream == SNDRV_PCM_STREAM_PLAYBACK) -+ delay = pos - lpib_pos; -+ else -+ delay = lpib_pos - pos; -+ if (delay < 0) { -+ if (delay >= azx_dev->core.delay_negative_threshold) -+ delay = 0; -+ else -+ delay += azx_dev->core.bufsize; -+ } -+ -+ if (delay >= azx_dev->core.period_bytes) { -+ dev_info(chip->card->dev, -+ "Unstable LPIB (%d >= %d); disabling LPIB delay counting\n", -+ delay, azx_dev->core.period_bytes); -+ delay = 0; -+ chip->driver_caps &= ~AZX_DCAPS_COUNT_LPIB_DELAY; -+ chip->get_delay[stream] = NULL; -+ } -+ -+ return bytes_to_frames(substream->runtime, delay); -+} -+ -+static int azx_position_ok(struct azx *chip, struct azx_dev *azx_dev); -+ -+/* called from IRQ */ -+static int azx_position_check(struct azx *chip, struct azx_dev *azx_dev) -+{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ int ok; -+ -+ ok = azx_position_ok(chip, azx_dev); -+ if (ok == 1) { -+ azx_dev->irq_pending = 0; -+ return ok; -+ } else if (ok == 0) { -+ /* bogus IRQ, process it later */ -+ azx_dev->irq_pending = 1; -+ schedule_work(&hda->irq_pending_work); -+ } -+ return 0; -+} -+ -+static int azx_ft_link_power(struct azx *chip, bool enable) -+{ -+ return 0; -+} -+ -+/* -+ * Check whether the current DMA position is acceptable for updating -+ * periods. Returns non-zero if it's OK. -+ * -+ * Many HD-audio controllers appear pretty inaccurate about -+ * the update-IRQ timing. The IRQ is issued before actually the -+ * data is processed. So, we need to process it afterwords in a -+ * workqueue. -+ */ -+static int azx_position_ok(struct azx *chip, struct azx_dev *azx_dev) -+{ -+ struct snd_pcm_substream *substream = azx_dev->core.substream; -+ int stream = substream->stream; -+ u32 wallclk; -+ unsigned int pos; -+ -+ wallclk = (azx_readl(chip, WALLCLK) - azx_dev->core.start_wallclk); -+ -+ if (wallclk < (azx_dev->core.period_wallclk * 2) / 3) -+ return -1; /* bogus (too early) interrupt */ -+ -+ if (chip->get_position[stream]) -+ pos = chip->get_position[stream](chip, azx_dev); -+ else { /* use the position buffer as default */ -+ pos = azx_get_pos_posbuf(chip, azx_dev); -+ if (!pos || pos == (u32)-1) { -+ dev_info(chip->card->dev, -+ "Invalid position buffer, using LPIB read method instead.\n"); -+ chip->get_position[stream] = azx_get_pos_lpib; -+ if (chip->get_position[0] == azx_get_pos_lpib && -+ chip->get_position[1] == azx_get_pos_lpib) -+ azx_bus(chip)->use_posbuf = false; -+ pos = azx_get_pos_lpib(chip, azx_dev); -+ chip->get_delay[stream] = NULL; -+ } else { -+ chip->get_position[stream] = azx_get_pos_posbuf; -+ if (chip->driver_caps & AZX_DCAPS_COUNT_LPIB_DELAY) -+ chip->get_delay[stream] = azx_get_delay_from_lpib; -+ } -+ } -+ -+ if (pos >= azx_dev->core.bufsize) -+ pos = 0; -+ -+ if (WARN_ONCE(!azx_dev->core.period_bytes, -+ "hda-ft: zero azx_dev->period_bytes")) -+ return -1; /* this shouldn't happen! */ -+ if (wallclk < (azx_dev->core.period_wallclk * 5) / 4 && -+ pos % azx_dev->core.period_bytes > azx_dev->core.period_bytes / 2) -+ /* NG - it's below the first next period boundary */ -+ return chip->bdl_pos_adj ? 0 : -1; + return ret; +@@ -1436,7 +1488,6 @@ arch_timer_mem_frame_register(struct arch_timer_mem_frame *frame) + return ret; + } + +- arch_counter_base = base; + arch_timers_present |= ARCH_TIMER_TYPE_MEM; + + return 0; +diff --git a/drivers/crypto/Kconfig b/drivers/crypto/Kconfig +index dbdee43c6..e2f01f00a 100644 +--- a/drivers/crypto/Kconfig ++++ b/drivers/crypto/Kconfig +@@ -21,7 +21,7 @@ config CRYPTO_DEV_PADLOCK + (so called VIA PadLock ACE, Advanced Cryptography Engine) + that provides instructions for very fast cryptographic + operations with supported algorithms. +- + -+ azx_dev->core.start_wallclk += wallclk; + The instructions are used only when the CPU supports them. + Otherwise software encryption is used. + +diff --git a/drivers/firmware/Kconfig b/drivers/firmware/Kconfig +index 807c5320d..91e8a70fc 100644 +--- a/drivers/firmware/Kconfig ++++ b/drivers/firmware/Kconfig +@@ -27,6 +27,18 @@ config ARM_SCMI_PROTOCOL + This protocol library provides interface for all the client drivers + making use of the features offered by the SCMI. + ++if ARM_SCMI_PROTOCOL ++config ARM_SCMI_TRANSPORT_FORCE_POLLING ++ bool "Support force polling mode for SCMI Mailbox" ++ help ++ Support force polling mode for SCMI Mailbox transports. + -+ return 1; /* OK, it's fine */ -+} ++ If you want to configure SCMI Mailbox transport to use polling mode ++ on the TX path and do not use any completion IRQ facility even when ++ available through kernel parameter, answer Y. If unsure, say N. + -+static int hda_ft_dma_configure(struct device *dev) -+{ -+ const struct of_device_id *match_of; -+ const struct acpi_device_id *match_acpi; ++endif #ARM_SCMI_PROTOCOL + -+ if (dev->of_node) { -+ match_of = of_match_device(dev->driver->of_match_table, dev); -+ if (!match_of) { -+ dev_err(dev, "Error DT match data is missing\n"); -+ return -ENODEV; -+ } -+ set_dma_ops(dev, NULL); -+ /* -+ * Because there is no way to transfer to non-coherent dma in -+ * of_dma_configure if 'dma-coherent' is described in DT, -+ * use acpi_dma_configure to alloc dma_ops correctly. -+ */ -+ acpi_dma_configure(dev, DEV_DMA_NON_COHERENT); -+ } else if (has_acpi_companion(dev)) { -+ match_acpi = acpi_match_device(dev->driver->acpi_match_table, dev); -+ if (!match_acpi) { -+ dev_err(dev, "Error ACPI match data is missing\n"); -+ return -ENODEV; -+ } -+ set_dma_ops(dev, NULL); -+ acpi_dma_configure(dev, DEV_DMA_NON_COHERENT); -+ } + config ARM_SCMI_POWER_DOMAIN + tristate "SCMI power domain driver" + depends on ARM_SCMI_PROTOCOL || (COMPILE_TEST && OF) +diff --git a/drivers/firmware/arm_scmi/driver.c b/drivers/firmware/arm_scmi/driver.c +index 8d2408284..e79580579 100644 +--- a/drivers/firmware/arm_scmi/driver.c ++++ b/drivers/firmware/arm_scmi/driver.c +@@ -98,6 +98,10 @@ struct scmi_info { + int users; + }; + ++#ifdef CONFIG_ARM_SCMI_TRANSPORT_FORCE_POLLING ++static bool scmi_force_polling; ++#endif + -+ return 0; -+} + #define handle_to_scmi_info(h) container_of(h, struct scmi_info, handle) + + static const int scmi_linux_errmap[] = { +@@ -344,6 +348,15 @@ static bool scmi_xfer_done_no_timeout(struct scmi_chan_info *cinfo, + ktime_after(ktime_get(), stop); + } + + -+/* The work for pending PCM period updates. */ -+static void azx_irq_pending_work(struct work_struct *work) ++#ifdef CONFIG_ARM_SCMI_TRANSPORT_FORCE_POLLING ++static int __init scmi_set_force_polling(char *str) +{ -+ struct hda_ft *hda = container_of(work, struct hda_ft, irq_pending_work); -+ struct azx *chip = &hda->chip; -+ struct hdac_bus *bus = azx_bus(chip); -+ struct hdac_stream *s; -+ int pending, ok; -+ -+ if (!hda->irq_pending_warned) { -+ dev_info(chip->card->dev, -+ "IRQ timing workaround is activated for card #%d. Suggest a bigger bdl_pos_adj.\n", -+ chip->card->number); -+ hda->irq_pending_warned = 1; -+ } -+ -+ for (;;) { -+ pending = 0; -+ spin_lock_irq(&bus->reg_lock); -+ list_for_each_entry(s, &bus->stream_list, list) { -+ struct azx_dev *azx_dev = stream_to_azx_dev(s); -+ -+ if (!azx_dev->irq_pending || -+ !s->substream || !s->running) -+ continue; -+ ok = azx_position_ok(chip, azx_dev); -+ if (ok > 0) { -+ azx_dev->irq_pending = 0; -+ spin_unlock(&bus->reg_lock); -+ snd_pcm_period_elapsed(s->substream); -+ spin_lock(&bus->reg_lock); -+ } else if (ok < 0) { -+ pending = 0; /* too early */ -+ } else { -+ pending++; -+ } -+ } -+ spin_unlock_irq(&bus->reg_lock); -+ if (!pending) -+ return; -+ udelay(1000); -+ } ++ return kstrtobool(str, &scmi_force_polling); +} ++early_param("scmi.force_polling", scmi_set_force_polling); ++#endif + -+/* clear irq_pending flags and assure no on-going workq */ -+static void azx_clear_irq_pending(struct azx *chip) -+{ -+ struct hdac_bus *bus = azx_bus(chip); -+ struct hdac_stream *s; -+ -+ spin_lock_irq(&bus->reg_lock); -+ list_for_each_entry(s, &bus->stream_list, list) { -+ struct azx_dev *azx_dev = stream_to_azx_dev(s); + /** + * scmi_do_xfer() - Do one transfer + * +@@ -366,6 +379,11 @@ int scmi_do_xfer(const struct scmi_handle *handle, struct scmi_xfer *xfer) + if (unlikely(!cinfo)) + return -EINVAL; + ++#ifdef CONFIG_ARM_SCMI_TRANSPORT_FORCE_POLLING ++ if (scmi_force_polling) ++ xfer->hdr.poll_completion = true; ++#endif + -+ azx_dev->irq_pending = 0; + trace_scmi_xfer_begin(xfer->transfer_id, xfer->hdr.id, + xfer->hdr.protocol_id, xfer->hdr.seq, + xfer->hdr.poll_completion); +diff --git a/drivers/firmware/arm_scmi/shmem.c b/drivers/firmware/arm_scmi/shmem.c +index 56a1f61aa..2d734faf8 100644 +--- a/drivers/firmware/arm_scmi/shmem.c ++++ b/drivers/firmware/arm_scmi/shmem.c +@@ -32,6 +32,14 @@ struct scmi_shared_mem { + void shmem_tx_prepare(struct scmi_shared_mem __iomem *shmem, + struct scmi_xfer *xfer) + { ++#ifdef CONFIG_ARCH_PHYTIUM ++ /* callee not set cahnnel free when init, caller set it */ ++ static int is_init = 0; ++ if(unlikely(is_init == 0)) { ++ iowrite32(0x1, &shmem->channel_status); ++ is_init = 1; + } -+ spin_unlock_irq(&bus->reg_lock); -+} ++#endif + /* + * Ideally channel must be free by now unless OS timeout last + * request and platform continued to process the same, wait +diff --git a/drivers/i2c/busses/i2c-designware-platdrv.c b/drivers/i2c/busses/i2c-designware-platdrv.c +index 474754151..f49a08355 100644 +--- a/drivers/i2c/busses/i2c-designware-platdrv.c ++++ b/drivers/i2c/busses/i2c-designware-platdrv.c +@@ -57,6 +57,7 @@ static const struct acpi_device_id dw_i2c_acpi_match[] = { + { "HISI02A2", 0 }, + { "HISI02A3", 0 }, + { "HYGO0010", ACCESS_INTR_MASK }, ++ { "PHYT0003", 0 }, + { } + }; + MODULE_DEVICE_TABLE(acpi, dw_i2c_acpi_match); +diff --git a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c +index 982c42c87..4dbeb03a0 100644 +--- a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c ++++ b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c +@@ -2873,6 +2873,13 @@ static void arm_smmu_write_msi_msg(struct msi_desc *desc, struct msi_msg *msg) + doorbell = (((u64)msg->address_hi) << 32) | msg->address_lo; + doorbell &= MSI_CFG0_ADDR_MASK; + ++#ifdef CONFIG_PM_SLEEP ++ /* Saves the msg (base addr of msi irq) and restores it during resume */ ++ desc->msg.address_lo = msg->address_lo; ++ desc->msg.address_hi = msg->address_hi; ++ desc->msg.data = msg->data; ++#endif + -+static int azx_acquire_irq(struct azx *chip, int do_disconnect) + writeq_relaxed(doorbell, smmu->base + cfg[0]); + writel_relaxed(msg->data, smmu->base + cfg[1]); + writel_relaxed(ARM_SMMU_MEMATTR_DEVICE_nGnRE, smmu->base + cfg[2]); +@@ -2928,11 +2935,51 @@ static void arm_smmu_setup_msis(struct arm_smmu_device *smmu) + devm_add_action(dev, arm_smmu_free_msis, dev); + } + +-static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu) ++#ifdef CONFIG_PM_SLEEP ++static void arm_smmu_resume_msis(struct arm_smmu_device *smmu) +{ -+ struct hdac_bus *bus = azx_bus(chip); ++ struct msi_desc *desc; ++ struct device *dev = smmu->dev; + -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ struct platform_device *pdev = to_platform_device(hda->dev); -+ int irq_id = platform_get_irq(pdev, 0); -+ int err; ++ for_each_msi_entry(desc, dev) { ++ switch (desc->platform.msi_index) { ++ case EVTQ_MSI_INDEX: ++ case GERROR_MSI_INDEX: ++ case PRIQ_MSI_INDEX: { ++ phys_addr_t *cfg = arm_smmu_msi_cfg[desc->platform.msi_index]; ++ struct msi_msg *msg = &desc->msg; ++ phys_addr_t doorbell = (((u64)msg->address_hi) << 32) | msg->address_lo; + -+ err = request_irq(irq_id, azx_interrupt, -+ IRQF_SHARED, KBUILD_MODNAME, chip); -+ if (err) { -+ dev_err(chip->card->dev, -+ "unable to request IRQ %d, disabling device\n", -+ irq_id); -+ if (do_disconnect) -+ snd_card_disconnect(chip->card); -+ return err; -+ } -+ bus->irq = irq_id; ++ doorbell &= MSI_CFG0_ADDR_MASK; ++ writeq_relaxed(doorbell, smmu->base + cfg[0]); ++ writel_relaxed(msg->data, smmu->base + cfg[1]); ++ writel_relaxed(ARM_SMMU_MEMATTR_DEVICE_nGnRE, ++ smmu->base + cfg[2]); ++ break; ++ } ++ default: ++ continue; + -+ return 0; ++ } ++ } +} -+ -+/* get the current DMA position with correction on VIA chips */ -+static unsigned int azx_via_get_position(struct azx *chip, -+ struct azx_dev *azx_dev) ++#else ++static void arm_smmu_resume_msis(struct arm_smmu_device *smmu) +{ -+ unsigned int link_pos, mini_pos, bound_pos; -+ unsigned int mod_link_pos, mod_dma_pos, mod_mini_pos; -+ unsigned int fifo_size; -+ -+ link_pos = snd_hdac_stream_get_pos_lpib(azx_stream(azx_dev)); -+ if (azx_dev->core.substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { -+ /* Playback, no problem using link position */ -+ return link_pos; -+ } -+ -+ /* Capture */ -+ /* For new chipset, -+ * use mod to get the DMA position just like old chipset -+ */ -+ mod_dma_pos = le32_to_cpu(*azx_dev->core.posbuf); -+ mod_dma_pos %= azx_dev->core.period_bytes; -+ -+ /* azx_dev->fifo_size can't get FIFO size of in stream. -+ * Get from base address + offset. -+ */ -+ fifo_size = readw(azx_bus(chip)->remap_addr + -+ VIA_IN_STREAM0_FIFO_SIZE_OFFSET); -+ -+ if (azx_dev->insufficient) { -+ /* Link position never gather than FIFO size */ -+ if (link_pos <= fifo_size) -+ return 0; -+ -+ azx_dev->insufficient = 0; -+ } -+ -+ if (link_pos <= fifo_size) -+ mini_pos = azx_dev->core.bufsize + link_pos - fifo_size; -+ else -+ mini_pos = link_pos - fifo_size; ++} ++#endif + -+ /* Find nearest previous boudary */ -+ mod_mini_pos = mini_pos % azx_dev->core.period_bytes; -+ mod_link_pos = link_pos % azx_dev->core.period_bytes; -+ if (mod_link_pos >= fifo_size) -+ bound_pos = link_pos - mod_link_pos; -+ else if (mod_dma_pos >= mod_mini_pos) -+ bound_pos = mini_pos - mod_mini_pos; ++static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu, bool resume) + { + int irq, ret; + +- arm_smmu_setup_msis(smmu); ++ if (!resume) ++ arm_smmu_setup_msis(smmu); + else { -+ bound_pos = mini_pos - mod_mini_pos + azx_dev->core.period_bytes; -+ if (bound_pos >= azx_dev->core.bufsize) -+ bound_pos = 0; ++ /* The irq doesn't need to be re-requested during resume */ ++ arm_smmu_resume_msis(smmu); ++ return; + } -+ -+ /* Calculate real DMA position we want */ -+ return bound_pos + mod_dma_pos; -+} -+ -+#ifdef CONFIG_PM -+static DEFINE_MUTEX(card_list_lock); -+static LIST_HEAD(card_list); -+ -+static void azx_add_card_list(struct azx *chip) -+{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ -+ mutex_lock(&card_list_lock); -+ list_add(&hda->list, &card_list); -+ mutex_unlock(&card_list_lock); -+} -+ -+static void azx_del_card_list(struct azx *chip) -+{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ -+ mutex_lock(&card_list_lock); -+ list_del_init(&hda->list); -+ mutex_unlock(&card_list_lock); -+} -+ -+#else -+#define azx_add_card_list(chip) /* NOP */ -+#define azx_del_card_list(chip) /* NOP */ -+#endif /* CONFIG_PM */ -+ -+#if defined(CONFIG_PM_SLEEP) -+/* power management */ -+static int azx_suspend(struct device *dev) + + /* Request interrupt lines */ + irq = smmu->evtq.q.irq; +@@ -2974,7 +3021,7 @@ static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu) + } + } + +-static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu) ++static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu, bool resume) + { + int ret, irq; + u32 irqen_flags = IRQ_CTRL_EVTQ_IRQEN | IRQ_CTRL_GERROR_IRQEN; +@@ -3001,7 +3048,7 @@ static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu) + if (ret < 0) + dev_warn(smmu->dev, "failed to enable combined irq\n"); + } else +- arm_smmu_setup_unique_irqs(smmu); ++ arm_smmu_setup_unique_irqs(smmu, resume); + + if (smmu->features & ARM_SMMU_FEAT_PRI) + irqen_flags |= IRQ_CTRL_PRIQ_IRQEN; +@@ -3026,7 +3073,7 @@ static int arm_smmu_device_disable(struct arm_smmu_device *smmu) + return ret; + } + +-static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) ++static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool resume) + { + int ret; + u32 reg, enables; +@@ -3134,7 +3181,7 @@ static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) + } + } + +- ret = arm_smmu_setup_irqs(smmu); ++ ret = arm_smmu_setup_irqs(smmu, resume); + if (ret) { + dev_err(smmu->dev, "failed to setup irqs\n"); + return ret; +@@ -3144,7 +3191,7 @@ static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) + enables &= ~(CR0_EVTQEN | CR0_PRIQEN); + + /* Enable the SMMU interface, or ensure bypass */ +- if (!bypass || disable_bypass) { ++ if (!smmu->bypass || disable_bypass) { + enables |= CR0_SMMUEN; + } else { + ret = arm_smmu_update_gbpa(smmu, 0, GBPA_ABORT); +@@ -3492,6 +3539,26 @@ static void __iomem *arm_smmu_ioremap(struct device *dev, resource_size_t start, + return devm_ioremap_resource(dev, &res); + } + ++#ifdef CONFIG_PM_SLEEP ++static int arm_smmu_suspend(struct device *dev) +{ -+ struct snd_card *card = dev_get_drvdata(dev); -+ struct azx *chip; -+ struct hda_ft *hda; -+ struct hdac_bus *bus; -+ -+ if (!card) -+ return 0; -+ -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ if (chip->disabled || !chip->running) -+ return 0; -+ -+ bus = azx_bus(chip); -+ snd_power_change_state(card, SNDRV_CTL_POWER_D3hot); -+ azx_clear_irq_pending(chip); -+ azx_stop_chip(chip); -+ if (bus->irq >= 0) { -+ free_irq(bus->irq, (void *)chip); -+ bus->irq = -1; -+ } -+ ++ /* ++ * The smmu is powered off and related registers are automatically ++ * cleared when suspend. No need to do anything. ++ */ + return 0; +} + -+static int azx_resume(struct device *dev) ++static int arm_smmu_resume(struct device *dev) +{ -+ struct snd_card *card = dev_get_drvdata(dev); -+ struct azx *chip; -+ struct hda_ft *hda; -+ struct hdac_bus *bus; -+ int index; -+ struct snd_pcm_substream *substream; -+ struct azx_dev *azx_dev; -+ int err; -+ -+ if (!card) -+ return 0; -+ -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ bus = azx_bus(chip); -+ if (chip->disabled || !chip->running) -+ return 0; -+ -+ if (azx_acquire_irq(chip, 1) < 0) -+ return -EIO; -+ -+ index = chip->dev_index; -+ -+ snd_hdac_bus_exit_link_reset(bus); -+ usleep_range(1000, 1200); -+ -+ azx_init_chip(chip, 0); -+ -+ snd_power_change_state(card, SNDRV_CTL_POWER_D0); -+ -+ if (hda->substream && hda->substream->runtime) { -+ substream = hda->substream; -+ -+ if (substream->runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) { -+ substream->runtime->status->state = -+ substream->runtime->status->suspended_state; -+ err = substream->ops->prepare(substream); -+ if (err < 0) -+ return err; -+ } ++ struct arm_smmu_device *smmu = dev_get_drvdata(dev); + -+ azx_dev = get_azx_dev(substream); -+ hda->substream = NULL; -+ } ++ arm_smmu_device_reset(smmu, true); + + return 0; +} -+#endif /* CONFIG_PM_SLEEP */ ++#endif + -+#ifdef CONFIG_PM -+static int azx_runtime_suspend(struct device *dev) -+{ -+ struct snd_card *card = dev_get_drvdata(dev); -+ struct azx *chip; -+ struct hda_ft *hda; + static int arm_smmu_device_probe(struct platform_device *pdev) + { + int irq, ret; +@@ -3499,7 +3566,6 @@ static int arm_smmu_device_probe(struct platform_device *pdev) + resource_size_t ioaddr; + struct arm_smmu_device *smmu; + struct device *dev = &pdev->dev; +- bool bypass; + + smmu = devm_kzalloc(dev, sizeof(*smmu), GFP_KERNEL); + if (!smmu) { +@@ -3517,7 +3583,7 @@ static int arm_smmu_device_probe(struct platform_device *pdev) + } + + /* Set bypass mode according to firmware probing result */ +- bypass = !!ret; ++ smmu->bypass = !!ret; + + /* Base address */ + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); +@@ -3578,7 +3644,7 @@ static int arm_smmu_device_probe(struct platform_device *pdev) + platform_set_drvdata(pdev, smmu); + + /* Reset the device */ +- ret = arm_smmu_device_reset(smmu, bypass); ++ ret = arm_smmu_device_reset(smmu, false); + if (ret) + return ret; + +@@ -3623,10 +3689,21 @@ static const struct of_device_id arm_smmu_of_match[] = { + }; + MODULE_DEVICE_TABLE(of, arm_smmu_of_match); + ++#ifdef CONFIG_PM_SLEEP ++static const struct dev_pm_ops arm_smmu_pm_ops = { ++ SET_SYSTEM_SLEEP_PM_OPS(arm_smmu_suspend, ++ arm_smmu_resume) ++}; ++#define ARM_SMMU_PM_OPS (&arm_smmu_pm_ops) ++#else ++#define ARM_SMMU_PM_OPS NULL ++#endif + -+ if (!card) -+ return 0; + static struct platform_driver arm_smmu_driver = { + .driver = { + .name = "arm-smmu-v3", + .of_match_table = arm_smmu_of_match, ++ .pm = ARM_SMMU_PM_OPS, + .suppress_bind_attrs = true, + }, + .probe = arm_smmu_device_probe, +diff --git a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h +index 57e5d223c..bc95e4773 100644 +--- a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h ++++ b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h +@@ -636,6 +636,7 @@ struct arm_smmu_device { + + /* IOMMU core code handle */ + struct iommu_device iommu; ++ bool bypass; + }; + + /* SMMU private data for each master */ +diff --git a/drivers/irqchip/irq-gic-v3-its.c b/drivers/irqchip/irq-gic-v3-its.c +index 23ca48741..343b6f2b9 100644 +--- a/drivers/irqchip/irq-gic-v3-its.c ++++ b/drivers/irqchip/irq-gic-v3-its.c +@@ -4783,6 +4783,7 @@ static void its_restore_enable(void) + { + struct its_node *its; + int ret; ++ int cpu; + + raw_spin_lock(&its_lock); + list_for_each_entry(its, &its_nodes, entry) { +@@ -4836,6 +4837,23 @@ static void its_restore_enable(void) + GITS_TYPER_HCC(gic_read_typer(base + GITS_TYPER))) + its_cpu_init_collection(its); + } + -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ if (chip->disabled) -+ return 0; ++ /* ++ * Enable LPIs:firmware just restore GICR_CTLR_ENABLE_LPIs of boot ++ * CPU, the other CPUs also should be restored. ++ */ ++ for_each_possible_cpu(cpu) { ++ void __iomem *rbase = gic_data_rdist_cpu(cpu)->rd_base; ++ u32 val; + -+ if (!azx_has_pm_runtime(chip)) -+ return 0; ++ /*Enable LPIs*/ ++ val = readl_relaxed(rbase + GICR_CTLR); ++ if (val & GICR_CTLR_ENABLE_LPIS) ++ continue; + -+ azx_stop_chip(chip); -+ azx_enter_link_reset(chip); -+ azx_clear_irq_pending(chip); ++ val |= GICR_CTLR_ENABLE_LPIS; ++ writel_relaxed(val, rbase + GICR_CTLR); ++ } + raw_spin_unlock(&its_lock); + } + +diff --git a/drivers/mtd/spi-nor/Makefile b/drivers/mtd/spi-nor/Makefile +index 653923896..ca91ca6b9 100644 +--- a/drivers/mtd/spi-nor/Makefile ++++ b/drivers/mtd/spi-nor/Makefile +@@ -17,6 +17,7 @@ spi-nor-objs += sst.o + spi-nor-objs += winbond.o + spi-nor-objs += xilinx.o + spi-nor-objs += xmc.o ++spi-nor-objs += boya.o + obj-$(CONFIG_MTD_SPI_NOR) += spi-nor.o + + obj-$(CONFIG_MTD_SPI_NOR) += controllers/ +diff --git a/drivers/mtd/spi-nor/boya.c b/drivers/mtd/spi-nor/boya.c +new file mode 100644 +index 000000000..db8c0c218 +--- /dev/null ++++ b/drivers/mtd/spi-nor/boya.c +@@ -0,0 +1,21 @@ ++// SPDX-License-Identifier: GPL-2.0 ++/* ++ * Copyright (C) 2005, Intec Automation Inc. ++ * Copyright (C) 2014, Freescale Semiconductor, Inc. ++ */ + -+ return 0; -+} ++#include + -+static int azx_runtime_resume(struct device *dev) -+{ -+ struct snd_card *card = dev_get_drvdata(dev); -+ struct azx *chip; -+ struct hda_ft *hda; -+ struct hdac_bus *bus; -+ struct hda_codec *codec; -+ int status; -+ int index; ++#include "core.h" + -+ if (!card) -+ return 0; ++static const struct flash_info boya_parts[] = { ++ /* Boya Microelectronics Memory Series */ ++ { "by25q64as", INFO(0x684017, 0, 64 * 1024, 128, SECT_4K) }, ++ { "by25q128as", INFO(0x684018, 0, 64 * 1024, 256, SECT_4K) }, ++}; + -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ bus = azx_bus(chip); -+ if (chip->disabled) -+ return 0; ++const struct spi_nor_manufacturer spi_nor_boya = { ++ .name = "boya", ++ .parts = boya_parts, ++ .nparts = ARRAY_SIZE(boya_parts), ++}; +diff --git a/drivers/mtd/spi-nor/controllers/Kconfig b/drivers/mtd/spi-nor/controllers/Kconfig +index 5c0e0ec2e..5bfc72f71 100644 +--- a/drivers/mtd/spi-nor/controllers/Kconfig ++++ b/drivers/mtd/spi-nor/controllers/Kconfig +@@ -62,3 +62,12 @@ config SPI_INTEL_SPI_PLATFORM + + To compile this driver as a module, choose M here: the module + will be called intel-spi-platform. ++ ++config SPI_PHYTIUM_QUADSPI ++ tristate "Phytium Quad SPI Controller" ++ depends on ARCH_PHYTIUM || ARM ++ depends on OF && HAS_IOMEM ++ help ++ This enables support for the Quad SPI controller in master mode. ++ This driver does not support generic SPI. The implementation only ++ supports SPI NOR. +diff --git a/drivers/mtd/spi-nor/controllers/Makefile b/drivers/mtd/spi-nor/controllers/Makefile +index e7abba491..a83cf25ce 100644 +--- a/drivers/mtd/spi-nor/controllers/Makefile ++++ b/drivers/mtd/spi-nor/controllers/Makefile +@@ -5,3 +5,4 @@ obj-$(CONFIG_SPI_NXP_SPIFI) += nxp-spifi.o + obj-$(CONFIG_SPI_INTEL_SPI) += intel-spi.o + obj-$(CONFIG_SPI_INTEL_SPI_PCI) += intel-spi-pci.o + obj-$(CONFIG_SPI_INTEL_SPI_PLATFORM) += intel-spi-platform.o ++obj-$(CONFIG_SPI_PHYTIUM_QUADSPI) += phytium-quadspi.o +diff --git a/drivers/mtd/spi-nor/controllers/phytium-quadspi.c b/drivers/mtd/spi-nor/controllers/phytium-quadspi.c +new file mode 100644 +index 000000000..267590aaa +--- /dev/null ++++ b/drivers/mtd/spi-nor/controllers/phytium-quadspi.c +@@ -0,0 +1,1024 @@ ++/* ++ * Phytium SPI core controller driver. ++ * ++ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. ++ * ++ * This program is free software; you can redistribute it and/or modify it ++ * under the terms and conditions of the GNU General Public License, ++ * version 2, as published by the Free Software Foundation. ++ * ++ * This program is distributed in the hope it will be useful, but WITHOUT ++ * 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 ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include + -+ if (!azx_has_pm_runtime(chip)) -+ return 0; ++#define QSPI_FLASH_CAP_REG 0x000 ++#define QSPI_RD_CFG_REG 0x004 ++#define QSPI_WR_CFG_REG 0x008 ++#define QSPI_FLUSH_REG 0x00C ++#define QSPI_CMD_PORT_REG 0x010 ++#define QSPI_ADDR_PORT_REG 0x014 ++#define QSPI_HD_PORT_REG 0x018 ++#define QSPI_LD_PORT_REG 0x01C ++#define QSPI_FUN_SET_REG 0x020 ++#define QSPI_WIP_REG 0x024 ++#define QSPI_WP_REG 0x028 ++#define QSPI_MODE_REG 0x02C + -+ /* Read STATESTS before controller reset */ -+ status = azx_readw(chip, STATESTS); ++#define QSPI_FLASH_CAP_NUM_SHIFT 3 ++#define QSPI_FLASH_CAP_NUM_MASK (0x3 << QSPI_FLASH_CAP_NUM_SHIFT) ++#define QSPI_FLASH_CAP_CAP_SHIFT 0 ++#define QSPI_FLASH_CAP_CAP_MASK (0x7 << QSPI_FLASH_CAP_CAP_SHIFT) + -+ index = chip->dev_index; ++#define QSPI_RD_CFG_RD_CMD_SHIFT 24 ++#define QSPI_RD_CFG_RD_CMD_MASK (0xFF << QSPI_RD_CFG_RD_CMD_SHIFT) ++#define QSPI_RD_CFG_RD_THROUGH_SHIFT 23 ++#define QSPI_RD_CFG_RD_THROUGH_MASK (0x01 << QSPI_RD_CFG_RD_THROUGH_SHIFT) ++#define QSPI_RD_CFG_RD_TRANSFER_SHIFT 20 ++#define QSPI_RD_CFG_RD_TRANSFER_MASK (0x07 << QSPI_RD_CFG_RD_TRANSFER_SHIFT) ++#define QSPI_RD_CFG_RD_ADDR_SEL_SHIFT 19 ++#define QSPI_RD_CFG_RD_ADDR_SEL_MASK (0x1 << QSPI_RD_CFG_RD_ADDR_SEL_SHIFT) ++#define QSPI_RD_CFG_RD_LATENCY_SHIFT 18 ++#define QSPI_RD_CFG_RD_LATENCY_MASK (0x1 << QSPI_RD_CFG_RD_LATENCY_SHIFT) ++#define QSPI_RD_CFG_MODE_BYTE_SHIFT 17 ++#define QSPI_RD_CFG_MODE_BYTE_MASK (0x1 << QSPI_RD_CFG_MODE_BYTE_SHIFT) ++#define QSPI_RD_CFG_CMD_SIGN_SHIFT 9 ++#define QSPI_RD_CFG_CMD_SIGN_MASK (0xFF << QSPI_RD_CFG_CMD_SIGN_SHIFT) ++#define QSPI_RD_CFG_DUMMY_SHIFT 4 ++#define QSPI_RD_CFG_DUMMY_MASK (0x1F << QSPI_RD_CFG_DUMMY_SHIFT) ++#define QSPI_RD_CFG_D_BUFFER_SHIFT 3 ++#define QSPI_RD_CFG_D_BUFFER_MASK (0x1 << QSPI_RD_CFG_D_BUFFER_SHIFT) ++#define QSPI_RD_CFG_RD_SCK_SEL_SHIFT 0 ++#define QSPI_RD_CFG_RD_SCK_SEL_MASK (0x3 << QSPI_RD_CFG_RD_SCK_SEL_SHIFT) + -+ snd_hdac_bus_exit_link_reset(bus); -+ usleep_range(1000, 1200); ++#define QSPI_WR_CFG_WR_CMD_SHIFT 24 ++#define QSPI_WR_CFG_WR_CMD_MASK (0xFF << QSPI_WR_CFG_WR_CMD_SHIFT) ++#define QSPI_WR_CFG_WR_WAIT_SHIFT 9 ++#define QSPI_WR_CFG_WR_WAIT_MASK (0x01 << QSPI_WR_CFG_WR_WAIT_SHIFT) ++#define QSPI_WR_CFG_WR_THROUGH_SHIFT 8 ++#define QSPI_WR_CFG_WR_THROUGH_MAS (0x01 << QSPI_WR_CFG_WR_THROUGH_SHIFT) ++#define QSPI_WR_CFG_WR_TRANSFER_SHIFT 5 ++#define QSPI_WR_CFG_WR_TRANSFER_MASK (0X7 << QSPI_WR_CFG_WR_TRANSFER_SHIFT) ++#define QSPI_WR_CFG_WR_ADDR_SEL_SHIFT 4 ++#define QSPI_WR_CFG_WR_ADDR_SEL_MASK (0x1 << QSPI_WR_CFG_WR_ADDR_SEL_SHIFT) ++#define QSPI_WR_CFG_WR_MODE_SHIFT 3 ++#define QSPI_WR_CFG_WR_MODE (0x01 << QSPI_WR_CFG_WR_MODE_SHIFT) ++#define QSPI_WR_CFG_WR_SCK_SEL_SHIFT 0 ++#define QSPI_WR_CFG_WR_SCK_SEL_MASK (0x7 << QSPI_WR_CFG_WR_SCK_SEL_SHIFT) + -+ azx_init_chip(chip, 0); ++#define QSPI_FLUSH_EN (0x1 << 0) + -+ if (status) { -+ list_for_each_codec(codec, &chip->bus) -+ if (status & (1 << codec->addr)) -+ schedule_delayed_work(&codec->jackpoll_work, -+ codec->jackpoll_interval); -+ } ++#define QSPI_CMD_PORT_CMD_SHIFT 24 ++#define QSPI_CMD_PORT_CMD_MASK (0xFF << QSPI_CMD_PORT_CMD_SHIFT) ++#define QSPI_CMD_PORT_WAIT_SHIFT 22 ++#define QSPI_CMD_PORT_WAIT_MASK (0x1 << QSPI_CMD_PORT_WAIT_SHIFT) ++#define QSPI_CMD_PORT_THROUGH_SHIFT 21 ++#define QSPI_CMD_PORT_THROUGH_MASK (0x1 << QSPI_CMD_PORT_THROUGH_SHIFT) ++#define QSPI_CMD_PORT_CS_SHIFT 19 ++#define QSPI_CMD_PORT_CS_MASK (0x3 << QSPI_CMD_PORT_CS_SHIFT) ++#define QSPI_CMD_PORT_TRANSFER_SHIFT 16 ++#define QSPI_CMD_PORT_TRANSFER_MASK (0x7 << QSPI_CMD_PORT_TRANSFER_SHIFT) ++#define QSPI_CMD_PORT_CMD_ADDR_SHIFT 15 ++#define QSPI_CMD_PORT_CMD_ADDR_MASK (0x1 << QSPI_CMD_PORT_CMD_ADDR_SHIFT) ++#define QSPI_CMD_PORT_LATENCY_SHIFT 14 ++#define QSPI_CMD_PORT_LATENCY_MASK (0x1 << QSPI_CMD_PORT_LATENCY_SHIFT) ++#define QSPI_CMD_PORT_DATA_TRANSFER_SHIFT 13 ++#define QSPI_CMD_PORT_DATA_TRANSFER_MASK (0x1 << 13) ++#define QSPI_CMD_PORT_SEL_SHIFT 12 ++#define QSPI_CMD_PORT_SEL_MASK (0x1 << QSPI_CMD_PORT_SEL_SHIFT) ++#define QSPI_CMD_PORT_DUMMY_SHIFT 7 ++#define QSPI_CMD_PORT_DUMMY_MASK (0x1F << QSPI_CMD_PORT_DUMMY_SHIFT) ++#define QSPI_CMD_PORT_DUMMY(x) (((x) << QSPI_CMD_PORT_DUMMY_SHIFT) & QSPI_CMD_PORT_DUMMY_MASK) ++#define QSPI_CMD_PORT_P_BUFFER_SHIFT 6 ++#define QSPI_CMD_PORT_P_BUFFER_MASK (0x1 << QSPI_CMD_PORT_P_BUFFER_SHIFT) ++#define QSPI_CMD_PORT_RW_NUM_SHIFT 3 ++#define QSPI_CMD_PORT_RW_NUM_MASK (0x7 << QSPI_CMD_PORT_RW_NUM_SHIFT) ++#define QSPI_CMD_PORT_SCK_SEL_SHIFT 0 ++#define QSPI_CMD_PORT_SCK_SEL_MASK (0x7 << QSPI_CMD_PORT_SCK_SEL_SHIFT) + -+ return 0; -+} ++#define QSPI_FUN_SET_HOLD_SHIFT 24 ++#define QSPI_FUN_SET_HOLD_MASK (0xFF << QSPI_FUN_SET_HOLD_SHIFT) ++#define QSPI_FUN_SET_SETUP_SHIFT 16 ++#define QSPI_FUN_SET_SETUP_MASK (0xFF << QSPI_FUN_SET_SETUP_SHIFT) ++#define QSPI_FUN_SET_DELAY_SHIFT 0 ++#define QSPI_FUN_SET_DELAY_MASK (0xFFFF << QSPI_FUN_SET_DELAY_SHIFT) + -+static int azx_runtime_idle(struct device *dev) -+{ -+ struct snd_card *card = dev_get_drvdata(dev); -+ struct azx *chip; -+ struct hda_ft *hda; ++#define QSPI_WIP_W_CMD_SHIFT 24 ++#define QSPI_WIP_W_CMD_MASK (0xFF << QSPI_WIP_W_CMD_SHIFT) ++#define QSPI_WIP_W_TRANSFER_SHIFT 3 ++#define QSPI_WIP_W_TRANSFER_MASK (0x3 << QSPI_WIP_W_TRANSFER_SHIFT) ++#define QSPI_WIP_W_SCK_SEL_SHIFT 0 ++#define QSPI_WIP_W_SCK_SEL_MASK (0x7 << QSPI_WIP_W_SCK_SEL_SHIFT) + -+ if (!card) -+ return 0; ++#define QSPI_WP_EN_SHIFT 17 ++#define QSPI_WP_EN_MASK (0x1 << QSPI_WP_EN_SHIFT) ++#define QSPI_WP_IO2_SHIFT 16 ++#define QSPI_WP_IO2_MASK (0x1 << QSPI_WP_IO2_SHIFT) ++#define QSPI_WP_HOLD_SHIFT 8 ++#define QSPI_WP_HOLD_MASK (0xFF << QSPI_WP_HOLD_SHIFT) ++#define QSPI_WP_SETUP_SHIFT 0 ++#define QSPI_WP_SETUP_MASK (0xFF << QSPI_WP_SETUP_SHIFT) + -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ if (chip->disabled) -+ return 0; ++#define QSPI_MODE_VALID_SHIFT 8 ++#define QSPI_MODE_VALID_MASK (0xFF << QSPI_MODE_VALID_SHIFT) ++#define QSPI_MODE_SHIFT 0 ++#define QSPI_MODE_MASK (0xFF << QSPI_MODE_SHIFT) + -+ if (!azx_has_pm_runtime(chip) || -+ azx_bus(chip)->codec_powered || !chip->running) -+ return -EBUSY; ++#define FSIZE_VAL(size) (__fls(size) - 1) + -+ return 0; -+} ++#define PHYTIUM_MAX_MMAP_S SZ_512M ++#define PHYTIUM_MAX_NORCHIP 4 + -+static const struct dev_pm_ops azx_pm = { -+ SET_SYSTEM_SLEEP_PM_OPS(azx_suspend, azx_resume) -+ SET_RUNTIME_PM_OPS(azx_runtime_suspend, azx_runtime_resume, azx_runtime_idle) -+}; ++#define PHYTIUM_QSPI_FIFO_SZ 32 ++#define PHYTIUM_QSPI_FIFO_TIMEOUT_US 50000 ++#define PHYTIUM_QSPI_BUSY_TIMEOUT_US 100000 + -+#define hda_ft_pm (&azx_pm) -+#else -+#define hda_ft_pm NULL -+#endif /* CONFIG_PM */ ++#define PHYTIUM_SCK_SEL 0x05 ++#define PHYTIUM_CMD_SCK_SEL 0x07 + -+static int azx_probe_continue(struct azx *chip); ++#define PHYTIUM_FMODE_MM 0x01 ++#define PHYTIUM_FMODE_IN 0x02 + +/* -+ * destructor ++ * the codes of the different commands + */ -+static int azx_free(struct azx *chip) -+{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ struct hdac_bus *bus = azx_bus(chip); -+ struct platform_device *pdev = to_platform_device(hda->dev); -+ struct device *hddev = hda->dev; -+ struct resource *res; -+ resource_size_t size; -+ -+ if (azx_has_pm_runtime(chip) && chip->running) -+ pm_runtime_get_noresume(&pdev->dev); -+ -+ azx_del_card_list(chip); -+ -+ complete_all(&hda->probe_wait); -+ -+ if (bus->chip_init) { -+ azx_clear_irq_pending(chip); -+ azx_stop_all_streams(chip); -+ azx_stop_chip(chip); -+ } ++#define CMD_WRDI 0x04 ++#define CMD_RDID 0x9F ++#define CMD_RDSR 0x05 ++#define CMD_WREN 0x06 ++#define CMD_RDAR 0x65 ++#define CMD_P4E 0x20 ++#define CMD_4P4E 0x21 ++#define CMD_BE 0x60 ++#define CMD_4BE 0xC7 ++#define CMD_READ 0x03 ++#define CMD_FAST_READ 0x0B ++#define CMD_QOR 0x6B ++#define CMD_QIOR 0xEB ++#define CMD_DDRFR 0x0D ++#define CMD_DDRQIOQ 0xED ++#define CMD_PP 0x02 ++#define CMD_QPP 0x32 ++#define CMD_SE 0xD8 ++#define CMD_4FAST_READ 0x0C ++#define CMD_4READ 0x13 ++#define CMD_4QOR 0x6C ++#define CMD_4QIOR 0xEC ++#define CMD_4DDRFR 0x0E ++#define CMD_4DDRQIOR 0xEE ++#define CMD_4PP 0x12 ++#define CMD_4QPP 0x34 ++#define CMD_4SE 0xDC + -+ if (bus->irq >= 0) { -+ free_irq(bus->irq, (void*)chip); -+ bus->irq = -1; -+ } ++#define PHYTIUM_QSPI_1_1_1 0 ++#define PHYTIUM_QSPI_1_1_2 1 ++#define PHYTIUM_QSPI_1_1_4 2 ++#define PHYTIUM_QSPI_1_2_2 3 ++#define PHYTIUM_QSPI_1_4_4 4 ++#define PHYTIUM_QSPI_2_2_2 5 ++#define PHYTIUM_QSPI_4_4_4 6 + -+ devm_iounmap(hddev, bus->remap_addr); ++struct phytium_qspi_flash { ++ struct spi_nor nor; ++ struct phytium_qspi *qspi; ++ u32 cs; ++ u32 fsize; ++ u32 presc; ++ u32 clk_div; ++ u32 read_mode; ++ bool registered; ++ u32 prefetch_limit; ++ u32 addr_width; ++ u32 read_cmd; ++}; + -+ azx_free_stream_pages(chip); -+ azx_free_streams(chip); -+ snd_hdac_bus_exit(bus); ++struct phytium_qspi { ++ struct device *dev; ++ void __iomem *io_base; ++ void __iomem *mm_base; ++ resource_size_t mm_size; ++ u32 nor_num; ++ struct clk *clk; ++ u32 clk_rate; ++ struct phytium_qspi_flash flash[PHYTIUM_MAX_NORCHIP]; + -+ if (chip->region_requested){ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ size = resource_size(res); -+ devm_release_mem_region(hddev, res->start, size); -+ } ++ spinlock_t spinlock; + -+ return 0; -+} ++ /* ++ * to protect device configuration, could be different between ++ * 2 flash access (bk1, bk2) ++ */ ++ struct mutex lock; ++}; + -+static int azx_dev_disconnect(struct snd_device *device) ++/* Need to enable p_buffer */ ++static int memcpy_from_ftreg(struct phytium_qspi *qspi, u_char *buf, size_t len) +{ -+ struct azx *chip = device->device_data; ++ int i; ++ u32 val = 0; + -+ chip->bus.shutdown = 1; -+ return 0; -+} ++ if (!qspi || !buf) ++ return -EINVAL; + -+static int azx_dev_free(struct snd_device *device) -+{ -+ return azx_free(device->device_data); -+} ++ for (i = 0; i < len; i++) { ++ if (0 == i % 4) ++ val = readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); + -+static int check_position_fix(struct azx *chip, int fix) -+{ -+ switch (fix) { -+ case POS_FIX_AUTO: -+ case POS_FIX_LPIB: -+ case POS_FIX_POSBUF: -+ case POS_FIX_VIACOMBO: -+ case POS_FIX_COMBO: -+ return fix; ++ buf[i] = (u_char) (val >> (i % 4) * 8) & 0xFF; + } + -+ if (chip->driver_caps & AZX_DCAPS_POSFIX_LPIB) { -+ dev_dbg(chip->card->dev, "Using LPIB position fix\n"); -+ return POS_FIX_LPIB; -+ } -+ return POS_FIX_AUTO; ++ return 0; +} + -+static void assign_position_fix(struct azx *chip, int fix) ++/* Not to enable p_buffer */ ++static int memcpy_to_ftreg(struct phytium_qspi *qspi, const u8 *buf, size_t len) +{ -+ static azx_get_pos_callback_t callbacks[] = { -+ [POS_FIX_AUTO] = NULL, -+ [POS_FIX_LPIB] = azx_get_pos_lpib, -+ [POS_FIX_POSBUF] = azx_get_pos_posbuf, -+ [POS_FIX_VIACOMBO] = azx_via_get_position, -+ [POS_FIX_COMBO] = azx_get_pos_lpib, -+ }; -+ -+ chip->get_position[0] = chip->get_position[1] = callbacks[fix]; -+ -+ /* combo mode uses LPIB only for playback */ -+ if (fix == POS_FIX_COMBO) -+ chip->get_position[1] = NULL; -+ -+ if (fix == POS_FIX_POSBUF && -+ (chip->driver_caps & AZX_DCAPS_COUNT_LPIB_DELAY)) { -+ chip->get_delay[0] = chip->get_delay[1] = -+ azx_get_delay_from_lpib; -+ } -+ -+} -+ -+#define AZX_FORCE_CODEC_MASK 0x100 ++ u32 val = 0; + -+static void check_probe_mask(struct azx *chip, int dev) -+{ -+ chip->codec_probe_mask = probe_mask[dev]; ++ if (!qspi || !buf || (len >= 8)) ++ return -EINVAL; + -+ /* check forced option */ -+ if (chip->codec_probe_mask != -1 && -+ (chip->codec_probe_mask & AZX_FORCE_CODEC_MASK)) { -+ azx_bus(chip)->codec_mask = chip->codec_probe_mask & 0xff; -+ dev_info(chip->card->dev, "codec_mask forced to 0x%x\n", -+ (int)azx_bus(chip)->codec_mask); ++ if (1 == len) { ++ val = buf[0]; ++ } else if (2 == len) { ++ val = buf[1]; ++ val = (val << 8) + buf[0]; ++ } else if (3 == len) { ++ val = buf[2]; ++ val = (val << 8) + buf[1]; ++ val = (val << 8) + buf[0]; ++ } else if (4 == len) { ++ val = buf[3]; ++ val = (val << 8) + buf[2]; ++ val = (val << 8) + buf[1]; ++ val = (val << 8) + buf[0]; + } -+} + -+static void azx_probe_work(struct work_struct *work) -+{ -+ struct hda_ft *hda = container_of(work, struct hda_ft, probe_work); ++ writel_relaxed(val, qspi->io_base + QSPI_LD_PORT_REG); + -+ azx_probe_continue(&hda->chip); ++ return 0; +} + -+/* -+ * constructor -+ */ -+static const struct hda_controller_ops axi_hda_ops; -+ -+static int hda_ft_create(struct snd_card *card, struct platform_device *pdev, -+ int dev, unsigned int driver_caps, -+ struct azx **rchip) ++static int phytium_qspi_wait_cmd(struct phytium_qspi *qspi, ++ struct phytium_qspi_flash *flash) +{ -+ static struct snd_device_ops ops = { -+ .dev_disconnect = azx_dev_disconnect, -+ .dev_free = azx_dev_free, -+ }; -+ struct hda_ft *hda; -+ struct azx *chip; -+ int err; -+ -+ *rchip = NULL; -+ -+ hda = devm_kzalloc(&pdev->dev, sizeof(*hda), GFP_KERNEL); -+ if (!hda) -+ return -ENOMEM; -+ hda->dev = &pdev->dev; -+ chip = &hda->chip; -+ mutex_init(&chip->open_mutex); -+ chip->card = card; -+ chip->ops = &axi_hda_ops; -+ chip->driver_caps = driver_caps; -+ chip->driver_type = driver_caps & 0xff; -+ chip->dev_index = dev; -+ if (jackpoll_ms[dev] >= 50 && jackpoll_ms[dev] <= 60000) -+ chip->jackpoll_interval = msecs_to_jiffies(jackpoll_ms[dev]); -+ INIT_LIST_HEAD(&chip->pcm_list); -+ INIT_WORK(&hda->irq_pending_work, azx_irq_pending_work); -+ INIT_LIST_HEAD(&hda->list); ++ u32 cmd = 0; ++ u32 cnt = 0; + -+ init_completion(&hda->probe_wait); -+ assign_position_fix(chip, check_position_fix(chip, position_fix[dev])); -+ check_probe_mask(chip, dev); ++ cmd |= CMD_RDSR << QSPI_CMD_PORT_CMD_SHIFT; ++ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); ++ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + -+ if (single_cmd < 0) /* allow fallback to single_cmd at errors */ -+ chip->fallback_to_single_cmd = 0; -+ else /* explicitly set to single_cmd or not */ -+ chip->single_cmd = single_cmd; ++ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + -+ if (bdl_pos_adj[dev] < 0) { -+ switch (chip->driver_type) { -+ case AZX_DRIVER_FT: -+ bdl_pos_adj[dev] = 32; -+ break; -+ default: -+ bdl_pos_adj[dev] = 32; ++ cnt = PHYTIUM_QSPI_BUSY_TIMEOUT_US / 10; ++ while (readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG) & 0x01) { ++ udelay(10); ++ cnt--; ++ if (!cnt) { ++ dev_err(qspi->dev, "wait command process timeout\n"); + break; + } + } -+ chip->bdl_pos_adj = bdl_pos_adj[dev]; -+ -+ err = azx_bus_init(chip, model[dev]); -+ if (err < 0) { -+ return err; -+ } -+ -+ chip->bus.core.aligned_mmio = 1; -+ -+ err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops); -+ if (err < 0) { -+ dev_err(card->dev, "Error creating device [card]!\n"); -+ azx_free(chip); -+ return err; -+ } + -+ /* continue probing in work context as may trigger request module */ -+ INIT_WORK(&hda->probe_work, azx_probe_work); -+ -+ *rchip = chip; -+ -+ return 0; ++ return !cnt; +} + -+static int azx_first_init(struct azx *chip) ++static int phytium_qspi_cmd_enable(struct phytium_qspi *qspi) +{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ struct platform_device *pdev = to_platform_device(hda->dev); -+ struct device *hddev = hda->dev; -+ -+ int dev = chip->dev_index; -+ bool full_reset; -+ -+ struct snd_card *card = chip->card; -+ struct hdac_bus *bus = azx_bus(chip); -+ int err; -+ unsigned short gcap; -+ unsigned int dma_bits = 64; -+ -+ struct resource *res; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ hda->regs = devm_ioremap_resource(hddev, res); -+ if (IS_ERR(hda->regs)) -+ return PTR_ERR(hda->regs); -+ chip->region_requested = 1; -+ -+ bus->addr = res->start; -+ bus->remap_addr = hda->regs; -+ if (bus->remap_addr == NULL) { -+ dev_err(card->dev, "ioremap error\n"); -+ return -ENXIO; -+ } -+ -+ bus->cmd_resend = 1; -+ -+ synchronize_irq(bus->irq); -+ -+ gcap = azx_readw(chip, GCAP); -+ dev_dbg(card->dev, "chipset global capabilities = 0x%x\n", gcap); -+ -+ /* disable 64bit DMA address on some devices */ -+ if (chip->driver_caps & AZX_DCAPS_NO_64BIT) { -+ dev_dbg(card->dev, "Disabling 64bit DMA\n"); -+ gcap &= ~AZX_GCAP_64OK; -+ } -+ -+ /* disable buffer size rounding to 128-byte multiples if supported */ -+ if (align_buffer_size >= 0) -+ chip->align_buffer_size = !!align_buffer_size; -+ else { -+ if (chip->driver_caps & AZX_DCAPS_NO_ALIGN_BUFSIZE) -+ chip->align_buffer_size = 0; -+ else -+ chip->align_buffer_size = 1; -+ } -+ -+ err = hda_ft_dma_configure(hddev); -+ if (err < 0) -+ return err; -+ -+ /* allow 64bit DMA address if supported by H/W */ -+ if (!(gcap & AZX_GCAP_64OK)) -+ dma_bits = 32; -+ if (!dma_set_mask(hddev, DMA_BIT_MASK(dma_bits))) { -+ dma_set_coherent_mask(hddev, DMA_BIT_MASK(dma_bits)); -+ } else { -+ dma_set_mask(hddev, DMA_BIT_MASK(32)); -+ dma_set_coherent_mask(hddev, DMA_BIT_MASK(32)); -+ } -+ -+ /* read number of streams from GCAP register instead of using -+ * hardcoded value -+ */ -+ chip->capture_streams = (gcap >> 8) & 0x0f; -+ chip->playback_streams = (gcap >> 12) & 0x0f; -+ if (!chip->playback_streams && !chip->capture_streams) { -+ /* gcap didn't give any info, switching to old method */ -+ chip->playback_streams = FT4C_NUM_PLAYBACK; -+ chip->capture_streams = FT4C_NUM_CAPTURE; -+ } -+ chip->capture_index_offset = 0; -+ chip->playback_index_offset = chip->capture_streams; -+ chip->num_streams = chip->playback_streams + chip->capture_streams; -+ -+ /* initialize streams */ -+ err = azx_init_streams(chip); -+ if (err < 0) -+ return err; -+ -+ err = azx_alloc_stream_pages(chip); -+ if (err < 0) -+ return err; -+ -+ full_reset = (probe_only[dev] & 2) ? false : true; -+ azx_init_chip(chip, full_reset); -+ -+ /* codec detection */ -+ if (!azx_bus(chip)->codec_mask) { -+ dev_err(card->dev, "no codecs found!\n"); -+ return -ENODEV; -+ } -+ -+ if (azx_acquire_irq(chip, 0) < 0) -+ return -EBUSY; ++ u32 val = 0; + -+ strcpy(card->driver, "ft-hda"); -+ strcpy(card->shortname, "ft-hda"); -+ snprintf(card->longname, sizeof(card->longname), -+ "%s at 0x%lx irq %i", -+ card->shortname, bus->addr, bus->irq); ++ writel_relaxed(val, qspi->io_base + QSPI_LD_PORT_REG); + + return 0; +} + -+static void pcm_mmap_prepare(struct snd_pcm_substream *substream, -+ struct vm_area_struct *area) -+{ -+ -+} -+ -+static const struct hda_controller_ops axi_hda_ops = { -+ .pcm_mmap_prepare = pcm_mmap_prepare, -+ .position_check = azx_position_check, -+ .link_power = azx_ft_link_power, -+}; -+ -+static DECLARE_BITMAP(probed_devs, SNDRV_CARDS); -+ -+static int hda_ft_probe(struct platform_device *pdev) ++static int phytium_qspi_write_enable(struct phytium_qspi *qspi, ++ struct phytium_qspi_flash *flash) +{ -+ const unsigned int driver_flags = AZX_DRIVER_FT; -+ struct snd_card *card; -+ struct hda_ft *hda; -+ struct azx *chip; -+ bool schedule_probe; -+ int err; -+ int dev; -+ -+ dev = find_first_zero_bit(probed_devs, SNDRV_CARDS); -+ -+ if (dev >= SNDRV_CARDS) -+ return -ENODEV; -+ if (!enable[dev]) { -+ set_bit(dev, probed_devs); -+ return -ENOENT; -+ } -+ -+ err = snd_card_new(&pdev->dev, index[dev], id[dev], THIS_MODULE, -+ 0, &card); -+ if (err < 0) { -+ dev_err(&pdev->dev, "Error creating card!\n"); -+ return err; -+ } -+ -+ err = hda_ft_create(card, pdev,dev, driver_flags, &chip); -+ if (err < 0) -+ goto out_free; -+ card->private_data = chip; -+ hda = container_of(chip, struct hda_ft, chip); -+ -+ dev_set_drvdata(&pdev->dev, card); ++ u32 cmd = 0; + -+ schedule_probe = !chip->disabled; ++ cmd = CMD_WREN << QSPI_CMD_PORT_CMD_SHIFT; ++ cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; ++ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + -+ if (schedule_probe) -+ schedule_work(&hda->probe_work); ++ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); ++ phytium_qspi_cmd_enable(qspi); + -+ set_bit(dev, probed_devs); -+ if (chip->disabled) -+ complete_all(&hda->probe_wait); + return 0; -+ -+out_free: -+ snd_card_free(card); -+ return err; +} + -+/* number of codec slots for each chipset: 0 = default slots (i.e. 4) */ -+static unsigned int azx_max_codecs[AZX_NUM_DRIVERS] = { -+ [AZX_DRIVER_FT] = 4, -+}; -+ -+static int azx_probe_continue(struct azx *chip) ++static int phytium_qspi_write_disable(struct phytium_qspi *qspi, ++ struct phytium_qspi_flash *flash) +{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ struct device *hddev = hda->dev; -+ int dev = chip->dev_index; -+ int err; -+ struct hdac_bus *bus = azx_bus(chip); -+ -+ hda->probe_continued = 1; -+ -+ err = azx_first_init(chip); -+ if (err < 0) -+ goto out_free; -+ -+#ifdef CONFIG_SND_HDA_INPUT_BEEP -+ chip->beep_mode = beep_mode[dev]; -+#endif -+ -+ /* create codec instances */ -+ err = azx_probe_codecs(chip, azx_max_codecs[chip->driver_type]); -+ if (err < 0) -+ goto out_free; -+ -+ if ((probe_only[dev] & 1) == 0) { -+ err = azx_codec_configure(chip); -+ if (err < 0) -+ goto out_free; -+ } -+ -+ err = snd_card_register(chip->card); -+ if (err < 0) -+ goto out_free; -+ -+ chip->running = 1; -+ azx_add_card_list(chip); -+ snd_hda_set_power_save(&chip->bus, power_save * 1000); -+ -+ if (azx_has_pm_runtime(chip)) -+ pm_runtime_put_noidle(hddev); -+ return err; -+ -+out_free: -+ if (bus->irq >= 0) { -+ free_irq(bus->irq, (void *)chip); -+ bus->irq = -1; -+ } -+ return err; -+} ++ u32 cmd = 0; + -+static int hda_ft_remove(struct platform_device *pdev) -+{ -+ struct snd_card *card = dev_get_drvdata(&pdev->dev); -+ struct azx *chip; -+ struct hda_ft *hda; ++ cmd = CMD_WRDI << QSPI_CMD_PORT_CMD_SHIFT; ++ cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; ++ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + -+ if (card) { -+ /* cancel the pending probing work */ -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ cancel_work_sync(&hda->probe_work); -+ clear_bit(chip->dev_index, probed_devs); ++ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); ++ phytium_qspi_cmd_enable(qspi); + -+ snd_card_free(card); -+ return 0; -+ } + return 0; +} + -+static void hda_ft_shutdown(struct platform_device *pdev) ++static int phytium_qspi_read_flash_id(struct phytium_qspi *qspi, ++ struct phytium_qspi_flash *flash, u8 opcode, u8 *buf, int len) +{ -+ struct snd_card *card = dev_get_drvdata(&pdev->dev); -+ struct azx *chip; -+ -+ if (!card) -+ return; -+ chip = card->private_data; -+ if (chip && chip->running) -+ azx_stop_chip(chip); -+} -+ -+static const struct of_device_id hda_ft_of_match[] = { -+ { .compatible = "phytium,hda" }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, hda_ft_of_match); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id hda_ft_acpi_match[] = { -+ { .id = "PHYT0006" }, -+ {} -+}; -+MODULE_DEVICE_TABLE(acpi, hda_ft_acpi_match); -+#else -+#define hda_ft_acpi_match NULL -+#endif -+ -+static struct platform_driver ft_platform_hda = { -+ .driver = { -+ .name = "ft-hda", -+ .pm = hda_ft_pm, -+ .of_match_table = hda_ft_of_match, -+ .acpi_match_table = hda_ft_acpi_match, -+ }, -+ .probe = hda_ft_probe, -+ .remove = hda_ft_remove, -+ .shutdown = hda_ft_shutdown, -+}; -+ -+module_platform_driver(ft_platform_hda); -+ -+MODULE_DESCRIPTION("FT HDA bus driver"); -+MODULE_LICENSE("GPL v2"); -diff --git a/sound/pci/hda/hda_phytium.h b/sound/pci/hda/hda_phytium.h -new file mode 100644 -index 000000000..ec1f3e7f7 ---- /dev/null -+++ b/sound/pci/hda/hda_phytium.h -@@ -0,0 +1,34 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Implementation of primary ALSA driver code base for Phytium HD Audio. -+ * -+ * Copyright (c) 2018-2024 Phytium Technology Co., Ltd. -+ */ -+#ifndef __SOUND_HDA_PHYTIUM_H__ -+#define __SOUND_HDA_PHYTIUM_H__ -+ -+#include "hda_controller.h" -+ -+struct hda_ft { -+ struct azx chip; -+ struct snd_pcm_substream *substream; -+ struct device *dev; -+ void __iomem *regs; -+ -+ /* for pending irqs */ -+ struct work_struct irq_pending_work; -+ -+ /* sync probing */ -+ struct completion probe_wait; -+ struct work_struct probe_work; -+ -+ /* card list (for power_save trigger) */ -+ struct list_head list; -+ -+ /* extra flags */ -+ unsigned int irq_pending_warned:1; -+ unsigned int probe_continued:1; -+ -+}; -+ -+#endif -diff --git a/sound/soc/Kconfig b/sound/soc/Kconfig -index 71a6fe87d..ed286439e 100644 ---- a/sound/soc/Kconfig -+++ b/sound/soc/Kconfig -@@ -77,6 +77,7 @@ source "sound/soc/ux500/Kconfig" - source "sound/soc/xilinx/Kconfig" - source "sound/soc/xtensa/Kconfig" - source "sound/soc/zte/Kconfig" -+source "sound/soc/phytium/Kconfig" - - # Supported codecs - source "sound/soc/codecs/Kconfig" -diff --git a/sound/soc/Makefile b/sound/soc/Makefile -index ddbac3a21..fc461482b 100644 ---- a/sound/soc/Makefile -+++ b/sound/soc/Makefile -@@ -60,3 +60,4 @@ obj-$(CONFIG_SND_SOC) += ux500/ - obj-$(CONFIG_SND_SOC) += xilinx/ - obj-$(CONFIG_SND_SOC) += xtensa/ - obj-$(CONFIG_SND_SOC) += zte/ -+obj-$(CONFIG_SND_SOC) += phytium/ -diff --git a/sound/soc/codecs/Kconfig b/sound/soc/codecs/Kconfig -index 04a7070c7..4558ee2b9 100644 ---- a/sound/soc/codecs/Kconfig -+++ b/sound/soc/codecs/Kconfig -@@ -795,6 +795,15 @@ config SND_SOC_ES8328_SPI - depends on SPI_MASTER - select SND_SOC_ES8328 - -+config SND_SOC_ES8336 -+ tristate "Everest Semi ES8336 CODEC" -+ depends on I2C -+ select GPIO_PHYTIUM_PCI -+ -+config SND_SOC_ES8388 -+ tristate "Everest Semi ES8388 CODEC" -+ depends on I2C -+ - config SND_SOC_GTM601 - tristate 'GTM601 UMTS modem audio codec' - -diff --git a/sound/soc/codecs/Makefile b/sound/soc/codecs/Makefile -index 11ce98c25..f89e41e8b 100644 ---- a/sound/soc/codecs/Makefile -+++ b/sound/soc/codecs/Makefile -@@ -90,6 +90,8 @@ snd-soc-es8316-objs := es8316.o - snd-soc-es8328-objs := es8328.o - snd-soc-es8328-i2c-objs := es8328-i2c.o - snd-soc-es8328-spi-objs := es8328-spi.o -+snd-soc-es8336-objs := es8336.o -+snd-soc-es8388-objs := es8388.o - snd-soc-gtm601-objs := gtm601.o - snd-soc-hdac-hdmi-objs := hdac_hdmi.o - snd-soc-hdac-hda-objs := hdac_hda.o -@@ -399,6 +401,8 @@ obj-$(CONFIG_SND_SOC_ES8316) += snd-soc-es8316.o - obj-$(CONFIG_SND_SOC_ES8328) += snd-soc-es8328.o - obj-$(CONFIG_SND_SOC_ES8328_I2C)+= snd-soc-es8328-i2c.o - obj-$(CONFIG_SND_SOC_ES8328_SPI)+= snd-soc-es8328-spi.o -+obj-$(CONFIG_SND_SOC_ES8336) += snd-soc-es8336.o -+obj-$(CONFIG_SND_SOC_ES8388) += snd-soc-es8388.o - obj-$(CONFIG_SND_SOC_GTM601) += snd-soc-gtm601.o - obj-$(CONFIG_SND_SOC_HDAC_HDMI) += snd-soc-hdac-hdmi.o - obj-$(CONFIG_SND_SOC_HDAC_HDA) += snd-soc-hdac-hda.o -diff --git a/sound/soc/codecs/es8336.c b/sound/soc/codecs/es8336.c -new file mode 100644 -index 000000000..719b7de0e ---- /dev/null -+++ b/sound/soc/codecs/es8336.c -@@ -0,0 +1,1081 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * es8336.c -- es8336 ALSA SoC audio driver -+ * Copyright Everest Semiconductor Co.,Ltd -+ * Phytium Information Technology Co.,Ltd -+ * -+ * Author: David Yang -+ * Yiqun Zhang -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 as -+ * published by the Free Software Foundation. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "es8336.h" -+ -+static struct snd_soc_component *es8336_component; -+ -+static const struct reg_default es8336_reg_defaults[] = { -+ {0x00, 0x03}, {0x01, 0x03}, {0x02, 0x00}, {0x03, 0x20}, -+ {0x04, 0x11}, {0x05, 0x00}, {0x06, 0x11}, {0x07, 0x00}, -+ {0x08, 0x00}, {0x09, 0x01}, {0x0a, 0x00}, {0x0b, 0x00}, -+ {0x0c, 0xf8}, {0x0d, 0x3f}, {0x0e, 0x00}, {0x0f, 0x00}, -+ {0x10, 0x01}, {0x11, 0xfc}, {0x12, 0x28}, {0x13, 0x00}, -+ {0x14, 0x00}, {0x15, 0x33}, {0x16, 0x00}, {0x17, 0x00}, -+ {0x18, 0x88}, {0x19, 0x06}, {0x1a, 0x22}, {0x1b, 0x03}, -+ {0x1c, 0x0f}, {0x1d, 0x00}, {0x1e, 0x80}, {0x1f, 0x80}, -+ {0x20, 0x00}, {0x21, 0x00}, {0x22, 0xc0}, {0x23, 0x00}, -+ {0x24, 0x01}, {0x25, 0x08}, {0x26, 0x10}, {0x27, 0xc0}, -+ {0x28, 0x00}, {0x29, 0x1c}, {0x2a, 0x00}, {0x2b, 0xb0}, -+ {0x2c, 0x32}, {0x2d, 0x03}, {0x2e, 0x00}, {0x2f, 0x11}, -+ {0x30, 0x10}, {0x31, 0x00}, {0x32, 0x00}, {0x33, 0xc0}, -+ {0x34, 0xc0}, {0x35, 0x1f}, {0x36, 0xf7}, {0x37, 0xfd}, -+ {0x38, 0xff}, {0x39, 0x1f}, {0x3a, 0xf7}, {0x3b, 0xfd}, -+ {0x3c, 0xff}, {0x3d, 0x1f}, {0x3e, 0xf7}, {0x3f, 0xfd}, -+ {0x40, 0xff}, {0x41, 0x1f}, {0x42, 0xf7}, {0x43, 0xfd}, -+ {0x44, 0xff}, {0x45, 0x1f}, {0x46, 0xf7}, {0x47, 0xfd}, -+ {0x48, 0xff}, {0x49, 0x1f}, {0x4a, 0xf7}, {0x4b, 0xfd}, -+ {0x4c, 0xff}, {0x4d, 0x00}, {0x4e, 0x00}, {0x4f, 0xff}, -+ {0x50, 0x00}, {0x51, 0x00}, {0x52, 0x00}, {0x53, 0x00}, -+}; ++ u32 cmd = 0; ++ unsigned long iflags; + -+/* codec private data */ -+struct es8336_priv { -+ struct regmap *regmap; -+ unsigned int dmic_amic; -+ unsigned int sysclk; -+ struct snd_pcm_hw_constraint_list *sysclk_constraints; -+ struct clk *mclk; -+ int debounce_time; -+ struct delayed_work work; ++ cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; ++ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); ++ cmd |= BIT(QSPI_CMD_PORT_P_BUFFER_SHIFT); ++ cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; ++ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + -+ struct gpio_desc *spk_ctl_gpio; -+ struct gpio_desc *hp_det_gpio; -+ bool muted; -+ bool hp_inserted; ++ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); ++ phytium_qspi_cmd_enable(qspi); + -+ u8 mic_src; -+ int pwr_count; -+}; ++ spin_lock_irqsave(&qspi->spinlock, iflags); ++ memcpy_from_ftreg(qspi, buf, len); ++ spin_unlock_irqrestore(&qspi->spinlock, iflags); + -+/* -+ * es8336_reset -+ * write value 0xff to reg0x00, the chip will be in reset mode -+ * then, writer 0x00 to reg0x00, unreset the chip -+ */ -+static int es8336_reset(struct snd_soc_component *component) -+{ -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0x3F); -+ usleep_range(5000, 5500); -+ return snd_soc_component_write(component, ES8336_RESET_REG00, 0x03); ++ dev_dbg(qspi->dev, "read flash id:%x\n", *(u32 *)buf); ++ return 0; +} + -+static void es8336_enable_spk(struct es8336_priv *es8336, bool enable) ++static int phytium_qspi_read_flash_sfdp(struct phytium_qspi *qspi, ++ struct phytium_qspi_flash *flash, struct spi_nor *nor, loff_t from, u8 *buf, int len) +{ -+ gpiod_set_value(es8336->spk_ctl_gpio, enable); -+} -+ -+static const DECLARE_TLV_DB_SCALE(dac_vol_tlv, -9600, 50, 1); -+static const DECLARE_TLV_DB_SCALE(adc_vol_tlv, -9600, 50, 1); -+static const DECLARE_TLV_DB_SCALE(hpmixer_gain_tlv, -1200, 150, 0); -+static const DECLARE_TLV_DB_SCALE(mic_bst_tlv, 0, 1200, 0); -+ -+static unsigned int linin_pga_tlv[] = { -+ TLV_DB_RANGE_HEAD(9), -+ 0, 0, TLV_DB_SCALE_ITEM(0, 0, 0), -+ 1, 1, TLV_DB_SCALE_ITEM(300, 0, 0), -+ 2, 2, TLV_DB_SCALE_ITEM(600, 0, 0), -+ 3, 3, TLV_DB_SCALE_ITEM(900, 0, 0), -+ 4, 4, TLV_DB_SCALE_ITEM(1200, 0, 0), -+ 5, 5, TLV_DB_SCALE_ITEM(1500, 0, 0), -+ 6, 6, TLV_DB_SCALE_ITEM(1800, 0, 0), -+ 7, 7, TLV_DB_SCALE_ITEM(2100, 0, 0), -+ 8, 8, TLV_DB_SCALE_ITEM(2400, 0, 0), -+}; -+ -+static unsigned int hpout_vol_tlv[] = { -+ TLV_DB_RANGE_HEAD(1), -+ 0, 3, TLV_DB_SCALE_ITEM(-4800, 1200, 0), -+}; -+ -+static const char *const alc_func_txt[] = { "Off", "On" }; -+ -+static const struct soc_enum alc_func = -+ SOC_ENUM_SINGLE(ES8336_ADC_ALC1_REG29, 6, 2, alc_func_txt); -+ -+static const char *const ng_type_txt[] = { -+ "Constant PGA Gain", "Mute ADC Output" }; -+ -+static const struct soc_enum ng_type = -+ SOC_ENUM_SINGLE(ES8336_ADC_ALC6_REG2E, 6, 2, ng_type_txt); -+ -+static const char *const adcpol_txt[] = { "Normal", "Invert" }; -+ -+static const struct soc_enum adcpol = -+ SOC_ENUM_SINGLE(ES8336_ADC_MUTE_REG26, 1, 2, adcpol_txt); -+ -+static const char *const dacpol_txt[] = { -+ "Normal", "R Invert", "L Invert", "L + R Invert" }; -+ -+static const struct soc_enum dacpol = -+ SOC_ENUM_SINGLE(ES8336_DAC_SET1_REG30, 0, 4, dacpol_txt); -+ -+static const struct snd_kcontrol_new es8336_snd_controls[] = { -+ /* HP OUT VOLUME */ -+ SOC_DOUBLE_TLV("HP Playback Volume", ES8336_CPHP_ICAL_VOL_REG18, -+ 4, 0, 4, 1, hpout_vol_tlv), -+ /* HPMIXER VOLUME Control */ -+ SOC_DOUBLE_TLV("HPMixer Gain", ES8336_HPMIX_VOL_REG16, -+ 0, 4, 7, 0, hpmixer_gain_tlv), -+ -+ /* DAC Digital controls */ -+ SOC_DOUBLE_R_TLV("DAC Playback Volume", ES8336_DAC_VOLL_REG33, -+ ES8336_DAC_VOLR_REG34, 0, 0xC0, 1, dac_vol_tlv), ++ unsigned long iflags; ++ u32 cmd = 0; ++ u8 opcode = nor->read_opcode; + -+ SOC_SINGLE("Enable DAC Soft Ramp", ES8336_DAC_SET1_REG30, 4, 1, 1), -+ SOC_SINGLE("DAC Soft Ramp Rate", ES8336_DAC_SET1_REG30, 2, 4, 0), ++ cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; ++ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); ++ cmd |= BIT(QSPI_CMD_PORT_P_BUFFER_SHIFT); ++ cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); ++ cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; ++ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; ++ cmd |= BIT(QSPI_CMD_PORT_LATENCY_SHIFT); ++ cmd |= QSPI_CMD_PORT_DUMMY(nor->read_dummy - 1); + -+ SOC_ENUM("Playback Polarity", dacpol), -+ SOC_SINGLE("DAC Notch Filter", ES8336_DAC_SET2_REG31, 6, 1, 0), -+ SOC_SINGLE("DAC Double Fs Mode", ES8336_DAC_SET2_REG31, 7, 1, 0), -+ SOC_SINGLE("DAC Volume Control-LeR", ES8336_DAC_SET2_REG31, 2, 1, 0), -+ SOC_SINGLE("DAC Stereo Enhancement", ES8336_DAC_SET3_REG32, 0, 7, 0), ++ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); ++ writel_relaxed(from, qspi->io_base + QSPI_ADDR_PORT_REG); ++ phytium_qspi_cmd_enable(qspi); + -+ /* +20dB D2SE PGA Control */ -+ SOC_SINGLE_TLV("MIC Boost", ES8336_ADC_D2SEPGA_REG24, -+ 0, 1, 0, mic_bst_tlv), -+ /* 0-+24dB Lineinput PGA Control */ -+ SOC_SINGLE_TLV("Input PGA", ES8336_ADC_PGAGAIN_REG23, -+ 4, 8, 0, linin_pga_tlv), -+}; ++ spin_lock_irqsave(&qspi->spinlock, iflags); ++ memcpy_from_ftreg(qspi, buf, len); ++ spin_unlock_irqrestore(&qspi->spinlock, iflags); + -+/* Analog Input MUX */ -+static const char * const es8336_analog_in_txt[] = { -+ "lin1-rin1", -+ "lin2-rin2", -+ "lin1-rin1 with 15db Boost", -+ "lin2-rin2 with 15db Boost" -+}; ++ dev_dbg(qspi->dev, "read flash sfdp:0x%llx 0x%llx\n", ++ *(u64 *)buf, *(u64 *)(buf + 8)); ++ return len; ++} + -+static const unsigned int es8336_analog_in_values[] = { 0, 1, 2, 3 }; ++static int phytium_qspi_read_flash_sr1(struct phytium_qspi *qspi, ++ struct phytium_qspi_flash *flash, u8 opcode, u8 *buf, int len) ++{ ++ u32 cmd = 0; ++ u32 val; + -+static const struct soc_enum es8336_analog_input_enum = -+ SOC_VALUE_ENUM_SINGLE(ES8336_ADC_PDN_LINSEL_REG22, 4, 3, -+ ARRAY_SIZE(es8336_analog_in_txt), -+ es8336_analog_in_txt, -+ es8336_analog_in_values); ++ cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; ++ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); ++ cmd |= (len << QSPI_CMD_PORT_RW_NUM_SHIFT) & QSPI_CMD_PORT_RW_NUM_MASK; ++ cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; ++ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + -+static const struct snd_kcontrol_new es8336_analog_in_mux_controls = -+ SOC_DAPM_ENUM("Route", es8336_analog_input_enum); ++ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); ++ phytium_qspi_cmd_enable(qspi); + -+/* Dmic MUX */ -+static const char * const es8336_dmic_txt[] = { -+ "dmic disable", -+ "dmic data at high level", -+ "dmic data at low level", -+}; ++ val = readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); ++ buf[0] = (u8)val; + -+static const unsigned int es8336_dmic_values[] = { 0, 2, 3 }; ++ return 0; ++} + -+static const struct soc_enum es8336_dmic_src_enum = -+ SOC_VALUE_ENUM_SINGLE(ES8336_ADC_DMIC_REG25, 0, 3, -+ ARRAY_SIZE(es8336_dmic_txt), -+ es8336_dmic_txt, -+ es8336_dmic_values); ++static int phytium_qspi_read_reg(struct spi_nor *nor, u8 opcode, u8 *buf, size_t len) ++{ ++ struct phytium_qspi_flash *flash = nor->priv; ++ struct device *dev = flash->qspi->dev; ++ struct phytium_qspi *qspi = flash->qspi; ++ unsigned long iflags; ++ u32 cmd = 0; + -+static const struct snd_kcontrol_new es8336_dmic_src_controls = -+ SOC_DAPM_ENUM("Route", es8336_dmic_src_enum); ++ dev_dbg(dev, "read_reg: cmd:%#.2x buf:%pK len:%#lx\n", opcode, buf, len); + -+/* hp mixer mux */ -+static const char *const es8336_hpmux_texts[] = { -+ "lin1-rin1", -+ "lin2-rin2", -+ "lin-rin with Boost", -+ "lin-rin with Boost and PGA" -+}; ++ switch (opcode) { ++ case CMD_RDID: ++ phytium_qspi_read_flash_id(qspi, flash, opcode, buf, len); ++ return 0; ++ case CMD_RDSR: ++ phytium_qspi_read_flash_sr1(qspi, flash, opcode, buf, len); ++ return 0; ++ default: ++ break; ++ } + -+static const unsigned int es8336_hpmux_values[] = { 0, 1, 2, 3 }; ++ cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; ++ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); ++ cmd |= BIT(QSPI_CMD_PORT_P_BUFFER_SHIFT); ++ cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; ++ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + -+static const struct soc_enum es8336_left_hpmux_enum = -+ SOC_VALUE_ENUM_SINGLE(ES8336_HPMIX_SEL_REG13, 4, 7, -+ ARRAY_SIZE(es8336_hpmux_texts), -+ es8336_hpmux_texts, -+ es8336_hpmux_values); ++ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); ++ phytium_qspi_cmd_enable(qspi); + -+static const struct snd_kcontrol_new es8336_left_hpmux_controls = -+ SOC_DAPM_ENUM("Route", es8336_left_hpmux_enum); ++ spin_lock_irqsave(&qspi->spinlock, iflags); ++ memcpy_from_ftreg(qspi, buf, len); ++ spin_unlock_irqrestore(&qspi->spinlock, iflags); + -+static const struct soc_enum es8336_right_hpmux_enum = -+ SOC_VALUE_ENUM_SINGLE(ES8336_HPMIX_SEL_REG13, 0, 7, -+ ARRAY_SIZE(es8336_hpmux_texts), -+ es8336_hpmux_texts, -+ es8336_hpmux_values); ++ return 0; ++} + -+static const struct snd_kcontrol_new es8336_right_hpmux_controls = -+ SOC_DAPM_ENUM("Route", es8336_right_hpmux_enum); ++static int phytium_qspi_write_reg(struct spi_nor *nor, u8 opcode, const u8 *buf, size_t len) ++{ ++ struct phytium_qspi_flash *flash = nor->priv; ++ struct device *dev = flash->qspi->dev; ++ struct phytium_qspi *qspi = flash->qspi; ++ u32 cmd = 0; + -+/* headphone Output Mixer */ -+static const struct snd_kcontrol_new es8336_out_left_mix[] = { -+ SOC_DAPM_SINGLE("LLIN Switch", ES8336_HPMIX_SWITCH_REG14, -+ 6, 1, 0), -+ SOC_DAPM_SINGLE("Left DAC Switch", ES8336_HPMIX_SWITCH_REG14, -+ 7, 1, 0), -+}; ++ dev_dbg(dev, "write_reg: cmd:%#.2x buf:%pK len:%#lx\n", opcode, buf, len); + -+static const struct snd_kcontrol_new es8336_out_right_mix[] = { -+ SOC_DAPM_SINGLE("RLIN Switch", ES8336_HPMIX_SWITCH_REG14, -+ 2, 1, 0), -+ SOC_DAPM_SINGLE("Right DAC Switch", ES8336_HPMIX_SWITCH_REG14, -+ 3, 1, 0), -+}; ++ switch (opcode) { ++ case CMD_WREN: ++ phytium_qspi_write_enable(qspi, flash); ++ return 0; ++ case CMD_WRDI: ++ phytium_qspi_write_disable(qspi, flash); ++ return 0; ++ default: ++ break; ++ } + -+/* DAC data source mux */ -+static const char * const es8336_dacsrc_texts[] = { -+ "LDATA TO LDAC, RDATA TO RDAC", -+ "LDATA TO LDAC, LDATA TO RDAC", -+ "RDATA TO LDAC, RDATA TO RDAC", -+ "RDATA TO LDAC, LDATA TO RDAC", -+}; ++ cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; ++ cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; ++ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + -+static const unsigned int es8336_dacsrc_values[] = { 0, 1, 2, 3 }; ++ if ((len > 8) || (NULL == buf)) { ++ dev_err(dev, "data length exceed. commad %x, len:%ld \n", opcode, len); ++ return -EINVAL; ++ } else if (len > 0) { ++ cmd |= ((len - 1) << QSPI_CMD_PORT_RW_NUM_SHIFT) & QSPI_CMD_PORT_RW_NUM_MASK; ++ cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); ++ } + -+static const struct soc_enum es8336_dacsrc_mux_enum = -+ SOC_VALUE_ENUM_SINGLE(ES8336_DAC_SET1_REG30, 6, 4, -+ ARRAY_SIZE(es8336_dacsrc_texts), -+ es8336_dacsrc_texts, -+ es8336_dacsrc_values); -+static const struct snd_kcontrol_new es8336_dacsrc_mux_controls = -+ SOC_DAPM_ENUM("Route", es8336_dacsrc_mux_enum); ++ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); ++ memcpy_to_ftreg(qspi, buf, len); + -+static const struct snd_soc_dapm_widget es8336_dapm_widgets[] = { -+ /* Input Lines */ -+ SND_SOC_DAPM_INPUT("DMIC"), -+ SND_SOC_DAPM_INPUT("MIC1"), -+ SND_SOC_DAPM_INPUT("MIC2"), ++ return 0; ++} + -+ SND_SOC_DAPM_MICBIAS("micbias", SND_SOC_NOPM, -+ 0, 0), -+ /* Input MUX */ -+ SND_SOC_DAPM_MUX("Differential Mux", SND_SOC_NOPM, 0, 0, -+ &es8336_analog_in_mux_controls), ++static ssize_t phytium_qspi_read_tmp(struct phytium_qspi *qspi, u32 read_cmd, loff_t from, size_t len, u_char *buf) ++{ ++ u32 addr = (u32)from; ++ u64 val = 0; + -+ SND_SOC_DAPM_PGA("Line input PGA", ES8336_ADC_PDN_LINSEL_REG22, -+ 7, 1, NULL, 0), ++ if (!qspi) ++ return -1; + -+ /* ADCs */ -+ SND_SOC_DAPM_ADC("Mono ADC", NULL, ES8336_ADC_PDN_LINSEL_REG22, 6, 1), ++ dev_dbg(qspi->dev, "read cmd:%x, addr:%x len:%zx\n", read_cmd, addr, len); ++ writel_relaxed(read_cmd, qspi->io_base + QSPI_RD_CFG_REG); + -+ /* Dmic MUX */ -+ SND_SOC_DAPM_MUX("Digital Mic Mux", SND_SOC_NOPM, 0, 0, -+ &es8336_dmic_src_controls), ++ memcpy_fromio(buf, qspi->mm_base + addr, len); + -+ /* Digital Interface */ -+ SND_SOC_DAPM_AIF_OUT("I2S OUT", "I2S1 Capture", 1, -+ SND_SOC_NOPM, 0, 0), ++ val = *(u64 *)(buf); ++ dev_dbg(qspi->dev, "read val:%llx\n", val); + -+ SND_SOC_DAPM_AIF_IN("I2S IN", "I2S1 Playback", 0, -+ SND_SOC_NOPM, 0, 0), ++ return len; ++} + -+ /* DACs DATA SRC MUX */ -+ SND_SOC_DAPM_MUX("DAC SRC Mux", SND_SOC_NOPM, 0, 0, -+ &es8336_dacsrc_mux_controls), -+ /* DACs */ -+ SND_SOC_DAPM_DAC("Right DAC", NULL, ES8336_DAC_PDN_REG2F, 0, 1), -+ SND_SOC_DAPM_DAC("Left DAC", NULL, ES8336_DAC_PDN_REG2F, 4, 1), ++static ssize_t phytium_qspi_read(struct spi_nor *nor, loff_t from, size_t len, u8 *buf) ++{ ++ struct phytium_qspi_flash *flash = nor->priv; ++ struct phytium_qspi *qspi = flash->qspi; ++ u32 cmd = nor->read_opcode; ++ u32 addr = (u32)from; + -+ /* Headphone Output Side */ -+ /* hpmux for hp mixer */ -+ SND_SOC_DAPM_MUX("Left Hp mux", SND_SOC_NOPM, 0, 0, -+ &es8336_left_hpmux_controls), -+ SND_SOC_DAPM_MUX("Right Hp mux", SND_SOC_NOPM, 0, 0, -+ &es8336_right_hpmux_controls), -+ /* Output mixer */ -+ SND_SOC_DAPM_MIXER("Left Hp mixer", ES8336_HPMIX_PDN_REG15, -+ 4, 1, &es8336_out_left_mix[0], -+ ARRAY_SIZE(es8336_out_left_mix)), -+ SND_SOC_DAPM_MIXER("Right Hp mixer", ES8336_HPMIX_PDN_REG15, -+ 0, 1, &es8336_out_right_mix[0], -+ ARRAY_SIZE(es8336_out_right_mix)), -+ SND_SOC_DAPM_MIXER("Left Hp mixer2", SND_SOC_NOPM, -+ 4, 1, &es8336_out_left_mix[0], -+ ARRAY_SIZE(es8336_out_left_mix)), -+ SND_SOC_DAPM_MIXER("Right Hp mixer2", SND_SOC_NOPM, -+ 0, 1, &es8336_out_right_mix[0], -+ ARRAY_SIZE(es8336_out_right_mix)), ++ addr = addr + flash->cs * flash->fsize; + -+ /* Output charge pump */ -+ SND_SOC_DAPM_PGA("HPCP L", ES8336_CPHP_OUTEN_REG17, -+ 6, 0, NULL, 0), -+ SND_SOC_DAPM_PGA("HPCP R", ES8336_CPHP_OUTEN_REG17, -+ 2, 0, NULL, 0), ++ dev_dbg(qspi->dev, "read(%#.2x): buf:%pK from:%#.8x len:%#zx\n", nor->read_opcode, buf, addr, len); + -+ /* Output Driver */ -+ SND_SOC_DAPM_PGA("HPVOL L", ES8336_CPHP_OUTEN_REG17, -+ 5, 0, NULL, 0), -+ SND_SOC_DAPM_PGA("HPVOL R", ES8336_CPHP_OUTEN_REG17, -+ 1, 0, NULL, 0), -+ /* Output Lines */ -+ SND_SOC_DAPM_OUTPUT("HPOL"), -+ SND_SOC_DAPM_OUTPUT("HPOR"), -+}; ++ cmd = cmd << QSPI_RD_CFG_RD_CMD_SHIFT; ++ cmd |= BIT(QSPI_RD_CFG_D_BUFFER_SHIFT); ++ cmd |= flash->clk_div << QSPI_CMD_PORT_SCK_SEL_SHIFT; + -+static const struct snd_soc_dapm_route es8336_dapm_routes[] = { -+ /* -+ * record route map -+ */ -+ {"MIC1", NULL, "micbias"}, -+ {"MIC2", NULL, "micbias"}, -+ {"DMIC", NULL, "micbias"}, ++ cmd &= ~QSPI_RD_CFG_RD_TRANSFER_MASK; ++ cmd |= (flash->addr_width << QSPI_RD_CFG_RD_TRANSFER_SHIFT); + -+ {"Differential Mux", "lin1-rin1", "MIC1"}, -+ {"Differential Mux", "lin2-rin2", "MIC2"}, -+ {"Differential Mux", "lin1-rin1 with 15db Boost", "MIC1"}, -+ {"Differential Mux", "lin2-rin2 with 15db Boost", "MIC2"}, -+ {"Line input PGA", NULL, "Differential Mux"}, ++ switch (nor->read_opcode) { ++ case CMD_READ: ++ case CMD_FAST_READ: ++ case CMD_QIOR: ++ case CMD_QOR: ++ cmd &= ~QSPI_RD_CFG_RD_ADDR_SEL_MASK; ++ break; ++ case CMD_4READ: ++ case CMD_4FAST_READ: ++ case CMD_4QOR: ++ case CMD_4QIOR: ++ cmd |= BIT(QSPI_RD_CFG_RD_ADDR_SEL_SHIFT); ++ break; ++ case 0x5A: ++ cmd &= ~QSPI_RD_CFG_RD_ADDR_SEL_MASK; ++ return phytium_qspi_read_flash_sfdp(qspi, flash, nor, from, buf, len); ++ break; ++ default: ++ break; ++ } + -+ {"Mono ADC", NULL, "Line input PGA"}, ++ if ((PHYTIUM_QSPI_1_1_4 == flash->addr_width) || (PHYTIUM_QSPI_1_4_4 == flash->addr_width)) { ++ cmd |= BIT(QSPI_RD_CFG_RD_LATENCY_SHIFT); ++ cmd &= ~QSPI_RD_CFG_DUMMY_MASK; ++ cmd |= (0x07 << QSPI_RD_CFG_DUMMY_SHIFT); ++ } + -+ {"Digital Mic Mux", "dmic disable", "Mono ADC"}, -+ {"Digital Mic Mux", "dmic data at high level", "DMIC"}, -+ {"Digital Mic Mux", "dmic data at low level", "DMIC"}, ++ dev_dbg(qspi->dev, "read(%#.2x): cmd:%#x\n", nor->read_opcode, cmd); + -+ {"I2S OUT", NULL, "Digital Mic Mux"}, -+ /* -+ * playback route map -+ */ -+ {"DAC SRC Mux", "LDATA TO LDAC, RDATA TO RDAC", "I2S IN"}, -+ {"DAC SRC Mux", "LDATA TO LDAC, LDATA TO RDAC", "I2S IN"}, -+ {"DAC SRC Mux", "RDATA TO LDAC, RDATA TO RDAC", "I2S IN"}, -+ {"DAC SRC Mux", "RDATA TO LDAC, LDATA TO RDAC", "I2S IN"}, ++ if (cmd != flash->read_cmd) ++ flash->read_cmd = cmd; + -+ {"Left DAC", NULL, "DAC SRC Mux"}, -+ {"Right DAC", NULL, "DAC SRC Mux"}, ++ writel_relaxed(cmd, qspi->io_base + QSPI_RD_CFG_REG); + -+ {"Left Hp mux", "lin1-rin1", "MIC1"}, -+ {"Left Hp mux", "lin2-rin2", "MIC2"}, -+ {"Left Hp mux", "lin-rin with Boost", "Differential Mux"}, -+ {"Left Hp mux", "lin-rin with Boost and PGA", "Line input PGA"}, ++ memcpy_fromio(buf, qspi->mm_base + addr, len); + -+ {"Right Hp mux", "lin1-rin1", "MIC1"}, -+ {"Right Hp mux", "lin2-rin2", "MIC2"}, -+ {"Right Hp mux", "lin-rin with Boost", "Differential Mux"}, -+ {"Right Hp mux", "lin-rin with Boost and PGA", "Line input PGA"}, ++ return len; ++} + -+ {"Left Hp mixer", "LLIN Switch", "Left Hp mux"}, -+ {"Left Hp mixer", "Left DAC Switch", "Left DAC"}, ++static ssize_t phytium_qspi_write(struct spi_nor *nor, loff_t to, size_t len, const u8 *buf) ++{ ++ struct phytium_qspi_flash *flash = nor->priv; ++ struct device *dev = flash->qspi->dev; ++ struct phytium_qspi *qspi = flash->qspi; ++ u32 cmd = nor->program_opcode; ++ u32 addr = (u32)to; ++ int i; ++ u_char tmp[8] = {0}; ++ size_t mask = 0x03; + -+ {"Right Hp mixer", "RLIN Switch", "Right Hp mux"}, -+ {"Right Hp mixer", "Right DAC Switch", "Right DAC"}, ++ addr = addr + flash->cs * flash->fsize; + -+ {"HPCP L", NULL, "Left Hp mixer"}, -+ {"HPCP R", NULL, "Right Hp mixer"}, ++ dev_dbg(dev, "write(%#.2x): buf:%p to:%#.8x len:%#zx\n", nor->program_opcode, buf, addr, len); + -+ {"HPVOL L", NULL, "HPCP L"}, -+ {"HPVOL R", NULL, "HPCP R"}, ++ if (addr & 0x03) { ++ dev_err(dev, "Addr not four-byte aligned!\n"); ++ return -EINVAL; ++ } + -+ {"HPOL", NULL, "HPVOL L"}, -+ {"HPOR", NULL, "HPVOL R"}, -+}; ++ cmd = cmd << QSPI_WR_CFG_WR_CMD_SHIFT; ++ cmd |= BIT(QSPI_WR_CFG_WR_MODE_SHIFT); ++ cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; + ++ switch (nor->program_opcode) { ++ case CMD_PP: ++ case CMD_QPP: ++ cmd &= ~QSPI_WR_CFG_WR_ADDR_SEL_MASK; ++ break; ++ case CMD_4PP: ++ case CMD_4QPP: ++ cmd |= BIT(QSPI_WR_CFG_WR_ADDR_SEL_SHIFT); ++ break; ++ default: ++ dev_err(qspi->dev, "Not support program command:%#x\n", nor->erase_opcode); ++ return -EINVAL; ++ } + -+/* The set of rates we can generate from the above for each SYSCLK */ ++ dev_dbg(qspi->dev, "write cmd:%x\n", cmd); + -+static unsigned int rates_12288[] = { -+ 8000, 12000, 16000, 24000, 24000, 32000, 48000, 96000, -+}; ++ writel_relaxed(cmd, qspi->io_base + QSPI_WR_CFG_REG); + -+static struct snd_pcm_hw_constraint_list constraints_12288 = { -+ .count = ARRAY_SIZE(rates_12288), -+ .list = rates_12288, -+}; ++ for (i = 0; i < len/4; i++) ++ writel_relaxed(*(u32 *)(buf + 4*i), qspi->mm_base + addr + 4*i); + -+static unsigned int rates_112896[] = { -+ 8000, 11025, 22050, 44100, -+}; ++ if (len & mask) { ++ addr = addr + (len & ~mask); ++ phytium_qspi_read_tmp(qspi, flash->read_cmd, addr, 4, &tmp[0]); ++ memcpy(tmp, buf + (len & ~mask), len & mask); ++ writel_relaxed(*(u32 *)(tmp), qspi->mm_base + addr); ++ } + -+static struct snd_pcm_hw_constraint_list constraints_112896 = { -+ .count = ARRAY_SIZE(rates_112896), -+ .list = rates_112896, -+}; ++ writel_relaxed(QSPI_FLUSH_EN, qspi->io_base + QSPI_FLUSH_REG); + -+static unsigned int rates_12[] = { -+ 8000, 11025, 12000, 16000, 22050, 24000, 32000, 44100, 48000, -+ 48000, 88235, 96000, -+}; ++ phytium_qspi_wait_cmd(qspi, flash); + -+static struct snd_pcm_hw_constraint_list constraints_12 = { -+ .count = ARRAY_SIZE(rates_12), -+ .list = rates_12, -+}; ++ return len; ++} + -+/* -+ * Note that this should be called from init rather than from hw_params. -+ */ -+static int es8336_set_dai_sysclk(struct snd_soc_dai *codec_dai, -+ int clk_id, unsigned int freq, int dir) ++static int phytium_qspi_erase(struct spi_nor *nor, loff_t offs) +{ -+ struct snd_soc_component *component = codec_dai->component; -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ -+ switch (freq) { -+ case 11289600: -+ case 18432000: -+ case 22579200: -+ case 36864000: -+ es8336->sysclk_constraints = &constraints_112896; -+ es8336->sysclk = freq; -+ return 0; -+ case 12288000: -+ case 19200000: -+ case 16934400: -+ case 24576000: -+ case 33868800: -+ es8336->sysclk_constraints = &constraints_12288; -+ es8336->sysclk = freq; -+ return 0; -+ case 12000000: -+ case 24000000: -+ es8336->sysclk_constraints = &constraints_12; -+ es8336->sysclk = freq; -+ return 0; -+ } ++ struct phytium_qspi_flash *flash = nor->priv; ++ struct device *dev = flash->qspi->dev; ++ struct phytium_qspi *qspi = flash->qspi; ++ u32 cmd = nor->erase_opcode; ++ u32 addr = (u32)offs; + -+ return 0; -+} ++ dev_dbg(dev, "erase(%#.2x):offs:%#x\n", nor->erase_opcode, (u32)offs); + -+static int es8336_set_dai_fmt(struct snd_soc_dai *codec_dai, -+ unsigned int fmt) -+{ -+ struct snd_soc_component *component = codec_dai->component; -+ u8 iface = 0; -+ u8 adciface = 0; -+ u8 daciface = 0; ++ phytium_qspi_write_enable(qspi, flash); + -+ iface = snd_soc_component_read(component, ES8336_IFACE); -+ adciface = snd_soc_component_read(component, ES8336_ADC_IFACE); -+ daciface = snd_soc_component_read(component, ES8336_DAC_IFACE); ++ cmd = cmd << QSPI_CMD_PORT_CMD_SHIFT; ++ cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; ++ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + -+ /* set master/slave audio interface */ -+ switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { -+ case SND_SOC_DAIFMT_CBM_CFM: -+ iface |= 0x80; ++ /* s25fl256s1 not supoort D8, DC, 20, 21 */ ++ switch (nor->erase_opcode) { ++ case CMD_SE: ++ cmd &= ~QSPI_CMD_PORT_SEL_MASK; ++ cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); ++ writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); + break; -+ case SND_SOC_DAIFMT_CBS_CFS: -+ iface &= 0x7F; ++ case CMD_4SE: ++ cmd |= BIT(QSPI_CMD_PORT_SEL_SHIFT); ++ cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); ++ writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); + break; -+ default: -+ return -EINVAL; -+ } -+ -+ /* interface format */ -+ switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { -+ case SND_SOC_DAIFMT_I2S: -+ adciface &= 0xFC; -+ daciface &= 0xFC; ++ case CMD_P4E: ++ cmd &= ~QSPI_CMD_PORT_SEL_MASK; ++ cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); ++ writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); + break; -+ case SND_SOC_DAIFMT_RIGHT_J: -+ return -EINVAL; -+ case SND_SOC_DAIFMT_LEFT_J: -+ adciface &= 0xFC; -+ daciface &= 0xFC; -+ adciface |= 0x01; -+ daciface |= 0x01; ++ case CMD_4P4E: ++ cmd |= BIT(QSPI_CMD_PORT_SEL_SHIFT); ++ cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); ++ writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); + break; -+ case SND_SOC_DAIFMT_DSP_A: -+ adciface &= 0xDC; -+ daciface &= 0xDC; -+ adciface |= 0x03; -+ daciface |= 0x03; ++ case CMD_BE: ++ cmd &= ~QSPI_CMD_PORT_SEL_MASK; + break; -+ case SND_SOC_DAIFMT_DSP_B: -+ adciface &= 0xDC; -+ daciface &= 0xDC; -+ adciface |= 0x23; -+ daciface |= 0x23; ++ case CMD_4BE: ++ cmd |= BIT(QSPI_CMD_PORT_SEL_SHIFT); + break; + default: ++ dev_err(qspi->dev, "Not support erase command:%#x\n", nor->erase_opcode); + return -EINVAL; + } + -+ /* clock inversion */ -+ switch (fmt & SND_SOC_DAIFMT_INV_MASK) { -+ case SND_SOC_DAIFMT_NB_NF: -+ iface &= 0xDF; -+ adciface &= 0xDF; -+ daciface &= 0xDF; -+ break; -+ case SND_SOC_DAIFMT_IB_IF: -+ iface |= 0x20; -+ adciface |= 0x20; -+ daciface |= 0x20; -+ break; -+ case SND_SOC_DAIFMT_IB_NF: -+ iface |= 0x20; -+ adciface &= 0xDF; -+ daciface &= 0xDF; -+ break; -+ case SND_SOC_DAIFMT_NB_IF: -+ iface &= 0xDF; -+ adciface |= 0x20; -+ daciface |= 0x20; -+ break; -+ default: -+ return -EINVAL; -+ } -+ snd_soc_component_write(component, ES8336_IFACE, iface); -+ snd_soc_component_write(component, ES8336_ADC_IFACE, adciface); -+ snd_soc_component_write(component, ES8336_DAC_IFACE, daciface); ++ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); ++ phytium_qspi_cmd_enable(qspi); ++ phytium_qspi_wait_cmd(qspi, flash); ++ + return 0; +} + -+static int es8336_pcm_startup(struct snd_pcm_substream *substream, -+ struct snd_soc_dai *dai) ++static int phytium_qspi_prep(struct spi_nor *nor) +{ -+ struct snd_soc_component *component = dai->component; -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ bool playback = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK); -+ -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0xC0); -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); -+ /* es8336: both playback and capture need dac mclk */ -+ snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, -+ ES8336_CLKMGR_MCLK_DIV_MASK | -+ ES8336_CLKMGR_DAC_MCLK_MASK, -+ ES8336_CLKMGR_MCLK_DIV_NML | -+ ES8336_CLKMGR_DAC_MCLK_EN); -+ es8336->pwr_count++; -+ -+ if (playback) { -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x3F); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x1F); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x88); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0xBB); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x10); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x30); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x02); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x00); -+ snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x66); -+ snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, -+ ES8336_CLKMGR_DAC_MCLK_MASK | -+ ES8336_CLKMGR_DAC_ANALOG_MASK, -+ ES8336_CLKMGR_DAC_MCLK_EN | -+ ES8336_CLKMGR_DAC_ANALOG_EN); -+ msleep(50); -+ } else { -+ snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0x00); -+ snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, -+ ES8336_CLKMGR_ADC_MCLK_MASK | -+ ES8336_CLKMGR_ADC_ANALOG_MASK, -+ ES8336_CLKMGR_ADC_MCLK_EN | -+ ES8336_CLKMGR_ADC_ANALOG_EN); -+ } ++ struct phytium_qspi_flash *flash = nor->priv; ++ struct phytium_qspi *qspi = flash->qspi; + ++ mutex_lock(&qspi->lock); + return 0; +} + -+static void es8336_pcm_shutdown(struct snd_pcm_substream *substream, -+ struct snd_soc_dai *dai) ++static void phytium_qspi_unprep(struct spi_nor *nor) +{ -+ struct snd_soc_component *component = dai->component; -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ bool playback = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK); -+ -+ if (playback) { -+ snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); -+ snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, -+ ES8336_CLKMGR_DAC_ANALOG_MASK, -+ ES8336_CLKMGR_DAC_ANALOG_DIS); -+ } else { -+ snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xc0); -+ snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, -+ ES8336_CLKMGR_ADC_MCLK_MASK | -+ ES8336_CLKMGR_ADC_ANALOG_MASK, -+ ES8336_CLKMGR_ADC_MCLK_DIS | -+ ES8336_CLKMGR_ADC_ANALOG_DIS); -+ } ++ struct phytium_qspi_flash *flash = nor->priv; ++ struct phytium_qspi *qspi = flash->qspi; + -+ if (--es8336->pwr_count == 0) { -+ if (!es8336->hp_inserted) -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); -+ snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); -+ } ++ mutex_unlock(&qspi->lock); +} + -+ -+static int es8336_pcm_hw_params(struct snd_pcm_substream *substream, -+ struct snd_pcm_hw_params *params, -+ struct snd_soc_dai *dai) ++static int phytium_qspi_get_flash_size(struct phytium_qspi *qspi, u32 size) +{ -+ struct snd_soc_component *component = dai->component; -+ int val = 0; ++ int ret = 0; ++ u32 value; + -+ switch (params_format(params)) { -+ case SNDRV_PCM_FORMAT_S16_LE: -+ val = ES8336_DACWL_16; ++ switch (size) { ++ case SZ_4M: ++ value = 0; ++ break; ++ case SZ_8M: ++ value = 1; ++ break; ++ case SZ_16M: ++ value = 2; + break; -+ case SNDRV_PCM_FORMAT_S20_3LE: -+ val = ES8336_DACWL_20; ++ case SZ_32M: ++ value = 3; + break; -+ case SNDRV_PCM_FORMAT_S24_LE: -+ val = ES8336_DACWL_24; ++ case SZ_64M: ++ value = 4; + break; -+ case SNDRV_PCM_FORMAT_S32_LE: -+ val = ES8336_DACWL_32; ++ case SZ_128M: ++ value = 5; + break; -+ default: -+ val = ES8336_DACWL_16; ++ case SZ_256M: ++ value = 6; ++ break; ++ case SZ_512M: ++ value = 7; + break; ++ default: ++ value = 0; ++ ret = -EINVAL; ++ return ret; + } + -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ snd_soc_component_update_bits(component, ES8336_SDP_DACFMT_REG0B, -+ ES8336_DACWL_MASK, val); -+ else -+ snd_soc_component_update_bits(component, ES8336_SDP_ADCFMT_REG0A, -+ ES8336_ADCWL_MASK, val); -+ -+ return 0; ++ return value; +} + -+static int es8336_mute(struct snd_soc_dai *dai, int mute, int direction) ++static const struct spi_nor_controller_ops phytium_controller_ops = { ++ .prepare = phytium_qspi_prep, ++ .unprepare = phytium_qspi_unprep, ++ .read_reg = phytium_qspi_read_reg, ++ .write_reg = phytium_qspi_write_reg, ++ .read = phytium_qspi_read, ++ .write = phytium_qspi_write, ++ .erase = phytium_qspi_erase, ++}; ++ ++static int phytium_qspi_flash_setup(struct phytium_qspi *qspi, struct fwnode_handle *np) +{ -+ struct snd_soc_component *component = dai->component; -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); ++ struct spi_nor_hwcaps hwcaps = { .mask = SNOR_HWCAPS_READ | SNOR_HWCAPS_READ_FAST | SNOR_HWCAPS_PP, }; ++ u32 width, presc; ++ u32 cs_num = 0; ++ u32 max_rate = 0; ++ u32 clk_div = 0; ++ u32 flash_cap = 0; ++ u32 addr_width = PHYTIUM_QSPI_1_1_1; ++ struct phytium_qspi_flash *flash; ++ struct mtd_info *mtd; ++ int ret; + -+ es8336->muted = mute; ++ fwnode_property_read_u32(np, "reg", &cs_num); ++ if (cs_num >= PHYTIUM_MAX_NORCHIP) ++ return -EINVAL; + -+ if (mute) { -+ es8336_enable_spk(es8336, false); -+ msleep(100); -+ snd_soc_component_write(component, ES8336_DAC_SET1_REG30, 0x20); -+ } ++ fwnode_property_read_u32(np, "spi-max-frequency", &max_rate); ++ if (!max_rate) ++ return -EINVAL; + -+ snd_soc_component_write(component, ES8336_DAC_SET1_REG30, 0x00); -+ msleep(130); ++ fwnode_property_read_u32(np, "spi-clk-div", &clk_div); ++ if (!clk_div) ++ clk_div = PHYTIUM_SCK_SEL; + -+ if (!es8336->hp_inserted) -+ es8336_enable_spk(es8336, true); ++ if (clk_div < 4) ++ return -EINVAL; + -+ return 0; -+} ++ presc = DIV_ROUND_UP(qspi->clk_rate, max_rate) - 1; + -+static int es8336_set_bias_level(struct snd_soc_component *component, -+ enum snd_soc_bias_level level) -+{ -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); ++ fwnode_property_read_u32(np, "spi-rx-bus-width", &width); ++ if (!width) ++ width = 1; + -+ switch (level) { -+ case SND_SOC_BIAS_ON: -+ break; ++ if (width == 4) { ++ hwcaps.mask |= SNOR_HWCAPS_READ_1_1_4; ++ addr_width = PHYTIUM_QSPI_1_1_4; ++ } else if (width == 2) { ++ hwcaps.mask |= SNOR_HWCAPS_READ_1_1_2; ++ addr_width = PHYTIUM_QSPI_1_1_2; ++ } else if (width != 1) ++ return -EINVAL; + -+ case SND_SOC_BIAS_PREPARE: -+ break; ++ flash = &qspi->flash[cs_num]; + -+ case SND_SOC_BIAS_STANDBY: -+ break; ++ flash->qspi = qspi; ++ flash->cs = cs_num; ++ flash->presc = presc; ++ flash->clk_div = clk_div; ++ flash->addr_width = addr_width; ++ flash->nor.dev = qspi->dev; ++ if (qspi->dev->of_node) ++ spi_nor_set_flash_node(&flash->nor, qspi->dev->of_node); ++ flash->nor.priv = flash; ++ flash->nor.controller_ops = &phytium_controller_ops; + -+ case SND_SOC_BIAS_OFF: -+ snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); -+ snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); -+ if (!es8336->hp_inserted) -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x3F); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x1F); -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0x00); -+ break; ++ ret = spi_nor_scan(&flash->nor, NULL, &hwcaps); ++ if (ret) { ++ dev_err(qspi->dev, "device scan failed\n"); ++ return ret; + } + -+ return 0; -+} ++ mtd = &flash->nor.mtd; + -+#define es8336_RATES SNDRV_PCM_RATE_8000_96000 ++ flash->fsize = mtd->size; ++ flash->prefetch_limit = mtd->size - PHYTIUM_QSPI_FIFO_SZ; + -+#define es8336_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ -+ SNDRV_PCM_FMTBIT_S24_LE) ++ ret = phytium_qspi_get_flash_size(flash->qspi, mtd->size); ++ if (ret < 0) { ++ dev_err(qspi->dev, "flash size invalid\n"); ++ return ret; ++ } + -+static const struct snd_soc_dai_ops es8336_ops = { -+ .startup = es8336_pcm_startup, -+ .hw_params = es8336_pcm_hw_params, -+ .set_fmt = es8336_set_dai_fmt, -+ .set_sysclk = es8336_set_dai_sysclk, -+ .mute_stream = es8336_mute, -+ .shutdown = es8336_pcm_shutdown, -+}; ++ flash_cap = cs_num << QSPI_FLASH_CAP_NUM_SHIFT; ++ flash_cap |= ret; ++ writel_relaxed(flash_cap, qspi->io_base + QSPI_FLASH_CAP_REG); + -+static struct snd_soc_dai_driver es8336_dai = { -+ .name = "es8336-hifi", -+ .playback = { -+ .stream_name = "Playback", -+ .channels_min = 1, -+ .channels_max = 2, -+ .rates = es8336_RATES, -+ .formats = es8336_FORMATS, -+ }, -+ .capture = { -+ .stream_name = "Capture", -+ .channels_min = 1, -+ .channels_max = 2, -+ .rates = es8336_RATES, -+ .formats = es8336_FORMATS, -+ }, -+ .ops = &es8336_ops, -+ .symmetric_rates = 1, -+}; ++ flash->read_mode = PHYTIUM_FMODE_MM; + -+static int es8336_init_regs(struct snd_soc_component *component) -+{ -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0x3f); -+ usleep_range(5000, 5500); -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0x00); -+ snd_soc_component_write(component, ES8336_SYS_VMIDSEL_REG0C, 0xFF); -+ msleep(30); -+ snd_soc_component_write(component, ES8336_CLKMGR_CLKSEL_REG02, 0x08); -+ snd_soc_component_write(component, ES8336_CLKMGR_ADCOSR_REG03, 0x20); -+ snd_soc_component_write(component, ES8336_CLKMGR_ADCDIV1_REG04, 0x11); -+ snd_soc_component_write(component, ES8336_CLKMGR_ADCDIV2_REG05, 0x00); -+ snd_soc_component_write(component, ES8336_CLKMGR_DACDIV1_REG06, 0x11); -+ snd_soc_component_write(component, ES8336_CLKMGR_DACDIV2_REG07, 0x00); -+ snd_soc_component_write(component, ES8336_CLKMGR_CPDIV_REG08, 0x00); -+ snd_soc_component_write(component, ES8336_SDP_MS_BCKDIV_REG09, 0x04); -+ snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0x7F); -+ snd_soc_component_write(component, ES8336_CAL_TYPE_REG1C, 0x0F); -+ snd_soc_component_write(component, ES8336_CAL_HPLIV_REG1E, 0x90); -+ snd_soc_component_write(component, ES8336_CAL_HPRIV_REG1F, 0x90); -+ snd_soc_component_write(component, ES8336_ADC_VOLUME_REG27, 0x00); -+ snd_soc_component_write(component, ES8336_ADC_PDN_LINSEL_REG22, es8336->mic_src); -+ snd_soc_component_write(component, ES8336_ADC_D2SEPGA_REG24, 0x00); -+ snd_soc_component_write(component, ES8336_ADC_DMIC_REG25, 0x08); -+ snd_soc_component_write(component, ES8336_DAC_SET2_REG31, 0x20); -+ snd_soc_component_write(component, ES8336_DAC_SET3_REG32, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_VOLL_REG33, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_VOLR_REG34, 0x00); -+ snd_soc_component_write(component, ES8336_SDP_ADCFMT_REG0A, 0x00); -+ snd_soc_component_write(component, ES8336_SDP_DACFMT_REG0B, 0x00); -+ snd_soc_component_write(component, ES8336_SYS_VMIDLOW_REG10, 0x11); -+ snd_soc_component_write(component, ES8336_SYS_VSEL_REG11, 0xFC); -+ snd_soc_component_write(component, ES8336_SYS_REF_REG12, 0x28); -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x04); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x0C); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); -+ snd_soc_component_write(component, ES8336_HPMIX_SEL_REG13, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x88); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0xBB); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x10); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x30); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x02); -+ snd_soc_component_write(component, ES8336_CPHP_ICAL_VOL_REG18, 0x00); -+ snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); -+ snd_soc_component_write(component, ES8336_GPIO_DEBUNCE_INT_REG4E, 0x02); -+ snd_soc_component_write(component, ES8336_TESTMODE_REG50, 0xA0); -+ snd_soc_component_write(component, ES8336_TEST1_REG51, 0x00); -+ snd_soc_component_write(component, ES8336_TEST2_REG52, 0x00); -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0xC0); -+ msleep(50); -+ snd_soc_component_write(component, ES8336_ADC_PGAGAIN_REG23, 0x60); -+ snd_soc_component_write(component, ES8336_ADC_D2SEPGA_REG24, 0x01); -+ /* adc ds mode, HPF enable */ -+ snd_soc_component_write(component, ES8336_ADC_DMIC_REG25, 0x08); -+ snd_soc_component_write(component, ES8336_ADC_ALC1_REG29, 0xcd); -+ snd_soc_component_write(component, ES8336_ADC_ALC2_REG2A, 0x08); -+ snd_soc_component_write(component, ES8336_ADC_ALC3_REG2B, 0xa0); -+ snd_soc_component_write(component, ES8336_ADC_ALC4_REG2C, 0x05); -+ snd_soc_component_write(component, ES8336_ADC_ALC5_REG2D, 0x06); -+ snd_soc_component_write(component, ES8336_ADC_ALC6_REG2E, 0x61); -+ return 0; -+} ++ ret = mtd_device_register(mtd, NULL, 0); ++ if (ret) { ++ dev_err(qspi->dev, "mtd device parse failed\n"); ++ return ret; ++ } + -+static int es8336_suspend(struct snd_soc_component *component) -+{ -+ return 0; -+} ++ flash->registered = true; + -+static int es8336_resume(struct snd_soc_component *component) -+{ -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ int ret; ++ dev_dbg(qspi->dev, "read mm:%s %px cs:%d bus:%d clk-div:%d\n", ++ flash->read_mode == PHYTIUM_FMODE_MM ? "yes" : "no", ++ qspi->mm_base, cs_num, width, clk_div); ++ ++ dev_dbg(qspi->dev, "mtd->size:%llx, mtd->erasesize:%x, fsize:%x\n", ++ mtd->size, mtd->erasesize, flash->fsize); + -+ es8336_reset(component); /* UPDATED BY DAVID,15-3-5 */ -+ ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); -+ if (!ret) { -+ es8336_init_regs(component); -+ snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); -+ /* max debance time, enable interrupt, low active */ -+ snd_soc_component_write(component, ES8336_GPIO_DEBUNCE_INT_REG4E, 0xf3); -+ /* es8336_set_bias_level(component, SND_SOC_BIAS_OFF); */ -+ snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); -+ if (!es8336->hp_inserted) -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); -+ snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); -+ snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); -+ } + return 0; +} + -+static irqreturn_t es8336_irq_handler(int irq, void *data) ++static void phytium_qspi_mtd_free(struct phytium_qspi *qspi) +{ -+ struct es8336_priv *es8336 = data; -+ -+ queue_delayed_work(system_power_efficient_wq, &es8336->work, -+ msecs_to_jiffies(es8336->debounce_time)); ++ int i; + -+ return IRQ_HANDLED; ++ for (i = 0; i < PHYTIUM_MAX_NORCHIP; i++) ++ if (qspi->flash[i].registered) ++ mtd_device_unregister(&qspi->flash[i].nor.mtd); +} + -+static void hp_work(struct work_struct *work) ++static ssize_t clk_div_show(struct device *dev, struct device_attribute *attr, ++ char *buf) +{ -+ struct es8336_priv *es8336; -+ -+ es8336 = container_of(work, struct es8336_priv, work.work); ++ struct phytium_qspi *qspi = dev_get_drvdata(dev); ++ struct phytium_qspi_flash *flash = &qspi->flash[0]; + -+ es8336->hp_inserted = gpiod_get_value(es8336->hp_det_gpio); -+ if (!es8336->muted) { -+ if (es8336->hp_inserted) -+ es8336_enable_spk(es8336, false); -+ else -+ es8336_enable_spk(es8336, true); -+ } ++ return sprintf(buf, "Flash 0 clk-div: %d\n", flash->clk_div); +} + -+static int es8336_probe(struct snd_soc_component *component) ++static ssize_t clk_div_store(struct device *dev, ++ struct device_attribute *attr, const char *buf, ++ size_t size) +{ -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ int ret = 0; ++ struct phytium_qspi *qspi = dev_get_drvdata(dev); ++ struct phytium_qspi_flash *flash = &qspi->flash[0]; ++ long value; ++ char *token; ++ ssize_t status; + -+ es8336_component = component; -+ ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); -+ if (!ret) { -+ es8336_reset(component); /* UPDATED BY DAVID,15-3-5 */ -+ ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); -+ if (!ret) { -+ es8336_init_regs(component); -+ snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); -+ /* max debance time, enable interrupt, low active */ -+ snd_soc_component_write(component, -+ ES8336_GPIO_DEBUNCE_INT_REG4E, 0xf3); ++ token = strsep ((char **)&buf, " "); ++ if (!token) ++ return -EINVAL; + -+ /* es8336_set_bias_level(codec, SND_SOC_BIAS_OFF); */ -+ snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); -+ if (!es8336->hp_inserted) -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, -+ 0x3F); -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); -+ snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); -+ snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); -+ } -+ } ++ status = kstrtol(token, 0, &value); ++ if (status) ++ return status; + -+ return ret; -+} ++ flash->clk_div = (u8)value; + -+static void es8336_remove(struct snd_soc_component *component) -+{ -+ es8336_set_bias_level(component, SND_SOC_BIAS_OFF); ++ return size; +} ++static DEVICE_ATTR_RW(clk_div); + -+const struct regmap_config es8336_regmap_config = { -+ .reg_bits = 8, -+ .val_bits = 8, -+ .max_register = ES8336_TEST3_REG53, -+ .cache_type = REGCACHE_RBTREE, -+ .reg_defaults = es8336_reg_defaults, -+ .num_reg_defaults = ARRAY_SIZE(es8336_reg_defaults), ++static struct attribute *phytium_qspi_attrs[] = { ++ &dev_attr_clk_div.attr, ++ NULL, +}; + -+static const struct snd_soc_component_driver soc_component_dev_es8336 = { -+ .probe = es8336_probe, -+ .remove = es8336_remove, -+ .suspend = es8336_suspend, -+ .resume = es8336_resume, -+ .set_bias_level = es8336_set_bias_level, -+ -+ .controls = es8336_snd_controls, -+ .num_controls = ARRAY_SIZE(es8336_snd_controls), -+ .dapm_widgets = es8336_dapm_widgets, -+ .num_dapm_widgets = ARRAY_SIZE(es8336_dapm_widgets), -+ .dapm_routes = es8336_dapm_routes, -+ .num_dapm_routes = ARRAY_SIZE(es8336_dapm_routes), ++static struct attribute_group phytium_qspi_attr_group = { ++ .attrs = phytium_qspi_attrs, +}; + -+static int es8336_i2c_probe(struct i2c_client *i2c, -+ const struct i2c_device_id *id) ++static int phytium_qspi_probe(struct platform_device *pdev) +{ -+ struct es8336_priv *es8336; -+ int ret = -1; -+ int hp_irq; ++ struct device *dev = &pdev->dev; ++ struct fwnode_handle *flash_np; ++ struct phytium_qspi *qspi; ++ struct resource *res; ++ int ret; + -+ es8336 = devm_kzalloc(&i2c->dev, sizeof(*es8336), GFP_KERNEL); -+ if (!es8336) ++ qspi = devm_kzalloc(dev, sizeof(*qspi), GFP_KERNEL); ++ if (!qspi) + return -ENOMEM; + -+ es8336->debounce_time = 200; -+ es8336->pwr_count = 0; -+ es8336->hp_inserted = false; -+ es8336->muted = true; ++ qspi->nor_num = device_get_child_node_count(dev); ++ if (!qspi->nor_num || qspi->nor_num > PHYTIUM_MAX_NORCHIP) ++ return -ENODEV; + -+ es8336->regmap = devm_regmap_init_i2c(i2c, &es8336_regmap_config); -+ if (IS_ERR(es8336->regmap)) { -+ ret = PTR_ERR(es8336->regmap); -+ dev_err(&i2c->dev, "Failed to init regmap: %d\n", ret); -+ return ret; ++ if (dev->of_node) ++ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi"); ++ else if (has_acpi_companion(dev)) { ++ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + } ++ qspi->io_base = devm_ioremap_resource(dev, res); ++ if (IS_ERR(qspi->io_base)) ++ return PTR_ERR(qspi->io_base); ++ ++ ++ if (dev->of_node) ++ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi_mm"); ++ else if (has_acpi_companion(dev)) ++ res = platform_get_resource(pdev, IORESOURCE_MEM, 1); ++ ++ qspi->mm_base = devm_ioremap_resource(dev, res); ++ if (IS_ERR(qspi->mm_base)) ++ return PTR_ERR(qspi->mm_base); ++ ++ qspi->mm_size = resource_size(res); ++ ++ if (dev->of_node) { ++ qspi->clk = devm_clk_get(dev, NULL); ++ if (IS_ERR(qspi->clk)) ++ return PTR_ERR(qspi->clk); + -+ i2c_set_clientdata(i2c, es8336); ++ qspi->clk_rate = clk_get_rate(qspi->clk); ++ if (!qspi->clk_rate) ++ return -EINVAL; + -+ es8336->spk_ctl_gpio = devm_gpiod_get_index_optional(&i2c->dev, "sel", 0, -+ GPIOD_OUT_HIGH); -+ ret = of_property_read_u8(i2c->dev.of_node, "mic-src", &es8336->mic_src); -+ if (ret != 0) { -+ dev_dbg(&i2c->dev, "mic1-src return %d", ret); -+ es8336->mic_src = 0x20; ++ ret = clk_prepare_enable(qspi->clk); ++ if (ret) { ++ dev_err(dev, "can not enable the clock\n"); ++ return ret; ++ } ++ } ++ else if (has_acpi_companion(dev)) { /* ACPI table not pass clk rate */ ++ qspi->clk_rate = 50000000; + } -+ dev_dbg(&i2c->dev, "mic1-src %x", es8336->mic_src); -+ -+ if (IS_ERR_OR_NULL(es8336->spk_ctl_gpio)) -+ dev_info(&i2c->dev, "Can not get spk_ctl_gpio\n"); -+ else -+ es8336_enable_spk(es8336, false); + -+ es8336->hp_det_gpio = devm_gpiod_get_index_optional(&i2c->dev, "det", 0, -+ GPIOD_IN); ++ qspi->dev = dev; ++ platform_set_drvdata(pdev, qspi); ++ mutex_init(&qspi->lock); ++ spin_lock_init(&qspi->spinlock); + -+ if (IS_ERR_OR_NULL(es8336->hp_det_gpio)) { -+ dev_info(&i2c->dev, "Can not get hp_det_gpio\n"); -+ } else { -+ INIT_DELAYED_WORK(&es8336->work, hp_work); -+ hp_irq = gpiod_to_irq(es8336->hp_det_gpio); -+ ret = devm_request_threaded_irq(&i2c->dev, hp_irq, NULL, -+ es8336_irq_handler, -+ IRQF_TRIGGER_FALLING | -+ IRQF_TRIGGER_RISING | -+ IRQF_ONESHOT, -+ "es8336_interrupt", es8336); -+ if (ret < 0) { -+ dev_err(&i2c->dev, "request_irq failed: %d\n", ret); -+ return ret; ++ fwnode_for_each_available_child_node(dev_fwnode(dev), flash_np) { ++ ret = phytium_qspi_flash_setup(qspi, flash_np); ++ if (ret) { ++ dev_err(dev, "unable to setup flash chip\n"); ++ goto err_flash; + } ++ } + -+ schedule_delayed_work(&es8336->work, -+ msecs_to_jiffies(es8336->debounce_time)); ++ ret = sysfs_create_group(&qspi->dev->kobj, &phytium_qspi_attr_group); ++ if (ret) { ++ dev_err(dev, "unable to create sysfs\n"); ++ goto err_flash; + } + -+ ret = snd_soc_register_component(&i2c->dev, -+ &soc_component_dev_es8336, -+ &es8336_dai, 1); ++ return 0; ++ ++err_flash: ++ mutex_destroy(&qspi->lock); ++ phytium_qspi_mtd_free(qspi); + ++ clk_disable_unprepare(qspi->clk); + return ret; +} + -+static int es8336_i2c_remove(struct i2c_client *client) ++static int phytium_qspi_remove(struct platform_device *pdev) +{ -+ kfree(i2c_get_clientdata(client)); -+ return 0; -+} ++ struct phytium_qspi *qspi = platform_get_drvdata(pdev); + -+static void es8336_i2c_shutdown(struct i2c_client *client) -+{ -+ struct es8336_priv *es8336 = i2c_get_clientdata(client); ++ sysfs_remove_group(&qspi->dev->kobj, &phytium_qspi_attr_group); + -+ if (es8336_component != NULL) { -+ es8336_enable_spk(es8336, false); -+ msleep(20); -+ es8336_set_bias_level(es8336_component, SND_SOC_BIAS_OFF); -+ } ++ phytium_qspi_mtd_free(qspi); ++ mutex_destroy(&qspi->lock); ++ ++ clk_disable_unprepare(qspi->clk); ++ return 0; +} + -+static const struct i2c_device_id es8336_i2c_id[] = { -+ {"es8336", 0}, -+ {"10ES8336:00", 0}, -+ {"10ES8336", 0}, -+ { } ++#ifdef CONFIG_ACPI ++static const struct acpi_device_id phytium_qspi_acpi_ids[] = { ++ { "PHYT0011", 0 }, ++ { /* sentinel */ }, +}; -+MODULE_DEVICE_TABLE(i2c, es8336_i2c_id); ++MODULE_DEVICE_TABLE(acpi, phytium_qspi_acpi_ids); ++#endif + -+static const struct of_device_id es8336_of_match[] = { -+ { .compatible = "everest,es8336", }, ++static const struct of_device_id phytium_qspi_match[] = { ++ { .compatible = "phytium,qspi" }, + { } +}; -+MODULE_DEVICE_TABLE(of, es8336_of_match); ++MODULE_DEVICE_TABLE(of, phytium_qspi_match); + -+static const struct acpi_device_id es8336_acpi_match[] = { -+ { "ESSX8336", 0}, -+ { } ++static struct platform_driver phytium_qspi_driver = { ++ .probe = phytium_qspi_probe, ++ .remove = phytium_qspi_remove, ++ .driver = { ++ .name = "phytium-quadspi", ++ .of_match_table = phytium_qspi_match, ++ .acpi_match_table = ACPI_PTR(phytium_qspi_acpi_ids), ++ }, +}; -+MODULE_DEVICE_TABLE(acpi, es8336_acpi_match); ++module_platform_driver(phytium_qspi_driver); + -+static struct i2c_driver es8336_i2c_driver = { -+ .driver = { -+ .name = "es8336", -+ .of_match_table = es8336_of_match, -+ .acpi_match_table = es8336_acpi_match, -+ }, -+ .probe = es8336_i2c_probe, -+ .remove = es8336_i2c_remove, -+ .shutdown = es8336_i2c_shutdown, -+ .id_table = es8336_i2c_id, ++MODULE_AUTHOR("Mingshuai Zhu "); ++MODULE_AUTHOR("Shaojun Yang "); ++MODULE_DESCRIPTION("Phytium QuadSPI driver"); ++MODULE_LICENSE("GPL v2"); +diff --git a/drivers/mtd/spi-nor/core.c b/drivers/mtd/spi-nor/core.c +index 09e112f37..0e95d7759 100644 +--- a/drivers/mtd/spi-nor/core.c ++++ b/drivers/mtd/spi-nor/core.c +@@ -2038,6 +2038,7 @@ static const struct spi_nor_manufacturer *manufacturers[] = { + &spi_nor_winbond, + &spi_nor_xilinx, + &spi_nor_xmc, ++ &spi_nor_boya, + }; + + static const struct flash_info * +diff --git a/drivers/mtd/spi-nor/core.h b/drivers/mtd/spi-nor/core.h +index 788775bb6..16a0e3a53 100644 +--- a/drivers/mtd/spi-nor/core.h ++++ b/drivers/mtd/spi-nor/core.h +@@ -398,6 +398,7 @@ extern const struct spi_nor_manufacturer spi_nor_sst; + extern const struct spi_nor_manufacturer spi_nor_winbond; + extern const struct spi_nor_manufacturer spi_nor_xilinx; + extern const struct spi_nor_manufacturer spi_nor_xmc; ++extern const struct spi_nor_manufacturer spi_nor_boya; + + int spi_nor_write_enable(struct spi_nor *nor); + int spi_nor_write_disable(struct spi_nor *nor); +diff --git a/drivers/net/ethernet/cadence/Kconfig b/drivers/net/ethernet/cadence/Kconfig +index e432a68ac..0fb01824d 100644 +--- a/drivers/net/ethernet/cadence/Kconfig ++++ b/drivers/net/ethernet/cadence/Kconfig +@@ -50,4 +50,10 @@ config MACB_PCI + To compile this driver as a module, choose M here: the module + will be called macb_pci. + ++config MACB_TSN ++ bool "TSN supports" ++ depends on MACB ++ help ++ This is TSN supports for MACB driver. ++ + endif # NET_VENDOR_CADENCE +diff --git a/drivers/net/ethernet/cadence/Makefile b/drivers/net/ethernet/cadence/Makefile +index 1f33cdca9..a48a4318d 100644 +--- a/drivers/net/ethernet/cadence/Makefile ++++ b/drivers/net/ethernet/cadence/Makefile +@@ -8,5 +8,9 @@ ifeq ($(CONFIG_MACB_USE_HWSTAMP),y) + macb-y += macb_ptp.o + endif + ++ifeq ($(CONFIG_MACB_TSN),y) ++macb-y += macb_tsn.o ++endif ++ + obj-$(CONFIG_MACB) += macb.o + obj-$(CONFIG_MACB_PCI) += macb_pci.o +diff --git a/drivers/net/ethernet/cadence/macb.h b/drivers/net/ethernet/cadence/macb.h +index 5de47f6fd..5f2395bac 100644 +--- a/drivers/net/ethernet/cadence/macb.h ++++ b/drivers/net/ethernet/cadence/macb.h +@@ -9,6 +9,7 @@ + + #include + #include ++#include + #include + #include + #include +@@ -17,6 +18,12 @@ + #define MACB_EXT_DESC + #endif + ++enum irq_type { ++ IRQ_TYPE_INTX = 1, ++ IRQ_TYPE_MSI = 2, ++ IRQ_TYPE_MAX = 3, +}; + -+module_i2c_driver(es8336_i2c_driver); -+MODULE_DESCRIPTION("ASoC es8336 driver"); -+MODULE_LICENSE("GPL"); -diff --git a/sound/soc/codecs/es8336.h b/sound/soc/codecs/es8336.h -new file mode 100644 -index 000000000..d2c74c11f ---- /dev/null -+++ b/sound/soc/codecs/es8336.h -@@ -0,0 +1,161 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Copyright Everest Semiconductor Co.,Ltd -+ * Phytium Information Technology Co.,Ltd -+ * -+ * Author: David Yang -+ * Yiqun Zhang -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 as -+ * published by the Free Software Foundation. -+ * -+ */ + #define MACB_GREGS_NBR 16 + #define MACB_GREGS_VERSION 2 + #define MACB_MAX_QUEUES 8 +@@ -77,10 +84,13 @@ + #define MACB_RBQPH 0x04D4 + + /* GEM register offsets. */ ++#define GEM_NCR 0x0000 /* Network Control */ + #define GEM_NCFGR 0x0004 /* Network Config */ + #define GEM_USRIO 0x000c /* User IO */ + #define GEM_DMACFG 0x0010 /* DMA Configuration */ + #define GEM_JML 0x0048 /* Jumbo Max Length */ ++#define GEM_HS_MAC_CONFIG 0x0050 /* GEM high speed config */ ++#define GEM_AXI_PIPE 0x0054 /* Axi max pipeline register*/ + #define GEM_HRB 0x0080 /* Hash Bottom */ + #define GEM_HRT 0x0084 /* Hash Top */ + #define GEM_SA1B 0x0088 /* Specific1 Bottom */ +@@ -157,6 +167,7 @@ + #define GEM_PEFTN 0x01f4 /* PTP Peer Event Frame Tx Ns */ + #define GEM_PEFRSL 0x01f8 /* PTP Peer Event Frame Rx Sec Low */ + #define GEM_PEFRN 0x01fc /* PTP Peer Event Frame Rx Ns */ ++#define GEM_PCSCNTRL 0x0200 /* PCS Control */ + #define GEM_DCFG1 0x0280 /* Design Config 1 */ + #define GEM_DCFG2 0x0284 /* Design Config 2 */ + #define GEM_DCFG3 0x0288 /* Design Config 3 */ +@@ -166,6 +177,10 @@ + #define GEM_DCFG7 0x0298 /* Design Config 7 */ + #define GEM_DCFG8 0x029C /* Design Config 8 */ + #define GEM_DCFG10 0x02A4 /* Design Config 10 */ ++#define GEM_DCFG12 0x02AC /* Design Config 12 */ ++#define GEM_USX_CONTROL 0x0A80 /* High speed PCS control register */ ++#define GEM_USX_STATUS 0x0A88 /* High speed PCS status register */ ++#define GEM_TAIL_ENABLE 0x0E7C /* Phytium: Enable tail */ + + #define GEM_TXBDCTRL 0x04cc /* TX Buffer Descriptor control register */ + #define GEM_RXBDCTRL 0x04d0 /* RX Buffer Descriptor control register */ +@@ -200,6 +215,37 @@ + #define GEM_IER(hw_q) (0x0600 + ((hw_q) << 2)) + #define GEM_IDR(hw_q) (0x0620 + ((hw_q) << 2)) + #define GEM_IMR(hw_q) (0x0640 + ((hw_q) << 2)) ++#define GEM_TAIL(hw_q) (0x0e80 + ((hw_q) << 2)) /* Phytium: tail register */ ++#define GEM_SRC_SEL_LN 0x1C04 ++#define GEM_DIV_SEL0_LN 0x1C08 ++#define GEM_DIV_SEL1_LN 0x1C0C ++#define GEM_PMA_XCVR_POWER_STATE 0x1C10 ++#define GEM_SPEED_MODE 0x1C14 ++#define GEM_MII_SELECT 0x1C18 ++#define GEM_SEL_MII_ON_RGMII 0x1C1C ++#define GEM_TX_CLK_SEL0 0x1C20 ++#define GEM_TX_CLK_SEL1 0x1C24 ++#define GEM_TX_CLK_SEL2 0x1C28 ++#define GEM_TX_CLK_SEL3 0x1C2C ++#define GEM_RX_CLK_SEL0 0x1C30 ++#define GEM_RX_CLK_SEL1 0x1C34 ++#define GEM_CLK_250M_DIV10_DIV100_SEL 0x1C38 ++#define GEM_TX_CLK_SEL5 0x1C3C ++#define GEM_TX_CLK_SEL6 0x1C40 ++#define GEM_RX_CLK_SEL4 0x1C44 ++#define GEM_RX_CLK_SEL5 0x1C48 ++#define GEM_TX_CLK_SEL3_0 0x1C70 ++#define GEM_TX_CLK_SEL4_0 0x1C74 ++#define GEM_RX_CLK_SEL3_0 0x1C78 ++#define GEM_RX_CLK_SEL4_0 0x1C7C ++#define GEM_RGMII_TX_CLK_SEL0 0x1C80 ++#define GEM_RGMII_TX_CLK_SEL1 0x1C84 + -+#ifndef _ES8336_H -+#define _ES8336_H ++#define GEM_PHY_INT_ENABLE 0x1C88 ++#define GEM_PHY_INT_CLEAR 0x1C8C ++#define GEM_PHY_INT_STATE 0x1C90 + -+/* ES8336 register space */ -+/* -+ * RESET Control -+ */ -+#define ES8336_RESET_REG00 0x00 -+/* -+ * Clock Managerment -+ */ -+#define ES8336_CLKMGR_CLKSW_REG01 0x01 -+#define ES8336_CLKMGR_CLKSEL_REG02 0x02 -+#define ES8336_CLKMGR_ADCOSR_REG03 0x03 -+#define ES8336_CLKMGR_ADCDIV1_REG04 0x04 -+#define ES8336_CLKMGR_ADCDIV2_REG05 0x05 -+#define ES8336_CLKMGR_DACDIV1_REG06 0x06 -+#define ES8336_CLKMGR_DACDIV2_REG07 0x07 -+#define ES8336_CLKMGR_CPDIV_REG08 0x08 -+/* -+ * SDP Control -+ */ -+#define ES8336_SDP_MS_BCKDIV_REG09 0x09 -+#define ES8336_SDP_ADCFMT_REG0A 0x0a -+#define ES8336_SDP_DACFMT_REG0B 0x0b -+/* -+ * System Control -+ */ -+#define ES8336_SYS_VMIDSEL_REG0C 0x0c -+#define ES8336_SYS_PDN_REG0D 0x0d -+#define ES8336_SYS_LP1_REG0E 0x0e -+#define ES8336_SYS_LP2_REG0F 0x0f -+#define ES8336_SYS_VMIDLOW_REG10 0x10 -+#define ES8336_SYS_VSEL_REG11 0x11 -+#define ES8336_SYS_REF_REG12 0x12 -+/* -+ * HP Mixer -+ */ -+#define ES8336_HPMIX_SEL_REG13 0x13 -+#define ES8336_HPMIX_SWITCH_REG14 0x14 -+#define ES8336_HPMIX_PDN_REG15 0x15 -+#define ES8336_HPMIX_VOL_REG16 0x16 -+/* -+ * Charge Pump Headphone driver -+ */ -+#define ES8336_CPHP_OUTEN_REG17 0x17 -+#define ES8336_CPHP_ICAL_VOL_REG18 0x18 -+#define ES8336_CPHP_PDN1_REG19 0x19 -+#define ES8336_CPHP_PDN2_REG1A 0x1a -+#define ES8336_CPHP_LDOCTL_REG1B 0x1b -+/* -+ * Calibration -+ */ -+#define ES8336_CAL_TYPE_REG1C 0x1c -+#define ES8336_CAL_SET_REG1D 0x1d -+#define ES8336_CAL_HPLIV_REG1E 0x1e -+#define ES8336_CAL_HPRIV_REG1F 0x1f -+#define ES8336_CAL_HPLMV_REG20 0x20 -+#define ES8336_CAL_HPRMV_REG21 0x21 -+/* -+ * ADC Control -+ */ -+#define ES8336_ADC_PDN_LINSEL_REG22 0x22 -+#define ES8336_ADC_PGAGAIN_REG23 0x23 -+#define ES8336_ADC_D2SEPGA_REG24 0x24 -+#define ES8336_ADC_DMIC_REG25 0x25 -+#define ES8336_ADC_MUTE_REG26 0x26 -+#define ES8336_ADC_VOLUME_REG27 0x27 -+#define ES8336_ADC_ALC1_REG29 0x29 -+#define ES8336_ADC_ALC2_REG2A 0x2a -+#define ES8336_ADC_ALC3_REG2B 0x2b -+#define ES8336_ADC_ALC4_REG2C 0x2c -+#define ES8336_ADC_ALC5_REG2D 0x2d -+#define ES8336_ADC_ALC6_REG2E 0x2e -+/* -+ * DAC Control -+ */ -+#define ES8336_DAC_PDN_REG2F 0x2f -+#define ES8336_DAC_SET1_REG30 0x30 -+#define ES8336_DAC_SET2_REG31 0x31 -+#define ES8336_DAC_SET3_REG32 0x32 -+#define ES8336_DAC_VOLL_REG33 0x33 -+#define ES8336_DAC_VOLR_REG34 0x34 -+/* -+ * GPIO -+ */ -+#define ES8336_GPIO_SEL_REG4D 0x4D -+#define ES8336_GPIO_DEBUNCE_INT_REG4E 0x4E -+#define ES8336_GPIO_FLAG 0x4F -+/* -+ * TEST MODE -+ */ -+#define ES8336_TESTMODE_REG50 0x50 -+#define ES8336_TEST1_REG51 0x51 -+#define ES8336_TEST2_REG52 0x52 -+#define ES8336_TEST3_REG53 0x53 ++#define GEM_INTX_IRQ_MASK 0x1C7C /* Phytium: irq mask */ + + /* Bitfields in NCR */ + #define MACB_LB_OFFSET 0 /* reserved */ +@@ -231,6 +277,8 @@ + #define MACB_SRTSM_OFFSET 15 + #define MACB_OSSMODE_OFFSET 24 /* Enable One Step Synchro Mode */ + #define MACB_OSSMODE_SIZE 1 ++#define MACB_2PT5G_OFFSET 29 /* 2.5G operation selected */ ++#define MACB_2PT5G_SIZE 1 + + /* Bitfields in NCFGR */ + #define MACB_SPD_OFFSET 0 /* Speed */ +@@ -272,11 +320,19 @@ + #define MACB_IRXFCS_OFFSET 19 + #define MACB_IRXFCS_SIZE 1 + ++/* GEM specific NCR bitfields. */ ++#define GEM_ENABLE_HS_MAC_OFFSET 31 ++#define GEM_ENABLE_HS_MAC_SIZE 1 + -+#define ES8336_IFACE ES8336_SDP_MS_BCKDIV_REG09 -+#define ES8336_ADC_IFACE ES8336_SDP_ADCFMT_REG0A -+#define ES8336_DAC_IFACE ES8336_SDP_DACFMT_REG0B + /* GEM specific NCFGR bitfields. */ ++#define GEM_FD_OFFSET 1 /* Full duplex */ ++#define GEM_FD_SIZE 1 + #define GEM_GBE_OFFSET 10 /* Gigabit mode enable */ + #define GEM_GBE_SIZE 1 + #define GEM_PCSSEL_OFFSET 11 + #define GEM_PCSSEL_SIZE 1 ++#define GEM_PAE_OFFSET 13 /* Pause enable */ ++#define GEM_PAE_SIZE 1 + #define GEM_CLK_OFFSET 18 /* MDC clock division */ + #define GEM_CLK_SIZE 3 + #define GEM_DBW_OFFSET 21 /* Data bus width */ +@@ -461,11 +517,21 @@ + #define MACB_REV_OFFSET 0 + #define MACB_REV_SIZE 16 + ++/* Bitfield in HS_MAC_CONFIG */ ++#define GEM_HS_MAC_SPEED_OFFSET 0 ++#define GEM_HS_MAC_SPEED_SIZE 3 + -+#define ES8336_REGNUM 84 ++/* Bitfields in PCSCNTRL */ ++#define GEM_PCSAUTONEG_OFFSET 12 ++#define GEM_PCSAUTONEG_SIZE 1 + -+/* REGISTER 0X01 CLOCK MANAGER */ -+#define ES8336_CLKMGR_MCLK_DIV_MASK (0X1<<7) -+#define ES8336_CLKMGR_MCLK_DIV_NML (0X0<<7) -+#define ES8336_CLKMGR_MCLK_DIV_1 (0X1<<7) -+#define ES8336_CLKMGR_ADC_MCLK_MASK (0X1<<3) -+#define ES8336_CLKMGR_ADC_MCLK_EN (0X1<<3) -+#define ES8336_CLKMGR_ADC_MCLK_DIS (0X0<<3) -+#define ES8336_CLKMGR_DAC_MCLK_MASK (0X1<<2) -+#define ES8336_CLKMGR_DAC_MCLK_EN (0X1<<2) -+#define ES8336_CLKMGR_DAC_MCLK_DIS (0X0<<2) -+#define ES8336_CLKMGR_ADC_ANALOG_MASK (0X1<<1) -+#define ES8336_CLKMGR_ADC_ANALOG_EN (0X1<<1) -+#define ES8336_CLKMGR_ADC_ANALOG_DIS (0X0<<1) -+#define ES8336_CLKMGR_DAC_ANALOG_MASK (0X1<<0) -+#define ES8336_CLKMGR_DAC_ANALOG_EN (0X1<<0) -+#define ES8336_CLKMGR_DAC_ANALOG_DIS (0X0<<0) + /* Bitfields in DCFG1. */ + #define GEM_IRQCOR_OFFSET 23 + #define GEM_IRQCOR_SIZE 1 + #define GEM_DBWDEF_OFFSET 25 + #define GEM_DBWDEF_SIZE 3 ++#define GEM_NO_PCS_OFFSET 0 ++#define GEM_NO_PCS_SIZE 1 + + /* Bitfields in DCFG2. */ + #define GEM_RX_PKT_BUFF_OFFSET 20 +@@ -500,6 +566,30 @@ + #define GEM_RXBD_RDBUFF_OFFSET 8 + #define GEM_RXBD_RDBUFF_SIZE 4 + ++/* Bitfields in DCFG12. */ ++#define GEM_HIGH_SPEED_OFFSET 26 ++#define GEM_HIGH_SPEED_SIZE 1 + -+/* REGISTER 0X0A */ -+#define ES8336_ADCWL_MASK (0x7 << 2) -+#define ES8336_ADCWL_32 (0x4 << 2) -+#define ES8336_ADCWL_24 (0x0 << 2) -+#define ES8336_ADCWL_20 (0x1 << 2) -+#define ES8336_ADCWL_18 (0x2 << 2) -+#define ES8336_ADCWL_16 (0x3 << 2) -+#define ES8336_ADCFMT_MASK (0x3 << 0) -+#define ES8336_ADCFMT_I2S (0x0 << 0) -+#define ES8336_ADCWL_LEFT (0x1 << 0) -+#define ES8336_ADCWL_RIGHT (0x2 << 0) -+#define ES8336_ADCWL_PCM (0x3 << 0) ++/* Bitfields in USX_CONTROL. */ ++#define GEM_USX_CTRL_SPEED_OFFSET 14 ++#define GEM_USX_CTRL_SPEED_SIZE 3 ++#define GEM_SERDES_RATE_OFFSET 12 ++#define GEM_SERDES_RATE_SIZE 2 ++#define GEM_RX_SCR_BYPASS_OFFSET 9 ++#define GEM_RX_SCR_BYPASS_SIZE 1 ++#define GEM_TX_SCR_BYPASS_OFFSET 8 ++#define GEM_TX_SCR_BYPASS_SIZE 1 ++#define GEM_RX_SYNC_RESET_OFFSET 2 ++#define GEM_RX_SYNC_RESET_SIZE 1 ++#define GEM_TX_EN_OFFSET 1 ++#define GEM_TX_EN_SIZE 1 ++#define GEM_SIGNAL_OK_OFFSET 0 ++#define GEM_SIGNAL_OK_SIZE 1 + -+/* REGISTER 0X0B */ -+#define ES8336_DACWL_MASK (0x7 << 2) -+#define ES8336_DACWL_32 (0x4 << 2) -+#define ES8336_DACWL_24 (0x0 << 2) -+#define ES8336_DACWL_20 (0x1 << 2) -+#define ES8336_DACWL_18 (0x2 << 2) -+#define ES8336_DACWL_16 (0x3 << 2) -+#define ES8336_DACFMT_MASK (0x3 << 0) -+#define ES8336_DACFMT_I2S (0x0 << 0) -+#define ES8336_DACWL_LEFT (0x1 << 0) -+#define ES8336_DACWL_RIGHT (0x2 << 0) -+#define ES8336_DACWL_PCM (0x3 << 0) ++/* Bitfields in USX_STATUS. */ ++#define GEM_USX_BLOCK_LOCK_OFFSET 0 ++#define GEM_USX_BLOCK_LOCK_SIZE 1 + -+#endif -diff --git a/sound/soc/codecs/es8388.c b/sound/soc/codecs/es8388.c -new file mode 100644 -index 000000000..fbb3f8399 ---- /dev/null -+++ b/sound/soc/codecs/es8388.c -@@ -0,0 +1,820 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * es8388.c -- ES8388 ALSA SoC Audio driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ * Author: Yiqun Zhang -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 as -+ * published by the Free Software Foundation. -+ */ + /* Bitfields in TISUBN */ + #define GEM_SUBNSINCR_OFFSET 0 + #define GEM_SUBNSINCRL_OFFSET 24 +@@ -555,6 +645,8 @@ + #define GEM_CMPC_SIZE 5 + #define GEM_CMPCEN_OFFSET 30 /* Compare C Enable */ + #define GEM_CMPCEN_SIZE 1 ++#define GEM_DROP_ON_MATCH_OFFSET 31 /* Drop on match */ ++#define GEM_DROP_ON_MATCH_SIZE 1 + + /* Bitfields in ETHT */ + #define GEM_ETHTCMP_OFFSET 0 /* EtherType compare value */ +@@ -567,6 +659,8 @@ + #define GEM_T2MASK_SIZE 16 + + /* Bitfields in T2CMPW1 */ ++#define GEM_T2VLANID_OFFSET 10 /* compare vlan id */ ++#define GEM_T2VLANID_SIZE 1 + #define GEM_T2DISMSK_OFFSET 9 /* disable mask */ + #define GEM_T2DISMSK_SIZE 1 + #define GEM_T2CMPOFST_OFFSET 7 /* compare offset */ +@@ -658,11 +752,16 @@ + #define MACB_CAPS_GEM_HAS_PTP 0x00000040 + #define MACB_CAPS_BD_RD_PREFETCH 0x00000080 + #define MACB_CAPS_NEEDS_RSTONUBR 0x00000100 ++#define MACB_CAPS_SEL_CLK 0x00000200 ++#define MACB_CAPS_TAILPTR 0x00001000 /* Phytium: tail register */ ++#define MACB_CAPS_CLK_HW_CHG 0x04000000 + #define MACB_CAPS_MACB_IS_EMAC 0x08000000 + #define MACB_CAPS_FIFO_MODE 0x10000000 + #define MACB_CAPS_GIGABIT_MODE_AVAILABLE 0x20000000 + #define MACB_CAPS_SG_DISABLED 0x40000000 + #define MACB_CAPS_MACB_IS_GEM 0x80000000 ++#define MACB_CAPS_PCS 0x01000000 ++#define MACB_CAPS_HIGH_SPEED 0x02000000 + + /* LSO settings */ + #define MACB_LSO_UFO_ENABLE 0x01 +@@ -1112,6 +1211,7 @@ struct macb_config { + struct clk **rx_clk, struct clk **tsu_clk); + int (*init)(struct platform_device *pdev); + int jumbo_max_len; ++ void (*sel_clk_hw)(struct macb *bp, int speed); + }; + + struct tsu_incr { +@@ -1132,6 +1232,7 @@ struct macb_queue { + unsigned int RBQS; + unsigned int RBQP; + unsigned int RBQPH; ++ unsigned int TAILADDR; + + unsigned int tx_head, tx_tail; + struct macb_dma_desc *tx_ring; +@@ -1191,6 +1292,7 @@ struct macb { + struct clk *rx_clk; + struct clk *tsu_clk; + struct net_device *dev; ++ struct ncsi_dev *ndev; + union { + struct macb_stats macb; + struct gem_stats gem; +@@ -1201,7 +1303,13 @@ struct macb { + struct mii_bus *mii_bus; + struct phylink *phylink; + struct phylink_config phylink_config; ++ struct phylink_pcs phylink_pcs; ++ int link; ++ int speed; ++ int duplex; ++ int use_ncsi; + ++ int force_phy_mode; + u32 caps; + unsigned int dma_burst_length; + +@@ -1244,6 +1352,19 @@ struct macb { + u32 rx_intr_mask; + + struct macb_pm_data pm_data; + -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "es8388.h" -+#include -+#include ++ void (*sel_clk_hw)(struct macb *bp, int speed); + -+static const unsigned int rates_12288[] = { -+ 8000, 12000, 16000, 24000, 32000, 48000, 96000, ++#ifdef CONFIG_MACB_TSN ++ u32 tsn_cap; ++ struct device_attribute cb_setting_attr; ++ struct device_attribute qci_setting_attr; ++ struct device_attribute qav_setting_attr; ++ struct device_attribute qbv_setting_attr; ++ struct device_attribute stream_id_attr; ++ u32 num_cb_streams; ++ u32 cb_history_len; ++#endif + }; + + #ifdef CONFIG_MACB_USE_HWSTAMP +@@ -1301,6 +1422,24 @@ static inline bool gem_has_ptp(struct macb *bp) + return !!(bp->caps & MACB_CAPS_GEM_HAS_PTP); + } + ++enum phytium_type { ++ PHYTIUM_DEV_1P0 = 1, ++ PHYTIUM_DEV_2P0, ++ PHYTIUM_DEV_3P0, +}; + -+static const int ratios_12288[] = { -+ 10, 7, 6, 4, 3, 2, 0, ++struct phytium_platform_pdata { ++ int phytium_dev_type; ++ struct clk *txclk; ++ struct clk *rxclk; ++ struct clk *tsu_clk; ++ u32 caps; ++ int irq_type; ++ int irq[4]; ++ phy_interface_t phy_interface; ++ const struct property_entry *properties; +}; + -+static const struct snd_pcm_hw_constraint_list constraints_12288 = { -+ .count = ARRAY_SIZE(rates_12288), -+ .list = rates_12288, -+}; + /** + * struct macb_platform_data - platform data for MACB Ethernet used for PCI registration + * @pclk: platform clock +@@ -1309,6 +1448,7 @@ static inline bool gem_has_ptp(struct macb *bp) + struct macb_platform_data { + struct clk *pclk; + struct clk *hclk; ++ struct phytium_platform_pdata phytium_macb_pdata; + }; + + #endif /* _MACB_H */ +diff --git a/drivers/net/ethernet/cadence/macb_main.c b/drivers/net/ethernet/cadence/macb_main.c +index 70d57ef95..bff1a934d 100644 +--- a/drivers/net/ethernet/cadence/macb_main.c ++++ b/drivers/net/ethernet/cadence/macb_main.c +@@ -35,8 +35,14 @@ + #include + #include + #include ++#include ++#include + #include "macb.h" + ++#ifdef CONFIG_MACB_TSN ++#include "macb_tsn.h" ++#endif ++ + /* This structure is only used for MACB on SiFive FU540 devices */ + struct sifive_fu540_macb_mgmt { + void __iomem *reg; +@@ -84,6 +90,14 @@ struct sifive_fu540_macb_mgmt { + #define MACB_WOL_HAS_MAGIC_PACKET (0x1 << 0) + #define MACB_WOL_ENABLED (0x1 << 1) + ++#define HS_SPEED_100M 0 ++#define HS_SPEED_1000M 1 ++#define HS_SPEED_2500M 2 ++#define HS_SPEED_5000M 3 ++#define HS_SPEED_10000M 4 ++#define MACB_SERDES_RATE_5G 0 ++#define MACB_SERDES_RATE_10G 1 ++ + /* Graceful stop timeouts in us. We should allow up to + * 1 frame time (10 Mbits/s, full-duplex, ignoring collisions) + */ +@@ -513,6 +527,10 @@ static void macb_validate(struct phylink_config *config, + state->interface != PHY_INTERFACE_MODE_RMII && + state->interface != PHY_INTERFACE_MODE_GMII && + state->interface != PHY_INTERFACE_MODE_SGMII && ++ state->interface != PHY_INTERFACE_MODE_2500BASEX && ++ state->interface != PHY_INTERFACE_MODE_5GBASER && ++ state->interface != PHY_INTERFACE_MODE_10GBASER && ++ state->interface != PHY_INTERFACE_MODE_USXGMII && + !phy_interface_mode_is_rgmii(state->interface)) { + bitmap_zero(supported, __ETHTOOL_LINK_MODE_MASK_NBITS); + return; +@@ -525,10 +543,47 @@ static void macb_validate(struct phylink_config *config, + return; + } + ++ if ((state->interface == PHY_INTERFACE_MODE_10GBASER || ++ state->interface == PHY_INTERFACE_MODE_USXGMII || ++ state->interface == PHY_INTERFACE_MODE_5GBASER) && ++ !(bp->caps & MACB_CAPS_HIGH_SPEED && ++ bp->caps & MACB_CAPS_PCS)) { ++ bitmap_zero(supported, __ETHTOOL_LINK_MODE_MASK_NBITS); ++ return; ++ } ++ + phylink_set_port_modes(mask); + phylink_set(mask, Autoneg); + phylink_set(mask, Asym_Pause); + ++ if (bp->caps & MACB_CAPS_GIGABIT_MODE_AVAILABLE && ++ (state->interface == PHY_INTERFACE_MODE_NA || ++ state->interface == PHY_INTERFACE_MODE_10GBASER || ++ state->interface == PHY_INTERFACE_MODE_USXGMII)) { ++ bp->speed = state->speed; ++ bp->link = 1; ++ bp->duplex = state->duplex; ++ if (bp->speed == SPEED_5000) { ++ phylink_set(mask, 5000baseT_Full); ++ } else { ++ phylink_set(mask, 10000baseCR_Full); ++ phylink_set(mask, 10000baseER_Full); ++ phylink_set(mask, 10000baseKR_Full); ++ phylink_set(mask, 10000baseLR_Full); ++ phylink_set(mask, 10000baseLRM_Full); ++ phylink_set(mask, 10000baseSR_Full); ++ phylink_set(mask, 10000baseT_Full); ++ } ++ if (state->interface != PHY_INTERFACE_MODE_NA) ++ goto out; ++ } + -+static const unsigned int rates_11289[] = { -+ 8018, 11025, 22050, 44100, 88200, -+}; ++ if (state->interface == PHY_INTERFACE_MODE_2500BASEX) ++ phylink_set(mask, 2500baseX_Full); + -+static const int ratios_11289[] = { -+ 9, 7, 4, 2, 0, -+}; ++ if (state->interface == PHY_INTERFACE_MODE_5GBASER) ++ phylink_set(mask, 5000baseT_Full); + -+static const struct snd_pcm_hw_constraint_list constraints_11289 = { -+ .count = ARRAY_SIZE(rates_11289), -+ .list = rates_11289, -+}; + phylink_set(mask, 10baseT_Half); + phylink_set(mask, 10baseT_Full); + phylink_set(mask, 100baseT_Half); +@@ -545,23 +600,110 @@ static void macb_validate(struct phylink_config *config, + if (!(bp->caps & MACB_CAPS_NO_GIGABIT_HALF)) + phylink_set(mask, 1000baseT_Half); + } +- ++out: + bitmap_and(supported, supported, mask, __ETHTOOL_LINK_MODE_MASK_NBITS); + bitmap_and(state->advertising, state->advertising, mask, + __ETHTOOL_LINK_MODE_MASK_NBITS); + } + +-static void macb_mac_pcs_get_state(struct phylink_config *config, ++static void macb_usx_pcs_link_up(struct phylink_pcs *pcs, unsigned int mode, ++ phy_interface_t interface, int speed, ++ int duplex) ++{ ++ struct macb *bp = container_of(pcs, struct macb, phylink_pcs); ++ u32 config; + -+#define ES8388_RATES (SNDRV_PCM_RATE_192000 | \ -+ SNDRV_PCM_RATE_96000 | \ -+ SNDRV_PCM_RATE_88200 | \ -+ SNDRV_PCM_RATE_8000_48000) -+#define ES8388_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \ -+ SNDRV_PCM_FMTBIT_S18_3LE | \ -+ SNDRV_PCM_FMTBIT_S20_3LE | \ -+ SNDRV_PCM_FMTBIT_S24_LE | \ -+ SNDRV_PCM_FMTBIT_S32_LE) ++ config = gem_readl(bp, USX_CONTROL); ++ if (speed == SPEED_10000) { ++ config = GEM_BFINS(SERDES_RATE, MACB_SERDES_RATE_10G, config); ++ config = GEM_BFINS(USX_CTRL_SPEED, HS_SPEED_10000M, config); ++ } else if (speed == SPEED_5000) { ++ config = GEM_BFINS(SERDES_RATE, MACB_SERDES_RATE_5G, config); ++ config = GEM_BFINS(USX_CTRL_SPEED, HS_SPEED_5000M, config); ++ } + -+struct es8388_priv { -+ struct regmap *regmap; -+ struct clk *clk; -+ int playback_fs; -+ bool deemph; -+ int mclkdiv2; -+ const struct snd_pcm_hw_constraint_list *sysclk_constraints; -+ const int *mclk_ratios; -+ bool master; -+}; ++ config &= ~(GEM_BIT(TX_SCR_BYPASS) | GEM_BIT(RX_SCR_BYPASS)); ++ /* reset */ ++ config &= ~(GEM_BIT(SIGNAL_OK) | GEM_BIT(TX_EN)); ++ config |= GEM_BIT(RX_SYNC_RESET); + -+/* -+ * ES8388 Controls -+ */ -+static const char * const adcpol_txt[] = {"Normal", "L Invert", "R Invert", -+ "L + R Invert"}; -+static SOC_ENUM_SINGLE_DECL(adcpol, -+ ES8388_ADCCONTROL6, 6, adcpol_txt); ++ gem_writel(bp, USX_CONTROL, config); + -+static const DECLARE_TLV_DB_SCALE(play_tlv, -3000, 100, 0); -+static const DECLARE_TLV_DB_SCALE(dac_adc_tlv, -9600, 50, 0); -+static const DECLARE_TLV_DB_SCALE(pga_tlv, 0, 300, 0); -+static const DECLARE_TLV_DB_SCALE(bypass_tlv, -1500, 300, 0); -+static const DECLARE_TLV_DB_SCALE(mic_tlv, 0, 300, 0); ++ /* enable rx and tx */ ++ config &= ~(GEM_BIT(RX_SYNC_RESET)); ++ config |= GEM_BIT(SIGNAL_OK) | GEM_BIT(TX_EN); + -+static const struct { -+ int rate; -+ unsigned int val; -+} deemph_settings[] = { -+ { 0, ES8388_DACCONTROL6_DEEMPH_OFF }, -+ { 32000, ES8388_DACCONTROL6_DEEMPH_32k }, -+ { 44100, ES8388_DACCONTROL6_DEEMPH_44_1k }, -+ { 48000, ES8388_DACCONTROL6_DEEMPH_48k }, -+}; ++ gem_writel(bp, USX_CONTROL, config); ++} + -+static int es8388_set_deemph(struct snd_soc_component *component) ++static void macb_usx_pcs_get_state(struct phylink_pcs *pcs, + struct phylink_link_state *state) +{ -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ int val, i, best; -+ -+ /* -+ * If we're using deemphasis select the nearest available sample -+ * rate. -+ */ -+ if (es8388->deemph) { -+ best = 0; -+ for (i = 1; i < ARRAY_SIZE(deemph_settings); i++) { -+ if (abs(deemph_settings[i].rate - es8388->playback_fs) < -+ abs(deemph_settings[best].rate - es8388->playback_fs)) -+ best = i; -+ } ++ struct macb *bp = container_of(pcs, struct macb, phylink_pcs); ++ u32 val; + -+ val = deemph_settings[best].val; -+ } else { -+ val = ES8388_DACCONTROL6_DEEMPH_OFF; -+ } ++ if (state->interface == PHY_INTERFACE_MODE_5GBASER) ++ state->speed = SPEED_5000; ++ else if (state->interface == PHY_INTERFACE_MODE_10GBASER || ++ state->interface == PHY_INTERFACE_MODE_USXGMII) ++ state->speed = bp->speed; + -+ dev_dbg(component->dev, "Set deemphasis %d\n", val); ++ state->duplex = 1; ++ state->an_complete = 1; + -+ return snd_soc_component_update_bits(component, ES8388_DACCONTROL6, -+ ES8388_DACCONTROL6_DEEMPH_MASK, val); ++ val = gem_readl(bp, USX_STATUS); ++ state->link = !!(val & GEM_BIT(USX_BLOCK_LOCK)); ++ val = gem_readl(bp, NCFGR); ++ if (val & GEM_BIT(PAE)) ++ state->pause = MLO_PAUSE_RX; +} + -+static int es8388_get_deemph(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) ++static int macb_usx_pcs_config(struct phylink_pcs *pcs, ++ unsigned int mode, ++ phy_interface_t interface, ++ const unsigned long *advertising, ++ bool permit_pause_to_mac) +{ -+ struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); ++ struct macb *bp = container_of(pcs, struct macb, phylink_pcs); ++ ++ gem_writel(bp, USX_CONTROL, gem_readl(bp, USX_CONTROL) | ++ GEM_BIT(SIGNAL_OK)); + -+ ucontrol->value.integer.value[0] = es8388->deemph; + return 0; +} + -+static int es8388_put_deemph(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) ++static void macb_pcs_get_state(struct phylink_pcs *pcs, ++ struct phylink_link_state *state) + { + state->link = 0; + } + +-static void macb_mac_an_restart(struct phylink_config *config) ++static void macb_pcs_an_restart(struct phylink_pcs *pcs) + { + /* Not supported */ + } + ++static int macb_pcs_config(struct phylink_pcs *pcs, ++ unsigned int mode, ++ phy_interface_t interface, ++ const unsigned long *advertising, ++ bool permit_pause_to_mac) +{ -+ struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ unsigned int deemph = ucontrol->value.integer.value[0]; -+ int ret; -+ -+ if (deemph > 1) -+ return -EINVAL; -+ -+ ret = es8388_set_deemph(component); -+ if (ret < 0) -+ return ret; -+ -+ es8388->deemph = deemph; -+ + return 0; +} + -+static const struct snd_kcontrol_new es8388_snd_controls[] = { -+ SOC_DOUBLE_R_TLV("Capture Digital Volume", -+ ES8388_ADCCONTROL8, ES8388_ADCCONTROL9, -+ 0, 0xc0, 1, dac_adc_tlv), -+ -+ SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0, -+ es8388_get_deemph, es8388_put_deemph), -+ -+ SOC_ENUM("Capture Polarity", adcpol), -+ -+ SOC_SINGLE_TLV("Left Mixer Left Bypass Volume", -+ ES8388_DACCONTROL17, 3, 7, 1, bypass_tlv), -+ SOC_SINGLE_TLV("Left Mixer Right Bypass Volume", -+ ES8388_DACCONTROL19, 3, 7, 1, bypass_tlv), -+ SOC_SINGLE_TLV("Right Mixer Left Bypass Volume", -+ ES8388_DACCONTROL18, 3, 7, 1, bypass_tlv), -+ SOC_SINGLE_TLV("Right Mixer Right Bypass Volume", -+ ES8388_DACCONTROL20, 3, 7, 1, bypass_tlv), -+ -+ SOC_DOUBLE_R_TLV("PCM Volume", -+ ES8388_LDACVOL, ES8388_RDACVOL, -+ 0, ES8388_DACVOL_MAX, 1, dac_adc_tlv), -+ -+ SOC_DOUBLE_R_TLV("Output 1 Playback Volume", -+ ES8388_LOUT1VOL, ES8388_ROUT1VOL, -+ 0, ES8388_OUT1VOL_MAX, 0, play_tlv), -+ -+ SOC_DOUBLE_R_TLV("Output 2 Playback Volume", -+ ES8388_LOUT2VOL, ES8388_ROUT2VOL, -+ 0, ES8388_OUT2VOL_MAX, 0, play_tlv), -+ -+ SOC_DOUBLE_TLV("Mic PGA Volume", ES8388_ADCCONTROL1, -+ 4, 0, 8, 0, mic_tlv), -+}; -+ -+/* -+ * DAPM Controls -+ */ -+static const char * const es8388_line_texts[] = { -+ "Line 1", "Line 2", "PGA", "Differential"}; -+ -+static const struct soc_enum es8388_lline_enum = -+ SOC_ENUM_SINGLE(ES8388_DACCONTROL16, 3, -+ ARRAY_SIZE(es8388_line_texts), -+ es8388_line_texts); -+static const struct snd_kcontrol_new es8388_left_line_controls = -+ SOC_DAPM_ENUM("Route", es8388_lline_enum); -+ -+static const struct soc_enum es8388_rline_enum = -+ SOC_ENUM_SINGLE(ES8388_DACCONTROL16, 0, -+ ARRAY_SIZE(es8388_line_texts), -+ es8388_line_texts); -+static const struct snd_kcontrol_new es8388_right_line_controls = -+ SOC_DAPM_ENUM("Route", es8388_lline_enum); -+ -+/* Left Mixer */ -+static const struct snd_kcontrol_new es8388_left_mixer_controls[] = { -+ SOC_DAPM_SINGLE("Playback Switch", ES8388_DACCONTROL17, 7, 1, 0), -+ SOC_DAPM_SINGLE("Left Bypass Switch", ES8388_DACCONTROL17, 6, 1, 0), -+ SOC_DAPM_SINGLE("Right Playback Switch", ES8388_DACCONTROL18, 7, 1, 0), -+ SOC_DAPM_SINGLE("Right Bypass Switch", ES8388_DACCONTROL18, 6, 1, 0), -+}; -+ -+/* Right Mixer */ -+static const struct snd_kcontrol_new es8388_right_mixer_controls[] = { -+ SOC_DAPM_SINGLE("Left Playback Switch", ES8388_DACCONTROL19, 7, 1, 0), -+ SOC_DAPM_SINGLE("Left Bypass Switch", ES8388_DACCONTROL19, 6, 1, 0), -+ SOC_DAPM_SINGLE("Playback Switch", ES8388_DACCONTROL20, 7, 1, 0), -+ SOC_DAPM_SINGLE("Right Bypass Switch", ES8388_DACCONTROL20, 6, 1, 0), ++static const struct phylink_pcs_ops macb_phylink_usx_pcs_ops = { ++ .pcs_get_state = macb_usx_pcs_get_state, ++ .pcs_config = macb_usx_pcs_config, ++ .pcs_link_up = macb_usx_pcs_link_up, +}; + -+static const char * const es8388_pga_sel[] = { -+ "Line 1", "Line 2", "Line 3", "Differential"}; -+ -+/* Left PGA Mux */ -+static const struct soc_enum es8388_lpga_enum = -+ SOC_ENUM_SINGLE(ES8388_ADCCONTROL2, 6, -+ ARRAY_SIZE(es8388_pga_sel), -+ es8388_pga_sel); -+static const struct snd_kcontrol_new es8388_left_pga_controls = -+ SOC_DAPM_ENUM("Route", es8388_lpga_enum); -+ -+/* Right PGA Mux */ -+static const struct soc_enum es8388_rpga_enum = -+ SOC_ENUM_SINGLE(ES8388_ADCCONTROL2, 4, -+ ARRAY_SIZE(es8388_pga_sel), -+ es8388_pga_sel); -+static const struct snd_kcontrol_new es8388_right_pga_controls = -+ SOC_DAPM_ENUM("Route", es8388_rpga_enum); -+ -+/* Differential Mux */ -+static const char * const es8388_diff_sel[] = {"Line 1", "Line 2"}; -+static SOC_ENUM_SINGLE_DECL(diffmux, -+ ES8388_ADCCONTROL3, 7, es8388_diff_sel); -+static const struct snd_kcontrol_new es8388_diffmux_controls = -+ SOC_DAPM_ENUM("Route", diffmux); -+ -+/* Mono ADC Mux */ -+static const char * const es8388_mono_mux[] = {"Stereo", "Mono (Left)", -+ "Mono (Right)", "Digital Mono"}; -+static SOC_ENUM_SINGLE_DECL(monomux, -+ ES8388_ADCCONTROL3, 3, es8388_mono_mux); -+static const struct snd_kcontrol_new es8388_monomux_controls = -+ SOC_DAPM_ENUM("Route", monomux); -+ -+static const struct snd_soc_dapm_widget es8388_dapm_widgets[] = { -+ SND_SOC_DAPM_MUX("Differential Mux", SND_SOC_NOPM, 0, 0, -+ &es8388_diffmux_controls), -+ SND_SOC_DAPM_MUX("Left ADC Mux", SND_SOC_NOPM, 0, 0, -+ &es8388_monomux_controls), -+ SND_SOC_DAPM_MUX("Right ADC Mux", SND_SOC_NOPM, 0, 0, -+ &es8388_monomux_controls), -+ -+ SND_SOC_DAPM_MUX("Left PGA Mux", ES8388_ADCPOWER, -+ ES8388_ADCPOWER_AINL_OFF, 1, -+ &es8388_left_pga_controls), -+ SND_SOC_DAPM_MUX("Right PGA Mux", ES8388_ADCPOWER, -+ ES8388_ADCPOWER_AINR_OFF, 1, -+ &es8388_right_pga_controls), -+ -+ SND_SOC_DAPM_MUX("Left Line Mux", SND_SOC_NOPM, 0, 0, -+ &es8388_left_line_controls), -+ SND_SOC_DAPM_MUX("Right Line Mux", SND_SOC_NOPM, 0, 0, -+ &es8388_right_line_controls), -+ -+ SND_SOC_DAPM_ADC("Right ADC", "Right Capture", ES8388_ADCPOWER, -+ ES8388_ADCPOWER_ADCR_OFF, 1), -+ SND_SOC_DAPM_ADC("Left ADC", "Left Capture", ES8388_ADCPOWER, -+ ES8388_ADCPOWER_ADCL_OFF, 1), -+ -+ SND_SOC_DAPM_SUPPLY("DAC STM", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_DACSTM_RESET, 1, NULL, 0), -+ SND_SOC_DAPM_SUPPLY("ADC STM", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_ADCSTM_RESET, 1, NULL, 0), -+ -+ SND_SOC_DAPM_SUPPLY("DAC DIG", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_DACDIG_OFF, 1, NULL, 0), -+ SND_SOC_DAPM_SUPPLY("ADC DIG", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_ADCDIG_OFF, 1, NULL, 0), -+ -+ SND_SOC_DAPM_SUPPLY("DAC DLL", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_DACDLL_OFF, 1, NULL, 0), -+ SND_SOC_DAPM_SUPPLY("ADC DLL", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_ADCDLL_OFF, 1, NULL, 0), -+ -+ SND_SOC_DAPM_SUPPLY("ADC Vref", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_ADCVREF_OFF, 1, NULL, 0), -+ SND_SOC_DAPM_SUPPLY("DAC Vref", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_DACVREF_OFF, 1, NULL, 0), -+ -+ SND_SOC_DAPM_DAC("Right DAC", "Right Playback", ES8388_DACPOWER, -+ ES8388_DACPOWER_RDAC_OFF, 1), -+ SND_SOC_DAPM_DAC("Left DAC", "Left Playback", ES8388_DACPOWER, -+ ES8388_DACPOWER_LDAC_OFF, 1), -+ -+ SND_SOC_DAPM_MIXER("Left Mixer", SND_SOC_NOPM, 0, 0, -+ &es8388_left_mixer_controls[0], -+ ARRAY_SIZE(es8388_left_mixer_controls)), -+ SND_SOC_DAPM_MIXER("Right Mixer", SND_SOC_NOPM, 0, 0, -+ &es8388_right_mixer_controls[0], -+ ARRAY_SIZE(es8388_right_mixer_controls)), -+ -+ SND_SOC_DAPM_PGA("Right Out 2", ES8388_DACPOWER, -+ ES8388_DACPOWER_ROUT2_ON, 0, NULL, 0), -+ SND_SOC_DAPM_PGA("Left Out 2", ES8388_DACPOWER, -+ ES8388_DACPOWER_LOUT2_ON, 0, NULL, 0), -+ SND_SOC_DAPM_PGA("Right Out 1", ES8388_DACPOWER, -+ ES8388_DACPOWER_ROUT1_ON, 0, NULL, 0), -+ SND_SOC_DAPM_PGA("Left Out 1", ES8388_DACPOWER, -+ ES8388_DACPOWER_LOUT1_ON, 0, NULL, 0), -+ -+ SND_SOC_DAPM_OUTPUT("LOUT1"), -+ SND_SOC_DAPM_OUTPUT("ROUT1"), -+ SND_SOC_DAPM_OUTPUT("LOUT2"), -+ SND_SOC_DAPM_OUTPUT("ROUT2"), -+ -+ SND_SOC_DAPM_INPUT("LINPUT1"), -+ SND_SOC_DAPM_INPUT("LINPUT2"), -+ SND_SOC_DAPM_INPUT("RINPUT1"), -+ SND_SOC_DAPM_INPUT("RINPUT2"), ++static const struct phylink_pcs_ops macb_phylink_pcs_ops = { ++ .pcs_get_state = macb_pcs_get_state, ++ .pcs_an_restart = macb_pcs_an_restart, ++ .pcs_config = macb_pcs_config, +}; + -+static const struct snd_soc_dapm_route es8388_dapm_routes[] = { -+ { "Left Line Mux", "Line 1", "LINPUT1" }, -+ { "Left Line Mux", "Line 2", "LINPUT2" }, -+ { "Left Line Mux", "PGA", "Left PGA Mux" }, -+ { "Left Line Mux", "Differential", "Differential Mux" }, -+ -+ { "Right Line Mux", "Line 1", "RINPUT1" }, -+ { "Right Line Mux", "Line 2", "RINPUT2" }, -+ { "Right Line Mux", "PGA", "Right PGA Mux" }, -+ { "Right Line Mux", "Differential", "Differential Mux" }, -+ -+ { "Left PGA Mux", "Line 1", "LINPUT1" }, -+ { "Left PGA Mux", "Line 2", "LINPUT2" }, -+ { "Left PGA Mux", "Differential", "Differential Mux" }, -+ -+ { "Right PGA Mux", "Line 1", "RINPUT1" }, -+ { "Right PGA Mux", "Line 2", "RINPUT2" }, -+ { "Right PGA Mux", "Differential", "Differential Mux" }, -+ -+ { "Differential Mux", "Line 1", "LINPUT1" }, -+ { "Differential Mux", "Line 1", "RINPUT1" }, -+ { "Differential Mux", "Line 2", "LINPUT2" }, -+ { "Differential Mux", "Line 2", "RINPUT2" }, -+ -+ { "Left ADC Mux", "Stereo", "Left PGA Mux" }, -+ { "Left ADC Mux", "Mono (Left)", "Left PGA Mux" }, -+ { "Left ADC Mux", "Digital Mono", "Left PGA Mux" }, -+ -+ { "Right ADC Mux", "Stereo", "Right PGA Mux" }, -+ { "Right ADC Mux", "Mono (Right)", "Right PGA Mux" }, -+ { "Right ADC Mux", "Digital Mono", "Right PGA Mux" }, -+ -+ { "Left ADC", NULL, "Left ADC Mux" }, -+ { "Right ADC", NULL, "Right ADC Mux" }, -+ -+ { "ADC DIG", NULL, "ADC STM" }, -+ { "ADC DIG", NULL, "ADC Vref" }, -+ { "ADC DIG", NULL, "ADC DLL" }, -+ -+ { "Left ADC", NULL, "ADC DIG" }, -+ { "Right ADC", NULL, "ADC DIG" }, -+ -+ { "Left Line Mux", "Line 1", "LINPUT1" }, -+ { "Left Line Mux", "Line 2", "LINPUT2" }, -+ { "Left Line Mux", "PGA", "Left PGA Mux" }, -+ { "Left Line Mux", "Differential", "Differential Mux" }, -+ -+ { "Right Line Mux", "Line 1", "RINPUT1" }, -+ { "Right Line Mux", "Line 2", "RINPUT2" }, -+ { "Right Line Mux", "PGA", "Right PGA Mux" }, -+ { "Right Line Mux", "Differential", "Differential Mux" }, -+ -+ { "Left Out 1", NULL, "Left DAC" }, -+ { "Right Out 1", NULL, "Right DAC" }, -+ { "Left Out 2", NULL, "Left DAC" }, -+ { "Right Out 2", NULL, "Right DAC" }, -+ -+ { "Left Mixer", "Playback Switch", "Left DAC" }, -+ { "Left Mixer", "Left Bypass Switch", "Left Line Mux" }, -+ { "Left Mixer", "Right Playback Switch", "Right DAC" }, -+ { "Left Mixer", "Right Bypass Switch", "Right Line Mux" }, -+ -+ { "Right Mixer", "Left Playback Switch", "Left DAC" }, -+ { "Right Mixer", "Left Bypass Switch", "Left Line Mux" }, -+ { "Right Mixer", "Playback Switch", "Right DAC" }, -+ { "Right Mixer", "Right Bypass Switch", "Right Line Mux" }, -+ -+ { "DAC DIG", NULL, "DAC STM" }, -+ { "DAC DIG", NULL, "DAC Vref" }, -+ { "DAC DIG", NULL, "DAC DLL" }, -+ -+ { "Left DAC", NULL, "DAC DIG" }, -+ { "Right DAC", NULL, "DAC DIG" }, + static void macb_mac_config(struct phylink_config *config, unsigned int mode, + const struct phylink_link_state *state) + { +@@ -569,25 +711,57 @@ static void macb_mac_config(struct phylink_config *config, unsigned int mode, + struct macb *bp = netdev_priv(ndev); + unsigned long flags; + u32 old_ctrl, ctrl; ++ u32 old_ncr, ncr; + + spin_lock_irqsave(&bp->lock, flags); + +- old_ctrl = ctrl = macb_or_gem_readl(bp, NCFGR); ++ ctrl = macb_or_gem_readl(bp, NCFGR); ++ old_ctrl = ctrl; ++ ncr = macb_or_gem_readl(bp, NCR); ++ old_ncr = ncr; + + if (bp->caps & MACB_CAPS_MACB_IS_EMAC) { + if (state->interface == PHY_INTERFACE_MODE_RMII) + ctrl |= MACB_BIT(RM9200_RMII); + } else if (macb_is_gem(bp)) { + ctrl &= ~(GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL)); ++ ncr &= ~GEM_BIT(ENABLE_HS_MAC); + +- if (state->interface == PHY_INTERFACE_MODE_SGMII) ++ if (state->interface == PHY_INTERFACE_MODE_SGMII || ++ state->interface == PHY_INTERFACE_MODE_2500BASEX) { + ctrl |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL); ++ } else if (state->interface == PHY_INTERFACE_MODE_10GBASER || ++ state->interface == PHY_INTERFACE_MODE_USXGMII || ++ state->interface == PHY_INTERFACE_MODE_5GBASER) { ++ ctrl |= GEM_BIT(PCSSEL); ++ ncr |= GEM_BIT(ENABLE_HS_MAC); ++ } + } + + /* Apply the new configuration, if any */ + if (old_ctrl ^ ctrl) + macb_or_gem_writel(bp, NCFGR, ctrl); + ++ if (old_ncr ^ ncr) ++ macb_or_gem_writel(bp, NCR, ncr); + -+ { "Left Out 1", NULL, "Left Mixer" }, -+ { "LOUT1", NULL, "Left Out 1" }, -+ { "Right Out 1", NULL, "Right Mixer" }, -+ { "ROUT1", NULL, "Right Out 1" }, ++ /* Disable AN for SGMII fixed link configuration, enable otherwise. ++ * Must be written after PCSSEL is set in NCFGR, ++ * otherwise writes will not take effect. ++ */ ++ if (macb_is_gem(bp) && (state->interface == PHY_INTERFACE_MODE_SGMII || ++ PHY_INTERFACE_MODE_2500BASEX)) { ++ u32 pcsctrl, old_pcsctrl; + -+ { "Left Out 2", NULL, "Left Mixer" }, -+ { "LOUT2", NULL, "Left Out 2" }, -+ { "Right Out 2", NULL, "Right Mixer" }, -+ { "ROUT2", NULL, "Right Out 2" }, -+}; ++ old_pcsctrl = gem_readl(bp, PCSCNTRL); ++ if (mode == MLO_AN_FIXED) ++ pcsctrl = old_pcsctrl & ~GEM_BIT(PCSAUTONEG); ++ else ++ pcsctrl = old_pcsctrl | GEM_BIT(PCSAUTONEG); ++ if (old_pcsctrl != pcsctrl) ++ gem_writel(bp, PCSCNTRL, pcsctrl); ++ } + -+static int es8388_mute(struct snd_soc_dai *dai, int mute, int direction) -+{ -+ return snd_soc_component_update_bits(dai->component, ES8388_DACCONTROL3, -+ ES8388_DACCONTROL3_DACMUTE, -+ mute ? ES8388_DACCONTROL3_DACMUTE : 0); -+} + spin_unlock_irqrestore(&bp->lock, flags); + } + +@@ -600,18 +774,184 @@ static void macb_mac_link_down(struct phylink_config *config, unsigned int mode, + unsigned int q; + u32 ctrl; + ++ if (bp->use_ncsi) ++ ncsi_stop_dev(bp->ndev); + -+static int es8388_startup(struct snd_pcm_substream *substream, -+ struct snd_soc_dai *dai) + if (!(bp->caps & MACB_CAPS_MACB_IS_EMAC)) + for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) + queue_writel(queue, IDR, + bp->rx_intr_mask | MACB_TX_INT_FLAGS | MACB_BIT(HRESP)); + + /* Disable Rx and Tx */ +- ctrl = macb_readl(bp, NCR) & ~(MACB_BIT(RE) | MACB_BIT(TE)); ++ ctrl = macb_readl(bp, NCR) & ~(MACB_BIT(RE) | MACB_BIT(TE)) & ~(MACB_BIT(2PT5G)); + macb_writel(bp, NCR, ctrl); + + netif_tx_stop_all_queues(ndev); + } + ++static void phytium_gem1p0_sel_clk(struct macb *bp, int speed) +{ -+ struct snd_soc_component *component = dai->component; -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ -+ if (es8388->master && es8388->sysclk_constraints) -+ snd_pcm_hw_constraint_list(substream->runtime, 0, -+ SNDRV_PCM_HW_PARAM_RATE, -+ es8388->sysclk_constraints); ++ if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER || ++ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ if (speed == SPEED_5000) { ++ gem_writel(bp, DIV_SEL0_LN, 0x8); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL0_LN, 0x8); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x0); /*0x1c10*/ ++ } else { ++ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x1); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ ++ } ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ gem_writel(bp, DIV_SEL0_LN, 0x8); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x0); /*0x1c10*/ ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ gem_writel(bp, DIV_SEL0_LN, 0x1); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x1); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ ++ gem_writel(bp, TX_CLK_SEL3_0, 0x0); /*0x1c70*/ ++ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ ++ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ ++ gem_writel(bp, RX_CLK_SEL4_0, 0x0); /*0x1c7c*/ ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { ++ if (speed == SPEED_1000) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x8); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x0); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ ++ gem_writel(bp, TX_CLK_SEL3_0, 0x0); /*0x1c70*/ ++ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ ++ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ ++ gem_writel(bp, RX_CLK_SEL4_0, 0x0); /*0x1c7c*/ ++ } else if (speed == SPEED_100 || speed == SPEED_10) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x8); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x0); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x1); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ ++ gem_writel(bp, TX_CLK_SEL3_0, 0x1); /*0x1c70*/ ++ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ ++ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ ++ gem_writel(bp, RX_CLK_SEL4_0, 0x1); /*0x1c7c*/ ++ } ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_RGMII || ++ bp->phy_interface == PHY_INTERFACE_MODE_RGMII_ID) { ++ if (speed == SPEED_1000) { ++ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ ++ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ ++ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x0); /*0x1c38*/ ++ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x1); /*0x1c80*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ ++ } else if (speed == SPEED_100) { ++ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ ++ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ ++ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x0); /*0x1c38*/ ++ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x0); /*0x1c80*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ ++ } else { ++ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ ++ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ ++ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x1); /*0x1c38*/ ++ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x0); /*0x1c80*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ ++ } ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_RMII) { ++ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ ++ } + -+ return 0; ++ if (speed == SPEED_100) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_100M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_1000) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_1000M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_2500) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_2500M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_5000) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_10000) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_10000M, ++ gem_readl(bp, HS_MAC_CONFIG))); +} + -+static int es8388_hw_params(struct snd_pcm_substream *substream, -+ struct snd_pcm_hw_params *params, -+ struct snd_soc_dai *dai) ++static void phytium_gem2p0_sel_clk(struct macb *bp, int speed) +{ -+ struct snd_soc_component *component = dai->component; -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ int i; -+ int reg; -+ int wl; -+ int ratio; -+ -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ reg = ES8388_DACCONTROL2; -+ else -+ reg = ES8388_ADCCONTROL5; -+ -+ if (es8388->master) { -+ if (!es8388->sysclk_constraints) { -+ dev_err(component->dev, "No MCLK configured\n"); -+ return -EINVAL; -+ } -+ -+ for (i = 0; i < es8388->sysclk_constraints->count; i++) -+ if (es8388->sysclk_constraints->list[i] == -+ params_rate(params)) -+ break; -+ -+ if (i == es8388->sysclk_constraints->count) { -+ dev_err(component->dev, -+ "LRCLK %d unsupported with current clock\n", -+ params_rate(params)); -+ return -EINVAL; ++ if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { ++ if (speed == SPEED_100 || speed == SPEED_10) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x1); /*0x1c0c*/ + } -+ ratio = es8388->mclk_ratios[i]; -+ } else { -+ ratio = 0; -+ es8388->mclkdiv2 = 0; + } + -+ snd_soc_component_update_bits(component, ES8388_MASTERMODE, -+ ES8388_MASTERMODE_MCLKDIV2, -+ es8388->mclkdiv2 ? ES8388_MASTERMODE_MCLKDIV2 : 0); ++ if (speed == SPEED_100 || speed == SPEED_10) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_100M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_1000) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_1000M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_2500) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_2500M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++} + -+ switch (params_width(params)) { -+ case 16: -+ wl = 3; -+ break; -+ case 18: -+ wl = 2; -+ break; -+ case 20: -+ wl = 1; -+ break; -+ case 24: -+ wl = 0; -+ break; -+ case 32: -+ wl = 4; -+ break; -+ default: -+ return -EINVAL; -+ } ++static void phytium_gem3p0_sel_clk(struct macb *bp, int speed) ++{ ++ if (speed == SPEED_100 || speed == SPEED_10) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_100M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_1000) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_1000M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_2500) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_2500M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++} + -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { -+ snd_soc_component_update_bits(component, ES8388_DACCONTROL1, -+ ES8388_DACCONTROL1_DACWL_MASK, -+ wl << ES8388_DACCONTROL1_DACWL_SHIFT); + static void macb_mac_link_up(struct phylink_config *config, + struct phy_device *phy, + unsigned int mode, phy_interface_t interface, +@@ -624,9 +964,13 @@ static void macb_mac_link_up(struct phylink_config *config, + unsigned long flags; + unsigned int q; + u32 ctrl; ++ int err; + + spin_lock_irqsave(&bp->lock, flags); + ++ if (bp->caps & MACB_CAPS_SEL_CLK) ++ bp->sel_clk_hw(bp, speed); + -+ es8388->playback_fs = params_rate(params); -+ es8388_set_deemph(component); -+ } else -+ snd_soc_component_update_bits(component, ES8388_ADCCONTROL4, -+ ES8388_ADCCONTROL4_ADCWL_MASK, -+ wl << ES8388_ADCCONTROL4_ADCWL_SHIFT); + ctrl = macb_or_gem_readl(bp, NCFGR); + + ctrl &= ~(MACB_BIT(SPD) | MACB_BIT(FD)); +@@ -642,7 +986,7 @@ static void macb_mac_link_up(struct phylink_config *config, + if (macb_is_gem(bp)) { + ctrl &= ~GEM_BIT(GBE); + +- if (speed == SPEED_1000) ++ if (speed == SPEED_1000 || speed == SPEED_2500) + ctrl |= GEM_BIT(GBE); + } + +@@ -664,18 +1008,73 @@ static void macb_mac_link_up(struct phylink_config *config, + + macb_or_gem_writel(bp, NCFGR, ctrl); + ++ if (speed == SPEED_2500) { ++ u32 network_ctrl; + -+ return snd_soc_component_update_bits(component, reg, ES8388_RATEMASK, ratio); -+} ++ network_ctrl = macb_readl(bp, NCR); ++ network_ctrl |= MACB_BIT(2PT5G); ++ macb_writel(bp, NCR, network_ctrl); ++ } + -+static int es8388_set_sysclk(struct snd_soc_dai *codec_dai, -+ int clk_id, unsigned int freq, int dir) -+{ -+ struct snd_soc_component *component = codec_dai->component; -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ int mclkdiv2 = 0; ++ if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER || ++ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { ++ if (speed == SPEED_5000) ++ gem_writel(bp, HS_MAC_CONFIG, ++ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else ++ gem_writel(bp, HS_MAC_CONFIG, ++ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_10000M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) ++ gem_writel(bp, HS_MAC_CONFIG, ++ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, ++ gem_readl(bp, HS_MAC_CONFIG))); + -+ switch (freq) { -+ case 0: -+ es8388->sysclk_constraints = NULL; -+ es8388->mclk_ratios = NULL; -+ break; -+ case 22579200: -+ mclkdiv2 = 1; -+ /* fallthru */ -+ case 11289600: -+ es8388->sysclk_constraints = &constraints_11289; -+ es8388->mclk_ratios = ratios_11289; -+ break; -+ case 24576000: -+ mclkdiv2 = 1; -+ /* fallthru */ -+ case 12288000: -+ es8388->sysclk_constraints = &constraints_12288; -+ es8388->mclk_ratios = ratios_12288; -+ break; -+ default: -+ return -EINVAL; + spin_unlock_irqrestore(&bp->lock, flags); + + /* Enable Rx and Tx */ + macb_writel(bp, NCR, macb_readl(bp, NCR) | MACB_BIT(RE) | MACB_BIT(TE)); + ++ if (bp->use_ncsi) { ++ /* Start the NCSI device */ ++ err = ncsi_start_dev(bp->ndev); ++ if (err) { ++ netdev_err(bp->dev, "Ncsi start dev failed (error %d)\n", err); ++ return; ++ } + } + -+ es8388->mclkdiv2 = mclkdiv2; -+ return 0; -+} ++ bp->speed = speed; + -+static int es8388_set_dai_fmt(struct snd_soc_dai *codec_dai, -+ unsigned int fmt) + netif_tx_wake_all_queues(ndev); + } + ++static int macb_mac_prepare(struct phylink_config *config, unsigned int mode, ++ phy_interface_t interface) +{ -+ struct snd_soc_component *component = codec_dai->component; -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ u8 dac_mode = 0; -+ u8 adc_mode = 0; -+ -+ switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { -+ case SND_SOC_DAIFMT_CBM_CFM: -+ /* Master serial port mode, with BCLK generated automatically */ -+ snd_soc_component_update_bits(component, ES8388_MASTERMODE, -+ ES8388_MASTERMODE_MSC, -+ ES8388_MASTERMODE_MSC); -+ es8388->master = true; -+ break; -+ case SND_SOC_DAIFMT_CBS_CFS: -+ /* Slave serial port mode */ -+ snd_soc_component_update_bits(component, ES8388_MASTERMODE, -+ ES8388_MASTERMODE_MSC, 0); -+ es8388->master = false; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ /* interface format */ -+ switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { -+ case SND_SOC_DAIFMT_I2S: -+ dac_mode |= ES8388_DACCONTROL1_DACFORMAT_I2S; -+ adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_I2S; -+ break; -+ case SND_SOC_DAIFMT_RIGHT_J: -+ dac_mode |= ES8388_DACCONTROL1_DACFORMAT_RJUST; -+ adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_RJUST; -+ break; -+ case SND_SOC_DAIFMT_LEFT_J: -+ dac_mode |= ES8388_DACCONTROL1_DACFORMAT_LJUST; -+ adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_LJUST; -+ break; -+ default: -+ return -EINVAL; -+ } ++ struct net_device *ndev = to_net_dev(config->dev); ++ struct macb *bp = netdev_priv(ndev); + -+ /* clock inversion */ -+ if ((fmt & SND_SOC_DAIFMT_INV_MASK) != SND_SOC_DAIFMT_NB_NF) -+ return -EINVAL; ++ if (interface == PHY_INTERFACE_MODE_10GBASER || ++ interface == PHY_INTERFACE_MODE_5GBASER || ++ interface == PHY_INTERFACE_MODE_USXGMII) ++ bp->phylink_pcs.ops = &macb_phylink_usx_pcs_ops; ++ else if (interface == PHY_INTERFACE_MODE_SGMII || ++ interface == PHY_INTERFACE_MODE_2500BASEX) ++ bp->phylink_pcs.ops = &macb_phylink_pcs_ops; ++ else ++ bp->phylink_pcs.ops = NULL; + -+ snd_soc_component_update_bits(component, ES8388_DACCONTROL1, -+ ES8388_DACCONTROL1_DACFORMAT_MASK, dac_mode); -+ snd_soc_component_update_bits(component, ES8388_ADCCONTROL4, -+ ES8388_ADCCONTROL4_ADCFORMAT_MASK, adc_mode); ++ if (bp->phylink_pcs.ops) ++ phylink_set_pcs(bp->phylink, &bp->phylink_pcs); + + return 0; +} + -+static int es8388_set_bias_level(struct snd_soc_component *component, -+ enum snd_soc_bias_level level) -+{ -+ switch (level) { -+ case SND_SOC_BIAS_ON: -+ break; -+ -+ case SND_SOC_BIAS_PREPARE: -+ /* VREF, VMID=2x50k, digital enabled */ -+ snd_soc_component_write(component, ES8388_CHIPPOWER, 0); -+ snd_soc_component_update_bits(component, ES8388_CONTROL1, -+ ES8388_CONTROL1_VMIDSEL_MASK | -+ ES8388_CONTROL1_ENREF, -+ ES8388_CONTROL1_VMIDSEL_50k | -+ ES8388_CONTROL1_ENREF); -+ break; -+ -+ case SND_SOC_BIAS_STANDBY: -+ if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) { -+ snd_soc_component_update_bits(component, ES8388_CONTROL1, -+ ES8388_CONTROL1_VMIDSEL_MASK | -+ ES8388_CONTROL1_ENREF, -+ ES8388_CONTROL1_VMIDSEL_5k | -+ ES8388_CONTROL1_ENREF); -+ -+ /* Charge caps */ -+ msleep(100); -+ } -+ -+ snd_soc_component_write(component, ES8388_CONTROL2, -+ ES8388_CONTROL2_OVERCURRENT_ON | -+ ES8388_CONTROL2_THERMAL_SHUTDOWN_ON); -+ -+ /* VREF, VMID=2*500k, digital stopped */ -+ snd_soc_component_update_bits(component, ES8388_CONTROL1, -+ ES8388_CONTROL1_VMIDSEL_MASK | -+ ES8388_CONTROL1_ENREF, -+ ES8388_CONTROL1_VMIDSEL_500k | -+ ES8388_CONTROL1_ENREF); -+ break; -+ -+ case SND_SOC_BIAS_OFF: -+ snd_soc_component_update_bits(component, ES8388_CONTROL1, -+ ES8388_CONTROL1_VMIDSEL_MASK | -+ ES8388_CONTROL1_ENREF, -+ 0); -+ break; + static const struct phylink_mac_ops macb_phylink_ops = { + .validate = macb_validate, +- .mac_pcs_get_state = macb_mac_pcs_get_state, +- .mac_an_restart = macb_mac_an_restart, ++ .mac_prepare = macb_mac_prepare, + .mac_config = macb_mac_config, + .mac_link_down = macb_mac_link_down, + .mac_link_up = macb_mac_link_up, +@@ -693,8 +1092,14 @@ static int macb_phylink_connect(struct macb *bp) + struct device_node *dn = bp->pdev->dev.of_node; + struct net_device *dev = bp->dev; + struct phy_device *phydev; ++ struct macb_platform_data *pdata = dev_get_platdata(&bp->pdev->dev); + int ret; + ++ if (pdata && pdata->phytium_macb_pdata.properties) { ++ phylink_start(bp->phylink); ++ return 0; + } -+ return 0; -+} -+ -+static const struct snd_soc_dai_ops es8388_dai_ops = { -+ .startup = es8388_startup, -+ .hw_params = es8388_hw_params, -+ .mute_stream = es8388_mute, -+ .set_sysclk = es8388_set_sysclk, -+ .set_fmt = es8388_set_dai_fmt, -+}; -+ -+static struct snd_soc_dai_driver es8388_dai = { -+ .name = "es8388-hifi", -+ .playback = { -+ .stream_name = "Playback", -+ .channels_min = 2, -+ .channels_max = 2, -+ .rates = ES8388_RATES, -+ .formats = ES8388_FORMATS, -+ }, -+ .capture = { -+ .stream_name = "Capture", -+ .channels_min = 2, -+ .channels_max = 2, -+ .rates = ES8388_RATES, -+ .formats = ES8388_FORMATS, -+ }, -+ .ops = &es8388_dai_ops, -+ .symmetric_rates = 1, -+}; -+ -+static int es8388_suspend(struct snd_soc_component *component) -+{ -+ return 0; -+} + -+static int es8388_resume(struct snd_soc_component *component) + if (dn) + ret = phylink_of_phy_connect(bp->phylink, dn, 0); + +@@ -704,6 +1109,7 @@ static int macb_phylink_connect(struct macb *bp) + netdev_err(dev, "no PHY found\n"); + return -ENXIO; + } ++ phydev->force_mode = bp->force_phy_mode; + + /* attach the mac to the phy */ + ret = phylink_connect_phy(bp->phylink, phydev); +@@ -719,6 +1125,29 @@ static int macb_phylink_connect(struct macb *bp) + return 0; + } + ++static void macb_get_pcs_fixed_state(struct phylink_config *config, ++ struct phylink_link_state *state) +{ -+ struct regmap *regmap = dev_get_regmap(component->dev, NULL); -+ struct es8388_priv *es8388; -+ int ret; -+ -+ es8388 = snd_soc_component_get_drvdata(component); -+ -+ regcache_mark_dirty(regmap); -+ ret = regcache_sync(regmap); -+ if (ret) { -+ dev_err(component->dev, "unable to sync regcache\n"); -+ return ret; -+ } ++ struct net_device *ndev = to_net_dev(config->dev); ++ struct macb *bp = netdev_priv(ndev); + -+ return 0; ++ state->link = (macb_readl(bp, NSR) & MACB_BIT(NSR_LINK)) != 0; +} + -+static int es8388_component_probe(struct snd_soc_component *component) ++static void macb_get_usx_pcs_fixed_state(struct phylink_config *config, ++ struct phylink_link_state *state) +{ -+ snd_soc_component_write(component, ES8388_ADCPOWER, 0xf0); -+ snd_soc_component_write(component, ES8388_CONTROL1, 0x30); -+ snd_soc_component_write(component, ES8388_DACCONTROL21, 0x80); -+ snd_soc_component_write(component, ES8388_ADCCONTROL10, 0xda); ++ u32 val; ++ struct net_device *ndev = to_net_dev(config->dev); ++ struct macb *bp = netdev_priv(ndev); + -+ return 0; ++ val = gem_readl(bp, USX_STATUS); ++ state->link = !!(val & GEM_BIT(USX_BLOCK_LOCK)); ++ val = gem_readl(bp, NCFGR); ++ if (val & GEM_BIT(PAE)) ++ state->pause = MLO_PAUSE_RX; +} + -+static void es8388_remove(struct snd_soc_component *component) -+{ -+} + /* based on au1000_eth. c*/ + static int macb_mii_probe(struct net_device *dev) + { +@@ -727,8 +1156,19 @@ static int macb_mii_probe(struct net_device *dev) + bp->phylink_config.dev = &dev->dev; + bp->phylink_config.type = PHYLINK_NETDEV; + ++ if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII || ++ bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { ++ bp->phylink_config.poll_fixed_state = true; ++ bp->phylink_config.get_fixed_state = macb_get_pcs_fixed_state; ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER || ++ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { ++ bp->phylink_config.poll_fixed_state = true; ++ bp->phylink_config.get_fixed_state = macb_get_usx_pcs_fixed_state; ++ } + -+const struct regmap_config es8388_regmap_config = { -+ .reg_bits = 8, -+ .val_bits = 8, -+ .max_register = ES8388_REG_MAX, -+ .cache_type = REGCACHE_RBTREE, -+ .use_single_read = true, -+ .use_single_write = true, -+}; -+EXPORT_SYMBOL_GPL(es8388_regmap_config); + bp->phylink = phylink_create(&bp->phylink_config, bp->pdev->dev.fwnode, + bp->phy_interface, &macb_phylink_ops); + -+static const struct snd_soc_component_driver es8388_component_driver = { -+ .probe = es8388_component_probe, -+ .remove = es8388_remove, -+ .suspend = es8388_suspend, -+ .resume = es8388_resume, -+ .set_bias_level = es8388_set_bias_level, -+ .controls = es8388_snd_controls, -+ .num_controls = ARRAY_SIZE(es8388_snd_controls), -+ .dapm_widgets = es8388_dapm_widgets, -+ .num_dapm_widgets = ARRAY_SIZE(es8388_dapm_widgets), -+ .dapm_routes = es8388_dapm_routes, -+ .num_dapm_routes = ARRAY_SIZE(es8388_dapm_routes), -+ .suspend_bias_off = 1, -+ .idle_bias_on = 1, -+ .use_pmdown_time = 1, -+ .endianness = 1, -+ .non_legacy_dai_naming = 1, -+}; + if (IS_ERR(bp->phylink)) { + netdev_err(dev, "Could not create a phylink instance (%ld)\n", + PTR_ERR(bp->phylink)); +@@ -2097,6 +2537,8 @@ static netdev_tx_t macb_start_xmit(struct sk_buff *skb, struct net_device *dev) + wmb(); + skb_tx_timestamp(skb); + ++ if (bp->caps & MACB_CAPS_TAILPTR) ++ queue_writel(queue, TAILADDR, BIT(31) | macb_tx_ring_wrap(bp, queue->tx_head)); + macb_writel(bp, NCR, macb_readl(bp, NCR) | MACB_BIT(TSTART)); + + if (CIRC_SPACE(queue->tx_head, queue->tx_tail, bp->tx_ring_size) < 1) +@@ -2294,6 +2736,9 @@ static void gem_init_rings(struct macb *bp) + queue->tx_head = 0; + queue->tx_tail = 0; + ++ if (bp->caps & MACB_CAPS_TAILPTR) ++ queue_writel(queue, TAILADDR, BIT(31) | queue->tx_head); + -+int es8388_probe(struct device *dev, struct regmap *regmap) + queue->rx_tail = 0; + queue->rx_prepared_head = 0; + +@@ -2463,6 +2908,45 @@ static void macb_configure_dma(struct macb *bp) + } + } + ++static int phytium_mac_config(struct macb *bp) +{ -+ struct es8388_priv *es8388; -+ -+ if (IS_ERR(regmap)) -+ return PTR_ERR(regmap); ++ u32 old_ctrl, ctrl; ++ u32 old_ncr, ncr; + -+ es8388 = devm_kzalloc(dev, sizeof(*es8388), GFP_KERNEL); -+ if (es8388 == NULL) -+ return -ENOMEM; ++ netdev_dbg(bp->dev, "phytium mac config"); + -+ es8388->regmap = regmap; ++ ncr = macb_readl(bp, NCR); ++ old_ncr = ncr; ++ ctrl = macb_or_gem_readl(bp, NCFGR); ++ old_ctrl = ctrl; + -+ dev_set_drvdata(dev, es8388); ++ ncr &= ~(GEM_BIT(ENABLE_HS_MAC) | MACB_BIT(2PT5G)); ++ ctrl &= ~(GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL) | MACB_BIT(SPD) | MACB_BIT(FD)); ++ if (macb_is_gem(bp)) ++ ctrl &= ~GEM_BIT(GBE); + -+ return devm_snd_soc_register_component(dev, -+ &es8388_component_driver, &es8388_dai, 1); -+} -+EXPORT_SYMBOL_GPL(es8388_probe); ++ if (bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { ++ ctrl |= GEM_BIT(PCSSEL) | GEM_BIT(SGMIIEN); ++ ncr |= MACB_BIT(2PT5G); ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_USXGMII || ++ bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) { ++ ctrl |= GEM_BIT(PCSSEL); ++ ncr |= GEM_BIT(ENABLE_HS_MAC); ++ } + -+static const struct i2c_device_id es8388_id[] = { -+ { "es8388", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(i2c, es8388_id); ++ if (bp->duplex) ++ ctrl |= MACB_BIT(FD); + -+static const struct of_device_id es8388_of_match[] = { -+ { .compatible = "everest,es8388", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, es8388_of_match); ++ /* Apply the new configuration, if any */ ++ if (old_ctrl ^ ctrl) ++ macb_or_gem_writel(bp, NCFGR, ctrl); + -+static struct acpi_device_id es8388_acpi_match[] = { -+ {"ESSX8388", 0 }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(acpi, es8388_acpi_match); ++ if (old_ncr ^ ncr) ++ macb_or_gem_writel(bp, NCR, ncr); + -+static int es8388_i2c_probe(struct i2c_client *i2c, -+ const struct i2c_device_id *id) -+{ -+ return es8388_probe(&i2c->dev, -+ devm_regmap_init_i2c(i2c, &es8388_regmap_config)); ++ return 0; +} + -+static struct i2c_driver es8388_i2c_driver = { -+ .driver = { -+ .name = "es8388", -+ .of_match_table = es8388_of_match, -+ .acpi_match_table = es8388_acpi_match, -+ }, -+ .probe = es8388_i2c_probe, -+ .id_table = es8388_id, -+}; -+ -+module_i2c_driver(es8388_i2c_driver); -+ -+MODULE_DESCRIPTION("ASoC ES8388 driver"); -+MODULE_AUTHOR("Yiqun Zhang "); -+MODULE_LICENSE("GPL"); -diff --git a/sound/soc/codecs/es8388.h b/sound/soc/codecs/es8388.h -new file mode 100644 -index 000000000..5858a7126 ---- /dev/null -+++ b/sound/soc/codecs/es8388.h -@@ -0,0 +1,290 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * es8388.h -- ES8388 ALSA SoC Audio driver -+ */ -+ -+#ifndef _ES8388_H -+#define _ES8388_H -+ -+#include -+ -+struct device; -+ -+extern const struct regmap_config es8388_regmap_config; -+int es8388_probe(struct device *dev, struct regmap *regmap); + static void macb_init_hw(struct macb *bp) + { + u32 config; +@@ -2491,6 +2975,25 @@ static void macb_init_hw(struct macb *bp) + if (bp->caps & MACB_CAPS_JUMBO) + bp->rx_frm_len_mask = MACB_RX_JFRMLEN_MASK; + ++ gem_writel(bp, AXI_PIPE, 0x1010); ++ if (bp->caps & MACB_CAPS_TAILPTR) ++ gem_writel(bp, TAIL_ENABLE, 0x80000001); + -+#define ES8388_DACLVOL 46 -+#define ES8388_DACRVOL 47 -+#define ES8388_DACCTL 28 -+#define ES8388_RATEMASK (0x1f << 0) ++ if (bp->phy_interface == PHY_INTERFACE_MODE_USXGMII || ++ bp->phy_interface == PHY_INTERFACE_MODE_5GBASER || ++ bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { ++ /* phytium need hwclock */ ++ if (bp->caps & MACB_CAPS_SEL_CLK) ++ bp->sel_clk_hw(bp, bp->speed); ++ phytium_mac_config(bp); ++ if (bp->link) ++ macb_usx_pcs_link_up(&bp->phylink_pcs, 0, ++ bp->phy_interface, bp->speed, bp->duplex); ++ } else { ++ bp->speed = SPEED_10; ++ bp->duplex = DUPLEX_HALF; ++ } + -+#define ES8388_CONTROL1 0x00 -+#define ES8388_CONTROL1_VMIDSEL_OFF (0 << 0) -+#define ES8388_CONTROL1_VMIDSEL_50k (1 << 0) -+#define ES8388_CONTROL1_VMIDSEL_500k (2 << 0) -+#define ES8388_CONTROL1_VMIDSEL_5k (3 << 0) -+#define ES8388_CONTROL1_VMIDSEL_MASK (3 << 0) -+#define ES8388_CONTROL1_ENREF (1 << 2) -+#define ES8388_CONTROL1_SEQEN (1 << 3) -+#define ES8388_CONTROL1_SAMEFS (1 << 4) -+#define ES8388_CONTROL1_DACMCLK_ADC (0 << 5) -+#define ES8388_CONTROL1_DACMCLK_DAC (1 << 5) -+#define ES8388_CONTROL1_LRCM (1 << 6) -+#define ES8388_CONTROL1_SCP_RESET (1 << 7) + macb_configure_dma(bp); + } + +@@ -2615,7 +3118,10 @@ static void macb_set_rx_mode(struct net_device *dev) + + static int macb_open(struct net_device *dev) + { +- size_t bufsz = dev->mtu + ETH_HLEN + ETH_FCS_LEN + NET_IP_ALIGN; ++ /* adjust bufsz to be at least the size of a standard frame, ++ * to fix rx error when set small size mtu. ++ */ ++ size_t bufsz = (dev->mtu < ETH_DATA_LEN ? ETH_DATA_LEN : dev->mtu) + ETH_HLEN + ETH_FCS_LEN + NET_IP_ALIGN; + struct macb *bp = netdev_priv(dev); + struct macb_queue *queue; + unsigned int q; +@@ -3540,9 +4046,14 @@ static const struct net_device_ops macb_netdev_ops = { + .ndo_set_mac_address = eth_mac_addr, + #ifdef CONFIG_NET_POLL_CONTROLLER + .ndo_poll_controller = macb_poll_controller, ++#endif ++#ifdef CONFIG_MACB_TSN ++ .ndo_setup_tc = phytium_setup_tc, + #endif + .ndo_set_features = macb_set_features, + .ndo_features_check = macb_features_check, ++ .ndo_vlan_rx_add_vid = ncsi_vlan_rx_add_vid, ++ .ndo_vlan_rx_kill_vid = ncsi_vlan_rx_kill_vid, + }; + + /* Configure peripheral capabilities according to device tree +@@ -3552,16 +4063,26 @@ static void macb_configure_caps(struct macb *bp, + const struct macb_config *dt_conf) + { + u32 dcfg; ++ struct macb_platform_data *pdata; + + if (dt_conf) + bp->caps = dt_conf->caps; + ++ pdata = dev_get_platdata(&bp->pdev->dev); ++ if (pdata && pdata->phytium_macb_pdata.phytium_dev_type == PHYTIUM_DEV_3P0) ++ bp->caps |= pdata->phytium_macb_pdata.caps; + -+#define ES8388_CONTROL2 0x01 -+#define ES8388_CONTROL2_VREF_BUF_OFF (1 << 0) -+#define ES8388_CONTROL2_VREF_LOWPOWER (1 << 1) -+#define ES8388_CONTROL2_IBIASGEN_OFF (1 << 2) -+#define ES8388_CONTROL2_ANALOG_OFF (1 << 3) -+#define ES8388_CONTROL2_VREF_BUF_LOWPOWER (1 << 4) -+#define ES8388_CONTROL2_VCM_MOD_LOWPOWER (1 << 5) -+#define ES8388_CONTROL2_OVERCURRENT_ON (1 << 6) -+#define ES8388_CONTROL2_THERMAL_SHUTDOWN_ON (1 << 7) + if (hw_is_gem(bp->regs, bp->native_io)) { + bp->caps |= MACB_CAPS_MACB_IS_GEM; + + dcfg = gem_readl(bp, DCFG1); + if (GEM_BFEXT(IRQCOR, dcfg) == 0) + bp->caps |= MACB_CAPS_ISR_CLEAR_ON_WRITE; ++ if (GEM_BFEXT(NO_PCS, dcfg) == 0) ++ bp->caps |= MACB_CAPS_PCS; ++ dcfg = gem_readl(bp, DCFG12); ++ if (GEM_BFEXT(HIGH_SPEED, dcfg) == 1) ++ bp->caps |= MACB_CAPS_HIGH_SPEED; + dcfg = gem_readl(bp, DCFG2); + if ((dcfg & (GEM_BIT(RX_PKT_BUFF) | GEM_BIT(TX_PKT_BUFF))) == 0) + bp->caps |= MACB_CAPS_FIFO_MODE; +@@ -3603,9 +4124,10 @@ static void macb_probe_queues(void __iomem *mem, + *num_queues = hweight32(*queue_mask); + } + +-static int macb_clk_init(struct platform_device *pdev, struct clk **pclk, +- struct clk **hclk, struct clk **tx_clk, +- struct clk **rx_clk, struct clk **tsu_clk) ++#ifdef CONFIG_ACPI ++static int phytium_clk_acpi_init(struct platform_device *pdev, struct clk **pclk, ++ struct clk **hclk, struct clk **tx_clk, ++ struct clk **rx_clk, struct clk **tsu_clk) + { + struct macb_platform_data *pdata; + int err; +@@ -3614,38 +4136,103 @@ static int macb_clk_init(struct platform_device *pdev, struct clk **pclk, + if (pdata) { + *pclk = pdata->pclk; + *hclk = pdata->hclk; ++ *tx_clk = pdata->phytium_macb_pdata.txclk; ++ *rx_clk = pdata->phytium_macb_pdata.rxclk; ++ *tsu_clk = pdata->phytium_macb_pdata.tsu_clk; + } else { +- *pclk = devm_clk_get(&pdev->dev, "pclk"); +- *hclk = devm_clk_get(&pdev->dev, "hclk"); ++ *pclk = NULL; ++ *hclk = NULL; ++ *tx_clk = NULL; ++ *rx_clk = NULL; ++ *tsu_clk = NULL; + } + +- if (IS_ERR_OR_NULL(*pclk)) { +- err = PTR_ERR(*pclk); +- if (!err) +- err = -ENODEV; +- +- dev_err(&pdev->dev, "failed to get macb_clk (%d)\n", err); ++ err = clk_prepare_enable(*pclk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable pclk (%d)\n", err); + return err; + } + +- if (IS_ERR_OR_NULL(*hclk)) { +- err = PTR_ERR(*hclk); +- if (!err) +- err = -ENODEV; ++ err = clk_prepare_enable(*hclk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable hclk (%d)\n", err); ++ goto err_disable_pclk; ++ } + +- dev_err(&pdev->dev, "failed to get hclk (%d)\n", err); +- return err; ++ err = clk_prepare_enable(*tx_clk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable tx_clk (%d)\n", err); ++ goto err_disable_hclk; + } + +- *tx_clk = devm_clk_get_optional(&pdev->dev, "tx_clk"); ++ err = clk_prepare_enable(*rx_clk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable rx_clk (%d)\n", err); ++ goto err_disable_txclk; ++ } + -+#define ES8388_CHIPPOWER 0x02 -+#define ES8388_CHIPPOWER_DACVREF_OFF 0 -+#define ES8388_CHIPPOWER_ADCVREF_OFF 1 -+#define ES8388_CHIPPOWER_DACDLL_OFF 2 -+#define ES8388_CHIPPOWER_ADCDLL_OFF 3 -+#define ES8388_CHIPPOWER_DACSTM_RESET 4 -+#define ES8388_CHIPPOWER_ADCSTM_RESET 5 -+#define ES8388_CHIPPOWER_DACDIG_OFF 6 -+#define ES8388_CHIPPOWER_ADCDIG_OFF 7 ++ err = clk_prepare_enable(*tsu_clk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable tsu_clk (%d)\n", err); ++ goto err_disable_rxclk; ++ } + -+#define ES8388_ADCPOWER 0x03 -+#define ES8388_ADCPOWER_INT1_LOWPOWER 0 -+#define ES8388_ADCPOWER_FLASH_ADC_LOWPOWER 1 -+#define ES8388_ADCPOWER_ADC_BIAS_GEN_OFF 2 -+#define ES8388_ADCPOWER_MIC_BIAS_OFF 3 -+#define ES8388_ADCPOWER_ADCR_OFF 4 -+#define ES8388_ADCPOWER_ADCL_OFF 5 -+#define ES8388_ADCPOWER_AINR_OFF 6 -+#define ES8388_ADCPOWER_AINL_OFF 7 ++ return 0; + -+#define ES8388_DACPOWER 0x04 -+#define ES8388_DACPOWER_OUT3_ON 0 -+#define ES8388_DACPOWER_MONO_ON 1 -+#define ES8388_DACPOWER_ROUT2_ON 2 -+#define ES8388_DACPOWER_LOUT2_ON 3 -+#define ES8388_DACPOWER_ROUT1_ON 4 -+#define ES8388_DACPOWER_LOUT1_ON 5 -+#define ES8388_DACPOWER_RDAC_OFF 6 -+#define ES8388_DACPOWER_LDAC_OFF 7 ++err_disable_rxclk: ++ clk_disable_unprepare(*rx_clk); + -+#define ES8388_CHIPLOPOW1 0x05 -+#define ES8388_CHIPLOPOW2 0x06 -+#define ES8388_ANAVOLMANAG 0x07 ++err_disable_txclk: ++ clk_disable_unprepare(*tx_clk); + -+#define ES8388_MASTERMODE 0x08 -+#define ES8388_MASTERMODE_BCLKDIV (0 << 0) -+#define ES8388_MASTERMODE_BCLK_INV (1 << 5) -+#define ES8388_MASTERMODE_MCLKDIV2 (1 << 6) -+#define ES8388_MASTERMODE_MSC (1 << 7) ++err_disable_hclk: ++ clk_disable_unprepare(*hclk); + -+#define ES8388_ADCCONTROL1 0x09 -+#define ES8388_ADCCONTROL2 0x0a -+#define ES8388_ADCCONTROL3 0x0b ++err_disable_pclk: ++ clk_disable_unprepare(*pclk); + -+#define ES8388_ADCCONTROL4 0x0c -+#define ES8388_ADCCONTROL4_ADCFORMAT_MASK (3 << 0) -+#define ES8388_ADCCONTROL4_ADCFORMAT_I2S (0 << 0) -+#define ES8388_ADCCONTROL4_ADCFORMAT_LJUST (1 << 0) -+#define ES8388_ADCCONTROL4_ADCFORMAT_RJUST (2 << 0) -+#define ES8388_ADCCONTROL4_ADCFORMAT_PCM (3 << 0) -+#define ES8388_ADCCONTROL4_ADCWL_SHIFT 2 -+#define ES8388_ADCCONTROL4_ADCWL_MASK (7 << 2) -+#define ES8388_ADCCONTROL4_ADCLRP_I2S_POL_NORMAL (0 << 5) -+#define ES8388_ADCCONTROL4_ADCLRP_I2S_POL_INV (1 << 5) -+#define ES8388_ADCCONTROL4_ADCLRP_PCM_MSB_CLK2 (0 << 5) -+#define ES8388_ADCCONTROL4_ADCLRP_PCM_MSB_CLK1 (1 << 5) ++ return err; ++} ++#endif + -+#define ES8388_ADCCONTROL5 0x0d -+#define ES8388_ADCCONTROL5_RATEMASK (0x1f << 0) ++static int phytium_clk_init(struct platform_device *pdev, struct clk **pclk, ++ struct clk **hclk, struct clk **tx_clk, ++ struct clk **rx_clk, struct clk **tsu_clk) ++{ ++ struct macb_platform_data *pdata; ++ int err; + -+#define ES8388_ADCCONTROL6 0x0e ++ pdata = dev_get_platdata(&pdev->dev); ++ if (pdata) { ++ *pclk = pdata->pclk; ++ *hclk = pdata->hclk; ++ *tx_clk = pdata->phytium_macb_pdata.txclk; ++ *rx_clk = pdata->phytium_macb_pdata.rxclk; ++ *tsu_clk = pdata->phytium_macb_pdata.tsu_clk; ++ } else { ++ *pclk = devm_clk_get(&pdev->dev, "pclk"); ++ *hclk = devm_clk_get(&pdev->dev, "hclk"); ++ *tx_clk = devm_clk_get_optional(&pdev->dev, "tx_clk"); ++ *rx_clk = devm_clk_get_optional(&pdev->dev, "rx_clk"); ++ *tsu_clk = devm_clk_get_optional(&pdev->dev, "tsu_clk"); ++ } + -+#define ES8388_ADCCONTROL7 0x0f -+#define ES8388_ADCCONTROL7_ADC_MUTE (1 << 2) -+#define ES8388_ADCCONTROL7_ADC_LER (1 << 3) -+#define ES8388_ADCCONTROL7_ADC_ZERO_CROSS (1 << 4) -+#define ES8388_ADCCONTROL7_ADC_SOFT_RAMP (1 << 5) -+#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_4 (0 << 6) -+#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_8 (1 << 6) -+#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_16 (2 << 6) -+#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_32 (3 << 6) ++ if (IS_ERR_OR_NULL(*pclk)) ++ return dev_err_probe(&pdev->dev, ++ IS_ERR(*pclk) ? PTR_ERR(*pclk) : -ENODEV, ++ "failed to get pclk\n"); + -+#define ES8388_ADCCONTROL8 0x10 -+#define ES8388_ADCCONTROL9 0x11 -+#define ES8388_ADCCONTROL10 0x12 -+#define ES8388_ADCCONTROL11 0x13 -+#define ES8388_ADCCONTROL12 0x14 -+#define ES8388_ADCCONTROL13 0x15 -+#define ES8388_ADCCONTROL14 0x16 ++ if (IS_ERR_OR_NULL(*hclk)) ++ return dev_err_probe(&pdev->dev, ++ IS_ERR(*hclk) ? PTR_ERR(*hclk) : -ENODEV, ++ "failed to get hclk\n"); + -+#define ES8388_DACCONTROL1 0x17 -+#define ES8388_DACCONTROL1_DACFORMAT_MASK (3 << 1) -+#define ES8388_DACCONTROL1_DACFORMAT_I2S (0 << 1) -+#define ES8388_DACCONTROL1_DACFORMAT_LJUST (1 << 1) -+#define ES8388_DACCONTROL1_DACFORMAT_RJUST (2 << 1) -+#define ES8388_DACCONTROL1_DACFORMAT_PCM (3 << 1) -+#define ES8388_DACCONTROL1_DACWL_SHIFT 3 -+#define ES8388_DACCONTROL1_DACWL_MASK (7 << 3) -+#define ES8388_DACCONTROL1_DACLRP_I2S_POL_NORMAL (0 << 6) -+#define ES8388_DACCONTROL1_DACLRP_I2S_POL_INV (1 << 6) -+#define ES8388_DACCONTROL1_DACLRP_PCM_MSB_CLK2 (0 << 6) -+#define ES8388_DACCONTROL1_DACLRP_PCM_MSB_CLK1 (1 << 6) -+#define ES8388_DACCONTROL1_LRSWAP (1 << 7) + if (IS_ERR(*tx_clk)) + return PTR_ERR(*tx_clk); + +- *rx_clk = devm_clk_get_optional(&pdev->dev, "rx_clk"); + if (IS_ERR(*rx_clk)) + return PTR_ERR(*rx_clk); + +- *tsu_clk = devm_clk_get_optional(&pdev->dev, "tsu_clk"); + if (IS_ERR(*tsu_clk)) + return PTR_ERR(*tsu_clk); + +@@ -3696,30 +4283,346 @@ static int macb_clk_init(struct platform_device *pdev, struct clk **pclk, + return err; + } + +-static int macb_init(struct platform_device *pdev) ++static int macb_clk_init(struct platform_device *pdev, struct clk **pclk, ++ struct clk **hclk, struct clk **tx_clk, ++ struct clk **rx_clk, struct clk **tsu_clk) + { +- struct net_device *dev = platform_get_drvdata(pdev); +- unsigned int hw_q, q; +- struct macb *bp = netdev_priv(dev); +- struct macb_queue *queue; ++ struct macb_platform_data *pdata; + int err; +- u32 val, reg; + +- bp->tx_ring_size = DEFAULT_TX_RING_SIZE; +- bp->rx_ring_size = DEFAULT_RX_RING_SIZE; ++ pdata = dev_get_platdata(&pdev->dev); ++ if (pdata) { ++ *pclk = pdata->pclk; ++ *hclk = pdata->hclk; ++ } else { ++ *pclk = devm_clk_get(&pdev->dev, "pclk"); ++ *hclk = devm_clk_get(&pdev->dev, "hclk"); ++ } + +- /* set the queue register mapping once for all: queue0 has a special +- * register mapping but we don't want to test the queue index then +- * compute the corresponding register offset at run time. +- */ +- for (hw_q = 0, q = 0; hw_q < MACB_MAX_QUEUES; ++hw_q) { +- if (!(bp->queue_mask & (1 << hw_q))) +- continue; ++ if (IS_ERR_OR_NULL(*pclk)) { ++ err = PTR_ERR(*pclk); ++ if (!err) ++ err = -ENODEV; + +- queue = &bp->queues[q]; +- queue->bp = bp; +- netif_napi_add(dev, &queue->napi, macb_poll, NAPI_POLL_WEIGHT); +- if (hw_q) { ++ dev_err(&pdev->dev, "failed to get macb_clk (%d)\n", err); ++ return err; ++ } + -+#define ES8388_DACCONTROL2 0x18 -+#define ES8388_DACCONTROL2_RATEMASK (0x1f << 0) -+#define ES8388_DACCONTROL2_DOUBLESPEED (1 << 5) ++ if (IS_ERR_OR_NULL(*hclk)) { ++ err = PTR_ERR(*hclk); ++ if (!err) ++ err = -ENODEV; + -+#define ES8388_DACCONTROL3 0x19 -+#define ES8388_DACCONTROL3_AUTOMUTE (1 << 2) -+#define ES8388_DACCONTROL3_DACMUTE (1 << 2) -+#define ES8388_DACCONTROL3_LEFTGAINVOL (1 << 3) -+#define ES8388_DACCONTROL3_DACZEROCROSS (1 << 4) -+#define ES8388_DACCONTROL3_DACSOFTRAMP (1 << 5) -+#define ES8388_DACCONTROL3_DACRAMPRATE (3 << 6) ++ dev_err(&pdev->dev, "failed to get hclk (%d)\n", err); ++ return err; ++ } + -+#define ES8388_LDACVOL 0x1a -+#define ES8388_LDACVOL_MASK (0 << 0) -+#define ES8388_LDACVOL_MAX (0xc0) ++ *tx_clk = devm_clk_get_optional(&pdev->dev, "tx_clk"); ++ if (IS_ERR(*tx_clk)) ++ return PTR_ERR(*tx_clk); + -+#define ES8388_RDACVOL 0x1b -+#define ES8388_RDACVOL_MASK (0 << 0) -+#define ES8388_RDACVOL_MAX (0xc0) ++ *rx_clk = devm_clk_get_optional(&pdev->dev, "rx_clk"); ++ if (IS_ERR(*rx_clk)) ++ return PTR_ERR(*rx_clk); + -+#define ES8388_DACVOL_MAX (0xc0) ++ *tsu_clk = devm_clk_get_optional(&pdev->dev, "tsu_clk"); ++ if (IS_ERR(*tsu_clk)) ++ return PTR_ERR(*tsu_clk); + -+#define ES8388_DACCONTROL4 0x1a -+#define ES8388_DACCONTROL5 0x1b ++ err = clk_prepare_enable(*pclk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable pclk (%d)\n", err); ++ return err; ++ } + -+#define ES8388_DACCONTROL6 0x1c -+#define ES8388_DACCONTROL6_CLICKFREE (1 << 3) -+#define ES8388_DACCONTROL6_DAC_INVR (1 << 4) -+#define ES8388_DACCONTROL6_DAC_INVL (1 << 5) -+#define ES8388_DACCONTROL6_DEEMPH_MASK (3 << 6) -+#define ES8388_DACCONTROL6_DEEMPH_OFF (0 << 6) -+#define ES8388_DACCONTROL6_DEEMPH_32k (1 << 6) -+#define ES8388_DACCONTROL6_DEEMPH_44_1k (2 << 6) -+#define ES8388_DACCONTROL6_DEEMPH_48k (3 << 6) ++ err = clk_prepare_enable(*hclk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable hclk (%d)\n", err); ++ goto err_disable_pclk; ++ } + -+#define ES8388_DACCONTROL7 0x1d -+#define ES8388_DACCONTROL7_VPP_SCALE_3p5 (0 << 0) -+#define ES8388_DACCONTROL7_VPP_SCALE_4p0 (1 << 0) -+#define ES8388_DACCONTROL7_VPP_SCALE_3p0 (2 << 0) -+#define ES8388_DACCONTROL7_VPP_SCALE_2p5 (3 << 0) -+#define ES8388_DACCONTROL7_SHELVING_STRENGTH (1 << 2) /* In eights */ -+#define ES8388_DACCONTROL7_MONO (1 << 5) -+#define ES8388_DACCONTROL7_ZEROR (1 << 6) -+#define ES8388_DACCONTROL7_ZEROL (1 << 7) ++ err = clk_prepare_enable(*tx_clk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable tx_clk (%d)\n", err); ++ goto err_disable_hclk; ++ } + -+/* Shelving filter */ -+#define ES8388_DACCONTROL8 0x1e -+#define ES8388_DACCONTROL9 0x1f -+#define ES8388_DACCONTROL10 0x20 -+#define ES8388_DACCONTROL11 0x21 -+#define ES8388_DACCONTROL12 0x22 -+#define ES8388_DACCONTROL13 0x23 -+#define ES8388_DACCONTROL14 0x24 -+#define ES8388_DACCONTROL15 0x25 ++ err = clk_prepare_enable(*rx_clk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable rx_clk (%d)\n", err); ++ goto err_disable_txclk; ++ } + -+#define ES8388_DACCONTROL16 0x26 -+#define ES8388_DACCONTROL16_RMIXSEL_RIN1 (0 << 0) -+#define ES8388_DACCONTROL16_RMIXSEL_RIN2 (1 << 0) -+#define ES8388_DACCONTROL16_RMIXSEL_RIN3 (2 << 0) -+#define ES8388_DACCONTROL16_RMIXSEL_RADC (3 << 0) -+#define ES8388_DACCONTROL16_LMIXSEL_LIN1 (0 << 3) -+#define ES8388_DACCONTROL16_LMIXSEL_LIN2 (1 << 3) -+#define ES8388_DACCONTROL16_LMIXSEL_LIN3 (2 << 3) -+#define ES8388_DACCONTROL16_LMIXSEL_LADC (3 << 3) ++ err = clk_prepare_enable(*tsu_clk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable tsu_clk (%d)\n", err); ++ goto err_disable_rxclk; ++ } + -+#define ES8388_DACCONTROL17 0x27 -+#define ES8388_DACCONTROL17_LI2LOVOL (7 << 3) -+#define ES8388_DACCONTROL17_LI2LO (1 << 6) -+#define ES8388_DACCONTROL17_LD2LO (1 << 7) ++ return 0; + -+#define ES8388_DACCONTROL18 0x28 -+#define ES8388_DACCONTROL18_RI2LOVOL (7 << 3) -+#define ES8388_DACCONTROL18_RI2LO (1 << 6) -+#define ES8388_DACCONTROL18_RD2LO (1 << 7) ++err_disable_rxclk: ++ clk_disable_unprepare(*rx_clk); + -+#define ES8388_DACCONTROL19 0x29 -+#define ES8388_DACCONTROL19_LI2ROVOL (7 << 3) -+#define ES8388_DACCONTROL19_LI2RO (1 << 6) -+#define ES8388_DACCONTROL19_LD2RO (1 << 7) ++err_disable_txclk: ++ clk_disable_unprepare(*tx_clk); + -+#define ES8388_DACCONTROL20 0x2a -+#define ES8388_DACCONTROL20_RI2ROVOL (7 << 3) -+#define ES8388_DACCONTROL20_RI2RO (1 << 6) -+#define ES8388_DACCONTROL20_RD2RO (1 << 7) ++err_disable_hclk: ++ clk_disable_unprepare(*hclk); + -+#define ES8388_DACCONTROL21 0x2b -+#define ES8388_DACCONTROL21_LI2MOVOL (7 << 3) -+#define ES8388_DACCONTROL21_LI2MO (1 << 6) -+#define ES8388_DACCONTROL21_LD2MO (1 << 7) ++err_disable_pclk: ++ clk_disable_unprepare(*pclk); + -+#define ES8388_DACCONTROL22 0x2c -+#define ES8388_DACCONTROL22_RI2MOVOL (7 << 3) -+#define ES8388_DACCONTROL22_RI2MO (1 << 6) -+#define ES8388_DACCONTROL22_RD2MO (1 << 7) ++ return err; ++} + -+#define ES8388_DACCONTROL23 0x2d -+#define ES8388_DACCONTROL23_MOUTINV (1 << 1) -+#define ES8388_DACCONTROL23_HPSWPOL (1 << 2) -+#define ES8388_DACCONTROL23_HPSWEN (1 << 3) -+#define ES8388_DACCONTROL23_VROI_1p5k (0 << 4) -+#define ES8388_DACCONTROL23_VROI_40k (1 << 4) -+#define ES8388_DACCONTROL23_OUT3_VREF (0 << 5) -+#define ES8388_DACCONTROL23_OUT3_ROUT1 (1 << 5) -+#define ES8388_DACCONTROL23_OUT3_MONOOUT (2 << 5) -+#define ES8388_DACCONTROL23_OUT3_RIGHT_MIXER (3 << 5) -+#define ES8388_DACCONTROL23_ROUT2INV (1 << 7) ++static irqreturn_t phytium_macb_interrupt_intx(int irq, void *dev_id) ++{ ++ struct macb *bp = dev_id; ++ u32 irq_mask; ++ int i; + -+/* LOUT1 Amplifier */ -+#define ES8388_LOUT1VOL 0x2e -+#define ES8388_LOUT1VOL_MASK (0 << 5) -+#define ES8388_LOUT1VOL_MAX (0x24) ++ irq_mask = gem_readl(bp, INTX_IRQ_MASK); ++ if (unlikely(!irq_mask)) ++ return IRQ_NONE; + -+/* ROUT1 Amplifier */ -+#define ES8388_ROUT1VOL 0x2f -+#define ES8388_ROUT1VOL_MASK (0 << 5) -+#define ES8388_ROUT1VOL_MAX (0x24) ++ gem_writel(bp, INTX_IRQ_MASK, irq_mask); + -+#define ES8388_OUT1VOL_MAX (0x24) ++ for (i = 0; i < bp->num_queues; i++) { ++ if ((irq_mask & bp->queue_mask) & BIT(i)) ++ macb_interrupt(irq, &bp->queues[i]); ++ } ++ return IRQ_HANDLED; ++} + -+/* LOUT2 Amplifier */ -+#define ES8388_LOUT2VOL 0x30 -+#define ES8388_LOUT2VOL_MASK (0 << 5) -+#define ES8388_LOUT2VOL_MAX (0x24) ++static int phytium_queue_request_irq(struct platform_device *pdev, unsigned int q) ++{ ++ int err; ++ struct macb_queue *queue; ++ struct macb_platform_data *pdata = dev_get_platdata(&pdev->dev); ++ struct net_device *dev = platform_get_drvdata(pdev); ++ struct macb *bp = netdev_priv(dev); + -+/* ROUT2 Amplifier */ -+#define ES8388_ROUT2VOL 0x31 -+#define ES8388_ROUT2VOL_MASK (0 << 5) -+#define ES8388_ROUT2VOL_MAX (0x24) ++ queue = &bp->queues[q]; ++ if (q == 0 && pdata->phytium_macb_pdata.irq_type == IRQ_TYPE_INTX) { ++ dev->irq = pdata->phytium_macb_pdata.irq[q]; ++ err = devm_request_irq(&pdev->dev, dev->irq, phytium_macb_interrupt_intx, ++ IRQF_SHARED, dev->name, bp); ++ if (err) { ++ dev_err(&pdev->dev, ++ "Unable to request dev %d (error %d)\n", ++ dev->irq, err); ++ } ++ } + -+#define ES8388_OUT2VOL_MAX (0x24) ++ if (pdata->phytium_macb_pdata.irq_type == IRQ_TYPE_MSI) { ++ queue->irq = pdata->phytium_macb_pdata.irq[q]; ++ err = devm_request_irq(&pdev->dev, queue->irq, macb_interrupt, ++ 0, dev->name, queue); ++ if (err) { ++ dev_err(&pdev->dev, ++ "Unable to request IRQ %d (error %d)\n", ++ queue->irq, err); ++ } ++ } + -+/* Mono Out Amplifier */ -+#define ES8388_MONOOUTVOL 0x32 -+#define ES8388_MONOOUTVOL_MASK (0 << 5) -+#define ES8388_MONOOUTVOL_MAX (0x24) ++ return err; ++} + -+#define ES8388_DACCONTROL29 0x33 -+#define ES8388_DACCONTROL30 0x34 ++static int phytium_init(struct platform_device *pdev) ++{ ++ struct net_device *dev = platform_get_drvdata(pdev); ++ unsigned int hw_q, q; ++ struct macb *bp = netdev_priv(dev); ++ struct macb_queue *queue; ++ int err; ++ u32 val, reg; ++ struct macb_platform_data *pdata; + -+#define ES8388_SYSCLK 0 ++ bp->tx_ring_size = DEFAULT_TX_RING_SIZE; ++ bp->rx_ring_size = DEFAULT_RX_RING_SIZE; + -+#define ES8388_REG_MAX 0x35 ++ pdata = dev_get_platdata(&pdev->dev); + -+#define ES8388_1536FS 1536 -+#define ES8388_1024FS 1024 -+#define ES8388_768FS 768 -+#define ES8388_512FS 512 -+#define ES8388_384FS 384 -+#define ES8388_256FS 256 -+#define ES8388_128FS 128 ++ /* set the queue register mapping once for all: queue0 has a special ++ * register mapping but we don't want to test the queue index then ++ * compute the corresponding register offset at run time. ++ */ ++ for (hw_q = 0, q = 0; hw_q < MACB_MAX_QUEUES; ++hw_q) { ++ if (!(bp->queue_mask & (1 << hw_q))) ++ continue; + ++ queue = &bp->queues[q]; ++ queue->bp = bp; ++ netif_napi_add(dev, &queue->napi, macb_poll, NAPI_POLL_WEIGHT); ++ if (hw_q) { ++ queue->ISR = GEM_ISR(hw_q - 1); ++ queue->IER = GEM_IER(hw_q - 1); ++ queue->IDR = GEM_IDR(hw_q - 1); ++ queue->IMR = GEM_IMR(hw_q - 1); ++ queue->TBQP = GEM_TBQP(hw_q - 1); ++ queue->RBQP = GEM_RBQP(hw_q - 1); ++ queue->RBQS = GEM_RBQS(hw_q - 1); ++#ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT ++ if (bp->hw_dma_cap & HW_DMA_CAP_64B) { ++ queue->TBQPH = GEM_TBQPH(hw_q - 1); ++ queue->RBQPH = GEM_RBQPH(hw_q - 1); ++ } +#endif -diff --git a/sound/soc/phytium/Kconfig b/sound/soc/phytium/Kconfig -new file mode 100755 -index 000000000..8769ed7cc ---- /dev/null -+++ b/sound/soc/phytium/Kconfig -@@ -0,0 +1,30 @@ -+config SND_SOC_PHYTIUM_I2S -+ tristate "Phytium I2S Device Driver" -+ help -+ Say Y or M if you want to add support for I2S driver for -+ Phytium I2S device . The device supports 2 channels each -+ for play and record. ++ } else { ++ /* queue0 uses legacy registers */ ++ queue->ISR = MACB_ISR; ++ queue->IER = MACB_IER; ++ queue->IDR = MACB_IDR; ++ queue->IMR = MACB_IMR; ++ queue->TBQP = MACB_TBQP; ++ queue->RBQP = MACB_RBQP; ++#ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT ++ if (bp->hw_dma_cap & HW_DMA_CAP_64B) { ++ queue->TBQPH = MACB_TBQPH; ++ queue->RBQPH = MACB_RBQPH; ++ } ++#endif ++ } + -+config SND_PMDK_ES8388 -+ tristate "Phytium machine support with ES8388" -+ depends on I2C && SND_SOC_PHYTIUM_I2S -+ select SND_SOC_ES8388 -+ help -+ Say Y if you want to add Phytium machine support for -+ ES8388 codecs. ++ if (bp->caps & MACB_CAPS_TAILPTR) ++ queue->TAILADDR = GEM_TAIL(hw_q); ++ /* get irq: here we use the linux queue index, not the hardware ++ * queue index. the queue irq definitions in the device tree ++ * must remove the optional gaps that could exist in the ++ * hardware queue mask. ++ */ ++ if (pdata && pdata->phytium_macb_pdata.phytium_dev_type == PHYTIUM_DEV_3P0) { ++ err = phytium_queue_request_irq(pdev, q); ++ } else { ++ queue->irq = platform_get_irq(pdev, q); ++ err = devm_request_irq(&pdev->dev, queue->irq, macb_interrupt, ++ IRQF_SHARED, dev->name, queue); ++ if (err) { ++ dev_err(&pdev->dev, ++ "Unable to request IRQ %d (error %d)\n", ++ queue->irq, err); ++ return err; ++ } ++ } + -+config SND_PMDK_ES8336 -+ tristate "Phytium machine support with ES8336" -+ depends on I2C && SND_SOC_PHYTIUM_I2S -+ select SND_SOC_ES8336 -+ help -+ Say Y if you want to add Phytium machine support for -+ ES8336 codecs. ++ INIT_WORK(&queue->tx_error_task, macb_tx_error_task); ++ q++; ++ } + -+config SND_PMDK_DP -+ tristate "Phytium machine support with DP" -+ depends on I2C && SND_SOC_PHYTIUM_I2S -+ select SND_SOC_HDMI_CODEC -+ help -+ Say Y if you want to add Phytium machine support for -+ Displayport. -diff --git a/sound/soc/phytium/Makefile b/sound/soc/phytium/Makefile -new file mode 100644 -index 000000000..db3c0659e ---- /dev/null -+++ b/sound/soc/phytium/Makefile -@@ -0,0 +1,13 @@ -+# PHYTIUM Platform Support ++ dev->netdev_ops = &macb_netdev_ops; + -+snd-soc-phytium-i2s-objs :=phytium_i2s.o -+obj-$(CONFIG_SND_SOC_PHYTIUM_I2S) += snd-soc-phytium-i2s.o ++ /* setup appropriated routines according to adapter type */ ++ if (macb_is_gem(bp)) { ++ bp->max_tx_length = GEM_MAX_TX_LEN; ++ bp->macbgem_ops.mog_alloc_rx_buffers = gem_alloc_rx_buffers; ++ bp->macbgem_ops.mog_free_rx_buffers = gem_free_rx_buffers; ++ bp->macbgem_ops.mog_init_rings = gem_init_rings; ++ bp->macbgem_ops.mog_rx = gem_rx; ++ dev->ethtool_ops = &gem_ethtool_ops; ++ } else { ++ bp->max_tx_length = MACB_MAX_TX_LEN; ++ bp->macbgem_ops.mog_alloc_rx_buffers = macb_alloc_rx_buffers; ++ bp->macbgem_ops.mog_free_rx_buffers = macb_free_rx_buffers; ++ bp->macbgem_ops.mog_init_rings = macb_init_rings; ++ bp->macbgem_ops.mog_rx = macb_rx; ++ dev->ethtool_ops = &macb_ethtool_ops; ++ } + -+snd-soc-pmdk-es8388-objs :=pmdk_es8388.o -+obj-$(CONFIG_SND_PMDK_ES8388) += snd-soc-pmdk-es8388.o ++ /* Set features */ ++ dev->hw_features = NETIF_F_SG; + -+snd-soc-pmdk-es8336-objs :=pmdk_es8336.o -+obj-$(CONFIG_SND_PMDK_ES8336) += snd-soc-pmdk-es8336.o ++ /* Check LSO capability */ ++ if (GEM_BFEXT(PBUF_LSO, gem_readl(bp, DCFG6))) ++ dev->hw_features |= MACB_NETIF_LSO; + -+snd-soc-pmdk-dp-objs :=pmdk_dp.o -+obj-$(CONFIG_SND_PMDK_DP) += snd-soc-pmdk-dp.o -diff --git a/sound/soc/phytium/local.h b/sound/soc/phytium/local.h -new file mode 100644 -index 000000000..887facdd7 ---- /dev/null -+++ b/sound/soc/phytium/local.h -@@ -0,0 +1,328 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ ++ /* Checksum offload is only available on gem with packet buffer */ ++ if (macb_is_gem(bp) && !(bp->caps & MACB_CAPS_FIFO_MODE)) ++ dev->hw_features |= NETIF_F_HW_CSUM | NETIF_F_RXCSUM; ++ if (bp->caps & MACB_CAPS_SG_DISABLED) ++ dev->hw_features &= ~NETIF_F_SG; ++ dev->features = dev->hw_features; + -+#ifndef __PHYTIUM_I2S_LOCAL_H -+#define __PHYTIUM_I2S_LOCAL_H ++ /* Check RX Flow Filters support. ++ * Max Rx flows set by availability of screeners & compare regs: ++ * each 4-tuple define requires 1 T2 screener reg + 3 compare regs ++ */ ++ reg = gem_readl(bp, DCFG8); ++ bp->max_tuples = min((GEM_BFEXT(SCR2CMP, reg) / 3), ++ GEM_BFEXT(T2SCR, reg)); ++ INIT_LIST_HEAD(&bp->rx_fs_list.list); ++ if (bp->max_tuples > 0) { ++ /* also needs one ethtype match to check IPv4 */ ++ if (GEM_BFEXT(SCR2ETH, reg) > 0) { ++ /* program this reg now */ ++ reg = 0; ++ reg = GEM_BFINS(ETHTCMP, (uint16_t)ETH_P_IP, reg); ++ gem_writel_n(bp, ETHT, SCRT2_ETHT, reg); ++ /* Filtering is supported in hw but don't enable it in kernel now */ ++ dev->hw_features |= NETIF_F_NTUPLE; ++ /* init Rx flow definitions */ ++ bp->rx_fs_list.count = 0; ++ spin_lock_init(&bp->rx_fs_lock); ++ } else { ++ bp->max_tuples = 0; ++ } ++ } + -+#include -+#include -+#include -+#include ++ if (!(bp->caps & MACB_CAPS_USRIO_DISABLED)) { ++ val = 0; ++ if (phy_interface_mode_is_rgmii(bp->phy_interface)) ++ val = GEM_BIT(RGMII); ++ else if (bp->phy_interface == PHY_INTERFACE_MODE_RMII && ++ (bp->caps & MACB_CAPS_USRIO_DEFAULT_IS_MII_GMII)) ++ val = MACB_BIT(RMII); ++ else if (!(bp->caps & MACB_CAPS_USRIO_DEFAULT_IS_MII_GMII)) ++ val = MACB_BIT(MII); ++ ++ if (bp->caps & MACB_CAPS_USRIO_HAS_CLKEN) ++ val |= MACB_BIT(CLKEN); + -+/* I2S clk setting*/ -+#define CLK_CFG0 0xc00 -+#define CLK_CFG1 0xc04 ++ macb_or_gem_writel(bp, USRIO, val); ++ } + -+/* common register for all channel */ -+#define I2S_IER 0x000 -+#define IRER 0x004 -+#define ITER 0x008 -+#define CER 0x00C ++ /* Set MII management clock divider */ ++ val = macb_mdc_clk_div(bp); ++ val |= macb_dbw(bp); ++ if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII || ++ bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) ++ val |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL); ++ macb_writel(bp, NCFGR, val); + -+#define RXFFR 0x014 -+#define TXFFR 0x018 ++#ifdef CONFIG_MACB_TSN ++ phytium_init_tsn(pdev); ++#endif + -+/* Interrupt status register fields */ -+#define ISR_TXFO BIT(5) -+#define ISR_TXFE BIT(4) -+#define ISR_RXFO BIT(1) -+#define ISR_RXDA BIT(0) ++ return 0; ++} + -+/* I2STxRxRegisters for all channels */ -+#define LRBR_LTHR(x) (0x40 * x + 0x020) -+#define RRBR_RTHR(x) (0x40 * x + 0x024) -+#define RER(x) (0x40 * x + 0x028) ++static int macb_init(struct platform_device *pdev) ++{ ++ struct net_device *dev = platform_get_drvdata(pdev); ++ unsigned int hw_q, q; ++ struct macb *bp = netdev_priv(dev); ++ struct macb_queue *queue; ++ int err; ++ u32 val, reg; + -+#define RCR(x) (0x40 * x + 0x030) ++ bp->tx_ring_size = DEFAULT_TX_RING_SIZE; ++ bp->rx_ring_size = DEFAULT_RX_RING_SIZE; + -+#define ISR(x) (0x40 * x + 0x038) -+#define IMR(x) (0x40 * x + 0x03C) -+#define ROR(x) (0x40 * x + 0x040) -+#define TOR(x) (0x40 * x + 0x044) -+#define RFCR(x) (0x40 * x + 0x048) -+#define TFCR(x) (0x40 * x + 0x04C) -+#define RFF(x) (0x40 * x + 0x050) -+#define TFF(x) (0x40 * x + 0x054) ++ /* set the queue register mapping once for all: queue0 has a special ++ * register mapping but we don't want to test the queue index then ++ * compute the corresponding register offset at run time. ++ */ ++ for (hw_q = 0, q = 0; hw_q < MACB_MAX_QUEUES; ++hw_q) { ++ if (!(bp->queue_mask & (1 << hw_q))) ++ continue; + -+/*enable txd and rxd block channel0~3 */ -+#define TER(x) (0x40 * x + 0x02C) -+#define CCR 0x010 -+#define TCR(x) (0x40 * x + 0x034) ++ queue = &bp->queues[q]; ++ queue->bp = bp; ++ netif_napi_add(dev, &queue->napi, macb_poll, NAPI_POLL_WEIGHT); ++ if (hw_q) { + queue->ISR = GEM_ISR(hw_q - 1); + queue->IER = GEM_IER(hw_q - 1); + queue->IDR = GEM_IDR(hw_q - 1); +@@ -3848,6 +4751,10 @@ static int macb_init(struct platform_device *pdev) + val |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL); + macb_writel(bp, NCFGR, val); + ++#ifdef CONFIG_MACB_TSN ++ phytium_init_tsn(pdev); ++#endif + + return 0; + } + +@@ -4436,6 +5343,75 @@ static const struct macb_config zynq_config = { + .init = macb_init, + }; + ++static const struct macb_config phytium_gem1p0_config = { ++ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | ++ MACB_CAPS_JUMBO | ++ MACB_CAPS_GEM_HAS_PTP | ++ MACB_CAPS_BD_RD_PREFETCH | ++ MACB_CAPS_SEL_CLK, ++ .dma_burst_length = 16, ++ .clk_init = phytium_clk_init, ++ .init = phytium_init, ++ .jumbo_max_len = 16360, ++ .sel_clk_hw = phytium_gem1p0_sel_clk, ++}; + -+/* I2SCOMPRegisters */ -+#define I2S_COMP_PARAM_2 0x01F0 -+#define I2S_COMP_PARAM_1 0x01F4 -+#define I2S_COMP_VERSION 0x01F8 -+#define I2S_COMP_TYPE 0x01FC ++static const struct macb_config phytium_gem2p0_config = { ++ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | ++ MACB_CAPS_JUMBO | ++ MACB_CAPS_GEM_HAS_PTP | ++ MACB_CAPS_BD_RD_PREFETCH | ++ MACB_CAPS_SEL_CLK, ++ .dma_burst_length = 16, ++ .clk_init = macb_clk_init, ++ .init = macb_init, ++ .jumbo_max_len = 10240, ++ .sel_clk_hw = phytium_gem2p0_sel_clk, ++}; + -+/***I2S AND DMA***/ ++static const struct macb_config phytium_gem3p0_config = { ++ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | ++ MACB_CAPS_JUMBO | ++ MACB_CAPS_GEM_HAS_PTP | ++ MACB_CAPS_BD_RD_PREFETCH | ++ MACB_CAPS_SEL_CLK | ++ MACB_CAPS_TAILPTR, ++ .dma_burst_length = 16, ++ .clk_init = phytium_clk_init, ++ .init = phytium_init, ++ .jumbo_max_len = 10240, ++ .sel_clk_hw = phytium_gem3p0_sel_clk, ++}; + -+#define DMA_GCAP 0x0024 ++#ifdef CONFIG_ACPI ++static const struct macb_config phytium_gem1p0_acpi_config = { ++ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | ++ MACB_CAPS_JUMBO | ++ MACB_CAPS_GEM_HAS_PTP | ++ MACB_CAPS_BD_RD_PREFETCH | ++ MACB_CAPS_SEL_CLK, ++ .dma_burst_length = 16, ++ .clk_init = phytium_clk_acpi_init, ++ .init = phytium_init, ++ .jumbo_max_len = 10240, ++ .sel_clk_hw = phytium_gem1p0_sel_clk, ++}; + -+#define DMA_CHAL_CONFG1 0x0028 ++static const struct macb_config phytium_gem3p0_acpi_config = { ++ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | ++ MACB_CAPS_JUMBO | ++ MACB_CAPS_GEM_HAS_PTP | ++ MACB_CAPS_BD_RD_PREFETCH | ++ MACB_CAPS_SEL_CLK | ++ MACB_CAPS_TAILPTR, ++ .dma_burst_length = 16, ++ .clk_init = phytium_clk_acpi_init, ++ .init = phytium_init, ++ .jumbo_max_len = 10240, ++ .sel_clk_hw = phytium_gem3p0_sel_clk, ++}; ++#endif + -+#define DMA_CHAL_CONFG0 0x0004 -+#define DMA_MASK_INT 0x000c -+#define DMA_BDLPU(x) (0x40 * x + 0x0040) -+#define DMA_BDLPL(x) (0x40 * x + 0x0044) -+#define DMA_CHALX_DEV_ADDR(x) (0x40 * x + 0x0048) -+#define DMA_CHALX_CBL(x) (0x40 * x + 0x0054) -+#define DMA_CHALX_LVI(x) (0x40 * x + 0x004c) + static const struct of_device_id macb_dt_ids[] = { + { .compatible = "cdns,at32ap7000-macb" }, + { .compatible = "cdns,at91sam9260-macb", .data = &at91sam9260_config }, +@@ -4453,11 +5429,26 @@ static const struct of_device_id macb_dt_ids[] = { + { .compatible = "cdns,zynqmp-gem", .data = &zynqmp_config}, + { .compatible = "cdns,zynq-gem", .data = &zynq_config }, + { .compatible = "sifive,fu540-c000-gem", .data = &fu540_c000_config }, ++ { .compatible = "cdns,phytium-gem-1.0", .data = &phytium_gem1p0_config }, ++ { .compatible = "cdns,phytium-gem-2.0", .data = &phytium_gem2p0_config }, ++ { .compatible = "cdns,phytium-gem-3.0", .data = &phytium_gem3p0_config }, + { /* sentinel */ } + }; + MODULE_DEVICE_TABLE(of, macb_dt_ids); + #endif /* CONFIG_OF */ + ++#ifdef CONFIG_ACPI ++static const struct acpi_device_id macb_acpi_ids[] = { ++ { .id = "PHYT0036", .driver_data = (kernel_ulong_t)&phytium_gem1p0_acpi_config }, ++ { .id = "PHYT0046", .driver_data = (kernel_ulong_t)&phytium_gem3p0_acpi_config }, ++ { } ++}; + -+#define DMA_CHALX_DSIZE(x) (0x40 * x + 0x0064) -+#define DMA_CHALX_DLENTH(x) (0x40 * x + 0x0068) -+#define DMA_CHALX_CTL(x) (0x40 * x + 0x0058) ++MODULE_DEVICE_TABLE(acpi, macb_acpi_ids); ++#else ++#define macb_acpi_ids NULL ++#endif + + static const struct macb_config default_gem_config = { + .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | + MACB_CAPS_JUMBO | +@@ -4468,6 +5459,32 @@ static const struct macb_config default_gem_config = { + .jumbo_max_len = 10240, + }; + ++static void gem_ncsi_handler(struct ncsi_dev *nd) ++{ ++ if (unlikely(nd->state != ncsi_dev_state_functional)) ++ return; + -+#define DMA_CTL 0x0000 ++ netdev_dbg(nd->dev, "NCSI interface %s\n", ++ nd->link_up ? "up" : "down"); ++} + -+#define DMA_LPIB(x) (0x40 * x + 0x0050) ++static int macb_get_phy_mode(struct platform_device *pdev) ++{ ++ const char *pm; ++ int err, i; + -+#define DMA_STS 0x0008 ++ err = device_property_read_string(&pdev->dev, "phy-mode", &pm); ++ if (err < 0) ++ return err; + -+/****************/ ++ for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) { ++ if (!strcasecmp(pm, phy_modes(i))) ++ return i; ++ } + ++ return -ENODEV; ++} + -+/* max number of fragments - we may use more if allocating more pages for BDL */ -+#define BDL_SIZE 4096 -+#define AZX_MAX_BDL_ENTRIES (BDL_SIZE / 16) + static int macb_probe(struct platform_device *pdev) + { + const struct macb_config *macb_config = &default_gem_config; +@@ -4476,11 +5493,11 @@ static int macb_probe(struct platform_device *pdev) + struct clk **) = macb_config->clk_init; + int (*init)(struct platform_device *) = macb_config->init; + struct device_node *np = pdev->dev.of_node; +- struct clk *pclk, *hclk = NULL, *tx_clk = NULL, *rx_clk = NULL; ++ struct clk *pclk = NULL, *hclk = NULL, *tx_clk = NULL, *rx_clk = NULL; + struct clk *tsu_clk = NULL; + unsigned int queue_mask, num_queues; ++ struct macb_platform_data *pdata; + bool native_io; +- phy_interface_t interface; + struct net_device *dev; + struct resource *regs; + void __iomem *mem; +@@ -4488,6 +5505,15 @@ static int macb_probe(struct platform_device *pdev) + struct macb *bp; + int err, val; + ++ pdata = dev_get_platdata(&pdev->dev); ++ if (pdata) { ++ if (pdata->phytium_macb_pdata.phytium_dev_type == PHYTIUM_DEV_3P0) { ++ macb_config = &phytium_gem3p0_config; ++ clk_init = macb_config->clk_init; ++ init = macb_config->init; ++ } ++ } + -+/* -+ * Component parameter register fields - define the I2S block's -+ * configuration. -+ */ -+#define COMP1_TX_WORDSIZE_3(r) (((r) & GENMASK(27, 25)) >> 25) -+#define COMP1_TX_WORDSIZE_2(r) (((r) & GENMASK(24, 22)) >> 22) -+#define COMP1_TX_WORDSIZE_1(r) (((r) & GENMASK(21, 19)) >> 19) -+#define COMP1_TX_WORDSIZE_0(r) (((r) & GENMASK(18, 16)) >> 16) -+#define COMP1_TX_CHANNELS(r) (((r) & GENMASK(10, 9)) >> 9) -+#define COMP1_RX_CHANNELS(r) (((r) & GENMASK(8, 7)) >> 7) -+#define COMP1_RX_ENABLED(r) (((r) & BIT(6)) >> 6) -+#define COMP1_TX_ENABLED(r) (((r) & BIT(5)) >> 5) -+#define COMP1_MODE_EN(r) (((r) & BIT(4)) >> 4) -+#define COMP1_FIFO_DEPTH_GLOBAL(r) (((r) & GENMASK(3, 2)) >> 2) -+#define COMP1_APB_DATA_WIDTH(r) (((r) & GENMASK(1, 0)) >> 0) + regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); + mem = devm_ioremap_resource(&pdev->dev, regs); + if (IS_ERR(mem)) +@@ -4502,6 +5528,15 @@ static int macb_probe(struct platform_device *pdev) + clk_init = macb_config->clk_init; + init = macb_config->init; + } ++ } else if (has_acpi_companion(&pdev->dev)) { ++ const struct acpi_device_id *match; + -+#define COMP2_RX_WORDSIZE_3(r) (((r) & GENMASK(12, 10)) >> 10) -+#define COMP2_RX_WORDSIZE_2(r) (((r) & GENMASK(9, 7)) >> 7) -+#define COMP2_RX_WORDSIZE_1(r) (((r) & GENMASK(5, 3)) >> 3) -+#define COMP2_RX_WORDSIZE_0(r) (((r) & GENMASK(2, 0)) >> 0) ++ match = acpi_match_device(macb_acpi_ids, &pdev->dev); ++ if (match && match->driver_data) { ++ macb_config = (void *)match->driver_data; ++ clk_init = macb_config->clk_init; ++ init = macb_config->init; ++ } + } + + err = clk_init(pdev, &pclk, &hclk, &tx_clk, &rx_clk, &tsu_clk); +@@ -4550,8 +5585,11 @@ static int macb_probe(struct platform_device *pdev) + if (macb_config) + bp->jumbo_max_len = macb_config->jumbo_max_len; + ++ if (macb_config) ++ bp->sel_clk_hw = macb_config->sel_clk_hw; + -+/* Number of entries in WORDSIZE and DATA_WIDTH parameter registers */ -+#define COMP_MAX_WORDSIZE (1 << 3) -+#define COMP_MAX_DATA_WIDTH (1 << 2) + bp->wol = 0; +- if (of_get_property(np, "magic-packet", NULL)) ++ if (device_property_read_bool(&pdev->dev, "magic-packet")) + bp->wol |= MACB_WOL_HAS_MAGIC_PACKET; + device_set_wakeup_capable(&pdev->dev, bp->wol & MACB_WOL_HAS_MAGIC_PACKET); + +@@ -4607,22 +5645,47 @@ static int macb_probe(struct platform_device *pdev) + macb_get_hwaddr(bp); + } + +- err = of_get_phy_mode(np, &interface); +- if (err) +- /* not found in DT, MII by default */ +- bp->phy_interface = PHY_INTERFACE_MODE_MII; +- else +- bp->phy_interface = interface; ++ err = macb_get_phy_mode(pdev); ++ if (err < 0) { ++ if (pdata && pdata->phytium_macb_pdata.phytium_dev_type == PHYTIUM_DEV_3P0) ++ bp->phy_interface = pdata->phytium_macb_pdata.phy_interface; ++ else ++ bp->phy_interface = PHY_INTERFACE_MODE_MII; ++ } else { ++ bp->phy_interface = err; ++ } + -+#define MAX_CHANNEL_NUM 8 -+#define MIN_CHANNEL_NUM 2 ++ bp->link = 0; ++ bp->duplex = DUPLEX_UNKNOWN; ++ bp->speed = SPEED_UNKNOWN; + + /* IP specific init */ + err = init(pdev); + if (err) + goto err_out_free_netdev; + ++ if (device_property_read_bool(&pdev->dev, "force-phy-mode")) { ++ bp->force_phy_mode = 1; ++ } + -+#define azx_bus(chip) (&(chip)->bus.core) -+#define bus_to_azx(_bus) container_of(_bus, struct azx, bus.core) + err = macb_mii_init(bp); + if (err) + goto err_out_free_netdev; + ++ if (device_property_read_bool(&pdev->dev, "use-ncsi")) { ++ if (!IS_ENABLED(CONFIG_NET_NCSI)) { ++ dev_err(&pdev->dev, "NCSI stack not enabled\n"); ++ goto err_out_free_netdev; ++ } ++ dev_notice(&pdev->dev, "Using NCSI interface\n"); ++ bp->use_ncsi = 1; ++ bp->ndev = ncsi_register_dev(dev, gem_ncsi_handler); ++ if (!bp->ndev) ++ goto err_out_free_netdev; ++ } else { ++ bp->use_ncsi = 0; ++ } + -+#define I2S_UNSOL_QUEUE_SIZE 64 -+#define I2S_MAX_CODECS 8 /* limit by controller side */ + netif_carrier_off(dev); + + err = register_netdev(dev); +@@ -4666,24 +5729,34 @@ static int macb_remove(struct platform_device *pdev) + { + struct net_device *dev; + struct macb *bp; ++ struct macb_platform_data *pdata = dev_get_platdata(&pdev->dev); + + dev = platform_get_drvdata(pdev); + + if (dev) { ++#ifdef CONFIG_MACB_TSN ++ phytium_deinit_tsn(pdev); ++#endif + + bp = netdev_priv(dev); + mdiobus_unregister(bp->mii_bus); + mdiobus_free(bp->mii_bus); + ++ if (bp->ndev) ++ ncsi_unregister_dev(bp->ndev); + unregister_netdev(dev); + tasklet_kill(&bp->hresp_err_tasklet); + pm_runtime_disable(&pdev->dev); + pm_runtime_dont_use_autosuspend(&pdev->dev); + if (!pm_runtime_suspended(&pdev->dev)) { +- clk_disable_unprepare(bp->tx_clk); +- clk_disable_unprepare(bp->hclk); +- clk_disable_unprepare(bp->pclk); +- clk_disable_unprepare(bp->rx_clk); +- clk_disable_unprepare(bp->tsu_clk); ++ if (!pdata) { ++ clk_disable_unprepare(bp->tx_clk); ++ clk_disable_unprepare(bp->hclk); ++ clk_disable_unprepare(bp->pclk); ++ clk_disable_unprepare(bp->rx_clk); ++ clk_disable_unprepare(bp->tsu_clk); ++ } + -+#define azx_stream(dev) (&(dev)->core) + pm_runtime_set_suspended(&pdev->dev); + } + phylink_destroy(bp->phylink); +@@ -4900,6 +5973,7 @@ static struct platform_driver macb_driver = { + .driver = { + .name = "macb", + .of_match_table = of_match_ptr(macb_dt_ids), ++ .acpi_match_table = ACPI_PTR(macb_acpi_ids), + .pm = &macb_pm_ops, + }, + }; +diff --git a/drivers/net/ethernet/cadence/macb_pci.c b/drivers/net/ethernet/cadence/macb_pci.c +index 3593b310c..63d8e3e01 100644 +--- a/drivers/net/ethernet/cadence/macb_pci.c ++++ b/drivers/net/ethernet/cadence/macb_pci.c +@@ -21,17 +21,166 @@ + + #define CDNS_VENDOR_ID 0x17cd + #define CDNS_DEVICE_ID 0xe007 ++#define PCI_DEVICE_ID_GMAC_3P0 0xdc3b ++#define PCI_SUBDEVICE_ID_SGMII 0x1000 ++#define PCI_SUBDEVICE_ID_1000BASEX 0x1001 ++#define PCI_SUBDEVICE_ID_USXGMII 0x1004 ++#define PCI_SUBDEVICE_ID_10GBASER 0x1005 + + #define GEM_PCLK_RATE 50000000 + #define GEM_HCLK_RATE 50000000 ++#define GEM_TXCLK_RATE 25000000 ++#define GEM_RXCLK_RATE 25000000 ++#define GEM_TSUCLK_RATE 300000000 + -+struct i2s_clk_config_data { -+ int chan_nr; -+ u32 data_width; -+ u32 sample_rate; ++static const u32 fixedlink[][5] = { ++ {0, 1, 1000, 1, 0}, ++ {0, 1, 2500, 1, 0}, ++ {0, 1, 5000, 1, 0}, ++ {0, 1, 10000, 1, 0}, +}; + -+struct i2sc_bus { -+ struct device *dev; -+ const struct i2s_bus_ops *ops; -+ const struct i2s_io_ops *io_ops; -+ const struct i2s_ext_bus_ops *ext_ops; -+ -+ /* h/w resources */ -+ unsigned long addr; -+ void __iomem *remap_addr; -+ int irq; -+ -+ /* codec linked list */ -+ struct list_head codec_list; -+ unsigned int num_codecs; -+ -+ unsigned int unsol_rp, unsol_wp; -+ struct work_struct unsol_work; -+ -+ struct snd_dma_buffer bdl0; -+ struct snd_dma_buffer bdl1; -+ -+ /* i2s_stream linked list */ -+ struct list_head stream_list; -+ -+ bool reverse_assign; /* assign devices in reverse order */ -+ -+ int bdl_pos_adj; /* BDL position adjustment */ -+ -+ /* locks */ -+ spinlock_t reg_lock; ++static const struct property_entry fl_properties[][2] = { ++ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[0]), {}}, ++ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[1]), {}}, ++ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[2]), {}}, ++ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[3]), {}}, +}; + -+struct i2s_bus { -+ struct i2sc_bus core; -+ -+ struct snd_card *card; -+ -+ struct pci_dev *pci; -+ -+ struct mutex prepare_mutex; ++static const struct phytium_platform_pdata phytium_sgmii_pdata = { ++ .phytium_dev_type = PHYTIUM_DEV_3P0, ++ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | ++ MACB_CAPS_JUMBO | ++ MACB_CAPS_GEM_HAS_PTP | ++ MACB_CAPS_BD_RD_PREFETCH | ++ MACB_CAPS_USRIO_DISABLED | ++ MACB_CAPS_TAILPTR, ++ .phy_interface = PHY_INTERFACE_MODE_SGMII, +}; + -+ -+/* -+ * i2s stream -+ */ -+struct i2s_stream { -+ struct i2sc_bus *bus; -+ struct snd_dma_buffer bdl; /* BDL buffer */ -+ __le32 *posbuf; /* position buffer pointer */ -+ int direction; /* playback / capture (SNDRV_PCM_STREAM_*) */ -+ -+ unsigned int bufsize; /* size of the play buffer in bytes */ -+ unsigned int period_bytes; /* size of the period in bytes */ -+ unsigned int frags; /* number for period in the play buffer */ -+ unsigned int fifo_size; /* FIFO size */ -+ -+ void __iomem *sd_addr; /* stream descriptor pointer */ -+ -+ u32 sd_int_sta_mask; /* stream int status mask */ -+ -+ /* pcm support */ -+ struct snd_pcm_substream *substream; /* assigned substream, -+ * set in PCM open -+ */ -+ unsigned int format_val; /* format value to be set in the -+ * controller and the codec -+ */ -+ unsigned char stream_tag; /* assigned stream */ -+ unsigned char index; /* stream index */ -+ int assigned_key; /* last device# key assigned to */ -+ -+ bool opened; -+ bool running; -+ bool prepared; -+ bool no_period_wakeup; -+ -+ int delay_negative_threshold; -+ -+ struct list_head list; -+ ++static const struct phytium_platform_pdata phytium_1000basex_pdata = { ++ .phytium_dev_type = PHYTIUM_DEV_3P0, ++ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | ++ MACB_CAPS_JUMBO | ++ MACB_CAPS_GEM_HAS_PTP | ++ MACB_CAPS_BD_RD_PREFETCH | ++ MACB_CAPS_USRIO_DISABLED | ++ MACB_CAPS_TAILPTR, ++ .phy_interface = PHY_INTERFACE_MODE_SGMII, ++ .properties = fl_properties[0], +}; + -+ -+struct azx_dev { -+ struct i2s_stream core; -+ unsigned int irq_pending:1; ++static const struct phytium_platform_pdata phytium_usxgmii_pdata = { ++ .phytium_dev_type = PHYTIUM_DEV_3P0, ++ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | ++ MACB_CAPS_JUMBO | ++ MACB_CAPS_GEM_HAS_PTP | ++ MACB_CAPS_BD_RD_PREFETCH | ++ MACB_CAPS_USRIO_DISABLED | ++ MACB_CAPS_TAILPTR, ++ .phy_interface = PHY_INTERFACE_MODE_USXGMII, ++ .properties = fl_properties[3], +}; + -+ -+ -+/* PCM setup */ -+static inline struct azx_dev *get_azx_dev(struct snd_pcm_substream *substream) ++static int phytium_macb_pci_init(struct pci_dev *pdev, struct macb_platform_data *plat_data, ++ struct platform_device_info *plat_info, ++ struct phytium_platform_pdata *phytium_data) +{ -+ return substream->runtime->private_data; -+} ++ int i; ++ int err; ++ char clkname[20]; + ++ err = pci_alloc_irq_vectors(pdev, 4, 4, PCI_IRQ_MSI); ++ if (err < 0) { ++ dev_err(&pdev->dev, "err=%d, fialed to allocate MSI entry", err); ++ plat_data->phytium_macb_pdata.irq_type = IRQ_TYPE_INTX; ++ plat_data->phytium_macb_pdata.irq[0] = pdev->irq; + -+#define AZX_MAX_CODECS HDA_MAX_CODECS -+#define AZX_DEFAULT_CODECS 4 ++ } else { ++ plat_data->phytium_macb_pdata.irq_type = IRQ_TYPE_MSI; ++ for (i = 0; i < 4; i++) ++ plat_data->phytium_macb_pdata.irq[i] = pci_irq_vector(pdev, i); ++ } + -+#define stream_to_azx_dev(s) container_of(s, struct azx_dev, core) ++ plat_data->phytium_macb_pdata.phytium_dev_type = phytium_data->phytium_dev_type; ++ plat_data->phytium_macb_pdata.caps = phytium_data->caps; ++ plat_data->phytium_macb_pdata.phy_interface = phytium_data->phy_interface; ++ if (phytium_data && phytium_data->properties) { ++ plat_info->fwnode = NULL; ++ plat_info->properties = phytium_data->properties; ++ plat_data->phytium_macb_pdata.properties = phytium_data->properties; ++ } + -+struct azx; ++ snprintf(clkname, 20, "txclk:%02x", plat_info->id); ++ plat_data->phytium_macb_pdata.txclk = ++ clk_register_fixed_rate(&pdev->dev, clkname, NULL, 0, GEM_TXCLK_RATE); ++ if (IS_ERR(plat_data->phytium_macb_pdata.txclk)) { ++ err = PTR_ERR(plat_data->phytium_macb_pdata.txclk); ++ goto err_txclk_register; ++ } + -+struct i2s_controller_ops { -+ int (*substream_alloc_pages)(struct azx *chip, -+ struct snd_pcm_substream *substream, -+ size_t size); -+ int (*substream_free_pages)(struct azx *chip, -+ struct snd_pcm_substream *substream); -+ int (*position_check)(struct azx *chip, struct azx_dev *azx_dev); -+}; ++ snprintf(clkname, 20, "rxclk:%02x", plat_info->id); ++ plat_data->phytium_macb_pdata.rxclk = ++ clk_register_fixed_rate(&pdev->dev, clkname, NULL, 0, GEM_RXCLK_RATE); ++ if (IS_ERR(plat_data->phytium_macb_pdata.rxclk)) { ++ err = PTR_ERR(plat_data->phytium_macb_pdata.rxclk); ++ goto err_rxclk_register; ++ } + -+struct i2s_io_ops { -+ int (*dma_alloc_pages)(struct i2sc_bus *bus, int type, size_t size, -+ struct snd_dma_buffer *buf); -+ void (*dma_free_pages)(struct i2sc_bus *bus, -+ struct snd_dma_buffer *buf); -+}; ++ snprintf(clkname, 20, "tsuclk:%02x", plat_info->id); ++ plat_data->phytium_macb_pdata.tsu_clk = ++ clk_register_fixed_rate(&pdev->dev, clkname, NULL, 0, GEM_TSUCLK_RATE); ++ if (IS_ERR(plat_data->phytium_macb_pdata.tsu_clk)) { ++ err = PTR_ERR(plat_data->phytium_macb_pdata.tsu_clk); ++ goto err_tsuclk_register; ++ } + -+struct azx { -+ struct i2s_bus bus; ++ return 0; + -+ struct snd_card *card; -+ struct pci_dev *pci; -+ int dev_index; ++err_tsuclk_register: ++ clk_unregister(plat_data->phytium_macb_pdata.rxclk); + -+ int playback_streams; -+ int playback_index_offset; -+ int capture_streams; -+ int capture_index_offset; -+ int num_streams; ++err_rxclk_register: ++ clk_unregister(plat_data->phytium_macb_pdata.txclk); + -+ /* Register interaction. */ -+ const struct i2s_controller_ops *ops; ++err_txclk_register: + -+ /* locks */ -+ struct mutex open_mutex; /* Prevents concurrent open/close operations */ ++ return err; ++} + -+ /* PCM */ -+ struct list_head pcm_list; /* azx_pcm list */ ++static void phytium_macb_pci_uninit(struct pci_dev *pdev) ++{ ++ struct platform_device *plat_dev = pci_get_drvdata(pdev); ++ struct macb_platform_data *plat_data = dev_get_platdata(&plat_dev->dev); + -+ /* flags */ -+ int bdl_pos_adj; -+ unsigned int running:1; -+ unsigned int region_requested:1; -+ unsigned int disabled:1; -+}; -+struct i2s_phytium { -+ struct azx chip; -+ struct snd_pcm_substream *substream; -+ struct device *dev; -+ struct device *pdev; -+ u32 paddr; -+ void __iomem *regs; -+ void __iomem *regs_db; -+ int irq_id; ++ plat_dev->dev.dma_ops = NULL; ++ plat_dev->dev.iommu = NULL; ++ plat_dev->dev.iommu_group = NULL; ++ plat_dev->dev.dma_range_map = NULL; + -+ /* for pending irqs */ -+ struct work_struct irq_pending_work; ++ clk_unregister(plat_data->phytium_macb_pdata.txclk); ++ clk_unregister(plat_data->phytium_macb_pdata.rxclk); ++ clk_unregister(plat_data->phytium_macb_pdata.tsu_clk); + -+ /* sync probing */ -+ struct completion probe_wait; -+ struct work_struct probe_work; ++ if (plat_data->phytium_macb_pdata.properties) { ++ struct fwnode_handle *fw_node = dev_fwnode(&plat_dev->dev); + -+ /* extra flags */ -+ unsigned int pcie:1; -+ unsigned int irq_pending_warned:1; -+ unsigned int probe_continued:1; -+ unsigned int i2s_dp:1; ++ if (fw_node) ++ fwnode_remove_software_node(fw_node); ++ fw_node = NULL; ++ } ++} + + static int macb_probe(struct pci_dev *pdev, const struct pci_device_id *id) + { + int err; + struct platform_device *plat_dev; + struct platform_device_info plat_info; ++ struct phytium_platform_pdata *phytium_data = NULL; + struct macb_platform_data plat_data; + struct resource res[2]; ++ char pclk_name[20] = "pclk"; ++ char hclk_name[20] = "hclk"; + + /* enable pci device */ + err = pcim_enable_device(pdev); +@@ -48,9 +197,6 @@ static int macb_probe(struct pci_dev *pdev, const struct pci_device_id *id) + res[0].end = pci_resource_end(pdev, 0); + res[0].name = PCI_DRIVER_NAME; + res[0].flags = IORESOURCE_MEM; +- res[1].start = pci_irq_vector(pdev, 0); +- res[1].name = PCI_DRIVER_NAME; +- res[1].flags = IORESOURCE_IRQ; + + dev_info(&pdev->dev, "EMAC physical base addr: %pa\n", + &res[0].start); +@@ -58,32 +204,48 @@ static int macb_probe(struct pci_dev *pdev, const struct pci_device_id *id) + /* set up macb platform data */ + memset(&plat_data, 0, sizeof(plat_data)); + ++ /* set up platform device info */ ++ memset(&plat_info, 0, sizeof(plat_info)); ++ plat_info.parent = &pdev->dev; ++ plat_info.fwnode = pdev->dev.fwnode; ++ plat_info.name = PLAT_DRIVER_NAME; ++ plat_info.id = pdev->devfn; ++ plat_info.res = res; ++ plat_info.num_res = ARRAY_SIZE(res); ++ plat_info.data = &plat_data; ++ plat_info.size_data = sizeof(plat_data); ++ plat_info.dma_mask = pdev->dma_mask; ++ if (pdev->vendor == PCI_VENDOR_ID_PHYTIUM) ++ phytium_data = (struct phytium_platform_pdata *)id->driver_data; + -+ unsigned int i2s_reg_comp1; -+ unsigned int i2s_reg_comp2; -+ struct clk *clk; -+ unsigned int capability; -+ unsigned int quirks; -+ u32 fifo_th; -+ int active; -+ u32 xfer_resolution; -+ u32 ccr; -+ u32 clk_base; + /* initialize clocks */ +- plat_data.pclk = clk_register_fixed_rate(&pdev->dev, "pclk", NULL, 0, ++ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) { ++ plat_info.id = (pdev->bus->number << 8) | pdev->devfn; ++ snprintf(pclk_name, 20, "pclk:%02x", plat_info.id); ++ snprintf(hclk_name, 20, "hclk:%02x", plat_info.id); ++ } ++ plat_data.pclk = clk_register_fixed_rate(&pdev->dev, pclk_name, NULL, 0, + GEM_PCLK_RATE); + if (IS_ERR(plat_data.pclk)) { + err = PTR_ERR(plat_data.pclk); + goto err_pclk_register; + } + +- plat_data.hclk = clk_register_fixed_rate(&pdev->dev, "hclk", NULL, 0, ++ plat_data.hclk = clk_register_fixed_rate(&pdev->dev, hclk_name, NULL, 0, + GEM_HCLK_RATE); + if (IS_ERR(plat_data.hclk)) { + err = PTR_ERR(plat_data.hclk); + goto err_hclk_register; + } + +- /* set up platform device info */ +- memset(&plat_info, 0, sizeof(plat_info)); +- plat_info.parent = &pdev->dev; +- plat_info.fwnode = pdev->dev.fwnode; +- plat_info.name = PLAT_DRIVER_NAME; +- plat_info.id = pdev->devfn; +- plat_info.res = res; +- plat_info.num_res = ARRAY_SIZE(res); +- plat_info.data = &plat_data; +- plat_info.size_data = sizeof(plat_data); +- plat_info.dma_mask = pdev->dma_mask; ++ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) { ++ if (phytium_macb_pci_init(pdev, &plat_data, &plat_info, phytium_data)) ++ goto err_phytium_clk_register; ++ } + -+ struct i2s_clk_config_data config; ++ res[1].start = pci_irq_vector(pdev, 0); ++ res[1].name = PCI_DRIVER_NAME; ++ res[1].flags = IORESOURCE_IRQ; + + /* register platform device */ + plat_dev = platform_device_register_full(&plat_info); +@@ -92,11 +254,21 @@ static int macb_probe(struct pci_dev *pdev, const struct pci_device_id *id) + goto err_plat_dev_register; + } + ++ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) { ++ plat_dev->dev.dma_ops = (&pdev->dev)->dma_ops; ++ plat_dev->dev.iommu = (&pdev->dev)->iommu; ++ plat_dev->dev.iommu_group = (&pdev->dev)->iommu_group; ++ plat_dev->dev.dma_range_map = (&pdev->dev)->dma_range_map; ++ } + pci_set_drvdata(pdev, plat_dev); + + return 0; + + err_plat_dev_register: ++ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) ++ clk_unregister(plat_data.phytium_macb_pdata.tsu_clk); + -+ /*azx_dev*/ -+ struct i2s_stream core; -+}; ++err_phytium_clk_register: + clk_unregister(plat_data.hclk); + + err_hclk_register: +@@ -113,11 +285,26 @@ static void macb_remove(struct pci_dev *pdev) + + clk_unregister(plat_data->pclk); + clk_unregister(plat_data->hclk); + -+#define azx_alloc_stream_pages(chip) \ -+ snd_i2s_bus_alloc_stream_pages(azx_bus(chip)) ++ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) ++ phytium_macb_pci_uninit(pdev); + platform_device_unregister(plat_dev); + -+#endif -diff --git a/sound/soc/phytium/phytium_i2s.c b/sound/soc/phytium/phytium_i2s.c -new file mode 100755 -index 000000000..c95cf5edc ++ if (pdev->device == PCI_DEVICE_ID_GMAC_3P0) ++ pci_free_irq_vectors(pdev); + } + + static const struct pci_device_id dev_id_table[] = { + { PCI_DEVICE(CDNS_VENDOR_ID, CDNS_DEVICE_ID), }, ++ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC_3P0, ++ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_SGMII), ++ .driver_data = (kernel_ulong_t)&phytium_sgmii_pdata}, ++ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC_3P0, ++ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_1000BASEX), ++ .driver_data = (kernel_ulong_t)&phytium_1000basex_pdata}, ++ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC_3P0, ++ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_USXGMII), ++ .driver_data = (kernel_ulong_t)&phytium_usxgmii_pdata}, + { 0, } + }; + +diff --git a/drivers/net/ethernet/cadence/macb_tsn.c b/drivers/net/ethernet/cadence/macb_tsn.c +new file mode 100644 +index 000000000..890d15db7 --- /dev/null -+++ b/sound/soc/phytium/phytium_i2s.c -@@ -0,0 +1,1424 @@ -+// SPDX-License-Identifier: GPL-2.0 ++++ b/drivers/net/ethernet/cadence/macb_tsn.c +@@ -0,0 +1,1290 @@ ++// SPDX-License-Identifier: GPL-2.0-only +/* -+ * Phytium I2S ASoC driver -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. ++ * Phytium TSN support driver + * -+ * Derived from sound/soc/dwc/dwc-i2s.c -+ * Copyright (C) 2010 ST Microelectronics ++ * Copyright (c) 2024 Phytium Technology Co., Ltd. + */ ++//#define DEBUG + -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "local.h" -+ -+#define NUM_CAPTURE 1 -+#define NUM_PLAYBACK 1 -+ -+#define PHYTIUM_I2S_PLAY (1 << 0) -+#define PHYTIUM_I2S_RECORD (1 << 1) -+#define PHYTIUM_I2S_SLAVE (1 << 2) -+#define PHYTIUM_I2S_MASTER (1 << 3) -+ -+#define PHYTIUM_I2S_QUIRK_16BIT_IDX_OVERRIDE (1 << 2) -+ -+#define TWO_CHANNEL_SUPPORT 2 /* up to 2.0 */ -+#define FOUR_CHANNEL_SUPPORT 4 /* up to 3.1 */ -+#define SIX_CHANNEL_SUPPORT 6 /* up to 5.1 */ -+#define EIGHT_CHANNEL_SUPPORT 8 /* up to 7.1 */ -+ -+struct pdata_px210_mfd { -+ struct device *dev; -+ char *name; -+ int clk_base; -+}; -+ -+static inline void i2s_write_reg(void __iomem *io_base, int reg, u32 val) -+{ -+ writel(val, io_base + reg); -+} ++#include ++#include ++#include ++#include ++#include ++#include + -+static inline u32 i2s_read_reg(void __iomem *io_base, int reg) -+{ -+ return readl(io_base + reg); -+} ++#include "macb.h" ++#include "macb_tsn.h" + -+static inline void i2s_disable_channels(struct i2s_phytium *dev, u32 stream) ++static int phytium_set_cbs_tc(struct net_device *ndev, void *type_data) +{ -+ u32 i = 0; ++ struct macb *bp = netdev_priv(ndev); ++ struct tc_cbs_qopt_offload *cbs = type_data; ++ u32 cbs_ctrl, idle_slope; ++ u8 tc = cbs->queue; ++ u8 tc_nums = netdev_get_num_tc(ndev); ++ u8 prio_top, prio_next; + -+ if (stream == SNDRV_PCM_STREAM_PLAYBACK) { -+ for (i = 0; i < 4; i++) -+ i2s_write_reg(dev->regs, TER(i), 0); -+ } else { -+ for (i = 0; i < 4; i++) -+ i2s_write_reg(dev->regs, RER(i), 0); -+ } -+} ++ prio_top = tc_nums - 1; ++ prio_next = tc_nums - 2; + -+static int substream_free_pages(struct azx *chip, -+ struct snd_pcm_substream *substream) -+{ -+ return snd_pcm_lib_free_pages(substream); -+} ++ pr_debug("%s %d cbs->queue %d\n", __func__, __LINE__, cbs->queue); ++ pr_debug("%s %d tc_nums %d\n", __func__, __LINE__, tc_nums); + -+static void stream_update(struct i2sc_bus *bus, struct i2s_stream *s) -+{ -+ struct azx *chip = bus_to_azx(bus); ++ /* CBS is available on the two highest priority active queues */ ++ if (tc != prio_top && tc != prio_next) ++ return -EINVAL; + -+ struct azx_dev *azx_dev = stream_to_azx_dev(s); ++ /* idleslope should be positive, sendslope should be negative */ ++ if (cbs->idleslope < 0 || cbs->sendslope > 0) ++ return -EINVAL; + -+ /* check whether this IRQ is really acceptable */ -+ if (!chip->ops->position_check || -+ chip->ops->position_check(chip, azx_dev)) { -+ spin_unlock(&bus->reg_lock); -+ snd_pcm_period_elapsed(azx_stream(azx_dev)->substream); -+ spin_lock(&bus->reg_lock); ++ /* if set sendslope, check idle - send == speed */ ++ if (cbs->sendslope != 0 && ++ (cbs->idleslope - cbs->sendslope) != bp->speed * 1000 * 1000) { ++ pr_warn("idleslope - sendslope != portTransmitRate, please check it\n"); ++ return -EINVAL; + } + -+} -+ -+int snd_i2s_bus_handle_stream_irq(struct i2sc_bus *bus, unsigned int status, -+ void (*ack)(struct i2sc_bus *, -+ struct i2s_stream *)) -+{ -+ struct i2s_stream *azx_dev; -+ u32 sd_status, qc_sd_status; -+ int handled = 0; -+ -+ list_for_each_entry(azx_dev, &bus->stream_list, list) { ++ cbs_ctrl = gem_readl(bp, CBS_CONTROL); + -+ if (status & azx_dev->sd_int_sta_mask) { -+ sd_status = i2s_read_reg(azx_dev->sd_addr, DMA_STS); -+ i2s_write_reg(azx_dev->sd_addr, DMA_STS, azx_dev->sd_int_sta_mask); -+ qc_sd_status = i2s_read_reg(azx_dev->sd_addr, DMA_STS); -+ handled |= 1 << azx_dev->index; -+ azx_dev->running = 1; -+ if (!azx_dev->substream || !azx_dev->running || -+ !(sd_status & 0xffffffff)) { -+ continue; -+ } -+ if (ack) -+ ack(bus, azx_dev); -+ } ++ if (!cbs->enable) { ++ cbs_ctrl &= (~BIT(prio_top - tc)); ++ gem_writel(bp, CBS_CONTROL, cbs_ctrl); ++ return 0; + } -+ return handled; -+} -+ -+irqreturn_t azx_i2s_interrupt(int irq, void *dev_id) -+{ -+ struct azx *chip = dev_id; -+ struct i2sc_bus *bus = azx_bus(chip); -+ u32 status; -+ bool active, handled = false; -+ int repeat = 0; /* count for avoiding endless loop */ + -+ spin_lock(&bus->reg_lock); -+ -+ if (chip->disabled) -+ goto unlock; -+ -+ do { -+ -+ status = i2s_read_reg(bus->remap_addr, DMA_STS); -+ -+ if (status == 0) -+ break; ++ pr_debug("bp->speed %d\n", bp->speed); ++ pr_debug("cbs->idleslope %d\n", cbs->idleslope); + -+ handled = true; -+ active = false; -+ if (snd_i2s_bus_handle_stream_irq(bus, status, stream_update)) -+ active = true; ++ /* calculate idle slope value, cbs->idleslope is kilobit/sec */ ++ /* reg value in bytes/sec for gigabit operation, and nibbles/sec */ ++ /* for 10/100 operation, and scaled by 2.5 in 2.5G operation */ ++ switch (bp->speed) { ++ case SPEED_10: ++ case SPEED_100: ++ idle_slope = 125 * cbs->idleslope * 2; ++ break; ++ case SPEED_1000: ++ idle_slope = 125 * cbs->idleslope; ++ break; ++ case SPEED_2500: ++ idle_slope = 125 * cbs->idleslope * 2 / 5; ++ break; ++ default: ++ pr_info("macb speed %d not support\n", bp->speed); ++ return -EOPNOTSUPP; ++ } + ++ /* cbs should be disabled prior to updating the idle slope value */ ++ cbs_ctrl &= (~BIT(prio_top - tc)); ++ gem_writel(bp, CBS_CONTROL, cbs_ctrl); + -+ } while (active && ++repeat < 1); ++ if (tc == prio_top) ++ gem_writel(bp, CBS_IDLESLOPE_Q_A, idle_slope); ++ else ++ gem_writel(bp, CBS_IDLESLOPE_Q_B, idle_slope); + -+ unlock: -+ spin_unlock(&bus->reg_lock); ++ /* after set idle slope, enable cbs */ ++ cbs_ctrl |= BIT(prio_top - tc); ++ gem_writel(bp, CBS_CONTROL, cbs_ctrl); + -+ return IRQ_RETVAL(handled); ++ return 0; +} + -+static int azx_acquire_irq(struct azx *chip, int do_disconnect) ++static int phytium_set_mqprio_tc(struct net_device *ndev, void *type_data) +{ -+ struct i2sc_bus *bus = azx_bus(chip); -+ struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); -+ int err; ++ struct macb *bp = netdev_priv(ndev); ++ struct tc_mqprio_qopt *mqprio = type_data; ++ u8 num_tc; ++ int i; + -+ err = devm_request_irq(i2s->dev, i2s->irq_id, azx_i2s_interrupt, IRQF_SHARED, -+ "phytium i2s", chip); ++ pr_debug("%s %d\n", __func__, __LINE__); ++ mqprio->hw = TC_MQPRIO_HW_OFFLOAD_TCS; ++ num_tc = mqprio->num_tc; + -+ if (err < 0) { -+ dev_err(i2s->dev, "failed to request irq\n"); -+ return err; ++ if (!num_tc) { ++ netdev_reset_tc(ndev); ++ return 0; ++ } ++ ++ /* For easier use, num_tc need same as num_queues. */ ++ if (num_tc != bp->num_queues) { ++ netdev_err(ndev, "num_tc should same as dev num_queues %d\n", ++ bp->num_queues); ++ return -EINVAL; + } + -+ bus->irq = i2s->irq_id; ++ netdev_set_num_tc(ndev, num_tc); + ++ /* Each TC is associated with one netdev queue, the queue index is */ ++ /* used as the priority, where a higher index will have a higher */ ++ /* priority than a lower index. */ ++ for (i = 0; i < num_tc; i++) ++ netdev_set_tc_queue(ndev, i, 1, i); + return 0; +} + -+static void i2s_start(struct i2s_phytium *dev, -+ struct snd_pcm_substream *substream) -+{ -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ i2s_write_reg(dev->regs, ITER, 1); -+ else -+ i2s_write_reg(dev->regs, IRER, 1); ++struct queues_enst_setting { ++ u8 enable; ++ u32 start_time; ++ u32 on_time; ++ u32 off_time; ++}; + -+ /*enable the clock*/ -+ i2s_write_reg(dev->regs, CER, 1); ++#ifdef TSN_DEBUG ++static void _dump_taprio_param(struct tc_taprio_qopt_offload *taprio) ++{ ++ int i = 0; + -+ /*enable the i2s*/ -+ i2s_write_reg(dev->regs, I2S_IER, 1); ++ _dump_param(taprio->enable); ++ _dump_param(taprio->base_time); ++ _dump_param(taprio->cycle_time); ++ _dump_param(taprio->cycle_time_extension); ++ _dump_param(taprio->num_entries); ++ for (; i < taprio->num_entries; i++) { ++ _dump_param(i); ++ _dump_param(taprio->entries[i].command); ++ _dump_param(taprio->entries[i].gate_mask); ++ _dump_param(taprio->entries[i].interval); ++ } +} + -+static void i2s_stop(struct i2s_phytium *dev, -+ struct snd_pcm_substream *substream) ++static void _dump_enst_param(struct queues_enst_setting *setting) +{ -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ i2s_write_reg(dev->regs, ITER, 0); -+ else -+ i2s_write_reg(dev->regs, IRER, 0); ++ int i = 0; + -+ if (!dev->active) { -+ i2s_write_reg(dev->regs, CER, 0); -+ i2s_write_reg(dev->regs, I2S_IER, 0); ++ for (; i < MACB_MAX_ENST_QUEUES; i++) { ++ if (!setting[i].enable) ++ continue; ++ _dump_param(i); ++ _dump_param(setting[i].enable); ++ _dump_param(setting[i].start_time); ++ _dump_param(setting[i].on_time); ++ _dump_param(setting[i].off_time); + } +} ++#else ++#define _dump_taprio_param(taprio) ++#define _dump_enst_param(setting) ++#endif + -+static void phytium_i2s_config(struct i2s_phytium *dev, int stream) ++static int _taprio_convert_enst(struct tc_taprio_qopt_offload *taprio, ++ struct queues_enst_setting *setting) +{ -+ i2s_disable_channels(dev, stream); ++ int i, j; ++ // TODO: queue start time need add base_time? ++ u32 queue_start_time = 0; + -+ if (stream == SNDRV_PCM_STREAM_PLAYBACK) { -+ i2s_write_reg(dev->regs, TCR(0), dev->xfer_resolution); -+ i2s_write_reg(dev->regs, TER(0), 1); -+ } else { -+ i2s_write_reg(dev->regs, RCR(0), dev->xfer_resolution); -+ i2s_write_reg(dev->regs, RER(0), 1); ++ for (i = 0; i < taprio->num_entries; i++) { ++ ulong bitmap = (ulong)taprio->entries[i].gate_mask; ++ ++ if (!bitmap) { ++ pr_warn("gata_mask should not be zero\n"); ++ return -EINVAL; ++ } ++ for_each_set_bit(j, &bitmap, MACB_MAX_ENST_QUEUES) { ++ /* find this entrie masked queue j */ ++ if (setting[j].enable) { ++ pr_warn("not support setting same queue two times, hw assumes with fixed period\n"); ++ return -EINVAL; ++ } ++ setting[j].enable = true; ++ setting[j].start_time = queue_start_time; ++ setting[j].on_time = taprio->entries[i].interval; ++ setting[j].off_time = ++ taprio->cycle_time - setting[j].on_time; ++ } ++ queue_start_time += taprio->entries[i].interval; + } ++ return 0; +} + -+static int phytium_i2s_hw_params(struct snd_pcm_substream *substream, -+ struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) ++static int phytium_set_taprio(struct net_device *ndev, ++ struct queues_enst_setting *setting) +{ -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); -+ struct i2s_clk_config_data *config = &dev->config; -+ u64 fix, point; -+ u32 cfg = 0; ++ struct macb *bp = netdev_priv(ndev); ++ int i; ++ int enst_ctrl = 0; ++ int scale = 8; + -+ switch (params_format(params)) { -+ case SNDRV_PCM_FORMAT_S16_LE: -+ config->data_width = 16; -+ dev->ccr = 0x00; -+ dev->xfer_resolution = 0x02; ++ switch (bp->speed) { ++ case SPEED_10: ++ scale = 800; + break; -+ -+ case SNDRV_PCM_FORMAT_S24_LE: -+ config->data_width = 24; -+ dev->ccr = 0x08; -+ dev->xfer_resolution = 0x04; ++ case SPEED_100: ++ scale = 80; + break; -+ -+ case SNDRV_PCM_FORMAT_S32_LE: -+ config->data_width = 32; -+ dev->ccr = 0x10; -+ dev->xfer_resolution = 0x05; ++ case SPEED_1000: ++ scale = 8; + break; -+ + default: -+ dev_err(dev->dev, "phytium-i2s: unsupported PCM fmt"); -+ return -EINVAL; ++ pr_info("macb speed %d not support\n", bp->speed); ++ return -EOPNOTSUPP; + } + -+ config->chan_nr = params_channels(params); -+ -+ switch (config->chan_nr) { -+ case EIGHT_CHANNEL_SUPPORT: -+ case SIX_CHANNEL_SUPPORT: -+ case FOUR_CHANNEL_SUPPORT: -+ case TWO_CHANNEL_SUPPORT: -+ break; -+ default: -+ dev_err(dev->dev, "channel not supported\n"); -+ return -EINVAL; -+ } ++ for (i = 0; i < bp->num_queues; i++) { ++ if (!setting[i].enable) ++ continue; ++ gem_writel_n(bp, ENST_START_TIME, i, setting[i].start_time); + -+ phytium_i2s_config(dev, substream->stream); ++ if (setting[i].on_time > 1048568 || ++ setting[i].off_time > 1048568) { ++ pr_warn("queue %d on_time:%d, off_time:%d should small 1048568 ns\n", ++ i, setting[i].on_time, setting[i].off_time); ++ return -EINVAL; ++ } + -+ i2s_write_reg(dev->regs, CCR, dev->ccr); ++ if (setting[i].on_time / scale < ++ ndev->mtu + ETH_HLEN + ++ ETH_FCS_LEN + NET_IP_ALIGN) ++ pr_info("tx frame may too long to be transmiited in on-time, it will cause transmission hang\n"); + -+ config->sample_rate = params_rate(params); -+ if (dev->capability & PHYTIUM_I2S_MASTER) { -+ fix = dev->clk_base / config->sample_rate / config->data_width / 32; -+ point = ((dev->clk_base / config->sample_rate) << 10) / config->data_width / 32; -+ point = (point - (fix << 10)) * 10; -+ cfg = ((u16) fix << 16) | (u16) point; -+ i2s_write_reg(dev->regs, CLK_CFG0, cfg); -+ i2s_write_reg(dev->regs, CLK_CFG1, 0xf); ++ gem_writel_n(bp, ENST_ON_TIME, i, setting[i].on_time / scale); ++ gem_writel_n(bp, ENST_OFF_TIME, i, setting[i].off_time / scale); ++ enst_ctrl |= BIT(i); + } ++ gem_writel(bp, ENST_CONTROL, enst_ctrl); + return 0; +} + -+static int phytium_i2s_prepare(struct snd_pcm_substream *substream, -+ struct snd_soc_dai *dai) ++static int phytium_set_taprio_tc(struct net_device *ndev, void *type_data) +{ -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); -+ -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ i2s_write_reg(dev->regs, TXFFR, 1); -+ else -+ i2s_write_reg(dev->regs, RXFFR, 1); ++ struct tc_taprio_qopt_offload *taprio = type_data; ++ struct queues_enst_setting setting[MACB_MAX_ENST_QUEUES] = {0}; ++ int ret; + -+ return 0; -+} ++ _dump_taprio_param(taprio); + -+static int phytium_i2s_trigger(struct snd_pcm_substream *substream, -+ int cmd, struct snd_soc_dai *dai) -+{ -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); -+ int ret = 0; ++ ret = _taprio_convert_enst(taprio, setting); ++ if (ret) ++ return ret; + -+ switch (cmd) { -+ case SNDRV_PCM_TRIGGER_START: -+ case SNDRV_PCM_TRIGGER_RESUME: -+ case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: -+ dev->active++; -+ i2s_start(dev, substream); -+ break; ++ _dump_enst_param(setting); + -+ case SNDRV_PCM_TRIGGER_STOP: -+ case SNDRV_PCM_TRIGGER_SUSPEND: -+ case SNDRV_PCM_TRIGGER_PAUSE_PUSH: -+ dev->active--; -+ i2s_stop(dev, substream); -+ break; -+ default: -+ ret = -EINVAL; -+ break; -+ } ++ ret = phytium_set_taprio(ndev, setting); + + return ret; +} + -+static int phytium_i2s_set_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt) ++int phytium_setup_tc(struct net_device *ndev, ++ enum tc_setup_type type, void *type_data) +{ -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(cpu_dai); -+ int ret = 0; ++ switch (type) { ++ case TC_SETUP_QDISC_CBS: ++ return phytium_set_cbs_tc(ndev, type_data); ++ ++ case TC_SETUP_QDISC_MQPRIO: ++ return phytium_set_mqprio_tc(ndev, type_data); ++ ++ case TC_SETUP_QDISC_TAPRIO: ++ return phytium_set_taprio_tc(ndev, type_data); + -+ switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { -+ case SND_SOC_DAIFMT_CBM_CFM: -+ if (dev->capability & PHYTIUM_I2S_SLAVE) -+ ret = 0; -+ else -+ ret = -EINVAL; -+ break; -+ case SND_SOC_DAIFMT_CBS_CFS: -+ if (dev->capability & PHYTIUM_I2S_MASTER) -+ ret = 0; -+ else -+ ret = -EINVAL; -+ break; -+ case SND_SOC_DAIFMT_CBM_CFS: -+ case SND_SOC_DAIFMT_CBS_CFM: -+ ret = -EINVAL; -+ break; + default: -+ dev_dbg(dev->dev, "phytium/i2s: Invalid master/slave format\n"); -+ ret = -EINVAL; -+ break; ++ return -EOPNOTSUPP; + } -+ return ret; -+} -+ -+static const struct snd_soc_dai_ops phytium_i2s_dai_ops = { -+ .hw_params = phytium_i2s_hw_params, -+ .prepare = phytium_i2s_prepare, -+ .trigger = phytium_i2s_trigger, -+ .set_fmt = phytium_i2s_set_fmt, +}; + -+#ifdef CONFIG_PM -+ -+static int phytium_i2s_suspend(struct snd_soc_component *component) -+{ -+ return 0; -+} ++static int phytium_find_stream_id(struct macb *bp, long value, bool print); + -+static int phytium_i2s_resume(struct snd_soc_component *component) ++static int phytium_set_cb(struct macb *bp, struct tsn_setting_param *setting) +{ -+ struct i2s_phytium *dev = snd_soc_component_get_drvdata(component); -+ struct snd_soc_dai *dai; -+ -+ for_each_component_dais(component, dai) { -+ if (snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_PLAYBACK)) -+ phytium_i2s_config(dev, SNDRV_PCM_STREAM_PLAYBACK); -+ if (snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_CAPTURE)) -+ phytium_i2s_config(dev, SNDRV_PCM_STREAM_CAPTURE); -+ } ++ int frer_reg_ofst, frer_stream_ofst; ++ int redundancy_tag, frer_control_a, frer_control_b; + -+ return 0; -+} ++ if (setting[CB_HIS_LEN].value > bp->cb_history_len || ++ setting[CB_OFST].value > bp->num_cb_streams || ++ setting[CB_SEQ_LEN].value > 16) ++ return -EINVAL; + -+#else -+#define phytium_i2s_suspend NULL -+#define phytium_i2s_resume NULL -+#endif ++ if (phytium_find_stream_id(bp, setting[CB_INDEX].value, false)) ++ return -EINVAL; + -+static struct snd_soc_dai_driver phytium_i2s_dai = { -+ .playback = { -+ .stream_name = "i2s-Playback", -+ .channels_min = 2, -+ .channels_max = 2, -+ .rates = SNDRV_PCM_RATE_8000_192000, -+ .formats = SNDRV_PCM_FMTBIT_S8 | -+ SNDRV_PCM_FMTBIT_S16_LE | -+ SNDRV_PCM_FMTBIT_S20_LE | -+ SNDRV_PCM_FMTBIT_S24_LE | -+ SNDRV_PCM_FMTBIT_S32_LE, -+ }, -+ .capture = { -+ .stream_name = "i2s-Capture", -+ .channels_min = 2, -+ .channels_max = 2, -+ .rates = SNDRV_PCM_RATE_8000_192000, -+ .formats = SNDRV_PCM_FMTBIT_S8 | -+ SNDRV_PCM_FMTBIT_S16_LE | -+ SNDRV_PCM_FMTBIT_S20_LE | -+ SNDRV_PCM_FMTBIT_S24_LE | -+ SNDRV_PCM_FMTBIT_S32_LE, -+ }, -+ .ops = &phytium_i2s_dai_ops, -+ .symmetric_rates = 1, -+}; ++ frer_reg_ofst = (setting[CB_OFST].value > 1) ? ++ 4 * (setting[CB_OFST].value > 1) : 0; ++ frer_stream_ofst = setting[CB_OFST].value % 2; + -+static const struct snd_pcm_hardware phytium_pcm_hardware = { -+ .info = SNDRV_PCM_INFO_INTERLEAVED | -+ SNDRV_PCM_INFO_MMAP | -+ SNDRV_PCM_INFO_MMAP_VALID | -+ SNDRV_PCM_INFO_BLOCK_TRANSFER, -+ .rates = SNDRV_PCM_RATE_8000 | -+ SNDRV_PCM_RATE_32000 | -+ SNDRV_PCM_RATE_44100 | -+ SNDRV_PCM_RATE_48000, -+ .rate_min = 8000, -+ .rate_max = 48000, -+ .formats = (SNDRV_PCM_FMTBIT_S8 | -+ SNDRV_PCM_FMTBIT_S16_LE | -+ SNDRV_PCM_FMTBIT_S20_LE | -+ SNDRV_PCM_FMTBIT_S24_LE | -+ SNDRV_PCM_FMTBIT_S32_LE), -+ .channels_min = 2, -+ .channels_max = 2, -+ .buffer_bytes_max = 4096*16, -+ .period_bytes_min = 1024, -+ .period_bytes_max = 4096*4, -+ .periods_min = 2, -+ .periods_max = 16, -+ .fifo_size = 16, -+}; ++ /* counter of 8192 rx_clk periods, */ ++ /* in gigabit means 65.536 us, set 1ms here */ ++ gem_writel(bp, FRER_TIMEOUT, 0xF); + -+struct i2s_stream *snd_i2s_stream_assign(struct i2sc_bus *bus, -+ struct snd_pcm_substream *substream) -+{ -+ struct i2s_stream *azx_dev; -+ struct i2s_stream *res = NULL; ++ redundancy_tag = GEM_BFINS(STRIP_R_TAG, setting[CB_STRIP_RTAG].value, ++ gem_readl(bp, FRER_RED_TAG)); ++ gem_writel(bp, FRER_RED_TAG, redundancy_tag); + -+ /* make a non-zero unique key for the substream */ -+ int key = (substream->pcm->device << 16) | (substream->number << 2) | -+ (substream->stream + 1); ++ /* before setting, set en_elimination low */ ++ frer_control_a = gem_readl_n(bp, FRER_CONTROL_1_A, frer_reg_ofst); ++ frer_control_a &= (~BIT(31)); + -+ list_for_each_entry(azx_dev, &bus->stream_list, list) { -+ if (azx_dev->direction != substream->stream) -+ continue; ++ gem_writel_n(bp, FRER_CONTROL_1_A, frer_reg_ofst, frer_control_a); + -+ azx_dev->opened = 0; ++ if (setting[CB_ENABLE].value == 0) ++ return 0; + -+ if (azx_dev->assigned_key == key) { -+ res = azx_dev; -+ break; -+ } ++ /* setting enable, now set frer control b */ ++ frer_control_b = GEM_BF(SEQ_NUM_LENGTH, setting[CB_SEQ_LEN].value) | ++ GEM_BF(SEQ_REC_WINDOW, ++ setting[CB_HIS_LEN].value); ++ gem_writel_n(bp, FRER_CONTROL_1_B, frer_reg_ofst, frer_control_b); + -+ if (!res || bus->reverse_assign) -+ res = azx_dev; -+ } ++ /* enable some default config */ ++ frer_control_a |= 0xF0000000; ++ if (frer_stream_ofst) ++ frer_control_a = GEM_BFINS(MEMBER_STREAM2, ++ setting[CB_INDEX].value, ++ frer_control_a); ++ else ++ frer_control_a = GEM_BFINS(MEMBER_STREAM1, ++ setting[CB_INDEX].value, ++ frer_control_a); + -+ if (res) { -+ spin_lock_irq(&bus->reg_lock); -+ res->opened = 1; -+ res->running = 0; -+ res->assigned_key = key; -+ res->substream = substream; -+ spin_unlock_irq(&bus->reg_lock); -+ } ++ gem_writel_n(bp, FRER_CONTROL_1_A, frer_reg_ofst, frer_control_a); + -+ return res; ++ return 0; +} + -+/* assign a stream for the PCM */ -+static inline struct azx_dev * -+azx_assign_device(struct azx *chip, struct snd_pcm_substream *substream) ++static ssize_t cb_setting_show(struct device *dev, ++ struct device_attribute *attr, char *buf) +{ -+ struct i2s_stream *s; ++ struct macb *bp = container_of(attr, struct macb, cb_setting_attr); + -+ s = snd_i2s_stream_assign(azx_bus(chip), substream); -+ if (!s) -+ return NULL; -+ return stream_to_azx_dev(s); ++ return snprintf(buf, PAGE_SIZE, ++ "help:\n" ++ " index: stream id handle, if use ethtool to do stream identify, it should same as [loc]\n" ++ " ofst: set offset of cb streams to hw, valid max to %d (optional, default 0)\n" ++ " seq_len: number of significant bits of th 802.1CB sequence number, max to 16(optional, default 16)\n" ++ " his_len: sequence history windows size, max to %d(optional, default %d)\n" ++ " strip_rtag: set this to 1 will tripping of the R-TAG from received frames(optional, default 1)\n" ++ " and strip_rtag is globla config, will affect all cb stream setting.\n" ++ " enable: enable:1, disable:0\n" ++ "example:\n" ++ " echo index 1 ofst 0 seq_len 16 his_len 64 strip_rtag 1 enable 1 > cb_setting\n" ++ " echo index 1 enable 1 > cb_setting\n" ++ "note:\n" ++ " if you set ofst 0 first, and set ofst 1 after, the ofst 1's setting will cover ofst 0's\n" ++ " because ofst 0 & 1(or even & odd) use same cb streams setting register.\n" ++ , bp->num_cb_streams, bp->cb_history_len, bp->cb_history_len); +} + -+static int phytium_pcm_open(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream) ++static ssize_t cb_setting_store(struct device *dev, ++ struct device_attribute *attr, ++ const char *buf, size_t count) +{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ struct azx *chip = &dev->chip; -+ struct azx_dev *azx_dev; -+ struct snd_pcm_runtime *runtime = substream->runtime; -+ -+ azx_dev = azx_assign_device(chip, substream); -+ if (azx_dev == NULL) -+ return -EBUSY; -+ -+ snd_soc_set_runtime_hwparams(substream, &phytium_pcm_hardware); -+ snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); -+ snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 128); -+ runtime->private_data = azx_dev; ++ struct macb *bp = container_of(attr, struct macb, cb_setting_attr); ++ struct tsn_setting_param cb_setting[] = { ++ [CB_INDEX] = { .name = "index", 1}, ++ [CB_OFST] = { .name = "ofst", 0}, ++ [CB_SEQ_LEN] = { .name = "seq_len", 16}, ++ [CB_HIS_LEN] = { .name = "his_len", 64}, ++ [CB_STRIP_RTAG] = { .name = "strip_rtag", 1}, ++ [CB_ENABLE] = { .name = "enable", 0}, ++ }; ++ int i, ret; + -+ return 0; -+} ++ for (i = 0; i < GET_SETTING_SIZE(cb_setting); i++) { ++ /* find setting name */ ++ char *tmp = strstr(buf, cb_setting[i].name); ++ char *end; ++ int recovery = 0; + -+static int phytium_pcm_close(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream) -+{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ struct azx *chip = &dev->chip; -+ struct azx_dev *azx_dev = get_azx_dev(substream); ++ if (!tmp) ++ continue; ++ tmp += strlen(cb_setting[i].name); ++ tmp = skip_spaces(tmp); ++ end = strpbrk(tmp, " "); ++ if (end) { ++ recovery = 1; ++ *end = '\0'; ++ } ++ /* kstrtol input string must be null-terminated */ ++ ret = kstrtol(tmp, 10, &cb_setting[i].value); ++ if (recovery) ++ *end = ' '; + -+ mutex_lock(&chip->open_mutex); -+ azx_stream(azx_dev)->opened = 0; -+ azx_stream(azx_dev)->running = 0; -+ azx_stream(azx_dev)->substream = NULL; ++ if (ret < 0) ++ return ret; ++ dev_dbg(dev, "get: %s=%ld\n", ++ cb_setting[i].name, cb_setting[i].value); ++ } + -+ mutex_unlock(&chip->open_mutex); -+ return 0; ++ ret = phytium_set_cb(bp, cb_setting); ++ if (ret < 0) ++ return ret; ++ return count; +} ++DEVICE_ATTR_RW(cb_setting); + -+static int phytium_pcm_new(struct snd_soc_component *component, -+ struct snd_soc_pcm_runtime *rtd) ++static ssize_t stream_id_show(struct device *dev, ++ struct device_attribute *attr, char *buf) +{ -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ size_t size = phytium_pcm_hardware.buffer_bytes_max; -+ -+ snd_pcm_set_managed_buffer_all(rtd->pcm, -+ SNDRV_DMA_TYPE_DEV, -+ dev->pdev, size, size); ++ struct macb *bp = container_of(attr, struct macb, stream_id_attr); + -+ return 0; ++ return snprintf(buf, PAGE_SIZE, ++ "help:\n" ++ " index: tsnStreamIdHandle, decimal\n" ++ " src_mac: tsnCpeSmacVlanDownSrcMac input format:aabbcc112233\n" ++ " dst_mac: tsnCpeNullDownDestMac input format:aa1122bbcc33\n" ++ " src_ip: ipv4 source address input format:192.168.1.2\n" ++ " dst_ip: ipv4 destination address input format:192.168.1.2\n" ++ " src_port: ip source port input format:5001\n" ++ " dst_port: ip destination port input format:5001\n" ++ " vlan_id: tsnCpeSmacVlanDownVlan or tsnCpeNullDownVlan, decimal\n" ++ " rx_queue: set the queue num to receive this stream id, max to %d\n" ++ " also use as IPV (internal priority value),\n" ++ " higher queue index means higher priority\n" ++ "p.s.if set src/dst mac, dst/dst ip/port will be ignored\n" ++ "example:\n" ++ " echo add index 0 src_mac aabbcc112233 vlan_id 210 > stream_id\n" ++ " echo del index 0 > stream_id\n" ++ " echo show index 0 > stream_id\n", bp->num_queues); +} + -+static const struct i2s_io_ops axi_i2s_io_ops; -+static const struct i2s_controller_ops axi_i2s_ops; -+ -+static int phytium_pcm_hw_params(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream, -+ struct snd_pcm_hw_params *hw_params) -+{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ -+ struct azx *chip = &dev->chip; -+ struct azx_dev *azx_dev = get_azx_dev(substream); -+ int ret; -+ -+ azx_dev->core.bufsize = 0; -+ azx_dev->core.period_bytes = 0; -+ azx_dev->core.format_val = 0; -+ -+ ret = chip->ops->substream_alloc_pages(chip, substream, -+ params_buffer_bytes(hw_params)); -+ -+ return ret; -+} -+/* -+ * set up a BDL entry -+ */ -+static int setup_bdle(struct i2sc_bus *bus, -+ struct snd_dma_buffer *dmab, -+ struct i2s_stream *azx_dev, __le32 **bdlp, -+ int ofs, int size, int with_ioc) ++static int phytium_set_stream_to_hw(struct macb *bp, ++ struct tsn_setting_param *stream_id) +{ -+ struct snd_pcm_substream *substream = azx_dev->substream; -+ struct snd_pcm_runtime *runtime = substream->runtime; -+ __le32 *bdl = *bdlp; -+ -+ dmab->addr = runtime->dma_addr; -+ while (size > 0) { -+ dma_addr_t addr; -+ int chunk; -+ -+ if (azx_dev->frags >= AZX_MAX_BDL_ENTRIES) -+ return -EINVAL; -+ -+ addr = snd_sgbuf_get_addr(dmab, ofs); -+ -+ /* program the address field of the BDL entry */ -+ bdl[0] = cpu_to_le32((u32)addr); ++ unsigned long mac_value; ++ int is_src_mac = 0; ++ u16 index = stream_id[STREAM_INDEX].value; ++ u32 w0, w1, t2_scr; ++ bool cmp_a = false; ++ bool cmp_b = false; ++ bool cmp_c = false; + -+ bdl[1] = cpu_to_le32(upper_32_bits(addr)); ++ /* stream_id param check */ ++ if (stream_id[STREAM_SRC_MAC].value) { ++ is_src_mac = 1; ++ mac_value = stream_id[STREAM_SRC_MAC].value; ++ } else if (stream_id[STREAM_DST_MAC].value) { ++ mac_value = stream_id[STREAM_DST_MAC].value; ++ } else { ++ return -EINVAL; ++ } + -+ /* program the size field of the BDL entry */ -+ chunk = snd_sgbuf_get_chunk_size(dmab, ofs, size); ++ /* compare first 4 byte in mac */ ++ w0 = 0; ++ w1 = 0; ++ w0 = __fswab32((u32)((mac_value & (0xFFFFFFFF0000L)) >> 16)); ++ w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ ++ w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_SOF, w1); ++ w1 = GEM_BFINS(T2OFST, is_src_mac * 6, w1); ++ gem_writel_n(bp, T2CMPW0, T2CMP_OFST(GEM_MAC_FIRST_CMP(index)), w0); ++ gem_writel_n(bp, T2CMPW1, T2CMP_OFST(GEM_MAC_FIRST_CMP(index)), w1); ++ cmp_a = true; + -+ bdl[2] = cpu_to_le32(chunk); ++ /* compare last 2 byte in mac */ ++ w0 = 0; ++ w1 = 0; ++ w0 = __fswab32((u32)(mac_value & (0xFFFF)) | 0xFFFF0000); ++ w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_SOF, w1); ++ w1 = GEM_BFINS(T2OFST, is_src_mac * 6 + 4, w1); ++ gem_writel_n(bp, T2CMPW0, T2CMP_OFST(GEM_MAC_SECOND_CMP(index)), w0); ++ gem_writel_n(bp, T2CMPW1, T2CMP_OFST(GEM_MAC_SECOND_CMP(index)), w1); ++ cmp_b = true; + -+ /* program the IOC to enable interrupt -+ * only when the whole fragment is processed -+ */ -+ size -= chunk; -+ bdl[3] = (size || !with_ioc) ? 0 : cpu_to_le32(0x01); ++ /* vlan id!=0, compare vlan id */ ++ if (stream_id[STREAM_VLAN_ID].value) { ++ w0 = 0; ++ w1 = 0; ++ /* vid 12 bit valid */ ++ w0 = (stream_id[STREAM_VLAN_ID].value << 16) | 0x0FFF; ++ w1 = GEM_BFINS(T2VLANID, 1, w1); ++ w1 = GEM_BFINS(T2CMPOFST, 0, w1); /* 0 C-TAG VID, 1 S-TAG VID */ ++ gem_writel_n(bp, T2CMPW0, ++ T2CMP_OFST(GEM_VLAN_ID_CMP(index)), w0); ++ gem_writel_n(bp, T2CMPW1, ++ T2CMP_OFST(GEM_VLAN_ID_CMP(index)), w1); ++ cmp_c = true; ++ } + -+ bdl += 4; -+ azx_dev->frags++; -+ ofs += chunk; ++ t2_scr = 0; ++ t2_scr = GEM_BFINS(QUEUE, ++ stream_id[STREAM_RX_QUEUE].value & 0xFF, t2_scr); ++ t2_scr = GEM_BFINS(ETHT2IDX, SCRT2_ETHT, t2_scr); ++ if (cmp_a) { ++ t2_scr = GEM_BFINS(CMPA, GEM_MAC_FIRST_CMP(index), t2_scr); ++ t2_scr = GEM_BFINS(CMPAEN, 1, t2_scr); ++ } ++ if (cmp_b) { ++ t2_scr = GEM_BFINS(CMPB, GEM_MAC_SECOND_CMP(index), t2_scr); ++ t2_scr = GEM_BFINS(CMPBEN, 1, t2_scr); ++ } ++ if (cmp_c) { ++ t2_scr = GEM_BFINS(CMPC, GEM_VLAN_ID_CMP(index), t2_scr); ++ t2_scr = GEM_BFINS(CMPCEN, 1, t2_scr); + } -+ *bdlp = bdl; -+ return ofs; ++ gem_writel_n(bp, SCRT2, index, t2_scr); ++ return 0; +} + -+int snd_i2s_stream_setup_periods(struct i2s_stream *azx_dev) ++static int phytium_set_ip_to_hw(struct macb *bp, struct tsn_setting_param *id) +{ -+ struct i2sc_bus *bus = azx_dev->bus; -+ struct snd_pcm_substream *substream = azx_dev->substream; -+ struct snd_pcm_runtime *runtime = substream->runtime; -+ __le32 *bdl; -+ int i, ofs, periods, period_bytes; -+ int pos_adj, pos_align; -+ -+ period_bytes = azx_dev->period_bytes; -+ periods = azx_dev->bufsize / period_bytes; -+ -+ /* program the initial BDL entries */ -+ bdl = (__le32 *)azx_dev->bdl.area; -+ -+ ofs = 0; -+ azx_dev->frags = 0; -+ -+ pos_adj = bus->bdl_pos_adj; ++ u16 index = id[STREAM_INDEX].value; ++ u32 w0, w1, t2_scr; ++ bool cmp_a = false; ++ bool cmp_b = false; ++ bool cmp_c = false; + -+ if (!azx_dev->no_period_wakeup && pos_adj > 0) { ++ if (id[STREAM_SRC_IP].value) { ++ /* 1st compare reg - IP source address */ ++ w0 = 0; ++ w1 = 0; ++ w0 = id[STREAM_SRC_IP].value; ++ w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ ++ w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_ETYPE, w1); ++ w1 = GEM_BFINS(T2OFST, ETYPE_SRCIP_OFFSET, w1); ++ gem_writel_n(bp, T2CMPW0, ++ T2CMP_OFST(GEM_IP4SRC_CMP(index)), w0); ++ gem_writel_n(bp, T2CMPW1, ++ T2CMP_OFST(GEM_IP4SRC_CMP(index)), w1); ++ cmp_a = true; ++ } + -+ pos_align = pos_adj; -+ pos_adj = (pos_adj * runtime->rate + 47999) / 48000; -+ if (!pos_adj) -+ pos_adj = pos_align; -+ else -+ pos_adj = ((pos_adj + pos_align - 1) / pos_align) * -+ pos_align; -+ pos_adj = frames_to_bytes(runtime, pos_adj); -+ if (pos_adj >= period_bytes) { -+ dev_warn(bus->dev, "Too big adjustment %d\n", -+ pos_adj); -+ pos_adj = 0; -+ } else { ++ if (id[STREAM_DST_IP].value) { ++ /* 2nd compare reg - IP destination address */ ++ w0 = 0; ++ w1 = 0; ++ w0 = id[STREAM_DST_IP].value; ++ w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ ++ w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_ETYPE, w1); ++ w1 = GEM_BFINS(T2OFST, ETYPE_DSTIP_OFFSET, w1); ++ gem_writel_n(bp, T2CMPW0, ++ T2CMP_OFST(GEM_IP4DST_CMP(index)), w0); ++ gem_writel_n(bp, T2CMPW1, ++ T2CMP_OFST(GEM_IP4DST_CMP(index)), w1); ++ cmp_b = true; ++ } + -+ ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), -+ azx_dev, -+ &bdl, ofs, pos_adj, true); -+ if (ofs < 0) -+ goto error; ++ if (id[STREAM_SRC_PORT].value || id[STREAM_DST_PORT].value) { ++ /* 3rd compare reg - source port, destination port */ ++ w0 = 0; ++ w1 = 0; ++ w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_IPHDR, w1); ++ if (id[STREAM_DST_PORT].value && ++ id[STREAM_SRC_PORT].value) { ++ w0 = GEM_BFINS(T2MASK, ++ id[STREAM_SRC_PORT].value, w0); ++ w0 = GEM_BFINS(T2CMP, ++ id[STREAM_DST_PORT].value, w0); ++ w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ ++ w1 = GEM_BFINS(T2OFST, IPHDR_SRCPORT_OFFSET, w1); ++ } else if (id[STREAM_SRC_PORT].value) { /* src port */ ++ /* only one port definition */ ++ w1 = GEM_BFINS(T2DISMSK, 0, w1); /* 16-bit compare */ ++ w0 = GEM_BFINS(T2MASK, 0xFFFF, w0); ++ w0 = GEM_BFINS(T2CMP, id[STREAM_SRC_PORT].value, w0); ++ w1 = GEM_BFINS(T2OFST, IPHDR_SRCPORT_OFFSET, w1); ++ } else { /* dst port */ ++ w1 = GEM_BFINS(T2DISMSK, 0, w1); /* 16-bit compare */ ++ w0 = GEM_BFINS(T2MASK, 0xFFFF, w0); ++ w0 = GEM_BFINS(T2CMP, id[STREAM_DST_PORT].value, w0); ++ w1 = GEM_BFINS(T2OFST, IPHDR_DSTPORT_OFFSET, w1); + } -+ } else -+ pos_adj = 0; ++ gem_writel_n(bp, T2CMPW0, T2CMP_OFST(GEM_PORT_CMP(index)), w0); ++ gem_writel_n(bp, T2CMPW1, T2CMP_OFST(GEM_PORT_CMP(index)), w1); ++ cmp_c = true; ++ } + -+ for (i = 0; i < periods; i++) { -+ if (i == periods - 1 && pos_adj) -+ ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), -+ azx_dev, &bdl, ofs, -+ period_bytes - pos_adj, 0); -+ else -+ ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), -+ azx_dev, &bdl, ofs, -+ period_bytes, -+ !azx_dev->no_period_wakeup); -+ if (ofs < 0) -+ goto error; ++ t2_scr = 0; ++ t2_scr = GEM_BFINS(QUEUE, ++ id[STREAM_RX_QUEUE].value & 0xFF, t2_scr); ++ t2_scr = GEM_BFINS(ETHT2IDX, SCRT2_ETHT, t2_scr); ++ if (cmp_a) { ++ t2_scr = GEM_BFINS(CMPA, GEM_MAC_FIRST_CMP(index), t2_scr); ++ t2_scr = GEM_BFINS(CMPAEN, 1, t2_scr); + } -+ return 0; ++ if (cmp_b) { ++ t2_scr = GEM_BFINS(CMPB, GEM_MAC_SECOND_CMP(index), t2_scr); ++ t2_scr = GEM_BFINS(CMPBEN, 1, t2_scr); ++ } ++ if (cmp_c) { ++ t2_scr = GEM_BFINS(CMPC, GEM_VLAN_ID_CMP(index), t2_scr); ++ t2_scr = GEM_BFINS(CMPCEN, 1, t2_scr); ++ } ++ gem_writel_n(bp, SCRT2, index, t2_scr); + -+ error: -+ dev_err(bus->dev, "Too many BDL entries: buffer=%d, period=%d\n", -+ azx_dev->bufsize, period_bytes); -+ return -EINVAL; ++ return 0; +} + -+int snd_i2s_stream_set_params(struct i2s_stream *azx_dev, -+ unsigned int format_val) ++static int phytium_add_stream_id(struct macb *bp, ++ struct tsn_setting_param *stream_id) +{ -+ unsigned int bufsize, period_bytes; -+ struct snd_pcm_substream *substream = azx_dev->substream; -+ struct snd_pcm_runtime *runtime; -+ int err; ++ struct ethtool_rx_fs_item *item, *newfs; ++ unsigned long flags, mac_value; ++ int ret = -EINVAL; ++ bool added = false, is_src_mac, is_ip = false; ++ ++ /* stream_id param check */ ++ if (stream_id[STREAM_SRC_MAC].value) { ++ is_src_mac = true; ++ mac_value = stream_id[STREAM_SRC_MAC].value; ++ } else if (stream_id[STREAM_DST_MAC].value) { ++ mac_value = stream_id[STREAM_DST_MAC].value; ++ } else if (stream_id[STREAM_DST_IP].value || ++ stream_id[STREAM_SRC_IP].value || ++ stream_id[STREAM_DST_PORT].value || ++ stream_id[STREAM_SRC_PORT].value) { ++ is_ip = true; ++ } else { ++ return -EINVAL; ++ } + -+ if (!substream) ++ ret = phytium_find_stream_id(bp, stream_id[STREAM_INDEX].value, false); ++ if ((ret != -ENOENT) || ++ stream_id[STREAM_RX_QUEUE].value >= bp->num_queues) + return -EINVAL; + -+ runtime = substream->runtime; -+ bufsize = snd_pcm_lib_buffer_bytes(substream); -+ period_bytes = snd_pcm_lib_period_bytes(substream); -+ if (bufsize != azx_dev->bufsize || -+ period_bytes != azx_dev->period_bytes || -+ format_val != azx_dev->format_val || -+ runtime->no_period_wakeup != azx_dev->no_period_wakeup) { ++ newfs = kzalloc(sizeof(*newfs), GFP_KERNEL); ++ if (!newfs) ++ return -ENOMEM; ++ ++ newfs->fs.location = stream_id[STREAM_INDEX].value; ++ newfs->fs.ring_cookie = stream_id[STREAM_RX_QUEUE].value; ++ ++ if (!is_ip) { ++ newfs->fs.flow_type = FLOW_MAC_EXT; ++ newfs->fs.h_ext.data[0] = is_src_mac; ++ newfs->fs.h_ext.vlan_tci = stream_id[STREAM_VLAN_ID].value; ++ mac_value = __fswab64(mac_value); ++ memcpy(newfs->fs.h_ext.h_dest, (char *)&mac_value + 2, 6); ++ } else { ++ newfs->fs.flow_type = TCP_V4_FLOW; ++ newfs->fs.h_u.tcp_ip4_spec.ip4src = ++ stream_id[STREAM_SRC_IP].value; ++ newfs->fs.h_u.tcp_ip4_spec.ip4dst = ++ stream_id[STREAM_DST_IP].value; ++ newfs->fs.h_u.tcp_ip4_spec.psrc = ++ stream_id[STREAM_SRC_PORT].value; ++ newfs->fs.h_u.tcp_ip4_spec.pdst = ++ stream_id[STREAM_DST_PORT].value; ++ } ++ ++ spin_lock_irqsave(&bp->rx_fs_lock, flags); + -+ azx_dev->bufsize = bufsize; -+ azx_dev->period_bytes = period_bytes; -+ azx_dev->format_val = format_val; -+ azx_dev->no_period_wakeup = runtime->no_period_wakeup; -+ err = snd_i2s_stream_setup_periods(azx_dev); -+ if (err < 0) -+ return err; ++ /* find correct place to add in list */ ++ list_for_each_entry(item, &bp->rx_fs_list.list, list) { ++ if (item->fs.location > newfs->fs.location) { ++ list_add_tail(&newfs->list, &item->list); ++ added = true; ++ break; ++ } else if (item->fs.location == stream_id[STREAM_INDEX].value) { ++ pr_warn("stream id %d not added: not free\n", ++ item->fs.location); ++ ret = -EBUSY; ++ goto err; ++ } + } ++ if (!added) ++ list_add_tail(&newfs->list, &bp->rx_fs_list.list); ++ ++ if (!is_ip) ++ phytium_set_stream_to_hw(bp, stream_id); ++ else ++ phytium_set_ip_to_hw(bp, stream_id); ++ bp->rx_fs_list.count++; + ++ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); + return 0; ++ ++err: ++ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); ++ kfree(newfs); ++ return ret; +} + -+int snd_i2s_stream_setup(struct i2s_stream *azx_dev, int pcie, u32 paddr) ++static int phytium_del_stream_id(struct macb *bp, ++ struct tsn_setting_param *stream_id) +{ -+ struct snd_pcm_runtime *runtime; ++ struct ethtool_rx_fs_item *item; ++ unsigned long flags; ++ ++ pr_debug("%s %d\n", __func__, __LINE__); + -+ if (azx_dev->substream) -+ runtime = azx_dev->substream->runtime; -+ else -+ runtime = NULL; ++ spin_lock_irqsave(&bp->rx_fs_lock, flags); + -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHAL_CONFG0, 0x8180); -+ i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, 0x80000003); ++ list_for_each_entry(item, &bp->rx_fs_list.list, list) { ++ if (item->fs.location == stream_id[STREAM_INDEX].value) { ++ gem_writel_n(bp, SCRT2, item->fs.location, 0); ++ list_del(&item->list); ++ bp->rx_fs_list.count--; + -+ if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) { -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(0), (u32)azx_dev->bdl.addr); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(0), upper_32_bits(azx_dev->bdl.addr)); -+ if (pcie) -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(0), 0x1c8); -+ else -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(0), paddr + 0x1c8); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CBL(0), azx_dev->bufsize); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_LVI(0), azx_dev->frags - 1); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DSIZE(0), 0x2);//0x2 -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DLENTH(0), 0x0);//0x0 -+ } else { -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(1), (u32)azx_dev->bdl.addr); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(1), upper_32_bits(azx_dev->bdl.addr)); -+ if (pcie) -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(1), 0x1c0); -+ else -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(1), paddr + 0x1c0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CBL(1), azx_dev->bufsize); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_LVI(1), azx_dev->frags - 1); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DSIZE(1), 0x8);//0x8 -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DLENTH(1), 0x0); ++ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); ++ pr_info("stream id %d: delete\n", item->fs.location); ++ kfree(item); ++ return 0; ++ } + } + -+ if (runtime && runtime->period_size > 64) -+ azx_dev->delay_negative_threshold = -+ -frames_to_bytes(runtime, 64); -+ else -+ azx_dev->delay_negative_threshold = 0; -+ -+ return 0; ++ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); ++ return -EINVAL; +} + -+static int phytium_pcm_prepare(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream) ++static int phytium_find_stream_id(struct macb *bp, long value, bool print) +{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ -+ struct azx *chip = &dev->chip; -+ struct azx_dev *azx_dev = get_azx_dev(substream); -+ struct i2sc_bus *bus = azx_bus(chip); -+ struct i2s_stream *hstr_p; -+ int err; -+ -+ dev->substream = substream; -+ azx_dev->core.substream = substream; -+ azx_dev->core.sd_addr = dev->regs_db; -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { -+ azx_dev->core.bdl.area = bus->bdl0.area; -+ azx_dev->core.bdl.addr = bus->bdl0.addr; -+ } else { -+ azx_dev->core.bdl.area = bus->bdl1.area; -+ azx_dev->core.bdl.addr = bus->bdl1.addr; -+ } ++ struct ethtool_rx_fs_item *item; ++ unsigned long flags; + -+ if (!substream) ++ if (value < 0 || value >= bp->max_tuples) + return -EINVAL; + -+ hstr_p = azx_stream(azx_dev); -+ hstr_p->direction = substream->stream; -+ -+ err = snd_i2s_stream_set_params(azx_stream(azx_dev), 0); -+ if (err < 0) -+ goto unlock; ++ pr_debug("%s %d\n", __func__, __LINE__); + -+ snd_i2s_stream_setup(azx_stream(azx_dev), dev->pcie, dev->paddr); ++ spin_lock_irqsave(&bp->rx_fs_lock, flags); + -+ unlock: -+ if (!err) -+ azx_stream(azx_dev)->prepared = 1; ++ list_for_each_entry(item, &bp->rx_fs_list.list, list) { ++ if (item->fs.location == value) { ++ if (print) { ++ if (item->fs.flow_type != FLOW_MAC_EXT) { ++ pr_info("stream id %ld is used by ethtool\n", ++ value); ++ } else { ++ pr_info("stream id %d: %s_mac:%pm vid %d\n", ++ item->fs.location, ++ item->fs.h_ext.data[0] ? ++ "src" : "dst", ++ (item->fs.h_ext.h_dest), ++ item->fs.h_ext.vlan_tci); ++ } ++ } ++ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); ++ return 0; ++ } ++ } ++ if (print) ++ pr_info("stream id %ld not find\n", value); + -+ return err; ++ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); ++ return -ENOENT; +} + -+void snd_i2s_stream_clear(struct i2s_stream *azx_dev) ++static int phytium_show_stream_id(struct macb *bp, ++ struct tsn_setting_param *stream_id) +{ -+ if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0x0); -+ else -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0x0); -+ -+ azx_dev->running = false; ++ return phytium_find_stream_id(bp, stream_id[STREAM_INDEX].value, true); +} + -+void snd_i2s_stream_stop(struct i2s_stream *azx_dev) ++static ssize_t stream_id_store(struct device *dev, ++ struct device_attribute *attr, ++ const char *buf, size_t count) +{ -+ snd_i2s_stream_clear(azx_dev); -+} ++ struct macb *bp = container_of(attr, struct macb, stream_id_attr); ++ struct tsn_setting_param stream_id[] = { ++ [STREAM_INDEX] = { .name = "index", 1}, ++ [STREAM_SRC_MAC] = { .name = "src_mac", 0}, ++ [STREAM_DST_MAC] = { .name = "dst_mac", 0}, ++ [STREAM_SRC_IP] = { .name = "src_ip", 0}, ++ [STREAM_DST_IP] = { .name = "dst_ip", 0}, ++ [STREAM_SRC_PORT] = { .name = "src_port", 0}, ++ [STREAM_DST_PORT] = { .name = "dst_port", 0}, ++ [STREAM_TAGGED] = { .name = "tagged", 3}, ++ [STREAM_VLAN_ID] = { .name = "vlan_id", 0}, ++ [STREAM_RX_QUEUE] = { .name = "rx_queue", 1}, ++ }; ++ int i, ret, action = 0; + -+void snd_i2s_stream_start(struct i2s_stream *azx_dev, bool fresh_start) -+{ -+ if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0x1); ++ if (strstr(buf, "add")) ++ action = STREAM_ADD; ++ else if (strstr(buf, "del")) ++ action = STREAM_DEL; ++ else if (strstr(buf, "show")) ++ action = STREAM_SHOW; + else -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0x5); -+ -+ azx_dev->running = true; -+} ++ return -EINVAL; + -+static int phytium_pcm_trigger(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream, int cmd) -+{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); ++ for (i = 0; i < GET_SETTING_SIZE(stream_id); i++) { ++ /* find setting name */ ++ char *tmp = strstr(buf, stream_id[i].name); ++ char *end; ++ int recovery = 0; + -+ struct azx *chip = &dev->chip; -+ struct i2sc_bus *bus = azx_bus(chip); -+ struct azx_dev *azx_dev = get_azx_dev(substream); -+ struct snd_pcm_substream *s; -+ struct i2s_stream *hstr; -+ bool start; -+ int sbits = 0; ++ if (!tmp) ++ continue; ++ tmp += strlen(stream_id[i].name); ++ tmp = skip_spaces(tmp); ++ end = strpbrk(tmp, " "); ++ if (end) { ++ recovery = 1; ++ *end = '\0'; ++ } ++ switch (i) { ++ case STREAM_SRC_IP: ++ case STREAM_DST_IP: ++ stream_id[i].value = in_aton(tmp); ++ break; ++ case STREAM_SRC_MAC: ++ case STREAM_DST_MAC: ++ ret = kstrtol(tmp, 16, &stream_id[i].value); ++ break; ++ case STREAM_SRC_PORT: ++ case STREAM_DST_PORT: ++ ret = kstrtol(tmp, 10, &stream_id[i].value); ++ stream_id[i].value = ntohs((short)stream_id[i].value); ++ break; ++ default: ++ ret = kstrtol(tmp, 10, &stream_id[i].value); ++ break; ++ } ++ if (recovery) ++ *end = ' '; + -+ hstr = azx_stream(azx_dev); -+ hstr->direction = substream->stream; ++ if (ret < 0) ++ return ret; ++ dev_dbg(dev, "get: %s=%lx\n", stream_id[i].name, ++ stream_id[i].value); ++ } + -+ switch (cmd) { -+ case SNDRV_PCM_TRIGGER_START: -+ case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: -+ case SNDRV_PCM_TRIGGER_RESUME: -+ start = true; ++ switch (action) { ++ case STREAM_ADD: ++ ret = phytium_add_stream_id(bp, stream_id); ++ break; ++ case STREAM_DEL: ++ ret = phytium_del_stream_id(bp, stream_id); + break; -+ case SNDRV_PCM_TRIGGER_PAUSE_PUSH: -+ case SNDRV_PCM_TRIGGER_SUSPEND: -+ case SNDRV_PCM_TRIGGER_STOP: -+ start = false; ++ case STREAM_SHOW: ++ ret = phytium_show_stream_id(bp, stream_id); + break; + default: + return -EINVAL; + } -+ -+ snd_pcm_group_for_each_entry(s, substream) { -+ if (s->pcm->card != substream->pcm->card) -+ continue; -+ azx_dev = get_azx_dev(s); -+ sbits |= 1 << azx_dev->core.index; -+ snd_pcm_trigger_done(s, substream); -+ } -+ -+ spin_lock(&bus->reg_lock); -+ -+ snd_pcm_group_for_each_entry(s, substream) { -+ if (s->pcm->card != substream->pcm->card) -+ continue; -+ azx_dev = get_azx_dev(s); -+ if (start) -+ snd_i2s_stream_start(azx_stream(azx_dev), true); -+ else -+ snd_i2s_stream_stop(azx_stream(azx_dev)); -+ } -+ -+ i2s_write_reg(dev->regs_db, DMA_CTL, 0x1); -+ spin_unlock(&bus->reg_lock); -+ -+ return 0; ++ if (ret < 0) ++ return ret; ++ return count; +} ++DEVICE_ATTR_RW(stream_id); + -+void snd_i2s_stream_cleanup(struct i2s_stream *azx_dev) ++static ssize_t qci_setting_show(struct device *dev, ++ struct device_attribute *attr, char *buf) +{ -+ int cnt = 10; -+ u32 mask; -+ -+ if (azx_dev->sd_addr) { -+ if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) { -+ mask = i2s_read_reg(azx_dev->sd_addr, DMA_MASK_INT); -+ mask &= ~BIT(0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, mask); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0); -+ while (cnt--) { -+ if (i2s_read_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0)) == 0) -+ break; -+ } -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 2); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(0), 0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(0), 0); -+ } else { -+ mask = i2s_read_reg(azx_dev->sd_addr, DMA_MASK_INT); -+ mask &= ~BIT(1); -+ i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, mask); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0); -+ while (cnt--) { -+ if (i2s_read_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1)) == 0) -+ break; -+ } -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 2); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(1), 0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(1), 0); -+ } -+ } ++ struct macb *bp = container_of(attr, struct macb, qci_setting_attr); ++ (void)bp; ++ return snprintf(buf, PAGE_SIZE, ++ "help:\n" ++ " index: stream id handle, if use ethtool to do stream identify, it should same as [loc]\n" ++ " max_sdu: maximum SDU(service data unit) size, max to 0xFFFF, byte,\n" ++ " this param will effect rx queue, not only this stream id handle\n" ++ " ipv: same as rx_queue in stream_id, it will cover the setting in stream_id\n" ++ " interval: TimeInterval, ns\n" ++ " max_rate: IntervalOctetMax, byte\n" ++ " mark_red: MarkAllFramesRed, all frame in this stream id will drop\n" ++ "example:\n" ++ " echo index 0 max_sdu 512 ipv 7 > qci_setting\n" ++ " echo index 0 ipv 7 interval 500000 max_rate 32768 > qci_setting\n" ++ " echo index 0 ipv 6 interval 500000 max_rate 16384 > qci_setting\n" ++ " echo index 0 mark_red 1 > qci_setting\n"); +} + -+static int phytium_pcm_hw_free(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream) ++static int phytium_set_qci(struct macb *bp, struct tsn_setting_param *setting) +{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); ++ int index = setting[QCI_INDEX].value; ++ u32 queue, t2_scr, max_sdu_size = 0, flush_reg = 0; ++ u32 rate_limit_reg, scale; ++ unsigned long flags; + -+ struct azx *chip = &dev->chip; -+ struct i2s_stream *hstr_p; -+ struct azx_dev *azx_dev = get_azx_dev(substream); -+ int err; ++ if (phytium_find_stream_id(bp, setting[QCI_INDEX].value, false) || ++ setting[QCI_IPV].value >= bp->num_queues || ++ setting[QCI_MAX_SDU].value > 0xFFFFL) ++ return -EINVAL; + -+ hstr_p = azx_stream(azx_dev); -+ hstr_p->direction = substream->stream; -+ snd_i2s_stream_cleanup(azx_stream(azx_dev)); ++ /* update screen type 2 register */ ++ spin_lock_irqsave(&bp->rx_fs_lock, flags); ++ t2_scr = gem_readl_n(bp, SCRT2, index); ++ if (setting[QCI_IPV].value > 0) ++ t2_scr = ++ GEM_BFINS(QUEUE, setting[QCI_IPV].value & 0xFF, t2_scr); + -+ err = chip->ops->substream_free_pages(chip, substream); -+ azx_stream(azx_dev)->prepared = 0; ++ if (setting[QCI_MARK_RED].value == 1) ++ t2_scr = GEM_BFINS(DROP_ON_MATCH, 1, t2_scr); ++ else ++ t2_scr = GEM_BFINS(DROP_ON_MATCH, 0, t2_scr); ++ gem_writel_n(bp, SCRT2, index, t2_scr); ++ spin_unlock_irqrestore(&bp->rx_fs_lock, flags); + -+ return err; -+} ++ /* get the queue num in screen type 2 */ ++ queue = GEM_BFEXT(QUEUE, t2_scr); + -+static snd_pcm_uframes_t phytium_pcm_pointer(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream) -+{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); ++ if (setting[QCI_MAX_SDU].value > 0) ++ max_sdu_size = setting[QCI_MAX_SDU].value & 0xFFFFL; + -+ int stream = substream->stream; ++ /* set rx Qx flush reg */ ++ if (max_sdu_size) ++ flush_reg = GEM_BF(MAX_VAL, max_sdu_size) | ++ GEM_BF(LIMIT_FRAME_SIZE, 1); ++ gem_writel_n(bp, RX_Q0_FLUSH, queue, flush_reg); + -+ u32 pos = i2s_read_reg(dev->regs_db, DMA_LPIB(stream)); ++ /* set rate limit reg */ ++ switch (bp->speed) { ++ case SPEED_10: ++ scale = 51200; ++ break; ++ case SPEED_100: ++ scale = 5120; ++ break; ++ case SPEED_1000: ++ scale = 1024; ++ break; ++ default: ++ pr_info("macb speed %d not support\n", bp->speed); ++ return -EOPNOTSUPP; ++ } ++ rate_limit_reg = GEM_BF(MAX_RATE_VAL, setting[QCI_MAX_RATE].value) | ++ GEM_BF(INTERVAL_TIME, setting[QCI_INTERVAL].value / scale); ++ gem_writel_n(bp, SCR2_REG0_RATE_LIMIT, index, rate_limit_reg); + -+ return bytes_to_frames(substream->runtime, pos); ++ return 0; +} + -+static const struct snd_soc_component_driver phytium_i2s_component = { -+ .name = "phytium-i2s", -+ .pcm_construct = phytium_pcm_new, -+ .suspend = phytium_i2s_suspend, -+ .resume = phytium_i2s_resume, -+ -+ .open = phytium_pcm_open, -+ .close = phytium_pcm_close, -+ .hw_params = phytium_pcm_hw_params, -+ .prepare = phytium_pcm_prepare, -+ .hw_free = phytium_pcm_hw_free, -+ .trigger = phytium_pcm_trigger, -+ .pointer = phytium_pcm_pointer, -+}; -+ -+/* Maximum bit resolution of a channel - not uniformly spaced */ -+static const u32 fifo_width[COMP_MAX_WORDSIZE] = { -+ 12, 16, 20, 24, 32, 0, 0, 0 -+}; ++static ssize_t qci_setting_store(struct device *dev, ++ struct device_attribute *attr, ++ const char *buf, size_t count) ++{ ++ struct macb *bp = container_of(attr, struct macb, qci_setting_attr); ++ struct tsn_setting_param qci_setting[] = { ++ [QCI_INDEX] = { .name = "index", 0}, ++ [QCI_MAX_SDU] = { .name = "max_sdu", -1}, ++ [QCI_IPV] = { .name = "ipv", -1}, ++ [QCI_INTERVAL] = { .name = "interval", 0}, ++ [QCI_MAX_RATE] = { .name = "max_rate", 0}, ++ [QCI_MARK_RED] = { .name = "mark_red", 0}, ++ }; ++ int i, ret; + -+/* Width of (DMA) bus */ -+static const u32 bus_widths[COMP_MAX_DATA_WIDTH] = { -+ DMA_SLAVE_BUSWIDTH_1_BYTE, -+ DMA_SLAVE_BUSWIDTH_2_BYTES, -+ DMA_SLAVE_BUSWIDTH_4_BYTES, -+ DMA_SLAVE_BUSWIDTH_UNDEFINED -+}; ++ for (i = 0; i < GET_SETTING_SIZE(qci_setting); i++) { ++ /* find setting name */ ++ char *tmp = strstr(buf, qci_setting[i].name); ++ char *end; ++ int recovery = 0; + -+/* PCM format to support channel resolution */ -+static const u32 formats[COMP_MAX_WORDSIZE] = { -+ SNDRV_PCM_FMTBIT_S16_LE, -+ SNDRV_PCM_FMTBIT_S16_LE, -+ SNDRV_PCM_FMTBIT_S24_LE, -+ SNDRV_PCM_FMTBIT_S24_LE, -+ SNDRV_PCM_FMTBIT_S32_LE, -+ 0, -+ 0, -+ 0 -+}; ++ if (!tmp) ++ continue; + -+static int phytium_configure_dai(struct i2s_phytium *dev) -+{ -+ u32 comp1 = i2s_read_reg(dev->regs, dev->i2s_reg_comp1); -+ u32 comp2 = i2s_read_reg(dev->regs, dev->i2s_reg_comp2); -+ u32 fifo_depth = 1 << (1 + COMP1_FIFO_DEPTH_GLOBAL(comp1)); -+ u32 idx; ++ tmp += strlen(qci_setting[i].name); ++ tmp = skip_spaces(tmp); ++ end = strpbrk(tmp, " "); ++ if (end) { ++ recovery = 1; ++ *end = '\0'; ++ } ++ /* kstrtol input string must be null-terminated */ ++ ret = kstrtol(tmp, 10, &qci_setting[i].value); ++ if (recovery) ++ *end = ' '; + -+ if (COMP1_TX_ENABLED(comp1)) { -+ dev_dbg(dev->dev, " phytium: play supported\n"); -+ idx = COMP1_TX_WORDSIZE_0(comp1); -+ if (WARN_ON(idx >= ARRAY_SIZE(formats))) -+ return -EINVAL; ++ if (ret < 0) ++ return ret; ++ dev_dbg(dev, "get: %s=%ld\n", qci_setting[i].name, ++ qci_setting[i].value); + } + -+ if (COMP1_RX_ENABLED(comp1)) { -+ dev_dbg(dev->dev, "phytium: record supported\n"); -+ idx = COMP2_RX_WORDSIZE_0(comp2); -+ if (WARN_ON(idx >= ARRAY_SIZE(formats))) -+ return -EINVAL; -+ if (dev->quirks & PHYTIUM_I2S_QUIRK_16BIT_IDX_OVERRIDE) -+ idx = 1; -+ } ++ ret = phytium_set_qci(bp, qci_setting); ++ if (ret < 0) ++ return ret; ++ return count; ++} ++DEVICE_ATTR_RW(qci_setting); + -+ if (COMP1_MODE_EN(comp1)) { -+ dev_dbg(dev->dev, "phytium: i2s master mode supported\n"); -+ dev->capability |= PHYTIUM_I2S_MASTER; -+ } else { -+ dev_dbg(dev->dev, "phytium: i2s slave mode supported\n"); -+ dev->capability |= PHYTIUM_I2S_SLAVE; -+ } ++static ssize_t qav_setting_show(struct device *dev, ++ struct device_attribute *attr, char *buf) ++{ ++ struct macb *bp = container_of(attr, struct macb, qci_setting_attr); + -+ dev->fifo_th = fifo_depth / 2; -+ return 0; ++ return snprintf(buf, PAGE_SIZE, ++ "help:\n" ++ " queue: queue index to set cbs, support value:%d, %d\n" ++ " idleslop: same as tc-cbs, kilobit/sec\n" ++ " enable: 1: enable, 0: disable, default enable\n" ++ "example:\n" ++ " echo queue 7 idleslop 400000 > qav_setting\n" ++ " echo queue 6 idleslop 200000 > qav_setting\n" ++ " echo queue 7 enable 0 > qav_setting\n", ++ bp->num_queues - 2, bp->num_queues - 1); +} + -+static int phytium_configure_dai_by_dt(struct i2s_phytium *dev) ++static int phytium_set_qav(struct macb *bp, struct tsn_setting_param *setting) +{ -+ u32 comp1 = i2s_read_reg(dev->regs, I2S_COMP_PARAM_1); -+ u32 comp2 = i2s_read_reg(dev->regs, I2S_COMP_PARAM_2); -+ u32 idx = COMP1_APB_DATA_WIDTH(comp1); -+ u32 idx2; -+ int ret; ++ int queue = setting[QAV_QUEUE].value; ++ int idle_slope, cbs_ctrl; + -+ if (WARN_ON(idx >= ARRAY_SIZE(bus_widths))) ++ if (queue != bp->num_queues - 1 && queue != bp->num_queues - 2) + return -EINVAL; + -+ ret = phytium_configure_dai(dev); -+ if (ret < 0) -+ return ret; ++ cbs_ctrl = gem_readl(bp, CBS_CONTROL); + -+ if (COMP1_TX_ENABLED(comp1)) { -+ idx2 = COMP1_TX_WORDSIZE_0(comp1); -+ dev->capability |= PHYTIUM_I2S_PLAY; ++ if (!setting[QAV_ENABLE].value) { ++ cbs_ctrl &= (~BIT(bp->num_queues - 1 - queue)); ++ gem_writel(bp, CBS_CONTROL, cbs_ctrl); ++ return 0; + } -+ if (COMP1_RX_ENABLED(comp1)) { -+ idx2 = COMP2_RX_WORDSIZE_0(comp2); -+ dev->capability |= PHYTIUM_I2S_RECORD; ++ ++ if (setting[QAV_IDLESLOPE].value < 0 || ++ setting[QAV_IDLESLOPE].value > bp->speed * 1000 * 1000) { ++ pr_warn("idleslope invalid, please check it\n"); ++ return -EINVAL; + } + -+ return 0; -+} ++ /* calculate idle slope value, cbs->idleslope is kilobit/sec */ ++ /* reg value in bytes/sec for gigabit operation, and nibbles/sec */ ++ /* for 10/100 operation, and scaled by 2.5 in 2.5G operation */ ++ switch (bp->speed) { ++ case SPEED_10: ++ case SPEED_100: ++ idle_slope = 125 * setting[QAV_IDLESLOPE].value * 2; ++ break; ++ case SPEED_1000: ++ idle_slope = 125 * setting[QAV_IDLESLOPE].value; ++ break; ++ case SPEED_2500: ++ idle_slope = 125 * setting[QAV_IDLESLOPE].value * 2 / 5; ++ break; ++ default: ++ pr_info("macb speed %d not support\n", bp->speed); ++ return -EOPNOTSUPP; ++ } + -+static int phytium_dma_alloc_pages(struct i2sc_bus *bus, int type, size_t size, -+ struct snd_dma_buffer *buf) -+{ -+ int err; ++ /* cbs should be disabled prior to updating the idle slope value */ ++ cbs_ctrl &= (~BIT(bp->num_queues - 1 - queue)); ++ gem_writel(bp, CBS_CONTROL, cbs_ctrl); + -+ err = snd_dma_alloc_pages(type, bus->dev, size, buf); -+ if (err < 0) -+ return err; ++ if (queue == bp->num_queues - 1) ++ gem_writel(bp, CBS_IDLESLOPE_Q_A, idle_slope); ++ else ++ gem_writel(bp, CBS_IDLESLOPE_Q_B, idle_slope); ++ ++ /* after set idle slope, enable cbs */ ++ cbs_ctrl |= BIT(bp->num_queues - 1 - queue); ++ gem_writel(bp, CBS_CONTROL, cbs_ctrl); + + return 0; +} + -+int snd_i2s_bus_alloc_stream_pages(struct i2sc_bus *bus) ++static ssize_t qav_setting_store(struct device *dev, ++ struct device_attribute *attr, ++ const char *buf, size_t count) +{ -+ struct i2s_stream *s; -+ int num_streams = 0; -+ int err; ++ struct macb *bp = container_of(attr, struct macb, qav_setting_attr); ++ struct tsn_setting_param qav_setting[] = { ++ [QAV_QUEUE] = { .name = "queue", 0}, ++ [QAV_IDLESLOPE] = { .name = "idleslop", 0}, ++ [QAV_ENABLE] = { .name = "enable", 1}, ++ }; ++ int i, ret; + -+ list_for_each_entry(s, &bus->stream_list, list) { ++ for (i = 0; i < GET_SETTING_SIZE(qav_setting); i++) { ++ /* find setting name */ ++ char *tmp = strstr(buf, qav_setting[i].name); ++ char *end; ++ int recovery = 0; + -+ /* allocate memory for the BDL for each stream */ -+ err = bus->io_ops->dma_alloc_pages(bus, SNDRV_DMA_TYPE_DEV, -+ BDL_SIZE, &s->bdl); -+ if (num_streams == 0) { -+ bus->bdl0.addr = s->bdl.addr; -+ bus->bdl0.area = s->bdl.area; -+ } else { -+ bus->bdl1.addr = s->bdl.addr; -+ bus->bdl1.area = s->bdl.area; ++ if (!tmp) ++ continue; ++ ++ tmp += strlen(qav_setting[i].name); ++ tmp = skip_spaces(tmp); ++ end = strpbrk(tmp, " "); ++ if (end) { ++ recovery = 1; ++ *end = '\0'; + } -+ num_streams++; -+ if (err < 0) -+ return -ENOMEM; ++ /* kstrtol input string must be null-terminated */ ++ ret = kstrtol(tmp, 10, &qav_setting[i].value); ++ if (recovery) ++ *end = ' '; ++ ++ if (ret < 0) ++ return ret; ++ dev_dbg(dev, "get: %s=%ld\n", qav_setting[i].name, ++ qav_setting[i].value); + } + -+ if (WARN_ON(!num_streams)) -+ return -EINVAL; ++ ret = phytium_set_qav(bp, qav_setting); ++ if (ret < 0) ++ return ret; + -+ return 0; ++ return count; +} ++DEVICE_ATTR_RW(qav_setting); + -+static int stream_direction(struct azx *chip, unsigned char index) ++static ssize_t qbv_setting_show(struct device *dev, ++ struct device_attribute *attr, char *buf) +{ -+ if (index >= chip->playback_index_offset && -+ index < chip->playback_index_offset + chip->playback_streams) -+ return SNDRV_PCM_STREAM_PLAYBACK; -+ return SNDRV_PCM_STREAM_CAPTURE; -+ ++ struct macb *bp = container_of(attr, struct macb, qbv_setting_attr); ++ (void)bp; ++ return snprintf(buf, PAGE_SIZE, ++ "help:\n" ++ " input format: queue [queue_number] [start_time] \\\n" ++ " [on_time] [off_time]\n" ++ " queue_number: set qbv this queue\n" ++ " start_time:after this time, period start\n" ++ " on_time: gate open time\n" ++ " off_time: gate close time\n" ++ "example:\n" ++ " echo queue 3 0 125000 375000 \\\n" ++ " queue 2 125000 125000 375000 \\\n" ++ " queue 1 250000 250000 250000 > qbv_setting\n"); +} + -+void snd_i2s_stream_init(struct i2sc_bus *bus, struct i2s_stream *azx_dev, -+ int idx, int direction, int tag) ++static ssize_t qbv_setting_store(struct device *dev, ++ struct device_attribute *attr, ++ const char *buf, size_t count) +{ -+ azx_dev->bus = bus; -+ azx_dev->sd_addr = bus->remap_addr; ++ struct queues_enst_setting setting[MACB_MAX_ENST_QUEUES] = {0}; ++ char *tmp = (char *)buf; ++ int ret; + -+ if (idx == 0) -+ azx_dev->sd_int_sta_mask = 1 << idx; -+ else -+ azx_dev->sd_int_sta_mask = 1 << 8; ++ while ((tmp = strstr(tmp, "queue")) != NULL) { ++ long q, start_time, on_time, off_time; ++ char *next; ++ ++ tmp += strlen("queue"); ++ next = skip_spaces(tmp); ++ tmp = strsep(&next, " "); ++ if (!tmp) ++ return -EINVAL; ++ ret = kstrtol(tmp, 10, &q); ++ if (ret < 0 || q > MACB_MAX_ENST_QUEUES || q < 0) ++ return -EINVAL; ++ setting[q].enable = 1; ++ ++ tmp = strsep(&next, " "); ++ if (!tmp) ++ return -EINVAL; ++ ret = kstrtol(tmp, 10, &start_time); ++ if (ret < 0) ++ return -EINVAL; ++ setting[q].start_time = start_time; ++ ++ tmp = strsep(&next, " "); ++ if (!tmp) ++ return -EINVAL; ++ ret = kstrtol(tmp, 10, &on_time); ++ if (ret < 0 || on_time > 1048568 || on_time < 0) ++ return -EINVAL; ++ setting[q].on_time = on_time; ++ ++ tmp = strsep(&next, " "); ++ if (!tmp) ++ return -EINVAL; ++ ret = kstrtol(tmp, 10, &off_time); ++ if (ret < 0 || off_time > 1048568 || off_time < 0) ++ return -EINVAL; ++ setting[q].off_time = off_time; ++ ++ tmp = next; ++ if (!tmp) ++ break; ++ } + -+ azx_dev->index = idx; -+ azx_dev->direction = direction; -+ azx_dev->stream_tag = tag; ++ _dump_enst_param(setting); + -+ list_add_tail(&azx_dev->list, &bus->stream_list); ++ ret = phytium_set_taprio(dev_get_drvdata(dev), setting); ++ if (ret) ++ return ret; + ++ return count; +} ++DEVICE_ATTR_RW(qbv_setting); + -+int azx_i2s_init_streams(struct azx *chip) ++static void _create_tsn_sysfs_entries(struct device *dev, struct macb *bp) +{ -+ int i; ++ int ret; + -+ for (i = 0; i < chip->num_streams; i++) { -+ struct azx_dev *azx_dev = kzalloc(sizeof(*azx_dev), GFP_KERNEL); -+ int dir, tag; ++ if (bp->tsn_cap & TSN_CAP_8021CB) { ++ bp->cb_setting_attr = dev_attr_cb_setting; ++ sysfs_attr_init(&bp->cb_setting_attr.attr); ++ ret = device_create_file(dev, &bp->cb_setting_attr); ++ if (ret < 0) ++ dev_warn(dev, "create cb_setting_attr failed %d", ret); ++ else ++ dev_dbg(dev, "create cb_setting_attr ok\n"); ++ } + -+ if (!azx_dev) -+ return -ENOMEM; ++ if (bp->tsn_cap & TSN_CAP_8021QCI) { ++ bp->qci_setting_attr = dev_attr_qci_setting; ++ sysfs_attr_init(&bp->qci_setting_attr.attr); ++ ret = device_create_file(dev, &bp->qci_setting_attr); ++ if (ret < 0) ++ dev_warn(dev, "create qci_setting_attr failed %d", ret); ++ else ++ dev_dbg(dev, "create qci_setting_attr ok\n"); ++ } + -+ dir = stream_direction(chip, i); ++ if (bp->tsn_cap & TSN_CAP_8021QAV) { ++ bp->qav_setting_attr = dev_attr_qav_setting; ++ sysfs_attr_init(&bp->qav_setting_attr.attr); ++ ret = device_create_file(dev, &bp->qav_setting_attr); ++ if (ret < 0) ++ dev_warn(dev, "create qav_setting_attr failed %d", ret); ++ else ++ dev_dbg(dev, "create qav_setting_attr ok\n"); ++ } + -+ tag = i + 1; ++ if (bp->tsn_cap & TSN_CAP_8021QBV) { ++ bp->qbv_setting_attr = dev_attr_qbv_setting; ++ sysfs_attr_init(&bp->qbv_setting_attr.attr); ++ ret = device_create_file(dev, &bp->qbv_setting_attr); ++ if (ret < 0) ++ dev_warn(dev, "create qbv_setting_attr failed %d", ret); ++ else ++ dev_dbg(dev, "create qbv_setting_attr ok\n"); ++ } + -+ snd_i2s_stream_init(azx_bus(chip), azx_stream(azx_dev), -+ i, dir, tag); ++ if (bp->tsn_cap & (TSN_CAP_8021CB | TSN_CAP_8021QCI)) { ++ bp->stream_id_attr = dev_attr_stream_id; ++ sysfs_attr_init(&bp->stream_id_attr.attr); ++ ret = device_create_file(dev, &bp->stream_id_attr); ++ if (ret < 0) ++ dev_warn(dev, "create stream_id_attr failed %d", ret); ++ else ++ dev_dbg(dev, "create stream_id_attr ok\n"); + } -+ -+ return 0; +} + -+static int azx_first_init(struct azx *chip) ++void phytium_init_tsn(struct platform_device *pdev) +{ -+ struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); -+ struct platform_device *pdev = to_platform_device(i2s->dev); -+ struct device *i2sdev = i2s->dev; -+ struct i2sc_bus *bus = azx_bus(chip); -+ struct resource *res; -+ int err; -+ unsigned int dma_bits = 64; -+ -+ chip->region_requested = 1; -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ bus->addr = res->start; -+ bus->remap_addr = i2s->regs_db; -+ bus->dev = i2s->pdev; ++ struct net_device *dev = platform_get_drvdata(pdev); ++ struct macb *bp = netdev_priv(dev); ++ u32 cfg12; + -+ if (bus->remap_addr == NULL) { -+ dev_err(i2sdev, "ioremap error\n"); -+ return -ENXIO; ++ if (!device_property_read_bool(&pdev->dev, "support-tsn")) { ++ dev_dbg(&pdev->dev, "not support tsn, skip it"); ++ return; + } ++ pr_debug("%s %d\n", __func__, __LINE__); + -+ if (azx_acquire_irq(chip, 0) < 0) -+ return -EBUSY; -+ -+ synchronize_irq(bus->irq); -+ -+ spin_lock_init(&bus->reg_lock); ++ bp->tsn_cap = TSN_CAP_8021QAV | TSN_CAP_8021QBV | TSN_CAP_8021QCI; ++ dev->hw_features |= NETIF_F_HW_TC; + -+ if (!dma_set_mask(i2sdev, DMA_BIT_MASK(dma_bits))) { -+ err = dma_set_coherent_mask(i2sdev, DMA_BIT_MASK(dma_bits)); -+ } else { -+ err = dma_set_mask(i2sdev, DMA_BIT_MASK(32)); -+ err = dma_set_coherent_mask(i2sdev, DMA_BIT_MASK(32)); ++ cfg12 = gem_readl(bp, DCFG12); ++ if (cfg12 & GEM_BIT(HAS_CB)) { ++ bp->tsn_cap |= TSN_CAP_8021CB; ++ bp->num_cb_streams = GEM_BFEXT(NUM_CB_STREAMS, cfg12); ++ bp->cb_history_len = GEM_BFEXT(CB_HISTORY_LEN, cfg12); + } -+ -+ chip->playback_streams = NUM_PLAYBACK; -+ chip->capture_streams = NUM_CAPTURE; -+ -+ chip->playback_index_offset = 0; -+ chip->capture_index_offset = chip->playback_streams; -+ chip->num_streams = chip->playback_streams + chip->capture_streams; -+ -+ err = azx_i2s_init_streams(chip); -+ if (err < 0) -+ return err; -+ -+ err = azx_alloc_stream_pages(chip); -+ if (err < 0) -+ return err; -+ -+ return 0; ++ _create_tsn_sysfs_entries(&pdev->dev, bp); +} + -+static int azx_probe_continue(struct azx *chip) ++void phytium_deinit_tsn(struct platform_device *pdev) +{ -+ struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); -+ int err; ++ struct net_device *dev = platform_get_drvdata(pdev); ++ struct macb *bp = netdev_priv(dev); + -+ i2s->probe_continued = 1; ++ if (!device_property_read_bool(&pdev->dev, "support-tsn")) { ++ dev_dbg(&pdev->dev, "not support tsn, skip it"); ++ return; ++ } + -+ err = azx_first_init(chip); -+ if (err < 0) -+ goto out_free; ++ if (bp->tsn_cap & TSN_CAP_8021CB) ++ device_remove_file(&pdev->dev, &bp->cb_setting_attr); + -+ chip->running = 1; ++ if (bp->tsn_cap & TSN_CAP_8021QCI) ++ device_remove_file(&pdev->dev, &bp->qci_setting_attr); + -+out_free: -+ return err; -+} ++ if (bp->tsn_cap & TSN_CAP_8021QAV) ++ device_remove_file(&pdev->dev, &bp->qav_setting_attr); + -+static void azx_probe_work(struct work_struct *work) -+{ -+ struct i2s_phytium *i2s = container_of(work, struct i2s_phytium, probe_work); ++ if (bp->tsn_cap & TSN_CAP_8021QBV) ++ device_remove_file(&pdev->dev, &bp->qbv_setting_attr); + -+ azx_probe_continue(&i2s->chip); ++ if (bp->tsn_cap & (TSN_CAP_8021CB | TSN_CAP_8021QCI)) { ++ device_remove_file(&pdev->dev, &bp->stream_id_attr); ++ } +} + -+int azx_i2s_bus_init(struct azx *chip, -+ const struct i2s_io_ops *io_ops) -+{ -+ struct i2s_bus *bus = &chip->bus; -+ -+ bus->core.io_ops = io_ops; +diff --git a/drivers/net/ethernet/cadence/macb_tsn.h b/drivers/net/ethernet/cadence/macb_tsn.h +new file mode 100644 +index 000000000..422a854eb +--- /dev/null ++++ b/drivers/net/ethernet/cadence/macb_tsn.h +@@ -0,0 +1,149 @@ ++/* SPDX-License-Identifier: GPL-2.0-only */ ++/* ++ * Phytium TSN support driver ++ * ++ * Copyright (c) 2024 Phytium Technology Co., Ltd. ++ */ ++#ifndef _MACB_TSN_H ++#define _MACB_TSN_H + -+ INIT_LIST_HEAD(&bus->core.stream_list); -+ bus->card = chip->card; -+ mutex_init(&bus->prepare_mutex); -+ bus->pci = chip->pci; ++#define MACB_MAX_ENST_QUEUES 8 + -+ bus->core.bdl_pos_adj = chip->bdl_pos_adj; -+ return 0; -+} ++#define TSN_CAP_8021QAV 0x00000001 ++#define TSN_CAP_8021QBV 0x00000002 ++#define TSN_CAP_8021QCI 0x00000004 ++#define TSN_CAP_8021CB 0x00000008 ++#define TSN_CAP_8023BR 0x00000010 + -+static int i2s_phytium_create(struct platform_device *pdev, -+ int dev, struct azx **rchip, struct i2s_phytium *i2s) -+{ -+ struct azx *chip; -+ int err; ++/* 802.1Qav */ ++#define GEM_CBS_CONTROL 0x04BC ++#define GEM_CBS_IDLESLOPE_Q_A 0x04C0 ++#define GEM_CBS_IDLESLOPE_Q_B 0x04C4 + -+ *rchip = NULL; ++/* 802.1Qbv */ ++#define GEM_ENST_START_TIME 0x0800 ++#define GEM_ENST_ON_TIME 0x0820 ++#define GEM_ENST_OFF_TIME 0x0840 ++#define GEM_ENST_CONTROL 0x0880 + -+ if (!i2s) -+ return -ENOMEM; -+ chip = &i2s->chip; ++/* 802.1CB */ ++/* Bitfields in DCFG12 */ ++#define GEM_HAS_CB_OFFSET 16 ++#define GEM_HAS_CB_SIZE 1 ++#define GEM_CB_HISTORY_LEN_OFFSET 8 ++#define GEM_CB_HISTORY_LEN_SIZE 8 ++#define GEM_NUM_CB_STREAMS_OFFSET 0 ++#define GEM_NUM_CB_STREAMS_SIZE 8 + -+ mutex_init(&chip->open_mutex); ++#define GEM_FRER_TIMEOUT 0x08A0 ++#define GEM_FRER_RED_TAG 0x08A4 ++#define GEM_FRER_CONTROL_1_A 0x08C0 ++#define GEM_FRER_CONTROL_1_B 0x08C4 ++#define GEM_FRER_STATISTICS_1_A 0x08C8 ++#define GEM_FRER_STATISTICS_1_B 0x08CC + -+ chip->ops = &axi_i2s_ops; -+ chip->dev_index = dev; ++/* Bitfields in FRER_RED_TAG */ ++#define GEM_STRIP_R_TAG_OFFSET 31 ++#define GEM_STRIP_R_TAG_SIZE 1 + -+ INIT_LIST_HEAD(&chip->pcm_list); -+ init_completion(&i2s->probe_wait); ++/* Bitfields in FRER_CONTROL_B */ ++#define GEM_MEMBER_STREAM2_OFFSET 4 ++#define GEM_MEMBER_STREAM2_SIZE 4 ++#define GEM_MEMBER_STREAM1_OFFSET 0 ++#define GEM_MEMBER_STREAM1_SIZE 4 + -+ chip->bdl_pos_adj = 32; -+ err = azx_i2s_bus_init(chip, &axi_i2s_io_ops); -+ if (err < 0) { -+ kfree(i2s); -+ return err; -+ } ++/* Bitfields in FRER_CONTROL_B */ ++#define GEM_SEQ_NUM_LENGTH_OFFSET 8 ++#define GEM_SEQ_NUM_LENGTH_SIZE 5 ++#define GEM_SEQ_REC_WINDOW_OFFSET 0 ++#define GEM_SEQ_REC_WINDOW_SIZE 6 + -+ INIT_WORK(&i2s->probe_work, azx_probe_work); -+ *rchip = chip; -+ return 0; -+} ++/* 802.1Qci */ ++#define GEM_RX_Q0_FLUSH 0x0B00 ++#define GEM_SCR2_REG0_RATE_LIMIT 0x0B40 ++#define GEM_SCR2_RATE_STATUS 0x0B80 + -+static int substream_alloc_pages(struct azx *chip, -+ struct snd_pcm_substream *substream, -+ size_t size) -+{ -+ int ret; ++/* Bitfields in rx q0 flush */ ++#define GEM_MAX_VAL_OFFSET 16 ++#define GEM_MAX_VAL_SIZE 16 ++#define GEM_LIMIT_FRAME_SIZE_OFFSET 3 ++#define GEM_LIMIT_FRAME_SIZE_SIZE 1 + -+ ret = snd_pcm_lib_malloc_pages(substream, size); -+ if (ret < 0) -+ return ret; ++/* Bitfields in scr2 reg0 rate limit */ ++#define GEM_MAX_RATE_VAL_OFFSET 16 ++#define GEM_MAX_RATE_VAL_SIZE 16 ++#define GEM_INTERVAL_TIME_OFFSET 0 ++#define GEM_INTERVAL_TIME_SIZE 16 + -+ return 0; -+} ++/* type 2 compare registers ++ * each location requires 3 compare regs ++ */ ++#define GEM_MAC_FIRST_CMP(idx) ((idx) * 3) ++#define GEM_MAC_SECOND_CMP(idx) ((idx) * 3 + 1) ++#define GEM_VLAN_ID_CMP(idx) ((idx) * 3 + 2) + -+static void phytium_dma_free_pages(struct i2sc_bus *bus, -+ struct snd_dma_buffer *buf) -+{ -+ snd_dma_free_pages(buf); -+} ++#undef TSN_DEBUG ++//#define TSN_DEBUG ++#ifdef TSN_DEBUG ++#define _dump_param(param) pr_err("%s %ld\n", #param, (unsigned long)param) ++#else ++#define _dump_param(param) ++#endif + -+static const struct i2s_io_ops axi_i2s_io_ops = { -+ .dma_alloc_pages = phytium_dma_alloc_pages, -+ .dma_free_pages = phytium_dma_free_pages, ++struct tsn_setting_param { ++ const char *name; ++ long value; +}; + -+static const struct i2s_controller_ops axi_i2s_ops = { -+ .substream_alloc_pages = substream_alloc_pages, -+ .substream_free_pages = substream_free_pages, ++enum { ++ CB_INDEX, ++ CB_OFST, ++ CB_SEQ_LEN, ++ CB_HIS_LEN, ++ CB_STRIP_RTAG, ++ CB_ENABLE, +}; + ++enum { ++ STREAM_ADD = 1, ++ STREAM_DEL, ++ STREAM_SHOW, ++}; + -+static int phytium_i2s_probe(struct platform_device *pdev) -+{ -+ struct i2s_phytium *i2s; -+ struct azx *chip; -+ struct resource *res; -+ struct pdata_px210_mfd *pdata; -+ struct snd_soc_dai_driver *dai_drv; -+ struct clk *clk; -+ int err, ret; -+ int card_num = 1; -+ bool schedule_probe; -+ struct fwnode_handle *np; ++enum { ++ STREAM_INDEX, ++ STREAM_SRC_MAC, ++ STREAM_DST_MAC, ++ STREAM_SRC_IP, ++ STREAM_DST_IP, ++ STREAM_SRC_PORT, ++ STREAM_DST_PORT, ++ STREAM_TAGGED, ++ STREAM_VLAN_ID, ++ STREAM_RX_QUEUE, ++}; + -+ i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL); -+ if (!i2s) -+ return -ENOMEM; ++enum { ++ QCI_INDEX, ++ QCI_MAX_SDU, ++ QCI_IPV, ++ QCI_INTERVAL, ++ QCI_MAX_RATE, ++ QCI_MARK_RED, ++}; + -+ dai_drv = devm_kzalloc(&pdev->dev, sizeof(*dai_drv), GFP_KERNEL); -+ if (!dai_drv) -+ return -ENOMEM; -+ memcpy(dai_drv, &phytium_i2s_dai, sizeof(phytium_i2s_dai)); ++enum { ++ QAV_QUEUE, ++ QAV_IDLESLOPE, ++ QAV_ENABLE, ++}; + -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ i2s->paddr = res->start; -+ i2s->regs = devm_ioremap_resource(&pdev->dev, res); ++#define GET_SETTING_SIZE(setting) (sizeof(setting) / \ ++ sizeof(struct tsn_setting_param)) + -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ i2s->regs_db = devm_ioremap_resource(&pdev->dev, res); ++void phytium_init_tsn(struct platform_device *pdev); ++void phytium_deinit_tsn(struct platform_device *pdev); ++int phytium_setup_tc(struct net_device *ndev, ++ enum tc_setup_type type, void *type_data); + -+ if (IS_ERR(i2s->regs)) -+ return PTR_ERR(i2s->regs); ++#endif /* _MACB_TSN_H */ +diff --git a/drivers/net/phy/at803x.c b/drivers/net/phy/at803x.c +index ac373510b..f5a17307b 100644 +--- a/drivers/net/phy/at803x.c ++++ b/drivers/net/phy/at803x.c +@@ -92,6 +92,10 @@ + #define AT803X_DEBUG_REG_5 0x05 + #define AT803X_DEBUG_TX_CLK_DLY_EN BIT(8) + ++#define AT803X_DEBUG_REG_B 0x0B ++#define AT803X_DEBUG_REG_B_HIBERNATION_ENABLE 0x1 ++#define AT803X_DEBUG_REG_B_HIBERNATION_OFFSET 15 + -+ i2s->irq_id = platform_get_irq(pdev, 0); + #define AT803X_DEBUG_REG_1F 0x1F + #define AT803X_DEBUG_PLL_ON BIT(2) + #define AT803X_DEBUG_RGMII_1V8 BIT(3) +@@ -202,6 +206,20 @@ static int at803x_enable_tx_delay(struct phy_device *phydev) + AT803X_DEBUG_TX_CLK_DLY_EN); + } + ++static inline int at803x_disable_hibernate(struct phy_device *phydev) ++{ ++ int ret = 0; ++ u16 val = 0; + -+ if (i2s->irq_id < 0) -+ return i2s->irq_id; ++ ret = at803x_debug_reg_read(phydev, AT803X_DEBUG_REG_B); ++ if (ret < 0) ++ return ret; + -+ i2s->i2s_reg_comp1 = I2S_COMP_PARAM_1; -+ i2s->i2s_reg_comp2 = I2S_COMP_PARAM_2; ++ val = ret & 0xffff; ++ val &= (~(AT803X_DEBUG_REG_B_HIBERNATION_ENABLE << AT803X_DEBUG_REG_B_HIBERNATION_OFFSET)); ++ return phy_write(phydev, AT803X_DEBUG_DATA, val); ++} + -+ ret = phytium_configure_dai_by_dt(i2s); + static int at803x_disable_rx_delay(struct phy_device *phydev) + { + return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_0, +@@ -563,6 +581,10 @@ static int at803x_config_init(struct phy_device *phydev) + { + int ret; + ++ ret = at803x_disable_hibernate(phydev); + if (ret < 0) + return ret; + -+ err = i2s_phytium_create(pdev, card_num, &chip, i2s); -+ if (err < 0) -+ return err; -+ i2s = container_of(chip, struct i2s_phytium, chip); -+ schedule_probe = !chip->disabled; + /* The RX and TX delay default is: + * after HW reset: RX delay enabled and TX delay disabled + * after SW reset: RX delay enabled, while TX delay retains the +diff --git a/drivers/net/phy/phylink.c b/drivers/net/phy/phylink.c +index cbdd01f31..d0c6bc96d 100644 +--- a/drivers/net/phy/phylink.c ++++ b/drivers/net/phy/phylink.c +@@ -306,6 +306,9 @@ static int phylink_parse_mode(struct phylink *pl, struct fwnode_handle *fwnode) + phylink_set(pl->supported, 2500baseX_Full); + break; + ++ case PHY_INTERFACE_MODE_5GBASER: ++ phylink_set(pl->supported, 5000baseT_Full); ++ break; + case PHY_INTERFACE_MODE_USXGMII: + case PHY_INTERFACE_MODE_10GKR: + case PHY_INTERFACE_MODE_10GBASER: +diff --git a/drivers/pci/hotplug/pciehp.h b/drivers/pci/hotplug/pciehp.h +index f1f789fe0..cd818ea56 100644 +--- a/drivers/pci/hotplug/pciehp.h ++++ b/drivers/pci/hotplug/pciehp.h +@@ -109,6 +109,11 @@ struct controller { + unsigned int ist_running; + int request_result; + wait_queue_head_t requester; + -+ dev_set_drvdata(&pdev->dev, i2s); ++#ifdef CONFIG_ARCH_PHYTIUM ++ u32 buses; ++ u16 slot_ctrl_t; ++#endif + }; + + /** +diff --git a/drivers/pci/hotplug/pciehp_ctrl.c b/drivers/pci/hotplug/pciehp_ctrl.c +index 32baba1b7..7c6a64c93 100644 +--- a/drivers/pci/hotplug/pciehp_ctrl.c ++++ b/drivers/pci/hotplug/pciehp_ctrl.c +@@ -226,6 +226,11 @@ void pciehp_handle_presence_or_link_change(struct controller *ctrl, u32 events) + { + int present, link_active; + ++#ifdef CONFIG_ARCH_PHYTIUM ++ struct pci_dev *pdev = ctrl->pcie->port; ++ u16 slot_ctrl_val; ++#endif + -+ pdata = dev_get_platdata(&pdev->dev); -+ i2s->dev = &pdev->dev; -+ if (pdata) { -+ dai_drv->name = pdata->name; -+ i2s->pdev = pdata->dev; -+ i2s->clk_base = pdata->clk_base; -+ i2s->pcie = 1; -+ } else if (pdev->dev.of_node) { -+ device_property_read_string(&pdev->dev, "dai-name", &dai_drv->name); -+ i2s->pdev = &pdev->dev; -+ clk = devm_clk_get(&pdev->dev, NULL); -+ i2s->clk_base = clk_get_rate(clk); -+ } else if (has_acpi_companion(&pdev->dev)) { -+ np = dev_fwnode(&(pdev->dev)); -+ ret = fwnode_property_read_string(np, "dai-name", &dai_drv->name); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing dai-name property from acpi\n"); -+ goto failed_get_dai_name; -+ } -+ i2s->pdev = &pdev->dev; -+ ret = fwnode_property_read_u32(np, "i2s_clk", &i2s->clk_base); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing i2s_clk property from acpi\n"); -+ goto failed_get_dai_name; + /* + * If the slot is on and presence or link has changed, turn it off. + * Even if it's occupied again, we cannot assume the card is the same. +@@ -244,6 +249,21 @@ void pciehp_handle_presence_or_link_change(struct controller *ctrl, u32 events) + if (events & PCI_EXP_SLTSTA_PDC) + ctrl_info(ctrl, "Slot(%s): Card not present\n", + slot_name(ctrl)); ++#ifdef CONFIG_ARCH_PHYTIUM ++ if ((ctrl->buses > 0) && (ctrl->slot_ctrl > 0)) { ++ pci_write_config_dword(pdev, PCI_PRIMARY_BUS, ctrl->buses); ++ slot_ctrl_val = ctrl->slot_ctrl_t | PCI_EXP_SLTCTL_ABPE | ++ PCI_EXP_SLTCTL_PFDE | PCI_EXP_SLTCTL_MRLSCE | ++ PCI_EXP_SLTCTL_PDCE | PCI_EXP_SLTCTL_CCIE | ++ PCI_EXP_SLTCTL_HPIE | PCI_EXP_SLTCTL_ATTN_IND_BLINK | ++ PCI_EXP_SLTCTL_PWR_IND_ON | ++ PCI_EXP_SLTCTL_DLLSCE; ++ slot_ctrl_val &= ~PCI_EXP_SLTCTL_PWR_OFF; ++ pcie_capability_write_word(pdev, PCI_EXP_SLTCTL, slot_ctrl_val); ++ ctrl_info(ctrl, "Ctrl buses=0x%x, slot_ctrl=0x%x\n", ++ ctrl->buses, slot_ctrl_val); + } -+ } -+ ret = devm_snd_soc_register_component(&pdev->dev, &phytium_i2s_component, -+ dai_drv, 1); -+ if (ret != 0) -+ dev_err(&pdev->dev, "not able to register dai\n"); ++#endif + pciehp_disable_slot(ctrl, SURPRISE_REMOVAL); + break; + default: +diff --git a/drivers/pci/hotplug/pciehp_hpc.c b/drivers/pci/hotplug/pciehp_hpc.c +index 75c6c72ec..ad7e9ce25 100644 +--- a/drivers/pci/hotplug/pciehp_hpc.c ++++ b/drivers/pci/hotplug/pciehp_hpc.c +@@ -597,7 +597,7 @@ static irqreturn_t pciehp_isr(int irq, void *dev_id) + * in the Slot Control register (PCIe r4.0, sec 6.7.3.4). + */ + if (pdev->current_state == PCI_D3cold || +- (!(ctrl->slot_ctrl & PCI_EXP_SLTCTL_HPIE) && !pciehp_poll_mode)) ++ (!(ctrl->slot_ctrl & PCI_EXP_SLTCTL_HPIE) && !pciehp_poll_mode)) + return IRQ_NONE; + + /* +@@ -695,7 +695,13 @@ static irqreturn_t pciehp_ist(int irq, void *dev_id) + struct controller *ctrl = (struct controller *)dev_id; + struct pci_dev *pdev = ctrl_dev(ctrl); + irqreturn_t ret; ++#ifdef CONFIG_ARCH_PHYTIUM ++ u32 events, buses; ++ u16 slot_ctrl; ++ bool link_active; ++#else + u32 events; ++#endif + + ctrl->ist_running = true; + pci_config_pm_runtime_get(pdev); +@@ -715,6 +721,23 @@ static irqreturn_t pciehp_ist(int irq, void *dev_id) + goto out; + } + ++#ifdef CONFIG_ARCH_PHYTIUM ++ if(ctrl->state == ON_STATE) { ++ pci_read_config_dword(pdev, PCI_PRIMARY_BUS, &buses); ++ pcie_capability_read_word(pdev, PCI_EXP_SLTCTL, &slot_ctrl); ++ ctrl->buses = buses; ++ ctrl->slot_ctrl_t = slot_ctrl; ++ ctrl_dbg(ctrl, "Ctrl buses=0x%x, slot_ctrl=0x%x\n", ++ ctrl->buses, ctrl->slot_ctrl_t); ++ } + -+ if (schedule_probe) -+ schedule_work(&i2s->probe_work); ++ mdelay(1000); + -+ if (chip->disabled) -+ complete_all(&i2s->probe_wait); ++ link_active = pciehp_check_link_active(ctrl); ++ if((ctrl->state == ON_STATE) && (link_active == false)) ++ events |= PCI_EXP_SLTSTA_DLLSC; ++#endif + -+ return 0; -+failed_get_dai_name: -+ return ret; + /* Check Attention Button Pressed */ + if (events & PCI_EXP_SLTSTA_ABP) { + ctrl_info(ctrl, "Slot(%s): Attention button pressed\n", +@@ -749,7 +772,6 @@ static irqreturn_t pciehp_ist(int irq, void *dev_id) + else if (events & (PCI_EXP_SLTSTA_PDC | PCI_EXP_SLTSTA_DLLSC)) + pciehp_handle_presence_or_link_change(ctrl, events); + up_read(&ctrl->reset_lock); +- + ret = IRQ_HANDLED; + out: + pci_config_pm_runtime_put(pdev); +diff --git a/drivers/pci/pcie/portdrv.h b/drivers/pci/pcie/portdrv.h +index 2ff5724b8..6ac559346 100644 +--- a/drivers/pci/pcie/portdrv.h ++++ b/drivers/pci/pcie/portdrv.h +@@ -123,6 +123,19 @@ void pcie_port_bus_unregister(void); + + struct pci_dev; + ++#ifdef CONFIG_HOTPLUG_PCI_PCIE ++extern bool pciehp_msi_disabled; ++ ++static inline bool pciehp_no_msi(void) ++{ ++ return pciehp_msi_disabled; +} + -+static int phytium_i2s_remove(struct platform_device *pdev) ++#else /* !CONFIG_HOTPLUG_PCI_PCIE */ ++static inline bool pciehp_no_msi(void) { return false; } ++#endif /* !CONFIG_HOTPLUG_PCI_PCIE */ ++ ++ + #ifdef CONFIG_PCIE_PME + extern bool pcie_pme_msi_disabled; + +diff --git a/drivers/pci/pcie/portdrv_core.c b/drivers/pci/pcie/portdrv_core.c +index 3779b264d..839e43c55 100644 +--- a/drivers/pci/pcie/portdrv_core.c ++++ b/drivers/pci/pcie/portdrv_core.c +@@ -25,6 +25,17 @@ struct portdrv_service_data { + u32 service; + }; + ++bool pciehp_msi_disabled; ++ ++static int __init pciehp_setup(char *str) +{ -+ pm_runtime_disable(&pdev->dev); -+ return 0; ++ if (!strncmp(str, "nomsi", 5)) ++ pciehp_msi_disabled = true; ++ ++ return 1; +} ++__setup("pcie_hp=", pciehp_setup); + -+static const struct of_device_id phytium_i2s_of_match[] = { -+ { .compatible = "phytium,i2s", }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, phytium_i2s_of_match); + /** + * release_pcie_device - free PCI Express port service device structure + * @dev: Port service device to release +@@ -177,6 +188,9 @@ static int pcie_init_service_irqs(struct pci_dev *dev, int *irqs, int mask) + if ((mask & PCIE_PORT_SERVICE_PME) && pcie_pme_no_msi()) + goto legacy_irq; + ++ if ((mask & PCIE_PORT_SERVICE_HP) && pciehp_no_msi()) ++ goto legacy_irq; + + /* Try to use MSI-X or MSI if supported */ + if (pcie_port_enable_irq_vec(dev, irqs, mask) == 0) + return 0; +diff --git a/drivers/pci/quirks.c b/drivers/pci/quirks.c +index 21661feee..5af216b4e 100644 +--- a/drivers/pci/quirks.c ++++ b/drivers/pci/quirks.c +@@ -30,6 +30,7 @@ + #include + #include + #include /* isa_dma_bridge_buggy */ ++#include + #include "pci.h" + + static ktime_t fixup_debug_start(struct pci_dev *dev, +@@ -3878,12 +3879,12 @@ static int nvme_disable_and_flr(struct pci_dev *dev, int probe) + void __iomem *bar; + u16 cmd; + u32 cfg; +- ++ printk("%s began\n", __func__); + if (dev->class != PCI_CLASS_STORAGE_EXPRESS || + !pcie_has_flr(dev) || !pci_resource_start(dev, 0)) + return -ENOTTY; + +- if (probe) ++ if (probe & !is_kdump_kernel()) + return 0; + + bar = pci_iomap(dev, 0, NVME_REG_CC + sizeof(cfg)); +@@ -3937,7 +3938,7 @@ static int nvme_disable_and_flr(struct pci_dev *dev, int probe) + pci_iounmap(dev, bar); + + pcie_flr(dev); +- ++ printk("%s finished\n", __func__); + return 0; + } + +@@ -4033,6 +4034,7 @@ static const struct pci_dev_reset_methods pci_dev_reset_methods[] = { + { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_IVB_M2_VGA, + reset_ivb_igd }, + { PCI_VENDOR_ID_SAMSUNG, 0xa804, nvme_disable_and_flr }, ++ { PCI_VENDOR_ID_SAMSUNG, 0xa809, nvme_disable_and_flr }, + { PCI_VENDOR_ID_INTEL, 0x0953, delay_250ms_after_flr }, + { PCI_VENDOR_ID_CHELSIO, PCI_ANY_ID, + reset_chelsio_generic_dev }, +@@ -4972,6 +4974,10 @@ static const struct pci_dev_acs_enabled { + { PCI_VENDOR_ID_ZHAOXIN, PCI_ANY_ID, pci_quirk_zhaoxin_pcie_ports_acs }, + /* Wangxun nics */ + { PCI_VENDOR_ID_WANGXUN, PCI_ANY_ID, pci_quirk_wangxun_nic_acs }, ++ /* Phytium Technology */ ++ { 0x10b5, PCI_ANY_ID, pci_quirk_xgene_acs }, ++ { 0x17cd, PCI_ANY_ID, pci_quirk_xgene_acs }, ++ { 0x1db7, PCI_ANY_ID, pci_quirk_xgene_acs }, + { 0 } + }; + +@@ -5355,6 +5361,7 @@ DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0142, quirk_no_ext_tags); + DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0144, quirk_no_ext_tags); + DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0420, quirk_no_ext_tags); + DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0422, quirk_no_ext_tags); ++DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_PHYTIUM, 0xdc3a, quirk_no_ext_tags); + + #ifdef CONFIG_PCI_ATS + static void quirk_no_ats(struct pci_dev *pdev) +diff --git a/drivers/tee/optee/core.c b/drivers/tee/optee/core.c +index 6ea80add7..b96f8e313 100644 +--- a/drivers/tee/optee/core.c ++++ b/drivers/tee/optee/core.c +@@ -5,6 +5,7 @@ + + #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt + ++#include + #include + #include + #include +@@ -776,6 +777,14 @@ static const struct of_device_id optee_dt_match[] = { + }; + MODULE_DEVICE_TABLE(of, optee_dt_match); + +#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_i2s_acpi_match[] = { -+ { "PHYT0016", 0}, ++static const struct acpi_device_id optee_acpi_match[] = { ++ { "PHYT8003" }, + { } +}; -+MODULE_DEVICE_TABLE(acpi, phytium_i2s_acpi_match); -+#else -+#define phytium_i2s_acpi_match NULL ++MODULE_DEVICE_TABLE(acpi, optee_acpi_match); +#endif + -+static struct platform_driver phytium_i2s_driver = { -+ .probe = phytium_i2s_probe, -+ .remove = phytium_i2s_remove, -+ .driver = { -+ .name = "phytium-i2s", -+ .of_match_table = of_match_ptr(phytium_i2s_of_match), -+ .acpi_match_table = phytium_i2s_acpi_match, -+ }, -+}; -+ -+module_platform_driver(phytium_i2s_driver); -+ -+MODULE_DESCRIPTION("Phytium I2S Driver"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Zhang Yiqun "); -diff --git a/sound/soc/phytium/pmdk_dp.c b/sound/soc/phytium/pmdk_dp.c -new file mode 100755 -index 000000000..8f7b72504 ---- /dev/null -+++ b/sound/soc/phytium/pmdk_dp.c -@@ -0,0 +1,235 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+ -+#define DAI_CNT(pmdk_dai_) sizeof(pmdk_dai_)/sizeof(struct snd_soc_dai_link) -+ -+struct pmdk_dp_private { -+ struct snd_soc_jack jack0; -+ struct snd_soc_jack jack1; -+ struct snd_soc_jack jack2; -+}; -+ -+/* PMDK widgets */ -+static const struct snd_soc_dapm_widget pmdk_dp_dapm_widgets[] = { -+ SND_SOC_DAPM_LINE("DP", NULL), -+}; -+ -+/* PMDK control */ -+static const struct snd_kcontrol_new pmdk_controls[] = { -+ SOC_DAPM_PIN_SWITCH("DP"), -+}; -+ -+/* PMDK connections */ -+static const struct snd_soc_dapm_route pmdk_dp_audio_map[] = { -+ {"DP", NULL, "TX"}, -+}; -+ -+static struct snd_soc_jack_pin dp0_pins[] = { -+ { -+ .pin = "HDMI/DP,pcm=0", -+ .mask = SND_JACK_LINEOUT, -+ }, -+}; -+ -+static struct snd_soc_jack_pin dp1_pins[] = { -+ { -+ .pin = "HDMI/DP,pcm=1", -+ .mask = SND_JACK_LINEOUT, -+ }, -+}; + static struct platform_driver optee_driver = { + .probe = optee_probe, + .remove = optee_remove, +@@ -783,6 +792,7 @@ static struct platform_driver optee_driver = { + .driver = { + .name = "optee", + .of_match_table = optee_dt_match, ++ .acpi_match_table = ACPI_PTR(optee_acpi_match), + }, + }; + module_platform_driver(optee_driver); +diff --git a/drivers/usb/host/xhci-pci.c b/drivers/usb/host/xhci-pci.c +index 53f832787..96be5bc21 100644 +--- a/drivers/usb/host/xhci-pci.c ++++ b/drivers/usb/host/xhci-pci.c +@@ -72,6 +72,8 @@ + #define PCI_DEVICE_ID_ASMEDIA_2142_XHCI 0x2142 + #define PCI_DEVICE_ID_ASMEDIA_3242_XHCI 0x3242 + ++#define PCI_DEVICE_ID_PHYTIUM_XHCI 0xdc27 + -+static struct snd_soc_jack_pin dp2_pins[] = { -+ { -+ .pin = "HDMI/DP,pcm=2", -+ .mask = SND_JACK_LINEOUT, -+ }, + static const char hcd_name[] = "xhci_hcd"; + + static struct hc_driver __read_mostly xhci_pci_hc_driver; +@@ -283,6 +285,9 @@ static void xhci_pci_quirks(struct device *dev, struct xhci_hcd *xhci) + if (pdev->vendor == PCI_VENDOR_ID_VIA) + xhci->quirks |= XHCI_RESET_ON_RESUME; + ++ if (pdev->vendor == PCI_VENDOR_ID_PHYTIUM || ++ pdev->device == PCI_DEVICE_ID_PHYTIUM_XHCI) ++ xhci->quirks |= XHCI_RESET_ON_RESUME; + /* See https://bugzilla.kernel.org/show_bug.cgi?id=79511 */ + if (pdev->vendor == PCI_VENDOR_ID_VIA && + pdev->device == 0x3432) +diff --git a/drivers/usb/host/xhci-plat.c b/drivers/usb/host/xhci-plat.c +index e56a1fb97..65a019a4d 100644 +--- a/drivers/usb/host/xhci-plat.c ++++ b/drivers/usb/host/xhci-plat.c +@@ -137,6 +137,10 @@ static const struct xhci_plat_priv xhci_plat_brcm = { + .quirks = XHCI_RESET_ON_RESUME | XHCI_SUSPEND_RESUME_CLKS, + }; + ++static const struct xhci_plat_priv xhci_plat_phytium_pe220x = { ++ .quirks = XHCI_RESET_ON_RESUME, +}; + -+#define SMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ -+ SND_SOC_DAIFMT_CBS_CFS) -+ -+static int pmdk_dp0_init(struct snd_soc_pcm_runtime *runtime) -+{ -+ struct snd_soc_card *card = runtime->card; -+ struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); -+ struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; -+ int ret; -+ -+ ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=0", -+ SND_JACK_LINEOUT, -+ &priv->jack0, dp0_pins, -+ ARRAY_SIZE(dp0_pins)); -+ if (ret) { -+ dev_err(card->dev, "Jack creation failed %d\n", ret); -+ return ret; -+ } -+ snd_soc_component_set_jack(component, &priv->jack0, NULL); -+ return ret; -+} -+ -+static int pmdk_dp1_init(struct snd_soc_pcm_runtime *runtime) -+{ -+ struct snd_soc_card *card = runtime->card; -+ struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); -+ struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; -+ int ret; -+ -+ ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=1", -+ SND_JACK_LINEOUT, -+ &priv->jack1, dp1_pins, -+ ARRAY_SIZE(dp1_pins)); -+ -+ if (ret) { -+ dev_err(card->dev, "Jack creation failed %d\n", ret); -+ return ret; -+ } -+ snd_soc_component_set_jack(component, &priv->jack1, NULL); -+ return ret; -+} -+ -+static int pmdk_dp2_init(struct snd_soc_pcm_runtime *runtime) + static const struct of_device_id usb_xhci_of_match[] = { + { + .compatible = "generic-xhci", +@@ -178,6 +182,9 @@ static const struct of_device_id usb_xhci_of_match[] = { + }, { + .compatible = "brcm,bcm7445-xhci", + .data = &xhci_plat_brcm, ++ }, { ++ .compatible = "phytium,pe220x-xhci", ++ .data = &xhci_plat_phytium_pe220x, + }, + {}, + }; +@@ -289,6 +296,8 @@ static int xhci_plat_probe(struct platform_device *pdev) + + if (pdev->dev.of_node) + priv_match = of_device_get_match_data(&pdev->dev); ++ else if (has_acpi_companion(&pdev->dev)) ++ priv_match = acpi_device_get_match_data(&pdev->dev); + else + priv_match = dev_get_platdata(&pdev->dev); + +@@ -533,6 +542,7 @@ static const struct dev_pm_ops xhci_plat_pm_ops = { + static const struct acpi_device_id usb_xhci_acpi_match[] = { + /* XHCI-compliant USB Controller */ + { "PNP0D10", }, ++ { "PHYT0039", (kernel_ulong_t)&xhci_plat_phytium_pe220x }, + { } + }; + MODULE_DEVICE_TABLE(acpi, usb_xhci_acpi_match); +diff --git a/include/acpi/acpi_drivers.h b/include/acpi/acpi_drivers.h +index 5eb175933..dbdcd2f51 100644 +--- a/include/acpi/acpi_drivers.h ++++ b/include/acpi/acpi_drivers.h +@@ -68,7 +68,7 @@ + + int acpi_irq_penalty_init(void); + int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, +- int *polarity, char **name); ++ int *polarity, char **name, struct fwnode_handle **rs_fwnode); + int acpi_pci_link_free_irq(acpi_handle handle); + + /* ACPI PCI Device Binding (pci_bind.c) */ +diff --git a/include/clocksource/arm_arch_timer.h b/include/clocksource/arm_arch_timer.h +index 1d68d5613..6b085710e 100644 +--- a/include/clocksource/arm_arch_timer.h ++++ b/include/clocksource/arm_arch_timer.h +@@ -24,7 +24,7 @@ + + enum arch_timer_reg { + ARCH_TIMER_REG_CTRL, +- ARCH_TIMER_REG_TVAL, ++ ARCH_TIMER_REG_CVAL, + }; + + enum arch_timer_ppi_nr { +diff --git a/include/linux/acpi.h b/include/linux/acpi.h +index 9c184dbce..5692707e0 100644 +--- a/include/linux/acpi.h ++++ b/include/linux/acpi.h +@@ -340,6 +340,16 @@ struct irq_domain *acpi_irq_create_hierarchy(unsigned int flags, + const struct irq_domain_ops *ops, + void *host_data); + ++#ifdef CONFIG_ACPI_GENERIC_GSI ++struct fwnode_handle *acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source); ++#else ++static inline ++struct fwnode_handle *acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source) +{ -+ struct snd_soc_card *card = runtime->card; -+ struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); -+ struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; -+ int ret; -+ -+ ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=2", -+ SND_JACK_LINEOUT, -+ &priv->jack2, dp2_pins, -+ ARRAY_SIZE(dp2_pins)); -+ if (ret) { -+ dev_err(card->dev, "Jack creation failed %d\n", ret); -+ return ret; -+ } -+ snd_soc_component_set_jack(component, &priv->jack2, NULL); -+ return ret; ++ return NULL; +} ++#endif + -+SND_SOC_DAILINK_DEFS(pmdk_dp0_dai, -+ DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp0")), -+ DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918656", "i2s-hifi")), -+ DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); -+ -+SND_SOC_DAILINK_DEFS(pmdk_dp1_dai, -+ DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp1")), -+ DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918657", "i2s-hifi")), -+ DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); -+ -+SND_SOC_DAILINK_DEFS(pmdk_dp2_dai, -+ DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp2")), -+ DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918658", "i2s-hifi")), -+ DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); -+ -+static struct snd_soc_dai_link pmdk_dai_local[] = { -+{ -+ .name = "Phytium dp0-audio", -+ .stream_name = "Playback", -+ .dai_fmt = SMDK_DAI_FMT, -+ .init = pmdk_dp0_init, -+ SND_SOC_DAILINK_REG(pmdk_dp0_dai), -+},{ -+ .name = "Phytium dp1-audio", -+ .stream_name = "Playback", -+ .dai_fmt = SMDK_DAI_FMT, -+ .init = pmdk_dp1_init, -+ SND_SOC_DAILINK_REG(pmdk_dp1_dai), -+}, -+{ -+ .name = "Phytium dp2-audio", -+ .stream_name = "Playback", -+ .dai_fmt = SMDK_DAI_FMT, -+ .init = pmdk_dp2_init, -+ SND_SOC_DAILINK_REG(pmdk_dp2_dai), -+}, -+}; -+ -+static struct snd_soc_card pmdk = { -+ .name = "PMDK-I2S", -+ .owner = THIS_MODULE, + #ifdef CONFIG_X86_IO_APIC + extern int acpi_get_override_irq(u32 gsi, int *trigger, int *polarity); + #else +diff --git a/include/linux/cpuhotplug.h b/include/linux/cpuhotplug.h +index 088c835ac..fff4c30ba 100644 +--- a/include/linux/cpuhotplug.h ++++ b/include/linux/cpuhotplug.h +@@ -198,6 +198,7 @@ enum cpuhp_state { + CPUHP_AP_ONLINE_DYN_END = CPUHP_AP_ONLINE_DYN + 30, + CPUHP_AP_X86_HPET_ONLINE, + CPUHP_AP_X86_KVM_CLK_ONLINE, ++ CPUHP_AP_HOMO_RPROC_STARTING, + CPUHP_AP_ACTIVE, + CPUHP_ONLINE, + }; +diff --git a/include/linux/pci_ids.h b/include/linux/pci_ids.h +index 1a41147b2..62c6786ce 100644 +--- a/include/linux/pci_ids.h ++++ b/include/linux/pci_ids.h +@@ -3141,4 +3141,6 @@ + + #define PCI_VENDOR_ID_NCUBE 0x10ff + ++#define PCI_VENDOR_ID_PHYTIUM 0x1db7 + -+ .dapm_widgets = pmdk_dp_dapm_widgets, -+ .num_dapm_widgets = ARRAY_SIZE(pmdk_dp_dapm_widgets), -+ .controls = pmdk_controls, -+ .num_controls = ARRAY_SIZE(pmdk_controls), -+ .dapm_routes = pmdk_dp_audio_map, -+ .num_dapm_routes = ARRAY_SIZE(pmdk_dp_audio_map), -+}; + #endif /* _LINUX_PCI_IDS_H */ +diff --git a/include/linux/phy.h b/include/linux/phy.h +old mode 100644 +new mode 100755 +index 08725a262..0336cb22b +--- a/include/linux/phy.h ++++ b/include/linux/phy.h +@@ -106,6 +106,7 @@ extern const int phy_10gbit_features_array[1]; + * @PHY_INTERFACE_MODE_TRGMII: Turbo RGMII + * @PHY_INTERFACE_MODE_1000BASEX: 1000 BaseX + * @PHY_INTERFACE_MODE_2500BASEX: 2500 BaseX ++ * @PHY_INTERFACE_MODE_5GBASER: 5G BaseR + * @PHY_INTERFACE_MODE_RXAUI: Reduced XAUI + * @PHY_INTERFACE_MODE_XAUI: 10 Gigabit Attachment Unit Interface + * @PHY_INTERFACE_MODE_10GBASER: 10G BaseR +@@ -137,6 +138,7 @@ typedef enum { + PHY_INTERFACE_MODE_TRGMII, + PHY_INTERFACE_MODE_1000BASEX, + PHY_INTERFACE_MODE_2500BASEX, ++ PHY_INTERFACE_MODE_5GBASER, + PHY_INTERFACE_MODE_RXAUI, + PHY_INTERFACE_MODE_XAUI, + /* 10GBASE-R, XFI, SFI - single lane 10G Serdes */ +@@ -207,6 +209,8 @@ static inline const char *phy_modes(phy_interface_t interface) + return "1000base-x"; + case PHY_INTERFACE_MODE_2500BASEX: + return "2500base-x"; ++ case PHY_INTERFACE_MODE_5GBASER: ++ return "5gbase-r"; + case PHY_INTERFACE_MODE_RXAUI: + return "rxaui"; + case PHY_INTERFACE_MODE_XAUI: +@@ -545,7 +549,7 @@ struct phy_device { + struct phy_driver *drv; + + u32 phy_id; +- ++ u32 force_mode; + struct phy_c45_device_ids c45_ids; + unsigned is_c45:1; + unsigned is_internal:1; +diff --git a/include/sound/hdaudio.h b/include/sound/hdaudio.h +index 496decb63..febaa698e 100644 +--- a/include/sound/hdaudio.h ++++ b/include/sound/hdaudio.h +@@ -340,6 +340,7 @@ struct hdac_bus { + bool align_bdle_4k:1; /* BDLE align 4K boundary */ + bool reverse_assign:1; /* assign devices in reverse order */ + bool corbrp_self_clear:1; /* CORBRP clears itself after reset */ ++ bool cmd_resend:1; /* command resend */ + bool polling_mode:1; + bool needs_damn_long_delay:1; + +diff --git a/include/uapi/linux/serial_core.h b/include/uapi/linux/serial_core.h +index 851b982f8..f08747fd2 100644 +--- a/include/uapi/linux/serial_core.h ++++ b/include/uapi/linux/serial_core.h +@@ -279,4 +279,11 @@ + /* Freescale LINFlexD UART */ + #define PORT_LINFLEXUART 122 + + -+static int pmdk_sound_probe(struct platform_device *pdev) -+{ -+ struct snd_soc_card *card = &pmdk; -+ struct pmdk_dp_private *priv; -+ struct snd_soc_dai_link *pmdk_dai; -+ int num_dp = 2; -+ char dp_mask = 0x7; -+ int i,j = 0; -+ card->dev = &pdev->dev; ++/* Phytium PCI UART ++ * use bigger value to aviod code confilct ++ * when update in the future. ++ */ ++#define PORT_PHYTIUM 200 + -+ device_property_read_u32(&pdev->dev, "num-dp", &num_dp); -+ device_property_read_u8(&pdev->dev, "dp-mask", &dp_mask); -+ pmdk_dai = devm_kzalloc(&pdev->dev, num_dp * sizeof(*pmdk_dai), GFP_KERNEL); -+ if (!pmdk_dai) -+ return -ENOMEM; + #endif /* _UAPILINUX_SERIAL_CORE_H */ +diff --git a/sound/hda/hdac_controller.c b/sound/hda/hdac_controller.c +index 522d18976..a019ad892 100644 +--- a/sound/hda/hdac_controller.c ++++ b/sound/hda/hdac_controller.c +@@ -143,6 +143,9 @@ int snd_hdac_bus_send_cmd(struct hdac_bus *bus, unsigned int val) + { + unsigned int addr = azx_command_addr(val); + unsigned int wp, rp; ++ unsigned long timeout; ++ unsigned int rirb_wp; ++ int i = 0; + + spin_lock_irq(&bus->reg_lock); + +@@ -169,6 +172,42 @@ int snd_hdac_bus_send_cmd(struct hdac_bus *bus, unsigned int val) + bus->corb.buf[wp] = cpu_to_le32(val); + snd_hdac_chip_writew(bus, CORBWP, wp); + ++ if (bus->cmd_resend) { ++ timeout = jiffies + msecs_to_jiffies(1000); ++ udelay(80); ++ rirb_wp = snd_hdac_chip_readw(bus, RIRBWP); ++ while (rirb_wp == bus->rirb.wp) { ++ udelay(80); ++ rirb_wp = snd_hdac_chip_readw(bus, RIRBWP); ++ if (rirb_wp != bus->rirb.wp) ++ break; ++ if (i > 5) ++ break; ++ if (time_after(jiffies, timeout)) ++ break; + -+ if (!num_dp || num_dp > DAI_CNT(pmdk_dai_local)) -+ return -EINVAL; ++ /* add command to corb */ ++ wp = snd_hdac_chip_readw(bus, CORBWP); ++ if (wp == 0xffff) { ++ /* something wrong, controller likely turned to D3 */ ++ spin_unlock_irq(&bus->reg_lock); ++ return -EIO; ++ } ++ wp++; ++ wp %= AZX_MAX_CORB_ENTRIES; + -+ for(i = 0; i < num_dp; i++) { -+ for (; j < DAI_CNT(pmdk_dai_local); j++) { -+ if (BIT(j) & dp_mask) { -+ pmdk_dai[i] = pmdk_dai_local[j]; -+ j++; -+ break; ++ rp = snd_hdac_chip_readw(bus, CORBRP); ++ if (wp == rp) { ++ /* oops, it's full */ ++ spin_unlock_irq(&bus->reg_lock); ++ return -EAGAIN; + } ++ bus->corb.buf[wp] = cpu_to_le32(val); ++ snd_hdac_chip_writew(bus, CORBWP, wp); ++ i++; + } + } + -+ card->dai_link = pmdk_dai; -+ card->num_links = num_dp; -+ -+ priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); -+ if (!priv) -+ return -ENOMEM; -+ -+ snd_soc_card_set_drvdata(card, priv); -+ -+ return devm_snd_soc_register_card(&pdev->dev, card); -+} -+ -+static const struct of_device_id pmdk_sound_of_match[] = { -+ { .compatible = "phytium,pmdk-dp",}, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, pmdk_sound_of_match); -+ -+static const struct acpi_device_id pmdk_sound_acpi_match[] = { -+ { "PHYT8006", 0}, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); -+ -+static struct platform_driver pmdk_sound_driver = { -+ .probe = pmdk_sound_probe, -+ .driver = { -+ .name = "pmdk_dp", -+ .acpi_match_table = pmdk_sound_acpi_match, -+ .of_match_table = pmdk_sound_of_match, -+#ifdef CONFIG_PM -+ .pm = &snd_soc_pm_ops, + spin_unlock_irq(&bus->reg_lock); + + return 0; +diff --git a/sound/hda/hdac_stream.c b/sound/hda/hdac_stream.c +index 557072245..84d5a9ca6 100644 +--- a/sound/hda/hdac_stream.c ++++ b/sound/hda/hdac_stream.c +@@ -87,7 +87,11 @@ void snd_hdac_stream_start(struct hdac_stream *azx_dev, bool fresh_start) + + trace_snd_hdac_stream_start(bus, azx_dev); + ++#ifdef CONFIG_SND_HDA_PHYTIUM ++ azx_dev->start_wallclk = snd_hdac_chip_readl(bus, WALLCLK) / 15; ++#else + azx_dev->start_wallclk = snd_hdac_chip_readl(bus, WALLCLK); +#endif -+ }, -+}; -+ -+module_platform_driver(pmdk_sound_driver); -+ -+MODULE_AUTHOR("Zhang Yiqun"); -+MODULE_DESCRIPTION("ALSA SoC PMDK DP"); -+MODULE_LICENSE("GPL"); -diff --git a/sound/soc/phytium/pmdk_es8336.c b/sound/soc/phytium/pmdk_es8336.c -new file mode 100644 -index 000000000..680fdbfdd ---- /dev/null -+++ b/sound/soc/phytium/pmdk_es8336.c -@@ -0,0 +1,96 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+ -+/* PMDK widgets */ -+static const struct snd_soc_dapm_widget pmdk_es8336_dapm_widgets[] = { -+ SND_SOC_DAPM_HP("HP", NULL), -+ SND_SOC_DAPM_MIC("Int Mic", NULL), -+ SND_SOC_DAPM_MIC("Mic In", NULL), -+}; -+ -+/* PMDK control */ -+static const struct snd_kcontrol_new pmdk_controls[] = { -+ SOC_DAPM_PIN_SWITCH("HP"), -+ SOC_DAPM_PIN_SWITCH("Int Mic"), -+ SOC_DAPM_PIN_SWITCH("Mic In"), -+}; -+ -+/* PMDK connections */ -+static const struct snd_soc_dapm_route pmdk_es8336_audio_map[] = { -+ {"DMIC", NULL, "Int Mic"}, -+ {"MIC1", NULL, "Mic In"}, -+ {"MIC2", NULL, "Mic In"}, -+ -+ {"HP", NULL, "HPOL"}, -+ {"HP", NULL, "HPOR"}, -+}; -+ -+#define PMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ -+ SND_SOC_DAIFMT_CBS_CFS) -+ -+SND_SOC_DAILINK_DEFS(pmdk_es8366, -+ DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-lsd")), -+ DAILINK_COMP_ARRAY(COMP_CODEC("i2c-ESSX8336:00", "es8336-hifi")), -+ DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); -+ -+static struct snd_soc_dai_link pmdk_dai[] = { -+ { -+ .name = "ES8336 HIFI", -+ .stream_name = "ES8336 HIFI", -+ .dai_fmt = PMDK_DAI_FMT, -+ SND_SOC_DAILINK_REG(pmdk_es8366), -+ }, -+}; -+ -+static struct snd_soc_card pmdk = { -+ .name = "PMDK-I2S", -+ .owner = THIS_MODULE, -+ .dai_link = pmdk_dai, -+ .num_links = ARRAY_SIZE(pmdk_dai), -+ -+ .dapm_widgets = pmdk_es8336_dapm_widgets, -+ .num_dapm_widgets = ARRAY_SIZE(pmdk_es8336_dapm_widgets), -+ .controls = pmdk_controls, -+ .num_controls = ARRAY_SIZE(pmdk_controls), -+ .dapm_routes = pmdk_es8336_audio_map, -+ .num_dapm_routes = ARRAY_SIZE(pmdk_es8336_audio_map), -+}; -+ -+static int pmdk_sound_probe(struct platform_device *pdev) -+{ -+ struct snd_soc_card *card = &pmdk; -+ struct device *dev = &pdev->dev; -+ -+ card->dev = dev; -+ -+ return devm_snd_soc_register_card(&pdev->dev, card); -+} -+ -+static const struct acpi_device_id pmdk_sound_acpi_match[] = { -+ { "PHYT8005", 0}, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); -+ -+static struct platform_driver pmdk_sound_driver = { -+ .probe = pmdk_sound_probe, -+ .driver = { -+ .name = "pmdk_es8336", -+ .acpi_match_table = pmdk_sound_acpi_match, -+#ifdef CONFIG_PM -+ .pm = &snd_soc_pm_ops, + if (!fresh_start) + azx_dev->start_wallclk -= azx_dev->period_wallclk; + +@@ -550,7 +554,11 @@ static u64 azx_cc_read(const struct cyclecounter *cc) + { + struct hdac_stream *azx_dev = container_of(cc, struct hdac_stream, cc); + ++#ifdef CONFIG_SND_HDA_PHYTIUM ++ return snd_hdac_chip_readl(azx_dev->bus, WALLCLK) / 25; ++#else + return snd_hdac_chip_readl(azx_dev->bus, WALLCLK); +#endif -+ }, -+}; + } + + static void azx_timecounter_init(struct hdac_stream *azx_dev, +diff --git a/sound/pci/hda/hda_controller.c b/sound/pci/hda/hda_controller.c +index ea76395d7..9bc0b6e24 100644 +--- a/sound/pci/hda/hda_controller.c ++++ b/sound/pci/hda/hda_controller.c +@@ -17,6 +17,8 @@ + #include + #include + ++#include "hda_phytium.h" + -+module_platform_driver(pmdk_sound_driver); -+MODULE_AUTHOR("Zhang Yiqun "); -+MODULE_DESCRIPTION("ALSA SoC PMDK ES8336"); -+MODULE_LICENSE("GPL"); -diff --git a/sound/soc/phytium/pmdk_es8388.c b/sound/soc/phytium/pmdk_es8388.c + #ifdef CONFIG_X86 + /* for art-tsc conversion */ + #include +@@ -157,6 +159,10 @@ static int azx_pcm_prepare(struct snd_pcm_substream *substream) + snd_hda_spdif_out_of_nid(apcm->codec, hinfo->nid); + unsigned short ctls = spdif ? spdif->ctls : 0; + ++ struct hda_ft *hda; ++ hda = container_of(chip, struct hda_ft, chip); ++ hda->substream = substream; ++ + trace_azx_pcm_prepare(chip, azx_dev); + dsp_lock(azx_dev); + if (dsp_is_locked(azx_dev)) { +diff --git a/sound/pci/hda/hda_phytium.h b/sound/pci/hda/hda_phytium.h new file mode 100644 -index 000000000..ece718469 +index 000000000..ec1f3e7f7 --- /dev/null -+++ b/sound/soc/phytium/pmdk_es8388.c -@@ -0,0 +1,169 @@ -+// SPDX-License-Identifier: GPL-2.0 ++++ b/sound/pci/hda/hda_phytium.h +@@ -0,0 +1,34 @@ ++/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. ++ * Implementation of primary ALSA driver code base for Phytium HD Audio. ++ * ++ * Copyright (c) 2018-2024 Phytium Technology Co., Ltd. + */ ++#ifndef __SOUND_HDA_PHYTIUM_H__ ++#define __SOUND_HDA_PHYTIUM_H__ + -+#include -+#include -+#include -+#include -+#include -+ -+static struct snd_soc_jack hs_jack; -+ -+/* Headset jack detection DAPM pins */ -+static struct snd_soc_jack_pin hs_jack_pins[] = { -+ { -+ .pin = "FrontIn", -+ .mask = SND_JACK_MICROPHONE, -+ }, -+ { -+ .pin = "RearIn", -+ .mask = SND_JACK_MICROPHONE, -+ .invert = 1 -+ }, -+ { -+ .pin = "Front", -+ .mask = SND_JACK_HEADPHONE, -+ }, -+ { -+ .pin = "Rear", -+ .mask = SND_JACK_HEADPHONE, -+ .invert = 1 -+ }, -+}; -+ -+/* Headset jack detection gpios */ -+static struct snd_soc_jack_gpio hs_jack_gpios[] = { -+ { -+ .name = "det", -+ .report = SND_JACK_HEADSET, -+ .debounce_time = 200, -+ .invert = 1, -+ }, -+}; -+ -+/* PMDK widgets */ -+static const struct snd_soc_dapm_widget pmdk_es8388_dapm_widgets[] = { -+ SND_SOC_DAPM_HP("Front", NULL), -+ SND_SOC_DAPM_HP("Rear", NULL), -+ -+ SND_SOC_DAPM_MIC("FrontIn", NULL), -+ SND_SOC_DAPM_MIC("RearIn", NULL), -+}; -+ -+/* PMDK control */ -+static const struct snd_kcontrol_new pmdk_controls[] = { -+ SOC_DAPM_PIN_SWITCH("Front"), -+ SOC_DAPM_PIN_SWITCH("Rear"), -+ SOC_DAPM_PIN_SWITCH("FrontIn"), -+ SOC_DAPM_PIN_SWITCH("RearIn"), -+}; -+ -+/* PMDK connections */ -+static const struct snd_soc_dapm_route pmdk_es8388_audio_map[] = { -+ {"LINPUT1", NULL, "FrontIn"}, -+ {"RINPUT1", NULL, "FrontIn"}, -+ -+ {"LINPUT2", NULL, "RearIn"}, -+ {"RINPUT2", NULL, "RearIn"}, -+ -+ {"Front", NULL, "LOUT1"}, -+ {"Front", NULL, "ROUT1"}, -+ -+ {"Rear", NULL, "LOUT2"}, -+ {"Rear", NULL, "ROUT2"}, -+}; -+ -+static int pmdk_es8388_init(struct snd_soc_pcm_runtime *rtd) -+{ -+ int ret; -+ -+ /* Jack detection API stuff */ -+ ret = snd_soc_card_jack_new(rtd->card, "Headset Jack", SND_JACK_HEADSET, -+ &hs_jack, hs_jack_pins, -+ ARRAY_SIZE(hs_jack_pins)); -+ if (ret) -+ goto err; -+ -+ ret = snd_soc_jack_add_gpios(&hs_jack, ARRAY_SIZE(hs_jack_gpios), -+ hs_jack_gpios); -+ if (ret) -+ goto err; -+ -+ return 0; -+ -+err: -+ return ret; -+} -+ -+#define PMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ -+ SND_SOC_DAIFMT_CBS_CFS) -+ -+SND_SOC_DAILINK_DEFS(pmdk_es8388, -+ DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-lsd")), -+ DAILINK_COMP_ARRAY(COMP_CODEC("i2c-ESSX8388:00", "es8388-hifi")), -+ DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); -+ -+static struct snd_soc_dai_link pmdk_dai[] = { -+ { -+ .name = "ES8388 HIFI", -+ .stream_name = "ES8388 HIFI", -+ .dai_fmt = PMDK_DAI_FMT, -+ .init = pmdk_es8388_init, -+ SND_SOC_DAILINK_REG(pmdk_es8388), -+ }, -+}; -+ -+static struct snd_soc_card pmdk = { -+ .name = "PMDK-I2S", -+ .owner = THIS_MODULE, -+ .dai_link = pmdk_dai, -+ .num_links = ARRAY_SIZE(pmdk_dai), ++#include "hda_controller.h" + -+ .dapm_widgets = pmdk_es8388_dapm_widgets, -+ .num_dapm_widgets = ARRAY_SIZE(pmdk_es8388_dapm_widgets), -+ .controls = pmdk_controls, -+ .num_controls = ARRAY_SIZE(pmdk_controls), -+ .dapm_routes = pmdk_es8388_audio_map, -+ .num_dapm_routes = ARRAY_SIZE(pmdk_es8388_audio_map), -+}; ++struct hda_ft { ++ struct azx chip; ++ struct snd_pcm_substream *substream; ++ struct device *dev; ++ void __iomem *regs; + -+static int pmdk_sound_probe(struct platform_device *pdev) -+{ -+ struct snd_soc_card *card = &pmdk; -+ struct device *dev = &pdev->dev; -+ int n; ++ /* for pending irqs */ ++ struct work_struct irq_pending_work; + -+ card->dev = dev; -+ hs_jack_gpios[0].gpiod_dev = dev; -+ n = gpiod_count(dev, "det"); ++ /* sync probing */ ++ struct completion probe_wait; ++ struct work_struct probe_work; + -+ if (n < 0) -+ pmdk_dai[0].init = NULL; ++ /* card list (for power_save trigger) */ ++ struct list_head list; + -+ return devm_snd_soc_register_card(&pdev->dev, card); -+} ++ /* extra flags */ ++ unsigned int irq_pending_warned:1; ++ unsigned int probe_continued:1; + -+static const struct acpi_device_id pmdk_sound_acpi_match[] = { -+ { "PHYT8004", 0}, -+ { } +}; -+MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); + -+static struct platform_driver pmdk_sound_driver = { -+ .probe = pmdk_sound_probe, -+ .driver = { -+ .name = "pmdk_es8388", -+ .acpi_match_table = pmdk_sound_acpi_match, -+#ifdef CONFIG_PM -+ .pm = &snd_soc_pm_ops, +#endif -+ }, -+}; -+ -+module_platform_driver(pmdk_sound_driver); -+ -+MODULE_AUTHOR("Zhang Yiqun"); -+MODULE_DESCRIPTION("ALSA SoC PMDK ES8388"); -+MODULE_LICENSE("GPL"); diff --git a/device_board_phytium/common/kernel_source/linux-5.10/phytium_standard_defconfig b/device_board_phytium/common/kernel_source/linux-5.10/phytium_standard_defconfig index cc114bb9112ad5e154afaaba6a1b7b0d6fe6f43f..eec50eb983e8f0e5082417fd0583e52c0147d3ac 100644 --- a/device_board_phytium/common/kernel_source/linux-5.10/phytium_standard_defconfig +++ b/device_board_phytium/common/kernel_source/linux-5.10/phytium_standard_defconfig @@ -316,9 +316,11 @@ CONFIG_MWIFIEX=m CONFIG_MWIFIEX_PCIE=m CONFIG_WL18XX=m CONFIG_WLCORE_SDIO=m -CONFIG_RTW88=y -CONFIG_RTW88_8821CS=y +#CONFIG_RTW88 is not set +#CONFIG_RTW88_8821CS is not set #CONFIG_RTL8821CS is not set +CONFIG_PHYTIUM_RTW88=y +CONFIG_PHYTIUM_RTW88_8821CS=y CONFIG_INPUT_EVDEV=y CONFIG_KEYBOARD_ADC=m CONFIG_KEYBOARD_GPIO=y @@ -659,7 +661,8 @@ CONFIG_ARM_MHU=y CONFIG_PLATFORM_MHU=y CONFIG_PHYTIUM_MBOX=y CONFIG_ARM_SMMU=y -# CONFIG_ARM_SMMU_V3 is not set +CONFIG_ARM_SMMU_DISABLE_BYPASS_BY_DEFAULT=y +CONFIG_ARM_SMMU_V3=y CONFIG_REMOTEPROC=y CONFIG_REMOTEPROC_CDEV=y CONFIG_HOMO_REMOTEPROC=y @@ -804,3 +807,5 @@ CONFIG_DRM_AMDGPU_CIK=y CONFIG_DRM_AMDGPU_USERPTR=y CONFIG_DRM_AMDGPU_GART_DEBUGFS=y CONFIG_DRM_MWV207=y + +CONFIG_OHOS_VENDOR=y diff --git a/device_board_phytium/common/kernel_source/linux-6.6/phytium.patch b/device_board_phytium/common/kernel_source/linux-6.6/phytium.patch index 0083ac82acb8836540af94375cc68e694cad5c64..1ba982532702f92bfc91f7fd72e3d9d4ab213eb4 100644 --- a/device_board_phytium/common/kernel_source/linux-6.6/phytium.patch +++ b/device_board_phytium/common/kernel_source/linux-6.6/phytium.patch @@ -2332,100280 +2332,10609 @@ index 30dd6347a..b7af3d263 100644 subdir-y += qcom subdir-y += realtek subdir-y += renesas -diff --git a/arch/arm64/boot/dts/phytium/Makefile b/arch/arm64/boot/dts/phytium/Makefile -new file mode 100644 -index 000000000..ad0867f8c ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/Makefile -@@ -0,0 +1,27 @@ -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-demo-ddr4.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-demo-ddr4-local.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2202-demo-ddr4.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2202-demo-ddr4-local.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2201-demo-ddr4.dtb -+ -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-miniitx-board.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2202-miniitx-board.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-vpx-board.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-edu-board.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-come-board.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2202-power-board.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-hanwei-board.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += phytiumpi_firefly.dtb -+dtb-$(CONFIG_ARCH_PHYTIUM) += pe2202-chillipi-edu-board.dtb -+ -+always := $(dtb-y) -+subdir-y := $(dts-dirs) -+clean-files := *.dtb -+ -+#Enable support for device-tree overlay -+DTC_FLAGS_pe2204-come-board += -@ -+DTC_FLAGS_pe2204-demo-ddr4 += -@ -+DTC_FLAGS_pe2204-edu-board += -@ -+DTC_FLAGS_pe2204-hanwei-board += -@ -+DTC_FLAGS_pe2204-miniitx-board += -@ -+DTC_FLAGS_pe2204-vpx-board += -@ -diff --git a/arch/arm64/boot/dts/phytium/pe2201-demo-ddr4.dts b/arch/arm64/boot/dts/phytium/pe2201-demo-ddr4.dts -new file mode 100644 -index 000000000..7e8e51fc4 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2201-demo-ddr4.dts -@@ -0,0 +1,82 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2201 demo board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2201.dtsi" -+ -+/{ -+ model = "Pe2201 DEMO DDR4"; -+ compatible = "phytium,pe2201"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0 { -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x0 0x80000000>; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ }; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&usb2_2 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&spi2 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&mmc0 { -+ status = "okay"; -+}; -+ -+&mmc1 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2201.dtsi b/arch/arm64/boot/dts/phytium/pe2201.dtsi -new file mode 100644 -index 000000000..82512bcb9 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2201.dtsi -@@ -0,0 +1,284 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * dts file for Phytium Pe2201 SoC -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include "pe220x.dtsi" -+ -+/ { -+ compatible = "phytium,pe2201"; -+ -+ aliases { -+ ethernet0 = &macb0; -+ ethernet1 = &macb1; -+ }; -+}; -+ -+&cpu { -+ cpu0: cpu@0 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc310", "arm,armv8"; -+ reg = <0x0 0x200>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 2>; -+ }; -+}; -+ -+&soc { -+ i2c0: i2c@28011000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28011000 0x0 0x1000>; -+ interrupts = ; -+ interrupt-names = "smbus_alert"; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ i2c1: i2c@28012000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28012000 0x0 0x1000>; -+ interrupts = ; -+ interrupt-names = "smbus_alert"; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ i2c2: i2c@28013000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28013000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ onewire0: onewire@2803f000 { -+ compatible = "phytium,w1"; -+ reg = <0x0 0x2803f000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ i3c0: i3c-master@28045000 { -+ compatible = "phytium,cdns-i3c-master"; -+ reg = <0x0 0x28045000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz>, <&sysclk_100mhz>; -+ clock-names = "pclk", "sysclk"; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ i2c-scl-hz = <400000>; -+ i3c-scl-hz = <1000000>; -+ status = "disabled"; -+ }; -+ -+ i3c1: i3c-master@28046000 { -+ compatible = "phytium,cdns-i3c-master"; -+ reg = <0x0 0x28046000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz>, <&sysclk_100mhz>; -+ clock-names = "pclk", "sysclk"; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ i2c-scl-hz = <400000>; -+ i3c-scl-hz = <1000000>; -+ status = "disabled"; -+ }; -+ -+ i3c2: i3c-master@28047000 { -+ compatible = "phytium,cdns-i3c-master"; -+ reg = <0x0 0x28047000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz>, <&sysclk_100mhz>; -+ clock-names = "pclk", "sysclk"; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ i2c-scl-hz = <400000>; -+ i3c-scl-hz = <1000000>; -+ status = "disabled"; -+ }; -+ -+ i3c3: i3c-master@28048000 { -+ compatible = "phytium,cdns-i3c-master"; -+ reg = <0x0 0x28048000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz>, <&sysclk_100mhz>; -+ clock-names = "pclk", "sysclk"; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ i2c-scl-hz = <400000>; -+ i3c-scl-hz = <1000000>; -+ status = "disabled"; -+ }; -+ -+ pwm2: pwm@2804c000 { -+ compatible = "phytium,pwm"; -+ reg = <0x0 0x2804c000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ pwm3: pwm@2804d000 { -+ compatible = "phytium,pwm"; -+ reg = <0x0 0x2804d000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ pwm4: pwm@2804e000 { -+ compatible = "phytium,pwm"; -+ reg = <0x0 0x2804e000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ pwm5: pwm@2804f000 { -+ compatible = "phytium,pwm"; -+ reg = <0x0 0x2804f000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ pwm6: pwm@28050000 { -+ compatible = "phytium,pwm"; -+ reg = <0x0 0x28050000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ pwm7: pwm@28051000 { -+ compatible = "phytium,pwm"; -+ reg = <0x0 0x28051000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ adc0: adc@2807b000 { -+ compatible = "phytium,adc"; -+ reg = <0x0 0x2807b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ -+ #address-cells = <1>; -+ #size-cells = <0>; -+ -+ channel@0 { -+ reg = <0>; -+ }; -+ channel@1 { -+ reg = <1>; -+ }; -+ channel@2 { -+ reg = <2>; -+ }; -+ channel@3 { -+ reg = <3>; -+ }; -+ channel@4 { -+ reg = <4>; -+ }; -+ channel@5 { -+ reg = <5>; -+ }; -+ channel@6 { -+ reg = <6>; -+ }; -+ channel@7 { -+ reg = <7>; -+ }; -+ }; -+ -+ adc1: adc@2807c000 { -+ compatible = "phytium,adc"; -+ reg = <0x0 0x2807c000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ -+ #address-cells = <1>; -+ #size-cells = <0>; -+ -+ channel@0 { -+ reg = <0>; -+ }; -+ channel@1 { -+ reg = <1>; -+ }; -+ channel@2 { -+ reg = <2>; -+ }; -+ channel@3 { -+ reg = <3>; -+ }; -+ channel@4 { -+ reg = <4>; -+ }; -+ channel@5 { -+ reg = <5>; -+ }; -+ channel@6 { -+ reg = <6>; -+ }; -+ channel@7 { -+ reg = <7>; -+ }; -+ }; -+ -+ sgpio: sgpio@2807d000 { -+ compatible = "phytium,sgpio"; -+ reg = <0x0 0x2807d000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ ngpios = <96>; -+ bus-frequency = <48000>; -+ gpio-controller; -+ #gpio-cells = <2>; -+ status = "disabled"; -+ }; -+ -+ macb0: ethernet@32010000 { -+ compatible = "cdns,phytium-gem"; -+ reg = <0x0 0x32010000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ macb1: ethernet@32012000 { -+ compatible = "cdns,phytium-gem"; -+ reg = <0x0 0x32012000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ jpeg0: jpeg@32b32000 { -+ compatible = "phytium,jpeg"; -+ reg = <0x0 0x32b32000 0 0x1000>, -+ <0x0 0x28072000 0 0x30>, -+ <0x0 0x28073000 0 0x30>; -+ interrupts = , -+ , -+ ; -+ phytium,ocm-buf-addr = <0x30c40000 0x30c60000>; -+ status = "disabled"; -+ }; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2202-chillipi-edu-board.dts b/arch/arm64/boot/dts/phytium/pe2202-chillipi-edu-board.dts -new file mode 100644 -index 000000000..e358e7c23 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2202-chillipi-edu-board.dts -@@ -0,0 +1,339 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2202 chillipi education board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * -+ * 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. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2202.dtsi" -+#include "dt-bindings/gpio/gpio.h" -+ -+ -+/{ -+ model = "Pe2202 CHILLIPI EDUCATION BOARD"; -+ compatible = "phytium,pe2202"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x0 0x80000000>; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,pin-switches = "mic-in"; -+ simple-audio-card,widgets = "Microphone","mic-in"; -+ simple-audio-card,routing = "MIC2","mic-in"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec{ -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio6: i2c@28020000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28020000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ oled@3c { -+ compatible = "SinoWealth,sh1106"; -+ reg = <0x3c>; -+ }; -+ -+ pcf8591@48 { -+ compatible = "philips,pcf8591"; -+ reg = <0x48>; -+ }; -+ }; -+ -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ /* localized chillipi education board use this rtc device */ -+ rtc@32 { -+ compatible = "wave,sd3068"; -+ reg = <0x32>; -+ status = "disabled"; -+ }; -+ -+ rtc@68 { -+ compatible = "dallas,ds1339"; -+ reg = <0x68>; -+ status = "disabled"; -+ }; -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ codec0: es8336@10 { -+ det-gpios = <&gpio2 5 GPIO_ACTIVE_LOW>; -+ sel-gpios = <&gpio2 11 GPIO_ACTIVE_LOW>; -+ #sound-dai-cells = <0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ status = "disabled"; -+ }; -+ }; -+}; -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ interrupt-controller; -+ #interrupt-cells = <2>; -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&watchdog0 { -+ status = "okay"; -+}; -+ -+&watchdog1 { -+ status = "okay"; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "host"; -+ status = "disabled"; -+}; -+ -+&usb2_2 { -+ dr_mode = "host"; -+ status = "disabled"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+/* -+ * In chillipi education board, M.2 interface may insert two types of disks: PCIE (nvme protocol) or SATA (ahci protocol), -+ * so here enable 'sata0' node by default to correspond to the sata drive case. Pin multiplexing exists -+ * in PCIE2 and SATA0, when used as a boot disk, the BIOS can automatically recognize these two conditions. -+ */ -+&sata0 { -+ status = "disabled"; -+}; -+ -+&sata1 { -+ status = "disabled"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "okay"; -+ -+ ILI9488@0 { -+ compatible = "ilitek,ili9488"; -+ reg = <0>; -+ spi-max-frequency = <50000000>; -+ -+ rotate = <0>; -+ fps = <30>; -+ buswidth = <8>; -+ regwidth = <8>; -+ bgr; -+ reset-gpios = <&gpio0 15 GPIO_ACTIVE_LOW>; -+ dc-gpios = <&gpio3 2 GPIO_ACTIVE_LOW>; -+ //cs-gpios = <&gpio3 2 GPIO_ACTIVE_LOW>; -+ -+ //backlight = <&backlight>; -+ debug = <0>; -+ }; -+ -+ ADS7843@1 { -+ compatible = "ti,ads7843"; -+ spi-max-frequency = <1000000>; -+ reg = <1>; -+ //cs-gpios = <&gpio4 10 GPIO_ACTIVE_LOW>; -+ interrupt-parent = <&gpio4>; -+ interrupts = <12 0>; -+ pendown-gpio = <&gpio4 12 0>; -+ -+ ti,x-min = /bits/ 16 <0>; -+ //ti,x-max = /bits/ 16 <8000>; -+ ti,x-max = /bits/ 16 <3200>; -+ ti,y-min = /bits/ 16 <0>; -+ //ti,y-max = /bits/ 16 <4800>; -+ ti,y-max = /bits/ 16 <4800>; -+ ti,x-plate-ohms = /bits/ 16 <40>; -+ ti,pressure-max = /bits/ 16 <255>; -+ -+ wakeup-source; -+ }; -+}; -+ -+&spi2 { -+ global-cs = <1>; -+ status = "okay"; -+ -+ mpu6500@0 { -+ compatible = "InvenSense,mpu6500"; -+ spi-max-frequency = <500000>; -+ reg = <0>; -+ spi-cpol; -+ spi-cpha; -+ }; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000008>; -+ max-frequency = <100000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ mmc-hs200-1_8v; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-sdio; -+ no-mmc; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ status = "okay"; -+}; -+ -+&dc0 { -+ pipe_mask = /bits/ 8 <0x2>; -+ edp_mask = /bits/ 8 <0x0>; -+ status = "okay"; -+}; -+ -+&i2s_dp1 { -+ status = "okay"; -+}; -+ -+&pmdk_dp { -+ num-dp = <1>; -+ dp-mask = /bits/ 8 <0x2>; -+ status = "okay"; -+}; -+ -+&rng0 { -+ status = "okay"; -+}; -+ -+&pwm0 { -+ phytium,db = <0 0 0 1000 1000 0>; -+ status = "okay"; -+}; -+ -+&pwm1 { -+ phytium,db = <0 0 0 1000 1000 0>; -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2202-demo-ddr4-local.dts b/arch/arm64/boot/dts/phytium/pe2202-demo-ddr4-local.dts -new file mode 100644 -index 000000000..0684e91f7 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2202-demo-ddr4-local.dts -@@ -0,0 +1,167 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2202 demo board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2202.dtsi" -+ -+/{ -+ model = "Pe2202 DEMO LOCAL DDR4"; -+ compatible = "phytium,pe2202"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0 { -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x0 0x80000000>; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,pin-switches = "mic-in"; -+ simple-audio-card,widgets = "Microphone", "mic-in"; -+ simple-audio-card,routing = "MIC2", "mic-in"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec { -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ rtc@32 { -+ compatible = "wave,sd3078"; -+ reg = <0x32>; -+ }; -+ -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ #sound-dai-cells = <0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ }; -+ }; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&usb2_2 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&spi2 { -+ dmas = <&ddma0 0 8>, -+ <&ddma0 1 21>; -+ dma-names = "tx", "rx"; -+ status = "okay"; -+}; -+ -+&uart1 { -+ dmas = <&ddma0 2 3>; -+ dma-names = "tx"; -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000008>; -+ max-frequency = <50000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ sd-uhs-sdr25; -+ no-mmc; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ status = "okay"; -+}; -+ -+&dc0 { -+ pipe_mask = /bits/ 8 <0x2>; -+ edp_mask = /bits/ 8 <0x0>; -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2202-demo-ddr4.dts b/arch/arm64/boot/dts/phytium/pe2202-demo-ddr4.dts -new file mode 100644 -index 000000000..f9dacea11 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2202-demo-ddr4.dts -@@ -0,0 +1,232 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2202 demo board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2202.dtsi" -+#include "dt-bindings/gpio/gpio.h" -+ -+/{ -+ model = "Pe2202 DEMO DDR4"; -+ compatible = "phytium,pe2202"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0 { -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x0 0x80000000>; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,pin-switches = "mic-in"; -+ simple-audio-card,widgets = "Microphone", "mic-in"; -+ simple-audio-card,routing = "MIC2", "mic-in"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec { -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ rtc@68 { -+ compatible = "dallas,ds1339"; -+ reg = <0x68>; -+ }; -+ -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ det-gpios = <&gpio2 5 GPIO_ACTIVE_LOW>; -+ sel-gpios = <&gpio2 11 GPIO_ACTIVE_LOW>; -+ #sound-dai-cells = <0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ }; -+ }; -+}; -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&watchdog0 { -+ status = "okay"; -+}; -+ -+&watchdog1 { -+ status = "okay"; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&usb2_2 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+/* -+ * In demo board, M.2 interface may insert two types of disks: PCIE (nvme protocol) or SATA (ahci protocol), -+ * so here enable 'sata0' node by default to correspond to the sata drive case. Pin multiplexing exists -+ * in PCIE2 and SATA0, when used as a boot disk, the BIOS can automatically recognize these two conditions. -+ */ -+&sata0 { -+ status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi2 { -+ dmas = <&ddma0 0 8>, -+ <&ddma0 1 21>; -+ dma-names = "tx", "rx"; -+ global-cs = <1>; -+ status = "okay"; -+}; -+ -+&uart1 { -+ dmas = <&ddma0 2 3>; -+ dma-names = "tx"; -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000008>; -+ max-frequency = <100000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ mmc-hs200-1_8v; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-sdio; -+ no-mmc; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ status = "okay"; -+}; -+ -+&dc0 { -+ pipe_mask = /bits/ 8 <0x2>; -+ edp_mask = /bits/ 8 <0x0>; -+ status = "okay"; -+}; -+ -+&i2s_dp1 { -+ status = "okay"; -+}; -+ -+&pmdk_dp { -+ num-dp = <1>; -+ dp-mask = /bits/ 8 <0x2>; -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2202-miniitx-board.dts b/arch/arm64/boot/dts/phytium/pe2202-miniitx-board.dts -new file mode 100644 -index 000000000..7d06f07cc ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2202-miniitx-board.dts -@@ -0,0 +1,296 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2202 miniitx board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * -+ * Hongmin Qi -+ * -+ * 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. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2202.dtsi" -+ -+/{ -+ model = "Pe2202 MINIITX Board"; -+ compatible = "phytium,pe2202"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x1 0x00000000>; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec { -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio0: uart@28014000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28014000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "disabled"; -+ }; -+ -+ mio1: uart@28016000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28016000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "disabled"; -+ }; -+ -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ rtc@68 { -+ compatible = "dallas,ds1339"; -+ reg = <0x68>; -+ }; -+ }; -+ -+ mio6: uart@28020000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28020000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio7: uart@28022000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28022000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ det-gpios = <&gpio2 5 0>; -+ sel-gpios = <&gpio2 6 0>; -+ #sound-dai-cells = <0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ mic-src = [20]; -+ }; -+ }; -+ -+ mio15: uart@28032000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28032000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "otg"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "host"; -+ status = "disabled"; -+}; -+ -+&usb2_2 { -+ dr_mode = "host"; -+ status = "disabled"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb1 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "disabled"; -+}; -+ -+&macb2 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb3 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "disabled"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "disabled"; -+ -+ flash: w25q128@0 { -+ compatible = "winbond,w25q128", "jedec,spi-nor"; -+ spi-tx-bus-width = <1>; -+ spi-rx-bus-width = <1>; -+ spi-max-frequency = <12000000>; -+ reg = <0x00>; -+ status = "disabled"; -+ }; -+}; -+ -+&spi2 { -+ global-cs = <1>; -+ status = "disabled"; -+}; -+ -+&spi3 { -+ global-cs = <1>; -+ status = "disabled"; -+}; -+ -+&mmc0 { -+ status = "okay"; -+ bus-width = <0x4>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-mmc; -+}; -+ -+&mmc1 { -+ status = "okay"; -+}; -+ -+&uart0 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&uart3 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&sata0 { -+ status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&dc0 { -+ status = "okay"; -+ pipe_mask = [02]; -+ edp_mask = [00]; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ dai-name = "phytium-i2s-lsd"; -+ status = "okay"; -+}; -+ -+&pwm1 { -+ phytium,db = <0 0 0 1000 1000 0>; -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2202-power-board.dts b/arch/arm64/boot/dts/phytium/pe2202-power-board.dts -new file mode 100644 -index 000000000..b0294d02d ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2202-power-board.dts -@@ -0,0 +1,243 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2202 power board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * -+ * Hongmin Qi -+ * -+ * 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. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2202.dtsi" -+ -+/{ -+ model = "Pe2202S power Board"; -+ compatible = "phytium,pe2202"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x1 0x00000000>; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = <0x0 0x65 0x4>; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <0x1>; -+ #size-cells = <0x0>; -+ status = "okay"; -+ -+ rtc@68 { -+ compatible = "dallas,ds1339"; -+ reg = <0x68>; -+ }; -+ }; -+ -+ mio6: i2c@28020000 { -+ status = "okay"; -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28020000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <0x1>; -+ #size-cells = <0x0>; -+ eeprom@50 { -+ compatible = "atmel,24c02"; -+ reg = <0x50>; -+ pagesize = <1>; -+ }; -+ }; -+ -+ mio10: uart@28028000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28028000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio11: uart@2802a000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x2802a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio13: uart@2802e000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x2802e000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio14: uart@28030000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio15: uart@28032000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28032000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "otg"; -+ status = "okay"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb1 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb2 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb3 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "disabled"; -+}; -+ -+&dc0 { -+ pipe_mask = [02]; -+ edp_mask = [00]; -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "disabled"; -+}; -+ -+&mmc0 { -+ bus-width = <8>; -+ max-frequency = <50000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ status = "okay"; -+}; -+ -+&uart0 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&uart3 { -+ status = "okay"; -+}; -+ -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2202.dtsi b/arch/arm64/boot/dts/phytium/pe2202.dtsi -new file mode 100644 -index 000000000..7ece269cf ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2202.dtsi -@@ -0,0 +1,235 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * dts file for Phytium Pe2202 SoC -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include "pe220x.dtsi" -+#include -+ -+/ { -+ compatible = "phytium,pe2202"; -+ -+ aliases { -+ ethernet0 = &macb0; -+ ethernet1 = &macb1; -+ ethernet2 = &macb2; -+ ethernet3 = &macb3; -+ }; -+}; -+ -+&thermal_zones { -+ sensor0 { -+ trips { -+ threshod: trip-point@0 { -+ temperature = <75000>; -+ hysteresis = <0>; -+ type = "passive"; -+ }; -+ target: trip-point@1 { -+ temperature = <90000>; -+ hysteresis = <0>; -+ type = "passive"; -+ }; -+ cpu_crit: cpu_crit { -+ temperature = <100000>; -+ hysteresis = <2000>; -+ type = "critical"; -+ }; -+ }; -+ cooling-maps { -+ map0 { -+ trip = <&target>; -+ cooling-device = <&cpu_l0 THERMAL_NO_LIMIT THERMAL_NO_LIMIT>; -+ }; -+ }; -+ }; -+ -+ sensor1 { -+ trips { -+ threshod1: trip-point@0 { -+ temperature = <75000>; -+ hysteresis = <0>; -+ type = "passive"; -+ }; -+ target1: trip-point@1 { -+ temperature = <90000>; -+ hysteresis = <0>; -+ type = "passive"; -+ }; -+ cpu_crit1: cpu_crit { -+ temperature = <100000>; -+ hysteresis = <2000>; -+ type = "critical"; -+ }; -+ }; -+ }; -+}; -+ -+&cpu { -+ cpu-map { -+ cluster0 { -+ core0 { -+ cpu = <&cpu_l0>; -+ }; -+ -+ core1 { -+ cpu = <&cpu_l1>; -+ }; -+ }; -+ }; -+ -+ cpu_l0: cpu@0 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc310", "arm,armv8"; -+ reg = <0x0 0x200>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 2>; -+ #cooling-cells = <2>; -+ dynamic-power-coefficient = <100>; -+ }; -+ -+ cpu_l1: cpu@1 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc310", "arm,armv8"; -+ reg = <0x0 0x201>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 2>; -+ }; -+}; -+ -+&soc { -+ hda0: hda@28006000 { -+ compatible = "phytium,hda"; -+ reg = <0x0 0x28006000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ i2s0: i2s@28009000 { -+ compatible = "phytium,i2s"; -+ reg = <0x0 0x28009000 0x0 0x1000>, -+ <0x0 0x28005000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_600mhz>; -+ clock-names = "i2s_clk"; -+ status = "disabled"; -+ }; -+ -+ can0: can@2800a000 { -+ compatible = "phytium,canfd"; -+ reg = <0x0 0x2800a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_200mhz>; -+ clock-names = "can_clk"; -+ tx-fifo-depth = <64>; -+ rx-fifo-depth = <64>; -+ status = "disabled"; -+ }; -+ -+ can1: can@2800b000 { -+ compatible = "phytium,canfd"; -+ reg = <0x0 0x2800b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_200mhz>; -+ clock-names = "can_clk"; -+ tx-fifo-depth = <64>; -+ rx-fifo-depth = <64>; -+ status = "disabled"; -+ }; -+ -+ keypad: keypad@2807a000 { -+ compatible = "phytium,keypad"; -+ reg = <0x0 0x2807a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ usb3_0: usb3@31a08000 { -+ compatible = "phytium,pe220x-xhci"; -+ reg = <0x0 0x31a08000 0x0 0x18000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb3_1: usb3@31a28000 { -+ compatible = "phytium,pe220x-xhci"; -+ reg = <0x0 0x31a28000 0x0 0x18000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ sata0: sata@31a40000 { -+ compatible = "generic-ahci"; -+ reg = <0x0 0x31a40000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ sata1: sata@32014000 { -+ compatible = "generic-ahci"; -+ reg = <0x0 0x32014000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ macb0: ethernet@3200c000 { -+ compatible = "cdns,phytium-gem"; -+ reg = <0x0 0x3200c000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ , -+ , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ macb1: ethernet@3200e000 { -+ compatible = "cdns,phytium-gem"; -+ reg = <0x0 0x3200e000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ macb2: ethernet@32010000 { -+ compatible = "cdns,phytium-gem"; -+ reg = <0x0 0x32010000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ use-mii; -+ status = "disabled"; -+ }; -+ -+ macb3: ethernet@32012000 { -+ compatible = "cdns,phytium-gem"; -+ reg = <0x0 0x32012000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ use-mii; -+ status = "disabled"; -+ }; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2204-come-board.dts b/arch/arm64/boot/dts/phytium/pe2204-come-board.dts -new file mode 100644 -index 000000000..e87b26078 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2204-come-board.dts -@@ -0,0 +1,268 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2204 come board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * -+ * Hongmin Qi -+ * -+ * 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. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+ -+/{ -+ model = "Pe2204 come Board"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x2 0x00000000>; -+ }; -+}; -+ -+&soc { -+ mio3: i2c@2801a000 { -+ status = "okay"; -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x2801a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ -+ eeprom@50 { -+ compatible = "atmel,24c02"; -+ reg = <0x50>; -+ pagesize = <1>; -+ }; -+ }; -+ -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ rtc@32 { -+ compatible = "wave,sd3068"; -+ reg = <0x32>; -+ }; -+ }; -+ -+ mio6: uart@28020000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28020000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio10: uart@28028000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28028000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio14: uart@28030000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio15: uart@28032000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28032000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "otg"; -+ status = "okay"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb1 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "disabled"; -+}; -+ -+&macb2 { -+ phy-mode = "rgmii"; -+ use-mii; -+ status = "disabled"; -+}; -+ -+&macb3 { -+ phy-mode = "rgmii"; -+ use-mii; -+ status = "disabled"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "disabled"; -+}; -+ -+&spi2 { -+ global-cs = <1>; -+ status = "okay"; -+ -+ flash: w25q128@0 { -+ compatible = "winbond,w25q128", "jedec,spi-nor"; -+ spi-tx-bus-width = <1>; -+ spi-rx-bus-width = <1>; -+ spi-max-frequency = <12000000>; -+ reg = <0x00>; -+ }; -+}; -+ -+&mmc0 { -+ bus-width = <4>; -+ max-frequency = <25000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ status = "okay"; -+}; -+ -+&uart0 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&uart3 { -+ status = "okay"; -+}; -+ -+&sata0 { -+ status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&hda0 { -+ status = "okay"; -+}; -+ -+&dc0 { -+ status = "okay"; -+ pipe_mask = [03]; -+ edp_mask = [00]; -+}; -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&pwm1 { -+ phytium,db = <0 0 0 1000 1000 0>; -+ status = "okay"; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2204-demo-ddr4-local.dts b/arch/arm64/boot/dts/phytium/pe2204-demo-ddr4-local.dts -new file mode 100644 -index 000000000..402d07735 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2204-demo-ddr4-local.dts -@@ -0,0 +1,166 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2204 demo board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+ -+/{ -+ model = "Pe2204 DEMO LOCAL DDR4"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0 { -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x0 0x80000000>; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,pin-switches = "mic-in"; -+ simple-audio-card,widgets = "Microphone", "mic-in"; -+ simple-audio-card,routing = "MIC2", "mic-in"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec { -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ rtc@32 { -+ compatible = "wave,sd3078"; -+ reg = <0x32>; -+ }; -+ -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ #sound-dai-cells = <0x0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ }; -+ }; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&usb2_2 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&spi2 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000008>; -+ max-frequency = <50000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ sd-uhs-sdr25; -+ no-mmc; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ status = "okay"; -+}; -+ -+&dc0 { -+ pipe_mask = /bits/ 8 <0x3>; -+ edp_mask = /bits/ 8 <0x0>; -+ status = "okay"; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2204-demo-ddr4.dts b/arch/arm64/boot/dts/phytium/pe2204-demo-ddr4.dts -new file mode 100644 -index 000000000..c12eb5810 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2204-demo-ddr4.dts -@@ -0,0 +1,236 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2204 demo board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+#include "dt-bindings/gpio/gpio.h" -+ -+/{ -+ model = "Pe2204 DEMO DDR4"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0 { -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x0 0x80000000>; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,pin-switches = "mic-in"; -+ simple-audio-card,widgets = "Microphone", "mic-in"; -+ simple-audio-card,routing = "MIC2", "mic-in"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec { -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ rtc@68 { -+ compatible = "dallas,ds1339"; -+ reg = <0x68>; -+ }; -+ -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ det-gpios = <&gpio2 5 GPIO_ACTIVE_LOW>; -+ sel-gpios = <&gpio2 11 GPIO_ACTIVE_LOW>; -+ #sound-dai-cells = <0x0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ }; -+ }; -+}; -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&watchdog0 { -+ status = "okay"; -+}; -+ -+&watchdog1 { -+ status = "okay"; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&usb2_2 { -+ dr_mode = "peripheral"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+/* -+ * In demo board, M.2 interface may insert two types of disks: PCIE (nvme protocol) or SATA (ahci protocol), -+ * so here enable 'sata0' node by default to correspond to the sata drive case. Pin multiplexing exists -+ * in PCIE2 and SATA0, when used as a boot disk, the BIOS can automatically recognize these two conditions. -+ */ -+&sata0 { -+ status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi2 { -+ global-cs = <1>; -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000008>; -+ max-frequency = <100000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ mmc-hs200-1_8v; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-sdio; -+ no-mmc; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ dai-name = "phytium-i2s-lsd"; -+ status = "okay"; -+}; -+ -+&dc0 { -+ pipe_mask = /bits/ 8 <0x3>; -+ edp_mask = /bits/ 8 <0x0>; -+ status = "okay"; -+}; -+ -+&i2s_dp0 { -+ status = "okay"; -+}; -+ -+&i2s_dp1 { -+ status = "okay"; -+}; -+ -+&pmdk_dp { -+ num-dp = <2>; -+ dp-mask = /bits/ 8 <0x3>; -+ status = "okay"; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2204-edu-board.dts b/arch/arm64/boot/dts/phytium/pe2204-edu-board.dts -new file mode 100644 -index 000000000..7a47cbc37 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2204-edu-board.dts -@@ -0,0 +1,347 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2204 edu board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * -+ * Hongmin Qi -+ * -+ * 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. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+ -+/{ -+ model = "Pe2204 edu Board"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x2 0x00000000>; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec { -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <0x1>; -+ #size-cells = <0x0>; -+ status = "okay"; -+ -+ rtc@68 { -+ compatible = "dallas,ds1339"; -+ reg = <0x68>; -+ }; -+ }; -+ -+ mio8: i2c@28024000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28024000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <0x1>; -+ #size-cells = <0x0>; -+ status = "okay"; -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <0x1>; -+ #size-cells = <0x0>; -+ status = "okay"; -+ -+ codec0:es8336@10 { -+ det-gpios = <&gpio2 5 0>; -+ sel-gpios = <&gpio2 6 0>; -+ #sound-dai-cells = <0x0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ mic-src = [30]; -+ }; -+ }; -+ -+ mio0: uart@28014000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28014000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio1: uart@28016000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28016000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio11: uart@2802A000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x2802a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio15: uart@28032000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28032000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ //status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "otg"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "host"; -+ //status = "okay"; -+}; -+ -+&usb2_2 { -+ dr_mode = "host"; -+ //status = "okay"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ //status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ //status = "okay"; -+}; -+ -+&macb1 { -+ phy-mode = "sgmii"; -+ use-mii; -+ //status = "okay"; -+}; -+ -+&macb2 { -+ phy-mode = "sgmii"; -+ use-mii; -+ //status = "okay"; -+}; -+ -+&macb3 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "okay"; -+ -+ flash: w25q128@0 { -+ compatible = "jedec,spi-nor"; -+ spi-tx-bus-width = <1>; -+ spi-rx-bus-width = <1>; -+ spi-max-frequency = <12000000>; -+ reg = <0x00>; -+ status = "okay"; -+ }; -+}; -+ -+&mmc0 { -+ bus-width = <0x8>; -+ max-frequency = <50000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x4>; -+ max-frequency = <25000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ status = "okay"; -+}; -+ -+&uart0 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&uart3 { -+ status = "okay"; -+}; -+ -+&sata0 { -+ //status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&dc0 { -+ status = "okay"; -+ pipe_mask = [01]; -+ edp_mask = [00]; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ dai-name = "phytium-i2s-lsd"; -+ status = "okay"; -+}; -+ -+&i2s_dp0 { -+ status = "okay"; -+}; -+ -+&pmdk_dp { -+ num-dp = <1>; -+ dp-mask = /bits/ 8 <0x1>; -+ status = "okay"; -+}; -+ -+&pwm0 { -+ phytium,db = <0 0 0 0 0 0>; -+ status = "okay"; -+}; -+ -+&pwm1 { -+ phytium,db = <0 0 0 0 0 0>; -+ status = "okay"; -+}; -+ -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&keypad { -+ keypad,num-rows = <4>; -+ keypad,num-columns = <4>; -+ linux,keymap = <0x00000011 -+ 0x00010012 -+ 0x00020013 -+ 0x00030014 -+ 0x01000021 /*KEY_21*/ -+ 0x01010022 /*KEY_22*/ -+ 0x01020023 /*KEY_23*/ -+ 0x01030024 /*KEY_24*/ -+ 0x02000031 /*KEY_31*/ -+ 0x02010032 /*KEY_32*/ -+ 0x02020033 /*KEY_33*/ -+ 0x02030034 /*KEY_34*/ -+ 0x03000041 /*KEY_41*/ -+ 0x03010042 /*KEY_42*/ -+ 0x03020043 /*KEY_43*/ -+ 0x03030044 /*KEY_44*/>; -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2204-hanwei-board.dts b/arch/arm64/boot/dts/phytium/pe2204-hanwei-board.dts -new file mode 100644 -index 000000000..d9e1eae59 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2204-hanwei-board.dts -@@ -0,0 +1,218 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2204 hanwei board -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * -+ * Hongmin Qi -+ * -+ * 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. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+ -+/{ -+ model = "Pe2204 hanwei Board"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x2 0x00000000>; -+ }; -+}; -+ -+&soc { -+ mio3: uart@2801a000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x2801a000 0x0 0x1000>; -+ interrupts = <0x0 0x5f 0x4>; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio8: uart@28024000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28024000 0x0 0x1000>; -+ interrupts = <0x0 0x64 0x4>; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio10: uart@28028000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28028000 0x0 0x1000>; -+ interrupts = <0x0 0x66 0x4>; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio14: uart@28030000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = <0x0 0x6a 0x4>; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio15: uart@28032000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x28032000 0x0 0x1000>; -+ interrupts = <0x0 0x6b 0x4>; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "otg"; -+ status = "okay"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb1 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb2 { -+ phy-mode = "rgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb3 { -+ phy-mode = "rgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "disabled"; -+}; -+ -+&mmc0 { -+ bus-width = <8>; -+ max-frequency = <25000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "disabled"; -+}; -+ -+&mmc1 { -+ status = "okay"; -+}; -+ -+&uart0 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&uart3 { -+ status = "okay"; -+}; -+ -+&sata0 { -+ status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2204-miniitx-board.dts b/arch/arm64/boot/dts/phytium/pe2204-miniitx-board.dts -new file mode 100644 -index 000000000..fe9288f6a ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2204-miniitx-board.dts -@@ -0,0 +1,343 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium miniITX-Pe2204 development board. -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * -+ * Shaojun Yang -+ * -+ * 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. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+ -+/{ -+ model = "miniITX-Pe2204 Board"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ aliases { -+ serial4 = &mio0; -+ serial5 = &mio1; -+ serial6 = &mio8; -+ serial7 = &mio11; -+ serial8 = &mio15; -+ }; -+ -+ memory@0{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x2 0x00000000>; -+ }; -+ -+ reserved-memory { -+ #address-cells = <2>; -+ #size-cells = <2>; -+ ranges; -+ -+ display_reserved: share@f4000000 { -+ no-map; -+ reg = <0x00 0xf4000000 0x0 0x4000000>; -+ }; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ -+ simple-audio-card,codec{ -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ rtc@68 { -+ compatible = "dallas,ds1339"; -+ reg = <0x68>; -+ }; -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ det-gpios = <&gpio2 5 0>; -+ sel-gpios = <&gpio2 6 0>; -+ #sound-dai-cells = <0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ mic-src = [20]; -+ }; -+ }; -+ -+ -+ mio0: uart@28014000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28014000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio1: uart@28016000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28016000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio8: uart@28024000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28024000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio11: uart@2802A000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2802A000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio15: uart@28032000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28032000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+}; -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&watchdog0 { -+ status = "okay"; -+}; -+ -+&watchdog1 { -+ status = "okay"; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "otg"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "peripheral"; -+ status = "disabled"; -+}; -+ -+&usb2_2 { -+ dr_mode = "peripheral"; -+ status = "disabled"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb2 { -+ phy-mode = "rgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&dc0 { -+ memory-region = <&display_reserved>; -+ pipe_mask = /bits/ 8 <0x3>; -+ edp_mask = /bits/ 8 <0x0>; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ dai-name = "phytium-i2s-lsd"; -+ status = "okay"; -+}; -+ -+&i2s_dp0 { -+ dai-name = "phytium-i2s-dp0"; -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "disabled"; -+ -+ flash: w25q128@0 { -+ compatible = "winbond,w25q128", "jedec,spi-nor"; -+ spi-tx-bus-width = <1>; -+ spi-rx-bus-width = <1>; -+ spi-max-frequency = <12000000>; -+ reg = <0x00>; -+ status = "disabled"; -+ }; -+}; -+ -+&spi1 { -+ global-cs = <1>; -+ status = "disabled"; -+}; -+ -+&spi2 { -+ global-cs = <1>; -+ status = "disabled"; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-mmc; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x00000008>; -+ max-frequency = <50000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "disabled"; -+}; -+ -+&pwm0 { -+ phytium,db = <0 0 0 1000 1000 0>; -+ status = "okay"; -+}; -+ -+&pwm1 { -+ phytium,db = <0 0 0 1000 1000 0>; -+ status = "okay"; -+}; -+ -+&uart0 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&uart3 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&rng0 { -+ status = "okay"; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2204-vpx-board.dts b/arch/arm64/boot/dts/phytium/pe2204-vpx-board.dts -new file mode 100644 -index 000000000..22c3c4395 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2204-vpx-board.dts -@@ -0,0 +1,325 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pe2204 vpx board. -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * -+ * Tianyu Liu -+ * -+ * 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. -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+ -+/{ -+ model = "Pe2204 vpx board"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ -+ memory@0{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x2 0x00000000>; -+ }; -+ aliases { -+ serial4 = &mio3; -+ serial5 = &mio8; -+ serial6 = &mio10; -+ serial7 = &mio11; -+ serial8 = &mio15; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec{ -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ rtc@68 { -+ compatible = "dallas,ds1339"; -+ reg = <0x68>; -+ }; -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ det-gpios = <&gpio2 5 0>; -+ sel-gpios = <&gpio2 6 0>; -+ #sound-dai-cells = <0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ mic-src = [30]; -+ }; -+ }; -+ -+ mio3: uart@2801A000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2801A000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio8: uart@28024000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28024000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio10: uart@28028000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28028000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio11: uart@2802A000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2802A000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio13: uart@2802E000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2802E000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio15: uart@28032000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28032000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+}; -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&sata0 { -+ status = "okay"; -+}; -+ -+&sata1 { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "otg"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "host"; -+ status = "disabled"; -+}; -+ -+&usb2_2 { -+ dr_mode = "host"; -+ status = "disabled"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb2 { -+ phy-mode = "rgmii"; -+ use-mii; -+ force-phy-mode; -+ status = "okay"; -+}; -+ -+&macb3 { -+ phy-mode = "rgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&dc0 { -+ pipe_mask = [03]; -+ edp_mask = [00]; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ dai-name = "phytium-i2s-lsd"; -+ status = "okay"; -+}; -+ -+&i2s_dp0 { -+ status = "okay"; -+}; -+ -+&i2s_dp1 { -+ status = "okay"; -+}; -+ -+&pmdk_dp { -+ num-dp = <2>; -+ dp-mask = /bits/ 8 <0x3>; -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "disabled"; -+ -+ flash: w25q128@0 { -+ compatible = "winbond,w25q128", "jedec,spi-nor"; -+ spi-tx-bus-width = <1>; -+ spi-rx-bus-width = <1>; -+ spi-max-frequency = <12000000>; -+ reg = <0x00>; -+ status = "disabled"; -+ }; -+}; -+ -+&spi2 { -+ global-cs = <1>; -+ status = "disabled"; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000008>; -+ max-frequency = <25000000>; -+ cap-mmc-hw-reset; -+ cap-mmc-highspeed; -+ no-sdio; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&uart0 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&uart3 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&rng0 { -+ status = "okay"; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe2204.dtsi b/arch/arm64/boot/dts/phytium/pe2204.dtsi -new file mode 100644 -index 000000000..5d8f2d6ff ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe2204.dtsi -@@ -0,0 +1,276 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * dts file for Phytium Pe2204 SoC -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include "pe220x.dtsi" -+#include -+ -+/ { -+ compatible = "phytium,pe2204"; -+ -+ aliases { -+ ethernet0 = &macb0; -+ ethernet1 = &macb1; -+ ethernet2 = &macb2; -+ ethernet3 = &macb3; -+ }; -+}; -+ -+&thermal_zones { -+ sensor0 { -+ trips { -+ threshod: trip-point@0 { -+ temperature = <75000>; -+ hysteresis = <0>; -+ type = "passive"; -+ }; -+ target: trip-point@1 { -+ temperature = <90000>; -+ hysteresis = <0>; -+ type = "passive"; -+ }; -+ cpu_crit: cpu_crit { -+ temperature = <100000>; -+ hysteresis = <2000>; -+ type = "critical"; -+ }; -+ }; -+ -+ cooling-maps { -+ map0 { -+ trip = <&target>; -+ cooling-device = -+ <&cpu_l0 THERMAL_NO_LIMIT THERMAL_NO_LIMIT>, -+ <&cpu_b0 THERMAL_NO_LIMIT THERMAL_NO_LIMIT>; -+ }; -+ }; -+ }; -+ -+ sensor1 { -+ trips { -+ threshod1: trip-point@0 { -+ temperature = <75000>; -+ hysteresis = <0>; -+ type = "passive"; -+ }; -+ target1: trip-point@1 { -+ temperature = <90000>; -+ hysteresis = <0>; -+ type = "passive"; -+ }; -+ cpu_crit1: cpu_crit { -+ temperature = <100000>; -+ hysteresis = <2000>; -+ type = "critical"; -+ }; -+ }; -+ }; -+}; -+ -+&cpu { -+ cpu-map { -+ cluster0 { -+ core0 { -+ cpu = <&cpu_l0>; -+ }; -+ -+ core1 { -+ cpu = <&cpu_l1>; -+ }; -+ }; -+ -+ cluster1 { -+ core0 { -+ cpu = <&cpu_b0>; -+ }; -+ }; -+ -+ cluster2 { -+ core0 { -+ cpu = <&cpu_b1>; -+ }; -+ }; -+ }; -+ -+ cpu_l0: cpu@0 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc310", "arm,armv8"; -+ reg = <0x0 0x200>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 2>; -+ #cooling-cells = <2>; -+ capacity-dmips-mhz = <2850>; -+ }; -+ -+ cpu_l1: cpu@1 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc310", "arm,armv8"; -+ reg = <0x0 0x201>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 2>; -+ capacity-dmips-mhz = <2850>; -+ }; -+ -+ cpu_b0: cpu@100 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc664", "arm,armv8"; -+ reg = <0x0 0x0>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 0>; -+ #cooling-cells = <2>; -+ capacity-dmips-mhz = <5660>; -+ }; -+ -+ cpu_b1: cpu@101 { -+ device_type = "cpu"; -+ compatible = "phytium,ftc664", "arm,armv8"; -+ reg = <0x0 0x100>; -+ enable-method = "psci"; -+ clocks = <&scmi_dvfs 1>; -+ capacity-dmips-mhz = <5660>; -+ }; -+}; -+ -+&soc { -+ hda0: hda@28006000 { -+ compatible = "phytium,hda"; -+ reg = <0x0 0x28006000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ i2s0: i2s@28009000 { -+ compatible = "phytium,i2s"; -+ reg = <0x0 0x28009000 0x0 0x1000>, -+ <0x0 0x28005000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_600mhz>; -+ clock-names = "i2s_clk"; -+ status = "disabled"; -+ }; -+ -+ can0: can@2800a000 { -+ compatible = "phytium,canfd"; -+ reg = <0x0 0x2800a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_200mhz>; -+ clock-names = "can_clk"; -+ tx-fifo-depth = <64>; -+ rx-fifo-depth = <64>; -+ status = "disabled"; -+ }; -+ -+ can1: can@2800b000 { -+ compatible = "phytium,canfd"; -+ reg = <0x0 0x2800b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_200mhz>; -+ clock-names = "can_clk"; -+ tx-fifo-depth = <64>; -+ rx-fifo-depth = <64>; -+ status = "disabled"; -+ }; -+ -+ keypad: keypad@2807a000 { -+ compatible = "phytium,keypad"; -+ reg = <0x0 0x2807a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ usb3_0: usb3@31a08000 { -+ compatible = "phytium,pe220x-xhci"; -+ reg = <0x0 0x31a08000 0x0 0x18000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb3_1: usb3@31a28000 { -+ compatible = "phytium,pe220x-xhci"; -+ reg = <0x0 0x31a28000 0x0 0x18000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ sata0: sata@31a40000 { -+ compatible = "generic-ahci"; -+ reg = <0x0 0x31a40000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ sata1: sata@32014000 { -+ compatible = "generic-ahci"; -+ reg = <0x0 0x32014000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ macb0: ethernet@3200c000 { -+ compatible = "cdns,phytium-gem"; -+ reg = <0x0 0x3200c000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ , -+ , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ support-tsn; -+ status = "disabled"; -+ }; -+ -+ macb1: ethernet@3200e000 { -+ compatible = "cdns,phytium-gem"; -+ reg = <0x0 0x3200e000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ macb2: ethernet@32010000 { -+ compatible = "cdns,phytium-gem"; -+ reg = <0x0 0x32010000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ macb3: ethernet@32012000 { -+ compatible = "cdns,phytium-gem"; -+ reg = <0x0 0x32012000 0x0 0x2000>; -+ interrupts = , -+ , -+ , -+ ; -+ clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; -+ clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; -+ magic-packet; -+ status = "disabled"; -+ }; -+ -+ vpu0: vpu@32b00000 { -+ compatible = "phytium,vpu"; -+ reg = <0x0 0x32b00000 0x0 0x20000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+}; -diff --git a/arch/arm64/boot/dts/phytium/pe220x.dtsi b/arch/arm64/boot/dts/phytium/pe220x.dtsi -new file mode 100644 -index 000000000..ad6a18463 ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/pe220x.dtsi -@@ -0,0 +1,1012 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * dts file for Phytium Pe220x SoC -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+ -+/ { -+ compatible = "phytium,pe220x"; -+ interrupt-parent = <&gic>; -+ #address-cells = <2>; -+ #size-cells = <2>; -+ -+ aliases { -+ serial0 = &uart0; -+ serial1 = &uart1; -+ serial2 = &uart2; -+ serial3 = &uart3; -+ }; -+ -+ psci { -+ compatible = "arm,psci-1.0"; -+ method = "smc"; -+ cpu_suspend = <0xc4000001>; -+ cpu_off = <0x84000002>; -+ cpu_on = <0xc4000003>; -+ sys_poweroff = <0x84000008>; -+ sys_reset = <0x84000009>; -+ }; -+ -+ firmware { -+ scmi: scmi { -+ compatible = "arm,scmi"; -+ mboxes = <&mbox 0>; -+ mbox-names = "tx"; -+ shmem = <&cpu_scp_hpri>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ -+ scmi_dvfs: protocol@13 { -+ reg = <0x13>; -+ #clock-cells = <1>; -+ }; -+ -+ scmi_sensors0: protocol@15 { -+ reg = <0x15>; -+ #thermal-sensor-cells = <1>; -+ }; -+ }; -+ optee { -+ compatible = "linaro,optee-tz"; -+ method = "smc"; -+ }; -+ }; -+ -+ thermal_zones: thermal-zones { -+ sensor0 { -+ polling-delay-passive = <100>; -+ polling-delay = <1000>; -+ thermal-sensors = <&scmi_sensors0 0>; -+ }; -+ -+ sensor1 { -+ polling-delay-passive = <100>; -+ polling-delay = <1000>; -+ thermal-sensors = <&scmi_sensors0 1>; -+ }; -+ }; -+ -+ cpu: cpus { -+ #address-cells = <0x2>; -+ #size-cells = <0x0>; -+ }; -+ -+ gic: interrupt-controller@30800000 { -+ compatible = "arm,gic-v3"; -+ #interrupt-cells = <3>; -+ #address-cells = <2>; -+ #size-cells = <2>; -+ ranges; -+ interrupt-controller; -+ reg = <0x0 0x30800000 0 0x20000>, /* GICD */ -+ <0x0 0x30880000 0 0x80000>, /* GICR */ -+ <0x0 0x30840000 0 0x10000>, /* GICC */ -+ <0x0 0x30850000 0 0x10000>, /* GICH */ -+ <0x0 0x30860000 0 0x10000>; /* GICV */ -+ interrupts = ; -+ -+ its: gic-its@30820000 { -+ compatible = "arm,gic-v3-its"; -+ msi-controller; -+ reg = <0x0 0x30820000 0x0 0x20000>; -+ }; -+ }; -+ -+ pmu { -+ compatible = "arm,armv8-pmuv3"; -+ interrupts = ; -+ }; -+ -+ timer { -+ compatible = "arm,armv8-timer"; -+ interrupts = , -+ , -+ , -+ ; -+ clock-frequency = <50000000>; -+ }; -+ -+ clocks { -+ #address-cells = <2>; -+ #size-cells = <2>; -+ ranges; -+ -+ sysclk_48mhz: clk48mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <48000000>; -+ }; -+ -+ sysclk_50mhz: clk50mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <50000000>; -+ }; -+ -+ sysclk_100mhz: clk100mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <100000000>; -+ }; -+ -+ sysclk_200mhz: clk200mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <200000000>; -+ }; -+ -+ sysclk_250mhz: clk250mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <250000000>; -+ }; -+ -+ sysclk_300mhz: clk300mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <300000000>; -+ }; -+ -+ sysclk_600mhz: clk600mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <600000000>; -+ }; -+ -+ sysclk_1200mhz: clk1200mhz { -+ compatible = "fixed-clock"; -+ #clock-cells = <0>; -+ clock-frequency = <1200000000>; -+ }; -+ }; -+ -+ smmu: iommu@30000000 { -+ compatible = "arm,smmu-v3"; -+ reg = <0x0 0x30000000 0x0 0x800000>; -+ interrupts = , -+ , -+ , -+ ; -+ interrupt-names = "eventq", "priq", "cmdq-sync", "gerror"; -+ dma-coherent; -+ #iommu-cells = <1>; -+ }; -+ -+ soc: soc { -+ compatible = "simple-bus"; -+ #address-cells = <2>; -+ #size-cells = <2>; -+ dma-coherent; -+ ranges; -+ -+ mmc0: mmc@28000000 { -+ compatible = "phytium,mci"; -+ reg = <0x0 0x28000000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_1200mhz>; -+ clock-names = "phytium_mci_clk"; -+ status = "disabled"; -+ }; -+ -+ mmc1: mmc@28001000 { -+ compatible = "phytium,mci"; -+ reg = <0x0 0x28001000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_1200mhz>; -+ clock-names = "phytium_mci_clk"; -+ status = "disabled"; -+ }; -+ -+ nand0: nand@28002000 { -+ compatible = "phytium,nfc"; -+ reg = <0x0 0x28002000 0x0 0x1000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ qspi0: spi@28008000 { -+ compatible = "phytium,qspi-nor"; -+ reg = <0x0 0x28008000 0x0 0x1000>, -+ <0x0 0x0 0x0 0x0fffffff>; -+ reg-names = "qspi", "qspi_mm"; -+ clocks = <&sysclk_300mhz>; -+ status = "disabled"; -+ -+ #address-cells = <1>; -+ #size-cells = <0>; -+ -+ flash@0 { -+ compatible = "jedec,spi-nor"; -+ reg = <0x00>; -+ spi-rx-bus-width = <1>; -+ spi-max-frequency = <20000000>; -+ }; -+ }; -+ -+ uart0: uart@2800c000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x2800c000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz &sysclk_100mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "disabled"; -+ }; -+ -+ uart1: uart@2800d000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x2800d000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz &sysclk_100mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "disabled"; -+ }; -+ -+ uart2: uart@2800e000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x2800e000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz &sysclk_100mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "disabled"; -+ }; -+ -+ uart3: uart@2800f000 { -+ compatible = "arm,pl011", "arm,primecell"; -+ reg = <0x0 0x2800f000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_100mhz &sysclk_100mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "disabled"; -+ }; -+ -+ ddma0: dma-controller@28003000 { -+ compatible = "phytium,ddma"; -+ reg = <0x0 0x28003000 0x0 0x1000>; -+ interrupts = ; -+ #dma-cells = <2>; -+ dma-channels = <8>; -+ }; -+ -+ ddma1: dma-controller@28004000 { -+ compatible = "phytium,ddma"; -+ reg = <0x0 0x28004000 0x0 0x1000>; -+ interrupts = ; -+ #dma-cells = <2>; -+ dma-channels = <8>; -+ }; -+ -+ lpc: lpc@28010000 { -+ compatible = "simple-mfd", "syscon"; -+ reg = <0x0 0x28010000 0x0 0x1000>; -+ reg-io-width = <4>; -+ -+ #address-cells = <1>; -+ #size-cells = <1>; -+ ranges = <0x0 0x0 0x28010000 0x1000>; -+ -+ kcs0: kcs@24 { -+ compatible = "phytium,kcs-bmc"; -+ reg = <0x24 0x1>, <0x30 0x1>, <0x3c 0x1>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ kcs1: kcs@28 { -+ compatible = "phytium,kcs-bmc"; -+ reg = <0x28 0x1>, <0x34 0x1>, <0x40 0x1>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ kcs2: kcs@2c { -+ compatible = "phytium,kcs-bmc"; -+ reg = <0x2c 0x1>, <0x38 0x1>, <0x44 0x1>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ kcs3: kcs@8c { -+ compatible = "phytium,kcs-bmc"; -+ reg = <0x8c 0x1>, <0x90 0x1>, <0x94 0x1>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ bt: bt@48 { -+ compatible = "phytium,bt-bmc"; -+ reg = <0x48 0x20>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ }; -+ -+ /* MIO */ -+ -+ gpio0: gpio@28034000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28034000 0x0 0x1000>; -+ interrupts = , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ gpio1: gpio@28035000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28035000 0x0 0x1000>; -+ interrupts = , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ gpio2: gpio@28036000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28036000 0x0 0x1000>; -+ interrupts = , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ , -+ ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ gpio3: gpio@28037000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28037000 0x0 0x1000>; -+ interrupts = ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ gpio4: gpio@28038000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28038000 0x0 0x1000>; -+ interrupts = ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ gpio5: gpio@28039000 { -+ compatible = "phytium,gpio"; -+ reg = <0x0 0x28039000 0x0 0x1000>; -+ interrupts = ; -+ gpio-controller; -+ #gpio-cells = <2>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ -+ porta { -+ compatible = "phytium,gpio-port"; -+ reg = <0>; -+ ngpios = <16>; -+ }; -+ }; -+ -+ spi0: spi@2803a000 { -+ compatible = "phytium,spi"; -+ reg = <0x0 0x2803a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ num-cs = <4>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ }; -+ -+ spi1: spi@2803b000 { -+ compatible = "phytium,spi"; -+ reg = <0x0 0x2803b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ num-cs = <4>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ }; -+ -+ spi2: spi@2803c000 { -+ compatible = "phytium,spi"; -+ reg = <0x0 0x2803c000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ num-cs = <4>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ }; -+ -+ spi3: spi@2803d000 { -+ compatible = "phytium,spi"; -+ reg = <0x0 0x2803d000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ num-cs = <4>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "disabled"; -+ }; -+ -+ watchdog0: watchdog@28040000 { -+ compatible = "arm,sbsa-gwdt"; -+ reg = <0x0 0x28041000 0x0 0x1000>, -+ <0x0 0x28040000 0x0 0x1000>; -+ interrupts = ; -+ timeout-sec = <30>; -+ status = "disabled"; -+ }; -+ -+ watchdog1: watchdog@28042000 { -+ compatible = "arm,sbsa-gwdt"; -+ reg = <0x0 0x28043000 0x0 0x1000>, -+ <0x0 0x28042000 0x0 0x1000>; -+ interrupts = ; -+ timeout-sec = <30>; -+ status = "disabled"; -+ }; -+ -+ pwm0: pwm@2804a000 { -+ compatible = "phytium,pwm"; -+ reg = <0x0 0x2804a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ pwm1: pwm@2804b000 { -+ compatible = "phytium,pwm"; -+ reg = <0x0 0x2804b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ status = "disabled"; -+ }; -+ -+ tacho0: tacho@28054000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28054000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho1: tacho@28055000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28055000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho2: tacho@28056000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28056000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho3: tacho@28057000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28057000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho4: tacho@28058000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28058000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho5: tacho@28059000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28059000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho6: tacho@2805a000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho7: tacho@2805b000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho8: tacho@2805c000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805c000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho9: tacho@2805d000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805d000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho10: tacho@2805e000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805e000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho11: tacho@2805f000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2805f000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho12: tacho@28060000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28060000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho13: tacho@28061000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28061000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho14: tacho@28062000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28062000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho15: tacho@28063000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28063000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho16: tacho@28064000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28064000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho17: tacho@28065000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28065000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho18: tacho@28066000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28066000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho19: tacho@28067000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28067000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho20: tacho@28068000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28068000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho21: tacho@28069000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28069000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho22: tacho@2806a000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806a000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho23: tacho@2806b000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806b000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho24: tacho@2806c000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806c000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho25: tacho@2806d000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806d000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho26: tacho@2806e000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806e000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho27: tacho@2806f000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x2806f000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho28: tacho@28070000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28070000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho29: tacho@28071000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28071000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho30: tacho@28072000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28072000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho31: tacho@28073000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28073000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho32: tacho@28074000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28074000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho33: tacho@28075000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28075000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho34: tacho@28076000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28076000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho35: tacho@28077000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28077000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho36: tacho@28078000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28078000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ tacho37: tacho@28079000 { -+ compatible = "phytium,tacho"; -+ reg = <0x0 0x28079000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz >; -+ status = "disabled"; -+ }; -+ -+ usb2_0: usb2@31800000 { -+ compatible = "phytium,usb2"; -+ reg = <0x0 0x31800000 0x0 0x80000>, -+ <0x0 0x31990000 0x0 0x10000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb2_1: usb2@31880000 { -+ compatible = "phytium,usb2"; -+ reg = <0x0 0x31880000 0x0 0x80000>, -+ <0x0 0x319a0000 0x0 0x10000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb2_2: usb2@31900000 { -+ compatible = "phytium,usb2"; -+ reg = <0x0 0x31900000 0x0 0x80000>, -+ <0x0 0x319b0000 0x0 0x10000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb2_3: usb2@32800000 { -+ compatible = "phytium,usb2"; -+ reg = <0x0 0x32800000 0x0 0x40000>, -+ <0x0 0x32880000 0x0 0x40000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ usb2_4: usb2@32840000 { -+ compatible = "phytium,usb2"; -+ reg = <0x0 0x32840000 0x0 0x40000>, -+ <0x0 0x328c0000 0x0 0x40000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ dc0: dc@32000000 { -+ compatible = "phytium,dc"; -+ reg = <0x0 0x32000000 0x0 0x8000>; -+ interrupts = ; -+ status = "disabled"; -+ }; -+ -+ i2s_dp0: i2s_dp0@32009000 { -+ compatible = "phytium,i2s"; -+ reg = <0x0 0x32009000 0x0 0x1000>, -+ <0x0 0x32008000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_600mhz>; -+ clock-names = "i2s_clk"; -+ dai-name = "phytium-i2s-dp0"; -+ status = "disabled"; -+ }; -+ -+ i2s_dp1: i2s_dp1@3200B000 { -+ compatible = "phytium,i2s"; -+ reg = <0x0 0x3200B000 0x0 0x1000>, -+ <0x0 0x3200A000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_600mhz>; -+ clock-names = "i2s_clk"; -+ dai-name = "phytium-i2s-dp1"; -+ status = "disabled"; -+ }; -+ -+ pmdk_dp: pmdk_dp { -+ compatible = "phytium,pmdk-dp"; -+ status = "disabled"; -+ }; -+ -+ mbox: mailbox@32a00000 { -+ compatible = "phytium,mbox"; -+ reg = <0x0 0x32a00000 0x0 0x1000>; -+ interrupts = ; -+ #mbox-cells = <1>; -+ }; -+ -+ rng0: rng@32a36000 { -+ compatible = "phytium,rng"; -+ reg = <0x0 0x32a36000 0x0 0x1000>; -+ status = "disabled"; -+ }; -+ -+ sram: sram@32a10000 { -+ compatible = "phytium,pe220x-sram-ns", "mmio-sram"; -+ reg = <0x0 0x32a10000 0x0 0x2000>; -+ -+ #address-cells = <1>; -+ #size-cells = <1>; -+ ranges = <0x0 0x0 0x32a10000 0x2000>; -+ -+ cpu_scp_lpri: scp-shmem@0 { -+ compatible = "arm,scmi-shmem"; -+ reg = <0x1000 0x400>; -+ }; -+ -+ cpu_scp_hpri: scp-shmem@1 { -+ compatible = "arm,scmi-shmem"; -+ reg = <0x1400 0x400>; -+ }; -+ }; -+ -+ edac: edac@32b28000 { -+ compatible = "phytium,pe220x-edac"; -+ reg = <0x0 0x32b28000 0x0 0x1000>, -+ <0x0 0x31400000 0x0 0x1000>, -+ <0x0 0x31401000 0x0 0x1000>; -+ interrupts = , -+ ; -+ status = "disabled"; -+ }; -+ -+ gdma: gdma@32b34000 { -+ compatible = "phytium,gdma"; -+ dma-channels = <16>; -+ max-outstanding = <16>; -+ reg = <0x0 0x32b34000 0x0 0x1000>; -+ interrupts = ; -+ #dma-cells = <1>; -+ }; -+ -+ hwspinlock: spinlock@32b36000 { -+ compatible = "phytium,hwspinlock"; -+ reg = <0x0 0x32b36000 0x0 0x1000>; -+ #hwlock-cells = <1>; -+ nr-locks = <32>; -+ status = "disabled"; -+ }; -+ -+ pcie: pcie@40000000 { -+ compatible = "pci-host-ecam-generic"; -+ device_type = "pci"; -+ #address-cells = <3>; -+ #size-cells = <2>; -+ #interrupt-cells = <1>; -+ reg = <0x0 0x40000000 0x0 0x10000000>; -+ msi-parent = <&its>; -+ bus-range = <0x0 0xff>; -+ interrupt-map-mask = <0x0 0x0 0x0 0x7>; -+ interrupt-map = -+ <0x0 0x0 0x0 0x1 &gic 0x0 0x0 GIC_SPI 4 IRQ_TYPE_LEVEL_HIGH>, -+ <0x0 0x0 0x0 0x2 &gic 0x0 0x0 GIC_SPI 5 IRQ_TYPE_LEVEL_HIGH>, -+ <0x0 0x0 0x0 0x3 &gic 0x0 0x0 GIC_SPI 6 IRQ_TYPE_LEVEL_HIGH>, -+ <0x0 0x0 0x0 0x4 &gic 0x0 0x0 GIC_SPI 7 IRQ_TYPE_LEVEL_HIGH>; -+ ranges = <0x01000000 0x00 0x00000000 0x0 0x50000000 0x0 0x00f00000>, -+ <0x02000000 0x00 0x58000000 0x0 0x58000000 0x0 0x28000000>, -+ <0x03000000 0x10 0x00000000 0x10 0x00000000 0x10 0x00000000>; -+ iommu-map = <0x0 &smmu 0x0 0x10000>; -+ status = "disabled"; -+ }; -+ }; -+}; -diff --git a/arch/arm64/boot/dts/phytium/phytiumpi_firefly.dts b/arch/arm64/boot/dts/phytium/phytiumpi_firefly.dts -new file mode 100644 -index 000000000..e16a4759c ---- /dev/null -+++ b/arch/arm64/boot/dts/phytium/phytiumpi_firefly.dts -@@ -0,0 +1,323 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * DTS file for Phytium Pi development board. -+ * -+ * Copyright (c) 2023-2024 Phytium Technology Co., Ltd. -+ * -+ * Shaojun Yang -+ */ -+ -+/dts-v1/; -+/memreserve/ 0x80000000 0x10000; -+ -+#include "pe2204.dtsi" -+#include "dt-bindings/gpio/gpio.h" -+ -+/{ -+ model = "Phytium Pi Board"; -+ compatible = "phytium,pe2204"; -+ -+ chosen { -+ stdout-path = "serial1:115200n8"; -+ }; -+ aliases { -+ serial4 = &mio0; -+ serial5 = &mio11; -+ serial6 = &mio15; -+ }; -+ -+ memory@0{ -+ device_type = "memory"; -+ reg = <0x0 0x80000000 0x2 0x00000000>; -+ }; -+ -+ leds { -+ compatible = "gpio-leds"; -+ sysled { -+ label = "sysled"; -+ gpios = <&gpio1 5 0>; -+ linux,default-trigger = "none"; -+ }; -+ }; -+ -+ sound_card: sound { -+ compatible = "simple-audio-card"; -+ simple-audio-card,format = "i2s"; -+ simple-audio-card,name = "phytium,pe220x-i2s-audio"; -+ simple-audio-card,pin-switches = "mic-in"; -+ simple-audio-card,widgets = -+ "Microphone","mic-in", -+ "Headphone","Headphones"; -+ simple-audio-card,routing = "MIC2","mic-in"; -+ simple-audio-card,hp-det-gpio = <&gpio2 11 GPIO_ACTIVE_LOW>; -+ -+ simple-audio-card,cpu { -+ sound-dai = <&i2s0>; -+ }; -+ simple-audio-card,codec{ -+ sound-dai = <&codec0>; -+ }; -+ }; -+}; -+ -+&soc { -+ mio9: i2c@28026000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28026000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ }; -+ -+ mio14: i2c@28030000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28030000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ -+ codec0: es8336@10 { -+ #sound-dai-cells = <0>; -+ compatible = "everest,es8336"; -+ reg = <0x10>; -+ }; -+ }; -+ -+ -+ mio0: uart@28014000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28014000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio1: i2c@28016000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28016000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ }; -+ -+ mio8: i2c@28024000 { -+ compatible = "phytium,i2c"; -+ reg = <0x0 0x28024000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz>; -+ #address-cells = <1>; -+ #size-cells = <0>; -+ status = "okay"; -+ }; -+ -+ mio11: uart@2802A000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x2802A000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+ -+ mio15: uart@28032000 { -+ compatible = "arm,pl011","arm,primecell"; -+ reg = <0x0 0x28032000 0x0 0x1000>; -+ interrupts = ; -+ clocks = <&sysclk_50mhz &sysclk_50mhz>; -+ clock-names = "uartclk", "apb_pclk"; -+ status = "okay"; -+ }; -+}; -+ -+&gpio0 { -+ status = "okay"; -+}; -+ -+&gpio1 { -+ status = "okay"; -+}; -+ -+&gpio2 { -+ status = "okay"; -+}; -+ -+&gpio3 { -+ status = "okay"; -+}; -+ -+&gpio4 { -+ status = "okay"; -+}; -+ -+&gpio5 { -+ status = "okay"; -+}; -+ -+&watchdog0 { -+ status = "okay"; -+}; -+ -+&watchdog1 { -+ status = "okay"; -+}; -+ -+&pcie { -+ status = "okay"; -+}; -+ -+&usb3_0 { -+ status = "okay"; -+}; -+ -+&usb3_1 { -+ status = "okay"; -+}; -+ -+&usb2_0 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_1 { -+ dr_mode = "peripheral"; -+ status = "disabled"; -+}; -+ -+&usb2_2 { -+ dr_mode = "peripheral"; -+ status = "disabled"; -+}; -+ -+&usb2_3 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&usb2_4 { -+ dr_mode = "host"; -+ status = "okay"; -+}; -+ -+&macb0 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&macb1 { -+ phy-mode = "sgmii"; -+ use-mii; -+ status = "okay"; -+}; -+ -+&dc0 { -+ pipe_mask = /bits/ 8 <0x1>; -+ edp_mask = /bits/ 8 <0x0>; -+ status = "okay"; -+}; -+ -+&i2s0 { -+ #sound-dai-cells = <0>; -+ dai-name = "phytium-i2s-lsd"; -+ status = "okay"; -+}; -+ -+&i2s_dp0 { -+ dai-name = "phytium-i2s-dp0"; -+ status = "okay"; -+}; -+ -+&qspi0 { -+ status = "okay"; -+ -+ flash@0 { -+ status = "okay"; -+ }; -+}; -+ -+&spi0 { -+ global-cs = <1>; -+ status = "okay"; -+ -+ spidev0: spidev@0 { -+ compatible = "spidev"; -+ reg = <0>; -+ spi-max-frequency = <50000000>; -+ status = "disabled"; -+ }; -+}; -+ -+&mmc0 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-mmc; -+ status = "okay"; -+}; -+ -+&mmc1 { -+ bus-width = <0x00000004>; -+ max-frequency = <50000000>; -+ cap-sdio-irq; -+ cap-sd-highspeed; -+ no-mmc; -+ no-sd; -+ non-removable; -+ status = "okay"; -+}; -+ -+&pwm0 { -+ phytium,db = <0 0 100 1000 1000 0>; -+ status = "okay"; -+}; -+ -+&pwm1 { -+ phytium,db = <0 0 100 1000 1000 0>; -+ status = "okay"; -+}; -+ -+&uart0 { -+ status = "okay"; -+}; -+ -+&uart1 { -+ status = "okay"; -+}; -+ -+&uart2 { -+ status = "okay"; -+}; -+ -+&uart3 { -+ status = "okay"; -+}; -+ -+&can0 { -+ status = "okay"; -+}; -+ -+&can1 { -+ status = "okay"; -+}; -+ -+&pmdk_dp { -+ num-dp = <1>; -+ dp-mask = /bits/ 8 <0x1>; -+ status = "okay"; -+}; -+ -+&rng0 { -+ status = "okay"; -+}; -+ -+&vpu0 { -+ status = "okay"; -+}; -diff --git a/arch/arm64/configs/defconfig b/arch/arm64/configs/defconfig -deleted file mode 100644 -index a789119e6..000000000 ---- a/arch/arm64/configs/defconfig -+++ /dev/null -@@ -1,1586 +0,0 @@ --CONFIG_SYSVIPC=y --CONFIG_POSIX_MQUEUE=y --CONFIG_AUDIT=y --CONFIG_NO_HZ_IDLE=y --CONFIG_HIGH_RES_TIMERS=y --CONFIG_BPF_SYSCALL=y --CONFIG_BPF_JIT=y --CONFIG_PREEMPT=y --CONFIG_IRQ_TIME_ACCOUNTING=y --CONFIG_BSD_PROCESS_ACCT=y --CONFIG_BSD_PROCESS_ACCT_V3=y --CONFIG_TASKSTATS=y --CONFIG_TASK_XACCT=y --CONFIG_TASK_IO_ACCOUNTING=y --CONFIG_IKCONFIG=y --CONFIG_IKCONFIG_PROC=y --CONFIG_NUMA_BALANCING=y --CONFIG_MEMCG=y --CONFIG_BLK_CGROUP=y --CONFIG_CGROUP_PIDS=y --CONFIG_CGROUP_FREEZER=y --CONFIG_CGROUP_HUGETLB=y --CONFIG_CPUSETS=y --CONFIG_CGROUP_DEVICE=y --CONFIG_CGROUP_CPUACCT=y --CONFIG_CGROUP_PERF=y --CONFIG_CGROUP_BPF=y --CONFIG_USER_NS=y --CONFIG_SCHED_AUTOGROUP=y --CONFIG_BLK_DEV_INITRD=y --CONFIG_KALLSYMS_ALL=y --CONFIG_PROFILING=y --CONFIG_ARCH_ACTIONS=y --CONFIG_ARCH_SUNXI=y --CONFIG_ARCH_ALPINE=y --CONFIG_ARCH_APPLE=y --CONFIG_ARCH_BCM=y --CONFIG_ARCH_BCM2835=y --CONFIG_ARCH_BCM_IPROC=y --CONFIG_ARCH_BCMBCA=y --CONFIG_ARCH_BRCMSTB=y --CONFIG_ARCH_BERLIN=y --CONFIG_ARCH_EXYNOS=y --CONFIG_ARCH_SPARX5=y --CONFIG_ARCH_K3=y --CONFIG_ARCH_LG1K=y --CONFIG_ARCH_HISI=y --CONFIG_ARCH_KEEMBAY=y --CONFIG_ARCH_MEDIATEK=y --CONFIG_ARCH_MESON=y --CONFIG_ARCH_MVEBU=y --CONFIG_ARCH_NXP=y --CONFIG_ARCH_LAYERSCAPE=y --CONFIG_ARCH_MXC=y --CONFIG_ARCH_S32=y --CONFIG_ARCH_MA35=y --CONFIG_ARCH_NPCM=y --CONFIG_ARCH_QCOM=y --CONFIG_ARCH_REALTEK=y --CONFIG_ARCH_RENESAS=y --CONFIG_ARCH_ROCKCHIP=y --CONFIG_ARCH_SEATTLE=y --CONFIG_ARCH_INTEL_SOCFPGA=y --CONFIG_ARCH_STM32=y --CONFIG_ARCH_SYNQUACER=y --CONFIG_ARCH_TEGRA=y --CONFIG_ARCH_TESLA_FSD=y --CONFIG_ARCH_SPRD=y --CONFIG_ARCH_THUNDER=y --CONFIG_ARCH_THUNDER2=y --CONFIG_ARCH_UNIPHIER=y --CONFIG_ARCH_VEXPRESS=y --CONFIG_ARCH_VISCONTI=y --CONFIG_ARCH_XGENE=y --CONFIG_ARCH_ZYNQMP=y --CONFIG_ARM64_VA_BITS_48=y --CONFIG_SCHED_MC=y --CONFIG_SCHED_SMT=y --CONFIG_NUMA=y --CONFIG_KEXEC=y --CONFIG_KEXEC_FILE=y --CONFIG_CRASH_DUMP=y --CONFIG_XEN=y --CONFIG_COMPAT=y --CONFIG_RANDOMIZE_BASE=y --CONFIG_HIBERNATION=y --CONFIG_WQ_POWER_EFFICIENT_DEFAULT=y --CONFIG_ENERGY_MODEL=y --CONFIG_ARM_PSCI_CPUIDLE=y --CONFIG_CPU_FREQ=y --CONFIG_CPU_FREQ_STAT=y --CONFIG_CPU_FREQ_GOV_POWERSAVE=m --CONFIG_CPU_FREQ_GOV_USERSPACE=y --CONFIG_CPU_FREQ_GOV_ONDEMAND=y --CONFIG_CPU_FREQ_GOV_CONSERVATIVE=m --CONFIG_CPUFREQ_DT=y --CONFIG_ACPI_CPPC_CPUFREQ=m --CONFIG_ARM_ALLWINNER_SUN50I_CPUFREQ_NVMEM=m --CONFIG_ARM_ARMADA_37XX_CPUFREQ=y --CONFIG_ARM_SCPI_CPUFREQ=y --CONFIG_ARM_IMX_CPUFREQ_DT=m --CONFIG_ARM_MEDIATEK_CPUFREQ=y --CONFIG_ARM_QCOM_CPUFREQ_NVMEM=y --CONFIG_ARM_QCOM_CPUFREQ_HW=y --CONFIG_ARM_RASPBERRYPI_CPUFREQ=m --CONFIG_ARM_SCMI_CPUFREQ=y --CONFIG_ARM_TEGRA186_CPUFREQ=y --CONFIG_QORIQ_CPUFREQ=y --CONFIG_ACPI=y --CONFIG_ACPI_HOTPLUG_MEMORY=y --CONFIG_ACPI_HMAT=y --CONFIG_ACPI_APEI=y --CONFIG_ACPI_APEI_GHES=y --CONFIG_ACPI_APEI_PCIEAER=y --CONFIG_ACPI_APEI_MEMORY_FAILURE=y --CONFIG_ACPI_APEI_EINJ=y --CONFIG_VIRTUALIZATION=y --CONFIG_KVM=y --CONFIG_JUMP_LABEL=y --CONFIG_MODULES=y --CONFIG_MODULE_UNLOAD=y --CONFIG_IOSCHED_BFQ=y --# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set --# CONFIG_COMPAT_BRK is not set --CONFIG_MEMORY_HOTPLUG=y --CONFIG_MEMORY_HOTREMOVE=y --CONFIG_KSM=y --CONFIG_MEMORY_FAILURE=y --CONFIG_TRANSPARENT_HUGEPAGE=y --CONFIG_NET=y --CONFIG_PACKET=y --CONFIG_UNIX=y --CONFIG_INET=y --CONFIG_IP_MULTICAST=y --CONFIG_IP_PNP=y --CONFIG_IP_PNP_DHCP=y --CONFIG_IP_PNP_BOOTP=y --CONFIG_IPV6=m --CONFIG_NETFILTER=y --CONFIG_BRIDGE_NETFILTER=m --CONFIG_NF_CONNTRACK=m --CONFIG_NF_CONNTRACK_EVENTS=y --CONFIG_NETFILTER_XT_MARK=m --CONFIG_NETFILTER_XT_TARGET_CHECKSUM=m --CONFIG_NETFILTER_XT_TARGET_LOG=m --CONFIG_NETFILTER_XT_MATCH_ADDRTYPE=m --CONFIG_NETFILTER_XT_MATCH_CONNTRACK=m --CONFIG_NETFILTER_XT_MATCH_IPVS=m --CONFIG_IP_VS=m --CONFIG_IP_NF_IPTABLES=m --CONFIG_IP_NF_FILTER=m --CONFIG_IP_NF_TARGET_REJECT=m --CONFIG_IP_NF_NAT=m --CONFIG_IP_NF_TARGET_MASQUERADE=m --CONFIG_IP_NF_MANGLE=m --CONFIG_IP6_NF_IPTABLES=m --CONFIG_IP6_NF_FILTER=m --CONFIG_IP6_NF_TARGET_REJECT=m --CONFIG_IP6_NF_MANGLE=m --CONFIG_IP6_NF_NAT=m --CONFIG_IP6_NF_TARGET_MASQUERADE=m --CONFIG_BRIDGE=m --CONFIG_BRIDGE_VLAN_FILTERING=y --CONFIG_NET_DSA=m --CONFIG_VLAN_8021Q=m --CONFIG_VLAN_8021Q_GVRP=y --CONFIG_VLAN_8021Q_MVRP=y --CONFIG_NET_SCHED=y --CONFIG_NET_SCH_CBS=m --CONFIG_NET_SCH_ETF=m --CONFIG_NET_SCH_TAPRIO=m --CONFIG_NET_SCH_MQPRIO=m --CONFIG_NET_SCH_INGRESS=m --CONFIG_NET_CLS_BASIC=m --CONFIG_NET_CLS_FLOWER=m --CONFIG_NET_CLS_ACT=y --CONFIG_NET_ACT_GACT=m --CONFIG_NET_ACT_MIRRED=m --CONFIG_NET_ACT_GATE=m --CONFIG_QRTR_SMD=m --CONFIG_QRTR_TUN=m --CONFIG_CAN=m --CONFIG_CAN_M_CAN=m --CONFIG_CAN_M_CAN_PLATFORM=m --CONFIG_BT=m --CONFIG_BT_HIDP=m --# CONFIG_BT_LE is not set --CONFIG_BT_LEDS=y --# CONFIG_BT_DEBUGFS is not set --CONFIG_BT_HCIBTUSB=m --CONFIG_BT_HCIBTUSB_MTK=y --CONFIG_BT_HCIUART=m --CONFIG_BT_HCIUART_LL=y --CONFIG_BT_HCIUART_BCM=y --CONFIG_BT_HCIUART_QCA=y --CONFIG_BT_HCIUART_MRVL=y --CONFIG_BT_MRVL=m --CONFIG_BT_MRVL_SDIO=m --CONFIG_BT_QCOMSMD=m --CONFIG_BT_NXPUART=m --CONFIG_CFG80211=m --CONFIG_MAC80211=m --CONFIG_MAC80211_LEDS=y --CONFIG_RFKILL=m --CONFIG_NET_9P=y --CONFIG_NET_9P_VIRTIO=y --CONFIG_NFC=m --CONFIG_NFC_NCI=m --CONFIG_NFC_S3FWRN5_I2C=m --CONFIG_PCI=y --CONFIG_PCIEPORTBUS=y --CONFIG_PCIEAER=y --CONFIG_PCI_IOV=y --CONFIG_PCI_PASID=y --CONFIG_HOTPLUG_PCI=y --CONFIG_HOTPLUG_PCI_ACPI=y --CONFIG_PCI_AARDVARK=y --CONFIG_PCI_TEGRA=y --CONFIG_PCIE_RCAR_HOST=y --CONFIG_PCIE_RCAR_EP=y --CONFIG_PCI_HOST_GENERIC=y --CONFIG_PCI_XGENE=y --CONFIG_PCIE_ALTERA=y --CONFIG_PCIE_ALTERA_MSI=y --CONFIG_PCI_HOST_THUNDER_PEM=y --CONFIG_PCI_HOST_THUNDER_ECAM=y --CONFIG_PCIE_ROCKCHIP_HOST=m --CONFIG_PCIE_MEDIATEK_GEN3=m --CONFIG_PCIE_BRCMSTB=m --CONFIG_PCI_IMX6_HOST=y --CONFIG_PCI_LAYERSCAPE=y --CONFIG_PCI_HISI=y --CONFIG_PCIE_QCOM=y --CONFIG_PCIE_ARMADA_8K=y --CONFIG_PCIE_ROCKCHIP_DW_HOST=y --CONFIG_PCIE_KIRIN=y --CONFIG_PCIE_HISI_STB=y --CONFIG_PCIE_TEGRA194_HOST=m --CONFIG_PCIE_VISCONTI_HOST=y --CONFIG_PCIE_LAYERSCAPE_GEN4=y --CONFIG_PCI_ENDPOINT=y --CONFIG_PCI_ENDPOINT_CONFIGFS=y --CONFIG_PCI_EPF_TEST=m --CONFIG_DEVTMPFS=y --CONFIG_DEVTMPFS_MOUNT=y --CONFIG_FW_LOADER_USER_HELPER=y --CONFIG_HISILICON_LPC=y --CONFIG_TEGRA_ACONNECT=m --CONFIG_MHI_BUS_PCI_GENERIC=m --CONFIG_ARM_SCMI_PROTOCOL=y --CONFIG_ARM_SCPI_PROTOCOL=y --CONFIG_RASPBERRYPI_FIRMWARE=y --CONFIG_INTEL_STRATIX10_SERVICE=y --CONFIG_INTEL_STRATIX10_RSU=m --CONFIG_EFI_CAPSULE_LOADER=y --CONFIG_IMX_SCU=y --CONFIG_IMX_SCU_PD=y --CONFIG_GNSS=m --CONFIG_GNSS_MTK_SERIAL=m --CONFIG_MTD=y --CONFIG_MTD_BLOCK=y --CONFIG_MTD_CFI=y --CONFIG_MTD_CFI_ADV_OPTIONS=y --CONFIG_MTD_CFI_INTELEXT=y --CONFIG_MTD_CFI_AMDSTD=y --CONFIG_MTD_CFI_STAA=y --CONFIG_MTD_PHYSMAP=y --CONFIG_MTD_PHYSMAP_OF=y --CONFIG_MTD_DATAFLASH=y --CONFIG_MTD_SST25L=y --CONFIG_MTD_RAW_NAND=y --CONFIG_MTD_NAND_DENALI_DT=y --CONFIG_MTD_NAND_MARVELL=y --CONFIG_MTD_NAND_BRCMNAND=m --CONFIG_MTD_NAND_FSL_IFC=y --CONFIG_MTD_NAND_QCOM=y --CONFIG_MTD_SPI_NOR=y --CONFIG_MTD_UBI=m --CONFIG_UBIFS_FS=m --CONFIG_BLK_DEV_LOOP=y --CONFIG_BLK_DEV_NBD=m --CONFIG_VIRTIO_BLK=y --CONFIG_BLK_DEV_NVME=m --CONFIG_QCOM_COINCELL=m --CONFIG_QCOM_FASTRPC=m --CONFIG_BATTERY_QCOM_BATTMGR=m --CONFIG_UCSI_PMIC_GLINK=m --CONFIG_SRAM=y --CONFIG_PCI_ENDPOINT_TEST=m --CONFIG_EEPROM_AT24=m --CONFIG_EEPROM_AT25=m --CONFIG_UACCE=m --# CONFIG_SCSI_PROC_FS is not set --CONFIG_BLK_DEV_SD=y --CONFIG_SCSI_SAS_ATA=y --CONFIG_SCSI_HISI_SAS=y --CONFIG_SCSI_HISI_SAS_PCI=y --CONFIG_MEGARAID_SAS=y --CONFIG_SCSI_MPT3SAS=m --CONFIG_ATA=y --CONFIG_SATA_AHCI=y --CONFIG_SATA_AHCI_PLATFORM=y --CONFIG_AHCI_BRCM=m --CONFIG_AHCI_DWC=m --CONFIG_AHCI_CEVA=y --CONFIG_AHCI_MVEBU=y --CONFIG_AHCI_XGENE=y --CONFIG_AHCI_QORIQ=y --CONFIG_SATA_SIL24=y --CONFIG_SATA_RCAR=y --CONFIG_PATA_PLATFORM=y --CONFIG_PATA_OF_PLATFORM=y --CONFIG_MD=y --CONFIG_BLK_DEV_MD=m --CONFIG_BLK_DEV_DM=m --CONFIG_DM_MIRROR=m --CONFIG_DM_ZERO=m --CONFIG_NETDEVICES=y --CONFIG_MACVLAN=m --CONFIG_MACVTAP=m --CONFIG_TUN=y --CONFIG_VETH=m --CONFIG_VIRTIO_NET=y --CONFIG_MHI_NET=m --CONFIG_NET_DSA_BCM_SF2=m --CONFIG_NET_DSA_MSCC_FELIX=m --CONFIG_AMD_XGBE=y --CONFIG_NET_XGENE=y --CONFIG_ATL1C=m --CONFIG_BCMGENET=m --CONFIG_BNX2X=m --CONFIG_SYSTEMPORT=m --CONFIG_MACB=y --CONFIG_THUNDER_NIC_PF=y --CONFIG_FEC=y --CONFIG_FSL_FMAN=y --CONFIG_FSL_DPAA_ETH=y --CONFIG_FSL_DPAA2_ETH=y --CONFIG_FSL_ENETC=y --CONFIG_FSL_ENETC_VF=y --CONFIG_FSL_ENETC_QOS=y --CONFIG_HIX5HD2_GMAC=y --CONFIG_HNS_DSAF=y --CONFIG_HNS_ENET=y --CONFIG_HNS3=y --CONFIG_HNS3_HCLGE=y --CONFIG_HNS3_ENET=y --CONFIG_E1000=y --CONFIG_E1000E=y --CONFIG_IGB=y --CONFIG_IGBVF=y --CONFIG_MVNETA=y --CONFIG_MVPP2=y --CONFIG_SKY2=y --CONFIG_MLX4_EN=m --CONFIG_MLX5_CORE=m --CONFIG_MLX5_CORE_EN=y --CONFIG_QCOM_EMAC=m --CONFIG_RMNET=m --CONFIG_R8169=m --CONFIG_SH_ETH=y --CONFIG_RAVB=y --CONFIG_RENESAS_ETHER_SWITCH=y --CONFIG_SMC91X=y --CONFIG_SMSC911X=y --CONFIG_SNI_AVE=y --CONFIG_SNI_NETSEC=y --CONFIG_STMMAC_ETH=m --CONFIG_DWMAC_TEGRA=m --CONFIG_TI_K3_AM65_CPSW_NUSS=y --CONFIG_QCOM_IPA=m --CONFIG_MESON_GXL_PHY=m --CONFIG_AQUANTIA_PHY=y --CONFIG_BCM54140_PHY=m --CONFIG_MARVELL_PHY=m --CONFIG_MARVELL_10G_PHY=y --CONFIG_MICREL_PHY=y --CONFIG_MICROSEMI_PHY=y --CONFIG_AT803X_PHY=y --CONFIG_REALTEK_PHY=y --CONFIG_ROCKCHIP_PHY=y --CONFIG_DP83867_PHY=y --CONFIG_DP83869_PHY=m --CONFIG_DP83TD510_PHY=y --CONFIG_VITESSE_PHY=y --CONFIG_CAN_FLEXCAN=m --CONFIG_CAN_RCAR=m --CONFIG_CAN_RCAR_CANFD=m --CONFIG_CAN_MCP251XFD=m --CONFIG_MDIO_GPIO=y --CONFIG_MDIO_BUS_MUX_MULTIPLEXER=y --CONFIG_MDIO_BUS_MUX_MMIOREG=y --CONFIG_USB_PEGASUS=m --CONFIG_USB_RTL8150=m --CONFIG_USB_RTL8152=m --CONFIG_USB_LAN78XX=m --CONFIG_USB_USBNET=m --CONFIG_USB_NET_DM9601=m --CONFIG_USB_NET_SR9800=m --CONFIG_USB_NET_SMSC75XX=m --CONFIG_USB_NET_SMSC95XX=m --CONFIG_USB_NET_PLUSB=m --CONFIG_USB_NET_MCS7830=m --CONFIG_ATH10K=m --CONFIG_ATH10K_PCI=m --CONFIG_ATH10K_SDIO=m --CONFIG_ATH10K_SNOC=m --CONFIG_WCN36XX=m --CONFIG_ATH11K=m --CONFIG_ATH11K_AHB=m --CONFIG_ATH11K_PCI=m --CONFIG_BRCMFMAC=m --CONFIG_MWIFIEX=m --CONFIG_MWIFIEX_SDIO=m --CONFIG_MWIFIEX_PCIE=m --CONFIG_MT7921E=m --CONFIG_RSI_91X=m --CONFIG_WL18XX=m --CONFIG_WLCORE_SDIO=m --CONFIG_WWAN=m --CONFIG_MHI_WWAN_CTRL=m --CONFIG_MHI_WWAN_MBIM=m --CONFIG_INPUT_EVDEV=y --CONFIG_KEYBOARD_ADC=m --CONFIG_KEYBOARD_GPIO=y --CONFIG_KEYBOARD_SNVS_PWRKEY=m --CONFIG_KEYBOARD_IMX_SC_KEY=m --CONFIG_KEYBOARD_CROS_EC=y --CONFIG_KEYBOARD_MTK_PMIC=m --CONFIG_MOUSE_ELAN_I2C=m --CONFIG_INPUT_TOUCHSCREEN=y --CONFIG_TOUCHSCREEN_ATMEL_MXT=m --CONFIG_TOUCHSCREEN_GOODIX=m --CONFIG_TOUCHSCREEN_ELAN=m --CONFIG_TOUCHSCREEN_EDT_FT5X06=m --CONFIG_INPUT_MISC=y --CONFIG_INPUT_BBNSM_PWRKEY=m --CONFIG_INPUT_PM8941_PWRKEY=y --CONFIG_INPUT_PM8XXX_VIBRATOR=m --CONFIG_INPUT_TPS65219_PWRBUTTON=m --CONFIG_INPUT_PWM_BEEPER=m --CONFIG_INPUT_PWM_VIBRA=m --CONFIG_INPUT_RK805_PWRKEY=m --CONFIG_INPUT_HISI_POWERKEY=y --# CONFIG_SERIO_SERPORT is not set --CONFIG_SERIO_AMBAKMI=y --CONFIG_LEGACY_PTY_COUNT=16 --CONFIG_SERIAL_8250=y --CONFIG_SERIAL_8250_CONSOLE=y --CONFIG_SERIAL_8250_EXTENDED=y --CONFIG_SERIAL_8250_SHARE_IRQ=y --CONFIG_SERIAL_8250_BCM2835AUX=y --CONFIG_SERIAL_8250_DW=y --CONFIG_SERIAL_8250_EM=y --CONFIG_SERIAL_8250_OMAP=y --CONFIG_SERIAL_8250_MT6577=y --CONFIG_SERIAL_8250_UNIPHIER=y --CONFIG_SERIAL_OF_PLATFORM=y --CONFIG_SERIAL_AMBA_PL011=y --CONFIG_SERIAL_AMBA_PL011_CONSOLE=y --CONFIG_SERIAL_MESON=y --CONFIG_SERIAL_MESON_CONSOLE=y --CONFIG_SERIAL_SAMSUNG=y --CONFIG_SERIAL_SAMSUNG_CONSOLE=y --CONFIG_SERIAL_TEGRA=y --CONFIG_SERIAL_TEGRA_TCU=y --CONFIG_SERIAL_IMX=y --CONFIG_SERIAL_IMX_CONSOLE=y --CONFIG_SERIAL_SH_SCI=y --CONFIG_SERIAL_MSM=y --CONFIG_SERIAL_MSM_CONSOLE=y --CONFIG_SERIAL_QCOM_GENI=y --CONFIG_SERIAL_QCOM_GENI_CONSOLE=y --CONFIG_SERIAL_XILINX_PS_UART=y --CONFIG_SERIAL_XILINX_PS_UART_CONSOLE=y --CONFIG_SERIAL_FSL_LPUART=y --CONFIG_SERIAL_FSL_LPUART_CONSOLE=y --CONFIG_SERIAL_FSL_LINFLEXUART=y --CONFIG_SERIAL_FSL_LINFLEXUART_CONSOLE=y --CONFIG_SERIAL_STM32=y --CONFIG_SERIAL_STM32_CONSOLE=y --CONFIG_SERIAL_MVEBU_UART=y --CONFIG_SERIAL_OWL=y --CONFIG_SERIAL_DEV_BUS=y --CONFIG_VIRTIO_CONSOLE=y --CONFIG_IPMI_HANDLER=m --CONFIG_IPMI_DEVICE_INTERFACE=m --CONFIG_IPMI_SI=m --CONFIG_HW_RANDOM=y --CONFIG_HW_RANDOM_VIRTIO=y --CONFIG_TCG_TPM=y --CONFIG_TCG_TIS=m --CONFIG_TCG_TIS_SPI=m --CONFIG_TCG_TIS_SPI_CR50=y --CONFIG_TCG_TIS_I2C_CR50=m --CONFIG_TCG_TIS_I2C_INFINEON=y --CONFIG_I2C_CHARDEV=y --CONFIG_I2C_MUX=y --CONFIG_I2C_MUX_PCA954x=y --CONFIG_I2C_BCM2835=m --CONFIG_I2C_CADENCE=m --CONFIG_I2C_DESIGNWARE_PLATFORM=y --CONFIG_I2C_GPIO=m --CONFIG_I2C_IMX=y --CONFIG_I2C_IMX_LPI2C=y --CONFIG_I2C_MESON=y --CONFIG_I2C_MT65XX=y --CONFIG_I2C_MV64XXX=y --CONFIG_I2C_OMAP=y --CONFIG_I2C_OWL=y --CONFIG_I2C_PXA=y --CONFIG_I2C_QCOM_CCI=m --CONFIG_I2C_QCOM_GENI=m --CONFIG_I2C_QUP=y --CONFIG_I2C_RIIC=y --CONFIG_I2C_RK3X=y --CONFIG_I2C_RZV2M=m --CONFIG_I2C_S3C2410=y --CONFIG_I2C_SH_MOBILE=y --CONFIG_I2C_TEGRA=y --CONFIG_I2C_UNIPHIER_F=y --CONFIG_I2C_RCAR=y --CONFIG_I2C_CROS_EC_TUNNEL=y --CONFIG_SPI=y --CONFIG_SPI_ARMADA_3700=y --CONFIG_SPI_BCM2835=m --CONFIG_SPI_BCM2835AUX=m --CONFIG_SPI_CADENCE_QUADSPI=y --CONFIG_SPI_DESIGNWARE=m --CONFIG_SPI_DW_DMA=y --CONFIG_SPI_DW_MMIO=m --CONFIG_SPI_FSL_LPSPI=y --CONFIG_SPI_FSL_QUADSPI=y --CONFIG_SPI_NXP_FLEXSPI=y --CONFIG_SPI_IMX=m --CONFIG_SPI_FSL_DSPI=y --CONFIG_SPI_MESON_SPICC=m --CONFIG_SPI_MESON_SPIFC=m --CONFIG_SPI_MT65XX=y --CONFIG_SPI_MTK_NOR=m --CONFIG_SPI_OMAP24XX=m --CONFIG_SPI_ORION=y --CONFIG_SPI_PL022=y --CONFIG_SPI_ROCKCHIP=y --CONFIG_SPI_ROCKCHIP_SFC=m --CONFIG_SPI_RPCIF=m --CONFIG_SPI_RSPI=m --CONFIG_SPI_RZV2M_CSI=m --CONFIG_SPI_QCOM_QSPI=m --CONFIG_SPI_QUP=y --CONFIG_SPI_QCOM_GENI=m --CONFIG_SPI_S3C64XX=y --CONFIG_SPI_SH_MSIOF=m --CONFIG_SPI_SUN6I=y --CONFIG_SPI_TEGRA210_QUAD=m --CONFIG_SPI_TEGRA114=m --CONFIG_SPI_SPIDEV=m --CONFIG_SPMI=y --CONFIG_SPMI_MTK_PMIF=m --CONFIG_PINCTRL_MAX77620=y --CONFIG_PINCTRL_RK805=m --CONFIG_PINCTRL_SINGLE=y --CONFIG_PINCTRL_OWL=y --CONFIG_PINCTRL_S700=y --CONFIG_PINCTRL_S900=y --CONFIG_PINCTRL_IMX8MM=y --CONFIG_PINCTRL_IMX8MN=y --CONFIG_PINCTRL_IMX8MP=y --CONFIG_PINCTRL_IMX8MQ=y --CONFIG_PINCTRL_IMX8QM=y --CONFIG_PINCTRL_IMX8QXP=y --CONFIG_PINCTRL_IMX8DXL=y --CONFIG_PINCTRL_IMX8ULP=y --CONFIG_PINCTRL_IMX93=y --CONFIG_PINCTRL_MSM=y --CONFIG_PINCTRL_IPQ8074=y --CONFIG_PINCTRL_IPQ5018=y --CONFIG_PINCTRL_IPQ5332=y --CONFIG_PINCTRL_IPQ6018=y --CONFIG_PINCTRL_IPQ9574=y --CONFIG_PINCTRL_MSM8916=y --CONFIG_PINCTRL_MSM8953=y --CONFIG_PINCTRL_MSM8976=y --CONFIG_PINCTRL_MSM8994=y --CONFIG_PINCTRL_MSM8996=y --CONFIG_PINCTRL_MSM8998=y --CONFIG_PINCTRL_QCM2290=y --CONFIG_PINCTRL_QCS404=y --CONFIG_PINCTRL_QDF2XXX=y --CONFIG_PINCTRL_QCOM_SPMI_PMIC=y --CONFIG_PINCTRL_QDU1000=y --CONFIG_PINCTRL_SA8775P=y --CONFIG_PINCTRL_SC7180=y --CONFIG_PINCTRL_SC7280=y --CONFIG_PINCTRL_SC7280_LPASS_LPI=m --CONFIG_PINCTRL_SC8180X=y --CONFIG_PINCTRL_SC8280XP=y --CONFIG_PINCTRL_SDM660=y --CONFIG_PINCTRL_SDM670=y --CONFIG_PINCTRL_SDM845=y --CONFIG_PINCTRL_SM6115=y --CONFIG_PINCTRL_SM6125=y --CONFIG_PINCTRL_SM6350=y --CONFIG_PINCTRL_SM6375=y --CONFIG_PINCTRL_SM8150=y --CONFIG_PINCTRL_SM8250=y --CONFIG_PINCTRL_SM8250_LPASS_LPI=m --CONFIG_PINCTRL_SM8350=y --CONFIG_PINCTRL_SM8450=y --CONFIG_PINCTRL_SM8450_LPASS_LPI=m --CONFIG_PINCTRL_SC8280XP_LPASS_LPI=m --CONFIG_PINCTRL_SM8550=y --CONFIG_PINCTRL_SM8550_LPASS_LPI=m --CONFIG_PINCTRL_LPASS_LPI=m --CONFIG_GPIO_ALTERA=m --CONFIG_GPIO_DAVINCI=y --CONFIG_GPIO_DWAPB=y --CONFIG_GPIO_MB86S7X=y --CONFIG_GPIO_MPC8XXX=y --CONFIG_GPIO_MXC=y --CONFIG_GPIO_PL061=y --CONFIG_GPIO_RCAR=y --CONFIG_GPIO_UNIPHIER=y --CONFIG_GPIO_VISCONTI=y --CONFIG_GPIO_WCD934X=m --CONFIG_GPIO_XGENE=y --CONFIG_GPIO_XGENE_SB=y --CONFIG_GPIO_MAX732X=y --CONFIG_GPIO_PCA953X=y --CONFIG_GPIO_PCA953X_IRQ=y --CONFIG_GPIO_BD9571MWV=m --CONFIG_GPIO_MAX77620=y --CONFIG_GPIO_SL28CPLD=m --CONFIG_GPIO_SYSCON=y --CONFIG_POWER_RESET_MSM=y --CONFIG_POWER_RESET_QCOM_PON=m --CONFIG_POWER_RESET_XGENE=y --CONFIG_POWER_RESET_SYSCON=y --CONFIG_POWER_RESET_SYSCON_POWEROFF=y --CONFIG_SYSCON_REBOOT_MODE=y --CONFIG_NVMEM_REBOOT_MODE=m --CONFIG_BATTERY_SBS=m --CONFIG_BATTERY_BQ27XXX=y --CONFIG_BATTERY_MAX17042=m --CONFIG_CHARGER_MT6360=m --CONFIG_CHARGER_BQ25890=m --CONFIG_CHARGER_BQ25980=m --CONFIG_CHARGER_RK817=m --CONFIG_SENSORS_ARM_SCMI=y --CONFIG_SENSORS_ARM_SCPI=y --CONFIG_SENSORS_GPIO_FAN=m --CONFIG_SENSORS_JC42=m --CONFIG_SENSORS_LM75=m --CONFIG_SENSORS_LM90=m --CONFIG_SENSORS_PWM_FAN=m --CONFIG_SENSORS_RASPBERRYPI_HWMON=m --CONFIG_SENSORS_SL28CPLD=m --CONFIG_SENSORS_INA2XX=m --CONFIG_SENSORS_INA3221=m --CONFIG_THERMAL_GOV_POWER_ALLOCATOR=y --CONFIG_CPU_THERMAL=y --CONFIG_DEVFREQ_THERMAL=y --CONFIG_THERMAL_EMULATION=y --CONFIG_IMX_SC_THERMAL=m --CONFIG_IMX8MM_THERMAL=m --CONFIG_QORIQ_THERMAL=m --CONFIG_K3_THERMAL=m --CONFIG_SUN8I_THERMAL=y --CONFIG_ROCKCHIP_THERMAL=m --CONFIG_RCAR_THERMAL=y --CONFIG_RCAR_GEN3_THERMAL=y --CONFIG_RZG2L_THERMAL=y --CONFIG_ARMADA_THERMAL=y --CONFIG_BCM2711_THERMAL=m --CONFIG_BCM2835_THERMAL=m --CONFIG_BRCMSTB_THERMAL=m --CONFIG_EXYNOS_THERMAL=y --CONFIG_TEGRA_SOCTHERM=m --CONFIG_TEGRA_BPMP_THERMAL=m --CONFIG_GENERIC_ADC_THERMAL=m --CONFIG_QCOM_TSENS=y --CONFIG_QCOM_SPMI_ADC_TM5=m --CONFIG_QCOM_SPMI_TEMP_ALARM=m --CONFIG_QCOM_LMH=m --CONFIG_UNIPHIER_THERMAL=y --CONFIG_WATCHDOG=y --CONFIG_SL28CPLD_WATCHDOG=m --CONFIG_ARM_SP805_WATCHDOG=y --CONFIG_ARM_SBSA_WATCHDOG=y --CONFIG_S3C2410_WATCHDOG=y --CONFIG_DW_WATCHDOG=y --CONFIG_SUNXI_WATCHDOG=m --CONFIG_NPCM7XX_WATCHDOG=y --CONFIG_IMX2_WDT=y --CONFIG_IMX_SC_WDT=m --CONFIG_IMX7ULP_WDT=m --CONFIG_QCOM_WDT=m --CONFIG_MESON_GXBB_WATCHDOG=m --CONFIG_MESON_WATCHDOG=m --CONFIG_ARM_SMC_WATCHDOG=y --CONFIG_RENESAS_WDT=y --CONFIG_RENESAS_RZG2LWDT=y --CONFIG_UNIPHIER_WATCHDOG=y --CONFIG_PM8916_WATCHDOG=m --CONFIG_BCM2835_WDT=y --CONFIG_BCM7038_WDT=m --CONFIG_K3_RTI_WATCHDOG=m --CONFIG_MFD_ALTERA_SYSMGR=y --CONFIG_MFD_BD9571MWV=y --CONFIG_MFD_AXP20X_I2C=y --CONFIG_MFD_AXP20X_RSB=y --CONFIG_MFD_EXYNOS_LPASS=m --CONFIG_MFD_HI6421_PMIC=y --CONFIG_MFD_HI655X_PMIC=y --CONFIG_MFD_MAX77620=y --CONFIG_MFD_MT6360=y --CONFIG_MFD_MT6397=y --CONFIG_MFD_SPMI_PMIC=y --CONFIG_MFD_RK8XX_I2C=y --CONFIG_MFD_RK8XX_SPI=y --CONFIG_MFD_SEC_CORE=y --CONFIG_MFD_SL28CPLD=y --CONFIG_RZ_MTU3=y --CONFIG_MFD_TPS65219=y --CONFIG_MFD_TI_AM335X_TSCADC=m --CONFIG_MFD_ROHM_BD718XX=y --CONFIG_MFD_WCD934X=m --CONFIG_REGULATOR_FIXED_VOLTAGE=y --CONFIG_REGULATOR_AXP20X=y --CONFIG_REGULATOR_BD718XX=y --CONFIG_REGULATOR_BD9571MWV=y --CONFIG_REGULATOR_CROS_EC=y --CONFIG_REGULATOR_FAN53555=y --CONFIG_REGULATOR_GPIO=y --CONFIG_REGULATOR_HI6421V530=y --CONFIG_REGULATOR_HI655X=y --CONFIG_REGULATOR_MAX77620=y --CONFIG_REGULATOR_MAX8973=y --CONFIG_REGULATOR_MP8859=y --CONFIG_REGULATOR_MT6315=m --CONFIG_REGULATOR_MT6357=y --CONFIG_REGULATOR_MT6358=y --CONFIG_REGULATOR_MT6359=y --CONFIG_REGULATOR_MT6360=y --CONFIG_REGULATOR_MT6397=y --CONFIG_REGULATOR_PCA9450=y --CONFIG_REGULATOR_PF8X00=y --CONFIG_REGULATOR_PFUZE100=y --CONFIG_REGULATOR_PWM=y --CONFIG_REGULATOR_QCOM_RPMH=y --CONFIG_REGULATOR_QCOM_SMD_RPM=y --CONFIG_REGULATOR_QCOM_SPMI=y --CONFIG_REGULATOR_RAA215300=y --CONFIG_REGULATOR_RK808=y --CONFIG_REGULATOR_S2MPS11=y --CONFIG_REGULATOR_TPS65132=m --CONFIG_REGULATOR_TPS65219=y --CONFIG_REGULATOR_VCTRL=m --CONFIG_RC_CORE=m --CONFIG_RC_DECODERS=y --CONFIG_RC_DEVICES=y --CONFIG_IR_GPIO_CIR=m --CONFIG_IR_MESON=m --CONFIG_IR_SUNXI=m --CONFIG_MEDIA_SUPPORT=m --CONFIG_MEDIA_CAMERA_SUPPORT=y --CONFIG_MEDIA_ANALOG_TV_SUPPORT=y --CONFIG_MEDIA_DIGITAL_TV_SUPPORT=y --CONFIG_MEDIA_SDR_SUPPORT=y --CONFIG_MEDIA_PLATFORM_SUPPORT=y --# CONFIG_DVB_NET is not set --CONFIG_MEDIA_USB_SUPPORT=y --CONFIG_USB_VIDEO_CLASS=m --CONFIG_V4L_PLATFORM_DRIVERS=y --CONFIG_SDR_PLATFORM_DRIVERS=y --CONFIG_V4L_MEM2MEM_DRIVERS=y --CONFIG_VIDEO_MEDIATEK_JPEG=m --CONFIG_VIDEO_MEDIATEK_VCODEC=m --CONFIG_VIDEO_IMX7_CSI=m --CONFIG_VIDEO_IMX_MIPI_CSIS=m --CONFIG_VIDEO_IMX8_ISI=m --CONFIG_VIDEO_IMX8_ISI_M2M=y --CONFIG_VIDEO_QCOM_CAMSS=m --CONFIG_VIDEO_QCOM_VENUS=m --CONFIG_VIDEO_RCAR_ISP=m --CONFIG_VIDEO_RCAR_CSI2=m --CONFIG_VIDEO_RCAR_VIN=m --CONFIG_VIDEO_RZG2L_CSI2=m --CONFIG_VIDEO_RZG2L_CRU=m --CONFIG_VIDEO_RENESAS_FCP=m --CONFIG_VIDEO_RENESAS_FDP1=m --CONFIG_VIDEO_RENESAS_VSP1=m --CONFIG_VIDEO_RCAR_DRIF=m --CONFIG_VIDEO_SAMSUNG_EXYNOS_GSC=m --CONFIG_VIDEO_SAMSUNG_S5P_JPEG=m --CONFIG_VIDEO_SAMSUNG_S5P_MFC=m --CONFIG_VIDEO_SUN6I_CSI=m --CONFIG_VIDEO_HANTRO=m --CONFIG_VIDEO_IMX219=m --CONFIG_VIDEO_IMX412=m --CONFIG_VIDEO_OV5640=m --CONFIG_VIDEO_OV5645=m --CONFIG_DRM=m --CONFIG_DRM_I2C_NXP_TDA998X=m --CONFIG_DRM_HDLCD=m --CONFIG_DRM_MALI_DISPLAY=m --CONFIG_DRM_KOMEDA=m --CONFIG_DRM_NOUVEAU=m --CONFIG_DRM_EXYNOS=m --CONFIG_DRM_EXYNOS5433_DECON=y --CONFIG_DRM_EXYNOS7_DECON=y --CONFIG_DRM_EXYNOS_DSI=y --# CONFIG_DRM_EXYNOS_DP is not set --CONFIG_DRM_EXYNOS_HDMI=y --CONFIG_DRM_EXYNOS_MIC=y --CONFIG_DRM_ROCKCHIP=m --CONFIG_ROCKCHIP_VOP2=y --CONFIG_ROCKCHIP_ANALOGIX_DP=y --CONFIG_ROCKCHIP_CDN_DP=y --CONFIG_ROCKCHIP_DW_HDMI=y --CONFIG_ROCKCHIP_DW_MIPI_DSI=y --CONFIG_ROCKCHIP_INNO_HDMI=y --CONFIG_ROCKCHIP_LVDS=y --CONFIG_DRM_RCAR_DU=m --CONFIG_DRM_RCAR_DW_HDMI=m --CONFIG_DRM_RCAR_MIPI_DSI=m --CONFIG_DRM_RZG2L_MIPI_DSI=m --CONFIG_DRM_SUN4I=m --CONFIG_DRM_SUN6I_DSI=m --CONFIG_DRM_SUN8I_DW_HDMI=m --CONFIG_DRM_SUN8I_MIXER=m --CONFIG_DRM_MSM=m --CONFIG_DRM_TEGRA=m --CONFIG_DRM_PANEL_BOE_TV101WUM_NL6=m --CONFIG_DRM_PANEL_LVDS=m --CONFIG_DRM_PANEL_SIMPLE=m --CONFIG_DRM_PANEL_EDP=m --CONFIG_DRM_PANEL_MANTIX_MLAF057WE51=m --CONFIG_DRM_PANEL_RAYDIUM_RM67191=m --CONFIG_DRM_PANEL_SITRONIX_ST7703=m --CONFIG_DRM_PANEL_TRULY_NT35597_WQXGA=m --CONFIG_DRM_PANEL_VISIONOX_VTDR6130=m --CONFIG_DRM_LONTIUM_LT8912B=m --CONFIG_DRM_LONTIUM_LT9611=m --CONFIG_DRM_LONTIUM_LT9611UXC=m --CONFIG_DRM_ITE_IT66121=m --CONFIG_DRM_NWL_MIPI_DSI=m --CONFIG_DRM_PARADE_PS8640=m --CONFIG_DRM_SII902X=m --CONFIG_DRM_SIMPLE_BRIDGE=m --CONFIG_DRM_THINE_THC63LVD1024=m --CONFIG_DRM_TOSHIBA_TC358768=m --CONFIG_DRM_TI_TFP410=m --CONFIG_DRM_TI_SN65DSI83=m --CONFIG_DRM_TI_SN65DSI86=m --CONFIG_DRM_ANALOGIX_ANX7625=m --CONFIG_DRM_I2C_ADV7511=m --CONFIG_DRM_I2C_ADV7511_AUDIO=y --CONFIG_DRM_CDNS_MHDP8546=m --CONFIG_DRM_DW_HDMI_AHB_AUDIO=m --CONFIG_DRM_DW_HDMI_CEC=m --CONFIG_DRM_IMX_DCSS=m --CONFIG_DRM_V3D=m --CONFIG_DRM_VC4=m --CONFIG_DRM_ETNAVIV=m --CONFIG_DRM_HISI_HIBMC=m --CONFIG_DRM_HISI_KIRIN=m --CONFIG_DRM_MEDIATEK=m --CONFIG_DRM_MEDIATEK_HDMI=m --CONFIG_DRM_MXSFB=m --CONFIG_DRM_MESON=m --CONFIG_DRM_IMX_LCDIF=m --CONFIG_DRM_PL111=m --CONFIG_DRM_LIMA=m --CONFIG_DRM_PANFROST=m --CONFIG_DRM_TIDSS=m --CONFIG_FB=y --CONFIG_FB_MODE_HELPERS=y --CONFIG_FB_EFI=y --CONFIG_BACKLIGHT_PWM=m --CONFIG_BACKLIGHT_LP855X=m --CONFIG_LOGO=y --# CONFIG_LOGO_LINUX_MONO is not set --# CONFIG_LOGO_LINUX_VGA16 is not set --CONFIG_SOUND=y --CONFIG_SND=y --CONFIG_SND_ALOOP=m --CONFIG_SND_HDA_TEGRA=m --CONFIG_SND_HDA_CODEC_HDMI=m --CONFIG_SND_SOC=y --CONFIG_SND_BCM2835_SOC_I2S=m --CONFIG_SND_SOC_FSL_ASRC=m --CONFIG_SND_SOC_FSL_MICFIL=m --CONFIG_SND_SOC_FSL_EASRC=m --CONFIG_SND_IMX_SOC=m --CONFIG_SND_SOC_IMX_SGTL5000=m --CONFIG_SND_SOC_IMX_SPDIF=m --CONFIG_SND_SOC_FSL_ASOC_CARD=m --CONFIG_SND_SOC_IMX_AUDMIX=m --CONFIG_SND_SOC_MT8183=m --CONFIG_SND_SOC_MT8183_MT6358_TS3A227E_MAX98357A=m --CONFIG_SND_SOC_MT8183_DA7219_MAX98357A=m --CONFIG_SND_SOC_MT8192=m --CONFIG_SND_SOC_MT8192_MT6359_RT1015_RT5682=m --CONFIG_SND_MESON_AXG_SOUND_CARD=m --CONFIG_SND_MESON_GX_SOUND_CARD=m --CONFIG_SND_SOC_QCOM=m --CONFIG_SND_SOC_APQ8016_SBC=m --CONFIG_SND_SOC_MSM8996=m --CONFIG_SND_SOC_SDM845=m --CONFIG_SND_SOC_SM8250=m --CONFIG_SND_SOC_SC7180=m --CONFIG_SND_SOC_SC7280=m --CONFIG_SND_SOC_ROCKCHIP=m --CONFIG_SND_SOC_ROCKCHIP_I2S_TDM=m --CONFIG_SND_SOC_ROCKCHIP_SPDIF=m --CONFIG_SND_SOC_ROCKCHIP_RT5645=m --CONFIG_SND_SOC_RK3399_GRU_SOUND=m --CONFIG_SND_SOC_SAMSUNG=y --CONFIG_SND_SOC_RCAR=m --CONFIG_SND_SOC_RZ=m --CONFIG_SND_SUN8I_CODEC=m --CONFIG_SND_SUN8I_CODEC_ANALOG=m --CONFIG_SND_SUN50I_CODEC_ANALOG=m --CONFIG_SND_SUN4I_I2S=m --CONFIG_SND_SUN4I_SPDIF=m --CONFIG_SND_SOC_TEGRA=m --CONFIG_SND_SOC_TEGRA210_AHUB=m --CONFIG_SND_SOC_TEGRA210_DMIC=m --CONFIG_SND_SOC_TEGRA210_I2S=m --CONFIG_SND_SOC_TEGRA210_OPE=m --CONFIG_SND_SOC_TEGRA186_ASRC=m --CONFIG_SND_SOC_TEGRA186_DSPK=m --CONFIG_SND_SOC_TEGRA210_ADMAIF=m --CONFIG_SND_SOC_TEGRA210_MVC=m --CONFIG_SND_SOC_TEGRA210_SFC=m --CONFIG_SND_SOC_TEGRA210_AMX=m --CONFIG_SND_SOC_TEGRA210_ADX=m --CONFIG_SND_SOC_TEGRA210_MIXER=m --CONFIG_SND_SOC_TEGRA_AUDIO_GRAPH_CARD=m --CONFIG_SND_SOC_DAVINCI_MCASP=m --CONFIG_SND_SOC_AK4613=m --CONFIG_SND_SOC_DA7213=m --CONFIG_SND_SOC_ES7134=m --CONFIG_SND_SOC_ES7241=m --CONFIG_SND_SOC_ES8316=m --CONFIG_SND_SOC_GTM601=m --CONFIG_SND_SOC_MSM8916_WCD_ANALOG=m --CONFIG_SND_SOC_MSM8916_WCD_DIGITAL=m --CONFIG_SND_SOC_PCM3168A_I2C=m --CONFIG_SND_SOC_RK817=m --CONFIG_SND_SOC_RT5640=m --CONFIG_SND_SOC_J721E_EVM=m --CONFIG_SND_SOC_RT5659=m --CONFIG_SND_SOC_SIMPLE_AMPLIFIER=m --CONFIG_SND_SOC_SIMPLE_MUX=m --CONFIG_SND_SOC_TAS2552=m --CONFIG_SND_SOC_TAS571X=m --CONFIG_SND_SOC_TLV320AIC32X4_I2C=m --CONFIG_SND_SOC_TLV320AIC3X_I2C=m --CONFIG_SND_SOC_WCD9335=m --CONFIG_SND_SOC_WCD934X=m --CONFIG_SND_SOC_WM8524=m --CONFIG_SND_SOC_WM8904=m --CONFIG_SND_SOC_WM8960=m --CONFIG_SND_SOC_WM8962=m --CONFIG_SND_SOC_WM8978=m --CONFIG_SND_SOC_WSA881X=m --CONFIG_SND_SOC_NAU8822=m --CONFIG_SND_SOC_LPASS_WSA_MACRO=m --CONFIG_SND_SOC_LPASS_VA_MACRO=m --CONFIG_SND_SOC_LPASS_RX_MACRO=m --CONFIG_SND_SOC_LPASS_TX_MACRO=m --CONFIG_SND_SIMPLE_CARD=m --CONFIG_SND_AUDIO_GRAPH_CARD=m --CONFIG_SND_AUDIO_GRAPH_CARD2=m --CONFIG_HID_MULTITOUCH=m --CONFIG_I2C_HID_ACPI=m --CONFIG_I2C_HID_OF=m --CONFIG_USB=y --CONFIG_USB_OTG=y --CONFIG_USB_XHCI_HCD=y --CONFIG_USB_XHCI_PCI_RENESAS=m --CONFIG_USB_XHCI_RZV2M=y --CONFIG_USB_XHCI_TEGRA=y --CONFIG_USB_BRCMSTB=m --CONFIG_USB_EHCI_HCD=y --CONFIG_USB_EHCI_EXYNOS=y --CONFIG_USB_EHCI_HCD_PLATFORM=y --CONFIG_USB_OHCI_HCD=y --CONFIG_USB_OHCI_EXYNOS=y --CONFIG_USB_OHCI_HCD_PLATFORM=y --CONFIG_USB_RENESAS_USBHS_HCD=m --CONFIG_USB_RENESAS_USBHS=m --CONFIG_USB_ACM=m --CONFIG_USB_STORAGE=y --CONFIG_USB_CDNS_SUPPORT=m --CONFIG_USB_CDNS3=m --CONFIG_USB_CDNS3_GADGET=y --CONFIG_USB_CDNS3_HOST=y --CONFIG_USB_MTU3=y --CONFIG_USB_MUSB_HDRC=y --CONFIG_USB_MUSB_SUNXI=y --CONFIG_USB_DWC3=y --CONFIG_USB_DWC2=y --CONFIG_USB_CHIPIDEA=y --CONFIG_USB_CHIPIDEA_UDC=y --CONFIG_USB_CHIPIDEA_HOST=y --CONFIG_USB_ISP1760=y --CONFIG_USB_SERIAL=m --CONFIG_USB_SERIAL_CP210X=m --CONFIG_USB_SERIAL_FTDI_SIO=m --CONFIG_USB_SERIAL_OPTION=m --CONFIG_USB_QCOM_EUD=m --CONFIG_USB_HSIC_USB3503=y --CONFIG_USB_ONBOARD_HUB=m --CONFIG_NOP_USB_XCEIV=y --CONFIG_USB_GADGET=y --CONFIG_USB_RENESAS_USBHS_UDC=m --CONFIG_USB_RZV2M_USB3DRD=y --CONFIG_USB_RENESAS_USB3=m --CONFIG_USB_TEGRA_XUDC=m --CONFIG_USB_CONFIGFS=m --CONFIG_USB_CONFIGFS_SERIAL=y --CONFIG_USB_CONFIGFS_ACM=y --CONFIG_USB_CONFIGFS_OBEX=y --CONFIG_USB_CONFIGFS_NCM=y --CONFIG_USB_CONFIGFS_ECM=y --CONFIG_USB_CONFIGFS_ECM_SUBSET=y --CONFIG_USB_CONFIGFS_RNDIS=y --CONFIG_USB_CONFIGFS_EEM=y --CONFIG_USB_CONFIGFS_MASS_STORAGE=y --CONFIG_USB_CONFIGFS_F_FS=y --CONFIG_TYPEC=m --CONFIG_TYPEC_TCPM=m --CONFIG_TYPEC_TCPCI=m --CONFIG_TYPEC_FUSB302=m --CONFIG_TYPEC_TPS6598X=m --CONFIG_TYPEC_HD3SS3220=m --CONFIG_TYPEC_UCSI=m --CONFIG_TYPEC_MUX_FSA4480=m --CONFIG_UCSI_CCG=m --CONFIG_TYPEC_MUX_GPIO_SBU=m --CONFIG_MMC=y --CONFIG_MMC_BLOCK_MINORS=32 --CONFIG_MMC_ARMMMCI=y --CONFIG_MMC_SDHCI=y --CONFIG_MMC_SDHCI_ACPI=y --CONFIG_MMC_SDHCI_PLTFM=y --CONFIG_MMC_SDHCI_OF_ARASAN=y --CONFIG_MMC_SDHCI_OF_ESDHC=y --CONFIG_MMC_SDHCI_OF_DWCMSHC=y --CONFIG_MMC_SDHCI_OF_SPARX5=y --CONFIG_MMC_SDHCI_CADENCE=y --CONFIG_MMC_SDHCI_ESDHC_IMX=y --CONFIG_MMC_SDHCI_TEGRA=y --CONFIG_MMC_SDHCI_F_SDH30=y --CONFIG_MMC_MESON_GX=y --CONFIG_MMC_SDHCI_MSM=y --CONFIG_MMC_SPI=y --CONFIG_MMC_SDHI=y --CONFIG_MMC_UNIPHIER=y --CONFIG_MMC_DW=y --CONFIG_MMC_DW_EXYNOS=y --CONFIG_MMC_DW_HI3798CV200=y --CONFIG_MMC_DW_K3=y --CONFIG_MMC_DW_ROCKCHIP=y --CONFIG_MMC_SUNXI=y --CONFIG_MMC_BCM2835=y --CONFIG_MMC_MTK=y --CONFIG_MMC_SDHCI_XENON=y --CONFIG_MMC_SDHCI_AM654=y --CONFIG_MMC_OWL=y --CONFIG_SCSI_UFSHCD=y --CONFIG_SCSI_UFS_BSG=y --CONFIG_SCSI_UFSHCD_PLATFORM=y --CONFIG_SCSI_UFS_CDNS_PLATFORM=m --CONFIG_SCSI_UFS_QCOM=m --CONFIG_SCSI_UFS_HISI=y --CONFIG_SCSI_UFS_RENESAS=m --CONFIG_SCSI_UFS_TI_J721E=m --CONFIG_SCSI_UFS_EXYNOS=y --CONFIG_NEW_LEDS=y --CONFIG_LEDS_CLASS=y --CONFIG_LEDS_CLASS_MULTICOLOR=m --CONFIG_LEDS_LM3692X=m --CONFIG_LEDS_PCA9532=m --CONFIG_LEDS_GPIO=y --CONFIG_LEDS_PWM=y --CONFIG_LEDS_SYSCON=y --CONFIG_LEDS_QCOM_LPG=m --CONFIG_LEDS_TRIGGER_TIMER=y --CONFIG_LEDS_TRIGGER_DISK=y --CONFIG_LEDS_TRIGGER_HEARTBEAT=y --CONFIG_LEDS_TRIGGER_CPU=y --CONFIG_LEDS_TRIGGER_DEFAULT_ON=y --CONFIG_LEDS_TRIGGER_PANIC=y --CONFIG_EDAC=y --CONFIG_EDAC_GHES=y --CONFIG_EDAC_LAYERSCAPE=m --CONFIG_RTC_CLASS=y --CONFIG_RTC_DRV_DS1307=m --CONFIG_RTC_DRV_HYM8563=m --CONFIG_RTC_DRV_MAX77686=y --CONFIG_RTC_DRV_RK808=m --CONFIG_RTC_DRV_ISL1208=m --CONFIG_RTC_DRV_PCF85063=m --CONFIG_RTC_DRV_PCF85363=m --CONFIG_RTC_DRV_M41T80=m --CONFIG_RTC_DRV_BQ32K=m --CONFIG_RTC_DRV_RX8581=m --CONFIG_RTC_DRV_RV3028=m --CONFIG_RTC_DRV_RV8803=m --CONFIG_RTC_DRV_S5M=y --CONFIG_RTC_DRV_DS3232=y --CONFIG_RTC_DRV_PCF2127=m --CONFIG_RTC_DRV_EFI=y --CONFIG_RTC_DRV_CROS_EC=y --CONFIG_RTC_DRV_FSL_FTM_ALARM=m --CONFIG_RTC_DRV_S3C=y --CONFIG_RTC_DRV_PL031=y --CONFIG_RTC_DRV_SUN6I=y --CONFIG_RTC_DRV_ARMADA38X=y --CONFIG_RTC_DRV_PM8XXX=m --CONFIG_RTC_DRV_TEGRA=y --CONFIG_RTC_DRV_SNVS=m --CONFIG_RTC_DRV_BBNSM=m --CONFIG_RTC_DRV_IMX_SC=m --CONFIG_RTC_DRV_MT6397=m --CONFIG_RTC_DRV_XGENE=y --CONFIG_RTC_DRV_TI_K3=m --CONFIG_DMADEVICES=y --CONFIG_DMA_BCM2835=y --CONFIG_DMA_SUN6I=m --CONFIG_FSL_EDMA=y --CONFIG_IMX_SDMA=m --CONFIG_K3_DMA=y --CONFIG_MV_XOR=y --CONFIG_MV_XOR_V2=y --CONFIG_OWL_DMA=y --CONFIG_PL330_DMA=y --CONFIG_TEGRA186_GPC_DMA=y --CONFIG_TEGRA20_APB_DMA=y --CONFIG_TEGRA210_ADMA=m --CONFIG_QCOM_BAM_DMA=y --CONFIG_QCOM_GPI_DMA=m --CONFIG_QCOM_HIDMA_MGMT=y --CONFIG_QCOM_HIDMA=y --CONFIG_RCAR_DMAC=y --CONFIG_RENESAS_USB_DMAC=m --CONFIG_RZ_DMAC=y --CONFIG_TI_K3_UDMA=y --CONFIG_TI_K3_UDMA_GLUE_LAYER=y --CONFIG_VFIO=y --CONFIG_VFIO_PCI=y --CONFIG_VIRTIO_PCI=y --CONFIG_VIRTIO_BALLOON=y --CONFIG_VIRTIO_MMIO=y --CONFIG_XEN_GNTDEV=y --CONFIG_XEN_GRANT_DEV_ALLOC=y --CONFIG_STAGING=y --CONFIG_STAGING_MEDIA=y --CONFIG_VIDEO_MAX96712=m --CONFIG_CHROME_PLATFORMS=y --CONFIG_CROS_EC=y --CONFIG_CROS_EC_I2C=y --CONFIG_CROS_EC_RPMSG=m --CONFIG_CROS_EC_SPI=y --CONFIG_CROS_EC_CHARDEV=m --CONFIG_COMMON_CLK_RK808=y --CONFIG_COMMON_CLK_SCMI=y --CONFIG_COMMON_CLK_SCPI=y --CONFIG_COMMON_CLK_CS2000_CP=y --CONFIG_COMMON_CLK_FSL_SAI=y --CONFIG_COMMON_CLK_S2MPS11=y --CONFIG_COMMON_CLK_PWM=y --CONFIG_COMMON_CLK_RS9_PCIE=y --CONFIG_COMMON_CLK_VC5=y --CONFIG_COMMON_CLK_BD718XX=m --CONFIG_CLK_RASPBERRYPI=m --CONFIG_CLK_IMX8MM=y --CONFIG_CLK_IMX8MN=y --CONFIG_CLK_IMX8MP=y --CONFIG_CLK_IMX8MQ=y --CONFIG_CLK_IMX8QXP=y --CONFIG_CLK_IMX8ULP=y --CONFIG_CLK_IMX93=y --CONFIG_TI_SCI_CLK=y --CONFIG_COMMON_CLK_MT8192_AUDSYS=y --CONFIG_COMMON_CLK_MT8192_CAMSYS=y --CONFIG_COMMON_CLK_MT8192_IMGSYS=y --CONFIG_COMMON_CLK_MT8192_IMP_IIC_WRAP=y --CONFIG_COMMON_CLK_MT8192_IPESYS=y --CONFIG_COMMON_CLK_MT8192_MDPSYS=y --CONFIG_COMMON_CLK_MT8192_MFGCFG=y --CONFIG_COMMON_CLK_MT8192_MMSYS=y --CONFIG_COMMON_CLK_MT8192_MSDC=y --CONFIG_COMMON_CLK_MT8192_SCP_ADSP=y --CONFIG_COMMON_CLK_MT8192_VDECSYS=y --CONFIG_COMMON_CLK_MT8192_VENCSYS=y --CONFIG_COMMON_CLK_QCOM=y --CONFIG_QCOM_A53PLL=y --CONFIG_QCOM_CLK_APCS_MSM8916=y --CONFIG_QCOM_CLK_APCC_MSM8996=y --CONFIG_QCOM_CLK_SMD_RPM=y --CONFIG_QCOM_CLK_RPMH=y --CONFIG_IPQ_APSS_6018=y --CONFIG_IPQ_GCC_5332=y --CONFIG_IPQ_APSS_5018=y --CONFIG_IPQ_GCC_5018=y --CONFIG_IPQ_GCC_6018=y --CONFIG_IPQ_GCC_8074=y --CONFIG_IPQ_GCC_9574=y --CONFIG_MSM_GCC_8916=y --CONFIG_MSM_GCC_8994=y --CONFIG_MSM_GCC_8996=y --CONFIG_MSM_MMCC_8994=m --CONFIG_MSM_MMCC_8996=m --CONFIG_MSM_MMCC_8998=m --CONFIG_MSM_GCC_8998=y --CONFIG_QCM_GCC_2290=y --CONFIG_QCM_DISPCC_2290=m --CONFIG_QCS_GCC_404=y --CONFIG_SA_GCC_8775P=y --CONFIG_SC_DISPCC_8280XP=m --CONFIG_SA_GPUCC_8775P=m --CONFIG_SC_GCC_7180=y --CONFIG_SC_GCC_7280=y --CONFIG_SC_GCC_8180X=y --CONFIG_SC_GCC_8280XP=y --CONFIG_SC_GPUCC_8280XP=m --CONFIG_SC_LPASSCC_8280XP=m --CONFIG_SDM_CAMCC_845=m --CONFIG_SDM_GPUCC_845=y --CONFIG_SDM_VIDEOCC_845=y --CONFIG_SDM_DISPCC_845=y --CONFIG_SDM_LPASSCC_845=m --CONFIG_SM_CAMCC_8250=m --CONFIG_SM_DISPCC_6115=m --CONFIG_SM_DISPCC_8250=y --CONFIG_SM_DISPCC_8450=m --CONFIG_SM_DISPCC_8550=m --CONFIG_SM_GCC_6115=y --CONFIG_SM_GCC_8350=y --CONFIG_SM_GCC_8450=y --CONFIG_SM_GCC_8550=y --CONFIG_SM_TCSRCC_8550=y --CONFIG_SM_GPUCC_6115=m --CONFIG_SM_GPUCC_8150=y --CONFIG_SM_GPUCC_8250=y --CONFIG_SM_VIDEOCC_8250=y --CONFIG_QCOM_HFPLL=y --CONFIG_CLK_GFM_LPASS_SM8250=m --CONFIG_CLK_RCAR_USB2_CLOCK_SEL=y --CONFIG_HWSPINLOCK=y --CONFIG_HWSPINLOCK_QCOM=y --CONFIG_TEGRA186_TIMER=y --CONFIG_RENESAS_OSTM=y --CONFIG_ARM_MHU=y --CONFIG_IMX_MBOX=y --CONFIG_OMAP2PLUS_MBOX=m --CONFIG_PLATFORM_MHU=y --CONFIG_BCM2835_MBOX=y --CONFIG_QCOM_APCS_IPC=y --CONFIG_QCOM_IPCC=y --CONFIG_ROCKCHIP_IOMMU=y --CONFIG_TEGRA_IOMMU_SMMU=y --CONFIG_ARM_SMMU=y --CONFIG_ARM_SMMU_V3=y --CONFIG_MTK_IOMMU=y --CONFIG_QCOM_IOMMU=y --CONFIG_REMOTEPROC=y --CONFIG_IMX_REMOTEPROC=y --CONFIG_TI_K3_R5_REMOTEPROC=m --CONFIG_TI_K3_DSP_REMOTEPROC=m --CONFIG_MTK_SCP=m --CONFIG_QCOM_Q6V5_ADSP=m --CONFIG_QCOM_Q6V5_MSS=m --CONFIG_QCOM_Q6V5_PAS=m --CONFIG_QCOM_SYSMON=m --CONFIG_QCOM_WCNSS_PIL=m --CONFIG_RPMSG_CHAR=m --CONFIG_RPMSG_CTRL=m --CONFIG_RPMSG_QCOM_GLINK_RPM=y --CONFIG_RPMSG_QCOM_GLINK_SMEM=m --CONFIG_RPMSG_QCOM_SMD=y --CONFIG_RPMSG_VIRTIO=y --CONFIG_SOUNDWIRE=m --CONFIG_SOUNDWIRE_QCOM=m --CONFIG_OWL_PM_DOMAINS=y --CONFIG_RASPBERRYPI_POWER=y --CONFIG_FSL_DPAA=y --CONFIG_FSL_MC_DPIO=y --CONFIG_FSL_RCPM=y --CONFIG_MTK_CMDQ=m --CONFIG_MTK_DEVAPC=m --CONFIG_MTK_PMIC_WRAP=y --CONFIG_MTK_SVS=m --CONFIG_QCOM_AOSS_QMP=y --CONFIG_QCOM_COMMAND_DB=y --CONFIG_QCOM_CPR=y --CONFIG_QCOM_GENI_SE=y --CONFIG_QCOM_LLCC=m --CONFIG_QCOM_OCMEM=m --CONFIG_QCOM_PMIC_GLINK=m --CONFIG_QCOM_RMTFS_MEM=m --CONFIG_QCOM_RPMH=y --CONFIG_QCOM_RPMHPD=y --CONFIG_QCOM_RPMPD=y --CONFIG_QCOM_SMEM=y --CONFIG_QCOM_SMD_RPM=y --CONFIG_QCOM_SMP2P=y --CONFIG_QCOM_SMSM=y --CONFIG_QCOM_SOCINFO=m --CONFIG_QCOM_SPM=m --CONFIG_QCOM_STATS=m --CONFIG_QCOM_WCNSS_CTRL=m --CONFIG_QCOM_APR=m --CONFIG_QCOM_ICC_BWMON=m --CONFIG_ARCH_R8A77995=y --CONFIG_ARCH_R8A77990=y --CONFIG_ARCH_R8A77951=y --CONFIG_ARCH_R8A77965=y --CONFIG_ARCH_R8A77960=y --CONFIG_ARCH_R8A77961=y --CONFIG_ARCH_R8A779F0=y --CONFIG_ARCH_R8A77980=y --CONFIG_ARCH_R8A77970=y --CONFIG_ARCH_R8A779A0=y --CONFIG_ARCH_R8A779G0=y --CONFIG_ARCH_R8A774C0=y --CONFIG_ARCH_R8A774E1=y --CONFIG_ARCH_R8A774A1=y --CONFIG_ARCH_R8A774B1=y --CONFIG_ARCH_R9A07G043=y --CONFIG_ARCH_R9A07G044=y --CONFIG_ARCH_R9A07G054=y --CONFIG_ARCH_R9A09G011=y --CONFIG_ROCKCHIP_IODOMAIN=y --CONFIG_ROCKCHIP_PM_DOMAINS=y --CONFIG_ARCH_TEGRA_132_SOC=y --CONFIG_ARCH_TEGRA_210_SOC=y --CONFIG_ARCH_TEGRA_186_SOC=y --CONFIG_ARCH_TEGRA_194_SOC=y --CONFIG_ARCH_TEGRA_234_SOC=y --CONFIG_TI_SCI_PM_DOMAINS=y --CONFIG_TI_PRUSS=m --CONFIG_ARM_IMX_BUS_DEVFREQ=y --CONFIG_ARM_IMX8M_DDRC_DEVFREQ=m --CONFIG_ARM_MEDIATEK_CCI_DEVFREQ=m --CONFIG_EXTCON_PTN5150=m --CONFIG_EXTCON_USB_GPIO=y --CONFIG_EXTCON_USBC_CROS_EC=y --CONFIG_RENESAS_RPCIF=m --CONFIG_IIO=y --CONFIG_EXYNOS_ADC=y --CONFIG_IMX93_ADC=m --CONFIG_MAX9611=m --CONFIG_MEDIATEK_MT6577_AUXADC=m --CONFIG_QCOM_SPMI_VADC=m --CONFIG_QCOM_SPMI_ADC5=m --CONFIG_ROCKCHIP_SARADC=m --CONFIG_RZG2L_ADC=m --CONFIG_TI_ADS1015=m --CONFIG_TI_AM335X_ADC=m --CONFIG_IIO_CROS_EC_SENSORS_CORE=m --CONFIG_IIO_CROS_EC_SENSORS=m --CONFIG_IIO_ST_LSM6DSX=m --CONFIG_IIO_CROS_EC_LIGHT_PROX=m --CONFIG_SENSORS_ISL29018=m --CONFIG_VCNL4000=m --CONFIG_IIO_ST_MAGN_3AXIS=m --CONFIG_IIO_CROS_EC_BARO=m --CONFIG_MPL3115=m --CONFIG_PWM=y --CONFIG_PWM_BCM2835=m --CONFIG_PWM_BRCMSTB=m --CONFIG_PWM_CROS_EC=m --CONFIG_PWM_IMX27=m --CONFIG_PWM_MESON=m --CONFIG_PWM_MTK_DISP=m --CONFIG_PWM_MEDIATEK=m --CONFIG_PWM_RCAR=m --CONFIG_PWM_RENESAS_TPU=m --CONFIG_PWM_ROCKCHIP=y --CONFIG_PWM_RZ_MTU3=m --CONFIG_PWM_SAMSUNG=y --CONFIG_PWM_SL28CPLD=m --CONFIG_PWM_SUN4I=m --CONFIG_PWM_TEGRA=m --CONFIG_PWM_TIECAP=m --CONFIG_PWM_TIEHRPWM=m --CONFIG_PWM_VISCONTI=m --CONFIG_SL28CPLD_INTC=y --CONFIG_QCOM_PDC=y --CONFIG_QCOM_MPM=y --CONFIG_RESET_IMX7=y --CONFIG_RESET_QCOM_AOSS=y --CONFIG_RESET_QCOM_PDC=m --CONFIG_RESET_RZG2L_USBPHY_CTRL=y --CONFIG_RESET_TI_SCI=y --CONFIG_PHY_XGENE=y --CONFIG_PHY_CAN_TRANSCEIVER=m --CONFIG_PHY_SUN4I_USB=y --CONFIG_PHY_CADENCE_TORRENT=m --CONFIG_PHY_CADENCE_SIERRA=m --CONFIG_PHY_MIXEL_MIPI_DPHY=m --CONFIG_PHY_FSL_IMX8M_PCIE=y --CONFIG_PHY_HI6220_USB=y --CONFIG_PHY_HISTB_COMBPHY=y --CONFIG_PHY_HISI_INNO_USB2=y --CONFIG_PHY_MVEBU_CP110_COMPHY=y --CONFIG_PHY_MTK_TPHY=y --CONFIG_PHY_QCOM_EDP=m --CONFIG_PHY_QCOM_EUSB2_REPEATER=m --CONFIG_PHY_QCOM_PCIE2=m --CONFIG_PHY_QCOM_QMP=m --CONFIG_PHY_QCOM_QUSB2=m --CONFIG_PHY_QCOM_SNPS_EUSB2=m --CONFIG_PHY_QCOM_USB_HS=m --CONFIG_PHY_QCOM_USB_SNPS_FEMTO_V2=m --CONFIG_PHY_QCOM_USB_HS_28NM=m --CONFIG_PHY_QCOM_USB_SS=m --CONFIG_PHY_QCOM_SGMII_ETH=m --CONFIG_PHY_R8A779F0_ETHERNET_SERDES=y --CONFIG_PHY_RCAR_GEN3_PCIE=y --CONFIG_PHY_RCAR_GEN3_USB2=y --CONFIG_PHY_RCAR_GEN3_USB3=m --CONFIG_PHY_ROCKCHIP_EMMC=y --CONFIG_PHY_ROCKCHIP_INNO_HDMI=m --CONFIG_PHY_ROCKCHIP_INNO_USB2=y --CONFIG_PHY_ROCKCHIP_INNO_DSIDPHY=m --CONFIG_PHY_ROCKCHIP_NANENG_COMBO_PHY=m --CONFIG_PHY_ROCKCHIP_PCIE=m --CONFIG_PHY_ROCKCHIP_SNPS_PCIE3=y --CONFIG_PHY_ROCKCHIP_TYPEC=y --CONFIG_PHY_SAMSUNG_UFS=y --CONFIG_PHY_UNIPHIER_USB2=y --CONFIG_PHY_UNIPHIER_USB3=y --CONFIG_PHY_TEGRA_XUSB=y --CONFIG_PHY_AM654_SERDES=m --CONFIG_PHY_J721E_WIZ=m --CONFIG_ARM_CCI_PMU=m --CONFIG_ARM_CCN=m --CONFIG_ARM_CMN=m --CONFIG_ARM_CORESIGHT_PMU_ARCH_SYSTEM_PMU=m --CONFIG_ARM_SMMU_V3_PMU=m --CONFIG_ARM_DSU_PMU=m --CONFIG_FSL_IMX8_DDR_PMU=m --CONFIG_QCOM_L2_PMU=y --CONFIG_QCOM_L3_PMU=y --CONFIG_ARM_SPE_PMU=m --CONFIG_ARM_DMC620_PMU=m --CONFIG_HISI_PMU=y --CONFIG_NVMEM_LAYOUT_SL28_VPD=m --CONFIG_NVMEM_IMX_OCOTP=y --CONFIG_NVMEM_IMX_OCOTP_ELE=m --CONFIG_NVMEM_IMX_OCOTP_SCU=y --CONFIG_NVMEM_LAYERSCAPE_SFP=m --CONFIG_NVMEM_MESON_EFUSE=m --CONFIG_NVMEM_MTK_EFUSE=y --CONFIG_NVMEM_QCOM_QFPROM=y --CONFIG_NVMEM_RMEM=m --CONFIG_NVMEM_ROCKCHIP_EFUSE=y --CONFIG_NVMEM_ROCKCHIP_OTP=y --CONFIG_NVMEM_SNVS_LPGPR=y --CONFIG_NVMEM_SPMI_SDAM=m --CONFIG_NVMEM_SUNXI_SID=y --CONFIG_NVMEM_UNIPHIER_EFUSE=y --CONFIG_FPGA=y --CONFIG_FPGA_MGR_ALTERA_CVP=m --CONFIG_FPGA_MGR_STRATIX10_SOC=m --CONFIG_FPGA_BRIDGE=m --CONFIG_ALTERA_FREEZE_BRIDGE=m --CONFIG_FPGA_REGION=m --CONFIG_OF_FPGA_REGION=m --CONFIG_TEE=y --CONFIG_OPTEE=y --CONFIG_MUX_GPIO=m --CONFIG_MUX_MMIO=y --CONFIG_SLIMBUS=m --CONFIG_SLIM_QCOM_CTRL=m --CONFIG_SLIM_QCOM_NGD_CTRL=m --CONFIG_INTERCONNECT=y --CONFIG_INTERCONNECT_IMX=y --CONFIG_INTERCONNECT_IMX8MM=m --CONFIG_INTERCONNECT_IMX8MN=m --CONFIG_INTERCONNECT_IMX8MQ=m --CONFIG_INTERCONNECT_IMX8MP=y --CONFIG_INTERCONNECT_QCOM=y --CONFIG_INTERCONNECT_QCOM_MSM8916=m --CONFIG_INTERCONNECT_QCOM_MSM8996=m --CONFIG_INTERCONNECT_QCOM_OSM_L3=m --CONFIG_INTERCONNECT_QCOM_QCM2290=m --CONFIG_INTERCONNECT_QCOM_QCS404=m --CONFIG_INTERCONNECT_QCOM_SA8775P=y --CONFIG_INTERCONNECT_QCOM_SC7180=y --CONFIG_INTERCONNECT_QCOM_SC7280=y --CONFIG_INTERCONNECT_QCOM_SC8180X=y --CONFIG_INTERCONNECT_QCOM_SC8280XP=y --CONFIG_INTERCONNECT_QCOM_SDM845=y --CONFIG_INTERCONNECT_QCOM_SM8150=m --CONFIG_INTERCONNECT_QCOM_SM8250=m --CONFIG_INTERCONNECT_QCOM_SM8350=m --CONFIG_INTERCONNECT_QCOM_SM8450=y --CONFIG_INTERCONNECT_QCOM_SM8550=y --CONFIG_COUNTER=m --CONFIG_RZ_MTU3_CNT=m --CONFIG_HTE=y --CONFIG_HTE_TEGRA194=y --CONFIG_HTE_TEGRA194_TEST=m --CONFIG_EXT2_FS=y --CONFIG_EXT3_FS=y --CONFIG_EXT4_FS_POSIX_ACL=y --CONFIG_BTRFS_FS=m --CONFIG_BTRFS_FS_POSIX_ACL=y --CONFIG_FANOTIFY=y --CONFIG_FANOTIFY_ACCESS_PERMISSIONS=y --CONFIG_QUOTA=y --CONFIG_AUTOFS_FS=y --CONFIG_FUSE_FS=m --CONFIG_CUSE=m --CONFIG_OVERLAY_FS=m --CONFIG_VFAT_FS=y --CONFIG_TMPFS_POSIX_ACL=y --CONFIG_HUGETLBFS=y --CONFIG_CONFIGFS_FS=y --CONFIG_EFIVAR_FS=y --CONFIG_SQUASHFS=y --CONFIG_NFS_FS=y --CONFIG_NFS_V4=y --CONFIG_NFS_V4_1=y --CONFIG_NFS_V4_2=y --CONFIG_ROOT_NFS=y --CONFIG_9P_FS=y --CONFIG_NLS_CODEPAGE_437=y --CONFIG_NLS_ISO8859_1=y --CONFIG_SECURITY=y --CONFIG_CRYPTO_USER=y --CONFIG_CRYPTO_TEST=m --CONFIG_CRYPTO_ECHAINIV=y --CONFIG_CRYPTO_MICHAEL_MIC=m --CONFIG_CRYPTO_ANSI_CPRNG=y --CONFIG_CRYPTO_USER_API_RNG=m --CONFIG_CRYPTO_CHACHA20_NEON=m --CONFIG_CRYPTO_GHASH_ARM64_CE=y --CONFIG_CRYPTO_SHA1_ARM64_CE=y --CONFIG_CRYPTO_SHA2_ARM64_CE=y --CONFIG_CRYPTO_SHA512_ARM64_CE=m --CONFIG_CRYPTO_SHA3_ARM64=m --CONFIG_CRYPTO_SM3_ARM64_CE=m --CONFIG_CRYPTO_AES_ARM64_CE_BLK=y --CONFIG_CRYPTO_AES_ARM64_BS=m --CONFIG_CRYPTO_AES_ARM64_CE_CCM=y --CONFIG_CRYPTO_CRCT10DIF_ARM64_CE=m --CONFIG_CRYPTO_DEV_SUN8I_CE=m --CONFIG_CRYPTO_DEV_FSL_CAAM=m --CONFIG_CRYPTO_DEV_FSL_DPAA2_CAAM=m --CONFIG_CRYPTO_DEV_QCE=m --CONFIG_CRYPTO_DEV_QCOM_RNG=m --CONFIG_CRYPTO_DEV_CCREE=m --CONFIG_CRYPTO_DEV_HISI_SEC2=m --CONFIG_CRYPTO_DEV_HISI_ZIP=m --CONFIG_CRYPTO_DEV_HISI_HPRE=m --CONFIG_CRYPTO_DEV_HISI_TRNG=m --CONFIG_CRYPTO_DEV_SA2UL=m --CONFIG_DMA_RESTRICTED_POOL=y --CONFIG_CMA_SIZE_MBYTES=32 --CONFIG_PRINTK_TIME=y --CONFIG_DEBUG_KERNEL=y --CONFIG_DEBUG_INFO_DWARF_TOOLCHAIN_DEFAULT=y --CONFIG_DEBUG_INFO_REDUCED=y --CONFIG_MAGIC_SYSRQ=y --CONFIG_DEBUG_FS=y --# CONFIG_SCHED_DEBUG is not set --# CONFIG_DEBUG_PREEMPT is not set --# CONFIG_FTRACE is not set --CONFIG_CORESIGHT=m --CONFIG_CORESIGHT_LINK_AND_SINK_TMC=m --CONFIG_CORESIGHT_CATU=m --CONFIG_CORESIGHT_SINK_TPIU=m --CONFIG_CORESIGHT_SINK_ETBV10=m --CONFIG_CORESIGHT_STM=m --CONFIG_CORESIGHT_CPU_DEBUG=m --CONFIG_CORESIGHT_CTI=m --CONFIG_MEMTEST=y -diff --git a/arch/arm64/configs/phytium_standard_defconfig b/arch/arm64/configs/phytium_standard_defconfig -new file mode 100644 -index 000000000..e72ecef11 ---- /dev/null -+++ b/arch/arm64/configs/phytium_standard_defconfig -@@ -0,0 +1,8833 @@ -+# -+# Automatically generated file; DO NOT EDIT. -+# Linux/arm64 6.6.22 Kernel Configuration -+# -+CONFIG_CC_VERSION_TEXT="OHOS (dev) clang version 15.0.4 (llvm-project 81cdec3cd117b1e6e3a9f1ebc4695d790c978463)" -+CONFIG_GCC_VERSION=0 -+CONFIG_CC_IS_CLANG=y -+CONFIG_CLANG_VERSION=150004 -+CONFIG_AS_IS_LLVM=y -+CONFIG_AS_VERSION=150004 -+CONFIG_LD_VERSION=0 -+CONFIG_LD_IS_LLD=y -+CONFIG_LLD_VERSION=150004 -+CONFIG_CC_CAN_LINK=y -+CONFIG_CC_CAN_LINK_STATIC=y -+CONFIG_CC_HAS_ASM_GOTO_OUTPUT=y -+CONFIG_CC_HAS_ASM_GOTO_TIED_OUTPUT=y -+CONFIG_TOOLS_SUPPORT_RELR=y -+CONFIG_CC_HAS_ASM_INLINE=y -+CONFIG_CC_HAS_NO_PROFILE_FN_ATTR=y -+CONFIG_PAHOLE_VERSION=0 -+CONFIG_IRQ_WORK=y -+CONFIG_BUILDTIME_TABLE_SORT=y -+CONFIG_THREAD_INFO_IN_TASK=y -+ -+# -+# General setup -+# -+CONFIG_INIT_ENV_ARG_LIMIT=32 -+# CONFIG_COMPILE_TEST is not set -+# CONFIG_WERROR is not set -+CONFIG_LOCALVERSION="" -+CONFIG_LOCALVERSION_AUTO=y -+CONFIG_BUILD_SALT="" -+CONFIG_DEFAULT_INIT="" -+CONFIG_DEFAULT_HOSTNAME="(none)" -+CONFIG_SYSVIPC=y -+CONFIG_SYSVIPC_SYSCTL=y -+CONFIG_SYSVIPC_COMPAT=y -+CONFIG_POSIX_MQUEUE=y -+CONFIG_POSIX_MQUEUE_SYSCTL=y -+# CONFIG_WATCH_QUEUE is not set -+CONFIG_CROSS_MEMORY_ATTACH=y -+# CONFIG_USELIB is not set -+CONFIG_AUDIT=y -+CONFIG_HAVE_ARCH_AUDITSYSCALL=y -+CONFIG_AUDITSYSCALL=y -+ -+# -+# IRQ subsystem -+# -+CONFIG_GENERIC_IRQ_PROBE=y -+CONFIG_GENERIC_IRQ_SHOW=y -+CONFIG_GENERIC_IRQ_SHOW_LEVEL=y -+CONFIG_GENERIC_IRQ_EFFECTIVE_AFF_MASK=y -+CONFIG_GENERIC_IRQ_MIGRATION=y -+CONFIG_HARDIRQS_SW_RESEND=y -+CONFIG_GENERIC_IRQ_CHIP=y -+CONFIG_IRQ_DOMAIN=y -+CONFIG_IRQ_DOMAIN_HIERARCHY=y -+CONFIG_GENERIC_IRQ_IPI=y -+CONFIG_GENERIC_MSI_IRQ=y -+CONFIG_IRQ_MSI_IOMMU=y -+CONFIG_IRQ_FORCED_THREADING=y -+CONFIG_SPARSE_IRQ=y -+# CONFIG_GENERIC_IRQ_DEBUGFS is not set -+# end of IRQ subsystem -+ -+CONFIG_GENERIC_TIME_VSYSCALL=y -+CONFIG_GENERIC_CLOCKEVENTS=y -+CONFIG_ARCH_HAS_TICK_BROADCAST=y -+CONFIG_GENERIC_CLOCKEVENTS_BROADCAST=y -+CONFIG_HAVE_POSIX_CPU_TIMERS_TASK_WORK=y -+CONFIG_POSIX_CPU_TIMERS_TASK_WORK=y -+CONFIG_CONTEXT_TRACKING=y -+CONFIG_CONTEXT_TRACKING_IDLE=y -+ -+# -+# Timers subsystem -+# -+CONFIG_TICK_ONESHOT=y -+CONFIG_NO_HZ_COMMON=y -+# CONFIG_HZ_PERIODIC is not set -+CONFIG_NO_HZ_IDLE=y -+# CONFIG_NO_HZ_FULL is not set -+CONFIG_NO_HZ=y -+CONFIG_HIGH_RES_TIMERS=y -+# end of Timers subsystem -+ -+CONFIG_BPF=y -+CONFIG_HAVE_EBPF_JIT=y -+CONFIG_ARCH_WANT_DEFAULT_BPF_JIT=y -+ -+# -+# BPF subsystem -+# -+CONFIG_BPF_SYSCALL=y -+CONFIG_BPF_JIT=y -+# CONFIG_BPF_JIT_ALWAYS_ON is not set -+CONFIG_BPF_JIT_DEFAULT_ON=y -+CONFIG_BPF_UNPRIV_DEFAULT_OFF=y -+# CONFIG_BPF_PRELOAD is not set -+# CONFIG_BPF_LSM is not set -+# end of BPF subsystem -+ -+CONFIG_PREEMPT_BUILD=y -+# CONFIG_PREEMPT_NONE is not set -+# CONFIG_PREEMPT_VOLUNTARY is not set -+CONFIG_PREEMPT=y -+CONFIG_PREEMPT_COUNT=y -+CONFIG_PREEMPTION=y -+# CONFIG_PREEMPT_DYNAMIC is not set -+# CONFIG_SCHED_CORE is not set -+ -+# -+# CPU/Task time and stats accounting -+# -+CONFIG_TICK_CPU_ACCOUNTING=y -+# CONFIG_VIRT_CPU_ACCOUNTING_GEN is not set -+CONFIG_IRQ_TIME_ACCOUNTING=y -+CONFIG_HAVE_SCHED_AVG_IRQ=y -+CONFIG_SCHED_THERMAL_PRESSURE=y -+CONFIG_BSD_PROCESS_ACCT=y -+CONFIG_BSD_PROCESS_ACCT_V3=y -+CONFIG_TASKSTATS=y -+# CONFIG_TASK_DELAY_ACCT is not set -+CONFIG_TASK_XACCT=y -+CONFIG_TASK_IO_ACCOUNTING=y -+CONFIG_PSI=y -+# CONFIG_PSI_DEFAULT_DISABLED is not set -+# end of CPU/Task time and stats accounting -+ -+CONFIG_CPU_ISOLATION=y -+ -+# -+# RCU Subsystem -+# -+CONFIG_TREE_RCU=y -+CONFIG_PREEMPT_RCU=y -+# CONFIG_RCU_EXPERT is not set -+CONFIG_TREE_SRCU=y -+CONFIG_TASKS_RCU_GENERIC=y -+CONFIG_TASKS_RCU=y -+CONFIG_TASKS_RUDE_RCU=y -+CONFIG_TASKS_TRACE_RCU=y -+CONFIG_RCU_STALL_COMMON=y -+CONFIG_RCU_NEED_SEGCBLIST=y -+# end of RCU Subsystem -+ -+CONFIG_IKCONFIG=y -+CONFIG_IKCONFIG_PROC=y -+# CONFIG_IKHEADERS is not set -+CONFIG_LOG_BUF_SHIFT=17 -+CONFIG_LOG_CPU_MAX_BUF_SHIFT=12 -+# CONFIG_PRINTK_INDEX is not set -+CONFIG_GENERIC_SCHED_CLOCK=y -+ -+# -+# Scheduler features -+# -+# CONFIG_UCLAMP_TASK is not set -+# CONFIG_SCHED_LATENCY_NICE is not set -+# end of Scheduler features -+ -+CONFIG_ARCH_SUPPORTS_NUMA_BALANCING=y -+CONFIG_ARCH_WANT_BATCHED_UNMAP_TLB_FLUSH=y -+CONFIG_CC_HAS_INT128=y -+CONFIG_CC_IMPLICIT_FALLTHROUGH="-Wimplicit-fallthrough" -+CONFIG_GCC11_NO_ARRAY_BOUNDS=y -+CONFIG_ARCH_SUPPORTS_INT128=y -+CONFIG_NUMA_BALANCING=y -+CONFIG_NUMA_BALANCING_DEFAULT_ENABLED=y -+CONFIG_CGROUPS=y -+CONFIG_PAGE_COUNTER=y -+# CONFIG_CGROUP_FAVOR_DYNMODS is not set -+CONFIG_MEMCG=y -+CONFIG_MEMCG_KMEM=y -+CONFIG_BLK_CGROUP=y -+CONFIG_CGROUP_WRITEBACK=y -+CONFIG_CGROUP_SCHED=y -+CONFIG_FAIR_GROUP_SCHED=y -+# CONFIG_CFS_BANDWIDTH is not set -+# CONFIG_RT_GROUP_SCHED is not set -+CONFIG_SCHED_MM_CID=y -+CONFIG_CGROUP_PIDS=y -+# CONFIG_CGROUP_RDMA is not set -+CONFIG_CGROUP_FREEZER=y -+CONFIG_CGROUP_HUGETLB=y -+CONFIG_CPUSETS=y -+CONFIG_PROC_PID_CPUSET=y -+CONFIG_CGROUP_DEVICE=y -+CONFIG_CGROUP_CPUACCT=y -+CONFIG_CGROUP_PERF=y -+CONFIG_CGROUP_BPF=y -+# CONFIG_CGROUP_MISC is not set -+# CONFIG_CGROUP_DEBUG is not set -+CONFIG_SOCK_CGROUP_DATA=y -+CONFIG_NAMESPACES=y -+CONFIG_UTS_NS=y -+CONFIG_TIME_NS=y -+CONFIG_IPC_NS=y -+CONFIG_USER_NS=y -+CONFIG_PID_NS=y -+CONFIG_NET_NS=y -+# CONFIG_CHECKPOINT_RESTORE is not set -+CONFIG_SCHED_AUTOGROUP=y -+CONFIG_RELAY=y -+CONFIG_BLK_DEV_INITRD=y -+CONFIG_INITRAMFS_SOURCE="" -+CONFIG_RD_GZIP=y -+CONFIG_RD_BZIP2=y -+CONFIG_RD_LZMA=y -+CONFIG_RD_XZ=y -+CONFIG_RD_LZO=y -+CONFIG_RD_LZ4=y -+CONFIG_RD_ZSTD=y -+# CONFIG_BOOT_CONFIG is not set -+CONFIG_INITRAMFS_PRESERVE_MTIME=y -+CONFIG_CC_OPTIMIZE_FOR_PERFORMANCE=y -+# CONFIG_CC_OPTIMIZE_FOR_SIZE is not set -+CONFIG_LD_ORPHAN_WARN=y -+CONFIG_LD_ORPHAN_WARN_LEVEL="warn" -+CONFIG_SYSCTL=y -+CONFIG_HAVE_UID16=y -+CONFIG_SYSCTL_EXCEPTION_TRACE=y -+# CONFIG_EXPERT is not set -+CONFIG_UID16=y -+CONFIG_MULTIUSER=y -+CONFIG_SYSFS_SYSCALL=y -+CONFIG_FHANDLE=y -+CONFIG_POSIX_TIMERS=y -+CONFIG_PRINTK=y -+CONFIG_BUG=y -+CONFIG_ELF_CORE=y -+CONFIG_BASE_FULL=y -+CONFIG_FUTEX=y -+CONFIG_FUTEX_PI=y -+CONFIG_EPOLL=y -+CONFIG_SIGNALFD=y -+CONFIG_TIMERFD=y -+CONFIG_EVENTFD=y -+CONFIG_SHMEM=y -+CONFIG_AIO=y -+CONFIG_IO_URING=y -+CONFIG_ADVISE_SYSCALLS=y -+CONFIG_MEMBARRIER=y -+CONFIG_KALLSYMS=y -+# CONFIG_KALLSYMS_SELFTEST is not set -+CONFIG_KALLSYMS_ALL=y -+CONFIG_KALLSYMS_BASE_RELATIVE=y -+CONFIG_ARCH_HAS_MEMBARRIER_SYNC_CORE=y -+CONFIG_KCMP=y -+CONFIG_RSEQ=y -+CONFIG_CACHESTAT_SYSCALL=y -+CONFIG_HAVE_PERF_EVENTS=y -+CONFIG_GUEST_PERF_EVENTS=y -+ -+# -+# Kernel Performance Events And Counters -+# -+CONFIG_PERF_EVENTS=y -+# CONFIG_DEBUG_PERF_USE_VMALLOC is not set -+# end of Kernel Performance Events And Counters -+ -+CONFIG_SYSTEM_DATA_VERIFICATION=y -+CONFIG_PROFILING=y -+CONFIG_TRACEPOINTS=y -+ -+# -+# Kexec and crash features -+# -+CONFIG_CRASH_CORE=y -+CONFIG_KEXEC_CORE=y -+CONFIG_KEXEC=y -+CONFIG_KEXEC_FILE=y -+# CONFIG_KEXEC_SIG is not set -+CONFIG_CRASH_DUMP=y -+# end of Kexec and crash features -+# end of General setup -+ -+CONFIG_ARM64=y -+CONFIG_CLANG_SUPPORTS_DYNAMIC_FTRACE_WITH_ARGS=y -+CONFIG_64BIT=y -+CONFIG_MMU=y -+CONFIG_ARM64_PAGE_SHIFT=12 -+CONFIG_ARM64_CONT_PTE_SHIFT=4 -+CONFIG_ARM64_CONT_PMD_SHIFT=4 -+CONFIG_ARCH_MMAP_RND_BITS_MIN=18 -+CONFIG_ARCH_MMAP_RND_BITS_MAX=33 -+CONFIG_ARCH_MMAP_RND_COMPAT_BITS_MIN=11 -+CONFIG_ARCH_MMAP_RND_COMPAT_BITS_MAX=16 -+CONFIG_STACKTRACE_SUPPORT=y -+CONFIG_ILLEGAL_POINTER_VALUE=0xdead000000000000 -+CONFIG_LOCKDEP_SUPPORT=y -+CONFIG_GENERIC_BUG=y -+CONFIG_GENERIC_BUG_RELATIVE_POINTERS=y -+CONFIG_GENERIC_HWEIGHT=y -+CONFIG_GENERIC_CSUM=y -+CONFIG_GENERIC_CALIBRATE_DELAY=y -+CONFIG_SMP=y -+CONFIG_KERNEL_MODE_NEON=y -+CONFIG_FIX_EARLYCON_MEM=y -+CONFIG_PGTABLE_LEVELS=4 -+CONFIG_ARCH_SUPPORTS_UPROBES=y -+CONFIG_ARCH_PROC_KCORE_TEXT=y -+CONFIG_BUILTIN_RETURN_ADDRESS_STRIPS_PAC=y -+ -+# -+# Platform selection -+# -+# CONFIG_ARCH_ACTIONS is not set -+# CONFIG_ARCH_SUNXI is not set -+# CONFIG_ARCH_ALPINE is not set -+# CONFIG_ARCH_APPLE is not set -+# CONFIG_ARCH_BCM is not set -+# CONFIG_ARCH_BERLIN is not set -+# CONFIG_ARCH_BITMAIN is not set -+# CONFIG_ARCH_EXYNOS is not set -+# CONFIG_ARCH_SPARX5 is not set -+# CONFIG_ARCH_K3 is not set -+# CONFIG_ARCH_LG1K is not set -+# CONFIG_ARCH_HISI is not set -+# CONFIG_ARCH_KEEMBAY is not set -+# CONFIG_ARCH_MEDIATEK is not set -+# CONFIG_ARCH_MESON is not set -+# CONFIG_ARCH_MVEBU is not set -+# CONFIG_ARCH_NXP is not set -+# CONFIG_ARCH_MA35 is not set -+# CONFIG_ARCH_NPCM is not set -+CONFIG_ARCH_PHYTIUM=y -+# CONFIG_ARCH_QCOM is not set -+# CONFIG_ARCH_REALTEK is not set -+# CONFIG_ARCH_RENESAS is not set -+# CONFIG_ARCH_ROCKCHIP is not set -+# CONFIG_ARCH_SEATTLE is not set -+# CONFIG_ARCH_INTEL_SOCFPGA is not set -+# CONFIG_ARCH_STM32 is not set -+# CONFIG_ARCH_SYNQUACER is not set -+# CONFIG_ARCH_TEGRA is not set -+# CONFIG_ARCH_SPRD is not set -+# CONFIG_ARCH_THUNDER is not set -+# CONFIG_ARCH_THUNDER2 is not set -+# CONFIG_ARCH_UNIPHIER is not set -+# CONFIG_ARCH_VEXPRESS is not set -+# CONFIG_ARCH_VISCONTI is not set -+# CONFIG_ARCH_XGENE is not set -+# CONFIG_ARCH_ZYNQMP is not set -+# end of Platform selection -+ -+# -+# Kernel Features -+# -+ -+# -+# ARM errata workarounds via the alternatives framework -+# -+CONFIG_AMPERE_ERRATUM_AC03_CPU_38=y -+CONFIG_ARM64_WORKAROUND_CLEAN_CACHE=y -+CONFIG_ARM64_ERRATUM_826319=y -+CONFIG_ARM64_ERRATUM_827319=y -+CONFIG_ARM64_ERRATUM_824069=y -+CONFIG_ARM64_ERRATUM_819472=y -+CONFIG_ARM64_ERRATUM_832075=y -+CONFIG_ARM64_ERRATUM_834220=y -+CONFIG_ARM64_ERRATUM_1742098=y -+CONFIG_ARM64_ERRATUM_845719=y -+CONFIG_ARM64_ERRATUM_843419=y -+CONFIG_ARM64_LD_HAS_FIX_ERRATUM_843419=y -+CONFIG_ARM64_ERRATUM_1024718=y -+CONFIG_ARM64_ERRATUM_1418040=y -+CONFIG_ARM64_WORKAROUND_SPECULATIVE_AT=y -+CONFIG_ARM64_ERRATUM_1165522=y -+CONFIG_ARM64_ERRATUM_1319367=y -+CONFIG_ARM64_ERRATUM_1530923=y -+CONFIG_ARM64_WORKAROUND_REPEAT_TLBI=y -+CONFIG_ARM64_ERRATUM_2441007=y -+CONFIG_ARM64_ERRATUM_1286807=y -+CONFIG_ARM64_ERRATUM_1463225=y -+CONFIG_ARM64_ERRATUM_1542419=y -+CONFIG_ARM64_ERRATUM_1508412=y -+CONFIG_ARM64_ERRATUM_2051678=y -+CONFIG_ARM64_ERRATUM_2077057=y -+CONFIG_ARM64_ERRATUM_2658417=y -+CONFIG_ARM64_WORKAROUND_TSB_FLUSH_FAILURE=y -+CONFIG_ARM64_ERRATUM_2054223=y -+CONFIG_ARM64_ERRATUM_2067961=y -+CONFIG_ARM64_ERRATUM_2441009=y -+CONFIG_ARM64_ERRATUM_2457168=y -+CONFIG_ARM64_ERRATUM_2645198=y -+CONFIG_ARM64_WORKAROUND_SPECULATIVE_UNPRIV_LOAD=y -+CONFIG_ARM64_ERRATUM_2966298=y -+CONFIG_ARM64_ERRATUM_3117295=y -+CONFIG_CAVIUM_ERRATUM_22375=y -+CONFIG_CAVIUM_ERRATUM_23144=y -+CONFIG_CAVIUM_ERRATUM_23154=y -+CONFIG_CAVIUM_ERRATUM_27456=y -+CONFIG_CAVIUM_ERRATUM_30115=y -+CONFIG_CAVIUM_TX2_ERRATUM_219=y -+CONFIG_FUJITSU_ERRATUM_010001=y -+CONFIG_HISILICON_ERRATUM_161600802=y -+CONFIG_QCOM_FALKOR_ERRATUM_1003=y -+CONFIG_QCOM_FALKOR_ERRATUM_1009=y -+CONFIG_QCOM_QDF2400_ERRATUM_0065=y -+CONFIG_QCOM_FALKOR_ERRATUM_E1041=y -+CONFIG_NVIDIA_CARMEL_CNP_ERRATUM=y -+CONFIG_ROCKCHIP_ERRATUM_3588001=y -+CONFIG_SOCIONEXT_SYNQUACER_PREITS=y -+# end of ARM errata workarounds via the alternatives framework -+ -+CONFIG_ARM64_4K_PAGES=y -+# CONFIG_ARM64_16K_PAGES is not set -+# CONFIG_ARM64_64K_PAGES is not set -+# CONFIG_ARM64_VA_BITS_39 is not set -+CONFIG_ARM64_VA_BITS_48=y -+CONFIG_ARM64_VA_BITS=48 -+CONFIG_ARM64_PA_BITS_48=y -+CONFIG_ARM64_PA_BITS=48 -+# CONFIG_CPU_BIG_ENDIAN is not set -+CONFIG_CPU_LITTLE_ENDIAN=y -+CONFIG_SCHED_MC=y -+# CONFIG_SCHED_CLUSTER is not set -+CONFIG_SCHED_SMT=y -+CONFIG_NR_CPUS=256 -+CONFIG_HOTPLUG_CPU=y -+# CONFIG_ARM64_ERR_RECOV is not set -+CONFIG_NUMA=y -+CONFIG_NODES_SHIFT=4 -+# CONFIG_HZ_100 is not set -+CONFIG_HZ_250=y -+# CONFIG_HZ_300 is not set -+# CONFIG_HZ_1000 is not set -+CONFIG_HZ=250 -+CONFIG_SCHED_HRTICK=y -+CONFIG_ARCH_SPARSEMEM_ENABLE=y -+CONFIG_HW_PERF_EVENTS=y -+CONFIG_CC_HAVE_SHADOW_CALL_STACK=y -+CONFIG_PARAVIRT=y -+# CONFIG_PARAVIRT_TIME_ACCOUNTING is not set -+CONFIG_ARCH_SUPPORTS_KEXEC=y -+CONFIG_ARCH_SUPPORTS_KEXEC_FILE=y -+CONFIG_ARCH_SELECTS_KEXEC_FILE=y -+CONFIG_ARCH_SUPPORTS_KEXEC_SIG=y -+CONFIG_ARCH_SUPPORTS_KEXEC_IMAGE_VERIFY_SIG=y -+CONFIG_ARCH_DEFAULT_KEXEC_IMAGE_VERIFY_SIG=y -+CONFIG_ARCH_SUPPORTS_CRASH_DUMP=y -+CONFIG_TRANS_TABLE=y -+CONFIG_XEN_DOM0=y -+CONFIG_XEN=y -+CONFIG_ARCH_FORCE_MAX_ORDER=10 -+CONFIG_UNMAP_KERNEL_AT_EL0=y -+CONFIG_MITIGATE_SPECTRE_BRANCH_HISTORY=y -+CONFIG_RODATA_FULL_DEFAULT_ENABLED=y -+# CONFIG_ARM64_SW_TTBR0_PAN is not set -+CONFIG_ARM64_TAGGED_ADDR_ABI=y -+CONFIG_COMPAT=y -+CONFIG_KUSER_HELPERS=y -+CONFIG_COMPAT_VDSO=y -+CONFIG_THUMB2_COMPAT_VDSO=y -+# CONFIG_COMPAT_ALIGNMENT_FIXUPS is not set -+# CONFIG_ARMV8_DEPRECATED is not set -+ -+# -+# ARMv8.1 architectural features -+# -+CONFIG_ARM64_HW_AFDBM=y -+CONFIG_ARM64_PAN=y -+CONFIG_AS_HAS_LSE_ATOMICS=y -+CONFIG_ARM64_LSE_ATOMICS=y -+CONFIG_ARM64_USE_LSE_ATOMICS=y -+# end of ARMv8.1 architectural features -+ -+# -+# ARMv8.2 architectural features -+# -+CONFIG_AS_HAS_ARMV8_2=y -+CONFIG_AS_HAS_SHA3=y -+# CONFIG_ARM64_PMEM is not set -+CONFIG_ARM64_RAS_EXTN=y -+CONFIG_ARM64_CNP=y -+# end of ARMv8.2 architectural features -+ -+# -+# ARMv8.3 architectural features -+# -+CONFIG_ARM64_PTR_AUTH=y -+CONFIG_ARM64_PTR_AUTH_KERNEL=y -+CONFIG_CC_HAS_BRANCH_PROT_PAC_RET=y -+CONFIG_CC_HAS_SIGN_RETURN_ADDRESS=y -+CONFIG_AS_HAS_ARMV8_3=y -+CONFIG_AS_HAS_CFI_NEGATE_RA_STATE=y -+CONFIG_AS_HAS_LDAPR=y -+# end of ARMv8.3 architectural features -+ -+# -+# ARMv8.4 architectural features -+# -+CONFIG_ARM64_AMU_EXTN=y -+CONFIG_AS_HAS_ARMV8_4=y -+CONFIG_ARM64_TLB_RANGE=y -+# end of ARMv8.4 architectural features -+ -+# -+# ARMv8.5 architectural features -+# -+CONFIG_AS_HAS_ARMV8_5=y -+CONFIG_ARM64_BTI=y -+CONFIG_ARM64_BTI_KERNEL=y -+CONFIG_CC_HAS_BRANCH_PROT_PAC_RET_BTI=y -+CONFIG_ARM64_E0PD=y -+CONFIG_ARM64_AS_HAS_MTE=y -+CONFIG_ARM64_MTE=y -+# end of ARMv8.5 architectural features -+ -+# -+# ARMv8.7 architectural features -+# -+CONFIG_ARM64_EPAN=y -+# end of ARMv8.7 architectural features -+ -+CONFIG_ARM64_SVE=y -+CONFIG_ARM64_SME=y -+# CONFIG_ARM64_PSEUDO_NMI is not set -+CONFIG_RELOCATABLE=y -+CONFIG_RANDOMIZE_BASE=y -+CONFIG_RANDOMIZE_MODULE_REGION_FULL=y -+CONFIG_CC_HAVE_STACKPROTECTOR_SYSREG=y -+CONFIG_STACKPROTECTOR_PER_TASK=y -+# end of Kernel Features -+ -+# -+# Boot options -+# -+# CONFIG_ARM64_ACPI_PARKING_PROTOCOL is not set -+CONFIG_CMDLINE="" -+CONFIG_EFI_STUB=y -+CONFIG_EFI=y -+CONFIG_DMI=y -+# end of Boot options -+ -+# -+# Power management options -+# -+# CONFIG_SUSPEND is not set -+CONFIG_HIBERNATE_CALLBACKS=y -+CONFIG_HIBERNATION=y -+CONFIG_HIBERNATION_SNAPSHOT_DEV=y -+CONFIG_PM_STD_PARTITION="" -+CONFIG_PM_SLEEP=y -+CONFIG_PM_SLEEP_SMP=y -+# CONFIG_PM_AUTOSLEEP is not set -+# CONFIG_PM_USERSPACE_AUTOSLEEP is not set -+# CONFIG_PM_WAKELOCKS is not set -+CONFIG_PM=y -+# CONFIG_PM_DEBUG is not set -+CONFIG_PM_CLK=y -+CONFIG_PM_GENERIC_DOMAINS=y -+CONFIG_WQ_POWER_EFFICIENT_DEFAULT=y -+CONFIG_PM_GENERIC_DOMAINS_SLEEP=y -+CONFIG_PM_GENERIC_DOMAINS_OF=y -+CONFIG_CPU_PM=y -+CONFIG_ENERGY_MODEL=y -+CONFIG_ARCH_HIBERNATION_POSSIBLE=y -+CONFIG_ARCH_HIBERNATION_HEADER=y -+CONFIG_ARCH_SUSPEND_POSSIBLE=y -+# end of Power management options -+ -+# -+# CPU Power Management -+# -+ -+# -+# CPU Idle -+# -+CONFIG_CPU_IDLE=y -+CONFIG_CPU_IDLE_MULTIPLE_DRIVERS=y -+# CONFIG_CPU_IDLE_GOV_LADDER is not set -+CONFIG_CPU_IDLE_GOV_MENU=y -+# CONFIG_CPU_IDLE_GOV_TEO is not set -+CONFIG_DT_IDLE_STATES=y -+CONFIG_DT_IDLE_GENPD=y -+ -+# -+# ARM CPU Idle Drivers -+# -+CONFIG_ARM_PSCI_CPUIDLE=y -+CONFIG_ARM_PSCI_CPUIDLE_DOMAIN=y -+# end of ARM CPU Idle Drivers -+# end of CPU Idle -+ -+# -+# CPU Frequency scaling -+# -+CONFIG_CPU_FREQ=y -+CONFIG_CPU_FREQ_GOV_ATTR_SET=y -+CONFIG_CPU_FREQ_GOV_COMMON=y -+CONFIG_CPU_FREQ_STAT=y -+# CONFIG_CPU_FREQ_DEFAULT_GOV_PERFORMANCE is not set -+# CONFIG_CPU_FREQ_DEFAULT_GOV_POWERSAVE is not set -+# CONFIG_CPU_FREQ_DEFAULT_GOV_USERSPACE is not set -+# CONFIG_CPU_FREQ_DEFAULT_GOV_ONDEMAND is not set -+# CONFIG_CPU_FREQ_DEFAULT_GOV_CONSERVATIVE is not set -+CONFIG_CPU_FREQ_DEFAULT_GOV_SCHEDUTIL=y -+CONFIG_CPU_FREQ_GOV_PERFORMANCE=y -+CONFIG_CPU_FREQ_GOV_POWERSAVE=y -+CONFIG_CPU_FREQ_GOV_USERSPACE=y -+CONFIG_CPU_FREQ_GOV_ONDEMAND=y -+CONFIG_CPU_FREQ_GOV_CONSERVATIVE=y -+CONFIG_CPU_FREQ_GOV_SCHEDUTIL=y -+ -+# -+# CPU frequency scaling drivers -+# -+CONFIG_CPUFREQ_DT=y -+CONFIG_CPUFREQ_DT_PLATDEV=y -+CONFIG_ACPI_CPPC_CPUFREQ=m -+CONFIG_ACPI_CPPC_CPUFREQ_FIE=y -+CONFIG_ARM_SCPI_CPUFREQ=y -+CONFIG_ARM_SCMI_CPUFREQ=y -+# end of CPU Frequency scaling -+# end of CPU Power Management -+ -+CONFIG_ARCH_SUPPORTS_ACPI=y -+CONFIG_ACPI=y -+CONFIG_ACPI_GENERIC_GSI=y -+CONFIG_ACPI_CCA_REQUIRED=y -+# CONFIG_ACPI_DEBUGGER is not set -+CONFIG_ACPI_SPCR_TABLE=y -+# CONFIG_ACPI_FPDT is not set -+# CONFIG_ACPI_EC_DEBUGFS is not set -+CONFIG_ACPI_AC=y -+CONFIG_ACPI_BATTERY=y -+CONFIG_ACPI_BUTTON=y -+CONFIG_ACPI_VIDEO=y -+CONFIG_ACPI_FAN=y -+# CONFIG_ACPI_TAD is not set -+# CONFIG_ACPI_DOCK is not set -+CONFIG_ACPI_PROCESSOR_IDLE=y -+CONFIG_ACPI_MCFG=y -+CONFIG_ACPI_CPPC_LIB=y -+CONFIG_ACPI_PROCESSOR=y -+# CONFIG_ACPI_IPMI is not set -+CONFIG_ACPI_HOTPLUG_CPU=y -+CONFIG_ACPI_THERMAL=y -+CONFIG_ARCH_HAS_ACPI_TABLE_UPGRADE=y -+CONFIG_ACPI_TABLE_UPGRADE=y -+# CONFIG_ACPI_DEBUG is not set -+# CONFIG_ACPI_PCI_SLOT is not set -+CONFIG_ACPI_CONTAINER=y -+CONFIG_ACPI_HOTPLUG_MEMORY=y -+CONFIG_ACPI_HED=y -+# CONFIG_ACPI_CUSTOM_METHOD is not set -+# CONFIG_ACPI_BGRT is not set -+CONFIG_ACPI_REDUCED_HARDWARE_ONLY=y -+CONFIG_ACPI_NUMA=y -+CONFIG_ACPI_HMAT=y -+CONFIG_HAVE_ACPI_APEI=y -+CONFIG_ACPI_APEI=y -+CONFIG_ACPI_APEI_GHES=y -+CONFIG_ACPI_APEI_PCIEAER=y -+CONFIG_ACPI_APEI_SEA=y -+CONFIG_ACPI_APEI_SEI=y -+CONFIG_ACPI_APEI_MEMORY_FAILURE=y -+CONFIG_ACPI_APEI_EINJ=y -+# CONFIG_ACPI_APEI_ERST_DEBUG is not set -+# CONFIG_ACPI_CONFIGFS is not set -+# CONFIG_ACPI_PFRUT is not set -+CONFIG_ACPI_IORT=y -+CONFIG_ACPI_GTDT=y -+CONFIG_ACPI_APMT=y -+CONFIG_ACPI_PPTT=y -+CONFIG_ACPI_PCC=y -+# CONFIG_ACPI_FFH is not set -+# CONFIG_PMIC_OPREGION is not set -+CONFIG_ACPI_PRMT=y -+CONFIG_IRQ_BYPASS_MANAGER=y -+CONFIG_HAVE_KVM=y -+CONFIG_HAVE_KVM_IRQCHIP=y -+CONFIG_HAVE_KVM_IRQFD=y -+CONFIG_HAVE_KVM_IRQ_ROUTING=y -+CONFIG_HAVE_KVM_DIRTY_RING=y -+CONFIG_HAVE_KVM_DIRTY_RING_ACQ_REL=y -+CONFIG_NEED_KVM_DIRTY_RING_WITH_BITMAP=y -+CONFIG_HAVE_KVM_EVENTFD=y -+CONFIG_KVM_MMIO=y -+CONFIG_HAVE_KVM_MSI=y -+CONFIG_HAVE_KVM_CPU_RELAX_INTERCEPT=y -+CONFIG_KVM_VFIO=y -+CONFIG_KVM_GENERIC_DIRTYLOG_READ_PROTECT=y -+CONFIG_HAVE_KVM_IRQ_BYPASS=y -+CONFIG_HAVE_KVM_VCPU_RUN_PID_CHANGE=y -+CONFIG_KVM_XFER_TO_GUEST_WORK=y -+CONFIG_KVM_GENERIC_HARDWARE_ENABLING=y -+CONFIG_VIRTUALIZATION=y -+CONFIG_KVM=y -+# CONFIG_NVHE_EL2_DEBUG is not set -+ -+# -+# General architecture-dependent options -+# -+CONFIG_ARCH_HAS_SUBPAGE_FAULTS=y -+CONFIG_HOTPLUG_CORE_SYNC=y -+CONFIG_HOTPLUG_CORE_SYNC_DEAD=y -+CONFIG_KPROBES=y -+CONFIG_JUMP_LABEL=y -+# CONFIG_STATIC_KEYS_SELFTEST is not set -+CONFIG_UPROBES=y -+CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS=y -+CONFIG_KRETPROBES=y -+CONFIG_HAVE_IOREMAP_PROT=y -+CONFIG_HAVE_KPROBES=y -+CONFIG_HAVE_KRETPROBES=y -+CONFIG_ARCH_CORRECT_STACKTRACE_ON_KRETPROBE=y -+CONFIG_HAVE_FUNCTION_ERROR_INJECTION=y -+CONFIG_HAVE_NMI=y -+CONFIG_TRACE_IRQFLAGS_SUPPORT=y -+CONFIG_TRACE_IRQFLAGS_NMI_SUPPORT=y -+CONFIG_HAVE_ARCH_TRACEHOOK=y -+CONFIG_HAVE_DMA_CONTIGUOUS=y -+CONFIG_GENERIC_SMP_IDLE_THREAD=y -+CONFIG_GENERIC_IDLE_POLL_SETUP=y -+CONFIG_ARCH_HAS_FORTIFY_SOURCE=y -+CONFIG_ARCH_HAS_KEEPINITRD=y -+CONFIG_ARCH_HAS_SET_MEMORY=y -+CONFIG_ARCH_HAS_SET_DIRECT_MAP=y -+CONFIG_HAVE_ARCH_THREAD_STRUCT_WHITELIST=y -+CONFIG_ARCH_WANTS_NO_INSTR=y -+CONFIG_HAVE_ASM_MODVERSIONS=y -+CONFIG_HAVE_REGS_AND_STACK_ACCESS_API=y -+CONFIG_HAVE_RSEQ=y -+CONFIG_HAVE_FUNCTION_ARG_ACCESS_API=y -+CONFIG_HAVE_HW_BREAKPOINT=y -+CONFIG_HAVE_PERF_REGS=y -+CONFIG_HAVE_PERF_USER_STACK_DUMP=y -+CONFIG_HAVE_ARCH_JUMP_LABEL=y -+CONFIG_HAVE_ARCH_JUMP_LABEL_RELATIVE=y -+CONFIG_MMU_GATHER_TABLE_FREE=y -+CONFIG_MMU_GATHER_RCU_TABLE_FREE=y -+CONFIG_MMU_LAZY_TLB_REFCOUNT=y -+CONFIG_ARCH_HAVE_NMI_SAFE_CMPXCHG=y -+CONFIG_ARCH_HAS_NMI_SAFE_THIS_CPU_OPS=y -+CONFIG_HAVE_ALIGNED_STRUCT_PAGE=y -+CONFIG_HAVE_CMPXCHG_LOCAL=y -+CONFIG_HAVE_CMPXCHG_DOUBLE=y -+CONFIG_ARCH_WANT_COMPAT_IPC_PARSE_VERSION=y -+CONFIG_HAVE_ARCH_SECCOMP=y -+CONFIG_HAVE_ARCH_SECCOMP_FILTER=y -+CONFIG_SECCOMP=y -+CONFIG_SECCOMP_FILTER=y -+# CONFIG_SECCOMP_CACHE_DEBUG is not set -+CONFIG_HAVE_ARCH_STACKLEAK=y -+CONFIG_HAVE_STACKPROTECTOR=y -+CONFIG_STACKPROTECTOR=y -+CONFIG_STACKPROTECTOR_STRONG=y -+CONFIG_ARCH_SUPPORTS_SHADOW_CALL_STACK=y -+# CONFIG_SHADOW_CALL_STACK is not set -+CONFIG_ARCH_SUPPORTS_LTO_CLANG=y -+CONFIG_ARCH_SUPPORTS_LTO_CLANG_THIN=y -+CONFIG_HAS_LTO_CLANG=y -+CONFIG_LTO_NONE=y -+# CONFIG_LTO_CLANG_FULL is not set -+# CONFIG_LTO_CLANG_THIN is not set -+CONFIG_ARCH_SUPPORTS_CFI_CLANG=y -+CONFIG_HAVE_CONTEXT_TRACKING_USER=y -+CONFIG_HAVE_VIRT_CPU_ACCOUNTING_GEN=y -+CONFIG_HAVE_IRQ_TIME_ACCOUNTING=y -+CONFIG_HAVE_MOVE_PUD=y -+CONFIG_HAVE_MOVE_PMD=y -+CONFIG_HAVE_ARCH_TRANSPARENT_HUGEPAGE=y -+CONFIG_HAVE_ARCH_HUGE_VMAP=y -+CONFIG_HAVE_ARCH_HUGE_VMALLOC=y -+CONFIG_ARCH_WANT_HUGE_PMD_SHARE=y -+CONFIG_ARCH_WANT_PMD_MKWRITE=y -+CONFIG_HAVE_MOD_ARCH_SPECIFIC=y -+CONFIG_MODULES_USE_ELF_RELA=y -+CONFIG_HAVE_SOFTIRQ_ON_OWN_STACK=y -+CONFIG_SOFTIRQ_ON_OWN_STACK=y -+CONFIG_ARCH_HAS_ELF_RANDOMIZE=y -+CONFIG_HAVE_ARCH_MMAP_RND_BITS=y -+CONFIG_ARCH_MMAP_RND_BITS=18 -+CONFIG_HAVE_ARCH_MMAP_RND_COMPAT_BITS=y -+CONFIG_ARCH_MMAP_RND_COMPAT_BITS=11 -+CONFIG_PAGE_SIZE_LESS_THAN_64KB=y -+CONFIG_PAGE_SIZE_LESS_THAN_256KB=y -+CONFIG_ARCH_WANT_DEFAULT_TOPDOWN_MMAP_LAYOUT=y -+CONFIG_CLONE_BACKWARDS=y -+CONFIG_OLD_SIGSUSPEND3=y -+CONFIG_COMPAT_OLD_SIGACTION=y -+CONFIG_COMPAT_32BIT_TIME=y -+CONFIG_HAVE_ARCH_VMAP_STACK=y -+CONFIG_VMAP_STACK=y -+CONFIG_HAVE_ARCH_RANDOMIZE_KSTACK_OFFSET=y -+CONFIG_RANDOMIZE_KSTACK_OFFSET=y -+# CONFIG_RANDOMIZE_KSTACK_OFFSET_DEFAULT is not set -+CONFIG_ARCH_HAS_STRICT_KERNEL_RWX=y -+CONFIG_STRICT_KERNEL_RWX=y -+CONFIG_ARCH_HAS_STRICT_MODULE_RWX=y -+CONFIG_STRICT_MODULE_RWX=y -+CONFIG_HAVE_ARCH_COMPILER_H=y -+CONFIG_HAVE_ARCH_PREL32_RELOCATIONS=y -+CONFIG_ARCH_USE_MEMREMAP_PROT=y -+# CONFIG_LOCK_EVENT_COUNTS is not set -+CONFIG_ARCH_HAS_RELR=y -+CONFIG_RELR=y -+CONFIG_HAVE_PREEMPT_DYNAMIC=y -+CONFIG_HAVE_PREEMPT_DYNAMIC_KEY=y -+CONFIG_ARCH_WANT_LD_ORPHAN_WARN=y -+CONFIG_ARCH_SUPPORTS_DEBUG_PAGEALLOC=y -+CONFIG_ARCH_SUPPORTS_PAGE_TABLE_CHECK=y -+CONFIG_ARCH_HAVE_TRACE_MMIO_ACCESS=y -+ -+# -+# GCOV-based kernel profiling -+# -+# CONFIG_GCOV_KERNEL is not set -+CONFIG_ARCH_HAS_GCOV_PROFILE_ALL=y -+# end of GCOV-based kernel profiling -+ -+CONFIG_HAVE_GCC_PLUGINS=y -+CONFIG_FUNCTION_ALIGNMENT_4B=y -+CONFIG_FUNCTION_ALIGNMENT_8B=y -+CONFIG_FUNCTION_ALIGNMENT=8 -+# end of General architecture-dependent options -+ -+CONFIG_RT_MUTEXES=y -+CONFIG_BASE_SMALL=0 -+CONFIG_MODULE_SIG_FORMAT=y -+CONFIG_MODULES=y -+# CONFIG_MODULE_DEBUG is not set -+CONFIG_MODULE_FORCE_LOAD=y -+CONFIG_MODULE_UNLOAD=y -+# CONFIG_MODULE_FORCE_UNLOAD is not set -+# CONFIG_MODULE_UNLOAD_TAINT_TRACKING is not set -+# CONFIG_MODVERSIONS is not set -+# CONFIG_MODULE_SRCVERSION_ALL is not set -+CONFIG_MODULE_SIG=y -+CONFIG_MODULE_SIG_FORCE=y -+CONFIG_MODULE_SIG_ALL=y -+CONFIG_MODULE_SIG_SHA1=y -+# CONFIG_MODULE_SIG_SHA224 is not set -+# CONFIG_MODULE_SIG_SHA256 is not set -+# CONFIG_MODULE_SIG_SHA384 is not set -+# CONFIG_MODULE_SIG_SHA512 is not set -+CONFIG_MODULE_SIG_HASH="sha1" -+CONFIG_MODULE_COMPRESS_NONE=y -+# CONFIG_MODULE_COMPRESS_GZIP is not set -+# CONFIG_MODULE_COMPRESS_XZ is not set -+# CONFIG_MODULE_COMPRESS_ZSTD is not set -+# CONFIG_MODULE_ALLOW_MISSING_NAMESPACE_IMPORTS is not set -+CONFIG_MODPROBE_PATH="/sbin/modprobe" -+CONFIG_MODULES_TREE_LOOKUP=y -+CONFIG_BLOCK=y -+CONFIG_BLOCK_LEGACY_AUTOLOAD=y -+CONFIG_BLK_CGROUP_RWSTAT=y -+CONFIG_BLK_CGROUP_PUNT_BIO=y -+CONFIG_BLK_DEV_BSG_COMMON=y -+CONFIG_BLK_ICQ=y -+CONFIG_BLK_DEV_BSGLIB=y -+CONFIG_BLK_DEV_INTEGRITY=y -+CONFIG_BLK_DEV_INTEGRITY_T10=y -+# CONFIG_BLK_DEV_ZONED is not set -+# CONFIG_BLK_DEV_THROTTLING is not set -+# CONFIG_BLK_WBT is not set -+# CONFIG_BLK_CGROUP_IOLATENCY is not set -+# CONFIG_BLK_CGROUP_IOCOST is not set -+# CONFIG_BLK_CGROUP_IOPRIO is not set -+CONFIG_BLK_DEBUG_FS=y -+# CONFIG_BLK_SED_OPAL is not set -+# CONFIG_BLK_INLINE_ENCRYPTION is not set -+ -+# -+# Partition Types -+# -+CONFIG_PARTITION_ADVANCED=y -+# CONFIG_ACORN_PARTITION is not set -+# CONFIG_AIX_PARTITION is not set -+# CONFIG_OSF_PARTITION is not set -+# CONFIG_AMIGA_PARTITION is not set -+# CONFIG_ATARI_PARTITION is not set -+# CONFIG_MAC_PARTITION is not set -+CONFIG_MSDOS_PARTITION=y -+# CONFIG_BSD_DISKLABEL is not set -+# CONFIG_MINIX_SUBPARTITION is not set -+# CONFIG_SOLARIS_X86_PARTITION is not set -+# CONFIG_UNIXWARE_DISKLABEL is not set -+# CONFIG_LDM_PARTITION is not set -+# CONFIG_SGI_PARTITION is not set -+# CONFIG_ULTRIX_PARTITION is not set -+# CONFIG_SUN_PARTITION is not set -+# CONFIG_KARMA_PARTITION is not set -+CONFIG_EFI_PARTITION=y -+# CONFIG_SYSV68_PARTITION is not set -+# CONFIG_CMDLINE_PARTITION is not set -+# end of Partition Types -+ -+CONFIG_BLK_MQ_PCI=y -+CONFIG_BLK_MQ_VIRTIO=y -+CONFIG_BLK_PM=y -+CONFIG_BLOCK_HOLDER_DEPRECATED=y -+CONFIG_BLK_MQ_STACKING=y -+ -+# -+# IO Schedulers -+# -+CONFIG_MQ_IOSCHED_DEADLINE=y -+CONFIG_MQ_IOSCHED_KYBER=y -+CONFIG_IOSCHED_BFQ=y -+CONFIG_BFQ_GROUP_IOSCHED=y -+# CONFIG_BFQ_CGROUP_DEBUG is not set -+# end of IO Schedulers -+ -+CONFIG_PREEMPT_NOTIFIERS=y -+CONFIG_ASN1=y -+CONFIG_UNINLINE_SPIN_UNLOCK=y -+CONFIG_ARCH_SUPPORTS_ATOMIC_RMW=y -+CONFIG_MUTEX_SPIN_ON_OWNER=y -+CONFIG_RWSEM_SPIN_ON_OWNER=y -+CONFIG_LOCK_SPIN_ON_OWNER=y -+CONFIG_ARCH_USE_QUEUED_SPINLOCKS=y -+CONFIG_QUEUED_SPINLOCKS=y -+CONFIG_ARCH_USE_QUEUED_RWLOCKS=y -+CONFIG_QUEUED_RWLOCKS=y -+CONFIG_ARCH_HAS_NON_OVERLAPPING_ADDRESS_SPACE=y -+CONFIG_ARCH_HAS_SYSCALL_WRAPPER=y -+CONFIG_FREEZER=y -+ -+# -+# Executable file formats -+# -+CONFIG_BINFMT_ELF=y -+CONFIG_COMPAT_BINFMT_ELF=y -+CONFIG_ARCH_BINFMT_ELF_STATE=y -+CONFIG_ARCH_BINFMT_ELF_EXTRA_PHDRS=y -+CONFIG_ARCH_HAVE_ELF_PROT=y -+CONFIG_ARCH_USE_GNU_PROPERTY=y -+CONFIG_ELFCORE=y -+# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set -+CONFIG_BINFMT_SCRIPT=y -+# CONFIG_BINFMT_MISC is not set -+CONFIG_COREDUMP=y -+# end of Executable file formats -+ -+# -+# Memory Management options -+# -+CONFIG_SWAP=y -+# CONFIG_ZSWAP is not set -+CONFIG_CMA_REUSE=y -+CONFIG_ZSMALLOC=y -+# CONFIG_ZSMALLOC_STAT is not set -+CONFIG_ZSMALLOC_CHAIN_SIZE=8 -+ -+# -+# SLAB allocator options -+# -+# CONFIG_SLAB_DEPRECATED is not set -+CONFIG_SLUB=y -+CONFIG_SLAB_MERGE_DEFAULT=y -+# CONFIG_SLAB_FREELIST_RANDOM is not set -+# CONFIG_SLAB_FREELIST_HARDENED is not set -+# CONFIG_SLUB_STATS is not set -+CONFIG_SLUB_CPU_PARTIAL=y -+# CONFIG_RANDOM_KMALLOC_CACHES is not set -+# end of SLAB allocator options -+ -+# CONFIG_SHUFFLE_PAGE_ALLOCATOR is not set -+# CONFIG_COMPAT_BRK is not set -+CONFIG_SPARSEMEM=y -+CONFIG_SPARSEMEM_EXTREME=y -+CONFIG_SPARSEMEM_VMEMMAP_ENABLE=y -+CONFIG_SPARSEMEM_VMEMMAP=y -+CONFIG_HAVE_FAST_GUP=y -+CONFIG_ARCH_KEEP_MEMBLOCK=y -+CONFIG_NUMA_KEEP_MEMINFO=y -+CONFIG_MEMORY_ISOLATION=y -+CONFIG_EXCLUSIVE_SYSTEM_RAM=y -+CONFIG_ARCH_ENABLE_MEMORY_HOTPLUG=y -+CONFIG_ARCH_ENABLE_MEMORY_HOTREMOVE=y -+CONFIG_MEMORY_HOTPLUG=y -+# CONFIG_MEMORY_HOTPLUG_DEFAULT_ONLINE is not set -+CONFIG_MEMORY_HOTREMOVE=y -+CONFIG_MHP_MEMMAP_ON_MEMORY=y -+CONFIG_ARCH_MHP_MEMMAP_ON_MEMORY_ENABLE=y -+CONFIG_SPLIT_PTLOCK_CPUS=4 -+CONFIG_ARCH_ENABLE_SPLIT_PMD_PTLOCK=y -+CONFIG_MEMORY_BALLOON=y -+CONFIG_BALLOON_COMPACTION=y -+CONFIG_COMPACTION=y -+CONFIG_COMPACT_UNEVICTABLE_DEFAULT=1 -+CONFIG_PAGE_REPORTING=y -+CONFIG_MIGRATION=y -+CONFIG_ARCH_ENABLE_HUGEPAGE_MIGRATION=y -+CONFIG_ARCH_ENABLE_THP_MIGRATION=y -+CONFIG_CONTIG_ALLOC=y -+CONFIG_PHYS_ADDR_T_64BIT=y -+CONFIG_MMU_NOTIFIER=y -+CONFIG_KSM=y -+CONFIG_DEFAULT_MMAP_MIN_ADDR=4096 -+CONFIG_ARCH_SUPPORTS_MEMORY_FAILURE=y -+CONFIG_MEMORY_FAILURE=y -+# CONFIG_HWPOISON_INJECT is not set -+CONFIG_ARCH_WANTS_THP_SWAP=y -+CONFIG_TRANSPARENT_HUGEPAGE=y -+CONFIG_TRANSPARENT_HUGEPAGE_ALWAYS=y -+# CONFIG_TRANSPARENT_HUGEPAGE_MADVISE is not set -+CONFIG_THP_SWAP=y -+# CONFIG_READ_ONLY_THP_FOR_FS is not set -+CONFIG_NEED_PER_CPU_EMBED_FIRST_CHUNK=y -+CONFIG_NEED_PER_CPU_PAGE_FIRST_CHUNK=y -+CONFIG_USE_PERCPU_NUMA_NODE_ID=y -+CONFIG_HAVE_SETUP_PER_CPU_AREA=y -+CONFIG_CMA=y -+CONFIG_CMA_DEBUG=y -+CONFIG_CMA_DEBUGFS=y -+# CONFIG_CMA_SYSFS is not set -+CONFIG_CMA_AREAS=7 -+CONFIG_GENERIC_EARLY_IOREMAP=y -+# CONFIG_DEFERRED_STRUCT_PAGE_INIT is not set -+# CONFIG_IDLE_PAGE_TRACKING is not set -+CONFIG_ARCH_HAS_CACHE_LINE_SIZE=y -+CONFIG_ARCH_HAS_CURRENT_STACK_POINTER=y -+CONFIG_ARCH_HAS_PTE_DEVMAP=y -+CONFIG_ZONE_DMA=y -+CONFIG_ZONE_DMA32=y -+# CONFIG_ZONE_DEVICE is not set -+CONFIG_HMM_MIRROR=y -+CONFIG_ARCH_USES_HIGH_VMA_FLAGS=y -+CONFIG_ARCH_USES_PG_ARCH_X=y -+CONFIG_VM_EVENT_COUNTERS=y -+# CONFIG_PERCPU_STATS is not set -+# CONFIG_GUP_TEST is not set -+# CONFIG_DMAPOOL_TEST is not set -+CONFIG_ARCH_HAS_PTE_SPECIAL=y -+CONFIG_MEMFD_CREATE=y -+CONFIG_SECRETMEM=y -+CONFIG_ANON_VMA_NAME=y -+# CONFIG_USERFAULTFD is not set -+# CONFIG_LRU_GEN is not set -+CONFIG_ARCH_SUPPORTS_PER_VMA_LOCK=y -+CONFIG_PER_VMA_LOCK=y -+CONFIG_LOCK_MM_AND_FIND_VMA=y -+ -+# -+# Data Access Monitoring -+# -+# CONFIG_DAMON is not set -+# end of Data Access Monitoring -+# end of Memory Management options -+ -+CONFIG_NET=y -+CONFIG_NET_INGRESS=y -+CONFIG_NET_EGRESS=y -+CONFIG_NET_XGRESS=y -+CONFIG_SKB_EXTENSIONS=y -+ -+# -+# Networking options -+# -+CONFIG_PACKET=y -+# CONFIG_PACKET_DIAG is not set -+CONFIG_UNIX=y -+CONFIG_UNIX_SCM=y -+CONFIG_AF_UNIX_OOB=y -+# CONFIG_UNIX_DIAG is not set -+CONFIG_TLS=y -+# CONFIG_TLS_DEVICE is not set -+# CONFIG_TLS_TOE is not set -+# CONFIG_XFRM_USER is not set -+# CONFIG_NET_KEY is not set -+# CONFIG_XDP_SOCKETS is not set -+CONFIG_NET_HANDSHAKE=y -+CONFIG_INET=y -+CONFIG_IP_MULTICAST=y -+CONFIG_IP_ADVANCED_ROUTER=y -+# CONFIG_IP_FIB_TRIE_STATS is not set -+# CONFIG_IP_MULTIPLE_TABLES is not set -+# CONFIG_IP_ROUTE_MULTIPATH is not set -+# CONFIG_IP_ROUTE_VERBOSE is not set -+CONFIG_IP_PNP=y -+CONFIG_IP_PNP_DHCP=y -+CONFIG_IP_PNP_BOOTP=y -+# CONFIG_IP_PNP_RARP is not set -+# CONFIG_NET_IPIP is not set -+# CONFIG_NET_IPGRE_DEMUX is not set -+CONFIG_NET_IP_TUNNEL=y -+# CONFIG_IP_MROUTE is not set -+# CONFIG_SYN_COOKIES is not set -+# CONFIG_NET_IPVTI is not set -+# CONFIG_NET_FOU is not set -+# CONFIG_NET_FOU_IP_TUNNELS is not set -+# CONFIG_INET_AH is not set -+# CONFIG_INET_ESP is not set -+# CONFIG_INET_IPCOMP is not set -+CONFIG_INET_TABLE_PERTURB_ORDER=16 -+CONFIG_INET_TUNNEL=y -+CONFIG_INET_DIAG=y -+CONFIG_INET_TCP_DIAG=y -+# CONFIG_INET_UDP_DIAG is not set -+# CONFIG_INET_RAW_DIAG is not set -+# CONFIG_INET_DIAG_DESTROY is not set -+# CONFIG_TCP_CONG_ADVANCED is not set -+CONFIG_TCP_CONG_CUBIC=y -+CONFIG_DEFAULT_TCP_CONG="cubic" -+# CONFIG_TCP_MD5SIG is not set -+CONFIG_IPV6=y -+# CONFIG_IPV6_ROUTER_PREF is not set -+# CONFIG_IPV6_OPTIMISTIC_DAD is not set -+# CONFIG_INET6_AH is not set -+# CONFIG_INET6_ESP is not set -+# CONFIG_INET6_IPCOMP is not set -+# CONFIG_IPV6_MIP6 is not set -+# CONFIG_IPV6_ILA is not set -+# CONFIG_IPV6_VTI is not set -+CONFIG_IPV6_SIT=y -+# CONFIG_IPV6_SIT_6RD is not set -+CONFIG_IPV6_NDISC_NODETYPE=y -+# CONFIG_IPV6_TUNNEL is not set -+# CONFIG_IPV6_MULTIPLE_TABLES is not set -+# CONFIG_IPV6_MROUTE is not set -+# CONFIG_IPV6_SEG6_LWTUNNEL is not set -+# CONFIG_IPV6_SEG6_HMAC is not set -+# CONFIG_IPV6_RPL_LWTUNNEL is not set -+# CONFIG_IPV6_IOAM6_LWTUNNEL is not set -+# CONFIG_NETLABEL is not set -+# CONFIG_MPTCP is not set -+CONFIG_NETWORK_SECMARK=y -+CONFIG_NET_PTP_CLASSIFY=y -+# CONFIG_NETWORK_PHY_TIMESTAMPING is not set -+CONFIG_NETFILTER=y -+CONFIG_NETFILTER_ADVANCED=y -+CONFIG_BRIDGE_NETFILTER=m -+ -+# -+# Core Netfilter Configuration -+# -+CONFIG_NETFILTER_INGRESS=y -+CONFIG_NETFILTER_EGRESS=y -+CONFIG_NETFILTER_SKIP_EGRESS=y -+CONFIG_NETFILTER_FAMILY_BRIDGE=y -+CONFIG_NETFILTER_BPF_LINK=y -+# CONFIG_NETFILTER_NETLINK_ACCT is not set -+# CONFIG_NETFILTER_NETLINK_QUEUE is not set -+# CONFIG_NETFILTER_NETLINK_LOG is not set -+# CONFIG_NETFILTER_NETLINK_OSF is not set -+CONFIG_NF_CONNTRACK=y -+CONFIG_NF_LOG_SYSLOG=m -+# CONFIG_NF_CONNTRACK_MARK is not set -+# CONFIG_NF_CONNTRACK_SECMARK is not set -+# CONFIG_NF_CONNTRACK_ZONES is not set -+# CONFIG_NF_CONNTRACK_PROCFS is not set -+CONFIG_NF_CONNTRACK_EVENTS=y -+# CONFIG_NF_CONNTRACK_TIMEOUT is not set -+# CONFIG_NF_CONNTRACK_TIMESTAMP is not set -+# CONFIG_NF_CONNTRACK_LABELS is not set -+CONFIG_NF_CT_PROTO_DCCP=y -+CONFIG_NF_CT_PROTO_SCTP=y -+CONFIG_NF_CT_PROTO_UDPLITE=y -+# CONFIG_NF_CONNTRACK_AMANDA is not set -+# CONFIG_NF_CONNTRACK_FTP is not set -+# CONFIG_NF_CONNTRACK_H323 is not set -+# CONFIG_NF_CONNTRACK_IRC is not set -+# CONFIG_NF_CONNTRACK_NETBIOS_NS is not set -+# CONFIG_NF_CONNTRACK_SNMP is not set -+# CONFIG_NF_CONNTRACK_PPTP is not set -+# CONFIG_NF_CONNTRACK_SANE is not set -+# CONFIG_NF_CONNTRACK_SIP is not set -+# CONFIG_NF_CONNTRACK_TFTP is not set -+# CONFIG_NF_CT_NETLINK is not set -+CONFIG_NF_NAT=y -+CONFIG_NF_NAT_MASQUERADE=y -+# CONFIG_NF_TABLES is not set -+CONFIG_NETFILTER_XTABLES=y -+# CONFIG_NETFILTER_XTABLES_COMPAT is not set -+ -+# -+# Xtables combined modules -+# -+CONFIG_NETFILTER_XT_MARK=m -+# CONFIG_NETFILTER_XT_CONNMARK is not set -+ -+# -+# Xtables targets -+# -+# CONFIG_NETFILTER_XT_TARGET_AUDIT is not set -+CONFIG_NETFILTER_XT_TARGET_CHECKSUM=m -+# CONFIG_NETFILTER_XT_TARGET_CLASSIFY is not set -+# CONFIG_NETFILTER_XT_TARGET_CONNMARK is not set -+# CONFIG_NETFILTER_XT_TARGET_CT is not set -+# CONFIG_NETFILTER_XT_TARGET_DSCP is not set -+# CONFIG_NETFILTER_XT_TARGET_HL is not set -+# CONFIG_NETFILTER_XT_TARGET_HMARK is not set -+# CONFIG_NETFILTER_XT_TARGET_IDLETIMER is not set -+# CONFIG_NETFILTER_XT_TARGET_LED is not set -+CONFIG_NETFILTER_XT_TARGET_LOG=m -+# CONFIG_NETFILTER_XT_TARGET_MARK is not set -+CONFIG_NETFILTER_XT_NAT=y -+# CONFIG_NETFILTER_XT_TARGET_NETMAP is not set -+# CONFIG_NETFILTER_XT_TARGET_NFLOG is not set -+# CONFIG_NETFILTER_XT_TARGET_NFQUEUE is not set -+# CONFIG_NETFILTER_XT_TARGET_NOTRACK is not set -+# CONFIG_NETFILTER_XT_TARGET_RATEEST is not set -+# CONFIG_NETFILTER_XT_TARGET_REDIRECT is not set -+CONFIG_NETFILTER_XT_TARGET_MASQUERADE=m -+# CONFIG_NETFILTER_XT_TARGET_TEE is not set -+# CONFIG_NETFILTER_XT_TARGET_TPROXY is not set -+# CONFIG_NETFILTER_XT_TARGET_TRACE is not set -+# CONFIG_NETFILTER_XT_TARGET_SECMARK is not set -+# CONFIG_NETFILTER_XT_TARGET_TCPMSS is not set -+# CONFIG_NETFILTER_XT_TARGET_TCPOPTSTRIP is not set -+ -+# -+# Xtables matches -+# -+CONFIG_NETFILTER_XT_MATCH_ADDRTYPE=m -+# CONFIG_NETFILTER_XT_MATCH_BPF is not set -+# CONFIG_NETFILTER_XT_MATCH_CGROUP is not set -+# CONFIG_NETFILTER_XT_MATCH_CLUSTER is not set -+# CONFIG_NETFILTER_XT_MATCH_COMMENT is not set -+# CONFIG_NETFILTER_XT_MATCH_CONNBYTES is not set -+# CONFIG_NETFILTER_XT_MATCH_CONNLABEL is not set -+# CONFIG_NETFILTER_XT_MATCH_CONNLIMIT is not set -+# CONFIG_NETFILTER_XT_MATCH_CONNMARK is not set -+CONFIG_NETFILTER_XT_MATCH_CONNTRACK=m -+# CONFIG_NETFILTER_XT_MATCH_CPU is not set -+# CONFIG_NETFILTER_XT_MATCH_DCCP is not set -+# CONFIG_NETFILTER_XT_MATCH_DEVGROUP is not set -+# CONFIG_NETFILTER_XT_MATCH_DSCP is not set -+# CONFIG_NETFILTER_XT_MATCH_ECN is not set -+# CONFIG_NETFILTER_XT_MATCH_ESP is not set -+# CONFIG_NETFILTER_XT_MATCH_HASHLIMIT is not set -+# CONFIG_NETFILTER_XT_MATCH_HELPER is not set -+# CONFIG_NETFILTER_XT_MATCH_HL is not set -+# CONFIG_NETFILTER_XT_MATCH_IPCOMP is not set -+# CONFIG_NETFILTER_XT_MATCH_IPRANGE is not set -+CONFIG_NETFILTER_XT_MATCH_IPVS=m -+# CONFIG_NETFILTER_XT_MATCH_L2TP is not set -+# CONFIG_NETFILTER_XT_MATCH_LENGTH is not set -+# CONFIG_NETFILTER_XT_MATCH_LIMIT is not set -+# CONFIG_NETFILTER_XT_MATCH_MAC is not set -+# CONFIG_NETFILTER_XT_MATCH_MARK is not set -+# CONFIG_NETFILTER_XT_MATCH_MULTIPORT is not set -+# CONFIG_NETFILTER_XT_MATCH_NFACCT is not set -+# CONFIG_NETFILTER_XT_MATCH_OSF is not set -+# CONFIG_NETFILTER_XT_MATCH_OWNER is not set -+# CONFIG_NETFILTER_XT_MATCH_PHYSDEV is not set -+# CONFIG_NETFILTER_XT_MATCH_PKTTYPE is not set -+# CONFIG_NETFILTER_XT_MATCH_QUOTA is not set -+# CONFIG_NETFILTER_XT_MATCH_RATEEST is not set -+# CONFIG_NETFILTER_XT_MATCH_REALM is not set -+# CONFIG_NETFILTER_XT_MATCH_RECENT is not set -+# CONFIG_NETFILTER_XT_MATCH_SCTP is not set -+# CONFIG_NETFILTER_XT_MATCH_SOCKET is not set -+# CONFIG_NETFILTER_XT_MATCH_STATE is not set -+# CONFIG_NETFILTER_XT_MATCH_STATISTIC is not set -+# CONFIG_NETFILTER_XT_MATCH_STRING is not set -+# CONFIG_NETFILTER_XT_MATCH_TCPMSS is not set -+# CONFIG_NETFILTER_XT_MATCH_TIME is not set -+# CONFIG_NETFILTER_XT_MATCH_U32 is not set -+# end of Core Netfilter Configuration -+ -+# CONFIG_IP_SET is not set -+CONFIG_IP_VS=m -+# CONFIG_IP_VS_IPV6 is not set -+# CONFIG_IP_VS_DEBUG is not set -+CONFIG_IP_VS_TAB_BITS=12 -+ -+# -+# IPVS transport protocol load balancing support -+# -+# CONFIG_IP_VS_PROTO_TCP is not set -+# CONFIG_IP_VS_PROTO_UDP is not set -+# CONFIG_IP_VS_PROTO_ESP is not set -+# CONFIG_IP_VS_PROTO_AH is not set -+# CONFIG_IP_VS_PROTO_SCTP is not set -+ -+# -+# IPVS scheduler -+# -+# CONFIG_IP_VS_RR is not set -+# CONFIG_IP_VS_WRR is not set -+# CONFIG_IP_VS_LC is not set -+# CONFIG_IP_VS_WLC is not set -+# CONFIG_IP_VS_FO is not set -+# CONFIG_IP_VS_OVF is not set -+# CONFIG_IP_VS_LBLC is not set -+# CONFIG_IP_VS_LBLCR is not set -+# CONFIG_IP_VS_DH is not set -+# CONFIG_IP_VS_SH is not set -+# CONFIG_IP_VS_MH is not set -+# CONFIG_IP_VS_SED is not set -+# CONFIG_IP_VS_NQ is not set -+# CONFIG_IP_VS_TWOS is not set -+ -+# -+# IPVS SH scheduler -+# -+CONFIG_IP_VS_SH_TAB_BITS=8 -+ -+# -+# IPVS MH scheduler -+# -+CONFIG_IP_VS_MH_TAB_INDEX=12 -+ -+# -+# IPVS application helper -+# -+# CONFIG_IP_VS_NFCT is not set -+ -+# -+# IP: Netfilter Configuration -+# -+CONFIG_NF_DEFRAG_IPV4=y -+# CONFIG_NF_SOCKET_IPV4 is not set -+# CONFIG_NF_TPROXY_IPV4 is not set -+# CONFIG_NF_DUP_IPV4 is not set -+# CONFIG_NF_LOG_ARP is not set -+# CONFIG_NF_LOG_IPV4 is not set -+CONFIG_NF_REJECT_IPV4=y -+CONFIG_IP_NF_IPTABLES=y -+# CONFIG_IP_NF_MATCH_AH is not set -+# CONFIG_IP_NF_MATCH_ECN is not set -+# CONFIG_IP_NF_MATCH_RPFILTER is not set -+# CONFIG_IP_NF_MATCH_TTL is not set -+CONFIG_IP_NF_FILTER=y -+CONFIG_IP_NF_TARGET_REJECT=y -+# CONFIG_IP_NF_TARGET_SYNPROXY is not set -+CONFIG_IP_NF_NAT=y -+CONFIG_IP_NF_TARGET_MASQUERADE=m -+# CONFIG_IP_NF_TARGET_NETMAP is not set -+# CONFIG_IP_NF_TARGET_REDIRECT is not set -+CONFIG_IP_NF_MANGLE=y -+# CONFIG_IP_NF_TARGET_ECN is not set -+# CONFIG_IP_NF_TARGET_TTL is not set -+CONFIG_IP_NF_RAW=y -+# CONFIG_IP_NF_SECURITY is not set -+# CONFIG_IP_NF_ARPTABLES is not set -+# end of IP: Netfilter Configuration -+ -+# -+# IPv6: Netfilter Configuration -+# -+CONFIG_NF_SOCKET_IPV6=y -+# CONFIG_NF_TPROXY_IPV6 is not set -+# CONFIG_NF_DUP_IPV6 is not set -+CONFIG_NF_REJECT_IPV6=m -+CONFIG_NF_LOG_IPV6=m -+CONFIG_IP6_NF_IPTABLES=y -+# CONFIG_IP6_NF_MATCH_AH is not set -+# CONFIG_IP6_NF_MATCH_EUI64 is not set -+# CONFIG_IP6_NF_MATCH_FRAG is not set -+# CONFIG_IP6_NF_MATCH_OPTS is not set -+# CONFIG_IP6_NF_MATCH_HL is not set -+# CONFIG_IP6_NF_MATCH_IPV6HEADER is not set -+# CONFIG_IP6_NF_MATCH_MH is not set -+# CONFIG_IP6_NF_MATCH_RPFILTER is not set -+# CONFIG_IP6_NF_MATCH_RT is not set -+# CONFIG_IP6_NF_MATCH_SRH is not set -+# CONFIG_IP6_NF_TARGET_HL is not set -+CONFIG_IP6_NF_FILTER=y -+CONFIG_IP6_NF_TARGET_REJECT=m -+# CONFIG_IP6_NF_TARGET_SYNPROXY is not set -+CONFIG_IP6_NF_MANGLE=y -+# CONFIG_IP6_NF_RAW is not set -+# CONFIG_IP6_NF_SECURITY is not set -+CONFIG_IP6_NF_NAT=y -+CONFIG_IP6_NF_TARGET_MASQUERADE=m -+# CONFIG_IP6_NF_TARGET_NPT is not set -+# end of IPv6: Netfilter Configuration -+ -+CONFIG_NF_DEFRAG_IPV6=y -+# CONFIG_NF_CONNTRACK_BRIDGE is not set -+# CONFIG_BRIDGE_NF_EBTABLES is not set -+# CONFIG_BPFILTER is not set -+# CONFIG_IP_DCCP is not set -+# CONFIG_IP_SCTP is not set -+# CONFIG_RDS is not set -+# CONFIG_TIPC is not set -+# CONFIG_ATM is not set -+# CONFIG_L2TP is not set -+CONFIG_STP=m -+CONFIG_GARP=m -+CONFIG_MRP=m -+CONFIG_BRIDGE=m -+CONFIG_BRIDGE_IGMP_SNOOPING=y -+CONFIG_BRIDGE_VLAN_FILTERING=y -+# CONFIG_BRIDGE_MRP is not set -+# CONFIG_BRIDGE_CFM is not set -+CONFIG_NET_DSA=m -+CONFIG_NET_DSA_TAG_NONE=m -+# CONFIG_NET_DSA_TAG_AR9331 is not set -+CONFIG_NET_DSA_TAG_BRCM_COMMON=m -+CONFIG_NET_DSA_TAG_BRCM=m -+CONFIG_NET_DSA_TAG_BRCM_LEGACY=m -+CONFIG_NET_DSA_TAG_BRCM_PREPEND=m -+# CONFIG_NET_DSA_TAG_HELLCREEK is not set -+# CONFIG_NET_DSA_TAG_GSWIP is not set -+# CONFIG_NET_DSA_TAG_DSA is not set -+# CONFIG_NET_DSA_TAG_EDSA is not set -+# CONFIG_NET_DSA_TAG_MTK is not set -+# CONFIG_NET_DSA_TAG_KSZ is not set -+CONFIG_NET_DSA_TAG_OCELOT=m -+CONFIG_NET_DSA_TAG_OCELOT_8021Q=m -+# CONFIG_NET_DSA_TAG_QCA is not set -+# CONFIG_NET_DSA_TAG_RTL4_A is not set -+# CONFIG_NET_DSA_TAG_RTL8_4 is not set -+# CONFIG_NET_DSA_TAG_RZN1_A5PSW is not set -+# CONFIG_NET_DSA_TAG_LAN9303 is not set -+# CONFIG_NET_DSA_TAG_SJA1105 is not set -+# CONFIG_NET_DSA_TAG_TRAILER is not set -+# CONFIG_NET_DSA_TAG_XRS700X is not set -+CONFIG_VLAN_8021Q=m -+CONFIG_VLAN_8021Q_GVRP=y -+CONFIG_VLAN_8021Q_MVRP=y -+CONFIG_LLC=m -+# CONFIG_LLC2 is not set -+# CONFIG_ATALK is not set -+# CONFIG_X25 is not set -+# CONFIG_LAPB is not set -+# CONFIG_PHONET is not set -+# CONFIG_6LOWPAN is not set -+# CONFIG_IEEE802154 is not set -+CONFIG_NET_SCHED=y -+ -+# -+# Queueing/Scheduling -+# -+# CONFIG_NET_SCH_HTB is not set -+# CONFIG_NET_SCH_HFSC is not set -+# CONFIG_NET_SCH_PRIO is not set -+# CONFIG_NET_SCH_MULTIQ is not set -+# CONFIG_NET_SCH_RED is not set -+# CONFIG_NET_SCH_SFB is not set -+# CONFIG_NET_SCH_SFQ is not set -+# CONFIG_NET_SCH_TEQL is not set -+# CONFIG_NET_SCH_TBF is not set -+CONFIG_NET_SCH_CBS=m -+CONFIG_NET_SCH_ETF=m -+CONFIG_NET_SCH_MQPRIO_LIB=m -+CONFIG_NET_SCH_TAPRIO=m -+# CONFIG_NET_SCH_GRED is not set -+# CONFIG_NET_SCH_NETEM is not set -+# CONFIG_NET_SCH_DRR is not set -+CONFIG_NET_SCH_MQPRIO=m -+# CONFIG_NET_SCH_SKBPRIO is not set -+# CONFIG_NET_SCH_CHOKE is not set -+# CONFIG_NET_SCH_QFQ is not set -+# CONFIG_NET_SCH_CODEL is not set -+# CONFIG_NET_SCH_FQ_CODEL is not set -+# CONFIG_NET_SCH_CAKE is not set -+# CONFIG_NET_SCH_FQ is not set -+# CONFIG_NET_SCH_HHF is not set -+# CONFIG_NET_SCH_PIE is not set -+CONFIG_NET_SCH_INGRESS=m -+# CONFIG_NET_SCH_PLUG is not set -+# CONFIG_NET_SCH_ETS is not set -+# CONFIG_NET_SCH_DEFAULT is not set -+ -+# -+# Classification -+# -+CONFIG_NET_CLS=y -+CONFIG_NET_CLS_BASIC=m -+# CONFIG_NET_CLS_ROUTE4 is not set -+# CONFIG_NET_CLS_FW is not set -+# CONFIG_NET_CLS_U32 is not set -+# CONFIG_NET_CLS_FLOW is not set -+# CONFIG_NET_CLS_CGROUP is not set -+# CONFIG_NET_CLS_BPF is not set -+CONFIG_NET_CLS_FLOWER=m -+# CONFIG_NET_CLS_MATCHALL is not set -+# CONFIG_NET_EMATCH is not set -+CONFIG_NET_CLS_ACT=y -+# CONFIG_NET_ACT_POLICE is not set -+CONFIG_NET_ACT_GACT=m -+# CONFIG_GACT_PROB is not set -+CONFIG_NET_ACT_MIRRED=m -+# CONFIG_NET_ACT_SAMPLE is not set -+# CONFIG_NET_ACT_IPT is not set -+# CONFIG_NET_ACT_NAT is not set -+# CONFIG_NET_ACT_PEDIT is not set -+# CONFIG_NET_ACT_SIMP is not set -+# CONFIG_NET_ACT_SKBEDIT is not set -+# CONFIG_NET_ACT_CSUM is not set -+# CONFIG_NET_ACT_MPLS is not set -+# CONFIG_NET_ACT_VLAN is not set -+# CONFIG_NET_ACT_BPF is not set -+# CONFIG_NET_ACT_SKBMOD is not set -+# CONFIG_NET_ACT_IFE is not set -+# CONFIG_NET_ACT_TUNNEL_KEY is not set -+CONFIG_NET_ACT_GATE=m -+# CONFIG_NET_TC_SKB_EXT is not set -+CONFIG_NET_SCH_FIFO=y -+# CONFIG_DCB is not set -+CONFIG_DNS_RESOLVER=y -+# CONFIG_BATMAN_ADV is not set -+# CONFIG_OPENVSWITCH is not set -+# CONFIG_VSOCKETS is not set -+# CONFIG_NETLINK_DIAG is not set -+# CONFIG_MPLS is not set -+# CONFIG_NET_NSH is not set -+# CONFIG_HSR is not set -+CONFIG_NET_SWITCHDEV=y -+# CONFIG_NET_L3_MASTER_DEV is not set -+CONFIG_QRTR=m -+CONFIG_QRTR_SMD=m -+CONFIG_QRTR_TUN=m -+CONFIG_QRTR_MHI=m -+# CONFIG_NET_NCSI is not set -+CONFIG_PCPU_DEV_REFCNT=y -+CONFIG_MAX_SKB_FRAGS=17 -+CONFIG_RPS=y -+CONFIG_RFS_ACCEL=y -+CONFIG_SOCK_RX_QUEUE_MAPPING=y -+CONFIG_XPS=y -+# CONFIG_CGROUP_NET_PRIO is not set -+# CONFIG_CGROUP_NET_CLASSID is not set -+CONFIG_NET_RX_BUSY_POLL=y -+CONFIG_BQL=y -+# CONFIG_BPF_STREAM_PARSER is not set -+CONFIG_NET_FLOW_LIMIT=y -+ -+# -+# Network testing -+# -+# CONFIG_NET_PKTGEN is not set -+# CONFIG_NET_DROP_MONITOR is not set -+# end of Network testing -+# end of Networking options -+ -+# CONFIG_HAMRADIO is not set -+CONFIG_CAN=m -+CONFIG_CAN_RAW=m -+CONFIG_CAN_BCM=m -+CONFIG_CAN_GW=m -+# CONFIG_CAN_J1939 is not set -+# CONFIG_CAN_ISOTP is not set -+CONFIG_BT=y -+CONFIG_BT_BREDR=y -+CONFIG_BT_RFCOMM=y -+# CONFIG_BT_RFCOMM_TTY is not set -+# CONFIG_BT_BNEP is not set -+CONFIG_BT_HIDP=y -+# CONFIG_BT_LE is not set -+CONFIG_BT_LEDS=y -+# CONFIG_BT_MSFTEXT is not set -+# CONFIG_BT_AOSPEXT is not set -+CONFIG_BT_DEBUGFS=y -+# CONFIG_BT_SELFTEST is not set -+# CONFIG_BT_FEATURE_DEBUG is not set -+ -+# -+# Bluetooth device drivers -+# -+CONFIG_BT_INTEL=m -+CONFIG_BT_BCM=m -+CONFIG_BT_RTL=m -+CONFIG_BT_QCA=m -+CONFIG_BT_MTK=m -+CONFIG_BT_HCIBTUSB=m -+# CONFIG_BT_HCIBTUSB_AUTOSUSPEND is not set -+CONFIG_BT_HCIBTUSB_POLL_SYNC=y -+CONFIG_BT_HCIBTUSB_BCM=y -+CONFIG_BT_HCIBTUSB_MTK=y -+CONFIG_BT_HCIBTUSB_RTL=y -+# CONFIG_BT_HCIBTSDIO is not set -+CONFIG_BT_HCIUART=m -+CONFIG_BT_HCIUART_SERDEV=y -+CONFIG_BT_HCIUART_H4=y -+# CONFIG_BT_HCIUART_NOKIA is not set -+# CONFIG_BT_HCIUART_BCSP is not set -+# CONFIG_BT_HCIUART_ATH3K is not set -+CONFIG_BT_HCIUART_LL=y -+CONFIG_BT_HCIUART_3WIRE=y -+# CONFIG_BT_HCIUART_INTEL is not set -+CONFIG_BT_HCIUART_BCM=y -+# CONFIG_BT_HCIUART_RTL is not set -+CONFIG_BT_HCIUART_QCA=y -+# CONFIG_BT_HCIUART_AG6XX is not set -+CONFIG_BT_HCIUART_MRVL=y -+# CONFIG_BT_HCIBCM203X is not set -+# CONFIG_BT_HCIBCM4377 is not set -+# CONFIG_BT_HCIBPA10X is not set -+# CONFIG_BT_HCIBFUSB is not set -+# CONFIG_BT_HCIVHCI is not set -+CONFIG_BT_MRVL=m -+CONFIG_BT_MRVL_SDIO=m -+# CONFIG_BT_ATH3K is not set -+# CONFIG_BT_MTKSDIO is not set -+# CONFIG_BT_MTKUART is not set -+CONFIG_BT_HCIRSI=m -+# CONFIG_BT_VIRTIO is not set -+CONFIG_BT_NXPUART=m -+# end of Bluetooth device drivers -+ -+# CONFIG_AF_RXRPC is not set -+# CONFIG_AF_KCM is not set -+CONFIG_STREAM_PARSER=y -+# CONFIG_MCTP is not set -+CONFIG_WIRELESS=y -+CONFIG_CFG80211=y -+# CONFIG_NL80211_TESTMODE is not set -+# CONFIG_CFG80211_DEVELOPER_WARNINGS is not set -+CONFIG_CFG80211_REQUIRE_SIGNED_REGDB=y -+CONFIG_CFG80211_USE_KERNEL_REGDB_KEYS=y -+CONFIG_CFG80211_DEFAULT_PS=y -+# CONFIG_CFG80211_DEBUGFS is not set -+CONFIG_CFG80211_CRDA_SUPPORT=y -+# CONFIG_CFG80211_WEXT is not set -+CONFIG_MAC80211=y -+CONFIG_MAC80211_HAS_RC=y -+CONFIG_MAC80211_RC_MINSTREL=y -+CONFIG_MAC80211_RC_DEFAULT_MINSTREL=y -+CONFIG_MAC80211_RC_DEFAULT="minstrel_ht" -+# CONFIG_MAC80211_MESH is not set -+CONFIG_MAC80211_LEDS=y -+# CONFIG_MAC80211_DEBUGFS is not set -+# CONFIG_MAC80211_MESSAGE_TRACING is not set -+# CONFIG_MAC80211_DEBUG_MENU is not set -+CONFIG_MAC80211_STA_HASH_MAX_SIZE=0 -+CONFIG_RFKILL=y -+CONFIG_RFKILL_LEDS=y -+CONFIG_RFKILL_INPUT=y -+# CONFIG_RFKILL_GPIO is not set -+CONFIG_NET_9P=y -+CONFIG_NET_9P_FD=y -+CONFIG_NET_9P_VIRTIO=y -+# CONFIG_NET_9P_XEN is not set -+# CONFIG_NET_9P_DEBUG is not set -+# CONFIG_CAIF is not set -+# CONFIG_CEPH_LIB is not set -+CONFIG_NFC=m -+# CONFIG_NFC_DIGITAL is not set -+CONFIG_NFC_NCI=m -+# CONFIG_NFC_NCI_SPI is not set -+# CONFIG_NFC_NCI_UART is not set -+# CONFIG_NFC_HCI is not set -+ -+# -+# Near Field Communication (NFC) devices -+# -+# CONFIG_NFC_VIRTUAL_NCI is not set -+# CONFIG_NFC_FDP is not set -+# CONFIG_NFC_PN533_USB is not set -+# CONFIG_NFC_PN533_I2C is not set -+# CONFIG_NFC_PN532_UART is not set -+# CONFIG_NFC_MRVL_USB is not set -+# CONFIG_NFC_ST_NCI_I2C is not set -+# CONFIG_NFC_ST_NCI_SPI is not set -+# CONFIG_NFC_NXP_NCI is not set -+CONFIG_NFC_S3FWRN5=m -+CONFIG_NFC_S3FWRN5_I2C=m -+# CONFIG_NFC_S3FWRN82_UART is not set -+# end of Near Field Communication (NFC) devices -+ -+# CONFIG_PSAMPLE is not set -+# CONFIG_NET_IFE is not set -+# CONFIG_LWTUNNEL is not set -+CONFIG_DST_CACHE=y -+CONFIG_GRO_CELLS=y -+CONFIG_NET_SELFTESTS=y -+CONFIG_NET_SOCK_MSG=y -+CONFIG_NET_DEVLINK=y -+CONFIG_PAGE_POOL=y -+CONFIG_PAGE_POOL_STATS=y -+CONFIG_FAILOVER=y -+CONFIG_ETHTOOL_NETLINK=y -+ -+# -+# Device Drivers -+# -+CONFIG_ARM_AMBA=y -+CONFIG_HAVE_PCI=y -+CONFIG_PCI=y -+CONFIG_PCI_DOMAINS=y -+CONFIG_PCI_DOMAINS_GENERIC=y -+CONFIG_PCI_SYSCALL=y -+CONFIG_PCIEPORTBUS=y -+# CONFIG_HOTPLUG_PCI_PCIE is not set -+CONFIG_PCIEAER=y -+# CONFIG_PCIEAER_INJECT is not set -+# CONFIG_PCIE_ECRC is not set -+CONFIG_PCIEASPM=y -+CONFIG_PCIEASPM_DEFAULT=y -+# CONFIG_PCIEASPM_POWERSAVE is not set -+# CONFIG_PCIEASPM_POWER_SUPERSAVE is not set -+# CONFIG_PCIEASPM_PERFORMANCE is not set -+CONFIG_PCIE_PME=y -+# CONFIG_PCIE_DPC is not set -+# CONFIG_PCIE_PTM is not set -+CONFIG_PCI_MSI=y -+CONFIG_PCI_QUIRKS=y -+# CONFIG_PCI_DEBUG is not set -+# CONFIG_PCI_REALLOC_ENABLE_AUTO is not set -+# CONFIG_PCI_STUB is not set -+# CONFIG_PCI_PF_STUB is not set -+CONFIG_PCI_ATS=y -+CONFIG_PCI_ECAM=y -+CONFIG_PCI_IOV=y -+# CONFIG_PCI_PRI is not set -+CONFIG_PCI_PASID=y -+CONFIG_PCI_LABEL=y -+# CONFIG_PCI_DYNAMIC_OF_NODES is not set -+CONFIG_VGA_ARB=y -+CONFIG_VGA_ARB_MAX_GPUS=16 -+CONFIG_HOTPLUG_PCI=y -+CONFIG_HOTPLUG_PCI_ACPI=y -+# CONFIG_HOTPLUG_PCI_ACPI_IBM is not set -+# CONFIG_HOTPLUG_PCI_CPCI is not set -+# CONFIG_HOTPLUG_PCI_SHPC is not set -+ -+# -+# PCI controller drivers -+# -+CONFIG_PCIE_ALTERA=y -+CONFIG_PCIE_ALTERA_MSI=y -+CONFIG_PCI_HOST_THUNDER_PEM=y -+CONFIG_PCI_HOST_THUNDER_ECAM=y -+# CONFIG_PCI_FTPCI100 is not set -+CONFIG_PCI_HOST_COMMON=y -+CONFIG_PCI_HOST_GENERIC=y -+# CONFIG_PCIE_HISI_ERR is not set -+# CONFIG_PCIE_MICROCHIP_HOST is not set -+# CONFIG_PCIE_PHYTIUM_EP is not set -+CONFIG_PCI_XGENE=y -+CONFIG_PCI_XGENE_MSI=y -+# CONFIG_PCIE_XILINX is not set -+ -+# -+# Cadence-based PCIe controllers -+# -+# CONFIG_PCIE_CADENCE_PLAT_HOST is not set -+# CONFIG_PCIE_CADENCE_PLAT_EP is not set -+# CONFIG_PCI_J721E_HOST is not set -+# CONFIG_PCI_J721E_EP is not set -+# end of Cadence-based PCIe controllers -+ -+# -+# DesignWare-based PCIe controllers -+# -+CONFIG_PCIE_DW=y -+CONFIG_PCIE_DW_HOST=y -+# CONFIG_PCIE_AL is not set -+CONFIG_PCI_MESON=m -+CONFIG_PCI_HISI=y -+CONFIG_PCIE_KIRIN=y -+# CONFIG_PCIE_DW_PLAT_HOST is not set -+# CONFIG_PCIE_DW_PLAT_EP is not set -+# end of DesignWare-based PCIe controllers -+ -+# -+# Mobiveil-based PCIe controllers -+# -+# end of Mobiveil-based PCIe controllers -+# end of PCI controller drivers -+ -+# -+# PCI Endpoint -+# -+CONFIG_PCI_ENDPOINT=y -+CONFIG_PCI_ENDPOINT_CONFIGFS=y -+CONFIG_PCI_EPF_TEST=m -+# CONFIG_PCI_EPF_NTB is not set -+# end of PCI Endpoint -+ -+# -+# PCI switch controller drivers -+# -+# CONFIG_PCI_SW_SWITCHTEC is not set -+# end of PCI switch controller drivers -+ -+# CONFIG_CXL_BUS is not set -+# CONFIG_PCCARD is not set -+# CONFIG_RAPIDIO is not set -+# CONFIG_HYPERHOLD is not set -+ -+# -+# Generic Driver Options -+# -+CONFIG_AUXILIARY_BUS=y -+# CONFIG_UEVENT_HELPER is not set -+CONFIG_DEVTMPFS=y -+CONFIG_DEVTMPFS_MOUNT=y -+# CONFIG_DEVTMPFS_SAFE is not set -+CONFIG_STANDALONE=y -+CONFIG_PREVENT_FIRMWARE_BUILD=y -+ -+# -+# Firmware loader -+# -+CONFIG_FW_LOADER=y -+CONFIG_FW_LOADER_PAGED_BUF=y -+CONFIG_FW_LOADER_SYSFS=y -+CONFIG_EXTRA_FIRMWARE="" -+CONFIG_FW_LOADER_USER_HELPER=y -+# CONFIG_FW_LOADER_USER_HELPER_FALLBACK is not set -+# CONFIG_FW_LOADER_COMPRESS is not set -+CONFIG_FW_CACHE=y -+# CONFIG_FW_UPLOAD is not set -+# end of Firmware loader -+ -+CONFIG_WANT_DEV_COREDUMP=y -+CONFIG_ALLOW_DEV_COREDUMP=y -+CONFIG_DEV_COREDUMP=y -+# CONFIG_DEBUG_DRIVER is not set -+# CONFIG_DEBUG_DEVRES is not set -+# CONFIG_DEBUG_TEST_DRIVER_REMOVE is not set -+CONFIG_HMEM_REPORTING=y -+# CONFIG_TEST_ASYNC_DRIVER_PROBE is not set -+CONFIG_SYS_HYPERVISOR=y -+CONFIG_GENERIC_CPU_AUTOPROBE=y -+CONFIG_GENERIC_CPU_VULNERABILITIES=y -+CONFIG_SOC_BUS=y -+CONFIG_REGMAP=y -+CONFIG_REGMAP_I2C=y -+CONFIG_REGMAP_SLIMBUS=m -+CONFIG_REGMAP_SPI=y -+CONFIG_REGMAP_SPMI=m -+CONFIG_REGMAP_MMIO=y -+CONFIG_REGMAP_IRQ=y -+CONFIG_REGMAP_SOUNDWIRE=m -+CONFIG_REGMAP_I3C=m -+CONFIG_DMA_SHARED_BUFFER=y -+# CONFIG_DMA_FENCE_TRACE is not set -+CONFIG_GENERIC_ARCH_TOPOLOGY=y -+CONFIG_GENERIC_ARCH_NUMA=y -+# CONFIG_FW_DEVLINK_SYNC_STATE_TIMEOUT is not set -+# end of Generic Driver Options -+ -+# -+# Bus devices -+# -+CONFIG_ARM_CCI=y -+CONFIG_ARM_CCI400_COMMON=y -+CONFIG_BRCMSTB_GISB_ARB=y -+# CONFIG_MOXTET is not set -+CONFIG_VEXPRESS_CONFIG=y -+CONFIG_MHI_BUS=m -+# CONFIG_MHI_BUS_DEBUG is not set -+CONFIG_MHI_BUS_PCI_GENERIC=m -+# CONFIG_MHI_BUS_EP is not set -+# end of Bus devices -+ -+# -+# Cache Drivers -+# -+# end of Cache Drivers -+ -+# CONFIG_CONNECTOR is not set -+ -+# -+# Firmware Drivers -+# -+ -+# -+# ARM System Control and Management Interface Protocol -+# -+CONFIG_ARM_SCMI_PROTOCOL=y -+# CONFIG_ARM_SCMI_RAW_MODE_SUPPORT is not set -+CONFIG_ARM_SCMI_HAVE_TRANSPORT=y -+CONFIG_ARM_SCMI_HAVE_SHMEM=y -+CONFIG_ARM_SCMI_TRANSPORT_MAILBOX=y -+CONFIG_ARM_SCMI_TRANSPORT_SMC=y -+# CONFIG_ARM_SCMI_TRANSPORT_SMC_ATOMIC_ENABLE is not set -+# CONFIG_ARM_SCMI_TRANSPORT_VIRTIO is not set -+CONFIG_ARM_SCMI_POWER_DOMAIN=y -+# CONFIG_ARM_SCMI_POWER_CONTROL is not set -+# end of ARM System Control and Management Interface Protocol -+ -+CONFIG_ARM_SCPI_PROTOCOL=y -+CONFIG_ARM_SCPI_POWER_DOMAIN=y -+# CONFIG_ARM_SDE_INTERFACE is not set -+CONFIG_DMIID=y -+# CONFIG_DMI_SYSFS is not set -+# CONFIG_ISCSI_IBFT is not set -+# CONFIG_FW_CFG_SYSFS is not set -+# CONFIG_SYSFB_SIMPLEFB is not set -+# CONFIG_ARM_FFA_TRANSPORT is not set -+# CONFIG_GOOGLE_FIRMWARE is not set -+ -+# -+# EFI (Extensible Firmware Interface) Support -+# -+CONFIG_EFI_ESRT=y -+CONFIG_EFI_VARS_PSTORE=y -+# CONFIG_EFI_VARS_PSTORE_DEFAULT_DISABLE is not set -+CONFIG_EFI_SOFT_RESERVE=y -+CONFIG_EFI_PARAMS_FROM_FDT=y -+CONFIG_EFI_RUNTIME_WRAPPERS=y -+CONFIG_EFI_GENERIC_STUB=y -+# CONFIG_EFI_ZBOOT is not set -+CONFIG_EFI_ARMSTUB_DTB_LOADER=y -+# CONFIG_EFI_BOOTLOADER_CONTROL is not set -+CONFIG_EFI_CAPSULE_LOADER=y -+# CONFIG_EFI_TEST is not set -+# CONFIG_RESET_ATTACK_MITIGATION is not set -+# CONFIG_EFI_DISABLE_PCI_DMA is not set -+CONFIG_EFI_EARLYCON=y -+CONFIG_EFI_CUSTOM_SSDT_OVERLAYS=y -+# CONFIG_EFI_DISABLE_RUNTIME is not set -+# CONFIG_EFI_COCO_SECRET is not set -+# end of EFI (Extensible Firmware Interface) Support -+ -+CONFIG_UEFI_CPER=y -+CONFIG_UEFI_CPER_ARM=y -+CONFIG_ARM_PSCI_FW=y -+# CONFIG_ARM_PSCI_CHECKER is not set -+CONFIG_HAVE_ARM_SMCCC=y -+CONFIG_HAVE_ARM_SMCCC_DISCOVERY=y -+CONFIG_ARM_SMCCC_SOC_ID=y -+ -+# -+# Tegra firmware driver -+# -+# end of Tegra firmware driver -+# end of Firmware Drivers -+ -+CONFIG_GNSS=m -+CONFIG_GNSS_SERIAL=m -+CONFIG_GNSS_MTK_SERIAL=m -+# CONFIG_GNSS_SIRF_SERIAL is not set -+# CONFIG_GNSS_UBX_SERIAL is not set -+# CONFIG_GNSS_USB is not set -+CONFIG_MTD=y -+# CONFIG_MTD_TESTS is not set -+ -+# -+# Partition parsers -+# -+# CONFIG_MTD_AR7_PARTS is not set -+CONFIG_MTD_CMDLINE_PARTS=y -+CONFIG_MTD_OF_PARTS=y -+CONFIG_MTD_ACPI_PARTS=y -+# CONFIG_MTD_AFS_PARTS is not set -+# CONFIG_MTD_REDBOOT_PARTS is not set -+# end of Partition parsers -+ -+# -+# User Modules And Translation Layers -+# -+CONFIG_MTD_BLKDEVS=y -+CONFIG_MTD_BLOCK=y -+ -+# -+# Note that in some cases UBI block is preferred. See MTD_UBI_BLOCK. -+# -+# CONFIG_FTL is not set -+# CONFIG_NFTL is not set -+# CONFIG_INFTL is not set -+# CONFIG_RFD_FTL is not set -+# CONFIG_SSFDC is not set -+# CONFIG_SM_FTL is not set -+# CONFIG_MTD_OOPS is not set -+# CONFIG_MTD_SWAP is not set -+# CONFIG_MTD_PARTITIONED_MASTER is not set -+ -+# -+# RAM/ROM/Flash chip drivers -+# -+CONFIG_MTD_CFI=y -+# CONFIG_MTD_JEDECPROBE is not set -+CONFIG_MTD_GEN_PROBE=y -+CONFIG_MTD_CFI_ADV_OPTIONS=y -+CONFIG_MTD_CFI_NOSWAP=y -+# CONFIG_MTD_CFI_BE_BYTE_SWAP is not set -+# CONFIG_MTD_CFI_LE_BYTE_SWAP is not set -+# CONFIG_MTD_CFI_GEOMETRY is not set -+CONFIG_MTD_MAP_BANK_WIDTH_1=y -+CONFIG_MTD_MAP_BANK_WIDTH_2=y -+CONFIG_MTD_MAP_BANK_WIDTH_4=y -+CONFIG_MTD_CFI_I1=y -+CONFIG_MTD_CFI_I2=y -+# CONFIG_MTD_OTP is not set -+CONFIG_MTD_CFI_INTELEXT=y -+CONFIG_MTD_CFI_AMDSTD=y -+CONFIG_MTD_CFI_STAA=y -+CONFIG_MTD_CFI_UTIL=y -+# CONFIG_MTD_RAM is not set -+# CONFIG_MTD_ROM is not set -+# CONFIG_MTD_ABSENT is not set -+# end of RAM/ROM/Flash chip drivers -+ -+# -+# Mapping drivers for chip access -+# -+# CONFIG_MTD_COMPLEX_MAPPINGS is not set -+CONFIG_MTD_PHYSMAP=y -+# CONFIG_MTD_PHYSMAP_COMPAT is not set -+CONFIG_MTD_PHYSMAP_OF=y -+# CONFIG_MTD_PHYSMAP_VERSATILE is not set -+# CONFIG_MTD_PHYSMAP_GEMINI is not set -+# CONFIG_MTD_INTEL_VR_NOR is not set -+# CONFIG_MTD_PLATRAM is not set -+# end of Mapping drivers for chip access -+ -+# -+# Self-contained MTD device drivers -+# -+# CONFIG_MTD_PMC551 is not set -+CONFIG_MTD_DATAFLASH=y -+# CONFIG_MTD_DATAFLASH_WRITE_VERIFY is not set -+# CONFIG_MTD_DATAFLASH_OTP is not set -+# CONFIG_MTD_MCHP23K256 is not set -+# CONFIG_MTD_MCHP48L640 is not set -+CONFIG_MTD_SST25L=y -+# CONFIG_MTD_SLRAM is not set -+# CONFIG_MTD_PHRAM is not set -+# CONFIG_MTD_MTDRAM is not set -+# CONFIG_MTD_BLOCK2MTD is not set -+ -+# -+# Disk-On-Chip Device Drivers -+# -+# CONFIG_MTD_DOCG3 is not set -+# end of Self-contained MTD device drivers -+ -+# -+# NAND -+# -+CONFIG_MTD_NAND_CORE=y -+# CONFIG_MTD_ONENAND is not set -+CONFIG_MTD_RAW_NAND=y -+ -+# -+# Raw/parallel NAND flash controllers -+# -+CONFIG_MTD_NAND_DENALI=y -+# CONFIG_MTD_NAND_DENALI_PCI is not set -+CONFIG_MTD_NAND_DENALI_DT=y -+# CONFIG_MTD_NAND_CAFE is not set -+CONFIG_MTD_NAND_PHYTIUM=m -+# CONFIG_MTD_NAND_PHYTIUM_PCI is not set -+CONFIG_MTD_NAND_PHYTIUM_PLAT=m -+CONFIG_MTD_NAND_BRCMNAND=m -+# CONFIG_MTD_NAND_BRCMNAND_BCM63XX is not set -+CONFIG_MTD_NAND_BRCMNAND_BCMBCA=m -+CONFIG_MTD_NAND_BRCMNAND_BRCMSTB=m -+CONFIG_MTD_NAND_BRCMNAND_IPROC=m -+# CONFIG_MTD_NAND_MXIC is not set -+# CONFIG_MTD_NAND_GPIO is not set -+# CONFIG_MTD_NAND_PLATFORM is not set -+# CONFIG_MTD_NAND_CADENCE is not set -+# CONFIG_MTD_NAND_ARASAN is not set -+# CONFIG_MTD_NAND_INTEL_LGM is not set -+ -+# -+# Misc -+# -+# CONFIG_MTD_NAND_NANDSIM is not set -+# CONFIG_MTD_NAND_RICOH is not set -+# CONFIG_MTD_NAND_DISKONCHIP is not set -+# CONFIG_MTD_SPI_NAND is not set -+ -+# -+# ECC engine support -+# -+CONFIG_MTD_NAND_ECC=y -+CONFIG_MTD_NAND_ECC_SW_HAMMING=y -+# CONFIG_MTD_NAND_ECC_SW_HAMMING_SMC is not set -+# CONFIG_MTD_NAND_ECC_SW_BCH is not set -+# CONFIG_MTD_NAND_ECC_MXIC is not set -+# end of ECC engine support -+# end of NAND -+ -+# -+# LPDDR & LPDDR2 PCM memory drivers -+# -+# CONFIG_MTD_LPDDR is not set -+# end of LPDDR & LPDDR2 PCM memory drivers -+ -+CONFIG_MTD_SPI_NOR=y -+CONFIG_MTD_SPI_NOR_USE_4K_SECTORS=y -+# CONFIG_MTD_SPI_NOR_SWP_DISABLE is not set -+CONFIG_MTD_SPI_NOR_SWP_DISABLE_ON_VOLATILE=y -+# CONFIG_MTD_SPI_NOR_SWP_KEEP is not set -+CONFIG_MTD_UBI=m -+CONFIG_MTD_UBI_WL_THRESHOLD=4096 -+CONFIG_MTD_UBI_BEB_LIMIT=20 -+# CONFIG_MTD_UBI_FASTMAP is not set -+# CONFIG_MTD_UBI_GLUEBI is not set -+# CONFIG_MTD_UBI_BLOCK is not set -+# CONFIG_MTD_HYPERBUS is not set -+CONFIG_DTC=y -+CONFIG_OF=y -+# CONFIG_OF_UNITTEST is not set -+CONFIG_OF_FLATTREE=y -+CONFIG_OF_EARLY_FLATTREE=y -+CONFIG_OF_KOBJ=y -+CONFIG_OF_DYNAMIC=y -+CONFIG_OF_ADDRESS=y -+CONFIG_OF_IRQ=y -+CONFIG_OF_RESERVED_MEM=y -+CONFIG_OF_RESOLVE=y -+CONFIG_OF_OVERLAY=y -+CONFIG_OF_NUMA=y -+CONFIG_OF_CONFIGFS=y -+# CONFIG_PARPORT is not set -+CONFIG_PNP=y -+CONFIG_PNP_DEBUG_MESSAGES=y -+ -+# -+# Protocols -+# -+CONFIG_PNPACPI=y -+CONFIG_BLK_DEV=y -+# CONFIG_BLK_DEV_NULL_BLK is not set -+CONFIG_CDROM=y -+# CONFIG_BLK_DEV_PCIESSD_MTIP32XX is not set -+CONFIG_ZRAM=y -+CONFIG_ZRAM_DEF_COMP_LZORLE=y -+# CONFIG_ZRAM_DEF_COMP_ZSTD is not set -+# CONFIG_ZRAM_DEF_COMP_LZ4 is not set -+# CONFIG_ZRAM_DEF_COMP_LZO is not set -+# CONFIG_ZRAM_DEF_COMP_LZ4HC is not set -+# CONFIG_ZRAM_DEF_COMP_842 is not set -+CONFIG_ZRAM_DEF_COMP="lzo-rle" -+# CONFIG_ZRAM_WRITEBACK is not set -+# CONFIG_ZRAM_MEMORY_TRACKING is not set -+# CONFIG_ZRAM_MULTI_COMP is not set -+CONFIG_BLK_DEV_LOOP=y -+CONFIG_BLK_DEV_LOOP_MIN_COUNT=8 -+# CONFIG_BLK_DEV_DRBD is not set -+CONFIG_BLK_DEV_NBD=m -+# CONFIG_BLK_DEV_RAM is not set -+# CONFIG_CDROM_PKTCDVD is not set -+# CONFIG_ATA_OVER_ETH is not set -+CONFIG_XEN_BLKDEV_FRONTEND=y -+# CONFIG_XEN_BLKDEV_BACKEND is not set -+CONFIG_VIRTIO_BLK=y -+# CONFIG_BLK_DEV_RBD is not set -+# CONFIG_BLK_DEV_UBLK is not set -+ -+# -+# NVME Support -+# -+CONFIG_NVME_CORE=y -+CONFIG_BLK_DEV_NVME=y -+# CONFIG_NVME_MULTIPATH is not set -+# CONFIG_NVME_VERBOSE_ERRORS is not set -+# CONFIG_NVME_HWMON is not set -+# CONFIG_NVME_FC is not set -+# CONFIG_NVME_TCP is not set -+# CONFIG_NVME_AUTH is not set -+# CONFIG_NVME_TARGET is not set -+# end of NVME Support -+ -+# -+# Misc devices -+# -+# CONFIG_AD525X_DPOT is not set -+# CONFIG_DUMMY_IRQ is not set -+# CONFIG_PHANTOM is not set -+# CONFIG_TIFM_CORE is not set -+# CONFIG_ICS932S401 is not set -+# CONFIG_ENCLOSURE_SERVICES is not set -+# CONFIG_HI6421V600_IRQ is not set -+# CONFIG_HP_ILO is not set -+# CONFIG_APDS9802ALS is not set -+# CONFIG_ISL29003 is not set -+# CONFIG_ISL29020 is not set -+# CONFIG_SENSORS_TSL2550 is not set -+# CONFIG_SENSORS_BH1770 is not set -+# CONFIG_SENSORS_APDS990X is not set -+# CONFIG_HMC6352 is not set -+# CONFIG_DS1682 is not set -+# CONFIG_LATTICE_ECP3_CONFIG is not set -+CONFIG_SRAM=y -+# CONFIG_DW_XDATA_PCIE is not set -+CONFIG_PCI_ENDPOINT_TEST=m -+# CONFIG_XILINX_SDFEC is not set -+# CONFIG_HISI_HIKEY_USB is not set -+# CONFIG_OPEN_DICE is not set -+# CONFIG_VCPU_STALL_DETECTOR is not set -+# CONFIG_C2PORT is not set -+ -+# -+# EEPROM support -+# -+CONFIG_EEPROM_AT24=m -+CONFIG_EEPROM_AT25=m -+# CONFIG_EEPROM_LEGACY is not set -+# CONFIG_EEPROM_MAX6875 is not set -+# CONFIG_EEPROM_93CX6 is not set -+# CONFIG_EEPROM_93XX46 is not set -+# CONFIG_EEPROM_IDT_89HPESX is not set -+# CONFIG_EEPROM_EE1004 is not set -+# end of EEPROM support -+ -+# CONFIG_CB710_CORE is not set -+ -+# -+# Texas Instruments shared transport line discipline -+# -+# CONFIG_TI_ST is not set -+# end of Texas Instruments shared transport line discipline -+ -+# CONFIG_SENSORS_LIS3_I2C is not set -+# CONFIG_ALTERA_STAPL is not set -+# CONFIG_VMWARE_VMCI is not set -+# CONFIG_GENWQE is not set -+# CONFIG_ECHO is not set -+# CONFIG_BCM_VK is not set -+# CONFIG_MISC_ALCOR_PCI is not set -+# CONFIG_MISC_RTSX_PCI is not set -+# CONFIG_MISC_RTSX_USB is not set -+CONFIG_UACCE=m -+# CONFIG_PVPANIC is not set -+# CONFIG_GP_PCI1XXXX is not set -+# end of Misc devices -+ -+# -+# SCSI device support -+# -+CONFIG_SCSI_MOD=y -+CONFIG_RAID_ATTRS=m -+CONFIG_SCSI_COMMON=y -+CONFIG_SCSI=y -+CONFIG_SCSI_DMA=y -+CONFIG_SCSI_PROC_FS=y -+ -+# -+# SCSI support type (disk, tape, CD-ROM) -+# -+CONFIG_BLK_DEV_SD=y -+# CONFIG_CHR_DEV_ST is not set -+CONFIG_BLK_DEV_SR=y -+# CONFIG_CHR_DEV_SG is not set -+CONFIG_BLK_DEV_BSG=y -+# CONFIG_CHR_DEV_SCH is not set -+# CONFIG_SCSI_CONSTANTS is not set -+# CONFIG_SCSI_LOGGING is not set -+# CONFIG_SCSI_SCAN_ASYNC is not set -+ -+# -+# SCSI Transports -+# -+# CONFIG_SCSI_SPI_ATTRS is not set -+# CONFIG_SCSI_FC_ATTRS is not set -+# CONFIG_SCSI_ISCSI_ATTRS is not set -+CONFIG_SCSI_SAS_ATTRS=y -+CONFIG_SCSI_SAS_LIBSAS=y -+CONFIG_SCSI_SAS_ATA=y -+CONFIG_SCSI_SAS_HOST_SMP=y -+# CONFIG_SCSI_SRP_ATTRS is not set -+# end of SCSI Transports -+ -+CONFIG_SCSI_LOWLEVEL=y -+# CONFIG_ISCSI_TCP is not set -+# CONFIG_ISCSI_BOOT_SYSFS is not set -+# CONFIG_SCSI_CXGB3_ISCSI is not set -+# CONFIG_SCSI_CXGB4_ISCSI is not set -+# CONFIG_SCSI_BNX2_ISCSI is not set -+# CONFIG_BE2ISCSI is not set -+# CONFIG_BLK_DEV_3W_XXXX_RAID is not set -+# CONFIG_SCSI_HPSA is not set -+# CONFIG_SCSI_3W_9XXX is not set -+# CONFIG_SCSI_3W_SAS is not set -+# CONFIG_SCSI_ACARD is not set -+# CONFIG_SCSI_AACRAID is not set -+# CONFIG_SCSI_AIC7XXX is not set -+# CONFIG_SCSI_AIC79XX is not set -+# CONFIG_SCSI_AIC94XX is not set -+CONFIG_SCSI_HISI_SAS=y -+CONFIG_SCSI_HISI_SAS_PCI=y -+# CONFIG_SCSI_HISI_SAS_DEBUGFS_DEFAULT_ENABLE is not set -+# CONFIG_SCSI_MVSAS is not set -+# CONFIG_SCSI_MVUMI is not set -+# CONFIG_SCSI_ADVANSYS is not set -+# CONFIG_SCSI_ARCMSR is not set -+# CONFIG_SCSI_ESAS2R is not set -+# CONFIG_MEGARAID_NEWGEN is not set -+# CONFIG_MEGARAID_LEGACY is not set -+CONFIG_MEGARAID_SAS=y -+CONFIG_SCSI_MPT3SAS=m -+CONFIG_SCSI_MPT2SAS_MAX_SGE=128 -+CONFIG_SCSI_MPT3SAS_MAX_SGE=128 -+# CONFIG_SCSI_MPT2SAS is not set -+# CONFIG_SCSI_MPI3MR is not set -+# CONFIG_SCSI_SMARTPQI is not set -+# CONFIG_SCSI_HPTIOP is not set -+# CONFIG_SCSI_BUSLOGIC is not set -+# CONFIG_SCSI_MYRB is not set -+# CONFIG_SCSI_MYRS is not set -+# CONFIG_XEN_SCSI_FRONTEND is not set -+# CONFIG_SCSI_SNIC is not set -+# CONFIG_SCSI_DMX3191D is not set -+# CONFIG_SCSI_FDOMAIN_PCI is not set -+# CONFIG_SCSI_IPS is not set -+# CONFIG_SCSI_INITIO is not set -+# CONFIG_SCSI_INIA100 is not set -+# CONFIG_SCSI_STEX is not set -+# CONFIG_SCSI_SYM53C8XX_2 is not set -+# CONFIG_SCSI_IPR is not set -+# CONFIG_SCSI_QLOGIC_1280 is not set -+# CONFIG_SCSI_QLA_ISCSI is not set -+# CONFIG_SCSI_DC395x is not set -+# CONFIG_SCSI_AM53C974 is not set -+# CONFIG_SCSI_WD719X is not set -+# CONFIG_SCSI_DEBUG is not set -+# CONFIG_SCSI_PMCRAID is not set -+# CONFIG_SCSI_PM8001 is not set -+# CONFIG_SCSI_VIRTIO is not set -+# CONFIG_SCSI_DH is not set -+# end of SCSI device support -+ -+CONFIG_ATA=y -+CONFIG_SATA_HOST=y -+CONFIG_PATA_TIMINGS=y -+CONFIG_ATA_VERBOSE_ERROR=y -+CONFIG_ATA_FORCE=y -+CONFIG_ATA_ACPI=y -+# CONFIG_SATA_ZPODD is not set -+CONFIG_SATA_PMP=y -+ -+# -+# Controllers with non-SFF native interface -+# -+CONFIG_SATA_AHCI=y -+CONFIG_SATA_MOBILE_LPM_POLICY=0 -+CONFIG_SATA_AHCI_PLATFORM=y -+CONFIG_AHCI_DWC=m -+CONFIG_AHCI_CEVA=y -+# CONFIG_SATA_INIC162X is not set -+# CONFIG_SATA_ACARD_AHCI is not set -+CONFIG_SATA_SIL24=y -+CONFIG_ATA_SFF=y -+ -+# -+# SFF controllers with custom DMA interface -+# -+# CONFIG_PDC_ADMA is not set -+# CONFIG_SATA_QSTOR is not set -+# CONFIG_SATA_SX4 is not set -+CONFIG_ATA_BMDMA=y -+ -+# -+# SATA SFF controllers with BMDMA -+# -+# CONFIG_ATA_PIIX is not set -+# CONFIG_SATA_DWC is not set -+# CONFIG_SATA_MV is not set -+# CONFIG_SATA_NV is not set -+# CONFIG_SATA_PROMISE is not set -+# CONFIG_SATA_SIL is not set -+# CONFIG_SATA_SIS is not set -+# CONFIG_SATA_SVW is not set -+# CONFIG_SATA_ULI is not set -+# CONFIG_SATA_VIA is not set -+# CONFIG_SATA_VITESSE is not set -+ -+# -+# PATA SFF controllers with BMDMA -+# -+# CONFIG_PATA_ALI is not set -+# CONFIG_PATA_AMD is not set -+# CONFIG_PATA_ARTOP is not set -+# CONFIG_PATA_ATIIXP is not set -+# CONFIG_PATA_ATP867X is not set -+# CONFIG_PATA_CMD64X is not set -+# CONFIG_PATA_CYPRESS is not set -+# CONFIG_PATA_EFAR is not set -+# CONFIG_PATA_HPT366 is not set -+# CONFIG_PATA_HPT37X is not set -+# CONFIG_PATA_HPT3X2N is not set -+# CONFIG_PATA_HPT3X3 is not set -+# CONFIG_PATA_IT8213 is not set -+# CONFIG_PATA_IT821X is not set -+# CONFIG_PATA_JMICRON is not set -+# CONFIG_PATA_MARVELL is not set -+# CONFIG_PATA_NETCELL is not set -+# CONFIG_PATA_NINJA32 is not set -+# CONFIG_PATA_NS87415 is not set -+# CONFIG_PATA_OLDPIIX is not set -+# CONFIG_PATA_OPTIDMA is not set -+# CONFIG_PATA_PDC2027X is not set -+# CONFIG_PATA_PDC_OLD is not set -+# CONFIG_PATA_RADISYS is not set -+# CONFIG_PATA_RDC is not set -+# CONFIG_PATA_SCH is not set -+# CONFIG_PATA_SERVERWORKS is not set -+# CONFIG_PATA_SIL680 is not set -+# CONFIG_PATA_SIS is not set -+# CONFIG_PATA_TOSHIBA is not set -+# CONFIG_PATA_TRIFLEX is not set -+# CONFIG_PATA_VIA is not set -+# CONFIG_PATA_WINBOND is not set -+ -+# -+# PIO-only SFF controllers -+# -+# CONFIG_PATA_CMD640_PCI is not set -+# CONFIG_PATA_MPIIX is not set -+# CONFIG_PATA_NS87410 is not set -+# CONFIG_PATA_OPTI is not set -+CONFIG_PATA_PLATFORM=y -+CONFIG_PATA_OF_PLATFORM=y -+# CONFIG_PATA_RZ1000 is not set -+ -+# -+# Generic fallback / legacy drivers -+# -+# CONFIG_PATA_ACPI is not set -+# CONFIG_ATA_GENERIC is not set -+# CONFIG_PATA_LEGACY is not set -+CONFIG_MD=y -+CONFIG_BLK_DEV_MD=m -+CONFIG_MD_BITMAP_FILE=y -+# CONFIG_MD_LINEAR is not set -+# CONFIG_MD_RAID0 is not set -+# CONFIG_MD_RAID1 is not set -+# CONFIG_MD_RAID10 is not set -+# CONFIG_MD_RAID456 is not set -+# CONFIG_MD_MULTIPATH is not set -+# CONFIG_MD_FAULTY is not set -+# CONFIG_BCACHE is not set -+CONFIG_BLK_DEV_DM_BUILTIN=y -+CONFIG_BLK_DEV_DM=m -+# CONFIG_DM_DEBUG is not set -+# CONFIG_DM_UNSTRIPED is not set -+# CONFIG_DM_CRYPT is not set -+# CONFIG_DM_SNAPSHOT is not set -+# CONFIG_DM_THIN_PROVISIONING is not set -+# CONFIG_DM_CACHE is not set -+# CONFIG_DM_WRITECACHE is not set -+# CONFIG_DM_EBS is not set -+# CONFIG_DM_ERA is not set -+# CONFIG_DM_CLONE is not set -+CONFIG_DM_MIRROR=m -+# CONFIG_DM_LOG_USERSPACE is not set -+# CONFIG_DM_RAID is not set -+CONFIG_DM_ZERO=m -+# CONFIG_DM_MULTIPATH is not set -+# CONFIG_DM_DELAY is not set -+# CONFIG_DM_DUST is not set -+# CONFIG_DM_UEVENT is not set -+# CONFIG_DM_FLAKEY is not set -+# CONFIG_DM_VERITY is not set -+# CONFIG_DM_SWITCH is not set -+# CONFIG_DM_LOG_WRITES is not set -+# CONFIG_DM_INTEGRITY is not set -+# CONFIG_DM_AUDIT is not set -+# CONFIG_TARGET_CORE is not set -+# CONFIG_FUSION is not set -+ -+# -+# IEEE 1394 (FireWire) support -+# -+# CONFIG_FIREWIRE is not set -+# CONFIG_FIREWIRE_NOSY is not set -+# end of IEEE 1394 (FireWire) support -+ -+CONFIG_NETDEVICES=y -+CONFIG_MII=y -+CONFIG_NET_CORE=y -+# CONFIG_BONDING is not set -+# CONFIG_DUMMY is not set -+# CONFIG_WIREGUARD is not set -+# CONFIG_EQUALIZER is not set -+# CONFIG_NET_FC is not set -+# CONFIG_IFB is not set -+# CONFIG_NET_TEAM is not set -+CONFIG_MACVLAN=m -+CONFIG_MACVTAP=m -+# CONFIG_IPVLAN is not set -+# CONFIG_VXLAN is not set -+# CONFIG_GENEVE is not set -+# CONFIG_BAREUDP is not set -+# CONFIG_GTP is not set -+# CONFIG_AMT is not set -+# CONFIG_MACSEC is not set -+# CONFIG_NETCONSOLE is not set -+CONFIG_TUN=y -+CONFIG_TAP=m -+# CONFIG_TUN_VNET_CROSS_LE is not set -+CONFIG_VETH=m -+CONFIG_VIRTIO_NET=y -+# CONFIG_NLMON is not set -+CONFIG_MHI_NET=m -+# CONFIG_ARCNET is not set -+ -+# -+# Distributed Switch Architecture drivers -+# -+CONFIG_B53=m -+# CONFIG_B53_SPI_DRIVER is not set -+# CONFIG_B53_MDIO_DRIVER is not set -+# CONFIG_B53_MMAP_DRIVER is not set -+CONFIG_B53_SRAB_DRIVER=m -+# CONFIG_B53_SERDES is not set -+CONFIG_NET_DSA_BCM_SF2=m -+# CONFIG_NET_DSA_LOOP is not set -+# CONFIG_NET_DSA_HIRSCHMANN_HELLCREEK is not set -+# CONFIG_NET_DSA_LANTIQ_GSWIP is not set -+# CONFIG_NET_DSA_MT7530 is not set -+# CONFIG_NET_DSA_MV88E6060 is not set -+# CONFIG_NET_DSA_MICROCHIP_KSZ_COMMON is not set -+# CONFIG_NET_DSA_MV88E6XXX is not set -+# CONFIG_NET_DSA_MSCC_OCELOT_EXT is not set -+# CONFIG_NET_DSA_MSCC_SEVILLE is not set -+# CONFIG_NET_DSA_AR9331 is not set -+# CONFIG_NET_DSA_QCA8K is not set -+# CONFIG_NET_DSA_SJA1105 is not set -+# CONFIG_NET_DSA_XRS700X_I2C is not set -+# CONFIG_NET_DSA_XRS700X_MDIO is not set -+# CONFIG_NET_DSA_REALTEK is not set -+# CONFIG_NET_DSA_SMSC_LAN9303_I2C is not set -+# CONFIG_NET_DSA_SMSC_LAN9303_MDIO is not set -+# CONFIG_NET_DSA_VITESSE_VSC73XX_SPI is not set -+# CONFIG_NET_DSA_VITESSE_VSC73XX_PLATFORM is not set -+# end of Distributed Switch Architecture drivers -+ -+CONFIG_ETHERNET=y -+CONFIG_MDIO=m -+CONFIG_NET_VENDOR_3COM=y -+# CONFIG_VORTEX is not set -+# CONFIG_TYPHOON is not set -+CONFIG_NET_VENDOR_ADAPTEC=y -+# CONFIG_ADAPTEC_STARFIRE is not set -+CONFIG_NET_VENDOR_AGERE=y -+# CONFIG_ET131X is not set -+CONFIG_NET_VENDOR_ALACRITECH=y -+# CONFIG_SLICOSS is not set -+CONFIG_NET_VENDOR_ALTEON=y -+# CONFIG_ACENIC is not set -+# CONFIG_ALTERA_TSE is not set -+CONFIG_NET_VENDOR_AMAZON=y -+# CONFIG_ENA_ETHERNET is not set -+CONFIG_NET_VENDOR_AMD=y -+# CONFIG_AMD8111_ETH is not set -+# CONFIG_PCNET32 is not set -+CONFIG_AMD_XGBE=y -+# CONFIG_PDS_CORE is not set -+CONFIG_NET_VENDOR_AQUANTIA=y -+# CONFIG_AQTION is not set -+CONFIG_NET_VENDOR_ARC=y -+CONFIG_NET_VENDOR_ASIX=y -+# CONFIG_SPI_AX88796C is not set -+CONFIG_NET_VENDOR_ATHEROS=y -+# CONFIG_ATL2 is not set -+# CONFIG_ATL1 is not set -+# CONFIG_ATL1E is not set -+CONFIG_ATL1C=m -+# CONFIG_ALX is not set -+CONFIG_NET_VENDOR_BROADCOM=y -+# CONFIG_B44 is not set -+CONFIG_BCMGENET=m -+# CONFIG_BNX2 is not set -+# CONFIG_CNIC is not set -+# CONFIG_TIGON3 is not set -+CONFIG_BNX2X=m -+CONFIG_BNX2X_SRIOV=y -+CONFIG_SYSTEMPORT=m -+# CONFIG_BNXT is not set -+CONFIG_NET_VENDOR_CADENCE=y -+CONFIG_MACB=y -+CONFIG_MACB_USE_HWSTAMP=y -+# CONFIG_MACB_PCI is not set -+CONFIG_NET_VENDOR_CAVIUM=y -+CONFIG_THUNDER_NIC_PF=y -+# CONFIG_THUNDER_NIC_VF is not set -+CONFIG_THUNDER_NIC_BGX=y -+CONFIG_THUNDER_NIC_RGX=y -+# CONFIG_CAVIUM_PTP is not set -+# CONFIG_LIQUIDIO is not set -+# CONFIG_LIQUIDIO_VF is not set -+CONFIG_NET_VENDOR_CHELSIO=y -+# CONFIG_CHELSIO_T1 is not set -+# CONFIG_CHELSIO_T3 is not set -+# CONFIG_CHELSIO_T4 is not set -+# CONFIG_CHELSIO_T4VF is not set -+CONFIG_NET_VENDOR_CISCO=y -+# CONFIG_ENIC is not set -+CONFIG_NET_VENDOR_CORTINA=y -+# CONFIG_GEMINI_ETHERNET is not set -+CONFIG_NET_VENDOR_DAVICOM=y -+# CONFIG_DM9051 is not set -+# CONFIG_DNET is not set -+CONFIG_NET_VENDOR_DEC=y -+# CONFIG_NET_TULIP is not set -+CONFIG_NET_VENDOR_DLINK=y -+# CONFIG_DL2K is not set -+# CONFIG_SUNDANCE is not set -+CONFIG_NET_VENDOR_EMULEX=y -+# CONFIG_BE2NET is not set -+CONFIG_NET_VENDOR_ENGLEDER=y -+# CONFIG_TSNEP is not set -+CONFIG_NET_VENDOR_EZCHIP=y -+# CONFIG_EZCHIP_NPS_MANAGEMENT_ENET is not set -+CONFIG_NET_VENDOR_FUNGIBLE=y -+# CONFIG_FUN_ETH is not set -+CONFIG_NET_VENDOR_GOOGLE=y -+# CONFIG_GVE is not set -+CONFIG_NET_VENDOR_HISILICON=y -+CONFIG_HIX5HD2_GMAC=y -+# CONFIG_HISI_FEMAC is not set -+# CONFIG_HIP04_ETH is not set -+CONFIG_HNS_MDIO=y -+CONFIG_HNS=y -+CONFIG_HNS_DSAF=y -+CONFIG_HNS_ENET=y -+CONFIG_HNS3=y -+CONFIG_HNS3_HCLGE=y -+# CONFIG_HNS3_HCLGEVF is not set -+CONFIG_HNS3_ENET=y -+CONFIG_NET_VENDOR_HUAWEI=y -+# CONFIG_HINIC is not set -+CONFIG_NET_VENDOR_I825XX=y -+CONFIG_NET_VENDOR_INTEL=y -+# CONFIG_E100 is not set -+CONFIG_E1000=y -+CONFIG_E1000E=y -+CONFIG_IGB=y -+CONFIG_IGB_HWMON=y -+CONFIG_IGBVF=y -+# CONFIG_IXGBE is not set -+# CONFIG_IXGBEVF is not set -+# CONFIG_I40E is not set -+# CONFIG_I40EVF is not set -+# CONFIG_ICE is not set -+# CONFIG_FM10K is not set -+# CONFIG_IGC is not set -+# CONFIG_JME is not set -+CONFIG_NET_VENDOR_ADI=y -+# CONFIG_ADIN1110 is not set -+CONFIG_NET_VENDOR_LITEX=y -+# CONFIG_LITEX_LITEETH is not set -+CONFIG_NET_VENDOR_MARVELL=y -+CONFIG_MVMDIO=y -+# CONFIG_SKGE is not set -+CONFIG_SKY2=y -+# CONFIG_SKY2_DEBUG is not set -+# CONFIG_OCTEONTX2_AF is not set -+# CONFIG_OCTEONTX2_PF is not set -+# CONFIG_OCTEON_EP is not set -+# CONFIG_PRESTERA is not set -+CONFIG_NET_VENDOR_MELLANOX=y -+CONFIG_MLX4_EN=m -+CONFIG_MLX4_CORE=m -+CONFIG_MLX4_DEBUG=y -+CONFIG_MLX4_CORE_GEN2=y -+CONFIG_MLX5_CORE=m -+# CONFIG_MLX5_FPGA is not set -+CONFIG_MLX5_CORE_EN=y -+CONFIG_MLX5_EN_ARFS=y -+CONFIG_MLX5_EN_RXNFC=y -+CONFIG_MLX5_MPFS=y -+CONFIG_MLX5_ESWITCH=y -+CONFIG_MLX5_BRIDGE=y -+# CONFIG_MLX5_CORE_IPOIB is not set -+CONFIG_MLX5_SW_STEERING=y -+# CONFIG_MLX5_SF is not set -+# CONFIG_MLXSW_CORE is not set -+# CONFIG_MLXFW is not set -+# CONFIG_MLXBF_GIGE is not set -+CONFIG_NET_VENDOR_MICREL=y -+# CONFIG_KS8842 is not set -+# CONFIG_KS8851 is not set -+# CONFIG_KS8851_MLL is not set -+# CONFIG_KSZ884X_PCI is not set -+CONFIG_NET_VENDOR_MICROCHIP=y -+# CONFIG_ENC28J60 is not set -+# CONFIG_ENCX24J600 is not set -+# CONFIG_LAN743X is not set -+# CONFIG_LAN966X_SWITCH is not set -+# CONFIG_VCAP is not set -+CONFIG_NET_VENDOR_MICROSEMI=y -+# CONFIG_MSCC_OCELOT_SWITCH is not set -+CONFIG_NET_VENDOR_MICROSOFT=y -+CONFIG_NET_VENDOR_MYRI=y -+# CONFIG_MYRI10GE is not set -+# CONFIG_FEALNX is not set -+CONFIG_NET_VENDOR_NI=y -+# CONFIG_NI_XGE_MANAGEMENT_ENET is not set -+CONFIG_NET_VENDOR_NATSEMI=y -+# CONFIG_NATSEMI is not set -+# CONFIG_NS83820 is not set -+CONFIG_NET_VENDOR_NETERION=y -+# CONFIG_S2IO is not set -+CONFIG_NET_VENDOR_NETRONOME=y -+# CONFIG_NFP is not set -+CONFIG_NET_VENDOR_8390=y -+# CONFIG_NE2K_PCI is not set -+CONFIG_NET_VENDOR_NVIDIA=y -+# CONFIG_FORCEDETH is not set -+CONFIG_NET_VENDOR_OKI=y -+# CONFIG_ETHOC is not set -+CONFIG_NET_VENDOR_PACKET_ENGINES=y -+# CONFIG_HAMACHI is not set -+# CONFIG_YELLOWFIN is not set -+CONFIG_NET_VENDOR_PENSANDO=y -+# CONFIG_IONIC is not set -+CONFIG_NET_VENDOR_PHYTIUM=y -+CONFIG_PHYTMAC=y -+CONFIG_PHYTMAC_ENABLE_PTP=y -+CONFIG_PHYTMAC_PLATFORM=y -+CONFIG_PHYTMAC_PCI=y -+CONFIG_NET_VENDOR_QLOGIC=y -+# CONFIG_QLA3XXX is not set -+# CONFIG_QLCNIC is not set -+# CONFIG_NETXEN_NIC is not set -+# CONFIG_QED is not set -+CONFIG_NET_VENDOR_BROCADE=y -+# CONFIG_BNA is not set -+CONFIG_NET_VENDOR_QUALCOMM=y -+# CONFIG_QCA7000_SPI is not set -+# CONFIG_QCA7000_UART is not set -+CONFIG_QCOM_EMAC=m -+CONFIG_RMNET=m -+CONFIG_NET_VENDOR_RDC=y -+# CONFIG_R6040 is not set -+CONFIG_NET_VENDOR_REALTEK=y -+# CONFIG_8139CP is not set -+# CONFIG_8139TOO is not set -+CONFIG_R8169=m -+CONFIG_NET_VENDOR_RENESAS=y -+CONFIG_NET_VENDOR_ROCKER=y -+# CONFIG_ROCKER is not set -+CONFIG_NET_VENDOR_SAMSUNG=y -+# CONFIG_SXGBE_ETH is not set -+CONFIG_NET_VENDOR_SEEQ=y -+CONFIG_NET_VENDOR_SILAN=y -+# CONFIG_SC92031 is not set -+CONFIG_NET_VENDOR_SIS=y -+# CONFIG_SIS900 is not set -+# CONFIG_SIS190 is not set -+CONFIG_NET_VENDOR_SOLARFLARE=y -+# CONFIG_SFC is not set -+# CONFIG_SFC_FALCON is not set -+# CONFIG_SFC_SIENA is not set -+CONFIG_NET_VENDOR_SMSC=y -+CONFIG_SMC91X=y -+# CONFIG_EPIC100 is not set -+CONFIG_SMSC911X=y -+# CONFIG_SMSC9420 is not set -+CONFIG_NET_VENDOR_SOCIONEXT=y -+CONFIG_NET_VENDOR_STMICRO=y -+CONFIG_STMMAC_ETH=y -+# CONFIG_STMMAC_SELFTESTS is not set -+CONFIG_STMMAC_PLATFORM=y -+# CONFIG_DWMAC_DWC_QOS_ETH is not set -+CONFIG_DWMAC_GENERIC=y -+CONFIG_DWMAC_PHYTIUM=y -+# CONFIG_DWMAC_INTEL_PLAT is not set -+# CONFIG_STMMAC_PCI is not set -+CONFIG_NET_VENDOR_SUN=y -+# CONFIG_HAPPYMEAL is not set -+# CONFIG_SUNGEM is not set -+# CONFIG_CASSINI is not set -+# CONFIG_NIU is not set -+CONFIG_NET_VENDOR_SYNOPSYS=y -+# CONFIG_DWC_XLGMAC is not set -+CONFIG_NET_VENDOR_TEHUTI=y -+# CONFIG_TEHUTI is not set -+CONFIG_NET_VENDOR_TI=y -+# CONFIG_TI_CPSW_PHY_SEL is not set -+# CONFIG_TLAN is not set -+CONFIG_NET_VENDOR_VERTEXCOM=y -+# CONFIG_MSE102X is not set -+CONFIG_NET_VENDOR_VIA=y -+# CONFIG_VIA_RHINE is not set -+# CONFIG_VIA_VELOCITY is not set -+CONFIG_NET_VENDOR_WANGXUN=y -+CONFIG_LIBWX=y -+CONFIG_NGBE=y -+# CONFIG_TXGBE is not set -+CONFIG_NET_VENDOR_WIZNET=y -+# CONFIG_WIZNET_W5100 is not set -+# CONFIG_WIZNET_W5300 is not set -+CONFIG_NET_VENDOR_XILINX=y -+# CONFIG_XILINX_EMACLITE is not set -+# CONFIG_XILINX_AXI_EMAC is not set -+# CONFIG_XILINX_LL_TEMAC is not set -+# CONFIG_FDDI is not set -+# CONFIG_HIPPI is not set -+# CONFIG_NET_SB1000 is not set -+CONFIG_PHYLINK=y -+CONFIG_PHYLIB=y -+CONFIG_SWPHY=y -+# CONFIG_LED_TRIGGER_PHY is not set -+CONFIG_PHYLIB_LEDS=y -+CONFIG_FIXED_PHY=y -+# CONFIG_SFP is not set -+ -+# -+# MII PHY device drivers -+# -+# CONFIG_AMD_PHY is not set -+# CONFIG_ADIN_PHY is not set -+# CONFIG_ADIN1100_PHY is not set -+CONFIG_AQUANTIA_PHY=y -+CONFIG_AX88796B_PHY=y -+CONFIG_BROADCOM_PHY=m -+CONFIG_BCM54140_PHY=m -+CONFIG_BCM7XXX_PHY=m -+# CONFIG_BCM84881_PHY is not set -+# CONFIG_BCM87XX_PHY is not set -+CONFIG_BCM_NET_PHYLIB=m -+# CONFIG_CICADA_PHY is not set -+# CONFIG_CORTINA_PHY is not set -+# CONFIG_DAVICOM_PHY is not set -+# CONFIG_ICPLUS_PHY is not set -+# CONFIG_LXT_PHY is not set -+# CONFIG_INTEL_XWAY_PHY is not set -+# CONFIG_LSI_ET1011C_PHY is not set -+CONFIG_MARVELL_PHY=m -+CONFIG_MARVELL_10G_PHY=y -+# CONFIG_MARVELL_88Q2XXX_PHY is not set -+# CONFIG_MARVELL_88X2222_PHY is not set -+# CONFIG_MAXLINEAR_GPHY is not set -+# CONFIG_MEDIATEK_GE_PHY is not set -+CONFIG_MICREL_PHY=y -+# CONFIG_MICROCHIP_T1S_PHY is not set -+CONFIG_MICROCHIP_PHY=m -+# CONFIG_MICROCHIP_T1_PHY is not set -+CONFIG_MICROSEMI_PHY=y -+CONFIG_MOTORCOMM_PHY=y -+# CONFIG_NATIONAL_PHY is not set -+# CONFIG_NXP_CBTX_PHY is not set -+# CONFIG_NXP_C45_TJA11XX_PHY is not set -+# CONFIG_NXP_TJA11XX_PHY is not set -+# CONFIG_NCN26000_PHY is not set -+CONFIG_AT803X_PHY=y -+# CONFIG_QSEMI_PHY is not set -+CONFIG_REALTEK_PHY=y -+# CONFIG_RENESAS_PHY is not set -+CONFIG_ROCKCHIP_PHY=y -+CONFIG_SMSC_PHY=m -+# CONFIG_STE10XP is not set -+# CONFIG_TERANETICS_PHY is not set -+# CONFIG_DP83822_PHY is not set -+# CONFIG_DP83TC811_PHY is not set -+# CONFIG_DP83848_PHY is not set -+CONFIG_DP83867_PHY=y -+CONFIG_DP83869_PHY=m -+CONFIG_DP83TD510_PHY=y -+CONFIG_VITESSE_PHY=y -+# CONFIG_XILINX_GMII2RGMII is not set -+# CONFIG_MICREL_KS8995MA is not set -+# CONFIG_PSE_CONTROLLER is not set -+CONFIG_CAN_DEV=m -+# CONFIG_CAN_VCAN is not set -+# CONFIG_CAN_VXCAN is not set -+CONFIG_CAN_NETLINK=y -+CONFIG_CAN_CALC_BITTIMING=y -+CONFIG_CAN_RX_OFFLOAD=y -+# CONFIG_CAN_CAN327 is not set -+CONFIG_CAN_FLEXCAN=m -+# CONFIG_CAN_GRCAN is not set -+# CONFIG_CAN_KVASER_PCIEFD is not set -+# CONFIG_CAN_SLCAN is not set -+# CONFIG_CAN_XILINXCAN is not set -+# CONFIG_CAN_C_CAN is not set -+# CONFIG_CAN_CC770 is not set -+# CONFIG_CAN_CTUCANFD_PCI is not set -+# CONFIG_CAN_CTUCANFD_PLATFORM is not set -+# CONFIG_CAN_IFI_CANFD is not set -+CONFIG_CAN_M_CAN=m -+# CONFIG_CAN_M_CAN_PCI is not set -+CONFIG_CAN_M_CAN_PLATFORM=m -+# CONFIG_CAN_M_CAN_TCAN4X5X is not set -+# CONFIG_CAN_PEAK_PCIEFD is not set -+CONFIG_CAN_PHYTIUM=m -+CONFIG_CAN_PHYTIUM_PLATFORM=m -+CONFIG_CAN_PHYTIUM_PCI=m -+# CONFIG_CAN_SJA1000 is not set -+# CONFIG_CAN_SOFTING is not set -+ -+# -+# CAN SPI interfaces -+# -+# CONFIG_CAN_HI311X is not set -+# CONFIG_CAN_MCP251X is not set -+CONFIG_CAN_MCP251XFD=m -+# CONFIG_CAN_MCP251XFD_SANITY is not set -+# end of CAN SPI interfaces -+ -+# -+# CAN USB interfaces -+# -+# CONFIG_CAN_8DEV_USB is not set -+# CONFIG_CAN_EMS_USB is not set -+# CONFIG_CAN_ESD_USB is not set -+# CONFIG_CAN_ETAS_ES58X is not set -+# CONFIG_CAN_F81604 is not set -+# CONFIG_CAN_GS_USB is not set -+# CONFIG_CAN_KVASER_USB is not set -+# CONFIG_CAN_MCBA_USB is not set -+# CONFIG_CAN_PEAK_USB is not set -+# CONFIG_CAN_UCAN is not set -+# end of CAN USB interfaces -+ -+# CONFIG_CAN_DEBUG_DEVICES is not set -+CONFIG_MDIO_DEVICE=y -+CONFIG_MDIO_BUS=y -+CONFIG_FWNODE_MDIO=y -+CONFIG_OF_MDIO=y -+CONFIG_ACPI_MDIO=y -+CONFIG_MDIO_DEVRES=y -+CONFIG_MDIO_BITBANG=y -+CONFIG_MDIO_BCM_UNIMAC=y -+CONFIG_MDIO_CAVIUM=y -+CONFIG_MDIO_GPIO=y -+# CONFIG_MDIO_HISI_FEMAC is not set -+# CONFIG_MDIO_MVUSB is not set -+# CONFIG_MDIO_MSCC_MIIM is not set -+# CONFIG_MDIO_OCTEON is not set -+# CONFIG_MDIO_IPQ4019 is not set -+# CONFIG_MDIO_IPQ8064 is not set -+CONFIG_MDIO_THUNDER=y -+ -+# -+# MDIO Multiplexers -+# -+CONFIG_MDIO_BUS_MUX=y -+# CONFIG_MDIO_BUS_MUX_GPIO is not set -+CONFIG_MDIO_BUS_MUX_MULTIPLEXER=y -+CONFIG_MDIO_BUS_MUX_MMIOREG=y -+ -+# -+# PCS device drivers -+# -+CONFIG_PCS_XPCS=y -+# end of PCS device drivers -+ -+CONFIG_PPP=m -+# CONFIG_PPP_BSDCOMP is not set -+CONFIG_PPP_DEFLATE=m -+# CONFIG_PPP_FILTER is not set -+# CONFIG_PPP_MPPE is not set -+# CONFIG_PPP_MULTILINK is not set -+# CONFIG_PPPOE is not set -+CONFIG_PPPOE_HASH_BITS=4 -+CONFIG_PPP_ASYNC=m -+CONFIG_PPP_SYNC_TTY=m -+# CONFIG_SLIP is not set -+CONFIG_SLHC=m -+CONFIG_USB_NET_DRIVERS=y -+# CONFIG_USB_CATC is not set -+# CONFIG_USB_KAWETH is not set -+CONFIG_USB_PEGASUS=m -+CONFIG_USB_RTL8150=m -+CONFIG_USB_RTL8152=m -+CONFIG_USB_LAN78XX=m -+CONFIG_USB_USBNET=y -+CONFIG_USB_NET_AX8817X=y -+CONFIG_USB_NET_AX88179_178A=y -+CONFIG_USB_NET_CDCETHER=y -+# CONFIG_USB_NET_CDC_EEM is not set -+CONFIG_USB_NET_CDC_NCM=y -+# CONFIG_USB_NET_HUAWEI_CDC_NCM is not set -+# CONFIG_USB_NET_CDC_MBIM is not set -+CONFIG_USB_NET_DM9601=m -+# CONFIG_USB_NET_SR9700 is not set -+CONFIG_USB_NET_SR9800=m -+CONFIG_USB_NET_SMSC75XX=m -+CONFIG_USB_NET_SMSC95XX=m -+# CONFIG_USB_NET_GL620A is not set -+CONFIG_USB_NET_NET1080=y -+CONFIG_USB_NET_PLUSB=m -+CONFIG_USB_NET_MCS7830=m -+# CONFIG_USB_NET_RNDIS_HOST is not set -+CONFIG_USB_NET_CDC_SUBSET_ENABLE=y -+CONFIG_USB_NET_CDC_SUBSET=y -+# CONFIG_USB_ALI_M5632 is not set -+# CONFIG_USB_AN2720 is not set -+CONFIG_USB_BELKIN=y -+CONFIG_USB_ARMLINUX=y -+# CONFIG_USB_EPSON2888 is not set -+# CONFIG_USB_KC2190 is not set -+CONFIG_USB_NET_ZAURUS=y -+# CONFIG_USB_NET_CX82310_ETH is not set -+# CONFIG_USB_NET_KALMIA is not set -+CONFIG_USB_NET_QMI_WWAN=m -+# CONFIG_USB_HSO is not set -+# CONFIG_USB_NET_INT51X1 is not set -+# CONFIG_USB_IPHETH is not set -+# CONFIG_USB_SIERRA_NET is not set -+# CONFIG_USB_VL600 is not set -+# CONFIG_USB_NET_CH9200 is not set -+# CONFIG_USB_NET_AQC111 is not set -+CONFIG_USB_RTL8153_ECM=m -+CONFIG_WLAN=y -+CONFIG_WLAN_VENDOR_ADMTEK=y -+# CONFIG_ADM8211 is not set -+CONFIG_ATH_COMMON=m -+CONFIG_WLAN_VENDOR_ATH=y -+# CONFIG_ATH_DEBUG is not set -+# CONFIG_ATH5K is not set -+# CONFIG_ATH5K_PCI is not set -+# CONFIG_ATH9K is not set -+# CONFIG_ATH9K_HTC is not set -+# CONFIG_CARL9170 is not set -+# CONFIG_ATH6KL is not set -+# CONFIG_AR5523 is not set -+# CONFIG_WIL6210 is not set -+CONFIG_ATH10K=m -+CONFIG_ATH10K_CE=y -+CONFIG_ATH10K_PCI=m -+# CONFIG_ATH10K_AHB is not set -+CONFIG_ATH10K_SDIO=m -+# CONFIG_ATH10K_USB is not set -+# CONFIG_ATH10K_DEBUG is not set -+# CONFIG_ATH10K_DEBUGFS is not set -+# CONFIG_ATH10K_TRACING is not set -+CONFIG_WCN36XX=m -+# CONFIG_WCN36XX_DEBUGFS is not set -+CONFIG_ATH11K=m -+CONFIG_ATH11K_AHB=m -+CONFIG_ATH11K_PCI=m -+# CONFIG_ATH11K_DEBUG is not set -+# CONFIG_ATH11K_TRACING is not set -+# CONFIG_ATH12K is not set -+CONFIG_WLAN_VENDOR_ATMEL=y -+# CONFIG_ATMEL is not set -+# CONFIG_AT76C50X_USB is not set -+CONFIG_WLAN_VENDOR_BROADCOM=y -+# CONFIG_B43 is not set -+# CONFIG_B43LEGACY is not set -+CONFIG_BRCMUTIL=m -+# CONFIG_BRCMSMAC is not set -+CONFIG_BRCMFMAC=m -+CONFIG_BRCMFMAC_PROTO_BCDC=y -+CONFIG_BRCMFMAC_SDIO=y -+# CONFIG_BRCMFMAC_USB is not set -+# CONFIG_BRCMFMAC_PCIE is not set -+# CONFIG_BRCM_TRACING is not set -+# CONFIG_BRCMDBG is not set -+CONFIG_WLAN_VENDOR_CISCO=y -+# CONFIG_AIRO is not set -+CONFIG_WLAN_VENDOR_INTEL=y -+# CONFIG_IPW2100 is not set -+# CONFIG_IPW2200 is not set -+# CONFIG_IWL4965 is not set -+# CONFIG_IWL3945 is not set -+# CONFIG_IWLWIFI is not set -+CONFIG_WLAN_VENDOR_INTERSIL=y -+# CONFIG_HOSTAP is not set -+# CONFIG_HERMES is not set -+# CONFIG_P54_COMMON is not set -+CONFIG_WLAN_VENDOR_MARVELL=y -+# CONFIG_LIBERTAS is not set -+# CONFIG_LIBERTAS_THINFIRM is not set -+CONFIG_MWIFIEX=m -+CONFIG_MWIFIEX_SDIO=m -+CONFIG_MWIFIEX_PCIE=m -+# CONFIG_MWIFIEX_USB is not set -+# CONFIG_MWL8K is not set -+CONFIG_WLAN_VENDOR_MEDIATEK=y -+# CONFIG_MT7601U is not set -+CONFIG_MT76_CORE=m -+CONFIG_MT76_LEDS=y -+CONFIG_MT76_CONNAC_LIB=m -+CONFIG_MT792x_LIB=m -+# CONFIG_MT76x0U is not set -+# CONFIG_MT76x0E is not set -+# CONFIG_MT76x2E is not set -+# CONFIG_MT76x2U is not set -+# CONFIG_MT7603E is not set -+# CONFIG_MT7615E is not set -+# CONFIG_MT7663U is not set -+# CONFIG_MT7663S is not set -+# CONFIG_MT7915E is not set -+CONFIG_MT7921_COMMON=m -+CONFIG_MT7921E=m -+# CONFIG_MT7921S is not set -+# CONFIG_MT7921U is not set -+# CONFIG_MT7996E is not set -+CONFIG_WLAN_VENDOR_MICROCHIP=y -+# CONFIG_WILC1000_SDIO is not set -+# CONFIG_WILC1000_SPI is not set -+CONFIG_WLAN_VENDOR_PURELIFI=y -+# CONFIG_PLFXLC is not set -+CONFIG_WLAN_VENDOR_RALINK=y -+# CONFIG_RT2X00 is not set -+CONFIG_WLAN_VENDOR_REALTEK=y -+# CONFIG_RTL8180 is not set -+# CONFIG_RTL8187 is not set -+CONFIG_RTL_CARDS=y -+# CONFIG_RTL8192CE is not set -+# CONFIG_RTL8192SE is not set -+# CONFIG_RTL8192DE is not set -+# CONFIG_RTL8723AE is not set -+# CONFIG_RTL8723BE is not set -+# CONFIG_RTL8188EE is not set -+# CONFIG_RTL8192EE is not set -+# CONFIG_RTL8821AE is not set -+# CONFIG_RTL8192CU is not set -+# CONFIG_RTL8XXXU is not set -+CONFIG_RTW88=m -+CONFIG_RTW88_CORE=m -+CONFIG_RTW88_SDIO=m -+CONFIG_RTW88_8821C=m -+# CONFIG_RTW88_8822BE is not set -+# CONFIG_RTW88_8822BS is not set -+# CONFIG_RTW88_8822BU is not set -+# CONFIG_RTW88_8822CE is not set -+# CONFIG_RTW88_8822CS is not set -+# CONFIG_RTW88_8822CU is not set -+# CONFIG_RTW88_8723DE is not set -+# CONFIG_RTW88_8723DS is not set -+# CONFIG_RTW88_8723DU is not set -+# CONFIG_RTW88_8821CE is not set -+CONFIG_RTW88_8821CS=m -+# CONFIG_RTW88_8821CU is not set -+# CONFIG_RTW88_DEBUG is not set -+# CONFIG_RTW88_DEBUGFS is not set -+# CONFIG_RTW89 is not set -+CONFIG_WLAN_VENDOR_RSI=y -+CONFIG_RSI_91X=m -+CONFIG_RSI_DEBUGFS=y -+CONFIG_RSI_SDIO=m -+CONFIG_RSI_USB=m -+CONFIG_RSI_COEX=y -+CONFIG_WLAN_VENDOR_SILABS=y -+# CONFIG_WFX is not set -+CONFIG_WLAN_VENDOR_ST=y -+# CONFIG_CW1200 is not set -+CONFIG_WLAN_VENDOR_TI=y -+# CONFIG_WL1251 is not set -+# CONFIG_WL12XX is not set -+CONFIG_WL18XX=m -+CONFIG_WLCORE=m -+# CONFIG_WLCORE_SPI is not set -+CONFIG_WLCORE_SDIO=m -+CONFIG_WLAN_VENDOR_ZYDAS=y -+# CONFIG_USB_ZD1201 is not set -+# CONFIG_ZD1211RW is not set -+CONFIG_WLAN_VENDOR_QUANTENNA=y -+# CONFIG_QTNFMAC_PCIE is not set -+# CONFIG_USB_NET_RNDIS_WLAN is not set -+# CONFIG_MAC80211_HWSIM is not set -+# CONFIG_VIRT_WIFI is not set -+# CONFIG_WAN is not set -+ -+# -+# Wireless WAN -+# -+CONFIG_WWAN=m -+CONFIG_WWAN_DEBUGFS=y -+# CONFIG_WWAN_HWSIM is not set -+CONFIG_MHI_WWAN_CTRL=m -+CONFIG_MHI_WWAN_MBIM=m -+# CONFIG_RPMSG_WWAN_CTRL is not set -+# CONFIG_IOSM is not set -+# CONFIG_MTK_T7XX is not set -+# end of Wireless WAN -+ -+CONFIG_XEN_NETDEV_FRONTEND=y -+# CONFIG_XEN_NETDEV_BACKEND is not set -+# CONFIG_VMXNET3 is not set -+# CONFIG_FUJITSU_ES is not set -+# CONFIG_NETDEVSIM is not set -+CONFIG_NET_FAILOVER=y -+# CONFIG_ISDN is not set -+ -+# -+# Input device support -+# -+CONFIG_INPUT=y -+CONFIG_INPUT_LEDS=y -+CONFIG_INPUT_FF_MEMLESS=y -+# CONFIG_INPUT_SPARSEKMAP is not set -+CONFIG_INPUT_MATRIXKMAP=y -+CONFIG_INPUT_VIVALDIFMAP=y -+ -+# -+# Userland interfaces -+# -+# CONFIG_INPUT_MOUSEDEV is not set -+# CONFIG_INPUT_JOYDEV is not set -+CONFIG_INPUT_EVDEV=y -+# CONFIG_INPUT_EVBUG is not set -+ -+# -+# Input Device Drivers -+# -+CONFIG_INPUT_KEYBOARD=y -+CONFIG_KEYBOARD_ADC=m -+# CONFIG_KEYBOARD_ADP5588 is not set -+# CONFIG_KEYBOARD_ADP5589 is not set -+CONFIG_KEYBOARD_ATKBD=y -+# CONFIG_KEYBOARD_QT1050 is not set -+# CONFIG_KEYBOARD_QT1070 is not set -+# CONFIG_KEYBOARD_QT2160 is not set -+# CONFIG_KEYBOARD_DLINK_DIR685 is not set -+# CONFIG_KEYBOARD_LKKBD is not set -+CONFIG_KEYBOARD_GPIO=y -+# CONFIG_KEYBOARD_GPIO_POLLED is not set -+# CONFIG_KEYBOARD_TCA6416 is not set -+# CONFIG_KEYBOARD_TCA8418 is not set -+# CONFIG_KEYBOARD_MATRIX is not set -+# CONFIG_KEYBOARD_LM8323 is not set -+# CONFIG_KEYBOARD_LM8333 is not set -+# CONFIG_KEYBOARD_MAX7359 is not set -+# CONFIG_KEYBOARD_MCS is not set -+# CONFIG_KEYBOARD_MPR121 is not set -+# CONFIG_KEYBOARD_NEWTON is not set -+# CONFIG_KEYBOARD_OPENCORES is not set -+# CONFIG_KEYBOARD_PINEPHONE is not set -+# CONFIG_KEYBOARD_SAMSUNG is not set -+# CONFIG_KEYBOARD_STOWAWAY is not set -+# CONFIG_KEYBOARD_SUNKBD is not set -+# CONFIG_KEYBOARD_OMAP4 is not set -+# CONFIG_KEYBOARD_TM2_TOUCHKEY is not set -+# CONFIG_KEYBOARD_XTKBD is not set -+CONFIG_KEYBOARD_CROS_EC=y -+# CONFIG_KEYBOARD_CAP11XX is not set -+# CONFIG_KEYBOARD_BCM is not set -+CONFIG_KEYBOARD_MTK_PMIC=m -+# CONFIG_KEYBOARD_CYPRESS_SF is not set -+CONFIG_KEYBOARD_PHYTIUM=m -+CONFIG_INPUT_MOUSE=y -+CONFIG_MOUSE_PS2=y -+CONFIG_MOUSE_PS2_ALPS=y -+CONFIG_MOUSE_PS2_BYD=y -+CONFIG_MOUSE_PS2_LOGIPS2PP=y -+CONFIG_MOUSE_PS2_SYNAPTICS=y -+CONFIG_MOUSE_PS2_SYNAPTICS_SMBUS=y -+CONFIG_MOUSE_PS2_CYPRESS=y -+CONFIG_MOUSE_PS2_TRACKPOINT=y -+# CONFIG_MOUSE_PS2_ELANTECH is not set -+# CONFIG_MOUSE_PS2_SENTELIC is not set -+# CONFIG_MOUSE_PS2_TOUCHKIT is not set -+CONFIG_MOUSE_PS2_FOCALTECH=y -+CONFIG_MOUSE_PS2_SMBUS=y -+# CONFIG_MOUSE_SERIAL is not set -+# CONFIG_MOUSE_APPLETOUCH is not set -+# CONFIG_MOUSE_BCM5974 is not set -+# CONFIG_MOUSE_CYAPA is not set -+CONFIG_MOUSE_ELAN_I2C=m -+CONFIG_MOUSE_ELAN_I2C_I2C=y -+# CONFIG_MOUSE_ELAN_I2C_SMBUS is not set -+# CONFIG_MOUSE_VSXXXAA is not set -+# CONFIG_MOUSE_GPIO is not set -+# CONFIG_MOUSE_SYNAPTICS_I2C is not set -+# CONFIG_MOUSE_SYNAPTICS_USB is not set -+# CONFIG_INPUT_JOYSTICK is not set -+# CONFIG_INPUT_TABLET is not set -+CONFIG_INPUT_TOUCHSCREEN=y -+# CONFIG_TOUCHSCREEN_ADS7846 is not set -+# CONFIG_TOUCHSCREEN_AD7877 is not set -+# CONFIG_TOUCHSCREEN_AD7879 is not set -+# CONFIG_TOUCHSCREEN_ADC is not set -+# CONFIG_TOUCHSCREEN_AR1021_I2C is not set -+CONFIG_TOUCHSCREEN_ATMEL_MXT=m -+# CONFIG_TOUCHSCREEN_ATMEL_MXT_T37 is not set -+# CONFIG_TOUCHSCREEN_AUO_PIXCIR is not set -+# CONFIG_TOUCHSCREEN_BU21013 is not set -+# CONFIG_TOUCHSCREEN_BU21029 is not set -+# CONFIG_TOUCHSCREEN_CHIPONE_ICN8318 is not set -+# CONFIG_TOUCHSCREEN_CHIPONE_ICN8505 is not set -+# CONFIG_TOUCHSCREEN_CY8CTMA140 is not set -+# CONFIG_TOUCHSCREEN_CY8CTMG110 is not set -+# CONFIG_TOUCHSCREEN_CYTTSP_CORE is not set -+# CONFIG_TOUCHSCREEN_CYTTSP4_CORE is not set -+# CONFIG_TOUCHSCREEN_CYTTSP5 is not set -+# CONFIG_TOUCHSCREEN_DYNAPRO is not set -+# CONFIG_TOUCHSCREEN_HAMPSHIRE is not set -+# CONFIG_TOUCHSCREEN_EETI is not set -+# CONFIG_TOUCHSCREEN_EGALAX is not set -+# CONFIG_TOUCHSCREEN_EGALAX_SERIAL is not set -+# CONFIG_TOUCHSCREEN_EXC3000 is not set -+# CONFIG_TOUCHSCREEN_FUJITSU is not set -+CONFIG_TOUCHSCREEN_GOODIX=m -+# CONFIG_TOUCHSCREEN_HIDEEP is not set -+# CONFIG_TOUCHSCREEN_HYCON_HY46XX is not set -+# CONFIG_TOUCHSCREEN_HYNITRON_CSTXXX is not set -+# CONFIG_TOUCHSCREEN_ILI210X is not set -+# CONFIG_TOUCHSCREEN_ILITEK is not set -+# CONFIG_TOUCHSCREEN_S6SY761 is not set -+# CONFIG_TOUCHSCREEN_GUNZE is not set -+# CONFIG_TOUCHSCREEN_EKTF2127 is not set -+CONFIG_TOUCHSCREEN_ELAN=m -+# CONFIG_TOUCHSCREEN_ELO is not set -+# CONFIG_TOUCHSCREEN_WACOM_W8001 is not set -+# CONFIG_TOUCHSCREEN_WACOM_I2C is not set -+# CONFIG_TOUCHSCREEN_MAX11801 is not set -+# CONFIG_TOUCHSCREEN_MCS5000 is not set -+# CONFIG_TOUCHSCREEN_MMS114 is not set -+# CONFIG_TOUCHSCREEN_MELFAS_MIP4 is not set -+# CONFIG_TOUCHSCREEN_MSG2638 is not set -+# CONFIG_TOUCHSCREEN_MTOUCH is not set -+# CONFIG_TOUCHSCREEN_NOVATEK_NVT_TS is not set -+# CONFIG_TOUCHSCREEN_IMAGIS is not set -+# CONFIG_TOUCHSCREEN_IMX6UL_TSC is not set -+# CONFIG_TOUCHSCREEN_INEXIO is not set -+# CONFIG_TOUCHSCREEN_PENMOUNT is not set -+CONFIG_TOUCHSCREEN_EDT_FT5X06=m -+# CONFIG_TOUCHSCREEN_TOUCHRIGHT is not set -+# CONFIG_TOUCHSCREEN_TOUCHWIN is not set -+# CONFIG_TOUCHSCREEN_PIXCIR is not set -+# CONFIG_TOUCHSCREEN_WDT87XX_I2C is not set -+# CONFIG_TOUCHSCREEN_USB_COMPOSITE is not set -+# CONFIG_TOUCHSCREEN_TOUCHIT213 is not set -+# CONFIG_TOUCHSCREEN_TSC_SERIO is not set -+# CONFIG_TOUCHSCREEN_TSC2004 is not set -+# CONFIG_TOUCHSCREEN_TSC2005 is not set -+# CONFIG_TOUCHSCREEN_TSC2007 is not set -+# CONFIG_TOUCHSCREEN_RM_TS is not set -+# CONFIG_TOUCHSCREEN_SILEAD is not set -+# CONFIG_TOUCHSCREEN_SIS_I2C is not set -+# CONFIG_TOUCHSCREEN_ST1232 is not set -+# CONFIG_TOUCHSCREEN_STMFTS is not set -+# CONFIG_TOUCHSCREEN_SUR40 is not set -+# CONFIG_TOUCHSCREEN_SURFACE3_SPI is not set -+# CONFIG_TOUCHSCREEN_SX8654 is not set -+# CONFIG_TOUCHSCREEN_TPS6507X is not set -+# CONFIG_TOUCHSCREEN_ZET6223 is not set -+# CONFIG_TOUCHSCREEN_ZFORCE is not set -+# CONFIG_TOUCHSCREEN_COLIBRI_VF50 is not set -+# CONFIG_TOUCHSCREEN_ROHM_BU21023 is not set -+# CONFIG_TOUCHSCREEN_IQS5XX is not set -+# CONFIG_TOUCHSCREEN_IQS7211 is not set -+# CONFIG_TOUCHSCREEN_ZINITIX is not set -+# CONFIG_TOUCHSCREEN_HIMAX_HX83112B is not set -+CONFIG_INPUT_MISC=y -+# CONFIG_INPUT_AD714X is not set -+# CONFIG_INPUT_ATMEL_CAPTOUCH is not set -+# CONFIG_INPUT_BMA150 is not set -+# CONFIG_INPUT_E3X0_BUTTON is not set -+# CONFIG_INPUT_MMA8450 is not set -+# CONFIG_INPUT_GPIO_BEEPER is not set -+# CONFIG_INPUT_GPIO_DECODER is not set -+# CONFIG_INPUT_GPIO_VIBRA is not set -+# CONFIG_INPUT_ATI_REMOTE2 is not set -+# CONFIG_INPUT_KEYSPAN_REMOTE is not set -+# CONFIG_INPUT_KXTJ9 is not set -+# CONFIG_INPUT_POWERMATE is not set -+# CONFIG_INPUT_YEALINK is not set -+# CONFIG_INPUT_CM109 is not set -+# CONFIG_INPUT_REGULATOR_HAPTIC is not set -+CONFIG_INPUT_TPS65219_PWRBUTTON=m -+# CONFIG_INPUT_AXP20X_PEK is not set -+# CONFIG_INPUT_UINPUT is not set -+# CONFIG_INPUT_PCF8574 is not set -+CONFIG_INPUT_PWM_BEEPER=m -+CONFIG_INPUT_PWM_VIBRA=m -+CONFIG_INPUT_RK805_PWRKEY=m -+# CONFIG_INPUT_GPIO_ROTARY_ENCODER is not set -+# CONFIG_INPUT_DA7280_HAPTICS is not set -+# CONFIG_INPUT_ADXL34X is not set -+# CONFIG_INPUT_IBM_PANEL is not set -+# CONFIG_INPUT_IMS_PCU is not set -+# CONFIG_INPUT_IQS269A is not set -+# CONFIG_INPUT_IQS626A is not set -+# CONFIG_INPUT_IQS7222 is not set -+# CONFIG_INPUT_CMA3000 is not set -+CONFIG_INPUT_XEN_KBDDEV_FRONTEND=y -+# CONFIG_INPUT_SOC_BUTTON_ARRAY is not set -+# CONFIG_INPUT_DRV260X_HAPTICS is not set -+# CONFIG_INPUT_DRV2665_HAPTICS is not set -+# CONFIG_INPUT_DRV2667_HAPTICS is not set -+# CONFIG_RMI4_CORE is not set -+ -+# -+# Hardware I/O ports -+# -+CONFIG_SERIO=y -+CONFIG_SERIO_PHYTIUM_PS2=m -+# CONFIG_SERIO_SERPORT is not set -+CONFIG_SERIO_AMBAKMI=y -+# CONFIG_SERIO_PCIPS2 is not set -+CONFIG_SERIO_LIBPS2=y -+# CONFIG_SERIO_RAW is not set -+# CONFIG_SERIO_ALTERA_PS2 is not set -+# CONFIG_SERIO_PS2MULT is not set -+# CONFIG_SERIO_ARC_PS2 is not set -+# CONFIG_SERIO_APBPS2 is not set -+# CONFIG_SERIO_GPIO_PS2 is not set -+# CONFIG_USERIO is not set -+# CONFIG_GAMEPORT is not set -+# end of Hardware I/O ports -+# end of Input device support -+ -+# -+# Character devices -+# -+CONFIG_TTY=y -+CONFIG_VT=y -+CONFIG_CONSOLE_TRANSLATIONS=y -+CONFIG_VT_CONSOLE=y -+CONFIG_VT_CONSOLE_SLEEP=y -+CONFIG_HW_CONSOLE=y -+CONFIG_VT_HW_CONSOLE_BINDING=y -+CONFIG_UNIX98_PTYS=y -+CONFIG_LEGACY_PTYS=y -+CONFIG_LEGACY_PTY_COUNT=16 -+CONFIG_LEGACY_TIOCSTI=y -+CONFIG_LDISC_AUTOLOAD=y -+ -+# -+# Serial drivers -+# -+CONFIG_SERIAL_EARLYCON=y -+CONFIG_SERIAL_8250=y -+CONFIG_SERIAL_8250_DEPRECATED_OPTIONS=y -+CONFIG_SERIAL_8250_PNP=y -+CONFIG_SERIAL_8250_16550A_VARIANTS=y -+# CONFIG_SERIAL_8250_FINTEK is not set -+CONFIG_SERIAL_8250_CONSOLE=y -+CONFIG_SERIAL_8250_DMA=y -+CONFIG_SERIAL_8250_PCILIB=y -+CONFIG_SERIAL_8250_PCI=y -+CONFIG_SERIAL_8250_EXAR=y -+CONFIG_SERIAL_8250_NR_UARTS=4 -+CONFIG_SERIAL_8250_RUNTIME_UARTS=4 -+CONFIG_SERIAL_8250_EXTENDED=y -+# CONFIG_SERIAL_8250_MANY_PORTS is not set -+# CONFIG_SERIAL_8250_PCI1XXXX is not set -+CONFIG_SERIAL_8250_SHARE_IRQ=y -+# CONFIG_SERIAL_8250_DETECT_IRQ is not set -+# CONFIG_SERIAL_8250_RSA is not set -+CONFIG_SERIAL_8250_DWLIB=y -+CONFIG_SERIAL_8250_FSL=y -+CONFIG_SERIAL_8250_DW=y -+# CONFIG_SERIAL_8250_RT288X is not set -+CONFIG_SERIAL_8250_PERICOM=y -+CONFIG_SERIAL_OF_PLATFORM=y -+ -+# -+# Non-8250 serial port support -+# -+# CONFIG_SERIAL_AMBA_PL010 is not set -+CONFIG_SERIAL_AMBA_PL011=y -+CONFIG_SERIAL_AMBA_PL011_CONSOLE=y -+# CONFIG_SERIAL_PHYTIUM_PCI is not set -+# CONFIG_SERIAL_EARLYCON_SEMIHOST is not set -+# CONFIG_SERIAL_MAX3100 is not set -+# CONFIG_SERIAL_MAX310X is not set -+# CONFIG_SERIAL_UARTLITE is not set -+CONFIG_SERIAL_CORE=y -+CONFIG_SERIAL_CORE_CONSOLE=y -+# CONFIG_SERIAL_JSM is not set -+# CONFIG_SERIAL_SIFIVE is not set -+# CONFIG_SERIAL_SCCNXP is not set -+# CONFIG_SERIAL_SC16IS7XX is not set -+# CONFIG_SERIAL_ALTERA_JTAGUART is not set -+# CONFIG_SERIAL_ALTERA_UART is not set -+CONFIG_SERIAL_XILINX_PS_UART=y -+CONFIG_SERIAL_XILINX_PS_UART_CONSOLE=y -+# CONFIG_SERIAL_ARC is not set -+# CONFIG_SERIAL_RP2 is not set -+CONFIG_SERIAL_FSL_LPUART=y -+CONFIG_SERIAL_FSL_LPUART_CONSOLE=y -+CONFIG_SERIAL_FSL_LINFLEXUART=y -+CONFIG_SERIAL_FSL_LINFLEXUART_CONSOLE=y -+# CONFIG_SERIAL_CONEXANT_DIGICOLOR is not set -+# CONFIG_SERIAL_SPRD is not set -+# end of Serial drivers -+ -+CONFIG_SERIAL_MCTRL_GPIO=y -+# CONFIG_SERIAL_NONSTANDARD is not set -+# CONFIG_N_GSM is not set -+# CONFIG_NOZOMI is not set -+# CONFIG_NULL_TTY is not set -+CONFIG_HVC_DRIVER=y -+CONFIG_HVC_IRQ=y -+CONFIG_HVC_XEN=y -+CONFIG_HVC_XEN_FRONTEND=y -+# CONFIG_HVC_DCC is not set -+# CONFIG_RPMSG_TTY is not set -+CONFIG_SERIAL_DEV_BUS=y -+CONFIG_SERIAL_DEV_CTRL_TTYPORT=y -+CONFIG_VIRTIO_CONSOLE=y -+CONFIG_IPMI_HANDLER=m -+CONFIG_IPMI_DMI_DECODE=y -+CONFIG_IPMI_PLAT_DATA=y -+# CONFIG_IPMI_PANIC_EVENT is not set -+CONFIG_IPMI_DEVICE_INTERFACE=m -+CONFIG_IPMI_SI=m -+# CONFIG_IPMI_SSIF is not set -+# CONFIG_IPMI_IPMB is not set -+# CONFIG_IPMI_WATCHDOG is not set -+# CONFIG_IPMI_POWEROFF is not set -+# CONFIG_PHYTIUM_KCS_IPMI_BMC is not set -+# CONFIG_PHYTIUM_BT_IPMI_BMC is not set -+# CONFIG_SSIF_IPMI_BMC is not set -+# CONFIG_IPMB_DEVICE_INTERFACE is not set -+CONFIG_HW_RANDOM=y -+# CONFIG_HW_RANDOM_TIMERIOMEM is not set -+# CONFIG_HW_RANDOM_BA431 is not set -+CONFIG_HW_RANDOM_VIRTIO=y -+# CONFIG_HW_RANDOM_CCTRNG is not set -+# CONFIG_HW_RANDOM_XIPHERA is not set -+CONFIG_HW_RANDOM_ARM_SMCCC_TRNG=y -+CONFIG_HW_RANDOM_CN10K=y -+CONFIG_HW_RANDOM_PHYTIUM=y -+# CONFIG_APPLICOM is not set -+CONFIG_DEVMEM=y -+CONFIG_DEVPORT=y -+CONFIG_TCG_TPM=y -+CONFIG_HW_RANDOM_TPM=y -+CONFIG_TCG_TIS_CORE=m -+CONFIG_TCG_TIS=m -+# CONFIG_TCG_TIS_SPI is not set -+# CONFIG_TCG_TIS_I2C is not set -+CONFIG_TCG_TIS_I2C_CR50=m -+# CONFIG_TCG_TIS_I2C_ATMEL is not set -+CONFIG_TCG_TIS_I2C_INFINEON=y -+# CONFIG_TCG_TIS_I2C_NUVOTON is not set -+# CONFIG_TCG_ATMEL is not set -+# CONFIG_TCG_INFINEON is not set -+# CONFIG_TCG_XEN is not set -+# CONFIG_TCG_CRB is not set -+# CONFIG_TCG_VTPM_PROXY is not set -+# CONFIG_TCG_TIS_ST33ZP24_I2C is not set -+# CONFIG_TCG_TIS_ST33ZP24_SPI is not set -+# CONFIG_XILLYBUS is not set -+# CONFIG_XILLYUSB is not set -+CONFIG_PHYTNET_LED=m -+# end of Character devices -+ -+# -+# I2C support -+# -+CONFIG_I2C=y -+CONFIG_ACPI_I2C_OPREGION=y -+CONFIG_I2C_BOARDINFO=y -+CONFIG_I2C_COMPAT=y -+CONFIG_I2C_CHARDEV=y -+CONFIG_I2C_MUX=y -+ -+# -+# Multiplexer I2C Chip support -+# -+# CONFIG_I2C_ARB_GPIO_CHALLENGE is not set -+# CONFIG_I2C_MUX_GPIO is not set -+# CONFIG_I2C_MUX_GPMUX is not set -+# CONFIG_I2C_MUX_LTC4306 is not set -+# CONFIG_I2C_MUX_PCA9541 is not set -+CONFIG_I2C_MUX_PCA954x=y -+# CONFIG_I2C_MUX_PINCTRL is not set -+# CONFIG_I2C_MUX_REG is not set -+# CONFIG_I2C_DEMUX_PINCTRL is not set -+# CONFIG_I2C_MUX_MLXCPLD is not set -+# end of Multiplexer I2C Chip support -+ -+CONFIG_I2C_HELPER_AUTO=y -+CONFIG_I2C_SMBUS=y -+CONFIG_I2C_ALGOBIT=y -+ -+# -+# I2C Hardware Bus support -+# -+ -+# -+# PC SMBus host controller drivers -+# -+# CONFIG_I2C_ALI1535 is not set -+# CONFIG_I2C_ALI1563 is not set -+# CONFIG_I2C_ALI15X3 is not set -+# CONFIG_I2C_AMD756 is not set -+# CONFIG_I2C_AMD8111 is not set -+# CONFIG_I2C_AMD_MP2 is not set -+# CONFIG_I2C_I801 is not set -+# CONFIG_I2C_ISCH is not set -+# CONFIG_I2C_PIIX4 is not set -+# CONFIG_I2C_NFORCE2 is not set -+# CONFIG_I2C_NVIDIA_GPU is not set -+# CONFIG_I2C_SIS5595 is not set -+# CONFIG_I2C_SIS630 is not set -+# CONFIG_I2C_SIS96X is not set -+# CONFIG_I2C_VIA is not set -+# CONFIG_I2C_VIAPRO is not set -+ -+# -+# ACPI drivers -+# -+# CONFIG_I2C_SCMI is not set -+ -+# -+# I2C system bus drivers (mostly embedded / system-on-chip) -+# -+CONFIG_I2C_CADENCE=m -+# CONFIG_I2C_CBUS_GPIO is not set -+CONFIG_I2C_DESIGNWARE_CORE=y -+# CONFIG_I2C_DESIGNWARE_SLAVE is not set -+CONFIG_I2C_DESIGNWARE_PLATFORM=y -+# CONFIG_I2C_DESIGNWARE_PCI is not set -+# CONFIG_I2C_EMEV2 is not set -+CONFIG_I2C_GPIO=m -+# CONFIG_I2C_GPIO_FAULT_INJECTOR is not set -+# CONFIG_I2C_HISI is not set -+# CONFIG_I2C_NOMADIK is not set -+# CONFIG_I2C_OCORES is not set -+# CONFIG_I2C_PCA_PLATFORM is not set -+CONFIG_I2C_PHYTIUM_CORE=y -+CONFIG_I2C_PHYTIUM_PCI=y -+CONFIG_I2C_PHYTIUM_PLATFORM=y -+CONFIG_I2C_RK3X=y -+# CONFIG_I2C_SIMTEC is not set -+# CONFIG_I2C_THUNDERX is not set -+# CONFIG_I2C_XILINX is not set -+ -+# -+# External I2C/SMBus adapter drivers -+# -+# CONFIG_I2C_DIOLAN_U2C is not set -+# CONFIG_I2C_CP2615 is not set -+# CONFIG_I2C_PCI1XXXX is not set -+# CONFIG_I2C_ROBOTFUZZ_OSIF is not set -+# CONFIG_I2C_TAOS_EVM is not set -+# CONFIG_I2C_TINY_USB is not set -+ -+# -+# Other I2C/SMBus bus drivers -+# -+# CONFIG_I2C_MLXCPLD is not set -+CONFIG_I2C_CROS_EC_TUNNEL=y -+# CONFIG_I2C_VIRTIO is not set -+# end of I2C Hardware Bus support -+ -+# CONFIG_I2C_STUB is not set -+CONFIG_I2C_SLAVE=y -+# CONFIG_I2C_SLAVE_EEPROM is not set -+# CONFIG_I2C_SLAVE_TESTUNIT is not set -+# CONFIG_I2C_DEBUG_CORE is not set -+# CONFIG_I2C_DEBUG_ALGO is not set -+# CONFIG_I2C_DEBUG_BUS is not set -+# end of I2C support -+ -+CONFIG_I3C=y -+# CONFIG_CDNS_I3C_MASTER is not set -+# CONFIG_DW_I3C_MASTER is not set -+# CONFIG_SVC_I3C_MASTER is not set -+# CONFIG_MIPI_I3C_HCI is not set -+CONFIG_PHYTIUM_I3C_MASTER=y -+CONFIG_SPI=y -+# CONFIG_SPI_DEBUG is not set -+CONFIG_SPI_MASTER=y -+CONFIG_SPI_MEM=y -+ -+# -+# SPI Master Controller Drivers -+# -+# CONFIG_SPI_ALTERA is not set -+# CONFIG_SPI_AXI_SPI_ENGINE is not set -+# CONFIG_SPI_BITBANG is not set -+# CONFIG_SPI_CADENCE is not set -+CONFIG_SPI_CADENCE_QUADSPI=y -+# CONFIG_SPI_CADENCE_XSPI is not set -+CONFIG_SPI_DESIGNWARE=m -+CONFIG_SPI_DW_DMA=y -+# CONFIG_SPI_DW_PCI is not set -+CONFIG_SPI_DW_MMIO=m -+# CONFIG_SPI_HISI_KUNPENG is not set -+# CONFIG_SPI_HISI_SFC_V3XX is not set -+# CONFIG_SPI_GPIO is not set -+# CONFIG_SPI_FSL_SPI is not set -+# CONFIG_SPI_MICROCHIP_CORE is not set -+# CONFIG_SPI_MICROCHIP_CORE_QSPI is not set -+# CONFIG_SPI_OC_TINY is not set -+# CONFIG_SPI_PCI1XXXX is not set -+CONFIG_SPI_PHYTIUM=m -+CONFIG_SPI_PHYTIUM_PLAT=m -+CONFIG_SPI_PHYTIUM_PCI=m -+CONFIG_SPI_PHYTIUM_QSPI=m -+CONFIG_SPI_PL022=y -+# CONFIG_SPI_PXA2XX is not set -+# CONFIG_SPI_SC18IS602 is not set -+# CONFIG_SPI_SIFIVE is not set -+# CONFIG_SPI_SN_F_OSPI is not set -+# CONFIG_SPI_MXIC is not set -+# CONFIG_SPI_THUNDERX is not set -+# CONFIG_SPI_XCOMM is not set -+# CONFIG_SPI_XILINX is not set -+# CONFIG_SPI_ZYNQMP_GQSPI is not set -+# CONFIG_SPI_AMD is not set -+ -+# -+# SPI Multiplexer support -+# -+# CONFIG_SPI_MUX is not set -+ -+# -+# SPI Protocol Masters -+# -+CONFIG_SPI_SPIDEV=y -+# CONFIG_SPI_LOOPBACK_TEST is not set -+# CONFIG_SPI_TLE62X0 is not set -+# CONFIG_SPI_SLAVE is not set -+CONFIG_SPI_DYNAMIC=y -+CONFIG_SPMI=y -+# CONFIG_SPMI_HISI3670 is not set -+# CONFIG_HSI is not set -+CONFIG_PPS=y -+# CONFIG_PPS_DEBUG is not set -+ -+# -+# PPS clients support -+# -+# CONFIG_PPS_CLIENT_KTIMER is not set -+# CONFIG_PPS_CLIENT_LDISC is not set -+# CONFIG_PPS_CLIENT_GPIO is not set -+ -+# -+# PPS generators support -+# -+ -+# -+# PTP clock support -+# -+CONFIG_PTP_1588_CLOCK=y -+CONFIG_PTP_1588_CLOCK_OPTIONAL=y -+ -+# -+# Enable PHYLIB and NETWORK_PHY_TIMESTAMPING to see the additional clocks. -+# -+CONFIG_PTP_1588_CLOCK_KVM=y -+# CONFIG_PTP_1588_CLOCK_IDT82P33 is not set -+# CONFIG_PTP_1588_CLOCK_IDTCM is not set -+# CONFIG_PTP_1588_CLOCK_MOCK is not set -+# CONFIG_PTP_1588_CLOCK_OCP is not set -+# end of PTP clock support -+ -+CONFIG_PINCTRL=y -+CONFIG_GENERIC_PINCTRL_GROUPS=y -+CONFIG_PINMUX=y -+CONFIG_GENERIC_PINMUX_FUNCTIONS=y -+CONFIG_PINCONF=y -+CONFIG_GENERIC_PINCONF=y -+# CONFIG_DEBUG_PINCTRL is not set -+# CONFIG_PINCTRL_AMD is not set -+# CONFIG_PINCTRL_AXP209 is not set -+# CONFIG_PINCTRL_CY8C95X0 is not set -+CONFIG_PINCTRL_MAX77620=y -+# CONFIG_PINCTRL_MCP23S08 is not set -+# CONFIG_PINCTRL_MICROCHIP_SGPIO is not set -+# CONFIG_PINCTRL_OCELOT is not set -+CONFIG_PINCTRL_RK805=m -+CONFIG_PINCTRL_SINGLE=y -+# CONFIG_PINCTRL_STMFX is not set -+# CONFIG_PINCTRL_SX150X is not set -+ -+# -+# Renesas pinctrl drivers -+# -+# end of Renesas pinctrl drivers -+ -+CONFIG_GPIOLIB=y -+CONFIG_GPIOLIB_FASTPATH_LIMIT=512 -+CONFIG_OF_GPIO=y -+CONFIG_GPIO_ACPI=y -+CONFIG_GPIOLIB_IRQCHIP=y -+CONFIG_OF_GPIO_MM_GPIOCHIP=y -+# CONFIG_DEBUG_GPIO is not set -+CONFIG_GPIO_CDEV=y -+CONFIG_GPIO_CDEV_V1=y -+CONFIG_GPIO_GENERIC=y -+CONFIG_GPIO_PHYTIUM_CORE=y -+ -+# -+# Memory mapped GPIO drivers -+# -+# CONFIG_GPIO_74XX_MMIO is not set -+CONFIG_GPIO_ALTERA=m -+# CONFIG_GPIO_AMDPT is not set -+# CONFIG_GPIO_CADENCE is not set -+CONFIG_GPIO_DWAPB=y -+# CONFIG_GPIO_EXAR is not set -+# CONFIG_GPIO_FTGPIO010 is not set -+CONFIG_GPIO_GENERIC_PLATFORM=y -+# CONFIG_GPIO_GRGPIO is not set -+# CONFIG_GPIO_HISI is not set -+# CONFIG_GPIO_HLWD is not set -+# CONFIG_GPIO_LOGICVC is not set -+CONFIG_GPIO_MB86S7X=y -+CONFIG_GPIO_PHYTIUM_PLAT=y -+CONFIG_GPIO_PHYTIUM_SGPIO=m -+CONFIG_GPIO_PL061=y -+# CONFIG_GPIO_SIFIVE is not set -+CONFIG_GPIO_SYSCON=y -+CONFIG_GPIO_WCD934X=m -+CONFIG_GPIO_XGENE=y -+# CONFIG_GPIO_XILINX is not set -+# CONFIG_GPIO_AMD_FCH is not set -+# end of Memory mapped GPIO drivers -+ -+# -+# I2C GPIO expanders -+# -+# CONFIG_GPIO_ADNP is not set -+# CONFIG_GPIO_FXL6408 is not set -+# CONFIG_GPIO_DS4520 is not set -+# CONFIG_GPIO_GW_PLD is not set -+# CONFIG_GPIO_MAX7300 is not set -+CONFIG_GPIO_MAX732X=y -+# CONFIG_GPIO_MAX732X_IRQ is not set -+CONFIG_GPIO_PCA953X=y -+CONFIG_GPIO_PCA953X_IRQ=y -+# CONFIG_GPIO_PCA9570 is not set -+# CONFIG_GPIO_PCF857X is not set -+# CONFIG_GPIO_TPIC2810 is not set -+# end of I2C GPIO expanders -+ -+# -+# MFD GPIO expanders -+# -+CONFIG_GPIO_BD9571MWV=m -+CONFIG_GPIO_MAX77620=y -+CONFIG_GPIO_TPS65219=y -+# CONFIG_GPIO_WM8994 is not set -+# end of MFD GPIO expanders -+ -+# -+# PCI GPIO expanders -+# -+# CONFIG_GPIO_BT8XX is not set -+# CONFIG_GPIO_PCI_IDIO_16 is not set -+# CONFIG_GPIO_PCIE_IDIO_24 is not set -+CONFIG_GPIO_PHYTIUM_PCI=y -+# CONFIG_GPIO_RDC321X is not set -+# end of PCI GPIO expanders -+ -+# -+# SPI GPIO expanders -+# -+# CONFIG_GPIO_74X164 is not set -+# CONFIG_GPIO_MAX3191X is not set -+# CONFIG_GPIO_MAX7301 is not set -+# CONFIG_GPIO_MC33880 is not set -+# CONFIG_GPIO_PISOSR is not set -+# CONFIG_GPIO_XRA1403 is not set -+# end of SPI GPIO expanders -+ -+# -+# USB GPIO expanders -+# -+# end of USB GPIO expanders -+ -+# -+# Virtual GPIO drivers -+# -+# CONFIG_GPIO_AGGREGATOR is not set -+# CONFIG_GPIO_LATCH is not set -+# CONFIG_GPIO_MOCKUP is not set -+# CONFIG_GPIO_VIRTIO is not set -+# CONFIG_GPIO_SIM is not set -+# end of Virtual GPIO drivers -+ -+CONFIG_W1=m -+ -+# -+# 1-wire Bus Masters -+# -+# CONFIG_W1_MASTER_MATROX is not set -+# CONFIG_W1_MASTER_DS2490 is not set -+# CONFIG_W1_MASTER_DS2482 is not set -+# CONFIG_W1_MASTER_GPIO is not set -+CONFIG_W1_MASTER_PHYTIUM=y -+# CONFIG_W1_MASTER_SGI is not set -+# end of 1-wire Bus Masters -+ -+# -+# 1-wire Slaves -+# -+CONFIG_W1_SLAVE_THERM=m -+# CONFIG_W1_SLAVE_SMEM is not set -+# CONFIG_W1_SLAVE_DS2405 is not set -+# CONFIG_W1_SLAVE_DS2408 is not set -+# CONFIG_W1_SLAVE_DS2413 is not set -+# CONFIG_W1_SLAVE_DS2406 is not set -+# CONFIG_W1_SLAVE_DS2423 is not set -+# CONFIG_W1_SLAVE_DS2805 is not set -+# CONFIG_W1_SLAVE_DS2430 is not set -+# CONFIG_W1_SLAVE_DS2431 is not set -+# CONFIG_W1_SLAVE_DS2433 is not set -+# CONFIG_W1_SLAVE_DS2438 is not set -+# CONFIG_W1_SLAVE_DS250X is not set -+# CONFIG_W1_SLAVE_DS2780 is not set -+# CONFIG_W1_SLAVE_DS2781 is not set -+# CONFIG_W1_SLAVE_DS28E04 is not set -+# CONFIG_W1_SLAVE_DS28E17 is not set -+# end of 1-wire Slaves -+ -+CONFIG_POWER_RESET=y -+CONFIG_POWER_RESET_BRCMSTB=y -+# CONFIG_POWER_RESET_GPIO is not set -+# CONFIG_POWER_RESET_GPIO_RESTART is not set -+# CONFIG_POWER_RESET_LTC2952 is not set -+# CONFIG_POWER_RESET_MT6323 is not set -+# CONFIG_POWER_RESET_REGULATOR is not set -+# CONFIG_POWER_RESET_RESTART is not set -+# CONFIG_POWER_RESET_VEXPRESS is not set -+CONFIG_POWER_RESET_XGENE=y -+CONFIG_POWER_RESET_SYSCON=y -+CONFIG_POWER_RESET_SYSCON_POWEROFF=y -+CONFIG_REBOOT_MODE=y -+CONFIG_SYSCON_REBOOT_MODE=y -+CONFIG_NVMEM_REBOOT_MODE=m -+CONFIG_POWER_SUPPLY=y -+# CONFIG_POWER_SUPPLY_DEBUG is not set -+CONFIG_POWER_SUPPLY_HWMON=y -+# CONFIG_GENERIC_ADC_BATTERY is not set -+# CONFIG_IP5XXX_POWER is not set -+# CONFIG_TEST_POWER is not set -+# CONFIG_CHARGER_ADP5061 is not set -+# CONFIG_BATTERY_CW2015 is not set -+# CONFIG_BATTERY_DS2760 is not set -+# CONFIG_BATTERY_DS2780 is not set -+# CONFIG_BATTERY_DS2781 is not set -+# CONFIG_BATTERY_DS2782 is not set -+CONFIG_BATTERY_QCOM_BATTMGR=m -+# CONFIG_BATTERY_SAMSUNG_SDI is not set -+CONFIG_BATTERY_SBS=m -+# CONFIG_CHARGER_SBS is not set -+# CONFIG_MANAGER_SBS is not set -+CONFIG_BATTERY_BQ27XXX=y -+CONFIG_BATTERY_BQ27XXX_I2C=y -+CONFIG_BATTERY_BQ27XXX_HDQ=m -+# CONFIG_BATTERY_BQ27XXX_DT_UPDATES_NVM is not set -+# CONFIG_AXP20X_POWER is not set -+# CONFIG_BATTERY_MAX17040 is not set -+CONFIG_BATTERY_MAX17042=m -+# CONFIG_BATTERY_MAX1721X is not set -+# CONFIG_CHARGER_ISP1704 is not set -+# CONFIG_CHARGER_MAX8903 is not set -+# CONFIG_CHARGER_LP8727 is not set -+# CONFIG_CHARGER_GPIO is not set -+# CONFIG_CHARGER_MANAGER is not set -+# CONFIG_CHARGER_LT3651 is not set -+# CONFIG_CHARGER_LTC4162L is not set -+# CONFIG_CHARGER_DETECTOR_MAX14656 is not set -+# CONFIG_CHARGER_MAX77976 is not set -+CONFIG_CHARGER_MT6360=m -+# CONFIG_CHARGER_BQ2415X is not set -+# CONFIG_CHARGER_BQ24190 is not set -+# CONFIG_CHARGER_BQ24257 is not set -+# CONFIG_CHARGER_BQ24735 is not set -+# CONFIG_CHARGER_BQ2515X is not set -+CONFIG_CHARGER_BQ25890=m -+CONFIG_CHARGER_BQ25980=m -+# CONFIG_CHARGER_BQ256XX is not set -+CONFIG_CHARGER_RK817=m -+# CONFIG_CHARGER_SMB347 is not set -+# CONFIG_BATTERY_GAUGE_LTC2941 is not set -+# CONFIG_BATTERY_GOLDFISH is not set -+# CONFIG_BATTERY_RT5033 is not set -+# CONFIG_CHARGER_RT9455 is not set -+# CONFIG_CHARGER_RT9467 is not set -+# CONFIG_CHARGER_RT9471 is not set -+# CONFIG_CHARGER_CROS_USBPD is not set -+CONFIG_CHARGER_CROS_PCHG=y -+# CONFIG_CHARGER_UCS1002 is not set -+# CONFIG_CHARGER_BD99954 is not set -+# CONFIG_BATTERY_UG3105 is not set -+CONFIG_HWMON=y -+# CONFIG_HWMON_DEBUG_CHIP is not set -+ -+# -+# Native drivers -+# -+# CONFIG_SENSORS_AD7314 is not set -+# CONFIG_SENSORS_AD7414 is not set -+# CONFIG_SENSORS_AD7418 is not set -+# CONFIG_SENSORS_ADM1025 is not set -+# CONFIG_SENSORS_ADM1026 is not set -+# CONFIG_SENSORS_ADM1029 is not set -+# CONFIG_SENSORS_ADM1031 is not set -+# CONFIG_SENSORS_ADM1177 is not set -+# CONFIG_SENSORS_ADM9240 is not set -+# CONFIG_SENSORS_ADT7310 is not set -+# CONFIG_SENSORS_ADT7410 is not set -+# CONFIG_SENSORS_ADT7411 is not set -+# CONFIG_SENSORS_ADT7462 is not set -+# CONFIG_SENSORS_ADT7470 is not set -+# CONFIG_SENSORS_ADT7475 is not set -+# CONFIG_SENSORS_AHT10 is not set -+# CONFIG_SENSORS_AQUACOMPUTER_D5NEXT is not set -+# CONFIG_SENSORS_AS370 is not set -+# CONFIG_SENSORS_ASC7621 is not set -+# CONFIG_SENSORS_AXI_FAN_CONTROL is not set -+CONFIG_SENSORS_ARM_SCMI=y -+CONFIG_SENSORS_ARM_SCPI=y -+CONFIG_SENSORS_PHYTIUM=m -+# CONFIG_SENSORS_ATXP1 is not set -+# CONFIG_SENSORS_CORSAIR_CPRO is not set -+# CONFIG_SENSORS_CORSAIR_PSU is not set -+# CONFIG_SENSORS_DRIVETEMP is not set -+# CONFIG_SENSORS_DS620 is not set -+# CONFIG_SENSORS_DS1621 is not set -+# CONFIG_SENSORS_I5K_AMB is not set -+# CONFIG_SENSORS_F71805F is not set -+# CONFIG_SENSORS_F71882FG is not set -+# CONFIG_SENSORS_F75375S is not set -+# CONFIG_SENSORS_FTSTEUTATES is not set -+# CONFIG_SENSORS_GL518SM is not set -+# CONFIG_SENSORS_GL520SM is not set -+# CONFIG_SENSORS_G760A is not set -+# CONFIG_SENSORS_G762 is not set -+CONFIG_SENSORS_GPIO_FAN=m -+# CONFIG_SENSORS_HIH6130 is not set -+# CONFIG_SENSORS_HS3001 is not set -+# CONFIG_SENSORS_IBMAEM is not set -+# CONFIG_SENSORS_IBMPEX is not set -+# CONFIG_SENSORS_IIO_HWMON is not set -+# CONFIG_SENSORS_IT87 is not set -+CONFIG_SENSORS_JC42=m -+# CONFIG_SENSORS_POWR1220 is not set -+# CONFIG_SENSORS_LINEAGE is not set -+# CONFIG_SENSORS_LTC2945 is not set -+# CONFIG_SENSORS_LTC2947_I2C is not set -+# CONFIG_SENSORS_LTC2947_SPI is not set -+# CONFIG_SENSORS_LTC2990 is not set -+# CONFIG_SENSORS_LTC2992 is not set -+# CONFIG_SENSORS_LTC4151 is not set -+# CONFIG_SENSORS_LTC4215 is not set -+# CONFIG_SENSORS_LTC4222 is not set -+# CONFIG_SENSORS_LTC4245 is not set -+# CONFIG_SENSORS_LTC4260 is not set -+# CONFIG_SENSORS_LTC4261 is not set -+# CONFIG_SENSORS_MAX1111 is not set -+# CONFIG_SENSORS_MAX127 is not set -+# CONFIG_SENSORS_MAX16065 is not set -+# CONFIG_SENSORS_MAX1619 is not set -+# CONFIG_SENSORS_MAX1668 is not set -+# CONFIG_SENSORS_MAX197 is not set -+# CONFIG_SENSORS_MAX31722 is not set -+# CONFIG_SENSORS_MAX31730 is not set -+# CONFIG_SENSORS_MAX31760 is not set -+# CONFIG_MAX31827 is not set -+# CONFIG_SENSORS_MAX6620 is not set -+# CONFIG_SENSORS_MAX6621 is not set -+# CONFIG_SENSORS_MAX6639 is not set -+# CONFIG_SENSORS_MAX6650 is not set -+# CONFIG_SENSORS_MAX6697 is not set -+# CONFIG_SENSORS_MAX31790 is not set -+# CONFIG_SENSORS_MC34VR500 is not set -+# CONFIG_SENSORS_MCP3021 is not set -+# CONFIG_SENSORS_TC654 is not set -+# CONFIG_SENSORS_TPS23861 is not set -+# CONFIG_SENSORS_MR75203 is not set -+# CONFIG_SENSORS_ADCXX is not set -+# CONFIG_SENSORS_LM63 is not set -+# CONFIG_SENSORS_LM70 is not set -+# CONFIG_SENSORS_LM73 is not set -+CONFIG_SENSORS_LM75=m -+# CONFIG_SENSORS_LM77 is not set -+# CONFIG_SENSORS_LM78 is not set -+# CONFIG_SENSORS_LM80 is not set -+# CONFIG_SENSORS_LM83 is not set -+# CONFIG_SENSORS_LM85 is not set -+# CONFIG_SENSORS_LM87 is not set -+CONFIG_SENSORS_LM90=m -+# CONFIG_SENSORS_LM92 is not set -+# CONFIG_SENSORS_LM93 is not set -+# CONFIG_SENSORS_LM95234 is not set -+# CONFIG_SENSORS_LM95241 is not set -+# CONFIG_SENSORS_LM95245 is not set -+# CONFIG_SENSORS_PC87360 is not set -+# CONFIG_SENSORS_PC87427 is not set -+# CONFIG_SENSORS_NTC_THERMISTOR is not set -+# CONFIG_SENSORS_NCT6683 is not set -+# CONFIG_SENSORS_NCT6775 is not set -+# CONFIG_SENSORS_NCT6775_I2C is not set -+# CONFIG_SENSORS_NCT7802 is not set -+# CONFIG_SENSORS_NCT7904 is not set -+# CONFIG_SENSORS_NPCM7XX is not set -+# CONFIG_SENSORS_NZXT_KRAKEN2 is not set -+# CONFIG_SENSORS_NZXT_SMART2 is not set -+# CONFIG_SENSORS_OCC_P8_I2C is not set -+# CONFIG_SENSORS_PCF8591 is not set -+# CONFIG_PMBUS is not set -+CONFIG_SENSORS_PWM_FAN=m -+# CONFIG_SENSORS_SBTSI is not set -+# CONFIG_SENSORS_SBRMI is not set -+# CONFIG_SENSORS_SHT15 is not set -+# CONFIG_SENSORS_SHT21 is not set -+# CONFIG_SENSORS_SHT3x is not set -+# CONFIG_SENSORS_SHT4x is not set -+# CONFIG_SENSORS_SHTC1 is not set -+# CONFIG_SENSORS_SIS5595 is not set -+# CONFIG_SENSORS_DME1737 is not set -+# CONFIG_SENSORS_EMC1403 is not set -+# CONFIG_SENSORS_EMC2103 is not set -+# CONFIG_SENSORS_EMC2305 is not set -+# CONFIG_SENSORS_EMC6W201 is not set -+# CONFIG_SENSORS_SMSC47M1 is not set -+# CONFIG_SENSORS_SMSC47M192 is not set -+# CONFIG_SENSORS_SMSC47B397 is not set -+# CONFIG_SENSORS_SCH5627 is not set -+# CONFIG_SENSORS_SCH5636 is not set -+# CONFIG_SENSORS_STTS751 is not set -+# CONFIG_SENSORS_ADC128D818 is not set -+# CONFIG_SENSORS_ADS7828 is not set -+# CONFIG_SENSORS_ADS7871 is not set -+# CONFIG_SENSORS_AMC6821 is not set -+# CONFIG_SENSORS_INA209 is not set -+CONFIG_SENSORS_INA2XX=m -+# CONFIG_SENSORS_INA238 is not set -+CONFIG_SENSORS_INA3221=m -+# CONFIG_SENSORS_TC74 is not set -+# CONFIG_SENSORS_THMC50 is not set -+# CONFIG_SENSORS_TMP102 is not set -+# CONFIG_SENSORS_TMP103 is not set -+# CONFIG_SENSORS_TMP108 is not set -+# CONFIG_SENSORS_TMP401 is not set -+# CONFIG_SENSORS_TMP421 is not set -+# CONFIG_SENSORS_TMP464 is not set -+# CONFIG_SENSORS_TMP513 is not set -+# CONFIG_SENSORS_VEXPRESS is not set -+# CONFIG_SENSORS_VIA686A is not set -+# CONFIG_SENSORS_VT1211 is not set -+# CONFIG_SENSORS_VT8231 is not set -+# CONFIG_SENSORS_W83773G is not set -+# CONFIG_SENSORS_W83781D is not set -+# CONFIG_SENSORS_W83791D is not set -+# CONFIG_SENSORS_W83792D is not set -+# CONFIG_SENSORS_W83793 is not set -+# CONFIG_SENSORS_W83795 is not set -+# CONFIG_SENSORS_W83L785TS is not set -+# CONFIG_SENSORS_W83L786NG is not set -+# CONFIG_SENSORS_W83627HF is not set -+# CONFIG_SENSORS_W83627EHF is not set -+# CONFIG_SENSORS_XGENE is not set -+ -+# -+# ACPI drivers -+# -+# CONFIG_SENSORS_ACPI_POWER is not set -+CONFIG_THERMAL=y -+# CONFIG_THERMAL_NETLINK is not set -+# CONFIG_THERMAL_STATISTICS is not set -+CONFIG_THERMAL_EMERGENCY_POWEROFF_DELAY_MS=0 -+CONFIG_THERMAL_HWMON=y -+CONFIG_THERMAL_OF=y -+# CONFIG_THERMAL_WRITABLE_TRIPS is not set -+CONFIG_THERMAL_DEFAULT_GOV_STEP_WISE=y -+# CONFIG_THERMAL_DEFAULT_GOV_FAIR_SHARE is not set -+# CONFIG_THERMAL_DEFAULT_GOV_USER_SPACE is not set -+# CONFIG_THERMAL_DEFAULT_GOV_POWER_ALLOCATOR is not set -+# CONFIG_THERMAL_GOV_FAIR_SHARE is not set -+CONFIG_THERMAL_GOV_STEP_WISE=y -+# CONFIG_THERMAL_GOV_BANG_BANG is not set -+# CONFIG_THERMAL_GOV_USER_SPACE is not set -+CONFIG_THERMAL_GOV_POWER_ALLOCATOR=y -+CONFIG_CPU_THERMAL=y -+CONFIG_CPU_FREQ_THERMAL=y -+CONFIG_DEVFREQ_THERMAL=y -+CONFIG_THERMAL_EMULATION=y -+# CONFIG_THERMAL_MMIO is not set -+# CONFIG_MAX77620_THERMAL is not set -+CONFIG_GENERIC_ADC_THERMAL=m -+CONFIG_WATCHDOG=y -+CONFIG_WATCHDOG_CORE=y -+# CONFIG_WATCHDOG_NOWAYOUT is not set -+CONFIG_WATCHDOG_HANDLE_BOOT_ENABLED=y -+CONFIG_WATCHDOG_OPEN_TIMEOUT=0 -+# CONFIG_WATCHDOG_SYSFS is not set -+# CONFIG_WATCHDOG_HRTIMER_PRETIMEOUT is not set -+ -+# -+# Watchdog Pretimeout Governors -+# -+# CONFIG_WATCHDOG_PRETIMEOUT_GOV is not set -+ -+# -+# Watchdog Device Drivers -+# -+# CONFIG_SOFT_WATCHDOG is not set -+# CONFIG_GPIO_WATCHDOG is not set -+# CONFIG_WDAT_WDT is not set -+# CONFIG_XILINX_WATCHDOG is not set -+# CONFIG_XILINX_WINDOW_WATCHDOG is not set -+# CONFIG_ZIIRAVE_WATCHDOG is not set -+CONFIG_ARM_SP805_WATCHDOG=y -+CONFIG_ARM_SBSA_WATCHDOG=y -+# CONFIG_CADENCE_WATCHDOG is not set -+CONFIG_DW_WATCHDOG=y -+# CONFIG_MAX63XX_WATCHDOG is not set -+# CONFIG_MAX77620_WATCHDOG is not set -+CONFIG_ARM_SMC_WATCHDOG=y -+# CONFIG_ALIM7101_WDT is not set -+# CONFIG_I6300ESB_WDT is not set -+# CONFIG_HP_WATCHDOG is not set -+# CONFIG_MEN_A21_WDT is not set -+# CONFIG_XEN_WDT is not set -+ -+# -+# PCI-based Watchdog Cards -+# -+# CONFIG_PCIPCWATCHDOG is not set -+# CONFIG_WDTPCI is not set -+ -+# -+# USB-based Watchdog Cards -+# -+# CONFIG_USBPCWATCHDOG is not set -+CONFIG_SSB_POSSIBLE=y -+# CONFIG_SSB is not set -+CONFIG_BCMA_POSSIBLE=y -+# CONFIG_BCMA is not set -+ -+# -+# Multifunction device drivers -+# -+CONFIG_MFD_CORE=y -+# CONFIG_MFD_ACT8945A is not set -+# CONFIG_MFD_AS3711 is not set -+# CONFIG_MFD_SMPRO is not set -+# CONFIG_MFD_AS3722 is not set -+# CONFIG_PMIC_ADP5520 is not set -+# CONFIG_MFD_AAT2870_CORE is not set -+# CONFIG_MFD_ATMEL_FLEXCOM is not set -+# CONFIG_MFD_ATMEL_HLCDC is not set -+# CONFIG_MFD_BCM590XX is not set -+CONFIG_MFD_BD9571MWV=y -+CONFIG_MFD_AXP20X=y -+CONFIG_MFD_AXP20X_I2C=y -+CONFIG_MFD_CROS_EC_DEV=y -+# CONFIG_MFD_CS42L43_I2C is not set -+# CONFIG_MFD_CS42L43_SDW is not set -+# CONFIG_MFD_MADERA is not set -+# CONFIG_MFD_MAX5970 is not set -+# CONFIG_PMIC_DA903X is not set -+# CONFIG_MFD_DA9052_SPI is not set -+# CONFIG_MFD_DA9052_I2C is not set -+# CONFIG_MFD_DA9055 is not set -+# CONFIG_MFD_DA9062 is not set -+# CONFIG_MFD_DA9063 is not set -+# CONFIG_MFD_DA9150 is not set -+# CONFIG_MFD_DLN2 is not set -+# CONFIG_MFD_GATEWORKS_GSC is not set -+# CONFIG_MFD_MC13XXX_SPI is not set -+# CONFIG_MFD_MC13XXX_I2C is not set -+# CONFIG_MFD_MP2629 is not set -+CONFIG_MFD_HI6421_PMIC=y -+# CONFIG_MFD_HI6421_SPMI is not set -+# CONFIG_LPC_ICH is not set -+# CONFIG_LPC_SCH is not set -+# CONFIG_MFD_IQS62X is not set -+# CONFIG_MFD_JANZ_CMODIO is not set -+# CONFIG_MFD_KEMPLD is not set -+# CONFIG_MFD_88PM800 is not set -+# CONFIG_MFD_88PM805 is not set -+# CONFIG_MFD_88PM860X is not set -+# CONFIG_MFD_MAX14577 is not set -+# CONFIG_MFD_MAX77541 is not set -+CONFIG_MFD_MAX77620=y -+# CONFIG_MFD_MAX77650 is not set -+# CONFIG_MFD_MAX77686 is not set -+# CONFIG_MFD_MAX77693 is not set -+# CONFIG_MFD_MAX77714 is not set -+# CONFIG_MFD_MAX77843 is not set -+# CONFIG_MFD_MAX8907 is not set -+# CONFIG_MFD_MAX8925 is not set -+# CONFIG_MFD_MAX8997 is not set -+# CONFIG_MFD_MAX8998 is not set -+CONFIG_MFD_MT6360=y -+# CONFIG_MFD_MT6370 is not set -+CONFIG_MFD_MT6397=y -+# CONFIG_MFD_MENF21BMC is not set -+# CONFIG_MFD_OCELOT is not set -+# CONFIG_EZX_PCAP is not set -+# CONFIG_MFD_CPCAP is not set -+# CONFIG_MFD_VIPERBOARD is not set -+# CONFIG_MFD_NTXEC is not set -+# CONFIG_MFD_RETU is not set -+# CONFIG_MFD_PCF50633 is not set -+CONFIG_MFD_PHYTIUM_I2S_LSD=y -+CONFIG_MFD_PHYTIUM_I2S_MMD=y -+# CONFIG_MFD_SY7636A is not set -+# CONFIG_MFD_RDC321X is not set -+# CONFIG_MFD_RT4831 is not set -+# CONFIG_MFD_RT5033 is not set -+# CONFIG_MFD_RT5120 is not set -+# CONFIG_MFD_RC5T583 is not set -+CONFIG_MFD_RK8XX=y -+CONFIG_MFD_RK8XX_I2C=y -+CONFIG_MFD_RK8XX_SPI=y -+# CONFIG_MFD_RN5T618 is not set -+CONFIG_MFD_SEC_CORE=y -+# CONFIG_MFD_SI476X_CORE is not set -+# CONFIG_MFD_SM501 is not set -+# CONFIG_MFD_SKY81452 is not set -+# CONFIG_MFD_STMPE is not set -+CONFIG_MFD_SYSCON=y -+# CONFIG_MFD_LP3943 is not set -+# CONFIG_MFD_LP8788 is not set -+# CONFIG_MFD_TI_LMU is not set -+# CONFIG_MFD_PALMAS is not set -+# CONFIG_TPS6105X is not set -+# CONFIG_TPS65010 is not set -+# CONFIG_TPS6507X is not set -+# CONFIG_MFD_TPS65086 is not set -+# CONFIG_MFD_TPS65090 is not set -+# CONFIG_MFD_TPS65217 is not set -+# CONFIG_MFD_TI_LP873X is not set -+# CONFIG_MFD_TI_LP87565 is not set -+# CONFIG_MFD_TPS65218 is not set -+CONFIG_MFD_TPS65219=y -+# CONFIG_MFD_TPS6586X is not set -+# CONFIG_MFD_TPS65910 is not set -+# CONFIG_MFD_TPS65912_I2C is not set -+# CONFIG_MFD_TPS65912_SPI is not set -+# CONFIG_MFD_TPS6594_I2C is not set -+# CONFIG_MFD_TPS6594_SPI is not set -+# CONFIG_TWL4030_CORE is not set -+# CONFIG_TWL6040_CORE is not set -+# CONFIG_MFD_WL1273_CORE is not set -+# CONFIG_MFD_LM3533 is not set -+# CONFIG_MFD_TC3589X is not set -+# CONFIG_MFD_TQMX86 is not set -+# CONFIG_MFD_VX855 is not set -+# CONFIG_MFD_LOCHNAGAR is not set -+# CONFIG_MFD_ARIZONA_I2C is not set -+# CONFIG_MFD_ARIZONA_SPI is not set -+# CONFIG_MFD_WM8400 is not set -+# CONFIG_MFD_WM831X_I2C is not set -+# CONFIG_MFD_WM831X_SPI is not set -+# CONFIG_MFD_WM8350_I2C is not set -+CONFIG_MFD_WM8994=m -+CONFIG_MFD_ROHM_BD718XX=y -+# CONFIG_MFD_ROHM_BD71828 is not set -+# CONFIG_MFD_ROHM_BD957XMUF is not set -+# CONFIG_MFD_STPMIC1 is not set -+# CONFIG_MFD_STMFX is not set -+CONFIG_MFD_WCD934X=m -+# CONFIG_MFD_ATC260X_I2C is not set -+# CONFIG_MFD_QCOM_PM8008 is not set -+CONFIG_MFD_VEXPRESS_SYSREG=y -+# CONFIG_RAVE_SP_CORE is not set -+# CONFIG_MFD_INTEL_M10_BMC_SPI is not set -+# CONFIG_MFD_RSMU_I2C is not set -+# CONFIG_MFD_RSMU_SPI is not set -+# end of Multifunction device drivers -+ -+CONFIG_REGULATOR=y -+# CONFIG_REGULATOR_DEBUG is not set -+CONFIG_REGULATOR_FIXED_VOLTAGE=y -+# CONFIG_REGULATOR_VIRTUAL_CONSUMER is not set -+# CONFIG_REGULATOR_USERSPACE_CONSUMER is not set -+# CONFIG_REGULATOR_88PG86X is not set -+# CONFIG_REGULATOR_ACT8865 is not set -+# CONFIG_REGULATOR_AD5398 is not set -+# CONFIG_REGULATOR_ARM_SCMI is not set -+# CONFIG_REGULATOR_AW37503 is not set -+CONFIG_REGULATOR_AXP20X=y -+CONFIG_REGULATOR_BD718XX=y -+CONFIG_REGULATOR_BD9571MWV=y -+CONFIG_REGULATOR_CROS_EC=y -+# CONFIG_REGULATOR_DA9121 is not set -+# CONFIG_REGULATOR_DA9210 is not set -+# CONFIG_REGULATOR_DA9211 is not set -+CONFIG_REGULATOR_FAN53555=y -+# CONFIG_REGULATOR_FAN53880 is not set -+CONFIG_REGULATOR_GPIO=y -+# CONFIG_REGULATOR_HI6421 is not set -+CONFIG_REGULATOR_HI6421V530=y -+# CONFIG_REGULATOR_ISL9305 is not set -+# CONFIG_REGULATOR_ISL6271A is not set -+# CONFIG_REGULATOR_LP3971 is not set -+# CONFIG_REGULATOR_LP3972 is not set -+# CONFIG_REGULATOR_LP872X is not set -+# CONFIG_REGULATOR_LP8755 is not set -+# CONFIG_REGULATOR_LTC3589 is not set -+# CONFIG_REGULATOR_LTC3676 is not set -+# CONFIG_REGULATOR_MAX1586 is not set -+CONFIG_REGULATOR_MAX77620=y -+# CONFIG_REGULATOR_MAX77857 is not set -+# CONFIG_REGULATOR_MAX8649 is not set -+# CONFIG_REGULATOR_MAX8660 is not set -+# CONFIG_REGULATOR_MAX8893 is not set -+# CONFIG_REGULATOR_MAX8952 is not set -+CONFIG_REGULATOR_MAX8973=y -+# CONFIG_REGULATOR_MAX20086 is not set -+# CONFIG_REGULATOR_MAX20411 is not set -+# CONFIG_REGULATOR_MAX77826 is not set -+# CONFIG_REGULATOR_MCP16502 is not set -+# CONFIG_REGULATOR_MP5416 is not set -+CONFIG_REGULATOR_MP8859=y -+# CONFIG_REGULATOR_MP886X is not set -+# CONFIG_REGULATOR_MPQ7920 is not set -+# CONFIG_REGULATOR_MT6311 is not set -+CONFIG_REGULATOR_MT6315=m -+# CONFIG_REGULATOR_MT6323 is not set -+# CONFIG_REGULATOR_MT6331 is not set -+# CONFIG_REGULATOR_MT6332 is not set -+CONFIG_REGULATOR_MT6357=y -+CONFIG_REGULATOR_MT6358=y -+CONFIG_REGULATOR_MT6359=y -+CONFIG_REGULATOR_MT6360=y -+CONFIG_REGULATOR_MT6397=y -+CONFIG_REGULATOR_PCA9450=y -+CONFIG_REGULATOR_PF8X00=y -+CONFIG_REGULATOR_PFUZE100=y -+# CONFIG_REGULATOR_PV88060 is not set -+# CONFIG_REGULATOR_PV88080 is not set -+# CONFIG_REGULATOR_PV88090 is not set -+CONFIG_REGULATOR_PWM=y -+CONFIG_REGULATOR_QCOM_SPMI=y -+# CONFIG_REGULATOR_QCOM_USB_VBUS is not set -+CONFIG_REGULATOR_RAA215300=y -+# CONFIG_REGULATOR_RASPBERRYPI_TOUCHSCREEN_ATTINY is not set -+CONFIG_REGULATOR_RK808=y -+CONFIG_REGULATOR_ROHM=y -+# CONFIG_REGULATOR_RT4801 is not set -+# CONFIG_REGULATOR_RT4803 is not set -+# CONFIG_REGULATOR_RT5190A is not set -+# CONFIG_REGULATOR_RT5739 is not set -+# CONFIG_REGULATOR_RT5759 is not set -+# CONFIG_REGULATOR_RT6160 is not set -+# CONFIG_REGULATOR_RT6190 is not set -+# CONFIG_REGULATOR_RT6245 is not set -+# CONFIG_REGULATOR_RTQ2134 is not set -+# CONFIG_REGULATOR_RTMV20 is not set -+# CONFIG_REGULATOR_RTQ6752 is not set -+# CONFIG_REGULATOR_RTQ2208 is not set -+# CONFIG_REGULATOR_S2MPA01 is not set -+CONFIG_REGULATOR_S2MPS11=y -+# CONFIG_REGULATOR_S5M8767 is not set -+# CONFIG_REGULATOR_SLG51000 is not set -+# CONFIG_REGULATOR_SY8106A is not set -+# CONFIG_REGULATOR_SY8824X is not set -+# CONFIG_REGULATOR_SY8827N is not set -+# CONFIG_REGULATOR_TPS51632 is not set -+# CONFIG_REGULATOR_TPS62360 is not set -+# CONFIG_REGULATOR_TPS6286X is not set -+# CONFIG_REGULATOR_TPS6287X is not set -+# CONFIG_REGULATOR_TPS65023 is not set -+# CONFIG_REGULATOR_TPS6507X is not set -+CONFIG_REGULATOR_TPS65132=m -+CONFIG_REGULATOR_TPS65219=y -+# CONFIG_REGULATOR_TPS6524X is not set -+CONFIG_REGULATOR_VCTRL=m -+# CONFIG_REGULATOR_VEXPRESS is not set -+# CONFIG_REGULATOR_WM8994 is not set -+# CONFIG_REGULATOR_QCOM_LABIBB is not set -+CONFIG_RC_CORE=m -+# CONFIG_LIRC is not set -+CONFIG_RC_MAP=m -+CONFIG_RC_DECODERS=y -+# CONFIG_IR_IMON_DECODER is not set -+# CONFIG_IR_JVC_DECODER is not set -+# CONFIG_IR_MCE_KBD_DECODER is not set -+# CONFIG_IR_NEC_DECODER is not set -+# CONFIG_IR_RC5_DECODER is not set -+# CONFIG_IR_RC6_DECODER is not set -+# CONFIG_IR_RCMM_DECODER is not set -+# CONFIG_IR_SANYO_DECODER is not set -+# CONFIG_IR_SHARP_DECODER is not set -+# CONFIG_IR_SONY_DECODER is not set -+# CONFIG_IR_XMP_DECODER is not set -+CONFIG_RC_DEVICES=y -+# CONFIG_IR_ENE is not set -+# CONFIG_IR_FINTEK is not set -+CONFIG_IR_GPIO_CIR=m -+# CONFIG_IR_HIX5HD2 is not set -+# CONFIG_IR_IGORPLUGUSB is not set -+# CONFIG_IR_IGUANA is not set -+# CONFIG_IR_IMON is not set -+# CONFIG_IR_IMON_RAW is not set -+# CONFIG_IR_ITE_CIR is not set -+# CONFIG_IR_MCEUSB is not set -+# CONFIG_IR_NUVOTON is not set -+# CONFIG_IR_REDRAT3 is not set -+# CONFIG_IR_SERIAL is not set -+# CONFIG_IR_STREAMZAP is not set -+# CONFIG_IR_TOY is not set -+# CONFIG_IR_TTUSBIR is not set -+# CONFIG_RC_ATI_REMOTE is not set -+# CONFIG_RC_LOOPBACK is not set -+# CONFIG_RC_XBOX_DVD is not set -+CONFIG_CEC_CORE=m -+ -+# -+# CEC support -+# -+# CONFIG_MEDIA_CEC_RC is not set -+# CONFIG_MEDIA_CEC_SUPPORT is not set -+# end of CEC support -+ -+CONFIG_MEDIA_SUPPORT=y -+CONFIG_MEDIA_SUPPORT_FILTER=y -+CONFIG_MEDIA_SUBDRV_AUTOSELECT=y -+ -+# -+# Media device types -+# -+CONFIG_MEDIA_CAMERA_SUPPORT=y -+CONFIG_MEDIA_ANALOG_TV_SUPPORT=y -+CONFIG_MEDIA_DIGITAL_TV_SUPPORT=y -+# CONFIG_MEDIA_RADIO_SUPPORT is not set -+CONFIG_MEDIA_SDR_SUPPORT=y -+CONFIG_MEDIA_PLATFORM_SUPPORT=y -+# CONFIG_MEDIA_TEST_SUPPORT is not set -+# end of Media device types -+ -+CONFIG_VIDEO_DEV=y -+CONFIG_MEDIA_CONTROLLER=y -+CONFIG_DVB_CORE=y -+ -+# -+# Video4Linux options -+# -+CONFIG_VIDEO_V4L2_I2C=y -+CONFIG_VIDEO_V4L2_SUBDEV_API=y -+# CONFIG_VIDEO_ADV_DEBUG is not set -+# CONFIG_VIDEO_FIXED_MINOR_RANGES is not set -+CONFIG_V4L2_FWNODE=y -+CONFIG_V4L2_ASYNC=y -+CONFIG_V4L2_CCI=m -+CONFIG_V4L2_CCI_I2C=m -+# end of Video4Linux options -+ -+# -+# Media controller options -+# -+# CONFIG_MEDIA_CONTROLLER_DVB is not set -+# end of Media controller options -+ -+# -+# Digital TV options -+# -+# CONFIG_DVB_MMAP is not set -+# CONFIG_DVB_NET is not set -+CONFIG_DVB_MAX_ADAPTERS=16 -+CONFIG_DVB_DYNAMIC_MINORS=y -+# CONFIG_DVB_DEMUX_SECTION_LOSS_LOG is not set -+# CONFIG_DVB_ULE_DEBUG is not set -+# end of Digital TV options -+ -+# -+# Media drivers -+# -+ -+# -+# Drivers filtered as selected at 'Filter media drivers' -+# -+ -+# -+# Media drivers -+# -+CONFIG_MEDIA_USB_SUPPORT=y -+ -+# -+# Webcam devices -+# -+# CONFIG_USB_GSPCA is not set -+# CONFIG_USB_PWC is not set -+# CONFIG_USB_S2255 is not set -+# CONFIG_VIDEO_USBTV is not set -+CONFIG_USB_VIDEO_CLASS=y -+CONFIG_USB_VIDEO_CLASS_INPUT_EVDEV=y -+ -+# -+# Analog TV USB devices -+# -+# CONFIG_VIDEO_GO7007 is not set -+# CONFIG_VIDEO_HDPVR is not set -+# CONFIG_VIDEO_PVRUSB2 is not set -+# CONFIG_VIDEO_STK1160 is not set -+ -+# -+# Analog/digital TV USB devices -+# -+# CONFIG_VIDEO_AU0828 is not set -+# CONFIG_VIDEO_CX231XX is not set -+ -+# -+# Digital TV USB devices -+# -+# CONFIG_DVB_AS102 is not set -+# CONFIG_DVB_B2C2_FLEXCOP_USB is not set -+# CONFIG_DVB_USB_V2 is not set -+# CONFIG_DVB_USB is not set -+# CONFIG_SMS_USB_DRV is not set -+# CONFIG_DVB_TTUSB_BUDGET is not set -+# CONFIG_DVB_TTUSB_DEC is not set -+ -+# -+# Webcam, TV (analog/digital) USB devices -+# -+# CONFIG_VIDEO_EM28XX is not set -+ -+# -+# Software defined radio USB devices -+# -+# CONFIG_USB_AIRSPY is not set -+# CONFIG_USB_HACKRF is not set -+# CONFIG_USB_MSI2500 is not set -+# CONFIG_MEDIA_PCI_SUPPORT is not set -+CONFIG_MEDIA_PLATFORM_DRIVERS=y -+CONFIG_V4L_PLATFORM_DRIVERS=y -+CONFIG_SDR_PLATFORM_DRIVERS=y -+# CONFIG_DVB_PLATFORM_DRIVERS is not set -+CONFIG_V4L_MEM2MEM_DRIVERS=y -+# CONFIG_VIDEO_MEM2MEM_DEINTERLACE is not set -+# CONFIG_VIDEO_MUX is not set -+ -+# -+# Allegro DVT media platform drivers -+# -+ -+# -+# Amlogic media platform drivers -+# -+ -+# -+# Amphion drivers -+# -+ -+# -+# Aspeed media platform drivers -+# -+ -+# -+# Atmel media platform drivers -+# -+ -+# -+# Cadence media platform drivers -+# -+# CONFIG_VIDEO_CADENCE_CSI2RX is not set -+# CONFIG_VIDEO_CADENCE_CSI2TX is not set -+ -+# -+# Chips&Media media platform drivers -+# -+ -+# -+# Intel media platform drivers -+# -+ -+# -+# Marvell media platform drivers -+# -+# CONFIG_VIDEO_CAFE_CCIC is not set -+ -+# -+# Mediatek media platform drivers -+# -+ -+# -+# Microchip Technology, Inc. media platform drivers -+# -+ -+# -+# NVidia media platform drivers -+# -+ -+# -+# NXP media platform drivers -+# -+ -+# -+# Phytium media platform drivers -+# -+CONFIG_VIDEO_PHYTIUM_JPEG=m -+ -+# -+# Qualcomm media platform drivers -+# -+ -+# -+# Renesas media platform drivers -+# -+ -+# -+# Rockchip media platform drivers -+# -+ -+# -+# Samsung media platform drivers -+# -+ -+# -+# STMicroelectronics media platform drivers -+# -+ -+# -+# Sunxi media platform drivers -+# -+ -+# -+# Texas Instruments drivers -+# -+ -+# -+# Verisilicon media platform drivers -+# -+ -+# -+# VIA media platform drivers -+# -+ -+# -+# Xilinx media platform drivers -+# -+# CONFIG_VIDEO_XILINX is not set -+ -+# -+# MMC/SDIO DVB adapters -+# -+# CONFIG_SMS_SDIO_DRV is not set -+CONFIG_UVC_COMMON=y -+CONFIG_VIDEOBUF2_CORE=y -+CONFIG_VIDEOBUF2_V4L2=y -+CONFIG_VIDEOBUF2_MEMOPS=y -+CONFIG_VIDEOBUF2_DMA_CONTIG=m -+CONFIG_VIDEOBUF2_VMALLOC=y -+CONFIG_VIDEOBUF2_DMA_SG=y -+# end of Media drivers -+ -+CONFIG_MEDIA_HIDE_ANCILLARY_SUBDRV=y -+ -+# -+# Media ancillary drivers -+# -+CONFIG_MEDIA_ATTACH=y -+ -+# -+# IR I2C driver auto-selected by 'Autoselect ancillary drivers' -+# -+CONFIG_VIDEO_IR_I2C=m -+CONFIG_VIDEO_CAMERA_SENSOR=y -+# CONFIG_VIDEO_AR0521 is not set -+# CONFIG_VIDEO_HI556 is not set -+# CONFIG_VIDEO_HI846 is not set -+# CONFIG_VIDEO_HI847 is not set -+# CONFIG_VIDEO_IMX208 is not set -+# CONFIG_VIDEO_IMX214 is not set -+CONFIG_VIDEO_IMX219=m -+# CONFIG_VIDEO_IMX258 is not set -+# CONFIG_VIDEO_IMX274 is not set -+# CONFIG_VIDEO_IMX290 is not set -+# CONFIG_VIDEO_IMX296 is not set -+# CONFIG_VIDEO_IMX319 is not set -+# CONFIG_VIDEO_IMX334 is not set -+# CONFIG_VIDEO_IMX335 is not set -+# CONFIG_VIDEO_IMX355 is not set -+CONFIG_VIDEO_IMX412=m -+# CONFIG_VIDEO_IMX415 is not set -+# CONFIG_VIDEO_MT9M001 is not set -+# CONFIG_VIDEO_MT9M111 is not set -+# CONFIG_VIDEO_MT9P031 is not set -+# CONFIG_VIDEO_MT9T112 is not set -+# CONFIG_VIDEO_MT9V011 is not set -+# CONFIG_VIDEO_MT9V032 is not set -+# CONFIG_VIDEO_MT9V111 is not set -+# CONFIG_VIDEO_OG01A1B is not set -+# CONFIG_VIDEO_OV01A10 is not set -+# CONFIG_VIDEO_OV02A10 is not set -+# CONFIG_VIDEO_OV08D10 is not set -+# CONFIG_VIDEO_OV08X40 is not set -+# CONFIG_VIDEO_OV13858 is not set -+# CONFIG_VIDEO_OV13B10 is not set -+# CONFIG_VIDEO_OV2640 is not set -+# CONFIG_VIDEO_OV2659 is not set -+# CONFIG_VIDEO_OV2680 is not set -+# CONFIG_VIDEO_OV2685 is not set -+# CONFIG_VIDEO_OV2740 is not set -+# CONFIG_VIDEO_OV4689 is not set -+CONFIG_VIDEO_OV5640=m -+CONFIG_VIDEO_OV5645=m -+# CONFIG_VIDEO_OV5647 is not set -+# CONFIG_VIDEO_OV5648 is not set -+# CONFIG_VIDEO_OV5670 is not set -+# CONFIG_VIDEO_OV5675 is not set -+# CONFIG_VIDEO_OV5693 is not set -+# CONFIG_VIDEO_OV5695 is not set -+# CONFIG_VIDEO_OV6650 is not set -+# CONFIG_VIDEO_OV7251 is not set -+# CONFIG_VIDEO_OV7640 is not set -+# CONFIG_VIDEO_OV7670 is not set -+# CONFIG_VIDEO_OV772X is not set -+# CONFIG_VIDEO_OV7740 is not set -+# CONFIG_VIDEO_OV8856 is not set -+# CONFIG_VIDEO_OV8858 is not set -+# CONFIG_VIDEO_OV8865 is not set -+# CONFIG_VIDEO_OV9282 is not set -+# CONFIG_VIDEO_OV9640 is not set -+# CONFIG_VIDEO_OV9650 is not set -+# CONFIG_VIDEO_OV9734 is not set -+# CONFIG_VIDEO_RDACM20 is not set -+# CONFIG_VIDEO_RDACM21 is not set -+# CONFIG_VIDEO_RJ54N1 is not set -+# CONFIG_VIDEO_S5C73M3 is not set -+# CONFIG_VIDEO_S5K5BAF is not set -+# CONFIG_VIDEO_S5K6A3 is not set -+# CONFIG_VIDEO_ST_VGXY61 is not set -+# CONFIG_VIDEO_CCS is not set -+# CONFIG_VIDEO_ET8EK8 is not set -+ -+# -+# Lens drivers -+# -+# CONFIG_VIDEO_AD5820 is not set -+# CONFIG_VIDEO_AK7375 is not set -+# CONFIG_VIDEO_DW9714 is not set -+# CONFIG_VIDEO_DW9719 is not set -+# CONFIG_VIDEO_DW9768 is not set -+# CONFIG_VIDEO_DW9807_VCM is not set -+# end of Lens drivers -+ -+# -+# Flash devices -+# -+# CONFIG_VIDEO_ADP1653 is not set -+# CONFIG_VIDEO_LM3560 is not set -+# CONFIG_VIDEO_LM3646 is not set -+# end of Flash devices -+ -+# -+# audio, video and radio I2C drivers auto-selected by 'Autoselect ancillary drivers' -+# -+ -+# -+# Video and audio decoders -+# -+ -+# -+# Video serializers and deserializers -+# -+# CONFIG_VIDEO_DS90UB913 is not set -+# CONFIG_VIDEO_DS90UB953 is not set -+# CONFIG_VIDEO_DS90UB960 is not set -+# end of Video serializers and deserializers -+ -+# -+# SPI I2C drivers auto-selected by 'Autoselect ancillary drivers' -+# -+ -+# -+# Media SPI Adapters -+# -+# CONFIG_CXD2880_SPI_DRV is not set -+# CONFIG_VIDEO_GS1662 is not set -+# end of Media SPI Adapters -+ -+CONFIG_MEDIA_TUNER=y -+ -+# -+# Tuner drivers auto-selected by 'Autoselect ancillary drivers' -+# -+CONFIG_MEDIA_TUNER_MC44S803=y -+CONFIG_MEDIA_TUNER_MT20XX=y -+CONFIG_MEDIA_TUNER_SIMPLE=y -+CONFIG_MEDIA_TUNER_TDA18271=y -+CONFIG_MEDIA_TUNER_TDA827X=y -+CONFIG_MEDIA_TUNER_TDA8290=y -+CONFIG_MEDIA_TUNER_TDA9887=y -+CONFIG_MEDIA_TUNER_XC2028=y -+CONFIG_MEDIA_TUNER_XC4000=y -+CONFIG_MEDIA_TUNER_XC5000=y -+ -+# -+# DVB Frontend drivers auto-selected by 'Autoselect ancillary drivers' -+# -+ -+# -+# Multistandard (satellite) frontends -+# -+ -+# -+# Multistandard (cable + terrestrial) frontends -+# -+ -+# -+# DVB-S (satellite) frontends -+# -+ -+# -+# DVB-T (terrestrial) frontends -+# -+ -+# -+# DVB-C (cable) frontends -+# -+ -+# -+# ATSC (North American/Korean Terrestrial/Cable DTV) frontends -+# -+ -+# -+# ISDB-T (terrestrial) frontends -+# -+ -+# -+# ISDB-S (satellite) & ISDB-T (terrestrial) frontends -+# -+ -+# -+# Digital terrestrial only tuners/PLL -+# -+ -+# -+# SEC control devices for DVB-S -+# -+ -+# -+# Common Interface (EN50221) controller drivers -+# -+# end of Media ancillary drivers -+ -+# -+# Graphics support -+# -+CONFIG_VIDEO_CMDLINE=y -+CONFIG_VIDEO_NOMODESET=y -+# CONFIG_AUXDISPLAY is not set -+CONFIG_DRM=y -+CONFIG_DRM_MIPI_DSI=y -+# CONFIG_DRM_DEBUG_MM is not set -+CONFIG_DRM_KMS_HELPER=y -+CONFIG_DRM_FBDEV_EMULATION=y -+CONFIG_DRM_FBDEV_OVERALLOC=100 -+# CONFIG_DRM_LOAD_EDID_FIRMWARE is not set -+CONFIG_DRM_DP_AUX_BUS=m -+CONFIG_DRM_DISPLAY_HELPER=y -+CONFIG_DRM_DISPLAY_DP_HELPER=y -+CONFIG_DRM_DISPLAY_HDCP_HELPER=y -+CONFIG_DRM_DISPLAY_HDMI_HELPER=y -+# CONFIG_DRM_DP_AUX_CHARDEV is not set -+# CONFIG_DRM_DP_CEC is not set -+CONFIG_DRM_TTM=y -+CONFIG_DRM_EXEC=y -+CONFIG_DRM_BUDDY=y -+CONFIG_DRM_VRAM_HELPER=m -+CONFIG_DRM_TTM_HELPER=y -+CONFIG_DRM_GEM_DMA_HELPER=m -+CONFIG_DRM_GEM_SHMEM_HELPER=m -+CONFIG_DRM_SUBALLOC_HELPER=y -+CONFIG_DRM_SCHED=y -+ -+# -+# I2C encoder or helper chips -+# -+CONFIG_DRM_I2C_CH7006=m -+CONFIG_DRM_I2C_SIL164=m -+CONFIG_DRM_I2C_NXP_TDA998X=m -+# CONFIG_DRM_I2C_NXP_TDA9950 is not set -+# end of I2C encoder or helper chips -+ -+# -+# ARM devices -+# -+CONFIG_DRM_HDLCD=m -+# CONFIG_DRM_HDLCD_SHOW_UNDERRUN is not set -+CONFIG_DRM_MALI_DISPLAY=m -+CONFIG_DRM_KOMEDA=m -+# end of ARM devices -+ -+# CONFIG_DRM_RADEON is not set -+CONFIG_DRM_AMDGPU=y -+CONFIG_DRM_AMDGPU_SI=y -+CONFIG_DRM_AMDGPU_CIK=y -+CONFIG_DRM_AMDGPU_USERPTR=y -+ -+# -+# ACP (Audio CoProcessor) Configuration -+# -+# CONFIG_DRM_AMD_ACP is not set -+# end of ACP (Audio CoProcessor) Configuration -+ -+# -+# Display Engine Configuration -+# -+CONFIG_DRM_AMD_DC=y -+CONFIG_DRM_AMD_DC_FP=y -+# CONFIG_DRM_AMD_DC_SI is not set -+# CONFIG_DRM_AMD_SECURE_DISPLAY is not set -+# end of Display Engine Configuration -+ -+CONFIG_HSA_AMD=y -+CONFIG_DRM_NOUVEAU=m -+CONFIG_NOUVEAU_DEBUG=5 -+CONFIG_NOUVEAU_DEBUG_DEFAULT=3 -+# CONFIG_NOUVEAU_DEBUG_MMU is not set -+# CONFIG_NOUVEAU_DEBUG_PUSH is not set -+CONFIG_DRM_NOUVEAU_BACKLIGHT=y -+# CONFIG_DRM_VGEM is not set -+# CONFIG_DRM_VKMS is not set -+# CONFIG_DRM_VMWGFX is not set -+# CONFIG_DRM_UDL is not set -+# CONFIG_DRM_AST is not set -+# CONFIG_DRM_MGAG200 is not set -+# CONFIG_DRM_QXL is not set -+# CONFIG_DRM_VIRTIO_GPU is not set -+CONFIG_DRM_PANEL=y -+ -+# -+# Display Panels -+# -+# CONFIG_DRM_PANEL_ABT_Y030XX067A is not set -+# CONFIG_DRM_PANEL_ARM_VERSATILE is not set -+# CONFIG_DRM_PANEL_ASUS_Z00T_TM5P5_NT35596 is not set -+# CONFIG_DRM_PANEL_AUO_A030JTN01 is not set -+# CONFIG_DRM_PANEL_BOE_BF060Y8M_AJ0 is not set -+# CONFIG_DRM_PANEL_BOE_HIMAX8279D is not set -+CONFIG_DRM_PANEL_BOE_TV101WUM_NL6=m -+# CONFIG_DRM_PANEL_DSI_CM is not set -+CONFIG_DRM_PANEL_LVDS=m -+CONFIG_DRM_PANEL_SIMPLE=m -+CONFIG_DRM_PANEL_EDP=m -+# CONFIG_DRM_PANEL_EBBG_FT8719 is not set -+# CONFIG_DRM_PANEL_ELIDA_KD35T133 is not set -+# CONFIG_DRM_PANEL_FEIXIN_K101_IM2BA02 is not set -+# CONFIG_DRM_PANEL_FEIYANG_FY07024DI26A30D is not set -+# CONFIG_DRM_PANEL_HIMAX_HX8394 is not set -+# CONFIG_DRM_PANEL_ILITEK_IL9322 is not set -+# CONFIG_DRM_PANEL_ILITEK_ILI9341 is not set -+# CONFIG_DRM_PANEL_ILITEK_ILI9881C is not set -+# CONFIG_DRM_PANEL_INNOLUX_EJ030NA is not set -+# CONFIG_DRM_PANEL_INNOLUX_P079ZCA is not set -+# CONFIG_DRM_PANEL_JADARD_JD9365DA_H3 is not set -+# CONFIG_DRM_PANEL_JDI_LT070ME05000 is not set -+# CONFIG_DRM_PANEL_JDI_R63452 is not set -+# CONFIG_DRM_PANEL_KHADAS_TS050 is not set -+# CONFIG_DRM_PANEL_KINGDISPLAY_KD097D04 is not set -+# CONFIG_DRM_PANEL_LEADTEK_LTK050H3146W is not set -+# CONFIG_DRM_PANEL_LEADTEK_LTK500HD1829 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_LD9040 is not set -+# CONFIG_DRM_PANEL_LG_LB035Q02 is not set -+# CONFIG_DRM_PANEL_LG_LG4573 is not set -+# CONFIG_DRM_PANEL_MAGNACHIP_D53E6EA8966 is not set -+# CONFIG_DRM_PANEL_NEC_NL8048HL11 is not set -+# CONFIG_DRM_PANEL_NEWVISION_NV3051D is not set -+# CONFIG_DRM_PANEL_NEWVISION_NV3052C is not set -+# CONFIG_DRM_PANEL_NOVATEK_NT35510 is not set -+# CONFIG_DRM_PANEL_NOVATEK_NT35560 is not set -+# CONFIG_DRM_PANEL_NOVATEK_NT35950 is not set -+# CONFIG_DRM_PANEL_NOVATEK_NT36523 is not set -+# CONFIG_DRM_PANEL_NOVATEK_NT36672A is not set -+# CONFIG_DRM_PANEL_NOVATEK_NT39016 is not set -+CONFIG_DRM_PANEL_MANTIX_MLAF057WE51=m -+# CONFIG_DRM_PANEL_OLIMEX_LCD_OLINUXINO is not set -+# CONFIG_DRM_PANEL_ORISETECH_OTA5601A is not set -+# CONFIG_DRM_PANEL_ORISETECH_OTM8009A is not set -+# CONFIG_DRM_PANEL_OSD_OSD101T2587_53TS is not set -+# CONFIG_DRM_PANEL_PANASONIC_VVX10F034N00 is not set -+# CONFIG_DRM_PANEL_RASPBERRYPI_TOUCHSCREEN is not set -+CONFIG_DRM_PANEL_RAYDIUM_RM67191=m -+# CONFIG_DRM_PANEL_RAYDIUM_RM68200 is not set -+# CONFIG_DRM_PANEL_RONBO_RB070D30 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_ATNA33XC20 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_DB7430 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_S6D16D0 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_S6D27A1 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_S6D7AA0 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_S6E3HA2 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_S6E63J0X03 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_S6E63M0 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_S6E88A0_AMS452EF01 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_S6E8AA0 is not set -+# CONFIG_DRM_PANEL_SAMSUNG_SOFEF00 is not set -+# CONFIG_DRM_PANEL_SEIKO_43WVF1G is not set -+# CONFIG_DRM_PANEL_SHARP_LQ101R1SX01 is not set -+# CONFIG_DRM_PANEL_SHARP_LS037V7DW01 is not set -+# CONFIG_DRM_PANEL_SHARP_LS043T1LE01 is not set -+# CONFIG_DRM_PANEL_SHARP_LS060T1SX01 is not set -+# CONFIG_DRM_PANEL_SITRONIX_ST7701 is not set -+CONFIG_DRM_PANEL_SITRONIX_ST7703=m -+# CONFIG_DRM_PANEL_SITRONIX_ST7789V is not set -+# CONFIG_DRM_PANEL_SONY_ACX565AKM is not set -+# CONFIG_DRM_PANEL_SONY_TD4353_JDI is not set -+# CONFIG_DRM_PANEL_SONY_TULIP_TRULY_NT35521 is not set -+# CONFIG_DRM_PANEL_STARTEK_KD070FHFID015 is not set -+# CONFIG_DRM_PANEL_TDO_TL070WSH30 is not set -+# CONFIG_DRM_PANEL_TPO_TD028TTEC1 is not set -+# CONFIG_DRM_PANEL_TPO_TD043MTEA1 is not set -+# CONFIG_DRM_PANEL_TPO_TPG110 is not set -+CONFIG_DRM_PANEL_TRULY_NT35597_WQXGA=m -+# CONFIG_DRM_PANEL_VISIONOX_RM69299 is not set -+CONFIG_DRM_PANEL_VISIONOX_VTDR6130=m -+# CONFIG_DRM_PANEL_VISIONOX_R66451 is not set -+# CONFIG_DRM_PANEL_WIDECHIPS_WS2401 is not set -+# CONFIG_DRM_PANEL_XINPENG_XPP055C272 is not set -+# end of Display Panels -+ -+CONFIG_DRM_BRIDGE=y -+CONFIG_DRM_PANEL_BRIDGE=y -+ -+# -+# Display Interface Bridges -+# -+# CONFIG_DRM_CHIPONE_ICN6211 is not set -+# CONFIG_DRM_CHRONTEL_CH7033 is not set -+# CONFIG_DRM_CROS_EC_ANX7688 is not set -+CONFIG_DRM_DISPLAY_CONNECTOR=m -+# CONFIG_DRM_ITE_IT6505 is not set -+CONFIG_DRM_LONTIUM_LT8912B=m -+# CONFIG_DRM_LONTIUM_LT9211 is not set -+CONFIG_DRM_LONTIUM_LT9611=m -+CONFIG_DRM_LONTIUM_LT9611UXC=m -+CONFIG_DRM_ITE_IT66121=m -+# CONFIG_DRM_LVDS_CODEC is not set -+# CONFIG_DRM_MEGACHIPS_STDPXXXX_GE_B850V3_FW is not set -+CONFIG_DRM_NWL_MIPI_DSI=m -+# CONFIG_DRM_NXP_PTN3460 is not set -+# CONFIG_DRM_PARADE_PS8622 is not set -+CONFIG_DRM_PARADE_PS8640=m -+CONFIG_DRM_SAMSUNG_DSIM=m -+# CONFIG_DRM_SIL_SII8620 is not set -+CONFIG_DRM_SII902X=m -+# CONFIG_DRM_SII9234 is not set -+CONFIG_DRM_SIMPLE_BRIDGE=m -+CONFIG_DRM_THINE_THC63LVD1024=m -+# CONFIG_DRM_TOSHIBA_TC358762 is not set -+# CONFIG_DRM_TOSHIBA_TC358764 is not set -+# CONFIG_DRM_TOSHIBA_TC358767 is not set -+CONFIG_DRM_TOSHIBA_TC358768=m -+# CONFIG_DRM_TOSHIBA_TC358775 is not set -+# CONFIG_DRM_TI_DLPC3433 is not set -+CONFIG_DRM_TI_TFP410=m -+CONFIG_DRM_TI_SN65DSI83=m -+CONFIG_DRM_TI_SN65DSI86=m -+# CONFIG_DRM_TI_TPD12S015 is not set -+# CONFIG_DRM_ANALOGIX_ANX6345 is not set -+# CONFIG_DRM_ANALOGIX_ANX78XX is not set -+CONFIG_DRM_ANALOGIX_ANX7625=m -+CONFIG_DRM_I2C_ADV7511=m -+CONFIG_DRM_I2C_ADV7511_AUDIO=y -+CONFIG_DRM_I2C_ADV7511_CEC=y -+# CONFIG_DRM_CDNS_DSI is not set -+CONFIG_DRM_CDNS_MHDP8546=m -+# end of Display Interface Bridges -+ -+# CONFIG_DRM_LOONGSON is not set -+CONFIG_DRM_ETNAVIV=m -+CONFIG_DRM_ETNAVIV_THERMAL=y -+CONFIG_DRM_HISI_HIBMC=m -+CONFIG_DRM_HISI_KIRIN=m -+# CONFIG_DRM_LOGICVC is not set -+# CONFIG_DRM_ARCPGU is not set -+# CONFIG_DRM_BOCHS is not set -+# CONFIG_DRM_CIRRUS_QEMU is not set -+# CONFIG_DRM_GM12U320 is not set -+# CONFIG_DRM_PANEL_MIPI_DBI is not set -+# CONFIG_DRM_SIMPLEDRM is not set -+# CONFIG_TINYDRM_HX8357D is not set -+# CONFIG_TINYDRM_ILI9163 is not set -+# CONFIG_TINYDRM_ILI9225 is not set -+# CONFIG_TINYDRM_ILI9341 is not set -+# CONFIG_TINYDRM_ILI9486 is not set -+# CONFIG_TINYDRM_MI0283QT is not set -+# CONFIG_TINYDRM_REPAPER is not set -+# CONFIG_TINYDRM_ST7586 is not set -+# CONFIG_TINYDRM_ST7735R is not set -+CONFIG_DRM_PL111=m -+# CONFIG_DRM_XEN_FRONTEND is not set -+CONFIG_DRM_LIMA=m -+CONFIG_DRM_PANFROST=m -+CONFIG_DRM_TIDSS=m -+# CONFIG_DRM_GUD is not set -+# CONFIG_DRM_SSD130X is not set -+CONFIG_DRM_PHYTIUMVR_OCTOPUS=y -+# CONFIG_DRM_PHYTIUMVR_DVFS is not set -+CONFIG_DRM_PHYTIUMVR_OCTOPUS_DMA=y -+CONFIG_DRM_PHYTIUM=y -+# CONFIG_DRM_LEGACY is not set -+CONFIG_DRM_PANEL_ORIENTATION_QUIRKS=y -+ -+# -+# Frame buffer Devices -+# -+CONFIG_FB=y -+# CONFIG_FB_CIRRUS is not set -+# CONFIG_FB_PM2 is not set -+# CONFIG_FB_ARMCLCD is not set -+# CONFIG_FB_CYBER2000 is not set -+# CONFIG_FB_ASILIANT is not set -+# CONFIG_FB_IMSTT is not set -+# CONFIG_FB_EFI is not set -+# CONFIG_FB_OPENCORES is not set -+# CONFIG_FB_S1D13XXX is not set -+# CONFIG_FB_NVIDIA is not set -+# CONFIG_FB_RIVA is not set -+# CONFIG_FB_I740 is not set -+# CONFIG_FB_MATROX is not set -+# CONFIG_FB_RADEON is not set -+# CONFIG_FB_ATY128 is not set -+# CONFIG_FB_ATY is not set -+# CONFIG_FB_S3 is not set -+# CONFIG_FB_SAVAGE is not set -+# CONFIG_FB_SIS is not set -+# CONFIG_FB_NEOMAGIC is not set -+# CONFIG_FB_KYRO is not set -+# CONFIG_FB_3DFX is not set -+# CONFIG_FB_VOODOO1 is not set -+# CONFIG_FB_VT8623 is not set -+# CONFIG_FB_TRIDENT is not set -+# CONFIG_FB_ARK is not set -+# CONFIG_FB_PM3 is not set -+# CONFIG_FB_CARMINE is not set -+# CONFIG_FB_SMSCUFX is not set -+# CONFIG_FB_UDL is not set -+# CONFIG_FB_IBM_GXT4500 is not set -+# CONFIG_FB_VIRTUAL is not set -+CONFIG_XEN_FBDEV_FRONTEND=y -+# CONFIG_FB_METRONOME is not set -+# CONFIG_FB_MB862XX is not set -+# CONFIG_FB_SIMPLE is not set -+# CONFIG_FB_SSD1307 is not set -+# CONFIG_FB_SM712 is not set -+CONFIG_FB_CORE=y -+CONFIG_FB_NOTIFY=y -+# CONFIG_FIRMWARE_EDID is not set -+CONFIG_FB_DEVICE=y -+CONFIG_FB_CFB_FILLRECT=y -+CONFIG_FB_CFB_COPYAREA=y -+CONFIG_FB_CFB_IMAGEBLIT=y -+CONFIG_FB_SYS_FILLRECT=y -+CONFIG_FB_SYS_COPYAREA=y -+CONFIG_FB_SYS_IMAGEBLIT=y -+# CONFIG_FB_FOREIGN_ENDIAN is not set -+CONFIG_FB_SYS_FOPS=y -+CONFIG_FB_DEFERRED_IO=y -+CONFIG_FB_DMAMEM_HELPERS=y -+CONFIG_FB_IOMEM_HELPERS=y -+CONFIG_FB_SYSMEM_HELPERS=y -+CONFIG_FB_SYSMEM_HELPERS_DEFERRED=y -+CONFIG_FB_MODE_HELPERS=y -+# CONFIG_FB_TILEBLITTING is not set -+# end of Frame buffer Devices -+ -+# -+# Backlight & LCD device support -+# -+# CONFIG_LCD_CLASS_DEVICE is not set -+CONFIG_BACKLIGHT_CLASS_DEVICE=y -+# CONFIG_BACKLIGHT_KTD253 is not set -+# CONFIG_BACKLIGHT_KTZ8866 is not set -+CONFIG_BACKLIGHT_PWM=y -+# CONFIG_BACKLIGHT_QCOM_WLED is not set -+# CONFIG_BACKLIGHT_ADP8860 is not set -+# CONFIG_BACKLIGHT_ADP8870 is not set -+# CONFIG_BACKLIGHT_LM3630A is not set -+# CONFIG_BACKLIGHT_LM3639 is not set -+CONFIG_BACKLIGHT_LP855X=m -+# CONFIG_BACKLIGHT_GPIO is not set -+# CONFIG_BACKLIGHT_LV5207LP is not set -+# CONFIG_BACKLIGHT_BD6107 is not set -+# CONFIG_BACKLIGHT_ARCXCNN is not set -+# CONFIG_BACKLIGHT_LED is not set -+# end of Backlight & LCD device support -+ -+CONFIG_VIDEOMODE_HELPERS=y -+CONFIG_HDMI=y -+ -+# -+# Console display driver support -+# -+CONFIG_DUMMY_CONSOLE=y -+CONFIG_DUMMY_CONSOLE_COLUMNS=80 -+CONFIG_DUMMY_CONSOLE_ROWS=25 -+CONFIG_FRAMEBUFFER_CONSOLE=y -+# CONFIG_FRAMEBUFFER_CONSOLE_LEGACY_ACCELERATION is not set -+CONFIG_FRAMEBUFFER_CONSOLE_DETECT_PRIMARY=y -+# CONFIG_FRAMEBUFFER_CONSOLE_ROTATION is not set -+# CONFIG_FRAMEBUFFER_CONSOLE_DEFERRED_TAKEOVER is not set -+# end of Console display driver support -+ -+CONFIG_LOGO=y -+# CONFIG_LOGO_LINUX_MONO is not set -+# CONFIG_LOGO_LINUX_VGA16 is not set -+CONFIG_LOGO_LINUX_CLUT224=y -+# end of Graphics support -+ -+# CONFIG_DRM_ACCEL is not set -+CONFIG_SOUND=y -+CONFIG_SND=y -+CONFIG_SND_TIMER=y -+CONFIG_SND_PCM=y -+CONFIG_SND_PCM_ELD=y -+CONFIG_SND_PCM_IEC958=y -+CONFIG_SND_DMAENGINE_PCM=y -+CONFIG_SND_JACK=y -+CONFIG_SND_JACK_INPUT_DEV=y -+# CONFIG_SND_OSSEMUL is not set -+CONFIG_SND_PCM_TIMER=y -+# CONFIG_SND_HRTIMER is not set -+CONFIG_SND_DYNAMIC_MINORS=y -+CONFIG_SND_MAX_CARDS=32 -+CONFIG_SND_SUPPORT_OLD_API=y -+CONFIG_SND_PROC_FS=y -+CONFIG_SND_VERBOSE_PROCFS=y -+# CONFIG_SND_VERBOSE_PRINTK is not set -+CONFIG_SND_CTL_FAST_LOOKUP=y -+# CONFIG_SND_DEBUG is not set -+# CONFIG_SND_CTL_INPUT_VALIDATION is not set -+CONFIG_SND_VMASTER=y -+CONFIG_SND_CTL_LED=y -+# CONFIG_SND_SEQUENCER is not set -+CONFIG_SND_DRIVERS=y -+# CONFIG_SND_DUMMY is not set -+CONFIG_SND_ALOOP=m -+# CONFIG_SND_PCMTEST is not set -+# CONFIG_SND_MTPAV is not set -+# CONFIG_SND_SERIAL_U16550 is not set -+# CONFIG_SND_SERIAL_GENERIC is not set -+# CONFIG_SND_MPU401 is not set -+CONFIG_SND_PCI=y -+# CONFIG_SND_AD1889 is not set -+# CONFIG_SND_ALS300 is not set -+# CONFIG_SND_ALI5451 is not set -+# CONFIG_SND_ATIIXP is not set -+# CONFIG_SND_ATIIXP_MODEM is not set -+# CONFIG_SND_AU8810 is not set -+# CONFIG_SND_AU8820 is not set -+# CONFIG_SND_AU8830 is not set -+# CONFIG_SND_AW2 is not set -+# CONFIG_SND_AZT3328 is not set -+# CONFIG_SND_BT87X is not set -+# CONFIG_SND_CA0106 is not set -+# CONFIG_SND_CMIPCI is not set -+# CONFIG_SND_OXYGEN is not set -+# CONFIG_SND_CS4281 is not set -+# CONFIG_SND_CS46XX is not set -+# CONFIG_SND_CTXFI is not set -+# CONFIG_SND_DARLA20 is not set -+# CONFIG_SND_GINA20 is not set -+# CONFIG_SND_LAYLA20 is not set -+# CONFIG_SND_DARLA24 is not set -+# CONFIG_SND_GINA24 is not set -+# CONFIG_SND_LAYLA24 is not set -+# CONFIG_SND_MONA is not set -+# CONFIG_SND_MIA is not set -+# CONFIG_SND_ECHO3G is not set -+# CONFIG_SND_INDIGO is not set -+# CONFIG_SND_INDIGOIO is not set -+# CONFIG_SND_INDIGODJ is not set -+# CONFIG_SND_INDIGOIOX is not set -+# CONFIG_SND_INDIGODJX is not set -+# CONFIG_SND_EMU10K1 is not set -+# CONFIG_SND_EMU10K1X is not set -+# CONFIG_SND_ENS1370 is not set -+# CONFIG_SND_ENS1371 is not set -+# CONFIG_SND_ES1938 is not set -+# CONFIG_SND_ES1968 is not set -+# CONFIG_SND_FM801 is not set -+# CONFIG_SND_HDSP is not set -+# CONFIG_SND_HDSPM is not set -+# CONFIG_SND_ICE1712 is not set -+# CONFIG_SND_ICE1724 is not set -+# CONFIG_SND_INTEL8X0 is not set -+# CONFIG_SND_INTEL8X0M is not set -+# CONFIG_SND_KORG1212 is not set -+# CONFIG_SND_LOLA is not set -+# CONFIG_SND_LX6464ES is not set -+# CONFIG_SND_MAESTRO3 is not set -+# CONFIG_SND_MIXART is not set -+# CONFIG_SND_NM256 is not set -+# CONFIG_SND_PCXHR is not set -+# CONFIG_SND_RIPTIDE is not set -+# CONFIG_SND_RME32 is not set -+# CONFIG_SND_RME96 is not set -+# CONFIG_SND_RME9652 is not set -+# CONFIG_SND_SE6X is not set -+# CONFIG_SND_SONICVIBES is not set -+# CONFIG_SND_TRIDENT is not set -+# CONFIG_SND_VIA82XX is not set -+# CONFIG_SND_VIA82XX_MODEM is not set -+# CONFIG_SND_VIRTUOSO is not set -+# CONFIG_SND_VX222 is not set -+# CONFIG_SND_YMFPCI is not set -+ -+# -+# HD-Audio -+# -+CONFIG_SND_HDA=y -+CONFIG_SND_HDA_GENERIC_LEDS=y -+# CONFIG_SND_HDA_INTEL is not set -+CONFIG_SND_HDA_PHYTIUM=y -+# CONFIG_SND_HDA_HWDEP is not set -+# CONFIG_SND_HDA_RECONFIG is not set -+# CONFIG_SND_HDA_INPUT_BEEP is not set -+# CONFIG_SND_HDA_PATCH_LOADER is not set -+# CONFIG_SND_HDA_SCODEC_CS35L41_I2C is not set -+# CONFIG_SND_HDA_SCODEC_CS35L41_SPI is not set -+# CONFIG_SND_HDA_SCODEC_CS35L56_I2C is not set -+# CONFIG_SND_HDA_SCODEC_CS35L56_SPI is not set -+# CONFIG_SND_HDA_SCODEC_TAS2781_I2C is not set -+CONFIG_SND_HDA_CODEC_REALTEK=y -+# CONFIG_SND_HDA_CODEC_ANALOG is not set -+# CONFIG_SND_HDA_CODEC_SIGMATEL is not set -+# CONFIG_SND_HDA_CODEC_VIA is not set -+CONFIG_SND_HDA_CODEC_HDMI=y -+# CONFIG_SND_HDA_CODEC_CIRRUS is not set -+# CONFIG_SND_HDA_CODEC_CS8409 is not set -+# CONFIG_SND_HDA_CODEC_CONEXANT is not set -+# CONFIG_SND_HDA_CODEC_CA0110 is not set -+# CONFIG_SND_HDA_CODEC_CA0132 is not set -+# CONFIG_SND_HDA_CODEC_CMEDIA is not set -+# CONFIG_SND_HDA_CODEC_SI3054 is not set -+CONFIG_SND_HDA_GENERIC=y -+CONFIG_SND_HDA_POWER_SAVE_DEFAULT=0 -+# end of HD-Audio -+ -+CONFIG_SND_HDA_CORE=y -+CONFIG_SND_HDA_ALIGNED_MMIO=y -+CONFIG_SND_HDA_COMPONENT=y -+CONFIG_SND_HDA_PREALLOC_SIZE=64 -+CONFIG_SND_SPI=y -+CONFIG_SND_USB=y -+# CONFIG_SND_USB_AUDIO is not set -+# CONFIG_SND_USB_UA101 is not set -+# CONFIG_SND_USB_CAIAQ is not set -+# CONFIG_SND_USB_6FIRE is not set -+# CONFIG_SND_USB_HIFACE is not set -+# CONFIG_SND_BCD2000 is not set -+# CONFIG_SND_USB_POD is not set -+# CONFIG_SND_USB_PODHD is not set -+# CONFIG_SND_USB_TONEPORT is not set -+# CONFIG_SND_USB_VARIAX is not set -+CONFIG_SND_SOC=y -+CONFIG_SND_SOC_GENERIC_DMAENGINE_PCM=y -+# CONFIG_SND_SOC_ADI is not set -+# CONFIG_SND_SOC_AMD_ACP is not set -+# CONFIG_SND_AMD_ACP_CONFIG is not set -+# CONFIG_SND_ATMEL_SOC is not set -+# CONFIG_SND_BCM63XX_I2S_WHISTLER is not set -+# CONFIG_SND_DESIGNWARE_I2S is not set -+ -+# -+# SoC Audio for Freescale CPUs -+# -+ -+# -+# Common SoC Audio options for Freescale CPUs: -+# -+CONFIG_SND_SOC_FSL_ASRC=m -+CONFIG_SND_SOC_FSL_SAI=m -+# CONFIG_SND_SOC_FSL_MQS is not set -+CONFIG_SND_SOC_FSL_AUDMIX=m -+CONFIG_SND_SOC_FSL_SSI=m -+CONFIG_SND_SOC_FSL_SPDIF=m -+CONFIG_SND_SOC_FSL_ESAI=m -+CONFIG_SND_SOC_FSL_MICFIL=m -+CONFIG_SND_SOC_FSL_EASRC=m -+# CONFIG_SND_SOC_FSL_XCVR is not set -+CONFIG_SND_SOC_FSL_UTILS=m -+# CONFIG_SND_SOC_FSL_RPMSG is not set -+CONFIG_SND_SOC_IMX_AUDMUX=m -+# end of SoC Audio for Freescale CPUs -+ -+# CONFIG_SND_SOC_CHV3_I2S is not set -+# CONFIG_SND_I2S_HI6210_I2S is not set -+# CONFIG_SND_SOC_IMG is not set -+# CONFIG_SND_SOC_MTK_BTCVSD is not set -+CONFIG_SND_SOC_PHYTIUM_I2S=y -+CONFIG_SND_PMDK_ES8388=y -+CONFIG_SND_PMDK_ES8336=y -+CONFIG_SND_PMDK_DP=y -+# CONFIG_SND_SOC_SOF_TOPLEVEL is not set -+ -+# -+# STMicroelectronics STM32 SOC audio support -+# -+# end of STMicroelectronics STM32 SOC audio support -+ -+# CONFIG_SND_SOC_XILINX_I2S is not set -+# CONFIG_SND_SOC_XILINX_AUDIO_FORMATTER is not set -+# CONFIG_SND_SOC_XILINX_SPDIF is not set -+# CONFIG_SND_SOC_XTFPGA_I2S is not set -+CONFIG_SND_SOC_I2C_AND_SPI=y -+ -+# -+# CODEC drivers -+# -+# CONFIG_SND_SOC_AC97_CODEC is not set -+# CONFIG_SND_SOC_ADAU1372_I2C is not set -+# CONFIG_SND_SOC_ADAU1372_SPI is not set -+# CONFIG_SND_SOC_ADAU1701 is not set -+# CONFIG_SND_SOC_ADAU1761_I2C is not set -+# CONFIG_SND_SOC_ADAU1761_SPI is not set -+CONFIG_SND_SOC_ADAU7002=m -+# CONFIG_SND_SOC_ADAU7118_HW is not set -+# CONFIG_SND_SOC_ADAU7118_I2C is not set -+# CONFIG_SND_SOC_AK4104 is not set -+# CONFIG_SND_SOC_AK4118 is not set -+# CONFIG_SND_SOC_AK4375 is not set -+# CONFIG_SND_SOC_AK4458 is not set -+# CONFIG_SND_SOC_AK4554 is not set -+CONFIG_SND_SOC_AK4613=m -+# CONFIG_SND_SOC_AK4642 is not set -+# CONFIG_SND_SOC_AK5386 is not set -+# CONFIG_SND_SOC_AK5558 is not set -+# CONFIG_SND_SOC_ALC5623 is not set -+# CONFIG_SND_SOC_AUDIO_IIO_AUX is not set -+# CONFIG_SND_SOC_AW8738 is not set -+# CONFIG_SND_SOC_AW88395 is not set -+# CONFIG_SND_SOC_AW88261 is not set -+# CONFIG_SND_SOC_BD28623 is not set -+CONFIG_SND_SOC_BT_SCO=m -+# CONFIG_SND_SOC_CHV3_CODEC is not set -+CONFIG_SND_SOC_CROS_EC_CODEC=m -+# CONFIG_SND_SOC_CS35L32 is not set -+# CONFIG_SND_SOC_CS35L33 is not set -+# CONFIG_SND_SOC_CS35L34 is not set -+# CONFIG_SND_SOC_CS35L35 is not set -+# CONFIG_SND_SOC_CS35L36 is not set -+# CONFIG_SND_SOC_CS35L41_SPI is not set -+# CONFIG_SND_SOC_CS35L41_I2C is not set -+# CONFIG_SND_SOC_CS35L45_SPI is not set -+# CONFIG_SND_SOC_CS35L45_I2C is not set -+# CONFIG_SND_SOC_CS35L56_I2C is not set -+# CONFIG_SND_SOC_CS35L56_SPI is not set -+# CONFIG_SND_SOC_CS35L56_SDW is not set -+# CONFIG_SND_SOC_CS42L42 is not set -+# CONFIG_SND_SOC_CS42L42_SDW is not set -+# CONFIG_SND_SOC_CS42L51_I2C is not set -+# CONFIG_SND_SOC_CS42L52 is not set -+# CONFIG_SND_SOC_CS42L56 is not set -+# CONFIG_SND_SOC_CS42L73 is not set -+# CONFIG_SND_SOC_CS42L83 is not set -+# CONFIG_SND_SOC_CS4234 is not set -+# CONFIG_SND_SOC_CS4265 is not set -+# CONFIG_SND_SOC_CS4270 is not set -+# CONFIG_SND_SOC_CS4271_I2C is not set -+# CONFIG_SND_SOC_CS4271_SPI is not set -+# CONFIG_SND_SOC_CS42XX8_I2C is not set -+# CONFIG_SND_SOC_CS43130 is not set -+# CONFIG_SND_SOC_CS4341 is not set -+# CONFIG_SND_SOC_CS4349 is not set -+# CONFIG_SND_SOC_CS53L30 is not set -+# CONFIG_SND_SOC_CX2072X is not set -+CONFIG_SND_SOC_DA7213=m -+CONFIG_SND_SOC_DMIC=m -+CONFIG_SND_SOC_HDMI_CODEC=y -+CONFIG_SND_SOC_ES7134=m -+CONFIG_SND_SOC_ES7241=m -+CONFIG_SND_SOC_ES8316=m -+# CONFIG_SND_SOC_ES8326 is not set -+# CONFIG_SND_SOC_ES8328_I2C is not set -+# CONFIG_SND_SOC_ES8328_SPI is not set -+CONFIG_SND_SOC_ES8336=y -+CONFIG_SND_SOC_ES8388=y -+CONFIG_SND_SOC_GTM601=m -+# CONFIG_SND_SOC_HDA is not set -+# CONFIG_SND_SOC_ICS43432 is not set -+# CONFIG_SND_SOC_IDT821034 is not set -+# CONFIG_SND_SOC_INNO_RK3036 is not set -+# CONFIG_SND_SOC_MAX98088 is not set -+# CONFIG_SND_SOC_MAX98090 is not set -+CONFIG_SND_SOC_MAX98357A=m -+# CONFIG_SND_SOC_MAX98504 is not set -+# CONFIG_SND_SOC_MAX9867 is not set -+CONFIG_SND_SOC_MAX98927=m -+# CONFIG_SND_SOC_MAX98520 is not set -+# CONFIG_SND_SOC_MAX98363 is not set -+# CONFIG_SND_SOC_MAX98373_I2C is not set -+# CONFIG_SND_SOC_MAX98373_SDW is not set -+# CONFIG_SND_SOC_MAX98388 is not set -+# CONFIG_SND_SOC_MAX98390 is not set -+# CONFIG_SND_SOC_MAX98396 is not set -+# CONFIG_SND_SOC_MAX9860 is not set -+CONFIG_SND_SOC_MSM8916_WCD_ANALOG=m -+CONFIG_SND_SOC_MSM8916_WCD_DIGITAL=m -+# CONFIG_SND_SOC_PCM1681 is not set -+# CONFIG_SND_SOC_PCM1789_I2C is not set -+# CONFIG_SND_SOC_PCM179X_I2C is not set -+# CONFIG_SND_SOC_PCM179X_SPI is not set -+# CONFIG_SND_SOC_PCM186X_I2C is not set -+# CONFIG_SND_SOC_PCM186X_SPI is not set -+# CONFIG_SND_SOC_PCM3060_I2C is not set -+# CONFIG_SND_SOC_PCM3060_SPI is not set -+CONFIG_SND_SOC_PCM3168A=m -+CONFIG_SND_SOC_PCM3168A_I2C=m -+# CONFIG_SND_SOC_PCM3168A_SPI is not set -+# CONFIG_SND_SOC_PCM5102A is not set -+# CONFIG_SND_SOC_PCM512x_I2C is not set -+# CONFIG_SND_SOC_PCM512x_SPI is not set -+# CONFIG_SND_SOC_PEB2466 is not set -+# CONFIG_SND_SOC_RK3328 is not set -+CONFIG_SND_SOC_RK817=m -+CONFIG_SND_SOC_RL6231=m -+# CONFIG_SND_SOC_RT1017_SDCA_SDW is not set -+# CONFIG_SND_SOC_RT1308_SDW is not set -+# CONFIG_SND_SOC_RT1316_SDW is not set -+# CONFIG_SND_SOC_RT1318_SDW is not set -+# CONFIG_SND_SOC_RT5616 is not set -+# CONFIG_SND_SOC_RT5631 is not set -+CONFIG_SND_SOC_RT5640=m -+CONFIG_SND_SOC_RT5659=m -+# CONFIG_SND_SOC_RT5682_SDW is not set -+# CONFIG_SND_SOC_RT700_SDW is not set -+# CONFIG_SND_SOC_RT711_SDW is not set -+# CONFIG_SND_SOC_RT711_SDCA_SDW is not set -+# CONFIG_SND_SOC_RT712_SDCA_SDW is not set -+# CONFIG_SND_SOC_RT712_SDCA_DMIC_SDW is not set -+# CONFIG_SND_SOC_RT722_SDCA_SDW is not set -+# CONFIG_SND_SOC_RT715_SDW is not set -+# CONFIG_SND_SOC_RT715_SDCA_SDW is not set -+# CONFIG_SND_SOC_RT9120 is not set -+CONFIG_SND_SOC_SGTL5000=m -+CONFIG_SND_SOC_SIMPLE_AMPLIFIER=m -+CONFIG_SND_SOC_SIMPLE_MUX=m -+# CONFIG_SND_SOC_SMA1303 is not set -+CONFIG_SND_SOC_SPDIF=m -+# CONFIG_SND_SOC_SRC4XXX_I2C is not set -+# CONFIG_SND_SOC_SSM2305 is not set -+# CONFIG_SND_SOC_SSM2518 is not set -+# CONFIG_SND_SOC_SSM2602_SPI is not set -+# CONFIG_SND_SOC_SSM2602_I2C is not set -+# CONFIG_SND_SOC_SSM3515 is not set -+# CONFIG_SND_SOC_SSM4567 is not set -+# CONFIG_SND_SOC_STA32X is not set -+# CONFIG_SND_SOC_STA350 is not set -+# CONFIG_SND_SOC_STI_SAS is not set -+CONFIG_SND_SOC_TAS2552=m -+# CONFIG_SND_SOC_TAS2562 is not set -+# CONFIG_SND_SOC_TAS2764 is not set -+# CONFIG_SND_SOC_TAS2770 is not set -+# CONFIG_SND_SOC_TAS2780 is not set -+# CONFIG_SND_SOC_TAS2781_I2C is not set -+# CONFIG_SND_SOC_TAS5086 is not set -+CONFIG_SND_SOC_TAS571X=m -+# CONFIG_SND_SOC_TAS5720 is not set -+# CONFIG_SND_SOC_TAS5805M is not set -+# CONFIG_SND_SOC_TAS6424 is not set -+# CONFIG_SND_SOC_TDA7419 is not set -+# CONFIG_SND_SOC_TFA9879 is not set -+# CONFIG_SND_SOC_TFA989X is not set -+# CONFIG_SND_SOC_TLV320ADC3XXX is not set -+# CONFIG_SND_SOC_TLV320AIC23_I2C is not set -+# CONFIG_SND_SOC_TLV320AIC23_SPI is not set -+CONFIG_SND_SOC_TLV320AIC31XX=m -+CONFIG_SND_SOC_TLV320AIC32X4=m -+CONFIG_SND_SOC_TLV320AIC32X4_I2C=m -+# CONFIG_SND_SOC_TLV320AIC32X4_SPI is not set -+CONFIG_SND_SOC_TLV320AIC3X=m -+CONFIG_SND_SOC_TLV320AIC3X_I2C=m -+# CONFIG_SND_SOC_TLV320AIC3X_SPI is not set -+# CONFIG_SND_SOC_TLV320ADCX140 is not set -+CONFIG_SND_SOC_TS3A227E=m -+# CONFIG_SND_SOC_TSCS42XX is not set -+# CONFIG_SND_SOC_TSCS454 is not set -+# CONFIG_SND_SOC_UDA1334 is not set -+CONFIG_SND_SOC_WCD_CLASSH=m -+CONFIG_SND_SOC_WCD9335=m -+CONFIG_SND_SOC_WCD_MBHC=m -+CONFIG_SND_SOC_WCD934X=m -+CONFIG_SND_SOC_WCD938X=m -+CONFIG_SND_SOC_WCD938X_SDW=m -+# CONFIG_SND_SOC_WM8510 is not set -+# CONFIG_SND_SOC_WM8523 is not set -+CONFIG_SND_SOC_WM8524=m -+# CONFIG_SND_SOC_WM8580 is not set -+# CONFIG_SND_SOC_WM8711 is not set -+# CONFIG_SND_SOC_WM8728 is not set -+# CONFIG_SND_SOC_WM8731_I2C is not set -+# CONFIG_SND_SOC_WM8731_SPI is not set -+# CONFIG_SND_SOC_WM8737 is not set -+# CONFIG_SND_SOC_WM8741 is not set -+# CONFIG_SND_SOC_WM8750 is not set -+# CONFIG_SND_SOC_WM8753 is not set -+# CONFIG_SND_SOC_WM8770 is not set -+# CONFIG_SND_SOC_WM8776 is not set -+# CONFIG_SND_SOC_WM8782 is not set -+# CONFIG_SND_SOC_WM8804_I2C is not set -+# CONFIG_SND_SOC_WM8804_SPI is not set -+# CONFIG_SND_SOC_WM8903 is not set -+CONFIG_SND_SOC_WM8904=m -+# CONFIG_SND_SOC_WM8940 is not set -+CONFIG_SND_SOC_WM8960=m -+# CONFIG_SND_SOC_WM8961 is not set -+CONFIG_SND_SOC_WM8962=m -+# CONFIG_SND_SOC_WM8974 is not set -+CONFIG_SND_SOC_WM8978=m -+# CONFIG_SND_SOC_WM8985 is not set -+CONFIG_SND_SOC_WSA881X=m -+# CONFIG_SND_SOC_WSA883X is not set -+# CONFIG_SND_SOC_WSA884X is not set -+# CONFIG_SND_SOC_ZL38060 is not set -+# CONFIG_SND_SOC_MAX9759 is not set -+# CONFIG_SND_SOC_MT6351 is not set -+CONFIG_SND_SOC_MT6358=m -+# CONFIG_SND_SOC_MT6660 is not set -+# CONFIG_SND_SOC_NAU8315 is not set -+# CONFIG_SND_SOC_NAU8540 is not set -+# CONFIG_SND_SOC_NAU8810 is not set -+# CONFIG_SND_SOC_NAU8821 is not set -+CONFIG_SND_SOC_NAU8822=m -+# CONFIG_SND_SOC_NAU8824 is not set -+# CONFIG_SND_SOC_TPA6130A2 is not set -+CONFIG_SND_SOC_LPASS_MACRO_COMMON=m -+CONFIG_SND_SOC_LPASS_WSA_MACRO=m -+CONFIG_SND_SOC_LPASS_VA_MACRO=m -+CONFIG_SND_SOC_LPASS_RX_MACRO=m -+CONFIG_SND_SOC_LPASS_TX_MACRO=m -+# end of CODEC drivers -+ -+CONFIG_SND_SIMPLE_CARD_UTILS=y -+CONFIG_SND_SIMPLE_CARD=y -+CONFIG_SND_AUDIO_GRAPH_CARD=m -+CONFIG_SND_AUDIO_GRAPH_CARD2=m -+# CONFIG_SND_AUDIO_GRAPH_CARD2_CUSTOM_SAMPLE is not set -+# CONFIG_SND_TEST_COMPONENT is not set -+# CONFIG_SND_XEN_FRONTEND is not set -+# CONFIG_SND_VIRTIO is not set -+CONFIG_HID_SUPPORT=y -+CONFIG_HID=y -+# CONFIG_HID_BATTERY_STRENGTH is not set -+# CONFIG_HIDRAW is not set -+# CONFIG_UHID is not set -+CONFIG_HID_GENERIC=y -+ -+# -+# Special HID drivers -+# -+CONFIG_HID_A4TECH=y -+# CONFIG_HID_ACCUTOUCH is not set -+# CONFIG_HID_ACRUX is not set -+CONFIG_HID_APPLE=y -+# CONFIG_HID_APPLEIR is not set -+# CONFIG_HID_ASUS is not set -+# CONFIG_HID_AUREAL is not set -+CONFIG_HID_BELKIN=y -+# CONFIG_HID_BETOP_FF is not set -+# CONFIG_HID_BIGBEN_FF is not set -+CONFIG_HID_CHERRY=y -+CONFIG_HID_CHICONY=y -+# CONFIG_HID_CORSAIR is not set -+# CONFIG_HID_COUGAR is not set -+# CONFIG_HID_MACALLY is not set -+# CONFIG_HID_PRODIKEYS is not set -+# CONFIG_HID_CMEDIA is not set -+# CONFIG_HID_CREATIVE_SB0540 is not set -+CONFIG_HID_CYPRESS=y -+# CONFIG_HID_DRAGONRISE is not set -+# CONFIG_HID_EMS_FF is not set -+# CONFIG_HID_ELAN is not set -+# CONFIG_HID_ELECOM is not set -+# CONFIG_HID_ELO is not set -+# CONFIG_HID_EVISION is not set -+CONFIG_HID_EZKEY=y -+# CONFIG_HID_GEMBIRD is not set -+# CONFIG_HID_GFRM is not set -+# CONFIG_HID_GLORIOUS is not set -+# CONFIG_HID_HOLTEK is not set -+# CONFIG_HID_GOOGLE_HAMMER is not set -+# CONFIG_HID_GOOGLE_STADIA_FF is not set -+# CONFIG_HID_VIVALDI is not set -+# CONFIG_HID_GT683R is not set -+# CONFIG_HID_KEYTOUCH is not set -+# CONFIG_HID_KYE is not set -+# CONFIG_HID_UCLOGIC is not set -+# CONFIG_HID_WALTOP is not set -+# CONFIG_HID_VIEWSONIC is not set -+# CONFIG_HID_VRC2 is not set -+# CONFIG_HID_XIAOMI is not set -+# CONFIG_HID_GYRATION is not set -+# CONFIG_HID_ICADE is not set -+CONFIG_HID_ITE=y -+# CONFIG_HID_JABRA is not set -+# CONFIG_HID_TWINHAN is not set -+CONFIG_HID_KENSINGTON=y -+# CONFIG_HID_LCPOWER is not set -+# CONFIG_HID_LED is not set -+# CONFIG_HID_LENOVO is not set -+# CONFIG_HID_LETSKETCH is not set -+CONFIG_HID_LOGITECH=y -+# CONFIG_HID_LOGITECH_HIDPP is not set -+# CONFIG_LOGITECH_FF is not set -+# CONFIG_LOGIRUMBLEPAD2_FF is not set -+# CONFIG_LOGIG940_FF is not set -+# CONFIG_LOGIWHEELS_FF is not set -+# CONFIG_HID_MAGICMOUSE is not set -+# CONFIG_HID_MALTRON is not set -+# CONFIG_HID_MAYFLASH is not set -+# CONFIG_HID_MEGAWORLD_FF is not set -+CONFIG_HID_REDRAGON=y -+CONFIG_HID_MICROSOFT=y -+CONFIG_HID_MONTEREY=y -+CONFIG_HID_MULTITOUCH=y -+# CONFIG_HID_NINTENDO is not set -+# CONFIG_HID_NTI is not set -+# CONFIG_HID_NTRIG is not set -+# CONFIG_HID_NVIDIA_SHIELD is not set -+# CONFIG_HID_ORTEK is not set -+# CONFIG_HID_PANTHERLORD is not set -+# CONFIG_HID_PENMOUNT is not set -+# CONFIG_HID_PETALYNX is not set -+# CONFIG_HID_PICOLCD is not set -+# CONFIG_HID_PLANTRONICS is not set -+# CONFIG_HID_PLAYSTATION is not set -+# CONFIG_HID_PXRC is not set -+# CONFIG_HID_RAZER is not set -+# CONFIG_HID_PRIMAX is not set -+# CONFIG_HID_RETRODE is not set -+# CONFIG_HID_ROCCAT is not set -+# CONFIG_HID_SAITEK is not set -+# CONFIG_HID_SAMSUNG is not set -+# CONFIG_HID_SEMITEK is not set -+# CONFIG_HID_SIGMAMICRO is not set -+# CONFIG_HID_SONY is not set -+# CONFIG_HID_SPEEDLINK is not set -+# CONFIG_HID_STEAM is not set -+# CONFIG_HID_STEELSERIES is not set -+# CONFIG_HID_SUNPLUS is not set -+# CONFIG_HID_RMI is not set -+# CONFIG_HID_GREENASIA is not set -+# CONFIG_HID_SMARTJOYPLUS is not set -+# CONFIG_HID_TIVO is not set -+# CONFIG_HID_TOPSEED is not set -+# CONFIG_HID_TOPRE is not set -+# CONFIG_HID_THINGM is not set -+# CONFIG_HID_THRUSTMASTER is not set -+# CONFIG_HID_UDRAW_PS3 is not set -+# CONFIG_HID_U2FZERO is not set -+# CONFIG_HID_WACOM is not set -+# CONFIG_HID_WIIMOTE is not set -+# CONFIG_HID_XINMO is not set -+# CONFIG_HID_ZEROPLUS is not set -+# CONFIG_HID_ZYDACRON is not set -+# CONFIG_HID_SENSOR_HUB is not set -+# CONFIG_HID_ALPS is not set -+# CONFIG_HID_MCP2221 is not set -+# end of Special HID drivers -+ -+# -+# HID-BPF support -+# -+# CONFIG_HID_BPF is not set -+# end of HID-BPF support -+ -+# -+# USB HID support -+# -+CONFIG_USB_HID=y -+# CONFIG_HID_PID is not set -+CONFIG_USB_HIDDEV=y -+# end of USB HID support -+ -+CONFIG_I2C_HID=y -+CONFIG_I2C_HID_ACPI=m -+CONFIG_I2C_HID_OF=m -+# CONFIG_I2C_HID_OF_ELAN is not set -+# CONFIG_I2C_HID_OF_GOODIX is not set -+CONFIG_I2C_HID_CORE=m -+CONFIG_USB_OHCI_LITTLE_ENDIAN=y -+CONFIG_USB_SUPPORT=y -+CONFIG_USB_COMMON=y -+# CONFIG_USB_LED_TRIG is not set -+CONFIG_USB_ULPI_BUS=y -+CONFIG_USB_CONN_GPIO=y -+CONFIG_USB_ARCH_HAS_HCD=y -+CONFIG_USB=y -+CONFIG_USB_PCI=y -+CONFIG_USB_ANNOUNCE_NEW_DEVICES=y -+ -+# -+# Miscellaneous USB options -+# -+CONFIG_USB_DEFAULT_PERSIST=y -+# CONFIG_USB_FEW_INIT_RETRIES is not set -+# CONFIG_USB_DYNAMIC_MINORS is not set -+CONFIG_USB_OTG=y -+# CONFIG_USB_OTG_PRODUCTLIST is not set -+# CONFIG_USB_OTG_DISABLE_EXTERNAL_HUB is not set -+# CONFIG_USB_OTG_FSM is not set -+# CONFIG_USB_LEDS_TRIGGER_USBPORT is not set -+CONFIG_USB_AUTOSUSPEND_DELAY=2 -+# CONFIG_USB_MON is not set -+ -+# -+# USB Host Controller Drivers -+# -+# CONFIG_USB_C67X00_HCD is not set -+CONFIG_USB_XHCI_HCD=y -+# CONFIG_USB_XHCI_DBGCAP is not set -+CONFIG_USB_XHCI_PCI=y -+# CONFIG_USB_XHCI_PCI_RENESAS is not set -+CONFIG_USB_XHCI_PLATFORM=y -+CONFIG_USB_EHCI_HCD=y -+CONFIG_USB_EHCI_ROOT_HUB_TT=y -+CONFIG_USB_EHCI_TT_NEWSCHED=y -+CONFIG_USB_EHCI_PCI=y -+# CONFIG_USB_EHCI_FSL is not set -+CONFIG_USB_EHCI_HCD_PLATFORM=y -+# CONFIG_USB_OXU210HP_HCD is not set -+# CONFIG_USB_ISP116X_HCD is not set -+# CONFIG_USB_MAX3421_HCD is not set -+CONFIG_USB_OHCI_HCD=y -+CONFIG_USB_OHCI_HCD_PCI=y -+CONFIG_USB_OHCI_HCD_PLATFORM=y -+# CONFIG_USB_UHCI_HCD is not set -+# CONFIG_USB_SL811_HCD is not set -+# CONFIG_USB_R8A66597_HCD is not set -+# CONFIG_USB_HCD_TEST_MODE is not set -+# CONFIG_USB_XEN_HCD is not set -+ -+# -+# USB Device Class drivers -+# -+CONFIG_USB_ACM=m -+# CONFIG_USB_PRINTER is not set -+CONFIG_USB_WDM=m -+# CONFIG_USB_TMC is not set -+ -+# -+# NOTE: USB_STORAGE depends on SCSI but BLK_DEV_SD may -+# -+ -+# -+# also be needed; see USB_STORAGE Help for more info -+# -+CONFIG_USB_STORAGE=y -+# CONFIG_USB_STORAGE_DEBUG is not set -+# CONFIG_USB_STORAGE_REALTEK is not set -+# CONFIG_USB_STORAGE_DATAFAB is not set -+# CONFIG_USB_STORAGE_FREECOM is not set -+# CONFIG_USB_STORAGE_ISD200 is not set -+# CONFIG_USB_STORAGE_USBAT is not set -+# CONFIG_USB_STORAGE_SDDR09 is not set -+# CONFIG_USB_STORAGE_SDDR55 is not set -+# CONFIG_USB_STORAGE_JUMPSHOT is not set -+# CONFIG_USB_STORAGE_ALAUDA is not set -+# CONFIG_USB_STORAGE_ONETOUCH is not set -+# CONFIG_USB_STORAGE_KARMA is not set -+# CONFIG_USB_STORAGE_CYPRESS_ATACB is not set -+# CONFIG_USB_STORAGE_ENE_UB6250 is not set -+# CONFIG_USB_UAS is not set -+ -+# -+# USB Imaging devices -+# -+# CONFIG_USB_MDC800 is not set -+# CONFIG_USB_MICROTEK is not set -+# CONFIG_USBIP_CORE is not set -+ -+# -+# USB dual-mode controller drivers -+# -+CONFIG_USB_CDNS_SUPPORT=m -+CONFIG_USB_CDNS_HOST=y -+CONFIG_USB_CDNS3=m -+CONFIG_USB_CDNS3_GADGET=y -+CONFIG_USB_CDNS3_HOST=y -+CONFIG_USB_CDNS3_PCI_WRAP=m -+# CONFIG_USB_CDNSP_PCI is not set -+CONFIG_USB_MUSB_HDRC=y -+# CONFIG_USB_MUSB_HOST is not set -+# CONFIG_USB_MUSB_GADGET is not set -+CONFIG_USB_MUSB_DUAL_ROLE=y -+ -+# -+# Platform Glue Layer -+# -+ -+# -+# MUSB DMA mode -+# -+# CONFIG_MUSB_PIO_ONLY is not set -+CONFIG_USB_DWC3=y -+# CONFIG_USB_DWC3_ULPI is not set -+# CONFIG_USB_DWC3_HOST is not set -+# CONFIG_USB_DWC3_GADGET is not set -+CONFIG_USB_DWC3_DUAL_ROLE=y -+ -+# -+# Platform Glue Driver Support -+# -+CONFIG_USB_DWC3_PCI=y -+CONFIG_USB_DWC3_HAPS=y -+CONFIG_USB_DWC3_OF_SIMPLE=y -+CONFIG_USB_DWC2=y -+# CONFIG_USB_DWC2_HOST is not set -+ -+# -+# Gadget/Dual-role mode requires USB Gadget support to be enabled -+# -+# CONFIG_USB_DWC2_PERIPHERAL is not set -+CONFIG_USB_DWC2_DUAL_ROLE=y -+# CONFIG_USB_DWC2_PCI is not set -+# CONFIG_USB_DWC2_DEBUG is not set -+# CONFIG_USB_DWC2_TRACK_MISSED_SOFS is not set -+CONFIG_USB_CHIPIDEA=y -+CONFIG_USB_CHIPIDEA_UDC=y -+CONFIG_USB_CHIPIDEA_HOST=y -+CONFIG_USB_CHIPIDEA_PCI=y -+CONFIG_USB_CHIPIDEA_MSM=y -+CONFIG_USB_CHIPIDEA_IMX=y -+CONFIG_USB_CHIPIDEA_GENERIC=y -+CONFIG_USB_CHIPIDEA_TEGRA=y -+CONFIG_USB_ISP1760=y -+CONFIG_USB_ISP1760_HCD=y -+CONFIG_USB_ISP1761_UDC=y -+# CONFIG_USB_ISP1760_HOST_ROLE is not set -+# CONFIG_USB_ISP1760_GADGET_ROLE is not set -+CONFIG_USB_ISP1760_DUAL_ROLE=y -+CONFIG_USB_PHYTIUM=m -+# CONFIG_USB_PHYTIUM_PCI is not set -+ -+# -+# USB port drivers -+# -+CONFIG_USB_SERIAL=m -+# CONFIG_USB_SERIAL_GENERIC is not set -+# CONFIG_USB_SERIAL_SIMPLE is not set -+# CONFIG_USB_SERIAL_AIRCABLE is not set -+# CONFIG_USB_SERIAL_ARK3116 is not set -+# CONFIG_USB_SERIAL_BELKIN is not set -+# CONFIG_USB_SERIAL_CH341 is not set -+# CONFIG_USB_SERIAL_WHITEHEAT is not set -+# CONFIG_USB_SERIAL_DIGI_ACCELEPORT is not set -+CONFIG_USB_SERIAL_CP210X=m -+# CONFIG_USB_SERIAL_CYPRESS_M8 is not set -+# CONFIG_USB_SERIAL_EMPEG is not set -+CONFIG_USB_SERIAL_FTDI_SIO=m -+# CONFIG_USB_SERIAL_VISOR is not set -+# CONFIG_USB_SERIAL_IPAQ is not set -+# CONFIG_USB_SERIAL_IR is not set -+# CONFIG_USB_SERIAL_EDGEPORT is not set -+# CONFIG_USB_SERIAL_EDGEPORT_TI is not set -+# CONFIG_USB_SERIAL_F81232 is not set -+# CONFIG_USB_SERIAL_F8153X is not set -+# CONFIG_USB_SERIAL_GARMIN is not set -+# CONFIG_USB_SERIAL_IPW is not set -+# CONFIG_USB_SERIAL_IUU is not set -+# CONFIG_USB_SERIAL_KEYSPAN_PDA is not set -+# CONFIG_USB_SERIAL_KEYSPAN is not set -+# CONFIG_USB_SERIAL_KLSI is not set -+# CONFIG_USB_SERIAL_KOBIL_SCT is not set -+# CONFIG_USB_SERIAL_MCT_U232 is not set -+# CONFIG_USB_SERIAL_METRO is not set -+# CONFIG_USB_SERIAL_MOS7720 is not set -+# CONFIG_USB_SERIAL_MOS7840 is not set -+# CONFIG_USB_SERIAL_MXUPORT is not set -+# CONFIG_USB_SERIAL_NAVMAN is not set -+# CONFIG_USB_SERIAL_PL2303 is not set -+# CONFIG_USB_SERIAL_OTI6858 is not set -+# CONFIG_USB_SERIAL_QCAUX is not set -+# CONFIG_USB_SERIAL_QUALCOMM is not set -+# CONFIG_USB_SERIAL_SPCP8X5 is not set -+# CONFIG_USB_SERIAL_SAFE is not set -+# CONFIG_USB_SERIAL_SIERRAWIRELESS is not set -+# CONFIG_USB_SERIAL_SYMBOL is not set -+# CONFIG_USB_SERIAL_TI is not set -+# CONFIG_USB_SERIAL_CYBERJACK is not set -+CONFIG_USB_SERIAL_WWAN=m -+CONFIG_USB_SERIAL_OPTION=m -+# CONFIG_USB_SERIAL_OMNINET is not set -+# CONFIG_USB_SERIAL_OPTICON is not set -+# CONFIG_USB_SERIAL_XSENS_MT is not set -+# CONFIG_USB_SERIAL_WISHBONE is not set -+# CONFIG_USB_SERIAL_SSU100 is not set -+# CONFIG_USB_SERIAL_QT2 is not set -+# CONFIG_USB_SERIAL_UPD78F0730 is not set -+# CONFIG_USB_SERIAL_XR is not set -+# CONFIG_USB_SERIAL_DEBUG is not set -+ -+# -+# USB Miscellaneous drivers -+# -+# CONFIG_USB_EMI62 is not set -+# CONFIG_USB_EMI26 is not set -+# CONFIG_USB_ADUTUX is not set -+# CONFIG_USB_SEVSEG is not set -+# CONFIG_USB_LEGOTOWER is not set -+# CONFIG_USB_LCD is not set -+# CONFIG_USB_CYPRESS_CY7C63 is not set -+# CONFIG_USB_CYTHERM is not set -+# CONFIG_USB_IDMOUSE is not set -+# CONFIG_USB_APPLEDISPLAY is not set -+# CONFIG_APPLE_MFI_FASTCHARGE is not set -+# CONFIG_USB_SISUSBVGA is not set -+# CONFIG_USB_LD is not set -+# CONFIG_USB_TRANCEVIBRATOR is not set -+# CONFIG_USB_IOWARRIOR is not set -+# CONFIG_USB_TEST is not set -+# CONFIG_USB_EHSET_TEST_FIXTURE is not set -+# CONFIG_USB_ISIGHTFW is not set -+# CONFIG_USB_YUREX is not set -+# CONFIG_USB_EZUSB_FX2 is not set -+# CONFIG_USB_HUB_USB251XB is not set -+CONFIG_USB_HSIC_USB3503=y -+# CONFIG_USB_HSIC_USB4604 is not set -+# CONFIG_USB_LINK_LAYER_TEST is not set -+# CONFIG_USB_CHAOSKEY is not set -+CONFIG_USB_ONBOARD_HUB=m -+ -+# -+# USB Physical Layer drivers -+# -+CONFIG_USB_PHY=y -+CONFIG_NOP_USB_XCEIV=y -+# CONFIG_USB_ISP1301 is not set -+CONFIG_USB_ULPI=y -+CONFIG_USB_ULPI_VIEWPORT=y -+# end of USB Physical Layer drivers -+ -+CONFIG_USB_GADGET=y -+# CONFIG_USB_GADGET_DEBUG is not set -+# CONFIG_USB_GADGET_DEBUG_FILES is not set -+# CONFIG_USB_GADGET_DEBUG_FS is not set -+CONFIG_USB_GADGET_VBUS_DRAW=500 -+CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS=2 -+# CONFIG_U_SERIAL_CONSOLE is not set -+ -+# -+# USB Peripheral Controller -+# -+# CONFIG_USB_GR_UDC is not set -+# CONFIG_USB_R8A66597 is not set -+# CONFIG_USB_PXA27X is not set -+# CONFIG_USB_MV_UDC is not set -+# CONFIG_USB_MV_U3D is not set -+CONFIG_USB_SNP_CORE=y -+CONFIG_USB_SNP_UDC_PLAT=y -+# CONFIG_USB_M66592 is not set -+CONFIG_USB_BDC_UDC=y -+# CONFIG_USB_AMD5536UDC is not set -+# CONFIG_USB_NET2272 is not set -+# CONFIG_USB_NET2280 is not set -+# CONFIG_USB_GOKU is not set -+# CONFIG_USB_EG20T is not set -+# CONFIG_USB_GADGET_XILINX is not set -+# CONFIG_USB_MAX3420_UDC is not set -+# CONFIG_USB_CDNS2_UDC is not set -+# CONFIG_USB_DUMMY_HCD is not set -+# end of USB Peripheral Controller -+ -+CONFIG_USB_LIBCOMPOSITE=y -+CONFIG_USB_F_ACM=y -+CONFIG_USB_U_SERIAL=y -+CONFIG_USB_U_ETHER=y -+CONFIG_USB_F_SERIAL=y -+CONFIG_USB_F_OBEX=y -+CONFIG_USB_F_NCM=y -+CONFIG_USB_F_ECM=y -+CONFIG_USB_F_EEM=y -+CONFIG_USB_F_SUBSET=y -+CONFIG_USB_F_RNDIS=y -+CONFIG_USB_F_MASS_STORAGE=y -+CONFIG_USB_F_FS=y -+CONFIG_USB_F_UVC=y -+CONFIG_USB_CONFIGFS=y -+CONFIG_USB_CONFIGFS_SERIAL=y -+CONFIG_USB_CONFIGFS_ACM=y -+CONFIG_USB_CONFIGFS_OBEX=y -+CONFIG_USB_CONFIGFS_NCM=y -+CONFIG_USB_CONFIGFS_ECM=y -+CONFIG_USB_CONFIGFS_ECM_SUBSET=y -+CONFIG_USB_CONFIGFS_RNDIS=y -+CONFIG_USB_CONFIGFS_EEM=y -+CONFIG_USB_CONFIGFS_MASS_STORAGE=y -+# CONFIG_USB_CONFIGFS_F_LB_SS is not set -+CONFIG_USB_CONFIGFS_F_FS=y -+# CONFIG_USB_CONFIGFS_F_UAC1 is not set -+# CONFIG_USB_CONFIGFS_F_UAC1_LEGACY is not set -+# CONFIG_USB_CONFIGFS_F_UAC2 is not set -+# CONFIG_USB_CONFIGFS_F_MIDI is not set -+# CONFIG_USB_CONFIGFS_F_MIDI2 is not set -+# CONFIG_USB_CONFIGFS_F_HID is not set -+CONFIG_USB_CONFIGFS_F_UVC=y -+# CONFIG_USB_CONFIGFS_F_PRINTER is not set -+ -+# -+# USB Gadget precomposed configurations -+# -+# CONFIG_USB_ZERO is not set -+# CONFIG_USB_AUDIO is not set -+# CONFIG_USB_ETH is not set -+# CONFIG_USB_G_NCM is not set -+# CONFIG_USB_GADGETFS is not set -+# CONFIG_USB_FUNCTIONFS is not set -+# CONFIG_USB_MASS_STORAGE is not set -+# CONFIG_USB_G_SERIAL is not set -+# CONFIG_USB_MIDI_GADGET is not set -+# CONFIG_USB_G_PRINTER is not set -+# CONFIG_USB_CDC_COMPOSITE is not set -+# CONFIG_USB_G_ACM_MS is not set -+# CONFIG_USB_G_MULTI is not set -+# CONFIG_USB_G_HID is not set -+# CONFIG_USB_G_DBGP is not set -+# CONFIG_USB_G_WEBCAM is not set -+# CONFIG_USB_RAW_GADGET is not set -+# end of USB Gadget precomposed configurations -+ -+CONFIG_TYPEC=m -+CONFIG_TYPEC_TCPM=m -+CONFIG_TYPEC_TCPCI=m -+# CONFIG_TYPEC_RT1711H is not set -+# CONFIG_TYPEC_MT6360 is not set -+# CONFIG_TYPEC_TCPCI_MAXIM is not set -+CONFIG_TYPEC_FUSB302=m -+CONFIG_TYPEC_UCSI=m -+CONFIG_UCSI_CCG=m -+# CONFIG_UCSI_ACPI is not set -+# CONFIG_UCSI_STM32G0 is not set -+CONFIG_UCSI_PMIC_GLINK=m -+CONFIG_TYPEC_TPS6598X=m -+# CONFIG_TYPEC_ANX7411 is not set -+# CONFIG_TYPEC_RT1719 is not set -+CONFIG_TYPEC_HD3SS3220=m -+# CONFIG_TYPEC_STUSB160X is not set -+# CONFIG_TYPEC_WUSB3801 is not set -+ -+# -+# USB Type-C Multiplexer/DeMultiplexer Switch support -+# -+CONFIG_TYPEC_MUX_FSA4480=m -+CONFIG_TYPEC_MUX_GPIO_SBU=m -+# CONFIG_TYPEC_MUX_PI3USB30532 is not set -+# CONFIG_TYPEC_MUX_NB7VPQ904M is not set -+# end of USB Type-C Multiplexer/DeMultiplexer Switch support -+ -+# -+# USB Type-C Alternate Mode drivers -+# -+# CONFIG_TYPEC_DP_ALTMODE is not set -+# end of USB Type-C Alternate Mode drivers -+ -+CONFIG_USB_ROLE_SWITCH=y -+CONFIG_MMC=y -+CONFIG_PWRSEQ_EMMC=y -+# CONFIG_PWRSEQ_SD8787 is not set -+CONFIG_PWRSEQ_SIMPLE=y -+CONFIG_MMC_BLOCK=y -+CONFIG_MMC_BLOCK_MINORS=32 -+# CONFIG_SDIO_UART is not set -+# CONFIG_MMC_TEST is not set -+ -+# -+# MMC/SD/SDIO Host Controller Drivers -+# -+# CONFIG_MMC_DEBUG is not set -+CONFIG_MMC_ARMMMCI=y -+CONFIG_MMC_STM32_SDMMC=y -+CONFIG_MMC_SDHCI=y -+CONFIG_MMC_SDHCI_IO_ACCESSORS=y -+# CONFIG_MMC_SDHCI_PCI is not set -+CONFIG_MMC_SDHCI_ACPI=y -+CONFIG_MMC_SDHCI_PLTFM=y -+CONFIG_MMC_SDHCI_OF_ARASAN=y -+# CONFIG_MMC_SDHCI_OF_AT91 is not set -+CONFIG_MMC_SDHCI_OF_DWCMSHC=y -+CONFIG_MMC_SDHCI_CADENCE=y -+CONFIG_MMC_SDHCI_F_SDH30=y -+# CONFIG_MMC_SDHCI_MILBEAUT is not set -+# CONFIG_MMC_TIFM_SD is not set -+CONFIG_MMC_SPI=y -+# CONFIG_MMC_CB710 is not set -+# CONFIG_MMC_VIA_SDMMC is not set -+CONFIG_MMC_DW=y -+CONFIG_MMC_DW_PLTFM=y -+# CONFIG_MMC_DW_BLUEFIELD is not set -+CONFIG_MMC_DW_EXYNOS=y -+CONFIG_MMC_DW_HI3798CV200=y -+CONFIG_MMC_DW_K3=y -+# CONFIG_MMC_DW_PCI is not set -+# CONFIG_MMC_VUB300 is not set -+# CONFIG_MMC_USHC is not set -+# CONFIG_MMC_USDHI6ROL0 is not set -+CONFIG_MMC_CQHCI=y -+# CONFIG_MMC_HSQ is not set -+# CONFIG_MMC_TOSHIBA_PCI is not set -+CONFIG_MMC_MTK=y -+CONFIG_MMC_SDHCI_XENON=y -+CONFIG_MMC_PHYTIUM_SDCI=m -+# CONFIG_MMC_PHYTIUM_MCI_PCI is not set -+CONFIG_MMC_PHYTIUM_MCI_PLTFM=y -+CONFIG_SCSI_UFSHCD=y -+CONFIG_SCSI_UFS_BSG=y -+# CONFIG_SCSI_UFS_HWMON is not set -+# CONFIG_SCSI_UFSHCD_PCI is not set -+CONFIG_SCSI_UFSHCD_PLATFORM=y -+CONFIG_SCSI_UFS_CDNS_PLATFORM=m -+# CONFIG_SCSI_UFS_DWC_TC_PLATFORM is not set -+# CONFIG_MEMSTICK is not set -+CONFIG_NEW_LEDS=y -+CONFIG_LEDS_CLASS=y -+# CONFIG_LEDS_CLASS_FLASH is not set -+CONFIG_LEDS_CLASS_MULTICOLOR=m -+# CONFIG_LEDS_BRIGHTNESS_HW_CHANGED is not set -+ -+# -+# LED drivers -+# -+# CONFIG_LEDS_AN30259A is not set -+# CONFIG_LEDS_AW200XX is not set -+# CONFIG_LEDS_AW2013 is not set -+# CONFIG_LEDS_BCM6328 is not set -+# CONFIG_LEDS_BCM6358 is not set -+# CONFIG_LEDS_CR0014114 is not set -+# CONFIG_LEDS_EL15203000 is not set -+# CONFIG_LEDS_LM3530 is not set -+# CONFIG_LEDS_LM3532 is not set -+# CONFIG_LEDS_LM3642 is not set -+CONFIG_LEDS_LM3692X=m -+# CONFIG_LEDS_MT6323 is not set -+CONFIG_LEDS_PCA9532=m -+# CONFIG_LEDS_PCA9532_GPIO is not set -+CONFIG_LEDS_GPIO=y -+# CONFIG_LEDS_LP3944 is not set -+# CONFIG_LEDS_LP3952 is not set -+# CONFIG_LEDS_LP50XX is not set -+# CONFIG_LEDS_LP55XX_COMMON is not set -+# CONFIG_LEDS_LP8860 is not set -+# CONFIG_LEDS_PCA955X is not set -+# CONFIG_LEDS_PCA963X is not set -+# CONFIG_LEDS_PCA995X is not set -+# CONFIG_LEDS_DAC124S085 is not set -+CONFIG_LEDS_PWM=y -+# CONFIG_LEDS_REGULATOR is not set -+# CONFIG_LEDS_BD2606MVV is not set -+# CONFIG_LEDS_BD2802 is not set -+# CONFIG_LEDS_LT3593 is not set -+# CONFIG_LEDS_TCA6507 is not set -+# CONFIG_LEDS_TLC591XX is not set -+# CONFIG_LEDS_LM355x is not set -+# CONFIG_LEDS_IS31FL319X is not set -+# CONFIG_LEDS_IS31FL32XX is not set -+ -+# -+# LED driver for blink(1) USB RGB LED is under Special HID drivers (HID_THINGM) -+# -+# CONFIG_LEDS_BLINKM is not set -+CONFIG_LEDS_SYSCON=y -+# CONFIG_LEDS_MLXREG is not set -+# CONFIG_LEDS_USER is not set -+# CONFIG_LEDS_SPI_BYTE is not set -+# CONFIG_LEDS_LM3697 is not set -+ -+# -+# Flash and Torch LED drivers -+# -+ -+# -+# RGB LED drivers -+# -+# CONFIG_LEDS_GROUP_MULTICOLOR is not set -+# CONFIG_LEDS_PWM_MULTICOLOR is not set -+CONFIG_LEDS_QCOM_LPG=m -+ -+# -+# LED Triggers -+# -+CONFIG_LEDS_TRIGGERS=y -+CONFIG_LEDS_TRIGGER_TIMER=y -+# CONFIG_LEDS_TRIGGER_ONESHOT is not set -+CONFIG_LEDS_TRIGGER_DISK=y -+# CONFIG_LEDS_TRIGGER_MTD is not set -+CONFIG_LEDS_TRIGGER_HEARTBEAT=y -+# CONFIG_LEDS_TRIGGER_BACKLIGHT is not set -+CONFIG_LEDS_TRIGGER_CPU=y -+# CONFIG_LEDS_TRIGGER_ACTIVITY is not set -+CONFIG_LEDS_TRIGGER_DEFAULT_ON=y -+ -+# -+# iptables trigger is under Netfilter config (LED target) -+# -+# CONFIG_LEDS_TRIGGER_TRANSIENT is not set -+# CONFIG_LEDS_TRIGGER_CAMERA is not set -+CONFIG_LEDS_TRIGGER_PANIC=y -+# CONFIG_LEDS_TRIGGER_NETDEV is not set -+# CONFIG_LEDS_TRIGGER_PATTERN is not set -+CONFIG_LEDS_TRIGGER_AUDIO=y -+# CONFIG_LEDS_TRIGGER_TTY is not set -+ -+# -+# Simple LED drivers -+# -+# CONFIG_ACCESSIBILITY is not set -+# CONFIG_INFINIBAND is not set -+CONFIG_EDAC_SUPPORT=y -+CONFIG_EDAC=y -+CONFIG_EDAC_LEGACY_SYSFS=y -+# CONFIG_EDAC_DEBUG is not set -+CONFIG_EDAC_GHES=y -+# CONFIG_EDAC_THUNDERX is not set -+# CONFIG_EDAC_XGENE is not set -+# CONFIG_EDAC_PHYTIUM is not set -+# CONFIG_EDAC_DMC520 is not set -+CONFIG_RTC_LIB=y -+CONFIG_RTC_CLASS=y -+CONFIG_RTC_HCTOSYS=y -+CONFIG_RTC_HCTOSYS_DEVICE="rtc0" -+CONFIG_RTC_SYSTOHC=y -+CONFIG_RTC_SYSTOHC_DEVICE="rtc0" -+# CONFIG_RTC_DEBUG is not set -+CONFIG_RTC_NVMEM=y -+ -+# -+# RTC interfaces -+# -+CONFIG_RTC_INTF_SYSFS=y -+CONFIG_RTC_INTF_PROC=y -+CONFIG_RTC_INTF_DEV=y -+# CONFIG_RTC_INTF_DEV_UIE_EMUL is not set -+# CONFIG_RTC_DRV_TEST is not set -+ -+# -+# I2C RTC drivers -+# -+# CONFIG_RTC_DRV_ABB5ZES3 is not set -+# CONFIG_RTC_DRV_ABEOZ9 is not set -+# CONFIG_RTC_DRV_ABX80X is not set -+CONFIG_RTC_DRV_DS1307=m -+# CONFIG_RTC_DRV_DS1307_CENTURY is not set -+# CONFIG_RTC_DRV_DS1374 is not set -+# CONFIG_RTC_DRV_DS1672 is not set -+CONFIG_RTC_DRV_HYM8563=m -+# CONFIG_RTC_DRV_MAX6900 is not set -+CONFIG_RTC_DRV_MAX77686=y -+# CONFIG_RTC_DRV_NCT3018Y is not set -+CONFIG_RTC_DRV_RK808=m -+# CONFIG_RTC_DRV_RS5C372 is not set -+CONFIG_RTC_DRV_ISL1208=m -+# CONFIG_RTC_DRV_ISL12022 is not set -+# CONFIG_RTC_DRV_ISL12026 is not set -+# CONFIG_RTC_DRV_X1205 is not set -+# CONFIG_RTC_DRV_PCF8523 is not set -+CONFIG_RTC_DRV_PCF85063=m -+CONFIG_RTC_DRV_PCF85363=m -+# CONFIG_RTC_DRV_PCF8563 is not set -+# CONFIG_RTC_DRV_PCF8583 is not set -+CONFIG_RTC_DRV_M41T80=m -+# CONFIG_RTC_DRV_M41T80_WDT is not set -+CONFIG_RTC_DRV_BQ32K=m -+# CONFIG_RTC_DRV_S35390A is not set -+# CONFIG_RTC_DRV_FM3130 is not set -+# CONFIG_RTC_DRV_RX8010 is not set -+CONFIG_RTC_DRV_RX8581=m -+# CONFIG_RTC_DRV_RX8025 is not set -+# CONFIG_RTC_DRV_EM3027 is not set -+CONFIG_RTC_DRV_RV3028=m -+# CONFIG_RTC_DRV_RV3032 is not set -+CONFIG_RTC_DRV_RV8803=m -+CONFIG_RTC_DRV_S5M=y -+# CONFIG_RTC_DRV_SD3068 is not set -+# CONFIG_RTC_DRV_SD3078 is not set -+ -+# -+# SPI RTC drivers -+# -+# CONFIG_RTC_DRV_M41T93 is not set -+# CONFIG_RTC_DRV_M41T94 is not set -+# CONFIG_RTC_DRV_DS1302 is not set -+# CONFIG_RTC_DRV_DS1305 is not set -+# CONFIG_RTC_DRV_DS1343 is not set -+# CONFIG_RTC_DRV_DS1347 is not set -+# CONFIG_RTC_DRV_DS1390 is not set -+# CONFIG_RTC_DRV_MAX6916 is not set -+# CONFIG_RTC_DRV_R9701 is not set -+# CONFIG_RTC_DRV_RX4581 is not set -+# CONFIG_RTC_DRV_RS5C348 is not set -+# CONFIG_RTC_DRV_MAX6902 is not set -+# CONFIG_RTC_DRV_PCF2123 is not set -+# CONFIG_RTC_DRV_MCP795 is not set -+CONFIG_RTC_I2C_AND_SPI=y -+ -+# -+# SPI and I2C RTC drivers -+# -+CONFIG_RTC_DRV_DS3232=y -+CONFIG_RTC_DRV_DS3232_HWMON=y -+CONFIG_RTC_DRV_PCF2127=m -+# CONFIG_RTC_DRV_RV3029C2 is not set -+# CONFIG_RTC_DRV_RX6110 is not set -+ -+# -+# Platform RTC drivers -+# -+# CONFIG_RTC_DRV_DS1286 is not set -+# CONFIG_RTC_DRV_DS1511 is not set -+# CONFIG_RTC_DRV_DS1553 is not set -+# CONFIG_RTC_DRV_DS1685_FAMILY is not set -+# CONFIG_RTC_DRV_DS1742 is not set -+# CONFIG_RTC_DRV_DS2404 is not set -+CONFIG_RTC_DRV_EFI=y -+# CONFIG_RTC_DRV_STK17TA8 is not set -+# CONFIG_RTC_DRV_M48T86 is not set -+# CONFIG_RTC_DRV_M48T35 is not set -+# CONFIG_RTC_DRV_M48T59 is not set -+# CONFIG_RTC_DRV_MSM6242 is not set -+# CONFIG_RTC_DRV_RP5C01 is not set -+# CONFIG_RTC_DRV_ZYNQMP is not set -+CONFIG_RTC_DRV_CROS_EC=y -+ -+# -+# on-CPU RTC drivers -+# -+# CONFIG_RTC_DRV_PL030 is not set -+CONFIG_RTC_DRV_PL031=y -+# CONFIG_RTC_DRV_CADENCE is not set -+# CONFIG_RTC_DRV_FTRTC010 is not set -+CONFIG_RTC_DRV_MT6397=m -+# CONFIG_RTC_DRV_R7301 is not set -+ -+# -+# HID Sensor RTC drivers -+# -+# CONFIG_RTC_DRV_GOLDFISH is not set -+CONFIG_DMADEVICES=y -+# CONFIG_DMADEVICES_DEBUG is not set -+ -+# -+# DMA Devices -+# -+CONFIG_ASYNC_TX_ENABLE_CHANNEL_SWITCH=y -+CONFIG_DMA_ENGINE=y -+CONFIG_DMA_VIRTUAL_CHANNELS=y -+CONFIG_DMA_ACPI=y -+CONFIG_DMA_OF=y -+# CONFIG_ALTERA_MSGDMA is not set -+# CONFIG_AMBA_PL08X is not set -+CONFIG_BCM_SBA_RAID=m -+# CONFIG_DW_AXI_DMAC is not set -+CONFIG_FSL_EDMA=y -+# CONFIG_FSL_QDMA is not set -+# CONFIG_INTEL_IDMA64 is not set -+CONFIG_MV_XOR_V2=y -+CONFIG_PHYTIUM_DDMA=y -+CONFIG_PHYTIUM_GDMA=y -+CONFIG_PL330_DMA=y -+# CONFIG_PLX_DMA is not set -+# CONFIG_XILINX_DMA is not set -+# CONFIG_XILINX_XDMA is not set -+# CONFIG_XILINX_ZYNQMP_DMA is not set -+# CONFIG_XILINX_ZYNQMP_DPDMA is not set -+CONFIG_PHYTIUM_PCI_DMAC=y -+CONFIG_QCOM_HIDMA_MGMT=y -+CONFIG_QCOM_HIDMA=y -+# CONFIG_DW_DMAC is not set -+# CONFIG_DW_DMAC_PCI is not set -+# CONFIG_DW_EDMA is not set -+# CONFIG_SF_PDMA is not set -+ -+# -+# DMA Clients -+# -+# CONFIG_ASYNC_TX_DMA is not set -+# CONFIG_DMATEST is not set -+CONFIG_DMA_ENGINE_RAID=y -+ -+# -+# DMABUF options -+# -+CONFIG_SYNC_FILE=y -+# CONFIG_SW_SYNC is not set -+# CONFIG_UDMABUF is not set -+# CONFIG_DMABUF_MOVE_NOTIFY is not set -+# CONFIG_DMABUF_DEBUG is not set -+# CONFIG_DMABUF_SELFTESTS is not set -+CONFIG_DMABUF_HEAPS=y -+CONFIG_DMABUF_SYSFS_STATS=y -+CONFIG_DMABUF_HEAPS_SYSTEM=y -+CONFIG_DMABUF_HEAPS_CMA=y -+# end of DMABUF options -+ -+CONFIG_UIO=m -+# CONFIG_UIO_CIF is not set -+CONFIG_UIO_PDRV_GENIRQ=m -+CONFIG_UIO_DMEM_GENIRQ=m -+# CONFIG_UIO_AEC is not set -+# CONFIG_UIO_SERCOS3 is not set -+CONFIG_UIO_PCI_GENERIC=m -+# CONFIG_UIO_NETX is not set -+# CONFIG_UIO_PRUSS is not set -+# CONFIG_UIO_MF624 is not set -+CONFIG_VFIO=y -+CONFIG_VFIO_GROUP=y -+CONFIG_VFIO_CONTAINER=y -+CONFIG_VFIO_IOMMU_TYPE1=y -+# CONFIG_VFIO_NOIOMMU is not set -+CONFIG_VFIO_VIRQFD=y -+ -+# -+# VFIO support for PCI devices -+# -+CONFIG_VFIO_PCI_CORE=y -+CONFIG_VFIO_PCI_MMAP=y -+CONFIG_VFIO_PCI_INTX=y -+CONFIG_VFIO_PCI=y -+# CONFIG_MLX5_VFIO_PCI is not set -+# CONFIG_HISI_ACC_VFIO_PCI is not set -+# end of VFIO support for PCI devices -+ -+# -+# VFIO support for platform devices -+# -+# CONFIG_VFIO_PLATFORM is not set -+# CONFIG_VFIO_AMBA is not set -+# end of VFIO support for platform devices -+ -+# CONFIG_VIRT_DRIVERS is not set -+CONFIG_VIRTIO_ANCHOR=y -+CONFIG_VIRTIO=y -+CONFIG_VIRTIO_PCI_LIB=y -+CONFIG_VIRTIO_PCI_LIB_LEGACY=y -+CONFIG_VIRTIO_MENU=y -+CONFIG_VIRTIO_PCI=y -+CONFIG_VIRTIO_PCI_LEGACY=y -+CONFIG_VIRTIO_BALLOON=y -+# CONFIG_VIRTIO_MEM is not set -+# CONFIG_VIRTIO_INPUT is not set -+CONFIG_VIRTIO_MMIO=y -+# CONFIG_VIRTIO_MMIO_CMDLINE_DEVICES is not set -+# CONFIG_VDPA is not set -+CONFIG_VHOST_MENU=y -+# CONFIG_VHOST_NET is not set -+# CONFIG_VHOST_CROSS_ENDIAN_LEGACY is not set -+ -+# -+# Microsoft Hyper-V guest support -+# -+# CONFIG_HYPERV is not set -+# end of Microsoft Hyper-V guest support -+ -+# -+# Xen driver support -+# -+CONFIG_XEN_BALLOON=y -+CONFIG_XEN_BALLOON_MEMORY_HOTPLUG=y -+CONFIG_XEN_SCRUB_PAGES_DEFAULT=y -+CONFIG_XEN_DEV_EVTCHN=y -+CONFIG_XEN_BACKEND=y -+CONFIG_XENFS=y -+CONFIG_XEN_COMPAT_XENFS=y -+CONFIG_XEN_SYS_HYPERVISOR=y -+CONFIG_XEN_XENBUS_FRONTEND=y -+CONFIG_XEN_GNTDEV=y -+CONFIG_XEN_GRANT_DEV_ALLOC=y -+# CONFIG_XEN_GRANT_DMA_ALLOC is not set -+CONFIG_SWIOTLB_XEN=y -+CONFIG_XEN_PCI_STUB=y -+CONFIG_XEN_PCIDEV_STUB=m -+# CONFIG_XEN_PVCALLS_FRONTEND is not set -+# CONFIG_XEN_PVCALLS_BACKEND is not set -+CONFIG_XEN_PRIVCMD=y -+CONFIG_XEN_EFI=y -+CONFIG_XEN_AUTO_XLATE=y -+# CONFIG_XEN_VIRTIO is not set -+# end of Xen driver support -+ -+# CONFIG_GREYBUS is not set -+# CONFIG_COMEDI is not set -+CONFIG_STAGING=y -+# CONFIG_PRISM2_USB is not set -+# CONFIG_RTL8192U is not set -+# CONFIG_RTLLIB is not set -+# CONFIG_RTL8723BS is not set -+# CONFIG_R8712U is not set -+# CONFIG_RTS5208 is not set -+# CONFIG_VT6655 is not set -+# CONFIG_VT6656 is not set -+ -+# -+# IIO staging drivers -+# -+ -+# -+# Accelerometers -+# -+# CONFIG_ADIS16203 is not set -+# CONFIG_ADIS16240 is not set -+# end of Accelerometers -+ -+# -+# Analog to digital converters -+# -+# CONFIG_AD7816 is not set -+# end of Analog to digital converters -+ -+# -+# Analog digital bi-direction converters -+# -+# CONFIG_ADT7316 is not set -+# end of Analog digital bi-direction converters -+ -+# -+# Direct Digital Synthesis -+# -+# CONFIG_AD9832 is not set -+# CONFIG_AD9834 is not set -+# end of Direct Digital Synthesis -+ -+# -+# Network Analyzer, Impedance Converters -+# -+# CONFIG_AD5933 is not set -+# end of Network Analyzer, Impedance Converters -+ -+# -+# Resolver to digital converters -+# -+# CONFIG_AD2S1210 is not set -+# end of Resolver to digital converters -+# end of IIO staging drivers -+ -+# CONFIG_FB_SM750 is not set -+CONFIG_STAGING_MEDIA=y -+# CONFIG_DVB_AV7110 is not set -+CONFIG_VIDEO_MAX96712=m -+# CONFIG_STAGING_MEDIA_DEPRECATED is not set -+# CONFIG_STAGING_BOARD is not set -+# CONFIG_LTE_GDM724X is not set -+# CONFIG_FB_TFT is not set -+# CONFIG_KS7010 is not set -+# CONFIG_PI433 is not set -+# CONFIG_XIL_AXIS_FIFO is not set -+# CONFIG_FIELDBUS_DEV is not set -+# CONFIG_QLGE is not set -+# CONFIG_VME_BUS is not set -+# CONFIG_HILOG is not set -+CONFIG_HIEVENT=y -+CONFIG_BBOX_BUFFER_SIZE=2048 -+CONFIG_HISYSEVENT=y -+# CONFIG_DFX_ZEROHUNG is not set -+# CONFIG_DFX_HUNGTASK is not set -+ -+# -+# Android -+# -+CONFIG_ASHMEM=y -+# CONFIG_ION is not set -+# end of Android -+ -+# CONFIG_GOLDFISH is not set -+CONFIG_CHROME_PLATFORMS=y -+# CONFIG_CHROMEOS_ACPI is not set -+# CONFIG_CHROMEOS_TBMC is not set -+CONFIG_CROS_EC=y -+CONFIG_CROS_EC_I2C=y -+CONFIG_CROS_EC_RPMSG=m -+CONFIG_CROS_EC_SPI=y -+# CONFIG_CROS_EC_UART is not set -+CONFIG_CROS_EC_PROTO=y -+# CONFIG_CROS_KBD_LED_BACKLIGHT is not set -+CONFIG_CROS_EC_CHARDEV=m -+CONFIG_CROS_EC_LIGHTBAR=y -+CONFIG_CROS_EC_VBC=y -+CONFIG_CROS_EC_DEBUGFS=y -+CONFIG_CROS_EC_SENSORHUB=y -+CONFIG_CROS_EC_SYSFS=y -+CONFIG_CROS_EC_TYPEC=m -+# CONFIG_CROS_HPS_I2C is not set -+CONFIG_CROS_USBPD_NOTIFY=y -+# CONFIG_CHROMEOS_PRIVACY_SCREEN is not set -+CONFIG_CROS_TYPEC_SWITCH=m -+# CONFIG_MELLANOX_PLATFORM is not set -+CONFIG_SURFACE_PLATFORMS=y -+# CONFIG_SURFACE_3_POWER_OPREGION is not set -+# CONFIG_SURFACE_GPE is not set -+# CONFIG_SURFACE_HOTPLUG is not set -+# CONFIG_SURFACE_PRO3_BUTTON is not set -+# CONFIG_SURFACE_AGGREGATOR is not set -+CONFIG_HAVE_CLK=y -+CONFIG_HAVE_CLK_PREPARE=y -+CONFIG_COMMON_CLK=y -+ -+# -+# Clock driver for ARM Reference designs -+# -+# CONFIG_CLK_ICST is not set -+# CONFIG_CLK_SP810 is not set -+CONFIG_CLK_VEXPRESS_OSC=y -+# end of Clock driver for ARM Reference designs -+ -+# CONFIG_LMK04832 is not set -+# CONFIG_COMMON_CLK_MAX77686 is not set -+# CONFIG_COMMON_CLK_MAX9485 is not set -+CONFIG_COMMON_CLK_RK808=y -+CONFIG_COMMON_CLK_SCMI=y -+CONFIG_COMMON_CLK_SCPI=y -+# CONFIG_COMMON_CLK_SI5341 is not set -+# CONFIG_COMMON_CLK_SI5351 is not set -+# CONFIG_COMMON_CLK_SI514 is not set -+# CONFIG_COMMON_CLK_SI544 is not set -+# CONFIG_COMMON_CLK_SI570 is not set -+# CONFIG_COMMON_CLK_CDCE706 is not set -+# CONFIG_COMMON_CLK_CDCE925 is not set -+CONFIG_COMMON_CLK_CS2000_CP=y -+CONFIG_COMMON_CLK_S2MPS11=y -+# CONFIG_COMMON_CLK_AXI_CLKGEN is not set -+CONFIG_COMMON_CLK_XGENE=y -+CONFIG_COMMON_CLK_PWM=y -+CONFIG_COMMON_CLK_RS9_PCIE=y -+# CONFIG_COMMON_CLK_SI521XX is not set -+# CONFIG_COMMON_CLK_VC3 is not set -+CONFIG_COMMON_CLK_VC5=y -+# CONFIG_COMMON_CLK_VC7 is not set -+CONFIG_COMMON_CLK_BD718XX=m -+# CONFIG_COMMON_CLK_FIXED_MMIO is not set -+# CONFIG_XILINX_VCU is not set -+# CONFIG_COMMON_CLK_XLNX_CLKWZRD is not set -+CONFIG_HWSPINLOCK=y -+CONFIG_HWSPINLOCK_PHYTIUM=m -+ -+# -+# Clock Source drivers -+# -+CONFIG_TIMER_OF=y -+CONFIG_TIMER_ACPI=y -+CONFIG_TIMER_PROBE=y -+CONFIG_ARM_ARCH_TIMER=y -+CONFIG_ARM_ARCH_TIMER_EVTSTREAM=y -+CONFIG_ARM_ARCH_TIMER_OOL_WORKAROUND=y -+CONFIG_FSL_ERRATUM_A008585=y -+CONFIG_HISILICON_ERRATUM_161010101=y -+CONFIG_ARM64_ERRATUM_858921=y -+# end of Clock Source drivers -+ -+CONFIG_MAILBOX=y -+CONFIG_ARM_MHU=y -+# CONFIG_ARM_MHU_V2 is not set -+CONFIG_PHYTIUM_MBOX=y -+CONFIG_PLATFORM_MHU=y -+# CONFIG_PL320_MBOX is not set -+CONFIG_PCC=y -+# CONFIG_ALTERA_MBOX is not set -+# CONFIG_MAILBOX_TEST is not set -+CONFIG_IOMMU_IOVA=y -+CONFIG_IOMMU_API=y -+CONFIG_IOMMU_SUPPORT=y -+ -+# -+# Generic IOMMU Pagetable Support -+# -+CONFIG_IOMMU_IO_PGTABLE=y -+CONFIG_IOMMU_IO_PGTABLE_LPAE=y -+# CONFIG_IOMMU_IO_PGTABLE_LPAE_SELFTEST is not set -+CONFIG_IOMMU_IO_PGTABLE_ARMV7S=y -+# CONFIG_IOMMU_IO_PGTABLE_ARMV7S_SELFTEST is not set -+CONFIG_IOMMU_IO_PGTABLE_DART=y -+# end of Generic IOMMU Pagetable Support -+ -+# CONFIG_IOMMU_DEBUGFS is not set -+CONFIG_IOMMU_DEFAULT_DMA_STRICT=y -+# CONFIG_IOMMU_DEFAULT_DMA_LAZY is not set -+# CONFIG_IOMMU_DEFAULT_PASSTHROUGH is not set -+CONFIG_OF_IOMMU=y -+CONFIG_IOMMU_DMA=y -+# CONFIG_IOMMUFD is not set -+CONFIG_ARM_SMMU=y -+# CONFIG_ARM_SMMU_LEGACY_DT_BINDINGS is not set -+CONFIG_ARM_SMMU_DISABLE_BYPASS_BY_DEFAULT=y -+CONFIG_ARM_SMMU_V3=y -+# CONFIG_ARM_SMMU_V3_SVA is not set -+# CONFIG_VIRTIO_IOMMU is not set -+ -+# -+# Remoteproc drivers -+# -+CONFIG_REMOTEPROC=y -+CONFIG_REMOTEPROC_CDEV=y -+CONFIG_HOMO_REMOTEPROC=y -+# end of Remoteproc drivers -+ -+# -+# Rpmsg drivers -+# -+CONFIG_RPMSG=y -+CONFIG_RPMSG_CHAR=m -+CONFIG_RPMSG_CTRL=m -+CONFIG_RPMSG_NS=y -+CONFIG_RPMSG_QCOM_GLINK=y -+CONFIG_RPMSG_QCOM_GLINK_RPM=y -+CONFIG_RPMSG_VIRTIO=y -+# end of Rpmsg drivers -+ -+CONFIG_SOUNDWIRE=m -+ -+# -+# SoundWire Devices -+# -+# CONFIG_SOUNDWIRE_AMD is not set -+# CONFIG_SOUNDWIRE_INTEL is not set -+CONFIG_SOUNDWIRE_QCOM=m -+ -+# -+# SOC (System On Chip) specific Drivers -+# -+ -+# -+# Amlogic SoC drivers -+# -+# end of Amlogic SoC drivers -+ -+# -+# Broadcom SoC drivers -+# -+CONFIG_SOC_BRCMSTB=y -+# end of Broadcom SoC drivers -+ -+# -+# NXP/Freescale QorIQ SoC drivers -+# -+# CONFIG_QUICC_ENGINE is not set -+CONFIG_FSL_RCPM=y -+# end of NXP/Freescale QorIQ SoC drivers -+ -+# -+# fujitsu SoC drivers -+# -+# CONFIG_A64FX_DIAG is not set -+# end of fujitsu SoC drivers -+ -+# -+# i.MX SoC drivers -+# -+# end of i.MX SoC drivers -+ -+# -+# Enable LiteX SoC Builder specific drivers -+# -+# CONFIG_LITEX_SOC_CONTROLLER is not set -+# end of Enable LiteX SoC Builder specific drivers -+ -+# CONFIG_WPCM450_SOC is not set -+ -+# -+# Qualcomm SoC drivers -+# -+CONFIG_QCOM_PDR_HELPERS=m -+CONFIG_QCOM_PMIC_GLINK=m -+CONFIG_QCOM_QMI_HELPERS=m -+# end of Qualcomm SoC drivers -+ -+CONFIG_SOC_TI=y -+ -+# -+# Xilinx SoC drivers -+# -+# end of Xilinx SoC drivers -+# end of SOC (System On Chip) specific Drivers -+ -+CONFIG_PM_DEVFREQ=y -+ -+# -+# DEVFREQ Governors -+# -+CONFIG_DEVFREQ_GOV_SIMPLE_ONDEMAND=y -+CONFIG_DEVFREQ_GOV_PERFORMANCE=y -+CONFIG_DEVFREQ_GOV_POWERSAVE=y -+CONFIG_DEVFREQ_GOV_USERSPACE=y -+CONFIG_DEVFREQ_GOV_PASSIVE=m -+ -+# -+# DEVFREQ Drivers -+# -+# CONFIG_PM_DEVFREQ_EVENT is not set -+CONFIG_EXTCON=y -+ -+# -+# Extcon Device Drivers -+# -+# CONFIG_EXTCON_ADC_JACK is not set -+# CONFIG_EXTCON_FSA9480 is not set -+# CONFIG_EXTCON_GPIO is not set -+# CONFIG_EXTCON_MAX3355 is not set -+CONFIG_EXTCON_PTN5150=m -+# CONFIG_EXTCON_RT8973A is not set -+# CONFIG_EXTCON_SM5502 is not set -+CONFIG_EXTCON_USB_GPIO=y -+CONFIG_EXTCON_USBC_CROS_EC=y -+# CONFIG_EXTCON_USBC_TUSB320 is not set -+CONFIG_MEMORY=y -+# CONFIG_ARM_PL172_MPMC is not set -+CONFIG_IIO=y -+CONFIG_IIO_BUFFER=y -+# CONFIG_IIO_BUFFER_CB is not set -+# CONFIG_IIO_BUFFER_DMA is not set -+# CONFIG_IIO_BUFFER_DMAENGINE is not set -+# CONFIG_IIO_BUFFER_HW_CONSUMER is not set -+CONFIG_IIO_KFIFO_BUF=y -+CONFIG_IIO_TRIGGERED_BUFFER=y -+# CONFIG_IIO_CONFIGFS is not set -+CONFIG_IIO_TRIGGER=y -+CONFIG_IIO_CONSUMERS_PER_TRIGGER=2 -+# CONFIG_IIO_SW_DEVICE is not set -+# CONFIG_IIO_SW_TRIGGER is not set -+# CONFIG_IIO_TRIGGERED_EVENT is not set -+ -+# -+# Accelerometers -+# -+# CONFIG_ADIS16201 is not set -+# CONFIG_ADIS16209 is not set -+# CONFIG_ADXL313_I2C is not set -+# CONFIG_ADXL313_SPI is not set -+# CONFIG_ADXL345_I2C is not set -+# CONFIG_ADXL345_SPI is not set -+# CONFIG_ADXL355_I2C is not set -+# CONFIG_ADXL355_SPI is not set -+# CONFIG_ADXL367_SPI is not set -+# CONFIG_ADXL367_I2C is not set -+# CONFIG_ADXL372_SPI is not set -+# CONFIG_ADXL372_I2C is not set -+# CONFIG_BMA180 is not set -+# CONFIG_BMA220 is not set -+# CONFIG_BMA400 is not set -+# CONFIG_BMC150_ACCEL is not set -+# CONFIG_BMI088_ACCEL is not set -+# CONFIG_DA280 is not set -+# CONFIG_DA311 is not set -+# CONFIG_DMARD06 is not set -+# CONFIG_DMARD09 is not set -+# CONFIG_DMARD10 is not set -+# CONFIG_FXLS8962AF_I2C is not set -+# CONFIG_FXLS8962AF_SPI is not set -+# CONFIG_IIO_CROS_EC_ACCEL_LEGACY is not set -+# CONFIG_IIO_ST_ACCEL_3AXIS is not set -+# CONFIG_IIO_KX022A_SPI is not set -+# CONFIG_IIO_KX022A_I2C is not set -+# CONFIG_KXSD9 is not set -+# CONFIG_KXCJK1013 is not set -+# CONFIG_MC3230 is not set -+# CONFIG_MMA7455_I2C is not set -+# CONFIG_MMA7455_SPI is not set -+# CONFIG_MMA7660 is not set -+# CONFIG_MMA8452 is not set -+# CONFIG_MMA9551 is not set -+# CONFIG_MMA9553 is not set -+# CONFIG_MSA311 is not set -+# CONFIG_MXC4005 is not set -+# CONFIG_MXC6255 is not set -+# CONFIG_SCA3000 is not set -+# CONFIG_SCA3300 is not set -+# CONFIG_STK8312 is not set -+# CONFIG_STK8BA50 is not set -+# end of Accelerometers -+ -+# -+# Analog to digital converters -+# -+# CONFIG_AD4130 is not set -+# CONFIG_AD7091R5 is not set -+# CONFIG_AD7124 is not set -+# CONFIG_AD7192 is not set -+# CONFIG_AD7266 is not set -+# CONFIG_AD7280 is not set -+# CONFIG_AD7291 is not set -+# CONFIG_AD7292 is not set -+# CONFIG_AD7298 is not set -+# CONFIG_AD7476 is not set -+# CONFIG_AD7606_IFACE_PARALLEL is not set -+# CONFIG_AD7606_IFACE_SPI is not set -+# CONFIG_AD7766 is not set -+# CONFIG_AD7768_1 is not set -+# CONFIG_AD7780 is not set -+# CONFIG_AD7791 is not set -+# CONFIG_AD7793 is not set -+# CONFIG_AD7887 is not set -+# CONFIG_AD7923 is not set -+# CONFIG_AD7949 is not set -+# CONFIG_AD799X is not set -+# CONFIG_ADI_AXI_ADC is not set -+# CONFIG_AXP20X_ADC is not set -+# CONFIG_AXP288_ADC is not set -+# CONFIG_CC10001_ADC is not set -+# CONFIG_ENVELOPE_DETECTOR is not set -+# CONFIG_HI8435 is not set -+# CONFIG_HX711 is not set -+# CONFIG_INA2XX_ADC is not set -+# CONFIG_LTC2471 is not set -+# CONFIG_LTC2485 is not set -+# CONFIG_LTC2496 is not set -+# CONFIG_LTC2497 is not set -+# CONFIG_MAX1027 is not set -+# CONFIG_MAX11100 is not set -+# CONFIG_MAX1118 is not set -+# CONFIG_MAX11205 is not set -+# CONFIG_MAX11410 is not set -+# CONFIG_MAX1241 is not set -+# CONFIG_MAX1363 is not set -+CONFIG_MAX9611=m -+# CONFIG_MCP320X is not set -+# CONFIG_MCP3422 is not set -+# CONFIG_MCP3911 is not set -+# CONFIG_MEDIATEK_MT6360_ADC is not set -+# CONFIG_NAU7802 is not set -+CONFIG_PHYTIUM_ADC=m -+CONFIG_QCOM_VADC_COMMON=m -+# CONFIG_QCOM_SPMI_IADC is not set -+CONFIG_QCOM_SPMI_VADC=m -+CONFIG_QCOM_SPMI_ADC5=m -+# CONFIG_RICHTEK_RTQ6056 is not set -+# CONFIG_SD_ADC_MODULATOR is not set -+# CONFIG_TI_ADC081C is not set -+# CONFIG_TI_ADC0832 is not set -+# CONFIG_TI_ADC084S021 is not set -+# CONFIG_TI_ADC12138 is not set -+# CONFIG_TI_ADC108S102 is not set -+# CONFIG_TI_ADC128S052 is not set -+# CONFIG_TI_ADC161S626 is not set -+CONFIG_TI_ADS1015=m -+# CONFIG_TI_ADS7924 is not set -+# CONFIG_TI_ADS1100 is not set -+# CONFIG_TI_ADS7950 is not set -+# CONFIG_TI_ADS8344 is not set -+# CONFIG_TI_ADS8688 is not set -+# CONFIG_TI_ADS124S08 is not set -+# CONFIG_TI_ADS131E08 is not set -+# CONFIG_TI_LMP92064 is not set -+# CONFIG_TI_TLC4541 is not set -+# CONFIG_TI_TSC2046 is not set -+# CONFIG_VF610_ADC is not set -+# CONFIG_XILINX_XADC is not set -+# end of Analog to digital converters -+ -+# -+# Analog to digital and digital to analog converters -+# -+# CONFIG_AD74115 is not set -+# CONFIG_AD74413R is not set -+# end of Analog to digital and digital to analog converters -+ -+# -+# Analog Front Ends -+# -+# CONFIG_IIO_RESCALE is not set -+# end of Analog Front Ends -+ -+# -+# Amplifiers -+# -+# CONFIG_AD8366 is not set -+# CONFIG_ADA4250 is not set -+# CONFIG_HMC425 is not set -+# end of Amplifiers -+ -+# -+# Capacitance to digital converters -+# -+# CONFIG_AD7150 is not set -+# CONFIG_AD7746 is not set -+# end of Capacitance to digital converters -+ -+# -+# Chemical Sensors -+# -+# CONFIG_ATLAS_PH_SENSOR is not set -+# CONFIG_ATLAS_EZO_SENSOR is not set -+# CONFIG_BME680 is not set -+# CONFIG_CCS811 is not set -+# CONFIG_IAQCORE is not set -+# CONFIG_PMS7003 is not set -+# CONFIG_SCD30_CORE is not set -+# CONFIG_SCD4X is not set -+# CONFIG_SENSIRION_SGP30 is not set -+# CONFIG_SENSIRION_SGP40 is not set -+# CONFIG_SPS30_I2C is not set -+# CONFIG_SPS30_SERIAL is not set -+# CONFIG_SENSEAIR_SUNRISE_CO2 is not set -+# CONFIG_VZ89X is not set -+# end of Chemical Sensors -+ -+CONFIG_IIO_CROS_EC_SENSORS_CORE=m -+CONFIG_IIO_CROS_EC_SENSORS=m -+# CONFIG_IIO_CROS_EC_SENSORS_LID_ANGLE is not set -+ -+# -+# Hid Sensor IIO Common -+# -+# end of Hid Sensor IIO Common -+ -+# -+# IIO SCMI Sensors -+# -+# CONFIG_IIO_SCMI is not set -+# end of IIO SCMI Sensors -+ -+# -+# SSP Sensor Common -+# -+# CONFIG_IIO_SSP_SENSORHUB is not set -+# end of SSP Sensor Common -+ -+CONFIG_IIO_ST_SENSORS_I2C=m -+CONFIG_IIO_ST_SENSORS_SPI=m -+CONFIG_IIO_ST_SENSORS_CORE=m -+ -+# -+# Digital to analog converters -+# -+# CONFIG_AD3552R is not set -+# CONFIG_AD5064 is not set -+# CONFIG_AD5360 is not set -+# CONFIG_AD5380 is not set -+# CONFIG_AD5421 is not set -+# CONFIG_AD5446 is not set -+# CONFIG_AD5449 is not set -+# CONFIG_AD5592R is not set -+# CONFIG_AD5593R is not set -+# CONFIG_AD5504 is not set -+# CONFIG_AD5624R_SPI is not set -+# CONFIG_LTC2688 is not set -+# CONFIG_AD5686_SPI is not set -+# CONFIG_AD5696_I2C is not set -+# CONFIG_AD5755 is not set -+# CONFIG_AD5758 is not set -+# CONFIG_AD5761 is not set -+# CONFIG_AD5764 is not set -+# CONFIG_AD5766 is not set -+# CONFIG_AD5770R is not set -+# CONFIG_AD5791 is not set -+# CONFIG_AD7293 is not set -+# CONFIG_AD7303 is not set -+# CONFIG_AD8801 is not set -+# CONFIG_DPOT_DAC is not set -+# CONFIG_DS4424 is not set -+# CONFIG_LTC1660 is not set -+# CONFIG_LTC2632 is not set -+# CONFIG_M62332 is not set -+# CONFIG_MAX517 is not set -+# CONFIG_MAX5522 is not set -+# CONFIG_MAX5821 is not set -+# CONFIG_MCP4725 is not set -+# CONFIG_MCP4728 is not set -+# CONFIG_MCP4922 is not set -+# CONFIG_TI_DAC082S085 is not set -+# CONFIG_TI_DAC5571 is not set -+# CONFIG_TI_DAC7311 is not set -+# CONFIG_TI_DAC7612 is not set -+# CONFIG_VF610_DAC is not set -+# end of Digital to analog converters -+ -+# -+# IIO dummy driver -+# -+# end of IIO dummy driver -+ -+# -+# Filters -+# -+# CONFIG_ADMV8818 is not set -+# end of Filters -+ -+# -+# Frequency Synthesizers DDS/PLL -+# -+ -+# -+# Clock Generator/Distribution -+# -+# CONFIG_AD9523 is not set -+# end of Clock Generator/Distribution -+ -+# -+# Phase-Locked Loop (PLL) frequency synthesizers -+# -+# CONFIG_ADF4350 is not set -+# CONFIG_ADF4371 is not set -+# CONFIG_ADF4377 is not set -+# CONFIG_ADMV1013 is not set -+# CONFIG_ADMV1014 is not set -+# CONFIG_ADMV4420 is not set -+# CONFIG_ADRF6780 is not set -+# end of Phase-Locked Loop (PLL) frequency synthesizers -+# end of Frequency Synthesizers DDS/PLL -+ -+# -+# Digital gyroscope sensors -+# -+# CONFIG_ADIS16080 is not set -+# CONFIG_ADIS16130 is not set -+# CONFIG_ADIS16136 is not set -+# CONFIG_ADIS16260 is not set -+# CONFIG_ADXRS290 is not set -+# CONFIG_ADXRS450 is not set -+# CONFIG_BMG160 is not set -+# CONFIG_FXAS21002C is not set -+# CONFIG_MPU3050_I2C is not set -+# CONFIG_IIO_ST_GYRO_3AXIS is not set -+# CONFIG_ITG3200 is not set -+# end of Digital gyroscope sensors -+ -+# -+# Health Sensors -+# -+ -+# -+# Heart Rate Monitors -+# -+# CONFIG_AFE4403 is not set -+# CONFIG_AFE4404 is not set -+# CONFIG_MAX30100 is not set -+# CONFIG_MAX30102 is not set -+# end of Heart Rate Monitors -+# end of Health Sensors -+ -+# -+# Humidity sensors -+# -+# CONFIG_AM2315 is not set -+# CONFIG_DHT11 is not set -+# CONFIG_HDC100X is not set -+# CONFIG_HDC2010 is not set -+# CONFIG_HTS221 is not set -+# CONFIG_HTU21 is not set -+# CONFIG_SI7005 is not set -+# CONFIG_SI7020 is not set -+# end of Humidity sensors -+ -+# -+# Inertial measurement units -+# -+# CONFIG_ADIS16400 is not set -+# CONFIG_ADIS16460 is not set -+# CONFIG_ADIS16475 is not set -+# CONFIG_ADIS16480 is not set -+# CONFIG_BMI160_I2C is not set -+# CONFIG_BMI160_SPI is not set -+# CONFIG_BOSCH_BNO055_SERIAL is not set -+# CONFIG_BOSCH_BNO055_I2C is not set -+# CONFIG_FXOS8700_I2C is not set -+# CONFIG_FXOS8700_SPI is not set -+# CONFIG_KMX61 is not set -+# CONFIG_INV_ICM42600_I2C is not set -+# CONFIG_INV_ICM42600_SPI is not set -+# CONFIG_INV_MPU6050_I2C is not set -+# CONFIG_INV_MPU6050_SPI is not set -+CONFIG_IIO_ST_LSM6DSX=m -+CONFIG_IIO_ST_LSM6DSX_I2C=m -+CONFIG_IIO_ST_LSM6DSX_SPI=m -+CONFIG_IIO_ST_LSM6DSX_I3C=m -+# CONFIG_IIO_ST_LSM9DS0 is not set -+# end of Inertial measurement units -+ -+# -+# Light sensors -+# -+# CONFIG_ACPI_ALS is not set -+# CONFIG_ADJD_S311 is not set -+# CONFIG_ADUX1020 is not set -+# CONFIG_AL3010 is not set -+# CONFIG_AL3320A is not set -+# CONFIG_APDS9300 is not set -+# CONFIG_APDS9960 is not set -+# CONFIG_AS73211 is not set -+# CONFIG_BH1750 is not set -+# CONFIG_BH1780 is not set -+# CONFIG_CM32181 is not set -+# CONFIG_CM3232 is not set -+# CONFIG_CM3323 is not set -+# CONFIG_CM3605 is not set -+# CONFIG_CM36651 is not set -+CONFIG_IIO_CROS_EC_LIGHT_PROX=m -+# CONFIG_GP2AP002 is not set -+# CONFIG_GP2AP020A00F is not set -+CONFIG_SENSORS_ISL29018=m -+# CONFIG_SENSORS_ISL29028 is not set -+# CONFIG_ISL29125 is not set -+# CONFIG_JSA1212 is not set -+# CONFIG_ROHM_BU27008 is not set -+# CONFIG_ROHM_BU27034 is not set -+# CONFIG_RPR0521 is not set -+# CONFIG_LTR501 is not set -+# CONFIG_LTRF216A is not set -+# CONFIG_LV0104CS is not set -+# CONFIG_MAX44000 is not set -+# CONFIG_MAX44009 is not set -+# CONFIG_NOA1305 is not set -+# CONFIG_OPT3001 is not set -+# CONFIG_OPT4001 is not set -+# CONFIG_PA12203001 is not set -+# CONFIG_SI1133 is not set -+# CONFIG_SI1145 is not set -+# CONFIG_STK3310 is not set -+# CONFIG_ST_UVIS25 is not set -+# CONFIG_TCS3414 is not set -+# CONFIG_TCS3472 is not set -+# CONFIG_SENSORS_TSL2563 is not set -+# CONFIG_TSL2583 is not set -+# CONFIG_TSL2591 is not set -+# CONFIG_TSL2772 is not set -+# CONFIG_TSL4531 is not set -+# CONFIG_US5182D is not set -+CONFIG_VCNL4000=m -+# CONFIG_VCNL4035 is not set -+# CONFIG_VEML6030 is not set -+# CONFIG_VEML6070 is not set -+# CONFIG_VL6180 is not set -+# CONFIG_ZOPT2201 is not set -+# end of Light sensors -+ -+# -+# Magnetometer sensors -+# -+# CONFIG_AK8974 is not set -+# CONFIG_AK8975 is not set -+# CONFIG_AK09911 is not set -+# CONFIG_BMC150_MAGN_I2C is not set -+# CONFIG_BMC150_MAGN_SPI is not set -+# CONFIG_MAG3110 is not set -+# CONFIG_MMC35240 is not set -+CONFIG_IIO_ST_MAGN_3AXIS=m -+CONFIG_IIO_ST_MAGN_I2C_3AXIS=m -+CONFIG_IIO_ST_MAGN_SPI_3AXIS=m -+# CONFIG_SENSORS_HMC5843_I2C is not set -+# CONFIG_SENSORS_HMC5843_SPI is not set -+# CONFIG_SENSORS_RM3100_I2C is not set -+# CONFIG_SENSORS_RM3100_SPI is not set -+# CONFIG_TI_TMAG5273 is not set -+# CONFIG_YAMAHA_YAS530 is not set -+# end of Magnetometer sensors -+ -+# -+# Multiplexers -+# -+# CONFIG_IIO_MUX is not set -+# end of Multiplexers -+ -+# -+# Inclinometer sensors -+# -+# end of Inclinometer sensors -+ -+# -+# Triggers - standalone -+# -+# CONFIG_IIO_INTERRUPT_TRIGGER is not set -+CONFIG_IIO_SYSFS_TRIGGER=y -+# end of Triggers - standalone -+ -+# -+# Linear and angular position sensors -+# -+# end of Linear and angular position sensors -+ -+# -+# Digital potentiometers -+# -+# CONFIG_AD5110 is not set -+# CONFIG_AD5272 is not set -+# CONFIG_DS1803 is not set -+# CONFIG_MAX5432 is not set -+# CONFIG_MAX5481 is not set -+# CONFIG_MAX5487 is not set -+# CONFIG_MCP4018 is not set -+# CONFIG_MCP4131 is not set -+# CONFIG_MCP4531 is not set -+# CONFIG_MCP41010 is not set -+# CONFIG_TPL0102 is not set -+# CONFIG_X9250 is not set -+# end of Digital potentiometers -+ -+# -+# Digital potentiostats -+# -+# CONFIG_LMP91000 is not set -+# end of Digital potentiostats -+ -+# -+# Pressure sensors -+# -+# CONFIG_ABP060MG is not set -+# CONFIG_BMP280 is not set -+CONFIG_IIO_CROS_EC_BARO=m -+# CONFIG_DLHL60D is not set -+# CONFIG_DPS310 is not set -+# CONFIG_HP03 is not set -+# CONFIG_ICP10100 is not set -+# CONFIG_MPL115_I2C is not set -+# CONFIG_MPL115_SPI is not set -+CONFIG_MPL3115=m -+# CONFIG_MPRLS0025PA is not set -+# CONFIG_MS5611 is not set -+# CONFIG_MS5637 is not set -+# CONFIG_IIO_ST_PRESS is not set -+# CONFIG_T5403 is not set -+# CONFIG_HP206C is not set -+# CONFIG_ZPA2326 is not set -+# end of Pressure sensors -+ -+# -+# Lightning sensors -+# -+# CONFIG_AS3935 is not set -+# end of Lightning sensors -+ -+# -+# Proximity and distance sensors -+# -+# CONFIG_CROS_EC_MKBP_PROXIMITY is not set -+# CONFIG_IRSD200 is not set -+# CONFIG_ISL29501 is not set -+# CONFIG_LIDAR_LITE_V2 is not set -+# CONFIG_MB1232 is not set -+# CONFIG_PING is not set -+# CONFIG_RFD77402 is not set -+# CONFIG_SRF04 is not set -+# CONFIG_SX9310 is not set -+# CONFIG_SX9324 is not set -+# CONFIG_SX9360 is not set -+# CONFIG_SX9500 is not set -+# CONFIG_SRF08 is not set -+# CONFIG_VCNL3020 is not set -+# CONFIG_VL53L0X_I2C is not set -+# end of Proximity and distance sensors -+ -+# -+# Resolver to digital converters -+# -+# CONFIG_AD2S90 is not set -+# CONFIG_AD2S1200 is not set -+# end of Resolver to digital converters -+ -+# -+# Temperature sensors -+# -+# CONFIG_LTC2983 is not set -+# CONFIG_MAXIM_THERMOCOUPLE is not set -+# CONFIG_MLX90614 is not set -+# CONFIG_MLX90632 is not set -+# CONFIG_TMP006 is not set -+# CONFIG_TMP007 is not set -+# CONFIG_TMP117 is not set -+# CONFIG_TSYS01 is not set -+# CONFIG_TSYS02D is not set -+# CONFIG_MAX30208 is not set -+# CONFIG_MAX31856 is not set -+# CONFIG_MAX31865 is not set -+# end of Temperature sensors -+ -+# CONFIG_NTB is not set -+CONFIG_PWM=y -+CONFIG_PWM_SYSFS=y -+# CONFIG_PWM_DEBUG is not set -+# CONFIG_PWM_ATMEL_TCB is not set -+# CONFIG_PWM_CLK is not set -+CONFIG_PWM_CROS_EC=m -+# CONFIG_PWM_DWC is not set -+# CONFIG_PWM_FSL_FTM is not set -+# CONFIG_PWM_PCA9685 is not set -+CONFIG_PWM_PHYTIUM=m -+# CONFIG_PWM_XILINX is not set -+ -+# -+# IRQ chip support -+# -+CONFIG_IRQCHIP=y -+CONFIG_ARM_GIC=y -+CONFIG_ARM_GIC_MAX_NR=1 -+CONFIG_ARM_GIC_V2M=y -+CONFIG_ARM_GIC_V3=y -+CONFIG_ARM_GIC_V3_ITS=y -+CONFIG_ARM_GIC_V3_ITS_PCI=y -+CONFIG_ARM_GIC_PHYTIUM_2500=y -+# CONFIG_AL_FIC is not set -+# CONFIG_XILINX_INTC is not set -+CONFIG_PARTITION_PERCPU=y -+CONFIG_PHYTIUM_IXIC=y -+# end of IRQ chip support -+ -+# CONFIG_IPACK_BUS is not set -+CONFIG_RESET_CONTROLLER=y -+CONFIG_RESET_SCMI=y -+# CONFIG_RESET_TI_SYSCON is not set -+# CONFIG_RESET_TI_TPS380X is not set -+ -+# -+# PHY Subsystem -+# -+CONFIG_GENERIC_PHY=y -+CONFIG_GENERIC_PHY_MIPI_DPHY=y -+CONFIG_PHY_CAN_TRANSCEIVER=m -+ -+# -+# PHY drivers for Broadcom platforms -+# -+# CONFIG_BCM_KONA_USB2_PHY is not set -+# end of PHY drivers for Broadcom platforms -+ -+CONFIG_PHY_CADENCE_TORRENT=m -+# CONFIG_PHY_CADENCE_DPHY is not set -+# CONFIG_PHY_CADENCE_DPHY_RX is not set -+CONFIG_PHY_CADENCE_SIERRA=m -+# CONFIG_PHY_CADENCE_SALVO is not set -+# CONFIG_PHY_PXA_28NM_HSIC is not set -+# CONFIG_PHY_PXA_28NM_USB2 is not set -+# CONFIG_PHY_LAN966X_SERDES is not set -+# CONFIG_PHY_CPCAP_USB is not set -+# CONFIG_PHY_MAPPHONE_MDM6600 is not set -+# CONFIG_PHY_OCELOT_SERDES is not set -+CONFIG_PHY_QCOM_USB_HS=m -+# CONFIG_PHY_QCOM_USB_HSIC is not set -+CONFIG_PHY_SAMSUNG_USB2=y -+# CONFIG_PHY_TUSB1210 is not set -+# end of PHY Subsystem -+ -+# CONFIG_POWERCAP is not set -+# CONFIG_MCB is not set -+ -+# -+# Performance monitor support -+# -+CONFIG_ARM_CCI_PMU=m -+CONFIG_ARM_CCI400_PMU=y -+CONFIG_ARM_CCI5xx_PMU=y -+CONFIG_ARM_CCN=m -+CONFIG_ARM_CMN=m -+CONFIG_ARM_PMU=y -+CONFIG_ARM_PMU_ACPI=y -+CONFIG_ARM_SMMU_V3_PMU=m -+CONFIG_ARM_PMUV3=y -+CONFIG_ARM_DSU_PMU=m -+CONFIG_ARM_SPE_PMU=m -+CONFIG_ARM_DMC620_PMU=m -+# CONFIG_ALIBABA_UNCORE_DRW_PMU is not set -+CONFIG_HISI_PMU=y -+# CONFIG_HISI_PCIE_PMU is not set -+# CONFIG_HNS3_PMU is not set -+CONFIG_ARM_CORESIGHT_PMU_ARCH_SYSTEM_PMU=m -+# CONFIG_PHYTIUM_PMU is not set -+# end of Performance monitor support -+ -+CONFIG_RAS=y -+# CONFIG_USB4 is not set -+ -+# -+# Android -+# -+CONFIG_ANDROID=y -+CONFIG_ANDROID_BINDER_IPC=y -+# CONFIG_ANDROID_BINDERFS is not set -+CONFIG_ANDROID_BINDER_DEVICES="binder,hwbinder,vndbinder" -+# CONFIG_ANDROID_BINDER_IPC_SELFTEST is not set -+CONFIG_BINDER_TRANSACTION_PROC_BRIEF=y -+CONFIG_BINDER_SENDER_INFO=y -+# end of Android -+ -+# CONFIG_LIBNVDIMM is not set -+# CONFIG_DAX is not set -+CONFIG_NVMEM=y -+CONFIG_NVMEM_SYSFS=y -+ -+# -+# Layout Types -+# -+CONFIG_NVMEM_LAYOUT_SL28_VPD=m -+# CONFIG_NVMEM_LAYOUT_ONIE_TLV is not set -+# end of Layout Types -+ -+CONFIG_NVMEM_RMEM=m -+CONFIG_NVMEM_SPMI_SDAM=m -+# CONFIG_NVMEM_U_BOOT_ENV is not set -+ -+# -+# HW tracing support -+# -+CONFIG_STM=m -+# CONFIG_STM_PROTO_BASIC is not set -+# CONFIG_STM_PROTO_SYS_T is not set -+# CONFIG_STM_DUMMY is not set -+# CONFIG_STM_SOURCE_CONSOLE is not set -+# CONFIG_STM_SOURCE_HEARTBEAT is not set -+# CONFIG_STM_SOURCE_FTRACE is not set -+# CONFIG_INTEL_TH is not set -+# CONFIG_HISI_PTT is not set -+# end of HW tracing support -+ -+CONFIG_FPGA=y -+# CONFIG_ALTERA_PR_IP_CORE is not set -+# CONFIG_FPGA_MGR_ALTERA_PS_SPI is not set -+CONFIG_FPGA_MGR_ALTERA_CVP=m -+# CONFIG_FPGA_MGR_XILINX_SPI is not set -+# CONFIG_FPGA_MGR_ICE40_SPI is not set -+# CONFIG_FPGA_MGR_MACHXO2_SPI is not set -+CONFIG_FPGA_BRIDGE=m -+CONFIG_ALTERA_FREEZE_BRIDGE=m -+# CONFIG_XILINX_PR_DECOUPLER is not set -+CONFIG_FPGA_REGION=m -+CONFIG_OF_FPGA_REGION=m -+# CONFIG_FPGA_DFL is not set -+# CONFIG_FPGA_MGR_MICROCHIP_SPI is not set -+# CONFIG_FPGA_MGR_LATTICE_SYSCONFIG_SPI is not set -+# CONFIG_FSI is not set -+CONFIG_TEE=y -+# CONFIG_OPTEE is not set -+CONFIG_MULTIPLEXER=y -+ -+# -+# Multiplexer drivers -+# -+# CONFIG_MUX_ADG792A is not set -+# CONFIG_MUX_ADGS1408 is not set -+CONFIG_MUX_GPIO=m -+CONFIG_MUX_MMIO=y -+# end of Multiplexer drivers -+ -+CONFIG_PM_OPP=y -+# CONFIG_SIOX is not set -+CONFIG_SLIMBUS=m -+CONFIG_SLIM_QCOM_CTRL=m -+CONFIG_INTERCONNECT=y -+CONFIG_COUNTER=m -+# CONFIG_INTERRUPT_CNT is not set -+# CONFIG_MOST is not set -+# CONFIG_PECI is not set -+CONFIG_HTE=y -+# CONFIG_CDX_BUS is not set -+CONFIG_ACCESS_TOKENID=y -+ -+# -+# Hck -+# -+CONFIG_HCK=y -+CONFIG_HCK_VENDOR_HOOKS=y -+# end of Hck -+# end of Device Drivers -+ -+# -+# File systems -+# -+CONFIG_DCACHE_WORD_ACCESS=y -+# CONFIG_VALIDATE_FS_PARSER is not set -+CONFIG_FS_IOMAP=y -+CONFIG_BUFFER_HEAD=y -+CONFIG_LEGACY_DIRECT_IO=y -+CONFIG_EXT2_FS=y -+# CONFIG_EXT2_FS_XATTR is not set -+CONFIG_EXT3_FS=y -+# CONFIG_EXT3_FS_POSIX_ACL is not set -+# CONFIG_EXT3_FS_SECURITY is not set -+CONFIG_EXT4_FS=y -+CONFIG_EXT4_FS_POSIX_ACL=y -+# CONFIG_EXT4_FS_SECURITY is not set -+# CONFIG_EXT4_DEBUG is not set -+CONFIG_HMDFS_FS=y -+CONFIG_HMDFS_FS_PERMISSION=y -+CONFIG_HMDFS_FS_ENCRYPTION=y -+# CONFIG_HMDFS_FS_DEBUG is not set -+# CONFIG_SHARE_FS is not set -+CONFIG_JBD2=y -+# CONFIG_JBD2_DEBUG is not set -+CONFIG_FS_MBCACHE=y -+# CONFIG_REISERFS_FS is not set -+# CONFIG_JFS_FS is not set -+CONFIG_XFS_FS=y -+CONFIG_XFS_SUPPORT_V4=y -+CONFIG_XFS_SUPPORT_ASCII_CI=y -+# CONFIG_XFS_QUOTA is not set -+# CONFIG_XFS_POSIX_ACL is not set -+# CONFIG_XFS_RT is not set -+# CONFIG_XFS_ONLINE_SCRUB is not set -+# CONFIG_XFS_WARN is not set -+# CONFIG_XFS_DEBUG is not set -+# CONFIG_GFS2_FS is not set -+# CONFIG_OCFS2_FS is not set -+CONFIG_BTRFS_FS=m -+CONFIG_BTRFS_FS_POSIX_ACL=y -+# CONFIG_BTRFS_FS_CHECK_INTEGRITY is not set -+# CONFIG_BTRFS_FS_RUN_SANITY_TESTS is not set -+# CONFIG_BTRFS_DEBUG is not set -+# CONFIG_BTRFS_ASSERT is not set -+# CONFIG_BTRFS_FS_REF_VERIFY is not set -+# CONFIG_NILFS2_FS is not set -+# CONFIG_F2FS_FS is not set -+CONFIG_FS_POSIX_ACL=y -+CONFIG_EXPORTFS=y -+# CONFIG_EXPORTFS_BLOCK_OPS is not set -+CONFIG_FILE_LOCKING=y -+CONFIG_FS_ENCRYPTION=y -+CONFIG_FS_ENCRYPTION_ALGS=y -+# CONFIG_FS_VERITY is not set -+CONFIG_FSNOTIFY=y -+CONFIG_DNOTIFY=y -+CONFIG_INOTIFY_USER=y -+CONFIG_FANOTIFY=y -+CONFIG_FANOTIFY_ACCESS_PERMISSIONS=y -+CONFIG_QUOTA=y -+# CONFIG_QUOTA_NETLINK_INTERFACE is not set -+# CONFIG_QUOTA_DEBUG is not set -+# CONFIG_QFMT_V1 is not set -+# CONFIG_QFMT_V2 is not set -+CONFIG_QUOTACTL=y -+CONFIG_AUTOFS_FS=y -+CONFIG_FUSE_FS=y -+CONFIG_CUSE=m -+# CONFIG_VIRTIO_FS is not set -+CONFIG_OVERLAY_FS=m -+# CONFIG_OVERLAY_FS_REDIRECT_DIR is not set -+CONFIG_OVERLAY_FS_REDIRECT_ALWAYS_FOLLOW=y -+# CONFIG_OVERLAY_FS_INDEX is not set -+# CONFIG_OVERLAY_FS_XINO_AUTO is not set -+# CONFIG_OVERLAY_FS_METACOPY is not set -+# CONFIG_OVERLAY_FS_DEBUG is not set -+ -+# -+# Caches -+# -+CONFIG_NETFS_SUPPORT=y -+# CONFIG_NETFS_STATS is not set -+# CONFIG_FSCACHE is not set -+# end of Caches -+ -+# -+# CD-ROM/DVD Filesystems -+# -+CONFIG_ISO9660_FS=y -+# CONFIG_JOLIET is not set -+# CONFIG_ZISOFS is not set -+# CONFIG_UDF_FS is not set -+# end of CD-ROM/DVD Filesystems -+ -+# -+# DOS/FAT/EXFAT/NT Filesystems -+# -+CONFIG_FAT_FS=y -+# CONFIG_MSDOS_FS is not set -+CONFIG_VFAT_FS=y -+CONFIG_FAT_DEFAULT_CODEPAGE=437 -+CONFIG_FAT_DEFAULT_IOCHARSET="iso8859-1" -+# CONFIG_FAT_DEFAULT_UTF8 is not set -+CONFIG_EXFAT_FS=y -+CONFIG_EXFAT_DEFAULT_IOCHARSET="utf8" -+CONFIG_NTFS_FS=y -+# CONFIG_NTFS_DEBUG is not set -+# CONFIG_NTFS_RW is not set -+# CONFIG_NTFS3_FS is not set -+# end of DOS/FAT/EXFAT/NT Filesystems -+ -+# -+# Pseudo filesystems -+# -+CONFIG_PROC_FS=y -+# CONFIG_PROC_KCORE is not set -+CONFIG_PROC_VMCORE=y -+# CONFIG_PROC_VMCORE_DEVICE_DUMP is not set -+CONFIG_PROC_SYSCTL=y -+CONFIG_PROC_PAGE_MONITOR=y -+# CONFIG_PROC_CHILDREN is not set -+CONFIG_KERNFS=y -+CONFIG_SYSFS=y -+CONFIG_TMPFS=y -+CONFIG_TMPFS_POSIX_ACL=y -+CONFIG_TMPFS_XATTR=y -+# CONFIG_TMPFS_INODE64 is not set -+# CONFIG_TMPFS_QUOTA is not set -+CONFIG_ARCH_SUPPORTS_HUGETLBFS=y -+CONFIG_HUGETLBFS=y -+CONFIG_HUGETLB_PAGE=y -+CONFIG_ARCH_HAS_GIGANTIC_PAGE=y -+CONFIG_CONFIGFS_FS=y -+CONFIG_EFIVAR_FS=y -+# end of Pseudo filesystems -+ -+CONFIG_MISC_FILESYSTEMS=y -+# CONFIG_ORANGEFS_FS is not set -+# CONFIG_ADFS_FS is not set -+# CONFIG_AFFS_FS is not set -+# CONFIG_ECRYPT_FS is not set -+# CONFIG_HFS_FS is not set -+# CONFIG_HFSPLUS_FS is not set -+# CONFIG_BEFS_FS is not set -+# CONFIG_BFS_FS is not set -+# CONFIG_EFS_FS is not set -+# CONFIG_JFFS2_FS is not set -+CONFIG_UBIFS_FS=m -+# CONFIG_UBIFS_FS_ADVANCED_COMPR is not set -+CONFIG_UBIFS_FS_LZO=y -+CONFIG_UBIFS_FS_ZLIB=y -+CONFIG_UBIFS_FS_ZSTD=y -+# CONFIG_UBIFS_ATIME_SUPPORT is not set -+CONFIG_UBIFS_FS_XATTR=y -+CONFIG_UBIFS_FS_SECURITY=y -+# CONFIG_UBIFS_FS_AUTHENTICATION is not set -+# CONFIG_CRAMFS is not set -+CONFIG_SQUASHFS=y -+CONFIG_SQUASHFS_FILE_CACHE=y -+# CONFIG_SQUASHFS_FILE_DIRECT is not set -+CONFIG_SQUASHFS_DECOMP_SINGLE=y -+# CONFIG_SQUASHFS_CHOICE_DECOMP_BY_MOUNT is not set -+CONFIG_SQUASHFS_COMPILE_DECOMP_SINGLE=y -+# CONFIG_SQUASHFS_COMPILE_DECOMP_MULTI is not set -+# CONFIG_SQUASHFS_COMPILE_DECOMP_MULTI_PERCPU is not set -+# CONFIG_SQUASHFS_XATTR is not set -+CONFIG_SQUASHFS_ZLIB=y -+# CONFIG_SQUASHFS_LZ4 is not set -+CONFIG_SQUASHFS_LZO=y -+CONFIG_SQUASHFS_XZ=y -+# CONFIG_SQUASHFS_ZSTD is not set -+# CONFIG_SQUASHFS_4K_DEVBLK_SIZE is not set -+# CONFIG_SQUASHFS_EMBEDDED is not set -+CONFIG_SQUASHFS_FRAGMENT_CACHE_SIZE=3 -+# CONFIG_VXFS_FS is not set -+# CONFIG_MINIX_FS is not set -+# CONFIG_OMFS_FS is not set -+# CONFIG_HPFS_FS is not set -+# CONFIG_QNX4FS_FS is not set -+# CONFIG_QNX6FS_FS is not set -+# CONFIG_ROMFS_FS is not set -+CONFIG_PSTORE=y -+CONFIG_PSTORE_DEFAULT_KMSG_BYTES=10240 -+CONFIG_PSTORE_COMPRESS=y -+CONFIG_PSTORE_CONSOLE=y -+# CONFIG_PSTORE_PMSG is not set -+# CONFIG_PSTORE_FTRACE is not set -+# CONFIG_PSTORE_RAM is not set -+# CONFIG_PSTORE_BLK is not set -+# CONFIG_SYSV_FS is not set -+# CONFIG_UFS_FS is not set -+# CONFIG_EROFS_FS is not set -+CONFIG_NETWORK_FILESYSTEMS=y -+CONFIG_NFS_FS=y -+CONFIG_NFS_V2=y -+CONFIG_NFS_V3=y -+CONFIG_NFS_V3_ACL=y -+CONFIG_NFS_V4=y -+# CONFIG_NFS_SWAP is not set -+CONFIG_NFS_V4_1=y -+CONFIG_NFS_V4_2=y -+CONFIG_PNFS_FILE_LAYOUT=y -+CONFIG_PNFS_BLOCK=m -+CONFIG_PNFS_FLEXFILE_LAYOUT=y -+CONFIG_NFS_V4_1_IMPLEMENTATION_ID_DOMAIN="kernel.org" -+# CONFIG_NFS_V4_1_MIGRATION is not set -+CONFIG_NFS_V4_SECURITY_LABEL=y -+CONFIG_ROOT_NFS=y -+# CONFIG_NFS_USE_LEGACY_DNS is not set -+CONFIG_NFS_USE_KERNEL_DNS=y -+CONFIG_NFS_DISABLE_UDP_SUPPORT=y -+CONFIG_NFS_V4_2_READ_PLUS=y -+CONFIG_NFSD=y -+CONFIG_NFSD_V2=y -+CONFIG_NFSD_V2_ACL=y -+CONFIG_NFSD_V3_ACL=y -+CONFIG_NFSD_V4=y -+# CONFIG_NFSD_BLOCKLAYOUT is not set -+# CONFIG_NFSD_SCSILAYOUT is not set -+# CONFIG_NFSD_FLEXFILELAYOUT is not set -+# CONFIG_NFSD_V4_2_INTER_SSC is not set -+# CONFIG_NFSD_V4_SECURITY_LABEL is not set -+CONFIG_GRACE_PERIOD=y -+CONFIG_LOCKD=y -+CONFIG_LOCKD_V4=y -+CONFIG_NFS_ACL_SUPPORT=y -+CONFIG_NFS_COMMON=y -+CONFIG_NFS_V4_2_SSC_HELPER=y -+CONFIG_SUNRPC=y -+CONFIG_SUNRPC_GSS=y -+CONFIG_SUNRPC_BACKCHANNEL=y -+CONFIG_RPCSEC_GSS_KRB5=y -+CONFIG_RPCSEC_GSS_KRB5_ENCTYPES_AES_SHA1=y -+# CONFIG_RPCSEC_GSS_KRB5_ENCTYPES_AES_SHA2 is not set -+# CONFIG_SUNRPC_DEBUG is not set -+# CONFIG_CEPH_FS is not set -+# CONFIG_CIFS is not set -+# CONFIG_SMB_SERVER is not set -+# CONFIG_CODA_FS is not set -+# CONFIG_AFS_FS is not set -+CONFIG_9P_FS=y -+# CONFIG_9P_FS_POSIX_ACL is not set -+# CONFIG_9P_FS_SECURITY is not set -+CONFIG_NLS=y -+CONFIG_NLS_DEFAULT="iso8859-1" -+CONFIG_NLS_CODEPAGE_437=y -+# CONFIG_NLS_CODEPAGE_737 is not set -+# CONFIG_NLS_CODEPAGE_775 is not set -+# CONFIG_NLS_CODEPAGE_850 is not set -+# CONFIG_NLS_CODEPAGE_852 is not set -+# CONFIG_NLS_CODEPAGE_855 is not set -+# CONFIG_NLS_CODEPAGE_857 is not set -+# CONFIG_NLS_CODEPAGE_860 is not set -+# CONFIG_NLS_CODEPAGE_861 is not set -+# CONFIG_NLS_CODEPAGE_862 is not set -+# CONFIG_NLS_CODEPAGE_863 is not set -+# CONFIG_NLS_CODEPAGE_864 is not set -+# CONFIG_NLS_CODEPAGE_865 is not set -+# CONFIG_NLS_CODEPAGE_866 is not set -+# CONFIG_NLS_CODEPAGE_869 is not set -+CONFIG_NLS_CODEPAGE_936=y -+# CONFIG_NLS_CODEPAGE_950 is not set -+# CONFIG_NLS_CODEPAGE_932 is not set -+# CONFIG_NLS_CODEPAGE_949 is not set -+# CONFIG_NLS_CODEPAGE_874 is not set -+# CONFIG_NLS_ISO8859_8 is not set -+# CONFIG_NLS_CODEPAGE_1250 is not set -+# CONFIG_NLS_CODEPAGE_1251 is not set -+CONFIG_NLS_ASCII=y -+CONFIG_NLS_ISO8859_1=y -+# CONFIG_NLS_ISO8859_2 is not set -+# CONFIG_NLS_ISO8859_3 is not set -+# CONFIG_NLS_ISO8859_4 is not set -+# CONFIG_NLS_ISO8859_5 is not set -+# CONFIG_NLS_ISO8859_6 is not set -+# CONFIG_NLS_ISO8859_7 is not set -+# CONFIG_NLS_ISO8859_9 is not set -+# CONFIG_NLS_ISO8859_13 is not set -+# CONFIG_NLS_ISO8859_14 is not set -+# CONFIG_NLS_ISO8859_15 is not set -+# CONFIG_NLS_KOI8_R is not set -+# CONFIG_NLS_KOI8_U is not set -+# CONFIG_NLS_MAC_ROMAN is not set -+# CONFIG_NLS_MAC_CELTIC is not set -+# CONFIG_NLS_MAC_CENTEURO is not set -+# CONFIG_NLS_MAC_CROATIAN is not set -+# CONFIG_NLS_MAC_CYRILLIC is not set -+# CONFIG_NLS_MAC_GAELIC is not set -+# CONFIG_NLS_MAC_GREEK is not set -+# CONFIG_NLS_MAC_ICELAND is not set -+# CONFIG_NLS_MAC_INUIT is not set -+# CONFIG_NLS_MAC_ROMANIAN is not set -+# CONFIG_NLS_MAC_TURKISH is not set -+CONFIG_NLS_UTF8=y -+# CONFIG_DLM is not set -+# CONFIG_UNICODE is not set -+# CONFIG_EPFS is not set -+CONFIG_IO_WQ=y -+# end of File systems -+ -+# -+# Security options -+# -+CONFIG_KEYS=y -+# CONFIG_KEYS_REQUEST_CACHE is not set -+# CONFIG_PERSISTENT_KEYRINGS is not set -+# CONFIG_TRUSTED_KEYS is not set -+# CONFIG_ENCRYPTED_KEYS is not set -+# CONFIG_KEY_DH_OPERATIONS is not set -+CONFIG_SECURITY_DMESG_RESTRICT=y -+CONFIG_SECURITY=y -+CONFIG_SECURITYFS=y -+CONFIG_SECURITY_NETWORK=y -+CONFIG_SECURITY_PATH=y -+CONFIG_HARDENED_USERCOPY=y -+# CONFIG_FORTIFY_SOURCE is not set -+# CONFIG_STATIC_USERMODEHELPER is not set -+# CONFIG_SECURITY_SELINUX is not set -+# CONFIG_SECURITY_SMACK is not set -+# CONFIG_SECURITY_TOMOYO is not set -+CONFIG_SECURITY_APPARMOR=y -+# CONFIG_SECURITY_APPARMOR_DEBUG is not set -+CONFIG_SECURITY_APPARMOR_INTROSPECT_POLICY=y -+CONFIG_SECURITY_APPARMOR_HASH=y -+CONFIG_SECURITY_APPARMOR_HASH_DEFAULT=y -+CONFIG_SECURITY_APPARMOR_EXPORT_BINARY=y -+CONFIG_SECURITY_APPARMOR_PARANOID_LOAD=y -+# CONFIG_SECURITY_LOADPIN is not set -+# CONFIG_SECURITY_YAMA is not set -+# CONFIG_SECURITY_SAFESETID is not set -+# CONFIG_SECURITY_LOCKDOWN_LSM is not set -+# CONFIG_SECURITY_LANDLOCK is not set -+CONFIG_INTEGRITY=y -+# CONFIG_INTEGRITY_SIGNATURE is not set -+CONFIG_INTEGRITY_AUDIT=y -+# CONFIG_IMA is not set -+# CONFIG_IMA_SECURE_AND_OR_TRUSTED_BOOT is not set -+# CONFIG_EVM is not set -+# CONFIG_DEFAULT_SECURITY_APPARMOR is not set -+CONFIG_DEFAULT_SECURITY_DAC=y -+CONFIG_LSM="landlock,lockdown,yama,loadpin,safesetid,bpf" -+ -+# -+# Kernel hardening options -+# -+ -+# -+# Memory initialization -+# -+CONFIG_CC_HAS_AUTO_VAR_INIT_PATTERN=y -+CONFIG_CC_HAS_AUTO_VAR_INIT_ZERO_ENABLER=y -+CONFIG_CC_HAS_AUTO_VAR_INIT_ZERO=y -+# CONFIG_INIT_STACK_NONE is not set -+# CONFIG_INIT_STACK_ALL_PATTERN is not set -+CONFIG_INIT_STACK_ALL_ZERO=y -+CONFIG_INIT_ON_ALLOC_DEFAULT_ON=y -+# CONFIG_INIT_ON_FREE_DEFAULT_ON is not set -+# end of Memory initialization -+ -+# -+# Hardening of kernel data structures -+# -+# CONFIG_LIST_HARDENED is not set -+# CONFIG_BUG_ON_DATA_CORRUPTION is not set -+# end of Hardening of kernel data structures -+ -+CONFIG_RANDSTRUCT_NONE=y -+# end of Kernel hardening options -+# end of Security options -+ -+CONFIG_XOR_BLOCKS=m -+CONFIG_ASYNC_TX_DISABLE_PQ_VAL_DMA=y -+CONFIG_ASYNC_TX_DISABLE_XOR_VAL_DMA=y -+CONFIG_CRYPTO=y -+ -+# -+# Crypto core or helper -+# -+CONFIG_CRYPTO_ALGAPI=y -+CONFIG_CRYPTO_ALGAPI2=y -+CONFIG_CRYPTO_AEAD=y -+CONFIG_CRYPTO_AEAD2=y -+CONFIG_CRYPTO_SIG2=y -+CONFIG_CRYPTO_SKCIPHER=y -+CONFIG_CRYPTO_SKCIPHER2=y -+CONFIG_CRYPTO_HASH=y -+CONFIG_CRYPTO_HASH2=y -+CONFIG_CRYPTO_RNG=y -+CONFIG_CRYPTO_RNG2=y -+CONFIG_CRYPTO_RNG_DEFAULT=y -+CONFIG_CRYPTO_AKCIPHER2=y -+CONFIG_CRYPTO_AKCIPHER=y -+CONFIG_CRYPTO_KPP2=y -+CONFIG_CRYPTO_KPP=y -+CONFIG_CRYPTO_ACOMP2=y -+CONFIG_CRYPTO_MANAGER=y -+CONFIG_CRYPTO_MANAGER2=y -+CONFIG_CRYPTO_USER=y -+CONFIG_CRYPTO_MANAGER_DISABLE_TESTS=y -+CONFIG_CRYPTO_NULL=y -+CONFIG_CRYPTO_NULL2=y -+# CONFIG_CRYPTO_PCRYPT is not set -+CONFIG_CRYPTO_CRYPTD=y -+CONFIG_CRYPTO_AUTHENC=m -+CONFIG_CRYPTO_TEST=m -+CONFIG_CRYPTO_ENGINE=m -+# end of Crypto core or helper -+ -+# -+# Public-key cryptography -+# -+CONFIG_CRYPTO_RSA=y -+CONFIG_CRYPTO_DH=m -+# CONFIG_CRYPTO_DH_RFC7919_GROUPS is not set -+CONFIG_CRYPTO_ECC=y -+CONFIG_CRYPTO_ECDH=y -+# CONFIG_CRYPTO_ECDSA is not set -+# CONFIG_CRYPTO_ECRDSA is not set -+# CONFIG_CRYPTO_SM2 is not set -+CONFIG_CRYPTO_CURVE25519=m -+# end of Public-key cryptography -+ -+# -+# Block ciphers -+# -+CONFIG_CRYPTO_AES=y -+# CONFIG_CRYPTO_AES_TI is not set -+# CONFIG_CRYPTO_ANUBIS is not set -+# CONFIG_CRYPTO_ARIA is not set -+# CONFIG_CRYPTO_BLOWFISH is not set -+# CONFIG_CRYPTO_CAMELLIA is not set -+# CONFIG_CRYPTO_CAST5 is not set -+# CONFIG_CRYPTO_CAST6 is not set -+CONFIG_CRYPTO_DES=m -+# CONFIG_CRYPTO_FCRYPT is not set -+# CONFIG_CRYPTO_KHAZAD is not set -+# CONFIG_CRYPTO_SEED is not set -+# CONFIG_CRYPTO_SERPENT is not set -+CONFIG_CRYPTO_SM4=m -+CONFIG_CRYPTO_SM4_GENERIC=m -+# CONFIG_CRYPTO_TEA is not set -+CONFIG_CRYPTO_TWOFISH=y -+CONFIG_CRYPTO_TWOFISH_COMMON=y -+# end of Block ciphers -+ -+# -+# Length-preserving ciphers and modes -+# -+# CONFIG_CRYPTO_ADIANTUM is not set -+# CONFIG_CRYPTO_ARC4 is not set -+# CONFIG_CRYPTO_CHACHA20 is not set -+CONFIG_CRYPTO_CBC=y -+# CONFIG_CRYPTO_CFB is not set -+CONFIG_CRYPTO_CTR=y -+CONFIG_CRYPTO_CTS=y -+CONFIG_CRYPTO_ECB=y -+# CONFIG_CRYPTO_HCTR2 is not set -+# CONFIG_CRYPTO_KEYWRAP is not set -+# CONFIG_CRYPTO_LRW is not set -+# CONFIG_CRYPTO_OFB is not set -+# CONFIG_CRYPTO_PCBC is not set -+CONFIG_CRYPTO_XTS=y -+# end of Length-preserving ciphers and modes -+ -+# -+# AEAD (authenticated encryption with associated data) ciphers -+# -+# CONFIG_CRYPTO_AEGIS128 is not set -+# CONFIG_CRYPTO_CHACHA20POLY1305 is not set -+CONFIG_CRYPTO_CCM=y -+CONFIG_CRYPTO_GCM=y -+CONFIG_CRYPTO_GENIV=y -+# CONFIG_CRYPTO_SEQIV is not set -+CONFIG_CRYPTO_ECHAINIV=y -+# CONFIG_CRYPTO_ESSIV is not set -+# end of AEAD (authenticated encryption with associated data) ciphers -+ -+# -+# Hashes, digests, and MACs -+# -+CONFIG_CRYPTO_BLAKE2B=m -+CONFIG_CRYPTO_CMAC=y -+CONFIG_CRYPTO_GHASH=y -+CONFIG_CRYPTO_HMAC=y -+# CONFIG_CRYPTO_MD4 is not set -+CONFIG_CRYPTO_MD5=y -+CONFIG_CRYPTO_MICHAEL_MIC=m -+# CONFIG_CRYPTO_POLY1305 is not set -+# CONFIG_CRYPTO_RMD160 is not set -+CONFIG_CRYPTO_SHA1=y -+CONFIG_CRYPTO_SHA256=y -+CONFIG_CRYPTO_SHA512=y -+CONFIG_CRYPTO_SHA3=y -+CONFIG_CRYPTO_SM3=m -+CONFIG_CRYPTO_SM3_GENERIC=m -+# CONFIG_CRYPTO_STREEBOG is not set -+# CONFIG_CRYPTO_VMAC is not set -+# CONFIG_CRYPTO_WP512 is not set -+# CONFIG_CRYPTO_XCBC is not set -+CONFIG_CRYPTO_XXHASH=m -+# end of Hashes, digests, and MACs -+ -+# -+# CRCs (cyclic redundancy checks) -+# -+CONFIG_CRYPTO_CRC32C=y -+CONFIG_CRYPTO_CRC32=y -+CONFIG_CRYPTO_CRCT10DIF=y -+CONFIG_CRYPTO_CRC64_ROCKSOFT=y -+# end of CRCs (cyclic redundancy checks) -+ -+# -+# Compression -+# -+CONFIG_CRYPTO_DEFLATE=y -+CONFIG_CRYPTO_LZO=y -+CONFIG_CRYPTO_842=m -+CONFIG_CRYPTO_LZ4=m -+CONFIG_CRYPTO_LZ4HC=m -+CONFIG_CRYPTO_ZSTD=y -+# end of Compression -+ -+# -+# Random number generation -+# -+CONFIG_CRYPTO_ANSI_CPRNG=y -+CONFIG_CRYPTO_DRBG_MENU=y -+CONFIG_CRYPTO_DRBG_HMAC=y -+# CONFIG_CRYPTO_DRBG_HASH is not set -+# CONFIG_CRYPTO_DRBG_CTR is not set -+CONFIG_CRYPTO_DRBG=y -+CONFIG_CRYPTO_JITTERENTROPY=y -+# CONFIG_CRYPTO_JITTERENTROPY_TESTINTERFACE is not set -+# end of Random number generation -+ -+# -+# Userspace interface -+# -+CONFIG_CRYPTO_USER_API=y -+CONFIG_CRYPTO_USER_API_HASH=y -+CONFIG_CRYPTO_USER_API_SKCIPHER=y -+CONFIG_CRYPTO_USER_API_RNG=m -+# CONFIG_CRYPTO_USER_API_RNG_CAVP is not set -+# CONFIG_CRYPTO_USER_API_AEAD is not set -+CONFIG_CRYPTO_USER_API_ENABLE_OBSOLETE=y -+# CONFIG_CRYPTO_STATS is not set -+# end of Userspace interface -+ -+CONFIG_CRYPTO_HASH_INFO=y -+# CONFIG_CRYPTO_NHPOLY1305_NEON is not set -+CONFIG_CRYPTO_CHACHA20_NEON=m -+ -+# -+# Accelerated Cryptographic Algorithms for CPU (arm64) -+# -+CONFIG_CRYPTO_GHASH_ARM64_CE=y -+# CONFIG_CRYPTO_POLY1305_NEON is not set -+CONFIG_CRYPTO_SHA1_ARM64_CE=y -+CONFIG_CRYPTO_SHA256_ARM64=y -+CONFIG_CRYPTO_SHA2_ARM64_CE=y -+CONFIG_CRYPTO_SHA512_ARM64=m -+CONFIG_CRYPTO_SHA512_ARM64_CE=m -+CONFIG_CRYPTO_SHA3_ARM64=m -+# CONFIG_CRYPTO_SM3_NEON is not set -+CONFIG_CRYPTO_SM3_ARM64_CE=m -+# CONFIG_CRYPTO_POLYVAL_ARM64_CE is not set -+# CONFIG_CRYPTO_AES_ARM64 is not set -+CONFIG_CRYPTO_AES_ARM64_CE=y -+CONFIG_CRYPTO_AES_ARM64_CE_BLK=y -+CONFIG_CRYPTO_AES_ARM64_NEON_BLK=m -+CONFIG_CRYPTO_AES_ARM64_BS=m -+# CONFIG_CRYPTO_SM4_ARM64_CE is not set -+# CONFIG_CRYPTO_SM4_ARM64_CE_BLK is not set -+# CONFIG_CRYPTO_SM4_ARM64_NEON_BLK is not set -+CONFIG_CRYPTO_AES_ARM64_CE_CCM=y -+# CONFIG_CRYPTO_SM4_ARM64_CE_CCM is not set -+# CONFIG_CRYPTO_SM4_ARM64_CE_GCM is not set -+CONFIG_CRYPTO_CRCT10DIF_ARM64_CE=m -+# end of Accelerated Cryptographic Algorithms for CPU (arm64) -+ -+CONFIG_CRYPTO_HW=y -+# CONFIG_CRYPTO_DEV_ATMEL_ECC is not set -+# CONFIG_CRYPTO_DEV_ATMEL_SHA204A is not set -+# CONFIG_CRYPTO_DEV_CCP is not set -+# CONFIG_CRYPTO_DEV_NITROX_CNN55XX is not set -+# CONFIG_CRYPTO_DEV_QAT_DH895xCC is not set -+# CONFIG_CRYPTO_DEV_QAT_C3XXX is not set -+# CONFIG_CRYPTO_DEV_QAT_C62X is not set -+# CONFIG_CRYPTO_DEV_QAT_4XXX is not set -+# CONFIG_CRYPTO_DEV_QAT_DH895xCCVF is not set -+# CONFIG_CRYPTO_DEV_QAT_C3XXXVF is not set -+# CONFIG_CRYPTO_DEV_QAT_C62XVF is not set -+# CONFIG_CRYPTO_DEV_CAVIUM_ZIP is not set -+# CONFIG_CRYPTO_DEV_VIRTIO is not set -+# CONFIG_CRYPTO_DEV_SAFEXCEL is not set -+CONFIG_CRYPTO_DEV_CCREE=m -+# CONFIG_CRYPTO_DEV_HISI_SEC is not set -+CONFIG_CRYPTO_DEV_HISI_SEC2=m -+CONFIG_CRYPTO_DEV_HISI_QM=m -+CONFIG_CRYPTO_DEV_HISI_ZIP=m -+CONFIG_CRYPTO_DEV_HISI_HPRE=m -+CONFIG_CRYPTO_DEV_HISI_TRNG=m -+CONFIG_CRYPTO_DEV_AMLOGIC_GXL=m -+# CONFIG_CRYPTO_DEV_AMLOGIC_GXL_DEBUG is not set -+CONFIG_ASYMMETRIC_KEY_TYPE=y -+CONFIG_ASYMMETRIC_PUBLIC_KEY_SUBTYPE=y -+CONFIG_X509_CERTIFICATE_PARSER=y -+# CONFIG_PKCS8_PRIVATE_KEY_PARSER is not set -+CONFIG_PKCS7_MESSAGE_PARSER=y -+# CONFIG_PKCS7_TEST_KEY is not set -+# CONFIG_SIGNED_PE_FILE_VERIFICATION is not set -+# CONFIG_FIPS_SIGNATURE_SELFTEST is not set -+ -+# -+# Certificates for signature checking -+# -+CONFIG_MODULE_SIG_KEY="certs/signing_key.pem" -+CONFIG_MODULE_SIG_KEY_TYPE_RSA=y -+# CONFIG_MODULE_SIG_KEY_TYPE_ECDSA is not set -+CONFIG_SYSTEM_TRUSTED_KEYRING=y -+CONFIG_SYSTEM_TRUSTED_KEYS="" -+# CONFIG_SYSTEM_EXTRA_CERTIFICATE is not set -+# CONFIG_SECONDARY_TRUSTED_KEYRING is not set -+# CONFIG_SYSTEM_BLACKLIST_KEYRING is not set -+# end of Certificates for signature checking -+ -+CONFIG_BINARY_PRINTF=y -+ -+# -+# Library routines -+# -+CONFIG_RAID6_PQ=m -+CONFIG_RAID6_PQ_BENCHMARK=y -+CONFIG_LINEAR_RANGES=y -+CONFIG_PACKING=y -+CONFIG_BITREVERSE=y -+CONFIG_HAVE_ARCH_BITREVERSE=y -+CONFIG_GENERIC_STRNCPY_FROM_USER=y -+CONFIG_GENERIC_STRNLEN_USER=y -+CONFIG_GENERIC_NET_UTILS=y -+# CONFIG_CORDIC is not set -+# CONFIG_PRIME_NUMBERS is not set -+CONFIG_RATIONAL=y -+CONFIG_GENERIC_PCI_IOMAP=y -+CONFIG_ARCH_USE_CMPXCHG_LOCKREF=y -+CONFIG_ARCH_HAS_FAST_MULTIPLIER=y -+CONFIG_ARCH_USE_SYM_ANNOTATIONS=y -+CONFIG_INDIRECT_PIO=y -+# CONFIG_TRACE_MMIO_ACCESS is not set -+ -+# -+# Crypto library routines -+# -+CONFIG_CRYPTO_LIB_UTILS=y -+CONFIG_CRYPTO_LIB_AES=y -+CONFIG_CRYPTO_LIB_ARC4=y -+CONFIG_CRYPTO_LIB_GF128MUL=y -+CONFIG_CRYPTO_LIB_BLAKE2S_GENERIC=y -+CONFIG_CRYPTO_ARCH_HAVE_LIB_CHACHA=m -+CONFIG_CRYPTO_LIB_CHACHA_GENERIC=m -+# CONFIG_CRYPTO_LIB_CHACHA is not set -+CONFIG_CRYPTO_LIB_CURVE25519_GENERIC=m -+# CONFIG_CRYPTO_LIB_CURVE25519 is not set -+CONFIG_CRYPTO_LIB_DES=m -+CONFIG_CRYPTO_LIB_POLY1305_RSIZE=9 -+# CONFIG_CRYPTO_LIB_POLY1305 is not set -+# CONFIG_CRYPTO_LIB_CHACHA20POLY1305 is not set -+CONFIG_CRYPTO_LIB_SHA1=y -+CONFIG_CRYPTO_LIB_SHA256=y -+# end of Crypto library routines -+ -+CONFIG_CRC_CCITT=y -+CONFIG_CRC16=y -+CONFIG_CRC_T10DIF=y -+CONFIG_CRC64_ROCKSOFT=y -+CONFIG_CRC_ITU_T=y -+CONFIG_CRC32=y -+# CONFIG_CRC32_SELFTEST is not set -+CONFIG_CRC32_SLICEBY8=y -+# CONFIG_CRC32_SLICEBY4 is not set -+# CONFIG_CRC32_SARWATE is not set -+# CONFIG_CRC32_BIT is not set -+CONFIG_CRC64=y -+# CONFIG_CRC4 is not set -+CONFIG_CRC7=y -+CONFIG_LIBCRC32C=y -+CONFIG_CRC8=y -+CONFIG_XXHASH=y -+CONFIG_AUDIT_GENERIC=y -+CONFIG_AUDIT_ARCH_COMPAT_GENERIC=y -+CONFIG_AUDIT_COMPAT_GENERIC=y -+# CONFIG_RANDOM32_SELFTEST is not set -+CONFIG_842_COMPRESS=m -+CONFIG_842_DECOMPRESS=m -+CONFIG_ZLIB_INFLATE=y -+CONFIG_ZLIB_DEFLATE=y -+CONFIG_LZO_COMPRESS=y -+CONFIG_LZO_DECOMPRESS=y -+CONFIG_LZ4_COMPRESS=m -+CONFIG_LZ4HC_COMPRESS=m -+CONFIG_LZ4_DECOMPRESS=y -+CONFIG_ZSTD_COMMON=y -+CONFIG_ZSTD_COMPRESS=y -+CONFIG_ZSTD_DECOMPRESS=y -+CONFIG_XZ_DEC=y -+CONFIG_XZ_DEC_X86=y -+CONFIG_XZ_DEC_POWERPC=y -+CONFIG_XZ_DEC_IA64=y -+CONFIG_XZ_DEC_ARM=y -+CONFIG_XZ_DEC_ARMTHUMB=y -+CONFIG_XZ_DEC_SPARC=y -+# CONFIG_XZ_DEC_MICROLZMA is not set -+CONFIG_XZ_DEC_BCJ=y -+# CONFIG_XZ_DEC_TEST is not set -+CONFIG_DECOMPRESS_GZIP=y -+CONFIG_DECOMPRESS_BZIP2=y -+CONFIG_DECOMPRESS_LZMA=y -+CONFIG_DECOMPRESS_XZ=y -+CONFIG_DECOMPRESS_LZO=y -+CONFIG_DECOMPRESS_LZ4=y -+CONFIG_DECOMPRESS_ZSTD=y -+CONFIG_GENERIC_ALLOCATOR=y -+CONFIG_INTERVAL_TREE=y -+CONFIG_XARRAY_MULTI=y -+CONFIG_ASSOCIATIVE_ARRAY=y -+CONFIG_HAS_IOMEM=y -+CONFIG_HAS_IOPORT=y -+CONFIG_HAS_IOPORT_MAP=y -+CONFIG_HAS_DMA=y -+CONFIG_DMA_OPS=y -+CONFIG_NEED_SG_DMA_FLAGS=y -+CONFIG_NEED_SG_DMA_LENGTH=y -+CONFIG_NEED_DMA_MAP_STATE=y -+CONFIG_ARCH_DMA_ADDR_T_64BIT=y -+CONFIG_DMA_DECLARE_COHERENT=y -+CONFIG_ARCH_HAS_SETUP_DMA_OPS=y -+CONFIG_ARCH_HAS_TEARDOWN_DMA_OPS=y -+CONFIG_ARCH_HAS_SYNC_DMA_FOR_DEVICE=y -+CONFIG_ARCH_HAS_SYNC_DMA_FOR_CPU=y -+CONFIG_ARCH_HAS_DMA_PREP_COHERENT=y -+CONFIG_SWIOTLB=y -+# CONFIG_SWIOTLB_DYNAMIC is not set -+CONFIG_DMA_BOUNCE_UNALIGNED_KMALLOC=y -+CONFIG_DMA_RESTRICTED_POOL=y -+CONFIG_DMA_NONCOHERENT_MMAP=y -+CONFIG_DMA_COHERENT_POOL=y -+CONFIG_DMA_DIRECT_REMAP=y -+CONFIG_DMA_CMA=y -+# CONFIG_DMA_NUMA_CMA is not set -+ -+# -+# Default contiguous memory area size: -+# -+CONFIG_CMA_SIZE_MBYTES=16 -+CONFIG_CMA_SIZE_SEL_MBYTES=y -+# CONFIG_CMA_SIZE_SEL_PERCENTAGE is not set -+# CONFIG_CMA_SIZE_SEL_MIN is not set -+# CONFIG_CMA_SIZE_SEL_MAX is not set -+CONFIG_CMA_ALIGNMENT=8 -+# CONFIG_DMA_API_DEBUG is not set -+# CONFIG_DMA_MAP_BENCHMARK is not set -+CONFIG_SGL_ALLOC=y -+CONFIG_CPU_RMAP=y -+CONFIG_DQL=y -+CONFIG_GLOB=y -+# CONFIG_GLOB_SELFTEST is not set -+CONFIG_NLATTR=y -+CONFIG_CLZ_TAB=y -+CONFIG_IRQ_POLL=y -+CONFIG_MPILIB=y -+CONFIG_DIMLIB=y -+CONFIG_LIBFDT=y -+CONFIG_OID_REGISTRY=y -+CONFIG_UCS2_STRING=y -+CONFIG_HAVE_GENERIC_VDSO=y -+CONFIG_GENERIC_GETTIMEOFDAY=y -+CONFIG_GENERIC_COMPAT_VDSO=y -+CONFIG_GENERIC_VDSO_TIME_NS=y -+CONFIG_FONT_SUPPORT=y -+# CONFIG_FONTS is not set -+CONFIG_FONT_8x8=y -+CONFIG_FONT_8x16=y -+CONFIG_SG_POOL=y -+CONFIG_MEMREGION=y -+CONFIG_ARCH_STACKWALK=y -+CONFIG_STACKDEPOT=y -+CONFIG_SBITMAP=y -+# end of Library routines -+ -+CONFIG_GENERIC_IOREMAP=y -+CONFIG_GENERIC_LIB_DEVMEM_IS_ALLOWED=y -+ -+# -+# Kernel hacking -+# -+ -+# -+# printk and dmesg options -+# -+CONFIG_PRINTK_TIME=y -+# CONFIG_PRINTK_CALLER is not set -+# CONFIG_STACKTRACE_BUILD_ID is not set -+CONFIG_CONSOLE_LOGLEVEL_DEFAULT=7 -+CONFIG_CONSOLE_LOGLEVEL_QUIET=4 -+CONFIG_MESSAGE_LOGLEVEL_DEFAULT=4 -+# CONFIG_BOOT_PRINTK_DELAY is not set -+# CONFIG_DYNAMIC_DEBUG is not set -+# CONFIG_DYNAMIC_DEBUG_CORE is not set -+CONFIG_SYMBOLIC_ERRNAME=y -+CONFIG_DEBUG_BUGVERBOSE=y -+# end of printk and dmesg options -+ -+CONFIG_DEBUG_KERNEL=y -+CONFIG_DEBUG_MISC=y -+ -+# -+# Compile-time checks and compiler options -+# -+CONFIG_DEBUG_INFO=y -+CONFIG_AS_HAS_NON_CONST_LEB128=y -+# CONFIG_DEBUG_INFO_NONE is not set -+CONFIG_DEBUG_INFO_DWARF_TOOLCHAIN_DEFAULT=y -+# CONFIG_DEBUG_INFO_DWARF4 is not set -+# CONFIG_DEBUG_INFO_DWARF5 is not set -+CONFIG_DEBUG_INFO_REDUCED=y -+CONFIG_DEBUG_INFO_COMPRESSED_NONE=y -+# CONFIG_DEBUG_INFO_SPLIT is not set -+# CONFIG_GDB_SCRIPTS is not set -+CONFIG_FRAME_WARN=2048 -+# CONFIG_STRIP_ASM_SYMS is not set -+# CONFIG_HEADERS_INSTALL is not set -+CONFIG_SECTION_MISMATCH_WARN_ONLY=y -+CONFIG_ARCH_WANT_FRAME_POINTERS=y -+CONFIG_FRAME_POINTER=y -+# CONFIG_DEBUG_FORCE_WEAK_PER_CPU is not set -+# end of Compile-time checks and compiler options -+ -+# -+# Generic Kernel Debugging Instruments -+# -+CONFIG_MAGIC_SYSRQ=y -+CONFIG_MAGIC_SYSRQ_DEFAULT_ENABLE=0x1 -+CONFIG_MAGIC_SYSRQ_SERIAL=y -+CONFIG_MAGIC_SYSRQ_SERIAL_SEQUENCE="" -+CONFIG_DEBUG_FS=y -+CONFIG_DEBUG_FS_ALLOW_ALL=y -+# CONFIG_DEBUG_FS_DISALLOW_MOUNT is not set -+# CONFIG_DEBUG_FS_ALLOW_NONE is not set -+CONFIG_HAVE_ARCH_KGDB=y -+# CONFIG_KGDB is not set -+CONFIG_ARCH_HAS_UBSAN_SANITIZE_ALL=y -+# CONFIG_UBSAN is not set -+CONFIG_HAVE_KCSAN_COMPILER=y -+# end of Generic Kernel Debugging Instruments -+ -+# -+# Networking Debugging -+# -+# CONFIG_NET_DEV_REFCNT_TRACKER is not set -+# CONFIG_NET_NS_REFCNT_TRACKER is not set -+# CONFIG_DEBUG_NET is not set -+# end of Networking Debugging -+ -+# -+# Memory Debugging -+# -+# CONFIG_PAGE_EXTENSION is not set -+# CONFIG_DEBUG_PAGEALLOC is not set -+CONFIG_SLUB_DEBUG=y -+# CONFIG_SLUB_DEBUG_ON is not set -+# CONFIG_PAGE_OWNER is not set -+# CONFIG_PAGE_TABLE_CHECK is not set -+# CONFIG_PAGE_POISONING is not set -+# CONFIG_DEBUG_PAGE_REF is not set -+# CONFIG_DEBUG_RODATA_TEST is not set -+CONFIG_ARCH_HAS_DEBUG_WX=y -+# CONFIG_DEBUG_WX is not set -+CONFIG_GENERIC_PTDUMP=y -+# CONFIG_PTDUMP_DEBUGFS is not set -+CONFIG_HAVE_DEBUG_KMEMLEAK=y -+# CONFIG_DEBUG_KMEMLEAK is not set -+# CONFIG_PER_VMA_LOCK_STATS is not set -+# CONFIG_DEBUG_OBJECTS is not set -+# CONFIG_SHRINKER_DEBUG is not set -+# CONFIG_DEBUG_STACK_USAGE is not set -+# CONFIG_SCHED_STACK_END_CHECK is not set -+CONFIG_ARCH_HAS_DEBUG_VM_PGTABLE=y -+# CONFIG_DEBUG_VM is not set -+# CONFIG_DEBUG_VM_PGTABLE is not set -+CONFIG_ARCH_HAS_DEBUG_VIRTUAL=y -+# CONFIG_DEBUG_VIRTUAL is not set -+CONFIG_DEBUG_MEMORY_INIT=y -+# CONFIG_DEBUG_PER_CPU_MAPS is not set -+CONFIG_HAVE_ARCH_KASAN=y -+CONFIG_HAVE_ARCH_KASAN_SW_TAGS=y -+CONFIG_HAVE_ARCH_KASAN_HW_TAGS=y -+CONFIG_HAVE_ARCH_KASAN_VMALLOC=y -+CONFIG_CC_HAS_KASAN_GENERIC=y -+CONFIG_CC_HAS_KASAN_SW_TAGS=y -+CONFIG_CC_HAS_WORKING_NOSANITIZE_ADDRESS=y -+# CONFIG_KASAN is not set -+CONFIG_HAVE_ARCH_KFENCE=y -+# CONFIG_KFENCE is not set -+# end of Memory Debugging -+ -+# CONFIG_DEBUG_SHIRQ is not set -+ -+# -+# Debug Oops, Lockups and Hangs -+# -+# CONFIG_PANIC_ON_OOPS is not set -+CONFIG_PANIC_ON_OOPS_VALUE=0 -+CONFIG_PANIC_TIMEOUT=0 -+# CONFIG_SOFTLOCKUP_DETECTOR is not set -+CONFIG_HAVE_HARDLOCKUP_DETECTOR_BUDDY=y -+# CONFIG_HARDLOCKUP_DETECTOR is not set -+CONFIG_DETECT_HUNG_TASK=y -+CONFIG_DEFAULT_HUNG_TASK_TIMEOUT=120 -+# CONFIG_BOOTPARAM_HUNG_TASK_PANIC is not set -+CONFIG_BOOTPARAM_HUNG_TASK_PANIC_VALUE=0 -+# CONFIG_WQ_WATCHDOG is not set -+# CONFIG_WQ_CPU_INTENSIVE_REPORT is not set -+# CONFIG_TEST_LOCKUP is not set -+# end of Debug Oops, Lockups and Hangs -+ -+# -+# Scheduler Debugging -+# -+CONFIG_SCHED_DEBUG=y -+CONFIG_SCHED_INFO=y -+CONFIG_SCHEDSTATS=y -+# end of Scheduler Debugging -+ -+# CONFIG_DEBUG_TIMEKEEPING is not set -+# CONFIG_DEBUG_PREEMPT is not set -+ -+# -+# Lock Debugging (spinlocks, mutexes, etc...) -+# -+CONFIG_LOCK_DEBUGGING_SUPPORT=y -+# CONFIG_PROVE_LOCKING is not set -+# CONFIG_LOCK_STAT is not set -+# CONFIG_DEBUG_RT_MUTEXES is not set -+# CONFIG_DEBUG_SPINLOCK is not set -+# CONFIG_DEBUG_MUTEXES is not set -+# CONFIG_DEBUG_WW_MUTEX_SLOWPATH is not set -+# CONFIG_DEBUG_RWSEMS is not set -+# CONFIG_DEBUG_LOCK_ALLOC is not set -+# CONFIG_DEBUG_ATOMIC_SLEEP is not set -+# CONFIG_DEBUG_LOCKING_API_SELFTESTS is not set -+# CONFIG_LOCK_TORTURE_TEST is not set -+# CONFIG_WW_MUTEX_SELFTEST is not set -+# CONFIG_SCF_TORTURE_TEST is not set -+# CONFIG_CSD_LOCK_WAIT_DEBUG is not set -+# end of Lock Debugging (spinlocks, mutexes, etc...) -+ -+# CONFIG_DEBUG_IRQFLAGS is not set -+CONFIG_STACKTRACE=y -+# CONFIG_WARN_ALL_UNSEEDED_RANDOM is not set -+# CONFIG_DEBUG_KOBJECT is not set -+ -+# -+# Debug kernel data structures -+# -+# CONFIG_DEBUG_LIST is not set -+# CONFIG_DEBUG_PLIST is not set -+# CONFIG_DEBUG_SG is not set -+# CONFIG_DEBUG_NOTIFIERS is not set -+# CONFIG_DEBUG_MAPLE_TREE is not set -+# end of Debug kernel data structures -+ -+# -+# RCU Debugging -+# -+# CONFIG_RCU_SCALE_TEST is not set -+# CONFIG_RCU_TORTURE_TEST is not set -+# CONFIG_RCU_REF_SCALE_TEST is not set -+CONFIG_RCU_CPU_STALL_TIMEOUT=21 -+CONFIG_RCU_EXP_CPU_STALL_TIMEOUT=0 -+# CONFIG_RCU_CPU_STALL_CPUTIME is not set -+CONFIG_RCU_TRACE=y -+# CONFIG_RCU_EQS_DEBUG is not set -+# end of RCU Debugging -+ -+# CONFIG_DEBUG_WQ_FORCE_RR_CPU is not set -+# CONFIG_CPU_HOTPLUG_STATE_CONTROL is not set -+# CONFIG_LATENCYTOP is not set -+# CONFIG_DEBUG_CGROUP_REF is not set -+CONFIG_NOP_TRACER=y -+CONFIG_HAVE_FUNCTION_TRACER=y -+CONFIG_HAVE_FUNCTION_GRAPH_TRACER=y -+CONFIG_HAVE_FUNCTION_GRAPH_RETVAL=y -+CONFIG_HAVE_DYNAMIC_FTRACE=y -+CONFIG_HAVE_DYNAMIC_FTRACE_WITH_DIRECT_CALLS=y -+CONFIG_HAVE_DYNAMIC_FTRACE_WITH_CALL_OPS=y -+CONFIG_HAVE_DYNAMIC_FTRACE_WITH_ARGS=y -+CONFIG_HAVE_FTRACE_MCOUNT_RECORD=y -+CONFIG_HAVE_SYSCALL_TRACEPOINTS=y -+CONFIG_HAVE_C_RECORDMCOUNT=y -+CONFIG_TRACE_CLOCK=y -+CONFIG_RING_BUFFER=y -+CONFIG_EVENT_TRACING=y -+CONFIG_CONTEXT_SWITCH_TRACER=y -+CONFIG_TRACING=y -+CONFIG_GENERIC_TRACER=y -+CONFIG_TRACING_SUPPORT=y -+CONFIG_FTRACE=y -+# CONFIG_BOOTTIME_TRACING is not set -+CONFIG_FUNCTION_TRACER=y -+CONFIG_FUNCTION_GRAPH_TRACER=y -+# CONFIG_FUNCTION_GRAPH_RETVAL is not set -+CONFIG_DYNAMIC_FTRACE=y -+CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS=y -+CONFIG_DYNAMIC_FTRACE_WITH_CALL_OPS=y -+CONFIG_DYNAMIC_FTRACE_WITH_ARGS=y -+# CONFIG_FUNCTION_PROFILER is not set -+# CONFIG_STACK_TRACER is not set -+# CONFIG_IRQSOFF_TRACER is not set -+# CONFIG_PREEMPT_TRACER is not set -+# CONFIG_SCHED_TRACER is not set -+# CONFIG_HWLAT_TRACER is not set -+# CONFIG_OSNOISE_TRACER is not set -+# CONFIG_TIMERLAT_TRACER is not set -+# CONFIG_FTRACE_SYSCALLS is not set -+# CONFIG_TRACER_SNAPSHOT is not set -+CONFIG_BRANCH_PROFILE_NONE=y -+# CONFIG_PROFILE_ANNOTATED_BRANCHES is not set -+# CONFIG_PROFILE_ALL_BRANCHES is not set -+CONFIG_BLK_DEV_IO_TRACE=y -+CONFIG_KPROBE_EVENTS=y -+# CONFIG_KPROBE_EVENTS_ON_NOTRACE is not set -+CONFIG_UPROBE_EVENTS=y -+CONFIG_BPF_EVENTS=y -+CONFIG_DYNAMIC_EVENTS=y -+CONFIG_PROBE_EVENTS=y -+CONFIG_FTRACE_MCOUNT_RECORD=y -+CONFIG_FTRACE_MCOUNT_USE_PATCHABLE_FUNCTION_ENTRY=y -+# CONFIG_SYNTH_EVENTS is not set -+# CONFIG_USER_EVENTS is not set -+# CONFIG_HIST_TRIGGERS is not set -+# CONFIG_TRACE_EVENT_INJECT is not set -+# CONFIG_TRACEPOINT_BENCHMARK is not set -+# CONFIG_RING_BUFFER_BENCHMARK is not set -+# CONFIG_TRACE_EVAL_MAP_FILE is not set -+# CONFIG_FTRACE_RECORD_RECURSION is not set -+# CONFIG_FTRACE_STARTUP_TEST is not set -+# CONFIG_RING_BUFFER_STARTUP_TEST is not set -+# CONFIG_RING_BUFFER_VALIDATE_TIME_DELTAS is not set -+# CONFIG_PREEMPTIRQ_DELAY_TEST is not set -+# CONFIG_KPROBE_EVENT_GEN_TEST is not set -+# CONFIG_RV is not set -+# CONFIG_SAMPLES is not set -+CONFIG_HAVE_SAMPLE_FTRACE_DIRECT=y -+CONFIG_HAVE_SAMPLE_FTRACE_DIRECT_MULTI=y -+CONFIG_STRICT_DEVMEM=y -+# CONFIG_IO_STRICT_DEVMEM is not set -+ -+# -+# arm64 Debugging -+# -+# CONFIG_PID_IN_CONTEXTIDR is not set -+# CONFIG_DEBUG_EFI is not set -+# CONFIG_ARM64_RELOC_TEST is not set -+CONFIG_CORESIGHT=m -+CONFIG_CORESIGHT_LINKS_AND_SINKS=m -+CONFIG_CORESIGHT_LINK_AND_SINK_TMC=m -+CONFIG_CORESIGHT_CATU=m -+CONFIG_CORESIGHT_SINK_TPIU=m -+CONFIG_CORESIGHT_SINK_ETBV10=m -+# CONFIG_CORESIGHT_SOURCE_ETM4X is not set -+CONFIG_CORESIGHT_STM=m -+CONFIG_CORESIGHT_CPU_DEBUG=m -+# CONFIG_CORESIGHT_CPU_DEBUG_DEFAULT_ON is not set -+CONFIG_CORESIGHT_CTI=m -+# CONFIG_CORESIGHT_CTI_INTEGRATION_REGS is not set -+# CONFIG_ULTRASOC_SMB is not set -+# CONFIG_CORESIGHT_TPDM is not set -+# CONFIG_CORESIGHT_TPDA is not set -+# CONFIG_CORESIGHT_DUMMY is not set -+# end of arm64 Debugging -+ -+# -+# Kernel Testing and Coverage -+# -+# CONFIG_KUNIT is not set -+# CONFIG_NOTIFIER_ERROR_INJECTION is not set -+# CONFIG_FUNCTION_ERROR_INJECTION is not set -+# CONFIG_FAULT_INJECTION is not set -+CONFIG_ARCH_HAS_KCOV=y -+CONFIG_CC_HAS_SANCOV_TRACE_PC=y -+# CONFIG_KCOV is not set -+CONFIG_RUNTIME_TESTING_MENU=y -+# CONFIG_TEST_DHRY is not set -+# CONFIG_LKDTM is not set -+# CONFIG_TEST_MIN_HEAP is not set -+# CONFIG_TEST_DIV64 is not set -+# CONFIG_BACKTRACE_SELF_TEST is not set -+# CONFIG_TEST_REF_TRACKER is not set -+# CONFIG_RBTREE_TEST is not set -+# CONFIG_REED_SOLOMON_TEST is not set -+# CONFIG_INTERVAL_TREE_TEST is not set -+# CONFIG_PERCPU_TEST is not set -+# CONFIG_ATOMIC64_SELFTEST is not set -+# CONFIG_TEST_HEXDUMP is not set -+# CONFIG_STRING_SELFTEST is not set -+# CONFIG_TEST_STRING_HELPERS is not set -+# CONFIG_TEST_KSTRTOX is not set -+# CONFIG_TEST_PRINTF is not set -+# CONFIG_TEST_SCANF is not set -+# CONFIG_TEST_BITMAP is not set -+# CONFIG_TEST_UUID is not set -+# CONFIG_TEST_XARRAY is not set -+# CONFIG_TEST_MAPLE_TREE is not set -+# CONFIG_TEST_RHASHTABLE is not set -+# CONFIG_TEST_IDA is not set -+# CONFIG_TEST_LKM is not set -+# CONFIG_TEST_BITOPS is not set -+# CONFIG_TEST_VMALLOC is not set -+# CONFIG_TEST_USER_COPY is not set -+# CONFIG_TEST_BPF is not set -+# CONFIG_TEST_BLACKHOLE_DEV is not set -+# CONFIG_FIND_BIT_BENCHMARK is not set -+# CONFIG_TEST_FIRMWARE is not set -+# CONFIG_TEST_SYSCTL is not set -+# CONFIG_TEST_UDELAY is not set -+# CONFIG_TEST_STATIC_KEYS is not set -+# CONFIG_TEST_KMOD is not set -+# CONFIG_TEST_MEMCAT_P is not set -+# CONFIG_TEST_MEMINIT is not set -+# CONFIG_TEST_FREE_PAGES is not set -+CONFIG_ARCH_USE_MEMTEST=y -+CONFIG_MEMTEST=y -+# end of Kernel Testing and Coverage -+ -+# -+# Rust hacking -+# -+# end of Rust hacking -+# end of Kernel hacking -diff --git a/arch/arm64/configs/virt.config b/arch/arm64/configs/virt.config -deleted file mode 100644 -index c47c36f8f..000000000 ---- a/arch/arm64/configs/virt.config -+++ /dev/null -@@ -1,61 +0,0 @@ --# Help: Virtualization guest --# --# Base options for platforms --# -- --# CONFIG_ARCH_ACTIONS is not set --# CONFIG_ARCH_SUNXI is not set --# CONFIG_ARCH_ALPINE is not set --# CONFIG_ARCH_APPLE is not set --# CONFIG_ARCH_BCM is not set --# CONFIG_ARCH_BCM2835 is not set --# CONFIG_ARCH_BCMBCA is not set --# CONFIG_ARCH_BCM_IPROC is not set --# CONFIG_ARCH_BERLIN is not set --# CONFIG_ARCH_BRCMSTB is not set --# CONFIG_ARCH_EXYNOS is not set --# CONFIG_ARCH_K3 is not set --# CONFIG_ARCH_LAYERSCAPE is not set --# CONFIG_ARCH_LG1K is not set --# CONFIG_ARCH_HISI is not set --# CONFIG_ARCH_KEEMBAY is not set --# CONFIG_ARCH_MEDIATEK is not set --# CONFIG_ARCH_MESON is not set --# CONFIG_ARCH_MVEBU is not set --# CONFIG_ARCH_NXP is not set --# CONFIG_ARCH_MXC is not set --# CONFIG_ARCH_NPCM is not set --# CONFIG_ARCH_QCOM is not set --# CONFIG_ARCH_RENESAS is not set --# CONFIG_ARCH_ROCKCHIP is not set --# CONFIG_ARCH_S32 is not set --# CONFIG_ARCH_SEATTLE is not set --# CONFIG_ARCH_INTEL_SOCFPGA is not set --# CONFIG_ARCH_SYNQUACER is not set --# CONFIG_ARCH_TEGRA is not set --# CONFIG_ARCH_TESLA_FSD is not set --# CONFIG_ARCH_SPRD is not set --# CONFIG_ARCH_THUNDER is not set --# CONFIG_ARCH_THUNDER2 is not set --# CONFIG_ARCH_UNIPHIER is not set --# CONFIG_ARCH_VEXPRESS is not set --# CONFIG_ARCH_VISCONTI is not set --# CONFIG_ARCH_XGENE is not set --# CONFIG_ARCH_ZYNQMP is not set -- --# --# Subsystems which can't be used in mach-virt --# --# CONFIG_CHROME_PLATFORMS is not set --# CONFIG_EXTCON is not set --# CONFIG_IIO is not set --# CONFIG_MTD is not set --# CONFIG_NEW_LEDS is not set --# CONFIG_PWM is not set --# CONFIG_REGULATOR is not set --# CONFIG_SLIMBUS is not set --# CONFIG_SND_SOC is not set --# CONFIG_SOUNDWIRE is not set --# CONFIG_SPI is not set --# CONFIG_SURFACE_PLATFORMS is not set --# CONFIG_THERMAL is not set -diff --git a/arch/arm64/include/asm/cputype.h b/arch/arm64/include/asm/cputype.h -index 52f076afe..18f70359a 100644 ---- a/arch/arm64/include/asm/cputype.h -+++ b/arch/arm64/include/asm/cputype.h -@@ -62,6 +62,7 @@ - #define ARM_CPU_IMP_APPLE 0x61 - #define ARM_CPU_IMP_AMPERE 0xC0 - #define ARM_CPU_IMP_MICROSOFT 0x6D -+#define ARM_CPU_IMP_PHYTIUM 0x70 - - #define ARM_CPU_PART_AEM_V8 0xD0F - #define ARM_CPU_PART_FOUNDATION 0xD00 -@@ -136,6 +137,13 @@ - - #define AMPERE_CPU_PART_AMPERE1 0xAC3 - -+#define PHYTIUM_CPU_PART_FTC310 0x660 -+#define PHYTIUM_CPU_PART_FTC660 0x660 -+#define PHYTIUM_CPU_PART_FTC661 0x661 -+#define PHYTIUM_CPU_PART_FTC662 0x662 -+#define PHYTIUM_CPU_PART_FTC663 0x663 -+#define PHYTIUM_CPU_PART_FTC664 0x664 -+ - #define MICROSOFT_CPU_PART_AZURE_COBALT_100 0xD49 /* Based on r0p0 of ARM Neoverse N2 */ - - #define MIDR_CORTEX_A53 MIDR_CPU_MODEL(ARM_CPU_IMP_ARM, ARM_CPU_PART_CORTEX_A53) -@@ -197,6 +205,12 @@ - #define MIDR_APPLE_M2_AVALANCHE_MAX MIDR_CPU_MODEL(ARM_CPU_IMP_APPLE, APPLE_CPU_PART_M2_AVALANCHE_MAX) - #define MIDR_AMPERE1 MIDR_CPU_MODEL(ARM_CPU_IMP_AMPERE, AMPERE_CPU_PART_AMPERE1) - #define MIDR_MICROSOFT_AZURE_COBALT_100 MIDR_CPU_MODEL(ARM_CPU_IMP_MICROSOFT, MICROSOFT_CPU_PART_AZURE_COBALT_100) -+#define MIDR_PHYTIUM_FTC310 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC310) -+#define MIDR_PHYTIUM_FTC660 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC660) -+#define MIDR_PHYTIUM_FTC661 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC661) -+#define MIDR_PHYTIUM_PS17064 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC662) -+#define MIDR_PHYTIUM_FTC663 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC663) -+#define MIDR_PHYTIUM_FTC664 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC664) - - /* Fujitsu Erratum 010001 affects A64FX 1.0 and 1.1, (v0r0 and v1r0) */ - #define MIDR_FUJITSU_ERRATUM_010001 MIDR_FUJITSU_A64FX -diff --git a/arch/arm64/include/asm/ras.h b/arch/arm64/include/asm/ras.h -new file mode 100644 -index 000000000..5453c1f9b ---- /dev/null -+++ b/arch/arm64/include/asm/ras.h -@@ -0,0 +1,13 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * ARM64 SEA error recoery support -+ * -+ * Copyright (c) 2019-2023, Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _ASM_RAS_H -+#define _ASM_RAS_H -+ -+extern void sea_notify_process(void); -+ -+#endif /*_ASM_RAS_H*/ -diff --git a/arch/arm64/include/asm/thread_info.h b/arch/arm64/include/asm/thread_info.h -index 553d1bc55..c5e3459f1 100644 ---- a/arch/arm64/include/asm/thread_info.h -+++ b/arch/arm64/include/asm/thread_info.h -@@ -64,6 +64,7 @@ void arch_setup_new_exec(void); - #define TIF_UPROBE 4 /* uprobe breakpoint or singlestep */ - #define TIF_MTE_ASYNC_FAULT 5 /* MTE Asynchronous Tag Check Fault */ - #define TIF_NOTIFY_SIGNAL 6 /* signal notifications exist */ -+#define TIF_SEA_NOTIFY 7 /* notify to do an error recovery */ - #define TIF_SYSCALL_TRACE 8 /* syscall trace active */ - #define TIF_SYSCALL_AUDIT 9 /* syscall auditing */ - #define TIF_SYSCALL_TRACEPOINT 10 /* syscall tracepoint for ftrace */ -@@ -85,6 +86,7 @@ void arch_setup_new_exec(void); - #define _TIF_NEED_RESCHED (1 << TIF_NEED_RESCHED) - #define _TIF_NOTIFY_RESUME (1 << TIF_NOTIFY_RESUME) - #define _TIF_FOREIGN_FPSTATE (1 << TIF_FOREIGN_FPSTATE) -+#define _TIF_SEA_NOTIFY (1 << TIF_SEA_NOTIFY) - #define _TIF_SYSCALL_TRACE (1 << TIF_SYSCALL_TRACE) - #define _TIF_SYSCALL_AUDIT (1 << TIF_SYSCALL_AUDIT) - #define _TIF_SYSCALL_TRACEPOINT (1 << TIF_SYSCALL_TRACEPOINT) -@@ -100,7 +102,7 @@ void arch_setup_new_exec(void); - #define _TIF_WORK_MASK (_TIF_NEED_RESCHED | _TIF_SIGPENDING | \ - _TIF_NOTIFY_RESUME | _TIF_FOREIGN_FPSTATE | \ - _TIF_UPROBE | _TIF_MTE_ASYNC_FAULT | \ -- _TIF_NOTIFY_SIGNAL) -+ _TIF_NOTIFY_SIGNAL | _TIF_SEA_NOTIFY) - - #define _TIF_SYSCALL_WORK (_TIF_SYSCALL_TRACE | _TIF_SYSCALL_AUDIT | \ - _TIF_SYSCALL_TRACEPOINT | _TIF_SECCOMP | \ -diff --git a/arch/arm64/kernel/Makefile b/arch/arm64/kernel/Makefile -index d95b3d6b4..eca1f9012 100644 ---- a/arch/arm64/kernel/Makefile -+++ b/arch/arm64/kernel/Makefile -@@ -54,6 +54,7 @@ obj-$(CONFIG_EFI) += efi.o efi-rt-wrapper.o - obj-$(CONFIG_PCI) += pci.o - obj-$(CONFIG_ARMV8_DEPRECATED) += armv8_deprecated.o - obj-$(CONFIG_ACPI) += acpi.o -+obj-$(CONFIG_ARM64_ERR_RECOV) += ras.o - obj-$(CONFIG_ACPI_NUMA) += acpi_numa.o - obj-$(CONFIG_ARM64_ACPI_PARKING_PROTOCOL) += acpi_parking_protocol.o - obj-$(CONFIG_PARAVIRT) += paravirt.o -diff --git a/arch/arm64/kernel/cpufeature.c b/arch/arm64/kernel/cpufeature.c -index 444a73c2e..abb864868 100644 ---- a/arch/arm64/kernel/cpufeature.c -+++ b/arch/arm64/kernel/cpufeature.c -@@ -1686,6 +1686,12 @@ static bool unmap_kernel_at_el0(const struct arm64_cpu_capabilities *entry, - MIDR_ALL_VERSIONS(MIDR_CORTEX_A73), - MIDR_ALL_VERSIONS(MIDR_HISI_TSV110), - MIDR_ALL_VERSIONS(MIDR_NVIDIA_CARMEL), -+ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC310), -+ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC660), -+ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC661), -+ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_PS17064), -+ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC663), -+ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC664), - MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_2XX_GOLD), - MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_2XX_SILVER), - MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_3XX_SILVER), -diff --git a/arch/arm64/kernel/proton-pack.c b/arch/arm64/kernel/proton-pack.c -index 05f40c4e1..5854a5b3d 100644 ---- a/arch/arm64/kernel/proton-pack.c -+++ b/arch/arm64/kernel/proton-pack.c -@@ -160,6 +160,7 @@ static enum mitigation_state spectre_v2_get_cpu_hw_mitigation_state(void) - MIDR_ALL_VERSIONS(MIDR_CORTEX_A55), - MIDR_ALL_VERSIONS(MIDR_BRAHMA_B53), - MIDR_ALL_VERSIONS(MIDR_HISI_TSV110), -+ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC310), - MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_2XX_SILVER), - MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_3XX_SILVER), - MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_4XX_SILVER), -@@ -470,6 +471,7 @@ static enum mitigation_state spectre_v4_get_cpu_hw_mitigation_state(void) - MIDR_ALL_VERSIONS(MIDR_CORTEX_A53), - MIDR_ALL_VERSIONS(MIDR_CORTEX_A55), - MIDR_ALL_VERSIONS(MIDR_BRAHMA_B53), -+ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC310), - MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_3XX_SILVER), - MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_4XX_SILVER), - { /* sentinel */ }, -diff --git a/arch/arm64/kernel/ras.c b/arch/arm64/kernel/ras.c -new file mode 100644 -index 000000000..bec6c8a73 ---- /dev/null -+++ b/arch/arm64/kernel/ras.c -@@ -0,0 +1,164 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * ARM64 SEA error recoery support -+ * -+ * Copyright (c) 2019-2023, Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+ -+#include -+#include -+#include -+ -+/* -+ * Need to save faulting physical address associated with a process -+ * in the sea ghes handler some place where we can grab it back -+ * later in sea_notify_process() -+ */ -+#define SEA_INFO_MAX 16 -+ -+struct sea_info { -+ atomic_t inuse; -+ struct task_struct *t; -+ __u64 paddr; -+} sea_info[SEA_INFO_MAX]; -+ -+static bool sea_save_info(__u64 addr) -+{ -+ struct sea_info *si; -+ -+ for (si = sea_info; si < &sea_info[SEA_INFO_MAX]; si++) { -+ if (atomic_cmpxchg(&si->inuse, 0, 1) == 0) { -+ si->t = current; -+ si->paddr = addr; -+ return true; -+ } -+ } -+ -+ pr_err("Too many concurrent recoverable errors\n"); -+ return false; -+} -+ -+static struct sea_info *sea_find_info(void) -+{ -+ struct sea_info *si; -+ -+ for (si = sea_info; si < &sea_info[SEA_INFO_MAX]; si++) -+ if (atomic_read(&si->inuse) && si->t == current) -+ return si; -+ return NULL; -+} -+ -+static void sea_clear_info(struct sea_info *si) -+{ -+ atomic_set(&si->inuse, 0); -+} -+ -+/* -+ * Called in process context that interrupted by SEA and marked with -+ * TIF_SEA_NOTIFY, just before returning to erroneous userland. -+ * This code is allowed to sleep. -+ * Attempt possible recovery such as calling the high level VM handler to -+ * process any corrupted pages, and kill/signal current process if required. -+ * Action required errors are handled here. -+ */ -+void sea_notify_process(void) -+{ -+ unsigned long pfn; -+ int fail = 0, flags = MF_ACTION_REQUIRED; -+ struct sea_info *si = sea_find_info(); -+ -+ if (!si) -+ panic("Lost physical address for consumed uncorrectable error"); -+ -+ clear_thread_flag(TIF_SEA_NOTIFY); -+ do { -+ pfn = si->paddr >> PAGE_SHIFT; -+ -+ pr_err("Uncorrected hardware memory error in user-access at %llx\n", -+ si->paddr); -+ /* -+ * We must call memory_failure() here even if the current process is -+ * doomed. We still need to mark the page as poisoned and alert any -+ * other users of the page. -+ */ -+ if (memory_failure(pfn, flags) < 0) -+ fail++; -+ -+ sea_clear_info(si); -+ -+ si = sea_find_info(); -+ } while (si); -+ -+ if (fail) { -+ pr_err("Memory error not recovered\n"); -+ -+ force_sig(SIGBUS); -+ } -+} -+ -+void ghes_arm_process_error(struct ghes *ghes, -+ struct cper_sec_proc_arm *err, int sec_sev) -+{ -+ int i; -+ bool info_saved = false; -+ struct cper_arm_err_info *err_info; -+ -+ log_arm_hw_error(err, sec_sev); -+ -+ if ((ghes->generic->notify.type != ACPI_HEST_NOTIFY_SEA) || -+ (ghes->estatus->error_severity != CPER_SEV_RECOVERABLE)) -+ return; -+ -+ err_info = (struct cper_arm_err_info *)(err + 1); -+ for (i = 0; i < err->err_info_num; i++, err_info++) { -+ if ((err_info->validation_bits & CPER_ARM_INFO_VALID_PHYSICAL_ADDR) && -+ (err_info->type == CPER_ARM_CACHE_ERROR)) -+ info_saved |= sea_save_info(err_info->physical_fault_addr); -+ } -+ -+ if (info_saved) -+ set_thread_flag(TIF_SEA_NOTIFY); -+} -+ -+int ghes_mem_err_callback(struct notifier_block *nb, unsigned long val, void *data) -+{ -+ bool info_saved = false; -+ struct ghes_mem_err *ghes_mem = (struct ghes_mem_err *)data; -+ struct cper_sec_mem_err *mem_err = ghes_mem->mem_err; -+ -+ if ((ghes_mem->notify_type != ACPI_HEST_NOTIFY_SEA) || -+ (ghes_mem->severity != CPER_SEV_RECOVERABLE)) -+ return 0; -+ -+ if (mem_err->validation_bits & CPER_MEM_VALID_PA) -+ info_saved = sea_save_info(mem_err->physical_addr); -+ -+ if (info_saved) -+ set_thread_flag(TIF_SEA_NOTIFY); -+ -+ return 0; -+} -+ -+static struct notifier_block ghes_mem_err_nb = { -+ .notifier_call = ghes_mem_err_callback, -+}; -+ -+static int arm64_err_recov_init(void) -+{ -+ atomic_notifier_chain_register(&ghes_mem_err_chain, &ghes_mem_err_nb); -+ return 0; -+} -+ -+late_initcall(arm64_err_recov_init); -diff --git a/arch/arm64/kernel/signal.c b/arch/arm64/kernel/signal.c -index 425b1bc17..0e1dbc6d2 100644 ---- a/arch/arm64/kernel/signal.c -+++ b/arch/arm64/kernel/signal.c -@@ -33,6 +33,7 @@ - #include - #include - #include -+#include - - /* - * Do a signal return; undo the signal stack. These are aligned to 128-bit. -@@ -1280,6 +1281,11 @@ static void do_signal(struct pt_regs *regs) - - void do_notify_resume(struct pt_regs *regs, unsigned long thread_flags) - { -+#ifdef CONFIG_ARM64_ERR_RECOV -+ /* notify userspace of pending SEAs */ -+ if (unlikely(thread_flags & _TIF_SEA_NOTIFY)) -+ sea_notify_process(); -+#endif /* CONFIG_ARM64_ERR_RECOV */ - do { - if (thread_flags & _TIF_NEED_RESCHED) { - /* Unmask Debug and SError for the next task */ -diff --git a/arch/arm64/kernel/traps.c b/arch/arm64/kernel/traps.c -index 8b70759cd..79935d0ad 100644 ---- a/arch/arm64/kernel/traps.c -+++ b/arch/arm64/kernel/traps.c -@@ -49,6 +49,8 @@ - #include - #include - -+#include -+ - static bool __kprobes __check_eq(unsigned long pstate) - { - return (pstate & PSR_Z_BIT) != 0; -@@ -968,6 +970,13 @@ void __noreturn arm64_serror_panic(struct pt_regs *regs, unsigned long esr) - bool arm64_is_fatal_ras_serror(struct pt_regs *regs, unsigned long esr) - { - unsigned long aet = arm64_ras_serror_get_severity(esr); -+ int ret = ENOENT; -+ -+ if (IS_ENABLED(CONFIG_ACPI_APEI_SEI)) { -+ ret = ghes_notify_sei(); -+ if (!ret) -+ return false; -+ } - - switch (aet) { - case ESR_ELx_AET_CE: /* corrected error */ -diff --git a/block/partitions/cmdline.c b/block/partitions/cmdline.c -index c03bc105e..152c85df9 100644 ---- a/block/partitions/cmdline.c -+++ b/block/partitions/cmdline.c -@@ -70,8 +70,8 @@ static int parse_subpart(struct cmdline_subpart **subpart, char *partdef) - } - - if (*partdef == '(') { -- int length; -- char *next = strchr(++partdef, ')'); -+ partdef++; -+ char *next = strsep(&partdef, ")"); - - if (!next) { - pr_warn("cmdline partition format is invalid."); -@@ -79,11 +79,7 @@ static int parse_subpart(struct cmdline_subpart **subpart, char *partdef) - goto fail; - } - -- length = min_t(int, next - partdef, -- sizeof(new_subpart->name) - 1); -- strscpy(new_subpart->name, partdef, length); -- -- partdef = ++next; -+ strscpy(new_subpart->name, next, sizeof(new_subpart->name)); - } else - new_subpart->name[0] = '\0'; - -@@ -117,14 +113,12 @@ static void free_subpart(struct cmdline_parts *parts) - } - } - --static int parse_parts(struct cmdline_parts **parts, const char *bdevdef) -+static int parse_parts(struct cmdline_parts **parts, char *bdevdef) - { - int ret = -EINVAL; - char *next; -- int length; - struct cmdline_subpart **next_subpart; - struct cmdline_parts *newparts; -- char buf[BDEVNAME_SIZE + 32 + 4]; - - *parts = NULL; - -@@ -132,28 +126,19 @@ static int parse_parts(struct cmdline_parts **parts, const char *bdevdef) - if (!newparts) - return -ENOMEM; - -- next = strchr(bdevdef, ':'); -+ next = strsep(&bdevdef, ":"); - if (!next) { - pr_warn("cmdline partition has no block device."); - goto fail; - } - -- length = min_t(int, next - bdevdef, sizeof(newparts->name) - 1); -- strscpy(newparts->name, bdevdef, length); -+ strscpy(newparts->name, next, sizeof(newparts->name)); - newparts->nr_subparts = 0; - - next_subpart = &newparts->subpart; - -- while (next && *(++next)) { -- bdevdef = next; -- next = strchr(bdevdef, ','); -- -- length = (!next) ? (sizeof(buf) - 1) : -- min_t(int, next - bdevdef, sizeof(buf) - 1); -- -- strscpy(buf, bdevdef, length); -- -- ret = parse_subpart(next_subpart, buf); -+ while ((next = strsep(&bdevdef, ","))) { -+ ret = parse_subpart(next_subpart, next); - if (ret) - goto fail; - -@@ -199,24 +184,17 @@ static int cmdline_parts_parse(struct cmdline_parts **parts, - - *parts = NULL; - -- next = pbuf = buf = kstrdup(cmdline, GFP_KERNEL); -+ pbuf = buf = kstrdup(cmdline, GFP_KERNEL); - if (!buf) - return -ENOMEM; - - next_parts = parts; - -- while (next && *pbuf) { -- next = strchr(pbuf, ';'); -- if (next) -- *next = '\0'; -- -- ret = parse_parts(next_parts, pbuf); -+ while ((next = strsep(&pbuf, ";"))) { -+ ret = parse_parts(next_parts, next); - if (ret) - goto fail; - -- if (next) -- pbuf = ++next; -- - next_parts = &(*next_parts)->next_parts; - } - -@@ -250,7 +228,6 @@ static struct cmdline_parts *bdev_parts; - static int add_part(int slot, struct cmdline_subpart *subpart, - struct parsed_partitions *state) - { -- int label_min; - struct partition_meta_info *info; - char tmp[sizeof(info->volname) + 4]; - -@@ -262,9 +239,7 @@ static int add_part(int slot, struct cmdline_subpart *subpart, - - info = &state->parts[slot].info; - -- label_min = min_t(int, sizeof(info->volname) - 1, -- sizeof(subpart->name)); -- strscpy(info->volname, subpart->name, label_min); -+ strscpy(info->volname, subpart->name, sizeof(info->volname)); - - snprintf(tmp, sizeof(tmp), "(%s)", info->volname); - strlcat(state->pp_buf, tmp, PAGE_SIZE); -diff --git a/drivers/acpi/acpi_apd.c b/drivers/acpi/acpi_apd.c -index 80f945cbe..9e265b3ba 100644 ---- a/drivers/acpi/acpi_apd.c -+++ b/drivers/acpi/acpi_apd.c -@@ -162,6 +162,16 @@ static const struct apd_device_desc hip08_lite_i2c_desc = { - .fixed_clk_rate = 125000000, - }; - -+static const struct apd_device_desc phytium_i2c_desc = { -+ .setup = acpi_apd_setup, -+ .fixed_clk_rate = 200000000, -+}; -+ -+static const struct apd_device_desc phytium_pe220x_i2c_desc = { -+ .setup = acpi_apd_setup, -+ .fixed_clk_rate = 50000000, -+}; -+ - static const struct apd_device_desc thunderx2_i2c_desc = { - .setup = acpi_apd_setup, - .fixed_clk_rate = 125000000, -@@ -246,6 +256,8 @@ static const struct acpi_device_id acpi_apd_device_ids[] = { - { "HISI02A3", APD_ADDR(hip08_lite_i2c_desc) }, - { "HISI0173", APD_ADDR(hip08_spi_desc) }, - { "NXP0001", APD_ADDR(nxp_i2c_desc) }, -+ { "PHYT0003", APD_ADDR(phytium_i2c_desc) }, -+ { "PHYT0038", APD_ADDR(phytium_pe220x_i2c_desc) }, - #endif - { } - }; -diff --git a/drivers/acpi/apei/Kconfig b/drivers/acpi/apei/Kconfig -index 6b18f8bc7..49e181f5a 100644 ---- a/drivers/acpi/apei/Kconfig -+++ b/drivers/acpi/apei/Kconfig -@@ -45,6 +45,21 @@ config ACPI_APEI_SEA - depends on ARM64 && ACPI_APEI_GHES - default y - -+config ACPI_APEI_SEI -+ bool "APEI SError(System Error) Interrupt logging/recovering support" -+ depends on ARM64 && ACPI_APEI_GHES -+ default y -+ help -+ This option should be enabled if the system supports -+ firmware first handling of SEI(SError interrupt) -+ -+ SEI happens with asynchronous external abort for errors on device -+ memory reads on ARMv8 systems. If a system supports firmware first -+ handling of SEI, the platform analyzes and handles hardware error -+ notifications from SEI, and it may then form a hardware error record -+ for the OS to parse and handle. This option allows the OS to look -+ for such hardware error record, and take appropriate action. -+ - config ACPI_APEI_MEMORY_FAILURE - bool "APEI memory error recovering support" - depends on ACPI_APEI && MEMORY_FAILURE -diff --git a/drivers/acpi/apei/ghes.c b/drivers/acpi/apei/ghes.c -index ab2a82cb1..2a7aa5e87 100644 ---- a/drivers/acpi/apei/ghes.c -+++ b/drivers/acpi/apei/ghes.c -@@ -148,6 +148,9 @@ static DEFINE_MUTEX(ghes_list_mutex); - static LIST_HEAD(ghes_devs); - static DEFINE_MUTEX(ghes_devs_mutex); - -+ATOMIC_NOTIFIER_HEAD(ghes_mem_err_chain); -+EXPORT_SYMBOL_GPL(ghes_mem_err_chain); -+ - /* - * Because the memory area used to transfer hardware error information - * from BIOS to Linux can be determined only in NMI, IRQ or timer -@@ -534,9 +537,8 @@ static bool ghes_handle_arm_hw_error(struct acpi_hest_generic_data *gdata, - int sec_sev, i; - char *p; - -- log_arm_hw_error(err); -- - sec_sev = ghes_severity(gdata->error_severity); -+ log_arm_hw_error(err, sec_sev); - if (sev != GHES_SEV_RECOVERABLE || sec_sev != GHES_SEV_RECOVERABLE) - return false; - -@@ -696,6 +698,11 @@ static bool ghes_do_proc(struct ghes *ghes, - - if (guid_equal(sec_type, &CPER_SEC_PLATFORM_MEM)) { - struct cper_sec_mem_err *mem_err = acpi_hest_get_payload(gdata); -+ struct ghes_mem_err mem; -+ -+ mem.notify_type = ghes->generic->notify.type; -+ mem.severity = gdata->error_severity; -+ mem.mem_err = mem_err; - - atomic_notifier_call_chain(&ghes_report_chain, sev, mem_err); - -@@ -1204,6 +1211,46 @@ static inline void ghes_sea_add(struct ghes *ghes) { } - static inline void ghes_sea_remove(struct ghes *ghes) { } - #endif /* CONFIG_ACPI_APEI_SEA */ - -+#ifdef CONFIG_ACPI_APEI_SEI -+static LIST_HEAD(ghes_sei); -+ -+/* -+ * Return 0 only if one of the SEI error sources successfully reported an error -+ * record sent from the firmware. -+ */ -+int ghes_notify_sei(void) -+{ -+ struct ghes *ghes; -+ int ret = -ENOENT; -+ -+ rcu_read_lock(); -+ list_for_each_entry_rcu(ghes, &ghes_sei, list) { -+ if (!ghes_proc(ghes)) -+ ret = 0; -+ } -+ rcu_read_unlock(); -+ return ret; -+} -+ -+static void ghes_sei_add(struct ghes *ghes) -+{ -+ mutex_lock(&ghes_list_mutex); -+ list_add_rcu(&ghes->list, &ghes_sei); -+ mutex_unlock(&ghes_list_mutex); -+} -+ -+static void ghes_sei_remove(struct ghes *ghes) -+{ -+ mutex_lock(&ghes_list_mutex); -+ list_del_rcu(&ghes->list); -+ mutex_unlock(&ghes_list_mutex); -+ synchronize_rcu(); -+} -+#else /* CONFIG_ACPI_APEI_SEI */ -+static inline void ghes_sei_add(struct ghes *ghes) { } -+static inline void ghes_sei_remove(struct ghes *ghes) { } -+#endif /*CONFIG_ACPI_APEI_SEI */ -+ - #ifdef CONFIG_HAVE_ACPI_APEI_NMI - /* - * NMI may be triggered on any CPU, so ghes_in_nmi is used for -@@ -1347,6 +1394,13 @@ static int ghes_probe(struct platform_device *ghes_dev) - goto err; - } - break; -+ case ACPI_HEST_NOTIFY_SEI: -+ if (!IS_ENABLED(CONFIG_ACPI_APEI_SEI)) { -+ pr_warn(GHES_PFX "Generic hardware error source: %d notified via SEI is not supported\n", -+ generic->header.source_id); -+ goto err; -+ } -+ break; - case ACPI_HEST_NOTIFY_NMI: - if (!IS_ENABLED(CONFIG_HAVE_ACPI_APEI_NMI)) { - pr_warn(GHES_PFX "Generic hardware error source: %d notified via NMI interrupt is not supported!\n", -@@ -1420,6 +1474,9 @@ static int ghes_probe(struct platform_device *ghes_dev) - case ACPI_HEST_NOTIFY_SEA: - ghes_sea_add(ghes); - break; -+ case ACPI_HEST_NOTIFY_SEI: -+ ghes_sei_add(ghes); -+ break; - case ACPI_HEST_NOTIFY_NMI: - ghes_nmi_add(ghes); - break; -@@ -1487,6 +1544,9 @@ static int ghes_remove(struct platform_device *ghes_dev) - case ACPI_HEST_NOTIFY_SEA: - ghes_sea_remove(ghes); - break; -+ case ACPI_HEST_NOTIFY_SEI: -+ ghes_sei_remove(ghes); -+ break; - case ACPI_HEST_NOTIFY_NMI: - ghes_nmi_remove(ghes); - break; -diff --git a/drivers/acpi/internal.h b/drivers/acpi/internal.h -index 866c7c4ed..19e7dd17c 100644 ---- a/drivers/acpi/internal.h -+++ b/drivers/acpi/internal.h -@@ -85,6 +85,18 @@ bool acpi_scan_is_offline(struct acpi_device *adev, bool uevent); - acpi_status acpi_sysfs_table_handler(u32 event, void *table, void *context); - void acpi_scan_table_notify(void); - -+#ifdef CONFIG_ACPI_GENERIC_GSI -+int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, -+ int polarity, struct fwnode_handle *fwnode); -+#else -+static inline -+int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, -+ int polarity, struct fwnode_handle *fwnode) -+{ -+ return acpi_register_gsi(dev, hwirq, trigger, polarity); -+} -+#endif -+ - /* -------------------------------------------------------------------------- - Device Node Initialization / Removal - -------------------------------------------------------------------------- */ -diff --git a/drivers/acpi/irq.c b/drivers/acpi/irq.c -index 1687483ff..ceed87bb1 100644 ---- a/drivers/acpi/irq.c -+++ b/drivers/acpi/irq.c -@@ -10,6 +10,8 @@ - #include - #include - -+#include "internal.h" -+ - enum acpi_irq_model_id acpi_irq_model; - - static struct fwnode_handle *(*acpi_get_gsi_domain_id)(u32 gsi); -@@ -43,6 +45,24 @@ int acpi_gsi_to_irq(u32 gsi, unsigned int *irq) - } - EXPORT_SYMBOL_GPL(acpi_gsi_to_irq); - -+int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, -+ int polarity, struct fwnode_handle *fwnode) -+{ -+ struct irq_fwspec fwspec; -+ -+ if (!fwnode) { -+ dev_warn(dev, "No registered irqchip for hwirq %d\n", hwirq); -+ return -EINVAL; -+ } -+ -+ fwspec.fwnode = fwnode; -+ fwspec.param[0] = hwirq; -+ fwspec.param[1] = acpi_dev_get_irq_type(trigger, polarity); -+ fwspec.param_count = 2; -+ -+ return irq_create_fwspec_mapping(&fwspec); -+} -+ - /** - * acpi_register_gsi() - Map a GSI to a linux IRQ number - * @dev: device for which IRQ has to be mapped -@@ -56,24 +76,7 @@ EXPORT_SYMBOL_GPL(acpi_gsi_to_irq); - int acpi_register_gsi(struct device *dev, u32 gsi, int trigger, - int polarity) - { -- struct irq_fwspec fwspec; -- unsigned int irq; -- -- fwspec.fwnode = acpi_get_gsi_domain_id(gsi); -- if (WARN_ON(!fwspec.fwnode)) { -- pr_warn("GSI: No registered irqchip, giving up\n"); -- return -EINVAL; -- } -- -- fwspec.param[0] = gsi; -- fwspec.param[1] = acpi_dev_get_irq_type(trigger, polarity); -- fwspec.param_count = 2; -- -- irq = irq_create_fwspec_mapping(&fwspec); -- if (!irq) -- return -EINVAL; -- -- return irq; -+ return acpi_register_irq(dev, gsi, trigger, polarity, acpi_get_gsi_domain_id(gsi)); - } - EXPORT_SYMBOL_GPL(acpi_register_gsi); - -@@ -108,7 +111,7 @@ EXPORT_SYMBOL_GPL(acpi_unregister_gsi); - * Return: - * The referenced device fwhandle or NULL on failure - */ --static struct fwnode_handle * -+struct fwnode_handle * - acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source, - u32 gsi) - { -diff --git a/drivers/acpi/pci_irq.c b/drivers/acpi/pci_irq.c -index ff30ceca2..c6fc738f7 100644 ---- a/drivers/acpi/pci_irq.c -+++ b/drivers/acpi/pci_irq.c -@@ -23,6 +23,8 @@ - #include - #include - -+#include "internal.h" -+ - struct acpi_prt_entry { - struct acpi_pci_id id; - u8 pin; -@@ -400,6 +402,7 @@ int acpi_pci_irq_enable(struct pci_dev *dev) - char *link = NULL; - char link_desc[16]; - int rc; -+ struct fwnode_handle *rs_fwnode; - - pin = dev->pin; - if (!pin) { -@@ -426,7 +429,8 @@ int acpi_pci_irq_enable(struct pci_dev *dev) - gsi = acpi_pci_link_allocate_irq(entry->link, - entry->index, - &triggering, &polarity, -- &link); -+ &link, -+ &rs_fwnode); - else - gsi = entry->index; - } else -@@ -450,7 +454,7 @@ int acpi_pci_irq_enable(struct pci_dev *dev) - return 0; - } - -- rc = acpi_register_gsi(&dev->dev, gsi, triggering, polarity); -+ rc = acpi_register_irq(&dev->dev, gsi, triggering, polarity, rs_fwnode); - if (rc < 0) { - dev_warn(&dev->dev, "PCI INT %c: failed to register GSI\n", - pin_name(pin)); -diff --git a/drivers/acpi/pci_link.c b/drivers/acpi/pci_link.c -index aa1038b8a..3af04e839 100644 ---- a/drivers/acpi/pci_link.c -+++ b/drivers/acpi/pci_link.c -@@ -59,6 +59,7 @@ struct acpi_pci_link_irq { - u8 resource_type; - u8 possible_count; - u32 possible[ACPI_PCI_LINK_MAX_POSSIBLE]; -+ struct acpi_resource_source resource_source; - u8 initialized:1; - u8 reserved:7; - }; -@@ -121,6 +122,8 @@ static acpi_status acpi_pci_link_check_possible(struct acpi_resource *resource, - { - struct acpi_resource_extended_irq *p = - &resource->data.extended_irq; -+ struct acpi_resource_source *rs = -+ &link->irq.resource_source; - if (!p->interrupt_count) { - acpi_handle_debug(handle, - "Blank _PRS EXT IRQ resource\n"); -@@ -141,6 +144,12 @@ static acpi_status acpi_pci_link_check_possible(struct acpi_resource *resource, - link->irq.triggering = p->triggering; - link->irq.polarity = p->polarity; - link->irq.resource_type = ACPI_RESOURCE_TYPE_EXTENDED_IRQ; -+ if (p->resource_source.string_length) { -+ rs->index = p->resource_source.index; -+ rs->string_length = p->resource_source.string_length; -+ rs->string_ptr = kstrdup(p->resource_source.string_ptr, -+ GFP_KERNEL); -+ } - break; - } - default: -@@ -327,7 +336,8 @@ static int acpi_pci_link_set(struct acpi_pci_link *link, int irq) - resource->res.data.extended_irq.shareable = ACPI_SHARED; - resource->res.data.extended_irq.interrupt_count = 1; - resource->res.data.extended_irq.interrupts[0] = irq; -- /* ignore resource_source, it's optional */ -+ resource->res.data.extended_irq.resource_source = -+ link->irq.resource_source; - break; - default: - acpi_handle_err(handle, "Invalid resource type %d\n", -@@ -604,7 +614,7 @@ static int acpi_pci_link_allocate(struct acpi_pci_link *link) - * failure: return -1 - */ - int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, -- int *polarity, char **name) -+ int *polarity, char **name, struct fwnode_handle **rs_fwnode) - { - struct acpi_device *device = acpi_fetch_acpi_dev(handle); - struct acpi_pci_link *link; -@@ -646,6 +656,13 @@ int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, - *polarity = link->irq.polarity; - if (name) - *name = acpi_device_bid(link->device); -+ if (rs_fwnode) -+ /* TODO: acpi_get_irq_source_fwhandle() requires a GSI as the second argument, -+ * which is not applicable for a hierarchical INTx. However, multiple GSI domains -+ * are only for LoongArch. Therefore, passing any value makes no differences for us. -+ * Need some reconstruction for this function to meet the real semantic. -+ */ -+ *rs_fwnode = acpi_get_irq_source_fwhandle(&link->irq.resource_source, 0); - acpi_handle_debug(handle, "Link is referenced\n"); - return link->irq.active; - } -diff --git a/drivers/char/Kconfig b/drivers/char/Kconfig -index 625af7583..907a541fd 100644 ---- a/drivers/char/Kconfig -+++ b/drivers/char/Kconfig -@@ -422,4 +422,6 @@ config ADI - and SSM (Silicon Secured Memory). Intended consumers of this - driver include crash and makedumpfile. - -+source "drivers/char/phytnetled/Kconfig" -+ - endmenu -diff --git a/drivers/char/Makefile b/drivers/char/Makefile -index c5f532e41..8a10c2370 100644 ---- a/drivers/char/Makefile -+++ b/drivers/char/Makefile -@@ -44,3 +44,4 @@ obj-$(CONFIG_PS3_FLASH) += ps3flash.o - obj-$(CONFIG_XILLYBUS_CLASS) += xillybus/ - obj-$(CONFIG_POWERNV_OP_PANEL) += powernv-op-panel.o - obj-$(CONFIG_ADI) += adi.o -+obj-$(CONFIG_PHYTNET_LED) += phytnetled/ -diff --git a/drivers/char/hw_random/Kconfig b/drivers/char/hw_random/Kconfig -index 8de74dcfa..5950e4e2f 100644 ---- a/drivers/char/hw_random/Kconfig -+++ b/drivers/char/hw_random/Kconfig -@@ -573,6 +573,18 @@ config HW_RANDOM_JH7110 - To compile this driver as a module, choose M here. - The module will be called jh7110-trng. - -+config HW_RANDOM_PHYTIUM -+ tristate "Phytium Random Number Generator support" -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ help -+ This driver provides kernel-side support for the Random Number -+ Generator hardware found on Phytium SoCs. -+ -+ To compile this driver as a module, choose M here: the -+ module will be called phytium-rng. -+ -+ If unsure, say Y. -+ - endif # HW_RANDOM - - config UML_RANDOM -diff --git a/drivers/char/hw_random/Makefile b/drivers/char/hw_random/Makefile -index 32549a118..7542784c6 100644 ---- a/drivers/char/hw_random/Makefile -+++ b/drivers/char/hw_random/Makefile -@@ -49,3 +49,4 @@ obj-$(CONFIG_HW_RANDOM_ARM_SMCCC_TRNG) += arm_smccc_trng.o - obj-$(CONFIG_HW_RANDOM_CN10K) += cn10k-rng.o - obj-$(CONFIG_HW_RANDOM_POLARFIRE_SOC) += mpfs-rng.o - obj-$(CONFIG_HW_RANDOM_JH7110) += jh7110-trng.o -+obj-$(CONFIG_HW_RANDOM_PHYTIUM) += phytium-rng.o -diff --git a/drivers/char/hw_random/phytium-rng.c b/drivers/char/hw_random/phytium-rng.c -new file mode 100644 -index 000000000..367a96c05 ---- /dev/null -+++ b/drivers/char/hw_random/phytium-rng.c -@@ -0,0 +1,154 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SoC RNG Driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define TRNG_CR 0x00 -+#define TRNG_CR_RNGEN BIT(0) -+#define TRNG_CR_ROSEN_MASK GENMASK(7, 4) -+#define TRNG_CR_DIEN BIT(16) -+#define TRNG_CR_ERIEN BIT(17) -+#define TRNG_CR_IRQEN BIT(24) -+#define TRNG_MSEL 0x04 -+#define TRNG_MSEL_MSEL BIT(0) -+#define TRNG_SR 0x08 -+#define TRNG_SR_HTF BIT(0) -+#define TRNG_SR_DRDY BIT(1) -+#define TRNG_SR_ERERR BIT(3) -+#define TRNG_DR 0x0C -+#define TRNG_RESEED 0x40 -+#define TRNG_RESEED_RSED BIT(0) -+ -+#define DELAY 10 -+#define TIMEOUT 100 -+ -+static int msel; -+module_param(msel, int, 0444); -+MODULE_PARM_DESC(msel, "Phytium RNG mode selection: 0 - TRNG. 1 - PRNG."); -+ -+struct phytium_rng { -+ struct hwrng rng; -+ void __iomem *base; -+}; -+ -+static int phytium_rng_init(struct hwrng *rng) -+{ -+ struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); -+ u32 reg; -+ -+ /* Mode Selection */ -+ reg = msel ? TRNG_MSEL_MSEL : 0; -+ writel(reg, priv->base + TRNG_MSEL); -+ -+ /* If PRGN mode is on, do reseed operations */ -+ if (msel) -+ writel(TRNG_RESEED_RSED, priv->base + TRNG_RESEED); -+ -+ /* Clear status */ -+ writel(0x7, priv->base + TRNG_SR); -+ -+ /* Enable TRNG */ -+ reg = readl(priv->base + TRNG_CR) | TRNG_CR_ROSEN_MASK | TRNG_CR_RNGEN; -+ writel(reg, priv->base + TRNG_CR); -+ -+ return 0; -+} -+ -+static void phytium_rng_cleanup(struct hwrng *rng) -+{ -+ struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); -+ -+ writel(0x7, priv->base + TRNG_SR); -+} -+ -+static int phytium_rng_read(struct hwrng *rng, void *buf, size_t max, bool wait) -+{ -+ struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); -+ u32 reg; -+ int ret = 0; -+ -+ /* TRNG can generate at most 8*32bit random number per time */ -+ max = max > 8 ? 8 : max; -+ -+ reg = readl(priv->base + TRNG_SR); -+ if (!(reg & TRNG_SR_DRDY) && wait) { -+ ret = readl_poll_timeout(priv->base + TRNG_SR, reg, -+ reg & TRNG_SR_DRDY, DELAY, TIMEOUT); -+ if (ret) { -+ dev_err((struct device *)priv->rng.priv, -+ "%s: timeout %x!\n", __func__, reg); -+ return -EIO; -+ } -+ } -+ -+ while (max > 4) { -+ *(u32 *)buf = readl(priv->base + TRNG_DR); -+ -+ ret += sizeof(u32); -+ buf += sizeof(u32); -+ max -= sizeof(u32); -+ } -+ -+ /* Clear DRDY by writing 1 */ -+ writel(reg | TRNG_SR_DRDY, priv->base + TRNG_SR); -+ -+ return ret; -+} -+ -+static int scto_rng_probe(struct platform_device *pdev) -+{ -+ struct phytium_rng *priv; -+ struct resource *mem; -+ -+ priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); -+ if (!priv) -+ return -ENOMEM; -+ -+ platform_set_drvdata(pdev, priv); -+ -+ mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ priv->base = devm_ioremap_resource(&pdev->dev, mem); -+ if (IS_ERR(priv->base)) -+ return PTR_ERR(priv->base); -+ -+ priv->rng.name = pdev->name; -+ priv->rng.init = phytium_rng_init; -+ priv->rng.cleanup = phytium_rng_cleanup; -+ priv->rng.read = phytium_rng_read; -+ priv->rng.priv = (unsigned long)&pdev->dev; -+ -+ return devm_hwrng_register(&pdev->dev, &priv->rng); -+} -+ -+static const struct of_device_id phytium_rng_dt_ids[] = { -+ { .compatible = "phytium,rng" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_rng_dt_ids); -+ -+static struct platform_driver phytium_rng_driver = { -+ .probe = scto_rng_probe, -+ .driver = { -+ .name = "phytium-rng", -+ .of_match_table = of_match_ptr(phytium_rng_dt_ids), -+ } -+}; -+module_platform_driver(phytium_rng_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium random number generator driver"); -+MODULE_AUTHOR("Chen Baozi "); -diff --git a/drivers/char/ipmi/Kconfig b/drivers/char/ipmi/Kconfig -index f4adc6feb..fe3b159c1 100644 ---- a/drivers/char/ipmi/Kconfig -+++ b/drivers/char/ipmi/Kconfig -@@ -118,6 +118,27 @@ config ASPEED_KCS_IPMI_BMC - The driver implements the BMC side of the KCS contorller, it - provides the access of KCS IO space for BMC side. - -+config PHYTIUM_KCS_IPMI_BMC -+ depends on ARCH_PHYTIUM -+ select IPMI_KCS_BMC -+ select REGMAP_MMIO -+ tristate "PHYTIUM KCS IPMI BMC driver" -+ help -+ Provides a driver for the KCS (Keyboard Controller Style) IPMI -+ interface found on Phytium SOCs. -+ -+ The driver implements the BMC side of the KCS contorller, it -+ provides the access of KCS IO space for BMC side. -+ -+config PHYTIUM_BT_IPMI_BMC -+ depends on ARCH_PHYTIUM -+ depends on REGMAP && REGMAP_MMIO && MFD_SYSCON -+ tristate "PHYTIUM BT BMC driver" -+ help -+ Provides a driver for the BT (Block Transfer) interface found -+ on Phytium SOCs. The driver implements the BMC side of -+ the BT interface. -+ - config NPCM7XX_KCS_IPMI_BMC - depends on ARCH_NPCM || COMPILE_TEST - select IPMI_KCS_BMC -diff --git a/drivers/char/ipmi/Makefile b/drivers/char/ipmi/Makefile -index cb6138b8d..e0f2d90e1 100644 ---- a/drivers/char/ipmi/Makefile -+++ b/drivers/char/ipmi/Makefile -@@ -31,3 +31,5 @@ obj-$(CONFIG_ASPEED_KCS_IPMI_BMC) += kcs_bmc_aspeed.o - obj-$(CONFIG_NPCM7XX_KCS_IPMI_BMC) += kcs_bmc_npcm7xx.o - obj-$(CONFIG_IPMB_DEVICE_INTERFACE) += ipmb_dev_int.o - obj-$(CONFIG_SSIF_IPMI_BMC) += ssif_bmc.o -+obj-$(CONFIG_PHYTIUM_KCS_IPMI_BMC) += kcs_bmc_phytium.o -+obj-$(CONFIG_PHYTIUM_BT_IPMI_BMC) += bt_bmc_phytium.o -diff --git a/drivers/char/ipmi/bt_bmc_phytium.c b/drivers/char/ipmi/bt_bmc_phytium.c -new file mode 100644 -index 000000000..1d4a50c14 ---- /dev/null -+++ b/drivers/char/ipmi/bt_bmc_phytium.c -@@ -0,0 +1,533 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from drivers/char/ipmi/bt-bmc.c -+ * Copyright (c) 2015-2016, IBM Corporation. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/* -+ * This is a BMC device used to communicate to the host -+ */ -+#define DEVICE_NAME "ipmi-bt-host" -+ -+#define BT_IO_BASE 0xe4 -+#define BT_IRQ 10 -+ -+#define LPC_HICR0 0x00 -+#define LPC_HICR0_LPC3E BIT(7) -+#define LPC_HICR0_LPC2E BIT(6) -+#define LPC_HICR0_LPC1E BIT(5) -+#define LPC_HICR0_SDWNE BIT(3) /* 0:disabl,1:enable for HICR1_SDWNB */ -+#define LPC_HICR0_PMEE BIT(2) /* 0:disabl,1:enable for HICR1_PMEB */ -+ -+#define LPC_HICR2 0x08 -+#define LPC_HICR2_IBFIF3 BIT(3) /* 0:normal,1:enable irq 3*/ -+ -+#define LPC_HICR4 0x10 -+#define LPC_HICR4_LADR12AS BIT(7) -+#define LPC_HICR4_KCSENBL BIT(2) -+#define LPC_BTENABLE BIT(0) /* share bt channel enable,0:disable,1:enable */ -+#define LPC_LADR3H_BT 0x014 -+#define LPC_LADR3L_BT 0x018 -+ -+#define BT_CR1 0x4C -+#define BT_CR1_IRQ_H2B 0x04 -+#define BT_CR1_IRQ_HWRST 0x40 -+ -+#define BT_CSR1 0x54 -+#define BT_CSR1_IRQ_H2B 0x04 -+#define BT_CSR1_IRQ_HWRST 0x40 -+ -+#define BT_CTRL 0x58 -+#define BT_CTRL_B_BUSY 0x80 -+#define BT_CTRL_H_BUSY 0x40 -+#define BT_CTRL_OEM0 0x20 -+#define BT_CTRL_SMS_ATN 0x10 -+#define BT_CTRL_B2H_ATN 0x08 -+#define BT_CTRL_H2B_ATN 0x04 -+#define BT_CTRL_CLR_RD_PTR 0x02 -+#define BT_CTRL_CLR_WR_PTR 0x01 -+#define BT_BMC2HOST 0x5C -+#define BT_HOST2BMC 0x98 -+#define BT_INTMASK 0x60 -+#define BT_INTMASK_B2H_IRQEN 0x01 -+#define BT_INTMASK_B2H_IRQ 0x02 -+#define BT_INTMASK_BMC_HWRST 0x80 -+ -+#define BT_BMC_BUFFER_SIZE 256 -+ -+struct bt_bmc { -+ struct device dev; -+ struct miscdevice miscdev; -+ struct regmap *map; -+ int irq; -+ wait_queue_head_t queue; -+ struct timer_list poll_timer; -+ struct mutex mutex; -+}; -+ -+static atomic_t open_count = ATOMIC_INIT(0); -+ -+static const struct regmap_config bt_regmap_cfg = { -+ .reg_bits = 32, -+ .val_bits = 32, -+ .reg_stride = 4, -+}; -+ -+static u8 bt_inb(struct bt_bmc *bt_bmc, int reg) -+{ -+ uint32_t val = 0; -+ int rc; -+ -+ rc = regmap_read(bt_bmc->map, reg, &val); -+ WARN(rc != 0, "regmap_read() failed: %d\n", rc); -+ -+ return rc == 0 ? (u8) val : 0; -+} -+ -+static void bt_outb(struct bt_bmc *bt_bmc, u8 data, int reg) -+{ -+ int rc; -+ -+ rc = regmap_write(bt_bmc->map, reg, data); -+ WARN(rc != 0, "regmap_write() failed: %d\n", rc); -+} -+ -+static void clr_rd_ptr(struct bt_bmc *bt_bmc) -+{ -+ bt_outb(bt_bmc, BT_CTRL_CLR_RD_PTR, BT_CTRL); -+} -+ -+static void clr_wr_ptr(struct bt_bmc *bt_bmc) -+{ -+ bt_outb(bt_bmc, BT_CTRL_CLR_WR_PTR, BT_CTRL); -+} -+ -+static void clr_h2b_atn(struct bt_bmc *bt_bmc) -+{ -+ bt_outb(bt_bmc, 0, BT_CTRL); -+} -+ -+static void set_b_busy(struct bt_bmc *bt_bmc) -+{ -+ if (!(bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_B_BUSY)) -+ bt_outb(bt_bmc, BT_CTRL_B_BUSY, BT_CTRL); -+} -+ -+static void clr_b_busy(struct bt_bmc *bt_bmc) -+{ -+ if (bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_B_BUSY) -+ bt_outb(bt_bmc, 0, BT_CTRL); -+} -+ -+static void set_b2h_atn(struct bt_bmc *bt_bmc) -+{ -+ bt_outb(bt_bmc, BT_CTRL_B2H_ATN, BT_CTRL); -+} -+ -+static u8 bt_read(struct bt_bmc *bt_bmc) -+{ -+ return bt_inb(bt_bmc, BT_HOST2BMC); -+} -+ -+static ssize_t bt_readn(struct bt_bmc *bt_bmc, u8 *buf, size_t n) -+{ -+ int i; -+ -+ for (i = 0; i < n; i++) -+ buf[i] = bt_read(bt_bmc); -+ return n; -+} -+ -+static void bt_write(struct bt_bmc *bt_bmc, u8 c) -+{ -+ bt_outb(bt_bmc, c, BT_BMC2HOST); -+} -+ -+static ssize_t bt_writen(struct bt_bmc *bt_bmc, u8 *buf, size_t n) -+{ -+ int i; -+ -+ for (i = 0; i < n; i++) -+ bt_write(bt_bmc, buf[i]); -+ return n; -+} -+ -+static void set_sms_atn(struct bt_bmc *bt_bmc) -+{ -+ bt_outb(bt_bmc, BT_CTRL_SMS_ATN, BT_CTRL); -+} -+ -+static struct bt_bmc *file_bt_bmc(struct file *file) -+{ -+ return container_of(file->private_data, struct bt_bmc, miscdev); -+} -+ -+static int bt_bmc_open(struct inode *inode, struct file *file) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ -+ if (atomic_inc_return(&open_count) == 1) { -+ clr_b_busy(bt_bmc); -+ return 0; -+ } -+ -+ atomic_dec(&open_count); -+ -+ return -EBUSY; -+} -+ -+/* -+ * The BT (Block Transfer) interface means that entire messages are -+ * buffered by the host before a notification is sent to the BMC that -+ * there is data to be read. The first byte is the length and the -+ * message data follows. The read operation just tries to capture the -+ * whole before returning it to userspace. -+ * -+ * BT Message format : -+ * -+ * Byte 1 Byte 2 Byte 3 Byte 4 Byte 5:N -+ * Length NetFn/LUN Seq Cmd Data -+ * -+ */ -+static ssize_t bt_bmc_read(struct file *file, char __user *buf, -+ size_t count, loff_t *ppos) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ u8 len; -+ int len_byte = 1; -+ u8 kbuffer[BT_BMC_BUFFER_SIZE]; -+ ssize_t ret = 0; -+ ssize_t nread; -+ -+ WARN_ON(*ppos); -+ -+ if (wait_event_interruptible(bt_bmc->queue, -+ bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_H2B_ATN)) -+ return -ERESTARTSYS; -+ -+ mutex_lock(&bt_bmc->mutex); -+ -+ if (unlikely(!(bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_H2B_ATN))) { -+ ret = -EIO; -+ goto out_unlock; -+ } -+ -+ set_b_busy(bt_bmc); -+ clr_h2b_atn(bt_bmc); -+ clr_rd_ptr(bt_bmc); -+ -+ /* -+ * The BT frames start with the message length, which does not -+ * include the length byte. -+ */ -+ kbuffer[0] = bt_read(bt_bmc); -+ len = kbuffer[0]; -+ -+ /* We pass the length back to userspace as well */ -+ if (len + 1 > count) -+ len = count - 1; -+ -+ while (len) { -+ nread = min_t(ssize_t, len, sizeof(kbuffer) - len_byte); -+ -+ bt_readn(bt_bmc, kbuffer + len_byte, nread); -+ -+ if (copy_to_user(buf, kbuffer, nread + len_byte)) { -+ ret = -EFAULT; -+ break; -+ } -+ len -= nread; -+ buf += nread + len_byte; -+ ret += nread + len_byte; -+ len_byte = 0; -+ } -+ -+ clr_b_busy(bt_bmc); -+ -+out_unlock: -+ mutex_unlock(&bt_bmc->mutex); -+ return ret; -+} -+ -+/* -+ * BT Message response format : -+ * -+ * Byte 1 Byte 2 Byte 3 Byte 4 Byte 5 Byte 6:N -+ * Length NetFn/LUN Seq Cmd Code Data -+ */ -+static ssize_t bt_bmc_write(struct file *file, const char __user *buf, -+ size_t count, loff_t *ppos) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ u8 kbuffer[BT_BMC_BUFFER_SIZE]; -+ ssize_t ret = 0; -+ ssize_t nwritten; -+ -+ /* -+ * send a minimum response size -+ */ -+ if (count < 5) -+ return -EINVAL; -+ -+ WARN_ON(*ppos); -+ -+ /* -+ * There's no interrupt for clearing bmc busy so we have to -+ * poll -+ */ -+ if (wait_event_interruptible(bt_bmc->queue, -+ !(bt_inb(bt_bmc, BT_CTRL) & -+ (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN)))) -+ return -ERESTARTSYS; -+ -+ mutex_lock(&bt_bmc->mutex); -+ -+ if (unlikely(bt_inb(bt_bmc, BT_CTRL) & -+ (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN))) { -+ ret = -EIO; -+ goto out_unlock; -+ } -+ -+ clr_wr_ptr(bt_bmc); -+ -+ while (count) { -+ nwritten = min_t(ssize_t, count, sizeof(kbuffer)); -+ if (copy_from_user(&kbuffer, buf, nwritten)) { -+ ret = -EFAULT; -+ break; -+ } -+ -+ bt_writen(bt_bmc, kbuffer, nwritten); -+ -+ count -= nwritten; -+ buf += nwritten; -+ ret += nwritten; -+ } -+ -+ set_b2h_atn(bt_bmc); -+ -+out_unlock: -+ mutex_unlock(&bt_bmc->mutex); -+ return ret; -+} -+ -+static long bt_bmc_ioctl(struct file *file, unsigned int cmd, -+ unsigned long param) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ -+ switch (cmd) { -+ case BT_BMC_IOCTL_SMS_ATN: -+ set_sms_atn(bt_bmc); -+ return 0; -+ } -+ return -EINVAL; -+} -+ -+static int bt_bmc_release(struct inode *inode, struct file *file) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ -+ atomic_dec(&open_count); -+ set_b_busy(bt_bmc); -+ return 0; -+} -+ -+static __poll_t bt_bmc_poll(struct file *file, poll_table *wait) -+{ -+ struct bt_bmc *bt_bmc = file_bt_bmc(file); -+ __poll_t mask = 0; -+ u8 ctrl; -+ -+ poll_wait(file, &bt_bmc->queue, wait); -+ -+ ctrl = bt_inb(bt_bmc, BT_CTRL); -+ -+ if (ctrl & BT_CTRL_H2B_ATN) -+ mask |= EPOLLIN; -+ -+ if (!(ctrl & (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN))) -+ mask |= EPOLLOUT; -+ -+ return mask; -+} -+ -+static const struct file_operations bt_bmc_fops = { -+ .owner = THIS_MODULE, -+ .open = bt_bmc_open, -+ .read = bt_bmc_read, -+ .write = bt_bmc_write, -+ .release = bt_bmc_release, -+ .poll = bt_bmc_poll, -+ .unlocked_ioctl = bt_bmc_ioctl, -+}; -+ -+static void poll_timer(struct timer_list *t) -+{ -+ struct bt_bmc *bt_bmc = from_timer(bt_bmc, t, poll_timer); -+ -+ bt_bmc->poll_timer.expires += msecs_to_jiffies(500); -+ wake_up(&bt_bmc->queue); -+ add_timer(&bt_bmc->poll_timer); -+} -+ -+static irqreturn_t bt_bmc_irq(int irq, void *arg) -+{ -+ struct bt_bmc *bt_bmc = arg; -+ u32 reg, intmsk; -+ int rc; -+ -+ rc = regmap_read(bt_bmc->map, BT_CR1, ®); -+ if (rc) -+ return IRQ_NONE; -+ -+ reg &= BT_CR1_IRQ_H2B | BT_CR1_IRQ_HWRST; -+ if (!reg) -+ return IRQ_NONE; -+ -+ /* ack pending IRQs */ -+ regmap_write(bt_bmc->map, BT_CR1, 0); -+ -+ if (reg & BT_CR1_IRQ_HWRST) { -+ regmap_read(bt_bmc->map, BT_INTMASK, &intmsk); -+ if (intmsk & BT_INTMASK_BMC_HWRST) -+ regmap_write(bt_bmc->map, BT_INTMASK, 0); -+ } -+ -+ wake_up(&bt_bmc->queue); -+ return IRQ_HANDLED; -+} -+ -+static int bt_bmc_config_irq(struct bt_bmc *bt_bmc, -+ struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ int rc; -+ -+ bt_bmc->irq = platform_get_irq(pdev, 0); -+ if (!bt_bmc->irq) -+ return -ENODEV; -+ -+ rc = devm_request_irq(dev, bt_bmc->irq, bt_bmc_irq, IRQF_SHARED, -+ DEVICE_NAME, bt_bmc); -+ if (rc < 0) { -+ dev_warn(dev, "Unable to request IRQ %d\n", bt_bmc->irq); -+ bt_bmc->irq = 0; -+ return rc; -+ } -+ -+ /* -+ * Configure IRQs on the bmc clearing the H2B and HBUSY bits; -+ * H2B will be asserted when the bmc has data for us; HBUSY -+ * will be cleared (along with B2H) when we can write the next -+ * message to the BT buffer -+ */ -+ rc = regmap_update_bits(bt_bmc->map, BT_CSR1, -+ BT_CSR1_IRQ_H2B | BT_CSR1_IRQ_HWRST, -+ BT_CSR1_IRQ_H2B | BT_CSR1_IRQ_HWRST); -+ -+ return rc; -+} -+ -+static int bt_bmc_probe(struct platform_device *pdev) -+{ -+ struct bt_bmc *bt_bmc; -+ struct device *dev; -+ int rc; -+ -+ if (!pdev || !pdev->dev.of_node) -+ return -ENODEV; -+ -+ dev = &pdev->dev; -+ dev_info(dev, "Found bt bmc device\n"); -+ -+ bt_bmc = devm_kzalloc(dev, sizeof(*bt_bmc), GFP_KERNEL); -+ if (!bt_bmc) -+ return -ENOMEM; -+ -+ dev_set_drvdata(&pdev->dev, bt_bmc); -+ -+ bt_bmc->map = syscon_node_to_regmap(pdev->dev.parent->of_node); -+ -+ mutex_init(&bt_bmc->mutex); -+ init_waitqueue_head(&bt_bmc->queue); -+ -+ bt_bmc->miscdev.minor = MISC_DYNAMIC_MINOR, -+ bt_bmc->miscdev.name = DEVICE_NAME, -+ bt_bmc->miscdev.fops = &bt_bmc_fops, -+ bt_bmc->miscdev.parent = dev; -+ rc = misc_register(&bt_bmc->miscdev); -+ if (rc) { -+ dev_err(dev, "Unable to register misc device\n"); -+ return rc; -+ } -+ -+ bt_bmc_config_irq(bt_bmc, pdev); -+ -+ if (bt_bmc->irq) { -+ dev_info(dev, "Using IRQ %d\n", bt_bmc->irq); -+ } else { -+ dev_info(dev, "No IRQ; using timer\n"); -+ timer_setup(&bt_bmc->poll_timer, poll_timer, 0); -+ bt_bmc->poll_timer.expires = jiffies + msecs_to_jiffies(10); -+ add_timer(&bt_bmc->poll_timer); -+ } -+ -+ regmap_update_bits(bt_bmc->map, LPC_HICR0, LPC_HICR0_LPC3E, LPC_HICR0_LPC3E); -+ regmap_update_bits(bt_bmc->map, LPC_HICR4, LPC_BTENABLE, LPC_BTENABLE); -+ regmap_write(bt_bmc->map, LPC_LADR3H_BT, BT_IO_BASE >> 8); -+ regmap_write(bt_bmc->map, LPC_LADR3L_BT, BT_IO_BASE); -+ regmap_update_bits(bt_bmc->map, LPC_HICR2, LPC_HICR2_IBFIF3, LPC_HICR2_IBFIF3); -+ clr_b_busy(bt_bmc); -+ -+ return 0; -+} -+ -+static int bt_bmc_remove(struct platform_device *pdev) -+{ -+ struct bt_bmc *bt_bmc = dev_get_drvdata(&pdev->dev); -+ -+ misc_deregister(&bt_bmc->miscdev); -+ if (!bt_bmc->irq) -+ del_timer_sync(&bt_bmc->poll_timer); -+ -+ return 0; -+} -+ -+static const struct of_device_id bt_bmc_match[] = { -+ { .compatible = "phytium,bt-bmc" }, -+ { }, -+}; -+MODULE_DEVICE_TABLE(of, bt_bmc_match); -+ -+static struct platform_driver bt_bmc_driver = { -+ .driver = { -+ .name = DEVICE_NAME, -+ .of_match_table = bt_bmc_match, -+ }, -+ .probe = bt_bmc_probe, -+ .remove = bt_bmc_remove, -+}; -+ -+module_platform_driver(bt_bmc_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Cheng Quan -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "kcs_bmc_device.h" -+ -+#define DEVICE_NAME "phytium-kcs-bmc" -+ -+#define KCS_CHANNEL_MAX 4 -+ -+/* mapped to lpc-bmc@0 IO space */ -+#define LPC_HICR0 0x000 -+#define LPC_HICR0_LPC3E BIT(7) -+#define LPC_HICR0_LPC2E BIT(6) -+#define LPC_HICR0_LPC1E BIT(5) -+#define LPC_HICR0_SDWNE BIT(3) /* 0:disabl,1:enable for HICR1_SDWNB */ -+#define LPC_HICR0_PMEE BIT(2) /* 0:disabl,1:enable for HICR1_PMEB */ -+#define LPC_HICR1 0x004 -+#define LPC_HICR1_LPCBSY BIT(7) /* 0:idle,1:trans busy */ -+#define LPC_HICR1_IRQBSY BIT(5) /* 0:idle,1:trans data */ -+#define LPC_HICR1_LPCSWRST BIT(4) /* 0:normal,1:reset */ -+#define LPC_HICR1_SDWNB BIT(3) /* 0:normal,1:software shutdown */ -+#define LPC_HICR1_PMEB BIT(2) /* 0:LPCPD low,1:LPCPD high */ -+#define LPC_HICR2 0x008 -+#define LPC_LPCSWRST_ERRIRQ BIT(6) /* 0:normal,1:reset irq */ -+#define LPC_SDWN_ERRIRQ BIT(5) /* 0:normal,1:lpcpd irq */ -+#define LPC_ABRT_ERRIRQ BIT(4) /* 0:normal,1:lframe low when busy*/ -+#define LPC_HICR2_IBFIF3 BIT(3) /* 0:normal,1:enable irq 3*/ -+#define LPC_HICR2_IBFIF2 BIT(2) -+#define LPC_HICR2_IBFIF1 BIT(1) -+/* 0:normal,1:enable err irq-reset,power down,abort */ -+#define LPC_HICR2_ERRIE BIT(0) -+#define LPC_HICR3 0x00C -+#define LPC_LFRAME_STATUS BIT(7) /* R */ -+#define LPC_SERIRQ_STATUS BIT(5) /* R */ -+#define LPC_LREST_STATUS BIT(4) /* R */ -+#define LPC_LPCPD_STATUS BIT(3) /* R */ -+#define LPC_PME_STATUS BIT(2) /* R */ -+#define LPC_HICR4 0x010 -+#define LPC_HICR4_LADR12AS BIT(7) -+#define LPC_HICR4_KCSENBL BIT(2) -+#define LPC_BTENABLE BIT(0) /* share bt channel enable,0:disable,1:enable */ -+#define LPC_LADR3H 0x014 -+#define LPC_LADR3L 0x018 -+#define LPC_LADR12H 0x01C -+#define LPC_LADR12L 0x020 -+#define LPC_IDR1 0x024 -+#define LPC_IDR2 0x028 -+#define LPC_IDR3 0x02C -+#define LPC_ODR1 0x030 -+#define LPC_ODR2 0x034 -+#define LPC_ODR3 0x038 -+#define LPC_STR1 0x03C -+#define LPC_STR2 0x040 -+#define LPC_STR3 0x044 -+ -+#define LPC_HICRB 0x80 -+#define LPC_HICRB_IBFIF4 BIT(1) -+#define LPC_HICRB_LPC4E BIT(0) -+#define LPC_LADR4 0x88 -+#define LPC_IDR4 0x8c -+#define LPC_ODR4 0x90 -+#define LPC_STR4 0x94 -+ -+#define OBE_POLL_PERIOD (HZ / 2) -+struct phytium_kcs_bmc { -+ struct kcs_bmc_device kcs_bmc; -+ -+ struct regmap *map; -+ -+ struct { -+ spinlock_t lock; -+ bool remove; -+ struct timer_list timer; -+ } obe; -+}; -+ -+struct phytium_kcs_of_ops { -+ int (*get_channel)(struct platform_device *pdev); -+ int (*get_io_address)(struct platform_device *pdev, u32 addr); -+}; -+ -+static inline struct phytium_kcs_bmc *to_phytium_kcs_bmc -+ (struct kcs_bmc_device *kcs_bmc) -+{ -+ return container_of(kcs_bmc, struct phytium_kcs_bmc, kcs_bmc); -+} -+ -+static u8 phytium_kcs_inb(struct kcs_bmc_device *kcs_bmc, u32 reg) -+{ -+ struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); -+ u32 val = 0; -+ int rc; -+ -+ rc = regmap_read(priv->map, reg, &val); -+ WARN(rc != 0, "regmap_read() failed: %d\n", rc); -+ -+ return rc == 0 ? (u8) val : 0; -+} -+ -+static void phytium_kcs_outb(struct kcs_bmc_device *kcs_bmc, u32 reg, u8 data) -+{ -+ struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); -+ int rc; -+ -+ rc = regmap_write(priv->map, reg, data); -+ WARN(rc != 0, "regmap_write() failed: %d\n", rc); -+} -+ -+static void phytium_kcs_updateb(struct kcs_bmc_device *kcs_bmc, u32 reg, u8 mask, u8 val) -+{ -+ struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); -+ int rc; -+ -+ rc = regmap_update_bits(priv->map, reg, mask, val); -+ WARN(rc != 0, "regmap_update_bits() failed: %d\n", rc); -+} -+/* -+ * Background: -+ * we note D for Data, and C for Cmd/Status, default rules are -+ * A. KCS1 / KCS2 ( D / C:X / X+4 ) -+ * D / C : CA0h / CA4h -+ * D / C : CA8h / CACh -+ * B. KCS3 ( D / C:XX2h / XX3h ) -+ * D / C : CA2h / CA3h -+ * D / C : CB2h / CB3h -use -+ * C. KCS4 -+ * D / C : CA4h / CA5h -+ * D / C : CB0h / CB1h -use -+ */ -+static int phytium_kcs_set_address(struct kcs_bmc_device *kcs_bmc, u16 addr) -+{ -+ struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); -+ -+ switch (priv->kcs_bmc.channel) { -+ case 1: -+ regmap_update_bits(priv->map, LPC_HICR4, LPC_HICR4_LADR12AS, 0); -+ regmap_write(priv->map, LPC_LADR12H, addr >> 8); -+ regmap_write(priv->map, LPC_LADR12L, addr & 0xFF); -+ break; -+ case 2: -+ regmap_update_bits(priv->map, LPC_HICR4, -+ LPC_HICR4_LADR12AS, LPC_HICR4_LADR12AS); -+ regmap_write(priv->map, LPC_LADR12H, addr >> 8); -+ regmap_write(priv->map, LPC_LADR12L, addr & 0xFF); -+ break; -+ case 3: -+ regmap_write(priv->map, LPC_LADR3H, addr >> 8); -+ regmap_write(priv->map, LPC_LADR3L, addr & 0xFF); -+ break; -+ case 4: -+ regmap_write(priv->map, LPC_LADR4, ((addr + 1) << 16) | -+ addr); -+ break; -+ default: -+ break; -+ } -+ return 0; -+} -+ -+static void phytium_kcs_enable_channel(struct kcs_bmc_device *kcs_bmc, bool enable) -+{ -+ struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); -+ -+ switch (kcs_bmc->channel) { -+ case 1: -+ if (enable) { -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC1E, LPC_HICR0_LPC1E); -+ } else { -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC1E, 0); -+ } -+ break; -+ case 2: -+ if (enable) { -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC2E, LPC_HICR0_LPC2E); -+ } else { -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC2E, 0); -+ } -+ break; -+ case 3: -+ if (enable) { -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC3E, LPC_HICR0_LPC3E); -+ regmap_update_bits(priv->map, LPC_HICR4, -+ LPC_HICR4_KCSENBL, LPC_HICR4_KCSENBL); -+ } else { -+ regmap_update_bits(priv->map, LPC_HICR0, -+ LPC_HICR0_LPC3E, 0); -+ regmap_update_bits(priv->map, LPC_HICR4, -+ LPC_HICR4_KCSENBL, 0); -+ } -+ break; -+ case 4: -+ if (enable) -+ regmap_update_bits(priv->map, LPC_HICRB, -+ LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E, -+ LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E); -+ else -+ regmap_update_bits(priv->map, LPC_HICRB, -+ LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E, -+ 0); -+ break; -+ default: -+ pr_warn("%s: Unsupported channel: %d", __func__, kcs_bmc->channel); -+ return; -+ } -+} -+ -+static void phytium_kcs_check_obe(struct timer_list *timer) -+{ -+ struct phytium_kcs_bmc *priv = container_of(timer, struct phytium_kcs_bmc, obe.timer); -+ unsigned long flags; -+ u8 str; -+ -+ spin_lock_irqsave(&priv->obe.lock, flags); -+ if (priv->obe.remove) { -+ spin_unlock_irqrestore(&priv->obe.lock, flags); -+ return; -+ } -+ -+ str = phytium_kcs_inb(&priv->kcs_bmc, priv->kcs_bmc.ioreg.str); -+ if (str & KCS_BMC_STR_OBF) { -+ mod_timer(timer, jiffies + OBE_POLL_PERIOD); -+ spin_unlock_irqrestore(&priv->obe.lock, flags); -+ return; -+ } -+ spin_unlock_irqrestore(&priv->obe.lock, flags); -+ -+ kcs_bmc_handle_event(&priv->kcs_bmc); -+} -+ -+static void phytium_kcs_irq_mask_update(struct kcs_bmc_device *kcs_bmc, u8 mask, u8 state) -+{ -+ struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); -+ -+ if (mask & KCS_BMC_EVENT_TYPE_OBE) { -+ if (KCS_BMC_EVENT_TYPE_OBE & state) -+ mod_timer(&priv->obe.timer, jiffies + OBE_POLL_PERIOD); -+ else -+ del_timer(&priv->obe.timer); -+ } -+ -+ if (mask & KCS_BMC_EVENT_TYPE_IBF) { -+ const bool enable = !!(state & KCS_BMC_EVENT_TYPE_IBF); -+ -+ switch (kcs_bmc->channel) { -+ case 1: -+ regmap_update_bits(priv->map, LPC_HICR2, LPC_HICR2_IBFIF1, -+ enable * LPC_HICR2_IBFIF1); -+ return; -+ case 2: -+ regmap_update_bits(priv->map, LPC_HICR2, LPC_HICR2_IBFIF2, -+ enable * LPC_HICR2_IBFIF2); -+ return; -+ case 3: -+ regmap_update_bits(priv->map, LPC_HICR2, LPC_HICR2_IBFIF3, -+ enable * LPC_HICR2_IBFIF3); -+ return; -+ case 4: -+ regmap_update_bits(priv->map, LPC_HICRB, LPC_HICRB_IBFIF4, -+ enable * LPC_HICRB_IBFIF4); -+ return; -+ default: -+ pr_warn("%s: Unsupported channel: %d", __func__, kcs_bmc->channel); -+ return; -+ } -+ } -+} -+ -+ -+static const struct kcs_bmc_device_ops phytium_kcs_ops = { -+ .irq_mask_update = phytium_kcs_irq_mask_update, -+ .io_inputb = phytium_kcs_inb, -+ .io_outputb = phytium_kcs_outb, -+ .io_updateb = phytium_kcs_updateb, -+}; -+ -+static irqreturn_t phytium_kcs_irq(int irq, void *arg) -+{ -+ struct kcs_bmc_device *kcs_bmc = arg; -+ -+ return kcs_bmc_handle_event(kcs_bmc); -+} -+ -+static int phytium_kcs_config_irq(struct kcs_bmc_device *kcs_bmc, -+ struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ int irq; -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) -+ return irq; -+ -+ return devm_request_irq(dev, irq, phytium_kcs_irq, IRQF_SHARED, -+ dev_name(dev), kcs_bmc); -+} -+ -+static const struct kcs_ioreg phytium_kcs_bmc_ioregs[KCS_CHANNEL_MAX] = { -+ { .idr = LPC_IDR1, .odr = LPC_ODR1, .str = LPC_STR1 }, -+ { .idr = LPC_IDR2, .odr = LPC_ODR2, .str = LPC_STR2 }, -+ { .idr = LPC_IDR3, .odr = LPC_ODR3, .str = LPC_STR3 }, -+ { .idr = LPC_IDR4, .odr = LPC_ODR4, .str = LPC_STR4 }, -+ -+}; -+ -+static int phytium_kcs_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct phytium_kcs_bmc *priv; -+ struct kcs_bmc_device *kcs_bmc; -+ struct device_node *np; -+ u32 chan, addr; -+ int rc; -+ -+ rc = of_property_read_u32(dev->of_node, "kcs_chan", &chan); -+ if ((rc != 0) || (chan == 0 || chan > KCS_CHANNEL_MAX)) { -+ dev_err(dev, "no valid 'kcs_chan' configured\n"); -+ return -ENODEV; -+ } -+ rc = of_property_read_u32(dev->of_node, "kcs_addr", &addr); -+ if (rc) { -+ dev_err(dev, "no valid 'kcs_addr' configured\n"); -+ return -ENODEV; -+ } -+ -+ np = pdev->dev.of_node; -+ -+ priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); -+ if (!priv) -+ return -ENOMEM; -+ -+ kcs_bmc = &priv->kcs_bmc; -+ kcs_bmc->dev = &pdev->dev; -+ kcs_bmc->channel = chan; -+ kcs_bmc->ioreg = phytium_kcs_bmc_ioregs[chan - 1]; -+ kcs_bmc->ops = &phytium_kcs_ops; -+ -+ priv->map = syscon_node_to_regmap(pdev->dev.parent->of_node); -+ if (IS_ERR(priv->map)) { -+ dev_err(&pdev->dev, "Couldn't get regmap\n"); -+ return -ENODEV; -+ } -+ -+ spin_lock_init(&priv->obe.lock); -+ priv->obe.remove = false; -+ timer_setup(&priv->obe.timer, phytium_kcs_check_obe, 0); -+ -+ rc = phytium_kcs_set_address(kcs_bmc, addr); -+ if (rc) -+ return rc; -+ -+ rc = phytium_kcs_config_irq(kcs_bmc, pdev); -+ if (rc) -+ return rc; -+ -+ platform_set_drvdata(pdev, priv); -+ -+ phytium_kcs_irq_mask_update(kcs_bmc, (KCS_BMC_EVENT_TYPE_IBF | KCS_BMC_EVENT_TYPE_OBE), 0); -+ -+ phytium_kcs_enable_channel(kcs_bmc, true); -+ -+ rc = kcs_bmc_add_device(&priv->kcs_bmc); -+ if (rc) { -+ dev_warn(&pdev->dev, "Failed to register channel %d: %d\n", -+ kcs_bmc->channel, rc); -+ return rc; -+ } -+ -+ dev_info(&pdev->dev, "Initialised channel %d at 0x%x\n", -+ kcs_bmc->channel, addr); -+ -+ return 0; -+} -+ -+static int phytium_kcs_remove(struct platform_device *pdev) -+{ -+ struct phytium_kcs_bmc *priv = platform_get_drvdata(pdev); -+ struct kcs_bmc_device *kcs_bmc = &priv->kcs_bmc; -+ -+ kcs_bmc_remove_device(kcs_bmc); -+ phytium_kcs_enable_channel(kcs_bmc, false); -+ phytium_kcs_irq_mask_update(kcs_bmc, (KCS_BMC_EVENT_TYPE_IBF | KCS_BMC_EVENT_TYPE_OBE), 0); -+ -+ spin_lock_irq(&priv->obe.lock); -+ priv->obe.remove = true; -+ spin_unlock_irq(&priv->obe.lock); -+ del_timer_sync(&priv->obe.timer); -+ return 0; -+} -+ -+static const struct of_device_id phytium_kcs_bmc_match[] = { -+ { .compatible = "phytium,kcs-bmc", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_kcs_bmc_match); -+ -+static struct platform_driver phytium_kcs_bmc_driver = { -+ .driver = { -+ .name = DEVICE_NAME, -+ .of_match_table = phytium_kcs_bmc_match, -+ }, -+ .probe = phytium_kcs_probe, -+ .remove = phytium_kcs_remove, -+}; -+module_platform_driver(phytium_kcs_bmc_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_DESCRIPTION("Phytium device interface to the KCS BMC device"); -diff --git a/drivers/char/phytnetled/Kconfig b/drivers/char/phytnetled/Kconfig -new file mode 100644 -index 000000000..26691906d ---- /dev/null -+++ b/drivers/char/phytnetled/Kconfig -@@ -0,0 +1,13 @@ -+# SPDX-License-Identifier: GPL-2.0-only -+# -+# PCMCIA character device configuration -+# -+config PHYTNET_LED -+ tristate "Phytium mac led control module" -+ depends on PHYTMAC -+ depends on GPIO_PHYTIUM_PLAT -+ default m -+ help -+ If you have a network (Ethernet) controller of this type and -+ want to use it control port led say Y or M here. -+ -diff --git a/drivers/char/phytnetled/Makefile b/drivers/char/phytnetled/Makefile -new file mode 100644 -index 000000000..781bc90c1 ---- /dev/null -+++ b/drivers/char/phytnetled/Makefile -@@ -0,0 +1 @@ -+obj-$(CONFIG_PHYTNET_LED) += phytnet_led.o -\ No newline at end of file -diff --git a/drivers/char/phytnetled/phytnet_led.c b/drivers/char/phytnetled/phytnet_led.c -new file mode 100644 -index 000000000..e9425f29a ---- /dev/null -+++ b/drivers/char/phytnetled/phytnet_led.c -@@ -0,0 +1,320 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (C) 2022-2023 Phytium Technology Co.,Ltd. -+ * -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytnet_led.h" -+ -+#define DRIVER_NAME "phytnet_led" -+#define DRIVER_VERSION "1.0" -+#define DRIVER_AUTHOR "LongShixiang " -+#define DRIVER_DESC "net device led control module" -+#define NET_DEV_PROPNAME "net_dev" -+#define LED_OF_NAME "led" -+#define CHECK_INTERVAL 125 /* Unit: ms */ -+#define NDEV_CHECK_DELAY 30000 /* Unit: 30s */ -+#define LED_ON 1 -+#define LED_OFF 0 -+#define LINK_OFFSET 0 -+#define ACT_OFFSET 1 -+ -+#if defined(CONFIG_OF) -+static const struct of_device_id phytnet_led_of_ids[] = { -+ { .compatible = "phytium,net_led"}, -+ {} -+}; -+ -+MODULE_DEVICE_TABLE(of, phytnet_led_of_ids); -+#endif /* CONFIG_OF */ -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytnet_acpi_ids[] = { -+ { .id = "PHYT800C"}, -+ {} -+}; -+MODULE_DEVICE_TABLE(acpi, phytnet_acpi_ids); -+#else -+#define phytnet_acpi_ids NULL -+#endif /* CONFIG_ACPI */ -+ -+static void -+led_on(struct gpio_desc *gd) -+{ -+ gpiod_set_value(gd, LED_ON); -+} -+ -+static void -+led_off(struct gpio_desc *gd) -+{ -+ gpiod_set_value(gd, LED_OFF); -+} -+ -+static void -+led_blink(struct led_data *phytnet_led) -+{ -+ phytnet_led->act_val = !phytnet_led->act_val; -+ gpiod_set_value(phytnet_led->act, phytnet_led->act_val); -+} -+ -+static int -+port_is_linkup(struct led_data *phytnet_led) -+{ -+ if (netif_carrier_ok(phytnet_led->ndev)) -+ return true; -+ else -+ return false; -+} -+ -+static bool -+port_is_act(struct led_data *phytnet_led) -+{ -+ bool ret = false; -+ -+ if (phytnet_led->ndev_rx != phytnet_led->ndev->stats.rx_packets) { -+ phytnet_led->ndev_rx = phytnet_led->ndev->stats.rx_packets; -+ ret = true; -+ } -+ -+ if (phytnet_led->ndev_tx != phytnet_led->ndev->stats.tx_packets) { -+ phytnet_led->ndev_tx = phytnet_led->ndev->stats.tx_packets; -+ ret = true; -+ } -+ -+ return ret; -+} -+ -+static void -+led_control(struct led_data *phytnet_led) -+{ -+ while (!phytnet_led->led_stop) { -+ msleep(CHECK_INTERVAL); -+ -+ if (!netif_running(phytnet_led->ndev)) { -+ led_off(phytnet_led->link); -+ led_off(phytnet_led->act); -+ continue; -+ } -+ -+ if (port_is_linkup(phytnet_led)) -+ led_on(phytnet_led->link); -+ else -+ led_off(phytnet_led->link); -+ -+ if (port_is_act(phytnet_led)) -+ led_blink(phytnet_led); -+ else -+ led_off(phytnet_led->act); -+ } -+} -+ -+static int -+of_ndev_init(struct led_data *phytnet_led) -+{ -+ struct device_node *net_node; -+ -+ net_node = of_parse_phandle(phytnet_led->pdev->dev.of_node, NET_DEV_PROPNAME, 0); -+ if (!net_node) { -+ dev_err(&phytnet_led->pdev->dev, "Failed to get netdev ofnode from device tree\n"); -+ return -ENODEV; -+ } -+ -+ phytnet_led->ndev = of_find_net_device_by_node(net_node); -+ -+ if (!phytnet_led->ndev) { -+ dev_err(&phytnet_led->pdev->dev, "Failed to get acpi ndev\n"); -+ return -ENODEV; -+ } -+ -+ dev_info(&phytnet_led->pdev->dev, "Successfully get ndev...\n"); -+ dev_hold(phytnet_led->ndev); -+ -+ return 0; -+} -+ -+ -+static int -+acpi_ndev_init(struct led_data *phytnet_led) -+{ -+ int err; -+ struct net_device *find_ndev; -+ const char *ndev_acpi_path; -+ acpi_handle net_handler; -+ struct acpi_device *adev; -+ acpi_status status; -+ struct device *find_dev; -+ -+ err = device_property_read_string(&phytnet_led->pdev->dev, -+ NET_DEV_PROPNAME, -+ &ndev_acpi_path); -+ if (err) { -+ dev_err(&phytnet_led->pdev->dev, "Failed to read net_dev property!\n"); -+ return -ENODEV; -+ } -+ -+ status = acpi_get_handle(NULL, (acpi_string)ndev_acpi_path, &net_handler); -+ if (ACPI_FAILURE(status)) { -+ dev_err(&phytnet_led->pdev->dev, "Failed to get acpi handler path: %s\n", -+ ndev_acpi_path); -+ return -ENODEV; -+ } -+ -+ adev = acpi_get_acpi_dev(net_handler); -+ if (!err) { -+ dev_err(&phytnet_led->pdev->dev, "Failed to get adev dev\n"); -+ return -ENODEV; -+ } -+ -+ for_each_netdev(&init_net, find_ndev) { -+ if (find_ndev->dev.parent != NULL) { -+ find_dev = find_ndev->dev.parent; -+ if (&adev->fwnode == find_dev->fwnode) -+ phytnet_led->ndev = find_ndev; -+ } -+ } -+ -+ if (!phytnet_led->ndev) { -+ dev_err(&phytnet_led->pdev->dev, "Failed to get acpi ndev\n"); -+ return -ENODEV; -+ } -+ -+ dev_info(&phytnet_led->pdev->dev, "Successfully get ndev...\n"); -+ dev_hold(phytnet_led->ndev); -+ -+ return 0; -+} -+ -+static int -+gpio_init(struct led_data *phytnet_led) -+{ -+ int err; -+ -+ phytnet_led->link = gpiod_get_index(&phytnet_led->pdev->dev, -+ LED_OF_NAME, -+ LINK_OFFSET, -+ GPIOD_OUT_HIGH); -+ if (IS_ERR(phytnet_led->link)) { -+ dev_err(&phytnet_led->pdev->dev, "Failed to get link gpio, err: %ld\n", -+ PTR_ERR(phytnet_led->link)); -+ return PTR_ERR(phytnet_led->link); -+ } -+ -+ err = gpiod_direction_output(phytnet_led->link, LED_OFF); -+ if (err) { -+ dev_err(&phytnet_led->pdev->dev, "Failed to set link dir, err: %ld\n", -+ PTR_ERR(phytnet_led->link)); -+ return err; -+ } -+ -+ phytnet_led->act = gpiod_get_index(&phytnet_led->pdev->dev, -+ LED_OF_NAME, -+ ACT_OFFSET, -+ GPIOD_OUT_HIGH); -+ if (IS_ERR(phytnet_led->act)) { -+ dev_err(&phytnet_led->pdev->dev, "Failed to get act gpio, err:%d\n", err); -+ return PTR_ERR(phytnet_led->act); -+ } -+ -+ err = gpiod_direction_output(phytnet_led->act, LED_OFF); -+ if (err) { -+ dev_err(&phytnet_led->pdev->dev, "Failed to set act dir, err: %d\n", err); -+ return err; -+ } -+ -+ return 0; -+} -+ -+static void -+led_init_and_control(struct work_struct *work) -+{ -+ int err = -1; -+ struct led_data *phytnet_led = container_of(work, struct led_data, led_control_work.work); -+ -+ if (phytnet_led->pdev->dev.of_node) -+ err = of_ndev_init(phytnet_led); -+ else if (has_acpi_companion(&phytnet_led->pdev->dev)) -+ err = acpi_ndev_init(phytnet_led); -+ -+ if (err) { -+ dev_err(&phytnet_led->pdev->dev, "ndev init wrong\n"); -+ return; -+ } -+ -+ err = gpio_init(phytnet_led); -+ if (err) { -+ dev_err(&phytnet_led->pdev->dev, "gpio init wrong\n"); -+ return; -+ } -+ -+ led_control(phytnet_led); -+} -+ -+static int -+net_led_probe(struct platform_device *pdev) -+{ -+ struct led_data *phytnet_led = devm_kzalloc(&pdev->dev, -+ sizeof(struct led_data), -+ GFP_KERNEL); -+ -+ if (!phytnet_led) -+ return -ENOMEM; -+ -+ platform_set_drvdata(pdev, phytnet_led); -+ -+ phytnet_led->act = LED_OFF; -+ phytnet_led->pdev = pdev; -+ phytnet_led->led_stop = 0; -+ -+ INIT_DELAYED_WORK(&phytnet_led->led_control_work, led_init_and_control); -+ schedule_delayed_work(&phytnet_led->led_control_work, msecs_to_jiffies(NDEV_CHECK_DELAY)); -+ -+ return 0; -+} -+ -+static int -+net_led_remove(struct platform_device *pdev) -+{ -+ struct led_data *phytnet_led = platform_get_drvdata(pdev); -+ -+ phytnet_led->led_stop = 1; -+ cancel_delayed_work_sync(&phytnet_led->led_control_work); -+ -+ if (phytnet_led->ndev) -+ dev_put(phytnet_led->ndev); -+ -+ if (phytnet_led->link) { -+ led_off(phytnet_led->link); -+ gpiod_put(phytnet_led->link); -+ } -+ -+ if (phytnet_led->act) { -+ led_off(phytnet_led->act); -+ gpiod_put(phytnet_led->act); -+ } -+ -+ return 0; -+} -+ -+static struct platform_driver net_led_driver = { -+ .driver = { -+ .owner = THIS_MODULE, -+ .name = DRIVER_NAME, -+ .of_match_table = of_match_ptr(phytnet_led_of_ids), -+ .acpi_match_table = ACPI_PTR(phytnet_acpi_ids), -+ }, -+ .probe = net_led_probe, -+ .remove = net_led_remove, -+}; -+ -+module_platform_driver(net_led_driver); -+ -+MODULE_VERSION(DRIVER_VERSION); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR(DRIVER_AUTHOR); -+MODULE_DESCRIPTION(DRIVER_DESC); -+MODULE_ALIAS("platform:" DRIVER_NAME); -diff --git a/drivers/char/phytnetled/phytnet_led.h b/drivers/char/phytnetled/phytnet_led.h -new file mode 100644 -index 000000000..8f2fbadde ---- /dev/null -+++ b/drivers/char/phytnetled/phytnet_led.h -@@ -0,0 +1,14 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2022-2023 Phytium Technology Co.,Ltd. -+ * -+ */ -+struct led_data { -+ struct platform_device *pdev; -+ struct net_device *ndev; -+ unsigned long ndev_rx, ndev_tx; -+ struct gpio_desc *link, *act; -+ struct delayed_work led_control_work; -+ int led_stop; -+ int act_val; -+}; -diff --git a/drivers/cpufreq/scpi-cpufreq.c b/drivers/cpufreq/scpi-cpufreq.c -index d33be5698..989f99e26 100644 ---- a/drivers/cpufreq/scpi-cpufreq.c -+++ b/drivers/cpufreq/scpi-cpufreq.c -@@ -48,7 +48,7 @@ scpi_cpufreq_set_target(struct cpufreq_policy *policy, unsigned int index) - if (ret) - return ret; - -- if (clk_get_rate(priv->clk) != rate) -+ if (clk_get_rate(priv->clk) / 1000 * 1000 != rate) - return -EIO; - - return 0; -diff --git a/drivers/dma/Kconfig b/drivers/dma/Kconfig -index 4ccae1a3b..e438b3abc 100644 ---- a/drivers/dma/Kconfig -+++ b/drivers/dma/Kconfig -@@ -503,6 +503,34 @@ config PCH_DMA - ML7213/ML7223/ML7831 is companion chip for Intel Atom E6xx series. - ML7213/ML7223/ML7831 is completely compatible for Intel EG20T PCH. - -+config PHYTIUM_DDMA -+ bool "Phytium PE220x DDMA support" -+ depends on (ARCH_PHYTIUM || COMPILE_TEST) -+ select DMA_ENGINE -+ select DMA_VIRTUAL_CHANNELS -+ help -+ Enable support for Phytium PE220x DDMA controller. -+ -+config PHYTIUM_GDMA -+ bool "Phytium GDMA support" -+ depends on (ARCH_PHYTIUM || COMPILE_TEST) -+ select DMA_ENGINE -+ select DMA_VIRTUAL_CHANNELS -+ help -+ Enable support for Phytium GDMA controller. -+ -+ This engine provides acceleration for memory copy operations, it does -+ not support peripherals to memory data transfer. Say Y here if you have -+ such a chipset. If unsure, say N. -+ -+config PHYTIUM_PCI_DMAC -+ bool "Phytium px210 PCI DMA support" -+ depends on OF || COMPILE_TEST -+ select DMA_ENGINE -+ select DMA_VIRTUAL_CHANNELS -+ help -+ Enable support for Phytium px210 DMA controller -+ - config PL330_DMA - tristate "DMA API Driver for PL330" - select DMA_ENGINE -diff --git a/drivers/dma/Makefile b/drivers/dma/Makefile -index 83553a97a..894019f5a 100644 ---- a/drivers/dma/Makefile -+++ b/drivers/dma/Makefile -@@ -60,6 +60,7 @@ obj-$(CONFIG_MXS_DMA) += mxs-dma.o - obj-$(CONFIG_NBPFAXI_DMA) += nbpfaxi.o - obj-$(CONFIG_OWL_DMA) += owl-dma.o - obj-$(CONFIG_PCH_DMA) += pch_dma.o -+obj-$(CONFIG_PHYTIUM_DDMA) += phytium/ - obj-$(CONFIG_PL330_DMA) += pl330.o - obj-$(CONFIG_PLX_DMA) += plx_dma.o - obj-$(CONFIG_PPC_BESTCOMM) += bestcomm/ -diff --git a/drivers/dma/phytium/Makefile b/drivers/dma/phytium/Makefile -new file mode 100644 -index 000000000..1dc7a062c ---- /dev/null -+++ b/drivers/dma/phytium/Makefile -@@ -0,0 +1,4 @@ -+# SPDX-License-Identifier: GPL-2.0 -+obj-$(CONFIG_PHYTIUM_DDMA) += phytium-ddmac.o -+obj-$(CONFIG_PHYTIUM_GDMA) += phytium-gdmac.o -+obj-$(CONFIG_PHYTIUM_PCI_DMAC) += phytium-dmac-pci.o -diff --git a/drivers/dma/phytium/phytium-ddmac.c b/drivers/dma/phytium/phytium-ddmac.c -new file mode 100644 -index 000000000..768236d99 ---- /dev/null -+++ b/drivers/dma/phytium/phytium-ddmac.c -@@ -0,0 +1,957 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium Device DDMA Controller driver. -+ * -+ * Copyright (c) 2023-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium-ddmac.h" -+ -+static inline struct phytium_ddma_device *to_ddma_device(struct dma_chan *chan) -+{ -+ return container_of(chan->device, struct phytium_ddma_device, dma_dev); -+} -+ -+static inline struct phytium_ddma_chan *to_ddma_chan(struct dma_chan *chan) -+{ -+ return container_of(chan, struct phytium_ddma_chan, vchan.chan); -+} -+ -+static inline struct phytium_ddma_desc *to_ddma_desc(struct virt_dma_desc *vd) -+{ -+ return container_of(vd, struct phytium_ddma_desc, vdesc); -+} -+ -+static inline struct device *chan_to_dev(struct phytium_ddma_chan *chan) -+{ -+ return chan->vchan.chan.device->dev; -+} -+ -+static inline struct phytium_ddma_device * -+chan_to_ddma(struct phytium_ddma_chan *chan) -+{ -+ return to_ddma_device(&chan->vchan.chan); -+} -+ -+static inline void -+phytium_ddma_iowrite32(const struct phytium_ddma_device *ddma, const u32 reg, -+ const u32 val) -+{ -+ iowrite32(val, ddma->base + reg); -+} -+ -+static inline u32 phytium_ddma_ioread32(const struct phytium_ddma_device *ddma, -+ const u32 reg) -+{ -+ return ioread32(ddma->base + reg); -+} -+ -+static inline void phytium_chan_iowrite32(const struct phytium_ddma_chan *chan, -+ const u32 reg, const u32 val) -+{ -+ iowrite32(val, chan->base + reg); -+} -+ -+static inline u32 phytium_chan_ioread32(const struct phytium_ddma_chan *chan, -+ const u32 reg) -+{ -+ return ioread32(chan->base + reg); -+} -+ -+static void phytium_ddma_disable(const struct phytium_ddma_device *ddma) -+{ -+ dev_dbg(ddma->dev, "ddma disable\n"); -+ phytium_ddma_iowrite32(ddma, DMA_CTL, !DMA_CTL_EN); -+} -+ -+static void phytium_ddma_enable(const struct phytium_ddma_device *ddma) -+{ -+ dev_dbg(ddma->dev, "ddma enable\n"); -+ phytium_ddma_iowrite32(ddma, DMA_CTL, DMA_CTL_EN); -+} -+ -+static void phytium_ddma_reset(const struct phytium_ddma_device *ddma) -+{ -+ u32 val = 0; -+ -+ dev_dbg(ddma->dev, "dma reset\n"); -+ val = phytium_ddma_ioread32(ddma, DMA_CTL); -+ val |= DMA_CTL_SRST; -+ phytium_ddma_iowrite32(ddma, DMA_CTL, val); -+ -+ udelay(10); -+ val &= ~DMA_CTL_SRST; -+ phytium_ddma_iowrite32(ddma, DMA_CTL, val); -+} -+ -+static void phytium_ddma_irq_disable(const struct phytium_ddma_device *ddma) -+{ -+ u32 val = 0; -+ -+ dev_dbg(ddma->dev, "ddma irq disable\n"); -+ val = phytium_ddma_ioread32(ddma, DMA_MASK_INT); -+ val |= DMA_INT_EN; -+ phytium_ddma_iowrite32(ddma, DMA_MASK_INT, val); -+} -+ -+static void phytium_ddma_irq_enable(const struct phytium_ddma_device *ddma) -+{ -+ u32 val = 0; -+ -+ dev_dbg(ddma->dev, "ddma irq enable\n"); -+ val = phytium_ddma_ioread32(ddma, DMA_MASK_INT); -+ val &= ~DMA_INT_EN; -+ phytium_ddma_iowrite32(ddma, DMA_MASK_INT, val); -+} -+ -+static u32 phytium_ddma_irq_read(const struct phytium_ddma_device *ddma) -+{ -+ u32 val = 0; -+ -+ val = phytium_ddma_ioread32(ddma, DMA_STAT); -+ -+ return val; -+} -+ -+static void phytium_chan_irq_disable(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d irq disable\n", chan->id); -+ val = phytium_ddma_ioread32(chan_to_ddma(chan), DMA_MASK_INT); -+ val |= DMA_INT_CHAL_EN(chan->id); -+ phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_MASK_INT, val); -+} -+ -+static void phytium_chan_irq_enable(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d irq enable\n", chan->id); -+ val = phytium_ddma_ioread32(chan_to_ddma(chan), DMA_MASK_INT); -+ val &= ~DMA_INT_CHAL_EN(chan->id); -+ phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_MASK_INT, val); -+} -+ -+static void phytium_chan_irq_clear(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d irq clear\n", chan->id); -+ val = DMA_STAT_CHAL(chan->id); -+ phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_STAT, val); -+} -+ -+static int phytium_chan_disable(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ int ret = 0; -+ u32 value1; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d disable\n", chan->id); -+ val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); -+ value1 = val |= DMA_CHAL_EN; -+ if (value1) { -+ val &= ~DMA_CHAL_EN; -+ phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); -+ -+ ret = readl_relaxed_poll_timeout_atomic( -+ chan->base + DMA_CHALX_CTL, val, !(val & DMA_CHAL_EN), -+ 0, 100000); -+ } -+ return ret; -+} -+ -+static void phytium_chan_enable(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d enable\n", chan->id); -+ val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); -+ val |= DMA_CHAL_EN; -+ phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); -+} -+ -+static bool phytium_chan_is_running(const struct phytium_ddma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); -+ -+ if (val & DMA_CHAL_EN) -+ return true; -+ else -+ return false; -+} -+ -+static void phytium_chan_reset(struct phytium_ddma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d reset\n", chan->id); -+ val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); -+ val |= DMA_CHAL_SRST; -+ phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); -+ -+ udelay(10); -+ val &= ~DMA_CHAL_SRST; -+ phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); -+} -+ -+static void phytium_ddma_vdesc_free(struct virt_dma_desc *vd) -+{ -+ kfree(to_ddma_desc(vd)); -+} -+ -+static int phytium_chan_pause(struct dma_chan *chan) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ int ret = 0; -+ -+ ret = phytium_chan_disable(pchan); -+ pchan->busy = false; -+ pchan->is_pasued = true; -+ -+ return ret; -+} -+ -+static int phytium_chan_resume(struct dma_chan *chan) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ -+ phytium_chan_enable(pchan); -+ pchan->is_pasued = false; -+ -+ return 0; -+} -+ -+static void phytium_chan_start_xfer(struct phytium_ddma_chan *chan) -+{ -+ struct virt_dma_desc *vdesc = NULL; -+ struct phytium_ddma_sg_req *sg_req = NULL; -+ char *tmp = NULL; -+ int i = 0; -+ unsigned long flags = 0; -+ -+ /* chan first xfer settings */ -+ if (!chan->desc) { -+ vdesc = vchan_next_desc(&chan->vchan); -+ if (!vdesc) -+ return; -+ -+ list_del(&vdesc->node); -+ chan->desc = to_ddma_desc(vdesc); -+ chan->next_sg = 0; -+ chan->current_sg = NULL; -+ dev_dbg(chan_to_dev(chan), "channel %d xfer start\n", chan->id); -+ } -+ -+ if (chan->next_sg == chan->desc->num_sgs) -+ chan->next_sg = 0; -+ -+ sg_req = &chan->desc->sg_req[chan->next_sg]; -+ chan->current_sg = sg_req; -+ /* fill to 4 bytes */ -+ switch (sg_req->direction) { -+ case DMA_MEM_TO_DEV: -+ tmp = phys_to_virt(sg_req->mem_addr_l); -+ memset(chan->buf, 0, sg_req->len * 4); -+ for (i = 0; i < sg_req->len; i++) -+ chan->buf[i * 4] = tmp[i]; -+ break; -+ -+ case DMA_DEV_TO_MEM: -+ memset(chan->buf, 0, sg_req->len * 4); -+ break; -+ -+ default: -+ break; -+ } -+ -+ /* start transfer */ -+ phytium_chan_iowrite32(chan, DMA_CHALX_DDR_LWADDR, -+ chan->paddr & 0xFFFFFFFF); -+ phytium_chan_iowrite32(chan, DMA_CHALX_DDR_UPADDR, -+ (chan->paddr >> 32) & 0xFFFFFFFF); -+ phytium_chan_iowrite32(chan, DMA_CHALX_DEV_ADDR, sg_req->dev_addr); -+ phytium_chan_iowrite32(chan, DMA_CHALX_TS, sg_req->len * 4); -+ -+ spin_lock_irqsave(&chan_to_ddma(chan)->lock, flags); -+ phytium_chan_irq_enable(chan); -+ spin_unlock_irqrestore(&chan_to_ddma(chan)->lock, flags); -+ phytium_chan_enable(chan); -+ -+ chan->next_sg++; -+ chan->busy = true; -+} -+ -+static void phytium_chan_xfer_done(struct phytium_ddma_chan *chan) -+{ -+ struct phytium_ddma_sg_req *sg_req = chan->current_sg; -+ char *tmp = NULL; -+ int i = 0; -+ -+ if (chan->desc) { -+ if (sg_req->direction == DMA_DEV_TO_MEM) { -+ tmp = phys_to_virt(sg_req->mem_addr_l); -+ for (i = 0; i < sg_req->len; i++) -+ tmp[i] = chan->buf[i * 4]; -+ } -+ -+ chan->busy = false; -+ if (chan->next_sg == chan->desc->num_sgs) { -+ dev_dbg(chan_to_dev(chan), -+ "channel %d xfer complete\n", chan->id); -+ vchan_cookie_complete(&chan->desc->vdesc); -+ chan->desc = NULL; -+ chan->current_sg = NULL; -+ } -+ phytium_chan_disable(chan); -+ phytium_chan_irq_clear(chan); -+ phytium_chan_start_xfer(chan); -+ } -+} -+ -+static void phytium_dma_hw_init(struct phytium_ddma_device *ddma) -+{ -+ u32 i = 0; -+ int ret = 0; -+ -+ phytium_ddma_disable(ddma); -+ phytium_ddma_reset(ddma); -+ phytium_ddma_irq_enable(ddma); -+ phytium_ddma_enable(ddma); -+ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ phytium_chan_irq_disable(&ddma->chan[i]); -+ ret = phytium_chan_disable(&ddma->chan[i]); -+ if (ret) -+ dev_err(ddma->dev, "can't disable channel %d\n", i); -+ } -+} -+ -+static size_t phytium_ddma_desc_residue(struct phytium_ddma_chan *chan) -+{ -+ u32 trans_cnt = 0; -+ u32 residue = 0; -+ int i = 0; -+ -+ trans_cnt = phytium_chan_ioread32(chan, DMA_CHALX_TRANS_CNT); -+ residue = chan->current_sg->len - trans_cnt; -+ -+ for (i = chan->next_sg; i < chan->desc->num_sgs; i++) -+ residue += chan->desc->sg_req[i].len; -+ -+ return residue; -+} -+ -+static enum dma_status phytium_ddma_tx_status(struct dma_chan *chan, -+ dma_cookie_t cookie, -+ struct dma_tx_state *txstate) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ struct virt_dma_desc *vd = NULL; -+ enum dma_status ret = 0; -+ unsigned long flags = 0; -+ size_t residue = 0; -+ -+ ret = dma_cookie_status(chan, cookie, txstate); -+ if ((ret == DMA_COMPLETE) || !txstate) -+ return ret; -+ -+ spin_lock_irqsave(&pchan->vchan.lock, flags); -+ vd = vchan_find_desc(&pchan->vchan, cookie); -+ if (pchan->desc && cookie == pchan->desc->vdesc.tx.cookie) -+ residue = phytium_ddma_desc_residue(pchan); -+ -+ dma_set_residue(txstate, residue); -+ spin_unlock_irqrestore(&pchan->vchan.lock, flags); -+ -+ if (pchan->is_pasued && ret == DMA_IN_PROGRESS) -+ ret = DMA_PAUSED; -+ -+ return ret; -+} -+ -+static void phytium_ddma_issue_pending(struct dma_chan *chan) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ unsigned long flags = 0; -+ -+ spin_lock_irqsave(&pchan->vchan.lock, flags); -+ -+ if (vchan_issue_pending(&pchan->vchan) && !pchan->desc && !pchan->busy) -+ phytium_chan_start_xfer(pchan); -+ -+ spin_unlock_irqrestore(&pchan->vchan.lock, flags); -+} -+ -+static int phytium_ddma_terminate_all(struct dma_chan *chan) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ unsigned long flags = 0; -+ LIST_HEAD(head); -+ -+ spin_lock_irqsave(&pchan->vchan.lock, flags); -+ if (pchan->desc) { -+ vchan_terminate_vdesc(&pchan->desc->vdesc); -+ if (pchan->busy) { -+ u32 tmp_ctl, timeout; -+ -+ phytium_chan_disable(pchan); -+ /* save some registers, reset will clear it */ -+ timeout = phytium_chan_ioread32(pchan, -+ DMA_CHALX_TIMEOUT_CNT); -+ tmp_ctl = phytium_chan_ioread32(pchan, -+ DMA_CHALX_CTL); -+ spin_lock(&chan_to_ddma(pchan)->lock); -+ phytium_chan_irq_disable(pchan); -+ spin_unlock(&chan_to_ddma(pchan)->lock); -+ /* need reset when terminate */ -+ phytium_chan_reset(pchan); -+ phytium_chan_irq_clear(pchan); -+ /* recover it */ -+ phytium_chan_iowrite32(pchan, -+ DMA_CHALX_CTL, tmp_ctl); -+ phytium_chan_iowrite32(pchan, -+ DMA_CHALX_TIMEOUT_CNT, timeout); -+ pchan->busy = false; -+ } -+ pchan->desc = NULL; -+ } -+ -+ vchan_get_all_descriptors(&pchan->vchan, &head); -+ spin_unlock_irqrestore(&pchan->vchan.lock, flags); -+ vchan_dma_desc_free_list(&pchan->vchan, &head); -+ -+ return 0; -+} -+ -+static int phytium_ddma_alloc_chan_resources(struct dma_chan *chan) -+{ -+ struct phytium_ddma_device *ddma = to_ddma_device(chan); -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ u32 bind_status = 0; -+ int ret = 0; -+ unsigned long flags = 0; -+ -+ bind_status = phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); -+ -+ if ((pchan->is_used) || (bind_status & BIT(pchan->id))) { -+ dev_err(ddma->dev, "channel %d already used\n", pchan->id); -+ ret = -EBUSY; -+ goto out; -+ } -+ -+ /* prepare channel */ -+ ret = phytium_chan_disable(pchan); -+ if (ret) { -+ dev_err(ddma->dev, "can't disable channel %d\n", pchan->id); -+ goto out; -+ } -+ phytium_chan_reset(pchan); -+ phytium_chan_irq_clear(pchan); -+ -+ /* channel bind */ -+ spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); -+ bind_status |= BIT(pchan->id); -+ phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, bind_status); -+ pchan->is_used = true; -+ spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); -+ -+ /* alloc dma memory */ -+ pchan->buf = dma_alloc_coherent(ddma->dev, 4 * PAGE_SIZE, &pchan->paddr, -+ GFP_KERNEL); -+ if (!pchan->buf) { -+ ret = -EBUSY; -+ dev_err(ddma->dev, "failed to alloc dma memory\n"); -+ } -+ -+ dev_info(ddma->dev, "alloc channel %d\n", pchan->id); -+ -+out: -+ return ret; -+} -+ -+static void phytium_ddma_free_chan_resources(struct dma_chan *chan) -+{ -+ struct phytium_ddma_device *ddma = to_ddma_device(chan); -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ u32 bind_status = 0; -+ unsigned long flags = 0; -+ -+ if (!pchan->is_used) -+ return; -+ -+ dev_dbg(ddma->dev, "free channel %d\n", pchan->id); -+ spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); -+ bind_status = phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); -+ bind_status &= ~BIT(pchan->id); -+ phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, bind_status); -+ spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); -+ -+ phytium_chan_disable(pchan); -+ -+ spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); -+ phytium_chan_irq_disable(pchan); -+ spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); -+ -+ vchan_free_chan_resources(to_virt_chan(chan)); -+ pchan->is_used = false; -+ -+ if (pchan->buf) -+ dma_free_coherent(ddma->dev, 4 * PAGE_SIZE, pchan->buf, -+ pchan->paddr); -+} -+ -+static int phytium_ddma_slave_config(struct dma_chan *chan, -+ struct dma_slave_config *config) -+{ -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ u32 chal_cfg = 0; -+ u32 req_mode = 0; -+ const u32 timeout = 0xffff; -+ unsigned long flag = 0; -+ -+ /* Check if chan will be configured for slave transfers */ -+ if (!is_slave_direction(config->direction)) -+ return -EINVAL; -+ -+ memcpy(&pchan->dma_config, config, sizeof(*config)); -+ -+ /* set channel config reg */ -+ spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flag); -+ if (pchan->id > 3) { -+ chal_cfg = phytium_ddma_ioread32(chan_to_ddma(pchan), -+ DMA_CHAL_CFG_H); -+ chal_cfg &= ~(0xFF << ((pchan->id - 4) * 8)); -+ chal_cfg |= DMA_CHAL_SEL((pchan->id - 4), pchan->request_line); -+ chal_cfg |= DMA_CHAL_SEL_EN(pchan->id - 4); -+ phytium_ddma_iowrite32(chan_to_ddma(pchan), DMA_CHAL_CFG_H, -+ chal_cfg); -+ } else { -+ chal_cfg = phytium_ddma_ioread32(chan_to_ddma(pchan), -+ DMA_CHAL_CFG_L); -+ chal_cfg &= ~(0xFF << (pchan->id * 8)); -+ chal_cfg |= DMA_CHAL_SEL((pchan->id), pchan->request_line); -+ chal_cfg |= DMA_CHAL_SEL_EN(pchan->id); -+ phytium_ddma_iowrite32(chan_to_ddma(pchan), DMA_CHAL_CFG_L, -+ chal_cfg); -+ } -+ spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flag); -+ -+ /* set channel mode */ -+ req_mode = (config->direction == DMA_DEV_TO_MEM) ? DMA_RX_REQ : -+ DMA_TX_REQ; -+ phytium_chan_iowrite32(pchan, DMA_CHALX_CTL, req_mode << 2); -+ -+ /* set channel timeout */ -+ phytium_chan_iowrite32(pchan, DMA_CHALX_TIMEOUT_CNT, -+ timeout | DMA_CHAL_TIMEOUT_EN); -+ -+ return 0; -+} -+ -+static struct dma_async_tx_descriptor * -+phytium_ddma_prep_slave_sg(struct dma_chan *chan, struct scatterlist *sgl, -+ u32 sg_len, enum dma_transfer_direction direction, -+ unsigned long flags, void *context) -+{ -+ struct phytium_ddma_device *ddma = to_ddma_device(chan); -+ struct phytium_ddma_chan *pchan = to_ddma_chan(chan); -+ struct dma_slave_config *sconfig = &pchan->dma_config; -+ struct phytium_ddma_desc *desc = NULL; -+ struct scatterlist *sg = NULL; -+ int i = 0; -+ char *tmp; -+ -+ if (unlikely(!is_slave_direction(direction))) { -+ dev_err(ddma->dev, "invalid dma direction\n"); -+ return NULL; -+ } -+ -+ if (unlikely(sg_len < 1)) { -+ dev_err(ddma->dev, "invalid segment length: %d\n", sg_len); -+ return NULL; -+ } -+ -+ desc = kzalloc(struct_size(desc, sg_req, sg_len), GFP_NOWAIT); -+ if (!desc) -+ return NULL; -+ -+ /* set sg list */ -+ for_each_sg(sgl, sg, sg_len, i) { -+ tmp = phys_to_virt(sg_dma_address(sg)); -+ desc->sg_req[i].direction = direction; -+ -+ switch (direction) { -+ case DMA_MEM_TO_DEV: -+ desc->sg_req[i].len = sg_dma_len(sg); -+ desc->sg_req[i].mem_addr_l = sg_dma_address(sg) & -+ 0xFFFFFFFF; -+ desc->sg_req[i].mem_addr_h = -+ (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; -+ desc->sg_req[i].dev_addr = sconfig->dst_addr & -+ 0xFFFFFFFF; -+ break; -+ -+ case DMA_DEV_TO_MEM: -+ desc->sg_req[i].len = sg_dma_len(sg); -+ desc->sg_req[i].mem_addr_l = sg_dma_address(sg) & -+ 0xFFFFFFFF; -+ desc->sg_req[i].mem_addr_h = -+ (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; -+ desc->sg_req[i].dev_addr = sconfig->src_addr & -+ 0xFFFFFFFF; -+ break; -+ -+ default: -+ return NULL; -+ } -+ } -+ -+ desc->num_sgs = sg_len; -+ -+ return vchan_tx_prep(&pchan->vchan, &desc->vdesc, flags); -+} -+ -+static irqreturn_t phytium_dma_interrupt(int irq, void *dev_id) -+{ -+ struct phytium_ddma_device *ddma = dev_id; -+ struct phytium_ddma_chan *chan; -+ u32 irq_status = 0; -+ u32 i = 0; -+ u32 val = 0; -+ -+ phytium_ddma_irq_disable(ddma); -+ -+ irq_status = phytium_ddma_irq_read(ddma); -+ val = phytium_ddma_ioread32(ddma, DMA_CTL); -+ -+ /* Poll, clear and process every chanel interrupt status */ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ if (!(irq_status & BIT(i * 4))) -+ continue; -+ -+ chan = &ddma->chan[i]; -+ phytium_chan_xfer_done(chan); -+ } -+ -+ phytium_ddma_irq_enable(ddma); -+ -+ return IRQ_HANDLED; -+} -+ -+static struct dma_chan *phytium_ddma_of_xlate(struct of_phandle_args *dma_spec, -+ struct of_dma *ofdma) -+{ -+ struct phytium_ddma_device *ddma = ofdma->of_dma_data; -+ struct device *dev = ddma->dev; -+ struct phytium_ddma_chan *chan = NULL; -+ struct dma_chan *c = NULL; -+ u32 channel_id = 0; -+ -+ channel_id = dma_spec->args[0]; -+ -+ if (channel_id > ddma->dma_channels) { -+ dev_err(dev, "bad channel %d\n", channel_id); -+ return NULL; -+ } -+ -+ chan = &ddma->chan[channel_id]; -+ chan->request_line = dma_spec->args[1]; -+ c = dma_get_slave_channel(&chan->vchan.chan); -+ if (!c) { -+ dev_err(dev, "no more channels available\n"); -+ return NULL; -+ } -+ -+ return c; -+} -+ -+static int phytium_ddma_probe(struct platform_device *pdev) -+{ -+ struct phytium_ddma_device *ddma; -+ struct dma_device *dma_dev; -+ struct resource *mem; -+ u32 i = 0; -+ int ret = 0; -+ u32 nr_channels = 0; -+ -+ ddma = devm_kzalloc(&pdev->dev, sizeof(*ddma), GFP_KERNEL); -+ if (!ddma) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ dma_dev = &ddma->dma_dev; -+ ddma->dev = &pdev->dev; -+ -+ spin_lock_init(&ddma->lock); -+ -+ ddma->irq = platform_get_irq(pdev, 0); -+ if (ddma->irq < 0) { -+ dev_err(&pdev->dev, "no irq resource\n"); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ ddma->base = devm_ioremap_resource(&pdev->dev, mem); -+ if (IS_ERR(ddma->base)) { -+ dev_err(&pdev->dev, "no resource address"); -+ ret = PTR_ERR(ddma->base); -+ goto out; -+ } -+ -+ ret = of_property_read_u32(pdev->dev.of_node, "dma-channels", -+ &nr_channels); -+ if (ret < 0) { -+ dev_err(&pdev->dev, -+ "can't get the number of dma channels: %d\n", ret); -+ goto out; -+ } -+ -+ if (nr_channels > DDMA_MAX_NR_PCHANNELS) { -+ dev_warn(&pdev->dev, "over the max number of channels\n"); -+ nr_channels = DDMA_MAX_NR_PCHANNELS; -+ } -+ -+ ddma->dma_channels = DDMA_MAX_NR_PCHANNELS; -+ -+ ret = devm_request_irq(&pdev->dev, ddma->irq, phytium_dma_interrupt, -+ IRQF_SHARED, dev_name(&pdev->dev), ddma); -+ if (ret) { -+ dev_err(&pdev->dev, "could not to request irq %d", ddma->irq); -+ goto out; -+ } -+ -+ /* Set capabilities */ -+ dma_cap_set(DMA_SLAVE, ddma->dma_dev.cap_mask); -+ -+ /* DMA capabilities */ -+ dma_dev->dev = ddma->dev; -+ dma_dev->chancnt = ddma->dma_channels; -+ dma_dev->src_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_4_BYTES); -+ dma_dev->dst_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_4_BYTES); -+ dma_dev->directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV); -+ dma_dev->residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; -+ -+ /* function callback */ -+ dma_dev->device_tx_status = phytium_ddma_tx_status; -+ dma_dev->device_issue_pending = phytium_ddma_issue_pending; -+ dma_dev->device_terminate_all = phytium_ddma_terminate_all; -+ dma_dev->device_alloc_chan_resources = -+ phytium_ddma_alloc_chan_resources; -+ dma_dev->device_free_chan_resources = phytium_ddma_free_chan_resources; -+ dma_dev->device_config = phytium_ddma_slave_config; -+ dma_dev->device_prep_slave_sg = phytium_ddma_prep_slave_sg; -+ dma_dev->device_pause = phytium_chan_pause; -+ dma_dev->device_resume = phytium_chan_resume; -+ -+ /* init dma physical channels */ -+ INIT_LIST_HEAD(&dma_dev->channels); -+ ddma->chan = devm_kcalloc(ddma->dev, ddma->dma_channels, -+ sizeof(*ddma->chan), GFP_KERNEL); -+ if (!ddma->chan) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ for (i = 0; i < ddma->dma_channels; i++) { -+ ddma->chan[i].id = i; -+ ddma->chan[i].buf = NULL; -+ ddma->chan[i].base = -+ ddma->base + DMA_REG_LEN + i * CHAN_REG_LEN; -+ ddma->chan[i].vchan.desc_free = phytium_ddma_vdesc_free; -+ ddma->chan[i].desc = NULL; -+ ddma->chan[i].current_sg = NULL; -+ vchan_init(&ddma->chan[i].vchan, dma_dev); -+ } -+ -+ phytium_dma_hw_init(ddma); -+ -+ ret = dma_async_device_register(dma_dev); -+ if (ret) -+ goto out; -+ -+ ret = of_dma_controller_register(pdev->dev.of_node, -+ phytium_ddma_of_xlate, ddma); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "phytium ddma of register failed %d\n", -+ ret); -+ goto err_unregister; -+ } -+ -+ platform_set_drvdata(pdev, ddma); -+ dev_info(ddma->dev, "phytium DDMA Controller registered\n"); -+ -+ return 0; -+ -+err_unregister: -+ dma_async_device_unregister(dma_dev); -+ -+out: -+ return ret; -+} -+ -+static void phytium_ddma_chan_remove(struct phytium_ddma_chan *chan) -+{ -+ phytium_chan_irq_disable(chan); -+ phytium_chan_disable(chan); -+ -+ if (chan->buf) -+ dma_free_coherent(chan_to_dev(chan), 4 * PAGE_SIZE, chan->buf, -+ chan->paddr); -+ -+ tasklet_kill(&chan->vchan.task); -+ list_del(&chan->vchan.chan.device_node); -+} -+ -+static int phytium_ddma_remove(struct platform_device *pdev) -+{ -+ struct phytium_ddma_device *ddma = platform_get_drvdata(pdev); -+ struct phytium_ddma_chan *chan = NULL; -+ int i = 0; -+ -+ of_dma_controller_free(pdev->dev.of_node); -+ dma_async_device_unregister(&ddma->dma_dev); -+ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ chan = &ddma->chan[i]; -+ phytium_ddma_chan_remove(chan); -+ } -+ -+ phytium_ddma_irq_disable(ddma); -+ phytium_ddma_disable(ddma); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_ddma_suspend(struct device *dev) -+{ -+ struct phytium_ddma_device *ddma = dev_get_drvdata(dev); -+ int i = 0; -+ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ if (phytium_chan_is_running(&ddma->chan[i])) { -+ dev_warn(dev, "suspend is prevented by channel %d\n", -+ i); -+ return -EBUSY; -+ } -+ } -+ -+ ddma->dma_reg.dma_chal_cfg0 = -+ phytium_ddma_ioread32(ddma, DMA_CHAL_CFG_L); -+ ddma->dma_reg.dma_chal_bind = -+ phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); -+ ddma->dma_reg.dma_chal_cfg1 = -+ phytium_ddma_ioread32(ddma, DMA_CHAL_CFG_H); -+ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ struct phytium_ddma_chan *chan = &ddma->chan[i]; -+ -+ if (!chan->is_used) -+ continue; -+ ddma->dma_chal_reg[i].dma_chalx_ctl = -+ phytium_chan_ioread32(chan, DMA_CHALX_CTL); -+ ddma->dma_chal_reg[i].dma_chalx_timeout_cnt = -+ phytium_chan_ioread32(chan, DMA_CHALX_TIMEOUT_CNT); -+ } -+ -+ phytium_ddma_irq_disable(ddma); -+ phytium_ddma_disable(ddma); -+ pm_runtime_force_suspend(dev); -+ -+ return 0; -+} -+ -+static int phytium_ddma_resume(struct device *dev) -+{ -+ struct phytium_ddma_device *ddma = dev_get_drvdata(dev); -+ u32 i = 0; -+ int ret = 0; -+ -+ phytium_dma_hw_init(ddma); -+ phytium_ddma_iowrite32(ddma, DMA_CHAL_CFG_L, -+ ddma->dma_reg.dma_chal_cfg0); -+ phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, -+ ddma->dma_reg.dma_chal_bind); -+ phytium_ddma_iowrite32(ddma, DMA_CHAL_CFG_H, -+ ddma->dma_reg.dma_chal_cfg1); -+ -+ for (i = 0; i < ddma->dma_channels; i++) { -+ struct phytium_ddma_chan *chan = &ddma->chan[i]; -+ -+ if (!chan->is_used) -+ continue; -+ phytium_chan_iowrite32(chan, DMA_CHALX_CTL, -+ ddma->dma_chal_reg[i].dma_chalx_ctl); -+ phytium_chan_iowrite32(chan, DMA_CHALX_TIMEOUT_CNT, -+ ddma->dma_chal_reg[i].dma_chalx_timeout_cnt); -+ } -+ -+ ret = pm_runtime_force_resume(dev); -+ -+ return ret; -+} -+#endif -+ -+static const struct dev_pm_ops phytium_ddma_pm_ops = { -+ SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_ddma_suspend, phytium_ddma_resume) -+}; -+ -+static const struct of_device_id phytium_dma_of_id_table[] = { -+ { .compatible = "phytium,ddma" }, -+ {} -+}; -+MODULE_DEVICE_TABLE(of, phytium_dma_of_id_table); -+ -+static struct platform_driver phytium_driver = { -+ .probe = phytium_ddma_probe, -+ .remove = phytium_ddma_remove, -+ .driver = { -+ .name = "phytium-ddma", -+ .of_match_table = of_match_ptr(phytium_dma_of_id_table), -+ .pm = &phytium_ddma_pm_ops, -+ }, -+}; -+ -+static __init int phytium_ddma_init(void) -+{ -+ return platform_driver_register(&phytium_driver); -+} -+ -+static void __exit phytium_ddma_exit(void) -+{ -+ platform_driver_unregister(&phytium_driver); -+} -+ -+subsys_initcall(phytium_ddma_init); -+module_exit(phytium_ddma_exit); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium DDMA Controller platform driver"); -+MODULE_AUTHOR("Huang Jie "); -diff --git a/drivers/dma/phytium/phytium-ddmac.h b/drivers/dma/phytium/phytium-ddmac.h -new file mode 100644 -index 000000000..7c55c4282 ---- /dev/null -+++ b/drivers/dma/phytium/phytium-ddmac.h -@@ -0,0 +1,168 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium Device DMA Controller driver. -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ * -+ */ -+ -+#ifndef _PHYTIUM_DDMAC_H -+#define _PHYTIUM_DDMAC_H -+ -+#include -+#include -+#include -+#include -+#include -+#include "../virt-dma.h" -+ -+/* the number of physical channel */ -+#define DDMA_MAX_NR_PCHANNELS 8 -+ -+#define DMAC_MAX_MASTERS 1 -+#define DMAC_MAX_BLK_SIZE PAGE_SIZE -+ -+#define CHAN_REG_LEN 0x40 -+#define DMA_REG_LEN 0x40 -+ -+#define DMA_CTL 0x00 -+#define DMA_CHAL_CFG_L 0x04 -+#define DMA_CHAL_CFG_H 0x28 -+#define DMA_STAT 0x08 -+#define DMA_MASK_INT 0x0C -+#define DMA_CHAL_BIND 0x20 -+#define DMA_GCAP 0x24 -+ -+#define DMA_CHALX_DDR_UPADDR 0x00 -+#define DMA_CHALX_DDR_LWADDR 0x04 -+#define DMA_CHALX_DEV_ADDR 0x08 -+#define DMA_CHALX_TS 0x0C -+#define DMA_CHALX_CRT_UPADDR 0x10 -+#define DMA_CHALX_CRT_LWADDR 0x14 -+#define DMA_CHALX_CTL 0x18 -+#define DMA_CHALX_STS 0x1C -+#define DMA_CHALX_TIMEOUT_CNT 0x20 -+#define DMA_CHALX_TRANS_CNT 0x24 -+ -+#define DMA_CTL_EN BIT(0) -+#define DMA_CTL_SRST BIT(1) -+ -+#define DMA_CHAL_SEL(id, x) (min_t(unsigned int, x, 0x7F) << (id * 8)) -+#define DMA_CHAL_SEL_EN(id) BIT(id * 8 + 7) -+ -+#define DMA_STAT_CHAL(id) BIT(id * 4) -+ -+#define DMA_INT_EN BIT(31) -+#define DMA_INT_CHAL_EN(id) BIT(id) -+ -+#define DMA_CHAL_EN BIT(0) -+#define DMA_CHAL_SRST BIT(1) -+#define DMA_CHAL_MODE BIT(2) -+ -+#define DMA_RX_REQ 1 -+#define DMA_TX_REQ 0 -+ -+#define DMA_CHAL_TIMEOUT_EN BIT(31) -+#define DMA_CHAL_TIMEOUT_CNT(x) min_t(unsigned int, x, 0xFFFFF) -+ -+#define DMA_TIMEOUT 10 -+ -+/** -+ * struct phytium_ddma_sg_req - scatter-gatter list data info -+ * @len: number of bytes to transform -+ * @mem_addr_l: bus address low 32bit -+ * @mem_addr_h: bus address high 32bit -+ * @dev_addr: dma cousumer data reg addr -+ * @direction: dma transmit direction -+ */ -+struct phytium_ddma_sg_req { -+ u32 len; -+ u32 mem_addr_l; -+ u32 mem_addr_h; -+ u32 dev_addr; -+ enum dma_transfer_direction direction; -+}; -+ -+/** -+ * struct phytium_ddma_desc - -+ * the struct holding info describing ddma request -+ * descriptor -+ * @vdesc: ddma request descriptor -+ * @num_sgs: the size of scatter-gatter list -+ * @sg_req: use to save scatter-gatter list info -+ */ -+struct phytium_ddma_desc { -+ struct virt_dma_desc vdesc; -+ u32 num_sgs; -+ struct phytium_ddma_sg_req sg_req[]; -+}; -+ -+/** -+ * struct phytium_ddma_chan - -+ * the struct holding info describing dma channel -+ * @vchan: virtual dma channel -+ * @base: the mapped register I/O of dma physical channel -+ * @id: the id of ddma physical channel -+ * @request_line: the request line of ddma channel -+ * @desc: the transform request descriptor -+ * @dma_config: config parameters for dma channel -+ * @busy: the channel busy flag, this flag set when channel is tansferring -+ * @is_used: the channel bind flag, this flag set when channel binded -+ * @next_sg: the index of next scatter-gatter -+ * @current_sg: use to save the current transfer scatter-gatter info -+ * @paddr: use to align data between dma provider and consumer -+ */ -+struct phytium_ddma_chan { -+ struct virt_dma_chan vchan; -+ void __iomem *base; -+ u32 id; -+ u32 request_line; -+ struct phytium_ddma_desc *desc; -+ struct dma_slave_config dma_config; -+ bool busy; -+ bool is_used; -+ bool is_pasued; -+ u32 next_sg; -+ struct phytium_ddma_sg_req *current_sg; -+ dma_addr_t paddr; -+ char *buf; -+}; -+ -+struct global_reg { -+ u32 dma_chal_cfg0; -+ u32 dma_chal_bind; -+ u32 dma_chal_cfg1; -+}; -+ -+struct channel_reg { -+ u32 dma_chalx_ctl; -+ u32 dma_chalx_timeout_cnt; -+}; -+ -+/** -+ * struct phytium_ddma_device - -+ * the struct holding info describing DDMA device -+ * @dma_dev: an instance for struct dma_device -+ * @irq: the irq that DDMA using -+ * @base: the mapped register I/O base of this DDMA -+ * @core_clk: DDMA clock -+ * @dma_channels: the number of DDMA physical channels -+ * @chan: the phyical channels of DDMA -+ * @lock: spinlock to lock when set global registers -+ * @dma_reg: store global register value which need recover after resume -+ * @dma_chal_reg: store channel register value which need recover after resume -+ */ -+struct phytium_ddma_device { -+ struct dma_device dma_dev; -+ struct device *dev; -+ int irq; -+ void __iomem *base; -+ struct clk *core_clk; -+ u32 dma_channels; -+ struct phytium_ddma_chan *chan; -+ spinlock_t lock; -+ struct global_reg dma_reg; -+ struct channel_reg dma_chal_reg[DDMA_MAX_NR_PCHANNELS]; -+}; -+ -+#endif /* _PHYTIUM_DDMAC_H */ -diff --git a/drivers/dma/phytium/phytium-dmac-pci.c b/drivers/dma/phytium/phytium-dmac-pci.c -new file mode 100644 -index 000000000..530b56905 ---- /dev/null -+++ b/drivers/dma/phytium/phytium-dmac-pci.c -@@ -0,0 +1,1076 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2021 Phytium Limited. -+ * -+ * Phytium PCI DMA Controller driver. -+ * -+ * 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 -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+ -+#include "phytium-dmac-pci.h" -+#include "../dmaengine.h" -+ -+static const struct dma_slave_map ft_px210gpu_slave_map[] = { -+ {"px210-dma", "tx", 0}, -+ {"px210-dma", "rx", 0}, -+}; -+ -+static inline void -+phytium_dma_iowrite32(struct phytium_dma_chip *chip, u32 reg, u32 val) -+{ -+ iowrite32(val, chip->regs + reg); -+} -+ -+static inline u32 phytium_dma_ioread32(struct phytium_dma_chip *chip, u32 reg) -+{ -+ return ioread32(chip->regs + reg); -+} -+ -+static inline void -+phytium_chan_iowrite32(struct phytium_dma_chan *chan, u32 reg, u32 val) -+{ -+ iowrite32(val, chan->chan_regs + reg); -+} -+ -+static inline u32 phytium_chan_ioread32(struct phytium_dma_chan *chan, u32 reg) -+{ -+ return ioread32(chan->chan_regs + reg); -+} -+ -+static inline void phytium_dma_irq_disable(struct phytium_dma_chip *chip) -+{ -+ u32 val; -+ -+ val = 0; -+ phytium_dma_iowrite32(chip, DMA_IRQ_MASK, val); -+} -+ -+static inline void phytium_dma_irq_enable(struct phytium_dma_chip *chip) -+{ -+ u32 val; -+ -+ val = 0x4077FFFF; -+ phytium_dma_iowrite32(chip, DMA_IRQ_MASK, val); -+} -+ -+static inline void phytium_dma_irq_clear(struct phytium_dma_chip *chip, -+ u32 irq_status) -+{ -+ phytium_dma_iowrite32(chip, DMA_IRQ_STATUS, irq_status); -+} -+ -+static inline u32 phytium_dma_irq_read(struct phytium_dma_chip *chip) -+{ -+ u32 val; -+ -+ val = phytium_dma_ioread32(chip, DMA_IRQ_STATUS); -+ -+ return val; -+} -+ -+static inline u32 phytium_dma_irq_mask_read(struct phytium_dma_chip *chip) -+{ -+ u32 val; -+ -+ val = phytium_dma_ioread32(chip, DMA_IRQ_MASK); -+ -+ return val; -+} -+ -+ -+static inline void phytium_chan_irq_disable -+ (struct phytium_dma_chan *chan, u32 irq_mask) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ val &= ~irq_mask; -+ phytium_chan_iowrite32(chan, DMA_CONTROL, val); -+} -+ -+static inline void phytium_chan_irq_set -+ (struct phytium_dma_chan *chan, u32 irq_mask) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ val &= ~DMA_CTRL_IRQ_MASK(0xF); -+ val |= irq_mask; -+ val |= DMA_CTRL_IRQ_ID(1); -+ phytium_chan_iowrite32(chan, DMA_CONTROL, val); -+} -+ -+static inline void phytium_chan_irq_clear -+ (struct phytium_dma_chan *chan, u32 irq_mask) -+{ -+ u32 val; -+ -+ val = phytium_dma_ioread32(chan->chip, DMA_IRQ_STATUS); -+ val &= ~irq_mask; -+ phytium_chan_iowrite32(chan, DMA_IRQ_STATUS, val); -+} -+ -+static inline u32 phytium_chan_irq_read(struct phytium_dma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_dma_ioread32(chan->chip, DMA_IRQ_STATUS); -+ val &= ((chan->id << 0) | (chan->id << 8)); -+ -+ return val; -+} -+ -+static inline u32 phytium_chan_status_read(struct phytium_dma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_STATUS); -+ -+ return val; -+} -+ -+static inline void phytium_chan_disable(struct phytium_dma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ val &= ~DMA_CTRL_START; -+ phytium_chan_iowrite32(chan, DMA_CONTROL, val); -+} -+ -+static inline void phytium_chan_enable(struct phytium_dma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ val |= DMA_CTRL_START; -+ phytium_chan_iowrite32(chan, DMA_CONTROL, val); -+} -+ -+static inline const char *phytium_chan_name(struct phytium_dma_chan *chan) -+{ -+ return dma_chan_name(&chan->vc.chan); -+} -+ -+static struct phytium_dma_desc *phytium_desc_get(struct phytium_dma_chan *chan) -+{ -+ struct phytium_dma_desc *desc = NULL; -+ -+ desc = kmalloc(sizeof(*desc), GFP_KERNEL); -+ if (unlikely(!desc)) { -+ dev_err(chan2dev(chan), "%s: not enough descriptors available\n", -+ phytium_chan_name(chan)); -+ return NULL; -+ } -+ -+ memset(desc, 0, sizeof(*desc)); -+ -+ INIT_LIST_HEAD(&desc->xfer_list); -+ -+ return desc; -+} -+ -+static void phytium_desc_put(struct phytium_dma_desc *desc) -+{ -+ unsigned int descs_put = 0; -+ -+ kfree(desc); -+ -+ descs_put++; -+} -+ -+static void phytium_vchan_desc_put(struct virt_dma_desc *vdesc) -+{ -+ phytium_desc_put(vd_to_desc(vdesc)); -+} -+ -+static inline bool phytium_chan_is_running(struct phytium_dma_chan *chan) -+{ -+ u32 val; -+ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ -+ if (val & DMA_CTRL_START) -+ return true; -+ else -+ return false; -+} -+ -+/* Called in chan locked context */ -+static void phytium_chan_block_xfer_start(struct phytium_dma_chan *chan, -+ struct phytium_dma_desc *desc) -+{ -+ u32 irq_mask; -+ u32 val; -+ -+ chan->is_idle = false; -+ if (phytium_chan_is_running(chan)) { -+ dev_err(chan2dev(chan), "%s is non-idle!\n", -+ phytium_chan_name(chan)); -+ return; -+ } -+ -+ phytium_chan_iowrite32(chan, DMA_SRCPARAM, desc->dma_srcparam); -+ phytium_chan_iowrite32(chan, DMA_DESTPARAM, desc->dma_destparam); -+ phytium_chan_iowrite32(chan, DMA_SRCADDR_L, desc->dma_srcaddr_l); -+ phytium_chan_iowrite32(chan, DMA_SRCADDR_H, desc->dma_srcaddr_h); -+ phytium_chan_iowrite32(chan, DMA_DESTADDR_L, desc->dma_destaddr_l); -+ phytium_chan_iowrite32(chan, DMA_DESTADDR_H, desc->dma_destaddr_h); -+ phytium_chan_iowrite32(chan, DMA_LENGTH, desc->dma_len); -+ -+ /* SG_TYPE & IRQ_ID & SE_COND & SG_EN */ -+ val = phytium_chan_ioread32(chan, DMA_CONTROL); -+ val |= desc->dma_ctrl; -+ val |= DMA_CTRL_COND_LEN | DMA_CTRL_COND_EOP | DMA_CTRL_COND_ERR; -+ -+ phytium_chan_iowrite32(chan, DMA_CONTROL, val); -+ -+ irq_mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; -+ phytium_chan_irq_set(chan, irq_mask); -+ -+ phytium_chan_enable(chan); -+} -+ -+static void phytium_chan_start_first_queued(struct phytium_dma_chan *chan) -+{ -+ struct phytium_dma_desc *desc = NULL; -+ struct virt_dma_desc *vd = NULL; -+ -+ vd = vchan_next_desc(&chan->vc); -+ if (!vd) -+ return; -+ -+ desc = vd_to_desc(vd); -+ dev_dbg(chan2dev(chan), "%s: started %u\n", phytium_chan_name(chan), -+ vd->tx.cookie); -+ -+ phytium_chan_block_xfer_start(chan, desc); -+} -+ -+static void phytium_dma_hw_init(struct phytium_dma_chip *chip) -+{ -+ u32 i; -+ -+ for (i = 0; i < chip->hdata->nr_channels; i++) { -+ phytium_chan_irq_disable(&chip->dmac->chan[i], -+ DMA_CTRL_IRQ_MASK(0xF)); -+ phytium_chan_disable(&chip->dmac->chan[i]); -+ } -+} -+ -+ -+static enum dma_status phytium_dma_tx_status(struct dma_chan *dchan, -+ dma_cookie_t cookie, -+ struct dma_tx_state *state) -+{ -+ enum dma_status ret; -+ -+ ret = dma_cookie_status(dchan, cookie, state); -+ -+ return ret; -+} -+ -+static void phytium_dma_issue_pending(struct dma_chan *dchan) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ unsigned long flags; -+ -+ spin_lock_irqsave(&chan->vc.lock, flags); -+ if (vchan_issue_pending(&chan->vc) && chan->is_idle) -+ phytium_chan_start_first_queued(chan); -+ spin_unlock_irqrestore(&chan->vc.lock, flags); -+} -+ -+static void phytium_dma_synchronize(struct dma_chan *dchan) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ -+ vchan_synchronize(&chan->vc); -+} -+ -+static int phytium_dma_terminate_all(struct dma_chan *dchan) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ unsigned long flags; -+ LIST_HEAD(head); -+ -+ spin_lock_irqsave(&chan->vc.lock, flags); -+ -+ phytium_chan_disable(chan); -+ -+ vchan_get_all_descriptors(&chan->vc, &head); -+ -+ /* -+ * As vchan_dma_desc_free_list can access to desc_allocated list -+ * we need to call it in vc.lock context. -+ */ -+ vchan_dma_desc_free_list(&chan->vc, &head); -+ -+ spin_unlock_irqrestore(&chan->vc.lock, flags); -+ -+ dev_vdbg(dchan2dev(dchan), "terminated: %s\n", phytium_chan_name(chan)); -+ -+ return 0; -+} -+ -+static int phytium_dma_alloc_chan_resources(struct dma_chan *dchan) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ -+ /* ASSERT: channel is idle */ -+ if (chan->is_used) { -+ dev_err(chan2dev(chan), "%s is non-idle!\n", -+ phytium_chan_name(chan)); -+ return -EBUSY; -+ } -+ -+ chan->is_used = true; -+ atomic_set(&chan->releasing, 0); -+ -+ return 0; -+} -+ -+static void phytium_dma_free_chan_resources(struct dma_chan *dchan) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ -+ atomic_set(&chan->releasing, 1); -+ -+ phytium_chan_disable(chan); -+ phytium_chan_irq_disable(chan, DMA_CTRL_IRQ_MASK(0xF)); -+ -+ vchan_free_chan_resources(&chan->vc); -+ -+ dev_vdbg(dchan2dev(dchan), -+ "%s: free resources, descriptor still allocated: %u\n", -+ phytium_chan_name(chan), atomic_read(&chan->descs_allocated)); -+ -+ chan->is_used = false; -+} -+ -+static int phytium_dma_slave_config(struct dma_chan *dchan, -+ struct dma_slave_config *sconfig) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ -+ /* Check if chan will be configured for slave transfers */ -+ if (!is_slave_direction(sconfig->direction)) -+ return -EINVAL; -+ -+ memcpy(&chan->dma_sconfig, sconfig, sizeof(*sconfig)); -+ -+ return 0; -+} -+ -+static struct dma_async_tx_descriptor *phytium_dma_prep_dma_memcpy( -+ struct dma_chan *dchan, dma_addr_t dst_adr, -+ dma_addr_t src_adr, size_t len, unsigned long flags) -+{ -+ struct phytium_dma_desc *desc = NULL; -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ struct dma_slave_config *sconfig = &chan->dma_sconfig; -+ size_t block_ts, max_block_ts, xfer_len; -+ -+ chan = dchan_to_dma_chan(dchan); -+ -+ dev_info(chan2dev(chan), "%s: memcpy: src: %pad dst: %pad length: %zd flags: %#lx", -+ phytium_chan_name(chan), &src_adr, &dst_adr, len, flags); -+ -+ max_block_ts = chan->chip->hdata->block_size[chan->id]; -+ if (len > max_block_ts) { -+ dev_err(chan2dev(chan), -+ "The data length(%zd) is too long!\n", len); -+ return NULL; -+ } -+ -+ xfer_len = len; -+ block_ts = xfer_len >> DMA_SLAVE_BUSWIDTH_4_BYTES; -+ xfer_len = block_ts << DMA_SLAVE_BUSWIDTH_4_BYTES; -+ -+ desc = phytium_desc_get(chan); -+ if (unlikely(!desc)) -+ goto err_desc_get; -+ -+ switch (sconfig->direction) { -+ case DMA_MEM_TO_DEV: -+ desc->dma_srcparam = DMA_SRCP_SRC_ID(0); -+ desc->dma_destparam = DMA_DESTP_DEST_ID(5); -+ break; -+ case DMA_DEV_TO_MEM: -+ desc->dma_srcparam = DMA_SRCP_SRC_ID(5); -+ desc->dma_destparam = DMA_DESTP_DEST_ID(0); -+ break; -+ default: -+ return NULL; -+ } -+ -+ desc->dma_ctrl |= DMA_CTRL_SG_EN; -+ desc->dma_ctrl |= DMA_CTRL_SG_TYPE(0); -+ -+ desc->dma_ctrl |= DMA_CTRL_SG_ID(0); -+ desc->dma_ctrl |= DMA_CTRL_SG2_ID(0); -+ desc->dma_ctrl |= DMA_CTRL_IRQ_ID(0); -+ -+ desc->dma_srcaddr_l = src_adr & 0xFFFFFFFF; -+ desc->dma_srcaddr_h = (src_adr >> 32) & 0xFFFFFFFF; -+ desc->dma_destaddr_l = dst_adr & 0xFFFFFFFF; -+ desc->dma_destaddr_h = (dst_adr >> 32) & 0xFFFFFFFF; -+ desc->dma_len = xfer_len; -+ -+ return vchan_tx_prep(&chan->vc, &desc->vd, flags); -+ -+err_desc_get: -+ phytium_desc_put(desc); -+ return NULL; -+} -+ -+static struct dma_async_tx_descriptor *phytium_dma_prep_slave_sg( -+ struct dma_chan *dchan, struct scatterlist *sgl, -+ u32 sg_len, enum dma_transfer_direction direction, -+ unsigned long flags, void *context) -+{ -+ struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); -+ struct dma_slave_config *sconfig = &chan->dma_sconfig; -+ struct phytium_dma_desc *desc = NULL; -+ struct phytium_chan_desc *chan_desc = NULL; -+ dma_addr_t reg; -+ unsigned int i = 0; -+ struct scatterlist *sg = NULL; -+ size_t total_len = 0; -+ u32 offset = 0; -+ -+ if (unlikely(!is_slave_direction(direction) || !sg_len)) { -+ dev_err(chan2dev(chan), "%s: bad direction\n", __func__); -+ return NULL; -+ } -+ -+ if (atomic_read(&chan->releasing)) { -+ dev_err(chan2dev(chan), -+ "%s: scheduled for release\n", __func__); -+ return NULL; -+ } -+ -+ desc = phytium_desc_get(chan); -+ if (unlikely(!desc)) -+ goto err_desc_get; -+ -+ chan_desc = kzalloc((sg_len + 1) * sizeof(struct phytium_chan_desc), -+ GFP_KERNEL | GFP_DMA); -+ if (unlikely(!chan_desc)) { -+ dev_err(chan->chip->dev, "Malloc space for chan_desc failed\n"); -+ goto err_desc_get; -+ } -+ -+ desc->cdesc = chan_desc; -+ -+ /* Must be aligned on 32-byte boundary */ -+ offset = (u64)chan_desc & 0x1F; -+ if (offset) -+ chan_desc = chan_desc + 32 - offset; -+ -+ for_each_sg(sgl, sg, sg_len, i) { -+ if (!sg) -+ break; -+ -+ if (direction == DMA_MEM_TO_DEV) { -+ chan_desc[i].desc_src_addr_l = -+ sg_dma_address(sg) & SG_OFFSET; -+ chan_desc[i].desc_src_addr_h = -+ (sg_dma_address(sg) >> 32) & -+ SG_OFFSET; -+ } else if (direction == DMA_DEV_TO_MEM) { -+ chan_desc[i].desc_dst_addr_l = -+ sg_dma_address(sg) & SG_OFFSET; -+ chan_desc[i].desc_dst_addr_h = -+ (sg_dma_address(sg) >> 32) & -+ SG_OFFSET; -+ } else { -+ kfree(desc->cdesc); -+ goto err_desc_get; -+ } -+ -+ chan_desc[i].desc_control = 0; -+ chan_desc[i].desc_control |= sg_dma_len(sg) << 8; -+ -+ if (sg_is_last(sg)) { -+ chan_desc[i].desc_next_addr_l = 0x01; -+ chan_desc[i].desc_next_addr_h = 0; -+ chan_desc[i].desc_control |= 0x03 << 4; -+ } else { -+ chan_desc[i].desc_next_addr_l = -+ virt_to_phys(&chan_desc[i+1]) & SG_OFFSET; -+ chan_desc[i].desc_next_addr_l |= 0x01 << 4; -+ chan_desc[i].desc_next_addr_l |= 0x02; -+ chan_desc[i].desc_next_addr_h = -+ (virt_to_phys(&chan_desc[i+1]) >> 32) & -+ SG_OFFSET; -+ } -+ total_len += sg_dma_len(sg); -+ } -+ -+ switch (direction) { -+ case DMA_MEM_TO_DEV: -+ reg = sconfig->dst_addr; -+ -+ desc->dma_srcparam = DMA_SRCP_SRC_ID(0); -+ desc->dma_destparam = DMA_DESTP_DEST_ID(5); -+ desc->dma_ctrl |= DMA_CTRL_SG_TYPE(1); -+ -+ desc->dma_srcaddr_l = virt_to_phys(chan_desc) & SG_OFFSET; -+ desc->dma_srcaddr_h = -+ (virt_to_phys(chan_desc) >> 32) & SG_OFFSET; -+ desc->dma_destaddr_l = sconfig->dst_addr & SG_OFFSET; -+ desc->dma_destaddr_h = (sconfig->dst_addr >> 32) & SG_OFFSET; -+ break; -+ case DMA_DEV_TO_MEM: -+ reg = sconfig->src_addr; -+ -+ /* memcpy from device */ -+ desc->dma_srcparam = DMA_SRCP_SRC_ID(5); -+ desc->dma_destparam = DMA_DESTP_DEST_ID(0); -+ desc->dma_ctrl |= DMA_CTRL_SG_TYPE(2); -+ -+ desc->dma_srcaddr_l = sconfig->src_addr & SG_OFFSET; -+ desc->dma_srcaddr_h = (sconfig->src_addr >> 32) & SG_OFFSET; -+ desc->dma_destaddr_l = -+ virt_to_phys(chan_desc) & SG_OFFSET; -+ desc->dma_destaddr_h = -+ (virt_to_phys(chan_desc) >> 32) & SG_OFFSET; -+ break; -+ default: -+ return NULL; -+ } -+ -+ desc->dma_ctrl |= DMA_CTRL_SG_EN; -+ -+ desc->dma_ctrl |= DMA_CTRL_SG_ID(0); -+ desc->dma_ctrl |= DMA_CTRL_SG2_ID(0); -+ desc->dma_ctrl |= DMA_CTRL_IRQ_ID(0); -+ -+ desc->dma_len = total_len; -+ -+ return vchan_tx_prep(&chan->vc, &desc->vd, flags); -+ -+err_desc_get: -+ dev_err(chan2dev(chan), -+ "not enough descriptors available. Direction %d\n", direction); -+ phytium_desc_put(desc); -+ return NULL; -+} -+ -+static void phytium_chan_block_xfer_complete_msi(struct phytium_dma_chan *chan) -+{ -+ struct virt_dma_desc *vd = NULL; -+ struct phytium_dma_desc *desc = NULL; -+ -+ chan->is_idle = true; -+ if (phytium_chan_is_running(chan)) { -+ dev_err(chan2dev(chan), "DMA %s is not idle!\n", -+ phytium_chan_name(chan)); -+ phytium_chan_disable(chan); -+ } -+ -+ /* The completed descriptor currently is in the head of vc list */ -+ vd = vchan_next_desc(&chan->vc); -+ if (!vd) { -+ dev_err(chan2dev(chan), "complete vchan next desc failed\n"); -+ return; -+ } -+ -+ desc = vd_to_desc(vd); -+ if (!desc) { -+ dev_err(chan2dev(chan), "vd to desc failed\n"); -+ return; -+ } -+ -+ kfree(desc->cdesc); -+ -+ /* Remove the completed descriptor from issued list before completing */ -+ list_del(&vd->node); -+ vchan_cookie_complete(vd); -+ -+ /* Submit queued descriptors after processing the completed ones */ -+ phytium_chan_start_first_queued(chan); -+} -+ -+static void phytium_chan_block_xfer_complete_intx(struct phytium_dma_chan *chan) -+{ -+ struct virt_dma_desc *vd = NULL; -+ struct phytium_dma_desc *desc = NULL; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&chan->vc.lock, flags); -+ chan->is_idle = true; -+ if (phytium_chan_is_running(chan)) { -+ dev_err(chan2dev(chan), "DMA %s is not idle!\n", -+ phytium_chan_name(chan)); -+ phytium_chan_disable(chan); -+ } -+ -+ /* The completed descriptor currently is in the head of vc list */ -+ vd = vchan_next_desc(&chan->vc); -+ if (!vd) { -+ spin_unlock_irqrestore(&chan->vc.lock, flags); -+ dev_err(chan2dev(chan), "complete vchan next desc failed\n"); -+ return; -+ } -+ -+ desc = vd_to_desc(vd); -+ if (!desc) { -+ spin_unlock_irqrestore(&chan->vc.lock, flags); -+ dev_err(chan2dev(chan), "vd to desc failed\n"); -+ return; -+ } -+ -+ kfree(desc->cdesc); -+ -+ /* Remove the completed descriptor from issued list before completing */ -+ list_del(&vd->node); -+ vchan_cookie_complete(vd); -+ -+ /* Submit queued descriptors after processing the completed ones */ -+ phytium_chan_start_first_queued(chan); -+ spin_unlock_irqrestore(&chan->vc.lock, flags); -+} -+ -+static irqreturn_t phytium_dma_interrupt_msi(int irq, void *dev_id) -+{ -+ unsigned long flags; -+ struct phytium_dma_chan *chan = dev_id; -+ struct phytium_dma_chip *chip = chan->chip; -+ -+ u32 irq_status; -+ u32 irq_mask = 0xffff; -+ u32 chan_status; -+ u32 mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; -+ -+ spin_lock_irqsave(&chan->vc.lock, flags); -+ -+ chan_status = phytium_chan_status_read(chan); -+ irq_status = phytium_dma_irq_read(chip); -+ -+ if (!(irq_status & irq_mask)) { -+ dev_err(chan2dev(chan), "irq_status = 0x%x, irq_mask = 0x%x, chan_status = 0x%x", -+ irq_status, irq_mask, chan_status); -+ if ((chan_status & DMA_STAT_END) | -+ (chan_status & DMA_STAT_EOP) | -+ (chan_status & DMA_STAT_EOC) | -+ (chan_status & DMA_STAT_ERR)) { -+ irq_status = phytium_dma_irq_read(chip); -+ goto next; -+ } else { -+ return IRQ_NONE; -+ } -+ } -+ -+next: -+ /* Disable DMAC inerrupts. We'll enable them after processing chanels */ -+ phytium_dma_irq_disable(chip); -+ phytium_chan_irq_disable(chan, mask); -+ phytium_chan_irq_clear(chan, mask); -+ phytium_dma_irq_clear(chip, irq_status); -+ -+ if ((chan_status & DMA_STAT_ERR)) { -+ dev_err(chan2dev(chan), "chan handle err, chan status is %x\n", -+ chan_status); -+ } else if ((chan_status & DMA_STAT_END) | (chan_status & DMA_STAT_EOP) | -+ (chan_status & DMA_STAT_EOC)) { -+ phytium_chan_block_xfer_complete_msi(chan); -+ } else { -+ dev_err(chan2dev(chan), "irq_status = 0x%x, ----unknown reason:%x\n", -+ irq_status, chan_status); -+ } -+ -+ /* Re-enable interrupts */ -+ phytium_dma_irq_enable(chip); -+ -+ spin_unlock_irqrestore(&chan->vc.lock, flags); -+ -+ return IRQ_HANDLED; -+} -+ -+static irqreturn_t phytium_dma_interrupt_intx(int irq, void *dev_id) -+{ -+ struct phytium_dma_chip *chip = dev_id; -+ struct phytium_dma *dmac = chip->dmac; -+ struct phytium_dma_chan *chan; -+ u32 irq_status = 0; -+ u32 irq_mask = 0; -+ u32 chan_status = 0; -+ u32 mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; -+ u32 i; -+ -+ irq_status = phytium_dma_irq_read(chip); -+ irq_status = irq_status & 0xffff; -+ irq_mask = phytium_dma_irq_mask_read(chip); -+ -+ if (!(irq_status & irq_mask)) -+ return IRQ_NONE; -+ -+ /* Disable DMAC inerrupts. We'll enable them after processing chanels */ -+ phytium_dma_irq_disable(chip); -+ phytium_dma_irq_clear(chip, irq_status); -+ -+ /* Poll, clear and process every chanel interrupt status */ -+ for (i = 0; i < chip->hdata->nr_channels; i++) { -+ if (!(irq_status & BIT(i)) && !(irq_status & BIT(i + 8))) -+ continue; -+ -+ chan = &dmac->chan[i]; -+ -+ chan_status = phytium_chan_status_read(chan); -+ -+ phytium_chan_irq_disable(chan, mask); -+ if ((chan_status & DMA_STAT_ERR)) -+ dev_err(chan2dev(chan), "chan handle err, chan status is %x\n", -+ chan_status); -+ else if ((chan_status & DMA_STAT_END) | -+ (chan_status & DMA_STAT_EOP) | -+ (chan_status & DMA_STAT_EOC)) -+ phytium_chan_block_xfer_complete_intx(chan); -+ else -+ dev_err(chan2dev(chan), "irq_status = 0x%x, ----unknown reason:%x\n", -+ irq_status, chan_status); -+ -+ phytium_chan_irq_set(chan, mask); -+ } -+ -+ /* Re-enable interrupts */ -+ phytium_dma_irq_enable(chip); -+ -+ return IRQ_HANDLED; -+} -+ -+struct phytium_dma_hcfg phytium_octopus_dma_hdata = { -+ .nr_channels = 4, -+ .nr_masters = 1, -+ .m_data_width = DMA_SLAVE_BUSWIDTH_4_BYTES, -+ .block_size[0] = 0x2000000, -+ .block_size[1] = 0x2000000, -+ .priority[0] = 0, -+ .priority[1] = 1, -+ .axi_rw_burst_len = 0, -+ .restrict_axi_burst_len = false, -+}; -+ -+static int phytium_dma_probe(struct phytium_dma_chip *chip) -+{ -+ struct phytium_dma_chan *chan; -+ struct pci_dev *pdev = chip->pdev; -+ struct phytium_dma *dmac; -+ struct phytium_dma_hcfg *hdata; -+ u32 i; -+ int ret = -1; -+ -+ chip->dev = &pdev->dev; -+ dmac = devm_kzalloc(chip->dev, sizeof(*dmac), GFP_KERNEL); -+ if (!dmac) { -+ dev_err(chip->dev, "dmac zalloc failed\n"); -+ return -ENOMEM; -+ } -+ -+ hdata = devm_kzalloc(chip->dev, sizeof(*hdata), GFP_KERNEL); -+ -+ hdata->nr_channels = 4; -+ memcpy(hdata, &phytium_octopus_dma_hdata, -+ sizeof(phytium_octopus_dma_hdata)); -+ -+ chip->dmac = dmac; -+ chip->hdata = hdata; -+ -+ dmac->chan = devm_kcalloc(chip->dev, hdata->nr_channels, -+ sizeof(*dmac->chan), GFP_KERNEL); -+ -+ /* Set capabilities */ -+ dma_cap_set(DMA_MEMCPY, dmac->dma.cap_mask); -+ dma_cap_set(DMA_SLAVE, dmac->dma.cap_mask); -+ dma_cap_set(DMA_PRIVATE, dmac->dma.cap_mask); -+ -+ /* DMA capabilities */ -+ dmac->dma.chancnt = hdata->nr_channels; -+ dmac->dma.src_addr_widths = DMA_SLAVE_BUSWIDTH_4_BYTES; -+ dmac->dma.dst_addr_widths = DMA_SLAVE_BUSWIDTH_4_BYTES; -+ dmac->dma.directions = BIT(DMA_MEM_TO_MEM) | -+ BIT(DMA_DEV_TO_MEM) | -+ BIT(DMA_MEM_TO_DEV); -+ dmac->dma.residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; -+ -+ dmac->dma.dev = chip->dev; -+ dmac->dma.device_tx_status = phytium_dma_tx_status; -+ dmac->dma.device_issue_pending = phytium_dma_issue_pending; -+ dmac->dma.device_terminate_all = phytium_dma_terminate_all; -+ dmac->dma.device_synchronize = phytium_dma_synchronize; -+ -+ dmac->dma.device_alloc_chan_resources = -+ phytium_dma_alloc_chan_resources; -+ dmac->dma.device_free_chan_resources = -+ phytium_dma_free_chan_resources; -+ -+ dmac->dma.device_prep_dma_memcpy = phytium_dma_prep_dma_memcpy; -+ dmac->dma.device_config = phytium_dma_slave_config; -+ dmac->dma.device_prep_slave_sg = phytium_dma_prep_slave_sg; -+ -+ -+ INIT_LIST_HEAD(&dmac->dma.channels); -+ for (i = 0; i < chip->hdata->nr_channels; i++) { -+ chan = &dmac->chan[i]; -+ chan->chip = chip; -+ chan->id = i; -+ chan->chan_regs = chip->regs + i * CHAN_REG_LEN; -+ chan->is_used = false; -+ chan->is_idle = true; -+ chan->is_paused = false; -+ -+ chan->vc.desc_free = phytium_vchan_desc_put; -+ vchan_init(&chan->vc, &dmac->dma); -+ } -+ -+ /* ----lt add begin--- */ -+ dmac->dma.filter.map = ft_px210gpu_slave_map; -+ dmac->dma.filter.mapcnt = ARRAY_SIZE(ft_px210gpu_slave_map); -+ dmac->dma.filter.fn = px210_filter_fn; -+ /*----lt add end----*/ -+ -+ phytium_dma_hw_init(chip); -+ -+ ret = dma_async_device_register(&dmac->dma); -+ if (ret) -+ goto err_pm_disable; -+ -+ ret = pci_alloc_irq_vectors(pdev, 4, 4, PCI_IRQ_MSI); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "fialed to allocate MSI entry"); -+ goto intx; -+ } -+ -+ for (i = 0; i < chip->hdata->nr_channels; i++) { -+ chan = &dmac->chan[i]; -+ chan->irq = pci_irq_vector(pdev, i); -+ dev_err(&pdev->dev, "desc->irq = 0x%x", chan->irq); -+ -+ ret = devm_request_irq(&pdev->dev, chan->irq, -+ phytium_dma_interrupt_msi, 0, -+ dev_name(chan2dev(chan)), chan); -+ if (ret) { -+ dev_err(&pdev->dev, -+ "faild %d channal with err %d", i, ret); -+ goto intx; -+ } -+ } -+ goto irq_done; -+ -+intx: -+ chip->irq = pdev->irq; -+ ret = devm_request_irq(chip->dev, chip->irq, -+ phytium_dma_interrupt_intx, -+ IRQF_SHARED, dev_name(chip->dev), chip); -+ if (ret) { -+ dev_err(&pdev->dev, "no interrupt used\n"); -+ return ret; -+ } -+ -+irq_done: -+ return 0; -+ -+err_pm_disable: -+ pm_runtime_disable(chip->dev); -+ -+ return ret; -+} -+ -+static int phytium_dma_remove(struct phytium_dma_chip *chip) -+{ -+ struct phytium_dma *dmac = chip->dmac; -+ struct phytium_dma_chan *chan, *_chan; -+ -+ list_for_each_entry_safe(chan, _chan, &dmac->dma.channels, -+ vc.chan.device_node) { -+ list_del(&chan->vc.chan.device_node); -+ tasklet_kill(&chan->vc.task); -+ } -+ -+ dma_async_device_unregister(&dmac->dma); -+ -+ return 0; -+} -+ -+static int phytium_pci_probe(struct pci_dev *pdev, -+ const struct pci_device_id *pid) -+{ -+ struct phytium_dma_chip *chip; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ ret = pcim_iomap_regions(pdev, 1 << 0, pci_name(pdev)); -+ if (ret) { -+ dev_err(&pdev->dev, "I/O memory remapping failed\n"); -+ return ret; -+ } -+ -+ pci_set_master(pdev); -+ pci_try_set_mwi(pdev); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 18, 0)) -+ ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64)); -+ if (ret) -+ return ret; -+#else -+ ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); -+ if (ret) -+ return ret; -+ -+ ret = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); -+ if (ret) -+ return ret; -+#endif -+ -+ chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); -+ if (!chip) -+ return -ENOMEM; -+ -+ chip->pdev = pdev; -+ chip->dev = &pdev->dev; -+ chip->id = pdev->devfn; -+ chip->regs = pcim_iomap_table(pdev)[0] + COMMON_REG_LEN; -+ -+ ret = phytium_dma_probe(chip); -+ if (ret) -+ return ret; -+ -+ pci_set_drvdata(pdev, chip); -+ -+ dev_dbg(&pdev->dev, "Phytium dma device at 0x%p 0x%llx\n", -+ chip->regs, pdev->resource[0].start); -+ return 0; -+} -+ -+static void phytium_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_dma_chip *chip = pci_get_drvdata(pdev); -+ int ret; -+ -+ ret = phytium_dma_remove(chip); -+ if (ret) -+ dev_warn(&pdev->dev, "can't remove device properly: %d\n", ret); -+} -+ -+static const struct pci_device_id phytium_pci_id_table[] = { -+ { -+ vendor:0x1DB7, -+ device : 0xDC3C, -+ subvendor : PCI_ANY_ID, -+ subdevice : PCI_ANY_ID, -+ class : 0, -+ class_mask : 0, -+ driver_data : (kernel_ulong_t)&phytium_octopus_dma_hdata, -+ }, -+ { } -+}; -+MODULE_DEVICE_TABLE(pci, phytium_pci_id_table); -+#ifdef CONFIG_PM_SLEEP -+ -+static int phytium_pci_prepare(struct device *dev) -+{ -+ u32 i; -+ struct pci_dev *pci = to_pci_dev(dev); -+ struct phytium_dma_chip *chip = pci_get_drvdata(pci); -+ struct phytium_dma_chan *chan; -+ -+ phytium_dma_hw_init(chip); -+ -+ for (i = 0; i < chip->hdata->nr_channels; i++) { -+ chan = &chip->dmac->chan[i]; -+ if (phytium_chan_is_running(chan)) { -+ dev_err(chan2dev(chan), -+ "DMA driver would suspend\n"); -+ return -1; -+ } -+ -+ } -+ return 0; -+}; -+ -+static int phytium_pci_suspend_late(struct device *dev) -+{ -+ struct pci_dev *pci = to_pci_dev(dev); -+ struct phytium_dma_chip *chip = pci_get_drvdata(pci); -+ -+ phytium_dma_hw_init(chip); -+ return 0; -+}; -+ -+static int phytium_pci_resume_early(struct device *dev) -+{ -+ struct pci_dev *pci = to_pci_dev(dev); -+ struct phytium_dma_chip *chip = pci_get_drvdata(pci); -+ -+ phytium_dma_hw_init(chip); -+ return 0; -+}; -+ -+#endif -+ -+static const struct dev_pm_ops phytium_pci_dev_pm_ops = { -+ .prepare = phytium_pci_prepare, -+ SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_pci_suspend_late, -+ phytium_pci_resume_early) -+}; -+ -+static struct pci_driver phytium_pci_driver = { -+ .name = "phytium_dmac_pci", -+ .id_table = phytium_pci_id_table, -+ .probe = phytium_pci_probe, -+ .remove = phytium_pci_remove, -+ .driver = { -+ .pm = &phytium_pci_dev_pm_ops, -+ }, -+}; -+ -+bool px210_filter_fn(struct dma_chan *chan, void *param) -+{ -+ if (chan->device->dev->driver != &phytium_pci_driver.driver) -+ return false; -+ -+ return true; -+} -+ -+module_pci_driver(phytium_pci_driver); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium DMA Controller platform driver"); -+MODULE_AUTHOR("Zhu mingshuai "); -+MODULE_AUTHOR("Liu tao "); -+MODULE_AUTHOR("Li Wenxiang "); -diff --git a/drivers/dma/phytium/phytium-dmac-pci.h b/drivers/dma/phytium/phytium-dmac-pci.h -new file mode 100644 -index 000000000..3d2d2462b ---- /dev/null -+++ b/drivers/dma/phytium/phytium-dmac-pci.h -@@ -0,0 +1,188 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium PCI DMA Controller driver. -+ * -+ * 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. -+ */ -+ -+#ifndef _AXI_DMA_PLATFORM_H -+#define _AXI_DMA_PLATFORM_H -+ -+#include -+#include -+#include -+#include -+#include -+#include "../virt-dma.h" -+ -+#define DMAC_MAX_CHANNELS 4 -+#define DMAC_MAX_MASTERS 1 -+#define DMAC_MAX_BLK_SIZE (1024 * 1024 * 2) -+#define SG_OFFSET 0xFFFFFFFF -+ -+struct phytium_dma_hcfg { -+ u32 nr_channels; -+ u32 nr_masters; -+ u32 m_data_width; -+ u32 block_size[DMAC_MAX_CHANNELS]; -+ u32 priority[DMAC_MAX_CHANNELS]; -+ /* maximum supported axi burst length */ -+ u32 axi_rw_burst_len; -+ bool restrict_axi_burst_len; -+}; -+ -+struct phytium_dma_chan { -+ struct phytium_dma_chip *chip; -+ void __iomem *chan_regs; -+ u8 id; -+ unsigned int irq; -+ atomic_t descs_allocated; -+ atomic_t releasing; -+ -+ struct virt_dma_chan vc; -+ -+ struct dma_slave_config dma_sconfig; -+ -+ bool is_used; -+ bool is_idle; -+ /* these other elements are all protected by vc.lock */ -+ bool is_paused; -+}; -+ -+struct phytium_dma { -+ struct dma_device dma; -+ //const struct phytium_dma_hcfg *hdata; -+ -+ /* channels */ -+ struct phytium_dma_chan *chan; -+}; -+ -+struct phytium_dma_chip { -+ struct pci_dev *pdev; -+ struct device *dev; -+ void __iomem *regs; -+ struct clk *core_clk; -+ struct phytium_dma *dmac; -+ -+ int irq; -+ int id; -+ struct completion complete; -+ -+ const struct phytium_dma_hcfg *hdata; -+ struct phytium_dma_chan chan[4]; -+}; -+ -+struct phytium_chan_desc { -+ u32 desc_status; -+ u32 desc_control; -+ u32 desc_next_addr_l; -+ u32 desc_next_addr_h; -+ u32 desc_src_addr_l; -+ u32 desc_src_addr_h; -+ u32 desc_dst_addr_l; -+ u32 desc_dst_addr_h; -+} __attribute__ ((__packed__)); -+ -+struct phytium_dma_desc { -+ struct virt_dma_desc vd; -+ struct phytium_dma_chan *chan; -+ struct list_head xfer_list; -+ struct dma_async_tx_descriptor *txd; -+ struct phytium_chan_desc *cdesc; -+ struct scatterlist *end_sg; -+ u32 dma_srcparam; -+ u32 dma_destparam; -+ u32 dma_srcaddr_l; -+ u32 dma_srcaddr_h; -+ u32 dma_destaddr_l; -+ u32 dma_destaddr_h; -+ u32 dma_len; -+ u32 dma_ctrl; -+ u32 sg_len; -+}; -+ -+bool px210_filter_fn(struct dma_chan *chan, void *param); -+ -+static inline struct device *dchan2dev(struct dma_chan *dchan) -+{ -+ return &dchan->dev->device; -+} -+ -+static inline struct device *chan2dev(struct phytium_dma_chan *chan) -+{ -+ return &chan->vc.chan.dev->device; -+} -+ -+static inline struct phytium_dma_desc *vd_to_desc(struct virt_dma_desc *vd) -+{ -+ return container_of(vd, struct phytium_dma_desc, vd); -+} -+ -+static inline struct phytium_dma_chan *vc_to_dma_chan(struct virt_dma_chan *vc) -+{ -+ return container_of(vc, struct phytium_dma_chan, vc); -+} -+ -+static inline struct phytium_dma_chan *dchan_to_dma_chan(struct dma_chan *dchan) -+{ -+ return vc_to_dma_chan(to_virt_chan(dchan)); -+} -+ -+#define TX_SG_LEN (1024 * 32) -+#define PAGE_SIZE2 (PAGE_SIZE << 1) -+ -+#define COMMON_REG_LEN 0 -+#define CHAN_REG_LEN 0x40 -+ -+#define DMA_IRQ_MASK 0x180 -+#define DMA_IRQ_STATUS 0x184 -+#define DMA_SRCPARAM 0x400 -+#define DMA_DESTPARAM 0x404 -+#define DMA_SRCADDR_L 0x408 -+#define DMA_SRCADDR_H 0x40C -+#define DMA_DESTADDR_L 0x410 -+#define DMA_DESTADDR_H 0x414 -+#define DMA_LENGTH 0x418 -+#define DMA_CONTROL 0x41C -+#define DMA_STATUS 0x420 -+#define DMA_PRC_LEN 0x424 -+#define DMA_SHARE_ACCESS 0x428 -+ -+#define DMA_SRCP_SRC_ID(x) min_t(unsigned int, x, 0xF) -+#define DMA_SRCP_TRSF_PARAM(x) (min_t(unsigned int, x, 0xFFF) << 16) -+#define DMA_DESTP_DEST_ID(x) min_t(unsigned int, x, 0xF) -+#define DMA_DESTP_TRSF_PARAM(x) (min_t(unsigned int, x, 0xFFF) << 16) -+#define DMA_CTRL_START BIT(0) -+#define DMA_CTRL_PAUSE BIT(1) -+#define DMA_CTRL_SG_EN BIT(3) -+#define DMA_CTRL_COND_LEN BIT(5) -+#define DMA_CTRL_COND_EOP BIT(6) -+#define DMA_CTRL_COND_ERR BIT(7) -+#define DMA_CTRL_COND_MASK(x) (min_t(unsigned int, x, 0xF) << 4) -+#define DMA_CTRL_IRQ_END BIT(8) -+#define DMA_CTRL_IRQ_ERR BIT(9) -+#define DMA_CTRL_IRQ_EOP BIT(10) -+#define DMA_CTRL_IRQ_MASK(x) (min_t(unsigned int, x, 0xF) << 8) -+#define DMA_CTRL_IRQ_ID(x) (min_t(unsigned int, x, 0x3) << 12) -+#define DMA_CTRL_DESC_UPDT BIT(23) -+#define DMA_CTRL_SG_TYPE(x) (min_t(unsigned int, x, 0x3) << 24) -+#define DMA_CTRL_SG_ID(x) (min_t(unsigned int, x, 0x5) << 26) -+#define DMA_CTRL_SG2_ID(x) (min_t(unsigned int, x, 0x5) << 29) -+#define DMA_STAT_MASK(x) (min_t(unsigned int, x, 0xFF) << 0) -+#define DMA_STAT_END BIT(0) -+#define DMA_STAT_EOP BIT(1) -+#define DMA_STAT_EOC BIT(2) -+#define DMA_STAT_ERR BIT(3) -+#define DMA_STAT_OVER BIT(4) -+#define DMA_STAT_STOP BIT(6) -+#define DMA_STAT_INCORRECT BIT(7) -+#define DMA_SRC_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 8) -+#define DMA_DEST_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 16) -+#define DMA_DESC_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 24) -+ -+#define DMA_TIMEOUT 200 -+ -+#endif /* _AXI_DMA_PLATFORM_H */ -diff --git a/drivers/dma/phytium/phytium-gdmac.c b/drivers/dma/phytium/phytium-gdmac.c -new file mode 100644 -index 000000000..ac8dd74b4 ---- /dev/null -+++ b/drivers/dma/phytium/phytium-gdmac.c -@@ -0,0 +1,1035 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium Device GDMA Controller driver. -+ * -+ * Copyright (c) 2023-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium-gdmac.h" -+ -+#define PHYTIUM_GDMA_DRIVER_VERSION "1.0.0" -+ -+static inline struct phytium_gdma_device *to_gdma_device(struct dma_chan *chan) -+{ -+ return container_of(chan->device, struct phytium_gdma_device, dma_dev); -+} -+ -+static inline struct phytium_gdma_chan *to_gdma_chan(struct dma_chan *chan) -+{ -+ return container_of(chan, struct phytium_gdma_chan, vchan.chan); -+} -+ -+static inline struct phytium_gdma_desc *to_gdma_desc(struct virt_dma_desc *vd) -+{ -+ return container_of(vd, struct phytium_gdma_desc, vdesc); -+} -+ -+static inline struct device *chan_to_dev(struct phytium_gdma_chan *chan) -+{ -+ return chan->vchan.chan.device->dev; -+} -+ -+static inline -+struct phytium_gdma_device *chan_to_gdma(struct phytium_gdma_chan *chan) -+{ -+ return to_gdma_device(&chan->vchan.chan); -+} -+ -+static inline void phytium_gdma_write(const struct phytium_gdma_device *gdma, -+ const u32 reg, const u32 val) -+{ -+ iowrite32(val, gdma->base + reg); -+} -+ -+static inline u32 phytium_gdma_read(const struct phytium_gdma_device *gdma, -+ const u32 reg) -+{ -+ return ioread32(gdma->base + reg); -+} -+ -+static inline void phytium_chan_write(const struct phytium_gdma_chan *chan, -+ const u32 reg, const u32 val) -+{ -+ iowrite32(val, chan->base + reg); -+} -+ -+static inline u32 phytium_chan_read(const struct phytium_gdma_chan *chan, -+ const u32 reg) -+{ -+ return ioread32(chan->base + reg); -+} -+ -+static void phytium_gdma_dump_reg(struct phytium_gdma_chan *chan) -+{ -+ struct phytium_gdma_device *gdma = chan_to_gdma(chan); -+ -+ dev_dbg(chan_to_dev(chan), "gdma registers:\n"); -+ dev_dbg(chan_to_dev(chan), "\tDMA_CTL: 0x%08x\n", -+ phytium_gdma_read(gdma, DMA_CTL)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_STATE: 0x%08x\n", -+ phytium_gdma_read(gdma, DMA_STATE)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_INTR_CTL: 0x%08x\n", -+ phytium_gdma_read(gdma, DMA_INTR_CTL)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_LP_CTL: 0x%08x\n", -+ phytium_gdma_read(gdma, DMA_LP_CTL)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_QOS_CFG: 0x%08x\n", -+ phytium_gdma_read(gdma, DMA_QOS_CFG)); -+ -+ dev_dbg(chan_to_dev(chan), "gdma channel %d registers\n", chan->id); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_CTRL: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_CTRL)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_MODE: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_MODE)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_INTR_CTL: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_INTR_CTL)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_STATE: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_STATE)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_LVI: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_LVI)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_TS: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_TS)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_UPSADDR: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_UPSADDR)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_LWSADDR: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_LWSADDR)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_UPDADDR: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_UPDADDR)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_LWDADDR: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_LWDADDR)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_XFER_CFG: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_XFER_CFG)); -+ dev_dbg(chan_to_dev(chan), "\tDMA_C%d_LCP: 0x%08x\n", chan->id, -+ phytium_chan_read(chan, DMA_CX_LCP)); -+} -+ -+static void phytium_gdma_disable(const struct phytium_gdma_device *gdma) -+{ -+ u32 val = phytium_gdma_read(gdma, DMA_CTL); -+ -+ dev_dbg(gdma->dev, "gdma disable\n"); -+ val &= ~DMA_CTL_EN; -+ phytium_gdma_write(gdma, DMA_CTL, !DMA_CTL_EN); -+} -+ -+static void phytium_gdma_enable(const struct phytium_gdma_device *gdma) -+{ -+ u32 val = phytium_gdma_read(gdma, DMA_CTL); -+ -+ dev_dbg(gdma->dev, "gdma enable\n"); -+ val |= DMA_CTL_EN; -+ phytium_gdma_write(gdma, DMA_CTL, DMA_CTL_EN); -+} -+ -+static void phytium_gdma_reset(const struct phytium_gdma_device *gdma) -+{ -+ u32 val = 0; -+ -+ dev_dbg(gdma->dev, "dma reset\n"); -+ val = phytium_gdma_read(gdma, DMA_CTL); -+ val |= DMA_CTL_SRST; -+ phytium_gdma_write(gdma, DMA_CTL, val); -+ -+ udelay(10); -+ val &= ~DMA_CTL_SRST; -+ phytium_gdma_write(gdma, DMA_CTL, val); -+} -+ -+static void phytium_gdma_irq_disable(const struct phytium_gdma_device *gdma) -+{ -+ u32 val = 0; -+ -+ dev_dbg(gdma->dev, "gdma irq disable\n"); -+ val = phytium_gdma_read(gdma, DMA_INTR_CTL); -+ val &= ~DMA_INT_EN; -+ phytium_gdma_write(gdma, DMA_INTR_CTL, val); -+} -+ -+static void phytium_gdma_irq_enable(const struct phytium_gdma_device *gdma) -+{ -+ u32 val = 0; -+ -+ dev_dbg(gdma->dev, "gdma irq enable\n"); -+ val = phytium_gdma_read(gdma, DMA_INTR_CTL); -+ val |= DMA_INT_EN; -+ phytium_gdma_write(gdma, DMA_INTR_CTL, val); -+} -+ -+static void __maybe_unused -+phytium_gdma_read_mode_set(struct phytium_gdma_device *gdma, -+ enum arbitration_mode mode) -+{ -+ u32 val = phytium_gdma_read(gdma, DMA_CTL); -+ -+ switch (mode) { -+ case POLLING_MODE: -+ dev_dbg(gdma->dev, "set read polling mode\n"); -+ val &= ~BIT(5); -+ break; -+ case QOS_MODE: -+ dev_dbg(gdma->dev, "set read qos mode\n"); -+ val |= BIT(5); -+ break; -+ } -+ phytium_gdma_write(gdma, DMA_CTL, val); -+} -+ -+static void phytium_gdma_write_mode_set(struct phytium_gdma_device *gdma, -+ enum arbitration_mode mode) -+{ -+ u32 val = phytium_gdma_read(gdma, DMA_CTL); -+ -+ switch (mode) { -+ case POLLING_MODE: -+ dev_dbg(gdma->dev, "set write polling mode\n"); -+ val &= ~BIT(4); -+ break; -+ case QOS_MODE: -+ dev_dbg(gdma->dev, "set write qos mode\n"); -+ val |= BIT(4); -+ break; -+ } -+ phytium_gdma_write(gdma, DMA_CTL, val); -+} -+ -+static void __maybe_unused -+phytium_gdma_outstanding_set(struct phytium_gdma_device *gdma, u32 outstanding) -+{ -+ u32 val = 0; -+ -+ dev_dbg(gdma->dev, "set dma outstanding %d\n", outstanding); -+ -+ val = phytium_gdma_read(gdma, DMA_CTL); -+ val &= ~DMA_OUTSTANDING_MASK; -+ val |= ((outstanding - 1) << 8); -+ phytium_gdma_write(gdma, DMA_CTL, val); -+} -+ -+static void __maybe_unused -+phytium_gdma_read_qos_set(struct phytium_gdma_device *gdma, u32 qos) -+{ -+ u32 val = 0; -+ -+ dev_dbg(gdma->dev, "set read qos %d", qos); -+ val = phytium_gdma_read(gdma, DMA_QOS_CFG); -+ val &= ~DMA_READ_QOS_MASK; -+ val |= (qos << 4); -+ phytium_gdma_write(gdma, DMA_QOS_CFG, val); -+} -+ -+static void __maybe_unused -+phytium_gdma_write_qos_set(struct phytium_gdma_device *gdma, u32 qos) -+{ -+ u32 val = phytium_gdma_read(gdma, DMA_QOS_CFG); -+ -+ dev_dbg(gdma->dev, "set read qos %d", qos); -+ val &= ~DMA_WRITE_QOS_MASK; -+ val |= qos; -+ phytium_gdma_write(gdma, DMA_QOS_CFG, val); -+} -+ -+static void phytium_chan_irq_enable(struct phytium_gdma_chan *chan, u32 mask) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d irq enable\n", chan->id); -+ val = phytium_gdma_read(chan_to_gdma(chan), DMA_INTR_CTL); -+ val |= DMA_INT_CHAL_EN(chan->id); -+ phytium_gdma_write(chan_to_gdma(chan), DMA_INTR_CTL, val); -+ phytium_chan_write(chan, DMA_CX_INTR_CTL, mask); -+} -+ -+static void phytium_chan_irq_disable(struct phytium_gdma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d irq disable\n", chan->id); -+ val = phytium_gdma_read(chan_to_gdma(chan), DMA_INTR_CTL); -+ val &= ~DMA_INT_CHAL_EN(chan->id); -+ phytium_gdma_write(chan_to_gdma(chan), DMA_INTR_CTL, val); -+} -+ -+static void phytium_chan_irq_clear(struct phytium_gdma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d irq clear\n", chan->id); -+ -+ val = phytium_chan_read(chan, DMA_CX_STATE); -+ phytium_chan_write(chan, DMA_CX_STATE, val); -+} -+ -+static void phytium_chan_disable(struct phytium_gdma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d disable\n", chan->id); -+ -+ /* disable channel */ -+ val = phytium_chan_read(chan, DMA_CX_CTRL); -+ val &= ~DMA_CHAL_EN; -+ phytium_chan_write(chan, DMA_CX_CTRL, val); -+} -+ -+static void phytium_chan_enable(struct phytium_gdma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d enable\n", chan->id); -+ -+ /* enable channel */ -+ val = phytium_chan_read(chan, DMA_CX_CTRL); -+ val |= DMA_CHAL_EN; -+ phytium_chan_write(chan, DMA_CX_CTRL, val); -+} -+ -+static void phytium_chan_clk_enable(struct phytium_gdma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d clk enable\n", chan->id); -+ -+ /* enable channel clock */ -+ val = phytium_gdma_read(chan_to_gdma(chan), DMA_LP_CTL); -+ val &= ~DMA_CX_CLK_EN(chan->id); -+ phytium_gdma_write(chan_to_gdma(chan), DMA_LP_CTL, val); -+} -+ -+static void phytium_chan_clk_disable(struct phytium_gdma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d clk disable\n", chan->id); -+ -+ /* disable channel clock */ -+ val = phytium_gdma_read(chan_to_gdma(chan), DMA_LP_CTL); -+ val |= DMA_CX_CLK_EN(chan->id); -+ phytium_gdma_write(chan_to_gdma(chan), DMA_LP_CTL, val); -+} -+ -+static void phytium_chan_reset(struct phytium_gdma_chan *chan) -+{ -+ u32 val = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d reset\n", chan->id); -+ val = phytium_chan_read(chan, DMA_CX_CTRL); -+ val |= DMA_CHAL_SRST; -+ phytium_chan_write(chan, DMA_CX_CTRL, val); -+ -+ udelay(10); -+ val = phytium_chan_read(chan, DMA_CX_CTRL); -+ val &= ~DMA_CHAL_SRST; -+ phytium_chan_write(chan, DMA_CX_CTRL, val); -+} -+ -+static void phytium_chan_set_bdl_mode(struct phytium_gdma_chan *chan, bool bdl) -+{ -+ u32 val = 0; -+ -+ val = phytium_chan_read(chan, DMA_CX_MODE); -+ if (bdl) { -+ dev_dbg(chan_to_dev(chan), "channel %d set bdl mode\n", -+ chan->id); -+ val |= DMA_CHAN_BDL_MODE; -+ } else { -+ dev_dbg(chan_to_dev(chan), "channel %d set direct mode\n", -+ chan->id); -+ val &= ~DMA_CHAN_BDL_MODE; -+ } -+ phytium_chan_write(chan, DMA_CX_MODE, val); -+} -+ -+static u32 __maybe_unused -+phytium_chan_get_bdl_num(struct phytium_gdma_chan *chan) -+{ -+ u32 val = phytium_chan_read(chan, DMA_CX_LVI) + 1; -+ -+ return val; -+} -+ -+static u32 phytium_gdma_set_xfer_ctrl(u32 burst_width, u32 burst_length, -+ enum burst_type burst_type) -+{ -+ u32 xfer_ctrl = 0; -+ -+ xfer_ctrl = burst_type; -+ xfer_ctrl |= (ffs(burst_width) - 1) << 4; -+ xfer_ctrl |= (burst_length - 1) << 8; -+ -+ return xfer_ctrl; -+} -+ -+static void phytium_chan_set_xfer_cfg(struct phytium_gdma_chan *chan, -+ u32 burst_width, u32 burst_length, -+ enum burst_type type) -+{ -+ u32 xfer_ctl = phytium_gdma_set_xfer_ctrl(burst_width, burst_length, -+ type); -+ u32 val = xfer_ctl << 16 | xfer_ctl; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d set xfer cfg 0x%08x", -+ chan->id, val); -+ phytium_chan_write(chan, DMA_CX_XFER_CFG, val); -+} -+ -+static void phytium_gdma_vdesc_free(struct virt_dma_desc *vd) -+{ -+ struct phytium_gdma_desc *desc = to_gdma_desc(vd); -+ int i = 0; -+ -+ if (desc->bdl_mode) { -+ for (i = 0; i < desc->bdl_size; i++) -+ dma_pool_free(desc->chan->dma_pool, -+ desc->bdl_list[i].bdl, desc->bdl_list[0].paddr); -+ } -+ kfree(desc); -+} -+ -+static void phytium_chan_start_desc(struct phytium_gdma_chan *chan) -+{ -+ struct virt_dma_desc *vd = vchan_next_desc(&chan->vchan); -+ struct phytium_gdma_desc *desc = NULL; -+ -+ if (!vd) { -+ chan->desc = NULL; -+ return; -+ } -+ -+ list_del(&vd->node); -+ desc = to_gdma_desc(vd); -+ chan->desc = desc; -+ -+ phytium_chan_clk_enable(chan); -+ -+ if (desc->bdl_mode) { -+ phytium_chan_set_bdl_mode(chan, true); -+ phytium_chan_write(chan, DMA_CX_UPSADDR, -+ upper_32_bits(desc->bdl_list[0].paddr)); -+ phytium_chan_write(chan, DMA_CX_LWSADDR, -+ lower_32_bits(desc->bdl_list[0].paddr)); -+ phytium_chan_write(chan, DMA_CX_UPDADDR, 0); -+ phytium_chan_write(chan, DMA_CX_LWDADDR, 0); -+ phytium_chan_write(chan, DMA_CX_TS, 0); -+ phytium_chan_write(chan, DMA_CX_LVI, desc->bdl_size - 1); -+ } else { -+ phytium_chan_set_bdl_mode(chan, false); -+ phytium_chan_set_xfer_cfg(chan, desc->burst_width, -+ desc->burst_length, BURST_INCR); -+ phytium_chan_write(chan, DMA_CX_UPSADDR, -+ upper_32_bits(desc->src)); -+ phytium_chan_write(chan, DMA_CX_LWSADDR, -+ lower_32_bits(desc->src)); -+ phytium_chan_write(chan, DMA_CX_UPDADDR, -+ upper_32_bits(desc->dst)); -+ phytium_chan_write(chan, DMA_CX_LWDADDR, -+ lower_32_bits(desc->dst)); -+ phytium_chan_write(chan, DMA_CX_TS, desc->len); -+ } -+ -+ phytium_gdma_outstanding_set(chan_to_gdma(chan), desc->outstanding); -+ phytium_gdma_write_mode_set(chan_to_gdma(chan), POLLING_MODE); -+ phytium_chan_irq_enable(chan, GDMA_CX_INT_CTRL_TRANS_END_ENABLE); -+ phytium_gdma_dump_reg(chan); -+ phytium_chan_enable(chan); -+} -+ -+static void phytium_gdma_hw_init(struct phytium_gdma_device *gdma) -+{ -+ u32 i = 0; -+ -+ phytium_gdma_disable(gdma); -+ phytium_gdma_reset(gdma); -+ phytium_gdma_irq_enable(gdma); -+ phytium_gdma_enable(gdma); -+ -+ for (i = 0; i < gdma->dma_channels; i++) { -+ phytium_chan_irq_disable(&gdma->chan[i]); -+ phytium_chan_disable(&gdma->chan[i]); -+ phytium_chan_clk_disable(&gdma->chan[i]); -+ } -+} -+ -+static int phytium_gdma_terminate_all(struct dma_chan *chan) -+{ -+ struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); -+ unsigned long flags = 0; -+ u32 val = 0; -+ int ret = 0; -+ LIST_HEAD(head); -+ -+ spin_lock_irqsave(&gdma_chan->vchan.lock, flags); -+ -+ if (gdma_chan->desc) { -+ vchan_terminate_vdesc(&gdma_chan->desc->vdesc); -+ gdma_chan->desc = NULL; -+ phytium_chan_disable(gdma_chan); -+ ret = readl_poll_timeout(gdma_chan->base + DMA_CX_STATE, val, -+ ~(val & BIT(4)), 10, 10000); -+ if (ret) -+ dev_err(chan_to_dev(gdma_chan), -+ "failed to complete writes\n"); -+ phytium_chan_reset(gdma_chan); -+ } -+ -+ vchan_get_all_descriptors(&gdma_chan->vchan, &head); -+ spin_unlock_irqrestore(&gdma_chan->vchan.lock, flags); -+ vchan_dma_desc_free_list(&gdma_chan->vchan, &head); -+ -+ return 0; -+} -+ -+static int phytium_gdma_alloc_chan_resources(struct dma_chan *chan) -+{ -+ struct phytium_gdma_device *gdma = to_gdma_device(chan); -+ struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); -+ struct device *dev = chan_to_dev(gdma_chan); -+ -+ /* prepare channel */ -+ phytium_chan_disable(gdma_chan); -+ phytium_chan_reset(gdma_chan); -+ phytium_chan_irq_clear(gdma_chan); -+ -+ /* alloc dma memory */ -+ gdma_chan->dma_pool = dma_pool_create(dev_name(dev), dev, -+ sizeof(struct phytium_gdma_bdl), -+ 128, 0); -+ if (!gdma_chan->dma_pool) { -+ dev_err(chan_to_dev(gdma_chan), -+ "unable to allocate descriptor pool\n"); -+ return -ENOMEM; -+ } -+ -+ dev_info(gdma->dev, "alloc channel %d\n", gdma_chan->id); -+ -+ return 0; -+} -+ -+static void phytium_gdma_free_chan_resources(struct dma_chan *chan) -+{ -+ struct phytium_gdma_device *gdma = to_gdma_device(chan); -+ struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); -+ -+ phytium_chan_disable(gdma_chan); -+ phytium_chan_irq_disable(gdma_chan); -+ -+ vchan_free_chan_resources(&gdma_chan->vchan); -+ dma_pool_destroy(gdma_chan->dma_pool); -+ -+ dev_dbg(gdma->dev, "free channel %d\n", gdma_chan->id); -+} -+ -+static int phytium_gdma_slave_config(struct dma_chan *chan, -+ struct dma_slave_config *config) -+{ -+ struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); -+ -+ gdma_chan->dma_config = *config; -+ -+ return 0; -+} -+ -+ -+static enum dma_status phytium_gdma_tx_status(struct dma_chan *chan, -+ dma_cookie_t cookie, struct dma_tx_state *txstate) -+{ -+ enum dma_status ret; -+ -+ ret = dma_cookie_status(chan, cookie, txstate); -+ -+ return ret; -+} -+ -+static int phytium_gdma_calcu_burst_width(dma_addr_t src, dma_addr_t dst, -+ u32 len) -+{ -+ enum dma_slave_buswidth max_width = DMA_SLAVE_BUSWIDTH_16_BYTES; -+ -+ for (max_width = DMA_SLAVE_BUSWIDTH_16_BYTES; -+ max_width > DMA_SLAVE_BUSWIDTH_1_BYTE; -+ max_width >>= 1) { -+ if ((((len | src | dst) & (max_width - 1)) == 0) && -+ len > max_width) -+ break; -+ } -+ -+ return max_width; -+} -+ -+static int phytium_gdma_xfer_bdl_mode(struct phytium_gdma_desc *desc, -+ dma_addr_t dst, dma_addr_t src) -+{ -+ struct phytium_gdma_chan *chan = desc->chan; -+ struct phytium_gdma_bdl_entry *bdl_entry = NULL; -+ struct phytium_gdma_bdl *bdl = NULL; -+ int i = 0; -+ int ret = 0; -+ u32 burst_width = 0; -+ u32 burst_length = 0; -+ size_t buf_len = desc->len; -+ -+ for (i = 0; i < desc->bdl_size; i++) { -+ bdl_entry = &desc->bdl_list[i]; -+ bdl_entry->bdl = dma_pool_alloc(chan->dma_pool, GFP_KERNEL, -+ &bdl_entry->paddr); -+ -+ if (!bdl_entry->bdl) { -+ ret = -ENOMEM; -+ goto error_bdl; -+ } -+ -+ /* set bdl info */ -+ bdl = bdl_entry->bdl; -+ bdl->src_addr_l = lower_32_bits(src); -+ bdl->src_addr_h = upper_32_bits(src); -+ bdl->dst_addr_l = lower_32_bits(dst); -+ bdl->dst_addr_h = upper_32_bits(dst); -+ bdl->length = min_t(u32, buf_len, GDMA_MAX_LEN); -+ buf_len -= bdl->length; -+ src += bdl->length; -+ dst += bdl->length; -+ desc->len = bdl->length; -+ -+ /* calculate burst width and burst length */ -+ burst_width = phytium_gdma_calcu_burst_width(src, dst, -+ bdl->length); -+ burst_length = min_t(u32, GDMA_MAX_BURST_LENGTH, -+ bdl->length / burst_width); -+ bdl->src_xfer_cfg = phytium_gdma_set_xfer_ctrl(burst_width, -+ burst_length, BURST_INCR); -+ -+ bdl->dst_xfer_cfg = bdl->src_xfer_cfg; -+ -+ /* not trigger interrupt after bdl transferred */ -+ bdl->intr_ctl = 0; -+ -+ dev_dbg(chan_to_dev(chan), -+ "channel %d: bdl_mode, frame %d, len %d, burst_width %d, burst_length %d, xfer_cfg 0x%08x, outstanding: %d\n", -+ chan->id, i, bdl->length, burst_width, burst_length, -+ bdl->src_xfer_cfg, desc->outstanding); -+ } -+ -+error_bdl: -+ return ret; -+} -+ -+static struct dma_async_tx_descriptor *phytium_gdma_prep_dma_memcpy( -+ struct dma_chan *chan, dma_addr_t dst, dma_addr_t src, -+ size_t len, unsigned long flags) -+{ -+ struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); -+ struct phytium_gdma_desc *desc = NULL; -+ struct dma_async_tx_descriptor *tx_desc = NULL; -+ u32 frames = 0; -+ u32 max_outstanding = 0; -+ int ret = 0; -+ -+ if (!src || !dst || !len) -+ return NULL; -+ -+ frames = DIV_ROUND_UP(len, GDMA_MAX_LEN); -+ -+ desc = kzalloc(struct_size(desc, bdl_list, frames), GFP_KERNEL); -+ if (IS_ERR_OR_NULL(desc)) -+ return NULL; -+ -+ dev_dbg(chan_to_dev(gdma_chan), -+ "memcpy: src %lld, dst %lld, len %ld, frames %d\n", -+ src, dst, len, frames); -+ -+ desc->len = len; -+ desc->chan = gdma_chan; -+ max_outstanding = chan_to_gdma(gdma_chan)->max_outstanding; -+ -+ if (frames > 1) { -+ /* bdl xfer */ -+ desc->bdl_mode = true; -+ desc->bdl_size = frames; -+ desc->outstanding = min_t(u32, max_outstanding, -+ len / GDMA_MAX_BURST_SIZE / GDMA_MAX_BURST_LENGTH); -+ ret = phytium_gdma_xfer_bdl_mode(desc, dst, src); -+ } else { -+ /* direct xfer */ -+ desc->bdl_mode = false; -+ desc->burst_width = phytium_gdma_calcu_burst_width(src, dst, -+ len); -+ desc->burst_length = min_t(u32, GDMA_MAX_BURST_LENGTH, -+ len / desc->burst_width); -+ desc->src = src; -+ desc->dst = dst; -+ desc->outstanding = min_t(u32, max_outstanding, -+ len / desc->burst_length / desc->burst_width); -+ dev_dbg(chan_to_dev(gdma_chan), "channel %d: direct mode, len %ld, burst_width %d, burst_length %d, outstanding %d\n", -+ gdma_chan->id, desc->len, desc->burst_width, -+ desc->burst_length, desc->outstanding); -+ } -+ -+ if (!ret) -+ tx_desc = vchan_tx_prep(&gdma_chan->vchan, &desc->vdesc, flags); -+ -+ return tx_desc; -+} -+ -+static void phytium_gdma_issue_pending(struct dma_chan *chan) -+{ -+ struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); -+ unsigned long flags = 0; -+ -+ spin_lock_irqsave(&gdma_chan->vchan.lock, flags); -+ if (vchan_issue_pending(&gdma_chan->vchan) && !gdma_chan->desc) -+ phytium_chan_start_desc(gdma_chan); -+ -+ spin_unlock_irqrestore(&gdma_chan->vchan.lock, flags); -+} -+ -+static void phytium_chan_irq_handler(struct phytium_gdma_chan *chan) -+{ -+ struct phytium_gdma_desc *desc = NULL; -+ unsigned long flags = 0; -+ u32 state = 0; -+ int ret = 0; -+ -+ dev_dbg(chan_to_dev(chan), "channel %d int state %08x", chan->id, -+ chan->state); -+ -+ /* transfer busy */ -+ if (chan->state & GDMA_CX_INT_STATE_BUSY) { -+ dev_info(chan_to_dev(chan), "gdma channel %d busy\n", chan->id); -+ ret = readl_poll_timeout_atomic(chan->base + DMA_CX_STATE, state, -+ state & GDMA_CX_INT_STATE_TRANS_END, -+ 10, 2000); -+ if (ret) { -+ dev_err(chan_to_dev(chan), -+ "gdma channel %d xfer timeout\n", chan->id); -+ } -+ } -+ -+ /* transfer complete */ -+ if (chan->state & GDMA_CX_INT_STATE_TRANS_END) { -+ dev_dbg(chan_to_dev(chan), "channel %d xfer complete\n", chan->id); -+ desc = chan->desc; -+ spin_lock_irqsave(&chan->vchan.lock, flags); -+ vchan_cookie_complete(&desc->vdesc); -+ phytium_chan_start_desc(chan); -+ spin_unlock_irqrestore(&chan->vchan.lock, flags); -+ } -+ -+ /* fifo fulll */ -+ if (chan->state & GDMA_CX_INT_STATE_FIFO_FULL) { -+ dev_err(chan_to_dev(chan), -+ "gdma channel %d fifo full\n", chan->id); -+ } -+} -+ -+static irqreturn_t phytium_dma_interrupt(int irq, void *dev_id) -+{ -+ struct phytium_gdma_device *gdma = dev_id; -+ struct phytium_gdma_chan *gdma_chan = NULL; -+ u32 state = 0; -+ int i = 0; -+ -+ state = phytium_gdma_read(gdma, DMA_STATE); -+ dev_dbg(gdma->dev, "gdma interrupt, state %04x", state); -+ -+ for (i = 0; i < gdma->dma_channels; i++) { -+ if (state & DMA_CX_INTR_STATE(i)) { -+ gdma_chan = &gdma->chan[i]; -+ gdma_chan->state = phytium_chan_read(gdma_chan, -+ DMA_CX_STATE); -+ phytium_chan_irq_clear(gdma_chan); -+ -+ if (gdma->chan[i].desc) { -+ phytium_chan_irq_handler(gdma_chan); -+ phytium_chan_disable(gdma_chan); -+ phytium_chan_clk_disable(gdma_chan); -+ } -+ } -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static struct dma_chan *phytium_gdma_of_xlate(struct of_phandle_args *dma_spec, -+ struct of_dma *ofdma) -+{ -+ struct phytium_gdma_device *gdma = ofdma->of_dma_data; -+ struct device *dev = gdma->dev; -+ struct phytium_gdma_chan *chan = NULL; -+ struct dma_chan *c = NULL; -+ u32 channel_id = 0; -+ -+ channel_id = dma_spec->args[0]; -+ -+ if (channel_id > gdma->dma_channels) { -+ dev_err(dev, "bad channel %d\n", channel_id); -+ return NULL; -+ } -+ -+ chan = &gdma->chan[channel_id]; -+ c = dma_get_slave_channel(&chan->vchan.chan); -+ if (!c) { -+ dev_err(dev, "no more channels available\n"); -+ return NULL; -+ } -+ -+ return c; -+} -+ -+static int phytium_gdma_probe(struct platform_device *pdev) -+{ -+ struct phytium_gdma_device *gdma; -+ struct dma_device *dma_dev; -+ struct resource *mem; -+ u32 i = 0; -+ u32 nr_channels = 0; -+ u32 max_outstanding = 0; -+ int irq_count = 0; -+ int irq = 0; -+ int ret = 0; -+ -+ if (!pdev->dev.dma_mask) -+ pdev->dev.dma_mask = &pdev->dev.coherent_dma_mask; -+ -+ ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64)); -+ if (ret) { -+ dev_err(&pdev->dev, "Unable to set DMA mask\n"); -+ goto out; -+ } -+ -+ gdma = devm_kzalloc(&pdev->dev, sizeof(*gdma), GFP_KERNEL); -+ if (!gdma) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ dma_dev = &gdma->dma_dev; -+ gdma->dev = &pdev->dev; -+ -+ mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ gdma->base = devm_ioremap_resource(&pdev->dev, mem); -+ if (IS_ERR(gdma->base)) { -+ dev_err(&pdev->dev, "no resource address"); -+ ret = PTR_ERR(gdma->base); -+ goto out; -+ } -+ -+ ret = of_property_read_u32(pdev->dev.of_node, "dma-channels", -+ &nr_channels); -+ if (ret < 0) { -+ dev_err(&pdev->dev, -+ "can't get the number of dma channels: %d\n", ret); -+ goto out; -+ } -+ gdma->dma_channels = nr_channels; -+ -+ ret = of_property_read_u32(pdev->dev.of_node, "max-outstanding", -+ &max_outstanding); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "can't get max outstanding %d\n", ret); -+ goto out; -+ } -+ gdma->max_outstanding = max_outstanding; -+ -+ irq_count = platform_irq_count(pdev); -+ if (irq_count <= 0) { -+ dev_err(&pdev->dev, "no irq found\n"); -+ ret = -EINVAL; -+ goto out; -+ } -+ for (i = 0; i < irq_count; i++) { -+ irq = platform_get_irq(pdev, i); -+ if (irq < 0) { -+ dev_err(&pdev->dev, "can't get irq %d\n", i); -+ continue; -+ } -+ ret = devm_request_irq(&pdev->dev, irq, -+ phytium_dma_interrupt, IRQF_SHARED, -+ dev_name(&pdev->dev), gdma); -+ if (ret) { -+ dev_err(&pdev->dev, "could not to request irq %d", irq); -+ goto out; -+ } -+ } -+ -+ /* Set capabilities */ -+ dma_cap_set(DMA_MEMCPY, gdma->dma_dev.cap_mask); -+ -+ /* DMA capabilities */ -+ dma_dev->dev = gdma->dev; -+ dma_dev->chancnt = gdma->dma_channels; -+ dma_dev->max_burst = 8; -+ dma_dev->src_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_1_BYTE) | -+ BIT(DMA_SLAVE_BUSWIDTH_2_BYTES) | -+ BIT(DMA_SLAVE_BUSWIDTH_4_BYTES) | -+ BIT(DMA_SLAVE_BUSWIDTH_8_BYTES) | -+ BIT(DMA_SLAVE_BUSWIDTH_16_BYTES); -+ dma_dev->dst_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_1_BYTE) | -+ BIT(DMA_SLAVE_BUSWIDTH_2_BYTES) | -+ BIT(DMA_SLAVE_BUSWIDTH_4_BYTES) | -+ BIT(DMA_SLAVE_BUSWIDTH_8_BYTES) | -+ BIT(DMA_SLAVE_BUSWIDTH_16_BYTES); -+ dma_dev->directions = BIT(DMA_MEM_TO_MEM); -+ dma_dev->residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; -+ -+ /* function callback */ -+ dma_dev->device_alloc_chan_resources = -+ phytium_gdma_alloc_chan_resources; -+ dma_dev->device_free_chan_resources = phytium_gdma_free_chan_resources; -+ dma_dev->device_tx_status = phytium_gdma_tx_status; -+ dma_dev->device_config = phytium_gdma_slave_config; -+ dma_dev->device_prep_dma_memcpy = phytium_gdma_prep_dma_memcpy; -+ dma_dev->device_issue_pending = phytium_gdma_issue_pending; -+ dma_dev->device_terminate_all = phytium_gdma_terminate_all; -+ -+ /* init dma channels */ -+ INIT_LIST_HEAD(&dma_dev->channels); -+ gdma->chan = devm_kcalloc(gdma->dev, gdma->dma_channels, -+ sizeof(*gdma->chan), GFP_KERNEL); -+ if (!gdma->chan) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ for (i = 0; i < gdma->dma_channels; i++) { -+ gdma->chan[i].id = i; -+ gdma->chan[i].base = gdma->base + DMA_REG_OFFSET + -+ i * CHAN_REG_OFFSET; -+ gdma->chan[i].vchan.desc_free = phytium_gdma_vdesc_free; -+ gdma->chan[i].desc = NULL; -+ vchan_init(&gdma->chan[i].vchan, dma_dev); -+ } -+ -+ phytium_gdma_hw_init(gdma); -+ -+ ret = dma_async_device_register(dma_dev); -+ if (ret) -+ goto out; -+ -+ ret = of_dma_controller_register(pdev->dev.of_node, -+ phytium_gdma_of_xlate, gdma); -+ if (ret < 0) { -+ dev_err(&pdev->dev, -+ "phytium gdma of register failed %d\n", ret); -+ goto err_unregister; -+ } -+ -+ platform_set_drvdata(pdev, gdma); -+ dev_info(gdma->dev, "phytium GDMA Controller registered\n"); -+ -+ return 0; -+ -+err_unregister: -+ dma_async_device_unregister(dma_dev); -+ -+out: -+ return ret; -+} -+ -+static void phytium_gdma_chan_remove(struct phytium_gdma_chan *chan) -+{ -+ phytium_chan_irq_disable(chan); -+ phytium_chan_disable(chan); -+ -+ tasklet_kill(&chan->vchan.task); -+ list_del(&chan->vchan.chan.device_node); -+} -+ -+static int phytium_gdma_remove(struct platform_device *pdev) -+{ -+ struct phytium_gdma_device *gdma = platform_get_drvdata(pdev); -+ struct phytium_gdma_chan *chan = NULL; -+ int i = 0; -+ -+ of_dma_controller_free(pdev->dev.of_node); -+ dma_async_device_unregister(&gdma->dma_dev); -+ -+ for (i = 0; i < gdma->dma_channels; i++) { -+ chan = &gdma->chan[i]; -+ phytium_gdma_chan_remove(chan); -+ } -+ -+ phytium_gdma_irq_disable(gdma); -+ phytium_gdma_disable(gdma); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_gdma_suspend(struct device *dev) -+{ -+ struct phytium_gdma_device *gdma = dev_get_drvdata(dev); -+ -+ phytium_gdma_irq_disable(gdma); -+ phytium_gdma_disable(gdma); -+ -+ return 0; -+} -+ -+static int phytium_gdma_resume(struct device *dev) -+{ -+ struct phytium_gdma_device *gdma = dev_get_drvdata(dev); -+ int ret = 0; -+ -+ phytium_gdma_hw_init(gdma); -+ -+ return ret; -+} -+#endif -+ -+static const struct dev_pm_ops phytium_gdma_pm_ops = { -+ SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_gdma_suspend, -+ phytium_gdma_resume) -+}; -+ -+static const struct of_device_id phytium_dma_of_id_table[] = { -+ { .compatible = "phytium,gdma" }, -+ {} -+}; -+MODULE_DEVICE_TABLE(of, phytium_dma_of_id_table); -+ -+static struct platform_driver phytium_gdma_driver = { -+ .probe = phytium_gdma_probe, -+ .remove = phytium_gdma_remove, -+ .driver = { -+ .name = "phytium-gdma", -+ .of_match_table = of_match_ptr(phytium_dma_of_id_table), -+ .pm = &phytium_gdma_pm_ops, -+ }, -+}; -+ -+static __init int phytium_gdma_init(void) -+{ -+ return platform_driver_register(&phytium_gdma_driver); -+} -+ -+static __exit void phytium_gdma_exit(void) -+{ -+ return platform_driver_unregister(&phytium_gdma_driver); -+} -+ -+subsys_initcall(phytium_gdma_init); -+module_exit(phytium_gdma_exit); -+ -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium gdma Controller platform driver"); -+MODULE_AUTHOR("HuangJie "); -+MODULE_VERSION(PHYTIUM_GDMA_DRIVER_VERSION); -diff --git a/drivers/dma/phytium/phytium-gdmac.h b/drivers/dma/phytium/phytium-gdmac.h -new file mode 100644 -index 000000000..ae880f853 ---- /dev/null -+++ b/drivers/dma/phytium/phytium-gdmac.h -@@ -0,0 +1,202 @@ -+/* SPDX-License-Identifier: GPL-2.0-only */ -+/* -+ * Phytium Device GDMA Controller driver. -+ * -+ * Copyright (c) 2023-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _PHYTIUM_GDMAC_H -+#define _PHYTIUM_GDMAC_H -+ -+#include -+#include -+#include -+#include -+#include -+#include "../virt-dma.h" -+ -+ -+#define GDMA_MAX_LEN SZ_1G -+#define GDMA_MAX_BURST_LENGTH 8 -+#define GDMA_MAX_BURST_SIZE 16 -+ -+/* GDMA register address offset */ -+#define DMA_REG_OFFSET 0x20 -+#define CHAN_REG_OFFSET 0x60 -+ -+#define DMA_CTL 0x00 -+#define DMA_STATE 0x04 -+#define DMA_INTR_CTL 0x08 -+#define DMA_LP_CTL 0x0C -+#define DMA_QOS_CFG 0x10 -+ -+#define DMA_CX_CTRL 0x00 -+#define DMA_CX_MODE 0x04 -+#define DMA_CX_INTR_CTL 0x08 -+#define DMA_CX_STATE 0x0C -+#define DMA_CX_LVI 0x10 -+#define DMA_CX_TS 0x14 -+#define DMA_CX_UPSADDR 0x18 -+#define DMA_CX_LWSADDR 0x1C -+#define DMA_CX_UPDADDR 0x20 -+#define DMA_CX_LWDADDR 0x24 -+#define DMA_CX_XFER_CFG 0x28 -+#define DMA_CX_LCP 0x2C -+#define DMA_CX_SECCTL 0x30 -+#define DMA_CX_SEC_ATST 0x34 -+#define DMA_CX_NSID_STRMID 0x38 -+#define DMA_CX_AW_CFG 0x3C -+#define DMA_CX_AR_CFG 0x40 -+#define DMA_CX_SECRSP 0x44 -+ -+/* DMA_CTL register */ -+#define DMA_CTL_EN BIT(0) -+#define DMA_CTL_SRST BIT(1) -+ -+#define DMA_OUTSTANDING_MASK GENMASK(11, 8) -+#define DMA_WRITE_QOS_MASK GENMASK(3, 0) -+#define DMA_READ_QOS_MASK GENMASK(7, 4) -+ -+/* DMA_STATE register */ -+#define DMA_CX_INTR_STATE(id) BIT(id) -+ -+/* DMA_INTR_CTL register */ -+#define DMA_INT_EN BIT(31) -+#define DMA_INT_CHAL_EN(id) BIT(id) -+ -+/* DMA_LP_CTL register */ -+#define DMA_CX_CLK_EN(id) BIT(id) -+ -+/* DMA_CX_MODE register */ -+#define DMA_CHAN_BDL_MODE BIT(0) -+ -+/* DMA_CX_CTRL register */ -+#define DMA_CHAL_EN BIT(0) -+#define DMA_CHAL_SRST BIT(4) -+ -+/* DMA_CX_INTR_CTL register, channel interrupt control bits */ -+#define GDMA_CX_INT_CTRL_TRANS_END_ENABLE BIT(3) -+#define GDMA_CX_INT_CTRL_BDL_END_ENABLE BIT(2) -+#define GDMA_CX_INT_CTRL_FIFO_FULL_ENABLE BIT(1) -+#define GDMA_CX_INT_CTRL_FIFO_EMPTY_ENABLE BIT(0) -+ -+ -+/* DMA_CX_STATE register, channel interrupt states */ -+#define GDMA_CX_INT_STATE_BUSY BIT(4) -+#define GDMA_CX_INT_STATE_TRANS_END BIT(3) -+#define GDMA_CX_INT_STATE_BDL_END BIT(2) -+#define GDMA_CX_INT_STATE_FIFO_FULL BIT(1) -+#define GDMA_CX_INT_STATE_FIFO_EMPTY BIT(0) -+ -+ -+/* channel modes */ -+enum arbitration_mode { -+ POLLING_MODE, -+ QOS_MODE -+}; -+ -+/* burst type */ -+enum burst_type { -+ BURST_FIX, -+ BURST_INCR -+}; -+ -+/** -+ * @brief struct phytium_gdma_bdl - describe for bdl list -+ * @src_addr_l: low 32 bits of src addr -+ * @src_addr_h: high 32 bits of src addr -+ * @dst_addr_l: low 32 bits of dst addr -+ * @dst_addr_h: high 32 bits of dst addr -+ * @src_xfer_cfg: xfer config for read -+ * @dst_xfer_cfg: xfer config for write -+ * @length: xfer length -+ * @intr_ctl: interrupt enable control -+ */ -+struct phytium_gdma_bdl { -+ u32 src_addr_l; -+ u32 src_addr_h; -+ u32 dst_addr_l; -+ u32 dst_addr_h; -+ u32 src_xfer_cfg; -+ u32 dst_xfer_cfg; -+ u32 length; -+ u32 intr_ctl; -+}; -+ -+/** -+ * @brief struct phytium_gdma_bdl_entry - entry for bdl_list -+ * @bdl: pointer to bdl lists -+ * @paddr: the first bdl list addr -+ */ -+struct phytium_gdma_bdl_entry { -+ struct phytium_gdma_bdl *bdl; -+ dma_addr_t paddr; -+}; -+ -+/** -+ * struct phytium_gdma_desc - the struct holding info describing gdma request -+ * descriptor -+ * @chan: the channel belonging to this descriptor -+ * @vdesc: gdma request descriptor -+ * @len: total len of dma request -+ * @bdl_size: store bdl size in bdl mode -+ * @bdl_mode: the bdl xfer mode flag -+ * @burst_widht: store burst width in direct xfer mode -+ * @burst_length: store burst length in direct xfer mode -+ * @dst: store dst addr in direct xfer mode -+ * @src: store src addr in direct xfer mode -+ * @outstanding: store outstanding -+ * @bdl_list: the entry of bdl lists -+ */ -+struct phytium_gdma_desc { -+ struct phytium_gdma_chan *chan; -+ struct virt_dma_desc vdesc; -+ size_t len; -+ u32 bdl_size; -+ bool bdl_mode; -+ u32 burst_width; -+ u32 burst_length; -+ dma_addr_t dst; -+ dma_addr_t src; -+ u32 outstanding; -+ struct phytium_gdma_bdl_entry bdl_list[]; -+}; -+ -+/** -+ * struct phytium_gdma_chan - the struct holding info describing dma channel -+ * @vchan: virtual dma channel -+ * @dma_config: config parameters for dma channel -+ * @desc: the transform request descriptor -+ * @dma_pool: dma memory for bdl list -+ * @id: the id of gdma physical channel -+ * @base: the mapped register I/O of dma physical channel -+ */ -+struct phytium_gdma_chan { -+ struct virt_dma_chan vchan; -+ struct dma_slave_config dma_config; -+ struct phytium_gdma_desc *desc; -+ struct dma_pool *dma_pool; -+ -+ void __iomem *base; -+ u32 id; -+ u32 state; -+}; -+ -+/** -+ * struct phytium_gdma_device - the struct holding info describing gdma device -+ * @dma_dev: an instance for struct dma_device -+ * @base: the mapped register I/O base of this gdma -+ * @dma_channels: the number of gdma channels -+ * @max_outstanding: the max outstanding support -+ * @chan: the phyical channels of gdma -+ */ -+struct phytium_gdma_device { -+ struct dma_device dma_dev; -+ struct device *dev; -+ void __iomem *base; -+ u32 dma_channels; -+ u32 max_outstanding; -+ struct phytium_gdma_chan *chan; -+}; -+ -+#endif /* _PHYTIUM_GDMAC_H */ -diff --git a/drivers/edac/Kconfig b/drivers/edac/Kconfig -index 110e99b86..1cbc7b48a 100644 ---- a/drivers/edac/Kconfig -+++ b/drivers/edac/Kconfig -@@ -505,6 +505,13 @@ config EDAC_TI - help - Support for error detection and correction on the TI SoCs. - -+config EDAC_PHYTIUM -+ tristate "Phytium Pe220x SoC" -+ depends on (ARM64) -+ help -+ Support for error detection and correction on the -+ Phytium Pe220x family of SOCs. -+ - config EDAC_QCOM - tristate "QCOM EDAC Controller" - depends on ARCH_QCOM && QCOM_LLCC -diff --git a/drivers/edac/Makefile b/drivers/edac/Makefile -index 61945d311..f21c95254 100644 ---- a/drivers/edac/Makefile -+++ b/drivers/edac/Makefile -@@ -80,6 +80,7 @@ obj-$(CONFIG_EDAC_ARMADA_XP) += armada_xp_edac.o - obj-$(CONFIG_EDAC_SYNOPSYS) += synopsys_edac.o - obj-$(CONFIG_EDAC_XGENE) += xgene_edac.o - obj-$(CONFIG_EDAC_TI) += ti_edac.o -+obj-$(CONFIG_EDAC_PHYTIUM) += phytium_edac.o - obj-$(CONFIG_EDAC_QCOM) += qcom_edac.o - obj-$(CONFIG_EDAC_ASPEED) += aspeed_edac.o - obj-$(CONFIG_EDAC_BLUEFIELD) += bluefield_edac.o -diff --git a/drivers/edac/phytium_edac.c b/drivers/edac/phytium_edac.c -new file mode 100644 -index 000000000..af6a72981 ---- /dev/null -+++ b/drivers/edac/phytium_edac.c -@@ -0,0 +1,481 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium Pe220x EDAC (error detection and correction) -+ * -+ * Copyright (c) 2019-2023, Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "edac_module.h" -+ -+#define EDAC_MOD_STR "phytium_edac" -+ -+/* register offset */ -+#define ERR_STATUS(n) (0x10 + ((n) * 64)) -+#define ERR_CTLR(n) (0x08 + ((n) * 64)) -+#define ERR_MISC0(n) (0x20 + ((n) * 64)) -+#define ERR_INJECT 0x7C -+#define ERR_DEVID 0xFC8 -+#define ERR_GSR 0xE00 -+ -+#define CTLR_ED BIT(0) -+#define CTLR_UI BIT(2) -+#define CTLR_CFI BIT(8) -+ -+#define MISC0_CEC(x) ((u64)(x) << 32) -+ -+#define ERR_STATUS_CLEAR GENMASK(31, 0) -+ -+#define CORRECTED_ERROR 0 -+#define UNCORRECTED_ERROR 1 -+ -+#define MAX_ERR_GROUP 3 -+ -+struct phytium_edac { -+ struct device *dev; -+ void __iomem **ras_base; -+ struct dentry *dfs; -+ struct edac_device_ctl_info *edac_dev; -+}; -+ -+struct ras_error_info { -+ u32 index; -+ u32 error_type; -+ const char *error_str; -+}; -+ -+/* error severity definition */ -+enum { -+ SEV_NO = 0x0, -+ SEV_CORRECTED = 0x1, -+ SEV_RECOVERABLE = 0x2, -+ SEV_PANIC = 0x3, -+}; -+ -+/* soc error record */ -+static const struct ras_error_info pe220x_ras_soc_error[] = { -+ { 0, UNCORRECTED_ERROR, "lsd_nfc_ras_error" }, -+ { 1, UNCORRECTED_ERROR, "lsd_lpc_ras_long_wait_to" }, -+ { 2, UNCORRECTED_ERROR, "lsd_lpc_ras_short_wait_to" }, -+ { 3, UNCORRECTED_ERROR, "lsd_lpc_ras_sync_err" }, -+ { 4, UNCORRECTED_ERROR, "lsd_lbc_ras_err" }, -+ { 5, UNCORRECTED_ERROR, "usb3_err_0" }, -+ { 6, UNCORRECTED_ERROR, "usb3_err_1" }, -+ { 7, UNCORRECTED_ERROR, "gsd_gmu_mac0_asf_nonfatal_int" }, -+ { 8, UNCORRECTED_ERROR, "gsd_gmu_mac0_asf_fatal_int" }, -+ { 9, UNCORRECTED_ERROR, "gsd_gmu_mac0_asf_trans_to_err" }, -+ { 10, UNCORRECTED_ERROR, "gsd_gmu_mac0_asf_protocol_err" }, -+ { 11, UNCORRECTED_ERROR, "gsd_gmu_mac1_asf_nonfatal_int" }, -+ { 12, UNCORRECTED_ERROR, "gsd_gmu_mac1_asf_fatal_int" }, -+ { 13, UNCORRECTED_ERROR, "gsd_gmu_mac1_asf_trans_to_err" }, -+ { 14, UNCORRECTED_ERROR, "gsd_gmu_mac1_asf_protocol_err" }, -+ { 15, UNCORRECTED_ERROR, "gsd_gmu_mac2_asf_nonfatal_int" }, -+ { 16, UNCORRECTED_ERROR, "gsd_gmu_mac2_asf_fatal_int" }, -+ { 17, UNCORRECTED_ERROR, "gsd_gmu_mac2_asf_trans_to_err" }, -+ { 18, UNCORRECTED_ERROR, "gsd_gmu_mac2_asf_protocol_err" }, -+ { 19, UNCORRECTED_ERROR, "gsd_gmu_mac3_asf_nonfatal_int" }, -+ { 20, UNCORRECTED_ERROR, "gsd_gmu_mac3_asf_fatal_int" }, -+ { 21, UNCORRECTED_ERROR, "gsd_gmu_mac3_asf_trans_to_err" }, -+ { 22, UNCORRECTED_ERROR, "gsd_gmu_mac3_asf_protocol_err" }, -+ { 23, CORRECTED_ERROR, "dmu_ras_ecc_corrected_error" }, -+ { 24, UNCORRECTED_ERROR, "dmu_ras_ecc_uncorrected_error" }, -+ { 25, UNCORRECTED_ERROR, "cci_ras_nERRIRQ" }, -+ { 26, UNCORRECTED_ERROR, "smmu_tcu_ras_irpt" }, -+ { 27, UNCORRECTED_ERROR, "smmu_tbu0_ras_irpt" }, -+ { 28, UNCORRECTED_ERROR, "smmu_tbu1_ras_irpt" }, -+ { 29, UNCORRECTED_ERROR, "smmu_tbu2_ras_irpt" }, -+ { 30, UNCORRECTED_ERROR, "ocm_sram_ue" }, -+ { 31, CORRECTED_ERROR, "ocm_sram_ce" }, -+ { 32, UNCORRECTED_ERROR, "int_axim_err" }, -+ { 33, UNCORRECTED_ERROR, "int_fatal_error" }, -+ { 34, UNCORRECTED_ERROR, "nEXTERRIRQ_clust0" }, -+ { 35, UNCORRECTED_ERROR, "nINTERRIRQ_clust0" }, -+ { 36, UNCORRECTED_ERROR, "nEXTERRIRQ_clust1" }, -+ { 37, UNCORRECTED_ERROR, "nINTERRIRQ_clust1" }, -+ { 38, UNCORRECTED_ERROR, "nEXTERRIRQ_clust2" }, -+ { 39, UNCORRECTED_ERROR, "nINTERRIRQ_clust2" }, -+ { 40, UNCORRECTED_ERROR, "ams_ame0_ras_err" }, -+ { 41, UNCORRECTED_ERROR, "ams_ame1_ras_err" }, -+ { 42, UNCORRECTED_ERROR, "ams_amer_ras_err" }, -+ { 43, UNCORRECTED_ERROR, "ras_err_ame1" }, -+}; -+ -+/* pcie controller error record */ -+static const struct ras_error_info pe220x_ras_peu_psu_error[] = { -+ { 0, CORRECTED_ERROR, "pio_rd_addr_error" }, -+ { 1, UNCORRECTED_ERROR, "pio_wr_addr_error" }, -+ { 2, CORRECTED_ERROR, "pio_rd_timeout" }, -+ { 3, CORRECTED_ERROR, "pio_wr_timeout" }, -+ { 4, CORRECTED_ERROR, "axi_b_rsp_error" }, -+ { 5, CORRECTED_ERROR, "axi_r_rsp_error" }, -+}; -+ -+static const struct ras_error_info pe220x_ras_peu_error[] = { -+ { 0, CORRECTED_ERROR, "pio_rd_addr_error" }, -+ { 1, UNCORRECTED_ERROR, "pio_wr_addr_error" }, -+ { 2, CORRECTED_ERROR, "pio_rd_timeout" }, -+ { 3, CORRECTED_ERROR, "pio_wr_timeout" }, -+ { 4, CORRECTED_ERROR, "axi_b_rsp_error" }, -+ { 5, CORRECTED_ERROR, "axi_r_rsp_error" }, -+}; -+ -+static const struct ras_error_info *pe220x_ras_error[] = { -+ pe220x_ras_soc_error, pe220x_ras_peu_psu_error, pe220x_ras_peu_error -+}; -+ -+static inline unsigned int get_error_num(const struct phytium_edac *edac, -+ int err_group) -+{ -+ unsigned int error_num = 0; -+ -+ error_num = readl(edac->ras_base[err_group] + ERR_DEVID); -+ -+ return error_num; -+} -+ -+static inline void phytium_ras_setup(const struct phytium_edac *edac) -+{ -+ u64 val = 0; -+ unsigned int i = 0; -+ /* -+ * enable error report and generate interrupt for corrected error event -+ * first error record owned by node present the node configuration -+ */ -+ for (i = 0; i < MAX_ERR_GROUP; i++) { -+ val = readq(edac->ras_base[i] + ERR_CTLR(0)); -+ val |= CTLR_ED | CTLR_UI | CTLR_CFI; -+ writeq(val, edac->ras_base[i] + ERR_CTLR(0)); -+ } -+} -+ -+static ssize_t phytium_edac_inject_ctrl_write(struct file *filp, -+ const char __user *buf, -+ size_t size, loff_t *ppos) -+{ -+ int ret = 0; -+ int res = 0; -+ unsigned int error_group = 0; -+ unsigned int error_id = 0; -+ unsigned int error_num = 0; -+ struct phytium_edac *edac = filp->private_data; -+ char str[255]; -+ char *p_str = str; -+ char *tmp = NULL; -+ -+ if (size > 255) { -+ ret = -EFAULT; -+ goto out; -+ } -+ -+ if (copy_from_user(str, buf, size)) { -+ ret = -EFAULT; -+ goto out; -+ } else { -+ *ppos += size; -+ ret = size; -+ } -+ str[size] = '\0'; -+ -+ tmp = strsep(&p_str, ","); -+ if (!tmp) -+ goto out; -+ -+ res = kstrtouint(tmp, 0, &error_group); -+ if (res || error_group >= MAX_ERR_GROUP) { -+ dev_err(edac->dev, "invalid error group parameters"); -+ goto out; -+ } -+ -+ res = kstrtouint(p_str, 0, &error_id); -+ if (res) { -+ dev_err(edac->dev, "invalid error id parameters"); -+ goto out; -+ } -+ -+ error_num = get_error_num(edac, error_group); -+ if (error_id >= error_num) { -+ dev_err(edac->dev, "invalid ras error id.\n"); -+ goto out; -+ } -+ -+ dev_dbg(edac->dev, "inject group%d, error_id: %d\n", -+ error_group, error_id); -+ -+ if (pe220x_ras_error[error_group][error_id].error_type -+ == CORRECTED_ERROR) { -+ writeq(MISC0_CEC(0xFF), -+ edac->ras_base[error_group] + ERR_MISC0(error_id)); -+ } -+ -+ writel(error_id, edac->ras_base[error_group] + ERR_INJECT); -+ -+out: -+ return ret; -+} -+ -+static const struct file_operations phytium_edac_debug_inject_fops[] = { -+ { -+ .open = simple_open, -+ .write = phytium_edac_inject_ctrl_write, -+ .llseek = generic_file_llseek, }, -+ { } -+}; -+ -+static void phytium_edac_create_debugfs_nodes(struct phytium_edac *edac) -+{ -+ if (!IS_ENABLED(CONFIG_EDAC_DEBUG) || !edac->dfs) { -+ dev_info(edac->dev, "edac debug is disable"); -+ return; -+ } -+ -+ edac_debugfs_create_file("error_inject_ctrl", 0x0200, edac->dfs, edac, -+ &phytium_edac_debug_inject_fops[0]); -+} -+ -+static int phytium_edac_device_add(struct phytium_edac *edac) -+{ -+ struct edac_device_ctl_info *edac_dev; -+ int res = 0; -+ -+ edac_dev = edac_device_alloc_ctl_info( -+ sizeof(struct edac_device_ctl_info), -+ "ras", 1, "soc", 1, 0, NULL, -+ 0, edac_device_alloc_index()); -+ if (!edac_dev) -+ res = -ENOMEM; -+ -+ edac_dev->dev = edac->dev; -+ edac_dev->mod_name = EDAC_MOD_STR; -+ edac_dev->ctl_name = "phytium ras"; -+ edac_dev->dev_name = "soc"; -+ -+ phytium_edac_create_debugfs_nodes(edac); -+ -+ res = edac_device_add_device(edac_dev); -+ if (res > 0) { -+ dev_err(edac->dev, "edac_device_add_device failed\n"); -+ goto err_free; -+ } -+ -+ edac->edac_dev = edac_dev; -+ dev_info(edac->dev, "phytium edac device registered\n"); -+ return 0; -+ -+err_free: -+ edac_device_free_ctl_info(edac_dev); -+ return res; -+} -+ -+static int phytium_edac_device_remove(struct phytium_edac *edac) -+{ -+ struct edac_device_ctl_info *edac_dev = edac->edac_dev; -+ -+ debugfs_remove_recursive(edac->dfs); -+ edac_device_del_device(edac_dev->dev); -+ edac_device_free_ctl_info(edac_dev); -+ return 0; -+} -+ -+static int get_error_id(struct phytium_edac *edac, int *error_id, -+ int *error_group) -+{ -+ unsigned int error_num = 0; -+ u64 error_bit = 0; -+ int ret = 0; -+ int i = 0; -+ int err_id = 0; -+ -+ /* Iterate over the ras node to check error status */ -+ for (i = 0; i < MAX_ERR_GROUP; i++) { -+ error_num = get_error_num(edac, i); -+ error_bit = readq(edac->ras_base[i] + ERR_GSR); -+ for (err_id = 0; err_id < error_num; err_id++) { -+ if (!(error_bit & BIT(err_id))) -+ continue; -+ else -+ break; -+ } -+ if (err_id < error_num) { -+ *error_id = err_id; -+ *error_group = i; -+ break; -+ } -+ } -+ -+ if (i >= MAX_ERR_GROUP) { -+ ret = -1; -+ dev_warn(edac->dev, "no error detect.\n"); -+ } -+ -+ return ret; -+} -+ -+static void phytium_edac_error_report(struct phytium_edac *edac, -+ const int error_id, const int error_group) -+{ -+ const struct ras_error_info *err_info = -+ pe220x_ras_error[error_group]; -+ -+ if (err_info[error_id].error_type == UNCORRECTED_ERROR) { -+ edac_printk(KERN_CRIT, EDAC_MOD_STR, "uncorrected error: %s\n", -+ err_info[error_id].error_str); -+ edac_device_handle_ue(edac->edac_dev, 0, 0, -+ err_info[error_id].error_str); -+ /* Report the error via the trace interface */ -+ if (IS_ENABLED(CONFIG_RAS)) -+ trace_non_standard_event(&NULL_GUID, &NULL_GUID, -+ EDAC_MOD_STR, SEV_RECOVERABLE, -+ err_info[error_id].error_str, -+ strlen(err_info[error_id].error_str)); -+ } else { -+ edac_printk(KERN_CRIT, EDAC_MOD_STR, "corrected error: %s\n", -+ err_info[error_id].error_str); -+ edac_device_handle_ce(edac->edac_dev, 0, 0, -+ err_info[error_id].error_str); -+ if (IS_ENABLED(CONFIG_RAS)) -+ trace_non_standard_event(&NULL_GUID, &NULL_GUID, -+ EDAC_MOD_STR, SEV_CORRECTED, -+ err_info[error_id].error_str, -+ strlen(err_info[error_id].error_str)); -+ } -+} -+ -+/* -+ * clear error status and set correct error counter to 0xFE for trigger -+ * interrupt when next correct error event -+ */ -+static void phytium_edac_clear_error_status(struct phytium_edac *edac, -+ const int error_id, const int error_group) -+{ -+ writeq(MISC0_CEC(0XFE), edac->ras_base[error_group] + -+ ERR_MISC0(error_id)); -+ writeq(GENMASK(31, 0), edac->ras_base[error_group] + -+ ERR_STATUS(error_id)); -+} -+ -+static irqreturn_t phytium_edac_isr(int irq, void *dev_id) -+{ -+ struct phytium_edac *edac = dev_id; -+ int ret = 0; -+ int error_group; -+ int error_id; -+ -+ ret = get_error_id(edac, &error_id, &error_group); -+ if (ret < 0) -+ goto out; -+ -+ phytium_edac_error_report(edac, error_id, error_group); -+ phytium_edac_clear_error_status(edac, error_id, error_group); -+ -+out: -+ return IRQ_HANDLED; -+} -+ -+static int phytium_edac_probe(struct platform_device *pdev) -+{ -+ struct phytium_edac *edac; -+ struct resource *res; -+ int ret = 0; -+ int irq_cnt = 0; -+ int irq = 0; -+ int i = 0; -+ -+ edac = devm_kzalloc(&pdev->dev, sizeof(*edac), GFP_KERNEL); -+ if (!edac) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ edac->dev = &pdev->dev; -+ platform_set_drvdata(pdev, edac); -+ -+ edac->ras_base = devm_kcalloc(&pdev->dev, 3, -+ sizeof(*edac->ras_base), GFP_KERNEL); -+ if (!edac->ras_base) { -+ return -ENOMEM; -+ goto out; -+ } -+ -+ for (i = 0; i < MAX_ERR_GROUP; i++) { -+ res = platform_get_resource(pdev, IORESOURCE_MEM, i); -+ edac->ras_base[i] = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(edac->ras_base[i])) { -+ dev_err(&pdev->dev, "no resource address\n"); -+ ret = PTR_ERR(edac->ras_base[i]); -+ goto out; -+ } -+ } -+ -+ edac->dfs = edac_debugfs_create_dir(EDAC_MOD_STR); -+ -+ ret = phytium_edac_device_add(edac); -+ if (ret) { -+ dev_err(&pdev->dev, "can't add edac device"); -+ goto out; -+ } -+ -+ phytium_ras_setup(edac); -+ -+ irq_cnt = platform_irq_count(pdev); -+ if (irq_cnt < 0) { -+ dev_err(&pdev->dev, "no irq resource\n"); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ for (i = 0; i < irq_cnt; i++) { -+ irq = platform_get_irq(pdev, i); -+ if (irq < 0) { -+ dev_err(&pdev->dev, "invalid irq resource\n"); -+ ret = -EINVAL; -+ goto out; -+ } -+ ret = devm_request_irq(&pdev->dev, irq, -+ phytium_edac_isr, IRQF_SHARED, -+ EDAC_MOD_STR, edac); -+ if (ret) { -+ dev_err(&pdev->dev, -+ "could not request irq %d\n", irq); -+ goto out; -+ } -+ } -+ -+out: -+ return ret; -+} -+ -+static int phytium_edac_remove(struct platform_device *pdev) -+{ -+ struct phytium_edac *edac = dev_get_drvdata(&pdev->dev); -+ -+ phytium_edac_device_remove(edac); -+ -+ return 0; -+} -+ -+static const struct of_device_id phytium_edac_of_match[] = { -+ { .compatible = "phytium,pe220x-edac" }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, phytium_edac_of_match); -+ -+static struct platform_driver phytium_edac_driver = { -+ .probe = phytium_edac_probe, -+ .remove = phytium_edac_remove, -+ .driver = { -+ .name = "phytium-edac", -+ .of_match_table = phytium_edac_of_match, -+ }, -+}; -+ -+module_platform_driver(phytium_edac_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Huangjie "); -diff --git a/drivers/firmware/arm_scmi/driver.c b/drivers/firmware/arm_scmi/driver.c -index 87383c054..6a16007c6 100644 ---- a/drivers/firmware/arm_scmi/driver.c -+++ b/drivers/firmware/arm_scmi/driver.c -@@ -51,6 +51,8 @@ static DEFINE_SPINLOCK(protocol_lock); - static LIST_HEAD(scmi_list); - /* Protection for the entire list */ - static DEFINE_MUTEX(scmi_list_mutex); -+/* Protection for scmi xfer, prevent transmission timeout */ -+static DEFINE_MUTEX(scmi_xfer_mutex); - /* Track the unique id for the transfers for debug & profiling purpose */ - static atomic_t transfer_last_id; - -@@ -1030,6 +1032,7 @@ static int scmi_wait_for_reply(struct device *dev, const struct scmi_desc *desc, - struct scmi_xfer *xfer, unsigned int timeout_ms) - { - int ret = 0; -+ struct scmi_info *info = handle_to_scmi_info(cinfo->handle); - - if (xfer->hdr.poll_completion) { - /* -@@ -1045,7 +1048,10 @@ static int scmi_wait_for_reply(struct device *dev, const struct scmi_desc *desc, - - spin_until_cond(scmi_xfer_done_no_timeout(cinfo, - xfer, stop)); -- if (ktime_after(ktime_get(), stop)) { -+ -+ /* Poll again, timeout maybe caused by preempted */ -+ if (ktime_after(ktime_get(), stop) && -+ !info->desc->ops->poll_done(cinfo, xfer)) { - dev_err(dev, - "timed out in resp(caller: %pS) - polling\n", - (void *)_RET_IP_); -@@ -1211,8 +1217,11 @@ static int do_xfer(const struct scmi_protocol_handle *ph, - */ - smp_mb(); - -+ /* lock scmi xfer, too many scmi xfers may cause timeout */ -+ mutex_lock(&scmi_xfer_mutex); - ret = info->desc->ops->send_message(cinfo, xfer); - if (ret < 0) { -+ mutex_unlock(&scmi_xfer_mutex); - dev_dbg(dev, "Failed to send message %d\n", ret); - return ret; - } -@@ -1228,6 +1237,8 @@ static int do_xfer(const struct scmi_protocol_handle *ph, - if (info->desc->ops->mark_txdone) - info->desc->ops->mark_txdone(cinfo, ret, xfer); - -+ mutex_unlock(&scmi_xfer_mutex); -+ - trace_scmi_xfer_end(xfer->transfer_id, xfer->hdr.id, - xfer->hdr.protocol_id, xfer->hdr.seq, ret); - -diff --git a/drivers/firmware/arm_scmi/mailbox.c b/drivers/firmware/arm_scmi/mailbox.c -index b8d470417..1a1580a8b 100644 ---- a/drivers/firmware/arm_scmi/mailbox.c -+++ b/drivers/firmware/arm_scmi/mailbox.c -@@ -167,6 +167,7 @@ static int mailbox_chan_setup(struct scmi_chan_info *cinfo, struct device *dev, - struct mbox_client *cl; - resource_size_t size; - struct resource res; -+ struct of_phandle_args args; - - ret = mailbox_chan_validate(cdev, &a2p_rx_chan, &p2a_chan); - if (ret) -@@ -226,6 +227,16 @@ static int mailbox_chan_setup(struct scmi_chan_info *cinfo, struct device *dev, - } - } - -+ ret = of_parse_phandle_with_args(cdev->of_node, "mboxes", -+ "#mbox-cells", tx ? 0 : p2a_chan, &args); -+ if (ret) { -+ dev_err(cdev, "failed to get SCMI %s mailbox\n", desc); -+ return ret; -+ } -+ -+ if (of_device_is_compatible(args.np, "phytium,mbox")) -+ cinfo->no_completion_irq = true; -+ - cinfo->transport_info = smbox; - smbox->cinfo = cinfo; - -diff --git a/drivers/gpio/Kconfig b/drivers/gpio/Kconfig -index d56b83535..be05e1f1c 100644 ---- a/drivers/gpio/Kconfig -+++ b/drivers/gpio/Kconfig -@@ -105,6 +105,10 @@ config GPIO_REGMAP - - # put drivers in the right section, in alphabetical order - -+# This symbol is selected by both MMIO and PCI expanders -+config GPIO_PHYTIUM_CORE -+ tristate -+ - # This symbol is selected by both I2C and SPI expanders - config GPIO_MAX730X - tristate -@@ -495,6 +499,27 @@ config GPIO_OMAP - help - Say yes here to enable GPIO support for TI OMAP SoCs. - -+config GPIO_PHYTIUM_PLAT -+ tristate "Phytium GPIO Platform support" -+ default y if ARCH_PHYTIUM -+ depends on ARM64 -+ select GPIO_PHYTIUM_CORE -+ select IRQ_DOMAIN -+ select GENERIC_IRQ_CHIP -+ select GPIOLIB_IRQCHIP -+ help -+ Say yes here to support the on-chip GPIO controller for the -+ Phytium SoC family. -+ -+config GPIO_PHYTIUM_SGPIO -+ tristate "Phytium SGPIO support" -+ default y if ARCH_PHYTIUM -+ depends on ARM64 -+ select IRQ_DOMAIN -+ select GENERIC_IRQ_CHIP -+ help -+ Say yes here to enable SGPIO support for Phytium SoCs. -+ - config GPIO_PL061 - tristate "PrimeCell PL061 GPIO support" - depends on ARM_AMBA -@@ -1680,6 +1705,19 @@ config GPIO_PCIE_IDIO_24 - Input filter control is not supported by this driver, and the input - filters are deactivated by this driver. - -+config GPIO_PHYTIUM_PCI -+ tristate "Phytium GPIO PCI support" -+ select GPIO_PHYTIUM_CORE -+ select IRQ_DOMAIN -+ select GENERIC_IRQ_CHIP -+ select GPIOLIB_IRQCHIP -+ help -+ Say Y here to support Phytium PCI GPIO controller on Px210 chipset. -+ An interrupt is generated when any of the inputs change state -+ (low to high or high to low). -+ -+ This driver can be used for Phytium Px210. -+ - config GPIO_RDC321X - tristate "RDC R-321x GPIO support" - select MFD_CORE -diff --git a/drivers/gpio/Makefile b/drivers/gpio/Makefile -index eb73b5d63..1b4888e64 100644 ---- a/drivers/gpio/Makefile -+++ b/drivers/gpio/Makefile -@@ -125,6 +125,10 @@ obj-$(CONFIG_GPIO_PCF857X) += gpio-pcf857x.o - obj-$(CONFIG_GPIO_PCH) += gpio-pch.o - obj-$(CONFIG_GPIO_PCIE_IDIO_24) += gpio-pcie-idio-24.o - obj-$(CONFIG_GPIO_PCI_IDIO_16) += gpio-pci-idio-16.o -+obj-$(CONFIG_GPIO_PHYTIUM_CORE) += gpio-phytium-core.o -+obj-$(CONFIG_GPIO_PHYTIUM_PCI) += gpio-phytium-pci.o -+obj-$(CONFIG_GPIO_PHYTIUM_PLAT) += gpio-phytium-platform.o -+obj-$(CONFIG_GPIO_PHYTIUM_SGPIO) += gpio-phytium-sgpio.o - obj-$(CONFIG_GPIO_PISOSR) += gpio-pisosr.o - obj-$(CONFIG_GPIO_PL061) += gpio-pl061.o - obj-$(CONFIG_GPIO_PMIC_EIC_SPRD) += gpio-pmic-eic-sprd.o -diff --git a/drivers/gpio/gpio-phytium-core.c b/drivers/gpio/gpio-phytium-core.c -new file mode 100644 -index 000000000..8ea7cafc4 ---- /dev/null -+++ b/drivers/gpio/gpio-phytium-core.c -@@ -0,0 +1,378 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "gpio-phytium-core.h" -+ -+static int get_pin_location(struct phytium_gpio *gpio, unsigned int offset, -+ struct pin_loc *pl) -+{ -+ int ret; -+ -+ if (offset < gpio->ngpio[0]) { -+ pl->port = 0; -+ pl->offset = offset; -+ ret = 0; -+ } else if (offset < (gpio->ngpio[0] + gpio->ngpio[1])) { -+ pl->port = 1; -+ pl->offset = offset - gpio->ngpio[0]; -+ ret = 0; -+ } else { -+ ret = -EINVAL; -+ } -+ -+ return ret; -+} -+ -+static void phytium_gpio_toggle_trigger(struct phytium_gpio *gpio, -+ unsigned int offset) -+{ -+ struct gpio_chip *gc; -+ u32 pol; -+ int val; -+ -+ /* Only port A can provide interrupt source */ -+ if (offset >= gpio->ngpio[0]) -+ return; -+ -+ gc = &gpio->gc; -+ -+ pol = readl(gpio->regs + GPIO_INT_POLARITY); -+ /* Just read the current value right out of the data register */ -+ val = gc->get(gc, offset); -+ if (val) -+ pol &= ~BIT(offset); -+ else -+ pol |= BIT(offset); -+ -+ writel(pol, gpio->regs + GPIO_INT_POLARITY); -+} -+ -+int phytium_gpio_get(struct gpio_chip *gc, unsigned int offset) -+{ -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct pin_loc loc; -+ void __iomem *dat; -+ -+ if (get_pin_location(gpio, offset, &loc)) -+ return -EINVAL; -+ -+ dat = gpio->regs + GPIO_EXT_PORTA + (loc.port * GPIO_PORT_STRIDE); -+ -+ return !!(readl(dat) & BIT(loc.offset)); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_get); -+ -+void phytium_gpio_set(struct gpio_chip *gc, unsigned int offset, int value) -+{ -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct pin_loc loc; -+ void __iomem *dr; -+ unsigned long flags; -+ u32 mask; -+ -+ if (get_pin_location(gpio, offset, &loc)) -+ return; -+ dr = gpio->regs + GPIO_SWPORTA_DR + (loc.port * GPIO_PORT_STRIDE); -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ if (value) -+ mask = readl(dr) | BIT(loc.offset); -+ else -+ mask = readl(dr) & ~BIT(loc.offset); -+ -+ writel(mask, dr); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_set); -+ -+int phytium_gpio_direction_input(struct gpio_chip *gc, unsigned int offset) -+{ -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct pin_loc loc; -+ unsigned long flags; -+ void __iomem *ddr; -+ -+ if (get_pin_location(gpio, offset, &loc)) -+ return -EINVAL; -+ ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ writel(readl(ddr) & ~(BIT(loc.offset)), ddr); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_direction_input); -+ -+int phytium_gpio_direction_output(struct gpio_chip *gc, unsigned int offset, -+ int value) -+{ -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct pin_loc loc; -+ unsigned long flags; -+ void __iomem *ddr; -+ -+ if (get_pin_location(gpio, offset, &loc)) -+ return -EINVAL; -+ ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ writel(readl(ddr) | BIT(loc.offset), ddr); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ phytium_gpio_set(gc, offset, value); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_direction_output); -+ -+void phytium_gpio_irq_ack(struct irq_data *d) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ u32 val = BIT(irqd_to_hwirq(d)); -+ -+ raw_spin_lock(&gpio->lock); -+ -+ writel(val, gpio->regs + GPIO_PORTA_EOI); -+ -+ raw_spin_unlock(&gpio->lock); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_ack); -+ -+void phytium_gpio_irq_mask(struct irq_data *d) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ u32 val; -+ -+ /* Only port A can provide interrupt source */ -+ if (irqd_to_hwirq(d) >= gpio->ngpio[0]) -+ return; -+ -+ raw_spin_lock(&gpio->lock); -+ -+ val = readl(gpio->regs + GPIO_INTMASK); -+ val |= BIT(irqd_to_hwirq(d)); -+ writel(val, gpio->regs + GPIO_INTMASK); -+ -+ raw_spin_unlock(&gpio->lock); -+ -+ gpiochip_disable_irq(gc, irqd_to_hwirq(d)); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_mask); -+ -+void phytium_gpio_irq_unmask(struct irq_data *d) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ u32 val; -+ -+ /* Only port A can provide interrupt source */ -+ if (irqd_to_hwirq(d) >= gpio->ngpio[0]) -+ return; -+ -+ gpiochip_enable_irq(gc, irqd_to_hwirq(d)); -+ -+ raw_spin_lock(&gpio->lock); -+ -+ val = readl(gpio->regs + GPIO_INTMASK); -+ val &= ~BIT(irqd_to_hwirq(d)); -+ writel(val, gpio->regs + GPIO_INTMASK); -+ -+ raw_spin_unlock(&gpio->lock); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_unmask); -+ -+int phytium_gpio_irq_set_type(struct irq_data *d, unsigned int flow_type) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ int hwirq = irqd_to_hwirq(d); -+ unsigned long flags, lvl, pol; -+ -+ if (hwirq < 0 || hwirq >= gpio->ngpio[0]) -+ return -EINVAL; -+ -+ if ((flow_type & (IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW)) && -+ (flow_type & (IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING))) { -+ dev_err(gc->parent, -+ "trying to configure line %d for both level and edge detection, choose one!\n", -+ hwirq); -+ return -EINVAL; -+ } -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ lvl = readl(gpio->regs + GPIO_INTTYPE_LEVEL); -+ pol = readl(gpio->regs + GPIO_INT_POLARITY); -+ -+ switch (flow_type) { -+ case IRQ_TYPE_EDGE_BOTH: -+ lvl |= BIT(hwirq); -+ phytium_gpio_toggle_trigger(gpio, hwirq); -+ irq_set_handler_locked(d, handle_edge_irq); -+ dev_dbg(gc->parent, "line %d: IRQ on both edges\n", hwirq); -+ break; -+ case IRQ_TYPE_EDGE_RISING: -+ lvl |= BIT(hwirq); -+ pol |= BIT(hwirq); -+ irq_set_handler_locked(d, handle_edge_irq); -+ dev_dbg(gc->parent, "line %d: IRQ on RISING edge\n", hwirq); -+ break; -+ case IRQ_TYPE_EDGE_FALLING: -+ lvl |= BIT(hwirq); -+ pol &= ~BIT(hwirq); -+ irq_set_handler_locked(d, handle_edge_irq); -+ dev_dbg(gc->parent, "line %d: IRQ on FALLING edge\n", hwirq); -+ break; -+ case IRQ_TYPE_LEVEL_HIGH: -+ lvl &= ~BIT(hwirq); -+ pol |= BIT(hwirq); -+ irq_set_handler_locked(d, handle_level_irq); -+ dev_dbg(gc->parent, "line %d: IRQ on HIGH level\n", hwirq); -+ break; -+ case IRQ_TYPE_LEVEL_LOW: -+ lvl &= ~BIT(hwirq); -+ pol &= ~BIT(hwirq); -+ irq_set_handler_locked(d, handle_level_irq); -+ dev_dbg(gc->parent, "line %d: IRQ on LOW level\n", hwirq); -+ break; -+ } -+ -+ writel(lvl, gpio->regs + GPIO_INTTYPE_LEVEL); -+ if (flow_type != IRQ_TYPE_EDGE_BOTH) -+ writel(pol, gpio->regs + GPIO_INT_POLARITY); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_set_type); -+ -+void phytium_gpio_irq_enable(struct irq_data *d) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ unsigned long flags; -+ u32 val; -+ -+ /* Only port A can provide interrupt source */ -+ if (irqd_to_hwirq(d) >= gpio->ngpio[0]) -+ return; -+ -+ gpiochip_enable_irq(gc, irqd_to_hwirq(d)); -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ val = readl(gpio->regs + GPIO_INTEN); -+ val |= BIT(irqd_to_hwirq(d)); -+ writel(val, gpio->regs + GPIO_INTEN); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ gpiochip_disable_irq(gc, irqd_to_hwirq(d)); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_enable); -+ -+void phytium_gpio_irq_disable(struct irq_data *d) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(d); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ unsigned long flags; -+ u32 val; -+ -+ /* Only port A can provide interrupt source */ -+ if (irqd_to_hwirq(d) >= gpio->ngpio[0]) -+ return; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ val = readl(gpio->regs + GPIO_INTEN); -+ val &= ~BIT(irqd_to_hwirq(d)); -+ writel(val, gpio->regs + GPIO_INTEN); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_disable); -+ -+void phytium_gpio_irq_print_chip(struct irq_data *data, struct seq_file *p) -+{ -+ struct gpio_chip *gc = irq_data_get_irq_chip_data(data); -+ -+ seq_printf(p, dev_name(gc->parent)); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_print_chip); -+ -+void phytium_gpio_irq_handler(struct irq_desc *desc) -+{ -+ struct gpio_chip *gc = irq_desc_get_handler_data(desc); -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct irq_chip *irqchip = irq_desc_get_chip(desc); -+ unsigned long pending; -+ int offset; -+ -+ chained_irq_enter(irqchip, desc); -+ -+ pending = readl(gpio->regs + GPIO_INTSTATUS); -+ if (pending) { -+ for_each_set_bit(offset, &pending, gpio->ngpio[0]) { -+ int gpio_irq = irq_find_mapping(gc->irq.domain, -+ offset); -+ generic_handle_irq(gpio_irq); -+ -+ if ((irq_get_trigger_type(gpio_irq) & -+ IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH) -+ phytium_gpio_toggle_trigger(gpio, offset); -+ } -+ } -+ -+ chained_irq_exit(irqchip, desc); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_handler); -+ -+int phytium_gpio_get_direction(struct gpio_chip *gc, unsigned int offset) -+{ -+ struct phytium_gpio *gpio = gpiochip_get_data(gc); -+ struct pin_loc loc; -+ void __iomem *ddr; -+ -+ if (get_pin_location(gpio, offset, &loc)) -+ return -EINVAL; -+ ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); -+ -+ return !(readl(ddr) & BIT(loc.offset)); -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_get_direction); -+ -+int phytium_gpio_irq_set_affinity(struct irq_data *d, const struct cpumask *mask_val, bool force) -+{ -+ int hwirq = irqd_to_hwirq(d); -+ struct gpio_chip *chip_data = irq_data_get_irq_chip_data(d); -+ struct irq_chip *chip = irq_get_chip(chip_data->irq.parents[hwirq]); -+ struct irq_data *data = irq_get_irq_data(chip_data->irq.parents[hwirq]); -+ -+ if (chip && chip->irq_set_affinity) -+ return chip->irq_set_affinity(data, mask_val, force); -+ -+ return -EINVAL; -+} -+EXPORT_SYMBOL_GPL(phytium_gpio_irq_set_affinity); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium GPIO Controller core"); -diff --git a/drivers/gpio/gpio-phytium-core.h b/drivers/gpio/gpio-phytium-core.h -new file mode 100644 -index 000000000..3d8c6e7b3 ---- /dev/null -+++ b/drivers/gpio/gpio-phytium-core.h -@@ -0,0 +1,87 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _GPIO_PHYTIUM_H -+#define _GPIO_PHYTIUM_H -+ -+#include -+#include -+ -+#include "gpiolib.h" -+ -+#define GPIO_SWPORTA_DR 0x00 /* WR Port A Output Data Register */ -+#define GPIO_SWPORTA_DDR 0x04 /* WR Port A Data Direction Register */ -+#define GPIO_EXT_PORTA 0x08 /* RO Port A Input Data Register */ -+#define GPIO_SWPORTB_DR 0x0c /* WR Port B Output Data Register */ -+#define GPIO_SWPORTB_DDR 0x10 /* WR Port B Data Direction Register */ -+#define GPIO_EXT_PORTB 0x14 /* RO Port B Input Data Register */ -+ -+#define GPIO_INTEN 0x18 /* WR Port A Interrput Enable Register */ -+#define GPIO_INTMASK 0x1c /* WR Port A Interrupt Mask Register */ -+#define GPIO_INTTYPE_LEVEL 0x20 /* WR Port A Interrupt Level Register */ -+#define GPIO_INT_POLARITY 0x24 /* WR Port A Interrupt Polarity Register */ -+#define GPIO_INTSTATUS 0x28 /* RO Port A Interrupt Status Register */ -+#define GPIO_RAW_INTSTATUS 0x2c /* RO Port A Raw Interrupt Status Register */ -+#define GPIO_LS_SYNC 0x30 /* WR Level-sensitive Synchronization Enable Register */ -+#define GPIO_DEBOUNCE 0x34 /* WR Debounce Enable Register */ -+#define GPIO_PORTA_EOI 0x38 /* WO Port A Clear Interrupt Register */ -+ -+#define MAX_NPORTS 2 -+#define NGPIO_DEFAULT 8 -+#define NGPIO_MAX 32 -+#define GPIO_PORT_STRIDE (GPIO_EXT_PORTB - GPIO_EXT_PORTA) -+ -+struct pin_loc { -+ unsigned int port; -+ unsigned int offset; -+}; -+ -+#ifdef CONFIG_PM_SLEEP -+struct phytium_gpio_ctx { -+ u32 swporta_dr; -+ u32 swporta_ddr; -+ u32 ext_porta; -+ u32 swportb_dr; -+ u32 swportb_ddr; -+ u32 ext_portb; -+ u32 inten; -+ u32 intmask; -+ u32 inttype_level; -+ u32 int_polarity; -+ u32 intstatus; -+ u32 raw_intstatus; -+ u32 ls_sync; -+ u32 debounce; -+}; -+#endif -+ -+struct phytium_gpio { -+ raw_spinlock_t lock; -+ void __iomem *regs; -+ struct gpio_chip gc; -+ unsigned int ngpio[2]; -+ int irq[32]; -+#ifdef CONFIG_PM_SLEEP -+ struct phytium_gpio_ctx ctx; -+#endif -+}; -+ -+int phytium_gpio_get(struct gpio_chip *gc, unsigned int offset); -+void phytium_gpio_set(struct gpio_chip *gc, unsigned int offset, int value); -+ -+int phytium_gpio_get_direction(struct gpio_chip *gc, unsigned int offset); -+int phytium_gpio_direction_input(struct gpio_chip *gc, unsigned int offset); -+int phytium_gpio_direction_output(struct gpio_chip *gc, unsigned int offset, int value); -+ -+void phytium_gpio_irq_ack(struct irq_data *d); -+void phytium_gpio_irq_mask(struct irq_data *d); -+void phytium_gpio_irq_unmask(struct irq_data *d); -+int phytium_gpio_irq_set_type(struct irq_data *d, unsigned int flow_type); -+void phytium_gpio_irq_print_chip(struct irq_data *data, struct seq_file *p); -+void phytium_gpio_irq_enable(struct irq_data *d); -+void phytium_gpio_irq_disable(struct irq_data *d); -+void phytium_gpio_irq_handler(struct irq_desc *desc); -+int phytium_gpio_irq_set_affinity(struct irq_data *d, const struct cpumask *mask_val, bool force); -+#endif -diff --git a/drivers/gpio/gpio-phytium-pci.c b/drivers/gpio/gpio-phytium-pci.c -new file mode 100644 -index 000000000..e194e3582 ---- /dev/null -+++ b/drivers/gpio/gpio-phytium-pci.c -@@ -0,0 +1,191 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "gpio-phytium-core.h" -+ -+static const struct irq_chip phytium_gpio_irq_chip = { -+ .irq_ack = phytium_gpio_irq_ack, -+ .irq_mask = phytium_gpio_irq_mask, -+ .irq_unmask = phytium_gpio_irq_unmask, -+ .irq_set_type = phytium_gpio_irq_set_type, -+ .irq_print_chip = phytium_gpio_irq_print_chip, -+ .irq_enable = phytium_gpio_irq_enable, -+ .irq_disable = phytium_gpio_irq_disable, -+ .flags = IRQCHIP_IMMUTABLE, -+ GPIOCHIP_IRQ_RESOURCE_HELPERS, -+}; -+ -+static int phytium_gpio_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) -+{ -+ struct device *dev = &pdev->dev; -+ struct phytium_gpio *gpio; -+ struct gpio_irq_chip *girq; -+ int err; -+ -+ gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL); -+ if (!gpio) -+ return -ENOMEM; -+ -+ err = pcim_enable_device(pdev); -+ if (err) { -+ dev_err(dev, "Failed to enable PCI device: err %d\n", err); -+ goto out; -+ } -+ -+ err = pcim_iomap_regions(pdev, 1 << 0, pci_name(pdev)); -+ if (err) { -+ dev_err(dev, "Failed to iomap PCI device: err %d\n", err); -+ goto out; -+ } -+ -+ gpio->regs = pcim_iomap_table(pdev)[0]; -+ if (!gpio->regs) { -+ dev_err(dev, "Cannot map PCI resource\n"); -+ err = -ENOMEM; -+ goto out; -+ } -+ -+ err = pci_enable_msi(pdev); -+ if (err < 0) -+ goto out; -+ -+ pci_set_master(pdev); -+ -+ gpio->irq[0] = pdev->irq; -+ if (gpio->irq[0] < 0) -+ dev_warn(dev, "no irq is found.\n"); -+ -+ /* There is only one group of Pins at the moment. */ -+ gpio->ngpio[0] = NGPIO_MAX; -+ -+ /* irq_chip support */ -+ raw_spin_lock_init(&gpio->lock); -+ -+ gpio->gc.base = -1; -+ gpio->gc.get_direction = phytium_gpio_get_direction; -+ gpio->gc.direction_input = phytium_gpio_direction_input; -+ gpio->gc.direction_output = phytium_gpio_direction_output; -+ gpio->gc.get = phytium_gpio_get; -+ gpio->gc.set = phytium_gpio_set; -+ gpio->gc.ngpio = gpio->ngpio[0] + gpio->ngpio[1]; -+ gpio->gc.label = dev_name(dev); -+ gpio->gc.parent = dev; -+ gpio->gc.owner = THIS_MODULE; -+ -+ girq = &gpio->gc.irq; -+ girq->handler = handle_bad_irq; -+ girq->default_type = IRQ_TYPE_NONE; -+ -+ girq->num_parents = 1; -+ girq->parents = devm_kcalloc(&pdev->dev, girq->num_parents, -+ sizeof(*girq->parents), GFP_KERNEL); -+ if (!girq->parents) -+ return -ENOMEM; -+ girq->parents[0] = gpio->irq[0]; -+ girq->parent_handler = phytium_gpio_irq_handler; -+ -+ gpio_irq_chip_set_chip(girq, &phytium_gpio_irq_chip); -+ -+ err = devm_gpiochip_add_data(dev, &gpio->gc, gpio); -+ if (err) -+ goto out; -+ -+ dev_info(dev, "Phytium PCI GPIO controller @%pa registered\n", -+ &gpio->regs); -+ -+ pci_set_drvdata(pdev, gpio); -+ -+out: -+ return err; -+} -+ -+static const struct pci_device_id phytium_gpio_pci_ids[] = { -+ { PCI_DEVICE(0x1DB7, 0xDC31) }, -+ { 0 } -+}; -+MODULE_DEVICE_TABLE(pci, phytium_gpio_pci_ids); -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_gpio_pci_suspend(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_gpio *gpio = pci_get_drvdata(pdev); -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ gpio->ctx.swporta_dr = readl(gpio->regs + GPIO_SWPORTA_DR); -+ gpio->ctx.swporta_ddr = readl(gpio->regs + GPIO_SWPORTA_DDR); -+ gpio->ctx.ext_porta = readl(gpio->regs + GPIO_EXT_PORTA); -+ gpio->ctx.swportb_dr = readl(gpio->regs + GPIO_SWPORTB_DR); -+ gpio->ctx.swportb_ddr = readl(gpio->regs + GPIO_SWPORTB_DDR); -+ gpio->ctx.ext_portb = readl(gpio->regs + GPIO_EXT_PORTB); -+ -+ gpio->ctx.inten = readl(gpio->regs + GPIO_INTEN); -+ gpio->ctx.intmask = readl(gpio->regs + GPIO_INTMASK); -+ gpio->ctx.inttype_level = readl(gpio->regs + GPIO_INTTYPE_LEVEL); -+ gpio->ctx.int_polarity = readl(gpio->regs + GPIO_INT_POLARITY); -+ gpio->ctx.debounce = readl(gpio->regs + GPIO_DEBOUNCE); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+ -+static int phytium_gpio_pci_resume(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_gpio *gpio = pci_get_drvdata(pdev); -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ writel(gpio->ctx.swporta_dr, gpio->regs + GPIO_SWPORTA_DR); -+ writel(gpio->ctx.swporta_ddr, gpio->regs + GPIO_SWPORTA_DDR); -+ writel(gpio->ctx.ext_porta, gpio->regs + GPIO_EXT_PORTA); -+ writel(gpio->ctx.swportb_dr, gpio->regs + GPIO_SWPORTB_DR); -+ writel(gpio->ctx.swportb_ddr, gpio->regs + GPIO_SWPORTB_DDR); -+ writel(gpio->ctx.ext_portb, gpio->regs + GPIO_EXT_PORTB); -+ -+ writel(gpio->ctx.inten, gpio->regs + GPIO_INTEN); -+ writel(gpio->ctx.intmask, gpio->regs + GPIO_INTMASK); -+ writel(gpio->ctx.inttype_level, gpio->regs + GPIO_INTTYPE_LEVEL); -+ writel(gpio->ctx.int_polarity, gpio->regs + GPIO_INT_POLARITY); -+ writel(gpio->ctx.debounce, gpio->regs + GPIO_DEBOUNCE); -+ -+ writel(0xffffffff, gpio->regs + GPIO_PORTA_EOI); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_gpio_pci_pm_ops, -+ phytium_gpio_pci_suspend, -+ phytium_gpio_pci_resume); -+ -+static struct pci_driver phytium_gpio_pci_driver = { -+ .name = "gpio-phytium-pci", -+ .id_table = phytium_gpio_pci_ids, -+ .probe = phytium_gpio_pci_probe, -+ .driver = { -+ .pm = &phytium_gpio_pci_pm_ops, -+ }, -+}; -+ -+module_pci_driver(phytium_gpio_pci_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_DESCRIPTION("Phytium GPIO PCI Driver"); -diff --git a/drivers/gpio/gpio-phytium-platform.c b/drivers/gpio/gpio-phytium-platform.c -new file mode 100644 -index 000000000..2f808b89e ---- /dev/null -+++ b/drivers/gpio/gpio-phytium-platform.c -@@ -0,0 +1,208 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Support functions for Phytium GPIO -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from drivers/gpio/gpio-pl061.c -+ * Copyright (C) 2008, 2009 Provigent Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "gpio-phytium-core.h" -+ -+static const struct of_device_id phytium_gpio_of_match[] = { -+ { .compatible = "phytium,gpio", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_gpio_of_match); -+ -+static const struct acpi_device_id phytium_gpio_acpi_match[] = { -+ { "PHYT0001", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_gpio_acpi_match); -+ -+static const struct irq_chip phytium_gpio_irq_chip = { -+ .irq_ack = phytium_gpio_irq_ack, -+ .irq_mask = phytium_gpio_irq_mask, -+ .irq_unmask = phytium_gpio_irq_unmask, -+ .irq_set_type = phytium_gpio_irq_set_type, -+ .irq_print_chip = phytium_gpio_irq_print_chip, -+ .irq_enable = phytium_gpio_irq_enable, -+ .irq_disable = phytium_gpio_irq_disable, -+ .irq_set_affinity = phytium_gpio_irq_set_affinity, -+ .flags = IRQCHIP_IMMUTABLE, -+ GPIOCHIP_IRQ_RESOURCE_HELPERS, -+}; -+ -+static int phytium_gpio_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct resource *res; -+ struct phytium_gpio *gpio; -+ struct gpio_irq_chip *girq; -+ struct fwnode_handle *fwnode; -+ int err, irq_count; -+ -+ gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL); -+ if (!gpio) -+ return -ENOMEM; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ gpio->regs = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(gpio->regs)) -+ return PTR_ERR(gpio->regs); -+ -+ if (!device_get_child_node_count(dev)) -+ return -ENODEV; -+ -+ device_for_each_child_node(dev, fwnode) { -+ int idx; -+ -+ if (fwnode_property_read_u32(fwnode, "reg", &idx) || -+ idx >= MAX_NPORTS) { -+ dev_err(dev, "missing/invalid port index\n"); -+ fwnode_handle_put(fwnode); -+ return -EINVAL; -+ } -+ -+ if (fwnode_property_read_u32(fwnode, "ngpios", -+ &gpio->ngpio[idx]) -+ && fwnode_property_read_u32(fwnode, "nr-gpios", -+ &gpio->ngpio[idx])) { -+ dev_info(dev, -+ "failed to get number of gpios for Port%c\n", -+ idx ? 'B' : 'A'); -+ gpio->ngpio[idx] = NGPIO_DEFAULT; -+ } -+ } -+ -+ /* irq_chip support */ -+ raw_spin_lock_init(&gpio->lock); -+ -+ gpio->gc.base = -1; -+ gpio->gc.get_direction = phytium_gpio_get_direction; -+ gpio->gc.direction_input = phytium_gpio_direction_input; -+ gpio->gc.direction_output = phytium_gpio_direction_output; -+ gpio->gc.get = phytium_gpio_get; -+ gpio->gc.set = phytium_gpio_set; -+ gpio->gc.ngpio = gpio->ngpio[0] + gpio->ngpio[1]; -+ gpio->gc.label = dev_name(dev); -+ gpio->gc.parent = dev; -+ gpio->gc.owner = THIS_MODULE; -+ -+ girq = &gpio->gc.irq; -+ girq->handler = handle_bad_irq; -+ girq->default_type = IRQ_TYPE_NONE; -+ -+ for (irq_count = 0; irq_count < platform_irq_count(pdev); irq_count++) { -+ gpio->irq[irq_count] = -ENXIO; -+ gpio->irq[irq_count] = platform_get_irq(pdev, irq_count); -+ if (gpio->irq[irq_count] < 0) { -+ dev_warn(dev, "no irq is found.\n"); -+ break; -+ } -+ }; -+ -+ girq->num_parents = irq_count; -+ girq->parents = gpio->irq; -+ girq->parent_handler = phytium_gpio_irq_handler; -+ -+ gpio_irq_chip_set_chip(girq, &phytium_gpio_irq_chip); -+ -+ err = devm_gpiochip_add_data(dev, &gpio->gc, gpio); -+ if (err) -+ return err; -+ -+ platform_set_drvdata(pdev, gpio); -+ dev_info(dev, "Phytium GPIO controller @%pa registered\n", -+ &res->start); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_gpio_suspend(struct device *dev) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct phytium_gpio *gpio = platform_get_drvdata(pdev); -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ gpio->ctx.swporta_dr = readl(gpio->regs + GPIO_SWPORTA_DR); -+ gpio->ctx.swporta_ddr = readl(gpio->regs + GPIO_SWPORTA_DDR); -+ gpio->ctx.ext_porta = readl(gpio->regs + GPIO_EXT_PORTA); -+ gpio->ctx.swportb_dr = readl(gpio->regs + GPIO_SWPORTB_DR); -+ gpio->ctx.swportb_ddr = readl(gpio->regs + GPIO_SWPORTB_DDR); -+ gpio->ctx.ext_portb = readl(gpio->regs + GPIO_EXT_PORTB); -+ -+ gpio->ctx.inten = readl(gpio->regs + GPIO_INTEN); -+ gpio->ctx.intmask = readl(gpio->regs + GPIO_INTMASK); -+ gpio->ctx.inttype_level = readl(gpio->regs + GPIO_INTTYPE_LEVEL); -+ gpio->ctx.int_polarity = readl(gpio->regs + GPIO_INT_POLARITY); -+ gpio->ctx.debounce = readl(gpio->regs + GPIO_DEBOUNCE); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+ -+static int phytium_gpio_resume(struct device *dev) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct phytium_gpio *gpio = platform_get_drvdata(pdev); -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&gpio->lock, flags); -+ -+ writel(gpio->ctx.swporta_dr, gpio->regs + GPIO_SWPORTA_DR); -+ writel(gpio->ctx.swporta_ddr, gpio->regs + GPIO_SWPORTA_DDR); -+ writel(gpio->ctx.ext_porta, gpio->regs + GPIO_EXT_PORTA); -+ writel(gpio->ctx.swportb_dr, gpio->regs + GPIO_SWPORTB_DR); -+ writel(gpio->ctx.swportb_ddr, gpio->regs + GPIO_SWPORTB_DDR); -+ writel(gpio->ctx.ext_portb, gpio->regs + GPIO_EXT_PORTB); -+ -+ writel(gpio->ctx.inten, gpio->regs + GPIO_INTEN); -+ writel(gpio->ctx.intmask, gpio->regs + GPIO_INTMASK); -+ writel(gpio->ctx.inttype_level, gpio->regs + GPIO_INTTYPE_LEVEL); -+ writel(gpio->ctx.int_polarity, gpio->regs + GPIO_INT_POLARITY); -+ writel(gpio->ctx.debounce, gpio->regs + GPIO_DEBOUNCE); -+ -+ writel(0xffffffff, gpio->regs + GPIO_PORTA_EOI); -+ -+ raw_spin_unlock_irqrestore(&gpio->lock, flags); -+ -+ return 0; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_gpio_pm_ops, phytium_gpio_suspend, -+ phytium_gpio_resume); -+ -+static struct platform_driver phytium_gpio_driver = { -+ .driver = { -+ .name = "gpio-phytium-platform", -+ .pm = &phytium_gpio_pm_ops, -+ .of_match_table = of_match_ptr(phytium_gpio_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_gpio_acpi_match), -+ }, -+ .probe = phytium_gpio_probe, -+}; -+ -+module_platform_driver(phytium_gpio_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium GPIO driver"); -diff --git a/drivers/gpio/gpio-phytium-sgpio.c b/drivers/gpio/gpio-phytium-sgpio.c -new file mode 100644 -index 000000000..c661a86ae ---- /dev/null -+++ b/drivers/gpio/gpio-phytium-sgpio.c -@@ -0,0 +1,319 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SGPIO Driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define SGPIO_CTL0_REG 0x00 -+#define SGPIO_CTL0_REG_ENABLE BIT(0) -+#define SGPIO_CTL0_REG_RX_DISABLE BIT(1) -+#define SGPIO_CTL0_REG_L3_L0 GENMASK(11, 8) -+#define SGPIO_CTL0_REG_CLK_DIV_NUM GENMASK(31, 12) -+#define SGPIO_CTL1_REG 0x04 -+#define SGPIO_CTL1_REG_READY BIT(0) -+#define SGPIO_CTL1_REG_W_UPDATA BIT(1) -+#define SGPIO_CTL1_REG_OP_MODE BIT(2) -+#define SGPIO_CTL1_REG_OP_STATE BIT(3) -+#define SGPIO_CTL1_REG_BIT_NUM GENMASK(14, 8) -+#define SGPIO_CTL1_REG_INTERVAL_TIMER GENMASK(31, 16) -+#define SGPIO_SOFT_RESET_REG 0x08 -+#define SGPIO_SOFT_RESET_REG_MASK BIT(0) -+#define SGPIO_IRQ_REG 0x0c -+#define SGPIO_IRQ_REG_MASK BIT(0) -+#define SGPIO_IRQ_M_REG 0x10 -+#define SGPIO_IRQ_M_REG_MASK BIT(0) -+#define SGPIO_WDATA0_REG 0x14 -+#define SGPIO_WDATA_REG(x) (SGPIO_WDATA0_REG + (x) * 4) -+#define SGPIO_RDATA0_REG 0x24 -+#define SGPIO_RDATA_REG(x) (SGPIO_RDATA0_REG + (x) * 4) -+ -+#define DEFAULT_L3_L0 0 -+#define DEFAULT_CLK 50000000 -+ -+#define GPIO_GROUP(x) ((x) >> 6) -+#define GPIO_OFFSET(x) ((x) & GENMASK(5, 0)) -+#define GPIO_BIT(x) BIT(GPIO_OFFSET(x) >> 1) -+ -+struct phytium_sgpio { -+ struct gpio_chip gc; -+ void __iomem *regs; -+ unsigned int ngpios; -+ struct clk *pclk; -+ -+ struct mutex lock; -+ struct completion completion; -+}; -+ -+static bool phytium_sgpio_is_input(unsigned int offset) -+{ -+ return !(offset % 2); -+} -+ -+static int sgpio_set_value(struct gpio_chip *gc, unsigned int offset, int val) -+{ -+ struct phytium_sgpio *gpio = gpiochip_get_data(gc); -+ u32 reg; -+ int rc = 0; -+ -+ if (phytium_sgpio_is_input(offset)) -+ return -EINVAL; -+ -+ reinit_completion(&gpio->completion); -+ -+ /* -+ * Since this is an output, read the cached value from rdata, -+ * then update value. -+ */ -+ reg = readl(gpio->regs + SGPIO_RDATA_REG(GPIO_GROUP(offset))); -+ if (val) -+ reg |= GPIO_BIT(offset); -+ else -+ reg &= GPIO_BIT(offset); -+ writel(reg, gpio->regs + SGPIO_WDATA_REG(GPIO_GROUP(offset))); -+ -+ /* Start transmission and wait for completion */ -+ writel(readl(gpio->regs + SGPIO_CTL1_REG) | SGPIO_CTL1_REG_W_UPDATA, -+ gpio->regs + SGPIO_CTL1_REG); -+ if (!wait_for_completion_timeout(&gpio->completion, msecs_to_jiffies(1000))) -+ rc = -EINVAL; -+ -+ return rc; -+} -+ -+static int phytium_sgpio_direction_input(struct gpio_chip *gc, unsigned int offset) -+{ -+ return phytium_sgpio_is_input(offset) ? 0 : -EINVAL; -+} -+ -+static int phytium_sgpio_direction_output(struct gpio_chip *gc, unsigned int offset, int val) -+{ -+ struct phytium_sgpio *gpio = gpiochip_get_data(gc); -+ int rc; -+ -+ mutex_lock(&gpio->lock); -+ -+ /* -+ * No special action is required for setting the direction; we'll -+ * error-out in sgpio_set_value if this isn't an output GPIO -+ */ -+ rc = sgpio_set_value(&gpio->gc, offset, val); -+ -+ mutex_unlock(&gpio->lock); -+ -+ return rc; -+} -+ -+static int phytium_sgpio_get_direction(struct gpio_chip *gc, unsigned int offset) -+{ -+ return !!phytium_sgpio_is_input(offset); -+} -+ -+static int phytium_sgpio_get(struct gpio_chip *gc, unsigned int offset) -+{ -+ struct phytium_sgpio *gpio = gpiochip_get_data(gc); -+ int rc = 0; -+ u32 val, ctl0; -+ -+ mutex_lock(&gpio->lock); -+ -+ if (!phytium_sgpio_is_input(offset)) { -+ val = readl(gpio->regs + SGPIO_WDATA_REG(GPIO_GROUP(offset))); -+ rc = !!(val & GPIO_BIT(offset)); -+ mutex_unlock(&gpio->lock); -+ return rc; -+ } -+ -+ reinit_completion(&gpio->completion); -+ -+ /* Enable Rx */ -+ ctl0 = readl(gpio->regs + SGPIO_CTL0_REG); -+ writel(ctl0 & ~SGPIO_CTL0_REG_RX_DISABLE, gpio->regs + SGPIO_CTL0_REG); -+ -+ /* Start reading transaction and wait for completion */ -+ writel(readl(gpio->regs + SGPIO_CTL1_REG) | SGPIO_CTL1_REG_W_UPDATA, -+ gpio->regs + SGPIO_CTL1_REG); -+ if (!wait_for_completion_timeout(&gpio->completion, msecs_to_jiffies(1000))) { -+ rc = -EINVAL; -+ goto err; -+ } -+ -+ val = readl(gpio->regs + SGPIO_RDATA_REG(GPIO_GROUP(offset))); -+ rc = !!(val & GPIO_BIT(offset)); -+ -+err: -+ /* Disalbe Rx to hold the value */ -+ writel(ctl0 | SGPIO_CTL0_REG_RX_DISABLE, gpio->regs + SGPIO_CTL0_REG); -+ mutex_unlock(&gpio->lock); -+ -+ return rc; -+} -+ -+static void phytium_sgpio_set(struct gpio_chip *gc, unsigned int offset, int val) -+{ -+ struct phytium_sgpio *gpio = gpiochip_get_data(gc); -+ -+ mutex_lock(&gpio->lock); -+ -+ sgpio_set_value(gc, offset, val); -+ -+ mutex_unlock(&gpio->lock); -+} -+ -+static irqreturn_t phytium_sgpio_irq_handler(int irq, void *data) -+{ -+ struct phytium_sgpio *gpio = data; -+ -+ if (!readl(gpio->regs + SGPIO_IRQ_REG)) -+ return IRQ_NONE; -+ -+ /* Clear the interrupt */ -+ writel(0, gpio->regs + SGPIO_IRQ_REG); -+ -+ /* Check if tx/rx has been done */ -+ if (!(readl(gpio->regs + SGPIO_CTL1_REG) & SGPIO_CTL1_REG_OP_STATE)) -+ complete(&gpio->completion); -+ -+ return IRQ_HANDLED; -+} -+ -+static int phytium_sgpio_probe(struct platform_device *pdev) -+{ -+ u32 pclk_freq, sclk_freq, clk_div; -+ struct phytium_sgpio *gpio; -+ struct resource *res; -+ struct device *dev = &pdev->dev; -+ int rc; -+ -+ gpio = devm_kzalloc(dev, sizeof(*gpio), GFP_KERNEL); -+ if (!gpio) -+ return -ENOMEM; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ gpio->regs = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(gpio->regs)) -+ return PTR_ERR(gpio->regs); -+ -+ if (devm_request_irq(dev, platform_get_irq(pdev, 0), -+ phytium_sgpio_irq_handler, -+ IRQF_SHARED, dev_name(dev), gpio)) { -+ dev_err(dev, "failed to request IRQ\n"); -+ return -ENOENT; -+ } -+ -+ rc = fwnode_property_read_u32(dev_fwnode(dev), "ngpios", &gpio->ngpios); -+ if (rc < 0) { -+ dev_err(dev, "Could not read ngpios property\n"); -+ return -EINVAL; -+ } else if (gpio->ngpios % 32) { -+ dev_err(&pdev->dev, "Number of GPIOs not multiple of 32: %d\n", -+ gpio->ngpios); -+ return -EINVAL; -+ } -+ -+ rc = fwnode_property_read_u32(dev_fwnode(dev), "bus-frequency", &sclk_freq); -+ if (rc < 0) { -+ dev_err(dev, "Could not read bus-frequency property\n"); -+ return -EINVAL; -+ } -+ -+ if (has_acpi_companion(dev)) { -+ device_property_read_u32(dev, "pclk_freq", &pclk_freq); -+ if (!pclk_freq || (pclk_freq != 50000000)) { -+ dev_err(dev, "Could not get APB clock property from acpi, use default clk!\n"); -+ pclk_freq = DEFAULT_CLK; -+ } -+ -+ } else { -+ gpio->pclk = devm_clk_get(dev, NULL); -+ if (IS_ERR(gpio->pclk)) { -+ dev_err(dev, "Could not get the APB clock property\n"); -+ return PTR_ERR(gpio->pclk); -+ } -+ rc = clk_prepare_enable(gpio->pclk); -+ if (rc) { -+ dev_err(dev, "failed to enable pclk: %d\n", rc); -+ return rc; -+ } -+ pclk_freq = clk_get_rate(gpio->pclk); -+ } -+ -+ /* -+ * From the datasheet: -+ * (pclk / 2) / (clk_div + 1) = sclk -+ */ -+ if (sclk_freq == 0) { -+ dev_err(dev, "SCLK should not be 0\n"); -+ return -EINVAL; -+ } -+ -+ clk_div = (pclk_freq / (sclk_freq * 2)) - 1; -+ if (clk_div > (1 << 20) - 1) { -+ dev_err(dev, "clk_div is overflow\n"); -+ return -EINVAL; -+ } -+ -+ writel(FIELD_PREP(SGPIO_CTL0_REG_CLK_DIV_NUM, clk_div) | -+ FIELD_PREP(SGPIO_CTL0_REG_L3_L0, DEFAULT_L3_L0) | -+ SGPIO_CTL0_REG_RX_DISABLE | SGPIO_CTL0_REG_ENABLE, -+ gpio->regs + SGPIO_CTL0_REG); -+ -+ writel(FIELD_PREP(SGPIO_CTL1_REG_BIT_NUM, gpio->ngpios) | -+ SGPIO_CTL1_REG_READY, gpio->regs + SGPIO_CTL1_REG); -+ -+ mutex_init(&gpio->lock); -+ init_completion(&gpio->completion); -+ platform_set_drvdata(pdev, gpio); -+ -+ gpio->gc.parent = dev; -+ gpio->gc.base = -1; -+ gpio->gc.ngpio = gpio->ngpios * 2; -+ gpio->gc.label = dev_name(dev); -+ gpio->gc.direction_input = phytium_sgpio_direction_input; -+ gpio->gc.direction_output = phytium_sgpio_direction_output; -+ gpio->gc.get_direction = phytium_sgpio_get_direction; -+ gpio->gc.get = phytium_sgpio_get; -+ gpio->gc.set = phytium_sgpio_set; -+ -+ return devm_gpiochip_add_data(dev, &gpio->gc, gpio); -+} -+ -+static const struct of_device_id phytium_sgpio_of_match[] = { -+ { .compatible = "phytium,sgpio", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_sgpio_of_match); -+ -+static const struct acpi_device_id phytium_sgpio_acpi_match[] = { -+ { "PHYT0031", 0}, -+ {}, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_sgpio_acpi_match); -+ -+static struct platform_driver phytium_sgpio_driver = { -+ .driver = { -+ .name = KBUILD_MODNAME, -+ .of_match_table = of_match_ptr(phytium_sgpio_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_sgpio_acpi_match), -+ }, -+ .probe = phytium_sgpio_probe, -+}; -+module_platform_driver(phytium_sgpio_driver); -+ -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium SGPIO driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/gpu/drm/Kconfig b/drivers/gpu/drm/Kconfig -index ec4abf9ff..d1cad875d 100644 ---- a/drivers/gpu/drm/Kconfig -+++ b/drivers/gpu/drm/Kconfig -@@ -388,6 +388,8 @@ source "drivers/gpu/drm/solomon/Kconfig" - - source "drivers/gpu/drm/sprd/Kconfig" - -+source "drivers/gpu/drm/phytium/Kconfig" -+ - config DRM_HYPERV - tristate "DRM Support for Hyper-V synthetic video device" - depends on DRM && PCI && MMU && HYPERV -diff --git a/drivers/gpu/drm/Makefile b/drivers/gpu/drm/Makefile -index 215e78e79..a670c0d95 100644 ---- a/drivers/gpu/drm/Makefile -+++ b/drivers/gpu/drm/Makefile -@@ -198,3 +198,4 @@ obj-$(CONFIG_DRM_HYPERV) += hyperv/ - obj-y += solomon/ - obj-$(CONFIG_DRM_SPRD) += sprd/ - obj-$(CONFIG_DRM_LOONGSON) += loongson/ -+obj-$(CONFIG_DRM_PHYTIUM) += phytium/ -diff --git a/drivers/gpu/drm/amd/display/Kconfig b/drivers/gpu/drm/amd/display/Kconfig -index 901d1961b..74d45d9ae 100644 ---- a/drivers/gpu/drm/amd/display/Kconfig -+++ b/drivers/gpu/drm/amd/display/Kconfig -@@ -8,7 +8,7 @@ config DRM_AMD_DC - depends on BROKEN || !CC_IS_CLANG || ARM64 || RISCV || SPARC64 || X86_64 - select SND_HDA_COMPONENT if SND_HDA_CORE - # !CC_IS_CLANG: https://github.com/ClangBuiltLinux/linux/issues/1752 -- select DRM_AMD_DC_FP if (X86 || LOONGARCH || (PPC64 && ALTIVEC) || (ARM64 && KERNEL_MODE_NEON && !CC_IS_CLANG)) -+ select DRM_AMD_DC_FP if (X86 || LOONGARCH || (PPC64 && ALTIVEC) || (ARM64 && KERNEL_MODE_NEON)) - help - Choose this option if you want to use the new display engine - support for AMDGPU. This adds required support for Vega and -diff --git a/drivers/gpu/drm/phytium/Kconfig b/drivers/gpu/drm/phytium/Kconfig -new file mode 100644 -index 000000000..d83759146 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/Kconfig -@@ -0,0 +1,12 @@ -+config DRM_PHYTIUM -+ tristate "DRM Support for Phytium Graphics Card" -+ depends on DRM -+ select FB_IOMEM_HELPERS -+ select DRM_KMS_HELPER -+ select DRM_DISPLAY_HELPER -+ select DRM_DISPLAY_DP_HELPER -+ select DRM_DISPLAY_HDCP_HELPER -+ select BACKLIGHT_CLASS_DEVICE -+ help -+ Choose this option if you have a phytium graphics card. -+ This driver provides kernel mode setting and buffer management to userspace. -diff --git a/drivers/gpu/drm/phytium/Makefile b/drivers/gpu/drm/phytium/Makefile -new file mode 100644 -index 000000000..2dc7ea111 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/Makefile -@@ -0,0 +1,18 @@ -+phytium-dc-drm-y := phytium_display_drv.o \ -+ phytium_plane.o \ -+ phytium_crtc.o \ -+ phytium_dp.o \ -+ phytium_fb.o \ -+ phytium_gem.o \ -+ phytium_fbdev.o \ -+ phytium_debugfs.o \ -+ px210_dp.o \ -+ phytium_panel.o \ -+ px210_dc.o \ -+ phytium_pci.o \ -+ pe220x_dp.o \ -+ pe220x_dc.o \ -+ phytium_platform.o -+ -+obj-$(CONFIG_DRM_PHYTIUM) += phytium-dc-drm.o -+CFLAGS_REMOVE_phytium_crtc.o += -mgeneral-regs-only -diff --git a/drivers/gpu/drm/phytium/pe220x_dc.c b/drivers/gpu/drm/phytium/pe220x_dc.c -new file mode 100644 -index 000000000..b465dbb61 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/pe220x_dc.c -@@ -0,0 +1,255 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium Pe220x display controller DRM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "pe220x_reg.h" -+#include "phytium_crtc.h" -+#include "phytium_plane.h" -+#include "phytium_fb.h" -+#include "phytium_gem.h" -+ -+void pe220x_dc_hw_disable(struct drm_crtc *crtc); -+ -+static const unsigned int pe220x_primary_formats[] = { -+ DRM_FORMAT_ARGB2101010, -+ DRM_FORMAT_ABGR2101010, -+ DRM_FORMAT_RGBA1010102, -+ DRM_FORMAT_BGRA1010102, -+ DRM_FORMAT_ARGB8888, -+ DRM_FORMAT_ABGR8888, -+ DRM_FORMAT_RGBA8888, -+ DRM_FORMAT_BGRA8888, -+ DRM_FORMAT_XRGB8888, -+ DRM_FORMAT_XBGR8888, -+ DRM_FORMAT_RGBX8888, -+ DRM_FORMAT_BGRX8888, -+ DRM_FORMAT_ARGB4444, -+ DRM_FORMAT_ABGR4444, -+ DRM_FORMAT_RGBA4444, -+ DRM_FORMAT_BGRA4444, -+ DRM_FORMAT_XRGB4444, -+ DRM_FORMAT_XBGR4444, -+ DRM_FORMAT_RGBX4444, -+ DRM_FORMAT_BGRX4444, -+ DRM_FORMAT_ARGB1555, -+ DRM_FORMAT_ABGR1555, -+ DRM_FORMAT_RGBA5551, -+ DRM_FORMAT_BGRA5551, -+ DRM_FORMAT_XRGB1555, -+ DRM_FORMAT_XBGR1555, -+ DRM_FORMAT_RGBX5551, -+ DRM_FORMAT_BGRX5551, -+ DRM_FORMAT_RGB565, -+ DRM_FORMAT_BGR565, -+ DRM_FORMAT_YUYV, -+ DRM_FORMAT_UYVY, -+ DRM_FORMAT_NV16, -+ DRM_FORMAT_NV12, -+ DRM_FORMAT_NV21, -+}; -+ -+static uint64_t pe220x_primary_formats_modifiers[] = { -+ DRM_FORMAT_MOD_LINEAR, -+ DRM_FORMAT_MOD_INVALID -+}; -+ -+static uint64_t pe220x_cursor_formats_modifiers[] = { -+ DRM_FORMAT_MOD_LINEAR, -+ DRM_FORMAT_MOD_INVALID -+}; -+ -+static const unsigned int pe220x_cursor_formats[] = { -+ DRM_FORMAT_ARGB8888, -+}; -+ -+void pe220x_dc_hw_vram_init(struct phytium_display_private *priv, resource_size_t vram_addr, -+ resource_size_t vram_size) -+{ -+ uint32_t config; -+ uint32_t group_offset = priv->address_transform_base; -+ -+ phytium_writel_reg(priv, (vram_addr & SRC_ADDR_MASK) >> SRC_ADDR_OFFSET, -+ group_offset, PE220X_DC_ADDRESS_TRANSFORM_SRC_ADDR); -+ phytium_writel_reg(priv, (vram_size >> SIZE_OFFSET) | ADDRESS_TRANSFORM_ENABLE, -+ group_offset, PE220X_DC_ADDRESS_TRANSFORM_SIZE); -+ config = phytium_readl_reg(priv, group_offset, PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR); -+ phytium_writel_reg(priv, config, group_offset, PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR); -+} -+ -+void pe220x_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ int ret = 0; -+ -+ /* config pix clock */ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_PIXEL_CLOCK | (clock & PIXEL_CLOCK_MASK), -+ 0, PE220X_DC_CMD_REGISTER(phys_pipe)); -+ ret = phytium_wait_cmd_done(priv, PE220X_DC_CMD_REGISTER(phys_pipe), -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to set pixel clock\n", __func__); -+} -+ -+void pe220x_dc_hw_reset(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int config = 0; -+ int phys_pipe = phytium_crtc->phys_pipe; -+ -+ /* disable pixel clock for bmc mode */ -+ if (phys_pipe == 0) -+ pe220x_dc_hw_disable(crtc); -+ -+ config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); -+ config &= (~(DC0_CORE_RESET | DC1_CORE_RESET | AXI_RESET | AHB_RESET)); -+ -+ if (phys_pipe == 0) { -+ phytium_writel_reg(priv, config | DC0_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET | AHB_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ } else { -+ phytium_writel_reg(priv, config | DC1_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET | AHB_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET, -+ 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ } -+} -+ -+void pe220x_dc_hw_disable(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int config = 0; -+ int phys_pipe = phytium_crtc->phys_pipe; -+ -+ /* clear framebuffer */ -+ phytium_writel_reg(priv, CLEAR_VALUE_BLACK, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE); -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ config |= FRAMEBUFFER_CLEAR; -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ -+ /* disable cursor */ -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); -+ config = ((config & (~CURSOR_FORMAT_MASK)) | CURSOR_FORMAT_DISABLED); -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); -+ mdelay(20); -+ -+ /* reset pix clock */ -+ pe220x_dc_hw_config_pix_clock(crtc, 0); -+ -+ if (phys_pipe == 0) { -+ config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, config | DC0_CORE_RESET, 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config & (~DC0_CORE_RESET), 0, PE220X_DC_CLOCK_CONTROL); -+ } else { -+ config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, config | DC1_CORE_RESET, 0, PE220X_DC_CLOCK_CONTROL); -+ udelay(20); -+ phytium_writel_reg(priv, config & (~DC1_CORE_RESET), 0, PE220X_DC_CLOCK_CONTROL); -+ } -+ udelay(20); -+} -+ -+int pe220x_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count) -+{ -+ int ret = 0; -+ -+ if (mode_cmd->modifier[count] != DRM_FORMAT_MOD_LINEAR) { -+ DRM_ERROR("unsupported fb modifier 0x%llx\n", mode_cmd->modifier[count]); -+ ret = -EINVAL; -+ } -+ -+ return ret; -+} -+ -+void pe220x_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count) -+{ -+ *format_modifiers = pe220x_primary_formats_modifiers; -+ *formats = pe220x_primary_formats; -+ *format_count = ARRAY_SIZE(pe220x_primary_formats); -+} -+ -+void pe220x_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count) -+{ -+ *format_modifiers = pe220x_cursor_formats_modifiers; -+ *formats = pe220x_cursor_formats; -+ *format_count = ARRAY_SIZE(pe220x_cursor_formats); -+} -+ -+void pe220x_dc_hw_update_primary_hi_addr(struct drm_plane *plane) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ int phys_pipe = phytium_plane->phys_pipe; -+ -+ phytium_writel_reg(priv, (phytium_plane->iova[0] >> PREFIX_SHIFT) & PREFIX_MASK, -+ priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_Y_HI_ADDRESS); -+ -+ phytium_writel_reg(priv, (phytium_plane->iova[1] >> U_PREFIX_SHIFT) & U_PREFIX_MASK, -+ priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_U_HI_ADDRESS); -+ -+ phytium_writel_reg(priv, (phytium_plane->iova[2] >> V_PREFIX_SHIFT) & V_PREFIX_MASK, -+ priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_V_HI_ADDRESS); -+} -+ -+void pe220x_dc_hw_update_cursor_hi_addr(struct drm_plane *plane, uint64_t iova) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ int phys_pipe = phytium_plane->phys_pipe; -+ int config; -+ -+ config = ((iova >> CURSOR_PREFIX_SHIFT) & CURSOR_PREFIX_MASK); -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PE220X_DC_CURSOR_HI_ADDRESS); -+} -diff --git a/drivers/gpu/drm/phytium/pe220x_dc.h b/drivers/gpu/drm/phytium/pe220x_dc.h -new file mode 100644 -index 000000000..5840795cb ---- /dev/null -+++ b/drivers/gpu/drm/phytium/pe220x_dc.h -@@ -0,0 +1,31 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium Pe220x display controller DRM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PE220X_DC_H__ -+#define __PE220X_DC_H__ -+ -+#define PE220X_DC_PIX_CLOCK_MAX (594000) -+#define PE220X_DC_HDISPLAY_MAX 3840 -+#define PE220X_DC_VDISPLAY_MAX 2160 -+#define PE220X_DC_ADDRESS_MASK 0x7f -+ -+extern void pe220x_dc_hw_vram_init(struct phytium_display_private *priv, -+ resource_size_t vram_addr, -+ resource_size_t vram_size); -+extern void pe220x_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock); -+extern void pe220x_dc_hw_disable(struct drm_crtc *crtc); -+extern int pe220x_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count); -+extern void pe220x_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+extern void pe220x_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+extern void pe220x_dc_hw_update_primary_hi_addr(struct drm_plane *plane); -+extern void pe220x_dc_hw_update_cursor_hi_addr(struct drm_plane *plane, uint64_t iova); -+void pe220x_dc_hw_reset(struct drm_crtc *crtc); -+#endif /* __PE220X_DC_H__ */ -diff --git a/drivers/gpu/drm/phytium/pe220x_dp.c b/drivers/gpu/drm/phytium/pe220x_dp.c -new file mode 100644 -index 000000000..b56484361 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/pe220x_dp.c -@@ -0,0 +1,508 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium display port DRM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "pe220x_reg.h" -+#include "phytium_dp.h" -+#include "pe220x_dp.h" -+ -+static uint8_t pe220x_dp_source_lane_count[2] = {1, 1}; -+ -+/* [reg][ling_rate 1.62->8.1] */ -+static int vco_val[12][4] = { -+ {0x0509, 0x0509, 0x0509, 0x0509}, /* CP_PADJ */ -+ {0x0f00, 0x0f00, 0x0f00, 0x0f00}, /* CP_IADJ */ -+ {0x0F08, 0x0F08, 0x0F08, 0x0F08}, /* FILT_PADJ */ -+ {0x0061, 0x006C, 0x006C, 0x0051}, /* INTDIV */ -+ {0x3333, 0x0000, 0x0000, 0x0000}, /* FRACDIVL */ -+ {0x0000, 0x0000, 0x0000, 0x0000}, /* FRACDIVH */ -+ {0x0042, 0x0048, 0x0048, 0x0036}, /* HIGH_THR */ -+ {0x0002, 0x0002, 0x0002, 0x0002}, /* PDIAG_CTRL */ -+ {0x0c5e, 0x0c5e, 0x0c5e, 0x0c5e}, /* VCOCAL_PLLCNT_START */ -+ {0x00c7, 0x00c7, 0x00c7, 0x00c7}, /* LOCK_PEFCNT */ -+ {0x00c7, 0x00c7, 0x00c7, 0x00c7}, /* LOCK_PLLCNT_START */ -+ {0x0005, 0x0005, 0x0005, 0x0005}, /* LOCK_PLLCNT_THR */ -+}; -+ -+/* [link_rate][swing][emphasis] */ -+static int mgnfs_val[4][4][4] = { -+ /* 1.62Gbps */ -+ { -+ {0x0026, 0x001f, 0x0012, 0x0000}, -+ {0x0013, 0x0013, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 2.7Gbps */ -+ { -+ {0x0026, 0x001f, 0x0012, 0x0000}, -+ {0x0013, 0x0013, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 5.4Gbps */ -+ { -+ {0x001f, 0x0013, 0x005, 0x0000}, -+ {0x0018, 0x006, 0x0000, 0x0000}, -+ {0x000c, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 8.1Gbps */ -+ { -+ {0x0026, 0x0013, 0x005, 0x0000}, -+ {0x0013, 0x006, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+}; -+ -+/* [link_rate][swing][emphasis] */ -+static int cpost_val[4][4][4] = { -+ /* 1.62Gbps */ -+ { -+ {0x0000, 0x0014, 0x0020, 0x002a}, -+ {0x0000, 0x0010, 0x001f, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 2.7Gbps */ -+ { -+ {0x0000, 0x0014, 0x0020, 0x002a}, -+ {0x0000, 0x0010, 0x001f, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 5.4Gbps */ -+ { -+ {0x0005, 0x0014, 0x0022, 0x002e}, -+ {0x0000, 0x0013, 0x0020, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ /* 8.1Gbps */ -+ { -+ {0x0000, 0x0014, 0x0022, 0x002e}, -+ {0x0000, 0x0013, 0x0020, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+}; -+ -+static int pe220x_dp_hw_set_phy_lane_and_rate(struct phytium_dp_device *phytium_dp, -+ uint8_t link_lane_count, uint32_t link_rate) -+{ -+ int port = phytium_dp->port%2; -+ int i = 0, data, tmp, tmp1, index = 0, mask = 0; -+ int timeout = 500, ret = 0; -+ -+ /* set pma powerdown */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (A3_POWERDOWN3 << (i * A3_POWERDOWN3_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); -+ -+ /* lane pll disable */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) { -+ data |= (PLL_EN << (i * PLL_EN_SHIFT)); -+ mask |= (((1<source_max_lane_count; i++) -+ data |= (PLL_EN << (i * PLL_EN_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_EN(port), data); -+ -+ /* set pma power active */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (A0_ACTIVE << (i * A0_ACTIVE_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); -+ -+ mask = PLL0_LOCK_DONE; -+ do { -+ mdelay(1); -+ timeout--; -+ tmp = phytium_phy_readl(phytium_dp, PE220X_PHY_PMA_CONTROL2(port)); -+ } while ((!(tmp & mask)) && timeout); -+ -+ if (timeout == 0) { -+ DRM_ERROR("dp(%d) phy pll lock failed\n", port); -+ ret = -1; -+ } -+ udelay(1); -+ -+ return ret; -+} -+ -+static void pe220x_dp_hw_set_phy_lane_setting(struct phytium_dp_device *phytium_dp, -+ uint32_t link_rate, uint8_t train_set) -+{ -+ int port = phytium_dp->port % 3; -+ int voltage_swing = 0; -+ int pre_emphasis = 0, link_rate_index = 0; -+ -+ switch (train_set & DP_TRAIN_VOLTAGE_SWING_MASK) { -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_1: -+ voltage_swing = 1; -+ break; -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_2: -+ voltage_swing = 2; -+ break; -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_3: -+ voltage_swing = 3; -+ break; -+ default: -+ voltage_swing = 0; -+ break; -+ } -+ -+ switch (train_set & DP_TRAIN_PRE_EMPHASIS_MASK) { -+ case DP_TRAIN_PRE_EMPH_LEVEL_1: -+ pre_emphasis = 1; -+ break; -+ case DP_TRAIN_PRE_EMPH_LEVEL_2: -+ pre_emphasis = 2; -+ break; -+ case DP_TRAIN_PRE_EMPH_LEVEL_3: -+ pre_emphasis = 3; -+ break; -+ default: -+ pre_emphasis = 0; -+ break; -+ } -+ -+ switch (link_rate) { -+ case 810000: -+ link_rate_index = 3; -+ break; -+ case 540000: -+ link_rate_index = 2; -+ break; -+ case 270000: -+ link_rate_index = 1; -+ break; -+ case 162000: -+ link_rate_index = 0; -+ break; -+ default: -+ DRM_ERROR("phytium dp rate(%d) not support\n", link_rate); -+ link_rate_index = 2; -+ break; -+ } -+ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DIAG_ACYA(port), LOCK); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_TXCC_CTRL(port), TX_TXCC_CTRL); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DRV(port), TX_DRV); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_MGNFS(port), -+ mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_CPOST(port), -+ cpost_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DIAG_ACYA(port), UNLOCK); -+} -+ -+static int pe220x_dp_hw_init_phy(struct phytium_dp_device *phytium_dp) -+{ -+ int port = phytium_dp->port; -+ int i = 0, data, tmp, mask; -+ int timeout = 500, ret = 0; -+ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_APB_RESET(port), APB_RESET); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PIPE_RESET(port), RESET); -+ -+ /* config lane to dp mode */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (LANE_BIT << (i * LANE_BIT_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_MODE(port), data); -+ -+ /* pll clock enable */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (PLL_EN << (i * PLL_EN_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_EN(port), data); -+ -+ /* config input 20 bit */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (BIT_20 << (i * BIT_20_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PMA_WIDTH(port), data); -+ -+ /* config lane active power state */ -+ data = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) -+ data |= (A0_ACTIVE << (i * A0_ACTIVE_SHIFT)); -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); -+ -+ /* link reset */ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_LINK_RESET(port), LINK_RESET); -+ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_SGMII_DPSEL_INIT(port), DP_SEL); -+ -+ /* config single link */ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_CFG(port), SINGLE_LINK); -+ -+ /* pipe reset */ -+ phytium_phy_writel(phytium_dp, PE220X_PHY_PIPE_RESET(port), RESET_DEASSERT); -+ -+ mask = PLL0_LOCK_DONE; -+ do { -+ mdelay(1); -+ timeout--; -+ tmp = phytium_phy_readl(phytium_dp, PE220X_PHY_PMA_CONTROL2(port)); -+ } while ((!(tmp & mask)) && timeout); -+ -+ if (timeout == 0) { -+ DRM_ERROR("reset dp(%d) phy failed\n", port); -+ ret = -1; -+ } -+ udelay(1); -+ -+ return ret; -+} -+ -+static void pe220x_dp_hw_poweron_panel(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret = 0; -+ -+ gpiod_set_value(priv->edp_power_en, 1); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to poweron panel\n", __func__); -+} -+ -+static void pe220x_dp_hw_poweroff_panel(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret = 0; -+ -+ gpiod_set_value(priv->edp_power_en, 0); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to poweroff panel\n", __func__); -+} -+ -+static void pe220x_dp_hw_enable_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct pwm_state state; -+ int ret = 0; -+ -+ pwm_get_state(phytium_dp->pwm, &state); -+ state.enabled = true; -+ pwm_set_relative_duty_cycle(&state, 50, 100); -+ ret = pwm_apply_state(phytium_dp->pwm, &state); -+ -+ gpiod_set_value(priv->edp_bl_en, 1); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to enable backlight\n", __func__); -+} -+ -+static void pe220x_dp_hw_disable_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret = 0; -+ -+ gpiod_set_value(priv->edp_bl_en, 0); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to disable backlight, ret = %d\n", __func__, ret); -+} -+ -+static uint32_t pe220x_dp_hw_get_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct pwm_state state; -+ uint32_t level; -+ -+ pwm_get_state(phytium_dp->pwm, &state); -+ level = pwm_get_relative_duty_cycle(&state, 100); -+ return level; -+} -+ -+static int pe220x_dp_hw_set_backlight(struct phytium_dp_device *phytium_dp, uint32_t level) -+{ -+ struct pwm_state state; -+ int ret = 0; -+ -+ if (level > PE220X_DP_BACKLIGHT_MAX) { -+ ret = -EINVAL; -+ goto out; -+ } -+ pwm_get_state(phytium_dp->pwm, &state); -+ state.enabled = true; -+ state.period = phytium_dp->pwm->args.period; -+ if (state.period == 0) -+ DRM_ERROR("%s: set pwm period to 0\n", __func__); -+ -+ pwm_set_relative_duty_cycle(&state, level, 100); -+ -+ ret = pwm_apply_state(phytium_dp->pwm, &state); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to set backlight\n", __func__); -+out: -+ return ret; -+} -+ -+bool pe220x_dp_hw_spread_is_enable(struct phytium_dp_device *phytium_dp) -+{ -+ return false; -+} -+ -+int pe220x_dp_hw_reset(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, DP_RESET, group_offset, PE220X_DP_CONTROLLER_RESET); -+ udelay(500); -+ phytium_writel_reg(priv, AUX_CLK_DIVIDER_100, group_offset, PHYTIUM_DP_AUX_CLK_DIVIDER); -+ phytium_writel_reg(priv, SUPPORT_EDP_1_4, group_offset, PHYTIUM_EDP_CRC_ENABLE); -+ -+ return 0; -+} -+ -+uint8_t pe220x_dp_hw_get_source_lane_count(struct phytium_dp_device *phytium_dp) -+{ -+ return pe220x_dp_source_lane_count[phytium_dp->port]; -+} -+ -+static struct phytium_dp_func pe220x_dp_funcs = { -+ .dp_hw_get_source_lane_count = pe220x_dp_hw_get_source_lane_count, -+ .dp_hw_reset = pe220x_dp_hw_reset, -+ .dp_hw_spread_is_enable = pe220x_dp_hw_spread_is_enable, -+ .dp_hw_set_backlight = pe220x_dp_hw_set_backlight, -+ .dp_hw_get_backlight = pe220x_dp_hw_get_backlight, -+ .dp_hw_disable_backlight = pe220x_dp_hw_disable_backlight, -+ .dp_hw_enable_backlight = pe220x_dp_hw_enable_backlight, -+ .dp_hw_poweroff_panel = pe220x_dp_hw_poweroff_panel, -+ .dp_hw_poweron_panel = pe220x_dp_hw_poweron_panel, -+ .dp_hw_init_phy = pe220x_dp_hw_init_phy, -+ .dp_hw_set_phy_lane_setting = pe220x_dp_hw_set_phy_lane_setting, -+ .dp_hw_set_phy_lane_and_rate = pe220x_dp_hw_set_phy_lane_and_rate, -+}; -+ -+void pe220x_dp_func_register(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_dp->funcs = &pe220x_dp_funcs; -+} -diff --git a/drivers/gpu/drm/phytium/pe220x_dp.h b/drivers/gpu/drm/phytium/pe220x_dp.h -new file mode 100644 -index 000000000..f9cf8a0d4 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/pe220x_dp.h -@@ -0,0 +1,15 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium display port DRM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PE220X_DP_H__ -+#define __PE220X_DP_H__ -+ -+#define PE220X_DP_BACKLIGHT_MAX 99 -+#define PE220X_DP_BACKLIGHT_MIN 2 -+ -+void pe220x_dp_func_register(struct phytium_dp_device *phytium_dp); -+#endif /* __PE220X_DP_H__ */ -diff --git a/drivers/gpu/drm/phytium/pe220x_reg.h b/drivers/gpu/drm/phytium/pe220x_reg.h -new file mode 100644 -index 000000000..696be3006 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/pe220x_reg.h -@@ -0,0 +1,209 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium Pe220x display engine register -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PE220X_REG_H__ -+#define __PE220X_REG_H__ -+ -+#include "phytium_reg.h" -+ -+/* dc register */ -+#define PE220X_DC_CLOCK_CONTROL 0x0000 -+#define DC1_CORE_RESET (1<<18) -+#define DC0_CORE_RESET (1<<17) -+#define AXI_RESET (1<<16) -+#define AHB_RESET (1<<12) -+ -+#define PE220X_DC_CMD_REGISTER(pipe) (PE220X_DC_BASE(0) + 0x00F0 + 0x4*(pipe)) -+#define FLAG_REPLY (1<<31) -+#define FLAG_REQUEST (1<<30) -+#define CMD_PIXEL_CLOCK (0x0 << 28) -+#define CMD_BACKLIGHT (0x1 << 28) -+#define CMD_DC_DP_RESET (0x3 << 28) -+#define BACKLIGHT_SHIFT 21 -+#define BACKLIGHT_MASK 0x7f -+#define BACKLIGHT_MAX 100 -+#define BACKLIGHT_ENABLE (101 << BACKLIGHT_SHIFT) -+#define BACKLIGHT_DISABLE (102 << BACKLIGHT_SHIFT) -+#define PANEL_POWER_ENABLE (103 << BACKLIGHT_SHIFT) -+#define PANEL_POWER_DISABLE (104 << BACKLIGHT_SHIFT) -+#define PIXEL_CLOCK_MASK (0x1fffff) -+ -+#define PE220X_DC_FRAMEBUFFER_Y_HI_ADDRESS 0x1404 -+#define PREFIX_MASK 0xff -+#define PREFIX_SHIFT 32 -+ -+#define PE220X_DC_CURSOR_HI_ADDRESS 0x1490 -+#define CURSOR_PREFIX_MASK 0xff -+#define CURSOR_PREFIX_SHIFT 32 -+ -+#define PE220X_DC_FRAMEBUFFER_U_HI_ADDRESS 0x1534 -+#define U_PREFIX_MASK 0xff -+#define U_PREFIX_SHIFT 32 -+ -+#define PE220X_DC_FRAMEBUFFER_V_HI_ADDRESS 0x153c -+#define V_PREFIX_MASK 0xff -+#define V_PREFIX_SHIFT 32 -+ -+/* dp register */ -+#define PE220X_DP_CONTROLLER_RESET 0x0850 -+#define DP_RESET 0x1 -+ -+/* address transform register */ -+#define PE220X_DC_ADDRESS_TRANSFORM_SRC_ADDR 0x0 -+#define SRC_ADDR_OFFSET 22 -+#define SRC_ADDR_MASK 0xffffffffff -+ -+#define PE220X_DC_ADDRESS_TRANSFORM_SIZE 0x4 -+#define ADDRESS_TRANSFORM_ENABLE (0x1 << 31) -+#define SIZE_OFFSET 22 -+ -+#define PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR 0x8 -+#define DST_ADDR_OFFSET 22 -+ -+#define PE220X_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS 0x48 -+#define DC_DP_RESET_STATUS(pipe) (1 << pipe) -+#define DP_SPREAD_ENABLE(pipe) (0x8 << pipe) -+ -+#define PE220X_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE 0x4c -+#define BACKLIGHT_VALUE_MASK (0x7f) -+#define BACKLIGHT_VALUE_SHIFT 16 -+ -+/* phy register start */ -+#define PE220X_PHY_BASE(pipe) (0x100000*pipe) -+ -+#define PE220X_PHY_PIPE_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40254) -+#define RESET 0x0 -+#define RESET_DEASSERT 0x1 -+ -+#define PE220X_PHY_MODE(pipe) (PE220X_PHY_BASE(pipe) + 0x40034) -+#define LANE_BIT (0x3) -+#define LANE_BIT_SHIFT 0x2 -+ -+#define PE220X_PHY_LINK_CFG(pipe) (PE220X_PHY_BASE(pipe) + 0x40044) -+#define LANE_MASTER 0x1 -+#define LANE_MASTER_SHIFT 1 -+ -+#define PE220X_PHY_PLL_EN(pipe) (PE220X_PHY_BASE(pipe) + 0x40214) -+#define PLL_EN 0x1 -+#define PLL_EN_SHIFT 1 -+ -+#define PE220X_PHY_PMA_WIDTH(pipe) (PE220X_PHY_BASE(pipe) + 0x4021c) -+#define BIT_20 0x5 -+#define BIT_20_SHIFT 4 -+ -+#define PE220X_PHY_PLL_SOURCE_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0x4004C) -+ -+#define PE220X_PHY_PMA0_POWER(pipe) (PE220X_PHY_BASE(pipe) + 0x402bc) -+#define A0_ACTIVE 0x1 -+#define A0_ACTIVE_SHIFT 8 -+#define A3_POWERDOWN3 0x8 -+#define A3_POWERDOWN3_SHIFT 8 -+ -+#define PE220X_PHY_LINK_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40258) -+#define LINK_RESET 0x1 -+#define LINK_RESET_MASK 0x1 -+#define LINTK_RESET_SHIFT 0x1 -+ -+#define PE220X_PHY_SGMII_DPSEL_INIT(pipe) (PE220X_PHY_BASE(pipe) + 0x40260) -+#define DP_SEL 0x1 -+ -+#define PE220X_PHY_APB_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40250) -+#define APB_RESET 0x1 -+ -+/* phy origin register */ -+#define PE220X_PHY_PLL_CFG(pipe) (PE220X_PHY_BASE(pipe) + 0x30038) -+#define SINGLE_LINK 0x0 -+ -+#define PE220X_PHY_PMA_CONTROL(pipe) (PE220X_PHY_BASE(pipe) + 0x3800c) -+#define CONTROL_ENABLE 0x1 -+#define CONTROL_ENABLE_MASK 0x1 -+#define CONTROL_ENABLE_SHIFT 0x1 -+ -+#define PE220X_PHY_PMA_CONTROL2(pipe) (PE220X_PHY_BASE(pipe) + 0x38004) -+#define PLL0_LOCK_DONE (0x1 << 6) -+ -+#define PE220X_PHY_PLL0_CLK_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0X684) -+#define PLL_LINK_RATE_162000 0xf01 -+#define PLL_LINK_RATE_270000 0x701 -+#define PLL_LINK_RATE_540000 0x301 -+#define PLL_LINK_RATE_810000 0x200 -+ -+#define PE220X_PHY_HSCLK0_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0x18398) -+#define HSCLK_LINK_0 0x0 -+#define HSCLK_LINK_1 0x1 -+ -+#define PE220X_PHY_HSCLK0_DIV(pipe) (PE220X_PHY_BASE(pipe) + 0x1839c) -+#define HSCLK_LINK_RATE_162000 0x2 -+#define HSCLK_LINK_RATE_270000 0x1 -+#define HSCLK_LINK_RATE_540000 0x0 -+#define HSCLK_LINK_RATE_810000 0x0 -+ -+#define PE220X_PHY_PLLDRC0_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x18394) -+#define PLLDRC_LINK0 0x1 -+#define PLLDRC_LINK1 0x9 -+ -+#define PE220X_PHY_PLL0_DSM_M0(pipe) (PE220X_PHY_BASE(pipe) + 0x250) -+#define PLL0_DSM_M0 0x4 -+#define PE220X_PHY_PLL0_VCOCAL_START(pipe) (PE220X_PHY_BASE(pipe) + 0x218) -+#define PLL0_VCOCAL_START 0xc5e -+#define PE220X_PHY_PLL0_VCOCAL_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x208) -+#define PLL0_VCOCAL_CTRL 0x3 -+ -+#define PE220X_PHY_PLL0_CP_PADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x690) -+#define PE220X_PHY_PLL0_CP_IADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x694) -+#define PE220X_PHY_PLL0_CP_FILT_PADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x698) -+#define PE220X_PHY_PLL0_INTDIV(pipe) (PE220X_PHY_BASE(pipe) + 0x240) -+#define PE220X_PHY_PLL0_FRACDIVL(pipe) (PE220X_PHY_BASE(pipe) + 0x244) -+#define PE220X_PHY_PLL0_FRACDIVH(pipe) (PE220X_PHY_BASE(pipe) + 0x248) -+#define PE220X_PHY_PLL0_HIGH_THR(pipe) (PE220X_PHY_BASE(pipe) + 0x24c) -+#define PE220X_PHY_PLL0_PDIAG_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x680) -+#define PE220X_PHY_PLL0_VCOCAL_PLLCNT_START(pipe) (PE220X_PHY_BASE(pipe) + 0x220) -+#define PE220X_PHY_PLL0_LOCK_PEFCNT(pipe) (PE220X_PHY_BASE(pipe) + 0x270) -+#define PE220X_PHY_PLL0_LOCK_PLLCNT_START(pipe) (PE220X_PHY_BASE(pipe) + 0x278) -+#define PE220X_PHY_PLL0_LOCK_PLLCNT_THR(pipe) (PE220X_PHY_BASE(pipe) + 0x27c) -+ -+#define PE220X_PHY_PLL0_TX_PSC_A0(pipe) (PE220X_PHY_BASE(pipe) + 0x18400) -+#define PLL0_TX_PSC_A0 0xfb -+#define PE220X_PHY_PLL0_TX_PSC_A2(pipe) (PE220X_PHY_BASE(pipe) + 0x18408) -+#define PLL0_TX_PSC_A2 0x4aa -+#define PE220X_PHY_PLL0_TX_PSC_A3(pipe) (PE220X_PHY_BASE(pipe) + 0x1840c) -+#define PLL0_TX_PSC_A3 0x4aa -+#define PE220X_PHY_PLL0_RX_PSC_A0(pipe) (PE220X_PHY_BASE(pipe) + 0x28000) -+#define PLL0_RX_PSC_A0 0x0 -+#define PE220X_PHY_PLL0_RX_PSC_A2(pipe) (PE220X_PHY_BASE(pipe) + 0x28008) -+#define PLL0_RX_PSC_A2 0x0 -+#define PE220X_PHY_PLL0_RX_PSC_A3(pipe) (PE220X_PHY_BASE(pipe) + 0x2800C) -+#define PLL0_RX_PSC_A3 0x0 -+#define PE220X_PHY_PLL0_RX_PSC_CAL(pipe) (PE220X_PHY_BASE(pipe) + 0x28018) -+#define PLL0_RX_PSC_CAL 0x0 -+ -+#define PE220X_PHY_PLL0_XCVR_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x183a8) -+#define PLL0_XCVR_CTRL 0xf -+ -+#define PE220X_PHY_PLL0_RX_GCSM1_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28420) -+#define PLL0_RX_GCSM1_CTRL 0x0 -+#define PE220X_PHY_PLL0_RX_GCSM2_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28440) -+#define PLL0_RX_GCSM2_CTRL 0x0 -+#define PE220X_PHY_PLL0_RX_PERGCSM_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28460) -+#define PLL0_RX_PERGCSM_CTRL 0x0 -+ -+/* swing and emphasis */ -+#define PE220X_PHY_PLL0_TX_DIAG_ACYA(pipe) (PE220X_PHY_BASE(pipe) + 0x1879c) -+#define LOCK 1 -+#define UNLOCK 0 -+ -+#define PE220X_PHY_PLL0_TX_TXCC_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x18100) -+#define TX_TXCC_CTRL 0x8a4 -+ -+#define PE220X_PHY_PLL0_TX_DRV(pipe) (PE220X_PHY_BASE(pipe) + 0x18318) -+#define TX_DRV 0x3 -+ -+#define PE220X_PHY_PLL0_TX_MGNFS(pipe) (PE220X_PHY_BASE(pipe) + 0x18140) -+ -+#define PE220X_PHY_PLL0_TX_CPOST(pipe) (PE220X_PHY_BASE(pipe) + 0x18130) -+ -+#endif /* __PE220X_REG_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_crtc.c b/drivers/gpu/drm/phytium/phytium_crtc.c -new file mode 100644 -index 000000000..8adc1c6e1 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_crtc.c -@@ -0,0 +1,828 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_crtc.h" -+#include "phytium_plane.h" -+#include "phytium_dp.h" -+#include "px210_dc.h" -+#include "pe220x_dc.h" -+#include "phytium_reg.h" -+ -+#define MAXKERNELSIZE 9 -+#define SUBPIXELINDEXBITS 5 -+#define SUBPIXELCOUNT (1 << SUBPIXELINDEXBITS) -+#define SUBPIXELLOADCOUNT (SUBPIXELCOUNT / 2 + 1) -+#define WEIGHTSTATECOUNT (((SUBPIXELLOADCOUNT * MAXKERNELSIZE + 1) & ~1) / 2) -+#define KERNELTABLESIZE (SUBPIXELLOADCOUNT * MAXKERNELSIZE * sizeof(uint16_t)) -+#define PHYALIGN(n, align) (((n) + ((align) - 1)) & ~((align) - 1)) -+#define KERNELSTATES (PHYALIGN(KERNELTABLESIZE + 4, 8)) -+#define PHYPI 3.14159265358979323846f -+ -+#define MATH_Add(X, Y) ((float)((X) + (Y))) -+#define MATH_Multiply(X, Y) ((float)((X) * (Y))) -+#define MATH_Divide(X, Y) ((float)((X) / (Y))) -+#define MATH_DivideFromUInteger(X, Y) ((float)(X) / (float)(Y)) -+#define MATH_I2Float(X) ((float)(X)) -+ -+struct filter_blit_array { -+ uint8_t kernelSize; -+ uint32_t scaleFactor; -+ uint32_t *kernelStates; -+}; -+ -+static uint32_t dc_scaling_get_factor(uint32_t src_size, uint32_t dst_size) -+{ -+ uint32_t factor = 0; -+ -+ factor = ((src_size - 1) << SCALE_FACTOR_SRC_OFFSET) / (dst_size - 1); -+ -+ return factor; -+} -+ -+static float dc_sint(float x) -+{ -+ const float B = 1.2732395477; -+ const float C = -0.4052847346; -+ const float P = 0.2310792853; -+ float y; -+ -+ if (x < 0) -+ y = B*x - C*x*x; -+ else -+ y = B*x + C*x*x; -+ if (y < 0) -+ y = P * (y * (0 - y) - y) + y; -+ else -+ y = P * (y * y - y) + y; -+ return y; -+} -+ -+static float dc_sinc_filter(float x, int radius) -+{ -+ float pit, pitd, f1, f2, result; -+ float f_radius = MATH_I2Float(radius); -+ -+ if (x == 0.0f) { -+ result = 1.0f; -+ } else if ((x < -f_radius) || (x > f_radius)) { -+ result = 0.0f; -+ } else { -+ pit = MATH_Multiply(PHYPI, x); -+ pitd = MATH_Divide(pit, f_radius); -+ f1 = MATH_Divide(dc_sint(pit), pit); -+ f2 = MATH_Divide(dc_sint(pitd), pitd); -+ result = MATH_Multiply(f1, f2); -+ } -+ -+ return result; -+} -+ -+static int dc_calculate_sync_table( -+ uint8_t kernel_size, -+ uint32_t src_size, -+ uint32_t dst_size, -+ struct filter_blit_array *kernel_info) -+{ -+ uint32_t scale_factor; -+ float f_scale; -+ int kernel_half; -+ float f_subpixel_step; -+ float f_subpixel_offset; -+ uint32_t subpixel_pos; -+ int kernel_pos; -+ int padding; -+ uint16_t *kernel_array; -+ int range = 0; -+ -+ do { -+ /* Compute the scale factor. */ -+ scale_factor = dc_scaling_get_factor(src_size, dst_size); -+ -+ /* Same kernel size and ratio as before? */ -+ if ((kernel_info->kernelSize == kernel_size) && -+ (kernel_info->scaleFactor == kernel_size)) { -+ break; -+ } -+ -+ /* check the array */ -+ if (kernel_info->kernelStates == NULL) -+ break; -+ -+ /* Store new parameters. */ -+ kernel_info->kernelSize = kernel_size; -+ kernel_info->scaleFactor = scale_factor; -+ -+ /* Compute the scale factor. */ -+ f_scale = MATH_DivideFromUInteger(dst_size, src_size); -+ -+ /* Adjust the factor for magnification. */ -+ if (f_scale > 1.0f) -+ f_scale = 1.0f; -+ -+ /* Calculate the kernel half. */ -+ kernel_half = (int) (kernel_info->kernelSize >> 1); -+ -+ /* Calculate the subpixel step. */ -+ f_subpixel_step = MATH_Divide(1.0f, MATH_I2Float(SUBPIXELCOUNT)); -+ -+ /* Init the subpixel offset. */ -+ f_subpixel_offset = 0.5f; -+ -+ /* Determine kernel padding size. */ -+ padding = (MAXKERNELSIZE - kernel_info->kernelSize) / 2; -+ -+ /* Set initial kernel array pointer. */ -+ kernel_array = (uint16_t *) (kernel_info->kernelStates + 1); -+ -+ /* Loop through each subpixel. */ -+ for (subpixel_pos = 0; subpixel_pos < SUBPIXELLOADCOUNT; subpixel_pos++) { -+ /* Define a temporary set of weights. */ -+ float fSubpixelSet[MAXKERNELSIZE]; -+ -+ /* Init the sum of all weights for the current subpixel. */ -+ float fWeightSum = 0.0f; -+ uint16_t weightSum = 0; -+ short int adjustCount, adjustFrom; -+ short int adjustment; -+ -+ /* Compute weights. */ -+ for (kernel_pos = 0; kernel_pos < MAXKERNELSIZE; kernel_pos++) { -+ /* Determine the current index. */ -+ int index = kernel_pos - padding; -+ -+ /* Pad with zeros. */ -+ if ((index < 0) || (index >= kernel_info->kernelSize)) { -+ fSubpixelSet[kernel_pos] = 0.0f; -+ } else { -+ if (kernel_info->kernelSize == 1) { -+ fSubpixelSet[kernel_pos] = 1.0f; -+ } else { -+ /* Compute the x position for filter function. */ -+ float fX = MATH_Add( -+ MATH_I2Float(index - kernel_half), -+ f_subpixel_offset); -+ fX = MATH_Multiply(fX, f_scale); -+ -+ /* Compute the weight. */ -+ fSubpixelSet[kernel_pos] = dc_sinc_filter(fX, -+ kernel_half); -+ } -+ -+ /* Update the sum of weights. */ -+ fWeightSum = MATH_Add(fWeightSum, -+ fSubpixelSet[kernel_pos]); -+ } -+ } -+ -+ /* Adjust weights so that the sum will be 1.0. */ -+ for (kernel_pos = 0; kernel_pos < MAXKERNELSIZE; kernel_pos++) { -+ /* Normalize the current weight. */ -+ float fWeight = MATH_Divide(fSubpixelSet[kernel_pos], -+ fWeightSum); -+ -+ /* Convert the weight to fixed point and store in the table. */ -+ if (fWeight == 0.0f) -+ kernel_array[kernel_pos] = 0x0000; -+ else if (fWeight >= 1.0f) -+ kernel_array[kernel_pos] = 0x4000; -+ else if (fWeight <= -1.0f) -+ kernel_array[kernel_pos] = 0xC000; -+ else -+ kernel_array[kernel_pos] = -+ (int16_t) MATH_Multiply(fWeight, 16384.0f); -+ weightSum += kernel_array[kernel_pos]; -+ } -+ -+ /* Adjust the fixed point coefficients. */ -+ adjustCount = 0x4000 - weightSum; -+ if (adjustCount < 0) { -+ adjustCount = -adjustCount; -+ adjustment = -1; -+ } else { -+ adjustment = 1; -+ } -+ -+ adjustFrom = (MAXKERNELSIZE - adjustCount) / 2; -+ for (kernel_pos = 0; kernel_pos < adjustCount; kernel_pos++) { -+ range = (MAXKERNELSIZE*subpixel_pos + adjustFrom + kernel_pos) * -+ sizeof(uint16_t); -+ if ((range >= 0) && (range < KERNELTABLESIZE)) -+ kernel_array[adjustFrom + kernel_pos] += adjustment; -+ else -+ DRM_ERROR("%s failed\n", __func__); -+ } -+ -+ kernel_array += MAXKERNELSIZE; -+ -+ /* Advance to the next subpixel. */ -+ f_subpixel_offset = MATH_Add(f_subpixel_offset, -f_subpixel_step); -+ } -+ } while (0); -+ -+ return 0; -+} -+ -+static void phytium_dc_scaling_config(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_state) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct drm_display_mode *mode = &crtc->state->adjusted_mode; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ uint32_t scale_factor_x, scale_factor_y, i; -+ uint32_t kernelStates[128]; -+ struct filter_blit_array kernel_info_width; -+ void *tmp = NULL; -+ -+ if (mode->hdisplay != mode->crtc_hdisplay || mode->vdisplay != mode->crtc_vdisplay) { -+ phytium_crtc->src_width = mode->hdisplay; -+ phytium_crtc->src_height = mode->vdisplay; -+ phytium_crtc->dst_width = mode->crtc_hdisplay; -+ phytium_crtc->dst_height = mode->crtc_vdisplay; -+ -+ phytium_crtc->dst_x = (mode->crtc_hdisplay - phytium_crtc->dst_width) / 2; -+ phytium_crtc->dst_y = (mode->crtc_vdisplay - phytium_crtc->dst_height) / 2; -+ -+ scale_factor_x = dc_scaling_get_factor(phytium_crtc->src_width, -+ phytium_crtc->dst_width); -+ scale_factor_y = dc_scaling_get_factor(phytium_crtc->src_height, -+ phytium_crtc->dst_height); -+ if (scale_factor_y > (SCALE_FACTOR_Y_MAX << SCALE_FACTOR_SRC_OFFSET)) -+ scale_factor_y = (SCALE_FACTOR_Y_MAX << SCALE_FACTOR_SRC_OFFSET); -+ -+ phytium_writel_reg(priv, scale_factor_x & SCALE_FACTOR_X_MASK, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_X); -+ phytium_writel_reg(priv, scale_factor_y & SCALE_FACTOR_Y_MASK, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_Y); -+ phytium_writel_reg(priv, FRAMEBUFFER_TAP, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALECONFIG); -+ -+ tmp = kmalloc(KERNELSTATES, GFP_KERNEL); -+ if (!tmp) { -+ DRM_ERROR("malloc %ld failed\n", KERNELSTATES); -+ return; -+ } -+ -+ memset(&kernel_info_width, 0, sizeof(struct filter_blit_array)); -+ kernel_info_width.kernelStates = tmp; -+ memset(kernel_info_width.kernelStates, 0, KERNELSTATES); -+ kernel_neon_begin(); -+ dc_calculate_sync_table(FRAMEBUFFER_HORIZONTAL_FILTER_TAP, -+ phytium_crtc->src_width, -+ phytium_crtc->dst_width, -+ &kernel_info_width); -+ memset(kernelStates, 0, sizeof(kernelStates)); -+ memcpy(kernelStates, kernel_info_width.kernelStates + 1, KERNELSTATES - 4); -+ kernel_neon_end(); -+ phytium_writel_reg(priv, HORI_FILTER_INDEX, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER_INDEX); -+ for (i = 0; i < 128; i++) { -+ phytium_writel_reg(priv, kernelStates[i], -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER); -+ } -+ -+ memset(&kernel_info_width, 0, sizeof(struct filter_blit_array)); -+ kernel_info_width.kernelStates = tmp; -+ memset(kernel_info_width.kernelStates, 0, KERNELSTATES); -+ kernel_neon_begin(); -+ dc_calculate_sync_table(FRAMEBUFFER_FILTER_TAP, phytium_crtc->src_height, -+ phytium_crtc->dst_height, &kernel_info_width); -+ memset(kernelStates, 0, sizeof(kernelStates)); -+ memcpy(kernelStates, kernel_info_width.kernelStates + 1, KERNELSTATES - 4); -+ kernel_neon_end(); -+ phytium_writel_reg(priv, VERT_FILTER_INDEX, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER_INDEX); -+ for (i = 0; i < 128; i++) -+ phytium_writel_reg(priv, kernelStates[i], -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER); -+ phytium_writel_reg(priv, INITIALOFFSET, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_INITIALOFFSET); -+ kfree(tmp); -+ phytium_crtc->scale_enable = true; -+ } else { -+ phytium_crtc->scale_enable = false; -+ } -+} -+ -+static void phytium_crtc_gamma_set(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ uint32_t config = 0, data; -+ struct drm_crtc_state *state = crtc->state; -+ struct drm_color_lut *lut; -+ unsigned long flags; -+ uint32_t active_line = 0, timeout = 500; -+ int i; -+ -+ if (state->gamma_lut) { -+ if (WARN((state->gamma_lut->length/sizeof(struct drm_color_lut) != GAMMA_INDEX_MAX), -+ "gamma size is not match\n")) -+ return; -+ lut = (struct drm_color_lut *)state->gamma_lut->data; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ if (config & FRAMEBUFFER_OUTPUT) { -+ struct drm_display_mode *mode = &state->adjusted_mode; -+ uint32_t frame_time; -+ uint32_t value_a, value_b; -+ -+ frame_time = mode->crtc_vtotal * mode->crtc_htotal / mode->crtc_clock; -+ value_b = (frame_time - 2) * mode->crtc_vtotal; -+ local_irq_save(flags); -+ do { -+ active_line = phytium_readl_reg(priv, group_offset, -+ PHYTIUM_DC_LOCATION); -+ active_line = active_line >> LOVATION_Y_SHIFT; -+ value_a = (mode->crtc_vblank_end - mode->crtc_vblank_start + -+ active_line) * frame_time; -+ if (value_a < value_b) -+ break; -+ local_irq_restore(flags); -+ udelay(1000); -+ timeout--; -+ local_irq_save(flags); -+ } while (timeout); -+ -+ if (timeout == 0) -+ DRM_ERROR("wait gamma active line timeout\n"); -+ } -+ -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DC_GAMMA_INDEX); -+ for (i = 0; i < GAMMA_INDEX_MAX; i++) { -+ data = ((lut[i].red >> 6) & GAMMA_RED_MASK) << GAMMA_RED_SHIFT; -+ data |= (((lut[i].green >> 6) & GAMMA_GREEN_MASK) << GAMMA_GREEN_SHIFT); -+ data |= (((lut[i].blue >> 6) & GAMMA_BLUE_MASK) << GAMMA_BLUE_SHIFT); -+ phytium_writel_reg(priv, data, group_offset, PHYTIUM_DC_GAMMA_DATA); -+ } -+ -+ if (config & FRAMEBUFFER_OUTPUT) -+ local_irq_restore(flags); -+ } -+} -+ -+static void phytium_crtc_gamma_init(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ struct drm_crtc_state *state = crtc->state; -+ uint32_t config = 0, data; -+ uint16_t *red, *green, *blue; -+ unsigned long flags; -+ uint32_t active_line = 0, timeout = 500; -+ int i; -+ -+ if (WARN((crtc->gamma_size != GAMMA_INDEX_MAX), "gamma size is not match\n")) -+ return; -+ -+ red = crtc->gamma_store; -+ green = red + crtc->gamma_size; -+ blue = green + crtc->gamma_size; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ if (config & FRAMEBUFFER_OUTPUT) { -+ struct drm_display_mode *mode = &state->adjusted_mode; -+ uint32_t frame_time; -+ uint32_t value_a, value_b; -+ -+ frame_time = mode->crtc_vtotal * mode->crtc_htotal / mode->crtc_clock; -+ value_b = (frame_time - 2) * mode->crtc_vtotal; -+ local_irq_save(flags); -+ do { -+ active_line = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_LOCATION); -+ active_line = active_line >> LOVATION_Y_SHIFT; -+ value_a = (mode->crtc_vblank_end - mode->crtc_vblank_start + -+ active_line) * frame_time; -+ if (value_a < value_b) -+ break; -+ local_irq_restore(flags); -+ udelay(1000); -+ timeout--; -+ local_irq_save(flags); -+ } while (timeout); -+ -+ if (timeout == 0) -+ DRM_ERROR("wait gamma active line timeout\n"); -+ } -+ -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DC_GAMMA_INDEX); -+ for (i = 0; i < GAMMA_INDEX_MAX; i++) { -+ data = ((*red++ >> 6) & GAMMA_RED_MASK) << GAMMA_RED_SHIFT; -+ data |= (((*green++ >> 6) & GAMMA_GREEN_MASK) << GAMMA_GREEN_SHIFT); -+ data |= (((*blue++ >> 6) & GAMMA_BLUE_MASK) << GAMMA_BLUE_SHIFT); -+ phytium_writel_reg(priv, data, group_offset, PHYTIUM_DC_GAMMA_DATA); -+ } -+ -+ if (config & FRAMEBUFFER_OUTPUT) -+ local_irq_restore(flags); -+} -+ -+static void phytium_crtc_destroy(struct drm_crtc *crtc) -+{ -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ -+ drm_crtc_cleanup(crtc); -+ kfree(phytium_crtc); -+} -+ -+struct drm_crtc_state * -+phytium_crtc_atomic_duplicate_state(struct drm_crtc *crtc) -+{ -+ struct phytium_crtc_state *phytium_crtc_state = NULL; -+ -+ phytium_crtc_state = kmemdup(crtc->state, sizeof(*phytium_crtc_state), -+ GFP_KERNEL); -+ if (!phytium_crtc_state) -+ return NULL; -+ __drm_atomic_helper_crtc_duplicate_state(crtc, -+ &phytium_crtc_state->base); -+ -+ return &phytium_crtc_state->base; -+} -+ -+void -+phytium_crtc_atomic_destroy_state(struct drm_crtc *crtc, -+ struct drm_crtc_state *state) -+{ -+ struct phytium_crtc_state *phytium_crtc_state = -+ to_phytium_crtc_state(state); -+ -+ phytium_crtc_state = to_phytium_crtc_state(state); -+ __drm_atomic_helper_crtc_destroy_state(state); -+ kfree(phytium_crtc_state); -+} -+ -+static int phytium_enable_vblank(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ -+ phytium_writel_reg(priv, INT_ENABLE, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_INT_ENABLE); -+ -+ return 0; -+} -+ -+static void phytium_disable_vblank(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ -+ phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_INT_ENABLE); -+} -+ -+static const struct drm_crtc_funcs phytium_crtc_funcs = { -+ .set_config = drm_atomic_helper_set_config, -+ .destroy = phytium_crtc_destroy, -+ .page_flip = drm_atomic_helper_page_flip, -+ .reset = drm_atomic_helper_crtc_reset, -+ .atomic_duplicate_state = phytium_crtc_atomic_duplicate_state, -+ .atomic_destroy_state = phytium_crtc_atomic_destroy_state, -+ .enable_vblank = phytium_enable_vblank, -+ .disable_vblank = phytium_disable_vblank, -+}; -+ -+static void -+phytium_crtc_atomic_enable(struct drm_crtc *crtc, -+ struct drm_atomic_state *state) -+{ -+ struct drm_crtc_state *old_state = drm_atomic_get_old_crtc_state(state, crtc); -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct drm_display_mode *mode = &crtc->state->adjusted_mode; -+ struct drm_connector_state *new_conn_state; -+ struct drm_connector *conn; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ int config = 0, i = 0; -+ -+ for_each_new_connector_in_state(state, conn, new_conn_state, i) { -+ if (new_conn_state->crtc != crtc) -+ continue; -+ -+ switch (conn->display_info.bpc) { -+ case 10: -+ phytium_crtc->bpc = DP_RGB101010; -+ break; -+ case 6: -+ phytium_crtc->bpc = DP_RGB666; -+ break; -+ default: -+ phytium_crtc->bpc = DP_RGB888; -+ break; -+ } -+ } -+ -+ /* config pix clock */ -+ phytium_crtc->dc_hw_config_pix_clock(crtc, mode->clock); -+ -+ phytium_dc_scaling_config(crtc, old_state); -+ config = ((mode->crtc_hdisplay & HDISPLAY_END_MASK) << HDISPLAY_END_SHIFT) -+ | ((mode->crtc_htotal&HDISPLAY_TOTAL_MASK) << HDISPLAY_TOTAL_SHIFT); -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_HDISPLAY); -+ config = ((mode->crtc_hsync_start & HSYNC_START_MASK) << HSYNC_START_SHIFT) -+ | ((mode->crtc_hsync_end & HSYNC_END_MASK) << HSYNC_END_SHIFT) -+ | HSYNC_PULSE_ENABLED; -+ config |= (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : HSYNC_NEGATIVE; -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_HSYNC); -+ config = ((mode->crtc_vdisplay & VDISPLAY_END_MASK) << VDISPLAY_END_SHIFT) -+ | ((mode->crtc_vtotal & VDISPLAY_TOTAL_MASK) << VDISPLAY_TOTAL_SHIFT); -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_VDISPLAY); -+ config = ((mode->crtc_vsync_start & VSYNC_START_MASK) << VSYNC_START_SHIFT) -+ | ((mode->crtc_vsync_end & VSYNC_END_MASK) << VSYNC_END_SHIFT) -+ | VSYNC_PULSE_ENABLED; -+ config |= (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : VSYNC_NEGATIVE; -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_VSYNC); -+ config = PANEL_DATAENABLE_ENABLE | PANEL_DATA_ENABLE | PANEL_CLOCK_ENABLE; -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_PANEL_CONFIG); -+ config = phytium_crtc->bpc | OUTPUT_DP; -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_DP_CONFIG); -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ -+ if (crtc->state->active) -+ config |= FRAMEBUFFER_OUTPUT | FRAMEBUFFER_RESET; -+ else -+ config &= (~(FRAMEBUFFER_OUTPUT | FRAMEBUFFER_RESET)); -+ -+ if (phytium_crtc->scale_enable) -+ config |= FRAMEBUFFER_SCALE_ENABLE; -+ else -+ config &= (~FRAMEBUFFER_SCALE_ENABLE); -+ -+ config |= FRAMEBUFFER_GAMMA_ENABLE; -+ -+ if (crtc->state->gamma_lut) -+ phytium_crtc_gamma_set(crtc); -+ else -+ phytium_crtc_gamma_init(crtc); -+ -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ drm_crtc_vblank_on(crtc); -+} -+ -+static void -+phytium_crtc_atomic_disable(struct drm_crtc *crtc, -+ struct drm_atomic_state *state) -+{ -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ -+ drm_crtc_vblank_off(crtc); -+ phytium_crtc->dc_hw_disable(crtc); -+} -+ -+static void phytium_crtc_update_timing_for_drm_display_mode(struct drm_display_mode *drm_mode, -+ const struct drm_display_mode *native_mode) -+{ -+ if (native_mode->clock == drm_mode->clock && -+ native_mode->htotal == drm_mode->htotal && -+ native_mode->vtotal == drm_mode->vtotal) { -+ drm_mode->crtc_hdisplay = native_mode->crtc_hdisplay; -+ drm_mode->crtc_vdisplay = native_mode->crtc_vdisplay; -+ drm_mode->crtc_clock = native_mode->crtc_clock; -+ drm_mode->crtc_hblank_start = native_mode->crtc_hblank_start; -+ drm_mode->crtc_hblank_end = native_mode->crtc_hblank_end; -+ drm_mode->crtc_hsync_start = native_mode->crtc_hsync_start; -+ drm_mode->crtc_hsync_end = native_mode->crtc_hsync_end; -+ drm_mode->crtc_htotal = native_mode->crtc_htotal; -+ drm_mode->crtc_hskew = native_mode->crtc_hskew; -+ drm_mode->crtc_vblank_start = native_mode->crtc_vblank_start; -+ drm_mode->crtc_vblank_end = native_mode->crtc_vblank_end; -+ drm_mode->crtc_vsync_start = native_mode->crtc_vsync_start; -+ drm_mode->crtc_vsync_end = native_mode->crtc_vsync_end; -+ drm_mode->crtc_vtotal = native_mode->crtc_vtotal; -+ } -+} -+ -+static int -+phytium_crtc_atomic_check(struct drm_crtc *crtc, struct drm_atomic_state *state) -+{ -+ struct drm_crtc_state *crtc_state = drm_atomic_get_new_crtc_state(state, crtc); -+ struct drm_plane_state *new_plane_state = NULL; -+ int ret = 0; -+ struct drm_connector *connector; -+ struct drm_connector_state *new_con_state; -+ uint32_t i; -+ struct phytium_dp_device *phytium_dp = NULL; -+ -+ for_each_new_connector_in_state(state, connector, new_con_state, i) { -+ if (new_con_state->crtc == crtc) { -+ phytium_dp = connector_to_dp_device(connector); -+ break; -+ } -+ } -+ if (phytium_dp) -+ phytium_crtc_update_timing_for_drm_display_mode(&crtc_state->adjusted_mode, -+ &phytium_dp->native_mode); -+ -+ new_plane_state = drm_atomic_get_new_plane_state(crtc_state->state, -+ crtc->primary); -+ if (crtc_state->enable && new_plane_state && !new_plane_state->crtc) { -+ ret = -EINVAL; -+ goto fail; -+ } -+ -+ return 0; -+fail: -+ return ret; -+} -+ -+static void -+phytium_crtc_atomic_begin(struct drm_crtc *crtc, -+ struct drm_atomic_state *state) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe, config; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ if (config & FRAMEBUFFER_RESET) { -+ phytium_writel_reg(priv, config | FRAMEBUFFER_VALID_PENDING, -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ } -+} -+ -+static void phytium_crtc_atomic_flush(struct drm_crtc *crtc, -+ struct drm_atomic_state *state) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ struct phytium_crtc_state *phytium_crtc_state = NULL; -+ int phys_pipe = phytium_crtc->phys_pipe, config; -+ uint32_t group_offset = priv->dc_reg_base[phys_pipe]; -+ -+ DRM_DEBUG_KMS("crtc->state active:%d enable:%d\n", -+ crtc->state->active, crtc->state->enable); -+ phytium_crtc_state = to_phytium_crtc_state(crtc->state); -+ -+ if (crtc->state->color_mgmt_changed) -+ phytium_crtc_gamma_set(crtc); -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ phytium_writel_reg(priv, config&(~FRAMEBUFFER_VALID_PENDING), -+ group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ -+ if (crtc->state->event) { -+ DRM_DEBUG_KMS("vblank->refcount:%d\n", -+ atomic_read(&dev->vblank[0].refcount)); -+ spin_lock_irq(&dev->event_lock); -+ if (drm_crtc_vblank_get(crtc) == 0) -+ drm_crtc_arm_vblank_event(crtc, crtc->state->event); -+ else -+ drm_crtc_send_vblank_event(crtc, crtc->state->event); -+ crtc->state->event = NULL; -+ spin_unlock_irq(&dev->event_lock); -+ } -+} -+ -+static enum drm_mode_status -+phytium_crtc_mode_valid(struct drm_crtc *crtc, const struct drm_display_mode *mode) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ if (mode->crtc_clock > priv->info.crtc_clock_max) -+ return MODE_CLOCK_HIGH; -+ -+ if (mode->hdisplay > priv->info.hdisplay_max) -+ return MODE_BAD_HVALUE; -+ -+ if (mode->vdisplay > priv->info.vdisplay_max) -+ return MODE_BAD_VVALUE; -+ -+ if (mode->flags & DRM_MODE_FLAG_INTERLACE) -+ return MODE_NO_INTERLACE; -+ -+ return MODE_OK; -+} -+ -+static const struct drm_crtc_helper_funcs phytium_crtc_helper_funcs = { -+ .mode_valid = phytium_crtc_mode_valid, -+ .atomic_check = phytium_crtc_atomic_check, -+ .atomic_begin = phytium_crtc_atomic_begin, -+ .atomic_flush = phytium_crtc_atomic_flush, -+ .atomic_enable = phytium_crtc_atomic_enable, -+ .atomic_disable = phytium_crtc_atomic_disable, -+}; -+ -+void phytium_crtc_resume(struct drm_device *drm_dev) -+{ -+ struct drm_crtc *crtc; -+ struct phytium_crtc *phytium_crtc = NULL; -+ -+ drm_for_each_crtc(crtc, drm_dev) { -+ phytium_crtc = to_phytium_crtc(crtc); -+ if (phytium_crtc->dc_hw_reset) -+ phytium_crtc->dc_hw_reset(crtc); -+ phytium_crtc_gamma_init(crtc); -+ } -+} -+ -+int phytium_crtc_init(struct drm_device *dev, int phys_pipe) -+{ -+ struct phytium_crtc *phytium_crtc; -+ struct phytium_crtc_state *phytium_crtc_state; -+ struct phytium_plane *phytium_primary_plane = NULL; -+ struct phytium_plane *phytium_cursor_plane = NULL; -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret; -+ -+ phytium_crtc = kzalloc(sizeof(*phytium_crtc), GFP_KERNEL); -+ if (!phytium_crtc) { -+ ret = -ENOMEM; -+ goto failed_malloc_crtc; -+ } -+ -+ phytium_crtc_state = kzalloc(sizeof(*phytium_crtc_state), GFP_KERNEL); -+ if (!phytium_crtc_state) { -+ ret = -ENOMEM; -+ goto failed_malloc_crtc_state; -+ } -+ -+ phytium_crtc_state->base.crtc = &phytium_crtc->base; -+ phytium_crtc->base.state = &phytium_crtc_state->base; -+ phytium_crtc->phys_pipe = phys_pipe; -+ -+ if (IS_PX210(priv)) { -+ phytium_crtc->dc_hw_config_pix_clock = px210_dc_hw_config_pix_clock; -+ phytium_crtc->dc_hw_disable = px210_dc_hw_disable; -+ phytium_crtc->dc_hw_reset = NULL; -+ priv->dc_reg_base[phys_pipe] = PX210_DC_BASE(phys_pipe); -+ priv->dcreq_reg_base[phys_pipe] = PX210_DCREQ_BASE(phys_pipe); -+ priv->address_transform_base = PX210_ADDRESS_TRANSFORM_BASE; -+ } else if (IS_PE220X(priv)) { -+ phytium_crtc->dc_hw_config_pix_clock = pe220x_dc_hw_config_pix_clock; -+ phytium_crtc->dc_hw_disable = pe220x_dc_hw_disable; -+ phytium_crtc->dc_hw_reset = pe220x_dc_hw_reset; -+ priv->dc_reg_base[phys_pipe] = PE220X_DC_BASE(phys_pipe); -+ priv->dcreq_reg_base[phys_pipe] = 0x0; -+ priv->address_transform_base = PE220X_ADDRESS_TRANSFORM_BASE; -+ } -+ -+ phytium_primary_plane = phytium_primary_plane_create(dev, phys_pipe); -+ if (IS_ERR(phytium_primary_plane)) { -+ ret = PTR_ERR(phytium_primary_plane); -+ DRM_ERROR("create primary plane failed, phys_pipe(%d)\n", phys_pipe); -+ goto failed_create_primary; -+ } -+ -+ phytium_cursor_plane = phytium_cursor_plane_create(dev, phys_pipe); -+ if (IS_ERR(phytium_cursor_plane)) { -+ ret = PTR_ERR(phytium_cursor_plane); -+ DRM_ERROR("create cursor plane failed, phys_pipe(%d)\n", phys_pipe); -+ goto failed_create_cursor; -+ } -+ -+ ret = drm_crtc_init_with_planes(dev, &phytium_crtc->base, -+ &phytium_primary_plane->base, -+ &phytium_cursor_plane->base, -+ &phytium_crtc_funcs, -+ "phys_pipe %d", phys_pipe); -+ -+ if (ret) { -+ DRM_ERROR("init crtc with plane failed, phys_pipe(%d)\n", phys_pipe); -+ goto failed_crtc_init; -+ } -+ drm_crtc_helper_add(&phytium_crtc->base, &phytium_crtc_helper_funcs); -+ drm_crtc_vblank_reset(&phytium_crtc->base); -+ drm_mode_crtc_set_gamma_size(&phytium_crtc->base, GAMMA_INDEX_MAX); -+ drm_crtc_enable_color_mgmt(&phytium_crtc->base, 0, false, GAMMA_INDEX_MAX); -+ if (phytium_crtc->dc_hw_reset) -+ phytium_crtc->dc_hw_reset(&phytium_crtc->base); -+ -+ return 0; -+ -+failed_crtc_init: -+failed_create_cursor: -+ /* drm_mode_config_cleanup() will free any crtcs/planes already initialized */ -+failed_create_primary: -+ kfree(phytium_crtc_state); -+failed_malloc_crtc_state: -+ kfree(phytium_crtc); -+failed_malloc_crtc: -+ return ret; -+} -diff --git a/drivers/gpu/drm/phytium/phytium_crtc.h b/drivers/gpu/drm/phytium/phytium_crtc.h -new file mode 100644 -index 000000000..8c5b2eb0e ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_crtc.h -@@ -0,0 +1,39 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_CRTC_H__ -+#define __PHYTIUM_CRTC_H__ -+ -+struct phytium_crtc { -+ struct drm_crtc base; -+ int phys_pipe; -+ unsigned int bpc; -+ -+ /* scale */ -+ uint32_t src_width; -+ uint32_t src_height; -+ uint32_t dst_width; -+ uint32_t dst_height; -+ uint32_t dst_x; -+ uint32_t dst_y; -+ bool scale_enable; -+ bool reserve[3]; -+ -+ void (*dc_hw_config_pix_clock)(struct drm_crtc *crtc, int clock); -+ void (*dc_hw_disable)(struct drm_crtc *crtc); -+ void (*dc_hw_reset)(struct drm_crtc *crtc); -+}; -+ -+struct phytium_crtc_state { -+ struct drm_crtc_state base; -+}; -+ -+#define to_phytium_crtc(x) container_of(x, struct phytium_crtc, base) -+#define to_phytium_crtc_state(x) container_of(x, struct phytium_crtc_state, base) -+ -+void phytium_crtc_resume(struct drm_device *drm_dev); -+int phytium_crtc_init(struct drm_device *dev, int pipe); -+#endif /* __PHYTIUM_CRTC_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_debugfs.c b/drivers/gpu/drm/phytium/phytium_debugfs.c -new file mode 100644 -index 000000000..8cd6c338d ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_debugfs.c -@@ -0,0 +1,456 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_dp.h" -+#include "phytium_reg.h" -+ -+const char *const mem_state[PHYTIUM_MEM_STATE_TYPE_COUNT] = { -+ "Memory_Vram_Total", -+ "Memory_Vram_Alloc", -+ "Memory_System_Carveout_Total", -+ "Memory_System_Carveout_Alloc", -+ "Memory_System_Alloc", -+}; -+ -+static ssize_t -+phytium_dp_register_write(struct file *filp, -+ const char __user *ubuf, -+ size_t len, -+ loff_t *ppos) -+{ -+ char tmp[16]; -+ -+ if (len >= sizeof(tmp)) -+ return -EINVAL; -+ -+ memset(tmp, 0, sizeof(tmp)); -+ if (copy_from_user(tmp, ubuf, len)) -+ return -EFAULT; -+ tmp[len] = '\0'; -+ -+ return len; -+} -+ -+static int phytium_dp_register_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_M_VID, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_M_VID)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_N_VID, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_N_VID)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_TRANSFER_UNIT_SIZE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_TRANSFER_UNIT_SIZE)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_DATA_COUNT, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_DATA_COUNT)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HTOTAL, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HTOTAL)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HRES, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HRES)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HSWIDTH, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HSWIDTH)); -+ seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HSTART, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HSTART)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VTOTAL, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VTOTAL)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VRES, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VRES)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VSWIDTH, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VSWIDTH)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VSTART, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VSTART)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_POLARITY, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_POLARITY)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_MISC0, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_MISC0)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_MISC1, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_MISC1)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_USER_SYNC_POLARITY, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_USER_SYNC_POLARITY)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_VIDEO_STREAM_ENABLE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SECONDARY_STREAM_ENABLE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE)); -+ seq_puts(m, "audio:\n"); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_INPUT_SELECT, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_INPUT_SELECT)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_DIRECT_CLKDIV, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_DIRECT_CLKDIV)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CHANNEL_COUNT, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CHANNEL_COUNT)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CHANNEL_MAP, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CHANNEL_MAP)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_DATA_WINDOW, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_CATEGORY_CODE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_CATEGORY_CODE)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_MAUD, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_MAUD)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_NAUD, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_NAUD)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CLOCK_MODE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CLOCK_MODE)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_SOURCE_FORMAT, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_SOURCE_FORMAT)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY)); -+ seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_AUDIO_ENABLE, -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE)); -+ -+ return 0; -+} -+ -+static int phytium_dp_register_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_dp_register_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_dp_register_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_dp_register_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = phytium_dp_register_write, -+}; -+ -+static ssize_t -+phytium_dp_trigger_train_fail_write(struct file *filp, -+ const char __user *ubuf, -+ size_t len, -+ loff_t *ppos) -+{ -+ struct seq_file *m = filp->private_data; -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ char tmp[16]; -+ -+ if (len >= sizeof(tmp)) -+ return -EINVAL; -+ -+ memset(tmp, 0, sizeof(tmp)); -+ if (copy_from_user(tmp, ubuf, len)) -+ return -EFAULT; -+ tmp[len] = '\0'; -+ -+ if (kstrtouint(tmp, 10, &phytium_dp->trigger_train_fail) != 0) -+ return -EINVAL; -+ -+ return len; -+} -+ -+static int phytium_dp_trigger_train_fail_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ seq_printf(m, "trigger_train_fail: %d\n", phytium_dp->trigger_train_fail); -+ seq_printf(m, "train_retry_count: %d\n", phytium_dp->train_retry_count); -+ -+ return 0; -+} -+ -+static int phytium_dp_trigger_train_fail_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_dp_trigger_train_fail_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_dp_trigger_train_fail_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_dp_trigger_train_fail_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = phytium_dp_trigger_train_fail_write, -+}; -+ -+static int phytium_edp_backlight_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ if (!phytium_dp->is_edp) -+ return -ENODEV; -+ -+ mutex_lock(&phytium_dp->panel.panel_lock); -+ seq_printf(m, "backlight: %s\n", phytium_dp->panel.backlight_enabled?"enabled":"disabled"); -+ mutex_unlock(&phytium_dp->panel.panel_lock); -+ -+ return 0; -+} -+ -+static int phytium_edp_backlight_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_edp_backlight_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_edp_backlight_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_edp_backlight_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+}; -+ -+static int phytium_edp_power_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ if (!phytium_dp->is_edp) -+ return -ENODEV; -+ -+ mutex_lock(&phytium_dp->panel.panel_lock); -+ seq_printf(m, "power: %s\n", phytium_dp->panel.power_enabled?"enabled":"disabled"); -+ mutex_unlock(&phytium_dp->panel.panel_lock); -+ -+ return 0; -+} -+ -+static int phytium_edp_power_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_edp_power_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_edp_power_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_edp_power_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+}; -+ -+struct dpcd_block { -+ /* DPCD dump start address. */ -+ unsigned int offset; -+ /* DPCD dump end address, inclusive. If unset, .size will be used. */ -+ unsigned int end; -+ /* DPCD dump size. Used if .end is unset. If unset, defaults to 1. */ -+ size_t size; -+ /* Only valid for eDP. */ -+ bool edp; -+}; -+ -+static const struct dpcd_block phytium_dpcd_debug[] = { -+ { .offset = DP_DPCD_REV, .size = DP_RECEIVER_CAP_SIZE }, -+ { .offset = DP_PSR_SUPPORT, .end = DP_PSR_CAPS }, -+ { .offset = DP_DOWNSTREAM_PORT_0, .size = 16 }, -+ { .offset = DP_LINK_BW_SET, .end = DP_EDP_CONFIGURATION_SET }, -+ { .offset = DP_SINK_COUNT, .end = DP_ADJUST_REQUEST_LANE2_3 }, -+ { .offset = DP_SET_POWER }, -+ { .offset = DP_EDP_DPCD_REV }, -+ { .offset = DP_EDP_GENERAL_CAP_1, .end = DP_EDP_GENERAL_CAP_3 }, -+ { .offset = DP_EDP_DISPLAY_CONTROL_REGISTER, .end = DP_EDP_BACKLIGHT_FREQ_CAP_MAX_LSB }, -+ { .offset = DP_EDP_DBC_MINIMUM_BRIGHTNESS_SET, .end = DP_EDP_DBC_MAXIMUM_BRIGHTNESS_SET }, -+ { .offset = DP_DEVICE_SERVICE_IRQ_VECTOR, .size = 1 }, -+ { .offset = DP_TEST_REQUEST, .end = DP_TEST_PATTERN }, -+}; -+ -+static int phytium_dpcd_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ uint8_t buf[16], i; -+ ssize_t err; -+ -+ if (connector->status != connector_status_connected) -+ return -ENODEV; -+ -+ for (i = 0; i < ARRAY_SIZE(phytium_dpcd_debug); i++) { -+ const struct dpcd_block *b = &phytium_dpcd_debug[i]; -+ size_t size = b->end ? b->end - b->offset + 1 : (b->size ?: 1); -+ -+ if (WARN_ON(size > sizeof(buf))) -+ continue; -+ -+ err = drm_dp_dpcd_read(&phytium_dp->aux, b->offset, buf, size); -+ if (err <= 0) { -+ DRM_ERROR("dpcd read (%zu bytes at %u) failed (%zd)\n", -+ size, b->offset, err); -+ continue; -+ } -+ -+ seq_printf(m, "%04x: %*ph\n", b->offset, (int) size, buf); -+ } -+ -+ return 0; -+} -+ -+static int phytium_dpcd_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_dpcd_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_dpcd_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_dpcd_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+}; -+ -+static ssize_t -+phytium_dp_state_write(struct file *filp, -+ const char __user *ubuf, -+ size_t len, -+ loff_t *ppos) -+{ -+ char tmp[16]; -+ -+ if (len >= sizeof(tmp)) -+ return -EINVAL; -+ -+ memset(tmp, 0, sizeof(tmp)); -+ if (copy_from_user(tmp, ubuf, len)) -+ return -EFAULT; -+ tmp[len] = '\0'; -+ -+ return len; -+} -+ -+static int phytium_dp_state_show(struct seq_file *m, void *data) -+{ -+ struct drm_connector *connector = m->private; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ seq_printf(m, "port number: %d\n", phytium_dp->port); -+ seq_printf(m, "source_max_lane_count: %d\n", phytium_dp->source_max_lane_count); -+ seq_printf(m, "max_source_rates: %d\n", -+ phytium_dp->source_rates[phytium_dp->num_source_rates-1]); -+ if (connector->status == connector_status_connected) { -+ seq_printf(m, "sink_max_lane_count: %d\n", phytium_dp->sink_max_lane_count); -+ seq_printf(m, "max_sink_rates: %d\n", -+ phytium_dp->sink_rates[phytium_dp->num_sink_rates-1]); -+ seq_printf(m, "link_rate: %d\n", phytium_dp->link_rate); -+ seq_printf(m, "link_lane_count: %d\n", phytium_dp->link_lane_count); -+ seq_printf(m, "train_set[0]: %d\n", phytium_dp->train_set[0]); -+ seq_printf(m, "has_audio: %s\n", phytium_dp->has_audio?"yes":"no"); -+ } -+ -+ return 0; -+} -+ -+static int phytium_dp_state_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_dp_state_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_dp_state_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_dp_state_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = phytium_dp_state_write, -+}; -+ -+static const struct phytium_debugfs_files { -+ const char *name; -+ const struct file_operations *fops; -+} phytium_debugfs_connector_files[] = { -+ {"dp_state", &phytium_dp_state_fops}, -+ {"dpcd", &phytium_dpcd_fops}, -+ {"dp_register", &phytium_dp_register_fops}, -+ {"dp_trigger_train_fail", &phytium_dp_trigger_train_fail_fops}, -+}; -+ -+static const struct phytium_debugfs_files phytium_edp_debugfs_connector_files[] = { -+ {"edp_power", &phytium_edp_power_fops}, -+ {"edp_backlight", &phytium_edp_backlight_fops}, -+}; -+ -+int phytium_debugfs_connector_add(struct drm_connector *connector) -+{ -+ struct dentry *root = connector->debugfs_entry; -+ struct dentry *ent; -+ int i; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ if (!root) -+ return -ENODEV; -+ -+ for (i = 0; i < ARRAY_SIZE(phytium_debugfs_connector_files); i++) { -+ ent = debugfs_create_file(phytium_debugfs_connector_files[i].name, -+ 0644, -+ root, -+ connector, -+ phytium_debugfs_connector_files[i].fops); -+ if (!ent) -+ return -ENOMEM; -+ } -+ -+ if (phytium_dp->is_edp) -+ for (i = 0; i < ARRAY_SIZE(phytium_edp_debugfs_connector_files); i++) { -+ ent = debugfs_create_file(phytium_edp_debugfs_connector_files[i].name, -+ 0644, -+ root, -+ connector, -+ phytium_edp_debugfs_connector_files[i].fops); -+ if (!ent) -+ return -ENOMEM; -+ } -+ -+ return 0; -+} -+ -+static int phytium_mem_state_show(struct seq_file *m, void *data) -+{ -+ struct phytium_display_private *priv = m->private; -+ uint8_t i; -+ -+ for (i = 0; i < ARRAY_SIZE(mem_state); i++) -+ seq_printf(m, "%-34s %10lld\n", mem_state[i], priv->mem_state[i]); -+ -+ return 0; -+} -+ -+static int phytium_mem_state_open(struct inode *inode, struct file *file) -+{ -+ return single_open(file, phytium_mem_state_show, inode->i_private); -+} -+ -+static const struct file_operations phytium_mem_state_fops = { -+ .owner = THIS_MODULE, -+ .open = phytium_mem_state_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+}; -+ -+static const struct phytium_debugfs_files phytium_debugfs_display_files[] = { -+ {"mem_state", &phytium_mem_state_fops}, -+}; -+ -+int phytium_debugfs_display_register(struct phytium_display_private *priv) -+{ -+ struct drm_minor *minor = priv->dev->primary; -+ struct dentry *root = minor->debugfs_root; -+ struct dentry *ent; -+ -+ if (!root) -+ return -ENODEV; -+ -+ ent = debugfs_create_file(phytium_debugfs_display_files[0].name, -+ 0644, -+ root, -+ priv, -+ phytium_debugfs_display_files[0].fops); -+ if (!ent) -+ return -ENOMEM; -+ -+ return 0; -+} -diff --git a/drivers/gpu/drm/phytium/phytium_debugfs.h b/drivers/gpu/drm/phytium/phytium_debugfs.h -new file mode 100644 -index 000000000..7e632bf9c ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_debugfs.h -@@ -0,0 +1,13 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_DEBUGFS_H__ -+#define __PHYTIUM_DEBUGFS_H__ -+ -+int phytium_debugfs_connector_add(struct drm_connector *connector); -+int phytium_debugfs_display_register(struct phytium_display_private *priv); -+ -+#endif /* __PHYTIUM_DEBUGFS_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_display_drv.c b/drivers/gpu/drm/phytium/phytium_display_drv.c -new file mode 100644 -index 000000000..c311c1c97 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_display_drv.c -@@ -0,0 +1,451 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_plane.h" -+#include "phytium_crtc.h" -+#include "phytium_dp.h" -+#include "phytium_gem.h" -+#include "phytium_fb.h" -+#include "phytium_fbdev.h" -+#include "phytium_reg.h" -+#include "phytium_pci.h" -+#include "phytium_platform.h" -+#include "phytium_debugfs.h" -+ -+int dc_fake_mode_enable; -+module_param(dc_fake_mode_enable, int, 0644); -+MODULE_PARM_DESC(dc_fake_mode_enable, "Enable DC fake mode (0-disabled; 1-enabled; default-0)"); -+ -+int dc_fast_training_check = 1; -+module_param(dc_fast_training_check, int, 0644); -+MODULE_PARM_DESC(dc_fast_training_check, "Check dp fast training (0-disabled; 1-enabled; default-1)"); -+ -+int num_source_rates = 4; -+module_param(num_source_rates, int, 0644); -+MODULE_PARM_DESC(num_source_rates, "set the source max rates (1-1.62Gbps; 2-2.7Gbps; 3-5.4Gbps; 4-8.1Gbps; default-4)"); -+ -+int source_max_lane_count = 4; -+module_param(source_max_lane_count, int, 0644); -+MODULE_PARM_DESC(source_max_lane_count, "set the source lane count (1-1lane; 2-2lane; 4-4lane; default-4)"); -+ -+int link_dynamic_adjust; -+module_param(link_dynamic_adjust, int, 0644); -+MODULE_PARM_DESC(link_dynamic_adjust, "dynamic select the train pamameter according to the display mode (0-disabled; 1-enabled; default-1)"); -+ -+int phytium_wait_cmd_done(struct phytium_display_private *priv, -+ uint32_t register_offset, -+ uint32_t request_bit, -+ uint32_t reply_bit) -+{ -+ int timeout = 1000, config = 0, ret = 0; -+ -+ do { -+ mdelay(1); -+ timeout--; -+ config = phytium_readl_reg(priv, 0, register_offset); -+ } while ((!(config & reply_bit)) && timeout); -+ -+ phytium_writel_reg(priv, config & (~request_bit), 0, register_offset); -+ -+ if (timeout == 0) { -+ DRM_ERROR("wait cmd reply timeout\n"); -+ ret = -EBUSY; -+ } else { -+ timeout = 500; -+ do { -+ mdelay(1); -+ timeout--; -+ config = phytium_readl_reg(priv, 0, register_offset); -+ } while ((config & reply_bit) && timeout); -+ if (timeout == 0) { -+ DRM_ERROR("clear cmd timeout\n"); -+ ret = -EBUSY; -+ } -+ } -+ mdelay(5); -+ -+ return ret; -+} -+ -+static void phytium_irq_preinstall(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ int i, status; -+ -+ for_each_pipe_masked(priv, i) { -+ status = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); -+ phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[i], PHYTIUM_DC_INT_ENABLE); -+ } -+} -+ -+static void phytium_irq_uninstall(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ int i, status; -+ -+ for_each_pipe_masked(priv, i) { -+ status = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); -+ phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[i], PHYTIUM_DC_INT_ENABLE); -+ } -+} -+ -+static irqreturn_t phytium_display_irq_handler(int irq, void *data) -+{ -+ struct drm_device *dev = data; -+ struct phytium_display_private *priv = dev->dev_private; -+ bool enabled = 0; -+ int i = 0, virt_pipe = 0; -+ irqreturn_t ret = IRQ_NONE, ret1 = IRQ_NONE; -+ -+ for_each_pipe_masked(priv, i) { -+ enabled = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); -+ if (enabled & INT_STATUS) { -+ virt_pipe = phytium_get_virt_pipe(priv, i); -+ if (virt_pipe < 0) -+ return IRQ_NONE; -+ drm_handle_vblank(dev, virt_pipe); -+ ret = IRQ_HANDLED; -+ if (priv->dc_hw_clear_msi_irq) -+ priv->dc_hw_clear_msi_irq(priv, i); -+ } -+ } -+ -+ ret1 = phytium_dp_hpd_irq_handler(priv); -+ if (ret == IRQ_HANDLED || ret1 == IRQ_HANDLED) -+ return IRQ_HANDLED; -+ -+ return IRQ_NONE; -+} -+ -+static const struct drm_mode_config_funcs phytium_mode_funcs = { -+ .fb_create = phytium_fb_create, -+ .output_poll_changed = drm_fb_helper_output_poll_changed, -+ .atomic_check = drm_atomic_helper_check, -+ .atomic_commit = drm_atomic_helper_commit, -+}; -+ -+static void phytium_atomic_commit_tail(struct drm_atomic_state *state) -+{ -+ struct drm_device *dev = state->dev; -+ -+ drm_atomic_helper_commit_modeset_disables(dev, state); -+ drm_atomic_helper_commit_planes(dev, state, false); -+ drm_atomic_helper_commit_modeset_enables(dev, state); -+ drm_atomic_helper_commit_hw_done(state); -+ drm_atomic_helper_wait_for_flip_done(dev, state); -+ drm_atomic_helper_cleanup_planes(dev, state); -+} -+ -+static struct drm_mode_config_helper_funcs phytium_mode_config_helpers = { -+ .atomic_commit_tail = phytium_atomic_commit_tail, -+}; -+ -+static int phytium_modeset_init(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ int i = 0, ret; -+ -+ drm_mode_config_init(dev); -+ dev->mode_config.min_width = 0; -+ dev->mode_config.min_height = 0; -+ dev->mode_config.max_width = 16384; -+ dev->mode_config.max_height = 16384; -+ dev->mode_config.cursor_width = 32; -+ dev->mode_config.cursor_height = 32; -+ -+ dev->mode_config.preferred_depth = 24; -+ dev->mode_config.prefer_shadow = 1; -+ dev->mode_config.fb_modifiers_not_supported = false; -+ -+ dev->mode_config.funcs = &phytium_mode_funcs; -+ dev->mode_config.helper_private = &phytium_mode_config_helpers; -+ -+ for_each_pipe_masked(priv, i) { -+ ret = phytium_crtc_init(dev, i); -+ if (ret) { -+ DRM_ERROR("phytium_crtc_init(pipe %d) return failed\n", i); -+ goto failed_crtc_init; -+ } -+ } -+ -+ for_each_pipe_masked(priv, i) { -+ ret = phytium_dp_init(dev, i); -+ if (ret) { -+ DRM_ERROR("phytium_dp_init(pipe %d) return failed\n", i); -+ goto failed_dp_init; -+ } -+ } -+ -+ drm_mode_config_reset(dev); -+ -+ return 0; -+failed_dp_init: -+failed_crtc_init: -+ drm_mode_config_cleanup(dev); -+ return ret; -+} -+ -+int phytium_get_virt_pipe(struct phytium_display_private *priv, int phys_pipe) -+{ -+ int i = 0; -+ int virt_pipe = 0; -+ -+ for_each_pipe_masked(priv, i) { -+ if (i != phys_pipe) -+ virt_pipe++; -+ else -+ return virt_pipe; -+ } -+ -+ DRM_ERROR("%s %d failed\n", __func__, phys_pipe); -+ return -EINVAL; -+} -+ -+int phytium_get_phys_pipe(struct phytium_display_private *priv, int virt_pipe) -+{ -+ int i = 0; -+ int tmp = 0; -+ -+ for_each_pipe_masked(priv, i) { -+ if (tmp != virt_pipe) -+ tmp++; -+ else -+ return i; -+ } -+ -+ DRM_ERROR("%s %d failed\n", __func__, virt_pipe); -+ return -EINVAL; -+} -+ -+static int phytium_display_load(struct drm_device *dev, unsigned long flags) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret = 0; -+ -+ ret = drm_vblank_init(dev, priv->info.num_pipes); -+ if (ret) { -+ DRM_ERROR("vblank init failed\n"); -+ goto failed_vblank_init; -+ } -+ -+ ret = phytium_modeset_init(dev); -+ if (ret) { -+ DRM_ERROR("phytium_modeset_init failed\n"); -+ goto failed_modeset_init; -+ } -+ -+ if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) -+ priv->vram_hw_init(priv); -+ -+ phytium_irq_preinstall(dev); -+ ret = request_irq(priv->irq, phytium_display_irq_handler, IRQF_SHARED, -+ dev->driver->name, dev); -+ if (ret) { -+ DRM_ERROR("install irq failed\n"); -+ goto failed_irq_install; -+ } -+ -+ ret = phytium_drm_fbdev_init(dev); -+ if (ret) -+ DRM_ERROR("failed to init dev\n"); -+ -+ phytium_debugfs_display_register(priv); -+ -+ return ret; -+ -+failed_irq_install: -+ drm_mode_config_cleanup(dev); -+failed_modeset_init: -+failed_vblank_init: -+ return ret; -+} -+ -+static void phytium_display_unload(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ phytium_drm_fbdev_fini(dev); -+ phytium_irq_uninstall(dev); -+ free_irq(priv->irq, dev); -+ drm_mode_config_cleanup(dev); -+} -+ -+/* phytium display specific ioctls -+ * The device specific ioctl range is 0x40 to 0x79. -+ */ -+#define DRM_PHYTIUM_VRAM_TYPE_DEVICE 0x0 -+#define DRM_IOCTL_PHYTIUM_VRAM_TYPE_DEVICE DRM_IO(DRM_COMMAND_BASE\ -+ + DRM_PHYTIUM_VRAM_TYPE_DEVICE) -+ -+static int phytium_ioctl_check_vram_device(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ return ((priv->support_memory_type == MEMORY_TYPE_VRAM_DEVICE) ? 1 : 0); -+} -+ -+static const struct drm_ioctl_desc phytium_ioctls[] = { -+ /* for test, none so far */ -+ DRM_IOCTL_DEF_DRV(PHYTIUM_VRAM_TYPE_DEVICE, phytium_ioctl_check_vram_device, -+ DRM_AUTH|DRM_UNLOCKED), -+}; -+ -+static const struct file_operations phytium_drm_driver_fops = { -+ .owner = THIS_MODULE, -+ .open = drm_open, -+ .release = drm_release, -+ .unlocked_ioctl = drm_ioctl, -+ .compat_ioctl = drm_compat_ioctl, -+ .poll = drm_poll, -+ .read = drm_read, -+ .llseek = no_llseek, -+ .mmap = phytium_gem_mmap, -+}; -+ -+struct drm_driver phytium_display_drm_driver = { -+ .driver_features = DRIVER_HAVE_IRQ | -+ DRIVER_MODESET | -+ DRIVER_ATOMIC | -+ DRIVER_GEM, -+ .load = phytium_display_load, -+ .unload = phytium_display_unload, -+ .lastclose = drm_fb_helper_lastclose, -+ .gem_prime_import = drm_gem_prime_import, -+ .gem_prime_import_sg_table = phytium_gem_prime_import_sg_table, -+ .dumb_create = phytium_gem_dumb_create, -+ .ioctls = phytium_ioctls, -+ .num_ioctls = ARRAY_SIZE(phytium_ioctls), -+ .fops = &phytium_drm_driver_fops, -+ .name = DRV_NAME, -+ .desc = DRV_DESC, -+ .date = DRV_DATE, -+ .major = DRV_MAJOR, -+ .minor = DRV_MINOR, -+}; -+ -+static void phytium_display_shutdown(struct drm_device *dev) -+{ -+ drm_atomic_helper_shutdown(dev); -+} -+ -+static int phytium_display_pm_suspend(struct drm_device *dev) -+{ -+ struct drm_atomic_state *state; -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret, ret1; -+ -+ phytium_dp_hpd_irq_setup(dev, false); -+ cancel_work_sync(&priv->hotplug_work); -+ drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 1); -+ state = drm_atomic_helper_suspend(dev); -+ if (IS_ERR(state)) { -+ DRM_ERROR("drm_atomic_helper_suspend failed: %ld\n", PTR_ERR(state)); -+ ret = PTR_ERR(state); -+ goto suspend_failed; -+ } -+ dev->mode_config.suspend_state = state; -+ ret = phytium_gem_suspend(dev); -+ if (ret) { -+ DRM_ERROR("phytium_gem_suspend failed: %d\n", ret); -+ goto gem_suspend_failed; -+ } -+ -+ return 0; -+ -+gem_suspend_failed: -+ ret1 = drm_atomic_helper_resume(dev, dev->mode_config.suspend_state); -+ if (ret1) -+ DRM_ERROR("Failed to resume (%d)\n", ret1); -+ dev->mode_config.suspend_state = NULL; -+suspend_failed: -+ drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 0); -+ phytium_dp_hpd_irq_setup(dev, true); -+ -+ return ret; -+} -+ -+static int phytium_display_pm_resume(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ int ret = 0; -+ -+ if (WARN_ON(!dev->mode_config.suspend_state)) -+ return -EINVAL; -+ -+ ret = phytium_dp_resume(dev); -+ if (ret) -+ return -EIO; -+ -+ phytium_crtc_resume(dev); -+ phytium_gem_resume(dev); -+ -+ if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) -+ priv->vram_hw_init(priv); -+ -+ ret = drm_atomic_helper_resume(dev, dev->mode_config.suspend_state); -+ if (ret) { -+ DRM_ERROR("Failed to resume (%d)\n", ret); -+ return ret; -+ } -+ -+ dev->mode_config.suspend_state = NULL; -+ drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 0); -+ phytium_dp_hpd_irq_setup(dev, true); -+ -+ return 0; -+} -+ -+void phytium_display_private_init(struct phytium_display_private *priv, struct drm_device *dev) -+{ -+ INIT_LIST_HEAD(&priv->gem_list_head); -+ spin_lock_init(&priv->hotplug_irq_lock); -+ INIT_WORK(&priv->hotplug_work, phytium_dp_hpd_work_func); -+ memset(priv->mem_state, 0, sizeof(priv->mem_state)); -+ priv->dev = dev; -+ priv->display_shutdown = phytium_display_shutdown; -+ priv->display_pm_suspend = phytium_display_pm_suspend; -+ priv->display_pm_resume = phytium_display_pm_resume; -+} -+ -+static int __init phytium_display_init(void) -+{ -+ int ret = 0; -+ -+ ret = platform_driver_register(&phytium_platform_driver); -+ if (ret) -+ return ret; -+ -+ ret = pci_register_driver(&phytium_pci_driver); -+ -+ return ret; -+} -+ -+static void __exit phytium_display_exit(void) -+{ -+ pci_unregister_driver(&phytium_pci_driver); -+ -+ platform_driver_unregister(&phytium_platform_driver); -+} -+ -+module_init(phytium_display_init); -+module_exit(phytium_display_exit); -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Yang Xun "); -+MODULE_DESCRIPTION("Phytium Display Controller"); -diff --git a/drivers/gpu/drm/phytium/phytium_display_drv.h b/drivers/gpu/drm/phytium/phytium_display_drv.h -new file mode 100644 -index 000000000..587614f5b ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_display_drv.h -@@ -0,0 +1,180 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_DISPLAY_DRV_H__ -+#define __PHYTIUM_DISPLAY_DRV_H__ -+ -+#include -+#include -+#include -+ -+#define DEBUG_LOG 0 -+ -+#define PHYTIUM_FORMAT_MAX_PLANE 3 -+#define DP_MAX_DOWNSTREAM_PORTS 0x10 -+ -+#define DRV_NAME "dc" -+#define DRV_DESC "phytium dc" -+#define DRV_DATE "20201220" -+#define DRV_MAJOR 1 -+#define DRV_MINOR 1 -+ -+/* come from GPU */ -+#define DRM_FORMAT_MOD_VENDOR_PHYTIUM 0x92 -+ -+/* dc:mode0 8x8 16bpp gpu: FBCDC_8X8_V10 */ -+#define DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC fourcc_mod_code(PHYTIUM, 21) -+/* dc:mode3 8x4 32bpp gpu: FBCDC_16X4_v10 */ -+#define DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC fourcc_mod_code(PHYTIUM, 22) -+ -+#define PIPE_MASK_SHIFT 0x0 -+#define PIPE_MASK_MASK 0x7 -+#define EDP_MASK_SHIFT 0x3 -+#define EDP_MASK_MASK 0x7 -+ -+enum phytium_platform { -+ PHYTIUM_PLATFORM_UNINITIALIZED = 0, -+ PHYTIUM_PLATFORM_PX210, -+ PHYTIUM_PLATFORM_PE220X, -+}; -+ -+enum phytium_mem_state_type { -+ PHYTIUM_MEM_VRAM_TOTAL = 0, -+ PHYTIUM_MEM_VRAM_ALLOC, -+ PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL, -+ PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC, -+ PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC, -+ PHYTIUM_MEM_STATE_TYPE_COUNT, -+}; -+ -+#define MEMORY_TYPE_VRAM_WC 0x1 -+#define MEMORY_TYPE_SYSTEM_CARVEOUT 0x2 -+#define MEMORY_TYPE_SYSTEM_UNIFIED 0x4 -+#define MEMORY_TYPE_VRAM_DEVICE 0x8 -+ -+#define IS_PLATFORM(priv, p) ((priv)->info.platform_mask & BIT(p)) -+ -+#define IS_PX210(priv) IS_PLATFORM(priv, PHYTIUM_PLATFORM_PX210) -+#define IS_PE220X(priv) IS_PLATFORM(priv, PHYTIUM_PLATFORM_PE220X) -+ -+struct phytium_device_info { -+ unsigned char platform_mask; -+ unsigned char pipe_mask; -+ unsigned char num_pipes; -+ unsigned char total_pipes; -+ unsigned char edp_mask; -+ unsigned int crtc_clock_max; -+ unsigned int hdisplay_max; -+ unsigned int vdisplay_max; -+ unsigned int backlight_max; -+ unsigned int backlight_min; -+ unsigned long address_mask; -+ struct pwm_device *pwm; -+}; -+ -+struct phytium_display_private { -+ /* hw */ -+ void __iomem *regs; -+ void __iomem *vram_addr; -+ struct phytium_device_info info; -+ char support_memory_type; -+ char reserve[3]; -+ uint32_t dc_reg_base[3]; -+ uint32_t dcreq_reg_base[3]; -+ uint32_t dp_reg_base[3]; -+ uint32_t address_transform_base; -+ uint32_t phy_access_base[3]; -+ -+ /* drm */ -+ struct drm_device *dev; -+ int irq; -+ -+ /* fb_dev */ -+ struct drm_fb_helper fbdev_helper; -+ struct phytium_gem_object *fbdev_phytium_gem; -+ -+ int save_reg[3]; -+ struct list_head gem_list_head; -+ -+ struct work_struct hotplug_work; -+ spinlock_t hotplug_irq_lock; -+ -+ void (*vram_hw_init)(struct phytium_display_private *priv); -+ void (*display_shutdown)(struct drm_device *dev); -+ int (*display_pm_suspend)(struct drm_device *dev); -+ int (*display_pm_resume)(struct drm_device *dev); -+ void (*dc_hw_clear_msi_irq)(struct phytium_display_private *priv, uint32_t phys_pipe); -+ int (*dc_hw_fb_format_check)(const struct drm_mode_fb_cmd2 *mode_cmd, int count); -+ -+ struct gen_pool *memory_pool; -+ resource_size_t pool_phys_addr; -+ resource_size_t pool_size; -+ void *pool_virt_addr; -+ uint64_t mem_state[PHYTIUM_MEM_STATE_TYPE_COUNT]; -+ -+ /* DMA info */ -+ int dma_inited; -+ struct dma_chan *dma_chan; -+ /*BL GPIO info*/ -+ struct gpio_desc *edp_bl_en, *edp_power_en; -+}; -+ -+static inline unsigned int -+phytium_readl_reg(struct phytium_display_private *priv, uint32_t group_offset, uint32_t reg_offset) -+{ -+ unsigned int data; -+ -+ data = readl(priv->regs + group_offset + reg_offset); -+#if DEBUG_LOG -+ pr_info("Read 32'h%08x 32'h%08x\n", group_offset + reg_offset, data); -+#endif -+ return data; -+} -+ -+static inline void -+phytium_writel_reg(struct phytium_display_private *priv, uint32_t data, -+ uint32_t group_offset, uint32_t reg_offset) -+{ -+ -+ writel(data, priv->regs + group_offset + reg_offset); -+#if DEBUG_LOG -+ pr_info("Write 32'h%08x 32'h%08x\n", group_offset + reg_offset, data); -+#endif -+} -+ -+static inline void -+phytium_writeb_reg(struct phytium_display_private *priv, uint8_t data, -+ uint32_t group_offset, uint32_t reg_offset) -+{ -+ writeb(data, priv->regs + group_offset + reg_offset); -+#if DEBUG_LOG -+ pr_info("Write 32'h%08x 8'h%08x\n", group_offset + reg_offset, data); -+#endif -+} -+ -+#define for_each_pipe(__dev_priv, __p) \ -+ for ((__p) = 0; (__p) < __dev_priv->info.total_pipes; (__p)++) -+ -+#define for_each_pipe_masked(__dev_priv, __p) \ -+ for ((__p) = 0; (__p) < __dev_priv->info.total_pipes; (__p)++) \ -+ for_each_if((__dev_priv->info.pipe_mask) & BIT(__p)) -+ -+int phytium_get_virt_pipe(struct phytium_display_private *priv, int phys_pipe); -+int phytium_get_phys_pipe(struct phytium_display_private *priv, int virt_pipe); -+int phytium_wait_cmd_done(struct phytium_display_private *priv, -+ uint32_t register_offset, -+ uint32_t request_bit, -+ uint32_t reply_bit); -+void phytium_display_private_init(struct phytium_display_private *priv, struct drm_device *dev); -+ -+extern struct drm_driver phytium_display_drm_driver; -+extern int dc_fake_mode_enable; -+extern int dc_fast_training_check; -+extern int num_source_rates; -+extern int source_max_lane_count; -+extern int link_dynamic_adjust; -+ -+#endif /* __PHYTIUM_DISPLAY_DRV_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_dp.c b/drivers/gpu/drm/phytium/phytium_dp.c -new file mode 100644 -index 000000000..fdd91daf0 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_dp.c -@@ -0,0 +1,2649 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_dp.h" -+#include "phytium_debugfs.h" -+#include "px210_dp.h" -+#include "pe220x_dp.h" -+#include "phytium_panel.h" -+#include "phytium_reg.h" -+ -+static void phytium_dp_aux_init(struct phytium_dp_device *phytium_dp); -+static void handle_plugged_change(struct phytium_dp_device *phytium_dp, bool plugged); -+static bool phytium_edp_init_connector(struct phytium_dp_device *phytium_dp); -+static void phytium_edp_fini_connector(struct phytium_dp_device *phytium_dp); -+static void phytium_edp_panel_poweroff(struct phytium_dp_device *phytium_dp); -+static void phytium_dp_audio_codec_fini(struct phytium_dp_device *phytium_dp); -+ -+static int phytium_rate[] = {162000, 270000, 540000, 810000}; -+static int codec_id = PHYTIUM_DP_AUDIO_ID; -+ -+void phytium_phy_writel(struct phytium_dp_device *phytium_dp, uint32_t address, uint32_t data) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->phy_access_base[port]; -+ -+#if DEBUG_LOG -+ pr_info("phy address write: 0x%x data:0x%x\n", address, data); -+#endif -+ phytium_writel_reg(priv, address, group_offset, PHYTIUM_PHY_ACCESS_ADDRESS); -+ phytium_writel_reg(priv, data, group_offset, PHYTIUM_PHY_WRITE_DATA); -+ phytium_writel_reg(priv, ACCESS_WRITE, group_offset, PHYTIUM_PHY_ACCESS_CTRL); -+ udelay(10); -+} -+ -+uint32_t phytium_phy_readl(struct phytium_dp_device *phytium_dp, uint32_t address) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->phy_access_base[port]; -+ uint32_t data; -+ -+ phytium_writel_reg(priv, address, group_offset, PHYTIUM_PHY_ACCESS_ADDRESS); -+ phytium_writel_reg(priv, ACCESS_READ, group_offset, PHYTIUM_PHY_ACCESS_CTRL); -+ udelay(10); -+ data = phytium_readl_reg(priv, group_offset, PHYTIUM_PHY_READ_DATA); -+#if DEBUG_LOG -+ pr_info("phy address read: 0x%x data:0x%x\n", address, data); -+#endif -+ -+ return data; -+} -+ -+static int -+phytium_dp_hw_aux_transfer_write(struct phytium_dp_device *phytium_dp, struct drm_dp_aux_msg *msg) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ unsigned int i = 0, j = 0; -+ unsigned int cmd = 0; -+ unsigned int aux_status = 0, interrupt_status = 0; -+ unsigned char *data = msg->buffer; -+ int count_timeout = 0; -+ long ret = 0; -+ -+ for (i = 0; i < 3; i++) { -+ /* clear PX210_DP_INTERRUPT_RAW_STATUS */ -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); -+ phytium_writel_reg(priv, msg->address, group_offset, PHYTIUM_DP_AUX_ADDRESS); -+ for (j = 0; j < msg->size; j++) -+ phytium_writeb_reg(priv, data[j], group_offset, PHYTIUM_DP_AUX_WRITE_FIFO); -+ -+ cmd = ((msg->request & COMMAND_MASK) << COMMAND_SHIFT); -+ if (msg->size == 0) -+ cmd |= ADDRESS_ONLY; -+ else -+ cmd |= (msg->size-1) & BYTE_COUNT_MASK; -+ phytium_writel_reg(priv, cmd, group_offset, PHYTIUM_DP_AUX_COMMAND); -+ -+ count_timeout = 0; -+ do { -+ mdelay(5); -+ interrupt_status = phytium_readl_reg(priv, group_offset, -+ PHYTIUM_DP_INTERRUPT_RAW_STATUS); -+ aux_status = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_STATUS); -+ if ((aux_status & REPLY_RECEIVED) || (aux_status & REPLY_ERROR) -+ || (interrupt_status & REPLY_TIMEOUT)) { -+ DRM_DEBUG_KMS("aux wait exit\n"); -+ break; -+ } -+ count_timeout++; -+ } while (count_timeout < 6); -+ -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); -+ if (interrupt_status & REPLY_TIMEOUT) { -+ DRM_DEBUG_KMS("aux write reply timeout\n"); -+ continue; -+ } else if (aux_status & REPLY_ERROR) { -+ DRM_DEBUG_KMS("aux write reply error\n"); -+ continue; -+ } else if (aux_status & REPLY_RECEIVED) { -+ DRM_DEBUG_KMS("aux write reply received succussful\n"); -+ break; -+ } -+ } -+ -+ if (interrupt_status & REPLY_TIMEOUT) { -+ DRM_NOTE("aux(%d) write reply timeout\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } else if (aux_status & REPLY_ERROR) { -+ DRM_ERROR("aux(%d) write reply error\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } else if ((aux_status & REPLY_RECEIVED) != REPLY_RECEIVED) { -+ DRM_ERROR("aux(%d) write reply no response\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } -+ -+ msg->reply = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_CODE); -+ ret = msg->size; -+out: -+ return ret; -+} -+ -+static int -+phytium_dp_hw_aux_transfer_read(struct phytium_dp_device *phytium_dp, struct drm_dp_aux_msg *msg) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ unsigned int i = 0; -+ unsigned int cmd = 0; -+ unsigned int aux_status = 0, interrupt_status = 0; -+ unsigned char *data = msg->buffer; -+ int count_timeout = 0; -+ long ret = 0; -+ -+ for (i = 0; i < 3; i++) { -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); -+ phytium_writel_reg(priv, msg->address, group_offset, PHYTIUM_DP_AUX_ADDRESS); -+ cmd = ((msg->request & COMMAND_MASK) << COMMAND_SHIFT); -+ if (msg->size == 0) -+ cmd |= ADDRESS_ONLY; -+ else -+ cmd |= ((msg->size-1) & BYTE_COUNT_MASK); -+ phytium_writel_reg(priv, cmd, group_offset, PHYTIUM_DP_AUX_COMMAND); -+ -+ count_timeout = 0; -+ do { -+ mdelay(5); -+ interrupt_status = phytium_readl_reg(priv, group_offset, -+ PHYTIUM_DP_INTERRUPT_RAW_STATUS); -+ aux_status = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_STATUS); -+ if ((aux_status & REPLY_RECEIVED) || (aux_status & REPLY_ERROR) -+ || (interrupt_status & REPLY_TIMEOUT)) { -+ DRM_DEBUG_KMS("aux wait exit\n"); -+ break; -+ } -+ count_timeout++; -+ } while (count_timeout < 6); -+ -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); -+ if (interrupt_status & REPLY_TIMEOUT) { -+ DRM_DEBUG_KMS("aux read reply timeout\n"); -+ continue; -+ } else if (aux_status & REPLY_ERROR) { -+ DRM_DEBUG_KMS("aux read reply error\n"); -+ continue; -+ } else if (aux_status & REPLY_RECEIVED) { -+ DRM_DEBUG_KMS("aux read reply received succussful\n"); -+ break; -+ } -+ } -+ -+ if (interrupt_status & REPLY_TIMEOUT) { -+ DRM_NOTE("aux(%d) read reply timeout\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } else if (aux_status & REPLY_ERROR) { -+ DRM_ERROR("aux(%d) read reply error\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } else if ((aux_status & REPLY_RECEIVED) != REPLY_RECEIVED) { -+ DRM_ERROR("aux(%d) read reply no response\n", phytium_dp->port); -+ ret = -EIO; -+ goto out; -+ } -+ -+ msg->reply = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_CODE); -+ ret = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_DATA_COUNT); -+ -+ if (ret > msg->size) { -+ ret = msg->size; -+ } else if (ret != msg->size) { -+ DRM_DEBUG_KMS("aux read count error(ret:0x%lx != 0x%lx)\n", ret, msg->size); -+ ret = -EBUSY; -+ goto out; -+ } -+ -+ for (i = 0; i < ret; i++) -+ data[i] = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_DATA); -+ -+out: -+ return ret; -+} -+ -+static void phytium_get_native_mode(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_display_mode *t, *mode; -+ struct drm_connector *connector = &phytium_dp->connector; -+ struct drm_display_mode *native_mode = &phytium_dp->native_mode; -+ -+ list_for_each_entry_safe(mode, t, &connector->probed_modes, head) { -+ if (mode->type & DRM_MODE_TYPE_PREFERRED) { -+ if (mode->hdisplay != native_mode->hdisplay || -+ mode->vdisplay != native_mode->vdisplay) { -+ memcpy(native_mode, mode, sizeof(*mode)); -+ drm_mode_set_crtcinfo(native_mode, 0); -+ } -+ break; -+ } -+ } -+ -+ if (&mode->head == &connector->probed_modes) -+ native_mode->clock = 0; -+} -+ -+static int phytium_connector_add_common_modes(struct phytium_dp_device *phytium_dp) -+{ -+ int i = 0, ret = 0; -+ struct drm_device *dev = phytium_dp->dev; -+ struct drm_display_mode *mode = NULL, *current_mode = NULL; -+ struct drm_display_mode *native_mode = &phytium_dp->native_mode; -+ bool mode_existed = false; -+ struct mode_size { -+ char name[DRM_DISPLAY_MODE_LEN]; -+ int w; -+ int h; -+ } common_mode[] = { -+ { "640x480", 640, 480}, -+ { "800x600", 800, 600}, -+ { "1024x768", 1024, 768}, -+ { "1280x720", 1280, 720}, -+ { "1280x800", 1280, 800}, -+ {"1280x1024", 1280, 1024}, -+ { "1440x900", 1440, 900}, -+ {"1680x1050", 1680, 1050}, -+ {"1600x1200", 1600, 1200}, -+ {"1920x1080", 1920, 1080}, -+ {"1920x1200", 1920, 1200} -+ }; -+ -+ if (native_mode->clock == 0) -+ return ret; -+ -+ for (i = 0; i < ARRAY_SIZE(common_mode); i++) { -+ mode_existed = false; -+ -+ if (common_mode[i].w > native_mode->hdisplay || -+ common_mode[i].h > native_mode->vdisplay || -+ (common_mode[i].w == native_mode->hdisplay && -+ common_mode[i].h == native_mode->vdisplay)) -+ continue; -+ -+ list_for_each_entry(current_mode, &phytium_dp->connector.probed_modes, head) { -+ if (common_mode[i].w == current_mode->hdisplay && -+ common_mode[i].h == current_mode->vdisplay) { -+ mode_existed = true; -+ break; -+ } -+ } -+ -+ if (mode_existed) -+ continue; -+ -+ mode = drm_mode_duplicate(dev, native_mode); -+ if (mode == NULL) -+ continue; -+ -+ mode->hdisplay = common_mode[i].w; -+ mode->vdisplay = common_mode[i].h; -+ mode->type &= ~DRM_MODE_TYPE_PREFERRED; -+ strscpy(mode->name, common_mode[i].name, DRM_DISPLAY_MODE_LEN); -+ drm_mode_probed_add(&phytium_dp->connector, mode); -+ ret++; -+ } -+ -+ return ret; -+} -+ -+static int phytium_connector_get_modes(struct drm_connector *connector) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ struct edid *edid; -+ int ret = 0; -+ -+ if (phytium_dp->is_edp) -+ edid = phytium_dp->edp_edid; -+ else -+ edid = drm_get_edid(connector, &phytium_dp->aux.ddc); -+ -+ if (edid && drm_edid_is_valid(edid)) { -+ drm_connector_update_edid_property(connector, edid); -+ ret = drm_add_edid_modes(connector, edid); -+ phytium_dp->has_audio = drm_detect_monitor_audio(edid); -+ phytium_get_native_mode(phytium_dp); -+ if (dc_fake_mode_enable) -+ ret += phytium_connector_add_common_modes(phytium_dp); -+ } else { -+ drm_connector_update_edid_property(connector, NULL); -+ phytium_dp->has_audio = false; -+ } -+ -+ if (!phytium_dp->is_edp) -+ kfree(edid); -+ -+ return ret; -+} -+ -+static struct drm_encoder *phytium_dp_best_encoder(struct drm_connector *connector) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ return &phytium_dp->encoder; -+} -+ -+static const -+struct drm_connector_helper_funcs phytium_connector_helper_funcs = { -+ .get_modes = phytium_connector_get_modes, -+ .best_encoder = phytium_dp_best_encoder, -+}; -+ -+static void phytium_dp_set_sink_rates(struct phytium_dp_device *phytium_dp) -+{ -+ static const int dp_rates[] = {162000, 270000, 540000, 810000}; -+ int i, max_rate; -+ -+ max_rate = drm_dp_bw_code_to_link_rate(phytium_dp->dpcd[DP_MAX_LINK_RATE]); -+ for (i = 0; i < ARRAY_SIZE(dp_rates); i++) { -+ if (dp_rates[i] > max_rate) -+ break; -+ phytium_dp->sink_rates[i] = dp_rates[i]; -+ } -+ phytium_dp->num_sink_rates = i; -+} -+ -+static int get_common_rates(const int *source_rates, int source_len, const int *sink_rates, -+ int sink_len, int *common_rates) -+{ -+ int i = 0, j = 0, k = 0; -+ -+ while (i < source_len && j < sink_len) { -+ if (source_rates[i] == sink_rates[j]) { -+ if (WARN_ON(k >= DP_MAX_SUPPORTED_RATES)) -+ return k; -+ common_rates[k] = source_rates[i]; -+ ++k; -+ ++i; -+ ++j; -+ } else if (source_rates[i] < sink_rates[j]) { -+ ++i; -+ } else { -+ ++j; -+ } -+ } -+ return k; -+} -+ -+static void phytium_dp_set_common_rates(struct phytium_dp_device *phytium_dp) -+{ -+ WARN_ON(!phytium_dp->num_source_rates || !phytium_dp->num_sink_rates); -+ -+ phytium_dp->num_common_rates = get_common_rates(phytium_dp->source_rates, -+ phytium_dp->num_source_rates, -+ phytium_dp->sink_rates, -+ phytium_dp->num_sink_rates, -+ phytium_dp->common_rates); -+ -+ if (WARN_ON(phytium_dp->num_common_rates == 0)) { -+ phytium_dp->common_rates[0] = 162000; -+ phytium_dp->num_common_rates = 1; -+ } -+} -+ -+static bool phytium_dp_get_dpcd(struct phytium_dp_device *phytium_dp) -+{ -+ int ret; -+ unsigned char sink_count = 0; -+ -+ /* get dpcd capability,but don't check data error; so check revision */ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, 0x00, phytium_dp->dpcd, -+ sizeof(phytium_dp->dpcd)); -+ if (ret < 0) { -+ DRM_ERROR("port %d get DPCD capability fail\n", phytium_dp->port); -+ return false; -+ } -+ -+ if (phytium_dp->dpcd[DP_DPCD_REV] == 0) { -+ DRM_ERROR("DPCD data error: 0x%x\n", phytium_dp->dpcd[DP_DPCD_REV]); -+ return false; -+ } -+ -+ /* parse sink support link */ -+ phytium_dp_set_sink_rates(phytium_dp); -+ phytium_dp_set_common_rates(phytium_dp); -+ phytium_dp->sink_max_lane_count = drm_dp_max_lane_count(phytium_dp->dpcd); -+ phytium_dp->common_max_lane_count = min(phytium_dp->source_max_lane_count, -+ phytium_dp->sink_max_lane_count); -+ -+ /* get dpcd sink count */ -+ if (drm_dp_dpcd_readb(&phytium_dp->aux, DP_SINK_COUNT, &sink_count) <= 0) { -+ DRM_ERROR("get DPCD sink_count fail\n"); -+ return false; -+ } -+ -+ phytium_dp->sink_count = DP_GET_SINK_COUNT(sink_count); -+ if (!phytium_dp->sink_count) { -+ DRM_ERROR("DPCD sink_count should not be zero\n"); -+ return false; -+ } -+ -+ if (!drm_dp_is_branch(phytium_dp->dpcd)) -+ return true; -+ -+ if (phytium_dp->dpcd[DP_DPCD_REV] == 0x10) -+ return true; -+ -+ /* get downstream port for branch device */ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_DOWNSTREAM_PORT_0, -+ phytium_dp->downstream_ports, DP_MAX_DOWNSTREAM_PORTS); -+ if (ret < 0) { -+ DRM_ERROR("get DPCD DFP fail\n"); -+ return false; -+ } -+ -+ return true; -+} -+ -+static enum drm_connector_status -+phytium_dp_detect_dpcd(struct phytium_dp_device *phytium_dp) -+{ -+ if (!phytium_dp_get_dpcd(phytium_dp)) -+ return connector_status_disconnected; -+ -+ if (!drm_dp_is_branch(phytium_dp->dpcd)) -+ return connector_status_connected; -+ -+ if (phytium_dp->downstream_ports[0] & DP_DS_PORT_HPD) { -+ return phytium_dp->sink_count ? connector_status_connected -+ : connector_status_disconnected; -+ } -+ return connector_status_connected; -+} -+ -+static void phytium_get_adjust_train(struct phytium_dp_device *phytium_dp, -+ const uint8_t link_status[DP_LINK_STATUS_SIZE], uint8_t lane_count) -+{ -+ unsigned char v = 0; -+ unsigned char p = 0; -+ int lane; -+ unsigned char voltage_max; -+ unsigned char preemph_max; -+ -+ /* find max value */ -+ for (lane = 0; lane < lane_count; lane++) { -+ uint8_t this_v = drm_dp_get_adjust_request_voltage(link_status, lane); -+ uint8_t this_p = drm_dp_get_adjust_request_pre_emphasis(link_status, lane); -+ -+ if (this_v > v) -+ v = this_v; -+ if (this_p > p) -+ p = this_p; -+ } -+ voltage_max = DP_TRAIN_VOLTAGE_SWING_LEVEL_3; -+ if (v >= voltage_max) -+ v = voltage_max | DP_TRAIN_MAX_SWING_REACHED; -+ -+ preemph_max = DP_TRAIN_PRE_EMPH_LEVEL_3; -+ if (p >= preemph_max) -+ p = preemph_max | DP_TRAIN_MAX_PRE_EMPHASIS_REACHED; -+ -+ for (lane = 0; lane < 4; lane++) -+ phytium_dp->train_set[lane] = v | p; -+} -+ -+bool phytium_dp_coding_8b10b_need_enable(unsigned char test_pattern) -+{ -+ switch (test_pattern) { -+ case PHYTIUM_PHY_TP_D10_2: -+ case PHYTIUM_PHY_TP_SYMBOL_ERROR: -+ case PHYTIUM_PHY_TP_CP2520_1: -+ case PHYTIUM_PHY_TP_CP2520_2: -+ case PHYTIUM_PHY_TP_CP2520_3: -+ return true; -+ case PHYTIUM_PHY_TP_PRBS7: -+ case PHYTIUM_PHY_TP_80BIT_CUSTOM: -+ return false; -+ default: -+ return false; -+ } -+} -+ -+bool phytium_dp_scrambled_need_enable(unsigned char test_pattern) -+{ -+ switch (test_pattern) { -+ case PHYTIUM_PHY_TP_SYMBOL_ERROR: -+ case PHYTIUM_PHY_TP_CP2520_1: -+ case PHYTIUM_PHY_TP_CP2520_2: -+ case PHYTIUM_PHY_TP_CP2520_3: -+ return true; -+ case PHYTIUM_PHY_TP_D10_2: -+ case PHYTIUM_PHY_TP_PRBS7: -+ case PHYTIUM_PHY_TP_80BIT_CUSTOM: -+ return false; -+ default: -+ return false; -+ } -+} -+ -+static void phytium_dp_hw_set_lane_setting(struct phytium_dp_device *phytium_dp, -+ uint32_t link_rate, -+ uint8_t train_set) -+{ -+ phytium_dp->funcs->dp_hw_set_phy_lane_setting(phytium_dp, link_rate, train_set); -+} -+ -+static void phytium_dp_hw_set_link(struct phytium_dp_device *phytium_dp, -+ uint8_t lane_count, -+ uint32_t link_rate) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, ret = 0, retry = 3; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, lane_count, -+ group_offset, PHYTIUM_DP_LANE_COUNT_SET); -+ phytium_writel_reg(priv, -+ drm_dp_link_rate_to_bw_code(link_rate), -+ group_offset, PHYTIUM_DP_LINK_BW_SET); -+ -+ if (drm_dp_enhanced_frame_cap(phytium_dp->dpcd)) -+ phytium_writel_reg(priv, ENHANCED_FRAME_ENABLE, -+ group_offset, PHYTIUM_DP_ENHANCED_FRAME_EN); -+ else -+ phytium_writel_reg(priv, ENHANCED_FRAME_DISABLE, -+ group_offset, PHYTIUM_DP_ENHANCED_FRAME_EN); -+ -+try_again: -+ ret = phytium_dp->funcs->dp_hw_set_phy_lane_and_rate(phytium_dp, lane_count, link_rate); -+ if ((ret < 0) && retry) { -+ retry--; -+ goto try_again; -+ } -+} -+ -+static void phytium_dp_hw_set_test_pattern(struct phytium_dp_device *phytium_dp, -+ uint8_t lane_count, -+ uint8_t test_pattern, -+ uint8_t *custom_pattern, -+ uint32_t custom_pattern_size) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, val = 0, tmp = 0, i; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ if ((test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) -+ && custom_pattern && (custom_pattern_size > 0)) { -+ val = *(int *)custom_pattern; -+ phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_0); -+ val = *(int *)(custom_pattern + 4); -+ phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_1); -+ val = *(short int *)(custom_pattern + 8); -+ phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_2); -+ } -+ -+ if (test_pattern == PHYTIUM_PHY_TP_D10_2 || test_pattern == PHYTIUM_PHY_TP_PRBS7 -+ || test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) -+ phytium_writel_reg(priv, SCRAMBLING_DISABLE, group_offset, -+ PHYTIUM_DP_SCRAMBLING_DISABLE); -+ else -+ phytium_writel_reg(priv, SCRAMBLING_ENABLE, group_offset, -+ PHYTIUM_DP_SCRAMBLING_DISABLE); -+ -+ tmp = test_pattern - PHYTIUM_PHY_TP_NONE + TEST_PATTERN_NONE; -+ val = 0; -+ for (i = 0; i < lane_count; i++) -+ val |= (tmp << (TEST_PATTERN_LANE_SHIFT * i)); -+ phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_LINK_QUAL_PATTERN_SET); -+} -+ -+static void phytium_dp_hw_set_train_pattern(struct phytium_dp_device *phytium_dp, -+ uint8_t train_pattern) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, tmp = 0; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ /* Scrambling is disabled for TPS1/TPS2/3 and enabled for TPS4 */ -+ if (train_pattern == DP_TRAINING_PATTERN_4 -+ || train_pattern == DP_TRAINING_PATTERN_DISABLE) { -+ phytium_writel_reg(priv, SCRAMBLING_ENABLE, group_offset, -+ PHYTIUM_DP_SCRAMBLING_DISABLE); -+ phytium_writel_reg(priv, SCRAMBLER_RESET, group_offset, -+ PHYTIUM_DP_FORCE_SCRAMBLER_RESET); -+ } else { -+ phytium_writel_reg(priv, SCRAMBLING_DISABLE, group_offset, -+ PHYTIUM_DP_SCRAMBLING_DISABLE); -+ } -+ switch (train_pattern) { -+ case DP_TRAINING_PATTERN_DISABLE: -+ tmp = TRAINING_OFF; -+ break; -+ case DP_TRAINING_PATTERN_1: -+ tmp = TRAINING_PATTERN_1; -+ break; -+ case DP_TRAINING_PATTERN_2: -+ tmp = TRAINING_PATTERN_2; -+ break; -+ case DP_TRAINING_PATTERN_3: -+ tmp = TRAINING_PATTERN_3; -+ break; -+ case DP_TRAINING_PATTERN_4: -+ tmp = TRAINING_PATTERN_4; -+ break; -+ default: -+ tmp = TRAINING_OFF; -+ break; -+ } -+ -+ phytium_writel_reg(priv, tmp, group_offset, PHYTIUM_DP_TRAINING_PATTERN_SET); -+} -+ -+void phytium_dp_hw_enable_audio(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ int config = 0, config1, data_window = 0; -+ const struct dp_audio_n_m *n_m = NULL; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); -+ phytium_writel_reg(priv, CHANNEL_MUTE_ENABLE, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); -+ -+ data_window = 90*(phytium_dp->link_rate)/100 -+ *(phytium_dp->mode.htotal - phytium_dp->mode.hdisplay) -+ /phytium_dp->mode.clock/4; -+ -+ phytium_writel_reg(priv, data_window, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW); -+ -+ n_m = phytium_dp_audio_get_n_m(phytium_dp->link_rate, phytium_dp->audio_info.sample_rate); -+ if (n_m == NULL) { -+ DRM_NOTE("can not get n_m for link_rate(%d) and sample_rate(%d)\n", -+ phytium_dp->link_rate, phytium_dp->audio_info.sample_rate); -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_MAUD); -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_NAUD); -+ } else { -+ phytium_writel_reg(priv, n_m->m, group_offset, PHYTIUM_DP_SEC_MAUD); -+ phytium_writel_reg(priv, n_m->n, group_offset, PHYTIUM_DP_SEC_NAUD); -+ } -+ -+ config1 = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+ phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, -+ group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+ phytium_writel_reg(priv, config1, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+ phytium_writel_reg(priv, config, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); -+} -+ -+static void phytium_dp_hw_audio_shutdown(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, -+ group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+} -+ -+static void phytium_dp_hw_audio_digital_mute(struct phytium_dp_device *phytium_dp, bool enable) -+{ -+ struct phytium_display_private *priv = phytium_dp->dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ if (enable) -+ phytium_writel_reg(priv, CHANNEL_MUTE_ENABLE, -+ group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); -+ else -+ phytium_writel_reg(priv, SEC_AUDIO_ENABLE, -+ group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); -+} -+ -+static int -+phytium_dp_hw_audio_hw_params(struct phytium_dp_device *phytium_dp, struct audio_info audio_info) -+{ -+ struct phytium_display_private *priv = phytium_dp->dev->dev_private; -+ int port = phytium_dp->port; -+ int ret = 0, data_window = 0; -+ const struct dp_audio_n_m *n_m = NULL; -+ uint32_t fs, ws, fs_accurac; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ DRM_DEBUG_KMS("%s:set port%d sample_rate(%d) channels(%d) sample_width(%d)\n", -+ __func__, phytium_dp->port, audio_info.sample_rate, -+ audio_info.channels, audio_info.sample_width); -+ -+ phytium_writel_reg(priv, INPUT_SELECT_I2S, group_offset, PHYTIUM_DP_SEC_INPUT_SELECT); -+ phytium_writel_reg(priv, APB_CLOCK/audio_info.sample_rate, -+ group_offset, PHYTIUM_DP_SEC_DIRECT_CLKDIV); -+ phytium_writel_reg(priv, audio_info.channels & CHANNEL_MASK, -+ group_offset, PHYTIUM_DP_SEC_CHANNEL_COUNT); -+ phytium_writel_reg(priv, CHANNEL_MAP_DEFAULT, group_offset, PHYTIUM_DP_SEC_CHANNEL_MAP); -+ data_window = 90*(phytium_dp->link_rate)/100 -+ *(phytium_dp->mode.htotal - phytium_dp->mode.hdisplay) -+ /phytium_dp->mode.clock/4; -+ phytium_writel_reg(priv, data_window, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW); -+ phytium_writel_reg(priv, 0xb5, group_offset, PHYTIUM_DP_SEC_CS_CATEGORY_CODE); -+ -+ phytium_writel_reg(priv, CLOCK_MODE_SYNC, group_offset, PHYTIUM_DP_SEC_CLOCK_MODE); -+ phytium_writel_reg(priv, CS_SOURCE_FORMAT_DEFAULT, -+ group_offset, PHYTIUM_DP_SEC_CS_SOURCE_FORMAT); -+ -+ switch (audio_info.sample_rate) { -+ case 32000: -+ fs = ORIG_FREQ_32000; -+ fs_accurac = SAMPLING_FREQ_32000; -+ break; -+ case 44100: -+ fs = ORIG_FREQ_44100; -+ fs_accurac = SAMPLING_FREQ_44100; -+ break; -+ case 48000: -+ fs = ORIG_FREQ_48000; -+ fs_accurac = SAMPLING_FREQ_48000; -+ break; -+ case 96000: -+ fs = ORIG_FREQ_96000; -+ fs_accurac = SAMPLING_FREQ_96000; -+ break; -+ case 176400: -+ fs = ORIG_FREQ_176400; -+ fs_accurac = SAMPLING_FREQ_176400; -+ break; -+ case 192000: -+ fs = ORIG_FREQ_192000; -+ fs_accurac = SAMPLING_FREQ_192000; -+ break; -+ default: -+ DRM_ERROR("dp not support sample_rate %d\n", audio_info.sample_rate); -+ goto out; -+ } -+ -+ switch (audio_info.sample_width) { -+ case 16: -+ ws = WORD_LENGTH_16; -+ break; -+ case 18: -+ ws = WORD_LENGTH_18; -+ break; -+ case 20: -+ ws = WORD_LENGTH_20; -+ break; -+ case 24: -+ ws = WORD_LENGTH_24; -+ break; -+ default: -+ DRM_ERROR("dp not support sample_width %d\n", audio_info.sample_width); -+ goto out; -+ } -+ -+ phytium_writel_reg(priv, ((fs&ORIG_FREQ_MASK)<link_rate, audio_info.sample_rate); -+ if (n_m == NULL) { -+ DRM_NOTE("can not get n_m for link_rate(%d) and sample_rate(%d)\n", -+ phytium_dp->link_rate, audio_info.sample_rate); -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_MAUD); -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_NAUD); -+ -+ } else { -+ phytium_writel_reg(priv, n_m->m, group_offset, PHYTIUM_DP_SEC_MAUD); -+ phytium_writel_reg(priv, n_m->n, group_offset, PHYTIUM_DP_SEC_NAUD); -+ } -+ phytium_writel_reg(priv, SECONDARY_STREAM_ENABLE, -+ group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+ phytium_dp->audio_info = audio_info; -+ -+ return 0; -+ -+out: -+ phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, -+ group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); -+ -+ return ret; -+} -+ -+void phytium_dp_hw_disable_video(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, SST_MST_SOURCE_0_DISABLE, -+ group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); -+} -+ -+bool phytium_dp_hw_video_is_enable(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, config; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); -+ return config ? true : false; -+} -+ -+void phytium_dp_hw_enable_video(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, SST_MST_SOURCE_0_ENABLE, -+ group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); -+ phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); -+} -+ -+void phytium_dp_hw_config_video(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ unsigned long link_bw, date_rate = 0; -+ struct drm_display_info *display_info = &phytium_dp->connector.display_info; -+ unsigned char tu_size = 64; -+ unsigned long data_per_tu = 0; -+ int symbols_per_tu, frac_symbols_per_tu, symbol_count, udc, value; -+ -+ /* cal M/N and tu_size */ -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_clock/10, group_offset, PHYTIUM_DP_M_VID); -+ phytium_writel_reg(priv, phytium_dp->link_rate/10, group_offset, PHYTIUM_DP_N_VID); -+ link_bw = phytium_dp->link_rate * phytium_dp->link_lane_count; -+ date_rate = (phytium_dp->mode.crtc_clock * display_info->bpc * 3)/8; -+ -+ /* mul 10 for register setting */ -+ data_per_tu = 10*tu_size * date_rate/link_bw; -+ symbols_per_tu = (data_per_tu/10)&0xff; -+ if (symbols_per_tu == 63) -+ frac_symbols_per_tu = 0; -+ else -+ frac_symbols_per_tu = (data_per_tu%10*16/10) & 0xf; -+ phytium_writel_reg(priv, frac_symbols_per_tu<<24 | symbols_per_tu<<16 | tu_size, -+ group_offset, PHYTIUM_DP_TRANSFER_UNIT_SIZE); -+ -+ symbol_count = (phytium_dp->mode.crtc_hdisplay*display_info->bpc*3 + 7)/8; -+ udc = (symbol_count + phytium_dp->link_lane_count - 1)/phytium_dp->link_lane_count; -+ phytium_writel_reg(priv, udc, group_offset, PHYTIUM_DP_DATA_COUNT); -+ -+ /* config main stream attributes */ -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_htotal, -+ group_offset, PHYTIUM_DP_MAIN_LINK_HTOTAL); -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_hdisplay, -+ group_offset, PHYTIUM_DP_MAIN_LINK_HRES); -+ phytium_writel_reg(priv, -+ phytium_dp->mode.crtc_hsync_end - phytium_dp->mode.crtc_hsync_start, -+ group_offset, PHYTIUM_DP_MAIN_LINK_HSWIDTH); -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_htotal - phytium_dp->mode.crtc_hsync_start, -+ group_offset, PHYTIUM_DP_MAIN_LINK_HSTART); -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_vtotal, -+ group_offset, PHYTIUM_DP_MAIN_LINK_VTOTAL); -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_vdisplay, -+ group_offset, PHYTIUM_DP_MAIN_LINK_VRES); -+ phytium_writel_reg(priv, -+ phytium_dp->mode.crtc_vsync_end - phytium_dp->mode.crtc_vsync_start, -+ group_offset, PHYTIUM_DP_MAIN_LINK_VSWIDTH); -+ phytium_writel_reg(priv, phytium_dp->mode.crtc_vtotal - phytium_dp->mode.crtc_vsync_start, -+ group_offset, PHYTIUM_DP_MAIN_LINK_VSTART); -+ -+ value = 0; -+ if (phytium_dp->mode.flags & DRM_MODE_FLAG_PHSYNC) -+ value = value & (~HSYNC_POLARITY_LOW); -+ else -+ value = value | HSYNC_POLARITY_LOW; -+ -+ if (phytium_dp->mode.flags & DRM_MODE_FLAG_PVSYNC) -+ value = value & (~VSYNC_POLARITY_LOW); -+ else -+ value = value | VSYNC_POLARITY_LOW; -+ phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_MAIN_LINK_POLARITY); -+ -+ switch (display_info->bpc) { -+ case 10: -+ value = (MISC0_BIT_DEPTH_10BIT << MISC0_BIT_DEPTH_OFFSET); -+ break; -+ case 6: -+ value = (MISC0_BIT_DEPTH_6BIT << MISC0_BIT_DEPTH_OFFSET); -+ break; -+ default: -+ value = (MISC0_BIT_DEPTH_8BIT << MISC0_BIT_DEPTH_OFFSET); -+ break; -+ } -+ value |= (MISC0_COMPONENT_FORMAT_RGB << MISC0_COMPONENT_FORMAT_SHIFT) -+ | MISC0_SYNCHRONOUS_CLOCK; -+ phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_MAIN_LINK_MISC0); -+ phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_MAIN_LINK_MISC1); -+ -+ value = USER_ODDEVEN_POLARITY_HIGH | USER_DATA_ENABLE_POLARITY_HIGH; -+ if (phytium_dp->mode.flags & DRM_MODE_FLAG_PHSYNC) -+ value = value | USER_HSYNC_POLARITY_HIGH; -+ else -+ value = value & (~USER_HSYNC_POLARITY_HIGH); -+ if (phytium_dp->mode.flags & DRM_MODE_FLAG_PVSYNC) -+ value = value | USER_VSYNC_POLARITY_HIGH; -+ else -+ value = value & (~USER_VSYNC_POLARITY_HIGH); -+ phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_USER_SYNC_POLARITY); -+} -+ -+void phytium_dp_hw_disable_output(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, TRANSMITTER_OUTPUT_DISABLE, -+ group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); -+ phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); -+} -+ -+void phytium_dp_hw_enable_output(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); -+ phytium_writel_reg(priv, TRANSMITTER_OUTPUT_ENABLE, -+ group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); -+} -+ -+void phytium_dp_hw_enable_input_source(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_writel_reg(priv, VIRTUAL_SOURCE_0_ENABLE, -+ group_offset, PHYTIUM_INPUT_SOURCE_ENABLE); -+} -+ -+void phytium_dp_hw_disable_input_source(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ -+ phytium_writel_reg(priv, (~VIRTUAL_SOURCE_0_ENABLE)&VIRTUAL_SOURCE_0_ENABLE_MASK, -+ priv->dp_reg_base[port], PHYTIUM_INPUT_SOURCE_ENABLE); -+} -+ -+bool phytium_dp_hw_output_is_enable(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ int config = 0; -+ -+ config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); -+ return config ? true : false; -+} -+ -+static void phytium_dp_hw_get_hpd_state(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t val = 0, raw_state = 0; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ val = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_RAW_STATUS); -+ -+ /* maybe miss hpd, so used for clear PHYTIUM_DP_INTERRUPT_RAW_STATUS */ -+ phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); -+ raw_state = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SINK_HPD_STATE); -+ if (val & HPD_EVENT) -+ phytium_dp->dp_hpd_state.hpd_event_state = true; -+ -+ if (val & HPD_IRQ) -+ phytium_dp->dp_hpd_state.hpd_irq_state = true; -+ -+ if (raw_state & HPD_CONNECT) -+ phytium_dp->dp_hpd_state.hpd_raw_state = true; -+ else -+ phytium_dp->dp_hpd_state.hpd_raw_state = false; -+} -+ -+void phytium_dp_hw_hpd_irq_setup(struct phytium_dp_device *phytium_dp, bool enable) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dp_reg_base[port]; -+ -+ phytium_dp->dp_hpd_state.hpd_irq_enable = enable; -+ if (enable) -+ phytium_writel_reg(priv, HPD_OTHER_MASK, group_offset, PHYTIUM_DP_INTERRUPT_MASK); -+ else -+ phytium_writel_reg(priv, HPD_IRQ_MASK|HPD_EVENT_MASK|HPD_OTHER_MASK, -+ group_offset, PHYTIUM_DP_INTERRUPT_MASK); -+} -+ -+int phytium_dp_hw_init(struct phytium_dp_device *phytium_dp) -+{ -+ int ret = 0; -+ uint8_t count = 0; -+ -+ phytium_dp->source_rates = phytium_rate; -+ phytium_dp->num_source_rates = num_source_rates; -+ count = phytium_dp->funcs->dp_hw_get_source_lane_count(phytium_dp); -+ phytium_dp->source_max_lane_count = count; -+ -+ ret = phytium_dp->funcs->dp_hw_reset(phytium_dp); -+ if (ret) -+ goto out; -+ ret = phytium_dp->funcs->dp_hw_init_phy(phytium_dp); -+ if (ret) -+ goto out; -+ -+ phytium_dp->fast_train_support = false; -+ phytium_dp->hw_spread_enable = phytium_dp->funcs->dp_hw_spread_is_enable(phytium_dp); -+ -+out: -+ return ret; -+} -+ -+static int phytium_dp_dpcd_get_tp_link(struct phytium_dp_device *phytium_dp, -+ uint8_t *test_lane_count, -+ uint32_t *test_link_rate) -+{ -+ uint8_t test_link_bw; -+ int ret; -+ -+ ret = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_LANE_COUNT, -+ test_lane_count); -+ if (ret <= 0) { -+ DRM_DEBUG_KMS("test pattern Lane count read failed(%d)\n", ret); -+ goto failed; -+ } -+ -+ ret = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_LINK_RATE, -+ &test_link_bw); -+ if (ret <= 0) { -+ DRM_DEBUG_KMS("test pattern link rate read failed(%d)\n", ret); -+ goto failed; -+ } -+ *test_link_rate = drm_dp_bw_code_to_link_rate(test_link_bw); -+ -+ return 0; -+failed: -+ return ret; -+} -+ -+static int phytium_dp_dpcd_set_link(struct phytium_dp_device *phytium_dp, -+ uint8_t lane_count, uint32_t link_rate) -+{ -+ uint8_t link_config[2]; -+ int ret = 0; -+ -+ link_config[0] = drm_dp_link_rate_to_bw_code(link_rate); -+ link_config[1] = lane_count; -+ if (drm_dp_enhanced_frame_cap(phytium_dp->dpcd)) -+ link_config[1] |= DP_LANE_COUNT_ENHANCED_FRAME_EN; -+ ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_LINK_BW_SET, link_config, 2); -+ if (ret < 0) { -+ DRM_NOTE("write dpcd DP_LINK_BW_SET fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ if (phytium_dp->hw_spread_enable) -+ link_config[0] = DP_SPREAD_AMP_0_5; -+ else -+ link_config[0] = 0; -+ link_config[1] = DP_SET_ANSI_8B10B; -+ ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_DOWNSPREAD_CTRL, link_config, 2); -+ if (ret < 0) { -+ DRM_ERROR("write DP_DOWNSPREAD_CTRL fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ return 0; -+failed: -+ return ret; -+} -+ -+static int phytium_dp_dpcd_set_test_pattern(struct phytium_dp_device *phytium_dp, -+ uint8_t test_pattern) -+{ -+ unsigned char value; -+ int ret; -+ -+ if (phytium_dp_coding_8b10b_need_enable(test_pattern)) -+ value = DP_SET_ANSI_8B10B; -+ else -+ value = 0; -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_MAIN_LINK_CHANNEL_CODING_SET, value); -+ if (ret < 0) { -+ DRM_ERROR("write DP_MAIN_LINK_CHANNEL_CODING_SET fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ if (phytium_dp_scrambled_need_enable(test_pattern)) -+ value = DP_TRAINING_PATTERN_DISABLE; -+ else -+ value = (DP_TRAINING_PATTERN_DISABLE | DP_LINK_SCRAMBLING_DISABLE); -+ -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TRAINING_PATTERN_SET, value); -+ if (ret < 0) { -+ DRM_ERROR("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_LINK_QUAL_LANE0_SET, test_pattern); -+ if (ret < 0) { -+ DRM_ERROR("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ return 0; -+failed: -+ return ret; -+} -+ -+static int phytium_dp_dpcd_set_train_pattern(struct phytium_dp_device *phytium_dp, -+ uint8_t train_pattern) -+{ -+ uint8_t value; -+ int ret; -+ -+ /* Scrambling is disabled for TPS1/2/3 and enabled for TPS4 */ -+ if (train_pattern == DP_TRAINING_PATTERN_4 || train_pattern == DP_TRAINING_PATTERN_DISABLE) -+ value = train_pattern; -+ else -+ value = (train_pattern | DP_LINK_SCRAMBLING_DISABLE); -+ -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TRAINING_PATTERN_SET, value); -+ if (ret < 0) { -+ DRM_NOTE("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ return 0; -+failed: -+ return ret; -+} -+ -+static int -+phytium_dp_dpcd_set_lane_setting(struct phytium_dp_device *phytium_dp, uint8_t *train_set) -+{ -+ int ret = 0; -+ -+ ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_TRAINING_LANE0_SET, -+ phytium_dp->train_set, 4); -+ if (ret < 0) { -+ DRM_ERROR("write DP_TRAINING_LANE0_SET fail: ret:%d\n", ret); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static int -+phytium_dp_dpcd_get_adjust_request(struct phytium_dp_device *phytium_dp, uint8_t lane_count) -+{ -+ int ret = 0; -+ uint8_t link_status[DP_LINK_STATUS_SIZE]; -+ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, -+ link_status, DP_LINK_STATUS_SIZE); -+ if (ret < 0) { -+ DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); -+ goto failed; -+ } -+ phytium_get_adjust_train(phytium_dp, link_status, lane_count); -+ -+ return 0; -+failed: -+ return ret; -+} -+ -+void phytium_dp_dpcd_sink_dpms(struct phytium_dp_device *phytium_dp, int mode) -+{ -+ int ret, i; -+ -+ if (phytium_dp->dpcd[DP_DPCD_REV] < 0x11) -+ return; -+ if (mode != DRM_MODE_DPMS_ON) { -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_SET_POWER, DP_SET_POWER_D3); -+ } else { -+ for (i = 0; i < 3; i++) { -+ ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_SET_POWER, DP_SET_POWER_D0); -+ if (ret == 1) -+ break; -+ msleep(20); -+ } -+ } -+ -+ if (ret != 1) -+ DRM_DEBUG_KMS("failed to %s sink power state\n", -+ mode == DRM_MODE_DPMS_ON ? "enable" : "disable"); -+} -+ -+static bool phytium_dp_link_training_clock_recovery(struct phytium_dp_device *phytium_dp) -+{ -+ int ret; -+ unsigned char voltage, max_vswing_tries; -+ int voltage_tries; -+ -+ /* clear the test pattern */ -+ phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->link_lane_count, -+ PHYTIUM_PHY_TP_NONE, NULL, 0); -+ -+ /* config source and sink's link rate and lane count */ -+ phytium_dp_hw_set_link(phytium_dp, phytium_dp->link_lane_count, phytium_dp->link_rate); -+ ret = phytium_dp_dpcd_set_link(phytium_dp, phytium_dp->link_lane_count, -+ phytium_dp->link_rate); -+ if (ret < 0) { -+ DRM_NOTE("phytium_dp_dpcd_set_link failed(ret=%d)\n", ret); -+ return false; -+ } -+ -+ /* config source's voltage swing and pre-emphasis(103-106) */ -+ memset(phytium_dp->train_set, 0, sizeof(phytium_dp->train_set)); -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, -+ phytium_dp->train_set[0]); -+ -+ /* config train pattern */ -+ phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); -+ ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); -+ return false; -+ } -+ -+ /* config sink's voltage swing and pre-emphasis(103-106) */ -+ ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); -+ return false; -+ } -+ -+ voltage_tries = 1; -+ max_vswing_tries = 0; -+ for (;;) { -+ unsigned char link_status[DP_LINK_STATUS_SIZE]; -+ -+ drm_dp_link_train_clock_recovery_delay(&phytium_dp->aux, phytium_dp->dpcd); -+ /* get link status 0x202-0x207 */ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, -+ link_status, DP_LINK_STATUS_SIZE); -+ if (ret < 0) { -+ DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); -+ return false; -+ } -+ -+ if (drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("clock revorery ok\n"); -+ return true; -+ } -+ -+ if (voltage_tries == 5) { -+ DRM_DEBUG_KMS("Same voltage tried 5 times\n"); -+ return false; -+ } -+ -+ if (max_vswing_tries == 1) { -+ DRM_DEBUG_KMS("Max Voltage Swing reached\n"); -+ return false; -+ } -+ -+ voltage = phytium_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK; -+ -+ /* config source and sink's voltage swing and pre-emphasis(103-106) */ -+ phytium_get_adjust_train(phytium_dp, link_status, phytium_dp->link_lane_count); -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, -+ phytium_dp->train_set[0]); -+ ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); -+ return false; -+ } -+ -+ if ((phytium_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK) == voltage) -+ ++voltage_tries; -+ else -+ voltage_tries = 1; -+ -+ if (phytium_dp->train_set[0] & DP_TRAIN_MAX_SWING_REACHED) -+ ++max_vswing_tries; -+ -+ DRM_DEBUG_KMS("try train_set:0x%x voltage_tries:%d max_vswing_tries:%d\n", -+ phytium_dp->train_set[0], voltage_tries, max_vswing_tries); -+ } -+} -+ -+static unsigned int phytium_dp_get_training_pattern(struct phytium_dp_device *phytium_dp) -+{ -+ bool sink_tps3, sink_tps4; -+ -+ sink_tps4 = drm_dp_tps4_supported(phytium_dp->dpcd); -+ if (sink_tps4) -+ return DP_TRAINING_PATTERN_4; -+ else if (phytium_dp->link_rate == 810000) -+ DRM_DEBUG_KMS("8.1 Gbps link rate without sink TPS4 support\n"); -+ -+ sink_tps3 = drm_dp_tps3_supported(phytium_dp->dpcd); -+ if (sink_tps3) -+ return DP_TRAINING_PATTERN_3; -+ else if (phytium_dp->link_rate >= 540000) -+ DRM_DEBUG_KMS(">=5.4/6.48 Gbps link rate without sink TPS3 support\n"); -+ -+ return DP_TRAINING_PATTERN_2; -+} -+ -+static bool phytium_dp_link_training_channel_equalization(struct phytium_dp_device *phytium_dp) -+{ -+ unsigned int training_pattern; -+ int tries, ret; -+ unsigned char link_status[DP_LINK_STATUS_SIZE]; -+ bool channel_eq = false; -+ -+ /* config source and sink's voltage swing and pre-emphasis(103-106), from clock recovery */ -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, -+ phytium_dp->train_set[0]); -+ ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); -+ return channel_eq; -+ } -+ -+ /* config source and sink's train_pattern x */ -+ training_pattern = phytium_dp_get_training_pattern(phytium_dp); -+ phytium_dp_hw_set_train_pattern(phytium_dp, training_pattern); -+ ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, training_pattern); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); -+ return channel_eq; -+ } -+ -+ for (tries = 0; tries < 5; tries++) { -+ drm_dp_link_train_channel_eq_delay(&phytium_dp->aux, phytium_dp->dpcd); -+ -+ /* get link status 0x202-0x207 */ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, -+ link_status, DP_LINK_STATUS_SIZE); -+ if (ret < 0) { -+ DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); -+ break; -+ } -+ -+ /* Make sure clock is still ok */ -+ if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("CR check failed, cannot continue channel equalization\n"); -+ break; -+ } -+ -+ if (drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { -+ channel_eq = true; -+ DRM_DEBUG_KMS("Channel EQ done. DP Training successful\n"); -+ break; -+ } -+ -+ /* config source and sink's voltage swing and pre-emphasis(103-106) */ -+ phytium_get_adjust_train(phytium_dp, link_status, phytium_dp->link_lane_count); -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, -+ phytium_dp->train_set[0]); -+ ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); -+ break; -+ } -+ } -+ -+ /* Try 5 times, else fail and try at lower BW */ -+ if (tries == 5) -+ DRM_DEBUG_KMS("Channel equalization failed 5 times\n"); -+ -+ return channel_eq; -+} -+ -+static void phytium_dp_train_retry_work_fn(struct work_struct *work) -+{ -+ struct phytium_dp_device *phytium_dp = train_retry_to_dp_device(work); -+ struct drm_connector *connector; -+ -+ connector = &phytium_dp->connector; -+ DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector->base.id, connector->name); -+ mutex_lock(&connector->dev->mode_config.mutex); -+ drm_connector_set_link_status_property(connector, DRM_MODE_LINK_STATUS_BAD); -+ mutex_unlock(&connector->dev->mode_config.mutex); -+ drm_kms_helper_hotplug_event(connector->dev); -+} -+ -+/* return index of rate in rates array, or -1 if not found */ -+static int phytium_dp_rate_index(const int *rates, int len, int rate) -+{ -+ int i; -+ -+ for (i = 0; i < len; i++) -+ if (rate == rates[i]) -+ return i; -+ -+ return -1; -+} -+ -+int phytium_dp_get_link_train_fallback_values(struct phytium_dp_device *phytium_dp) -+{ -+ int index, ret = 0; -+ -+ if (phytium_dp->is_edp) { -+ phytium_dp->train_retry_count++; -+ DRM_INFO("Retrying Link training for eDP(%d) with same parameters\n", -+ phytium_dp->port); -+ goto out; -+ } else { -+ index = phytium_dp_rate_index(phytium_dp->common_rates, -+ phytium_dp->num_common_rates, -+ phytium_dp->link_rate); -+ if (index > 0) { -+ phytium_dp->link_rate = phytium_dp->common_rates[index - 1]; -+ } else if (phytium_dp->link_lane_count > 1) { -+ phytium_dp->link_rate = phytium_dp->max_link_rate; -+ phytium_dp->link_lane_count = phytium_dp->link_lane_count >> 1; -+ } else { -+ phytium_dp->train_retry_count++; -+ phytium_dp->link_rate = phytium_dp->max_link_rate; -+ phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; -+ DRM_INFO("Retrying Link training for DP(%d) with maximal parameters\n", -+ phytium_dp->port); -+ ret = -1; -+ } -+ } -+ -+out: -+ return ret; -+} -+ -+static int -+phytium_dp_stop_link_train(struct phytium_dp_device *phytium_dp) -+{ -+ int ret; -+ -+ /* config source and sink's train_pattern x: DP_TRAINING_PATTERN_DISABLE */ -+ phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); -+ -+ ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); -+ if (ret < 0) { -+ DRM_NOTE("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+int phytium_dp_start_link_train(struct phytium_dp_device *phytium_dp) -+{ -+ int ret = 0; -+ -+ phytium_dp_hw_disable_output(phytium_dp); -+ phytium_dp_hw_disable_input_source(phytium_dp); -+ phytium_dp_hw_disable_video(phytium_dp); -+ phytium_dp_hw_enable_input_source(phytium_dp); -+ phytium_dp_hw_enable_output(phytium_dp); -+ phytium_dp_dpcd_sink_dpms(phytium_dp, DRM_MODE_DPMS_OFF); -+ phytium_dp_dpcd_sink_dpms(phytium_dp, DRM_MODE_DPMS_ON); -+ -+ if (!phytium_dp_link_training_clock_recovery(phytium_dp)) -+ goto failure_handling; -+ -+ if (!phytium_dp_link_training_channel_equalization(phytium_dp)) -+ goto failure_handling; -+ -+ ret = phytium_dp_stop_link_train(phytium_dp); -+ if (ret < 0) { -+ DRM_NOTE("phytium_dp_stop_link_train failed: ret = %d\n", ret); -+ goto out; -+ } -+ -+ if (phytium_dp->trigger_train_fail) { -+ phytium_dp->trigger_train_fail--; -+ goto failure_handling; -+ } -+ phytium_dp->train_retry_count = 0; -+ -+ DRM_DEBUG_KMS("[CONNECTOR:%d:%s] Link Training Pass at Link Rate = %d, Lane count = %d\n", -+ phytium_dp->connector.base.id, -+ phytium_dp->connector.name, phytium_dp->link_rate, -+ phytium_dp->link_lane_count); -+ -+ return 0; -+ -+failure_handling: -+ DRM_INFO("[CONNECTOR:%d:%s] Link Training failed at Link Rate = %d, Lane count = %d", -+ phytium_dp->connector.base.id, -+ phytium_dp->connector.name, -+ phytium_dp->link_rate, phytium_dp->link_lane_count); -+ -+ ret = phytium_dp_stop_link_train(phytium_dp); -+ if (ret < 0) { -+ DRM_NOTE("phytium_dp_stop_link_train failed: ret = %d\n", ret); -+ goto out; -+ } -+ -+ phytium_dp_get_link_train_fallback_values(phytium_dp); -+ if (phytium_dp->train_retry_count < 5) -+ schedule_work(&phytium_dp->train_retry_work); -+ else -+ DRM_ERROR("DP(%d) Link Training Unsuccessful, and stop Training\n", -+ phytium_dp->port); -+ -+out: -+ return -1; -+} -+ -+static bool phytium_dp_needs_link_retrain(struct phytium_dp_device *phytium_dp) -+{ -+ unsigned char link_status[DP_LINK_STATUS_SIZE]; -+ int ret = 0; -+ -+ /* get link status 0x202-0x207 */ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, -+ link_status, DP_LINK_STATUS_SIZE); -+ if (ret < 0) { -+ DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); -+ return true; -+ } -+ -+ if ((phytium_dp->link_rate == 0) || (phytium_dp->link_lane_count == 0)) { -+ DRM_DEBUG_KMS("link_rate(%d) or lane_count(%d) is invalid\n", -+ phytium_dp->link_rate, phytium_dp->link_lane_count); -+ return true; -+ } -+ -+ /* Make sure clock is still ok */ -+ if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("Clock recovery check failed\n"); -+ return true; -+ } -+ -+ if (!drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("Channel EQ check failed\n"); -+ return true; -+ } -+ -+ if (!phytium_dp_hw_output_is_enable(phytium_dp)) { -+ DRM_DEBUG_KMS("check DP output enable failed\n"); -+ return true; -+ } -+ return false; -+} -+ -+static bool -+phytium_dp_get_sink_irq(struct phytium_dp_device *phytium_dp, u8 *sink_irq_vector) -+{ -+ return drm_dp_dpcd_readb(&phytium_dp->aux, DP_DEVICE_SERVICE_IRQ_VECTOR, -+ sink_irq_vector) == 1; -+} -+ -+static uint8_t phytium_dp_autotest_phy_pattern(struct phytium_dp_device *phytium_dp) -+{ -+ union phytium_phy_tp phytium_phy_tp; -+ int ret; -+ unsigned char test_80_bit_pattern[ -+ (DP_TEST_80BIT_CUSTOM_PATTERN_79_72 - -+ DP_TEST_80BIT_CUSTOM_PATTERN_7_0)+1] = {0}; -+ unsigned char test_pattern; -+ unsigned int offset; -+ -+ offset = DP_PHY_TEST_PATTERN; -+ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, offset, -+ &phytium_phy_tp.raw, -+ sizeof(phytium_phy_tp)); -+ if (ret <= 0) { -+ DRM_DEBUG_KMS("Could not read DP_TEST_PHY_PATTERN\n"); -+ goto failed; -+ } -+ -+ test_pattern = phytium_phy_tp.bits.PATTERN; -+ -+ if (test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) { -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_TEST_80BIT_CUSTOM_PATTERN_7_0, -+ test_80_bit_pattern, -+ sizeof(test_80_bit_pattern)); -+ if (ret <= 0) { -+ DRM_DEBUG_KMS("Could not read DP_TEST_PHY_PATTERN\n"); -+ goto failed; -+ } -+ } -+ -+ /* config source and sink's link rate and link count */ -+ ret = phytium_dp_dpcd_get_tp_link(phytium_dp, &phytium_dp->compliance.test_lane_count, -+ &phytium_dp->compliance.test_link_rate); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_get_tp_link fail: ret:%d\n", ret); -+ goto failed; -+ } -+ -+ phytium_dp_hw_set_link(phytium_dp, phytium_dp->compliance.test_lane_count, -+ phytium_dp->compliance.test_link_rate); -+ ret = phytium_dp_dpcd_set_link(phytium_dp, phytium_dp->compliance.test_lane_count, -+ phytium_dp->compliance.test_link_rate); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_link fail: ret:%d\n", ret); -+ goto failed_dpcd_set_link; -+ } -+ -+ /* config source and sink's lane setting: voltage swing and pre-emphasis */ -+ ret = phytium_dp_dpcd_get_adjust_request(phytium_dp, -+ phytium_dp->compliance.test_lane_count); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_get_adjust_request fail: ret:%d\n", ret); -+ goto failed_dpcd_get_adjust_request; -+ } -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->compliance.test_link_rate, -+ phytium_dp->train_set[0]); -+ ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); -+ goto failed_dpcd_set_lane_setting; -+ } -+ -+ /* config test pattern */ -+ phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->compliance.test_lane_count, -+ test_pattern, test_80_bit_pattern, -+ sizeof(test_80_bit_pattern)); -+ ret = phytium_dp_dpcd_set_test_pattern(phytium_dp, test_pattern); -+ if (ret < 0) { -+ DRM_ERROR("phytium_dp_dpcd_set_test_pattern fail: ret:%d\n", ret); -+ goto failed_dpcd_set_tp; -+ } -+ -+ return DP_TEST_ACK; -+ -+failed_dpcd_set_tp: -+ phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->compliance.test_lane_count, -+ PHYTIUM_PHY_TP_NONE, test_80_bit_pattern, -+ sizeof(test_80_bit_pattern)); -+failed_dpcd_set_link: -+failed_dpcd_set_lane_setting: -+failed_dpcd_get_adjust_request: -+failed: -+ return DP_TEST_NAK; -+} -+ -+static void phytium_dp_handle_test_request(struct phytium_dp_device *phytium_dp) -+{ -+ uint8_t response = DP_TEST_NAK; -+ uint8_t request = 0; -+ int status; -+ -+ status = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_REQUEST, &request); -+ if (status <= 0) { -+ DRM_DEBUG_KMS("Could not read test request from sink\n"); -+ goto update_status; -+ } -+ -+ switch (request) { -+ case DP_TEST_LINK_TRAINING: -+ case DP_TEST_LINK_VIDEO_PATTERN: -+ case DP_TEST_LINK_EDID_READ: -+ DRM_DEBUG_KMS("Not support test request '%02x'\n", request); -+ response = DP_TEST_NAK; -+ break; -+ case DP_TEST_LINK_PHY_TEST_PATTERN: -+ DRM_DEBUG_KMS("PHY_PATTERN test requested\n"); -+ response = phytium_dp_autotest_phy_pattern(phytium_dp); -+ break; -+ default: -+ DRM_DEBUG_KMS("Invalid test request '%02x'\n", request); -+ break; -+ } -+ -+update_status: -+ status = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TEST_RESPONSE, response); -+ if (status <= 0) -+ DRM_DEBUG_KMS("Could not write test response to sink\n"); -+ -+} -+ -+static int phytium_dp_long_pulse(struct drm_connector *connector, bool hpd_raw_state) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ enum drm_connector_status status = connector->status; -+ bool video_enable = false; -+ uint32_t index = 0; -+ struct edid *edid = NULL; -+ -+ if (phytium_dp->is_edp) -+ status = connector_status_connected; -+ else if (hpd_raw_state) { -+ if (!phytium_dp_needs_link_retrain(phytium_dp)) { -+ status = connector_status_connected; -+ goto out; -+ } -+ } else { -+ status = connector_status_disconnected; -+ goto out; -+ } -+ -+ if (!phytium_dp->is_edp) { -+ status = phytium_dp_detect_dpcd(phytium_dp); -+ if (status == connector_status_disconnected) -+ goto out; -+ -+ index = phytium_dp->num_common_rates-1; -+ phytium_dp->max_link_rate = phytium_dp->common_rates[index]; -+ phytium_dp->max_link_lane_count = phytium_dp->common_max_lane_count; -+ phytium_dp->link_rate = phytium_dp->max_link_rate; -+ phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; -+ DRM_DEBUG_KMS("common_max_lane_count: %d, common_max_rate:%d\n", -+ phytium_dp->max_link_lane_count, phytium_dp->max_link_rate); -+ -+ video_enable = phytium_dp_hw_video_is_enable(phytium_dp); -+ phytium_dp_start_link_train(phytium_dp); -+ -+ if (video_enable) { -+ mdelay(2); -+ phytium_dp_hw_enable_video(phytium_dp); -+ } -+ -+ edid = drm_get_edid(connector, &phytium_dp->aux.ddc); -+ -+ if (edid && drm_edid_is_valid(edid)) -+ phytium_dp->has_audio = drm_detect_monitor_audio(edid); -+ else -+ phytium_dp->has_audio = false; -+ -+ kfree(edid); -+ } -+ -+out: -+ return status; -+} -+ -+static int phytium_dp_short_pulse(struct drm_connector *connector) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ enum drm_connector_status status = connector->status; -+ u8 sink_irq_vector = 0; -+ bool video_enable = false; -+ -+ /* handle the test pattern */ -+ if (phytium_dp_get_sink_irq(phytium_dp, &sink_irq_vector) && -+ sink_irq_vector != 0) { -+ drm_dp_dpcd_writeb(&phytium_dp->aux, -+ DP_DEVICE_SERVICE_IRQ_VECTOR, -+ sink_irq_vector); -+ if (sink_irq_vector & DP_AUTOMATED_TEST_REQUEST) -+ phytium_dp_handle_test_request(phytium_dp); -+ if (sink_irq_vector & (DP_CP_IRQ | DP_SINK_SPECIFIC_IRQ)) -+ DRM_DEBUG_DRIVER("CP or sink specific irq unhandled\n"); -+ } -+ if (!phytium_dp_needs_link_retrain(phytium_dp)) { -+ status = connector_status_connected; -+ goto out; -+ } -+ -+ video_enable = phytium_dp_hw_video_is_enable(phytium_dp); -+ phytium_dp_start_link_train(phytium_dp); -+ if (video_enable) { -+ mdelay(2); -+ phytium_dp_hw_enable_video(phytium_dp); -+ } -+ -+out: -+ return status; -+} -+ -+void phytium_dp_hpd_poll_handler(struct phytium_display_private *priv) -+{ -+ struct drm_device *dev = priv->dev; -+ struct drm_connector_list_iter conn_iter; -+ struct drm_connector *connector; -+ enum drm_connector_status old_status; -+ bool changed = false; -+ -+ mutex_lock(&dev->mode_config.mutex); -+ DRM_DEBUG_KMS("running encoder hotplug poll functions\n"); -+ drm_connector_list_iter_begin(dev, &conn_iter); -+ drm_for_each_connector_iter(connector, &conn_iter) { -+ if (connector->force) -+ continue; -+ old_status = connector->status; -+ connector->status = drm_helper_probe_detect(connector, NULL, false); -+ if (old_status != connector->status) { -+ const char *old, *new; -+ -+ old = drm_get_connector_status_name(old_status); -+ new = drm_get_connector_status_name(connector->status); -+ DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n", -+ connector->base.id, -+ connector->name, -+ old, new); -+ changed = true; -+ } -+ } -+ drm_connector_list_iter_end(&conn_iter); -+ mutex_unlock(&dev->mode_config.mutex); -+ -+ if (changed) -+ drm_kms_helper_hotplug_event(dev); -+} -+ -+void phytium_dp_hpd_irq_setup(struct drm_device *dev, bool enable) -+{ -+ struct phytium_dp_device *phytium_dp; -+ struct drm_encoder *encoder; -+ struct phytium_display_private *priv = dev->dev_private; -+ bool handler = false; -+ bool hpd_raw_state_old = false; -+ -+ /* We might have missed any hotplugs that happened, so polling and handler */ -+ if (enable) { -+ spin_lock_irq(&priv->hotplug_irq_lock); -+ -+ drm_for_each_encoder(encoder, dev) { -+ phytium_dp = encoder_to_dp_device(encoder); -+ if (!phytium_dp->dp_hpd_state.hpd_irq_enable) { -+ hpd_raw_state_old = phytium_dp->dp_hpd_state.hpd_raw_state; -+ phytium_dp_hw_get_hpd_state(phytium_dp); -+ if (phytium_dp->dp_hpd_state.hpd_event_state -+ || phytium_dp->dp_hpd_state.hpd_irq_state -+ || (hpd_raw_state_old != phytium_dp->dp_hpd_state.hpd_raw_state)) { -+ handler = true; -+ } -+ } -+ } -+ spin_unlock_irq(&priv->hotplug_irq_lock); -+ if (handler) -+ phytium_dp_hpd_poll_handler(priv); -+ } -+ -+ drm_for_each_encoder(encoder, dev) { -+ phytium_dp = encoder_to_dp_device(encoder); -+ phytium_dp_hw_hpd_irq_setup(phytium_dp, enable); -+ } -+} -+ -+void phytium_dp_hpd_work_func(struct work_struct *work) -+{ -+ struct phytium_display_private *priv = -+ container_of(work, struct phytium_display_private, hotplug_work); -+ struct drm_device *dev = priv->dev; -+ struct drm_connector_list_iter conn_iter; -+ struct drm_connector *connector; -+ enum drm_connector_status old_status; -+ bool changed = false; -+ -+ mutex_lock(&dev->mode_config.mutex); -+ DRM_DEBUG_KMS("running encoder hotplug work functions\n"); -+ drm_connector_list_iter_begin(dev, &conn_iter); -+ drm_for_each_connector_iter(connector, &conn_iter) { -+ if (connector->force) -+ continue; -+ old_status = connector->status; -+ connector->status = drm_helper_probe_detect(connector, NULL, false); -+ if (old_status != connector->status) { -+ const char *old, *new; -+ -+ old = drm_get_connector_status_name(old_status); -+ new = drm_get_connector_status_name(connector->status); -+ DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n", -+ connector->base.id, -+ connector->name, -+ old, new); -+ changed = true; -+ } -+ } -+ drm_connector_list_iter_end(&conn_iter); -+ mutex_unlock(&dev->mode_config.mutex); -+ -+ if (changed) -+ drm_kms_helper_hotplug_event(dev); -+ -+ phytium_dp_hpd_irq_setup(dev, true); -+} -+ -+irqreturn_t phytium_dp_hpd_irq_handler(struct phytium_display_private *priv) -+{ -+ struct drm_encoder *encoder = NULL; -+ struct phytium_dp_device *phytium_dp = NULL; -+ struct drm_device *dev = priv->dev; -+ bool handler = false; -+ -+ spin_lock(&priv->hotplug_irq_lock); -+ -+ drm_for_each_encoder(encoder, dev) { -+ phytium_dp = encoder_to_dp_device(encoder); -+ if (phytium_dp->dp_hpd_state.hpd_irq_enable) { -+ phytium_dp_hw_get_hpd_state(phytium_dp); -+ if (phytium_dp->dp_hpd_state.hpd_event_state -+ || phytium_dp->dp_hpd_state.hpd_irq_state) { -+ handler = true; -+ } -+ } -+ } -+ spin_unlock(&priv->hotplug_irq_lock); -+ -+ if (handler) { -+ phytium_dp_hpd_irq_setup(dev, false); -+ schedule_work(&priv->hotplug_work); -+ return IRQ_HANDLED; -+ } -+ return IRQ_NONE; -+} -+ -+ -+static void phytium_dp_fast_link_train_detect(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_dp->fast_train_support = !!(phytium_dp->dpcd[DP_MAX_DOWNSPREAD] -+ & DP_NO_AUX_HANDSHAKE_LINK_TRAINING); -+ DRM_DEBUG_KMS("fast link training %s\n", -+ phytium_dp->fast_train_support ? "supported" : "unsupported"); -+} -+ -+bool phytium_dp_fast_link_train(struct phytium_dp_device *phytium_dp) -+{ -+ int ret = 0; -+ unsigned int training_pattern; -+ -+ /* clear the test pattern */ -+ phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->link_lane_count, -+ PHYTIUM_PHY_TP_NONE, NULL, 0); -+ -+ /* config source and sink's link rate and lane count */ -+ phytium_dp_hw_set_link(phytium_dp, phytium_dp->link_lane_count, phytium_dp->link_rate); -+ -+ /* config source and sink's voltage swing and pre-emphasis(103-106) */ -+ phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, -+ phytium_dp->train_set[0]); -+ -+ /* config train pattern */ -+ phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); -+ usleep_range(500, 600); -+ -+ training_pattern = phytium_dp_get_training_pattern(phytium_dp); -+ phytium_dp_hw_set_train_pattern(phytium_dp, training_pattern); -+ usleep_range(500, 600); -+ -+ phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); -+ -+ if (dc_fast_training_check) { -+ unsigned char link_status[DP_LINK_STATUS_SIZE]; -+ -+ ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, -+ link_status, DP_LINK_STATUS_SIZE); -+ if (ret < 0) { -+ DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); -+ return false; -+ } -+ -+ if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("check clock recovery failed\n"); -+ return false; -+ } -+ -+ if (!drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { -+ DRM_DEBUG_KMS("check channel equalization failed\n"); -+ return false; -+ } -+ } -+ -+ return true; -+} -+ -+static enum drm_connector_status -+phytium_connector_detect(struct drm_connector *connector, bool force) -+{ -+ enum drm_connector_status status = connector->status; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ bool hpd_event_state, hpd_irq_state, hpd_raw_state; -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ bool plugged = true; -+ -+ spin_lock_irq(&priv->hotplug_irq_lock); -+ hpd_event_state = phytium_dp->dp_hpd_state.hpd_event_state; -+ hpd_irq_state = phytium_dp->dp_hpd_state.hpd_irq_state; -+ hpd_raw_state = phytium_dp->dp_hpd_state.hpd_raw_state; -+ phytium_dp->dp_hpd_state.hpd_event_state = false; -+ phytium_dp->dp_hpd_state.hpd_irq_state = false; -+ spin_unlock_irq(&priv->hotplug_irq_lock); -+ -+ if (hpd_event_state) -+ status = phytium_dp_long_pulse(connector, hpd_raw_state); -+ -+ if (hpd_irq_state) -+ status = phytium_dp_short_pulse(connector); -+ -+ if (status == connector_status_unknown) -+ status = connector_status_disconnected; -+ -+ if ((!phytium_dp->is_edp) && (!hpd_raw_state)) -+ status = connector_status_disconnected; -+ -+ if (connector->status != status) { -+ if ((status == connector_status_connected) && phytium_dp->has_audio) -+ plugged = true; -+ else -+ plugged = false; -+ -+ handle_plugged_change(phytium_dp, plugged); -+ } -+ -+ return status; -+} -+ -+static void -+phytium_connector_destroy(struct drm_connector *connector) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ drm_connector_cleanup(connector); -+ kfree(phytium_dp); -+} -+ -+static int -+phytium_dp_connector_register(struct drm_connector *connector) -+{ -+ int ret; -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ phytium_dp_aux_init(phytium_dp); -+ if (phytium_dp->is_edp) { -+ phytium_edp_init_connector(phytium_dp); -+ ret = phytium_edp_backlight_device_register(phytium_dp); -+ if (ret) -+ DRM_ERROR("failed to register port(%d) backlight device(ret=%d)\n", -+ phytium_dp->port, ret); -+ } -+ -+ ret = phytium_debugfs_connector_add(connector); -+ if (ret) -+ DRM_ERROR("failed to register phytium connector debugfs(ret=%d)\n", ret); -+ -+ return 0; -+} -+ -+static void -+phytium_dp_connector_unregister(struct drm_connector *connector) -+{ -+ struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); -+ -+ if (phytium_dp->is_edp) { -+ phytium_edp_backlight_device_unregister(phytium_dp); -+ phytium_edp_fini_connector(phytium_dp); -+ } -+ drm_dp_aux_unregister(&phytium_dp->aux); -+} -+ -+static const struct drm_connector_funcs phytium_connector_funcs = { -+ .dpms = drm_helper_connector_dpms, -+ .detect = phytium_connector_detect, -+ .fill_modes = drm_helper_probe_single_connector_modes, -+ .destroy = phytium_connector_destroy, -+ .reset = drm_atomic_helper_connector_reset, -+ .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, -+ .late_register = phytium_dp_connector_register, -+ .early_unregister = phytium_dp_connector_unregister, -+}; -+ -+static void phytium_dp_encoder_mode_set(struct drm_encoder *encoder, -+ struct drm_display_mode *mode, -+ struct drm_display_mode *adjusted) -+{ -+ struct phytium_dp_device *dp = encoder_to_dp_device(encoder); -+ -+ drm_mode_copy(&dp->mode, adjusted); -+} -+ -+static void phytium_edp_panel_poweron(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_panel_poweron(&phytium_dp->panel); -+} -+ -+static void phytium_edp_panel_poweroff(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_panel_poweroff(&phytium_dp->panel); -+} -+ -+static void phytium_edp_backlight_on(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_panel_enable_backlight(&phytium_dp->panel); -+} -+ -+static void phytium_edp_backlight_off(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_panel_disable_backlight(&phytium_dp->panel); -+} -+ -+static void phytium_encoder_disable(struct drm_encoder *encoder) -+{ -+ struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); -+ -+ if (phytium_dp->is_edp) -+ phytium_edp_backlight_off(phytium_dp); -+ -+ phytium_dp_hw_disable_video(phytium_dp); -+ -+ mdelay(50); -+ -+ if (phytium_dp->is_edp) -+ phytium_edp_panel_poweroff(phytium_dp); -+} -+ -+void phytium_dp_adjust_link_train_parameter(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_display_info *display_info = &phytium_dp->connector.display_info; -+ unsigned long link_bw, date_rate = 0, bs_limit, bs_request; -+ int rate = 0; -+ -+ bs_request = phytium_dp->mode.crtc_htotal/(phytium_dp->mode.crtc_clock/1000); -+ date_rate = (phytium_dp->mode.crtc_clock * display_info->bpc * 3)/8; -+ -+ for (;;) { -+ bs_limit = 8192 / (phytium_dp->link_rate/1000); -+ link_bw = phytium_dp->link_rate * phytium_dp->link_lane_count; -+ rate = 10 * date_rate / link_bw; -+ DRM_DEBUG_KMS("adjust link rate(%d), lane count(%d)\n", -+ phytium_dp->link_rate, phytium_dp->link_lane_count); -+ DRM_DEBUG_KMS("for crtc_clock(%d) bs_request(%ld) bs_limit(%ld) rate(%d)\n", -+ phytium_dp->mode.crtc_clock, bs_request, bs_limit, rate); -+ if ((link_dynamic_adjust && (bs_request < bs_limit) && rate < 10) || -+ ((!link_dynamic_adjust) && (rate < 10))) -+ break; -+ phytium_dp_get_link_train_fallback_values(phytium_dp); -+ } -+ -+ DRM_DEBUG_KMS("Try link training at Link Rate = %d, Lane count = %d\n", -+ phytium_dp->link_rate, phytium_dp->link_lane_count); -+} -+ -+static void phytium_encoder_enable(struct drm_encoder *encoder) -+{ -+ struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); -+ int ret = 0; -+ -+ phytium_dp_hw_disable_video(phytium_dp); -+ -+ if (phytium_dp->is_edp) { -+ phytium_edp_panel_poweron(phytium_dp); -+ if (phytium_dp->fast_train_support) -+ phytium_dp_fast_link_train(phytium_dp); -+ else -+ ret = phytium_dp_start_link_train(phytium_dp); -+ mdelay(2); -+ phytium_dp_fast_link_train_detect(phytium_dp); -+ } else { -+ phytium_dp_adjust_link_train_parameter(phytium_dp); -+ ret = phytium_dp_start_link_train(phytium_dp); -+ mdelay(2); -+ } -+ -+ phytium_dp_hw_config_video(phytium_dp); -+ if (ret == 0) { -+ phytium_dp_hw_enable_video(phytium_dp); -+ if (phytium_dp->has_audio) -+ phytium_dp_hw_enable_audio(phytium_dp); -+ } -+ -+ if (phytium_dp->is_edp) -+ phytium_edp_backlight_on(phytium_dp); -+} -+ -+enum drm_mode_status -+phytium_encoder_mode_valid(struct drm_encoder *encoder, const struct drm_display_mode *mode) -+{ -+ struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); -+ struct drm_display_info *display_info = &phytium_dp->connector.display_info; -+ unsigned int requested, actual; -+ -+ switch (display_info->bpc) { -+ case 10: -+ case 6: -+ case 8: -+ break; -+ default: -+ DRM_INFO("not support bpc(%d)\n", display_info->bpc); -+ display_info->bpc = 8; -+ break; -+ } -+ -+ if ((display_info->color_formats & DRM_COLOR_FORMAT_RGB444) == 0) { -+ DRM_INFO("not support color_format(%d)\n", display_info->color_formats); -+ display_info->color_formats = DRM_COLOR_FORMAT_RGB444; -+ } -+ -+ requested = mode->clock * display_info->bpc * 3 / 1000; -+ actual = phytium_dp->max_link_rate * phytium_dp->max_link_lane_count / 100; -+ actual = actual * 8 / 10; -+ if (requested >= actual) { -+ DRM_DEBUG_KMS("requested=%d, actual=%d, clock=%d\n", requested, actual, -+ mode->clock); -+ return MODE_CLOCK_HIGH; -+ } -+ -+ if (dc_fake_mode_enable && -+ (phytium_dp->native_mode.clock == mode->clock) && -+ (phytium_dp->native_mode.htotal == mode->htotal) && -+ (phytium_dp->native_mode.vtotal == mode->vtotal)) -+ return MODE_OK; -+ -+ if ((mode->hdisplay == 1600) && (mode->vdisplay == 900)) -+ return MODE_BAD_HVALUE; -+ -+ if ((mode->hdisplay == 1024) && (mode->clock > 78000)) -+ return MODE_BAD_HVALUE; -+ -+ if ((mode->hdisplay < 640) || (mode->vdisplay < 480)) -+ return MODE_BAD_HVALUE; -+ -+ return MODE_OK; -+} -+ -+static const struct drm_encoder_helper_funcs phytium_encoder_helper_funcs = { -+ .mode_set = phytium_dp_encoder_mode_set, -+ .disable = phytium_encoder_disable, -+ .enable = phytium_encoder_enable, -+ .mode_valid = phytium_encoder_mode_valid, -+}; -+ -+void phytium_dp_encoder_destroy(struct drm_encoder *encoder) -+{ -+ struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); -+ -+ phytium_dp_audio_codec_fini(phytium_dp); -+ drm_encoder_cleanup(encoder); -+} -+ -+static const struct drm_encoder_funcs phytium_encoder_funcs = { -+ .destroy = phytium_dp_encoder_destroy, -+}; -+ -+static const struct dp_audio_n_m phytium_dp_audio_n_m[] = { -+ { 32000, 162000, 1024, 10125 }, -+ { 44100, 162000, 784, 5625 }, -+ { 48000, 162000, 512, 3375 }, -+ { 64000, 162000, 2048, 10125 }, -+ { 88200, 162000, 1568, 5625 }, -+ { 96000, 162000, 1024, 3375 }, -+ { 128000, 162000, 4096, 10125 }, -+ { 176400, 162000, 3136, 5625 }, -+ { 192000, 162000, 2048, 3375 }, -+ { 32000, 270000, 1024, 16875 }, -+ { 44100, 270000, 784, 9375 }, -+ { 48000, 270000, 512, 5625 }, -+ { 64000, 270000, 2048, 16875 }, -+ { 88200, 270000, 1568, 9375 }, -+ { 96000, 270000, 1024, 5625 }, -+ { 128000, 270000, 4096, 16875 }, -+ { 176400, 270000, 3136, 9375 }, -+ { 192000, 270000, 2048, 5625 }, -+ { 32000, 540000, 1024, 33750 }, -+ { 44100, 540000, 784, 18750 }, -+ { 48000, 540000, 512, 11250 }, -+ { 64000, 540000, 2048, 33750 }, -+ { 88200, 540000, 1568, 18750 }, -+ { 96000, 540000, 1024, 11250 }, -+ { 128000, 540000, 4096, 33750 }, -+ { 176400, 540000, 3136, 18750 }, -+ { 192000, 540000, 2048, 11250 }, -+ { 32000, 810000, 1024, 50625 }, -+ { 44100, 810000, 784, 28125 }, -+ { 48000, 810000, 512, 16875 }, -+ { 64000, 810000, 2048, 50625 }, -+ { 88200, 810000, 1568, 28125 }, -+ { 96000, 810000, 1024, 16875 }, -+ { 128000, 810000, 4096, 50625 }, -+ { 176400, 810000, 3136, 28125 }, -+ { 192000, 810000, 2048, 16875 }, -+}; -+ -+static int phytium_dp_audio_get_eld(struct device *dev, void *data, u8 *buf, size_t len) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ -+ memcpy(buf, phytium_dp->connector.eld, min(sizeof(phytium_dp->connector.eld), len)); -+ -+ return 0; -+} -+ -+static int phytium_dp_audio_mute_stream(struct device *dev, void *data, bool enable, int direction) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ -+ phytium_dp_hw_audio_digital_mute(phytium_dp, enable); -+ -+ return 0; -+} -+ -+const struct dp_audio_n_m *phytium_dp_audio_get_n_m(int link_rate, int sample_rate) -+{ -+ int i; -+ -+ for (i = 0; i < ARRAY_SIZE(phytium_dp_audio_n_m); i++) { -+ if (sample_rate == phytium_dp_audio_n_m[i].sample_rate -+ && link_rate == phytium_dp_audio_n_m[i].link_rate) -+ return &phytium_dp_audio_n_m[i]; -+ } -+ -+ return NULL; -+} -+ -+static int phytium_dp_audio_hw_params(struct device *dev, void *data, -+ struct hdmi_codec_daifmt *daifmt, -+ struct hdmi_codec_params *params) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ int ret = 0; -+ struct audio_info audio_info = { -+ .sample_width = params->sample_width, -+ .sample_rate = params->sample_rate, -+ .channels = params->channels, -+ }; -+ -+ if (daifmt->fmt != HDMI_I2S) { -+ DRM_ERROR("invalid audio format %d\n", daifmt->fmt); -+ ret = -EINVAL; -+ goto failed; -+ } -+ -+ ret = phytium_dp_hw_audio_hw_params(phytium_dp, audio_info); -+ -+failed: -+ return ret; -+} -+ -+static void phytium_dp_audio_shutdown(struct device *dev, void *data) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ -+ phytium_dp_hw_audio_shutdown(phytium_dp); -+} -+ -+static void handle_plugged_change(struct phytium_dp_device *phytium_dp, bool plugged) -+{ -+ if (phytium_dp->plugged_cb && phytium_dp->codec_dev) -+ phytium_dp->plugged_cb(phytium_dp->codec_dev, plugged); -+} -+ -+static int phytium_dp_audio_hook_plugged_cb(struct device *dev, void *data, -+ hdmi_codec_plugged_cb fn, -+ struct device *codec_dev) -+{ -+ struct phytium_dp_device *phytium_dp = data; -+ bool plugged; -+ -+ phytium_dp->plugged_cb = fn; -+ phytium_dp->codec_dev = codec_dev; -+ -+ if ((phytium_dp->connector.status == connector_status_connected) && phytium_dp->has_audio) -+ plugged = true; -+ else -+ plugged = false; -+ -+ handle_plugged_change(phytium_dp, plugged); -+ return 0; -+} -+ -+ -+static const struct hdmi_codec_ops phytium_audio_codec_ops = { -+ .hw_params = phytium_dp_audio_hw_params, -+ .audio_shutdown = phytium_dp_audio_shutdown, -+ .mute_stream = phytium_dp_audio_mute_stream, -+ .get_eld = phytium_dp_audio_get_eld, -+ .hook_plugged_cb = phytium_dp_audio_hook_plugged_cb, -+}; -+ -+static int phytium_dp_audio_codec_init(struct phytium_dp_device *phytium_dp, -+ const int port) -+{ -+ struct device *dev = phytium_dp->dev->dev; -+ struct hdmi_codec_pdata codec_data = { -+ .i2s = 1, -+ .spdif = 0, -+ .ops = &phytium_audio_codec_ops, -+ .max_i2s_channels = 2, -+ .data = phytium_dp, -+ }; -+ -+ phytium_dp->audio_pdev = platform_device_register_data(dev, HDMI_CODEC_DRV_NAME, -+ codec_id + port, -+ &codec_data, sizeof(codec_data)); -+ -+ return PTR_ERR_OR_ZERO(phytium_dp->audio_pdev); -+} -+ -+static void phytium_dp_audio_codec_fini(struct phytium_dp_device *phytium_dp) -+{ -+ -+ if (!PTR_ERR_OR_ZERO(phytium_dp->audio_pdev)) -+ platform_device_unregister(phytium_dp->audio_pdev); -+ phytium_dp->audio_pdev = NULL; -+} -+ -+static long phytium_dp_aux_transfer(struct drm_dp_aux *aux, struct drm_dp_aux_msg *msg) -+{ -+ struct phytium_dp_device *phytium_dp = container_of(aux, struct phytium_dp_device, aux); -+ long ret = 0; -+ -+ DRM_DEBUG_KMS("msg->size: 0x%lx\n", msg->size); -+ -+ if (WARN_ON(msg->size > 16)) -+ return -E2BIG; -+ -+ switch (msg->request & ~DP_AUX_I2C_MOT) { -+ case DP_AUX_NATIVE_WRITE: -+ case DP_AUX_I2C_WRITE: -+ case DP_AUX_I2C_WRITE_STATUS_UPDATE: -+ ret = phytium_dp_hw_aux_transfer_write(phytium_dp, msg); -+ DRM_DEBUG_KMS("aux write reply:0x%x ret:0x%lx\n", msg->reply, ret); -+ break; -+ case DP_AUX_NATIVE_READ: -+ case DP_AUX_I2C_READ: -+ ret = phytium_dp_hw_aux_transfer_read(phytium_dp, msg); -+ DRM_DEBUG_KMS("aux read ret:0x%lx\n", ret); -+ break; -+ default: -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+static void phytium_dp_aux_init(struct phytium_dp_device *phytium_dp) -+{ -+ drm_dp_aux_init(&phytium_dp->aux); -+ phytium_dp->aux.name = kasprintf(GFP_KERNEL, "dp-%d", phytium_dp->port); -+ phytium_dp->aux.transfer = phytium_dp_aux_transfer; -+} -+ -+int phytium_get_encoder_crtc_mask(struct phytium_dp_device *phytium_dp, int port) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int i, mask = 0; -+ -+ for_each_pipe_masked(priv, i) { -+ if (i != port) -+ mask++; -+ else -+ break; -+ } -+ -+ return BIT(mask); -+} -+ -+static bool phytium_dp_is_edp(struct phytium_dp_device *phytium_dp, int port) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ if (priv->info.edp_mask & BIT(port)) -+ return true; -+ else -+ return false; -+} -+ -+static bool phytium_edp_init_connector(struct phytium_dp_device *phytium_dp) -+{ -+ enum drm_connector_status status; -+ struct drm_connector *connector = &phytium_dp->connector; -+ -+ phytium_edp_panel_poweron(phytium_dp); -+ -+ status = phytium_dp_detect_dpcd(phytium_dp); -+ if (status == connector_status_disconnected) { -+ DRM_ERROR("detect edp dpcd failed\n"); -+ return false; -+ } -+ -+ phytium_dp->edp_edid = drm_get_edid(connector, &phytium_dp->aux.ddc); -+ if (!phytium_dp->edp_edid) { -+ DRM_ERROR("get edp edid failed\n"); -+ return false; -+ } -+ -+ connector->status = status; -+ phytium_dp->max_link_rate = phytium_dp->common_rates[phytium_dp->num_common_rates-1]; -+ phytium_dp->max_link_lane_count = phytium_dp->common_max_lane_count; -+ phytium_dp->link_rate = phytium_dp->max_link_rate; -+ phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; -+ DRM_DEBUG_KMS("common_max_lane_count: %d, common_max_rate:%d\n", -+ phytium_dp->max_link_lane_count, phytium_dp->max_link_rate); -+ -+ return true; -+} -+ -+static void phytium_edp_fini_connector(struct phytium_dp_device *phytium_dp) -+{ -+ kfree(phytium_dp->edp_edid); -+ -+ phytium_dp->edp_edid = NULL; -+ phytium_edp_panel_poweroff(phytium_dp); -+} -+ -+int phytium_dp_resume(struct drm_device *drm_dev) -+{ -+ struct phytium_dp_device *phytium_dp; -+ struct drm_encoder *encoder; -+ int ret = 0; -+ -+ drm_for_each_encoder(encoder, drm_dev) { -+ phytium_dp = encoder_to_dp_device(encoder); -+ if (phytium_dp->is_edp) { -+ phytium_edp_backlight_off(phytium_dp); -+ phytium_edp_panel_poweroff(phytium_dp); -+ } -+ ret = phytium_dp_hw_init(phytium_dp); -+ if (ret) { -+ DRM_ERROR("failed to initialize dp %d\n", phytium_dp->port); -+ return -EIO; -+ } -+ } -+ -+ return 0; -+} -+ -+int phytium_dp_init(struct drm_device *dev, int port) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_dp_device *phytium_dp = NULL; -+ int ret, type; -+ -+ DRM_DEBUG_KMS("%s: port %d\n", __func__, port); -+ phytium_dp = kzalloc(sizeof(*phytium_dp), GFP_KERNEL); -+ if (!phytium_dp) { -+ ret = -ENOMEM; -+ goto failed_malloc_dp; -+ } -+ -+ phytium_dp->dev = dev; -+ phytium_dp->port = port; -+ -+ if (IS_PX210(priv)) { -+ px210_dp_func_register(phytium_dp); -+ priv->dp_reg_base[port] = PX210_DP_BASE(port); -+ priv->phy_access_base[port] = PX210_PHY_ACCESS_BASE(port); -+ } else if (IS_PE220X(priv)) { -+ pe220x_dp_func_register(phytium_dp); -+ priv->dp_reg_base[port] = PE220X_DP_BASE(port); -+ priv->phy_access_base[port] = PE220X_PHY_ACCESS_BASE(port); -+ } -+ -+ if (phytium_dp_is_edp(phytium_dp, port)) { -+ phytium_dp->is_edp = true; -+ type = DRM_MODE_CONNECTOR_eDP; -+ phytium_dp->pwm = priv->info.pwm; -+ phytium_dp_panel_init_backlight_funcs(phytium_dp); -+ phytium_edp_backlight_off(phytium_dp); -+ phytium_edp_panel_poweroff(phytium_dp); -+ } else { -+ phytium_dp->is_edp = false; -+ type = DRM_MODE_CONNECTOR_DisplayPort; -+ } -+ -+ ret = phytium_dp_hw_init(phytium_dp); -+ if (ret) { -+ DRM_ERROR("failed to initialize dp %d\n", phytium_dp->port); -+ goto failed_init_dp; -+ } -+ -+ ret = drm_encoder_init(dev, &phytium_dp->encoder, -+ &phytium_encoder_funcs, -+ DRM_MODE_ENCODER_TMDS, "DP %d", port); -+ if (ret) { -+ DRM_ERROR("failed to initialize encoder with drm\n"); -+ goto failed_encoder_init; -+ } -+ drm_encoder_helper_add(&phytium_dp->encoder, &phytium_encoder_helper_funcs); -+ phytium_dp->encoder.possible_crtcs = phytium_get_encoder_crtc_mask(phytium_dp, port); -+ -+ phytium_dp->connector.dpms = DRM_MODE_DPMS_OFF; -+ phytium_dp->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; -+ ret = drm_connector_init(dev, &phytium_dp->connector, &phytium_connector_funcs, -+ type); -+ if (ret) { -+ DRM_ERROR("failed to initialize connector with drm\n"); -+ goto failed_connector_init; -+ } -+ drm_connector_helper_add(&phytium_dp->connector, &phytium_connector_helper_funcs); -+ drm_connector_attach_encoder(&phytium_dp->connector, &phytium_dp->encoder); -+ -+ ret = phytium_dp_audio_codec_init(phytium_dp, port); -+ if (ret) { -+ DRM_ERROR("failed to initialize audio codec\n"); -+ goto failed_connector_init; -+ } -+ -+ phytium_dp->train_retry_count = 0; -+ INIT_WORK(&phytium_dp->train_retry_work, phytium_dp_train_retry_work_fn); -+ drm_connector_register(&phytium_dp->connector); -+ -+ return 0; -+failed_connector_init: -+failed_encoder_init: -+failed_init_dp: -+ kfree(phytium_dp); -+failed_malloc_dp: -+ return ret; -+} -diff --git a/drivers/gpu/drm/phytium/phytium_dp.h b/drivers/gpu/drm/phytium/phytium_dp.h -new file mode 100644 -index 000000000..c4915dd40 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_dp.h -@@ -0,0 +1,157 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_DP_H__ -+#define __PHYTIUM_DP_H__ -+ -+#include -+#include -+#include -+#include -+ -+struct phytium_dp_device; -+ -+#include "phytium_panel.h" -+ -+struct audio_info { -+ int sample_rate; -+ int channels; -+ int sample_width; -+}; -+ -+struct dp_audio_n_m { -+ int sample_rate; -+ int link_rate; -+ u16 m; -+ u16 n; -+}; -+ -+struct phytium_dp_compliance { -+ unsigned long test_type; -+ uint32_t test_link_rate; -+ u8 test_lane_count; -+ bool test_active; -+ u8 reserve[2]; -+}; -+ -+struct phytium_dp_func { -+ uint8_t (*dp_hw_get_source_lane_count)(struct phytium_dp_device *phytium_dp); -+ int (*dp_hw_reset)(struct phytium_dp_device *phytium_dp); -+ bool (*dp_hw_spread_is_enable)(struct phytium_dp_device *phytium_dp); -+ int (*dp_hw_set_backlight)(struct phytium_dp_device *phytium_dp, uint32_t level); -+ uint32_t (*dp_hw_get_backlight)(struct phytium_dp_device *phytium_dp); -+ void (*dp_hw_disable_backlight)(struct phytium_dp_device *phytium_dp); -+ void (*dp_hw_enable_backlight)(struct phytium_dp_device *phytium_dp); -+ void (*dp_hw_poweroff_panel)(struct phytium_dp_device *phytium_dp); -+ void (*dp_hw_poweron_panel)(struct phytium_dp_device *phytium_dp); -+ int (*dp_hw_init_phy)(struct phytium_dp_device *phytium_dp); -+ void (*dp_hw_set_phy_lane_setting)(struct phytium_dp_device *phytium_dp, -+ uint32_t link_rate, uint8_t train_set); -+ int (*dp_hw_set_phy_lane_and_rate)(struct phytium_dp_device *phytium_dp, -+ uint8_t link_lane_count, -+ uint32_t link_rate); -+}; -+ -+struct phytium_dp_hpd_state { -+ bool hpd_event_state; -+ bool hpd_irq_state; -+ bool hpd_raw_state; -+ bool hpd_irq_enable; -+}; -+ -+struct phytium_dp_device { -+ struct drm_device *dev; -+ struct drm_encoder encoder; -+ struct drm_connector connector; -+ int port; -+ struct drm_display_mode mode; -+ bool link_trained; -+ bool detect_done; -+ bool is_edp; -+ bool reserve0; -+ struct drm_dp_aux aux; -+ unsigned char dpcd[DP_RECEIVER_CAP_SIZE]; -+ uint8_t edp_dpcd[EDP_DISPLAY_CTL_CAP_SIZE]; -+ unsigned char downstream_ports[DP_MAX_DOWNSTREAM_PORTS]; -+ unsigned char sink_count; -+ -+ int *source_rates; -+ int num_source_rates; -+ int sink_rates[DP_MAX_SUPPORTED_RATES]; -+ int num_sink_rates; -+ int common_rates[DP_MAX_SUPPORTED_RATES]; -+ int num_common_rates; -+ -+ int source_max_lane_count; -+ int sink_max_lane_count; -+ int common_max_lane_count; -+ -+ int max_link_rate; -+ int max_link_lane_count; -+ int link_rate; -+ int link_lane_count; -+ struct work_struct train_retry_work; -+ int train_retry_count; -+ uint32_t trigger_train_fail; -+ -+ unsigned char train_set[4]; -+ struct edid *edp_edid; -+ bool has_audio; -+ bool fast_train_support; -+ bool hw_spread_enable; -+ bool reserve[1]; -+ struct platform_device *audio_pdev; -+ struct audio_info audio_info; -+ hdmi_codec_plugged_cb plugged_cb; -+ struct device *codec_dev; -+ struct phytium_dp_compliance compliance; -+ struct phytium_dp_func *funcs; -+ struct phytium_dp_hpd_state dp_hpd_state; -+ -+ struct phytium_panel panel; -+ struct drm_display_mode native_mode; -+ struct pwm_device *pwm; -+}; -+ -+union phytium_phy_tp { -+ struct { -+ /* DpcdPhyTestPatterns. This field is 2 bits for DP1.1 -+ * and 3 bits for DP1.2. -+ */ -+ uint8_t PATTERN :3; -+ uint8_t RESERVED :5; -+ } bits; -+ uint8_t raw; -+}; -+ -+/* PHY test patterns -+ * The order of test patterns follows DPCD register PHY_TEST_PATTERN (0x248) -+ */ -+enum phytium_dpcd_phy_tp { -+ PHYTIUM_PHY_TP_NONE = 0, -+ PHYTIUM_PHY_TP_D10_2, -+ PHYTIUM_PHY_TP_SYMBOL_ERROR, -+ PHYTIUM_PHY_TP_PRBS7, -+ PHYTIUM_PHY_TP_80BIT_CUSTOM, -+ PHYTIUM_PHY_TP_CP2520_1, -+ PHYTIUM_PHY_TP_CP2520_2, -+ PHYTIUM_PHY_TP_CP2520_3, -+}; -+#define PHYTIUM_DP_AUDIO_ID (('P' << 24) + ('H' << 16) + ('Y' << 8)) -+#define encoder_to_dp_device(x) container_of(x, struct phytium_dp_device, encoder) -+#define connector_to_dp_device(x) container_of(x, struct phytium_dp_device, connector) -+#define panel_to_dp_device(x) container_of(x, struct phytium_dp_device, panel) -+#define train_retry_to_dp_device(x) container_of(x, struct phytium_dp_device, train_retry_work) -+void phytium_phy_writel(struct phytium_dp_device *phytium_dp, uint32_t address, uint32_t data); -+uint32_t phytium_phy_readl(struct phytium_dp_device *phytium_dp, uint32_t address); -+ -+int phytium_dp_init(struct drm_device *dev, int pipe); -+int phytium_dp_resume(struct drm_device *drm_dev); -+void phytium_dp_hpd_irq_setup(struct drm_device *dev, bool enable); -+irqreturn_t phytium_dp_hpd_irq_handler(struct phytium_display_private *priv); -+void phytium_dp_hpd_work_func(struct work_struct *work); -+const struct dp_audio_n_m *phytium_dp_audio_get_n_m(int link_rate, int sample_rate); -+#endif /* __PHYTIUM_DP_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_fb.c b/drivers/gpu/drm/phytium/phytium_fb.c -new file mode 100644 -index 000000000..230714f79 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_fb.c -@@ -0,0 +1,131 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_fb.h" -+#include "phytium_gem.h" -+ -+static int -+phytium_fb_create_handle(struct drm_framebuffer *fb, struct drm_file *file_priv, -+ unsigned int *handle) -+{ -+ struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); -+ -+ return drm_gem_handle_create(file_priv, &phytium_fb->phytium_gem_obj[0]->base, handle); -+} -+ -+static void phytium_fb_destroy(struct drm_framebuffer *fb) -+{ -+ struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); -+ int i, num_planes; -+ struct drm_gem_object *obj = NULL; -+ const struct drm_format_info *info; -+ -+ info = drm_format_info(fb->format->format); -+ num_planes = info ? info->num_planes : 1; -+ -+ for (i = 0; i < num_planes; i++) { -+ obj = &phytium_fb->phytium_gem_obj[i]->base; -+ if (obj) -+ drm_gem_object_put(obj); -+ } -+ -+ drm_framebuffer_cleanup(fb); -+ kfree(phytium_fb); -+} -+ -+static struct drm_framebuffer_funcs viv_fb_funcs = { -+ .create_handle = phytium_fb_create_handle, -+ .destroy = phytium_fb_destroy, -+}; -+ -+struct phytium_framebuffer * -+phytium_fb_alloc(struct drm_device *dev, const struct drm_mode_fb_cmd2 *mode_cmd, -+ struct phytium_gem_object **phytium_gem_obj, unsigned int num_planes) -+{ -+ struct phytium_framebuffer *phytium_fb; -+ int ret = 0, i; -+ -+ phytium_fb = kzalloc(sizeof(*phytium_fb), GFP_KERNEL); -+ if (!phytium_fb) -+ return ERR_PTR(-ENOMEM); -+ -+ drm_helper_mode_fill_fb_struct(dev, &phytium_fb->base, mode_cmd); -+ -+ ret = drm_framebuffer_init(dev, &phytium_fb->base, &viv_fb_funcs); -+ -+ if (ret) { -+ DRM_ERROR("Failed to initialize framebuffer: %d\n", ret); -+ kfree(phytium_fb); -+ return ERR_PTR(ret); -+ } -+ -+ for (i = 0; i < num_planes; i++) { -+ phytium_fb->phytium_gem_obj[i] = phytium_gem_obj[i]; -+ phytium_fb->base.obj[i] = &phytium_gem_obj[i]->base; -+ } -+ return phytium_fb; -+} -+ -+struct drm_framebuffer * -+phytium_fb_create(struct drm_device *dev, struct drm_file *file_priv, -+ const struct drm_mode_fb_cmd2 *mode_cmd) -+{ -+ int ret = 0, i, num_planes; -+ struct drm_gem_object *obj; -+ unsigned int hsub, vsub, size; -+ struct phytium_gem_object *phytium_gem_obj[PHYTIUM_FORMAT_MAX_PLANE] = {0}; -+ struct phytium_framebuffer *phytium_fb; -+ struct phytium_display_private *priv = dev->dev_private; -+ const struct drm_format_info *info; -+ -+ info = drm_format_info(mode_cmd->pixel_format); -+ hsub = info ? info->hsub : 1; -+ vsub = info ? info->vsub : 1; -+ num_planes = info ? info->num_planes : 1; -+ num_planes = min(num_planes, PHYTIUM_FORMAT_MAX_PLANE); -+ -+ for (i = 0; i < num_planes; i++) { -+ unsigned int height = mode_cmd->height / (i ? vsub : 1); -+ -+ size = height * mode_cmd->pitches[i] + mode_cmd->offsets[i]; -+ obj = drm_gem_object_lookup(file_priv, mode_cmd->handles[i]); -+ if (!obj) { -+ DRM_ERROR("Failed to lookup GEM object\n"); -+ ret = -ENXIO; -+ goto error; -+ } -+ -+ if (obj->size < size) { -+ drm_gem_object_put(obj); -+ ret = -EINVAL; -+ goto error; -+ } -+ -+ phytium_gem_obj[i] = to_phytium_gem_obj(obj); -+ -+ ret = priv->dc_hw_fb_format_check(mode_cmd, i); -+ if (ret < 0) -+ goto error; -+ } -+ -+ phytium_fb = phytium_fb_alloc(dev, mode_cmd, phytium_gem_obj, i); -+ if (IS_ERR(phytium_fb)) { -+ DRM_DEBUG_KMS("phytium_fb_alloc failed\n"); -+ ret = PTR_ERR(phytium_fb); -+ goto error; -+ } -+ -+ return &phytium_fb->base; -+error: -+ for (i--; i >= 0; i--) -+ drm_gem_object_put(&phytium_gem_obj[i]->base); -+ -+ return ERR_PTR(ret); -+} -diff --git a/drivers/gpu/drm/phytium/phytium_fb.h b/drivers/gpu/drm/phytium/phytium_fb.h -new file mode 100644 -index 000000000..eb7903f3a ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_fb.h -@@ -0,0 +1,26 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_FB_H__ -+#define __PHYTIUM_FB_H__ -+ -+#include -+ -+struct phytium_framebuffer { -+ struct drm_framebuffer base; -+ struct phytium_gem_object *phytium_gem_obj[PHYTIUM_FORMAT_MAX_PLANE]; -+}; -+ -+#define to_phytium_framebuffer(fb) container_of(fb, struct phytium_framebuffer, base) -+ -+struct phytium_framebuffer *phytium_fb_alloc(struct drm_device *dev, -+ const struct drm_mode_fb_cmd2 *mode_cmd, -+ struct phytium_gem_object **phytium_gem_obj, -+ unsigned int num_planes); -+ -+struct drm_framebuffer *phytium_fb_create(struct drm_device *dev, struct drm_file *file_priv, -+ const struct drm_mode_fb_cmd2 *mode_cmd); -+#endif /* __PHYTIUM_FB_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_fbdev.c b/drivers/gpu/drm/phytium/phytium_fbdev.c -new file mode 100644 -index 000000000..8c424fc35 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_fbdev.c -@@ -0,0 +1,152 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_gem.h" -+#include "phytium_fb.h" -+ -+ -+#define PHYTIUM_MAX_CONNECTOR 1 -+#define helper_to_drm_private(x) container_of(x, struct phytium_display_private, fbdev_helper) -+ -+static void phytium_fbdev_destroy(struct fb_info *info) -+{ -+ struct drm_fb_helper *helper = info->par; -+ struct phytium_display_private *priv = helper_to_drm_private(helper); -+ -+ phytium_gem_free_object(&priv->fbdev_phytium_gem->base); -+} -+ -+static int phytium_fbdev_mmap(struct fb_info *info, struct vm_area_struct *vma) -+{ -+ struct drm_fb_helper *helper = info->par; -+ struct phytium_display_private *priv = helper_to_drm_private(helper); -+ -+ return phytium_gem_mmap_obj(&priv->fbdev_phytium_gem->base, vma); -+} -+ -+static const struct fb_ops phytium_fbdev_ops = { -+ .owner = THIS_MODULE, -+ .fb_mmap = phytium_fbdev_mmap, -+ .fb_destroy = phytium_fbdev_destroy, -+ DRM_FB_HELPER_DEFAULT_OPS, -+ __FB_DEFAULT_IOMEM_OPS_RDWR, -+ __FB_DEFAULT_IOMEM_OPS_DRAW, -+}; -+ -+static int -+phytium_drm_fbdev_create(struct drm_fb_helper *helper, struct drm_fb_helper_surface_size *sizes) -+{ -+ struct phytium_display_private *priv = helper_to_drm_private(helper); -+ struct drm_device *dev = helper->dev; -+ unsigned int bytes_per_pixel; -+ struct drm_mode_fb_cmd2 mode_cmd = {0}; -+ struct phytium_framebuffer *phytium_fb = NULL; -+ struct fb_info *fbi = NULL; -+ struct drm_framebuffer *fb = NULL; -+ size_t size = 0; -+ int ret = 0; -+ unsigned long offset; -+ -+ bytes_per_pixel = DIV_ROUND_UP(sizes->surface_bpp, 8); -+ mode_cmd.width = sizes->surface_width; -+ mode_cmd.height = sizes->surface_height; -+ mode_cmd.pitches[0] = ALIGN(sizes->surface_width * bytes_per_pixel, 128); -+ mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, sizes->surface_depth); -+ size = PAGE_ALIGN(mode_cmd.pitches[0] * mode_cmd.height); -+ -+ ret = mutex_lock_interruptible(&dev->struct_mutex); -+ if (ret < 0) { -+ DRM_ERROR("failed to get mutex lock\n"); -+ return ret; -+ } -+ -+ priv->fbdev_phytium_gem = phytium_gem_create_object(dev, size); -+ if (!priv->fbdev_phytium_gem) { -+ DRM_ERROR("failed to create gem object\n"); -+ return -ENOMEM; -+ } -+ mutex_unlock(&dev->struct_mutex); -+ -+ fbi = drm_fb_helper_alloc_info(helper); -+ if (IS_ERR(fbi)) { -+ DRM_DEV_ERROR(dev->dev, "Failed to create framebuffer info."); -+ ret = PTR_ERR(fbi); -+ goto out; -+ } -+ -+ phytium_fb = phytium_fb_alloc(dev, &mode_cmd, &priv->fbdev_phytium_gem, 1); -+ if (IS_ERR(phytium_fb)) { -+ DRM_DEV_ERROR(dev->dev, "Failed to alloc DRM framebuffer.\n"); -+ ret = PTR_ERR(phytium_fb); -+ goto out; -+ } -+ -+ helper->fb = &(phytium_fb->base); -+ fbi->par = helper; -+ fbi->fbops = &phytium_fbdev_ops; -+ -+ fb = helper->fb; -+ drm_fb_helper_fill_info(fbi, helper, sizes); -+ -+ offset = fbi->var.xoffset * bytes_per_pixel; -+ offset += fbi->var.yoffset * fb->pitches[0]; -+ fbi->screen_base = priv->fbdev_phytium_gem->vaddr + offset; -+ fbi->screen_size = priv->fbdev_phytium_gem->base.size; -+ fbi->fix.smem_len = priv->fbdev_phytium_gem->base.size; -+ DRM_DEBUG_KMS("FB [%dx%d]-%d kvaddr=%pa offset=%ld size=%zu\n", fb->width, fb->height, -+ fb->format->depth, &priv->fbdev_phytium_gem->iova, offset, size); -+ fbi->skip_vt_switch = true; -+ -+ return 0; -+out: -+ phytium_gem_free_object(&priv->fbdev_phytium_gem->base); -+ return ret; -+} -+ -+static const struct drm_fb_helper_funcs phytium_drm_fb_helper_funcs = { -+ .fb_probe = phytium_drm_fbdev_create, -+}; -+ -+int phytium_drm_fbdev_init(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ struct drm_fb_helper *helper; -+ int ret; -+ -+ if (!dev->mode_config.num_crtc || !dev->mode_config.num_connector) -+ return -EINVAL; -+ -+ helper = &priv->fbdev_helper; -+ drm_fb_helper_prepare(dev, helper, 32, &phytium_drm_fb_helper_funcs); -+ -+ ret = drm_fb_helper_init(dev, helper); -+ if (ret < 0) { -+ DRM_DEV_ERROR(dev->dev, "Failed to initialize drm fb helper -ret %d\n", ret); -+ return ret; -+ } -+ -+ ret = drm_fb_helper_initial_config(helper); -+ return 0; -+} -+ -+void phytium_drm_fbdev_fini(struct drm_device *dev) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ struct drm_fb_helper *helper; -+ -+ helper = &priv->fbdev_helper; -+ drm_fb_helper_unregister_info(helper); -+ -+ if (helper->fb) -+ drm_framebuffer_put(helper->fb); -+ -+ drm_fb_helper_fini(helper); -+} -diff --git a/drivers/gpu/drm/phytium/phytium_fbdev.h b/drivers/gpu/drm/phytium/phytium_fbdev.h -new file mode 100644 -index 000000000..ff63ba84d ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_fbdev.h -@@ -0,0 +1,13 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _PHYTIUM_FBDEV_H -+#define _PHYTIUM_FBDEV_H -+ -+int phytium_drm_fbdev_init(struct drm_device *dev); -+void phytium_drm_fbdev_fini(struct drm_device *dev); -+ -+#endif /* _PHYTIUM_FBDEV_H */ -diff --git a/drivers/gpu/drm/phytium/phytium_gem.c b/drivers/gpu/drm/phytium/phytium_gem.c -new file mode 100644 -index 000000000..7d962076f ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_gem.c -@@ -0,0 +1,520 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_gem.h" -+ -+#define VRAM_POOL_ALLOC_ORDER 12 -+ -+int phytium_memory_pool_alloc(struct phytium_display_private *priv, void **pvaddr, -+ phys_addr_t *phys_addr, uint64_t size) -+{ -+ unsigned long vaddr; -+ -+ vaddr = gen_pool_alloc(priv->memory_pool, size); -+ if (!vaddr) -+ return -ENOMEM; -+ -+ *phys_addr = gen_pool_virt_to_phys(priv->memory_pool, vaddr); -+ -+ *pvaddr = (void *)vaddr; -+ return 0; -+} -+ -+void phytium_memory_pool_free(struct phytium_display_private *priv, void *vaddr, uint64_t size) -+{ -+ gen_pool_free(priv->memory_pool, (unsigned long)vaddr, size); -+} -+ -+int phytium_memory_pool_init(struct device *dev, struct phytium_display_private *priv) -+{ -+ int ret = 0; -+ -+ priv->memory_pool = gen_pool_create(VRAM_POOL_ALLOC_ORDER, -1); -+ if (priv->memory_pool == NULL) { -+ DRM_ERROR("fail to create memory pool\n"); -+ ret = -1; -+ goto failed_create_pool; -+ } -+ -+ ret = gen_pool_add_virt(priv->memory_pool, (unsigned long)priv->pool_virt_addr, -+ priv->pool_phys_addr, priv->pool_size, -1); -+ if (ret) { -+ DRM_ERROR("fail to add vram pool\n"); -+ ret = -1; -+ goto failed_add_pool_virt; -+ } -+ -+ return 0; -+ -+failed_add_pool_virt: -+ gen_pool_destroy(priv->memory_pool); -+ -+failed_create_pool: -+ return ret; -+} -+ -+void phytium_memory_pool_fini(struct device *dev, struct phytium_display_private *priv) -+{ -+ gen_pool_destroy(priv->memory_pool); -+} -+ -+struct sg_table * -+phytium_gem_prime_get_sg_table(struct drm_gem_object *obj) -+{ -+ struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); -+ struct sg_table *sgt; -+ struct drm_device *dev = obj->dev; -+ int ret; -+ struct page *page = NULL; -+ -+ sgt = kzalloc(sizeof(*sgt), GFP_KERNEL); -+ if (!sgt) { -+ DRM_DEBUG_KMS("malloc sgt fail\n"); -+ return ERR_PTR(-ENOMEM); -+ } -+ -+ if ((phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) || -+ (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE) || -+ (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT)) { -+ ret = sg_alloc_table(sgt, 1, GFP_KERNEL); -+ if (ret) { -+ DRM_ERROR("failed to allocate sg\n"); -+ goto sgt_free; -+ } -+ page = phys_to_page(phytium_gem_obj->phys_addr); -+ sg_set_page(sgt->sgl, page, PAGE_ALIGN(phytium_gem_obj->size), 0); -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { -+ ret = dma_get_sgtable_attrs(dev->dev, sgt, phytium_gem_obj->vaddr, -+ phytium_gem_obj->iova, phytium_gem_obj->size, -+ DMA_ATTR_WRITE_COMBINE); -+ if (ret) { -+ DRM_ERROR("failed to allocate sgt, %d\n", ret); -+ goto sgt_free; -+ } -+ } -+ -+ return sgt; -+sgt_free: -+ kfree(sgt); -+ return ERR_PTR(ret); -+} -+ -+struct drm_gem_object * -+phytium_gem_prime_import_sg_table(struct drm_device *dev, -+ struct dma_buf_attachment *attach, -+ struct sg_table *sgt) -+{ -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ struct scatterlist *s; -+ dma_addr_t expected; -+ int ret, i; -+ -+ phytium_gem_obj = kzalloc(sizeof(*phytium_gem_obj), GFP_KERNEL); -+ if (!phytium_gem_obj) { -+ DRM_ERROR("failed to allocate phytium_gem_obj\n"); -+ ret = -ENOMEM; -+ goto failed_malloc; -+ } -+ -+ ret = drm_gem_object_init(dev, &phytium_gem_obj->base, attach->dmabuf->size); -+ if (ret) { -+ DRM_ERROR("failed to initialize drm gem object: %d\n", ret); -+ goto failed_object_init; -+ } -+ -+ expected = sg_dma_address(sgt->sgl); -+ for_each_sg(sgt->sgl, s, sgt->nents, i) { -+ if (sg_dma_address(s) != expected) { -+ DRM_ERROR("sg_table is not contiguous"); -+ ret = -EINVAL; -+ goto failed_check_continue; -+ } -+ expected = sg_dma_address(s) + sg_dma_len(s); -+ } -+ -+ phytium_gem_obj->iova = sg_dma_address(sgt->sgl); -+ phytium_gem_obj->sgt = sgt; -+ -+ return &phytium_gem_obj->base; -+failed_check_continue: -+ drm_gem_object_release(&phytium_gem_obj->base); -+failed_object_init: -+ kfree(phytium_gem_obj); -+failed_malloc: -+ return ERR_PTR(ret); -+} -+ -+int phytium_gem_prime_vmap(struct drm_gem_object *obj, struct iosys_map *map) -+{ -+ struct phytium_gem_object *phytium_obj = to_phytium_gem_obj(obj); -+ -+ iosys_map_set_vaddr(map, phytium_obj->vaddr); -+ -+ return 0; -+} -+ -+void phytium_gem_prime_vunmap(struct drm_gem_object *obj, struct iosys_map *map) -+{ -+} -+ -+int phytium_gem_prime_mmap(struct drm_gem_object *obj, struct vm_area_struct *vma) -+{ -+ return phytium_gem_mmap_obj(obj, vma); -+} -+ -+static void phytium_dma_callback(void *callback_param) -+{ -+ struct completion *comp = callback_param; -+ -+ complete(comp); -+} -+ -+int phytium_dma_transfer(struct drm_device *drm_dev, int dev_to_mem, void *addr, -+ dma_addr_t iova, uint64_t size) -+{ -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ struct dma_chan *dma_chan = priv->dma_chan; -+ struct sg_table st; -+ struct scatterlist *sgl; -+ int ret = 0, timeout; -+ uint32_t nents, i; -+ struct dma_slave_config cfg = {0}; -+ struct dma_async_tx_descriptor *desc; -+ struct completion comp; -+ enum dma_data_direction dir; -+ size_t min = 0; -+ -+ nents = DIV_ROUND_UP(size, PAGE_SIZE); -+ ret = sg_alloc_table(&st, nents, GFP_KERNEL); -+ if (ret) { -+ DRM_ERROR("failed to allocate sg_table\n"); -+ ret = -ENOMEM; -+ goto failed_sg_alloc_table; -+ } -+ -+ for_each_sg(st.sgl, sgl, st.nents, i) { -+ min = min_t(size_t, size, PAGE_SIZE - offset_in_page(addr)); -+ sg_set_page(sgl, vmalloc_to_page(addr), min, offset_in_page(addr)); -+ addr += min; -+ size -= min; -+ } -+ -+ memset(&cfg, 0, sizeof(cfg)); -+ if (dev_to_mem) { -+ cfg.direction = DMA_DEV_TO_MEM; -+ cfg.src_addr = iova; -+ cfg.dst_addr = 0; -+ dir = DMA_FROM_DEVICE; -+ } else { -+ cfg.direction = DMA_MEM_TO_DEV; -+ cfg.src_addr = 0; -+ cfg.dst_addr = iova; -+ dir = DMA_TO_DEVICE; -+ } -+ -+ dmaengine_slave_config(dma_chan, &cfg); -+ -+ nents = dma_map_sg(dma_chan->device->dev, st.sgl, st.nents, dir); -+ if (!nents) { -+ DRM_DEV_ERROR(drm_dev->dev, "failed to dma_map_sg for dmaengine\n"); -+ ret = -EINVAL; -+ goto failed_dma_map_sg; -+ } -+ st.nents = nents; -+ dma_sync_sg_for_device(dma_chan->device->dev, st.sgl, st.nents, dir); -+ -+ sgl = st.sgl; -+ desc = dmaengine_prep_slave_sg(dma_chan, -+ st.sgl, -+ st.nents, -+ cfg.direction, -+ DMA_PREP_INTERRUPT | DMA_CTRL_ACK); -+ if (!desc) { -+ DRM_DEV_ERROR(drm_dev->dev, "failed to dmaengine_prep_slave_sg\n"); -+ ret = -EINVAL; -+ goto failed_prep_slave_sg; -+ } -+ init_completion(&comp); -+ desc->callback = phytium_dma_callback; -+ desc->callback_param = ∁ -+ -+ dmaengine_submit(desc); -+ dma_async_issue_pending(dma_chan); -+ -+ timeout = wait_for_completion_timeout(&comp, 2 * HZ); -+ if (timeout == 0) { -+ DRM_DEV_ERROR(drm_dev->dev, "wait for dma callback timeout\n"); -+ ret = -EIO; -+ } -+ dma_sync_sg_for_cpu(dma_chan->device->dev, st.sgl, st.nents, dir); -+ -+failed_prep_slave_sg: -+ dma_unmap_sg(dma_chan->device->dev, st.sgl, st.nents, dir); -+failed_dma_map_sg: -+ sg_free_table(&st); -+failed_sg_alloc_table: -+ return ret; -+} -+ -+int phytium_gem_suspend(struct drm_device *drm_dev) -+{ -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ int ret = 0; -+ -+ list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { -+ if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && -+ (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) -+ continue; -+ -+ phytium_gem_obj->vaddr_save = vmalloc(phytium_gem_obj->size); -+ if (!phytium_gem_obj->vaddr_save) -+ goto malloc_failed; -+ -+ if (priv->dma_inited) -+ ret = phytium_dma_transfer(drm_dev, 1, phytium_gem_obj->vaddr_save, -+ phytium_gem_obj->iova, phytium_gem_obj->size); -+ -+ if ((!priv->dma_inited) || ret) -+ memcpy(phytium_gem_obj->vaddr_save, phytium_gem_obj->vaddr, -+ phytium_gem_obj->size); -+ } -+ -+ return 0; -+malloc_failed: -+ list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { -+ if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && -+ (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) -+ continue; -+ -+ if (phytium_gem_obj->vaddr_save) { -+ vfree(phytium_gem_obj->vaddr_save); -+ phytium_gem_obj->vaddr_save = NULL; -+ } -+ } -+ return -ENOMEM; -+} -+ -+void phytium_gem_resume(struct drm_device *drm_dev) -+{ -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ -+ list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { -+ if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && -+ (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) -+ continue; -+ -+ memcpy(phytium_gem_obj->vaddr, phytium_gem_obj->vaddr_save, phytium_gem_obj->size); -+ vfree(phytium_gem_obj->vaddr_save); -+ phytium_gem_obj->vaddr_save = NULL; -+ } -+} -+ -+void phytium_gem_free_object(struct drm_gem_object *obj) -+{ -+ struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); -+ struct drm_device *dev = obj->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ uint64_t size = phytium_gem_obj->size; -+ -+ DRM_DEBUG_KMS("free phytium_gem_obj iova:0x%pa size:0x%lx\n", -+ &phytium_gem_obj->iova, phytium_gem_obj->size); -+ if (phytium_gem_obj->vaddr) { -+ if ((phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) || -+ (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE)) { -+ phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); -+ priv->mem_state[PHYTIUM_MEM_VRAM_ALLOC] -= size; -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { -+ dma_unmap_page(dev->dev, phytium_gem_obj->iova, size, DMA_TO_DEVICE); -+ phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC] -= size; -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { -+ dma_free_attrs(dev->dev, size, phytium_gem_obj->vaddr, -+ phytium_gem_obj->iova, 0); -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC] -= size; -+ } -+ list_del(&phytium_gem_obj->list); -+ } else if (obj->import_attach) -+ drm_prime_gem_destroy(obj, phytium_gem_obj->sgt); -+ drm_gem_object_release(obj); -+ kfree(phytium_gem_obj); -+} -+ -+int phytium_gem_mmap_obj(struct drm_gem_object *obj, struct vm_area_struct *vma) -+{ -+ int ret = 0; -+ struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); -+ unsigned long pfn = PHYS_PFN(phytium_gem_obj->phys_addr); -+ /* -+ * Clear the VM_PFNMAP flag that was set by drm_gem_mmap(), and set the -+ * vm_pgoff (used as a fake buffer offset by DRM) to 0 as we want to map -+ * the whole buffer. -+ */ -+ vm_flags_clear(vma, VM_PFNMAP); -+ vma->vm_pgoff = 0; -+ vma->vm_page_prot = vm_get_page_prot(vma->vm_flags); -+ -+ if (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) { -+ vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot); -+ ret = remap_pfn_range(vma, vma->vm_start, pfn, -+ vma->vm_end - vma->vm_start, vma->vm_page_prot); -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE) { -+ vma->vm_page_prot = pgprot_device(vma->vm_page_prot); -+ ret = remap_pfn_range(vma, vma->vm_start, pfn, -+ vma->vm_end - vma->vm_start, vma->vm_page_prot); -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { -+ ret = remap_pfn_range(vma, vma->vm_start, pfn, -+ vma->vm_end - vma->vm_start, vma->vm_page_prot); -+ } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { -+ ret = dma_mmap_attrs(obj->dev->dev, vma, phytium_gem_obj->vaddr, -+ phytium_gem_obj->iova, vma->vm_end - vma->vm_start, 0); -+ } -+ if (ret) -+ drm_gem_vm_close(vma); -+ -+ return ret; -+} -+ -+int phytium_gem_mmap(struct file *filp, struct vm_area_struct *vma) -+{ -+ int ret = 0; -+ -+ ret = drm_gem_mmap(filp, vma); -+ return ret; -+} -+ -+static const struct vm_operations_struct phytium_vm_ops = { -+ .open = drm_gem_vm_open, -+ .close = drm_gem_vm_close, -+}; -+ -+static const struct drm_gem_object_funcs phytium_drm_gem_object_funcs = { -+ .free = phytium_gem_free_object, -+ .get_sg_table = phytium_gem_prime_get_sg_table, -+ .vmap = phytium_gem_prime_vmap, -+ .vunmap = phytium_gem_prime_vunmap, -+ .vm_ops = &phytium_vm_ops, -+ .mmap = phytium_gem_prime_mmap, -+}; -+ -+struct phytium_gem_object *phytium_gem_create_object(struct drm_device *dev, unsigned long size) -+{ -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct page *page = NULL; -+ int ret = 0; -+ -+ phytium_gem_obj = kzalloc(sizeof(*phytium_gem_obj), GFP_KERNEL); -+ if (!phytium_gem_obj) { -+ DRM_ERROR("failed to allocate phytium_gem_obj\n"); -+ ret = -ENOMEM; -+ goto error; -+ } -+ -+ ret = drm_gem_object_init(dev, &phytium_gem_obj->base, size); -+ if (ret) { -+ DRM_ERROR("failed to initialize drm gem object: %d\n", ret); -+ goto failed_object_init; -+ } -+ -+ if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) { -+ ret = phytium_memory_pool_alloc(priv, &phytium_gem_obj->vaddr, -+ &phytium_gem_obj->phys_addr, size); -+ if (ret) { -+ DRM_ERROR("fail to allocate vram buffer with size %lx\n", size); -+ goto failed_dma_alloc; -+ } -+ phytium_gem_obj->iova = phytium_gem_obj->phys_addr; -+ phytium_gem_obj->memory_type = priv->support_memory_type; -+ priv->mem_state[PHYTIUM_MEM_VRAM_ALLOC] += size; -+ } else if (priv->support_memory_type & MEMORY_TYPE_SYSTEM_CARVEOUT) { -+ ret = phytium_memory_pool_alloc(priv, &phytium_gem_obj->vaddr, -+ &phytium_gem_obj->phys_addr, size); -+ if (ret) { -+ DRM_ERROR("fail to allocate carveout memory with size %lx\n", size); -+ goto failed_dma_alloc; -+ } -+ page = phys_to_page(phytium_gem_obj->phys_addr); -+ phytium_gem_obj->iova = dma_map_page(dev->dev, page, 0, size, DMA_TO_DEVICE); -+ if (dma_mapping_error(dev->dev, phytium_gem_obj->iova)) { -+ DRM_ERROR("fail to dma map carveout memory with size %lx\n", size); -+ phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); -+ ret = -ENOMEM; -+ goto failed_dma_alloc; -+ } -+ phytium_gem_obj->memory_type = MEMORY_TYPE_SYSTEM_CARVEOUT; -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC] += size; -+ } else if (priv->support_memory_type & MEMORY_TYPE_SYSTEM_UNIFIED) { -+ phytium_gem_obj->vaddr = dma_alloc_attrs(dev->dev, size, &phytium_gem_obj->iova, -+ GFP_KERNEL, 0); -+ if (!phytium_gem_obj->vaddr) { -+ DRM_ERROR("fail to allocate unified buffer with size %lx\n", size); -+ ret = -ENOMEM; -+ goto failed_dma_alloc; -+ } -+ phytium_gem_obj->memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC] += size; -+ } else { -+ DRM_ERROR("fail to allocate buffer with size %lx\n", size); -+ ret = -ENOMEM; -+ goto failed_dma_alloc; -+ } -+ -+ phytium_gem_obj->base.funcs = &phytium_drm_gem_object_funcs; -+ -+ phytium_gem_obj->size = size; -+ list_add_tail(&phytium_gem_obj->list, &priv->gem_list_head); -+ DRM_DEBUG_KMS("phytium_gem_obj iova:0x%pa size:0x%lx\n", -+ &phytium_gem_obj->iova, phytium_gem_obj->size); -+ return phytium_gem_obj; -+ -+failed_dma_alloc: -+ drm_gem_object_put(&phytium_gem_obj->base); -+ -+ return ERR_PTR(ret); -+failed_object_init: -+ kfree(phytium_gem_obj); -+error: -+ return ERR_PTR(ret); -+} -+ -+int phytium_gem_dumb_create(struct drm_file *file, struct drm_device *dev, -+ struct drm_mode_create_dumb *args) -+{ -+ int size = 0; -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ int ret = 0; -+ -+ args->pitch = ALIGN(args->width*DIV_ROUND_UP(args->bpp, 8), 128); -+ args->size = args->pitch * args->height; -+ size = PAGE_ALIGN(args->size); -+ phytium_gem_obj = phytium_gem_create_object(dev, size); -+ if (IS_ERR(phytium_gem_obj)) -+ return PTR_ERR(phytium_gem_obj); -+ ret = drm_gem_handle_create(file, &phytium_gem_obj->base, &args->handle); -+ if (ret) { -+ DRM_ERROR("failed to drm_gem_handle_create\n"); -+ goto failed_gem_handle; -+ } -+ drm_gem_object_put(&phytium_gem_obj->base); -+ -+ return 0; -+failed_gem_handle: -+ phytium_gem_free_object(&phytium_gem_obj->base); -+ return ret; -+} -diff --git a/drivers/gpu/drm/phytium/phytium_gem.h b/drivers/gpu/drm/phytium/phytium_gem.h -new file mode 100644 -index 000000000..693d5408f ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_gem.h -@@ -0,0 +1,42 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_GEM_H__ -+#define __PHYTIUM_GEM_H__ -+ -+#include -+ -+struct phytium_gem_object { -+ struct drm_gem_object base; -+ phys_addr_t phys_addr; -+ dma_addr_t iova; -+ void *vaddr; -+ unsigned long size; -+ struct sg_table *sgt; -+ char memory_type; -+ char reserve[3]; -+ struct list_head list; -+ void *vaddr_save; -+}; -+ -+#define to_phytium_gem_obj(obj) container_of(obj, struct phytium_gem_object, base) -+ -+int phytium_memory_pool_init(struct device *dev, struct phytium_display_private *priv); -+void phytium_memory_pool_fini(struct device *dev, struct phytium_display_private *priv); -+int phytium_gem_mmap_obj(struct drm_gem_object *obj, struct vm_area_struct *vma); -+int phytium_gem_mmap(struct file *filp, struct vm_area_struct *vma); -+void phytium_gem_free_object(struct drm_gem_object *obj); -+struct sg_table *phytium_gem_prime_get_sg_table(struct drm_gem_object *obj); -+struct drm_gem_object *phytium_gem_prime_import_sg_table(struct drm_device *dev, -+ struct dma_buf_attachment *attach, struct sg_table *sgt); -+void phytium_gem_free_object(struct drm_gem_object *obj); -+int phytium_gem_dumb_destroy(struct drm_file *file, struct drm_device *dev, unsigned int handle); -+struct phytium_gem_object *phytium_gem_create_object(struct drm_device *dev, unsigned long size); -+int phytium_gem_dumb_create(struct drm_file *file, struct drm_device *dev, -+ struct drm_mode_create_dumb *args); -+int phytium_gem_suspend(struct drm_device *drm_dev); -+void phytium_gem_resume(struct drm_device *drm_dev); -+#endif /* __PHYTIUM_GEM_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_panel.c b/drivers/gpu/drm/phytium/phytium_panel.c -new file mode 100644 -index 000000000..15fe45f42 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_panel.c -@@ -0,0 +1,420 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_dp.h" -+#include "phytium_panel.h" -+ -+static int -+phytium_dp_aux_set_backlight(struct phytium_panel *panel, unsigned int level) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ unsigned char vals[2] = { 0x0 }; -+ -+ vals[0] = level; -+ if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) { -+ vals[0] = (level & 0xFF00) >> 8; -+ vals[1] = (level & 0xFF); -+ } -+ -+ if (drm_dp_dpcd_write(&phytium_dp->aux, DP_EDP_BACKLIGHT_BRIGHTNESS_MSB, -+ vals, sizeof(vals)) < 0) { -+ DRM_DEBUG_KMS("Failed to write aux backlight level\n"); -+ return -EIO; -+ } -+ -+ return 0; -+} -+ -+static unsigned int phytium_dp_aux_get_backlight(struct phytium_panel *panel) -+{ -+ unsigned char read_val[2] = { 0x0 }; -+ unsigned char level = 0; -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ if (drm_dp_dpcd_read(&phytium_dp->aux, DP_EDP_BACKLIGHT_BRIGHTNESS_MSB, -+ &read_val, sizeof(read_val)) < 0) { -+ DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", -+ DP_EDP_BACKLIGHT_BRIGHTNESS_MSB); -+ return 0; -+ } -+ -+ level = read_val[0]; -+ if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) -+ level = (read_val[0] << 8 | read_val[1]); -+ -+ return level; -+} -+ -+static void set_aux_backlight_enable(struct phytium_panel *panel, bool enable) -+{ -+ u8 reg_val = 0; -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ if (!(phytium_dp->edp_dpcd[1] & DP_EDP_BACKLIGHT_AUX_ENABLE_CAP)) -+ return; -+ -+ if (drm_dp_dpcd_readb(&phytium_dp->aux, DP_EDP_DISPLAY_CONTROL_REGISTER, -+ ®_val) < 0) { -+ DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", -+ DP_EDP_DISPLAY_CONTROL_REGISTER); -+ return; -+ } -+ -+ if (enable) -+ reg_val |= DP_EDP_BACKLIGHT_ENABLE; -+ else -+ reg_val &= ~(DP_EDP_BACKLIGHT_ENABLE); -+ -+ if (drm_dp_dpcd_writeb(&phytium_dp->aux, DP_EDP_DISPLAY_CONTROL_REGISTER, -+ reg_val) != 1) { -+ DRM_DEBUG_KMS("Failed to %s aux backlight\n", -+ enable ? "enable" : "disable"); -+ } -+} -+ -+static void phytium_dp_aux_enable_backlight(struct phytium_panel *panel) -+{ -+ unsigned char dpcd_buf, new_dpcd_buf, edp_backlight_mode; -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ if (drm_dp_dpcd_readb(&phytium_dp->aux, -+ DP_EDP_BACKLIGHT_MODE_SET_REGISTER, &dpcd_buf) != 1) { -+ DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", -+ DP_EDP_BACKLIGHT_MODE_SET_REGISTER); -+ return; -+ } -+ -+ new_dpcd_buf = dpcd_buf; -+ edp_backlight_mode = dpcd_buf & DP_EDP_BACKLIGHT_CONTROL_MODE_MASK; -+ -+ switch (edp_backlight_mode) { -+ case DP_EDP_BACKLIGHT_CONTROL_MODE_PWM: -+ case DP_EDP_BACKLIGHT_CONTROL_MODE_PRESET: -+ case DP_EDP_BACKLIGHT_CONTROL_MODE_PRODUCT: -+ new_dpcd_buf &= ~DP_EDP_BACKLIGHT_CONTROL_MODE_MASK; -+ new_dpcd_buf |= DP_EDP_BACKLIGHT_CONTROL_MODE_DPCD; -+ break; -+ -+ /* Do nothing when it is already DPCD mode */ -+ case DP_EDP_BACKLIGHT_CONTROL_MODE_DPCD: -+ default: -+ break; -+ } -+ -+ if (new_dpcd_buf != dpcd_buf) { -+ if (drm_dp_dpcd_writeb(&phytium_dp->aux, -+ DP_EDP_BACKLIGHT_MODE_SET_REGISTER, new_dpcd_buf) < 0) { -+ DRM_DEBUG_KMS("Failed to write aux backlight mode\n"); -+ } -+ } -+ -+ set_aux_backlight_enable(panel, true); -+ phytium_dp_aux_set_backlight(panel, panel->level); -+} -+ -+static void phytium_dp_aux_disable_backlight(struct phytium_panel *panel) -+{ -+ set_aux_backlight_enable(panel, false); -+} -+ -+static void phytium_dp_aux_setup_backlight(struct phytium_panel *panel) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) -+ phytium_dp->panel.max = 0xFFFF; -+ else -+ phytium_dp->panel.max = 0xFF; -+ -+ phytium_dp->panel.min = 0; -+ phytium_dp->panel.level = phytium_dp_aux_get_backlight(panel); -+ phytium_dp->panel.backlight_enabled = (phytium_dp->panel.level != 0); -+} -+ -+static void phytium_dp_hw_poweron_panel(struct phytium_panel *panel) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ phytium_dp->funcs->dp_hw_poweron_panel(phytium_dp); -+} -+ -+static void phytium_dp_hw_poweroff_panel(struct phytium_panel *panel) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ phytium_dp->funcs->dp_hw_poweroff_panel(phytium_dp); -+} -+ -+static int -+phytium_dp_hw_set_backlight(struct phytium_panel *panel, uint32_t level) -+{ -+ int ret; -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ ret = phytium_dp->funcs->dp_hw_set_backlight(phytium_dp, level); -+ -+ return ret; -+} -+ -+static uint32_t phytium_dp_hw_get_backlight(struct phytium_panel *panel) -+{ -+ uint32_t ret; -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ ret = phytium_dp->funcs->dp_hw_get_backlight(phytium_dp); -+ -+ return ret; -+} -+ -+static void phytium_dp_hw_enable_backlight(struct phytium_panel *panel) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ phytium_dp->funcs->dp_hw_set_backlight(phytium_dp, phytium_dp->panel.level); -+ phytium_dp->funcs->dp_hw_enable_backlight(phytium_dp); -+} -+ -+static void phytium_dp_hw_disable_backlight(struct phytium_panel *panel) -+{ -+ struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); -+ -+ phytium_dp->funcs->dp_hw_disable_backlight(phytium_dp); -+} -+ -+static void phytium_dp_hw_setup_backlight(struct phytium_panel *panel) -+{ -+ struct drm_device *dev = panel->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ panel->max = priv->info.backlight_max; -+ panel->min = priv->info.backlight_min; -+ panel->level = phytium_dp_hw_get_backlight(panel); -+} -+ -+void phytium_dp_panel_init_backlight_funcs(struct phytium_dp_device *phytium_dp) -+{ -+ if (phytium_dp->edp_dpcd[1] & DP_EDP_TCON_BACKLIGHT_ADJUSTMENT_CAP && -+ (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_AUX_SET_CAP) && -+ !(phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_PWM_PIN_CAP)) { -+ DRM_DEBUG_KMS("AUX Backlight Control Supported!\n"); -+ phytium_dp->panel.setup_backlight = phytium_dp_aux_setup_backlight; -+ phytium_dp->panel.enable_backlight = phytium_dp_aux_enable_backlight; -+ phytium_dp->panel.disable_backlight = phytium_dp_aux_disable_backlight; -+ phytium_dp->panel.set_backlight = phytium_dp_aux_set_backlight; -+ phytium_dp->panel.get_backlight = phytium_dp_aux_get_backlight; -+ } else { -+ DRM_DEBUG_KMS("PWM Backlight Control Supported!\n"); -+ phytium_dp->panel.setup_backlight = phytium_dp_hw_setup_backlight; -+ phytium_dp->panel.enable_backlight = phytium_dp_hw_enable_backlight; -+ phytium_dp->panel.disable_backlight = phytium_dp_hw_disable_backlight; -+ phytium_dp->panel.set_backlight = phytium_dp_hw_set_backlight; -+ phytium_dp->panel.get_backlight = phytium_dp_hw_get_backlight; -+ } -+ phytium_dp->panel.poweron = phytium_dp_hw_poweron_panel; -+ phytium_dp->panel.poweroff = phytium_dp_hw_poweroff_panel; -+ mutex_init(&phytium_dp->panel.panel_lock); -+ phytium_dp->panel.dev = phytium_dp->dev; -+ -+ /* Upper limits from eDP 1.3 spec */ -+ phytium_dp->panel.panel_power_up_delay = 210; /* t1_t3 */ -+ phytium_dp->panel.backlight_on_delay = 50; /* t7 */ -+ phytium_dp->panel.backlight_off_delay = 50; -+ phytium_dp->panel.panel_power_down_delay = 0; /* t10 */ -+ phytium_dp->panel.panel_power_cycle_delay = 510; /* t11 + t12 */ -+} -+ -+void phytium_dp_panel_release_backlight_funcs(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_dp->panel.setup_backlight = NULL; -+ phytium_dp->panel.enable_backlight = NULL; -+ phytium_dp->panel.disable_backlight = NULL; -+ phytium_dp->panel.set_backlight = NULL; -+ phytium_dp->panel.get_backlight = NULL; -+ phytium_dp->panel.poweron = NULL; -+ phytium_dp->panel.poweroff = NULL; -+} -+ -+void phytium_panel_enable_backlight(struct phytium_panel *panel) -+{ -+ -+ if (panel->enable_backlight) { -+ mutex_lock(&panel->panel_lock); -+ msleep(panel->backlight_on_delay); -+ panel->enable_backlight(panel); -+ panel->backlight_enabled = true; -+ mutex_unlock(&panel->panel_lock); -+ } -+} -+ -+void phytium_panel_disable_backlight(struct phytium_panel *panel) -+{ -+ if (panel->disable_backlight) { -+ mutex_lock(&panel->panel_lock); -+ panel->disable_backlight(panel); -+ panel->backlight_enabled = false; -+ msleep(panel->backlight_off_delay); -+ mutex_unlock(&panel->panel_lock); -+ } -+} -+ -+void phytium_panel_poweron(struct phytium_panel *panel) -+{ -+ if (panel->poweron) { -+ mutex_lock(&panel->panel_lock); -+ panel->poweron(panel); -+ panel->power_enabled = true; -+ msleep(panel->panel_power_up_delay); -+ mutex_unlock(&panel->panel_lock); -+ } -+} -+ -+void phytium_panel_poweroff(struct phytium_panel *panel) -+{ -+ if (panel->poweroff) { -+ mutex_lock(&panel->panel_lock); -+ msleep(panel->panel_power_down_delay); -+ panel->poweroff(panel); -+ panel->power_enabled = false; -+ mutex_unlock(&panel->panel_lock); -+ } -+} -+ -+static uint32_t phytium_scale(uint32_t source_val, -+ uint32_t source_min, uint32_t source_max, -+ uint32_t target_min, uint32_t target_max) -+{ -+ uint64_t target_val; -+ -+ WARN_ON(source_min > source_max); -+ WARN_ON(target_min > target_max); -+ -+ /* defensive */ -+ source_val = clamp(source_val, source_min, source_max); -+ -+ /* avoid overflows */ -+ target_val = mul_u32_u32(source_val - source_min, target_max - target_min); -+ target_val = DIV_ROUND_CLOSEST_ULL(target_val, source_max - source_min); -+ target_val += target_min; -+ -+ return target_val; -+} -+ -+static inline uint32_t -+phytium_scale_hw_to_user(struct phytium_panel *panel, uint32_t hw_level, uint32_t user_max) -+{ -+ return phytium_scale(hw_level, panel->min, panel->max, -+ 0, user_max); -+} -+ -+static inline uint32_t -+phytium_scale_user_to_hw(struct phytium_panel *panel, u32 user_level, u32 user_max) -+{ -+ return phytium_scale(user_level, 0, user_max, -+ panel->min, panel->max); -+} -+ -+static int phytium_backlight_device_update_status(struct backlight_device *bd) -+{ -+ struct phytium_panel *panel = bl_get_data(bd); -+ struct drm_device *dev = panel->dev; -+ uint32_t hw_level = 0; -+ int ret = 0; -+ -+ DRM_DEBUG_KMS("updating phytium_backlight, brightness=%d/%d\n", -+ bd->props.brightness, bd->props.max_brightness); -+ drm_modeset_lock(&dev->mode_config.connection_mutex, NULL); -+ hw_level = phytium_scale_user_to_hw(panel, bd->props.brightness, bd->props.max_brightness); -+ -+ if ((panel->set_backlight) && (panel->backlight_enabled)) { -+ mutex_lock(&panel->panel_lock); -+ ret = panel->set_backlight(panel, hw_level); -+ panel->level = hw_level; -+ mutex_unlock(&panel->panel_lock); -+ } -+ drm_modeset_unlock(&dev->mode_config.connection_mutex); -+ -+ return ret; -+} -+ -+static int phytium_backlight_device_get_brightness(struct backlight_device *bd) -+{ -+ struct phytium_panel *panel = bl_get_data(bd); -+ struct drm_device *dev = panel->dev; -+ uint32_t hw_level = 0; -+ int ret; -+ -+ drm_modeset_lock(&dev->mode_config.connection_mutex, NULL); -+ if (panel->get_backlight && panel->backlight_enabled) { -+ mutex_lock(&panel->panel_lock); -+ hw_level = panel->get_backlight(panel); -+ panel->level = hw_level; -+ mutex_unlock(&panel->panel_lock); -+ } -+ drm_modeset_unlock(&dev->mode_config.connection_mutex); -+ ret = phytium_scale_hw_to_user(panel, hw_level, bd->props.max_brightness); -+ DRM_DEBUG_KMS("get phytium_backlight, brightness=%d/%d\n", -+ ret, bd->props.max_brightness); -+ -+ return ret; -+} -+ -+static const struct backlight_ops phytium_backlight_device_ops = { -+ .update_status = phytium_backlight_device_update_status, -+ .get_brightness = phytium_backlight_device_get_brightness, -+}; -+ -+int phytium_edp_backlight_device_register(struct phytium_dp_device *phytium_dp) -+{ -+ struct backlight_properties props; -+ char bl_name[16]; -+ -+ if (phytium_dp->panel.setup_backlight) { -+ mutex_lock(&phytium_dp->panel.panel_lock); -+ phytium_dp->panel.setup_backlight(&phytium_dp->panel); -+ mutex_unlock(&phytium_dp->panel.panel_lock); -+ } else { -+ return -EINVAL; -+ } -+ -+ memset(&props, 0, sizeof(props)); -+ props.max_brightness = PHYTIUM_MAX_BL_LEVEL; -+ props.type = BACKLIGHT_RAW; -+ props.brightness = phytium_scale_hw_to_user(&phytium_dp->panel, phytium_dp->panel.level, -+ props.max_brightness); -+ snprintf(bl_name, sizeof(bl_name), "phytium_bl%d", phytium_dp->port); -+ -+ phytium_dp->panel.bl_device = -+ backlight_device_register(bl_name, -+ phytium_dp->connector.kdev, -+ &phytium_dp->panel, -+ &phytium_backlight_device_ops, -+ &props); -+ -+ if (IS_ERR(phytium_dp->panel.bl_device)) { -+ DRM_ERROR("Failed to register backlight: %ld\n", -+ PTR_ERR(phytium_dp->panel.bl_device)); -+ phytium_dp->panel.bl_device = NULL; -+ return -ENODEV; -+ } -+ -+ DRM_DEBUG_KMS("Connector %s backlight sysfs interface registered\n", -+ phytium_dp->connector.name); -+ -+ return 0; -+} -+ -+void phytium_edp_backlight_device_unregister(struct phytium_dp_device *phytium_dp) -+{ -+ if (phytium_dp->panel.bl_device) { -+ backlight_device_unregister(phytium_dp->panel.bl_device); -+ phytium_dp->panel.bl_device = NULL; -+ } -+} -diff --git a/drivers/gpu/drm/phytium/phytium_panel.h b/drivers/gpu/drm/phytium/phytium_panel.h -new file mode 100644 -index 000000000..ff4d760d8 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_panel.h -@@ -0,0 +1,46 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_PANEL_H__ -+#define __PHYTIUM_PANEL_H__ -+#include "phytium_dp.h" -+ -+#define PHYTIUM_MAX_BL_LEVEL 0xFF -+ -+struct phytium_panel { -+ struct drm_device *dev; -+ bool backlight_enabled; -+ bool power_enabled; -+ bool reserve1[2]; -+ unsigned int min; -+ unsigned int level; -+ unsigned int max; -+ struct backlight_device *bl_device; -+ void (*setup_backlight)(struct phytium_panel *panel); -+ uint32_t (*get_backlight)(struct phytium_panel *panel); -+ int (*set_backlight)(struct phytium_panel *panel, uint32_t level); -+ void (*disable_backlight)(struct phytium_panel *panel); -+ void (*enable_backlight)(struct phytium_panel *panel); -+ void (*poweron)(struct phytium_panel *panel); -+ void (*poweroff)(struct phytium_panel *panel); -+ struct mutex panel_lock; -+ uint32_t panel_power_up_delay; -+ uint32_t backlight_on_delay; -+ uint32_t backlight_off_delay; -+ uint32_t panel_power_down_delay; -+ uint32_t panel_power_cycle_delay; -+}; -+ -+void phytium_dp_panel_init_backlight_funcs(struct phytium_dp_device *phytium_dp); -+void phytium_panel_release_backlight_funcs(struct phytium_dp_device *phytium_dp); -+int phytium_edp_backlight_device_register(struct phytium_dp_device *phytium_dp); -+void phytium_edp_backlight_device_unregister(struct phytium_dp_device *phytium_dp); -+void phytium_panel_enable_backlight(struct phytium_panel *panel); -+void phytium_panel_disable_backlight(struct phytium_panel *panel); -+void phytium_panel_poweron(struct phytium_panel *panel); -+void phytium_panel_poweroff(struct phytium_panel *panel); -+ -+#endif /* __PHYTIUM_PANEL_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_pci.c b/drivers/gpu/drm/phytium/phytium_pci.c -new file mode 100644 -index 000000000..80a1db064 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_pci.c -@@ -0,0 +1,433 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_pci.h" -+#include "phytium_dp.h" -+#include "phytium_gem.h" -+#include "px210_dc.h" -+#include "px210_dp.h" -+#include "pe220x_dc.h" -+#include "pe220x_dp.h" -+ -+int dc_msi_enable; -+module_param(dc_msi_enable, int, 0644); -+MODULE_PARM_DESC(dc_msi_enable, "Enable DC msi interrupt (0-disabled; 1-enabled; default-0)"); -+ -+void phytium_pci_vram_hw_init(struct phytium_display_private *priv) -+{ -+ struct phytium_pci_private *pci_priv = to_pci_priv(priv); -+ -+ pci_priv->dc_hw_vram_init(priv, priv->pool_phys_addr, priv->pool_size); -+} -+ -+static bool phytium_pci_host_is_5c01(struct pci_bus *bus) -+{ -+ struct pci_bus *child = bus; -+ struct pci_dev *root = NULL; -+ -+ while (child) { -+ if (child->parent->parent) -+ child = child->parent; -+ else -+ break; -+ } -+ -+ root = child->self; -+ if ((root->vendor == 0x1db7) && (root->device == 0x5c01)) -+ return true; -+ return false; -+} -+ -+int phytium_pci_vram_init(struct pci_dev *pdev, struct phytium_display_private *priv) -+{ -+ int ret = 0; -+ -+ priv->pool_phys_addr = pci_resource_start(pdev, 2); -+ priv->pool_size = pci_resource_len(pdev, 2); -+ if ((priv->pool_phys_addr != 0) && (priv->pool_size != 0)) { -+ if ((pdev->device == 0xdc3e) && phytium_pci_host_is_5c01(pdev->bus)) { -+ priv->pool_virt_addr = devm_ioremap(&pdev->dev, priv->pool_phys_addr, -+ priv->pool_size); -+ priv->support_memory_type = MEMORY_TYPE_VRAM_DEVICE; -+ } else { -+ priv->pool_virt_addr = devm_ioremap_wc(&pdev->dev, priv->pool_phys_addr, -+ priv->pool_size); -+ priv->support_memory_type = MEMORY_TYPE_VRAM_WC; -+ } -+ if (priv->pool_virt_addr == NULL) { -+ DRM_ERROR("pci vram ioremap fail, addr:0x%llx, size:0x%llx\n", -+ priv->pool_phys_addr, priv->pool_size); -+ ret = -EINVAL; -+ goto failed_ioremap; -+ } -+ ret = phytium_memory_pool_init(&pdev->dev, priv); -+ if (ret) -+ goto failed_init_memory_pool; -+ -+ priv->mem_state[PHYTIUM_MEM_VRAM_TOTAL] = priv->pool_size; -+ priv->vram_hw_init = phytium_pci_vram_hw_init; -+ } else { -+ DRM_DEBUG_KMS("not support vram\n"); -+ priv->pool_virt_addr = NULL; -+ priv->mem_state[PHYTIUM_MEM_VRAM_TOTAL] = 0; -+ priv->support_memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; -+ priv->vram_hw_init = NULL; -+ } -+ -+ return 0; -+ -+failed_init_memory_pool: -+ devm_iounmap(&pdev->dev, priv->pool_virt_addr); -+failed_ioremap: -+ return ret; -+} -+ -+void phytium_pci_vram_fini(struct pci_dev *pdev, struct phytium_display_private *priv) -+{ -+ if ((priv->support_memory_type == MEMORY_TYPE_VRAM_WC) || -+ (priv->support_memory_type == MEMORY_TYPE_VRAM_DEVICE)) { -+ phytium_memory_pool_fini(&pdev->dev, priv); -+ devm_iounmap(&pdev->dev, priv->pool_virt_addr); -+ } -+} -+ -+static bool phytium_pci_dma_chan_filter(struct dma_chan *chan, void *param) -+{ -+ struct phytium_dma_slave *s = param; -+ -+ if (s->dma_dev != chan->device->dev) -+ return false; -+ -+ if (s->chan_id == chan->chan_id) -+ return true; -+ else -+ return false; -+} -+ -+int phytium_pci_dma_init(struct phytium_display_private *priv) -+{ -+ struct pci_dev *dma_dev, *gpu_dev; -+ struct drm_device *drm_dev = priv->dev; -+ dma_cap_mask_t mask; -+ struct phytium_dma_slave s; -+ int ret = 0; -+ u16 cmd; -+ -+ /* check px210 gpu enable */ -+ gpu_dev = pci_get_device(PCI_VENDOR_ID_PHYTIUM, 0xdc20, NULL); -+ if (!gpu_dev) { -+ DRM_INFO("failed to get gpu_dev\n"); -+ ret = -ENODEV; -+ goto failed; -+ } -+ -+ pci_read_config_word(gpu_dev, PCI_COMMAND, &cmd); -+ if (!(cmd & PCI_COMMAND_MASTER)) { -+ DRM_INFO("gpu_dev master is disabled\n"); -+ ret = -ENODEV; -+ goto failed; -+ } -+ -+ dma_dev = pci_get_device(PCI_VENDOR_ID_PHYTIUM, 0xdc3c, NULL); -+ if (!dma_dev) { -+ DRM_INFO("failed to get dma_dev\n"); -+ ret = -ENODEV; -+ goto failed; -+ } -+ -+ dma_cap_zero(mask); -+ dma_cap_set(DMA_SLAVE, mask); -+ -+ s.dma_dev = &dma_dev->dev; -+ s.chan_id = 2; -+ priv->dma_chan = dma_request_channel(mask, phytium_pci_dma_chan_filter, &s); -+ if (!priv->dma_chan) { -+ DRM_DEV_ERROR(drm_dev->dev, "failed to request dma chan\n"); -+ ret = -EBUSY; -+ goto failed; -+ } -+ priv->dma_inited = 1; -+ -+failed: -+ return ret; -+} -+ -+void phytium_pci_dma_fini(struct phytium_display_private *priv) -+{ -+ if (priv->dma_inited) -+ dma_release_channel(priv->dma_chan); -+ priv->dma_inited = 0; -+ priv->dma_chan = NULL; -+} -+ -+static struct phytium_display_private* -+phytium_pci_private_init(struct pci_dev *pdev, const struct pci_device_id *ent) -+{ -+ struct drm_device *dev = pci_get_drvdata(pdev); -+ struct phytium_display_private *priv = NULL; -+ struct phytium_pci_private *pci_priv = NULL; -+ struct phytium_device_info *phytium_info = (struct phytium_device_info *)ent->driver_data; -+ int i = 0; -+ resource_size_t io_addr, io_size; -+ -+ pci_priv = devm_kzalloc(&pdev->dev, sizeof(*pci_priv), GFP_KERNEL); -+ if (!pci_priv) { -+ DRM_ERROR("no memory to allocate for drm_display_private\n"); -+ goto failed_malloc_priv; -+ } -+ -+ memset(pci_priv, 0, sizeof(*pci_priv)); -+ priv = &pci_priv->base; -+ phytium_display_private_init(priv, dev); -+ -+ memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); -+ DRM_DEBUG_KMS("priv->info.num_pipes :%d\n", priv->info.num_pipes); -+ priv->info.pipe_mask = ((pdev->subsystem_device >> PIPE_MASK_SHIFT) & PIPE_MASK_MASK); -+ priv->info.edp_mask = ((pdev->subsystem_device >> EDP_MASK_SHIFT) & EDP_MASK_MASK); -+ priv->info.num_pipes = 0; -+ for_each_pipe_masked(priv, i) -+ priv->info.num_pipes++; -+ if (priv->info.num_pipes == 0) { -+ DRM_ERROR("num_pipes is zero, so exit init\n"); -+ goto failed_init_numpipe; -+ } -+ -+ io_addr = pci_resource_start(pdev, 0); -+ io_size = pci_resource_len(pdev, 0); -+ priv->regs = ioremap(io_addr, io_size); -+ if (priv->regs == NULL) { -+ DRM_ERROR("pci bar0 ioremap fail, addr:0x%llx, size:0x%llx\n", io_addr, io_size); -+ goto failed_ioremap; -+ } -+ -+ priv->irq = pdev->irq; -+ if (IS_PX210(priv)) { -+ pci_priv->dc_hw_vram_init = px210_dc_hw_vram_init; -+ priv->dc_hw_clear_msi_irq = px210_dc_hw_clear_msi_irq; -+ priv->dc_hw_fb_format_check = px210_dc_hw_fb_format_check; -+ } else if (IS_PE220X(priv)) { -+ pci_priv->dc_hw_vram_init = pe220x_dc_hw_vram_init; -+ priv->dc_hw_clear_msi_irq = NULL; -+ priv->dc_hw_fb_format_check = pe220x_dc_hw_fb_format_check; -+ } -+ -+ return priv; -+ -+failed_ioremap: -+failed_init_numpipe: -+ devm_kfree(&pdev->dev, pci_priv); -+failed_malloc_priv: -+ return NULL; -+} -+ -+static void -+phytium_pci_private_fini(struct pci_dev *pdev, struct phytium_display_private *priv) -+{ -+ struct phytium_pci_private *pci_priv = to_pci_priv(priv); -+ -+ if (priv->regs) -+ iounmap(priv->regs); -+ -+ devm_kfree(&pdev->dev, pci_priv); -+} -+ -+static int phytium_remove_conflicting_framebuffers(struct pci_dev *pdev) -+{ -+ resource_size_t base, size; -+ -+ base = pci_resource_start(pdev, 2); -+ size = pci_resource_len(pdev, 2); -+ -+ return drm_aperture_remove_conflicting_framebuffers(base, size, -+ &phytium_display_drm_driver); -+ -+} -+ -+static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent) -+{ -+ struct phytium_display_private *priv = NULL; -+ struct drm_device *dev = NULL; -+ int ret = 0; -+ -+ ret = phytium_remove_conflicting_framebuffers(pdev); -+ if (ret) { -+ DRM_ERROR("failed to remove conflicting phytium framebuffers\n"); -+ return ret; -+ } -+ -+ dev = drm_dev_alloc(&phytium_display_drm_driver, &pdev->dev); -+ if (IS_ERR(dev)) { -+ DRM_ERROR("failed to allocate drm_device\n"); -+ return PTR_ERR(dev); -+ } -+ pci_set_drvdata(pdev, dev); -+ pci_set_master(pdev); -+ ret = pci_enable_device(pdev); -+ if (ret) { -+ DRM_ERROR("pci enable device fail\n"); -+ goto failed_enable_device; -+ } -+ -+ if (dc_msi_enable) { -+ ret = pci_enable_msi(pdev); -+ if (ret) -+ DRM_ERROR("pci enable msi fail\n"); -+ } -+ -+ dma_set_mask(&pdev->dev, DMA_BIT_MASK(40)); -+ -+ priv = phytium_pci_private_init(pdev, ent); -+ if (priv) -+ dev->dev_private = priv; -+ else -+ goto failed_pci_private_init; -+ -+ ret = phytium_pci_vram_init(pdev, priv); -+ if (ret) { -+ DRM_ERROR("failed to init pci vram\n"); -+ goto failed_pci_vram_init; -+ } -+ -+ ret = drm_dev_register(dev, 0); -+ if (ret) { -+ DRM_ERROR("failed to register drm dev\n"); -+ goto failed_register_drm; -+ } -+ -+ phytium_dp_hpd_irq_setup(dev, true); -+ -+ return 0; -+ -+failed_register_drm: -+ phytium_pci_vram_fini(pdev, priv); -+failed_pci_vram_init: -+ phytium_pci_private_fini(pdev, priv); -+failed_pci_private_init: -+ if (pdev->msi_enabled) -+ pci_disable_msi(pdev); -+ pci_disable_device(pdev); -+failed_enable_device: -+ pci_set_drvdata(pdev, NULL); -+ drm_dev_put(dev); -+ -+ return -1; -+} -+ -+static void phytium_pci_remove(struct pci_dev *pdev) -+{ -+ struct drm_device *dev = pci_get_drvdata(pdev); -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ phytium_dp_hpd_irq_setup(dev, false); -+ cancel_work_sync(&priv->hotplug_work); -+ drm_dev_unregister(dev); -+ phytium_pci_vram_fini(pdev, priv); -+ phytium_pci_private_fini(pdev, priv); -+ if (pdev->msi_enabled) -+ pci_disable_msi(pdev); -+ pci_disable_device(pdev); -+ pci_set_drvdata(pdev, NULL); -+ drm_dev_put(dev); -+} -+ -+static void phytium_pci_shutdown(struct pci_dev *pdev) -+{ -+ struct drm_device *dev = pci_get_drvdata(pdev); -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ priv->display_shutdown(dev); -+} -+ -+static int phytium_pci_pm_suspend(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct drm_device *drm_dev = pci_get_drvdata(pdev); -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ int ret = 0; -+ -+ if (IS_PX210(priv)) -+ phytium_pci_dma_init(priv); -+ -+ ret = priv->display_pm_suspend(drm_dev); -+ if (ret < 0) -+ goto out; -+ -+ pci_save_state(pdev); -+ pci_disable_device(pdev); -+ pci_set_power_state(pdev, PCI_D3hot); -+ udelay(200); -+ -+out: -+ return ret; -+} -+ -+static int phytium_pci_pm_resume(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct drm_device *drm_dev = pci_get_drvdata(pdev); -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ int ret = 0; -+ -+ pci_set_power_state(pdev, PCI_D0); -+ pci_restore_state(pdev); -+ ret = pci_enable_device(pdev); -+ if (ret) -+ return ret; -+ pci_set_master(pdev); -+ -+ ret = priv->display_pm_resume(drm_dev); -+ if (IS_PX210(priv)) -+ phytium_pci_dma_fini(priv); -+ -+ return ret; -+} -+ -+static const struct dev_pm_ops phytium_pci_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_pci_pm_suspend, phytium_pci_pm_resume) -+}; -+ -+static const struct phytium_device_info px210_info = { -+ .platform_mask = BIT(PHYTIUM_PLATFORM_PX210), -+ .total_pipes = 3, -+ .crtc_clock_max = PX210_DC_PIX_CLOCK_MAX, -+ .hdisplay_max = PX210_DC_HDISPLAY_MAX, -+ .vdisplay_max = PX210_DC_VDISPLAY_MAX, -+ .address_mask = PX210_DC_ADDRESS_MASK, -+ .backlight_max = PX210_DP_BACKLIGHT_MAX, -+ .backlight_min = PX210_DP_BACKLIGHT_MIN, -+}; -+ -+static const struct phytium_device_info pe220x_info = { -+ .platform_mask = BIT(PHYTIUM_PLATFORM_PE220X), -+ .total_pipes = 2, -+ .crtc_clock_max = PE220X_DC_PIX_CLOCK_MAX, -+ .hdisplay_max = PE220X_DC_HDISPLAY_MAX, -+ .vdisplay_max = PE220X_DC_VDISPLAY_MAX, -+ .address_mask = PE220X_DC_ADDRESS_MASK, -+ .backlight_max = PE220X_DP_BACKLIGHT_MAX, -+ .backlight_min = PE220X_DP_BACKLIGHT_MIN, -+}; -+ -+static const struct pci_device_id phytium_display_pci_ids[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc22), (kernel_ulong_t)&px210_info }, -+ { PCI_VDEVICE(PHYTIUM, 0xdc3e), (kernel_ulong_t)&pe220x_info }, -+ { /* End: all zeroes */ } -+}; -+MODULE_DEVICE_TABLE(pci, phytium_display_pci_ids); -+ -+struct pci_driver phytium_pci_driver = { -+ .name = "phytium_display_pci", -+ .id_table = phytium_display_pci_ids, -+ .probe = phytium_pci_probe, -+ .remove = phytium_pci_remove, -+ .shutdown = phytium_pci_shutdown, -+ .driver.pm = &phytium_pci_pm_ops, -+}; -diff --git a/drivers/gpu/drm/phytium/phytium_pci.h b/drivers/gpu/drm/phytium/phytium_pci.h -new file mode 100644 -index 000000000..7ac379717 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_pci.h -@@ -0,0 +1,26 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_PCI_H__ -+#define __PHYTIUM_PCI_H__ -+ -+#include "phytium_display_drv.h" -+ -+struct phytium_pci_private { -+ struct phytium_display_private base; -+ void (*dc_hw_vram_init)(struct phytium_display_private *priv, resource_size_t vram_addr, -+ resource_size_t vram_size); -+}; -+ -+struct phytium_dma_slave { -+ struct device *dma_dev; -+ u32 chan_id; -+}; -+ -+#define to_pci_priv(priv) container_of(priv, struct phytium_pci_private, base) -+ -+extern struct pci_driver phytium_pci_driver; -+#endif /* __PHYTIUM_PCI_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_plane.c b/drivers/gpu/drm/phytium/phytium_plane.c -new file mode 100644 -index 000000000..bc28ad8d4 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_plane.c -@@ -0,0 +1,672 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+ -+#include "phytium_display_drv.h" -+#include "phytium_plane.h" -+#include "phytium_fb.h" -+#include "phytium_gem.h" -+#include "phytium_crtc.h" -+#include "px210_dc.h" -+#include "pe220x_dc.h" -+#include "phytium_reg.h" -+ -+#define PHYTIUM_CURS_W_SIZE 32 -+#define PHYTIUM_CURS_H_SIZE 32 -+ -+void phytium_plane_destroy(struct drm_plane *plane) -+{ -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ -+ drm_plane_cleanup(plane); -+ kfree(phytium_plane); -+} -+ -+/** -+ * phytium_plane_atomic_get_property - fetch plane property value -+ * @plane: plane to fetch property for -+ * @state: state containing the property value -+ * @property: property to look up -+ * @val: pointer to write property value into -+ * -+ * The DRM core does not store shadow copies of properties for -+ * atomic-capable drivers. This entrypoint is used to fetch -+ * the current value of a driver-specific plane property. -+ */ -+static int -+phytium_plane_atomic_get_property(struct drm_plane *plane, -+ const struct drm_plane_state *state, -+ struct drm_property *property, -+ uint64_t *val) -+{ -+ DRM_DEBUG_KMS("Unknown plane property [PROP:%d:%s]\n", property->base.id, property->name); -+ return -EINVAL; -+} -+ -+/** -+ * phytium_plane_atomic_set_property - set plane property value -+ * @plane: plane to set property for -+ * @state: state to update property value in -+ * @property: property to set -+ * @val: value to set property to -+ * -+ * Writes the specified property value for a plane into the provided atomic -+ * state object. -+ * -+ * Returns 0 on success, -EINVAL on unrecognized properties -+ */ -+int -+phytium_plane_atomic_set_property(struct drm_plane *plane, -+ struct drm_plane_state *state, -+ struct drm_property *property, -+ uint64_t val) -+{ -+ DRM_DEBUG_KMS("Unknown plane property [PROP:%d:%s]\n", property->base.id, property->name); -+ return -EINVAL; -+} -+ -+struct drm_plane_state * -+phytium_plane_atomic_duplicate_state(struct drm_plane *plane) -+{ -+ struct drm_plane_state *state = NULL; -+ struct phytium_plane_state *phytium_state = NULL; -+ -+ phytium_state = kmemdup(plane->state, sizeof(*phytium_state), GFP_KERNEL); -+ -+ if (!phytium_state) -+ return NULL; -+ -+ state = &phytium_state->base; -+ if (state->fb) -+ drm_framebuffer_get(state->fb); -+ -+ state->fence = NULL; -+ state->commit = NULL; -+ -+ return state; -+} -+ -+void -+phytium_plane_atomic_destroy_state(struct drm_plane *plane, struct drm_plane_state *state) -+{ -+ struct phytium_plane_state *phytium_state = to_phytium_plane_state(state); -+ -+ __drm_atomic_helper_plane_destroy_state(state); -+ kfree(phytium_state); -+} -+ -+static bool phytium_plane_format_mod_supported(struct drm_plane *plane, -+ uint32_t format, uint64_t modifier) -+{ -+ if (modifier == DRM_FORMAT_MOD_LINEAR) -+ return true; -+ -+ if (modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC) { -+ switch (format) { -+ case DRM_FORMAT_ARGB2101010: -+ case DRM_FORMAT_ABGR2101010: -+ case DRM_FORMAT_RGBA1010102: -+ case DRM_FORMAT_BGRA1010102: -+ case DRM_FORMAT_ARGB8888: -+ case DRM_FORMAT_ABGR8888: -+ case DRM_FORMAT_RGBA8888: -+ case DRM_FORMAT_BGRA8888: -+ case DRM_FORMAT_XRGB8888: -+ case DRM_FORMAT_XBGR8888: -+ case DRM_FORMAT_RGBX8888: -+ case DRM_FORMAT_BGRX8888: -+ return true; -+ default: -+ return false; -+ } -+ } -+ -+ return false; -+} -+ -+const struct drm_plane_funcs phytium_plane_funcs = { -+ .update_plane = drm_atomic_helper_update_plane, -+ .disable_plane = drm_atomic_helper_disable_plane, -+ .destroy = phytium_plane_destroy, -+ .reset = drm_atomic_helper_plane_reset, -+ .atomic_get_property = phytium_plane_atomic_get_property, -+ .atomic_set_property = phytium_plane_atomic_set_property, -+ .atomic_duplicate_state = phytium_plane_atomic_duplicate_state, -+ .atomic_destroy_state = phytium_plane_atomic_destroy_state, -+ .format_mod_supported = phytium_plane_format_mod_supported, -+}; -+ -+static int -+phytium_plane_atomic_check(struct drm_plane *plane, struct drm_atomic_state *atomic_state) -+{ -+ struct drm_plane_state *state = drm_atomic_get_new_plane_state(atomic_state, -+ plane); -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct drm_framebuffer *fb = state->fb; -+ struct drm_crtc *crtc = state->crtc; -+ struct drm_crtc_state *crtc_state; -+ int src_x, src_y, src_w, src_h; -+ unsigned long base_offset; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ -+ if ((!fb) || (!crtc)) -+ return 0; -+ -+ crtc_state = drm_atomic_get_crtc_state(state->state, crtc); -+ if (IS_ERR(crtc_state)) -+ return PTR_ERR(crtc_state); -+ -+ if (plane->type == DRM_PLANE_TYPE_CURSOR) { -+ src_w = state->src_w >> 16; -+ src_h = state->src_h >> 16; -+ if (phytium_crtc->scale_enable) -+ return -EINVAL; -+ if ((src_w != PHYTIUM_CURS_W_SIZE) || (src_h != PHYTIUM_CURS_W_SIZE)) { -+ DRM_INFO("Invalid cursor size(%d, %d)\n", src_w, src_h); -+ return -EINVAL; -+ } -+ } else if (plane->type == DRM_PLANE_TYPE_PRIMARY) { -+ src_x = state->src_x >> 16; -+ src_y = state->src_y >> 16; -+ src_w = state->src_w >> 16; -+ src_h = state->src_h >> 16; -+ -+ base_offset = src_x * fb->format->cpp[0] + src_y*fb->pitches[0]; -+ if (base_offset & (priv->info.address_mask)) { -+ DRM_ERROR("fb base address is not aligned by 0x%lx byte\n", -+ priv->info.address_mask); -+ return -EINVAL; -+ } -+ -+ if (src_w != state->crtc_w || src_h != state->crtc_h) { -+ DRM_ERROR("scale not support: crtc_w(0x%x)/h(0x%x) src_w(0x%x)/h(0x%x)\n", -+ state->crtc_w, state->crtc_h, src_w, src_h); -+ return -EINVAL; -+ } -+ -+ if ((state->crtc_x < 0) || (state->crtc_y < 0)) { -+ DRM_ERROR("crtc_x(0x%x)/y(0x%x) of drm plane state is invalid\n", -+ state->crtc_x, state->crtc_y); -+ return -EINVAL; -+ } -+ -+ if ((state->crtc_x + state->crtc_w > crtc_state->adjusted_mode.hdisplay) -+ || (state->crtc_y + state->crtc_h > crtc_state->adjusted_mode.vdisplay)) { -+ DRM_ERROR("plane out of crtc region\n"); -+ return -EINVAL; -+ } -+ } -+ -+ return 0; -+} -+ -+static void phytium_dc_get_plane_parameter(struct drm_plane *plane) -+{ -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ struct drm_framebuffer *fb = plane->state->fb; -+ struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); -+ struct phytium_gem_object *phytium_gem_obj = NULL; -+ int i, num_planes = 0; -+ const struct drm_format_info *info; -+ -+ info = drm_format_info(fb->format->format); -+ num_planes = info ? info->num_planes : 1; -+ -+ for (i = 0; i < num_planes; i++) { -+ phytium_gem_obj = phytium_fb->phytium_gem_obj[i]; -+ phytium_plane->iova[i] = phytium_gem_obj->iova + fb->offsets[i]; -+ phytium_plane->size[i] = phytium_gem_obj->size - fb->offsets[i]; -+ -+ if (fb->modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC) -+ phytium_plane->tiling[i] = FRAMEBUFFER_TILE_MODE0; -+ else if (fb->modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC) -+ phytium_plane->tiling[i] = FRAMEBUFFER_TILE_MODE3; -+ else if (fb->modifier == DRM_FORMAT_MOD_LINEAR) -+ phytium_plane->tiling[i] = FRAMEBUFFER_LINEAR; -+ else -+ phytium_plane->tiling[i] = FRAMEBUFFER_LINEAR; -+ -+ if (i == 0) { -+ switch (fb->format->format) { -+ case DRM_FORMAT_ARGB2101010: -+ case DRM_FORMAT_ABGR2101010: -+ case DRM_FORMAT_RGBA1010102: -+ case DRM_FORMAT_BGRA1010102: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB2101010; -+ break; -+ -+ case DRM_FORMAT_ARGB8888: -+ case DRM_FORMAT_ABGR8888: -+ case DRM_FORMAT_RGBA8888: -+ case DRM_FORMAT_BGRA8888: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB8888; -+ break; -+ -+ case DRM_FORMAT_XRGB8888: -+ case DRM_FORMAT_XBGR8888: -+ case DRM_FORMAT_RGBX8888: -+ case DRM_FORMAT_BGRX8888: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB8888; -+ break; -+ -+ case DRM_FORMAT_ARGB4444: -+ case DRM_FORMAT_ABGR4444: -+ case DRM_FORMAT_RGBA4444: -+ case DRM_FORMAT_BGRA4444: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB4444; -+ break; -+ -+ case DRM_FORMAT_XRGB4444: -+ case DRM_FORMAT_XBGR4444: -+ case DRM_FORMAT_RGBX4444: -+ case DRM_FORMAT_BGRX4444: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB4444; -+ break; -+ -+ case DRM_FORMAT_ARGB1555: -+ case DRM_FORMAT_ABGR1555: -+ case DRM_FORMAT_RGBA5551: -+ case DRM_FORMAT_BGRA5551: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB1555; -+ break; -+ -+ case DRM_FORMAT_XRGB1555: -+ case DRM_FORMAT_XBGR1555: -+ case DRM_FORMAT_RGBX5551: -+ case DRM_FORMAT_BGRX5551: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB1555; -+ break; -+ -+ case DRM_FORMAT_RGB565: -+ case DRM_FORMAT_BGR565: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_RGB565; -+ break; -+ -+ case DRM_FORMAT_YUYV: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_YUYV; -+ break; -+ -+ case DRM_FORMAT_UYVY: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_UYVY; -+ break; -+ case DRM_FORMAT_NV16: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_NV16; -+ break; -+ case DRM_FORMAT_NV12: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_NV12; -+ break; -+ case DRM_FORMAT_NV21: -+ phytium_plane->format = FRAMEBUFFER_FORMAT_NV12; -+ break; -+ default: -+ DRM_ERROR("unsupported pixel format (format = %d)\n", -+ fb->format->format); -+ return; -+ } -+ -+ switch (fb->format->format) { -+ case DRM_FORMAT_ARGB2101010: -+ case DRM_FORMAT_ARGB8888: -+ case DRM_FORMAT_XRGB8888: -+ case DRM_FORMAT_ARGB4444: -+ case DRM_FORMAT_XRGB4444: -+ case DRM_FORMAT_ARGB1555: -+ case DRM_FORMAT_XRGB1555: -+ case DRM_FORMAT_RGB565: -+ phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ARGB; -+ phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; -+ break; -+ -+ case DRM_FORMAT_ABGR2101010: -+ case DRM_FORMAT_ABGR8888: -+ case DRM_FORMAT_XBGR8888: -+ case DRM_FORMAT_ABGR4444: -+ case DRM_FORMAT_XBGR4444: -+ case DRM_FORMAT_ABGR1555: -+ case DRM_FORMAT_XBGR1555: -+ case DRM_FORMAT_BGR565: -+ phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ABGR; -+ phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; -+ break; -+ -+ case DRM_FORMAT_RGBA1010102: -+ case DRM_FORMAT_RGBA8888: -+ case DRM_FORMAT_RGBX8888: -+ case DRM_FORMAT_RGBA4444: -+ case DRM_FORMAT_RGBX4444: -+ case DRM_FORMAT_RGBA5551: -+ case DRM_FORMAT_RGBX5551: -+ phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_RGBA; -+ phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; -+ break; -+ -+ case DRM_FORMAT_BGRA1010102: -+ case DRM_FORMAT_BGRA8888: -+ case DRM_FORMAT_BGRX8888: -+ case DRM_FORMAT_BGRA4444: -+ case DRM_FORMAT_BGRX4444: -+ case DRM_FORMAT_BGRA5551: -+ case DRM_FORMAT_BGRX5551: -+ phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_BGRA; -+ phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; -+ break; -+ -+ case DRM_FORMAT_YUYV: -+ case DRM_FORMAT_UYVY: -+ case DRM_FORMAT_NV16: -+ case DRM_FORMAT_NV12: -+ phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ARGB; -+ phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; -+ break; -+ -+ default: -+ DRM_ERROR("unsupported pixel format (format = %d)\n", -+ fb->format->format); -+ return; -+ } -+ } -+ } -+} -+ -+static void phytium_dc_primary_plane_update(struct drm_plane *plane) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ struct drm_framebuffer *fb = plane->state->fb; -+ int phys_pipe = phytium_plane->phys_pipe; -+ int src_x, src_y, crtc_x, crtc_y, crtc_w, crtc_h; -+ unsigned long base_offset; -+ int config; -+ -+ src_x = plane->state->src_x >> 16; -+ src_y = plane->state->src_y >> 16; -+ crtc_x = plane->state->crtc_x; -+ crtc_y = plane->state->crtc_y; -+ crtc_w = plane->state->crtc_w; -+ crtc_h = plane->state->crtc_h; -+ -+ if (phytium_plane->dc_hw_update_dcreq) -+ phytium_plane->dc_hw_update_dcreq(plane); -+ phytium_plane->dc_hw_update_primary_hi_addr(plane); -+ -+ /* config dc */ -+ /* Y */ -+ base_offset = src_x * fb->format->cpp[0] + src_y*fb->pitches[0]; -+ phytium_writel_reg(priv, (phytium_plane->iova[0] + base_offset) & ADDRESS_MASK, -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_Y_ADDRESS); -+ phytium_writel_reg(priv, ALIGN(fb->pitches[0], 128), -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_Y_STRIDE); -+ -+ /* U */ -+ phytium_writel_reg(priv, phytium_plane->iova[1] & 0xffffffff, -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_U_ADDRESS); -+ phytium_writel_reg(priv, ALIGN(fb->pitches[1], 128), -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_U_STRIDE); -+ -+ /* V */ -+ phytium_writel_reg(priv, phytium_plane->iova[2] & 0xffffffff, -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_V_ADDRESS); -+ phytium_writel_reg(priv, ALIGN(fb->pitches[2], 128), -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_V_STRIDE); -+ -+ /* size */ -+ phytium_writel_reg(priv, (crtc_w & WIDTH_MASK) | ((crtc_h&HEIGHT_MASK) << HEIGHT_SHIFT), -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_SIZE); -+ /* config */ -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ config &= ~(FRAMEBUFFER_FORMAT_MASK << FRAMEBUFFER_FORMAT_SHIFT); -+ config |= (phytium_plane->format << FRAMEBUFFER_FORMAT_SHIFT); -+ config &= ~(1 << FRAMEBUFFER_UVSWIZZLE_SHIFT); -+ config |= (phytium_plane->uv_swizzle << FRAMEBUFFER_UVSWIZZLE_SHIFT); -+ config &= ~(FRAMEBUFFER_SWIZZLE_MASK << FRAMEBUFFER_SWIZZLE_SHIFT); -+ config |= (phytium_plane->swizzle << FRAMEBUFFER_SWIZZLE_SHIFT); -+ config &= ~(FRAMEBUFFER_TILE_MODE_MASK << FRAMEBUFFER_TILE_MODE_SHIFT); -+ config |= (phytium_plane->tiling[0] << FRAMEBUFFER_TILE_MODE_SHIFT); -+ config &= (~FRAMEBUFFER_CLEAR); -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+} -+ -+static void phytium_dc_cursor_plane_update(struct drm_plane *plane) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ struct drm_framebuffer *fb = plane->state->fb; -+ int phys_pipe = phytium_plane->phys_pipe; -+ int config; -+ unsigned long iova; -+ -+ phytium_plane->enable = 1; -+ phytium_plane->cursor_hot_x = fb->hot_x; -+ phytium_plane->cursor_hot_y = fb->hot_y; -+ phytium_plane->cursor_x = plane->state->crtc_x + fb->hot_x; -+ phytium_plane->cursor_y = plane->state->crtc_y + fb->hot_y; -+ -+ if (phytium_plane->cursor_x < 0) { -+ phytium_plane->cursor_hot_x = plane->state->crtc_w - 1; -+ phytium_plane->cursor_x = plane->state->crtc_x + phytium_plane->cursor_hot_x; -+ } -+ -+ if (phytium_plane->cursor_y < 0) { -+ phytium_plane->cursor_hot_y = plane->state->crtc_h - 1; -+ phytium_plane->cursor_y = plane->state->crtc_y + phytium_plane->cursor_hot_y; -+ } -+ -+ config = CURSOR_FORMAT_ARGB8888 | -+ ((phytium_plane->cursor_hot_y & CURSOR_HOT_Y_MASK) << CURSOR_HOT_Y_SHIFT) | -+ ((phytium_plane->cursor_hot_x & CURSOR_HOT_X_MASK) << CURSOR_HOT_X_SHIFT); -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); -+ -+ config = ((phytium_plane->cursor_x & CURSOR_X_MASK) << CURSOR_X_SHIFT) | -+ ((phytium_plane->cursor_y & CURSOR_Y_MASK) << CURSOR_Y_SHIFT); -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_CURSOR_LOCATION); -+ iova = phytium_plane->iova[0]; -+ phytium_writel_reg(priv, iova & 0xffffffff, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_CURSOR_ADDRESS); -+ if (phytium_plane->dc_hw_update_cursor_hi_addr) -+ phytium_plane->dc_hw_update_cursor_hi_addr(plane, iova); -+} -+ -+static void phytium_plane_atomic_update(struct drm_plane *plane, -+ struct drm_atomic_state *state) -+{ -+ struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state, plane); -+ struct drm_framebuffer *fb, *old_fb; -+ -+ DRM_DEBUG_KMS("update plane: type=%d\n", plane->type); -+ if (!plane->state->crtc || !plane->state->fb) -+ return; -+ -+ fb = plane->state->fb; -+ old_fb = old_state->fb; -+ -+ if (fb) -+ drm_framebuffer_get(fb); -+ if (old_fb) -+ drm_framebuffer_put(old_fb); -+ -+ phytium_dc_get_plane_parameter(plane); -+ -+ if (plane->type == DRM_PLANE_TYPE_PRIMARY) -+ phytium_dc_primary_plane_update(plane); -+ else if (plane->type == DRM_PLANE_TYPE_CURSOR) -+ phytium_dc_cursor_plane_update(plane); -+} -+ -+static void phytium_plane_atomic_disable(struct drm_plane *plane, -+ struct drm_atomic_state *state) -+{ -+ struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state, plane); -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ int phys_pipe = phytium_plane->phys_pipe; -+ int config; -+ struct drm_framebuffer *old_fb; -+ -+ old_fb = old_state->fb; -+ if (old_fb) -+ drm_framebuffer_put(old_fb); -+ -+ if (plane->type == DRM_PLANE_TYPE_PRIMARY) { -+ phytium_writel_reg(priv, CLEAR_VALUE_RED, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE); -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ config |= FRAMEBUFFER_CLEAR; -+ phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], -+ PHYTIUM_DC_FRAMEBUFFER_CONFIG); -+ } else if (plane->type == DRM_PLANE_TYPE_CURSOR) { -+ phytium_writel_reg(priv, CURSOR_FORMAT_DISABLED, -+ priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); -+ } -+} -+ -+const struct drm_plane_helper_funcs phytium_plane_helper_funcs = { -+ .prepare_fb = drm_gem_plane_helper_prepare_fb, -+ .atomic_check = phytium_plane_atomic_check, -+ .atomic_update = phytium_plane_atomic_update, -+ .atomic_disable = phytium_plane_atomic_disable, -+}; -+ -+struct phytium_plane *phytium_primary_plane_create(struct drm_device *dev, int phys_pipe) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = NULL; -+ struct phytium_plane_state *phytium_plane_state = NULL; -+ int ret = 0; -+ unsigned int flags = 0; -+ const uint32_t *formats = NULL; -+ uint32_t format_count; -+ const uint64_t *format_modifiers; -+ -+ phytium_plane = kzalloc(sizeof(*phytium_plane), GFP_KERNEL); -+ if (!phytium_plane) { -+ ret = -ENOMEM; -+ goto failed_malloc_plane; -+ } -+ -+ phytium_plane_state = kzalloc(sizeof(*phytium_plane_state), GFP_KERNEL); -+ if (!phytium_plane_state) { -+ ret = -ENOMEM; -+ goto failed_malloc_plane_state; -+ } -+ phytium_plane_state->base.plane = &phytium_plane->base; -+ phytium_plane_state->base.rotation = DRM_MODE_ROTATE_0; -+ phytium_plane->base.state = &phytium_plane_state->base; -+ phytium_plane->phys_pipe = phys_pipe; -+ -+ if (IS_PX210(priv)) { -+ phytium_plane->dc_hw_plane_get_format = px210_dc_hw_plane_get_primary_format; -+ phytium_plane->dc_hw_update_dcreq = px210_dc_hw_update_dcreq; -+ phytium_plane->dc_hw_update_primary_hi_addr = px210_dc_hw_update_primary_hi_addr; -+ phytium_plane->dc_hw_update_cursor_hi_addr = NULL; -+ } else if (IS_PE220X(priv)) { -+ phytium_plane->dc_hw_plane_get_format = pe220x_dc_hw_plane_get_primary_format; -+ phytium_plane->dc_hw_update_dcreq = NULL; -+ phytium_plane->dc_hw_update_primary_hi_addr = pe220x_dc_hw_update_primary_hi_addr; -+ phytium_plane->dc_hw_update_cursor_hi_addr = NULL; -+ } -+ -+ phytium_plane->dc_hw_plane_get_format(&format_modifiers, &formats, &format_count); -+ ret = drm_universal_plane_init(dev, &phytium_plane->base, 0x0, -+ &phytium_plane_funcs, formats, -+ format_count, -+ format_modifiers, -+ DRM_PLANE_TYPE_PRIMARY, "primary %d", phys_pipe); -+ -+ if (ret) -+ goto failed_plane_init; -+ -+ flags = DRM_MODE_ROTATE_0; -+ drm_plane_create_rotation_property(&phytium_plane->base, DRM_MODE_ROTATE_0, flags); -+ drm_plane_helper_add(&phytium_plane->base, &phytium_plane_helper_funcs); -+ -+ return phytium_plane; -+failed_plane_init: -+ kfree(phytium_plane_state); -+failed_malloc_plane_state: -+ kfree(phytium_plane); -+failed_malloc_plane: -+ return ERR_PTR(ret); -+} -+ -+struct phytium_plane *phytium_cursor_plane_create(struct drm_device *dev, int phys_pipe) -+{ -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = NULL; -+ struct phytium_plane_state *phytium_plane_state = NULL; -+ int ret = 0; -+ unsigned int flags = 0; -+ const uint32_t *formats = NULL; -+ uint32_t format_count; -+ const uint64_t *format_modifiers; -+ -+ phytium_plane = kzalloc(sizeof(*phytium_plane), GFP_KERNEL); -+ if (!phytium_plane) { -+ ret = -ENOMEM; -+ goto failed_malloc_plane; -+ } -+ -+ phytium_plane_state = kzalloc(sizeof(*phytium_plane_state), GFP_KERNEL); -+ if (!phytium_plane_state) { -+ ret = -ENOMEM; -+ goto failed_malloc_plane_state; -+ } -+ phytium_plane_state->base.plane = &phytium_plane->base; -+ phytium_plane_state->base.rotation = DRM_MODE_ROTATE_0; -+ phytium_plane->base.state = &phytium_plane_state->base; -+ phytium_plane->phys_pipe = phys_pipe; -+ -+ if (IS_PX210(priv)) { -+ phytium_plane->dc_hw_plane_get_format = px210_dc_hw_plane_get_cursor_format; -+ phytium_plane->dc_hw_update_dcreq = NULL; -+ phytium_plane->dc_hw_update_primary_hi_addr = NULL; -+ phytium_plane->dc_hw_update_cursor_hi_addr = NULL; -+ } else if (IS_PE220X(priv)) { -+ phytium_plane->dc_hw_plane_get_format = pe220x_dc_hw_plane_get_cursor_format; -+ phytium_plane->dc_hw_update_dcreq = NULL; -+ phytium_plane->dc_hw_update_primary_hi_addr = NULL; -+ phytium_plane->dc_hw_update_cursor_hi_addr = pe220x_dc_hw_update_cursor_hi_addr; -+ } -+ -+ phytium_plane->dc_hw_plane_get_format(&format_modifiers, &formats, &format_count); -+ ret = drm_universal_plane_init(dev, &phytium_plane->base, 0x0, -+ &phytium_plane_funcs, -+ formats, format_count, -+ format_modifiers, -+ DRM_PLANE_TYPE_CURSOR, "cursor %d", phys_pipe); -+ -+ if (ret) -+ goto failed_plane_init; -+ -+ flags = DRM_MODE_ROTATE_0; -+ drm_plane_create_rotation_property(&phytium_plane->base, DRM_MODE_ROTATE_0, flags); -+ drm_plane_helper_add(&phytium_plane->base, &phytium_plane_helper_funcs); -+ -+ return phytium_plane; -+failed_plane_init: -+ kfree(phytium_plane_state); -+failed_malloc_plane_state: -+ kfree(phytium_plane); -+failed_malloc_plane: -+ return ERR_PTR(ret); -+} -diff --git a/drivers/gpu/drm/phytium/phytium_plane.h b/drivers/gpu/drm/phytium/phytium_plane.h -new file mode 100644 -index 000000000..25b6bba6c ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_plane.h -@@ -0,0 +1,46 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_PLANE_H__ -+#define __PHYTIUM_PLANE_H__ -+ -+struct phytium_plane { -+ struct drm_plane base; -+ int phys_pipe; -+ unsigned long iova[PHYTIUM_FORMAT_MAX_PLANE]; -+ unsigned long size[PHYTIUM_FORMAT_MAX_PLANE]; -+ unsigned int format; -+ unsigned int tiling[PHYTIUM_FORMAT_MAX_PLANE]; -+ unsigned int swizzle; -+ unsigned int uv_swizzle; -+ unsigned int rot_angle; -+ -+ /* only for cursor */ -+ bool enable; -+ bool reserve[3]; -+ int cursor_x; -+ int cursor_y; -+ int cursor_hot_x; -+ int cursor_hot_y; -+ -+ void (*dc_hw_plane_get_format)(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+ void (*dc_hw_update_dcreq)(struct drm_plane *plane); -+ void (*dc_hw_update_primary_hi_addr)(struct drm_plane *plane); -+ void (*dc_hw_update_cursor_hi_addr)(struct drm_plane *plane, uint64_t iova); -+}; -+ -+struct phytium_plane_state { -+ struct drm_plane_state base; -+}; -+ -+#define to_phytium_plane(x) container_of(x, struct phytium_plane, base) -+#define to_phytium_plane_state(x) container_of(x, struct phytium_plane_state, base) -+ -+struct phytium_plane *phytium_primary_plane_create(struct drm_device *dev, int pipe); -+struct phytium_plane *phytium_cursor_plane_create(struct drm_device *dev, int pipe); -+#endif /* __PHYTIUM_PLANE_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_platform.c b/drivers/gpu/drm/phytium/phytium_platform.c -new file mode 100644 -index 000000000..32c4a3efe ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_platform.c -@@ -0,0 +1,371 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium display engine DRM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "phytium_platform.h" -+#include "phytium_dp.h" -+#include "phytium_gem.h" -+#include "pe220x_dc.h" -+#include "pe220x_dp.h" -+ -+int phytium_platform_carveout_mem_init(struct platform_device *pdev, -+ struct phytium_display_private *priv) -+{ -+ struct device_node *np; -+ struct resource res; -+ struct resource *pres; -+ int ret = 0; -+ -+ if (pdev->dev.of_node) { -+ np = of_parse_phandle(pdev->dev.of_node, "memory-region", 0); -+ if(!np) -+ goto next; -+ ret = of_address_to_resource(np, 0, &res); -+ if(ret) -+ DRM_ERROR("No memory address assigned to the region\n"); -+ else { -+ priv->pool_size = resource_size(&res); -+ priv->pool_phys_addr = res.start; -+ } -+ } -+ -+next: -+ pres = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ if (pres) { -+ priv->pool_size = resource_size(pres); -+ priv->pool_phys_addr = pres->start; -+ } -+ -+ if ((priv->pool_phys_addr != 0) && (priv->pool_size != 0)) { -+ priv->pool_virt_addr = ioremap_cache(priv->pool_phys_addr, priv->pool_size); -+ if (priv->pool_virt_addr == NULL) { -+ DRM_ERROR("failed to remap carveout mem(0x%llx)\n", priv->pool_phys_addr); -+ ret = -EINVAL; -+ goto failed_ioremap; -+ } -+ ret = phytium_memory_pool_init(&pdev->dev, priv); -+ if (ret) -+ goto failed_init_memory_pool; -+ -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL] = priv->pool_size; -+ priv->support_memory_type = MEMORY_TYPE_SYSTEM_CARVEOUT; -+ priv->vram_hw_init = NULL; -+ } else { -+ DRM_DEBUG_KMS("not support carveout memory\n"); -+ priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL] = 0; -+ priv->support_memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; -+ priv->vram_hw_init = NULL; -+ } -+ -+ return 0; -+ -+failed_init_memory_pool: -+ iounmap(priv->pool_virt_addr); -+failed_ioremap: -+ return ret; -+} -+ -+void phytium_platform_carveout_mem_fini(struct platform_device *pdev, -+ struct phytium_display_private *priv) -+{ -+ if (priv->support_memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { -+ phytium_memory_pool_fini(&pdev->dev, priv); -+ iounmap(priv->pool_virt_addr); -+ } -+} -+ -+static struct phytium_display_private * -+phytium_platform_private_init(struct platform_device *pdev) -+{ -+ struct drm_device *dev = dev_get_drvdata(&pdev->dev); -+ struct device_node *node; -+ struct fwnode_handle *np; -+ struct phytium_display_private *priv = NULL; -+ struct phytium_platform_private *platform_priv = NULL; -+ struct phytium_device_info *phytium_info = NULL; -+ int i = 0, ret = 0; -+ struct resource *res; -+ -+ platform_priv = devm_kzalloc(&pdev->dev, sizeof(*platform_priv), GFP_KERNEL); -+ if (!platform_priv) { -+ DRM_ERROR("no memory to allocate for phytium_platform_private\n"); -+ goto exit; -+ } -+ -+ memset(platform_priv, 0, sizeof(*platform_priv)); -+ priv = &platform_priv->base; -+ phytium_display_private_init(priv, dev); -+ -+ if (pdev->dev.of_node) { -+ phytium_info = (struct phytium_device_info *)of_device_get_match_data(&pdev->dev); -+ if (!phytium_info) { -+ DRM_ERROR("failed to get dts id data(phytium_info)\n"); -+ goto failed; -+ } -+ -+ memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); -+ node = pdev->dev.of_node; -+ ret = of_property_read_u8(node, "pipe_mask", &priv->info.pipe_mask); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing pipe_mask property from dts\n"); -+ goto failed; -+ } -+ -+ ret = of_property_read_u8(node, "edp_mask", &priv->info.edp_mask); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing edp_mask property from dts\n"); -+ goto failed; -+ } -+ if (priv->info.edp_mask) { -+ priv->info.pwm = devm_pwm_get(&pdev->dev, NULL); -+ if (IS_ERR(priv->info.pwm)) { -+ dev_err(&pdev->dev, "Failed to request PWM device: %ld\n", -+ PTR_ERR(priv->info.pwm)); -+ goto failed; -+ } -+ priv->edp_bl_en = gpiod_get(&pdev->dev, "edp-bl-en", GPIOD_OUT_HIGH); -+ if (!priv->edp_bl_en) { -+ dev_err(&pdev->dev, "Failed to get edp_en gpio\n"); -+ goto failed; -+ } -+ priv->edp_power_en = gpiod_get(&pdev->dev, "edp-power-en", GPIOD_OUT_HIGH); -+ if (!priv->edp_power_en) { -+ dev_err(&pdev->dev, "Failed to get edp_pwr_en gpio\n"); -+ goto failed; -+ } -+ // set GPIO pin output -+ gpiod_direction_output(priv->edp_power_en, 0); -+ gpiod_direction_output(priv->edp_bl_en, 0); -+ } -+ } else if (has_acpi_companion(&pdev->dev)) { -+ phytium_info = (struct phytium_device_info *)acpi_device_get_match_data(&pdev->dev); -+ if (!phytium_info) { -+ DRM_ERROR("failed to get acpi id data(phytium_info)\n"); -+ goto failed; -+ } -+ -+ memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); -+ np = dev_fwnode(&(pdev->dev)); -+ ret = fwnode_property_read_u8(np, "pipe_mask", &priv->info.pipe_mask); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing pipe_mask property from acpi\n"); -+ goto failed; -+ } -+ ret = fwnode_property_read_u8(np, "edp_mask", &priv->info.edp_mask); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing edp_mask property from acpi\n"); -+ goto failed; -+ } -+ if (priv->info.edp_mask) { -+ priv->info.pwm = devm_pwm_get(&pdev->dev, NULL); -+ if (IS_ERR(priv->info.pwm)) { -+ dev_err(&pdev->dev, "Failed to request PWM device: %ld\n", -+ PTR_ERR(priv->info.pwm)); -+ goto failed; -+ } -+ priv->edp_bl_en = gpiod_get(&pdev->dev, "edp-bl-en", GPIOD_OUT_HIGH); -+ if (!priv->edp_bl_en) { -+ dev_err(&pdev->dev, "Failed to get edp_en gpio\n"); -+ goto failed; -+ } -+ priv->edp_power_en = gpiod_get(&pdev->dev, "edp-power-en", GPIOD_OUT_HIGH); -+ if (!priv->edp_power_en) { -+ dev_err(&pdev->dev, "Failed to get edp_pwr_en gpio\n"); -+ goto failed; -+ } -+ // set GPIO pin output -+ gpiod_direction_output(priv->edp_power_en, 0); -+ gpiod_direction_output(priv->edp_bl_en, 0); -+ } -+ } -+ -+ priv->info.num_pipes = 0; -+ for_each_pipe_masked(priv, i) -+ priv->info.num_pipes++; -+ if (priv->info.num_pipes == 0) { -+ DRM_ERROR("num_pipes is zero, so exit init\n"); -+ goto failed; -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ priv->regs = devm_ioremap_resource(&pdev->dev, res); -+ if (priv->regs == NULL) { -+ DRM_ERROR("ioremap fail, addr:0x%llx, size:0x%llx\n", res->start, res->end); -+ goto failed; -+ } -+ -+ priv->irq = platform_get_irq(pdev, 0); -+ if (priv->irq < 0) { -+ dev_err(&pdev->dev, "failed to get irq\n"); -+ goto failed; -+ } -+ -+ if (IS_PE220X(priv)) { -+ priv->dc_hw_clear_msi_irq = NULL; -+ priv->dc_hw_fb_format_check = pe220x_dc_hw_fb_format_check; -+ } -+ -+ return priv; -+ -+failed: -+ devm_kfree(&pdev->dev, platform_priv); -+exit: -+ return NULL; -+} -+ -+static void phytium_platform_private_fini(struct platform_device *pdev) -+{ -+ struct drm_device *dev = dev_get_drvdata(&pdev->dev); -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_platform_private *platform_priv = to_platform_priv(priv); -+ -+ devm_kfree(&pdev->dev, platform_priv); -+} -+ -+static int phytium_platform_probe(struct platform_device *pdev) -+{ -+ struct phytium_display_private *priv = NULL; -+ struct drm_device *dev = NULL; -+ int ret = 0; -+ -+ dev = drm_dev_alloc(&phytium_display_drm_driver, &pdev->dev); -+ if (IS_ERR(dev)) { -+ DRM_ERROR("failed to allocate drm_device\n"); -+ return PTR_ERR(dev); -+ } -+ -+ dev_set_drvdata(&pdev->dev, dev); -+ dma_set_mask(&pdev->dev, DMA_BIT_MASK(40)); -+ -+ priv = phytium_platform_private_init(pdev); -+ if (priv) -+ dev->dev_private = priv; -+ else -+ goto failed_platform_private_init; -+ -+ ret = phytium_platform_carveout_mem_init(pdev, priv); -+ if (ret) { -+ DRM_ERROR("failed to init system carveout memory\n"); -+ goto failed_carveout_mem_init; -+ } -+ -+ ret = drm_dev_register(dev, 0); -+ if (ret) { -+ DRM_ERROR("failed to register drm dev\n"); -+ goto failed_register_drm; -+ } -+ -+ phytium_dp_hpd_irq_setup(dev, true); -+ -+ return 0; -+ -+failed_register_drm: -+ phytium_platform_carveout_mem_fini(pdev, priv); -+failed_carveout_mem_init: -+ phytium_platform_private_fini(pdev); -+failed_platform_private_init: -+ dev_set_drvdata(&pdev->dev, NULL); -+ drm_dev_put(dev); -+ return -1; -+} -+ -+static int phytium_platform_remove(struct platform_device *pdev) -+{ -+ struct drm_device *dev = dev_get_drvdata(&pdev->dev); -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ phytium_dp_hpd_irq_setup(dev, false); -+ cancel_work_sync(&priv->hotplug_work); -+ drm_dev_unregister(dev); -+ phytium_platform_private_fini(pdev); -+ dev_set_drvdata(&pdev->dev, NULL); -+ drm_dev_put(dev); -+ -+ return 0; -+} -+ -+static void phytium_platform_shutdown(struct platform_device *pdev) -+{ -+ struct drm_device *dev = dev_get_drvdata(&pdev->dev); -+ struct phytium_display_private *priv = dev->dev_private; -+ -+ priv->display_shutdown(dev); -+} -+ -+static int phytium_platform_pm_suspend(struct device *dev) -+{ -+ struct drm_device *drm_dev = dev_get_drvdata(dev); -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ -+ return priv->display_pm_suspend(drm_dev); -+} -+ -+static int phytium_platform_pm_resume(struct device *dev) -+{ -+ struct drm_device *drm_dev = dev_get_drvdata(dev); -+ struct phytium_display_private *priv = drm_dev->dev_private; -+ -+ return priv->display_pm_resume(drm_dev); -+} -+ -+static const struct dev_pm_ops phytium_platform_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_platform_pm_suspend, phytium_platform_pm_resume) -+}; -+ -+static const struct phytium_device_info pe220x_info = { -+ .platform_mask = BIT(PHYTIUM_PLATFORM_PE220X), -+ .total_pipes = 2, -+ .crtc_clock_max = PE220X_DC_PIX_CLOCK_MAX, -+ .hdisplay_max = PE220X_DC_HDISPLAY_MAX, -+ .vdisplay_max = PE220X_DC_VDISPLAY_MAX, -+ .address_mask = PE220X_DC_ADDRESS_MASK, -+ .backlight_max = PE220X_DP_BACKLIGHT_MAX, -+ .backlight_min = PE220X_DP_BACKLIGHT_MIN, -+}; -+ -+static const struct of_device_id display_of_match[] = { -+ { -+ .compatible = "phytium,dc", -+ .data = &pe220x_info, -+ }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, display_of_match); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id display_acpi_ids[] = { -+ { -+ .id = "PHYT0015", -+ .driver_data = (kernel_ulong_t)&pe220x_info, -+ }, -+ {}, -+}; -+ -+MODULE_DEVICE_TABLE(acpi, display_acpi_ids); -+#else -+#define display_acpi_ids NULL -+#endif -+ -+struct platform_driver phytium_platform_driver = { -+ .driver = { -+ .name = "phytium_display_platform", -+ .of_match_table = of_match_ptr(display_of_match), -+ .acpi_match_table = ACPI_PTR(display_acpi_ids), -+ }, -+ .probe = phytium_platform_probe, -+ .remove = phytium_platform_remove, -+ .shutdown = phytium_platform_shutdown, -+ .driver.pm = &phytium_platform_pm_ops, -+}; -diff --git a/drivers/gpu/drm/phytium/phytium_platform.h b/drivers/gpu/drm/phytium/phytium_platform.h -new file mode 100644 -index 000000000..b754ef0a1 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_platform.h -@@ -0,0 +1,18 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_PLATFORM_H__ -+#define __PHYTIUM_PLATFORM_H__ -+ -+struct phytium_platform_private { -+ struct phytium_display_private base; -+}; -+ -+#define to_platform_priv(priv) container_of(priv, struct phytium_platform_private, base) -+ -+extern struct platform_driver phytium_platform_driver; -+ -+#endif /* __PHYTIUM_PLATFORM_H__ */ -diff --git a/drivers/gpu/drm/phytium/phytium_reg.h b/drivers/gpu/drm/phytium/phytium_reg.h -new file mode 100644 -index 000000000..f5d4a6945 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/phytium_reg.h -@@ -0,0 +1,366 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_REG_H__ -+#define __PHYTIUM_REG_H__ -+ -+/******************************register base******************************************/ -+#define PX210_PIPE_BASE(pipe) (0x8000*pipe) -+#define PX210_DC_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x0000) -+#define PX210_DCREQ_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x2000) -+#define PX210_DP_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x3000) -+#define PX210_ADDRESS_TRANSFORM_BASE 0x4000 -+#define PX210_PHY_ACCESS_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x5000) -+ -+#define PE220X_DC_BASE(pipe) (0x1000*pipe) -+#define PE220X_DP_BASE(pipe) (0x4000 + 0x1000*pipe) -+#define PE220X_ADDRESS_TRANSFORM_BASE 0x8000 -+#define PE220X_PHY_ACCESS_BASE(pipe) (0x6000 + 0x1000*pipe) -+/******************************register base end******************************************/ -+ -+/******************************dc register start******************************************/ -+#define PHYTIUM_DC_FRAMEBUFFER_Y_ADDRESS 0x1400 -+ #define ADDRESS_MASK 0xffffff80 -+#define PHYTIUM_DC_FRAMEBUFFER_Y_STRIDE 0x1408 -+#define PHYTIUM_DC_PANEL_CONFIG 0x1418 -+ #define PANEL_DATAENABLE_ENABLE (1<<0) -+ #define PANEL_DATA_ENABLE (1<<4) -+ #define PANEL_CLOCK_ENABLE (1<<8) -+#define PHYTIUM_DC_HDISPLAY 0x1430 -+ #define HDISPLAY_END_SHIFT 0 -+ #define HDISPLAY_END_MASK 0x7fff -+ #define HDISPLAY_TOTAL_SHIFT 16 -+ #define HDISPLAY_TOTAL_MASK 0x7fff -+#define PHYTIUM_DC_HSYNC 0x1438 -+ #define HSYNC_START_SHIFT 0 -+ #define HSYNC_START_MASK 0x7fff -+ #define HSYNC_END_SHIFT 15 -+ #define HSYNC_END_MASK 0x7fff -+ #define HSYNC_PULSE_ENABLED (1<<30) -+ #define HSYNC_NEGATIVE (1<<31) -+#define PHYTIUM_DC_VDISPLAY 0x1440 -+ #define VDISPLAY_END_SHIFT 0 -+ #define VDISPLAY_END_MASK 0x7fff -+ #define VDISPLAY_TOTAL_SHIFT 16 -+ #define VDISPLAY_TOTAL_MASK 0x7fff -+#define PHYTIUM_DC_VSYNC 0x1448 -+ #define VSYNC_START_SHIFT 0 -+ #define VSYNC_START_MASK 0x7fff -+ #define VSYNC_END_SHIFT 15 -+ #define VSYNC_END_MASK 0x7fff -+ #define VSYNC_PULSE_ENABLED (1<<30) -+ #define VSYNC_NEGATIVE (1<<31) -+#define PHYTIUM_DC_LOCATION 0x1450 -+ #define LOVATION_Y_SHIFT 16 -+#define PHYTIUM_DC_GAMMA_INDEX 0x1458 -+ #define GAMMA_INDEX_MAX 256 -+#define PHYTIUM_DC_GAMMA_DATA 0x1460 -+ #define GAMMA_BLUE_SHIFT 0 -+ #define GAMMA_BLUE_MASK 0x3ff -+ #define GAMMA_GREEN_SHIFT 10 -+ #define GAMMA_GREEN_MASK 0x3ff -+ #define GAMMA_RED_SHIFT 20 -+ #define GAMMA_RED_MASK 0x3ff -+#define PHYTIUM_DC_CURSOR_CONFIG 0x1468 -+ #define CURSOR_FORMAT_DISABLED 0x0 -+ #define CURSOR_FORMAT_MASKMODE 0x3 -+ #define CURSOR_FORMAT_ARGB8888 0x2 -+ #define CURSOR_FORMAT_MASK 0x3 -+ #define CURSOR_HOT_Y_SHIFT 8 -+ #define CURSOR_HOT_Y_MASK 0x1f -+ #define CURSOR_HOT_X_SHIFT 16 -+ #define CURSOR_HOT_X_MASK 0x1f -+#define PHYTIUM_DC_CURSOR_ADDRESS 0x146c -+#define PHYTIUM_DC_CURSOR_LOCATION 0x1470 -+ #define CURSOR_X_SHIFT 0 -+ #define CURSOR_X_MASK 0x7fff -+ #define CURSOR_Y_SHIFT 16 -+ #define CURSOR_Y_MASK 0x7fff -+#define PHYTIUM_DC_CURSOR_BACKGROUND 0x1474 -+#define PHYTIUM_DC_CURSOR_FOREGROUND 0x1478 -+#define PHYTIUM_DC_INT_STATUS 0x147c -+ #define INT_STATUS 0x1 -+#define PHYTIUM_DC_INT_ENABLE 0x1480 -+ #define INT_ENABLE 0x1 -+ #define INT_DISABLE 0x0 -+ -+#define PHYTIUM_DC_FRAMEBUFFER_CONFIG 0x1518 -+ #define FRAMEBUFFER_OUTPUT BIT(0) -+ #define FRAMEBUFFER_GAMMA_ENABLE BIT(2) -+ #define FRAMEBUFFER_VALID_PENDING BIT(3) -+ #define FRAMEBUFFER_RESET BIT(4) -+ #define FRAMEBUFFER_PROGRESS BIT(6) -+ #define FRAMEBUFFER_ROT_ANGLE_SHIFT (11) -+ #define FRAMEBUFFER_ROT_ANGLE_MASK (0x7) -+ #define FRAMEBUFFER_ROT_ANGLE_ROT0 (0) -+ #define FRAMEBUFFER_ROT_ANGLE_FLIP_X (1) -+ #define FRAMEBUFFER_ROT_ANGLE_FLIP_Y (2) -+ #define FRAMEBUFFER_TILE_MODE_SHIFT (17) -+ #define FRAMEBUFFER_TILE_MODE_MASK (0x1f) -+ #define FRAMEBUFFER_LINEAR 0 -+ #define FRAMEBUFFER_TILE_MODE0 4 -+ #define FRAMEBUFFER_TILE_MODE3 7 -+ #define FRAMEBUFFER_FORMAT_SHIFT 26 -+ #define FRAMEBUFFER_FORMAT_MASK 0x3f -+ #define FRAMEBUFFER_FORMAT_XRGB4444 0x0 -+ #define FRAMEBUFFER_FORMAT_ARGB4444 0x1 -+ #define FRAMEBUFFER_FORMAT_XRGB1555 0x2 -+ #define FRAMEBUFFER_FORMAT_ARGB1555 0x3 -+ #define FRAMEBUFFER_FORMAT_RGB565 0x4 -+ #define FRAMEBUFFER_FORMAT_XRGB8888 0x5 -+ #define FRAMEBUFFER_FORMAT_ARGB8888 0x6 -+ #define FRAMEBUFFER_FORMAT_YUYV 0x7 -+ #define FRAMEBUFFER_FORMAT_UYVY 0x8 -+ #define FRAMEBUFFER_FORMAT_NV12 0x11 -+ #define FRAMEBUFFER_FORMAT_NV16 0x12 -+ #define FRAMEBUFFER_FORMAT_ARGB2101010 0x16 -+ #define FRAMEBUFFER_SWIZZLE_SHIFT 23 -+ #define FRAMEBUFFER_SWIZZLE_MASK 0x3 -+ #define FRAMEBUFFER_SWIZZLE_ARGB 0 -+ #define FRAMEBUFFER_SWIZZLE_RGBA 1 -+ #define FRAMEBUFFER_SWIZZLE_ABGR 2 -+ #define FRAMEBUFFER_SWIZZLE_BGRA 3 -+ #define FRAMEBUFFER_UVSWIZZLE_SHIFT 25 -+ #define FRAMEBUFFER_UVSWIZZLE_DISABLE 0 -+ #define FRAMEBUFFER_UVSWIZZLE_ENABLE 1 -+ #define FRAMEBUFFER_CLEAR BIT(8) -+ #define FRAMEBUFFER_SCALE_ENABLE BIT(22) -+#define PHYTIUM_DC_FRAMEBUFFER_SCALECONFIG 0x1520 -+ #define FRAMEBUFFER_FILTER_TAP 3 -+ #define FRAMEBUFFER_HORIZONTAL_FILTER_TAP 3 -+ #define FRAMEBUFFER_TAP 0x33 -+#define PHYTIUM_DC_FRAMEBUFFER_U_ADDRESS 0x1530 -+#define PHYTIUM_DC_FRAMEBUFFER_V_ADDRESS 0x1538 -+#define PHYTIUM_DC_OVERLAY_CONFIG 0x1540 -+ #define PX210_DC_OVERLAY_ENABLE BIT(24) -+ -+#define PHYTIUM_DC_FRAMEBUFFER_U_STRIDE 0x1800 -+#define PHYTIUM_DC_FRAMEBUFFER_V_STRIDE 0x1808 -+#define PHYTIUM_DC_FRAMEBUFFER_SIZE 0x1810 -+ #define WIDTH_SHIFT 0 -+ #define WIDTH_MASK 0x7fff -+ #define HEIGHT_SHIFT 15 -+ #define HEIGHT_MASK 0x7fff -+ -+#define PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_X 0x1828 -+ #define SCALE_FACTOR_X_MASK 0x7fffffff -+#define PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_Y 0x1830 -+ #define SCALE_FACTOR_Y_MASK 0x7fffffff -+ #define SCALE_FACTOR_Y_MAX 0x3 -+ #define SCALE_FACTOR_SRC_OFFSET 16 -+ -+#define PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER_INDEX 0x1838 -+ #define HORI_FILTER_INDEX 0x0 -+#define PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER 0x1a00 -+#define PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER_INDEX 0x1a08 -+ #define VERT_FILTER_INDEX 0x0 -+#define PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER 0x1a10 -+#define PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE 0x1a18 -+ #define CLEAR_VALUE_RED 0x00ff0000 -+ #define CLEAR_VALUE_GREEN 0x0000ff00 -+ #define CLEAR_VALUE_BLACK 0x00000000 -+#define PHYTIUM_DC_FRAMEBUFFER_INITIALOFFSET 0x1a20 -+ #define INITIALOFFSET (0x8000 | (0X8000 << 16)) -+#define PHYTIUM_DC_DP_CONFIG 0x1cd0 -+ #define OUTPUT_DP (1<<3) -+ #define DP_RGB666 (0x1) -+ #define DP_RGB888 (0x2) -+ #define DP_RGB101010 (0x3) -+/******************************dc register end********************************************/ -+ -+/******************************phy access register****************************************/ -+#define PHYTIUM_PHY_ACCESS_ADDRESS 0x0000 -+#define PHYTIUM_PHY_WRITE_DATA 0x0004 -+#define PHYTIUM_PHY_READ_DATA 0x0008 -+#define PHYTIUM_PHY_ACCESS_CTRL 0x000c -+ #define ACCESS_WRITE (1<<0) -+ #define ACCESS_READ (1<<1) -+/******************************phy access register end*************************************/ -+ -+/******************************dp register start******************************************/ -+#define PHYTIUM_DP_LINK_BW_SET 0x0000 -+#define PHYTIUM_DP_LANE_COUNT_SET 0x0004 -+#define PHYTIUM_DP_ENHANCED_FRAME_EN 0x0008 -+ #define ENHANCED_FRAME_ENABLE 0x1 -+ #define ENHANCED_FRAME_DISABLE 0x0 -+#define PHYTIUM_DP_TRAINING_PATTERN_SET 0x000c -+ #define TRAINING_OFF 0x0 -+ #define TRAINING_PATTERN_1 0x1 -+ #define TRAINING_PATTERN_2 0x2 -+ #define TRAINING_PATTERN_3 0x3 -+ #define TRAINING_PATTERN_4 0x4 -+#define PHYTIUM_DP_LINK_QUAL_PATTERN_SET 0x0010 -+ #define TEST_PATTERN_NONE 0x0 -+ #define TEST_PATTERN_D10_2 0x1 -+ #define TEST_PATTERN_SYMBOL_ERROR 0x2 -+ #define TEST_PATTERN_PRBS7 0x3 -+ #define TEST_PATTERN_80BIT_CUSTOM 0x4 -+ #define TEST_PATTERN_CP2520_1 0x5 -+ #define TEST_PATTERN_CP2520_2 0x6 -+ #define TEST_PATTERN_CP2520_3 0x7 -+ #define TEST_PATTERN_LANE_SHIFT 8 -+#define PHYTIUM_DP_SCRAMBLING_DISABLE 0x0014 -+ #define SCRAMBLING_ENABLE 0x0 -+ #define SCRAMBLING_DISABLE 0x1 -+#define PHYTIUM_DP_DOWNSPREAD_CTRL 0x0018 -+#define PHYTIUM_DP_ALT_SCRAMBLER_RESET 0x001c -+#define PHYTIUM_DP_HBR2_SCRAMBLER_RESET 0x0020 -+#define PHYTIUM_DP_DISPLAYPORT_VERSION 0x0024 -+#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_0 0x0030 -+#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_1 0x0034 -+#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_2 0x0038 -+#define PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE 0x0080 -+ #define TRANSMITTER_OUTPUT_ENABLE BIT(0) -+ #define TRANSMITTER_OUTPUT_DISABLE 0 -+#define PHYTIUM_DP_VIDEO_STREAM_ENABLE 0x0084 -+ #define SST_MST_SOURCE_0_ENABLE BIT(0) -+ #define SST_MST_SOURCE_0_ENABLE_MASK 0x1 -+ #define SST_MST_SOURCE_0_DISABLE 0 -+#define PHYTIUM_DP_SECONDARY_STREAM_ENABLE 0x0088 -+ #define SECONDARY_STREAM_ENABLE 0x1 -+ #define SECONDARY_STREAM_DISABLE 0x0 -+#define PHYTIUM_DP_SEC_DATA_WINDOW 0x008C -+#define PHYTIUM_DP_SOFT_RESET 0x0090 -+ #define LINK_SOFT_RESET (0x1 << 0) -+ #define VIDEO_SOFT_RESET (0x1 << 1) -+#define PHYTIUM_INPUT_SOURCE_ENABLE 0x0094 -+ #define VIRTUAL_SOURCE_0_ENABLE BIT(0) -+ #define VIRTUAL_SOURCE_0_ENABLE_MASK 0x1 -+#define PHYTIUM_DP_FORCE_SCRAMBLER_RESET 0x00C0 -+ #define SCRAMBLER_RESET BIT(0) -+#define PHYTIUM_DP_SOURCE_CONTROL_STATUS 0x00C4 -+#define PHYTIUM_DP_DATA_CONTROL 0x00C8 -+#define PHYTIUM_DP_CORE_CAPABILITY 0x00F8 -+#define PHYTIUM_DP_CORE_ID 0x00FC -+#define PHYTIUM_DP_AUX_COMMAND 0x0100 -+ #define BYTE_COUNT_MASK 0xf -+ #define COMMAND_SHIFT 8 -+ #define COMMAND_MASK 0xf -+ #define ADDRESS_ONLY (1<<12) -+#define PHYTIUM_DP_AUX_WRITE_FIFO 0x0104 -+#define PHYTIUM_DP_AUX_ADDRESS 0x0108 -+#define PHYTIUM_DP_AUX_CLK_DIVIDER 0x010C -+ #define AUX_CLK_DIVIDER 48 -+ #define AUX_CLK_DIVIDER_100 100 -+#define PHYTIUM_DP_SINK_HPD_STATE 0x0128 -+ #define HPD_CONNECT 0x1 -+ #define HPD_DISCONNECT 0x0 -+#define PHYTIUM_DP_INTERRUPT_RAW_STATUS 0x0130 -+ #define REPLY_TIMEOUT (1<<3) -+ #define DP_STATUS_REQUEST_IN_PROGRESS (1<<1) -+ #define HPD_STATE (0<<1) -+#define PHYTIUM_DP_AUX_REPLY_DATA 0x0134 -+#define PHYTIUM_DP_AUX_REPLY_CODE 0x0138 -+ #define AUX_NATIVE_ACK (0x0<<0) -+ #define AUX_NATIVE_NACK (0x1<<0) -+ #define AUX_NATIVE_DEFER (0x2<<0) -+ #define AUX_NATIVE_MASK (0x3 << 0) -+ #define AUX_I2C_ACK (0x0<<2) -+ #define AUX_I2C_NACK (0x1<<2) -+ #define AUX_I2C_DEFER (0x2<<2) -+ #define AUX_I2C_MASK (0x3 << 2) -+#define PHYTIUM_DP_INTERRUPT_STATUS 0x0140 -+ #define HPD_IRQ (1<<1) -+ #define HPD_EVENT (1<<0) -+#define PHYTIUM_DP_INTERRUPT_MASK 0x0144 -+ #define HPD_IRQ_MASK (1<<1) -+ #define HPD_EVENT_MASK (1<<0) -+ #define HPD_OTHER_MASK 0x7c -+#define PHYTIUM_DP_AUX_REPLY_DATA_COUNT 0x0148 -+#define PHYTIUM_DP_AUX_STATUS 0x014C -+ #define REPLY_RECEIVED 0x1 -+ #define REPLY_IN_PROGRESS 0x2 -+ #define REQUEST_IN_PROGRESS 0x4 -+ #define REPLY_ERROR 0x8 -+#define PHYTIUM_DP_AUX_TIMER 0x0158 -+#define PHYTIUM_DP_MAIN_LINK_HTOTAL 0x0180 -+#define PHYTIUM_DP_MAIN_LINK_VTOTAL 0x0184 -+#define PHYTIUM_DP_MAIN_LINK_POLARITY 0x0188 -+ #define VSYNC_POLARITY_LOW BIT(1) -+ #define HSYNC_POLARITY_LOW BIT(0) -+#define PHYTIUM_DP_MAIN_LINK_HSWIDTH 0x018C -+#define PHYTIUM_DP_MAIN_LINK_VSWIDTH 0x0190 -+#define PHYTIUM_DP_MAIN_LINK_HRES 0x0194 -+#define PHYTIUM_DP_MAIN_LINK_VRES 0x0198 -+#define PHYTIUM_DP_MAIN_LINK_HSTART 0x019C -+#define PHYTIUM_DP_MAIN_LINK_VSTART 0x01A0 -+#define PHYTIUM_DP_MAIN_LINK_MISC0 0x01A4 -+ #define MISC0_SYNCHRONOUS_CLOCK BIT(0) -+ #define MISC0_BIT_DEPTH_OFFSET 5 -+ #define MISC0_BIT_DEPTH_6BIT 0x0 -+ #define MISC0_BIT_DEPTH_8BIT 0x1 -+ #define MISC0_BIT_DEPTH_10BIT 0x2 -+ #define MISC0_COMPONENT_FORMAT_SHIFT 1 -+ #define MISC0_COMPONENT_FORMAT_RGB 0x0 -+#define PHYTIUM_DP_MAIN_LINK_MISC1 0x01A8 -+#define PHYTIUM_DP_M_VID 0x01AC -+#define PHYTIUM_DP_TRANSFER_UNIT_SIZE 0x01B0 -+#define PHYTIUM_DP_N_VID 0x01B4 -+#define PHYTIUM_DP_USER_PIXEL_WIDTH 0x01B8 -+#define PHYTIUM_DP_DATA_COUNT 0x01BC -+#define PHYTIUM_DP_INTERLACED 0x01C0 -+#define PHYTIUM_DP_USER_SYNC_POLARITY 0x01C4 -+ #define USER_ODDEVEN_POLARITY_HIGH BIT(3) -+ #define USER_DATA_ENABLE_POLARITY_HIGH BIT(2) -+ #define USER_VSYNC_POLARITY_HIGH BIT(1) -+ #define USER_HSYNC_POLARITY_HIGH BIT(0) -+#define PHYTIUM_DP_USER_CONTROL 0x01C8 -+#define PHYTIUM_EDP_CRC_ENABLE 0x01D0 -+ #define SUPPORT_EDP_1_4 BIT(1) -+#define PHYTIUM_EDP_CRC_RED 0x01D4 -+#define PHYTIUM_EDP_CRC_GREEN 0x01D8 -+#define PHYTIUM_EDP_CRC_BLUE 0x01DC -+#define PHYTIUM_DP_SEC_AUDIO_ENABLE 0x0300 -+ #define SEC_AUDIO_ENABLE BIT(0) -+ #define CHANNEL_MUTE_ENABLE BIT(1) -+#define PHYTIUM_DP_SEC_INPUT_SELECT 0x0304 -+ #define INPUT_SELECT_I2S 0x0 -+#define PHYTIUM_DP_SEC_CHANNEL_COUNT 0x0308 -+ #define CHANNEL_2 0x2 -+ #define CHANNEL_2_LFE 0x3 -+ #define CHANNEL_5_1 0x6 -+ #define CHANNEL_7_1 0x7 -+ #define CHANNEL_MASK 0xf -+#define PHYTIUM_DP_SEC_DIRECT_CLKDIV 0x030c -+ #define APB_CLOCK 48000000 -+#define PHYTIUM_DP_SEC_MAUD 0x0318 -+#define PHYTIUM_DP_SEC_NAUD 0x031c -+#define PHYTIUM_DP_SEC_CLOCK_MODE 0x0320 -+ #define CLOCK_MODE_SYNC 0x1 -+#define PHYTIUM_DP_SEC_CS_SOURCE_FORMAT 0x0340 -+ #define CS_SOURCE_FORMAT_DEFAULT 0x0 -+#define PHYTIUM_DP_SEC_CS_CATEGORY_CODE 0x0344 -+#define PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ 0x0348 -+ #define ORIG_FREQ_32000 0xc -+ #define ORIG_FREQ_44100 0xf -+ #define ORIG_FREQ_48000 0xd -+ #define ORIG_FREQ_88200 0x7 -+ #define ORIG_FREQ_96000 0x5 -+ #define ORIG_FREQ_176400 0x3 -+ #define ORIG_FREQ_192000 0x1 -+ #define ORIG_FREQ_MASK 0xf -+ #define ORIG_FREQ_SHIFT 0 -+ #define WORD_LENGTH_16 0x4 -+ #define WORD_LENGTH_18 0x2 -+ #define WORD_LENGTH_20 0xc -+ #define WORD_LENGTH_24 0xd -+ #define WORD_LENGTH_MASK 0xf -+ #define WORD_LENGTH_SHIFT 4 -+#define PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY 0x034c // not used -+ #define SAMPLING_FREQ_32000 0xc -+ #define SAMPLING_FREQ_44100 0x0 -+ #define SAMPLING_FREQ_48000 0x4 -+ #define SAMPLING_FREQ_88200 0x1 -+ #define SAMPLING_FREQ_96000 0x5 -+ #define SAMPLING_FREQ_176400 0x3 -+ #define SAMPLING_FREQ_192000 0x7 -+ #define SAMPLING_FREQ_MASK 0xf -+ #define SAMPLING_FREQ_SHIFT 4 -+#define PHYTIUM_DP_SEC_CHANNEL_MAP 0x035C -+ #define CHANNEL_MAP_DEFAULT 0x87654321 -+/******************************dp register end********************************************/ -+ -+#endif /* __PHYTIUM_REG_H__ */ -diff --git a/drivers/gpu/drm/phytium/px210_dc.c b/drivers/gpu/drm/phytium/px210_dc.c -new file mode 100644 -index 000000000..84fd44a13 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/px210_dc.c -@@ -0,0 +1,326 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include "phytium_display_drv.h" -+#include "px210_reg.h" -+#include "phytium_crtc.h" -+#include "phytium_plane.h" -+#include "phytium_fb.h" -+#include "phytium_gem.h" -+ -+static const unsigned int px210_primary_formats[] = { -+ DRM_FORMAT_ARGB2101010, -+ DRM_FORMAT_ABGR2101010, -+ DRM_FORMAT_RGBA1010102, -+ DRM_FORMAT_BGRA1010102, -+ DRM_FORMAT_ARGB8888, -+ DRM_FORMAT_ABGR8888, -+ DRM_FORMAT_RGBA8888, -+ DRM_FORMAT_BGRA8888, -+ DRM_FORMAT_XRGB8888, -+ DRM_FORMAT_XBGR8888, -+ DRM_FORMAT_RGBX8888, -+ DRM_FORMAT_BGRX8888, -+ DRM_FORMAT_ARGB4444, -+ DRM_FORMAT_ABGR4444, -+ DRM_FORMAT_RGBA4444, -+ DRM_FORMAT_BGRA4444, -+ DRM_FORMAT_XRGB4444, -+ DRM_FORMAT_XBGR4444, -+ DRM_FORMAT_RGBX4444, -+ DRM_FORMAT_BGRX4444, -+ DRM_FORMAT_ARGB1555, -+ DRM_FORMAT_ABGR1555, -+ DRM_FORMAT_RGBA5551, -+ DRM_FORMAT_BGRA5551, -+ DRM_FORMAT_XRGB1555, -+ DRM_FORMAT_XBGR1555, -+ DRM_FORMAT_RGBX5551, -+ DRM_FORMAT_BGRX5551, -+ DRM_FORMAT_RGB565, -+ DRM_FORMAT_BGR565, -+ DRM_FORMAT_YUYV, -+ DRM_FORMAT_UYVY, -+}; -+ -+static uint64_t px210_primary_formats_modifiers[] = { -+ DRM_FORMAT_MOD_LINEAR, -+ DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC, -+ DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC, -+ DRM_FORMAT_MOD_INVALID -+}; -+ -+static uint64_t px210_cursor_formats_modifiers[] = { -+ DRM_FORMAT_MOD_LINEAR, -+ DRM_FORMAT_MOD_INVALID -+}; -+ -+static const unsigned int px210_cursor_formats[] = { -+ DRM_FORMAT_ARGB8888, -+}; -+ -+void px210_dc_hw_vram_init(struct phytium_display_private *priv, resource_size_t vram_addr, -+ resource_size_t vram_size) -+{ -+ uint32_t config; -+ uint32_t group_offset = priv->address_transform_base; -+ -+ config = phytium_readl_reg(priv, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR); -+ if (config) -+ phytium_writel_reg(priv, config, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR); -+ -+ config = phytium_readl_reg(priv, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_SIZE); -+ if (config) -+ phytium_writel_reg(priv, config, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_SIZE); -+ -+ config = phytium_readl_reg(priv, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR); -+ if (config) -+ phytium_writel_reg(priv, config, group_offset, -+ PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR); -+ -+ phytium_writel_reg(priv, (vram_addr & SRC_ADDR_MASK) >> SRC_ADDR_OFFSET, -+ group_offset, PX210_DC_ADDRESS_TRANSFORM_SRC_ADDR); -+ phytium_writel_reg(priv, (vram_size >> SIZE_OFFSET) | ADDRESS_TRANSFORM_ENABLE, -+ group_offset, PX210_DC_ADDRESS_TRANSFORM_SIZE); -+ config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DST_ADDR); -+ phytium_writel_reg(priv, config, group_offset, PX210_DC_ADDRESS_TRANSFORM_DST_ADDR); -+} -+ -+void px210_dc_hw_clear_msi_irq(struct phytium_display_private *priv, uint32_t phys_pipe) -+{ -+ phytium_writel_reg(priv, MSI_CLEAR, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_MSI_CLEAR); -+} -+ -+void px210_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int phys_pipe = phytium_crtc->phys_pipe; -+ uint32_t group_offset = priv->dcreq_reg_base[phys_pipe]; -+ int ret = 0; -+ -+ /* config pix clock */ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_PIXEL_CLOCK | (clock & PIXEL_CLOCK_MASK), -+ group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to set pixel clock\n", __func__); -+} -+ -+void px210_dc_hw_disable(struct drm_crtc *crtc) -+{ -+ struct drm_device *dev = crtc->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); -+ int reset_timeout = 100; -+ int config = 0; -+ int phys_pipe = phytium_crtc->phys_pipe; -+ -+ // reset dc -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, config | SOFT_RESET, priv->dc_reg_base[phys_pipe], -+ PX210_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, 0, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); -+ do { -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_IDLE); -+ if (config | IS_IDLE) -+ break; -+ mdelay(1); -+ reset_timeout--; -+ } while (reset_timeout); -+ -+ /* reset pix clock */ -+ px210_dc_hw_config_pix_clock(crtc, 0); -+ -+ // reset dc -+ reset_timeout = 100; -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, config | SOFT_RESET, priv->dc_reg_base[phys_pipe], -+ PX210_DC_CLOCK_CONTROL); -+ phytium_writel_reg(priv, 0, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); -+ do { -+ config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_IDLE); -+ if (config | IS_IDLE) -+ break; -+ mdelay(1); -+ reset_timeout--; -+ } while (reset_timeout); -+ -+ /* reset dcreq */ -+ phytium_writel_reg(priv, DCREQ_PLAN_A, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_PLAN); -+ phytium_writel_reg(priv, 0, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_CONTROL); -+ phytium_writel_reg(priv, DCREQ_RESET, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_RESET); -+ msleep(20); -+ phytium_writel_reg(priv, (~DCREQ_RESET)&DCREQ_RESET_MASK, -+ priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_RESET); -+} -+ -+int px210_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count) -+{ -+ int ret = 0; -+ -+ switch (mode_cmd->modifier[count]) { -+ case DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC: -+ switch (mode_cmd->pixel_format) { -+ case DRM_FORMAT_ARGB4444: -+ case DRM_FORMAT_ABGR4444: -+ case DRM_FORMAT_RGBA4444: -+ case DRM_FORMAT_BGRA4444: -+ case DRM_FORMAT_XRGB4444: -+ case DRM_FORMAT_XBGR4444: -+ case DRM_FORMAT_RGBX4444: -+ case DRM_FORMAT_BGRX4444: -+ case DRM_FORMAT_ARGB1555: -+ case DRM_FORMAT_ABGR1555: -+ case DRM_FORMAT_RGBA5551: -+ case DRM_FORMAT_BGRA5551: -+ case DRM_FORMAT_XRGB1555: -+ case DRM_FORMAT_XBGR1555: -+ case DRM_FORMAT_RGBX5551: -+ case DRM_FORMAT_BGRX5551: -+ case DRM_FORMAT_RGB565: -+ case DRM_FORMAT_BGR565: -+ case DRM_FORMAT_YUYV: -+ case DRM_FORMAT_UYVY: -+ break; -+ default: -+ DRM_ERROR("TILE_MODE0_FBCDC not support DRM_FORMAT %d", -+ mode_cmd->pixel_format); -+ ret = -EINVAL; -+ goto error; -+ } -+ break; -+ case DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC: -+ switch (mode_cmd->pixel_format) { -+ case DRM_FORMAT_ARGB2101010: -+ case DRM_FORMAT_ABGR2101010: -+ case DRM_FORMAT_RGBA1010102: -+ case DRM_FORMAT_BGRA1010102: -+ case DRM_FORMAT_ARGB8888: -+ case DRM_FORMAT_ABGR8888: -+ case DRM_FORMAT_RGBA8888: -+ case DRM_FORMAT_BGRA8888: -+ case DRM_FORMAT_XRGB8888: -+ case DRM_FORMAT_XBGR8888: -+ case DRM_FORMAT_RGBX8888: -+ case DRM_FORMAT_BGRX8888: -+ break; -+ default: -+ DRM_ERROR("TILE_MODE3_FBCDC not support DRM_FORMAT %d", -+ mode_cmd->pixel_format); -+ ret = -EINVAL; -+ goto error; -+ } -+ break; -+ case DRM_FORMAT_MOD_LINEAR: -+ break; -+ default: -+ DRM_ERROR("unsupported fb modifier 0x%llx\n", mode_cmd->modifier[0]); -+ ret = -EINVAL; -+ goto error; -+ } -+ -+ return 0; -+error: -+ return ret; -+} -+ -+void px210_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count) -+{ -+ *format_modifiers = px210_primary_formats_modifiers; -+ *formats = px210_primary_formats; -+ *format_count = ARRAY_SIZE(px210_primary_formats); -+} -+ -+void px210_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count) -+{ -+ *format_modifiers = px210_cursor_formats_modifiers; -+ *formats = px210_cursor_formats; -+ *format_count = ARRAY_SIZE(px210_cursor_formats); -+} -+ -+void px210_dc_hw_update_dcreq(struct drm_plane *plane) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ int phys_pipe = phytium_plane->phys_pipe; -+ uint32_t group_offset = priv->dcreq_reg_base[phys_pipe]; -+ int config; -+ -+ if (phytium_plane->tiling[0] == FRAMEBUFFER_LINEAR) { -+ phytium_writel_reg(priv, DCREQ_MODE_LINEAR, -+ group_offset, PX210_DCREQ_PLANE0_CONFIG); -+ } else { -+ config = DCREQ_NO_LOSSY; -+ if (phytium_plane->tiling[0] == FRAMEBUFFER_TILE_MODE0) -+ config |= DCREQ_TILE_TYPE_MODE0; -+ else if (phytium_plane->tiling[0] == FRAMEBUFFER_TILE_MODE3) -+ config |= DCREQ_TILE_TYPE_MODE3; -+ else -+ config |= DCREQ_TILE_TYPE_MODE0; -+ -+ switch (phytium_plane->format) { -+ case FRAMEBUFFER_FORMAT_ARGB8888: -+ case FRAMEBUFFER_FORMAT_XRGB8888: -+ config |= DCREQ_COLOURFORMAT_BGRA8888; -+ break; -+ case FRAMEBUFFER_FORMAT_ARGB2101010: -+ config |= DCREQ_COLOURFORMAT_ARGB2101010; -+ break; -+ case FRAMEBUFFER_FORMAT_XRGB4444: -+ case FRAMEBUFFER_FORMAT_ARGB4444: -+ config |= DCREQ_COLOURFORMAT_ARGB4444; -+ break; -+ case FRAMEBUFFER_FORMAT_XRGB1555: -+ case FRAMEBUFFER_FORMAT_ARGB1555: -+ config |= DCREQ_COLOURFORMAT_ARGB1555; -+ break; -+ case FRAMEBUFFER_FORMAT_RGB565: -+ config |= DCREQ_COLOURFORMAT_RGB565; -+ break; -+ case FRAMEBUFFER_FORMAT_YUYV: -+ config |= DCREQ_COLOURFORMAT_YUYV; -+ break; -+ case FRAMEBUFFER_FORMAT_UYVY: -+ config |= DCREQ_COLOURFORMAT_UYVY; -+ break; -+ } -+ config |= DCREQ_ARGBSWIZZLE_ARGB; -+ config |= DCREQ_MODE_TILE; -+ phytium_writel_reg(priv, phytium_plane->iova[0] & 0xffffffff, -+ group_offset, PX210_DCREQ_PLANE0_ADDR_START); -+ phytium_writel_reg(priv, (phytium_plane->iova[0] + phytium_plane->size[0]) & -+ 0xffffffff, group_offset, PX210_DCREQ_PLANE0_ADDR_END); -+ phytium_writel_reg(priv, config, group_offset, PX210_DCREQ_PLANE0_CONFIG); -+ } -+} -+ -+void px210_dc_hw_update_primary_hi_addr(struct drm_plane *plane) -+{ -+ struct drm_device *dev = plane->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ struct phytium_plane *phytium_plane = to_phytium_plane(plane); -+ int phys_pipe = phytium_plane->phys_pipe; -+ -+ phytium_writel_reg(priv, (phytium_plane->iova[0] >> PREFIX_SHIFT) & PREFIX_MASK, -+ priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_PIX_DMA_PREFIX); -+} -diff --git a/drivers/gpu/drm/phytium/px210_dc.h b/drivers/gpu/drm/phytium/px210_dc.h -new file mode 100644 -index 000000000..ef2208bf4 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/px210_dc.h -@@ -0,0 +1,30 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PX210_DC_H__ -+#define __PX210_DC_H__ -+ -+#define PX210_DC_PIX_CLOCK_MAX (594000) -+#define PX210_DC_HDISPLAY_MAX 3840 -+#define PX210_DC_VDISPLAY_MAX 2160 -+#define PX210_DC_ADDRESS_MASK 0x7f -+ -+extern void px210_dc_hw_vram_init(struct phytium_display_private *priv, -+ resource_size_t vram_addr, -+ resource_size_t vram_size); -+extern void px210_dc_hw_clear_msi_irq(struct phytium_display_private *priv, uint32_t phys_pipe); -+extern void px210_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock); -+extern void px210_dc_hw_disable(struct drm_crtc *crtc); -+extern int px210_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count); -+extern void px210_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+extern void px210_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, -+ const uint32_t **formats, -+ uint32_t *format_count); -+void px210_dc_hw_update_dcreq(struct drm_plane *plane); -+void px210_dc_hw_update_primary_hi_addr(struct drm_plane *plane); -+#endif /* __PX210_DC_H__ */ -diff --git a/drivers/gpu/drm/phytium/px210_dp.c b/drivers/gpu/drm/phytium/px210_dp.c -new file mode 100644 -index 000000000..7c6555631 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/px210_dp.c -@@ -0,0 +1,920 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include "phytium_display_drv.h" -+#include "px210_reg.h" -+#include "phytium_dp.h" -+#include "px210_dp.h" -+ -+static uint8_t px210_dp_source_lane_count[3] = {4, 4, 1}; -+ -+/* [reg][ling_rate 1.62->8.1] */ -+static int vco_val[12][4] = { -+ {0x0509, 0x0509, 0x0509, 0x0509}, // CP_PADJ -+ {0x0f00, 0x0f00, 0x0f00, 0x0f00}, // CP_IADJ -+ {0x0F08, 0x0F08, 0x0F08, 0x0F08}, // FILT_PADJ -+ {0x0061, 0x006C, 0x006C, 0x0051}, // INTDIV -+ {0x3333, 0x0000, 0x0000, 0x0000}, // FRACDIVL -+ {0x0000, 0x0000, 0x0000, 0x0000}, // FRACDIVH -+ {0x0042, 0x0048, 0x0048, 0x0036}, // HIGH_THR -+ {0x0002, 0x0002, 0x0002, 0x0002}, // PDIAG_CTRL -+ {0x0c5e, 0x0c5e, 0x0c5e, 0x0c5e}, // VCOCAL_PLLCNT_START -+ {0x00c7, 0x00c7, 0x00c7, 0x00c7}, // LOCK_PEFCNT -+ {0x00c7, 0x00c7, 0x00c7, 0x00c7}, // LOCK_PLLCNT_START -+ {0x0005, 0x0005, 0x0005, 0x0005}, // LOCK_PLLCNT_THR -+}; -+ -+static int mgnfs_val[4][4][4] = // [link_rate][swing][emphasis] -+{ -+ /* 1.62Gbps */ -+ { -+ {0x0026, 0x001f, 0x0012, 0x0000}, -+ {0x0013, 0x0013, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 2.7Gbps */ -+ { -+ {0x0026, 0x001f, 0x0012, 0x0000}, -+ {0x0013, 0x0013, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 5.4Gbps */ -+ { -+ {0x0026, 0x0013, 0x005, 0x0000}, -+ {0x0018, 0x006, 0x0000, 0x0000}, -+ {0x000c, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 8.1Gbps */ -+ { -+ {0x0026, 0x0013, 0x005, 0x0000}, -+ {0x0013, 0x006, 0x0000, 0x0000}, -+ {0x0006, 0x0000, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+}; -+ -+static int cpost_val[4][4][4] = // [link_rate][swing][emphasis] -+{ -+ /* 1.62Gbps */ -+ { -+ {0x0000, 0x0014, 0x0020, 0x002a}, -+ {0x0000, 0x0010, 0x001f, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 2.7Gbps */ -+ { -+ {0x0000, 0x0014, 0x0020, 0x002a}, -+ {0x0000, 0x0010, 0x001f, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 5.4Gbps */ -+ { -+ {0x0000, 0x0014, 0x0022, 0x002e}, -+ {0x0000, 0x0013, 0x0020, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+ -+ /* 8.1Gbps */ -+ { -+ {0x0000, 0x0014, 0x0022, 0x002e}, -+ {0x0000, 0x0013, 0x0020, 0x0000}, -+ {0x0000, 0x0013, 0x0000, 0x0000}, -+ {0x0000, 0x0000, 0x0000, 0x0000}, -+ }, -+}; -+ -+static int px210_dp_hw_set_phy_lane_and_rate(struct phytium_dp_device *phytium_dp, -+ uint8_t link_lane_count, -+ uint32_t link_rate) -+{ -+ int port = phytium_dp->port%3; -+ int i = 0, data, tmp, tmp1, index = 0, mask; -+ int timeout = 500, ret = 0; -+ -+ if (port == 0 || port == 1) { -+ /* set pma powerdown */ -+ data = 0; -+ mask = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) { -+ data |= (A3_POWERDOWN3 << i*A3_POWERDOWN3_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (PLL_EN << i*PLL_EN_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (PLL_EN << i*PLL_EN_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (A0_ACTIVE << i*A0_ACTIVE_SHIFT); -+ mask |= (((1<port%3; -+ int voltage_swing = 0; -+ int pre_emphasis = 0, link_rate_index = 0; -+ -+ switch (train_set & DP_TRAIN_VOLTAGE_SWING_MASK) { -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_0: -+ default: -+ voltage_swing = 0; -+ break; -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_1: -+ voltage_swing = 1; -+ break; -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_2: -+ voltage_swing = 2; -+ break; -+ case DP_TRAIN_VOLTAGE_SWING_LEVEL_3: -+ voltage_swing = 3; -+ break; -+ } -+ switch (train_set & DP_TRAIN_PRE_EMPHASIS_MASK) { -+ case DP_TRAIN_PRE_EMPH_LEVEL_0: -+ default: -+ pre_emphasis = 0; -+ break; -+ case DP_TRAIN_PRE_EMPH_LEVEL_1: -+ pre_emphasis = 1; -+ break; -+ case DP_TRAIN_PRE_EMPH_LEVEL_2: -+ pre_emphasis = 2; -+ break; -+ case DP_TRAIN_PRE_EMPH_LEVEL_3: -+ pre_emphasis = 3; -+ break; -+ } -+ -+ switch (link_rate) { -+ case 810000: -+ link_rate_index = 3; -+ break; -+ case 540000: -+ link_rate_index = 2; -+ break; -+ case 270000: -+ link_rate_index = 1; -+ break; -+ case 162000: -+ link_rate_index = 0; -+ break; -+ default: -+ DRM_ERROR("phytium dp rate(%d) not support\n", link_rate); -+ link_rate_index = 2; -+ break; -+ } -+ -+ if (port == 0) { -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DIAG_ACYA, LOCK); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_TXCC_CTRL, TX_TXCC_CTRL); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DRV, TX_DRV); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_MGNFS, -+ mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_CPOST, -+ cpost_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DIAG_ACYA, UNLOCK); -+ -+ } else if (port == 1) { -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DIAG_ACYA, LOCK); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_TXCC_CTRL, TX_TXCC_CTRL); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DRV, TX_DRV); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_MGNFS, -+ mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_CPOST, -+ cpost_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_CPOST1, -+ cpost_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DIAG_ACYA, UNLOCK); -+ } else { -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DIAG_ACYA, LOCK); -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_TXCC_CTRL, TX_TXCC_CTRL); -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DRV, TX_DRV); -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_MGNFS, -+ mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_CPOST, -+ cpost_val[link_rate_index][voltage_swing][pre_emphasis]); -+ phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DIAG_ACYA, UNLOCK); -+ } -+} -+ -+static int px210_dp_hw_init_phy(struct phytium_dp_device *phytium_dp) -+{ -+ int port = phytium_dp->port; -+ int i = 0, data, tmp, mask; -+ int timeout = 500, ret = 0; -+ -+ if (port == 0 || port == 1) { -+ phytium_phy_writel(phytium_dp, PX210_PHY0_APB_RESET, APB_RESET); -+ -+ phytium_phy_writel(phytium_dp, PX210_PHY0_PIPE_RESET, RESET); -+ -+ /* config lane to dp mode */ -+ data = 0; -+ mask = 0; -+ for (i = 0; i < phytium_dp->source_max_lane_count; i++) { -+ data |= (LANE_BIT << i*LANE_BIT_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (LANE_MASTER << i*LANE_MASTER_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (PLL_EN << i*PLL_EN_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (BIT_20 << i*BIT_20_SHIFT); -+ mask |= (((1<source_max_lane_count; i++) { -+ data |= (A0_ACTIVE << i*A0_ACTIVE_SHIFT); -+ mask |= (((1<dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dcreq_reg_base[port]; -+ int ret = 0; -+ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | PANEL_POWER_ENABLE, -+ group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to poweron panel\n", __func__); -+} -+ -+static void px210_dp_hw_poweroff_panel(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dcreq_reg_base[port]; -+ int ret = 0; -+ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | PANEL_POWER_DISABLE, -+ group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to poweroff panel\n", __func__); -+} -+ -+static void px210_dp_hw_enable_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, ret = 0; -+ uint32_t group_offset = priv->dcreq_reg_base[port]; -+ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | BACKLIGHT_ENABLE, -+ group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to enable backlight\n", __func__); -+} -+ -+static void px210_dp_hw_disable_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dcreq_reg_base[port]; -+ int ret = 0; -+ -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | BACKLIGHT_DISABLE, -+ group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to disable backlight\n", __func__); -+} -+ -+static uint32_t px210_dp_hw_get_backlight(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int config; -+ uint32_t group_offset = priv->address_transform_base; -+ -+ config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE); -+ return ((config >> BACKLIGHT_VALUE_SHIFT) & BACKLIGHT_VALUE_MASK); -+} -+ -+static int px210_dp_hw_set_backlight(struct phytium_dp_device *phytium_dp, uint32_t level) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ uint32_t group_offset = priv->dcreq_reg_base[port]; -+ int config = 0; -+ int ret = 0; -+ -+ if (level > PX210_DP_BACKLIGHT_MAX) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ config = FLAG_REQUEST | CMD_BACKLIGHT | ((level & BACKLIGHT_MASK) << BACKLIGHT_SHIFT); -+ phytium_writel_reg(priv, config, group_offset, PX210_DCREQ_CMD_REGISTER); -+ ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, -+ FLAG_REQUEST, FLAG_REPLY); -+ if (ret < 0) -+ DRM_ERROR("%s: failed to set backlight\n", __func__); -+ -+out: -+ return ret; -+} -+ -+bool px210_dp_hw_spread_is_enable(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port, config; -+ uint32_t group_offset = priv->address_transform_base; -+ -+ config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); -+ -+ return ((config & DP_SPREAD_ENABLE(port)) ? true:false); -+} -+ -+int px210_dp_hw_reset(struct phytium_dp_device *phytium_dp) -+{ -+ struct drm_device *dev = phytium_dp->dev; -+ struct phytium_display_private *priv = dev->dev_private; -+ int port = phytium_dp->port; -+ int timeout = 100, config, ret = 0; -+ uint32_t group_offset = priv->address_transform_base; -+ uint32_t group_offset_dp = priv->dp_reg_base[port]; -+ -+ config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); -+ config &= (~DC_DP_RESET_STATUS(port)); -+ -+ phytium_writel_reg(priv, config, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); -+ phytium_writel_reg(priv, FLAG_REQUEST | CMD_DC_DP_RESET, -+ priv->dcreq_reg_base[port], PX210_DCREQ_CMD_REGISTER); -+ do { -+ mdelay(10); -+ timeout--; -+ config = phytium_readl_reg(priv, group_offset, -+ PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); -+ if (config & DC_DP_RESET_STATUS(port)) -+ break; -+ } while (timeout); -+ if (timeout == 0) { -+ DRM_ERROR("reset dc/dp pipe(%d) failed\n", port); -+ ret = -1; -+ } -+ -+ phytium_writel_reg(priv, AUX_CLK_DIVIDER, group_offset_dp, PHYTIUM_DP_AUX_CLK_DIVIDER); -+ -+ return ret; -+} -+ -+uint8_t px210_dp_hw_get_source_lane_count(struct phytium_dp_device *phytium_dp) -+{ -+ return px210_dp_source_lane_count[phytium_dp->port]; -+} -+ -+static struct phytium_dp_func px210_dp_funcs = { -+ .dp_hw_get_source_lane_count = px210_dp_hw_get_source_lane_count, -+ .dp_hw_reset = px210_dp_hw_reset, -+ .dp_hw_spread_is_enable = px210_dp_hw_spread_is_enable, -+ .dp_hw_set_backlight = px210_dp_hw_set_backlight, -+ .dp_hw_get_backlight = px210_dp_hw_get_backlight, -+ .dp_hw_disable_backlight = px210_dp_hw_disable_backlight, -+ .dp_hw_enable_backlight = px210_dp_hw_enable_backlight, -+ .dp_hw_poweroff_panel = px210_dp_hw_poweroff_panel, -+ .dp_hw_poweron_panel = px210_dp_hw_poweron_panel, -+ .dp_hw_init_phy = px210_dp_hw_init_phy, -+ .dp_hw_set_phy_lane_setting = px210_dp_hw_set_phy_lane_setting, -+ .dp_hw_set_phy_lane_and_rate = px210_dp_hw_set_phy_lane_and_rate, -+}; -+ -+void px210_dp_func_register(struct phytium_dp_device *phytium_dp) -+{ -+ phytium_dp->funcs = &px210_dp_funcs; -+} -diff --git a/drivers/gpu/drm/phytium/px210_dp.h b/drivers/gpu/drm/phytium/px210_dp.h -new file mode 100644 -index 000000000..b62a3c833 ---- /dev/null -+++ b/drivers/gpu/drm/phytium/px210_dp.h -@@ -0,0 +1,14 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PX210_DP_H__ -+#define __PX210_DP_H__ -+ -+#define PX210_DP_BACKLIGHT_MAX 100 -+#define PX210_DP_BACKLIGHT_MIN 0 -+ -+void px210_dp_func_register(struct phytium_dp_device *phytium_dp); -+#endif /* __PX210_DP_H__ */ -diff --git a/drivers/gpu/drm/phytium/px210_reg.h b/drivers/gpu/drm/phytium/px210_reg.h -new file mode 100644 -index 000000000..dbe1e537f ---- /dev/null -+++ b/drivers/gpu/drm/phytium/px210_reg.h -@@ -0,0 +1,349 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium display drm driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PX210_REG_H__ -+#define __PX210_REG_H__ -+ -+#include "phytium_reg.h" -+ -+/******************************dc register start******************************************/ -+#define PX210_DC_CLOCK_CONTROL 0x0000 -+ #define SOFT_RESET (1<<12) -+#define PX210_DC_CLOCK_IDLE 0x0004 -+ #define IS_IDLE (1<<16) -+/******************************dc register end********************************************/ -+ -+/******************************dcreq register start**************************************/ -+#define PX210_DCREQ_PLANE0_ADDR_START 0x00 -+#define PX210_DCREQ_PLANE0_ADDR_END 0x04 -+#define PX210_DCREQ_PLANE1_ADDR_START 0x08 -+#define PX210_DCREQ_PLANE1_ADDR_END 0x0c -+#define PX210_DCREQ_PLANE0_CONFIG 0x10 -+ #define DCREQ_NO_LOSSY (0 << 0) -+ #define DCREQ_LOSSY (1 << 0) -+ #define DCREQ_TILE_TYPE_MASK (0x3 << 1) -+ #define DCREQ_TILE_TYPE_MODE0 (0x1 << 1) -+ #define DCREQ_TILE_TYPE_MODE3 (0x2 << 1) -+ #define DCREQ_COLOURFORMAT_MASK (0x7f << 8) -+ #define DCREQ_COLOURFORMAT_RGB565 (0x5 << 8) -+ #define DCREQ_COLOURFORMAT_ARGB1555 (0x4 << 8) -+ #define DCREQ_COLOURFORMAT_ARGB4444 (0x02 << 8) -+ #define DCREQ_COLOURFORMAT_BGRA8888 (0x29 << 8) -+ #define DCREQ_COLOURFORMAT_ARGB2101010 (0xe << 8) -+ #define DCREQ_COLOURFORMAT_YUYV (0x59 << 8) -+ #define DCREQ_COLOURFORMAT_UYVY (0x5b << 8) -+ #define DCREQ_ARGBSWIZZLE_MASK (0xf << 4) -+ #define DCREQ_ARGBSWIZZLE_ARGB (0X0 << 4) -+ #define DCREQ_ARGBSWIZZLE_BGRA (0XC << 4) -+ #define DCREQ_MODE_MASK (1 << 16) -+ #define DCREQ_MODE_LINEAR (0 << 16) -+ #define DCREQ_MODE_TILE (1 << 16) -+#define PX210_DCREQ_PLANE1_CONFIG(pipe) 0x14 -+#define PX210_DCREQ_PLANE0_CLEAR_COLOR_L 0x18 -+#define PX210_DCREQ_PLANE0_CLEAR_COLOR_H 0x1C -+#define PX210_DCREQ_PLANE1_CLEAR_COLOR_L 0x20 -+#define PX210_DCREQ_PLANE1_CLEAR_COLOR_H 0x24 -+#define PX210_DCREQ_CMD_REGISTER 0x38 -+ #define FLAG_REPLY (1<<31) -+ #define FLAG_REQUEST (1<<30) -+ #define CMD_PIXEL_CLOCK (0x0 << 28) -+ #define CMD_BACKLIGHT (0x1 << 28) -+ #define CMD_DC_DP_RESET (0x3 << 28) -+ #define BACKLIGHT_SHIFT 21 -+ #define BACKLIGHT_MASK 0x7f -+ #define BACKLIGHT_MAX 100 -+ #define BACKLIGHT_ENABLE (101 << BACKLIGHT_SHIFT) -+ #define BACKLIGHT_DISABLE (102 << BACKLIGHT_SHIFT) -+ #define PANEL_POWER_ENABLE (103 << BACKLIGHT_SHIFT) -+ #define PANEL_POWER_DISABLE (104 << BACKLIGHT_SHIFT) -+ #define PIXEL_CLOCK_MASK (0x1fffff) -+#define PX210_DCREQ_FBCD_CLOCK_CONFIG 0x3c -+#define PX210_DCREQ_PIX_DMA_PREFIX 0x50 -+ #define PREFIX_MASK 0xff -+ #define PREFIX_SHIFT 32 -+#define PX210_DCREQ_FRAME_START 0x54 -+#define PX210_DCREQ_FILTER_CONFIG 0x58 -+#define PX210_DCREQ_CONTROL 0x5C -+ #define DC_REQ_ENABLE (1<<0) -+#define PX210_DCREQ_MSI_CLEAR 0x60 -+ #define MSI_CLEAR 0x0 -+#define PX210_DCREQ_RESET 0x68 -+ #define DCREQ_RESET (0x3 << 0) -+ #define DCREQ_RESET_MASK 0x3 -+#define PX210_DCREQ_PLAN 0x94 -+ #define DCREQ_PLAN_A 0x0 -+ #define DCREQ_PLAN_B 0X5 -+/******************************dcreq register end**************************************/ -+ -+/******************************address transform register start**************************/ -+#define PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR 0x0 -+#define PX210_GPU_ADDRESS_TRANSFORM_SIZE 0x4 -+#define PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR 0x8 -+ -+#define PX210_DC_ADDRESS_TRANSFORM_SRC_ADDR 0x24 -+ #define SRC_ADDR_OFFSET 22 -+ #define SRC_ADDR_MASK 0xffffffffff -+#define PX210_DC_ADDRESS_TRANSFORM_SIZE 0x28 -+ #define ADDRESS_TRANSFORM_ENABLE (0x1 << 31) -+ #define SIZE_OFFSET 22 -+#define PX210_DC_ADDRESS_TRANSFORM_DST_ADDR 0x2c -+ #define DST_ADDR_OFFSET 22 -+#define PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS 0x48 -+ #define DC_DP_RESET_STATUS(pipe) (1 << pipe) -+ #define DP_SPREAD_ENABLE(pipe) (0x8 << pipe) -+#define PX210_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE 0x4c -+ #define BACKLIGHT_VALUE_MASK (0x7f) -+ #define BACKLIGHT_VALUE_SHIFT 16 -+/******************************address transform register end**************************/ -+ -+/******************************phy register start******************************************/ -+/* self define */ -+#define PX210_PHY0_PIPE_RESET 0x40104 -+ #define RESET 0x0 -+ #define RESET_DEASSERT 0x1 -+#define PX210_PHY1_PIPE_RESET 0x100100 -+ #define PHY1_PIPE_RESET 0x0 -+ #define PHY1_PIPE_RESET_DEASSERT 0x4 -+ -+#define PX210_PHY1_EN_REFCLK 0x100070 -+ -+#define PX210_PHY0_MODE 0x40088 -+ #define LANE_BIT (0x3) -+ #define LANE_BIT_SHIFT 0x2 -+#define PX210_PHY1_SEL 0x100004 -+ #define PHY1_DP_LANE_BIT 0x1 -+ #define PHY1_DP_LANE_BIT_SHIFT 2 -+ -+#define PX210_PHY0_LINK_CFG 0x40044 -+ #define LANE_MASTER 0x1 -+ #define LANE_MASTER_SHIFT 1 -+ -+#define PX210_PHY0_PLL_EN 0x40010 -+ #define PLL_EN 0x1 -+ #define PLL_EN_SHIFT 1 -+#define PX210_PHY0_PMA_WIDTH 0x40020 -+ #define BIT_20 0x5 -+ #define BIT_20_SHIFT 4 -+ -+#define PX210_PHY0_PMA0_POWER 0x40014 -+#define PX210_PHY0_PMA1_POWER 0x40018 -+ #define A0_ACTIVE 0x1 -+ #define A0_ACTIVE_SHIFT 8 -+ #define A3_POWERDOWN3 0x8 -+ #define A3_POWERDOWN3_SHIFT 8 -+ -+#define PX210_PHY1_PMA_MISC 0x1000a0 -+ #define PHY1_PLL_EN 0x1 -+ #define PHY1_PLL_EN_MASK 1 -+ #define PHY1_PLL_EN_SHIFT 8 -+ #define PHY1_BIT_20 0x5 -+ #define PHY1_BIT_20_SHIFT 9 -+ #define PHY1_A0_ACTIVE 0x1 -+ #define PHY1_A0_ACTIVE_SHIFT 2 -+ #define PHY1_A0_ACTIVE_MASK 0x3f -+ #define PHY1_A3_POWERDOWN3 0x8 -+ #define PHY1_A3_POWERDOWN3_MASK 0x3f -+ #define PHY1_A3_POWERDOWN3_SHIFT 2 -+ -+#define PX210_PHY0_LINK_RESET 0x40108 -+ #define LINK_RESET 0x1 -+ #define LINK_RESET_MASK 0x1 -+ #define LINTK_RESET_SHIFT 0x1 -+ -+#define PX210_PHY0_APB_RESET 0x40100 -+ #define APB_RESET 0x1 -+#define PX210_PHY1_APB_RESET 0x100104 -+ #define PHY1_APB_RESET 0x4 -+ -+/* phy origin register */ -+#define PX210_PHY0_PLL_CFG 0x30038 -+#define PX210_PHY1_PLL_CFG 0xb0038 -+ #define SINGLE_LINK 0x0 -+ #define DOUBLE_LINK 0x2 -+ -+#define PX210_PHY0_PMA_CONTROL 0x3800c -+#define PX210_PHY1_PMA_CONTROL 0xb800c -+ #define CONTROL_ENABLE 0x1 -+ #define CONTROL_ENABLE_MASK 0x1 -+ #define CONTROL_ENABLE_SHIFT 0x1 -+ -+#define PX210_PHY0_PMA_CONTROL2 0x38004 -+#define PX210_PHY1_PMA_CONTROL2 0xb8004 -+ #define PLL0_LOCK_DONE (0x1 << 6) -+ #define PLL1_LOCK_DONE (0x1 << 7) -+ -+#define PX210_PHY0_PLL0_CLK_SEL 0X684 -+#define PX210_PHY0_PLL1_CLK_SEL 0x704 -+#define PX210_PHY1_PLL_CLK_SEL 0X80684 -+ #define PLL_LINK_RATE_162000 0xf01 -+ #define PLL_LINK_RATE_270000 0x701 -+ #define PLL_LINK_RATE_540000 0x301 -+ #define PLL_LINK_RATE_810000 0x200 -+ -+#define PX210_PHY0_HSCLK0_SEL 0x18398 -+#define PX210_PHY0_HSCLK1_SEL 0x1a398 -+#define PX210_PHY1_HSCLK_SEL 0x90398 -+ #define HSCLK_LINK_0 0x0 -+ #define HSCLK_LINK_1 0x1 -+ -+#define PX210_PHY0_HSCLK0_DIV 0x1839c -+#define PX210_PHY0_HSCLK1_DIV 0x1a39c -+#define PX210_PHY1_HSCLK_DIV 0x9039c -+ #define HSCLK_LINK_RATE_162000 0x2 -+ #define HSCLK_LINK_RATE_270000 0x1 -+ #define HSCLK_LINK_RATE_540000 0x0 -+ #define HSCLK_LINK_RATE_810000 0x0 -+ -+#define PX210_PHY0_PLLDRC0_CTRL 0x18394 -+#define PX210_PHY0_PLLDRC1_CTRL 0x1a394 -+#define PX210_PHY1_PLLDRC_CTRL 0x90394 -+ #define PLLDRC_LINK0 0x1 -+ #define PLLDRC_LINK1 0x9 -+ -+#define PX210_PHY0_PLL0_DSM_M0 0x250 -+#define PX210_PHY1_PLL0_DSM_M0 0x80250 -+ #define PLL0_DSM_M0 0x4 -+#define PX210_PHY0_PLL0_VCOCAL_START 0x218 -+#define PX210_PHY1_PLL0_VCOCAL_START 0x80218 -+ #define PLL0_VCOCAL_START 0xc5e -+#define PX210_PHY0_PLL0_VCOCAL_CTRL 0x208 -+#define PX210_PHY1_PLL0_VCOCAL_CTRL 0x80208 -+ #define PLL0_VCOCAL_CTRL 0x3 -+ -+#define PX210_PHY0_PLL1_DSM_M0 0x350 -+ #define PLL1_DSM_M0 0x4 -+#define PX210_PHY0_PLL1_VCOCAL_START 0x318 -+ #define PLL1_VCOCAL_START 0xc5e -+#define PX210_PHY0_PLL1_VCOCAL_CTRL 0x308 -+ #define PLL1_VCOCAL_CTRL 0x3 -+ -+#define PX210_PHY0_PLL0_CP_PADJ 0x690 -+#define PX210_PHY0_PLL0_CP_IADJ 0x694 -+#define PX210_PHY0_PLL0_CP_FILT_PADJ 0x698 -+#define PX210_PHY0_PLL0_INTDIV 0x240 -+#define PX210_PHY0_PLL0_FRACDIVL 0x244 -+#define PX210_PHY0_PLL0_FRACDIVH 0x248 -+#define PX210_PHY0_PLL0_HIGH_THR 0x24c -+#define PX210_PHY0_PLL0_PDIAG_CTRL 0x680 -+#define PX210_PHY0_PLL0_VCOCAL_PLLCNT_START 0x220 -+#define PX210_PHY0_PLL0_LOCK_PEFCNT 0x270 -+#define PX210_PHY0_PLL0_LOCK_PLLCNT_START 0x278 -+#define PX210_PHY0_PLL0_LOCK_PLLCNT_THR 0x27c -+ -+#define PX210_PHY0_PLL1_CP_PADJ 0x710 -+#define PX210_PHY0_PLL1_CP_IADJ 0x714 -+#define PX210_PHY0_PLL1_CP_FILT_PADJ 0x718 -+#define PX210_PHY0_PLL1_INTDIV 0x340 -+#define PX210_PHY0_PLL1_FRACDIVL 0x344 -+#define PX210_PHY0_PLL1_FRACDIVH 0x348 -+#define PX210_PHY0_PLL1_HIGH_THR 0x34c -+#define PX210_PHY0_PLL1_PDIAG_CTRL 0x700 -+#define PX210_PHY0_PLL1_VCOCAL_PLLCNT_START 0x320 -+#define PX210_PHY0_PLL1_LOCK_PEFCNT 0x370 -+#define PX210_PHY0_PLL1_LOCK_PLLCNT_START 0x378 -+#define PX210_PHY0_PLL1_LOCK_PLLCNT_THR 0x37c -+ -+#define PX210_PHY1_PLL0_CP_PADJ 0x80690 -+#define PX210_PHY1_PLL0_CP_IADJ 0x80694 -+#define PX210_PHY1_PLL0_CP_FILT_PADJ 0x80698 -+#define PX210_PHY1_PLL0_INTDIV 0x80240 -+#define PX210_PHY1_PLL0_FRACDIVL 0x80244 -+#define PX210_PHY1_PLL0_FRACDIVH 0x80248 -+#define PX210_PHY1_PLL0_HIGH_THR 0x8024c -+#define PX210_PHY1_PLL0_PDIAG_CTRL 0x80680 -+#define PX210_PHY1_PLL0_VCOCAL_PLLCNT_START 0x80220 -+#define PX210_PHY1_PLL0_LOCK_PEFCNT 0x80270 -+#define PX210_PHY1_PLL0_LOCK_PLLCNT_START 0x80278 -+#define PX210_PHY1_PLL0_LOCK_PLLCNT_THR 0x8027c -+ -+#define PX210_PHY0_PLL0_TX_PSC_A0 0x18400 -+#define PX210_PHY1_PLL0_TX_PSC_A0 0x90400 -+ #define PLL0_TX_PSC_A0 0xfb -+#define PX210_PHY0_PLL0_TX_PSC_A2 0x18408 -+#define PX210_PHY1_PLL0_TX_PSC_A2 0x90408 -+ #define PLL0_TX_PSC_A2 0x4aa -+#define PX210_PHY0_PLL0_TX_PSC_A3 0x1840c -+#define PX210_PHY1_PLL0_TX_PSC_A3 0x9040c -+ #define PLL0_TX_PSC_A3 0x4aa -+#define PX210_PHY0_PLL0_RX_PSC_A0 0x28000 -+#define PX210_PHY1_PLL0_RX_PSC_A0 0xa0000 -+ #define PLL0_RX_PSC_A0 0x0 -+#define PX210_PHY0_PLL0_RX_PSC_A2 0x28008 -+#define PX210_PHY1_PLL0_RX_PSC_A2 0xa0008 -+ #define PLL0_RX_PSC_A2 0x0 -+#define PX210_PHY0_PLL0_RX_PSC_A3 0x2800C -+#define PX210_PHY1_PLL0_RX_PSC_A3 0xa000C -+ #define PLL0_RX_PSC_A3 0x0 -+#define PX210_PHY0_PLL0_RX_PSC_CAL 0x28018 -+#define PX210_PHY1_PLL0_RX_PSC_CAL 0xa0018 -+ #define PLL0_RX_PSC_CAL 0x0 -+ -+#define PX210_PHY0_PLL1_TX_PSC_A0 0x1a400 -+ #define PLL1_TX_PSC_A0 0xfb -+#define PX210_PHY0_PLL1_TX_PSC_A2 0x1a408 -+ #define PLL1_TX_PSC_A2 0x4aa -+#define PX210_PHY0_PLL1_TX_PSC_A3 0x1a40c -+ #define PLL1_TX_PSC_A3 0x4aa -+#define PX210_PHY0_PLL1_RX_PSC_A0 0x2a000 -+ #define PLL1_RX_PSC_A0 0x0 -+#define PX210_PHY0_PLL1_RX_PSC_A2 0x2a008 -+ #define PLL1_RX_PSC_A2 0x0 -+#define PX210_PHY0_PLL1_RX_PSC_A3 0x2a00C -+ #define PLL1_RX_PSC_A3 0x0 -+#define PX210_PHY0_PLL1_RX_PSC_CAL 0x2a018 -+ #define PLL1_RX_PSC_CAL 0x0 -+ -+#define PX210_PHY0_PLL0_XCVR_CTRL 0x183a8 -+#define PX210_PHY1_PLL0_XCVR_CTRL 0x903a8 -+ #define PLL0_XCVR_CTRL 0xf -+#define PX210_PHY0_PLL1_XCVR_CTRL 0x1a3a8 -+ #define PLL1_XCVR_CTRL 0xf -+ -+#define PX210_PHY0_PLL0_RX_GCSM1_CTRL 0x28420 -+#define PX210_PHY1_PLL0_RX_GCSM1_CTRL 0xa0420 -+ #define PLL0_RX_GCSM1_CTRL 0x0 -+#define PX210_PHY0_PLL0_RX_GCSM2_CTRL 0x28440 -+#define PX210_PHY1_PLL0_RX_GCSM2_CTRL 0xa0440 -+ #define PLL0_RX_GCSM2_CTRL 0x0 -+#define PX210_PHY0_PLL0_RX_PERGCSM_CTRL 0x28460 -+#define PX210_PHY1_PLL0_RX_PERGCSM_CTRL 0xa0460 -+ #define PLL0_RX_PERGCSM_CTRL 0x0 -+ -+#define PX210_PHY0_PLL1_RX_GCSM1_CTRL 0x2a420 -+ #define PLL1_RX_GCSM1_CTRL 0x0 -+#define PX210_PHY0_PLL1_RX_GCSM2_CTRL 0x2a440 -+ #define PLL1_RX_GCSM2_CTRL 0x0 -+#define PX210_PHY0_PLL1_RX_PERGCSM_CTRL 0x2a460 -+ #define PLL1_RX_PERGCSM_CTRL 0x0 -+ -+/* swing and emphasis */ -+#define PX210_PHY0_PLL0_TX_DIAG_ACYA 0x1879c -+#define PX210_PHY0_PLL1_TX_DIAG_ACYA 0x1a79c -+#define PX210_PHY1_PLL0_TX_DIAG_ACYA 0x9079c -+ #define LOCK 1 -+ #define UNLOCK 0 -+ -+#define PX210_PHY0_PLL0_TX_TXCC_CTRL 0x18100 -+#define PX210_PHY0_PLL1_TX_TXCC_CTRL 0x1a100 -+#define PX210_PHY1_PLL0_TX_TXCC_CTRL 0x90100 -+ #define TX_TXCC_CTRL 0x8a4 -+ -+#define PX210_PHY0_PLL0_TX_DRV 0x18318 -+#define PX210_PHY0_PLL1_TX_DRV 0x1a318 -+#define PX210_PHY1_PLL0_TX_DRV 0x90318 -+ #define TX_DRV 0x3 -+ -+#define PX210_PHY0_PLL0_TX_MGNFS 0x18140 -+#define PX210_PHY0_PLL1_TX_MGNFS 0x1a140 -+#define PX210_PHY1_PLL0_TX_MGNFS 0x90140 -+ -+#define PX210_PHY0_PLL0_TX_CPOST 0x18130 -+#define PX210_PHY0_PLL1_TX_CPOST 0x1a130 -+#define PX210_PHY0_PLL1_TX_CPOST1 0x1a13c -+#define PX210_PHY1_PLL0_TX_CPOST 0x90130 -+ -+/******************************phy register end********************************************/ -+#endif /* __PX210_REG_H__ */ -diff --git a/drivers/hwmon/Kconfig b/drivers/hwmon/Kconfig -index ec38c8892..46b4391d8 100644 ---- a/drivers/hwmon/Kconfig -+++ b/drivers/hwmon/Kconfig -@@ -412,6 +412,15 @@ config SENSORS_ASPEED - This driver can also be built as a module. If so, the module - will be called aspeed_pwm_tacho. - -+config SENSORS_PHYTIUM -+ tristate "Phytium Fan tach and capture counter driver" -+ help -+ This driver provides support for Phytium Fan Tacho and capture -+ counter controllers. -+ -+ This driver can also be built as a module. If so, the module -+ will be called tacho-phytium. -+ - config SENSORS_ATXP1 - tristate "Attansic ATXP1 VID controller" - depends on I2C -diff --git a/drivers/hwmon/Makefile b/drivers/hwmon/Makefile -index 4ac9452b5..2e948eae4 100644 ---- a/drivers/hwmon/Makefile -+++ b/drivers/hwmon/Makefile -@@ -176,6 +176,7 @@ obj-$(CONFIG_SENSORS_OXP) += oxp-sensors.o - obj-$(CONFIG_SENSORS_PC87360) += pc87360.o - obj-$(CONFIG_SENSORS_PC87427) += pc87427.o - obj-$(CONFIG_SENSORS_PCF8591) += pcf8591.o -+obj-$(CONFIG_SENSORS_PHYTIUM) += tacho-phytium.o - obj-$(CONFIG_SENSORS_POWR1220) += powr1220.o - obj-$(CONFIG_SENSORS_PWM_FAN) += pwm-fan.o - obj-$(CONFIG_SENSORS_RASPBERRYPI_HWMON) += raspberrypi-hwmon.o -diff --git a/drivers/hwmon/tacho-phytium.c b/drivers/hwmon/tacho-phytium.c -new file mode 100644 -index 000000000..00a773014 ---- /dev/null -+++ b/drivers/hwmon/tacho-phytium.c -@@ -0,0 +1,416 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Hwmon driver for Phytium tachometer. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+ -+#define TIMER_CTRL_REG 0x00 -+#define TIMER_CTRL_MODE_SHIFT 0//0:1 -+#define TIMER_CTRL_RESET_SHIFT BIT(2) -+#define TIMER_CTRL_FORCE_SHIFT BIT(3) -+#define TIMER_CTRL_CAPTURE_EN_SHIFT BIT(4) -+#define TIMER_CTRL_CAPTURE_CNT_SHIFT 5//5:11 -+#define TIMER_CTRL_ANTI_JITTER_SHIFT 18//18:19 -+#define TIMER_CTRL_TACHO_MODE_SHIFT 20//20:21 -+#define TIMER_CTRL_TIMER_CNT_MODE_SHIFT BIT(22) -+#define TIMER_CTRL_BIT_SET_SHIFT 24 -+#define TIMER_CTRL_CNT_EN_SHIFT BIT(25) -+#define TIMER_CTRL_CNT_CLR_SHIFT BIT(26) -+#define TIMER_CTRL_TIMER_MODE_SHIFT BIT(27) -+#define TIMER_CTRL_PULSE_NUM_SHIFT 28//28:30 -+#define TIMER_CTRL_TACHO_EN_SHIFT BIT(31) -+#define TIMER_TACHO_RES_REG 0x04 -+#define TIMER_TACHO_RES_VALID_SHIFT BIT(31) -+#define TIMER_TACHO_RES_MASK GENMASK(30, 0) -+#define TIMER_CMP_VALUE_UP_REG 0x08 -+#define TIMER_CMP_VALUE_LOW_REG 0x1C -+#define TIMER_CNT_VALUE_UP_REG 0x20 -+#define TIMER_CNT_VALUE_LOW_REG 0x24 -+#define TIMER_INT_MASK_REG 0x28 -+#define TIMER_INT_STAT_REG 0x2C -+#define TIMER_INT_CAPTURE_SHIFT BIT(5) -+#define TIMER_INT_CYC_COMP_SHIFT BIT(4) -+#define TIMER_INT_ONE_COMP_SHIFT BIT(3) -+#define TIMER_INT_ROLLOVER_SHIFT BIT(2) -+#define TIMER_INT_TACHO_UNDER_SHIFT BIT(1) -+#define TIMER_INT_TACHO_OVER_SHIFT BIT(0) -+#define TIMER_TACHO_OVER_REG 0x30 -+#define TIMER_TACHO_UNDER_REG 0x34 -+#define TIMER_START_VALUE_REG 0x38 -+ -+#define TIMER_INT_CLR_MASK GENMASK(5, 0) -+ -+enum tacho_modes { -+tacho_mode = 1, -+capture_mode, -+}; -+ -+enum edge_modes { -+rising_edge, -+falling_edge, -+double_edge, -+}; -+ -+struct phytium_tacho { -+ struct device *dev; -+ struct device *hwmon; -+ void __iomem *base; -+ struct clk *clk; -+ u32 freq; -+ int irq; -+ u8 work_mode; -+ u8 edge_mode; -+ u32 debounce; -+}; -+ -+static u16 capture_count; -+ -+static void phytium_tacho_init(struct phytium_tacho *tacho) -+{ -+ u32 val; -+ -+ if (tacho->work_mode == tacho_mode) { -+ val = (TIMER_CTRL_TACHO_EN_SHIFT | -+ TIMER_CTRL_CNT_EN_SHIFT | -+ (tacho->edge_mode << TIMER_CTRL_TACHO_MODE_SHIFT) | -+ (tacho->debounce << TIMER_CTRL_ANTI_JITTER_SHIFT) | -+ (tacho->work_mode << TIMER_CTRL_MODE_SHIFT)); -+ writel_relaxed(val, tacho->base + TIMER_CTRL_REG); -+ writel_relaxed(0x2faf07f, tacho->base + TIMER_CMP_VALUE_LOW_REG); -+ } else { -+ val = (TIMER_CTRL_TACHO_EN_SHIFT | -+ TIMER_CTRL_CNT_EN_SHIFT | -+ (tacho->edge_mode << TIMER_CTRL_TACHO_MODE_SHIFT) | -+ (tacho->debounce << TIMER_CTRL_ANTI_JITTER_SHIFT) | -+ TIMER_CTRL_CAPTURE_EN_SHIFT | -+ (0x7f << TIMER_CTRL_CAPTURE_CNT_SHIFT) | -+ (tacho->work_mode << TIMER_CTRL_MODE_SHIFT)), -+ writel_relaxed(val, tacho->base + TIMER_CTRL_REG); -+ writel_relaxed(0x20, tacho->base + TIMER_INT_MASK_REG); -+ } -+} -+ -+static int phytium_get_fan_tach_rpm(struct phytium_tacho *priv) -+{ -+ u64 raw_data, tach_div, clk_source; -+ u8 mode, both; -+ unsigned long timeout; -+ unsigned long loopcounter; -+ -+ timeout = jiffies + msecs_to_jiffies(500); -+ -+ for (loopcounter = 0;; loopcounter++) { -+ raw_data = readl_relaxed(priv->base + TIMER_TACHO_RES_REG); -+ -+ if (raw_data & TIMER_TACHO_RES_VALID_SHIFT) -+ break; -+ -+ if (time_after(jiffies, timeout)) -+ return -ETIMEDOUT; -+ -+ if (loopcounter > 3000) -+ msleep(20); -+ else { -+ udelay(100); -+ cond_resched(); -+ } -+ } -+ -+ raw_data = raw_data & TIMER_TACHO_RES_MASK; -+ clk_source = priv->freq; -+ mode = priv->edge_mode; -+ both = (mode == double_edge) ? 1 : 0; -+ tach_div = 1 << both; -+ -+ if (raw_data == 0) -+ return 0; -+ -+ return (clk_source * 60 * raw_data) / 0x2faf080 / tach_div; -+} -+ -+static ssize_t show_rpm(struct device *dev, struct device_attribute *attr, -+ char *buf) -+{ -+ int rpm; -+ struct phytium_tacho *priv = dev_get_drvdata(dev); -+ -+ rpm = phytium_get_fan_tach_rpm(priv); -+ if (rpm < 0) -+ return rpm; -+ -+ return sprintf(buf, "%d\n", rpm); -+} -+ -+static SENSOR_DEVICE_ATTR(fan_input, 0444, -+ show_rpm, NULL, 0); -+ -+static struct attribute *tacho_dev_attrs[] = { -+ &sensor_dev_attr_fan_input.dev_attr.attr, -+ NULL -+}; -+ -+static umode_t tacho_dev_is_visible(struct kobject *kobj, -+ struct attribute *a, int index) -+{ -+ return a->mode; -+} -+ -+static const struct attribute_group tacho_group = { -+ .attrs = tacho_dev_attrs, -+ .is_visible = tacho_dev_is_visible, -+}; -+ -+static const struct attribute_group *tacho_groups[] = { -+ &tacho_group, -+ NULL -+}; -+ -+static irqreturn_t capture_irq_handler(int irq, void *dev_id) -+{ -+ struct phytium_tacho *priv = dev_id; -+ u32 status = readl_relaxed(priv->base + TIMER_INT_STAT_REG); -+ -+ if (status & TIMER_INT_CAPTURE_SHIFT) { -+ capture_count++; -+ -+ if (capture_count == 0) -+ dev_err(priv->dev, "Capture counter is overflowed"); -+ -+ writel_relaxed(status, priv->base + TIMER_INT_STAT_REG); -+ return IRQ_HANDLED; -+ } -+ return IRQ_NONE; -+} -+ -+static ssize_t show_capture(struct device *dev, struct device_attribute *attr, -+ char *buf) -+{ -+ int cnt; -+ struct phytium_tacho *priv = dev_get_drvdata(dev); -+ -+ cnt = capture_count * 0x7f + readl_relaxed(priv->base + TIMER_CNT_VALUE_LOW_REG); -+ -+ return sprintf(buf, "%d\n", cnt); -+} -+ -+static SENSOR_DEVICE_ATTR(capture_input, 0444, -+ show_capture, NULL, 0); -+ -+static struct attribute *capture_dev_attrs[] = { -+ &sensor_dev_attr_capture_input.dev_attr.attr, -+ NULL -+}; -+ -+static umode_t capture_dev_is_visible(struct kobject *kobj, -+ struct attribute *a, int index) -+{ -+ return a->mode; -+} -+ -+static const struct attribute_group capture_group = { -+ .attrs = capture_dev_attrs, -+ .is_visible = capture_dev_is_visible, -+}; -+ -+static const struct attribute_group *capture_groups[] = { -+ &capture_group, -+ NULL -+}; -+ -+static int phytium_tacho_get_work_mode(struct phytium_tacho *tacho) -+{ -+ struct device_node *nc = tacho->dev->of_node; -+ struct fwnode_handle *fwn = tacho->dev->fwnode; -+ -+ if (of_property_read_bool(nc, "tacho")) -+ return tacho_mode; -+ else if (has_acpi_companion(tacho->dev) && fwnode_property_read_bool( -+ fwn, "tacho")) -+ return tacho_mode; -+ if (of_property_read_bool(nc, "capture")) -+ return capture_mode; -+ else if (has_acpi_companion(tacho->dev) && fwnode_property_read_bool( -+ fwn, "capture")) -+ return capture_mode; -+ return tacho_mode; -+} -+ -+static int phytium_tacho_get_edge_mode(struct phytium_tacho *tacho) -+{ -+ struct device_node *nc = tacho->dev->of_node; -+ struct fwnode_handle *fwn = tacho->dev->fwnode; -+ -+ if (of_property_read_bool(nc, "up")) -+ return rising_edge; -+ else if (has_acpi_companion(tacho->dev) && fwnode_property_read_bool( -+ fwn, "up")) -+ return rising_edge; -+ if (of_property_read_bool(nc, "down")) -+ return falling_edge; -+ else if (has_acpi_companion(tacho->dev) && fwnode_property_read_bool( -+ fwn, "down")) -+ return falling_edge; -+ if (of_property_read_bool(nc, "double")) -+ return double_edge; -+ else if (has_acpi_companion(tacho->dev) && fwnode_property_read_bool( -+ fwn, "double")) -+ return double_edge; -+ return rising_edge; -+} -+ -+static int phytium_tacho_get_debounce(struct phytium_tacho *tacho) -+{ -+ u32 value; -+ struct device_node *nc = tacho->dev->of_node; -+ struct fwnode_handle *fwn = tacho->dev->fwnode; -+ -+ if (!of_property_read_u32(nc, "debounce-level", &value)) -+ return value; -+ if (has_acpi_companion(tacho->dev)) { -+ if (!fwnode_property_read_u32(fwn, "debounce-level", &value)) -+ return value; -+ } -+ return 0; -+} -+ -+static void phytium_tacho_get_of_data(struct phytium_tacho *tacho) -+{ -+ tacho->work_mode = phytium_tacho_get_work_mode(tacho); -+ tacho->edge_mode = phytium_tacho_get_edge_mode(tacho); -+ tacho->debounce = phytium_tacho_get_debounce(tacho); -+} -+ -+static int phytium_tacho_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct resource *res; -+ struct phytium_tacho *tacho; -+ int ret; -+ -+ tacho = devm_kzalloc(dev, sizeof(*tacho), GFP_KERNEL); -+ if (!tacho) -+ return -ENOMEM; -+ -+ tacho->dev = &pdev->dev; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ if (!res) -+ return -ENOENT; -+ -+ tacho->base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(tacho->base)) { -+ dev_err(&pdev->dev, "region map failed\n"); -+ return PTR_ERR(tacho->base); -+ } -+ -+ if (!has_acpi_companion(tacho->dev)) { -+ tacho->clk = devm_clk_get(&pdev->dev, NULL); -+ if (IS_ERR(tacho->clk)) -+ return PTR_ERR(tacho->clk); -+ ret = clk_prepare_enable(tacho->clk); -+ if (ret) -+ return ret; -+ tacho->freq = clk_get_rate(tacho->clk); -+ } else { -+ u32 fre; -+ -+ ret = clk_prepare_enable(tacho->clk); -+ if (ret) -+ return ret; -+ fwnode_property_read_u32(tacho->dev->fwnode, "clock-frequency", &fre); -+ tacho->freq = fre; -+ } -+ -+ tacho->irq = platform_get_irq(pdev, 0); -+ if (tacho->irq < 0) { -+ dev_err(&pdev->dev, "no irq resource?\n"); -+ return tacho->irq; -+ } -+ -+ ret = devm_request_irq(dev, tacho->irq, capture_irq_handler, -+ 0, "phytium_tacho", tacho); -+ if (ret) { -+ dev_err(&pdev->dev, "Cannot request IRQ\n"); -+ return ret; -+ } -+ -+ phytium_tacho_get_of_data(tacho); -+ -+ phytium_tacho_init(tacho); -+ -+ if (tacho->work_mode == tacho_mode) -+ tacho->hwmon = devm_hwmon_device_register_with_groups(dev, -+ "phytium_tacho", -+ tacho, tacho_groups); -+ else -+ tacho->hwmon = devm_hwmon_device_register_with_groups(dev, -+ "phytium_capture", -+ tacho, capture_groups); -+ -+ platform_set_drvdata(pdev, tacho); -+ -+ return PTR_ERR_OR_ZERO(tacho->hwmon); -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_tacho_suspend(struct device *dev) -+{ -+ return 0; -+} -+ -+static int phytium_tacho_resume(struct device *dev) -+{ -+ struct phytium_tacho *tacho = dev_get_drvdata(dev); -+ -+ phytium_tacho_init(tacho); -+ -+ return 0; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_tacho_pm, phytium_tacho_suspend, phytium_tacho_resume); -+ -+static const struct of_device_id tacho_of_match[] = { -+ { .compatible = "phytium,tacho", }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, tacho_of_match); -+ -+static const struct acpi_device_id tacho_acpi_match[] = { -+ { "PHYT0033", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, tacho_acpi_match); -+ -+static struct platform_driver phytium_tacho_driver = { -+ .probe = phytium_tacho_probe, -+ .driver = { -+ .name = "phytium_tacho", -+ .pm = &phytium_tacho_pm, -+ .of_match_table = of_match_ptr(tacho_of_match), -+ .acpi_match_table = ACPI_PTR(tacho_acpi_match), -+ }, -+}; -+ -+module_platform_driver(phytium_tacho_driver); -+ -+MODULE_AUTHOR("Zhang Yiqun "); -+MODULE_DESCRIPTION("Phytium tachometer driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/hwspinlock/Kconfig b/drivers/hwspinlock/Kconfig -index 3874d15b0..f4690adb5 100644 ---- a/drivers/hwspinlock/Kconfig -+++ b/drivers/hwspinlock/Kconfig -@@ -17,6 +17,15 @@ config HWSPINLOCK_OMAP - - If unsure, say N. - -+config HWSPINLOCK_PHYTIUM -+ tristate "Phytium Hardware Spinlock device" -+ depends on HWSPINLOCK -+ depends on ARCH_PHYTIUM -+ help -+ Say y here to support the Phytium Hardware Spinlock device. -+ -+ If unsure, say N. -+ - config HWSPINLOCK_QCOM - tristate "Qualcomm Hardware Spinlock device" - depends on ARCH_QCOM || COMPILE_TEST -diff --git a/drivers/hwspinlock/Makefile b/drivers/hwspinlock/Makefile -index a0f16c9aa..d3ef14bc5 100644 ---- a/drivers/hwspinlock/Makefile -+++ b/drivers/hwspinlock/Makefile -@@ -5,6 +5,7 @@ - - obj-$(CONFIG_HWSPINLOCK) += hwspinlock_core.o - obj-$(CONFIG_HWSPINLOCK_OMAP) += omap_hwspinlock.o -+obj-$(CONFIG_HWSPINLOCK_PHYTIUM) += phytium_hwspinlock.o - obj-$(CONFIG_HWSPINLOCK_QCOM) += qcom_hwspinlock.o - obj-$(CONFIG_HWSPINLOCK_SPRD) += sprd_hwspinlock.o - obj-$(CONFIG_HWSPINLOCK_STM32) += stm32_hwspinlock.o -diff --git a/drivers/hwspinlock/phytium_hwspinlock.c b/drivers/hwspinlock/phytium_hwspinlock.c -new file mode 100644 -index 000000000..579e6bacc ---- /dev/null -+++ b/drivers/hwspinlock/phytium_hwspinlock.c -@@ -0,0 +1,189 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium hardware spinlock driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from drivers/hwspinlock/omap_hwspinlock.c -+ * Copyright (C) 2010-2015 Texas Instruments Incorporated - http://www.ti.com -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "hwspinlock_internal.h" -+ -+/* Spinlock register offsets */ -+#define LOCK_BASE 0x10 -+ -+#define SEMA_NOTTAKEN (0) /* free */ -+#define SEMA_TAKEN (1) /* locked */ -+ -+static int phytium_hwspinlock_trylock(struct hwspinlock *lock) -+{ -+ void __iomem *lock_addr = lock->priv; -+ -+ /* attempt to acquire the lock by reading its value */ -+ return (readl(lock_addr) == SEMA_NOTTAKEN); -+} -+ -+static void phytium_hwspinlock_unlock(struct hwspinlock *lock) -+{ -+ void __iomem *lock_addr = lock->priv; -+ -+ /* release the lock by writing 0 to it */ -+ writel(SEMA_NOTTAKEN, lock_addr); -+} -+ -+static void phytium_hwspinlock_relax(struct hwspinlock *lock) -+{ -+ ndelay(50); -+} -+ -+static const struct hwspinlock_ops phytium_hwspinlock_ops = { -+ .trylock = phytium_hwspinlock_trylock, -+ .unlock = phytium_hwspinlock_unlock, -+ .relax = phytium_hwspinlock_relax, -+}; -+ -+static int phytium_hwspinlock_probe(struct platform_device *pdev) -+{ -+ struct fwnode_handle *np = dev_fwnode(&(pdev->dev)); -+ struct hwspinlock_device *bank; -+ struct hwspinlock *hwlock; -+ struct resource *res; -+ void __iomem *io_base; -+ int num_locks, i, ret; -+ -+ if (!np) -+ return -ENODEV; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ if (!res) -+ return -ENODEV; -+ -+ io_base = ioremap(res->start, resource_size(res)); -+ if (!io_base) -+ return -ENOMEM; -+ -+ /* -+ * make sure the module is enabled and clocked before reading -+ * the module SYSSTATUS register -+ */ -+ pm_runtime_enable(&pdev->dev); -+ ret = pm_runtime_get_sync(&pdev->dev); -+ if (ret < 0) { -+ pm_runtime_put_noidle(&pdev->dev); -+ goto iounmap_base; -+ } -+ -+ /* Determine number of locks */ -+ if (fwnode_property_read_u32(np, "nr-locks", &num_locks)) { -+ dev_err(&pdev->dev, "missing/invalid number of locks\n"); -+ ret = -EINVAL; -+ goto iounmap_base; -+ } -+ -+ /* -+ * runtime PM will make sure the clock of this module is -+ * enabled again iff at least one lock is requested -+ */ -+ ret = pm_runtime_put(&pdev->dev); -+ if (ret < 0) -+ goto iounmap_base; -+ -+ bank = kzalloc(struct_size(bank, lock, num_locks), GFP_KERNEL); -+ if (!bank) { -+ ret = -ENOMEM; -+ goto iounmap_base; -+ } -+ -+ platform_set_drvdata(pdev, bank); -+ -+ for (i = 0, hwlock = &bank->lock[0]; i < num_locks; i++, hwlock++) { -+ /* Set register address of each lock */ -+ hwlock->priv = io_base + LOCK_BASE + sizeof(u32) * i; -+ } -+ -+ ret = hwspin_lock_register(bank, &pdev->dev, &phytium_hwspinlock_ops, -+ 0, num_locks); -+ if (ret) -+ goto reg_fail; -+ -+ return 0; -+ -+reg_fail: -+ kfree(bank); -+iounmap_base: -+ iounmap(io_base); -+ return ret; -+} -+ -+static int phytium_hwspinlock_remove(struct platform_device *pdev) -+{ -+ struct hwspinlock_device *bank = platform_get_drvdata(pdev); -+ void __iomem *io_base = bank->lock[0].priv - LOCK_BASE; -+ int ret; -+ -+ ret = hwspin_lock_unregister(bank); -+ if (ret) { -+ dev_err(&pdev->dev, "%s failed: %d\n", __func__, ret); -+ return ret; -+ } -+ -+ iounmap(io_base); -+ kfree(bank); -+ -+ return 0; -+} -+ -+static const struct of_device_id phytium_hwspinlock_of_match[] = { -+ { .compatible = "phytium,hwspinlock", }, -+ { /* end */ }, -+}; -+MODULE_DEVICE_TABLE(of, phytium_hwspinlock_of_match); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_hwspinlock_acpi_match[] = { -+ { "PHYT0053", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_hwspinlock_acpi_match); -+#endif -+ -+static struct platform_driver phytium_hwspinlock_driver = { -+ .probe = phytium_hwspinlock_probe, -+ .remove = phytium_hwspinlock_remove, -+ .driver = { -+ .name = "phytium_hwspinlock", -+ .of_match_table = of_match_ptr(phytium_hwspinlock_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_hwspinlock_acpi_match), -+ }, -+}; -+ -+static int __init phytium_hwspinlock_init(void) -+{ -+ return platform_driver_register(&phytium_hwspinlock_driver); -+} -+postcore_initcall(phytium_hwspinlock_init); -+ -+static void __exit phytium_hwspinlock_exit(void) -+{ -+ platform_driver_unregister(&phytium_hwspinlock_driver); -+} -+module_exit(phytium_hwspinlock_exit); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Hardware spinlock driver for Phytium"); -+MODULE_AUTHOR("Chen Baozi "); -diff --git a/drivers/i2c/busses/Kconfig b/drivers/i2c/busses/Kconfig -index 97d27e01a..ba10a5fd8 100644 ---- a/drivers/i2c/busses/Kconfig -+++ b/drivers/i2c/busses/Kconfig -@@ -938,6 +938,34 @@ config I2C_PCA_PLATFORM - This driver can also be built as a module. If so, the module - will be called i2c-pca-platform. - -+config I2C_PHYTIUM_CORE -+ tristate -+ -+config I2C_PHYTIUM_PCI -+ tristate "Phytium I2C PCI" -+ depends on PCI && ARCH_PHYTIUM -+ select I2C_PHYTIUM_CORE -+ select I2C_SMBUS -+ help -+ If you say yes to this option, support will be included for the -+ Phytium I2C adapter. Only master mode is supported. -+ -+ This driver can also be built as a module. If so, the module -+ will be called i2c-phytium-pci. -+ -+config I2C_PHYTIUM_PLATFORM -+ tristate "Phytium I2C Platform" -+ depends on (ACPI && COMMON_CLK) || !ACPI -+ select I2C_SLAVE -+ select I2C_PHYTIUM_CORE -+ select I2C_SMBUS -+ help -+ If you say yes to this option, support will be included for the -+ Phytium I2C adapter. Only master mode is supported. -+ -+ This driver can also be built as a module. If so, the module -+ will be called i2c-phytium-platform. -+ - config I2C_PNX - tristate "I2C bus support for Philips PNX and NXP LPC targets" - depends on ARCH_LPC32XX || COMPILE_TEST -diff --git a/drivers/i2c/busses/Makefile b/drivers/i2c/busses/Makefile -index 9be9fdb07..9d4fa0249 100644 ---- a/drivers/i2c/busses/Makefile -+++ b/drivers/i2c/busses/Makefile -@@ -93,6 +93,10 @@ obj-$(CONFIG_I2C_OWL) += i2c-owl.o - obj-$(CONFIG_I2C_PASEMI) += i2c-pasemi-core.o i2c-pasemi-pci.o - obj-$(CONFIG_I2C_APPLE) += i2c-pasemi-core.o i2c-pasemi-platform.o - obj-$(CONFIG_I2C_PCA_PLATFORM) += i2c-pca-platform.o -+obj-$(CONFIG_I2C_PHYTIUM_CORE) += i2c-phytium-core.o -+i2c-phytium-core-objs := i2c-phytium-common.o i2c-phytium-master.o i2c-phytium-slave.o -+obj-$(CONFIG_I2C_PHYTIUM_PCI) += i2c-phytium-pci.o -+obj-$(CONFIG_I2C_PHYTIUM_PLATFORM) += i2c-phytium-platform.o - obj-$(CONFIG_I2C_PNX) += i2c-pnx.o - obj-$(CONFIG_I2C_PXA) += i2c-pxa.o - obj-$(CONFIG_I2C_PXA_PCI) += i2c-pxa-pci.o -diff --git a/drivers/i2c/busses/i2c-designware-platdrv.c b/drivers/i2c/busses/i2c-designware-platdrv.c -index 855b698e9..6ab38151c 100644 ---- a/drivers/i2c/busses/i2c-designware-platdrv.c -+++ b/drivers/i2c/busses/i2c-designware-platdrv.c -@@ -57,6 +57,7 @@ static const struct acpi_device_id dw_i2c_acpi_match[] = { - { "HISI02A2", 0 }, - { "HISI02A3", 0 }, - { "HYGO0010", ACCESS_INTR_MASK }, -+ { "PHYT0003", 0 }, - { } - }; - MODULE_DEVICE_TABLE(acpi, dw_i2c_acpi_match); -diff --git a/drivers/i2c/busses/i2c-phytium-common.c b/drivers/i2c/busses/i2c-phytium-common.c -new file mode 100644 -index 000000000..2c866fa8e ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-common.c -@@ -0,0 +1,206 @@ -+// SPDX-License-Identifier: GPL-2.0-or-later -+/* -+ * Phytium I2C adapter driver. -+ * -+ * Derived from Synopysys I2C driver. -+ * Copyright (C) 2006 Texas Instruments. -+ * Copyright (C) 2007 MontaVista Software Inc. -+ * Copyright (C) 2009 Provigent Ltd. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "i2c-phytium-core.h" -+ -+static char *abort_sources[] = { -+ [ABRT_7B_ADDR_NOACK] = -+ "slave address not acknowledged (7bit mode)", -+ [ABRT_10ADDR1_NOACK] = -+ "first address byte not acknowledged (10bit mode)", -+ [ABRT_10ADDR2_NOACK] = -+ "second address byte not acknowledged (10bit mode)", -+ [ABRT_TXDATA_NOACK] = -+ "data not acknowledged", -+ [ABRT_GCALL_NOACK] = -+ "no acknowledgment for a general call", -+ [ABRT_GCALL_READ] = -+ "read after general call", -+ [ABRT_SBYTE_ACKDET] = -+ "start byte acknowledged", -+ [ABRT_SBYTE_NORSTRT] = -+ "trying to send start byte when restart is disabled", -+ [ABRT_10B_RD_NORSTRT] = -+ "trying to read when restart is disabled (10bit mode)", -+ [ABRT_MASTER_DIS] = -+ "trying to use disabled adapter", -+ [ARB_LOST] = -+ "lost arbitration", -+ [ABRT_SLAVE_FLUSH_TXFIFO] = -+ "read command so flush old data in the TX FIFO", -+ [ABRT_SLAVE_ARBLOST] = -+ "slave lost the bus while transmitting data to a remote master", -+ [ABRT_SLAVE_RD_INTX] = -+ "incorrect slave-transmitter mode configuration", -+}; -+ -+u32 phytium_readl(struct phytium_i2c_dev *dev, int offset) -+{ -+ return readl_relaxed(dev->base + offset); -+} -+ -+void phytium_writel(struct phytium_i2c_dev *dev, u32 b, int offset) -+{ -+ writel_relaxed(b, dev->base + offset); -+} -+ -+u32 i2c_phytium_scl_hcnt(u32 ic_clk, u32 tSYMBOL, u32 tf, int cond, int offset) -+{ -+ if (cond) -+ return (ic_clk * tSYMBOL + 500000) / 1000000 - 8 + offset; -+ else -+ return (ic_clk * (tSYMBOL + tf) + 500000) / 1000000 - 3 + offset; -+} -+ -+u32 i2c_phytium_scl_lcnt(u32 ic_clk, u32 tLOW, u32 tf, int offset) -+{ -+ return ((ic_clk * (tLOW + tf) + 500000) / 1000000) - 1 + offset; -+} -+ -+int i2c_phytium_set_sda_hold(struct phytium_i2c_dev *dev) -+{ -+ if (!dev->sda_hold_time) { -+ /* Keep previous hold time setting if no one set it */ -+ dev->sda_hold_time = phytium_readl(dev, IC_SDA_HOLD); -+ } -+ -+ if (!(dev->sda_hold_time & IC_SDA_HOLD_RX_MASK)) -+ dev->sda_hold_time |= 1 << IC_SDA_HOLD_RX_SHIFT; -+ -+ dev_dbg(dev->dev, "SDA Hold Time TX:RX = %d:%d\n", -+ dev->sda_hold_time & ~(u32)IC_SDA_HOLD_RX_MASK, -+ dev->sda_hold_time >> IC_SDA_HOLD_RX_SHIFT); -+ -+ return 0; -+} -+ -+void __i2c_phytium_disable(struct phytium_i2c_dev *dev) -+{ -+ int timeout = 100; -+ -+ do { -+ __i2c_phytium_disable_nowait(dev); -+ if ((phytium_readl(dev, IC_ENABLE_STATUS) & 1) == 0) -+ return; -+ -+ /* -+ * Wait 10 times the signaling period of the highest I2C -+ * transfer supported by the driver (for 400KHz this is -+ * 25us). -+ */ -+ usleep_range(25, 250); -+ } while (timeout--); -+ -+ dev_warn(dev->dev, "timeout in disabling adapter\n"); -+} -+ -+unsigned long i2c_phytium_clk_rate(struct phytium_i2c_dev *dev) -+{ -+ if (WARN_ON_ONCE(!dev->get_clk_rate_khz)) -+ return 0; -+ return dev->get_clk_rate_khz(dev); -+} -+ -+int i2c_phytium_prepare_clk(struct phytium_i2c_dev *dev, bool prepare) -+{ -+ if (IS_ERR(dev->clk)) -+ return PTR_ERR(dev->clk); -+ -+ if (prepare) -+ return clk_prepare_enable(dev->clk); -+ -+ clk_disable_unprepare(dev->clk); -+ return 0; -+} -+EXPORT_SYMBOL_GPL(i2c_phytium_prepare_clk); -+ -+int i2c_phytium_wait_bus_not_busy(struct phytium_i2c_dev *dev) -+{ -+ int timeout = 20; /* 20 ms */ -+ -+ while (phytium_readl(dev, IC_STATUS) & IC_STATUS_ACTIVITY) { -+ if (timeout <= 0) { -+ dev_warn(dev->dev, "timeout waiting for bus ready\n"); -+ i2c_recover_bus(&dev->adapter); -+ -+ if (phytium_readl(dev, IC_STATUS) & IC_STATUS_ACTIVITY) -+ return -ETIMEDOUT; -+ return 0; -+ } -+ timeout--; -+ usleep_range(1000, 1100); -+ } -+ -+ return 0; -+} -+ -+int i2c_phytium_handle_tx_abort(struct phytium_i2c_dev *dev) -+{ -+ unsigned long abort_source = dev->abort_source; -+ int i; -+ -+ if (abort_source & IC_TX_ABRT_NOACK) { -+ for_each_set_bit(i, &abort_source, ARRAY_SIZE(abort_sources)) -+ dev_dbg(dev->dev, -+ "%s: %s\n", __func__, abort_sources[i]); -+ return -EREMOTEIO; -+ } -+ -+ for_each_set_bit(i, &abort_source, ARRAY_SIZE(abort_sources)) -+ dev_err(dev->dev, "%s: %s\n", __func__, abort_sources[i]); -+ -+ if (abort_source & IC_TX_ARB_LOST) -+ return -EAGAIN; -+ else if (abort_source & IC_TX_ABRT_GCALL_READ) -+ return -EINVAL; -+ else -+ return -EIO; -+ -+ return 0; -+} -+ -+u32 i2c_phytium_func(struct i2c_adapter *adapter) -+{ -+ struct phytium_i2c_dev *dev = i2c_get_adapdata(adapter); -+ -+ return dev->functionality; -+} -+ -+void i2c_phytium_disable(struct phytium_i2c_dev *dev) -+{ -+ /* Disable controller */ -+ __i2c_phytium_disable(dev); -+ -+ /* Disable all interrupts */ -+ phytium_writel(dev, 0, IC_INTR_MASK); -+ phytium_readl(dev, IC_CLR_INTR); -+} -+ -+void i2c_phytium_disable_int(struct phytium_i2c_dev *dev) -+{ -+ phytium_writel(dev, 0, IC_INTR_MASK); -+} -+ -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_DESCRIPTION("Phytium I2C bus adapter core"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/i2c/busses/i2c-phytium-core.h b/drivers/i2c/busses/i2c-phytium-core.h -new file mode 100644 -index 000000000..7423ccb1b ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-core.h -@@ -0,0 +1,259 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium I2C adapter driver. -+ * -+ * Derived from Synopysys I2C driver. -+ * Copyright (C) 2006 Texas Instruments. -+ * Copyright (C) 2007 MontaVista Software Inc. -+ * Copyright (C) 2009 Provigent Ltd. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+ -+#define IC_DEFAULT_FUNCTIONALITY (I2C_FUNC_I2C | \ -+ I2C_FUNC_SMBUS_BYTE | \ -+ I2C_FUNC_SMBUS_BYTE_DATA | \ -+ I2C_FUNC_SMBUS_WORD_DATA | \ -+ I2C_FUNC_SMBUS_BLOCK_DATA | \ -+ I2C_FUNC_SMBUS_I2C_BLOCK) -+ -+#define IC_CON_MASTER 0x1 -+#define IC_CON_SPEED_STD 0x2 -+#define IC_CON_SPEED_FAST 0x4 -+#define IC_CON_SPEED_HIGH 0x6 -+#define IC_CON_SPEED_MASK 0x6 -+#define IC_CON_10BITADDR_SLAVE 0x8 -+#define IC_CON_10BITADDR_MASTER 0x10 -+#define IC_CON_RESTART_EN 0x20 -+#define IC_CON_SLAVE_DISABLE 0x40 -+#define IC_CON_STOP_DET_IFADDRESSED 0x80 -+#define IC_CON_TX_EMPTY_CTRL 0x100 -+#define IC_CON_RX_FIFO_FULL_HLD_CTRL 0x200 -+ -+#define IC_CON 0x0 -+#define IC_TAR 0x4 -+#define IC_SAR 0x8 -+#define IC_DATA_CMD 0x10 -+#define IC_SS_SCL_HCNT 0x14 -+#define IC_SS_SCL_LCNT 0x18 -+#define IC_FS_SCL_HCNT 0x1c -+#define IC_FS_SCL_LCNT 0x20 -+#define IC_HS_SCL_HCNT 0x24 -+#define IC_HS_SCL_LCNT 0x28 -+#define IC_INTR_STAT 0x2c -+#define IC_INTR_MASK 0x30 -+#define IC_RAW_INTR_STAT 0x34 -+#define IC_RX_TL 0x38 -+#define IC_TX_TL 0x3c -+#define IC_CLR_INTR 0x40 -+#define IC_CLR_RX_UNDER 0x44 -+#define IC_CLR_RX_OVER 0x48 -+#define IC_CLR_TX_OVER 0x4c -+#define IC_CLR_RD_REQ 0x50 -+#define IC_CLR_TX_ABRT 0x54 -+#define IC_CLR_RX_DONE 0x58 -+#define IC_CLR_ACTIVITY 0x5c -+#define IC_CLR_STOP_DET 0x60 -+#define IC_CLR_START_DET 0x64 -+#define IC_CLR_GEN_CALL 0x68 -+#define IC_ENABLE 0x6c -+#define IC_STATUS 0x70 -+#define IC_TXFLR 0x74 -+#define IC_RXFLR 0x78 -+#define IC_SDA_HOLD 0x7c -+#define IC_TX_ABRT_SOURCE 0x80 -+#define IC_ENABLE_STATUS 0x9c -+#define IC_SMBCLK_LOW_MEXT 0xa8 -+#define IC_SMBCLK_LOW_TIMEOUT 0xac -+#define IC_SMBDAT_STUCK_TIMEOUT 0xb4 -+#define IC_CLR_SMBCLK_EXT_LOW_TIMEOUT 0xbc -+#define IC_CLR_SMBCLK_TMO_LOW_TIMEOUT 0xc0 -+#define IC_CLR_SMBDAT_LOW_TIMEOUT 0xc4 -+#define IC_CLR_SMBALERT_IN_N 0xd0 -+ -+#define IC_INTR_RX_UNDER 0x001 -+#define IC_INTR_RX_OVER 0x002 -+#define IC_INTR_RX_FULL 0x004 -+#define IC_INTR_TX_OVER 0x008 -+#define IC_INTR_TX_EMPTY 0x010 -+#define IC_INTR_RD_REQ 0x020 -+#define IC_INTR_TX_ABRT 0x040 -+#define IC_INTR_RX_DONE 0x080 -+#define IC_INTR_ACTIVITY 0x100 -+#define IC_INTR_STOP_DET 0x200 -+#define IC_INTR_START_DET 0x400 -+#define IC_INTR_GEN_CALL 0x800 -+#define IC_INTR_SMBCLK_EXT_LOW_TIMEOUT 0x1000 -+#define IC_INTR_SMBCLK_TMO_LOW_TIMEOUT 0x2000 -+#define IC_INTR_SMBSDA_LOW_TIMEOUT 0x4000 -+#define IC_INTR_SMBALERT_IN_N 0x20000 -+ -+#define IC_INTR_DEFAULT_MASK (IC_INTR_RX_FULL | \ -+ IC_INTR_TX_ABRT | \ -+ IC_INTR_STOP_DET) -+#define IC_INTR_MASTER_MASK (IC_INTR_DEFAULT_MASK | \ -+ IC_INTR_TX_EMPTY) -+#define IC_INTR_SLAVE_MASK (IC_INTR_DEFAULT_MASK | \ -+ IC_INTR_RX_DONE | \ -+ IC_INTR_RX_UNDER | \ -+ IC_INTR_RD_REQ) -+#define IC_INTR_SMBUS_MASK (IC_INTR_MASTER_MASK | \ -+ IC_INTR_SMBCLK_EXT_LOW_TIMEOUT | \ -+ IC_INTR_SMBCLK_TMO_LOW_TIMEOUT | \ -+ IC_INTR_SMBSDA_LOW_TIMEOUT) -+ -+#define IC_STATUS_ACTIVITY 0x1 -+#define IC_STATUS_TFE BIT(2) -+#define IC_STATUS_MASTER_ACTIVITY BIT(5) -+#define IC_STATUS_SLAVE_ACTIVITY BIT(6) -+ -+#define IC_SDA_HOLD_RX_SHIFT 16 -+#define IC_SDA_HOLD_RX_MASK GENMASK(23, IC_SDA_HOLD_RX_SHIFT) -+ -+#define IC_ERR_TX_ABRT 0x1 -+ -+#define IC_TAR_10BITADDR_MASTER BIT(12) -+ -+#define IC_COMP_PARAM_1_SPEED_MODE_HIGH (BIT(2) | BIT(3)) -+#define IC_COMP_PARAM_1_SPEED_MODE_MASK GENMASK(3, 2) -+ -+#define STATUS_IDLE 0x0 -+#define STATUS_WRITE_IN_PROGRESS 0x1 -+#define STATUS_READ_IN_PROGRESS 0x2 -+ -+/* -+ * operation modes -+ */ -+#define PHYTIUM_IC_MASTER 0 -+#define PHYTIUM_IC_SLAVE 1 -+ -+#define ABRT_7B_ADDR_NOACK 0 -+#define ABRT_10ADDR1_NOACK 1 -+#define ABRT_10ADDR2_NOACK 2 -+#define ABRT_TXDATA_NOACK 3 -+#define ABRT_GCALL_NOACK 4 -+#define ABRT_GCALL_READ 5 -+#define ABRT_SBYTE_ACKDET 7 -+#define ABRT_SBYTE_NORSTRT 9 -+#define ABRT_10B_RD_NORSTRT 10 -+#define ABRT_MASTER_DIS 11 -+#define ARB_LOST 12 -+#define ABRT_SLAVE_FLUSH_TXFIFO 13 -+#define ABRT_SLAVE_ARBLOST 14 -+#define ABRT_SLAVE_RD_INTX 15 -+ -+#define IC_TX_ABRT_7B_ADDR_NOACK (1UL << ABRT_7B_ADDR_NOACK) -+#define IC_TX_ABRT_10ADDR1_NOACK (1UL << ABRT_10ADDR1_NOACK) -+#define IC_TX_ABRT_10ADDR2_NOACK (1UL << ABRT_10ADDR2_NOACK) -+#define IC_TX_ABRT_TXDATA_NOACK (1UL << ABRT_TXDATA_NOACK) -+#define IC_TX_ABRT_GCALL_NOACK (1UL << ABRT_GCALL_NOACK) -+#define IC_TX_ABRT_GCALL_READ (1UL << ABRT_GCALL_READ) -+#define IC_TX_ABRT_SBYTE_ACKDET (1UL << ABRT_SBYTE_ACKDET) -+#define IC_TX_ABRT_SBYTE_NORSTRT (1UL << ABRT_SBYTE_NORSTRT) -+#define IC_TX_ABRT_10B_RD_NORSTRT (1UL << ABRT_10B_RD_NORSTRT) -+#define IC_TX_ABRT_MASTER_DIS (1UL << ABRT_MASTER_DIS) -+#define IC_TX_ARB_LOST (1UL << ARB_LOST) -+#define IC_RX_ABRT_SLAVE_RD_INTX (1UL << ABRT_SLAVE_RD_INTX) -+#define IC_RX_ABRT_SLAVE_ARBLOST (1UL << ABRT_SLAVE_ARBLOST) -+#define IC_RX_ABRT_SLAVE_FLUSH_TXFIFO (1UL << ABRT_SLAVE_FLUSH_TXFIFO) -+ -+#define IC_TX_ABRT_NOACK (IC_TX_ABRT_7B_ADDR_NOACK | \ -+ IC_TX_ABRT_10ADDR1_NOACK | \ -+ IC_TX_ABRT_10ADDR2_NOACK | \ -+ IC_TX_ABRT_TXDATA_NOACK | \ -+ IC_TX_ABRT_GCALL_NOACK) -+#define CONTROLLER_TYPE_IIC 0 -+#define CONTROLLER_TYPE_SMBUS 1 -+ -+struct phytium_i2c_dev { -+ struct device *dev; -+ void __iomem *base; -+ int irq; -+ u32 flags; -+ struct completion cmd_complete; -+ struct clk *clk; -+ struct reset_control *rst; -+ int mode; -+ struct i2c_client *slave; -+ u32 (*get_clk_rate_khz)(struct phytium_i2c_dev *dev); -+ -+ struct i2c_adapter adapter; -+ struct i2c_client *ara; -+ struct i2c_smbus_alert_setup alert_data; -+ -+ struct phytium_pci_i2c *controller; -+ -+ unsigned int status; -+ int cmd_err; -+ u32 abort_source; -+ -+ struct i2c_msg *msgs; -+ int msgs_num; -+ int msg_write_idx; -+ int msg_read_idx; -+ int msg_err; -+ u32 tx_buf_len; -+ u8 *tx_buf; -+ u32 rx_buf_len; -+ u8 *rx_buf; -+ -+ u32 master_cfg; -+ u32 slave_cfg; -+ u32 functionality; -+ unsigned int tx_fifo_depth; -+ unsigned int rx_fifo_depth; -+ int rx_outstanding; -+ -+ struct i2c_timings timings; -+ u32 sda_hold_time; -+ u16 ss_hcnt; -+ u16 ss_lcnt; -+ u16 fs_hcnt; -+ u16 fs_lcnt; -+ u16 fp_hcnt; -+ u16 fp_lcnt; -+ u16 hs_hcnt; -+ u16 hs_lcnt; -+ -+ bool pm_disabled; -+ void (*disable)(struct phytium_i2c_dev *dev); -+ void (*disable_int)(struct phytium_i2c_dev *dev); -+ int (*init)(struct phytium_i2c_dev *dev); -+}; -+ -+#define ACCESS_INTR_MASK 0x00000004 -+ -+#define DEFAULT_CLOCK_FREQUENCY 48000000 -+ -+u32 phytium_readl(struct phytium_i2c_dev *dev, int offset); -+void phytium_writel(struct phytium_i2c_dev *dev, u32 b, int offset); -+unsigned long i2c_phytium_clk_rate(struct phytium_i2c_dev *dev); -+int i2c_phytium_prepare_clk(struct phytium_i2c_dev *dev, bool prepare); -+int i2c_phytium_wait_bus_not_busy(struct phytium_i2c_dev *dev); -+int i2c_phytium_handle_tx_abort(struct phytium_i2c_dev *dev); -+u32 i2c_phytium_func(struct i2c_adapter *adap); -+void i2c_phytium_disable(struct phytium_i2c_dev *dev); -+void i2c_phytium_disable_int(struct phytium_i2c_dev *dev); -+int i2c_phytium_set_sda_hold(struct phytium_i2c_dev *dev); -+u32 i2c_phytium_scl_hcnt(u32 ic_clk, u32 tSYMBOL, u32 tf, int cond, int offset); -+u32 i2c_phytium_scl_lcnt(u32 ic_clk, u32 tLOW, u32 tf, int offset); -+ -+static inline void __i2c_phytium_enable(struct phytium_i2c_dev *dev) -+{ -+ phytium_writel(dev, 1, IC_ENABLE); -+} -+ -+static inline void __i2c_phytium_disable_nowait(struct phytium_i2c_dev *dev) -+{ -+ phytium_writel(dev, 0, IC_ENABLE); -+} -+ -+void __i2c_phytium_disable(struct phytium_i2c_dev *dev); -+ -+extern int i2c_phytium_probe(struct phytium_i2c_dev *dev); -+ -+extern int i2c_phytium_probe_slave(struct phytium_i2c_dev *dev); -diff --git a/drivers/i2c/busses/i2c-phytium-master.c b/drivers/i2c/busses/i2c-phytium-master.c -new file mode 100644 -index 000000000..ca745b146 ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-master.c -@@ -0,0 +1,583 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium I2C adapter driver. -+ * -+ * Derived from Synopysys I2C driver. -+ * Copyright (C) 2006 Texas Instruments. -+ * Copyright (C) 2007 MontaVista Software Inc. -+ * Copyright (C) 2009 Provigent Ltd. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "i2c-phytium-core.h" -+ -+static int i2c_phytium_init_master(struct phytium_i2c_dev *dev) -+{ -+ /* Disable the adapter */ -+ __i2c_phytium_disable(dev); -+ -+ /* Write standard speed timing parameters */ -+ phytium_writel(dev, dev->ss_hcnt, IC_SS_SCL_HCNT); -+ phytium_writel(dev, dev->ss_lcnt, IC_SS_SCL_LCNT); -+ -+ /* Write fast mode/fast mode plus timing parameters */ -+ phytium_writel(dev, dev->fs_hcnt, IC_FS_SCL_HCNT); -+ phytium_writel(dev, dev->fs_lcnt, IC_FS_SCL_LCNT); -+ -+ /* Write high speed timing parameters if supported */ -+ if (dev->hs_hcnt && dev->hs_hcnt) { -+ phytium_writel(dev, dev->hs_hcnt, IC_HS_SCL_HCNT); -+ phytium_writel(dev, dev->hs_lcnt, IC_HS_SCL_LCNT); -+ } -+ -+ /* Write SDA hold time if supported */ -+ if (dev->sda_hold_time) -+ phytium_writel(dev, dev->sda_hold_time, IC_SDA_HOLD); -+ -+ /* Configure Tx/Rx FIFO threshold levels */ -+ phytium_writel(dev, dev->tx_fifo_depth >> 1, IC_TX_TL); -+ phytium_writel(dev, 0, IC_RX_TL); -+ -+ /* Configure the I2C master */ -+ phytium_writel(dev, dev->master_cfg, IC_CON); -+ -+ return 0; -+} -+ -+static void i2c_phytium_xfer_init(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_msg *msgs = dev->msgs; -+ u32 ic_con, ic_tar = 0; -+ -+ /* Disable the adapter */ -+ __i2c_phytium_disable(dev); -+ -+ /* If the slave address is 10-bit address, enable 10BITADDR */ -+ ic_con = phytium_readl(dev, IC_CON); -+ if (msgs[dev->msg_write_idx].flags & I2C_M_TEN) { -+ ic_con |= IC_CON_10BITADDR_MASTER; -+ ic_tar = IC_TAR_10BITADDR_MASTER; -+ } else { -+ ic_con &= ~IC_CON_10BITADDR_MASTER; -+ } -+ -+ phytium_writel(dev, ic_con, IC_CON); -+ -+ /* -+ * Set the slave (target) address and enable 10-bit addressing mode -+ * if applicable. -+ */ -+ phytium_writel(dev, msgs[dev->msg_write_idx].addr | ic_tar, IC_TAR); -+ -+ /* Enforce disabled interrupts */ -+ i2c_phytium_disable_int(dev); -+ -+ /* Enable the adapter */ -+ __i2c_phytium_enable(dev); -+ -+ /* Dummy read */ -+ phytium_readl(dev, IC_ENABLE_STATUS); -+ -+ /* Clear and enable interrupts */ -+ phytium_readl(dev, IC_CLR_INTR); -+ phytium_writel(dev, IC_INTR_SMBUS_MASK, IC_INTR_MASK); -+} -+ -+static void i2c_phytium_xfer_msg(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_msg *msgs = dev->msgs; -+ u32 intr_mask; -+ int tx_limit, rx_limit; -+ u32 addr = msgs[dev->msg_write_idx].addr; -+ u32 buf_len = dev->tx_buf_len; -+ u8 *buf = dev->tx_buf; -+ bool need_restart = false; -+ -+ intr_mask = IC_INTR_MASTER_MASK; -+ -+ for (; dev->msg_write_idx < dev->msgs_num; dev->msg_write_idx++) { -+ u32 flags = msgs[dev->msg_write_idx].flags; -+ -+ if (msgs[dev->msg_write_idx].addr != addr) { -+ dev_err(dev->dev, -+ "%s: invalid target address\n", __func__); -+ dev->msg_err = -EINVAL; -+ break; -+ } -+ -+ if (!(dev->status & STATUS_WRITE_IN_PROGRESS)) { -+ /* new i2c_msg */ -+ buf = msgs[dev->msg_write_idx].buf; -+ buf_len = msgs[dev->msg_write_idx].len; -+ -+ if ((dev->master_cfg & IC_CON_RESTART_EN) && -+ (dev->msg_write_idx > 0)) -+ need_restart = true; -+ } -+ -+ tx_limit = dev->tx_fifo_depth - phytium_readl(dev, IC_TXFLR); -+ rx_limit = dev->tx_fifo_depth - phytium_readl(dev, IC_RXFLR); -+ -+ while (buf_len > 0 && tx_limit > 0 && rx_limit > 0) { -+ u32 cmd = 0; -+ -+ if (dev->msg_write_idx == dev->msgs_num - 1 && -+ buf_len == 1 && !(flags & I2C_M_RECV_LEN)) -+ cmd |= BIT(9); -+ -+ if (need_restart) { -+ cmd |= BIT(10); -+ need_restart = false; -+ } -+ -+ if (msgs[dev->msg_write_idx].flags & I2C_M_RD) { -+ /* avoid rx buffer overrun */ -+ if (dev->rx_outstanding >= dev->rx_fifo_depth) -+ break; -+ -+ phytium_writel(dev, cmd | 0x100, IC_DATA_CMD); -+ rx_limit--; -+ dev->rx_outstanding++; -+ } else { -+ phytium_writel(dev, cmd | *buf++, IC_DATA_CMD); -+ } -+ tx_limit--; -+ buf_len--; -+ } -+ -+ dev->tx_buf = buf; -+ dev->tx_buf_len = buf_len; -+ -+ /* -+ * Because we don't know the buffer length in the -+ * I2C_FUNC_SMBUS_BLOCK_DATA case, we can't stop -+ * the transaction here. -+ */ -+ if (buf_len > 0 || flags & I2C_M_RECV_LEN) { -+ /* more bytes to be written */ -+ dev->status |= STATUS_WRITE_IN_PROGRESS; -+ break; -+ } -+ -+ dev->status &= ~STATUS_WRITE_IN_PROGRESS; -+ } -+ -+ if (dev->msg_write_idx == dev->msgs_num) -+ intr_mask &= ~IC_INTR_TX_EMPTY; -+ -+ if (dev->msg_err) -+ intr_mask = 0; -+ -+ phytium_writel(dev, intr_mask, IC_INTR_MASK); -+} -+ -+static u8 i2c_phytium_recv_len(struct phytium_i2c_dev *dev, u8 len) -+{ -+ struct i2c_msg *msgs = dev->msgs; -+ u32 flags = msgs[dev->msg_read_idx].flags; -+ -+ /* -+ * Adjust the buffer length and mask the flag -+ * after receiving the first byte. -+ */ -+ len += (flags & I2C_CLIENT_PEC) ? 2 : 1; -+ dev->tx_buf_len = len - min_t(u8, len, dev->rx_outstanding); -+ msgs[dev->msg_read_idx].len = len; -+ msgs[dev->msg_read_idx].flags &= ~I2C_M_RECV_LEN; -+ -+ return len; -+} -+ -+static void i2c_phytium_read(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_msg *msgs = dev->msgs; -+ int rx_valid; -+ -+ for (; dev->msg_read_idx < dev->msgs_num; dev->msg_read_idx++) { -+ u32 len; -+ u8 *buf; -+ -+ if (!(msgs[dev->msg_read_idx].flags & I2C_M_RD)) -+ continue; -+ -+ if (!(dev->status & STATUS_READ_IN_PROGRESS)) { -+ len = msgs[dev->msg_read_idx].len; -+ buf = msgs[dev->msg_read_idx].buf; -+ } else { -+ len = dev->rx_buf_len; -+ buf = dev->rx_buf; -+ } -+ -+ rx_valid = phytium_readl(dev, IC_RXFLR); -+ -+ for (; len > 0 && rx_valid > 0; len--, rx_valid--) { -+ u32 flags = msgs[dev->msg_read_idx].flags; -+ -+ *buf = phytium_readl(dev, IC_DATA_CMD); -+ /* Ensure length byte is a valid value */ -+ if (flags & I2C_M_RECV_LEN && -+ *buf <= I2C_SMBUS_BLOCK_MAX && *buf > 0) { -+ len = i2c_phytium_recv_len(dev, *buf); -+ } -+ buf++; -+ dev->rx_outstanding--; -+ } -+ -+ if (len > 0) { -+ dev->status |= STATUS_READ_IN_PROGRESS; -+ dev->rx_buf_len = len; -+ dev->rx_buf = buf; -+ return; -+ } -+ -+ dev->status &= ~STATUS_READ_IN_PROGRESS; -+ } -+} -+ -+static int i2c_phytium_xfer(struct i2c_adapter *adapter, struct i2c_msg msgs[], int num) -+{ -+ struct phytium_i2c_dev *dev = i2c_get_adapdata(adapter); -+ int ret; -+ -+ dev_dbg(dev->dev, "%s: msgs: %d\n", __func__, num); -+ -+ pm_runtime_get_sync(dev->dev); -+ -+ reinit_completion(&dev->cmd_complete); -+ dev->msgs = msgs; -+ dev->msgs_num = num; -+ dev->cmd_err = 0; -+ dev->msg_write_idx = 0; -+ dev->msg_read_idx = 0; -+ dev->msg_err = 0; -+ dev->status = STATUS_IDLE; -+ dev->abort_source = 0; -+ dev->rx_outstanding = 0; -+ -+ ret = i2c_phytium_wait_bus_not_busy(dev); -+ if (ret < 0) -+ goto done; -+ -+ /* Start the transfers */ -+ i2c_phytium_xfer_init(dev); -+ -+ /* Wait for tx to complete */ -+ if (!wait_for_completion_timeout(&dev->cmd_complete, adapter->timeout)) { -+ dev_err(dev->dev, "controller timed out\n"); -+ i2c_recover_bus(&dev->adapter); -+ i2c_phytium_init_master(dev); -+ ret = -ETIMEDOUT; -+ goto done; -+ } -+ -+ __i2c_phytium_disable_nowait(dev); -+ -+ if (dev->msg_err) { -+ ret = dev->msg_err; -+ goto done; -+ } -+ -+ if (likely(!dev->cmd_err && !dev->status)) { -+ ret = num; -+ goto done; -+ } -+ -+ /* We have got an error */ -+ if (dev->cmd_err == IC_ERR_TX_ABRT) { -+ ret = i2c_phytium_handle_tx_abort(dev); -+ goto done; -+ } -+ -+ if (dev->status) -+ dev_err(dev->dev, "transfer terminated early.\n"); -+ -+ ret = -EIO; -+ -+done: -+ pm_runtime_mark_last_busy(dev->dev); -+ pm_runtime_put_autosuspend(dev->dev); -+ -+ return ret; -+} -+ -+static const struct i2c_algorithm i2c_phytium_algo = { -+ .master_xfer = i2c_phytium_xfer, -+ .functionality = i2c_phytium_func, -+}; -+ -+static const struct i2c_adapter_quirks i2c_phytium_quirks = { -+ .flags = I2C_AQ_NO_ZERO_LEN, -+}; -+ -+static u32 i2c_phytium_read_clear_intrbits(struct phytium_i2c_dev *dev) -+{ -+ u32 stat; -+ -+ stat = phytium_readl(dev, IC_INTR_STAT); -+ -+ if (stat & IC_INTR_RX_UNDER) -+ phytium_readl(dev, IC_CLR_RX_UNDER); -+ if (stat & IC_INTR_RX_OVER) -+ phytium_readl(dev, IC_CLR_RX_OVER); -+ if (stat & IC_INTR_TX_OVER) -+ phytium_readl(dev, IC_CLR_TX_OVER); -+ if (stat & IC_INTR_RD_REQ) -+ phytium_readl(dev, IC_CLR_RD_REQ); -+ if (stat & IC_INTR_TX_ABRT) { -+ dev->abort_source = phytium_readl(dev, IC_TX_ABRT_SOURCE); -+ phytium_readl(dev, IC_CLR_TX_ABRT); -+ } -+ if (stat & IC_INTR_RX_DONE) -+ phytium_readl(dev, IC_CLR_RX_DONE); -+ if (stat & IC_INTR_ACTIVITY) -+ phytium_readl(dev, IC_CLR_ACTIVITY); -+ if (stat & IC_INTR_STOP_DET) -+ phytium_readl(dev, IC_CLR_STOP_DET); -+ if (stat & IC_INTR_START_DET) -+ phytium_readl(dev, IC_CLR_START_DET); -+ if (stat & IC_INTR_GEN_CALL) -+ phytium_readl(dev, IC_CLR_GEN_CALL); -+ if (stat & IC_INTR_SMBCLK_EXT_LOW_TIMEOUT) -+ phytium_readl(dev, IC_CLR_SMBCLK_EXT_LOW_TIMEOUT); -+ if (stat & IC_INTR_SMBCLK_TMO_LOW_TIMEOUT) -+ phytium_readl(dev, IC_CLR_SMBCLK_TMO_LOW_TIMEOUT); -+ if (stat & IC_INTR_SMBSDA_LOW_TIMEOUT) -+ phytium_readl(dev, IC_CLR_SMBDAT_LOW_TIMEOUT); -+ if (stat & IC_INTR_SMBALERT_IN_N) -+ phytium_readl(dev, IC_CLR_SMBALERT_IN_N); -+ -+ return stat; -+} -+ -+static int i2c_phytium_irq_handler_master(struct phytium_i2c_dev *dev) -+{ -+ u32 stat; -+ -+ stat = i2c_phytium_read_clear_intrbits(dev); -+ -+ /* SMBus interrupt */ -+ if (stat & (IC_INTR_SMBCLK_EXT_LOW_TIMEOUT | IC_INTR_SMBCLK_TMO_LOW_TIMEOUT)) { -+ phytium_writel(dev, phytium_readl(dev, IC_ENABLE) & (~BIT(6)), -+ IC_ENABLE); -+ phytium_writel(dev, phytium_readl(dev, IC_ENABLE) | BIT(4), -+ IC_ENABLE); -+ goto abort; -+ } -+ -+ if (stat & IC_INTR_SMBSDA_LOW_TIMEOUT) { -+ phytium_writel(dev, phytium_readl(dev, IC_ENABLE) | BIT(6), -+ IC_ENABLE); -+ goto abort; -+ } -+ -+ if (stat & IC_INTR_SMBALERT_IN_N && dev->ara) -+ i2c_handle_smbus_alert(dev->ara); -+ -+ if (stat & IC_INTR_TX_ABRT) { -+ dev->cmd_err |= IC_ERR_TX_ABRT; -+ dev->status = STATUS_IDLE; -+ -+ /* Anytime TX_ABRT is set, the contents of the tx/rx -+ * buffers are flushed. Make sure to skip them. -+ */ -+ phytium_writel(dev, 0, IC_INTR_MASK); -+ goto abort; -+ } -+ -+ if (stat & IC_INTR_RX_FULL) -+ i2c_phytium_read(dev); -+ -+ if (stat & IC_INTR_TX_EMPTY) -+ i2c_phytium_xfer_msg(dev); -+ -+abort: -+ if ((stat & (IC_INTR_TX_ABRT | IC_INTR_STOP_DET)) || -+ dev->msg_err) -+ complete(&dev->cmd_complete); -+ else if (unlikely(dev->flags & ACCESS_INTR_MASK)) { -+ /* Workaround to trigger pending interrupt */ -+ stat = phytium_readl(dev, IC_INTR_MASK); -+ i2c_phytium_disable_int(dev); -+ phytium_writel(dev, stat, IC_INTR_MASK); -+ } -+ -+ return 0; -+} -+ -+static int i2c_phytium_set_timings_master(struct phytium_i2c_dev *dev) -+{ -+ const char *mode_str, *fp_str = ""; -+ u32 sda_falling_time, scl_falling_time; -+ struct i2c_timings *t = &dev->timings; -+ u32 ic_clk; -+ int ret; -+ -+ /* Set standard and fast speed dividers for high/low periods */ -+ sda_falling_time = t->sda_fall_ns ?: 300; /* ns */ -+ scl_falling_time = t->scl_fall_ns ?: 300; /* ns */ -+ -+ /* Calculate SCL timing parameters for standard mode if not set */ -+ if (!dev->ss_hcnt || !dev->ss_lcnt) { -+ ic_clk = i2c_phytium_clk_rate(dev); -+ dev->ss_hcnt = -+ i2c_phytium_scl_hcnt(ic_clk, -+ 4000, /* tHD;STA = tHIGH = 4.0 us */ -+ sda_falling_time, -+ 0, /* 0: DW default, 1: Ideal */ -+ 0); /* No offset */ -+ dev->ss_lcnt = -+ i2c_phytium_scl_lcnt(ic_clk, -+ 4700, /* tLOW = 4.7 us */ -+ scl_falling_time, -+ 0); /* No offset */ -+ } -+ dev_dbg(dev->dev, "Standard Mode HCNT:LCNT = %d:%d\n", -+ dev->ss_hcnt, dev->ss_lcnt); -+ /* -+ * Set SCL timing parameters for fast mode or fast mode plus. Only -+ * difference is the timing parameter values since the registers are -+ * the same. -+ */ -+ if (t->bus_freq_hz == 1000000) { -+ /* -+ * Check are fast mode plus parameters available and use -+ * fast mode if not. -+ */ -+ if (dev->fp_hcnt && dev->fp_lcnt) { -+ dev->fs_hcnt = dev->fp_hcnt; -+ dev->fs_lcnt = dev->fp_lcnt; -+ fp_str = " Plus"; -+ } -+ } -+ /* -+ * Calculate SCL timing parameters for fast mode if not set. They are -+ * needed also in high speed mode. -+ */ -+ if (!dev->fs_hcnt || !dev->fs_lcnt) { -+ ic_clk = i2c_phytium_clk_rate(dev); -+ dev->fs_hcnt = -+ i2c_phytium_scl_hcnt(ic_clk, -+ 600, /* tHD;STA = tHIGH = 0.6 us */ -+ sda_falling_time, -+ 0, /* 0: DW default, 1: Ideal */ -+ 0); /* No offset */ -+ dev->fs_lcnt = -+ i2c_phytium_scl_lcnt(ic_clk, -+ 1300, /* tLOW = 1.3 us */ -+ scl_falling_time, -+ 0); /* No offset */ -+ } -+ dev_dbg(dev->dev, "Fast Mode%s HCNT:LCNT = %d:%d\n", -+ fp_str, dev->fs_hcnt, dev->fs_lcnt); -+ -+ if (dev->hs_hcnt && dev->hs_lcnt) -+ dev_dbg(dev->dev, "High Speed Mode HCNT:LCNT = %d:%d\n", -+ dev->hs_hcnt, dev->hs_lcnt); -+ -+ ret = i2c_phytium_set_sda_hold(dev); -+ if (ret) -+ goto out; -+ -+ switch (dev->master_cfg & IC_CON_SPEED_MASK) { -+ case IC_CON_SPEED_STD: -+ mode_str = "Standard Mode"; -+ break; -+ case IC_CON_SPEED_HIGH: -+ mode_str = "High Speed Mode"; -+ break; -+ default: -+ mode_str = "Fast Mode"; -+ } -+ dev_dbg(dev->dev, "Bus speed: %s%s\n", mode_str, fp_str); -+ -+out: -+ return ret; -+} -+ -+static irqreturn_t i2c_phytium_isr(int this_irq, void *dev_id) -+{ -+ struct phytium_i2c_dev *dev = dev_id; -+ u32 stat, enabled; -+ -+ enabled = phytium_readl(dev, IC_ENABLE); -+ stat = phytium_readl(dev, IC_RAW_INTR_STAT); -+ if (!enabled || !(stat & ~IC_INTR_ACTIVITY)) -+ return IRQ_NONE; -+ -+ i2c_phytium_irq_handler_master(dev); -+ -+ return IRQ_HANDLED; -+} -+ -+int i2c_phytium_probe(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_adapter *adapter = &dev->adapter; -+ unsigned long irq_flags; -+ int ret; -+ -+ init_completion(&dev->cmd_complete); -+ -+ dev->init = i2c_phytium_init_master; -+ dev->disable = i2c_phytium_disable; -+ dev->disable_int = i2c_phytium_disable_int; -+ -+ ret = i2c_phytium_set_timings_master(dev); -+ if (ret) -+ return ret; -+ -+ ret = dev->init(dev); -+ if (ret) -+ return ret; -+ -+ /* XXX: should be initialized in firmware, remove it in future */ -+#define DEFAULT_TIMEOUT (DEFAULT_CLOCK_FREQUENCY / 1000 * 35) -+ phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBCLK_LOW_MEXT); -+ phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBCLK_LOW_TIMEOUT); -+ phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBDAT_STUCK_TIMEOUT); -+ -+ snprintf(adapter->name, sizeof(adapter->name), "Phytium I2C adapter"); -+ adapter->retries = 3; -+ adapter->algo = &i2c_phytium_algo; -+ adapter->quirks = &i2c_phytium_quirks; -+ adapter->dev.parent = dev->dev; -+ i2c_set_adapdata(adapter, dev); -+ -+ irq_flags = IRQF_SHARED | IRQF_COND_SUSPEND; -+ -+ i2c_phytium_disable_int(dev); -+ ret = devm_request_irq(dev->dev, dev->irq, i2c_phytium_isr, irq_flags, -+ dev_name(dev->dev), dev); -+ if (ret) { -+ dev_err(dev->dev, "failed to request irq %i: %d\n", dev->irq, ret); -+ return ret; -+ } -+ -+ /* -+ * Increment PM usage count during adapter registration in order to -+ * avoid possible spurious runtime suspend when adapter device is -+ * registered to the device core and immediate resume in case bus has -+ * registered I2C slaves that do I2C transfers in their probe. -+ */ -+ pm_runtime_get_noresume(dev->dev); -+ ret = i2c_add_numbered_adapter(adapter); -+ if (ret) -+ dev_err(dev->dev, "fail to add adapter: %d\n", ret); -+ pm_runtime_put_noidle(dev->dev); -+ -+ return ret; -+} -+EXPORT_SYMBOL_GPL(i2c_phytium_probe); -+ -+MODULE_DESCRIPTION("Phytium I2C bus master adapter"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/i2c/busses/i2c-phytium-pci.c b/drivers/i2c/busses/i2c-phytium-pci.c -new file mode 100644 -index 000000000..c63abddd0 ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-pci.c -@@ -0,0 +1,260 @@ -+// SPDX-License-Identifier: GPL-2.0-or-later -+/* -+ * PCI driver for Phytium I2C adapter. -+ * -+ * Derived from Synopysys I2C driver. -+ * Copyright (C) 2006 Texas Instruments. -+ * Copyright (C) 2007 MontaVista Software Inc. -+ * Copyright (C) 2009 Provigent Ltd. -+ * Copyright (C) 2011, 2015, 2016 Intel Corporation. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "i2c-phytium-core.h" -+ -+#define DRV_NAME "i2c-phytium-pci" -+ -+int i2c_msi_enable; -+module_param(i2c_msi_enable, int, 0644); -+MODULE_PARM_DESC(i2c_msi_enable, "Enable I2C msi interrupt (0-disabled; 1-enabled; default-0)"); -+ -+enum phytium_pci_ctl_id_t { -+ octopus_i2c, -+}; -+ -+struct scl_sda_cfg { -+ u32 ss_hcnt; -+ u32 fs_hcnt; -+ u32 ss_lcnt; -+ u32 fs_lcnt; -+ u32 sda_hold; -+}; -+ -+struct phytium_pci_i2c { -+ u32 bus_num; -+ u32 bus_cfg; -+ u32 tx_fifo_depth; -+ u32 rx_fifo_depth; -+ u32 clk_khz; -+ u32 functionality; -+ u32 flags; -+ struct scl_sda_cfg *scl_sda_cfg; -+ int (*setup)(struct pci_dev *pdev, struct phytium_pci_i2c *c); -+}; -+ -+/* Octopus HCNT/LCNT/SDA hold time */ -+static struct scl_sda_cfg octopus_config = { -+ .ss_hcnt = 0x190, -+ .ss_lcnt = 0x1d6, -+ .fs_hcnt = 0x3c, -+ .fs_lcnt = 0x82, -+ .sda_hold = 0x0, // XXX -+}; -+ -+static int octopus_setup(struct pci_dev *pdev, struct phytium_pci_i2c *c) -+{ -+ struct phytium_i2c_dev *i2c = pci_get_drvdata(pdev); -+ struct i2c_client *ara; -+ -+ if (pdev->device == 0xdc32) { -+ /* -+ * Since we have already register the adapter, the dev->irq -+ * must be valid. -+ */ -+ i2c->alert_data.irq = i2c->irq; -+ -+ ara = i2c_new_smbus_alert_device(&i2c->adapter, &i2c->alert_data); -+ if (IS_ERR(ara)) -+ return PTR_ERR(ara); -+ -+ i2c->ara = ara; -+ } -+ -+ return 0; -+} -+ -+static struct phytium_pci_i2c pci_ctrl_info[] = { -+ [octopus_i2c] = { -+ .bus_num = -1, -+ .bus_cfg = IC_CON_MASTER | IC_CON_SLAVE_DISABLE | -+ IC_CON_RESTART_EN | IC_CON_SPEED_FAST, -+ .tx_fifo_depth = 7, -+ .rx_fifo_depth = 7, -+ .functionality = I2C_FUNC_10BIT_ADDR, -+ .clk_khz = 48000000, -+ .scl_sda_cfg = &octopus_config, -+ .setup = octopus_setup, -+ }, -+}; -+ -+#ifdef CONFIG_PM -+static int i2c_phytium_pci_suspend(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_i2c_dev *i_dev = pci_get_drvdata(pdev); -+ -+ i_dev->disable(i_dev); -+ -+ return 0; -+} -+ -+static int i2c_phytium_pci_resume(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_i2c_dev *i_dev = pci_get_drvdata(pdev); -+ -+ return i_dev->init(i_dev); -+} -+#endif -+ -+static UNIVERSAL_DEV_PM_OPS(i2c_phytium_pm_ops, i2c_phytium_pci_suspend, -+ i2c_phytium_pci_resume, NULL); -+ -+static u32 i2c_phytium_get_clk_rate_khz(struct phytium_i2c_dev *dev) -+{ -+ return dev->controller->clk_khz; -+} -+ -+static int i2c_phytium_pci_probe(struct pci_dev *pdev, -+ const struct pci_device_id *id) -+{ -+ struct phytium_i2c_dev *dev; -+ struct i2c_adapter *adapter; -+ struct phytium_pci_i2c *controller; -+ struct scl_sda_cfg *cfg; -+ int ret; -+ -+ if (id->driver_data >= ARRAY_SIZE(pci_ctrl_info)) { -+ dev_err(&pdev->dev, "%s: invalid driver data %ld\n", __func__, -+ id->driver_data); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ controller = &pci_ctrl_info[id->driver_data]; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) { -+ dev_err(&pdev->dev, "Failed to enable I2C PCI device (%d)\n", ret); -+ goto out; -+ } -+ -+ ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); -+ if (ret) { -+ dev_err(&pdev->dev, "I/O memory remapping failed\n"); -+ goto out; -+ } -+ -+ dev = devm_kzalloc(&pdev->dev, sizeof(struct phytium_i2c_dev), GFP_KERNEL); -+ if (!dev) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ if (i2c_msi_enable) { -+ pci_set_master(pdev); -+ -+ ret = pci_enable_msi(pdev); -+ if (ret) { -+ dev_dbg(&pdev->dev, "Error enabling MSI. ret = %d\n", ret); -+ goto out; -+ } -+ } -+ -+ dev->controller = controller; -+ dev->get_clk_rate_khz = i2c_phytium_get_clk_rate_khz; -+ dev->base = pcim_iomap_table(pdev)[0]; -+ dev->dev = &pdev->dev; -+ dev->irq = pdev->irq; -+ dev->flags |= controller->flags; -+ -+ dev->functionality = controller->functionality | IC_DEFAULT_FUNCTIONALITY; -+ dev->master_cfg = controller->bus_cfg; -+ if (controller->scl_sda_cfg) { -+ cfg = controller->scl_sda_cfg; -+ dev->ss_hcnt = cfg->ss_hcnt; -+ dev->fs_hcnt = cfg->fs_hcnt; -+ dev->ss_lcnt = cfg->ss_lcnt; -+ dev->fs_lcnt = cfg->fs_lcnt; -+ dev->sda_hold_time = cfg->sda_hold; -+ } -+ -+ pci_set_drvdata(pdev, dev); -+ -+ dev->tx_fifo_depth = controller->tx_fifo_depth; -+ dev->rx_fifo_depth = controller->rx_fifo_depth; -+ -+ adapter = &dev->adapter; -+ adapter->owner = THIS_MODULE; -+ adapter->class = 0; -+ ACPI_COMPANION_SET(&adapter->dev, ACPI_COMPANION(&pdev->dev)); -+ adapter->nr = controller->bus_num; -+ -+ ret = i2c_phytium_probe(dev); -+ if (ret) -+ goto out; -+ -+ if (controller->setup) { -+ ret = controller->setup(pdev, controller); -+ if (ret) -+ goto out; -+ } -+ -+ pm_runtime_set_autosuspend_delay(&pdev->dev, 1000); -+ pm_runtime_use_autosuspend(&pdev->dev); -+ pm_runtime_put_autosuspend(&pdev->dev); -+ pm_runtime_allow(&pdev->dev); -+ -+out: -+ return ret; -+} -+ -+static void i2c_phytium_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_i2c_dev *dev = pci_get_drvdata(pdev); -+ -+ dev->disable(dev); -+ pm_runtime_forbid(&pdev->dev); -+ pm_runtime_get_noresume(&pdev->dev); -+ -+ i2c_del_adapter(&dev->adapter); -+} -+ -+static const struct pci_device_id i2_phytium_pci_ids[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc32), octopus_i2c }, -+ { PCI_VDEVICE(PHYTIUM, 0xdc30), octopus_i2c }, -+ { } -+}; -+MODULE_DEVICE_TABLE(pci, i2_phytium_pci_ids); -+ -+static struct pci_driver phytium_i2c_driver = { -+ .name = DRV_NAME, -+ .id_table = i2_phytium_pci_ids, -+ .probe = i2c_phytium_pci_probe, -+ .remove = i2c_phytium_pci_remove, -+ .driver = { -+ .pm = &i2c_phytium_pm_ops, -+ }, -+}; -+ -+module_pci_driver(phytium_i2c_driver); -+ -+MODULE_ALIAS("i2c-phytium-pci"); -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_DESCRIPTION("Phytium PCI I2C bus adapter"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/i2c/busses/i2c-phytium-platform.c b/drivers/i2c/busses/i2c-phytium-platform.c -new file mode 100644 -index 000000000..6f4de1557 ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-platform.c -@@ -0,0 +1,364 @@ -+// SPDX-License-Identifier: GPL-2.0-or-later -+/* -+ * Phytium I2C adapter driver. -+ * -+ * Derived from Synopysys I2C driver. -+ * Copyright (C) 2006 Texas Instruments. -+ * Copyright (C) 2007 MontaVista Software Inc. -+ * Copyright (C) 2009 Provigent Ltd. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "i2c-phytium-core.h" -+ -+#define DRV_NAME "i2c-phytium-platform" -+ -+static u32 i2c_phytium_get_clk_rate_khz(struct phytium_i2c_dev *dev) -+{ -+ return clk_get_rate(dev->clk)/1000; -+} -+ -+#ifdef CONFIG_ACPI -+static void phytium_i2c_acpi_params(struct platform_device *pdev, char method[], -+ u16 *hcnt, u16 *lcnt, u32 *sda_hold) -+{ -+ struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER }; -+ acpi_handle handle = ACPI_HANDLE(&pdev->dev); -+ union acpi_object *obj; -+ -+ if (ACPI_FAILURE(acpi_evaluate_object(handle, method, NULL, &buf))) -+ return; -+ -+ obj = (union acpi_object *)buf.pointer; -+ if (obj->type == ACPI_TYPE_PACKAGE && obj->package.count == 3) { -+ const union acpi_object *objs = obj->package.elements; -+ -+ *hcnt = (u16)objs[0].integer.value; -+ *lcnt = (u16)objs[1].integer.value; -+ *sda_hold = (u32)objs[2].integer.value; -+ } -+ -+ kfree(buf.pointer); -+} -+ -+static int phytium_i2c_acpi_configure(struct platform_device *pdev) -+{ -+ struct phytium_i2c_dev *dev = platform_get_drvdata(pdev); -+ struct i2c_timings *t = &dev->timings; -+ u32 ss_ht = 0, fp_ht = 0, hs_ht = 0, fs_ht = 0; -+ const struct acpi_device_id *id; -+ -+ dev->adapter.nr = -1; -+ dev->tx_fifo_depth = 32; -+ dev->rx_fifo_depth = 32; -+ -+ /* -+ * Try to get SDA hold time and *CNT values from an ACPI method for -+ * selected speed modes. -+ */ -+ phytium_i2c_acpi_params(pdev, "SSCN", &dev->ss_hcnt, &dev->ss_lcnt, &ss_ht); -+ phytium_i2c_acpi_params(pdev, "FPCN", &dev->fp_hcnt, &dev->fp_lcnt, &fp_ht); -+ phytium_i2c_acpi_params(pdev, "HSCN", &dev->hs_hcnt, &dev->hs_lcnt, &hs_ht); -+ phytium_i2c_acpi_params(pdev, "FMCN", &dev->fs_hcnt, &dev->fs_lcnt, &fs_ht); -+ -+ switch (t->bus_freq_hz) { -+ case 100000: -+ dev->sda_hold_time = ss_ht; -+ break; -+ case 1000000: -+ dev->sda_hold_time = fp_ht; -+ break; -+ case 3400000: -+ dev->sda_hold_time = hs_ht; -+ break; -+ case 400000: -+ default: -+ dev->sda_hold_time = fs_ht; -+ break; -+ } -+ -+ id = acpi_match_device(pdev->dev.driver->acpi_match_table, &pdev->dev); -+ if (id && id->driver_data) -+ dev->flags |= (u32)id->driver_data; -+ -+ return 0; -+} -+ -+static const struct acpi_device_id phytium_i2c_acpi_match[] = { -+ { "PHYT0038", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_i2c_acpi_match); -+#else -+static inline int phytium_i2c_acpi_configure(struct platform_device *pdev) -+{ -+ return -ENODEV; -+} -+#endif -+ -+static void i2c_phytium_configure_master(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_timings *t = &dev->timings; -+ -+ dev->functionality = I2C_FUNC_10BIT_ADDR | IC_DEFAULT_FUNCTIONALITY; -+ -+ dev->master_cfg = IC_CON_MASTER | IC_CON_SLAVE_DISABLE | -+ IC_CON_RESTART_EN; -+ -+ dev->mode = PHYTIUM_IC_MASTER; -+ -+ switch (t->bus_freq_hz) { -+ case 100000: -+ dev->master_cfg |= IC_CON_SPEED_STD; -+ break; -+ case 3400000: -+ dev->master_cfg |= IC_CON_SPEED_HIGH; -+ break; -+ default: -+ dev->master_cfg |= IC_CON_SPEED_FAST; -+ } -+} -+ -+static void i2c_phytium_configure_slave(struct phytium_i2c_dev *dev) -+{ -+ dev->functionality = I2C_FUNC_SLAVE | IC_DEFAULT_FUNCTIONALITY; -+ -+ dev->slave_cfg = IC_CON_RX_FIFO_FULL_HLD_CTRL | -+ IC_CON_RESTART_EN | IC_CON_STOP_DET_IFADDRESSED; -+ -+ dev->mode = PHYTIUM_IC_SLAVE; -+} -+ -+static int phytium_i2c_plat_probe(struct platform_device *pdev) -+{ -+ struct i2c_adapter *adap; -+ struct phytium_i2c_dev *dev; -+ struct i2c_timings *t; -+ u32 acpi_speed; -+ struct resource *mem; -+ int irq, ret, i; -+ static const int supported_speeds[] = { -+ 0, 100000, 400000, 1000000, 3400000 -+ }; -+ -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) -+ return irq; -+ -+ dev = devm_kzalloc(&pdev->dev, sizeof(struct phytium_i2c_dev), GFP_KERNEL); -+ if (!dev) -+ return -ENOMEM; -+ -+ mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ dev->base = devm_ioremap_resource(&pdev->dev, mem); -+ if (IS_ERR(dev->base)) -+ return PTR_ERR(dev->base); -+ -+ dev->dev = &pdev->dev; -+ dev->irq = irq; -+ platform_set_drvdata(pdev, dev); -+ -+ dev->rst = devm_reset_control_get_optional_exclusive(&pdev->dev, NULL); -+ if (IS_ERR(dev->rst)) { -+ if (PTR_ERR(dev->rst) == -EPROBE_DEFER) -+ return -EPROBE_DEFER; -+ } else { -+ reset_control_deassert(dev->rst); -+ } -+ -+ t = &dev->timings; -+ i2c_parse_fw_timings(&pdev->dev, t, false); -+ -+ acpi_speed = i2c_acpi_find_bus_speed(&pdev->dev); -+ /* -+ * Some DSTDs use a non standard speed, round down to the lowest -+ * standard speed. -+ */ -+ for (i = 1; i < ARRAY_SIZE(supported_speeds); i++) { -+ if (acpi_speed < supported_speeds[i]) -+ break; -+ } -+ acpi_speed = supported_speeds[i - 1]; -+ -+ /* -+ * Find bus speed from the "clock-frequency" device property, ACPI -+ * or by using fast mode if neither is set. -+ */ -+ if (acpi_speed && t->bus_freq_hz) -+ t->bus_freq_hz = min(t->bus_freq_hz, acpi_speed); -+ else if (acpi_speed || t->bus_freq_hz) -+ t->bus_freq_hz = max(t->bus_freq_hz, acpi_speed); -+ else -+ t->bus_freq_hz = 400000; -+ -+ if (has_acpi_companion(&pdev->dev)) -+ phytium_i2c_acpi_configure(pdev); -+ -+ /* -+ * Only standard mode at 100kHz, fast mode at 400kHz, -+ * fast mode plus at 1MHz and high speed mode at 3.4MHz are supported. -+ */ -+ if (t->bus_freq_hz != 100000 && t->bus_freq_hz != 400000 && -+ t->bus_freq_hz != 1000000 && t->bus_freq_hz != 3400000) { -+ dev_err(&pdev->dev, -+ "%d Hz is unsupported, only 100kHz, 400kHz, 1MHz and 3.4MHz are supported\n", -+ t->bus_freq_hz); -+ ret = -EINVAL; -+ goto exit_reset; -+ } -+ -+ if (i2c_detect_slave_mode(&pdev->dev)) -+ i2c_phytium_configure_slave(dev); -+ else -+ i2c_phytium_configure_master(dev); -+ -+ dev->clk = devm_clk_get(&pdev->dev, NULL); -+ if (!i2c_phytium_prepare_clk(dev, true)) { -+ u64 clk_khz; -+ -+ dev->get_clk_rate_khz = i2c_phytium_get_clk_rate_khz; -+ clk_khz = dev->get_clk_rate_khz(dev); -+ -+ if (!dev->sda_hold_time && t->sda_hold_ns) -+ dev->sda_hold_time = -+ div_u64(clk_khz * t->sda_hold_ns + 500000, 1000000); -+ } -+ -+ dev->tx_fifo_depth = 7; -+ dev->rx_fifo_depth = 7; -+ dev->adapter.nr = pdev->id; -+ -+ adap = &dev->adapter; -+ adap->owner = THIS_MODULE; -+ adap->class = I2C_CLASS_DEPRECATED; -+ ACPI_COMPANION_SET(&adap->dev, ACPI_COMPANION(&pdev->dev)); -+ adap->dev.of_node = pdev->dev.of_node; -+ -+ dev_pm_set_driver_flags(&pdev->dev, -+ DPM_FLAG_SMART_PREPARE | -+ DPM_FLAG_SMART_SUSPEND | -+ DPM_FLAG_MAY_SKIP_RESUME); -+ -+ /* The code below assumes runtime PM to be disabled. */ -+ WARN_ON(pm_runtime_enabled(&pdev->dev)); -+ -+ pm_runtime_set_autosuspend_delay(&pdev->dev, 1000); -+ pm_runtime_use_autosuspend(&pdev->dev); -+ pm_runtime_set_active(&pdev->dev); -+ -+ pm_runtime_enable(&pdev->dev); -+ -+ if (dev->mode == PHYTIUM_IC_SLAVE) -+ ret = i2c_phytium_probe_slave(dev); -+ else -+ ret = i2c_phytium_probe(dev); -+ -+ if (ret) -+ goto exit_probe; -+ -+ return ret; -+ -+exit_probe: -+ pm_runtime_disable(dev->dev); -+exit_reset: -+ if (!IS_ERR_OR_NULL(dev->rst)) -+ reset_control_assert(dev->rst); -+ return ret; -+} -+ -+static int phytium_i2c_plat_remove(struct platform_device *pdev) -+{ -+ struct phytium_i2c_dev *dev = platform_get_drvdata(pdev); -+ -+ pm_runtime_get_sync(&pdev->dev); -+ -+ i2c_del_adapter(&dev->adapter); -+ -+ dev->disable(dev); -+ -+ pm_runtime_dont_use_autosuspend(&pdev->dev); -+ pm_runtime_put_sync(&pdev->dev); -+ pm_runtime_disable(dev->dev); -+ -+ if (!IS_ERR_OR_NULL(dev->rst)) -+ reset_control_assert(dev->rst); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_OF -+static const struct of_device_id phytium_i2c_of_match[] = { -+ { .compatible = "phytium,i2c", }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, phytium_i2c_of_match); -+#endif -+ -+static int __maybe_unused phytium_i2c_plat_suspend(struct device *dev) -+{ -+ struct phytium_i2c_dev *idev = dev_get_drvdata(dev); -+ -+ idev->disable(idev); -+ i2c_phytium_prepare_clk(idev, false); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_i2c_plat_resume(struct device *dev) -+{ -+ struct phytium_i2c_dev *idev = dev_get_drvdata(dev); -+ -+ i2c_phytium_prepare_clk(idev, true); -+ -+ idev->init(idev); -+ -+ return 0; -+} -+ -+static const struct dev_pm_ops phytium_i2c_dev_pm_ops = { -+ SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_i2c_plat_suspend, -+ phytium_i2c_plat_resume) -+ SET_RUNTIME_PM_OPS(phytium_i2c_plat_suspend, -+ phytium_i2c_plat_resume, NULL) -+}; -+ -+static struct platform_driver phytium_i2c_driver = { -+ .probe = phytium_i2c_plat_probe, -+ .remove = phytium_i2c_plat_remove, -+ .driver = { -+ .name = DRV_NAME, -+ .of_match_table = of_match_ptr(phytium_i2c_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_i2c_acpi_match), -+ .pm = &phytium_i2c_dev_pm_ops, -+ }, -+}; -+module_platform_driver(phytium_i2c_driver); -+ -+MODULE_ALIAS("platform:i2c-phytium"); -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium I2C bus adapter"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/i2c/busses/i2c-phytium-slave.c b/drivers/i2c/busses/i2c-phytium-slave.c -new file mode 100644 -index 000000000..2f0076561 ---- /dev/null -+++ b/drivers/i2c/busses/i2c-phytium-slave.c -@@ -0,0 +1,265 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium I2C adapter driver (slave only). -+ * -+ * Derived from Synopysys I2C driver. -+ * Copyright (C) 2016 Synopsys Inc. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "i2c-phytium-core.h" -+ -+static void i2c_phytium_configure_fifo_slave(struct phytium_i2c_dev *dev) -+{ -+ /* Configure Tx/Rx FIFO threshold levels. */ -+ phytium_writel(dev, 0, IC_TX_TL); -+ phytium_writel(dev, 0, IC_RX_TL); -+ -+ /* Configure the I2C slave. */ -+ phytium_writel(dev, dev->slave_cfg, IC_CON); -+ phytium_writel(dev, IC_INTR_SLAVE_MASK, IC_INTR_MASK); -+} -+ -+static int i2c_phytium_init_slave(struct phytium_i2c_dev *dev) -+{ -+ /* Disable the adapter. */ -+ __i2c_phytium_disable(dev); -+ -+ /* Write SDA hold time if supported */ -+ if (dev->sda_hold_time) -+ phytium_writel(dev, dev->sda_hold_time, IC_SDA_HOLD); -+ -+ i2c_phytium_configure_fifo_slave(dev); -+ -+ return 0; -+} -+ -+static int i2c_phytium_reg_slave(struct i2c_client *slave) -+{ -+ struct phytium_i2c_dev *dev = i2c_get_adapdata(slave->adapter); -+ -+ if (dev->slave) -+ return -EBUSY; -+ if (slave->flags & I2C_CLIENT_TEN) -+ return -EAFNOSUPPORT; -+ pm_runtime_get_sync(dev->dev); -+ -+ /* -+ * Set slave address in the IC_SAR register, -+ * the address to which the i2c responds. -+ */ -+ __i2c_phytium_disable_nowait(dev); -+ phytium_writel(dev, slave->addr, IC_SAR); -+ dev->slave = slave; -+ -+ __i2c_phytium_enable(dev); -+ -+ dev->cmd_err = 0; -+ dev->msg_write_idx = 0; -+ dev->msg_read_idx = 0; -+ dev->msg_err = 0; -+ dev->status = STATUS_IDLE; -+ dev->abort_source = 0; -+ dev->rx_outstanding = 0; -+ -+ return 0; -+} -+ -+static int i2c_phytium_unreg_slave(struct i2c_client *slave) -+{ -+ struct phytium_i2c_dev *dev = i2c_get_adapdata(slave->adapter); -+ -+ dev->disable_int(dev); -+ dev->disable(dev); -+ dev->slave = NULL; -+ pm_runtime_put(dev->dev); -+ -+ return 0; -+} -+ -+static u32 i2c_phytium_read_clear_intrbits_slave(struct phytium_i2c_dev *dev) -+{ -+ u32 stat; -+ -+ /* -+ * The IC_INTR_STAT register just indicates "enabled" interrupts. -+ * Ths unmasked raw version of interrupt status bits are available -+ * in the IC_RAW_INTR_STAT register. -+ * -+ * That is, -+ * stat = phytium_readl(IC_INTR_STAT); -+ * equals to, -+ * stat = phytium_readl(IC_RAW_INTR_STAT) & phytium_readl(IC_INTR_MASK); -+ * -+ * The raw version might be useful for debugging purposes. -+ */ -+ stat = phytium_readl(dev, IC_INTR_STAT); -+ -+ /* -+ * Do not use the IC_CLR_INTR register to clear interrupts, or -+ * you'll miss some interrupts, triggered during the period from -+ * phytium_readl(IC_INTR_STAT) to phytium_readl(IC_CLR_INTR). -+ * -+ * Instead, use the separately-prepared IC_CLR_* registers. -+ */ -+ if (stat & IC_INTR_TX_ABRT) -+ phytium_readl(dev, IC_CLR_TX_ABRT); -+ if (stat & IC_INTR_RX_UNDER) -+ phytium_readl(dev, IC_CLR_RX_UNDER); -+ if (stat & IC_INTR_RX_OVER) -+ phytium_readl(dev, IC_CLR_RX_OVER); -+ if (stat & IC_INTR_TX_OVER) -+ phytium_readl(dev, IC_CLR_TX_OVER); -+ if (stat & IC_INTR_RX_DONE) -+ phytium_readl(dev, IC_CLR_RX_DONE); -+ if (stat & IC_INTR_ACTIVITY) -+ phytium_readl(dev, IC_CLR_ACTIVITY); -+ if (stat & IC_INTR_STOP_DET) -+ phytium_readl(dev, IC_CLR_STOP_DET); -+ if (stat & IC_INTR_START_DET) -+ phytium_readl(dev, IC_CLR_START_DET); -+ if (stat & IC_INTR_GEN_CALL) -+ phytium_readl(dev, IC_CLR_GEN_CALL); -+ -+ return stat; -+} -+ -+/* -+ * Interrupt service routine. This gets called whenever an I2C slave interrupt -+ * occurs. -+ */ -+static int i2c_phytium_irq_handler_slave(struct phytium_i2c_dev *dev) -+{ -+ u32 raw_stat, stat, enabled; -+ u8 val, slave_activity; -+ -+ stat = phytium_readl(dev, IC_INTR_STAT); -+ enabled = phytium_readl(dev, IC_ENABLE); -+ raw_stat = phytium_readl(dev, IC_RAW_INTR_STAT); -+ slave_activity = ((phytium_readl(dev, IC_STATUS) & -+ IC_STATUS_SLAVE_ACTIVITY) >> 6); -+ -+ if (!enabled || !(raw_stat & ~IC_INTR_ACTIVITY) || !dev->slave) -+ return 0; -+ -+ dev_dbg(dev->dev, -+ "%#x STATUS SLAVE_ACTIVITY=%#x : RAW_INTR_STAT=%#x : INTR_STAT=%#x\n", -+ enabled, slave_activity, raw_stat, stat); -+ -+ if ((stat & IC_INTR_RX_FULL) && (stat & IC_INTR_STOP_DET)) -+ i2c_slave_event(dev->slave, I2C_SLAVE_WRITE_REQUESTED, &val); -+ -+ if (stat & IC_INTR_RD_REQ) { -+ if (slave_activity) { -+ if (stat & IC_INTR_RX_FULL) { -+ val = phytium_readl(dev, IC_DATA_CMD); -+ -+ if (!i2c_slave_event(dev->slave, -+ I2C_SLAVE_WRITE_RECEIVED, -+ &val)) { -+ dev_vdbg(dev->dev, "Byte %X acked!", -+ val); -+ } -+ phytium_readl(dev, IC_CLR_RD_REQ); -+ stat = i2c_phytium_read_clear_intrbits_slave(dev); -+ } else { -+ phytium_readl(dev, IC_CLR_RD_REQ); -+ phytium_readl(dev, IC_CLR_RX_UNDER); -+ stat = i2c_phytium_read_clear_intrbits_slave(dev); -+ } -+ if (!i2c_slave_event(dev->slave, -+ I2C_SLAVE_READ_REQUESTED, -+ &val)) -+ phytium_writel(dev, val, IC_DATA_CMD); -+ } -+ } -+ -+ if (stat & IC_INTR_RX_DONE) { -+ if (!i2c_slave_event(dev->slave, I2C_SLAVE_READ_PROCESSED, -+ &val)) -+ phytium_readl(dev, IC_CLR_RX_DONE); -+ -+ i2c_slave_event(dev->slave, I2C_SLAVE_STOP, &val); -+ stat = i2c_phytium_read_clear_intrbits_slave(dev); -+ return 1; -+ } -+ -+ if (stat & IC_INTR_RX_FULL) { -+ val = phytium_readl(dev, IC_DATA_CMD); -+ if (!i2c_slave_event(dev->slave, I2C_SLAVE_WRITE_RECEIVED, -+ &val)) -+ dev_vdbg(dev->dev, "Byte %X acked!", val); -+ } else { -+ i2c_slave_event(dev->slave, I2C_SLAVE_STOP, &val); -+ stat = i2c_phytium_read_clear_intrbits_slave(dev); -+ } -+ -+ return 1; -+} -+ -+static irqreturn_t i2c_phytium_isr_slave(int this_irq, void *dev_id) -+{ -+ struct phytium_i2c_dev *dev = dev_id; -+ int ret; -+ -+ i2c_phytium_read_clear_intrbits_slave(dev); -+ ret = i2c_phytium_irq_handler_slave(dev); -+ if (ret > 0) -+ complete(&dev->cmd_complete); -+ -+ return IRQ_RETVAL(ret); -+} -+ -+static const struct i2c_algorithm i2c_phytium_algo = { -+ .functionality = i2c_phytium_func, -+ .reg_slave = i2c_phytium_reg_slave, -+ .unreg_slave = i2c_phytium_unreg_slave, -+}; -+ -+int i2c_phytium_probe_slave(struct phytium_i2c_dev *dev) -+{ -+ struct i2c_adapter *adap = &dev->adapter; -+ int ret; -+ -+ init_completion(&dev->cmd_complete); -+ -+ dev->init = i2c_phytium_init_slave; -+ dev->disable = i2c_phytium_disable; -+ dev->disable_int = i2c_phytium_disable_int; -+ -+ ret = dev->init(dev); -+ if (ret) -+ return ret; -+ -+ snprintf(adap->name, sizeof(adap->name), -+ "Synopsys DesignWare I2C Slave adapter"); -+ adap->retries = 3; -+ adap->algo = &i2c_phytium_algo; -+ adap->dev.parent = dev->dev; -+ i2c_set_adapdata(adap, dev); -+ -+ ret = devm_request_irq(dev->dev, dev->irq, i2c_phytium_isr_slave, -+ IRQF_SHARED, dev_name(dev->dev), dev); -+ if (ret) { -+ dev_err(dev->dev, "failure requesting irq %i: %d\n", -+ dev->irq, ret); -+ return ret; -+ } -+ -+ ret = i2c_add_numbered_adapter(adap); -+ if (ret) -+ dev_err(dev->dev, "failure adding adapter: %d\n", ret); -+ -+ return ret; -+} -+EXPORT_SYMBOL_GPL(i2c_phytium_probe_slave); -diff --git a/drivers/i3c/Makefile b/drivers/i3c/Makefile -index 11982efbc..02d9b450f 100644 ---- a/drivers/i3c/Makefile -+++ b/drivers/i3c/Makefile -@@ -1,4 +1,5 @@ - # SPDX-License-Identifier: GPL-2.0 - i3c-y := device.o master.o - obj-$(CONFIG_I3C) += i3c.o -+i3c-$(CONFIG_ACPI) += i3c_master_acpi.o - obj-$(CONFIG_I3C) += master/ -diff --git a/drivers/i3c/i3c_master_acpi.c b/drivers/i3c/i3c_master_acpi.c -new file mode 100644 -index 000000000..9346d882a ---- /dev/null -+++ b/drivers/i3c/i3c_master_acpi.c -@@ -0,0 +1,95 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Driver for I3C ACPI Interface -+ * -+ * Copyright (C) 2021-2023 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include "i3c_master_acpi.h" -+ -+static int i3c_master_acpi_parse_val(union acpi_object *store_elements, char *method, -+ int count, u32 *value) -+{ -+ int i, package_count, ret = -1; -+ union acpi_object *acpi_elements; -+ -+ for (i = 0; i < count; i++) { -+ acpi_elements = store_elements; -+ if (acpi_elements[i].type == ACPI_TYPE_PACKAGE) { -+ package_count = acpi_elements[i].package.count; -+ -+ if (package_count == 2) { -+ acpi_elements = acpi_elements[i].package.elements; -+ if (acpi_elements[0].type == ACPI_TYPE_STRING) { -+ if (!strcmp(acpi_elements[0].string.pointer, method)) { -+ *value = acpi_elements[1].integer.value; -+ ret = 0; -+ break; -+ } -+ } -+ } -+ } -+ } -+ return ret; -+} -+ -+int i3c_master_acpi_get_params(acpi_handle handle, char *method, u32 *value) -+{ -+ struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER }; -+ acpi_status status = 0; -+ union acpi_object *obj; -+ int count, ret = -1; -+ -+ status = acpi_evaluate_object(handle, "_DSD", NULL, &buf); -+ if (ACPI_FAILURE(status)) { -+ kfree(buf.pointer); -+ return -2; -+ } -+ -+ obj = (union acpi_object *)buf.pointer; -+ -+ if (obj->type == ACPI_TYPE_PACKAGE) { -+ union acpi_object *acpi_elements; -+ union acpi_object *store_elements; -+ -+ acpi_elements = obj->package.elements; -+ if ((obj->package.count >= 2) && (acpi_elements[1].type == ACPI_TYPE_PACKAGE)) { -+ count = acpi_elements[1].package.count; -+ acpi_elements = acpi_elements[1].package.elements; -+ -+ store_elements = acpi_elements; -+ ret = i3c_master_acpi_parse_val(store_elements, method, count, value); -+ } -+ } -+ -+ kfree(buf.pointer); -+ return ret; -+} -+EXPORT_SYMBOL_GPL(i3c_master_acpi_get_params); -+ -+void i3c_master_acpi_clk_params(acpi_handle handle, char *method, -+ u32 *pres_ctrl0, u32 *pres_ctrl1, u32 *thd_delay) -+{ -+ struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER }; -+ union acpi_object *obj; -+ -+ if (ACPI_FAILURE(acpi_evaluate_object(handle, method, NULL, &buf))) -+ return; -+ -+ obj = (union acpi_object *)buf.pointer; -+ if (obj->type == ACPI_TYPE_PACKAGE && obj->package.count == 3) { -+ const union acpi_object *objs = obj->package.elements; -+ -+ *pres_ctrl0 = (u32)objs[0].integer.value; -+ *pres_ctrl1 = (u32)objs[1].integer.value; -+ *thd_delay = (u32)objs[2].integer.value; -+ } -+ -+ kfree(buf.pointer); -+} -+EXPORT_SYMBOL_GPL(i3c_master_acpi_clk_params); -diff --git a/drivers/i3c/i3c_master_acpi.h b/drivers/i3c/i3c_master_acpi.h -new file mode 100644 -index 000000000..61fa62ff1 ---- /dev/null -+++ b/drivers/i3c/i3c_master_acpi.h -@@ -0,0 +1,18 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Driver for I3C ACPI Interface -+ * -+ * Copyright (C) 2021-2023 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __I3C_MASTER_ACPI_H -+#define __I3C_MASTER_ACPI_H -+ -+#include -+#include -+ -+int i3c_master_acpi_get_params(acpi_handle handle, char *method, u32 *value); -+void i3c_master_acpi_clk_params(acpi_handle handle, char *method, -+ u32 *pres_ctrl0, u32 *pres_ctrl1, u32 *thd_delay); -+ -+#endif -diff --git a/drivers/i3c/master.c b/drivers/i3c/master.c -index 0e9ff5500..826f2877d 100644 ---- a/drivers/i3c/master.c -+++ b/drivers/i3c/master.c -@@ -5,6 +5,8 @@ - * Author: Boris Brezillon - */ - -+#include -+#include - #include - #include - #include -@@ -17,8 +19,25 @@ - #include - #include - -+#ifdef CONFIG_ACPI -+#include "i3c_master_acpi.h" -+#endif - #include "internals.h" - -+struct i3c_acpi_lookup { -+ u64 pid; -+ acpi_handle adapter_handle; -+ acpi_handle device_handle; -+ acpi_handle search_handle; -+ int n; -+ int index; -+ u32 speed; -+ u32 min_speed; -+ u32 force_speed; -+ u32 slave_address; -+ u32 lvr; -+}; -+ - static DEFINE_IDR(i3c_bus_idr); - static DEFINE_MUTEX(i3c_core_lock); - static int __i3c_first_dynamic_bus_num; -@@ -263,6 +282,88 @@ static ssize_t modalias_show(struct device *dev, - } - static DEVICE_ATTR_RO(modalias); - -+static ssize_t reg_read_store(struct device *dev, -+ struct device_attribute *da, -+ const char *buf, size_t size) -+{ -+ struct i3c_device *i3c = dev_to_i3cdev(dev); -+ struct i3c_priv_xfer xfers[2]; -+ u8 status = 0; -+ long value; -+ __u8 reg; -+ __u8 val; -+ -+ status = kstrtol(buf, 0, &value); -+ if (status) -+ return status; -+ -+ reg = (__u8)value; -+ -+ xfers[0].rnw = false; -+ xfers[0].len = 1; -+ xfers[0].data.out = ® -+ -+ xfers[1].rnw = true; -+ xfers[1].len = 1; -+ xfers[1].data.in = &val; -+ -+ i3c_bus_normaluse_lock(i3c->bus); -+ i3c_device_do_priv_xfers(i3c, xfers, 2); -+ dev_info(dev, "reg read reg =0x%x, val=%x\n", reg, val); -+ i3c_bus_normaluse_unlock(i3c->bus); -+ -+ return size; -+} -+static DEVICE_ATTR_WO(reg_read); -+ -+static ssize_t reg_write_store(struct device *dev, -+ struct device_attribute *da, -+ const char *buf, size_t size) -+{ -+ struct i3c_device *i3c = dev_to_i3cdev(dev); -+ struct i3c_priv_xfer xfers[2]; -+ u8 status = 0; -+ char *p; -+ char *token; -+ long value; -+ __u8 reg; -+ u16 val; -+ -+ p = kmalloc(size, GFP_KERNEL); -+ strscpy(p, buf, size); -+ token = strsep(&p, " "); -+ -+ if (!token) -+ return -EINVAL; -+ -+ status = kstrtol(token, 0, &value); -+ if (status) -+ return status; -+ -+ reg = (u8)value; -+ token = strsep(&p, " "); -+ if (!token) -+ return -EINVAL; -+ -+ status = kstrtol(token, 0, &value); -+ if (status) -+ return status; -+ -+ val = ((u8)value << 8) | reg; -+ xfers[0].rnw = false; -+ xfers[0].len = 2; -+ xfers[0].data.out = &val; -+ -+ i3c_bus_normaluse_lock(i3c->bus); -+ i3c_device_do_priv_xfers(i3c, xfers, 1); -+ dev_info(dev, "reg write reg =0x%x, val=%x\n", reg, val); -+ i3c_bus_normaluse_unlock(i3c->bus); -+ -+ kfree(p); -+ return size; -+} -+static DEVICE_ATTR_WO(reg_write); -+ - static struct attribute *i3c_device_attrs[] = { - &dev_attr_bcr.attr, - &dev_attr_dcr.attr, -@@ -270,6 +371,8 @@ static struct attribute *i3c_device_attrs[] = { - &dev_attr_dynamic_address.attr, - &dev_attr_hdrcap.attr, - &dev_attr_modalias.attr, -+ &dev_attr_reg_read.attr, -+ &dev_attr_reg_write.attr, - NULL, - }; - ATTRIBUTE_GROUPS(i3c_device); -@@ -1521,9 +1624,10 @@ i3c_master_register_new_i3c_devs(struct i3c_master_controller *master) - dev_set_name(&desc->dev->dev, "%d-%llx", master->bus.id, - desc->info.pid); - -- if (desc->boardinfo) -+ if (desc->boardinfo) { - desc->dev->dev.of_node = desc->boardinfo->of_node; -- -+ desc->dev->dev.fwnode = desc->boardinfo->fwnode; -+ } - ret = device_register(&desc->dev->dev); - if (ret) { - dev_err(&master->dev, -@@ -2148,6 +2252,183 @@ static int of_populate_i3c_bus(struct i3c_master_controller *master) - return 0; - } - -+#ifdef CONFIG_ACPI -+static int i3c_acpi_master_add_i2c_boardinfo(struct i3c_master_controller *master, -+ struct acpi_device *adev, struct i3c_acpi_lookup *look_up) -+{ -+ struct i2c_dev_boardinfo *boardinfo; -+ struct device *dev = &master->dev; -+ u32 addr = look_up->slave_address; -+ -+ boardinfo = devm_kzalloc(dev, sizeof(*boardinfo), GFP_KERNEL); -+ if (!boardinfo) -+ return -ENOMEM; -+ -+ boardinfo->base.addr = addr; -+ acpi_set_modalias(adev, dev_name(&adev->dev), boardinfo->base.type, -+ sizeof(boardinfo->base.type)); -+ boardinfo->base.fwnode = acpi_fwnode_handle(adev); -+ -+ /* -+ * The I3C Specification does not clearly say I2C devices with 10-bit -+ * address are supported. These devices can't be passed properly through -+ * DEFSLVS command. -+ */ -+ if (boardinfo->base.flags & I2C_CLIENT_TEN) { -+ dev_err(dev, "I2C device with 10 bit address not supported."); -+ return -EOPNOTSUPP; -+ } -+ -+ boardinfo->lvr = look_up->lvr; -+ -+ /* If the client speed is smaller than controller speed, -+ * then set the controller speed to the client speed -+ */ -+ if (look_up->speed && look_up->speed < master->bus.scl_rate.i2c) -+ master->bus.scl_rate.i2c = look_up->speed; -+ -+ list_add_tail(&boardinfo->node, &master->boardinfo.i2c); -+ -+ return 0; -+} -+ -+static int i3c_acpi_master_add_i3c_boardinfo(struct i3c_master_controller *master, -+ struct acpi_device *adev, acpi_handle handle, struct i3c_acpi_lookup *look_up) -+{ -+ struct i3c_dev_boardinfo *boardinfo; -+ struct device *dev = &master->dev; -+ enum i3c_addr_slot_status addrstatus; -+ u32 init_dyn_addr = 0; -+ -+ boardinfo = devm_kzalloc(dev, sizeof(*boardinfo), GFP_KERNEL); -+ if (!boardinfo) -+ return -ENOMEM; -+ -+ if (look_up->slave_address) { -+ if (look_up->slave_address > I3C_MAX_ADDR) -+ return -EINVAL; -+ -+ addrstatus = i3c_bus_get_addr_slot_status(&master->bus, look_up->slave_address); -+ if (addrstatus != I3C_ADDR_SLOT_FREE) -+ return -EINVAL; -+ } -+ -+ boardinfo->static_addr = look_up->slave_address; -+ boardinfo->pid = look_up->pid; -+ -+ if ((boardinfo->pid & GENMASK_ULL(63, 48)) || -+ I3C_PID_RND_LOWER_32BITS(boardinfo->pid)) -+ return -EINVAL; -+ -+ boardinfo->init_dyn_addr = init_dyn_addr; -+ boardinfo->fwnode = acpi_fwnode_handle(adev); -+ -+ /* If the client speed is smaller than controller speed, -+ * then set the controller speed to the client speed -+ */ -+ if (look_up->speed && look_up->speed < master->bus.scl_rate.i3c) -+ master->bus.scl_rate.i3c = look_up->speed; -+ -+ list_add_tail(&boardinfo->node, &master->boardinfo.i3c); -+ -+ return 0; -+} -+ -+static int i3c_acpi_master_get_resource(struct acpi_resource *ares, void *data) -+{ -+ struct i3c_acpi_lookup *look_up = (struct i3c_acpi_lookup *)data; -+ struct acpi_resource_i2c_serialbus *sb; -+ bool ret; -+ -+ ret = i2c_acpi_get_i2c_resource(ares, &sb); -+ if (ret == true) { -+ look_up->slave_address = sb->slave_address; -+ look_up->speed = sb->connection_speed; -+ } -+ -+ return 0; -+} -+ -+static int i3c_acpi_master_get_slave_info(struct i3c_master_controller *master, -+ struct acpi_device *adev, struct i3c_acpi_lookup *look_up) -+{ -+ struct list_head resource_list; -+ int ret; -+ -+ /* Look up for I2cSerialBus resource */ -+ INIT_LIST_HEAD(&resource_list); -+ ret = acpi_dev_get_resources(adev, &resource_list, -+ i3c_acpi_master_get_resource, look_up); -+ acpi_dev_free_resource_list(&resource_list); -+ -+ return ret; -+} -+ -+ -+static bool i3c_master_check_cpu_workaround(void) -+{ -+ u32 cpu_implementor; -+ -+ cpu_implementor = read_cpuid_implementor(); -+ -+ if (cpu_implementor == ARM_CPU_IMP_PHYTIUM) -+ return true; -+ -+ return false; -+} -+ -+static int i3c_acpi_master_add_dev(struct acpi_device *adev, void *data) -+{ -+ int ret = -1; -+ acpi_handle handle = adev->handle; -+ acpi_status status; -+ struct i3c_master_controller *master = (struct i3c_master_controller *)data; -+ u64 pid, lvr; -+ struct i3c_acpi_lookup look_up; -+ u32 mode_val; -+ -+ i3c_acpi_master_get_slave_info(master, adev, &look_up); -+ -+ status = acpi_evaluate_integer(handle, "_ADR", NULL, &pid); -+ -+ if (ACPI_SUCCESS(status)) -+ look_up.pid = pid; -+ else -+ look_up.pid = 0x202a0a0a0a0; -+ -+ if (i3c_master_check_cpu_workaround() == true) { -+ dev_info(&master->dev, "I3C ACPI SPECIAL KEYS\n"); -+ status = acpi_evaluate_integer(handle, "_LVR", NULL, &lvr); -+ -+ if (ACPI_SUCCESS(status)) -+ look_up.lvr = (u32)lvr; -+ else -+ look_up.lvr = 0; -+ -+ ret = i3c_master_acpi_get_params(handle, "i3c-mode", &mode_val); -+ if (!ret) { -+ if (!mode_val) -+ i3c_acpi_master_add_i2c_boardinfo(master, adev, &look_up); -+ else -+ i3c_acpi_master_add_i3c_boardinfo(master, adev, handle, &look_up); -+ } -+ } -+ return 0; -+} -+ -+static void i3c_acpi_register_devices(struct i3c_master_controller *master) -+{ -+ struct acpi_device *adev = NULL; -+ -+ if (!has_acpi_companion(master->dev.parent)) -+ return; -+ -+ adev = acpi_fetch_acpi_dev(ACPI_HANDLE(master->dev.parent)); -+ if (adev) -+ acpi_dev_for_each_child(adev, i3c_acpi_master_add_dev, master); -+} -+#endif -+ - static int i3c_master_i2c_adapter_xfer(struct i2c_adapter *adap, - struct i2c_msg *xfers, int nxfers) - { -@@ -2311,7 +2592,7 @@ static int i3c_master_i2c_adapter_init(struct i3c_master_controller *master) - adap->dev.parent = master->dev.parent; - adap->owner = master->dev.parent->driver->owner; - adap->algo = &i3c_master_i2c_algo; -- strncpy(adap->name, dev_name(master->dev.parent), sizeof(adap->name)); -+ strscpy(adap->name, dev_name(master->dev.parent), sizeof(adap->name)); - - /* FIXME: Should we allow i3c masters to override these values? */ - adap->timeout = 1000; -@@ -2616,6 +2897,7 @@ int i3c_master_register(struct i3c_master_controller *master, - - master->dev.parent = parent; - master->dev.of_node = of_node_get(parent->of_node); -+ master->dev.fwnode = parent->fwnode; - master->dev.bus = &i3c_bus_type; - master->dev.type = &i3c_masterdev_type; - master->dev.release = i3c_masterdev_release; -@@ -2634,7 +2916,9 @@ int i3c_master_register(struct i3c_master_controller *master, - ret = of_populate_i3c_bus(master); - if (ret) - goto err_put_dev; -- -+#ifdef CONFIG_ACPI -+ i3c_acpi_register_devices(master); -+#endif - list_for_each_entry(i2cbi, &master->boardinfo.i2c, node) { - switch (i2cbi->lvr & I3C_LVR_I2C_INDEX_MASK) { - case I3C_LVR_I2C_INDEX(0): -diff --git a/drivers/i3c/master/Kconfig b/drivers/i3c/master/Kconfig -index 90dee3ec5..f39122918 100644 ---- a/drivers/i3c/master/Kconfig -+++ b/drivers/i3c/master/Kconfig -@@ -57,3 +57,12 @@ config MIPI_I3C_HCI - - This driver can also be built as a module. If so, the module will be - called mipi-i3c-hci. -+ -+config PHYTIUM_I3C_MASTER -+ tristate "Phytium I3C master driver" -+ depends on I3C -+ depends on HAS_IOMEM -+ depends on !(ALPHA || PARISC) -+ help -+ Enable this driver if you want to support phytium I3C master block. -+ -diff --git a/drivers/i3c/master/Makefile b/drivers/i3c/master/Makefile -index 3e9796016..3819a4dab 100644 ---- a/drivers/i3c/master/Makefile -+++ b/drivers/i3c/master/Makefile -@@ -4,3 +4,4 @@ obj-$(CONFIG_DW_I3C_MASTER) += dw-i3c-master.o - obj-$(CONFIG_AST2600_I3C_MASTER) += ast2600-i3c-master.o - obj-$(CONFIG_SVC_I3C_MASTER) += svc-i3c-master.o - obj-$(CONFIG_MIPI_I3C_HCI) += mipi-i3c-hci/ -+obj-$(CONFIG_PHYTIUM_I3C_MASTER) += i3c-master-phytium.o -diff --git a/drivers/i3c/master/i3c-master-cdns.c b/drivers/i3c/master/i3c-master-cdns.c -index fa5aaaf44..925deb746 100644 ---- a/drivers/i3c/master/i3c-master-cdns.c -+++ b/drivers/i3c/master/i3c-master-cdns.c -@@ -393,6 +393,7 @@ struct cdns_i3c_xfer { - - struct cdns_i3c_data { - u8 thd_delay_ns; -+ u8 halt_disable; - }; - - struct cdns_i3c_master { -@@ -724,6 +725,19 @@ static int cdns_i3c_master_send_ccc_cmd(struct i3c_master_controller *m, - if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) - cdns_i3c_master_unqueue_xfer(master, xfer); - -+ /*GETMXDS format 1 need retransmission*/ -+ if ((xfer->ret) && (cmd->id == I3C_CCC_GETMXDS)) { -+ if (cmd->dests[0].payload.len == 5) { -+ cmd->dests[0].payload.len = 2; -+ ccmd->rx_len = cmd->dests[0].payload.len; -+ ccmd->cmd0 &= 0xfff000fff; -+ ccmd->cmd0 |= CMD0_FIFO_PL_LEN(cmd->dests[0].payload.len); -+ cdns_i3c_master_queue_xfer(master, xfer); -+ if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) -+ cdns_i3c_master_unqueue_xfer(master, xfer); -+ } -+ } -+ - ret = xfer->ret; - cmd->err = cdns_i3c_cmd_get_err(&xfer->cmds[0]); - cdns_i3c_master_free_xfer(xfer); -@@ -1285,7 +1299,10 @@ static int cdns_i3c_master_bus_init(struct i3c_master_controller *m) - * - * We will issue ENTDAA afterwards from the threaded IRQ handler. - */ -- ctrl |= CTRL_HJ_ACK | CTRL_HJ_DISEC | CTRL_HALT_EN | CTRL_MCS_EN; -+ if (master->devdata->halt_disable) -+ ctrl |= CTRL_HJ_DISEC | CTRL_MCS_EN; -+ else -+ ctrl |= CTRL_HJ_ACK | CTRL_HJ_DISEC | CTRL_HALT_EN | CTRL_MCS_EN; - - /* - * Configure data hold delay based on device-specific data. -@@ -1556,10 +1573,17 @@ static void cdns_i3c_master_hj(struct work_struct *work) - - static struct cdns_i3c_data cdns_i3c_devdata = { - .thd_delay_ns = 10, -+ .halt_disable = 0, -+}; -+ -+static struct cdns_i3c_data phytium_i3c_devdata = { -+ .thd_delay_ns = 10, -+ .halt_disable = 1, - }; - - static const struct of_device_id cdns_i3c_master_of_ids[] = { - { .compatible = "cdns,i3c-master", .data = &cdns_i3c_devdata }, -+ { .compatible = "phytium,cdns-i3c-master", .data = &phytium_i3c_devdata}, - { /* sentinel */ }, - }; - -@@ -1651,6 +1675,8 @@ static int cdns_i3c_master_probe(struct platform_device *pdev) - if (ret) - goto err_disable_sysclk; - -+ writel(readl(master->regs + CTRL) | CTRL_HJ_ACK, master->regs + CTRL); -+ - return 0; - - err_disable_sysclk: -diff --git a/drivers/i3c/master/i3c-master-phytium.c b/drivers/i3c/master/i3c-master-phytium.c -new file mode 100644 -index 000000000..50f3f6c98 ---- /dev/null -+++ b/drivers/i3c/master/i3c-master-phytium.c -@@ -0,0 +1,1848 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (C) 2022 Phytium Technology Co.,Ltd. -+ * -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "../i3c_master_acpi.h" -+ -+#define DEV_ID 0x0 -+#define DEV_ID_I3C_MASTER 0x5034 -+ -+#define CONF_STATUS0 0x4 -+#define CONF_STATUS0_CMDR_DEPTH(x) (4 << (((x) & GENMASK(31, 29)) >> 29)) -+#define CONF_STATUS0_ECC_CHK BIT(28) -+#define CONF_STATUS0_INTEG_CHK BIT(27) -+#define CONF_STATUS0_CSR_DAP_CHK BIT(26) -+#define CONF_STATUS0_TRANS_TOUT_CHK BIT(25) -+#define CONF_STATUS0_PROT_FAULTS_CHK BIT(24) -+#define CONF_STATUS0_GPO_NUM(x) (((x) & GENMASK(23, 16)) >> 16) -+#define CONF_STATUS0_GPI_NUM(x) (((x) & GENMASK(15, 8)) >> 8) -+#define CONF_STATUS0_IBIR_DEPTH(x) (4 << (((x) & GENMASK(7, 6)) >> 7)) -+#define CONF_STATUS0_SUPPORTS_DDR BIT(5) -+#define CONF_STATUS0_SEC_MASTER BIT(4) -+#define CONF_STATUS0_DEVS_NUM(x) ((x) & GENMASK(3, 0)) -+ -+#define CONF_STATUS1 0x8 -+#define CONF_STATUS1_IBI_HW_RES(x) ((((x) & GENMASK(31, 28)) >> 28) + 1) -+#define CONF_STATUS1_CMD_DEPTH(x) (4 << (((x) & GENMASK(27, 26)) >> 26)) -+#define CONF_STATUS1_SLVDDR_RX_DEPTH(x) (8 << (((x) & GENMASK(25, 21)) >> 21)) -+#define CONF_STATUS1_SLVDDR_TX_DEPTH(x) (8 << (((x) & GENMASK(20, 16)) >> 16)) -+#define CONF_STATUS1_IBI_DEPTH(x) (2 << (((x) & GENMASK(12, 10)) >> 10)) -+#define CONF_STATUS1_RX_DEPTH(x) (8 << (((x) & GENMASK(9, 5)) >> 5)) -+#define CONF_STATUS1_TX_DEPTH(x) (8 << ((x) & GENMASK(4, 0))) -+ -+#define REV_ID 0xc -+#define REV_ID_VID(id) (((id) & GENMASK(31, 20)) >> 20) -+#define REV_ID_PID(id) (((id) & GENMASK(19, 8)) >> 8) -+#define REV_ID_REV_MAJOR(id) (((id) & GENMASK(7, 4)) >> 4) -+#define REV_ID_REV_MINOR(id) ((id) & GENMASK(3, 0)) -+ -+#define CTRL 0x10 -+#define CTRL_DEV_EN BIT(31) -+#define CTRL_HALT_EN BIT(30) -+#define CTRL_MCS BIT(29) -+#define CTRL_MCS_EN BIT(28) -+#define CTRL_THD_DELAY(x) (((x) << 24) & GENMASK(25, 24)) -+#define CTRL_HJ_DISEC BIT(8) -+#define CTRL_MST_ACK BIT(7) -+#define CTRL_HJ_ACK BIT(6) -+#define CTRL_HJ_INIT BIT(5) -+#define CTRL_MST_INIT BIT(4) -+#define CTRL_AHDR_OPT BIT(3) -+#define CTRL_PURE_BUS_MODE 0 -+#define CTRL_MIXED_FAST_BUS_MODE 2 -+#define CTRL_MIXED_SLOW_BUS_MODE 3 -+#define CTRL_BUS_MODE_MASK GENMASK(1, 0) -+#define THD_DELAY_MAX 3 -+ -+#define PRESCL_CTRL0 0x14 -+#define PRESCL_CTRL0_I2C(x) ((x) << 16) -+#define PRESCL_CTRL0_I3C(x) (x) -+#define PRESCL_CTRL0_MAX GENMASK(9, 0) -+ -+#define PRESCL_CTRL1 0x18 -+#define PRESCL_CTRL1_PP_LOW_MASK GENMASK(15, 8) -+#define PRESCL_CTRL1_PP_LOW(x) ((x) << 8) -+#define PRESCL_CTRL1_OD_LOW_MASK GENMASK(7, 0) -+#define PRESCL_CTRL1_OD_LOW(x) (x) -+ -+#define MST_IER 0x20 -+#define MST_IDR 0x24 -+#define MST_IMR 0x28 -+#define MST_ICR 0x2c -+#define MST_ISR 0x30 -+#define MST_INT_HALTED BIT(18) -+#define MST_INT_MR_DONE BIT(17) -+#define MST_INT_IMM_COMP BIT(16) -+#define MST_INT_TX_THR BIT(15) -+#define MST_INT_TX_OVF BIT(14) -+#define MST_INT_IBID_THR BIT(12) -+#define MST_INT_IBID_UNF BIT(11) -+#define MST_INT_IBIR_THR BIT(10) -+#define MST_INT_IBIR_UNF BIT(9) -+#define MST_INT_IBIR_OVF BIT(8) -+#define MST_INT_RX_THR BIT(7) -+#define MST_INT_RX_UNF BIT(6) -+#define MST_INT_CMDD_EMP BIT(5) -+#define MST_INT_CMDD_THR BIT(4) -+#define MST_INT_CMDD_OVF BIT(3) -+#define MST_INT_CMDR_THR BIT(2) -+#define MST_INT_CMDR_UNF BIT(1) -+#define MST_INT_CMDR_OVF BIT(0) -+ -+#define MST_STATUS0 0x34 -+#define MST_STATUS0_IDLE BIT(18) -+#define MST_STATUS0_HALTED BIT(17) -+#define MST_STATUS0_MASTER_MODE BIT(16) -+#define MST_STATUS0_TX_FULL BIT(13) -+#define MST_STATUS0_IBID_FULL BIT(12) -+#define MST_STATUS0_IBIR_FULL BIT(11) -+#define MST_STATUS0_RX_FULL BIT(10) -+#define MST_STATUS0_CMDD_FULL BIT(9) -+#define MST_STATUS0_CMDR_FULL BIT(8) -+#define MST_STATUS0_TX_EMP BIT(5) -+#define MST_STATUS0_IBID_EMP BIT(4) -+#define MST_STATUS0_IBIR_EMP BIT(3) -+#define MST_STATUS0_RX_EMP BIT(2) -+#define MST_STATUS0_CMDD_EMP BIT(1) -+#define MST_STATUS0_CMDR_EMP BIT(0) -+ -+#define CMDR 0x38 -+#define CMDR_NO_ERROR 0 -+#define CMDR_DDR_PREAMBLE_ERROR 1 -+#define CMDR_DDR_PARITY_ERROR 2 -+#define CMDR_DDR_RX_FIFO_OVF 3 -+#define CMDR_DDR_TX_FIFO_UNF 4 -+#define CMDR_M0_ERROR 5 -+#define CMDR_M1_ERROR 6 -+#define CMDR_M2_ERROR 7 -+#define CMDR_MST_ABORT 8 -+#define CMDR_NACK_RESP 9 -+#define CMDR_INVALID_DA 10 -+#define CMDR_DDR_DROPPED 11 -+#define CMDR_ERROR(x) (((x) & GENMASK(27, 24)) >> 24) -+#define CMDR_XFER_BYTES(x) (((x) & GENMASK(19, 8)) >> 8) -+#define CMDR_CMDID_HJACK_DISEC 0xfe -+#define CMDR_CMDID_HJACK_ENTDAA 0xff -+#define CMDR_CMDID(x) ((x) & GENMASK(7, 0)) -+ -+#define IBIR 0x3c -+#define IBIR_ACKED BIT(12) -+#define IBIR_SLVID(x) (((x) & GENMASK(11, 8)) >> 8) -+#define IBIR_ERROR BIT(7) -+#define IBIR_XFER_BYTES(x) (((x) & GENMASK(6, 2)) >> 2) -+#define IBIR_TYPE_IBI 0 -+#define IBIR_TYPE_HJ 1 -+#define IBIR_TYPE_MR 2 -+#define IBIR_TYPE(x) ((x) & GENMASK(1, 0)) -+ -+#define SLV_IER 0x40 -+#define SLV_IDR 0x44 -+#define SLV_IMR 0x48 -+#define SLV_ICR 0x4c -+#define SLV_ISR 0x50 -+#define SLV_INT_TM BIT(20) -+#define SLV_INT_ERROR BIT(19) -+#define SLV_INT_EVENT_UP BIT(18) -+#define SLV_INT_HJ_DONE BIT(17) -+#define SLV_INT_MR_DONE BIT(16) -+#define SLV_INT_DA_UPD BIT(15) -+#define SLV_INT_SDR_FAIL BIT(14) -+#define SLV_INT_DDR_FAIL BIT(13) -+#define SLV_INT_M_RD_ABORT BIT(12) -+#define SLV_INT_DDR_RX_THR BIT(11) -+#define SLV_INT_DDR_TX_THR BIT(10) -+#define SLV_INT_SDR_RX_THR BIT(9) -+#define SLV_INT_SDR_TX_THR BIT(8) -+#define SLV_INT_DDR_RX_UNF BIT(7) -+#define SLV_INT_DDR_TX_OVF BIT(6) -+#define SLV_INT_SDR_RX_UNF BIT(5) -+#define SLV_INT_SDR_TX_OVF BIT(4) -+#define SLV_INT_DDR_RD_COMP BIT(3) -+#define SLV_INT_DDR_WR_COMP BIT(2) -+#define SLV_INT_SDR_RD_COMP BIT(1) -+#define SLV_INT_SDR_WR_COMP BIT(0) -+ -+#define SLV_STATUS0 0x54 -+#define SLV_STATUS0_REG_ADDR(s) (((s) & GENMASK(23, 16)) >> 16) -+#define SLV_STATUS0_XFRD_BYTES(s) ((s) & GENMASK(15, 0)) -+ -+#define SLV_STATUS1 0x58 -+#define SLV_STATUS1_AS(s) (((s) & GENMASK(21, 20)) >> 20) -+#define SLV_STATUS1_VEN_TM BIT(19) -+#define SLV_STATUS1_HJ_DIS BIT(18) -+#define SLV_STATUS1_MR_DIS BIT(17) -+#define SLV_STATUS1_PROT_ERR BIT(16) -+#define SLV_STATUS1_DA(x) (((s) & GENMASK(15, 9)) >> 9) -+#define SLV_STATUS1_HAS_DA BIT(8) -+#define SLV_STATUS1_DDR_RX_FULL BIT(7) -+#define SLV_STATUS1_DDR_TX_FULL BIT(6) -+#define SLV_STATUS1_DDR_RX_EMPTY BIT(5) -+#define SLV_STATUS1_DDR_TX_EMPTY BIT(4) -+#define SLV_STATUS1_SDR_RX_FULL BIT(3) -+#define SLV_STATUS1_SDR_TX_FULL BIT(2) -+#define SLV_STATUS1_SDR_RX_EMPTY BIT(1) -+#define SLV_STATUS1_SDR_TX_EMPTY BIT(0) -+ -+#define CMD0_FIFO 0x60 -+#define CMD0_FIFO_IS_DDR BIT(31) -+#define CMD0_FIFO_IS_CCC BIT(30) -+#define CMD0_FIFO_BCH BIT(29) -+#define XMIT_BURST_STATIC_SUBADDR 0 -+#define XMIT_SINGLE_INC_SUBADDR 1 -+#define XMIT_SINGLE_STATIC_SUBADDR 2 -+#define XMIT_BURST_WITHOUT_SUBADDR 3 -+#define CMD0_FIFO_PRIV_XMIT_MODE(m) ((m) << 27) -+#define CMD0_FIFO_SBCA BIT(26) -+#define CMD0_FIFO_RSBC BIT(25) -+#define CMD0_FIFO_IS_10B BIT(24) -+#define CMD0_FIFO_PL_LEN(l) ((l) << 12) -+#define CMD0_FIFO_PL_LEN_MAX 4095 -+#define CMD0_FIFO_DEV_ADDR(a) ((a) << 1) -+#define CMD0_FIFO_RNW BIT(0) -+ -+#define CMD1_FIFO 0x64 -+#define CMD1_FIFO_CMDID(id) ((id) << 24) -+#define CMD1_FIFO_CSRADDR(a) (a) -+#define CMD1_FIFO_CCC(id) (id) -+ -+#define TX_FIFO 0x68 -+ -+#define IMD_CMD0 0x70 -+#define IMD_CMD0_PL_LEN(l) ((l) << 12) -+#define IMD_CMD0_DEV_ADDR(a) ((a) << 1) -+#define IMD_CMD0_RNW BIT(0) -+ -+#define IMD_CMD1 0x74 -+#define IMD_CMD1_CCC(id) (id) -+ -+#define IMD_DATA 0x78 -+#define RX_FIFO 0x80 -+#define IBI_DATA_FIFO 0x84 -+#define SLV_DDR_TX_FIFO 0x88 -+#define SLV_DDR_RX_FIFO 0x8c -+ -+#define CMD_IBI_THR_CTRL 0x90 -+#define IBIR_THR(t) ((t) << 24) -+#define CMDR_THR(t) ((t) << 16) -+#define IBI_THR(t) ((t) << 8) -+#define CMD_THR(t) (t) -+ -+#define TX_RX_THR_CTRL 0x94 -+#define RX_THR(t) ((t) << 16) -+#define TX_THR(t) (t) -+ -+#define SLV_DDR_TX_RX_THR_CTRL 0x98 -+#define SLV_DDR_RX_THR(t) ((t) << 16) -+#define SLV_DDR_TX_THR(t) (t) -+ -+#define FLUSH_CTRL 0x9c -+#define FLUSH_IBI_RESP BIT(23) -+#define FLUSH_CMD_RESP BIT(22) -+#define FLUSH_SLV_DDR_RX_FIFO BIT(22) -+#define FLUSH_SLV_DDR_TX_FIFO BIT(21) -+#define FLUSH_IMM_FIFO BIT(20) -+#define FLUSH_IBI_FIFO BIT(19) -+#define FLUSH_RX_FIFO BIT(18) -+#define FLUSH_TX_FIFO BIT(17) -+#define FLUSH_CMD_FIFO BIT(16) -+ -+#define TTO_PRESCL_CTRL0 0xb0 -+#define TTO_PRESCL_CTRL0_DIVB(x) ((x) << 16) -+#define TTO_PRESCL_CTRL0_DIVA(x) (x) -+ -+#define TTO_PRESCL_CTRL1 0xb4 -+#define TTO_PRESCL_CTRL1_DIVB(x) ((x) << 16) -+#define TTO_PRESCL_CTRL1_DIVA(x) (x) -+ -+#define DEVS_CTRL 0xb8 -+#define DEVS_CTRL_DEV_CLR_SHIFT 16 -+#define DEVS_CTRL_DEV_CLR_ALL GENMASK(31, 16) -+#define DEVS_CTRL_DEV_CLR(dev) BIT(16 + (dev)) -+#define DEVS_CTRL_DEV_ACTIVE(dev) BIT(dev) -+#define DEVS_CTRL_DEVS_ACTIVE_MASK GENMASK(15, 0) -+#define MAX_DEVS 16 -+ -+#define DEV_ID_RR0(d) (0xc0 + ((d) * 0x10)) -+#define DEV_ID_RR0_LVR_EXT_ADDR BIT(11) -+#define DEV_ID_RR0_HDR_CAP BIT(10) -+#define DEV_ID_RR0_IS_I3C BIT(9) -+#define DEV_ID_RR0_DEV_ADDR_MASK (GENMASK(6, 0) | GENMASK(15, 13)) -+#define DEV_ID_RR0_SET_DEV_ADDR(a) (((a) & GENMASK(6, 0)) | \ -+ (((a) & GENMASK(9, 7)) << 6)) -+#define DEV_ID_RR0_GET_DEV_ADDR(x) ((((x) >> 1) & GENMASK(6, 0)) | \ -+ (((x) >> 6) & GENMASK(9, 7))) -+ -+#define DEV_ID_RR1(d) (0xc4 + ((d) * 0x10)) -+#define DEV_ID_RR1_PID_MSB(pid) (pid) -+ -+#define DEV_ID_RR2(d) (0xc8 + ((d) * 0x10)) -+#define DEV_ID_RR2_PID_LSB(pid) ((pid) << 16) -+#define DEV_ID_RR2_BCR(bcr) ((bcr) << 8) -+#define DEV_ID_RR2_DCR(dcr) (dcr) -+#define DEV_ID_RR2_LVR(lvr) (lvr) -+ -+#define SIR_MAP(x) (0x180 + ((x) * 4)) -+#define SIR_MAP_DEV_REG(d) SIR_MAP((d) / 2) -+#define SIR_MAP_DEV_SHIFT(d, fs) ((fs) + (((d) % 2) ? 16 : 0)) -+#define SIR_MAP_DEV_CONF_MASK(d) (GENMASK(15, 0) << (((d) % 2) ? 16 : 0)) -+#define SIR_MAP_DEV_CONF(d, c) ((c) << (((d) % 2) ? 16 : 0)) -+#define DEV_ROLE_SLAVE 0 -+#define DEV_ROLE_MASTER 1 -+#define SIR_MAP_DEV_ROLE(role) ((role) << 14) -+#define SIR_MAP_DEV_SLOW BIT(13) -+#define SIR_MAP_DEV_PL(l) ((l) << 8) -+#define SIR_MAP_PL_MAX GENMASK(4, 0) -+#define SIR_MAP_DEV_DA(a) ((a) << 1) -+#define SIR_MAP_DEV_ACK BIT(0) -+ -+#define GPIR_WORD(x) (0x200 + ((x) * 4)) -+#define GPI_REG(val, id) \ -+ (((val) >> (((id) % 4) * 8)) & GENMASK(7, 0)) -+ -+#define GPOR_WORD(x) (0x220 + ((x) * 4)) -+#define GPO_REG(val, id) \ -+ (((val) >> (((id) % 4) * 8)) & GENMASK(7, 0)) -+ -+#define ASF_INT_STATUS 0x300 -+#define ASF_INT_RAW_STATUS 0x304 -+#define ASF_INT_MASK 0x308 -+#define ASF_INT_TEST 0x30c -+#define ASF_INT_FATAL_SELECT 0x310 -+#define ASF_INTEGRITY_ERR BIT(6) -+#define ASF_PROTOCOL_ERR BIT(5) -+#define ASF_TRANS_TIMEOUT_ERR BIT(4) -+#define ASF_CSR_ERR BIT(3) -+#define ASF_DAP_ERR BIT(2) -+#define ASF_SRAM_UNCORR_ERR BIT(1) -+#define ASF_SRAM_CORR_ERR BIT(0) -+ -+#define ASF_SRAM_CORR_FAULT_STATUS 0x320 -+#define ASF_SRAM_UNCORR_FAULT_STATUS 0x324 -+#define ASF_SRAM_CORR_FAULT_INSTANCE(x) ((x) >> 24) -+#define ASF_SRAM_CORR_FAULT_ADDR(x) ((x) & GENMASK(23, 0)) -+ -+#define ASF_SRAM_FAULT_STATS 0x328 -+#define ASF_SRAM_FAULT_UNCORR_STATS(x) ((x) >> 16) -+#define ASF_SRAM_FAULT_CORR_STATS(x) ((x) & GENMASK(15, 0)) -+ -+#define ASF_TRANS_TOUT_CTRL 0x330 -+#define ASF_TRANS_TOUT_EN BIT(31) -+#define ASF_TRANS_TOUT_VAL(x) (x) -+ -+#define ASF_TRANS_TOUT_FAULT_MASK 0x334 -+#define ASF_TRANS_TOUT_FAULT_STATUS 0x338 -+#define ASF_TRANS_TOUT_FAULT_APB BIT(3) -+#define ASF_TRANS_TOUT_FAULT_SCL_LOW BIT(2) -+#define ASF_TRANS_TOUT_FAULT_SCL_HIGH BIT(1) -+#define ASF_TRANS_TOUT_FAULT_FSCL_HIGH BIT(0) -+ -+#define ASF_PROTO_FAULT_MASK 0x340 -+#define ASF_PROTO_FAULT_STATUS 0x344 -+#define ASF_PROTO_FAULT_SLVSDR_RD_ABORT BIT(31) -+#define ASF_PROTO_FAULT_SLVDDR_FAIL BIT(30) -+#define ASF_PROTO_FAULT_S(x) BIT(16 + (x)) -+#define ASF_PROTO_FAULT_MSTSDR_RD_ABORT BIT(15) -+#define ASF_PROTO_FAULT_MSTDDR_FAIL BIT(14) -+#define ASF_PROTO_FAULT_M(x) BIT(x) -+ -+#define I3C_CONTROL_DEFAULT_I2C_SCL (1000000) -+#define I3C_CONTROL_DEFAULT_I3C_SCL (1000000) -+#define PHYTIUM_I3C_DEV_MAX_NUM (12) -+#define PHYTIUM_I3C_CMDR_MAX_TIMES (32) -+ -+struct phytium_i3c_master_caps { -+ u32 cmdfifodepth; -+ u32 cmdrfifodepth; -+ u32 txfifodepth; -+ u32 rxfifodepth; -+ u32 ibirfifodepth; -+}; -+ -+struct phytium_i3c_cmd { -+ u32 cmd0; -+ u32 cmd1; -+ u32 tx_len; -+ const void *tx_buf; -+ u32 rx_len; -+ void *rx_buf; -+ u32 error; -+}; -+ -+struct phytium_i3c_xfer { -+ struct list_head node; -+ struct completion comp; -+ int ret; -+ unsigned int ncmds; -+ struct phytium_i3c_cmd cmds[]; -+}; -+ -+struct phytium_i3c_data { -+ u8 thd_delay_ns; -+}; -+ -+struct phytium_i3c_slave_dev { -+ u32 dev_rr0; -+ u32 dev_rr1; -+ u32 dev_rr2; -+}; -+ -+struct phytium_i3c_master { -+ struct work_struct hj_work; -+ struct i3c_master_controller base; -+ u32 free_rr_slots; -+ unsigned int maxdevs; -+ struct { -+ unsigned int num_slots; -+ struct i3c_dev_desc **slots; -+ spinlock_t lock; -+ } ibi; -+ struct { -+ struct list_head list; -+ struct phytium_i3c_xfer *cur; -+ spinlock_t lock; -+ } xferqueue; -+ void __iomem *regs; -+ struct clk *sysclk; -+ struct clk *pclk; -+ u32 sysclk_rate; -+ u32 prescl0; -+ u32 prescl1; -+ u32 ctrl_thd_del; -+ u32 ctrl_info; -+ u32 dev_valid; -+ struct device *dev; -+ struct phytium_i3c_master_caps caps; -+ unsigned long i3c_scl_lim; -+ const struct phytium_i3c_data *devdata; -+ struct phytium_i3c_slave_dev devinfo[PHYTIUM_I3C_DEV_MAX_NUM]; -+}; -+ -+static inline struct phytium_i3c_master * -+to_phytium_i3c_master(struct i3c_master_controller *master) -+{ -+ return container_of(master, struct phytium_i3c_master, base); -+} -+ -+static void phytium_i3c_master_wr_to_tx_fifo(struct phytium_i3c_master *master, -+ const u8 *bytes, int nbytes) -+{ -+ writesl(master->regs + TX_FIFO, bytes, nbytes / 4); -+ if (nbytes & 3) { -+ u32 tmp = 0; -+ -+ memcpy(&tmp, bytes + (nbytes & ~3), nbytes & 3); -+ writesl(master->regs + TX_FIFO, &tmp, 1); -+ } -+} -+ -+static void phytium_i3c_master_rd_from_rx_fifo(struct phytium_i3c_master *master, -+ u8 *bytes, int nbytes) -+{ -+ readsl(master->regs + RX_FIFO, bytes, nbytes / 4); -+ if (nbytes & 3) { -+ u32 tmp; -+ -+ readsl(master->regs + RX_FIFO, &tmp, 1); -+ memcpy(bytes + (nbytes & ~3), &tmp, nbytes & 3); -+ } -+} -+ -+static bool phytium_i3c_master_supports_ccc_cmd(struct i3c_master_controller *m, -+ const struct i3c_ccc_cmd *cmd) -+{ -+ if (cmd->ndests > 1) -+ return false; -+ -+ switch (cmd->id) { -+ case I3C_CCC_ENEC(true): -+ case I3C_CCC_ENEC(false): -+ case I3C_CCC_DISEC(true): -+ case I3C_CCC_DISEC(false): -+ case I3C_CCC_ENTAS(0, true): -+ case I3C_CCC_ENTAS(0, false): -+ case I3C_CCC_RSTDAA(true): -+ case I3C_CCC_RSTDAA(false): -+ case I3C_CCC_ENTDAA: -+ case I3C_CCC_SETMWL(true): -+ case I3C_CCC_SETMWL(false): -+ case I3C_CCC_SETMRL(true): -+ case I3C_CCC_SETMRL(false): -+ case I3C_CCC_DEFSLVS: -+ case I3C_CCC_ENTHDR(0): -+ case I3C_CCC_SETDASA: -+ case I3C_CCC_SETNEWDA: -+ case I3C_CCC_GETMWL: -+ case I3C_CCC_GETMRL: -+ case I3C_CCC_GETPID: -+ case I3C_CCC_GETBCR: -+ case I3C_CCC_GETDCR: -+ case I3C_CCC_GETSTATUS: -+ case I3C_CCC_GETACCMST: -+ case I3C_CCC_GETMXDS: -+ case I3C_CCC_GETHDRCAP: -+ return true; -+ default: -+ break; -+ } -+ -+ return false; -+} -+ -+static int phytium_i3c_master_disable(struct phytium_i3c_master *master) -+{ -+ u32 status; -+ -+ writel(readl(master->regs + CTRL) & ~CTRL_DEV_EN, master->regs + CTRL); -+ -+ return readl_poll_timeout(master->regs + MST_STATUS0, status, -+ status & MST_STATUS0_IDLE, 10, 1000000); -+} -+ -+static void phytium_i3c_master_enable(struct phytium_i3c_master *master) -+{ -+ writel(readl(master->regs + CTRL) | CTRL_DEV_EN, master->regs + CTRL); -+} -+ -+static struct phytium_i3c_xfer * -+phytium_i3c_master_alloc_xfer(struct phytium_i3c_master *master, unsigned int ncmds) -+{ -+ struct phytium_i3c_xfer *xfer; -+ -+ xfer = kzalloc(struct_size(xfer, cmds, ncmds), GFP_KERNEL); -+ if (!xfer) -+ return NULL; -+ -+ INIT_LIST_HEAD(&xfer->node); -+ xfer->ncmds = ncmds; -+ xfer->ret = -ETIMEDOUT; -+ -+ return xfer; -+} -+ -+static void phytium_i3c_master_free_xfer(struct phytium_i3c_xfer *xfer) -+{ -+ kfree(xfer); -+} -+ -+static void phytium_i3c_master_start_xfer_locked(struct phytium_i3c_master *master) -+{ -+ struct phytium_i3c_xfer *xfer = master->xferqueue.cur; -+ unsigned int i; -+ -+ if (!xfer) -+ return; -+ -+ phytium_i3c_master_enable(master); -+ -+ writel(MST_INT_CMDD_EMP, master->regs + MST_ICR); -+ for (i = 0; i < xfer->ncmds; i++) { -+ struct phytium_i3c_cmd *cmd = &xfer->cmds[i]; -+ -+ phytium_i3c_master_wr_to_tx_fifo(master, cmd->tx_buf, -+ cmd->tx_len); -+ } -+ for (i = 0; i < xfer->ncmds; i++) { -+ struct phytium_i3c_cmd *cmd = &xfer->cmds[i]; -+ -+ writel(cmd->cmd1 | CMD1_FIFO_CMDID(i), -+ master->regs + CMD1_FIFO); -+ writel(cmd->cmd0, master->regs + CMD0_FIFO); -+ } -+ -+ writel(readl(master->regs + CTRL) | CTRL_MCS, -+ master->regs + CTRL); -+ writel(MST_INT_CMDD_EMP, master->regs + MST_IER); -+} -+ -+static void phytium_i3c_master_end_xfer_locked(struct phytium_i3c_master *master, -+ u32 isr) -+{ -+ struct phytium_i3c_xfer *xfer = master->xferqueue.cur; -+ int i, ret = 0; -+ u32 status0; -+ -+ if (!xfer) -+ return; -+ -+ if (!(isr & MST_INT_CMDD_EMP)) -+ return; -+ -+ writel(MST_INT_CMDD_EMP, master->regs + MST_IDR); -+ -+ for (status0 = readl(master->regs + MST_STATUS0); -+ !(status0 & MST_STATUS0_CMDR_EMP); -+ status0 = readl(master->regs + MST_STATUS0)) { -+ struct phytium_i3c_cmd *cmd; -+ u32 cmdr, rx_len, id; -+ -+ cmdr = readl(master->regs + CMDR); -+ id = CMDR_CMDID(cmdr); -+ if (id == CMDR_CMDID_HJACK_DISEC || -+ id == CMDR_CMDID_HJACK_ENTDAA || -+ WARN_ON(id >= xfer->ncmds)) -+ continue; -+ -+ cmd = &xfer->cmds[CMDR_CMDID(cmdr)]; -+ rx_len = min_t(u32, CMDR_XFER_BYTES(cmdr), cmd->rx_len); -+ phytium_i3c_master_rd_from_rx_fifo(master, cmd->rx_buf, rx_len); -+ cmd->error = CMDR_ERROR(cmdr); -+ } -+ -+ for (i = 0; i < xfer->ncmds; i++) { -+ switch (xfer->cmds[i].error) { -+ case CMDR_NO_ERROR: -+ break; -+ -+ case CMDR_DDR_PREAMBLE_ERROR: -+ case CMDR_DDR_PARITY_ERROR: -+ case CMDR_M0_ERROR: -+ case CMDR_M1_ERROR: -+ case CMDR_M2_ERROR: -+ case CMDR_MST_ABORT: -+ case CMDR_NACK_RESP: -+ case CMDR_DDR_DROPPED: -+ ret = -EIO; -+ break; -+ -+ case CMDR_DDR_RX_FIFO_OVF: -+ case CMDR_DDR_TX_FIFO_UNF: -+ ret = -ENOSPC; -+ break; -+ -+ case CMDR_INVALID_DA: -+ default: -+ ret = -EINVAL; -+ break; -+ } -+ } -+ -+ xfer->ret = ret; -+ complete(&xfer->comp); -+ -+ xfer = list_first_entry_or_null(&master->xferqueue.list, -+ struct phytium_i3c_xfer, node); -+ if (xfer) -+ list_del_init(&xfer->node); -+ -+ master->xferqueue.cur = xfer; -+ phytium_i3c_master_start_xfer_locked(master); -+} -+ -+static void phytium_i3c_master_queue_xfer(struct phytium_i3c_master *master, -+ struct phytium_i3c_xfer *xfer) -+{ -+ unsigned long flags; -+ -+ init_completion(&xfer->comp); -+ spin_lock_irqsave(&master->xferqueue.lock, flags); -+ if (master->xferqueue.cur) { -+ list_add_tail(&xfer->node, &master->xferqueue.list); -+ } else { -+ master->xferqueue.cur = xfer; -+ phytium_i3c_master_start_xfer_locked(master); -+ } -+ spin_unlock_irqrestore(&master->xferqueue.lock, flags); -+} -+ -+static void phytium_i3c_master_unqueue_xfer(struct phytium_i3c_master *master, -+ struct phytium_i3c_xfer *xfer) -+{ -+ unsigned long flags; -+ -+ spin_lock_irqsave(&master->xferqueue.lock, flags); -+ if (master->xferqueue.cur == xfer) { -+ u32 status; -+ -+ writel(readl(master->regs + CTRL) & ~CTRL_DEV_EN, -+ master->regs + CTRL); -+ readl_poll_timeout_atomic(master->regs + MST_STATUS0, status, -+ status & MST_STATUS0_IDLE, 10, -+ 1000000); -+ master->xferqueue.cur = NULL; -+ writel(FLUSH_RX_FIFO | FLUSH_TX_FIFO | FLUSH_CMD_FIFO | -+ FLUSH_CMD_RESP, -+ master->regs + FLUSH_CTRL); -+ writel(MST_INT_CMDD_EMP, master->regs + MST_IDR); -+ writel(readl(master->regs + CTRL) | CTRL_DEV_EN, -+ master->regs + CTRL); -+ } else { -+ list_del_init(&xfer->node); -+ } -+ spin_unlock_irqrestore(&master->xferqueue.lock, flags); -+} -+ -+static enum i3c_error_code phytium_i3c_cmd_get_err(struct phytium_i3c_cmd *cmd) -+{ -+ switch (cmd->error) { -+ case CMDR_M0_ERROR: -+ return I3C_ERROR_M0; -+ -+ case CMDR_M1_ERROR: -+ return I3C_ERROR_M1; -+ -+ case CMDR_M2_ERROR: -+ case CMDR_NACK_RESP: -+ return I3C_ERROR_M2; -+ -+ default: -+ break; -+ } -+ -+ return I3C_ERROR_UNKNOWN; -+} -+ -+static int phytium_i3c_master_send_ccc_cmd(struct i3c_master_controller *m, -+ struct i3c_ccc_cmd *cmd) -+{ -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ struct phytium_i3c_xfer *xfer; -+ struct phytium_i3c_cmd *ccmd; -+ int ret; -+ -+ xfer = phytium_i3c_master_alloc_xfer(master, 1); -+ if (!xfer) -+ return -ENOMEM; -+ -+ ccmd = xfer->cmds; -+ ccmd->cmd1 = CMD1_FIFO_CCC(cmd->id); -+ ccmd->cmd0 = CMD0_FIFO_IS_CCC | -+ CMD0_FIFO_PL_LEN(cmd->dests[0].payload.len); -+ -+ if (cmd->id & I3C_CCC_DIRECT) -+ ccmd->cmd0 |= CMD0_FIFO_DEV_ADDR(cmd->dests[0].addr); -+ -+ if (cmd->rnw) { -+ ccmd->cmd0 |= CMD0_FIFO_RNW; -+ ccmd->rx_buf = cmd->dests[0].payload.data; -+ ccmd->rx_len = cmd->dests[0].payload.len; -+ } else { -+ ccmd->tx_buf = cmd->dests[0].payload.data; -+ ccmd->tx_len = cmd->dests[0].payload.len; -+ } -+ -+ phytium_i3c_master_queue_xfer(master, xfer); -+ if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) -+ phytium_i3c_master_unqueue_xfer(master, xfer); -+ -+ /*GETMXDS format 1 need retransmission*/ -+ if ((xfer->ret) && (cmd->id == I3C_CCC_GETMXDS)) { -+ if (cmd->dests[0].payload.len == 5) { -+ cmd->dests[0].payload.len = 2; -+ ccmd->rx_len = cmd->dests[0].payload.len; -+ ccmd->cmd0 &= 0xfff000fff; -+ ccmd->cmd0 |= CMD0_FIFO_PL_LEN(cmd->dests[0].payload.len); -+ phytium_i3c_master_queue_xfer(master, xfer); -+ if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) -+ phytium_i3c_master_unqueue_xfer(master, xfer); -+ } -+ } -+ ret = xfer->ret; -+ cmd->err = phytium_i3c_cmd_get_err(&xfer->cmds[0]); -+ phytium_i3c_master_free_xfer(xfer); -+ -+ return ret; -+} -+ -+static int phytium_i3c_master_priv_xfers(struct i3c_dev_desc *dev, -+ struct i3c_priv_xfer *xfers, -+ int nxfers) -+{ -+ struct i3c_master_controller *m = i3c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ int txslots = 0, rxslots = 0, i, ret; -+ struct phytium_i3c_xfer *phytium_xfer; -+ -+ for (i = 0; i < nxfers; i++) { -+ if (xfers[i].len > CMD0_FIFO_PL_LEN_MAX) -+ return -EOPNOTSUPP; -+ } -+ -+ if (!nxfers) -+ return 0; -+ -+ if (nxfers > master->caps.cmdfifodepth || -+ nxfers > master->caps.cmdrfifodepth) -+ return -EOPNOTSUPP; -+ -+ /* -+ * First make sure that all transactions (block of transfers separated -+ * by a STOP marker) fit in the FIFOs. -+ */ -+ for (i = 0; i < nxfers; i++) { -+ if (xfers[i].rnw) -+ rxslots += DIV_ROUND_UP(xfers[i].len, 4); -+ else -+ txslots += DIV_ROUND_UP(xfers[i].len, 4); -+ } -+ -+ if (rxslots > master->caps.rxfifodepth || -+ txslots > master->caps.txfifodepth) -+ return -EOPNOTSUPP; -+ -+ phytium_xfer = phytium_i3c_master_alloc_xfer(master, nxfers); -+ if (!phytium_xfer) -+ return -ENOMEM; -+ -+ for (i = 0; i < nxfers; i++) { -+ struct phytium_i3c_cmd *ccmd = &phytium_xfer->cmds[i]; -+ u32 pl_len = xfers[i].len; -+ -+ ccmd->cmd0 = CMD0_FIFO_DEV_ADDR(dev->info.dyn_addr) | -+ CMD0_FIFO_PRIV_XMIT_MODE(XMIT_BURST_WITHOUT_SUBADDR); -+ -+ if (xfers[i].rnw) { -+ ccmd->cmd0 |= CMD0_FIFO_RNW; -+ ccmd->rx_buf = xfers[i].data.in; -+ ccmd->rx_len = xfers[i].len; -+ pl_len++; -+ } else { -+ ccmd->tx_buf = xfers[i].data.out; -+ ccmd->tx_len = xfers[i].len; -+ } -+ -+ ccmd->cmd0 |= CMD0_FIFO_PL_LEN(pl_len); -+ -+ if (i < nxfers - 1) -+ ccmd->cmd0 |= CMD0_FIFO_RSBC; -+ -+ if (!i) -+ ccmd->cmd0 |= CMD0_FIFO_BCH; -+ } -+ -+ phytium_i3c_master_queue_xfer(master, phytium_xfer); -+ if (!wait_for_completion_timeout(&phytium_xfer->comp, -+ msecs_to_jiffies(1000))) -+ phytium_i3c_master_unqueue_xfer(master, phytium_xfer); -+ -+ ret = phytium_xfer->ret; -+ -+ for (i = 0; i < nxfers; i++) -+ xfers[i].err = phytium_i3c_cmd_get_err(&phytium_xfer->cmds[i]); -+ -+ phytium_i3c_master_free_xfer(phytium_xfer); -+ -+ return ret; -+} -+ -+static int phytium_i3c_master_i2c_xfers(struct i2c_dev_desc *dev, -+ const struct i2c_msg *xfers, int nxfers) -+{ -+ struct i3c_master_controller *m = i2c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ unsigned int nrxwords = 0, ntxwords = 0; -+ struct phytium_i3c_xfer *xfer; -+ int i, ret = 0; -+ -+ if (nxfers > master->caps.cmdfifodepth) -+ return -EOPNOTSUPP; -+ -+ for (i = 0; i < nxfers; i++) { -+ if (xfers[i].len > CMD0_FIFO_PL_LEN_MAX) -+ return -EOPNOTSUPP; -+ -+ if (xfers[i].flags & I2C_M_RD) -+ nrxwords += DIV_ROUND_UP(xfers[i].len, 4); -+ else -+ ntxwords += DIV_ROUND_UP(xfers[i].len, 4); -+ } -+ -+ if (ntxwords > master->caps.txfifodepth || -+ nrxwords > master->caps.rxfifodepth) -+ return -EOPNOTSUPP; -+ -+ xfer = phytium_i3c_master_alloc_xfer(master, nxfers); -+ if (!xfer) -+ return -ENOMEM; -+ -+ for (i = 0; i < nxfers; i++) { -+ struct phytium_i3c_cmd *ccmd = &xfer->cmds[i]; -+ -+ ccmd->cmd0 = CMD0_FIFO_DEV_ADDR(xfers[i].addr) | -+ CMD0_FIFO_PL_LEN(xfers[i].len) | -+ CMD0_FIFO_PRIV_XMIT_MODE(XMIT_BURST_WITHOUT_SUBADDR); -+ -+ if (xfers[i].flags & I2C_M_TEN) -+ ccmd->cmd0 |= CMD0_FIFO_IS_10B; -+ -+ if (xfers[i].flags & I2C_M_RD) { -+ ccmd->cmd0 |= CMD0_FIFO_RNW; -+ ccmd->rx_buf = xfers[i].buf; -+ ccmd->rx_len = xfers[i].len; -+ } else { -+ ccmd->tx_buf = xfers[i].buf; -+ ccmd->tx_len = xfers[i].len; -+ } -+ } -+ -+ phytium_i3c_master_queue_xfer(master, xfer); -+ if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) -+ phytium_i3c_master_unqueue_xfer(master, xfer); -+ -+ ret = xfer->ret; -+ phytium_i3c_master_free_xfer(xfer); -+ -+ return ret; -+} -+ -+struct phytium_i3c_i2c_dev_data { -+ u16 id; -+ s16 ibi; -+ struct i3c_generic_ibi_pool *ibi_pool; -+}; -+ -+static u32 prepare_rr0_dev_address(u32 addr) -+{ -+ u32 ret = (addr << 1) & 0xff; -+ -+ /* RR0[7:1] = addr[6:0] */ -+ ret |= (addr & GENMASK(6, 0)) << 1; -+ -+ /* RR0[15:13] = addr[9:7] */ -+ ret |= (addr & GENMASK(9, 7)) << 6; -+ -+ /* RR0[0] = ~XOR(addr[6:0]) */ -+ if (!(hweight8(addr & 0x7f) & 1)) -+ ret |= 1; -+ -+ return ret; -+} -+ -+static void phytium_i3c_master_upd_i3c_addr(struct i3c_dev_desc *dev) -+{ -+ struct i3c_master_controller *m = i3c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); -+ u32 rr; -+ -+ rr = prepare_rr0_dev_address(dev->info.dyn_addr ? -+ dev->info.dyn_addr : -+ dev->info.static_addr); -+ writel(DEV_ID_RR0_IS_I3C | rr, master->regs + DEV_ID_RR0(data->id)); -+} -+ -+static int phytium_i3c_master_get_rr_slot(struct phytium_i3c_master *master, -+ u8 dyn_addr) -+{ -+ unsigned long activedevs; -+ u32 rr; -+ int i; -+ -+ if (!dyn_addr) { -+ if (!master->free_rr_slots) -+ return -ENOSPC; -+ -+ return ffs(master->free_rr_slots) - 1; -+ } -+ -+ activedevs = readl(master->regs + DEVS_CTRL) & DEVS_CTRL_DEVS_ACTIVE_MASK; -+ activedevs &= ~BIT(0); -+ -+ for_each_set_bit(i, &activedevs, master->maxdevs + 1) { -+ rr = readl(master->regs + DEV_ID_RR0(i)); -+ if (!(rr & DEV_ID_RR0_IS_I3C) || -+ DEV_ID_RR0_GET_DEV_ADDR(rr) != dyn_addr) -+ continue; -+ -+ return i; -+ } -+ -+ return -EINVAL; -+} -+ -+static int phytium_i3c_master_reattach_i3c_dev(struct i3c_dev_desc *dev, -+ u8 old_dyn_addr) -+{ -+ phytium_i3c_master_upd_i3c_addr(dev); -+ -+ return 0; -+} -+ -+static int phytium_i3c_master_attach_i3c_dev(struct i3c_dev_desc *dev) -+{ -+ struct i3c_master_controller *m = i3c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ struct phytium_i3c_i2c_dev_data *data; -+ int slot; -+ -+ data = kzalloc(sizeof(*data), GFP_KERNEL); -+ if (!data) -+ return -ENOMEM; -+ -+ slot = phytium_i3c_master_get_rr_slot(master, dev->info.dyn_addr); -+ if (slot < 0) { -+ kfree(data); -+ return slot; -+ } -+ -+ data->ibi = -1; -+ data->id = slot; -+ i3c_dev_set_master_data(dev, data); -+ master->free_rr_slots &= ~BIT(slot); -+ -+ if (!dev->info.dyn_addr) { -+ phytium_i3c_master_upd_i3c_addr(dev); -+ writel(readl(master->regs + DEVS_CTRL) | -+ DEVS_CTRL_DEV_ACTIVE(data->id), -+ master->regs + DEVS_CTRL); -+ } -+ -+ return 0; -+} -+ -+static void phytium_i3c_master_detach_i3c_dev(struct i3c_dev_desc *dev) -+{ -+ struct i3c_master_controller *m = i3c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); -+ -+ writel(readl(master->regs + DEVS_CTRL) | -+ DEVS_CTRL_DEV_CLR(data->id), -+ master->regs + DEVS_CTRL); -+ -+ i3c_dev_set_master_data(dev, NULL); -+ master->free_rr_slots |= BIT(data->id); -+ kfree(data); -+} -+ -+static int phytium_i3c_master_attach_i2c_dev(struct i2c_dev_desc *dev) -+{ -+ struct i3c_master_controller *m = i2c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ struct phytium_i3c_i2c_dev_data *data; -+ int slot; -+ -+ slot = phytium_i3c_master_get_rr_slot(master, 0); -+ if (slot < 0) -+ return slot; -+ -+ data = kzalloc(sizeof(*data), GFP_KERNEL); -+ if (!data) -+ return -ENOMEM; -+ -+ data->id = slot; -+ master->free_rr_slots &= ~BIT(slot); -+ i2c_dev_set_master_data(dev, data); -+ -+ writel(prepare_rr0_dev_address(dev->addr), -+ master->regs + DEV_ID_RR0(data->id)); -+ writel(dev->lvr, master->regs + DEV_ID_RR2(data->id)); -+ writel(readl(master->regs + DEVS_CTRL) | -+ DEVS_CTRL_DEV_ACTIVE(data->id), -+ master->regs + DEVS_CTRL); -+ -+ return 0; -+} -+ -+static void phytium_i3c_master_detach_i2c_dev(struct i2c_dev_desc *dev) -+{ -+ struct i3c_master_controller *m = i2c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ struct phytium_i3c_i2c_dev_data *data = i2c_dev_get_master_data(dev); -+ -+ writel(readl(master->regs + DEVS_CTRL) | -+ DEVS_CTRL_DEV_CLR(data->id), -+ master->regs + DEVS_CTRL); -+ master->free_rr_slots |= BIT(data->id); -+ -+ i2c_dev_set_master_data(dev, NULL); -+ kfree(data); -+} -+ -+static void phytium_i3c_master_bus_cleanup(struct i3c_master_controller *m) -+{ -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ -+ phytium_i3c_master_disable(master); -+} -+ -+static void phytium_i3c_master_dev_rr_to_info(struct phytium_i3c_master *master, -+ unsigned int slot, -+ struct i3c_device_info *info) -+{ -+ u32 rr; -+ -+ memset(info, 0, sizeof(*info)); -+ rr = readl(master->regs + DEV_ID_RR0(slot)); -+ info->dyn_addr = DEV_ID_RR0_GET_DEV_ADDR(rr); -+ rr = readl(master->regs + DEV_ID_RR2(slot)); -+ info->dcr = rr; -+ info->bcr = rr >> 8; -+ info->pid = rr >> 16; -+ info->pid |= (u64)readl(master->regs + DEV_ID_RR1(slot)) << 16; -+} -+ -+static void phytium_i3c_master_upd_i3c_scl_lim(struct phytium_i3c_master *master) -+{ -+ struct i3c_master_controller *m = &master->base; -+ unsigned long i3c_lim_period, pres_step, ncycles; -+ struct i3c_bus *bus = i3c_master_get_bus(m); -+ unsigned long new_i3c_scl_lim = 0; -+ struct i3c_dev_desc *dev; -+ u32 prescl1, ctrl; -+ -+ i3c_bus_for_each_i3cdev(bus, dev) { -+ unsigned long max_fscl; -+ -+ max_fscl = max(I3C_CCC_MAX_SDR_FSCL(dev->info.max_read_ds), -+ I3C_CCC_MAX_SDR_FSCL(dev->info.max_write_ds)); -+ switch (max_fscl) { -+ case I3C_SDR1_FSCL_8MHZ: -+ max_fscl = 8000000; -+ break; -+ case I3C_SDR2_FSCL_6MHZ: -+ max_fscl = 6000000; -+ break; -+ case I3C_SDR3_FSCL_4MHZ: -+ max_fscl = 4000000; -+ break; -+ case I3C_SDR4_FSCL_2MHZ: -+ max_fscl = 2000000; -+ break; -+ case I3C_SDR0_FSCL_MAX: -+ default: -+ max_fscl = 0; -+ break; -+ } -+ -+ if (max_fscl && -+ (new_i3c_scl_lim > max_fscl || !new_i3c_scl_lim)) -+ new_i3c_scl_lim = max_fscl; -+ } -+ -+ /* Only update PRESCL_CTRL1 if the I3C SCL limitation has changed. */ -+ if (new_i3c_scl_lim == master->i3c_scl_lim) -+ return; -+ master->i3c_scl_lim = new_i3c_scl_lim; -+ if (!new_i3c_scl_lim) -+ return; -+ pres_step = 1000000000UL / (bus->scl_rate.i3c * 4); -+ -+ /* Configure PP_LOW to meet I3C slave limitations. */ -+ prescl1 = readl(master->regs + PRESCL_CTRL1) & -+ ~PRESCL_CTRL1_PP_LOW_MASK; -+ ctrl = readl(master->regs + CTRL); -+ -+ i3c_lim_period = DIV_ROUND_UP(1000000000, master->i3c_scl_lim); -+ ncycles = DIV_ROUND_UP(i3c_lim_period, pres_step); -+ if (ncycles < 4) -+ ncycles = 0; -+ else -+ ncycles -= 4; -+ -+ prescl1 |= PRESCL_CTRL1_PP_LOW(ncycles); -+ -+ /* Disable I3C master before updating PRESCL_CTRL1. */ -+ if (ctrl & CTRL_DEV_EN) -+ phytium_i3c_master_disable(master); -+ -+ writel(prescl1, master->regs + PRESCL_CTRL1); -+ -+ if (ctrl & CTRL_DEV_EN) -+ phytium_i3c_master_enable(master); -+} -+ -+static int phytium_i3c_master_do_daa(struct i3c_master_controller *m) -+{ -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ unsigned long olddevs, newdevs; -+ int ret, slot; -+ u8 addrs[MAX_DEVS] = { }; -+ u8 last_addr = 0; -+ -+ olddevs = readl(master->regs + DEVS_CTRL) & DEVS_CTRL_DEVS_ACTIVE_MASK; -+ olddevs |= BIT(0); -+ -+ /* Prepare RR slots before launching DAA. */ -+ for_each_clear_bit(slot, &olddevs, master->maxdevs + 1) { -+ ret = i3c_master_get_free_addr(m, last_addr + 1); -+ if (ret < 0) -+ return -ENOSPC; -+ -+ last_addr = ret; -+ addrs[slot] = last_addr; -+ writel(prepare_rr0_dev_address(last_addr) | DEV_ID_RR0_IS_I3C, -+ master->regs + DEV_ID_RR0(slot)); -+ writel(0, master->regs + DEV_ID_RR1(slot)); -+ writel(0, master->regs + DEV_ID_RR2(slot)); -+ } -+ -+ ret = i3c_master_entdaa_locked(&master->base); -+ if (ret && ret != I3C_ERROR_M2) -+ return ret; -+ -+ newdevs = readl(master->regs + DEVS_CTRL) & DEVS_CTRL_DEVS_ACTIVE_MASK; -+ newdevs &= ~olddevs; -+ -+ /* -+ * Clear all retaining registers filled during DAA. We already -+ * have the addressed assigned to them in the addrs array. -+ */ -+ for_each_set_bit(slot, &newdevs, master->maxdevs + 1) -+ i3c_master_add_i3c_dev_locked(m, addrs[slot]); -+ -+ /* -+ * Clear slots that ended up not being used. Can be caused by I3C -+ * device creation failure or when the I3C device was already known -+ * by the system but with a different address (in this case the device -+ * already has a slot and does not need a new one). -+ */ -+ writel(readl(master->regs + DEVS_CTRL) | -+ master->free_rr_slots << DEVS_CTRL_DEV_CLR_SHIFT, -+ master->regs + DEVS_CTRL); -+ i3c_master_defslvs_locked(&master->base); -+ -+ phytium_i3c_master_upd_i3c_scl_lim(master); -+ -+ /* Unmask Hot-Join and Mastership request interrupts. */ -+ i3c_master_enec_locked(m, I3C_BROADCAST_ADDR, -+ I3C_CCC_EVENT_HJ | I3C_CCC_EVENT_MR); -+ -+ return 0; -+} -+ -+static u8 phytium_i3c_master_calculate_thd_delay(struct phytium_i3c_master *master) -+{ -+ unsigned long sysclk_rate = clk_get_rate(master->sysclk); -+ u8 thd_delay = DIV_ROUND_UP(master->devdata->thd_delay_ns, -+ (NSEC_PER_SEC / sysclk_rate)); -+ -+ /* Every value greater than 3 is not valid. */ -+ if (thd_delay > THD_DELAY_MAX) -+ thd_delay = THD_DELAY_MAX; -+ -+ /* CTLR_THD_DEL value is encoded. */ -+ return (THD_DELAY_MAX - thd_delay); -+} -+ -+static int phytium_i3c_master_bus_init(struct i3c_master_controller *m) -+{ -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ unsigned long pres_step, sysclk_rate, max_i2cfreq; -+ struct i3c_bus *bus = i3c_master_get_bus(m); -+ u32 ctrl, prescl0, prescl1, pres, low; -+ struct i3c_device_info info = { }; -+ int ret, ncycles; -+ -+ switch (bus->mode) { -+ case I3C_BUS_MODE_PURE: -+ ctrl = CTRL_PURE_BUS_MODE; -+ break; -+ -+ case I3C_BUS_MODE_MIXED_FAST: -+ ctrl = CTRL_MIXED_FAST_BUS_MODE; -+ break; -+ -+ case I3C_BUS_MODE_MIXED_SLOW: -+ ctrl = CTRL_MIXED_SLOW_BUS_MODE; -+ break; -+ -+ default: -+ return -EINVAL; -+ } -+ -+ if (has_acpi_companion(master->dev)) { -+ writel(master->prescl0, master->regs + PRESCL_CTRL0); -+ writel(master->prescl1, master->regs + PRESCL_CTRL1); -+ } else { -+ sysclk_rate = clk_get_rate(master->sysclk); -+ -+ if (!sysclk_rate) -+ return -EINVAL; -+ -+ pres = DIV_ROUND_UP(sysclk_rate, (bus->scl_rate.i3c * 4)) - 1; -+ if (pres > PRESCL_CTRL0_MAX) -+ return -ERANGE; -+ -+ bus->scl_rate.i3c = sysclk_rate / ((pres + 1) * 4); -+ -+ prescl0 = PRESCL_CTRL0_I3C(pres); -+ -+ low = ((I3C_BUS_TLOW_OD_MIN_NS * sysclk_rate) / (pres + 1)) - 2; -+ prescl1 = PRESCL_CTRL1_OD_LOW(low); -+ -+ max_i2cfreq = bus->scl_rate.i2c; -+ -+ pres = (sysclk_rate / (max_i2cfreq * 5)) - 1; -+ if (pres > PRESCL_CTRL0_MAX) -+ return -ERANGE; -+ -+ bus->scl_rate.i2c = sysclk_rate / ((pres + 1) * 5); -+ -+ prescl0 |= PRESCL_CTRL0_I2C(pres); -+ writel(prescl0, master->regs + PRESCL_CTRL0); -+ master->prescl0 = prescl0; -+ -+ /* Calculate OD and PP low. */ -+ pres_step = 1000000000 / (bus->scl_rate.i3c * 4); -+ ncycles = DIV_ROUND_UP(I3C_BUS_TLOW_OD_MIN_NS, pres_step) - 2; -+ if (ncycles < 0) -+ ncycles = 0; -+ prescl1 = PRESCL_CTRL1_OD_LOW(ncycles); -+ writel(prescl1, master->regs + PRESCL_CTRL1); -+ master->prescl1 = prescl1; -+ } -+ /* Get an address for the master. */ -+ ret = i3c_master_get_free_addr(m, 0); -+ if (ret < 0) -+ return ret; -+ -+ writel(prepare_rr0_dev_address(ret) | DEV_ID_RR0_IS_I3C, -+ master->regs + DEV_ID_RR0(0)); -+ -+ phytium_i3c_master_dev_rr_to_info(master, 0, &info); -+ if (info.bcr & I3C_BCR_HDR_CAP) -+ info.hdr_cap = I3C_CCC_HDR_MODE(I3C_HDR_DDR); -+ -+ ret = i3c_master_set_info(&master->base, &info); -+ if (ret) -+ return ret; -+ -+ /* -+ * Enable Hot-Join, and, when a Hot-Join request happens, disable all -+ * events coming from this device. -+ * -+ * We will issue ENTDAA afterwards from the threaded IRQ handler. -+ */ -+ -+ ctrl |= CTRL_HJ_DISEC | CTRL_MCS_EN; -+ /* -+ * Configure data hold delay based on device-specific data. -+ * -+ * MIPI I3C Specification 1.0 defines non-zero minimal tHD_PP timing on -+ * master output. This setting allows to meet this timing on master's -+ * SoC outputs, regardless of PCB balancing. -+ */ -+ if (has_acpi_companion(master->dev)) -+ ctrl |= CTRL_THD_DELAY(master->ctrl_thd_del); -+ else -+ ctrl |= CTRL_THD_DELAY(phytium_i3c_master_calculate_thd_delay(master)); -+ -+ writel(ctrl, master->regs + CTRL); -+ -+ phytium_i3c_master_enable(master); -+ -+ return 0; -+} -+ -+static void phytium_i3c_master_handle_ibi(struct phytium_i3c_master *master, -+ u32 ibir) -+{ -+ struct phytium_i3c_i2c_dev_data *data; -+ bool data_consumed = false; -+ struct i3c_ibi_slot *slot; -+ u32 id = IBIR_SLVID(ibir); -+ struct i3c_dev_desc *dev; -+ size_t nbytes; -+ u8 *buf; -+ -+ /* -+ * FIXME: maybe we should report the FIFO OVF errors to the upper -+ * layer. -+ */ -+ if (id >= master->ibi.num_slots || (ibir & IBIR_ERROR)) -+ goto out; -+ -+ dev = master->ibi.slots[id]; -+ spin_lock(&master->ibi.lock); -+ -+ data = i3c_dev_get_master_data(dev); -+ slot = i3c_generic_ibi_get_free_slot(data->ibi_pool); -+ if (!slot) -+ goto out_unlock; -+ -+ buf = slot->data; -+ -+ nbytes = IBIR_XFER_BYTES(ibir); -+ readsl(master->regs + IBI_DATA_FIFO, buf, nbytes / 4); -+ if (nbytes % 3) { -+ u32 tmp = __raw_readl(master->regs + IBI_DATA_FIFO); -+ -+ memcpy(buf + (nbytes & ~3), &tmp, nbytes & 3); -+ } -+ -+ slot->len = min_t(unsigned int, IBIR_XFER_BYTES(ibir), -+ dev->ibi->max_payload_len); -+ i3c_master_queue_ibi(dev, slot); -+ data_consumed = true; -+ -+out_unlock: -+ spin_unlock(&master->ibi.lock); -+ -+out: -+ /* Consume data from the FIFO if it's not been done already. */ -+ if (!data_consumed) { -+ int i; -+ -+ for (i = 0; i < IBIR_XFER_BYTES(ibir); i += 4) -+ readl(master->regs + IBI_DATA_FIFO); -+ } -+} -+ -+static void phytium_i3c_master_demux_ibis(struct phytium_i3c_master *master) -+{ -+ u32 status0; -+ -+ writel(MST_INT_IBIR_THR, master->regs + MST_ICR); -+ -+ for (status0 = readl(master->regs + MST_STATUS0); -+ !(status0 & MST_STATUS0_IBIR_EMP); -+ status0 = readl(master->regs + MST_STATUS0)) { -+ u32 ibir = readl(master->regs + IBIR); -+ -+ switch (IBIR_TYPE(ibir)) { -+ case IBIR_TYPE_IBI: -+ phytium_i3c_master_handle_ibi(master, ibir); -+ break; -+ -+ case IBIR_TYPE_HJ: -+ WARN_ON(IBIR_XFER_BYTES(ibir) || (ibir & IBIR_ERROR)); -+ queue_work(master->base.wq, &master->hj_work); -+ break; -+ -+ case IBIR_TYPE_MR: -+ WARN_ON(IBIR_XFER_BYTES(ibir) || (ibir & IBIR_ERROR)); -+ break; -+ default: -+ break; -+ } -+ } -+} -+ -+static irqreturn_t phytium_i3c_master_interrupt(int irq, void *data) -+{ -+ struct phytium_i3c_master *master = data; -+ u32 status; -+ -+ status = readl(master->regs + MST_ISR); -+ if (!(status & readl(master->regs + MST_IMR))) -+ return IRQ_NONE; -+ -+ spin_lock(&master->xferqueue.lock); -+ phytium_i3c_master_end_xfer_locked(master, status); -+ spin_unlock(&master->xferqueue.lock); -+ -+ if (status & MST_INT_IBIR_THR) -+ phytium_i3c_master_demux_ibis(master); -+ -+ return IRQ_HANDLED; -+} -+ -+static int phytium_i3c_master_disable_ibi(struct i3c_dev_desc *dev) -+{ -+ struct i3c_master_controller *m = i3c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); -+ unsigned long flags; -+ u32 sirmap; -+ int ret; -+ -+ ret = i3c_master_disec_locked(m, dev->info.dyn_addr, -+ I3C_CCC_EVENT_SIR); -+ if (ret) -+ return ret; -+ -+ spin_lock_irqsave(&master->ibi.lock, flags); -+ sirmap = readl(master->regs + SIR_MAP_DEV_REG(data->ibi)); -+ sirmap &= ~SIR_MAP_DEV_CONF_MASK(data->ibi); -+ sirmap |= SIR_MAP_DEV_CONF(data->ibi, -+ SIR_MAP_DEV_DA(I3C_BROADCAST_ADDR)); -+ writel(sirmap, master->regs + SIR_MAP_DEV_REG(data->ibi)); -+ spin_unlock_irqrestore(&master->ibi.lock, flags); -+ -+ return ret; -+} -+ -+static int phytium_i3c_master_enable_ibi(struct i3c_dev_desc *dev) -+{ -+ struct i3c_master_controller *m = i3c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); -+ unsigned long flags; -+ u32 sircfg, sirmap; -+ int ret; -+ -+ spin_lock_irqsave(&master->ibi.lock, flags); -+ sirmap = readl(master->regs + SIR_MAP_DEV_REG(data->ibi)); -+ sirmap &= ~SIR_MAP_DEV_CONF_MASK(data->ibi); -+ sircfg = SIR_MAP_DEV_ROLE(dev->info.bcr >> 6) | -+ SIR_MAP_DEV_DA(dev->info.dyn_addr) | -+ SIR_MAP_DEV_PL(dev->info.max_ibi_len) | -+ SIR_MAP_DEV_ACK; -+ -+ if (dev->info.bcr & I3C_BCR_MAX_DATA_SPEED_LIM) -+ sircfg |= SIR_MAP_DEV_SLOW; -+ -+ sirmap |= SIR_MAP_DEV_CONF(data->ibi, sircfg); -+ writel(sirmap, master->regs + SIR_MAP_DEV_REG(data->ibi)); -+ spin_unlock_irqrestore(&master->ibi.lock, flags); -+ -+ ret = i3c_master_enec_locked(m, dev->info.dyn_addr, -+ I3C_CCC_EVENT_SIR); -+ if (ret) { -+ spin_lock_irqsave(&master->ibi.lock, flags); -+ sirmap = readl(master->regs + SIR_MAP_DEV_REG(data->ibi)); -+ sirmap &= ~SIR_MAP_DEV_CONF_MASK(data->ibi); -+ sirmap |= SIR_MAP_DEV_CONF(data->ibi, -+ SIR_MAP_DEV_DA(I3C_BROADCAST_ADDR)); -+ writel(sirmap, master->regs + SIR_MAP_DEV_REG(data->ibi)); -+ spin_unlock_irqrestore(&master->ibi.lock, flags); -+ } -+ -+ return ret; -+} -+ -+static int phytium_i3c_master_request_ibi(struct i3c_dev_desc *dev, -+ const struct i3c_ibi_setup *req) -+{ -+ struct i3c_master_controller *m = i3c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); -+ unsigned long flags; -+ unsigned int i; -+ -+ data->ibi_pool = i3c_generic_ibi_alloc_pool(dev, req); -+ if (IS_ERR(data->ibi_pool)) -+ return PTR_ERR(data->ibi_pool); -+ -+ spin_lock_irqsave(&master->ibi.lock, flags); -+ for (i = 0; i < master->ibi.num_slots; i++) { -+ if (!master->ibi.slots[i]) { -+ data->ibi = i; -+ master->ibi.slots[i] = dev; -+ break; -+ } -+ } -+ spin_unlock_irqrestore(&master->ibi.lock, flags); -+ -+ if (i < master->ibi.num_slots) -+ return 0; -+ -+ i3c_generic_ibi_free_pool(data->ibi_pool); -+ data->ibi_pool = NULL; -+ -+ return -ENOSPC; -+} -+ -+static void phytium_i3c_master_free_ibi(struct i3c_dev_desc *dev) -+{ -+ struct i3c_master_controller *m = i3c_dev_get_master(dev); -+ struct phytium_i3c_master *master = to_phytium_i3c_master(m); -+ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); -+ unsigned long flags; -+ -+ spin_lock_irqsave(&master->ibi.lock, flags); -+ master->ibi.slots[data->ibi] = NULL; -+ data->ibi = -1; -+ spin_unlock_irqrestore(&master->ibi.lock, flags); -+ -+ i3c_generic_ibi_free_pool(data->ibi_pool); -+} -+ -+static void phytium_i3c_master_recycle_ibi_slot(struct i3c_dev_desc *dev, -+ struct i3c_ibi_slot *slot) -+{ -+ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); -+ -+ i3c_generic_ibi_recycle_slot(data->ibi_pool, slot); -+} -+ -+static const struct i3c_master_controller_ops phytium_i3c_master_ops = { -+ .bus_init = phytium_i3c_master_bus_init, -+ .bus_cleanup = phytium_i3c_master_bus_cleanup, -+ .do_daa = phytium_i3c_master_do_daa, -+ .attach_i3c_dev = phytium_i3c_master_attach_i3c_dev, -+ .reattach_i3c_dev = phytium_i3c_master_reattach_i3c_dev, -+ .detach_i3c_dev = phytium_i3c_master_detach_i3c_dev, -+ .attach_i2c_dev = phytium_i3c_master_attach_i2c_dev, -+ .detach_i2c_dev = phytium_i3c_master_detach_i2c_dev, -+ .supports_ccc_cmd = phytium_i3c_master_supports_ccc_cmd, -+ .send_ccc_cmd = phytium_i3c_master_send_ccc_cmd, -+ .priv_xfers = phytium_i3c_master_priv_xfers, -+ .i2c_xfers = phytium_i3c_master_i2c_xfers, -+ .enable_ibi = phytium_i3c_master_enable_ibi, -+ .disable_ibi = phytium_i3c_master_disable_ibi, -+ .request_ibi = phytium_i3c_master_request_ibi, -+ .free_ibi = phytium_i3c_master_free_ibi, -+ .recycle_ibi_slot = phytium_i3c_master_recycle_ibi_slot, -+}; -+ -+static void phytium_i3c_master_hj(struct work_struct *work) -+{ -+ struct phytium_i3c_master *master = container_of(work, -+ struct phytium_i3c_master, -+ hj_work); -+ -+ i3c_master_do_daa(&master->base); -+} -+ -+static struct phytium_i3c_data phytium_i3c_devdata = { -+ .thd_delay_ns = 10, -+}; -+ -+static const struct of_device_id phytium_i3c_master_of_ids[] = { -+ { .compatible = "phytium,cdns-i3c-master", .data = &phytium_i3c_devdata }, -+ { /* sentinel */ }, -+}; -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_i3c_master_acpi_ids[] = { -+ { "PHYT0035", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_i3c_master_acpi_ids); -+#endif -+ -+static void phytium_i3c_master_controller_init(struct phytium_i3c_master *master) -+{ -+ int i; -+ -+ phytium_i3c_master_disable(master); -+ -+ writel(FLUSH_RX_FIFO | FLUSH_TX_FIFO | FLUSH_CMD_FIFO | -+ FLUSH_CMD_RESP, -+ master->regs + FLUSH_CTRL); -+ -+ writel(0xffffffff, master->regs + MST_IDR); -+ writel(0xffffffff, master->regs + SLV_IDR); -+ -+ writel(master->prescl0, master->regs + PRESCL_CTRL0); -+ writel(master->prescl1, master->regs + PRESCL_CTRL1); -+ -+ writel(IBIR_THR(1), master->regs + CMD_IBI_THR_CTRL); -+ writel(MST_INT_IBIR_THR, master->regs + MST_IER); -+ writel(master->dev_valid, master->regs + DEVS_CTRL); -+ -+ for (i = 0; i < PHYTIUM_I3C_DEV_MAX_NUM; i++) { -+ writel(master->devinfo[i].dev_rr0, master->regs + DEV_ID_RR0(i)); -+ writel(master->devinfo[i].dev_rr1, master->regs + DEV_ID_RR1(i)); -+ writel(master->devinfo[i].dev_rr2, master->regs + DEV_ID_RR2(i)); -+ } -+ -+ for (i = 0; i < PHYTIUM_I3C_CMDR_MAX_TIMES; i++) -+ readl(master->regs + CMDR); -+ -+ writel(master->ctrl_info, master->regs + CTRL); -+ -+ phytium_i3c_master_enable(master); -+} -+ -+static void phytium_i3c_master_store_dev(struct phytium_i3c_master *master) -+{ -+ int i; -+ -+ master->ctrl_info = readl(master->regs + CTRL); -+ master->dev_valid = readl(master->regs + DEVS_CTRL); -+ -+ for (i = 0; i < PHYTIUM_I3C_DEV_MAX_NUM; i++) { -+ master->devinfo[i].dev_rr0 = readl(master->regs + DEV_ID_RR0(i)); -+ master->devinfo[i].dev_rr1 = readl(master->regs + DEV_ID_RR1(i)); -+ master->devinfo[i].dev_rr2 = readl(master->regs + DEV_ID_RR2(i)); -+ } -+} -+ -+static int phytium_i3c_master_probe(struct platform_device *pdev) -+{ -+ struct phytium_i3c_master *master; -+ struct resource *res; -+ int ret, irq; -+ u32 val; -+ -+ master = devm_kzalloc(&pdev->dev, sizeof(*master), GFP_KERNEL); -+ if (!master) -+ return -ENOMEM; -+ -+ master->dev = &pdev->dev; -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ master->regs = devm_ioremap_resource(&pdev->dev, res); -+ -+ if (IS_ERR(master->regs)) -+ return PTR_ERR(master->regs); -+ -+ if (pdev->dev.of_node) { -+ master->devdata = of_device_get_match_data(&pdev->dev); -+ -+ if (!master->devdata) -+ return -EINVAL; -+ -+ -+ master->pclk = devm_clk_get(&pdev->dev, "pclk"); -+ if (IS_ERR(master->pclk)) -+ return PTR_ERR(master->pclk); -+ -+ master->sysclk = devm_clk_get(&pdev->dev, "sysclk"); -+ if (IS_ERR(master->sysclk)) -+ return PTR_ERR(master->sysclk); -+ -+ ret = clk_prepare_enable(master->pclk); -+ if (ret) -+ return ret; -+ -+ ret = clk_prepare_enable(master->sysclk); -+ if (ret) -+ goto err_disable_pclk; -+#ifdef CONFIG_ACPI -+ } else if (has_acpi_companion(&pdev->dev)) { -+ i3c_master_acpi_clk_params(ACPI_HANDLE(&pdev->dev), "SCLK", &master->prescl0, -+ &master->prescl1, &master->ctrl_thd_del); -+ -+ if (!master->prescl0) -+ goto err_disable_sysclk; -+ -+ master->base.bus.scl_rate.i2c = I3C_CONTROL_DEFAULT_I2C_SCL; -+ master->base.bus.scl_rate.i3c = I3C_BUS_MAX_I3C_SCL_RATE; -+ ACPI_COMPANION_SET(master->dev, ACPI_COMPANION(&pdev->dev)); -+#endif -+ } -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) -+ return irq; -+ -+ if (readl(master->regs + DEV_ID) != DEV_ID_I3C_MASTER) { -+ ret = -EINVAL; -+ goto err_disable_sysclk; -+ } -+ -+ spin_lock_init(&master->xferqueue.lock); -+ INIT_LIST_HEAD(&master->xferqueue.list); -+ -+ INIT_WORK(&master->hj_work, phytium_i3c_master_hj); -+ phytium_i3c_master_disable(master); -+ -+ writel(FLUSH_RX_FIFO | FLUSH_TX_FIFO | FLUSH_CMD_FIFO | -+ FLUSH_CMD_RESP, -+ master->regs + FLUSH_CTRL); -+ writel(0xffffffff, master->regs + MST_IDR); -+ writel(0xffffffff, master->regs + SLV_IDR); -+ ret = devm_request_irq(&pdev->dev, irq, phytium_i3c_master_interrupt, 0, -+ dev_name(&pdev->dev), master); -+ if (ret) -+ goto err_disable_sysclk; -+ -+ platform_set_drvdata(pdev, master); -+ -+ val = readl(master->regs + CONF_STATUS0); -+ -+ /* Device ID0 is reserved to describe this master. */ -+ master->maxdevs = CONF_STATUS0_DEVS_NUM(val); -+ master->free_rr_slots = GENMASK(master->maxdevs, 1); -+ -+ val = readl(master->regs + CONF_STATUS1); -+ master->caps.cmdfifodepth = CONF_STATUS1_CMD_DEPTH(val); -+ master->caps.rxfifodepth = CONF_STATUS1_RX_DEPTH(val); -+ master->caps.txfifodepth = CONF_STATUS1_TX_DEPTH(val); -+ master->caps.ibirfifodepth = CONF_STATUS0_IBIR_DEPTH(val); -+ master->caps.cmdrfifodepth = CONF_STATUS0_CMDR_DEPTH(val); -+ -+ spin_lock_init(&master->ibi.lock); -+ master->ibi.num_slots = CONF_STATUS1_IBI_HW_RES(val); -+ master->ibi.slots = devm_kcalloc(&pdev->dev, master->ibi.num_slots, -+ sizeof(*master->ibi.slots), -+ GFP_KERNEL); -+ if (!master->ibi.slots) { -+ ret = -ENOMEM; -+ goto err_disable_sysclk; -+ } -+ -+ writel(IBIR_THR(1), master->regs + CMD_IBI_THR_CTRL); -+ writel(MST_INT_IBIR_THR, master->regs + MST_IER); -+ writel(DEVS_CTRL_DEV_CLR_ALL, master->regs + DEVS_CTRL); -+ -+ ret = i3c_master_register(&master->base, &pdev->dev, -+ &phytium_i3c_master_ops, false); -+ if (ret) -+ goto err_disable_sysclk; -+ writel(readl(master->regs + CTRL) | CTRL_HJ_ACK, master->regs + CTRL); -+ phytium_i3c_master_store_dev(master); -+ -+ return 0; -+ -+err_disable_sysclk: -+ clk_disable_unprepare(master->sysclk); -+ -+err_disable_pclk: -+ clk_disable_unprepare(master->pclk); -+ -+ return ret; -+} -+ -+static int phytium_i3c_master_remove(struct platform_device *pdev) -+{ -+ struct phytium_i3c_master *master = platform_get_drvdata(pdev); -+ -+ i3c_master_unregister(&master->base); -+ -+ clk_disable_unprepare(master->sysclk); -+ clk_disable_unprepare(master->pclk); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_i3c_plat_suspend(struct device *dev) -+{ -+ struct phytium_i3c_master *master = dev_get_drvdata(dev); -+ -+ -+ phytium_i3c_master_disable(master); -+ -+ clk_disable_unprepare(master->sysclk); -+ clk_disable_unprepare(master->pclk); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_i3c_plat_resume(struct device *dev) -+{ -+ struct phytium_i3c_master *master = dev_get_drvdata(dev); -+ -+ phytium_i3c_master_controller_init(master); -+ -+ clk_prepare_enable(master->sysclk); -+ clk_prepare_enable(master->pclk); -+ -+ return 0; -+} -+ -+static const struct dev_pm_ops phytium_i3c_dev_pm_ops = { -+ SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_i3c_plat_suspend, -+ phytium_i3c_plat_resume) -+}; -+ -+static struct platform_driver phytium_i3c_master = { -+ .probe = phytium_i3c_master_probe, -+ .remove = phytium_i3c_master_remove, -+ .driver = { -+ .name = "phytium-i3c-master", -+ .of_match_table = phytium_i3c_master_of_ids, -+ .acpi_match_table = ACPI_PTR(phytium_i3c_master_acpi_ids), -+ .pm = &phytium_i3c_dev_pm_ops, -+ }, -+}; -+module_platform_driver(phytium_i3c_master); -+ -+MODULE_AUTHOR("Feng Jun "); -+MODULE_DESCRIPTION("Phytium I3C master driver"); -+MODULE_LICENSE("GPL"); -+MODULE_ALIAS("platform:phytium-i3c-master"); -diff --git a/drivers/iio/adc/Kconfig b/drivers/iio/adc/Kconfig -index 517b3db11..ac10acff2 100644 ---- a/drivers/iio/adc/Kconfig -+++ b/drivers/iio/adc/Kconfig -@@ -886,6 +886,18 @@ config PALMAS_GPADC - is used in smartphones and tablets and supports a 16 channel - general purpose ADC. - -+config PHYTIUM_ADC -+ tristate "Phytium ADC driver" -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ select IIO_BUFFER -+ select IIO_TRIGGERED_BUFFER -+ help -+ Say yes here to build support for Phytium analog to digital -+ converters (ADC). -+ -+ To compile this driver as a module, choose M here: the module -+ will be called phytium-adc. -+ - config QCOM_VADC_COMMON - tristate - -diff --git a/drivers/iio/adc/Makefile b/drivers/iio/adc/Makefile -index 2facf9793..5b411b68b 100644 ---- a/drivers/iio/adc/Makefile -+++ b/drivers/iio/adc/Makefile -@@ -82,6 +82,7 @@ obj-$(CONFIG_MXS_LRADC_ADC) += mxs-lradc-adc.o - obj-$(CONFIG_NAU7802) += nau7802.o - obj-$(CONFIG_NPCM_ADC) += npcm_adc.o - obj-$(CONFIG_PALMAS_GPADC) += palmas_gpadc.o -+obj-$(CONFIG_PHYTIUM_ADC) += phytium-adc.o - obj-$(CONFIG_QCOM_SPMI_ADC5) += qcom-spmi-adc5.o - obj-$(CONFIG_QCOM_SPMI_IADC) += qcom-spmi-iadc.o - obj-$(CONFIG_QCOM_SPMI_RRADC) += qcom-spmi-rradc.o -diff --git a/drivers/iio/adc/phytium-adc.c b/drivers/iio/adc/phytium-adc.c -new file mode 100644 -index 000000000..3d498e509 ---- /dev/null -+++ b/drivers/iio/adc/phytium-adc.c -@@ -0,0 +1,688 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium ADC device driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/* ADC register */ -+#define ADC_CTRL_REG 0x00 -+#define ADC_CTRL_REG_PD_EN BIT(31) -+#define ADC_CTRL_REG_CH_ONLY_S(x) ((x & 0x7) << 16) -+#define ADC_CTRL_REG_CLK_DIV(x) ((x) << 12) -+#define ADC_CTRL_REG_CHANNEL_EN(x) BIT((x) + 4) -+#define ADC_CTRL_REG_CH_ONLY_EN BIT(3) -+#define ADC_CTRL_REG_SINGLE_EN BIT(2) -+#define ADC_CTRL_REG_SINGLE_SEL BIT(1) -+#define ADC_CTRL_REG_SOC_EN BIT(0) -+#define ADC_INTER_REG 0x04 -+#define ADC_STATE_REG 0x08 -+#define ADC_STATE_REG_B_STA(x) ((x) << 8) -+#define ADC_STATE_REG_EOC_STA BIT(7) -+#define ADC_STATE_REG_S_STA(x) ((x) << 4) -+#define ADC_STATE_REG_SOC_STA BIT(3) -+#define ADC_STATE_REG_ERR_STA BIT(2) -+#define ADC_STATE_REG_COV_FINISH_STA BIT(1) -+#define ADC_STATE_REG_ADCCTL_BUSY_STA BIT(0) -+#define ADC_ERRCLR_REG 0x0c -+#define ADC_LEVEL_REG(x) (0x10 + ((x) << 2)) -+#define ADC_LEVEL_REG_HIGH_LEVEL(x) ((x) << 16) -+#define ADC_LEVEL_REG_LOW_LEVEL(x) (x) -+#define ADC_INTRMASK_REG 0x30 -+#define ADC_INTRMASK_REG_ERR_INTR_MASK BIT(24) -+#define ADC_INTRMASK_REG_ULIMIT_OFF(x) BIT(9 + ((x) << 1)) -+#define ADC_INTRMASK_REG_DLIMIT_MASK(x) BIT(8 + ((x) << 1)) -+#define ADC_INTRMASK_REG_COVFIN_MASK(x) BIT((x)) -+#define ADC_INTR_REG 0x34 -+#define ADC_INTR_REG_ERR BIT(24) -+#define ADC_INTR_REG_ULIMIT(x) BIT(9 + ((x) << 1)) -+#define ADC_INTR_REG_DLIMIT(x) BIT(8 + ((x) << 1)) -+#define ADC_INTR_REG_LIMIT_MASK GENMASK(23, 8) -+#define ADC_INTR_REG_COVFIN(x) BIT((x)) -+#define ADC_INTR_REG_COVFIN_MASK GENMASK(7, 0) -+#define ADC_COV_RESULT_REG(x) (0x38 + ((x) << 2)) -+#define ADC_COV_RESULT_REG_MASK GENMASK(9, 0) -+#define ADC_FINISH_CNT_REG(x) (0x58 + ((x) << 2)) -+#define ADC_HIS_LIMIT_REG(x) (0x78 + ((x) << 2)) -+ -+#define PHYTIUM_MAX_CHANNELS 8 -+#define PHYTIUM_ADC_TIMEOUT usecs_to_jiffies(1000 * 1000) -+ -+static const struct iio_event_spec phytium_adc_event[] = { -+ { -+ .type = IIO_EV_TYPE_THRESH, -+ .dir = IIO_EV_DIR_RISING, -+ .mask_separate = BIT(IIO_EV_INFO_VALUE), -+ }, { -+ .type = IIO_EV_TYPE_THRESH, -+ .dir = IIO_EV_DIR_FALLING, -+ .mask_separate = BIT(IIO_EV_INFO_VALUE), -+ }, -+}; -+ -+struct phytium_adc_data { -+ const struct iio_chan_spec *channels; -+ u8 num_channels; -+}; -+ -+struct phytium_adc { -+ struct device *dev; -+ void __iomem *regs; -+ struct clk *adc_clk; -+ -+ u32 interval; -+ u16 thresh_high[PHYTIUM_MAX_CHANNELS]; -+ u16 thresh_low[PHYTIUM_MAX_CHANNELS]; -+ u16 last_val[PHYTIUM_MAX_CHANNELS]; -+ const struct phytium_adc_data *data; -+ u16 *scan_data; -+ -+ struct completion completion; -+ struct mutex lock; -+}; -+ -+static ssize_t phytium_adc_show_conv_interval(struct iio_dev *indio_dev, -+ uintptr_t priv, -+ struct iio_chan_spec const *ch, -+ char *buf) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ return sprintf(buf, "%u\n", adc->interval); -+} -+ -+static ssize_t phytium_adc_store_conv_interval(struct iio_dev *indio_dev, -+ uintptr_t priv, -+ struct iio_chan_spec const *ch, -+ const char *buf, size_t len) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ u32 interval; -+ int ret; -+ -+ ret = kstrtou32(buf, 0, &interval); -+ if (ret < 0) -+ return ret; -+ -+ mutex_lock(&adc->lock); -+ adc->interval = interval; -+ mutex_unlock(&adc->lock); -+ -+ return len; -+} -+ -+static const struct iio_chan_spec_ext_info phytium_adc_ext_info[] = { -+ { -+ .name = "conv_interval", -+ .read = phytium_adc_show_conv_interval, -+ .write = phytium_adc_store_conv_interval, -+ }, -+ { /* sentinel */ } -+}; -+ -+static int phytium_adc_parse_properties(struct platform_device *pdev, struct phytium_adc *adc) -+{ -+ struct iio_chan_spec *chan_array; -+ struct fwnode_handle *fwnode; -+ struct phytium_adc_data *data; -+ unsigned int channel; -+ int num_channels; -+ int ret, i = 0; -+ -+ data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL); -+ if (!data) -+ return -ENOMEM; -+ -+ num_channels = device_get_child_node_count(&pdev->dev); -+ if (!num_channels) { -+ dev_err(&pdev->dev, "no channel children\n"); -+ return -ENODEV; -+ } -+ -+ if (num_channels > PHYTIUM_MAX_CHANNELS) { -+ dev_err(&pdev->dev, "num of channel children out of range\n"); -+ return -EINVAL; -+ } -+ -+ chan_array = devm_kcalloc(&pdev->dev, num_channels, sizeof(*chan_array), -+ GFP_KERNEL); -+ if (!chan_array) -+ return -ENOMEM; -+ -+ device_for_each_child_node(&pdev->dev, fwnode) { -+ ret = fwnode_property_read_u32(fwnode, "reg", &channel); -+ if (ret) -+ return ret; -+ -+ if (channel >= PHYTIUM_MAX_CHANNELS) -+ return -EINVAL; -+ -+ chan_array[i].type = IIO_VOLTAGE; -+ chan_array[i].indexed = 1; -+ chan_array[i].channel = channel; -+ chan_array[i].info_mask_separate = BIT(IIO_CHAN_INFO_RAW); -+ chan_array[i].event_spec = phytium_adc_event; -+ chan_array[i].num_event_specs = ARRAY_SIZE(phytium_adc_event); -+ chan_array[i].scan_index = channel; -+ chan_array[i].scan_type.sign = 'u'; -+ chan_array[i].scan_type.realbits = 10; -+ chan_array[i].scan_type.storagebits = 16; -+ chan_array[i].scan_type.endianness = IIO_LE; -+ chan_array[i].ext_info = phytium_adc_ext_info; -+ i++; -+ } -+ -+ data->num_channels = num_channels; -+ data->channels = chan_array; -+ adc->data = data; -+ -+ return 0; -+} -+ -+static void phytium_adc_start_stop(struct phytium_adc *adc, bool start) -+{ -+ u32 ctrl; -+ -+ ctrl = readl(adc->regs + ADC_CTRL_REG); -+ if (start) -+ ctrl |= ADC_CTRL_REG_SOC_EN | ADC_CTRL_REG_SINGLE_EN; -+ else -+ ctrl &= ~ADC_CTRL_REG_SOC_EN; -+ /* Start conversion */ -+ writel(ctrl, adc->regs + ADC_CTRL_REG); -+} -+ -+static void phytium_adc_power_setup(struct phytium_adc *adc, bool on) -+{ -+ u32 reg; -+ -+ reg = readl(adc->regs + ADC_CTRL_REG); -+ if (on) -+ reg &= ~ADC_CTRL_REG_PD_EN; -+ else -+ reg |= ADC_CTRL_REG_PD_EN; -+ writel(reg, adc->regs + ADC_CTRL_REG); -+} -+ -+static int phytium_adc_hw_init(struct phytium_adc *adc) -+{ -+ int ret; -+ u32 reg; -+ -+ ret = clk_prepare_enable(adc->adc_clk); -+ if (ret) -+ return ret; -+ -+ /* -+ * Setup ctrl register: -+ * - Power up conversion module -+ * - Set the division by 4 as default -+ */ -+ reg = ADC_CTRL_REG_CLK_DIV(4); -+ writel(reg, adc->regs + ADC_CTRL_REG); -+ -+ /* Set all the interrupt mask, unmask them when necessary. */ -+ writel(0x1ffffff, adc->regs + ADC_INTRMASK_REG); -+ -+ /* Set default conversion interval */ -+ adc->interval = (clk_get_rate(adc->adc_clk) * 1000) / NSEC_PER_SEC; -+ -+ phytium_adc_power_setup(adc, true); -+ -+ return 0; -+} -+ -+static void phytium_adc_intrmask_setup(struct phytium_adc *adc, unsigned long chan_mask, bool on) -+{ -+ u32 reg; -+ u16 limit_mask = 0; -+ int ch; -+ -+ for_each_set_bit(ch, &chan_mask, PHYTIUM_MAX_CHANNELS) -+ limit_mask |= BIT(ch << 1) | BIT((ch << 1) + 1); -+ -+ reg = readl(adc->regs + ADC_INTRMASK_REG); -+ if (on) -+ reg &= ~(ADC_INTRMASK_REG_ERR_INTR_MASK | -+ (limit_mask << 8) | chan_mask); -+ else -+ reg |= (ADC_INTRMASK_REG_ERR_INTR_MASK | -+ (limit_mask << 8) | chan_mask); -+ writel(reg, adc->regs + ADC_INTRMASK_REG); -+} -+ -+static void phytium_adc_single_conv_setup(struct phytium_adc *adc, u8 ch) -+{ -+ u32 reg; -+ -+ /* -+ * Setup control register: -+ * - Single conversion mode selection -+ * - Single conversion enable -+ * - Fixed channel conversion -+ * - Target channel -+ */ -+ reg = readl(adc->regs + ADC_CTRL_REG); -+ -+ /* Clean ch_only_s bits */ -+ reg &= ~ADC_CTRL_REG_CH_ONLY_S(7); -+ -+ /* Clean channel_en bit */ -+ reg &= 0xFFF00F; -+ -+ reg |= ADC_CTRL_REG_SINGLE_SEL | ADC_CTRL_REG_SINGLE_EN | -+ ADC_CTRL_REG_CH_ONLY_EN | ADC_CTRL_REG_CH_ONLY_S(ch) | ADC_CTRL_REG_CHANNEL_EN(ch); -+ writel(reg, adc->regs + ADC_CTRL_REG); -+} -+ -+static int phytium_adc_single_conv(struct iio_dev *indio_dev, u8 ch) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ int ret; -+ -+ ret = iio_device_claim_direct_mode(indio_dev); -+ if (ret) -+ return ret; -+ mutex_lock(&adc->lock); -+ -+ phytium_adc_intrmask_setup(adc, BIT(ch), true); -+ reinit_completion(&adc->completion); -+ phytium_adc_single_conv_setup(adc, ch); -+ phytium_adc_start_stop(adc, true); -+ -+ if (!wait_for_completion_timeout(&adc->completion, PHYTIUM_ADC_TIMEOUT)) -+ ret = -ETIMEDOUT; -+ -+ phytium_adc_start_stop(adc, false); -+ phytium_adc_intrmask_setup(adc, BIT(ch), false); -+ -+ mutex_unlock(&adc->lock); -+ iio_device_release_direct_mode(indio_dev); -+ -+ return ret; -+} -+ -+static int phytium_adc_read_raw(struct iio_dev *indio_dev, -+ struct iio_chan_spec const *chan, -+ int *val, int *val2, long mask) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ int ret; -+ -+ switch (mask) { -+ case IIO_CHAN_INFO_RAW: -+ if (chan->type != IIO_VOLTAGE) -+ return -EINVAL; -+ -+ ret = phytium_adc_single_conv(indio_dev, chan->channel); -+ if (ret) -+ return ret; -+ *val = adc->last_val[chan->channel]; -+ -+ return IIO_VAL_INT; -+ default: -+ return -EINVAL; -+ } -+} -+ -+static int phytium_read_thresh(struct iio_dev *indio_dev, -+ const struct iio_chan_spec *chan, -+ enum iio_event_type type, -+ enum iio_event_direction dir, -+ enum iio_event_info iinfo, int *val, int *val2) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ if (dir == IIO_EV_DIR_FALLING) -+ *val = adc->thresh_low[chan->channel]; -+ else -+ *val = adc->thresh_high[chan->channel]; -+ -+ return IIO_VAL_INT; -+} -+ -+static int phytium_write_thresh(struct iio_dev *indio_dev, -+ const struct iio_chan_spec *chan, -+ enum iio_event_type type, -+ enum iio_event_direction dir, -+ enum iio_event_info einfo, int val, int val2) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ u32 thresh; -+ -+ switch (dir) { -+ case IIO_EV_DIR_FALLING: -+ adc->thresh_low[chan->channel] = val; -+ thresh = readl(adc->regs + ADC_LEVEL_REG(chan->channel)) & 0x3ff0000; -+ thresh |= ADC_LEVEL_REG_LOW_LEVEL(val); -+ writel(thresh, adc->regs + ADC_LEVEL_REG(chan->channel)); -+ break; -+ case IIO_EV_DIR_RISING: -+ adc->thresh_high[chan->channel] = val; -+ thresh = readl(adc->regs + ADC_LEVEL_REG(chan->channel)) & 0xffff; -+ thresh |= ADC_LEVEL_REG_HIGH_LEVEL(val); -+ writel(thresh, adc->regs + ADC_LEVEL_REG(chan->channel)); -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int phytium_update_scan_mode(struct iio_dev *indio_dev, const unsigned long *mask) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ unsigned int n; -+ -+ n = bitmap_weight(mask, indio_dev->masklength); -+ -+ kfree(adc->scan_data); -+ adc->scan_data = kcalloc(n, sizeof(*adc->scan_data), GFP_KERNEL); -+ if (!adc->scan_data) -+ return -ENOMEM; -+ -+ return 0; -+} -+ -+static const u64 phytium_adc_event_codes[] = { -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 0, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 0, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 1, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 1, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 2, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 2, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 3, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 3, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 4, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 4, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 5, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 5, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 6, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 6, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 7, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), -+ IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 7, -+ IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), -+}; -+ -+static irqreturn_t phytium_adc_threaded_irq(int irq, void *data) -+{ -+ struct iio_dev *indio_dev = data; -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ s64 timestamp = iio_get_time_ns(indio_dev); -+ unsigned long status; -+ int ch; -+ u32 intr; -+ -+ intr = readl(adc->regs + ADC_INTR_REG); -+ -+ if (intr & ADC_INTR_REG_ERR) { -+ dev_err(adc->dev, "conversion error: ADC_INTR_REG(0x%x)\n", intr); -+ writel(ADC_INTR_REG_ERR, adc->regs + ADC_INTR_REG); -+ return IRQ_HANDLED; -+ } -+ -+ status = (intr & ADC_INTR_REG_LIMIT_MASK) >> 8; -+ if (status) { -+ for_each_set_bit(ch, &status, PHYTIUM_MAX_CHANNELS * 2) -+ iio_push_event(indio_dev, phytium_adc_event_codes[ch], timestamp); -+ } -+ -+ status = intr & ADC_INTR_REG_COVFIN_MASK; -+ if (status) { -+ for_each_set_bit(ch, &status, PHYTIUM_MAX_CHANNELS) -+ adc->last_val[ch] = readl(adc->regs + ADC_COV_RESULT_REG(ch)) & -+ ADC_COV_RESULT_REG_MASK; -+ -+ if (iio_buffer_enabled(indio_dev)) -+ iio_trigger_poll(indio_dev->trig); -+ else -+ complete(&adc->completion); -+ } -+ -+ /* Clear all the interrupts */ -+ writel(status, adc->regs + ADC_INTR_REG); -+ -+ return IRQ_HANDLED; -+} -+ -+static void phytium_adc_cont_conv_setup(struct phytium_adc *adc, -+ unsigned long chan_mask, -+ u32 interval) -+{ -+ u32 reg; -+ -+ /* -+ * Setup control register: -+ * - Continuous conversion mode -+ * - Multi-channel rotation mode -+ * - Channel enablement -+ */ -+ reg = readl(adc->regs + ADC_CTRL_REG); -+ reg &= ~(ADC_CTRL_REG_SINGLE_SEL | ADC_CTRL_REG_SINGLE_EN | -+ ADC_CTRL_REG_CH_ONLY_EN); -+ reg |= chan_mask << 4; -+ writel(reg, adc->regs + ADC_CTRL_REG); -+ -+ /* Setup interval between two conversions */ -+ writel(interval, adc->regs + ADC_INTER_REG); -+} -+ -+static int phytium_adc_preenable(struct iio_dev *indio_dev) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ unsigned long scan_mask = *indio_dev->active_scan_mask; -+ -+ phytium_adc_cont_conv_setup(adc, scan_mask & 0xff, adc->interval); -+ phytium_adc_intrmask_setup(adc, scan_mask & 0xff, true); -+ -+ return 0; -+} -+ -+static int phytium_adc_postenable(struct iio_dev *indio_dev) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ phytium_adc_start_stop(adc, true); -+ -+ return 0; -+} -+ -+static int phytium_adc_postdisable(struct iio_dev *indio_dev) -+{ -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ unsigned long scan_mask = *indio_dev->active_scan_mask; -+ -+ phytium_adc_start_stop(adc, false); -+ phytium_adc_intrmask_setup(adc, scan_mask & 0xff, false); -+ -+ return 0; -+} -+ -+static const struct iio_buffer_setup_ops phytium_buffer_setup_ops = { -+ .preenable = &phytium_adc_preenable, -+ .postenable = &phytium_adc_postenable, -+ .postdisable = &phytium_adc_postdisable, -+}; -+ -+static irqreturn_t phytium_adc_trigger_handler(int irq, void *p) -+{ -+ struct iio_poll_func *pf = p; -+ struct iio_dev *indio_dev = pf->indio_dev; -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ int i, j = 0; -+ -+ if (!adc->scan_data) -+ goto out; -+ -+ for_each_set_bit(i, indio_dev->active_scan_mask, indio_dev->masklength) -+ adc->scan_data[j++] = adc->last_val[i]; -+ -+ iio_push_to_buffers(indio_dev, adc->scan_data); -+ -+out: -+ iio_trigger_notify_done(indio_dev->trig); -+ -+ return IRQ_HANDLED; -+} -+ -+static const struct iio_info phytium_adc_iio_info = { -+ .read_raw = &phytium_adc_read_raw, -+ .read_event_value = &phytium_read_thresh, -+ .write_event_value = &phytium_write_thresh, -+ .update_scan_mode = &phytium_update_scan_mode, -+}; -+ -+static int phytium_adc_probe(struct platform_device *pdev) -+{ -+ struct phytium_adc *adc; -+ struct iio_dev *indio_dev; -+ struct device *dev = &pdev->dev; -+ struct resource *res; -+ int ret; -+ -+ indio_dev = devm_iio_device_alloc(dev, sizeof(*adc)); -+ if (!indio_dev) -+ return -ENOMEM; -+ -+ adc = iio_priv(indio_dev); -+ adc->dev = dev; -+ -+ ret = phytium_adc_parse_properties(pdev, adc); -+ if (ret) -+ return ret; -+ -+ mutex_init(&adc->lock); -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ adc->regs = devm_ioremap_resource(dev, res); -+ if (IS_ERR(adc->regs)) -+ return PTR_ERR(adc->regs); -+ -+ adc->adc_clk = devm_clk_get(dev, NULL); -+ if (IS_ERR(adc->adc_clk)) -+ return PTR_ERR(adc->adc_clk); -+ -+ init_completion(&adc->completion); -+ -+ indio_dev->name = dev_name(dev); -+ indio_dev->info = &phytium_adc_iio_info; -+ indio_dev->modes = INDIO_DIRECT_MODE; -+ indio_dev->channels = adc->data->channels; -+ indio_dev->num_channels = adc->data->num_channels; -+ -+ platform_set_drvdata(pdev, indio_dev); -+ -+ ret = devm_request_threaded_irq(adc->dev, platform_get_irq(pdev, 0), -+ NULL, phytium_adc_threaded_irq, IRQF_ONESHOT, -+ dev_name(dev), indio_dev); -+ if (ret) -+ return ret; -+ -+ ret = devm_iio_triggered_buffer_setup(dev, indio_dev, -+ &iio_pollfunc_store_time, -+ phytium_adc_trigger_handler, -+ &phytium_buffer_setup_ops); -+ if (ret) -+ return ret; -+ -+ ret = phytium_adc_hw_init(adc); -+ if (ret) { -+ dev_err(&pdev->dev, "failed to initialize Phytium ADC, %d\n", ret); -+ return ret; -+ } -+ -+ return iio_device_register(indio_dev); -+} -+ -+static int phytium_adc_remove(struct platform_device *pdev) -+{ -+ struct iio_dev *indio_dev = platform_get_drvdata(pdev); -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ phytium_adc_power_setup(adc, false); -+ iio_device_unregister(indio_dev); -+ kfree(adc->scan_data); -+ -+ return 0; -+} -+ -+static const struct of_device_id phytium_of_match[] = { -+ { .compatible = "phytium,adc", }, -+ { /* sentinel */ } -+}; -+MODULE_DEVICE_TABLE(of, phytium_of_match); -+ -+#ifdef CONFIG_PM -+static int phytium_adc_suspend(struct device *dev) -+{ -+ struct iio_dev *indio_dev = dev_get_drvdata(dev); -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ phytium_adc_power_setup(adc, false); -+ clk_disable_unprepare(adc->adc_clk); -+ -+ return 0; -+} -+ -+static int phytium_adc_resume(struct device *dev) -+{ -+ struct iio_dev *indio_dev = dev_get_drvdata(dev); -+ struct phytium_adc *adc = iio_priv(indio_dev); -+ -+ clk_prepare_enable(adc->adc_clk); -+ phytium_adc_power_setup(adc, true); -+ -+ return 0; -+} -+#endif -+ -+SIMPLE_DEV_PM_OPS(phytium_adc_pm_ops, phytium_adc_suspend, phytium_adc_resume); -+ -+static struct platform_driver phytium_adc_driver = { -+ .driver = { -+ .name = "phytium_adc", -+ .of_match_table = phytium_of_match, -+ .pm = &phytium_adc_pm_ops, -+ }, -+ .probe = phytium_adc_probe, -+ .remove = phytium_adc_remove, -+}; -+module_platform_driver(phytium_adc_driver); -+ -+MODULE_AUTHOR("Yang Liu "); -+MODULE_DESCRIPTION("Phytium ADC driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/input/keyboard/Kconfig b/drivers/input/keyboard/Kconfig -index 1d0c5f4c0..bd943d967 100644 ---- a/drivers/input/keyboard/Kconfig -+++ b/drivers/input/keyboard/Kconfig -@@ -809,4 +809,15 @@ config KEYBOARD_CYPRESS_SF - To compile this driver as a module, choose M here: the - module will be called cypress-sf. - -+config KEYBOARD_PHYTIUM -+ tristate "Phytium keypad support" -+ depends on ARCH_PHYTIUM -+ select INPUT_MATRIXKMAP -+ help -+ Say Y here if you want to enable support for Phytium keypad -+ port. -+ -+ To compile this driver as a module, choose M here: the -+ module will be called phytium_keypad. -+ - endif -diff --git a/drivers/input/keyboard/Makefile b/drivers/input/keyboard/Makefile -index aecef00c5..43ade5a0d 100644 ---- a/drivers/input/keyboard/Makefile -+++ b/drivers/input/keyboard/Makefile -@@ -51,6 +51,7 @@ obj-$(CONFIG_KEYBOARD_NSPIRE) += nspire-keypad.o - obj-$(CONFIG_KEYBOARD_OMAP) += omap-keypad.o - obj-$(CONFIG_KEYBOARD_OMAP4) += omap4-keypad.o - obj-$(CONFIG_KEYBOARD_OPENCORES) += opencores-kbd.o -+obj-$(CONFIG_KEYBOARD_PHYTIUM) += phytium-keypad.o - obj-$(CONFIG_KEYBOARD_PINEPHONE) += pinephone-keyboard.o - obj-$(CONFIG_KEYBOARD_PMIC8XXX) += pmic8xxx-keypad.o - obj-$(CONFIG_KEYBOARD_PXA27x) += pxa27x_keypad.o -diff --git a/drivers/input/keyboard/phytium-keypad.c b/drivers/input/keyboard/phytium-keypad.c -new file mode 100644 -index 000000000..8237c0051 ---- /dev/null -+++ b/drivers/input/keyboard/phytium-keypad.c -@@ -0,0 +1,583 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Driver for the Phytium keypad port. -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/* -+ * Keypad Controller registers -+ */ -+#define KPCR 0x00 /* Keypad Control Register */ -+ -+#define KPSR 0x04 /* Keypad Status Register */ -+#define KBD_STAT_KPKD (0x1 << 0) /* Key Press Interrupt Status bit (w1c) */ -+#define KBD_STAT_KPKR (0x1 << 1) /* Key Release Interrupt Status bit (w1c) */ -+#define KBD_STAT_KDSC (0x1 << 2) /* Key Depress Synch Chain Status bit (w1c)*/ -+#define KBD_STAT_KRSS (0x1 << 3) /* Key Release Synch Status bit (w1c)*/ -+#define KBD_STAT_KDIE (0x1 << 8) /* Key Depress Interrupt Enable Status bit */ -+#define KBD_STAT_KRIE (0x1 << 9) /* Key Release Interrupt Enable */ -+ -+#define KDDR 0x08 /* Keypad Data Direction Register */ -+#define KPDR 0x0C /* Keypad Data Register */ -+ -+#define MAX_MATRIX_KEY_ROWS 8 -+#define MAX_MATRIX_KEY_COLS 8 -+ -+#define MAX_MATRIX_KEY_NUM (MAX_MATRIX_KEY_ROWS * MAX_MATRIX_KEY_COLS) -+ -+struct phytium_keypad { -+ struct input_dev *input_dev; -+ void __iomem *mmio_base; -+ -+ int irq; -+ struct timer_list check_matrix_timer; -+ -+ /* -+ * The matrix is stable only if no changes are detected after -+ * PHYTIUM_KEYPAD_SCANS_FOR_STABILITY scans -+ */ -+#define PHYTIUM_KEYPAD_SCANS_FOR_STABILITY 3 -+ -+ int stable_count; -+ -+ bool enabled; -+ -+ unsigned int n_rows; -+ unsigned int n_cols; -+ int row_shift; -+ -+ /* Masks for enabled rows/cols */ -+ unsigned short rows_en_mask; -+ unsigned short cols_en_mask; -+ -+ unsigned short keycodes[MAX_MATRIX_KEY_NUM]; -+ -+ /* -+ * Matrix states: -+ * -stable: achieved after a complete debounce process. -+ * -unstable: used in the debouncing process. -+ */ -+ unsigned short matrix_stable_state[MAX_MATRIX_KEY_COLS]; -+ unsigned short matrix_unstable_state[MAX_MATRIX_KEY_COLS]; -+}; -+ -+static u32 phytium_read(struct phytium_keypad *keypad, int reg) -+{ -+ return readl(keypad->mmio_base + reg); -+} -+ -+static void phytium_write(struct phytium_keypad *keypad, u32 value, int reg) -+{ -+ writel(value, keypad->mmio_base + reg); -+} -+ -+/* Scan the matrix and return the new state in *matrix_volatile_state. */ -+static void phytium_keypad_scan_matrix(struct phytium_keypad *keypad, -+ unsigned short *matrix_volatile_state) -+{ -+ int col; -+ u32 reg_val; -+ -+ for (col = 0; col < keypad->n_cols; col++) { -+ if ((keypad->cols_en_mask & (1 << col)) == 0) -+ continue; -+ /* -+ * Discharge keypad capacitance: -+ * 2. write 0s on KDDR[KCD], configure columns as input. -+ */ -+ reg_val = phytium_read(keypad, KDDR); -+ reg_val = 0x00000000; -+ phytium_write(keypad, reg_val, KDDR); -+ -+ /* -+ * 3. Write a single column to 0, others to 1. -+ * 4. Sample row inputs and save data. -+ * 5. Repeat steps 3 - 4 for remaining columns. -+ */ -+ reg_val = 0; -+ reg_val |= (1 << (16 + col)); -+ phytium_write(keypad, reg_val, KDDR); -+ reg_val = phytium_read(keypad, KPDR); -+ reg_val = 0x00000000; -+ phytium_write(keypad, reg_val, KPDR); -+ -+ /* -+ * Delay added to avoid propagating the 0 from column to row -+ * when scanning. -+ */ -+ udelay(5); -+ -+ /* -+ * 1s in matrix_volatile_state[col] means key pressures -+ * throw data from non enabled rows. -+ */ -+ reg_val = phytium_read(keypad, KPDR); -+ matrix_volatile_state[col] = (~reg_val) & keypad->rows_en_mask; -+ } -+ -+ /* -+ * Return in standby mode: -+ * 6. write 0s to columns -+ */ -+ /* Configure columns as output, output 0 */ -+ reg_val = 0; -+ reg_val |= (keypad->cols_en_mask & 0xffff) << 16; -+ phytium_write(keypad, reg_val, KDDR); -+ phytium_write(keypad, 0x00000000, KPDR); -+} -+ -+/* -+ * Compare the new matrix state (volatile) with the stable one stored in -+ * keypad->matrix_stable_state and fire events if changes are detected. -+ */ -+static void phytium_keypad_fire_events(struct phytium_keypad *keypad, -+ unsigned short *matrix_volatile_state) -+{ -+ struct input_dev *input_dev = keypad->input_dev; -+ int row, col; -+ -+ for (col = 0; col < keypad->n_cols; col++) { -+ unsigned short bits_changed; -+ int code; -+ -+ if ((keypad->cols_en_mask & (1 << col)) == 0) -+ continue; /* Column is not enabled */ -+ -+ bits_changed = keypad->matrix_stable_state[col] ^ -+ matrix_volatile_state[col]; -+ -+ if (bits_changed == 0) -+ continue; /* Column does not contain changes */ -+ -+ for (row = 0; row < keypad->n_rows; row++) { -+ if ((keypad->rows_en_mask & (1 << row)) == 0) -+ continue; /* Row is not enabled */ -+ if ((bits_changed & (1 << row)) == 0) -+ continue; /* Row does not contain changes */ -+ -+ code = MATRIX_SCAN_CODE(row, col, keypad->row_shift); -+ input_event(input_dev, EV_MSC, MSC_SCAN, code); -+ input_report_key(input_dev, keypad->keycodes[code], -+ matrix_volatile_state[col] & (1 << row)); -+ dev_dbg(&input_dev->dev, "Event code: %d, val: %d", -+ keypad->keycodes[code], -+ matrix_volatile_state[col] & (1 << row)); -+ } -+ } -+ input_sync(input_dev); -+} -+ -+/* -+ * phytium_keypad_check_for_events is the timer handler. -+ */ -+static void phytium_keypad_check_for_events(struct timer_list *t) -+{ -+ struct phytium_keypad *keypad = from_timer(keypad, t, check_matrix_timer); -+ unsigned short matrix_volatile_state[MAX_MATRIX_KEY_COLS]; -+ u32 reg_val; -+ bool state_changed, is_zero_matrix; -+ int i; -+ -+ memset(matrix_volatile_state, 0, sizeof(matrix_volatile_state)); -+ -+ phytium_keypad_scan_matrix(keypad, matrix_volatile_state); -+ -+ state_changed = false; -+ for (i = 0; i < keypad->n_cols; i++) { -+ if ((keypad->cols_en_mask & (1 << i)) == 0) -+ continue; -+ -+ if (keypad->matrix_unstable_state[i] ^ matrix_volatile_state[i]) { -+ state_changed = true; -+ break; -+ } -+ } -+ -+ /* -+ * If the matrix state is changed from the previous scan -+ * (Re)Begin the debouncing process, saving the new state in -+ * keypad->matrix_unstable_state. -+ * else -+ * Increase the count of number of scans with a stable state. -+ */ -+ if (state_changed) { -+ memcpy(keypad->matrix_unstable_state, matrix_volatile_state, -+ sizeof(matrix_volatile_state)); -+ keypad->stable_count = 0; -+ } else { -+ keypad->stable_count++; -+ } -+ -+ /* -+ * If the matrix is not as stable as we want reschedule scan -+ * in the near future. -+ */ -+ if (keypad->stable_count < PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) { -+ mod_timer(&keypad->check_matrix_timer, -+ jiffies + msecs_to_jiffies(10)); -+ return; -+ } -+ -+ /* -+ * If the matrix state is stable, fire the events and save the new -+ * stable state. Note, if the matrix is kept stable for longer -+ * (keypad->stable_count > PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) all -+ * events have already been generated. -+ */ -+ if (keypad->stable_count == PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) { -+ phytium_keypad_fire_events(keypad, matrix_volatile_state); -+ memcpy(keypad->matrix_stable_state, matrix_volatile_state, -+ sizeof(matrix_volatile_state)); -+ } -+ -+ is_zero_matrix = true; -+ for (i = 0; i < keypad->n_cols; i++) { -+ if (matrix_volatile_state[i] != 0) { -+ is_zero_matrix = false; -+ break; -+ } -+ } -+ -+ if (is_zero_matrix) { -+ /* -+ * All keys have been released. Enable only the KDI -+ * interrupt for future key presses (clear the KDI -+ * status bit and its sync chain before that). -+ */ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val |= KBD_STAT_KPKD | KBD_STAT_KDSC; -+ phytium_write(keypad, reg_val, KPSR); -+ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val |= KBD_STAT_KDIE; -+ reg_val &= ~KBD_STAT_KRIE; -+ phytium_write(keypad, reg_val, KPSR); -+ } else { -+ /* -+ * Some keys are still pressed. Schedule a rescan in -+ * attempt to detect multiple key presses and enable -+ * the KRI interrupt to react quickly to key release -+ * event. -+ */ -+ mod_timer(&keypad->check_matrix_timer, -+ jiffies + msecs_to_jiffies(60)); -+ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val |= KBD_STAT_KPKR | KBD_STAT_KRSS; -+ phytium_write(keypad, reg_val, KPSR); -+ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val |= KBD_STAT_KRIE; -+ reg_val &= ~KBD_STAT_KDIE; -+ phytium_write(keypad, reg_val, KPSR); -+ } -+} -+ -+static irqreturn_t phytium_keypad_irq_handler(int irq, void *dev_id) -+{ -+ struct phytium_keypad *keypad = dev_id; -+ u32 reg_val; -+ -+ reg_val = phytium_read(keypad, KPSR); -+ /* Disable both interrupt types */ -+ reg_val &= ~(KBD_STAT_KRIE | KBD_STAT_KDIE); -+ /* Clear interrupts status bits */ -+ reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD; -+ phytium_write(keypad, reg_val, KPSR); -+ -+ if (keypad->enabled) { -+ /* The matrix is supposed to be changed */ -+ keypad->stable_count = 0; -+ -+ /* Schedule the scanning procedure near in the future */ -+ mod_timer(&keypad->check_matrix_timer, -+ jiffies + msecs_to_jiffies(2)); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static void phytium_keypad_config(struct phytium_keypad *keypad) -+{ -+ u32 reg_val; -+ -+ /* -+ * Include enabled rows in interrupt generation (KPCR[15:0]) -+ * Configure keypad columns as open-drain (KPCR[31:16]) -+ */ -+ reg_val = phytium_read(keypad, KPCR); -+ reg_val |= keypad->rows_en_mask & 0xffff; /* rows */ -+ reg_val |= (keypad->cols_en_mask & 0xffff) << 16; /* cols */ -+ phytium_write(keypad, reg_val, KPCR); -+ -+ /* Configure columns as output, output 0 */ -+ reg_val = 0; -+ reg_val |= (keypad->cols_en_mask & 0xffff) << 16; -+ phytium_write(keypad, reg_val, KDDR); -+ phytium_write(keypad, 0x00000000, KPDR); -+ -+ /* -+ * Clear Key Depress and Key Release status bit. -+ * Clear both synchronizer chain. -+ */ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD | -+ KBD_STAT_KDSC | KBD_STAT_KRSS; -+ phytium_write(keypad, reg_val, KPSR); -+ -+ /* Enable KDI and disable KRI (avoid false release events). */ -+ reg_val |= KBD_STAT_KDIE; -+ reg_val &= ~KBD_STAT_KRIE; -+ phytium_write(keypad, reg_val, KPSR); -+} -+ -+static void phytium_keypad_inhibit(struct phytium_keypad *keypad) -+{ -+ unsigned short reg_val; -+ -+ /* Inhibit KDI and KRI interrupts. */ -+ reg_val = phytium_read(keypad, KPSR); -+ reg_val &= ~(KBD_STAT_KRIE | KBD_STAT_KDIE); -+ reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD; -+ phytium_write(keypad, reg_val, KPSR); -+} -+ -+static void phytium_keypad_close(struct input_dev *dev) -+{ -+ struct phytium_keypad *keypad = input_get_drvdata(dev); -+ -+ /* Mark keypad as being inactive */ -+ keypad->enabled = false; -+ synchronize_irq(keypad->irq); -+ del_timer_sync(&keypad->check_matrix_timer); -+ -+ phytium_keypad_inhibit(keypad); -+} -+ -+static int phytium_keypad_open(struct input_dev *dev) -+{ -+ struct phytium_keypad *keypad = input_get_drvdata(dev); -+ -+ /* We became active from now */ -+ keypad->enabled = true; -+ -+ phytium_keypad_config(keypad); -+ -+ /* Sanity control, not all the rows must be activated now. */ -+ if ((phytium_read(keypad, KPDR) & keypad->rows_en_mask) == 0) { -+ dev_err(&dev->dev, -+ "too many keys pressed, control pins initialisation\n"); -+ goto open_err; -+ } -+ -+ return 0; -+ -+open_err: -+ phytium_keypad_close(dev); -+ return -EIO; -+} -+ -+#ifdef CONFIG_OF -+static const struct of_device_id phytium_keypad_of_match[] = { -+ { .compatible = "phytium,keypad", }, -+ { /* sentinel */ } -+}; -+MODULE_DEVICE_TABLE(of, phytium_keypad_of_match); -+#endif -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_keypad_acpi_match[] = { -+ { "PHYT0028", 0}, -+ {} -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_keypad_acpi_match); -+#endif -+ -+static int phytium_keypad_probe(struct platform_device *pdev) -+{ -+ const struct matrix_keymap_data *keymap_data = dev_get_platdata(&pdev->dev); -+ struct phytium_keypad *keypad; -+ struct input_dev *input_dev; -+ struct resource *res; -+ int irq, error, i, row, col; -+ -+ if (!keymap_data && !pdev->dev.of_node && !has_acpi_companion(&pdev->dev)) { -+ dev_err(&pdev->dev, "no keymap defined\n"); -+ return -EINVAL; -+ } -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) { -+ dev_err(&pdev->dev, "no irq defined in platform data\n"); -+ return irq; -+ } -+ -+ input_dev = devm_input_allocate_device(&pdev->dev); -+ if (!input_dev) { -+ dev_err(&pdev->dev, "failed to allocate the input device\n"); -+ return -ENOMEM; -+ } -+ -+ keypad = devm_kzalloc(&pdev->dev, sizeof(*keypad), GFP_KERNEL); -+ if (!keypad) -+ return -ENOMEM; -+ -+ keypad->input_dev = input_dev; -+ keypad->irq = irq; -+ keypad->stable_count = 0; -+ -+ timer_setup(&keypad->check_matrix_timer, -+ phytium_keypad_check_for_events, 0); -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ keypad->mmio_base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(keypad->mmio_base)) -+ return PTR_ERR(keypad->mmio_base); -+ -+ /* Init the Input device */ -+ input_dev->name = pdev->name; -+ input_dev->id.bustype = BUS_HOST; -+ input_dev->dev.parent = &pdev->dev; -+ input_dev->open = phytium_keypad_open; -+ input_dev->close = phytium_keypad_close; -+ -+ error = matrix_keypad_parse_properties(&pdev->dev, &keypad->n_rows, &keypad->n_cols); -+ if (error) { -+ dev_err(&pdev->dev, "failed to parse phytium kp params\n"); -+ return error; -+ } -+ -+ error = matrix_keypad_build_keymap(keymap_data, NULL, -+ keypad->n_rows, -+ keypad->n_cols, -+ keypad->keycodes, input_dev); -+ if (error) { -+ dev_err(&pdev->dev, "failed to build keymap\n"); -+ return error; -+ } -+ -+ keypad->row_shift = get_count_order(keypad->n_cols); -+ -+ /* Search for rows and cols enabled */ -+ for (row = 0; row < keypad->n_rows; row++) { -+ for (col = 0; col < keypad->n_cols; col++) { -+ i = MATRIX_SCAN_CODE(row, col, keypad->row_shift); -+ if (keypad->keycodes[i] != KEY_RESERVED) { -+ keypad->rows_en_mask |= 1 << row; -+ keypad->cols_en_mask |= 1 << col; -+ } -+ } -+ } -+ -+ __set_bit(EV_REP, input_dev->evbit); -+ input_set_capability(input_dev, EV_MSC, MSC_SCAN); -+ input_set_drvdata(input_dev, keypad); -+ -+ phytium_keypad_inhibit(keypad); -+ -+ error = devm_request_irq(&pdev->dev, irq, phytium_keypad_irq_handler, 0, -+ pdev->name, keypad); -+ if (error) { -+ dev_err(&pdev->dev, "failed to request IRQ\n"); -+ return error; -+ } -+ -+ /* Register the input device */ -+ error = input_register_device(input_dev); -+ if (error) { -+ dev_err(&pdev->dev, "failed to register input device\n"); -+ return error; -+ } -+ -+ platform_set_drvdata(pdev, keypad); -+ device_init_wakeup(&pdev->dev, 1); -+ -+ return 0; -+} -+ -+static int phytium_keypad_remove(struct platform_device *pdev) -+{ -+ struct phytium_keypad *keypad = platform_get_drvdata(pdev); -+ -+ input_unregister_device(keypad->input_dev); -+ devm_kfree(&pdev->dev, keypad); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_keypad_suspend(struct device *dev) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct phytium_keypad *keypad = platform_get_drvdata(pdev); -+ struct input_dev *input_dev = keypad->input_dev; -+ -+ mutex_lock(&input_dev->mutex); -+ -+ if (input_dev->users) -+ phytium_keypad_inhibit(keypad); -+ -+ mutex_unlock(&input_dev->mutex); -+ -+ if (device_may_wakeup(&pdev->dev)) -+ enable_irq_wake(keypad->irq); -+ -+ return 0; -+} -+ -+static int phytium_keypad_resume(struct device *dev) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct phytium_keypad *keypad = platform_get_drvdata(pdev); -+ struct input_dev *input_dev = keypad->input_dev; -+ int ret = 0; -+ -+ if (device_may_wakeup(&pdev->dev)) -+ disable_irq_wake(keypad->irq); -+ -+ mutex_lock(&input_dev->mutex); -+ -+ if (input_dev->users) -+ phytium_keypad_config(keypad); -+ -+ mutex_unlock(&input_dev->mutex); -+ -+ return ret; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_keypad_pm_ops, phytium_keypad_suspend, phytium_keypad_resume); -+ -+static struct platform_driver phytium_keypad_driver = { -+ .driver = { -+ .name = "phytium-keypad", -+ .pm = &phytium_keypad_pm_ops, -+ .of_match_table = of_match_ptr(phytium_keypad_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_keypad_acpi_match), -+ }, -+ .probe = phytium_keypad_probe, -+ .remove = phytium_keypad_remove, -+}; -+module_platform_driver(phytium_keypad_driver); -+ -+MODULE_AUTHOR("Song Wenting "); -+MODULE_DESCRIPTION("PHYTIUM Keypad Port Driver"); -+MODULE_LICENSE("GPL"); -+MODULE_ALIAS("platform:phytium-keypad"); -diff --git a/drivers/input/serio/Kconfig b/drivers/input/serio/Kconfig -index 17edc1597..50b5da6b6 100644 ---- a/drivers/input/serio/Kconfig -+++ b/drivers/input/serio/Kconfig -@@ -40,6 +40,18 @@ config SERIO_I8042 - To compile this driver as a module, choose M here: the - module will be called i8042. - -+config SERIO_PHYTIUM_PS2 -+ depends on SERIO -+ tristate "PHYTIUM PS/2 (keyboard and mouse)" -+ default y if ARCH_PHYTIUM -+ depends on PCI -+ help -+ This selects support for the PS/2 Host Controller on -+ Phytium SoCs. -+ -+ To compile this driver as a module, choose M here: the -+ module will be called phytium-ps2. -+ - config SERIO_SERPORT - tristate "Serial port line discipline" - default y -diff --git a/drivers/input/serio/Makefile b/drivers/input/serio/Makefile -index 6d97bad7b..958591822 100644 ---- a/drivers/input/serio/Makefile -+++ b/drivers/input/serio/Makefile -@@ -7,6 +7,7 @@ - - obj-$(CONFIG_SERIO) += serio.o - obj-$(CONFIG_SERIO_I8042) += i8042.o -+obj-$(CONFIG_SERIO_PHYTIUM_PS2) += phytium-ps2.o - obj-$(CONFIG_SERIO_PARKBD) += parkbd.o - obj-$(CONFIG_SERIO_SERPORT) += serport.o - obj-$(CONFIG_SERIO_CT82C710) += ct82c710.o -diff --git a/drivers/input/serio/phytium-ps2.c b/drivers/input/serio/phytium-ps2.c -new file mode 100644 -index 000000000..902dd7a04 ---- /dev/null -+++ b/drivers/input/serio/phytium-ps2.c -@@ -0,0 +1,186 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * Phytium PS/2 keyboard controller driver. -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define DRV_NAME "phytium_ps2_pci" -+ -+#define REG_STAT 0x0 -+#define REG_STAT_TX_TIMEOUT 0x1 -+#define REG_STAT_RX_TIMEOUT 0x2 -+#define REG_STAT_TX_FULL 0x4 -+#define REG_CTRL 0x4 -+#define REG_CTRL_RESET 0x1 -+#define REG_CTRL_TX_TIMEOUT 0x2 -+#define REG_CTRL_RX_TIMEOUT 0x4 -+#define REG_CTRL_RX_INTR 0x8 -+#define REG_INTR 0x8 -+#define REG_INTR_TIMEOUT 0x1 -+#define REG_INTR_RX 0x2 -+#define REG_TX 0xc -+#define REG_RX 0x10 -+#define REG_TIMER_VAL 0x14 -+ -+#define REG_CTRL_ENABLE (REG_CTRL_TX_TIMEOUT|REG_CTRL_RX_TIMEOUT|REG_CTRL_RX_INTR) -+#define REG_DATA_PARITY 0x100 -+ -+#define STAT_RX_COUNTER(stat) ((stat >> 8) & 0x1f) -+ -+struct phytium_ps2_data { -+ void __iomem *base; -+ struct serio *io; -+ struct pci_dev *dev; -+}; -+ -+static irqreturn_t phytium_ps2_irq(int irq, void *devid) -+{ -+ struct phytium_ps2_data *ps2if = devid; -+ u32 status, scancode, val = 0; -+ unsigned int flag; -+ int i, rxcount; -+ -+ status = readl(ps2if->base + REG_STAT); -+ if (!status) -+ return IRQ_NONE; -+ -+ /* Check if there is timeout interrupt */ -+ if (status & (REG_STAT_RX_TIMEOUT|REG_STAT_TX_TIMEOUT)) -+ val |= REG_INTR_TIMEOUT; -+ -+ rxcount = STAT_RX_COUNTER(status); -+ for (i = 0; i < rxcount; i++) { -+ scancode = readl(ps2if->base + REG_RX) & 0x1ff; -+ -+ if (rxcount <= 16 && scancode != 0x1ff) { -+ flag = ((scancode & REG_DATA_PARITY) ? SERIO_PARITY : 0); -+ serio_interrupt(ps2if->io, scancode & 0xff, flag); -+ } -+ } -+ -+ val |= REG_INTR_RX; -+ writel(val, ps2if->base + REG_INTR); -+ -+ return IRQ_HANDLED; -+} -+ -+int phytium_ps2_write(struct serio *serio, unsigned char val) -+{ -+ struct phytium_ps2_data *ps2if = serio->port_data; -+ unsigned int stat; -+ -+ do { -+ stat = readl(ps2if->base + REG_STAT); -+ cpu_relax(); -+ } while (stat & REG_STAT_TX_FULL); -+ -+ writel(val, ps2if->base + REG_TX); -+ -+ return 0; -+} -+ -+int phytium_ps2_open(struct serio *io) -+{ -+ struct phytium_ps2_data *ps2if = io->port_data; -+ -+ writel(REG_CTRL_RESET, ps2if->base + REG_CTRL); -+ /* Wait 4ms for the controller to be reset */ -+ usleep_range(4000, 6000); -+ writel(REG_CTRL_ENABLE, ps2if->base + REG_CTRL); -+ -+ return 0; -+} -+ -+void phytium_ps2_close(struct serio *io) -+{ -+ struct phytium_ps2_data *ps2if = io->port_data; -+ -+ writel(0, ps2if->base + REG_CTRL); -+} -+ -+static int phytium_pci_ps2_probe(struct pci_dev *pdev, const struct pci_device_id *id) -+{ -+ struct phytium_ps2_data *ps2if; -+ struct serio *serio; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ goto out; -+ -+ ret = pcim_iomap_regions(pdev, 0x1, DRV_NAME); -+ if (ret) -+ goto out; -+ -+ ps2if = devm_kzalloc(&pdev->dev, sizeof(struct phytium_ps2_data), GFP_KERNEL); -+ serio = kzalloc(sizeof(struct serio), GFP_KERNEL); -+ if (!ps2if || !serio) { -+ ret = -ENOMEM; -+ goto free; -+ } -+ -+ serio->id.type = SERIO_8042; -+ serio->write = phytium_ps2_write; -+ serio->open = phytium_ps2_open; -+ serio->close = phytium_ps2_close; -+ strscpy(serio->name, pci_name(pdev), sizeof(serio->name)); -+ strscpy(serio->phys, dev_name(&pdev->dev), sizeof(serio->phys)); -+ serio->port_data = ps2if; -+ serio->dev.parent = &pdev->dev; -+ ps2if->io = serio; -+ ps2if->dev = pdev; -+ ps2if->base = pcim_iomap_table(pdev)[0]; -+ -+ ret = devm_request_irq(&pdev->dev, pdev->irq, phytium_ps2_irq, -+ IRQF_SHARED, DRV_NAME, ps2if); -+ if (ret) { -+ dev_err(&pdev->dev, "could not request IRQ %d\n", pdev->irq); -+ goto free; -+ } -+ -+ pci_set_drvdata(pdev, ps2if); -+ serio_register_port(ps2if->io); -+ -+ return 0; -+ -+free: -+ kfree(serio); -+out: -+ return ret; -+} -+ -+static void phytium_pci_ps2_remove(struct pci_dev *pdev) -+{ -+ struct phytium_ps2_data *ps2if = pci_get_drvdata(pdev); -+ -+ serio_unregister_port(ps2if->io); -+ pcim_iounmap_regions(pdev, 0x1); -+} -+ -+static const struct pci_device_id phytium_pci_ps2_ids[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc34) }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(pci, phytium_pci_ps2_ids); -+ -+static struct pci_driver phytium_pci_ps2_driver = { -+ .name = DRV_NAME, -+ .id_table = phytium_pci_ps2_ids, -+ .probe = phytium_pci_ps2_probe, -+ .remove = phytium_pci_ps2_remove, -+}; -+module_pci_driver(phytium_pci_ps2_driver); -+ -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_DESCRIPTION("Phytium PCI PS/2 controller driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c -index bd0a596f9..6b96ac3b9 100644 ---- a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c -+++ b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c -@@ -3154,6 +3154,13 @@ static void arm_smmu_write_msi_msg(struct msi_desc *desc, struct msi_msg *msg) - doorbell = (((u64)msg->address_hi) << 32) | msg->address_lo; - doorbell &= MSI_CFG0_ADDR_MASK; - -+#ifdef CONFIG_PM_SLEEP -+ /* Saves the msg (base addr of msi irq) and restores it during resume */ -+ desc->msg.address_lo = msg->address_lo; -+ desc->msg.address_hi = msg->address_hi; -+ desc->msg.data = msg->data; -+#endif -+ - writeq_relaxed(doorbell, smmu->base + cfg[0]); - writel_relaxed(msg->data, smmu->base + cfg[1]); - writel_relaxed(ARM_SMMU_MEMATTR_DEVICE_nGnRE, smmu->base + cfg[2]); -@@ -3196,11 +3203,53 @@ static void arm_smmu_setup_msis(struct arm_smmu_device *smmu) - devm_add_action(dev, arm_smmu_free_msis, dev); - } - --static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu) -+#ifdef CONFIG_PM_SLEEP -+static void arm_smmu_resume_msis(struct arm_smmu_device *smmu) -+{ -+ struct msi_desc *desc; -+ struct device *dev = smmu->dev; -+ -+ if (!dev->msi.domain) -+ return; -+ -+ msi_for_each_desc(desc, dev, MSI_DESC_ASSOCIATED) { -+ switch (desc->msi_index) { -+ case EVTQ_MSI_INDEX: -+ case GERROR_MSI_INDEX: -+ case PRIQ_MSI_INDEX: { -+ phys_addr_t *cfg = arm_smmu_msi_cfg[desc->msi_index]; -+ struct msi_msg *msg = &desc->msg; -+ phys_addr_t doorbell = (((u64)msg->address_hi) << 32) | msg->address_lo; -+ -+ doorbell &= MSI_CFG0_ADDR_MASK; -+ writeq_relaxed(doorbell, smmu->base + cfg[0]); -+ writel_relaxed(msg->data, smmu->base + cfg[1]); -+ writel_relaxed(ARM_SMMU_MEMATTR_DEVICE_nGnRE, -+ smmu->base + cfg[2]); -+ break; -+ } -+ default: -+ continue; -+ } -+ } -+} -+#else -+static void arm_smmu_resume_msis(struct arm_smmu_device *smmu) -+{ -+} -+#endif -+ -+static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu, bool resume) - { - int irq, ret; - -- arm_smmu_setup_msis(smmu); -+ if (!resume) -+ arm_smmu_setup_msis(smmu); -+ else { -+ /* The irq doesn't need to be re-requested during resume */ -+ arm_smmu_resume_msis(smmu); -+ return; -+ } - - /* Request interrupt lines */ - irq = smmu->evtq.q.irq; -@@ -3242,7 +3291,7 @@ static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu) - } - } - --static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu) -+static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu, bool resume) - { - int ret, irq; - u32 irqen_flags = IRQ_CTRL_EVTQ_IRQEN | IRQ_CTRL_GERROR_IRQEN; -@@ -3269,7 +3318,7 @@ static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu) - if (ret < 0) - dev_warn(smmu->dev, "failed to enable combined irq\n"); - } else -- arm_smmu_setup_unique_irqs(smmu); -+ arm_smmu_setup_unique_irqs(smmu, resume); - - if (smmu->features & ARM_SMMU_FEAT_PRI) - irqen_flags |= IRQ_CTRL_PRIQ_IRQEN; -@@ -3294,7 +3343,7 @@ static int arm_smmu_device_disable(struct arm_smmu_device *smmu) - return ret; - } - --static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) -+static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool resume) - { - int ret; - u32 reg, enables; -@@ -3402,7 +3451,7 @@ static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) - } - } - -- ret = arm_smmu_setup_irqs(smmu); -+ ret = arm_smmu_setup_irqs(smmu, resume); - if (ret) { - dev_err(smmu->dev, "failed to setup irqs\n"); - return ret; -@@ -3412,7 +3461,7 @@ static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) - enables &= ~(CR0_EVTQEN | CR0_PRIQEN); - - /* Enable the SMMU interface, or ensure bypass */ -- if (!bypass || disable_bypass) { -+ if (!smmu->bypass || disable_bypass) { - enables |= CR0_SMMUEN; - } else { - ret = arm_smmu_update_gbpa(smmu, 0, GBPA_ABORT); -@@ -3797,6 +3846,26 @@ static void arm_smmu_rmr_install_bypass_ste(struct arm_smmu_device *smmu) - iort_put_rmr_sids(dev_fwnode(smmu->dev), &rmr_list); - } - -+#ifdef CONFIG_PM_SLEEP -+static int arm_smmu_suspend(struct device *dev) -+{ -+ /* -+ * The smmu is powered off and related registers are automatically -+ * cleared when suspend. No need to do anything. -+ */ -+ return 0; -+} -+ -+static int arm_smmu_resume(struct device *dev) -+{ -+ struct arm_smmu_device *smmu = dev_get_drvdata(dev); -+ -+ arm_smmu_device_reset(smmu, true); -+ -+ return 0; -+} -+#endif -+ - static int arm_smmu_device_probe(struct platform_device *pdev) - { - int irq, ret; -@@ -3804,7 +3873,6 @@ static int arm_smmu_device_probe(struct platform_device *pdev) - resource_size_t ioaddr; - struct arm_smmu_device *smmu; - struct device *dev = &pdev->dev; -- bool bypass; - - smmu = devm_kzalloc(dev, sizeof(*smmu), GFP_KERNEL); - if (!smmu) -@@ -3820,7 +3888,7 @@ static int arm_smmu_device_probe(struct platform_device *pdev) - } - - /* Set bypass mode according to firmware probing result */ -- bypass = !!ret; -+ smmu->bypass = !!ret; - - /* Base address */ - res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -@@ -3884,7 +3952,7 @@ static int arm_smmu_device_probe(struct platform_device *pdev) - arm_smmu_rmr_install_bypass_ste(smmu); - - /* Reset the device */ -- ret = arm_smmu_device_reset(smmu, bypass); -+ ret = arm_smmu_device_reset(smmu, false); - if (ret) - return ret; - -@@ -3928,6 +3996,16 @@ static const struct of_device_id arm_smmu_of_match[] = { - }; - MODULE_DEVICE_TABLE(of, arm_smmu_of_match); - -+#ifdef CONFIG_PM_SLEEP -+static const struct dev_pm_ops arm_smmu_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(arm_smmu_suspend, -+ arm_smmu_resume) -+}; -+#define ARM_SMMU_PM_OPS (&arm_smmu_pm_ops) -+#else -+#define ARM_SMMU_PM_OPS NULL -+#endif -+ - static void arm_smmu_driver_unregister(struct platform_driver *drv) - { - arm_smmu_sva_notifier_synchronize(); -@@ -3938,6 +4016,7 @@ static struct platform_driver arm_smmu_driver = { - .driver = { - .name = "arm-smmu-v3", - .of_match_table = arm_smmu_of_match, -+ .pm = ARM_SMMU_PM_OPS, - .suppress_bind_attrs = true, - }, - .probe = arm_smmu_device_probe, -diff --git a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h -index 9915850dd..07f2b0941 100644 ---- a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h -+++ b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h -@@ -682,6 +682,8 @@ struct arm_smmu_device { - - struct rb_root streams; - struct mutex streams_mutex; -+ -+ bool bypass; - }; - - struct arm_smmu_stream { -diff --git a/drivers/iommu/arm/arm-smmu/arm-smmu.c b/drivers/iommu/arm/arm-smmu/arm-smmu.c -index d6d1a2a55..ee910444b 100644 ---- a/drivers/iommu/arm/arm-smmu/arm-smmu.c -+++ b/drivers/iommu/arm/arm-smmu/arm-smmu.c -@@ -1363,6 +1363,19 @@ static struct iommu_device *arm_smmu_probe_device(struct device *dev) - return ERR_PTR(-ENODEV); - } - -+#ifdef CONFIG_ARCH_PHYTIUM -+ /* Phytium Ps17064 workaround patch */ -+ if ((read_cpuid_id() & MIDR_CPU_MODEL_MASK) == MIDR_PHYTIUM_PS17064) { -+ int num = fwspec->num_ids; -+ -+ for (i = 0; i < num; i++) { -+ u32 fwid = FWID_READ(fwspec->ids[i]); -+ -+ iommu_fwspec_add_ids(dev, &fwid, 1); -+ } -+ } -+#endif -+ - ret = -EINVAL; - for (i = 0; i < fwspec->num_ids; i++) { - u16 sid = FIELD_GET(ARM_SMMU_SMR_ID, fwspec->ids[i]); -diff --git a/drivers/iommu/arm/arm-smmu/arm-smmu.h b/drivers/iommu/arm/arm-smmu/arm-smmu.h -index 703fd5817..723532e24 100644 ---- a/drivers/iommu/arm/arm-smmu/arm-smmu.h -+++ b/drivers/iommu/arm/arm-smmu/arm-smmu.h -@@ -10,6 +10,7 @@ - #ifndef _ARM_SMMU_H - #define _ARM_SMMU_H - -+#include - #include - #include - #include -@@ -23,6 +24,10 @@ - #include - #include - -+#ifdef CONFIG_ARCH_PHYTIUM -+#define FWID_READ(id) (((u16)(id) >> 3) | (((id) >> 16 | 0x7000) << 16)) -+#endif -+ - /* Configuration registers */ - #define ARM_SMMU_GR0_sCR0 0x0 - #define ARM_SMMU_sCR0_VMID16EN BIT(31) -diff --git a/drivers/iommu/iommu.c b/drivers/iommu/iommu.c -index 3a67e6362..3a7e65742 100644 ---- a/drivers/iommu/iommu.c -+++ b/drivers/iommu/iommu.c -@@ -32,6 +32,9 @@ - #include - #include - #include -+#ifdef CONFIG_ARCH_PHYTIUM -+#include -+#endif - - #include "dma-iommu.h" - #include "iommu-priv.h" -@@ -198,6 +201,15 @@ static int __init iommu_subsys_init(void) - iommu_set_default_passthrough(false); - else - iommu_set_default_translated(false); -+#ifdef CONFIG_ARCH_PHYTIUM -+ /* -+ * Always set default iommu type to IOMMU_DOMAIN_IDENTITY -+ * on Phytium Ps17064 SoC to avoid unnecessary troubles -+ * introduced by the SMMU workaround. -+ */ -+ if ((read_cpuid_id() & MIDR_CPU_MODEL_MASK) == MIDR_PHYTIUM_PS17064) -+ iommu_set_default_passthrough(true); -+#endif - - if (iommu_default_passthrough() && cc_platform_has(CC_ATTR_MEM_ENCRYPT)) { - pr_info("Memory encryption detected - Disabling default IOMMU Passthrough\n"); -@@ -648,6 +660,19 @@ static int __init iommu_set_def_domain_type(char *str) - if (ret) - return ret; - -+#ifdef CONFIG_ARCH_PHYTIUM -+ /* -+ * Always set default iommu type to IOMMU_DOMAIN_IDENTITY -+ * on Phytium Ps17064 SoC to avoid unnecessary troubles -+ * introduced by the SMMU workaround. -+ */ -+ if ((read_cpuid_id() & MIDR_CPU_MODEL_MASK) == MIDR_PHYTIUM_PS17064) { -+ iommu_def_domain_type = IOMMU_DOMAIN_IDENTITY; -+ iommu_set_default_passthrough(true); -+ return 0; -+ } -+#endif -+ - if (pt) - iommu_set_default_passthrough(true); - else -diff --git a/drivers/irqchip/Kconfig b/drivers/irqchip/Kconfig -index f7149d0f3..0419a0800 100644 ---- a/drivers/irqchip/Kconfig -+++ b/drivers/irqchip/Kconfig -@@ -56,6 +56,12 @@ config ARM_GIC_V3_ITS_FSL_MC - depends on FSL_MC_BUS - default ARM_GIC_V3_ITS - -+config ARM_GIC_PHYTIUM_2500 -+ bool -+ select IRQ_DOMAIN_HIERARCHY -+ select PARTITION_PERCPU -+ select GENERIC_IRQ_EFFECTIVE_AFF_MASK -+ - config ARM_NVIC - bool - select IRQ_DOMAIN_HIERARCHY -@@ -679,4 +685,12 @@ config SUNPLUS_SP7021_INTC - chained controller, routing all interrupt source in P-Chip to - the primary controller on C-Chip. - -+config PHYTIUM_IXIC -+ bool "Phytium SoC PCI Legacy Interrupt Controller" -+ depends on ARCH_PHYTIUM -+ select IRQ_DOMAIN -+ select IRQ_DOMAIN_HIERARCHY -+ help -+ This enables support PCI Legacy Interrupt on Phytium SoC. -+ - endmenu -diff --git a/drivers/irqchip/Makefile b/drivers/irqchip/Makefile -index ffd945fe7..7b04778db 100644 ---- a/drivers/irqchip/Makefile -+++ b/drivers/irqchip/Makefile -@@ -34,6 +34,7 @@ obj-$(CONFIG_ARM_GIC_V3) += irq-gic-v3.o irq-gic-v3-mbi.o irq-gic-common.o - obj-$(CONFIG_ARM_GIC_V3_ITS) += irq-gic-v3-its.o irq-gic-v3-its-platform-msi.o irq-gic-v4.o - obj-$(CONFIG_ARM_GIC_V3_ITS_PCI) += irq-gic-v3-its-pci-msi.o - obj-$(CONFIG_ARM_GIC_V3_ITS_FSL_MC) += irq-gic-v3-its-fsl-mc-msi.o -+obj-$(CONFIG_ARM_GIC_PHYTIUM_2500) += irq-gic-phytium-2500.o irq-gic-phytium-2500-its.o - obj-$(CONFIG_PARTITION_PERCPU) += irq-partition-percpu.o - obj-$(CONFIG_HISILICON_IRQ_MBIGEN) += irq-mbigen.o - obj-$(CONFIG_ARM_NVIC) += irq-nvic.o -@@ -120,3 +121,4 @@ obj-$(CONFIG_IRQ_IDT3243X) += irq-idt3243x.o - obj-$(CONFIG_APPLE_AIC) += irq-apple-aic.o - obj-$(CONFIG_MCHP_EIC) += irq-mchp-eic.o - obj-$(CONFIG_SUNPLUS_SP7021_INTC) += irq-sp7021-intc.o -+obj-$(CONFIG_PHYTIUM_IXIC) += irq-phytium-ixic.o -diff --git a/drivers/irqchip/irq-gic-phytium-2500-its.c b/drivers/irqchip/irq-gic-phytium-2500-its.c -new file mode 100644 -index 000000000..d41edb9b9 ---- /dev/null -+++ b/drivers/irqchip/irq-gic-phytium-2500-its.c -@@ -0,0 +1,5694 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#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 "irq-gic-common.h" -+ -+#define ITS_FLAGS_CMDQ_NEEDS_FLUSHING (1ULL << 0) -+#define ITS_FLAGS_WORKAROUND_CAVIUM_22375 (1ULL << 1) -+#define ITS_FLAGS_WORKAROUND_CAVIUM_23144 (1ULL << 2) -+ -+#define RDIST_FLAGS_PROPBASE_NEEDS_FLUSHING (1 << 0) -+#define RDIST_FLAGS_RD_TABLES_PREALLOCATED (1 << 1) -+ -+#define RD_LOCAL_LPI_ENABLED BIT(0) -+#define RD_LOCAL_PENDTABLE_PREALLOCATED BIT(1) -+#define RD_LOCAL_MEMRESERVE_DONE BIT(2) -+ -+static u32 lpi_id_bits; -+ -+/* -+ * We allocate memory for PROPBASE to cover 2 ^ lpi_id_bits LPIs to -+ * deal with (one configuration byte per interrupt). PENDBASE has to -+ * be 64kB aligned (one bit per LPI, plus 8192 bits for SPI/PPI/SGI). -+ */ -+#define LPI_NRBITS lpi_id_bits -+#define LPI_PROPBASE_SZ ALIGN(BIT(LPI_NRBITS), SZ_64K) -+#define LPI_PENDBASE_SZ ALIGN(BIT(LPI_NRBITS) / 8, SZ_64K) -+ -+#define LPI_PROP_DEFAULT_PRIO GICD_INT_DEF_PRI -+ -+/* -+ * Collection structure - just an ID, and a redistributor address to -+ * ping. We use one per CPU as a bag of interrupts assigned to this -+ * CPU. -+ */ -+struct its_collection { -+ u64 target_address; -+ u16 col_id; -+}; -+ -+/* -+ * The ITS_BASER structure - contains memory information, cached -+ * value of BASER register configuration and ITS page size. -+ */ -+struct its_baser { -+ void *base; -+ u64 val; -+ u32 order; -+ u32 psz; -+}; -+ -+struct its_device; -+ -+/* -+ * The ITS structure - contains most of the infrastructure, with the -+ * top-level MSI domain, the command queue, the collections, and the -+ * list of devices writing to it. -+ * -+ * dev_alloc_lock has to be taken for device allocations, while the -+ * spinlock must be taken to parse data structures such as the device -+ * list. -+ */ -+struct its_node { -+ raw_spinlock_t lock; -+ struct mutex dev_alloc_lock; -+ struct list_head entry; -+ void __iomem *base; -+ void __iomem *sgir_base; -+ phys_addr_t phys_base; -+ struct its_cmd_block *cmd_base; -+ struct its_cmd_block *cmd_write; -+ struct its_baser tables[GITS_BASER_NR_REGS]; -+ struct its_collection *collections; -+ struct fwnode_handle *fwnode_handle; -+ u64 (*get_msi_base)(struct its_device *its_dev); -+ u64 typer; -+ u64 cbaser_save; -+ u32 ctlr_save; -+ u32 mpidr; -+ struct list_head its_device_list; -+ u64 flags; -+ unsigned long list_nr; -+ int numa_node; -+ unsigned int msi_domain_flags; -+ u32 pre_its_base; /* for Socionext Synquacer */ -+ int vlpi_redist_offset; -+}; -+ -+#define is_v4(its) (!!((its)->typer & GITS_TYPER_VLPIS)) -+#define is_v4_1(its) (!!((its)->typer & GITS_TYPER_VMAPP)) -+#define device_ids(its) (FIELD_GET(GITS_TYPER_DEVBITS, (its)->typer) + 1) -+ -+#define ITS_ITT_ALIGN SZ_256 -+ -+/* The maximum number of VPEID bits supported by VLPI commands */ -+#define ITS_MAX_VPEID_BITS \ -+ ({ \ -+ int nvpeid = 16; \ -+ if (gic_rdists->has_rvpeid && \ -+ gic_rdists->gicd_typer2 & GICD_TYPER2_VIL) \ -+ nvpeid = 1 + (gic_rdists->gicd_typer2 & \ -+ GICD_TYPER2_VID); \ -+ \ -+ nvpeid; \ -+ }) -+#define ITS_MAX_VPEID (1 << (ITS_MAX_VPEID_BITS)) -+ -+/* Convert page order to size in bytes */ -+#define PAGE_ORDER_TO_SIZE(o) (PAGE_SIZE << (o)) -+ -+struct event_lpi_map { -+ unsigned long *lpi_map; -+ u16 *col_map; -+ irq_hw_number_t lpi_base; -+ int nr_lpis; -+ raw_spinlock_t vlpi_lock; -+ struct its_vm *vm; -+ struct its_vlpi_map *vlpi_maps; -+ int nr_vlpis; -+}; -+ -+/* -+ * The ITS view of a device - belongs to an ITS, owns an interrupt -+ * translation table, and a list of interrupts. If it some of its -+ * LPIs are injected into a guest (GICv4), the event_map.vm field -+ * indicates which one. -+ */ -+struct its_device { -+ struct list_head entry; -+ struct its_node *its; -+ struct event_lpi_map event_map; -+ void *itt; -+ u32 nr_ites; -+ u32 device_id; -+ bool shared; -+}; -+ -+static struct { -+ raw_spinlock_t lock; -+ struct its_device *dev; -+ struct its_vpe **vpes; -+ int next_victim; -+} vpe_proxy; -+ -+struct cpu_lpi_count { -+ atomic_t managed; -+ atomic_t unmanaged; -+}; -+ -+static DEFINE_PER_CPU(struct cpu_lpi_count, cpu_lpi_count); -+ -+static LIST_HEAD(its_nodes); -+static DEFINE_RAW_SPINLOCK(its_lock); -+static struct rdists *gic_rdists; -+static struct irq_domain *its_parent; -+ -+static unsigned long its_list_map; -+static u16 vmovp_seq_num; -+static DEFINE_RAW_SPINLOCK(vmovp_lock); -+ -+static DEFINE_IDA(its_vpeid_ida); -+ -+#define gic_data_rdist() (raw_cpu_ptr(gic_rdists->rdist)) -+#define gic_data_rdist_cpu(cpu) (per_cpu_ptr(gic_rdists->rdist, cpu)) -+#define gic_data_rdist_rd_base() (gic_data_rdist()->rd_base) -+#define gic_data_rdist_vlpi_base() (gic_data_rdist_rd_base() + SZ_128K) -+ -+/* -+ * Skip ITSs that have no vLPIs mapped, unless we're on GICv4.1, as we -+ * always have vSGIs mapped. -+ */ -+static bool require_its_list_vmovp(struct its_vm *vm, struct its_node *its) -+{ -+ return (gic_rdists->has_rvpeid || vm->vlpi_count[its->list_nr]); -+} -+ -+static u16 get_its_list(struct its_vm *vm) -+{ -+ struct its_node *its; -+ unsigned long its_list = 0; -+ -+ list_for_each_entry(its, &its_nodes, entry) { -+ if (!is_v4(its)) -+ continue; -+ -+ if (require_its_list_vmovp(vm, its)) -+ __set_bit(its->list_nr, &its_list); -+ } -+ -+ return (u16)its_list; -+} -+ -+static inline u32 its_get_event_id(struct irq_data *d) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ -+ return d->hwirq - its_dev->event_map.lpi_base; -+} -+ -+static struct its_collection *dev_event_to_col(struct its_device *its_dev, -+ u32 event) -+{ -+ struct its_node *its = its_dev->its; -+ -+ return its->collections + its_dev->event_map.col_map[event]; -+} -+ -+static struct its_vlpi_map *dev_event_to_vlpi_map(struct its_device *its_dev, -+ u32 event) -+{ -+ if (WARN_ON_ONCE(event >= its_dev->event_map.nr_lpis)) -+ return NULL; -+ -+ return &its_dev->event_map.vlpi_maps[event]; -+} -+ -+static struct its_vlpi_map *get_vlpi_map(struct irq_data *d) -+{ -+ if (irqd_is_forwarded_to_vcpu(d)) { -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ u32 event = its_get_event_id(d); -+ -+ return dev_event_to_vlpi_map(its_dev, event); -+ } -+ -+ return NULL; -+} -+ -+static int vpe_to_cpuid_lock(struct its_vpe *vpe, unsigned long *flags) -+{ -+ raw_spin_lock_irqsave(&vpe->vpe_lock, *flags); -+ return vpe->col_idx; -+} -+ -+static void vpe_to_cpuid_unlock(struct its_vpe *vpe, unsigned long flags) -+{ -+ raw_spin_unlock_irqrestore(&vpe->vpe_lock, flags); -+} -+ -+static int irq_to_cpuid_lock(struct irq_data *d, unsigned long *flags) -+{ -+ struct its_vlpi_map *map = get_vlpi_map(d); -+ int cpu; -+ -+ if (map) { -+ cpu = vpe_to_cpuid_lock(map->vpe, flags); -+ } else { -+ /* Physical LPIs are already locked via the irq_desc lock */ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ -+ cpu = its_dev->event_map.col_map[its_get_event_id(d)]; -+ /* Keep GCC quiet... */ -+ *flags = 0; -+ } -+ -+ return cpu; -+} -+ -+static void irq_to_cpuid_unlock(struct irq_data *d, unsigned long flags) -+{ -+ struct its_vlpi_map *map = get_vlpi_map(d); -+ -+ if (map) -+ vpe_to_cpuid_unlock(map->vpe, flags); -+} -+ -+static struct its_collection *valid_col(struct its_collection *col) -+{ -+ if (WARN_ON_ONCE(col->target_address & GENMASK_ULL(15, 0))) -+ return NULL; -+ -+ return col; -+} -+ -+static struct its_vpe *valid_vpe(struct its_node *its, struct its_vpe *vpe) -+{ -+ if (valid_col(its->collections + vpe->col_idx)) -+ return vpe; -+ -+ return NULL; -+} -+ -+/* -+ * ITS command descriptors - parameters to be encoded in a command -+ * block. -+ */ -+struct its_cmd_desc { -+ union { -+ struct { -+ struct its_device *dev; -+ u32 event_id; -+ } its_inv_cmd; -+ -+ struct { -+ struct its_device *dev; -+ u32 event_id; -+ } its_clear_cmd; -+ -+ struct { -+ struct its_device *dev; -+ u32 event_id; -+ } its_int_cmd; -+ -+ struct { -+ struct its_device *dev; -+ int valid; -+ } its_mapd_cmd; -+ -+ struct { -+ struct its_collection *col; -+ int valid; -+ } its_mapc_cmd; -+ -+ struct { -+ struct its_device *dev; -+ u32 phys_id; -+ u32 event_id; -+ } its_mapti_cmd; -+ -+ struct { -+ struct its_device *dev; -+ struct its_collection *col; -+ u32 event_id; -+ } its_movi_cmd; -+ -+ struct { -+ struct its_device *dev; -+ u32 event_id; -+ } its_discard_cmd; -+ -+ struct { -+ struct its_collection *col; -+ } its_invall_cmd; -+ -+ struct { -+ struct its_vpe *vpe; -+ } its_vinvall_cmd; -+ -+ struct { -+ struct its_vpe *vpe; -+ struct its_collection *col; -+ bool valid; -+ } its_vmapp_cmd; -+ -+ struct { -+ struct its_vpe *vpe; -+ struct its_device *dev; -+ u32 virt_id; -+ u32 event_id; -+ bool db_enabled; -+ } its_vmapti_cmd; -+ -+ struct { -+ struct its_vpe *vpe; -+ struct its_device *dev; -+ u32 event_id; -+ bool db_enabled; -+ } its_vmovi_cmd; -+ -+ struct { -+ struct its_vpe *vpe; -+ struct its_collection *col; -+ u16 seq_num; -+ u16 its_list; -+ } its_vmovp_cmd; -+ -+ struct { -+ struct its_vpe *vpe; -+ } its_invdb_cmd; -+ -+ struct { -+ struct its_vpe *vpe; -+ u8 sgi; -+ u8 priority; -+ bool enable; -+ bool group; -+ bool clear; -+ } its_vsgi_cmd; -+ }; -+}; -+ -+/* -+ * The ITS command block, which is what the ITS actually parses. -+ */ -+struct its_cmd_block { -+ union { -+ u64 raw_cmd[4]; -+ __le64 raw_cmd_le[4]; -+ }; -+}; -+ -+#define ITS_CMD_QUEUE_SZ SZ_64K -+#define ITS_CMD_QUEUE_NR_ENTRIES (ITS_CMD_QUEUE_SZ / sizeof(struct its_cmd_block)) -+ -+typedef struct its_collection *(*its_cmd_builder_t)(struct its_node *, -+ struct its_cmd_block *, -+ struct its_cmd_desc *); -+ -+typedef struct its_vpe *(*its_cmd_vbuilder_t)(struct its_node *, -+ struct its_cmd_block *, -+ struct its_cmd_desc *); -+ -+static void its_mask_encode(u64 *raw_cmd, u64 val, int h, int l) -+{ -+ u64 mask = GENMASK_ULL(h, l); -+ *raw_cmd &= ~mask; -+ *raw_cmd |= (val << l) & mask; -+} -+ -+static void its_encode_cmd(struct its_cmd_block *cmd, u8 cmd_nr) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], cmd_nr, 7, 0); -+} -+ -+static void its_encode_devid(struct its_cmd_block *cmd, u32 devid) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], devid, 63, 32); -+} -+ -+static void its_encode_event_id(struct its_cmd_block *cmd, u32 id) -+{ -+ its_mask_encode(&cmd->raw_cmd[1], id, 31, 0); -+} -+ -+static void its_encode_phys_id(struct its_cmd_block *cmd, u32 phys_id) -+{ -+ its_mask_encode(&cmd->raw_cmd[1], phys_id, 63, 32); -+} -+ -+static void its_encode_size(struct its_cmd_block *cmd, u8 size) -+{ -+ its_mask_encode(&cmd->raw_cmd[1], size, 4, 0); -+} -+ -+static void its_encode_itt(struct its_cmd_block *cmd, u64 itt_addr) -+{ -+ its_mask_encode(&cmd->raw_cmd[2], itt_addr >> 8, 51, 8); -+} -+ -+static void its_encode_valid(struct its_cmd_block *cmd, int valid) -+{ -+ its_mask_encode(&cmd->raw_cmd[2], !!valid, 63, 63); -+} -+ -+static void its_encode_target(struct its_cmd_block *cmd, u64 target_addr) -+{ -+ its_mask_encode(&cmd->raw_cmd[2], target_addr >> 16, 51, 16); -+} -+ -+static void its_encode_collection(struct its_cmd_block *cmd, u16 col) -+{ -+ its_mask_encode(&cmd->raw_cmd[2], col, 15, 0); -+} -+ -+static void its_encode_vpeid(struct its_cmd_block *cmd, u16 vpeid) -+{ -+ its_mask_encode(&cmd->raw_cmd[1], vpeid, 47, 32); -+} -+ -+static void its_encode_virt_id(struct its_cmd_block *cmd, u32 virt_id) -+{ -+ its_mask_encode(&cmd->raw_cmd[2], virt_id, 31, 0); -+} -+ -+static void its_encode_db_phys_id(struct its_cmd_block *cmd, u32 db_phys_id) -+{ -+ its_mask_encode(&cmd->raw_cmd[2], db_phys_id, 63, 32); -+} -+ -+static void its_encode_db_valid(struct its_cmd_block *cmd, bool db_valid) -+{ -+ its_mask_encode(&cmd->raw_cmd[2], db_valid, 0, 0); -+} -+ -+static void its_encode_seq_num(struct its_cmd_block *cmd, u16 seq_num) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], seq_num, 47, 32); -+} -+ -+static void its_encode_its_list(struct its_cmd_block *cmd, u16 its_list) -+{ -+ its_mask_encode(&cmd->raw_cmd[1], its_list, 15, 0); -+} -+ -+static void its_encode_vpt_addr(struct its_cmd_block *cmd, u64 vpt_pa) -+{ -+ its_mask_encode(&cmd->raw_cmd[3], vpt_pa >> 16, 51, 16); -+} -+ -+static void its_encode_vpt_size(struct its_cmd_block *cmd, u8 vpt_size) -+{ -+ its_mask_encode(&cmd->raw_cmd[3], vpt_size, 4, 0); -+} -+ -+static void its_encode_vconf_addr(struct its_cmd_block *cmd, u64 vconf_pa) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], vconf_pa >> 16, 51, 16); -+} -+ -+static void its_encode_alloc(struct its_cmd_block *cmd, bool alloc) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], alloc, 8, 8); -+} -+ -+static void its_encode_ptz(struct its_cmd_block *cmd, bool ptz) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], ptz, 9, 9); -+} -+ -+static void its_encode_vmapp_default_db(struct its_cmd_block *cmd, -+ u32 vpe_db_lpi) -+{ -+ its_mask_encode(&cmd->raw_cmd[1], vpe_db_lpi, 31, 0); -+} -+ -+static void its_encode_vmovp_default_db(struct its_cmd_block *cmd, -+ u32 vpe_db_lpi) -+{ -+ its_mask_encode(&cmd->raw_cmd[3], vpe_db_lpi, 31, 0); -+} -+ -+static void its_encode_db(struct its_cmd_block *cmd, bool db) -+{ -+ its_mask_encode(&cmd->raw_cmd[2], db, 63, 63); -+} -+ -+static void its_encode_sgi_intid(struct its_cmd_block *cmd, u8 sgi) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], sgi, 35, 32); -+} -+ -+static void its_encode_sgi_priority(struct its_cmd_block *cmd, u8 prio) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], prio >> 4, 23, 20); -+} -+ -+static void its_encode_sgi_group(struct its_cmd_block *cmd, bool grp) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], grp, 10, 10); -+} -+ -+static void its_encode_sgi_clear(struct its_cmd_block *cmd, bool clr) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], clr, 9, 9); -+} -+ -+static void its_encode_sgi_enable(struct its_cmd_block *cmd, bool en) -+{ -+ its_mask_encode(&cmd->raw_cmd[0], en, 8, 8); -+} -+ -+static inline void its_fixup_cmd(struct its_cmd_block *cmd) -+{ -+ /* Let's fixup BE commands */ -+ cmd->raw_cmd_le[0] = cpu_to_le64(cmd->raw_cmd[0]); -+ cmd->raw_cmd_le[1] = cpu_to_le64(cmd->raw_cmd[1]); -+ cmd->raw_cmd_le[2] = cpu_to_le64(cmd->raw_cmd[2]); -+ cmd->raw_cmd_le[3] = cpu_to_le64(cmd->raw_cmd[3]); -+} -+ -+static struct its_collection *its_build_mapd_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ unsigned long itt_addr; -+ u8 size = ilog2(desc->its_mapd_cmd.dev->nr_ites); -+ -+ itt_addr = virt_to_phys(desc->its_mapd_cmd.dev->itt); -+ itt_addr = ALIGN(itt_addr, ITS_ITT_ALIGN); -+ -+ its_encode_cmd(cmd, GITS_CMD_MAPD); -+ its_encode_devid(cmd, desc->its_mapd_cmd.dev->device_id); -+ its_encode_size(cmd, size - 1); -+ its_encode_itt(cmd, itt_addr); -+ its_encode_valid(cmd, desc->its_mapd_cmd.valid); -+ -+ its_fixup_cmd(cmd); -+ -+ return NULL; -+} -+ -+static struct its_collection *its_build_mapc_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ its_encode_cmd(cmd, GITS_CMD_MAPC); -+ its_encode_collection(cmd, desc->its_mapc_cmd.col->col_id); -+ its_encode_target(cmd, desc->its_mapc_cmd.col->target_address); -+ its_encode_valid(cmd, desc->its_mapc_cmd.valid); -+ -+ its_fixup_cmd(cmd); -+ -+ return desc->its_mapc_cmd.col; -+} -+ -+static struct its_collection *its_build_mapti_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ struct its_collection *col; -+ -+ col = dev_event_to_col(desc->its_mapti_cmd.dev, -+ desc->its_mapti_cmd.event_id); -+ if (is_kdump_kernel()) -+ col->col_id = col->col_id % 65; -+ else -+ col->col_id = col->col_id % 64; -+ -+ its_encode_cmd(cmd, GITS_CMD_MAPTI); -+ its_encode_devid(cmd, desc->its_mapti_cmd.dev->device_id); -+ its_encode_event_id(cmd, desc->its_mapti_cmd.event_id); -+ its_encode_phys_id(cmd, desc->its_mapti_cmd.phys_id); -+ its_encode_collection(cmd, col->col_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_col(col); -+} -+ -+static struct its_collection *its_build_movi_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ struct its_collection *col; -+ -+ col = dev_event_to_col(desc->its_movi_cmd.dev, -+ desc->its_movi_cmd.event_id); -+ -+ its_encode_cmd(cmd, GITS_CMD_MOVI); -+ its_encode_devid(cmd, desc->its_movi_cmd.dev->device_id); -+ its_encode_event_id(cmd, desc->its_movi_cmd.event_id); -+ its_encode_collection(cmd, desc->its_movi_cmd.col->col_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_col(col); -+} -+ -+static struct its_collection *its_build_discard_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ struct its_collection *col; -+ -+ col = dev_event_to_col(desc->its_discard_cmd.dev, -+ desc->its_discard_cmd.event_id); -+ -+ its_encode_cmd(cmd, GITS_CMD_DISCARD); -+ its_encode_devid(cmd, desc->its_discard_cmd.dev->device_id); -+ its_encode_event_id(cmd, desc->its_discard_cmd.event_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_col(col); -+} -+ -+static struct its_collection *its_build_inv_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ struct its_collection *col; -+ -+ col = dev_event_to_col(desc->its_inv_cmd.dev, -+ desc->its_inv_cmd.event_id); -+ -+ its_encode_cmd(cmd, GITS_CMD_INV); -+ its_encode_devid(cmd, desc->its_inv_cmd.dev->device_id); -+ its_encode_event_id(cmd, desc->its_inv_cmd.event_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_col(col); -+} -+ -+static struct its_collection *its_build_int_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ struct its_collection *col; -+ -+ col = dev_event_to_col(desc->its_int_cmd.dev, -+ desc->its_int_cmd.event_id); -+ -+ its_encode_cmd(cmd, GITS_CMD_INT); -+ its_encode_devid(cmd, desc->its_int_cmd.dev->device_id); -+ its_encode_event_id(cmd, desc->its_int_cmd.event_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_col(col); -+} -+ -+static struct its_collection *its_build_clear_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ struct its_collection *col; -+ -+ col = dev_event_to_col(desc->its_clear_cmd.dev, -+ desc->its_clear_cmd.event_id); -+ -+ its_encode_cmd(cmd, GITS_CMD_CLEAR); -+ its_encode_devid(cmd, desc->its_clear_cmd.dev->device_id); -+ its_encode_event_id(cmd, desc->its_clear_cmd.event_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_col(col); -+} -+ -+static struct its_collection *its_build_invall_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ its_encode_cmd(cmd, GITS_CMD_INVALL); -+ its_encode_collection(cmd, desc->its_invall_cmd.col->col_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return desc->its_invall_cmd.col; -+} -+ -+static struct its_vpe *its_build_vinvall_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ its_encode_cmd(cmd, GITS_CMD_VINVALL); -+ its_encode_vpeid(cmd, desc->its_vinvall_cmd.vpe->vpe_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_vpe(its, desc->its_vinvall_cmd.vpe); -+} -+ -+static struct its_vpe *its_build_vmapp_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ unsigned long vpt_addr, vconf_addr; -+ u64 target; -+ bool alloc; -+ -+ its_encode_cmd(cmd, GITS_CMD_VMAPP); -+ its_encode_vpeid(cmd, desc->its_vmapp_cmd.vpe->vpe_id); -+ its_encode_valid(cmd, desc->its_vmapp_cmd.valid); -+ -+ if (!desc->its_vmapp_cmd.valid) { -+ if (is_v4_1(its)) { -+ alloc = !atomic_dec_return(&desc->its_vmapp_cmd.vpe->vmapp_count); -+ its_encode_alloc(cmd, alloc); -+ } -+ -+ goto out; -+ } -+ -+ vpt_addr = virt_to_phys(page_address(desc->its_vmapp_cmd.vpe->vpt_page)); -+ target = desc->its_vmapp_cmd.col->target_address + its->vlpi_redist_offset; -+ -+ its_encode_target(cmd, target); -+ its_encode_vpt_addr(cmd, vpt_addr); -+ its_encode_vpt_size(cmd, LPI_NRBITS - 1); -+ -+ if (!is_v4_1(its)) -+ goto out; -+ -+ vconf_addr = virt_to_phys(page_address(desc->its_vmapp_cmd.vpe->its_vm->vprop_page)); -+ -+ alloc = !atomic_fetch_inc(&desc->its_vmapp_cmd.vpe->vmapp_count); -+ -+ its_encode_alloc(cmd, alloc); -+ -+ /* -+ * GICv4.1 provides a way to get the VLPI state, which needs the vPE -+ * to be unmapped first, and in this case, we may remap the vPE -+ * back while the VPT is not empty. So we can't assume that the -+ * VPT is empty on map. This is why we never advertise PTZ. -+ */ -+ its_encode_ptz(cmd, false); -+ its_encode_vconf_addr(cmd, vconf_addr); -+ its_encode_vmapp_default_db(cmd, desc->its_vmapp_cmd.vpe->vpe_db_lpi); -+ -+out: -+ its_fixup_cmd(cmd); -+ -+ return valid_vpe(its, desc->its_vmapp_cmd.vpe); -+} -+ -+static struct its_vpe *its_build_vmapti_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ u32 db; -+ -+ if (!is_v4_1(its) && desc->its_vmapti_cmd.db_enabled) -+ db = desc->its_vmapti_cmd.vpe->vpe_db_lpi; -+ else -+ db = 1023; -+ -+ its_encode_cmd(cmd, GITS_CMD_VMAPTI); -+ its_encode_devid(cmd, desc->its_vmapti_cmd.dev->device_id); -+ its_encode_vpeid(cmd, desc->its_vmapti_cmd.vpe->vpe_id); -+ its_encode_event_id(cmd, desc->its_vmapti_cmd.event_id); -+ its_encode_db_phys_id(cmd, db); -+ its_encode_virt_id(cmd, desc->its_vmapti_cmd.virt_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_vpe(its, desc->its_vmapti_cmd.vpe); -+} -+ -+static struct its_vpe *its_build_vmovi_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ u32 db; -+ -+ if (!is_v4_1(its) && desc->its_vmovi_cmd.db_enabled) -+ db = desc->its_vmovi_cmd.vpe->vpe_db_lpi; -+ else -+ db = 1023; -+ -+ its_encode_cmd(cmd, GITS_CMD_VMOVI); -+ its_encode_devid(cmd, desc->its_vmovi_cmd.dev->device_id); -+ its_encode_vpeid(cmd, desc->its_vmovi_cmd.vpe->vpe_id); -+ its_encode_event_id(cmd, desc->its_vmovi_cmd.event_id); -+ its_encode_db_phys_id(cmd, db); -+ its_encode_db_valid(cmd, true); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_vpe(its, desc->its_vmovi_cmd.vpe); -+} -+ -+static struct its_vpe *its_build_vmovp_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ u64 target; -+ -+ target = desc->its_vmovp_cmd.col->target_address + its->vlpi_redist_offset; -+ its_encode_cmd(cmd, GITS_CMD_VMOVP); -+ its_encode_seq_num(cmd, desc->its_vmovp_cmd.seq_num); -+ its_encode_its_list(cmd, desc->its_vmovp_cmd.its_list); -+ its_encode_vpeid(cmd, desc->its_vmovp_cmd.vpe->vpe_id); -+ its_encode_target(cmd, target); -+ -+ if (is_v4_1(its)) { -+ its_encode_db(cmd, true); -+ its_encode_vmovp_default_db(cmd, desc->its_vmovp_cmd.vpe->vpe_db_lpi); -+ } -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_vpe(its, desc->its_vmovp_cmd.vpe); -+} -+ -+static struct its_vpe *its_build_vinv_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ struct its_vlpi_map *map; -+ -+ map = dev_event_to_vlpi_map(desc->its_inv_cmd.dev, -+ desc->its_inv_cmd.event_id); -+ -+ its_encode_cmd(cmd, GITS_CMD_INV); -+ its_encode_devid(cmd, desc->its_inv_cmd.dev->device_id); -+ its_encode_event_id(cmd, desc->its_inv_cmd.event_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_vpe(its, map->vpe); -+} -+ -+static struct its_vpe *its_build_vint_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ struct its_vlpi_map *map; -+ -+ map = dev_event_to_vlpi_map(desc->its_int_cmd.dev, -+ desc->its_int_cmd.event_id); -+ -+ its_encode_cmd(cmd, GITS_CMD_INT); -+ its_encode_devid(cmd, desc->its_int_cmd.dev->device_id); -+ its_encode_event_id(cmd, desc->its_int_cmd.event_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_vpe(its, map->vpe); -+} -+ -+static struct its_vpe *its_build_vclear_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ struct its_vlpi_map *map; -+ -+ map = dev_event_to_vlpi_map(desc->its_clear_cmd.dev, -+ desc->its_clear_cmd.event_id); -+ -+ its_encode_cmd(cmd, GITS_CMD_CLEAR); -+ its_encode_devid(cmd, desc->its_clear_cmd.dev->device_id); -+ its_encode_event_id(cmd, desc->its_clear_cmd.event_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_vpe(its, map->vpe); -+} -+ -+static struct its_vpe *its_build_invdb_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ if (WARN_ON(!is_v4_1(its))) -+ return NULL; -+ -+ its_encode_cmd(cmd, GITS_CMD_INVDB); -+ its_encode_vpeid(cmd, desc->its_invdb_cmd.vpe->vpe_id); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_vpe(its, desc->its_invdb_cmd.vpe); -+} -+ -+static struct its_vpe *its_build_vsgi_cmd(struct its_node *its, -+ struct its_cmd_block *cmd, -+ struct its_cmd_desc *desc) -+{ -+ if (WARN_ON(!is_v4_1(its))) -+ return NULL; -+ -+ its_encode_cmd(cmd, GITS_CMD_VSGI); -+ its_encode_vpeid(cmd, desc->its_vsgi_cmd.vpe->vpe_id); -+ its_encode_sgi_intid(cmd, desc->its_vsgi_cmd.sgi); -+ its_encode_sgi_priority(cmd, desc->its_vsgi_cmd.priority); -+ its_encode_sgi_group(cmd, desc->its_vsgi_cmd.group); -+ its_encode_sgi_clear(cmd, desc->its_vsgi_cmd.clear); -+ its_encode_sgi_enable(cmd, desc->its_vsgi_cmd.enable); -+ -+ its_fixup_cmd(cmd); -+ -+ return valid_vpe(its, desc->its_vsgi_cmd.vpe); -+} -+ -+static u64 its_cmd_ptr_to_offset(struct its_node *its, -+ struct its_cmd_block *ptr) -+{ -+ return (ptr - its->cmd_base) * sizeof(*ptr); -+} -+ -+static int its_queue_full(struct its_node *its) -+{ -+ int widx; -+ int ridx; -+ -+ widx = its->cmd_write - its->cmd_base; -+ ridx = readl_relaxed(its->base + GITS_CREADR) / sizeof(struct its_cmd_block); -+ -+ /* This is incredibly unlikely to happen, unless the ITS locks up. */ -+ if (((widx + 1) % ITS_CMD_QUEUE_NR_ENTRIES) == ridx) -+ return 1; -+ -+ return 0; -+} -+ -+static struct its_cmd_block *its_allocate_entry(struct its_node *its) -+{ -+ struct its_cmd_block *cmd; -+ u32 count = 1000000; /* 1s! */ -+ -+ while (its_queue_full(its)) { -+ count--; -+ if (!count) { -+ pr_err_ratelimited("ITS queue not draining\n"); -+ return NULL; -+ } -+ cpu_relax(); -+ udelay(1); -+ } -+ -+ cmd = its->cmd_write++; -+ -+ /* Handle queue wrapping */ -+ if (its->cmd_write == (its->cmd_base + ITS_CMD_QUEUE_NR_ENTRIES)) -+ its->cmd_write = its->cmd_base; -+ -+ /* Clear command */ -+ cmd->raw_cmd[0] = 0; -+ cmd->raw_cmd[1] = 0; -+ cmd->raw_cmd[2] = 0; -+ cmd->raw_cmd[3] = 0; -+ -+ return cmd; -+} -+ -+static struct its_cmd_block *its_post_commands(struct its_node *its) -+{ -+ u64 wr = its_cmd_ptr_to_offset(its, its->cmd_write); -+ -+ writel_relaxed(wr, its->base + GITS_CWRITER); -+ -+ return its->cmd_write; -+} -+ -+static void its_flush_cmd(struct its_node *its, struct its_cmd_block *cmd) -+{ -+ /* -+ * Make sure the commands written to memory are observable by -+ * the ITS. -+ */ -+ if (its->flags & ITS_FLAGS_CMDQ_NEEDS_FLUSHING) -+ gic_flush_dcache_to_poc(cmd, sizeof(*cmd)); -+ else -+ dsb(ishst); -+} -+ -+static int its_wait_for_range_completion(struct its_node *its, -+ u64 prev_idx, -+ struct its_cmd_block *to) -+{ -+ u64 rd_idx, to_idx, linear_idx; -+ u32 count = 1000000; /* 1s! */ -+ -+ /* Linearize to_idx if the command set has wrapped around */ -+ to_idx = its_cmd_ptr_to_offset(its, to); -+ if (to_idx < prev_idx) -+ to_idx += ITS_CMD_QUEUE_SZ; -+ -+ linear_idx = prev_idx; -+ -+ while (1) { -+ s64 delta; -+ -+ rd_idx = readl_relaxed(its->base + GITS_CREADR); -+ -+ /* -+ * Compute the read pointer progress, taking the -+ * potential wrap-around into account. -+ */ -+ delta = rd_idx - prev_idx; -+ if (rd_idx < prev_idx) -+ delta += ITS_CMD_QUEUE_SZ; -+ -+ linear_idx += delta; -+ if (linear_idx >= to_idx) -+ break; -+ -+ count--; -+ if (!count) { -+ pr_err_ratelimited("ITS queue timeout (%llu %llu)\n", -+ to_idx, linear_idx); -+ return -1; -+ } -+ prev_idx = rd_idx; -+ cpu_relax(); -+ udelay(1); -+ } -+ -+ return 0; -+} -+ -+/* Warning, macro hell follows */ -+#define BUILD_SINGLE_CMD_FUNC(name, buildtype, synctype, buildfn) \ -+void name(struct its_node *its, \ -+ buildtype builder, \ -+ struct its_cmd_desc *desc) \ -+{ \ -+ struct its_cmd_block *cmd, *sync_cmd, *next_cmd; \ -+ synctype *sync_obj; \ -+ unsigned long flags; \ -+ u64 rd_idx; \ -+ \ -+ raw_spin_lock_irqsave(&its->lock, flags); \ -+ \ -+ cmd = its_allocate_entry(its); \ -+ if (!cmd) { /* We're soooooo screewed... */ \ -+ raw_spin_unlock_irqrestore(&its->lock, flags); \ -+ return; \ -+ } \ -+ sync_obj = builder(its, cmd, desc); \ -+ its_flush_cmd(its, cmd); \ -+ \ -+ if (sync_obj) { \ -+ sync_cmd = its_allocate_entry(its); \ -+ if (!sync_cmd) \ -+ goto post; \ -+ \ -+ buildfn(its, sync_cmd, sync_obj); \ -+ its_flush_cmd(its, sync_cmd); \ -+ } \ -+ \ -+post: \ -+ rd_idx = readl_relaxed(its->base + GITS_CREADR); \ -+ next_cmd = its_post_commands(its); \ -+ raw_spin_unlock_irqrestore(&its->lock, flags); \ -+ \ -+ if (its_wait_for_range_completion(its, rd_idx, next_cmd)) \ -+ pr_err_ratelimited("ITS cmd %ps failed\n", builder); \ -+} -+ -+static void its_build_sync_cmd(struct its_node *its, -+ struct its_cmd_block *sync_cmd, -+ struct its_collection *sync_col) -+{ -+ its_encode_cmd(sync_cmd, GITS_CMD_SYNC); -+ its_encode_target(sync_cmd, sync_col->target_address); -+ -+ its_fixup_cmd(sync_cmd); -+} -+ -+static BUILD_SINGLE_CMD_FUNC(its_send_single_command, its_cmd_builder_t, -+ struct its_collection, its_build_sync_cmd) -+ -+static void its_build_vsync_cmd(struct its_node *its, -+ struct its_cmd_block *sync_cmd, -+ struct its_vpe *sync_vpe) -+{ -+ its_encode_cmd(sync_cmd, GITS_CMD_VSYNC); -+ its_encode_vpeid(sync_cmd, sync_vpe->vpe_id); -+ -+ its_fixup_cmd(sync_cmd); -+} -+ -+static BUILD_SINGLE_CMD_FUNC(its_send_single_vcommand, its_cmd_vbuilder_t, -+ struct its_vpe, its_build_vsync_cmd) -+ -+static void its_send_int(struct its_device *dev, u32 event_id) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_int_cmd.dev = dev; -+ desc.its_int_cmd.event_id = event_id; -+ -+ its_send_single_command(dev->its, its_build_int_cmd, &desc); -+} -+ -+static void its_send_clear(struct its_device *dev, u32 event_id) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_clear_cmd.dev = dev; -+ desc.its_clear_cmd.event_id = event_id; -+ -+ its_send_single_command(dev->its, its_build_clear_cmd, &desc); -+} -+ -+static void its_send_inv(struct its_device *dev, u32 event_id) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_inv_cmd.dev = dev; -+ desc.its_inv_cmd.event_id = event_id; -+ -+ its_send_single_command(dev->its, its_build_inv_cmd, &desc); -+} -+ -+static void its_send_mapd(struct its_device *dev, int valid) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_mapd_cmd.dev = dev; -+ desc.its_mapd_cmd.valid = !!valid; -+ -+ its_send_single_command(dev->its, its_build_mapd_cmd, &desc); -+} -+ -+static void its_send_mapc(struct its_node *its, struct its_collection *col, -+ int valid) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_mapc_cmd.col = col; -+ desc.its_mapc_cmd.valid = !!valid; -+ -+ its_send_single_command(its, its_build_mapc_cmd, &desc); -+} -+ -+static void its_send_mapti(struct its_device *dev, u32 irq_id, u32 id) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_mapti_cmd.dev = dev; -+ desc.its_mapti_cmd.phys_id = irq_id; -+ desc.its_mapti_cmd.event_id = id; -+ -+ its_send_single_command(dev->its, its_build_mapti_cmd, &desc); -+} -+ -+static void its_send_movi(struct its_device *dev, -+ struct its_collection *col, u32 id) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_movi_cmd.dev = dev; -+ desc.its_movi_cmd.col = col; -+ desc.its_movi_cmd.event_id = id; -+ -+ its_send_single_command(dev->its, its_build_movi_cmd, &desc); -+} -+ -+static void its_send_discard(struct its_device *dev, u32 id) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_discard_cmd.dev = dev; -+ desc.its_discard_cmd.event_id = id; -+ -+ its_send_single_command(dev->its, its_build_discard_cmd, &desc); -+} -+ -+static void its_send_invall(struct its_node *its, struct its_collection *col) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_invall_cmd.col = col; -+ -+ its_send_single_command(its, its_build_invall_cmd, &desc); -+} -+ -+static void its_send_vmapti(struct its_device *dev, u32 id) -+{ -+ struct its_vlpi_map *map = dev_event_to_vlpi_map(dev, id); -+ struct its_cmd_desc desc; -+ -+ desc.its_vmapti_cmd.vpe = map->vpe; -+ desc.its_vmapti_cmd.dev = dev; -+ desc.its_vmapti_cmd.virt_id = map->vintid; -+ desc.its_vmapti_cmd.event_id = id; -+ desc.its_vmapti_cmd.db_enabled = map->db_enabled; -+ -+ its_send_single_vcommand(dev->its, its_build_vmapti_cmd, &desc); -+} -+ -+static void its_send_vmovi(struct its_device *dev, u32 id) -+{ -+ struct its_vlpi_map *map = dev_event_to_vlpi_map(dev, id); -+ struct its_cmd_desc desc; -+ -+ desc.its_vmovi_cmd.vpe = map->vpe; -+ desc.its_vmovi_cmd.dev = dev; -+ desc.its_vmovi_cmd.event_id = id; -+ desc.its_vmovi_cmd.db_enabled = map->db_enabled; -+ -+ its_send_single_vcommand(dev->its, its_build_vmovi_cmd, &desc); -+} -+ -+static void its_send_vmapp(struct its_node *its, -+ struct its_vpe *vpe, bool valid) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_vmapp_cmd.vpe = vpe; -+ desc.its_vmapp_cmd.valid = valid; -+ desc.its_vmapp_cmd.col = &its->collections[vpe->col_idx]; -+ -+ its_send_single_vcommand(its, its_build_vmapp_cmd, &desc); -+} -+ -+static void its_send_vmovp(struct its_vpe *vpe) -+{ -+ struct its_cmd_desc desc = {}; -+ struct its_node *its; -+ unsigned long flags; -+ int col_id = vpe->col_idx; -+ -+ desc.its_vmovp_cmd.vpe = vpe; -+ -+ if (!its_list_map) { -+ its = list_first_entry(&its_nodes, struct its_node, entry); -+ desc.its_vmovp_cmd.col = &its->collections[col_id]; -+ its_send_single_vcommand(its, its_build_vmovp_cmd, &desc); -+ return; -+ } -+ -+ /* -+ * Yet another marvel of the architecture. If using the -+ * its_list "feature", we need to make sure that all ITSs -+ * receive all VMOVP commands in the same order. The only way -+ * to guarantee this is to make vmovp a serialization point. -+ * -+ * Wall <-- Head. -+ */ -+ raw_spin_lock_irqsave(&vmovp_lock, flags); -+ -+ desc.its_vmovp_cmd.seq_num = vmovp_seq_num++; -+ desc.its_vmovp_cmd.its_list = get_its_list(vpe->its_vm); -+ -+ /* Emit VMOVPs */ -+ list_for_each_entry(its, &its_nodes, entry) { -+ if (!is_v4(its)) -+ continue; -+ -+ if (!require_its_list_vmovp(vpe->its_vm, its)) -+ continue; -+ -+ desc.its_vmovp_cmd.col = &its->collections[col_id]; -+ its_send_single_vcommand(its, its_build_vmovp_cmd, &desc); -+ } -+ -+ raw_spin_unlock_irqrestore(&vmovp_lock, flags); -+} -+ -+static void its_send_vinvall(struct its_node *its, struct its_vpe *vpe) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_vinvall_cmd.vpe = vpe; -+ its_send_single_vcommand(its, its_build_vinvall_cmd, &desc); -+} -+ -+static void its_send_vinv(struct its_device *dev, u32 event_id) -+{ -+ struct its_cmd_desc desc; -+ -+ /* -+ * There is no real VINV command. This is just a normal INV, -+ * with a VSYNC instead of a SYNC. -+ */ -+ desc.its_inv_cmd.dev = dev; -+ desc.its_inv_cmd.event_id = event_id; -+ -+ its_send_single_vcommand(dev->its, its_build_vinv_cmd, &desc); -+} -+ -+static void its_send_vint(struct its_device *dev, u32 event_id) -+{ -+ struct its_cmd_desc desc; -+ -+ /* -+ * There is no real VINT command. This is just a normal INT, -+ * with a VSYNC instead of a SYNC. -+ */ -+ desc.its_int_cmd.dev = dev; -+ desc.its_int_cmd.event_id = event_id; -+ -+ its_send_single_vcommand(dev->its, its_build_vint_cmd, &desc); -+} -+ -+static void its_send_vclear(struct its_device *dev, u32 event_id) -+{ -+ struct its_cmd_desc desc; -+ -+ /* -+ * There is no real VCLEAR command. This is just a normal CLEAR, -+ * with a VSYNC instead of a SYNC. -+ */ -+ desc.its_clear_cmd.dev = dev; -+ desc.its_clear_cmd.event_id = event_id; -+ -+ its_send_single_vcommand(dev->its, its_build_vclear_cmd, &desc); -+} -+ -+static void its_send_invdb(struct its_node *its, struct its_vpe *vpe) -+{ -+ struct its_cmd_desc desc; -+ -+ desc.its_invdb_cmd.vpe = vpe; -+ its_send_single_vcommand(its, its_build_invdb_cmd, &desc); -+} -+ -+/* -+ * irqchip functions - assumes MSI, mostly. -+ */ -+static void lpi_write_config(struct irq_data *d, u8 clr, u8 set) -+{ -+ struct its_vlpi_map *map = get_vlpi_map(d); -+ irq_hw_number_t hwirq; -+ void *va; -+ u8 *cfg; -+ -+ if (map) { -+ va = page_address(map->vm->vprop_page); -+ hwirq = map->vintid; -+ -+ /* Remember the updated property */ -+ map->properties &= ~clr; -+ map->properties |= set | LPI_PROP_GROUP1; -+ } else { -+ va = gic_rdists->prop_table_va; -+ hwirq = d->hwirq; -+ } -+ -+ cfg = va + hwirq - 8192; -+ *cfg &= ~clr; -+ *cfg |= set | LPI_PROP_GROUP1; -+ -+ /* -+ * Make the above write visible to the redistributors. -+ * And yes, we're flushing exactly: One. Single. Byte. -+ * Humpf... -+ */ -+ if (gic_rdists->flags & RDIST_FLAGS_PROPBASE_NEEDS_FLUSHING) -+ gic_flush_dcache_to_poc(cfg, sizeof(*cfg)); -+ else -+ dsb(ishst); -+} -+ -+static void wait_for_syncr(void __iomem *rdbase) -+{ -+ while (readl_relaxed(rdbase + GICR_SYNCR) & 1) -+ cpu_relax(); -+} -+ -+static void direct_lpi_inv(struct irq_data *d) -+{ -+ struct its_vlpi_map *map = get_vlpi_map(d); -+ void __iomem *rdbase; -+ unsigned long flags; -+ u64 val; -+ int cpu; -+ -+ if (map) { -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ -+ WARN_ON(!is_v4_1(its_dev->its)); -+ -+ val = GICR_INVLPIR_V; -+ val |= FIELD_PREP(GICR_INVLPIR_VPEID, map->vpe->vpe_id); -+ val |= FIELD_PREP(GICR_INVLPIR_INTID, map->vintid); -+ } else { -+ val = d->hwirq; -+ } -+ -+ /* Target the redistributor this LPI is currently routed to */ -+ cpu = irq_to_cpuid_lock(d, &flags); -+ raw_spin_lock(&gic_data_rdist_cpu(cpu)->rd_lock); -+ rdbase = per_cpu_ptr(gic_rdists->rdist, cpu)->rd_base; -+ gic_write_lpir(val, rdbase + GICR_INVLPIR); -+ -+ wait_for_syncr(rdbase); -+ raw_spin_unlock(&gic_data_rdist_cpu(cpu)->rd_lock); -+ irq_to_cpuid_unlock(d, flags); -+} -+ -+static void lpi_update_config(struct irq_data *d, u8 clr, u8 set) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ -+ lpi_write_config(d, clr, set); -+ if (gic_rdists->has_direct_lpi && -+ (is_v4_1(its_dev->its) || !irqd_is_forwarded_to_vcpu(d))) -+ direct_lpi_inv(d); -+ else if (!irqd_is_forwarded_to_vcpu(d)) -+ its_send_inv(its_dev, its_get_event_id(d)); -+ else -+ its_send_vinv(its_dev, its_get_event_id(d)); -+} -+ -+static void its_vlpi_set_doorbell(struct irq_data *d, bool enable) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ u32 event = its_get_event_id(d); -+ struct its_vlpi_map *map; -+ -+ /* -+ * GICv4.1 does away with the per-LPI nonsense, nothing to do -+ * here. -+ */ -+ if (is_v4_1(its_dev->its)) -+ return; -+ -+ map = dev_event_to_vlpi_map(its_dev, event); -+ -+ if (map->db_enabled == enable) -+ return; -+ -+ map->db_enabled = enable; -+ -+ /* -+ * More fun with the architecture: -+ * -+ * Ideally, we'd issue a VMAPTI to set the doorbell to its LPI -+ * value or to 1023, depending on the enable bit. But that -+ * would be issuing a mapping for an /existing/ DevID+EventID -+ * pair, which is UNPREDICTABLE. Instead, let's issue a VMOVI -+ * to the /same/ vPE, using this opportunity to adjust the -+ * doorbell. Mouahahahaha. We loves it, Precious. -+ */ -+ its_send_vmovi(its_dev, event); -+} -+ -+static void its_mask_irq(struct irq_data *d) -+{ -+ if (irqd_is_forwarded_to_vcpu(d)) -+ its_vlpi_set_doorbell(d, false); -+ -+ lpi_update_config(d, LPI_PROP_ENABLED, 0); -+} -+ -+static void its_unmask_irq(struct irq_data *d) -+{ -+ if (irqd_is_forwarded_to_vcpu(d)) -+ its_vlpi_set_doorbell(d, true); -+ -+ lpi_update_config(d, 0, LPI_PROP_ENABLED); -+} -+ -+static __maybe_unused u32 its_read_lpi_count(struct irq_data *d, int cpu) -+{ -+ if (irqd_affinity_is_managed(d)) -+ return atomic_read(&per_cpu_ptr(&cpu_lpi_count, cpu)->managed); -+ -+ return atomic_read(&per_cpu_ptr(&cpu_lpi_count, cpu)->unmanaged); -+} -+ -+static void its_inc_lpi_count(struct irq_data *d, int cpu) -+{ -+ if (irqd_affinity_is_managed(d)) -+ atomic_inc(&per_cpu_ptr(&cpu_lpi_count, cpu)->managed); -+ else -+ atomic_inc(&per_cpu_ptr(&cpu_lpi_count, cpu)->unmanaged); -+} -+ -+static void its_dec_lpi_count(struct irq_data *d, int cpu) -+{ -+ if (irqd_affinity_is_managed(d)) -+ atomic_dec(&per_cpu_ptr(&cpu_lpi_count, cpu)->managed); -+ else -+ atomic_dec(&per_cpu_ptr(&cpu_lpi_count, cpu)->unmanaged); -+} -+ -+static unsigned int cpumask_pick_least_loaded(struct irq_data *d, -+ const struct cpumask *cpu_mask) -+{ -+ unsigned int cpu = nr_cpu_ids, tmp; -+ int count = S32_MAX; -+ -+ for_each_cpu(tmp, cpu_mask) { -+ int this_count = its_read_lpi_count(d, tmp); -+ -+ if (this_count < count) { -+ cpu = tmp; -+ count = this_count; -+ } -+ } -+ -+ return cpu; -+} -+ -+/* -+ * As suggested by Thomas Gleixner in: -+ * https://lore.kernel.org/r/87h80q2aoc.fsf@nanos.tec.linutronix.de -+ */ -+static int its_select_cpu(struct irq_data *d, -+ const struct cpumask *aff_mask) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ static DEFINE_RAW_SPINLOCK(tmpmask_lock); -+ static struct cpumask __tmpmask; -+ struct cpumask *tmpmask; -+ unsigned long flags; -+ int cpu, node; -+ -+ node = its_dev->its->numa_node; -+ tmpmask = &__tmpmask; -+ -+ raw_spin_lock_irqsave(&tmpmask_lock, flags); -+ -+ if (!irqd_affinity_is_managed(d)) { -+ /* First try the NUMA node */ -+ if (node != NUMA_NO_NODE) { -+ /* -+ * Try the intersection of the affinity mask and the -+ * node mask (and the online mask, just to be safe). -+ */ -+ cpumask_and(tmpmask, cpumask_of_node(node), aff_mask); -+ cpumask_and(tmpmask, tmpmask, cpu_online_mask); -+ -+ /* -+ * Ideally, we would check if the mask is empty, and -+ * try again on the full node here. -+ * -+ * But it turns out that the way ACPI describes the -+ * affinity for ITSs only deals about memory, and -+ * not target CPUs, so it cannot describe a single -+ * ITS placed next to two NUMA nodes. -+ * -+ * Instead, just fallback on the online mask. This -+ * diverges from Thomas' suggestion above. -+ */ -+ cpu = cpumask_pick_least_loaded(d, tmpmask); -+ if (cpu < nr_cpu_ids) -+ goto out; -+ -+ /* If we can't cross sockets, give up */ -+ if ((its_dev->its->flags & ITS_FLAGS_WORKAROUND_CAVIUM_23144)) -+ goto out; -+ -+ /* If the above failed, expand the search */ -+ } -+ -+ /* Try the intersection of the affinity and online masks */ -+ cpumask_and(tmpmask, aff_mask, cpu_online_mask); -+ -+ /* If that doesn't fly, the online mask is the last resort */ -+ if (cpumask_empty(tmpmask)) -+ cpumask_copy(tmpmask, cpu_online_mask); -+ -+ cpu = cpumask_pick_least_loaded(d, tmpmask); -+ } else { -+ cpumask_copy(tmpmask, aff_mask); -+ -+ /* If we cannot cross sockets, limit the search to that node */ -+ if ((its_dev->its->flags & ITS_FLAGS_WORKAROUND_CAVIUM_23144) && -+ node != NUMA_NO_NODE) -+ cpumask_and(tmpmask, tmpmask, cpumask_of_node(node)); -+ -+ cpu = cpumask_pick_least_loaded(d, tmpmask); -+ } -+out: -+ raw_spin_unlock_irqrestore(&tmpmask_lock, flags); -+ -+ pr_debug("IRQ%d -> %*pbl CPU%d\n", d->irq, cpumask_pr_args(aff_mask), cpu); -+ return cpu; -+} -+ -+#define MAX_MARS3_SKT_COUNT 8 -+ -+static int its_cpumask_select(struct its_device *its_dev, -+ const struct cpumask *mask_val, -+ const struct cpumask *cpu_mask) -+{ -+ unsigned int skt, skt_id, i; -+ phys_addr_t its_phys_base; -+ unsigned int cpu, cpus = 0; -+ -+ unsigned int skt_cpu_cnt[MAX_MARS3_SKT_COUNT] = {0}; -+ -+ its_phys_base = its_dev->its->phys_base; -+ skt_id = (its_phys_base >> 41) & 0x7; -+ -+ for (i = 0; i < nr_cpu_ids; i++) { -+ skt = (cpu_logical_map(i) >> 16) & 0xff; -+ if ((skt >= 0) && (skt < MAX_MARS3_SKT_COUNT)) { -+ if ((is_kdump_kernel()) && (skt_id == skt)) -+ return i; -+ -+ skt_cpu_cnt[skt]++; -+ } else if (skt != 0xff) { -+ pr_err("socket address: %d is out of range.", skt); -+ } -+ } -+ -+ if (skt_id) { -+ for (i = 0; i < skt_id; i++) -+ cpus += skt_cpu_cnt[i]; -+ } -+ -+ cpu = cpumask_any_and(mask_val, cpu_mask); -+ cpus = cpus + cpu % skt_cpu_cnt[skt_id]; -+ -+ return cpus; -+} -+ -+static int its_set_affinity(struct irq_data *d, const struct cpumask *mask_val, -+ bool force) -+{ -+ unsigned int cpu; -+ const struct cpumask *cpu_mask = cpu_online_mask; -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ struct its_collection *target_col; -+ u32 id = its_get_event_id(d); -+ int prev_cpu; -+ unsigned int skt_t1, skt_t2, cpu_idx; -+ -+ /* A forwarded interrupt should use irq_set_vcpu_affinity */ -+ if (irqd_is_forwarded_to_vcpu(d)) -+ return -EINVAL; -+ -+ prev_cpu = its_dev->event_map.col_map[id]; -+ its_dec_lpi_count(d, prev_cpu); -+ -+ cpu_idx = its_cpumask_select(its_dev, mask_val, cpu_mask); -+ skt_t1 = (cpu_logical_map(cpu_idx) >> 16) & 0xff; -+ if (!force) -+ cpu = its_select_cpu(d, mask_val); -+ else -+ cpu = cpumask_pick_least_loaded(d, mask_val); -+ -+ skt_t2 = (cpu_logical_map(cpu) >> 16) & 0xff; -+ if (skt_t1 != skt_t2) -+ cpu = cpu_idx; -+ -+ if (cpu < 0 || cpu >= nr_cpu_ids) -+ goto err; -+ -+ /* don't set the affinity when the target cpu is same as current one */ -+ if (cpu != prev_cpu) { -+ target_col = &its_dev->its->collections[cpu]; -+ its_send_movi(its_dev, target_col, id); -+ its_dev->event_map.col_map[id] = cpu; -+ irq_data_update_effective_affinity(d, cpumask_of(cpu)); -+ } -+ -+ its_inc_lpi_count(d, cpu); -+ -+ return IRQ_SET_MASK_OK_DONE; -+ -+err: -+ its_inc_lpi_count(d, prev_cpu); -+ return -EINVAL; -+} -+ -+static u64 its_irq_get_msi_base(struct its_device *its_dev) -+{ -+ struct its_node *its = its_dev->its; -+ -+ return its->phys_base + GITS_TRANSLATER; -+} -+ -+static void its_irq_compose_msi_msg(struct irq_data *d, struct msi_msg *msg) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ struct its_node *its; -+ u64 addr; -+ -+ its = its_dev->its; -+ addr = its->get_msi_base(its_dev); -+ -+ msg->address_lo = lower_32_bits(addr); -+ msg->address_hi = upper_32_bits(addr); -+ msg->data = its_get_event_id(d); -+} -+ -+static int its_irq_set_irqchip_state(struct irq_data *d, -+ enum irqchip_irq_state which, -+ bool state) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ u32 event = its_get_event_id(d); -+ -+ if (which != IRQCHIP_STATE_PENDING) -+ return -EINVAL; -+ -+ if (irqd_is_forwarded_to_vcpu(d)) { -+ if (state) -+ its_send_vint(its_dev, event); -+ else -+ its_send_vclear(its_dev, event); -+ } else { -+ if (state) -+ its_send_int(its_dev, event); -+ else -+ its_send_clear(its_dev, event); -+ } -+ -+ return 0; -+} -+ -+static int its_irq_retrigger(struct irq_data *d) -+{ -+ return !its_irq_set_irqchip_state(d, IRQCHIP_STATE_PENDING, true); -+} -+ -+/* -+ * Two favourable cases: -+ * -+ * (a) Either we have a GICv4.1, and all vPEs have to be mapped at all times -+ * for vSGI delivery -+ * -+ * (b) Or the ITSs do not use a list map, meaning that VMOVP is cheap enough -+ * and we're better off mapping all VPEs always -+ * -+ * If neither (a) nor (b) is true, then we map vPEs on demand. -+ * -+ */ -+static bool gic_requires_eager_mapping(void) -+{ -+ if (!its_list_map || gic_rdists->has_rvpeid) -+ return true; -+ -+ return false; -+} -+ -+static void its_map_vm(struct its_node *its, struct its_vm *vm) -+{ -+ unsigned long flags; -+ -+ if (gic_requires_eager_mapping()) -+ return; -+ -+ raw_spin_lock_irqsave(&vmovp_lock, flags); -+ -+ /* -+ * If the VM wasn't mapped yet, iterate over the vpes and get -+ * them mapped now. -+ */ -+ vm->vlpi_count[its->list_nr]++; -+ -+ if (vm->vlpi_count[its->list_nr] == 1) { -+ int i; -+ -+ for (i = 0; i < vm->nr_vpes; i++) { -+ struct its_vpe *vpe = vm->vpes[i]; -+ struct irq_data *d = irq_get_irq_data(vpe->irq); -+ -+ /* Map the VPE to the first possible CPU */ -+ vpe->col_idx = cpumask_first(cpu_online_mask); -+ its_send_vmapp(its, vpe, true); -+ its_send_vinvall(its, vpe); -+ irq_data_update_effective_affinity(d, cpumask_of(vpe->col_idx)); -+ } -+ } -+ -+ raw_spin_unlock_irqrestore(&vmovp_lock, flags); -+} -+ -+static void its_unmap_vm(struct its_node *its, struct its_vm *vm) -+{ -+ unsigned long flags; -+ -+ /* Not using the ITS list? Everything is always mapped. */ -+ if (gic_requires_eager_mapping()) -+ return; -+ -+ raw_spin_lock_irqsave(&vmovp_lock, flags); -+ -+ if (!--vm->vlpi_count[its->list_nr]) { -+ int i; -+ -+ for (i = 0; i < vm->nr_vpes; i++) -+ its_send_vmapp(its, vm->vpes[i], false); -+ } -+ -+ raw_spin_unlock_irqrestore(&vmovp_lock, flags); -+} -+ -+static int its_vlpi_map(struct irq_data *d, struct its_cmd_info *info) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ u32 event = its_get_event_id(d); -+ int ret = 0; -+ -+ if (!info->map) -+ return -EINVAL; -+ -+ raw_spin_lock(&its_dev->event_map.vlpi_lock); -+ -+ if (!its_dev->event_map.vm) { -+ struct its_vlpi_map *maps; -+ -+ maps = kcalloc(its_dev->event_map.nr_lpis, sizeof(*maps), -+ GFP_ATOMIC); -+ if (!maps) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ its_dev->event_map.vm = info->map->vm; -+ its_dev->event_map.vlpi_maps = maps; -+ } else if (its_dev->event_map.vm != info->map->vm) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ /* Get our private copy of the mapping information */ -+ its_dev->event_map.vlpi_maps[event] = *info->map; -+ -+ if (irqd_is_forwarded_to_vcpu(d)) { -+ /* Already mapped, move it around */ -+ its_send_vmovi(its_dev, event); -+ } else { -+ /* Ensure all the VPEs are mapped on this ITS */ -+ its_map_vm(its_dev->its, info->map->vm); -+ -+ /* -+ * Flag the interrupt as forwarded so that we can -+ * start poking the virtual property table. -+ */ -+ irqd_set_forwarded_to_vcpu(d); -+ -+ /* Write out the property to the prop table */ -+ lpi_write_config(d, 0xff, info->map->properties); -+ -+ /* Drop the physical mapping */ -+ its_send_discard(its_dev, event); -+ -+ /* and install the virtual one */ -+ its_send_vmapti(its_dev, event); -+ -+ /* Increment the number of VLPIs */ -+ its_dev->event_map.nr_vlpis++; -+ } -+ -+out: -+ raw_spin_unlock(&its_dev->event_map.vlpi_lock); -+ return ret; -+} -+ -+static int its_vlpi_get(struct irq_data *d, struct its_cmd_info *info) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ struct its_vlpi_map *map; -+ int ret = 0; -+ -+ raw_spin_lock(&its_dev->event_map.vlpi_lock); -+ -+ map = get_vlpi_map(d); -+ -+ if (!its_dev->event_map.vm || !map) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ /* Copy our mapping information to the incoming request */ -+ *info->map = *map; -+ -+out: -+ raw_spin_unlock(&its_dev->event_map.vlpi_lock); -+ return ret; -+} -+ -+static int its_vlpi_unmap(struct irq_data *d) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ u32 event = its_get_event_id(d); -+ int ret = 0; -+ -+ raw_spin_lock(&its_dev->event_map.vlpi_lock); -+ -+ if (!its_dev->event_map.vm || !irqd_is_forwarded_to_vcpu(d)) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ /* Drop the virtual mapping */ -+ its_send_discard(its_dev, event); -+ -+ /* and restore the physical one */ -+ irqd_clr_forwarded_to_vcpu(d); -+ its_send_mapti(its_dev, d->hwirq, event); -+ lpi_update_config(d, 0xff, (LPI_PROP_DEFAULT_PRIO | -+ LPI_PROP_ENABLED | -+ LPI_PROP_GROUP1)); -+ -+ /* Potentially unmap the VM from this ITS */ -+ its_unmap_vm(its_dev->its, its_dev->event_map.vm); -+ -+ /* -+ * Drop the refcount and make the device available again if -+ * this was the last VLPI. -+ */ -+ if (!--its_dev->event_map.nr_vlpis) { -+ its_dev->event_map.vm = NULL; -+ kfree(its_dev->event_map.vlpi_maps); -+ } -+ -+out: -+ raw_spin_unlock(&its_dev->event_map.vlpi_lock); -+ return ret; -+} -+ -+static int its_vlpi_prop_update(struct irq_data *d, struct its_cmd_info *info) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ -+ if (!its_dev->event_map.vm || !irqd_is_forwarded_to_vcpu(d)) -+ return -EINVAL; -+ -+ if (info->cmd_type == PROP_UPDATE_AND_INV_VLPI) -+ lpi_update_config(d, 0xff, info->config); -+ else -+ lpi_write_config(d, 0xff, info->config); -+ its_vlpi_set_doorbell(d, !!(info->config & LPI_PROP_ENABLED)); -+ -+ return 0; -+} -+ -+static int its_irq_set_vcpu_affinity(struct irq_data *d, void *vcpu_info) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ struct its_cmd_info *info = vcpu_info; -+ -+ /* Need a v4 ITS */ -+ if (!is_v4(its_dev->its)) -+ return -EINVAL; -+ -+ /* Unmap request? */ -+ if (!info) -+ return its_vlpi_unmap(d); -+ -+ switch (info->cmd_type) { -+ case MAP_VLPI: -+ return its_vlpi_map(d, info); -+ -+ case GET_VLPI: -+ return its_vlpi_get(d, info); -+ -+ case PROP_UPDATE_VLPI: -+ case PROP_UPDATE_AND_INV_VLPI: -+ return its_vlpi_prop_update(d, info); -+ -+ default: -+ return -EINVAL; -+ } -+} -+ -+static struct irq_chip its_irq_chip = { -+ .name = "ITS", -+ .irq_mask = its_mask_irq, -+ .irq_unmask = its_unmask_irq, -+ .irq_eoi = irq_chip_eoi_parent, -+ .irq_set_affinity = its_set_affinity, -+ .irq_compose_msi_msg = its_irq_compose_msi_msg, -+ .irq_set_irqchip_state = its_irq_set_irqchip_state, -+ .irq_retrigger = its_irq_retrigger, -+ .irq_set_vcpu_affinity = its_irq_set_vcpu_affinity, -+}; -+ -+ -+/* -+ * How we allocate LPIs: -+ * -+ * lpi_range_list contains ranges of LPIs that are to available to -+ * allocate from. To allocate LPIs, just pick the first range that -+ * fits the required allocation, and reduce it by the required -+ * amount. Once empty, remove the range from the list. -+ * -+ * To free a range of LPIs, add a free range to the list, sort it and -+ * merge the result if the new range happens to be adjacent to an -+ * already free block. -+ * -+ * The consequence of the above is that allocation is cost is low, but -+ * freeing is expensive. We assumes that freeing rarely occurs. -+ */ -+#define ITS_MAX_LPI_NRBITS 16 /* 64K LPIs */ -+ -+static DEFINE_MUTEX(lpi_range_lock); -+static LIST_HEAD(lpi_range_list); -+ -+struct lpi_range { -+ struct list_head entry; -+ u32 base_id; -+ u32 span; -+}; -+ -+static struct lpi_range *mk_lpi_range(u32 base, u32 span) -+{ -+ struct lpi_range *range; -+ -+ range = kmalloc(sizeof(*range), GFP_KERNEL); -+ if (range) { -+ range->base_id = base; -+ range->span = span; -+ } -+ -+ return range; -+} -+ -+static int alloc_lpi_range(u32 nr_lpis, u32 *base) -+{ -+ struct lpi_range *range, *tmp; -+ int err = -ENOSPC; -+ -+ mutex_lock(&lpi_range_lock); -+ -+ list_for_each_entry_safe(range, tmp, &lpi_range_list, entry) { -+ if (range->span >= nr_lpis) { -+ *base = range->base_id; -+ range->base_id += nr_lpis; -+ range->span -= nr_lpis; -+ -+ if (range->span == 0) { -+ list_del(&range->entry); -+ kfree(range); -+ } -+ -+ err = 0; -+ break; -+ } -+ } -+ -+ mutex_unlock(&lpi_range_lock); -+ -+ pr_debug("ITS: alloc %u:%u\n", *base, nr_lpis); -+ return err; -+} -+ -+static void merge_lpi_ranges(struct lpi_range *a, struct lpi_range *b) -+{ -+ if (&a->entry == &lpi_range_list || &b->entry == &lpi_range_list) -+ return; -+ if (a->base_id + a->span != b->base_id) -+ return; -+ b->base_id = a->base_id; -+ b->span += a->span; -+ list_del(&a->entry); -+ kfree(a); -+} -+ -+static int free_lpi_range(u32 base, u32 nr_lpis) -+{ -+ struct lpi_range *new, *old; -+ -+ new = mk_lpi_range(base, nr_lpis); -+ if (!new) -+ return -ENOMEM; -+ -+ mutex_lock(&lpi_range_lock); -+ -+ list_for_each_entry_reverse(old, &lpi_range_list, entry) { -+ if (old->base_id < base) -+ break; -+ } -+ /* -+ * old is the last element with ->base_id smaller than base, -+ * so new goes right after it. If there are no elements with -+ * ->base_id smaller than base, &old->entry ends up pointing -+ * at the head of the list, and inserting new it the start of -+ * the list is the right thing to do in that case as well. -+ */ -+ list_add(&new->entry, &old->entry); -+ /* -+ * Now check if we can merge with the preceding and/or -+ * following ranges. -+ */ -+ merge_lpi_ranges(old, new); -+ merge_lpi_ranges(new, list_next_entry(new, entry)); -+ -+ mutex_unlock(&lpi_range_lock); -+ return 0; -+} -+ -+static int __init its_lpi_init(u32 id_bits) -+{ -+ u32 lpis = (1UL << id_bits) - 8192; -+ u32 numlpis; -+ int err; -+ -+ numlpis = 1UL << GICD_TYPER_NUM_LPIS(gic_rdists->gicd_typer); -+ -+ if (numlpis > 2 && !WARN_ON(numlpis > lpis)) { -+ lpis = numlpis; -+ pr_info("ITS: Using hypervisor restricted LPI range [%u]\n", -+ lpis); -+ } -+ -+ /* -+ * Initializing the allocator is just the same as freeing the -+ * full range of LPIs. -+ */ -+ err = free_lpi_range(8192, lpis); -+ pr_debug("ITS: Allocator initialized for %u LPIs\n", lpis); -+ return err; -+} -+ -+static unsigned long *its_lpi_alloc(int nr_irqs, u32 *base, int *nr_ids) -+{ -+ unsigned long *bitmap = NULL; -+ int err = 0; -+ -+ do { -+ err = alloc_lpi_range(nr_irqs, base); -+ if (!err) -+ break; -+ -+ nr_irqs /= 2; -+ } while (nr_irqs > 0); -+ -+ if (!nr_irqs) -+ err = -ENOSPC; -+ -+ if (err) -+ goto out; -+ -+ bitmap = bitmap_zalloc(nr_irqs, GFP_ATOMIC); -+ if (!bitmap) -+ goto out; -+ -+ *nr_ids = nr_irqs; -+ -+out: -+ if (!bitmap) -+ *base = *nr_ids = 0; -+ -+ return bitmap; -+} -+ -+static void its_lpi_free(unsigned long *bitmap, u32 base, u32 nr_ids) -+{ -+ WARN_ON(free_lpi_range(base, nr_ids)); -+ bitmap_free(bitmap); -+} -+ -+static void gic_reset_prop_table(void *va) -+{ -+ /* Priority 0xa0, Group-1, disabled */ -+ memset(va, LPI_PROP_DEFAULT_PRIO | LPI_PROP_GROUP1, LPI_PROPBASE_SZ); -+ -+ /* Make sure the GIC will observe the written configuration */ -+ gic_flush_dcache_to_poc(va, LPI_PROPBASE_SZ); -+} -+ -+static struct page *its_allocate_prop_table(gfp_t gfp_flags) -+{ -+ struct page *prop_page; -+ -+ prop_page = alloc_pages(gfp_flags, get_order(LPI_PROPBASE_SZ)); -+ if (!prop_page) -+ return NULL; -+ -+ gic_reset_prop_table(page_address(prop_page)); -+ -+ return prop_page; -+} -+ -+static void its_free_prop_table(struct page *prop_page) -+{ -+ free_pages((unsigned long)page_address(prop_page), -+ get_order(LPI_PROPBASE_SZ)); -+} -+ -+static bool gic_check_reserved_range(phys_addr_t addr, unsigned long size) -+{ -+ phys_addr_t start, end, addr_end; -+ u64 i; -+ -+ /* -+ * We don't bother checking for a kdump kernel as by -+ * construction, the LPI tables are out of this kernel's -+ * memory map. -+ */ -+ if (is_kdump_kernel()) -+ return true; -+ -+ addr_end = addr + size - 1; -+ -+ for_each_reserved_mem_range(i, &start, &end) { -+ if (addr >= start && addr_end <= end) -+ return true; -+ } -+ -+ /* Not found, not a good sign... */ -+ pr_warn("GIC-S2500: Expected reserved range [%pa:%pa], not found\n", -+ &addr, &addr_end); -+ add_taint(TAINT_CRAP, LOCKDEP_STILL_OK); -+ return false; -+} -+ -+static int gic_reserve_range(phys_addr_t addr, unsigned long size) -+{ -+ if (efi_enabled(EFI_CONFIG_TABLES)) -+ return efi_mem_reserve_persistent(addr, size); -+ -+ return 0; -+} -+ -+static int __init its_setup_lpi_prop_table(void) -+{ -+ if (gic_rdists->flags & RDIST_FLAGS_RD_TABLES_PREALLOCATED) { -+ u64 val; -+ -+ val = gicr_read_propbaser(gic_data_rdist_rd_base() + GICR_PROPBASER); -+ lpi_id_bits = (val & GICR_PROPBASER_IDBITS_MASK) + 1; -+ -+ gic_rdists->prop_table_pa = val & GENMASK_ULL(51, 12); -+ gic_rdists->prop_table_va = memremap(gic_rdists->prop_table_pa, -+ LPI_PROPBASE_SZ, -+ MEMREMAP_WB); -+ gic_reset_prop_table(gic_rdists->prop_table_va); -+ } else { -+ struct page *page; -+ -+ lpi_id_bits = min_t(u32, -+ GICD_TYPER_ID_BITS(gic_rdists->gicd_typer), -+ ITS_MAX_LPI_NRBITS); -+ page = its_allocate_prop_table(GFP_NOWAIT); -+ if (!page) { -+ pr_err("Failed to allocate PROPBASE\n"); -+ return -ENOMEM; -+ } -+ -+ gic_rdists->prop_table_pa = page_to_phys(page); -+ gic_rdists->prop_table_va = page_address(page); -+ WARN_ON(gic_reserve_range(gic_rdists->prop_table_pa, -+ LPI_PROPBASE_SZ)); -+ } -+ -+ pr_info("GICv-S2500: using LPI property table @%pa\n", -+ &gic_rdists->prop_table_pa); -+ -+ return its_lpi_init(lpi_id_bits); -+} -+ -+static const char *its_base_type_string[] = { -+ [GITS_BASER_TYPE_DEVICE] = "Devices", -+ [GITS_BASER_TYPE_VCPU] = "Virtual CPUs", -+ [GITS_BASER_TYPE_RESERVED3] = "Reserved (3)", -+ [GITS_BASER_TYPE_COLLECTION] = "Interrupt Collections", -+ [GITS_BASER_TYPE_RESERVED5] = "Reserved (5)", -+ [GITS_BASER_TYPE_RESERVED6] = "Reserved (6)", -+ [GITS_BASER_TYPE_RESERVED7] = "Reserved (7)", -+}; -+ -+static u64 its_read_baser(struct its_node *its, struct its_baser *baser) -+{ -+ u32 idx = baser - its->tables; -+ -+ return gits_read_baser(its->base + GITS_BASER + (idx << 3)); -+} -+ -+static void its_write_baser(struct its_node *its, struct its_baser *baser, -+ u64 val) -+{ -+ u32 idx = baser - its->tables; -+ -+ gits_write_baser(val, its->base + GITS_BASER + (idx << 3)); -+ baser->val = its_read_baser(its, baser); -+} -+ -+static int its_setup_baser(struct its_node *its, struct its_baser *baser, -+ u64 cache, u64 shr, u32 order, bool indirect) -+{ -+ u64 val = its_read_baser(its, baser); -+ u64 esz = GITS_BASER_ENTRY_SIZE(val); -+ u64 type = GITS_BASER_TYPE(val); -+ u64 baser_phys, tmp; -+ u32 alloc_pages, psz; -+ struct page *page; -+ void *base; -+ -+ psz = baser->psz; -+ alloc_pages = (PAGE_ORDER_TO_SIZE(order) / psz); -+ if (alloc_pages > GITS_BASER_PAGES_MAX) { -+ pr_warn("ITS@%pa: %s too large, reduce ITS pages %u->%u\n", -+ &its->phys_base, its_base_type_string[type], -+ alloc_pages, GITS_BASER_PAGES_MAX); -+ alloc_pages = GITS_BASER_PAGES_MAX; -+ order = get_order(GITS_BASER_PAGES_MAX * psz); -+ } -+ -+ page = alloc_pages_node(its->numa_node, GFP_KERNEL | __GFP_ZERO, order); -+ if (!page) -+ return -ENOMEM; -+ -+ base = (void *)page_address(page); -+ baser_phys = virt_to_phys(base); -+ -+ /* Check if the physical address of the memory is above 48bits */ -+ if (IS_ENABLED(CONFIG_ARM64_64K_PAGES) && (baser_phys >> 48)) { -+ -+ /* 52bit PA is supported only when PageSize=64K */ -+ if (psz != SZ_64K) { -+ pr_err("ITS: no 52bit PA support when psz=%d\n", psz); -+ free_pages((unsigned long)base, order); -+ return -ENXIO; -+ } -+ -+ /* Convert 52bit PA to 48bit field */ -+ baser_phys = GITS_BASER_PHYS_52_to_48(baser_phys); -+ } -+ -+retry_baser: -+ val = (baser_phys | -+ (type << GITS_BASER_TYPE_SHIFT) | -+ ((esz - 1) << GITS_BASER_ENTRY_SIZE_SHIFT) | -+ ((alloc_pages - 1) << GITS_BASER_PAGES_SHIFT) | -+ cache | -+ shr | -+ GITS_BASER_VALID); -+ -+ val |= indirect ? GITS_BASER_INDIRECT : 0x0; -+ -+ switch (psz) { -+ case SZ_4K: -+ val |= GITS_BASER_PAGE_SIZE_4K; -+ break; -+ case SZ_16K: -+ val |= GITS_BASER_PAGE_SIZE_16K; -+ break; -+ case SZ_64K: -+ val |= GITS_BASER_PAGE_SIZE_64K; -+ break; -+ } -+ -+ its_write_baser(its, baser, val); -+ tmp = baser->val; -+ -+ if ((val ^ tmp) & GITS_BASER_SHAREABILITY_MASK) { -+ /* -+ * Shareability didn't stick. Just use -+ * whatever the read reported, which is likely -+ * to be the only thing this redistributor -+ * supports. If that's zero, make it -+ * non-cacheable as well. -+ */ -+ shr = tmp & GITS_BASER_SHAREABILITY_MASK; -+ if (!shr) { -+ cache = GITS_BASER_nC; -+ gic_flush_dcache_to_poc(base, PAGE_ORDER_TO_SIZE(order)); -+ } -+ goto retry_baser; -+ } -+ -+ if (val != tmp) { -+ pr_err("ITS@%pa: %s doesn't stick: %llx %llx\n", -+ &its->phys_base, its_base_type_string[type], -+ val, tmp); -+ free_pages((unsigned long)base, order); -+ return -ENXIO; -+ } -+ -+ baser->order = order; -+ baser->base = base; -+ baser->psz = psz; -+ tmp = indirect ? GITS_LVL1_ENTRY_SIZE : esz; -+ -+ pr_info("ITS@%pa: allocated %d %s @%lx (%s, esz %d, psz %dK, shr %d)\n", -+ &its->phys_base, (int)(PAGE_ORDER_TO_SIZE(order) / (int)tmp), -+ its_base_type_string[type], -+ (unsigned long)virt_to_phys(base), -+ indirect ? "indirect" : "flat", (int)esz, -+ psz / SZ_1K, (int)shr >> GITS_BASER_SHAREABILITY_SHIFT); -+ -+ return 0; -+} -+ -+static bool its_parse_indirect_baser(struct its_node *its, -+ struct its_baser *baser, -+ u32 *order, u32 ids) -+{ -+ u64 tmp = its_read_baser(its, baser); -+ u64 type = GITS_BASER_TYPE(tmp); -+ u64 esz = GITS_BASER_ENTRY_SIZE(tmp); -+ u64 val = GITS_BASER_InnerShareable | GITS_BASER_RaWaWb; -+ u32 new_order = *order; -+ u32 psz = baser->psz; -+ bool indirect = false; -+ -+ /* No need to enable Indirection if memory requirement < (psz*2)bytes */ -+ if ((esz << ids) > (psz * 2)) { -+ /* -+ * Find out whether hw supports a single or two-level table by -+ * table by reading bit at offset '62' after writing '1' to it. -+ */ -+ its_write_baser(its, baser, val | GITS_BASER_INDIRECT); -+ indirect = !!(baser->val & GITS_BASER_INDIRECT); -+ -+ if (indirect) { -+ /* -+ * The size of the lvl2 table is equal to ITS page size -+ * which is 'psz'. For computing lvl1 table size, -+ * subtract ID bits that sparse lvl2 table from 'ids' -+ * which is reported by ITS hardware times lvl1 table -+ * entry size. -+ */ -+ ids -= ilog2(psz / (int)esz); -+ esz = GITS_LVL1_ENTRY_SIZE; -+ } -+ } -+ -+ /* -+ * Allocate as many entries as required to fit the -+ * range of device IDs that the ITS can grok... The ID -+ * space being incredibly sparse, this results in a -+ * massive waste of memory if two-level device table -+ * feature is not supported by hardware. -+ */ -+ new_order = max_t(u32, get_order(esz << ids), new_order); -+ if (new_order >= MAX_ORDER) { -+ new_order = MAX_ORDER - 1; -+ ids = ilog2(PAGE_ORDER_TO_SIZE(new_order) / (int)esz); -+ pr_warn("ITS@%pa: %s Table too large, reduce ids %llu->%u\n", -+ &its->phys_base, its_base_type_string[type], -+ device_ids(its), ids); -+ } -+ -+ *order = new_order; -+ -+ return indirect; -+} -+ -+static u32 compute_common_aff(u64 val) -+{ -+ u32 aff, clpiaff; -+ -+ aff = FIELD_GET(GICR_TYPER_AFFINITY, val); -+ clpiaff = FIELD_GET(GICR_TYPER_COMMON_LPI_AFF, val); -+ -+ return aff & ~(GENMASK(31, 0) >> (clpiaff * 8)); -+} -+ -+static u32 compute_its_aff(struct its_node *its) -+{ -+ u64 val; -+ u32 svpet; -+ -+ /* -+ * Reencode the ITS SVPET and MPIDR as a GICR_TYPER, and compute -+ * the resulting affinity. We then use that to see if this match -+ * our own affinity. -+ */ -+ svpet = FIELD_GET(GITS_TYPER_SVPET, its->typer); -+ val = FIELD_PREP(GICR_TYPER_COMMON_LPI_AFF, svpet); -+ val |= FIELD_PREP(GICR_TYPER_AFFINITY, its->mpidr); -+ return compute_common_aff(val); -+} -+ -+static struct its_node *find_sibling_its(struct its_node *cur_its) -+{ -+ struct its_node *its; -+ u32 aff; -+ -+ if (!FIELD_GET(GITS_TYPER_SVPET, cur_its->typer)) -+ return NULL; -+ -+ aff = compute_its_aff(cur_its); -+ -+ list_for_each_entry(its, &its_nodes, entry) { -+ u64 baser; -+ -+ if (!is_v4_1(its) || its == cur_its) -+ continue; -+ -+ if (!FIELD_GET(GITS_TYPER_SVPET, its->typer)) -+ continue; -+ -+ if (aff != compute_its_aff(its)) -+ continue; -+ -+ /* GICv4.1 guarantees that the vPE table is GITS_BASER2 */ -+ baser = its->tables[2].val; -+ if (!(baser & GITS_BASER_VALID)) -+ continue; -+ -+ return its; -+ } -+ -+ return NULL; -+} -+ -+static void its_free_tables(struct its_node *its) -+{ -+ int i; -+ -+ for (i = 0; i < GITS_BASER_NR_REGS; i++) { -+ if (its->tables[i].base) { -+ free_pages((unsigned long)its->tables[i].base, -+ its->tables[i].order); -+ its->tables[i].base = NULL; -+ } -+ } -+} -+ -+static int its_probe_baser_psz(struct its_node *its, struct its_baser *baser) -+{ -+ u64 psz = SZ_64K; -+ -+ while (psz) { -+ u64 val, gpsz; -+ -+ val = its_read_baser(its, baser); -+ val &= ~GITS_BASER_PAGE_SIZE_MASK; -+ -+ switch (psz) { -+ case SZ_64K: -+ gpsz = GITS_BASER_PAGE_SIZE_64K; -+ break; -+ case SZ_16K: -+ gpsz = GITS_BASER_PAGE_SIZE_16K; -+ break; -+ case SZ_4K: -+ default: -+ gpsz = GITS_BASER_PAGE_SIZE_4K; -+ break; -+ } -+ -+ gpsz >>= GITS_BASER_PAGE_SIZE_SHIFT; -+ -+ val |= FIELD_PREP(GITS_BASER_PAGE_SIZE_MASK, gpsz); -+ its_write_baser(its, baser, val); -+ -+ if (FIELD_GET(GITS_BASER_PAGE_SIZE_MASK, baser->val) == gpsz) -+ break; -+ -+ switch (psz) { -+ case SZ_64K: -+ psz = SZ_16K; -+ break; -+ case SZ_16K: -+ psz = SZ_4K; -+ break; -+ case SZ_4K: -+ default: -+ return -1; -+ } -+ } -+ -+ baser->psz = psz; -+ return 0; -+} -+ -+static int its_alloc_tables(struct its_node *its) -+{ -+ u64 shr = GITS_BASER_InnerShareable; -+ u64 cache = GITS_BASER_RaWaWb; -+ int err, i; -+ -+ if (its->flags & ITS_FLAGS_WORKAROUND_CAVIUM_22375) -+ /* erratum 24313: ignore memory access type */ -+ cache = GITS_BASER_nCnB; -+ -+ for (i = 0; i < GITS_BASER_NR_REGS; i++) { -+ struct its_baser *baser = its->tables + i; -+ u64 val = its_read_baser(its, baser); -+ u64 type = GITS_BASER_TYPE(val); -+ bool indirect = false; -+ u32 order; -+ -+ if (type == GITS_BASER_TYPE_NONE) -+ continue; -+ -+ if (its_probe_baser_psz(its, baser)) { -+ its_free_tables(its); -+ return -ENXIO; -+ } -+ -+ order = get_order(baser->psz); -+ -+ switch (type) { -+ case GITS_BASER_TYPE_DEVICE: -+ indirect = its_parse_indirect_baser(its, baser, &order, -+ device_ids(its)); -+ break; -+ -+ case GITS_BASER_TYPE_VCPU: -+ if (is_v4_1(its)) { -+ struct its_node *sibling; -+ -+ WARN_ON(i != 2); -+ if ((sibling = find_sibling_its(its))) { -+ *baser = sibling->tables[2]; -+ its_write_baser(its, baser, baser->val); -+ continue; -+ } -+ } -+ -+ indirect = its_parse_indirect_baser(its, baser, &order, -+ ITS_MAX_VPEID_BITS); -+ break; -+ } -+ -+ err = its_setup_baser(its, baser, cache, shr, order, indirect); -+ if (err < 0) { -+ its_free_tables(its); -+ return err; -+ } -+ -+ /* Update settings which will be used for next BASERn */ -+ cache = baser->val & GITS_BASER_CACHEABILITY_MASK; -+ shr = baser->val & GITS_BASER_SHAREABILITY_MASK; -+ } -+ -+ return 0; -+} -+ -+static u64 inherit_vpe_l1_table_from_its(void) -+{ -+ struct its_node *its; -+ u64 val; -+ u32 aff; -+ -+ val = gic_read_typer(gic_data_rdist_rd_base() + GICR_TYPER); -+ aff = compute_common_aff(val); -+ -+ list_for_each_entry(its, &its_nodes, entry) { -+ u64 baser, addr; -+ -+ if (!is_v4_1(its)) -+ continue; -+ -+ if (!FIELD_GET(GITS_TYPER_SVPET, its->typer)) -+ continue; -+ -+ if (aff != compute_its_aff(its)) -+ continue; -+ -+ /* GICv4.1 guarantees that the vPE table is GITS_BASER2 */ -+ baser = its->tables[2].val; -+ if (!(baser & GITS_BASER_VALID)) -+ continue; -+ -+ /* We have a winner! */ -+ gic_data_rdist()->vpe_l1_base = its->tables[2].base; -+ -+ val = GICR_VPROPBASER_4_1_VALID; -+ if (baser & GITS_BASER_INDIRECT) -+ val |= GICR_VPROPBASER_4_1_INDIRECT; -+ val |= FIELD_PREP(GICR_VPROPBASER_4_1_PAGE_SIZE, -+ FIELD_GET(GITS_BASER_PAGE_SIZE_MASK, baser)); -+ switch (FIELD_GET(GITS_BASER_PAGE_SIZE_MASK, baser)) { -+ case GIC_PAGE_SIZE_64K: -+ addr = GITS_BASER_ADDR_48_to_52(baser); -+ break; -+ default: -+ addr = baser & GENMASK_ULL(47, 12); -+ break; -+ } -+ val |= FIELD_PREP(GICR_VPROPBASER_4_1_ADDR, addr >> 12); -+ val |= FIELD_PREP(GICR_VPROPBASER_SHAREABILITY_MASK, -+ FIELD_GET(GITS_BASER_SHAREABILITY_MASK, baser)); -+ val |= FIELD_PREP(GICR_VPROPBASER_INNER_CACHEABILITY_MASK, -+ FIELD_GET(GITS_BASER_INNER_CACHEABILITY_MASK, baser)); -+ val |= FIELD_PREP(GICR_VPROPBASER_4_1_SIZE, GITS_BASER_NR_PAGES(baser) - 1); -+ -+ return val; -+ } -+ -+ return 0; -+} -+ -+static u64 inherit_vpe_l1_table_from_rd(cpumask_t **mask) -+{ -+ u32 aff; -+ u64 val; -+ int cpu; -+ -+ val = gic_read_typer(gic_data_rdist_rd_base() + GICR_TYPER); -+ aff = compute_common_aff(val); -+ -+ for_each_possible_cpu(cpu) { -+ void __iomem *base = gic_data_rdist_cpu(cpu)->rd_base; -+ -+ if (!base || cpu == smp_processor_id()) -+ continue; -+ -+ val = gic_read_typer(base + GICR_TYPER); -+ if (aff != compute_common_aff(val)) -+ continue; -+ -+ /* -+ * At this point, we have a victim. This particular CPU -+ * has already booted, and has an affinity that matches -+ * ours wrt CommonLPIAff. Let's use its own VPROPBASER. -+ * Make sure we don't write the Z bit in that case. -+ */ -+ val = gicr_read_vpropbaser(base + SZ_128K + GICR_VPROPBASER); -+ val &= ~GICR_VPROPBASER_4_1_Z; -+ -+ gic_data_rdist()->vpe_l1_base = gic_data_rdist_cpu(cpu)->vpe_l1_base; -+ *mask = gic_data_rdist_cpu(cpu)->vpe_table_mask; -+ -+ return val; -+ } -+ -+ return 0; -+} -+ -+static bool allocate_vpe_l2_table(int cpu, u32 id) -+{ -+ void __iomem *base = gic_data_rdist_cpu(cpu)->rd_base; -+ unsigned int psz, esz, idx, npg, gpsz; -+ u64 val; -+ struct page *page; -+ __le64 *table; -+ -+ if (!gic_rdists->has_rvpeid) -+ return true; -+ -+ /* Skip non-present CPUs */ -+ if (!base) -+ return true; -+ -+ val = gicr_read_vpropbaser(base + SZ_128K + GICR_VPROPBASER); -+ -+ esz = FIELD_GET(GICR_VPROPBASER_4_1_ENTRY_SIZE, val) + 1; -+ gpsz = FIELD_GET(GICR_VPROPBASER_4_1_PAGE_SIZE, val); -+ npg = FIELD_GET(GICR_VPROPBASER_4_1_SIZE, val) + 1; -+ -+ switch (gpsz) { -+ default: -+ WARN_ON(1); -+ fallthrough; -+ case GIC_PAGE_SIZE_4K: -+ psz = SZ_4K; -+ break; -+ case GIC_PAGE_SIZE_16K: -+ psz = SZ_16K; -+ break; -+ case GIC_PAGE_SIZE_64K: -+ psz = SZ_64K; -+ break; -+ } -+ -+ /* Don't allow vpe_id that exceeds single, flat table limit */ -+ if (!(val & GICR_VPROPBASER_4_1_INDIRECT)) -+ return (id < (npg * psz / (esz * SZ_8))); -+ -+ /* Compute 1st level table index & check if that exceeds table limit */ -+ idx = id >> ilog2(psz / (esz * SZ_8)); -+ if (idx >= (npg * psz / GITS_LVL1_ENTRY_SIZE)) -+ return false; -+ -+ table = gic_data_rdist_cpu(cpu)->vpe_l1_base; -+ -+ /* Allocate memory for 2nd level table */ -+ if (!table[idx]) { -+ page = alloc_pages(GFP_KERNEL | __GFP_ZERO, get_order(psz)); -+ if (!page) -+ return false; -+ -+ /* Flush Lvl2 table to PoC if hw doesn't support coherency */ -+ if (!(val & GICR_VPROPBASER_SHAREABILITY_MASK)) -+ gic_flush_dcache_to_poc(page_address(page), psz); -+ -+ table[idx] = cpu_to_le64(page_to_phys(page) | GITS_BASER_VALID); -+ -+ /* Flush Lvl1 entry to PoC if hw doesn't support coherency */ -+ if (!(val & GICR_VPROPBASER_SHAREABILITY_MASK)) -+ gic_flush_dcache_to_poc(table + idx, GITS_LVL1_ENTRY_SIZE); -+ -+ /* Ensure updated table contents are visible to RD hardware */ -+ dsb(sy); -+ } -+ -+ return true; -+} -+ -+static int allocate_vpe_l1_table(void) -+{ -+ void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); -+ u64 val, gpsz, npg, pa; -+ unsigned int psz = SZ_64K; -+ unsigned int np, epp, esz; -+ struct page *page; -+ -+ if (!gic_rdists->has_rvpeid) -+ return 0; -+ -+ /* -+ * if VPENDBASER.Valid is set, disable any previously programmed -+ * VPE by setting PendingLast while clearing Valid. This has the -+ * effect of making sure no doorbell will be generated and we can -+ * then safely clear VPROPBASER.Valid. -+ */ -+ if (gicr_read_vpendbaser(vlpi_base + GICR_VPENDBASER) & GICR_VPENDBASER_Valid) -+ gicr_write_vpendbaser(GICR_VPENDBASER_PendingLast, -+ vlpi_base + GICR_VPENDBASER); -+ -+ /* -+ * If we can inherit the configuration from another RD, let's do -+ * so. Otherwise, we have to go through the allocation process. We -+ * assume that all RDs have the exact same requirements, as -+ * nothing will work otherwise. -+ */ -+ val = inherit_vpe_l1_table_from_rd(&gic_data_rdist()->vpe_table_mask); -+ if (val & GICR_VPROPBASER_4_1_VALID) -+ goto out; -+ -+ gic_data_rdist()->vpe_table_mask = kzalloc(sizeof(cpumask_t), GFP_ATOMIC); -+ if (!gic_data_rdist()->vpe_table_mask) -+ return -ENOMEM; -+ -+ val = inherit_vpe_l1_table_from_its(); -+ if (val & GICR_VPROPBASER_4_1_VALID) -+ goto out; -+ -+ /* First probe the page size */ -+ val = FIELD_PREP(GICR_VPROPBASER_4_1_PAGE_SIZE, GIC_PAGE_SIZE_64K); -+ gicr_write_vpropbaser(val, vlpi_base + GICR_VPROPBASER); -+ val = gicr_read_vpropbaser(vlpi_base + GICR_VPROPBASER); -+ gpsz = FIELD_GET(GICR_VPROPBASER_4_1_PAGE_SIZE, val); -+ esz = FIELD_GET(GICR_VPROPBASER_4_1_ENTRY_SIZE, val); -+ -+ switch (gpsz) { -+ default: -+ gpsz = GIC_PAGE_SIZE_4K; -+ fallthrough; -+ case GIC_PAGE_SIZE_4K: -+ psz = SZ_4K; -+ break; -+ case GIC_PAGE_SIZE_16K: -+ psz = SZ_16K; -+ break; -+ case GIC_PAGE_SIZE_64K: -+ psz = SZ_64K; -+ break; -+ } -+ -+ /* -+ * Start populating the register from scratch, including RO fields -+ * (which we want to print in debug cases...) -+ */ -+ val = 0; -+ val |= FIELD_PREP(GICR_VPROPBASER_4_1_PAGE_SIZE, gpsz); -+ val |= FIELD_PREP(GICR_VPROPBASER_4_1_ENTRY_SIZE, esz); -+ -+ /* How many entries per GIC page? */ -+ esz++; -+ epp = psz / (esz * SZ_8); -+ -+ /* -+ * If we need more than just a single L1 page, flag the table -+ * as indirect and compute the number of required L1 pages. -+ */ -+ if (epp < ITS_MAX_VPEID) { -+ int nl2; -+ -+ val |= GICR_VPROPBASER_4_1_INDIRECT; -+ -+ /* Number of L2 pages required to cover the VPEID space */ -+ nl2 = DIV_ROUND_UP(ITS_MAX_VPEID, epp); -+ -+ /* Number of L1 pages to point to the L2 pages */ -+ npg = DIV_ROUND_UP(nl2 * SZ_8, psz); -+ } else { -+ npg = 1; -+ } -+ -+ val |= FIELD_PREP(GICR_VPROPBASER_4_1_SIZE, npg - 1); -+ -+ /* Right, that's the number of CPU pages we need for L1 */ -+ np = DIV_ROUND_UP(npg * psz, PAGE_SIZE); -+ -+ pr_debug("np = %d, npg = %lld, psz = %d, epp = %d, esz = %d\n", -+ np, npg, psz, epp, esz); -+ page = alloc_pages(GFP_ATOMIC | __GFP_ZERO, get_order(np * PAGE_SIZE)); -+ if (!page) -+ return -ENOMEM; -+ -+ gic_data_rdist()->vpe_l1_base = page_address(page); -+ pa = virt_to_phys(page_address(page)); -+ WARN_ON(!IS_ALIGNED(pa, psz)); -+ -+ val |= FIELD_PREP(GICR_VPROPBASER_4_1_ADDR, pa >> 12); -+ val |= GICR_VPROPBASER_RaWb; -+ val |= GICR_VPROPBASER_InnerShareable; -+ val |= GICR_VPROPBASER_4_1_Z; -+ val |= GICR_VPROPBASER_4_1_VALID; -+ -+out: -+ gicr_write_vpropbaser(val, vlpi_base + GICR_VPROPBASER); -+ cpumask_set_cpu(smp_processor_id(), gic_data_rdist()->vpe_table_mask); -+ -+ pr_debug("CPU%d: VPROPBASER = %llx %*pbl\n", -+ smp_processor_id(), val, -+ cpumask_pr_args(gic_data_rdist()->vpe_table_mask)); -+ -+ return 0; -+} -+ -+static int its_alloc_collections(struct its_node *its) -+{ -+ int i; -+ -+ its->collections = kcalloc(nr_cpu_ids, sizeof(*its->collections), -+ GFP_KERNEL); -+ if (!its->collections) -+ return -ENOMEM; -+ -+ for (i = 0; i < nr_cpu_ids; i++) -+ its->collections[i].target_address = ~0ULL; -+ -+ return 0; -+} -+ -+static struct page *its_allocate_pending_table(gfp_t gfp_flags) -+{ -+ struct page *pend_page; -+ -+ pend_page = alloc_pages(gfp_flags | __GFP_ZERO, -+ get_order(LPI_PENDBASE_SZ)); -+ if (!pend_page) -+ return NULL; -+ -+ /* Make sure the GIC will observe the zero-ed page */ -+ gic_flush_dcache_to_poc(page_address(pend_page), LPI_PENDBASE_SZ); -+ -+ return pend_page; -+} -+ -+static void its_free_pending_table(struct page *pt) -+{ -+ free_pages((unsigned long)page_address(pt), get_order(LPI_PENDBASE_SZ)); -+} -+ -+/* -+ * Booting with kdump and LPIs enabled is generally fine. Any other -+ * case is wrong in the absence of firmware/EFI support. -+ */ -+static bool enabled_lpis_allowed(void) -+{ -+ phys_addr_t addr; -+ u64 val; -+ -+ /* Check whether the property table is in a reserved region */ -+ val = gicr_read_propbaser(gic_data_rdist_rd_base() + GICR_PROPBASER); -+ addr = val & GENMASK_ULL(51, 12); -+ -+ return gic_check_reserved_range(addr, LPI_PROPBASE_SZ); -+} -+ -+static int __init allocate_lpi_tables(void) -+{ -+ u64 val; -+ int err, cpu; -+ -+ /* -+ * If LPIs are enabled while we run this from the boot CPU, -+ * flag the RD tables as pre-allocated if the stars do align. -+ */ -+ val = readl_relaxed(gic_data_rdist_rd_base() + GICR_CTLR); -+ if ((val & GICR_CTLR_ENABLE_LPIS) && enabled_lpis_allowed()) { -+ gic_rdists->flags |= (RDIST_FLAGS_RD_TABLES_PREALLOCATED | -+ RDIST_FLAGS_PROPBASE_NEEDS_FLUSHING); -+ pr_info("GIC-S2500: Using preallocated redistributor tables\n"); -+ } -+ -+ err = its_setup_lpi_prop_table(); -+ if (err) -+ return err; -+ -+ /* -+ * We allocate all the pending tables anyway, as we may have a -+ * mix of RDs that have had LPIs enabled, and some that -+ * don't. We'll free the unused ones as each CPU comes online. -+ */ -+ for_each_possible_cpu(cpu) { -+ struct page *pend_page; -+ -+ pend_page = its_allocate_pending_table(GFP_NOWAIT); -+ if (!pend_page) { -+ pr_err("Failed to allocate PENDBASE for CPU%d\n", cpu); -+ return -ENOMEM; -+ } -+ -+ gic_data_rdist_cpu(cpu)->pend_page = pend_page; -+ } -+ -+ return 0; -+} -+ -+static u64 read_vpend_dirty_clear(void __iomem *vlpi_base) -+{ -+ u32 count = 1000000; /* 1s! */ -+ bool clean; -+ u64 val; -+ -+ do { -+ val = gicr_read_vpendbaser(vlpi_base + GICR_VPENDBASER); -+ clean = !(val & GICR_VPENDBASER_Dirty); -+ if (!clean) { -+ count--; -+ cpu_relax(); -+ udelay(1); -+ } -+ } while (!clean && count); -+ -+ if (unlikely(!clean)) -+ pr_err_ratelimited("ITS virtual pending table not cleaning\n"); -+ -+ return val; -+} -+ -+static u64 its_clear_vpend_valid(void __iomem *vlpi_base, u64 clr, u64 set) -+{ -+ u64 val; -+ -+ /* Make sure we wait until the RD is done with the initial scan */ -+ val = read_vpend_dirty_clear(vlpi_base); -+ val &= ~GICR_VPENDBASER_Valid; -+ val &= ~clr; -+ val |= set; -+ gicr_write_vpendbaser(val, vlpi_base + GICR_VPENDBASER); -+ -+ val = read_vpend_dirty_clear(vlpi_base); -+ if (unlikely(val & GICR_VPENDBASER_Dirty)) -+ val |= GICR_VPENDBASER_PendingLast; -+ -+ return val; -+} -+ -+static void its_cpu_init_lpis(void) -+{ -+ void __iomem *rbase = gic_data_rdist_rd_base(); -+ struct page *pend_page; -+ phys_addr_t paddr; -+ u64 val, tmp; -+ -+ if (gic_data_rdist()->flags & RD_LOCAL_LPI_ENABLED) -+ return; -+ -+ val = readl_relaxed(rbase + GICR_CTLR); -+ if ((gic_rdists->flags & RDIST_FLAGS_RD_TABLES_PREALLOCATED) && -+ (val & GICR_CTLR_ENABLE_LPIS)) { -+ /* -+ * Check that we get the same property table on all -+ * RDs. If we don't, this is hopeless. -+ */ -+ paddr = gicr_read_propbaser(rbase + GICR_PROPBASER); -+ paddr &= GENMASK_ULL(51, 12); -+ if (WARN_ON(gic_rdists->prop_table_pa != paddr)) -+ add_taint(TAINT_CRAP, LOCKDEP_STILL_OK); -+ -+ paddr = gicr_read_pendbaser(rbase + GICR_PENDBASER); -+ paddr &= GENMASK_ULL(51, 16); -+ -+ WARN_ON(!gic_check_reserved_range(paddr, LPI_PENDBASE_SZ)); -+ gic_data_rdist()->flags |= RD_LOCAL_PENDTABLE_PREALLOCATED; -+ -+ goto out; -+ } -+ -+ pend_page = gic_data_rdist()->pend_page; -+ paddr = page_to_phys(pend_page); -+ -+ /* set PROPBASE */ -+ val = (gic_rdists->prop_table_pa | -+ GICR_PROPBASER_InnerShareable | -+ GICR_PROPBASER_RaWaWb | -+ ((LPI_NRBITS - 1) & GICR_PROPBASER_IDBITS_MASK)); -+ -+ gicr_write_propbaser(val, rbase + GICR_PROPBASER); -+ tmp = gicr_read_propbaser(rbase + GICR_PROPBASER); -+ -+ if ((tmp ^ val) & GICR_PROPBASER_SHAREABILITY_MASK) { -+ if (!(tmp & GICR_PROPBASER_SHAREABILITY_MASK)) { -+ /* -+ * The HW reports non-shareable, we must -+ * remove the cacheability attributes as -+ * well. -+ */ -+ val &= ~(GICR_PROPBASER_SHAREABILITY_MASK | -+ GICR_PROPBASER_CACHEABILITY_MASK); -+ val |= GICR_PROPBASER_nC; -+ gicr_write_propbaser(val, rbase + GICR_PROPBASER); -+ } -+ pr_info_once("GIC: using cache flushing for LPI property table\n"); -+ gic_rdists->flags |= RDIST_FLAGS_PROPBASE_NEEDS_FLUSHING; -+ } -+ -+ /* set PENDBASE */ -+ val = (page_to_phys(pend_page) | -+ GICR_PENDBASER_InnerShareable | -+ GICR_PENDBASER_RaWaWb); -+ -+ gicr_write_pendbaser(val, rbase + GICR_PENDBASER); -+ tmp = gicr_read_pendbaser(rbase + GICR_PENDBASER); -+ -+ if (!(tmp & GICR_PENDBASER_SHAREABILITY_MASK)) { -+ /* -+ * The HW reports non-shareable, we must remove the -+ * cacheability attributes as well. -+ */ -+ val &= ~(GICR_PENDBASER_SHAREABILITY_MASK | -+ GICR_PENDBASER_CACHEABILITY_MASK); -+ val |= GICR_PENDBASER_nC; -+ gicr_write_pendbaser(val, rbase + GICR_PENDBASER); -+ } -+ -+ /* Enable LPIs */ -+ val = readl_relaxed(rbase + GICR_CTLR); -+ val |= GICR_CTLR_ENABLE_LPIS; -+ writel_relaxed(val, rbase + GICR_CTLR); -+ -+ if (gic_rdists->has_vlpis && !gic_rdists->has_rvpeid) { -+ void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); -+ -+ /* -+ * It's possible for CPU to receive VLPIs before it is -+ * scheduled as a vPE, especially for the first CPU, and the -+ * VLPI with INTID larger than 2^(IDbits+1) will be considered -+ * as out of range and dropped by GIC. -+ * So we initialize IDbits to known value to avoid VLPI drop. -+ */ -+ val = (LPI_NRBITS - 1) & GICR_VPROPBASER_IDBITS_MASK; -+ pr_debug("GICv4: CPU%d: Init IDbits to 0x%llx for GICR_VPROPBASER\n", -+ smp_processor_id(), val); -+ gicr_write_vpropbaser(val, vlpi_base + GICR_VPROPBASER); -+ -+ /* -+ * Also clear Valid bit of GICR_VPENDBASER, in case some -+ * ancient programming gets left in and has possibility of -+ * corrupting memory. -+ */ -+ val = its_clear_vpend_valid(vlpi_base, 0, 0); -+ } -+ -+ if (allocate_vpe_l1_table()) { -+ /* -+ * If the allocation has failed, we're in massive trouble. -+ * Disable direct injection, and pray that no VM was -+ * already running... -+ */ -+ gic_rdists->has_rvpeid = false; -+ gic_rdists->has_vlpis = false; -+ } -+ -+ /* Make sure the GIC has seen the above */ -+ dsb(sy); -+out: -+ gic_data_rdist()->flags |= RD_LOCAL_LPI_ENABLED; -+ pr_info("GIC-2500: CPU%d: using %s LPI pending table @%pa\n", -+ smp_processor_id(), -+ gic_data_rdist()->flags & RD_LOCAL_PENDTABLE_PREALLOCATED ? -+ "reserved" : "allocated", -+ &paddr); -+} -+ -+static void its_cpu_init_collection(struct its_node *its) -+{ -+ int cpu = smp_processor_id(); -+ u64 target; -+ -+ /* avoid cross node collections and its mapping */ -+ if (its->flags & ITS_FLAGS_WORKAROUND_CAVIUM_23144) { -+ struct device_node *cpu_node; -+ -+ cpu_node = of_get_cpu_node(cpu, NULL); -+ if (its->numa_node != NUMA_NO_NODE && -+ its->numa_node != of_node_to_nid(cpu_node)) -+ return; -+ } -+ -+ /* -+ * We now have to bind each collection to its target -+ * redistributor. -+ */ -+ if (gic_read_typer(its->base + GITS_TYPER) & GITS_TYPER_PTA) { -+ /* -+ * This ITS wants the physical address of the -+ * redistributor. -+ */ -+ target = gic_data_rdist()->phys_base; -+ } else { -+ /* This ITS wants a linear CPU number. */ -+ target = gic_read_typer(gic_data_rdist_rd_base() + GICR_TYPER); -+ target = GICR_TYPER_CPU_NUMBER(target) << 16; -+ } -+ -+ /* Perform collection mapping */ -+ its->collections[cpu].target_address = target; -+ if (is_kdump_kernel()) -+ its->collections[cpu].col_id = cpu % 65; -+ else -+ its->collections[cpu].col_id = cpu % 64; -+ -+ its_send_mapc(its, &its->collections[cpu], 1); -+ its_send_invall(its, &its->collections[cpu]); -+} -+ -+static void its_cpu_init_collections(void) -+{ -+ struct its_node *its; -+ -+ raw_spin_lock(&its_lock); -+ -+ list_for_each_entry(its, &its_nodes, entry) -+ its_cpu_init_collection(its); -+ -+ raw_spin_unlock(&its_lock); -+} -+ -+static struct its_device *its_find_device(struct its_node *its, u32 dev_id) -+{ -+ struct its_device *its_dev = NULL, *tmp; -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&its->lock, flags); -+ -+ list_for_each_entry(tmp, &its->its_device_list, entry) { -+ if (tmp->device_id == dev_id) { -+ its_dev = tmp; -+ break; -+ } -+ } -+ -+ raw_spin_unlock_irqrestore(&its->lock, flags); -+ -+ return its_dev; -+} -+ -+static struct its_baser *its_get_baser(struct its_node *its, u32 type) -+{ -+ int i; -+ -+ for (i = 0; i < GITS_BASER_NR_REGS; i++) { -+ if (GITS_BASER_TYPE(its->tables[i].val) == type) -+ return &its->tables[i]; -+ } -+ -+ return NULL; -+} -+ -+static bool its_alloc_table_entry(struct its_node *its, -+ struct its_baser *baser, u32 id) -+{ -+ struct page *page; -+ u32 esz, idx; -+ __le64 *table; -+ -+ /* Don't allow device id that exceeds single, flat table limit */ -+ esz = GITS_BASER_ENTRY_SIZE(baser->val); -+ if (!(baser->val & GITS_BASER_INDIRECT)) -+ return (id < (PAGE_ORDER_TO_SIZE(baser->order) / esz)); -+ -+ /* Compute 1st level table index & check if that exceeds table limit */ -+ idx = id >> ilog2(baser->psz / esz); -+ if (idx >= (PAGE_ORDER_TO_SIZE(baser->order) / GITS_LVL1_ENTRY_SIZE)) -+ return false; -+ -+ table = baser->base; -+ -+ /* Allocate memory for 2nd level table */ -+ if (!table[idx]) { -+ page = alloc_pages_node(its->numa_node, GFP_KERNEL | __GFP_ZERO, -+ get_order(baser->psz)); -+ if (!page) -+ return false; -+ -+ /* Flush Lvl2 table to PoC if hw doesn't support coherency */ -+ if (!(baser->val & GITS_BASER_SHAREABILITY_MASK)) -+ gic_flush_dcache_to_poc(page_address(page), baser->psz); -+ -+ table[idx] = cpu_to_le64(page_to_phys(page) | GITS_BASER_VALID); -+ -+ /* Flush Lvl1 entry to PoC if hw doesn't support coherency */ -+ if (!(baser->val & GITS_BASER_SHAREABILITY_MASK)) -+ gic_flush_dcache_to_poc(table + idx, GITS_LVL1_ENTRY_SIZE); -+ -+ /* Ensure updated table contents are visible to ITS hardware */ -+ dsb(sy); -+ } -+ -+ return true; -+} -+ -+static bool its_alloc_device_table(struct its_node *its, u32 dev_id) -+{ -+ struct its_baser *baser; -+ -+ baser = its_get_baser(its, GITS_BASER_TYPE_DEVICE); -+ -+ /* Don't allow device id that exceeds ITS hardware limit */ -+ if (!baser) -+ return (ilog2(dev_id) < device_ids(its)); -+ -+ return its_alloc_table_entry(its, baser, dev_id); -+} -+ -+static bool its_alloc_vpe_table(u32 vpe_id) -+{ -+ struct its_node *its; -+ int cpu; -+ -+ /* -+ * Make sure the L2 tables are allocated on *all* v4 ITSs. We -+ * could try and only do it on ITSs corresponding to devices -+ * that have interrupts targeted at this VPE, but the -+ * complexity becomes crazy (and you have tons of memory -+ * anyway, right?). -+ */ -+ list_for_each_entry(its, &its_nodes, entry) { -+ struct its_baser *baser; -+ -+ if (!is_v4(its)) -+ continue; -+ -+ baser = its_get_baser(its, GITS_BASER_TYPE_VCPU); -+ if (!baser) -+ return false; -+ -+ if (!its_alloc_table_entry(its, baser, vpe_id)) -+ return false; -+ } -+ -+ /* Non v4.1? No need to iterate RDs and go back early. */ -+ if (!gic_rdists->has_rvpeid) -+ return true; -+ -+ /* -+ * Make sure the L2 tables are allocated for all copies of -+ * the L1 table on *all* v4.1 RDs. -+ */ -+ for_each_possible_cpu(cpu) { -+ if (!allocate_vpe_l2_table(cpu, vpe_id)) -+ return false; -+ } -+ -+ return true; -+} -+ -+static struct its_device *its_create_device(struct its_node *its, u32 dev_id, -+ int nvecs, bool alloc_lpis) -+{ -+ struct its_device *dev; -+ unsigned long *lpi_map = NULL; -+ unsigned long flags; -+ u16 *col_map = NULL; -+ void *itt; -+ int lpi_base; -+ int nr_lpis; -+ int nr_ites; -+ int sz; -+ -+ if (!its_alloc_device_table(its, dev_id)) -+ return NULL; -+ -+ if (WARN_ON(!is_power_of_2(nvecs))) -+ nvecs = roundup_pow_of_two(nvecs); -+ -+ dev = kzalloc(sizeof(*dev), GFP_KERNEL); -+ /* -+ * Even if the device wants a single LPI, the ITT must be -+ * sized as a power of two (and you need at least one bit...). -+ */ -+ nr_ites = max(2, nvecs); -+ sz = nr_ites * (FIELD_GET(GITS_TYPER_ITT_ENTRY_SIZE, its->typer) + 1); -+ sz = max(sz, ITS_ITT_ALIGN) + ITS_ITT_ALIGN - 1; -+ itt = kzalloc_node(sz, GFP_KERNEL, its->numa_node); -+ if (alloc_lpis) { -+ lpi_map = its_lpi_alloc(nvecs, &lpi_base, &nr_lpis); -+ if (lpi_map) -+ col_map = kcalloc(nr_lpis, sizeof(*col_map), -+ GFP_KERNEL); -+ } else { -+ col_map = kcalloc(nr_ites, sizeof(*col_map), GFP_KERNEL); -+ nr_lpis = 0; -+ lpi_base = 0; -+ } -+ -+ if (!dev || !itt || !col_map || (!lpi_map && alloc_lpis)) { -+ kfree(dev); -+ kfree(itt); -+ bitmap_free(lpi_map); -+ kfree(col_map); -+ return NULL; -+ } -+ -+ gic_flush_dcache_to_poc(itt, sz); -+ -+ dev->its = its; -+ dev->itt = itt; -+ dev->nr_ites = nr_ites; -+ dev->event_map.lpi_map = lpi_map; -+ dev->event_map.col_map = col_map; -+ dev->event_map.lpi_base = lpi_base; -+ dev->event_map.nr_lpis = nr_lpis; -+ raw_spin_lock_init(&dev->event_map.vlpi_lock); -+ dev->device_id = dev_id; -+ INIT_LIST_HEAD(&dev->entry); -+ -+ raw_spin_lock_irqsave(&its->lock, flags); -+ list_add(&dev->entry, &its->its_device_list); -+ raw_spin_unlock_irqrestore(&its->lock, flags); -+ -+ /* Map device to its ITT */ -+ its_send_mapd(dev, 1); -+ -+ return dev; -+} -+ -+static void its_free_device(struct its_device *its_dev) -+{ -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&its_dev->its->lock, flags); -+ list_del(&its_dev->entry); -+ raw_spin_unlock_irqrestore(&its_dev->its->lock, flags); -+ kfree(its_dev->event_map.col_map); -+ kfree(its_dev->itt); -+ kfree(its_dev); -+} -+ -+static int its_alloc_device_irq(struct its_device *dev, int nvecs, irq_hw_number_t *hwirq) -+{ -+ int idx; -+ -+ /* Find a free LPI region in lpi_map and allocate them. */ -+ idx = bitmap_find_free_region(dev->event_map.lpi_map, -+ dev->event_map.nr_lpis, -+ get_count_order(nvecs)); -+ if (idx < 0) -+ return -ENOSPC; -+ -+ *hwirq = dev->event_map.lpi_base + idx; -+ -+ return 0; -+} -+ -+static int its_msi_prepare(struct irq_domain *domain, struct device *dev, -+ int nvec, msi_alloc_info_t *info) -+{ -+ struct its_node *its; -+ struct its_device *its_dev; -+ struct msi_domain_info *msi_info; -+ u32 dev_id; -+ int err = 0; -+ -+ /* -+ * We ignore "dev" entirely, and rely on the dev_id that has -+ * been passed via the scratchpad. This limits this domain's -+ * usefulness to upper layers that definitely know that they -+ * are built on top of the ITS. -+ */ -+ dev_id = info->scratchpad[0].ul; -+ -+ msi_info = msi_get_domain_info(domain); -+ its = msi_info->data; -+ -+ if (!gic_rdists->has_direct_lpi && -+ vpe_proxy.dev && -+ vpe_proxy.dev->its == its && -+ dev_id == vpe_proxy.dev->device_id) { -+ /* Bad luck. Get yourself a better implementation */ -+ WARN_ONCE(1, "DevId %x clashes with GICv4 VPE proxy device\n", -+ dev_id); -+ return -EINVAL; -+ } -+ -+ mutex_lock(&its->dev_alloc_lock); -+ its_dev = its_find_device(its, dev_id); -+ if (its_dev) { -+ /* -+ * We already have seen this ID, probably through -+ * another alias (PCI bridge of some sort). No need to -+ * create the device. -+ */ -+ its_dev->shared = true; -+ pr_debug("Reusing ITT for devID %x\n", dev_id); -+ goto out; -+ } -+ -+ its_dev = its_create_device(its, dev_id, nvec, true); -+ if (!its_dev) { -+ err = -ENOMEM; -+ goto out; -+ } -+ -+ if (info->flags & MSI_ALLOC_FLAGS_PROXY_DEVICE) -+ its_dev->shared = true; -+ -+ pr_debug("ITT %d entries, %d bits\n", nvec, ilog2(nvec)); -+out: -+ mutex_unlock(&its->dev_alloc_lock); -+ info->scratchpad[0].ptr = its_dev; -+ return err; -+} -+ -+static struct msi_domain_ops its_msi_domain_ops = { -+ .msi_prepare = its_msi_prepare, -+}; -+ -+static int its_irq_gic_domain_alloc(struct irq_domain *domain, -+ unsigned int virq, -+ irq_hw_number_t hwirq) -+{ -+ struct irq_fwspec fwspec; -+ -+ if (irq_domain_get_of_node(domain->parent)) { -+ fwspec.fwnode = domain->parent->fwnode; -+ fwspec.param_count = 3; -+ fwspec.param[0] = GIC_IRQ_TYPE_LPI; -+ fwspec.param[1] = hwirq; -+ fwspec.param[2] = IRQ_TYPE_EDGE_RISING; -+ } else if (is_fwnode_irqchip(domain->parent->fwnode)) { -+ fwspec.fwnode = domain->parent->fwnode; -+ fwspec.param_count = 2; -+ fwspec.param[0] = hwirq; -+ fwspec.param[1] = IRQ_TYPE_EDGE_RISING; -+ } else { -+ return -EINVAL; -+ } -+ -+ return irq_domain_alloc_irqs_parent(domain, virq, 1, &fwspec); -+} -+ -+static int its_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, -+ unsigned int nr_irqs, void *args) -+{ -+ msi_alloc_info_t *info = args; -+ struct its_device *its_dev = info->scratchpad[0].ptr; -+ struct its_node *its = its_dev->its; -+ struct irq_data *irqd; -+ irq_hw_number_t hwirq; -+ int err; -+ int i; -+ -+ err = its_alloc_device_irq(its_dev, nr_irqs, &hwirq); -+ if (err) -+ return err; -+ -+ err = iommu_dma_prepare_msi(info->desc, its->get_msi_base(its_dev)); -+ if (err) -+ return err; -+ -+ for (i = 0; i < nr_irqs; i++) { -+ err = its_irq_gic_domain_alloc(domain, virq + i, hwirq + i); -+ if (err) -+ return err; -+ -+ irq_domain_set_hwirq_and_chip(domain, virq + i, -+ hwirq + i, &its_irq_chip, its_dev); -+ irqd = irq_get_irq_data(virq + i); -+ irqd_set_single_target(irqd); -+ irqd_set_affinity_on_activate(irqd); -+ pr_debug("ID:%d pID:%d vID:%d\n", -+ (int)(hwirq + i - its_dev->event_map.lpi_base), -+ (int)(hwirq + i), virq + i); -+ } -+ -+ return 0; -+} -+ -+static int its_cpumask_first(struct its_device *its_dev, -+ const struct cpumask *cpu_mask) -+{ -+ unsigned int skt, skt_id, i; -+ phys_addr_t its_phys_base; -+ unsigned int cpu, cpus = 0; -+ unsigned int skt_cpu_cnt[MAX_MARS3_SKT_COUNT] = {0}; -+ -+ its_phys_base = its_dev->its->phys_base; -+ skt_id = (its_phys_base >> 41) & 0x7; -+ -+ for (i = 0; i < nr_cpu_ids; i++) { -+ skt = (cpu_logical_map(i) >> 16) & 0xff; -+ if ((skt >= 0) && (skt < MAX_MARS3_SKT_COUNT)) { -+ if ((is_kdump_kernel()) && (skt_id == skt)) -+ return i; -+ -+ skt_cpu_cnt[skt]++; -+ } else if (skt != 0xff) { -+ pr_err("socket address: %d is out of range.", skt); -+ } -+ } -+ -+ if (skt_id) { -+ for (i = 0; i < skt_id; i++) -+ cpus += skt_cpu_cnt[i]; -+ } -+ -+ cpu = cpumask_first(cpu_mask); -+ if ((cpu > cpus) && (cpu < (cpus + skt_cpu_cnt[skt_id]))) -+ cpus = cpu; -+ -+ return cpus; -+} -+ -+static int its_irq_domain_activate(struct irq_domain *domain, -+ struct irq_data *d, bool reserve) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ u32 event = its_get_event_id(d); -+ const struct cpumask *cpu_mask = cpu_online_mask; -+ int cpu; -+ -+ cpu = its_cpumask_first(its_dev, cpu_mask); -+ -+ if (cpu < 0 || cpu >= nr_cpu_ids) -+ return -EINVAL; -+ -+ its_inc_lpi_count(d, cpu); -+ its_dev->event_map.col_map[event] = cpu; -+ irq_data_update_effective_affinity(d, cpumask_of(cpu)); -+ -+ /* Map the GIC IRQ and event to the device */ -+ its_send_mapti(its_dev, d->hwirq, event); -+ return 0; -+} -+ -+static void its_irq_domain_deactivate(struct irq_domain *domain, -+ struct irq_data *d) -+{ -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ u32 event = its_get_event_id(d); -+ -+ its_dec_lpi_count(d, its_dev->event_map.col_map[event]); -+ /* Stop the delivery of interrupts */ -+ its_send_discard(its_dev, event); -+} -+ -+static void its_irq_domain_free(struct irq_domain *domain, unsigned int virq, -+ unsigned int nr_irqs) -+{ -+ struct irq_data *d = irq_domain_get_irq_data(domain, virq); -+ struct its_device *its_dev = irq_data_get_irq_chip_data(d); -+ struct its_node *its = its_dev->its; -+ int i; -+ -+ bitmap_release_region(its_dev->event_map.lpi_map, -+ its_get_event_id(irq_domain_get_irq_data(domain, virq)), -+ get_count_order(nr_irqs)); -+ -+ for (i = 0; i < nr_irqs; i++) { -+ struct irq_data *data = irq_domain_get_irq_data(domain, -+ virq + i); -+ /* Nuke the entry in the domain */ -+ irq_domain_reset_irq_data(data); -+ } -+ -+ mutex_lock(&its->dev_alloc_lock); -+ -+ /* -+ * If all interrupts have been freed, start mopping the -+ * floor. This is conditioned on the device not being shared. -+ */ -+ if (!its_dev->shared && -+ bitmap_empty(its_dev->event_map.lpi_map, -+ its_dev->event_map.nr_lpis)) { -+ its_lpi_free(its_dev->event_map.lpi_map, -+ its_dev->event_map.lpi_base, -+ its_dev->event_map.nr_lpis); -+ -+ /* Unmap device/itt */ -+ its_send_mapd(its_dev, 0); -+ its_free_device(its_dev); -+ } -+ -+ mutex_unlock(&its->dev_alloc_lock); -+ -+ irq_domain_free_irqs_parent(domain, virq, nr_irqs); -+} -+ -+static const struct irq_domain_ops its_domain_ops = { -+ .alloc = its_irq_domain_alloc, -+ .free = its_irq_domain_free, -+ .activate = its_irq_domain_activate, -+ .deactivate = its_irq_domain_deactivate, -+}; -+ -+/* -+ * This is insane. -+ * -+ * If a GICv4.0 doesn't implement Direct LPIs (which is extremely -+ * likely), the only way to perform an invalidate is to use a fake -+ * device to issue an INV command, implying that the LPI has first -+ * been mapped to some event on that device. Since this is not exactly -+ * cheap, we try to keep that mapping around as long as possible, and -+ * only issue an UNMAP if we're short on available slots. -+ * -+ * Broken by design(tm). -+ * -+ * GICv4.1, on the other hand, mandates that we're able to invalidate -+ * by writing to a MMIO register. It doesn't implement the whole of -+ * DirectLPI, but that's good enough. And most of the time, we don't -+ * even have to invalidate anything, as the redistributor can be told -+ * whether to generate a doorbell or not (we thus leave it enabled, -+ * always). -+ */ -+static void its_vpe_db_proxy_unmap_locked(struct its_vpe *vpe) -+{ -+ /* GICv4.1 doesn't use a proxy, so nothing to do here */ -+ if (gic_rdists->has_rvpeid) -+ return; -+ -+ /* Already unmapped? */ -+ if (vpe->vpe_proxy_event == -1) -+ return; -+ -+ its_send_discard(vpe_proxy.dev, vpe->vpe_proxy_event); -+ vpe_proxy.vpes[vpe->vpe_proxy_event] = NULL; -+ -+ /* -+ * We don't track empty slots at all, so let's move the -+ * next_victim pointer if we can quickly reuse that slot -+ * instead of nuking an existing entry. Not clear that this is -+ * always a win though, and this might just generate a ripple -+ * effect... Let's just hope VPEs don't migrate too often. -+ */ -+ if (vpe_proxy.vpes[vpe_proxy.next_victim]) -+ vpe_proxy.next_victim = vpe->vpe_proxy_event; -+ -+ vpe->vpe_proxy_event = -1; -+} -+ -+static void its_vpe_db_proxy_unmap(struct its_vpe *vpe) -+{ -+ /* GICv4.1 doesn't use a proxy, so nothing to do here */ -+ if (gic_rdists->has_rvpeid) -+ return; -+ -+ if (!gic_rdists->has_direct_lpi) { -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&vpe_proxy.lock, flags); -+ its_vpe_db_proxy_unmap_locked(vpe); -+ raw_spin_unlock_irqrestore(&vpe_proxy.lock, flags); -+ } -+} -+ -+static void its_vpe_db_proxy_map_locked(struct its_vpe *vpe) -+{ -+ /* GICv4.1 doesn't use a proxy, so nothing to do here */ -+ if (gic_rdists->has_rvpeid) -+ return; -+ -+ /* Already mapped? */ -+ if (vpe->vpe_proxy_event != -1) -+ return; -+ -+ /* This slot was already allocated. Kick the other VPE out. */ -+ if (vpe_proxy.vpes[vpe_proxy.next_victim]) -+ its_vpe_db_proxy_unmap_locked(vpe_proxy.vpes[vpe_proxy.next_victim]); -+ -+ /* Map the new VPE instead */ -+ vpe_proxy.vpes[vpe_proxy.next_victim] = vpe; -+ vpe->vpe_proxy_event = vpe_proxy.next_victim; -+ vpe_proxy.next_victim = (vpe_proxy.next_victim + 1) % vpe_proxy.dev->nr_ites; -+ -+ vpe_proxy.dev->event_map.col_map[vpe->vpe_proxy_event] = vpe->col_idx; -+ its_send_mapti(vpe_proxy.dev, vpe->vpe_db_lpi, vpe->vpe_proxy_event); -+} -+ -+static void its_vpe_db_proxy_move(struct its_vpe *vpe, int from, int to) -+{ -+ unsigned long flags; -+ struct its_collection *target_col; -+ -+ /* GICv4.1 doesn't use a proxy, so nothing to do here */ -+ if (gic_rdists->has_rvpeid) -+ return; -+ -+ if (gic_rdists->has_direct_lpi) { -+ void __iomem *rdbase; -+ -+ rdbase = per_cpu_ptr(gic_rdists->rdist, from)->rd_base; -+ gic_write_lpir(vpe->vpe_db_lpi, rdbase + GICR_CLRLPIR); -+ wait_for_syncr(rdbase); -+ -+ return; -+ } -+ -+ raw_spin_lock_irqsave(&vpe_proxy.lock, flags); -+ -+ its_vpe_db_proxy_map_locked(vpe); -+ -+ target_col = &vpe_proxy.dev->its->collections[to]; -+ its_send_movi(vpe_proxy.dev, target_col, vpe->vpe_proxy_event); -+ vpe_proxy.dev->event_map.col_map[vpe->vpe_proxy_event] = to; -+ -+ raw_spin_unlock_irqrestore(&vpe_proxy.lock, flags); -+} -+ -+static int its_vpe_set_affinity(struct irq_data *d, -+ const struct cpumask *mask_val, -+ bool force) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ int from, cpu = cpumask_first(mask_val); -+ unsigned long flags; -+ -+ /* -+ * Changing affinity is mega expensive, so let's be as lazy as -+ * we can and only do it if we really have to. Also, if mapped -+ * into the proxy device, we need to move the doorbell -+ * interrupt to its new location. -+ * -+ * Another thing is that changing the affinity of a vPE affects -+ * *other interrupts* such as all the vLPIs that are routed to -+ * this vPE. This means that the irq_desc lock is not enough to -+ * protect us, and that we must ensure nobody samples vpe->col_idx -+ * during the update, hence the lock below which must also be -+ * taken on any vLPI handling path that evaluates vpe->col_idx. -+ */ -+ from = vpe_to_cpuid_lock(vpe, &flags); -+ if (from == cpu) -+ goto out; -+ -+ vpe->col_idx = cpu; -+ -+ /* -+ * GICv4.1 allows us to skip VMOVP if moving to a cpu whose RD -+ * is sharing its VPE table with the current one. -+ */ -+ if (gic_data_rdist_cpu(cpu)->vpe_table_mask && -+ cpumask_test_cpu(from, gic_data_rdist_cpu(cpu)->vpe_table_mask)) -+ goto out; -+ -+ its_send_vmovp(vpe); -+ its_vpe_db_proxy_move(vpe, from, cpu); -+ -+out: -+ irq_data_update_effective_affinity(d, cpumask_of(cpu)); -+ vpe_to_cpuid_unlock(vpe, flags); -+ -+ return IRQ_SET_MASK_OK_DONE; -+} -+ -+static void its_wait_vpt_parse_complete(void) -+{ -+ void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); -+ u64 val; -+ -+ if (!gic_rdists->has_vpend_valid_dirty) -+ return; -+ -+ WARN_ON_ONCE(readq_relaxed_poll_timeout_atomic(vlpi_base + GICR_VPENDBASER, -+ val, -+ !(val & GICR_VPENDBASER_Dirty), -+ 1, 500)); -+} -+ -+static void its_vpe_schedule(struct its_vpe *vpe) -+{ -+ void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); -+ u64 val; -+ -+ /* Schedule the VPE */ -+ val = virt_to_phys(page_address(vpe->its_vm->vprop_page)) & -+ GENMASK_ULL(51, 12); -+ val |= (LPI_NRBITS - 1) & GICR_VPROPBASER_IDBITS_MASK; -+ val |= GICR_VPROPBASER_RaWb; -+ val |= GICR_VPROPBASER_InnerShareable; -+ gicr_write_vpropbaser(val, vlpi_base + GICR_VPROPBASER); -+ -+ val = virt_to_phys(page_address(vpe->vpt_page)) & -+ GENMASK_ULL(51, 16); -+ val |= GICR_VPENDBASER_RaWaWb; -+ val |= GICR_VPENDBASER_InnerShareable; -+ /* -+ * There is no good way of finding out if the pending table is -+ * empty as we can race against the doorbell interrupt very -+ * easily. So in the end, vpe->pending_last is only an -+ * indication that the vcpu has something pending, not one -+ * that the pending table is empty. A good implementation -+ * would be able to read its coarse map pretty quickly anyway, -+ * making this a tolerable issue. -+ */ -+ val |= GICR_VPENDBASER_PendingLast; -+ val |= vpe->idai ? GICR_VPENDBASER_IDAI : 0; -+ val |= GICR_VPENDBASER_Valid; -+ gicr_write_vpendbaser(val, vlpi_base + GICR_VPENDBASER); -+} -+ -+static void its_vpe_deschedule(struct its_vpe *vpe) -+{ -+ void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); -+ u64 val; -+ -+ val = its_clear_vpend_valid(vlpi_base, 0, 0); -+ -+ vpe->idai = !!(val & GICR_VPENDBASER_IDAI); -+ vpe->pending_last = !!(val & GICR_VPENDBASER_PendingLast); -+} -+ -+static void its_vpe_invall(struct its_vpe *vpe) -+{ -+ struct its_node *its; -+ -+ list_for_each_entry(its, &its_nodes, entry) { -+ if (!is_v4(its)) -+ continue; -+ -+ if (its_list_map && !vpe->its_vm->vlpi_count[its->list_nr]) -+ continue; -+ -+ /* -+ * Sending a VINVALL to a single ITS is enough, as all -+ * we need is to reach the redistributors. -+ */ -+ its_send_vinvall(its, vpe); -+ return; -+ } -+} -+ -+static int its_vpe_set_vcpu_affinity(struct irq_data *d, void *vcpu_info) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ struct its_cmd_info *info = vcpu_info; -+ -+ switch (info->cmd_type) { -+ case SCHEDULE_VPE: -+ its_vpe_schedule(vpe); -+ return 0; -+ -+ case DESCHEDULE_VPE: -+ its_vpe_deschedule(vpe); -+ return 0; -+ -+ case COMMIT_VPE: -+ its_wait_vpt_parse_complete(); -+ return 0; -+ -+ case INVALL_VPE: -+ its_vpe_invall(vpe); -+ return 0; -+ -+ default: -+ return -EINVAL; -+ } -+} -+ -+static void its_vpe_send_cmd(struct its_vpe *vpe, -+ void (*cmd)(struct its_device *, u32)) -+{ -+ unsigned long flags; -+ -+ raw_spin_lock_irqsave(&vpe_proxy.lock, flags); -+ -+ its_vpe_db_proxy_map_locked(vpe); -+ cmd(vpe_proxy.dev, vpe->vpe_proxy_event); -+ -+ raw_spin_unlock_irqrestore(&vpe_proxy.lock, flags); -+} -+ -+static void its_vpe_send_inv(struct irq_data *d) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ -+ if (gic_rdists->has_direct_lpi) { -+ void __iomem *rdbase; -+ -+ /* Target the redistributor this VPE is currently known on */ -+ raw_spin_lock(&gic_data_rdist_cpu(vpe->col_idx)->rd_lock); -+ rdbase = per_cpu_ptr(gic_rdists->rdist, vpe->col_idx)->rd_base; -+ gic_write_lpir(d->parent_data->hwirq, rdbase + GICR_INVLPIR); -+ wait_for_syncr(rdbase); -+ raw_spin_unlock(&gic_data_rdist_cpu(vpe->col_idx)->rd_lock); -+ } else { -+ its_vpe_send_cmd(vpe, its_send_inv); -+ } -+} -+ -+static void its_vpe_mask_irq(struct irq_data *d) -+{ -+ /* -+ * We need to unmask the LPI, which is described by the parent -+ * irq_data. Instead of calling into the parent (which won't -+ * exactly do the right thing, let's simply use the -+ * parent_data pointer. Yes, I'm naughty. -+ */ -+ lpi_write_config(d->parent_data, LPI_PROP_ENABLED, 0); -+ its_vpe_send_inv(d); -+} -+ -+static void its_vpe_unmask_irq(struct irq_data *d) -+{ -+ /* Same hack as above... */ -+ lpi_write_config(d->parent_data, 0, LPI_PROP_ENABLED); -+ its_vpe_send_inv(d); -+} -+ -+static int its_vpe_set_irqchip_state(struct irq_data *d, -+ enum irqchip_irq_state which, -+ bool state) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ -+ if (which != IRQCHIP_STATE_PENDING) -+ return -EINVAL; -+ -+ if (gic_rdists->has_direct_lpi) { -+ void __iomem *rdbase; -+ -+ rdbase = per_cpu_ptr(gic_rdists->rdist, vpe->col_idx)->rd_base; -+ if (state) { -+ gic_write_lpir(vpe->vpe_db_lpi, rdbase + GICR_SETLPIR); -+ } else { -+ gic_write_lpir(vpe->vpe_db_lpi, rdbase + GICR_CLRLPIR); -+ wait_for_syncr(rdbase); -+ } -+ } else { -+ if (state) -+ its_vpe_send_cmd(vpe, its_send_int); -+ else -+ its_vpe_send_cmd(vpe, its_send_clear); -+ } -+ -+ return 0; -+} -+ -+static int its_vpe_retrigger(struct irq_data *d) -+{ -+ return !its_vpe_set_irqchip_state(d, IRQCHIP_STATE_PENDING, true); -+} -+ -+static struct irq_chip its_vpe_irq_chip = { -+ .name = "GICv4-vpe", -+ .irq_mask = its_vpe_mask_irq, -+ .irq_unmask = its_vpe_unmask_irq, -+ .irq_eoi = irq_chip_eoi_parent, -+ .irq_set_affinity = its_vpe_set_affinity, -+ .irq_retrigger = its_vpe_retrigger, -+ .irq_set_irqchip_state = its_vpe_set_irqchip_state, -+ .irq_set_vcpu_affinity = its_vpe_set_vcpu_affinity, -+}; -+ -+static struct its_node *find_4_1_its(void) -+{ -+ static struct its_node *its = NULL; -+ -+ if (!its) { -+ list_for_each_entry(its, &its_nodes, entry) { -+ if (is_v4_1(its)) -+ return its; -+ } -+ -+ /* Oops? */ -+ its = NULL; -+ } -+ -+ return its; -+} -+ -+static void its_vpe_4_1_send_inv(struct irq_data *d) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ struct its_node *its; -+ -+ /* -+ * GICv4.1 wants doorbells to be invalidated using the -+ * INVDB command in order to be broadcast to all RDs. Send -+ * it to the first valid ITS, and let the HW do its magic. -+ */ -+ its = find_4_1_its(); -+ if (its) -+ its_send_invdb(its, vpe); -+} -+ -+static void its_vpe_4_1_mask_irq(struct irq_data *d) -+{ -+ lpi_write_config(d->parent_data, LPI_PROP_ENABLED, 0); -+ its_vpe_4_1_send_inv(d); -+} -+ -+static void its_vpe_4_1_unmask_irq(struct irq_data *d) -+{ -+ lpi_write_config(d->parent_data, 0, LPI_PROP_ENABLED); -+ its_vpe_4_1_send_inv(d); -+} -+ -+static void its_vpe_4_1_schedule(struct its_vpe *vpe, -+ struct its_cmd_info *info) -+{ -+ void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); -+ u64 val = 0; -+ -+ /* Schedule the VPE */ -+ val |= GICR_VPENDBASER_Valid; -+ val |= info->g0en ? GICR_VPENDBASER_4_1_VGRP0EN : 0; -+ val |= info->g1en ? GICR_VPENDBASER_4_1_VGRP1EN : 0; -+ val |= FIELD_PREP(GICR_VPENDBASER_4_1_VPEID, vpe->vpe_id); -+ -+ gicr_write_vpendbaser(val, vlpi_base + GICR_VPENDBASER); -+} -+ -+static void its_vpe_4_1_deschedule(struct its_vpe *vpe, -+ struct its_cmd_info *info) -+{ -+ void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); -+ u64 val; -+ -+ if (info->req_db) { -+ unsigned long flags; -+ -+ /* -+ * vPE is going to block: make the vPE non-resident with -+ * PendingLast clear and DB set. The GIC guarantees that if -+ * we read-back PendingLast clear, then a doorbell will be -+ * delivered when an interrupt comes. -+ * -+ * Note the locking to deal with the concurrent update of -+ * pending_last from the doorbell interrupt handler that can -+ * run concurrently. -+ */ -+ raw_spin_lock_irqsave(&vpe->vpe_lock, flags); -+ val = its_clear_vpend_valid(vlpi_base, -+ GICR_VPENDBASER_PendingLast, -+ GICR_VPENDBASER_4_1_DB); -+ vpe->pending_last = !!(val & GICR_VPENDBASER_PendingLast); -+ raw_spin_unlock_irqrestore(&vpe->vpe_lock, flags); -+ } else { -+ /* -+ * We're not blocking, so just make the vPE non-resident -+ * with PendingLast set, indicating that we'll be back. -+ */ -+ val = its_clear_vpend_valid(vlpi_base, -+ 0, -+ GICR_VPENDBASER_PendingLast); -+ vpe->pending_last = true; -+ } -+} -+ -+static void its_vpe_4_1_invall(struct its_vpe *vpe) -+{ -+ void __iomem *rdbase; -+ unsigned long flags; -+ u64 val; -+ int cpu; -+ -+ val = GICR_INVALLR_V; -+ val |= FIELD_PREP(GICR_INVALLR_VPEID, vpe->vpe_id); -+ -+ /* Target the redistributor this vPE is currently known on */ -+ cpu = vpe_to_cpuid_lock(vpe, &flags); -+ raw_spin_lock(&gic_data_rdist_cpu(cpu)->rd_lock); -+ rdbase = per_cpu_ptr(gic_rdists->rdist, cpu)->rd_base; -+ gic_write_lpir(val, rdbase + GICR_INVALLR); -+ -+ wait_for_syncr(rdbase); -+ raw_spin_unlock(&gic_data_rdist_cpu(cpu)->rd_lock); -+ vpe_to_cpuid_unlock(vpe, flags); -+} -+ -+static int its_vpe_4_1_set_vcpu_affinity(struct irq_data *d, void *vcpu_info) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ struct its_cmd_info *info = vcpu_info; -+ -+ switch (info->cmd_type) { -+ case SCHEDULE_VPE: -+ its_vpe_4_1_schedule(vpe, info); -+ return 0; -+ -+ case DESCHEDULE_VPE: -+ its_vpe_4_1_deschedule(vpe, info); -+ return 0; -+ -+ case COMMIT_VPE: -+ its_wait_vpt_parse_complete(); -+ return 0; -+ -+ case INVALL_VPE: -+ its_vpe_4_1_invall(vpe); -+ return 0; -+ -+ default: -+ return -EINVAL; -+ } -+} -+ -+static struct irq_chip its_vpe_4_1_irq_chip = { -+ .name = "GICv4.1-vpe", -+ .irq_mask = its_vpe_4_1_mask_irq, -+ .irq_unmask = its_vpe_4_1_unmask_irq, -+ .irq_eoi = irq_chip_eoi_parent, -+ .irq_set_affinity = its_vpe_set_affinity, -+ .irq_set_vcpu_affinity = its_vpe_4_1_set_vcpu_affinity, -+}; -+ -+static void its_configure_sgi(struct irq_data *d, bool clear) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ struct its_cmd_desc desc; -+ -+ desc.its_vsgi_cmd.vpe = vpe; -+ desc.its_vsgi_cmd.sgi = d->hwirq; -+ desc.its_vsgi_cmd.priority = vpe->sgi_config[d->hwirq].priority; -+ desc.its_vsgi_cmd.enable = vpe->sgi_config[d->hwirq].enabled; -+ desc.its_vsgi_cmd.group = vpe->sgi_config[d->hwirq].group; -+ desc.its_vsgi_cmd.clear = clear; -+ -+ /* -+ * GICv4.1 allows us to send VSGI commands to any ITS as long as the -+ * destination VPE is mapped there. Since we map them eagerly at -+ * activation time, we're pretty sure the first GICv4.1 ITS will do. -+ */ -+ its_send_single_vcommand(find_4_1_its(), its_build_vsgi_cmd, &desc); -+} -+ -+static void its_sgi_mask_irq(struct irq_data *d) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ -+ vpe->sgi_config[d->hwirq].enabled = false; -+ its_configure_sgi(d, false); -+} -+ -+static void its_sgi_unmask_irq(struct irq_data *d) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ -+ vpe->sgi_config[d->hwirq].enabled = true; -+ its_configure_sgi(d, false); -+} -+ -+static int its_sgi_set_affinity(struct irq_data *d, -+ const struct cpumask *mask_val, -+ bool force) -+{ -+ /* -+ * There is no notion of affinity for virtual SGIs, at least -+ * not on the host (since they can only be targeting a vPE). -+ * Tell the kernel we've done whatever it asked for. -+ */ -+ irq_data_update_effective_affinity(d, mask_val); -+ return IRQ_SET_MASK_OK; -+} -+ -+static int its_sgi_set_irqchip_state(struct irq_data *d, -+ enum irqchip_irq_state which, -+ bool state) -+{ -+ if (which != IRQCHIP_STATE_PENDING) -+ return -EINVAL; -+ -+ if (state) { -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ struct its_node *its = find_4_1_its(); -+ u64 val; -+ -+ val = FIELD_PREP(GITS_SGIR_VPEID, vpe->vpe_id); -+ val |= FIELD_PREP(GITS_SGIR_VINTID, d->hwirq); -+ writeq_relaxed(val, its->sgir_base + GITS_SGIR - SZ_128K); -+ } else { -+ its_configure_sgi(d, true); -+ } -+ -+ return 0; -+} -+ -+static int its_sgi_get_irqchip_state(struct irq_data *d, -+ enum irqchip_irq_state which, bool *val) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ void __iomem *base; -+ unsigned long flags; -+ u32 count = 1000000; /* 1s! */ -+ u32 status; -+ int cpu; -+ -+ if (which != IRQCHIP_STATE_PENDING) -+ return -EINVAL; -+ -+ /* -+ * Locking galore! We can race against two different events: -+ * -+ * - Concurrent vPE affinity change: we must make sure it cannot -+ * happen, or we'll talk to the wrong redistributor. This is -+ * identical to what happens with vLPIs. -+ * -+ * - Concurrent VSGIPENDR access: As it involves accessing two -+ * MMIO registers, this must be made atomic one way or another. -+ */ -+ cpu = vpe_to_cpuid_lock(vpe, &flags); -+ raw_spin_lock(&gic_data_rdist_cpu(cpu)->rd_lock); -+ base = gic_data_rdist_cpu(cpu)->rd_base + SZ_128K; -+ writel_relaxed(vpe->vpe_id, base + GICR_VSGIR); -+ do { -+ status = readl_relaxed(base + GICR_VSGIPENDR); -+ if (!(status & GICR_VSGIPENDR_BUSY)) -+ goto out; -+ -+ count--; -+ if (!count) { -+ pr_err_ratelimited("Unable to get SGI status\n"); -+ goto out; -+ } -+ cpu_relax(); -+ udelay(1); -+ } while (count); -+ -+out: -+ raw_spin_unlock(&gic_data_rdist_cpu(cpu)->rd_lock); -+ vpe_to_cpuid_unlock(vpe, flags); -+ -+ if (!count) -+ return -ENXIO; -+ -+ *val = !!(status & (1 << d->hwirq)); -+ -+ return 0; -+} -+ -+static int its_sgi_set_vcpu_affinity(struct irq_data *d, void *vcpu_info) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ struct its_cmd_info *info = vcpu_info; -+ -+ switch (info->cmd_type) { -+ case PROP_UPDATE_VSGI: -+ vpe->sgi_config[d->hwirq].priority = info->priority; -+ vpe->sgi_config[d->hwirq].group = info->group; -+ its_configure_sgi(d, false); -+ return 0; -+ -+ default: -+ return -EINVAL; -+ } -+} -+ -+static struct irq_chip its_sgi_irq_chip = { -+ .name = "GICv4.1-sgi", -+ .irq_mask = its_sgi_mask_irq, -+ .irq_unmask = its_sgi_unmask_irq, -+ .irq_set_affinity = its_sgi_set_affinity, -+ .irq_set_irqchip_state = its_sgi_set_irqchip_state, -+ .irq_get_irqchip_state = its_sgi_get_irqchip_state, -+ .irq_set_vcpu_affinity = its_sgi_set_vcpu_affinity, -+}; -+ -+static int its_sgi_irq_domain_alloc(struct irq_domain *domain, -+ unsigned int virq, unsigned int nr_irqs, -+ void *args) -+{ -+ struct its_vpe *vpe = args; -+ int i; -+ -+ /* Yes, we do want 16 SGIs */ -+ WARN_ON(nr_irqs != 16); -+ -+ for (i = 0; i < 16; i++) { -+ vpe->sgi_config[i].priority = 0; -+ vpe->sgi_config[i].enabled = false; -+ vpe->sgi_config[i].group = false; -+ -+ irq_domain_set_hwirq_and_chip(domain, virq + i, i, -+ &its_sgi_irq_chip, vpe); -+ irq_set_status_flags(virq + i, IRQ_DISABLE_UNLAZY); -+ } -+ -+ return 0; -+} -+ -+static void its_sgi_irq_domain_free(struct irq_domain *domain, -+ unsigned int virq, -+ unsigned int nr_irqs) -+{ -+ /* Nothing to do */ -+} -+ -+static int its_sgi_irq_domain_activate(struct irq_domain *domain, -+ struct irq_data *d, bool reserve) -+{ -+ /* Write out the initial SGI configuration */ -+ its_configure_sgi(d, false); -+ return 0; -+} -+ -+static void its_sgi_irq_domain_deactivate(struct irq_domain *domain, -+ struct irq_data *d) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ -+ /* -+ * The VSGI command is awkward: -+ * -+ * - To change the configuration, CLEAR must be set to false, -+ * leaving the pending bit unchanged. -+ * - To clear the pending bit, CLEAR must be set to true, leaving -+ * the configuration unchanged. -+ * -+ * You just can't do both at once, hence the two commands below. -+ */ -+ vpe->sgi_config[d->hwirq].enabled = false; -+ its_configure_sgi(d, false); -+ its_configure_sgi(d, true); -+} -+ -+static const struct irq_domain_ops its_sgi_domain_ops = { -+ .alloc = its_sgi_irq_domain_alloc, -+ .free = its_sgi_irq_domain_free, -+ .activate = its_sgi_irq_domain_activate, -+ .deactivate = its_sgi_irq_domain_deactivate, -+}; -+ -+static int its_vpe_id_alloc(void) -+{ -+ return ida_simple_get(&its_vpeid_ida, 0, ITS_MAX_VPEID, GFP_KERNEL); -+} -+ -+static void its_vpe_id_free(u16 id) -+{ -+ ida_simple_remove(&its_vpeid_ida, id); -+} -+ -+static int its_vpe_init(struct its_vpe *vpe) -+{ -+ struct page *vpt_page; -+ int vpe_id; -+ -+ /* Allocate vpe_id */ -+ vpe_id = its_vpe_id_alloc(); -+ if (vpe_id < 0) -+ return vpe_id; -+ -+ /* Allocate VPT */ -+ vpt_page = its_allocate_pending_table(GFP_KERNEL); -+ if (!vpt_page) { -+ its_vpe_id_free(vpe_id); -+ return -ENOMEM; -+ } -+ -+ if (!its_alloc_vpe_table(vpe_id)) { -+ its_vpe_id_free(vpe_id); -+ its_free_pending_table(vpt_page); -+ return -ENOMEM; -+ } -+ -+ raw_spin_lock_init(&vpe->vpe_lock); -+ vpe->vpe_id = vpe_id; -+ vpe->vpt_page = vpt_page; -+ if (gic_rdists->has_rvpeid) -+ atomic_set(&vpe->vmapp_count, 0); -+ else -+ vpe->vpe_proxy_event = -1; -+ -+ return 0; -+} -+ -+static void its_vpe_teardown(struct its_vpe *vpe) -+{ -+ its_vpe_db_proxy_unmap(vpe); -+ its_vpe_id_free(vpe->vpe_id); -+ its_free_pending_table(vpe->vpt_page); -+} -+ -+static void its_vpe_irq_domain_free(struct irq_domain *domain, -+ unsigned int virq, -+ unsigned int nr_irqs) -+{ -+ struct its_vm *vm = domain->host_data; -+ int i; -+ -+ irq_domain_free_irqs_parent(domain, virq, nr_irqs); -+ -+ for (i = 0; i < nr_irqs; i++) { -+ struct irq_data *data = irq_domain_get_irq_data(domain, -+ virq + i); -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(data); -+ -+ BUG_ON(vm != vpe->its_vm); -+ -+ clear_bit(data->hwirq, vm->db_bitmap); -+ its_vpe_teardown(vpe); -+ irq_domain_reset_irq_data(data); -+ } -+ -+ if (bitmap_empty(vm->db_bitmap, vm->nr_db_lpis)) { -+ its_lpi_free(vm->db_bitmap, vm->db_lpi_base, vm->nr_db_lpis); -+ its_free_prop_table(vm->vprop_page); -+ } -+} -+ -+static int its_vpe_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, -+ unsigned int nr_irqs, void *args) -+{ -+ struct irq_chip *irqchip = &its_vpe_irq_chip; -+ struct its_vm *vm = args; -+ unsigned long *bitmap; -+ struct page *vprop_page; -+ int base, nr_ids, i, err = 0; -+ -+ BUG_ON(!vm); -+ -+ bitmap = its_lpi_alloc(roundup_pow_of_two(nr_irqs), &base, &nr_ids); -+ if (!bitmap) -+ return -ENOMEM; -+ -+ if (nr_ids < nr_irqs) { -+ its_lpi_free(bitmap, base, nr_ids); -+ return -ENOMEM; -+ } -+ -+ vprop_page = its_allocate_prop_table(GFP_KERNEL); -+ if (!vprop_page) { -+ its_lpi_free(bitmap, base, nr_ids); -+ return -ENOMEM; -+ } -+ -+ vm->db_bitmap = bitmap; -+ vm->db_lpi_base = base; -+ vm->nr_db_lpis = nr_ids; -+ vm->vprop_page = vprop_page; -+ -+ if (gic_rdists->has_rvpeid) -+ irqchip = &its_vpe_4_1_irq_chip; -+ -+ for (i = 0; i < nr_irqs; i++) { -+ vm->vpes[i]->vpe_db_lpi = base + i; -+ err = its_vpe_init(vm->vpes[i]); -+ if (err) -+ break; -+ err = its_irq_gic_domain_alloc(domain, virq + i, -+ vm->vpes[i]->vpe_db_lpi); -+ if (err) -+ break; -+ irq_domain_set_hwirq_and_chip(domain, virq + i, i, -+ irqchip, vm->vpes[i]); -+ set_bit(i, bitmap); -+ } -+ -+ if (err) { -+ if (i > 0) -+ its_vpe_irq_domain_free(domain, virq, i); -+ -+ its_lpi_free(bitmap, base, nr_ids); -+ its_free_prop_table(vprop_page); -+ } -+ -+ return err; -+} -+ -+static int its_vpe_irq_domain_activate(struct irq_domain *domain, -+ struct irq_data *d, bool reserve) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ struct its_node *its; -+ -+ /* -+ * If we use the list map, we issue VMAPP on demand... Unless -+ * we're on a GICv4.1 and we eagerly map the VPE on all ITSs -+ * so that VSGIs can work. -+ */ -+ if (!gic_requires_eager_mapping()) -+ return 0; -+ -+ /* Map the VPE to the first possible CPU */ -+ vpe->col_idx = cpumask_first(cpu_online_mask); -+ -+ list_for_each_entry(its, &its_nodes, entry) { -+ if (!is_v4(its)) -+ continue; -+ -+ its_send_vmapp(its, vpe, true); -+ its_send_vinvall(its, vpe); -+ } -+ -+ irq_data_update_effective_affinity(d, cpumask_of(vpe->col_idx)); -+ -+ return 0; -+} -+ -+static void its_vpe_irq_domain_deactivate(struct irq_domain *domain, -+ struct irq_data *d) -+{ -+ struct its_vpe *vpe = irq_data_get_irq_chip_data(d); -+ struct its_node *its; -+ -+ /* -+ * If we use the list map on GICv4.0, we unmap the VPE once no -+ * VLPIs are associated with the VM. -+ */ -+ if (!gic_requires_eager_mapping()) -+ return; -+ -+ list_for_each_entry(its, &its_nodes, entry) { -+ if (!is_v4(its)) -+ continue; -+ -+ its_send_vmapp(its, vpe, false); -+ } -+ -+ /* -+ * There may be a direct read to the VPT after unmapping the -+ * vPE, to guarantee the validity of this, we make the VPT -+ * memory coherent with the CPU caches here. -+ */ -+ if (find_4_1_its() && !atomic_read(&vpe->vmapp_count)) -+ gic_flush_dcache_to_poc(page_address(vpe->vpt_page), -+ LPI_PENDBASE_SZ); -+} -+ -+static const struct irq_domain_ops its_vpe_domain_ops = { -+ .alloc = its_vpe_irq_domain_alloc, -+ .free = its_vpe_irq_domain_free, -+ .activate = its_vpe_irq_domain_activate, -+ .deactivate = its_vpe_irq_domain_deactivate, -+}; -+ -+static int its_force_quiescent(void __iomem *base) -+{ -+ u32 count = 1000000; /* 1s */ -+ u32 val; -+ -+ val = readl_relaxed(base + GITS_CTLR); -+ /* -+ * GIC architecture specification requires the ITS to be both -+ * disabled and quiescent for writes to GITS_BASER or -+ * GITS_CBASER to not have UNPREDICTABLE results. -+ */ -+ if ((val & GITS_CTLR_QUIESCENT) && !(val & GITS_CTLR_ENABLE)) -+ return 0; -+ -+ /* Disable the generation of all interrupts to this ITS */ -+ val &= ~(GITS_CTLR_ENABLE | GITS_CTLR_ImDe); -+ writel_relaxed(val, base + GITS_CTLR); -+ -+ /* Poll GITS_CTLR and wait until ITS becomes quiescent */ -+ while (1) { -+ val = readl_relaxed(base + GITS_CTLR); -+ if (val & GITS_CTLR_QUIESCENT) -+ return 0; -+ -+ count--; -+ if (!count) -+ return -EBUSY; -+ -+ cpu_relax(); -+ udelay(1); -+ } -+} -+ -+static bool __maybe_unused its_enable_quirk_cavium_22375(void *data) -+{ -+ struct its_node *its = data; -+ -+ /* erratum 22375: only alloc 8MB table size (20 bits) */ -+ its->typer &= ~GITS_TYPER_DEVBITS; -+ its->typer |= FIELD_PREP(GITS_TYPER_DEVBITS, 20 - 1); -+ its->flags |= ITS_FLAGS_WORKAROUND_CAVIUM_22375; -+ -+ return true; -+} -+ -+static bool __maybe_unused its_enable_quirk_cavium_23144(void *data) -+{ -+ struct its_node *its = data; -+ -+ its->flags |= ITS_FLAGS_WORKAROUND_CAVIUM_23144; -+ -+ return true; -+} -+ -+static bool __maybe_unused its_enable_quirk_qdf2400_e0065(void *data) -+{ -+ struct its_node *its = data; -+ -+ /* On QDF2400, the size of the ITE is 16Bytes */ -+ its->typer &= ~GITS_TYPER_ITT_ENTRY_SIZE; -+ its->typer |= FIELD_PREP(GITS_TYPER_ITT_ENTRY_SIZE, 16 - 1); -+ -+ return true; -+} -+ -+static u64 its_irq_get_msi_base_pre_its(struct its_device *its_dev) -+{ -+ struct its_node *its = its_dev->its; -+ -+ /* -+ * The Socionext Synquacer SoC has a so-called 'pre-ITS', -+ * which maps 32-bit writes targeted at a separate window of -+ * size '4 << device_id_bits' onto writes to GITS_TRANSLATER -+ * with device ID taken from bits [device_id_bits + 1:2] of -+ * the window offset. -+ */ -+ return its->pre_its_base + (its_dev->device_id << 2); -+} -+ -+static bool __maybe_unused its_enable_quirk_socionext_synquacer(void *data) -+{ -+ struct its_node *its = data; -+ u32 pre_its_window[2]; -+ u32 ids; -+ -+ if (!fwnode_property_read_u32_array(its->fwnode_handle, -+ "socionext,synquacer-pre-its", -+ pre_its_window, -+ ARRAY_SIZE(pre_its_window))) { -+ -+ its->pre_its_base = pre_its_window[0]; -+ its->get_msi_base = its_irq_get_msi_base_pre_its; -+ -+ ids = ilog2(pre_its_window[1]) - 2; -+ if (device_ids(its) > ids) { -+ its->typer &= ~GITS_TYPER_DEVBITS; -+ its->typer |= FIELD_PREP(GITS_TYPER_DEVBITS, ids - 1); -+ } -+ -+ /* the pre-ITS breaks isolation, so disable MSI remapping */ -+ its->msi_domain_flags &= ~IRQ_DOMAIN_FLAG_ISOLATED_MSI; -+ return true; -+ } -+ return false; -+} -+ -+static bool __maybe_unused its_enable_quirk_hip07_161600802(void *data) -+{ -+ struct its_node *its = data; -+ -+ /* -+ * Hip07 insists on using the wrong address for the VLPI -+ * page. Trick it into doing the right thing... -+ */ -+ its->vlpi_redist_offset = SZ_128K; -+ return true; -+} -+ -+static const struct gic_quirk its_quirks[] = { -+#ifdef CONFIG_CAVIUM_ERRATUM_22375 -+ { -+ .desc = "ITS: Cavium errata 22375, 24313", -+ .iidr = 0xa100034c, /* ThunderX pass 1.x */ -+ .mask = 0xffff0fff, -+ .init = its_enable_quirk_cavium_22375, -+ }, -+#endif -+#ifdef CONFIG_CAVIUM_ERRATUM_23144 -+ { -+ .desc = "ITS: Cavium erratum 23144", -+ .iidr = 0xa100034c, /* ThunderX pass 1.x */ -+ .mask = 0xffff0fff, -+ .init = its_enable_quirk_cavium_23144, -+ }, -+#endif -+#ifdef CONFIG_QCOM_QDF2400_ERRATUM_0065 -+ { -+ .desc = "ITS: QDF2400 erratum 0065", -+ .iidr = 0x00001070, /* QDF2400 ITS rev 1.x */ -+ .mask = 0xffffffff, -+ .init = its_enable_quirk_qdf2400_e0065, -+ }, -+#endif -+#ifdef CONFIG_SOCIONEXT_SYNQUACER_PREITS -+ { -+ /* -+ * The Socionext Synquacer SoC incorporates ARM's own GIC-500 -+ * implementation, but with a 'pre-ITS' added that requires -+ * special handling in software. -+ */ -+ .desc = "ITS: Socionext Synquacer pre-ITS", -+ .iidr = 0x0001143b, -+ .mask = 0xffffffff, -+ .init = its_enable_quirk_socionext_synquacer, -+ }, -+#endif -+#ifdef CONFIG_HISILICON_ERRATUM_161600802 -+ { -+ .desc = "ITS: Hip07 erratum 161600802", -+ .iidr = 0x00000004, -+ .mask = 0xffffffff, -+ .init = its_enable_quirk_hip07_161600802, -+ }, -+#endif -+ { -+ } -+}; -+ -+static void its_enable_quirks(struct its_node *its) -+{ -+ u32 iidr = readl_relaxed(its->base + GITS_IIDR); -+ -+ gic_enable_quirks(iidr, its_quirks, its); -+} -+ -+static int its_save_disable(void) -+{ -+ struct its_node *its; -+ int err = 0; -+ -+ raw_spin_lock(&its_lock); -+ list_for_each_entry(its, &its_nodes, entry) { -+ void __iomem *base; -+ -+ base = its->base; -+ its->ctlr_save = readl_relaxed(base + GITS_CTLR); -+ err = its_force_quiescent(base); -+ if (err) { -+ pr_err("ITS@%pa: failed to quiesce: %d\n", -+ &its->phys_base, err); -+ writel_relaxed(its->ctlr_save, base + GITS_CTLR); -+ goto err; -+ } -+ -+ its->cbaser_save = gits_read_cbaser(base + GITS_CBASER); -+ } -+ -+err: -+ if (err) { -+ list_for_each_entry_continue_reverse(its, &its_nodes, entry) { -+ void __iomem *base; -+ -+ base = its->base; -+ writel_relaxed(its->ctlr_save, base + GITS_CTLR); -+ } -+ } -+ raw_spin_unlock(&its_lock); -+ -+ return err; -+} -+ -+static void its_restore_enable(void) -+{ -+ struct its_node *its; -+ int ret; -+ -+ raw_spin_lock(&its_lock); -+ list_for_each_entry(its, &its_nodes, entry) { -+ void __iomem *base; -+ int i; -+ -+ base = its->base; -+ -+ /* -+ * Make sure that the ITS is disabled. If it fails to quiesce, -+ * don't restore it since writing to CBASER or BASER -+ * registers is undefined according to the GIC v3 ITS -+ * Specification. -+ * -+ * Firmware resuming with the ITS enabled is terminally broken. -+ */ -+ WARN_ON(readl_relaxed(base + GITS_CTLR) & GITS_CTLR_ENABLE); -+ ret = its_force_quiescent(base); -+ if (ret) { -+ pr_err("ITS@%pa: failed to quiesce on resume: %d\n", -+ &its->phys_base, ret); -+ continue; -+ } -+ -+ gits_write_cbaser(its->cbaser_save, base + GITS_CBASER); -+ -+ /* -+ * Writing CBASER resets CREADR to 0, so make CWRITER and -+ * cmd_write line up with it. -+ */ -+ its->cmd_write = its->cmd_base; -+ gits_write_cwriter(0, base + GITS_CWRITER); -+ -+ /* Restore GITS_BASER from the value cache. */ -+ for (i = 0; i < GITS_BASER_NR_REGS; i++) { -+ struct its_baser *baser = &its->tables[i]; -+ -+ if (!(baser->val & GITS_BASER_VALID)) -+ continue; -+ -+ its_write_baser(its, baser, baser->val); -+ } -+ writel_relaxed(its->ctlr_save, base + GITS_CTLR); -+ -+ /* -+ * Reinit the collection if it's stored in the ITS. This is -+ * indicated by the col_id being less than the HCC field. -+ * CID < HCC as specified in the GIC v3 Documentation. -+ */ -+ if (its->collections[smp_processor_id()].col_id < -+ GITS_TYPER_HCC(gic_read_typer(base + GITS_TYPER))) -+ its_cpu_init_collection(its); -+ } -+ raw_spin_unlock(&its_lock); -+} -+ -+static struct syscore_ops its_syscore_ops = { -+ .suspend = its_save_disable, -+ .resume = its_restore_enable, -+}; -+ -+static void __init __iomem *its_map_one(struct resource *res, int *err) -+{ -+ void __iomem *its_base; -+ u32 val; -+ -+ its_base = ioremap(res->start, SZ_64K); -+ if (!its_base) { -+ pr_warn("ITS@%pa: Unable to map ITS registers\n", &res->start); -+ *err = -ENOMEM; -+ return NULL; -+ } -+ -+ val = readl_relaxed(its_base + GITS_PIDR2) & GIC_PIDR2_ARCH_MASK; -+ if (val != 0x30 && val != 0x40) { -+ pr_warn("ITS@%pa: No ITS detected, giving up\n", &res->start); -+ *err = -ENODEV; -+ goto out_unmap; -+ } -+ -+ *err = its_force_quiescent(its_base); -+ if (*err) { -+ pr_warn("ITS@%pa: Failed to quiesce, giving up\n", &res->start); -+ goto out_unmap; -+ } -+ -+ return its_base; -+ -+out_unmap: -+ iounmap(its_base); -+ return NULL; -+} -+ -+static int its_init_domain(struct fwnode_handle *handle, struct its_node *its) -+{ -+ struct irq_domain *inner_domain; -+ struct msi_domain_info *info; -+ -+ info = kzalloc(sizeof(*info), GFP_KERNEL); -+ if (!info) -+ return -ENOMEM; -+ -+ inner_domain = irq_domain_create_tree(handle, &its_domain_ops, its); -+ if (!inner_domain) { -+ kfree(info); -+ return -ENOMEM; -+ } -+ -+ inner_domain->parent = its_parent; -+ irq_domain_update_bus_token(inner_domain, DOMAIN_BUS_NEXUS); -+ inner_domain->flags |= its->msi_domain_flags; -+ info->ops = &its_msi_domain_ops; -+ info->data = its; -+ inner_domain->host_data = info; -+ -+ return 0; -+} -+ -+static int its_init_vpe_domain(void) -+{ -+ struct its_node *its; -+ u32 devid; -+ int entries; -+ -+ if (gic_rdists->has_direct_lpi) { -+ pr_info("ITS: Using DirectLPI for VPE invalidation\n"); -+ return 0; -+ } -+ -+ /* Any ITS will do, even if not v4 */ -+ its = list_first_entry(&its_nodes, struct its_node, entry); -+ -+ entries = roundup_pow_of_two(nr_cpu_ids); -+ vpe_proxy.vpes = kcalloc(entries, sizeof(*vpe_proxy.vpes), -+ GFP_KERNEL); -+ if (!vpe_proxy.vpes) -+ return -ENOMEM; -+ -+ /* Use the last possible DevID */ -+ devid = GENMASK(device_ids(its) - 1, 0); -+ vpe_proxy.dev = its_create_device(its, devid, entries, false); -+ if (!vpe_proxy.dev) { -+ kfree(vpe_proxy.vpes); -+ pr_err("ITS: Can't allocate GICv4 proxy device\n"); -+ return -ENOMEM; -+ } -+ -+ BUG_ON(entries > vpe_proxy.dev->nr_ites); -+ -+ raw_spin_lock_init(&vpe_proxy.lock); -+ vpe_proxy.next_victim = 0; -+ pr_info("ITS: Allocated DevID %x as GICv4 proxy device (%d slots)\n", -+ devid, vpe_proxy.dev->nr_ites); -+ -+ return 0; -+} -+ -+static int __init its_compute_its_list_map(struct resource *res, -+ void __iomem *its_base) -+{ -+ int its_number; -+ u32 ctlr; -+ -+ /* -+ * This is assumed to be done early enough that we're -+ * guaranteed to be single-threaded, hence no -+ * locking. Should this change, we should address -+ * this. -+ */ -+ its_number = find_first_zero_bit(&its_list_map, GICv4_ITS_LIST_MAX); -+ if (its_number >= GICv4_ITS_LIST_MAX) { -+ pr_err("ITS@%pa: No ITSList entry available!\n", -+ &res->start); -+ return -EINVAL; -+ } -+ -+ ctlr = readl_relaxed(its_base + GITS_CTLR); -+ ctlr &= ~GITS_CTLR_ITS_NUMBER; -+ ctlr |= its_number << GITS_CTLR_ITS_NUMBER_SHIFT; -+ writel_relaxed(ctlr, its_base + GITS_CTLR); -+ ctlr = readl_relaxed(its_base + GITS_CTLR); -+ if ((ctlr & GITS_CTLR_ITS_NUMBER) != (its_number << GITS_CTLR_ITS_NUMBER_SHIFT)) { -+ its_number = ctlr & GITS_CTLR_ITS_NUMBER; -+ its_number >>= GITS_CTLR_ITS_NUMBER_SHIFT; -+ } -+ -+ if (test_and_set_bit(its_number, &its_list_map)) { -+ pr_err("ITS@%pa: Duplicate ITSList entry %d\n", -+ &res->start, its_number); -+ return -EINVAL; -+ } -+ -+ return its_number; -+} -+ -+static int __init its_probe_one(struct resource *res, -+ struct fwnode_handle *handle, int numa_node) -+{ -+ struct its_node *its; -+ void __iomem *its_base; -+ u64 baser, tmp, typer; -+ struct page *page; -+ u32 ctlr; -+ int err; -+ -+ its_base = its_map_one(res, &err); -+ if (!its_base) -+ return err; -+ -+ pr_info("ITS %pR\n", res); -+ -+ its = kzalloc(sizeof(*its), GFP_KERNEL); -+ if (!its) { -+ err = -ENOMEM; -+ goto out_unmap; -+ } -+ -+ raw_spin_lock_init(&its->lock); -+ mutex_init(&its->dev_alloc_lock); -+ INIT_LIST_HEAD(&its->entry); -+ INIT_LIST_HEAD(&its->its_device_list); -+ typer = gic_read_typer(its_base + GITS_TYPER); -+ its->typer = typer; -+ its->base = its_base; -+ its->phys_base = res->start; -+ if (is_v4(its)) { -+ if (!(typer & GITS_TYPER_VMOVP)) { -+ err = its_compute_its_list_map(res, its_base); -+ if (err < 0) -+ goto out_free_its; -+ -+ its->list_nr = err; -+ -+ pr_info("ITS@%pa: Using ITS number %d\n", -+ &res->start, err); -+ } else { -+ pr_info("ITS@%pa: Single VMOVP capable\n", &res->start); -+ } -+ -+ if (is_v4_1(its)) { -+ u32 svpet = FIELD_GET(GITS_TYPER_SVPET, typer); -+ -+ its->sgir_base = ioremap(res->start + SZ_128K, SZ_64K); -+ if (!its->sgir_base) { -+ err = -ENOMEM; -+ goto out_free_its; -+ } -+ -+ its->mpidr = readl_relaxed(its_base + GITS_MPIDR); -+ -+ pr_info("ITS@%pa: Using GICv4.1 mode %08x %08x\n", -+ &res->start, its->mpidr, svpet); -+ } -+ } -+ -+ its->numa_node = numa_node; -+ -+ page = alloc_pages_node(its->numa_node, GFP_KERNEL | __GFP_ZERO, -+ get_order(ITS_CMD_QUEUE_SZ)); -+ if (!page) { -+ err = -ENOMEM; -+ goto out_unmap_sgir; -+ } -+ its->cmd_base = (void *)page_address(page); -+ its->cmd_write = its->cmd_base; -+ its->fwnode_handle = handle; -+ its->get_msi_base = its_irq_get_msi_base; -+ its->msi_domain_flags = IRQ_DOMAIN_FLAG_ISOLATED_MSI; -+ -+ its_enable_quirks(its); -+ -+ err = its_alloc_tables(its); -+ if (err) -+ goto out_free_cmd; -+ -+ err = its_alloc_collections(its); -+ if (err) -+ goto out_free_tables; -+ -+ baser = (virt_to_phys(its->cmd_base) | -+ GITS_CBASER_RaWaWb | -+ GITS_CBASER_InnerShareable | -+ (ITS_CMD_QUEUE_SZ / SZ_4K - 1) | -+ GITS_CBASER_VALID); -+ -+ gits_write_cbaser(baser, its->base + GITS_CBASER); -+ tmp = gits_read_cbaser(its->base + GITS_CBASER); -+ -+ if ((tmp ^ baser) & GITS_CBASER_SHAREABILITY_MASK) { -+ if (!(tmp & GITS_CBASER_SHAREABILITY_MASK)) { -+ /* -+ * The HW reports non-shareable, we must -+ * remove the cacheability attributes as -+ * well. -+ */ -+ baser &= ~(GITS_CBASER_SHAREABILITY_MASK | -+ GITS_CBASER_CACHEABILITY_MASK); -+ baser |= GITS_CBASER_nC; -+ gits_write_cbaser(baser, its->base + GITS_CBASER); -+ } -+ pr_info("ITS: using cache flushing for cmd queue\n"); -+ its->flags |= ITS_FLAGS_CMDQ_NEEDS_FLUSHING; -+ } -+ -+ gits_write_cwriter(0, its->base + GITS_CWRITER); -+ ctlr = readl_relaxed(its->base + GITS_CTLR); -+ ctlr |= GITS_CTLR_ENABLE; -+ if (is_v4(its)) -+ ctlr |= GITS_CTLR_ImDe; -+ writel_relaxed(ctlr, its->base + GITS_CTLR); -+ -+ err = its_init_domain(handle, its); -+ if (err) -+ goto out_free_tables; -+ -+ raw_spin_lock(&its_lock); -+ list_add(&its->entry, &its_nodes); -+ raw_spin_unlock(&its_lock); -+ -+ return 0; -+ -+out_free_tables: -+ its_free_tables(its); -+out_free_cmd: -+ free_pages((unsigned long)its->cmd_base, get_order(ITS_CMD_QUEUE_SZ)); -+out_unmap_sgir: -+ if (its->sgir_base) -+ iounmap(its->sgir_base); -+out_free_its: -+ kfree(its); -+out_unmap: -+ iounmap(its_base); -+ pr_err("ITS@%pa: failed probing (%d)\n", &res->start, err); -+ return err; -+} -+ -+static bool gic_rdists_supports_plpis(void) -+{ -+ return !!(gic_read_typer(gic_data_rdist_rd_base() + GICR_TYPER) & GICR_TYPER_PLPIS); -+} -+ -+static int redist_disable_lpis(void) -+{ -+ void __iomem *rbase = gic_data_rdist_rd_base(); -+ u64 timeout = USEC_PER_SEC; -+ u64 val; -+ -+ if (!gic_rdists_supports_plpis()) { -+ pr_info("CPU%d: LPIs not supported\n", smp_processor_id()); -+ return -ENXIO; -+ } -+ -+ val = readl_relaxed(rbase + GICR_CTLR); -+ if (!(val & GICR_CTLR_ENABLE_LPIS)) -+ return 0; -+ -+ /* -+ * If coming via a CPU hotplug event, we don't need to disable -+ * LPIs before trying to re-enable them. They are already -+ * configured and all is well in the world. -+ * -+ * If running with preallocated tables, there is nothing to do. -+ */ -+ if ((gic_data_rdist()->flags & RD_LOCAL_LPI_ENABLED) || -+ (gic_rdists->flags & RDIST_FLAGS_RD_TABLES_PREALLOCATED)) -+ return 0; -+ -+ /* -+ * From that point on, we only try to do some damage control. -+ */ -+ pr_warn("GIC-2500: CPU%d: Booted with LPIs enabled, memory probably corrupted\n", -+ smp_processor_id()); -+ add_taint(TAINT_CRAP, LOCKDEP_STILL_OK); -+ -+ /* Disable LPIs */ -+ val &= ~GICR_CTLR_ENABLE_LPIS; -+ writel_relaxed(val, rbase + GICR_CTLR); -+ -+ /* Make sure any change to GICR_CTLR is observable by the GIC */ -+ dsb(sy); -+ -+ /* -+ * Software must observe RWP==0 after clearing GICR_CTLR.EnableLPIs -+ * from 1 to 0 before programming GICR_PEND{PROP}BASER registers. -+ * Error out if we time out waiting for RWP to clear. -+ */ -+ while (readl_relaxed(rbase + GICR_CTLR) & GICR_CTLR_RWP) { -+ if (!timeout) { -+ pr_err("CPU%d: Timeout while disabling LPIs\n", -+ smp_processor_id()); -+ return -ETIMEDOUT; -+ } -+ udelay(1); -+ timeout--; -+ } -+ -+ /* -+ * After it has been written to 1, it is IMPLEMENTATION -+ * DEFINED whether GICR_CTLR.EnableLPI becomes RES1 or can be -+ * cleared to 0. Error out if clearing the bit failed. -+ */ -+ if (readl_relaxed(rbase + GICR_CTLR) & GICR_CTLR_ENABLE_LPIS) { -+ pr_err("CPU%d: Failed to disable LPIs\n", smp_processor_id()); -+ return -EBUSY; -+ } -+ -+ return 0; -+} -+ -+int phytium_its_cpu_init(void) -+{ -+ if (!list_empty(&its_nodes)) { -+ int ret; -+ -+ ret = redist_disable_lpis(); -+ if (ret) -+ return ret; -+ -+ its_cpu_init_lpis(); -+ its_cpu_init_collections(); -+ } -+ -+ return 0; -+} -+ -+static void rdist_memreserve_cpuhp_cleanup_workfn(struct work_struct *work) -+{ -+ cpuhp_remove_state_nocalls(gic_rdists->cpuhp_memreserve_state); -+ gic_rdists->cpuhp_memreserve_state = CPUHP_INVALID; -+} -+ -+static DECLARE_WORK(rdist_memreserve_cpuhp_cleanup_work, -+ rdist_memreserve_cpuhp_cleanup_workfn); -+ -+static int its_cpu_memreserve_lpi(unsigned int cpu) -+{ -+ struct page *pend_page; -+ int ret = 0; -+ -+ /* This gets to run exactly once per CPU */ -+ if (gic_data_rdist()->flags & RD_LOCAL_MEMRESERVE_DONE) -+ return 0; -+ -+ pend_page = gic_data_rdist()->pend_page; -+ if (WARN_ON(!pend_page)) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ /* -+ * If the pending table was pre-programmed, free the memory we -+ * preemptively allocated. Otherwise, reserve that memory for -+ * later kexecs. -+ */ -+ if (gic_data_rdist()->flags & RD_LOCAL_PENDTABLE_PREALLOCATED) { -+ its_free_pending_table(pend_page); -+ gic_data_rdist()->pend_page = NULL; -+ } else { -+ phys_addr_t paddr = page_to_phys(pend_page); -+ -+ WARN_ON(gic_reserve_range(paddr, LPI_PENDBASE_SZ)); -+ } -+ -+out: -+ /* Last CPU being brought up gets to issue the cleanup */ -+ if (!IS_ENABLED(CONFIG_SMP) || -+ cpumask_equal(&cpus_booted_once_mask, cpu_possible_mask)) -+ schedule_work(&rdist_memreserve_cpuhp_cleanup_work); -+ -+ gic_data_rdist()->flags |= RD_LOCAL_MEMRESERVE_DONE; -+ return ret; -+} -+ -+/* Mark all the BASER registers as invalid before they get reprogrammed */ -+static int __init its_reset_one(struct resource *res) -+{ -+ void __iomem *its_base; -+ int err, i; -+ -+ its_base = its_map_one(res, &err); -+ if (!its_base) -+ return err; -+ -+ for (i = 0; i < GITS_BASER_NR_REGS; i++) -+ gits_write_baser(0, its_base + GITS_BASER + (i << 3)); -+ -+ iounmap(its_base); -+ return 0; -+} -+ -+static const struct of_device_id its_device_id[] = { -+ { .compatible = "arm,gic-s2500-its", }, -+ {}, -+}; -+ -+static int __init its_of_probe(struct device_node *node) -+{ -+ struct device_node *np; -+ struct resource res; -+ -+ /* -+ * Make sure *all* the ITS are reset before we probe any, as -+ * they may be sharing memory. If any of the ITS fails to -+ * reset, don't even try to go any further, as this could -+ * result in something even worse. -+ */ -+ for (np = of_find_matching_node(node, its_device_id); np; -+ np = of_find_matching_node(np, its_device_id)) { -+ int err; -+ -+ if (!of_device_is_available(np) || -+ !of_property_read_bool(np, "msi-controller") || -+ of_address_to_resource(np, 0, &res)) -+ continue; -+ -+ err = its_reset_one(&res); -+ if (err) -+ return err; -+ } -+ -+ for (np = of_find_matching_node(node, its_device_id); np; -+ np = of_find_matching_node(np, its_device_id)) { -+ if (!of_device_is_available(np)) -+ continue; -+ if (!of_property_read_bool(np, "msi-controller")) { -+ pr_warn("%pOF: no msi-controller property, ITS ignored\n", -+ np); -+ continue; -+ } -+ -+ if (of_address_to_resource(np, 0, &res)) { -+ pr_warn("%pOF: no regs?\n", np); -+ continue; -+ } -+ -+ its_probe_one(&res, &np->fwnode, of_node_to_nid(np)); -+ } -+ return 0; -+} -+ -+#ifdef CONFIG_ACPI -+ -+#define ACPI_GICV3_ITS_MEM_SIZE (SZ_128K) -+ -+#ifdef CONFIG_ACPI_NUMA -+struct its_srat_map { -+ /* numa node id */ -+ u32 numa_node; -+ /* GIC ITS ID */ -+ u32 its_id; -+}; -+ -+static struct its_srat_map *its_srat_maps __initdata; -+static int its_in_srat __initdata; -+ -+static int __init acpi_get_its_numa_node(u32 its_id) -+{ -+ int i; -+ -+ for (i = 0; i < its_in_srat; i++) { -+ if (its_id == its_srat_maps[i].its_id) -+ return its_srat_maps[i].numa_node; -+ } -+ return NUMA_NO_NODE; -+} -+ -+static int __init gic_acpi_match_srat_its(union acpi_subtable_headers *header, -+ const unsigned long end) -+{ -+ return 0; -+} -+ -+static int __init gic_acpi_parse_srat_its(union acpi_subtable_headers *header, -+ const unsigned long end) -+{ -+ int node; -+ struct acpi_srat_gic_its_affinity *its_affinity; -+ -+ its_affinity = (struct acpi_srat_gic_its_affinity *)header; -+ if (!its_affinity) -+ return -EINVAL; -+ -+ if (its_affinity->header.length < sizeof(*its_affinity)) { -+ pr_err("SRAT: Invalid header length %d in ITS affinity\n", -+ its_affinity->header.length); -+ return -EINVAL; -+ } -+ -+ /* -+ * Note that in theory a new proximity node could be created by this -+ * entry as it is an SRAT resource allocation structure. -+ * We do not currently support doing so. -+ */ -+ node = pxm_to_node(its_affinity->proximity_domain); -+ -+ if (node == NUMA_NO_NODE || node >= MAX_NUMNODES) { -+ pr_err("SRAT: Invalid NUMA node %d in ITS affinity\n", node); -+ return 0; -+ } -+ -+ its_srat_maps[its_in_srat].numa_node = node; -+ its_srat_maps[its_in_srat].its_id = its_affinity->its_id; -+ its_in_srat++; -+ pr_info("SRAT: PXM %d -> ITS %d -> Node %d\n", -+ its_affinity->proximity_domain, its_affinity->its_id, node); -+ -+ return 0; -+} -+ -+static void __init acpi_table_parse_srat_its(void) -+{ -+ int count; -+ -+ count = acpi_table_parse_entries(ACPI_SIG_SRAT, -+ sizeof(struct acpi_table_srat), -+ ACPI_SRAT_TYPE_GIC_ITS_AFFINITY, -+ gic_acpi_match_srat_its, 0); -+ if (count <= 0) -+ return; -+ -+ its_srat_maps = kmalloc_array(count, sizeof(struct its_srat_map), -+ GFP_KERNEL); -+ if (!its_srat_maps) -+ return; -+ -+ acpi_table_parse_entries(ACPI_SIG_SRAT, -+ sizeof(struct acpi_table_srat), -+ ACPI_SRAT_TYPE_GIC_ITS_AFFINITY, -+ gic_acpi_parse_srat_its, 0); -+} -+ -+/* free the its_srat_maps after ITS probing */ -+static void __init acpi_its_srat_maps_free(void) -+{ -+ kfree(its_srat_maps); -+} -+#else -+static void __init acpi_table_parse_srat_its(void) { } -+static int __init acpi_get_its_numa_node(u32 its_id) { return NUMA_NO_NODE; } -+static void __init acpi_its_srat_maps_free(void) { } -+#endif -+ -+static int __init gic_acpi_parse_madt_its(union acpi_subtable_headers *header, -+ const unsigned long end) -+{ -+ struct acpi_madt_generic_translator *its_entry; -+ struct fwnode_handle *dom_handle; -+ struct resource res; -+ int err; -+ -+ its_entry = (struct acpi_madt_generic_translator *)header; -+ memset(&res, 0, sizeof(res)); -+ res.start = its_entry->base_address; -+ res.end = its_entry->base_address + ACPI_GICV3_ITS_MEM_SIZE - 1; -+ res.flags = IORESOURCE_MEM; -+ -+ dom_handle = irq_domain_alloc_fwnode(&res.start); -+ if (!dom_handle) { -+ pr_err("ITS@%pa: Unable to allocate GIC-phytium-S2500 ITS domain token\n", -+ &res.start); -+ return -ENOMEM; -+ } -+ -+ err = iort_register_domain_token(its_entry->translation_id, res.start, -+ dom_handle); -+ if (err) { -+ pr_err("ITS@%pa: Unable to register GIC-Phytium-S2500 ITS domain token (ITS ID %d) to IORT\n", -+ &res.start, its_entry->translation_id); -+ goto dom_err; -+ } -+ -+ err = its_probe_one(&res, dom_handle, -+ acpi_get_its_numa_node(its_entry->translation_id)); -+ if (!err) -+ return 0; -+ -+ iort_deregister_domain_token(its_entry->translation_id); -+dom_err: -+ irq_domain_free_fwnode(dom_handle); -+ return err; -+} -+ -+static int __init its_acpi_reset(union acpi_subtable_headers *header, -+ const unsigned long end) -+{ -+ struct acpi_madt_generic_translator *its_entry; -+ struct resource res; -+ -+ its_entry = (struct acpi_madt_generic_translator *)header; -+ res = (struct resource) { -+ .start = its_entry->base_address, -+ .end = its_entry->base_address + ACPI_GICV3_ITS_MEM_SIZE - 1, -+ .flags = IORESOURCE_MEM, -+ }; -+ -+ return its_reset_one(&res); -+} -+ -+static void __init its_acpi_probe(void) -+{ -+ acpi_table_parse_srat_its(); -+ /* -+ * Make sure *all* the ITS are reset before we probe any, as -+ * they may be sharing memory. If any of the ITS fails to -+ * reset, don't even try to go any further, as this could -+ * result in something even worse. -+ */ -+ if (acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_TRANSLATOR, -+ its_acpi_reset, 0) > 0) -+ acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_TRANSLATOR, -+ gic_acpi_parse_madt_its, 0); -+ acpi_its_srat_maps_free(); -+} -+#else -+static void __init its_acpi_probe(void) { } -+#endif -+ -+int __init phytium_its_lpi_memreserve_init(void) -+{ -+ int state; -+ -+ if (!efi_enabled(EFI_CONFIG_TABLES)) -+ return 0; -+ -+ if (list_empty(&its_nodes)) -+ return 0; -+ -+ gic_rdists->cpuhp_memreserve_state = CPUHP_INVALID; -+ state = cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, -+ "irqchip/arm/gic-2500/memreserve:online", -+ its_cpu_memreserve_lpi, -+ NULL); -+ if (state < 0) -+ return state; -+ -+ gic_rdists->cpuhp_memreserve_state = state; -+ -+ return 0; -+} -+int __init phytium_its_init(struct fwnode_handle *handle, struct rdists *rdists, -+ struct irq_domain *parent_domain) -+{ -+ struct device_node *of_node; -+ struct its_node *its; -+ bool has_v4 = false; -+ bool has_v4_1 = false; -+ int err; -+ -+ gic_rdists = rdists; -+ -+ its_parent = parent_domain; -+ of_node = to_of_node(handle); -+ if (of_node) -+ its_of_probe(of_node); -+ else -+ its_acpi_probe(); -+ -+ if (list_empty(&its_nodes)) { -+ pr_warn("ITS: No ITS available, not enabling LPIs\n"); -+ return -ENXIO; -+ } -+ -+ err = allocate_lpi_tables(); -+ if (err) -+ return err; -+ -+ list_for_each_entry(its, &its_nodes, entry) { -+ has_v4 |= is_v4(its); -+ has_v4_1 |= is_v4_1(its); -+ } -+ -+ /* Don't bother with inconsistent systems */ -+ if (WARN_ON(!has_v4_1 && rdists->has_rvpeid)) -+ rdists->has_rvpeid = false; -+ -+ if (has_v4 & rdists->has_vlpis) { -+ const struct irq_domain_ops *sgi_ops; -+ -+ if (has_v4_1) -+ sgi_ops = &its_sgi_domain_ops; -+ else -+ sgi_ops = NULL; -+ -+ if (its_init_vpe_domain() || -+ its_init_v4(parent_domain, &its_vpe_domain_ops, sgi_ops)) { -+ rdists->has_vlpis = false; -+ pr_err("ITS: Disabling GICv4 support\n"); -+ } -+ } -+ -+ register_syscore_ops(&its_syscore_ops); -+ -+ return 0; -+} -diff --git a/drivers/irqchip/irq-gic-phytium-2500.c b/drivers/irqchip/irq-gic-phytium-2500.c -new file mode 100644 -index 000000000..b16dbb416 ---- /dev/null -+++ b/drivers/irqchip/irq-gic-phytium-2500.c -@@ -0,0 +1,2604 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#define pr_fmt(fmt) "GIC-2500: " fmt -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+ -+#include "irq-gic-common.h" -+#include -+ -+#define MAX_MARS3_SOC_COUNT 8 -+#define MARS3_ADDR_SKTID_SHIFT 41 -+ -+struct gic_dist_desc { -+ void __iomem *dist_base; -+ phys_addr_t phys_base; -+ unsigned long size; -+}; -+ -+#define GICD_INT_NMI_PRI (GICD_INT_DEF_PRI & ~0x80) -+ -+#define FLAGS_WORKAROUND_GICR_WAKER_MSM8996 (1ULL << 0) -+#define FLAGS_WORKAROUND_CAVIUM_ERRATUM_38539 (1ULL << 1) -+ -+#define GIC_IRQ_TYPE_PARTITION (GIC_IRQ_TYPE_LPI + 1) -+ -+struct redist_region { -+ void __iomem *redist_base; -+ phys_addr_t phys_base; -+ bool single_redist; -+}; -+ -+static struct gic_dist_desc mars3_gic_dists[MAX_MARS3_SOC_COUNT] __read_mostly; -+ -+static unsigned int mars3_sockets_bitmap = 0x1; -+ -+#define mars3_irq_to_skt(hwirq) (((hwirq) - 32) % 8) -+ -+struct gic_chip_data { -+ struct fwnode_handle *fwnode; -+ void __iomem *dist_base; -+ struct redist_region *redist_regions; -+ struct rdists rdists; -+ struct irq_domain *domain; -+ u64 redist_stride; -+ u32 nr_redist_regions; -+ u64 flags; -+ bool has_rss; -+ unsigned int ppi_nr; -+ struct partition_desc **ppi_descs; -+}; -+ -+static struct gic_chip_data gic_data __read_mostly; -+static DEFINE_STATIC_KEY_TRUE(supports_deactivate_key); -+ -+#define GIC_ID_NR (1U << GICD_TYPER_ID_BITS(gic_data.rdists.gicd_typer)) -+#define GIC_LINE_NR min(GICD_TYPER_SPIS(gic_data.rdists.gicd_typer), 1020U) -+#define GIC_ESPI_NR GICD_TYPER_ESPIS(gic_data.rdists.gicd_typer) -+ -+/* -+ * The behaviours of RPR and PMR registers differ depending on the value of -+ * SCR_EL3.FIQ, and the behaviour of non-secure priority registers of the -+ * distributor and redistributors depends on whether security is enabled in the -+ * GIC. -+ * -+ * When security is enabled, non-secure priority values from the (re)distributor -+ * are presented to the GIC CPUIF as follow: -+ * (GIC_(R)DIST_PRI[irq] >> 1) | 0x80; -+ * -+ * If SCR_EL3.FIQ == 1, the values written to/read from PMR and RPR at non-secure -+ * EL1 are subject to a similar operation thus matching the priorities presented -+ * from the (re)distributor when security is enabled. When SCR_EL3.FIQ == 0, -+ * these values are unchanged by the GIC. -+ * -+ * see GICv3/GICv4 Architecture Specification (IHI0069D): -+ * - section 4.8.1 Non-secure accesses to register fields for Secure interrupt -+ * priorities. -+ * - Figure 4-7 Secure read of the priority field for a Non-secure Group 1 -+ * interrupt. -+ */ -+static DEFINE_STATIC_KEY_FALSE(supports_pseudo_nmis); -+ -+#ifndef CONFIG_ARM_GIC_V3 -+/* -+ * Global static key controlling whether an update to PMR allowing more -+ * interrupts requires to be propagated to the redistributor (DSB SY). -+ * And this needs to be exported for modules to be able to enable -+ * interrupts... -+ */ -+DEFINE_STATIC_KEY_FALSE(gic_pmr_sync); -+EXPORT_SYMBOL(gic_pmr_sync); -+ -+DEFINE_STATIC_KEY_FALSE(gic_nonsecure_priorities); -+EXPORT_SYMBOL(gic_nonsecure_priorities); -+#else -+extern struct static_key_false gic_pmr_sync; -+extern struct static_key_false gic_nonsecure_priorities; -+#endif -+ -+/* -+ * When the Non-secure world has access to group 0 interrupts (as a -+ * consequence of SCR_EL3.FIQ == 0), reading the ICC_RPR_EL1 register will -+ * return the Distributor's view of the interrupt priority. -+ * -+ * When GIC security is enabled (GICD_CTLR.DS == 0), the interrupt priority -+ * written by software is moved to the Non-secure range by the Distributor. -+ * -+ * If both are true (which is when gic_nonsecure_priorities gets enabled), -+ * we need to shift down the priority programmed by software to match it -+ * against the value returned by ICC_RPR_EL1. -+ */ -+#define GICD_INT_RPR_PRI(priority) \ -+ ({ \ -+ u32 __priority = (priority); \ -+ if (static_branch_unlikely(&gic_nonsecure_priorities)) \ -+ __priority = 0x80 | (__priority >> 1); \ -+ \ -+ __priority; \ -+ }) -+ -+/* ppi_nmi_refs[n] == number of cpus having ppi[n + 16] set as NMI */ -+static refcount_t *ppi_nmi_refs; -+ -+static struct gic_kvm_info gic_v3_kvm_info __initdata; -+static DEFINE_PER_CPU(bool, has_rss); -+ -+#define MPIDR_RS(mpidr) (((mpidr) & 0xF0UL) >> 4) -+#define gic_data_rdist() (this_cpu_ptr(gic_data.rdists.rdist)) -+#define gic_data_rdist_rd_base() (gic_data_rdist()->rd_base) -+#define gic_data_rdist_sgi_base() (gic_data_rdist_rd_base() + SZ_64K) -+ -+/* Our default, arbitrary priority value. Linux only uses one anyway. */ -+#define DEFAULT_PMR_VALUE 0xf0 -+ -+enum gic_intid_range { -+ SGI_RANGE, -+ PPI_RANGE, -+ SPI_RANGE, -+ EPPI_RANGE, -+ ESPI_RANGE, -+ LPI_RANGE, -+ __INVALID_RANGE__ -+}; -+ -+static enum gic_intid_range __get_intid_range(irq_hw_number_t hwirq) -+{ -+ switch (hwirq) { -+ case 0 ... 15: -+ return SGI_RANGE; -+ case 16 ... 31: -+ return PPI_RANGE; -+ case 32 ... 1019: -+ return SPI_RANGE; -+ case EPPI_BASE_INTID ... (EPPI_BASE_INTID + 63): -+ return EPPI_RANGE; -+ case ESPI_BASE_INTID ... (ESPI_BASE_INTID + 1023): -+ return ESPI_RANGE; -+ case 8192 ... GENMASK(23, 0): -+ return LPI_RANGE; -+ default: -+ return __INVALID_RANGE__; -+ } -+} -+ -+static enum gic_intid_range get_intid_range(struct irq_data *d) -+{ -+ return __get_intid_range(d->hwirq); -+} -+ -+static inline unsigned int gic_irq(struct irq_data *d) -+{ -+ return d->hwirq; -+} -+ -+static inline bool gic_irq_in_rdist(struct irq_data *d) -+{ -+ switch (get_intid_range(d)) { -+ case SGI_RANGE: -+ case PPI_RANGE: -+ case EPPI_RANGE: -+ return true; -+ default: -+ return false; -+ } -+} -+ -+static inline void __iomem *gic_dist_base(struct irq_data *d) -+{ -+ switch (get_intid_range(d)) { -+ case SGI_RANGE: -+ case PPI_RANGE: -+ case EPPI_RANGE: -+ /* SGI+PPI -> SGI_base for this CPU */ -+ return gic_data_rdist_sgi_base(); -+ -+ case SPI_RANGE: -+ case ESPI_RANGE: -+ /* SPI -> dist_base */ -+ return gic_data.dist_base; -+ -+ default: -+ return NULL; -+ } -+} -+ -+static void gic_do_wait_for_rwp(void __iomem *base, u32 bit) -+{ -+ u32 count = 1000000; /* 1s! */ -+ -+ while (readl_relaxed(base + GICD_CTLR) & bit) { -+ count--; -+ if (!count) { -+ pr_err_ratelimited("RWP timeout, gone fishing\n"); -+ return; -+ } -+ cpu_relax(); -+ udelay(1); -+ } -+} -+ -+/* Wait for completion of a distributor change */ -+static void gic_dist_wait_for_rwp(void) -+{ -+ gic_do_wait_for_rwp(gic_data.dist_base, GICD_CTLR_RWP); -+} -+ -+/* Wait for completion of a redistributor change */ -+static void gic_redist_wait_for_rwp(void) -+{ -+ gic_do_wait_for_rwp(gic_data_rdist_rd_base(), GICR_CTLR_RWP); -+} -+ -+#ifdef CONFIG_ARM64 -+ -+static u64 __maybe_unused gic_read_iar(void) -+{ -+ if (cpus_have_const_cap(ARM64_WORKAROUND_CAVIUM_23154)) -+ return gic_read_iar_cavium_thunderx(); -+ else -+ return gic_read_iar_common(); -+} -+#endif -+ -+static void gic_enable_redist(bool enable) -+{ -+ void __iomem *rbase; -+ u32 count = 1000000; /* 1s! */ -+ u32 val; -+ unsigned long mpidr; -+ int i; -+ -+ if (gic_data.flags & FLAGS_WORKAROUND_GICR_WAKER_MSM8996) -+ return; -+ -+ rbase = gic_data_rdist_rd_base(); -+ -+ val = readl_relaxed(rbase + GICR_WAKER); -+ if (enable) -+ /* Wake up this CPU redistributor */ -+ val &= ~GICR_WAKER_ProcessorSleep; -+ else -+ val |= GICR_WAKER_ProcessorSleep; -+ writel_relaxed(val, rbase + GICR_WAKER); -+ -+ if (!enable) { /* Check that GICR_WAKER is writeable */ -+ val = readl_relaxed(rbase + GICR_WAKER); -+ if (!(val & GICR_WAKER_ProcessorSleep)) -+ return; /* No PM support in this redistributor */ -+ } -+ -+ while (--count) { -+ val = readl_relaxed(rbase + GICR_WAKER); -+ if (enable ^ (bool)(val & GICR_WAKER_ChildrenAsleep)) -+ break; -+ cpu_relax(); -+ udelay(1); -+ } -+ if (!count) -+ pr_err_ratelimited("redistributor failed to %s...\n", -+ enable ? "wakeup" : "sleep"); -+ -+ mpidr = (unsigned long)cpu_logical_map(smp_processor_id()); -+ -+ /* Either Aff0 or Aff1 is not zero */ -+ if (mpidr & 0xffff) -+ return; -+ -+ /* Skip 64 Redistributors */ -+ rbase = rbase + 64 * SZ_128K; -+ -+ for (i = 0; i < 4; i++) { -+ val = readl_relaxed(rbase + GICR_WAKER); -+ if (enable) -+ val &= ~GICR_WAKER_ProcessorSleep; -+ else -+ val |= GICR_WAKER_ProcessorSleep; -+ writel_relaxed(val, rbase + GICR_WAKER); -+ -+ if (!enable) { -+ val = readl_relaxed(rbase + GICR_WAKER); -+ if (!(val & GICR_WAKER_ProcessorSleep)) -+ return; -+ } -+ -+ count = 1000000; /* 1s! */ -+ while (--count) { -+ val = readl_relaxed(rbase + GICR_WAKER); -+ if (enable ^ (bool)(val & GICR_WAKER_ChildrenAsleep)) -+ break; -+ cpu_relax(); -+ udelay(1); -+ }; -+ -+ if (!count) -+ pr_err_ratelimited("CPU MPIDR 0x%lx: redistributor %d failed to %s...\n", -+ mpidr, 64 + i, enable ? "wakeup" : "sleep"); -+ -+ rbase = rbase + SZ_128K; -+ } -+} -+ -+/* -+ * Routines to disable, enable, EOI and route interrupts -+ */ -+static u32 convert_offset_index(struct irq_data *d, u32 offset, u32 *index) -+{ -+ switch (get_intid_range(d)) { -+ case SGI_RANGE: -+ case PPI_RANGE: -+ case SPI_RANGE: -+ *index = d->hwirq; -+ return offset; -+ case EPPI_RANGE: -+ /* -+ * Contrary to the ESPI range, the EPPI range is contiguous -+ * to the PPI range in the registers, so let's adjust the -+ * displacement accordingly. Consistency is overrated. -+ */ -+ *index = d->hwirq - EPPI_BASE_INTID + 32; -+ return offset; -+ case ESPI_RANGE: -+ *index = d->hwirq - ESPI_BASE_INTID; -+ switch (offset) { -+ case GICD_ISENABLER: -+ return GICD_ISENABLERnE; -+ case GICD_ICENABLER: -+ return GICD_ICENABLERnE; -+ case GICD_ISPENDR: -+ return GICD_ISPENDRnE; -+ case GICD_ICPENDR: -+ return GICD_ICPENDRnE; -+ case GICD_ISACTIVER: -+ return GICD_ISACTIVERnE; -+ case GICD_ICACTIVER: -+ return GICD_ICACTIVERnE; -+ case GICD_IPRIORITYR: -+ return GICD_IPRIORITYRnE; -+ case GICD_ICFGR: -+ return GICD_ICFGRnE; -+ case GICD_IROUTER: -+ return GICD_IROUTERnE; -+ default: -+ break; -+ } -+ break; -+ default: -+ break; -+ } -+ -+ WARN_ON(1); -+ *index = d->hwirq; -+ return offset; -+} -+ -+static int gic_peek_irq(struct irq_data *d, u32 offset) -+{ -+ void __iomem *base; -+ u32 index, mask, skt; -+ -+ offset = convert_offset_index(d, offset, &index); -+ mask = 1 << (index % 32); -+ -+ if (gic_irq_in_rdist(d)) -+ base = gic_data_rdist_sgi_base(); -+ else { -+ skt = mars3_irq_to_skt(gic_irq(d)); -+ base = mars3_gic_dists[skt].dist_base; -+ } -+ -+ return !!(readl_relaxed(base + offset + (index / 32) * 4) & mask); -+} -+ -+static void gic_poke_irq(struct irq_data *d, u32 offset) -+{ -+ void __iomem *base, *rbase; -+ unsigned long mpidr; -+ int i; -+ u32 index, mask, skt; -+ -+ offset = convert_offset_index(d, offset, &index); -+ mask = 1 << (index % 32); -+ -+ if (gic_irq_in_rdist(d)) { -+ base = gic_data_rdist_sgi_base(); -+ -+ writel_relaxed(mask, base + offset + (index / 32) * 4); -+ gic_redist_wait_for_rwp(); -+ -+ mpidr = (unsigned long)cpu_logical_map(smp_processor_id()); -+ -+ if ((mpidr & 0xffff) == 0) { -+ rbase = base + 64*SZ_128K; -+ -+ for (i = 0; i < 4; i++) { -+ writel_relaxed(mask, rbase + offset + (index / 32) * 4); -+ gic_do_wait_for_rwp(rbase - SZ_64K, GICR_CTLR_RWP); -+ rbase = rbase + SZ_128K; -+ } -+ } -+ } else { -+ skt = mars3_irq_to_skt(gic_irq(d)); -+ base = mars3_gic_dists[skt].dist_base; -+ writel_relaxed(mask, base + offset + (index / 32) * 4); -+ gic_do_wait_for_rwp(base, GICD_CTLR_RWP); -+ } -+} -+ -+static void gic_mask_irq(struct irq_data *d) -+{ -+ gic_poke_irq(d, GICD_ICENABLER); -+ if (gic_irq_in_rdist(d)) -+ gic_redist_wait_for_rwp(); -+ else -+ gic_dist_wait_for_rwp(); -+} -+ -+static void gic_eoimode1_mask_irq(struct irq_data *d) -+{ -+ gic_mask_irq(d); -+ /* -+ * When masking a forwarded interrupt, make sure it is -+ * deactivated as well. -+ * -+ * This ensures that an interrupt that is getting -+ * disabled/masked will not get "stuck", because there is -+ * noone to deactivate it (guest is being terminated). -+ */ -+ if (irqd_is_forwarded_to_vcpu(d)) -+ gic_poke_irq(d, GICD_ICACTIVER); -+} -+ -+static void gic_unmask_irq(struct irq_data *d) -+{ -+ gic_poke_irq(d, GICD_ISENABLER); -+} -+ -+static inline bool gic_supports_nmi(void) -+{ -+ return IS_ENABLED(CONFIG_ARM64_PSEUDO_NMI) && -+ static_branch_likely(&supports_pseudo_nmis); -+} -+ -+static int gic_irq_set_irqchip_state(struct irq_data *d, -+ enum irqchip_irq_state which, bool val) -+{ -+ u32 reg; -+ -+ if (d->hwirq >= 8192) /* SGI/PPI/SPI only */ -+ return -EINVAL; -+ -+ switch (which) { -+ case IRQCHIP_STATE_PENDING: -+ reg = val ? GICD_ISPENDR : GICD_ICPENDR; -+ break; -+ -+ case IRQCHIP_STATE_ACTIVE: -+ reg = val ? GICD_ISACTIVER : GICD_ICACTIVER; -+ break; -+ -+ case IRQCHIP_STATE_MASKED: -+ if (val) { -+ gic_mask_irq(d); -+ return 0; -+ } -+ reg = GICD_ISENABLER; -+ break; -+ -+ default: -+ return -EINVAL; -+ } -+ -+ gic_poke_irq(d, reg); -+ return 0; -+} -+ -+static int gic_irq_get_irqchip_state(struct irq_data *d, -+ enum irqchip_irq_state which, bool *val) -+{ -+ if (d->hwirq >= 8192) /* PPI/SPI only */ -+ return -EINVAL; -+ -+ switch (which) { -+ case IRQCHIP_STATE_PENDING: -+ *val = gic_peek_irq(d, GICD_ISPENDR); -+ break; -+ -+ case IRQCHIP_STATE_ACTIVE: -+ *val = gic_peek_irq(d, GICD_ISACTIVER); -+ break; -+ -+ case IRQCHIP_STATE_MASKED: -+ *val = !gic_peek_irq(d, GICD_ISENABLER); -+ break; -+ -+ default: -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static void gic_irq_set_prio(struct irq_data *d, u8 prio) -+{ -+ void __iomem *base = gic_dist_base(d); -+ u32 offset, index; -+ -+ offset = convert_offset_index(d, GICD_IPRIORITYR, &index); -+ -+ writeb_relaxed(prio, base + offset + index); -+} -+ -+static u32 __gic_get_ppi_index(irq_hw_number_t hwirq) -+{ -+ switch (__get_intid_range(hwirq)) { -+ case PPI_RANGE: -+ return hwirq - 16; -+ case EPPI_RANGE: -+ return hwirq - EPPI_BASE_INTID + 16; -+ default: -+ unreachable(); -+ } -+} -+ -+static u32 gic_get_ppi_index(struct irq_data *d) -+{ -+ return __gic_get_ppi_index(d->hwirq); -+} -+ -+static int gic_irq_nmi_setup(struct irq_data *d) -+{ -+ struct irq_desc *desc = irq_to_desc(d->irq); -+ -+ if (!gic_supports_nmi()) -+ return -EINVAL; -+ -+ if (gic_peek_irq(d, GICD_ISENABLER)) { -+ pr_err("Cannot set NMI property of enabled IRQ %u\n", d->irq); -+ return -EINVAL; -+ } -+ -+ /* -+ * A secondary irq_chip should be in charge of LPI request, -+ * it should not be possible to get there -+ */ -+ if (WARN_ON(gic_irq(d) >= 8192)) -+ return -EINVAL; -+ -+ /* desc lock should already be held */ -+ if (gic_irq_in_rdist(d)) { -+ u32 idx = gic_get_ppi_index(d); -+ -+ /* Setting up PPI as NMI, only switch handler for first NMI */ -+ if (!refcount_inc_not_zero(&ppi_nmi_refs[idx])) { -+ refcount_set(&ppi_nmi_refs[idx], 1); -+ desc->handle_irq = handle_percpu_devid_fasteoi_nmi; -+ } -+ } else { -+ desc->handle_irq = handle_fasteoi_nmi; -+ } -+ -+ gic_irq_set_prio(d, GICD_INT_NMI_PRI); -+ -+ return 0; -+} -+ -+static void gic_irq_nmi_teardown(struct irq_data *d) -+{ -+ struct irq_desc *desc = irq_to_desc(d->irq); -+ -+ if (WARN_ON(!gic_supports_nmi())) -+ return; -+ -+ if (gic_peek_irq(d, GICD_ISENABLER)) { -+ pr_err("Cannot set NMI property of enabled IRQ %u\n", d->irq); -+ return; -+ } -+ -+ /* -+ * A secondary irq_chip should be in charge of LPI request, -+ * it should not be possible to get there -+ */ -+ if (WARN_ON(gic_irq(d) >= 8192)) -+ return; -+ -+ /* desc lock should already be held */ -+ if (gic_irq_in_rdist(d)) { -+ u32 idx = gic_get_ppi_index(d); -+ -+ /* Tearing down NMI, only switch handler for last NMI */ -+ if (refcount_dec_and_test(&ppi_nmi_refs[idx])) -+ desc->handle_irq = handle_percpu_devid_irq; -+ } else { -+ desc->handle_irq = handle_fasteoi_irq; -+ } -+ -+ gic_irq_set_prio(d, GICD_INT_DEF_PRI); -+} -+ -+static void gic_eoi_irq(struct irq_data *d) -+{ -+ write_gicreg(gic_irq(d), ICC_EOIR1_EL1); -+ isb(); -+} -+ -+static void gic_eoimode1_eoi_irq(struct irq_data *d) -+{ -+ /* -+ * No need to deactivate an LPI, or an interrupt that -+ * is getting forwarded to a vcpu. -+ */ -+ if (gic_irq(d) >= 8192 || irqd_is_forwarded_to_vcpu(d)) -+ return; -+ gic_write_dir(gic_irq(d)); -+} -+ -+static int gic_set_type(struct irq_data *d, unsigned int type) -+{ -+ enum gic_intid_range range; -+ unsigned int irq = gic_irq(d); -+ void __iomem *base, *rbase; -+ u32 offset, index, skt; -+ int ret, i; -+ unsigned long mpidr; -+ -+ range = get_intid_range(d); -+ /* Interrupt configuration for SGIs can't be changed */ -+ if (range == SGI_RANGE) -+ return type != IRQ_TYPE_EDGE_RISING ? -EINVAL : 0; -+ -+ /* SPIs have restrictions on the supported types */ -+ if ((range == SPI_RANGE || range == ESPI_RANGE) && -+ type != IRQ_TYPE_LEVEL_HIGH && type != IRQ_TYPE_EDGE_RISING) -+ return -EINVAL; -+ -+ offset = convert_offset_index(d, GICD_ICFGR, &index); -+ -+ if (gic_irq_in_rdist(d)) { -+ base = gic_data_rdist_sgi_base(); -+ ret = gic_configure_irq(index, type, base + offset, gic_redist_wait_for_rwp); -+ mpidr = (unsigned long)cpu_logical_map(smp_processor_id()); -+ -+ if ((mpidr & 0xffff) == 0) { -+ rbase = base + 64*SZ_128K; -+ -+ for (i = 0; i < 4; i++) { -+ ret = gic_configure_irq(index, type, rbase + offset, NULL); -+ gic_do_wait_for_rwp(rbase - SZ_64K, GICR_CTLR_RWP); -+ rbase = rbase + SZ_128K; -+ } -+ } -+ } else { -+ skt = mars3_irq_to_skt(gic_irq(d)); -+ base = mars3_gic_dists[skt].dist_base; -+ ret = gic_configure_irq(index, type, base + offset, NULL); -+ gic_do_wait_for_rwp(base, GICD_CTLR_RWP); -+ } -+ -+ -+ if (ret && (range == PPI_RANGE || range == EPPI_RANGE)) { -+ /* Misconfigured PPIs are usually not fatal */ -+ pr_warn("GIC: PPI INTID%d is secure or misconfigured\n", irq); -+ ret = 0; -+ } -+ -+ return ret; -+} -+ -+static int gic_irq_set_vcpu_affinity(struct irq_data *d, void *vcpu) -+{ -+ if (get_intid_range(d) == SGI_RANGE) -+ return -EINVAL; -+ -+ if (vcpu) -+ irqd_set_forwarded_to_vcpu(d); -+ else -+ irqd_clr_forwarded_to_vcpu(d); -+ return 0; -+} -+ -+static u64 gic_mpidr_to_affinity(unsigned long mpidr) -+{ -+ u64 aff; -+ -+ aff = ((u64)MPIDR_AFFINITY_LEVEL(mpidr, 3) << 32 | -+ MPIDR_AFFINITY_LEVEL(mpidr, 2) << 16 | -+ MPIDR_AFFINITY_LEVEL(mpidr, 1) << 8 | -+ MPIDR_AFFINITY_LEVEL(mpidr, 0)); -+ -+ return aff; -+} -+ -+static void gic_deactivate_unhandled(u32 irqnr) -+{ -+ if (static_branch_likely(&supports_deactivate_key)) { -+ if (irqnr < 8192) -+ gic_write_dir(irqnr); -+ } else { -+ write_gicreg(irqnr, ICC_EOIR1_EL1); -+ isb(); -+ } -+} -+ -+/* -+ * Follow a read of the IAR with any HW maintenance that needs to happen prior -+ * to invoking the relevant IRQ handler. We must do two things: -+ * -+ * (1) Ensure instruction ordering between a read of IAR and subsequent -+ * instructions in the IRQ handler using an ISB. -+ * -+ * It is possible for the IAR to report an IRQ which was signalled *after* -+ * the CPU took an IRQ exception as multiple interrupts can race to be -+ * recognized by the GIC, earlier interrupts could be withdrawn, and/or -+ * later interrupts could be prioritized by the GIC. -+ * -+ * For devices which are tightly coupled to the CPU, such as PMUs, a -+ * context synchronization event is necessary to ensure that system -+ * register state is not stale, as these may have been indirectly written -+ * *after* exception entry. -+ * -+ * (2) Deactivate the interrupt when EOI mode 1 is in use. -+ */ -+static inline void gic_complete_ack(u32 irqnr) -+{ -+ if (static_branch_likely(&supports_deactivate_key)) -+ write_gicreg(irqnr, ICC_EOIR1_EL1); -+ -+ isb(); -+} -+ -+static bool gic_rpr_is_nmi_prio(void) -+{ -+ if (!gic_supports_nmi()) -+ return false; -+ -+ return unlikely(gic_read_rpr() == GICD_INT_RPR_PRI(GICD_INT_NMI_PRI)); -+} -+ -+static bool gic_irqnr_is_special(u32 irqnr) -+{ -+ return irqnr >= 1020 && irqnr <= 1023; -+} -+ -+static void __gic_handle_irq(u32 irqnr, struct pt_regs *regs) -+{ -+ if (gic_irqnr_is_special(irqnr)) -+ return; -+ -+ gic_complete_ack(irqnr); -+ -+ if (generic_handle_domain_irq(gic_data.domain, irqnr)) { -+ WARN_ONCE(true, "Unexpected interrupt (irqnr %u)\n", irqnr); -+ gic_deactivate_unhandled(irqnr); -+ } -+} -+ -+static void __gic_handle_nmi(u32 irqnr, struct pt_regs *regs) -+{ -+ if (gic_irqnr_is_special(irqnr)) -+ return; -+ -+ gic_complete_ack(irqnr); -+ -+ if (generic_handle_domain_nmi(gic_data.domain, irqnr)) { -+ WARN_ONCE(true, "Unexpected pseudo-NMI (irqnr %u)\n", irqnr); -+ gic_deactivate_unhandled(irqnr); -+ } -+} -+ -+/* -+ * An exception has been taken from a context with IRQs enabled, and this could -+ * be an IRQ or an NMI. -+ * -+ * The entry code called us with DAIF.IF set to keep NMIs masked. We must clear -+ * DAIF.IF (and update ICC_PMR_EL1 to mask regular IRQs) prior to returning, -+ * after handling any NMI but before handling any IRQ. -+ * -+ * The entry code has performed IRQ entry, and if an NMI is detected we must -+ * perform NMI entry/exit around invoking the handler. -+ */ -+static void __gic_handle_irq_from_irqson(struct pt_regs *regs) -+{ -+ bool is_nmi; -+ u32 irqnr; -+ -+ irqnr = gic_read_iar(); -+ -+ is_nmi = gic_rpr_is_nmi_prio(); -+ -+ if (is_nmi) { -+ nmi_enter(); -+ __gic_handle_nmi(irqnr, regs); -+ nmi_exit(); -+ } -+ -+ if (gic_prio_masking_enabled()) { -+ gic_pmr_mask_irqs(); -+ gic_arch_enable_irqs(); -+ } -+ -+ if (!is_nmi) -+ __gic_handle_irq(irqnr, regs); -+} -+ -+/* -+ * An exception has been taken from a context with IRQs disabled, which can only -+ * be an NMI. -+ * -+ * The entry code called us with DAIF.IF set to keep NMIs masked. We must leave -+ * DAIF.IF (and ICC_PMR_EL1) unchanged. -+ * -+ * The entry code has performed NMI entry. -+ */ -+static void __gic_handle_irq_from_irqsoff(struct pt_regs *regs) -+{ -+ u64 pmr; -+ u32 irqnr; -+ -+ /* -+ * We were in a context with IRQs disabled. However, the -+ * entry code has set PMR to a value that allows any -+ * interrupt to be acknowledged, and not just NMIs. This can -+ * lead to surprising effects if the NMI has been retired in -+ * the meantime, and that there is an IRQ pending. The IRQ -+ * would then be taken in NMI context, something that nobody -+ * wants to debug twice. -+ * -+ * Until we sort this, drop PMR again to a level that will -+ * actually only allow NMIs before reading IAR, and then -+ * restore it to what it was. -+ */ -+ pmr = gic_read_pmr(); -+ gic_pmr_mask_irqs(); -+ isb(); -+ irqnr = gic_read_iar(); -+ gic_write_pmr(pmr); -+ -+ __gic_handle_nmi(irqnr, regs); -+} -+ -+static asmlinkage void __exception_irq_entry gic_handle_irq(struct pt_regs *regs) -+{ -+ if (unlikely(gic_supports_nmi() && !interrupts_enabled(regs))) -+ __gic_handle_irq_from_irqsoff(regs); -+ else -+ __gic_handle_irq_from_irqson(regs); -+} -+ -+static u32 gic_get_pribits(void) -+{ -+ u32 pribits; -+ -+ pribits = gic_read_ctlr(); -+ pribits &= ICC_CTLR_EL1_PRI_BITS_MASK; -+ pribits >>= ICC_CTLR_EL1_PRI_BITS_SHIFT; -+ pribits++; -+ -+ return pribits; -+} -+ -+static bool gic_has_group0(void) -+{ -+ u32 val; -+ u32 old_pmr; -+ -+ old_pmr = gic_read_pmr(); -+ -+ /* -+ * Let's find out if Group0 is under control of EL3 or not by -+ * setting the highest possible, non-zero priority in PMR. -+ * -+ * If SCR_EL3.FIQ is set, the priority gets shifted down in -+ * order for the CPU interface to set bit 7, and keep the -+ * actual priority in the non-secure range. In the process, it -+ * looses the least significant bit and the actual priority -+ * becomes 0x80. Reading it back returns 0, indicating that -+ * we're don't have access to Group0. -+ */ -+ gic_write_pmr(BIT(8 - gic_get_pribits())); -+ val = gic_read_pmr(); -+ -+ gic_write_pmr(old_pmr); -+ -+ return val != 0; -+} -+ -+static void __init gic_dist_init(void) -+{ -+ unsigned int i; -+ u64 affinity; -+ void __iomem *base = gic_data.dist_base; -+ u32 val, skt; -+ -+ for (skt = 0; skt < MAX_MARS3_SOC_COUNT; skt++) { -+ if (((1U << skt) & mars3_sockets_bitmap) == 0) -+ continue; -+ -+ base = mars3_gic_dists[skt].dist_base; -+ -+ /* Disable the distributor */ -+ writel_relaxed(0, base + GICD_CTLR); -+ gic_do_wait_for_rwp(base, GICD_CTLR_RWP); -+ -+ /* -+ * Configure SPIs as non-secure Group-1. This will only matter -+ * if the GIC only has a single security state. This will not -+ * do the right thing if the kernel is running in secure mode, -+ * but that's not the intended use case anyway. -+ */ -+ for (i = 32; i < GIC_LINE_NR; i += 32) -+ writel_relaxed(~0, base + GICD_IGROUPR + i / 8); -+ -+ /* Extended SPI range, not handled by the GICv2/GICv3 common code */ -+ for (i = 0; i < GIC_ESPI_NR; i += 32) { -+ writel_relaxed(~0U, base + GICD_ICENABLERnE + i / 8); -+ writel_relaxed(~0U, base + GICD_ICACTIVERnE + i / 8); -+ } -+ -+ for (i = 0; i < GIC_ESPI_NR; i += 32) -+ writel_relaxed(~0U, base + GICD_IGROUPRnE + i / 8); -+ -+ for (i = 0; i < GIC_ESPI_NR; i += 16) -+ writel_relaxed(0, base + GICD_ICFGRnE + i / 4); -+ -+ for (i = 0; i < GIC_ESPI_NR; i += 4) -+ writel_relaxed(GICD_INT_DEF_PRI_X4, base + GICD_IPRIORITYRnE + i); -+ -+ /* Now do the common stuff, and wait for the distributor to drain */ -+ gic_dist_config(base, GIC_LINE_NR, NULL); -+ gic_do_wait_for_rwp(base, GICD_CTLR_RWP); // do sync outside of gic_dist_config -+ -+ val = GICD_CTLR_ARE_NS | GICD_CTLR_ENABLE_G1A | GICD_CTLR_ENABLE_G1; -+ if (gic_data.rdists.gicd_typer2 & GICD_TYPER2_nASSGIcap) { -+ pr_info("Enabling SGIs without active state\n"); -+ val |= GICD_CTLR_nASSGIreq; -+ } -+ -+ /* Enable distributor with ARE, Group1 */ -+ writel_relaxed(val, base + GICD_CTLR); -+ -+ /* -+ * Set all global interrupts to the boot CPU only. ARE must be -+ * enabled. -+ */ -+ affinity = gic_mpidr_to_affinity(cpu_logical_map(smp_processor_id())); -+ for (i = 32; i < GIC_LINE_NR; i++) -+ gic_write_irouter(affinity, base + GICD_IROUTER + i * 8); -+ -+ for (i = 0; i < GIC_ESPI_NR; i++) -+ gic_write_irouter(affinity, base + GICD_IROUTERnE + i * 8); -+ } -+} -+ -+static int gic_iterate_rdists(int (*fn)(struct redist_region *, void __iomem *)) -+{ -+ int ret = -ENODEV; -+ int i; -+ -+ for (i = 0; i < gic_data.nr_redist_regions; i++) { -+ void __iomem *ptr = gic_data.redist_regions[i].redist_base; -+ u64 typer; -+ u32 reg; -+ -+ reg = readl_relaxed(ptr + GICR_PIDR2) & GIC_PIDR2_ARCH_MASK; -+ if (reg != GIC_PIDR2_ARCH_GICv3 && -+ reg != GIC_PIDR2_ARCH_GICv4) { /* We're in trouble... */ -+ pr_warn("No redistributor present @%p\n", ptr); -+ break; -+ } -+ -+ do { -+ typer = gic_read_typer(ptr + GICR_TYPER); -+ ret = fn(gic_data.redist_regions + i, ptr); -+ if (!ret) -+ return 0; -+ -+ if (gic_data.redist_regions[i].single_redist) -+ break; -+ -+ if (gic_data.redist_stride) { -+ ptr += gic_data.redist_stride; -+ } else { -+ ptr += SZ_64K * 2; /* Skip RD_base + SGI_base */ -+ if (typer & GICR_TYPER_VLPIS) -+ ptr += SZ_64K * 2; /* Skip VLPI_base + reserved page */ -+ } -+ } while (!(typer & GICR_TYPER_LAST)); -+ } -+ -+ return ret ? -ENODEV : 0; -+} -+ -+static int __gic_populate_rdist(struct redist_region *region, void __iomem *ptr) -+{ -+ unsigned long mpidr = cpu_logical_map(smp_processor_id()); -+ u64 typer; -+ u32 aff, aff2_skt, rdist_skt; -+ -+ /* -+ * Convert affinity to a 32bit value that can be matched to -+ * GICR_TYPER bits [63:32]. -+ */ -+ aff = (MPIDR_AFFINITY_LEVEL(mpidr, 1) << 8 | -+ MPIDR_AFFINITY_LEVEL(mpidr, 0)); -+ -+ aff2_skt = MPIDR_AFFINITY_LEVEL(mpidr, 2) & 0x7; -+ rdist_skt = (((u64)region->phys_base >> MARS3_ADDR_SKTID_SHIFT) & 0x7); -+ -+ if (aff2_skt != rdist_skt) -+ return 1; -+ -+ typer = gic_read_typer(ptr + GICR_TYPER); -+ if ((typer >> 32) == aff) { -+ u64 offset = ptr - region->redist_base; -+ -+ raw_spin_lock_init(&gic_data_rdist()->rd_lock); -+ gic_data_rdist_rd_base() = ptr; -+ gic_data_rdist()->phys_base = region->phys_base + offset; -+ -+ pr_info("CPU%d: found redistributor %lx region %d:%pa\n", -+ smp_processor_id(), mpidr, -+ (int)(region - gic_data.redist_regions), -+ &gic_data_rdist()->phys_base); -+ return 0; -+ } -+ -+ /* Try next one */ -+ return 1; -+} -+ -+static int gic_populate_rdist(void) -+{ -+ if (gic_iterate_rdists(__gic_populate_rdist) == 0) -+ return 0; -+ -+ /* We couldn't even deal with ourselves... */ -+ WARN(true, "CPU%d: mpidr %lx has no re-distributor!\n", -+ smp_processor_id(), -+ (unsigned long)cpu_logical_map(smp_processor_id())); -+ return -ENODEV; -+} -+ -+static int __gic_update_rdist_properties(struct redist_region *region, -+ void __iomem *ptr) -+{ -+ u64 typer = gic_read_typer(ptr + GICR_TYPER); -+ u32 ctlr = readl_relaxed(ptr + GICR_CTLR); -+ -+ /* Boot-time cleanip */ -+ if ((typer & GICR_TYPER_VLPIS) && (typer & GICR_TYPER_RVPEID)) { -+ u64 val; -+ -+ /* Deactivate any present vPE */ -+ val = gicr_read_vpendbaser(ptr + SZ_128K + GICR_VPENDBASER); -+ if (val & GICR_VPENDBASER_Valid) -+ gicr_write_vpendbaser(GICR_VPENDBASER_PendingLast, -+ ptr + SZ_128K + GICR_VPENDBASER); -+ -+ /* Mark the VPE table as invalid */ -+ val = gicr_read_vpropbaser(ptr + SZ_128K + GICR_VPROPBASER); -+ val &= ~GICR_VPROPBASER_4_1_VALID; -+ gicr_write_vpropbaser(val, ptr + SZ_128K + GICR_VPROPBASER); -+ } -+ -+ gic_data.rdists.has_vlpis &= !!(typer & GICR_TYPER_VLPIS); -+ -+ /* -+ * TYPER.RVPEID implies some form of DirectLPI, no matter what the -+ * doc says... :-/ And CTLR.IR implies another subset of DirectLPI -+ * that the ITS driver can make use of for LPIs (and not VLPIs). -+ * -+ * These are 3 different ways to express the same thing, depending -+ * on the revision of the architecture and its relaxations over -+ * time. Just group them under the 'direct_lpi' banner. -+ */ -+ gic_data.rdists.has_rvpeid &= !!(typer & GICR_TYPER_RVPEID); -+ gic_data.rdists.has_direct_lpi &= (!!(typer & GICR_TYPER_DirectLPIS) | -+ !!(ctlr & GICR_CTLR_IR) | -+ gic_data.rdists.has_rvpeid); -+ gic_data.rdists.has_vpend_valid_dirty &= !!(typer & GICR_TYPER_DIRTY); -+ -+ /* Detect non-sensical configurations */ -+ if (WARN_ON_ONCE(gic_data.rdists.has_rvpeid && !gic_data.rdists.has_vlpis)) { -+ gic_data.rdists.has_direct_lpi = false; -+ gic_data.rdists.has_vlpis = false; -+ gic_data.rdists.has_rvpeid = false; -+ } -+ -+ gic_data.ppi_nr = min(GICR_TYPER_NR_PPIS(typer), gic_data.ppi_nr); -+ -+ return 1; -+} -+ -+static void gic_update_rdist_properties(void) -+{ -+ gic_data.ppi_nr = UINT_MAX; -+ gic_iterate_rdists(__gic_update_rdist_properties); -+ if (WARN_ON(gic_data.ppi_nr == UINT_MAX)) -+ gic_data.ppi_nr = 0; -+ pr_info("GIC-2500 features: %d PPIs%s%s\n", -+ gic_data.ppi_nr, -+ gic_data.has_rss ? ", RSS" : "", -+ gic_data.rdists.has_direct_lpi ? ", DirectLPI" : ""); -+ -+ if (gic_data.rdists.has_vlpis) -+ pr_info("GICv4 features: %s%s%s\n", -+ gic_data.rdists.has_direct_lpi ? "DirectLPI " : "", -+ gic_data.rdists.has_rvpeid ? "RVPEID " : "", -+ gic_data.rdists.has_vpend_valid_dirty ? "Valid+Dirty " : ""); -+} -+ -+/* Check whether it's single security state view */ -+static inline bool gic_dist_security_disabled(void) -+{ -+ return readl_relaxed(gic_data.dist_base + GICD_CTLR) & GICD_CTLR_DS; -+} -+ -+static void gic_cpu_sys_reg_init(void) -+{ -+ int i, cpu = smp_processor_id(); -+ u64 mpidr = cpu_logical_map(cpu); -+ u64 need_rss = MPIDR_RS(mpidr); -+ bool group0; -+ u32 pribits; -+ -+ /* -+ * Need to check that the SRE bit has actually been set. If -+ * not, it means that SRE is disabled at EL2. We're going to -+ * die painfully, and there is nothing we can do about it. -+ * -+ * Kindly inform the luser. -+ */ -+ if (!gic_enable_sre()) -+ pr_err("GIC: unable to set SRE (disabled at EL2), panic ahead\n"); -+ -+ pribits = gic_get_pribits(); -+ -+ group0 = gic_has_group0(); -+ -+ /* Set priority mask register */ -+ if (!gic_prio_masking_enabled()) { -+ write_gicreg(DEFAULT_PMR_VALUE, ICC_PMR_EL1); -+ } else if (gic_supports_nmi()) { -+ /* -+ * Mismatch configuration with boot CPU, the system is likely -+ * to die as interrupt masking will not work properly on all -+ * CPUs -+ * -+ * The boot CPU calls this function before enabling NMI support, -+ * and as a result we'll never see this warning in the boot path -+ * for that CPU. -+ */ -+ if (static_branch_unlikely(&gic_nonsecure_priorities)) -+ WARN_ON(!group0 || gic_dist_security_disabled()); -+ else -+ WARN_ON(group0 && !gic_dist_security_disabled()); -+ } -+ -+ /* -+ * Some firmwares hand over to the kernel with the BPR changed from -+ * its reset value (and with a value large enough to prevent -+ * any pre-emptive interrupts from working at all). Writing a zero -+ * to BPR restores is reset value. -+ */ -+ gic_write_bpr1(0); -+ -+ if (static_branch_likely(&supports_deactivate_key)) { -+ /* EOI drops priority only (mode 1) */ -+ gic_write_ctlr(ICC_CTLR_EL1_EOImode_drop); -+ } else { -+ /* EOI deactivates interrupt too (mode 0) */ -+ gic_write_ctlr(ICC_CTLR_EL1_EOImode_drop_dir); -+ } -+ -+ /* Always whack Group0 before Group1 */ -+ if (group0) { -+ switch (pribits) { -+ case 8: -+ case 7: -+ write_gicreg(0, ICC_AP0R3_EL1); -+ write_gicreg(0, ICC_AP0R2_EL1); -+ fallthrough; -+ case 6: -+ write_gicreg(0, ICC_AP0R1_EL1); -+ fallthrough; -+ case 5: -+ case 4: -+ write_gicreg(0, ICC_AP0R0_EL1); -+ } -+ -+ isb(); -+ } -+ -+ switch (pribits) { -+ case 8: -+ case 7: -+ write_gicreg(0, ICC_AP1R3_EL1); -+ write_gicreg(0, ICC_AP1R2_EL1); -+ fallthrough; -+ case 6: -+ write_gicreg(0, ICC_AP1R1_EL1); -+ fallthrough; -+ case 5: -+ case 4: -+ write_gicreg(0, ICC_AP1R0_EL1); -+ } -+ -+ isb(); -+ -+ /* ... and let's hit the road... */ -+ gic_write_grpen1(1); -+ -+ /* Keep the RSS capability status in per_cpu variable */ -+ per_cpu(has_rss, cpu) = !!(gic_read_ctlr() & ICC_CTLR_EL1_RSS); -+ -+ /* Check all the CPUs have capable of sending SGIs to other CPUs */ -+ for_each_online_cpu(i) { -+ bool have_rss = per_cpu(has_rss, i) && per_cpu(has_rss, cpu); -+ -+ need_rss |= MPIDR_RS(cpu_logical_map(i)); -+ if (need_rss && (!have_rss)) -+ pr_crit("CPU%d (%lx) can't SGI CPU%d (%lx), no RSS\n", -+ cpu, (unsigned long)mpidr, -+ i, (unsigned long)cpu_logical_map(i)); -+ } -+ -+ /** -+ * GIC spec says, when ICC_CTLR_EL1.RSS==1 and GICD_TYPER.RSS==0, -+ * writing ICC_ASGI1R_EL1 register with RS != 0 is a CONSTRAINED -+ * UNPREDICTABLE choice of : -+ * - The write is ignored. -+ * - The RS field is treated as 0. -+ */ -+ if (need_rss && (!gic_data.has_rss)) -+ pr_crit_once("RSS is required but GICD doesn't support it\n"); -+} -+ -+static bool gicv3_nolpi; -+ -+static int __init gicv3_nolpi_cfg(char *buf) -+{ -+ return strtobool(buf, &gicv3_nolpi); -+} -+early_param("irqchip.gicv3_nolpi", gicv3_nolpi_cfg); -+ -+static int gic_dist_supports_lpis(void) -+{ -+ return (IS_ENABLED(CONFIG_ARM_GIC_V3_ITS) && -+ !!(readl_relaxed(gic_data.dist_base + GICD_TYPER) & GICD_TYPER_LPIS) && -+ !gicv3_nolpi); -+} -+ -+static void gic_cpu_init(void) -+{ -+ void __iomem *rbase; -+ int i; -+ unsigned long mpidr; -+ -+ /* Register ourselves with the rest of the world */ -+ if (gic_populate_rdist()) -+ return; -+ -+ gic_enable_redist(true); -+ -+ WARN((gic_data.ppi_nr > 16 || GIC_ESPI_NR != 0) && -+ !(gic_read_ctlr() & ICC_CTLR_EL1_ExtRange), -+ "Distributor has extended ranges, but CPU%d doesn't\n", -+ smp_processor_id()); -+ -+ rbase = gic_data_rdist_sgi_base(); -+ -+ /* Configure SGIs/PPIs as non-secure Group-1 */ -+ for (i = 0; i < gic_data.ppi_nr + 16; i += 32) -+ writel_relaxed(~0, rbase + GICR_IGROUPR0 + i / 8); -+ -+ gic_cpu_config(rbase, gic_data.ppi_nr + 16, gic_redist_wait_for_rwp); -+ -+ mpidr = (unsigned long)cpu_logical_map(smp_processor_id()); -+ -+ if ((mpidr & 0xffff) == 0) { -+ rbase = rbase + 64*SZ_128K; -+ -+ for (i = 0; i < 4; i++) { -+ /* Configure SGIs/PPIs as non-secure Group-1 */ -+ writel_relaxed(~0, rbase + GICR_IGROUPR0); -+ -+ gic_cpu_config(rbase, gic_data.ppi_nr + 16, NULL); -+ gic_do_wait_for_rwp(rbase - SZ_64K, GICR_CTLR_RWP); -+ -+ rbase = rbase + SZ_128K; -+ } -+ } -+ -+ /* initialise system registers */ -+ gic_cpu_sys_reg_init(); -+} -+ -+#ifdef CONFIG_SMP -+ -+#define MPIDR_TO_SGI_RS(mpidr) (MPIDR_RS(mpidr) << ICC_SGI1R_RS_SHIFT) -+#define MPIDR_TO_SGI_CLUSTER_ID(mpidr) ((mpidr) & ~0xFUL) -+ -+static int gic_starting_cpu(unsigned int cpu) -+{ -+ gic_cpu_init(); -+ -+ if (gic_dist_supports_lpis()) -+ phytium_its_cpu_init(); -+ -+ return 0; -+} -+ -+static u16 gic_compute_target_list(int *base_cpu, const struct cpumask *mask, -+ unsigned long cluster_id) -+{ -+ int next_cpu, cpu = *base_cpu; -+ unsigned long mpidr = cpu_logical_map(cpu); -+ u16 tlist = 0; -+ -+ while (cpu < nr_cpu_ids) { -+ tlist |= 1 << (mpidr & 0xf); -+ -+ next_cpu = cpumask_next(cpu, mask); -+ if (next_cpu >= nr_cpu_ids) -+ goto out; -+ cpu = next_cpu; -+ -+ mpidr = cpu_logical_map(cpu); -+ -+ if (cluster_id != MPIDR_TO_SGI_CLUSTER_ID(mpidr)) { -+ cpu--; -+ goto out; -+ } -+ } -+out: -+ *base_cpu = cpu; -+ return tlist; -+} -+ -+#define MPIDR_TO_SGI_AFFINITY(cluster_id, level) \ -+ (MPIDR_AFFINITY_LEVEL(cluster_id, level) \ -+ << ICC_SGI1R_AFFINITY_## level ##_SHIFT) -+ -+static void gic_send_sgi(u64 cluster_id, u16 tlist, unsigned int irq) -+{ -+ u64 val; -+ -+ val = (MPIDR_TO_SGI_AFFINITY(cluster_id, 3) | -+ MPIDR_TO_SGI_AFFINITY(cluster_id, 2) | -+ irq << ICC_SGI1R_SGI_ID_SHIFT | -+ MPIDR_TO_SGI_AFFINITY(cluster_id, 1) | -+ MPIDR_TO_SGI_RS(cluster_id) | -+ tlist << ICC_SGI1R_TARGET_LIST_SHIFT); -+ -+ pr_devel("CPU%d: ICC_SGI1R_EL1 %llx\n", smp_processor_id(), val); -+ gic_write_sgi1r(val); -+} -+ -+static void gic_ipi_send_mask(struct irq_data *d, const struct cpumask *mask) -+{ -+ int cpu; -+ -+ if (WARN_ON(d->hwirq >= 16)) -+ return; -+ -+ /* -+ * Ensure that stores to Normal memory are visible to the -+ * other CPUs before issuing the IPI. -+ */ -+ dsb(ishst); -+ -+ for_each_cpu(cpu, mask) { -+ u64 cluster_id = MPIDR_TO_SGI_CLUSTER_ID(cpu_logical_map(cpu)); -+ u16 tlist; -+ -+ tlist = gic_compute_target_list(&cpu, mask, cluster_id); -+ gic_send_sgi(cluster_id, tlist, d->hwirq); -+ } -+ -+ /* Force the above writes to ICC_SGI1R_EL1 to be executed */ -+ isb(); -+} -+ -+static void __init gic_smp_init(void) -+{ -+ struct irq_fwspec sgi_fwspec = { -+ .fwnode = gic_data.fwnode, -+ .param_count = 1, -+ }; -+ int base_sgi; -+ -+ cpuhp_setup_state_nocalls(CPUHP_AP_IRQ_GIC_STARTING, -+ "irqchip/arm/gic_phytium_2500:starting", -+ gic_starting_cpu, NULL); -+ -+ /* Register all 8 non-secure SGIs */ -+ base_sgi = __irq_domain_alloc_irqs(gic_data.domain, -1, 8, -+ NUMA_NO_NODE, &sgi_fwspec, -+ false, NULL); -+ if (WARN_ON(base_sgi <= 0)) -+ return; -+ -+ set_smp_ipi_range(base_sgi, 8); -+} -+ -+static int gic_cpumask_select(struct irq_data *d, const struct cpumask *mask_val) -+{ -+ unsigned int skt, irq_skt, i; -+ unsigned int cpu, cpus = 0; -+ unsigned int skt_cpu_cnt[MAX_MARS3_SOC_COUNT] = {0}; -+ -+ irq_skt = mars3_irq_to_skt(gic_irq(d)); -+ -+ for (i = 0; i < nr_cpu_ids; i++) { -+ skt = (cpu_logical_map(i) >> 16) & 0xff; -+ if ((skt >= 0) && (skt < MAX_MARS3_SOC_COUNT)) { -+ if ((is_kdump_kernel()) && (irq_skt == skt)) -+ return i; -+ -+ skt_cpu_cnt[skt]++; -+ } else if (skt != 0xff) { -+ pr_err("socket address: %d is out of range.", skt); -+ } -+ } -+ -+ if (irq_skt) { -+ for (i = 0; i < irq_skt; i++) -+ cpus += skt_cpu_cnt[i]; -+ } -+ -+ cpu = cpumask_any_and(mask_val, cpu_online_mask); -+ cpus = cpus + cpu % skt_cpu_cnt[irq_skt]; -+ -+ return cpus; -+} -+ -+static int gic_set_affinity(struct irq_data *d, const struct cpumask *mask_val, -+ bool force) -+{ -+ unsigned int cpu, skt; -+ u32 offset, index; -+ void __iomem *reg; -+ int enabled; -+ u64 val; -+ -+ if (force) -+ cpu = cpumask_first(mask_val); -+ else -+ cpu = gic_cpumask_select(d, mask_val); -+ -+ if (cpu >= nr_cpu_ids) -+ return -EINVAL; -+ -+ if (gic_irq_in_rdist(d)) -+ return -EINVAL; -+ -+ /* If interrupt was enabled, disable it first */ -+ enabled = gic_peek_irq(d, GICD_ISENABLER); -+ if (enabled) -+ gic_mask_irq(d); -+ -+ offset = convert_offset_index(d, GICD_IROUTER, &index); -+ -+ skt = mars3_irq_to_skt(gic_irq(d)); -+ reg = mars3_gic_dists[skt].dist_base + offset + (index * 8); -+ val = gic_mpidr_to_affinity(cpu_logical_map(cpu)); -+ -+ gic_write_irouter(val, reg); -+ -+ /* -+ * If the interrupt was enabled, enabled it again. Otherwise, -+ * just wait for the distributor to have digested our changes. -+ */ -+ if (enabled) -+ gic_unmask_irq(d); -+ -+ irq_data_update_effective_affinity(d, cpumask_of(cpu)); -+ -+ return IRQ_SET_MASK_OK_DONE; -+} -+#else -+#define gic_set_affinity NULL -+#define gic_ipi_send_mask NULL -+#define gic_smp_init() do { } while (0) -+#endif -+ -+static int gic_retrigger(struct irq_data *data) -+{ -+ return !gic_irq_set_irqchip_state(data, IRQCHIP_STATE_PENDING, true); -+} -+ -+#ifdef CONFIG_CPU_PM -+static int gic_cpu_pm_notifier(struct notifier_block *self, -+ unsigned long cmd, void *v) -+{ -+ if (cmd == CPU_PM_EXIT) { -+ if (gic_dist_security_disabled()) -+ gic_enable_redist(true); -+ gic_cpu_sys_reg_init(); -+ } else if (cmd == CPU_PM_ENTER && gic_dist_security_disabled()) { -+ gic_write_grpen1(0); -+ gic_enable_redist(false); -+ } -+ return NOTIFY_OK; -+} -+ -+static struct notifier_block gic_cpu_pm_notifier_block = { -+ .notifier_call = gic_cpu_pm_notifier, -+}; -+ -+static void gic_cpu_pm_init(void) -+{ -+ cpu_pm_register_notifier(&gic_cpu_pm_notifier_block); -+} -+ -+#else -+static inline void gic_cpu_pm_init(void) { } -+#endif /* CONFIG_CPU_PM */ -+ -+static struct irq_chip gic_chip = { -+ .name = "GIC-Phytium-2500", -+ .irq_mask = gic_mask_irq, -+ .irq_unmask = gic_unmask_irq, -+ .irq_eoi = gic_eoi_irq, -+ .irq_set_type = gic_set_type, -+ .irq_set_affinity = gic_set_affinity, -+ .irq_retrigger = gic_retrigger, -+ .irq_get_irqchip_state = gic_irq_get_irqchip_state, -+ .irq_set_irqchip_state = gic_irq_set_irqchip_state, -+ .irq_nmi_setup = gic_irq_nmi_setup, -+ .irq_nmi_teardown = gic_irq_nmi_teardown, -+ .ipi_send_mask = gic_ipi_send_mask, -+ .flags = IRQCHIP_SET_TYPE_MASKED | -+ IRQCHIP_SKIP_SET_WAKE | -+ IRQCHIP_MASK_ON_SUSPEND, -+}; -+ -+static struct irq_chip gic_eoimode1_chip = { -+ .name = "GIC-Phytium-2500", -+ .irq_mask = gic_eoimode1_mask_irq, -+ .irq_unmask = gic_unmask_irq, -+ .irq_eoi = gic_eoimode1_eoi_irq, -+ .irq_set_type = gic_set_type, -+ .irq_set_affinity = gic_set_affinity, -+ .irq_retrigger = gic_retrigger, -+ .irq_get_irqchip_state = gic_irq_get_irqchip_state, -+ .irq_set_irqchip_state = gic_irq_set_irqchip_state, -+ .irq_set_vcpu_affinity = gic_irq_set_vcpu_affinity, -+ .irq_nmi_setup = gic_irq_nmi_setup, -+ .irq_nmi_teardown = gic_irq_nmi_teardown, -+ .ipi_send_mask = gic_ipi_send_mask, -+ .flags = IRQCHIP_SET_TYPE_MASKED | -+ IRQCHIP_SKIP_SET_WAKE | -+ IRQCHIP_MASK_ON_SUSPEND, -+}; -+ -+static int gic_irq_domain_map(struct irq_domain *d, unsigned int irq, -+ irq_hw_number_t hw) -+{ -+ struct irq_chip *chip = &gic_chip; -+ struct irq_data *irqd = irq_desc_get_irq_data(irq_to_desc(irq)); -+ -+ if (static_branch_likely(&supports_deactivate_key)) -+ chip = &gic_eoimode1_chip; -+ -+ switch (__get_intid_range(hw)) { -+ case SGI_RANGE: -+ case PPI_RANGE: -+ case EPPI_RANGE: -+ irq_set_percpu_devid(irq); -+ irq_domain_set_info(d, irq, hw, chip, d->host_data, -+ handle_percpu_devid_irq, NULL, NULL); -+ break; -+ -+ case SPI_RANGE: -+ case ESPI_RANGE: -+ irq_domain_set_info(d, irq, hw, chip, d->host_data, -+ handle_fasteoi_irq, NULL, NULL); -+ irq_set_probe(irq); -+ irqd_set_single_target(irqd); -+ break; -+ -+ case LPI_RANGE: -+ if (!gic_dist_supports_lpis()) -+ return -EPERM; -+ irq_domain_set_info(d, irq, hw, chip, d->host_data, -+ handle_fasteoi_irq, NULL, NULL); -+ break; -+ -+ default: -+ return -EPERM; -+ } -+ -+ /* Prevents SW retriggers which mess up the ACK/EOI ordering */ -+ irqd_set_handle_enforce_irqctx(irqd); -+ return 0; -+} -+ -+static int gic_irq_domain_translate(struct irq_domain *d, -+ struct irq_fwspec *fwspec, -+ unsigned long *hwirq, -+ unsigned int *type) -+{ -+ if (fwspec->param_count == 1 && fwspec->param[0] < 16) { -+ *hwirq = fwspec->param[0]; -+ *type = IRQ_TYPE_EDGE_RISING; -+ return 0; -+ } -+ -+ if (is_of_node(fwspec->fwnode)) { -+ if (fwspec->param_count < 3) -+ return -EINVAL; -+ -+ switch (fwspec->param[0]) { -+ case 0: /* SPI */ -+ *hwirq = fwspec->param[1] + 32; -+ break; -+ case 1: /* PPI */ -+ *hwirq = fwspec->param[1] + 16; -+ break; -+ case 2: /* ESPI */ -+ *hwirq = fwspec->param[1] + ESPI_BASE_INTID; -+ break; -+ case 3: /* EPPI */ -+ *hwirq = fwspec->param[1] + EPPI_BASE_INTID; -+ break; -+ case GIC_IRQ_TYPE_LPI: /* LPI */ -+ *hwirq = fwspec->param[1]; -+ break; -+ case GIC_IRQ_TYPE_PARTITION: -+ *hwirq = fwspec->param[1]; -+ if (fwspec->param[1] >= 16) -+ *hwirq += EPPI_BASE_INTID - 16; -+ else -+ *hwirq += 16; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; -+ -+ /* -+ * Make it clear that broken DTs are... broken. -+ * Partitioned PPIs are an unfortunate exception. -+ */ -+ WARN_ON(*type == IRQ_TYPE_NONE && -+ fwspec->param[0] != GIC_IRQ_TYPE_PARTITION); -+ return 0; -+ } -+ -+ if (is_fwnode_irqchip(fwspec->fwnode)) { -+ if (fwspec->param_count != 2) -+ return -EINVAL; -+ -+ if (fwspec->param[0] < 16) { -+ pr_err(FW_BUG "Illegal GSI%d translation request\n", -+ fwspec->param[0]); -+ return -EINVAL; -+ } -+ -+ *hwirq = fwspec->param[0]; -+ *type = fwspec->param[1]; -+ -+ WARN_ON(*type == IRQ_TYPE_NONE); -+ return 0; -+ } -+ -+ return -EINVAL; -+} -+ -+static int gic_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, -+ unsigned int nr_irqs, void *arg) -+{ -+ int i, ret; -+ irq_hw_number_t hwirq; -+ unsigned int type = IRQ_TYPE_NONE; -+ struct irq_fwspec *fwspec = arg; -+ -+ ret = gic_irq_domain_translate(domain, fwspec, &hwirq, &type); -+ if (ret) -+ return ret; -+ -+ for (i = 0; i < nr_irqs; i++) { -+ ret = gic_irq_domain_map(domain, virq + i, hwirq + i); -+ if (ret) -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static void gic_irq_domain_free(struct irq_domain *domain, unsigned int virq, -+ unsigned int nr_irqs) -+{ -+ int i; -+ -+ for (i = 0; i < nr_irqs; i++) { -+ struct irq_data *d = irq_domain_get_irq_data(domain, virq + i); -+ -+ irq_set_handler(virq + i, NULL); -+ irq_domain_reset_irq_data(d); -+ } -+} -+ -+static bool fwspec_is_partitioned_ppi(struct irq_fwspec *fwspec, -+ irq_hw_number_t hwirq) -+{ -+ enum gic_intid_range range; -+ -+ if (!gic_data.ppi_descs) -+ return false; -+ -+ if (!is_of_node(fwspec->fwnode)) -+ return false; -+ -+ if (fwspec->param_count < 4 || !fwspec->param[3]) -+ return false; -+ -+ range = __get_intid_range(hwirq); -+ if (range != PPI_RANGE && range != EPPI_RANGE) -+ return false; -+ -+ return true; -+} -+ -+static int gic_irq_domain_select(struct irq_domain *d, -+ struct irq_fwspec *fwspec, -+ enum irq_domain_bus_token bus_token) -+{ -+ unsigned int type, ret, ppi_idx; -+ irq_hw_number_t hwirq; -+ -+ /* Not for us */ -+ if (fwspec->fwnode != d->fwnode) -+ return 0; -+ -+ /* If this is not DT, then we have a single domain */ -+ if (!is_of_node(fwspec->fwnode)) -+ return 1; -+ -+ ret = gic_irq_domain_translate(d, fwspec, &hwirq, &type); -+ if (WARN_ON_ONCE(ret)) -+ return 0; -+ -+ if (!fwspec_is_partitioned_ppi(fwspec, hwirq)) -+ return d == gic_data.domain; -+ -+ /* -+ * If this is a PPI and we have a 4th (non-null) parameter, -+ * then we need to match the partition domain. -+ */ -+ ppi_idx = __gic_get_ppi_index(hwirq); -+ return d == partition_get_domain(gic_data.ppi_descs[ppi_idx]); -+} -+ -+static const struct irq_domain_ops gic_irq_domain_ops = { -+ .translate = gic_irq_domain_translate, -+ .alloc = gic_irq_domain_alloc, -+ .free = gic_irq_domain_free, -+ .select = gic_irq_domain_select, -+}; -+ -+static int partition_domain_translate(struct irq_domain *d, -+ struct irq_fwspec *fwspec, -+ unsigned long *hwirq, -+ unsigned int *type) -+{ -+ unsigned long ppi_intid; -+ struct device_node *np; -+ unsigned int ppi_idx; -+ int ret; -+ -+ if (!gic_data.ppi_descs) -+ return -ENOMEM; -+ -+ np = of_find_node_by_phandle(fwspec->param[3]); -+ if (WARN_ON(!np)) -+ return -EINVAL; -+ -+ ret = gic_irq_domain_translate(d, fwspec, &ppi_intid, type); -+ if (WARN_ON_ONCE(ret)) -+ return 0; -+ -+ ppi_idx = __gic_get_ppi_index(ppi_intid); -+ ret = partition_translate_id(gic_data.ppi_descs[ppi_idx], -+ of_node_to_fwnode(np)); -+ if (ret < 0) -+ return ret; -+ -+ *hwirq = ret; -+ *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; -+ -+ return 0; -+} -+ -+static const struct irq_domain_ops partition_domain_ops = { -+ .translate = partition_domain_translate, -+ .select = gic_irq_domain_select, -+}; -+ -+static void gic_enable_nmi_support(void) -+{ -+ int i; -+ -+ if (!gic_prio_masking_enabled()) -+ return; -+ -+ ppi_nmi_refs = kcalloc(gic_data.ppi_nr, sizeof(*ppi_nmi_refs), GFP_KERNEL); -+ if (!ppi_nmi_refs) -+ return; -+ -+ for (i = 0; i < gic_data.ppi_nr; i++) -+ refcount_set(&ppi_nmi_refs[i], 0); -+ -+ /* -+ * Linux itself doesn't use 1:N distribution, so has no need to -+ * set PMHE. The only reason to have it set is if EL3 requires it -+ * (and we can't change it). -+ */ -+ if (gic_read_ctlr() & ICC_CTLR_EL1_PMHE_MASK) -+ static_branch_enable(&gic_pmr_sync); -+ -+ pr_info("Pseudo-NMIs enabled using %s ICC_PMR_EL1 synchronisation\n", -+ static_branch_unlikely(&gic_pmr_sync) ? "forced" : "relaxed"); -+ -+ /* -+ * How priority values are used by the GIC depends on two things: -+ * the security state of the GIC (controlled by the GICD_CTRL.DS bit) -+ * and if Group 0 interrupts can be delivered to Linux in the non-secure -+ * world as FIQs (controlled by the SCR_EL3.FIQ bit). These affect the -+ * ICC_PMR_EL1 register and the priority that software assigns to -+ * interrupts: -+ * -+ * GICD_CTRL.DS | SCR_EL3.FIQ | ICC_PMR_EL1 | Group 1 priority -+ * ----------------------------------------------------------- -+ * 1 | - | unchanged | unchanged -+ * ----------------------------------------------------------- -+ * 0 | 1 | non-secure | non-secure -+ * ----------------------------------------------------------- -+ * 0 | 0 | unchanged | non-secure -+ * -+ * where non-secure means that the value is right-shifted by one and the -+ * MSB bit set, to make it fit in the non-secure priority range. -+ * -+ * In the first two cases, where ICC_PMR_EL1 and the interrupt priority -+ * are both either modified or unchanged, we can use the same set of -+ * priorities. -+ * -+ * In the last case, where only the interrupt priorities are modified to -+ * be in the non-secure range, we use a different PMR value to mask IRQs -+ * and the rest of the values that we use remain unchanged. -+ */ -+ if (gic_has_group0() && !gic_dist_security_disabled()) -+ static_branch_enable(&gic_nonsecure_priorities); -+ -+ static_branch_enable(&supports_pseudo_nmis); -+ -+ if (static_branch_likely(&supports_deactivate_key)) -+ gic_eoimode1_chip.flags |= IRQCHIP_SUPPORTS_NMI; -+ else -+ gic_chip.flags |= IRQCHIP_SUPPORTS_NMI; -+} -+ -+static int __init gic_init_bases(void __iomem *dist_base, -+ struct redist_region *rdist_regs, -+ u32 nr_redist_regions, -+ u64 redist_stride, -+ struct fwnode_handle *handle) -+{ -+ u32 typer; -+ int err; -+ -+ if (!is_hyp_mode_available()) -+ static_branch_disable(&supports_deactivate_key); -+ -+ if (static_branch_likely(&supports_deactivate_key)) -+ pr_info("GIC: Using split EOI/Deactivate mode\n"); -+ -+ gic_data.fwnode = handle; -+ gic_data.dist_base = dist_base; -+ gic_data.redist_regions = rdist_regs; -+ gic_data.nr_redist_regions = nr_redist_regions; -+ gic_data.redist_stride = redist_stride; -+ -+ /* -+ * Find out how many interrupts are supported. -+ */ -+ typer = readl_relaxed(gic_data.dist_base + GICD_TYPER); -+ gic_data.rdists.gicd_typer = typer; -+ -+ pr_info("%d SPIs implemented\n", GIC_LINE_NR - 32); -+ pr_info("%d Extended SPIs implemented\n", GIC_ESPI_NR); -+ -+ gic_data.rdists.gicd_typer2 = readl_relaxed(gic_data.dist_base + GICD_TYPER2); -+ -+ gic_data.domain = irq_domain_create_tree(handle, &gic_irq_domain_ops, -+ &gic_data); -+ gic_data.rdists.rdist = alloc_percpu(typeof(*gic_data.rdists.rdist)); -+ gic_data.rdists.has_rvpeid = true; -+ gic_data.rdists.has_vlpis = true; -+ gic_data.rdists.has_direct_lpi = true; -+ gic_data.rdists.has_vpend_valid_dirty = true; -+ -+ if (WARN_ON(!gic_data.domain) || WARN_ON(!gic_data.rdists.rdist)) { -+ err = -ENOMEM; -+ goto out_free; -+ } -+ -+ irq_domain_update_bus_token(gic_data.domain, DOMAIN_BUS_WIRED); -+ -+ gic_data.has_rss = !!(typer & GICD_TYPER_RSS); -+ -+ if (typer & GICD_TYPER_MBIS) { -+ err = mbi_init(handle, gic_data.domain); -+ if (err) -+ pr_err("Failed to initialize MBIs\n"); -+ } -+ -+ set_handle_irq(gic_handle_irq); -+ -+ gic_update_rdist_properties(); -+ -+ gic_dist_init(); -+ gic_cpu_init(); -+ gic_smp_init(); -+ gic_cpu_pm_init(); -+ -+ if (gic_dist_supports_lpis()) { -+ phytium_its_init(handle, &gic_data.rdists, gic_data.domain); -+ phytium_its_cpu_init(); -+ phytium_its_lpi_memreserve_init(); -+ } else { -+ if (IS_ENABLED(CONFIG_ARM_GIC_V2M)) -+ gicv2m_init(handle, gic_data.domain); -+ } -+ -+ gic_enable_nmi_support(); -+ -+ return 0; -+ -+out_free: -+ if (gic_data.domain) -+ irq_domain_remove(gic_data.domain); -+ free_percpu(gic_data.rdists.rdist); -+ return err; -+} -+ -+static int __init gic_validate_dist_version(void __iomem *dist_base) -+{ -+ u32 reg = readl_relaxed(dist_base + GICD_PIDR2) & GIC_PIDR2_ARCH_MASK; -+ -+ if (reg != GIC_PIDR2_ARCH_GICv3 && reg != GIC_PIDR2_ARCH_GICv4) -+ return -ENODEV; -+ -+ return 0; -+} -+ -+/* Create all possible partitions at boot time */ -+static void __init gic_populate_ppi_partitions(struct device_node *gic_node) -+{ -+ struct device_node *parts_node, *child_part; -+ int part_idx = 0, i; -+ int nr_parts; -+ struct partition_affinity *parts; -+ -+ parts_node = of_get_child_by_name(gic_node, "ppi-partitions"); -+ if (!parts_node) -+ return; -+ -+ gic_data.ppi_descs = kcalloc(gic_data.ppi_nr, sizeof(*gic_data.ppi_descs), GFP_KERNEL); -+ if (!gic_data.ppi_descs) -+ goto out_put_node; -+ -+ nr_parts = of_get_child_count(parts_node); -+ -+ if (!nr_parts) -+ goto out_put_node; -+ -+ parts = kcalloc(nr_parts, sizeof(*parts), GFP_KERNEL); -+ if (WARN_ON(!parts)) -+ goto out_put_node; -+ -+ for_each_child_of_node(parts_node, child_part) { -+ struct partition_affinity *part; -+ int n; -+ -+ part = &parts[part_idx]; -+ -+ part->partition_id = of_node_to_fwnode(child_part); -+ -+ pr_info("GIC: PPI partition %pOFn[%d] { ", -+ child_part, part_idx); -+ -+ n = of_property_count_elems_of_size(child_part, "affinity", -+ sizeof(u32)); -+ WARN_ON(n <= 0); -+ -+ for (i = 0; i < n; i++) { -+ int err, cpu; -+ u32 cpu_phandle; -+ struct device_node *cpu_node; -+ -+ err = of_property_read_u32_index(child_part, "affinity", -+ i, &cpu_phandle); -+ if (WARN_ON(err)) -+ continue; -+ -+ cpu_node = of_find_node_by_phandle(cpu_phandle); -+ if (WARN_ON(!cpu_node)) -+ continue; -+ -+ cpu = of_cpu_node_to_id(cpu_node); -+ if (WARN_ON(cpu < 0)) { -+ of_node_put(cpu_node); -+ continue; -+ } -+ -+ pr_cont("%pOF[%d] ", cpu_node, cpu); -+ -+ cpumask_set_cpu(cpu, &part->mask); -+ of_node_put(cpu_node); -+ } -+ -+ pr_cont("}\n"); -+ part_idx++; -+ } -+ -+ for (i = 0; i < gic_data.ppi_nr; i++) { -+ unsigned int irq; -+ struct partition_desc *desc; -+ struct irq_fwspec ppi_fwspec = { -+ .fwnode = gic_data.fwnode, -+ .param_count = 3, -+ .param = { -+ [0] = GIC_IRQ_TYPE_PARTITION, -+ [1] = i, -+ [2] = IRQ_TYPE_NONE, -+ }, -+ }; -+ -+ irq = irq_create_fwspec_mapping(&ppi_fwspec); -+ if (WARN_ON(!irq)) -+ continue; -+ desc = partition_create_desc(gic_data.fwnode, parts, nr_parts, -+ irq, &partition_domain_ops); -+ if (WARN_ON(!desc)) -+ continue; -+ -+ gic_data.ppi_descs[i] = desc; -+ } -+ -+out_put_node: -+ of_node_put(parts_node); -+} -+ -+static void __init gic_of_setup_kvm_info(struct device_node *node) -+{ -+ int ret; -+ struct resource r; -+ u32 gicv_idx; -+ -+ gic_v3_kvm_info.type = GIC_V3; -+ -+ gic_v3_kvm_info.maint_irq = irq_of_parse_and_map(node, 0); -+ if (!gic_v3_kvm_info.maint_irq) -+ return; -+ -+ if (of_property_read_u32(node, "#redistributor-regions", -+ &gicv_idx)) -+ gicv_idx = 1; -+ -+ gicv_idx += 3; /* Also skip GICD, GICC, GICH */ -+ ret = of_address_to_resource(node, gicv_idx, &r); -+ if (!ret) -+ gic_v3_kvm_info.vcpu = r; -+ -+ gic_v3_kvm_info.has_v4 = gic_data.rdists.has_vlpis; -+ gic_v3_kvm_info.has_v4_1 = gic_data.rdists.has_rvpeid; -+ vgic_set_kvm_info(&gic_v3_kvm_info); -+} -+ -+static void gic_request_region(resource_size_t base, resource_size_t size, -+ const char *name) -+{ -+ if (!request_mem_region(base, size, name)) -+ pr_warn_once(FW_BUG "%s region %pa has overlapping address\n", -+ name, &base); -+} -+ -+static void __iomem *gic_of_iomap(struct device_node *node, int idx, -+ const char *name, struct resource *res) -+{ -+ void __iomem *base; -+ int ret; -+ -+ ret = of_address_to_resource(node, idx, res); -+ if (ret) -+ return IOMEM_ERR_PTR(ret); -+ -+ gic_request_region(res->start, resource_size(res), name); -+ base = of_iomap(node, idx); -+ -+ return base ?: IOMEM_ERR_PTR(-ENOMEM); -+} -+ -+static int __init gic_of_init(struct device_node *node, struct device_node *parent) -+{ -+ void __iomem *dist_base; -+ struct redist_region *rdist_regs; -+ u64 redist_stride; -+ u32 nr_redist_regions; -+ int err, i; -+ struct resource res; -+ unsigned long skt; -+ -+ dist_base = gic_of_iomap(node, 0, "GICD", &res); -+ if (IS_ERR(dist_base)) { -+ pr_err("%pOF: unable to map gic dist registers\n", node); -+ return PTR_ERR(dist_base); -+ } -+ -+ err = gic_validate_dist_version(dist_base); -+ if (err) { -+ pr_err("%pOF: no distributor detected, giving up\n", node); -+ goto out_unmap_dist; -+ } -+ -+ if (of_address_to_resource(node, 0, &res)) { -+ pr_err("Error: No GIC Distributor in FDT\n"); -+ goto out_unmap_dist; -+ } -+ -+ mars3_gic_dists[0].phys_base = res.start; -+ mars3_gic_dists[0].size = resource_size(&res); -+ mars3_gic_dists[0].dist_base = dist_base; -+ -+ if (of_property_read_u32(node, "#mars3-soc-bitmap", &mars3_sockets_bitmap)) -+ mars3_sockets_bitmap = 0x1; -+ -+ for (skt = 1; skt < MAX_MARS3_SOC_COUNT; skt++) { -+ if (((1U << skt) & mars3_sockets_bitmap) == 0) -+ continue; -+ -+ mars3_gic_dists[skt].phys_base = ((unsigned long)skt << MARS3_ADDR_SKTID_SHIFT) | -+ mars3_gic_dists[0].phys_base; -+ mars3_gic_dists[skt].size = mars3_gic_dists[0].size; -+ mars3_gic_dists[skt].dist_base = ioremap(mars3_gic_dists[skt].phys_base, -+ mars3_gic_dists[skt].size); -+ } -+ -+ if (of_property_read_u32(node, "#redistributor-regions", &nr_redist_regions)) -+ nr_redist_regions = 1; -+ -+ rdist_regs = kcalloc(nr_redist_regions, sizeof(*rdist_regs), -+ GFP_KERNEL); -+ if (!rdist_regs) { -+ err = -ENOMEM; -+ goto out_unmap_dist; -+ } -+ -+ for (i = 0; i < nr_redist_regions; i++) { -+ rdist_regs[i].redist_base = gic_of_iomap(node, 1 + i, "GICR", &res); -+ if (IS_ERR(rdist_regs[i].redist_base)) { -+ pr_err("%pOF: couldn't map region %d\n", node, i); -+ err = -ENODEV; -+ goto out_unmap_rdist; -+ } -+ rdist_regs[i].phys_base = res.start; -+ } -+ -+ if (of_property_read_u64(node, "redistributor-stride", &redist_stride)) -+ redist_stride = 0; -+ -+ err = gic_init_bases(dist_base, rdist_regs, nr_redist_regions, -+ redist_stride, &node->fwnode); -+ if (err) -+ goto out_unmap_rdist; -+ -+ gic_populate_ppi_partitions(node); -+ -+ if (static_branch_likely(&supports_deactivate_key)) -+ gic_of_setup_kvm_info(node); -+ return 0; -+ -+out_unmap_rdist: -+ for (i = 0; i < nr_redist_regions; i++) -+ if (rdist_regs[i].redist_base && !IS_ERR(rdist_regs[i].redist_base)) -+ iounmap(rdist_regs[i].redist_base); -+ kfree(rdist_regs); -+out_unmap_dist: -+ iounmap(dist_base); -+ return err; -+} -+ -+IRQCHIP_DECLARE(gic_phyt_2500, "arm,gic-phytium-2500", gic_of_init); -+ -+#ifdef CONFIG_ACPI -+static struct -+{ -+ void __iomem *dist_base; -+ struct redist_region *redist_regs; -+ u32 nr_redist_regions; -+ bool single_redist; -+ int enabled_rdists; -+ u32 maint_irq; -+ int maint_irq_mode; -+ phys_addr_t vcpu_base; -+} acpi_data __initdata; -+ -+static int gic_mars3_sockets_bitmap(void) -+{ -+ unsigned int skt, i; -+ int skt_bitmap = 0; -+ unsigned int skt_cpu_cnt[MAX_MARS3_SOC_COUNT] = {0}; -+ -+ for (i = 0; i < max_t(unsigned int, nr_cpu_ids, NR_CPUS); i++) { -+ skt = (cpu_logical_map(i) >> 16) & 0xff; -+ if ((skt >= 0) && (skt < MAX_MARS3_SOC_COUNT)) -+ skt_cpu_cnt[skt]++; -+ else if (skt != 0xff) -+ pr_err("socket address: %d is out of range.", skt); -+ } -+ -+ for (i = 0; i < MAX_MARS3_SOC_COUNT; i++) { -+ if (skt_cpu_cnt[i] > 0) -+ skt_bitmap |= (1 << i); -+ } -+ -+ return skt_bitmap; -+} -+ -+static void __init -+gic_acpi_register_redist(phys_addr_t phys_base, void __iomem *redist_base) -+{ -+ static int count = 0; -+ -+ acpi_data.redist_regs[count].phys_base = phys_base; -+ acpi_data.redist_regs[count].redist_base = redist_base; -+ acpi_data.redist_regs[count].single_redist = acpi_data.single_redist; -+ count++; -+} -+ -+static int __init -+gic_acpi_parse_madt_redist(union acpi_subtable_headers *header, -+ const unsigned long end) -+{ -+ struct acpi_madt_generic_redistributor *redist = -+ (struct acpi_madt_generic_redistributor *)header; -+ void __iomem *redist_base; -+ -+ redist_base = ioremap(redist->base_address, redist->length); -+ if (!redist_base) { -+ pr_err("Couldn't map GICR region @%llx\n", redist->base_address); -+ return -ENOMEM; -+ } -+ gic_request_region(redist->base_address, redist->length, "GICR"); -+ -+ gic_acpi_register_redist(redist->base_address, redist_base); -+ return 0; -+} -+ -+static int __init -+gic_acpi_parse_madt_gicc(union acpi_subtable_headers *header, -+ const unsigned long end) -+{ -+ struct acpi_madt_generic_interrupt *gicc = -+ (struct acpi_madt_generic_interrupt *)header; -+ u32 reg = readl_relaxed(acpi_data.dist_base + GICD_PIDR2) & GIC_PIDR2_ARCH_MASK; -+ u32 size = reg == GIC_PIDR2_ARCH_GICv4 ? SZ_64K * 4 : SZ_64K * 2; -+ void __iomem *redist_base; -+ -+ /* GICC entry which has !ACPI_MADT_ENABLED is not unusable so skip */ -+ if (!(gicc->flags & ACPI_MADT_ENABLED)) -+ return 0; -+ -+ redist_base = ioremap(gicc->gicr_base_address, size); -+ if (!redist_base) -+ return -ENOMEM; -+ gic_request_region(gicc->gicr_base_address, size, "GICR"); -+ -+ gic_acpi_register_redist(gicc->gicr_base_address, redist_base); -+ return 0; -+} -+ -+static int __init gic_acpi_collect_gicr_base(void) -+{ -+ acpi_tbl_entry_handler redist_parser; -+ enum acpi_madt_type type; -+ -+ if (acpi_data.single_redist) { -+ type = ACPI_MADT_TYPE_GENERIC_INTERRUPT; -+ redist_parser = gic_acpi_parse_madt_gicc; -+ } else { -+ type = ACPI_MADT_TYPE_GENERIC_REDISTRIBUTOR; -+ redist_parser = gic_acpi_parse_madt_redist; -+ } -+ -+ /* Collect redistributor base addresses in GICR entries */ -+ if (acpi_table_parse_madt(type, redist_parser, 0) > 0) -+ return 0; -+ -+ pr_info("No valid GICR entries exist\n"); -+ return -ENODEV; -+} -+ -+static int __init gic_acpi_match_gicr(union acpi_subtable_headers *header, -+ const unsigned long end) -+{ -+ /* Subtable presence means that redist exists, that's it */ -+ return 0; -+} -+ -+static int __init gic_acpi_match_gicc(union acpi_subtable_headers *header, -+ const unsigned long end) -+{ -+ struct acpi_madt_generic_interrupt *gicc = -+ (struct acpi_madt_generic_interrupt *)header; -+ -+ /* -+ * If GICC is enabled and has valid gicr base address, then it means -+ * GICR base is presented via GICC -+ */ -+ if ((gicc->flags & ACPI_MADT_ENABLED) && gicc->gicr_base_address) { -+ acpi_data.enabled_rdists++; -+ return 0; -+ } -+ -+ /* -+ * It's perfectly valid firmware can pass disabled GICC entry, driver -+ * should not treat as errors, skip the entry instead of probe fail. -+ */ -+ if (!(gicc->flags & ACPI_MADT_ENABLED)) -+ return 0; -+ -+ return -ENODEV; -+} -+ -+static int __init gic_acpi_count_gicr_regions(void) -+{ -+ int count; -+ -+ /* -+ * Count how many redistributor regions we have. It is not allowed -+ * to mix redistributor description, GICR and GICC subtables have to be -+ * mutually exclusive. -+ */ -+ count = acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_REDISTRIBUTOR, -+ gic_acpi_match_gicr, 0); -+ if (count > 0) { -+ acpi_data.single_redist = false; -+ return count; -+ } -+ -+ count = acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_INTERRUPT, -+ gic_acpi_match_gicc, 0); -+ if (count > 0) { -+ acpi_data.single_redist = true; -+ count = acpi_data.enabled_rdists; -+ } -+ -+ return count; -+} -+ -+static bool __init acpi_validate_gic_table(struct acpi_subtable_header *header, -+ struct acpi_probe_entry *ape) -+{ -+ struct acpi_madt_generic_distributor *dist; -+ int count; -+ -+ dist = (struct acpi_madt_generic_distributor *)header; -+ if (dist->version != ape->driver_data) -+ return false; -+ -+ /* We need to do that exercise anyway, the sooner the better */ -+ count = gic_acpi_count_gicr_regions(); -+ if (count <= 0) -+ return false; -+ -+ acpi_data.nr_redist_regions = count; -+ return true; -+} -+ -+static int __init gic_acpi_parse_virt_madt_gicc(union acpi_subtable_headers *header, -+ const unsigned long end) -+{ -+ struct acpi_madt_generic_interrupt *gicc = -+ (struct acpi_madt_generic_interrupt *)header; -+ int maint_irq_mode; -+ static int first_madt = true; -+ -+ /* Skip unusable CPUs */ -+ if (!(gicc->flags & ACPI_MADT_ENABLED)) -+ return 0; -+ -+ maint_irq_mode = (gicc->flags & ACPI_MADT_VGIC_IRQ_MODE) ? -+ ACPI_EDGE_SENSITIVE : ACPI_LEVEL_SENSITIVE; -+ -+ if (first_madt) { -+ first_madt = false; -+ -+ acpi_data.maint_irq = gicc->vgic_interrupt; -+ acpi_data.maint_irq_mode = maint_irq_mode; -+ acpi_data.vcpu_base = gicc->gicv_base_address; -+ -+ return 0; -+ } -+ -+ /* -+ * The maintenance interrupt and GICV should be the same for every CPU -+ */ -+ if ((acpi_data.maint_irq != gicc->vgic_interrupt) || -+ (acpi_data.maint_irq_mode != maint_irq_mode) || -+ (acpi_data.vcpu_base != gicc->gicv_base_address)) -+ return -EINVAL; -+ -+ return 0; -+} -+ -+static bool __init gic_acpi_collect_virt_info(void) -+{ -+ int count; -+ -+ count = acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_INTERRUPT, -+ gic_acpi_parse_virt_madt_gicc, 0); -+ -+ return (count > 0); -+} -+ -+#define ACPI_GICV3_DIST_MEM_SIZE (SZ_64K) -+#define ACPI_GICV2_VCTRL_MEM_SIZE (SZ_4K) -+#define ACPI_GICV2_VCPU_MEM_SIZE (SZ_8K) -+ -+static void __init gic_acpi_setup_kvm_info(void) -+{ -+ int irq; -+ -+ if (!gic_acpi_collect_virt_info()) { -+ pr_warn("Unable to get hardware information used for virtualization\n"); -+ return; -+ } -+ -+ gic_v3_kvm_info.type = GIC_V3; -+ -+ irq = acpi_register_gsi(NULL, acpi_data.maint_irq, -+ acpi_data.maint_irq_mode, -+ ACPI_ACTIVE_HIGH); -+ if (irq <= 0) -+ return; -+ -+ gic_v3_kvm_info.maint_irq = irq; -+ -+ if (acpi_data.vcpu_base) { -+ struct resource *vcpu = &gic_v3_kvm_info.vcpu; -+ -+ vcpu->flags = IORESOURCE_MEM; -+ vcpu->start = acpi_data.vcpu_base; -+ vcpu->end = vcpu->start + ACPI_GICV2_VCPU_MEM_SIZE - 1; -+ } -+ -+ gic_v3_kvm_info.has_v4 = gic_data.rdists.has_vlpis; -+ gic_v3_kvm_info.has_v4_1 = gic_data.rdists.has_rvpeid; -+ vgic_set_kvm_info(&gic_v3_kvm_info); -+} -+ -+static struct fwnode_handle *gsi_domain_handle; -+ -+static struct fwnode_handle *gic_s2500_get_gsi_domain_id(u32 gsi) -+{ -+ return gsi_domain_handle; -+} -+ -+static int __init -+gic_acpi_init(union acpi_subtable_headers *header, const unsigned long end) -+{ -+ struct acpi_madt_generic_distributor *dist; -+ size_t size; -+ int i, err, skt; -+ -+ /* Get distributor base address */ -+ dist = (struct acpi_madt_generic_distributor *)header; -+ acpi_data.dist_base = ioremap(dist->base_address, -+ ACPI_GICV3_DIST_MEM_SIZE); -+ if (!acpi_data.dist_base) { -+ pr_err("Unable to map GICD registers\n"); -+ return -ENOMEM; -+ } -+ gic_request_region(dist->base_address, ACPI_GICV3_DIST_MEM_SIZE, "GICD"); -+ -+ err = gic_validate_dist_version(acpi_data.dist_base); -+ if (err) { -+ pr_err("No distributor detected at @%p, giving up\n", -+ acpi_data.dist_base); -+ goto out_dist_unmap; -+ } -+ -+ mars3_gic_dists[0].phys_base = dist->base_address; -+ mars3_gic_dists[0].size = ACPI_GICV3_DIST_MEM_SIZE; -+ mars3_gic_dists[0].dist_base = acpi_data.dist_base; -+ -+ mars3_sockets_bitmap = gic_mars3_sockets_bitmap(); -+ if (mars3_sockets_bitmap == 0) { -+ mars3_sockets_bitmap = 0x1; -+ pr_err("No socket, please check cpus MPIDR_AFFINITY_LEVEL!"); -+ } else -+ pr_info("mars3_sockets_bitmap = 0x%x\n", mars3_sockets_bitmap); -+ -+ for (skt = 1; skt < MAX_MARS3_SOC_COUNT; skt++) { -+ if (((1U << skt) & mars3_sockets_bitmap) == 0) -+ continue; -+ -+ mars3_gic_dists[skt].phys_base = ((unsigned long)skt << MARS3_ADDR_SKTID_SHIFT) | -+ mars3_gic_dists[0].phys_base; -+ mars3_gic_dists[skt].size = mars3_gic_dists[0].size; -+ mars3_gic_dists[skt].dist_base = ioremap(mars3_gic_dists[skt].phys_base, -+ mars3_gic_dists[skt].size); -+ } -+ -+ size = sizeof(*acpi_data.redist_regs) * acpi_data.nr_redist_regions; -+ acpi_data.redist_regs = kzalloc(size, GFP_KERNEL); -+ if (!acpi_data.redist_regs) { -+ err = -ENOMEM; -+ goto out_dist_unmap; -+ } -+ -+ err = gic_acpi_collect_gicr_base(); -+ if (err) -+ goto out_redist_unmap; -+ -+ gsi_domain_handle = irq_domain_alloc_fwnode(&dist->base_address); -+ if (!gsi_domain_handle) { -+ err = -ENOMEM; -+ goto out_redist_unmap; -+ } -+ -+ err = gic_init_bases(acpi_data.dist_base, acpi_data.redist_regs, -+ acpi_data.nr_redist_regions, 0, gsi_domain_handle); -+ if (err) -+ goto out_fwhandle_free; -+ -+ acpi_set_irq_model(ACPI_IRQ_MODEL_GIC, gic_s2500_get_gsi_domain_id); -+ -+ if (static_branch_likely(&supports_deactivate_key)) -+ gic_acpi_setup_kvm_info(); -+ -+ return 0; -+ -+out_fwhandle_free: -+ irq_domain_free_fwnode(gsi_domain_handle); -+out_redist_unmap: -+ for (i = 0; i < acpi_data.nr_redist_regions; i++) -+ if (acpi_data.redist_regs[i].redist_base) -+ iounmap(acpi_data.redist_regs[i].redist_base); -+ kfree(acpi_data.redist_regs); -+out_dist_unmap: -+ iounmap(acpi_data.dist_base); -+ return err; -+} -+IRQCHIP_ACPI_DECLARE(gic_phyt_2500, ACPI_MADT_TYPE_OEM_RESERVED, -+ acpi_validate_gic_table, ACPI_MADT_GIC_VERSION_V3, -+ gic_acpi_init); -+#endif -diff --git a/drivers/irqchip/irq-gic-v3-its.c b/drivers/irqchip/irq-gic-v3-its.c -index 676c9250d..6005e1bad 100644 ---- a/drivers/irqchip/irq-gic-v3-its.c -+++ b/drivers/irqchip/irq-gic-v3-its.c -@@ -1730,7 +1730,8 @@ static void its_irq_compose_msi_msg(struct irq_data *d, struct msi_msg *msg) - msg->address_hi = upper_32_bits(addr); - msg->data = its_get_event_id(d); - -- iommu_dma_compose_msi_msg(irq_data_get_msi_desc(d), msg); -+ if ((read_cpuid_id() & MIDR_CPU_MODEL_MASK) != MIDR_PHYTIUM_PS17064) -+ iommu_dma_compose_msi_msg(irq_data_get_msi_desc(d), msg); - } - - static int its_irq_set_irqchip_state(struct irq_data *d, -@@ -4893,6 +4894,7 @@ static void its_restore_enable(void) - { - struct its_node *its; - int ret; -+ int cpu; - - raw_spin_lock(&its_lock); - list_for_each_entry(its, &its_nodes, entry) { -@@ -4946,6 +4948,23 @@ static void its_restore_enable(void) - GITS_TYPER_HCC(gic_read_typer(base + GITS_TYPER))) - its_cpu_init_collection(its); - } -+ -+ /* -+ * Enable LPIs:firmware just restore GICR_CTLR_ENABLE_LPIs of boot -+ * CPU, the other CPUs also should be restored. -+ */ -+ for_each_possible_cpu(cpu) { -+ void __iomem *rbase = gic_data_rdist_cpu(cpu)->rd_base; -+ u32 val; -+ -+ /* Enable LPIs */ -+ val = readl_relaxed(rbase + GICR_CTLR); -+ if (val & GICR_CTLR_ENABLE_LPIS) -+ continue; -+ -+ val |= GICR_CTLR_ENABLE_LPIS; -+ writel_relaxed(val, rbase + GICR_CTLR); -+ } - raw_spin_unlock(&its_lock); - } - -diff --git a/drivers/irqchip/irq-phytium-ixic.c b/drivers/irqchip/irq-phytium-ixic.c -new file mode 100644 -index 000000000..9fee4c6dc ---- /dev/null -+++ b/drivers/irqchip/irq-phytium-ixic.c -@@ -0,0 +1,264 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Driver for Phytium PCIe legacy INTx interrupt controller -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+ -+#define NUM_IRQS 4 -+ -+#define CTR_BANK_NUM 6 -+#define CTR_BANK_SIZE 0x10000 -+#define CTR_BANK_ISTATUS_LOCAL 0x184 -+ -+#define HPB_INTX_STATUS_0 0x0 -+#define HPB_INTX_STATUS_1 0x1000 -+ -+struct ixic_irq_data { -+ void __iomem *ctr; -+ void __iomem *hpb; -+ u32 spi_base; -+}; -+ -+static void phytium_ixic_irq_eoi(struct irq_data *d) -+{ -+ struct ixic_irq_data *data = irq_data_get_irq_chip_data(d); -+ unsigned int intx = irqd_to_hwirq(d); -+ u32 gstatus = readl(data->hpb) | (readl(data->hpb + HPB_INTX_STATUS_1) << 12); -+ u32 imask, istatus; -+ int i; -+ -+ WARN_ON(intx >= NUM_IRQS); -+ imask = 1 << (3 - intx); -+ istatus = (1 << intx) << 24; -+ for (i = 0; i < CTR_BANK_NUM; i++, gstatus >>= 4) { -+ if (gstatus & imask) -+ writel(istatus, data->ctr + CTR_BANK_SIZE*i + CTR_BANK_ISTATUS_LOCAL); -+ } -+ -+ irq_chip_eoi_parent(d); -+} -+ -+static struct irq_chip phytium_ixic_irq_chip = { -+ .name = "IXIU", -+ .irq_eoi = phytium_ixic_irq_eoi, -+ .irq_mask = irq_chip_mask_parent, -+ .irq_unmask = irq_chip_unmask_parent, -+ .irq_set_type = irq_chip_set_type_parent, -+ .irq_set_affinity = irq_chip_set_affinity_parent, -+ .flags = IRQCHIP_MASK_ON_SUSPEND, -+}; -+ -+static int phytium_ixic_translate(struct irq_domain *domain, -+ struct irq_fwspec *fwspec, -+ unsigned long *hwirq, -+ unsigned int *type) -+{ -+ struct ixic_irq_data *info = domain->host_data; -+ -+ if (is_of_node(fwspec->fwnode)) { -+ if (fwspec->param_count != 3) -+ return -EINVAL; -+ -+ if (fwspec->param[0] != GIC_SPI) -+ return -EINVAL; /* No PPI should point to this domain */ -+ -+ *hwirq = fwspec->param[1] - info->spi_base; -+ *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; -+ } else { -+ if (fwspec->param_count != 2) -+ return -EINVAL; -+ *hwirq = fwspec->param[0] - info->spi_base; -+ *type = fwspec->param[1] & IRQ_TYPE_SENSE_MASK; -+ } -+ -+ return 0; -+} -+ -+static int phytium_ixic_alloc(struct irq_domain *dom, unsigned int virq, -+ unsigned int nr_irqs, void *data) -+{ -+ struct irq_fwspec *fwspec = data; -+ struct irq_fwspec parent_fwspec; -+ struct ixic_irq_data *info = dom->host_data; -+ irq_hw_number_t hwirq; -+ -+ /* We assume the device use the parent's format directly */ -+ parent_fwspec = *fwspec; -+ if (is_of_node(dom->parent->fwnode)) { -+ if (fwspec->param_count != 3) -+ return -EINVAL; /* Not GIC compliant */ -+ if (fwspec->param[0] != GIC_SPI) -+ return -EINVAL; /* No PPI should point to this domain */ -+ -+ /* Get the local hwirq of IXIC */ -+ hwirq = fwspec->param[1] - info->spi_base; -+ } else { -+ hwirq = fwspec->param[0] - info->spi_base; -+ } -+ WARN_ON(nr_irqs != 1); -+ irq_domain_set_hwirq_and_chip(dom, virq, hwirq, &phytium_ixic_irq_chip, info); -+ -+ parent_fwspec.fwnode = dom->parent->fwnode; -+ return irq_domain_alloc_irqs_parent(dom, virq, nr_irqs, &parent_fwspec); -+} -+ -+static const struct irq_domain_ops ixic_domain_ops = { -+ .translate = phytium_ixic_translate, -+ .alloc = phytium_ixic_alloc, -+ .free = irq_domain_free_irqs_common, -+}; -+ -+static struct ixic_irq_data *phytium_ixic_init(const struct fwnode_handle *fwnode, -+ struct resource *ctr, struct resource *hpb) -+{ -+ struct ixic_irq_data *data; -+ int err; -+ -+ data = kzalloc(sizeof(*data), GFP_KERNEL); -+ if (!data) -+ return ERR_PTR(-ENOMEM); -+ -+ if (fwnode_property_read_u32_array(fwnode, "intx-spi-base", -+ &data->spi_base, 1)) { -+ err = -ENODEV; -+ goto out_free; -+ } -+ -+ data->ctr = ioremap(ctr->start, resource_size(ctr)); -+ if (!data->ctr) { -+ err = -ENODEV; -+ goto out_free; -+ } -+ -+ data->hpb = ioremap(hpb->start, resource_size(hpb)); -+ if (!data->hpb) { -+ err = -ENODEV; -+ goto out_free; -+ } -+ -+ return data; -+ -+out_free: -+ kfree(data); -+ return ERR_PTR(err); -+} -+ -+static int __init phytium_ixic_dt_init(struct device_node *node, -+ struct device_node *parent) -+{ -+ struct irq_domain *pd, *d; -+ struct ixic_irq_data *data; -+ struct resource ctr, hpb; -+ -+ if (!parent) { -+ pr_err("%pOF: no parent, giving up\n", node); -+ return -ENODEV; -+ } -+ -+ pd = irq_find_host(parent); -+ if (!pd) { -+ pr_err("%pOF: unable to obtain parent domain\n", node); -+ return -ENXIO; -+ } -+ -+ if (of_address_to_resource(node, 0, &ctr)) { -+ pr_err("%pOF: failed to parse 'ctr' memory resource\n", node); -+ return -ENXIO; -+ } -+ -+ if (of_address_to_resource(node, 1, &hpb)) { -+ pr_err("%pOF: failed to parse 'hpb' memory resource\n", node); -+ return -ENXIO; -+ } -+ -+ data = phytium_ixic_init(of_node_to_fwnode(node), &ctr, &hpb); -+ if (IS_ERR(data)) -+ return PTR_ERR(data); -+ -+ d = irq_domain_add_hierarchy(pd, 0, NUM_IRQS, node, &ixic_domain_ops, data); -+ if (!d) { -+ pr_err("%pOF: failed to allocate domain\n", node); -+ goto out_unmap; -+ } -+ -+ pr_info("%pOF: %d interrupts forwarded to %pOF\n", node, NUM_IRQS, parent); -+ -+ return 0; -+ -+out_unmap: -+ iounmap(data->ctr); -+ iounmap(data->hpb); -+ kfree(data); -+ return -ENOMEM; -+} -+IRQCHIP_DECLARE(ixic, "phytium,ixic", phytium_ixic_dt_init); -+ -+#ifdef CONFIG_ACPI -+static int phytium_ixic_acpi_probe(struct platform_device *pdev) -+{ -+ struct irq_domain *domain; -+ struct ixic_irq_data *data; -+ struct resource *ctr, *hpb; -+ -+ ctr = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ if (!ctr) { -+ dev_err(&pdev->dev, "failed to parse 'ctr' memory resource\n"); -+ return -ENXIO; -+ } -+ -+ hpb = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ if (!hpb) { -+ dev_err(&pdev->dev, "failed to parse 'hpb' memory resource\n"); -+ return -ENXIO; -+ } -+ -+ data = phytium_ixic_init(dev_fwnode(&pdev->dev), ctr, hpb); -+ if (IS_ERR(data)) -+ return PTR_ERR(data); -+ -+ domain = acpi_irq_create_hierarchy(0, NUM_IRQS, dev_fwnode(&pdev->dev), -+ &ixic_domain_ops, data); -+ if (!domain) { -+ dev_err(&pdev->dev, "failed to create IRQ domain\n"); -+ goto out_unmap; -+ } -+ -+ dev_info(&pdev->dev, "%d interrupts forwarded\n", NUM_IRQS); -+ -+ return 0; -+ -+out_unmap: -+ iounmap(data->ctr); -+ iounmap(data->hpb); -+ kfree(data); -+ return -ENOMEM; -+} -+ -+static const struct acpi_device_id phytium_ixic_acpi_ids[] = { -+ { "PHYT0013" }, -+ { /* sentinel */ } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_ixic_acpi_ids); -+ -+static struct platform_driver phytium_ixic_driver = { -+ .driver = { -+ .name = "phytium-ixic", -+ .acpi_match_table = phytium_ixic_acpi_ids, -+ }, -+ .probe = phytium_ixic_acpi_probe, -+}; -+builtin_platform_driver(phytium_ixic_driver); -+#endif -diff --git a/drivers/mailbox/Kconfig b/drivers/mailbox/Kconfig -index bc2e265cb..771f8fabd 100644 ---- a/drivers/mailbox/Kconfig -+++ b/drivers/mailbox/Kconfig -@@ -41,6 +41,15 @@ config IMX_MBOX - help - Mailbox implementation for i.MX Messaging Unit (MU). - -+config PHYTIUM_MBOX -+ tristate "Phytium SoC Mailbox Support" -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ help -+ Mailbox driver implementation for the Phytium platform. It is used -+ to send message between application processors and on-chip management -+ firmware. Say Y here if you want to build this mailbox controller -+ driver. -+ - config PLATFORM_MHU - tristate "Platform MHU Mailbox" - depends on OF -diff --git a/drivers/mailbox/Makefile b/drivers/mailbox/Makefile -index fc9376117..487f62094 100644 ---- a/drivers/mailbox/Makefile -+++ b/drivers/mailbox/Makefile -@@ -62,3 +62,5 @@ obj-$(CONFIG_SPRD_MBOX) += sprd-mailbox.o - obj-$(CONFIG_QCOM_IPCC) += qcom-ipcc.o - - obj-$(CONFIG_APPLE_MAILBOX) += apple-mailbox.o -+ -+obj-$(CONFIG_PHYTIUM_MBOX) += phytium_mailbox.o -diff --git a/drivers/mailbox/phytium_mailbox.c b/drivers/mailbox/phytium_mailbox.c -new file mode 100644 -index 000000000..14d3b40cb ---- /dev/null -+++ b/drivers/mailbox/phytium_mailbox.c -@@ -0,0 +1,216 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SoC mailbox driver -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from drivers/mailbox/arm_mhu.c -+ * Copyright (C) 2013-2015 Fujitsu Semiconductor Ltd. -+ * Copyright (C) 2015 Linaro Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define INTR_STAT 0x0 -+#define INTR_SET 0x8 -+#define INTR_CLR 0x10 -+ -+#define TX_REG 0x100 -+ -+#define NR_CHANS 1 -+ -+static spinlock_t lock; -+ -+struct phytium_mbox_link { -+ unsigned int irq; -+ void __iomem *tx_reg; -+ void __iomem *rx_reg; -+}; -+ -+struct phytium_mbox { -+ void __iomem *base; -+ struct phytium_mbox_link mlink; -+ struct mbox_chan chan; -+ struct mbox_controller mbox; -+}; -+ -+static irqreturn_t phytium_mbox_rx_irq(int irq, void *ch) -+{ -+ struct mbox_chan *chan = ch; -+ struct phytium_mbox_link *mlink = chan->con_priv; -+ u32 val; -+ unsigned long flags = 0; -+ -+ spin_lock_irqsave(&lock, flags); -+ val = readl_relaxed(mlink->rx_reg + INTR_STAT); -+ spin_unlock_irqrestore(&lock, flags); -+ if (!val) -+ return IRQ_NONE; -+ -+ mbox_chan_received_data(chan, (void *)&val); -+ -+ spin_lock_irqsave(&lock, flags); -+ writel_relaxed(val, mlink->rx_reg + INTR_CLR); -+ spin_unlock_irqrestore(&lock, flags); -+ -+ return IRQ_HANDLED; -+} -+ -+static int phytium_mbox_send_data(struct mbox_chan *chan, void *data) -+{ -+ struct phytium_mbox_link *mlink = chan->con_priv; -+ u32 *arg = data; -+ unsigned long flags = 0; -+ -+ spin_lock_irqsave(&lock, flags); -+ writel_relaxed(*arg, mlink->tx_reg + INTR_SET); -+ spin_unlock_irqrestore(&lock, flags); -+ -+ return 0; -+} -+ -+static int phytium_mbox_startup(struct mbox_chan *chan) -+{ -+ struct phytium_mbox_link *mlink = chan->con_priv; -+ u32 val; -+ int ret; -+ unsigned long flags = 0; -+ -+ spin_lock_irqsave(&lock, flags); -+ val = readl_relaxed(mlink->tx_reg + INTR_STAT); -+ writel_relaxed(val, mlink->tx_reg + INTR_CLR); -+ spin_unlock_irqrestore(&lock, flags); -+ -+ ret = request_irq(mlink->irq, phytium_mbox_rx_irq, -+ IRQF_SHARED, "phytium_mbox_link", chan); -+ if (ret) { -+ dev_err(chan->mbox->dev, -+ "Unable to acquire IRQ %d\n", mlink->irq); -+ } -+ -+ return ret; -+} -+ -+static void phytium_mbox_shutdown(struct mbox_chan *chan) -+{ -+ struct phytium_mbox_link *mlink = chan->con_priv; -+ -+ free_irq(mlink->irq, chan); -+} -+ -+static bool phytium_mbox_last_tx_done(struct mbox_chan *chan) -+{ -+ unsigned long flags; -+ struct phytium_mbox_link *mlink = chan->con_priv; -+ u32 val; -+ -+ spin_lock_irqsave(&lock, flags); -+ val = readl_relaxed(mlink->tx_reg + INTR_STAT); -+ spin_unlock_irqrestore(&lock, flags); -+ -+ return (val == (u32)(1U << 31)); -+} -+ -+static const struct mbox_chan_ops phytium_mbox_ops = { -+ .send_data = phytium_mbox_send_data, -+ .startup = phytium_mbox_startup, -+ .shutdown = phytium_mbox_shutdown, -+ .last_tx_done = phytium_mbox_last_tx_done, -+}; -+ -+static const struct acpi_device_id phytium_mbox_acpi_match[] = { -+ { "PHYT0009", 0 }, -+ { }, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_mbox_acpi_match); -+ -+static const struct of_device_id phytium_mbox_of_match[] = { -+ { .compatible = "phytium,mbox", }, -+ { }, -+}; -+MODULE_DEVICE_TABLE(of, phytium_mbox_of_match); -+ -+static int phytium_mbox_probe(struct platform_device *pdev) -+{ -+ struct phytium_mbox *mbox; -+ struct resource *res; -+ int err, irq; -+ -+ spin_lock_init(&lock); -+ -+ /* Allocate memory for device */ -+ mbox = devm_kzalloc(&pdev->dev, sizeof(*mbox), GFP_KERNEL); -+ if (!mbox) -+ return -ENOMEM; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ mbox->base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(mbox->base)) { -+ dev_err(&pdev->dev, "ioremap base failed\n"); -+ return PTR_ERR(mbox->base); -+ } -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) { -+ dev_err(&pdev->dev, "cannot obtain irq\n"); -+ return irq; -+ } -+ -+ mbox->chan.con_priv = &mbox->mlink; -+ mbox->mlink.irq = irq; -+ mbox->mlink.rx_reg = mbox->base; -+ mbox->mlink.tx_reg = mbox->mlink.rx_reg + TX_REG; -+ -+ mbox->mbox.dev = &pdev->dev; -+ mbox->mbox.chans = &mbox->chan; -+ mbox->mbox.num_chans = NR_CHANS; -+ mbox->mbox.ops = &phytium_mbox_ops; -+ mbox->mbox.txdone_irq = false; -+ mbox->mbox.txdone_poll = true; -+ mbox->mbox.txpoll_period = 1; -+ -+ platform_set_drvdata(pdev, mbox); -+ -+ err = mbox_controller_register(&mbox->mbox); -+ if (err) { -+ dev_err(&pdev->dev, "Failed to register mailboxes %d\n", err); -+ goto fail; -+ } -+ -+ dev_info(&pdev->dev, "Phytium SoC Mailbox registered\n"); -+fail: -+ return err; -+} -+ -+static int phytium_mbox_remove(struct platform_device *pdev) -+{ -+ struct phytium_mbox *mbox = platform_get_drvdata(pdev); -+ -+ mbox_controller_unregister(&mbox->mbox); -+ -+ return 0; -+} -+ -+static struct platform_driver phytium_mbox_driver = { -+ .probe = phytium_mbox_probe, -+ .remove = phytium_mbox_remove, -+ .driver = { -+ .name = "phytium-mbox", -+ .of_match_table = of_match_ptr(phytium_mbox_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_mbox_acpi_match), -+ }, -+}; -+ -+module_platform_driver(phytium_mbox_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium SoC Mailbox Driver"); -+MODULE_AUTHOR("Chen Baozi "); -diff --git a/drivers/media/platform/Kconfig b/drivers/media/platform/Kconfig -index ee579916f..20a72238a 100644 ---- a/drivers/media/platform/Kconfig -+++ b/drivers/media/platform/Kconfig -@@ -75,6 +75,7 @@ source "drivers/media/platform/mediatek/Kconfig" - source "drivers/media/platform/microchip/Kconfig" - source "drivers/media/platform/nvidia/Kconfig" - source "drivers/media/platform/nxp/Kconfig" -+source "drivers/media/platform/phytium/Kconfig" - source "drivers/media/platform/qcom/Kconfig" - source "drivers/media/platform/renesas/Kconfig" - source "drivers/media/platform/rockchip/Kconfig" -diff --git a/drivers/media/platform/Makefile b/drivers/media/platform/Makefile -index 5453bb868..ab61f38de 100644 ---- a/drivers/media/platform/Makefile -+++ b/drivers/media/platform/Makefile -@@ -18,6 +18,7 @@ obj-y += mediatek/ - obj-y += microchip/ - obj-y += nvidia/ - obj-y += nxp/ -+obj-y += phytium/ - obj-y += qcom/ - obj-y += renesas/ - obj-y += rockchip/ -diff --git a/drivers/media/platform/phytium/Kconfig b/drivers/media/platform/phytium/Kconfig -new file mode 100644 -index 000000000..498314fbf ---- /dev/null -+++ b/drivers/media/platform/phytium/Kconfig -@@ -0,0 +1,14 @@ -+# SPDX-License-Identifier: GPL-2.0-only -+ -+comment "Phytium media platform drivers" -+ -+config VIDEO_PHYTIUM_JPEG -+ tristate "Phytium JPEG Encoder Engine driver" -+ depends on V4L_PLATFORM_DRIVERS -+ depends on VIDEO_DEV -+ select VIDEOBUF2_DMA_CONTIG -+ help -+ Support for the Phytium JPEG Encoder Engine embedded -+ in the Phytium SOCs. The engine can capture and -+ compress video data from digital or analog sources. -+ -diff --git a/drivers/media/platform/phytium/Makefile b/drivers/media/platform/phytium/Makefile -new file mode 100644 -index 000000000..79b6bfa52 ---- /dev/null -+++ b/drivers/media/platform/phytium/Makefile -@@ -0,0 +1,5 @@ -+# SPDX-License-Identifier: GPL-2.0-only -+# -+phytium_jpeg-objs := phytium_jpeg_core.o -+ -+obj-$(CONFIG_VIDEO_PHYTIUM_JPEG) += phytium_jpeg.o -diff --git a/drivers/media/platform/phytium/phytium_jpeg_core.c b/drivers/media/platform/phytium/phytium_jpeg_core.c -new file mode 100644 -index 000000000..014af0162 ---- /dev/null -+++ b/drivers/media/platform/phytium/phytium_jpeg_core.c -@@ -0,0 +1,1379 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Driver for Phytium JPEG Encoder Engine -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include "phytium_jpeg_reg.h" -+#include "phytium_jpeg_core.h" -+#include -+ -+static u32 phytium_jpeg_header[PHYTIUM_JPEG_HEADER_SIZE] = { -+ 0xe0ffd8ff, 0x464a0100, 0x01004649, 0x01000001, -+ 0x00000100, 0x4300dbff, 0x0c0b1000, 0x100a0c0e, -+ 0x120e0d0e, 0x18131011, 0x16181a28, 0x23311816, -+ 0x3a281d25, 0x393c3d33, 0x40373833, 0x404e5c48, -+ 0x37455744, 0x516d5038, 0x67625f57, 0x4d3e6768, -+ 0x64707971, 0x67655c78, 0x00dbff63, 0x12110143, -+ 0x18151812, 0x2f1a1a2f, 0x42384263, 0x63636363, -+ 0x63636363, 0x63636363, 0x63636363, 0x63636363, -+ 0x63636363, 0x63636363, 0x63636363, 0x63636363, -+ 0x63636363, 0x63636363, 0x63636363, 0xc0ff6363, -+ /* h_index(40) indicates high 8 bits of the height -+ * w_index(41) contains the low 8 bits of the height, -+ * and the width. For example, height 480(0x01e0) -+ * locates at 0x<01> 081100 and 0x038002 . -+ * width 640 (0x0280) locates at 0x03 <80> <02> e0. -+ */ -+ -+ /* 0x0200 <11> 01 is a field marks YUV mode */ -+ 0x01081100, 0x038002e0, 0x02001101, 0x11030111, -+ 0x00c4ff01, 0x0100001f, 0x01010105, 0x00010101, -+ 0x00000000, 0x01000000, 0x05040302, 0x09080706, -+ 0xc4ff0b0a, 0x00011f00, 0x01010103, 0x01010101, -+ 0x00000101, 0x00000000, 0x04030201, 0x08070605, -+ 0xff0b0a09, 0x10b500c4, 0x03010200, 0x03040203, -+ 0x04040505, 0x7d010000, 0x00030201, 0x12051104, -+ 0x06413121, 0x07615113, 0x32147122, 0x08a19181, -+ 0xc1b14223, 0xf0d15215, 0x72623324, 0x160a0982, -+ 0x1a191817, 0x28272625, 0x35342a29, 0x39383736, -+ 0x4544433a, 0x49484746, 0x5554534a, 0x59585756, -+ 0x6564635a, 0x69686766, 0x7574736a, 0x79787776, -+ 0x8584837a, 0x89888786, 0x9493928a, 0x98979695, -+ 0xa3a29a99, 0xa7a6a5a4, 0xb2aaa9a8, 0xb6b5b4b3, -+ 0xbab9b8b7, 0xc5c4c3c2, 0xc9c8c7c6, 0xd4d3d2ca, -+ 0xd8d7d6d5, 0xe2e1dad9, 0xe6e5e4e3, 0xeae9e8e7, -+ 0xf4f3f2f1, 0xf8f7f6f5, 0xc4fffaf9, 0x0011b500, -+ 0x04020102, 0x07040304, 0x00040405, 0x00770201, -+ 0x11030201, 0x31210504, 0x51411206, 0x13716107, -+ 0x08813222, 0xa1914214, 0x2309c1b1, 0x15f05233, -+ 0x0ad17262, 0xe1342416, 0x1817f125, 0x27261a19, -+ 0x352a2928, 0x39383736, 0x4544433a, 0x49484746, -+ 0x5554534a, 0x59585756, 0x6564635a, 0x69686766, -+ 0x7574736a, 0x79787776, 0x8483827a, 0x88878685, -+ 0x93928a89, 0x97969594, 0xa29a9998, 0xa6a5a4a3, -+ 0xaaa9a8a7, 0xb5b4b3b2, 0xb9b8b7b6, 0xc4c3c2ba, -+ 0xc8c7c6c5, 0xd3d2cac9, 0xd7d6d5d4, 0xe2dad9d8, -+ 0xe6e5e4e3, 0xeae9e8e7, 0xf5f4f3f2, 0xf9f8f7f6, -+ 0x00fefffa, 0x0000008f, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0x00000000, 0x00000000, 0x00000000, 0x00000000, -+ 0xdaff0000, 0x01030c00, 0x03110200, 0x003f0011 -+}; -+ -+static char yuv_mode_str[YUV_MODE_STR_LEN] = { "yuv444" }; -+ -+module_param_string(yuv_mode, yuv_mode_str, sizeof(yuv_mode_str), 0444); -+MODULE_PARM_DESC(yuv_mode, "Users select one mode from such modes as 'yuv444', or 'yuv422', or 'yuv420'. If no mode is set, the driver adapts defaults mode 'yuv444'."); -+ -+static u32 phytium_jpeg_read(struct phytium_jpeg_dev *jpeg_dev, u32 reg) -+{ -+ u32 reg_val = readl(jpeg_dev->base_addr + reg); -+ -+ dev_dbg(jpeg_dev->dev, "read 0x%p + 0x%x -->val[0x%x]\n", -+ jpeg_dev->base_addr, reg, reg_val); -+ -+ return reg_val; -+} -+ -+static void phytium_jpeg_write(struct phytium_jpeg_dev *jpeg_dev, -+ u32 reg, u32 val) -+{ -+ writel(val, jpeg_dev->base_addr + reg); -+ dev_dbg(jpeg_dev->dev, "write 0x%x to addr 0x%p + 0x%x\n", -+ val, jpeg_dev->base_addr, reg); -+} -+ -+static void phytium_jpeg_update(struct phytium_jpeg_dev *jpeg_dev, u32 reg, -+ u32 clear, u32 bits) -+{ -+ u32 reg_val = readl(jpeg_dev->base_addr + reg); -+ u32 tmp = reg_val; -+ -+ reg_val &= ~clear; -+ reg_val |= bits; -+ writel(reg_val, jpeg_dev->base_addr + reg); -+ -+ dev_dbg(jpeg_dev->dev, "the val of addr 0x%p + 0x%x, from 0x%x to 0x%x\n", -+ jpeg_dev->base_addr, reg, tmp, readl(jpeg_dev->base_addr + reg)); -+} -+ -+static void phytium_jpeg_init_regs(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ u32 transform_info = 0; -+ u32 disable_all_interrupt = 0; -+ u32 clear_all_interrupt = INT_FIFO_OVERFLOW | INT_OCM_BUF_OVERFLOW | -+ INT_JPEG_ENCODE_COMPLETE | INT_VIDEO_FORMAT_CHANGE; -+ u32 rate_to_reg = 0; -+ -+ /* First, disable the JPEG engine, set bit0 = 0*/ -+ phytium_jpeg_write(jpeg_dev, TRANSFORM_INFO_REG, transform_info); -+ -+ /* Second, set VGAvideo_source_information. bit1 = 0 marks VGA */ -+ transform_info |= 0; -+ -+ /* Third, set AXI burst length bit[16:22]= 0xf , default value*/ -+ transform_info |= (0xF << TRANS_AXI_LEN_SHIFT) & TRANSINFO_AXI_LEN; -+ -+ /* Fourth, the default sampling format is YUV422, set bit13 to 0 */ -+ /* ignore setting sampling interval */ -+ phytium_jpeg_write(jpeg_dev, TRANSFORM_INFO_REG, transform_info); -+ udelay(5); -+ -+ /* Fifth, setting frame rate. -+ * Linux driver prohibit float point operations. So use the -+ * format: reg_val = (1 second * 10^8 / frame_rate / 134 *100) -+ * write reg_val to register. then enable Highest bit31 = 1 -+ */ -+ if (jpeg_dev->frame_rate) { -+ rate_to_reg = 100000000 / jpeg_dev->frame_rate / 134 * 100; -+ rate_to_reg |= FRAME_SAMPLE_CTRL_EN; -+ phytium_jpeg_write(jpeg_dev, FRAME_SAMPLE_CTRL, rate_to_reg); -+ } -+ /* Sixth, HUFF_MODE, driver needn't to configure, ignore */ -+ -+ /* disable all interrupts and then clear all interrupts */ -+ phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, -+ disable_all_interrupt); -+ udelay(5); -+ phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, clear_all_interrupt); -+ -+ /* Seventh, Sample_mode, hardware default is yuv444 */ -+ jpeg_dev->yuv420 = false; -+} -+ -+/* Turn on the clock of the jpeg engine */ -+static void phytium_jpeg_on(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ if (test_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status)) -+ return; -+ -+ /* Turn on the relevant clocks */ -+ set_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status); -+} -+ -+/* Disable the jpeg engine */ -+static void phytium_jpeg_off(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ u32 disable_all_interrupt = 0; -+ u32 clear_all_interrupt = INT_FIFO_OVERFLOW | INT_OCM_BUF_OVERFLOW | -+ INT_JPEG_ENCODE_COMPLETE | INT_VIDEO_FORMAT_CHANGE; -+ -+ if (!test_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status)) { -+ dev_info(jpeg_dev->dev, "JPEG Engine is already off.\n"); -+ return; -+ } -+ -+ /* disable all interrupt */ -+ phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, disable_all_interrupt); -+ /* clear all interrupt */ -+ phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, clear_all_interrupt); -+ /* disable JPEG engine */ -+ phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 0); -+ -+ clear_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status); -+ /* wait 50 ms */ -+ mdelay(50); -+ /* C08 bit7 1:busy */ -+} -+ -+static inline void phytium_jpeg_enable_source_detecting(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ /* -+ * Enable the dectection to discovery -+ * the source resolution is changed -+ */ -+ //phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, DETECT_RESOLUTION_CHANGE_EN); -+ phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, 0, TRANSINFO_SRC_SELECT); -+} -+ -+#define res_check(val) \ -+ test_and_clear_bit(VIDEO_MODE_DETECT_DONE, &(val)->status) -+ -+static void phytium_jpeg_get_resolution(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ u32 source_info; -+ u32 width; -+ u32 height; -+ struct v4l2_bt_timings *detected_timings = &jpeg_dev->detected_timings; -+ -+ /* Before get a new resolution, maybe need to wait 10 us */ -+ detected_timings->width = MIN_WIDTH; -+ detected_timings->height = MIN_HEIGHT; -+ jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; -+ -+ -+ phytium_jpeg_enable_source_detecting(jpeg_dev); -+ source_info = phytium_jpeg_read(jpeg_dev, SRC_VGA_INFO_REG); -+ width = (source_info & SRC_HOR_PIXELS) >> SRC_WIDTH_SHIFT; -+ height = (source_info & SRC_VER_PIXELS) >> SRC_HEIGHT_SHIFT; -+ -+ if (width * height != 0) { -+ detected_timings->width = width; -+ detected_timings->height = height; -+ } -+ -+ jpeg_dev->v4l2_input_status = 0; -+ -+ /* -+ * Resolution is changed will trigger an interrupt, resolution detecting -+ * also is disable during process interrupt. So re-enable. -+ */ -+ phytium_jpeg_enable_source_detecting(jpeg_dev); -+ dev_info(jpeg_dev->dev, "Change resolution: %uX%u\n", width, height); -+} -+ -+static void phytium_jpeg_set_resolution(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ struct v4l2_bt_timings *active_timings = &jpeg_dev->active_timings; -+ int i; -+ int src_addrs[OCM_BUF_NUM]; -+ /* -+ * The OCM address space is 0x30C0_0000 ~ 0x30C7_FFFF, JPEG Engine uses the -+ * high-bottom address. src_0 uses 0x30C4_0000 ~ 0x30c6_0000 (total capacity is -+ * 128KB, greater than the requirements of the largest resolution). src_1 uses -+ * 0x30C6_0000 ~ 0x30C7_FFFF. -+ */ -+ -+ /* The OCM address should shift right 8 bits */ -+ for (i = 0; i < OCM_BUF_NUM; i++) -+ src_addrs[i] = jpeg_dev->src_addrs[i].dma_addr >> OCM_BUF_SHIFT; -+ -+ phytium_jpeg_write(jpeg_dev, OCM_BUF0_ADDR, src_addrs[0]); -+ phytium_jpeg_write(jpeg_dev, OCM_BUF1_ADDR, src_addrs[1]); -+ -+ /* -+ * In the worst case, the size of one image will be compressed to 25% the -+ * raw image's size. When a pixel is 4-byte, no need to divide 4. -+ */ -+ jpeg_dev->max_compressed_size = active_timings->width * active_timings->height; -+} -+ -+/* The below functions is implemented for various v4l2 ioctl operations */ -+static int phytium_jpeg_querycap(struct file *file, void *priv, -+ struct v4l2_capability *cap) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ strscpy(cap->driver, PHYTIUM_JPEG_NAME, sizeof(cap->driver)); -+ strscpy(cap->card, "Phytium JPEG Engine", sizeof(cap->card)); -+ snprintf(cap->bus_info, sizeof(cap->bus_info), "platform:%s", dev_name(jpeg_dev->dev)); -+ -+ return 0; -+} -+ -+static int phytium_jpeg_enum_format(struct file *file, void *priv, -+ struct v4l2_fmtdesc *f) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ if (f->index) { -+ dev_err(jpeg_dev->dev, "Failed to enum format\n"); -+ return -EINVAL; -+ } -+ -+ f->pixelformat = V4L2_PIX_FMT_JPEG; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_get_format(struct file *file, void *priv, -+ struct v4l2_format *f) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ f->fmt.pix = jpeg_dev->pix_fmt; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_enum_input(struct file *file, void *priv, -+ struct v4l2_input *input) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ if (input->index) { -+ dev_err(jpeg_dev->dev, "failed to enum input\n"); -+ return -EINVAL; -+ } -+ -+ strscpy(input->name, "Host DC Capture", sizeof(input->name)); -+ input->type = V4L2_INPUT_TYPE_CAMERA; -+ input->capabilities = V4L2_IN_CAP_DV_TIMINGS; -+ input->status = jpeg_dev->v4l2_input_status; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_get_input(struct file *file, void *priv, -+ unsigned int *i) -+{ -+ *i = 0; -+ return 0; -+} -+ -+static int phytium_jpeg_set_input(struct file *file, void *priv, -+ unsigned int i) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ if (i != 0) { -+ dev_err(jpeg_dev->dev, "Failed to set input\n"); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int phytium_jpeg_get_parm(struct file *file, void *priv, -+ struct v4l2_streamparm *stream) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ /* Readbuffers num is 3 */ -+ stream->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; -+ stream->parm.capture.readbuffers = CAPTURE_BUF_NUMBER; -+ stream->parm.capture.timeperframe.denominator = 1; -+ -+ if (jpeg_dev->frame_rate == 0) -+ stream->parm.capture.timeperframe.denominator = MAX_FRAME_RATE; -+ else -+ stream->parm.capture.timeperframe.denominator = jpeg_dev->frame_rate; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_set_parm(struct file *file, void *priv, -+ struct v4l2_streamparm *stream) -+{ -+ unsigned int frame_rate = 0; -+ u32 rate_to_reg = 0; -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ /* Readbuffers num is 3 */ -+ stream->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; -+ stream->parm.capture.readbuffers = CAPTURE_BUF_NUMBER; -+ -+ if (stream->parm.capture.timeperframe.numerator) -+ frame_rate = stream->parm.capture.timeperframe.denominator / -+ stream->parm.capture.timeperframe.numerator; -+ -+ if (frame_rate == 0 || frame_rate > MAX_FRAME_RATE) { -+ frame_rate = MAX_FRAME_RATE; -+ stream->parm.capture.timeperframe.denominator = MAX_FRAME_RATE; -+ stream->parm.capture.timeperframe.numerator = 1; -+ } -+ /* -+ * reg_val = (1 second * 10^9 / frame_rate / 13.4) -+ * Linux driver prohibit float point operations. So use the -+ * format: reg_val = (1 second * 10^8 / frame_rate / 134 *100) -+ * write reg_val to register. then enable Highest bit31 = 1 -+ */ -+ if (jpeg_dev->frame_rate != frame_rate) { -+ jpeg_dev->frame_rate = frame_rate; -+ rate_to_reg = 100000000 / jpeg_dev->frame_rate / 134 * 100; -+ rate_to_reg |= FRAME_SAMPLE_CTRL_EN; -+ phytium_jpeg_write(jpeg_dev, FRAME_SAMPLE_CTRL, rate_to_reg); -+ } -+ -+ return 0; -+} -+ -+static int phytium_jpeg_enum_framesizes(struct file *file, void *priv, -+ struct v4l2_frmsizeenum *fsize) -+ -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ if (fsize->index != 0) { -+ dev_err(jpeg_dev->dev, "Failed to enum framesize.\n"); -+ return -EINVAL; -+ } -+ -+ if (fsize->pixel_format != V4L2_PIX_FMT_JPEG) { -+ dev_err(jpeg_dev->dev, "enum framesize pixel_format is not JPEG"); -+ return -EINVAL; -+ } -+ -+ fsize->discrete.width = jpeg_dev->pix_fmt.width; -+ fsize->discrete.height = jpeg_dev->pix_fmt.height; -+ fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; -+ -+ return 0; -+ -+} -+ -+static int phytium_jpeg_enum_frameintervals(struct file *file, void *priv, -+ struct v4l2_frmivalenum *fival) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ if (fival->index != 0) { -+ dev_err(jpeg_dev->dev, "enum frame intervals failed\n"); -+ return -EINVAL; -+ } -+ -+ if (fival->width != jpeg_dev->detected_timings.width || -+ fival->height != jpeg_dev->detected_timings.height) { -+ dev_err(jpeg_dev->dev, "interval isn't same with the detected_timings.\n"); -+ return -EINVAL; -+ } -+ -+ if (fival->pixel_format != V4L2_PIX_FMT_JPEG) { -+ dev_err(jpeg_dev->dev, "enum frame interval pixel fomat is incorrect.\n"); -+ return -EINVAL; -+ } -+ -+ fival->type = V4L2_FRMIVAL_TYPE_CONTINUOUS; -+ fival->stepwise.min.denominator = MAX_FRAME_RATE; -+ fival->stepwise.min.numerator = 1; -+ fival->stepwise.max.denominator = 1; -+ fival->stepwise.max.numerator = 1; -+ fival->stepwise.step = fival->stepwise.max; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_set_dv_timings(struct file *file, void *priv, -+ struct v4l2_dv_timings *timings) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ /* the params are passed from user space are same with hardware's params */ -+ if (timings->bt.width == jpeg_dev->active_timings.width && -+ timings->bt.height == jpeg_dev->active_timings.height) -+ return 0; -+ -+ if (vb2_is_busy(&jpeg_dev->queue)) { -+ dev_err(jpeg_dev->dev, "queue is busy during setting dv timings.\n"); -+ return -EBUSY; -+ } -+ -+ jpeg_dev->active_timings = timings->bt; -+ phytium_jpeg_set_resolution(jpeg_dev); -+ jpeg_dev->pix_fmt.width = timings->bt.width; -+ jpeg_dev->pix_fmt.height = timings->bt.height; -+ jpeg_dev->pix_fmt.sizeimage = jpeg_dev->max_compressed_size; -+ timings->type = V4L2_DV_BT_656_1120; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_get_dv_timings(struct file *file, void *priv, -+ struct v4l2_dv_timings *timings) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ timings->type = V4L2_DV_BT_656_1120; -+ timings->bt = jpeg_dev->active_timings; -+ -+ return 0; -+} -+ -+static int phytium_jpeg_query_dv_timings(struct file *file, void *priv, -+ struct v4l2_dv_timings *timings) -+{ -+ int ret; -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ /* -+ * This blocks only if the driver is currently in the process of -+ * detecting a new resolution; in the event of no signal or timeout -+ * this function is woken up. -+ */ -+ if ((file->f_flags & O_NONBLOCK) && -+ test_bit(VIDEO_RES_CHANGE, &jpeg_dev->status)) -+ return -EAGAIN; -+ -+ ret = wait_event_interruptible(jpeg_dev->wait, !test_bit(VIDEO_RES_CHANGE, -+ &jpeg_dev->status)); -+ if (ret) { -+ dev_err(jpeg_dev->dev, "Failed to query dv timing\n"); -+ return -EINTR; -+ } -+ -+ timings->type = V4L2_DV_BT_656_1120; -+ timings->bt = jpeg_dev->detected_timings; -+ -+ return jpeg_dev->v4l2_input_status ? -ENOLINK : 0; -+} -+ -+static const struct v4l2_dv_timings_cap phytium_jpeg_timings_cap = { -+ .type = V4L2_DV_BT_656_1120, -+ .bt = { -+ .min_width = MIN_WIDTH, -+ .max_width = MAX_WIDTH, -+ .min_height = MIN_HEIGHT, -+ .max_height = MAX_HEIGHT, -+ .min_pixelclock = 6574080, /* 640 x 480 x 24Hz */ -+ .max_pixelclock = 1244160000, /* 1920 x 1080 x 60Hz */ -+ .standards = V4L2_DV_BT_STD_CEA861 | V4L2_DV_BT_STD_DMT | -+ V4L2_DV_BT_STD_CVT | V4L2_DV_BT_STD_GTF, -+ .capabilities = V4L2_DV_BT_CAP_PROGRESSIVE | -+ V4L2_DV_BT_CAP_REDUCED_BLANKING | -+ V4L2_DV_BT_CAP_CUSTOM, -+ }, -+}; -+ -+static int phytium_jpeg_enum_dv_timings(struct file *file, void *priv, -+ struct v4l2_enum_dv_timings *timings) -+{ -+ return v4l2_enum_dv_timings_cap(timings, &phytium_jpeg_timings_cap, -+ NULL, NULL); -+} -+ -+static int phytium_jpeg_dv_timings_cap(struct file *file, void *priv, -+ struct v4l2_dv_timings_cap *cap) -+{ -+ *cap = phytium_jpeg_timings_cap; -+ -+ return 0; -+} -+ -+/* The function is used to notify DV that video resolution is altered */ -+static int phytium_jpeg_sub_event(struct v4l2_fh *fh, -+ const struct v4l2_event_subscription *sub) -+{ -+ switch (sub->type) { -+ case V4L2_EVENT_SOURCE_CHANGE: -+ return v4l2_src_change_event_subscribe(fh, sub); -+ default: -+ break; -+ } -+ -+ return v4l2_ctrl_subscribe_event(fh, sub); -+} -+ -+static const struct v4l2_ioctl_ops phytium_jpeg_ioctl_ops = { -+ .vidioc_querycap = phytium_jpeg_querycap, -+ .vidioc_enum_fmt_vid_cap = phytium_jpeg_enum_format, -+ .vidioc_g_fmt_vid_cap = phytium_jpeg_get_format, -+ .vidioc_s_fmt_vid_cap = phytium_jpeg_get_format, -+ .vidioc_try_fmt_vid_cap = phytium_jpeg_get_format, -+ .vidioc_reqbufs = vb2_ioctl_reqbufs, -+ .vidioc_querybuf = vb2_ioctl_querybuf, -+ .vidioc_qbuf = vb2_ioctl_qbuf, -+ .vidioc_expbuf = vb2_ioctl_expbuf, -+ .vidioc_dqbuf = vb2_ioctl_dqbuf, -+ .vidioc_create_bufs = vb2_ioctl_create_bufs, -+ .vidioc_prepare_buf = vb2_ioctl_prepare_buf, -+ .vidioc_streamon = vb2_ioctl_streamon, -+ .vidioc_streamoff = vb2_ioctl_streamoff, -+ .vidioc_enum_input = phytium_jpeg_enum_input, -+ .vidioc_g_input = phytium_jpeg_get_input, -+ .vidioc_s_input = phytium_jpeg_set_input, -+ .vidioc_g_parm = phytium_jpeg_get_parm, -+ .vidioc_s_parm = phytium_jpeg_set_parm, -+ .vidioc_enum_framesizes = phytium_jpeg_enum_framesizes, -+ .vidioc_enum_frameintervals = phytium_jpeg_enum_frameintervals, -+ .vidioc_s_dv_timings = phytium_jpeg_set_dv_timings, -+ .vidioc_g_dv_timings = phytium_jpeg_get_dv_timings, -+ .vidioc_query_dv_timings = phytium_jpeg_query_dv_timings, -+ .vidioc_enum_dv_timings = phytium_jpeg_enum_dv_timings, -+ .vidioc_dv_timings_cap = phytium_jpeg_dv_timings_cap, -+ .vidioc_subscribe_event = phytium_jpeg_sub_event, -+ .vidioc_unsubscribe_event = v4l2_event_unsubscribe, -+}; -+ -+static void phytium_jpeg_init_jpeg_quant(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ const u32 y_quant_table[QUANT_REG_NUM] = { -+ 0x08000000, 0x0ba2e8ba, 0x0aaaaaab, 0x09249249, 0x0aaaaaab, -+ 0x0ccccccc, 0x08000000, 0x09249249, 0x09d89d8a, 0x09249249, -+ 0x071c71c7, 0x07878788, 0x08000000, 0x06bca1af, 0x05555555, -+ 0x03333333, 0x04ec4ec5, 0x05555555, 0x05d1745d, 0x05d1745d, -+ 0x05555555, 0x029cbc15, 0x03a83a84, 0x03759f23, 0x0469ee58, -+ 0x03333333, 0x0234f72c, 0x02828283, 0x02192e2a, 0x02222222, -+ 0x023ee090, 0x02828283, 0x02492492, 0x0253c825, 0x02000000, -+ 0x01c71c72, 0x01642c86, 0x01a41a42, 0x02000000, 0x01e1e1e2, -+ 0x0178a4c8, 0x01dae607, 0x0253c825, 0x02492492, 0x0199999a, -+ 0x012c9fb5, 0x01948b10, 0x0178a4c8, 0x0158ed23, 0x014e5e0a, -+ 0x013e22cc, 0x013b13b1, 0x013e22cc, 0x02108421, 0x01a98ef6, -+ 0x0121fb78, 0x010ecf57, 0x01249249, 0x013e22cc, 0x01111111, -+ 0x01642c86, 0x01446f86, 0x013e22cc, 0x014afd6a -+ }; -+ -+ const u32 c_quant_table[QUANT_REG_NUM] = { -+ 0x07878788, 0x071c71c7, 0x071c71c7, 0x05555555, 0x06186186, -+ 0x05555555, 0x02b93105, 0x04ec4ec5, 0x04ec4ec5, 0x02b93105, -+ 0x014afd6a, 0x01f07c1f, 0x02492492, 0x01f07c1f, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, -+ 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a -+ }; -+ int i; -+ -+ for (i = 0; i < QUANT_REG_NUM; i++) { -+ phytium_jpeg_write(jpeg_dev, Y_QUANT_INDEX_ADDR_REG(i), y_quant_table[i]); -+ phytium_jpeg_write(jpeg_dev, C_QUANT_INDEX_ADDR_REG(i), c_quant_table[i]); -+ } -+ -+} -+ -+static void phytium_jpeg_start(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ phytium_jpeg_on(jpeg_dev); -+ phytium_jpeg_init_regs(jpeg_dev); -+ -+ /* Resolution set to 640x480 if no signal is found */ -+ phytium_jpeg_get_resolution(jpeg_dev); -+ -+ /* Set timings since the device is being opened for the first tiime */ -+ jpeg_dev->active_timings = jpeg_dev->detected_timings; -+ phytium_jpeg_set_resolution(jpeg_dev); -+ -+ jpeg_dev->pix_fmt.width = jpeg_dev->active_timings.width; -+ jpeg_dev->pix_fmt.height = jpeg_dev->active_timings.height; -+ jpeg_dev->pix_fmt.sizeimage = jpeg_dev->max_compressed_size; -+} -+ -+static void phytium_jpeg_stop(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ set_bit(VIDEO_STOPPED, &jpeg_dev->status); -+ cancel_delayed_work_sync(&jpeg_dev->res_work); -+ -+ phytium_jpeg_off(jpeg_dev); -+ -+ jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; -+ jpeg_dev->status = 0; -+} -+ -+static int phytium_jpeg_open(struct file *file) -+{ -+ int ret; -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ mutex_lock(&jpeg_dev->video_lock); -+ -+ ret = v4l2_fh_open(file); -+ if (ret != 0) { -+ mutex_unlock(&jpeg_dev->video_lock); -+ dev_err(jpeg_dev->dev, "Failed to open the phytium jpeg device.\n"); -+ return ret; -+ } -+ -+ if (v4l2_fh_is_singular_file(file)) -+ phytium_jpeg_start(jpeg_dev); -+ -+ mutex_unlock(&jpeg_dev->video_lock); -+ -+ return 0; -+} -+ -+static int phytium_jpeg_release(struct file *file) -+{ -+ int ret; -+ struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); -+ -+ mutex_lock(&jpeg_dev->video_lock); -+ -+ if (v4l2_fh_is_singular_file(file)) -+ phytium_jpeg_stop(jpeg_dev); -+ -+ ret = _vb2_fop_release(file, NULL); -+ mutex_unlock(&jpeg_dev->video_lock); -+ -+ return ret; -+} -+ -+ -+static const struct v4l2_file_operations phytium_jpeg_fops = { -+ .owner = THIS_MODULE, -+ .read = vb2_fop_read, -+ .poll = vb2_fop_poll, -+ .unlocked_ioctl = video_ioctl2, -+ .mmap = vb2_fop_mmap, -+ .open = phytium_jpeg_open, -+ .release = phytium_jpeg_release, -+}; -+ -+static void phytium_jpeg_update_jpeg_header(u32 width, u32 height) -+{ -+ const int h_index = PHYTIUM_JPEG_HEADER_H_INDEX; -+ const int w_index = PHYTIUM_JPEG_HEADER_W_INDEX; -+ -+ /* the high 8 bits of the height locates at bit24~bit31 */ -+ phytium_jpeg_header[h_index] = phytium_jpeg_header[h_index] & 0x00FFFFFF; -+ phytium_jpeg_header[h_index] |= ((height >> 8) & 0xFF) << 24; -+ -+ /* the low 8 bits of the height locates at bit0~bit7 */ -+ phytium_jpeg_header[w_index] = phytium_jpeg_header[w_index] & 0xFF000000; -+ phytium_jpeg_header[w_index] |= height & 0xFF; -+ -+ /* the high 8 bits of the width locates at bit8~bit15 */ -+ phytium_jpeg_header[w_index] |= ((width >> 8) & 0xFF) << 8; -+ /* the low 8 bits of the width locates at bit16~bit24 */ -+ phytium_jpeg_header[w_index] |= (width & 0xFF) << 16; -+} -+ -+static void phytium_jpeg_fill_header(struct phytium_jpeg_dev *jpeg_dev, -+ struct phytium_jpeg_buffer *jpeg_buf) -+{ -+ void *vbuf = vb2_plane_vaddr(&jpeg_buf->vb.vb2_buf, 0); -+ u32 width = jpeg_dev->active_timings.width; -+ u32 height = jpeg_dev->active_timings.height; -+ -+ /* update the contents of the phytium jpeg header according to the resolution */ -+ phytium_jpeg_update_jpeg_header(width, height); -+ -+ /* replenish the contents of the JPEG header */ -+ memcpy(vbuf, phytium_jpeg_header, PHYTIUM_JPEG_HEADER_LEN); -+} -+ -+static int phytium_jpeg_start_frame(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ dma_addr_t dst_addr; -+ unsigned long status; -+ struct phytium_jpeg_buffer *jpeg_buf; -+ -+ if (jpeg_dev->v4l2_input_status) { -+ dev_err(jpeg_dev->dev, "No signal; needn't start frame\n"); -+ return 0; -+ } -+ -+ spin_lock_irqsave(&jpeg_dev->hw_lock, status); -+ jpeg_buf = list_first_entry_or_null(&jpeg_dev->buffers, -+ struct phytium_jpeg_buffer, link); -+ if (jpeg_buf == NULL) { -+ spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); -+ dev_err(jpeg_dev->dev, "No buffers; doesn't start frame\n"); -+ return -EPROTO; -+ } -+ -+ set_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); -+ dst_addr = vb2_dma_contig_plane_dma_addr(&jpeg_buf->vb.vb2_buf, 0); -+ spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); -+ -+ /* -+ * Because the JPEG Engine is unable to add a JPEG header, the phytium -+ * jpeg driver is required to fill the contents of a JPEG header before -+ * the jpeg engine write datas to the dma address. -+ */ -+ phytium_jpeg_fill_header(jpeg_dev, jpeg_buf); -+ dst_addr += PHYTIUM_JPEG_HEADER_LEN; -+ /* -+ * The ikvm application only using the last frame, so the driver replenish -+ * one output register with a dma address. -+ */ -+ dst_addr >>= JPEG_DST_ADDR_SHIFT; -+ phytium_jpeg_write(jpeg_dev, BUF_LIST_INDEX_ADDR(VB_BUF_NO), dst_addr); -+ /* Enable the validilty of the buffer marked with index */ -+ phytium_jpeg_write(jpeg_dev, BUF_LIST_INDEX_CTRL_STS_ADDR(VB_BUF_NO), -+ STS_JPEG_BUF_HIGH_LEVEL_VALID); -+ /* Enable the interruption which is used to identify an image was compressed */ -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, STS_VE_JPEG_CODE_COMP_EN); -+ /* Enable JPEG, start to capture and compress */ -+ phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 1); -+ -+ return 0; -+} -+ -+static void phytium_jpeg_resolution_work(struct work_struct *work) -+{ -+ struct delayed_work *dwork = to_delayed_work(work); -+ struct phytium_jpeg_dev *jpeg_dev = container_of(dwork, -+ struct phytium_jpeg_dev, res_work); -+ u32 input_status = jpeg_dev->v4l2_input_status; -+ -+ phytium_jpeg_on(jpeg_dev); -+ -+ /* Exit early in the case no clients remain */ -+ if (test_bit(VIDEO_STOPPED, &jpeg_dev->status)) -+ goto done; -+ -+ phytium_jpeg_init_regs(jpeg_dev); -+ phytium_jpeg_get_resolution(jpeg_dev); -+ -+ /* if source's resolution is changed, the event should be enqueued */ -+ if (jpeg_dev->detected_timings.width != jpeg_dev->active_timings.width || -+ jpeg_dev->detected_timings.height != jpeg_dev->active_timings.height || -+ input_status != jpeg_dev->v4l2_input_status) { -+ -+ static const struct v4l2_event event = { -+ .type = V4L2_EVENT_SOURCE_CHANGE, -+ .u.src_change.changes = V4L2_EVENT_SRC_CH_RESOLUTION, -+ }; -+ v4l2_event_queue(&jpeg_dev->vdev, &event); -+ clear_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); -+ dev_info(jpeg_dev->dev, "event notifies changing resolution\n"); -+ } else if (test_bit(VIDEO_STREAMING, &jpeg_dev->status)) { -+ /* No resolution change so just restart streaming */ -+ dev_info(jpeg_dev->dev, "resolution doesn't change\n"); -+ phytium_jpeg_set_resolution(jpeg_dev); -+ phytium_jpeg_start_frame(jpeg_dev); -+ } -+ -+done: -+ clear_bit(VIDEO_RES_CHANGE, &jpeg_dev->status); -+ wake_up_interruptible_all(&jpeg_dev->wait); -+} -+ -+static int phytium_jpeg_queue_setup(struct vb2_queue *q, -+ unsigned int *num_buffers, -+ unsigned int *num_planes, -+ unsigned int sizes[], -+ struct device *alloc_devs[]) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); -+ -+ if (*num_planes) { -+ if (sizes[0] < jpeg_dev->max_compressed_size) { -+ v4l2_err(&jpeg_dev->v4l2_dev, "queue v4l2_buf's size is invalid\n"); -+ return -EINVAL; -+ } -+ } -+ -+ *num_planes = 1; -+ sizes[0] = jpeg_dev->max_compressed_size; -+ return 0; -+} -+ -+static int phytium_jpeg_buf_prepare(struct vb2_buffer *vb) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(vb->vb2_queue); -+ -+ if (vb2_plane_size(vb, 0) < jpeg_dev->max_compressed_size) { -+ v4l2_err(&jpeg_dev->v4l2_dev, "failed to prepare buffer\n"); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static inline struct phytium_jpeg_buffer * -+phytium_vb2buf_to_dstbuf(struct vb2_v4l2_buffer *buf) -+{ -+ return container_of(buf, struct phytium_jpeg_buffer, vb); -+} -+ -+static void phytium_jpeg_buf_queue(struct vb2_buffer *vb) -+{ -+ bool empty; -+ struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(vb->vb2_queue); -+ struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); -+ struct phytium_jpeg_buffer *jpeg_buf = phytium_vb2buf_to_dstbuf(vbuf); -+ unsigned long status; -+ -+ spin_lock_irqsave(&jpeg_dev->hw_lock, status); -+ empty = list_empty(&jpeg_dev->buffers); -+ list_add_tail(&jpeg_buf->link, &jpeg_dev->buffers); -+ spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); -+ -+ /* the empty ensures the address of the first node's vb2_v4l2_buf -+ * in the list is written to output register -+ */ -+ if (test_bit(VIDEO_STREAMING, &jpeg_dev->status) && -+ (!test_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status)) && -+ empty) -+ phytium_jpeg_start_frame(jpeg_dev); -+} -+ -+static void phytium_jpeg_bufs_done(struct phytium_jpeg_dev *jpeg_dev, -+ enum vb2_buffer_state state) -+{ -+ unsigned long flags; -+ struct phytium_jpeg_buffer *buf; -+ -+ spin_lock_irqsave(&jpeg_dev->hw_lock, flags); -+ -+ list_for_each_entry(buf, &jpeg_dev->buffers, link) -+ vb2_buffer_done(&buf->vb.vb2_buf, state); -+ -+ INIT_LIST_HEAD(&jpeg_dev->buffers); -+ -+ spin_unlock_irqrestore(&jpeg_dev->hw_lock, flags); -+} -+ -+static void phytium_jpeg_irq_res_change(struct phytium_jpeg_dev *jpeg_dev, -+ ulong delay) -+{ -+ dev_info(jpeg_dev->dev, "Source resolution is changed, resetting\n"); -+ -+ phytium_jpeg_off(jpeg_dev); -+ -+ schedule_delayed_work(&jpeg_dev->res_work, delay); -+} -+ -+static irqreturn_t phytium_jpeg_irq(int irq, void *arg) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = arg; -+ u32 status; -+ struct phytium_jpeg_buffer *buf; -+ u32 frame_size; -+ -+ if (test_bit(VIDEO_POWEROFF, &jpeg_dev->status)) { -+ dev_info(jpeg_dev->dev, "jpeg engine is requested to poweroff\n"); -+ return IRQ_HANDLED; -+ } -+ -+ status = phytium_jpeg_read(jpeg_dev, INT_STATUS_CTRL_REG); -+ -+ if (status & INT_VIDEO_FORMAT_CHANGE) { -+ dev_info(jpeg_dev->dev, "receive resolution changed interrupt\n"); -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, -+ DETECT_RESOLUTION_CHANGE_EN, 0); -+ phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, INT_VIDEO_FORMAT_CHANGE); -+ phytium_jpeg_irq_res_change(jpeg_dev, RESOLUTION_CHANGE_DELAY); -+ return IRQ_HANDLED; -+ } -+ -+ /* -+ * JPEG engine finish compressing a image JPEG encoding to trigger -+ * a interruption. the status identifies the buffer number. Currently, -+ * the driver uses one buffer. -+ * -+ * Note: Because the JPEG doesn't support adding a JPEG header, and -+ * driver is also unable to add a JPEG header to vb2_buffers. One -+ * solution is that a JPEG header is added by an application. -+ */ -+ if (status & INT_JPEG_COMP_BUF_LIST_NO) { -+ frame_size = phytium_jpeg_read(jpeg_dev, jpeg_dev->comp_size_read); -+ frame_size &= JPEG_BUF_CAPACITY_SIZE; -+ frame_size >>= JPEG_BUF_CAPACITY_SIZE_SHIFT; -+ spin_lock(&jpeg_dev->hw_lock); -+ clear_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); -+ /* Delete first node from the queue */ -+ buf = list_first_entry_or_null(&jpeg_dev->buffers, -+ struct phytium_jpeg_buffer, link); -+ if (buf != NULL) { -+ frame_size += PHYTIUM_JPEG_HEADER_LEN; -+ vb2_set_plane_payload(&buf->vb.vb2_buf, 0, frame_size); -+ if (!list_is_last(&buf->link, &jpeg_dev->buffers)) { -+ buf->vb.vb2_buf.timestamp = ktime_get_ns(); -+ buf->vb.sequence = jpeg_dev->sequence++; -+ buf->vb.field = V4L2_FIELD_NONE; -+ vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE); -+ list_del(&buf->link); -+ } -+ } -+ -+ spin_unlock(&jpeg_dev->hw_lock); -+ /* Disable JPEG engine */ -+ phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 0); -+ /* Disable interruption */ -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, STS_VE_JPEG_CODE_COMP_EN, 0); -+ /* clear all interruption of the hardware's buffers */ -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, INT_JPEG_ENCODE_COMPLETE, 1); -+ -+ status &= ~INT_JPEG_COMP_BUF_LIST_NO; -+ if (test_bit(VIDEO_STREAMING, &jpeg_dev->status) && buf) -+ phytium_jpeg_start_frame(jpeg_dev); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+/* VIDIOC_STREAMON, all vb2_v4l2_buf' states are queue */ -+static int phytium_jpeg_start_streaming(struct vb2_queue *q, unsigned int count) -+{ -+ int ret; -+ struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); -+ -+ jpeg_dev->sequence = 0; -+ ret = phytium_jpeg_start_frame(jpeg_dev); -+ if (ret != 0) { -+ phytium_jpeg_bufs_done(jpeg_dev, VB2_BUF_STATE_QUEUED); -+ return ret; -+ } -+ -+ /* set the states of the jpeg engine */ -+ set_bit(VIDEO_STREAMING, &jpeg_dev->status); -+ return ret; -+} -+ -+static void phytium_jpeg_stop_streaming(struct vb2_queue *q) -+{ -+ int ret; -+ struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); -+ -+ clear_bit(VIDEO_STREAMING, &jpeg_dev->status); -+ ret = wait_event_timeout(jpeg_dev->wait, -+ !test_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status), -+ STOP_TIMEOUT); -+ -+ /* time out */ -+ if (ret == 0) { -+ dev_err(jpeg_dev->dev, "Timed out when stopping streaming.\n"); -+ /* -+ * Need to force stop any DMA and try and get HW into a good states -+ * for future calls to start streaming again. -+ */ -+ phytium_jpeg_off(jpeg_dev); -+ phytium_jpeg_on(jpeg_dev); -+ phytium_jpeg_init_regs(jpeg_dev); -+ phytium_jpeg_get_resolution(jpeg_dev); -+ } -+ /* first stop jpeg, wait, the free buffer */ -+ phytium_jpeg_bufs_done(jpeg_dev, VB2_BUF_STATE_ERROR); -+} -+ -+static const struct vb2_ops phytium_jpeg_vb2_ops = { -+ .queue_setup = phytium_jpeg_queue_setup, -+ .wait_prepare = vb2_ops_wait_prepare, -+ .wait_finish = vb2_ops_wait_finish, -+ .buf_prepare = phytium_jpeg_buf_prepare, -+ .buf_queue = phytium_jpeg_buf_queue, -+ .start_streaming = phytium_jpeg_start_streaming, -+ .stop_streaming = phytium_jpeg_stop_streaming, -+}; -+ -+static void phytium_jpeg_set_yuv_mode(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ const char *mode = yuv_mode_str; -+ enum jpeg_yuv_mode yuv_mode; -+ -+ if (strstr(mode, "yuv422") != NULL) -+ yuv_mode = YUV422; -+ else if (strstr(mode, "yuv420") != NULL) -+ yuv_mode = YUV420; -+ else -+ yuv_mode = YUV444; -+ -+ /* set the yuv mode register */ -+ phytium_jpeg_write(jpeg_dev, SAMPLE_MODE_REG, yuv_mode); -+ -+ /* update the field which indicates YUV mode locates in the JPEG header. */ -+ phytium_jpeg_header[YUVID] &= 0xFFFF00FF; -+ if (yuv_mode == YUV422) -+ phytium_jpeg_header[YUVID] |= 0x2100; -+ else if (yuv_mode == YUV420) -+ phytium_jpeg_header[YUVID] |= 0x2200; -+ else -+ phytium_jpeg_header[YUVID] |= 0x1100; -+ -+} -+ -+static irqreturn_t phytium_jpeg_timer31_irq(int irq, void *arg) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = arg; -+ -+ /* disable timer interrupt */ -+ writel(0, jpeg_dev->timer31_addr); -+ -+ /* clear timer interrupt status */ -+ writel(0x8, jpeg_dev->timer31_addr + 0x2c); -+ -+ /* clear JPEG Engine's poweroff status */ -+ clear_bit(VIDEO_POWEROFF, &jpeg_dev->status); -+ dev_info(jpeg_dev->dev, "timer31 set jpeg status 0x%lx\n", jpeg_dev->status); -+ -+ /* JPEG Engine is poweron, reconfig quntization table and YUV mode */ -+ phytium_jpeg_init_jpeg_quant(jpeg_dev); -+ phytium_jpeg_set_yuv_mode(jpeg_dev); -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, DETECT_RESOLUTION_CHANGE_EN); -+ phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, 0, TRANSINFO_SRC_SELECT); -+ -+ dev_info(jpeg_dev->dev, "reconfigure quant table and yuv mode\n"); -+ -+ return IRQ_HANDLED; -+} -+ -+static int phytium_jpeg_parser_timer31_irq(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ int irq; -+ int ret; -+ struct device *dev = jpeg_dev->dev; -+ -+ irq = irq_of_parse_and_map(dev->of_node, 2); -+ if (!irq) { -+ dev_err(dev, "Failed to get timer31 IRQ\n"); -+ return -ENODEV; -+ } -+ -+ ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_timer31_irq, -+ IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); -+ if (ret < 0) -+ dev_err(dev, "Failed to request timer31 IRQ %d\n", irq); -+ -+ return ret; -+} -+ -+static irqreturn_t phytium_jpeg_timer30_irq(int irq, void *arg) -+{ -+ struct phytium_jpeg_dev *jpeg_dev = arg; -+ struct arm_smccc_res res; -+ -+ /* disable timer interrupt */ -+ writel(0, jpeg_dev->timer30_addr); -+ /* clear timer interrupt status */ -+ writel(0x8, jpeg_dev->timer30_addr + 0x2c); -+ -+ /* Disable interruption */ -+ phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, STS_VE_JPEG_CODE_COMP_EN, 0); -+ -+ /* call SE to poweroff JPEG Engine */ -+ arm_smccc_smc(0xc300fff4, 0x9, 0x2, 0x80000020, 0, 0, 0, 0, &res); -+ -+ set_bit(VIDEO_RES_CHANGE, &jpeg_dev->status); -+ /* set JPEG Engine's status is poweroff */ -+ set_bit(VIDEO_POWEROFF, &jpeg_dev->status); -+ dev_info(jpeg_dev->dev, "timer30 set jpeg status 0x%lx\n", jpeg_dev->status); -+ -+ return IRQ_HANDLED; -+} -+ -+static int phytium_jpeg_parser_timer30_irq(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ int irq; -+ int ret; -+ struct device *dev = jpeg_dev->dev; -+ -+ irq = irq_of_parse_and_map(dev->of_node, 1); -+ if (!irq) { -+ dev_err(dev, "Failed to get timer30 IRQ\n"); -+ return -ENODEV; -+ } -+ -+ ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_timer30_irq, -+ IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); -+ if (ret < 0) -+ dev_err(dev, "Failed to request timer30 IRQ %d\n", irq); -+ -+ return ret; -+} -+ -+static int phytium_jpeg_init(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ int irq; -+ int ret; -+ struct device *dev = jpeg_dev->dev; -+ u32 ocm_buf_addr[OCM_BUF_NUM]; -+ int i; -+ -+ irq = irq_of_parse_and_map(dev->of_node, 0); -+ if (!irq) { -+ dev_err(dev, "Failed to get IRQ\n"); -+ return -ENODEV; -+ } -+ -+ ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_irq, -+ IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); -+ if (ret < 0) { -+ dev_err(dev, "Failed to request IRQ %d\n", irq); -+ return ret; -+ } -+ -+ ret = phytium_jpeg_parser_timer30_irq(jpeg_dev); -+ if (ret < 0) -+ return ret; -+ -+ ret = phytium_jpeg_parser_timer31_irq(jpeg_dev); -+ if (ret < 0) -+ return ret; -+ -+ ret = of_property_read_u32_array(dev->of_node, "phytium,ocm-buf-addr", -+ ocm_buf_addr, OCM_BUF_NUM); -+ if (ret != 0) { -+ dev_err(dev, "Failed to get the OCM address from device tree node.\n"); -+ return ret; -+ } -+ -+ for (i = 0; i < OCM_BUF_NUM; i++) -+ jpeg_dev->src_addrs[i].dma_addr = ocm_buf_addr[i]; -+ -+ /* CMA memory for JPEG device */ -+ of_reserved_mem_device_init(dev); -+ ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(32)); -+ if (ret != 0) { -+ dev_err(dev, "Failed to set DMA mask\n"); -+ return ret; -+ } -+ -+ /* Initializing JPEG Y and CbCr quantization table */ -+ phytium_jpeg_init_jpeg_quant(jpeg_dev); -+ -+ /* Select YUV mode */ -+ phytium_jpeg_set_yuv_mode(jpeg_dev); -+ dev_info(dev, "successfully initialize jpeg engine\n"); -+ return 0; -+ -+} -+ -+ -+static int phytium_jpeg_setup_video(struct phytium_jpeg_dev *jpeg_dev) -+{ -+ struct v4l2_device *v4l2_dev = &jpeg_dev->v4l2_dev; -+ struct vb2_queue *dst_vq = &jpeg_dev->queue; -+ struct video_device *vdev = &jpeg_dev->vdev; -+ int ret; -+ -+ jpeg_dev->pix_fmt.pixelformat = V4L2_PIX_FMT_JPEG; -+ jpeg_dev->pix_fmt.field = V4L2_FIELD_NONE; -+ jpeg_dev->pix_fmt.colorspace = V4L2_COLORSPACE_SRGB; /* maybe ARGB */ -+ jpeg_dev->pix_fmt.quantization = V4L2_QUANTIZATION_FULL_RANGE; -+ jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; -+ -+ ret = v4l2_device_register(jpeg_dev->dev, v4l2_dev); -+ if (ret != 0) { -+ dev_err(jpeg_dev->dev, "Failed to register v4l2 device\n"); -+ return ret; -+ } -+ -+ /* Register how many v4l2 controls to a handler */ -+ dst_vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; -+ dst_vq->io_modes = VB2_MMAP | VB2_READ | VB2_DMABUF; -+ dst_vq->dev = v4l2_dev->dev; -+ dst_vq->lock = &jpeg_dev->video_lock; -+ dst_vq->ops = &phytium_jpeg_vb2_ops; -+ dst_vq->mem_ops = &vb2_dma_contig_memops; -+ dst_vq->drv_priv = jpeg_dev; -+ dst_vq->buf_struct_size = sizeof(struct phytium_jpeg_buffer); -+ dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; -+ dst_vq->min_buffers_needed = CAPTURE_BUF_NUMBER; -+ ret = vb2_queue_init(dst_vq); -+ if (ret) { -+ dev_err(jpeg_dev->dev, "Failed to init vb2 queue\n"); -+ goto err_v4l2_register; -+ } -+ -+ vdev->queue = dst_vq; -+ vdev->fops = &phytium_jpeg_fops; -+ vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE | -+ V4L2_CAP_STREAMING; -+ vdev->v4l2_dev = v4l2_dev; -+ strscpy(vdev->name, PHYTIUM_JPEG_NAME, sizeof(vdev->name)); -+ vdev->vfl_type = VFL_TYPE_VIDEO; -+ vdev->vfl_dir = VFL_DIR_RX; -+ vdev->release = video_device_release_empty; -+ vdev->ioctl_ops = &phytium_jpeg_ioctl_ops; -+ vdev->lock = &jpeg_dev->video_lock; -+ -+ video_set_drvdata(vdev, jpeg_dev); -+ ret = video_register_device(vdev, VFL_TYPE_VIDEO, 0); -+ if (ret != 0) { -+ dev_err(jpeg_dev->dev, "Failed to register video device\n"); -+ goto err_video_register; -+ } -+ -+ v4l2_info(v4l2_dev, "phytium JPEG registered as /dev/video%d (%d, %d)\n", -+ jpeg_dev->vdev.num, VIDEO_MAJOR, jpeg_dev->vdev.minor); -+ return ret; -+ -+err_video_register: -+ vb2_queue_release(dst_vq); -+ -+err_v4l2_register: -+ v4l2_device_unregister(v4l2_dev); -+ return ret; -+} -+ -+static const struct phytium_jpeg_config phytium_jpeg_config = { -+ .comp_size_read = BUF_LIST_INDEX_CTRL_STS_ADDR(VB_BUF_NO), -+}; -+ -+static const struct of_device_id phytium_jpeg_match[] = { -+ { -+ .compatible = "phytium,jpeg", -+ .data = &phytium_jpeg_config, -+ }, -+ {}, -+}; -+ -+MODULE_DEVICE_TABLE(of, phytium_jpeg_match); -+ -+static int phytium_jpeg_probe(struct platform_device *pdev) -+{ -+ struct phytium_jpeg_dev *jpeg_dev; -+ const struct of_device_id *match; -+ const struct phytium_jpeg_config *config; -+ struct resource *res; -+ int ret; -+ -+ jpeg_dev = devm_kzalloc(&pdev->dev, sizeof(*jpeg_dev), GFP_KERNEL); -+ if (jpeg_dev == NULL) -+ return -ENOMEM; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ jpeg_dev->base_addr = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(jpeg_dev->base_addr)) { -+ dev_err(jpeg_dev->dev, "Failed to ioremap.\n"); -+ return PTR_ERR(jpeg_dev->base_addr); -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ jpeg_dev->timer30_addr = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(jpeg_dev->base_addr)) { -+ dev_err(jpeg_dev->dev, "Failed to parse timer30.\n"); -+ return PTR_ERR(jpeg_dev->timer30_addr); -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 2); -+ jpeg_dev->timer31_addr = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(jpeg_dev->base_addr)) { -+ dev_err(jpeg_dev->dev, "Failed to parse timer30.\n"); -+ return PTR_ERR(jpeg_dev->timer31_addr); -+ } -+ match = of_match_node(phytium_jpeg_match, pdev->dev.of_node); -+ if (match == NULL) { -+ dev_err(jpeg_dev->dev, "Failed to match.\n"); -+ return -EINVAL; -+ } -+ -+ config = match->data; -+ jpeg_dev->comp_size_read = config->comp_size_read; -+ -+ jpeg_dev->frame_rate = 30; -+ jpeg_dev->dev = &pdev->dev; -+ spin_lock_init(&jpeg_dev->hw_lock); -+ mutex_init(&jpeg_dev->video_lock); -+ init_waitqueue_head(&jpeg_dev->wait); -+ INIT_DELAYED_WORK(&jpeg_dev->res_work, phytium_jpeg_resolution_work); -+ INIT_LIST_HEAD(&jpeg_dev->buffers); -+ -+ ret = phytium_jpeg_init(jpeg_dev); -+ if (ret != 0) { -+ dev_err(jpeg_dev->dev, "Failed to initialize the JPEG engine.\n"); -+ return ret; -+ } -+ -+ ret = phytium_jpeg_setup_video(jpeg_dev); -+ -+ return ret; -+} -+ -+#define to_phytium_jpeg(x) container_of((x), struct phytium_jpeg_dev, v4l2_dev) -+static int phytium_jpeg_remove(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct v4l2_device *v4l2_dev = dev_get_drvdata(dev); -+ struct phytium_jpeg_dev *jpeg_dev = to_phytium_jpeg(v4l2_dev); -+ -+ phytium_jpeg_off(jpeg_dev); -+ -+ video_unregister_device(&jpeg_dev->vdev); -+ -+ vb2_queue_release(&jpeg_dev->queue); -+ -+ v4l2_device_unregister(v4l2_dev); -+ -+ of_reserved_mem_device_release(dev); -+ -+ return 0; -+} -+ -+static struct platform_driver phytium_jpeg_driver = { -+ .probe = phytium_jpeg_probe, -+ .remove = phytium_jpeg_remove, -+ .driver = { -+ .name = PHYTIUM_JPEG_NAME, -+ .of_match_table = phytium_jpeg_match, -+ }, -+}; -+ -+module_platform_driver(phytium_jpeg_driver); -+ -+MODULE_DESCRIPTION("Phytium JPEG Encoder driver"); -+MODULE_AUTHOR("Wang Min "); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/media/platform/phytium/phytium_jpeg_core.h b/drivers/media/platform/phytium/phytium_jpeg_core.h -new file mode 100644 -index 000000000..27e32b2d3 ---- /dev/null -+++ b/drivers/media/platform/phytium/phytium_jpeg_core.h -@@ -0,0 +1,147 @@ -+/* SPDX-License-Identifier: GPL-2.0-or-later */ -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _PHYTIUM_JPEG_CORE_H -+#define _PHYTIUM_JPEG_CORE_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 -+ -+#define PHYTIUM_JPEG_NAME "phytium-jpeg" -+#define MAX_FRAME_RATE 60 -+#define MAX_HEIGHT 1080 -+#define MAX_WIDTH 1920 -+#define MIN_HEIGHT 480 -+#define MIN_WIDTH 640 -+#define MIN_PIXEL_CLOCK (640 * 480 * 60) /* 640 x 480 x 60Hz */ -+#define MAX_PIXEL_CLOCK (1920 * 1080 * 60) /* 1920 x 1080 x 60Hz */ -+ -+#define SOURCE_RESOLUTION_DETECT_TIMEOUT msecs_to_jiffies(500) -+#define RESOLUTION_CHANGE_DELAY msecs_to_jiffies(0) -+#define INVALID_RESOLUTION_DELAY msecs_to_jiffies(250) -+#define STOP_TIMEOUT msecs_to_jiffies(1000) -+ -+#define INVALID_RESOLUTION_RETRIES 2 -+#define CAPTURE_BUF_NUMBER 3 /* using how many buffers */ -+#define VB_BUF_NO 0 /* there are 16 buffer, use which one */ -+ -+/* The below macros are defined for the JPEG header of the phytium JPEG Engine */ -+#define PHYTIUM_JPEG_HEADER_LEN (256 * 3) -+#define PHYTIUM_JPEG_HEADER_SIZE (PHYTIUM_JPEG_HEADER_LEN / sizeof(u32)) -+#define PHYTIUM_JPEG_HEADER_H_INDEX 40 -+#define PHYTIUM_JPEG_HEADER_W_INDEX 41 -+ -+/* There are two ocm buffers that are used for storaging the inputing video data */ -+#define OCM_BUF_NUM 2 -+ -+enum phytium_jpeg_status { -+ VIDEO_MODE_DETECT_DONE, -+ VIDEO_RES_CHANGE, -+ VIDEO_RES_DETECT, -+ VIDEO_STREAMING, -+ VIDEO_FRAME_INPRG, -+ VIDEO_STOPPED, -+ VIDEO_CLOCKS_ON, -+ VIDEO_POWEROFF, -+}; -+ -+struct phytium_jpeg_addr { -+ unsigned int size; -+ dma_addr_t dma_addr; -+ void *virt_addr; -+}; -+ -+struct phytium_jpeg_buffer { -+ struct vb2_v4l2_buffer vb; -+ struct list_head link; -+}; -+ -+/** -+ * struct phytium_jpeg - JPEG IP abstraction -+ * @lock: the mutex protecting this structure -+ * @hw_lock: spinlock protecting the hw device resource -+ * @workqueue: decode work queue -+ * @dev: JPEG device -+ * @v4l2_dev: v4l2 device for mem2mem mode -+ * @m2m_dev: v4l2 mem2mem device data -+ * @alloc_ctx: videobuf2 memory allocator's context -+ * @dec_vdev: video device node for decoder mem2mem mode -+ * @dec_reg_base: JPEG registers mapping -+ * @clk_jdec: JPEG hw working clock -+ * @clk_jdec_smi: JPEG SMI bus clock -+ * @larb: SMI device -+ */ -+struct phytium_jpeg_dev { -+ void __iomem *base_addr; -+ struct device *dev; -+ struct v4l2_device v4l2_dev; -+ struct v4l2_pix_format pix_fmt; -+ struct v4l2_bt_timings active_timings; -+ struct v4l2_bt_timings detected_timings; -+ u32 v4l2_input_status; -+ struct vb2_queue queue; -+ struct video_device vdev; -+ /* v4l2 and videobuf2 lock, protect the structure*/ -+ struct mutex video_lock; -+ u32 jpeg_mode; -+ u32 comp_size_read; -+ wait_queue_head_t wait; -+ /* buffer list lock, protecting the hw device resource */ -+ spinlock_t hw_lock; -+ struct delayed_work res_work; -+ struct list_head buffers; -+ unsigned long status; -+ unsigned int sequence; -+ unsigned int max_compressed_size; -+ struct phytium_jpeg_addr src_addrs[OCM_BUF_NUM]; -+ struct phytium_jpeg_addr dst_addrs[16]; -+ -+ bool yuv420; -+ unsigned int frame_rate; -+ void __iomem *timer30_addr; -+ void __iomem *timer31_addr; -+}; -+ -+struct phytium_jpeg_config { -+ u32 jpeg_mode; -+ u32 comp_size_read; -+}; -+ -+#define YUV_MODE_STR_LEN 8 -+#define YUVID 42 -+ -+enum jpeg_yuv_mode { -+ YUV444 = 0x0, -+ YUV422 = 0x1, -+ YUV420 = 0x2 -+}; -+ -+#endif /* _PHYTIUM_JPEG_CORE_H */ -diff --git a/drivers/media/platform/phytium/phytium_jpeg_reg.h b/drivers/media/platform/phytium/phytium_jpeg_reg.h -new file mode 100644 -index 000000000..b0a27e2b7 ---- /dev/null -+++ b/drivers/media/platform/phytium/phytium_jpeg_reg.h -@@ -0,0 +1,113 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _PHYTIUM_JPEG_REG_H -+#define _PHYTIUM_JPEG_REG_H -+ -+#include -+/* define the all kinds of control registers in a JPEG soc */ -+ -+/* The register is used to set the information of the video comes from main memory */ -+#define SRC_DDR_INFO_REG 0x00000800 -+ -+/* The register is used to get the information of the video comes from external VGA */ -+#define SRC_VGA_INFO_REG 0x00000894 -+ -+#define SRC_FORMAT BIT(0) /* 0:RGB888, 1:RGB565 */ -+#define SRC_DE_POLARITY BIT(1) /* 0:low level is effect, other */ -+#define SRC_HS_POLARITY BIT(2) /* 0:low level is effect, other */ -+#define SRC_VS_POLARITY BIT(3) /* 0:low level is effect, other */ -+#define SRC_HOR_PIXELS GENMASK(15, 4) /* the number of the horizontal pixels */ -+#define SRC_WIDTH_SHIFT 4 /* shift right to get width */ -+#define SRC_VER_PIXELS GENMASK(26, 16) /* the number of the vertical pixels */ -+#define SRC_HEIGHT_SHIFT 16 /* shift right to get height */ -+/* The below bit fields is only used by image comes from main memory */ -+#define SRC_COMP_DDR_IMG_EN BIT(27) /* 0: disable to JPEG compression, others */ -+ -+/* marks which ocm buffer is occupied to store an image */ -+#define SRC_DDR_IMG2OCM_VALID GENMASK(29, 28) -+ -+/* The register controls starting work of the JPEG engine */ -+#define TRANSFORM_INFO_REG 0x00000804 -+#define TRANSINFO_ENABLE_ENGINE BIT(0) /* 1: enable the JPEG engine */ -+/* 1: video comes from external VGA, 0: video comes from DDR */ -+#define TRANSINFO_SRC_SELECT BIT(1) -+/* 0: video comes from external VGA is cached to OCM, 1: DDR */ -+#define TRANSINFO_IMAGE_STORE BIT(2) -+#define TRANSINFO_FRAME_RATE GENMASK(9, 4) /* the value notes frame rate */ -+#define TRANSINFO_BLOCK_SIZE BIT(12) /* 0: 8x8, 1: 16x16 */ -+#define TRANSINFO_ENABLE_YUV422 BIT(13) /* 1: JPEG block is populated YUV422 */ -+/* support burst with the values such as 1, 2, 4, 8, 16, 32, 64. using default value 0xf */ -+#define TRANSINFO_AXI_LEN GENMASK(22, 16) -+#define TRANS_AXI_LEN_SHIFT 16 -+ -+/* The interrupt and status register */ -+#define INT_STATUS_CTRL_REG 0x00000808 -+#define INT_FIFO_OVERFLOW BIT(0) /* video fifo overflow, write 1 to clear */ -+#define INT_OCM_BUF_OVERFLOW BIT(1) /* ocm buffer overflow, write 1 to clear */ -+/* JPEG engine complete compression, write 1 to clear */ -+#define INT_JPEG_ENCODE_COMPLETE BIT(2) -+/* in VGA mode, video's format is changed */ -+#define INT_VIDEO_FORMAT_CHANGE BIT(3) -+/* enable the interrupt of th video fifo overflow and source resolution */ -+#define DETECT_RESOLUTION_CHANGE_EN BIT(4) -+/* enable the interrupt of the ocm buffer overflow */ -+#define STS_VE_OCM_BUF_OVERFLOW_EN BIT(5) -+/* enable the interrupt of the JPEG complete compression */ -+#define STS_VE_JPEG_CODE_COMP_EN BIT(6) -+/* in VGA mode, the bit notes ocm buff is busy */ -+#define STS_VE_OCM_BUF_BUSY BIT(7) -+/* in VGA mode, the bit notes sequence number of the frame */ -+#define STS_VE_CUR_FRAME_NUMBER GENMASK(9, 8) -+/* in VGA mode, the bit notes sequence number of the cached frame */ -+#define STS_VE_BUF_CACHE_NUMBER GENMASK(11, 10) -+/* in VGA mode, the buffer number in buffer list */ -+#define STS_JPEG_COMP_BUF_NO GENMASK(15, 12) -+#define INT_JPEG_COMP_BUF_LIST_NO GENMASK(31, 16) /* the interrupt number of the buffer */ -+ -+#define OCM_BUF0_ADDR 0x0000080C -+#define OCM_BUF1_ADDR 0x00000810 -+#define OCM_BUF_SHIFT 8 -+ -+#define BUF_LIST_BASE_ADDR 0x00000814 -+ -+#define PHYTIUM_BUF_LIST_ACTRL_AND_STS_BASE_ADDR_REG 0x00000818 -+#define STS_JPEG_BUF_HIGH_LEVEL_VALID BIT(0) /* Hight levle is validity */ -+#define JPEG_BUF_CAPACITY_SIZE GENMASK(29, 8) /* the capacity of the buffer */ -+#define JPEG_BUF_CAPACITY_SIZE_SHIFT 8 -+ -+/* There are 16 buffers in the buffer list, the width between each other' address is 8 bytes */ -+#define BUF_LIST_ADDR_OFFSET 0x8 -+#define BUF_LIST_CTRL_AND_STS_OFFSET 0x8 -+ -+/* Get the address of the specific index buffer */ -+#define BUF_LIST_INDEX_ADDR(index) \ -+ (BUF_LIST_BASE_ADDR + (index) * BUF_LIST_ADDR_OFFSET) -+ -+#define JPEG_DST_ADDR_SHIFT 8 -+ -+#define BUF_LIST_INDEX_CTRL_STS_ADDR(index) \ -+ (PHYTIUM_BUF_LIST_ACTRL_AND_STS_BASE_ADDR_REG + (index) * BUF_LIST_CTRL_AND_STS_OFFSET) -+ -+#define FRAME_SAMPLE_CTRL 0x00000898 -+#define FRAME_SAMPLE_CTRL_EN BIT(31) -+#define FRAME_SAMPLE_INTERVAL GENMASK(30, 0) -+ -+/* The below registers are all related to quantilize */ -+#define HUFF_MODE_REG 0x300 -+#define SAMPLE_MODE_REG 0x304 -+ -+#define Y_QUANT_BASE_ADDR_REG 0x400 -+#define C_QUANT_BASE_ADDR_REG 0x500 -+ -+#define QUANT_REG_NUM 64 -+ -+#define Y_QUANT_INDEX_ADDR_REG(index) \ -+ (Y_QUANT_BASE_ADDR_REG + 4 * (index)) -+ -+#define C_QUANT_INDEX_ADDR_REG(index) \ -+ (C_QUANT_BASE_ADDR_REG + 4 * (index)) -+ -+#endif /* _PHYTIUM_JPEG_REG_H */ -diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig -index 68d71b4b5..43e552602 100644 ---- a/drivers/mfd/Kconfig -+++ b/drivers/mfd/Kconfig -@@ -1107,6 +1107,21 @@ config PCF50633_GPIO - Say yes here if you want to include support GPIO for pins on - the PCF50633 chip. - -+config MFD_PHYTIUM_I2S_LSD -+ bool "PHYTIUM Px210 I2S LSD MFD driver" -+ depends on (PCI && ARCH_PHYTIUM) -+ select MFD_CORE -+ help -+ This enables support for the Phytium Px210 LSD I2S controller. -+ -+config MFD_PHYTIUM_I2S_MMD -+ bool "PHYTIUM Px210 I2S MMD MFD driver" -+ depends on (PCI && ARCH_PHYTIUM) -+ select MFD_CORE -+ help -+ This enables support for the Phytium Px210 MMD I2S controllers -+ for Display Port. -+ - config MFD_PM8XXX - tristate "Qualcomm PM8xxx PMIC chips driver" - depends on (ARM || HEXAGON || COMPILE_TEST) -diff --git a/drivers/mfd/Makefile b/drivers/mfd/Makefile -index c66f07edc..298655810 100644 ---- a/drivers/mfd/Makefile -+++ b/drivers/mfd/Makefile -@@ -284,3 +284,6 @@ rsmu-i2c-objs := rsmu_core.o rsmu_i2c.o - rsmu-spi-objs := rsmu_core.o rsmu_spi.o - obj-$(CONFIG_MFD_RSMU_I2C) += rsmu-i2c.o - obj-$(CONFIG_MFD_RSMU_SPI) += rsmu-spi.o -+ -+obj-$(CONFIG_MFD_PHYTIUM_I2S_LSD) += phytium_px210_i2s_lsd.o -+obj-$(CONFIG_MFD_PHYTIUM_I2S_MMD) += phytium_px210_i2s_mmd.o -diff --git a/drivers/mfd/phytium_px210_i2s_lsd.c b/drivers/mfd/phytium_px210_i2s_lsd.c -new file mode 100644 -index 000000000..1f082a3c8 ---- /dev/null -+++ b/drivers/mfd/phytium_px210_i2s_lsd.c -@@ -0,0 +1,131 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium I2S LSD MFD driver over PCI bus -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+ -+struct phytium_px210_mfd { -+ struct device *dev; -+}; -+ -+struct pdata_px210_mfd { -+ struct device *dev; -+ char *name; -+ int clk_base; -+}; -+ -+static struct resource phytium_px210_i2s_res0[] = { -+ [0] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [1] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [2] = { -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+static struct mfd_cell phytium_px210_mfd_cells[] = { -+ { -+ .id = 0, -+ .name = "phytium-i2s", -+ .of_compatible = "phytium,i2s", -+ .resources = phytium_px210_i2s_res0, -+ .num_resources = ARRAY_SIZE(phytium_px210_i2s_res0), -+ .ignore_resource_conflicts = true, -+ }, -+}; -+ -+static void phytium_px210_i2s_setup(struct pci_dev *pdev) -+{ -+ struct mfd_cell *cell = &phytium_px210_mfd_cells[0]; -+ struct resource *res = (struct resource *)cell->resources; -+ struct pdata_px210_mfd *pdata; -+ -+ res[0].start = pci_resource_start(pdev, 0); -+ res[0].end = pci_resource_start(pdev, 0) + 0x0fff; -+ -+ res[1].start = pci_resource_start(pdev, 0) + 0x1000; -+ res[1].end = pci_resource_start(pdev, 0) + 0x1fff; -+ -+ res[2].start = pdev->irq; -+ res[2].end = pdev->irq; -+ -+ pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); -+ -+ pdata->dev = &pdev->dev; -+ pdata->name = "phytium-i2s-lsd"; -+ pdata->clk_base = 480000000; -+ -+ cell->platform_data = pdata; -+ cell->pdata_size = sizeof(*pdata); -+} -+ -+static int phytium_px210_mfd_probe(struct pci_dev *pdev, -+ const struct pci_device_id *id) -+{ -+ struct phytium_px210_mfd *phytium_mfd; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ pci_set_master(pdev); -+ -+ phytium_mfd = devm_kzalloc(&pdev->dev, sizeof(*phytium_mfd), GFP_KERNEL); -+ if (!phytium_mfd) -+ return -ENOMEM; -+ -+ phytium_mfd->dev = &pdev->dev; -+ dev_set_drvdata(&pdev->dev, phytium_mfd); -+ -+ phytium_px210_i2s_setup(pdev); -+ -+ ret = mfd_add_devices(&pdev->dev, 0, phytium_px210_mfd_cells, -+ ARRAY_SIZE(phytium_px210_mfd_cells), NULL, 0, -+ NULL); -+ if (ret) -+ return 0; -+ -+ return 0; -+} -+ -+ -+static void phytium_px210_mfd_remove(struct pci_dev *pdev) -+{ -+ mfd_remove_devices(&pdev->dev); -+} -+ -+static const struct pci_device_id phytium_px210_mfd_ids[] = { -+ { -+ .vendor = 0x1DB7, -+ .device = 0xDC2B, -+ .subvendor = PCI_ANY_ID, -+ .subdevice = PCI_ANY_ID, -+ .class = 0x3, -+ .class_mask = 0, -+ }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(pci, phytium_px210_mfd_ids); -+ -+static struct pci_driver phytium_i2s_lsd_mfd_driver = { -+ .name = "phytium_px210_mfd_i2s", -+ .id_table = phytium_px210_mfd_ids, -+ .probe = phytium_px210_mfd_probe, -+ .remove = phytium_px210_mfd_remove, -+}; -+ -+module_pci_driver(phytium_i2s_lsd_mfd_driver); -+ -+MODULE_AUTHOR("Zhang Yiqun "); -+MODULE_DESCRIPTION("Phytium Px210 MFD PCI driver for I2S-LSD"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/mfd/phytium_px210_i2s_mmd.c b/drivers/mfd/phytium_px210_i2s_mmd.c -new file mode 100644 -index 000000000..d225a22f2 ---- /dev/null -+++ b/drivers/mfd/phytium_px210_i2s_mmd.c -@@ -0,0 +1,185 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium I2S MMD MFD driver over PCI bus -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+ -+struct phytium_px210_mfd { -+ struct device *dev; -+}; -+ -+struct pdata_px210_mfd { -+ struct device *dev; -+ char *name; -+ int clk_base; -+}; -+ -+static struct resource phytium_px210_i2s_res0[] = { -+ [0] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [1] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [2] = { -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+static struct resource phytium_px210_i2s_res1[] = { -+ [0] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [1] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [2] = { -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+static struct resource phytium_px210_i2s_res2[] = { -+ [0] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [1] = { -+ .flags = IORESOURCE_MEM, -+ }, -+ [2] = { -+ .flags = IORESOURCE_IRQ, -+ }, -+}; -+ -+static struct mfd_cell phytium_px210_mfd_cells[] = { -+ { -+ .id = 1, -+ .name = "phytium-i2s", -+ .of_compatible = "phytium,i2s", -+ .resources = phytium_px210_i2s_res0, -+ .num_resources = ARRAY_SIZE(phytium_px210_i2s_res0), -+ .ignore_resource_conflicts = true, -+ }, -+ { -+ .id = 2, -+ .name = "phytium-i2s", -+ .of_compatible = "phytium,i2s", -+ .resources = phytium_px210_i2s_res1, -+ .num_resources = ARRAY_SIZE(phytium_px210_i2s_res1), -+ .ignore_resource_conflicts = true, -+ }, -+ { -+ .id = 3, -+ .name = "phytium-i2s", -+ .of_compatible = "phytium,i2s", -+ .resources = phytium_px210_i2s_res2, -+ .num_resources = ARRAY_SIZE(phytium_px210_i2s_res2), -+ .ignore_resource_conflicts = true, -+ }, -+}; -+ -+static void phytium_px210_i2s_setup(struct pci_dev *pdev, int i) -+{ -+ struct mfd_cell *cell = &phytium_px210_mfd_cells[i]; -+ struct resource *res = (struct resource *)cell->resources; -+ struct pdata_px210_mfd *pdata; -+ -+ res[0].start = pci_resource_start(pdev, 0) + 0x2000 * i + 0x1000; -+ res[0].end = pci_resource_start(pdev, 0) + 0x2000 * i + 0x1fff; -+ -+ res[1].start = pci_resource_start(pdev, 0) + 0x2000 * i; -+ res[1].end = pci_resource_start(pdev, 0) + 0x2000 * i + 0x0fff; -+ -+ res[2].start = pdev->irq; -+ res[2].end = pdev->irq; -+ -+ pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); -+ -+ pdata->dev = &pdev->dev; -+ pdata->clk_base = 600000000; -+ switch (i) { -+ case 0: -+ pdata->name = "phytium-i2s-dp0"; -+ break; -+ case 1: -+ pdata->name = "phytium-i2s-dp1"; -+ break; -+ case 2: -+ pdata->name = "phytium-i2s-dp2"; -+ break; -+ default: -+ break; -+ } -+ -+ cell->platform_data = pdata; -+ cell->pdata_size = sizeof(*pdata); -+} -+ -+static int phytium_px210_mfd_probe(struct pci_dev *pdev, -+ const struct pci_device_id *id) -+{ -+ struct phytium_px210_mfd *phytium_mfd; -+ int i; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ pci_set_master(pdev); -+ -+ phytium_mfd = devm_kzalloc(&pdev->dev, sizeof(*phytium_mfd), GFP_KERNEL); -+ if (!phytium_mfd) -+ return -ENOMEM; -+ -+ phytium_mfd->dev = &pdev->dev; -+ dev_set_drvdata(&pdev->dev, phytium_mfd); -+ -+ for (i = 0; i < 3; i++) -+ phytium_px210_i2s_setup(pdev, i); -+ -+ ret = mfd_add_devices(&pdev->dev, 0, phytium_px210_mfd_cells, -+ ARRAY_SIZE(phytium_px210_mfd_cells), NULL, 0, -+ NULL); -+ if (ret) -+ return 0; -+ -+ return 0; -+} -+ -+ -+static void phytium_px210_mfd_remove(struct pci_dev *pdev) -+{ -+ mfd_remove_devices(&pdev->dev); -+} -+ -+static const struct pci_device_id phytium_px210_mfd_ids[] = { -+ { -+ .vendor = 0x1DB7, -+ .device = 0xDC23, -+ .subvendor = PCI_ANY_ID, -+ .subdevice = PCI_ANY_ID, -+ .class = 0x3, -+ .class_mask = 0, -+ }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(pci, phytium_px210_mfd_ids); -+ -+static struct pci_driver phytium_i2s_mmd_mfd_driver = { -+ .name = "phytium_px210_mfd_mmd", -+ .id_table = phytium_px210_mfd_ids, -+ .probe = phytium_px210_mfd_probe, -+ .remove = phytium_px210_mfd_remove, -+}; -+ -+module_pci_driver(phytium_i2s_mmd_mfd_driver); -+ -+MODULE_AUTHOR("Zhang Yiqun "); -+MODULE_DESCRIPTION("Phytium Px210 MFD PCI driver for I2S-DP"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/mmc/host/Kconfig b/drivers/mmc/host/Kconfig -index bc7e2ad37..a31cacc65 100644 ---- a/drivers/mmc/host/Kconfig -+++ b/drivers/mmc/host/Kconfig -@@ -1071,3 +1071,31 @@ config MMC_LITEX - module will be called litex_mmc. - - If unsure, say N. -+ -+config MMC_PHYTIUM_SDCI -+ tristate "Phytium SD Host Controller support" -+ depends on ARM64 -+ help -+ This selects support for the Phytium SD Host Controller -+ -+config MMC_PHYTIUM_MCI_PCI -+ tristate "Phytium PCI MultiMedia Card Interface support" -+ depends on ARCH_PHYTIUM -+ default y if ARCH_PHYTIUM -+ help -+ This selects support for the PCI MultiMedia Card Interface on Phytium -+ Px210 chipset. -+ -+ If you have a controller with this interface, say Y or M here. -+ -+ If unsure, say N. -+ -+config MMC_PHYTIUM_MCI_PLTFM -+ tristate "Phytium MultiMedia Card Interface support" -+ depends on ARCH_PHYTIUM && OF -+ default y if ARCH_PHYTIUM -+ help -+ This selects support for the MultiMedia Card Interface on Phytium SoCs. -+ If you have a controller with this interface, say Y or M here. -+ -+ If unsure, say N. -diff --git a/drivers/mmc/host/Makefile b/drivers/mmc/host/Makefile -index a693fa3d3..129010f63 100644 ---- a/drivers/mmc/host/Makefile -+++ b/drivers/mmc/host/Makefile -@@ -70,6 +70,9 @@ obj-$(CONFIG_MMC_USDHI6ROL0) += usdhi6rol0.o - obj-$(CONFIG_MMC_TOSHIBA_PCI) += toshsd.o - obj-$(CONFIG_MMC_BCM2835) += bcm2835.o - obj-$(CONFIG_MMC_OWL) += owl-mmc.o -+obj-$(CONFIG_MMC_PHYTIUM_SDCI) += phytium-sdci.o -+obj-$(CONFIG_MMC_PHYTIUM_MCI_PCI) += phytium-mci-pci.o phytium-mci.o -+obj-$(CONFIG_MMC_PHYTIUM_MCI_PLTFM) += phytium-mci-plat.o phytium-mci.o - - obj-$(CONFIG_MMC_REALTEK_PCI) += rtsx_pci_sdmmc.o - obj-$(CONFIG_MMC_REALTEK_USB) += rtsx_usb_sdmmc.o -diff --git a/drivers/mmc/host/phytium-mci-pci.c b/drivers/mmc/host/phytium-mci-pci.c -new file mode 100644 -index 000000000..eb7aa5b11 ---- /dev/null -+++ b/drivers/mmc/host/phytium-mci-pci.c -@@ -0,0 +1,175 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * Phytium Multimedia Card Interface PCI driver -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ * -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium-mci.h" -+ -+static u32 sd_caps = MMC_CAP_SD_HIGHSPEED | MMC_CAP_WAIT_WHILE_BUSY | -+ MMC_CAP_CMD23 | MMC_CAP_4_BIT_DATA; -+static u32 sd_caps2 = MMC_CAP2_NO_MMC; -+ -+static u32 emmc_caps = MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA | MMC_CAP_WAIT_WHILE_BUSY | -+ MMC_CAP_CMD23 | MMC_CAP_HW_RESET | MMC_CAP_MMC_HIGHSPEED | -+ MMC_CAP_NONREMOVABLE; -+static u32 emmc_caps2 = MMC_CAP2_NO_SDIO | MMC_CAP2_NO_SD; -+ -+#define PCI_BAR_NO 0 -+ -+#if defined CONFIG_PM && defined CONFIG_PM_SLEEP -+static const struct dev_pm_ops phytium_mci_dev_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_mci_suspend, -+ phytium_mci_resume) -+ SET_RUNTIME_PM_OPS(phytium_mci_runtime_suspend, -+ phytium_mci_runtime_resume, NULL) -+}; -+#else -+#define phytium_mci_dev_pm_ops NULL -+#endif -+ -+static int -+phytium_mci_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) -+{ -+ struct phytium_mci_host *host; -+ struct mmc_host *mmc; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ -+ if (ret) -+ return ret; -+ pci_set_master(pdev); -+ -+ mmc = mmc_alloc_host(sizeof(struct phytium_mci_host), &pdev->dev); -+ -+ if (!mmc) -+ return -ENOMEM; -+ -+ host = mmc_priv(mmc); -+ -+ pci_enable_msi(pdev); -+ -+ host->irq = pdev->irq; -+ host->irq_flags = IRQF_SHARED; -+ host->dev = &pdev->dev; -+ ret = pcim_iomap_regions(pdev, 1 << PCI_BAR_NO, pci_name(pdev)); -+ -+ if (ret) { -+ dev_err(&pdev->dev, "I/O memory remapping failed\n"); -+ goto host_free; -+ } -+ -+ host->base = pcim_iomap_table(pdev)[PCI_BAR_NO]; -+ host->is_use_dma = 1; -+ host->is_device_x100 = 1; -+ -+ if (pdev->devfn == 2) { -+ host->caps = emmc_caps; -+ host->caps2 = emmc_caps2; -+ } else { -+ host->caps = sd_caps; -+ host->caps2 = sd_caps2; -+ mmc->f_max = 25000000; /* stable frequency */ -+ } -+ -+ host->mmc = mmc; -+ host->clk_rate = MCI_CLK; -+ -+ dev_info(&pdev->dev, "%s %d: [bar %d] addr: 0x%llx size: 0x%llx km: 0x%llx devfn:%d\n", -+ __func__, __LINE__, PCI_BAR_NO, pci_resource_start(pdev, 0), -+ pci_resource_len(pdev, 0), (uint64_t)host->base, pdev->devfn); -+ -+ dev_dbg(&pdev->dev, "%s %d:irq:0x%x\n", __func__, __LINE__, host->irq); -+ -+ ret = phytium_mci_common_probe(host); -+ -+ if (ret == MCI_REALEASE_MEM) { -+ ret = -ENOMEM; -+ goto release_mem; -+ } else if (ret) { -+ goto release; -+ } -+ pci_set_drvdata(pdev, mmc); -+ dev_info(&pdev->dev, "%s %d: probe phytium mci successful.\n", __func__, __LINE__); -+ return 0; -+ -+release: -+ phytium_mci_deinit_hw(host); -+release_mem: -+ -+ if (host->dma.adma_table) { -+ dma_free_coherent(&pdev->dev, -+ MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), -+ host->dma.adma_table, host->dma.adma_addr); -+ } -+host_free: -+ mmc_free_host(mmc); -+ pci_disable_device(pdev); -+ return ret; -+} -+ -+static void phytium_mci_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_mci_host *host; -+ struct mmc_host *mmc; -+ -+ mmc = pci_get_drvdata(pdev); -+ if (!mmc) { -+ dev_info(&pdev->dev, "%s %d: mmc is null.\n", __func__, __LINE__); -+ return; -+ } -+ host = mmc_priv(mmc); -+ if (!host) { -+ dev_info(&pdev->dev, "%s %d: host is null.\n", __func__, __LINE__); -+ mmc_remove_host(mmc); -+ mmc_free_host(mmc); -+ return; -+ } -+ -+ del_timer(&host->hotplug_timer); -+ -+ mmc_remove_host(host->mmc); -+ -+ if (host->dma.adma_table) { -+ dma_free_coherent(&pdev->dev, -+ MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), -+ host->dma.adma_table, host->dma.adma_addr); -+ } -+ phytium_mci_deinit_hw(host); -+ mmc_free_host(mmc); -+ pci_set_drvdata(pdev, NULL); -+} -+ -+static const struct pci_device_id phytium_mci_pci_tbl[] = { -+ { -+ PCI_DEVICE(PCI_VENDOR_ID_PHYTIUM, 0xdc28), -+ .class = 0x5, -+ .class_mask = 0, -+ }, -+ {} -+}; -+MODULE_DEVICE_TABLE(pci, phytium_mci_pci_tbl); -+ -+static struct pci_driver phytium_mci_pci_driver = { -+ .name = "phytium-mci-pci", -+ .id_table = phytium_mci_pci_tbl, -+ .probe = phytium_mci_pci_probe, -+ .remove = phytium_mci_pci_remove, -+ .driver = { -+ .pm = &phytium_mci_dev_pm_ops, -+ } -+}; -+module_pci_driver(phytium_mci_pci_driver); -+ -+MODULE_DESCRIPTION("Phytium Multimedia Card Interface PCI driver"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Cheng Quan "); -diff --git a/drivers/mmc/host/phytium-mci-plat.c b/drivers/mmc/host/phytium-mci-plat.c -new file mode 100644 -index 000000000..c18b7dd16 ---- /dev/null -+++ b/drivers/mmc/host/phytium-mci-plat.c -@@ -0,0 +1,195 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * Phytium Multimedia Card Interface PCI driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytium-mci.h" -+ -+static u32 mci_caps = MMC_CAP_CMD23; -+ -+#if defined CONFIG_PM && defined CONFIG_PM_SLEEP -+ -+static const struct dev_pm_ops phytium_mci_dev_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_mci_suspend, -+ phytium_mci_resume) -+ SET_RUNTIME_PM_OPS(phytium_mci_runtime_suspend, -+ phytium_mci_runtime_resume, NULL) -+}; -+#else -+#define phytium_mci_dev_pm_ops NULL -+#endif -+ -+static int phytium_mci_probe(struct platform_device *pdev) -+{ -+ struct mmc_host *mmc; -+ struct phytium_mci_host *host; -+ struct resource *res; -+ const struct acpi_device_id *match; -+ struct device *dev = &pdev->dev; -+ int ret; -+ -+ mmc = mmc_alloc_host(sizeof(struct phytium_mci_host), &pdev->dev); -+ if (!mmc) -+ return -ENOMEM; -+ host = mmc_priv(mmc); -+ ret = mmc_of_parse(mmc); -+ if (ret) -+ goto host_free; -+ -+ if (device_property_read_bool(dev, "use-hold")) -+ host->use_hold = 1; -+ -+ if (device_property_read_bool(dev, "clk-set")) -+ host->clk_set = 1; -+ -+ if (host->clk_set) { -+ host->clk_smpl_drv_25m = -1; -+ host->clk_smpl_drv_50m = -1; -+ host->clk_smpl_drv_66m = -1; -+ host->clk_smpl_drv_100m = -1; -+ device_property_read_u32(dev, "clk-smpl-drv-25m", &host->clk_smpl_drv_25m); -+ device_property_read_u32(dev, "clk-smpl-drv-50m", &host->clk_smpl_drv_50m); -+ device_property_read_u32(dev, "clk-smpl-drv-66m", &host->clk_smpl_drv_66m); -+ device_property_read_u32(dev, "clk-smpl-drv-100m", &host->clk_smpl_drv_100m); -+ } -+ dev_info(dev, "mci clk set %d %d 0x%x 0x%x 0x%x 0x%x\n", -+ host->use_hold, host->clk_set, host->clk_smpl_drv_25m, -+ host->clk_smpl_drv_50m, host->clk_smpl_drv_66m, host->clk_smpl_drv_100m); -+ -+ if (dev->of_node) { -+ host->src_clk = devm_clk_get(&pdev->dev, "phytium_mci_clk"); -+ if (IS_ERR(host->src_clk)) { -+ ret = PTR_ERR(host->src_clk); -+ goto host_free; -+ } -+ -+ host->clk_rate = clk_get_rate(host->src_clk); -+ } else if (has_acpi_companion(dev)) { -+ match = acpi_match_device(dev->driver->acpi_match_table, dev); -+ if (!match) { -+ dev_err(dev, "Error ACPI match data is missing\n"); -+ return -ENODEV; -+ } -+ host->clk_rate = 1200000000; -+ } -+ -+ host->is_use_dma = 1; -+ host->is_device_x100 = 0; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ host->base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(host->base)) { -+ ret = PTR_ERR(host->base); -+ goto host_free; -+ } -+ -+ host->irq = platform_get_irq(pdev, 0); -+ -+ if (host->irq < 0) { -+ ret = -EINVAL; -+ goto host_free; -+ } -+ host->irq_flags = IRQF_SHARED; -+ dev_dbg(&pdev->dev, "%s %d:irq:%d\n", __func__, __LINE__, host->irq); -+ host->dev = &pdev->dev; -+ host->caps = mci_caps; -+ host->mmc = mmc; -+ ret = phytium_mci_common_probe(host); -+ if (ret == MCI_REALEASE_MEM) { -+ ret = -ENOMEM; -+ goto release_mem; -+ } else if (ret) { -+ goto release; -+ } -+ platform_set_drvdata(pdev, mmc); -+ dev_info(&pdev->dev, "%s %d: probe phytium mci successful.\n", __func__, __LINE__); -+ return 0; -+ -+release: -+ phytium_mci_deinit_hw(host); -+release_mem: -+ if (host->dma.adma_table) { -+ dma_free_coherent(&pdev->dev, -+ MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), -+ host->dma.adma_table, host->dma.adma_addr); -+ } -+host_free: -+ mmc_free_host(mmc); -+ return ret; -+} -+ -+static int phytium_mci_remove(struct platform_device *pdev) -+{ -+ struct mmc_host *mmc; -+ struct phytium_mci_host *host; -+ -+ mmc = platform_get_drvdata(pdev); -+ if (!mmc) { -+ dev_info(&pdev->dev, "%s %d: mmc is null.\n", __func__, __LINE__); -+ return -1; -+ } -+ host = mmc_priv(mmc); -+ if (!host) { -+ dev_info(&pdev->dev, "%s %d: host is null.\n", __func__, __LINE__); -+ mmc_remove_host(mmc); -+ mmc_free_host(mmc); -+ return -1; -+ } -+ del_timer(&host->hotplug_timer); -+ del_timer_sync(&host->timeout_timer); -+ mmc_remove_host(host->mmc); -+ -+ if (host->dma.adma_table) { -+ dma_free_coherent(&pdev->dev, -+ MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), -+ host->dma.adma_table, host->dma.adma_addr); -+ } -+ phytium_mci_deinit_hw(host); -+ mmc_free_host(mmc); -+ platform_set_drvdata(pdev, NULL); -+ return 0; -+} -+ -+static const struct of_device_id phytium_mci_of_ids[] = { -+ { .compatible = "phytium,mci", }, -+ {} -+}; -+ -+MODULE_DEVICE_TABLE(of, phytium_mci_of_ids); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_mci_acpi_ids[] = { -+ { .id = "PHYT0017" }, -+ { } -+}; -+ -+MODULE_DEVICE_TABLE(acpi, phytium_mci_acpi_ids); -+#else -+#define phytium_mci_acpi_ids NULL -+#endif -+ -+static struct platform_driver phytium_mci_driver = { -+ .probe = phytium_mci_probe, -+ .remove = phytium_mci_remove, -+ .driver = { -+ .name = "phytium-mci-platform", -+ .of_match_table = phytium_mci_of_ids, -+ .acpi_match_table = phytium_mci_acpi_ids, -+ .pm = &phytium_mci_dev_pm_ops, -+ }, -+}; -+ -+module_platform_driver(phytium_mci_driver); -+ -+MODULE_DESCRIPTION("Phytium Multimedia Card Interface driver"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Cheng Quan "); -diff --git a/drivers/mmc/host/phytium-mci.c b/drivers/mmc/host/phytium-mci.c -new file mode 100644 -index 000000000..b511d893b ---- /dev/null -+++ b/drivers/mmc/host/phytium-mci.c -@@ -0,0 +1,1578 @@ -+// SPDX-License-Identifier: GPL-2.0+ -+/* -+ * Driver for Phytium Multimedia Card Interface -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#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 "phytium-mci.h" -+ -+static const u32 cmd_ints_mask = MCI_INT_MASK_RE | MCI_INT_MASK_CMD | MCI_INT_MASK_RCRC | -+ MCI_INT_MASK_RTO | MCI_INT_MASK_HTO | MCI_RAW_INTS_HLE; -+ -+static const u32 data_ints_mask = MCI_INT_MASK_DTO | MCI_INT_MASK_DCRC | MCI_INT_MASK_DRTO | -+ MCI_INT_MASK_SBE_BCI; -+static const u32 cmd_err_ints_mask = MCI_INT_MASK_RTO | MCI_INT_MASK_RCRC | MCI_INT_MASK_RE | -+ MCI_INT_MASK_DCRC | MCI_INT_MASK_DRTO | -+ MCI_MASKED_INTS_SBE_BCI; -+ -+static const u32 dmac_ints_mask = MCI_DMAC_INT_ENA_FBE | MCI_DMAC_INT_ENA_DU | -+ MCI_DMAC_INT_ENA_NIS | MCI_DMAC_INT_ENA_AIS; -+static const u32 dmac_err_ints_mask = MCI_DMAC_INT_ENA_FBE | MCI_DMAC_INT_ENA_DU | -+ MCI_DMAC_INT_ENA_AIS; -+ -+static void phytium_mci_cmd_next(struct phytium_mci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd); -+static void phytium_mci_adma_reset(struct phytium_mci_host *host); -+static void phytium_mci_send_cmd(struct phytium_mci_host *host, u32 cmd, u32 arg); -+static bool phytium_mci_data_xfer_done(struct phytium_mci_host *host, u32 events, -+ struct mmc_request *mrq, struct mmc_data *data); -+static void phytium_mci_init_adma_table(struct phytium_mci_host *host, -+ struct phytium_mci_dma *dma); -+static void phytium_mci_init_hw(struct phytium_mci_host *host); -+static int phytium_mci_get_cd(struct mmc_host *mmc); -+static int phytium_mci_err_irq(struct phytium_mci_host *host, u32 dmac_events, u32 events); -+ -+static void sdr_set_bits(void __iomem *reg, u32 bs) -+{ -+ u32 val = readl(reg); -+ -+ val |= bs; -+ writel(val, reg); -+} -+ -+static void sdr_clr_bits(void __iomem *reg, u32 bs) -+{ -+ u32 val = readl(reg); -+ -+ val &= ~bs; -+ writel(val, reg); -+} -+ -+static void phytium_mci_reset_hw(struct phytium_mci_host *host) -+{ -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET); -+ -+ while (readl(host->base + MCI_CNTRL) & (MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET)) -+ cpu_relax(); -+ phytium_mci_send_cmd(host, MCI_CMD_UPD_CLK, 0); -+} -+ -+static void phytium_mci_update_external_clk(struct phytium_mci_host *host, u32 uhs_reg_value) -+{ -+ writel(0, host->base + MCI_UHS_REG_EXT); -+ writel(uhs_reg_value, host->base + MCI_UHS_REG_EXT); -+ while (!(readl(host->base + MCI_CCLK_RDY) & 0x1)) -+ cpu_relax(); -+ -+} -+ -+static void phytium_mci_prepare_data(struct phytium_mci_host *host, -+ struct mmc_request *mrq) -+{ -+ struct mmc_data *data = mrq->data; -+ -+ if (!(data->host_cookie & MCI_PREPARE_FLAG)) { -+ data->host_cookie |= MCI_PREPARE_FLAG; -+ data->sg_count = dma_map_sg(host->dev, data->sg, data->sg_len, -+ mmc_get_dma_dir(data)); -+ } -+} -+ -+static void phytium_mci_unprepare_data(struct phytium_mci_host *host, -+ struct mmc_request *mrq) -+{ -+ struct mmc_data *data = mrq->data; -+ -+ if (data->host_cookie & MCI_ASYNC_FLAG) -+ return; -+ -+ if (data->host_cookie & MCI_PREPARE_FLAG) { -+ dma_unmap_sg(host->dev, data->sg, data->sg_len, mmc_get_dma_dir(data)); -+ data->host_cookie &= ~MCI_PREPARE_FLAG; -+ } -+} -+ -+static void phytium_mci_send_cmd(struct phytium_mci_host *host, u32 cmd, u32 arg) -+{ -+ int rc; -+ u32 data; -+ -+ writel(arg, host->base + MCI_CMDARG); -+ wmb(); /* drain writebuffer */ -+ -+ rc = readl_relaxed_poll_timeout(host->base + MCI_STATUS, -+ data, -+ !(data & MCI_STATUS_CARD_BUSY), -+ 0, 5000 * 1000); -+ if (rc == -ETIMEDOUT) -+ pr_debug("%s %d, timeout mci_status: 0x%08x\n", __func__, __LINE__, data); -+ -+ writel(MCI_CMD_START | cmd, host->base + MCI_CMD); -+ -+ rc = readl_relaxed_poll_timeout(host->base + MCI_CMD, -+ data, -+ !(data & MCI_CMD_START), -+ 0, 5000 * 1000); -+ if (rc == -ETIMEDOUT) -+ pr_debug("%s %d, timeout mci_cmd: 0x%08x\n", __func__, __LINE__, data); -+} -+ -+static void phytium_mci_update_cmd11(struct phytium_mci_host *host, u32 cmd) -+{ -+ writel(MCI_CMD_START | cmd, host->base + MCI_CMD); -+ -+ while (readl(host->base + MCI_CMD) & MCI_CMD_START) -+ cpu_relax(); -+} -+ -+static void phytium_mci_set_clk(struct phytium_mci_host *host, struct mmc_ios *ios) -+{ -+ u32 div = 0xff, drv = 0, sample = 0; -+ unsigned long clk_rate; -+ u32 mci_cmd_bits = MCI_CMD_UPD_CLK; -+ u32 cmd_reg; -+ u32 cur_cmd_index; -+ u32 first_uhs_div, tmp_ext_reg; -+ -+ cmd_reg = readl(host->base + MCI_CMD); -+ cur_cmd_index = cmd_reg & 0x3F; -+ -+ if (cur_cmd_index == SD_SWITCH_VOLTAGE) -+ mci_cmd_bits |= MCI_CMD_VOLT_SWITCH; -+ if (ios->clock) { -+ if (host->current_ios_clk == ios->clock) -+ return; -+ -+ dev_dbg(host->dev, "will change clock, host->clk_rate: %ld, ios->clock: %d\n", -+ host->clk_rate, ios->clock); -+ -+ if (ios->clock >= 25000000) -+ tmp_ext_reg = 0x202; -+ else if (ios->clock == 400000) -+ tmp_ext_reg = 0x502; -+ else -+ tmp_ext_reg = 0x302; -+ -+ phytium_mci_update_external_clk(host, tmp_ext_reg); -+ sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ -+ if (cur_cmd_index == SD_SWITCH_VOLTAGE) -+ phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); -+ else -+ phytium_mci_send_cmd(host, mci_cmd_bits, 0); -+ -+ clk_rate = host->clk_rate; -+ first_uhs_div = 1 + ((tmp_ext_reg >> 8)&0xFF); -+ div = clk_rate / (2 * first_uhs_div * ios->clock); -+ -+ if (host->clk_smpl_drv_25m >= 0 -+ && ios->clock == 25000000 && host->clk_set) { -+ writel((host->clk_smpl_drv_25m << 8) | (div & 0xff), -+ host->base + MCI_CLKDIV); -+ } else if (host->clk_smpl_drv_50m >= 0 -+ && ios->clock == 50000000 && host->clk_set){ -+ writel((host->clk_smpl_drv_50m << 8) | (div & 0xff), -+ host->base + MCI_CLKDIV); -+ } else if (host->clk_smpl_drv_66m >= 0 -+ && ios->clock == 66000000 && host->clk_set){ -+ writel((host->clk_smpl_drv_66m << 8) | (div & 0xff), -+ host->base + MCI_CLKDIV); -+ } else if (host->clk_smpl_drv_100m >= 0 -+ && ios->clock == 100000000 && host->clk_set){ -+ writel((host->clk_smpl_drv_100m << 8) | (div & 0xff), -+ host->base + MCI_CLKDIV); -+ } else { -+ if (div > 2) { -+ sample = div / 2 + 1; -+ drv = sample - 1; -+ writel((sample << 16) | (drv << 8) | (div & 0xff), -+ host->base + MCI_CLKDIV); -+ } else if (div == 2) { -+ drv = 0; -+ sample = 1; -+ writel((drv << 8) | (sample << 16) | (div & 0xff), -+ host->base + MCI_CLKDIV); -+ } -+ } -+ -+ dev_dbg(host->dev, "UHS_REG_EXT ext: %x, CLKDIV: %x\n", -+ readl(host->base + MCI_UHS_REG_EXT), readl(host->base + MCI_CLKDIV)); -+ -+ sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ -+ if (cur_cmd_index == SD_SWITCH_VOLTAGE) -+ phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); -+ else -+ phytium_mci_send_cmd(host, mci_cmd_bits, 0); -+ -+ host->current_ios_clk = ios->clock; -+ -+ dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", -+ host->clk_rate, ios->clock); -+ } else { -+ host->current_ios_clk = 0; -+ sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ -+ if (cur_cmd_index == SD_SWITCH_VOLTAGE) -+ phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); -+ else -+ phytium_mci_send_cmd(host, mci_cmd_bits, 0); -+ -+ sdr_clr_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); -+ dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", -+ host->clk_rate, ios->clock); -+ } -+} -+ -+static inline u32 -+phytium_mci_cmd_find_resp(struct phytium_mci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ u32 resp; -+ -+ switch (mmc_resp_type(cmd)) { -+ case MMC_RSP_R1: -+ case MMC_RSP_R1B: -+ resp = 0x5; -+ break; -+ -+ case MMC_RSP_R2: -+ resp = 0x7; -+ break; -+ -+ case MMC_RSP_R3: -+ resp = 0x1; -+ break; -+ -+ case MMC_RSP_NONE: -+ default: -+ resp = 0x0; -+ break; -+ } -+ -+ return resp; -+} -+ -+static inline -+u32 phytium_mci_cmd_prepare_raw_cmd(struct phytium_mci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ u32 opcode = cmd->opcode; -+ u32 resp = phytium_mci_cmd_find_resp(host, mrq, cmd); -+ u32 rawcmd = ((opcode & 0x3f) | ((resp & 0x7) << 6)); -+ -+ if (opcode == MMC_GO_INACTIVE_STATE || -+ (opcode == SD_IO_RW_DIRECT && ((cmd->arg >> 9) & 0x1FFFF) == SDIO_CCCR_ABORT)) -+ rawcmd |= (0x1 << 14); -+ else if (opcode == SD_SWITCH_VOLTAGE) -+ rawcmd |= (0x1 << 28); -+ -+ if (test_and_clear_bit(MCI_CARD_NEED_INIT, &host->flags)) -+ rawcmd |= (0x1 << 15); -+ -+ if (cmd->data) { -+ struct mmc_data *data = cmd->data; -+ -+ rawcmd |= (0x1 << 9); -+ -+ if (data->flags & MMC_DATA_WRITE) -+ rawcmd |= (0x1 << 10); -+ } -+ if (host->use_hold) -+ rawcmd |= (0x1 << 29); -+ -+ return (rawcmd | (0x1 << 31)); -+} -+ -+static inline void -+phytium_mci_adma_write_desc(struct phytium_mci_host *host, -+ struct phytium_adma2_64_desc *desc, -+ dma_addr_t addr, u32 len, u32 attribute) -+{ -+ desc->attribute = attribute; -+ desc->len = len; -+ desc->addr_lo = lower_32_bits(addr); -+ desc->addr_hi = upper_32_bits(addr); -+ dev_dbg(host->dev, "%s %d:addr_lo:0x%x ddr_hi:0x%x\n", __func__, -+ __LINE__, desc->addr_lo, desc->addr_hi); -+ -+ if ((attribute == 0x80000004) || (attribute == 0x8000000c)) { -+ desc->desc_lo = 0; -+ desc->desc_hi = 0; -+ } -+} -+ -+static void -+phytium_mci_data_sg_write_2_admc_table(struct phytium_mci_host *host, struct mmc_data *data) -+{ -+ struct phytium_adma2_64_desc *desc; -+ u32 dma_len, i; -+ dma_addr_t dma_address; -+ struct scatterlist *sg; -+ -+ phytium_mci_init_adma_table(host, &host->dma); -+ -+ desc = host->dma.adma_table; -+ for_each_sg(data->sg, sg, data->sg_count, i) { -+ dma_address = sg_dma_address(sg); -+ dma_len = sg_dma_len(sg); -+ -+ if (i == 0) { -+ if (sg_is_last(sg) || (data->sg_count == 1 && dma_len == SD_BLOCK_SIZE)) -+ phytium_mci_adma_write_desc(host, desc, dma_address, -+ dma_len, 0x8000000c); -+ else -+ phytium_mci_adma_write_desc(host, desc, dma_address, -+ dma_len, 0x8000001a); -+ } else if (sg_is_last(sg)) { -+ phytium_mci_adma_write_desc(host, desc, dma_address, -+ dma_len, 0x80000004); -+ } else { -+ phytium_mci_adma_write_desc(host, desc, dma_address, -+ dma_len, 0x80000012); -+ } -+ -+ desc++; -+ } -+} -+ -+static void -+phytium_mci_data_sg_write_2_fifo(struct phytium_mci_host *host, struct mmc_data *data) -+{ -+ struct scatterlist *sg; -+ u32 dma_len, i, j; -+ u32 *virt_addr; -+ -+ if (mmc_get_dma_dir(data) == DMA_TO_DEVICE) { -+ writel(0x1<<10, host->base + MCI_CMD); -+ for_each_sg(data->sg, sg, data->sg_count, i) { -+ dma_len = sg_dma_len(sg); -+ virt_addr = sg_virt(data->sg); -+ for (j = 0; j < (dma_len / 4); j++) { -+ writel(*virt_addr, host->base + MCI_DATA); -+ virt_addr++; -+ } -+ } -+ } -+} -+ -+static void phytium_mci_restart_clk(struct phytium_mci_host *host) -+{ -+ u32 clk_div, uhs; -+ -+ while (readl(host->base + MCI_CMD) & MCI_CMD_START) -+ cpu_relax(); -+ sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ clk_div = readl(host->base + MCI_CLKDIV); -+ uhs = readl(host->base + MCI_UHS_REG_EXT); -+ writel(0, host->base + MCI_UHS_REG_EXT); -+ writel(uhs, host->base + MCI_UHS_REG_EXT); -+ while (!(readl(host->base + MCI_CCLK_RDY) & 0x1)) -+ cpu_relax(); -+ -+ writel(clk_div, host->base + MCI_CLKDIV); -+ sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ writel(MCI_CMD_START | MCI_CMD_UPD_CLK, host->base + MCI_CMD); -+ while (readl(host->base + MCI_CMD) & MCI_CMD_START) -+ cpu_relax(); -+} -+ -+static int -+phytim_mci_start_multiple_write(struct phytium_mci_host *host, -+ struct mmc_request *mrq, u32 cnts, u32 offset) -+{ -+ u32 rawcmd, cmd_status; -+ struct mmc_command *cmd = mrq->cmd; -+ u32 *rsp = cmd->resp; -+ unsigned long deadline_time; -+ -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) -+ return -ESHUTDOWN; -+ -+ while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) -+ cpu_relax(); -+ -+ writel(0xffffe, host->base + MCI_RAW_INTS); -+ rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); -+ writel(mrq->data->blksz, host->base + MCI_BLKSIZ); -+ writel(cnts * mrq->data->blksz, host->base + MCI_BYTCNT); -+ writel(cmd->arg + offset, host->base + MCI_CMDARG); -+ writel(rawcmd, host->base + MCI_CMD); -+ deadline_time = jiffies + msecs_to_jiffies(200); -+ -+ cmd_status = readl(host->base + MCI_RAW_INTS); -+ while (!(cmd_status & MCI_MASKED_INTS_CMD)) { -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && -+ readl(host->base + MCI_CARD_DETECT)) -+ return -ESHUTDOWN; -+ -+ cmd_status = readl(host->base + MCI_RAW_INTS); -+ if (cmd_err_ints_mask & cmd_status) -+ return -ESHUTDOWN; -+ -+ if (cmd_status & MCI_MASKED_INTS_CMD) -+ break; -+ -+ if (time_after(jiffies, deadline_time)) -+ return -ESHUTDOWN; -+ } -+ -+ if (cmd_status & MCI_MASKED_INTS_CMD) { -+ if (cmd->flags & MMC_RSP_136) { -+ rsp[3] = readl(host->base + MCI_RESP0); -+ rsp[2] = readl(host->base + MCI_RESP1); -+ rsp[1] = readl(host->base + MCI_RESP2); -+ rsp[0] = readl(host->base + MCI_RESP3); -+ } else { -+ rsp[0] = readl(host->base + MCI_RESP0); -+ } -+ } -+ deadline_time = jiffies + msecs_to_jiffies(1000); -+ while (!(cmd_status & MCI_MASKED_INTS_DTO)) { -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && -+ readl(host->base + MCI_CARD_DETECT)) -+ return -ESHUTDOWN; -+ cmd_status = readl(host->base + MCI_RAW_INTS); -+ if (cmd_err_ints_mask & cmd_status) -+ return -ESHUTDOWN; -+ if (cmd_status & MCI_MASKED_INTS_DTO) -+ return 0; -+ if (time_after(jiffies, deadline_time)) -+ return -ESHUTDOWN; -+ } -+ return 0; -+} -+ -+static int -+phytium_mci_start_sbc_stop_cmd(struct phytium_mci_host *host, struct mmc_request *mrq, -+ struct mmc_command *cmd, u32 arg) -+{ -+ u32 rawcmd, cmd_status; -+ u32 *rsp = cmd->resp; -+ unsigned long deadline_time; -+ -+ writel(0xffffe, host->base + MCI_RAW_INTS); -+ -+ while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) -+ cpu_relax(); -+ -+ rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); -+ writel(arg, host->base + MCI_CMDARG); -+ writel(rawcmd, host->base + MCI_CMD); -+ -+ deadline_time = jiffies + msecs_to_jiffies(200); -+ cmd_status = readl(host->base + MCI_RAW_INTS); -+ while (!(cmd_status & MCI_MASKED_INTS_CMD)) { -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && -+ readl(host->base + MCI_CARD_DETECT)) -+ return -ENOMEDIUM; -+ -+ cmd_status = readl(host->base + MCI_RAW_INTS); -+ if (cmd_err_ints_mask & cmd_status) -+ return -ETIMEDOUT; -+ -+ if (cmd_status & MCI_MASKED_INTS_CMD) -+ break; -+ -+ if (time_after(jiffies, deadline_time)) -+ return -ETIMEDOUT; -+ } -+ -+ if (cmd_status & MCI_MASKED_INTS_CMD) { -+ if (cmd->flags & MMC_RSP_136) { -+ rsp[3] = readl(host->base + MCI_RESP0); -+ rsp[2] = readl(host->base + MCI_RESP1); -+ rsp[1] = readl(host->base + MCI_RESP2); -+ rsp[0] = readl(host->base + MCI_RESP3); -+ } else { -+ rsp[0] = readl(host->base + MCI_RESP0); -+ } -+ } -+ -+ if (cmd_err_ints_mask & cmd_status) -+ return -ETIMEDOUT; -+ -+ return 0; -+} -+ -+static void -+phytium_mci_start_write_multiple_non_dma(struct mmc_host *mmc, struct mmc_request *mrq) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ struct mmc_data *data = mrq->data; -+ u32 write_cnts, last_cnts; -+ u32 i, j, k, send_cnt_one_sg, block_offset; -+ int ret = 0, dma_len; -+ struct scatterlist *sg; -+ u32 *virt_addr = NULL; -+ -+ write_cnts = data->blocks / 4; -+ (data->blocks % 4) ? write_cnts++ : write_cnts; -+ last_cnts = data->blocks % 4; -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { -+ ret = -ENOMEDIUM; -+ goto write_err; -+ } -+ -+ dev_dbg(host->dev, "%s: cmd:%d, block counts:%d\n", -+ __func__, mrq->cmd->opcode, data->blocks); -+ -+ sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET); -+ while (readl(host->base + MCI_CNTRL) & MCI_CNTRL_FIFO_RESET) -+ cpu_relax(); -+ sdr_clr_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); -+ -+ if (mmc_get_dma_dir(data) == DMA_TO_DEVICE) { -+ block_offset = 0; -+ for_each_sg(data->sg, sg, data->sg_count, i) { -+ /* Each SG data transfor starts */ -+ dma_len = sg_dma_len(sg); -+ send_cnt_one_sg = (dma_len / MCI_MAX_FIFO_CNT) + 1; -+ virt_addr = sg_virt(sg); -+ for (k = 0; k < send_cnt_one_sg; k++) { -+ if (dma_len && dma_len >= MCI_MAX_FIFO_CNT) { -+ /*first write sbc cmd*/ -+ ret = phytium_mci_start_sbc_stop_cmd(host, mrq, -+ mrq->sbc, 4); -+ if (ret) -+ goto write_err; -+ writel(0x1 << 10, host->base + MCI_CMD); -+ for (j = 0; j < (MCI_MAX_FIFO_CNT / 4); j++) { -+ writel(*virt_addr, host->base + MCI_DATA); -+ virt_addr++; -+ } -+ -+ /*second write cmd25 here*/ -+ ret = phytim_mci_start_multiple_write(host, mrq, 4, -+ block_offset); -+ if (ret) -+ goto write_err; -+ block_offset += 4; -+ dma_len -= MCI_MAX_FIFO_CNT; -+ } else if (dma_len > 0) { -+ /*first write sbc cmd*/ -+ last_cnts = dma_len / 512; -+ ret = phytium_mci_start_sbc_stop_cmd(host, mrq, mrq->sbc, -+ last_cnts); -+ if (ret) -+ goto write_err; -+ writel(0x1 << 10, host->base + MCI_CMD); -+ for (j = 0; j < (dma_len / 4); j++) { -+ writel(*virt_addr, host->base + MCI_DATA); -+ virt_addr++; -+ } -+ /*second write cmd25 here*/ -+ ret = phytim_mci_start_multiple_write(host, mrq, last_cnts, -+ block_offset); -+ if (ret) -+ goto write_err; -+ block_offset += last_cnts; -+ dma_len = 0; -+ } else { -+ dev_dbg(host->dev, "%s: sg %d end\n", __func__, i); -+ break; -+ } -+ } -+ } -+ } -+ -+write_err: -+ host->data = NULL; -+ host->cmd = NULL; -+ host->mrq = NULL; -+ writel(0xffffe, host->base + MCI_RAW_INTS); -+ if (ret) { -+ data->bytes_xfered = 0; -+ if (ret == -ESHUTDOWN) { -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET); -+ while (readl(host->base + MCI_CNTRL) & MCI_CNTRL_FIFO_RESET) -+ cpu_relax(); -+ -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_CONTROLLER_RESET); -+ while (readl(host->base + MCI_STATUS) & MCI_STATUS_CARD_BUSY) -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_CONTROLLER_RESET); -+ phytium_mci_restart_clk(host); -+ phytium_mci_start_sbc_stop_cmd(host, mrq, mrq->stop, mrq->stop->arg); -+ } -+ data->error = -ETIMEDOUT; -+ mrq->cmd->error = -ETIMEDOUT; -+ mmc_request_done(host->mmc, mrq); -+ return; -+ } -+ data->bytes_xfered = data->blocks * data->blksz; -+ mmc_request_done(host->mmc, mrq); -+} -+ -+static void -+phytium_mci_start_data(struct phytium_mci_host *host, struct mmc_request *mrq, -+ struct mmc_command *cmd, struct mmc_data *data) -+{ -+ bool read; -+ u32 rawcmd; -+ unsigned long flags; -+ -+ -+ WARN_ON(host->cmd); -+ host->cmd = cmd; -+ cmd->error = 0; -+ WARN_ON(host->data); -+ host->data = data; -+ read = data->flags & MMC_DATA_READ; -+ -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { -+ phytium_mci_err_irq(host, 0, MCI_INT_MASK_RTO); -+ return; -+ } -+ /* clear interrupts */ -+ writel(0xffffe, host->base + MCI_RAW_INTS); -+ -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET); -+ -+ while (readl(host->base + MCI_CNTRL) & (MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET)) -+ cpu_relax(); -+ -+ if (host->adtc_type == COMMOM_ADTC) -+ sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); -+ else -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); -+ wmb(); /* drain writebuffer */ -+ sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE); -+ -+ rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); -+ if (host->is_use_dma && host->adtc_type == BLOCK_RW_ADTC) -+ phytium_mci_data_sg_write_2_admc_table(host, data); -+ else -+ phytium_mci_data_sg_write_2_fifo(host, data); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ mod_timer(&host->timeout_timer, -+ jiffies + msecs_to_jiffies(MMC_REQ_TIMEOUT_MS)); -+ sdr_set_bits(host->base + MCI_INT_MASK, cmd_ints_mask | data_ints_mask); -+ if (host->is_use_dma && host->adtc_type == BLOCK_RW_ADTC) { -+ sdr_set_bits(host->base + MCI_DMAC_INT_ENA, dmac_ints_mask); -+ /* Enable the IDMAC */ -+ sdr_set_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); -+ writel((u32)host->dma.adma_addr, host->base + MCI_DESC_LIST_ADDRL); -+ writel((u32)(host->dma.adma_addr >> 32), host->base + MCI_DESC_LIST_ADDRH); -+ } -+ writel(mrq->data->blksz, host->base + MCI_BLKSIZ); -+ writel(mrq->data->blocks * mrq->data->blksz, host->base + MCI_BYTCNT); -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE); -+ writel(cmd->arg, host->base + MCI_CMDARG); -+ wmb(); /* drain writebuffer */ -+ writel(rawcmd, host->base + MCI_CMD); -+ spin_unlock_irqrestore(&host->lock, flags); -+} -+ -+static void phytium_mci_track_cmd_data(struct phytium_mci_host *host, -+ struct mmc_command *cmd, -+ struct mmc_data *data) -+{ -+ if (host->error) -+ dev_dbg(host->dev, "%s: cmd=%d arg=%08X; host->error=0x%08X\n", -+ __func__, cmd->opcode, cmd->arg, host->error); -+} -+ -+static void phytium_mci_request_done(struct phytium_mci_host *host, struct mmc_request *mrq) -+{ -+ unsigned long flags; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ del_timer(&host->timeout_timer); -+ host->mrq = NULL; -+ if (host->cmd) -+ host->cmd = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ phytium_mci_track_cmd_data(host, mrq->cmd, mrq->data); -+ -+ if (mrq->data) -+ phytium_mci_unprepare_data(host, mrq); -+ -+ mmc_request_done(host->mmc, mrq); -+} -+ -+static bool phytium_mci_cmd_done(struct phytium_mci_host *host, int events, -+ struct mmc_request *mrq, struct mmc_command *cmd) -+{ -+ bool done = false; -+ unsigned long flags; -+ u32 *rsp = cmd->resp; -+ -+ if (!(events & (MCI_RAW_INTS_RCRC | MCI_RAW_INTS_RE | MCI_RAW_INTS_CMD | -+ MCI_RAW_INTS_RTO | MCI_INT_MASK_HTO))) { -+ dev_err(host->dev, "No interrupt generation:h%x\n", events); -+ return done; -+ } -+ -+ spin_lock_irqsave(&host->lock, flags); -+ done = !host->cmd; -+ host->cmd = NULL; -+ if (done) { -+ spin_unlock_irqrestore(&host->lock, flags); -+ return true; -+ } -+ sdr_clr_bits(host->base + MCI_INT_MASK, cmd_ints_mask); -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (cmd->flags & MMC_RSP_PRESENT) { -+ if (cmd->flags & MMC_RSP_136) { -+ rsp[3] = readl(host->base + MCI_RESP0); -+ rsp[2] = readl(host->base + MCI_RESP1); -+ rsp[1] = readl(host->base + MCI_RESP2); -+ rsp[0] = readl(host->base + MCI_RESP3); -+ } else { -+ /* -+ * Sometimes get ACMD41 cmd done irq but the respose index still the APP_CMD, -+ * so polling the mci status entill the respose index change. -+ */ -+ if (cmd->opcode == SD_APP_OP_COND) { -+ int polling_cnt = 20; -+ while (MMC_APP_CMD == MCI_STATUS_RESPOSE_INDEX(readl(host->base + MCI_STATUS))) { -+ udelay(100); -+ polling_cnt --; -+ if (polling_cnt == 0) { -+ dev_info(host->dev, "hw respose index not equal cmd opcode, respose value may error\n"); -+ break; -+ } -+ } -+ } -+ rsp[0] = readl(host->base + MCI_RESP0); -+ } -+ -+ if (cmd->opcode == SD_SEND_RELATIVE_ADDR) -+ host->current_rca = rsp[0] & 0xFFFF0000; -+ } -+ if (!(events & (MCI_RAW_INTS_CMD | MCI_INT_MASK_HTO))) { -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && (events & MCI_RAW_INTS_RTO) -+ && readl(host->base + MCI_CARD_DETECT)) { -+ cmd->error = -ENOMEDIUM; -+ rsp[0] = 0; -+ } else if (events & MCI_RAW_INTS_RTO || -+ (cmd->opcode != MMC_SEND_TUNING_BLOCK && -+ cmd->opcode != MMC_SEND_TUNING_BLOCK_HS200)) { -+ cmd->error = -ETIMEDOUT; -+ } else if (events & MCI_RAW_INTS_RCRC) { -+ cmd->error = -EILSEQ; -+ } else { -+ cmd->error = -ETIMEDOUT; -+ } -+ } -+ phytium_mci_cmd_next(host, mrq, cmd); -+ return true; -+} -+ -+static void phytium_mci_start_command(struct phytium_mci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ u32 rawcmd; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ WARN_ON(host->cmd); -+ host->cmd = cmd; -+ cmd->error = 0; -+ writel(0xffffe, host->base + MCI_RAW_INTS); -+ -+ rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { -+ phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, cmd); -+ return; -+ } -+ -+ spin_lock_irqsave(&host->lock, flags); -+ mod_timer(&host->timeout_timer, -+ jiffies + msecs_to_jiffies(MMC_REQ_TIMEOUT_MS)); -+ sdr_set_bits(host->base + MCI_INT_MASK, cmd_ints_mask); -+ writel(cmd->arg, host->base + MCI_CMDARG); -+ writel(rawcmd, host->base + MCI_CMD); -+ spin_unlock_irqrestore(&host->lock, flags); -+} -+ -+static void -+phytium_mci_cmd_next(struct phytium_mci_host *host, struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ if ((cmd->error && !(cmd->opcode == MMC_SEND_TUNING_BLOCK || -+ cmd->opcode == MMC_SEND_TUNING_BLOCK_HS200)) || -+ (mrq->sbc && mrq->sbc->error)) { -+ phytium_mci_request_done(host, mrq); -+ } else if (cmd == mrq->sbc) { -+ if ((mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_WRITE_BLOCK)) { -+ dev_dbg(host->dev, "%s %d:sbc done and next cmd :%d length:%d\n", -+ __func__, __LINE__, mrq->cmd->opcode, mrq->data->sg->length); -+ phytium_mci_prepare_data(host, mrq); -+ if (host->is_use_dma) -+ host->adtc_type = BLOCK_RW_ADTC; -+ else -+ host->adtc_type = COMMOM_ADTC; -+ phytium_mci_start_data(host, mrq, mrq->cmd, mrq->data); -+ } else { -+ dev_err(host->dev, "%s %d:ERROR: cmd %d followers the SBC\n", -+ __func__, __LINE__, cmd->opcode); -+ } -+ } else if (!cmd->data) { -+ phytium_mci_request_done(host, mrq); -+ } -+} -+ -+static void phytium_mci_ops_request(struct mmc_host *mmc, struct mmc_request *mrq) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ u32 data; -+ int rc; -+ -+ host->error = 0; -+ WARN_ON(host->mrq); -+ host->mrq = mrq; -+ -+ rc = readl_relaxed_poll_timeout(host->base + MCI_STATUS, -+ data, -+ !(data & MCI_STATUS_CARD_BUSY), -+ 0, 500 * 1000); -+ if (rc == -ETIMEDOUT) -+ pr_debug("%s %d, timeout mci_status: 0x%08x\n", __func__, __LINE__, data); -+ -+ rc = readl_relaxed_poll_timeout(host->base + MCI_CMD, -+ data, -+ !(data & MCI_CMD_START), -+ 0, 500 * 1000); -+ if (rc == -ETIMEDOUT) -+ pr_debug("%s %d, timeout mci_cmd.start_cmd bit clear: 0x%08x\n", __func__, __LINE__, data); -+ -+ dev_dbg(host->dev, "%s %d: cmd:%d arg:0x%x\n", __func__, __LINE__, -+ mrq->cmd->opcode, mrq->cmd->arg); -+ -+ if (host->is_device_x100 && mrq->sbc && mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) { -+ phytium_mci_start_write_multiple_non_dma(mmc, mrq); -+ return; -+ } -+ -+ if (mrq->sbc) { -+ phytium_mci_start_command(host, mrq, mrq->sbc); -+ return; -+ } -+ if (mrq->data) { -+ phytium_mci_prepare_data(host, mrq); -+ -+ if ((mrq->data->sg->length >= 512) && host->is_use_dma && -+ ((mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) || -+ (mrq->cmd->opcode == MMC_WRITE_BLOCK) || -+ (mrq->cmd->opcode == SD_IO_RW_EXTENDED))) -+ -+ host->adtc_type = BLOCK_RW_ADTC; -+ else -+ host->adtc_type = COMMOM_ADTC; -+ -+ phytium_mci_start_data(host, mrq, mrq->cmd, mrq->data); -+ return; -+ } -+ phytium_mci_start_command(host, mrq, mrq->cmd); -+} -+ -+static void phytium_mci_pre_req(struct mmc_host *mmc, struct mmc_request *mrq) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ struct mmc_data *data = mrq->data; -+ -+ if (!data) -+ return; -+ -+ phytium_mci_prepare_data(host, mrq); -+ data->host_cookie |= MCI_ASYNC_FLAG; -+} -+ -+static void phytium_mci_post_req(struct mmc_host *mmc, struct mmc_request *mrq, -+ int err) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ struct mmc_data *data = mrq->data; -+ -+ if (!data) -+ return; -+ -+ if (data->host_cookie & MCI_ASYNC_FLAG) { -+ data->host_cookie &= ~MCI_ASYNC_FLAG; -+ phytium_mci_unprepare_data(host, mrq); -+ } -+} -+ -+static void phytium_mci_data_read_without_dma(struct phytium_mci_host *host, -+ struct mmc_data *data) -+{ -+ u32 length, i, data_val, dma_len, tmp = 0; -+ u32 *virt_addr; -+ unsigned long flags; -+ struct scatterlist *sg; -+ -+ length = data->blocks * data->blksz; -+ -+ if (mmc_get_dma_dir(data) == DMA_FROM_DEVICE) { -+ spin_lock_irqsave(&host->lock, flags); -+ if (data->host_cookie & MCI_ASYNC_FLAG) { -+ tmp = MCI_ASYNC_FLAG; -+ phytium_mci_post_req(host->mmc, data->mrq, 0); -+ } else { -+ phytium_mci_unprepare_data(host, data->mrq); -+ } -+ -+ for_each_sg(data->sg, sg, data->sg_count, i) { -+ dma_len = sg_dma_len(sg); -+ virt_addr = sg_virt(data->sg); -+ -+ for (i = 0; i < (dma_len / 4); i++) { -+ data_val = readl(host->base + MCI_DATA); -+ memcpy(virt_addr, &data_val, 4); -+ ++virt_addr; -+ } -+ } -+ -+ if (tmp & MCI_ASYNC_FLAG) -+ phytium_mci_pre_req(host->mmc, data->mrq); -+ else -+ phytium_mci_prepare_data(host, data->mrq); -+ -+ spin_unlock_irqrestore(&host->lock, flags); -+ } -+ data->bytes_xfered = length; -+} -+ -+static void phytium_mci_data_xfer_next(struct phytium_mci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_data *data) -+{ -+ if (mmc_op_multi(mrq->cmd->opcode) && mrq->stop && -+ (data->error || !mrq->sbc)) { -+ while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) -+ cpu_relax(); -+ phytium_mci_start_command(host, mrq, mrq->stop); -+ } else { -+ phytium_mci_request_done(host, mrq); -+ } -+} -+ -+static bool phytium_mci_data_xfer_done(struct phytium_mci_host *host, u32 events, -+ struct mmc_request *mrq, struct mmc_data *data) -+{ -+ unsigned long flags; -+ bool done; -+ -+ unsigned int check_data = events & (MCI_RAW_INTS_DTO | MCI_RAW_INTS_RCRC | -+ MCI_RAW_INTS_DCRC | MCI_RAW_INTS_RE | -+ MCI_RAW_INTS_DRTO | MCI_RAW_INTS_EBE | -+ MCI_DMAC_STATUS_AIS | MCI_DMAC_STATUS_DU | -+ MCI_RAW_INTS_SBE_BCI | MCI_INT_MASK_RTO); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ done = !host->data; -+ -+ if (check_data || host->data) -+ host->data = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (done) -+ return true; -+ if (check_data) { -+ spin_lock_irqsave(&host->lock, flags); -+ sdr_clr_bits(host->base + MCI_DMAC_INT_ENA, dmac_ints_mask); -+ sdr_clr_bits(host->base + MCI_INT_MASK, data_ints_mask); -+ /* Stop the IDMAC running */ -+ sdr_clr_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); -+ dev_dbg(host->dev, "DMA stop\n"); -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (events & MCI_RAW_INTS_DTO) { -+ if (!host->is_use_dma || -+ (host->is_use_dma && host->adtc_type == COMMOM_ADTC && -+ (mrq->cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC)) -+ phytium_mci_data_read_without_dma(host, data); -+ else -+ data->bytes_xfered = data->blocks * data->blksz; -+ } else { -+ data->bytes_xfered = 0; -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) -+ && readl(host->base + MCI_CARD_DETECT) -+ && (events & cmd_err_ints_mask)) { -+ data->error = -ENOMEDIUM; -+ data->mrq->cmd->error = -ENOMEDIUM; -+ } else if (events & (MCI_RAW_INTS_DCRC | MCI_RAW_INTS_EBE | -+ MCI_RAW_INTS_SBE_BCI)) { -+ data->error = -EILSEQ; -+ host->cmd = NULL; -+ } else { -+ data->error = -ETIMEDOUT; -+ host->cmd = NULL; -+ } -+ } -+ -+ phytium_mci_data_xfer_next(host, mrq, data); -+ done = true; -+ } -+ return done; -+} -+ -+static int phytium_mci_card_busy(struct mmc_host *mmc) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ u32 status; -+ -+ status = readl(host->base + MCI_STATUS); -+ -+ return !!(status & MCI_STATUS_CARD_BUSY); -+} -+ -+static void __phytium_mci_enable_sdio_irq(struct phytium_mci_host *host, int enable) -+{ -+ if (enable) -+ sdr_set_bits(host->base + MCI_INT_MASK, MCI_INT_MASK_SDIO); -+ else -+ sdr_clr_bits(host->base + MCI_INT_MASK, MCI_INT_MASK_SDIO); -+} -+ -+static void phytium_mci_enable_sdio_irq(struct mmc_host *mmc, int enable) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ __phytium_mci_enable_sdio_irq(host, enable); -+} -+ -+static void hotplug_timer_func(struct timer_list *t) -+{ -+ struct phytium_mci_host *host; -+ u32 status; -+ -+ host = from_timer(host, t, hotplug_timer); -+ if (!host) -+ return; -+ -+ status = readl(host->base + MCI_CARD_DETECT); -+ -+ if (status & 0x1) { -+ if (host->mmc->card) { -+ cancel_delayed_work(&host->mmc->detect); -+ mmc_detect_change(host->mmc, msecs_to_jiffies(100)); -+ } -+ } else { -+ cancel_delayed_work(&host->mmc->detect); -+ mmc_detect_change(host->mmc, msecs_to_jiffies(200)); -+ } -+} -+ -+static void phytium_mci_request_timeout(struct timer_list *t) -+{ -+ struct phytium_mci_host *host = from_timer(host, t, timeout_timer); -+ -+ dev_err(host->dev, "request timeout\n"); -+ if (host->mrq) { -+ dev_err(host->dev, "aborting mrq=%p cmd=%d\n", -+ host->mrq, host->mrq->cmd->opcode); -+ if (host->cmd) { -+ dev_err(host->dev, "aborting cmd=%d\n", host->cmd->opcode); -+ phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, host->mrq, host->cmd); -+ } else if (host->data) { -+ dev_err(host->dev, "abort data: cmd%d; %d blocks\n", -+ host->mrq->cmd->opcode, host->data->blocks); -+ phytium_mci_data_xfer_done(host, MCI_RAW_INTS_RTO, host->mrq, -+ host->data); -+ } -+ } -+} -+ -+static int phytium_mci_err_irq(struct phytium_mci_host *host, u32 dmac_events, u32 events) -+{ -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ -+ mrq = host->mrq; -+ cmd = host->cmd; -+ data = host->data; -+ -+ if (cmd && (cmd == mrq->sbc)) { -+ phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->sbc); -+ } else if (cmd && (cmd == mrq->stop)) { -+ phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->stop); -+ } else if (data) { -+ data->error = -ETIMEDOUT; -+ if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || -+ (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) -+ phytium_mci_data_xfer_done(host, events | dmac_events, mrq, data); -+ } else if (cmd) { -+ phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->cmd); -+ } -+ -+ return 0; -+} -+ -+static irqreturn_t phytium_mci_irq(int irq, void *dev_id) -+{ -+ struct phytium_mci_host *host = (struct phytium_mci_host *) dev_id; -+ unsigned long flags; -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ u32 events, event_mask, dmac_events, dmac_evt_mask; -+ -+ if (!host) -+ return IRQ_NONE; -+ writel(0, host->base + 0xfd0); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ events = readl(host->base + MCI_RAW_INTS); -+ dmac_events = readl(host->base + MCI_DMAC_STATUS); -+ event_mask = readl(host->base + MCI_INT_MASK); -+ dmac_evt_mask = readl(host->base + MCI_DMAC_INT_ENA); -+ if ((!events) && (!(dmac_events&0x1fff))) { -+ spin_unlock_irqrestore(&host->lock, flags); -+ return IRQ_NONE; -+ } -+ dev_dbg(host->dev, "%s:events:%x,mask:0x%x,dmac_events:%x,dmac_mask:0x%x,cmd:%d\n", -+ __func__, events, event_mask, dmac_events, dmac_evt_mask, -+ host->mrq ? host->mrq->cmd->opcode : 255); -+ -+ mrq = host->mrq; -+ cmd = host->cmd; -+ data = host->data; -+ -+ if ((events & event_mask) & MCI_RAW_INTS_SDIO) -+ __phytium_mci_enable_sdio_irq(host, 0); -+ -+ writel((events & event_mask), host->base + MCI_RAW_INTS); -+ writel(dmac_events, host->base + MCI_DMAC_STATUS); -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if ((events & event_mask) & MCI_RAW_INTS_SDIO) -+ sdio_signal_irq(host->mmc); -+ -+ if (((events & event_mask) == 0) && ((dmac_evt_mask & dmac_events) == 0)) -+ goto irq_out; -+ -+ if (((events & event_mask) & MCI_RAW_INTS_CD) && -+ !(host->mmc->caps & MMC_CAP_NONREMOVABLE)) { -+ mod_timer(&host->hotplug_timer, jiffies + usecs_to_jiffies(20000)); -+ dev_dbg(host->dev, "sd status changed here ! status:[%d] [%s %d]", -+ readl(host->base + MCI_CARD_DETECT), __func__, __LINE__); -+ -+ if ((events & event_mask) == MCI_RAW_INTS_CD) -+ goto irq_out; -+ } -+ -+ if (!mrq) { -+ if (events & MCI_RAW_INTS_HLE) -+ dev_dbg(host->dev, -+ "%s: MRQ=NULL and HW write locked, events=%08x,event_mask=%08x\n", -+ __func__, events, event_mask); -+ else -+ dev_dbg(host->dev, "%s: MRQ=NULL events:%08X evt_mask=%08X,sd_status:%d\n", -+ __func__, events, event_mask, readl(host->base + MCI_CARD_DETECT)); -+ goto irq_out; -+ } -+ -+ if ((dmac_events & dmac_err_ints_mask) || (events & cmd_err_ints_mask)) { -+ dev_dbg(host->dev, "ERR:events:%x,mask:0x%x,dmac_evts:%x,dmac_mask:0x%x,cmd:%d\n", -+ events, event_mask, dmac_events, dmac_evt_mask, mrq->cmd->opcode); -+ phytium_mci_err_irq(host, dmac_events & dmac_err_ints_mask, -+ events & cmd_err_ints_mask); -+ goto irq_out; -+ } -+ -+ if (cmd && (events & MCI_MASKED_INTS_DTO) && (events & MCI_MASKED_INTS_CMD)) { -+ phytium_mci_cmd_done(host, events, mrq, cmd); -+ phytium_mci_data_xfer_done(host, (events & data_ints_mask) | -+ (dmac_events & dmac_ints_mask), mrq, data); -+ } else if (cmd && (events & MCI_MASKED_INTS_CMD || -+ ((events & MCI_INT_MASK_HTO) && (cmd->opcode == SD_SWITCH_VOLTAGE)))) { -+ phytium_mci_cmd_done(host, events, mrq, cmd); -+ } else if (events & MCI_MASKED_INTS_DTO) { -+ phytium_mci_data_xfer_done(host, (events & data_ints_mask) | -+ (dmac_events & dmac_ints_mask), mrq, data); -+ } -+ -+irq_out: -+ return IRQ_HANDLED; -+} -+ -+static void phytium_mci_init_hw(struct phytium_mci_host *host) -+{ -+ u32 val; -+ int uhs_reg_value = 0x502; -+ -+ writel(MCI_SET_FIFOTH(0x2, 0x7, 0x100), host->base + MCI_FIFOTH); -+ writel(0x800001, host->base + MCI_CARD_THRCTL); -+ sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ phytium_mci_update_external_clk(host, uhs_reg_value); -+ -+ sdr_set_bits(host->base + MCI_PWREN, MCI_PWREN_ENABLE); -+ sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ sdr_set_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); -+ sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); -+ -+ phytium_mci_reset_hw(host); -+ -+ if (host->mmc->caps & MMC_CAP_NONREMOVABLE) -+ sdr_set_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); -+ else -+ sdr_clr_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); -+ -+ writel(0, host->base + MCI_INT_MASK); -+ val = readl(host->base + MCI_RAW_INTS); -+ writel(val, host->base + MCI_RAW_INTS); -+ writel(0, host->base + MCI_DMAC_INT_ENA); -+ val = readl(host->base + MCI_DMAC_STATUS); -+ writel(val, host->base + MCI_DMAC_STATUS); -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE)) -+ writel(MCI_INT_MASK_CD, host->base + MCI_INT_MASK); -+ -+ sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE | -+ MCI_CNTRL_USE_INTERNAL_DMAC); -+ -+ writel(0xFFFFFFFF, host->base + MCI_TMOUT); -+ dev_info(host->dev, "init hardware done!"); -+ -+} -+ -+void phytium_mci_deinit_hw(struct phytium_mci_host *host) -+{ -+ u32 val; -+ -+ sdr_clr_bits(host->base + MCI_PWREN, MCI_PWREN_ENABLE); -+ sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); -+ sdr_clr_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); -+ sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); -+ writel(0, host->base + MCI_INT_MASK); -+ val = readl(host->base + MCI_RAW_INTS); -+ writel(val, host->base + MCI_RAW_INTS); -+ writel(0, host->base + MCI_DMAC_INT_ENA); -+ val = readl(host->base + MCI_DMAC_STATUS); -+ writel(val, host->base + MCI_DMAC_STATUS); -+ if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE)) -+ writel(MCI_INT_MASK_CD, host->base + MCI_INT_MASK); -+} -+EXPORT_SYMBOL_GPL(phytium_mci_deinit_hw); -+ -+static void phytium_mci_adma_reset(struct phytium_mci_host *host) -+{ -+ u32 bmod = readl(host->base + MCI_BUS_MODE); -+ -+ bmod |= MCI_BUS_MODE_SWR; -+ writel(bmod, host->base + MCI_BUS_MODE); -+} -+ -+static void phytium_mci_init_adma_table(struct phytium_mci_host *host, -+ struct phytium_mci_dma *dma) -+{ -+ struct phytium_adma2_64_desc *adma_table = dma->adma_table; -+ dma_addr_t dma_addr; -+ int i; -+ -+ memset(adma_table, 0, sizeof(struct phytium_adma2_64_desc) * MAX_BD_NUM); -+ -+ for (i = 0; i < (MAX_BD_NUM - 1); i++) { -+ dma_addr = dma->adma_addr + sizeof(*adma_table) * (i + 1); -+ adma_table[i].desc_lo = lower_32_bits(dma_addr); -+ adma_table[i].desc_hi = upper_32_bits(dma_addr); -+ adma_table[i].attribute = 0; -+ adma_table[i].NON1 = 0; -+ adma_table[i].len = 0; -+ adma_table[i].NON2 = 0; -+ } -+ -+ phytium_mci_adma_reset(host); -+} -+ -+static void phytium_mci_set_buswidth(struct phytium_mci_host *host, u32 width) -+{ -+ u32 val; -+ -+ switch (width) { -+ case MMC_BUS_WIDTH_1: -+ val = MCI_BUS_1BITS; -+ break; -+ -+ case MMC_BUS_WIDTH_4: -+ val = MCI_BUS_4BITS; -+ break; -+ -+ case MMC_BUS_WIDTH_8: -+ val = MCI_BUS_8BITS; -+ break; -+ default: -+ val = MCI_BUS_4BITS; -+ break; -+ } -+ writel(val, host->base + MCI_CTYPE); -+ dev_dbg(host->dev, "Bus Width = %d, set value:0x%x\n", width, val); -+} -+ -+static void phytium_mci_ops_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ if (ios->timing == MMC_TIMING_MMC_DDR52 || ios->timing == MMC_TIMING_UHS_DDR50) -+ sdr_set_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_DDR); -+ else -+ sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_DDR); -+ -+ phytium_mci_set_buswidth(host, ios->bus_width); -+ -+ switch (ios->power_mode) { -+ case MMC_POWER_UP: -+ set_bit(MCI_CARD_NEED_INIT, &host->flags); -+ writel(MCI_POWER_ON, host->base + MCI_PWREN); -+ break; -+ -+ case MMC_POWER_ON: -+ break; -+ -+ case MMC_POWER_OFF: -+ writel(MCI_POWER_OFF, host->base + MCI_PWREN); -+ break; -+ -+ default: -+ break; -+ } -+ phytium_mci_set_clk(host, ios); -+} -+ -+static void phytium_mci_ack_sdio_irq(struct mmc_host *mmc) -+{ -+ unsigned long flags; -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ __phytium_mci_enable_sdio_irq(host, 1); -+ spin_unlock_irqrestore(&host->lock, flags); -+} -+ -+static int phytium_mci_get_cd(struct mmc_host *mmc) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ u32 status; -+ -+ if (mmc->caps & MMC_CAP_NONREMOVABLE) -+ return 1; -+ -+ status = readl(host->base + MCI_CARD_DETECT); -+ -+ if ((status & 0x1) == 0x1) -+ return 0; -+ -+ return 1; -+} -+ -+static int phytium_mci_ops_switch_volt(struct mmc_host *mmc, struct mmc_ios *ios) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ unsigned int is_voltage_180 = 0; -+ -+ is_voltage_180 = readl(host->base + MCI_UHS_REG); -+ if ((mmc->caps & MMC_CAP_NONREMOVABLE) && (ios->signal_voltage != MMC_SIGNAL_VOLTAGE_180)) -+ return -EINVAL; -+ -+ if ((ios->signal_voltage == MMC_SIGNAL_VOLTAGE_330) && (is_voltage_180 & 0x1)) -+ sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); -+ else if ((ios->signal_voltage == MMC_SIGNAL_VOLTAGE_180) && (!(is_voltage_180 & 0x1))) -+ sdr_set_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); -+ else if (ios->signal_voltage == MMC_SIGNAL_VOLTAGE_120) -+ return -EINVAL; -+ return 0; -+} -+ -+static void phytium_mci_hw_reset(struct mmc_host *mmc) -+{ -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ u32 reset_flag; -+ -+ if (host->is_use_dma) { -+ reset_flag = MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET; -+ phytium_mci_adma_reset(host); -+ sdr_set_bits(host->base + MCI_CNTRL, reset_flag); -+ } else { -+ reset_flag = MCI_CNTRL_FIFO_RESET; -+ sdr_set_bits(host->base + MCI_CNTRL, reset_flag); -+ } -+ -+ while (readl(host->base + MCI_CNTRL) & reset_flag) -+ cpu_relax(); -+ -+ sdr_clr_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); -+ udelay(5); -+ sdr_set_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); -+ usleep_range(200, 300); -+} -+ -+#ifdef CONFIG_PM_SLEEP -+int phytium_mci_suspend(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ phytium_mci_deinit_hw(host); -+ return 0; -+} -+EXPORT_SYMBOL(phytium_mci_suspend); -+ -+int phytium_mci_resume(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ phytium_mci_init_hw(host); -+ return 0; -+} -+EXPORT_SYMBOL(phytium_mci_resume); -+ -+#endif -+ -+#ifdef CONFIG_PM -+int phytium_mci_runtime_suspend(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ phytium_mci_deinit_hw(host); -+ return 0; -+} -+EXPORT_SYMBOL(phytium_mci_runtime_suspend); -+ -+int phytium_mci_runtime_resume(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_mci_host *host = mmc_priv(mmc); -+ -+ phytium_mci_init_hw(host); -+ return 0; -+} -+EXPORT_SYMBOL(phytium_mci_runtime_resume); -+ -+#endif -+ -+static struct mmc_host_ops phytium_mci_ops = { -+ .post_req = phytium_mci_post_req, -+ .pre_req = phytium_mci_pre_req, -+ .request = phytium_mci_ops_request, -+ .set_ios = phytium_mci_ops_set_ios, -+ .get_cd = phytium_mci_get_cd, -+ .enable_sdio_irq = phytium_mci_enable_sdio_irq, -+ .ack_sdio_irq = phytium_mci_ack_sdio_irq, -+ .card_busy = phytium_mci_card_busy, -+ .start_signal_voltage_switch = phytium_mci_ops_switch_volt, -+ .card_hw_reset = phytium_mci_hw_reset, -+}; -+ -+int phytium_mci_common_probe(struct phytium_mci_host *host) -+{ -+ struct mmc_host *mmc = host->mmc; -+ struct device *dev = host->dev; -+ int ret; -+ -+ dma_set_mask(dev, DMA_BIT_MASK(64)); -+ dma_set_coherent_mask(dev, DMA_BIT_MASK(64)); -+ -+ timer_setup(&host->hotplug_timer, hotplug_timer_func, 0); -+ timer_setup(&host->timeout_timer, phytium_mci_request_timeout, 0); -+ -+ mmc->f_min = MCI_F_MIN; -+ if (!mmc->f_max) -+ mmc->f_max = MCI_F_MAX; -+ -+ mmc->ops = &phytium_mci_ops; -+ mmc->ocr_avail_sdio = MMC_VDD_32_33 | MMC_VDD_33_34; -+ mmc->ocr_avail_sd = MMC_VDD_32_33 | MMC_VDD_33_34; -+ mmc->ocr_avail_mmc = MMC_VDD_165_195; -+ mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34 | MMC_VDD_165_195; -+ mmc->caps |= host->caps; -+ -+ if (mmc->caps & MMC_CAP_SDIO_IRQ) { -+ mmc->caps2 |= MMC_CAP2_SDIO_IRQ_NOTHREAD; -+ dev_dbg(host->dev, "%s %d: MMC_CAP_SDIO_IRQ\n", __func__, __LINE__); -+ } -+ mmc->caps2 |= host->caps2; -+ if (host->is_use_dma) { -+ /* MMC core transfer sizes tunable parameters */ -+ mmc->max_segs = MAX_BD_NUM; -+ mmc->max_seg_size = 4 * 1024; -+ mmc->max_blk_size = 512; -+ mmc->max_req_size = 512 * 1024; -+ mmc->max_blk_count = mmc->max_req_size / 512; -+ host->dma.adma_table = dma_alloc_coherent(host->dev, -+ MAX_BD_NUM * -+ sizeof(struct phytium_adma2_64_desc), -+ &host->dma.adma_addr, GFP_KERNEL); -+ if (!host->dma.adma_table) -+ return MCI_REALEASE_MEM; -+ -+ host->dma.desc_sz = ADMA2_64_DESC_SZ; -+ phytium_mci_init_adma_table(host, &host->dma); -+ } else { -+ mmc->max_segs = MAX_BD_NUM; -+ mmc->max_seg_size = 4 * 1024; -+ mmc->max_blk_size = 512; -+ mmc->max_req_size = 4 * 512; -+ mmc->max_blk_count = mmc->max_req_size / 512; -+ } -+ -+ spin_lock_init(&host->lock); -+ -+ phytium_mci_init_hw(host); -+ ret = devm_request_irq(host->dev, host->irq, phytium_mci_irq, -+ host->irq_flags, "phytium-mci", host); -+ -+ if (ret) -+ return ret; -+ -+ ret = mmc_add_host(mmc); -+ -+ if (ret) { -+ dev_err(host->dev, "%s %d: mmc add host!\n", __func__, __LINE__); -+ return ret; -+ } -+ return 0; -+} -+EXPORT_SYMBOL(phytium_mci_common_probe); -+ -+MODULE_DESCRIPTION("Phytium Multimedia Card Interface driver"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Cheng Quan "); -diff --git a/drivers/mmc/host/phytium-mci.h b/drivers/mmc/host/phytium-mci.h -new file mode 100644 -index 000000000..90f51b9ee ---- /dev/null -+++ b/drivers/mmc/host/phytium-mci.h -@@ -0,0 +1,362 @@ -+/* SPDX-License-Identifier: GPL-2.0+ */ -+/* -+ * Driver for Phytium Multimedia Card Interface -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_MCI_H -+#define __PHYTIUM_MCI_H -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/*------------------------------------------------------*/ -+/* Common Definition */ -+/*------------------------------------------------------*/ -+#define MAX_BD_NUM 128 -+#define SD_BLOCK_SIZE 512 -+ -+#define MCI_BUS_1BITS 0x0 -+#define MCI_BUS_4BITS 0x1 -+#define MCI_BUS_8BITS (0x1 << 16) -+ -+#define MCI_SD_DRV_VALUE 0 -+#define MCI_SD_SAMP_VALUE_MAX 0 -+#define MCI_SD_SAMP_VALUE_MIN 0 -+ -+#define MCI_TIMEOUT_CMD_VALUE 0xFFFFFFFF -+#define MCI_POWER_ON 1 -+#define MCI_POWER_OFF 0 -+ -+#define MCI_PREPARE_FLAG (0x1 << 0) -+#define MCI_ASYNC_FLAG (0x1 << 1) -+#define MCI_MMAP_FLAG (0x1 << 2) -+ -+#define MCI_CMD_TIMEOUT (HZ/10 * 50) /* 100ms x5 */ -+#define MCI_DATA_TIMEOUT (HZ * 10) /* 1000ms x5 */ -+ -+#define MCI_CMD_TYPE_ADTC 0x2 -+ -+#define MCI_F_MIN 400000 -+#define MCI_F_MAX 50000000 -+ -+#define MCI_CLK 1200000000 -+#define MCI_REALEASE_MEM 0x1 -+#define MCI_MAX_FIFO_CNT 0x800 -+ -+/* FIFOTH register defines */ -+#define MCI_SET_FIFOTH(m, r, t) (((m) & 0x7) << 28 | \ -+ ((r) & 0xFFF) << 16 | ((t) & 0xFFF)) -+/* Card read threshold */ -+#define MCI_SET_THLD(v, x) (((v) & 0xFFF) << 16 | (x)) -+#define MCI_CARD_WR_THR_EN BIT(2) -+#define MCI_CARD_RD_THR_EN BIT(0) -+ -+/*----------------------------------------------------------------------*/ -+/* Register Offset */ -+/*----------------------------------------------------------------------*/ -+#define MCI_CNTRL 0x00 /* the controller config reg */ -+#define MCI_PWREN 0x04 /* the power enable reg */ -+#define MCI_CLKDIV 0x08 /* the clock divider reg */ -+#define MCI_CLKENA 0x10 /* the clock enable reg */ -+#define MCI_TMOUT 0x14 /* the timeout reg */ -+#define MCI_CTYPE 0x18 /* the card type reg */ -+#define MCI_BLKSIZ 0x1C /* the block size reg */ -+#define MCI_BYTCNT 0x20 /* the byte count reg */ -+#define MCI_INT_MASK 0x24 /* the interrupt mask reg */ -+#define MCI_CMDARG 0x28 /* the command argument reg */ -+#define MCI_CMD 0x2C /* the command reg */ -+#define MCI_RESP0 0x30 /* the response reg0 */ -+#define MCI_RESP1 0x34 /* the response reg1 */ -+#define MCI_RESP2 0x38 /* the response reg2 */ -+#define MCI_RESP3 0X3C /* the response reg3 */ -+#define MCI_MASKED_INTS 0x40 /* the masked interrupt status reg */ -+#define MCI_RAW_INTS 0x44 /* the raw interrupt status reg */ -+#define MCI_STATUS 0x48 /* the status reg */ -+#define MCI_FIFOTH 0x4C /* the FIFO threshold watermark reg */ -+#define MCI_CARD_DETECT 0x50 /* the card detect reg */ -+#define MCI_CARD_WRTPRT 0x54 /* the card write protect reg */ -+#define MCI_CCLK_RDY 0x58 /* first div is ready? 1:ready,0:not ready*/ -+#define MCI_TRAN_CARD_CNT 0x5C /* the transferred CIU card byte count reg */ -+#define MCI_TRAN_FIFO_CNT 0x60 /* the transferred host to FIFO byte count reg */ -+#define MCI_DEBNCE 0x64 /* the debounce count reg */ -+#define MCI_UID 0x68 /* the user ID reg */ -+#define MCI_VID 0x6C /* the controller version ID reg */ -+#define MCI_HWCONF 0x70 /* the hardware configuration reg */ -+#define MCI_UHS_REG 0x74 /* the UHS-I reg */ -+#define MCI_CARD_RESET 0x78 /* the card reset reg */ -+#define MCI_BUS_MODE 0x80 /* the bus mode reg */ -+#define MCI_DESC_LIST_ADDRL 0x88 /* the descriptor list low base address reg */ -+#define MCI_DESC_LIST_ADDRH 0x8C /* the descriptor list high base address reg */ -+#define MCI_DMAC_STATUS 0x90 /* the internal DMAC status reg */ -+#define MCI_DMAC_INT_ENA 0x94 /* the internal DMAC interrupt enable reg */ -+#define MCI_CUR_DESC_ADDRL 0x98 /* the current host descriptor low address reg */ -+#define MCI_CUR_DESC_ADDRH 0x9C /* the current host descriptor high address reg */ -+#define MCI_CUR_BUF_ADDRL 0xA0 /* the current buffer low address reg */ -+#define MCI_CUR_BUF_ADDRH 0xA4 /* the current buffer high address reg */ -+#define MCI_CARD_THRCTL 0x100 /* the card threshold control reg */ -+#define MCI_UHS_REG_EXT 0x108 /* the UHS register extension */ -+#define MCI_EMMC_DDR_REG 0x10C /* the EMMC DDR reg */ -+#define MCI_ENABLE_SHIFT 0x110 /* the enable phase shift reg */ -+#define MCI_DATA 0x200 /* the data FIFO access */ -+ -+/* Command register defines */ -+#define MCI_CMD_START BIT(31) -+#define MCI_CMD_USE_HOLD_REG BIT(29) -+#define MCI_CMD_VOLT_SWITCH BIT(28) -+#define MCI_CMD_CCS_EXP BIT(23) -+#define MCI_CMD_CEATA_RD BIT(22) -+#define MCI_CMD_UPD_CLK BIT(21) -+#define MCI_CMD_INIT BIT(15) -+#define MCI_CMD_STOP BIT(14) -+#define MCI_CMD_PRV_DAT_WAIT BIT(13) -+#define MCI_CMD_SEND_STOP BIT(12) -+#define MCI_CMD_STRM_MODE BIT(11) -+#define MCI_CMD_DAT_WR BIT(10) -+#define MCI_CMD_DAT_EXP BIT(9) -+#define MCI_CMD_RESP_CRC BIT(8) -+#define MCI_CMD_RESP_LONG BIT(7) -+#define MCI_CMD_RESP_EXP BIT(6) -+#define MCI_CMD_INDX(n) ((n) & 0x1F) -+ -+/*------------------------------------------------------*/ -+/* Register Mask */ -+/*------------------------------------------------------*/ -+/* MCI_CNTRL mask */ -+#define MCI_CNTRL_CONTROLLER_RESET (0x1 << 0) /* RW */ -+#define MCI_CNTRL_FIFO_RESET (0x1 << 1) /* RW */ -+#define MCI_CNTRL_DMA_RESET (0x1 << 2) /* RW */ -+#define MCI_CNTRL_RES (0x1 << 3) /* */ -+#define MCI_CNTRL_INT_ENABLE (0x1 << 4) /* RW */ -+#define MCI_CNTRL_DMA_ENABLE (0x1 << 5) /* RW */ -+#define MCI_CNTRL_READ_WAIT (0x1 << 6) /* RW */ -+#define MCI_CNTRL_SEND_IRQ_RESPONSE (0x1 << 7) /* RW */ -+#define MCI_CNTRL_ABORT_READ_DATA (0x1 << 8) /* RW */ -+#define MCI_CNTRL_ENDIAN (0x1 << 11) /* RW */ -+//#define MCI_CNTRL_CARD_VOLTAGE_A (0xF << 16) /* RW */ -+//#define MCI_CNTRL_CARD_VOLTAGE_B (0xF << 20) /* RW */ -+#define MCI_CNTRL_ENABLE_OD_PULLUP (0x1 << 24) /* RW */ -+#define MCI_CNTRL_USE_INTERNAL_DMAC (0x1 << 25) /* RW */ -+ -+/* MCI_PWREN mask */ -+#define MCI_PWREN_ENABLE (0x1 << 0) /* RW */ -+ -+/* MCI_CLKENA mask */ -+#define MCI_CLKENA_CCLK_ENABLE (0x1 << 0) /* RW */ -+#define MCI_CLKENA_CCLK_LOW_POWER (0x1 << 16) /* RW */ -+#define MCI_EXT_CLK_ENABLE (0x1 << 1) -+ -+/* MCI_INT_MASK mask */ -+#define MCI_INT_MASK_CD (0x1 << 0) /* RW */ -+#define MCI_INT_MASK_RE (0x1 << 1) /* RW */ -+#define MCI_INT_MASK_CMD (0x1 << 2) /* RW */ -+#define MCI_INT_MASK_DTO (0x1 << 3) /* RW */ -+#define MCI_INT_MASK_TXDR (0x1 << 4) /* RW */ -+#define MCI_INT_MASK_RXDR (0x1 << 5) /* RW */ -+#define MCI_INT_MASK_RCRC (0x1 << 6) /* RW */ -+#define MCI_INT_MASK_DCRC (0x1 << 7) /* RW */ -+#define MCI_INT_MASK_RTO (0x1 << 8) /* RW */ -+#define MCI_INT_MASK_DRTO (0x1 << 9) /* RW */ -+#define MCI_INT_MASK_HTO (0x1 << 10) /* RW */ -+#define MCI_INT_MASK_FRUN (0x1 << 11) /* RW */ -+#define MCI_INT_MASK_HLE (0x1 << 12) /* RW */ -+#define MCI_INT_MASK_SBE_BCI (0x1 << 13) /* RW */ -+#define MCI_INT_MASK_ACD (0x1 << 14) /* RW */ -+#define MCI_INT_MASK_EBE (0x1 << 15) /* RW */ -+#define MCI_INT_MASK_SDIO (0x1 << 16) /* RW */ -+ -+/* MCI_MASKED_INTS mask */ -+#define MCI_MASKED_INTS_CD (0x1 << 0) /* RO */ -+#define MCI_MASKED_INTS_RE (0x1 << 1) /* RO */ -+#define MCI_MASKED_INTS_CMD (0x1 << 2) /* RO */ -+#define MCI_MASKED_INTS_DTO (0x1 << 3) /* RO */ -+#define MCI_MASKED_INTS_TXDR (0x1 << 4) /* RO */ -+#define MCI_MASKED_INTS_RXDR (0x1 << 5) /* RO */ -+#define MCI_MASKED_INTS_RCRC (0x1 << 6) /* RO */ -+#define MCI_MASKED_INTS_DCRC (0x1 << 7) /* RO */ -+#define MCI_MASKED_INTS_RTO (0x1 << 8) /* RO */ -+#define MCI_MASKED_INTS_DRTO (0x1 << 9) /* RO */ -+#define MCI_MASKED_INTS_HTO (0x1 << 10) /* RO */ -+#define MCI_MASKED_INTS_FRUN (0x1 << 11) /* RO */ -+#define MCI_MASKED_INTS_HLE (0x1 << 12) /* RO */ -+#define MCI_MASKED_INTS_SBE_BCI (0x1 << 13) /* RO */ -+#define MCI_MASKED_INTS_ACD (0x1 << 14) /* RO */ -+#define MCI_MASKED_INTS_EBE (0x1 << 15) /* RO */ -+#define MCI_MASKED_INTS_SDIO (0x1 << 16) /* RO */ -+ -+/* MCI_RAW_INTS mask */ -+#define MCI_RAW_INTS_CD (0x1 << 0) /* W1C */ -+#define MCI_RAW_INTS_RE (0x1 << 1) /* W1C */ -+#define MCI_RAW_INTS_CMD (0x1 << 2) /* W1C */ -+#define MCI_RAW_INTS_DTO (0x1 << 3) /* W1C */ -+#define MCI_RAW_INTS_TXDR (0x1 << 4) /* W1C */ -+#define MCI_RAW_INTS_RXDR (0x1 << 5) /* W1C */ -+#define MCI_RAW_INTS_RCRC (0x1 << 6) /* W1C */ -+#define MCI_RAW_INTS_DCRC (0x1 << 7) /* W1C */ -+#define MCI_RAW_INTS_RTO (0x1 << 8) /* W1C */ -+#define MCI_RAW_INTS_DRTO (0x1 << 9) /* W1C */ -+#define MCI_RAW_INTS_HTO (0x1 << 10) /* W1C */ -+#define MCI_RAW_INTS_FRUN (0x1 << 11) /* W1C */ -+#define MCI_RAW_INTS_HLE (0x1 << 12) /* W1C */ -+#define MCI_RAW_INTS_SBE_BCI (0x1 << 13) /* W1C */ -+#define MCI_RAW_INTS_ACD (0x1 << 14) /* W1C */ -+#define MCI_RAW_INTS_EBE (0x1 << 15) /* W1C */ -+#define MCI_RAW_INTS_SDIO (0x1 << 16) /* W1C */ -+ -+/* MCI_STATUS mask */ -+#define MCI_STATUS_FIFO_RX (0x1 << 0) /* RO */ -+#define MCI_STATUS_FIFO_TX (0x1 << 1) /* RO */ -+#define MCI_STATUS_FIFO_EMPTY (0x1 << 2) /* RO */ -+#define MCI_STATUS_FIFO_FULL (0x1 << 3) /* RO */ -+#define MCI_STATUS_CARD_STATUS (0x1 << 8) /* RO */ -+#define MCI_STATUS_CARD_BUSY (0x1 << 9) /* RO */ -+#define MCI_STATUS_DATA_BUSY (0x1 << 10) /* RO */ -+#define MCI_STATUS_RESPOSE_INDEX_OFFSET (11) -+#define MCI_STATUS_RESPOSE_INDEX_MASK (0x3f << MCI_STATUS_RESPOSE_INDEX_OFFSET) /* RO */ -+#define MCI_STATUS_RESPOSE_INDEX(reg) (((reg) & MCI_STATUS_RESPOSE_INDEX_MASK) >> MCI_STATUS_RESPOSE_INDEX_OFFSET) -+#define MCI_STATUS_DMA_ACK (0x1 << 31) /* RO */ -+#define MCI_STATUS_DMA_REQ (0x1 << 32) /* RO */ -+ -+/* MCI_UHS_REG mask */ -+#define MCI_UHS_REG_VOLT (0x1 << 0) /* RW */ -+#define MCI_UHS_REG_DDR (0x1 << 16) /* RW */ -+ -+/* MCI_CARD_RESET mask */ -+#define MCI_CARD_RESET_ENABLE (0x1 << 0) /* RW */ -+ -+/* MCI_BUS_MODE mask */ -+#define MCI_BUS_MODE_SWR (0x1 << 0) /* RW */ -+#define MCI_BUS_MODE_FB (0x1 << 1) /* RW */ -+#define MCI_BUS_MODE_DE (0x1 << 7) /* RW */ -+ -+/* MCI_DMAC_STATUS mask */ -+#define MCI_DMAC_STATUS_TI (0x1 << 0) /* RW */ -+#define MCI_DMAC_STATUS_RI (0x1 << 1) /* RW */ -+#define MCI_DMAC_STATUS_FBE (0x1 << 2) /* RW */ -+#define MCI_DMAC_STATUS_DU (0x1 << 4) /* RW */ -+#define MCI_DMAC_STATUS_NIS (0x1 << 8) /* RW */ -+#define MCI_DMAC_STATUS_AIS (0x1 << 9) /* RW */ -+ -+/* MCI_DMAC_INT_ENA mask */ -+#define MCI_DMAC_INT_ENA_TI (0x1 << 0) /* RW */ -+#define MCI_DMAC_INT_ENA_RI (0x1 << 1) /* RW */ -+#define MCI_DMAC_INT_ENA_FBE (0x1 << 2) /* RW */ -+#define MCI_DMAC_INT_ENA_DU (0x1 << 4) /* RW */ -+#define MCI_DMAC_INT_ENA_CES (0x1 << 5) /* RW */ -+#define MCI_DMAC_INT_ENA_NIS (0x1 << 8) /* RW */ -+#define MCI_DMAC_INT_ENA_AIS (0x1 << 9) /* RW */ -+ -+/* MCI_CARD_THRCTL mask */ -+#define MCI_CARD_THRCTL_CARDRD (0x1 << 0) /* RW */ -+#define MCI_CARD_THRCTL_BUSY_CLR (0x1 << 1) /* RW */ -+#define MCI_CARD_THRCTL_CARDWR (0x1 << 2) /* RW */ -+ -+/* MCI_UHS_REG_EXT mask */ -+#define MCI_UHS_REG_EXT_MMC_VOLT (0x1 << 0) /* RW */ -+#define MCI_UHS_REG_EXT_CLK_ENA (0x1 << 1) /* RW */ -+ -+/* MCI_EMMC_DDR_REG mask */ -+#define MCI_EMMC_DDR_CYCLE (0x1 << 0) /* RW */ -+ -+/*--------------------------------------*/ -+/* Structure Type */ -+/*--------------------------------------*/ -+/* Maximum segments assuming a 512KiB maximum requisition */ -+/* size and a minimum4KiB page size. */ -+#define MCI_MAX_SEGS 128 -+/* ADMA2 64-bit DMA descriptor size */ -+#define ADMA2_64_DESC_SZ 32 -+ -+/* mmc request timeout 5000ms */ -+#define MMC_REQ_TIMEOUT_MS 5000 -+ -+/* Each descriptor can transfer up to 4KB of data in chained mode */ -+/*ADMA2 64-bit descriptor.*/ -+struct phytium_adma2_64_desc { -+ u32 attribute; -+#define IDMAC_DES0_DIC BIT(1) -+#define IDMAC_DES0_LD BIT(2) -+#define IDMAC_DES0_FD BIT(3) -+#define IDMAC_DES0_CH BIT(4) -+#define IDMAC_DES0_ER BIT(5) -+#define IDMAC_DES0_CES BIT(30) -+#define IDMAC_DES0_OWN BIT(31) -+ u32 NON1; -+ u32 len; -+ u32 NON2; -+ u32 addr_lo; /* Lower 32-bits of Buffer Address Pointer 1*/ -+ u32 addr_hi; /* Upper 32-bits of Buffer Address Pointer 1*/ -+ u32 desc_lo; /* Lower 32-bits of Next Descriptor Address */ -+ u32 desc_hi; /* Upper 32-bits of Next Descriptor Address */ -+} __packed __aligned(4); -+ -+struct phytium_mci_dma { -+ struct scatterlist *sg; /* I/O scatter list */ -+ /* ADMA descriptor table, pointer to adma_table array */ -+ struct phytium_adma2_64_desc *adma_table; -+ /* Mapped ADMA descr. table, the physical address of adma_table array */ -+ dma_addr_t adma_addr; -+ unsigned int desc_sz; /* ADMA descriptor size */ -+}; -+ -+enum adtc_t { -+ COMMOM_ADTC = 0, -+ BLOCK_RW_ADTC = 1 -+}; -+ -+struct phytium_mci_host { -+ struct device *dev; -+ struct mmc_host *mmc; -+ u32 caps; -+ u32 caps2; -+ spinlock_t lock; -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ int error; -+ void __iomem *base; /* host base address */ -+ void *adma_table1; -+ dma_addr_t adma_addr1; -+ struct phytium_mci_dma dma_rx; /* dma channel */ -+ struct phytium_mci_dma dma_tx; /* dma channel */ -+ struct phytium_mci_dma dma; /* dma channel */ -+ u64 dma_mask; -+ bool vqmmc_enabled; -+ u32 *sg_virt_addr; -+ enum adtc_t adtc_type; /* 0:common adtc cmd; 1:block r/w adtc cmd;*/ -+ struct timer_list hotplug_timer; -+ struct timer_list timeout_timer; -+ struct delayed_work req_timeout; -+ int irq; /* host interrupt */ -+ u32 current_rca; /*the current rca value*/ -+ u32 current_ios_clk; -+ u32 is_use_dma; -+ u32 is_device_x100; -+ struct clk *src_clk; /* phytium_mci source clock */ -+ unsigned long clk_rate; -+ unsigned long clk_div; -+ unsigned long irq_flags; -+ unsigned long flags; -+#define MCI_CARD_NEED_INIT 1 -+ bool use_hold; /*use hold reg*/ -+ bool clk_set; /*clock set function enable*/ -+ s32 clk_smpl_drv_25m; /*25M clk smpl & drv*/ -+ s32 clk_smpl_drv_50m; /*50M clk smpl & drv*/ -+ s32 clk_smpl_drv_66m; /*66M clk smpl & drv*/ -+ s32 clk_smpl_drv_100m; /*100M clk smpl & drv*/ -+}; -+ -+int phytium_mci_common_probe(struct phytium_mci_host *host); -+void phytium_mci_deinit_hw(struct phytium_mci_host *host); -+int phytium_mci_runtime_suspend(struct device *dev); -+int phytium_mci_runtime_resume(struct device *dev); -+int phytium_mci_resume(struct device *dev); -+int phytium_mci_suspend(struct device *dev); -+ -+#endif /* __PHYTIUM_MCI_HW_H */ -diff --git a/drivers/mmc/host/phytium-sdci.c b/drivers/mmc/host/phytium-sdci.c -new file mode 100644 -index 000000000..44379f558 ---- /dev/null -+++ b/drivers/mmc/host/phytium-sdci.c -@@ -0,0 +1,1439 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SDCI dirver -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ * -+ * 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 -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "phytium-sdci.h" -+ -+static const u32 cmd_ints_mask = SDCI_SDCI_NORMAL_ISER_ECC_EN | SDCI_SDCI_NORMAL_ISER_EEI_EN; -+static const u32 data_ints_mask = SDCI_BD_ISER_ETRS_EN; -+static const u32 err_ints_mask = SDCI_ERROR_ISER_ECTE_EN | SDCI_ERROR_ISR_CCRCE_EN | -+ SDCI_ERROR_ISR_CIR_EN | SDCI_ERROR_ISR_CNR_EN; -+ -+static void hotplug_timer_func(struct timer_list *t); -+static bool phytium_sdci_private_send_cmd(struct phytium_sdci_host *host, -+ u32 cmd, u32 resp_type, u32 arg); -+static bool phytium_sdci_cmd_done(struct phytium_sdci_host *host, int events, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd); -+static bool phytium_sdci_data_xfer_done(struct phytium_sdci_host *host, -+ u32 events, struct mmc_request *mrq, -+ struct mmc_data *data); -+static void phytium_sdci_cmd_next(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd); -+ -+static int phytium_sdci_cmd13_process(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_data *data, -+ u32 wait_timeout_ms, -+ u32 send_once_time_ms); -+ -+static int phytium_sd_error(struct phytium_sdci_host *host) -+{ -+ int temp; -+ -+ temp = readl(host->base + SDCI_NORMAL_ISR); -+ dev_err(host->dev, "[%s %d]SDCI_NORMAL_ISR:%x\n", __func__, __LINE__, temp); -+ temp = readl(host->base + SDCI_BD_ISR); -+ temp = readl(host->base + SDCI_ERROR_ISR); -+ dev_err(host->dev, "[%s %d]SDCI_ERROR_ISR:%x\n", __func__, __LINE__, temp); -+ temp = readl(host->base + SDCI_BD_ISR); -+ dev_err(host->dev, "[%s %d]SDCI_BD_ISR:%x\n", __func__, __LINE__, temp); -+ temp = readl(host->base + SDCI_RESP0); -+ dev_err(host->dev, "[%s %d]SDCI_RESP0:%x\n", __func__, __LINE__, temp); -+ -+ return 0; -+} -+ -+static void sdr_set_bits(void __iomem *reg, u32 bs) -+{ -+ u32 val; -+ -+ val = readl(reg); -+ val |= bs; -+ -+ writel(val, reg); -+} -+ -+static void sdr_clr_bits(void __iomem *reg, u32 bs) -+{ -+ u32 val; -+ -+ val = readl(reg); -+ val &= ~bs; -+ -+ writel(val, reg); -+} -+ -+static void phytium_sdci_reset_hw(struct phytium_sdci_host *host) -+{ -+ sdr_set_bits(host->base + SDCI_SOFTWARE, -+ SDCI_SOFTWARE_SRST); -+ sdr_clr_bits(host->base + SDCI_SOFTWARE, -+ SDCI_SOFTWARE_SRST); -+ while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) -+ cpu_relax(); -+} -+ -+static void phytium_sdci_prepare_data(struct phytium_sdci_host *host, -+ struct mmc_request *mrq) -+{ -+ struct mmc_data *data = mrq->data; -+ bool read; -+ -+ read = (data->flags & MMC_DATA_READ) != 0; -+ data->sg_count = dma_map_sg(host->dev, data->sg, data->sg_len, -+ read ? DMA_FROM_DEVICE : DMA_TO_DEVICE); -+} -+ -+static void phytium_sdci_unprepare_data(struct phytium_sdci_host *host, -+ struct mmc_request *mrq) -+{ -+ bool read; -+ struct mmc_data *data = mrq->data; -+ -+ read = (data->flags & MMC_DATA_READ) != 0; -+ dma_unmap_sg(host->dev, data->sg, data->sg_len, -+ read ? DMA_FROM_DEVICE : DMA_TO_DEVICE); -+} -+ -+static void phytium_sdci_set_clk(struct phytium_sdci_host *host, -+ struct mmc_ios *ios) -+{ -+ unsigned long clk_rate; -+ u32 div = 0xffffffff, div_reg; -+ -+ if (ios->clock) { -+ clk_rate = host->clk_rate; -+ div = ((clk_rate / (2 * ios->clock)) - 1); -+ div_reg = readl(host->base + SDCI_CLOCK_D); -+ if (div_reg == div) -+ return; -+ writel(div, host->base + SDCI_CLOCK_D); -+ writel(0, host->base + SDCI_SD_DRV); -+ writel(5, host->base + SDCI_SD_SAMP); -+ -+ sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); -+ sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); -+ while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) -+ cpu_relax(); -+ dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", -+ host->clk_rate, ios->clock); -+ } -+} -+ -+ -+static inline u32 phytium_sdci_cmd_find_resp(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ u32 resp; -+ -+ switch (mmc_resp_type(cmd)) { -+ case MMC_RSP_R1: -+ resp = 0x2; -+ break; -+ case MMC_RSP_R1B: -+ resp = 0x2; -+ break; -+ case MMC_RSP_R2: -+ resp = 0x1; -+ break; -+ case MMC_RSP_R3: -+ resp = 0x3; -+ break; -+ case MMC_RSP_NONE: -+ default: -+ resp = 0x0; -+ break; -+ } -+ -+ return resp; -+} -+ -+static inline u32 phytium_sdci_cmd_prepare_raw_cmd(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, struct mmc_command *cmd) -+{ -+ /* -+ * rawcmd : -+ * trty << 14 | opcode << 8 | cmdw << 6 | cice << 4 | crce << 3 | resp -+ */ -+ u32 resp, rawcmd; -+ u32 opcode = cmd->opcode; -+ -+ resp = phytium_sdci_cmd_find_resp(host, mrq, cmd); -+ rawcmd = ((opcode << 8) | resp); -+ -+ if ((cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC) -+ rawcmd = (rawcmd | (SDCI_CMD_TYPE_ADTC << 14)); -+ -+ return rawcmd; -+} -+ -+static void -+phytium_sdci_unexpected_error_handler(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_data *data, -+ int err_type) -+{ -+ unsigned long flags; -+ int error; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ host->mrq = NULL; -+ host->cmd = NULL; -+ host->data = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (err_type & ERR_CARD_ABSENT) { -+ host->mmc->detect_change = 1; -+ dev_dbg(host->dev, "SD is absent when send cmd:%d\n", mrq->cmd->opcode); -+ } -+ -+ switch (err_type) { -+ case ERR_CARD_ABSENT: -+ error = -ENOMEDIUM; -+ break; -+ case ERR_TIMEOUT: -+ error = -ETIMEDOUT; -+ break; -+ case ERR_CMD_RESPONED: -+ error = -EIO; -+ break; -+ default: -+ error = -ETIMEDOUT; -+ break; -+ } -+ -+ if (data) { -+ data->error = error; -+ phytium_sdci_unprepare_data(host, mrq); -+ -+ if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || -+ (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) -+ phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_R, mrq, data); -+ } else { -+ mrq->cmd->error = error; -+ } -+ -+ mmc_request_done(host->mmc, mrq); -+} -+ -+static bool phytium_sdci_start_data(struct phytium_sdci_host *host, struct mmc_request *mrq, -+ struct mmc_command *cmd, struct mmc_data *data) -+{ -+ bool read, res; -+ u32 sg_dma_addrh, sg_dma_addrl; -+ u32 sd_block_addrh, sd_block_addrl; -+ u32 temp, timeout, sd_status; -+ u32 block_cnt = 0; -+ u32 sd_block_addr = cmd->arg; -+ u32 private_cmd, resp_type, arg; -+ u32 j, dma_len; -+ unsigned long deadline_time; -+ dma_addr_t dma_address; -+ struct scatterlist *sg; -+ int ret; -+ -+ WARN_ON(host->cmd); -+ host->cmd = cmd; -+ -+ WARN_ON(host->data); -+ host->data = data; -+ read = data->flags & MMC_DATA_READ; -+ -+ for_each_sg(data->sg, sg, data->sg_count, j) { -+ writel(0, host->base + SDCI_COMMAND); -+ -+ dma_address = sg_dma_address(sg); -+ sg_dma_addrh = (u32) (dma_address >> 32); -+ sg_dma_addrl = (u32) dma_address; -+ -+ dma_len = sg_dma_len(sg); -+ block_cnt = (dma_len / SD_BLOCK_SIZE); -+ -+ sd_block_addrh = 0; -+ sd_block_addrl = sd_block_addr; -+ -+ sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_BDRST); -+ sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_BDRST); -+ writel(block_cnt, host->base + SDCI_BLK_CNT); -+ -+ if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { -+ writel(sg_dma_addrl, host->base + SDCI_BD_RX); -+ writel(sg_dma_addrh, host->base + SDCI_BD_RX); -+ writel(sd_block_addrl, host->base + SDCI_BD_RX); -+ writel(sd_block_addrh, host->base + SDCI_BD_RX); -+ timeout = 100 * block_cnt; -+ } else { -+ timeout = 250 * block_cnt; -+ ret = phytium_sdci_cmd13_process(host, mrq, data, timeout, 1); -+ if (ret != SDCI_CMD13_OK) -+ return false; -+ -+ writel(sg_dma_addrl, host->base + SDCI_BD_TX); -+ writel(sg_dma_addrh, host->base + SDCI_BD_TX); -+ writel(sd_block_addrl, host->base + SDCI_BD_TX); -+ writel(sd_block_addrh, host->base + SDCI_BD_TX); -+ } -+ -+ deadline_time = jiffies + msecs_to_jiffies(timeout); -+ -+ temp = readl(host->base + SDCI_BD_ISR); -+ if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { -+ while ((temp & SDCI_BD_ISR_TRS_R) != SDCI_BD_ISR_TRS_R) { -+ sd_status = readl(host->base + SDCI_STATUS); -+ if (sd_status & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CARD_ABSENT); -+ if (temp & SDCI_BD_ISR_DAIS) -+ writel(1, host->base + SDCI_BD_ISR); -+ return false; -+ } -+ -+ temp = readl(host->base + SDCI_BD_ISR); -+ if (time_after(jiffies, deadline_time)) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_TIMEOUT); -+ dev_err(host->dev, -+ "Read Data timeout:jiffies:0x%lx,dt_jiffies:0x%lx, BD_isr_reg:0x%x,cmd:%d, REG_D0:0x%x\n", -+ jiffies, jiffies - deadline_time, temp, -+ cmd->opcode, readl(host->base + SDCI_STATUS)); -+ -+ return false; -+ } -+ } -+ } else { -+ while ((temp & SDCI_BD_ISR_TRS_W) != SDCI_BD_ISR_TRS_W) { -+ sd_status = readl(host->base + SDCI_STATUS); -+ if (sd_status & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CARD_ABSENT); -+ dev_err(host->dev, "[%s][%d]: Card absent ! cmd(%d)\n", -+ __func__, __LINE__, mrq->cmd->opcode); -+ return false; -+ } -+ -+ temp = readl(host->base + SDCI_BD_ISR); -+ if (time_after(jiffies, deadline_time)) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_TIMEOUT); -+ dev_err(host->dev, -+ "Write Date timeout: jiffies:0x%lx,dt_jiffies:0x%lx,BD_isr_reg:0x%x\n", -+ jiffies, jiffies - deadline_time, temp); -+ return false; -+ } -+ } -+ } -+ writel(1, host->base + SDCI_BD_ISR); -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ sd_block_addr = sd_block_addr + block_cnt; -+ -+ if (j < (data->sg_count - 1) && 1 < block_cnt) { -+ private_cmd = MMC_STOP_TRANSMISSION; -+ resp_type = 0x2; -+ arg = 0; -+ res = phytium_sdci_private_send_cmd(host, private_cmd, -+ resp_type, arg); -+ if (!res) { -+ sd_status = readl(host->base + SDCI_STATUS); -+ if (sd_status & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CARD_ABSENT); -+ writel(1, host->base + SDCI_BD_ISR); -+ dev_err(host->dev, -+ "[%s][%d]:Card absent ! private_cmd(%d)\n", -+ __func__, __LINE__, private_cmd); -+ } else { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CMD_RESPONED); -+ dev_err(host->dev, -+ "[%s][%d] cmd(%d) response errored\n", -+ __func__, __LINE__, mrq->cmd->opcode); -+ phytium_sd_error(host); -+ } -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ return false; -+ } -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ } -+ } -+ -+ host->is_multi_rw_only_one_blkcnt = false; -+ -+ if ((cmd->opcode == MMC_READ_MULTIPLE_BLOCK && block_cnt == 1) || -+ (cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK && block_cnt == 1)) -+ host->is_multi_rw_only_one_blkcnt = true; -+ -+ phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_CC, mrq, cmd); -+ if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) -+ phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_R, -+ mrq, data); -+ else -+ phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_W, -+ mrq, data); -+ -+ return true; -+} -+ -+static int phytium_sdci_auto_cmd_done(struct phytium_sdci_host *host, -+ int events, struct mmc_command *cmd) -+{ -+ u32 *rsp = cmd->resp; -+ -+ rsp[0] = readl(host->base + SDCI_RESP0); -+ -+ if (events & SDCI_NORMAL_ISR_CC) -+ cmd->error = 0; -+ else { -+ phytium_sdci_reset_hw(host); -+ dev_err(host->dev, -+ "%s: AUTO_CMD%d arg=%08X; rsp %08X; cmd_error=%d\n", -+ __func__, cmd->opcode, cmd->arg, rsp[0], cmd->error); -+ } -+ -+ return cmd->error; -+} -+ -+static void phytium_sdci_track_cmd_data(struct phytium_sdci_host *host, -+ struct mmc_command *cmd, -+ struct mmc_data *data) -+{ -+ if (host->error) -+ dev_dbg(host->dev, "%s: cmd=%d arg=%08X; host->error=0x%08X\n", -+ __func__, cmd->opcode, cmd->arg, host->error); -+} -+ -+static void phytium_sdci_request_done(struct phytium_sdci_host *host, -+ struct mmc_request *mrq) -+{ -+ unsigned long flags; -+ -+ dev_dbg(host->dev, -+ "%s_%d:mrq->cmd->opcode:%d, mrq->cmd->arg:0x%x resp 0x%x 0x%x 0x%x 0x%x\n", -+ __func__, __LINE__, mrq->cmd->opcode, mrq->cmd->arg, -+ mrq->cmd->resp[0], mrq->cmd->resp[1], mrq->cmd->resp[2], -+ mrq->cmd->resp[3]); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ host->mrq = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ phytium_sdci_track_cmd_data(host, mrq->cmd, mrq->data); -+ if (mrq->data && host->adtc_type != COMMOM_ADTC) -+ phytium_sdci_unprepare_data(host, mrq); -+ mmc_request_done(host->mmc, mrq); -+} -+ -+static bool -+phytium_sdci_auto_command_done(struct phytium_sdci_host *host, int events, -+ struct mmc_request *mrq, struct mmc_command *cmd) -+{ -+ u32 *rsp = cmd->resp; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ host->cmd = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ sdr_clr_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); -+ -+ rsp[0] = 0x900; -+ phytium_sdci_request_done(host, mrq); -+ return true; -+} -+ -+/* returns true if command is fully handled; returns false otherwise */ -+static bool phytium_sdci_cmd_done(struct phytium_sdci_host *host, int events, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ bool done = false; -+ bool sbc_error; -+ unsigned long flags; -+ u32 *rsp = cmd->resp; -+ -+ if (mrq->sbc && cmd == mrq->cmd && -+ (events & SDCI_NORMAL_ISR_CC)) -+ phytium_sdci_auto_cmd_done(host, events, mrq->sbc); -+ -+ sbc_error = mrq->sbc && mrq->sbc->error; -+ -+ if (!sbc_error && !(events & (SDCI_NORMAL_ISR_CC | -+ SDCI_NORMAL_ISR_CR | -+ SDCI_NORMAL_ISR_TIMEOUT))) -+ return done; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ done = !host->cmd; -+ host->cmd = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (done) -+ return true; -+ -+ sdr_clr_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); -+ -+ if (cmd->flags & MMC_RSP_PRESENT) { -+ if (cmd->flags & MMC_RSP_136) { -+ rsp[0] = readl(host->base + SDCI_RESP0); -+ rsp[1] = readl(host->base + SDCI_RESP1); -+ rsp[2] = readl(host->base + SDCI_RESP2); -+ rsp[3] = readl(host->base + SDCI_RESP3); -+ } else { -+ rsp[0] = readl(host->base + SDCI_RESP0); -+ } -+ -+ if (cmd->opcode == SD_SEND_RELATIVE_ADDR) -+ host->current_rca = rsp[0] & 0xFFFF0000; -+ } -+ -+ if (!sbc_error && -+ !(events & SDCI_NORMAL_ISR_CC) && -+ (events & SDCI_NORMAL_ISR_TIMEOUT)) -+ cmd->error = -ETIMEDOUT; -+ -+ if (cmd->error) -+ dev_dbg(host->dev, -+ "%s: cmd=%d arg=%08X; rsp %08X; cmd_error=%d\n", -+ __func__, cmd->opcode, cmd->arg, rsp[0], -+ cmd->error); -+ -+ phytium_sdci_cmd_next(host, mrq, cmd); -+ -+ return true; -+} -+ -+static bool set_databus_width(struct phytium_sdci_host *host) -+{ -+ bool res; -+ u32 cmd, resp_type, arg; -+ -+ cmd = SD_APP_SET_BUS_WIDTH; -+ resp_type = 0x2; -+ arg = 0x2; -+ res = phytium_sdci_private_send_cmd(host, cmd, resp_type, arg); -+ if (!res) -+ return false; -+ -+ cmd = MMC_APP_CMD; -+ resp_type = 0x2; -+ arg = host->current_rca; -+ res = phytium_sdci_private_send_cmd(host, cmd, resp_type, arg); -+ if (!res) -+ return false; -+ -+ return true; -+} -+ -+ -+static void phytium_sdci_start_command(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ u32 rawcmd; -+ struct mmc_data *data = mrq->data; -+ dma_addr_t dma_adtc_buf; -+ u32 dma_bufh, dma_bufl; -+ u32 block_cnt = 0; -+ -+ WARN_ON(host->cmd); -+ host->cmd = cmd; -+ -+ cmd->error = 0; -+ rawcmd = phytium_sdci_cmd_prepare_raw_cmd(host, mrq, cmd); -+ if (cmd->opcode == MMC_STOP_TRANSMISSION || -+ cmd->opcode == MMC_SEND_STATUS) -+ writel(1, host->base + SDCI_ERROR_ISR); -+ sdr_set_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); -+ writel(rawcmd, host->base + SDCI_COMMAND); -+ -+ if ((cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC) { -+ WARN_ON(host->data); -+ host->data = data; -+ -+ dma_adtc_buf = host->dma_rx.bd_addr; -+ dma_bufh = (u32) (dma_adtc_buf >> 32); -+ dma_bufl = (u32) dma_adtc_buf; -+ block_cnt = mrq->data->blocks; -+ sdr_set_bits(host->base + SDCI_BD_ISER, data_ints_mask); -+ writel(block_cnt, host->base + SDCI_BLK_CNT); -+ -+ if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { -+ writel(dma_bufl, host->base + SDCI_BD_RX); -+ writel(dma_bufh, host->base + SDCI_BD_RX); -+ writel(cmd->arg, host->base + SDCI_BD_RX); -+ writel(0, host->base + SDCI_BD_RX); -+ } else { -+ writel(dma_bufl, host->base + SDCI_BD_TX); -+ writel(dma_bufh, host->base + SDCI_BD_TX); -+ writel(cmd->arg, host->base + SDCI_BD_TX); -+ writel(0, host->base + SDCI_BD_TX); -+ } -+ } else { -+ writel(cmd->arg, host->base + SDCI_ARGUMENT); -+ } -+} -+ -+static void phytium_sdci_cmd_next(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_command *cmd) -+{ -+ if (cmd->error || (mrq->sbc && mrq->sbc->error)) -+ phytium_sdci_request_done(host, mrq); -+ else if (cmd == mrq->sbc) -+ phytium_sdci_start_command(host, mrq, mrq->cmd); -+ else if (!cmd->data) -+ phytium_sdci_request_done(host, mrq); -+} -+ -+static int phytium_sdci_cmd13_process(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_data *data, -+ u32 wait_timeout_ms, -+ u32 send_once_time_ms) -+{ -+ u32 private_cmd, resp_type, arg, temp, sd_status; -+ unsigned long deadline_time; -+ bool res; -+ -+ deadline_time = jiffies + msecs_to_jiffies(wait_timeout_ms); -+ -+ do { -+ private_cmd = MMC_SEND_STATUS; -+ resp_type = 0x2; -+ arg = host->current_rca; -+ -+ res = phytium_sdci_private_send_cmd(host, private_cmd, resp_type, arg); -+ if (!res) { -+ sd_status = readl(host->base + SDCI_STATUS); -+ if (sd_status & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CARD_ABSENT); -+ dev_err(host->dev, -+ "[%s][%d] Card absent! private_cmd(%d)\n", -+ __func__, __LINE__, private_cmd); -+ } else { -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_CMD_RESPONED); -+ -+ dev_err(host->dev, -+ "[%s][%d] private_cmd(%d) response errored\n", -+ __func__, __LINE__, private_cmd); -+ phytium_sd_error(host); -+ } -+ writel(1, host->base + SDCI_BD_ISR); -+ return SDCI_CMD13_FAILED; -+ } -+ -+ temp = readl(host->base + SDCI_RESP0); -+ -+ if (time_after(jiffies, deadline_time)) { -+ -+ if (mrq->cmd->opcode == MMC_SEND_STATUS) -+ return SDCI_CMD13_OK; -+ -+ dev_err(host->dev, -+ "SD card is not in transfer mode,timeout:%d,rsp[0]:%x\n", -+ wait_timeout_ms, temp); -+ -+ phytium_sdci_unexpected_error_handler(host, mrq, data, -+ ERR_TIMEOUT); -+ phytium_sd_error(host); -+ return SDCI_CMD13_FAILED; -+ } -+ -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ -+ if (CARD_TRAN_STATE != (temp & CARD_CURRENT_STATE) && send_once_time_ms) -+ mdelay(send_once_time_ms); -+ -+ } while (CARD_TRAN_STATE != (temp & CARD_CURRENT_STATE)); -+ -+ return SDCI_CMD13_OK; -+} -+ -+static void phytium_sdci_ops_request(struct mmc_host *mmc, -+ struct mmc_request *mrq) -+{ -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ unsigned long flags; -+ bool res; -+ u32 status_sd; -+ int res_cmd13; -+ -+ host->error = 0; -+ WARN_ON(host->mrq); -+ host->mrq = mrq; -+ -+ dev_dbg(host->dev, "%s: mrq->cmd->opcode:%d, mrq->cmd->arg:0x%x\n", -+ __func__, mrq->cmd->opcode, mrq->cmd->arg); -+ -+ if (mrq->cmd->opcode == MMC_SEND_STATUS && -+ (mrq->cmd->flags & MMC_CMD_MASK) != MMC_CMD_ADTC) { -+ u32 status = readl(host->base + SDCI_STATUS); -+ -+ if (status & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, NULL, -+ ERR_CARD_ABSENT); -+ return; -+ } -+ -+ res_cmd13 = phytium_sdci_cmd13_process(host, mrq, NULL, 400, 5); -+ if (res_cmd13 == SDCI_CMD13_FAILED) -+ return; -+ } else if (mrq->cmd->opcode == MMC_STOP_TRANSMISSION) { -+ status_sd = readl(host->base + SDCI_STATUS); -+ if (status_sd & SDCI_STATUS_CDSL) { -+ phytium_sdci_unexpected_error_handler(host, mrq, NULL, -+ ERR_CARD_ABSENT); -+ return; -+ } -+ } -+ -+ if (mrq->data) { -+ if (mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK || -+ mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK || -+ mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK || -+ mrq->cmd->opcode == MMC_WRITE_BLOCK) { -+ host->adtc_type = BLOCK_RW_ADTC; -+ phytium_sdci_prepare_data(host, mrq); -+ phytium_sdci_start_data(host, mrq, -+ mrq->cmd, mrq->data); -+ return; -+ } -+ host->adtc_type = COMMOM_ADTC; -+ } -+ -+ if (mrq->cmd->opcode == SD_IO_RW_DIRECT || -+ mrq->cmd->opcode == SD_IO_SEND_OP_COND) { -+ spin_lock_irqsave(&host->lock, flags); -+ host->mrq = NULL; -+ host->cmd = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ mrq->cmd->error = -EINVAL; -+ mmc_request_done(host->mmc, mrq); -+ -+ return; -+ } -+ -+ if (mrq->cmd->opcode == SD_APP_SEND_SCR) { -+ res = set_databus_width(host); -+ if (!res) { -+ phytium_sdci_unexpected_error_handler(host, mrq, NULL, ERR_CMD_RESPONED); -+ return; -+ } -+ } -+ -+ /* if SBC is required, we have HW option and SW option. -+ * if HW option is enabled, and SBC does not have "special" flags, -+ * use HW option, otherwise use SW option -+ */ -+ if (mrq->sbc && -+ (!mmc_card_mmc(mmc->card) || (mrq->sbc->arg & 0xFFFF0000))) -+ phytium_sdci_start_command(host, mrq, mrq->sbc); -+ else -+ phytium_sdci_start_command(host, mrq, mrq->cmd); -+} -+ -+static void phytium_sdci_data_xfer_next(struct phytium_sdci_host *host, -+ struct mmc_request *mrq, -+ struct mmc_data *data) -+{ -+ if (mmc_op_multi(mrq->cmd->opcode) && -+ mrq->stop && !mrq->stop->error && -+ !mrq->sbc && host->is_multi_rw_only_one_blkcnt) { -+ host->is_multi_rw_only_one_blkcnt = false; -+ phytium_sdci_auto_command_done(host, SDCI_NORMAL_ISR_CC, mrq, mrq->stop); -+ } else if (mmc_op_multi(mrq->cmd->opcode) && -+ mrq->stop && !mrq->stop->error && -+ !mrq->sbc) -+ phytium_sdci_start_command(host, mrq, mrq->stop); -+ else -+ phytium_sdci_request_done(host, mrq); -+} -+ -+static inline void get_data_buffer(struct mmc_data *data, -+ u32 *bytes, u32 **pointer) -+{ -+ struct scatterlist *sg; -+ -+ sg = &data->sg[0]; -+ *bytes = sg->length; -+ *pointer = sg_virt(sg); -+} -+ -+static bool phytium_sdci_data_xfer_done(struct phytium_sdci_host *host, -+ u32 events, struct mmc_request *mrq, -+ struct mmc_data *data) -+{ -+ struct mmc_command *stop = data->stop; -+ unsigned long flags; -+ bool done; -+ unsigned int check_data; -+ u32 sg_length, i; -+ u32 *sg_virt_addr; -+ -+ check_data = events & (SDCI_BD_ISR_TRS_R | SDCI_BD_ISR_TRS_W | SDCI_BD_ISR_EDTE); -+ -+ spin_lock_irqsave(&host->lock, flags); -+ done = !host->data; -+ if (check_data) -+ host->data = NULL; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (done) -+ return true; -+ -+ if (check_data || (stop && stop->error)) { -+ sdr_clr_bits(host->base + SDCI_BD_ISER, data_ints_mask); -+ dev_dbg(host->dev, "DMA stop\n"); -+ -+ if (((events & SDCI_BD_ISR_TRS_R) || -+ (events & SDCI_BD_ISR_TRS_W)) && -+ (!stop || !stop->error)) { -+ if ((mrq->cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC && -+ (host->adtc_type == COMMOM_ADTC)) { -+ get_data_buffer(data, &sg_length, -+ &host->sg_virt_addr); -+ sg_virt_addr = host->sg_virt_addr; -+ -+ for (i = 0; i < (sg_length/4); i++) { -+ *sg_virt_addr = host->dma_rx.buf[i]; -+ sg_virt_addr++; -+ } -+ } -+ data->bytes_xfered = data->blocks * data->blksz; -+ } else { -+ dev_dbg(host->dev, "interrupt events: %x\n", events); -+ phytium_sdci_reset_hw(host); -+ data->bytes_xfered = 0; -+ dev_dbg(host->dev, "%s: cmd=%d; blocks=%d", -+ __func__, mrq->cmd->opcode, data->blocks); -+ dev_dbg(host->dev, "data_error=%d xfer_size=%d\n", -+ (int)data->error, data->bytes_xfered); -+ } -+ -+ phytium_sdci_data_xfer_next(host, mrq, data); -+ done = true; -+ } -+ -+ return done; -+} -+ -+ -+__maybe_unused static int phytium_sdci_card_busy(struct mmc_host *mmc) -+{ -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ u32 status; -+ -+ /* check if any pin between dat[0:3] is low */ -+ status = readl(host->base + SDCI_STATUS); -+ if (((status >> 20) & 0xf) != 0xf) -+ return 1; -+ -+ return 0; -+} -+ -+static void phytium_sdci_request_timeout(struct work_struct *work) -+{ -+ struct phytium_sdci_host *host; -+ -+ host = container_of(work, struct phytium_sdci_host, req_timeout.work); -+ dev_err(host->dev, "%s: aborting cmd/data/mrq\n", __func__); -+ if (host->mrq) { -+ dev_err(host->dev, "%s: aborting mrq=%p cmd=%d\n", __func__, -+ host->mrq, host->mrq->cmd->opcode); -+ if (host->cmd) { -+ dev_err(host->dev, "%s: aborting cmd=%d\n", -+ __func__, host->cmd->opcode); -+ phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_TIMEOUT, -+ host->mrq, host->cmd); -+ } else if (host->data) { -+ dev_err(host->dev, "%s: abort data: cmd%d; %d blocks\n", -+ __func__, host->mrq->cmd->opcode, -+ host->data->blocks); -+ phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_EDTE, -+ host->mrq, host->data); -+ } -+ } -+} -+ -+static void hotplug_timer_func(struct timer_list *t) -+{ -+ struct phytium_sdci_host *host; -+ u32 status; -+ -+ host = from_timer(host, t, hotplug_timer); -+ if (!host) -+ dev_err(host->dev, "%s: Not find host!\n", __func__); -+ status = readl(host->base + SDCI_STATUS); -+ -+ if (status & SDCI_STATUS_CDSL) { /* card absent */ -+ if (host->mmc->card) { -+ cancel_delayed_work(&host->mmc->detect); -+ mmc_detect_change(host->mmc, -+ msecs_to_jiffies(100)); -+ } -+ } else { /* card insert */ -+ cancel_delayed_work(&host->mmc->detect); -+ mmc_detect_change(host->mmc, msecs_to_jiffies(200)); -+ } -+} -+ -+static irqreturn_t phytium_sdci_irq(int irq, void *dev_id) -+{ -+ struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; -+ unsigned long flags; -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ u32 events; -+ -+ if (!host) -+ return IRQ_NONE; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ events = readl(host->base + SDCI_NORMAL_ISR); -+ /* clear interrupts */ -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ -+ mrq = host->mrq; -+ cmd = host->cmd; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (events & (SDCI_NORMAL_ISR_CR | SDCI_NORMAL_ISR_CI)) { -+ mod_timer(&host->hotplug_timer, -+ jiffies + usecs_to_jiffies(30000)); -+ goto irq_out; -+ } -+ -+ if (!(events & cmd_ints_mask)) -+ goto irq_out; -+ -+ if (!mrq) { -+ dev_err(host->dev, "%s: MRQ=NULL; events=%08X\n", -+ __func__, events); -+ WARN_ON(1); -+ goto irq_out; -+ } -+ -+ dev_dbg(host->dev, "%s: events=%08X\n", __func__, events); -+ -+ if (cmd) -+ phytium_sdci_cmd_done(host, events, mrq, cmd); -+ -+irq_out: -+ return IRQ_HANDLED; -+} -+ -+static irqreturn_t phytium_sdci_dma_irq(int irq, void *dev_id) -+{ -+ struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; -+ unsigned long flags; -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ u32 events; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ events = readl(host->base + SDCI_BD_ISR); -+ writel(1, host->base + SDCI_BD_ISR); -+ -+ mrq = host->mrq; -+ cmd = host->cmd; -+ data = host->data; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (!(events & data_ints_mask)) -+ goto dma_irq_out; -+ -+ if (!mrq) { -+ dev_err(host->dev, -+ "%s: MRQ=NULL; events=%08X\n", -+ __func__, events); -+ goto dma_irq_out; -+ } -+ -+ dev_dbg(host->dev, "%s: events=%08X\n", __func__, events); -+ -+ if (data) -+ phytium_sdci_data_xfer_done(host, events, mrq, data); -+ -+dma_irq_out: -+ return IRQ_HANDLED; -+} -+ -+static irqreturn_t phytium_sdci_err_irq(int irq, void *dev_id) -+{ -+ struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; -+ unsigned long flags; -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ u32 events; -+ -+ if (!host) -+ return IRQ_NONE; -+ -+ spin_lock_irqsave(&host->lock, flags); -+ events = readl(host->base + SDCI_ERROR_ISR); -+ mrq = host->mrq; -+ cmd = host->cmd; -+ data = host->data; -+ spin_unlock_irqrestore(&host->lock, flags); -+ -+ if (!(events&err_ints_mask)) -+ goto err_irq_out; -+ -+ if (!mrq) { -+ sdr_clr_bits(host->base + SDCI_NORMAL_ISER, SDCI_NORMAL_ISR_EI); -+ writel(1, host->base + SDCI_ERROR_ISR); -+ dev_err(host->dev, "%s: MRQ=NULL; events=%08X\n", __func__, events); -+ goto err_irq_out; -+ } -+ sdr_clr_bits(host->base + SDCI_NORMAL_ISER, SDCI_NORMAL_ISR_EI); -+ if (data) { -+ dev_err(host->dev, -+ "[%s][%d]: cmd(%d); %d read blocks, status:%x,flag:%x\n", -+ __func__, __LINE__, mrq->cmd->opcode, data->blocks, events, data->flags); -+ data->error = -ETIMEDOUT; -+ if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || -+ (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) -+ phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_EDTE | SDCI_BD_ISR_TRS_R, -+ mrq, data); -+ mrq->cmd->error = -ETIMEDOUT; -+ mmc_request_done(host->mmc, mrq); -+ } else if (cmd) { -+ phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_TIMEOUT, mrq, cmd); -+ } -+ -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ writel(1, host->base + SDCI_ERROR_ISR); -+err_irq_out: -+ return IRQ_HANDLED; -+} -+ -+static void phytium_sdci_init_hw(struct phytium_sdci_host *host) -+{ -+ u32 val; -+ -+ /* Reset */ -+ phytium_sdci_reset_hw(host); -+ -+ val = SDCI_SEN_CREFR_VAL | SDCI_SEN_DEBNCE_VAL; -+ writel(val, host->base + SDCI_SD_SEN); -+ -+ /* Disable and clear all interrupts */ -+ writel(0, host->base + SDCI_NORMAL_ISER); -+ writel(0, host->base + SDCI_ERROR_ISER); -+ writel(0, host->base + SDCI_BD_ISER); -+ -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ writel(1, host->base + SDCI_ERROR_ISR); -+ writel(1, host->base + SDCI_BD_ISR); -+ -+ sdr_set_bits(host->base + SDCI_NORMAL_ISER, -+ SDCI_SDCI_NORMAL_ISER_ECI|SDCI_SDCI_NORMAL_ISER_ECR); -+ /* Configure default cmd timeout to 0.1(s)s = val/25M */ -+ val = SDCI_F_MAX / 10; -+ writel(val, host->base + SDCI_TIMEOUT_CMD); -+ writel(SDCI_TIMEOUT_DATA_VALUE, host->base + SDCI_TIMEOUT_DATA); -+ -+ val = 0x0F00; -+ writel(val, host->base + SDCI_CONTROLLER); -+ -+ dev_dbg(host->dev, "init hardware done!"); -+} -+ -+static void phytium_sdci_deinit_hw(struct phytium_sdci_host *host) -+{ -+ /* Disable and clear all interrupts */ -+ writel(0, host->base + SDCI_NORMAL_ISER); -+ writel(0, host->base + SDCI_ERROR_ISER); -+ writel(0, host->base + SDCI_BD_ISER); -+ -+ writel(0, host->base + SDCI_NORMAL_ISR); -+ writel(0, host->base + SDCI_ERROR_ISR); -+ writel(0, host->base + SDCI_BD_ISR); -+} -+ -+static void phytium_sdci_ops_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) -+{ -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ if (ios->bus_width == MMC_BUS_WIDTH_4) -+ mmc->caps = mmc->caps & (~MMC_CAP_4_BIT_DATA); -+ -+ /* Suspend/Resume will do power off/on */ -+ switch (ios->power_mode) { -+ case MMC_POWER_UP: -+ writel(SDCI_POWER_ON, host->base + SDCI_POWER); -+ break; -+ case MMC_POWER_ON: -+ phytium_sdci_set_clk(host, ios); -+ break; -+ case MMC_POWER_OFF: -+ writel(SDCI_POWER_OFF, host->base + SDCI_POWER); -+ break; -+ default: -+ break; -+ } -+} -+ -+static int phytium_sdci_get_cd(struct mmc_host *mmc) -+{ -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ u32 status = readl(host->base + SDCI_STATUS); -+ -+ if (((status >> 19) & 0x1) == 0x1) -+ return 0; -+ -+ return 1; -+} -+ -+static void phytium_sdci_hw_reset(struct mmc_host *mmc) -+{ -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); -+ sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); -+ while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) -+ cpu_relax(); -+} -+ -+static struct mmc_host_ops phytium_sdci_ops = { -+ .request = phytium_sdci_ops_request, -+ .set_ios = phytium_sdci_ops_set_ios, -+ .get_cd = phytium_sdci_get_cd, -+ .card_hw_reset = phytium_sdci_hw_reset, -+}; -+ -+static bool phytium_sdci_private_send_cmd(struct phytium_sdci_host *host, -+ u32 cmd, u32 resp_type, u32 arg) -+{ -+ u32 temp, sd_cmd, sd_arg, sd_status; -+ unsigned long deadline_time; -+ -+ writel(1, host->base + SDCI_NORMAL_ISR); -+ writel(1, host->base + SDCI_ERROR_ISR); -+ -+ sd_cmd = (cmd << 8) | resp_type; -+ sd_arg = arg; -+ writel(sd_cmd, host->base + SDCI_COMMAND); -+ writel(sd_arg, host->base + SDCI_ARGUMENT); -+ -+ if (cmd == MMC_STOP_TRANSMISSION) -+ deadline_time = jiffies + msecs_to_jiffies(1000); -+ else -+ deadline_time = jiffies + msecs_to_jiffies(100); -+ -+ temp = readl(host->base + SDCI_NORMAL_ISR); -+ while ((temp & SDCI_NORMAL_ISR_CC) != SDCI_NORMAL_ISR_CC) { -+ sd_status = readl(host->base + SDCI_STATUS); -+ if (sd_status & SDCI_STATUS_CDSL) -+ return false; -+ -+ temp = readl(host->base + SDCI_NORMAL_ISR); -+ if (time_after(jiffies, deadline_time)) -+ return false; -+ -+ if (cmd == MMC_STOP_TRANSMISSION) -+ mdelay(1); -+ } -+ -+ return true; -+} -+ -+static int phytium_sdci_probe(struct platform_device *pdev) -+{ -+ struct mmc_host *mmc; -+ struct phytium_sdci_host *host; -+ struct resource *res; -+ int ret; -+ const struct acpi_device_id *match; -+ struct device *dev = &pdev->dev; -+ -+ /* Allocate MMC host for this device */ -+ mmc = mmc_alloc_host(sizeof(struct phytium_sdci_host), &pdev->dev); -+ if (!mmc) -+ return -ENOMEM; -+ -+ host = mmc_priv(mmc); -+ ret = mmc_of_parse(mmc); -+ if (ret) -+ goto host_free; -+ -+ if (dev->of_node) { -+ host->src_clk = devm_clk_get(&pdev->dev, "phytium_sdc_clk"); -+ if (IS_ERR(host->src_clk)) { -+ ret = PTR_ERR(host->src_clk); -+ goto host_free; -+ } -+ -+ host->clk_rate = clk_get_rate(host->src_clk); -+ if (device_property_read_bool(dev, "no-dma-coherent")) -+ dev->dma_coherent = false; -+ } else if (has_acpi_companion(dev)) { -+ match = acpi_match_device(dev->driver->acpi_match_table, dev); -+ if (!match) { -+ dev_err(dev, "Error ACPI match data is missing\n"); -+ return -ENODEV; -+ } -+ -+ acpi_dma_configure(dev, DEV_DMA_NON_COHERENT); -+ -+ host->clk_rate = 600000000; -+ } else { -+ dev_err(&pdev->dev, "No DT found\n"); -+ return -EINVAL; -+ } -+ -+ dma_set_mask(dev, DMA_BIT_MASK(40)); -+ dma_set_coherent_mask(dev, DMA_BIT_MASK(40)); -+ -+ timer_setup(&host->hotplug_timer, hotplug_timer_func, 0); -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ host->base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(host->base)) { -+ ret = PTR_ERR(host->base); -+ goto host_free; -+ } -+ -+ host->irq = platform_get_irq(pdev, 1); -+ if (host->irq < 0) { -+ ret = -EINVAL; -+ goto host_free; -+ } -+ -+ host->irq_err = platform_get_irq(pdev, 2); -+ if (host->irq_err < 0) { -+ ret = -EINVAL; -+ goto host_free; -+ } -+ -+ host->irq_bd = platform_get_irq(pdev, 0); -+ if (host->irq_bd < 0) { -+ ret = -EINVAL; -+ goto host_free; -+ } -+ -+ host->dev = &pdev->dev; -+ host->mmc = mmc; -+ -+ if ((4 * SDCI_F_MAX) > host->clk_rate) -+ host->clk_div = 1; -+ else -+ host->clk_div = ((host->clk_rate / (2 * SDCI_F_MAX)) - 1); -+ -+ /* Set host parameters to mmc */ -+ mmc->f_min = SDCI_F_MIN; -+ mmc->f_max = (host->clk_rate / ((host->clk_div + 1) * 2)); -+ mmc->ops = &phytium_sdci_ops; -+ mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; -+ -+ mmc->caps |= host->caps; -+ /* MMC core transfer sizes tunable parameters */ -+ mmc->max_segs = MAX_BD_NUM; -+ mmc->max_seg_size = 512 * 1024; -+ mmc->max_blk_size = 512; -+ mmc->max_req_size = 512 * 1024; -+ mmc->max_blk_count = mmc->max_req_size / 512; -+ -+ host->dma_rx.buf = dma_alloc_coherent(&pdev->dev, -+ MAX_BD_NUM, -+ &host->dma_rx.bd_addr, -+ GFP_KERNEL); -+ if (!host->dma_rx.buf) { -+ ret = -ENOMEM; -+ goto release_mem; -+ } -+ -+ host->cmd_timeout = msecs_to_jiffies(100); -+ host->data_timeout = msecs_to_jiffies(250); -+ -+ INIT_DELAYED_WORK(&host->req_timeout, phytium_sdci_request_timeout); -+ spin_lock_init(&host->lock); -+ -+ platform_set_drvdata(pdev, mmc); -+ phytium_sdci_init_hw(host); -+ -+ ret = devm_request_irq(&pdev->dev, host->irq, phytium_sdci_irq, -+ IRQF_SHARED, pdev->name, host); -+ if (ret) -+ goto release; -+ -+ ret = devm_request_irq(&pdev->dev, host->irq_err, phytium_sdci_err_irq, -+ IRQF_SHARED, pdev->name, host); -+ if (ret) -+ goto release; -+ -+ ret = devm_request_irq(&pdev->dev, host->irq_bd, phytium_sdci_dma_irq, -+ IRQF_SHARED, pdev->name, host); -+ if (ret) -+ goto release; -+ -+ ret = mmc_add_host(mmc); -+ if (ret) -+ goto release; -+ -+ return 0; -+ -+release: -+ platform_set_drvdata(pdev, NULL); -+ phytium_sdci_deinit_hw(host); -+release_mem: -+ if (host->dma_rx.buf) -+ dma_free_coherent(&pdev->dev, MAX_BD_NUM, -+ host->dma_rx.buf, -+ host->dma_rx.bd_addr); -+host_free: -+ mmc_free_host(mmc); -+ -+ return ret; -+} -+ -+static int phytium_sdci_remove(struct platform_device *pdev) -+{ -+ struct mmc_host *mmc; -+ struct phytium_sdci_host *host; -+ -+ mmc = platform_get_drvdata(pdev); -+ host = mmc_priv(mmc); -+ -+ cancel_delayed_work_sync(&host->req_timeout); -+ platform_set_drvdata(pdev, NULL); -+ mmc_remove_host(host->mmc); -+ phytium_sdci_deinit_hw(host); -+ -+ if (host->dma_rx.buf) -+ dma_free_coherent(&pdev->dev, MAX_BD_NUM, -+ host->dma_rx.buf, host->dma_rx.bd_addr); -+ -+ mmc_free_host(host->mmc); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_sdci_suspend(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ phytium_sdci_deinit_hw(host); -+ return 0; -+} -+ -+static int phytium_sdci_resume(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ phytium_sdci_init_hw(host); -+ mmc->caps = mmc->caps | MMC_CAP_4_BIT_DATA; -+ -+ return 0; -+} -+#endif -+ -+#ifdef CONFIG_PM -+static int phytium_sdci_runtime_suspend(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ phytium_sdci_deinit_hw(host); -+ -+ return 0; -+} -+ -+static int phytium_sdci_runtime_resume(struct device *dev) -+{ -+ struct mmc_host *mmc = dev_get_drvdata(dev); -+ struct phytium_sdci_host *host = mmc_priv(mmc); -+ -+ phytium_sdci_init_hw(host); -+ -+ return 0; -+} -+ -+static const struct dev_pm_ops phytium_sdci_dev_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_sdci_suspend, -+ phytium_sdci_resume) -+ SET_RUNTIME_PM_OPS(phytium_sdci_runtime_suspend, -+ phytium_sdci_runtime_resume, NULL) -+}; -+#else -+#define phytium_sdci_dev_pm_ops NULL -+#endif -+ -+static const struct of_device_id phytium_sdci_of_ids[] = { -+ { .compatible = "phytium,sdci", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_sdci_of_ids); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_sdci_acpi_ids[] = { -+ { .id = "PHYT0005" }, -+ { } -+}; -+ -+MODULE_DEVICE_TABLE(acpi, phytium_sdci_acpi_ids); -+#else -+#define phytium_sdci_acpi_ids NULL -+#endif -+ -+static struct platform_driver phytium_sdci_driver = { -+ .probe = phytium_sdci_probe, -+ .remove = phytium_sdci_remove, -+ .driver = { -+ .name = "sdci-phytium", -+ .of_match_table = phytium_sdci_of_ids, -+ .acpi_match_table = phytium_sdci_acpi_ids, -+ .pm = &phytium_sdci_dev_pm_ops, -+ }, -+}; -+ -+module_platform_driver(phytium_sdci_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium SD Card Interface driver"); -diff --git a/drivers/mmc/host/phytium-sdci.h b/drivers/mmc/host/phytium-sdci.h -new file mode 100644 -index 000000000..87ee37235 ---- /dev/null -+++ b/drivers/mmc/host/phytium-sdci.h -@@ -0,0 +1,200 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium SDCI dirver -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ */ -+ -+/*---------------------------------------------------------------------------*/ -+/* Common Definition */ -+/*---------------------------------------------------------------------------*/ -+#define MAX_BD_NUM 0x1000 -+#define SD_BLOCK_SIZE 512 -+ -+/*---------------------------------------------------------------------------*/ -+/* Register Offset */ -+/*---------------------------------------------------------------------------*/ -+#define SDCI_CONTROLLER 0x00 /* controller config reg */ -+#define SDCI_ARGUMENT 0x04 /* argument reg */ -+#define SDCI_COMMAND 0x08 /* command reg */ -+#define SDCI_CLOCK_D 0x0C /* clock divide reg */ -+#define SDCI_SOFTWARE 0x10 /* controller reset reg */ -+#define SDCI_POWER 0X14 /* POWRE CONTROL REG */ -+#define SDCI_TIMEOUT_CMD 0x18 /* cmd timeout config reg */ -+#define SDCI_TIMEOUT_DATA 0x1C /* data timeout reg */ -+#define SDCI_NORMAL_ISER 0x20 /* normal ISR config reg */ -+#define SDCI_ERROR_ISER 0x24 /* erroe ISR config reg */ -+#define SDCI_BD_ISER 0x28 /* BD ISR config reg */ -+#define SDCI_CAPA 0x2C /* BD ISR config reg */ -+#define SDCI_SD_DRV 0x30 /* SD card driving phase position reg */ -+#define SDCI_SD_SAMP 0x34 /* SD card sampling phase position reg */ -+#define SDCI_SD_SEN 0x38 /* SD card detection reg */ -+#define SDCI_HDS_AXI 0x3C /* AXI boundary config reg */ -+#define SDCI_BD_RX 0x40 /* BD rx addr reg */ -+#define SDCI_BD_TX 0x60 /* BD tx addr reg */ -+#define SDCI_BLK_CNT 0x80 /* r/w block num reg */ -+#define SDCI_NORMAL_ISR 0xC0 /* normal ISR status reg */ -+#define SDCI_ERROR_ISR 0xC4 /* error ISR status reg */ -+#define SDCI_BD_ISR 0xC8 /* BD ISR status reg */ -+#define SDCI_BD_STATUS 0xCC /* BD descriptor status reg */ -+#define SDCI_STATUS 0xD0 /* status reg */ -+#define SDCI_BLOCK 0xD4 /* block len reg */ -+#define SDCI_RESP0 0xE0 /* response reg0 */ -+#define SDCI_RESP1 0xE4 /* response reg1 */ -+#define SDCI_RESP2 0xE8 /* response reg2 */ -+#define SDCI_RESP3 0XEC /* response reg3 */ -+ -+/*---------------------------------------------------------------------------*/ -+/* Register Mask */ -+/*---------------------------------------------------------------------------*/ -+/* SDCI_CONTROLLER mask */ -+#define SDCI_CONTROLLER_ECRCWR (0x1 << 0) /* RW */ -+#define SDCI_CONTROLLER_ECRCRD (0x1 << 1) /* RW */ -+#define SDCI_CONTROLLER_RESEDE (0x1 << 2) /* RW */ -+#define SDCI_CONTROLLER_PERMDR (0x3 << 8) /* RW */ -+#define SDCI_CONTROLLER_PERMDX (0x3 << 10) /* RW */ -+ -+/* SDCI_SOFTWARE mask */ -+#define SDCI_SOFTWARE_SRST (0x1 << 0) /* RW */ -+#define SDCI_SOFTWARE_SCRST (0x1 << 1) /* RW */ -+#define SDCI_SOFTWARE_BDRST (0x1 << 2) /* RW */ -+#define SDCI_SOFTWARE_CFCLF (0x1 << 3) /* RW */ -+#define SDCI_SOFTWARE_SDRST (0x1 << 4) /* RW */ -+ -+/* SDCI_NORMAL_ISER mask */ -+#define SDCI_SDCI_NORMAL_ISER_ECC_EN (0x1 << 0) /* RW */ -+#define SDCI_SDCI_NORMAL_ISER_ECR (0x1 << 1) /* RW */ -+#define SDCI_SDCI_NORMAL_ISER_ECI (0x1 << 2) /* RW */ -+#define SDCI_SDCI_NORMAL_ISER_EEI_EN (0x1 << 15) /* RW */ -+ -+/* SDCI_NORMAL_ISR mask */ -+#define SDCI_NORMAL_ISR_CC (0x1 << 0) /* R */ -+#define SDCI_NORMAL_ISR_CR (0x1 << 1) /* R */ -+#define SDCI_NORMAL_ISR_CI (0x1 << 2) /* R */ -+#define SDCI_NORMAL_ISR_TIMEOUT (0x1 << 3) /* R */ -+#define SDCI_NORMAL_ISR_EI (0x1 << 15) /* R */ -+ -+/* SDCI_ERROR_ISER mask */ -+#define SDCI_ERROR_ISER_ECTE_EN (0x1 << 0) /* RW */ -+#define SDCI_ERROR_ISR_CCRCE_EN (0x1 << 1) /* RW */ -+#define SDCI_ERROR_ISR_CIR_EN (0x1 << 3) /* RW */ -+#define SDCI_ERROR_ISR_CNR_EN (0x1 << 4) /* RW */ -+/* SDCI_ERROR_ISR mask */ -+#define SDCI_ERROR_ISR_CTE (0x1 << 0) /* R */ -+#define SDCI_ERROR_ISR_CCRCE (0x1 << 1) /* R */ -+#define SDCI_ERROR_ISR_CIR (0x1 << 3) /* R */ -+#define SDCI_ERROR_ISR_CNR (0x1 << 4) /* R */ -+ -+/* SDCI_BD_ISER mask */ -+#define SDCI_BD_ISER_ETRS_EN (0x1 << 8) /* RW */ -+#define SDCI_BD_ISER_DATFRAX_EN (0x1 << 7) /* RW */ -+ -+/* SDCI_BD_ISR mask */ -+#define SDCI_BD_ISR_TRS_W (0x1 << 0) /* R */ -+#define SDCI_BD_ISR_TRS_R (0x1 << 8) /* R */ -+#define SDCI_BD_ISR_EDTE (0x1 << 3) /* R */ -+#define SDCI_BD_ISR_DAIS (0x1 << 15) /* R */ -+#define SDCI_BD_ISR_DATFRAX (0x1 << 7) /* R */ -+ -+/* SDCI_HDS_AXI mask */ -+#define SDCI_HDS_AXI_AWDOMAIN (0x1 << 0) /* RW */ -+#define SDCI_HDS_AXI_ARDOMAIN (0x1 << 12) /* RW */ -+#define SDCI_HDS_AXI_AWCACHE (0x6 << 24) /* RW */ -+#define SDCI_HDS_AXI_ARCACHE (0xB << 28) /* RW */ -+ -+/* SDCI_STATUS mask */ -+#define SDCI_STATUS_CMD_BUSY (0x0 << 0) /* R */ -+#define SDCI_STATUS_CMD_READY (0x1 << 0) /* R */ -+#define SDCI_STATUS_IDIE (0x1 << 12) /* R */ -+#define SDCI_CARD_BUSY_IN_PRG (0x1 << 20) /* R D0 BUSY:0,IDLE:1 */ -+ -+/* SDCI_STATUS */ -+#define SDCI_STATUS_CDSL (0x1 << 19) /* R */ -+ -+/*---------------------------------------------------------------------------*/ -+/* Register Value */ -+/*---------------------------------------------------------------------------*/ -+#define SDCI_SD_DRV_VALUE 0 -+#define SDCI_SD_SAMP_VALUE_MAX 50 -+#define SDCI_SD_SAMP_VALUE_MIN 0 -+ -+#define SDCI_TIMEOUT_CMD_VALUE 0xFFFFFFFF -+#define SDCI_TIMEOUT_DATA_VALUE 0xFFFFFFFF -+#define SDCI_POWER_ON 1 -+#define SDCI_POWER_OFF 0 -+ -+#define SDCI_CMD_TIMEOUT 10 -+#define SDCI_DAT_TIMEOUT 5000 -+ -+#define SDCI_CMD_TYPE_ADTC 0x2 -+ -+#define SDCI_F_MIN 400000 -+#define SDCI_F_MAX 25000000 -+ -+#define SDCI_SEN_CREFR_VAL (0x1 << 1) -+#define SDCI_SEN_DEBNCE_VAL (0xB << 8) -+ -+#define CARD_CURRENT_STATE (0xF << 9) -+#define CARD_PRG_STATE (0x7 << 9) -+#define CARD_TRAN_STATE (0x4 << 9) -+ -+#define SDCI_CMD13_OK 1 -+#define SDCI_CMD13_FAILED 0 -+ -+#define ERR_TIMEOUT (0x1 << 0) -+#define ERR_CARD_ABSENT (0x1 << 1) -+#define ERR_CMD_RESPONED (0x1 << 2) -+ -+/*---------------------------------------------------------------------------*/ -+/* Structure Type */ -+/*---------------------------------------------------------------------------*/ -+struct phytium_sdci_dma { -+ struct scatterlist *sg; -+ u32 *buf; -+ dma_addr_t bd_addr; -+ size_t bytes; -+}; -+ -+enum adtc_type { -+ COMMOM_ADTC = 0, -+ BLOCK_RW_ADTC = 1 -+}; -+ -+struct phytium_sdci_host { -+ struct device *dev; -+ struct mmc_host *mmc; -+ u32 caps; -+ spinlock_t lock; -+ -+ struct mmc_request *mrq; -+ struct mmc_command *cmd; -+ struct mmc_data *data; -+ int error; -+ -+ void __iomem *base; -+ -+ struct phytium_sdci_dma dma_rx; -+ struct phytium_sdci_dma dma_tx; -+ -+ u32 *sg_virt_addr; -+ enum adtc_type adtc_type; -+ -+ struct timer_list hotplug_timer; -+ -+ struct delayed_work req_timeout; -+ u32 cmd_timeout; -+ u32 data_timeout; -+ -+ int irq; -+ int irq_err; -+ int irq_bd; -+ -+ struct clk *src_clk; -+ unsigned long clk_rate; -+ unsigned long clk_div; -+ unsigned long real_rate; -+ -+ u32 current_rca; -+ bool is_multi_rw_only_one_blkcnt; -+}; -+ -diff --git a/drivers/mtd/mtdcore.c b/drivers/mtd/mtdcore.c -index 9bd661be3..a1911ac53 100644 ---- a/drivers/mtd/mtdcore.c -+++ b/drivers/mtd/mtdcore.c -@@ -742,7 +742,8 @@ int add_mtd_device(struct mtd_info *mtd) - dev_set_name(&mtd->dev, "mtd%d", i); - dev_set_drvdata(&mtd->dev, mtd); - mtd_check_of_node(mtd); -- of_node_get(mtd_get_of_node(mtd)); -+ if (mtd->dev.of_node) -+ of_node_get(mtd_get_of_node(mtd)); - error = device_register(&mtd->dev); - if (error) { - put_device(&mtd->dev); -@@ -903,7 +904,8 @@ static struct nvmem_device *mtd_otp_nvmem_register(struct mtd_info *mtd, - config.ignore_wp = true; - config.reg_read = reg_read; - config.size = size; -- config.of_node = np; -+ if (IS_ENABLED(CONFIG_OF)) -+ config.of_node = np; - config.priv = mtd; - - nvmem = nvmem_register(&config); -@@ -911,7 +913,8 @@ static struct nvmem_device *mtd_otp_nvmem_register(struct mtd_info *mtd, - if (IS_ERR(nvmem) && PTR_ERR(nvmem) == -EOPNOTSUPP) - nvmem = NULL; - -- of_node_put(np); -+ if (IS_ENABLED(CONFIG_OF)) -+ of_node_put(np); - - return nvmem; - } -diff --git a/drivers/mtd/mtdpart.c b/drivers/mtd/mtdpart.c -index 23483db8f..17a44b31c 100644 ---- a/drivers/mtd/mtdpart.c -+++ b/drivers/mtd/mtdpart.c -@@ -19,6 +19,8 @@ - #include - #include - -+#include -+#include - #include "mtdcore.h" - - /* -@@ -504,12 +506,14 @@ EXPORT_SYMBOL_GPL(deregister_mtd_parser); - static const char * const default_mtd_part_types[] = { - "cmdlinepart", - "ofpart", -+ "acpipart", - NULL - }; - - /* Check DT only when looking for subpartitions. */ - static const char * const default_subpartition_types[] = { - "ofpart", -+ "acpipart", - NULL - }; - -@@ -573,6 +577,44 @@ static struct mtd_part_parser *mtd_part_get_compatible_parser(const char *compat - return ret; - } - -+static int mtd_part_acpi_parse(struct mtd_info *master, -+ struct mtd_partitions *pparts) -+{ -+ struct mtd_part_parser *parser; -+ struct acpi_device *adev; -+ struct fwnode_handle *child; -+ const char *compat = NULL; -+ const char *fixed = "acpi-partitions"; -+ int ret, err = 0; -+ int compare = 1; -+ struct device *dev = &master->dev; -+ -+ if (has_acpi_companion(dev)) -+ adev = ACPI_COMPANION(dev); -+ if (!mtd_is_partition(master)) { -+ fwnode_property_read_string(dev->fwnode, "fixed", &compat); -+ if (compat) -+ compare = strcmp(compat, fixed); -+ } -+ -+ device_for_each_child_node(dev, child) { -+ if (compat && !compare) { -+ parser = mtd_part_parser_get(fixed); -+ if (!parser && !request_module("%s", fixed)) -+ parser = mtd_part_parser_get(fixed); -+ if (parser) { -+ ret = mtd_part_do_parse(parser, master, pparts, NULL); -+ if (ret > 0) -+ return ret; -+ mtd_part_parser_put(parser); -+ if (ret < 0 && !err) -+ err = ret; -+ } -+ } -+ } -+ return err; -+} -+ - static int mtd_part_of_parse(struct mtd_info *master, - struct mtd_partitions *pparts) - { -@@ -591,7 +633,7 @@ static int mtd_part_of_parse(struct mtd_info *master, - dev = master->dev.parent; - - np = mtd_get_of_node(master); -- if (mtd_is_partition(master)) -+ if (mtd_is_partition(master) && np) - of_node_get(np); - else - np = of_get_child_by_name(np, "partitions"); -@@ -612,7 +654,8 @@ static int mtd_part_of_parse(struct mtd_info *master, - ret = mtd_part_do_parse(parser, master, pparts, NULL); - if (ret > 0) { - of_platform_populate(np, NULL, NULL, dev); -- of_node_put(np); -+ if (np) -+ of_node_put(np); - return ret; - } - mtd_part_parser_put(parser); -@@ -620,7 +663,8 @@ static int mtd_part_of_parse(struct mtd_info *master, - err = ret; - } - of_platform_populate(np, NULL, NULL, dev); -- of_node_put(np); -+ if (np) -+ of_node_put(np); - - /* - * For backward compatibility we have to try the "fixed-partitions" -@@ -678,7 +722,9 @@ int parse_mtd_partitions(struct mtd_info *master, const char *const *types, - * should be used. It requires a bit different logic so it is - * handled in a separated function. - */ -- if (!strcmp(*types, "ofpart")) { -+ if (!strcmp(*types, "acpipart")) { -+ ret = mtd_part_acpi_parse(master, &pparts); -+ } else if (!strcmp(*types, "ofpart")) { - ret = mtd_part_of_parse(master, &pparts); - } else { - pr_debug("%s: parsing partitions %s\n", master->name, -diff --git a/drivers/mtd/nand/raw/Kconfig b/drivers/mtd/nand/raw/Kconfig -index cbf8ae85e..10b9f7a41 100644 ---- a/drivers/mtd/nand/raw/Kconfig -+++ b/drivers/mtd/nand/raw/Kconfig -@@ -150,6 +150,25 @@ config MTD_NAND_ORION - No board specific support is done by this driver, each board - must advertise a platform_device for the driver to attach. - -+config MTD_NAND_PHYTIUM -+ tristate -+ -+config MTD_NAND_PHYTIUM_PCI -+ tristate "Support Phytium NAND controller as a PCI device" -+ select MTD_NAND_PHYTIUM -+ depends on PCI -+ help -+ Enable the driver for NAND flash controller of Phytium Px210 chipset, -+ using the Phytium NAND controller core. -+ -+config MTD_NAND_PHYTIUM_PLAT -+ tristate "Support Phytium NAND controller as a platform device" -+ select MTD_NAND_PHYTIUM -+ depends on ARCH_PHYTIUM -+ help -+ Enable the driver for NAND flash controller of Phytium CPU chipset, -+ using the Phytium NAND controller core. -+ - config MTD_NAND_MARVELL - tristate "Marvell EBU NAND controller" - depends on PXA3xx || ARCH_MMP || PLAT_ORION || ARCH_MVEBU || \ -diff --git a/drivers/mtd/nand/raw/Makefile b/drivers/mtd/nand/raw/Makefile -index 25120a4af..0898acbe1 100644 ---- a/drivers/mtd/nand/raw/Makefile -+++ b/drivers/mtd/nand/raw/Makefile -@@ -57,6 +57,9 @@ obj-$(CONFIG_MTD_NAND_INTEL_LGM) += intel-nand-controller.o - obj-$(CONFIG_MTD_NAND_ROCKCHIP) += rockchip-nand-controller.o - obj-$(CONFIG_MTD_NAND_PL35X) += pl35x-nand-controller.o - obj-$(CONFIG_MTD_NAND_RENESAS) += renesas-nand-controller.o -+obj-$(CONFIG_MTD_NAND_PHYTIUM) += phytium_nand.o -+obj-$(CONFIG_MTD_NAND_PHYTIUM_PCI) += phytium_nand_pci.o -+obj-$(CONFIG_MTD_NAND_PHYTIUM_PLAT) += phytium_nand_plat.o - - nand-objs := nand_base.o nand_legacy.o nand_bbt.o nand_timings.o nand_ids.o - nand-objs += nand_onfi.o -diff --git a/drivers/mtd/nand/raw/phytium_nand.c b/drivers/mtd/nand/raw/phytium_nand.c -new file mode 100644 -index 000000000..2763455f3 ---- /dev/null -+++ b/drivers/mtd/nand/raw/phytium_nand.c -@@ -0,0 +1,2089 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Core driver for Phytium NAND flash controller -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "phytium_nand.h" -+ -+u16 timing_asy_mode0[TIMING_ASY_NUM] = { /* x100 pass, sample: 1 */ -+ 0x03, 0x03, 0x28, 0x28, 0x03, 0x03, 0x06, 0x06, 0x28, 0x70, 0x30, 0x50}; -+u16 timing_asy_mode1[TIMING_ASY_NUM] = { /* x100 pass, sample: 1 */ -+ 0x03, 0x03, 0x14, 0x14, 0x03, 0x03, 0x06, 0x06, 0x14, 0x70, 0x30, 0x28}; -+u16 timing_asy_mode2[TIMING_ASY_NUM] = { /* x100 pass, sample: 7/8 (unlic) */ -+ 0x03, 0x03, 0x0D, 0x0D, 0x03, 0x03, 0x06, 0x06, 0x0D, 0x70, 0x20, 0x1A}; -+u16 timing_asy_mode3[TIMING_ASY_NUM] = { /* x100 pass, sample: 4-7 */ -+ 0x03, 0x03, 0x0A, 0x0A, 0x03, 0x03, 0x06, 0x06, 0x0A, 0x70, 0x20, 0x14}; -+u16 timing_asy_mode4[TIMING_ASY_NUM] = { /* x100 1.8v pass */ -+ 0x03, 0x03, 0x08, 0x08, 0x03, 0x03, 0x06, 0x06, 0x08, 0x70, 0x15, 0x10}; -+u16 timing_asy_mode5[TIMING_ASY_NUM] = { /* x100 1.8v pass */ -+ 0x03, 0x03, 0x07, 0x07, 0x03, 0x03, 0x06, 0x06, 0x07, 0x20, 0x15, 0x0E}; -+u16 timing_syn_mode0[TIMING_SYN_NUM] = { /* x100 1.8v pass */ -+ 0x20, 0x41, 0x05, 0x20, 0x10, 0x19, 0x62, 0x40, 0x38, 0x20, 0x00, 0x09, -+ 0x50, 0x20}; -+u16 timing_syn_mode1[TIMING_SYN_NUM] = { /* x100 1.8v pass */ -+ 0x18, 0x32, 0x06, 0x18, 0x0C, 0x10, 0x76, 0x40, 0x2A, 0x1E, 0x00, 0x12, -+ 0x24, 0x18}; -+u16 timing_syn_mode2[TIMING_SYN_NUM] = { /* x100 1.8v pass */ -+ 0x10, 0x0A, 0x04, 0x10, 0x08, 0x0A, 0x6E, 0x50, 0x1D, 0x10, 0x00, 0x0C, -+ 0x18, 0x10}; -+u16 timing_syn_mode3[TIMING_SYN_NUM] = { /* x100 1.8v pass */ -+ 0x0C, 0x1A, 0x02, 0x0C, 0x06, 0x08, 0x78, 0x7C, 0x15, 0x0C, 0x00, 0x08, -+ 0x12, 0x0C}; -+u16 timing_syn_mode4[TIMING_SYN_NUM] = { /* x100 1.8v failed */ -+ 0x08, 0x17, 0x05, 0x08, 0x04, 0x01, 0x73, 0x40, 0x0C, 0x08, 0x00, 0x06, -+ 0x0C, 0x10}; -+u16 timing_tog_ddr_mode0[TIMING_TOG_NUM] = { /* 600M clk */ -+ 0x14, 0x0a, 0x08, 0x08, 0xc8, 0xc8, 0x08, 0x08, 0x20, 0x0a, 0x14, 0x08}; -+ -+static u32 nfc_ecc_errover; -+static u32 nfc_ecc_err; -+static u32 nfc_irq_st; -+static u32 nfc_irq_en; -+static u32 nfc_irq_complete; -+ -+static DECLARE_WAIT_QUEUE_HEAD(wait_done); -+ -+/* -+ * Internal helper to conditionnally apply a delay (from the above structure, -+ * most of the time). -+ */ -+static void cond_delay(unsigned int ns) -+{ -+ if (!ns) -+ return; -+ -+ if (ns < 10000) -+ ndelay(ns); -+ else -+ udelay(DIV_ROUND_UP(ns, 1000)); -+} -+ -+static inline struct phytium_nfc *to_phytium_nfc(struct nand_controller *ctrl) -+{ -+ return container_of(ctrl, struct phytium_nfc, controller); -+} -+ -+static inline struct phytium_nand_chip *to_phytium_nand(struct nand_chip *chip) -+{ -+ return container_of(chip, struct phytium_nand_chip, chip); -+} -+ -+static u32 phytium_read(struct phytium_nfc *nfc, u32 reg) -+{ -+ return readl_relaxed(nfc->regs + reg); -+} -+ -+static void phytium_write(struct phytium_nfc *nfc, u32 reg, u32 value) -+{ -+ return writel_relaxed(value, nfc->regs + reg); -+} -+ -+static inline int phytium_wait_busy(struct phytium_nfc *nfc) -+{ -+ u32 status; -+ -+ if (nfc_ecc_errover) { -+ nfc_ecc_errover = 0; -+ return 0; -+ } -+ -+ return readl_relaxed_poll_timeout(nfc->regs + NDSR, status, -+ !(status & NDSR_BUSY), 10, 10000); -+} -+ -+static void phytium_nfc_disable_int(struct phytium_nfc *nfc, u32 int_mask) -+{ -+ u32 reg; -+ -+ reg = phytium_read(nfc, NDIR_MASK); -+ phytium_write(nfc, NDIR_MASK, reg | int_mask); -+} -+ -+static void phytium_nfc_enable_int(struct phytium_nfc *nfc, u32 int_mask) -+{ -+ u32 reg; -+ -+ reg = phytium_read(nfc, NDIR_MASK); -+ phytium_write(nfc, NDIR_MASK, reg & (~int_mask)); -+} -+ -+static void phytium_nfc_clear_int(struct phytium_nfc *nfc, u32 int_mask) -+{ -+ phytium_write(nfc, NDIR_MASK, int_mask); -+} -+ -+static int phytium_nfc_cmd_correct(struct phytium_nfc_op *nfc_op) -+{ -+ if (!nfc_op) -+ return -EINVAL; -+ -+ if (nfc_op->cmd_len == 0x01) { -+ nfc_op->cmd[1] = nfc_op->cmd[0]; -+ nfc_op->cmd[0] = 0; -+ } -+ -+ return 0; -+} -+ -+static int phytium_nfc_addr_correct(struct phytium_nfc_op *nfc_op) -+{ -+ u32 len; -+ int i, j; -+ -+ if (!nfc_op) -+ return -EINVAL; -+ -+ len = nfc_op->addr_len > PHYTIUM_NFC_ADDR_MAX_LEN ? -+ PHYTIUM_NFC_ADDR_MAX_LEN : nfc_op->addr_len; -+ -+ if (len == PHYTIUM_NFC_ADDR_MAX_LEN) -+ return 0; -+ -+ for (i = len-1, j = PHYTIUM_NFC_ADDR_MAX_LEN - 1; i >= 0; i--, j--) { -+ nfc_op->addr[j] = nfc_op->addr[i]; -+ nfc_op->addr[i] = 0; -+ } -+ -+ return 0; -+} -+ -+static void phytium_nfc_parse_instructions(struct nand_chip *chip, -+ const struct nand_subop *subop, -+ struct phytium_nfc_op *nfc_op) -+{ -+ struct nand_op_instr *instr = NULL; -+ bool first_cmd = true; -+ u32 op_id; -+ int i; -+ -+ /* Reset the input structure as most of its fields will be OR'ed */ -+ memset(nfc_op, 0, sizeof(struct phytium_nfc_op)); -+ -+ for (op_id = 0; op_id < subop->ninstrs; op_id++) { -+ unsigned int offset, naddrs; -+ const u8 *addrs; -+ int len; -+ -+ instr = (struct nand_op_instr *)&subop->instrs[op_id]; -+ -+ switch (instr->type) { -+ case NAND_OP_CMD_INSTR: -+ if (first_cmd) { -+ nfc_op->cmd[0] = instr->ctx.cmd.opcode; -+ } else { -+ nfc_op->cmd[1] = instr->ctx.cmd.opcode; -+ nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; -+ } -+ -+ nfc_op->cle_ale_delay_ns = instr->delay_ns; -+ first_cmd = false; -+ nfc_op->cmd_len++; -+ -+ break; -+ -+ case NAND_OP_ADDR_INSTR: -+ offset = nand_subop_get_addr_start_off(subop, op_id); -+ naddrs = nand_subop_get_num_addr_cyc(subop, op_id); -+ addrs = &instr->ctx.addr.addrs[offset]; -+ -+ nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = naddrs; -+ -+ for (i = 0; i < min_t(u32, PHYTIUM_NFC_ADDR_MAX_LEN, naddrs); i++) -+ nfc_op->addr[i] = addrs[i]; -+ -+ nfc_op->cle_ale_delay_ns = instr->delay_ns; -+ -+ nfc_op->addr_len = naddrs; -+ break; -+ -+ case NAND_OP_DATA_IN_INSTR: -+ nfc_op->data_instr = instr; -+ nfc_op->data_instr_idx = op_id; -+ nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; -+ len = nand_subop_get_data_len(subop, op_id); -+ nfc_op->page_cnt = len; -+ nfc_op->data_delay_ns = instr->delay_ns; -+ -+ break; -+ -+ case NAND_OP_DATA_OUT_INSTR: -+ nfc_op->data_instr = instr; -+ nfc_op->data_instr_idx = op_id; -+ nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; -+ len = nand_subop_get_data_len(subop, op_id); -+ nfc_op->page_cnt = len; -+ nfc_op->data_delay_ns = instr->delay_ns; -+ break; -+ -+ case NAND_OP_WAITRDY_INSTR: -+ nfc_op->rdy_timeout_ms = instr->ctx.waitrdy.timeout_ms; -+ nfc_op->rdy_delay_ns = instr->delay_ns; -+ break; -+ } -+ } -+} -+ -+int phytium_nfc_prepare_cmd(struct nand_chip *chip, -+ struct phytium_nfc_op *nfc_op, -+ enum dma_data_direction direction) -+{ -+ struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ int i; -+ -+ phytium_nfc_cmd_correct(nfc_op); -+ phytium_nfc_addr_correct(nfc_op); -+ -+ nfc_op->cmd_ctrl.nfc_ctrl.csel = 0x0F ^ (0x01 << phytium_nand->selected_die); -+ -+ for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) -+ nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_prepare_cmd); -+ -+int phytium_nfc_send_cmd(struct nand_chip *chip, -+ struct phytium_nfc_op *nfc_op) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 value = 0; -+ -+ memset((u8 *)nfc->dsp_addr, 0, PAGE_SIZE); -+ memcpy((u8 *)nfc->dsp_addr, (u8 *)nfc_op, PHYTIUM_NFC_DSP_SIZE); -+ -+ if (phytium_wait_busy(nfc) != 0) { -+ dev_err(nfc->dev, "NFC was always busy\n"); -+ dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); -+ dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); -+ return 0; -+ } -+ -+ spin_lock(&nfc->spinlock); -+ value = nfc->dsp_phy_addr & 0xFFFFFFFF; -+ phytium_write(nfc, NDAR0, value); -+ -+ /* Don't modify NDAR1_DMA_RLEN & NDAR1_DMA_WLEN */ -+ value = phytium_read(nfc, NDAR1); -+ value |= NDAR1_H8((nfc->dsp_phy_addr >> 32) & 0xFF); -+ phytium_write(nfc, NDAR1, value); -+ -+ phytium_nfc_enable_int(nfc, NDIR_CMD_FINISH_MASK); -+ -+ value |= NDAR1_DMA_EN; -+ phytium_write(nfc, NDAR1, value); -+ spin_unlock(&nfc->spinlock); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_send_cmd); -+ -+int phytium_nfc_prepare_cmd2(struct nand_chip *chip, -+ struct phytium_nfc_op *nfc_op, -+ enum dma_data_direction direction, -+ u32 cmd_num) -+{ -+ struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); -+ int i; -+ -+ for (i = 0; i < cmd_num; i++) { -+ phytium_nfc_cmd_correct(nfc_op); -+ phytium_nfc_addr_correct(nfc_op); -+ nfc_op->cmd_ctrl.nfc_ctrl.csel = 0x0F ^ (0x01 << phytium_nand->selected_die); -+ nfc_op++; -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_prepare_cmd2); -+ -+int phytium_nfc_send_cmd2(struct nand_chip *chip, -+ struct phytium_nfc_op *nfc_op, -+ u32 cmd_num) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 value = 0; -+ int i; -+ -+ memset((u8 *)nfc->dsp_addr, 0, PAGE_SIZE); -+ -+ for (i = 0; i < cmd_num; i++) { -+ memcpy((u8 *)nfc->dsp_addr + i*PHYTIUM_NFC_DSP_SIZE, -+ (u8 *)nfc_op, PHYTIUM_NFC_DSP_SIZE); -+ nfc_op++; -+ } -+ -+ if (phytium_wait_busy(nfc) != 0) { -+ dev_err(nfc->dev, "NFC was always busy\n"); -+ dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); -+ dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); -+ return 0; -+ } -+ -+ spin_lock(&nfc->spinlock); -+ value = nfc->dsp_phy_addr & 0xFFFFFFFF; -+ phytium_write(nfc, NDAR0, value); -+ -+ /* Don't modify NDAR1_DMA_RLEN & NDAR1_DMA_WLEN */ -+ value = phytium_read(nfc, NDAR1); -+ value |= NDAR1_H8((nfc->dsp_phy_addr >> 32) & 0xFF); -+ phytium_write(nfc, NDAR1, value); -+ -+ phytium_nfc_enable_int(nfc, NDIR_DMA_FINISH_MASK | NDIR_ECC_ERR_MASK); -+ -+ value |= NDAR1_DMA_EN; -+ phytium_write(nfc, NDAR1, value); -+ spin_unlock(&nfc->spinlock); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_send_cmd2); -+ -+int phytium_nfc_wait_op(struct nand_chip *chip, -+ u32 timeout_ms) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ int ret; -+ -+ /* Timeout is expressed in ms */ -+ if (!timeout_ms) -+ timeout_ms = IRQ_TIMEOUT; -+ else if (timeout_ms > 1000) -+ timeout_ms = 1000; -+ else if (timeout_ms < 100) -+ timeout_ms = 100; -+ -+ ret = wait_event_interruptible_timeout(wait_done, nfc_irq_complete, -+ msecs_to_jiffies(timeout_ms)); -+ nfc_irq_complete = false; -+ if (!ret) { -+ dev_err(nfc->dev, "Timeout waiting for RB signal\n"); -+ dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); -+ dev_err(nfc->dev, "NFC irq state: %x, irq en:%x\n", -+ phytium_read(nfc, NDIR), phytium_read(nfc, NDIR_MASK)); -+ dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); -+ -+ phytium_nfc_clear_int(nfc, NDIR_ALL_INT(nfc->caps->int_mask_bits)); -+ return -ETIMEDOUT; -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_wait_op); -+ -+static int phytium_nfc_xfer_data_pio(struct phytium_nfc *nfc, -+ const struct nand_subop *subop, -+ struct phytium_nfc_op *nfc_op) -+{ -+ const struct nand_op_instr *instr = nfc_op->data_instr; -+ unsigned int op_id = nfc_op->data_instr_idx; -+ unsigned int len = nand_subop_get_data_len(subop, op_id); -+ unsigned int offset = nand_subop_get_data_start_off(subop, op_id); -+ bool reading = (instr->type == NAND_OP_DATA_IN_INSTR); -+ -+ if (reading) { -+ u8 *in = instr->ctx.data.buf.in + offset; -+ -+ memcpy(in, nfc->dma_buf, len); -+ -+ nfc->dma_offset = 0; -+ } else { -+ const u8 *out = instr->ctx.data.buf.out + offset; -+ -+ memcpy(nfc->dma_buf, out, len); -+ } -+ -+ return 0; -+} -+ -+static int memcpy_to_reg16(struct phytium_nfc *nfc, u32 reg, u16 *buf, size_t len) -+{ -+ int i; -+ u32 val = 0; -+ -+ if (!nfc || !buf || (len >= 16)) -+ return -EINVAL; -+ -+ for (i = 0; i < len; i++) { -+ val = (val << 16) + buf[i]; -+ if (i % 2) { -+ phytium_write(nfc, reg, val); -+ val = 0; -+ reg += 4; -+ } -+ } -+ -+ return 0; -+} -+ -+int phytium_nfc_default_data_interface(struct phytium_nfc *nfc) -+{ -+ int value; -+ -+ value = phytium_read(nfc, NDCR0); -+ value &= (~NDCR0_IN_MODE(3)); -+ value |= NDCR0_IN_MODE(nfc->inter_mode); -+ phytium_write(nfc, NDCR0, value); -+ -+ value = phytium_read(nfc, NDCR1); -+ value &= (~NDCR1_SAMPL_PHASE(0xFFFF)); -+ -+ switch (nfc->inter_mode) { -+ case ASYN_SDR: -+ if (nfc->timing_mode == ASY_MODE4) { -+ memcpy_to_reg16(nfc, NDTR0, timing_asy_mode4, TIMING_ASY_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(4)); -+ } else if (nfc->timing_mode == ASY_MODE3) { -+ memcpy_to_reg16(nfc, NDTR0, timing_asy_mode3, TIMING_ASY_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(5)); -+ } else if (nfc->timing_mode == ASY_MODE2) { -+ memcpy_to_reg16(nfc, NDTR0, timing_asy_mode2, TIMING_ASY_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(3)); -+ } else if (nfc->timing_mode == ASY_MODE1) { -+ memcpy_to_reg16(nfc, NDTR0, timing_asy_mode1, TIMING_ASY_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(2)); -+ } else { -+ memcpy_to_reg16(nfc, NDTR0, timing_asy_mode0, TIMING_ASY_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(1)); -+ } -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x01); -+ break; -+ case ONFI_DDR: -+ if (nfc->timing_mode == SYN_MODE4) { -+ memcpy_to_reg16(nfc, NDTR6, timing_syn_mode4, TIMING_SYN_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x0D)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x30); -+ } else if (nfc->timing_mode == SYN_MODE3) { -+ memcpy_to_reg16(nfc, NDTR6, timing_syn_mode3, TIMING_SYN_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x05)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x18); -+ } else if (nfc->timing_mode == SYN_MODE2) { -+ memcpy_to_reg16(nfc, NDTR6, timing_syn_mode2, TIMING_SYN_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x08)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x20); -+ } else if (nfc->timing_mode == SYN_MODE1) { -+ memcpy_to_reg16(nfc, NDTR6, timing_syn_mode1, TIMING_SYN_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x12)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x40); -+ } else { -+ memcpy_to_reg16(nfc, NDTR6, timing_syn_mode0, TIMING_SYN_NUM); -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x12)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0x40); -+ } -+ break; -+ case TOG_ASYN_DDR: -+ phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(8)); -+ phytium_write(nfc, ND_INTERVAL_TIME, 0xC8); -+ memcpy_to_reg16(nfc, NDTR13, timing_tog_ddr_mode0, TIMING_TOG_NUM); -+ break; -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_default_data_interface); -+ -+static int phytium_nfc_naked_waitrdy_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ int ret = 0; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ -+ dev_info(nfc->dev, "Phytium nand command 0x%02x 0x%02x.\n", -+ nfc_op.cmd[0], nfc_op.cmd[1]); -+ -+ switch (nfc_op.cmd[0]) { -+ case NAND_CMD_PARAM: -+ memset(nfc->dma_buf, 0, PAGE_SIZE); -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_PARAM; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ if (nfc->inter_pro == NAND_ONFI) -+ nfc_op.page_cnt = 3 * sizeof(struct nand_onfi_params); -+ else if (nfc->inter_pro == NAND_JEDEC) -+ nfc_op.page_cnt = 3 * sizeof(struct nand_jedec_params); -+ if (nfc_op.page_cnt) -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc->dma_offset = 0; -+ break; -+ case NAND_CMD_SET_FEATURES: -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_SET_FTR; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ if (nfc->inter_mode != ASYN_SDR) { -+ dev_err(nfc->dev, "Not support SET_FEATURES command!\n"); -+ return 0; -+ } -+ break; -+ case NAND_CMD_GET_FEATURES: -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_GET_FTR; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ break; -+ case NAND_CMD_READ0: -+ if (nfc_op.cmd[1] == NAND_CMD_READSTART) { /* large page */ -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ } else if (nfc_op.cmd[1] == NAND_CMD_SEQIN) { /* program page begin */ -+ nfc_op.cmd[0] = NAND_CMD_SEQIN; -+ nfc_op.cmd[1] = NAND_CMD_PAGEPROG; -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ } else { /* small page */ -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ } -+ break; -+ case NAND_CMD_RNDOUT: /* change read column */ -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ break; -+ case NAND_CMD_READSTART: /* large page */ -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ break; -+ case NAND_CMD_RNDOUTSTART: /* change read column */ -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc->dma_offset = nfc_op.addr[1]; -+ nfc->dma_offset = (nfc->dma_offset << 8) + nfc_op.addr[0]; -+ break; -+ case NAND_CMD_SEQIN: /* program begin */ -+ if (nfc_op.cmd[0] == NAND_CMD_READ0) { -+ nfc_op.cmd[0] = NAND_CMD_SEQIN; -+ nfc_op.cmd[1] = NAND_CMD_PAGEPROG; -+ } -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ break; -+ case NAND_CMD_RNDIN: /* change write column */ -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_WR_COL; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ break; -+ case NAND_CMD_PAGEPROG: /* program end */ -+ nfc_op.cmd[0] = NAND_CMD_RNDIN; -+ nfc_op.cmd[1] = NAND_CMD_PAGEPROG; -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ break; -+ default: -+ dev_err(nfc->dev, "Not support cmd %d.\n", nfc_op.cmd[1]); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ if ((nfc_op.data_instr) && (direction == DMA_TO_DEVICE)) -+ phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); -+ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ nfc_op.rdy_timeout_ms = nfc_op.rdy_timeout_ms; -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ goto out; -+ -+ cond_delay(nfc_op.rdy_delay_ns); -+ -+ if ((nfc_op.data_instr) && (direction == DMA_FROM_DEVICE)) -+ phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); -+ -+out: -+ return ret; -+} -+ -+static int phytium_nfc_read_id_type_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ u16 read_len = 0; -+ int ret; -+ u8 *buf = nfc->dma_buf; -+ -+ memset(nfc->dma_buf, 0, PAGE_SIZE); -+ direction = DMA_FROM_DEVICE; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ read_len = nfc_op.page_cnt; -+ nfc_op.page_cnt = (read_len & 0x03) ? ((read_len & 0xFFFC) + 4) : read_len; -+ -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_ID; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 0; -+ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ return ret; -+ -+ cond_delay(nfc_op.rdy_delay_ns); -+ -+ if (!strncmp(nfc->dma_buf, "ONFI", 4)) { -+ nfc->inter_pro = NAND_ONFI; -+ } else if (!strncmp(nfc->dma_buf, "JEDEC", 5)) { -+ nfc->inter_pro = NAND_JEDEC; -+ if (buf[5] == 1) -+ nfc->inter_mode = ASYN_SDR; -+ else if (buf[5] == 2) -+ nfc->inter_mode = TOG_ASYN_DDR; -+ else if (buf[5] == 4) -+ nfc->inter_mode = ASYN_SDR; -+ } else { -+ nfc->inter_pro = NAND_OTHER; -+ } -+ -+ dev_info(nfc->dev, "Nand protocol: %d, interface mode: %d\n", -+ nfc->inter_pro, nfc->inter_mode); -+ -+ phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); -+ -+ return 0; -+} -+ -+static int phytium_nfc_read_status_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ u16 read_len = 0; -+ u32 timeout, count = 0; -+ int ret = 0; -+ -+ direction = DMA_FROM_DEVICE; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ read_len = nfc_op.page_cnt; -+ nfc_op.page_cnt = (read_len & 0x03) ? ((read_len & 0xFFFC) + 4) : read_len; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_STATUS; -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ -+read_status_retry: -+ count++; -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ timeout = nfc_op.rdy_timeout_ms ? nfc_op.rdy_timeout_ms : 10; -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ goto out; -+ -+ phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); -+ -+ if (0xE0 != *(u8 *)(nfc->dma_buf)) { -+ dev_info(nfc->dev, "Retry to read status (%x)\n", *(u8 *)(nfc->dma_buf)); -+ -+ if (count < 10) -+ goto read_status_retry; -+ } -+ -+out: -+ return ret; -+} -+ -+static int phytium_nfc_reset_cmd_type_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ -+ direction = DMA_NONE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_RESET; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ return phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+} -+ -+static int phytium_nfc_erase_cmd_type_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ direction = DMA_NONE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_ERASE; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ return phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+} -+ -+static int phytium_nfc_data_in_type_exec(struct nand_chip *chip, -+ const struct nand_subop *subop) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nfc_op nfc_op; -+ struct nand_op_instr *instr; -+ unsigned int op_id; -+ unsigned int len; -+ unsigned int offset; -+ u8 *in = NULL; -+ -+ phytium_nfc_parse_instructions(chip, subop, &nfc_op); -+ if (nfc_op.data_instr->type != NAND_OP_DATA_IN_INSTR) { -+ dev_err(nfc->dev, "Phytium nfc instrs parser failed!\n"); -+ return -EINVAL; -+ } -+ -+ instr = nfc_op.data_instr; -+ op_id = nfc_op.data_instr_idx; -+ len = nand_subop_get_data_len(subop, op_id); -+ offset = nand_subop_get_data_start_off(subop, op_id); -+ in = instr->ctx.data.buf.in + offset; -+ -+ memcpy(in, nfc->dma_buf + nfc->dma_offset, len); -+ nfc->dma_offset += len; -+ -+ return 0; -+} -+ -+static const struct nand_op_parser phytium_nfc_op_parser = NAND_OP_PARSER( -+ /* Naked commands not supported, use a function for each pattern */ -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_read_id_type_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, 8)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_erase_cmd_type_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_read_status_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, 1)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_reset_cmd_type_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_naked_waitrdy_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_WAITRDY_ELEM(false), -+ NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_naked_waitrdy_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_naked_waitrdy_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_DATA_OUT_ELEM(false, 8), -+ NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_naked_waitrdy_exec, -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), -+ NAND_OP_PARSER_PAT_CMD_ELEM(false), -+ NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), -+ NAND_OP_PARSER_PATTERN( -+ phytium_nfc_data_in_type_exec, -+ NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), -+ ); -+ -+static int phytium_nfc_exec_op(struct nand_chip *chip, -+ const struct nand_operation *op, -+ bool check_only) -+{ -+ return nand_op_parser_exec_op(chip, &phytium_nfc_op_parser, -+ op, check_only); -+} -+ -+static int phytium_nfc_reset(struct phytium_nfc *nfc) -+{ -+ u32 value; -+ -+ phytium_write(nfc, NDIR_MASK, NDIR_ALL_INT(nfc->caps->int_mask_bits)); -+ phytium_write(nfc, NDSR, NDIR_ALL_INT(nfc->caps->int_mask_bits)); -+ -+ phytium_write(nfc, ND_ERR_CLR, 0x0F); -+ phytium_write(nfc, NDFIFO_CLR, 1); -+ -+ value = phytium_read(nfc, NDCR0); -+ phytium_write(nfc, NDCR0, value & ~(NDCR0_ECC_EN | NDCR0_SPARE_EN)); -+ -+ return 0; -+} -+ -+static void phytium_nfc_select_chip(struct nand_chip *chip, int die_nr) -+{ -+ struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ -+ dev_dbg(nfc->dev, "Phytium nand selected chip %d\n", die_nr); -+ -+ if (chip == nfc->selected_chip && die_nr == phytium_nand->selected_die) -+ return; -+ -+ if (die_nr < 0 || die_nr >= phytium_nand->nsels) { -+ nfc->selected_chip = NULL; -+ phytium_nand->selected_die = -1; -+ return; -+ } -+ -+ phytium_nfc_reset(nfc); -+ -+ nfc->selected_chip = chip; -+ phytium_nand->selected_die = die_nr; -+} -+ -+static int phytium_nand_ooblayout_ecc(struct mtd_info *mtd, int section, -+ struct mtd_oob_region *oobregion) -+{ -+ struct nand_chip *chip = mtd_to_nand(mtd); -+ -+ if (section) -+ return -ERANGE; -+ -+ oobregion->length = chip->ecc.total; -+ oobregion->offset = mtd->oobsize - oobregion->length; -+ -+ return 0; -+} -+ -+static int phytium_nand_ooblayout_free(struct mtd_info *mtd, int section, -+ struct mtd_oob_region *oobregion) -+{ -+ struct nand_chip *chip = mtd_to_nand(mtd); -+ -+ if (section) -+ return -ERANGE; -+ -+ /* -+ * Bootrom looks in bytes 0 & 5 for bad blocks for the -+ * 4KB page / 4bit BCH combination. -+ */ -+ if (mtd->writesize >= SZ_4K) -+ oobregion->offset = 6; -+ else -+ oobregion->offset = 2; -+ -+ oobregion->length = mtd->oobsize - chip->ecc.total - oobregion->offset; -+ -+ return 0; -+} -+ -+static const struct mtd_ooblayout_ops phytium_nand_ooblayout_ops = { -+ .ecc = phytium_nand_ooblayout_ecc, -+ .free = phytium_nand_ooblayout_free, -+}; -+ -+static void phytium_nfc_enable_hw_ecc(struct nand_chip *chip) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 ndcr0 = phytium_read(nfc, NDCR0); -+ -+ if (!(ndcr0 & NDCR0_ECC_EN)) -+ phytium_write(nfc, NDCR0, ndcr0 | NDCR0_ECC_EN); -+} -+ -+static void phytium_nfc_disable_hw_ecc(struct nand_chip *chip) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 ndcr0 = phytium_read(nfc, NDCR0); -+ -+ if (ndcr0 & NDCR0_ECC_EN) -+ phytium_write(nfc, NDCR0, ndcr0 & ~NDCR0_ECC_EN); -+} -+ -+irqreturn_t phytium_nfc_isr(int irq, void *dev_id) -+{ -+ struct phytium_nfc *nfc = dev_id; -+ u32 st = phytium_read(nfc, NDIR); -+ u32 ien = (~phytium_read(nfc, NDIR_MASK)) & NDIR_ALL_INT(nfc->caps->int_mask_bits); -+ -+ if (!(st & ien)) -+ return IRQ_NONE; -+ -+ nfc_irq_st = st; -+ nfc_irq_en = ien; -+ phytium_nfc_disable_int(nfc, st & NDIR_ALL_INT(nfc->caps->int_mask_bits)); -+ phytium_write(nfc, 0xFD0, 0); -+ -+ if (st & (NDIR_CMD_FINISH | NDIR_DMA_FINISH)) { -+ if (st & NDIR_ECC_ERR) -+ nfc_ecc_err = 1; -+ phytium_write(nfc, NDIR, st); -+ nfc_irq_complete = 1; -+ } else if (st & (NDIR_FIFO_TIMEOUT | NDIR_PGFINISH)) { -+ phytium_write(nfc, NDIR, st); -+ phytium_nfc_enable_int(nfc, (~st) & (NDIR_DMA_FINISH_MASK | -+ NDIR_PGFINISH_MASK | -+ NDIR_FIFO_TIMEOUT_MASK | -+ NDIR_CMD_FINISH_MASK)); -+ nfc_irq_complete = 0; -+ } else if (st & NDIR_ECC_ERR) { -+ phytium_write(nfc, ND_ERR_CLR, 0x08); -+ phytium_write(nfc, NDIR, st); -+ phytium_write(nfc, NDFIFO_CLR, 0x01); -+ nfc_irq_complete = 1; -+ nfc_ecc_errover = 1; -+ } else { -+ phytium_write(nfc, NDIR, st); -+ nfc_irq_complete = 1; -+ } -+ -+ wake_up(&wait_done); -+ -+ return IRQ_HANDLED; -+} -+EXPORT_SYMBOL(phytium_nfc_isr); -+ -+static int phytium_nfc_hw_ecc_correct(struct nand_chip *chip, -+ char *buf, int len) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 i, j, value, tmp; -+ u32 ecc_err_reg_nums; -+ int stat = 0; -+ -+ if (!buf) -+ return -EINVAL; -+ -+ if (nfc->caps->hw_ver == 1) -+ ecc_err_reg_nums = 2; -+ else -+ ecc_err_reg_nums = 4; -+ -+ for (i = 0; i < chip->ecc.steps; i++) { -+ for (j = 0; j < ecc_err_reg_nums; j++) { -+ value = phytium_read(nfc, 0xB8 + 4 * (ecc_err_reg_nums * i + j)); -+ dev_info(nfc->dev, "ECC_FLAG: offset:%x value:0x%08x\n", -+ 0xB8 + 4 * (2 * i + j), value); -+ -+ tmp = value & 0xFFFF; -+ if (tmp && (tmp <= 4096)) { -+ tmp--; -+ stat++; -+ buf[chip->ecc.size * i + (tmp >> 3)] ^= (0x01 << tmp % 8); -+ dev_info(nfc->dev, "ECC_CORRECT %x %02x\n", -+ chip->ecc.size * i + (tmp >> 3), -+ buf[chip->ecc.size * i + (tmp >> 3)]); -+ dev_info(nfc->dev, "ECC_CORRECT xor %x %02x\n", -+ 0x01 << (tmp % 8), buf[chip->ecc.size * i + (tmp >> 3)]); -+ } else if (tmp > 4096) { -+ dev_info(nfc->dev, "ECC_CORRECT offset > 4096!\n"); -+ } -+ -+ tmp = (value >> 16) & 0xFFFF; -+ if (tmp && (tmp <= 4096)) { -+ tmp--; -+ stat++; -+ buf[chip->ecc.size * i + (tmp >> 3)] ^= (0x01 << tmp % 8); -+ dev_info(nfc->dev, "ECC_CORRECT %x %02x\n", -+ chip->ecc.size * i + (tmp >> 3), -+ buf[chip->ecc.size * i + (tmp >> 3)]); -+ dev_info(nfc->dev, "ECC_CORRECT xor %x %02x\n", -+ chip->ecc.size * i + (tmp >> 3), -+ buf[chip->ecc.size * i + (tmp >> 3)]); -+ } else if (tmp > 4096) { -+ dev_info(nfc->dev, "ECC_CORRECT offset > 4096!\n"); -+ } -+ } -+ } -+ -+ return stat; -+} -+ -+static int phytium_nand_page_read(struct mtd_info *mtd, struct nand_chip *chip, -+ u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ int ret = 0; -+ -+ memset(&nfc_op, 0, sizeof(nfc_op)); -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); -+ -+ memset(nfc->dma_buf, 0x0, mtd->writesize + mtd->oobsize); -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op.cmd[0] = NAND_CMD_READ0; -+ nfc_op.cmd[1] = NAND_CMD_READSTART; -+ nfc_op.cmd_len = 2; -+ nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); -+ nfc_op.rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); -+ -+ nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op.addr[2] = page; -+ nfc_op.addr[3] = page >> 8; -+ nfc_op.addr[4] = page >> 16; -+ nfc_op.addr_len = 5; -+ nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ -+ nfc_op.page_cnt = mtd->writesize; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; -+ -+ /* For data read/program */ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ return ret; -+ -+ if ((direction == DMA_FROM_DEVICE) && buf) -+ memcpy(buf, nfc->dma_buf, mtd->writesize); -+ -+ return ret; -+} -+ -+static int phytium_nand_oob_read(struct mtd_info *mtd, struct nand_chip *chip, -+ u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ int ret = 0; -+ -+ memset(&nfc_op, 0, sizeof(nfc_op)); -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); -+ -+ memset(nfc->dma_buf, 0x00, mtd->writesize + mtd->oobsize); -+ direction = DMA_FROM_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op.cmd[0] = NAND_CMD_READ0; -+ nfc_op.cmd[1] = NAND_CMD_READSTART; -+ nfc_op.cmd_len = 2; -+ nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); -+ nfc_op.rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); -+ -+ nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op.addr[2] = page; -+ nfc_op.addr[3] = page >> 8; -+ nfc_op.addr[4] = page >> 16; -+ nfc_op.addr_len = 5; -+ nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ -+ nfc_op.page_cnt = oob_len; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; -+ nfc_op.addr[0] = mtd->writesize & 0xFF; -+ nfc_op.addr[1] = (mtd->writesize >> 8) & 0xFF; -+ -+ /* For data read/program */ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ return ret; -+ -+ cond_delay(nfc_op.rdy_delay_ns); -+ -+ if (direction == DMA_FROM_DEVICE) -+ memcpy(oob_buf, nfc->dma_buf, oob_len); -+ -+ return ret; -+} -+ -+static int phytium_nand_get_ecc_total(struct mtd_info *mtd, -+ struct nand_ecc_ctrl *ecc) -+{ -+ int ecc_total = 0; -+ -+ switch (mtd->writesize) { -+ case 0x200: -+ if (ecc->strength == 8) -+ ecc_total = 0x0D; -+ else if (ecc->strength == 4) -+ ecc_total = 7; -+ else if (ecc->strength == 2) -+ ecc_total = 4; -+ else -+ ecc_total = 0; -+ break; -+ case 0x800: -+ if (ecc->strength == 8) -+ ecc_total = 0x34; -+ else if (ecc->strength == 4) -+ ecc_total = 0x1a; -+ else if (ecc->strength == 2) -+ ecc_total = 0xd; -+ else -+ ecc_total = 0; -+ break; -+ case 0x1000: -+ if (ecc->strength == 8) -+ ecc_total = 0x68; -+ else if (ecc->strength == 4) -+ ecc_total = 0x34; -+ else if (ecc->strength == 2) -+ ecc_total = 0x1a; -+ else -+ ecc_total = 0; -+ break; -+ case 0x2000: -+ if (ecc->strength == 8) -+ ecc_total = 0xD0; -+ else if (ecc->strength == 4) -+ ecc_total = 0x68; -+ else if (ecc->strength == 2) -+ ecc_total = 0x34; -+ else -+ ecc_total = 0; -+ break; -+ case 0x4000: -+ if (ecc->strength == 8) -+ ecc_total = 0x1A0; -+ if (ecc->strength == 4) -+ ecc_total = 0xD0; -+ else if (ecc->strength == 2) -+ ecc_total = 0x68; -+ else -+ ecc_total = 0; -+ break; -+ default: -+ ecc_total = 0; -+ break; -+ } -+ -+ return ecc_total; -+} -+ -+static int phytium_nand_page_read_hwecc(struct mtd_info *mtd, struct nand_chip *chip, -+ u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op *nfc_op = NULL; -+ enum dma_data_direction direction; -+ u32 ecc_offset; -+ int max_bitflips = 0; -+ u32 nfc_state = 0; -+ int ret = 0; -+ int i; -+ -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); -+ -+ ecc_offset = phytium_nand->ecc.offset; -+ memset(nfc->dma_buf, 0x00, mtd->writesize + mtd->oobsize); -+ nfc_op = kzalloc(2 * sizeof(struct phytium_nfc_op), GFP_KERNEL); -+ if (!nfc_op) { -+ dev_err(nfc->dev, "Can't malloc space for phytium_nfc_op\n"); -+ return 0; -+ } -+ -+ nfc_op->cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op->rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); -+ nfc_op->rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); -+ -+ direction = DMA_FROM_DEVICE; -+ nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; -+ nfc_op->cmd[0] = NAND_CMD_READ0; -+ nfc_op->cmd[1] = NAND_CMD_READSTART; -+ nfc_op->cmd_len = 2; -+ nfc_op->addr_len = 5; -+ nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op->addr[2] = page; -+ nfc_op->addr[3] = page >> 8; -+ nfc_op->addr[4] = page >> 16; -+ nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc_op->page_cnt = mtd->writesize; -+ nfc_op->cmd_ctrl.nfc_ctrl.nc = 1; -+ for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) -+ nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; -+ -+ nfc_op++; -+ memcpy(nfc_op, nfc_op - 1, sizeof(struct phytium_nfc_op)); -+ nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; -+ nfc_op->cmd[0] = NAND_CMD_RNDOUT; -+ nfc_op->cmd[1] = NAND_CMD_RNDOUTSTART; -+ memset(&nfc_op->addr, 0, PHYTIUM_NFC_ADDR_MAX_LEN); -+ nfc_op->addr_len = 2; -+ nfc_op->addr[0] = mtd->writesize + phytium_nand->ecc.offset; -+ nfc_op->addr[1] = (mtd->writesize + phytium_nand->ecc.offset) >> 8; -+ nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x02; -+ nfc_op->page_cnt = phytium_nand_get_ecc_total(mtd, &chip->ecc); -+ nfc_op->cmd_ctrl.nfc_ctrl.nc = 0; -+ nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 0; -+ nfc_op->cmd_ctrl.nfc_ctrl.ecc_en = 1; -+ for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) -+ nfc_op->mem_addr_first[i] = -+ ((nfc->dma_phy_addr + mtd->writesize) >> (8 * i)) & 0xFF; -+ -+ nfc_op--; -+ phytium_nfc_prepare_cmd2(chip, nfc_op, direction, 2); -+ phytium_nfc_send_cmd2(chip, nfc_op, 2); -+ cond_delay(nfc_op->cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op->rdy_timeout_ms); -+ if (ret) -+ return ret; -+ -+ cond_delay(nfc_op->rdy_delay_ns * 1000); -+ -+ if ((direction == DMA_FROM_DEVICE) && buf) { -+ nfc_state = phytium_read(nfc, NDSR); -+ if ((nfc_state & NDSR_ECC_ERROVER) || (nfc_ecc_errover == 1)) { -+ for (i = 0; i < mtd->writesize/16; i++) { -+ if (0xFF != *(u8 *)(nfc->dma_buf + i)) { -+ dev_info(nfc->dev, "NFC: NDSR_ECC_ERROVER %x\n", page); -+ mtd->ecc_stats.failed++; -+ mtd->ecc_stats.corrected += max_bitflips; -+ break; -+ } -+ } -+ } else if (nfc_state & NDSR_ECC_ERR) { -+ max_bitflips = phytium_nfc_hw_ecc_correct(chip, -+ nfc->dma_buf, mtd->writesize); -+ mtd->ecc_stats.corrected += max_bitflips; -+ dev_info(nfc->dev, "NFC: NDSR_ECC_ERR page:%x, bit:%d\n", -+ page, max_bitflips); -+ } -+ -+ memcpy(buf, nfc->dma_buf, mtd->writesize); -+ } -+ -+ kfree(nfc_op); -+ return max_bitflips; -+} -+ -+static int phytium_nand_page_write(struct mtd_info *mtd, struct nand_chip *chip, -+ const u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ int ret = 0; -+ -+ memset(&nfc_op, 0, sizeof(nfc_op)); -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); -+ -+ memcpy(nfc->dma_buf, buf, mtd->writesize); -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op.cmd[0] = NAND_CMD_SEQIN; -+ nfc_op.cmd[1] = NAND_CMD_PAGEPROG; -+ nfc_op.cmd_len = 2; -+ nfc_op.addr_len = 5; -+ nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tPROG_max); -+ nfc_op.rdy_delay_ns = 0; -+ -+ nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op.addr[2] = page; -+ nfc_op.addr[3] = page >> 8; -+ nfc_op.addr[4] = page >> 16; -+ nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc_op.page_cnt = mtd->writesize; -+ -+ /* For data read/program */ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ goto out; -+ -+ cond_delay(nfc_op.rdy_delay_ns); -+out: -+ return ret; -+} -+ -+static int phytium_nand_oob_write(struct mtd_info *mtd, struct nand_chip *chip, -+ u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op nfc_op; -+ enum dma_data_direction direction; -+ int ret = 0; -+ -+ memset(&nfc_op, 0, sizeof(nfc_op)); -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); -+ -+ direction = DMA_TO_DEVICE; -+ nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op.cmd[0] = NAND_CMD_SEQIN; -+ nfc_op.cmd[1] = NAND_CMD_PAGEPROG; -+ nfc_op.cmd_len = 2; -+ nfc_op.addr_len = 5; -+ nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tPROG_max); -+ nfc_op.rdy_delay_ns = 0; -+ -+ nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op.addr[2] = page; -+ nfc_op.addr[3] = page >> 8; -+ nfc_op.addr[4] = page >> 16; -+ nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ -+ nfc_op.page_cnt = oob_len; -+ nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; -+ nfc_op.addr[0] = mtd->writesize & 0xFF; -+ nfc_op.addr[1] = (mtd->writesize >> 8) & 0xFF; -+ nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; -+ memcpy(nfc->dma_buf, oob_buf, mtd->oobsize); -+ -+ /* For data read/program */ -+ phytium_nfc_prepare_cmd(chip, &nfc_op, direction); -+ phytium_nfc_send_cmd(chip, &nfc_op); -+ cond_delay(nfc_op.cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); -+ if (ret) -+ goto out; -+ -+ cond_delay(nfc_op.rdy_delay_ns); -+out: -+ return ret; -+} -+ -+static int phytium_nand_page_write_hwecc(struct mtd_info *mtd, struct nand_chip *chip, -+ const u8 *buf, u8 *oob_buf, int oob_len, int page, -+ bool read) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ struct phytium_nand_chip *phytium_nand = NULL; -+ const struct nand_sdr_timings *sdr = NULL; -+ struct phytium_nfc_op *nfc_op; -+ enum dma_data_direction direction; -+ u32 ecc_offset; -+ int ret = 0; -+ int i; -+ -+ phytium_nand = to_phytium_nand(chip); -+ sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); -+ ecc_offset = phytium_nand->ecc.offset; -+ -+ nfc_op = kzalloc(2 * sizeof(struct phytium_nfc_op), GFP_KERNEL); -+ if (!nfc_op) -+ return 0; -+ -+ nfc_op->cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); -+ nfc_op->rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); -+ nfc_op->rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); -+ -+ direction = DMA_TO_DEVICE; -+ nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_ROW_ADDR; -+ nfc_op->cmd[0] = NAND_CMD_SEQIN; -+ nfc_op->cmd_len = 1; -+ nfc_op->addr_len = 5; -+ nfc_op->cmd_ctrl.nfc_ctrl.dbc = 0; -+ nfc_op->addr[2] = page; -+ nfc_op->addr[3] = page >> 8; -+ nfc_op->addr[4] = page >> 16; -+ nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; -+ nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 0; -+ nfc_op->cmd_ctrl.nfc_ctrl.nc = 1; -+ for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) -+ nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; -+ -+ /* The first dsp must have data to transfer */ -+ memcpy(nfc->dma_buf, buf, mtd->writesize); -+ nfc_op->page_cnt = mtd->writesize; -+ nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; -+ -+ nfc_op++; -+ memcpy(nfc_op, nfc_op - 1, sizeof(struct phytium_nfc_op)); -+ nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; -+ nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; -+ nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 1; -+ nfc_op->cmd[0] = NAND_CMD_RNDIN; -+ nfc_op->cmd[1] = NAND_CMD_PAGEPROG; -+ memset(&nfc_op->addr, 0, PHYTIUM_NFC_ADDR_MAX_LEN); -+ nfc_op->addr_len = 2; -+ nfc_op->cmd_len = 2; -+ nfc_op->addr[0] = mtd->writesize + ecc_offset; -+ nfc_op->addr[1] = (mtd->writesize + ecc_offset) >> 8; -+ nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x02; -+ nfc_op->page_cnt = phytium_nand_get_ecc_total(mtd, &chip->ecc); -+ nfc_op->cmd_ctrl.nfc_ctrl.nc = 0; -+ nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; -+ nfc_op->cmd_ctrl.nfc_ctrl.ecc_en = 1; -+ for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) -+ nfc_op->mem_addr_first[i] = -+ ((nfc->dma_phy_addr + mtd->writesize + ecc_offset) >> (8 * i)) & 0xFF; -+ -+ /* when enable ECC, must offer ecc_offset of oob, but no oobdata */ -+ nfc_op--; -+ phytium_nfc_prepare_cmd2(chip, nfc_op, direction, 2); -+ phytium_nfc_send_cmd2(chip, nfc_op, 2); -+ cond_delay(nfc_op->cle_ale_delay_ns); -+ -+ ret = phytium_nfc_wait_op(chip, nfc_op->rdy_timeout_ms); -+ if (ret) -+ goto out; -+ -+ cond_delay(nfc_op->rdy_delay_ns * 1000); -+out: -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_read_page_raw(struct nand_chip *chip, -+ u8 *buf, int oob_required, -+ int page) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ u32 oob_len = oob_required ? mtd->oobsize : 0; -+ int ret; -+ -+ ret = phytium_nand_page_read(mtd, chip, buf, NULL, 0, page, true); -+ if (oob_required) -+ ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, -+ oob_len, page, true); -+ -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_read_oob_raw(struct nand_chip *chip, int page) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ int ret; -+ -+ /* Invalidate page cache */ -+ chip->pagecache.page = -1; -+ memset(chip->oob_poi, 0xFF, mtd->oobsize); -+ -+ ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, -+ mtd->oobsize, page, true); -+ -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_read_page(struct nand_chip *chip, -+ u8 *buf, int oob_required, -+ int page) -+{ -+ int ret; -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ u32 oob_len = oob_required ? mtd->oobsize : 0; -+ struct phytium_nand_chip *phytium_nand = NULL; -+ -+ phytium_nand = to_phytium_nand(chip); -+ -+ phytium_nfc_enable_hw_ecc(chip); -+ cond_delay(20*1000); -+ -+ ret = phytium_nand_page_read_hwecc(mtd, chip, buf, NULL, -+ 0, page, true); -+ -+ phytium_nfc_disable_hw_ecc(chip); -+ -+ if (oob_required) { -+ oob_len = mtd->oobsize; -+ ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, -+ oob_len, page, true); -+ } -+ -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_read_oob(struct nand_chip *chip, -+ int page) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ u32 oob_len = mtd->oobsize; -+ int ret; -+ -+ ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, -+ oob_len, page, true); -+ -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_write_page_raw(struct nand_chip *chip, -+ const u8 *buf, -+ int oob_required, int page) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ void *oob_buf = oob_required ? chip->oob_poi : NULL; -+ -+ if (oob_required) -+ phytium_nand_oob_write(mtd, chip, NULL, oob_buf, -+ mtd->oobsize, page, false); -+ -+ return phytium_nand_page_write(mtd, chip, buf, NULL, -+ 0, page, false); -+} -+ -+static int phytium_nfc_hw_ecc_bch_write_page(struct nand_chip *chip, -+ const u8 *buf, -+ int oob_required, int page) -+{ -+ int ret; -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ void *oob_buf = oob_required ? chip->oob_poi : NULL; -+ u32 oob_len; -+ -+ if (oob_required) { -+ oob_len = mtd->oobsize; -+ phytium_nand_oob_write(mtd, chip, NULL, oob_buf, -+ oob_len, page, false); -+ } -+ -+ phytium_nfc_enable_hw_ecc(chip); -+ cond_delay(20*1000); -+ ret = phytium_nand_page_write_hwecc(mtd, chip, buf, NULL, -+ 0, page, false); -+ phytium_nfc_disable_hw_ecc(chip); -+ -+ return ret; -+} -+ -+static int phytium_nfc_hw_ecc_bch_write_oob_raw(struct nand_chip *chip, int page) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ -+ return phytium_nand_oob_write(mtd, chip, NULL, chip->oob_poi, -+ mtd->oobsize, page, false); -+} -+ -+static int phytium_nfc_hw_ecc_bch_write_oob(struct nand_chip *chip, int page) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); -+ u32 oob_len = mtd->oobsize - phytium_nand->ecc.length; -+ -+ return phytium_nand_oob_write(mtd, chip, NULL, chip->oob_poi, -+ oob_len, page, false); -+} -+ -+static int phytium_nand_hw_ecc_ctrl_init(struct mtd_info *mtd, -+ struct nand_ecc_ctrl *ecc) -+{ -+ struct nand_chip *chip = mtd_to_nand(mtd); -+ -+ if ((mtd->writesize + mtd->oobsize > MAX_CHUNK_SIZE)) -+ return -EOPNOTSUPP; -+ -+ chip->ecc.algo = NAND_ECC_ALGO_BCH; -+ ecc->read_page_raw = phytium_nfc_hw_ecc_bch_read_page_raw; -+ ecc->read_page = phytium_nfc_hw_ecc_bch_read_page; -+ ecc->read_oob_raw = phytium_nfc_hw_ecc_bch_read_oob_raw; -+ ecc->read_oob = phytium_nfc_hw_ecc_bch_read_oob; -+ ecc->write_page_raw = phytium_nfc_hw_ecc_bch_write_page_raw; -+ ecc->write_page = phytium_nfc_hw_ecc_bch_write_page; -+ ecc->write_oob_raw = phytium_nfc_hw_ecc_bch_write_oob_raw; -+ ecc->write_oob = phytium_nfc_hw_ecc_bch_write_oob; -+ -+ return 0; -+} -+ -+static int phytium_nand_ecc_init(struct mtd_info *mtd, -+ struct nand_ecc_ctrl *ecc) -+{ -+ int ret = 0; -+ -+ mtd_set_ooblayout(mtd, &phytium_nand_ooblayout_ops); -+ -+ switch (ecc->engine_type) { -+ case NAND_ECC_ENGINE_TYPE_ON_HOST: -+ ret = phytium_nand_hw_ecc_ctrl_init(mtd, ecc); -+ break; -+ case NAND_ECC_ENGINE_TYPE_NONE: -+ ecc->read_page_raw = phytium_nfc_hw_ecc_bch_read_page_raw; -+ ecc->read_oob_raw = phytium_nfc_hw_ecc_bch_read_oob; -+ ecc->write_page_raw = phytium_nfc_hw_ecc_bch_write_page_raw; -+ ecc->write_oob_raw = phytium_nfc_hw_ecc_bch_write_oob_raw; -+ ecc->read_page = ecc->read_page_raw; -+ ecc->read_oob = ecc->read_oob_raw; -+ ecc->write_page = ecc->write_page_raw; -+ ecc->write_oob = ecc->write_oob_raw; -+ break; -+ case NAND_ECC_ENGINE_TYPE_SOFT: -+ case NAND_ECC_ENGINE_TYPE_ON_DIE: -+ default: -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+static u8 bbt_pattern[] = {'P', 'H', 'Y', 'b', 't', '0' }; -+static u8 bbt_mirror_pattern[] = {'1', 't', 'b', 'Y', 'H', 'P' }; -+ -+static struct nand_bbt_descr bbt_main_descr = { -+ .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE | -+ NAND_BBT_2BIT | NAND_BBT_VERSION, -+ .offs = 8, -+ .len = 6, -+ .veroffs = 14, -+ .maxblocks = 8, /* Last 8 blocks in each chip */ -+ .pattern = bbt_pattern -+}; -+ -+static struct nand_bbt_descr bbt_mirror_descr = { -+ .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE | -+ NAND_BBT_2BIT | NAND_BBT_VERSION, -+ .offs = 8, -+ .len = 6, -+ .veroffs = 14, -+ .maxblocks = 8, /* Last 8 blocks in each chip */ -+ .pattern = bbt_mirror_pattern -+}; -+ -+static int phytium_nand_attach_chip(struct nand_chip *chip) -+{ -+ struct mtd_info *mtd = nand_to_mtd(chip); -+ struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ u32 value; -+ int ret = 0; -+ -+ if (nfc->caps->flash_bbt) -+ chip->bbt_options |= NAND_BBT_USE_FLASH; -+ -+ if (chip->bbt_options & NAND_BBT_USE_FLASH) { -+ /* -+ * We'll use a bad block table stored in-flash and don't -+ * allow writing the bad block marker to the flash. -+ */ -+ chip->bbt_options |= NAND_BBT_NO_OOB_BBM; -+ chip->bbt_td = &bbt_main_descr; -+ chip->bbt_md = &bbt_mirror_descr; -+ } -+ -+ if (chip->options & NAND_BUSWIDTH_16) -+ phytium_nand->ndcr |= NDCR0_WIDTH; -+ -+ /* -+ * On small page NANDs, only one cycle is needed to pass the -+ * column address. -+ */ -+ if (mtd->writesize <= 512) -+ phytium_nand->addr_cyc = 1; -+ else -+ phytium_nand->addr_cyc = 2; -+ -+ /* -+ * Now add the number of cycles needed to pass the row -+ * address. -+ * -+ * Addressing a chip using CS 2 or 3 should also need the third row -+ * cycle but due to inconsistance in the documentation and lack of -+ * hardware to test this situation, this case is not supported. -+ */ -+ if (chip->options & NAND_ROW_ADDR_3) -+ phytium_nand->addr_cyc += 3; -+ else -+ phytium_nand->addr_cyc += 2; -+ -+ if (nfc->caps) { -+ if (chip->ecc.engine_type == NAND_ECC_ENGINE_TYPE_ON_HOST) { -+ chip->ecc.size = nfc->caps->ecc_step_size ? -+ nfc->caps->ecc_step_size : -+ chip->ecc.size; -+ chip->ecc.strength = nfc->caps->ecc_strength ? -+ nfc->caps->ecc_strength : -+ chip->ecc.strength; -+ chip->ecc.strength = nfc->caps->ecc_strength; -+ chip->ecc.bytes = 7; -+ } else { -+ chip->ecc.size = 512; -+ chip->ecc.strength = 1; -+ chip->ecc.bytes = 0; -+ } -+ chip->ecc.engine_type = NAND_ECC_ENGINE_TYPE_ON_HOST; -+ } -+ -+ if (nfc->caps->hw_ver == 1) { -+ if (chip->ecc.strength == 0x04) -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(4); -+ else if (chip->ecc.strength == 0x02) -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(2); -+ else -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(0); -+ } else { -+ if (chip->ecc.strength == 0x08) -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(7); -+ else if (chip->ecc.strength == 0x04) -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(3); -+ else if (chip->ecc.strength == 0x02) -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(1); -+ else -+ phytium_nand->ndcr |= NDCR0_ECC_STREN(0); -+ } -+ -+ value = phytium_read(nfc, NDCR0); -+ value &= ~NDCR0_EN; -+ phytium_write(nfc, NDCR0, value); -+ -+ value &= ~NDCR0_ECC_STREN(7); -+ value |= phytium_nand->ndcr; -+ phytium_write(nfc, NDCR0, value | NDCR0_EN); -+ -+ ret = phytium_nand_ecc_init(mtd, &chip->ecc); -+ if (ret) { -+ dev_err(nfc->dev, "ECC init failed: %d\n", ret); -+ goto out; -+ } -+ -+ /* -+ * Subpage write not available with hardware ECC, prohibit also -+ * subpage read as in userspace subpage access would still be -+ * allowed and subpage write, if used, would lead to numerous -+ * uncorrectable ECC errors. -+ */ -+ if (chip->ecc.engine_type == NAND_ECC_ENGINE_TYPE_ON_HOST) -+ chip->options |= NAND_NO_SUBPAGE_WRITE; -+ -+ /* -+ * We keep the MTD name unchanged to avoid breaking platforms -+ * where the MTD cmdline parser is used and the bootloader -+ * has not been updated to use the new naming scheme. -+ */ -+ if (nfc->caps->legacy_of_bindings) -+ mtd->name = "phytium_nand-0"; -+ -+out: -+ return ret; -+} -+ -+static void phytium_nand_chips_cleanup(struct phytium_nfc *nfc) -+{ -+ struct phytium_nand_chip *entry, *temp; -+ -+ list_for_each_entry_safe(entry, temp, &nfc->chips, node) { -+ /* Unregister device */ -+ WARN_ON(mtd_device_unregister(nand_to_mtd(&entry->chip))); -+ nand_cleanup(&entry->chip); -+ list_del(&entry->node); -+ } -+} -+ -+static int phytium_nfc_init_dma(struct phytium_nfc *nfc) -+{ -+ int ret; -+ -+ ret = dma_set_mask_and_coherent(nfc->dev, DMA_BIT_MASK(64)); -+ if (ret) -+ return ret; -+ -+ nfc->dsp_addr = dma_alloc_coherent(nfc->dev, PAGE_SIZE, -+ &nfc->dsp_phy_addr, GFP_KERNEL | GFP_DMA); -+ if (!nfc->dsp_addr) -+ return -ENOMEM; -+ -+ nfc->dma_buf = dma_alloc_coherent(nfc->dev, MAX_CHUNK_SIZE, -+ &nfc->dma_phy_addr, GFP_KERNEL | GFP_DMA); -+ if (!nfc->dma_buf) -+ return -ENOMEM; -+ -+ dev_info(nfc->dev, "NFC address dsp_phy_addr:%llx, dma_phy_addr:%llx\n", -+ nfc->dsp_phy_addr, nfc->dma_phy_addr); -+ -+ return 0; -+} -+ -+int phytium_nfc_init(struct phytium_nfc *nfc) -+{ -+ u32 value; -+ -+ nfc->inter_mode = ASYN_SDR; -+ nfc->timing_mode = ASY_MODE0; -+ -+ value = phytium_read(nfc, NDCR1); -+ value &= (~NDCR1_SAMPL_PHASE(0xFFFF)); -+ value &= ~NDCR1_ECC_DATA_FIRST_EN; -+ value |= NDCR1_SAMPL_PHASE(1); -+ value |= NDCR1_ECC_BYPASS; -+ phytium_write(nfc, NDCR1, value); -+ phytium_write(nfc, ND_INTERVAL_TIME, 1); -+ phytium_write(nfc, NDFIFO_LEVEL0, 4); -+ phytium_write(nfc, NDFIFO_LEVEL1, 4); -+ phytium_write(nfc, NDFIFO_CLR, 1); -+ phytium_write(nfc, ND_ERR_CLR, 1); -+ -+ /* Configure the DMA */ -+ phytium_nfc_init_dma(nfc); -+ -+ -+ -+ phytium_nfc_reset(nfc); -+ -+ value = phytium_read(nfc, NDCR0); -+ value &= (~NDCR0_IN_MODE(3)); -+ value |= NDCR0_IN_MODE(nfc->inter_mode); -+ value |= NDCR0_EN; -+ -+ phytium_write(nfc, NDCR0, value); -+ -+ nfc_ecc_errover = 0; -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nfc_init); -+ -+static int phytium_nfc_setup_interface(struct nand_chip *chip, int chipnr, -+ const struct nand_interface_config *conf) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ unsigned int period_ns = 2; -+ const struct nand_sdr_timings *sdr; -+ struct phytium_nfc_timings nfc_tmg; -+ int read_delay; -+ -+ sdr = nand_get_sdr_timings(conf); -+ if (IS_ERR(sdr)) -+ return PTR_ERR(sdr); -+ -+ nfc_tmg.tRP = TO_CYCLES(DIV_ROUND_UP(sdr->tRC_min, 2), period_ns) - 1; -+ nfc_tmg.tRH = nfc_tmg.tRP; -+ nfc_tmg.tWP = TO_CYCLES(DIV_ROUND_UP(sdr->tWC_min, 2), period_ns) - 1; -+ nfc_tmg.tWH = nfc_tmg.tWP; -+ nfc_tmg.tCS = TO_CYCLES(sdr->tCS_min, period_ns); -+ nfc_tmg.tCH = TO_CYCLES(sdr->tCH_min, period_ns) - 1; -+ nfc_tmg.tADL = TO_CYCLES(sdr->tADL_min, period_ns); -+ dev_info(nfc->dev, "[nfc_tmg]tRP: %d, tRH:%d, tWP:%d tWH:%d\n", -+ nfc_tmg.tRP, nfc_tmg.tRH, nfc_tmg.tWP, nfc_tmg.tWH); -+ dev_info(nfc->dev, "[nfc_tmg]tCS: %d, tCH:%d, tADL:%d\n", -+ nfc_tmg.tCS, nfc_tmg.tCH, nfc_tmg.tADL); -+ -+ read_delay = sdr->tRC_min >= 30000 ? -+ MIN_RD_DEL_CNT : MIN_RD_DEL_CNT + nfc_tmg.tRH; -+ -+ nfc_tmg.tAR = TO_CYCLES(sdr->tAR_min, period_ns); -+ nfc_tmg.tWHR = TO_CYCLES(max_t(int, sdr->tWHR_min, sdr->tCCS_min), -+ period_ns) - 2, -+ nfc_tmg.tRHW = TO_CYCLES(max_t(int, sdr->tRHW_min, sdr->tCCS_min), -+ period_ns); -+ dev_info(nfc->dev, "[nfc_tmg]tAR: %d, tWHR:%d, tRHW:%d\n", -+ nfc_tmg.tAR, nfc_tmg.tWHR, nfc_tmg.tRHW); -+ -+ nfc_tmg.tR = TO_CYCLES(sdr->tWB_max, period_ns); -+ -+ if (chipnr < 0) -+ return 0; -+ -+ if (nfc_tmg.tWP > 0x10) -+ nfc->timing_mode = ASY_MODE1; -+ else if (nfc_tmg.tWP < 0x0D) -+ nfc->timing_mode = ASY_MODE3; -+ -+ if (nfc->inter_mode == ONFI_DDR) -+ nfc->timing_mode = SYN_MODE3; -+ -+ phytium_nfc_default_data_interface(nfc); -+ -+ return 0; -+} -+ -+static int phytium_nand_chip_init(struct phytium_nfc *nfc) -+{ -+ struct device *dev = nfc->dev; -+ struct phytium_nand_chip *phytium_nand; -+ struct mtd_info *mtd; -+ struct nand_chip *chip; -+ int ret; -+ -+ /* Alloc the nand chip structure */ -+ phytium_nand = devm_kzalloc(dev, sizeof(*phytium_nand), GFP_KERNEL); -+ if (!phytium_nand) -+ return -ENOMEM; -+ -+ phytium_nand->nsels = 1; -+ phytium_nand->selected_die = -1; -+ -+ chip = &phytium_nand->chip; -+ chip->controller = &nfc->controller; -+ chip->legacy.select_chip = phytium_nfc_select_chip; -+ phytium_nfc_default_data_interface(nfc); -+ -+ mtd = nand_to_mtd(chip); -+ mtd->dev.parent = dev; -+ mtd->owner = THIS_MODULE; -+ -+ /* -+ * Default to HW ECC engine mode. If the nand-ecc-mode property is given -+ * in the DT node, this entry will be overwritten in nand_scan_ident(). -+ */ -+ chip->ecc.engine_type = NAND_ECC_ENGINE_TYPE_ON_HOST; -+ -+ chip->options |= NAND_BUSWIDTH_AUTO; -+ chip->options |= NAND_SKIP_BBTSCAN; -+ chip->bbt_options |= NAND_BBT_NO_OOB; -+ -+ ret = nand_scan(chip, phytium_nand->nsels); -+ if (ret) { -+ dev_err(dev, "could not scan the nand chip\n"); -+ goto out; -+ } -+ -+ if (nfc->caps->parts) { -+ ret = mtd_device_register(mtd, nfc->caps->parts, nfc->caps->nr_parts - 1); -+ } else if (dev->of_node) { -+ nand_set_flash_node(chip, dev->of_node); -+ ret = mtd_device_register(mtd, NULL, 0); -+ } else { -+ ret = -EINVAL; -+ } -+ -+ if (ret) { -+ dev_err(dev, "failed to register mtd device: %d\n", ret); -+ /* Unregister device */ -+ WARN_ON(mtd_device_unregister(mtd)); -+ nand_cleanup(mtd_to_nand(mtd)); -+ return ret; -+ } -+ -+ phytium_nand->ecc.length = phytium_nand_get_ecc_total(mtd, &chip->ecc); -+ phytium_nand->ecc.offset = mtd->oobsize - phytium_nand->ecc.length; -+ chip->ecc.total = phytium_nand_get_ecc_total(mtd, &chip->ecc); -+ -+ mtd_ooblayout_ecc(mtd, 0, &phytium_nand->ecc); -+ -+ dev_info(dev, "ooblayout ecc offset: %x, length: %x\n", -+ phytium_nand->ecc.offset, phytium_nand->ecc.length); -+ -+out: -+ list_add_tail(&phytium_nand->node, &nfc->chips); -+ return 0; -+} -+ -+static const struct nand_controller_ops phytium_nand_controller_ops = { -+ .attach_chip = phytium_nand_attach_chip, -+ .exec_op = phytium_nfc_exec_op, -+ .setup_interface = phytium_nfc_setup_interface, -+}; -+ -+int phytium_nand_init(struct phytium_nfc *nfc) -+{ -+ int ret; -+ -+ nand_controller_init(&nfc->controller); -+ nfc->controller.ops = &phytium_nand_controller_ops; -+ INIT_LIST_HEAD(&nfc->chips); -+ -+ /* Init the controller and then probe the chips */ -+ ret = phytium_nfc_init(nfc); -+ if (ret) -+ goto out; -+ -+ ret = phytium_nand_chip_init(nfc); -+ if (ret) -+ goto out; -+ -+ spin_lock_init(&nfc->spinlock); -+ -+out: -+ return ret; -+} -+EXPORT_SYMBOL_GPL(phytium_nand_init); -+ -+int phytium_nand_remove(struct phytium_nfc *nfc) -+{ -+ phytium_nand_chips_cleanup(nfc); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nand_remove); -+ -+static int phytium_nfc_wait_ndrun(struct nand_chip *chip) -+{ -+ struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); -+ int ret = 0; -+ u32 val; -+ -+ ret = readl_relaxed_poll_timeout(nfc->regs + NDSR, val, -+ (val & NDSR_RB) == 0, -+ 0, 100 * 1000); -+ if (ret) { -+ dev_err(nfc->dev, "Timeout on NAND controller run mode\n"); -+ ret = -EAGAIN; -+ } -+ -+ return ret; -+} -+ -+int phytium_nand_prepare(struct phytium_nfc *nfc) -+{ -+ struct phytium_nand_chip *chip = NULL; -+ -+ list_for_each_entry(chip, &nfc->chips, node) -+ phytium_nfc_wait_ndrun(&chip->chip); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nand_prepare); -+ -+int phytium_nand_resume(struct phytium_nfc *nfc) -+{ -+ nfc->selected_chip = NULL; -+ phytium_nfc_init(nfc); -+ phytium_nfc_default_data_interface(nfc); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_nand_resume); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium NAND controller platform driver"); -+MODULE_AUTHOR("Zhu Mingshuai "); -diff --git a/drivers/mtd/nand/raw/phytium_nand.h b/drivers/mtd/nand/raw/phytium_nand.h -new file mode 100644 -index 000000000..d7a85fcaa ---- /dev/null -+++ b/drivers/mtd/nand/raw/phytium_nand.h -@@ -0,0 +1,449 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium NAND flash controller driver -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+#ifndef PHYTIUM_NAND_H -+#define PHYTIUM_NAND_H -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/* NFC does not support transfers of larger chunks at a time */ -+#define MAX_PAGE_NUM 16 -+#define MAX_CHUNK_SIZE ((1024 + 76) * 16) -+ -+#define POLL_PERIOD 0 -+#define POLL_TIMEOUT 100000 -+/* Interrupt maximum wait period in ms */ -+#define IRQ_TIMEOUT 1000 -+ -+/* Latency in clock cycles between SoC pins and NFC logic */ -+#define MIN_RD_DEL_CNT 3 -+ -+#define PHYTIUM_NFC_ADDR_MAX_LEN 5 -+#define PHYTIUM_NFC_DSP_SIZE 16 -+ -+/* NAND controller flash control register */ -+#define NDCR0 0x00 -+#define NDCR0_EN BIT(0) -+#define NDCR0_WIDTH BIT(1) -+#define NDCR0_IN_MODE(x) (min_t(u32, x, 0x3) << 2) -+#define NDCR0_ECC_EN BIT(4) -+#define NDCR0_ECC_STREN(x) (min_t(u32, x, 0x7) << 5) -+#define NDCR0_SPARE_EN BIT(8) -+#define NDCR0_SPARE_SIZE(x) (min_t(u32, x, 0xFFF) << 9) -+#define NDCR0_GENERIC_FIELDS_MASK -+ -+#define NDCR1 0x04 -+#define NDCR1_SAMPL_PHASE(x) min_t(u32, x, 0xFFFF) -+#define NDCR1_ECC_DATA_FIRST_EN BIT(16) -+#define NDCR1_RB_SHARE_EN BIT(17) -+#define NDCR1_ECC_BYPASS BIT(18) -+ -+#define NDAR0 0x08 -+ -+#define NDAR1 0x0C -+#define NDAR1_H8(x) min_t(u32, x, 0xFF) -+#define NDAR1_DMA_EN BIT(8) -+#define NDAR1_EMPTY(x) (min_t(u32, x, 0x7F) << 9) -+#define NDAR1_DMA_RLEN(x) (min_t(u32, x, 0xFF) << 9) -+#define NDAR1_DMA_WLEN(x) (min_t(u32, x, 0xFF) << 9) -+ -+#define NDTR0 0x10 -+#define NDTR0_TCS_TCLS(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR0_TCLS_TWP(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR1 0x14 -+#define NDTR1_TWH(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR1_TWP(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR2 0x18 -+#define NDTR2_TCH_TCLH(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR2_TCLH_TWH(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR3 0x1c -+#define NDTR3_TDQ_EN(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR3_TCH_TWH(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR4 0x20 -+#define NDTR4_TWHR_SMX(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR4_TREH(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR5 0x24 -+#define NDTR5_TRC(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR5_TADL_SMX(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR6 0x28 -+#define NDTR6_TCAD_TCS_SMX(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR6_RES(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR7 0x2c -+#define NDTR7_TCK(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR7_TDQ_EN(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR8 0x30 -+#define NDTR8_TCAD_TCK_SMX(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR8_HF_TCK(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR9 0x34 -+#define NDTR9_TWHR(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR9_TCCS_TCALS_SMX(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR10 0x38 -+#define NDTR10_TCK(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR10_MTCK(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR11 0x3c -+#define NDTR11_TCK_TCALS(x) (min_t(u32, x, 0xFFFF) << 16) -+#define NDTR11_RES(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR12 0x40 -+#define NDTR12_TWRCK(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR12_RES(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR13 0x44 -+#define NDTR13_TWRHCA(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR13_TRLCA(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR14 0x48 -+#define NDTR14_TWRHCE(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR14_RES(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR15 0x4c -+#define NDTR15_TCDQSS_TWPRE_TDS(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR15_HFTDSC(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR16 0x50 -+#define NDTR16_TWPST_TDH(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR16_TWPSTH(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR17 0x54 -+#define NDTR17_TCS_TRPRE(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR17_TRELDQS(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDTR18 0x58 -+#define NDTR18_TRPST_TDQSRE(x) (min_t(u32, x, 0xFFFF) << 0) -+#define NDTR18_RES(x) (min_t(u32, x, 0xFFFF) << 16) -+ -+#define NDFIFO 0x5c -+#define NDFIFO_REV (min_t(u32, x, 0) << 12) -+#define NDFIFO_FULL BIT(11) -+#define NDFIFO_EMP BIT(10) -+#define NDFIFO_CNT(x) (min_t(u32, x, 0x3F) << 0) -+ -+#define ND_INTERVAL_TIME 0x60 -+#define NDCMD_INTERVAL_TIME 0x64 -+#define NDFIFO_TIMEOUT 0x68 -+#define NDFIFO_LEVEL0 0x6c -+#define NDFIFO_LEVEL1 0x70 -+#define NDWP 0x74 -+#define NDFIFO_CLR 0x78 -+ -+#define NDSR 0x7c -+#define NDSR_BUSY BIT(0) -+#define NDSR_DMA_BUSY BIT(1) -+#define NDSR_DMA_PGFINISH BIT(2) -+#define NDSR_DMA_FINISH BIT(3) -+#define NDSR_FIFO_EMP BIT(4) -+#define NDSR_FIFO_FULL BIT(5) -+#define NDSR_FIFO_TIMEOUT BIT(6) -+#define NDSR_CS(x) (min_t(u32, x, 0xF) << 7) -+#define NDSR_CMD_PGFINISH BIT(11) -+#define NDSR_PG_PGFINISH BIT(12) -+#define NDSR_RE BIT(13) -+#define NDSR_DQS BIT(14) -+#define NDSR_RB BIT(15) -+#define NDSR_ECC_BUSY BIT(16) -+#define NDSR_ECC_FINISH BIT(17) -+#define NDSR_ECC_RIGHT BIT(18) -+#define NDSR_ECC_ERR BIT(19) -+#define NDSR_ECC_ERROVER BIT(20) -+#define NDSR_AXI_DSP_ERR BIT(21) -+#define NDSR_AXI_RD_ERR BIT(22) -+#define NDSR_AXI_WR_ERR BIT(23) -+#define NDSR_RB_STATUS(x) (min_t(u32, x, 0xF) << 24) -+#define NDSR_PROT_ERR BIT(28) -+#define NDSR_ECC_BYPASS BIT(29) -+ -+#define NDIR_MASK 0x80 -+#define NDIR_BUSY_MASK BIT(0) -+#define NDIR_DMA_BUSY_MASK BIT(1) -+#define NDIR_DMA_PGFINISH_MASK BIT(2) -+#define NDIR_DMA_FINISH_MASK BIT(3) -+#define NDIR_FIFO_EMP_MASK BIT(4) -+#define NDIR_FIFO_FULL_MASK BIT(5) -+#define NDIR_FIFO_TIMEOUT_MASK BIT(6) -+#define NDIR_CMD_FINISH_MASK BIT(7) -+#define NDIR_PGFINISH_MASK BIT(8) -+#define NDIR_RE_MASK BIT(9) -+#define NDIR_DQS_MASK BIT(10) -+#define NDIR_RB_MASK BIT(11) -+#define NDIR_ECC_FINISH_MASK BIT(12) -+#define NDIR_ECC_ERR_MASK BIT(13) -+ -+#define NDIR 0x84 -+#define NDIR_ALL_INT(x) GENMASK(x, 0) -+#define NDIR_BUSY BIT(0) -+#define NDIR_DMA_BUSY BIT(1) -+#define NDIR_DMA_PGFINISH BIT(2) -+#define NDIR_DMA_FINISH BIT(3) -+#define NDIR_FIFO_EMP BIT(4) -+#define NDIR_FIFO_FULL BIT(5) -+#define NDIR_FIFO_TIMEOUT BIT(6) -+#define NDIR_CMD_FINISH BIT(7) -+#define NDIR_PGFINISH BIT(8) -+#define NDIR_RE BIT(9) -+#define NDIR_DQS BIT(10) -+#define NDIR_RB BIT(11) -+#define NDIR_ECC_FINISH BIT(12) -+#define NDIR_ECC_ERR BIT(13) -+ -+#define ND_DEBUG 0x88 -+ -+#define ND_ERR_CLR 0x8c -+#define ND_DSP_ERR_CLR BIT(0) -+#define ND_AXI_RD_ERR_CLR BIT(1) -+#define ND_AXI_WR_ERR_CLR BIT(2) -+#define ND_ECC_ERR_CLR BIT(3) -+ -+#define NDCR_PAGE_SZ(x) (x >= 2048 ? BIT(24) : 0) -+ -+enum nand_inter_pro { -+ NAND_ONFI, -+ NAND_JEDEC, -+ NAND_OTHER, -+}; -+ -+enum nand_inter_mode { -+ ASYN_SDR, -+ ONFI_DDR, -+ TOG_ASYN_DDR, -+}; -+ -+enum asy_timing_mode { -+ ASY_MODE0, -+ ASY_MODE1, -+ ASY_MODE2, -+ ASY_MODE3, -+ ASY_MODE4, -+}; -+ -+enum onfi_syn_timing_mode { -+ SYN_MODE0 = 0x10, -+ SYN_MODE1, -+ SYN_MODE2, -+ SYN_MODE3, -+ SYN_MODE4, -+}; -+ -+/** -+ * NAND controller timings expressed in NAND Controller clock cycles -+ * -+ * @tRP: ND_nRE pulse width -+ * @tRH: ND_nRE high duration -+ * @tWP: ND_nWE pulse time -+ * @tWH: ND_nWE high duration -+ * @tCS: Enable signal setup time -+ * @tCH: Enable signal hold time -+ * @tADL: Address to write data delay -+ * @tAR: ND_ALE low to ND_nRE low delay -+ * @tWHR: ND_nWE high to ND_nRE low for status read -+ * @tRHW: ND_nRE high duration, read to write delay -+ * @tR: ND_nWE high to ND_nRE low for read -+ */ -+struct phytium_nfc_timings { -+ u16 tRP; -+ u16 tRH; -+ u16 tWP; /* NDTR1_TWP */ -+ u16 tWH; /* NDTR1_TWH */ -+ u16 tCS; -+ u16 tCH; -+ u16 tADL; -+ u16 tAR; -+ u16 tWHR; -+ u16 tRHW; -+ u16 tR; -+}; -+ -+/** -+ * NAND chip structure: stores NAND chip device related information -+ * -+ * @chip: Base NAND chip structure -+ * @node: Used to store NAND chips into a list -+ * @ndcr: Controller register value for this NAND chip -+ * @ndtr0: Timing registers 0 value for this NAND chip -+ * @ndtr1: Timing registers 1 value for this NAND chip -+ * @selected_die: Current active CS -+ * @nsels: Number of CS lines required by the NAND chip -+ */ -+struct phytium_nand_chip { -+ struct nand_chip chip; -+ struct list_head node; -+ u32 ndcr; -+ u32 ndtr0; -+ u32 ndtr1; -+ int addr_cyc; -+ int selected_die; -+ unsigned int nsels; -+ struct mtd_oob_region ecc; -+}; -+ -+/** -+ * NAND controller capabilities for distinction between compatible strings -+ * -+ * @max_cs_nb: Number of Chip Select lines available -+ * @max_rb_nb: Number of Ready/Busy lines available -+ * @legacy_of_bindings: Indicates if DT parsing must be done using the old -+ * fashion way -+ * @flash_bbt: -+ * @ecc_strength: -+ * @ecc_step_size: -+ * @parts: -+ * @nr_parts: -+ */ -+struct phytium_nfc_caps { -+ unsigned int hw_ver; -+ unsigned int int_mask_bits; -+ unsigned int max_cs_nb; -+ unsigned int max_rb_nb; -+ bool legacy_of_bindings; -+ bool flash_bbt; -+ int ecc_strength; -+ int ecc_step_size; -+ struct mtd_partition *parts; -+ unsigned int nr_parts; -+}; -+ -+/** -+ * NAND controller structure: stores Marvell NAND controller information -+ * -+ * @controller: Base controller structure -+ * @dev: Parent device (used to print error messages) -+ * @regs: NAND controller registers -+ * @reg_clk: Regiters clock -+ * @complete: Completion object to wait for NAND controller events -+ * @chips: List containing all the NAND chips attached to -+ * this NAND controller -+ * @caps: NAND controller capabilities for each compatible string -+ * @dma_buf: 32-bit aligned buffer for DMA transfers (NFCv1 only) -+ */ -+struct phytium_nfc { -+ struct nand_controller controller; -+ struct device *dev; -+ void __iomem *regs; -+ int irq; -+ struct list_head chips; -+ struct nand_chip *selected_chip; -+ struct phytium_nfc_caps *caps; -+ -+ void *dsp_addr; -+ dma_addr_t dsp_phy_addr; -+ -+ void *dma_buf; -+ u32 dma_offset; -+ dma_addr_t dma_phy_addr; -+ -+ enum nand_inter_pro inter_pro; -+ enum nand_inter_mode inter_mode; -+ u32 timing_mode; -+ -+ spinlock_t spinlock; -+}; -+ -+/** -+ * Derives a duration in numbers of clock cycles. -+ * -+ * @ps: Duration in pico-seconds -+ * @period_ns: Clock period in nano-seconds -+ * -+ * Convert the duration in nano-seconds, then divide by the period and -+ * return the number of clock periods. -+ */ -+#define TO_CYCLES(ps, period_ns) (DIV_ROUND_UP(ps / 1000, period_ns)) -+#define TO_CYCLES64(ps, period_ns) (DIV_ROUND_UP_ULL(div_u64(ps, 1000), \ -+ period_ns)) -+ -+struct phytium_nfc_cmd_ctrl { -+ u16 csel:4; -+ u16 dbc:1; -+ u16 addr_cyc:3; -+ u16 nc:1; -+#define TYPE_RESET 0x00 -+#define TYPE_SET_FTR 0x01 -+#define TYPE_GET_FTR 0x02 -+#define TYPE_READ_ID 0x03 -+#define TYPE_PAGE_PRO 0x04 -+#define TYPE_ERASE 0x05 -+#define TYPE_READ 0x06 -+#define TYPE_TOGGLE 0x07 -+#define TYPE_READ_PARAM 0x02 -+#define TYPE_READ_STATUS 0x03 -+#define TYPE_CH_READ_COL 0x03 -+#define TYPE_CH_ROW_ADDR 0x01 -+#define TYPE_CH_WR_COL 0x01 -+ u16 cmd_type:4; -+ u16 dc:1; -+ u16 auto_rs:1; -+ u16 ecc_en:1; -+}; -+ -+/** -+ * NAND driver structure filled during the parsing of the ->exec_op() subop -+ * subset of instructions. -+ * -+ * @cle_ale_delay_ns: Optional delay after the last CMD or ADDR cycle -+ * @rdy_timeout_ms: Timeout for waits on Ready/Busy pin -+ * @rdy_delay_ns: Optional delay after waiting for the RB pin -+ * @data_delay_ns: Optional delay after the data xfer -+ * @data_instr_idx: Index of the data instruction in the subop -+ * @data_instr: Pointer to the data instruction in the subop -+ */ -+struct phytium_nfc_op { -+ u8 cmd[2]; -+ union { -+ u16 ctrl; -+ struct phytium_nfc_cmd_ctrl nfc_ctrl; -+ } cmd_ctrl; -+ u8 addr[PHYTIUM_NFC_ADDR_MAX_LEN]; -+ u16 page_cnt; -+ u8 mem_addr_first[PHYTIUM_NFC_ADDR_MAX_LEN]; -+ -+ u32 cmd_len; -+ u32 addr_len; -+ -+ u32 cle_ale_delay_ns; -+ u32 rdy_timeout_ms; -+ u32 rdy_delay_ns; -+ u32 data_delay_ns; -+ u32 data_instr_idx; -+ struct nand_op_instr *data_instr; -+} __packed; -+ -+#define TIMING_ASY_NUM 12 -+#define TIMING_SYN_NUM 14 -+#define TIMING_TOG_NUM 12 -+ -+#define TMP_DMA_DEBUG 0 /* Temporary dma space */ -+ -+int phytium_nand_init(struct phytium_nfc *nfc); -+int phytium_nand_remove(struct phytium_nfc *nfc); -+int phytium_nand_prepare(struct phytium_nfc *nfc); -+int phytium_nand_suspend(struct phytium_nfc *nfc); -+int phytium_nand_resume(struct phytium_nfc *nfc); -+ -+irqreturn_t phytium_nfc_isr(int irq, void *dev_id); -+ -+#endif /* NAND_PHYTIUM_NAND_H */ -diff --git a/drivers/mtd/nand/raw/phytium_nand_pci.c b/drivers/mtd/nand/raw/phytium_nand_pci.c -new file mode 100644 -index 000000000..62e64adea ---- /dev/null -+++ b/drivers/mtd/nand/raw/phytium_nand_pci.c -@@ -0,0 +1,150 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * PCI driver for Phytium NAND flash controller -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+#include -+#include -+#include -+ -+#include "phytium_nand.h" -+ -+#define DRV_NAME "phytium_nand_pci" -+ -+static struct mtd_partition partition_info[] = { -+ { -+ .name = "Flash partition 1", -+ .offset = 0x0000000, -+ .size = 0x4000000 }, -+ { -+ .name = "Flash partition 2", -+ .offset = 0x4000000, -+ .size = 0x8000000 }, -+ { -+ .name = "Flash partition 3", -+ .offset = 0x8000000, -+ .size = 0x10000000 }, -+ { -+ .name = "Flash partition 4", -+ .offset = 0x10000000, -+ .size = 0x12000000 }, -+ { -+ .name = "Flash partition 5", -+ .offset = 0x12000000, -+ .size = 0x14000000 }, -+}; -+ -+static struct phytium_nfc_caps x100_nfc_caps = { -+ .hw_ver = 1, -+ .int_mask_bits = 13, -+ .max_cs_nb = 2, -+ .max_rb_nb = 1, -+ .legacy_of_bindings = true, -+ .ecc_strength = 4, -+ .ecc_step_size = 512, -+ .nr_parts = 5, -+ .parts = partition_info, -+}; -+ -+static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) -+{ -+ struct phytium_nfc *nfc; -+ int ret; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); -+ if (ret) { -+ dev_err(&pdev->dev, "I/O memory remapping failed\n"); -+ return ret; -+ } -+ -+ pci_set_master(pdev); -+ pci_try_set_mwi(pdev); -+ -+ nfc = devm_kzalloc(&pdev->dev, sizeof(struct phytium_nfc), -+ GFP_KERNEL); -+ if (!nfc) -+ return -ENOMEM; -+ -+ nfc->dev = &pdev->dev; -+ nfc->regs = pcim_iomap_table(pdev)[0]; -+ nfc->irq = pdev->irq; -+ nfc->caps = &x100_nfc_caps; -+ -+ ret = devm_request_irq(nfc->dev, nfc->irq, phytium_nfc_isr, -+ IRQF_SHARED, "phytium-nfc-pci", nfc); -+ if (ret) { -+ dev_err(nfc->dev, "Failed to register NFC interrupt.\n"); -+ return ret; -+ } -+ -+ ret = phytium_nand_init(nfc); -+ if (ret) -+ return ret; -+ -+ pci_set_drvdata(pdev, nfc); -+ -+ return ret; -+} -+ -+static void phytium_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_nfc *nfc = pci_get_drvdata(pdev); -+ int ret; -+ -+ ret = phytium_nand_remove(nfc); -+ if (ret) -+ dev_warn(&pdev->dev, "can't remove device properly: %d\n", ret); -+} -+ -+static int __maybe_unused phytium_nfc_prepare(struct device *dev) -+{ -+ struct pci_dev *pci = to_pci_dev(dev); -+ struct phytium_nfc *nfc = pci_get_drvdata(pci); -+ int ret; -+ -+ ret = phytium_nand_prepare(nfc); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_nfc_resume(struct device *dev) -+{ -+ struct pci_dev *pci = to_pci_dev(dev); -+ struct phytium_nfc *nfc = pci_get_drvdata(pci); -+ int ret; -+ -+ ret = phytium_nand_resume(nfc); -+ -+ return ret; -+} -+ -+static const struct dev_pm_ops phytium_pci_dev_pm_ops = { -+ .prepare = phytium_nfc_prepare, -+ .resume = phytium_nfc_resume, -+}; -+ -+static const struct pci_device_id phytium_pci_id_table[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc29) }, -+ { } -+}; -+MODULE_DEVICE_TABLE(pci, phytium_pci_id_table); -+ -+static struct pci_driver phytium_pci_driver = { -+ .name = DRV_NAME, -+ .id_table = phytium_pci_id_table, -+ .probe = phytium_pci_probe, -+ .remove = phytium_pci_remove, -+ .driver = { -+ .pm = &phytium_pci_dev_pm_ops, -+ }, -+}; -+module_pci_driver(phytium_pci_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("PCI driver for Phytium NAND controller"); -+MODULE_AUTHOR("Zhu Mingshuai "); -diff --git a/drivers/mtd/nand/raw/phytium_nand_plat.c b/drivers/mtd/nand/raw/phytium_nand_plat.c -new file mode 100644 -index 000000000..411a53a66 ---- /dev/null -+++ b/drivers/mtd/nand/raw/phytium_nand_plat.c -@@ -0,0 +1,138 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Core driver for Phytium NAND flash controller -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "phytium_nand.h" -+ -+#define DRV_NAME "phytium_nand_plat" -+ -+static int phytium_nfc_plat_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct resource *r; -+ struct phytium_nfc *nfc; -+ unsigned int ecc_strength; -+ unsigned int ecc_step_size; -+ int ret; -+ -+ nfc = devm_kzalloc(&pdev->dev, sizeof(struct phytium_nfc), -+ GFP_KERNEL); -+ if (!nfc) -+ return -ENOMEM; -+ -+ nfc->dev = dev; -+ -+ r = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ nfc->regs = devm_ioremap_resource(dev, r); -+ if (IS_ERR(nfc->regs)) -+ return PTR_ERR(nfc->regs); -+ -+ dev_info(nfc->dev, "NFC register address :%p, phy address:%llx\n", -+ nfc->regs, r->start); -+ -+ nfc->irq = platform_get_irq(pdev, 0); -+ if (nfc->irq < 0) { -+ dev_err(dev, "failed to retrieve irq\n"); -+ return nfc->irq; -+ } -+ -+ ret = devm_request_irq(dev, nfc->irq, phytium_nfc_isr, 0, -+ "phytium-nfc-plat", nfc); -+ if (ret) { -+ dev_err(nfc->dev, "Failed to register NFC interrupt.\n"); -+ return ret; -+ } -+ -+ nfc->caps = devm_kzalloc(dev, sizeof(struct phytium_nfc_caps), GFP_KERNEL); -+ if (!nfc->caps) -+ return -ENOMEM; -+ -+ /* Currently hard-coded parameters */ -+ nfc->caps->hw_ver = 2; -+ nfc->caps->int_mask_bits = 17; -+ nfc->caps->max_cs_nb = 4; -+ nfc->caps->max_rb_nb = 4; -+ nfc->caps->nr_parts = 0; -+ nfc->caps->parts = NULL; -+ -+ device_property_read_u32(&pdev->dev, "nand-ecc-strength", &ecc_strength); -+ nfc->caps->ecc_strength = ecc_strength ? ecc_strength : 8; -+ -+ device_property_read_u32(&pdev->dev, "nand-ecc-step-size", &ecc_step_size); -+ nfc->caps->ecc_step_size = ecc_step_size ? ecc_step_size : 512; -+ -+ ret = phytium_nand_init(nfc); -+ if (ret) -+ return ret; -+ -+ platform_set_drvdata(pdev, nfc); -+ -+ return ret; -+} -+ -+static int phytium_nfc_plat_remove(struct platform_device *pdev) -+{ -+ struct phytium_nfc *nfc = platform_get_drvdata(pdev); -+ -+ return phytium_nand_remove(nfc); -+} -+ -+static int __maybe_unused phytium_nfc_plat_prepare(struct device *dev) -+{ -+ struct phytium_nfc *nfc = dev_get_drvdata(dev); -+ -+ return phytium_nand_prepare(nfc); -+} -+ -+static int __maybe_unused phytium_nfc_plat_resume(struct device *dev) -+{ -+ struct phytium_nfc *nfc = dev_get_drvdata(dev); -+ int ret; -+ -+ ret = phytium_nand_resume(nfc); -+ -+ return ret; -+} -+ -+static const struct dev_pm_ops phytium_dev_pm_ops = { -+ .prepare = phytium_nfc_plat_prepare, -+ .resume = phytium_nfc_plat_resume, -+}; -+ -+#ifdef CONFIG_OF -+static const struct of_device_id phytium_nfc_of_ids[] = { -+ { .compatible = "phytium,nfc", }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(of, phytium_nfc_of_ids); -+#endif -+ -+static struct platform_driver phytium_nfc_plat_driver = { -+ .driver = { -+ .name = DRV_NAME, -+ .of_match_table = phytium_nfc_of_ids, -+ .pm = &phytium_dev_pm_ops, -+ }, -+ .probe = phytium_nfc_plat_probe, -+ .remove = phytium_nfc_plat_remove, -+}; -+module_platform_driver(phytium_nfc_plat_driver) -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium NAND controller Platform driver"); -+MODULE_AUTHOR("Zhu Mingshuai "); -diff --git a/drivers/mtd/parsers/Kconfig b/drivers/mtd/parsers/Kconfig -index 60738edcd..ae1870d27 100644 ---- a/drivers/mtd/parsers/Kconfig -+++ b/drivers/mtd/parsers/Kconfig -@@ -96,6 +96,15 @@ config MTD_OF_PARTS_LINKSYS_NS - two "firmware" partitions. Currently used firmware has to be detected - using CFE environment variable. - -+config MTD_ACPI_PARTS -+ tristate "ACPI partitioning parser" -+ default y -+ depends on ACPI -+ help -+ This provides an acpi partition parser, which is used to parse the -+ partition map described in ACPI table, as the children of the flash -+ memory struct. -+ - config MTD_PARSER_IMAGETAG - tristate "Parser for BCM963XX Image Tag format partitions" - depends on BCM63XX || BMIPS_GENERIC || COMPILE_TEST -diff --git a/drivers/mtd/parsers/Makefile b/drivers/mtd/parsers/Makefile -index 0e70b621a..2679fd766 100644 ---- a/drivers/mtd/parsers/Makefile -+++ b/drivers/mtd/parsers/Makefile -@@ -8,6 +8,8 @@ obj-$(CONFIG_MTD_OF_PARTS) += ofpart.o - ofpart-y += ofpart_core.o - ofpart-$(CONFIG_MTD_OF_PARTS_BCM4908) += ofpart_bcm4908.o - ofpart-$(CONFIG_MTD_OF_PARTS_LINKSYS_NS)+= ofpart_linksys_ns.o -+obj-$(CONFIG_MTD_ACPI_PARTS) += acpipart.o -+acpipart-y += acpipart_core.o - obj-$(CONFIG_MTD_PARSER_IMAGETAG) += parser_imagetag.o - obj-$(CONFIG_MTD_AFS_PARTS) += afs.o - obj-$(CONFIG_MTD_PARSER_TPLINK_SAFELOADER) += tplink_safeloader.o -diff --git a/drivers/mtd/parsers/acpipart_core.c b/drivers/mtd/parsers/acpipart_core.c -new file mode 100644 -index 000000000..dde80407a ---- /dev/null -+++ b/drivers/mtd/parsers/acpipart_core.c -@@ -0,0 +1,142 @@ -+// SPDX-License-Identifier: GPL-2.0-or-later -+/* -+ * Flash partitions described by the acpi table -+ * -+ * Author: Wang Hanmo -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+static const struct acpi_device_id parse_acpipart_match_table[]; -+ -+static int parse_acpi_fixed_partitions(struct mtd_info *master, -+ const struct mtd_partition **pparts, -+ struct mtd_part_parser_data *data) -+{ -+ struct mtd_partition *parts; -+ const struct acpi_device_id *acpi_id; -+ const char *partname; -+ int nr_parts, i, ret = 0; -+ struct acpi_device *adev; -+ struct fwnode_handle *child_handle; -+ bool dedicated = true; -+ struct device *dev; -+ -+ dev = &master->dev; -+ adev = ACPI_COMPANION(&master->dev); -+ -+ if (!master->parent) {/*master*/ -+ device_get_next_child_node(dev, child_handle); -+ if (!child_handle) { -+ pr_debug("%s: 'partitions' subnode not found on %pOF. Trying to parse direct subnodes as partitions.\n", -+ master->name, child_handle); -+ dedicated = false; -+ } -+ } -+ -+ acpi_id = acpi_match_device(parse_acpipart_match_table, dev); -+ if (dedicated && !acpi_id) -+ return 0; -+ -+ nr_parts = 0; -+ device_for_each_child_node(dev, child_handle) { -+ nr_parts++; -+ } -+ -+ if (nr_parts == 0) -+ return 0; -+ parts = kcalloc(nr_parts, sizeof(*parts), GFP_KERNEL); -+ if (!parts) -+ return -ENOMEM; -+ -+ i = 0; -+ device_for_each_child_node(dev, child_handle) { -+ u64 offset, length; -+ bool bool_match; -+ -+ fwnode_property_read_u64(child_handle, "offset", &offset); -+ fwnode_property_read_u64(child_handle, "length", &length); -+ if (!offset && !length) { -+ if (dedicated) { -+ pr_debug("%s: acpipart partition %pOF (%pOF) missing reg property.\n", -+ master->name, child_handle, -+ dev->fwnode); -+ goto acpipart_fail; -+ } else { -+ nr_parts--; -+ continue; -+ } -+ } -+ -+ parts[i].offset = offset; -+ parts[i].size = length; -+ parts[i].fwnode = child_handle; -+ if (!fwnode_property_read_string(child_handle, "label", &partname)) -+ parts[i].name = partname; -+ bool_match = fwnode_property_read_bool(child_handle, "read-only"); -+ if (bool_match) -+ parts[i].mask_flags |= MTD_WRITEABLE; -+ bool_match = fwnode_property_read_bool(child_handle, "lock"); -+ if (bool_match) -+ parts[i].mask_flags |= MTD_POWERUP_LOCK; -+ bool_match = fwnode_property_read_bool(child_handle, "slc-mode"); -+ if (bool_match) -+ parts[i].mask_flags |= MTD_SLC_ON_MLC_EMULATION; -+ i++; -+ } -+ -+ if (!nr_parts) -+ goto acpipart_none; -+ -+ *pparts = parts; -+ ret = nr_parts; -+ return ret; -+ -+acpipart_fail: -+ pr_err("%s: error parsing acpipart partition %pOF (%pOF)\n", -+ master->name, child_handle, dev->fwnode); -+ ret = -EINVAL; -+acpipart_none: -+ kfree(parts); -+ return ret; -+} -+ -+static const struct acpi_device_id parse_acpipart_match_table[] = { -+ /* Generic */ -+ { "acpi-partitions", 0 }, -+ /* Customized */ -+ {}, -+}; -+ -+MODULE_DEVICE_TABLE(acpi, parse_acpipart_match_table); -+ -+static struct mtd_part_parser acpipart_parser = { -+ .parse_fn = parse_acpi_fixed_partitions, -+ .name = "acpi-fixed-partitions", -+ .acpi_match_table = ACPI_PTR(parse_acpipart_match_table), -+}; -+ -+static int __init acpipart_parser_init(void) -+{ -+ register_mtd_parser(&acpipart_parser); -+ return 0; -+} -+ -+static void __exit acpipart_parser_exit(void) -+{ -+ deregister_mtd_parser(&acpipart_parser); -+} -+ -+module_init(acpipart_parser_init); -+module_exit(acpipart_parser_exit); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Parser for MTD partitioning information in acpi table"); -+MODULE_AUTHOR("Wang Hanmo "); -+MODULE_ALIAS("acpi-partitions"); -diff --git a/drivers/mtd/spi-nor/Makefile b/drivers/mtd/spi-nor/Makefile -index e347b435a..cc12acf1f 100644 ---- a/drivers/mtd/spi-nor/Makefile -+++ b/drivers/mtd/spi-nor/Makefile -@@ -17,6 +17,7 @@ spi-nor-objs += sst.o - spi-nor-objs += winbond.o - spi-nor-objs += xilinx.o - spi-nor-objs += xmc.o -+spi-nor-objs += boya.o - spi-nor-$(CONFIG_DEBUG_FS) += debugfs.o - obj-$(CONFIG_MTD_SPI_NOR) += spi-nor.o - -diff --git a/drivers/mtd/spi-nor/boya.c b/drivers/mtd/spi-nor/boya.c -new file mode 100644 -index 000000000..71d361ccf ---- /dev/null -+++ b/drivers/mtd/spi-nor/boya.c -@@ -0,0 +1,26 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+ -+#include "core.h" -+ -+static const struct flash_info boya_nor_parts[] = { -+ /* Boya */ -+ { "by25q64as", INFO(0x684017, 0, 64 * 1024, 128) -+ FLAGS(SPI_NOR_HAS_LOCK | SPI_NOR_HAS_TB) -+ NO_SFDP_FLAGS(SECT_4K | SPI_NOR_DUAL_READ | -+ SPI_NOR_QUAD_READ) }, -+ { "by25q128as", INFO(0x684018, 0, 64 * 1024, 256) -+ FLAGS(SPI_NOR_HAS_LOCK | SPI_NOR_HAS_TB) -+ NO_SFDP_FLAGS(SECT_4K | SPI_NOR_DUAL_READ | -+ SPI_NOR_QUAD_READ) }, -+}; -+ -+const struct spi_nor_manufacturer spi_nor_boya = { -+ .name = "boya", -+ .parts = boya_nor_parts, -+ .nparts = ARRAY_SIZE(boya_nor_parts), -+}; -diff --git a/drivers/mtd/spi-nor/core.c b/drivers/mtd/spi-nor/core.c -index 1b0c6770c..0810e27d9 100644 ---- a/drivers/mtd/spi-nor/core.c -+++ b/drivers/mtd/spi-nor/core.c -@@ -7,6 +7,7 @@ - * Copyright (C) 2014, Freescale Semiconductor, Inc. - */ - -+#include - #include - #include - #include -@@ -17,6 +18,7 @@ - #include - #include - #include -+#include - #include - #include - #include -@@ -2015,6 +2017,7 @@ static const struct spi_nor_manufacturer *manufacturers[] = { - &spi_nor_winbond, - &spi_nor_xilinx, - &spi_nor_xmc, -+ &spi_nor_boya, - }; - - static const struct flash_info spi_nor_generic_flash = { -@@ -3621,6 +3624,7 @@ static int spi_nor_probe(struct spi_mem *spimem) - struct spi_device *spi = spimem->spi; - struct flash_platform_data *data = dev_get_platdata(&spi->dev); - struct spi_nor *nor; -+ struct acpi_device *adev; - /* - * Enable all caps by default. The core will mask them after - * checking what's really supported using spi_mem_supports_op(). -@@ -3636,6 +3640,10 @@ static int spi_nor_probe(struct spi_mem *spimem) - nor->spimem = spimem; - nor->dev = &spi->dev; - spi_nor_set_flash_node(nor, spi->dev.of_node); -+ adev = ACPI_COMPANION(nor->dev); -+ nor->mtd.dev.fwnode = spi->dev.fwnode; -+ -+ device_property_read_string(&spi->dev, "_HID", &nor->mtd.name); - - spi_mem_set_drvdata(spimem, nor); - -@@ -3775,6 +3783,11 @@ static const struct of_device_id spi_nor_of_table[] = { - }; - MODULE_DEVICE_TABLE(of, spi_nor_of_table); - -+static const struct acpi_device_id spi_nor_acpi_table[] = { -+ {"PHYT8009", 0}, -+ { }, -+}; -+MODULE_DEVICE_TABLE(acpi, spi_nor_acpi_table); - /* - * REVISIT: many of these chips have deep power-down modes, which - * should clearly be entered on suspend() to minimize power use. -@@ -3786,6 +3799,7 @@ static struct spi_mem_driver spi_nor_driver = { - .name = "spi-nor", - .of_match_table = spi_nor_of_table, - .dev_groups = spi_nor_sysfs_groups, -+ .acpi_match_table = spi_nor_acpi_table, - }, - .id_table = spi_nor_dev_ids, - }, -diff --git a/drivers/mtd/spi-nor/core.h b/drivers/mtd/spi-nor/core.h -index 9217379b9..36252b89e 100644 ---- a/drivers/mtd/spi-nor/core.h -+++ b/drivers/mtd/spi-nor/core.h -@@ -647,6 +647,7 @@ extern const struct spi_nor_manufacturer spi_nor_sst; - extern const struct spi_nor_manufacturer spi_nor_winbond; - extern const struct spi_nor_manufacturer spi_nor_xilinx; - extern const struct spi_nor_manufacturer spi_nor_xmc; -+extern const struct spi_nor_manufacturer spi_nor_boya; - - extern const struct attribute_group *spi_nor_sysfs_groups[]; - -diff --git a/drivers/net/can/Kconfig b/drivers/net/can/Kconfig -index f8cde9f9f..718331660 100644 ---- a/drivers/net/can/Kconfig -+++ b/drivers/net/can/Kconfig -@@ -221,6 +221,7 @@ source "drivers/net/can/ifi_canfd/Kconfig" - source "drivers/net/can/m_can/Kconfig" - source "drivers/net/can/mscan/Kconfig" - source "drivers/net/can/peak_canfd/Kconfig" -+source "drivers/net/can/phytium/Kconfig" - source "drivers/net/can/rcar/Kconfig" - source "drivers/net/can/sja1000/Kconfig" - source "drivers/net/can/softing/Kconfig" -diff --git a/drivers/net/can/Makefile b/drivers/net/can/Makefile -index ff8f76295..4d40836e5 100644 ---- a/drivers/net/can/Makefile -+++ b/drivers/net/can/Makefile -@@ -27,6 +27,7 @@ obj-$(CONFIG_CAN_KVASER_PCIEFD) += kvaser_pciefd.o - obj-$(CONFIG_CAN_MSCAN) += mscan/ - obj-$(CONFIG_CAN_M_CAN) += m_can/ - obj-$(CONFIG_CAN_PEAK_PCIEFD) += peak_canfd/ -+obj-$(CONFIG_CAN_PHYTIUM) += phytium/ - obj-$(CONFIG_CAN_SJA1000) += sja1000/ - obj-$(CONFIG_CAN_SUN4I) += sun4i_can.o - obj-$(CONFIG_CAN_TI_HECC) += ti_hecc.o -diff --git a/drivers/net/can/phytium/Kconfig b/drivers/net/can/phytium/Kconfig -new file mode 100644 -index 000000000..a23216d23 ---- /dev/null -+++ b/drivers/net/can/phytium/Kconfig -@@ -0,0 +1,34 @@ -+# SPDX-License-Identifier: GPL-2.0-only -+menuconfig CAN_PHYTIUM -+ tristate "Phytium CAN support" -+ help -+ Say Y here if you want support for Phytium CAN controller framework. -+ This is common support for devices that embed the Phytium CAN IP. -+ -+ To compile this driver as a module, choose M here: the module will -+ be called phytium_can. -+ -+if CAN_PHYTIUM -+ -+config CAN_PHYTIUM_PLATFORM -+ tristate "Phytium CAN support for io-mapped devices" -+ depends on HAS_IOMEM -+ help -+ Say Y here is you want to support for IO Mapped Phytium CAN controller. -+ This support is for devices that have the Phytium CAN controller IP -+ embedded into the device and the IP is IO Mapped to the processor. -+ -+ To compile this driver as a module, choose M here: the module will -+ be called phytium_can_platform. -+ -+config CAN_PHYTIUM_PCI -+ tristate "Phytium CAN support for PCI devices" -+ depends on PCI -+ help -+ Say Y here is you want to support for Phytium CAN controller connected -+ to the PCI bus. This support is for devices that have the Phytium CAN -+ controller IP embedded into a PCI device. -+ -+ To compile this driver as a module, choose M here: the module will -+ be called phytium_can_pci. -+endif -diff --git a/drivers/net/can/phytium/Makefile b/drivers/net/can/phytium/Makefile -new file mode 100644 -index 000000000..7ef554fca ---- /dev/null -+++ b/drivers/net/can/phytium/Makefile -@@ -0,0 +1,8 @@ -+# -+# Makefile for the Phytium CAN controller drivers. -+# -+# -+ -+obj-$(CONFIG_CAN_PHYTIUM) += phytium_can.o -+obj-$(CONFIG_CAN_PHYTIUM_PLATFORM) += phytium_can_platform.o -+obj-$(CONFIG_CAN_PHYTIUM_PCI) += phytium_can_pci.o -diff --git a/drivers/net/can/phytium/phytium_can.c b/drivers/net/can/phytium/phytium_can.c -new file mode 100644 -index 000000000..52564c4aa ---- /dev/null -+++ b/drivers/net/can/phytium/phytium_can.c -@@ -0,0 +1,1191 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* CAN bus driver for Phytium CAN controller -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+ -+#include "phytium_can.h" -+ -+/* register definition */ -+enum phytium_can_reg { -+ CAN_CTRL = 0x00, /* Global control register */ -+ CAN_INTR = 0x04, /* Interrupt register */ -+ CAN_ARB_RATE_CTRL = 0x08, /* Arbitration rate control register */ -+ CAN_DAT_RATE_CTRL = 0x0c, /* Data rate control register */ -+ CAN_ACC_ID0 = 0x10, /* Acceptance identifier0 register */ -+ CAN_ACC_ID1 = 0x14, /* Acceptance identifier1 register */ -+ CAN_ACC_ID2 = 0x18, /* Acceptance identifier2 register */ -+ CAN_ACC_ID3 = 0x1c, /* Acceptance identifier3 register */ -+ CAN_ACC_ID0_MASK = 0x20, /* Acceptance identifier0 mask register */ -+ CAN_ACC_ID1_MASK = 0x24, /* Acceptance identifier1 mask register */ -+ CAN_ACC_ID2_MASK = 0x28, /* Acceptance identifier2 mask register */ -+ CAN_ACC_ID3_MASK = 0x2c, /* Acceptance identifier3 mask register */ -+ CAN_XFER_STS = 0x30, /* Transfer status register */ -+ CAN_ERROR_CNT = 0x34, /* Error counter register */ -+ CAN_FIFO_CNT = 0x38, /* FIFO counter register */ -+ CAN_DMA_CTRL = 0x3c, /* DMA request control register */ -+ CAN_XFER_EN = 0x40, /* Transfer enable register */ -+ CAN_INTR1 = 0x44, /* Interrupt register 1 */ -+ CAN_FRM_INFO = 0x48, /* Frame valid number register */ -+ CAN_TIME_OUT = 0x4c, /* Timeout register */ -+ CAN_TIME_OUT_CNT = 0x50, /* Timeout counter register */ -+ CAN_INTR2 = 0x54, /* Interrupt register 2 */ -+ CAN_TX_FIFO = 0x100, /* TX FIFO shadow register */ -+ CAN_RX_FIFO = 0x200, /* RX FIFO shadow register */ -+ CAN_RX_INFO_FIFO = 0x300, /* RX information FIFO shadow register */ -+ CAN_PIDR4 = 0xfd0, /* Peripheral Identification Register 4 */ -+ CAN_PIDR0 = 0xfe0, /* Peripheral Identification Register 0 */ -+ CAN_PIDR1 = 0xfe4, /* Peripheral Identification Register 1 */ -+ CAN_PIDR2 = 0xfe8, /* Peripheral Identification Register 2 */ -+ CAN_PIDR3 = 0xfec, /* Peripheral Identification Register 3 */ -+ CAN_CIDR0 = 0xff0, /* Component Identification Register 0 */ -+ CAN_CIDR1 = 0xff4, /* Component Identification Register 1 */ -+ CAN_CIDR2 = 0xff8, /* Component Identification Register 2 */ -+ CAN_CIDR3 = 0xffc, /* Component Identification Register 3 */ -+}; -+ -+/* Global control register (CTRL) */ -+#define CTRL_XFER BIT(0) /* Transfer enable */ -+#define CTRL_TXREQ BIT(1) /* Transmit request */ -+#define CTRL_AIME BIT(2) /* Acceptance identifier mask enable */ -+#define CTRL_TTS BIT(3) /* Transmit trigger strategy */ -+#define CTRL_RST BIT(7) /* Write 1 to soft reset and self clear */ -+#define CTRL_RFEIDF BIT(8) /* Allow RX frame end interrupt during ID filtered frame */ -+#define CTRL_RFEDT BIT(9) /* Allow RX frame end interrupt during TX frame */ -+#define CTRL_IOF BIT(10) /* Ignore overload flag internally */ -+#define CTRL_FDCRC BIT(11) /* CANFD CRC mode */ -+ -+/* Interrupt register (INTR) */ -+#define INTR_BOIS BIT(0) /* Bus off interrupt status */ -+#define INTR_PWIS BIT(1) /* Passive warning interrupt status */ -+#define INTR_PEIS BIT(2) /* Passive error interrupt status */ -+#define INTR_RFIS BIT(3) /* RX FIFO full interrupt status */ -+#define INTR_TFIS BIT(4) /* TX FIFO empty interrupt status */ -+#define INTR_REIS BIT(5) /* RX frame end interrupt status */ -+#define INTR_TEIS BIT(6) /* TX frame end interrupt status */ -+#define INTR_EIS BIT(7) /* Error interrupt status */ -+#define INTR_BOIE BIT(8) /* Bus off interrupt enable */ -+#define INTR_PWIE BIT(9) /* Passive warning interrupt enable */ -+#define INTR_PEIE BIT(10) /* Passive error interrupt enable */ -+#define INTR_RFIE BIT(11) /* RX FIFO full interrupt enable */ -+#define INTR_TFIE BIT(12) /* TX FIFO empty interrupt enable */ -+#define INTR_REIE BIT(13) /* RX frame end interrupt enable */ -+#define INTR_TEIE BIT(14) /* TX frame end interrupt enable */ -+#define INTR_EIE BIT(15) /* Error interrupt enable */ -+#define INTR_BOIC BIT(16) /* Bus off interrupt clear */ -+#define INTR_PWIC BIT(17) /* Passive warning interrupt clear */ -+#define INTR_PEIC BIT(18) /* Passive error interrupt clear */ -+#define INTR_RFIC BIT(19) /* RX FIFO full interrupt clear */ -+#define INTR_TFIC BIT(20) /* TX FIFO empty interrupt clear */ -+#define INTR_REIC BIT(21) /* RX frame end interrupt clear */ -+#define INTR_TEIC BIT(22) /* TX frame end interrupt clear */ -+#define INTR_EIC BIT(23) /* Error interrupt clear */ -+ -+#define INTR_STATUS_MASK (INTR_BOIS | INTR_PWIS | INTR_PEIS | INTR_RFIS | \ -+ INTR_TFIS | INTR_REIS | INTR_TEIS | INTR_EIS) -+ -+#define INTR_EN_MASK (INTR_BOIE | INTR_PWIE | INTR_PEIE | INTR_RFIE | \ -+ INTR_REIE | INTR_TEIE | INTR_EIE) -+ -+#define INTR_CLEAR_MASK (INTR_BOIC | INTR_PWIC | INTR_PEIC | INTR_RFIC | \ -+ INTR_TFIC | INTR_REIC | INTR_TEIC | INTR_EIC) -+ -+/* Arbitration rate control register (ARB_RATE_CTRL) */ -+#define ARB_RATE_CTRL_ARJW GENMASK(1, 0) /* Arbitration field resync jump width */ -+#define ARB_RATE_CTRL_APRS GENMASK(4, 2) /* Arbitration field propagation segment */ -+#define ARB_RATE_CTRL_APH1S GENMASK(7, 5) /* Arbitration field phase1 segment */ -+#define ARB_RATE_CTRL_APH2S GENMASK(10, 8) /* Arbitration field phase2 segment */ -+#define ARB_RATE_CTRL_APD GENMASK(28, 16) /* Arbitration field prescaler divider */ -+ -+/* Data rate control register (DAT_RATE_CTRL) */ -+#define DAT_RATE_CTRL_DRJW GENMASK(1, 0) /* Data field resync jump width */ -+#define DAT_RATE_CTRL_DPRS GENMASK(4, 2) /* Data field propagation segment */ -+#define DAT_RATE_CTRL_DPH1S GENMASK(7, 5) /* Data field phase1 segment */ -+#define DAT_RATE_CTRL_DPH2S GENMASK(10, 8) /* Data field phase2 segment */ -+#define DAT_RATE_CTRL_DPD GENMASK(28, 16) /* Data field prescaler divider */ -+ -+/* Acceptance identifierX register (ACC_IDX) */ -+#define ACC_IDX_AID_MASK GENMASK(28, 0) /* Acceptance identifier */ -+ -+/* Acceptance identifier0 mask register (ACC_ID0_MASK) */ -+#define ACC_IDX_MASK_AID_MASK GENMASK(28, 0) /* Acceptance identifier mask */ -+ -+/* Transfer status register (XFER_STS) */ -+#define XFER_STS_FRAS GENMASK(2, 0) /* Frame status */ -+#define XFER_STS_FIES GENMASK(7, 3) /* Field status */ -+#define XFER_STS_FIES_IDLE (0x0) /* idle */ -+#define XFER_STS_FIES_ARBITRATION (0x1) /* arbitration */ -+#define XFER_STS_FIES_TX_CTRL (0x2) /* transmit control */ -+#define XFER_STS_FIES_TX_DATA (0x3) /* transmit data */ -+#define XFER_STS_FIES_TX_CRC (0x4) /* transmit crc */ -+#define XFER_STS_FIES_TX_FRM (0x5) /* transmit frame */ -+#define XFER_STS_FIES_RX_CTRL (0x6) /* receive control */ -+#define XFER_STS_FIES_RX_DATA (0x7) /* receive data */ -+#define XFER_STS_FIES_RX_CRC (0x8) /* receive crc */ -+#define XFER_STS_FIES_RX_FRM (0x9) /* receive frame */ -+#define XFER_STS_FIES_INTERMISSION (0xa) /* intermission */ -+#define XFER_STS_FIES_TX_SUSPD (0xb) /* transmit suspend */ -+#define XFER_STS_FIES_BUS_IDLE (0xc) /* bus idle */ -+#define XFER_STS_FIES_OVL_FLAG (0xd) /* overload flag */ -+#define XFER_STS_FIES_OVL_DLM (0xe) /* overload delimiter */ -+#define XFER_STS_FIES_ERR_FLAG (0xf) /* error flag */ -+#define XFER_STS_FIES_ERR_DLM (0x10) /* error delimiter */ -+#define XFER_STS_FIES_BUS_OFF (0x11) /* bus off */ -+#define XFER_STS_TS BIT(8) /* Transmit status */ -+#define XFER_STS_RS BIT(9) /* Receive status */ -+#define XFER_STS_XFERS BIT(10) /* Transfer status */ -+ -+/* Error counter register (ERR_CNT) */ -+#define ERR_CNT_REC GENMASK(8, 0) /* Receive error counter */ -+#define ERR_CNT_TEC GENMASK(24, 16) /* Transmit error counter */ -+ -+/* FIFO counter register (FIFO_CNT) */ -+#define FIFO_CNT_RFN GENMASK(6, 0) /* Receive FIFO valid data number */ -+#define FIFO_CNT_TFN GENMASK(22, 16) /* Transmit FIFO valid data number */ -+ -+/* DMA request control register (DMA_CTRL) */ -+#define DMA_CTRL_RFTH GENMASK(5, 0) /* Receive FIFO DMA request threshold */ -+#define DMA_CTRL_RFRE BIT(6) /* Receive FIFO DMA request enable */ -+#define DMA_CTRL_TFTH GENMASK(21, 16) /* Transmit FIFO DMA request threshold */ -+#define DMA_CTRL_TFRE BIT(22) /* Transmit FIFO DMA request enable */ -+ -+/* Transfer enable register (XFER_EN) */ -+#define XFER_EN_XFER BIT(0) /* Transfer enable */ -+ -+/* Interrupt register 1 (INTR1) */ -+#define INTR1_RF1IS BIT(0) /* RX FIFO 1/4 interrupt status */ -+#define INTR1_RF2IS BIT(1) /* RX FIFO 1/2 interrupt status */ -+#define INTR1_RF3IS BIT(2) /* RX FIFO 3/4 interrupt status */ -+#define INTR1_RF4IS BIT(3) /* RX FIFO full interrupt status */ -+#define INTR1_TF1IS BIT(4) /* TX FIFO 1/4 interrupt status */ -+#define INTR1_TF2IS BIT(5) /* TX FIFO 1/2 interrupt status */ -+#define INTR1_TF3IS BIT(6) /* TX FIFO 3/4 interrupt status */ -+#define INTR1_TF4IS BIT(7) /* TX FIFO empty interrupt status */ -+#define INTR1_RF1IE BIT(8) /* RX FIFO 1/4 interrupt enable */ -+#define INTR1_RF2IE BIT(9) /* RX FIFO 1/2 interrupt enable */ -+#define INTR1_RF3IE BIT(10) /* RX FIFO 3/4 interrupt enable */ -+#define INTR1_RF4IE BIT(11) /* RX FIFO full interrupt enable */ -+#define INTR1_TF1IE BIT(12) /* TX FIFO 1/4 interrupt enable */ -+#define INTR1_TF2IE BIT(13) /* TX FIFO 1/2 interrupt enable */ -+#define INTR1_TF3IE BIT(14) /* TX FIFO 3/4 interrupt enable */ -+#define INTR1_TF4IE BIT(15) /* TX FIFO empty interrupt enable */ -+#define INTR1_RF1IC BIT(16) /* RX FIFO 1/4 interrupt clear */ -+#define INTR1_RF2IC BIT(17) /* RX FIFO 1/2 interrupt clear */ -+#define INTR1_RF3IC BIT(18) /* RX FIFO 3/4 interrupt clear */ -+#define INTR1_RF4IC BIT(19) /* RX FIFO full interrupt clear */ -+#define INTR1_TF1IC BIT(20) /* TX FIFO 1/4 interrupt clear */ -+#define INTR1_TF2IC BIT(21) /* TX FIFO 1/2 interrupt clear */ -+#define INTR1_TF3IC BIT(22) /* TX FIFO 3/4 interrupt clear */ -+#define INTR1_TF4IC BIT(23) /* TX FIFO empty interrupt clear */ -+#define INTR1_RF1RIS BIT(24) /* RX FIFO 1/4 raw interrupt status */ -+#define INTR1_RF2RIS BIT(25) /* RX FIFO 1/2 raw interrupt status */ -+#define INTR1_RF3RIS BIT(26) /* RX FIFO 3/4 raw interrupt status */ -+#define INTR1_RF4RIS BIT(27) /* RX FIFO full raw interrupt status */ -+#define INTR1_TF1RIS BIT(28) /* TX FIFO 1/4 raw interrupt status */ -+#define INTR1_TF2RIS BIT(29) /* TX FIFO 1/2 raw interrupt status */ -+#define INTR1_TF3RIS BIT(30) /* TX FIFO 3/4 raw interrupt status */ -+#define INTR1_TF4RIS BIT(31) /* TX FIFO empty raw interrupt status */ -+ -+/* Frame valid number register (FRM_INFO) */ -+#define FRM_INFO_RXFC GENMASK(5, 0) /* Valid frame number in RX FIFO */ -+#define FRM_INFO_SSPD GENMASK(31, 16) /* Secondary sample point delay */ -+ -+/* Interrupt register 2 (INTR2) */ -+#define INTR2_TOIS BIT(0) /* RX FIFO time out interrupt status */ -+#define INTR2_TOIM BIT(8) /* RX FIFO time out interrupt mask */ -+#define INTR2_TOIC BIT(16) /* RX FIFO time out interrupt clear */ -+#define INTR2_TORIS BIT(24) /* RX FIFO time out raw interrupt status */ -+ -+/* RX information FIFO shadow register (RX_INFO_FIFO) */ -+#define RX_INFO_FIFO_WNORF GENMASK(4, 0) /* Word (4-byte) number of current receive frame */ -+#define RX_INFO_FIFO_RORF BIT(5) /* RTR value of current receive frame */ -+#define RX_INFO_FIFO_FORF BIT(6) /* FDF value of current receive frame */ -+#define RX_INFO_FIFO_IORF BIT(7) /* IDE value of current receive frame */ -+ -+/* Arbitration Bits */ -+#define CAN_ID1_MASK GENMASK(31, 21) /* Base identifer */ -+/* Standard Remote Transmission Request */ -+#define CAN_ID1_RTR_MASK BIT(20) -+/* Extended Substitute remote TXreq */ -+#define CAN_ID2_SRR_MASK BIT(20) -+#define CAN_IDE_MASK BIT(19) /* IDentifier extension flag */ -+#define CAN_ID2_MASK GENMASK(18, 1) /* Identifier extension */ -+/* Extended frames remote TX request */ -+#define CAN_ID2_RTR_MASK BIT(0) -+#define CAN_ID1_FDF_MASK BIT(18) -+#define CAN_ID1_DLC_MASK GENMASK(17, 14) -+#define CANFD_ID1_BRS_MASK BIT(16) -+#define CANFD_ID1_ESI_MASK BIT(15) -+#define CANFD_ID1_DLC_MASK GENMASK(14, 11) -+ -+#define CAN_ID2_FDF_MASK BIT(31) -+#define CAN_ID2_DLC_MASK GENMASK(29, 26) -+#define CANFD_ID2_BRS_MASK BIT(29) -+#define CANFD_ID2_ESI_MASK BIT(28) -+#define CANFD_ID2_DLC_MASK GENMASK(27, 24) -+ -+#define CAN_ID1_DLC_OFF 14 -+#define CANFD_ID1_DLC_OFF 11 -+#define CAN_ID2_DLC_OFF 26 -+#define CANFD_ID2_DLC_OFF 24 -+ -+#define CAN_IDR_ID1_SHIFT 21 /* Standard Messg Identifier */ -+#define CAN_IDR_ID2_SHIFT 1 /* Extended Message Identifier */ -+#define CAN_IDR_SDLC_SHIFT 14 -+#define CAN_IDR_EDLC_SHIFT 26 -+ -+/* CANFD Standard msg padding 1 */ -+#define CANFD_IDR_PAD_MASK 0x000007FF -+#define CAN_IDR_PAD_MASK 0x00003FFF /* Standard msg padding 1 */ -+ -+/** -+ * phytium_can_set_reg_bits - set a bit value to the device register -+ * @cdev: Driver private data structure -+ * @reg: Register offset -+ * @bs: The bit mask -+ * -+ * Read data from the particular CAN register -+ * Return: value read from the CAN register -+ */ -+static void -+phytium_can_set_reg_bits(const struct phytium_can_dev *cdev, -+ enum phytium_can_reg reg, u32 bs) -+{ -+ u32 val = readl(cdev->base + reg); -+ -+ val |= bs; -+ writel(val, cdev->base + reg); -+} -+ -+/** -+ * phytium_can_clr_reg_bits - clear a bit value to the device register -+ * @cdev: Driver private data structure -+ * @reg: Register offset -+ * @bs: The bit mask -+ * -+ * Read data from the particular CAN register -+ * Return: value read from the CAN register -+ */ -+static void -+phytium_can_clr_reg_bits(const struct phytium_can_dev *cdev, -+ enum phytium_can_reg reg, u32 bs) -+{ -+ u32 val = readl(cdev->base + reg); -+ -+ val &= ~bs; -+ writel(val, cdev->base + reg); -+} -+ -+static inline u32 phytium_can_read(const struct phytium_can_dev *cdev, enum phytium_can_reg reg) -+{ -+ return readl(cdev->base + reg); -+} -+ -+static inline void phytium_can_write(const struct phytium_can_dev *cdev, enum phytium_can_reg reg, -+ u32 val) -+{ -+ writel(val, cdev->base + reg); -+} -+ -+static inline void phytium_can_enable_all_interrupts(struct phytium_can_dev *cdev) -+{ -+ phytium_can_write(cdev, CAN_INTR, INTR_EN_MASK); -+} -+ -+static inline void phytium_can_disable_all_interrupt(struct phytium_can_dev *cdev) -+{ -+ phytium_can_write(cdev, CAN_INTR, 0x0); -+} -+ -+static int phytium_can_get_berr_counter(const struct net_device *dev, -+ struct can_berr_counter *bec) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ bec->rxerr = phytium_can_read(cdev, CAN_ERROR_CNT) & ERR_CNT_REC; -+ bec->txerr = (phytium_can_read(cdev, CAN_ERROR_CNT) & ERR_CNT_TEC) >> 16; -+ -+ return 0; -+} -+ -+static int phytium_can_read_fifo(struct net_device *dev) -+{ -+ struct net_device_stats *stats = &dev->stats; -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ struct canfd_frame *cf; -+ struct sk_buff *skb; -+ u32 id, dlc, i; -+ -+ /* Read the frame header from FIFO */ -+ id = phytium_can_read(cdev, CAN_RX_FIFO); -+ id = be32_to_cpup(&id); -+ if (id & CAN_IDE_MASK) { -+ /* Received an extended frame */ -+ dlc = phytium_can_read(cdev, CAN_RX_FIFO); -+ dlc = be32_to_cpup(&dlc); -+ if (dlc & CAN_ID2_FDF_MASK) -+ skb = alloc_canfd_skb(dev, &cf); -+ else -+ skb = alloc_can_skb(dev, (struct can_frame **)&cf); -+ -+ if (unlikely(!skb)) { -+ stats->rx_dropped++; -+ return 0; -+ } -+ -+ if (dlc & CAN_ID2_FDF_MASK) { -+ /* CAN FD extended frame */ -+ if (dlc & CANFD_ID2_BRS_MASK) -+ cf->flags |= CANFD_BRS; -+ if (dlc & CANFD_ID2_ESI_MASK) -+ cf->flags |= CANFD_ESI; -+ cf->len = can_fd_dlc2len((dlc & CANFD_ID2_DLC_MASK) >> CANFD_ID2_DLC_OFF); -+ } else { -+ /* CAN extended frame */ -+ cf->len = can_cc_dlc2len((dlc & CAN_ID2_DLC_MASK) >> CAN_ID2_DLC_OFF); -+ } -+ -+ cf->can_id = (id & CAN_ID1_MASK) >> 3; -+ cf->can_id |= (id & CAN_ID2_MASK) >> 1; -+ cf->can_id |= CAN_EFF_FLAG; -+ -+ if (id & CAN_ID2_RTR_MASK) -+ cf->can_id |= CAN_RTR_FLAG; -+ } else { -+ /* Received a standard frame */ -+ if (id & CAN_ID1_FDF_MASK) -+ skb = alloc_canfd_skb(dev, &cf); -+ else -+ skb = alloc_can_skb(dev, (struct can_frame **)&cf); -+ -+ if (unlikely(!skb)) { -+ stats->rx_dropped++; -+ return 0; -+ } -+ -+ if (id & CAN_ID1_FDF_MASK) { -+ /* CAN FD extended frame */ -+ if (id & CANFD_ID1_BRS_MASK) -+ cf->flags |= CANFD_BRS; -+ if (id & CANFD_ID1_ESI_MASK) -+ cf->flags |= CANFD_ESI; -+ cf->len = can_fd_dlc2len((id & CANFD_ID1_DLC_MASK) >> CANFD_ID1_DLC_OFF); -+ } else { -+ /* CAN extended frame */ -+ cf->len = can_cc_dlc2len((id & CAN_ID1_DLC_MASK) >> CAN_ID1_DLC_OFF); -+ } -+ -+ cf->can_id = (id & CAN_ID1_MASK) >> 21; -+ -+ if (id & CAN_ID1_RTR_MASK) -+ cf->can_id |= CAN_RTR_FLAG; -+ } -+ -+ if (!(cf->can_id & CAN_RTR_FLAG)) -+ /* Receive data frames */ -+ for (i = 0; i < cf->len; i += 4) -+ *(__be32 *)(cf->data + i) = phytium_can_read(cdev, CAN_RX_FIFO); -+ -+ stats->rx_packets++; -+ stats->rx_bytes += cf->len; -+ netif_receive_skb(skb); -+ -+ return 1; -+} -+ -+static int phytium_can_do_rx_poll(struct net_device *dev, int quota) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ u32 rxfs, pkts = 0; -+ -+ rxfs = phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_RFN; -+ if (!rxfs) { -+ netdev_dbg(dev, "no messages in RX FIFO\n"); -+ return 0; -+ } -+ -+ while ((rxfs != 0) && (quota > 0)) { -+ pkts += phytium_can_read_fifo(dev); -+ quota--; -+ rxfs = phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_RFN; -+ netdev_dbg(dev, "Next received %d frame again.\n", rxfs); -+ } -+ -+ return pkts; -+} -+ -+static int phytium_can_poll(struct napi_struct *napi, int quota) -+{ -+ struct net_device *dev = napi->dev; -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ int work_done; -+ unsigned long flags; -+ -+ netdev_dbg(dev, "The receive processing is going on !\n"); -+ -+ work_done = phytium_can_do_rx_poll(dev, quota); -+ -+ /* Don't re-enable interrupts if the driver had a fatal error -+ * (e.g., FIFO read failure) -+ */ -+ if (work_done >= 0 && work_done < quota) { -+ napi_complete_done(napi, work_done); -+ -+ spin_lock_irqsave(&cdev->lock, flags); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_REIE); -+ spin_unlock_irqrestore(&cdev->lock, flags); -+ } -+ -+ return work_done; -+} -+ -+static void phytium_can_write_frame(struct phytium_can_dev *cdev) -+{ -+ struct canfd_frame *cf = (struct canfd_frame *)cdev->tx_skb->data; -+ struct net_device *dev = cdev->net; -+ struct net_device_stats *stats = &dev->stats; -+ struct sk_buff *skb = cdev->tx_skb; -+ u32 i, id, dlc = 0, frame_head[2] = {0, 0}; -+ u32 data_len; -+ unsigned int len; -+ -+ data_len = can_fd_len2dlc(cf->len); -+ cdev->tx_skb = NULL; -+ -+ /* Watch carefully on the bit sequence */ -+ if (cf->can_id & CAN_EFF_FLAG) { -+ /* Extended CAN ID format */ -+ id = ((cf->can_id & CAN_EFF_MASK) << 1) & CAN_ID2_MASK; -+ id |= (((cf->can_id & CAN_EFF_MASK) >> -+ (CAN_EFF_ID_BITS - CAN_SFF_ID_BITS)) << -+ CAN_IDR_ID1_SHIFT) & CAN_ID1_MASK; -+ -+ /* The substibute remote TX request bit should be "1" -+ * for extended frames as in the Phytium CAN datasheet -+ */ -+ id |= CAN_IDE_MASK | CAN_ID2_SRR_MASK; -+ -+ if (cf->can_id & CAN_RTR_FLAG) -+ /* Extended frames remote TX request */ -+ id |= CAN_ID2_RTR_MASK; -+ if ((cdev->can.ctrlmode & CAN_CTRLMODE_FD) && -+ can_is_canfd_skb(skb)) -+ dlc = data_len << CANFD_ID2_DLC_OFF; -+ else -+ dlc = data_len << CAN_ID2_DLC_OFF; -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { -+ dlc |= CAN_ID2_FDF_MASK; -+ if (cf->flags & CANFD_BRS) -+ dlc |= CANFD_ID2_BRS_MASK; -+ if (cf->flags & CANFD_ESI) -+ dlc |= CANFD_ID2_ESI_MASK; -+ } -+ -+ frame_head[0] = cpu_to_be32p(&id); -+ frame_head[1] = cpu_to_be32p(&dlc); -+ -+ /* Write the Frame to Phytium CAN TX FIFO */ -+ phytium_can_write(cdev, CAN_TX_FIFO, frame_head[0]); -+ phytium_can_write(cdev, CAN_TX_FIFO, frame_head[1]); -+ netdev_dbg(dev, "Write atbitration field [0]:0x%x [1]:0x%x\n", -+ frame_head[0], frame_head[1]); -+ } else { -+ /* Standard CAN ID format */ -+ id = ((cf->can_id & CAN_SFF_MASK) << CAN_IDR_ID1_SHIFT) -+ & CAN_ID1_MASK; -+ -+ if (cf->can_id & CAN_RTR_FLAG) -+ /* Standard frames remote TX request */ -+ id |= CAN_ID1_RTR_MASK; -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) -+ dlc = (data_len << CANFD_ID1_DLC_OFF) -+ | CANFD_IDR_PAD_MASK; -+ else -+ dlc = (data_len << CAN_ID1_DLC_OFF) | CAN_IDR_PAD_MASK; -+ -+ id |= dlc; -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { -+ id |= CAN_ID1_FDF_MASK; -+ if (cf->flags & CANFD_BRS) -+ id |= CANFD_ID1_BRS_MASK; -+ if (cf->flags & CANFD_ESI) -+ id |= CANFD_ID1_ESI_MASK; -+ } -+ -+ frame_head[0] = cpu_to_be32p(&id); -+ /* Write the Frame to Phytium CAN TX FIFO */ -+ phytium_can_write(cdev, CAN_TX_FIFO, frame_head[0]); -+ netdev_dbg(dev, "Write atbitration field [0] 0x%x\n", -+ frame_head[0]); -+ } -+ -+ if (!(cf->can_id & CAN_RTR_FLAG)) { -+ netdev_dbg(dev, "Write CAN data frame\n"); -+ for (i = 0; i < cf->len; i += 4) { -+ phytium_can_write(cdev, CAN_TX_FIFO, -+ *(__be32 *)(cf->data + i)); -+ netdev_dbg(dev, "[%d]:%x\n", i, -+ *(__be32 *)(cf->data + i)); -+ } -+ } -+ -+ stats->tx_bytes += cf->len; -+ stats->tx_packets++; -+ -+ cdev->is_tx_done = false; -+ cdev->is_need_stop_xmit = true; -+ mod_timer(&cdev->timer, jiffies + HZ / 10); -+ -+ netdev_dbg(dev, "Trigger send message!\n"); -+ -+ can_put_echo_skb(skb, dev, 0, 0); -+ len = can_get_echo_skb(dev, 0, NULL); -+ return; -+} -+ -+static netdev_tx_t phytium_can_tx_handler(struct phytium_can_dev *cdev) -+{ -+ struct net_device *dev = cdev->net; -+ u32 tx_fifo_used; -+ unsigned long flags; -+ -+ phytium_can_write_frame(cdev); -+ /* Check if the TX buffer is full */ -+ tx_fifo_used = 4 * ((phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_TFN) >> 16); -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { -+ if (CAN_FIFO_BYTE_LEN - tx_fifo_used <= KEEP_CANFD_FIFO_MIN_LEN) { -+ netif_stop_queue(dev); -+ spin_lock_irqsave(&cdev->lock, flags); -+ cdev->is_stop_queue_flag = STOP_QUEUE_TRUE; -+ spin_unlock_irqrestore(&cdev->lock, flags); -+ } -+ } else { -+ if (CAN_FIFO_BYTE_LEN - tx_fifo_used <= KEEP_CAN_FIFO_MIN_LEN) { -+ netif_stop_queue(dev); -+ spin_lock_irqsave(&cdev->lock, flags); -+ cdev->is_stop_queue_flag = STOP_QUEUE_TRUE; -+ spin_unlock_irqrestore(&cdev->lock, flags); -+ } -+ } -+ -+ return NETDEV_TX_OK; -+} -+ -+/** -+ * phytium_can_tx_interrupt - Tx Done Isr -+ * @ndev: net_device pointer -+ * @isr: Interrupt status register value -+ */ -+static void phytium_can_tx_interrupt(struct net_device *ndev, u32 isr) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ struct net_device_stats *stats = &ndev->stats; -+ u32 tx_fifo_used = 0; -+ -+ if (isr & INTR_TEIS) -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); -+ -+ /* Check if the TX buffer is full */ -+ if (cdev->is_stop_queue_flag) { -+ tx_fifo_used = 4 * ((phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_TFN) >> 16); -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { -+ if (CAN_FIFO_BYTE_LEN - tx_fifo_used > KEEP_CANFD_FIFO_MIN_LEN) { -+ netif_wake_queue(ndev); -+ cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; -+ } -+ } else { -+ if (CAN_FIFO_BYTE_LEN - tx_fifo_used > KEEP_CAN_FIFO_MIN_LEN) { -+ netif_wake_queue(ndev); -+ cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; -+ } -+ } -+ } -+ -+ cdev->is_tx_done = true; -+ cdev->is_need_stop_xmit = false; -+ del_timer(&cdev->timer); -+ -+ netdev_dbg(ndev, "Finish transform packets %lu\n", stats->tx_packets); -+ -+ -+ phytium_can_set_reg_bits(cdev, CAN_INTR, (INTR_BOIE | -+ INTR_PWIE | INTR_PEIE)); -+} -+ -+static void phytium_can_tx_done_timeout(struct timer_list *t) -+{ -+ struct phytium_can_dev *priv = from_timer(priv, t, timer); -+ struct net_device *ndev = priv->net; -+ -+ if (!priv->is_tx_done) { -+ if (priv->is_need_stop_xmit) { -+ netdev_dbg(ndev, "%s stop xmit\n", __func__); -+ priv->is_need_stop_xmit = false; -+ phytium_can_clr_reg_bits(priv, CAN_CTRL, CTRL_XFER); -+ phytium_can_clr_reg_bits(priv, CAN_INTR, (INTR_BOIE | -+ INTR_PWIE | INTR_PEIE)); -+ /* stop xmit and restart after 500ms */ -+ mod_timer(&priv->timer, jiffies + HZ / 2); -+ } else { -+ netdev_dbg(ndev, "%s start xmit\n", __func__); -+ priv->is_need_stop_xmit = true; -+ phytium_can_set_reg_bits(priv, CAN_CTRL, CTRL_XFER); -+ /* start xmit and stop after 250ms */ -+ mod_timer(&priv->timer, jiffies + HZ / 4); -+ } -+ } -+} -+ -+static void phytium_can_err_interrupt(struct net_device *ndev, u32 isr) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ struct net_device_stats *stats = &ndev->stats; -+ struct can_frame *cf; -+ struct sk_buff *skb; -+ u32 txerr = 0, rxerr = 0; -+ -+ skb = alloc_can_err_skb(ndev, &cf); -+ -+ rxerr = phytium_can_read(cdev, CAN_ERROR_CNT) & ERR_CNT_REC; -+ txerr = ((phytium_can_read(cdev, CAN_ERROR_CNT) & ERR_CNT_TEC) >> 16); -+ -+ if (isr & INTR_BOIS) { -+ netdev_dbg(ndev, "bus_off %s: txerr :%u rxerr :%u\n", -+ __func__, txerr, rxerr); -+ cdev->can.state = CAN_STATE_BUS_OFF; -+ cdev->can.can_stats.bus_off++; -+ /* Leave device in Config Mode in bus-off state */ -+ phytium_can_write(cdev, CAN_CTRL, CTRL_RST); -+ can_bus_off(ndev); -+ if (skb) -+ cf->can_id |= CAN_ERR_BUSOFF; -+ } else if ((isr & INTR_PEIS) == INTR_PEIS) { -+ netdev_dbg(ndev, "error_passive %s: txerr :%u rxerr :%u\n", -+ __func__, txerr, rxerr); -+ cdev->can.state = CAN_STATE_ERROR_PASSIVE; -+ cdev->can.can_stats.error_passive++; -+ /* Clear interrupt condition */ -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PEIC); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PWIC); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_EIC); -+ if (skb) { -+ cf->can_id |= CAN_ERR_CRTL; -+ cf->data[1] = (rxerr > 127) ? -+ CAN_ERR_CRTL_RX_PASSIVE : -+ CAN_ERR_CRTL_TX_PASSIVE; -+ cf->data[6] = txerr; -+ cf->data[7] = rxerr; -+ } -+ } else if (isr & INTR_PWIS) { -+ netdev_dbg(ndev, "error_warning %s: txerr :%u rxerr :%u\n", -+ __func__, txerr, rxerr); -+ cdev->can.state = CAN_STATE_ERROR_WARNING; -+ cdev->can.can_stats.error_warning++; -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PWIC); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_EIC); -+ if (skb) { -+ cf->can_id |= CAN_ERR_CRTL; -+ cf->data[1] |= (txerr > rxerr) ? -+ CAN_ERR_CRTL_TX_WARNING : -+ CAN_ERR_CRTL_RX_WARNING; -+ cf->data[6] = txerr; -+ cf->data[7] = rxerr; -+ } -+ } -+ -+ /* Check for RX FIFO Overflow interrupt */ -+ if (isr & INTR_RFIS) { -+ stats->rx_over_errors++; -+ stats->rx_errors++; -+ -+ if (skb) { -+ cf->can_id |= CAN_ERR_CRTL; -+ cf->data[1] |= CAN_ERR_CRTL_RX_OVERFLOW; -+ } -+ } -+ -+ if (skb) { -+ stats->rx_packets++; -+ stats->rx_bytes += cf->can_dlc; -+ netif_rx(skb); -+ } -+} -+ -+/** -+ * phytium_can_isr - CAN Isr -+ * @irq: irq number -+ * @dev_id: device id poniter -+ * -+ * This is the phytium CAN Isr. It checks for the type of interrupt -+ * and invokes the corresponding ISR. -+ * -+ * Return: -+ * * IRQ_NONE - If CAN device is in sleep mode, IRQ_HANDLED otherwise -+ */ -+static irqreturn_t phytium_can_isr(int irq, void *dev_id) -+{ -+ struct net_device *dev = (struct net_device *)dev_id; -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ u32 isr; -+ -+ /* Get the interrupt status */ -+ isr = phytium_can_read(cdev, CAN_INTR) & INTR_STATUS_MASK; -+ if (!isr) -+ return IRQ_NONE; -+ -+ spin_lock(&cdev->lock); -+ /* Check for FIFO full interrupt and alarm */ -+ if ((isr & INTR_RFIS)) { -+ netdev_dbg(dev, "rx_fifo is full!.\n"); -+ phytium_can_clr_reg_bits(cdev, CAN_INTR, INTR_RFIE); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_RFIC); -+ napi_schedule(&cdev->napi); -+ } -+ -+ /* Check for FIFO empty interrupt and alarm */ -+ if ((isr & INTR_TFIS)) { -+ netdev_dbg(dev, "tx_fifo is empty!.\n"); -+ isr &= (~INTR_TFIS); -+ phytium_can_clr_reg_bits(cdev, CAN_INTR, INTR_TFIE); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TFIC); -+ } -+ -+ /* Check for the type of error interrupt and Processing it */ -+ if (isr & (INTR_EIS | INTR_RFIS | INTR_BOIS | INTR_PWIS | INTR_PEIS)) { -+ phytium_can_clr_reg_bits(cdev, CAN_INTR, (INTR_EIE | INTR_RFIE | -+ INTR_BOIE | INTR_PWIE | INTR_PEIE)); -+ phytium_can_err_interrupt(dev, isr); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, (INTR_EIC | INTR_RFIC | -+ INTR_BOIC | INTR_PWIC | INTR_PEIC)); -+ spin_unlock(&cdev->lock); -+ return IRQ_HANDLED; -+ } -+ -+ /* Check for Tx interrupt and Processing it */ -+ if ((isr & INTR_TEIS)) { -+ phytium_can_tx_interrupt(dev, isr); -+ } -+ -+ /* Check for the type of receive interrupt and Processing it */ -+ if (isr & (INTR_REIS)) { -+ phytium_can_clr_reg_bits(cdev, CAN_INTR, INTR_REIE); -+ phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_REIC); -+ napi_schedule(&cdev->napi); -+ } -+ spin_unlock(&cdev->lock); -+ return IRQ_HANDLED; -+} -+ -+/** -+ * phytium_can_set_bittiming - CAN set bit timing routine -+ * @dev: Pointer to net_device structure -+ * -+ * This is the driver set bittiming routine. -+ * Return: 0 on success and failure value on error -+ */ -+static int phytium_can_set_bittiming(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ const struct can_bittiming *bt = &cdev->can.bittiming; -+ const struct can_bittiming *dbt = &cdev->can.data_bittiming; -+ u32 btr, dbtr; -+ u32 is_config_mode; -+ -+ /** -+ * Check whether Phytium CAN is in configuration mode. -+ * It cannot set bit timing if Phytium CAN is not in configuration mode. -+ */ -+ is_config_mode = phytium_can_read(cdev, CAN_CTRL) & CTRL_XFER; -+ if (is_config_mode) { -+ netdev_alert(dev, "BUG! Cannot set bittiming - CAN is not in config mode\n"); -+ return -EPERM; -+ } -+ -+ /* Setting Baud Rate prescalar value in BRPR Register */ -+ btr = (bt->brp - 1) << 16; -+ -+ /* Setting Time Segment 1 in BTR Register */ -+ btr |= (bt->prop_seg - 1) << 2; -+ -+ btr |= (bt->phase_seg1 - 1) << 5; -+ -+ /* Setting Time Segment 2 in BTR Register */ -+ btr |= (bt->phase_seg2 - 1) << 8; -+ -+ /* Setting Synchronous jump width in BTR Register */ -+ btr |= (bt->sjw - 1); -+ -+ dbtr = (dbt->brp - 1) << 16; -+ dbtr |= (dbt->prop_seg - 1) << 2; -+ dbtr |= (dbt->phase_seg1 - 1) << 5; -+ dbtr |= (dbt->phase_seg2 - 1) << 8; -+ dbtr |= (dbt->sjw - 1); -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { -+ phytium_can_write(cdev, CAN_ARB_RATE_CTRL, btr); -+ phytium_can_write(cdev, CAN_DAT_RATE_CTRL, dbtr); -+ } else { -+ phytium_can_write(cdev, CAN_ARB_RATE_CTRL, btr); -+ phytium_can_write(cdev, CAN_DAT_RATE_CTRL, btr); -+ } -+ -+ netdev_dbg(dev, "DAT=0x%08x, ARB=0x%08x\n", -+ phytium_can_read(cdev, CAN_DAT_RATE_CTRL), -+ phytium_can_read(cdev, CAN_ARB_RATE_CTRL)); -+ -+ return 0; -+} -+ -+/** -+ * phytium_can_start - This the drivers start routine -+ * @dev: Pointer to net_device structure -+ * -+ * This is the drivers start routine. -+ * Based on the State of the CAN device it puts -+ * the CAN device into a proper mode. -+ * -+ * Return: 0 on success and failure value on error -+ */ -+static void phytium_can_start(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ u32 ctrl; -+ -+ /* Disable transfer */ -+ ctrl = phytium_can_read(cdev, CAN_CTRL); -+ ctrl &= ~CTRL_XFER; -+ phytium_can_write(cdev, CAN_CTRL, ctrl); -+ -+ /* XXX: If CANFD, reset the controller */ -+ phytium_can_write(cdev, CAN_CTRL, (ctrl | CTRL_RST)); -+ -+ /* Bittiming setup */ -+ phytium_can_set_bittiming(dev); -+ -+ /* Acceptance identifier mask setup */ -+ phytium_can_write(cdev, CAN_ACC_ID0_MASK, ACC_IDX_MASK_AID_MASK); -+ phytium_can_write(cdev, CAN_ACC_ID1_MASK, ACC_IDX_MASK_AID_MASK); -+ phytium_can_write(cdev, CAN_ACC_ID2_MASK, ACC_IDX_MASK_AID_MASK); -+ phytium_can_write(cdev, CAN_ACC_ID3_MASK, ACC_IDX_MASK_AID_MASK); -+ ctrl |= CTRL_AIME; -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) -+ ctrl |= CTRL_IOF | CTRL_FDCRC; -+ -+ phytium_can_write(cdev, CAN_CTRL, ctrl); -+ -+ cdev->can.state = CAN_STATE_ERROR_ACTIVE; -+ -+ phytium_can_enable_all_interrupts(cdev); -+ -+ if (cdev->can.ctrlmode & CAN_CTRLMODE_LISTENONLY) -+ ctrl |= CTRL_XFER; -+ else -+ ctrl |= CTRL_XFER | CTRL_TXREQ; -+ -+ phytium_can_write(cdev, CAN_CTRL, ctrl); -+} -+ -+/** -+ * phytium_can_stop - Driver stop routine -+ * @dev: Pointer to net_device structure -+ * -+ * This is the drivers stop routine. It will disable the -+ * interrupts and put the device into configuration mode. -+ */ -+static void phytium_can_stop(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ u32 ctrl; -+ -+ /* Disable all interrupts */ -+ phytium_can_disable_all_interrupt(cdev); -+ -+ /* Disable transfer and switch to receive-only mode */ -+ ctrl = phytium_can_read(cdev, CAN_CTRL); -+ ctrl &= ~(CTRL_XFER | CTRL_TXREQ); -+ phytium_can_write(cdev, CAN_CTRL, ctrl); -+ -+ del_timer(&cdev->timer); -+ -+ /* Set the state as STOPPED */ -+ cdev->can.state = CAN_STATE_STOPPED; -+} -+ -+static void phytium_can_clean(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ if (cdev->tx_skb) { -+ dev->stats.tx_errors++; -+ can_free_echo_skb(cdev->net, 0, NULL); -+ cdev->tx_skb = NULL; -+ } -+} -+ -+static int phytium_can_set_mode(struct net_device *dev, enum can_mode mode) -+{ -+ switch (mode) { -+ case CAN_MODE_START: -+ phytium_can_clean(dev); -+ phytium_can_start(dev); -+ netif_wake_queue(dev); -+ break; -+ default: -+ return -EOPNOTSUPP; -+ } -+ return 0; -+} -+ -+/** -+ * phytium_can_open - Driver open routine -+ * @dev: Pointer to net_device structure -+ * -+ * This is the driver open routine. -+ * Return: 0 on success and failure value on error -+ */ -+static int phytium_can_open(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ int ret; -+ -+ ret = pm_runtime_get_sync(cdev->dev); -+ if (ret < 0) { -+ netdev_err(dev, "%s: pm_runtime_get failed(%d)\n", -+ __func__, ret); -+ return ret; -+ } -+ -+ /* Open the CAN device */ -+ ret = open_candev(dev); -+ if (ret) { -+ netdev_err(dev, "failed to open can device\n"); -+ goto disable_clk; -+ } -+ -+ /* Register interrupt handler */ -+ ret = request_irq(dev->irq, phytium_can_isr, -+ IRQF_SHARED, dev->name, dev); -+ if (ret < 0) { -+ netdev_err(dev, "failed to request interrupt\n"); -+ goto fail; -+ } -+ -+ /* Start the controller */ -+ phytium_can_start(dev); -+ -+ netdev_dbg(dev, "%s is going on\n", __func__); -+ -+ napi_enable(&cdev->napi); -+ cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; -+ netif_start_queue(dev); -+ -+ return 0; -+ -+fail: -+ pm_runtime_put(cdev->dev); -+ close_candev(dev); -+disable_clk: -+ pm_runtime_put_sync(cdev->dev); -+ return ret; -+} -+ -+/** -+ * phytium_can_close - Driver close routine -+ * @dev: Pointer to net_device structure -+ * -+ * Return: 0 always -+ */ -+static int phytium_can_close(struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ netif_stop_queue(dev); -+ napi_disable(&cdev->napi); -+ -+ phytium_can_stop(dev); -+ free_irq(dev->irq, dev); -+ pm_runtime_put_sync(cdev->dev); -+ -+ close_candev(dev); -+ -+ return 0; -+} -+ -+/** -+ * phytium_can_start_xmit - Starts the transmission -+ * -+ * Return: 0 on success. -+ */ -+static netdev_tx_t phytium_can_start_xmit(struct sk_buff *skb, struct net_device *dev) -+{ -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ if (can_dropped_invalid_skb(dev, skb)) -+ return NETDEV_TX_OK; -+ -+ cdev->tx_skb = skb; -+ -+ return phytium_can_tx_handler(cdev); -+} -+ -+static const struct net_device_ops phytium_can_netdev_ops = { -+ .ndo_open = phytium_can_open, -+ .ndo_stop = phytium_can_close, -+ .ndo_start_xmit = phytium_can_start_xmit, -+ .ndo_change_mtu = can_change_mtu, -+}; -+ -+static int register_phytium_can_dev(struct net_device *dev) -+{ -+ dev->flags |= IFF_ECHO; -+ dev->netdev_ops = &phytium_can_netdev_ops; -+ -+ return register_candev(dev); -+} -+ -+static int phytium_can_dev_setup(struct phytium_can_dev *cdev) -+{ -+ struct net_device *dev = cdev->net; -+ -+ netif_napi_add(dev, &cdev->napi, phytium_can_poll); -+ -+ cdev->can.do_set_mode = phytium_can_set_mode; -+ cdev->can.do_get_berr_counter = phytium_can_get_berr_counter; -+ -+ cdev->can.ctrlmode_supported = CAN_CTRLMODE_LISTENONLY | -+ CAN_CTRLMODE_BERR_REPORTING; -+ cdev->can.bittiming_const = cdev->bit_timing; -+ -+ if (cdev->fdmode) { -+ cdev->can.ctrlmode_supported |= CAN_CTRLMODE_FD; -+ dev->mtu = CANFD_MTU; -+ cdev->can.ctrlmode = CAN_CTRLMODE_FD; -+ cdev->can.data_bittiming_const = cdev->bit_timing; -+ } -+ spin_lock_init(&cdev->lock); -+ return 0; -+} -+ -+struct phytium_can_dev *phytium_can_allocate_dev(struct device *dev, int sizeof_priv, -+ int tx_fifo_depth) -+{ -+ struct phytium_can_dev *cdev = NULL; -+ struct net_device *net_dev; -+ -+ /* Allocate the can device struct */ -+ net_dev = alloc_candev(sizeof_priv, tx_fifo_depth); -+ if (!net_dev) { -+ dev_err(dev, "Failed to allocate CAN device.\n"); -+ goto out; -+ } -+ -+ cdev = netdev_priv(net_dev); -+ cdev->net = net_dev; -+ cdev->dev = dev; -+ SET_NETDEV_DEV(net_dev, dev); -+ -+out: -+ return cdev; -+} -+EXPORT_SYMBOL(phytium_can_allocate_dev); -+ -+void phytium_can_free_dev(struct net_device *net) -+{ -+ free_candev(net); -+} -+EXPORT_SYMBOL(phytium_can_free_dev); -+ -+int phytium_can_register(struct phytium_can_dev *cdev) -+{ -+ int ret; -+ -+ ret = phytium_can_dev_setup(cdev); -+ if (ret) -+ goto fail; -+ -+ ret = register_phytium_can_dev(cdev->net); -+ if (ret) { -+ dev_err(cdev->dev, "registering %s failed (err=%d)\n", -+ cdev->net->name, ret); -+ goto fail; -+ } -+ -+ cdev->is_tx_done = true; -+ cdev->is_need_stop_xmit = false; -+ timer_setup(&cdev->timer, phytium_can_tx_done_timeout, 0); -+ -+ dev_info(cdev->dev, "%s device registered (irq=%d)\n", -+ KBUILD_MODNAME, cdev->net->irq); -+ -+ /* Probe finished -+ * Stop clocks. They will be reactivated once the device is opened. -+ */ -+ pm_runtime_put_sync(cdev->dev); -+ -+ return 0; -+ -+fail: -+ pm_runtime_put_sync(cdev->dev); -+ return ret; -+} -+EXPORT_SYMBOL(phytium_can_register); -+ -+void phytium_can_unregister(struct phytium_can_dev *cdev) -+{ -+ unregister_candev(cdev->net); -+} -+EXPORT_SYMBOL(phytium_can_unregister); -+ -+int phytium_can_suspend(struct device *dev) -+{ -+ struct net_device *ndev = dev_get_drvdata(dev); -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ -+ if (netif_running(ndev)) { -+ netif_stop_queue(ndev); -+ netif_device_detach(ndev); -+ phytium_can_stop(ndev); -+ pm_runtime_put_sync(cdev->dev); -+ } -+ -+ cdev->can.state = CAN_STATE_SLEEPING; -+ -+ return 0; -+} -+EXPORT_SYMBOL(phytium_can_suspend); -+ -+int phytium_can_resume(struct device *dev) -+{ -+ struct net_device *ndev = dev_get_drvdata(dev); -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ int ret; -+ -+ cdev->can.state = CAN_STATE_ERROR_ACTIVE; -+ -+ if (netif_running(ndev)) { -+ ret = pm_runtime_resume(cdev->dev); -+ if (ret) -+ return ret; -+ -+ phytium_can_start(ndev); -+ netif_device_attach(ndev); -+ netif_start_queue(ndev); -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL(phytium_can_resume); -+ -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("CAN bus driver for Phytium CAN controller"); -+ -diff --git a/drivers/net/can/phytium/phytium_can.h b/drivers/net/can/phytium/phytium_can.h -new file mode 100644 -index 000000000..52bddeddc ---- /dev/null -+++ b/drivers/net/can/phytium/phytium_can.h -@@ -0,0 +1,74 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* Phytium CAN controller driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef _PHYTIUM_CAN_H_ -+#define _PHYTIUM_CAN_H_ -+ -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define KEEP_CAN_FIFO_MIN_LEN 16 -+#define KEEP_CANFD_FIFO_MIN_LEN 128 -+#define CAN_FIFO_BYTE_LEN 256 -+#define STOP_QUEUE_TRUE 1 -+#define STOP_QUEUE_FALSE 0 -+ -+enum phytium_can_ip_type { -+ PHYTIUM_CAN = 0, -+ PHYTIUM_CANFD, -+}; -+ -+struct phytium_can_devtype { -+ enum phytium_can_ip_type cantype; -+ const struct can_bittiming_const *bittiming_const; -+}; -+ -+struct phytium_can_dev { -+ struct can_priv can; -+ -+ struct napi_struct napi; -+ struct net_device *net; -+ struct device *dev; -+ struct clk *clk; -+ -+ struct sk_buff *tx_skb; -+ -+ const struct can_bittiming_const *bit_timing; -+ spinlock_t lock; /*spinlock*/ -+ int fdmode; -+ u32 isr; -+ u32 tx_fifo_depth; -+ unsigned int is_stop_queue_flag; -+ void __iomem *base; -+ -+ struct timer_list timer; /* xmit done timer */ -+ u32 is_tx_done; -+ u32 is_need_stop_xmit; -+}; -+ -+struct phytium_can_dev *phytium_can_allocate_dev(struct device *dev, int sizeof_priv, -+ int tx_fifo_depth); -+void phytium_can_free_dev(struct net_device *net); -+ -+int phytium_can_register(struct phytium_can_dev *cdev); -+void phytium_can_unregister(struct phytium_can_dev *cdev); -+ -+int phytium_can_suspend(struct device *dev); -+int phytium_can_resume(struct device *dev); -+#endif /* _PHYTIUM_CAN_H_ */ -diff --git a/drivers/net/can/phytium/phytium_can_pci.c b/drivers/net/can/phytium/phytium_can_pci.c -new file mode 100644 -index 000000000..a41833b7e ---- /dev/null -+++ b/drivers/net/can/phytium/phytium_can_pci.c -@@ -0,0 +1,148 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* Platform CAN bus driver for Phytium CAN controller -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+ -+#include "phytium_can.h" -+ -+struct phytium_can_pci_config { -+ const struct phytium_can_devtype *devtype; -+ unsigned int clock_freq; -+ unsigned int tx_fifo_depth; -+}; -+ -+#define cdev2priv(dev) container_of(dev, struct phytium_can_pci, cdev) -+ -+struct phytium_can_pci { -+ struct phytium_can_dev cdev; -+ -+ void __iomem *base; -+}; -+ -+static const struct can_bittiming_const phytium_bittiming_const_8192 = { -+ .name = "phytium_can", -+ .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ -+ .tseg1_max = 16, -+ .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ -+ .tseg2_max = 8, -+ .sjw_max = 4, /* Synchronisation jump width */ -+ .brp_min = 1, /* Bit-rate prescaler */ -+ .brp_max = 8192, -+ .brp_inc = 2, -+}; -+ -+static const struct phytium_can_devtype phytium_can_pci = { -+ .cantype = PHYTIUM_CAN, -+ .bittiming_const = &phytium_bittiming_const_8192, -+}; -+ -+static const struct phytium_can_pci_config phytium_can_pci_data = { -+ .devtype = &phytium_can_pci, -+ .clock_freq = 480000000, -+ .tx_fifo_depth = 64, -+}; -+ -+static int phytium_can_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) -+{ -+ const struct phytium_can_pci_config *cfg; -+ struct phytium_can_dev *cdev; -+ struct phytium_can_pci *priv; -+ int ret; -+ -+ cfg = (const struct phytium_can_pci_config *)id->driver_data; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ goto err; -+ -+ ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); -+ if (ret) -+ goto err; -+ -+ cdev = phytium_can_allocate_dev(&pdev->dev, sizeof(struct phytium_can_pci), -+ cfg->tx_fifo_depth); -+ if (!cdev) -+ return -ENOMEM; -+ -+ priv = cdev2priv(cdev); -+ priv->base = pcim_iomap_table(pdev)[0]; -+ -+ cdev->dev = &pdev->dev; -+ cdev->fdmode = cfg->devtype->cantype; -+ cdev->bit_timing = cfg->devtype->bittiming_const; -+ cdev->can.clock.freq = cfg->clock_freq; -+ cdev->tx_fifo_depth = cfg->tx_fifo_depth; -+ -+ cdev->base = priv->base; -+ cdev->net->irq = pdev->irq; -+ -+ pci_set_drvdata(pdev, cdev->net); -+ -+ if (!pm_runtime_enabled(cdev->dev)) -+ pm_runtime_enable(cdev->dev); -+ ret = pm_runtime_get_sync(cdev->dev); -+ if (ret < 0) { -+ netdev_err(cdev->net, "%s: pm_runtime_get failed(%d)\n", -+ __func__, ret); -+ goto err_pmdisable; -+ } -+ ret = phytium_can_register(cdev); -+ if (ret) -+ goto err; -+ -+ return 0; -+ -+err_pmdisable: -+ pm_runtime_disable(&pdev->dev); -+err: -+ return ret; -+} -+ -+static void phytium_can_pci_remove(struct pci_dev *pdev) -+{ -+ struct net_device *dev = pci_get_drvdata(pdev); -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ pm_runtime_disable(cdev->dev); -+ -+ phytium_can_unregister(cdev); -+ phytium_can_free_dev(cdev->net); -+} -+ -+static __maybe_unused int phytium_can_pci_suspend(struct device *dev) -+{ -+ return phytium_can_suspend(dev); -+} -+ -+static __maybe_unused int phytium_can_pci_resume(struct device *dev) -+{ -+ return phytium_can_resume(dev); -+} -+ -+static SIMPLE_DEV_PM_OPS(phytium_can_pci_pm_ops, -+ phytium_can_pci_suspend, phytium_can_pci_resume); -+ -+static const struct pci_device_id phytium_can_pci_id_table[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc2d), (kernel_ulong_t)&phytium_can_pci_data, }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(pci, phytium_can_pci_id_table); -+ -+static struct pci_driver phytium_can_pci_driver = { -+ .name = KBUILD_MODNAME, -+ .probe = phytium_can_pci_probe, -+ .remove = phytium_can_pci_remove, -+ .id_table = phytium_can_pci_id_table, -+ .driver = { -+ .pm = &phytium_can_pci_pm_ops, -+ }, -+}; -+ -+module_pci_driver(phytium_can_pci_driver); -+ -+MODULE_AUTHOR("Cheng Quan -+#include -+#include -+ -+#include "phytium_can.h" -+ -+#define cdev2priv(dev) container_of(dev, struct phytium_can_plat, cdev) -+ -+struct phytium_can_plat { -+ struct phytium_can_dev cdev; -+ struct phytium_can_devtype *devtype; -+ -+ int irq; -+ void __iomem *reg_base; -+}; -+ -+static const struct can_bittiming_const phytium_bittiming_const_512 = { -+ .name = "phytium_can", -+ .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ -+ .tseg1_max = 16, -+ .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ -+ .tseg2_max = 8, -+ .sjw_max = 4, /* Synchronisation jump width */ -+ .brp_min = 1, /* Bit-rate prescaler */ -+ .brp_max = 512, -+ .brp_inc = 2, -+}; -+ -+static const struct can_bittiming_const phytium_bittiming_const_8192 = { -+ .name = "phytium_can", -+ .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ -+ .tseg1_max = 16, -+ .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ -+ .tseg2_max = 8, -+ .sjw_max = 4, /* Synchronisation jump width */ -+ .brp_min = 1, /* Bit-rate prescaler */ -+ .brp_max = 8192, -+ .brp_inc = 2, -+}; -+ -+static const struct phytium_can_devtype phytium_can_data = { -+ .cantype = PHYTIUM_CAN, -+ .bittiming_const = &phytium_bittiming_const_512, -+}; -+ -+static const struct phytium_can_devtype phytium_canfd_data = { -+ .cantype = PHYTIUM_CANFD, -+ .bittiming_const = &phytium_bittiming_const_8192, -+}; -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_can_acpi_ids[] = { -+ { "PHYT000A", 0 }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_can_acpi_ids); -+#endif -+ -+#ifdef CONFIG_OF -+static const struct of_device_id phytium_can_of_ids[] = { -+ { .compatible = "phytium,can", .data = &phytium_can_data }, -+ { .compatible = "phytium,canfd", .data = &phytium_canfd_data }, -+ { /* sentinel */ }, -+}; -+MODULE_DEVICE_TABLE(of, phytium_can_of_ids); -+#endif -+ -+static int phytium_can_plat_probe(struct platform_device *pdev) -+{ -+ struct phytium_can_dev *cdev; -+ struct phytium_can_plat *priv; -+ struct resource *res; -+ const struct of_device_id *of_id; -+ const struct phytium_can_devtype *devtype = &phytium_can_data; -+ u32 tx_fifo_depth; -+ int ret; -+ const char *str = "can"; -+ -+ ret = fwnode_property_read_u32(dev_fwnode(&pdev->dev), "tx-fifo-depth", &tx_fifo_depth); -+ if (ret) -+ tx_fifo_depth = 64; -+ -+ cdev = phytium_can_allocate_dev(&pdev->dev, sizeof(struct phytium_can_plat), -+ tx_fifo_depth); -+ if (!cdev) -+ return -ENOMEM; -+ -+ priv = cdev2priv(cdev); -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ priv->reg_base = devm_ioremap_resource(&pdev->dev, res); -+ priv->irq = platform_get_irq(pdev, 0); -+ if (IS_ERR(priv->reg_base) || cdev->net->irq < 0) { -+ ret = -EINVAL; -+ goto fail; -+ } -+ -+ if (pdev->dev.of_node) { -+ cdev->clk = devm_clk_get(&pdev->dev, "can_clk"); -+ if (IS_ERR(cdev->clk)) { -+ dev_err(&pdev->dev, "no clock found\n"); -+ ret = -ENODEV; -+ goto fail; -+ } -+ cdev->can.clock.freq = clk_get_rate(cdev->clk); -+ -+ of_id = of_match_device(phytium_can_of_ids, &pdev->dev); -+ if (of_id && of_id->data) -+ devtype = of_id->data; -+ } else if (has_acpi_companion(&pdev->dev)) { -+ ret = fwnode_property_read_u32(dev_fwnode(&pdev->dev), -+ "clock-frequency", -+ &cdev->can.clock.freq); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "failed to get clock frequency.\n"); -+ goto fail; -+ } -+ -+ fwnode_property_read_string(dev_fwnode(&pdev->dev), -+ "mode-select", &str); -+ if (!(strcmp(str, "canfd"))) -+ devtype = &phytium_canfd_data; -+ } -+ -+ cdev->tx_fifo_depth = tx_fifo_depth; -+ -+ if (devtype->cantype == PHYTIUM_CANFD) -+ cdev->fdmode = 1; -+ else -+ cdev->fdmode = 0; -+ -+ if (fwnode_property_present(dev_fwnode(&pdev->dev), "extend_brp")) -+ cdev->bit_timing = &phytium_bittiming_const_8192; -+ else -+ cdev->bit_timing = devtype->bittiming_const; -+ cdev->can.bittiming_const = devtype->bittiming_const; -+ cdev->base = priv->reg_base; -+ cdev->net->irq = priv->irq; -+ -+ platform_set_drvdata(pdev, cdev->net); -+ -+ if (!pm_runtime_enabled(cdev->dev)) -+ pm_runtime_enable(cdev->dev); -+ ret = pm_runtime_get_sync(cdev->dev); -+ if (ret < 0) { -+ netdev_err(cdev->net, "%s: pm_runtime_get failed(%d)\n", -+ __func__, ret); -+ goto out_runtime_disable; -+ } -+ -+ ret = phytium_can_register(cdev); -+ if (ret) -+ goto out_runtime_disable; -+ -+ return ret; -+ -+out_runtime_disable: -+ pm_runtime_disable(cdev->dev); -+fail: -+ phytium_can_free_dev(cdev->net); -+ return ret; -+} -+ -+static __maybe_unused int phytium_can_plat_suspend(struct device *dev) -+{ -+ return phytium_can_suspend(dev); -+} -+ -+static __maybe_unused int phytium_can_plat_resume(struct device *dev) -+{ -+ return phytium_can_resume(dev); -+} -+ -+static int phytium_can_plat_remove(struct platform_device *pdev) -+{ -+ struct net_device *dev = platform_get_drvdata(pdev); -+ struct phytium_can_dev *cdev = netdev_priv(dev); -+ -+ phytium_can_unregister(cdev); -+ -+ phytium_can_free_dev(cdev->net); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_can_runtime_suspend(struct device *dev) -+{ -+ struct net_device *ndev = dev_get_drvdata(dev); -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ -+ clk_disable_unprepare(cdev->clk); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_can_runtime_resume(struct device *dev) -+{ -+ struct net_device *ndev = dev_get_drvdata(dev); -+ struct phytium_can_dev *cdev = netdev_priv(ndev); -+ -+ return clk_prepare_enable(cdev->clk); -+} -+ -+static const struct dev_pm_ops phytium_can_plat_pm_ops = { -+ SET_RUNTIME_PM_OPS(phytium_can_runtime_suspend, -+ phytium_can_runtime_resume, NULL) -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_can_suspend, phytium_can_resume) -+}; -+ -+static struct platform_driver phytium_can_plat_driver = { -+ .driver = { -+ .name = KBUILD_MODNAME, -+ .of_match_table = of_match_ptr(phytium_can_of_ids), -+ .acpi_match_table = ACPI_PTR(phytium_can_acpi_ids), -+ .pm = &phytium_can_plat_pm_ops, -+ }, -+ .probe = phytium_can_plat_probe, -+ .remove = phytium_can_plat_remove, -+}; -+ -+module_platform_driver(phytium_can_plat_driver); -+ -+MODULE_AUTHOR("Cheng Quan "); -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Phytium CAN driver for IO Mapped controllers"); -diff --git a/drivers/net/ethernet/Kconfig b/drivers/net/ethernet/Kconfig -index 5a274b99f..0b38c5f99 100644 ---- a/drivers/net/ethernet/Kconfig -+++ b/drivers/net/ethernet/Kconfig -@@ -163,6 +163,7 @@ config ETHOC - source "drivers/net/ethernet/packetengines/Kconfig" - source "drivers/net/ethernet/pasemi/Kconfig" - source "drivers/net/ethernet/pensando/Kconfig" -+source "drivers/net/ethernet/phytium/Kconfig" - source "drivers/net/ethernet/qlogic/Kconfig" - source "drivers/net/ethernet/brocade/Kconfig" - source "drivers/net/ethernet/qualcomm/Kconfig" -diff --git a/drivers/net/ethernet/Makefile b/drivers/net/ethernet/Makefile -index 0d872d4ef..72d80f46a 100644 ---- a/drivers/net/ethernet/Makefile -+++ b/drivers/net/ethernet/Makefile -@@ -75,6 +75,7 @@ obj-$(CONFIG_NET_VENDOR_OKI) += oki-semi/ - obj-$(CONFIG_ETHOC) += ethoc.o - obj-$(CONFIG_NET_VENDOR_PACKET_ENGINES) += packetengines/ - obj-$(CONFIG_NET_VENDOR_PASEMI) += pasemi/ -+obj-$(CONFIG_NET_VENDOR_PHYTIUM) += phytium/ - obj-$(CONFIG_NET_VENDOR_QLOGIC) += qlogic/ - obj-$(CONFIG_NET_VENDOR_QUALCOMM) += qualcomm/ - obj-$(CONFIG_NET_VENDOR_REALTEK) += realtek/ -diff --git a/drivers/net/ethernet/cadence/macb.h b/drivers/net/ethernet/cadence/macb.h -index 78c972bb1..3a5441dcc 100644 ---- a/drivers/net/ethernet/cadence/macb.h -+++ b/drivers/net/ethernet/cadence/macb.h -@@ -85,6 +85,7 @@ - #define GEM_PBUFRXCUT 0x0044 /* RX Partial Store and Forward */ - #define GEM_JML 0x0048 /* Jumbo Max Length */ - #define GEM_HS_MAC_CONFIG 0x0050 /* GEM high speed config */ -+#define GEM_AXI_PIPE 0x0054 /* Axi max pipeline register*/ - #define GEM_HRB 0x0080 /* Hash Bottom */ - #define GEM_HRT 0x0084 /* Hash Top */ - #define GEM_SA1B 0x0088 /* Specific1 Bottom */ -@@ -220,6 +221,36 @@ - #define GEM_IDR(hw_q) (0x0620 + ((hw_q) << 2)) - #define GEM_IMR(hw_q) (0x0640 + ((hw_q) << 2)) - -+#define GEM_SRC_SEL_LN 0x1C04 -+#define GEM_DIV_SEL0_LN 0x1C08 -+#define GEM_DIV_SEL1_LN 0x1C0C -+#define GEM_PMA_XCVR_POWER_STATE 0x1C10 -+#define GEM_SPEED_MODE 0x1C14 -+#define GEM_MII_SELECT 0x1C18 -+#define GEM_SEL_MII_ON_RGMII 0x1C1C -+#define GEM_TX_CLK_SEL0 0x1C20 -+#define GEM_TX_CLK_SEL1 0x1C24 -+#define GEM_TX_CLK_SEL2 0x1C28 -+#define GEM_TX_CLK_SEL3 0x1C2C -+#define GEM_RX_CLK_SEL0 0x1C30 -+#define GEM_RX_CLK_SEL1 0x1C34 -+#define GEM_CLK_250M_DIV10_DIV100_SEL 0x1C38 -+#define GEM_TX_CLK_SEL5 0x1C3C -+#define GEM_TX_CLK_SEL6 0x1C40 -+#define GEM_RX_CLK_SEL4 0x1C44 -+#define GEM_RX_CLK_SEL5 0x1C48 -+#define GEM_TX_CLK_SEL3_0 0x1C70 -+#define GEM_TX_CLK_SEL4_0 0x1C74 -+#define GEM_RX_CLK_SEL3_0 0x1C78 -+#define GEM_RX_CLK_SEL4_0 0x1C7C -+#define GEM_RGMII_TX_CLK_SEL0 0x1C80 -+#define GEM_RGMII_TX_CLK_SEL1 0x1C84 -+ -+#define GEM_PHY_INT_ENABLE 0x1C88 -+#define GEM_PHY_INT_CLEAR 0x1C8C -+#define GEM_PHY_INT_STATE 0x1C90 -+#define GEM_INTX_IRQ_MASK 0x1C7C /* Phytium: irq mask */ -+ - /* Bitfields in NCR */ - #define MACB_LB_OFFSET 0 /* reserved */ - #define MACB_LB_SIZE 1 -@@ -254,6 +285,8 @@ - #define MACB_OSSMODE_SIZE 1 - #define MACB_MIIONRGMII_OFFSET 28 /* MII Usage on RGMII Interface */ - #define MACB_MIIONRGMII_SIZE 1 -+#define MACB_2PT5G_OFFSET 29 /* 2.5G operation selected */ -+#define MACB_2PT5G_SIZE 1 - - /* Bitfields in NCFGR */ - #define MACB_SPD_OFFSET 0 /* Speed */ -@@ -562,6 +595,8 @@ - #define GEM_RX_SCR_BYPASS_SIZE 1 - #define GEM_TX_SCR_BYPASS_OFFSET 8 - #define GEM_TX_SCR_BYPASS_SIZE 1 -+#define GEM_RX_SYNC_RESET_OFFSET 2 -+#define GEM_RX_SYNC_RESET_SIZE 1 - #define GEM_TX_EN_OFFSET 1 - #define GEM_TX_EN_SIZE 1 - #define GEM_SIGNAL_OK_OFFSET 0 -@@ -731,8 +766,10 @@ - #define MACB_CAPS_GEM_HAS_PTP 0x00000040 - #define MACB_CAPS_BD_RD_PREFETCH 0x00000080 - #define MACB_CAPS_NEEDS_RSTONUBR 0x00000100 -+#define MACB_CAPS_SEL_CLK 0x00000800 - #define MACB_CAPS_MIIONRGMII 0x00000200 - #define MACB_CAPS_NEED_TSUCLK 0x00000400 -+#define MACB_CAPS_SEL_CLK 0x00000800 - #define MACB_CAPS_PCS 0x01000000 - #define MACB_CAPS_HIGH_SPEED 0x02000000 - #define MACB_CAPS_CLK_HW_CHG 0x04000000 -@@ -741,6 +778,8 @@ - #define MACB_CAPS_GIGABIT_MODE_AVAILABLE 0x20000000 - #define MACB_CAPS_SG_DISABLED 0x40000000 - #define MACB_CAPS_MACB_IS_GEM 0x80000000 -+#define MACB_CAPS_PCS 0x01000000 -+#define MACB_CAPS_HIGH_SPEED 0x02000000 - - /* LSO settings */ - #define MACB_LSO_UFO_ENABLE 0x01 -@@ -783,6 +822,8 @@ - #define gem_readl_n(port, reg, idx) (port)->macb_reg_readl((port), GEM_##reg + idx * 4) - #define gem_writel_n(port, reg, idx, value) (port)->macb_reg_writel((port), GEM_##reg + idx * 4, (value)) - -+#define PTP_TS_BUFFER_SIZE 128 /* must be power of 2 */ -+ - /* Conditional GEM/MACB macros. These perform the operation to the correct - * register dependent on whether the device is a GEM or a MACB. For registers - * and bitfields that are common across both devices, use macb_{read,write}l -@@ -832,6 +873,11 @@ struct macb_dma_desc_ptp { - u32 ts_1; - u32 ts_2; - }; -+ -+struct gem_tx_ts { -+ struct sk_buff *skb; -+ struct macb_dma_desc_ptp desc_ptp; -+}; - #endif - - /* DMA descriptor bitfields */ -@@ -1193,6 +1239,7 @@ struct macb_config { - unsigned int max_tx_length; - int jumbo_max_len; - const struct macb_usrio_config *usrio; -+ void (*sel_clk_hw)(struct macb *bp, int speed); - }; - - struct tsu_incr { -@@ -1231,8 +1278,15 @@ struct macb_queue { - struct macb_dma_desc *rx_ring; - struct sk_buff **rx_skbuff; - void *rx_buffers; -+ struct napi_struct napi; - struct napi_struct napi_rx; - struct queue_stats stats; -+ -+#ifdef CONFIG_MACB_USE_HWSTAMP -+ struct work_struct tx_ts_task; -+ unsigned int tx_ts_head, tx_ts_tail; -+ struct gem_tx_ts tx_timestamps[PTP_TS_BUFFER_SIZE]; -+#endif - }; - - struct ethtool_rx_fs_item { -@@ -1270,6 +1324,7 @@ struct macb { - struct clk *rx_clk; - struct clk *tsu_clk; - struct net_device *dev; -+ struct ncsi_dev *ndev; - union { - struct macb_stats macb; - struct gem_stats gem; -@@ -1282,6 +1337,10 @@ struct macb { - struct phylink_config phylink_config; - struct phylink_pcs phylink_usx_pcs; - struct phylink_pcs phylink_sgmii_pcs; -+ int link; -+ int speed; -+ int duplex; -+ int use_ncsi; - - u32 caps; - unsigned int dma_burst_length; -@@ -1330,6 +1389,8 @@ struct macb { - - struct macb_pm_data pm_data; - const struct macb_usrio_config *usrio; -+ -+ void (*sel_clk_hw)(struct macb *bp, int speed); - }; - - #ifdef CONFIG_MACB_USE_HWSTAMP -diff --git a/drivers/net/ethernet/cadence/macb_main.c b/drivers/net/ethernet/cadence/macb_main.c -index b940dcd3a..683d2095c 100644 ---- a/drivers/net/ethernet/cadence/macb_main.c -+++ b/drivers/net/ethernet/cadence/macb_main.c -@@ -26,6 +26,7 @@ - #include - #include - #include -+#include - #include - #include - #include -@@ -38,6 +39,8 @@ - #include - #include - #include -+#include -+#include - #include "macb.h" - - /* This structure is only used for MACB on SiFive FU540 devices */ -@@ -47,6 +50,9 @@ struct sifive_fu540_macb_mgmt { - struct clk_hw hw; - }; - -+#define MAX_RING_ADDR_ALLOC_TIMES 3 -+#define RING_ADDR_INTERVAL 128 -+ - #define MACB_RX_BUFFER_SIZE 128 - #define RX_BUFFER_MULTIPLE 64 /* bytes */ - -@@ -87,7 +93,12 @@ struct sifive_fu540_macb_mgmt { - #define MACB_WOL_HAS_MAGIC_PACKET (0x1 << 0) - #define MACB_WOL_ENABLED (0x1 << 1) - --#define HS_SPEED_10000M 4 -+#define HS_SPEED_100M 0 -+#define HS_SPEED_1000M 1 -+#define HS_SPEED_2500M 2 -+#define HS_SPEED_5000M 3 -+#define HS_SPEED_10000M 4 -+#define MACB_SERDES_RATE_5G 0 - #define MACB_SERDES_RATE_10G 1 - - /* Graceful stop timeouts in us. We should allow up to -@@ -98,6 +109,10 @@ struct sifive_fu540_macb_mgmt { - - #define MACB_MDIO_TIMEOUT 1000000 /* in usecs */ - -+static void macb_tx_unmap(struct macb *bp, -+ struct macb_tx_skb *tx_skb, -+ int budget); -+ - /* DMA buffer descriptor might be different size - * depends on hardware configuration: - * -@@ -562,7 +577,7 @@ static void macb_set_tx_clk(struct macb *bp, int speed) - netdev_err(bp->dev, "adjusting tx_clk failed.\n"); - } - --static void macb_usx_pcs_link_up(struct phylink_pcs *pcs, unsigned int neg_mode, -+static void macb_usx_pcs_link_up(struct phylink_pcs *pcs, unsigned int mode, - phy_interface_t interface, int speed, - int duplex) - { -@@ -570,10 +585,25 @@ static void macb_usx_pcs_link_up(struct phylink_pcs *pcs, unsigned int neg_mode, - u32 config; - - config = gem_readl(bp, USX_CONTROL); -- config = GEM_BFINS(SERDES_RATE, MACB_SERDES_RATE_10G, config); -- config = GEM_BFINS(USX_CTRL_SPEED, HS_SPEED_10000M, config); -+ if (speed == SPEED_10000) { -+ config = GEM_BFINS(SERDES_RATE, MACB_SERDES_RATE_10G, config); -+ config = GEM_BFINS(USX_CTRL_SPEED, HS_SPEED_10000M, config); -+ } else if (speed == SPEED_5000) { -+ config = GEM_BFINS(SERDES_RATE, MACB_SERDES_RATE_5G, config); -+ config = GEM_BFINS(USX_CTRL_SPEED, HS_SPEED_5000M, config); -+ } -+ - config &= ~(GEM_BIT(TX_SCR_BYPASS) | GEM_BIT(RX_SCR_BYPASS)); -- config |= GEM_BIT(TX_EN); -+ /* reset */ -+ config &= ~(GEM_BIT(SIGNAL_OK) | GEM_BIT(TX_EN)); -+ config |= GEM_BIT(RX_SYNC_RESET); -+ -+ gem_writel(bp, USX_CONTROL, config); -+ -+ /* enable rx and tx */ -+ config &= ~(GEM_BIT(RX_SYNC_RESET)); -+ config |= GEM_BIT(SIGNAL_OK) | GEM_BIT(TX_EN); -+ - gem_writel(bp, USX_CONTROL, config); - } - -@@ -583,7 +613,12 @@ static void macb_usx_pcs_get_state(struct phylink_pcs *pcs, - struct macb *bp = container_of(pcs, struct macb, phylink_usx_pcs); - u32 val; - -- state->speed = SPEED_10000; -+ if (state->interface == PHY_INTERFACE_MODE_5GBASER) -+ state->speed = SPEED_5000; -+ else if (state->interface == PHY_INTERFACE_MODE_10GBASER || -+ state->interface == PHY_INTERFACE_MODE_USXGMII) -+ state->speed = bp->speed; -+ - state->duplex = 1; - state->an_complete = 1; - -@@ -661,9 +696,12 @@ static void macb_mac_config(struct phylink_config *config, unsigned int mode, - ctrl &= ~(GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL)); - ncr &= ~GEM_BIT(ENABLE_HS_MAC); - -- if (state->interface == PHY_INTERFACE_MODE_SGMII) { -+ if (state->interface == PHY_INTERFACE_MODE_SGMII || -+ state->interface == PHY_INTERFACE_MODE_2500BASEX) { - ctrl |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL); -- } else if (state->interface == PHY_INTERFACE_MODE_10GBASER) { -+ } else if (state->interface == PHY_INTERFACE_MODE_10GBASER || -+ state->interface == PHY_INTERFACE_MODE_USXGMII || -+ state->interface == PHY_INTERFACE_MODE_5GBASER) { - ctrl |= GEM_BIT(PCSSEL); - ncr |= GEM_BIT(ENABLE_HS_MAC); - } else if (bp->caps & MACB_CAPS_MIIONRGMII && -@@ -683,7 +721,8 @@ static void macb_mac_config(struct phylink_config *config, unsigned int mode, - * Must be written after PCSSEL is set in NCFGR, - * otherwise writes will not take effect. - */ -- if (macb_is_gem(bp) && state->interface == PHY_INTERFACE_MODE_SGMII) { -+ if (macb_is_gem(bp) && (state->interface == PHY_INTERFACE_MODE_SGMII || -+ state->interface == PHY_INTERFACE_MODE_2500BASEX)) { - u32 pcsctrl, old_pcsctrl; - - old_pcsctrl = gem_readl(bp, PCSCNTRL); -@@ -703,9 +742,14 @@ static void macb_mac_link_down(struct phylink_config *config, unsigned int mode, - { - struct net_device *ndev = to_net_dev(config->dev); - struct macb *bp = netdev_priv(ndev); -+ struct macb_tx_skb *tx_skb; - struct macb_queue *queue; - unsigned int q; - u32 ctrl; -+ int i; -+ -+ if (bp->use_ncsi) -+ ncsi_stop_dev(bp->ndev); - - if (!(bp->caps & MACB_CAPS_MACB_IS_EMAC)) - for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) -@@ -713,12 +757,172 @@ static void macb_mac_link_down(struct phylink_config *config, unsigned int mode, - bp->rx_intr_mask | MACB_TX_INT_FLAGS | MACB_BIT(HRESP)); - - /* Disable Rx and Tx */ -- ctrl = macb_readl(bp, NCR) & ~(MACB_BIT(RE) | MACB_BIT(TE)); -+ ctrl = macb_readl(bp, NCR) & ~(MACB_BIT(RE) | -+ MACB_BIT(TE)) & ~(MACB_BIT(2PT5G)); - macb_writel(bp, NCR, ctrl); - -+ /* Tx clean */ -+ for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) { -+ for (i = 0; i < bp->tx_ring_size; i++) { -+ tx_skb = macb_tx_skb(queue, i); -+ /* free unsent skb buffers */ -+ if (tx_skb) -+ macb_tx_unmap(bp, tx_skb, 0); -+ } -+ } -+ - netif_tx_stop_all_queues(ndev); - } - -+static void phytium_gem1p0_sel_clk(struct macb *bp, int speed) -+{ -+ if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER || -+ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ if (speed == SPEED_5000) { -+ gem_writel(bp, DIV_SEL0_LN, 0x8); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x0); /*0x1c10*/ -+ } else { -+ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x1); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ -+ } -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ gem_writel(bp, DIV_SEL0_LN, 0x8); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x0); /*0x1c10*/ -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ gem_writel(bp, DIV_SEL0_LN, 0x1); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x1); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ -+ gem_writel(bp, TX_CLK_SEL3_0, 0x0); /*0x1c70*/ -+ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ -+ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ -+ gem_writel(bp, RX_CLK_SEL4_0, 0x0); /*0x1c7c*/ -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { -+ if (speed == SPEED_1000) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x8); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x0); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ -+ gem_writel(bp, TX_CLK_SEL3_0, 0x0); /*0x1c70*/ -+ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ -+ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ -+ gem_writel(bp, RX_CLK_SEL4_0, 0x0); /*0x1c7c*/ -+ } else if (speed == SPEED_100 || speed == SPEED_10) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x8); /*0x1c0c*/ -+ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x0); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x1); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ -+ gem_writel(bp, TX_CLK_SEL3_0, 0x1); /*0x1c70*/ -+ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ -+ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ -+ gem_writel(bp, RX_CLK_SEL4_0, 0x1); /*0x1c7c*/ -+ } -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_RGMII || -+ bp->phy_interface == PHY_INTERFACE_MODE_RGMII_ID) { -+ if (speed == SPEED_1000) { -+ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ -+ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ -+ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x0); /*0x1c38*/ -+ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x1); /*0x1c80*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ -+ } else if (speed == SPEED_100) { -+ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ -+ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ -+ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x0); /*0x1c38*/ -+ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x0); /*0x1c80*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ -+ } else { -+ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ -+ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ -+ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ -+ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ -+ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ -+ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ -+ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ -+ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ -+ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x1); /*0x1c38*/ -+ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x0); /*0x1c80*/ -+ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ -+ } -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_RMII) { -+ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ -+ } -+ -+ if (speed == SPEED_100) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_100M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_1000) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_1000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_2500) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_2500M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_5000) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_10000) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_10000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+} -+ -+static void phytium_gem2p0_sel_clk(struct macb *bp, int speed) -+{ -+ if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { -+ if (speed == SPEED_100 || speed == SPEED_10) { -+ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ -+ gem_writel(bp, DIV_SEL1_LN, 0x1); /*0x1c0c*/ -+ } -+ } -+ -+ if (speed == SPEED_100 || speed == SPEED_10) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_100M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_1000) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_1000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else if (speed == SPEED_2500) -+ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_2500M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+} -+ - static void macb_mac_link_up(struct phylink_config *config, - struct phy_device *phy, - unsigned int mode, phy_interface_t interface, -@@ -731,9 +935,13 @@ static void macb_mac_link_up(struct phylink_config *config, - unsigned long flags; - unsigned int q; - u32 ctrl; -+ int err; - - spin_lock_irqsave(&bp->lock, flags); - -+ if (bp->caps & MACB_CAPS_SEL_CLK) -+ bp->sel_clk_hw(bp, speed); -+ - ctrl = macb_or_gem_readl(bp, NCFGR); - - ctrl &= ~(MACB_BIT(SPD) | MACB_BIT(FD)); -@@ -749,13 +957,15 @@ static void macb_mac_link_up(struct phylink_config *config, - if (macb_is_gem(bp)) { - ctrl &= ~GEM_BIT(GBE); - -- if (speed == SPEED_1000) -+ if (speed == SPEED_1000 || speed == SPEED_2500) - ctrl |= GEM_BIT(GBE); - } - - if (rx_pause) - ctrl |= MACB_BIT(PAE); - -+ macb_set_tx_clk(bp, speed); -+ - /* Initialize rings & buffers as clearing MACB_BIT(TE) in link down - * cleared the pipeline and control registers. - */ -@@ -769,9 +979,28 @@ static void macb_mac_link_up(struct phylink_config *config, - - macb_or_gem_writel(bp, NCFGR, ctrl); - -- if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER) -- gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_10000M, -- gem_readl(bp, HS_MAC_CONFIG))); -+ if (speed == SPEED_2500) { -+ u32 network_ctrl; -+ -+ network_ctrl = macb_readl(bp, NCR); -+ network_ctrl |= MACB_BIT(2PT5G); -+ macb_writel(bp, NCR, network_ctrl); -+ } -+ -+ if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER || -+ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { -+ if (speed == SPEED_5000) -+ gem_writel(bp, HS_MAC_CONFIG, -+ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ else -+ gem_writel(bp, HS_MAC_CONFIG, -+ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_10000M, -+ gem_readl(bp, HS_MAC_CONFIG))); -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) -+ gem_writel(bp, HS_MAC_CONFIG, -+ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, -+ gem_readl(bp, HS_MAC_CONFIG))); - - spin_unlock_irqrestore(&bp->lock, flags); - -@@ -785,6 +1014,15 @@ static void macb_mac_link_up(struct phylink_config *config, - - macb_writel(bp, NCR, ctrl | MACB_BIT(RE) | MACB_BIT(TE)); - -+ if (bp->use_ncsi) { -+ /* Start the NCSI device */ -+ err = ncsi_start_dev(bp->ndev); -+ if (err) { -+ netdev_err(bp->dev, "Ncsi start dev failed (error %d)\n", err); -+ return; -+ } -+ } -+ - netif_tx_wake_all_queues(ndev); - } - -@@ -794,12 +1032,16 @@ static struct phylink_pcs *macb_mac_select_pcs(struct phylink_config *config, - struct net_device *ndev = to_net_dev(config->dev); - struct macb *bp = netdev_priv(ndev); - -- if (interface == PHY_INTERFACE_MODE_10GBASER) -+ if (interface == PHY_INTERFACE_MODE_10GBASER || -+ interface == PHY_INTERFACE_MODE_5GBASER || -+ interface == PHY_INTERFACE_MODE_USXGMII) { - return &bp->phylink_usx_pcs; -- else if (interface == PHY_INTERFACE_MODE_SGMII) -+ } else if (interface == PHY_INTERFACE_MODE_SGMII || -+ interface == PHY_INTERFACE_MODE_2500BASEX) { - return &bp->phylink_sgmii_pcs; -- else -+ } else { - return NULL; -+ } - } - - static const struct phylink_mac_ops macb_phylink_ops = { -@@ -821,7 +1063,7 @@ static int macb_phylink_connect(struct macb *bp) - struct device_node *dn = bp->pdev->dev.of_node; - struct net_device *dev = bp->dev; - struct phy_device *phydev; -- int ret; -+ int ret = 0; - - if (dn) - ret = phylink_of_phy_connect(bp->phylink, dn, 0); -@@ -834,7 +1076,8 @@ static int macb_phylink_connect(struct macb *bp) - } - - /* attach the mac to the phy */ -- ret = phylink_connect_phy(bp->phylink, phydev); -+ if (phylink_expects_phy(bp->phylink)) -+ ret = phylink_connect_phy(bp->phylink, phydev); - } - - if (ret) { -@@ -856,6 +1099,20 @@ static void macb_get_pcs_fixed_state(struct phylink_config *config, - state->link = (macb_readl(bp, NSR) & MACB_BIT(NSR_LINK)) != 0; - } - -+static void macb_get_usx_pcs_fixed_state(struct phylink_config *config, -+ struct phylink_link_state *state) -+{ -+ u32 val; -+ struct net_device *ndev = to_net_dev(config->dev); -+ struct macb *bp = netdev_priv(ndev); -+ -+ val = gem_readl(bp, USX_STATUS); -+ state->link = !!(val & GEM_BIT(USX_BLOCK_LOCK)); -+ val = gem_readl(bp, NCFGR); -+ if (val & GEM_BIT(PAE)) -+ state->pause = MLO_PAUSE_RX; -+} -+ - /* based on au1000_eth. c*/ - static int macb_mii_probe(struct net_device *dev) - { -@@ -873,6 +1130,10 @@ static int macb_mii_probe(struct net_device *dev) - if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { - bp->phylink_config.poll_fixed_state = true; - bp->phylink_config.get_fixed_state = macb_get_pcs_fixed_state; -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX || -+ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { -+ bp->phylink_config.poll_fixed_state = true; -+ bp->phylink_config.get_fixed_state = macb_get_usx_pcs_fixed_state; - } - - bp->phylink_config.mac_capabilities = MAC_ASYM_PAUSE | -@@ -900,10 +1161,18 @@ static int macb_mii_probe(struct net_device *dev) - if (bp->caps & MACB_CAPS_HIGH_SPEED) { - __set_bit(PHY_INTERFACE_MODE_10GBASER, - bp->phylink_config.supported_interfaces); -+ __set_bit(PHY_INTERFACE_MODE_USXGMII, -+ bp->phylink_config.supported_interfaces); - bp->phylink_config.mac_capabilities |= MAC_10000FD; - } - } - -+ if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII || -+ bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { -+ bp->phylink_config.poll_fixed_state = true; -+ bp->phylink_config.get_fixed_state = macb_get_pcs_fixed_state; -+ } -+ - bp->phylink = phylink_create(&bp->phylink_config, bp->pdev->dev.fwnode, - bp->phy_interface, &macb_phylink_ops); - if (IS_ERR(bp->phylink)) { -@@ -1316,6 +1585,7 @@ static void gem_rx_refill(struct macb_queue *queue) - /* Make hw descriptor updates visible to CPU */ - rmb(); - -+ queue->rx_prepared_head++; - desc = macb_rx_desc(queue, entry); - - if (!queue->rx_skbuff[entry]) { -@@ -1354,7 +1624,6 @@ static void gem_rx_refill(struct macb_queue *queue) - dma_wmb(); - desc->addr &= ~MACB_BIT(RX_USED); - } -- queue->rx_prepared_head++; - } - - /* Make descriptor updates visible to hardware */ -@@ -2473,27 +2742,48 @@ static void macb_free_rx_buffers(struct macb *bp) - - static void macb_free_consistent(struct macb *bp) - { -+ struct macb_dma_desc *tx_ring_base = NULL; -+ struct macb_dma_desc *rx_ring_base = NULL; -+ dma_addr_t tx_ring_base_addr; -+ dma_addr_t rx_ring_base_addr; - struct macb_queue *queue; - unsigned int q; - int size; - - bp->macbgem_ops.mog_free_rx_buffers(bp); - -+ queue = bp->queues; -+ if (queue->tx_ring) { -+ tx_ring_base = queue->tx_ring; -+ tx_ring_base_addr = queue->tx_ring_dma; -+ } -+ if (queue->rx_ring) { -+ rx_ring_base = queue->rx_ring; -+ rx_ring_base_addr = queue->rx_ring_dma; -+ } -+ - for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) { - kfree(queue->tx_skb); - queue->tx_skb = NULL; -- if (queue->tx_ring) { -- size = TX_RING_BYTES(bp) + bp->tx_bd_rd_prefetch; -- dma_free_coherent(&bp->pdev->dev, size, -- queue->tx_ring, queue->tx_ring_dma); -+ if (queue->tx_ring) - queue->tx_ring = NULL; -- } -- if (queue->rx_ring) { -- size = RX_RING_BYTES(bp) + bp->rx_bd_rd_prefetch; -- dma_free_coherent(&bp->pdev->dev, size, -- queue->rx_ring, queue->rx_ring_dma); -+ if (queue->rx_ring) - queue->rx_ring = NULL; -- } -+ } -+ -+ if (tx_ring_base) { -+ size = bp->num_queues * (TX_RING_BYTES(bp) + -+ bp->tx_bd_rd_prefetch + -+ RING_ADDR_INTERVAL); -+ dma_free_coherent(&bp->pdev->dev, size, tx_ring_base, -+ tx_ring_base_addr); -+ } -+ if (rx_ring_base) { -+ size = bp->num_queues * (RX_RING_BYTES(bp) + -+ bp->rx_bd_rd_prefetch + -+ RING_ADDR_INTERVAL); -+ dma_free_coherent(&bp->pdev->dev, size, rx_ring_base, -+ rx_ring_base_addr); - } - } - -@@ -2533,17 +2823,87 @@ static int macb_alloc_rx_buffers(struct macb *bp) - return 0; - } - -+static int macb_queue_phyaddr_check(struct macb *bp, dma_addr_t ring_base_addr, -+ int offset) -+{ -+ u32 bus_addr_high; -+ int i; -+ -+ bus_addr_high = upper_32_bits(ring_base_addr); -+ for (i = 1; i < bp->num_queues; i++) { -+ ring_base_addr += offset; -+ if (bus_addr_high != upper_32_bits(ring_base_addr)) -+ return -1; -+ } -+ -+ return 0; -+} -+ - static int macb_alloc_consistent(struct macb *bp) - { -+ struct macb_dma_desc *tx_ring_base, *rx_ring_base; -+ dma_addr_t tx_ring_base_addr, rx_ring_base_addr; - struct macb_queue *queue; -+ int tx_offset, rx_offset; -+ int tx_size, rx_size; - unsigned int q; -+ int ret, i; - int size; - -+ tx_offset = TX_RING_BYTES(bp) + bp->tx_bd_rd_prefetch + -+ RING_ADDR_INTERVAL; -+ tx_size = bp->num_queues * tx_offset; -+ for (i = 0; i < MAX_RING_ADDR_ALLOC_TIMES + 1; i++) { -+ if (i == MAX_RING_ADDR_ALLOC_TIMES) -+ return -ENOMEM; -+ -+ tx_ring_base = dma_alloc_coherent(&bp->pdev->dev, tx_size, -+ &tx_ring_base_addr, -+ GFP_KERNEL); -+ if (!tx_ring_base) -+ continue; -+ -+ ret = macb_queue_phyaddr_check(bp, tx_ring_base_addr, -+ tx_offset); -+ if (ret) { -+ dma_free_coherent(&bp->pdev->dev, tx_size, tx_ring_base, -+ tx_ring_base_addr); -+ continue; -+ } else { -+ break; -+ } -+ } -+ -+ rx_offset = RX_RING_BYTES(bp) + bp->rx_bd_rd_prefetch + -+ RING_ADDR_INTERVAL; -+ rx_size = bp->num_queues * rx_offset; -+ for (i = 0; i < MAX_RING_ADDR_ALLOC_TIMES + 1; i++) { -+ if (i == MAX_RING_ADDR_ALLOC_TIMES) { -+ dma_free_coherent(&bp->pdev->dev, tx_size, tx_ring_base, -+ tx_ring_base_addr); -+ return -ENOMEM; -+ } -+ -+ rx_ring_base = dma_alloc_coherent(&bp->pdev->dev, rx_size, -+ &rx_ring_base_addr, -+ GFP_KERNEL); -+ if (!rx_ring_base) -+ continue; -+ -+ ret = macb_queue_phyaddr_check(bp, rx_ring_base_addr, -+ rx_offset); -+ if (ret) { -+ dma_free_coherent(&bp->pdev->dev, rx_size, rx_ring_base, -+ rx_ring_base_addr); -+ continue; -+ } else { -+ break; -+ } -+ } -+ - for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) { -- size = TX_RING_BYTES(bp) + bp->tx_bd_rd_prefetch; -- queue->tx_ring = dma_alloc_coherent(&bp->pdev->dev, size, -- &queue->tx_ring_dma, -- GFP_KERNEL); -+ queue->tx_ring = (void *)tx_ring_base + q * tx_offset; -+ queue->tx_ring_dma = tx_ring_base_addr + q * tx_offset; - if (!queue->tx_ring) - goto out_err; - netdev_dbg(bp->dev, -@@ -2552,13 +2912,12 @@ static int macb_alloc_consistent(struct macb *bp) - queue->tx_ring); - - size = bp->tx_ring_size * sizeof(struct macb_tx_skb); -- queue->tx_skb = kmalloc(size, GFP_KERNEL); -+ queue->tx_skb = kzalloc(size, GFP_KERNEL); - if (!queue->tx_skb) - goto out_err; - -- size = RX_RING_BYTES(bp) + bp->rx_bd_rd_prefetch; -- queue->rx_ring = dma_alloc_coherent(&bp->pdev->dev, size, -- &queue->rx_ring_dma, GFP_KERNEL); -+ queue->rx_ring = (void *)rx_ring_base + q * rx_offset; -+ queue->rx_ring_dma = rx_ring_base_addr + q * rx_offset; - if (!queue->rx_ring) - goto out_err; - netdev_dbg(bp->dev, -@@ -2592,6 +2951,15 @@ static void gem_init_rings(struct macb *bp) - queue->tx_head = 0; - queue->tx_tail = 0; - -+ for (i = 0; i < bp->rx_ring_size; i++) { -+ desc = macb_rx_desc(queue, i); -+ desc->ctrl = 0; -+ /* make sure ctrl is cleared first, -+ * and bit RX_USED is set to avoid a race. -+ */ -+ dma_wmb(); -+ desc->addr |= MACB_BIT(RX_USED); -+ } - queue->rx_tail = 0; - queue->rx_prepared_head = 0; - -@@ -2768,6 +3136,46 @@ static void macb_configure_dma(struct macb *bp) - } - } - -+static int phytium_mac_config(struct macb *bp) -+{ -+ u32 old_ctrl, ctrl; -+ u32 old_ncr, ncr; -+ -+ netdev_dbg(bp->dev, "phytium mac config"); -+ -+ ncr = macb_readl(bp, NCR); -+ old_ncr = ncr; -+ ctrl = macb_or_gem_readl(bp, NCFGR); -+ old_ctrl = ctrl; -+ -+ ncr &= ~(GEM_BIT(ENABLE_HS_MAC) | MACB_BIT(2PT5G)); -+ ctrl &= ~(GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL) | -+ MACB_BIT(SPD) | MACB_BIT(FD)); -+ if (macb_is_gem(bp)) -+ ctrl &= ~GEM_BIT(GBE); -+ -+ if (bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { -+ ctrl |= GEM_BIT(PCSSEL) | GEM_BIT(SGMIIEN); -+ ncr |= MACB_BIT(2PT5G); -+ } else if (bp->phy_interface == PHY_INTERFACE_MODE_USXGMII || -+ bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) { -+ ctrl |= GEM_BIT(PCSSEL); -+ ncr |= GEM_BIT(ENABLE_HS_MAC); -+ } -+ -+ if (bp->duplex) -+ ctrl |= MACB_BIT(FD); -+ -+ /* Apply the new configuration, if any */ -+ if (old_ctrl ^ ctrl) -+ macb_or_gem_writel(bp, NCFGR, ctrl); -+ -+ if (old_ncr ^ ncr) -+ macb_or_gem_writel(bp, NCR, ncr); -+ -+ return 0; -+} -+ - static void macb_init_hw(struct macb *bp) - { - u32 config; -@@ -2796,11 +3204,24 @@ static void macb_init_hw(struct macb *bp) - if (bp->caps & MACB_CAPS_JUMBO) - bp->rx_frm_len_mask = MACB_RX_JFRMLEN_MASK; - -- macb_configure_dma(bp); -+ gem_writel(bp, AXI_PIPE, 0x1010); -+ -+ if (bp->phy_interface == PHY_INTERFACE_MODE_USXGMII || -+ bp->phy_interface == PHY_INTERFACE_MODE_5GBASER || -+ bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { -+ /* phytium need hwclock */ -+ if (bp->caps & MACB_CAPS_SEL_CLK) -+ bp->sel_clk_hw(bp, bp->speed); -+ phytium_mac_config(bp); -+ if (bp->link) -+ macb_usx_pcs_link_up(&bp->phylink_usx_pcs, 0, -+ bp->phy_interface, bp->speed, bp->duplex); -+ } else { -+ bp->speed = SPEED_10; -+ bp->duplex = DUPLEX_HALF; -+ } - -- /* Enable RX partial store and forward and set watermark */ -- if (bp->rx_watermark) -- gem_writel(bp, PBUFRXCUT, (bp->rx_watermark | GEM_BIT(ENCUTTHRU))); -+ macb_configure_dma(bp); - } - - /* The hash address register is 64 bits long and takes up two -@@ -2924,7 +3345,10 @@ static void macb_set_rx_mode(struct net_device *dev) - - static int macb_open(struct net_device *dev) - { -- size_t bufsz = dev->mtu + ETH_HLEN + ETH_FCS_LEN + NET_IP_ALIGN; -+ /* adjust bufsz to be at least the size of a standard frame, -+ * to fix rx error when set small size mtu. -+ */ -+ size_t bufsz = (dev->mtu < ETH_DATA_LEN ? ETH_DATA_LEN : dev->mtu) + ETH_HLEN + ETH_FCS_LEN + NET_IP_ALIGN; - struct macb *bp = netdev_priv(dev); - struct macb_queue *queue; - unsigned int q; -@@ -2951,6 +3375,7 @@ static int macb_open(struct net_device *dev) - napi_enable(&queue->napi_tx); - } - -+ macb_writel(bp, NCR, macb_readl(bp, NCR) | MACB_BIT(MPE)); - macb_init_hw(bp); - - err = phy_power_on(bp->sgmii_phy); -@@ -3884,6 +4309,8 @@ static const struct net_device_ops macb_netdev_ops = { - #endif - .ndo_set_features = macb_set_features, - .ndo_features_check = macb_features_check, -+ .ndo_vlan_rx_add_vid = ncsi_vlan_rx_add_vid, -+ .ndo_vlan_rx_kill_vid = ncsi_vlan_rx_kill_vid, - }; - - /* Configure peripheral capabilities according to device tree -@@ -4048,6 +4475,97 @@ err_disable_pclk: - return err; - } - -+static int phytium_clk_init(struct platform_device *pdev, struct clk **pclk, -+ struct clk **hclk, struct clk **tx_clk, -+ struct clk **rx_clk, struct clk **tsu_clk) -+{ -+ struct macb_platform_data *pdata; -+ struct device_node *np = pdev->dev.of_node; -+ int err; -+ -+ pdata = dev_get_platdata(&pdev->dev); -+ if (pdata) { -+ *pclk = pdata->pclk; -+ *hclk = pdata->hclk; -+ } else { -+ if (has_acpi_companion(&pdev->dev)) { -+ *pclk = NULL; -+ *hclk = NULL; -+ } else if (np) { -+ *pclk = devm_clk_get(&pdev->dev, "pclk"); -+ *hclk = devm_clk_get(&pdev->dev, "hclk"); -+ } -+ } -+ -+ if (IS_ERR(*pclk)) -+ return dev_err_probe(&pdev->dev, -+ IS_ERR(*pclk) ? PTR_ERR(*pclk) : -ENODEV, -+ "failed to get pclk\n"); -+ -+ if (IS_ERR(*hclk)) -+ return dev_err_probe(&pdev->dev, -+ IS_ERR(*hclk) ? PTR_ERR(*hclk) : -ENODEV, -+ "failed to get hclk\n"); -+ -+ *tx_clk = devm_clk_get_optional(&pdev->dev, "tx_clk"); -+ if (IS_ERR(*tx_clk)) -+ return PTR_ERR(*tx_clk); -+ -+ *rx_clk = devm_clk_get_optional(&pdev->dev, "rx_clk"); -+ if (IS_ERR(*rx_clk)) -+ return PTR_ERR(*rx_clk); -+ -+ *tsu_clk = devm_clk_get_optional(&pdev->dev, "tsu_clk"); -+ if (IS_ERR(*tsu_clk)) -+ return PTR_ERR(*tsu_clk); -+ -+ err = clk_prepare_enable(*pclk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable pclk (%d)\n", err); -+ return err; -+ } -+ -+ err = clk_prepare_enable(*hclk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable hclk (%d)\n", err); -+ goto err_disable_pclk; -+ } -+ -+ err = clk_prepare_enable(*tx_clk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable tx_clk (%d)\n", err); -+ goto err_disable_hclk; -+ } -+ -+ err = clk_prepare_enable(*rx_clk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable rx_clk (%d)\n", err); -+ goto err_disable_txclk; -+ } -+ -+ err = clk_prepare_enable(*tsu_clk); -+ if (err) { -+ dev_err(&pdev->dev, "failed to enable tsu_clk (%d)\n", err); -+ goto err_disable_rxclk; -+ } -+ -+ return 0; -+ -+err_disable_rxclk: -+ clk_disable_unprepare(*rx_clk); -+ -+err_disable_txclk: -+ clk_disable_unprepare(*tx_clk); -+ -+err_disable_hclk: -+ clk_disable_unprepare(*hclk); -+ -+err_disable_pclk: -+ clk_disable_unprepare(*pclk); -+ -+ return err; -+} -+ - static int macb_init(struct platform_device *pdev) - { - struct net_device *dev = platform_get_drvdata(pdev); -@@ -4126,12 +4644,14 @@ static int macb_init(struct platform_device *pdev) - - /* setup appropriated routines according to adapter type */ - if (macb_is_gem(bp)) { -+ bp->max_tx_length = GEM_MAX_TX_LEN; - bp->macbgem_ops.mog_alloc_rx_buffers = gem_alloc_rx_buffers; - bp->macbgem_ops.mog_free_rx_buffers = gem_free_rx_buffers; - bp->macbgem_ops.mog_init_rings = gem_init_rings; - bp->macbgem_ops.mog_rx = gem_rx; - dev->ethtool_ops = &gem_ethtool_ops; - } else { -+ bp->max_tx_length = MACB_MAX_TX_LEN; - bp->macbgem_ops.mog_alloc_rx_buffers = macb_alloc_rx_buffers; - bp->macbgem_ops.mog_free_rx_buffers = macb_free_rx_buffers; - bp->macbgem_ops.mog_init_rings = macb_init_rings; -@@ -4901,6 +5421,34 @@ static const struct macb_config versal_config = { - .usrio = &macb_default_usrio, - }; - -+static const struct macb_config phytium_gem1p0_config = { -+ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | -+ MACB_CAPS_JUMBO | -+ MACB_CAPS_GEM_HAS_PTP | -+ MACB_CAPS_BD_RD_PREFETCH | -+ MACB_CAPS_SEL_CLK, -+ .dma_burst_length = 16, -+ .clk_init = phytium_clk_init, -+ .init = macb_init, -+ .jumbo_max_len = 16360, -+ .sel_clk_hw = phytium_gem1p0_sel_clk, -+ .usrio = &macb_default_usrio, -+}; -+ -+static const struct macb_config phytium_gem2p0_config = { -+ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | -+ MACB_CAPS_JUMBO | -+ MACB_CAPS_GEM_HAS_PTP | -+ MACB_CAPS_BD_RD_PREFETCH | -+ MACB_CAPS_SEL_CLK, -+ .dma_burst_length = 16, -+ .clk_init = phytium_clk_init, -+ .init = macb_init, -+ .jumbo_max_len = 10240, -+ .sel_clk_hw = phytium_gem2p0_sel_clk, -+ .usrio = &macb_default_usrio, -+}; -+ - static const struct of_device_id macb_dt_ids[] = { - { .compatible = "cdns,at91sam9260-macb", .data = &at91sam9260_config }, - { .compatible = "cdns,macb" }, -@@ -4924,11 +5472,25 @@ static const struct of_device_id macb_dt_ids[] = { - { .compatible = "xlnx,zynqmp-gem", .data = &zynqmp_config}, - { .compatible = "xlnx,zynq-gem", .data = &zynq_config }, - { .compatible = "xlnx,versal-gem", .data = &versal_config}, -+ { .compatible = "cdns,phytium-gem", .data = &phytium_gem1p0_config }, /* old version */ -+ { .compatible = "cdns,phytium-gem-1.0", .data = &phytium_gem1p0_config }, -+ { .compatible = "cdns,phytium-gem-2.0", .data = &phytium_gem2p0_config }, - { /* sentinel */ } - }; - MODULE_DEVICE_TABLE(of, macb_dt_ids); - #endif /* CONFIG_OF */ - -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id macb_acpi_ids[] = { -+ { .id = "PHYT0036", .driver_data = (kernel_ulong_t)&phytium_gem1p0_config }, -+ { } -+}; -+ -+MODULE_DEVICE_TABLE(acpi, macb_acpi_ids); -+#else -+#define macb_acpi_ids NULL -+#endif -+ - static const struct macb_config default_gem_config = { - .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | - MACB_CAPS_JUMBO | -@@ -4940,6 +5502,32 @@ static const struct macb_config default_gem_config = { - .jumbo_max_len = 10240, - }; - -+static void gem_ncsi_handler(struct ncsi_dev *nd) -+{ -+ if (unlikely(nd->state != ncsi_dev_state_functional)) -+ return; -+ -+ netdev_dbg(nd->dev, "NCSI interface %s\n", -+ nd->link_up ? "up" : "down"); -+} -+ -+static int macb_get_phy_mode(struct platform_device *pdev) -+{ -+ const char *pm; -+ int err, i; -+ -+ err = device_property_read_string(&pdev->dev, "phy-mode", &pm); -+ if (err < 0) -+ return err; -+ -+ for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) { -+ if (!strcasecmp(pm, phy_modes(i))) -+ return i; -+ } -+ -+ return -ENODEV; -+} -+ - static int macb_probe(struct platform_device *pdev) - { - const struct macb_config *macb_config = &default_gem_config; -@@ -4952,7 +5540,6 @@ static int macb_probe(struct platform_device *pdev) - struct clk *tsu_clk = NULL; - unsigned int queue_mask, num_queues; - bool native_io; -- phy_interface_t interface; - struct net_device *dev; - struct resource *regs; - u32 wtrmrk_rst_val; -@@ -4973,6 +5560,15 @@ static int macb_probe(struct platform_device *pdev) - clk_init = macb_config->clk_init; - init = macb_config->init; - } -+ } else if (has_acpi_companion(&pdev->dev)) { -+ const struct acpi_device_id *match; -+ -+ match = acpi_match_device(macb_acpi_ids, &pdev->dev); -+ if (match && match->driver_data) { -+ macb_config = (void *)match->driver_data; -+ clk_init = macb_config->clk_init; -+ init = macb_config->init; -+ } - } - - err = clk_init(pdev, &pclk, &hclk, &tx_clk, &rx_clk, &tsu_clk); -@@ -5021,6 +5617,9 @@ static int macb_probe(struct platform_device *pdev) - if (macb_config) - bp->jumbo_max_len = macb_config->jumbo_max_len; - -+ if (macb_config) -+ bp->sel_clk_hw = macb_config->sel_clk_hw; -+ - if (!hw_is_gem(bp->regs, bp->native_io)) - bp->max_tx_length = MACB_MAX_TX_LEN; - else if (macb_config->max_tx_length) -@@ -5029,7 +5628,7 @@ static int macb_probe(struct platform_device *pdev) - bp->max_tx_length = GEM_MAX_TX_LEN; - - bp->wol = 0; -- if (of_property_read_bool(np, "magic-packet")) -+ if (device_property_read_bool(&pdev->dev, "magic-packet")) - bp->wol |= MACB_WOL_HAS_MAGIC_PACKET; - device_set_wakeup_capable(&pdev->dev, bp->wol & MACB_WOL_HAS_MAGIC_PACKET); - -@@ -5102,12 +5701,12 @@ static int macb_probe(struct platform_device *pdev) - else if (err) - macb_get_hwaddr(bp); - -- err = of_get_phy_mode(np, &interface); -- if (err) -- /* not found in DT, MII by default */ -+ err = macb_get_phy_mode(pdev); -+ if (err < 0) - bp->phy_interface = PHY_INTERFACE_MODE_MII; - else -- bp->phy_interface = interface; -+ bp->phy_interface = err; -+ - - /* IP specific init */ - err = init(pdev); -@@ -5118,6 +5717,20 @@ static int macb_probe(struct platform_device *pdev) - if (err) - goto err_out_phy_exit; - -+ if (device_property_read_bool(&pdev->dev, "use-ncsi")) { -+ if (!IS_ENABLED(CONFIG_NET_NCSI)) { -+ dev_err(&pdev->dev, "NCSI stack not enabled\n"); -+ goto err_out_free_netdev; -+ } -+ dev_notice(&pdev->dev, "Using NCSI interface\n"); -+ bp->use_ncsi = 1; -+ bp->ndev = ncsi_register_dev(dev, gem_ncsi_handler); -+ if (!bp->ndev) -+ goto err_out_free_netdev; -+ } else { -+ bp->use_ncsi = 0; -+ } -+ - netif_carrier_off(dev); - - err = register_netdev(dev); -@@ -5349,6 +5962,8 @@ static int __maybe_unused macb_resume(struct device *dev) - macb_set_rx_mode(netdev); - macb_restore_features(bp); - rtnl_lock(); -+ if (!device_may_wakeup(&bp->dev->dev)) -+ phy_init(bp->sgmii_phy); - - phylink_start(bp->phylink); - rtnl_unlock(); -@@ -5402,6 +6017,7 @@ static struct platform_driver macb_driver = { - .driver = { - .name = "macb", - .of_match_table = of_match_ptr(macb_dt_ids), -+ .acpi_match_table = macb_acpi_ids, - .pm = &macb_pm_ops, - }, - }; -diff --git a/drivers/net/ethernet/phytium/Kconfig b/drivers/net/ethernet/phytium/Kconfig -new file mode 100644 -index 000000000..14a77adbf ---- /dev/null -+++ b/drivers/net/ethernet/phytium/Kconfig -@@ -0,0 +1,58 @@ -+# SPDX-License-Identifier: GPL-2.0-only -+# -+# Phytium device configuration -+# -+ -+config NET_VENDOR_PHYTIUM -+ bool "Phytium devices" -+ depends on HAS_IOMEM -+ default y -+ help -+ If you have a network (Ethernet) card belonging to this class, say Y. -+ -+ Note that the answer to this question doesn't directly affect the -+ kernel: saying N will just cause the configurator to skip all the -+ remaining Cadence network card questions. If you say Y, you will be -+ asked for your specific card in the following questions. -+ -+if NET_VENDOR_PHYTIUM -+ -+config PHYTMAC -+ tristate "Phytium GMAC support" -+ depends on HAS_DMA -+ select PHYLINK -+ select CRC32 -+ help -+ If you have a network (Ethernet) controller of this type, say Y -+ or M here. -+ -+ To compile this driver as a module, choose M here: the module -+ will be phytmac. -+ -+config PHYTMAC_ENABLE_PTP -+ bool "Enable IEEE 1588 hwstamp" -+ depends on PHYTMAC -+ depends on PTP_1588_CLOCK -+ default y -+ help -+ Enable IEEE 1588 PTP support for PHYTMAC. -+ -+config PHYTMAC_PLATFORM -+ tristate "Phytmac Platform support" -+ depends on PHYTMAC -+ help -+ This is Platform driver. -+ -+ To compile this driver as a module, choose M here: the module -+ will be called phytmac_platform. -+ -+config PHYTMAC_PCI -+ tristate "Phytmac PCI support" -+ depends on PHYTMAC && PCI -+ help -+ This is PCI driver. -+ -+ To compile this driver as a module, choose M here: the module -+ will be called phytmac_pci. -+ -+endif # NET_VENDOR_PHYTIUM -diff --git a/drivers/net/ethernet/phytium/Makefile b/drivers/net/ethernet/phytium/Makefile -new file mode 100644 -index 000000000..6e710d4d5 ---- /dev/null -+++ b/drivers/net/ethernet/phytium/Makefile -@@ -0,0 +1,17 @@ -+ -+# SPDX-License-Identifier: GPL-2.0 -+# -+# Makefile for the Phytium network device drivers. -+# -+# -+ -+obj-$(CONFIG_PHYTMAC) += phytmac.o -+ -+phytmac-objs := phytmac_main.o phytmac_ethtool.o phytmac_v1.o phytmac_v2.o -+phytmac-$(CONFIG_PHYTMAC_ENABLE_PTP) += phytmac_ptp.o -+ -+obj-$(CONFIG_PHYTMAC_PLATFORM) += phytmac-platform.o -+phytmac-platform-objs := phytmac_platform.o -+ -+obj-$(CONFIG_PHYTMAC_PCI) += phytmac-pci.o -+phytmac-pci-objs := phytmac_pci.o -diff --git a/drivers/net/ethernet/phytium/phytmac.h b/drivers/net/ethernet/phytium/phytmac.h -new file mode 100644 -index 000000000..b90e15514 ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac.h -@@ -0,0 +1,591 @@ -+/* SPDX-License-Identifier: GPL-2.0-only */ -+#ifndef _PHYTMAC_H -+#define _PHYTMAC_H -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define PHYTMAC_DRV_NAME "phytium-mac" -+#define PHYTMAC_DRV_DESC "PHYTIUM Ethernet Driver" -+ -+#define PHYTMAC_DEFAULT_MSG_ENABLE \ -+ (NETIF_MSG_DRV | \ -+ NETIF_MSG_PROBE | \ -+ NETIF_MSG_LINK | \ -+ NETIF_MSG_INTR | \ -+ NETIF_MSG_HW |\ -+ NETIF_MSG_PKTDATA) -+ -+#define IRQ_TYPE_INT 0 -+#define IRQ_TYPE_MSI 1 -+#define IRQ_TYPE_INTX 2 -+ -+#define PHYTMAC_MAX_QUEUES 8 -+#define DEFAULT_DMA_BURST_LENGTH 16 -+#define DEFAULT_JUMBO_MAX_LENGTH 10240 -+#define PHYTMAC_MAX_TX_LEN 16320 -+#define PHYTMAC_MIN_TX_LEN 64 -+#define DEFAULT_TX_RING_SIZE 512 -+#define DEFAULT_RX_RING_SIZE 512 -+#define MAX_TX_RING_SIZE 1024 -+#define MAX_RX_RING_SIZE 4096 -+#define MIN_TX_RING_SIZE 64 -+#define MIN_RX_RING_SIZE 64 -+#define DEFAULT_TX_DESC_MIN_FREE 64 -+#define DEFAULT_RX_DESC_MIN_FREE 64 -+ -+#define MEMORY_SIZE 4096 -+#define MHU_SIZE 0x20 -+ -+#define PHYTMAC_POWEROFF 1 -+#define PHYTMAC_POWERON 2 -+ -+#define PHYTMAC_WOL_MAGIC_PACKET 1 -+ -+#define DEFAULT_MSG_RING_SIZE 16 -+ -+#define PHYTMAC_CAPS_JUMBO 0x00000001 -+#define PHYTMAC_CAPS_PTP 0x00000002 -+#define PHYTMAC_CAPS_BD_RD_PREFETCH 0x00000004 -+#define PHYTMAC_CAPS_PCS 0x00000008 -+#define PHYTMAC_CAPS_LSO 0x00000010 -+#define PHYTMAC_CAPS_SG_DISABLED 0x00000020 -+#define PHYTMAC_CAPS_TAILPTR 0x00000040 -+#define PHYTMAC_CAPS_START 0x00000080 -+#define PHYTMAC_CAPS_NO_WOL 0x0000100 -+#define PHYTMAC_CAPS_LPI 0x0000400 -+#define PHYTMAC_CAPS_MSG 0x0000800 -+ -+#define PHYTMAC_TX 0x1 -+#define PHYTMAC_RX 0x2 -+ -+#define PHYTMAC_GREGS_LEN 16 -+ -+#define PHYTMAC_MTU_MIN_SIZE ETH_MIN_MTU -+ -+#define EQUAL(a, b) ((a) == (b)) -+ -+#define TXD_USE_COUNT(_pdata, s) DIV_ROUND_UP((s), (_pdata)->max_tx_length) -+ -+/* Bit manipulation macros */ -+#define PHYTMAC_BIT(_field) \ -+ (1 << PHYTMAC_##_field##_INDEX) -+ -+#define PHYTMAC_BITS(_field, value) \ -+ (((value) & ((1 << PHYTMAC_##_field##_WIDTH) - 1)) \ -+ << PHYTMAC_##_field##_INDEX) -+ -+#define PHYTMAC_GET_BITS(_var, _field) \ -+ (((_var) >> (PHYTMAC_##_field##_INDEX)) \ -+ & ((0x1 << (PHYTMAC_##_field##_WIDTH)) - 1)) -+ -+#define PHYTMAC_SET_BITS(_var, _field, _val) \ -+ (((_var) & ~(((1 << PHYTMAC_##_field##_WIDTH) - 1) \ -+ << PHYTMAC_##_field##_INDEX)) \ -+ | (((_val) & ((1 << PHYTMAC_##_field##_WIDTH) - 1)) \ -+ << PHYTMAC_##_field##_INDEX)) -+ -+#define PHYTMAC_READ(_pdata, _reg) \ -+ __raw_readl((_pdata)->mac_regs + (_reg)) -+ -+#define PHYTMAC_READ_BITS(_pdata, _reg, _field) \ -+ PHYTMAC_GET_BITS(PHYTMAC_READ((_pdata), _reg), _field) -+ -+#define PHYTMAC_WRITE(_pdata, _reg, _val) \ -+ __raw_writel((_val), (_pdata)->mac_regs + (_reg)) -+ -+#define PHYTMAC_MSG_READ(_pdata, _reg) \ -+ __raw_readl((_pdata)->mac_regs + (_reg)) -+ -+#define PHYTMAC_WRITE(_pdata, _reg, _val) \ -+ __raw_writel((_val), (_pdata)->mac_regs + (_reg)) -+ -+#define LSO_UFO 1 -+#define LSO_TSO 2 -+ -+#define PHYTMAC_INT_TX_COMPLETE 0x1 -+#define PHYTMAC_INT_TX_ERR 0x2 -+#define PHYTMAC_INT_RX_COMPLETE 0x4 -+#define PHYTMAC_INT_RX_OVERRUN 0x8 -+#define PHYTMAC_INT_RX_DESC_FULL 0x10 -+#define PHYTMAC_RX_INT_FLAGS (PHYTMAC_INT_RX_COMPLETE) -+#define PHYTMAC_TX_INT_FLAGS (PHYTMAC_INT_TX_COMPLETE \ -+ | PHYTMAC_INT_TX_ERR) -+ -+#define PHYTMAC_WAKE_MAGIC 0x00000001 -+#define PHYTMAC_WAKE_ARP 0x00000002 -+#define PHYTMAC_WAKE_UCAST 0x00000004 -+#define PHYTMAC_WAKE_MCAST 0x00000008 -+ -+struct packet_info { -+ int lso; -+ int desc_cnt; -+ int hdrlen; -+ int nocrc; -+ u32 mss; -+ u32 seq; -+}; -+ -+#define DEV_TYPE_PLATFORM 0 -+#define DEV_TYPE_PCI 1 -+ -+struct phytmac_statistics { -+ char stat_string[ETH_GSTRING_LEN]; -+}; -+ -+#define STAT_TITLE(title) { \ -+ .stat_string = title, \ -+} -+ -+static const struct phytmac_statistics phytmac_statistics[] = { -+ STAT_TITLE("tx_octets"), -+ STAT_TITLE("tx_packets"), -+ STAT_TITLE("tx_bcast_packets"), -+ STAT_TITLE("tx_mcase_packets"), -+ STAT_TITLE("tx_pause_packets"), -+ STAT_TITLE("tx_64_byte_packets"), -+ STAT_TITLE("tx_65_127_byte_packets"), -+ STAT_TITLE("tx_128_255_byte_packets"), -+ STAT_TITLE("tx_256_511_byte_packets"), -+ STAT_TITLE("tx_512_1023_byte_packets"), -+ STAT_TITLE("tx_1024_1518_byte_packets"), -+ STAT_TITLE("tx_more_than_1518_byte_packets"), -+ STAT_TITLE("tx_underrun"), -+ STAT_TITLE("tx_single_collisions"), -+ STAT_TITLE("tx_multiple_collisions"), -+ STAT_TITLE("tx_excessive_collisions"), -+ STAT_TITLE("tx_late_collisions"), -+ STAT_TITLE("tx_deferred"), -+ STAT_TITLE("tx_carrier_sense_errors"), -+ STAT_TITLE("rx_octets"), -+ STAT_TITLE("rx_packets"), -+ STAT_TITLE("rx_bcast_packets"), -+ STAT_TITLE("rx_mcast_packets"), -+ STAT_TITLE("rx_pause_packets"), -+ STAT_TITLE("rx_64_byte_packets"), -+ STAT_TITLE("rx_65_127_byte_packets"), -+ STAT_TITLE("rx_128_255_byte_packets"), -+ STAT_TITLE("rx_256_511_byte_packets"), -+ STAT_TITLE("rx_512_1023_byte_packets"), -+ STAT_TITLE("rx_1024_1518_byte_packets"), -+ STAT_TITLE("rx_more_than_1518_byte_packets"), -+ STAT_TITLE("rx_undersized_packets"), -+ STAT_TITLE("rx_oversize_packets"), -+ STAT_TITLE("rx_jabbers"), -+ STAT_TITLE("rx_fcs_errors"), -+ STAT_TITLE("rx_length_errors"), -+ STAT_TITLE("rx_symbol_errors"), -+ STAT_TITLE("rx_alignment_errors"), -+ STAT_TITLE("rx_resource_over"), -+ STAT_TITLE("rx_overruns"), -+ STAT_TITLE("rx_iphdr_csum_errors"), -+ STAT_TITLE("rx_tcp_csum_errors"), -+ STAT_TITLE("rx_udp_csum_errors"), -+}; -+ -+#define PHYTMAC_STATS_LEN ARRAY_SIZE(phytmac_statistics) -+ -+/* per queue statistics, each should be unsigned long type */ -+struct phytmac_queue_stats { -+ unsigned long rx_packets; -+ unsigned long rx_bytes; -+ unsigned long rx_dropped; -+ unsigned long tx_packets; -+ unsigned long tx_bytes; -+ unsigned long tx_dropped; -+}; -+ -+static const struct phytmac_statistics queue_statistics[] = { -+ STAT_TITLE("rx_packets"), -+ STAT_TITLE("rx_bytes"), -+ STAT_TITLE("rx_dropped"), -+ STAT_TITLE("tx_packets"), -+ STAT_TITLE("tx_bytes"), -+ STAT_TITLE("tx_dropped"), -+}; -+ -+#define QUEUE_STATS_LEN ARRAY_SIZE(queue_statistics) -+ -+struct phytmac_config { -+ struct phytmac_hw_if *hw_if; -+ u32 caps; -+ u32 tsu_rate; -+ u16 queue_num; -+}; -+ -+struct phytmac_stats { -+ u64 tx_octets; -+ u64 tx_packets; -+ u64 tx_bcast_packets; -+ u64 tx_mcase_packets; -+ u64 tx_pause_packets; -+ u64 tx_64_byte_packets; -+ u64 tx_65_127_byte_packets; -+ u64 tx_128_255_byte_packets; -+ u64 tx_256_511_byte_packets; -+ u64 tx_512_1023_byte_packets; -+ u64 tx_1024_1518_byte_packets; -+ u64 tx_more_than_1518_byte_packets; -+ u64 tx_underrun; -+ u64 tx_single_collisions; -+ u64 tx_multiple_collisions; -+ u64 tx_excessive_collisions; -+ u64 tx_late_collisions; -+ u64 tx_deferred; -+ u64 tx_carrier_sense_errors; -+ u64 rx_octets; -+ u64 rx_packets; -+ u64 rx_bcast_packets; -+ u64 rx_mcast_packets; -+ u64 rx_pause_packets; -+ u64 rx_64_byte_packets; -+ u64 rx_65_127_byte_packets; -+ u64 rx_128_255_byte_packets; -+ u64 rx_256_511_byte_packets; -+ u64 rx_512_1023_byte_packets; -+ u64 rx_1024_1518_byte_packets; -+ u64 rx_more_than_1518_byte_packets; -+ u64 rx_undersized_packets; -+ u64 rx_oversize_packets; -+ u64 rx_jabbers; -+ u64 rx_fcs_errors; -+ u64 rx_length_errors; -+ u64 rx_symbol_errors; -+ u64 rx_alignment_errors; -+ u64 rx_resource_over; -+ u64 rx_overruns; -+ u64 rx_iphdr_csum_errors; -+ u64 rx_tcp_csum_errors; -+ u64 rx_udp_csum_errors; -+}; -+ -+struct ts_incr { -+ u32 sub_ns; -+ u32 ns; -+}; -+ -+enum phytmac_bd_control { -+ TS_DISABLED, -+ TS_FRAME_PTP_EVENT_ONLY, -+ TS_ALL_PTP_FRAMES, -+ TS_ALL_FRAMES, -+}; -+ -+#ifdef CONFIG_PHYTMAC_ENABLE_PTP -+struct phytmac_dma_desc { -+ u32 desc0; -+ u32 desc1; -+ u32 desc2; -+ u32 desc3; -+ u32 desc4; -+ u32 desc5; -+}; -+#else -+struct phytmac_dma_desc { -+ u32 desc0; -+ u32 desc1; -+ u32 desc2; -+ u32 desc3; -+}; -+#endif -+ -+struct phytmac_tx_skb { -+ struct sk_buff *skb; -+ dma_addr_t addr; -+ size_t length; -+ bool mapped_as_page; -+}; -+ -+struct phytmac_tx_ts { -+ struct sk_buff *skb; -+ u32 ts_1; -+ u32 ts_2; -+}; -+ -+struct phytmac_queue { -+ struct phytmac *pdata; -+ int irq; -+ int index; -+ -+ /* tx queue info */ -+ unsigned int tx_head; -+ unsigned int tx_tail; -+ unsigned int tx_xmit_more; -+ dma_addr_t tx_ring_addr; -+ struct work_struct tx_error_task; -+ struct napi_struct tx_napi; -+ struct phytmac_dma_desc *tx_ring; -+ struct phytmac_tx_skb *tx_skb; -+ /* Lock to protect tx */ -+ spinlock_t tx_lock; -+ -+ /* rx queue info */ -+ dma_addr_t rx_ring_addr; -+ unsigned int rx_head; -+ unsigned int rx_tail; -+ struct phytmac_dma_desc *rx_ring; -+ struct sk_buff **rx_skb; -+ struct napi_struct rx_napi; -+ struct phytmac_queue_stats stats; -+ -+#ifdef CONFIG_PHYTMAC_ENABLE_PTP -+ struct work_struct tx_ts_task; -+ unsigned int tx_ts_head; -+ unsigned int tx_ts_tail; -+ struct phytmac_tx_ts tx_timestamps[128]; -+#endif -+}; -+ -+struct ethtool_rx_fs_item { -+ struct ethtool_rx_flow_spec fs; -+ struct list_head list; -+}; -+ -+struct ethtool_rx_fs_list { -+ struct list_head list; -+ unsigned int count; -+}; -+ -+struct phytmac_msg { -+ struct completion tx_msg_comp; -+ u32 tx_msg_ring_size; -+ u32 rx_msg_ring_size; -+ u32 tx_msg_head; -+ u32 tx_msg_tail; -+ u32 rx_msg_head; -+ u32 rx_msg_tail; -+ /* Lock to protect msg */ -+ spinlock_t msg_lock; -+}; -+ -+struct ts_ctrl { -+ int tx_control; -+ int rx_control; -+ int one_step; -+}; -+ -+struct phytmac { -+ void __iomem *mac_regs; -+ void __iomem *msg_regs; -+ void __iomem *mhu_regs; -+ struct pci_dev *pcidev; -+ struct platform_device *platdev; -+ struct net_device *ndev; -+ struct device *dev; -+ struct ncsi_dev *ncsidev; -+ struct fwnode_handle *fwnode; -+ struct phytmac_hw_if *hw_if; -+ struct phytmac_msg msg_ring; -+ int dev_type; -+ int sfp_irq; -+ int irq_type; -+ int queue_irq[PHYTMAC_MAX_QUEUES]; -+ u32 rx_irq_mask; -+ u32 tx_irq_mask; -+ u32 msg_enable; -+ u32 capacities; -+ u32 max_tx_length; -+ u32 min_tx_length; -+ u32 jumbo_len; -+ u32 wol; -+ u32 lpi; -+ u32 power_state; -+ struct work_struct restart_task; -+ /* Lock to protect mac config */ -+ spinlock_t lock; -+ /* Lock to protect msg tx */ -+ spinlock_t msg_lock; -+ u32 rx_ring_size; -+ u32 tx_ring_size; -+ u32 dma_data_width; -+ u32 dma_addr_width; -+ u32 dma_burst_length; -+ int rx_bd_prefetch; -+ int tx_bd_prefetch; -+ int rx_buffer_len; -+ u16 queues_max_num; -+ u16 queues_num; -+ struct phytmac_queue queues[PHYTMAC_MAX_QUEUES]; -+ struct phytmac_stats stats; -+ u64 ethtool_stats[PHYTMAC_STATS_LEN + -+ QUEUE_STATS_LEN * PHYTMAC_MAX_QUEUES]; -+ int use_ncsi; -+ int use_mii; -+ struct mii_bus *mii_bus; -+ struct phylink *phylink; -+ struct phylink_config phylink_config; -+ struct phylink_pcs phylink_pcs; -+ int pause; -+ phy_interface_t phy_interface; -+ int speed; -+ int duplex; -+ int autoneg; -+ /* 1588 */ -+ spinlock_t ts_clk_lock; /* clock locking */ -+ unsigned int ts_rate; -+ struct ptp_clock *ptp_clock; -+ struct ptp_clock_info ptp_clock_info; -+ struct ts_incr ts_incr; -+ struct hwtstamp_config ts_config; -+ struct ts_ctrl ts_ctrl; -+ /* RX queue filer rule set */ -+ struct ethtool_rx_fs_list rx_fs_list; -+ /* Lock to protect fs */ -+ spinlock_t rx_fs_lock; -+ unsigned int max_rx_fs; -+}; -+ -+struct phytmac_hw_if { -+ int (*init_msg_ring)(struct phytmac *pdata); -+ int (*init_hw)(struct phytmac *pdata); -+ void (*reset_hw)(struct phytmac *pdata); -+ int (*init_ring_hw)(struct phytmac *pdata); -+ int (*poweron)(struct phytmac *pdata, int on); -+ int (*set_wol)(struct phytmac *pdata, int wake); -+ int (*get_feature)(struct phytmac *pdata); -+ int (*set_mac_address)(struct phytmac *pdata, const u8 *addr); -+ int (*get_mac_address)(struct phytmac *pdata, u8 *addr); -+ int (*enable_promise)(struct phytmac *pdata, int enable); -+ int (*enable_multicast)(struct phytmac *pdata, int enable); -+ int (*set_hash_table)(struct phytmac *pdata, unsigned long *mc_filter); -+ int (*enable_rx_csum)(struct phytmac *pdata, int enable); -+ int (*enable_tx_csum)(struct phytmac *pdata, int enable); -+ int (*enable_pause)(struct phytmac *pdata, int enable); -+ int (*enable_autoneg)(struct phytmac *pdata, int enable); -+ int (*enable_network)(struct phytmac *pdata, int enable, int rx_tx); -+ void (*get_stats)(struct phytmac *pdata); -+ void (*get_regs)(struct phytmac *pdata, u32 *reg_buff); -+ int (*set_speed)(struct phytmac *pdata); -+ -+ void (*mac_config)(struct phytmac *pdata, u32 mode, -+ const struct phylink_link_state *state); -+ int (*mac_linkup)(struct phytmac *pdata, phy_interface_t interface, -+ int speed, int duplex); -+ int (*mac_linkdown)(struct phytmac *pdata); -+ int (*pcs_linkup)(struct phytmac *pdata, phy_interface_t interface, -+ int speed, int duplex); -+ int (*pcs_linkdown)(struct phytmac *pdata); -+ unsigned int (*get_link)(struct phytmac *pdata, phy_interface_t interface); -+ -+ /* For RX coalescing */ -+ int (*config_rx_coalesce)(struct phytmac *pdata); -+ int (*config_tx_coalesce)(struct phytmac *pdata); -+ -+ /* ethtool nfc */ -+ int (*add_fdir_entry)(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow); -+ int (*del_fdir_entry)(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow); -+ -+ /* mido ops */ -+ int (*enable_mdio_control)(struct phytmac *pdata, int enable); -+ int (*mdio_read)(struct phytmac *pdata, int mii_id, int regnum); -+ int (*mdio_write)(struct phytmac *pdata, int mii_id, -+ int regnum, u16 data); -+ int (*mdio_read_c45)(struct phytmac *pdata, int mii_id, int devad, int regnum); -+ int (*mdio_write_c45)(struct phytmac *pdata, int mii_id, int devad, -+ int regnum, u16 data); -+ void (*enable_irq)(struct phytmac *pdata, int queue_index, u32 mask); -+ void (*disable_irq)(struct phytmac *pdata, int queue_index, u32 mask); -+ void (*clear_irq)(struct phytmac *pdata, int queue_index, u32 mask); -+ void (*mask_irq)(struct phytmac *pdata, int queue_index, u32 mask); -+ unsigned int (*get_irq)(struct phytmac *pdata, int queue_index); -+ unsigned int (*get_intx_mask)(struct phytmac *pdata); -+ unsigned int (*tx_map)(struct phytmac_queue *pdata, u32 tx_tail, -+ struct packet_info *packet); -+ void (*init_rx_map)(struct phytmac_queue *queue, u32 index); -+ unsigned int (*rx_map)(struct phytmac_queue *queue, u32 index, dma_addr_t addr); -+ unsigned int (*rx_clean)(struct phytmac_queue *queue, u32 cleaned_count); -+ void (*transmit)(struct phytmac_queue *queue); -+ void (*restart)(struct phytmac *pdata); -+ int (*tx_complete)(const struct phytmac_dma_desc *desc); -+ int (*rx_complete)(const struct phytmac_dma_desc *desc); -+ int (*get_rx_pkt_len)(struct phytmac *pdata, const struct phytmac_dma_desc *desc); -+ dma_addr_t (*get_desc_addr)(const struct phytmac_dma_desc *desc); -+ bool (*rx_checksum)(const struct phytmac_dma_desc *desc); -+ void (*set_desc_rxused)(struct phytmac_dma_desc *desc); -+ bool (*rx_single_buffer)(const struct phytmac_dma_desc *desc); -+ bool (*rx_pkt_start)(const struct phytmac_dma_desc *desc); -+ bool (*rx_pkt_end)(const struct phytmac_dma_desc *desc); -+ void (*clear_rx_desc)(struct phytmac_queue *queue, int begin, int end); -+ void (*clear_tx_desc)(struct phytmac_queue *queue); -+ /* ptp */ -+ void (*init_ts_hw)(struct phytmac *pdata); -+ void (*get_time)(struct phytmac *pdata, struct timespec64 *ts); -+ void (*set_time)(struct phytmac *pdata, time64_t sec, long nsec); -+ int (*set_ts_config)(struct phytmac *pdata, struct ts_ctrl *ctrl); -+ void (*clear_time)(struct phytmac *pdata); -+ int (*set_incr)(struct phytmac *pdata, struct ts_incr *incr); -+ int (*adjust_fine)(struct phytmac *pdata, long ppm, bool negative); -+ int (*adjust_time)(struct phytmac *pdata, s64 delta, int neg); -+ int (*ts_valid)(struct phytmac *pdata, struct phytmac_dma_desc *desc, -+ int direction); -+ void (*get_timestamp)(struct phytmac *pdata, u32 ts_1, u32 ts_2, -+ struct timespec64 *ts); -+ unsigned int (*get_ts_rate)(struct phytmac *pdata); -+}; -+ -+/* mhu */ -+#define PHYTMAC_MHU_AP_CPP_STAT 0x00 -+#define PHYTMAC_MHU_AP_CPP_SET 0x04 -+#define PHYTMAC_MHU_CPP_DATA0 0x18 -+#define PHYTMAC_MHU_CPP_DATA1 0x1c -+ -+#define PHYTMAC_MHU_STAT_BUSY_INDEX 0 -+#define PHYTMAC_MHU_STAT_BUSY_WIDTH 1 -+ -+#define PHYTMAC_MHU_SET_INDEX 0 -+#define PHYTMAC_MHU_SET_WIDTH 1 -+ -+#define PHYTMAC_DATA0_FREE_INDEX 0 -+#define PHYTMAC_DATA0_FREE_WIDTH 1 -+#define PHYTMAC_DATA0_DOMAIN_INDEX 1 -+#define PHYTMAC_DATA0_DOMAIN_WIDTH 7 -+#define PHYTMAC_DATA0_MSG_INDEX 8 -+#define PHYTMAC_DATA0_MSG_WIDTH 8 -+#define PHYTMAC_MSG_PM 0x04 -+#define PHYTMAC_DATA0_PRO_INDEX 16 -+#define PHYTMAC_DATA0_PRO_WIDTH 8 -+#define PHYTMAC_PRO_ID 0x11 -+#define PHYTMAC_DATA0_PAYLOAD_INDEX 24 -+#define PHYTMAC_DATA0_PAYLOAD_WIDTH 8 -+ -+#define PHYTMAC_DATA1_STAT_INDEX 0 -+#define PHYTMAC_DATA1_STAT_WIDTH 28 -+#define PHYTMAC_STATON 8 -+#define PHYTMAC_STATOFF 0 -+#define PHYTMAC_DATA1_MUST0_INDEX 28 -+#define PHYTMAC_DATA1_MUST0_WIDTH 2 -+#define PHYTMAC_DATA1_STATTYPE_INDEX 30 -+#define PHYTMAC_DATA1_STATTYPE_WIDTH 1 -+#define PHYTMAC_STATTYPE 0x1 -+#define PHYTMAC_DATA1_MUST1_INDEX 31 -+#define PHYTMAC_DATA1_MUST1_WIDTH 1 -+ -+#define PHYTMAC_MHU_READ(_pdata, _reg) \ -+ __raw_readl((_pdata)->mhu_regs + (_reg)) -+#define PHYTMAC_MHU_WRITE(_pdata, _reg, _val) \ -+ __raw_writel((_val), (_pdata)->mhu_regs + (_reg)) -+#define PHYTMAC_READ_STAT(pdata) PHYTMAC_MHU_READ(pdata, PHYTMAC_MHU_AP_CPP_STAT) -+#define PHYTMAC_READ_DATA0(pdata) PHYTMAC_MHU_READ(pdata, PHYTMAC_MHU_CPP_DATA0) -+#define PHYTMAC_TIMEOUT 1000000000 /* in usecs */ -+ -+struct phytmac_tx_skb *phytmac_get_tx_skb(struct phytmac_queue *queue, -+ unsigned int index); -+inline struct phytmac_dma_desc *phytmac_get_tx_desc(struct phytmac_queue *queue, -+ unsigned int index); -+inline struct phytmac_dma_desc *phytmac_get_rx_desc(struct phytmac_queue *queue, -+ unsigned int index); -+void phytmac_set_ethtool_ops(struct net_device *netdev); -+int phytmac_drv_probe(struct phytmac *pdata); -+int phytmac_drv_remove(struct phytmac *pdata); -+int phytmac_drv_suspend(struct phytmac *pdata); -+int phytmac_drv_resume(struct phytmac *pdata); -+struct phytmac *phytmac_alloc_pdata(struct device *dev); -+void phytmac_free_pdata(struct phytmac *pdata); -+int phytmac_reset_ringsize(struct phytmac *pdata, u32 rx_size, u32 tx_size); -+#endif -diff --git a/drivers/net/ethernet/phytium/phytmac_ethtool.c b/drivers/net/ethernet/phytium/phytmac_ethtool.c -new file mode 100644 -index 000000000..592d2d9dc ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac_ethtool.c -@@ -0,0 +1,544 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+ -+#include -+#include -+#include "phytmac.h" -+#include "phytmac_v1.h" -+#include "phytmac_v2.h" -+#include "phytmac_ptp.h" -+ -+static void phytmac_get_ethtool_stats(struct net_device *ndev, -+ struct ethtool_stats *stats, -+ u64 *data) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ int i = PHYTMAC_STATS_LEN, j; -+ int q; -+ struct phytmac_queue *queue; -+ unsigned long *stat; -+ -+ hw_if->get_stats(pdata); -+ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) -+ for (j = 0, stat = &queue->stats.rx_packets; j < QUEUE_STATS_LEN; ++j, ++stat) -+ pdata->ethtool_stats[i++] = *stat; -+ -+ memcpy(data, &pdata->ethtool_stats, sizeof(u64) -+ * (PHYTMAC_STATS_LEN + QUEUE_STATS_LEN * pdata->queues_num)); -+} -+ -+static inline int phytmac_get_sset_count(struct net_device *ndev, int sset) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ -+ switch (sset) { -+ case ETH_SS_STATS: -+ return PHYTMAC_STATS_LEN + QUEUE_STATS_LEN * pdata->queues_num; -+ default: -+ return -EOPNOTSUPP; -+ } -+} -+ -+static void phytmac_get_ethtool_strings(struct net_device *ndev, u32 sset, u8 *p) -+{ -+ char stat_string[ETH_GSTRING_LEN]; -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_queue *queue; -+ unsigned int i; -+ unsigned int q; -+ -+ switch (sset) { -+ case ETH_SS_STATS: -+ for (i = 0; i < PHYTMAC_STATS_LEN; i++, p += ETH_GSTRING_LEN) -+ memcpy(p, phytmac_statistics[i].stat_string, -+ ETH_GSTRING_LEN); -+ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { -+ for (i = 0; i < QUEUE_STATS_LEN; i++, p += ETH_GSTRING_LEN) { -+ snprintf(stat_string, ETH_GSTRING_LEN, "q%d_%s", -+ q, queue_statistics[i].stat_string); -+ memcpy(p, stat_string, ETH_GSTRING_LEN); -+ } -+ } -+ break; -+ } -+} -+ -+static inline int phytmac_get_regs_len(struct net_device *ndev) -+{ -+ return PHYTMAC_GREGS_LEN; -+} -+ -+static void phytmac_get_regs(struct net_device *ndev, -+ struct ethtool_regs *regs, -+ void *p) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ u32 *regs_buff = p; -+ -+ memset(p, 0, PHYTMAC_GREGS_LEN * sizeof(u32)); -+ -+ hw_if->get_regs(pdata, regs_buff); -+} -+ -+static void phytmac_get_wol(struct net_device *ndev, struct ethtool_wolinfo *wol) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ -+ phylink_ethtool_get_wol(pdata->phylink, wol); -+ -+ if (pdata->wol & PHYTMAC_WAKE_MAGIC) { -+ wol->wolopts |= WAKE_MAGIC; -+ wol->supported |= WAKE_MAGIC; -+ } -+ if (pdata->wol & PHYTMAC_WAKE_ARP) { -+ wol->wolopts |= WAKE_ARP; -+ wol->supported |= WAKE_ARP; -+ } -+ if (pdata->wol & PHYTMAC_WAKE_UCAST) { -+ wol->wolopts |= WAKE_UCAST; -+ wol->supported |= WAKE_UCAST; -+ } -+ if (pdata->wol & PHYTMAC_WAKE_MCAST) { -+ wol->wolopts |= WAKE_MCAST; -+ wol->supported |= WAKE_MCAST; -+ } -+} -+ -+static int phytmac_set_wol(struct net_device *ndev, struct ethtool_wolinfo *wol) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ int ret; -+ -+ ret = phylink_ethtool_set_wol(pdata->phylink, wol); -+ -+ if (!ret || ret != -EOPNOTSUPP) -+ return ret; -+ -+ pdata->wol = 0; -+ -+ if (wol->wolopts & WAKE_MAGIC) -+ pdata->wol |= PHYTMAC_WAKE_MAGIC; -+ if (wol->wolopts & WAKE_ARP) -+ pdata->wol |= PHYTMAC_WAKE_ARP; -+ if (wol->wolopts & WAKE_UCAST) -+ pdata->wol |= PHYTMAC_WAKE_UCAST; -+ if (wol->wolopts & WAKE_MCAST) -+ pdata->wol |= PHYTMAC_WAKE_MCAST; -+ -+ device_set_wakeup_enable(pdata->dev, pdata->wol ? 1 : 0); -+ -+ return 0; -+} -+ -+static void phytmac_get_ringparam(struct net_device *ndev, -+ struct ethtool_ringparam *ring, -+ struct kernel_ethtool_ringparam *kernel_ring, -+ struct netlink_ext_ack *extack) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ -+ ring->rx_max_pending = MAX_RX_RING_SIZE; -+ ring->tx_max_pending = MAX_TX_RING_SIZE; -+ -+ ring->rx_pending = pdata->rx_ring_size; -+ ring->tx_pending = pdata->tx_ring_size; -+} -+ -+static int phytmac_set_ringparam(struct net_device *ndev, -+ struct ethtool_ringparam *ring, -+ struct kernel_ethtool_ringparam *kernel_ring, -+ struct netlink_ext_ack *extack) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ u32 new_rx_size, new_tx_size; -+ -+ if (ring->rx_mini_pending || ring->rx_jumbo_pending) -+ return -EINVAL; -+ -+ new_rx_size = clamp_t(u32, ring->rx_pending, -+ MIN_RX_RING_SIZE, MAX_RX_RING_SIZE); -+ new_rx_size = roundup_pow_of_two(new_rx_size); -+ -+ new_tx_size = clamp_t(u32, ring->tx_pending, -+ MIN_TX_RING_SIZE, MAX_TX_RING_SIZE); -+ new_tx_size = roundup_pow_of_two(new_tx_size); -+ -+ if (EQUAL(new_tx_size, pdata->tx_ring_size) && -+ EQUAL(new_rx_size, pdata->rx_ring_size)) { -+ /* nothing to do */ -+ return 0; -+ } -+ -+ return phytmac_reset_ringsize(pdata, new_rx_size, new_tx_size); -+} -+ -+static int phytmac_get_ts_info(struct net_device *ndev, -+ struct ethtool_ts_info *info) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ -+ if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) { -+ info->so_timestamping = -+ SOF_TIMESTAMPING_TX_SOFTWARE | -+ SOF_TIMESTAMPING_RX_SOFTWARE | -+ SOF_TIMESTAMPING_SOFTWARE | -+ SOF_TIMESTAMPING_TX_HARDWARE | -+ SOF_TIMESTAMPING_RX_HARDWARE | -+ SOF_TIMESTAMPING_RAW_HARDWARE; -+ info->tx_types = -+ (1 << HWTSTAMP_TX_ONESTEP_SYNC) | -+ (1 << HWTSTAMP_TX_OFF) | -+ (1 << HWTSTAMP_TX_ON); -+ info->rx_filters = -+ (1 << HWTSTAMP_FILTER_NONE) | -+ (1 << HWTSTAMP_FILTER_ALL); -+ -+ info->phc_index = pdata->ptp_clock ? ptp_clock_index(pdata->ptp_clock) : -1; -+ -+ return 0; -+ } -+ -+ return ethtool_op_get_ts_info(ndev, info); -+} -+ -+static int phytmac_add_fdir_ethtool(struct net_device *ndev, -+ struct ethtool_rxnfc *cmd) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct ethtool_rx_flow_spec *fs = &cmd->fs; -+ struct ethtool_rx_fs_item *item, *newfs; -+ unsigned long flags; -+ int ret = -EINVAL; -+ bool added = false; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ -+ if (cmd->fs.location >= pdata->max_rx_fs || -+ cmd->fs.ring_cookie >= pdata->queues_num) { -+ return -EINVAL; -+ } -+ -+ newfs = kmalloc(sizeof(*newfs), GFP_KERNEL); -+ if (!newfs) -+ return -ENOMEM; -+ memcpy(&newfs->fs, fs, sizeof(newfs->fs)); -+ -+ netdev_dbg(ndev, "Adding flow filter entry,type=%u,queue=%u,loc=%u,src=%08X,dst=%08X,ps=%u,pd=%u\n", -+ fs->flow_type, (int)fs->ring_cookie, fs->location, -+ htonl(fs->h_u.tcp_ip4_spec.ip4src), -+ htonl(fs->h_u.tcp_ip4_spec.ip4dst), -+ htons(fs->h_u.tcp_ip4_spec.psrc), htons(fs->h_u.tcp_ip4_spec.pdst)); -+ -+ spin_lock_irqsave(&pdata->rx_fs_lock, flags); -+ -+ /* find correct place to add in list */ -+ list_for_each_entry(item, &pdata->rx_fs_list.list, list) { -+ if (item->fs.location > newfs->fs.location) { -+ list_add_tail(&newfs->list, &item->list); -+ added = true; -+ break; -+ } else if (item->fs.location == fs->location) { -+ netdev_err(ndev, "Rule not added: location %d not free!\n", -+ fs->location); -+ ret = -EBUSY; -+ goto err; -+ } -+ } -+ if (!added) -+ list_add_tail(&newfs->list, &pdata->rx_fs_list.list); -+ -+ hw_if->add_fdir_entry(pdata, fs); -+ pdata->rx_fs_list.count++; -+ -+ spin_unlock_irqrestore(&pdata->rx_fs_lock, flags); -+ return 0; -+ -+err: -+ spin_unlock_irqrestore(&pdata->rx_fs_lock, flags); -+ kfree(newfs); -+ return ret; -+} -+ -+static int phytmac_del_fdir_ethtool(struct net_device *ndev, -+ struct ethtool_rxnfc *cmd) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct ethtool_rx_fs_item *item; -+ struct ethtool_rx_flow_spec *fs; -+ unsigned long flags; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ -+ spin_lock_irqsave(&pdata->rx_fs_lock, flags); -+ -+ list_for_each_entry(item, &pdata->rx_fs_list.list, list) { -+ if (item->fs.location == cmd->fs.location) { -+ /* disable screener regs for the flow entry */ -+ fs = &item->fs; -+ netdev_dbg(ndev, "Deleting flow filter entry,type=%u,queue=%u,loc=%u,src=%08X,dst=%08X,ps=%u,pd=%u\n", -+ fs->flow_type, (int)fs->ring_cookie, fs->location, -+ htonl(fs->h_u.tcp_ip4_spec.ip4src), -+ htonl(fs->h_u.tcp_ip4_spec.ip4dst), -+ htons(fs->h_u.tcp_ip4_spec.psrc), -+ htons(fs->h_u.tcp_ip4_spec.pdst)); -+ -+ hw_if->del_fdir_entry(pdata, fs); -+ -+ list_del(&item->list); -+ pdata->rx_fs_list.count--; -+ spin_unlock_irqrestore(&pdata->rx_fs_lock, flags); -+ kfree(item); -+ return 0; -+ } -+ } -+ -+ spin_unlock_irqrestore(&pdata->rx_fs_lock, flags); -+ return -EINVAL; -+} -+ -+static int phytmac_get_fdir_entry(struct net_device *ndev, -+ struct ethtool_rxnfc *cmd) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct ethtool_rx_fs_item *item; -+ -+ list_for_each_entry(item, &pdata->rx_fs_list.list, list) { -+ if (item->fs.location == cmd->fs.location) { -+ memcpy(&cmd->fs, &item->fs, sizeof(cmd->fs)); -+ return 0; -+ } -+ } -+ return -EINVAL; -+} -+ -+static int phytmac_get_all_fdir_entries(struct net_device *ndev, -+ struct ethtool_rxnfc *cmd, -+ u32 *rule_locs) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct ethtool_rx_fs_item *item; -+ u32 cnt = 0; -+ -+ list_for_each_entry(item, &pdata->rx_fs_list.list, list) { -+ if (cnt == cmd->rule_cnt) -+ return -EMSGSIZE; -+ rule_locs[cnt] = item->fs.location; -+ cnt++; -+ } -+ cmd->data = pdata->max_rx_fs; -+ cmd->rule_cnt = cnt; -+ -+ return 0; -+} -+ -+static int phytmac_get_rxnfc(struct net_device *ndev, -+ struct ethtool_rxnfc *cmd, -+ u32 *rule_locs) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ int ret = 0; -+ -+ switch (cmd->cmd) { -+ case ETHTOOL_GRXRINGS: -+ cmd->data = pdata->queues_num; -+ break; -+ case ETHTOOL_GRXCLSRLCNT: -+ cmd->rule_cnt = pdata->rx_fs_list.count; -+ break; -+ case ETHTOOL_GRXCLSRULE: -+ ret = phytmac_get_fdir_entry(ndev, cmd); -+ break; -+ case ETHTOOL_GRXCLSRLALL: -+ ret = phytmac_get_all_fdir_entries(ndev, cmd, rule_locs); -+ break; -+ default: -+ netdev_err(ndev, "Command parameter %d is not supported\n", cmd->cmd); -+ ret = -EOPNOTSUPP; -+ } -+ -+ return ret; -+} -+ -+static int phytmac_set_rxnfc(struct net_device *ndev, struct ethtool_rxnfc *cmd) -+{ -+ switch (cmd->cmd) { -+ case ETHTOOL_SRXCLSRLINS: -+ return phytmac_add_fdir_ethtool(ndev, cmd); -+ case ETHTOOL_SRXCLSRLDEL: -+ return phytmac_del_fdir_ethtool(ndev, cmd); -+ default: -+ netdev_err(ndev, "Command parameter %d is not supported\n", cmd->cmd); -+ return -EOPNOTSUPP; -+ } -+} -+ -+static int phytmac_get_link_ksettings(struct net_device *ndev, -+ struct ethtool_link_ksettings *kset) -+{ -+ int ret = 0; -+ struct phytmac *pdata = netdev_priv(ndev); -+ u32 supported = 0; -+ u32 advertising = 0; -+ -+ if (!ndev->phydev) { -+ if (pdata->phy_interface == PHY_INTERFACE_MODE_USXGMII || -+ pdata->phy_interface == PHY_INTERFACE_MODE_10GBASER) { -+ supported = SUPPORTED_10000baseT_Full -+ | SUPPORTED_FIBRE | SUPPORTED_Pause; -+ advertising = ADVERTISED_10000baseT_Full -+ | ADVERTISED_FIBRE | ADVERTISED_Pause; -+ kset->base.port = PORT_FIBRE; -+ kset->base.transceiver = XCVR_INTERNAL; -+ kset->base.duplex = DUPLEX_FULL; -+ kset->base.speed = SPEED_10000; -+ } else if (pdata->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { -+ supported = SUPPORTED_2500baseX_Full | SUPPORTED_Pause; -+ advertising = ADVERTISED_2500baseX_Full | ADVERTISED_Pause; -+ kset->base.port = PORT_FIBRE; -+ kset->base.transceiver = XCVR_INTERNAL; -+ kset->base.duplex = DUPLEX_FULL; -+ kset->base.speed = SPEED_2500; -+ } else if (pdata->phy_interface == PHY_INTERFACE_MODE_1000BASEX) { -+ supported = SUPPORTED_1000baseT_Full | SUPPORTED_100baseT_Full -+ | SUPPORTED_10baseT_Full | SUPPORTED_FIBRE -+ | SUPPORTED_Pause; -+ advertising = ADVERTISED_1000baseT_Full | ADVERTISED_100baseT_Full -+ | ADVERTISED_10baseT_Full | ADVERTISED_FIBRE -+ | ADVERTISED_Pause; -+ kset->base.port = PORT_FIBRE; -+ kset->base.transceiver = XCVR_INTERNAL; -+ kset->base.duplex = DUPLEX_FULL; -+ kset->base.speed = SPEED_100; -+ } else if (pdata->phy_interface == PHY_INTERFACE_MODE_SGMII) { -+ supported = SUPPORTED_1000baseT_Full | SUPPORTED_100baseT_Full -+ | SUPPORTED_10baseT_Full | SUPPORTED_FIBRE | SUPPORTED_Pause; -+ advertising = ADVERTISED_1000baseT_Full | ADVERTISED_100baseT_Full -+ | ADVERTISED_10baseT_Full | ADVERTISED_FIBRE | ADVERTISED_Pause; -+ kset->base.port = PORT_FIBRE; -+ kset->base.transceiver = XCVR_INTERNAL; -+ kset->base.duplex = DUPLEX_FULL; -+ kset->base.speed = SPEED_1000; -+ } -+ -+ ethtool_convert_legacy_u32_to_link_mode(kset->link_modes.supported, -+ supported); -+ ethtool_convert_legacy_u32_to_link_mode(kset->link_modes.advertising, -+ advertising); -+ } else { -+ phy_ethtool_get_link_ksettings(ndev, kset); -+ } -+ -+ return ret; -+} -+ -+static int phytmac_set_link_ksettings(struct net_device *ndev, -+ const struct ethtool_link_ksettings *kset) -+{ -+ int ret = 0; -+ -+ if (!ndev->phydev) { -+ netdev_err(ndev, "fixed link interface not supported set link\n"); -+ ret = -EOPNOTSUPP; -+ } else { -+ phy_ethtool_set_link_ksettings(ndev, kset); -+ } -+ -+ return ret; -+} -+ -+static inline void phytmac_get_pauseparam(struct net_device *ndev, -+ struct ethtool_pauseparam *pause) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ -+ pause->rx_pause = pdata->pause; -+ pause->tx_pause = pdata->pause; -+} -+ -+static int phytmac_set_pauseparam(struct net_device *ndev, -+ struct ethtool_pauseparam *pause) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ -+ if (pause->rx_pause != pdata->pause) -+ hw_if->enable_pause(pdata, pause->rx_pause); -+ -+ pdata->pause = pause->rx_pause; -+ -+ return 0; -+} -+ -+static inline void phytmac_get_channels(struct net_device *ndev, -+ struct ethtool_channels *ch) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ -+ ch->max_combined = pdata->queues_max_num; -+ ch->combined_count = pdata->queues_num; -+} -+ -+static int phytmac_set_channels(struct net_device *ndev, -+ struct ethtool_channels *ch) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ -+ if (netif_running(ndev)) -+ return -EBUSY; -+ -+ if (ch->combined_count > pdata->queues_max_num) { -+ netdev_err(ndev, "combined channel count cannot exceed %u\n", -+ ch->combined_count); -+ -+ return -EINVAL; -+ } -+ -+ pdata->queues_num = ch->combined_count; -+ -+ return 0; -+} -+ -+static inline u32 phytmac_get_msglevel(struct net_device *ndev) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ -+ return pdata->msg_enable; -+} -+ -+static inline void phytmac_set_msglevel(struct net_device *ndev, u32 level) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ -+ pdata->msg_enable = level; -+} -+ -+static const struct ethtool_ops phytmac_ethtool_ops = { -+ .get_regs_len = phytmac_get_regs_len, -+ .get_regs = phytmac_get_regs, -+ .get_msglevel = phytmac_get_msglevel, -+ .set_msglevel = phytmac_set_msglevel, -+ .get_link = ethtool_op_get_link, -+ .get_ts_info = phytmac_get_ts_info, -+ .get_ethtool_stats = phytmac_get_ethtool_stats, -+ .get_strings = phytmac_get_ethtool_strings, -+ .get_sset_count = phytmac_get_sset_count, -+ .get_link_ksettings = phytmac_get_link_ksettings, -+ .set_link_ksettings = phytmac_set_link_ksettings, -+ .get_ringparam = phytmac_get_ringparam, -+ .set_ringparam = phytmac_set_ringparam, -+ .get_rxnfc = phytmac_get_rxnfc, -+ .set_rxnfc = phytmac_set_rxnfc, -+ .get_pauseparam = phytmac_get_pauseparam, -+ .set_pauseparam = phytmac_set_pauseparam, -+ .get_channels = phytmac_get_channels, -+ .set_channels = phytmac_set_channels, -+ .get_wol = phytmac_get_wol, -+ .set_wol = phytmac_set_wol, -+}; -+ -+void phytmac_set_ethtool_ops(struct net_device *ndev) -+{ -+ ndev->ethtool_ops = &phytmac_ethtool_ops; -+} -+ -diff --git a/drivers/net/ethernet/phytium/phytmac_main.c b/drivers/net/ethernet/phytium/phytmac_main.c -new file mode 100644 -index 000000000..c172103a9 ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac_main.c -@@ -0,0 +1,2244 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+/* -+ * Phytium Ethernet Controller driver -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 as -+ * published by the Free Software Foundation. -+ */ -+ -+#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt -+#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 "phytmac.h" -+#include "phytmac_ptp.h" -+ -+static int debug; -+module_param(debug, int, 0); -+MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)"); -+ -+#define RX_BUFFER_MULTIPLE 64 /* bytes */ -+#define MAX_MTU 3072 -+#define RING_ADDR_INTERVAL 128 -+ -+#define RX_RING_BYTES(pdata) (sizeof(struct phytmac_dma_desc) \ -+ * (pdata)->rx_ring_size) -+ -+#define TX_RING_BYTES(pdata) (sizeof(struct phytmac_dma_desc)\ -+ * (pdata)->tx_ring_size) -+ -+/* Max length of transmit frame must be a multiple of 8 bytes */ -+#define PHYTMAC_TX_LEN_ALIGN 8 -+/* Limit maximum TX length as per Cadence TSO errata. This is to avoid a -+ * false amba_error in TX path from the DMA assuming there is not enough -+ * space in the SRAM (16KB) even when there is. -+ */ -+ -+static int phytmac_change_mtu(struct net_device *ndev, int new_mtu) -+{ -+ if (netif_running(ndev)) -+ return -EBUSY; -+ -+ if (new_mtu > MAX_MTU) { -+ netdev_info(ndev, "Can not set MTU over %d.\n", MAX_MTU); -+ return -EINVAL; -+ } -+ -+ ndev->mtu = new_mtu; -+ -+ return 0; -+} -+ -+static int phytmac_set_mac_address(struct net_device *netdev, void *addr) -+{ -+ struct phytmac *pdata = netdev_priv(netdev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct sockaddr *saddr = addr; -+ -+ if (netif_msg_drv(pdata)) -+ netdev_info(netdev, "phytmac set mac address"); -+ -+ if (!is_valid_ether_addr(saddr->sa_data)) -+ return -EADDRNOTAVAIL; -+ -+ eth_hw_addr_set(netdev, saddr->sa_data); -+ -+ hw_if->set_mac_address(pdata, saddr->sa_data); -+ -+ return 0; -+} -+ -+static int phytmac_get_mac_address(struct phytmac *pdata) -+{ -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ u8 addr[6]; -+ -+ hw_if->get_mac_address(pdata, addr); -+ -+ if (is_valid_ether_addr(addr)) { -+ eth_hw_addr_set(pdata->ndev, addr); -+ return 0; -+ } -+ dev_info(pdata->dev, "invalid hw address, using random\n"); -+ eth_hw_addr_random(pdata->ndev); -+ -+ return 0; -+} -+ -+static int phytmac_mdio_read_c22(struct mii_bus *bus, int mii_id, int regnum) -+{ -+ struct phytmac *pdata = bus->priv; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ int data; -+ -+ data = hw_if->mdio_read(pdata, mii_id, regnum); -+ -+ if (netif_msg_link(pdata)) -+ netdev_info(pdata->ndev, "mdio read c22 mii_id=%d, regnum=%x, data=%x\n", -+ mii_id, regnum, data); -+ -+ return data; -+} -+ -+static int phytmac_mdio_write_c22(struct mii_bus *bus, int mii_id, int regnum, u16 data) -+{ -+ struct phytmac *pdata = bus->priv; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ int ret; -+ -+ ret = hw_if->mdio_write(pdata, mii_id, regnum, data); -+ if (ret) -+ netdev_err(pdata->ndev, "mdio %d, reg %x, data %x write failed!\n", -+ mii_id, regnum, data); -+ -+ if (netif_msg_link(pdata)) -+ netdev_info(pdata->ndev, "mdio write c22 mii_id=%d, regnum=%x, data=%x\n", -+ mii_id, regnum, data); -+ -+ return 0; -+} -+ -+static int phytmac_mdio_read_c45(struct mii_bus *bus, int mii_id, int devad, int regnum) -+{ -+ struct phytmac *pdata = bus->priv; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ int data; -+ -+ data = hw_if->mdio_read_c45(pdata, mii_id, devad, regnum); -+ -+ if (netif_msg_link(pdata)) -+ netdev_info(pdata->ndev, "mdio read c45 mii_id=%d, regnum=%x, data=%x\n", -+ mii_id, regnum, data); -+ -+ return data; -+} -+ -+static int phytmac_mdio_write_c45(struct mii_bus *bus, int mii_id, int devad, int regnum, u16 data) -+{ -+ struct phytmac *pdata = bus->priv; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ int ret; -+ -+ ret = hw_if->mdio_write_c45(pdata, mii_id, devad, regnum, data); -+ if (ret) -+ netdev_err(pdata->ndev, "mdio %d, reg %x, data %x write failed!\n", -+ mii_id, regnum, data); -+ -+ if (netif_msg_link(pdata)) -+ netdev_info(pdata->ndev, "mdio write c45 mii_id=%d, regnum=%x, data=%x\n", -+ mii_id, regnum, data); -+ -+ return 0; -+} -+ -+static inline int hash_bit_value(int bitnr, __u8 *addr) -+{ -+ if (addr[bitnr / 8] & (1 << (bitnr % 8))) -+ return 1; -+ return 0; -+} -+ -+/* Return the hash index value for the specified address. */ -+static int phytmac_get_hash_index(__u8 *addr) -+{ -+ int i, j, bitval; -+ int hash_index = 0; -+ -+ for (j = 0; j < 6; j++) { -+ for (i = 0, bitval = 0; i < 8; i++) -+ bitval ^= hash_bit_value(i * 6 + j, addr); -+ -+ hash_index |= (bitval << j); -+ } -+ -+ return hash_index; -+} -+ -+static void phytmac_set_mac_hash_table(struct net_device *ndev) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct netdev_hw_addr *ha; -+ unsigned long mc_filter[2]; -+ unsigned int bitnr; -+ -+ mc_filter[0] = 0; -+ mc_filter[1] = 0; -+ -+ netdev_for_each_mc_addr(ha, ndev) { -+ bitnr = phytmac_get_hash_index(ha->addr); -+ mc_filter[bitnr >> 5] |= 1 << (bitnr & 31); -+ } -+ -+ hw_if->set_hash_table(pdata, mc_filter); -+} -+ -+/* Enable/Disable promiscuous and multicast modes. */ -+static void phytmac_set_rx_mode(struct net_device *ndev) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ -+ hw_if->enable_promise(pdata, ndev->flags & IFF_PROMISC); -+ -+ hw_if->enable_multicast(pdata, ndev->flags & IFF_ALLMULTI); -+ if (!netdev_mc_empty(ndev)) -+ phytmac_set_mac_hash_table(ndev); -+} -+ -+static struct net_device_stats *phytmac_get_stats(struct net_device *dev) -+{ -+ struct phytmac *pdata = netdev_priv(dev); -+ struct net_device_stats *nstat = &pdata->ndev->stats; -+ struct phytmac_stats *stat = &pdata->stats; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ -+ if (pdata->power_state == PHYTMAC_POWEROFF) -+ return nstat; -+ -+ hw_if->get_stats(pdata); -+ -+ nstat->rx_errors = (stat->rx_fcs_errors + -+ stat->rx_alignment_errors + -+ stat->rx_overruns + -+ stat->rx_oversize_packets + -+ stat->rx_jabbers + -+ stat->rx_undersized_packets + -+ stat->rx_length_errors); -+ nstat->rx_dropped = stat->rx_resource_over; -+ nstat->tx_errors = (stat->tx_late_collisions + -+ stat->tx_excessive_collisions + -+ stat->tx_underrun + -+ stat->tx_carrier_sense_errors); -+ nstat->multicast = stat->rx_mcast_packets; -+ nstat->collisions = (stat->tx_single_collisions + -+ stat->tx_multiple_collisions + -+ stat->tx_excessive_collisions + -+ stat->tx_late_collisions); -+ nstat->rx_length_errors = (stat->rx_oversize_packets + -+ stat->rx_jabbers + -+ stat->rx_undersized_packets + -+ stat->rx_length_errors); -+ nstat->rx_over_errors = stat->rx_resource_over; -+ nstat->rx_crc_errors = stat->rx_fcs_errors; -+ nstat->rx_frame_errors = stat->rx_alignment_errors; -+ nstat->rx_fifo_errors = stat->rx_overruns; -+ nstat->tx_aborted_errors = stat->tx_excessive_collisions; -+ nstat->tx_carrier_errors = stat->tx_carrier_sense_errors; -+ nstat->tx_fifo_errors = stat->tx_underrun; -+ -+ return nstat; -+} -+ -+static int phytmac_calc_rx_buf_len(struct phytmac *pdata, u32 mtu) -+{ -+ unsigned int size = mtu + ETH_HLEN + ETH_FCS_LEN; -+ int rx_buf_len = roundup(size, RX_BUFFER_MULTIPLE); -+ -+ netdev_dbg(pdata->ndev, "mtu [%u] rx_buffer_size [%u]\n", -+ mtu, rx_buf_len); -+ -+ return rx_buf_len; -+} -+ -+inline struct phytmac_dma_desc *phytmac_get_rx_desc(struct phytmac_queue *queue, -+ unsigned int index) -+{ -+ return &queue->rx_ring[index & (queue->pdata->rx_ring_size - 1)]; -+} -+ -+struct sk_buff *phytmac_get_rx_skb(struct phytmac_queue *queue, -+ unsigned int index) -+{ -+ return queue->rx_skb[index & (queue->pdata->rx_ring_size - 1)]; -+} -+ -+struct phytmac_tx_skb *phytmac_get_tx_skb(struct phytmac_queue *queue, -+ unsigned int index) -+{ -+ return &queue->tx_skb[index & (queue->pdata->tx_ring_size - 1)]; -+} -+ -+inline struct phytmac_dma_desc *phytmac_get_tx_desc(struct phytmac_queue *queue, -+ unsigned int index) -+{ -+ return &queue->tx_ring[index & (queue->pdata->tx_ring_size - 1)]; -+} -+ -+static int phytmac_free_tx_resource(struct phytmac *pdata) -+{ -+ struct phytmac_queue *queue; -+ struct phytmac_dma_desc *tx_ring_base = NULL; -+ dma_addr_t tx_ring_base_addr; -+ unsigned int q; -+ int size; -+ -+ queue = pdata->queues; -+ if (queue->tx_ring) { -+ tx_ring_base = queue->tx_ring; -+ tx_ring_base_addr = queue->tx_ring_addr; -+ } -+ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { -+ kfree(queue->tx_skb); -+ queue->tx_skb = NULL; -+ -+ if (queue->tx_ring) -+ queue->tx_ring = NULL; -+ } -+ -+ if (tx_ring_base) { -+ size = pdata->queues_num * (TX_RING_BYTES(pdata) + pdata->tx_bd_prefetch + -+ RING_ADDR_INTERVAL); -+ dma_free_coherent(pdata->dev, size, tx_ring_base, tx_ring_base_addr); -+ } -+ -+ return 0; -+} -+ -+static int phytmac_free_rx_resource(struct phytmac *pdata) -+{ -+ struct phytmac_queue *queue; -+ struct sk_buff *skb; -+ struct phytmac_dma_desc *desc; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct phytmac_dma_desc *rx_ring_base = NULL; -+ dma_addr_t rx_ring_base_addr; -+ dma_addr_t addr; -+ unsigned int q; -+ int size, i; -+ -+ queue = pdata->queues; -+ if (queue->rx_ring) { -+ rx_ring_base = queue->rx_ring; -+ rx_ring_base_addr = queue->rx_ring_addr; -+ } -+ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { -+ if (queue->rx_skb) { -+ for (i = 0; i < pdata->rx_ring_size; i++) { -+ skb = phytmac_get_rx_skb(queue, i); -+ if (skb) { -+ desc = &queue->rx_ring[i]; -+ addr = hw_if->get_desc_addr(desc); -+ dma_unmap_single(pdata->dev, addr, pdata->rx_buffer_len, -+ DMA_FROM_DEVICE); -+ dev_kfree_skb_any(skb); -+ skb = NULL; -+ } -+ } -+ -+ kfree(queue->rx_skb); -+ queue->rx_skb = NULL; -+ } -+ -+ if (queue->rx_ring) -+ queue->rx_ring = NULL; -+ } -+ -+ if (rx_ring_base) { -+ size = pdata->queues_num * (RX_RING_BYTES(pdata) + pdata->rx_bd_prefetch + -+ RING_ADDR_INTERVAL); -+ dma_free_coherent(pdata->dev, size, rx_ring_base, rx_ring_base_addr); -+ } -+ -+ return 0; -+} -+ -+static int phytmac_alloc_tx_resource(struct phytmac *pdata) -+{ -+ struct phytmac_queue *queue; -+ struct phytmac_dma_desc *tx_ring_base; -+ dma_addr_t tx_ring_base_addr; -+ unsigned int q; -+ int size; -+ -+ size = pdata->queues_num * (TX_RING_BYTES(pdata) + pdata->tx_bd_prefetch + -+ RING_ADDR_INTERVAL); -+ tx_ring_base = dma_alloc_coherent(pdata->dev, size, -+ &tx_ring_base_addr, GFP_KERNEL); -+ if (!tx_ring_base) -+ goto err; -+ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { -+ size = TX_RING_BYTES(pdata) + pdata->tx_bd_prefetch + RING_ADDR_INTERVAL; -+ queue->tx_ring = (void *)tx_ring_base + q * size; -+ queue->tx_ring_addr = tx_ring_base_addr + q * size; -+ if (!queue->tx_ring) -+ goto err; -+ -+ if (netif_msg_drv(pdata)) -+ netdev_info(pdata->ndev, -+ "Allocated TX ring for queue %u of %d bytes at %08lx\n", -+ q, size, (unsigned long)queue->tx_ring_addr); -+ -+ size = pdata->tx_ring_size * sizeof(struct phytmac_tx_skb); -+ queue->tx_skb = kzalloc(size, GFP_KERNEL); -+ if (!queue->tx_skb) -+ goto err; -+ -+ if (netif_msg_drv(pdata)) -+ netdev_info(pdata->ndev, -+ "Allocated %d TX struct tx_skb entries at %p\n", -+ pdata->tx_ring_size, queue->tx_skb); -+ } -+ tx_ring_base = NULL; -+ -+ return 0; -+err: -+ phytmac_free_tx_resource(pdata); -+ -+ return -ENOMEM; -+} -+ -+static int phytmac_alloc_rx_resource(struct phytmac *pdata) -+{ -+ struct phytmac_queue *queue; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct phytmac_dma_desc *rx_ring_base; -+ dma_addr_t rx_ring_base_addr; -+ unsigned int q; -+ int size; -+ int i; -+ -+ size = pdata->queues_num * (RX_RING_BYTES(pdata) + pdata->rx_bd_prefetch + -+ RING_ADDR_INTERVAL); -+ rx_ring_base = dma_alloc_coherent(pdata->dev, size, -+ &rx_ring_base_addr, GFP_KERNEL); -+ if (!rx_ring_base) -+ goto err; -+ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { -+ size = RX_RING_BYTES(pdata) + pdata->rx_bd_prefetch + RING_ADDR_INTERVAL; -+ queue->rx_ring = (void *)rx_ring_base + q * size; -+ queue->rx_ring_addr = rx_ring_base_addr + q * size; -+ if (!queue->rx_ring) -+ goto err; -+ -+ if (netif_msg_drv(pdata)) -+ netdev_info(pdata->ndev, -+ "Allocated RX ring for queue %u of %d bytes at %08lx\n", -+ q, size, (unsigned long)queue->rx_ring_addr); -+ -+ for (i = 0; i < pdata->rx_ring_size; i++) -+ hw_if->init_rx_map(queue, i); -+ -+ size = pdata->rx_ring_size * sizeof(struct sk_buff *); -+ queue->rx_skb = kzalloc(size, GFP_KERNEL); -+ if (!queue->rx_skb) -+ goto err; -+ -+ if (netif_msg_drv(pdata)) -+ netdev_info(pdata->ndev, -+ "Allocated %d RX struct sk_buff entries at %p\n", -+ pdata->rx_ring_size, queue->rx_skb); -+ } -+ rx_ring_base = NULL; -+ -+ return 0; -+err: -+ phytmac_free_rx_resource(pdata); -+ -+ return -ENOMEM; -+} -+ -+static int phytmac_alloc_resource(struct phytmac *pdata) -+{ -+ struct net_device *ndev = pdata->ndev; -+ int ret; -+ -+ pdata->rx_buffer_len = phytmac_calc_rx_buf_len(pdata, ndev->mtu); -+ -+ if (netif_msg_drv(pdata)) -+ netdev_info(pdata->ndev, "alloc resource, rx_buffer_len = %d\n", -+ pdata->rx_buffer_len); -+ -+ ret = phytmac_alloc_tx_resource(pdata); -+ if (ret) -+ return ret; -+ -+ ret = phytmac_alloc_rx_resource(pdata); -+ if (ret) { -+ phytmac_free_tx_resource(pdata); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static void phytmac_free_resource(struct phytmac *pdata) -+{ -+ phytmac_free_tx_resource(pdata); -+ phytmac_free_rx_resource(pdata); -+} -+ -+static irqreturn_t phytmac_irq(int irq, void *data) -+{ -+ struct phytmac_queue *queue = data; -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ u32 status; -+ -+ status = hw_if->get_irq(pdata, queue->index); -+ -+ if (netif_msg_intr(pdata)) -+ netdev_info(pdata->ndev, "phymac irq status = %x\n", status); -+ -+ if (unlikely(!status)) -+ return IRQ_NONE; -+ -+ while (status) { -+ if (status & pdata->rx_irq_mask) { -+ /* Disable RX interrupts */ -+ hw_if->disable_irq(pdata, queue->index, pdata->rx_irq_mask); -+ hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_RX_COMPLETE); -+ -+ if (napi_schedule_prep(&queue->rx_napi)) -+ __napi_schedule(&queue->rx_napi); -+ } -+ -+ if (status & (PHYTMAC_INT_TX_COMPLETE)) { -+ /* Disable TX interrupts */ -+ hw_if->disable_irq(pdata, queue->index, PHYTMAC_INT_TX_COMPLETE); -+ hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_TX_COMPLETE); -+ -+ if (napi_schedule_prep(&queue->tx_napi)) -+ __napi_schedule(&queue->tx_napi); -+ } -+ -+ if (status & PHYTMAC_INT_TX_ERR) -+ hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_TX_ERR); -+ -+ if (status & PHYTMAC_INT_RX_OVERRUN) { -+ hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_RX_OVERRUN); -+ pdata->stats.rx_overruns++; -+ } -+ status = hw_if->get_irq(pdata, queue->index); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static irqreturn_t phytmac_intx_irq(int irq, void *data) -+{ -+ struct phytmac *pdata = data; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ u32 irq_mask; -+ int i; -+ -+ irq_mask = hw_if->get_intx_mask(pdata); -+ -+ if (unlikely(!irq_mask)) -+ return IRQ_NONE; -+ -+ for (i = 0; i < pdata->queues_num; i++) { -+ if (irq_mask & BIT(i)) -+ phytmac_irq(irq, &pdata->queues[i]); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static void phytmac_dump_pkt(struct phytmac *pdata, struct sk_buff *skb, bool tx) -+{ -+ struct net_device *ndev = pdata->ndev; -+ -+ if (tx) { -+ netdev_dbg(ndev, "start_xmit: queue %u len %u head %p data %p tail %p end %p\n", -+ skb->queue_mapping, skb->len, skb->head, skb->data, -+ skb_tail_pointer(skb), skb_end_pointer(skb)); -+ } else { -+ netdev_dbg(ndev, "queue %u received skb of length %u, csum: %08x\n", -+ skb->queue_mapping, skb->len, skb->csum); -+ print_hex_dump(KERN_DEBUG, " mac: ", DUMP_PREFIX_ADDRESS, 16, 1, -+ skb_mac_header(skb), 16, true); -+ } -+ -+ print_hex_dump(KERN_DEBUG, "data: ", DUMP_PREFIX_OFFSET, 16, 1, -+ skb->data, skb->len, true); -+} -+ -+static struct sk_buff *phytmac_rx_single(struct phytmac_queue *queue, struct phytmac_dma_desc *desc) -+{ -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct sk_buff *skb; -+ unsigned int len; -+ dma_addr_t addr; -+ -+ skb = phytmac_get_rx_skb(queue, queue->rx_tail); -+ if (unlikely(!skb)) { -+ netdev_err(pdata->ndev, -+ "inconsistent Rx descriptor chain\n"); -+ pdata->ndev->stats.rx_dropped++; -+ queue->stats.rx_dropped++; -+ return NULL; -+ } -+ -+ queue->rx_skb[queue->rx_tail & (pdata->rx_ring_size - 1)] = NULL; -+ len = hw_if->get_rx_pkt_len(pdata, desc); -+ addr = hw_if->get_desc_addr(desc); -+ -+ skb_put(skb, len); -+ dma_unmap_single(pdata->dev, addr, -+ pdata->rx_buffer_len, DMA_FROM_DEVICE); -+ skb->protocol = eth_type_trans(skb, pdata->ndev); -+ skb_checksum_none_assert(skb); -+ -+ if (pdata->ndev->features & NETIF_F_RXCSUM && -+ !(pdata->ndev->flags & IFF_PROMISC) && -+ hw_if->rx_checksum(desc)) -+ skb->ip_summed = CHECKSUM_UNNECESSARY; -+ -+ if (netif_msg_pktdata(pdata)) -+ phytmac_dump_pkt(pdata, skb, false); -+ -+ return skb; -+} -+ -+static struct sk_buff *phytmac_rx_frame(struct phytmac_queue *queue, -+ unsigned int first_frag, unsigned int last_frag, int len) -+{ -+ unsigned int offset = 0; -+ unsigned int frag = 0; -+ unsigned int entry = 0; -+ dma_addr_t addr = 0; -+ struct sk_buff *skb; -+ struct phytmac_dma_desc *desc; -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ unsigned int frag_len = pdata->rx_buffer_len; -+ -+ if (netif_msg_drv(pdata)) -+ netdev_info(pdata->ndev, "rx frame %u - %u (len %u)\n", -+ first_frag, last_frag, len); -+ -+ skb = netdev_alloc_skb(pdata->ndev, len); -+ if (!skb) { -+ pdata->ndev->stats.rx_dropped++; -+ netdev_err(pdata->ndev, "rx frame alloc skb failed\n"); -+ return NULL; -+ } -+ -+ skb_checksum_none_assert(skb); -+ -+ if (pdata->ndev->features & NETIF_F_RXCSUM && -+ !(pdata->ndev->flags & IFF_PROMISC) && -+ hw_if->rx_checksum(phytmac_get_rx_desc(queue, last_frag))) -+ skb->ip_summed = CHECKSUM_UNNECESSARY; -+ -+ skb_put(skb, len); -+ -+ for (frag = first_frag; ; frag++) { -+ if (offset + frag_len > len) { -+ if (unlikely(frag != last_frag)) { -+ dev_kfree_skb_any(skb); -+ return NULL; -+ } -+ frag_len = len - offset; -+ } -+ -+ desc = phytmac_get_rx_desc(queue, frag); -+ addr = hw_if->get_desc_addr(desc); -+ dma_sync_single_for_cpu(pdata->dev, addr, frag_len, -+ DMA_FROM_DEVICE); -+ -+ entry = frag & (pdata->rx_ring_size - 1); -+ skb_copy_to_linear_data_offset(skb, offset, queue->rx_skb[entry]->data, frag_len); -+ -+ offset += pdata->rx_buffer_len; -+ -+ dma_sync_single_for_device(pdata->dev, addr, frag_len, -+ DMA_FROM_DEVICE); -+ -+ if (frag == last_frag) -+ break; -+ } -+ -+ skb->protocol = eth_type_trans(skb, pdata->ndev); -+ if (netif_msg_pktdata(pdata)) -+ phytmac_dump_pkt(pdata, skb, false); -+ -+ return skb; -+} -+ -+static struct sk_buff *phytmac_rx_mbuffer(struct phytmac_queue *queue) -+{ -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct phytmac_dma_desc *desc; -+ struct sk_buff *skb = NULL; -+ unsigned int rx_tail = 0; -+ int first_frag = -1; -+ int len; -+ -+ for (rx_tail = queue->rx_tail; ; rx_tail++) { -+ desc = phytmac_get_rx_desc(queue, rx_tail); -+ if (hw_if->rx_pkt_start(desc)) { -+ if (first_frag != -1) -+ hw_if->clear_rx_desc(queue, first_frag, rx_tail); -+ first_frag = rx_tail; -+ continue; -+ } -+ -+ if (hw_if->rx_pkt_end(desc)) { -+ queue->rx_tail = rx_tail; -+ len = hw_if->get_rx_pkt_len(pdata, desc); -+ skb = phytmac_rx_frame(queue, first_frag, rx_tail, len); -+ first_frag = -1; -+ break; -+ } -+ } -+ return skb; -+} -+ -+static void phytmac_rx_clean(struct phytmac_queue *queue) -+{ -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ unsigned int index, space; -+ dma_addr_t paddr; -+ struct sk_buff *skb; -+ unsigned int rx_unclean = 0; -+ -+ space = CIRC_SPACE(queue->rx_head, queue->rx_tail, -+ pdata->rx_ring_size); -+ -+ if (space < DEFAULT_RX_DESC_MIN_FREE) -+ return; -+ -+ index = queue->rx_head & (pdata->rx_ring_size - 1); -+ while (space > 0) { -+ if (!queue->rx_skb[index]) { -+ skb = netdev_alloc_skb(pdata->ndev, pdata->rx_buffer_len); -+ if (unlikely(!skb)) { -+ netdev_err(pdata->ndev, "rx clean alloc skb failed\n"); -+ break; -+ } -+ -+ paddr = dma_map_single(pdata->dev, skb->data, -+ pdata->rx_buffer_len, DMA_FROM_DEVICE); -+ if (dma_mapping_error(pdata->dev, paddr)) { -+ dev_kfree_skb(skb); -+ break; -+ } -+ -+ queue->rx_skb[index] = skb; -+ -+ hw_if->rx_map(queue, index, paddr); -+ } -+ -+ index = (index + 1) & (pdata->rx_ring_size - 1); -+ rx_unclean++; -+ space--; -+ } -+ -+ /* make newly descriptor to hardware */ -+ wmb(); -+ hw_if->rx_clean(queue, rx_unclean); -+ /* make newly descriptor to hardware */ -+ wmb(); -+ queue->rx_head += rx_unclean; -+ if (queue->rx_head >= pdata->rx_ring_size) -+ queue->rx_head &= (pdata->rx_ring_size - 1); -+} -+ -+static int phytmac_rx(struct phytmac_queue *queue, struct napi_struct *napi, -+ int budget) -+{ -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct sk_buff *skb; -+ struct phytmac_dma_desc *desc; -+ int count = 0; -+ -+ while (count < budget) { -+ desc = phytmac_get_rx_desc(queue, queue->rx_tail); -+ /* make newly desc to cpu */ -+ rmb(); -+ -+ if (!hw_if->rx_complete(desc)) -+ break; -+ -+ /* Ensure ctrl is at least as up-to-date as rxused */ -+ dma_rmb(); -+ -+ if (hw_if->rx_single_buffer(desc)) -+ skb = phytmac_rx_single(queue, desc); -+ else -+ skb = phytmac_rx_mbuffer(queue); -+ -+ if (!skb) { -+ netdev_warn(pdata->ndev, "phytmac rx skb is NULL\n"); -+ break; -+ } -+ -+ pdata->ndev->stats.rx_packets++; -+ queue->stats.rx_packets++; -+ pdata->ndev->stats.rx_bytes += skb->len; -+ queue->stats.rx_bytes += skb->len; -+ queue->rx_tail = (queue->rx_tail + 1) & (pdata->rx_ring_size - 1); -+ -+ count++; -+ -+ if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) -+ phytmac_ptp_rxstamp(pdata, skb, desc); -+ -+ napi_gro_receive(napi, skb); -+ } -+ -+ phytmac_rx_clean(queue); -+ -+ return count; -+} -+ -+static void phytmac_tx_unmap(struct phytmac *pdata, struct phytmac_tx_skb *tx_skb, int budget) -+{ -+ if (tx_skb->addr) { -+ if (tx_skb->mapped_as_page) -+ dma_unmap_page(pdata->dev, tx_skb->addr, -+ tx_skb->length, DMA_TO_DEVICE); -+ else -+ dma_unmap_single(pdata->dev, tx_skb->addr, -+ tx_skb->length, DMA_TO_DEVICE); -+ tx_skb->addr = 0; -+ } -+ -+ if (tx_skb->skb) { -+ napi_consume_skb(tx_skb->skb, budget); -+ tx_skb->skb = NULL; -+ } -+} -+ -+static int phytmac_maybe_stop_tx_queue(struct phytmac_queue *queue, -+ unsigned int count) -+{ -+ struct phytmac *pdata = queue->pdata; -+ int space = CIRC_SPACE(queue->tx_tail, queue->tx_head, -+ pdata->tx_ring_size); -+ -+ if (space < count) { -+ if (netif_msg_drv(pdata)) -+ netdev_info(pdata->ndev, "Tx queue %d stopped, not enough descriptors available\n", -+ queue->index); -+ -+ netif_stop_subqueue(pdata->ndev, queue->index); -+ -+ return NETDEV_TX_BUSY; -+ } -+ -+ return 0; -+} -+ -+static int phytmac_maybe_wake_tx_queue(struct phytmac_queue *queue) -+{ -+ struct phytmac *pdata = queue->pdata; -+ int space = CIRC_CNT(queue->tx_tail, queue->tx_head, -+ pdata->tx_ring_size); -+ -+ return (space <= (3 * pdata->tx_ring_size / 4)) ? 1 : 0; -+} -+ -+static int phytmac_tx_clean(struct phytmac_queue *queue, int budget) -+{ -+ struct phytmac *pdata = queue->pdata; -+ u16 queue_index = queue->index; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct phytmac_tx_skb *tx_skb; -+ struct phytmac_dma_desc *desc; -+ int complete = 0; -+ int packet_count = 0; -+ unsigned int tail = queue->tx_tail; -+ unsigned int head; -+ -+ spin_lock(&pdata->lock); -+ -+ for (head = queue->tx_head; head != tail && packet_count < budget; ) { -+ struct sk_buff *skb; -+ -+ desc = phytmac_get_tx_desc(queue, head); -+ /* make newly desc to cpu */ -+ rmb(); -+ if (!hw_if->tx_complete(desc)) -+ break; -+ -+ /* Process all buffers of the current transmitted frame */ -+ for (;; head++) { -+ tx_skb = phytmac_get_tx_skb(queue, head); -+ skb = tx_skb->skb; -+ -+ if (skb) { -+ complete = 1; -+ if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) { -+ if (unlikely(skb_shinfo(skb)->tx_flags & -+ SKBTX_HW_TSTAMP) && -+ !phytmac_ptp_one_step(skb)) { -+ phytmac_ptp_txstamp(queue, skb, desc); -+ } -+ } -+ -+ if (netif_msg_drv(pdata)) -+ netdev_info(pdata->ndev, "desc %u (data %p) tx complete\n", -+ head, tx_skb->skb->data); -+ -+ pdata->ndev->stats.tx_packets++; -+ queue->stats.tx_packets++; -+ pdata->ndev->stats.tx_bytes += tx_skb->skb->len; -+ queue->stats.tx_bytes += tx_skb->skb->len; -+ packet_count++; -+ } -+ -+ /* Now we can safely release resources */ -+ phytmac_tx_unmap(pdata, tx_skb, budget); -+ -+ if (complete) { -+ complete = 0; -+ break; -+ } -+ } -+ -+ head++; -+ if (head >= pdata->tx_ring_size) -+ head &= (pdata->tx_ring_size - 1); -+ } -+ -+ queue->tx_head = head; -+ if (__netif_subqueue_stopped(pdata->ndev, queue_index) && -+ (phytmac_maybe_wake_tx_queue(queue))) -+ netif_wake_subqueue(pdata->ndev, queue_index); -+ spin_unlock(&pdata->lock); -+ -+ return packet_count; -+} -+ -+static int phytmac_rx_poll(struct napi_struct *napi, int budget) -+{ -+ struct phytmac_queue *queue = container_of(napi, struct phytmac_queue, rx_napi); -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct phytmac_dma_desc *desc; -+ int work_done; -+ -+ work_done = phytmac_rx(queue, napi, budget); -+ -+ if (netif_msg_drv(pdata)) -+ netdev_info(pdata->ndev, "RX poll: queue = %u, work_done = %d, budget = %d\n", -+ (unsigned int)(queue->index), work_done, budget); -+ if (work_done < budget && napi_complete_done(napi, work_done)) { -+ hw_if->enable_irq(pdata, queue->index, pdata->rx_irq_mask); -+ -+ desc = phytmac_get_rx_desc(queue, queue->rx_tail); -+ /* make newly desc to cpu */ -+ rmb(); -+ -+ if (hw_if->rx_complete(desc)) { -+ hw_if->disable_irq(pdata, queue->index, pdata->rx_irq_mask); -+ hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_RX_COMPLETE); -+ -+ napi_schedule(napi); -+ } -+ } -+ -+ return work_done; -+} -+ -+static int phytmac_tx_poll(struct napi_struct *napi, int budget) -+{ -+ struct phytmac_queue *queue = container_of(napi, struct phytmac_queue, tx_napi); -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct phytmac_dma_desc *desc; -+ int work_done; -+ -+ work_done = phytmac_tx_clean(queue, budget); -+ -+ if (netif_msg_drv(pdata)) -+ netdev_info(pdata->ndev, "TX poll: queue = %u, work_done = %d, budget = %d\n", -+ (unsigned int)(queue->index), work_done, budget); -+ if (work_done < budget && napi_complete_done(napi, work_done)) { -+ hw_if->enable_irq(pdata, queue->index, PHYTMAC_INT_TX_COMPLETE); -+ if (queue->tx_head != queue->tx_tail) { -+ desc = phytmac_get_tx_desc(queue, queue->tx_head); -+ /* make newly desc to cpu */ -+ rmb(); -+ -+ if (hw_if->tx_complete(desc)) { -+ hw_if->disable_irq(pdata, queue->index, PHYTMAC_INT_TX_COMPLETE); -+ hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_TX_COMPLETE); -+ -+ napi_schedule(napi); -+ } -+ } -+ } -+ -+ return work_done; -+} -+ -+static inline int phytmac_clear_csum(struct sk_buff *skb) -+{ -+ if (skb->ip_summed != CHECKSUM_PARTIAL) -+ return 0; -+ -+ /* make sure we can modify the header */ -+ if (unlikely(skb_cow_head(skb, 0))) -+ return -1; -+ -+ *(__sum16 *)(skb_checksum_start(skb) + skb->csum_offset) = 0; -+ return 0; -+} -+ -+static int phytmac_add_fcs(struct sk_buff **skb, struct net_device *ndev) -+{ -+ bool cloned = skb_cloned(*skb) || skb_header_cloned(*skb) || -+ skb_is_nonlinear(*skb); -+ int padlen = ETH_ZLEN - (*skb)->len; -+ int headroom = skb_headroom(*skb); -+ int tailroom = skb_tailroom(*skb); -+ struct sk_buff *nskb; -+ u32 fcs; -+ int i; -+ -+ if ((ndev->features & NETIF_F_HW_CSUM) || -+ !((*skb)->ip_summed != CHECKSUM_PARTIAL) || -+ skb_shinfo(*skb)->gso_size || phytmac_ptp_one_step(*skb)) -+ return 0; -+ -+ if (padlen <= 0) { -+ if (tailroom >= ETH_FCS_LEN) -+ goto add_fcs; -+ else if (!cloned && headroom + tailroom >= ETH_FCS_LEN) -+ padlen = 0; -+ else -+ padlen = ETH_FCS_LEN; -+ } else { -+ padlen += ETH_FCS_LEN; -+ } -+ -+ if (!cloned && headroom + tailroom >= padlen) { -+ (*skb)->data = memmove((*skb)->head, (*skb)->data, (*skb)->len); -+ skb_set_tail_pointer(*skb, (*skb)->len); -+ } else { -+ nskb = skb_copy_expand(*skb, 0, padlen, GFP_ATOMIC); -+ if (!nskb) -+ return -ENOMEM; -+ -+ dev_consume_skb_any(*skb); -+ *skb = nskb; -+ } -+ -+ if (padlen > ETH_FCS_LEN) -+ skb_put_zero(*skb, padlen - ETH_FCS_LEN); -+ -+add_fcs: -+ fcs = crc32_le(~0, (*skb)->data, (*skb)->len); -+ fcs = ~fcs; -+ -+ for (i = 0; i < 4; ++i) -+ skb_put_u8(*skb, (fcs >> (i * 8)) & 0xff); -+ return 0; -+} -+ -+static int phytmac_packet_info(struct phytmac *pdata, -+ struct phytmac_queue *queue, struct sk_buff *skb, -+ struct packet_info *packet) -+{ -+ int is_lso; -+ unsigned int hdrlen, f; -+ int desc_cnt; -+ -+ memset(packet, 0, sizeof(struct packet_info)); -+ -+ is_lso = (skb_shinfo(skb)->gso_size != 0); -+ -+ if (is_lso) { -+ /* length of headers */ -+ if (ip_hdr(skb)->protocol == IPPROTO_UDP) { -+ /* only queue eth + ip headers separately for UDP */ -+ hdrlen = skb_transport_offset(skb); -+ packet->lso = LSO_UFO; -+ packet->mss = skb_shinfo(skb)->gso_size + hdrlen + ETH_FCS_LEN; -+ } else { -+ hdrlen = skb_transport_offset(skb) + tcp_hdrlen(skb); -+ packet->lso = LSO_TSO; -+ packet->mss = skb_shinfo(skb)->gso_size; -+ } -+ -+ if (skb_headlen(skb) < hdrlen) { -+ dev_err(pdata->dev, "Error - LSO headers fragmented!!!\n"); -+ return NETDEV_TX_BUSY; -+ } -+ } else { -+ hdrlen = min(skb_headlen(skb), pdata->max_tx_length); -+ packet->lso = 0; -+ packet->mss = 0; -+ } -+ -+ packet->hdrlen = hdrlen; -+ -+ if (is_lso && (skb_headlen(skb) > hdrlen)) -+ desc_cnt = TXD_USE_COUNT(pdata, (skb_headlen(skb) - hdrlen)) + 1; -+ else -+ desc_cnt = TXD_USE_COUNT(pdata, hdrlen); -+ -+ for (f = 0; f < skb_shinfo(skb)->nr_frags; f++) -+ desc_cnt += TXD_USE_COUNT(pdata, skb_frag_size(&skb_shinfo(skb)->frags[f])); -+ packet->desc_cnt = desc_cnt; -+ -+ if ((!(pdata->ndev->features & NETIF_F_HW_CSUM)) && -+ skb->ip_summed != CHECKSUM_PARTIAL && -+ !is_lso && -+ !phytmac_ptp_one_step(skb)) -+ packet->nocrc = 1; -+ else -+ packet->nocrc = 0; -+ -+ if (netif_msg_pktdata(pdata)) { -+ netdev_info(pdata->ndev, "packet info: desc_cnt=%d, nocrc=%d,ip_summed=%d\n", -+ desc_cnt, packet->nocrc, skb->ip_summed); -+ netdev_info(pdata->ndev, "packet info: mss=%d, lso=%d,skb_len=%d, nr_frags=%d\n", -+ packet->mss, packet->lso, skb->len, skb_shinfo(skb)->nr_frags); -+ } -+ -+ return 0; -+} -+ -+static unsigned int phytmac_tx_map(struct phytmac *pdata, -+ struct phytmac_queue *queue, -+ struct sk_buff *skb, -+ struct packet_info *packet) -+{ -+ dma_addr_t mapping; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ unsigned int len, i, tx_tail = queue->tx_tail; -+ struct phytmac_tx_skb *tx_skb = NULL; -+ unsigned int offset, size, count = 0; -+ unsigned int f, nr_frags = skb_shinfo(skb)->nr_frags; -+ -+ len = skb_headlen(skb); -+ size = packet->hdrlen; -+ -+ offset = 0; -+ tx_tail = queue->tx_tail; -+ while (len) { -+ tx_skb = phytmac_get_tx_skb(queue, tx_tail); -+ -+ mapping = dma_map_single(pdata->dev, -+ skb->data + offset, -+ size, DMA_TO_DEVICE); -+ if (dma_mapping_error(pdata->dev, mapping)) -+ goto dma_error; -+ -+ /* Save info to properly release resources */ -+ tx_skb->skb = NULL; -+ tx_skb->addr = mapping; -+ tx_skb->length = size; -+ tx_skb->mapped_as_page = false; -+ -+ len -= size; -+ offset += size; -+ count++; -+ tx_tail++; -+ -+ size = min(len, pdata->max_tx_length); -+ } -+ -+ /* Then, map paged data from fragments */ -+ for (f = 0; f < nr_frags; f++) { -+ const skb_frag_t *frag = &skb_shinfo(skb)->frags[f]; -+ -+ len = skb_frag_size(frag); -+ offset = 0; -+ while (len) { -+ size = min(len, pdata->max_tx_length); -+ tx_skb = phytmac_get_tx_skb(queue, tx_tail); -+ mapping = skb_frag_dma_map(pdata->dev, frag, -+ offset, size, DMA_TO_DEVICE); -+ if (dma_mapping_error(pdata->dev, mapping)) -+ goto dma_error; -+ -+ /* Save info to properly release resources */ -+ tx_skb->skb = NULL; -+ tx_skb->addr = mapping; -+ tx_skb->length = size; -+ tx_skb->mapped_as_page = true; -+ -+ len -= size; -+ offset += size; -+ count++; -+ tx_tail++; -+ } -+ } -+ -+ /* Should never happen */ -+ if (unlikely(!tx_skb)) { -+ netdev_err(pdata->ndev, "BUG! empty skb!\n"); -+ return 0; -+ } -+ -+ /* This is the last buffer of the frame: save socket buffer */ -+ tx_skb->skb = skb; -+ -+ if (hw_if->tx_map(queue, tx_tail, packet)) { -+ netdev_err(pdata->ndev, "BUG!hw tx map failed!\n"); -+ return 0; -+ } -+ -+ queue->tx_tail = tx_tail & (pdata->tx_ring_size - 1); -+ -+ return count; -+ -+dma_error: -+ netdev_err(pdata->ndev, "TX DMA map failed\n"); -+ -+ for (i = queue->tx_tail; i != tx_tail; i++) { -+ tx_skb = phytmac_get_tx_skb(queue, i); -+ phytmac_tx_unmap(pdata, tx_skb, 0); -+ } -+ -+ return 0; -+} -+ -+static inline void phytmac_init_ring(struct phytmac *pdata) -+{ -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct phytmac_queue *queue; -+ unsigned int q = 0; -+ -+ for (queue = pdata->queues; q < pdata->queues_num; ++q) { -+ queue->tx_head = 0; -+ queue->tx_tail = 0; -+ hw_if->clear_tx_desc(queue); -+ -+ queue->rx_head = 0; -+ queue->rx_tail = 0; -+ phytmac_rx_clean(queue); -+ ++queue; -+ } -+ -+ hw_if->init_ring_hw(pdata); -+} -+ -+static netdev_tx_t phytmac_start_xmit(struct sk_buff *skb, struct net_device *ndev) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ u16 queue_index = skb->queue_mapping; -+ struct phytmac_queue *queue = &pdata->queues[queue_index]; -+ netdev_tx_t ret = NETDEV_TX_OK; -+ struct packet_info packet; -+ unsigned long flags; -+ -+ if (phytmac_clear_csum(skb)) { -+ dev_kfree_skb_any(skb); -+ return ret; -+ } -+ -+ if (phytmac_add_fcs(&skb, ndev)) { -+ dev_kfree_skb_any(skb); -+ return ret; -+ } -+ -+ ret = phytmac_packet_info(pdata, queue, skb, &packet); -+ if (ret) { -+ dev_kfree_skb_any(skb); -+ return ret; -+ } -+ -+ if (netif_msg_pktdata(pdata)) -+ phytmac_dump_pkt(pdata, skb, true); -+ -+ spin_lock_irqsave(&pdata->lock, flags); -+ /* Check that there are enough descriptors available */ -+ ret = phytmac_maybe_stop_tx_queue(queue, packet.desc_cnt); -+ if (ret) -+ goto tx_return; -+ -+ /* Map socket buffer for DMA transfer */ -+ if (!phytmac_tx_map(pdata, queue, skb, &packet)) { -+ dev_kfree_skb_any(skb); -+ goto tx_return; -+ } -+ -+ skb_tx_timestamp(skb); -+ /* Make newly descriptor to hardware */ -+ wmb(); -+ -+ hw_if->transmit(queue); -+ -+tx_return: -+ spin_unlock_irqrestore(&pdata->lock, flags); -+ return ret; -+} -+ -+static int phytmac_phylink_connect(struct phytmac *pdata) -+{ -+ struct net_device *ndev = pdata->ndev; -+ struct phy_device *phydev; -+ struct fwnode_handle *fwnode = dev_fwnode(pdata->dev); -+ int ret = 0; -+ -+ if (fwnode) -+ ret = phylink_fwnode_phy_connect(pdata->phylink, fwnode, 0); -+ -+ if (!fwnode || ret) { -+ if (pdata->mii_bus) { -+ phydev = phy_find_first(pdata->mii_bus); -+ if (!phydev) { -+ dev_err(pdata->dev, "no PHY found\n"); -+ return -ENXIO; -+ } -+ /* attach the mac to the phy */ -+ ret = phylink_connect_phy(pdata->phylink, phydev); -+ } else { -+ netdev_err(ndev, "Not mii register\n"); -+ return -ENXIO; -+ } -+ } -+ -+ if (ret) { -+ netdev_err(ndev, "Could not attach PHY (%d)\n", ret); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+int phytmac_pcs_config(struct phylink_pcs *pcs, unsigned int mode, -+ phy_interface_t interface, -+ const unsigned long *advertising, -+ bool permit_pause_to_mac) -+{ -+ return 0; -+} -+ -+void phytmac_pcs_link_up(struct phylink_pcs *pcs, unsigned int mode, -+ phy_interface_t interface, int speed, int duplex) -+{ -+ struct phytmac *pdata = container_of(pcs, struct phytmac, phylink_pcs); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ -+ if (netif_msg_link(pdata)) -+ netdev_info(pdata->ndev, "pcs link up, interface = %s, speed = %d, duplex = %d\n", -+ phy_modes(interface), speed, duplex); -+ hw_if->pcs_linkup(pdata, interface, speed, duplex); -+} -+ -+static const struct phylink_pcs_ops phytmac_pcs_phylink_ops = { -+ .pcs_config = phytmac_pcs_config, -+ .pcs_link_up = phytmac_pcs_link_up, -+}; -+ -+static struct phylink_pcs *phytmac_mac_select_pcs(struct phylink_config *config, -+ phy_interface_t interface) -+{ -+ struct phytmac *pdata = netdev_priv(to_net_dev(config->dev)); -+ -+ if (interface == PHY_INTERFACE_MODE_USXGMII || -+ interface == PHY_INTERFACE_MODE_10GBASER || -+ interface == PHY_INTERFACE_MODE_SGMII || -+ interface == PHY_INTERFACE_MODE_1000BASEX || -+ interface == PHY_INTERFACE_MODE_2500BASEX) { -+ pdata->phylink_pcs.ops = &phytmac_pcs_phylink_ops; -+ } else { -+ pdata->phylink_pcs.ops = NULL; -+ } -+ -+ return &pdata->phylink_pcs; -+} -+ -+static void phytmac_mac_config(struct phylink_config *config, unsigned int mode, -+ const struct phylink_link_state *state) -+{ -+ struct phytmac *pdata = netdev_priv(to_net_dev(config->dev)); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ unsigned long flags; -+ -+ if (netif_msg_link(pdata)) { -+ netdev_info(pdata->ndev, "mac config interface=%s, mode=%d\n", -+ phy_modes(state->interface), mode); -+ } -+ -+ spin_lock_irqsave(&pdata->lock, flags); -+ hw_if->mac_config(pdata, mode, state); -+ spin_unlock_irqrestore(&pdata->lock, flags); -+} -+ -+static void phytmac_mac_link_down(struct phylink_config *config, unsigned int mode, -+ phy_interface_t interface) -+{ -+ struct net_device *ndev = to_net_dev(config->dev); -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct phytmac_queue *queue; -+ unsigned int q; -+ unsigned long flags; -+ struct phytmac_tx_skb *tx_skb; -+ int i; -+ -+ if (netif_msg_link(pdata)) { -+ netdev_info(ndev, "link down interface:%s, mode=%d\n", -+ phy_modes(interface), mode); -+ } -+ -+ if (pdata->use_ncsi) -+ ncsi_stop_dev(pdata->ncsidev); -+ -+ spin_lock_irqsave(&pdata->lock, flags); -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { -+ hw_if->disable_irq(pdata, queue->index, pdata->rx_irq_mask | pdata->tx_irq_mask); -+ hw_if->clear_irq(pdata, queue->index, pdata->rx_irq_mask | pdata->tx_irq_mask); -+ } -+ -+ /* Disable Rx and Tx */ -+ hw_if->enable_network(pdata, false, PHYTMAC_RX | PHYTMAC_TX); -+ -+ /* Tx clean */ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { -+ for (i = 0; i < pdata->tx_ring_size; i++) { -+ tx_skb = phytmac_get_tx_skb(queue, i); -+ if (tx_skb) -+ phytmac_tx_unmap(pdata, tx_skb, 0); -+ } -+ } -+ -+ spin_unlock_irqrestore(&pdata->lock, flags); -+ -+ netif_tx_stop_all_queues(ndev); -+} -+ -+static void phytmac_mac_link_up(struct phylink_config *config, -+ struct phy_device *phy, -+ unsigned int mode, phy_interface_t interface, -+ int speed, int duplex, -+ bool tx_pause, bool rx_pause) -+{ -+ struct net_device *ndev = to_net_dev(config->dev); -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct phytmac_queue *queue; -+ unsigned long flags; -+ unsigned int q; -+ int ret; -+ -+ if (netif_msg_link(pdata)) -+ netdev_info(pdata->ndev, "link up interface:%s, speed:%d, duplex:%s\n", -+ phy_modes(interface), speed, duplex ? "full-duplex" : "half-duplex"); -+ -+ spin_lock_irqsave(&pdata->lock, flags); -+ -+ hw_if->mac_linkup(pdata, interface, speed, duplex); -+ -+ if (rx_pause != pdata->pause) { -+ hw_if->enable_pause(pdata, rx_pause); -+ pdata->pause = rx_pause; -+ } -+ -+ phytmac_init_ring(pdata); -+ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) -+ hw_if->enable_irq(pdata, queue->index, pdata->rx_irq_mask | pdata->tx_irq_mask); -+ -+ /* Enable Rx and Tx */ -+ hw_if->enable_network(pdata, true, PHYTMAC_RX | PHYTMAC_TX); -+ spin_unlock_irqrestore(&pdata->lock, flags); -+ -+ if (pdata->use_ncsi) { -+ /* Start the NCSI device */ -+ ret = ncsi_start_dev(pdata->ncsidev); -+ if (ret) { -+ netdev_err(pdata->ndev, "Ncsi start dev failed (error %d)\n", ret); -+ return; -+ } -+ } -+ -+ netif_tx_wake_all_queues(ndev); -+} -+ -+int phytmac_mdio_register(struct phytmac *pdata) -+{ -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ int ret; -+ -+ pdata->mii_bus = mdiobus_alloc(); -+ if (!pdata->mii_bus) { -+ ret = -ENOMEM; -+ goto err_out; -+ } -+ -+ pdata->mii_bus->name = "phytmac_mii_bus"; -+ pdata->mii_bus->read = &phytmac_mdio_read_c22; -+ pdata->mii_bus->write = &phytmac_mdio_write_c22; -+ pdata->mii_bus->read_c45 = &phytmac_mdio_read_c45; -+ pdata->mii_bus->write_c45 = &phytmac_mdio_write_c45; -+ -+ if (pdata->platdev) { -+ snprintf(pdata->mii_bus->id, MII_BUS_ID_SIZE, "%s-%s", -+ pdata->mii_bus->name, pdata->platdev->name); -+ } else if (pdata->pcidev) { -+ snprintf(pdata->mii_bus->id, MII_BUS_ID_SIZE, "%s-%s", -+ pdata->mii_bus->name, pci_name(pdata->pcidev)); -+ } else { -+ ret = -ENOMEM; -+ goto free_mdio; -+ } -+ -+ pdata->mii_bus->priv = pdata; -+ pdata->mii_bus->parent = pdata->dev; -+ -+ hw_if->enable_mdio_control(pdata, 1); -+ -+ return mdiobus_register(pdata->mii_bus); -+free_mdio: -+ mdiobus_free(pdata->mii_bus); -+ pdata->mii_bus = NULL; -+ -+err_out: -+ return ret; -+} -+ -+static void phytmac_pcs_get_state(struct phylink_config *config, -+ struct phylink_link_state *state) -+{ -+ struct phytmac *pdata = container_of(config, struct phytmac, phylink_config); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ -+ state->link = hw_if->get_link(pdata, state->interface); -+} -+ -+static void phytmac_validate(struct phylink_config *config, -+ unsigned long *supported, -+ struct phylink_link_state *state) -+{ -+ struct net_device *ndev = to_net_dev(config->dev); -+ __ETHTOOL_DECLARE_LINK_MODE_MASK(mask) = { 0, }; -+ struct phytmac *pdata = netdev_priv(ndev); -+ -+ if (state->interface != PHY_INTERFACE_MODE_SGMII && -+ state->interface != PHY_INTERFACE_MODE_1000BASEX && -+ state->interface != PHY_INTERFACE_MODE_2500BASEX && -+ state->interface != PHY_INTERFACE_MODE_5GBASER && -+ state->interface != PHY_INTERFACE_MODE_10GBASER && -+ state->interface != PHY_INTERFACE_MODE_USXGMII && -+ !phy_interface_mode_is_rgmii(state->interface)) { -+ bitmap_zero(supported, __ETHTOOL_LINK_MODE_MASK_NBITS); -+ return; -+ } -+ -+ phylink_set_port_modes(mask); -+ phylink_set(mask, Autoneg); -+ phylink_set(mask, Asym_Pause); -+ -+ if (state->interface == PHY_INTERFACE_MODE_10GBASER || -+ state->interface == PHY_INTERFACE_MODE_USXGMII) { -+ pdata->speed = state->speed; -+ pdata->duplex = state->duplex; -+ if (pdata->speed == SPEED_5000) { -+ phylink_set(mask, 5000baseT_Full); -+ } else { -+ phylink_set(mask, 10000baseCR_Full); -+ phylink_set(mask, 10000baseER_Full); -+ phylink_set(mask, 10000baseKR_Full); -+ phylink_set(mask, 10000baseLR_Full); -+ phylink_set(mask, 10000baseLRM_Full); -+ phylink_set(mask, 10000baseSR_Full); -+ phylink_set(mask, 10000baseT_Full); -+ } -+ } -+ -+ if (state->interface == PHY_INTERFACE_MODE_2500BASEX) -+ phylink_set(mask, 2500baseX_Full); -+ -+ if (state->interface == PHY_INTERFACE_MODE_5GBASER) -+ phylink_set(mask, 5000baseT_Full); -+ -+ if (state->interface == PHY_INTERFACE_MODE_1000BASEX || -+ state->interface == PHY_INTERFACE_MODE_SGMII || -+ phy_interface_mode_is_rgmii(state->interface)) { -+ phylink_set(mask, 1000baseT_Full); -+ phylink_set(mask, 1000baseX_Full); -+ phylink_set(mask, 1000baseT_Half); -+ phylink_set(mask, 10baseT_Half); -+ phylink_set(mask, 10baseT_Full); -+ phylink_set(mask, 100baseT_Half); -+ phylink_set(mask, 100baseT_Full); -+ } -+ -+ bitmap_and(supported, supported, mask, __ETHTOOL_LINK_MODE_MASK_NBITS); -+ bitmap_and(state->advertising, state->advertising, mask, -+ __ETHTOOL_LINK_MODE_MASK_NBITS); -+} -+ -+static const struct phylink_mac_ops phytmac_phylink_ops = { -+ .validate = phytmac_validate, -+ .mac_select_pcs = phytmac_mac_select_pcs, -+ .mac_config = phytmac_mac_config, -+ .mac_link_down = phytmac_mac_link_down, -+ .mac_link_up = phytmac_mac_link_up, -+}; -+ -+static inline void set_phy_interface(unsigned long *intf) -+{ -+ __set_bit(PHY_INTERFACE_MODE_SGMII, intf); -+ __set_bit(PHY_INTERFACE_MODE_1000BASEX, intf); -+ __set_bit(PHY_INTERFACE_MODE_2500BASEX, intf); -+ __set_bit(PHY_INTERFACE_MODE_USXGMII, intf); -+ __set_bit(PHY_INTERFACE_MODE_10GBASER, intf); -+} -+ -+static int phytmac_phylink_create(struct phytmac *pdata) -+{ -+ struct fwnode_handle *fw_node = dev_fwnode(pdata->dev); -+ -+ pdata->phylink_config.dev = &pdata->ndev->dev; -+ pdata->phylink_config.type = PHYLINK_NETDEV; -+ if (pdata->phy_interface == PHY_INTERFACE_MODE_SGMII || -+ pdata->phy_interface == PHY_INTERFACE_MODE_1000BASEX || -+ pdata->phy_interface == PHY_INTERFACE_MODE_2500BASEX || -+ pdata->phy_interface == PHY_INTERFACE_MODE_USXGMII || -+ pdata->phy_interface == PHY_INTERFACE_MODE_10GBASER) { -+ pdata->phylink_config.poll_fixed_state = true; -+ pdata->phylink_config.get_fixed_state = phytmac_pcs_get_state; -+ pdata->phylink_pcs.ops = &phytmac_pcs_phylink_ops; -+ } -+ -+ set_phy_interface(pdata->phylink_config.supported_interfaces); -+ pdata->phylink = phylink_create(&pdata->phylink_config, fw_node, -+ pdata->phy_interface, &phytmac_phylink_ops); -+ if (IS_ERR(pdata->phylink)) { -+ dev_err(pdata->dev, "Could not create a phylink instance (%ld)\n", -+ PTR_ERR(pdata->phylink)); -+ return PTR_ERR(pdata->phylink); -+ } -+ -+ return 0; -+} -+ -+static int phytmac_open(struct net_device *ndev) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_queue *queue; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ unsigned int q = 0; -+ int ret; -+ -+ if (netif_msg_probe(pdata)) -+ dev_dbg(pdata->dev, "open\n"); -+ -+ /* phytmac_powerup */ -+ if (pdata->power_state == PHYTMAC_POWEROFF) -+ hw_if->poweron(pdata, PHYTMAC_POWERON); -+ -+ if (hw_if->init_msg_ring) -+ hw_if->init_msg_ring(pdata); -+ -+ ret = hw_if->get_feature(pdata); -+ if (ret) { -+ netdev_err(ndev, "phytmac get features failed\n"); -+ return ret; -+ } -+ -+ hw_if->reset_hw(pdata); -+ -+ ret = phytmac_get_mac_address(pdata); -+ if (ret) { -+ netdev_err(ndev, "phytmac get mac address failed\n"); -+ goto reset_hw; -+ } -+ -+ ret = netif_set_real_num_tx_queues(ndev, pdata->queues_num); -+ if (ret) { -+ netdev_err(ndev, "error setting real tx queue number\n"); -+ return ret; -+ } -+ ret = netif_set_real_num_rx_queues(ndev, pdata->queues_num); -+ if (ret) { -+ netdev_err(ndev, "error setting real tx queue number\n"); -+ return ret; -+ } -+ -+ /* RX buffers initialization */ -+ ret = phytmac_alloc_resource(pdata); -+ if (ret) { -+ netdev_err(ndev, "Unable to allocate DMA memory (error %d)\n", -+ ret); -+ goto reset_hw; -+ } -+ -+ for (queue = pdata->queues; q < pdata->queues_num; ++q) { -+ napi_enable(&queue->tx_napi); -+ napi_enable(&queue->rx_napi); -+ ++queue; -+ } -+ -+ phytmac_init_ring(pdata); -+ hw_if->init_hw(pdata); -+ -+ ret = phytmac_phylink_connect(pdata); -+ if (ret) { -+ netdev_err(ndev, "phylink connet failed,(error %d)\n", -+ ret); -+ goto reset_hw; -+ } -+ -+ phylink_start(pdata->phylink); -+ -+ netif_tx_start_all_queues(pdata->ndev); -+ -+ if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) { -+ ret = phytmac_ptp_register(pdata); -+ if (ret) { -+ netdev_err(ndev, "ptp register failed, (error %d)\n", -+ ret); -+ goto reset_hw; -+ } -+ -+ phytmac_ptp_init(pdata->ndev); -+ } -+ -+ return 0; -+ -+reset_hw: -+ hw_if->reset_hw(pdata); -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q) { -+ napi_disable(&queue->tx_napi); -+ napi_disable(&queue->rx_napi); -+ ++queue; -+ } -+ phytmac_free_resource(pdata); -+ return ret; -+} -+ -+static int phytmac_close(struct net_device *ndev) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_queue *queue; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ unsigned long flags; -+ unsigned int q; -+ -+ if (netif_msg_probe(pdata)) -+ dev_dbg(pdata->dev, "close"); -+ -+ netif_tx_stop_all_queues(ndev); -+ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { -+ napi_disable(&queue->tx_napi); -+ napi_disable(&queue->rx_napi); -+ } -+ -+ phylink_stop(pdata->phylink); -+ phylink_disconnect_phy(pdata->phylink); -+ -+ netif_carrier_off(ndev); -+ -+ spin_lock_irqsave(&pdata->lock, flags); -+ hw_if->reset_hw(pdata); -+ spin_unlock_irqrestore(&pdata->lock, flags); -+ -+ phytmac_free_resource(pdata); -+ -+ if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) -+ phytmac_ptp_unregister(pdata); -+ -+ /* phytmac_powerup */ -+ if (pdata->power_state == PHYTMAC_POWERON) -+ hw_if->poweron(pdata, PHYTMAC_POWEROFF); -+ -+ return 0; -+} -+ -+static int phytmac_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) -+{ -+ struct phytmac *pdata = netdev_priv(dev); -+ int ret; -+ -+ if (!netif_running(dev)) -+ return -EINVAL; -+ -+ switch (cmd) { -+ case SIOCGMIIPHY: -+ case SIOCGMIIREG: -+ case SIOCSMIIREG: -+ ret = phylink_mii_ioctl(pdata->phylink, rq, cmd); -+ break; -+#ifdef CONFIG_PHYTMAC_ENABLE_PTP -+ case SIOCSHWTSTAMP: -+ ret = phytmac_ptp_set_ts_config(dev, rq, cmd); -+ break; -+ case SIOCGHWTSTAMP: -+ ret = phytmac_ptp_get_ts_config(dev, rq); -+ break; -+#endif -+ default: -+ break; -+ } -+ -+ return ret; -+} -+ -+static inline int phytmac_set_features(struct net_device *netdev, -+ netdev_features_t features) -+{ -+ struct phytmac *pdata = netdev_priv(netdev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ netdev_features_t changed = features ^ netdev->features; -+ -+ /* TX checksum offload */ -+ if (changed & NETIF_F_HW_CSUM) { -+ if (features & NETIF_F_HW_CSUM) -+ hw_if->enable_tx_csum(pdata, 1); -+ else -+ hw_if->enable_tx_csum(pdata, 0); -+ } -+ -+ /* RX checksum offload */ -+ if (changed & NETIF_F_RXCSUM) { -+ if (features & NETIF_F_RXCSUM && -+ !(netdev->flags & IFF_PROMISC)) -+ hw_if->enable_rx_csum(pdata, 1); -+ else -+ hw_if->enable_rx_csum(pdata, 0); -+ } -+ return 0; -+} -+ -+static netdev_features_t phytmac_features_check(struct sk_buff *skb, -+ struct net_device *dev, -+ netdev_features_t features) -+{ -+ unsigned int nr_frags, f; -+ unsigned int hdrlen; -+ -+ /* there is only one buffer or protocol is not UDP */ -+ if (!skb_is_nonlinear(skb) || (ip_hdr(skb)->protocol != IPPROTO_UDP)) -+ return features; -+ -+ /* length of header */ -+ hdrlen = skb_transport_offset(skb); -+ -+ if (!IS_ALIGNED(skb_headlen(skb) - hdrlen, PHYTMAC_TX_LEN_ALIGN)) -+ return features & ~NETIF_F_TSO; -+ -+ nr_frags = skb_shinfo(skb)->nr_frags; -+ /* No need to check last fragment */ -+ nr_frags--; -+ for (f = 0; f < nr_frags; f++) { -+ const skb_frag_t *frag = &skb_shinfo(skb)->frags[f]; -+ -+ if (!IS_ALIGNED(skb_frag_size(frag), PHYTMAC_TX_LEN_ALIGN)) -+ return features & ~NETIF_F_TSO; -+ } -+ return features; -+} -+ -+int phytmac_reset_ringsize(struct phytmac *pdata, u32 rx_size, u32 tx_size) -+{ -+ int ret = 0; -+ int reset = 0; -+ -+ if (netif_running(pdata->ndev)) { -+ reset = 1; -+ phytmac_close(pdata->ndev); -+ } -+ -+ pdata->rx_ring_size = rx_size; -+ pdata->tx_ring_size = tx_size; -+ -+ if (reset) -+ phytmac_open(pdata->ndev); -+ -+ return ret; -+} -+ -+static const struct net_device_ops phytmac_netdev_ops = { -+ .ndo_open = phytmac_open, -+ .ndo_stop = phytmac_close, -+ .ndo_start_xmit = phytmac_start_xmit, -+ .ndo_set_rx_mode = phytmac_set_rx_mode, -+ .ndo_get_stats = phytmac_get_stats, -+ .ndo_eth_ioctl = phytmac_ioctl, -+ .ndo_validate_addr = eth_validate_addr, -+ .ndo_change_mtu = phytmac_change_mtu, -+ .ndo_set_mac_address = phytmac_set_mac_address, -+ .ndo_set_features = phytmac_set_features, -+ .ndo_features_check = phytmac_features_check, -+ .ndo_vlan_rx_add_vid = ncsi_vlan_rx_add_vid, -+ .ndo_vlan_rx_kill_vid = ncsi_vlan_rx_kill_vid, -+}; -+ -+static int phytmac_init(struct phytmac *pdata) -+{ -+ struct net_device *ndev = pdata->ndev; -+ unsigned int q; -+ struct phytmac_queue *queue; -+ int ret; -+ -+ if (netif_msg_probe(pdata)) -+ dev_dbg(pdata->dev, "phytmac init !\n"); -+ -+ spin_lock_init(&pdata->lock); -+ -+ /* set the queue register mapping once for all: queue0 has a special -+ * register mapping but we don't want to test the queue index then -+ * compute the corresponding register offset at run time. -+ */ -+ for (q = 0; q < pdata->queues_num; ++q) { -+ queue = &pdata->queues[q]; -+ queue->pdata = pdata; -+ queue->index = q; -+ spin_lock_init(&queue->tx_lock); -+ -+ netif_napi_add(ndev, &queue->tx_napi, phytmac_tx_poll); -+ netif_napi_add(ndev, &queue->rx_napi, phytmac_rx_poll); -+ -+ if (pdata->irq_type == IRQ_TYPE_INT || pdata->irq_type == IRQ_TYPE_MSI) { -+ queue->irq = pdata->queue_irq[q]; -+ if (pdata->irq_type == IRQ_TYPE_INT) -+ ret = devm_request_irq(pdata->dev, queue->irq, phytmac_irq, -+ IRQF_SHARED, ndev->name, queue); -+ else -+ ret = devm_request_irq(pdata->dev, queue->irq, phytmac_irq, -+ 0, ndev->name, queue); -+ -+ if (ret) { -+ dev_err(pdata->dev, -+ "Unable to request IRQ %d (error %d)\n", -+ queue->irq, ret); -+ return ret; -+ } -+ } -+ } -+ -+ if (pdata->irq_type == IRQ_TYPE_INTX) { -+ ret = devm_request_irq(pdata->dev, pdata->queue_irq[0], phytmac_intx_irq, -+ IRQF_SHARED, ndev->name, pdata); -+ if (ret) { -+ dev_err(pdata->dev, -+ "Unable to request INTX IRQ %d (error %d)\n", -+ pdata->queue_irq[0], ret); -+ return ret; -+ } -+ } -+ -+ ndev->netdev_ops = &phytmac_netdev_ops; -+ phytmac_set_ethtool_ops(ndev); -+ eth_hw_addr_random(pdata->ndev); -+ -+ if (ndev->hw_features & NETIF_F_NTUPLE) { -+ INIT_LIST_HEAD(&pdata->rx_fs_list.list); -+ pdata->rx_fs_list.count = 0; -+ spin_lock_init(&pdata->rx_fs_lock); -+ } -+ -+ device_set_wakeup_enable(pdata->dev, pdata->wol ? 1 : 0); -+ -+ return 0; -+} -+ -+void phytmac_default_config(struct phytmac *pdata) -+{ -+ struct net_device *ndev = pdata->ndev; -+ -+ pdata->rx_irq_mask = PHYTMAC_RX_INT_FLAGS; -+ pdata->tx_irq_mask = PHYTMAC_TX_INT_FLAGS; -+ pdata->tx_ring_size = DEFAULT_TX_RING_SIZE; -+ pdata->rx_ring_size = DEFAULT_RX_RING_SIZE; -+ pdata->max_tx_length = PHYTMAC_MAX_TX_LEN; -+ pdata->min_tx_length = PHYTMAC_MIN_TX_LEN; -+ pdata->pause = true; -+ -+ ndev->hw_features = NETIF_F_SG; -+ -+ if (pdata->capacities & PHYTMAC_CAPS_LSO) -+ ndev->hw_features |= NETIF_F_TSO; -+ -+ if (pdata->use_ncsi) { -+ ndev->hw_features &= ~(NETIF_F_HW_CSUM | NETIF_F_RXCSUM); -+ ndev->hw_features |= NETIF_F_HW_VLAN_CTAG_FILTER; -+ } else { -+ ndev->hw_features |= NETIF_F_HW_CSUM | NETIF_F_RXCSUM; -+ } -+ -+ if (pdata->capacities & PHYTMAC_CAPS_SG_DISABLED) -+ ndev->hw_features &= ~NETIF_F_SG; -+ -+ ndev->hw_features |= NETIF_F_NTUPLE; -+ -+ ndev->min_mtu = ETH_MIN_MTU; -+ if (pdata->capacities & PHYTMAC_CAPS_JUMBO) -+ ndev->max_mtu = pdata->jumbo_len - ETH_HLEN - ETH_FCS_LEN; -+ else -+ ndev->max_mtu = ETH_DATA_LEN; -+ -+ ndev->features = ndev->hw_features; -+} -+ -+static void phytmac_ncsi_handler(struct ncsi_dev *nd) -+{ -+ if (unlikely(nd->state != ncsi_dev_state_functional)) -+ return; -+ -+ netdev_dbg(nd->dev, "NCSI interface %s\n", -+ nd->link_up ? "up" : "down"); -+} -+ -+int phytmac_drv_probe(struct phytmac *pdata) -+{ -+ struct net_device *ndev = pdata->ndev; -+ struct device *dev = pdata->dev; -+ int ret = 0; -+ -+ if (netif_msg_probe(pdata)) -+ dev_dbg(pdata->dev, "phytmac drv probe start\n"); -+ -+ phytmac_default_config(pdata); -+ -+ if (dma_set_mask(dev, DMA_BIT_MASK(40)) || -+ dma_set_mask_and_coherent(dev, DMA_BIT_MASK(40))) { -+ dev_err(dev, "dma_set_mask or coherent failed\n"); -+ return 1; -+ } -+ -+ ret = phytmac_init(pdata); -+ if (ret) -+ goto err_out; -+ -+ if (pdata->use_ncsi) { -+ pdata->ncsidev = ncsi_register_dev(ndev, phytmac_ncsi_handler); -+ if (!pdata->ncsidev) -+ goto err_out; -+ } -+ -+ netif_carrier_off(ndev); -+ ret = register_netdev(ndev); -+ if (ret) { -+ dev_err(pdata->dev, "Cannot register net device, aborting.\n"); -+ goto err_out; -+ } -+ -+ if (pdata->use_mii && !pdata->mii_bus) { -+ ret = phytmac_mdio_register(pdata); -+ if (ret) { -+ netdev_err(ndev, "MDIO bus registration failed\n"); -+ goto err_out_free_mdiobus; -+ } -+ } -+ -+ ret = phytmac_phylink_create(pdata); -+ if (ret) { -+ netdev_err(ndev, "phytmac phylink create failed, error %d\n", ret); -+ goto err_phylink_init; -+ } -+ -+ if (netif_msg_probe(pdata)) -+ dev_dbg(pdata->dev, "probe successfully! Phytium %s at 0x%08lx irq %d (%pM)\n", -+ "MAC", ndev->base_addr, ndev->irq, ndev->dev_addr); -+ -+ return 0; -+ -+err_phylink_init: -+ if (pdata->mii_bus) -+ mdiobus_unregister(pdata->mii_bus); -+ -+err_out_free_mdiobus: -+ if (pdata->mii_bus) -+ mdiobus_free(pdata->mii_bus); -+ -+ unregister_netdev(ndev); -+ -+err_out: -+ return ret; -+} -+EXPORT_SYMBOL_GPL(phytmac_drv_probe); -+ -+int phytmac_drv_remove(struct phytmac *pdata) -+{ -+ struct net_device *ndev = pdata->ndev; -+ -+ if (ndev) { -+ if (pdata->use_ncsi && pdata->ncsidev) -+ ncsi_unregister_dev(pdata->ncsidev); -+ -+ unregister_netdev(ndev); -+ -+ if (pdata->use_mii && pdata->mii_bus) { -+ mdiobus_unregister(pdata->mii_bus); -+ mdiobus_free(pdata->mii_bus); -+ } -+ -+ if (pdata->phylink) -+ phylink_destroy(pdata->phylink); -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytmac_drv_remove); -+ -+int phytmac_drv_suspend(struct phytmac *pdata) -+{ -+ int q; -+ unsigned long flags; -+ struct phytmac_queue *queue; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ -+ if (!netif_running(pdata->ndev)) -+ return 0; -+ -+ if (pdata->power_state == PHYTMAC_POWEROFF) -+ return 0; -+ -+ netif_carrier_off(pdata->ndev); -+ netif_device_detach(pdata->ndev); -+ -+ /* napi_disable */ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; -+ ++q, ++queue) { -+ napi_disable(&queue->tx_napi); -+ napi_disable(&queue->rx_napi); -+ } -+ -+ if (pdata->wol) { -+ hw_if->set_wol(pdata, pdata->wol); -+ } else { -+ rtnl_lock(); -+ phylink_stop(pdata->phylink); -+ rtnl_unlock(); -+ spin_lock_irqsave(&pdata->lock, flags); -+ hw_if->reset_hw(pdata); -+ hw_if->poweron(pdata, PHYTMAC_POWEROFF); -+ spin_unlock_irqrestore(&pdata->lock, flags); -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytmac_drv_suspend); -+ -+int phytmac_drv_resume(struct phytmac *pdata) -+{ -+ int q; -+ struct phytmac_queue *queue; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct ethtool_rx_fs_item *item; -+ -+ if (!netif_running(pdata->ndev)) -+ return 0; -+ -+ if (pdata->power_state == PHYTMAC_POWEROFF) -+ hw_if->poweron(pdata, PHYTMAC_POWERON); -+ -+ if (hw_if->init_msg_ring) -+ hw_if->init_msg_ring(pdata); -+ -+ if (pdata->wol) { -+ hw_if->set_wol(pdata, 0); -+ rtnl_lock(); -+ phylink_stop(pdata->phylink); -+ rtnl_unlock(); -+ } -+ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; -+ ++q, ++queue) { -+ napi_enable(&queue->tx_napi); -+ napi_enable(&queue->rx_napi); -+ } -+ -+ hw_if->init_hw(pdata); -+ phytmac_set_rx_mode(pdata->ndev); -+ phytmac_set_features(pdata->ndev, pdata->ndev->features); -+ list_for_each_entry(item, &pdata->rx_fs_list.list, list) -+ hw_if->add_fdir_entry(pdata, &item->fs); -+ -+ rtnl_lock(); -+ phylink_start(pdata->phylink); -+ rtnl_unlock(); -+ -+ netif_device_attach(pdata->ndev); -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytmac_drv_resume); -+ -+struct phytmac *phytmac_alloc_pdata(struct device *dev) -+{ -+ struct phytmac *pdata; -+ struct net_device *netdev; -+ -+ netdev = alloc_etherdev_mq(sizeof(struct phytmac), -+ PHYTMAC_MAX_QUEUES); -+ if (!netdev) { -+ dev_err(dev, "alloc_etherdev_mq failed\n"); -+ return ERR_PTR(-ENOMEM); -+ } -+ SET_NETDEV_DEV(netdev, dev); -+ pdata = netdev_priv(netdev); -+ pdata->ndev = netdev; -+ pdata->dev = dev; -+ -+ spin_lock_init(&pdata->lock); -+ spin_lock_init(&pdata->msg_lock); -+ spin_lock_init(&pdata->ts_clk_lock); -+ pdata->msg_enable = netif_msg_init(debug, PHYTMAC_DEFAULT_MSG_ENABLE); -+ -+ return pdata; -+} -+EXPORT_SYMBOL_GPL(phytmac_alloc_pdata); -+ -+void phytmac_free_pdata(struct phytmac *pdata) -+{ -+ struct net_device *netdev = pdata->ndev; -+ -+ free_netdev(netdev); -+} -+EXPORT_SYMBOL_GPL(phytmac_free_pdata); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium Ethernet driver"); -+MODULE_AUTHOR("Wenting Song"); -+MODULE_ALIAS("platform:phytmac"); -+ -diff --git a/drivers/net/ethernet/phytium/phytmac_pci.c b/drivers/net/ethernet/phytium/phytmac_pci.c -new file mode 100644 -index 000000000..fd21bf80f ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac_pci.c -@@ -0,0 +1,318 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+/* -+ * Phytium GMAC PCI wrapper. -+ * -+ */ -+ -+#include -+#include -+#include "phytmac.h" -+#include "phytmac_v1.h" -+#include "phytmac_v2.h" -+ -+#define PCI_DEVICE_ID_GMAC 0xDC3B -+#define PCI_SUBDEVICE_ID_SGMII 0x1000 -+#define PCI_SUBDEVICE_ID_1000BASEX 0x1001 -+#define PCI_SUBDEVICE_ID_2500BASEX 0x1002 -+#define PCI_SUBDEVICE_ID_5GBASER 0x1003 -+#define PCI_SUBDEVICE_ID_USXGMII 0x1004 -+#define PCI_SUBDEVICE_ID_10GBASER 0x1005 -+ -+struct phytmac_data { -+ struct phytmac_hw_if *hw_if; -+ u32 caps; -+ u32 tsu_rate; -+ u16 queue_num; -+ int speed; -+ bool duplex; -+ bool use_mii; -+ bool use_ncsi; -+ phy_interface_t interface; -+ const struct property_entry *properties; -+}; -+ -+static const u32 fixedlink[][5] = { -+ {0, 1, 1000, 1, 0}, -+ {0, 1, 2500, 1, 0}, -+ {0, 1, 5000, 1, 0}, -+ {0, 1, 10000, 1, 0}, -+}; -+ -+static const struct property_entry fl_properties[][2] = { -+ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[0]), {} }, -+ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[1]), {} }, -+ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[2]), {} }, -+ {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[3]), {} }, -+}; -+ -+static int phytmac_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) -+{ -+ struct phytmac_data *data = (struct phytmac_data *)id->driver_data; -+ struct phytmac *pdata; -+ struct device *dev = &pdev->dev; -+ void __iomem * const *iomap_table; -+ struct fwnode_handle *fw_node = NULL; -+ int bar_mask; -+ int ret, i; -+ -+ pdata = phytmac_alloc_pdata(dev); -+ if (IS_ERR(pdata)) { -+ ret = PTR_ERR(pdata); -+ goto err_alloc; -+ } -+ -+ pdata->pcidev = pdev; -+ pci_set_drvdata(pdev, pdata); -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) { -+ dev_err(dev, "pcim_enable_device failed\n"); -+ goto err_pci_enable; -+ } -+ -+ /* Obtain the mmio areas for the device */ -+ bar_mask = pci_select_bars(pdev, IORESOURCE_MEM); -+ ret = pcim_iomap_regions(pdev, bar_mask, PHYTMAC_DRV_NAME); -+ if (ret) { -+ dev_err(dev, "pcim_iomap_regions failed\n"); -+ goto err_pci_enable; -+ } -+ -+ iomap_table = pcim_iomap_table(pdev); -+ if (!iomap_table) { -+ dev_err(dev, "pcim_iomap_table failed\n"); -+ ret = -ENOMEM; -+ goto err_pci_enable; -+ } -+ -+ pdata->mac_regs = iomap_table[0]; -+ if (!pdata->mac_regs) { -+ dev_err(dev, "xgmac ioremap failed\n"); -+ ret = -ENOMEM; -+ goto err_pci_enable; -+ } -+ -+ pdata->msg_regs = iomap_table[1]; -+ if (!pdata->msg_regs) { -+ dev_err(dev, "xpcs ioremap failed\n"); -+ ret = -ENOMEM; -+ goto err_pci_enable; -+ } -+ -+ pci_set_master(pdev); -+ -+ /* para */ -+ pdata->dma_burst_length = DEFAULT_DMA_BURST_LENGTH; -+ pdata->jumbo_len = DEFAULT_DMA_BURST_LENGTH; -+ pdata->wol |= PHYTMAC_WAKE_MAGIC; -+ pdata->use_ncsi = data->use_ncsi; -+ pdata->use_mii = data->use_mii; -+ pdata->phy_interface = data->interface; -+ pdata->queues_num = data->queue_num; -+ pdata->capacities = data->caps; -+ pdata->hw_if = data->hw_if; -+ -+ if (!pdata->use_mii) { -+ fw_node = fwnode_create_software_node(data->properties, NULL); -+ if (IS_ERR(fw_node)) { -+ dev_err(dev, "Failed to create software node\n"); -+ goto err_pci_enable; -+ } -+ pdata->dev->fwnode = fw_node; -+ } -+ -+ /* irq */ -+ ret = pci_alloc_irq_vectors(pdev, pdata->queues_num, pdata->queues_num, PCI_IRQ_MSI); -+ if (ret < 0) { -+ pdata->irq_type = IRQ_TYPE_INTX; -+ pdata->queue_irq[0] = pdev->irq; -+ } else { -+ pdata->irq_type = IRQ_TYPE_MSI; -+ for (i = 0; i < pdata->queues_num; i++) -+ pdata->queue_irq[i] = pci_irq_vector(pdev, i); -+ } -+ -+ /* Configure the netdev resource */ -+ ret = phytmac_drv_probe(pdata); -+ if (ret) -+ goto err_irq_vectors; -+ -+ netdev_notice(pdata->ndev, "net device enabled\n"); -+ -+ return 0; -+ -+err_irq_vectors: -+ if (fw_node) -+ fwnode_remove_software_node(fw_node); -+ pci_free_irq_vectors(pdata->pcidev); -+ -+err_pci_enable: -+ phytmac_free_pdata(pdata); -+ -+err_alloc: -+ dev_notice(dev, "net device not enabled\n"); -+ -+ return ret; -+} -+ -+static void phytmac_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytmac *pdata = pci_get_drvdata(pdev); -+ struct fwnode_handle *fw_node = dev_fwnode(pdata->dev); -+ int i = 0; -+ int bar_mask; -+ -+ if (fw_node) { -+ fwnode_remove_software_node(fw_node); -+ pdata->dev->fwnode = NULL; -+ } -+ -+ phytmac_drv_remove(pdata); -+ -+ for (i = 0; i < pdata->queues_num; i++) -+ free_irq(pci_irq_vector(pdev, i), &pdata->queues[i]); -+ pci_free_irq_vectors(pdev); -+ -+ phytmac_free_pdata(pdata); -+ bar_mask = pci_select_bars(pdev, IORESOURCE_MEM); -+ pcim_iounmap_regions(pdev, bar_mask); -+ -+ pci_disable_device(pdev); -+} -+ -+static int __maybe_unused phytmac_pci_suspend(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytmac *pdata = pci_get_drvdata(pdev); -+ int ret; -+ -+ ret = phytmac_drv_suspend(pdata); -+ -+ return ret; -+} -+ -+static int __maybe_unused phytmac_pci_resume(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytmac *pdata = pci_get_drvdata(pdev); -+ int ret; -+ -+ ret = phytmac_drv_resume(pdata); -+ -+ return ret; -+} -+ -+struct phytmac_data phytmac_sgmii = { -+ .hw_if = &phytmac_1p0_hw, -+ .caps = PHYTMAC_CAPS_TAILPTR -+ | PHYTMAC_CAPS_START -+ | PHYTMAC_CAPS_JUMBO -+ | PHYTMAC_CAPS_LSO, -+ .queue_num = 4, -+ .use_ncsi = false, -+ .use_mii = true, -+ .interface = PHY_INTERFACE_MODE_SGMII, -+}; -+ -+struct phytmac_data phytmac_1000basex = { -+ .hw_if = &phytmac_1p0_hw, -+ .caps = PHYTMAC_CAPS_TAILPTR -+ | PHYTMAC_CAPS_START -+ | PHYTMAC_CAPS_JUMBO -+ | PHYTMAC_CAPS_LSO, -+ .queue_num = 4, -+ .use_ncsi = false, -+ .use_mii = false, -+ .speed = 1000, -+ .duplex = true, -+ .interface = PHY_INTERFACE_MODE_SGMII, -+ .properties = fl_properties[0], -+}; -+ -+struct phytmac_data phytmac_2500basex = { -+ .hw_if = &phytmac_1p0_hw, -+ .caps = PHYTMAC_CAPS_TAILPTR -+ | PHYTMAC_CAPS_START -+ | PHYTMAC_CAPS_JUMBO -+ | PHYTMAC_CAPS_LSO, -+ .queue_num = 4, -+ .use_ncsi = false, -+ .use_mii = false, -+ .speed = 2500, -+ .duplex = true, -+ .interface = PHY_INTERFACE_MODE_2500BASEX, -+ .properties = fl_properties[1], -+}; -+ -+struct phytmac_data phytmac_5000baser = { -+ .hw_if = &phytmac_1p0_hw, -+ .caps = PHYTMAC_CAPS_TAILPTR -+ | PHYTMAC_CAPS_START -+ | PHYTMAC_CAPS_JUMBO -+ | PHYTMAC_CAPS_LSO, -+ .queue_num = 4, -+ .use_ncsi = false, -+ .use_mii = false, -+ .speed = 5000, -+ .duplex = true, -+ .interface = PHY_INTERFACE_MODE_5GBASER, -+ .properties = fl_properties[2], -+}; -+ -+struct phytmac_data phytmac_usxgmii = { -+ .hw_if = &phytmac_1p0_hw, -+ .caps = PHYTMAC_CAPS_TAILPTR -+ | PHYTMAC_CAPS_START -+ | PHYTMAC_CAPS_JUMBO -+ | PHYTMAC_CAPS_LSO, -+ .queue_num = 4, -+ .use_ncsi = false, -+ .use_mii = false, -+ .speed = 10000, -+ .duplex = true, -+ .interface = PHY_INTERFACE_MODE_USXGMII, -+ .properties = fl_properties[3], -+}; -+ -+static const struct pci_device_id phytmac_pci_table[] = { -+ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, -+ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_SGMII), -+ .driver_data = (kernel_ulong_t)&phytmac_sgmii}, -+ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, -+ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_1000BASEX), -+ .driver_data = (kernel_ulong_t)&phytmac_1000basex}, -+ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, -+ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_2500BASEX), -+ .driver_data = (kernel_ulong_t)&phytmac_2500basex}, -+ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, -+ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_5GBASER), -+ .driver_data = (kernel_ulong_t)&phytmac_5000baser}, -+ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, -+ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_USXGMII), -+ .driver_data = (kernel_ulong_t)&phytmac_usxgmii}, -+ { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, -+ PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_10GBASER), -+ .driver_data = (kernel_ulong_t)&phytmac_usxgmii}, -+ /* Last entry must be zero */ -+ { 0, } -+}; -+MODULE_DEVICE_TABLE(pci, phytmac_pci_table); -+ -+static const struct dev_pm_ops phytmac_pci_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytmac_pci_suspend, phytmac_pci_resume) -+}; -+ -+static struct pci_driver phytmac_driver = { -+ .name = PHYTMAC_DRV_NAME, -+ .id_table = phytmac_pci_table, -+ .probe = phytmac_pci_probe, -+ .remove = phytmac_pci_remove, -+ .driver = { -+ .pm = &phytmac_pci_pm_ops, -+ } -+}; -+ -+module_pci_driver(phytmac_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium NIC PCI wrapper"); -diff --git a/drivers/net/ethernet/phytium/phytmac_platform.c b/drivers/net/ethernet/phytium/phytmac_platform.c -new file mode 100644 -index 000000000..305ff5866 ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac_platform.c -@@ -0,0 +1,255 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+/* -+ * Phytium GMAC Platform wrapper. -+ * -+ */ -+ -+#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt -+#include -+#include -+#include -+#include -+#include -+#include "phytmac.h" -+#include "phytmac_v1.h" -+#include "phytmac_v2.h" -+ -+static const struct phytmac_config phytium_1p0_config = { -+ .hw_if = &phytmac_1p0_hw, -+ .caps = PHYTMAC_CAPS_TAILPTR -+ | PHYTMAC_CAPS_START -+ | PHYTMAC_CAPS_JUMBO -+ | PHYTMAC_CAPS_LSO, -+ .queue_num = 4, -+ .tsu_rate = 300000000, -+}; -+ -+static const struct phytmac_config phytium_2p0_config = { -+ .hw_if = &phytmac_2p0_hw, -+ .caps = PHYTMAC_CAPS_TAILPTR -+ | PHYTMAC_CAPS_LPI -+ | PHYTMAC_CAPS_LSO -+ | PHYTMAC_CAPS_MSG -+ | PHYTMAC_CAPS_JUMBO, -+ .queue_num = 2, -+ .tsu_rate = 300000000, -+}; -+ -+#if defined(CONFIG_OF) -+static const struct of_device_id phytmac_dt_ids[] = { -+ { .compatible = "phytium,gmac-1.0", .data = &phytium_1p0_config }, -+ { .compatible = "phytium,gmac-2.0", .data = &phytium_2p0_config }, -+ { /* sentinel */ } -+}; -+MODULE_DEVICE_TABLE(of, phytmac_dt_ids); -+#endif /* CONFIG_OF */ -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytmac_acpi_ids[] = { -+ { .id = "PHYT0046", .driver_data = (kernel_ulong_t)&phytium_1p0_config }, -+ { } -+}; -+ -+MODULE_DEVICE_TABLE(acpi, phytmac_acpi_ids); -+#else -+#define phytmac_acpi_ids NULL -+#endif -+ -+static int phytmac_get_phy_mode(struct platform_device *pdev) -+{ -+ const char *pm; -+ int err, i; -+ -+ err = device_property_read_string(&pdev->dev, "phy-mode", &pm); -+ if (err < 0) -+ return err; -+ -+ for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) { -+ if (!strcasecmp(pm, phy_modes(i))) -+ return i; -+ } -+ -+ return -ENODEV; -+} -+ -+static int phytmac_plat_probe(struct platform_device *pdev) -+{ -+ const struct phytmac_config *phytmac_config = &phytium_1p0_config; -+ struct device_node *np = pdev->dev.of_node; -+ struct resource *regs; -+ struct phytmac *pdata; -+ int ret, i; -+ u32 queue_num; -+ -+ pdata = phytmac_alloc_pdata(&pdev->dev); -+ if (IS_ERR(pdata)) { -+ ret = PTR_ERR(pdata); -+ goto err_alloc; -+ } -+ -+ platform_set_drvdata(pdev, pdata); -+ -+ pdata->platdev = pdev; -+ -+ if (pdev->dev.of_node) { -+ const struct of_device_id *match; -+ -+ match = of_match_node(phytmac_dt_ids, np); -+ if (match && match->data) { -+ phytmac_config = match->data; -+ pdata->hw_if = phytmac_config->hw_if; -+ pdata->capacities = phytmac_config->caps; -+ pdata->queues_max_num = phytmac_config->queue_num; -+ } -+ } else if (has_acpi_companion(&pdev->dev)) { -+ const struct acpi_device_id *match; -+ -+ match = acpi_match_device(phytmac_acpi_ids, &pdev->dev); -+ if (match && match->driver_data) { -+ phytmac_config = (void *)match->driver_data; -+ pdata->hw_if = phytmac_config->hw_if; -+ pdata->capacities = phytmac_config->caps; -+ pdata->queues_max_num = phytmac_config->queue_num; -+ } -+ } -+ -+ i = 0; -+ pdata->mac_regs = devm_platform_get_and_ioremap_resource(pdev, i, ®s); -+ if (IS_ERR(pdata->mac_regs)) { -+ dev_err(&pdev->dev, "mac_regs ioremap failed\n"); -+ ret = PTR_ERR(pdata->mac_regs); -+ goto err_mem; -+ } -+ pdata->ndev->base_addr = regs->start; -+ -+ if (pdata->capacities & PHYTMAC_CAPS_MSG) { -+ ++i; -+ regs = platform_get_resource(pdev, IORESOURCE_MEM, i); -+ if (regs) { -+ pdata->msg_regs = ioremap_wt(regs->start, MEMORY_SIZE); -+ if (!pdata->msg_regs) { -+ dev_err(&pdev->dev, "msg_regs ioremap failed, i=%d\n", i); -+ goto err_mem; -+ } -+ } -+ } -+ -+ if (device_property_read_bool(&pdev->dev, "lpi")) -+ pdata->capacities |= PHYTMAC_CAPS_LPI; -+ -+ if (pdata->capacities & PHYTMAC_CAPS_LPI) { -+ /* lpi resource */ -+ ++i; -+ regs = platform_get_resource(pdev, IORESOURCE_MEM, i); -+ if (regs) { -+ pdata->mhu_regs = ioremap(regs->start, MHU_SIZE); -+ if (!pdata->mhu_regs) -+ dev_err(&pdev->dev, "mhu_regs ioremap failed, i=%d\n", i); -+ } -+ } -+ -+ if (device_property_read_u32(&pdev->dev, "dma-burst-length", &pdata->dma_burst_length)) -+ pdata->dma_burst_length = DEFAULT_DMA_BURST_LENGTH; -+ -+ if (device_property_read_u32(&pdev->dev, "jumbo-max-length", &pdata->jumbo_len)) -+ pdata->jumbo_len = DEFAULT_JUMBO_MAX_LENGTH; -+ -+ if (device_property_read_u32(&pdev->dev, "queue-number", &queue_num)) -+ pdata->queues_num = pdata->queues_max_num; -+ else -+ pdata->queues_num = queue_num; -+ -+ pdata->wol = 0; -+ if (device_property_read_bool(&pdev->dev, "magic-packet")) -+ pdata->wol |= PHYTMAC_WAKE_MAGIC; -+ -+ pdata->use_ncsi = device_property_read_bool(&pdev->dev, "use-ncsi"); -+ pdata->use_mii = device_property_read_bool(&pdev->dev, "use-mii"); -+ -+ pdata->power_state = PHYTMAC_POWEROFF; -+ -+ device_set_wakeup_capable(&pdev->dev, pdata->wol & PHYTMAC_WOL_MAGIC_PACKET); -+ -+ for (i = 0; i < pdata->queues_num; i++) { -+ pdata->irq_type = IRQ_TYPE_INT; -+ pdata->queue_irq[i] = platform_get_irq(pdev, i); -+ } -+ -+ ret = phytmac_get_phy_mode(pdev); -+ if (ret < 0) -+ pdata->phy_interface = PHY_INTERFACE_MODE_MII; -+ else -+ pdata->phy_interface = ret; -+ -+ ret = phytmac_drv_probe(pdata); -+ if (ret) -+ goto err_mem; -+ -+ if (netif_msg_probe(pdata)) { -+ dev_notice(&pdev->dev, "phytium net device enabled\n"); -+ dev_dbg(pdata->dev, "use_ncsi:%d, use_mii:%d, wol:%d, queues_num:%d\n", -+ pdata->use_ncsi, pdata->use_mii, pdata->wol, pdata->queues_num); -+ } -+ -+ return 0; -+ -+err_mem: -+ phytmac_free_pdata(pdata); -+ -+err_alloc: -+ dev_err(&pdev->dev, "phytium net device not enabled\n"); -+ -+ return ret; -+} -+ -+static int phytmac_plat_remove(struct platform_device *pdev) -+{ -+ struct phytmac *pdata = platform_get_drvdata(pdev); -+ -+ phytmac_drv_remove(pdata); -+ phytmac_free_pdata(pdata); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytmac_plat_suspend(struct device *dev) -+{ -+ struct phytmac *pdata = dev_get_drvdata(dev); -+ int ret; -+ -+ ret = phytmac_drv_suspend(pdata); -+ -+ return ret; -+} -+ -+static int __maybe_unused phytmac_plat_resume(struct device *dev) -+{ -+ struct phytmac *pdata = dev_get_drvdata(dev); -+ int ret; -+ -+ ret = phytmac_drv_resume(pdata); -+ -+ return ret; -+} -+ -+static const struct dev_pm_ops phytmac_plat_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytmac_plat_suspend, phytmac_plat_resume) -+}; -+ -+static struct platform_driver phytmac_driver = { -+ .probe = phytmac_plat_probe, -+ .remove = phytmac_plat_remove, -+ .driver = { -+ .name = PHYTMAC_DRV_NAME, -+ .of_match_table = of_match_ptr(phytmac_dt_ids), -+ .acpi_match_table = phytmac_acpi_ids, -+ .pm = &phytmac_plat_pm_ops, -+ }, -+}; -+ -+module_platform_driver(phytmac_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium Ethernet driver"); -+MODULE_AUTHOR("Wenting Song"); -+MODULE_ALIAS("platform:phytmac"); -diff --git a/drivers/net/ethernet/phytium/phytmac_ptp.c b/drivers/net/ethernet/phytium/phytmac_ptp.c -new file mode 100644 -index 000000000..26b1b75ed ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac_ptp.c -@@ -0,0 +1,304 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+/** -+ * 1588 PTP support for Phytium GMAC device. -+ * -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytmac.h" -+#include "phytmac_ptp.h" -+ -+bool phytmac_ptp_one_step(struct sk_buff *skb) -+{ -+ struct ptp_header *hdr; -+ unsigned int ptp_class; -+ u8 msgtype; -+ -+ /* No need to parse packet if PTP TS is not involved */ -+ if (likely(!(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP))) -+ goto not_oss; -+ -+ /* Identify and return whether PTP one step sync is being processed */ -+ ptp_class = ptp_classify_raw(skb); -+ if (ptp_class == PTP_CLASS_NONE) -+ goto not_oss; -+ -+ hdr = ptp_parse_header(skb, ptp_class); -+ if (!hdr) -+ goto not_oss; -+ -+ if (hdr->flag_field[0] & 0x2) -+ goto not_oss; -+ -+ msgtype = ptp_get_msgtype(hdr, ptp_class); -+ if (msgtype == PTP_MSGTYPE_SYNC) -+ return true; -+ -+not_oss: -+ return false; -+} -+ -+int phytmac_ptp_gettime(struct ptp_clock_info *ptp, struct timespec64 *ts) -+{ -+ struct phytmac *pdata = container_of(ptp, struct phytmac, ptp_clock_info); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&pdata->ts_clk_lock, flags); -+ hw_if->get_time(pdata, ts); -+ spin_unlock_irqrestore(&pdata->ts_clk_lock, flags); -+ -+ return 0; -+} -+ -+int phytmac_ptp_settime(struct ptp_clock_info *ptp, -+ const struct timespec64 *ts) -+{ -+ struct phytmac *pdata = container_of(ptp, struct phytmac, ptp_clock_info); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&pdata->ts_clk_lock, flags); -+ hw_if->set_time(pdata, ts->tv_sec, ts->tv_nsec); -+ spin_unlock_irqrestore(&pdata->ts_clk_lock, flags); -+ -+ return 0; -+} -+ -+int phytmac_ptp_adjfine(struct ptp_clock_info *ptp, long scaled_ppm) -+{ -+ struct phytmac *pdata = container_of(ptp, struct phytmac, ptp_clock_info); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ bool negative = false; -+ -+ if (scaled_ppm < 0) { -+ negative = true; -+ scaled_ppm = -scaled_ppm; -+ } -+ -+ hw_if->adjust_fine(pdata, scaled_ppm, negative); -+ return 0; -+} -+ -+int phytmac_ptp_adjtime(struct ptp_clock_info *ptp, s64 delta) -+{ -+ struct phytmac *pdata = container_of(ptp, struct phytmac, ptp_clock_info); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ int negative = 0; -+ -+ if (delta < 0) { -+ negative = 1; -+ delta = -delta; -+ } -+ -+ spin_lock_irq(&pdata->ts_clk_lock); -+ hw_if->adjust_time(pdata, delta, negative); -+ spin_unlock_irq(&pdata->ts_clk_lock); -+ -+ return 0; -+} -+ -+int phytmac_ptp_enable(struct ptp_clock_info *ptp, -+ struct ptp_clock_request *rq, int on) -+{ -+ return -EOPNOTSUPP; -+} -+ -+void phytmac_ptp_init_timer(struct phytmac *pdata) -+{ -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ u32 rem = 0; -+ u64 adj; -+ -+ pdata->ts_rate = hw_if->get_ts_rate(pdata); -+ pdata->ts_incr.ns = div_u64_rem(NSEC_PER_SEC, pdata->ts_rate, &rem); -+ if (rem) { -+ adj = rem; -+ adj <<= 24; -+ pdata->ts_incr.sub_ns = div_u64(adj, pdata->ts_rate); -+ } else { -+ pdata->ts_incr.sub_ns = 0; -+ } -+} -+ -+void phytmac_ptp_rxstamp(struct phytmac *pdata, struct sk_buff *skb, -+ struct phytmac_dma_desc *desc) -+{ -+ struct skb_shared_hwtstamps *shhwtstamps = skb_hwtstamps(skb); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct timespec64 ts; -+ -+ if (hw_if->ts_valid(pdata, desc, PHYTMAC_RX)) { -+ hw_if->get_timestamp(pdata, desc->desc4, desc->desc5, &ts); -+ memset(shhwtstamps, 0, sizeof(struct skb_shared_hwtstamps)); -+ shhwtstamps->hwtstamp = ktime_set(ts.tv_sec, ts.tv_nsec); -+ } -+} -+ -+int phytmac_ptp_txstamp(struct phytmac_queue *queue, struct sk_buff *skb, -+ struct phytmac_dma_desc *desc) -+{ -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct timespec64 ts; -+ struct skb_shared_hwtstamps shhwtstamps; -+ -+ if (queue->pdata->ts_config.tx_type == TS_DISABLED) -+ return -EOPNOTSUPP; -+ -+ if (!hw_if->ts_valid(pdata, desc, PHYTMAC_TX)) -+ return -EINVAL; -+ -+ skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS; -+ hw_if->get_timestamp(pdata, desc->desc4, desc->desc5, &ts); -+ memset(&shhwtstamps, 0, sizeof(shhwtstamps)); -+ shhwtstamps.hwtstamp = ktime_set(ts.tv_sec, ts.tv_nsec); -+ skb_tstamp_tx(skb, &shhwtstamps); -+ -+ return 0; -+} -+ -+int phytmac_ptp_register(struct phytmac *pdata) -+{ -+ pdata->ptp_clock_info.owner = THIS_MODULE; -+ snprintf(pdata->ptp_clock_info.name, 16, "%s", pdata->ndev->name); -+ pdata->ptp_clock_info.max_adj = 64000000; /* In PPB */ -+ pdata->ptp_clock_info.n_alarm = 0; -+ pdata->ptp_clock_info.n_ext_ts = 0; -+ pdata->ptp_clock_info.n_per_out = 0; -+ pdata->ptp_clock_info.pps = 1; -+ pdata->ptp_clock_info.adjfine = phytmac_ptp_adjfine; -+ pdata->ptp_clock_info.adjtime = phytmac_ptp_adjtime; -+ pdata->ptp_clock_info.gettime64 = phytmac_ptp_gettime; -+ pdata->ptp_clock_info.settime64 = phytmac_ptp_settime; -+ pdata->ptp_clock_info.enable = phytmac_ptp_enable; -+ pdata->ptp_clock = ptp_clock_register(&pdata->ptp_clock_info, pdata->dev); -+ if (IS_ERR_OR_NULL(pdata->ptp_clock)) { -+ dev_err(pdata->dev, "ptp_clock_register failed %lu\n", -+ PTR_ERR(pdata->ptp_clock)); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+void phytmac_ptp_unregister(struct phytmac *pdata) -+{ -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ -+ if (pdata->ptp_clock) -+ ptp_clock_unregister(pdata->ptp_clock); -+ pdata->ptp_clock = NULL; -+ -+ hw_if->clear_time(pdata); -+ -+ dev_info(pdata->dev, "phytmac ptp clock unregistered.\n"); -+} -+ -+void phytmac_ptp_init(struct net_device *ndev) -+{ -+ struct phytmac *pdata = netdev_priv(ndev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ -+ phytmac_ptp_init_timer(pdata); -+ -+ hw_if->init_ts_hw(pdata); -+ -+ dev_info(pdata->dev, "phytmac ptp clock init success.\n"); -+} -+ -+int phytmac_ptp_get_ts_config(struct net_device *dev, struct ifreq *rq) -+{ -+ struct hwtstamp_config *tstamp_config; -+ struct phytmac *pdata = netdev_priv(dev); -+ -+ if (!IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) -+ return -EOPNOTSUPP; -+ -+ tstamp_config = &pdata->ts_config; -+ -+ if (copy_to_user(rq->ifr_data, tstamp_config, sizeof(*tstamp_config))) -+ return -EFAULT; -+ else -+ return 0; -+} -+ -+int phytmac_ptp_set_ts_config(struct net_device *dev, struct ifreq *ifr, int cmd) -+{ -+ struct hwtstamp_config config; -+ struct phytmac *pdata = netdev_priv(dev); -+ struct phytmac_hw_if *hw_if = pdata->hw_if; -+ struct ts_ctrl tstamp_ctrl; -+ int ret; -+ -+ memset(&tstamp_ctrl, 0, sizeof(struct ts_ctrl)); -+ -+ if (copy_from_user(&config, ifr->ifr_data, sizeof(config))) -+ return -EFAULT; -+ -+ switch (config.tx_type) { -+ case HWTSTAMP_TX_OFF: -+ break; -+ case HWTSTAMP_TX_ONESTEP_SYNC: -+ tstamp_ctrl.one_step = 1; -+ tstamp_ctrl.tx_control = TS_ALL_FRAMES; -+ break; -+ case HWTSTAMP_TX_ON: -+ tstamp_ctrl.one_step = 0; -+ tstamp_ctrl.tx_control = TS_ALL_FRAMES; -+ break; -+ default: -+ return -ERANGE; -+ } -+ -+ switch (config.rx_filter) { -+ case HWTSTAMP_FILTER_NONE: -+ case HWTSTAMP_FILTER_PTP_V1_L4_SYNC: -+ case HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ: -+ break; -+ case HWTSTAMP_FILTER_PTP_V2_EVENT: -+ case HWTSTAMP_FILTER_PTP_V2_L2_EVENT: -+ case HWTSTAMP_FILTER_PTP_V2_L4_EVENT: -+ case HWTSTAMP_FILTER_PTP_V2_SYNC: -+ case HWTSTAMP_FILTER_PTP_V2_L2_SYNC: -+ case HWTSTAMP_FILTER_PTP_V2_L4_SYNC: -+ case HWTSTAMP_FILTER_PTP_V2_DELAY_REQ: -+ case HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ: -+ case HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ: -+ tstamp_ctrl.rx_control = TS_ALL_PTP_FRAMES; -+ config.rx_filter = HWTSTAMP_FILTER_PTP_V2_EVENT; -+ break; -+ case HWTSTAMP_FILTER_PTP_V1_L4_EVENT: -+ case HWTSTAMP_FILTER_ALL: -+ tstamp_ctrl.rx_control = TS_ALL_FRAMES; -+ config.rx_filter = HWTSTAMP_FILTER_ALL; -+ break; -+ default: -+ config.rx_filter = HWTSTAMP_FILTER_NONE; -+ return -ERANGE; -+ } -+ -+ ret = hw_if->set_ts_config(pdata, &tstamp_ctrl); -+ if (ret) -+ return ret; -+ -+ /* save these settings for future reference */ -+ pdata->ts_config = config; -+ memcpy(&pdata->ts_config, &config, sizeof(config)); -+ -+ if (copy_to_user(ifr->ifr_data, &config, sizeof(config))) -+ return -EFAULT; -+ else -+ return 0; -+} -+ -diff --git a/drivers/net/ethernet/phytium/phytmac_ptp.h b/drivers/net/ethernet/phytium/phytmac_ptp.h -new file mode 100644 -index 000000000..72c8b7c67 ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac_ptp.h -@@ -0,0 +1,55 @@ -+/* SPDX-License-Identifier: GPL-2.0-only */ -+/* -+ * Phytium Ethernet Controller driver -+ * -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 as -+ * published by the Free Software Foundation. -+ */ -+#ifndef _PHYTMAC_PTP_H -+#define _PHYTMAC_PTP_H -+ -+#ifdef CONFIG_PHYTMAC_ENABLE_PTP -+bool phytmac_ptp_one_step(struct sk_buff *skb); -+int phytmac_ptp_gettime(struct ptp_clock_info *ptp, struct timespec64 *ts); -+int phytmac_ptp_settime(struct ptp_clock_info *ptp, -+ const struct timespec64 *ts); -+int phytmac_ptp_adjfine(struct ptp_clock_info *ptp, long scaled_ppm); -+int phytmac_ptp_adjtime(struct ptp_clock_info *ptp, s64 delta); -+int phytmac_ptp_enable(struct ptp_clock_info *ptp, -+ struct ptp_clock_request *rq, int on); -+void phytmac_ptp_init_timer(struct phytmac *pdata); -+void phytmac_ptp_rxstamp(struct phytmac *pdata, struct sk_buff *skb, -+ struct phytmac_dma_desc *desc); -+int phytmac_ptp_txstamp(struct phytmac_queue *queue, struct sk_buff *skb, -+ struct phytmac_dma_desc *desc); -+int phytmac_ptp_register(struct phytmac *pdata); -+void phytmac_ptp_unregister(struct phytmac *pdata); -+void phytmac_ptp_init(struct net_device *ndev); -+int phytmac_ptp_get_ts_config(struct net_device *dev, struct ifreq *rq); -+int phytmac_ptp_set_ts_config(struct net_device *dev, struct ifreq *ifr, int cmd); -+#else -+static inline bool phytmac_ptp_one_step(struct sk_buff *skb) -+{ -+ return 1; -+} -+ -+static inline void phytmac_ptp_rxstamp(struct phytmac *pdata, struct sk_buff *skb, -+ struct phytmac_dma_desc *desc) {} -+static inline int phytmac_ptp_txstamp(struct phytmac_queue *queue, struct sk_buff *skb, -+ struct phytmac_dma_desc *desc) -+{ -+ return -1; -+} -+ -+static inline int phytmac_ptp_register(struct phytmac *pdata) -+{ -+ return 0; -+} -+ -+static inline void phytmac_ptp_unregister(struct phytmac *pdata) {} -+static inline void phytmac_ptp_init(struct net_device *ndev) {} -+ -+#endif -+#endif -diff --git a/drivers/net/ethernet/phytium/phytmac_v1.c b/drivers/net/ethernet/phytium/phytmac_v1.c -new file mode 100644 -index 000000000..ec95c6c79 ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac_v1.c -@@ -0,0 +1,1400 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytmac.h" -+#include "phytmac_v1.h" -+ -+static int phytmac_enable_promise(struct phytmac *pdata, int enable) -+{ -+ u32 value = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); -+ -+ if (enable) -+ value |= PHYTMAC_BIT(PROMISC); -+ else -+ value &= ~PHYTMAC_BIT(PROMISC); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, value); -+ -+ return 0; -+} -+ -+static int phytmac_enable_multicast(struct phytmac *pdata, int enable) -+{ -+ u32 config; -+ -+ if (enable) { -+ PHYTMAC_WRITE(pdata, PHYTMAC_HASHB, -1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_HASHT, -1); -+ config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); -+ config |= PHYTMAC_BIT(MH_EN); -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); -+ } else { -+ PHYTMAC_WRITE(pdata, PHYTMAC_HASHB, 0); -+ PHYTMAC_WRITE(pdata, PHYTMAC_HASHT, 0); -+ config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); -+ config &= ~PHYTMAC_BIT(MH_EN); -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); -+ } -+ -+ return 0; -+} -+ -+static int phytmac_set_mc_hash(struct phytmac *pdata, unsigned long *mc_filter) -+{ -+ u32 config; -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_HASHB, mc_filter[0]); -+ PHYTMAC_WRITE(pdata, PHYTMAC_HASHT, mc_filter[1]); -+ config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); -+ config |= PHYTMAC_BIT(MH_EN); -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); -+ -+ return 0; -+} -+ -+static int phytmac_enable_rxcsum(struct phytmac *pdata, int enable) -+{ -+ u32 value = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); -+ -+ if (enable) -+ value |= PHYTMAC_BIT(RCO_EN); -+ else -+ value &= ~PHYTMAC_BIT(RCO_EN); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, value); -+ -+ return 0; -+} -+ -+static int phytmac_enable_txcsum(struct phytmac *pdata, int enable) -+{ -+ u32 value = PHYTMAC_READ(pdata, PHYTMAC_DCONFIG); -+ -+ if (enable) -+ value |= PHYTMAC_BIT(TCO_EN); -+ else -+ value &= ~PHYTMAC_BIT(TCO_EN); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_DCONFIG, value); -+ -+ return 0; -+} -+ -+static int phytmac_enable_mdio(struct phytmac *pdata, int enable) -+{ -+ u32 value = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); -+ -+ if (enable) -+ value |= PHYTMAC_BIT(MPE); -+ else -+ value &= ~PHYTMAC_BIT(MPE); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, value); -+ -+ return 0; -+} -+ -+static int phytmac_enable_pause(struct phytmac *pdata, int enable) -+{ -+ u32 value = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); -+ -+ if (enable) -+ value |= PHYTMAC_BIT(PAUSE_EN); -+ else -+ value &= ~PHYTMAC_BIT(PAUSE_EN); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, value); -+ return 0; -+} -+ -+static int phytmac_enable_network(struct phytmac *pdata, int enable, int rx_tx) -+{ -+ u32 old_ctrl = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); -+ u32 ctrl; -+ -+ ctrl = old_ctrl; -+ -+ if (rx_tx & PHYTMAC_TX) { -+ if (enable) -+ ctrl |= PHYTMAC_BIT(TE); -+ else -+ ctrl &= ~PHYTMAC_BIT(TE); -+ } -+ -+ if (rx_tx & PHYTMAC_RX) { -+ if (enable) -+ ctrl |= PHYTMAC_BIT(RE); -+ else -+ ctrl &= ~PHYTMAC_BIT(RE); -+ } -+ -+ if (ctrl ^ old_ctrl) -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, ctrl); -+ -+ return 0; -+} -+ -+static int phytmac_enable_autoneg(struct phytmac *pdata, int enable) -+{ -+ u32 value = PHYTMAC_READ(pdata, PHYTMAC_PCSCTRL); -+ -+ if (enable) -+ value |= PHYTMAC_BIT(AUTONEG); -+ else -+ value &= ~PHYTMAC_BIT(AUTONEG); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_PCSCTRL, value); -+ -+ return 0; -+} -+ -+static int phytmac_pcs_software_reset(struct phytmac *pdata, int reset) -+{ -+ u32 value = PHYTMAC_READ(pdata, PHYTMAC_PCSCTRL); -+ -+ if (reset) -+ value |= PHYTMAC_BIT(PCS_RESET); -+ else -+ value &= ~PHYTMAC_BIT(PCS_RESET); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_PCSCTRL, value); -+ -+ return 0; -+} -+ -+static int phytmac_mac_linkup(struct phytmac *pdata, phy_interface_t interface, -+ int speed, int duplex) -+{ -+ u32 ctrl, config; -+ -+ config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); -+ -+ config &= ~(PHYTMAC_BIT(SPEED) | PHYTMAC_BIT(FD)); -+ -+ if (speed == SPEED_100) -+ config |= PHYTMAC_BIT(SPEED); -+ else if (speed == SPEED_1000 || speed == SPEED_2500) -+ config |= PHYTMAC_BIT(GM_EN); -+ -+ if (duplex) -+ config |= PHYTMAC_BIT(FD); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); -+ -+ if (speed == SPEED_2500) { -+ ctrl = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); -+ ctrl |= PHYTMAC_BIT(2PT5G); -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, ctrl); -+ } -+ -+ if (speed == SPEED_10000) -+ PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_10000M); -+ else if (speed == SPEED_5000) -+ PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_5000M); -+ else if (speed == SPEED_2500) -+ PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_2500M); -+ else if (speed == SPEED_1000) -+ PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_1000M); -+ else -+ PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_100M); -+ -+ return 0; -+} -+ -+static int phytmac_mac_linkdown(struct phytmac *pdata) -+{ -+ return 0; -+} -+ -+static int phytmac_pcs_linkup(struct phytmac *pdata, phy_interface_t interface, -+ int speed, int duplex) -+{ -+ u32 config; -+ -+ if (interface == PHY_INTERFACE_MODE_USXGMII || -+ interface == PHY_INTERFACE_MODE_10GBASER) { -+ config = PHYTMAC_READ(pdata, PHYTMAC_USXCTRL); -+ if (speed == SPEED_10000) { -+ config = PHYTMAC_SET_BITS(config, SERDES_RATE, PHYTMAC_SERDES_RATE_10G); -+ config = PHYTMAC_SET_BITS(config, USX_SPEED, PHYTMAC_SPEED_10000M); -+ } else if (speed == SPEED_5000) { -+ config = PHYTMAC_SET_BITS(config, SERDES_RATE, PHYTMAC_SERDES_RATE_5G); -+ config = PHYTMAC_SET_BITS(config, USX_SPEED, PHYTMAC_SPEED_5000M); -+ } -+ -+ /* reset */ -+ config &= ~(PHYTMAC_BIT(RX_EN) | PHYTMAC_BIT(TX_EN)); -+ config |= PHYTMAC_BIT(RX_SYNC_RESET); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_USXCTRL, config); -+ -+ /* enable rx and tx */ -+ config &= ~(PHYTMAC_BIT(RX_SYNC_RESET)); -+ config |= PHYTMAC_BIT(RX_EN) | PHYTMAC_BIT(TX_EN); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_USXCTRL, config); -+ } -+ -+ return 0; -+} -+ -+static int phytmac_pcs_linkdown(struct phytmac *pdata) -+{ -+ return 0; -+} -+ -+static int phytmac_get_mac_addr(struct phytmac *pdata, u8 *addr) -+{ -+ u32 bottom; -+ u16 top; -+ -+ bottom = PHYTMAC_READ(pdata, PHYTMAC_MAC1B); -+ top = PHYTMAC_READ(pdata, PHYTMAC_MAC1T); -+ -+ addr[0] = bottom & 0xff; -+ addr[1] = (bottom >> 8) & 0xff; -+ addr[2] = (bottom >> 16) & 0xff; -+ addr[3] = (bottom >> 24) & 0xff; -+ addr[4] = top & 0xff; -+ addr[5] = (top >> 8) & 0xff; -+ -+ return 0; -+} -+ -+static int phytmac_set_mac_addr(struct phytmac *pdata, const u8 *addr) -+{ -+ u32 bottom; -+ u16 top; -+ -+ bottom = cpu_to_le32(*((u32 *)addr)); -+ PHYTMAC_WRITE(pdata, PHYTMAC_MAC1B, bottom); -+ top = cpu_to_le16(*((u16 *)(addr + 4))); -+ PHYTMAC_WRITE(pdata, PHYTMAC_MAC1T, top); -+ -+ return 0; -+} -+ -+static void phytmac_reset_hw(struct phytmac *pdata) -+{ -+ struct phytmac_queue *queue; -+ unsigned int q; -+ u32 ctrl; -+ -+ ctrl = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); -+ -+ ctrl &= ~(PHYTMAC_BIT(RE) | PHYTMAC_BIT(TE)); -+ ctrl |= PHYTMAC_BIT(CLEARSTAT); -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, ctrl); -+ -+ /* Disable and clear all interrupts and disable queues */ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_max_num; ++q, ++queue) { -+ if (q == 0) { -+ PHYTMAC_WRITE(pdata, PHYTMAC_ID, -1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_IS, -1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TXPTR_Q0, 1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_RXPTR_Q0, 1); -+ } else { -+ PHYTMAC_WRITE(pdata, PHYTMAC_IDR(q - 1), -1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_ISR(q - 1), -1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TXPTR(q - 1), 1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_RXPTR(q - 1), 1); -+ } -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_TXPTRH(q), 0); -+ PHYTMAC_WRITE(pdata, PHYTMAC_RXPTRH(q), 0); -+ -+ if (pdata->capacities & PHYTMAC_CAPS_TAILPTR) -+ PHYTMAC_WRITE(pdata, PHYTMAC_TAILPTR(q), 0); -+ } -+} -+ -+static void phytmac_get_regs(struct phytmac *pdata, u32 *reg_buff) -+{ -+ reg_buff[0] = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); -+ reg_buff[1] = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); -+ reg_buff[2] = PHYTMAC_READ(pdata, PHYTMAC_NSTATUS); -+ reg_buff[3] = PHYTMAC_READ(pdata, PHYTMAC_DCONFIG); -+ reg_buff[4] = PHYTMAC_READ(pdata, PHYTMAC_TXPTR_Q0); -+ reg_buff[5] = PHYTMAC_READ(pdata, PHYTMAC_RXPTR_Q0); -+ reg_buff[6] = PHYTMAC_READ(pdata, PHYTMAC_TXPTR(1)); -+ reg_buff[7] = PHYTMAC_READ(pdata, PHYTMAC_RXPTR(1)); -+ reg_buff[8] = PHYTMAC_READ(pdata, PHYTMAC_TXPTR(2)); -+ reg_buff[9] = PHYTMAC_READ(pdata, PHYTMAC_RXPTR(2)); -+ reg_buff[10] = PHYTMAC_READ(pdata, PHYTMAC_TXPTR(3)); -+ reg_buff[11] = PHYTMAC_READ(pdata, PHYTMAC_RXPTR(3)); -+ reg_buff[12] = PHYTMAC_READ(pdata, PHYTMAC_HCONFIG); -+ reg_buff[13] = PHYTMAC_READ(pdata, PHYTMAC_IM); -+ if (pdata->phy_interface == PHY_INTERFACE_MODE_USXGMII || -+ pdata->phy_interface == PHY_INTERFACE_MODE_10GBASER) { -+ reg_buff[14] = PHYTMAC_READ(pdata, PHYTMAC_USXCTRL); -+ reg_buff[15] = PHYTMAC_READ(pdata, PHYTMAC_USXSTATUS); -+ } else { -+ reg_buff[14] = PHYTMAC_READ(pdata, PHYTMAC_PCSCTRL); -+ reg_buff[15] = PHYTMAC_READ(pdata, PHYTMAC_PCSSTATUS); -+ } -+} -+ -+static int phytmac_init_hw(struct phytmac *pdata) -+{ -+ u32 config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); -+ u32 dmaconfig; -+ u32 nctrlconfig; -+ -+ nctrlconfig = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); -+ nctrlconfig |= PHYTMAC_BIT(MPE); -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, nctrlconfig); -+ -+ phytmac_set_mac_addr(pdata, pdata->ndev->dev_addr); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_AXICTRL, 0x1010); -+ -+ /* jumbo */ -+ if (pdata->capacities & PHYTMAC_CAPS_JUMBO) -+ config |= PHYTMAC_BIT(JUMBO_EN); -+ else -+ config |= PHYTMAC_BIT(RCV_BIG); -+ /* promisc */ -+ if (pdata->ndev->flags & IFF_PROMISC) -+ config |= PHYTMAC_BIT(PROMISC); -+ if (pdata->ndev->features & NETIF_F_RXCSUM) -+ config |= PHYTMAC_BIT(RCO_EN); -+ if (pdata->ndev->flags & IFF_BROADCAST) -+ config &= ~PHYTMAC_BIT(NO_BCAST); -+ else -+ config |= PHYTMAC_BIT(NO_BCAST); -+ -+ /* pause enable */ -+ config |= PHYTMAC_BIT(PAUSE_EN); -+ /* Rx Fcs remove */ -+ config |= PHYTMAC_BIT(FCS_REMOVE); -+ if (pdata->dma_data_width == PHYTMAC_DBW_64) -+ config |= PHYTMAC_BIT(DBW64); -+ if (pdata->dma_data_width == PHYTMAC_DBW_128) -+ config |= PHYTMAC_BIT(DBW128); -+ /* mdc div */ -+ config = PHYTMAC_SET_BITS(config, MCD, 6); -+ netdev_dbg(pdata->ndev, "phytmac configure NetConfig with 0x%08x\n", -+ config); -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); -+ -+ /* init dma */ -+ dmaconfig = PHYTMAC_READ(pdata, PHYTMAC_DCONFIG); -+ if (pdata->dma_burst_length) -+ dmaconfig = PHYTMAC_SET_BITS(dmaconfig, BURST, pdata->dma_burst_length); -+ /* default in small endian */ -+ dmaconfig &= ~(PHYTMAC_BIT(ENDIA_PKT) | PHYTMAC_BIT(ENDIA_DESC)); -+ -+ if (pdata->ndev->features & NETIF_F_HW_CSUM) -+ dmaconfig |= PHYTMAC_BIT(TCO_EN); -+ else -+ dmaconfig &= ~PHYTMAC_BIT(TCO_EN); -+ -+ if (pdata->dma_addr_width) -+ dmaconfig |= PHYTMAC_BIT(ABW); -+ -+ /* fdir ethtype -- ipv4 */ -+ PHYTMAC_WRITE(pdata, PHYTMAC_ETHT(0), (uint16_t)ETH_P_IP); -+ -+ if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) -+ dmaconfig |= PHYTMAC_BIT(RX_EXBD_EN) | PHYTMAC_BIT(TX_EXBD_EN); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_DCONFIG, dmaconfig); -+ -+ if (pdata->capacities & PHYTMAC_CAPS_TAILPTR) -+ PHYTMAC_WRITE(pdata, PHYTMAC_TAIL_ENABLE, 0x80000001); -+ -+ if (phy_interface_mode_is_8023z(pdata->phy_interface)) -+ phytmac_pcs_software_reset(pdata, 1); -+ -+ return 0; -+} -+ -+static int phytmac_powerup_hw(struct phytmac *pdata, int on) -+{ -+ u32 status, data0, data1, rdata1; -+ int ret; -+ -+ if (pdata->capacities & PHYTMAC_CAPS_LPI) { -+ ret = readx_poll_timeout(PHYTMAC_READ_STAT, pdata, status, !status, -+ 1, PHYTMAC_TIMEOUT); -+ if (ret) -+ netdev_err(pdata->ndev, "mnh status is busy, status=%x\n", status); -+ -+ ret = readx_poll_timeout(PHYTMAC_READ_DATA0, pdata, data0, -+ data0 & PHYTMAC_BIT(DATA0_FREE), -+ 1, PHYTMAC_TIMEOUT); -+ if (ret) -+ netdev_err(pdata->ndev, "mnh data0 is busy, data0=%x\n", data0); -+ -+ data0 = 0; -+ data0 = PHYTMAC_SET_BITS(data0, DATA0_MSG, PHYTMAC_MSG_PM); -+ data0 = PHYTMAC_SET_BITS(data0, DATA0_PRO, PHYTMAC_PRO_ID); -+ PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA0, data0); -+ data1 = 0; -+ -+ if (on == PHYTMAC_POWERON) { -+ data1 = PHYTMAC_SET_BITS(data1, DATA1_STAT, PHYTMAC_STATON); -+ data1 = PHYTMAC_SET_BITS(data1, DATA1_STATTYPE, PHYTMAC_STATTYPE); -+ PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA1, data1); -+ } else { -+ data1 = PHYTMAC_SET_BITS(data1, DATA1_STAT, PHYTMAC_STATOFF); -+ data1 = PHYTMAC_SET_BITS(data1, DATA1_STATTYPE, PHYTMAC_STATTYPE); -+ PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA1, data1); -+ } -+ -+ PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_AP_CPP_SET, 1); -+ ret = readx_poll_timeout(PHYTMAC_READ_DATA0, pdata, data0, -+ data0 & PHYTMAC_BIT(DATA0_FREE), -+ 1, PHYTMAC_TIMEOUT); -+ if (ret) -+ netdev_err(pdata->ndev, "mnh data0 is busy"); -+ -+ rdata1 = PHYTMAC_MHU_READ(pdata, PHYTMAC_MHU_CPP_DATA1); -+ if (rdata1 == data1) -+ netdev_err(pdata->ndev, "gmac power %s success, data1 = %x, rdata1=%x\n", -+ on ? "up" : "down", data1, rdata1); -+ else -+ netdev_err(pdata->ndev, "gmac power %s failed, data1 = %x, rdata1=%x\n", -+ on ? "up" : "down", data1, rdata1); -+ } -+ pdata->power_state = on; -+ -+ return 0; -+} -+ -+static int phytmac_set_wake(struct phytmac *pdata, int wake) -+{ -+ u32 value = 0; -+ -+ if (wake & PHYTMAC_WAKE_MAGIC) -+ value |= PHYTMAC_BIT(MAGIC); -+ if (wake & PHYTMAC_WAKE_ARP) -+ value |= PHYTMAC_BIT(ARP); -+ if (wake & PHYTMAC_WAKE_UCAST) -+ value |= PHYTMAC_BIT(UCAST); -+ if (wake & PHYTMAC_WAKE_MCAST) -+ value |= PHYTMAC_BIT(MCAST); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_WOL, value); -+ -+ return 0; -+} -+ -+static void phytmac_mdio_idle(struct phytmac *pdata) -+{ -+ u32 val; -+ -+ /* wait for end of transfer */ -+ val = PHYTMAC_READ(pdata, PHYTMAC_NSTATUS); -+ while (!(val & PHYTMAC_BIT(MDIO_IDLE))) { -+ cpu_relax(); -+ val = PHYTMAC_READ(pdata, PHYTMAC_NSTATUS); -+ } -+} -+ -+static int phytmac_mdio_data_read_c22(struct phytmac *pdata, int mii_id, int regnum) -+{ -+ u16 data; -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C22) -+ | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C22_READ) -+ | PHYTMAC_BITS(PHY_ADDR, mii_id) -+ | PHYTMAC_BITS(REG_ADDR, regnum) -+ | PHYTMAC_BITS(MUST, 2))); -+ -+ phytmac_mdio_idle(pdata); -+ data = PHYTMAC_READ(pdata, PHYTMAC_MDATA) & 0xffff; -+ phytmac_mdio_idle(pdata); -+ -+ return data; -+} -+ -+static int phytmac_mdio_data_write_c22(struct phytmac *pdata, int mii_id, -+ int regnum, u16 data) -+{ -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C22) -+ | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C22_WRITE) -+ | PHYTMAC_BITS(PHY_ADDR, mii_id) -+ | PHYTMAC_BITS(REG_ADDR, regnum) -+ | PHYTMAC_BITS(DATA, data) -+ | PHYTMAC_BITS(MUST, 2))); -+ phytmac_mdio_idle(pdata); -+ -+ return 0; -+} -+ -+static int phytmac_mdio_data_read_c45(struct phytmac *pdata, int mii_id, int devad, int regnum) -+{ -+ u16 data; -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C45) -+ | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C45_ADDR) -+ | PHYTMAC_BITS(PHY_ADDR, mii_id) -+ | PHYTMAC_BITS(REG_ADDR, devad & 0x1F) -+ | PHYTMAC_BITS(DATA, regnum & 0xFFFF) -+ | PHYTMAC_BITS(MUST, 2))); -+ phytmac_mdio_idle(pdata); -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C45) -+ | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C45_READ) -+ | PHYTMAC_BITS(PHY_ADDR, mii_id) -+ | PHYTMAC_BITS(REG_ADDR, devad & 0x1F) -+ | PHYTMAC_BITS(DATA, regnum & 0xFFFF) -+ | PHYTMAC_BITS(MUST, 2))); -+ -+ phytmac_mdio_idle(pdata); -+ data = PHYTMAC_READ(pdata, PHYTMAC_MDATA) & 0xffff; -+ phytmac_mdio_idle(pdata); -+ -+ return data; -+} -+ -+static int phytmac_mdio_data_write_c45(struct phytmac *pdata, int mii_id, int devad, -+ int regnum, u16 data) -+{ -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C45) -+ | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C45_ADDR) -+ | PHYTMAC_BITS(PHY_ADDR, mii_id) -+ | PHYTMAC_BITS(REG_ADDR, devad & 0x1F) -+ | PHYTMAC_BITS(DATA, regnum & 0xFFFF) -+ | PHYTMAC_BITS(MUST, 2))); -+ phytmac_mdio_idle(pdata); -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C45) -+ | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C45_WRITE) -+ | PHYTMAC_BITS(PHY_ADDR, mii_id) -+ | PHYTMAC_BITS(REG_ADDR, devad & 0x1F) -+ | PHYTMAC_BITS(DATA, data) -+ | PHYTMAC_BITS(MUST, 2))); -+ phytmac_mdio_idle(pdata); -+ -+ return 0; -+} -+ -+static int phytmac_get_feature_all(struct phytmac *pdata) -+{ -+ unsigned int queue_mask; -+ unsigned int num_queues; -+ int val; -+ -+ /* get max queues */ -+ queue_mask = 0x1; -+ queue_mask |= PHYTMAC_READ(pdata, PHYTMAC_DEFAULT2) & 0xff; -+ num_queues = hweight32(queue_mask); -+ pdata->queues_max_num = num_queues; -+ -+ /* get dma desc prefetch number */ -+ val = PHYTMAC_READ_BITS(pdata, PHYTMAC_DEFAULT4, TXDESCRD); -+ if (val) -+ pdata->tx_bd_prefetch = (2 << (val - 1)) * -+ sizeof(struct phytmac_dma_desc); -+ -+ val = PHYTMAC_READ_BITS(pdata, PHYTMAC_DEFAULT4, RXDESCRD); -+ if (val) -+ pdata->rx_bd_prefetch = (2 << (val - 1)) * -+ sizeof(struct phytmac_dma_desc); -+ -+ /* dma bus width */ -+ pdata->dma_data_width = PHYTMAC_READ_BITS(pdata, PHYTMAC_DEFAULT1, DBW); -+ -+ /* dma addr width */ -+ if (PHYTMAC_READ_BITS(pdata, PHYTMAC_DEFAULT2, DAW64)) -+ pdata->dma_addr_width = 64; -+ else -+ pdata->dma_addr_width = 32; -+ -+ /* max rx fs */ -+ pdata->max_rx_fs = PHYTMAC_READ_BITS(pdata, PHYTMAC_DEFAULT3, SCR2CMP); -+ -+ if (netif_msg_hw(pdata)) -+ netdev_info(pdata->ndev, "get feature queue_num=%d, daw=%d, dbw=%d, rx_fs=%d, rx_bd=%d, tx_bd=%d\n", -+ pdata->queues_num, pdata->dma_addr_width, pdata->dma_data_width, -+ pdata->max_rx_fs, pdata->rx_bd_prefetch, pdata->tx_bd_prefetch); -+ return 0; -+} -+ -+static int phytmac_add_fdir_entry(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow) -+{ -+ struct ethtool_tcpip4_spec *tp4sp_v, *tp4sp_m; -+ u16 index = rx_flow->location; -+ u32 tmp, fdir_ctrl; -+ bool ipsrc = false; -+ bool ipdst = false; -+ bool port = false; -+ -+ tp4sp_v = &rx_flow->h_u.tcp_ip4_spec; -+ tp4sp_m = &rx_flow->m_u.tcp_ip4_spec; -+ -+ if (tp4sp_m->ip4src == 0xFFFFFFFF) { -+ tmp = 0; -+ tmp = PHYTMAC_SET_BITS(tmp, OFFSET, ETHTYPE_SIP_OFFSET); -+ tmp = PHYTMAC_SET_BITS(tmp, OFFSET_TYPE, PHYTMAC_OFFSET_AFTER_L2HEAD); -+ tmp = PHYTMAC_SET_BITS(tmp, DIS_MASK, 1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index), tp4sp_v->ip4src); -+ PHYTMAC_WRITE(pdata, PHYTMAC_COMP2(3 * index), tmp); -+ ipsrc = true; -+ } -+ -+ if (tp4sp_m->ip4dst == 0xFFFFFFFF) { -+ /* 2nd compare reg - IP destination address */ -+ tmp = 0; -+ tmp = PHYTMAC_SET_BITS(tmp, OFFSET, ETHTYPE_DIP_OFFSET); -+ tmp = PHYTMAC_SET_BITS(tmp, OFFSET_TYPE, PHYTMAC_OFFSET_AFTER_L2HEAD); -+ tmp = PHYTMAC_SET_BITS(tmp, DIS_MASK, 1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index + 1), tp4sp_v->ip4dst); -+ PHYTMAC_WRITE(pdata, PHYTMAC_COMP2(3 * index + 1), tmp); -+ ipdst = true; -+ } -+ -+ if (tp4sp_m->psrc == 0xFFFF || tp4sp_m->pdst == 0xFFFF) { -+ tmp = 0; -+ tmp = PHYTMAC_SET_BITS(tmp, OFFSET_TYPE, PHYTMAC_OFFSET_AFTER_L3HEAD); -+ if (tp4sp_m->psrc == tp4sp_m->pdst) { -+ tmp = PHYTMAC_SET_BITS(tmp, DIS_MASK, 1); -+ tmp = PHYTMAC_SET_BITS(tmp, OFFSET, IPHEAD_SPORT_OFFSET); -+ PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index + 2), -+ tp4sp_v->psrc | (u32)(tp4sp_v->pdst << 16)); -+ } else { -+ tmp = PHYTMAC_SET_BITS(tmp, DIS_MASK, 0); -+ if (tp4sp_m->psrc == 0xFFFF) { /* src port */ -+ tmp = PHYTMAC_SET_BITS(tmp, OFFSET, IPHEAD_SPORT_OFFSET); -+ PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index + 2), -+ tp4sp_m->psrc | (u32)(tp4sp_v->psrc << 16)); -+ } else { /* dst port */ -+ tmp = PHYTMAC_SET_BITS(tmp, OFFSET, IPHEAD_DPORT_OFFSET); -+ PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index + 2), -+ tp4sp_m->pdst | (u32)(tp4sp_v->pdst << 16)); -+ } -+ } -+ PHYTMAC_WRITE(pdata, PHYTMAC_COMP2(3 * index + 2), tmp); -+ port = true; -+ } -+ -+ fdir_ctrl = PHYTMAC_READ(pdata, PHYTMAC_FDIR(rx_flow->location)); -+ -+ if (ipsrc) { -+ fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CA, 3 * index); -+ fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CA_EN, 1); -+ } -+ -+ if (ipdst) { -+ fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CB, 3 * index + 1); -+ fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CB_EN, 1); -+ } -+ -+ if (port) { -+ fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CC, 3 * index + 2); -+ fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CC_EN, 1); -+ } -+ -+ fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, QUEUE_NUM, (rx_flow->ring_cookie) & 0xFF); -+ fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, ETH_TYPE, 0); -+ fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, ETH_EN, 1); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_FDIR(rx_flow->location), fdir_ctrl); -+ -+ return 0; -+} -+ -+static int phytmac_del_fdir_entry(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow) -+{ -+ int i; -+ int index = rx_flow->location; -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_FDIR(index), 0); -+ for (i = 0; i < 3; i++) { -+ PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index + i), 0); -+ PHYTMAC_WRITE(pdata, PHYTMAC_COMP2(3 * index + i), 0); -+ } -+ return 0; -+} -+ -+static int phytmac_init_ring_hw(struct phytmac *pdata) -+{ -+ struct phytmac_queue *queue; -+ unsigned int q = 0; -+ u32 buffer_size = pdata->rx_buffer_len / 64; -+ -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { -+ if (q == 0) { -+ PHYTMAC_WRITE(pdata, PHYTMAC_RXPTR_Q0, -+ lower_32_bits(queue->rx_ring_addr)); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TXPTR_Q0, -+ lower_32_bits(queue->tx_ring_addr)); -+ PHYTMAC_WRITE(pdata, PHYTMAC_DCONFIG, -+ PHYTMAC_SET_BITS(PHYTMAC_READ(pdata, PHYTMAC_DCONFIG), -+ RX_BUF_LEN, buffer_size)); -+ } else { -+ PHYTMAC_WRITE(pdata, PHYTMAC_RXPTR(q - 1), -+ lower_32_bits(queue->rx_ring_addr)); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TXPTR(q - 1), -+ lower_32_bits(queue->tx_ring_addr)); -+ PHYTMAC_WRITE(pdata, PHYTMAC_RBQS(q - 1), buffer_size); -+ } -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_TXPTRH(q), upper_32_bits(queue->tx_ring_addr)); -+ PHYTMAC_WRITE(pdata, PHYTMAC_RXPTRH(q), upper_32_bits(queue->rx_ring_addr)); -+ -+ if (pdata->capacities & PHYTMAC_CAPS_TAILPTR) -+ PHYTMAC_WRITE(pdata, PHYTMAC_TAILPTR(q), queue->tx_tail); -+ } -+ -+ return 0; -+} -+ -+static u32 phytmac_get_irq_mask(u32 mask) -+{ -+ u32 value = 0; -+ -+ value |= (mask & PHYTMAC_INT_TX_COMPLETE) ? PHYTMAC_BIT(TXCOMP) : 0; -+ value |= (mask & PHYTMAC_INT_TX_ERR) ? PHYTMAC_BIT(BUS_ERR) : 0; -+ value |= (mask & PHYTMAC_INT_RX_COMPLETE) ? PHYTMAC_BIT(RXCOMP) : 0; -+ value |= (mask & PHYTMAC_INT_RX_OVERRUN) ? PHYTMAC_BIT(RXOVERRUN) : 0; -+ value |= (mask & PHYTMAC_INT_RX_DESC_FULL) ? PHYTMAC_BIT(RUB) : 0; -+ -+ return value; -+} -+ -+static u32 phytmac_get_irq_status(u32 value) -+{ -+ u32 status = 0; -+ -+ status |= (value & PHYTMAC_BIT(TXCOMP)) ? PHYTMAC_INT_TX_COMPLETE : 0; -+ status |= (value & PHYTMAC_BIT(BUS_ERR)) ? PHYTMAC_INT_TX_ERR : 0; -+ status |= (value & PHYTMAC_BIT(RXCOMP)) ? PHYTMAC_INT_RX_COMPLETE : 0; -+ status |= (value & PHYTMAC_BIT(RXOVERRUN)) ? PHYTMAC_INT_RX_OVERRUN : 0; -+ status |= (value & PHYTMAC_BIT(RUB)) ? PHYTMAC_INT_RX_DESC_FULL : 0; -+ -+ return status; -+} -+ -+static void phytmac_enable_irq(struct phytmac *pdata, -+ int queue_index, u32 mask) -+{ -+ u32 value; -+ -+ value = phytmac_get_irq_mask(mask); -+ -+ if (queue_index == 0) -+ PHYTMAC_WRITE(pdata, PHYTMAC_IE, value); -+ else -+ PHYTMAC_WRITE(pdata, PHYTMAC_IER(queue_index - 1), value); -+} -+ -+static void phytmac_disable_irq(struct phytmac *pdata, -+ int queue_index, u32 mask) -+{ -+ u32 value; -+ -+ value = phytmac_get_irq_mask(mask); -+ -+ if (queue_index == 0) -+ PHYTMAC_WRITE(pdata, PHYTMAC_ID, value); -+ else -+ PHYTMAC_WRITE(pdata, PHYTMAC_IDR(queue_index - 1), value); -+} -+ -+static void phytmac_clear_irq(struct phytmac *pdata, -+ int queue_index, u32 mask) -+{ -+ u32 value; -+ -+ value = phytmac_get_irq_mask(mask); -+ -+ if (queue_index == 0) -+ PHYTMAC_WRITE(pdata, PHYTMAC_IS, value); -+ else -+ PHYTMAC_WRITE(pdata, PHYTMAC_ISR(queue_index - 1), value); -+} -+ -+static unsigned int phytmac_get_intx_mask(struct phytmac *pdata) -+{ -+ u32 value; -+ -+ value = PHYTMAC_READ(pdata, PHYTMAC_INTX_IRQ_MASK); -+ PHYTMAC_WRITE(pdata, PHYTMAC_INTX_IRQ_MASK, value); -+ -+ return value; -+} -+ -+static unsigned int phytmac_get_irq(struct phytmac *pdata, int queue_index) -+{ -+ u32 status, value; -+ -+ if (queue_index == 0) -+ value = PHYTMAC_READ(pdata, PHYTMAC_IS); -+ else -+ value = PHYTMAC_READ(pdata, PHYTMAC_ISR(queue_index - 1)); -+ -+ status = phytmac_get_irq_status(value); -+ -+ return status; -+} -+ -+static unsigned int phytmac_tx_map_desc(struct phytmac_queue *queue, -+ u32 tx_tail, struct packet_info *packet) -+{ -+ unsigned int i, ctrl; -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_dma_desc *desc; -+ struct phytmac_tx_skb *tx_skb; -+ unsigned int eof = 1; -+ -+ i = tx_tail; -+ -+ if (!(pdata->capacities & PHYTMAC_CAPS_TAILPTR)) { -+ ctrl = PHYTMAC_BIT(TX_USED); -+ desc = phytmac_get_tx_desc(queue, i); -+ desc->desc1 = ctrl; -+ } -+ -+ do { -+ i--; -+ tx_skb = phytmac_get_tx_skb(queue, i); -+ desc = phytmac_get_tx_desc(queue, i); -+ -+ ctrl = (u32)tx_skb->length; -+ if (eof) { -+ ctrl |= PHYTMAC_BIT(TX_LAST); -+ eof = 0; -+ } -+ -+ if (unlikely(i == (pdata->tx_ring_size - 1))) -+ ctrl |= PHYTMAC_BIT(TX_WRAP); -+ -+ if (i == queue->tx_tail) { -+ ctrl |= PHYTMAC_BITS(TX_LSO, packet->lso); -+ ctrl |= PHYTMAC_BITS(TX_TCP_SEQ_SRC, packet->seq); -+ if (packet->nocrc) -+ ctrl |= PHYTMAC_BIT(TX_NOCRC); -+ } else { -+ ctrl |= PHYTMAC_BITS(MSS_MFS, packet->mss); -+ } -+ -+ desc->desc2 = upper_32_bits(tx_skb->addr); -+ desc->desc0 = lower_32_bits(tx_skb->addr); -+ /* Make newly descriptor visible to hardware */ -+ wmb(); -+ desc->desc1 = ctrl; -+ } while (i != queue->tx_tail); -+ -+ return 0; -+} -+ -+static void phytmac_init_rx_map_desc(struct phytmac_queue *queue, -+ u32 index) -+{ -+ struct phytmac_dma_desc *desc; -+ -+ desc = phytmac_get_rx_desc(queue, index); -+ -+ desc->desc1 = 0; -+ /* Make newly descriptor to hardware */ -+ dma_wmb(); -+ desc->desc0 |= PHYTMAC_BIT(RX_USED); -+} -+ -+static unsigned int phytmac_rx_map_desc(struct phytmac_queue *queue, -+ u32 index, dma_addr_t addr) -+{ -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_dma_desc *desc; -+ -+ desc = phytmac_get_rx_desc(queue, index); -+ -+ if (addr) { -+ if (unlikely(index == (pdata->rx_ring_size - 1))) -+ addr |= PHYTMAC_BIT(RX_WRAP); -+ desc->desc1 = 0; -+ desc->desc2 = upper_32_bits(addr); -+ desc->desc0 = lower_32_bits(addr) | PHYTMAC_BIT(RX_USED); -+ } -+ return 0; -+} -+ -+static unsigned int phytmac_rx_clean_desc(struct phytmac_queue *queue, u32 count) -+{ -+ struct phytmac_dma_desc *desc; -+ u32 index = queue->rx_head + count - 1; -+ -+ while (count) { -+ desc = phytmac_get_rx_desc(queue, index); -+ desc->desc0 &= ~PHYTMAC_BIT(RX_USED); -+ dma_wmb(); -+ index--; -+ count--; -+ } -+ -+ return 0; -+} -+ -+static void phytmac_tx_start(struct phytmac_queue *queue) -+{ -+ struct phytmac *pdata = queue->pdata; -+ -+ if (pdata->capacities & PHYTMAC_CAPS_TAILPTR) -+ PHYTMAC_WRITE(pdata, PHYTMAC_TAILPTR(queue->index), -+ BIT(31) | queue->tx_tail); -+ -+ if (pdata->capacities & PHYTMAC_CAPS_START) -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, -+ PHYTMAC_READ(pdata, PHYTMAC_NCTRL) | PHYTMAC_BIT(TSTART)); -+} -+ -+static void phytmac_restart(struct phytmac *pdata) -+{ -+ int q; -+ struct phytmac_queue *queue; -+ -+ for (q = 0; q < pdata->queues_num; q++) { -+ queue = &pdata->queues[q]; -+ if (queue->tx_head != queue->tx_tail) { -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, -+ PHYTMAC_READ(pdata, PHYTMAC_NCTRL) | PHYTMAC_BIT(TSTART)); -+ break; -+ } -+ } -+} -+ -+static int phytmac_tx_complete(const struct phytmac_dma_desc *desc) -+{ -+ return PHYTMAC_GET_BITS(desc->desc1, TX_USED); -+} -+ -+static int phytmac_rx_complete(const struct phytmac_dma_desc *desc) -+{ -+ return (desc->desc0 & PHYTMAC_BIT(RX_USED)) != 0; -+} -+ -+static int phytmac_rx_pkt_len(struct phytmac *pdata, const struct phytmac_dma_desc *desc) -+{ -+ if (pdata->capacities & PHYTMAC_CAPS_JUMBO) -+ return desc->desc1 & PHYTMAC_JUMBO_FRAME_MASK; -+ else -+ return desc->desc1 & PHYTMAC_FRAME_MASK; -+} -+ -+static dma_addr_t phytmac_get_desc_addr(const struct phytmac_dma_desc *desc) -+{ -+ dma_addr_t addr = 0; -+ -+ addr = ((u64)(desc->desc2) << 32); -+ -+ addr |= (desc->desc0 & 0xfffffffc); -+ return addr; -+} -+ -+static bool phytmac_rx_checksum(const struct phytmac_dma_desc *desc) -+{ -+ u32 value = desc->desc1; -+ u32 check = value >> PHYTMAC_RX_CSUM_INDEX & 0x3; -+ -+ return (check == PHYTMAC_RX_CSUM_IP_TCP || check == PHYTMAC_RX_CSUM_IP_UDP); -+} -+ -+static bool phytmac_rx_single_buffer(const struct phytmac_dma_desc *desc) -+{ -+ u32 value = desc->desc1; -+ -+ return ((value & PHYTMAC_BIT(RX_SOF)) && (value & PHYTMAC_BIT(RX_EOF))); -+} -+ -+static bool phytmac_rx_sof(const struct phytmac_dma_desc *desc) -+{ -+ u32 value = desc->desc1; -+ -+ return (value & PHYTMAC_BIT(RX_SOF)); -+} -+ -+static bool phytmac_rx_eof(const struct phytmac_dma_desc *desc) -+{ -+ u32 value = desc->desc1; -+ -+ return (value & PHYTMAC_BIT(RX_EOF)); -+} -+ -+static void phytmac_clear_rx_desc(struct phytmac_queue *queue, int begin, int end) -+{ -+ unsigned int frag; -+ unsigned int tmp = end; -+ struct phytmac_dma_desc *desc; -+ -+ if (begin > end) -+ tmp = end + queue->pdata->rx_ring_size; -+ -+ for (frag = begin; frag != end; frag++) { -+ desc = phytmac_get_rx_desc(queue, frag); -+ desc->desc0 &= ~PHYTMAC_BIT(RX_USED); -+ } -+} -+ -+static void phytmac_mac_interface_config(struct phytmac *pdata, unsigned int mode, -+ const struct phylink_link_state *state) -+{ -+ u32 old_ctrl, old_config; -+ u32 ctrl, config, usxctl; -+ -+ old_ctrl = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); -+ old_config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); -+ ctrl = old_ctrl; -+ config = old_config; -+ -+ if (state->speed == SPEED_10000) -+ PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_10000M); -+ else if (state->speed == SPEED_5000) -+ PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_5000M); -+ else if (state->speed == SPEED_2500) -+ PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_2500M); -+ else if (state->speed == SPEED_1000) -+ PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_1000M); -+ else if (state->speed == SPEED_100 || state->speed == SPEED_10) -+ PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_100M); -+ -+ config &= ~(PHYTMAC_BIT(SGMII_EN) | PHYTMAC_BIT(PCS_EN) -+ | PHYTMAC_BIT(SPEED) | PHYTMAC_BIT(FD) | PHYTMAC_BIT(GM_EN)); -+ ctrl &= ~(PHYTMAC_BIT(HIGHSPEED) | PHYTMAC_BIT(2PT5G)); -+ -+ if (state->interface == PHY_INTERFACE_MODE_SGMII) { -+ config |= PHYTMAC_BIT(SGMII_EN) | PHYTMAC_BIT(PCS_EN); -+ if (state->speed == SPEED_1000) -+ config |= PHYTMAC_BIT(GM_EN); -+ else if (state->speed == SPEED_2500) -+ config |= PHYTMAC_BIT(2PT5G); -+ } else if (state->interface == PHY_INTERFACE_MODE_1000BASEX) { -+ config |= PHYTMAC_BIT(PCS_EN) | PHYTMAC_BIT(GM_EN); -+ } else if (state->interface == PHY_INTERFACE_MODE_2500BASEX) { -+ config |= PHYTMAC_BIT(2PT5G) | PHYTMAC_BIT(PCS_EN); -+ } else if (state->interface == PHY_INTERFACE_MODE_10GBASER || -+ state->interface == PHY_INTERFACE_MODE_USXGMII || -+ state->interface == PHY_INTERFACE_MODE_5GBASER) { -+ usxctl = PHYTMAC_READ(pdata, PHYTMAC_USXCTRL); -+ if (state->speed == SPEED_10000) { -+ usxctl = PHYTMAC_SET_BITS(usxctl, SERDES_RATE, PHYTMAC_SERDES_RATE_10G); -+ usxctl = PHYTMAC_SET_BITS(usxctl, USX_SPEED, PHYTMAC_SPEED_10000M); -+ } else if (state->speed == SPEED_5000) { -+ usxctl = PHYTMAC_SET_BITS(usxctl, SERDES_RATE, PHYTMAC_SERDES_RATE_5G); -+ usxctl = PHYTMAC_SET_BITS(usxctl, USX_SPEED, PHYTMAC_SPEED_5000M); -+ } -+ usxctl |= PHYTMAC_BIT(RX_EN) | PHYTMAC_BIT(TX_EN); -+ PHYTMAC_WRITE(pdata, PHYTMAC_USXCTRL, usxctl); -+ -+ config |= PHYTMAC_BIT(PCS_EN); -+ ctrl |= PHYTMAC_BIT(HIGHSPEED); -+ } -+ -+ if (state->duplex) -+ config |= PHYTMAC_BIT(FD); -+ -+ if (old_ctrl ^ ctrl) -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, ctrl); -+ -+ if (old_config ^ config) -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); -+ -+ /* Disable AN for SGMII fixed link configuration, enable otherwise.*/ -+ if (state->interface == PHY_INTERFACE_MODE_SGMII) -+ phytmac_enable_autoneg(pdata, mode == MLO_AN_FIXED ? 0 : 1); -+ if (state->interface == PHY_INTERFACE_MODE_1000BASEX) -+ phytmac_enable_autoneg(pdata, 1); -+} -+ -+static unsigned int phytmac_pcs_get_link(struct phytmac *pdata, -+ phy_interface_t interface) -+{ -+ if (interface == PHY_INTERFACE_MODE_SGMII || -+ interface == PHY_INTERFACE_MODE_1000BASEX || -+ interface == PHY_INTERFACE_MODE_2500BASEX) -+ return PHYTMAC_READ_BITS(pdata, PHYTMAC_NSTATUS, PCS_LINK); -+ else if (interface == PHY_INTERFACE_MODE_USXGMII || -+ interface == PHY_INTERFACE_MODE_10GBASER) -+ return PHYTMAC_READ_BITS(pdata, PHYTMAC_USXSTATUS, USX_PCS_LINK); -+ -+ return 0; -+} -+ -+static void phytmac_clear_tx_desc(struct phytmac_queue *queue) -+{ -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_dma_desc *desc = NULL; -+ int i; -+ -+ for (i = 0; i < queue->pdata->tx_ring_size; i++) { -+ desc = phytmac_get_tx_desc(queue, i); -+ desc->desc2 = 0; -+ desc->desc0 = 0; -+ /* make newly desc1 to hardware */ -+ wmb(); -+ desc->desc1 = PHYTMAC_BIT(TX_USED); -+ } -+ desc->desc1 |= PHYTMAC_BIT(TX_WRAP); -+ -+ if (pdata->capacities & PHYTMAC_CAPS_TAILPTR) -+ PHYTMAC_WRITE(pdata, PHYTMAC_TAILPTR(queue->index), queue->tx_tail); -+} -+ -+static void phytmac_get_hw_stats(struct phytmac *pdata) -+{ -+ u32 stats[45]; -+ int i, j; -+ u64 val; -+ u64 *p = &pdata->stats.tx_octets; -+ -+ for (i = 0 ; i < 45; i++) -+ stats[i] = PHYTMAC_READ(pdata, PHYTMAC_OCTTX + i * 4); -+ -+ for (i = 0, j = 0; i < 45; i++) { -+ if (i == 0 || i == 20) { -+ val = (u64)stats[i + 1] << 32 | stats[i]; -+ *p += val; -+ pdata->ethtool_stats[j] = *p; -+ ++j; -+ ++p; -+ } else { -+ if (i != 1 && i != 21) { -+ val = stats[i]; -+ *p += val; -+ pdata->ethtool_stats[j] = *p; -+ ++j; -+ ++p; -+ } -+ } -+ } -+} -+ -+static void phytmac_get_time(struct phytmac *pdata, struct timespec64 *ts) -+{ -+ u32 ns, secl, sech; -+ -+ ns = PHYTMAC_READ(pdata, PHYTMAC_TN); -+ secl = PHYTMAC_READ(pdata, PHYTMAC_TSL); -+ sech = PHYTMAC_READ(pdata, PHYTMAC_TSH); -+ -+ ts->tv_nsec = ns; -+ ts->tv_sec = (((u64)sech << 32) | secl) & SEC_MAX_VAL; -+} -+ -+static void phytmac_set_time(struct phytmac *pdata, time64_t sec, long nsec) -+{ -+ u32 secl, sech; -+ -+ secl = (u32)sec; -+ sech = (sec >> 32) & (0xffff); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_TN, 0); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TSH, sech); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TSL, secl); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TN, nsec); -+} -+ -+static void phytmac_clear_time(struct phytmac *pdata) -+{ -+ u32 value; -+ -+ pdata->ts_incr.sub_ns = 0; -+ pdata->ts_incr.ns = 0; -+ -+ value = PHYTMAC_READ(pdata, PHYTMAC_TISN); -+ value = PHYTMAC_SET_BITS(value, SUB_NSECL, 0); -+ value = PHYTMAC_SET_BITS(value, SUB_NSECH, 0); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TISN, value); -+ -+ value = PHYTMAC_READ(pdata, PHYTMAC_TI); -+ value = PHYTMAC_SET_BITS(value, INCR_NS, 0); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TI, value); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_TA, 0); -+} -+ -+static int phytmac_set_tsmode(struct phytmac *pdata, struct ts_ctrl *ctrl) -+{ -+ if (ctrl->rx_control == TS_ALL_PTP_FRAMES) -+ PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, -+ PHYTMAC_READ(pdata, PHYTMAC_NCTRL) | PHYTMAC_BIT(STORE_RX_TS)); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_TXBDCTRL, PHYTMAC_BITS(TX_TSMODE, ctrl->tx_control)); -+ PHYTMAC_WRITE(pdata, PHYTMAC_RXBDCTRL, PHYTMAC_BITS(RX_TSMODE, ctrl->rx_control)); -+ -+ return 0; -+} -+ -+static int phytmac_set_tsincr(struct phytmac *pdata, struct ts_incr *incr) -+{ -+ u32 value; -+ -+ value = PHYTMAC_BITS(SUB_NSECL, incr->sub_ns) | -+ PHYTMAC_BITS(SUB_NSECH, incr->sub_ns >> 8); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TISN, value); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TI, incr->ns); -+ -+ return 0; -+} -+ -+static void phytmac_ptp_init_hw(struct phytmac *pdata) -+{ -+ struct timespec64 ts; -+ -+ ts = ns_to_timespec64(ktime_to_ns(ktime_get_real())); -+ phytmac_set_time(pdata, ts.tv_sec, ts.tv_nsec); -+ -+ phytmac_set_tsincr(pdata, &pdata->ts_incr); -+} -+ -+static int phytmac_adjust_fine(struct phytmac *pdata, long ppm, bool negative) -+{ -+ struct ts_incr ts_incr; -+ u32 tmp; -+ u64 adj; -+ -+ ts_incr.ns = pdata->ts_incr.ns; -+ ts_incr.sub_ns = pdata->ts_incr.sub_ns; -+ -+ tmp = ((u64)ts_incr.ns << PHYTMAC_SUB_NSECL_INDEX) + ts_incr.sub_ns; -+ adj = ((u64)ppm * tmp + (USEC_PER_SEC >> 1)) >> PHYTMAC_SUB_NSECL_INDEX; -+ -+ adj = div_u64(adj, USEC_PER_SEC); -+ adj = negative ? (tmp - adj) : (tmp + adj); -+ -+ ts_incr.ns = (adj >> PHYTMAC_SUB_NSEC_WIDTH) -+ & ((1 << PHYTMAC_SUB_NSECL_WIDTH) - 1); -+ ts_incr.sub_ns = adj & ((1 << PHYTMAC_SUB_NSEC_WIDTH) - 1); -+ -+ phytmac_set_tsincr(pdata, &ts_incr); -+ -+ return 0; -+} -+ -+static int phytmac_adjust_time(struct phytmac *pdata, s64 delta, int neg) -+{ -+ u32 adj; -+ -+ if (delta > PHYTMAC_ADJUST_SEC_MAX) { -+ struct timespec64 now, then; -+ -+ if (neg) -+ then = ns_to_timespec64(-delta); -+ else -+ then = ns_to_timespec64(delta); -+ phytmac_get_time(pdata, &now); -+ now = timespec64_add(now, then); -+ phytmac_set_time(pdata, now.tv_sec, now.tv_nsec); -+ } else { -+ adj = (neg << PHYTMAC_INCR_ADD_INDEX) | delta; -+ PHYTMAC_WRITE(pdata, PHYTMAC_TA, adj); -+ } -+ -+ return 0; -+} -+ -+static int phytmac_ts_valid(struct phytmac *pdata, struct phytmac_dma_desc *desc, int direction) -+{ -+ int ts_valid = 0; -+ -+ if (direction == PHYTMAC_TX) -+ ts_valid = desc->desc1 & PHYTMAC_BIT(TX_TS_VALID); -+ else if (direction == PHYTMAC_RX) -+ ts_valid = desc->desc0 & PHYTMAC_BIT(RX_TS_VALID); -+ return ts_valid; -+} -+ -+static void phytmac_get_dma_ts(struct phytmac *pdata, u32 ts_1, u32 ts_2, struct timespec64 *ts) -+{ -+ struct timespec64 ts2; -+ -+ ts->tv_sec = (PHYTMAC_GET_BITS(ts_2, DMA_SECH) << 2) | -+ PHYTMAC_GET_BITS(ts_1, DMA_SECL); -+ ts->tv_nsec = PHYTMAC_GET_BITS(ts_1, DMA_NSEC); -+ -+ phytmac_get_time(pdata, &ts2); -+ -+ if (((ts->tv_sec ^ ts2.tv_sec) & (PHYTMAC_DMA_SEC_TOP >> 1)) != 0) -+ ts->tv_sec -= PHYTMAC_DMA_SEC_TOP; -+ -+ ts->tv_sec += (ts2.tv_sec & (~PHYTMAC_DMA_SEC_MASK)); -+} -+ -+static unsigned int phytmac_get_ts_rate(struct phytmac *pdata) -+{ -+ return 300000000; -+} -+ -+struct phytmac_hw_if phytmac_1p0_hw = { -+ .reset_hw = phytmac_reset_hw, -+ .init_hw = phytmac_init_hw, -+ .init_ring_hw = phytmac_init_ring_hw, -+ .get_feature = phytmac_get_feature_all, -+ .get_regs = phytmac_get_regs, -+ .get_stats = phytmac_get_hw_stats, -+ .set_mac_address = phytmac_set_mac_addr, -+ .get_mac_address = phytmac_get_mac_addr, -+ .mdio_read = phytmac_mdio_data_read_c22, -+ .mdio_write = phytmac_mdio_data_write_c22, -+ .mdio_read_c45 = phytmac_mdio_data_read_c45, -+ .mdio_write_c45 = phytmac_mdio_data_write_c45, -+ .poweron = phytmac_powerup_hw, -+ .set_wol = phytmac_set_wake, -+ .enable_promise = phytmac_enable_promise, -+ .enable_multicast = phytmac_enable_multicast, -+ .set_hash_table = phytmac_set_mc_hash, -+ .enable_rx_csum = phytmac_enable_rxcsum, -+ .enable_tx_csum = phytmac_enable_txcsum, -+ .enable_mdio_control = phytmac_enable_mdio, -+ .enable_autoneg = phytmac_enable_autoneg, -+ .enable_pause = phytmac_enable_pause, -+ .enable_network = phytmac_enable_network, -+ .add_fdir_entry = phytmac_add_fdir_entry, -+ .del_fdir_entry = phytmac_del_fdir_entry, -+ /* mac config */ -+ .mac_config = phytmac_mac_interface_config, -+ .mac_linkup = phytmac_mac_linkup, -+ .mac_linkdown = phytmac_mac_linkdown, -+ .pcs_linkup = phytmac_pcs_linkup, -+ .pcs_linkdown = phytmac_pcs_linkdown, -+ .get_link = phytmac_pcs_get_link, -+ /* irq */ -+ .enable_irq = phytmac_enable_irq, -+ .disable_irq = phytmac_disable_irq, -+ .clear_irq = phytmac_clear_irq, -+ .get_irq = phytmac_get_irq, -+ .get_intx_mask = phytmac_get_intx_mask, -+ /* tx and rx */ -+ .tx_map = phytmac_tx_map_desc, -+ .transmit = phytmac_tx_start, -+ .restart = phytmac_restart, -+ .tx_complete = phytmac_tx_complete, -+ .rx_complete = phytmac_rx_complete, -+ .get_rx_pkt_len = phytmac_rx_pkt_len, -+ .get_desc_addr = phytmac_get_desc_addr, -+ .init_rx_map = phytmac_init_rx_map_desc, -+ .rx_map = phytmac_rx_map_desc, -+ .rx_clean = phytmac_rx_clean_desc, -+ .rx_checksum = phytmac_rx_checksum, -+ .rx_single_buffer = phytmac_rx_single_buffer, -+ .rx_pkt_start = phytmac_rx_sof, -+ .rx_pkt_end = phytmac_rx_eof, -+ .clear_rx_desc = phytmac_clear_rx_desc, -+ .clear_tx_desc = phytmac_clear_tx_desc, -+ /* ptp */ -+ .init_ts_hw = phytmac_ptp_init_hw, -+ .set_time = phytmac_set_time, -+ .clear_time = phytmac_clear_time, -+ .get_time = phytmac_get_time, -+ .set_ts_config = phytmac_set_tsmode, -+ .set_incr = phytmac_set_tsincr, -+ .adjust_fine = phytmac_adjust_fine, -+ .adjust_time = phytmac_adjust_time, -+ .ts_valid = phytmac_ts_valid, -+ .get_timestamp = phytmac_get_dma_ts, -+ .get_ts_rate = phytmac_get_ts_rate, -+}; -+EXPORT_SYMBOL_GPL(phytmac_1p0_hw); -diff --git a/drivers/net/ethernet/phytium/phytmac_v1.h b/drivers/net/ethernet/phytium/phytmac_v1.h -new file mode 100644 -index 000000000..d8de2c26c ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac_v1.h -@@ -0,0 +1,455 @@ -+/* SPDX-License-Identifier: GPL-2.0-only */ -+#ifndef _PHYTMAC_V1_H -+#define _PHYTMAC_V1_H -+ -+extern struct phytmac_hw_if phytmac_1p0_hw; -+ -+#define PHYTMAC_FRAME_MASK 0x1fff -+#define PHYTMAC_JUMBO_FRAME_MASK 0x3fff -+ -+#define PHYTMAC_SPEED_100M 0 -+#define PHYTMAC_SPEED_1000M 1 -+#define PHYTMAC_SPEED_2500M 2 -+#define PHYTMAC_SPEED_5000M 3 -+#define PHYTMAC_SPEED_10000M 4 -+#define PHYTMAC_SERDES_RATE_5G 0 -+#define PHYTMAC_SERDES_RATE_10G 1 -+ -+#define PHYTMAC_NCTRL 0x0000 -+#define PHYTMAC_NCONFIG 0x0004 -+#define PHYTMAC_NSTATUS 0x0008 -+#define PHYTMAC_DCONFIG 0x0010 -+#define PHYTMAC_RXPTR_Q0 0x0018 -+#define PHYTMAC_TXPTR_Q0 0x001C -+#define PHYTMAC_IS 0x0024 -+#define PHYTMAC_IE 0x0028 -+#define PHYTMAC_ID 0x002C -+#define PHYTMAC_IM 0x0030 -+#define PHYTMAC_MDATA 0x0034 -+#define PHYTMAC_HCONFIG 0x0050 -+#define PHYTMAC_AXICTRL 0x0054 -+#define PHYTMAC_INT_MODERATION 0x005C -+#define PHYTMAC_HASHB 0x0080 -+#define PHYTMAC_HASHT 0x0084 -+#define PHYTMAC_MAC1B 0x0088 -+#define PHYTMAC_MAC1T 0x008C -+#define PHYTMAC_WOL 0x00B8 -+#define PHYTMAC_OCTTX 0x0100 -+#define PHYTMAC_TISN 0x01BC -+#define PHYTMAC_TSH 0x01C0 -+#define PHYTMAC_TSL 0x01D0 -+#define PHYTMAC_TN 0x01D4 -+#define PHYTMAC_TA 0x01D8 -+#define PHYTMAC_TI 0x01DC -+#define PHYTMAC_PCSCTRL 0x0200 -+#define PHYTMAC_PCSSTATUS 0x0204 -+#define PHYTMAC_PCSANLPBASE 0x0214 -+#define PHYTMAC_DEFAULT1 0x0280 /* Default HW Config 1 */ -+#define PHYTMAC_DEFAULT2 0x0294 /* Default HW Config 2 */ -+#define PHYTMAC_DEFAULT3 0x029C /* Default HW Config 3 */ -+#define PHYTMAC_DEFAULT4 0x02A4 /* Default HW Config 4 */ -+#define PHYTMAC_DEFAULT5 0x02AC /* Default HW Config 5 */ -+#define PHYTMAC_USXCTRL 0x0A80 -+#define PHYTMAC_USXSTATUS 0x0A88 -+#define PHYTMAC_TXBDCTRL 0x04CC -+#define PHYTMAC_RXBDCTRL 0x04D0 -+ -+/* Fdir match registers */ -+#define PHYTMAC_FDIR(i) (0x0540 + ((i) << 2)) -+ -+/* EtherType registers */ -+#define PHYTMAC_ETHT(i) (0x06E0 + ((i) << 2)) -+ -+/* Fdir compare registers */ -+#define PHYTMAC_COMP1(i) (0x0700 + ((i) << 3)) -+#define PHYTMAC_COMP2(i) (0x0704 + ((i) << 3)) -+ -+#define PHYTMAC_ISR(i) (0x0400 + ((i) << 2)) -+#define PHYTMAC_TXPTR(i) (0x0440 + ((i) << 2)) -+#define PHYTMAC_RXPTR(i) (0x0480 + ((i) << 2)) -+#define PHYTMAC_RBQS(i) (0x04A0 + ((i) << 2)) -+#define PHYTMAC_TXPTRH(i) (0x04c8) -+#define PHYTMAC_RXPTRH(i) (0x04d4) -+ -+#define PHYTMAC_IER(i) (0x0600 + ((i) << 2)) -+#define PHYTMAC_IDR(i) (0x0620 + ((i) << 2)) -+#define PHYTMAC_IMR(i) (0x0640 + ((i) << 2)) -+#define PHYTMAC_TAIL_ENABLE (0x0e7c) -+#define PHYTMAC_TAILPTR(i) (0x0e80 + ((i) << 2)) -+ -+#define PHYTMAC_PHY_INT_ENABLE 0x1C88 -+#define PHYTMAC_PHY_INT_CLEAR 0x1C8C -+#define PHYTMAC_PHY_INT_STATE 0x1C90 -+#define PHYTMAC_INTX_IRQ_MASK 0x1C7C -+ -+#define PHYTMAC_READ_NSTATUS(pdata) PHYTMAC_READ(pdata, PHYTMAC_NSTATUS) -+ -+/* Ethernet Network Control Register */ -+#define PHYTMAC_RE_INDEX 2 /* Receive enable */ -+#define PHYTMAC_RE_WIDTH 1 -+#define PHYTMAC_TE_INDEX 3 /* Transmit enable */ -+#define PHYTMAC_TE_WIDTH 1 -+#define PHYTMAC_MPE_INDEX 4 /* Management port enable */ -+#define PHYTMAC_MPE_WIDTH 1 -+#define PHYTMAC_CLEARSTAT_INDEX 5 /* Clear stats regs */ -+#define PHYTMAC_CLEARSTAT_WIDTH 1 -+#define PHYTMAC_TSTART_INDEX 9 /* Start transmission */ -+#define PHYTMAC_TSTART_WIDTH 1 -+#define PHYTMAC_THALT_INDEX 10 /* Transmit halt */ -+#define PHYTMAC_THALT_WIDTH 1 -+#define PHYTMAC_STORE_RX_TS_INDEX 15 -+#define PHYTMAC_STORE_RX_TS_WIDTH 1 -+#define PHYTMAC_OSSMODE_INDEX 24 /* Enable One Step Synchro Mode */ -+#define PHYTMAC_OSSMODE_WIDTH 1 -+#define PHYTMAC_2PT5G_INDEX 29 /* 2.5G operation selected */ -+#define PHYTMAC_2PT5G_WIDTH 1 -+#define PHYTMAC_HIGHSPEED_INDEX 31 /* High speed enable */ -+#define PHYTMAC_HIGHSPEED_WIDTH 1 -+ -+/* Ethernet Network Config Register */ -+#define PHYTMAC_SPEED_INDEX 0 /* Speed */ -+#define PHYTMAC_SPEED_WIDTH 1 -+#define PHYTMAC_FD_INDEX 1 /* Full duplex */ -+#define PHYTMAC_FD_WIDTH 1 -+#define PHYTMAC_JUMBO_EN_INDEX 3 /* Transmit enable */ -+#define PHYTMAC_JUMBO_EN_WIDTH 1 -+#define PHYTMAC_PROMISC_INDEX 4 /* Copy all frames */ -+#define PHYTMAC_PROMISC_WIDTH 1 -+#define PHYTMAC_NO_BCAST_INDEX 5 /* No broadcast */ -+#define PHYTMAC_NO_BCAST_WIDTH 1 -+#define PHYTMAC_MH_EN_INDEX 6 /* Multicast hash enable */ -+#define PHYTMAC_MH_EN_WIDTH 1 -+#define PHYTMAC_RCV_BIG_INDEX 8 -+#define PHYTMAC_RCV_BIG_WIDTH 1 -+#define PHYTMAC_GM_EN_INDEX 10 /* Gigabit mode enable */ -+#define PHYTMAC_GM_EN_WIDTH 1 -+#define PHYTMAC_PCS_EN_INDEX 11 /* PCS select */ -+#define PHYTMAC_PCS_EN_WIDTH 1 -+#define PHYTMAC_PAUSE_EN_INDEX 13 /* Pause enable */ -+#define PHYTMAC_PAUSE_EN_WIDTH 1 -+#define PHYTMAC_FCS_REMOVE_INDEX 17 /* FCS remove */ -+#define PHYTMAC_FCS_REMOVE_WIDTH 1 -+#define PHYTMAC_MCD_INDEX 18 /* MDC clock division */ -+#define PHYTMAC_MCD_WIDTH 3 -+#define PHYTMAC_DBW64_INDEX 21 /* Data bus width */ -+#define PHYTMAC_DBW64_WIDTH 1 -+#define PHYTMAC_DBW128_INDEX 22 /* Data bus width */ -+#define PHYTMAC_DBW128_WIDTH 1 -+#define PHYTMAC_DBW_32 1 -+#define PHYTMAC_DBW_64 2 -+#define PHYTMAC_DBW_128 4 -+#define PHYTMAC_RCO_EN_INDEX 24 /* Receive checksum offload enable */ -+#define PHYTMAC_RCO_EN_WIDTH 1 -+#define PHYTMAC_SGMII_EN_INDEX 27 /* Sgmii mode enable */ -+#define PHYTMAC_SGMII_EN_WIDTH 1 -+ -+/* Ethernet Network Status Register */ -+#define PHYTMAC_PCS_LINK_INDEX 0 /* PCS link status */ -+#define PHYTMAC_PCS_LINK_WIDTH 1 -+#define PHYTMAC_MDIO_IDLE_INDEX 2 /* Mdio idle */ -+#define PHYTMAC_MDIO_IDLE_WIDTH 1 -+#define PHYTMAC_PCS_FD_INDEX 3 /* PCS auto negotiation duplex resolution */ -+#define PHYTMAC_PCS_FD__WIDTH 1 -+ -+/* Ethernet Network Dma config Register */ -+#define PHYTMAC_BURST_INDEX 0 /* Amba burst length */ -+#define PHYTMAC_BURST_WIDTH 5 -+#define PHYTMAC_ENDIA_PKT_INDEX 6 -+#define PHYTMAC_ENDIA_PKT_WIDTH 1 -+#define PHYTMAC_ENDIA_DESC_INDEX 7 -+#define PHYTMAC_ENDIA_DESC_WIDTH 1 -+#define PHYTMAC_TCO_EN_INDEX 11 /* Tx Checksum Offload en */ -+#define PHYTMAC_TCO_EN_WIDTH 1 -+#define PHYTMAC_RX_BUF_LEN_INDEX 16 /* DMA receive buffer size */ -+#define PHYTMAC_RX_BUF_LEN_WIDTH 8 -+#define PHYTMAC_RX_EXBD_EN_INDEX 28 /* Enable RX extended BD mode */ -+#define PHYTMAC_RX_EXBD_EN_WIDTH 1 -+#define PHYTMAC_TX_EXBD_EN_INDEX 29 /* Enable TX extended BD mode */ -+#define PHYTMAC_TX_EXBD_EN_WIDTH 1 -+#define PHYTMAC_ABW_INDEX 30 /* DMA address bus width */ -+#define PHYTMAC_ABW_WIDTH 1 -+ -+/* Int stauts/Enable/Disable/Mask Register */ -+#define PHYTMAC_RXCOMP_INDEX 1 /* Rx complete */ -+#define PHYTMAC_RXCOMP_WIDTH 1 -+#define PHYTMAC_RUB_INDEX 2 /* Rx used bit read */ -+#define PHYTMAC_RUB_WIDTH 1 -+#define PHYTMAC_BUS_ERR_INDEX 6 /* AMBA error */ -+#define PHYTMAC_BUS_ERR_WIDTH 1 -+#define PHYTMAC_TXCOMP_INDEX 7 /* Tx complete */ -+#define PHYTMAC_TXCOMP_WIDTH 1 -+#define PHYTMAC_RXOVERRUN_INDEX 10 /* Tx overrun */ -+#define PHYTMAC_RXOVERRUN_WIDTH 1 -+#define PHYTMAC_RESP_ERR_INDEX 11 /* Resp not ok */ -+#define PHYTMAC_RESP_ERR_WIDTH 1 -+ -+/* Mdio read/write Register */ -+#define PHYTMAC_DATA_INDEX 0 /* Data */ -+#define PHYTMAC_DATA_WIDTH 16 -+#define PHYTMAC_MUST_INDEX 16 /* Must Be 10 */ -+#define PHYTMAC_MUST_WIDTH 2 -+#define PHYTMAC_REG_ADDR_INDEX 18 /* Register address */ -+#define PHYTMAC_REG_ADDR_WIDTH 5 -+#define PHYTMAC_PHY_ADDR_INDEX 23 /* Phy address */ -+#define PHYTMAC_PHY_ADDR_WIDTH 5 -+#define PHYTMAC_OPS_INDEX 28 -+#define PHYTMAC_OPS_WIDTH 2 -+#define PHYTMAC_CLAUSE_SEL_INDEX 30 -+#define PHYTMAC_CLAUSE_SEL_WIDTH 1 -+#define PHYTMAC_CLAUSE_C22 1 -+#define PHYTMAC_CLAUSE_C45 0 -+#define PHYTMAC_OPS_C45_ADDR 0 -+#define PHYTMAC_OPS_C45_WRITE 1 -+#define PHYTMAC_OPS_C45_READ 3 -+#define PHYTMAC_OPS_C22_WRITE 1 -+#define PHYTMAC_OPS_C22_READ 2 -+ -+/* hs mac config register */ -+#define PHYTMAC_HS_SPEED_INDEX 0 -+#define PHYTMAC_HS_SPEED_WIDTH 3 -+#define PHYTMAC_HS_SPEED_100M 0 -+#define PHYTMAC_HS_SPEED_1000M 1 -+#define PHYTMAC_HS_SPEED_2500M 2 -+#define PHYTMAC_HS_SPEED_5000M 3 -+#define PHYTMAC_HS_SPEED_10G 4 -+ -+/* WOL register */ -+#define PHYTMAC_ARP_IP_INDEX 0 -+#define PHYTMAC_ARP_IP_WIDTH 16 -+#define PHYTMAC_MAGIC_INDEX 16 -+#define PHYTMAC_MAGIC_WIDTH 1 -+#define PHYTMAC_ARP_INDEX 17 -+#define PHYTMAC_ARP_WIDTH 1 -+#define PHYTMAC_UCAST_INDEX 18 -+#define PHYTMAC_UCAST_WIDTH 1 -+#define PHYTMAC_MCAST_INDEX 19 -+#define PHYTMAC_MCAST_WIDTH 1 -+ -+/* PCSCTRL register */ -+#define PHYTMAC_AUTONEG_INDEX 12 -+#define PHYTMAC_AUTONEG_WIDTH 1 -+#define PHYTMAC_PCS_RESET_INDEX 15 -+#define PHYTMAC_PCS_RESET_WIDTH 1 -+ -+/* DEFAULT1 register */ -+#define PHYTMAC_DBW_INDEX 25 -+#define PHYTMAC_DBW_WIDTH 3 -+ -+/* DEFAULT2 register */ -+#define PHYTMAC_DAW64_INDEX 23 -+#define PHYTMAC_DAW64_WIDTH 1 -+ -+/* DEFAULT3 register */ -+#define PHYTMAC_SCR2CMP_INDEX 0 -+#define PHYTMAC_SCR2CMP_WIDTH 8 -+#define PHYTMAC_SCR2ETH_INDEX 8 -+#define PHYTMAC_SCR2ETH_WIDTH 8 -+ -+/* DEFAULT4 register */ -+#define PHYTMAC_TXDESCRD_INDEX 12 -+#define PHYTMAC_TXDESCRD_WIDTH 4 -+#define PHYTMAC_RXDESCRD_INDEX 8 -+#define PHYTMAC_RXDESCRD_WIDTH 4 -+ -+/* USXCTRL register */ -+#define PHYTMAC_RX_EN_INDEX 0 -+#define PHYTMAC_RX_EN_WIDTH 1 -+#define PHYTMAC_TX_EN_INDEX 1 -+#define PHYTMAC_TX_EN_WIDTH 1 -+#define PHYTMAC_RX_SYNC_RESET_INDEX 2 -+#define PHYTMAC_RX_SYNC_RESET_WIDTH 1 -+#define PHYTMAC_SERDES_RATE_INDEX 12 -+#define PHYTMAC_SERDES_RATE_WIDTH 2 -+#define PHYTMAC_USX_SPEED_INDEX 14 -+#define PHYTMAC_USX_SPEED_WIDTH 3 -+ -+/* Bitfields in USX_STATUS. */ -+#define PHYTMAC_USX_PCS_LINK_INDEX 0 -+#define PHYTMAC_USX_PCS_LINK_WIDTH 1 -+ -+/* Bitfields in PHYTMAC_TISN */ -+#define PHYTMAC_SUB_NSECH_INDEX 0 -+#define PHYTMAC_SUB_NSECH_WIDTH 16 -+#define PHYTMAC_SUB_NSECL_INDEX 24 -+#define PHYTMAC_SUB_NSECL_WIDTH 8 -+#define PHYTMAC_SUB_NSEC_WIDTH 24 -+ -+/* Bitfields in PHYTMAC_TSH */ -+#define PHYTMAC_SECH_INDEX 0 -+#define PHYTMAC_SECH_WIDTH 16 -+ -+/* Bitfields in PHYTMAC_TSL */ -+#define PHYTMAC_SECL_INDEX 0 -+#define PHYTMAC_SECL_WIDTH 32 -+ -+/* Bitfields in PHYTMAC_TN */ -+#define PHYTMAC_NSEC_INDEX 0 -+#define PHYTMAC_NSEC_WIDTH 30 -+ -+/* Bitfields in PHYTMAC_TA */ -+#define PHYTMAC_INCR_SEC_INDEX 0 -+#define PHYTMAC_INCR_SEC_WIDTH 30 -+#define PHYTMAC_INCR_ADD_INDEX 31 -+#define PHYTMAC_INCR_ADD_WIDTH 1 -+#define PHYTMAC_ADJUST_SEC_MAX ((1 << PHYTMAC_INCR_SEC_WIDTH) - 1) -+ -+/* Bitfields in PHYTMAC_TI */ -+#define PHYTMAC_INCR_NS_INDEX 0 -+#define PHYTMAC_INCR_NS_WIDTH 8 -+ -+/* PHYTMAC_TXBDCTRL register */ -+#define PHYTMAC_TX_TSMODE_INDEX 4 -+#define PHYTMAC_TX_TSMODE_WIDTH 2 -+ -+#define PHYTMAC_RX_TSMODE_INDEX 4 -+#define PHYTMAC_RX_TSMODE_WIDTH 2 -+ -+/* Bitfields in PHYTMAC_FDIR */ -+#define PHYTMAC_QUEUE_NUM_INDEX 0 -+#define PHYTMAC_QUEUE_NUM_WIDTH 4 -+#define PHYTMAC_VLAN_PRI_INDEX 4 -+#define PHYTMAC_VLAN_PRI_WIDTH 3 -+#define PHYTMAC_VLAN_EN_INDEX 8 -+#define PHYTMAC_VLAN_EN_WIDTH 1 -+#define PHYTMAC_ETH_TYPE_INDEX 9 -+#define PHYTMAC_ETH_TYPE_WIDTH 3 -+#define PHYTMAC_ETH_EN_INDEX 12 -+#define PHYTMAC_ETH_EN_WIDTH 1 -+#define PHYTMAC_CA_INDEX 13 -+#define PHYTMAC_CA_WIDTH 5 -+#define PHYTMAC_CA_EN_INDEX 18 -+#define PHYTMAC_CA_EN_WIDTH 1 -+#define PHYTMAC_CB_INDEX 19 -+#define PHYTMAC_CB_WIDTH 5 -+#define PHYTMAC_CB_EN_INDEX 24 -+#define PHYTMAC_CB_EN_WIDTH 1 -+#define PHYTMAC_CC_INDEX 25 -+#define PHYTMAC_CC_WIDTH 5 -+#define PHYTMAC_CC_EN_INDEX 30 -+#define PHYTMAC_CC_EN_WIDTH 1 -+ -+/* Bitfields in PHYTMAC_ETHERTYPE */ -+#define PHYTMAC_ETHTYPE_VALUE_INDEX 0 -+#define PHYTMAC_ETHTYPE_VALUE_WIDTH 16 -+ -+/* Bitfields in PHYTMAC_COMP1 */ -+#define PHYTMAC_SPORT_INDEX 0 -+#define PHYTMAC_SPORT_WIDTH 16 -+#define PHYTMAC_DPORT_INDEX 16 -+#define PHYTMAC_DPORTE_WIDTH 16 -+ -+/* Bitfields in PHYTMAC_COMP2 */ -+#define PHYTMAC_OFFSET_INDEX 0 -+#define PHYTMAC_OFFSET_WIDTH 7 -+#define ETHTYPE_SIP_OFFSET 12 -+#define ETHTYPE_DIP_OFFSET 16 -+#define IPHEAD_SPORT_OFFSET 0 -+#define IPHEAD_DPORT_OFFSET 2 -+#define PHYTMAC_OFFSET_TYPE_INDEX 7 -+#define PHYTMAC_OFFSET_TYPE_WIDTH 2 -+#define PHYTMAC_OFFSET_BEGIN 0 -+#define PHYTMAC_OFFSET_AFTER_L2HEAD 1 -+#define PHYTMAC_OFFSET_AFTER_L3HEAD 2 -+#define PHYTMAC_OFFSET_AFTER_L4HEAD 3 -+#define PHYTMAC_DIS_MASK_INDEX 9 -+#define PHYTMAC_DIS_MASK_WIDTH 1 -+#define PHYTMAC_VLAN_ID_INDEX 10 -+#define PHYTMAC_VLAN_ID_WIDTH 1 -+ -+#define PHYTMAC_TSEC_WIDTH (PHYTMAC_SECH_WIDTH + PHYTMAC_SECL_WIDTH) -+#define SEC_MAX_VAL (((u64)1 << PHYTMAC_TSEC_WIDTH) - 1) -+#define NSEC_MAX_VAL ((1 << PHYTMAC_NSEC_WIDTH) - 1) -+ -+/* rx dma desc bit */ -+/* DMA descriptor bitfields */ -+#define PHYTMAC_RX_USED_INDEX 0 -+#define PHYTMAC_RX_USED_WIDTH 1 -+#define PHYTMAC_RX_WRAP_INDEX 1 -+#define PHYTMAC_RX_WRAP_WIDTH 1 -+#define PHYTMAC_RX_TS_VALID_INDEX 2 -+#define PHYTMAC_RX_TS_VALID_WIDTH 1 -+#define PHYTMAC_RX_WADDR_INDEX 2 -+#define PHYTMAC_RX_WADDR_WIDTH 30 -+ -+#define PHYTMAC_RX_FRMLEN_INDEX 0 -+#define PHYTMAC_RX_FRMLEN_WIDTH 12 -+#define PHYTMAC_RX_INDEX_INDEX 12 -+#define PHYTMAC_RX_INDEX_WIDTH 2 -+#define PHYTMAC_RX_SOF_INDEX 14 -+#define PHYTMAC_RX_SOF_WIDTH 1 -+#define PHYTMAC_RX_EOF_INDEX 15 -+#define PHYTMAC_RX_EOF_WIDTH 1 -+#define PHYTMAC_RX_CFI_INDEX 16 -+#define PHYTMAC_RX_CFI_WIDTH 1 -+#define PHYTMAC_RX_VLAN_PRI_INDEX 17 -+#define PHYTMAC_RX_VLAN_PRI_WIDTH 3 -+#define PHYTMAC_RX_PRI_TAG_INDEX 20 -+#define PHYTMAC_RX_PRI_TAG_WIDTH 1 -+#define PHYTMAC_RX_VLAN_TAG_INDEX 21 -+#define PHYTMAC_RX_VLAN_TAG_WIDTH 1 -+#define PHYTMAC_RX_UHASH_MATCH_INDEX 29 -+#define PHYTMAC_RX_UHASH_MATCH_WIDTH 1 -+#define PHYTMAC_RX_MHASH_MATCH_INDEX 30 -+#define PHYTMAC_RX_MHASH_MATCH_WIDTH 1 -+#define PHYTMAC_RX_BROADCAST_INDEX 31 -+#define PHYTMAC_RX_BROADCAST_WIDTH 1 -+ -+#define PHYTMAC_RX_FRMLEN_MASK 0x1FFF -+#define PHYTMAC_RX_JFRMLEN_MASK 0x3FFF -+ -+/* RX checksum offload disabled: bit 24 clear in NCFGR */ -+#define PHYTMAC_RX_TYPEID_MATCH_INDEX 22 -+#define PHYTMAC_RX_TYPEID_MATCH_WIDTH 2 -+ -+/* RX checksum offload enabled: bit 24 set in NCFGR */ -+#define PHYTMAC_RX_CSUM_INDEX 22 -+#define PHYTMAC_RX_CSUM_WIDTH 2 -+ -+/* tx dma desc bit */ -+#define PHYTMAC_TX_FRMLEN_INDEX 0 -+#define PHYTMAC_TX_FRMLEN_WIDTH 14 -+#define PHYTMAC_TX_LAST_INDEX 15 -+#define PHYTMAC_TX_LAST_WIDTH 1 -+#define PHYTMAC_TX_NOCRC_INDEX 16 -+#define PHYTMAC_TX_NOCRC_WIDTH 1 -+#define PHYTMAC_MSS_MFS_INDEX 16 -+#define PHYTMAC_MSS_MFS_WIDTH 14 -+#define PHYTMAC_TX_LSO_INDEX 17 -+#define PHYTMAC_TX_LSO_WIDTH 2 -+#define PHYTMAC_TX_TCP_SEQ_SRC_INDEX 19 -+#define PHYTMAC_TX_TCP_SEQ_SRC_WIDTH 1 -+#define PHYTMAC_TX_TS_VALID_INDEX 23 -+#define PHYTMAC_TX_TS_VALID_WIDTH 1 -+#define PHYTMAC_TX_BUF_EXHAUSTED_INDEX 27 -+#define PHYTMAC_TX_BUF_EXHAUSTED_WIDTH 1 -+#define PHYTMAC_TX_UNDERRUN_INDEX 28 -+#define PHYTMAC_TX_UNDERRUN_WIDTH 1 -+#define PHYTMAC_TX_ERROR_INDEX 29 -+#define PHYTMAC_TX_ERROR_WIDTH 1 -+#define PHYTMAC_TX_WRAP_INDEX 30 -+#define PHYTMAC_TX_WRAP_WIDTH 1 -+#define PHYTMAC_TX_USED_INDEX 31 -+#define PHYTMAC_TX_USED_WIDTH 1 -+ -+/* Transmit DMA buffer descriptor Word 4 */ -+#define PHYTMAC_DMA_NSEC_INDEX 0 -+#define PHYTMAC_DMA_NSEC_WIDTH 30 -+#define PHYTMAC_DMA_SECL_INDEX 30 -+#define PHYTMAC_DMA_SECL_WIDTH 2 -+ -+/* Transmit DMA buffer descriptor Word 4 */ -+#define PHYTMAC_DMA_SECH_INDEX 0 -+#define PHYTMAC_DMA_SECH_WIDTH 4 -+#define PHYTMAC_DMA_SEC_MASK 0x3f -+#define PHYTMAC_DMA_SEC_TOP 0x40 -+ -+/* Buffer descriptor constants */ -+#define PHYTMAC_RX_CSUM_NONE 0 -+#define PHYTMAC_RX_CSUM_IP_ONLY 1 -+#define PHYTMAC_RX_CSUM_IP_TCP 2 -+#define PHYTMAC_RX_CSUM_IP_UDP 3 -+ -+/* limit RX checksum offload to TCP and UDP packets */ -+#define PHYTMAC_RX_CSUM_CHECKED_MASK 2 -+ -+#endif -diff --git a/drivers/net/ethernet/phytium/phytmac_v2.c b/drivers/net/ethernet/phytium/phytmac_v2.c -new file mode 100644 -index 000000000..df142aa67 ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac_v2.c -@@ -0,0 +1,1254 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "phytmac.h" -+#include "phytmac_v2.h" -+ -+static int phytmac_msg_send(struct phytmac *pdata, u16 cmd_id, -+ u16 cmd_subid, void *data, int len, int wait) -+{ -+ int index = 0; -+ struct phytmac_msg_info msg; -+ struct phytmac_msg_info msg_rx; -+ int ret = 0; -+ -+ ++pdata->msg_ring.tx_msg_tail; -+ if (pdata->msg_ring.tx_msg_tail > pdata->msg_ring.tx_msg_ring_size) -+ pdata->msg_ring.tx_msg_tail = 1; -+ index = pdata->msg_ring.tx_msg_tail; -+ -+ wait = 1; -+ memset(&msg, 0, sizeof(msg)); -+ memset(&msg_rx, 0, sizeof(msg_rx)); -+ msg.module_id = PHYTMAC_MODULE_ID_GMAC; -+ msg.cmd_id = cmd_id; -+ msg.cmd_subid = cmd_subid; -+ msg.flags = PHYTMAC_FLAGS_MSG_NOINT; -+ -+ if (len) -+ memcpy(&msg.para[0], data, len); -+ -+ if (netif_msg_hw(pdata)) { -+ netdev_info(pdata->ndev, "tx msg: cmdid=%d, subid=%d, flags=%d, len=%d, tail=%d\n", -+ msg.cmd_id, msg.cmd_subid, msg.flags, len, pdata->msg_ring.tx_msg_tail); -+ } -+ -+ memcpy(pdata->msg_regs + PHYTMAC_MSG(index), &msg, sizeof(msg)); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TX_MSG_TAIL, -+ pdata->msg_ring.tx_msg_tail | PHYTMAC_BIT(TX_MSG_INT)); -+ -+ if (wait) { -+ memcpy(&msg_rx, pdata->msg_regs + PHYTMAC_MSG(index), MSG_HDR_LEN); -+ while (!(msg_rx.flags & 0x1)) { -+ cpu_relax(); -+ memcpy(&msg_rx, pdata->msg_regs + PHYTMAC_MSG(index), MSG_HDR_LEN); -+ } -+ } -+ -+ return ret; -+} -+ -+void phytmac_reset_hw(struct phytmac *pdata) -+{ -+ int q; -+ u16 cmd_id, cmd_subid; -+ struct phytmac_ring_info ring; -+ -+ /* Disable and clear all interrupts and disable queues */ -+ for (q = 0; q < pdata->queues_max_num; ++q) { -+ PHYTMAC_WRITE(pdata, PHYTMAC_INT_DR(q), -1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_INT_SR(q), -1); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TAIL_PTR(q), 0); -+ } -+ -+ /* reset hw rx/tx enable */ -+ cmd_id = PHYTMAC_MSG_CMD_DEFAULT; -+ cmd_subid = PHYTMAC_MSG_CMD_DEFAULT_RESET_HW; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); -+ -+ /* reset tx ring */ -+ memset(&ring, 0, sizeof(ring)); -+ ring.queue_num = pdata->queues_max_num; -+ cmd_subid = PHYTMAC_MSG_CMD_DEFAULT_RESET_TX_QUEUE; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&ring), sizeof(ring), 0); -+ -+ /* reset rx ring */ -+ cmd_subid = PHYTMAC_MSG_CMD_DEFAULT_RESET_RX_QUEUE; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&ring), sizeof(ring), 1); -+} -+ -+static int phytmac_get_mac_addr(struct phytmac *pdata, u8 *addr) -+{ -+ int index; -+ u16 cmd_id, cmd_subid; -+ struct phytmac_mac para; -+ -+ cmd_id = PHYTMAC_MSG_CMD_GET; -+ cmd_subid = PHYTMAC_MSG_CMD_GET_ADDR; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); -+ -+ index = pdata->msg_ring.tx_msg_tail; -+ if (index <= 0) -+ index += pdata->msg_ring.tx_msg_ring_size; -+ memcpy(¶, pdata->msg_regs + PHYTMAC_MSG(index) + MSG_HDR_LEN, -+ sizeof(struct phytmac_mac)); -+ -+ addr[0] = para.addrl & 0xff; -+ addr[1] = (para.addrl >> 8) & 0xff; -+ addr[2] = (para.addrl >> 16) & 0xff; -+ addr[3] = (para.addrl >> 24) & 0xff; -+ addr[4] = para.addrh & 0xff; -+ addr[5] = (para.addrh >> 8) & 0xff; -+ -+ return 0; -+} -+ -+int phytmac_set_mac_addr(struct phytmac *pdata, const u8 *addr) -+{ -+ u16 cmd_id; -+ u16 cmd_subid; -+ struct phytmac_mac para; -+ -+ memset(¶, 0, sizeof(para)); -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ADDR; -+ para.addrl = cpu_to_le32(*((u32 *)addr)); -+ para.addrh = cpu_to_le16(*((u16 *)(addr + 4))); -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); -+ -+ return 0; -+} -+ -+static int phytmac_init_hw(struct phytmac *pdata) -+{ -+ u16 cmd_id, cmd_subid; -+ struct phytmac_dma_info dma; -+ struct phytmac_eth_info eth; -+ -+ phytmac_set_mac_addr(pdata, pdata->ndev->dev_addr); -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ if (pdata->capacities & PHYTMAC_CAPS_JUMBO) -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_JUMBO; -+ else -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_1536_FRAMES; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); -+ -+ if (pdata->ndev->flags & IFF_PROMISC) { -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_PROMISE; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); -+ } -+ -+ if (pdata->ndev->features & NETIF_F_RXCSUM) { -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_RXCSUM; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); -+ } -+ -+ if (!(pdata->ndev->flags & IFF_BROADCAST)) { -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_BC; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); -+ } -+ -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_PAUSE; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); -+ -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_STRIPCRC; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); -+ -+ memset(&dma, 0, sizeof(dma)); -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DMA; -+ dma.dma_burst_length = pdata->dma_burst_length; -+ if (pdata->dma_addr_width) -+ dma.hw_dma_cap |= HW_DMA_CAP_64B; -+ if (pdata->ndev->features & NETIF_F_HW_CSUM) -+ dma.hw_dma_cap |= HW_DMA_CAP_CSUM; -+ if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) -+ dma.hw_dma_cap |= HW_DMA_CAP_PTP; -+ if (pdata->dma_data_width == PHYTMAC_DBW64) -+ dma.hw_dma_cap |= HW_DMA_CAP_DDW64; -+ if (pdata->dma_data_width == PHYTMAC_DBW128) -+ dma.hw_dma_cap |= HW_DMA_CAP_DDW128; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)&dma, sizeof(dma), 0); -+ -+ memset(ð, 0, sizeof(eth)); -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ETH_MATCH; -+ eth.index = 0; -+ eth.etype = (uint16_t)ETH_P_IP; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)ð, sizeof(eth), 1); -+ -+ return 0; -+} -+ -+static int phytmac_enable_multicast(struct phytmac *pdata, int enable) -+{ -+ u16 cmd_id, cmd_subid; -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ if (enable) -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_MC; -+ else -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_MC; -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); -+ return 0; -+} -+ -+static int phytmac_set_mc_hash(struct phytmac *pdata, unsigned long *mc_filter) -+{ -+ u16 cmd_id, cmd_subid; -+ struct phytmac_mc_info para; -+ -+ memset(¶, 0, sizeof(para)); -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_HASH_MC; -+ para.mc_bottom = (u32)mc_filter[0]; -+ para.mc_top = (u32)mc_filter[1]; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); -+ -+ return 0; -+} -+ -+static int phytmac_init_ring_hw(struct phytmac *pdata) -+{ -+ u16 cmd_id, cmd_subid; -+ struct phytmac_ring_info rxring; -+ struct phytmac_ring_info txring; -+ struct phytmac_rxbuf_info rxbuf; -+ struct phytmac_queue *queue; -+ u32 q; -+ -+ memset(&rxring, 0, sizeof(rxring)); -+ memset(&txring, 0, sizeof(txring)); -+ memset(&rxbuf, 0, sizeof(rxbuf)); -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_INIT_TX_RING; -+ txring.queue_num = pdata->queues_num; -+ rxring.queue_num = pdata->queues_num; -+ txring.hw_dma_cap |= HW_DMA_CAP_64B; -+ rxring.hw_dma_cap |= HW_DMA_CAP_64B; -+ for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { -+ PHYTMAC_WRITE(pdata, PHYTMAC_TAIL_PTR(q), queue->tx_head); -+ txring.addr[q] = queue->tx_ring_addr; -+ rxring.addr[q] = queue->rx_ring_addr; -+ } -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&txring), sizeof(txring), 0); -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DMA_RX_BUFSIZE; -+ rxbuf.queue_num = pdata->queues_num; -+ rxbuf.buffer_size = pdata->rx_buffer_len / 64; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&rxbuf), sizeof(rxbuf), 0); -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_INIT_RX_RING; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&rxring), sizeof(rxring), 0); -+ -+ return 0; -+} -+ -+int phytmac_init_msg_ring(struct phytmac *pdata) -+{ -+ u32 size = 0; -+ -+ pdata->msg_ring.tx_msg_tail = PHYTMAC_READ(pdata, PHYTMAC_TX_MSG_TAIL) & 0xff; -+ size = PHYTMAC_READ_BITS(pdata, PHYTMAC_SIZE, TXRING_SIZE); -+ pdata->msg_ring.tx_msg_ring_size = size; -+ if (pdata->msg_ring.tx_msg_tail == size) -+ pdata->msg_ring.tx_msg_tail = 0; -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_MSG_IMR, 0xfffffffe); -+ if (netif_msg_hw(pdata)) -+ netdev_info(pdata->ndev, "mac msg ring: tx_msg_ring_size=%d, tx_msg_tail=%d\n", -+ size, pdata->msg_ring.tx_msg_tail); -+ -+ return 0; -+} -+ -+static int phytmac_get_feature_all(struct phytmac *pdata) -+{ -+ u16 cmd_id, cmd_subid; -+ int index; -+ struct phytmac_feature para; -+ -+ memset(¶, 0, sizeof(para)); -+ cmd_id = PHYTMAC_MSG_CMD_GET; -+ cmd_subid = PHYTMAC_MSG_CMD_GET_CAPS; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); -+ -+ index = pdata->msg_ring.tx_msg_tail; -+ if (index <= 0) -+ index += pdata->msg_ring.tx_msg_ring_size; -+ -+ memcpy(¶, pdata->msg_regs + PHYTMAC_MSG(index) + MSG_HDR_LEN, -+ sizeof(struct phytmac_feature)); -+ -+ pdata->queues_max_num = para.queue_num; -+ if (para.dma_addr_width) -+ pdata->dma_addr_width = 64; -+ else -+ pdata->dma_addr_width = 32; -+ pdata->dma_data_width = para.dma_data_width; -+ pdata->max_rx_fs = para.max_rx_fs; -+ pdata->tx_bd_prefetch = (2 << (para.tx_bd_prefetch - 1)) * -+ sizeof(struct phytmac_dma_desc); -+ pdata->rx_bd_prefetch = (2 << (para.rx_bd_prefetch - 1)) * -+ sizeof(struct phytmac_dma_desc); -+ -+ if (netif_msg_hw(pdata)) { -+ netdev_info(pdata->ndev, "feature qnum=%d, daw=%d, dbw=%d, rxfs=%d, rxbd=%d, txbd=%d\n", -+ pdata->queues_num, pdata->dma_addr_width, pdata->dma_data_width, -+ pdata->max_rx_fs, pdata->rx_bd_prefetch, pdata->tx_bd_prefetch); -+ } -+ -+ return 0; -+} -+ -+void phytmac_get_regs(struct phytmac *pdata, u32 *reg_buff) -+{ -+ u16 cmd_id, cmd_subid; -+ u16 reg_num; -+ int index; -+ -+ cmd_id = PHYTMAC_MSG_CMD_GET; -+ cmd_subid = PHYTMAC_MSG_CMD_GET_REG_READ; -+ reg_num = 16; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)®_num, 2, 1); -+ -+ index = pdata->msg_ring.tx_msg_tail; -+ if (index <= 0) -+ index += pdata->msg_ring.tx_msg_ring_size; -+ -+ memcpy(reg_buff, pdata->msg_regs + PHYTMAC_MSG(index) + MSG_HDR_LEN, 64); -+} -+ -+static void phytmac_get_hw_stats(struct phytmac *pdata) -+{ -+ u16 cmd_id, cmd_subid; -+ u8 count; -+ int i, j, index; -+ u32 stats[48]; -+ u64 val; -+ u64 *p = &pdata->stats.tx_octets; -+ -+ cmd_id = PHYTMAC_MSG_CMD_GET; -+ cmd_subid = PHYTMAC_MSG_CMD_GET_STATS; -+ count = 1; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)&count, sizeof(count), 0); -+ -+ cmd_id = PHYTMAC_MSG_CMD_GET; -+ cmd_subid = PHYTMAC_MSG_CMD_GET_STATS; -+ count = 2; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)&count, sizeof(count), 0); -+ -+ cmd_id = PHYTMAC_MSG_CMD_GET; -+ cmd_subid = PHYTMAC_MSG_CMD_GET_STATS; -+ count = 3; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)&count, sizeof(count), 1); -+ -+ for (i = 0; i < 3; i++) { -+ index = pdata->msg_ring.tx_msg_tail + i - 2; -+ if (index <= 0) -+ index += pdata->msg_ring.tx_msg_ring_size; -+ memcpy(&stats[i * 16], pdata->msg_regs + PHYTMAC_MSG(index) + MSG_HDR_LEN, 64); -+ } -+ -+ for (i = 0, j = 0; i < 44; i++) { -+ if (i == 0 || i == 20) { -+ val = (u64)stats[i + 1] << 32 | stats[i]; -+ *p += val; -+ pdata->ethtool_stats[j] = *p; -+ ++j; -+ ++p; -+ } else { -+ if (i != 1 && i != 21) { -+ val = stats[i]; -+ *p += val; -+ pdata->ethtool_stats[j] = *p; -+ ++j; -+ ++p; -+ } -+ } -+ } -+} -+ -+static void phytmac_mdio_idle(struct phytmac *pdata) -+{ -+ u32 val; -+ -+ /* wait for end of transfer */ -+ val = PHYTMAC_READ(pdata, PHYTMAC_NETWORK_STATUS); -+ while (!(val & PHYTMAC_BIT(MIDLE))) { -+ cpu_relax(); -+ val = PHYTMAC_READ(pdata, PHYTMAC_NETWORK_STATUS); -+ } -+} -+ -+static int phytmac_mdio_data_read_c22(struct phytmac *pdata, int mii_id, int regnum) -+{ -+ u16 data; -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C22) -+ | PHYTMAC_BITS(MDCOPS, PHYTMAC_C22_READ) -+ | PHYTMAC_BITS(PHYADDR, mii_id) -+ | PHYTMAC_BITS(REGADDR, regnum) -+ | PHYTMAC_BITS(CONST, 2))); -+ phytmac_mdio_idle(pdata); -+ data = PHYTMAC_READ(pdata, PHYTMAC_MDIO) & 0xffff; -+ phytmac_mdio_idle(pdata); -+ return data; -+} -+ -+static int phytmac_mdio_data_write_c22(struct phytmac *pdata, int mii_id, -+ int regnum, u16 data) -+{ -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C22) -+ | PHYTMAC_BITS(MDCOPS, PHYTMAC_C22_WRITE) -+ | PHYTMAC_BITS(PHYADDR, mii_id) -+ | PHYTMAC_BITS(REGADDR, regnum) -+ | PHYTMAC_BITS(VALUE, data) -+ | PHYTMAC_BITS(CONST, 2))); -+ phytmac_mdio_idle(pdata); -+ -+ return 0; -+} -+ -+static int phytmac_mdio_data_read_c45(struct phytmac *pdata, int mii_id, int devad, int regnum) -+{ -+ u16 data; -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C45) -+ | PHYTMAC_BITS(MDCOPS, PHYTMAC_C45_ADDR) -+ | PHYTMAC_BITS(PHYADDR, mii_id) -+ | PHYTMAC_BITS(REGADDR, devad & 0x1F) -+ | PHYTMAC_BITS(VALUE, regnum & 0xFFFF) -+ | PHYTMAC_BITS(CONST, 2))); -+ phytmac_mdio_idle(pdata); -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C45) -+ | PHYTMAC_BITS(MDCOPS, PHYTMAC_C45_READ) -+ | PHYTMAC_BITS(PHYADDR, mii_id) -+ | PHYTMAC_BITS(REGADDR, devad & 0x1F) -+ | PHYTMAC_BITS(VALUE, regnum & 0xFFFF) -+ | PHYTMAC_BITS(CONST, 2))); -+ phytmac_mdio_idle(pdata); -+ data = PHYTMAC_READ(pdata, PHYTMAC_MDIO) & 0xffff; -+ phytmac_mdio_idle(pdata); -+ return data; -+} -+ -+static int phytmac_mdio_data_write_c45(struct phytmac *pdata, int mii_id, int devad, -+ int regnum, u16 data) -+{ -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C45) -+ | PHYTMAC_BITS(MDCOPS, PHYTMAC_C45_ADDR) -+ | PHYTMAC_BITS(PHYADDR, mii_id) -+ | PHYTMAC_BITS(REGADDR, (regnum >> 16) & 0x1F) -+ | PHYTMAC_BITS(VALUE, regnum & 0xFFFF) -+ | PHYTMAC_BITS(CONST, 2))); -+ phytmac_mdio_idle(pdata); -+ PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C45) -+ | PHYTMAC_BITS(MDCOPS, PHYTMAC_C45_WRITE) -+ | PHYTMAC_BITS(PHYADDR, mii_id) -+ | PHYTMAC_BITS(REGADDR, (regnum >> 16) & 0x1F) -+ | PHYTMAC_BITS(VALUE, data) -+ | PHYTMAC_BITS(CONST, 2))); -+ phytmac_mdio_idle(pdata); -+ -+ return 0; -+} -+ -+static int phytmac_powerup_hw(struct phytmac *pdata, int on) -+{ -+ u32 status, data0, data1, rdata1; -+ int ret; -+ -+ if (pdata->capacities & PHYTMAC_CAPS_LPI) { -+ ret = readx_poll_timeout(PHYTMAC_READ_STAT, pdata, status, !status, -+ 1, PHYTMAC_TIMEOUT); -+ if (ret) -+ netdev_err(pdata->ndev, "mnh status is busy"); -+ -+ ret = readx_poll_timeout(PHYTMAC_READ_DATA0, pdata, data0, -+ data0 & PHYTMAC_BIT(DATA0_FREE), -+ 1, PHYTMAC_TIMEOUT); -+ if (ret) -+ netdev_err(pdata->ndev, "mnh data0 is busy"); -+ -+ data0 = 0; -+ data0 = PHYTMAC_SET_BITS(data0, DATA0_MSG, PHYTMAC_MSG_PM); -+ data0 = PHYTMAC_SET_BITS(data0, DATA0_PRO, PHYTMAC_PRO_ID); -+ PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA0, data0); -+ data1 = 0; -+ -+ if (on == PHYTMAC_POWERON) { -+ data1 = PHYTMAC_SET_BITS(data1, DATA1_STAT, PHYTMAC_STATON); -+ data1 = PHYTMAC_SET_BITS(data1, DATA1_STATTYPE, PHYTMAC_STATTYPE); -+ PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA1, data1); -+ } else { -+ data1 = PHYTMAC_SET_BITS(data1, DATA1_STAT, PHYTMAC_STATOFF); -+ data1 = PHYTMAC_SET_BITS(data1, DATA1_STATTYPE, PHYTMAC_STATTYPE); -+ PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA1, data1); -+ } -+ -+ PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_AP_CPP_SET, 1); -+ ret = readx_poll_timeout(PHYTMAC_READ_DATA0, pdata, data0, -+ data0 & PHYTMAC_BIT(DATA0_FREE), -+ 1, PHYTMAC_TIMEOUT); -+ if (ret) -+ netdev_err(pdata->ndev, "mnh data0 is busy\n"); -+ -+ rdata1 = PHYTMAC_MHU_READ(pdata, PHYTMAC_MHU_CPP_DATA1); -+ if (rdata1 == data1) -+ netdev_err(pdata->ndev, "gmac power %s success, data1 = %x, rdata1=%x\n", -+ on ? "up" : "down", data1, rdata1); -+ else -+ netdev_err(pdata->ndev, "gmac power %s failed, data1 = %x, rdata1=%x\n", -+ on ? "up" : "down", data1, rdata1); -+ } -+ -+ pdata->power_state = on; -+ -+ return 0; -+} -+ -+static int phytmac_set_wake(struct phytmac *pdata, int wake) -+{ -+ u16 cmd_id, cmd_subid; -+ u8 wol = (u8)wake; -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_WOL; -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&wol), 1, 1); -+ -+ return 0; -+} -+ -+static int phytmac_enable_promise(struct phytmac *pdata, int enable) -+{ -+ u16 cmd_id, cmd_subid; -+ u8 rxcsum = 0; -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ if (enable) { -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_PROMISE; -+ } else { -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_PROMISE; -+ if (pdata->ndev->features & NETIF_F_RXCSUM) -+ rxcsum = 1; -+ } -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&rxcsum), 1, 1); -+ -+ return 0; -+} -+ -+static int phytmac_enable_rxcsum(struct phytmac *pdata, int enable) -+{ -+ u16 cmd_id, cmd_subid; -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ if (enable) -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_RXCSUM; -+ else -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_RXCSUM; -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); -+ -+ return 0; -+} -+ -+static int phytmac_enable_txcsum(struct phytmac *pdata, int enable) -+{ -+ u16 cmd_id, cmd_subid; -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ if (enable) -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_TXCSUM; -+ else -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_TXCSUM; -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); -+ -+ return 0; -+} -+ -+static int phytmac_enable_mdio(struct phytmac *pdata, int enable) -+{ -+ u16 cmd_id, cmd_subid; -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ if (enable) -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_MDIO; -+ else -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_MDIO; -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); -+ -+ return 0; -+} -+ -+static int phytmac_enable_autoneg(struct phytmac *pdata, int enable) -+{ -+ u16 cmd_id, cmd_subid; -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ if (enable) -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_AUTONEG; -+ else -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_AUTONEG; -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); -+ -+ pdata->autoneg = enable; -+ return 0; -+} -+ -+static int phytmac_enable_pause(struct phytmac *pdata, int enable) -+{ -+ u16 cmd_id, cmd_subid; -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ if (enable) -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_PAUSE; -+ else -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_PAUSE; -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); -+ -+ return 0; -+} -+ -+static int phytmac_enable_network(struct phytmac *pdata, int enable, int rx_tx) -+{ -+ u16 cmd_id, cmd_subid; -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ if (enable) -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_NETWORK; -+ else -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_NETWORK; -+ -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); -+ -+ return 0; -+} -+ -+static int phytmac_add_fdir_entry(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow) -+{ -+ struct ethtool_tcpip4_spec *tp4sp_v, *tp4sp_m; -+ struct phytmac_fdir_info fdir; -+ u16 cmd_id, cmd_subid; -+ -+ memset(&fdir, 0, sizeof(fdir)); -+ -+ tp4sp_v = &rx_flow->h_u.tcp_ip4_spec; -+ tp4sp_m = &rx_flow->m_u.tcp_ip4_spec; -+ if (tp4sp_m->ip4src == 0xFFFFFFFF) { -+ fdir.ipsrc_en = true; -+ fdir.ip4src = tp4sp_v->ip4src; -+ } -+ -+ if (tp4sp_m->ip4dst == 0xFFFFFFFF) { -+ fdir.ipdst_en = true; -+ fdir.ip4dst = tp4sp_v->ip4dst; -+ } -+ -+ if (tp4sp_m->psrc == 0xFFFF || tp4sp_m->pdst == 0xFFFF) { -+ fdir.port_en = true; -+ fdir.dstport = tp4sp_v->pdst; -+ fdir.srcport = tp4sp_v->psrc; -+ fdir.dstport_mask = tp4sp_m->pdst; -+ fdir.srcport_mask = tp4sp_m->psrc; -+ } -+ -+ fdir.location = rx_flow->location; -+ fdir.queue = rx_flow->ring_cookie; -+ -+ if (fdir.ipsrc_en || fdir.ipdst_en || fdir.port_en) { -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_ADD_FDIR; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&fdir), sizeof(fdir), 1); -+ } -+ -+ return 0; -+} -+ -+static int phytmac_del_fdir_entry(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow) -+{ -+ struct phytmac_fdir_info fdir; -+ u16 cmd_id, cmd_subid; -+ -+ memset(&fdir, 0, sizeof(fdir)); -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_DEL_FDIR; -+ fdir.location = (u8)rx_flow->location; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&fdir), sizeof(fdir), 1); -+ -+ return 0; -+} -+ -+static void phytmac_tx_start(struct phytmac_queue *queue) -+{ -+ struct phytmac *pdata = queue->pdata; -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_TAIL_PTR(queue->index), queue->tx_tail); -+ queue->tx_xmit_more = 0; -+} -+ -+static u32 phytmac_get_irq_mask(u32 mask) -+{ -+ u32 value = 0; -+ -+ value |= (mask & PHYTMAC_INT_TX_COMPLETE) ? PHYTMAC_BIT(TXCOMP) : 0; -+ value |= (mask & PHYTMAC_INT_TX_ERR) ? PHYTMAC_BIT(DMA_ERR) : 0; -+ value |= (mask & PHYTMAC_INT_RX_COMPLETE) ? PHYTMAC_BIT(RXCOMP) : 0; -+ value |= (mask & PHYTMAC_INT_RX_OVERRUN) ? PHYTMAC_BIT(RXOVERRUN) : 0; -+ value |= (mask & PHYTMAC_INT_RX_DESC_FULL) ? PHYTMAC_BIT(RUSED) : 0; -+ -+ return value; -+} -+ -+static u32 phytmac_get_irq_status(u32 value) -+{ -+ u32 status = 0; -+ -+ status |= (value & PHYTMAC_BIT(TXCOMP)) ? PHYTMAC_INT_TX_COMPLETE : 0; -+ status |= (value & PHYTMAC_BIT(DMA_ERR)) ? PHYTMAC_INT_TX_ERR : 0; -+ status |= (value & PHYTMAC_BIT(RXCOMP)) ? PHYTMAC_INT_RX_COMPLETE : 0; -+ status |= (value & PHYTMAC_BIT(RXOVERRUN)) ? PHYTMAC_INT_RX_OVERRUN : 0; -+ status |= (value & PHYTMAC_BIT(RUSED)) ? PHYTMAC_INT_RX_DESC_FULL : 0; -+ -+ return status; -+} -+ -+static void phytmac_enable_irq(struct phytmac *pdata, -+ int queue_index, u32 mask) -+{ -+ u32 value; -+ -+ value = phytmac_get_irq_mask(mask); -+ PHYTMAC_WRITE(pdata, PHYTMAC_INT_ER(queue_index), value); -+} -+ -+static void phytmac_disable_irq(struct phytmac *pdata, -+ int queue_index, u32 mask) -+{ -+ u32 value; -+ -+ value = phytmac_get_irq_mask(mask); -+ PHYTMAC_WRITE(pdata, PHYTMAC_INT_DR(queue_index), value); -+} -+ -+static void phytmac_clear_irq(struct phytmac *pdata, -+ int queue_index, u32 mask) -+{ -+ u32 value; -+ -+ value = phytmac_get_irq_mask(mask); -+ PHYTMAC_WRITE(pdata, PHYTMAC_INT_SR(queue_index), value); -+} -+ -+static unsigned int phytmac_get_irq(struct phytmac *pdata, int queue_index) -+{ -+ u32 status; -+ u32 value; -+ -+ value = PHYTMAC_READ(pdata, PHYTMAC_INT_SR(queue_index)); -+ status = phytmac_get_irq_status(value); -+ -+ return status; -+} -+ -+static void phytmac_interface_config(struct phytmac *pdata, unsigned int mode, -+ const struct phylink_link_state *state) -+{ -+ struct phytmac_interface_info para; -+ u16 cmd_id, cmd_subid; -+ -+ memset(¶, 0, sizeof(para)); -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_MAC_CONFIG; -+ para.interface = state->interface; -+ para.autoneg = (mode == MLO_AN_FIXED ? 0 : 1); -+ para.speed = state->speed; -+ para.duplex = state->duplex; -+ pdata->autoneg = para.autoneg; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); -+} -+ -+static int phytmac_interface_linkup(struct phytmac *pdata, phy_interface_t interface, -+ int speed, int duplex) -+{ -+ struct phytmac_interface_info para; -+ u16 cmd_id, cmd_subid; -+ -+ memset(¶, 0, sizeof(para)); -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_MAC_LINK_CONFIG; -+ para.interface = interface; -+ para.duplex = duplex; -+ para.speed = speed; -+ para.autoneg = pdata->autoneg; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); -+ -+ return 0; -+} -+ -+static int phytmac_interface_linkdown(struct phytmac *pdata) -+{ -+ return 0; -+} -+ -+static int phytmac_pcs_linkup(struct phytmac *pdata, phy_interface_t interface, -+ int speed, int duplex) -+{ -+ struct phytmac_interface_info para; -+ u16 cmd_id, cmd_subid; -+ -+ if (interface == PHY_INTERFACE_MODE_USXGMII || -+ interface == PHY_INTERFACE_MODE_10GBASER) { -+ memset(¶, 0, sizeof(para)); -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_PCS_LINK_UP; -+ para.interface = interface; -+ para.duplex = duplex; -+ para.speed = speed; -+ para.autoneg = 0; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); -+ } -+ -+ return 0; -+} -+ -+static int phytmac_pcs_linkdown(struct phytmac *pdata) -+{ -+ return 0; -+} -+ -+static unsigned int phytmac_pcs_get_link(struct phytmac *pdata, phy_interface_t interface) -+{ -+ if (interface == PHY_INTERFACE_MODE_SGMII || -+ interface == PHY_INTERFACE_MODE_2500BASEX) -+ return PHYTMAC_READ_BITS(pdata, PHYTMAC_NETWORK_STATUS, LINK); -+ else if (interface == PHY_INTERFACE_MODE_USXGMII || -+ interface == PHY_INTERFACE_MODE_10GBASER) -+ return PHYTMAC_READ_BITS(pdata, PHYTMAC_USX_LINK_STATUS, USX_LINK); -+ -+ return 0; -+} -+ -+static unsigned int phytmac_tx_map_desc(struct phytmac_queue *queue, -+ u32 tx_tail, struct packet_info *packet) -+{ -+ unsigned int i, ctrl; -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_dma_desc *desc; -+ struct phytmac_tx_skb *tx_skb; -+ unsigned int eof = 1; -+ -+ i = tx_tail; -+ -+ do { -+ i--; -+ tx_skb = phytmac_get_tx_skb(queue, i); -+ desc = phytmac_get_tx_desc(queue, i); -+ -+ ctrl = (u32)tx_skb->length; -+ if (eof) { -+ ctrl |= PHYTMAC_BIT(TXLAST); -+ eof = 0; -+ } -+ -+ if (unlikely(i == (pdata->tx_ring_size - 1))) -+ ctrl |= PHYTMAC_BIT(TXWRAP); -+ -+ if (i == queue->tx_tail) { -+ ctrl |= PHYTMAC_BITS(TXLSO, packet->lso); -+ ctrl |= PHYTMAC_BITS(TXTCP_SEQ_SRC, packet->seq); -+ if (packet->nocrc) -+ ctrl |= PHYTMAC_BIT(TXNOCRC); -+ } else { -+ ctrl |= PHYTMAC_BITS(MSSMFS, packet->mss); -+ } -+ -+ desc->desc2 = upper_32_bits(tx_skb->addr); -+ desc->desc0 = lower_32_bits(tx_skb->addr); -+ /* make newly desc1 to hardware */ -+ wmb(); -+ desc->desc1 = ctrl; -+ } while (i != queue->tx_tail); -+ -+ return 0; -+} -+ -+static void phytmac_init_rx_map_desc(struct phytmac_queue *queue, -+ u32 index) -+{ -+ struct phytmac_dma_desc *desc; -+ -+ desc = phytmac_get_rx_desc(queue, index); -+ -+ desc->desc1 = 0; -+ /* Make newly descriptor to hardware */ -+ dma_wmb(); -+ desc->desc0 |= PHYTMAC_BIT(RXUSED); -+} -+ -+static unsigned int phytmac_rx_map_desc(struct phytmac_queue *queue, u32 index, dma_addr_t addr) -+{ -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_dma_desc *desc; -+ -+ desc = phytmac_get_rx_desc(queue, index); -+ -+ if (addr) { -+ if (unlikely(index == (pdata->rx_ring_size - 1))) -+ addr |= PHYTMAC_BIT(RXWRAP); -+ desc->desc1 = 0; -+ desc->desc2 = upper_32_bits(addr); -+ /* Make newly descriptor to hardware */ -+ dma_wmb(); -+ desc->desc0 = lower_32_bits(addr); -+ } else { -+ desc->desc1 = 0; -+ /* make newly descriptor to hardware */ -+ dma_wmb(); -+ desc->desc0 &= ~PHYTMAC_BIT(RXUSED); -+ } -+ -+ return 0; -+} -+ -+static int phytmac_tx_complete(const struct phytmac_dma_desc *desc) -+{ -+ return PHYTMAC_GET_BITS(desc->desc1, TXUSED); -+} -+ -+static int phytmac_rx_complete(const struct phytmac_dma_desc *desc) -+{ -+ return PHYTMAC_GET_BITS(desc->desc0, RXUSED); -+} -+ -+static int phytmac_rx_pkt_len(struct phytmac *pdata, const struct phytmac_dma_desc *desc) -+{ -+ if (pdata->capacities & PHYTMAC_CAPS_JUMBO) -+ return desc->desc1 & PHYTMAC_RXJFRMLEN_MASK; -+ else -+ return desc->desc1 & PHYTMAC_RXFRMLEN_MASK; -+} -+ -+static dma_addr_t phytmac_get_desc_addr(const struct phytmac_dma_desc *desc) -+{ -+ dma_addr_t addr = 0; -+ -+ addr = ((u64)(desc->desc2) << 32); -+ -+ addr |= (desc->desc0 & 0xfffffffc); -+ return addr; -+} -+ -+static bool phytmac_rx_checksum(const struct phytmac_dma_desc *desc) -+{ -+ u32 value = desc->desc1; -+ u32 check = value >> PHYTMAC_RXCSUM_INDEX & 0x3; -+ -+ return (check == PHYTMAC_RXCSUM_IP_TCP || check == PHYTMAC_RXCSUM_IP_UDP); -+} -+ -+static bool phytmac_rx_single_buffer(const struct phytmac_dma_desc *desc) -+{ -+ u32 value = desc->desc1; -+ -+ return ((value & PHYTMAC_BIT(RXSOF)) && (value & PHYTMAC_BIT(RXEOF))); -+} -+ -+static bool phytmac_rx_sof(const struct phytmac_dma_desc *desc) -+{ -+ u32 value = desc->desc1; -+ -+ return (value & PHYTMAC_BIT(RXSOF)); -+} -+ -+static bool phytmac_rx_eof(const struct phytmac_dma_desc *desc) -+{ -+ u32 value = desc->desc1; -+ -+ return (value & PHYTMAC_BIT(RXEOF)); -+} -+ -+static void phytmac_clear_rx_desc(struct phytmac_queue *queue, int begin, int end) -+{ -+ unsigned int frag; -+ unsigned int tmp = end; -+ struct phytmac_dma_desc *desc; -+ -+ if (begin > end) -+ tmp = end + queue->pdata->rx_ring_size; -+ -+ for (frag = begin; frag != end; frag++) { -+ desc = phytmac_get_rx_desc(queue, frag); -+ desc->desc0 &= ~PHYTMAC_BIT(RXUSED); -+ } -+} -+ -+static void phytmac_clear_tx_desc(struct phytmac_queue *queue) -+{ -+ struct phytmac *pdata = queue->pdata; -+ struct phytmac_dma_desc *desc = NULL; -+ struct phytmac_tx_skb *tx_skb = NULL; -+ int i; -+ -+ for (i = 0; i < queue->pdata->tx_ring_size; i++) { -+ desc = phytmac_get_tx_desc(queue, i); -+ tx_skb = phytmac_get_tx_skb(queue, i); -+ desc->desc2 = upper_32_bits(tx_skb->addr); -+ desc->desc0 = lower_32_bits(tx_skb->addr); -+ /* make newly desc to hardware */ -+ wmb(); -+ desc->desc1 = PHYTMAC_BIT(TXUSED); -+ } -+ desc->desc1 |= PHYTMAC_BIT(TXWRAP); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TAIL_PTR(queue->index), queue->tx_tail); -+} -+ -+static void phytmac_get_time(struct phytmac *pdata, struct timespec64 *ts) -+{ -+ u32 ns, secl, sech; -+ -+ ns = PHYTMAC_READ(pdata, PHYTMAC_TIMER_NSEC); -+ secl = PHYTMAC_READ(pdata, PHYTMAC_TIMER_SEC); -+ sech = PHYTMAC_READ(pdata, PHYTMAC_TIMER_MSB_SEC); -+ -+ ts->tv_nsec = ns; -+ ts->tv_sec = (((u64)sech << 32) | secl) & TIMER_SEC_MAX_VAL; -+} -+ -+void phytmac_set_time(struct phytmac *pdata, time64_t sec, long nsec) -+{ -+ u32 secl, sech; -+ -+ secl = (u32)sec; -+ sech = (sec >> 32) & (0xffff); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_NSEC, 0); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_MSB_SEC, sech); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_SEC, secl); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_NSEC, nsec); -+} -+ -+void phytmac_clear_time(struct phytmac *pdata) -+{ -+ u32 value; -+ -+ pdata->ts_incr.sub_ns = 0; -+ pdata->ts_incr.ns = 0; -+ -+ value = PHYTMAC_READ(pdata, PHYTMAC_TIMER_INCR); -+ value = PHYTMAC_SET_BITS(value, INCR_NSEC, 0); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_INCR, value); -+ -+ value = PHYTMAC_READ(pdata, PHYTMAC_TIMER_INCR_SUB_NSEC); -+ value = PHYTMAC_SET_BITS(value, INCR_SNSEC, 0); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_INCR_SUB_NSEC, value); -+ -+ PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_ADJUST, 0); -+} -+ -+int phytmac_set_tsmode(struct phytmac *pdata, struct ts_ctrl *ctrl) -+{ -+ u16 cmd_id, cmd_subid; -+ struct phytmac_ts_config para; -+ -+ cmd_id = PHYTMAC_MSG_CMD_SET; -+ cmd_subid = PHYTMAC_MSG_CMD_SET_TS_CONFIG; -+ para.tx_mode = ctrl->tx_control; -+ para.rx_mode = ctrl->rx_control; -+ para.one_step = ctrl->one_step; -+ phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); -+ -+ return 0; -+} -+ -+static int phytmac_set_tsincr(struct phytmac *pdata, struct ts_incr *incr) -+{ -+ u32 value; -+ -+ value = PHYTMAC_BITS(INCR_SNSEC, incr->sub_ns); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_INCR_SUB_NSEC, value); -+ PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_INCR, incr->ns); -+ -+ return 0; -+} -+ -+static void phytmac_ptp_init_hw(struct phytmac *pdata) -+{ -+ struct timespec64 ts; -+ -+ ts = ns_to_timespec64(ktime_to_ns(ktime_get_real())); -+ phytmac_set_time(pdata, ts.tv_sec, ts.tv_nsec); -+ -+ phytmac_set_tsincr(pdata, &pdata->ts_incr); -+} -+ -+static int phytmac_adjust_fine(struct phytmac *pdata, long ppm, bool negative) -+{ -+ struct ts_incr ts_incr; -+ u32 tmp; -+ u64 adj; -+ -+ ts_incr.ns = pdata->ts_incr.ns; -+ ts_incr.sub_ns = pdata->ts_incr.sub_ns; -+ -+ /* scaling: unused(8bit) | ns(8bit) | fractions(16bit) */ -+ tmp = ((u64)ts_incr.ns << PHYTMAC_INCR_SNSECL_INDEX) + ts_incr.sub_ns; -+ adj = ((u64)ppm * tmp + (USEC_PER_SEC >> 1)) >> PHYTMAC_INCR_SNSECL_INDEX; -+ -+ adj = div_u64(adj, USEC_PER_SEC); -+ adj = negative ? (tmp - adj) : (tmp + adj); -+ -+ ts_incr.ns = (adj >> PHYTMAC_INCR_SNSEC_WIDTH) -+ & ((1 << PHYTMAC_INCR_NSEC_WIDTH) - 1); -+ ts_incr.sub_ns = adj & ((1 << PHYTMAC_INCR_SNSEC_WIDTH) - 1); -+ -+ phytmac_set_tsincr(pdata, &ts_incr); -+ -+ return 0; -+} -+ -+int phytmac_adjust_time(struct phytmac *pdata, s64 delta, int neg) -+{ -+ u32 adj; -+ -+ if (delta > PHYTMAC_ASEC_MAX) { -+ struct timespec64 now, then; -+ -+ then = ns_to_timespec64(delta); -+ phytmac_get_time(pdata, &now); -+ now = timespec64_add(now, then); -+ phytmac_set_time(pdata, now.tv_sec, now.tv_nsec); -+ } else { -+ adj = (neg << PHYTMAC_AADD_INDEX) | delta; -+ PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_ADJUST, adj); -+ } -+ -+ return 0; -+} -+ -+static int phytmac_ts_valid(struct phytmac *pdata, struct phytmac_dma_desc *desc, int direction) -+{ -+ int ts_valid = 0; -+ -+ if (direction == PHYTMAC_TX) -+ ts_valid = desc->desc1 & PHYTMAC_BIT(TXTSVALID); -+ else if (direction == PHYTMAC_RX) -+ ts_valid = desc->desc0 & PHYTMAC_BIT(RXTSVALID); -+ return ts_valid; -+} -+ -+static void phytmac_get_dma_ts(struct phytmac *pdata, u32 ts_1, u32 ts_2, struct timespec64 *ts) -+{ -+ struct timespec64 ts2; -+ -+ ts->tv_sec = (PHYTMAC_GET_BITS(ts_2, TS_SECH) << 2) | -+ PHYTMAC_GET_BITS(ts_1, TS_SECL); -+ ts->tv_nsec = PHYTMAC_GET_BITS(ts_1, TS_NSEC); -+ -+ phytmac_get_time(pdata, &ts2); -+ -+ if (((ts->tv_sec ^ ts2.tv_sec) & (PHYTMAC_TS_SEC_TOP >> 1)) != 0) -+ ts->tv_sec -= PHYTMAC_TS_SEC_TOP; -+ -+ ts->tv_sec += (ts2.tv_sec & (~PHYTMAC_TS_SEC_MASK)); -+} -+ -+static unsigned int phytmac_get_ts_rate(struct phytmac *pdata) -+{ -+ return 300000000; -+} -+ -+struct phytmac_hw_if phytmac_2p0_hw = { -+ .init_msg_ring = phytmac_init_msg_ring, -+ .reset_hw = phytmac_reset_hw, -+ .init_hw = phytmac_init_hw, -+ .init_ring_hw = phytmac_init_ring_hw, -+ .get_feature = phytmac_get_feature_all, -+ .get_regs = phytmac_get_regs, -+ .get_stats = phytmac_get_hw_stats, -+ .set_mac_address = phytmac_set_mac_addr, -+ .get_mac_address = phytmac_get_mac_addr, -+ .mdio_read = phytmac_mdio_data_read_c22, -+ .mdio_write = phytmac_mdio_data_write_c22, -+ .mdio_read_c45 = phytmac_mdio_data_read_c45, -+ .mdio_write_c45 = phytmac_mdio_data_write_c45, -+ .poweron = phytmac_powerup_hw, -+ .set_wol = phytmac_set_wake, -+ .enable_promise = phytmac_enable_promise, -+ .enable_multicast = phytmac_enable_multicast, -+ .set_hash_table = phytmac_set_mc_hash, -+ .enable_rx_csum = phytmac_enable_rxcsum, -+ .enable_tx_csum = phytmac_enable_txcsum, -+ .enable_mdio_control = phytmac_enable_mdio, -+ .enable_autoneg = phytmac_enable_autoneg, -+ .enable_pause = phytmac_enable_pause, -+ .enable_network = phytmac_enable_network, -+ .add_fdir_entry = phytmac_add_fdir_entry, -+ .del_fdir_entry = phytmac_del_fdir_entry, -+ -+ /* mac config */ -+ .mac_config = phytmac_interface_config, -+ .mac_linkup = phytmac_interface_linkup, -+ .mac_linkdown = phytmac_interface_linkdown, -+ .pcs_linkup = phytmac_pcs_linkup, -+ .pcs_linkdown = phytmac_pcs_linkdown, -+ .get_link = phytmac_pcs_get_link, -+ -+ /* irq */ -+ .enable_irq = phytmac_enable_irq, -+ .disable_irq = phytmac_disable_irq, -+ .clear_irq = phytmac_clear_irq, -+ .get_irq = phytmac_get_irq, -+ -+ /* tx and rx */ -+ .tx_map = phytmac_tx_map_desc, -+ .transmit = phytmac_tx_start, -+ .tx_complete = phytmac_tx_complete, -+ .rx_complete = phytmac_rx_complete, -+ .get_rx_pkt_len = phytmac_rx_pkt_len, -+ .get_desc_addr = phytmac_get_desc_addr, -+ .init_rx_map = phytmac_init_rx_map_desc, -+ .rx_map = phytmac_rx_map_desc, -+ .rx_checksum = phytmac_rx_checksum, -+ .rx_single_buffer = phytmac_rx_single_buffer, -+ .rx_pkt_start = phytmac_rx_sof, -+ .rx_pkt_end = phytmac_rx_eof, -+ .clear_rx_desc = phytmac_clear_rx_desc, -+ .clear_tx_desc = phytmac_clear_tx_desc, -+ -+ /* ptp */ -+ .init_ts_hw = phytmac_ptp_init_hw, -+ .set_time = phytmac_set_time, -+ .clear_time = phytmac_clear_time, -+ .get_time = phytmac_get_time, -+ .set_ts_config = phytmac_set_tsmode, -+ .set_incr = phytmac_set_tsincr, -+ .adjust_fine = phytmac_adjust_fine, -+ .adjust_time = phytmac_adjust_time, -+ .ts_valid = phytmac_ts_valid, -+ .get_timestamp = phytmac_get_dma_ts, -+ .get_ts_rate = phytmac_get_ts_rate, -+}; -+EXPORT_SYMBOL_GPL(phytmac_2p0_hw); -diff --git a/drivers/net/ethernet/phytium/phytmac_v2.h b/drivers/net/ethernet/phytium/phytmac_v2.h -new file mode 100644 -index 000000000..92e4806ac ---- /dev/null -+++ b/drivers/net/ethernet/phytium/phytmac_v2.h -@@ -0,0 +1,362 @@ -+/* SPDX-License-Identifier: GPL-2.0-only */ -+#ifndef _PHYTMAC_V2_H -+#define _PHYTMAC_V2_H -+ -+extern struct phytmac_hw_if phytmac_2p0_hw; -+ -+#define PHYTMAC_MSG_SRAM_SIZE 4096 -+#define MSG_HDR_LEN 8 -+ -+#define PHYTMAC_TX_MSG_HEAD 0x000 -+#define PHYTMAC_TX_MSG_TAIL 0x004 -+#define PHYTMAC_RX_MSG_HEAD 0x008 -+#define PHYTMAC_RX_MSG_TAIL 0x00c -+#define PHYTMAC_MSG_IMR 0x020 -+#define PHYTMAC_MSG_ISR 0x02c -+ -+#define PHYTMAC_SIZE 0x0048 -+#define PHYTMAC_NETWORK_STATUS 0x0240 -+#define PHYTMAC_PCS_AN_LP 0x0244 -+#define PHYTMAC_USX_LINK_STATUS 0x0248 -+#define PHYTMAC_MDIO 0x0264 -+#define PHYTMAC_TIMER_INCR_SUB_NSEC 0x024c -+#define PHYTMAC_TIMER_INCR 0x0250 -+#define PHYTMAC_TIMER_MSB_SEC 0x0254 -+#define PHYTMAC_TIMER_SEC 0x0258 -+#define PHYTMAC_TIMER_NSEC 0x025c -+#define PHYTMAC_TIMER_ADJUST 0x0260 -+#define PHYTMAC_MSG(i) (((i) - 1) * 0x48) -+ -+#define PHYTMAC_MODULE_ID_GMAC 0x60 -+#define PHYTMAC_FLAGS_MSG_COMP 0x1 -+#define PHYTMAC_FLAGS_MSG_NOINT 0x2 -+ -+/* Bitfields in PHYTMAC_TX_MSG_TAIL */ -+#define PHYTMAC_TX_MSG_INT_INDEX 16 -+#define PHYTMAC_TX_MSG_INT_WIDTH 1 -+ -+/* Bitfields in PHYTMAC_MSG_ISR */ -+#define PHYTMAC_MSG_COMPLETE_INDEX 0 -+#define PHYTMAC_MSG_COMPLETE_WIDTH 1 -+ -+/* Bitfields in PHYTMAC_SIZE */ -+#define PHYTMAC_MEM_SIZE_INDEX 0 -+#define PHYTMAC_MEM_SIZE_WIDTH 4 -+#define PHYTMAC_TXRING_SIZE_INDEX 8 -+#define PHYTMAC_TXRING_SIZE_WIDTH 6 -+ -+/* Bitfields in PHYTMAC_TIMER_INCR_SUB_NSEC */ -+#define PHYTMAC_INCR_SNSECH_INDEX 0 -+#define PHYTMAC_INCR_SNSECH_WIDTH 16 -+#define PHYTMAC_INCR_SNSECL_INDEX 24 -+#define PHYTMAC_INCR_SNSECL_WIDTH 8 -+#define PHYTMAC_INCR_SNSEC_WIDTH 24 -+ -+/* Bitfields in PHYTMAC_TIMER_INCR_SUB_NSEC */ -+#define PHYTMAC_INCR_SNSEC_INDEX 0 -+#define PHYTMAC_INCR_SNSEC_WIDTH 24 -+ -+/* Bitfields in PHYTMAC_TIMER_INCR */ -+#define PHYTMAC_INCR_NSEC_INDEX 0 -+#define PHYTMAC_INCR_NSEC_WIDTH 8 -+ -+/* Bitfields in PHYTMAC_TIMER_MSB_SEC */ -+#define PHYTMAC_TIMER_SECH_INDEX 0 -+#define PHYTMAC_TIMER_SECH_WIDTH 16 -+ -+/* Bitfields in PHYTMAC_TIMER_SEC */ -+#define PHYTMAC_TIMER_SECL_INDEX 0 -+#define PHYTMAC_TIMER_SECL_WIDTH 32 -+ -+/* Bitfields in PHYTMAC_TIMER_NSEC */ -+#define PHYTMAC_TIMER_NSEC_INDEX 0 -+#define PHYTMAC_TIMER_NSEC_WIDTH 30 -+ -+/* Bitfields in PHYTMAC_TIMER_ADJUST */ -+#define PHYTMAC_ASEC_INDEX 0 -+#define PHYTMAC_ASEC_WIDTH 30 -+#define PHYTMAC_AADD_INDEX 31 -+#define PHYTMAC_AADD_WIDTH 1 -+#define PHYTMAC_ASEC_MAX ((1 << PHYTMAC_ASEC_WIDTH) - 1) -+ -+#define PHYTMAC_TIMER_SEC_WIDTH (PHYTMAC_TIMER_SECH_WIDTH + PHYTMAC_TIMER_SECL_WIDTH) -+#define TIMER_SEC_MAX_VAL (((u64)1 << PHYTMAC_TIMER_SEC_WIDTH) - 1) -+#define TIMER_NSEC_MAX_VAL ((1 << PHYTMAC_TIMER_NSEC_WIDTH) - 1) -+ -+#define PHYTMAC_TAIL_PTR(i) (0x0100 + ((i) * 4)) -+#define PHYTMAC_INT_ER(i) (0x0140 + ((i) * 4)) -+#define PHYTMAC_INT_DR(i) (0x0180 + ((i) * 4)) -+#define PHYTMAC_INT_MR(i) (0x01c0 + ((i) * 4)) -+#define PHYTMAC_INT_SR(i) (0x0200 + ((i) * 4)) -+ -+#define PHYTMAC_LINK_INDEX 0 /* PCS link status */ -+#define PHYTMAC_LINK_WIDTH 1 -+#define PHYTMAC_MIDLE_INDEX 2 /* Mdio idle */ -+#define PHYTMAC_MIDLE_WIDTH 1 -+ -+/* Int stauts/Enable/Disable/Mask Register */ -+#define PHYTMAC_RXCOMP_INDEX 1 /* Rx complete */ -+#define PHYTMAC_RXCOMP_WIDTH 1 -+#define PHYTMAC_RUSED_INDEX 2 /* Rx used bit read */ -+#define PHYTMAC_RUSED_WIDTH 1 -+#define PHYTMAC_DMA_ERR_INDEX 6 /* AMBA error */ -+#define PHYTMAC_DMA_ERR_WIDTH 1 -+#define PHYTMAC_TXCOMP_INDEX 7 /* Tx complete */ -+#define PHYTMAC_TXCOMP_WIDTH 1 -+#define PHYTMAC_RXOVERRUN_INDEX 10 /* Rx overrun */ -+#define PHYTMAC_RXOVERRUN_WIDTH 1 -+#define PHYTMAC_RESP_ERR_INDEX 11 /* Resp not ok */ -+#define PHYTMAC_RESP_ERR_WIDTH 1 -+ -+/* pcs an lp */ -+#define PHYTMAC_AUTO_NEG_INDEX 12 -+#define PHYTMAC_AUTO_NEG_WIDTH 1 -+ -+/* Bitfields in USX_STATUS. */ -+#define PHYTMAC_USX_LINK_INDEX 0 -+#define PHYTMAC_USX_LINK_WIDTH 1 -+ -+/* Mdio read/write Register */ -+#define PHYTMAC_VALUE_INDEX 0 /* value */ -+#define PHYTMAC_VALUE_WIDTH 16 -+#define PHYTMAC_CONST_INDEX 16 /* Must Be 10 */ -+#define PHYTMAC_CONST_WIDTH 2 -+#define PHYTMAC_REGADDR_INDEX 18 /* Register address */ -+#define PHYTMAC_REGADDR_WIDTH 5 -+#define PHYTMAC_PHYADDR_INDEX 23 /* Phy address */ -+#define PHYTMAC_PHYADDR_WIDTH 5 -+#define PHYTMAC_MDCOPS_INDEX 28 -+#define PHYTMAC_MDCOPS_WIDTH 2 -+#define PHYTMAC_CLAUSESEL_INDEX 30 -+#define PHYTMAC_CLAUSESEL_WIDTH 1 -+#define PHYTMAC_C22 1 -+#define PHYTMAC_C45 0 -+#define PHYTMAC_C45_ADDR 0 -+#define PHYTMAC_C45_WRITE 1 -+#define PHYTMAC_C45_READ 3 -+#define PHYTMAC_C22_WRITE 1 -+#define PHYTMAC_C22_READ 2 -+ -+/* rx dma desc bit */ -+/* DMA descriptor bitfields */ -+#define PHYTMAC_RXUSED_INDEX 0 -+#define PHYTMAC_RXUSED_WIDTH 1 -+#define PHYTMAC_RXWRAP_INDEX 1 -+#define PHYTMAC_RXWRAP_WIDTH 1 -+#define PHYTMAC_RXTSVALID_INDEX 2 -+#define PHYTMAC_RXTSVALID_WIDTH 1 -+#define PHYTMAC_RXWADDR_INDEX 2 -+#define PHYTMAC_RXWADDR_WIDTH 30 -+ -+#define PHYTMAC_RXFRMLEN_INDEX 0 -+#define PHYTMAC_RXFRMLEN_WIDTH 12 -+#define PHYTMAC_RXINDEX_INDEX 12 -+#define PHYTMAC_RXINDEX_WIDTH 2 -+#define PHYTMAC_RXSOF_INDEX 14 -+#define PHYTMAC_RXSOF_WIDTH 1 -+#define PHYTMAC_RXEOF_INDEX 15 -+#define PHYTMAC_RXEOF_WIDTH 1 -+ -+#define PHYTMAC_RXFRMLEN_MASK 0x1FFF -+#define PHYTMAC_RXJFRMLEN_MASK 0x3FFF -+ -+#define PHYTMAC_RXTYPEID_MATCH_INDEX 22 -+#define PHYTMAC_RXTYPEID_MATCH_WIDTH 2 -+#define PHYTMAC_RXCSUM_INDEX 22 -+#define PHYTMAC_RXCSUM_WIDTH 2 -+ -+/* Buffer descriptor constants */ -+#define PHYTMAC_RXCSUM_NONE 0 -+#define PHYTMAC_RXCSUM_IP 1 -+#define PHYTMAC_RXCSUM_IP_TCP 2 -+#define PHYTMAC_RXCSUM_IP_UDP 3 -+ -+#define PHYTMAC_TXFRMLEN_INDEX 0 -+#define PHYTMAC_TXFRMLEN_WIDTH 14 -+#define PHYTMAC_TXLAST_INDEX 15 -+#define PHYTMAC_TXLAST_WIDTH 1 -+#define PHYTMAC_TXNOCRC_INDEX 16 -+#define PHYTMAC_TXNOCRC_WIDTH 1 -+#define PHYTMAC_MSSMFS_INDEX 16 -+#define PHYTMAC_MSSMFS_WIDTH 14 -+#define PHYTMAC_TXLSO_INDEX 17 -+#define PHYTMAC_TXLSO_WIDTH 2 -+#define PHYTMAC_TXTCP_SEQ_SRC_INDEX 19 -+#define PHYTMAC_TXTCP_SEQ_SRC_WIDTH 1 -+#define PHYTMAC_TXTSVALID_INDEX 23 -+#define PHYTMAC_TXTSVALID_WIDTH 1 -+#define PHYTMAC_TXWRAP_INDEX 30 -+#define PHYTMAC_TXWRAP_WIDTH 1 -+#define PHYTMAC_TXUSED_INDEX 31 -+#define PHYTMAC_TXUSED_WIDTH 1 -+ -+/* dma ts */ -+#define PHYTMAC_TS_NSEC_INDEX 0 -+#define PHYTMAC_TS_NSEC_WIDTH 30 -+#define PHYTMAC_TS_SECL_INDEX 30 -+#define PHYTMAC_TS_SECL_WIDTH 2 -+#define PHYTMAC_TS_SECH_INDEX 0 -+#define PHYTMAC_TS_SECH_WIDTH 4 -+#define PHYTMAC_TS_SEC_MASK 0x3f -+#define PHYTMAC_TS_SEC_TOP 0x40 -+ -+#define HW_DMA_CAP_64B 0x1 -+#define HW_DMA_CAP_CSUM 0x2 -+#define HW_DMA_CAP_PTP 0x4 -+#define HW_DMA_CAP_DDW64 0x8 -+#define HW_DMA_CAP_DDW128 0x10 -+ -+#define PHYTMAC_DBW64 2 -+#define PHYTMAC_DBW128 4 -+ -+enum phytmac_msg_cmd_id { -+ PHYTMAC_MSG_CMD_DEFAULT = 0, -+ PHYTMAC_MSG_CMD_SET, -+ PHYTMAC_MSG_CMD_GET, -+ PHYTMAC_MSG_CMD_DATA, -+ PHYTMAC_MSG_CMD_REPORT, -+}; -+ -+enum phytmac_default_subid { -+ PHYTMAC_MSG_CMD_DEFAULT_RESET_HW = 0, -+ PHYTMAC_MSG_CMD_DEFAULT_RESET_TX_QUEUE, -+ PHYTMAC_MSG_CMD_DEFAULT_RESET_RX_QUEUE, -+}; -+ -+enum phytmac_set_subid { -+ PHYTMAC_MSG_CMD_SET_INIT_ALL = 0, -+ PHYTMAC_MSG_CMD_SET_INIT_RING = 1, -+ PHYTMAC_MSG_CMD_SET_INIT_TX_RING = 2, -+ PHYTMAC_MSG_CMD_SET_INIT_RX_RING = 3, -+ PHYTMAC_MSG_CMD_SET_MAC_CONFIG = 4, -+ PHYTMAC_MSG_CMD_SET_ADDR = 5, -+ PHYTMAC_MSG_CMD_SET_DMA_RX_BUFSIZE = 6, -+ PHYTMAC_MSG_CMD_SET_DMA = 7, -+ PHYTMAC_MSG_CMD_SET_CAPS = 8, -+ PHYTMAC_MSG_CMD_SET_TS_CONFIG = 9, -+ PHYTMAC_MSG_CMD_SET_INIT_TX_ENABLE_TRANSMIT = 10, -+ PHYTMAC_MSG_CMD_SET_INIT_RX_ENABLE_RECEIVE = 11, -+ PHYTMAC_MSG_CMD_SET_ENABLE_NETWORK = 12, -+ PHYTMAC_MSG_CMD_SET_DISABLE_NETWORK = 13, -+ PHYTMAC_MSG_CMD_SET_ENABLE_MDIO = 14, -+ PHYTMAC_MSG_CMD_SET_DISABLE_MDIO = 15, -+ PHYTMAC_MSG_CMD_SET_ENABLE_TXCSUM = 16, -+ PHYTMAC_MSG_CMD_SET_DISABLE_TXCSUM = 17, -+ PHYTMAC_MSG_CMD_SET_ENABLE_RXCSUM = 18, -+ PHYTMAC_MSG_CMD_SET_DISABLE_RXCSUM = 19, -+ PHYTMAC_MSG_CMD_SET_ENABLE_PROMISE = 20, -+ PHYTMAC_MSG_CMD_SET_DISABLE_PROMISE = 21, -+ PHYTMAC_MSG_CMD_SET_ENABLE_MC = 22, -+ PHYTMAC_MSG_CMD_SET_DISABLE_MC = 23, -+ PHYTMAC_MSG_CMD_SET_ENABLE_HASH_MC = 24, -+ PHYTMAC_MSG_CMD_SET_ENABLE_PAUSE = 25, -+ PHYTMAC_MSG_CMD_SET_DISABLE_PAUSE = 26, -+ PHYTMAC_MSG_CMD_SET_ENABLE_JUMBO = 27, -+ PHYTMAC_MSG_CMD_SET_DISABLE_JUMBO = 28, -+ PHYTMAC_MSG_CMD_SET_ENABLE_1536_FRAMES = 29, -+ PHYTMAC_MSG_CMD_SET_ENABLE_STRIPCRC = 30, -+ PHYTMAC_MSG_CMD_SET_DISABLE_STRIPCRC = 31, -+ PHYTMAC_MSG_CMD_SET_PCS_LINK_UP = 32, -+ PHYTMAC_MSG_CMD_SET_PCS_LINK_DOWN = 33, -+ PHYTMAC_MSG_CMD_SET_MAC_LINK_CONFIG = 34, -+ PHYTMAC_MSG_CMD_SET_REG_WRITE = 35, -+ PHYTMAC_MSG_CMD_SET_ENABLE_BC = 36, -+ PHYTMAC_MSG_CMD_SET_DISABLE_BC = 37, -+ PHYTMAC_MSG_CMD_SET_ETH_MATCH = 38, -+ PHYTMAC_MSG_CMD_SET_ADD_FDIR = 39, -+ PHYTMAC_MSG_CMD_SET_DEL_FDIR = 40, -+ PHYTMAC_MSG_CMD_SET_ENABLE_AUTONEG = 41, -+ PHYTMAC_MSG_CMD_SET_DISABLE_AUTONEG = 42, -+ PHYTMAC_MSG_CMD_SET_RX_DATA_OFFSET = 43, -+ PHYTMAC_MSG_CMD_SET_WOL = 44, -+}; -+ -+enum phytmac_get_subid { -+ PHYTMAC_MSG_CMD_GET_ADDR, -+ PHYTMAC_MSG_CMD_GET_QUEUENUMS, -+ PHYTMAC_MSG_CMD_GET_CAPS, -+ PHYTMAC_MSG_CMD_GET_BD_PREFETCH, -+ PHYTMAC_MSG_CMD_GET_STATS, -+ PHYTMAC_MSG_CMD_GET_REG_READ, -+}; -+ -+struct phytmac_interface_info { -+ u8 interface; -+ u8 autoneg; -+ u16 duplex; -+ u32 speed; -+} __packed; -+ -+struct phytmac_mc_info { -+ u32 mc_bottom; -+ u32 mc_top; -+} __packed; -+ -+struct phytmac_fdir_info { -+ u32 ip4src; -+ u32 ip4dst; -+ u16 srcport; -+ u16 srcport_mask; -+ u16 dstport; -+ u16 dstport_mask; -+ u8 location; -+ u8 queue; -+ u8 ipsrc_en; -+ u8 ipdst_en; -+ u8 port_en; -+} __packed; -+ -+struct phytmac_ts_config { -+ u8 tx_mode; -+ u8 rx_mode; -+ u8 one_step; -+} __packed; -+ -+struct phytmac_ring_info { -+ u64 addr[4]; -+ u8 queue_num; -+ u8 hw_dma_cap; -+} __packed; -+ -+struct phytmac_rxbuf_info { -+ u8 queue_num; -+ u8 buffer_size; -+} __packed; -+ -+struct phytmac_dma_info { -+ u16 dma_burst_length; -+ u8 hw_dma_cap; -+} __packed; -+ -+struct phytmac_eth_info { -+ u16 index; -+ u16 etype; -+} __packed; -+ -+struct phytmac_mac { -+ u32 addrl; -+ u16 addrh; -+} __packed; -+ -+struct phytmac_feature { -+ u8 irq_read_clear; -+ u8 dma_data_width; -+ u8 dma_addr_width; -+ u8 tx_pkt_buffer; -+ u8 rx_pkt_buffer; -+ u8 pbuf_lso; -+ u8 queue_num; -+ u8 tx_bd_prefetch; -+ u8 rx_bd_prefetch; -+ u8 max_rx_fs; -+} __packed; -+ -+struct phytmac_msg_info { -+ u16 module_id; -+ u16 cmd_id; -+ u16 cmd_subid; -+ u16 flags; -+ u8 para[64]; -+} __packed; -+ -+#endif -diff --git a/drivers/net/ethernet/stmicro/stmmac/Kconfig b/drivers/net/ethernet/stmicro/stmmac/Kconfig -index 25f2d42de..bd1a3a9dd 100644 ---- a/drivers/net/ethernet/stmicro/stmmac/Kconfig -+++ b/drivers/net/ethernet/stmicro/stmmac/Kconfig -@@ -121,6 +121,16 @@ config DWMAC_MESON - the stmmac device driver. This driver is used for Meson6, - Meson8, Meson8b and GXBB SoCs. - -+config DWMAC_PHYTIUM -+ tristate "Phytium dwmac support" -+ default ARCH_PHYTIUM -+ depends on (OF || ACPI) && (ARCH_PHYTIUM || COMPILE_TEST) -+ help -+ Support for GMAC controller on Phytium SoCs. -+ -+ This selects the Phytium GMAC glue layer support for the -+ stmmac device driver. -+ - config DWMAC_QCOM_ETHQOS - tristate "Qualcomm ETHQOS support" - default ARCH_QCOM -diff --git a/drivers/net/ethernet/stmicro/stmmac/Makefile b/drivers/net/ethernet/stmicro/stmmac/Makefile -index 5b57aee19..91b1cf9bc 100644 ---- a/drivers/net/ethernet/stmicro/stmmac/Makefile -+++ b/drivers/net/ethernet/stmicro/stmmac/Makefile -@@ -19,6 +19,7 @@ obj-$(CONFIG_DWMAC_IPQ806X) += dwmac-ipq806x.o - obj-$(CONFIG_DWMAC_LPC18XX) += dwmac-lpc18xx.o - obj-$(CONFIG_DWMAC_MEDIATEK) += dwmac-mediatek.o - obj-$(CONFIG_DWMAC_MESON) += dwmac-meson.o dwmac-meson8b.o -+obj-$(CONFIG_DWMAC_PHYTIUM) += dwmac-phytium.o - obj-$(CONFIG_DWMAC_QCOM_ETHQOS) += dwmac-qcom-ethqos.o - obj-$(CONFIG_DWMAC_ROCKCHIP) += dwmac-rk.o - obj-$(CONFIG_DWMAC_SOCFPGA) += dwmac-altr-socfpga.o -diff --git a/drivers/net/ethernet/stmicro/stmmac/common.h b/drivers/net/ethernet/stmicro/stmmac/common.h -index b0dd8adce..e4294c606 100644 ---- a/drivers/net/ethernet/stmicro/stmmac/common.h -+++ b/drivers/net/ethernet/stmicro/stmmac/common.h -@@ -50,10 +50,10 @@ - */ - #define DMA_MIN_TX_SIZE 64 - #define DMA_MAX_TX_SIZE 1024 --#define DMA_DEFAULT_TX_SIZE 512 -+#define DMA_DEFAULT_TX_SIZE 1024 - #define DMA_MIN_RX_SIZE 64 - #define DMA_MAX_RX_SIZE 1024 --#define DMA_DEFAULT_RX_SIZE 512 -+#define DMA_DEFAULT_RX_SIZE 1024 - #define STMMAC_GET_ENTRY(x, size) ((x + 1) & (size - 1)) - - #undef FRAME_FILTER_DEBUG -diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c b/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c -new file mode 100644 -index 000000000..6e8e44730 ---- /dev/null -+++ b/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c -@@ -0,0 +1,221 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium DWMAC specific glue layer -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * -+ * Chen Baozi -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "stmmac.h" -+#include "stmmac_platform.h" -+ -+static int phytium_get_mac_mode(struct fwnode_handle *fwnode) -+{ -+ const char *pm; -+ int err, i; -+ -+ err = fwnode_property_read_string(fwnode, "mac-mode", &pm); -+ if (err < 0) -+ return err; -+ -+ for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) { -+ if (!strcasecmp(pm, phy_modes(i))) -+ return i; -+ } -+ -+ return -ENODEV; -+} -+ -+static int phytium_dwmac_acpi_phy(struct plat_stmmacenet_data *plat, -+ struct fwnode_handle *np, struct device *dev) -+{ -+ plat->mdio_bus_data = devm_kzalloc(dev, sizeof(struct stmmac_mdio_bus_data), GFP_KERNEL); -+ -+ if (!plat->mdio_bus_data) -+ return -ENOMEM; -+ -+ return 0; -+} -+ -+static int phytium_dwmac_probe(struct platform_device *pdev) -+{ -+ struct fwnode_handle *fwnode = dev_fwnode(&pdev->dev); -+ struct plat_stmmacenet_data *plat; -+ struct stmmac_resources stmmac_res; -+ struct device_node *np = pdev->dev.of_node; -+ u64 clk_freq; -+ char clk_name[20]; -+ int ret; -+ -+ plat = devm_kzalloc(&pdev->dev, sizeof(*plat), GFP_KERNEL); -+ if (!plat) -+ return -ENOMEM; -+ -+ plat->dma_cfg = devm_kzalloc(&pdev->dev, sizeof(*plat->dma_cfg), GFP_KERNEL); -+ if (!plat->dma_cfg) -+ return -ENOMEM; -+ -+ plat->axi = devm_kzalloc(&pdev->dev, sizeof(*plat->axi), GFP_KERNEL); -+ if (!plat->axi) -+ return -ENOMEM; -+ -+ plat->phy_interface = device_get_phy_mode(&pdev->dev); -+ if (plat->phy_interface < 0) -+ return plat->phy_interface; -+ -+ plat->mac_interface = phytium_get_mac_mode(fwnode); -+ if (plat->mac_interface < 0) -+ plat->mac_interface = plat->phy_interface; -+ -+ /* Configure PHY if using device-tree */ -+ if (pdev->dev.of_node) { -+ plat->phy_node = of_parse_phandle(np, "phy-handle", 0); -+ plat->port_node = of_fwnode_handle(np); -+ } -+ -+ if (pdev->dev.of_node) { -+ plat->bus_id = of_alias_get_id(np, "ethernet"); -+ if (plat->bus_id < 0) -+ plat->bus_id = 0; -+ } else if (fwnode_property_read_u32(fwnode, "bus_id", &plat->bus_id)) { -+ plat->bus_id = 2; -+ } -+ -+ plat->phy_addr = -1; -+ plat->clk_csr = -1; -+ plat->has_gmac = 1; -+ plat->enh_desc = 1; -+ plat->bugged_jumbo = 1; -+ plat->pmt = 1; -+ plat->force_sf_dma_mode = 1; -+ -+ if (fwnode_property_read_u32(fwnode, "max-speed", &plat->max_speed)) -+ plat->max_speed = -1; -+ -+ if (fwnode_property_read_u32(fwnode, "max-frame-size", &plat->maxmtu)) -+ plat->maxmtu = JUMBO_LEN; -+ -+ if (fwnode_property_read_u32(fwnode, "snps,multicast-filter-bins", -+ &plat->multicast_filter_bins)) -+ plat->multicast_filter_bins = HASH_TABLE_SIZE; -+ -+ if (fwnode_property_read_u32(fwnode, "snps,perfect-filter-entries", -+ &plat->unicast_filter_entries)) -+ plat->unicast_filter_entries = 1; -+ -+ if (fwnode_property_read_u32(fwnode, "tx-fifo-depth", &plat->tx_fifo_size)) -+ plat->tx_fifo_size = 0x1000; -+ -+ if (fwnode_property_read_u32(fwnode, "rx-fifo-depth", &plat->rx_fifo_size)) -+ plat->rx_fifo_size = 0x1000; -+ -+ if (phytium_dwmac_acpi_phy(plat, fwnode, &pdev->dev)) -+ return -ENODEV; -+ -+ plat->rx_queues_to_use = 1; -+ plat->tx_queues_to_use = 1; -+ plat->rx_queues_cfg[0].mode_to_use = MTL_QUEUE_DCB; -+ plat->tx_queues_cfg[0].mode_to_use = MTL_QUEUE_DCB; -+ -+ if (fwnode_property_read_u64(fwnode, "clock-frequency", &clk_freq)) -+ clk_freq = 125000000; -+ -+ /* Set system clock */ -+ snprintf(clk_name, sizeof(clk_name), "%s-%d", "stmmaceth", plat->bus_id); -+ -+ plat->stmmac_clk = clk_register_fixed_rate(&pdev->dev, clk_name, NULL, 0, clk_freq); -+ if (IS_ERR(plat->stmmac_clk)) { -+ dev_warn(&pdev->dev, "Fail to register stmmac-clk\n"); -+ plat->stmmac_clk = NULL; -+ } -+ -+ ret = clk_prepare_enable(plat->stmmac_clk); -+ if (ret) { -+ clk_unregister_fixed_rate(plat->stmmac_clk); -+ return ret; -+ } -+ -+ plat->clk_ptp_rate = clk_get_rate(plat->stmmac_clk); -+ plat->clk_ptp_ref = NULL; -+ -+ if (fwnode_property_read_u32(fwnode, "snps,pbl", &plat->dma_cfg->pbl)) -+ plat->dma_cfg->pbl = 16; -+ -+ fwnode_property_read_u32(fwnode, "snps,txpbl", &plat->dma_cfg->txpbl); -+ fwnode_property_read_u32(fwnode, "snps,rxpbl", &plat->dma_cfg->rxpbl); -+ -+ plat->dma_cfg->pblx8 = !fwnode_property_read_bool(fwnode, "snps,no-pbl-x8"); -+ plat->dma_cfg->aal = fwnode_property_read_bool(fwnode, "snps,aal"); -+ plat->dma_cfg->fixed_burst = fwnode_property_read_bool(fwnode, "snps,fixed-burst"); -+ plat->dma_cfg->mixed_burst = fwnode_property_read_bool(fwnode, "snps,mixed-burst"); -+ -+ plat->axi->axi_lpi_en = false; -+ plat->axi->axi_xit_frm = false; -+ plat->axi->axi_wr_osr_lmt = 7; -+ plat->axi->axi_rd_osr_lmt = 7; -+ plat->axi->axi_blen[0] = 16; -+ -+ memset(&stmmac_res, 0, sizeof(stmmac_res)); -+ stmmac_res.addr = devm_platform_ioremap_resource(pdev, 0); -+ stmmac_res.irq = platform_get_irq(pdev, 0); -+ if (stmmac_res.irq < 0) { -+ dev_err(&pdev->dev, "IRQ not found.\n"); -+ return -ENXIO; -+ } -+ stmmac_res.wol_irq = stmmac_res.irq; -+ stmmac_res.lpi_irq = -1; -+ -+ return stmmac_dvr_probe(&pdev->dev, plat, &stmmac_res); -+} -+ -+int phytium_dwmac_remove(struct platform_device *pdev) -+{ -+ struct net_device *ndev = platform_get_drvdata(pdev); -+ struct stmmac_priv *priv = netdev_priv(ndev); -+ struct plat_stmmacenet_data *plat = priv->plat; -+ -+ stmmac_pltfr_remove(pdev); -+ clk_unregister_fixed_rate(plat->stmmac_clk); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_OF -+static const struct of_device_id phytium_dwmac_of_match[] = { -+ { .compatible = "phytium,gmac" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_dwmac_of_match); -+#endif -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_dwmac_acpi_ids[] = { -+ { .id = "PHYT0004" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_dwmac_acpi_ids); -+#endif -+ -+static struct platform_driver phytium_dwmac_driver = { -+ .probe = phytium_dwmac_probe, -+ .remove = phytium_dwmac_remove, -+ .driver = { -+ .name = "phytium-dwmac", -+ .pm = &stmmac_pltfr_pm_ops, -+ .of_match_table = of_match_ptr(phytium_dwmac_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_dwmac_acpi_ids), -+ }, -+}; -+module_platform_driver(phytium_dwmac_driver); -+ -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium DWMAC specific glue layer"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/net/ethernet/stmicro/stmmac/norm_desc.c b/drivers/net/ethernet/stmicro/stmmac/norm_desc.c -index 68a7cfcb1..40088a390 100644 ---- a/drivers/net/ethernet/stmicro/stmmac/norm_desc.c -+++ b/drivers/net/ethernet/stmicro/stmmac/norm_desc.c -@@ -200,6 +200,10 @@ static void ndesc_prepare_tx_desc(struct dma_desc *p, int is_fs, int len, - else - norm_set_tx_desc_len_on_ring(p, len); - -+ /* The own bit must be the latest setting done when prepare the -+ * descriptor and then barrier is needed to make sure that all is coherent. -+ */ -+ wmb(); - if (tx_own) - p->des0 |= cpu_to_le32(TDES0_OWN); - } -diff --git a/drivers/net/phy/at803x.c b/drivers/net/phy/at803x.c -index ef203b080..32ac18d6e 100644 ---- a/drivers/net/phy/at803x.c -+++ b/drivers/net/phy/at803x.c -@@ -868,6 +868,9 @@ static int at803x_probe(struct phy_device *phydev) - if (ret) - return ret; - -+ /* dwmac-phytium need disable hibernate mode */ -+ priv->flags |= AT803X_DISABLE_HIBERNATION_MODE; -+ - if (phydev->drv->phy_id == ATH8031_PHY_ID) { - int ccr = phy_read(phydev, AT803X_REG_CHIP_CONFIG); - int mode_cfg; -diff --git a/drivers/net/phy/phylink.c b/drivers/net/phy/phylink.c -index b5f012619..fead84822 100644 ---- a/drivers/net/phy/phylink.c -+++ b/drivers/net/phy/phylink.c -@@ -3739,6 +3739,11 @@ static int __init phylink_init(void) - return 0; - } - -+static void __exit phylink_exit(void) -+{ -+} -+ - module_init(phylink_init); -+module_exit(phylink_exit); - - MODULE_LICENSE("GPL v2"); -diff --git a/drivers/net/wireless/realtek/rtw88/mac.c b/drivers/net/wireless/realtek/rtw88/mac.c -index 298663b03..0c1c1ff31 100644 ---- a/drivers/net/wireless/realtek/rtw88/mac.c -+++ b/drivers/net/wireless/realtek/rtw88/mac.c -@@ -309,6 +309,13 @@ static int rtw_mac_power_switch(struct rtw_dev *rtwdev, bool pwr_on) - pwr_seq = pwr_on ? chip->pwr_on_seq : chip->pwr_off_seq; - ret = rtw_pwr_seq_parser(rtwdev, pwr_seq); - -+ if (pwr_on && rtw_hci_type(rtwdev) == RTW_HCI_TYPE_USB) { -+ if (chip->id == RTW_CHIP_TYPE_8822C || -+ chip->id == RTW_CHIP_TYPE_8822B || -+ chip->id == RTW_CHIP_TYPE_8821C) -+ rtw_write8_clr(rtwdev, REG_SYS_STATUS1 + 1, BIT(0)); -+ } -+ - if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) - rtw_write32(rtwdev, REG_SDIO_HIMR, imr); - -diff --git a/drivers/net/wireless/realtek/rtw88/rtw8821cu.c b/drivers/net/wireless/realtek/rtw88/rtw8821cu.c -index 7a5cbdc31..e2c7d9f87 100644 ---- a/drivers/net/wireless/realtek/rtw88/rtw8821cu.c -+++ b/drivers/net/wireless/realtek/rtw88/rtw8821cu.c -@@ -9,24 +9,36 @@ - #include "usb.h" - - static const struct usb_device_id rtw_8821cu_id_table[] = { -- { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb82b, 0xff, 0xff, 0xff), -- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x2006, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x8731, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x8811, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, - { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb820, 0xff, 0xff, 0xff), -- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -- { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc821, 0xff, 0xff, 0xff), -- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb82b, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc80c, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc811, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, - { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc820, 0xff, 0xff, 0xff), -- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc821, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, - { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82a, 0xff, 0xff, 0xff), -- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, - { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82b, 0xff, 0xff, 0xff), -- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ -- { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc811, 0xff, 0xff, 0xff), -- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8811CU */ -- { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x8811, 0xff, 0xff, 0xff), -- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8811CU */ -- { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x2006, 0xff, 0xff, 0xff), -- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* TOTOLINK A650UA v3 */ -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82c, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, -+ { USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x331d, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* D-Link */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xc811, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* Edimax */ -+ { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xd811, 0xff, 0xff, 0xff), -+ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* Edimax */ - {}, - }; - MODULE_DEVICE_TABLE(usb, rtw_8821cu_id_table); -diff --git a/drivers/of/Kconfig b/drivers/of/Kconfig -index da9826acc..69e7c420b 100644 ---- a/drivers/of/Kconfig -+++ b/drivers/of/Kconfig -@@ -102,4 +102,15 @@ config OF_OVERLAY - config OF_NUMA - bool - -+config OF_DMA_DEFAULT_COHERENT -+ # arches should select this if DMA is coherent by default for OF devices -+ bool -+ -+config OF_CONFIGFS -+ bool "Device Tree Overlay ConfigFS interface" -+ select CONFIGFS_FS -+ select OF_OVERLAY -+ help -+ Enable a simple user-space driven DT overlay interface. -+ - endif # OF -diff --git a/drivers/of/Makefile b/drivers/of/Makefile -index eff624854..61bd05f08 100644 ---- a/drivers/of/Makefile -+++ b/drivers/of/Makefile -@@ -1,6 +1,7 @@ - # SPDX-License-Identifier: GPL-2.0 - obj-y = base.o cpu.o device.o module.o platform.o property.o - obj-$(CONFIG_OF_KOBJ) += kobj.o -+obj-$(CONFIG_OF_CONFIGFS) += configfs.o - obj-$(CONFIG_OF_DYNAMIC) += dynamic.o - obj-$(CONFIG_OF_FLATTREE) += fdt.o - obj-$(CONFIG_OF_EARLY_FLATTREE) += fdt_address.o -diff --git a/drivers/of/configfs.c b/drivers/of/configfs.c -new file mode 100644 -index 000000000..1c30f35c3 ---- /dev/null -+++ b/drivers/of/configfs.c -@@ -0,0 +1,277 @@ -+/* -+ * Configfs entries for device-tree -+ * -+ * Copyright (C) 2013 - Pantelis Antoniou -+ * -+ * 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 -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "of_private.h" -+ -+struct cfs_overlay_item { -+ struct config_item item; -+ -+ char path[PATH_MAX]; -+ -+ const struct firmware *fw; -+ struct device_node *overlay; -+ int ov_id; -+ -+ void *dtbo; -+ int dtbo_size; -+}; -+ -+static inline struct cfs_overlay_item *to_cfs_overlay_item( -+ struct config_item *item) -+{ -+ return item ? container_of(item, struct cfs_overlay_item, item) : NULL; -+} -+ -+static ssize_t cfs_overlay_item_path_show(struct config_item *item, -+ char *page) -+{ -+ struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); -+ return sprintf(page, "%s\n", overlay->path); -+} -+ -+static ssize_t cfs_overlay_item_path_store(struct config_item *item, -+ const char *page, size_t count) -+{ -+ struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); -+ const char *p = page; -+ char *s; -+ int err; -+ -+ /* if it's set do not allow changes */ -+ if (overlay->path[0] != '\0' || overlay->dtbo_size > 0) -+ return -EPERM; -+ -+ /* copy to path buffer (and make sure it's always zero terminated */ -+ count = snprintf(overlay->path, sizeof(overlay->path) - 1, "%s", p); -+ overlay->path[sizeof(overlay->path) - 1] = '\0'; -+ -+ /* strip trailing newlines */ -+ s = overlay->path + strlen(overlay->path); -+ while (s > overlay->path && *--s == '\n') -+ *s = '\0'; -+ -+ pr_debug("%s: path is '%s'\n", __func__, overlay->path); -+ -+ err = request_firmware(&overlay->fw, overlay->path, NULL); -+ if (err != 0) -+ goto out_err; -+ -+ err = of_overlay_fdt_apply((void *)overlay->fw->data, -+ (u32)overlay->fw->size, &overlay->ov_id, NULL); -+ if (err != 0) -+ goto out_err; -+ -+ return count; -+ -+out_err: -+ -+ release_firmware(overlay->fw); -+ overlay->fw = NULL; -+ -+ overlay->path[0] = '\0'; -+ return err; -+} -+ -+static ssize_t cfs_overlay_item_status_show(struct config_item *item, -+ char *page) -+{ -+ struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); -+ -+ return sprintf(page, "%s\n", -+ overlay->ov_id > 0 ? "applied" : "unapplied"); -+} -+ -+CONFIGFS_ATTR(cfs_overlay_item_, path); -+CONFIGFS_ATTR_RO(cfs_overlay_item_, status); -+ -+static struct configfs_attribute *cfs_overlay_attrs[] = { -+ &cfs_overlay_item_attr_path, -+ &cfs_overlay_item_attr_status, -+ NULL, -+}; -+ -+ssize_t cfs_overlay_item_dtbo_read(struct config_item *item, -+ void *buf, size_t max_count) -+{ -+ struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); -+ -+ pr_debug("%s: buf=%p max_count=%zu\n", __func__, -+ buf, max_count); -+ -+ if (overlay->dtbo == NULL) -+ return 0; -+ -+ /* copy if buffer provided */ -+ if (buf != NULL) { -+ /* the buffer must be large enough */ -+ if (overlay->dtbo_size > max_count) -+ return -ENOSPC; -+ -+ memcpy(buf, overlay->dtbo, overlay->dtbo_size); -+ } -+ -+ return overlay->dtbo_size; -+} -+ -+ssize_t cfs_overlay_item_dtbo_write(struct config_item *item, -+ const void *buf, size_t count) -+{ -+ struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); -+ int err; -+ -+ /* if it's set do not allow changes */ -+ if (overlay->path[0] != '\0' || overlay->dtbo_size > 0) -+ return -EPERM; -+ -+ /* copy the contents */ -+ overlay->dtbo = kmemdup(buf, count, GFP_KERNEL); -+ if (overlay->dtbo == NULL) -+ return -ENOMEM; -+ -+ overlay->dtbo_size = count; -+ -+ err = of_overlay_fdt_apply(overlay->dtbo, overlay->dtbo_size, -+ &overlay->ov_id, NULL); -+ if (err != 0) -+ goto out_err; -+ -+ return count; -+ -+out_err: -+ kfree(overlay->dtbo); -+ overlay->dtbo = NULL; -+ overlay->dtbo_size = 0; -+ overlay->ov_id = 0; -+ -+ return err; -+} -+ -+CONFIGFS_BIN_ATTR(cfs_overlay_item_, dtbo, NULL, SZ_1M); -+ -+static struct configfs_bin_attribute *cfs_overlay_bin_attrs[] = { -+ &cfs_overlay_item_attr_dtbo, -+ NULL, -+}; -+ -+static void cfs_overlay_release(struct config_item *item) -+{ -+ struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); -+ -+ if (overlay->ov_id > 0) -+ of_overlay_remove(&overlay->ov_id); -+ if (overlay->fw) -+ release_firmware(overlay->fw); -+ /* kfree with NULL is safe */ -+ kfree(overlay->dtbo); -+ kfree(overlay); -+} -+ -+static struct configfs_item_operations cfs_overlay_item_ops = { -+ .release = cfs_overlay_release, -+}; -+ -+static struct config_item_type cfs_overlay_type = { -+ .ct_item_ops = &cfs_overlay_item_ops, -+ .ct_attrs = cfs_overlay_attrs, -+ .ct_bin_attrs = cfs_overlay_bin_attrs, -+ .ct_owner = THIS_MODULE, -+}; -+ -+static struct config_item *cfs_overlay_group_make_item( -+ struct config_group *group, const char *name) -+{ -+ struct cfs_overlay_item *overlay; -+ -+ overlay = kzalloc(sizeof(*overlay), GFP_KERNEL); -+ if (!overlay) -+ return ERR_PTR(-ENOMEM); -+ -+ config_item_init_type_name(&overlay->item, name, &cfs_overlay_type); -+ return &overlay->item; -+} -+ -+static void cfs_overlay_group_drop_item(struct config_group *group, -+ struct config_item *item) -+{ -+ struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); -+ -+ config_item_put(&overlay->item); -+} -+ -+static struct configfs_group_operations overlays_ops = { -+ .make_item = cfs_overlay_group_make_item, -+ .drop_item = cfs_overlay_group_drop_item, -+}; -+ -+static struct config_item_type overlays_type = { -+ .ct_group_ops = &overlays_ops, -+ .ct_owner = THIS_MODULE, -+}; -+ -+static struct configfs_group_operations of_cfs_ops = { -+ /* empty - we don't allow anything to be created */ -+}; -+ -+static struct config_item_type of_cfs_type = { -+ .ct_group_ops = &of_cfs_ops, -+ .ct_owner = THIS_MODULE, -+}; -+ -+struct config_group of_cfs_overlay_group; -+ -+static struct configfs_subsystem of_cfs_subsys = { -+ .su_group = { -+ .cg_item = { -+ .ci_namebuf = "device-tree", -+ .ci_type = &of_cfs_type, -+ }, -+ }, -+ .su_mutex = __MUTEX_INITIALIZER(of_cfs_subsys.su_mutex), -+}; -+ -+static int __init of_cfs_init(void) -+{ -+ int ret; -+ -+ pr_info("%s\n", __func__); -+ -+ config_group_init(&of_cfs_subsys.su_group); -+ config_group_init_type_name(&of_cfs_overlay_group, "overlays", -+ &overlays_type); -+ configfs_add_default_group(&of_cfs_overlay_group, -+ &of_cfs_subsys.su_group); -+ -+ ret = configfs_register_subsystem(&of_cfs_subsys); -+ if (ret != 0) { -+ pr_err("%s: failed to register subsys\n", __func__); -+ goto out; -+ } -+ pr_info("%s: OK\n", __func__); -+out: -+ return ret; -+} -+late_initcall(of_cfs_init); -diff --git a/drivers/pci/controller/Kconfig b/drivers/pci/controller/Kconfig -index c0c3f2824..5701b4e44 100644 ---- a/drivers/pci/controller/Kconfig -+++ b/drivers/pci/controller/Kconfig -@@ -231,6 +231,16 @@ config PCI_HYPERV_INTERFACE - drivers to have a common interface with the Hyper-V PCI frontend - driver. - -+config PCIE_PHYTIUM_EP -+ tristate "Phytium PCIe endpoint controller" -+ depends on OF -+ depends on PCI_ENDPOINT -+ help -+ Say Y here if you want to support Phytium PCIe controller in -+ endpoint mode on Phytium SoC. The controller can act as Root Port -+ or End Point with different phytium firmware. But End Point mode only support -+ one physical function. -+ - config PCI_TEGRA - bool "NVIDIA Tegra PCIe controller" - depends on ARCH_TEGRA || COMPILE_TEST -diff --git a/drivers/pci/controller/Makefile b/drivers/pci/controller/Makefile -index 37c8663de..74c69a5be 100644 ---- a/drivers/pci/controller/Makefile -+++ b/drivers/pci/controller/Makefile -@@ -39,6 +39,7 @@ obj-$(CONFIG_PCI_LOONGSON) += pci-loongson.o - obj-$(CONFIG_PCIE_HISI_ERR) += pcie-hisi-error.o - obj-$(CONFIG_PCIE_APPLE) += pcie-apple.o - obj-$(CONFIG_PCIE_MT7621) += pcie-mt7621.o -+obj-$(CONFIG_PCIE_PHYTIUM_EP) += pcie-phytium-ep.o - - # pcie-hisi.o quirks are needed even without CONFIG_PCIE_DW - obj-y += dwc/ -diff --git a/drivers/pci/controller/pcie-phytium-ep.c b/drivers/pci/controller/pcie-phytium-ep.c -new file mode 100644 -index 000000000..e25c7cdfb ---- /dev/null -+++ b/drivers/pci/controller/pcie-phytium-ep.c -@@ -0,0 +1,469 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium PCIe Endpoint controller driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ * -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "pcie-phytium-ep.h" -+#include "pcie-phytium-register.h" -+ -+#define PHYTIUM_PCIE_EP_IRQ_PCI_ADDR_NONE 0x0 -+#define PHYTIUM_PCIE_EP_IRQ_PCI_ADDR_LEGACY 0x1 -+ -+static int phytium_pcie_ep_write_header(struct pci_epc *epc, unsigned char fn, u8 vfn, -+ struct pci_epf_header *hdr) -+{ -+ struct phytium_pcie_ep *priv = epc_get_drvdata(epc); -+ u16 tmp = 0; -+ -+ phytium_pcie_writew(priv, fn, PHYTIUM_PCI_VENDOR_ID, hdr->vendorid); -+ phytium_pcie_writew(priv, fn, PHYTIUM_PCI_DEVICE_ID, hdr->deviceid); -+ phytium_pcie_writeb(priv, fn, PHYTIUM_PCI_REVISION_ID, hdr->revid); -+ phytium_pcie_writeb(priv, fn, PHYTIUM_PCI_CLASS_PROG, hdr->progif_code); -+ phytium_pcie_writew(priv, fn, PHYTIUM_PCI_CLASS_DEVICE, -+ hdr->subclass_code | (hdr->baseclass_code << 8)); -+ -+ phytium_pcie_writew(priv, fn, PHYTIUM_PCI_SUBSYS_VENDOR_ID, -+ hdr->subsys_vendor_id); -+ phytium_pcie_writew(priv, fn, PHYTIUM_PCI_SUBSYS_DEVICE_ID, -+ hdr->subsys_id); -+ -+ tmp = phytium_pcie_readw(priv, fn, PHYTIUM_PCI_INTERRUPT_PIN); -+ tmp = ((tmp & (~INTERRUPT_PIN_MASK)) | hdr->interrupt_pin); -+ phytium_pcie_writew(priv, fn, PHYTIUM_PCI_INTERRUPT_PIN, tmp); -+ -+ tmp = phytium_pcie_readw(priv, fn, PHYTIUM_PCI_MSIX_CAP); -+ phytium_pcie_writew(priv, fn, PHYTIUM_PCI_MSIX_CAP, MSIX_DISABLE); -+ -+ return 0; -+} -+ -+static int phytium_pcie_ep_set_bar(struct pci_epc *epc, u8 fn, u8 vfn, -+ struct pci_epf_bar *epf_bar) -+{ -+ struct phytium_pcie_ep *priv = epc_get_drvdata(epc); -+ u64 sz = 0, sz_mask, atr_size; -+ int flags = epf_bar->flags; -+ u32 setting, src_addr0, src_addr1, trsl_addr0, trsl_addr1, trsl_param; -+ enum pci_barno barno = epf_bar->barno; -+ struct pci_epc_mem *mem = epc->mem; -+ -+ if ((flags & PCI_BASE_ADDRESS_MEM_TYPE_64) && (barno & 1)) { -+ dev_err(&epc->dev, "bar %d do not support mem64\n", barno); -+ return -EINVAL; -+ } -+ -+ if (barno & 1) { -+ dev_err(&epc->dev, "not support bar 1/3/5\n"); -+ return -EINVAL; -+ } -+ dev_dbg(epc->dev.parent, "set bar%d mapping address 0x%pa size 0x%lx\n", -+ barno, &(epf_bar->phys_addr), epf_bar->size); -+ -+ if ((flags & PCI_BASE_ADDRESS_SPACE) == PCI_BASE_ADDRESS_SPACE_IO) { -+ setting = BAR_IO_TYPE; -+ sz = max_t(size_t, epf_bar->size, BAR_IO_MIN_APERTURE); -+ sz = 1 << fls64(sz - 1); -+ sz_mask = ~(sz - 1); -+ setting |= sz_mask; -+ trsl_param = TRSL_ID_IO; -+ } else { -+ setting = BAR_MEM_TYPE; -+ sz = max_t(size_t, epf_bar->size, BAR_MEM_MIN_APERTURE); -+ sz = 1 << fls64(sz - 1); -+ sz_mask = ~(sz - 1); -+ setting |= lower_32_bits(sz_mask); -+ -+ if (flags & PCI_BASE_ADDRESS_MEM_TYPE_64) -+ setting |= BAR_MEM_64BIT; -+ -+ if (flags & PCI_BASE_ADDRESS_MEM_PREFETCH) -+ setting |= BAR_MEM_PREFETCHABLE; -+ -+ trsl_param = TRSL_ID_MASTER; -+ } -+ -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_BAR(barno), setting); -+ if (flags & PCI_BASE_ADDRESS_MEM_TYPE_64) -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_BAR(barno + 1), -+ upper_32_bits(sz_mask)); -+ dev_dbg(epc->dev.parent, "set bar%d mapping address 0x%pa size 0x%llx 0x%x\n", -+ barno, &(epf_bar->phys_addr), sz, lower_32_bits(epf_bar->phys_addr)); -+ sz = ALIGN(sz, mem->window.page_size); -+ atr_size = fls64(sz - 1) - 1; -+ src_addr0 = ATR_IMPL | ((atr_size & ATR_SIZE_MASK) << ATR_SIZE_SHIFT); -+ src_addr1 = 0; -+ trsl_addr0 = (lower_32_bits(epf_bar->phys_addr) & TRSL_ADDR_32_12_MASK); -+ trsl_addr1 = upper_32_bits(epf_bar->phys_addr); -+ -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_SRC_ADDR0(barno), -+ src_addr0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_SRC_ADDR1(barno), -+ src_addr1); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_ADDR0(barno), -+ trsl_addr0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_ADDR1(barno), -+ trsl_addr1); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_PARAM(barno), -+ trsl_param); -+ -+ return 0; -+} -+ -+static void phytium_pcie_ep_clear_bar(struct pci_epc *epc, u8 fn, u8 vfn, -+ struct pci_epf_bar *epf_bar) -+{ -+ struct phytium_pcie_ep *priv = epc_get_drvdata(epc); -+ int flags = epf_bar->flags; -+ enum pci_barno barno = epf_bar->barno; -+ -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_BAR(barno), 0); -+ if (flags & PCI_BASE_ADDRESS_MEM_TYPE_64) -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_BAR(barno + 1), 0); -+ -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_SRC_ADDR0(barno), 0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_SRC_ADDR1(barno), 0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_ADDR0(barno), 0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_ADDR1(barno), 0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_PARAM(barno), 0); -+} -+ -+static int phytium_pcie_ep_map_addr(struct pci_epc *epc, u8 fn, u8 vfn, -+ phys_addr_t addr, u64 pci_addr, -+ size_t size) -+{ -+ struct phytium_pcie_ep *priv = epc_get_drvdata(epc); -+ u32 src_addr0, src_addr1, trsl_addr0, trsl_addr1, trsl_param, atr_size; -+ u64 sz = 0; -+ u32 r; -+ struct pci_epc_mem *mem = epc->mem; -+ -+ r = find_first_zero_bit(&priv->ob_region_map, BITS_PER_LONG); -+ if (r >= priv->max_regions) { -+ dev_err(&epc->dev, "no free outbound region\n"); -+ return -EINVAL; -+ } -+ -+ dev_dbg(epc->dev.parent, "set slave %d: mapping address 0x%pa to pci 0x%llx, size 0x%zx\n", -+ r, &addr, pci_addr, size); -+ -+ sz = ALIGN(size, mem->window.page_size); -+ atr_size = fls64(sz - 1) - 1; -+ src_addr0 = ATR_IMPL | ((atr_size & ATR_SIZE_MASK) << ATR_SIZE_SHIFT); -+ src_addr0 |= (lower_32_bits(addr) & SRC_ADDR_32_12_MASK); -+ src_addr1 = upper_32_bits(addr); -+ trsl_addr0 = (lower_32_bits(pci_addr) & TRSL_ADDR_32_12_MASK); -+ trsl_addr1 = upper_32_bits(pci_addr); -+ trsl_param = TRSL_ID_PCIE_TR; -+ -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR0(r), -+ src_addr0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR1(r), -+ src_addr1); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR0(r), -+ trsl_addr0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR1(r), -+ trsl_addr1); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_PARAM(r), -+ trsl_param); -+ set_bit(r, &priv->ob_region_map); -+ priv->ob_addr[r] = addr; -+ -+ return 0; -+} -+ -+static void phytium_pcie_ep_unmap_addr(struct pci_epc *epc, u8 fn, u8 vfn, -+ phys_addr_t addr) -+{ -+ struct phytium_pcie_ep *priv = epc_get_drvdata(epc); -+ u32 r; -+ -+ for (r = 0; r < priv->max_regions; r++) -+ if (priv->ob_addr[r] == addr) -+ break; -+ -+ if (r == priv->max_regions) { -+ dev_err(&epc->dev, "used unmap addr 0x%pa\n", &addr); -+ return; -+ } -+ dev_dbg(epc->dev.parent, "set slave %d: unmapping address 0x%pa\n", r, &addr); -+ -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR0(r), 0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR1(r), 0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR0(r), 0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR1(r), 0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_PARAM(r), 0); -+ priv->ob_addr[r] = 0; -+ clear_bit(r, &priv->ob_region_map); -+} -+ -+static int phytium_pcie_ep_set_msi(struct pci_epc *epc, u8 fn, u8 vfn, u8 mmc) -+{ -+ struct phytium_pcie_ep *priv = epc_get_drvdata(epc); -+ u16 flags = 0; -+ -+ flags = (mmc & MSI_NUM_MASK) << MSI_NUM_SHIFT; -+ flags &= ~MSI_MASK_SUPPORT; -+ phytium_pcie_writew(priv, fn, PHYTIUM_PCI_INTERRUPT_PIN, flags); -+ -+ return 0; -+} -+ -+static int phytium_pcie_ep_get_msi(struct pci_epc *epc, u8 fn, u8 vfn) -+{ -+ struct phytium_pcie_ep *priv = epc_get_drvdata(epc); -+ u16 flags, mme; -+ u32 cap = PHYTIUM_PCI_CF_MSI_BASE; -+ -+ flags = phytium_pcie_readw(priv, fn, cap + PCI_MSI_FLAGS); -+ if (!(flags & PCI_MSI_FLAGS_ENABLE)) -+ return -EINVAL; -+ -+ mme = (flags & PCI_MSI_FLAGS_QSIZE) >> 4; -+ -+ return mme; -+} -+ -+static int phytium_pcie_ep_send_msi_irq(struct phytium_pcie_ep *priv, u8 fn, -+ u8 interrupt_num) -+{ -+ u32 cap = PHYTIUM_PCI_CF_MSI_BASE; -+ u16 flags, mme, data_mask, data; -+ u8 msi_count; -+ u64 pci_addr, pci_addr_mask = IRQ_MAPPING_SIZE - 1; -+ u32 src_addr0, src_addr1, trsl_addr0, trsl_addr1, trsl_param, atr_size; -+ -+ flags = phytium_pcie_readw(priv, fn, cap + PCI_MSI_FLAGS); -+ if (!(flags & PCI_MSI_FLAGS_ENABLE)) -+ return -EINVAL; -+ -+ mme = (flags & PCI_MSI_FLAGS_QSIZE) >> 4; -+ msi_count = 1 << mme; -+ if (!interrupt_num || interrupt_num > msi_count) -+ return -EINVAL; -+ -+ data_mask = msi_count - 1; -+ data = phytium_pcie_readw(priv, fn, cap + PCI_MSI_DATA_64); -+ data = (data & ~data_mask) | ((interrupt_num - 1) & data_mask); -+ -+ /* Get the PCI address */ -+ pci_addr = phytium_pcie_readl(priv, fn, cap + PCI_MSI_ADDRESS_HI); -+ pci_addr <<= 32; -+ pci_addr |= phytium_pcie_readl(priv, fn, cap + PCI_MSI_ADDRESS_LO); -+ pci_addr &= GENMASK_ULL(63, 2); -+ -+ if (priv->irq_pci_addr != (pci_addr & ~pci_addr_mask) || (priv->irq_pci_fn != fn)) { -+ /* First region for IRQ writes. */ -+ atr_size = fls64(pci_addr_mask) - 1; -+ src_addr0 = ATR_IMPL | ((atr_size & ATR_SIZE_MASK) << ATR_SIZE_SHIFT); -+ src_addr0 |= (lower_32_bits(priv->irq_phys_addr) & SRC_ADDR_32_12_MASK); -+ src_addr1 = upper_32_bits(priv->irq_phys_addr); -+ trsl_addr0 = (lower_32_bits(pci_addr) & TRSL_ADDR_32_12_MASK); -+ trsl_addr1 = upper_32_bits(pci_addr); -+ trsl_param = TRSL_ID_PCIE_TR; -+ -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR0(0), -+ src_addr0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR1(0), -+ src_addr1); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR0(0), -+ trsl_addr0); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR1(0), -+ trsl_addr1); -+ phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_PARAM(0), -+ trsl_param); -+ priv->irq_pci_addr = (pci_addr & ~pci_addr_mask); -+ priv->irq_pci_fn = fn; -+ } -+ -+ dev_dbg(priv->epc->dev.parent, "send event %d\n", data); -+ writew(data, priv->irq_cpu_addr + (pci_addr & pci_addr_mask)); -+ -+ return 0; -+} -+ -+static int phytium_pcie_ep_raise_irq(struct pci_epc *epc, u8 fn, u8 vfn, -+ enum pci_epc_irq_type type, -+ u16 interrupt_num) -+{ -+ struct phytium_pcie_ep *priv = epc_get_drvdata(epc); -+ -+ switch (type) { -+ case PCI_EPC_IRQ_MSI: -+ return phytium_pcie_ep_send_msi_irq(priv, fn, interrupt_num); -+ -+ default: -+ break; -+ } -+ -+ return -EINVAL; -+} -+ -+static int phytium_pcie_ep_start(struct pci_epc *epc) -+{ -+ struct pci_epf *epf; -+ u32 cfg; -+ -+ cfg = BIT(0); -+ list_for_each_entry(epf, &epc->pci_epf, list) -+ cfg |= BIT(epf->func_no); -+ -+ return 0; -+} -+ -+static const struct pci_epc_ops phytium_pcie_epc_ops = { -+ .write_header = phytium_pcie_ep_write_header, -+ .set_bar = phytium_pcie_ep_set_bar, -+ .clear_bar = phytium_pcie_ep_clear_bar, -+ .map_addr = phytium_pcie_ep_map_addr, -+ .unmap_addr = phytium_pcie_ep_unmap_addr, -+ .set_msi = phytium_pcie_ep_set_msi, -+ .get_msi = phytium_pcie_ep_get_msi, -+ .raise_irq = phytium_pcie_ep_raise_irq, -+ .start = phytium_pcie_ep_start, -+}; -+ -+ -+ -+static int phytium_pcie_ep_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct phytium_pcie_ep *priv = NULL; -+ struct resource *res; -+ struct device_node *np = dev->of_node; -+ struct pci_epc *epc; -+ int ret = 0, value; -+ -+ priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); -+ if (!priv) -+ return -ENOMEM; -+ -+ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "reg"); -+ priv->reg_base = devm_ioremap_resource(dev, res); -+ if (IS_ERR(priv->reg_base)) { -+ dev_err(dev, "missing \"reg\"\n"); -+ return PTR_ERR(priv->reg_base); -+ } -+ -+ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mem"); -+ if (!res) { -+ dev_err(dev, "missing \"mem\"\n"); -+ return -EINVAL; -+ } -+ priv->mem_res = res; -+ -+ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "hpb"); -+ priv->hpb_base = devm_ioremap_resource(dev, res); -+ if (IS_ERR(priv->hpb_base)) { -+ dev_err(dev, "missing \"hpb\"\n"); -+ return PTR_ERR(priv->hpb_base); -+ } -+ -+ ret = of_property_read_u32(np, "max-outbound-regions", &priv->max_regions); -+ if (ret < 0) { -+ dev_err(dev, "missing \"max-outbound-regions\"\n"); -+ return ret; -+ } -+ dev_info(dev, "%s max-outbound-regions %d\n", __func__, priv->max_regions); -+ -+ priv->ob_addr = devm_kcalloc(dev, priv->max_regions, -+ sizeof(*priv->ob_addr), GFP_KERNEL); -+ if (!priv->ob_addr) -+ return -ENOMEM; -+ -+ platform_set_drvdata(pdev, priv); -+ -+ epc = devm_pci_epc_create(dev, &phytium_pcie_epc_ops); -+ if (IS_ERR(epc)) { -+ dev_err(dev, "failed to create epc device\n"); -+ return PTR_ERR(epc); -+ } -+ -+ priv->epc = epc; -+ epc_set_drvdata(epc, priv); -+ -+ if (of_property_read_u8(np, "max-functions", &epc->max_functions) < 0) -+ epc->max_functions = 1; -+ dev_info(dev, "%s epc->max_functions %d\n", __func__, epc->max_functions); -+ -+ -+ ret = pci_epc_mem_init(epc, priv->mem_res->start, -+ resource_size(priv->mem_res), PAGE_SIZE); -+ if (ret < 0) { -+ dev_err(dev, "failed to initialize the memory space\n"); -+ return ret; -+ } -+ -+ priv->irq_cpu_addr = pci_epc_mem_alloc_addr(epc, &priv->irq_phys_addr, -+ SZ_4K); -+ if (!priv->irq_cpu_addr) { -+ dev_err(dev, "failed to reserve memory space for MSI\n"); -+ ret = -ENOMEM; -+ goto err_alloc_irq_mem; -+ } -+ priv->irq_pci_addr = PHYTIUM_PCIE_EP_IRQ_PCI_ADDR_NONE; -+ /* Reserve region 0 for IRQS */ -+ set_bit(0, &priv->ob_region_map); -+ -+ value = ((lower_32_bits(priv->mem_res->start) >> C0_PREF_VALUE_SHIFT) -+ & C0_PREF_BASE_MASK) << C0_PREF_BASE_SHIFT; -+ value |= (((lower_32_bits(priv->mem_res->end) >> C0_PREF_VALUE_SHIFT) -+ & C0_PREF_LIMIT_MASK) << C0_PREF_LIMIT_SHIFT); -+ phytium_hpb_writel(priv, PHYTIUM_HPB_C0_PREF_BASE_LIMIT, value); -+ -+ value = ((upper_32_bits(priv->mem_res->start) >> C0_PREF_UP32_VALUE_SHIFT) -+ & C0_PREF_BASE_UP32_MASK) << C0_PREF_BASE_UP32_SHIFT; -+ value |= (((upper_32_bits(priv->mem_res->end) >> C0_PREF_UP32_VALUE_SHIFT) -+ & C0_PREF_LIMIT_UP32_MASK) << C0_PREF_LIMIT_UP32_SHIFT); -+ phytium_hpb_writel(priv, PHYTIUM_HPB_C0_PREF_BASE_LIMIT_UP32, value); -+ -+ dev_dbg(dev, "exit %s successful\n", __func__); -+ return 0; -+ -+err_alloc_irq_mem: -+ pci_epc_mem_exit(epc); -+ return ret; -+} -+ -+static int phytium_pcie_ep_remove(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct phytium_pcie_ep *priv = dev_get_drvdata(dev); -+ struct pci_epc *epc = priv->epc; -+ -+ pci_epc_mem_exit(epc); -+ -+ return 0; -+} -+ -+static const struct of_device_id phytium_pcie_ep_of_match[] = { -+ { .compatible = "phytium,pd2008-pcie-ep" }, -+ { }, -+}; -+ -+static struct platform_driver phytium_pcie_ep_driver = { -+ .driver = { -+ .name = "phytium-pcie-ep", -+ .of_match_table = phytium_pcie_ep_of_match, -+ }, -+ .probe = phytium_pcie_ep_probe, -+ .remove = phytium_pcie_ep_remove, -+}; -+ -+module_platform_driver(phytium_pcie_ep_driver); -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Yang Xun "); -+MODULE_DESCRIPTION("Phytium PCIe Controller Endpoint driver"); -diff --git a/drivers/pci/controller/pcie-phytium-ep.h b/drivers/pci/controller/pcie-phytium-ep.h -new file mode 100644 -index 000000000..10cece4fc ---- /dev/null -+++ b/drivers/pci/controller/pcie-phytium-ep.h -@@ -0,0 +1,88 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium endpoint driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PCIE_PHYTIUM_EP_H__ -+#define __PCIE_PHYTIUM_EP_H__ -+ -+#include "pcie-phytium-register.h" -+ -+#define IRQ_MAPPING_SIZE 0x1000 -+struct phytium_pcie_ep { -+ void __iomem *reg_base; -+ struct resource *mem_res; -+ void __iomem *hpb_base; -+ unsigned int max_regions; -+ unsigned long ob_region_map; -+ phys_addr_t *ob_addr; -+ phys_addr_t irq_phys_addr; -+ void __iomem *irq_cpu_addr; -+ unsigned long irq_pci_addr; -+ u8 irq_pci_fn; -+ struct pci_epc *epc; -+}; -+ -+static inline void -+phytium_pcie_writeb(struct phytium_pcie_ep *priv, u8 fn, u32 reg, u8 value) -+{ -+ pr_debug("Write 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); -+ writeb(value, priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); -+} -+ -+static inline unsigned char -+phytium_pcie_readb(struct phytium_pcie_ep *priv, u8 fn, u32 reg) -+{ -+ unsigned char value; -+ -+ value = readb(priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); -+ pr_debug("Read 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); -+ -+ return value; -+} -+ -+static inline void -+phytium_pcie_writew(struct phytium_pcie_ep *priv, u8 fn, u32 reg, u16 value) -+{ -+ pr_debug("Write 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); -+ writew(value, priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); -+} -+ -+static inline unsigned short -+phytium_pcie_readw(struct phytium_pcie_ep *priv, u8 fn, u32 reg) -+{ -+ unsigned short value; -+ -+ value = readw(priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); -+ pr_debug("Read 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); -+ -+ return value; -+} -+ -+static inline void -+phytium_pcie_writel(struct phytium_pcie_ep *priv, u8 fn, u32 reg, u32 value) -+{ -+ pr_debug("Write 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); -+ writel(value, priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); -+} -+ -+static inline unsigned int -+phytium_pcie_readl(struct phytium_pcie_ep *priv, u8 fn, u32 reg) -+{ -+ unsigned int value; -+ -+ value = readl(priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); -+ pr_debug("Read 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); -+ -+ return value; -+} -+ -+static inline void -+phytium_hpb_writel(struct phytium_pcie_ep *priv, u32 reg, u32 value) -+{ -+ pr_debug("Write 32'h%08x 32'h%08x\n", reg, value); -+ writel(value, priv->hpb_base + reg); -+} -+#endif -diff --git a/drivers/pci/controller/pcie-phytium-register.h b/drivers/pci/controller/pcie-phytium-register.h -new file mode 100644 -index 000000000..c2c477cad ---- /dev/null -+++ b/drivers/pci/controller/pcie-phytium-register.h -@@ -0,0 +1,80 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium PCIe Ednpoint controllr driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PCIE_PHYTIUM_REGISTER_H__ -+#define __PCIE_PHYTIUM_REGISTER_H__ -+ -+#define PHYTIUM_PCIE_FUNC_BASE(fn) (((fn) << 14) & GENMASK(16, 14)) -+#define PHYTIUM_PCI_VENDOR_ID 0x98 -+#define PHYTIUM_PCI_DEVICE_ID 0x9a -+#define PHYTIUM_PCI_REVISION_ID 0x9c -+#define PHYTIUM_PCI_CLASS_PROG 0x9d -+#define PHYTIUM_PCI_CLASS_DEVICE 0x9e -+#define PHYTIUM_PCI_SUBSYS_VENDOR_ID 0xa0 -+#define PHYTIUM_PCI_SUBSYS_DEVICE_ID 0xa2 -+#define PHYTIUM_PCI_INTERRUPT_PIN 0xa8 -+#define INTERRUPT_PIN_MASK 0x7 -+#define MSI_DISABLE (1 << 3) -+#define MSI_NUM_MASK (0x7) -+#define MSI_NUM_SHIFT 4 -+#define MSI_MASK_SUPPORT (1 << 7) -+#define PHYTIUM_PCI_MSIX_CAP 0xaa -+ #define MSIX_DISABLE (0 << 15) -+ -+#define PHYTIUM_PCI_BAR_0 0xe4 -+#define PHYTIUM_PCI_BAR(bar_num) (0xe4 + bar_num * 4) -+#define BAR_IO_TYPE (1 << 0) -+#define BAR_MEM_TYPE (0 << 0) -+#define BAR_MEM_64BIT (1 << 2) -+#define BAR_MEM_PREFETCHABLE (1 << 3) -+#define BAR_IO_MIN_APERTURE 4 -+#define BAR_MEM_MIN_APERTURE 16 -+ -+ -+#define PHYTIUM_PCI_WIN0_BASE 0x600 -+#define PHYTIUM_PCI_WIN0_SRC_ADDR0(table) (PHYTIUM_PCI_WIN0_BASE + 0X20 * table + 0x0) -+#define ATR_IMPL 0x1 -+#define ATR_SIZE_MASK 0x3f -+#define ATR_SIZE_SHIFT 1 -+#define ATR_SIZE_ALIGN 0x1000 -+#define SRC_ADDR_32_12_MASK 0xfffff000 -+ -+#define PHYTIUM_PCI_WIN0_SRC_ADDR1(table) (PHYTIUM_PCI_WIN0_BASE + 0X20 * table + 0x4) -+#define PHYTIUM_PCI_WIN0_TRSL_ADDR0(table) (PHYTIUM_PCI_WIN0_BASE + 0X20 * table + 0x8) -+#define TRSL_ADDR_32_12_MASK 0xfffff000 -+ -+#define PHYTIUM_PCI_WIN0_TRSL_ADDR1(table) (PHYTIUM_PCI_WIN0_BASE + 0X20 * table + 0xc) -+#define PHYTIUM_PCI_WIN0_TRSL_PARAM(table) (PHYTIUM_PCI_WIN0_BASE + 0X20 * table + 0x10) -+#define TRSL_ID_IO 0x1 -+#define TRSL_ID_MASTER 0x4 -+#define TRSL_ID_PCIE_TR 0x0 -+ -+#define PHYTIUM_PCI_SLAVE0_BASE 0x800 -+#define PHYTIUM_PCI_SLAVE0_SRC_ADDR0(table) (PHYTIUM_PCI_SLAVE0_BASE + 0X20 * table + 0x0) -+#define PHYTIUM_PCI_SLAVE0_SRC_ADDR1(table) (PHYTIUM_PCI_SLAVE0_BASE + 0X20 * table + 0x4) -+#define PHYTIUM_PCI_SLAVE0_TRSL_ADDR0(table) (PHYTIUM_PCI_SLAVE0_BASE + 0X20 * table + 0x8) -+#define PHYTIUM_PCI_SLAVE0_TRSL_ADDR1(table) (PHYTIUM_PCI_SLAVE0_BASE + 0X20 * table + 0xc) -+#define PHYTIUM_PCI_SLAVE0_TRSL_PARAM(table) (PHYTIUM_PCI_SLAVE0_BASE + 0X20 * table + 0x10) -+ -+#define PHYTIUM_PCI_CF_MSI_BASE 0x10e0 -+#define PHYTIUM_PCI_CF_MSI_CONTROL 0x10e2 -+ -+#define PHYTIUM_HPB_C0_PREF_BASE_LIMIT 0xa30 -+ #define C0_PREF_LIMIT_MASK 0xfff -+ #define C0_PREF_LIMIT_SHIFT 20 -+ #define C0_PREF_BASE_MASK 0xfff -+ #define C0_PREF_BASE_SHIFT 4 -+ #define C0_PREF_VALUE_SHIFT 20 -+#define PHYTIUM_HPB_C0_PREF_BASE_LIMIT_UP32 0xa34 -+ #define C0_PREF_LIMIT_UP32_MASK 0xff -+ #define C0_PREF_LIMIT_UP32_SHIFT 8 -+ #define C0_PREF_BASE_UP32_MASK 0xff -+ #define C0_PREF_BASE_UP32_SHIFT 0 -+ #define C0_PREF_UP32_VALUE_SHIFT 0 -+#endif -+ -+ -diff --git a/drivers/pci/quirks.c b/drivers/pci/quirks.c -index b5b96d2a9..4a2c10df8 100644 ---- a/drivers/pci/quirks.c -+++ b/drivers/pci/quirks.c -@@ -31,6 +31,7 @@ - #include - #include - #include -+#include - #include "pci.h" - - /* -@@ -4047,7 +4048,7 @@ static int nvme_disable_and_flr(struct pci_dev *dev, bool probe) - pcie_reset_flr(dev, PCI_RESET_PROBE) || !pci_resource_start(dev, 0)) - return -ENOTTY; - -- if (probe) -+ if (probe & !is_kdump_kernel()) - return 0; - - bar = pci_iomap(dev, 0, NVME_REG_CC + sizeof(cfg)); -@@ -4195,6 +4196,7 @@ static const struct pci_dev_reset_methods pci_dev_reset_methods[] = { - { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_IVB_M2_VGA, - reset_ivb_igd }, - { PCI_VENDOR_ID_SAMSUNG, 0xa804, nvme_disable_and_flr }, -+ { PCI_VENDOR_ID_SAMSUNG, 0xa809, nvme_disable_and_flr }, - { PCI_VENDOR_ID_INTEL, 0x0953, delay_250ms_after_flr }, - { PCI_VENDOR_ID_INTEL, 0x0a54, delay_250ms_after_flr }, - { PCI_VENDOR_ID_SOLIDIGM, 0xf1ac, delay_250ms_after_flr }, -@@ -5527,6 +5529,7 @@ DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0142, quirk_no_ext_tags); - DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0144, quirk_no_ext_tags); - DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0420, quirk_no_ext_tags); - DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0422, quirk_no_ext_tags); -+DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_PHYTIUM, 0xdc3a, quirk_no_ext_tags); - - #ifdef CONFIG_PCI_ATS - static void quirk_no_ats(struct pci_dev *pdev) -diff --git a/drivers/pci/setup-bus.c b/drivers/pci/setup-bus.c -index dae490f25..1d877793b 100644 ---- a/drivers/pci/setup-bus.c -+++ b/drivers/pci/setup-bus.c -@@ -576,6 +576,9 @@ static void pci_setup_bridge_io(struct pci_dev *bridge) - u8 io_base_lo, io_limit_lo; - u16 l; - u32 io_upper16; -+#ifdef CONFIG_ARCH_PHYTIUM -+ u32 io_base_limit = 0; -+#endif - - io_mask = PCI_IO_RANGE_MASK; - if (bridge->io_window_1k) -@@ -603,6 +606,19 @@ static void pci_setup_bridge_io(struct pci_dev *bridge) - pci_write_config_word(bridge, PCI_IO_BASE, l); - /* Update upper 16 bits of I/O base/limit */ - pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, io_upper16); -+ -+#ifdef CONFIG_ARCH_PHYTIUM -+ if (bridge->dev.parent) { -+ if (!fwnode_property_read_u32(dev_fwnode(bridge->dev.parent), -+ "io-upper", &io_base_limit)) -+ pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, io_base_limit); -+ } -+ if (bridge->dev.parent->parent) { -+ if (!fwnode_property_read_u32(dev_fwnode(bridge->dev.parent->parent), -+ "io-upper", &io_base_limit)) -+ pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, io_base_limit); -+ } -+#endif - } - - static void pci_setup_bridge_mmio(struct pci_dev *bridge) -diff --git a/drivers/perf/Kconfig b/drivers/perf/Kconfig -index 273d67ecf..88a6e70ba 100644 ---- a/drivers/perf/Kconfig -+++ b/drivers/perf/Kconfig -@@ -234,4 +234,6 @@ config CXL_PMU - - If unsure say 'm'. - -+source "drivers/perf/phytium/Kconfig" -+ - endmenu -diff --git a/drivers/perf/Makefile b/drivers/perf/Makefile -index 16b3ec4db..51603317f 100644 ---- a/drivers/perf/Makefile -+++ b/drivers/perf/Makefile -@@ -26,3 +26,4 @@ obj-$(CONFIG_ALIBABA_UNCORE_DRW_PMU) += alibaba_uncore_drw_pmu.o - obj-$(CONFIG_ARM_CORESIGHT_PMU_ARCH_SYSTEM_PMU) += arm_cspmu/ - obj-$(CONFIG_MESON_DDR_PMU) += amlogic/ - obj-$(CONFIG_CXL_PMU) += cxl_pmu.o -+obj-$(CONFIG_PHYTIUM_PMU) += phytium/ -diff --git a/drivers/perf/phytium/Kconfig b/drivers/perf/phytium/Kconfig -new file mode 100644 -index 000000000..e9dabba72 ---- /dev/null -+++ b/drivers/perf/phytium/Kconfig -@@ -0,0 +1,27 @@ -+# SPDX-License-Identifier: GPL-2.0 -+menuconfig PHYTIUM_PMU -+ bool "Phytium PMU support" -+ help -+ Say Y here if you want to support Phytium performance monitoring -+ unit (PMU) drivers. -+ -+if PHYTIUM_PMU -+ -+config PHYT_DDR_PMU -+ tristate "Phytium SoC DDR PMU driver" -+ depends on (ARCH_PHYTIUM && ACPI) || COMPILE_TEST -+ default m -+ help -+ Provides support for Phytium SoC DDR Controller performance -+ monitoring unit (PMU). -+ -+config PHYT_PCIE_PMU -+ tristate "Phytium SoC PCIE PMU driver" -+ depends on (ARCH_PHYTIUM && ACPI) || COMPILE_TEST -+ default m -+ help -+ Provides support for Phytium SoC PCIe Controller performance -+ monitoring unit (PMU). -+ -+endif -+ -diff --git a/drivers/perf/phytium/Makefile b/drivers/perf/phytium/Makefile -new file mode 100644 -index 000000000..af37afc69 ---- /dev/null -+++ b/drivers/perf/phytium/Makefile -@@ -0,0 +1,4 @@ -+# SPDX-License-Identifier: GPL-2.0 -+# -+obj-$(CONFIG_PHYT_DDR_PMU) += phytium_ddr_pmu.o -+obj-$(CONFIG_PHYT_PCIE_PMU) += phytium_pcie_pmu.o -diff --git a/drivers/perf/phytium/phytium_ddr_pmu.c b/drivers/perf/phytium/phytium_ddr_pmu.c -new file mode 100644 -index 000000000..a31bf29c8 ---- /dev/null -+++ b/drivers/perf/phytium/phytium_ddr_pmu.c -@@ -0,0 +1,753 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SoC DDR performance monitoring unit support -+ * -+ * Copyright (c) 2023, Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+ -+#undef pr_fmt -+#define pr_fmt(fmt) "phytium_ddr_pmu: " fmt -+ -+#define PHYTIUM_DDR_MAX_COUNTERS 8 -+ -+#define DDR_START_TIMER 0x000 -+#define DDR_STOP_TIMER 0x004 -+#define DDR_CLEAR_EVENT 0x008 -+#define DDR_SET_TIMER_L 0x00c -+#define DDR_SET_TIMER_H 0x010 -+#define DDR_TRIG_MODE 0x014 -+#define DDR_NOW_STATE 0x0e0 -+#define DDR_EVENT_CYCLES 0x0e4 -+#define DDR_TPOINT_END_L 0x0e4 -+#define DDR_TPOINT_END_H 0x0e8 -+#define DDR_STATE_STOP 0x0ec -+#define DDR_EVENT_RXREQ 0x100 -+#define DDR_EVENT_RXDAT 0x104 -+#define DDR_EVENT_TXDAT 0x108 -+#define DDR_EVENT_RXREQ_RNS 0x10c -+#define DDR_EVENT_RXREQ_WNSP 0x110 -+#define DDR_EVENT_RXREQ_WNSF 0x114 -+#define DDR_EVENT_BANDWIDTH 0x200 -+#define DDR_W_DATA_BASE 0x200 -+#define DDR_CLK_FRE 0xe00 -+#define DDR_DATA_WIDTH 0xe04 -+ -+#define to_phytium_ddr_pmu(p) (container_of(p, struct phytium_ddr_pmu, pmu)) -+ -+static int phytium_ddr_pmu_hp_state; -+ -+struct phytium_ddr_pmu_hwevents { -+ struct perf_event *hw_events[PHYTIUM_DDR_MAX_COUNTERS]; -+ DECLARE_BITMAP(used_mask, PHYTIUM_DDR_MAX_COUNTERS); -+}; -+ -+struct phytium_ddr_pmu { -+ struct device *dev; -+ void __iomem *base; -+ void __iomem *csr_base; -+ struct pmu pmu; -+ struct phytium_ddr_pmu_hwevents pmu_events; -+ u32 die_id; -+ u32 ddr_id; -+ u32 pmu_id; -+ int bit_idx; -+ int on_cpu; -+ int irq; -+ struct hlist_node node; -+}; -+ -+#define GET_DDR_EVENTID(hwc) (hwc->config_base & 0x7) -+#define EVENT_VALID(idx) ((idx >= 0) && (idx < PHYTIUM_DDR_MAX_COUNTERS)) -+ -+static const u32 ddr_counter_reg_offset[] = { -+ DDR_EVENT_CYCLES, DDR_EVENT_RXREQ, DDR_EVENT_RXDAT, -+ DDR_EVENT_TXDAT, DDR_EVENT_RXREQ_RNS, DDR_EVENT_RXREQ_WNSP, -+ DDR_EVENT_RXREQ_WNSF, DDR_EVENT_BANDWIDTH -+}; -+ -+ssize_t phytium_ddr_pmu_format_sysfs_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct dev_ext_attribute *eattr; -+ -+ eattr = container_of(attr, struct dev_ext_attribute, attr); -+ -+ return sprintf(buf, "%s\n", (char *)eattr->var); -+} -+ -+ssize_t phytium_ddr_pmu_event_sysfs_show(struct device *dev, -+ struct device_attribute *attr, -+ char *page) -+{ -+ struct dev_ext_attribute *eattr; -+ -+ eattr = container_of(attr, struct dev_ext_attribute, attr); -+ -+ return sprintf(page, "config=0x%lx\n", (unsigned long)eattr->var); -+} -+ -+static ssize_t cpumask_show(struct device *dev, struct device_attribute *attr, -+ char *buf) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = -+ to_phytium_ddr_pmu(dev_get_drvdata(dev)); -+ -+ return cpumap_print_to_pagebuf(true, buf, cpumask_of(ddr_pmu->on_cpu)); -+} -+ -+#define PHYTIUM_PMU_ATTR(_name, _func, _config) \ -+ (&((struct dev_ext_attribute[]){ \ -+ { __ATTR(_name, 0444, _func, NULL), (void *)_config } })[0] \ -+ .attr.attr) -+ -+#define PHYTIUM_DDR_PMU_FORMAT_ATTR(_name, _config) \ -+ PHYTIUM_PMU_ATTR(_name, phytium_ddr_pmu_format_sysfs_show, \ -+ (void *)_config) -+ -+#define PHYTIUM_DDR_PMU_EVENT_ATTR(_name, _config) \ -+ PHYTIUM_PMU_ATTR(_name, phytium_ddr_pmu_event_sysfs_show, \ -+ (unsigned long)_config) -+ -+static struct attribute *phytium_ddr_pmu_format_attr[] = { -+ PHYTIUM_DDR_PMU_FORMAT_ATTR(event, "config:0-2"), -+ PHYTIUM_DDR_PMU_FORMAT_ATTR(timer, "config1:0-31"), -+ NULL, -+}; -+ -+static const struct attribute_group phytium_ddr_pmu_format_group = { -+ .name = "format", -+ .attrs = phytium_ddr_pmu_format_attr, -+}; -+ -+static struct attribute *phytium_ddr_pmu_events_attr[] = { -+ PHYTIUM_DDR_PMU_EVENT_ATTR(cycles, 0x00), -+ PHYTIUM_DDR_PMU_EVENT_ATTR(rxreq, 0x01), -+ PHYTIUM_DDR_PMU_EVENT_ATTR(rxdat, 0x02), -+ PHYTIUM_DDR_PMU_EVENT_ATTR(txdat, 0x03), -+ PHYTIUM_DDR_PMU_EVENT_ATTR(rxreq_RNS, 0x04), -+ PHYTIUM_DDR_PMU_EVENT_ATTR(rxreq_WNSP, 0x05), -+ PHYTIUM_DDR_PMU_EVENT_ATTR(rxreq_WNSF, 0x06), -+ PHYTIUM_DDR_PMU_EVENT_ATTR(bandwidth, 0x07), -+ NULL, -+}; -+ -+static const struct attribute_group phytium_ddr_pmu_events_group = { -+ .name = "events", -+ .attrs = phytium_ddr_pmu_events_attr, -+}; -+ -+static DEVICE_ATTR_RO(cpumask); -+ -+static struct attribute *phytium_ddr_pmu_cpumask_attrs[] = { -+ &dev_attr_cpumask.attr, -+ NULL, -+}; -+ -+static const struct attribute_group phytium_ddr_pmu_cpumask_attr_group = { -+ .attrs = phytium_ddr_pmu_cpumask_attrs, -+}; -+ -+static const struct attribute_group *phytium_ddr_pmu_attr_groups[] = { -+ &phytium_ddr_pmu_format_group, -+ &phytium_ddr_pmu_events_group, -+ &phytium_ddr_pmu_cpumask_attr_group, -+ NULL, -+}; -+ -+static u32 phytium_ddr_pmu_get_event_timer(struct perf_event *event) -+{ -+ return FIELD_GET(GENMASK(31, 0), event->attr.config1); -+} -+ -+static u64 phytium_ddr_pmu_read_counter(struct phytium_ddr_pmu *ddr_pmu, -+ struct hw_perf_event *hwc) -+{ -+ u32 idx = GET_DDR_EVENTID(hwc); -+ u32 cycle_l, cycle_h, w_data, ddr_data_width; -+ u64 val64 = 0; -+ int i; -+ u32 counter_offset = ddr_counter_reg_offset[idx]; -+ -+ if (!EVENT_VALID(idx)) { -+ dev_err(ddr_pmu->dev, "Unsupported event index:%d!\n", idx); -+ return 0; -+ } -+ -+ switch (idx) { -+ case 0: -+ cycle_l = readl(ddr_pmu->base + counter_offset); -+ cycle_h = readl(ddr_pmu->base + counter_offset + 4); -+ val64 = (u64)cycle_h << 32 | (u64)cycle_l; -+ break; -+ case 7: -+ ddr_data_width = readl(ddr_pmu->base + DDR_DATA_WIDTH); -+ for (i = 0; i < (ddr_data_width / 8); i++) { -+ w_data = readl(ddr_pmu->base + counter_offset + 4 * i); -+ val64 += w_data; -+ } -+ break; -+ default: -+ val64 = readl(ddr_pmu->base + counter_offset); -+ break; -+ } -+ -+ return val64; -+} -+ -+static void phytium_ddr_pmu_enable_clk(struct phytium_ddr_pmu *ddr_pmu) -+{ -+ u32 val; -+ -+ val = readl(ddr_pmu->csr_base); -+ val |= 0xF; -+ writel(val, ddr_pmu->csr_base); -+} -+ -+static void phytium_ddr_pmu_disable_clk(struct phytium_ddr_pmu *ddr_pmu) -+{ -+ u32 val; -+ -+ val = readl(ddr_pmu->csr_base); -+ val &= ~(0xF); -+ writel(val, ddr_pmu->csr_base); -+} -+ -+static void phytium_ddr_pmu_clear_all_counters(struct phytium_ddr_pmu *ddr_pmu) -+{ -+ writel(0x1, ddr_pmu->base + DDR_CLEAR_EVENT); -+} -+ -+static void phytium_ddr_pmu_start_all_counters(struct phytium_ddr_pmu *ddr_pmu) -+{ -+ writel(0x1, ddr_pmu->base + DDR_START_TIMER); -+} -+ -+static void phytium_ddr_pmu_stop_all_counters(struct phytium_ddr_pmu *ddr_pmu) -+{ -+ writel(0x1, ddr_pmu->base + DDR_STOP_TIMER); -+} -+ -+static void phytium_ddr_pmu_set_timer(struct phytium_ddr_pmu *ddr_pmu, -+ u32 th_val) -+{ -+ u32 val; -+ -+ val = readl(ddr_pmu->base + DDR_SET_TIMER_L); -+ val = readl(ddr_pmu->base + DDR_SET_TIMER_H); -+ -+ writel(th_val, ddr_pmu->base + DDR_SET_TIMER_L); -+ writel(0, ddr_pmu->base + DDR_SET_TIMER_H); -+} -+ -+static void phytium_ddr_pmu_reset_timer(struct phytium_ddr_pmu *ddr_pmu) -+{ -+ u32 val; -+ -+ val = readl(ddr_pmu->base + DDR_SET_TIMER_L); -+ val = readl(ddr_pmu->base + DDR_SET_TIMER_H); -+ -+ writel(0xFFFFFFFF, ddr_pmu->base + DDR_SET_TIMER_L); -+ writel(0xFFFFFFFF, ddr_pmu->base + DDR_SET_TIMER_H); -+} -+ -+static unsigned long -+phytium_ddr_pmu_get_stop_state(struct phytium_ddr_pmu *ddr_pmu) -+{ -+ unsigned long val; -+ -+ val = (unsigned long)readl(ddr_pmu->base + DDR_STATE_STOP); -+ return val; -+} -+ -+static unsigned long -+phytium_ddr_pmu_get_irq_flag(struct phytium_ddr_pmu *ddr_pmu) -+{ -+ unsigned long val; -+ -+ val = (unsigned long)readl(ddr_pmu->csr_base + 4); -+ return val; -+} -+ -+static int phytium_ddr_pmu_mark_event(struct perf_event *event) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(event->pmu); -+ unsigned long *used_mask = ddr_pmu->pmu_events.used_mask; -+ struct hw_perf_event *hwc = &event->hw; -+ -+ int idx = GET_DDR_EVENTID(hwc); -+ -+ if (test_bit(idx, used_mask)) -+ return -EAGAIN; -+ -+ set_bit(idx, used_mask); -+ -+ return idx; -+} -+ -+static void phytium_ddr_pmu_unmark_event(struct phytium_ddr_pmu *ddr_pmu, -+ int idx) -+{ -+ if (!EVENT_VALID(idx)) { -+ dev_err(ddr_pmu->dev, "Unsupported event index:%d!\n", idx); -+ return; -+ } -+ -+ clear_bit(idx, ddr_pmu->pmu_events.used_mask); -+} -+ -+int phytium_ddr_pmu_event_init(struct perf_event *event) -+{ -+ struct hw_perf_event *hwc = &event->hw; -+ struct phytium_ddr_pmu *ddr_pmu; -+ u32 event_timer; -+ -+ if (event->attr.type != event->pmu->type) -+ return -ENOENT; -+ -+ if (is_sampling_event(event) || event->attach_state & PERF_ATTACH_TASK) -+ return -EOPNOTSUPP; -+ -+ ddr_pmu = to_phytium_ddr_pmu(event->pmu); -+ -+ if (event->cpu < 0) { -+ dev_warn(ddr_pmu->dev, "Can't provide per-task data!\n"); -+ return -EINVAL; -+ } -+ -+ if (event->attr.config > PHYTIUM_DDR_MAX_COUNTERS) -+ return -EINVAL; -+ -+ if (ddr_pmu->on_cpu == -1) -+ return -EINVAL; -+ -+ event_timer = phytium_ddr_pmu_get_event_timer(event); -+ if (event_timer != 0) -+ phytium_ddr_pmu_set_timer(ddr_pmu, event_timer); -+ -+ hwc->idx = -1; -+ hwc->config_base = event->attr.config; -+ -+ event->cpu = ddr_pmu->on_cpu; -+ -+ return 0; -+} -+ -+void phytium_ddr_pmu_event_update(struct perf_event *event) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(event->pmu); -+ struct hw_perf_event *hwc = &event->hw; -+ u64 delta; -+ -+ delta = phytium_ddr_pmu_read_counter(ddr_pmu, hwc); -+ local64_add(delta, &event->count); -+} -+ -+void phytium_ddr_pmu_event_start(struct perf_event *event, int flags) -+{ -+ struct hw_perf_event *hwc = &event->hw; -+ -+ hwc->state = 0; -+ perf_event_update_userpage(event); -+} -+ -+void phytium_ddr_pmu_event_stop(struct perf_event *event, int flags) -+{ -+ struct hw_perf_event *hwc = &event->hw; -+ -+ hwc->state |= PERF_HES_STOPPED; -+ -+ if (flags & PERF_EF_UPDATE) -+ phytium_ddr_pmu_event_update(event); -+} -+ -+int phytium_ddr_pmu_event_add(struct perf_event *event, int flags) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(event->pmu); -+ struct hw_perf_event *hwc = &event->hw; -+ int idx; -+ -+ hwc->state |= PERF_HES_STOPPED; -+ -+ idx = phytium_ddr_pmu_mark_event(event); -+ if (idx < 0) -+ return idx; -+ -+ event->hw.idx = idx; -+ ddr_pmu->pmu_events.hw_events[idx] = event; -+ -+ return 0; -+} -+ -+void phytium_ddr_pmu_event_del(struct perf_event *event, int flags) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(event->pmu); -+ struct hw_perf_event *hwc = &event->hw; -+ unsigned long val; -+ u32 event_timer; -+ -+ phytium_ddr_pmu_event_stop(event, PERF_EF_UPDATE); -+ val = phytium_ddr_pmu_get_irq_flag(ddr_pmu); -+ val = phytium_ddr_pmu_get_stop_state(ddr_pmu); -+ phytium_ddr_pmu_unmark_event(ddr_pmu, hwc->idx); -+ -+ event_timer = phytium_ddr_pmu_get_event_timer(event); -+ if (event_timer != 0) -+ phytium_ddr_pmu_reset_timer(ddr_pmu); -+ -+ perf_event_update_userpage(event); -+ ddr_pmu->pmu_events.hw_events[hwc->idx] = NULL; -+} -+ -+void phytium_ddr_pmu_enable(struct pmu *pmu) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(pmu); -+ int event_added = bitmap_weight(ddr_pmu->pmu_events.used_mask, -+ PHYTIUM_DDR_MAX_COUNTERS); -+ -+ if (event_added) { -+ phytium_ddr_pmu_clear_all_counters(ddr_pmu); -+ phytium_ddr_pmu_start_all_counters(ddr_pmu); -+ } -+} -+ -+void phytium_ddr_pmu_disable(struct pmu *pmu) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(pmu); -+ int event_added = bitmap_weight(ddr_pmu->pmu_events.used_mask, -+ PHYTIUM_DDR_MAX_COUNTERS); -+ -+ if (event_added) -+ phytium_ddr_pmu_stop_all_counters(ddr_pmu); -+} -+ -+static const struct acpi_device_id phytium_ddr_pmu_acpi_match[] = { -+ { -+ "PHYT0043", -+ }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_ddr_pmu_acpi_match); -+ -+static irqreturn_t phytium_ddr_pmu_overflow_handler(int irq, void *dev_id) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = dev_id; -+ struct perf_event *event; -+ unsigned long overflown, stop_state; -+ int idx; -+ unsigned long *used_mask = ddr_pmu->pmu_events.used_mask; -+ -+ int event_added = bitmap_weight(used_mask, PHYTIUM_DDR_MAX_COUNTERS); -+ -+ overflown = phytium_ddr_pmu_get_irq_flag(ddr_pmu); -+ -+ if (!test_bit(ddr_pmu->bit_idx, &overflown)) -+ return IRQ_NONE; -+ -+ stop_state = phytium_ddr_pmu_get_stop_state(ddr_pmu); -+ -+ if (bitmap_weight(&stop_state, 6)) { -+ for_each_set_bit(idx, used_mask, PHYTIUM_DDR_MAX_COUNTERS) { -+ event = ddr_pmu->pmu_events.hw_events[idx]; -+ if (!event) -+ continue; -+ phytium_ddr_pmu_event_update(event); -+ } -+ phytium_ddr_pmu_clear_all_counters(ddr_pmu); -+ phytium_ddr_pmu_start_all_counters(ddr_pmu); -+ -+ return IRQ_HANDLED; -+ } -+ -+ if (!event_added) { -+ phytium_ddr_pmu_clear_all_counters(ddr_pmu); -+ return IRQ_HANDLED; -+ } -+ -+ return IRQ_NONE; -+} -+ -+static int phytium_ddr_pmu_init_irq(struct phytium_ddr_pmu *ddr_pmu, -+ struct platform_device *pdev) -+{ -+ int irq, ret; -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) -+ return irq; -+ -+ ret = devm_request_irq(&pdev->dev, irq, -+ phytium_ddr_pmu_overflow_handler, -+ IRQF_NOBALANCING | IRQF_NO_THREAD | IRQF_SHARED, -+ dev_name(&pdev->dev), ddr_pmu); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "Fail to request IRQ:%d ret:%d\n", irq, -+ ret); -+ return ret; -+ } -+ -+ ddr_pmu->irq = irq; -+ -+ return 0; -+} -+ -+static int phytium_ddr_pmu_init_data(struct platform_device *pdev, -+ struct phytium_ddr_pmu *ddr_pmu) -+{ -+ struct resource *res, *clkres; -+ -+ if (device_property_read_u32(&pdev->dev, "phytium,die-id", -+ &ddr_pmu->die_id)) { -+ dev_err(&pdev->dev, "Can not read phytium,die-id!\n"); -+ return -EINVAL; -+ } -+ -+ if (device_property_read_u32(&pdev->dev, "phytium,ddr-id", -+ &ddr_pmu->ddr_id)) { -+ dev_err(&pdev->dev, "Can not read phytium,ddr-id!\n"); -+ return -EINVAL; -+ } -+ -+ if (device_property_read_u32(&pdev->dev, "phytium,pmu-id", -+ &ddr_pmu->pmu_id)) { -+ dev_err(&pdev->dev, "Can not read ddr pmu-id!\n"); -+ return -EINVAL; -+ } -+ -+ ddr_pmu->bit_idx = ddr_pmu->ddr_id * 2 + ddr_pmu->pmu_id; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ ddr_pmu->base = devm_ioremap_resource(&pdev->dev, res); -+ -+ if (IS_ERR(ddr_pmu->base)) { -+ dev_err(&pdev->dev, -+ "ioremap failed for ddr_pmu base resource\n"); -+ return PTR_ERR(ddr_pmu->base); -+ } -+ -+ clkres = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ if (!clkres) { -+ dev_err(&pdev->dev, "failed for get ddr_pmu clk resource.\n"); -+ return -EINVAL; -+ } -+ -+ ddr_pmu->csr_base = -+ devm_ioremap(&pdev->dev, clkres->start, resource_size(clkres)); -+ if (IS_ERR(ddr_pmu->csr_base)) { -+ dev_err(&pdev->dev, -+ "ioremap failed for ddr_pmu csr resource\n"); -+ return PTR_ERR(ddr_pmu->csr_base); -+ } -+ -+ return 0; -+} -+ -+static int phytium_ddr_pmu_dev_probe(struct platform_device *pdev, -+ struct phytium_ddr_pmu *ddr_pmu) -+{ -+ int ret; -+ -+ ret = phytium_ddr_pmu_init_data(pdev, ddr_pmu); -+ if (ret) -+ return ret; -+ -+ ret = phytium_ddr_pmu_init_irq(ddr_pmu, pdev); -+ if (ret) -+ return ret; -+ -+ ddr_pmu->dev = &pdev->dev; -+ ddr_pmu->on_cpu = -1; -+ -+ return 0; -+} -+ -+static int phytium_ddr_pmu_probe(struct platform_device *pdev) -+{ -+ struct phytium_ddr_pmu *ddr_pmu; -+ char *name; -+ int ret; -+ -+ ddr_pmu = devm_kzalloc(&pdev->dev, sizeof(*ddr_pmu), GFP_KERNEL); -+ if (!ddr_pmu) -+ return -ENOMEM; -+ -+ platform_set_drvdata(pdev, ddr_pmu); -+ -+ ret = phytium_ddr_pmu_dev_probe(pdev, ddr_pmu); -+ if (ret) -+ return ret; -+ -+ ret = cpuhp_state_add_instance( -+ phytium_ddr_pmu_hp_state, &ddr_pmu->node); -+ if (ret) { -+ dev_err(&pdev->dev, "Error %d registering hotplug;\n", ret); -+ return ret; -+ } -+ -+ name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "phyt%u_ddr%u_pmu%u", -+ ddr_pmu->die_id, ddr_pmu->ddr_id, -+ ddr_pmu->pmu_id); -+ ddr_pmu->pmu = (struct pmu){ -+ .name = name, -+ .module = THIS_MODULE, -+ .task_ctx_nr = perf_invalid_context, -+ .event_init = phytium_ddr_pmu_event_init, -+ .pmu_enable = phytium_ddr_pmu_enable, -+ .pmu_disable = phytium_ddr_pmu_disable, -+ .add = phytium_ddr_pmu_event_add, -+ .del = phytium_ddr_pmu_event_del, -+ .start = phytium_ddr_pmu_event_start, -+ .stop = phytium_ddr_pmu_event_stop, -+ .read = phytium_ddr_pmu_event_update, -+ .attr_groups = phytium_ddr_pmu_attr_groups, -+ .capabilities = PERF_PMU_CAP_NO_EXCLUDE, -+ }; -+ -+ ret = perf_pmu_register(&ddr_pmu->pmu, name, -1); -+ if (ret) { -+ dev_err(ddr_pmu->dev, "DDR PMU register failed!\n"); -+ cpuhp_state_remove_instance_nocalls( -+ phytium_ddr_pmu_hp_state, -+ &ddr_pmu->node); -+ } -+ -+ phytium_ddr_pmu_enable_clk(ddr_pmu); -+ -+ pr_info("Phytium DDR PMU: "); -+ pr_info(" die_id = %d ddr_id = %d pmu_id = %d.\n", ddr_pmu->die_id, -+ ddr_pmu->ddr_id, ddr_pmu->pmu_id); -+ -+ return ret; -+} -+ -+static int phytium_ddr_pmu_remove(struct platform_device *pdev) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = platform_get_drvdata(pdev); -+ -+ phytium_ddr_pmu_disable_clk(ddr_pmu); -+ -+ perf_pmu_unregister(&ddr_pmu->pmu); -+ cpuhp_state_remove_instance_nocalls( -+ phytium_ddr_pmu_hp_state, &ddr_pmu->node); -+ -+ return 0; -+} -+ -+static struct platform_driver phytium_ddr_pmu_driver = { -+ .driver = { -+ .name = "phytium_ddr_pmu", -+ .acpi_match_table = ACPI_PTR(phytium_ddr_pmu_acpi_match), -+ .suppress_bind_attrs = true, -+ }, -+ .probe = phytium_ddr_pmu_probe, -+ .remove = phytium_ddr_pmu_remove, -+}; -+ -+int phytium_ddr_pmu_online_cpu(unsigned int cpu, struct hlist_node *node) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = -+ hlist_entry_safe(node, struct phytium_ddr_pmu, node); -+ -+ if (!cpumask_test_cpu(cpu, cpumask_of_node(ddr_pmu->die_id))) -+ return 0; -+ -+ if (ddr_pmu->on_cpu != -1) { -+ if (!cpumask_test_cpu(ddr_pmu->on_cpu, cpumask_of_node(ddr_pmu->die_id))) { -+ perf_pmu_migrate_context(&ddr_pmu->pmu, ddr_pmu->on_cpu, cpu); -+ ddr_pmu->on_cpu = cpu; -+ WARN_ON(irq_set_affinity_hint(ddr_pmu->irq, cpumask_of(cpu))); -+ } -+ return 0; -+ } -+ -+ ddr_pmu->on_cpu = cpu; -+ WARN_ON(irq_set_affinity_hint(ddr_pmu->irq, cpumask_of(cpu))); -+ -+ return 0; -+} -+ -+int phytium_ddr_pmu_offline_cpu(unsigned int cpu, struct hlist_node *node) -+{ -+ struct phytium_ddr_pmu *ddr_pmu = -+ hlist_entry_safe(node, struct phytium_ddr_pmu, node); -+ unsigned int target; -+ cpumask_t available_cpus; -+ -+ if (ddr_pmu->on_cpu != cpu) -+ return 0; -+ -+ if (cpumask_and(&available_cpus, cpumask_of_node(ddr_pmu->die_id), cpu_online_mask) && -+ cpumask_andnot(&available_cpus, &available_cpus, cpumask_of(cpu))) -+ target = cpumask_last(&available_cpus); -+ else { -+ cpumask_andnot(&available_cpus, cpu_online_mask, cpumask_of(cpu)); -+ target = cpumask_last(&available_cpus); -+ } -+ -+ if (target >= nr_cpu_ids) { -+ dev_err(ddr_pmu->dev, "offline cpu%d with no target to migrate.\n", -+ cpu); -+ return 0; -+ } -+ -+ perf_pmu_migrate_context(&ddr_pmu->pmu, cpu, target); -+ WARN_ON(irq_set_affinity_hint(ddr_pmu->irq, cpumask_of(target))); -+ ddr_pmu->on_cpu = target; -+ -+ return 0; -+} -+ -+static int __init phytium_ddr_pmu_module_init(void) -+{ -+ int ret; -+ -+ phytium_ddr_pmu_hp_state = cpuhp_setup_state_multi(CPUHP_AP_ONLINE_DYN, -+ "perf/phytium/ddrpmu:online", -+ phytium_ddr_pmu_online_cpu, phytium_ddr_pmu_offline_cpu); -+ if (phytium_ddr_pmu_hp_state < 0) { -+ pr_err("DDR PMU: setup hotplug, phytium_ddr_pmu_hp_state = %d\n", -+ phytium_ddr_pmu_hp_state); -+ return phytium_ddr_pmu_hp_state; -+ } -+ -+ ret = platform_driver_register(&phytium_ddr_pmu_driver); -+ if (ret) -+ cpuhp_remove_multi_state( -+ phytium_ddr_pmu_hp_state); -+ -+ return ret; -+} -+module_init(phytium_ddr_pmu_module_init); -+ -+static void __exit phytium_ddr_pmu_module_exit(void) -+{ -+ platform_driver_unregister(&phytium_ddr_pmu_driver); -+ cpuhp_remove_multi_state(phytium_ddr_pmu_hp_state); -+} -+module_exit(phytium_ddr_pmu_module_exit); -+ -+MODULE_DESCRIPTION("Phytium DDR PMU driver"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Hu Xianghua "); -diff --git a/drivers/perf/phytium/phytium_pcie_pmu.c b/drivers/perf/phytium/phytium_pcie_pmu.c -new file mode 100644 -index 000000000..e1dfbf11e ---- /dev/null -+++ b/drivers/perf/phytium/phytium_pcie_pmu.c -@@ -0,0 +1,899 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium Soc PCIe performance monitoring unit support -+ * -+ * Copyright (c) 2023, Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+ -+#undef pr_fmt -+#define pr_fmt(fmt) "phytium_pcie_pmu: " fmt -+ -+#define PHYTIUM_PCIE_MAX_COUNTERS 18 -+ -+#define PCIE_START_TIMER 0x000 -+#define PCIE_STOP_TIMER 0x004 -+#define PCIE_CLEAR_EVENT 0x008 -+#define PCIE_SET_TIMER_L 0x00c -+#define PCIE_SET_TIMER_H 0x010 -+#define PCIE_TRIG_MODE 0x014 -+ -+#define PCIE_NOW_STATE 0x0e0 -+#define PCIE_EVENT_CYCLES 0x0e4 -+#define PCIE_TPOINT_END_L 0x0e4 -+#define PCIE_TPOINT_END_H 0x0e8 -+#define PCIE_STATE_STOP 0x0ec -+ -+#define PCIE_EVENT_AW 0x100 -+#define PCIE_EVENT_W_LAST 0x104 -+#define PCIE_EVENT_B 0x108 -+#define PCIE_EVENT_AR 0x10c -+#define PCIE_EVENT_R_LAST 0x110 -+#define PCIE_EVENT_R_FULL 0x114 -+#define PCIE_EVENT_R_ERR 0x118 -+#define PCIE_EVENT_W_ERR 0x11c -+#define PCIE_EVENT_DELAY_RD 0x120 -+#define PCIE_EVENT_DELAY_WR 0x124 -+#define PCIE_EVENT_RD_MAX 0x128 -+#define PCIE_EVENT_RD_MIN 0x12c -+#define PCIE_EVENT_WR_MAX 0x130 -+#define PCIE_EVENT_WR_MIN 0x134 -+ -+#define PCIE_EVENT_W_DATA 0x200 -+#define PCIE_W_DATA_BASE 0x200 -+ -+#define PCIE_EVENT_RDELAY_TIME 0x300 -+#define PCIE_RDELAY_TIME_BASE 0x300 -+ -+#define PCIE_EVENT_WDELAY_TIME 0x700 -+#define PCIE_WDELAY_TIME_BASE 0x700 -+ -+#define PCIE_CLK_FRE 0xe00 -+#define PCIE_DATA_WIDTH 0xe04 -+ -+#define to_phytium_pcie_pmu(p) (container_of(p, struct phytium_pcie_pmu, pmu)) -+ -+static int phytium_pcie_pmu_hp_state; -+ -+struct phytium_pcie_pmu_hwevents { -+ struct perf_event *hw_events[PHYTIUM_PCIE_MAX_COUNTERS]; -+ DECLARE_BITMAP(used_mask, PHYTIUM_PCIE_MAX_COUNTERS); -+}; -+ -+struct phytium_pcie_pmu { -+ struct device *dev; -+ void __iomem *base; -+ void __iomem *csr_base; -+ void __iomem *irq_reg; -+ struct pmu pmu; -+ struct phytium_pcie_pmu_hwevents pmu_events; -+ u32 die_id; -+ u32 pmu_id; -+ int on_cpu; -+ int irq; -+ struct hlist_node node; -+ int ctrler_id; -+ int real_ctrler; -+ u32 clk_bits; -+}; -+ -+#define GET_PCIE_EVENTID(hwc) (hwc->config_base & 0x1F) -+ -+#define EVENT_VALID(idx) ((idx >= 0) && (idx < PHYTIUM_PCIE_MAX_COUNTERS)) -+ -+static const u32 pcie_counter_reg_offset[] = { -+ PCIE_EVENT_CYCLES, PCIE_EVENT_AW, PCIE_EVENT_W_LAST, -+ PCIE_EVENT_B, PCIE_EVENT_AR, PCIE_EVENT_R_LAST, -+ PCIE_EVENT_R_FULL, PCIE_EVENT_R_ERR, PCIE_EVENT_W_ERR, -+ PCIE_EVENT_DELAY_RD, PCIE_EVENT_DELAY_WR, PCIE_EVENT_RD_MAX, -+ PCIE_EVENT_RD_MIN, PCIE_EVENT_WR_MAX, PCIE_EVENT_WR_MIN, -+ PCIE_EVENT_W_DATA, PCIE_EVENT_RDELAY_TIME, PCIE_EVENT_WDELAY_TIME -+}; -+ -+ssize_t phytium_pcie_pmu_format_sysfs_show(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct dev_ext_attribute *eattr; -+ -+ eattr = container_of(attr, struct dev_ext_attribute, attr); -+ -+ return sprintf(buf, "%s\n", (char *)eattr->var); -+} -+ -+ssize_t phytium_pcie_pmu_event_sysfs_show(struct device *dev, -+ struct device_attribute *attr, -+ char *page) -+{ -+ struct dev_ext_attribute *eattr; -+ -+ eattr = container_of(attr, struct dev_ext_attribute, attr); -+ -+ return sprintf(page, "config=0x%lx\n", (unsigned long)eattr->var); -+} -+ -+static ssize_t cpumask_show(struct device *dev, struct device_attribute *attr, -+ char *buf) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = -+ to_phytium_pcie_pmu(dev_get_drvdata(dev)); -+ -+ return cpumap_print_to_pagebuf(true, buf, cpumask_of(pcie_pmu->on_cpu)); -+} -+ -+#define PHYTIUM_PMU_ATTR(_name, _func, _config) \ -+ (&((struct dev_ext_attribute[]){ \ -+ { __ATTR(_name, 0444, _func, NULL), (void *)_config } })[0] \ -+ .attr.attr) -+ -+#define PHYTIUM_PCIE_PMU_FORMAT_ATTR(_name, _config) \ -+ PHYTIUM_PMU_ATTR(_name, phytium_pcie_pmu_format_sysfs_show, \ -+ (void *)_config) -+ -+#define PHYTIUM_PCIE_PMU_EVENT_ATTR(_name, _config) \ -+ PHYTIUM_PMU_ATTR(_name, phytium_pcie_pmu_event_sysfs_show, \ -+ (unsigned long)_config) -+ -+static struct attribute *phytium_pcie_pmu_format_attr[] = { -+ PHYTIUM_PCIE_PMU_FORMAT_ATTR(event, "config:0-4"), -+ PHYTIUM_PCIE_PMU_FORMAT_ATTR(ctrler, "config:8-10"), -+ PHYTIUM_PCIE_PMU_FORMAT_ATTR(timer, "config1:0-31"), -+ NULL, -+}; -+ -+static const struct attribute_group phytium_pcie_pmu_format_group = { -+ .name = "format", -+ .attrs = phytium_pcie_pmu_format_attr, -+}; -+ -+static struct attribute *phytium_pcie_pmu_events_attr[] = { -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(cycles, 0x00), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(aw, 0x01), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(w_last, 0x02), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(b, 0x03), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(ar, 0x04), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(r_last, 0x05), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(r_full, 0x06), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(r_err, 0x07), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(w_err, 0x08), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(delay_rd, 0x09), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(delay_wr, 0x0a), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(rd_max, 0x0b), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(rd_min, 0x0c), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(wr_max, 0x0d), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(wr_min, 0x0e), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(w_data, 0x0f), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(rdelay_time, 0x10), -+ PHYTIUM_PCIE_PMU_EVENT_ATTR(wdelay_time, 0x11), -+ NULL, -+}; -+ -+static const struct attribute_group phytium_pcie_pmu_events_group = { -+ .name = "events", -+ .attrs = phytium_pcie_pmu_events_attr, -+}; -+ -+static DEVICE_ATTR_RO(cpumask); -+ -+static struct attribute *phytium_pcie_pmu_cpumask_attrs[] = { -+ &dev_attr_cpumask.attr, -+ NULL, -+}; -+ -+static const struct attribute_group phytium_pcie_pmu_cpumask_attr_group = { -+ .attrs = phytium_pcie_pmu_cpumask_attrs, -+}; -+ -+static const struct attribute_group *phytium_pcie_pmu_attr_groups[] = { -+ &phytium_pcie_pmu_format_group, -+ &phytium_pcie_pmu_events_group, -+ &phytium_pcie_pmu_cpumask_attr_group, -+ NULL, -+}; -+ -+static u32 phytium_pcie_pmu_get_event_ctrler(struct perf_event *event) -+{ -+ return FIELD_GET(GENMASK(10, 8), event->attr.config); -+} -+ -+static u32 phytium_pcie_pmu_get_event_timer(struct perf_event *event) -+{ -+ return FIELD_GET(GENMASK(31, 0), event->attr.config1); -+} -+ -+static u64 phytium_pcie_pmu_read_counter(struct phytium_pcie_pmu *pcie_pmu, -+ struct hw_perf_event *hwc) -+{ -+ u32 idx = GET_PCIE_EVENTID(hwc); -+ u32 cycle_l, cycle_h, rdelay_l, rdelay_h, w_data, wdelay_l, wdelay_h, -+ pcie_data_width; -+ u64 val64 = 0; -+ int i; -+ u32 counter_offset = pcie_counter_reg_offset[idx]; -+ -+ if (!EVENT_VALID(idx)) { -+ dev_err(pcie_pmu->dev, "Unsupported event index:%d!\n", idx); -+ return 0; -+ } -+ -+ switch (idx) { -+ case 0: -+ cycle_l = readl(pcie_pmu->base + counter_offset); -+ cycle_h = readl(pcie_pmu->base + counter_offset + 4); -+ val64 = (u64)cycle_h << 32 | (u64)cycle_l; -+ break; -+ case 15: -+ pcie_data_width = readl(pcie_pmu->base + PCIE_DATA_WIDTH); -+ for (i = 0; i < (pcie_data_width / 8); i++) { -+ w_data = readl(pcie_pmu->base + counter_offset + 4 * i); -+ val64 += w_data; -+ } -+ break; -+ case 16: -+ for (i = 0; i <= 127; i = i + 2) { -+ rdelay_l = -+ readl(pcie_pmu->base + counter_offset + 4 * i); -+ rdelay_h = readl(pcie_pmu->base + counter_offset + -+ 4 * i + 4); -+ val64 += (u64)rdelay_h << 32 | (u64)rdelay_l; -+ } -+ break; -+ case 17: -+ for (i = 0; i <= 63; i++) { -+ wdelay_l = -+ readl(pcie_pmu->base + counter_offset + 4 * i); -+ wdelay_h = readl(pcie_pmu->base + counter_offset + -+ 4 * i + 4); -+ val64 += (u64)wdelay_h << 32 | (u64)wdelay_l; -+ } -+ break; -+ default: -+ val64 = readl(pcie_pmu->base + counter_offset); -+ break; -+ } -+ return val64; -+} -+ -+static void phytium_pcie_pmu_enable_clk(struct phytium_pcie_pmu *pcie_pmu) -+{ -+ u32 val; -+ -+ val = readl(pcie_pmu->csr_base); -+ val |= (pcie_pmu->clk_bits); -+ writel(val, pcie_pmu->csr_base); -+} -+ -+static void phytium_pcie_pmu_disable_clk(struct phytium_pcie_pmu *pcie_pmu) -+{ -+ u32 val; -+ -+ val = readl(pcie_pmu->csr_base); -+ val &= ~(pcie_pmu->clk_bits); -+ writel(val, pcie_pmu->csr_base); -+} -+ -+static void phytium_pcie_pmu_select_ctrler(struct phytium_pcie_pmu *pcie_pmu) -+{ -+ u32 val, offset = 0; -+ -+ if (pcie_pmu->pmu_id != 2) -+ offset = 0xc; -+ -+ val = readl(pcie_pmu->csr_base + offset); -+ -+ if (pcie_pmu->pmu_id == 2) { -+ val &= 0xffffffcf; -+ val |= pcie_pmu->real_ctrler; -+ } else { -+ val &= 0xfffffffc; -+ val |= pcie_pmu->real_ctrler; -+ } -+ -+ writel(val, pcie_pmu->csr_base + offset); -+} -+ -+static void -+phytium_pcie_pmu_clear_all_counters(struct phytium_pcie_pmu *pcie_pmu) -+{ -+ writel(0x1, pcie_pmu->base + PCIE_CLEAR_EVENT); -+} -+ -+static void -+phytium_pcie_pmu_start_all_counters(struct phytium_pcie_pmu *pcie_pmu) -+{ -+ writel(0x1, pcie_pmu->base + PCIE_START_TIMER); -+} -+ -+static void -+phytium_pcie_pmu_stop_all_counters(struct phytium_pcie_pmu *pcie_pmu) -+{ -+ writel(0x1, pcie_pmu->base + PCIE_STOP_TIMER); -+} -+ -+static void phytium_pcie_pmu_set_timer(struct phytium_pcie_pmu *pcie_pmu, -+ u32 th_val) -+{ -+ u32 val; -+ -+ val = readl(pcie_pmu->base + PCIE_SET_TIMER_L); -+ val = readl(pcie_pmu->base + PCIE_SET_TIMER_H); -+ -+ writel(th_val, pcie_pmu->base + PCIE_SET_TIMER_L); -+ writel(0, pcie_pmu->base + PCIE_SET_TIMER_H); -+} -+ -+static void phytium_pcie_pmu_reset_timer(struct phytium_pcie_pmu *pcie_pmu) -+{ -+ u32 val; -+ -+ val = readl(pcie_pmu->base + PCIE_SET_TIMER_L); -+ val = readl(pcie_pmu->base + PCIE_SET_TIMER_H); -+ -+ writel(0xFFFFFFFF, pcie_pmu->base + PCIE_SET_TIMER_L); -+ writel(0xFFFFFFFF, pcie_pmu->base + PCIE_SET_TIMER_H); -+} -+ -+static unsigned long -+phytium_pcie_pmu_get_stop_state(struct phytium_pcie_pmu *pcie_pmu) -+{ -+ unsigned long val; -+ -+ val = (unsigned long)readl(pcie_pmu->base + PCIE_STATE_STOP); -+ return val; -+} -+ -+static unsigned long -+phytium_pcie_pmu_get_irq_flag(struct phytium_pcie_pmu *pcie_pmu) -+{ -+ unsigned long val; -+ -+ val = (unsigned long)readl(pcie_pmu->irq_reg); -+ return val; -+} -+ -+static int phytium_pcie_pmu_mark_event(struct perf_event *event) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(event->pmu); -+ unsigned long *used_mask = pcie_pmu->pmu_events.used_mask; -+ struct hw_perf_event *hwc = &event->hw; -+ -+ int idx = GET_PCIE_EVENTID(hwc); -+ -+ if (test_bit(idx, used_mask)) -+ return -EAGAIN; -+ -+ set_bit(idx, used_mask); -+ -+ return idx; -+} -+ -+static void phytium_pcie_pmu_unmark_event(struct phytium_pcie_pmu *pcie_pmu, -+ int idx) -+{ -+ if (!EVENT_VALID(idx)) { -+ dev_err(pcie_pmu->dev, "Unsupported event index:%d!\n", idx); -+ return; -+ } -+ -+ clear_bit(idx, pcie_pmu->pmu_events.used_mask); -+} -+ -+int phytium_pcie_pmu_event_init(struct perf_event *event) -+{ -+ struct hw_perf_event *hwc = &event->hw; -+ struct phytium_pcie_pmu *pcie_pmu; -+ u32 event_ctrler, event_timer; -+ -+ if (event->attr.type != event->pmu->type) -+ return -ENOENT; -+ -+ if (is_sampling_event(event) || event->attach_state & PERF_ATTACH_TASK) -+ return -EOPNOTSUPP; -+ -+ pcie_pmu = to_phytium_pcie_pmu(event->pmu); -+ -+ if (event->cpu < 0) { -+ dev_warn(pcie_pmu->dev, "Can't provide per-task data!\n"); -+ return -EINVAL; -+ } -+ -+ if ((event->attr.config & 0x1F) > PHYTIUM_PCIE_MAX_COUNTERS) -+ return -EINVAL; -+ -+ if (pcie_pmu->on_cpu == -1) -+ return -EINVAL; -+ -+ event_timer = phytium_pcie_pmu_get_event_timer(event); -+ if (event_timer != 0) -+ phytium_pcie_pmu_set_timer(pcie_pmu, event_timer); -+ -+ event_ctrler = phytium_pcie_pmu_get_event_ctrler(event); -+ switch (pcie_pmu->pmu_id) { -+ case 0: -+ if (event_ctrler != 0) { -+ dev_warn(pcie_pmu->dev, -+ "Wrong ctrler id(%d) for pcie-pmu0!\n", -+ event_ctrler); -+ return -EINVAL; -+ } -+ break; -+ case 1: -+ if ((event_ctrler < 1) || (event_ctrler > 3)) { -+ dev_warn(pcie_pmu->dev, -+ "Wrong ctrler id(%d) for pcie-pmu1!\n", -+ event_ctrler); -+ return -EINVAL; -+ } -+ break; -+ case 2: -+ if ((event_ctrler < 4) || (event_ctrler > 7)) { -+ dev_warn(pcie_pmu->dev, -+ "Wrong ctrler id(%d) for pcie-pmu2!\n", -+ event_ctrler); -+ return -EINVAL; -+ } -+ break; -+ default: -+ dev_err(pcie_pmu->dev, "Unsupported pmu id:%d!\n", -+ pcie_pmu->pmu_id); -+ return -EINVAL; -+ } -+ -+ pcie_pmu->ctrler_id = event_ctrler; -+ switch (pcie_pmu->pmu_id) { -+ case 0: -+ case 1: -+ pcie_pmu->real_ctrler = pcie_pmu->ctrler_id; -+ break; -+ case 2: -+ pcie_pmu->real_ctrler = (pcie_pmu->ctrler_id - 4) * 16; -+ break; -+ default: -+ dev_err(pcie_pmu->dev, "Unsupported pmu id:%d!\n", -+ pcie_pmu->pmu_id); -+ return -EINVAL; -+ } -+ phytium_pcie_pmu_select_ctrler(pcie_pmu); -+ -+ hwc->idx = -1; -+ hwc->config_base = event->attr.config; -+ -+ event->cpu = pcie_pmu->on_cpu; -+ return 0; -+} -+ -+void phytium_pcie_pmu_event_update(struct perf_event *event) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(event->pmu); -+ struct hw_perf_event *hwc = &event->hw; -+ u64 delta; -+ -+ delta = phytium_pcie_pmu_read_counter(pcie_pmu, hwc); -+ local64_add(delta, &event->count); -+} -+ -+void phytium_pcie_pmu_event_start(struct perf_event *event, int flags) -+{ -+ struct hw_perf_event *hwc = &event->hw; -+ -+ hwc->state = 0; -+ perf_event_update_userpage(event); -+} -+ -+void phytium_pcie_pmu_event_stop(struct perf_event *event, int flags) -+{ -+ struct hw_perf_event *hwc = &event->hw; -+ -+ hwc->state |= PERF_HES_STOPPED; -+ -+ if (flags & PERF_EF_UPDATE) -+ phytium_pcie_pmu_event_update(event); -+} -+ -+int phytium_pcie_pmu_event_add(struct perf_event *event, int flags) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(event->pmu); -+ struct hw_perf_event *hwc = &event->hw; -+ int idx; -+ -+ hwc->state |= PERF_HES_STOPPED; -+ -+ idx = phytium_pcie_pmu_mark_event(event); -+ if (idx < 0) -+ return idx; -+ -+ event->hw.idx = idx; -+ pcie_pmu->pmu_events.hw_events[idx] = event; -+ -+ return 0; -+} -+ -+void phytium_pcie_pmu_event_del(struct perf_event *event, int flags) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(event->pmu); -+ struct hw_perf_event *hwc = &event->hw; -+ unsigned long val; -+ u32 event_timer; -+ -+ phytium_pcie_pmu_event_stop(event, PERF_EF_UPDATE); -+ val = phytium_pcie_pmu_get_irq_flag(pcie_pmu); -+ val = phytium_pcie_pmu_get_stop_state(pcie_pmu); -+ phytium_pcie_pmu_unmark_event(pcie_pmu, hwc->idx); -+ -+ event_timer = phytium_pcie_pmu_get_event_timer(event); -+ if (event_timer != 0) -+ phytium_pcie_pmu_reset_timer(pcie_pmu); -+ -+ perf_event_update_userpage(event); -+ pcie_pmu->pmu_events.hw_events[hwc->idx] = NULL; -+} -+ -+void phytium_pcie_pmu_enable(struct pmu *pmu) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(pmu); -+ int event_added = bitmap_weight(pcie_pmu->pmu_events.used_mask, -+ PHYTIUM_PCIE_MAX_COUNTERS); -+ -+ if (event_added) { -+ phytium_pcie_pmu_clear_all_counters(pcie_pmu); -+ phytium_pcie_pmu_start_all_counters(pcie_pmu); -+ } -+} -+ -+void phytium_pcie_pmu_disable(struct pmu *pmu) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(pmu); -+ int event_added = bitmap_weight(pcie_pmu->pmu_events.used_mask, -+ PHYTIUM_PCIE_MAX_COUNTERS); -+ -+ if (event_added) -+ phytium_pcie_pmu_stop_all_counters(pcie_pmu); -+} -+ -+static const struct acpi_device_id phytium_pcie_pmu_acpi_match[] = { -+ { -+ "PHYT0044", -+ }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_pcie_pmu_acpi_match); -+ -+static irqreturn_t phytium_pcie_pmu_overflow_handler(int irq, void *dev_id) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = dev_id; -+ struct perf_event *event; -+ unsigned long overflown, stop_state; -+ int idx; -+ unsigned long *used_mask = pcie_pmu->pmu_events.used_mask; -+ int event_added = bitmap_weight(used_mask, PHYTIUM_PCIE_MAX_COUNTERS); -+ -+ overflown = phytium_pcie_pmu_get_irq_flag(pcie_pmu); -+ -+ if (!test_bit(pcie_pmu->pmu_id + 4, &overflown)) -+ return IRQ_NONE; -+ -+ stop_state = phytium_pcie_pmu_get_stop_state(pcie_pmu); -+ -+ if (bitmap_weight(&stop_state, 6)) { -+ for_each_set_bit(idx, used_mask, PHYTIUM_PCIE_MAX_COUNTERS) { -+ event = pcie_pmu->pmu_events.hw_events[idx]; -+ if (!event) -+ continue; -+ phytium_pcie_pmu_event_update(event); -+ } -+ phytium_pcie_pmu_clear_all_counters(pcie_pmu); -+ phytium_pcie_pmu_start_all_counters(pcie_pmu); -+ -+ return IRQ_HANDLED; -+ } -+ if (!event_added) { -+ phytium_pcie_pmu_clear_all_counters(pcie_pmu); -+ return IRQ_HANDLED; -+ } -+ return IRQ_NONE; -+} -+ -+static int phytium_pcie_pmu_init_irq(struct phytium_pcie_pmu *pcie_pmu, -+ struct platform_device *pdev) -+{ -+ int irq, ret; -+ -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) -+ return irq; -+ -+ ret = devm_request_irq(&pdev->dev, irq, -+ phytium_pcie_pmu_overflow_handler, -+ IRQF_NOBALANCING | IRQF_NO_THREAD | IRQF_SHARED, -+ dev_name(&pdev->dev), pcie_pmu); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "Fail to request IRQ:%d ret:%d\n", irq, -+ ret); -+ return ret; -+ } -+ -+ pcie_pmu->irq = irq; -+ -+ return 0; -+} -+ -+static int phytium_pcie_pmu_init_data(struct platform_device *pdev, -+ struct phytium_pcie_pmu *pcie_pmu) -+{ -+ struct resource *res, *clkres, *irqres; -+ -+ if (device_property_read_u32(&pdev->dev, "phytium,die-id", -+ &pcie_pmu->die_id)) { -+ dev_err(&pdev->dev, "Can not read phytium,die-id!\n"); -+ return -EINVAL; -+ } -+ -+ if (device_property_read_u32(&pdev->dev, "phytium,pmu-id", -+ &pcie_pmu->pmu_id)) { -+ dev_err(&pdev->dev, "Can not read phytium,pmu-id!\n"); -+ return -EINVAL; -+ } -+ -+ switch (pcie_pmu->pmu_id) { -+ case 0: -+ pcie_pmu->clk_bits = 0x1; -+ break; -+ case 1: -+ pcie_pmu->clk_bits = 0xe; -+ break; -+ case 2: -+ pcie_pmu->clk_bits = 0xf; -+ break; -+ default: -+ dev_err(&pdev->dev, "Unsupported pmu id:%d!\n", -+ pcie_pmu->pmu_id); -+ break; -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ pcie_pmu->base = devm_ioremap_resource(&pdev->dev, res); -+ if (IS_ERR(pcie_pmu->base)) { -+ dev_err(&pdev->dev, "ioremap failed for pcie_pmu resource\n"); -+ return PTR_ERR(pcie_pmu->base); -+ } -+ -+ clkres = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ if (!clkres) { -+ dev_err(&pdev->dev, "failed for get pcie_pmu clk resource.\n"); -+ return -EINVAL; -+ } -+ -+ pcie_pmu->csr_base = -+ devm_ioremap(&pdev->dev, clkres->start, resource_size(clkres)); -+ if (IS_ERR(pcie_pmu->csr_base)) { -+ dev_err(&pdev->dev, -+ "ioremap failed for pcie_pmu csr resource\n"); -+ return PTR_ERR(pcie_pmu->csr_base); -+ } -+ -+ irqres = platform_get_resource(pdev, IORESOURCE_MEM, 2); -+ if (!irqres) { -+ dev_err(&pdev->dev, -+ "failed for get pcie_pmu irq reg resource.\n"); -+ return -EINVAL; -+ } -+ -+ pcie_pmu->irq_reg = -+ devm_ioremap(&pdev->dev, irqres->start, resource_size(irqres)); -+ if (IS_ERR(pcie_pmu->irq_reg)) { -+ dev_err(&pdev->dev, -+ "ioremap failed for pcie_pmu irq resource\n"); -+ return PTR_ERR(pcie_pmu->irq_reg); -+ } -+ -+ return 0; -+} -+ -+static int phytium_pcie_pmu_dev_probe(struct platform_device *pdev, -+ struct phytium_pcie_pmu *pcie_pmu) -+{ -+ int ret; -+ -+ ret = phytium_pcie_pmu_init_data(pdev, pcie_pmu); -+ if (ret) -+ return ret; -+ -+ ret = phytium_pcie_pmu_init_irq(pcie_pmu, pdev); -+ if (ret) -+ return ret; -+ pcie_pmu->dev = &pdev->dev; -+ pcie_pmu->on_cpu = -1; -+ pcie_pmu->ctrler_id = -1; -+ -+ return 0; -+} -+ -+static int phytium_pcie_pmu_probe(struct platform_device *pdev) -+{ -+ struct phytium_pcie_pmu *pcie_pmu; -+ char *name; -+ int ret; -+ -+ pcie_pmu = devm_kzalloc(&pdev->dev, sizeof(*pcie_pmu), GFP_KERNEL); -+ if (!pcie_pmu) -+ return -ENOMEM; -+ -+ platform_set_drvdata(pdev, pcie_pmu); -+ -+ ret = phytium_pcie_pmu_dev_probe(pdev, pcie_pmu); -+ if (ret) -+ return ret; -+ -+ ret = cpuhp_state_add_instance( -+ phytium_pcie_pmu_hp_state, &pcie_pmu->node); -+ if (ret) { -+ dev_err(&pdev->dev, "Error %d registering hotplug;\n", ret); -+ return ret; -+ } -+ -+ name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "phyt%u_pcie_pmu%u", -+ pcie_pmu->die_id, pcie_pmu->pmu_id); -+ pcie_pmu->pmu = (struct pmu){ -+ .name = name, -+ .module = THIS_MODULE, -+ .task_ctx_nr = perf_invalid_context, -+ .event_init = phytium_pcie_pmu_event_init, -+ .pmu_enable = phytium_pcie_pmu_enable, -+ .pmu_disable = phytium_pcie_pmu_disable, -+ .add = phytium_pcie_pmu_event_add, -+ .del = phytium_pcie_pmu_event_del, -+ .start = phytium_pcie_pmu_event_start, -+ .stop = phytium_pcie_pmu_event_stop, -+ .read = phytium_pcie_pmu_event_update, -+ .attr_groups = phytium_pcie_pmu_attr_groups, -+ .capabilities = PERF_PMU_CAP_NO_EXCLUDE, -+ }; -+ -+ ret = perf_pmu_register(&pcie_pmu->pmu, name, -1); -+ if (ret) { -+ dev_err(pcie_pmu->dev, "PCIE PMU register failed!\n"); -+ cpuhp_state_remove_instance_nocalls( -+ phytium_pcie_pmu_hp_state, -+ &pcie_pmu->node); -+ } -+ -+ phytium_pcie_pmu_enable_clk(pcie_pmu); -+ -+ pr_info("Phytium PCIe PMU: "); -+ pr_info("die_id = %d pmu_id = %d.\n", pcie_pmu->die_id, -+ pcie_pmu->pmu_id); -+ -+ return ret; -+} -+ -+static int phytium_pcie_pmu_remove(struct platform_device *pdev) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = platform_get_drvdata(pdev); -+ -+ phytium_pcie_pmu_disable_clk(pcie_pmu); -+ -+ perf_pmu_unregister(&pcie_pmu->pmu); -+ cpuhp_state_remove_instance_nocalls( -+ phytium_pcie_pmu_hp_state, &pcie_pmu->node); -+ -+ return 0; -+} -+ -+static struct platform_driver phytium_pcie_pmu_driver = { -+ .driver = { -+ .name = "phytium_pcie_pmu", -+ .acpi_match_table = ACPI_PTR(phytium_pcie_pmu_acpi_match), -+ .suppress_bind_attrs = true, -+ }, -+ .probe = phytium_pcie_pmu_probe, -+ .remove = phytium_pcie_pmu_remove, -+}; -+ -+int phytium_pcie_pmu_online_cpu(unsigned int cpu, struct hlist_node *node) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = -+ hlist_entry_safe(node, struct phytium_pcie_pmu, node); -+ -+ if (!cpumask_test_cpu(cpu, cpumask_of_node(pcie_pmu->die_id))) -+ return 0; -+ -+ if (pcie_pmu->on_cpu != -1) { -+ if (!cpumask_test_cpu(pcie_pmu->on_cpu, cpumask_of_node(pcie_pmu->die_id))) { -+ perf_pmu_migrate_context(&pcie_pmu->pmu, pcie_pmu->on_cpu, cpu); -+ pcie_pmu->on_cpu = cpu; -+ WARN_ON(irq_set_affinity_hint(pcie_pmu->irq, cpumask_of(cpu))); -+ } -+ return 0; -+ } -+ -+ pcie_pmu->on_cpu = cpu; -+ WARN_ON(irq_set_affinity_hint(pcie_pmu->irq, cpumask_of(cpu))); -+ -+ return 0; -+} -+ -+int phytium_pcie_pmu_offline_cpu(unsigned int cpu, struct hlist_node *node) -+{ -+ struct phytium_pcie_pmu *pcie_pmu = -+ hlist_entry_safe(node, struct phytium_pcie_pmu, node); -+ unsigned int target; -+ cpumask_t available_cpus; -+ -+ if (pcie_pmu->on_cpu != cpu) -+ return 0; -+ -+ if (cpumask_and(&available_cpus, cpumask_of_node(pcie_pmu->die_id), cpu_online_mask) && -+ cpumask_andnot(&available_cpus, &available_cpus, cpumask_of(cpu))) -+ target = cpumask_last(&available_cpus); -+ else { -+ cpumask_andnot(&available_cpus, cpu_online_mask, cpumask_of(cpu)); -+ target = cpumask_last(&available_cpus); -+ } -+ -+ if (target >= nr_cpu_ids) { -+ dev_err(pcie_pmu->dev, "offline cpu%d with no target to migrate.\n", -+ cpu); -+ return 0; -+ } -+ -+ perf_pmu_migrate_context(&pcie_pmu->pmu, cpu, target); -+ WARN_ON(irq_set_affinity_hint(pcie_pmu->irq, cpumask_of(target))); -+ pcie_pmu->on_cpu = target; -+ -+ return 0; -+} -+ -+static int __init phytium_pcie_pmu_module_init(void) -+{ -+ int ret; -+ -+ phytium_pcie_pmu_hp_state = -+ cpuhp_setup_state_multi(CPUHP_AP_ONLINE_DYN, -+ "perf/phytium/pciepmu:online", -+ phytium_pcie_pmu_online_cpu, phytium_pcie_pmu_offline_cpu); -+ if (phytium_pcie_pmu_hp_state < 0) { -+ pr_err("PCIE PMU: setup hotplug, ret = %d\n", -+ phytium_pcie_pmu_hp_state); -+ return phytium_pcie_pmu_hp_state; -+ } -+ -+ ret = platform_driver_register(&phytium_pcie_pmu_driver); -+ if (ret) -+ cpuhp_remove_multi_state( -+ phytium_pcie_pmu_hp_state); -+ -+ return ret; -+} -+module_init(phytium_pcie_pmu_module_init); -+ -+static void __exit phytium_pcie_pmu_module_exit(void) -+{ -+ platform_driver_unregister(&phytium_pcie_pmu_driver); -+ cpuhp_remove_multi_state(phytium_pcie_pmu_hp_state); -+} -+module_exit(phytium_pcie_pmu_module_exit); -+ -+MODULE_DESCRIPTION("Phytium PCIe PMU driver"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Hu Xianghua "); -diff --git a/drivers/pwm/Kconfig b/drivers/pwm/Kconfig -index 8ebcddf91..3bd556182 100644 ---- a/drivers/pwm/Kconfig -+++ b/drivers/pwm/Kconfig -@@ -454,6 +454,16 @@ config PWM_PCA9685 - To compile this driver as a module, choose M here: the module - will be called pwm-pca9685. - -+config PWM_PHYTIUM -+ tristate "Phytium PWM support" -+ depends on ARCH_PHYTIUM -+ help -+ Generic PWM framework driver for the PWM controller found on -+ Phytium SoCs. -+ -+ To compile this driver as a module, choose M here: the module -+ will be called pwm-phytium. -+ - config PWM_PXA - tristate "PXA PWM support" - depends on ARCH_PXA || ARCH_MMP || COMPILE_TEST -diff --git a/drivers/pwm/Makefile b/drivers/pwm/Makefile -index c822389c2..e3fb6e95b 100644 ---- a/drivers/pwm/Makefile -+++ b/drivers/pwm/Makefile -@@ -41,6 +41,7 @@ obj-$(CONFIG_PWM_MXS) += pwm-mxs.o - obj-$(CONFIG_PWM_NTXEC) += pwm-ntxec.o - obj-$(CONFIG_PWM_OMAP_DMTIMER) += pwm-omap-dmtimer.o - obj-$(CONFIG_PWM_PCA9685) += pwm-pca9685.o -+obj-$(CONFIG_PWM_PHYTIUM) += pwm-phytium.o - obj-$(CONFIG_PWM_PXA) += pwm-pxa.o - obj-$(CONFIG_PWM_RASPBERRYPI_POE) += pwm-raspberrypi-poe.o - obj-$(CONFIG_PWM_RCAR) += pwm-rcar.o -diff --git a/drivers/pwm/pwm-phytium.c b/drivers/pwm/pwm-phytium.c -new file mode 100644 -index 000000000..98ae864a8 ---- /dev/null -+++ b/drivers/pwm/pwm-phytium.c -@@ -0,0 +1,590 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium PWM driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define REG_TCNT 0x00 -+#define REG_TCTRL 0x04 -+#define REG_STAT 0x08 -+ -+#define REG_TPERIOD 0x0c -+#define REG_PWMCTRL 0x10 -+#define REG_PWMCCR 0x14 -+ -+#define TCTRL_DIV_MASK 0x1ff8 -+#define TCTRL_PWMMOD_MASK 0x4 -+#define TCTRL_CAPMOD_MASK 0x3 -+#define PWM_PERIOD_MASK 0xffff -+#define PWM_DUTY_MASK 0xffff -+#define PWM_MODE_MASK 0x4 -+#define PWM_CTRL_INIT 0xc4 -+ -+#define PWM_NUM 2 -+ -+#define REG_DBCTRL 0x00 -+#define REG_DBCLY 0x04 -+#define PWM_UPDBCLY_MASK 0x3ff -+#define PWM_DWDBCLY_MASK 0xffc00 -+#define PWM_DB_POLARITY_MASK 0xc -+ -+#define PWM_N(x) ((0x400)*(x)) -+#define MAX_PARAMETER 2 -+ -+struct phytium_pwm_state { -+ int rst; -+ int cntmod; -+ int dutymod; -+ unsigned int div; -+ int db_rst; -+ unsigned int updbcly; -+ unsigned int dwdbcly; -+ unsigned int dbpolarity; -+}; -+ -+struct phytium_pwm_param { -+ int cntmod; -+ int dutymod; -+ unsigned int div; -+ unsigned int updbcly; -+ unsigned int dwdbcly; -+ unsigned int dbpolarity; -+}; -+ -+struct phytium_pwm_variant { -+ u8 rst_mask; -+ u8 div; -+ int counter_mode; -+ int periodns; -+ int duty_ns; -+ int pwm_mode; -+ u8 duty_mode; -+ int updbcly; -+ int dwdbcly; -+}; -+ -+struct phytium_pwm_channel { -+ u32 period_ns; -+ u32 duty_ns; -+ u32 tin_ns; -+}; -+ -+struct phytium_pwm_chip { -+ struct pwm_chip chip; -+ struct pwm_state state_pm[PWM_NUM]; -+ struct phytium_pwm_variant variant; -+ struct phytium_pwm_state state; -+ u8 inverter_mask; -+ u8 disabled_mask; -+ int db_init; -+ void __iomem *base; -+ void __iomem *base1; -+ struct phytium_pwm_param parameter[MAX_PARAMETER]; -+ unsigned int num_parameters; -+ -+ struct clk *base_clk; -+}; -+ -+static inline struct phytium_pwm_chip *to_phytium_pwm_chip(struct pwm_chip *chip) -+{ -+ return container_of(chip, struct phytium_pwm_chip, chip); -+} -+ -+ -+static void pwm_phytium_free(struct pwm_chip *chip, struct pwm_device *pwm) -+{ -+ devm_kfree(chip->dev, pwm_get_chip_data(pwm)); -+ pwm_set_chip_data(pwm, NULL); -+} -+ -+static int pwm_phytium_enable(struct pwm_chip *chip, struct pwm_device *pwm, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); -+ reg |= 0x2; -+ our_chip->state_pm[n].enabled = 1; -+ writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); -+ -+ return 0; -+} -+ -+static void pwm_phytium_disable(struct pwm_chip *chip, struct pwm_device *pwm, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); -+ reg &= 0xfffffffd; -+ our_chip->state_pm[n].enabled = 0; -+ writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); -+} -+ -+static void pwm_phytium_dutymod(struct pwm_chip *chip, int dutymod, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_PWMCTRL); -+ -+ if (dutymod == 0) -+ reg &= 0xfffffeff; -+ else if (dutymod == 1) -+ reg |= 0x100; -+ -+ writel(reg, our_chip->base + PWM_N(n) + REG_PWMCTRL); -+} -+ -+static void pwm_phytium_set_div(struct pwm_chip *chip, unsigned int div, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); -+ reg &= 0xffff; -+ reg |= (div<<16); -+ writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); -+} -+ -+static void pwm_phytium_set_tmode(struct pwm_chip *chip, int tmode, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); -+ if (tmode == 0) -+ reg &= 0xfffffffb; -+ else if (tmode == 1) -+ reg |= 0x4; -+ -+ writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); -+} -+ -+static void pwm_phytium_set_periodns(struct pwm_chip *chip, unsigned int periodns, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ int div = our_chip->state.div; -+ u64 cycles; -+ -+ if (has_acpi_companion(chip->dev)) -+ device_property_read_u64(chip->dev, "clock-frequency", &cycles); -+ else -+ cycles = clk_get_rate(our_chip->base_clk); -+ cycles *= (periodns / (div + 1)); -+ do_div(cycles, NSEC_PER_SEC); -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_TPERIOD); -+ cycles = (cycles & PWM_PERIOD_MASK) - 0x1; -+ our_chip->state_pm[n].period = cycles; -+ -+ writel(cycles, our_chip->base + PWM_N(n) + REG_TPERIOD); -+} -+ -+static void pwm_phytium_set_duty(struct pwm_chip *chip, unsigned int duty, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ int div = our_chip->state.div; -+ u64 cycles; -+ -+ if (has_acpi_companion(chip->dev)) -+ device_property_read_u64(chip->dev, "clock-frequency", &cycles); -+ else -+ cycles = clk_get_rate(our_chip->base_clk); -+ cycles *= (duty / (div + 1)); -+ do_div(cycles, NSEC_PER_SEC); -+ -+ reg = readl(our_chip->base + PWM_N(n) + REG_PWMCCR); -+ cycles = (cycles & PWM_DUTY_MASK) - 0x1; -+ our_chip->state_pm[n].duty_cycle = cycles; -+ -+ writel(cycles, our_chip->base + PWM_N(n) + REG_PWMCCR); -+} -+ -+static int pwm_phytium_set_dbcly(struct pwm_chip *chip, unsigned int updbcly, unsigned int dwdbcly) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ u64 dbcly, cycles, upcycles, dwcycles; -+ -+ reg = readl(our_chip->base + REG_TPERIOD); -+ if (has_acpi_companion(chip->dev)) -+ device_property_read_u64(chip->dev, "clock-frequency", &cycles); -+ else -+ cycles = clk_get_rate(our_chip->base_clk); -+ dbcly &= 0x0; -+ if (updbcly) { -+ upcycles = cycles * updbcly; -+ do_div(upcycles, NSEC_PER_SEC); -+ -+ if (upcycles < reg) -+ dbcly |= (upcycles & PWM_UPDBCLY_MASK); -+ else -+ return -EINVAL; -+ } -+ -+ if (dwdbcly) { -+ dwcycles = cycles * dwdbcly; -+ do_div(dwcycles, NSEC_PER_SEC); -+ -+ if (dwcycles < reg) -+ dbcly |= ((dwcycles << 10) & PWM_DWDBCLY_MASK); -+ else -+ return -EINVAL; -+ } -+ -+ writel(dbcly, our_chip->base1 + REG_DBCLY); -+ -+ reg = readl(our_chip->base1 + REG_DBCTRL); -+ reg |= 0x30; -+ writel(reg, our_chip->base1 + REG_DBCTRL); -+ -+ return 0; -+} -+ -+static void pwm_phytium_set_dbpolarity(struct pwm_chip *chip, unsigned int db_polarity) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 reg; -+ -+ reg = readl(our_chip->base1 + REG_DBCTRL); -+ reg &= 0x33; -+ reg |= ((db_polarity<<2) & PWM_DB_POLARITY_MASK); -+ writel(reg, our_chip->base1 + REG_DBCTRL); -+} -+ -+static int pwm_phytium_init(struct pwm_chip *chip, struct pwm_device *pwm, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ -+ writel(PWM_CTRL_INIT, our_chip->base + PWM_N(n) + REG_PWMCTRL); -+ -+ pwm_phytium_dutymod(chip, our_chip->state.dutymod, n); -+ pwm_phytium_set_div(chip, our_chip->state.div, n); -+ pwm_phytium_set_tmode(chip, our_chip->state.cntmod, n); -+ -+ return 0; -+} -+ -+static int pwm_phytium_db_init(struct pwm_chip *chip, struct pwm_device *pwm) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ -+ pwm_phytium_set_dbcly(chip, our_chip->state.updbcly, our_chip->state.dwdbcly); -+ pwm_phytium_set_dbpolarity(chip, our_chip->state.dbpolarity); -+ -+ return 0; -+} -+ -+static int __pwm_phytium_config(struct pwm_chip *chip, struct pwm_device *pwm) -+{ -+ pwm_phytium_init(chip, pwm, 0); -+ pwm_phytium_init(chip, pwm, 1); -+ return 0; -+} -+ -+static int pwm_phytium_set_polarity(struct pwm_chip *chip, enum pwm_polarity polarity, int n) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ u32 value; -+ -+ value = readl(our_chip->base + PWM_N(n) + REG_PWMCTRL); -+ -+ if (polarity == PWM_POLARITY_INVERSED) { -+ value &= 0xffffff0f; -+ value |= 0x30; -+ } else if (polarity == PWM_POLARITY_NORMAL) { -+ value &= 0xffffff0f; -+ value |= 0x40; -+ } -+ -+ our_chip->state_pm[n].polarity = polarity; -+ writel(value, our_chip->base + PWM_N(n) + REG_PWMCTRL); -+ -+ return 0; -+} -+ -+static int pwm_phytium_apply(struct pwm_chip *chip, struct pwm_device *pwm, -+ const struct pwm_state *state) -+{ -+ struct phytium_pwm_chip *phytium_pwm = to_phytium_pwm_chip(chip); -+ struct pwm_state cstate; -+ u32 reg; -+ int n; -+ -+ pwm_get_state(pwm, &cstate); -+ -+ n = pwm->hwpwm & BIT(0); -+ -+ if ((state->polarity != cstate.polarity) && !state->enabled) -+ pwm_phytium_set_polarity(chip, state->polarity, n); -+ -+ if (state->enabled && !cstate.enabled) -+ pwm_phytium_enable(chip, pwm, n); -+ -+ if (!state->enabled && cstate.enabled) -+ pwm_phytium_disable(chip, pwm, n); -+ -+ if (state->period != cstate.period) { -+ pwm_phytium_set_periodns(chip, state->period, n); -+ if ((phytium_pwm->db_init == 1) && (n == 0)) -+ pwm_phytium_db_init(chip, pwm); -+ } -+ -+ if (state->duty_cycle != cstate.duty_cycle) { -+ if (phytium_pwm->state.dutymod == true) { -+ reg = readl(phytium_pwm->base + PWM_N(n) + REG_STAT); -+ if ((reg & 0x8) != 0x8) -+ pwm_phytium_set_duty(chip, state->duty_cycle, n); -+ } else { -+ pwm_phytium_set_duty(chip, state->duty_cycle, n); -+ } -+ } -+ -+ return 0; -+} -+ -+static int pwm_phytium_request(struct pwm_chip *chip, struct pwm_device *pwm) -+{ -+ struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); -+ struct phytium_pwm_channel *our_chan; -+ -+ our_chan = devm_kzalloc(chip->dev, sizeof(*our_chan), GFP_KERNEL); -+ if (!our_chan) -+ return -ENOMEM; -+ -+ pwm_set_chip_data(pwm, our_chan); -+ __pwm_phytium_config(&our_chip->chip, our_chip->chip.pwms); -+ -+ return 0; -+} -+ -+static const struct pwm_ops pwm_phytium_ops = { -+ .request = pwm_phytium_request, -+ .free = pwm_phytium_free, -+ .apply = pwm_phytium_apply, -+ .owner = THIS_MODULE, -+}; -+ -+static int phytium_pwm_set_parameter(struct phytium_pwm_chip *priv) -+{ -+ unsigned int i; -+ -+ for (i = 0; i < priv->num_parameters; i++) { -+ if (priv->parameter[i].updbcly > 0 || priv->parameter[i].dwdbcly > 0) { -+ priv->db_init = 1; -+ priv->state.db_rst = 1; -+ } -+ -+ priv->state.cntmod = priv->parameter[i].cntmod; -+ priv->state.dutymod = priv->parameter[i].dutymod; -+ priv->state.div = priv->parameter[i].div; -+ priv->state.updbcly = priv->parameter[i].updbcly; -+ priv->state.dwdbcly = priv->parameter[i].dwdbcly; -+ priv->state.dbpolarity = priv->parameter[i].dbpolarity; -+ } -+ priv->state.rst = 1; -+ -+ return 0; -+} -+ -+static int pwm_phytium_probe_parameter(struct phytium_pwm_chip *priv, -+ struct device_node *np) -+{ -+ int nb, ret, array_size; -+ unsigned int i; -+ -+ if (has_acpi_companion(priv->chip.dev)) { -+ priv->num_parameters = 1; -+ array_size = sizeof(struct phytium_pwm_param) / sizeof(u32); -+ ret = fwnode_property_read_u32_array(dev_fwnode(priv->chip.dev), -+ "phytium,db", (u32 *)priv->parameter, -+ array_size); -+ if (ret < 0) -+ return ret; -+ } else { -+ nb = of_property_count_elems_of_size(np, "phytium,db", -+ sizeof(struct phytium_pwm_param)); -+ if (nb <= 0 || nb > MAX_PARAMETER) -+ return -EINVAL; -+ -+ priv->num_parameters = nb; -+ array_size = nb * sizeof(struct phytium_pwm_param) / sizeof(u32); -+ ret = of_property_read_u32_array(np, "phytium,db", -+ (u32 *)priv->parameter, array_size); -+ if (ret) -+ return ret; -+ } -+ -+ for (i = 0; i < priv->num_parameters; i++) { -+ if (priv->parameter[i].cntmod > 1 || -+ priv->parameter[i].dutymod > 1 || -+ priv->parameter[i].div > 4096 || -+ priv->parameter[i].dbpolarity > 3) -+ return -EINVAL; -+ } -+ -+ return phytium_pwm_set_parameter(priv); -+} -+static int pwm_phytium_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct device_node *np = dev->of_node; -+ struct phytium_pwm_chip *chip; -+ struct resource *res; -+ int ret; -+ -+ chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); -+ -+ if (chip == NULL) -+ return -ENOMEM; -+ -+ chip->chip.dev = &pdev->dev; -+ chip->chip.ops = &pwm_phytium_ops; -+ chip->chip.base = -1; -+ chip->chip.npwm = PWM_NUM; -+ chip->inverter_mask = BIT(PWM_NUM) - 1; -+ -+ if (pdev->dev.of_node) { -+ chip->chip.of_xlate = of_pwm_xlate_with_flags; -+ chip->chip.of_pwm_n_cells = 3; -+ } -+ -+ ret = pwm_phytium_probe_parameter(chip, np); -+ if (ret) { -+ dev_err(dev, "failed to set parameter\n"); -+ return ret; -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ chip->base1 = devm_ioremap_resource(&pdev->dev, res); -+ chip->base = (chip->base1 + 0x400); -+ -+ if (!has_acpi_companion(&pdev->dev)) { -+ if (IS_ERR(chip->base)) { -+ dev_err(dev, "failed to get base_addr\n"); -+ return PTR_ERR(chip->base); -+ } -+ -+ if (pdev->dev.of_node) { -+ chip->base_clk = devm_clk_get(&pdev->dev, NULL); -+ if (IS_ERR(chip->base_clk)) { -+ dev_err(dev, "failed to get clk\n"); -+ return PTR_ERR(chip->base_clk); -+ } -+ -+ ret = clk_prepare_enable(chip->base_clk); -+ if (ret < 0) { -+ dev_err(dev, "failed to enable clk\n"); -+ return ret; -+ } -+ } -+ } -+ -+ platform_set_drvdata(pdev, chip); -+ -+ ret = pwmchip_add(&chip->chip); -+ -+ if (ret < 0) { -+ dev_err(dev, "failed to register PWM chip\n"); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static int pwm_phytium_remove(struct platform_device *pdev) -+{ -+ struct phytium_pwm_chip *chip = platform_get_drvdata(pdev); -+ -+ pwmchip_remove(&chip->chip); -+ -+ clk_disable_unprepare(chip->base_clk); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int pwm_phytium_pm_init(struct phytium_pwm_chip *priv) -+{ -+ int i; -+ -+ __pwm_phytium_config(&priv->chip, priv->chip.pwms); -+ for (i = 0; i < priv->chip.npwm; i++) { -+ writel(priv->state_pm[i].period, priv->base + PWM_N(i) + REG_TPERIOD); -+ if ((priv->db_init == 1) && (i == 0)) -+ pwm_phytium_db_init(&priv->chip, priv->chip.pwms); -+ writel(priv->state_pm[i].duty_cycle, priv->base + PWM_N(i) + REG_PWMCTRL); -+ pwm_phytium_set_polarity(&priv->chip, priv->state_pm[i].polarity, i); -+ if (priv->state_pm[i].enabled) -+ pwm_phytium_enable(&priv->chip, priv->chip.pwms, i); -+ } -+ -+ return 0; -+} -+ -+static int pwm_phytium_suspend(struct device *dev) -+{ -+ return 0; -+} -+ -+static int pwm_phytium_resume(struct device *dev) -+{ -+ struct phytium_pwm_chip *priv = dev_get_drvdata(dev); -+ -+ pwm_phytium_pm_init(priv); -+ return 0; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_pwm_dev_pm_ops, pwm_phytium_suspend, pwm_phytium_resume); -+ -+static const struct of_device_id phytium_pwm_matches[] = { -+ { .compatible = "phytium,pwm" }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, phytium_pwm_matches); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_pwm_acpi_matches[] = { -+ { "PHYT0029", 0 }, -+ {} -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_pwm_acpi_matches); -+#endif -+ -+static struct platform_driver pwm_phytium_driver = { -+ .driver = { -+ .name = "phytium-pwm", -+ .pm = &phytium_pwm_dev_pm_ops, -+ .of_match_table = phytium_pwm_matches, -+#ifdef CONFIG_ACPI -+ .acpi_match_table = phytium_pwm_acpi_matches, -+#endif -+ }, -+ .probe = pwm_phytium_probe, -+ .remove = pwm_phytium_remove, -+}; -+module_platform_driver(pwm_phytium_driver); -+ -+MODULE_DESCRIPTION("Phytium SoC PWM driver"); -+MODULE_AUTHOR("Yang Liu "); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/pwm/sysfs.c b/drivers/pwm/sysfs.c -index 8d1254761..0180ee80a 100644 ---- a/drivers/pwm/sysfs.c -+++ b/drivers/pwm/sysfs.c -@@ -260,7 +260,7 @@ static int pwm_export_child(struct device *parent, struct pwm_device *pwm) - export->child.parent = parent; - export->child.devt = MKDEV(0, 0); - export->child.groups = pwm_groups; -- dev_set_name(&export->child, "pwm%u", pwm->hwpwm); -+ dev_set_name(&export->child, "pwm%u", pwm->pwm); - - ret = device_register(&export->child); - if (ret) { -diff --git a/drivers/ras/ras.c b/drivers/ras/ras.c -index 95540ea8d..e8094b931 100644 ---- a/drivers/ras/ras.c -+++ b/drivers/ras/ras.c -@@ -21,9 +21,53 @@ void log_non_standard_event(const guid_t *sec_type, const guid_t *fru_id, - trace_non_standard_event(sec_type, fru_id, fru_text, sev, err, len); - } - --void log_arm_hw_error(struct cper_sec_proc_arm *err) -+void log_arm_hw_error(struct cper_sec_proc_arm *err, const u8 sev) - { -- trace_arm_event(err); -+ u32 pei_len; -+ u32 ctx_len = 0; -+ u32 vsei_len; -+ u8 *pei_err; -+ u8 *ctx_err; -+ u8 *ven_err_data; -+ struct cper_arm_err_info *err_info; -+ struct cper_arm_ctx_info *ctx_info; -+ int n, sz; -+ int cpu; -+ -+ pei_len = sizeof(struct cper_arm_err_info) * err->err_info_num; -+ pei_err = (u8 *)err + sizeof(struct cper_sec_proc_arm); -+ -+ err_info = (struct cper_arm_err_info *)(err + 1); -+ ctx_info = (struct cper_arm_ctx_info *)(err_info + err->err_info_num); -+ ctx_err = (u8 *)ctx_info; -+ for (n = 0; n < err->context_info_num; n++) { -+ sz = sizeof(struct cper_arm_ctx_info) + ctx_info->size; -+ ctx_info = (struct cper_arm_ctx_info *)((long)ctx_info + sz); -+ ctx_len += sz; -+ } -+ -+ vsei_len = err->section_length - (sizeof(struct cper_sec_proc_arm) + -+ pei_len + ctx_len); -+ -+ if (vsei_len < 0) { -+ pr_warn(FW_BUG -+ "section length: %d\n", err->section_length); -+ pr_warn(FW_BUG -+ "section length is too small\n"); -+ pr_warn(FW_BUG -+ "firmware-generated error record is incorrect\n"); -+ vsei_len = 0; -+ } -+ ven_err_data = (u8 *)ctx_info; -+ -+ cpu = GET_LOGICAL_INDEX(err->mpidr); -+ /* when return value is invalid, set cpu index to -1 */ -+ if (cpu < 0) -+ cpu = -1; -+ -+ -+ trace_arm_event(err, pei_err, pei_len, ctx_err, ctx_len, -+ ven_err_data, vsei_len, sev, cpu); - } - - static int __init ras_init(void) -diff --git a/drivers/remoteproc/Kconfig b/drivers/remoteproc/Kconfig -index 48845dc8f..f118bfc4b 100644 ---- a/drivers/remoteproc/Kconfig -+++ b/drivers/remoteproc/Kconfig -@@ -365,6 +365,12 @@ config XLNX_R5_REMOTEPROC - - It's safe to say N if not interested in using RPU r5f cores. - -+config HOMO_REMOTEPROC -+ bool "homogeneous remoteproc support" -+ select RPMSG_VIRTIO -+ help -+ Say y here to support homogeneous processors via the remote processor framework. -+ - endif # REMOTEPROC - - endmenu -diff --git a/drivers/remoteproc/Makefile b/drivers/remoteproc/Makefile -index 91314a9b4..87a388098 100644 ---- a/drivers/remoteproc/Makefile -+++ b/drivers/remoteproc/Makefile -@@ -39,3 +39,4 @@ obj-$(CONFIG_STM32_RPROC) += stm32_rproc.o - obj-$(CONFIG_TI_K3_DSP_REMOTEPROC) += ti_k3_dsp_remoteproc.o - obj-$(CONFIG_TI_K3_R5_REMOTEPROC) += ti_k3_r5_remoteproc.o - obj-$(CONFIG_XLNX_R5_REMOTEPROC) += xlnx_r5_remoteproc.o -+obj-$(CONFIG_HOMO_REMOTEPROC) += homo_remoteproc.o -diff --git a/drivers/remoteproc/homo_remoteproc.c b/drivers/remoteproc/homo_remoteproc.c -new file mode 100644 -index 000000000..ea03bfae8 ---- /dev/null -+++ b/drivers/remoteproc/homo_remoteproc.c -@@ -0,0 +1,350 @@ -+/* -+ * Homogeneous Remote Processor Control Driver -+ * -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ * Author: Shaojun Yang -+ * -+ * This program is free software; you can redistribute it and/or modify it under the terms -+ * of the GNU General Public License version 2 as published by the Free Software Foundation. -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "remoteproc_internal.h" -+ -+#define RPROC_RESOURCE_ENTRIES 8 -+ -+#define PSCI_VERSION 0x84000000 -+#define CPU_SUSPEND 0xc4000001 -+#define CPU_OFF 0x84000002 -+#define CPU_ON 0xc4000003 -+#define AFFINITY_INFO 0xc4000004 -+#define MIGRATE 0xc4000005 -+ -+/* Resource table for the homo remote processors */ -+struct homo_resource_table { -+ unsigned int version; -+ unsigned int num; -+ unsigned int reserved[2]; -+ unsigned int offset[RPROC_RESOURCE_ENTRIES]; -+ -+ /* Note: linux kenrel 'struct fw_rsc_vdev' has no 'type' field, here add to align data structre */ -+ uint32_t type; -+ /* rpmsg vdev entry */ -+ struct fw_rsc_vdev rpmsg_vdev; -+ struct fw_rsc_vdev_vring rpmsg_vring0; -+ struct fw_rsc_vdev_vring rpmsg_vring1; -+}; -+ -+struct homo_rproc { -+ struct rproc *rproc; -+ struct homo_resource_table *rsc; -+ -+ u64 phys_addr; -+ void *addr; -+ u64 size; -+ -+ int irq; -+ int cpu; -+}; -+ -+static int homo_rproc_irq; -+static struct homo_rproc *g_priv; -+static struct work_struct workqueue; -+ -+#define MPIDR_TO_SGI_AFFINITY(cluster_id, level) (MPIDR_AFFINITY_LEVEL(cluster_id, level) << ICC_SGI1R_AFFINITY_## level ## _SHIFT) -+ -+void gicv3_ipi_send_single(int irq, u64 mpidr) -+{ -+ u16 tlist = 0; -+ u64 cluster_id; -+ u64 sgi1r; -+ -+ /* Ensure stores to Normal memory are visible to other CPUs before sending the IPI. */ -+ wmb(); -+ -+ cluster_id = mpidr & ~0xffUL; -+ tlist |= 1 << (mpidr & 0xf); -+ -+ /* Send the IPIs for the target list of this cluster */ -+ sgi1r = (MPIDR_TO_SGI_AFFINITY(cluster_id, 3) | -+ MPIDR_TO_SGI_AFFINITY(cluster_id, 2) | -+ irq << 24 | -+ MPIDR_TO_SGI_AFFINITY(cluster_id, 1) | tlist); -+ gic_write_sgi1r(sgi1r); -+ -+ /* Force the above writes to ICC_SGI1R_EL1 to be executed */ -+ isb(); -+} -+ -+static void homo_rproc_vq_irq(struct work_struct *work) -+{ -+ struct homo_rproc *priv = g_priv; -+ struct homo_resource_table *rsc = priv->rsc; -+ struct rproc *rproc = priv->rproc; -+ -+ rproc_vq_interrupt(rproc, rsc->rpmsg_vring0.notifyid); -+} -+ -+static int homo_rproc_start(struct rproc *rproc) -+{ -+ int err; -+ struct homo_rproc *priv = rproc->priv; -+ int phys_cpuid = cpu_logical_map(priv->cpu); -+ struct arm_smccc_res smc_res; -+ -+ err = psci_ops.affinity_info(phys_cpuid, 0); -+ if (err == 0) -+ remove_cpu(priv->cpu); -+ -+ INIT_WORK(&workqueue, homo_rproc_vq_irq); -+ -+ priv->rsc = (struct homo_resource_table *)rproc->table_ptr; -+ -+ /* ARMv8 requires to clean D-cache and invalidate I-cache for memory containing new instructions. */ -+ flush_icache_range((unsigned long)priv->addr, (unsigned long)(priv->addr + priv->size)); -+ -+ arm_smccc_smc(CPU_ON, phys_cpuid, (unsigned long long)priv->phys_addr, 0, 0, 0, 0, 0, &smc_res); -+ -+ return smc_res.a0; -+} -+ -+static int homo_rproc_stop(struct rproc *rproc) -+{ -+ int err; -+ struct homo_rproc *priv = rproc->priv; -+ -+ err = psci_ops.affinity_info(cpu_logical_map(priv->cpu), 0); -+ if (err == 1) -+ add_cpu(priv->cpu); -+ -+ return 0; -+} -+ -+static void *homo_rproc_da_to_va(struct rproc *rproc, u64 da, size_t len, -+ bool *is_iomem) -+{ -+ struct homo_rproc *priv = rproc->priv; -+ -+ return priv->addr + (da - rproc->bootaddr); -+} -+ -+static void homo_rproc_kick(struct rproc *rproc, int vqid) -+{ -+ struct homo_rproc *priv = rproc->priv; -+ -+ if (rproc->state == RPROC_RUNNING) -+ gicv3_ipi_send_single(priv->irq, cpu_logical_map(priv->cpu)); -+ -+ return ; -+} -+ -+static const struct rproc_ops homo_rproc_ops = { -+ .start = homo_rproc_start, -+ .stop = homo_rproc_stop, -+ .kick = homo_rproc_kick, -+ .da_to_va = homo_rproc_da_to_va, -+}; -+ -+static void __iomem *homo_ioremap_prot(phys_addr_t addr, size_t size, pgprot_t prot) -+{ -+ unsigned long offset, vaddr; -+ phys_addr_t last_addr; -+ struct vm_struct *area; -+ -+ /* Disallow wrap-around or zero size */ -+ last_addr = addr + size - 1; -+ if (!size || last_addr < addr) -+ return NULL; -+ -+ /* Page-align mappings */ -+ offset = addr & (~PAGE_MASK); -+ addr -= offset; -+ size = PAGE_ALIGN(size + offset); -+ -+ area = get_vm_area_caller(size, VM_IOREMAP, -+ __builtin_return_address(0)); -+ if (!area) -+ return NULL; -+ vaddr = (unsigned long)area->addr; -+ -+ if (ioremap_page_range(vaddr, vaddr + size, addr, prot)) { -+ free_vm_area(area); -+ return NULL; -+ } -+ -+ return (void __iomem *)(vaddr + offset); -+} -+ -+static irqreturn_t homo_rproc_irq_handler(int irq, void *data) -+{ -+ schedule_work(&workqueue); -+ return IRQ_HANDLED; -+} -+ -+static int homo_rproc_starting_cpu(unsigned int cpu) -+{ -+ enable_percpu_irq(homo_rproc_irq, irq_get_trigger_type(homo_rproc_irq)); -+ return 0; -+} -+ -+static int homo_rproc_dying_cpu(unsigned int cpu) -+{ -+ disable_percpu_irq(homo_rproc_irq); -+ return 0; -+} -+ -+static int homo_rproc_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct device_node *np = dev->of_node, *p; -+ struct device_node *np_mem; -+ struct resource res; -+ struct rproc *rproc; -+ const char *fw_name; -+ struct homo_rproc *priv; -+ int ret; -+ unsigned int ipi, cpu; -+ struct of_phandle_args oirq; -+ -+ ret = rproc_of_parse_firmware(dev, 0, &fw_name); -+ if (ret) { -+ dev_err(dev, "failed to parse firmware-name property, ret = %d\n", ret); -+ return ret; -+ } -+ -+ rproc = rproc_alloc(dev, np->name, &homo_rproc_ops, fw_name, sizeof(*priv)); -+ if (!rproc) -+ return -ENOMEM; -+ -+ rproc->auto_boot = false; -+ rproc->has_iommu = false; -+ -+ platform_set_drvdata(pdev, rproc); -+ -+ priv = g_priv = rproc->priv; -+ priv->rproc = rproc; -+ -+ /* The following values can be modified through devicetree 'homo_rproc' node */ -+ if (of_property_read_u32(np, "remote-processor", &cpu)) { -+ dev_err(dev, "not found 'remote-processor' property\n"); -+ return -EINVAL; -+ } -+ -+ if (of_property_read_u32(np, "inter-processor-interrupt", &ipi)) { -+ dev_err(dev, "not found 'inter-processor-interrupt' property\n"); -+ return -EINVAL; -+ } -+ -+ /* The gic-v3 driver has registered the 0-7 range of SGI interrupt for system purpose */ -+ if (ipi < 8) { -+ dev_err(dev, "'inter-processor-interrupt' is %d, should be between 9~15\n", ipi); -+ return -EINVAL; -+ } -+ -+ priv->cpu = cpu; -+ priv->irq = ipi; -+ -+ dev_info(dev, "remote-processor = %d, inter-processor-interrupt = %d\n", cpu, ipi); -+ -+ np_mem = of_parse_phandle(np, "memory-region", 0); -+ ret = of_address_to_resource(np_mem, 0, &res); -+ if (ret) { -+ dev_err(dev, "can't find memory-region for Baremetal\n"); -+ return ret; -+ } -+ -+ priv->rsc = NULL; -+ priv->addr = NULL; -+ -+ priv->phys_addr = res.start; -+ priv->size = resource_size(&res); -+ -+ /* Map physical memory region reserved for homo remote processor. */ -+ priv->addr = homo_ioremap_prot(priv->phys_addr, priv->size, PAGE_KERNEL_EXEC); -+ if (!priv->addr) { -+ dev_err(dev, "ioremap failed\n"); -+ return -ENOMEM; -+ } -+ dev_info(dev, "ioremap: phys_addr = %016llx, addr = %llx, size = %lld\n", -+ priv->phys_addr, (u64)(priv->addr), priv->size); -+ -+ /* Look for the interrupt parent. */ -+ p = of_irq_find_parent(np); -+ if (p == NULL) { -+ ret = -EINVAL; -+ goto err; -+ } -+ -+ oirq.np = p; -+ oirq.args_count = 1; -+ oirq.args[0] = ipi; -+ homo_rproc_irq = irq_create_of_mapping(&oirq); -+ if (homo_rproc_irq <= 0) { -+ ret = -EINVAL; -+ goto err; -+ } -+ -+ ret = request_percpu_irq(homo_rproc_irq, homo_rproc_irq_handler, "homo-rproc-ipi", &cpu_number); -+ if (ret) { -+ dev_err(dev, "failed to request percpu irq, status = %d\n", ret); -+ goto err; -+ } -+ -+ ret = cpuhp_setup_state(CPUHP_AP_HOMO_RPROC_STARTING, "remoteproc/homo_rproc:starting", homo_rproc_starting_cpu, homo_rproc_dying_cpu); -+ if (ret) { -+ dev_err(dev, "cpuhp setup state failed, status = %d\n", ret); -+ goto err; -+ } -+ -+ ret = rproc_add(rproc); -+ if (ret) { -+ dev_err(dev, "failed to add register device with remoteproc core, status = %d\n", ret); -+ goto err; -+ } -+ -+ return 0; -+ -+err: -+ vunmap((void *)((unsigned long)priv->addr & PAGE_MASK)); -+ return ret; -+} -+ -+static int homo_rproc_remove(struct platform_device *pdev) -+{ -+ struct rproc *rproc = platform_get_drvdata(pdev); -+ -+ rproc_del(rproc); -+ rproc_free(rproc); -+ -+ return 0; -+} -+ -+static const struct of_device_id homo_rproc_ids[] = { -+ { .compatible = "homo,rproc", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, homo_rproc_ids); -+ -+static struct platform_driver homo_rproc_driver = { -+ .probe = homo_rproc_probe, -+ .remove = homo_rproc_remove, -+ .driver = { -+ .name = "homo-rproc", -+ .of_match_table = of_match_ptr(homo_rproc_ids), -+ }, -+}; -+module_platform_driver(homo_rproc_driver); -+ -+MODULE_DESCRIPTION("Homogeneous Remote Processor Control Driver"); -+MODULE_AUTHOR("Shaojun Yang "); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/rtc/Kconfig b/drivers/rtc/Kconfig -old mode 100644 -new mode 100755 -index d7502433c..7d5f56945 ---- a/drivers/rtc/Kconfig -+++ b/drivers/rtc/Kconfig -@@ -708,6 +708,16 @@ config RTC_DRV_S5M - This driver can also be built as a module. If so, the module - will be called rtc-s5m. - -+config RTC_DRV_SD3068 -+ tristate "ZXW Shenzhen whwave SD3068" -+ select REGMAP_I2C -+ help -+ If you say yes here you get support for the ZXW Shenzhen whwave -+ SD3068 RTC chips. -+ -+ This driver can also be built as a module. If so, the module -+ will be called rtc-sd3068 -+ - config RTC_DRV_SD3078 - tristate "ZXW Shenzhen whwave SD3078" - select REGMAP_I2C -diff --git a/drivers/rtc/Makefile b/drivers/rtc/Makefile -old mode 100644 -new mode 100755 -index fd209883e..700d1e9d1 ---- a/drivers/rtc/Makefile -+++ b/drivers/rtc/Makefile -@@ -158,6 +158,7 @@ obj-$(CONFIG_RTC_DRV_S3C) += rtc-s3c.o - obj-$(CONFIG_RTC_DRV_S5M) += rtc-s5m.o - obj-$(CONFIG_RTC_DRV_SA1100) += rtc-sa1100.o - obj-$(CONFIG_RTC_DRV_SC27XX) += rtc-sc27xx.o -+obj-$(CONFIG_RTC_DRV_SD3068) += rtc-sd3068.o - obj-$(CONFIG_RTC_DRV_SD3078) += rtc-sd3078.o - obj-$(CONFIG_RTC_DRV_SH) += rtc-sh.o - obj-$(CONFIG_RTC_DRV_SNVS) += rtc-snvs.o -diff --git a/drivers/rtc/rtc-ds1307.c b/drivers/rtc/rtc-ds1307.c -index 506b7d1c2..479706161 100644 ---- a/drivers/rtc/rtc-ds1307.c -+++ b/drivers/rtc/rtc-ds1307.c -@@ -8,12 +8,14 @@ - * Copyright (C) 2012 Bertrand Achard (nvram access fixes) - */ - -+#include - #include - #include - #include - #include - #include - #include -+#include - #include - #include - #include -@@ -1146,6 +1148,31 @@ static const struct of_device_id ds1307_of_match[] = { - }; - MODULE_DEVICE_TABLE(of, ds1307_of_match); - -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id ds1307_acpi_ids[] = { -+ { .id = "DS1307", .driver_data = ds_1307 }, -+ { .id = "DS1308", .driver_data = ds_1308 }, -+ { .id = "DS1337", .driver_data = ds_1337 }, -+ { .id = "DS1338", .driver_data = ds_1338 }, -+ { .id = "DS1339", .driver_data = ds_1339 }, -+ { .id = "DS1388", .driver_data = ds_1388 }, -+ { .id = "DS1340", .driver_data = ds_1340 }, -+ { .id = "DS1341", .driver_data = ds_1341 }, -+ { .id = "DS3231", .driver_data = ds_3231 }, -+ { .id = "M41T0", .driver_data = m41t0 }, -+ { .id = "M41T00", .driver_data = m41t00 }, -+ { .id = "M41T11", .driver_data = m41t11 }, -+ { .id = "MCP7940X", .driver_data = mcp794xx }, -+ { .id = "MCP7941X", .driver_data = mcp794xx }, -+ { .id = "PT7C4338", .driver_data = ds_1307 }, -+ { .id = "RX8025", .driver_data = rx_8025 }, -+ { .id = "ISL12057", .driver_data = ds_1337 }, -+ { .id = "RX8130", .driver_data = rx_8130 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, ds1307_acpi_ids); -+#endif -+ - /* - * The ds1337 and ds1339 both have two alarms, but we only use the first - * one (with a "seconds" field). For ds1337 we expect nINTA is our alarm -@@ -2010,6 +2037,7 @@ static struct i2c_driver ds1307_driver = { - .driver = { - .name = "rtc-ds1307", - .of_match_table = ds1307_of_match, -+ .acpi_match_table = ACPI_PTR(ds1307_acpi_ids), - }, - .probe = ds1307_probe, - .id_table = ds1307_id, -diff --git a/drivers/rtc/rtc-sd3068.c b/drivers/rtc/rtc-sd3068.c -new file mode 100755 -index 000000000..4ff94c4a1 ---- /dev/null -+++ b/drivers/rtc/rtc-sd3068.c -@@ -0,0 +1,255 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+/* -+ * rtc-sd3068.c - RTC driver for some mostly-compatible I2C chips. -+ * -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define SD3068_REG_SC 0x00 -+#define SD3068_REG_MN 0x01 -+#define SD3068_REG_HR 0x02 -+#define SD3068_REG_DW 0x03 -+#define SD3068_REG_DM 0x04 -+#define SD3068_REG_MO 0x05 -+#define SD3068_REG_YR 0x06 -+ -+#define SD3068_REG_CTRL1 0x0f -+#define SD3068_REG_CTRL2 0x10 -+#define SD3068_REG_CTRL3 0x11 -+ -+#define KEY_WRITE1 0x80 -+#define KEY_WRITE2 0x04 -+#define KEY_WRITE3 0x80 -+ -+#define NUM_TIME_REGS (SD3068_REG_YR - SD3068_REG_SC + 1) -+ -+/* -+ * The sd3068 has write protection -+ * and we can choose whether or not to use it. -+ * Write protection is turned off by default. -+ */ -+#define WRITE_PROTECT_EN 1 -+ -+struct sd3068 { -+ struct rtc_device *rtc; -+ struct regmap *regmap; -+}; -+ -+/* -+ * In order to prevent arbitrary modification of the time register, -+ * when modification of the register, -+ * the "write" bit needs to be written in a certain order. -+ * 1. set WRITE1 bit -+ * 2. set WRITE2 bit -+ * 3. set WRITE3 bit -+ */ -+static void sd3068_enable_reg_write(struct sd3068 *sd3068) -+{ -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL2, -+ KEY_WRITE1, KEY_WRITE1); -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, -+ KEY_WRITE2, KEY_WRITE2); -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, -+ KEY_WRITE3, KEY_WRITE3); -+} -+ -+#if WRITE_PROTECT_EN -+/* -+ * In order to prevent arbitrary modification of the time register, -+ * we should disable the write function. -+ * when disable write, -+ * the "write" bit needs to be clear in a certain order. -+ * 1. clear WRITE2 bit -+ * 2. clear WRITE3 bit -+ * 3. clear WRITE1 bit -+ */ -+static void sd3068_disable_reg_write(struct sd3068 *sd3068) -+{ -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, -+ KEY_WRITE2, 0); -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, -+ KEY_WRITE3, 0); -+ regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL2, -+ KEY_WRITE1, 0); -+} -+#endif -+ -+static int sd3068_rtc_read_time(struct device *dev, struct rtc_time *tm) -+{ -+ unsigned char hour; -+ unsigned char rtc_data[NUM_TIME_REGS] = {0}; -+ struct i2c_client *client = to_i2c_client(dev); -+ struct sd3068 *sd3068 = i2c_get_clientdata(client); -+ int ret; -+ pr_debug("sd3068 read\n"); -+ -+ ret = regmap_bulk_read(sd3068->regmap, SD3068_REG_SC, rtc_data, -+ NUM_TIME_REGS); -+ if (ret < 0) { -+ dev_err(dev, "reading from RTC failed with err:%d\n", ret); -+ return ret; -+ } -+ -+ tm->tm_sec = bcd2bin(rtc_data[SD3068_REG_SC] & 0x7F); -+ tm->tm_min = bcd2bin(rtc_data[SD3068_REG_MN] & 0x7F); -+ -+ /* -+ * The sd3068 supports 12/24 hour mode. -+ * When getting time, -+ * we need to convert the 12 hour mode to the 24 hour mode. -+ */ -+ hour = rtc_data[SD3068_REG_HR]; -+ if (hour & 0x80) /* 24H MODE */ -+ tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x3F); -+ else if (hour & 0x20) /* 12H MODE PM */ -+ tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x1F) + 12; -+ else /* 12H MODE AM */ -+ tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x1F); -+ -+ tm->tm_mday = bcd2bin(rtc_data[SD3068_REG_DM] & 0x3F); -+ tm->tm_wday = rtc_data[SD3068_REG_DW] & 0x07; -+ tm->tm_mon = bcd2bin(rtc_data[SD3068_REG_MO] & 0x1F) - 1; -+ tm->tm_year = bcd2bin(rtc_data[SD3068_REG_YR]) + 100; -+ -+ return 0; -+} -+ -+static int sd3068_rtc_set_time(struct device *dev, struct rtc_time *tm) -+{ -+ unsigned char rtc_data[NUM_TIME_REGS]; -+ struct i2c_client *client = to_i2c_client(dev); -+ struct sd3068 *sd3068 = i2c_get_clientdata(client); -+ int ret; -+ pr_debug("sd3068 set\n"); -+ -+ rtc_data[SD3068_REG_SC] = bin2bcd(tm->tm_sec); -+ rtc_data[SD3068_REG_MN] = bin2bcd(tm->tm_min); -+ rtc_data[SD3068_REG_HR] = bin2bcd(tm->tm_hour) | 0x80; -+ rtc_data[SD3068_REG_DM] = bin2bcd(tm->tm_mday); -+ rtc_data[SD3068_REG_DW] = tm->tm_wday & 0x07; -+ rtc_data[SD3068_REG_MO] = bin2bcd(tm->tm_mon) + 1; -+ rtc_data[SD3068_REG_YR] = bin2bcd(tm->tm_year - 100); -+ -+#if WRITE_PROTECT_EN -+ sd3068_enable_reg_write(sd3068); -+#endif -+ -+ ret = regmap_bulk_write(sd3068->regmap, SD3068_REG_SC, rtc_data, -+ NUM_TIME_REGS); -+ if (ret < 0) { -+ dev_err(dev, "writing to RTC failed with err:%d\n", ret); -+ return ret; -+ } -+ -+#if WRITE_PROTECT_EN -+ sd3068_disable_reg_write(sd3068); -+#endif -+ -+ return 0; -+} -+ -+static const struct rtc_class_ops sd3068_rtc_ops = { -+ .read_time = sd3068_rtc_read_time, -+ .set_time = sd3068_rtc_set_time, -+}; -+ -+static const struct regmap_config regmap_config = { -+ .reg_bits = 8, -+ .val_bits = 8, -+ .max_register = 0x11, -+}; -+ -+static int sd3068_probe(struct i2c_client *client, -+ const struct i2c_device_id *id) -+{ -+ int ret; -+ struct sd3068 *sd3068; -+ unsigned char rtc_data[NUM_TIME_REGS] = {0}; -+ pr_debug("probed\n"); -+ -+ if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) -+ return -ENODEV; -+ -+ sd3068 = devm_kzalloc(&client->dev, sizeof(*sd3068), GFP_KERNEL); -+ if (!sd3068) -+ return -ENOMEM; -+ -+ sd3068->regmap = devm_regmap_init_i2c(client, ®map_config); -+ if (IS_ERR(sd3068->regmap)) { -+ dev_err(&client->dev, "regmap allocation failed\n"); -+ return PTR_ERR(sd3068->regmap); -+ } -+ -+ i2c_set_clientdata(client, sd3068); -+ -+ sd3068->rtc = devm_rtc_allocate_device(&client->dev); -+ if (IS_ERR(sd3068->rtc)) -+ return PTR_ERR(sd3068->rtc); -+ -+ sd3068->rtc->ops = &sd3068_rtc_ops; -+ sd3068->rtc->range_min = RTC_TIMESTAMP_BEGIN_2000; -+ sd3068->rtc->range_max = RTC_TIMESTAMP_END_2099; -+ -+ ret = regmap_bulk_read(sd3068->regmap, SD3068_REG_SC, rtc_data, -+ NUM_TIME_REGS); -+ if (ret < 0) { -+ dev_info(&client->dev, "can not read time data when probe\n"); -+ return ret; -+ } -+ -+ ret = devm_rtc_register_device(sd3068->rtc); -+ if (ret) -+ return ret; -+ -+ sd3068_enable_reg_write(sd3068); -+ -+ return 0; -+} -+ -+ -+static const struct acpi_device_id ds1307_acpi_ids[] = { -+ { .id = "DS1339", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, ds1307_acpi_ids); -+ -+static const struct i2c_device_id sd3068_id[] = { -+ { "sd3068", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(i2c,sd3068_id); -+ -+static const struct of_device_id sd3068_of_match[] = { -+ { .compatible = "wave,sd3068" }, -+ { } -+}; -+ -+static struct i2c_driver sd3068_driver = { -+ .driver = { -+ .name = "rtc-sd3068", -+ .of_match_table = of_match_ptr(sd3068_of_match), -+ .acpi_match_table = ACPI_PTR(ds1307_acpi_ids), -+ }, -+ .probe = sd3068_probe, -+ .id_table = sd3068_id, -+}; -+ -+module_i2c_driver(sd3068_driver); -+MODULE_DEVICE_TABLE(of, sd3068_of_match); -+ -+MODULE_DESCRIPTION("RTC driver for SD3068 and similar chips"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/spi/Kconfig b/drivers/spi/Kconfig -index 3ce0fd5df..03a3037b0 100644 ---- a/drivers/spi/Kconfig -+++ b/drivers/spi/Kconfig -@@ -774,6 +774,44 @@ config SPI_PCI1XXXX - This driver can be built as module. If so, the module will be - called as spi-pci1xxxx. - -+config SPI_PHYTIUM -+ tristate -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ -+config SPI_PHYTIUM_PLAT -+ tristate "Phytium SPI controller platform support" -+ select SPI_PHYTIUM -+ help -+ This selects a platform driver for Phytium SPI controller. -+ -+ If you say yes to this option, support will be included for -+ Phytium SoC families of SPI controller. -+ -+config SPI_PHYTIUM_PCI -+ tristate "Phytium SPI controller PCI support" -+ depends on PCI -+ select SPI_PHYTIUM -+ help -+ This selects a PCI driver for Phytium SPI controller. -+ -+ If you say yes to this option, support will be included for -+ Phytium PCIe chipsets of SPI controller. -+ -+ If unsure, say N. -+ -+config SPI_PHYTIUM_QSPI -+ tristate "Phytium Quad SPI controller" -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ depends on OF -+ depends on SPI_MEM -+ help -+ This enables support for Phytium Quad SPI flash controller. -+ -+ This driver does not support generic SPI. The implementation only -+ supports spi-mem interface. -+ -+ If unsure, say N. -+ - config SPI_PIC32 - tristate "Microchip PIC32 series SPI" - depends on MACH_PIC32 || COMPILE_TEST -diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile -index 6af54842b..cfaf68b2d 100644 ---- a/drivers/spi/Makefile -+++ b/drivers/spi/Makefile -@@ -101,6 +101,11 @@ obj-$(CONFIG_SPI_OMAP24XX) += spi-omap2-mcspi.o - obj-$(CONFIG_SPI_TI_QSPI) += spi-ti-qspi.o - obj-$(CONFIG_SPI_ORION) += spi-orion.o - obj-$(CONFIG_SPI_PCI1XXXX) += spi-pci1xxxx.o -+obj-$(CONFIG_SPI_PHYTIUM) += spi-phytium.o -+obj-$(CONFIG_SPI_PHYTIUM_PLAT) += spi-phytium-plat.o -+obj-$(CONFIG_SPI_PHYTIUM_PCI) += spi-phytium-pci.o -+obj-$(CONFIG_SPI_PHYTIUM_QSPI) += spi-phytium-qspi.o -+obj-$(CONFIG_SPI_PHYTIUM) += spi-phytium-dma.o - obj-$(CONFIG_SPI_PIC32) += spi-pic32.o - obj-$(CONFIG_SPI_PIC32_SQI) += spi-pic32-sqi.o - obj-$(CONFIG_SPI_PL022) += spi-pl022.o -diff --git a/drivers/spi/spi-phytium-dma.c b/drivers/spi/spi-phytium-dma.c -new file mode 100644 -index 000000000..25693b633 ---- /dev/null -+++ b/drivers/spi/spi-phytium-dma.c -@@ -0,0 +1,554 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+/* -+ * Special handling for phytium DMA core -+ * -+ * Copyright (c) 2023-2024 Phytium Technology Co., Ltd. -+ */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "spi-phytium.h" -+ -+#define RX_BUSY 0 -+#define RX_BURST_LEVEL 16 -+#define TX_BUSY 1 -+#define TX_BURST_LEVEL 16 -+ -+#define DMA_MAX_BUF_SIZE 4096 -+ -+static void phytium_spi_dma_maxburst_init(struct phytium_spi *fts) -+{ -+ struct dma_slave_caps caps; -+ u32 max_burst, def_burst; -+ int ret; -+ -+ def_burst = fts->fifo_len / 2; -+ -+ ret = dma_get_slave_caps(fts->rxchan, &caps); -+ if (!ret && caps.max_burst) -+ max_burst = caps.max_burst; -+ else -+ max_burst = RX_BURST_LEVEL; -+ -+ fts->rxburst = min(max_burst, def_burst); -+ phytium_writel(fts, DMARDLR, 0x0); -+ -+ ret = dma_get_slave_caps(fts->txchan, &caps); -+ if (!ret && caps.max_burst) -+ max_burst = caps.max_burst; -+ else -+ max_burst = TX_BURST_LEVEL; -+ -+ /* -+ * Having a Rx DMA channel serviced with higher priority than a Tx DMA -+ * channel might not be enough to provide a well balanced DMA-based -+ * SPI transfer interface. There might still be moments when the Tx DMA -+ * channel is occasionally handled faster than the Rx DMA channel. -+ * That in its turn will eventually cause the SPI Rx FIFO overflow if -+ * SPI bus speed is high enough to fill the SPI Rx FIFO in before it's -+ * cleared by the Rx DMA channel. In order to fix the problem the Tx -+ * DMA activity is intentionally slowed down by limiting the SPI Tx -+ * FIFO depth with a value twice bigger than the Tx burst length. -+ */ -+ fts->txburst = min(max_burst, def_burst); -+ /* set dmatdlr to 0 + 1 */ -+ phytium_writel(fts, DMATDLR, 0); -+} -+ -+static int phytium_spi_dma_init(struct device *dev, -+ struct phytium_spi *fts) -+{ -+ fts->rxchan = dma_request_chan(dev, "rx"); -+ if (IS_ERR_OR_NULL(fts->rxchan)) -+ return -ENODEV; -+ -+ fts->txchan = dma_request_chan(dev, "tx"); -+ if (IS_ERR_OR_NULL(fts->txchan)) { -+ dev_err(dev, "can't request chan\n"); -+ dma_release_channel(fts->rxchan); -+ fts->rxchan = NULL; -+ return -ENODEV; -+ } -+ -+ fts->master->dma_rx = fts->rxchan; -+ fts->master->dma_tx = fts->txchan; -+ init_completion(&fts->dma_completion); -+ -+ phytium_spi_dma_maxburst_init(fts); -+ fts->dma_sg_burst = 0; -+ -+ return 0; -+} -+ -+static void phytium_spi_dma_exit(struct phytium_spi *fts) -+{ -+ if (fts->txchan) { -+ dmaengine_terminate_sync(fts->txchan); -+ dma_release_channel(fts->txchan); -+ } -+ -+ if (fts->rxchan) { -+ dmaengine_terminate_sync(fts->rxchan); -+ dma_release_channel(fts->rxchan); -+ } -+} -+ -+static irqreturn_t phytium_spi_dma_transfer_handler -+(struct phytium_spi *fts) -+{ -+ phytium_spi_check_status(fts, false); -+ -+ complete(&fts->dma_completion); -+ -+ return IRQ_HANDLED; -+} -+ -+static bool phytium_spi_can_dma(struct spi_controller *master, -+ struct spi_device *spi, struct spi_transfer *xfer) -+{ -+ struct phytium_spi *fts = spi_controller_get_devdata(master); -+ -+ return xfer->len > fts->fifo_len; -+} -+ -+static enum dma_slave_buswidth phytium_spi_dma_convert_width(u8 n_bytes) -+{ -+ if (n_bytes == 1) -+ return DMA_SLAVE_BUSWIDTH_1_BYTE; -+ else if (n_bytes == 2) -+ return DMA_SLAVE_BUSWIDTH_2_BYTES; -+ -+ return DMA_SLAVE_BUSWIDTH_UNDEFINED; -+} -+ -+static int phytium_spi_dma_wait(struct phytium_spi *fts, unsigned int len, -+ u32 speed) -+{ -+ unsigned long long ms; -+ -+ ms = len * MSEC_PER_SEC * BITS_PER_BYTE; -+ do_div(ms, speed); -+ ms += ms + 200; -+ -+ if (ms > UINT_MAX) -+ ms = UINT_MAX; -+ -+ ms = wait_for_completion_timeout(&fts->dma_completion, -+ msecs_to_jiffies(ms)); -+ -+ if (ms == 0) { -+ dev_err(&fts->master->cur_msg->spi->dev, -+ "DMA transaction timed out\n"); -+ return -ETIMEDOUT; -+ } -+ -+ return 0; -+} -+ -+static inline bool phytium_spi_dma_tx_busy(struct phytium_spi *fts) -+{ -+ return !(phytium_readl(fts, SR) & SR_TF_EMPT); -+} -+ -+static void spi_transfer_delay_ns(u32 ns) -+{ -+ if (!ns) -+ return; -+ if (ns <= 1000) { -+ ndelay(ns); -+ } else { -+ u32 us = DIV_ROUND_UP(ns, 1000); -+ -+ if (us <= 10) -+ udelay(us); -+ else -+ usleep_range(us, us + DIV_ROUND_UP(us, 10)); -+ } -+} -+ -+static int phytium_spi_dma_wait_tx_done(struct phytium_spi *fts, -+ struct spi_transfer *xfer) -+{ -+ int retry = SPI_WAIT_RETRIES; -+ u32 ns = 0; -+ u32 nents = 0; -+ -+ nents = phytium_readl(fts, TXFLR); -+ ns = nents * fts->n_bytes * BITS_PER_BYTE; -+ ns *= DIV_ROUND_UP(1000000000, xfer->speed_hz / 2); -+ -+ while (phytium_spi_dma_tx_busy(fts) && retry--) -+ spi_transfer_delay_ns(ns); -+ -+ if (retry < 0) { -+ dev_err(&fts->master->dev, "Tx hanged up\n"); -+ return -EIO; -+ } -+ -+ return 0; -+} -+ -+/* -+ * fts->dma_chan_busy is set before the dma transfer starts, -+ * callback for tx -+ * channel will clear a corresponding bit. -+ */ -+static void phytium_spi_dma_tx_done(void *arg) -+{ -+ struct phytium_spi *fts = arg; -+ -+ clear_bit(TX_BUSY, &fts->dma_chan_busy); -+ if (test_bit(RX_BUSY, &fts->dma_chan_busy)) -+ return; -+ -+ complete(&fts->dma_completion); -+} -+ -+static int phytium_spi_dma_config_tx(struct phytium_spi *fts) -+{ -+ struct dma_slave_config txconf; -+ -+ memset(&txconf, 0, sizeof(txconf)); -+ txconf.direction = DMA_MEM_TO_DEV; -+ txconf.dst_addr = fts->dma_addr; -+ txconf.dst_maxburst = fts->txburst; -+ txconf.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; -+ txconf.dst_addr_width = phytium_spi_dma_convert_width(fts->n_bytes); -+ txconf.device_fc = false; -+ -+ return dmaengine_slave_config(fts->txchan, &txconf); -+} -+ -+static int phytium_spi_dma_submit_tx(struct phytium_spi *fts, -+ struct scatterlist *sgl, unsigned int nents) -+{ -+ struct dma_async_tx_descriptor *txdesc; -+ dma_cookie_t cookie; -+ int ret; -+ -+ txdesc = dmaengine_prep_slave_sg(fts->txchan, sgl, nents, -+ DMA_MEM_TO_DEV, -+ DMA_PREP_INTERRUPT | DMA_CTRL_ACK); -+ if (!txdesc) -+ return -ENOMEM; -+ -+ txdesc->callback = phytium_spi_dma_tx_done; -+ txdesc->callback_param = fts; -+ -+ cookie = dmaengine_submit(txdesc); -+ ret = dma_submit_error(cookie); -+ if (ret) { -+ dmaengine_terminate_sync(fts->txchan); -+ return ret; -+ } -+ -+ set_bit(TX_BUSY, &fts->dma_chan_busy); -+ -+ return 0; -+} -+ -+static inline bool phytium_spi_dma_rx_busy(struct phytium_spi *fts) -+{ -+ return !!(phytium_readl(fts, SR) & SR_RF_NOT_EMPT); -+} -+ -+static int phytium_spi_dma_wait_rx_done(struct phytium_spi *fts) -+{ -+ int retry = SPI_WAIT_RETRIES; -+ unsigned long ns = 0; -+ u32 nents = 0; -+ -+ /* -+ * It's unlikely that DMA engine is still doing the data fetching, but -+ * if it's let's give it some reasonable time. The timeout calculation -+ * is based on the synchronous APB/SSI reference clock rate, on a -+ * number of data entries left in the Rx FIFO, times a number of clock -+ * periods normally needed for a single APB read/write transaction -+ * without PREADY signal utilized (which is true for the phytium APB SSI -+ * controller). -+ */ -+ nents = phytium_readl(fts, RXFLR); -+ ns = 4U * NSEC_PER_SEC / fts->max_freq * nents; -+ -+ while (phytium_spi_dma_rx_busy(fts) && retry--) -+ spi_transfer_delay_ns(ns); -+ -+ if (retry < 0) { -+ dev_err(&fts->master->dev, "Rx hanged up, nents = %d\n", nents); -+ return -EIO; -+ } -+ -+ return 0; -+} -+ -+/* -+ * fts->dma_chan_busy is set before the dma transfer starts, -+ * callback for rx -+ * channel will clear a corresponding bit. -+ */ -+static void phytium_spi_dma_rx_done(void *arg) -+{ -+ struct phytium_spi *fts = arg; -+ -+ clear_bit(RX_BUSY, &fts->dma_chan_busy); -+ if (test_bit(TX_BUSY, &fts->dma_chan_busy)) -+ return; -+ -+ complete(&fts->dma_completion); -+} -+ -+static int phytium_spi_dma_config_rx(struct phytium_spi *fts) -+{ -+ struct dma_slave_config rxconf; -+ -+ memset(&rxconf, 0, sizeof(rxconf)); -+ rxconf.direction = DMA_DEV_TO_MEM; -+ rxconf.src_addr = fts->dma_addr; -+ rxconf.src_maxburst = fts->rxburst; -+ rxconf.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; -+ rxconf.src_addr_width = phytium_spi_dma_convert_width(fts->n_bytes); -+ rxconf.device_fc = false; -+ -+ return dmaengine_slave_config(fts->rxchan, &rxconf); -+} -+ -+static int phytium_spi_dma_submit_rx(struct phytium_spi *fts, -+ struct scatterlist *sgl, unsigned int nents) -+{ -+ struct dma_async_tx_descriptor *rxdesc; -+ dma_cookie_t cookie; -+ int ret; -+ -+ rxdesc = dmaengine_prep_slave_sg(fts->rxchan, sgl, nents, -+ DMA_DEV_TO_MEM, -+ DMA_PREP_INTERRUPT | DMA_CTRL_ACK); -+ if (!rxdesc) -+ return -ENOMEM; -+ -+ rxdesc->callback = phytium_spi_dma_rx_done; -+ rxdesc->callback_param = fts; -+ -+ cookie = dmaengine_submit(rxdesc); -+ ret = dma_submit_error(cookie); -+ if (ret) { -+ dmaengine_terminate_sync(fts->rxchan); -+ return ret; -+ } -+ -+ set_bit(RX_BUSY, &fts->dma_chan_busy); -+ -+ return 0; -+} -+ -+static int phytium_spi_dma_setup(struct phytium_spi *fts, -+ struct spi_transfer *xfer) -+{ -+ u16 imr, dma_ctrl; -+ int ret; -+ -+ if (!xfer->tx_buf) -+ return -EINVAL; -+ -+ /* Setup DMA channels */ -+ ret = phytium_spi_dma_config_tx(fts); -+ if (ret) -+ return ret; -+ -+ if (xfer->rx_buf) { -+ ret = phytium_spi_dma_config_rx(fts); -+ if (ret) -+ return ret; -+ } -+ -+ /* Set the DMA handshaking interface */ -+ dma_ctrl = SPI_DMA_TDMAE; -+ if (xfer->rx_buf) -+ dma_ctrl |= SPI_DMA_RDMAE; -+ phytium_writel(fts, DMACR, dma_ctrl); -+ -+ /* Set the interrupt mask */ -+ imr = INT_TXOI; -+ if (xfer->rx_buf) -+ imr |= INT_RXUI | INT_RXOI; -+ -+ spi_umask_intr(fts, imr); -+ -+ reinit_completion(&fts->dma_completion); -+ -+ fts->transfer_handler = phytium_spi_dma_transfer_handler; -+ -+ return 0; -+} -+ -+static int phytium_spi_dma_transfer_all(struct phytium_spi *fts, -+ struct spi_transfer *xfer) -+{ -+ int ret; -+ -+ /* Submit the DMA Tx transfer */ -+ ret = phytium_spi_dma_submit_tx(fts, xfer->tx_sg.sgl, -+ xfer->tx_sg.nents); -+ if (ret) -+ goto err_clear_dmac; -+ -+ /* Submit the DMA Rx transfer if required */ -+ if (xfer->rx_buf) { -+ ret = phytium_spi_dma_submit_rx(fts, xfer->rx_sg.sgl, -+ xfer->rx_sg.nents); -+ if (ret) -+ goto err_clear_dmac; -+ -+ /* rx must be started before tx due to spi instinct */ -+ dma_async_issue_pending(fts->rxchan); -+ } -+ -+ dma_async_issue_pending(fts->txchan); -+ -+ ret = phytium_spi_dma_wait(fts, xfer->len, xfer->speed_hz); -+ -+err_clear_dmac: -+ phytium_writel(fts, DMACR, 0); -+ -+ return ret; -+} -+ -+static int phytium_spi_dma_transfer_one(struct phytium_spi *fts, -+ struct spi_transfer *xfer) -+{ -+ struct scatterlist *tx_sg = NULL, *rx_sg = NULL, tx_tmp, rx_tmp; -+ unsigned int tx_len = 0, rx_len = 0; -+ unsigned int base, len; -+ int ret; -+ -+ sg_init_table(&tx_tmp, 1); -+ sg_init_table(&rx_tmp, 1); -+ -+ for (base = 0, len = 0; base < xfer->len; base += len) { -+ /* Fetch next Tx DMA data chunk */ -+ if (!tx_len) { -+ tx_sg = !tx_sg ? &xfer->tx_sg.sgl[0] : sg_next(tx_sg); -+ sg_dma_address(&tx_tmp) = sg_dma_address(tx_sg); -+ tx_len = sg_dma_len(tx_sg); -+ } -+ -+ /* Fetch next Rx DMA data chunk */ -+ if (!rx_len) { -+ rx_sg = !rx_sg ? &xfer->rx_sg.sgl[0] : sg_next(rx_sg); -+ sg_dma_address(&rx_tmp) = sg_dma_address(rx_sg); -+ rx_len = sg_dma_len(rx_sg); -+ } -+ -+ if ((base + DMA_MAX_BUF_SIZE) > xfer->len) -+ len = xfer->len - base; -+ else -+ len = DMA_MAX_BUF_SIZE; -+ -+ len = min3(len, tx_len, rx_len); -+ -+ sg_dma_len(&tx_tmp) = len; -+ sg_dma_len(&rx_tmp) = len; -+ -+ /* Submit DMA Tx transfer */ -+ ret = phytium_spi_dma_submit_tx(fts, &tx_tmp, 1); -+ if (ret) -+ break; -+ -+ /* Submit DMA Rx transfer */ -+ ret = phytium_spi_dma_submit_rx(fts, &rx_tmp, 1); -+ if (ret) -+ break; -+ -+ /* Rx must be started before Tx due to SPI instinct */ -+ dma_async_issue_pending(fts->rxchan); -+ -+ dma_async_issue_pending(fts->txchan); -+ -+ /* -+ * Here we only need to wait for the DMA transfer to be -+ * finished since SPI controller is kept enabled during the -+ * procedure this loop implements and there is no risk to lose -+ * data left in the Tx/Rx FIFOs. -+ */ -+ ret = phytium_spi_dma_wait(fts, len, xfer->speed_hz); -+ if (ret) -+ break; -+ -+ reinit_completion(&fts->dma_completion); -+ -+ sg_dma_address(&tx_tmp) += len; -+ sg_dma_address(&rx_tmp) += len; -+ tx_len -= len; -+ rx_len -= len; -+ } -+ -+ phytium_writel(fts, DMACR, 0); -+ -+ return ret; -+} -+ -+static int phytium_spi_dma_transfer(struct phytium_spi *fts, -+ struct spi_transfer *xfer) -+{ -+ unsigned int nents; -+ int ret; -+ -+ nents = max(xfer->tx_sg.nents, xfer->rx_sg.nents); -+ -+ /* -+ * large transfer length caused spi RX FIFO full event -+ * transfer 4096 bytes each time -+ */ -+ if (xfer->len <= DMA_MAX_BUF_SIZE) -+ ret = phytium_spi_dma_transfer_all(fts, xfer); -+ else -+ ret = phytium_spi_dma_transfer_one(fts, xfer); -+ if (ret) -+ return ret; -+ -+ if (fts->master->cur_msg->status == -EINPROGRESS) { -+ ret = phytium_spi_dma_wait_tx_done(fts, xfer); -+ if (ret) -+ return ret; -+ } -+ -+ if (xfer->rx_buf && fts->master->cur_msg->status == -EINPROGRESS) -+ ret = phytium_spi_dma_wait_rx_done(fts); -+ -+ return ret; -+} -+ -+static void phytium_spi_dma_stop(struct phytium_spi *fts) -+{ -+ if (test_bit(TX_BUSY, &fts->dma_chan_busy)) { -+ dmaengine_terminate_sync(fts->txchan); -+ clear_bit(TX_BUSY, &fts->dma_chan_busy); -+ } -+ if (test_bit(RX_BUSY, &fts->dma_chan_busy)) { -+ dmaengine_terminate_sync(fts->rxchan); -+ clear_bit(RX_BUSY, &fts->dma_chan_busy); -+ } -+} -+ -+static const struct phytium_spi_dma_ops phytium_spi_dma_generic_ops = { -+ .dma_init = phytium_spi_dma_init, -+ .dma_exit = phytium_spi_dma_exit, -+ .dma_setup = phytium_spi_dma_setup, -+ .can_dma = phytium_spi_can_dma, -+ .dma_transfer = phytium_spi_dma_transfer, -+ .dma_stop = phytium_spi_dma_stop, -+}; -+ -+void phytium_spi_dmaops_set(struct phytium_spi *fts) -+{ -+ fts->dma_ops = &phytium_spi_dma_generic_ops; -+} -+EXPORT_SYMBOL_GPL(phytium_spi_dmaops_set); -+ -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/spi/spi-phytium-pci.c b/drivers/spi/spi-phytium-pci.c -new file mode 100644 -index 000000000..6ef8acfe5 ---- /dev/null -+++ b/drivers/spi/spi-phytium-pci.c -@@ -0,0 +1,127 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SPI core controller PCI driver. -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from drivers/spi/spi-dw-pci.c -+ * Copyright (c) 2009, 2014 Intel Corporation. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "spi-phytium.h" -+ -+#define DRIVER_NAME "phytium_spi_pci" -+ -+static int phytium_spi_pci_probe(struct pci_dev *pdev, -+ const struct pci_device_id *id) -+{ -+ struct phytium_spi *fts; -+ int pci_bar = 0; -+ int ret; -+ -+ fts = devm_kzalloc(&pdev->dev, sizeof(struct phytium_spi), -+ GFP_KERNEL); -+ if (!fts) -+ return -ENOMEM; -+ -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ ret = pcim_iomap_regions(pdev, 1 << pci_bar, pci_name(pdev)); -+ if (ret) { -+ dev_err(&pdev->dev, "pci iomap failed?\n"); -+ return ret; -+ } -+ -+ fts->regs = pcim_iomap_table(pdev)[pci_bar]; -+ if (IS_ERR(fts->regs)) { -+ dev_err(&pdev->dev, "SPI region map failed\n"); -+ return PTR_ERR(fts->regs); -+ } -+ -+ fts->irq = pdev->irq; -+ if (fts->irq < 0) { -+ dev_err(&pdev->dev, "no irq resource?\n"); -+ return fts->irq; /* -ENXIO */ -+ } -+ -+ fts->bus_num = -1; -+ -+ fts->max_freq = 48000000; -+ -+ fts->num_cs = 4; -+ -+ fts->global_cs = 1; -+ -+ ret = phytium_spi_add_host(&pdev->dev, fts); -+ if (ret) -+ return ret; -+ -+ pci_set_drvdata(pdev, fts); -+ return 0; -+} -+ -+static void phytium_spi_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_spi *fts = pci_get_drvdata(pdev); -+ -+ phytium_spi_remove_host(fts); -+} -+ -+ -+#ifdef CONFIG_PM_SLEEP -+static int spi_suspend(struct device *dev) -+{ -+ struct spi_master *master = dev_get_drvdata(dev); -+ struct phytium_spi *fts = spi_master_get_devdata(master); -+ -+ return phytium_spi_suspend_host(fts); -+} -+ -+static int spi_resume(struct device *dev) -+{ -+ struct spi_master *master = dev_get_drvdata(dev); -+ struct phytium_spi *fts = spi_master_get_devdata(master); -+ -+ return phytium_spi_resume_host(fts); -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_spi_pm_ops, spi_suspend, spi_resume); -+ -+static const struct pci_device_id phytium_device_pci_tbl[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc2c) }, -+ {}, -+}; -+ -+static struct pci_driver phytium_spi_pci_driver = { -+ .name = DRIVER_NAME, -+ .id_table = phytium_device_pci_tbl, -+ .probe = phytium_spi_pci_probe, -+ .remove = phytium_spi_pci_remove, -+ .driver = { -+ .pm = &phytium_spi_pm_ops, -+ } -+}; -+ -+module_pci_driver(phytium_spi_pci_driver); -+ -+MODULE_AUTHOR("Yiqun Zhang "); -+MODULE_DESCRIPTION("PCI Driver for Phytium SPI controller core"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/spi/spi-phytium-plat.c b/drivers/spi/spi-phytium-plat.c -new file mode 100644 -index 000000000..9b82c5c01 ---- /dev/null -+++ b/drivers/spi/spi-phytium-plat.c -@@ -0,0 +1,171 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SPI core controller platform driver. -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from drivers/spi/spi-dw-mmio.c -+ * Copyright (c) 2010, Octasic semiconductor. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "spi-phytium.h" -+ -+#define DRIVER_NAME "phytium_spi" -+ -+struct phytium_spi_clk { -+ struct phytium_spi fts; -+ struct clk *clk; -+}; -+ -+static int phytium_spi_probe(struct platform_device *pdev) -+{ -+ struct phytium_spi_clk *ftsc; -+ struct phytium_spi *fts; -+ struct resource *mem; -+ int ret; -+ int num_cs; -+ int global_cs; -+ -+ ftsc = devm_kzalloc(&pdev->dev, sizeof(struct phytium_spi_clk), -+ GFP_KERNEL); -+ if (!ftsc) -+ return -ENOMEM; -+ -+ fts = &ftsc->fts; -+ -+ mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ if (!mem) { -+ dev_err(&pdev->dev, "no mem resource?\n"); -+ return -EINVAL; -+ } -+ -+ fts->paddr = mem->start; -+ fts->regs = devm_ioremap_resource(&pdev->dev, mem); -+ if (IS_ERR(fts->regs)) { -+ dev_err(&pdev->dev, "SPI region map failed\n"); -+ return PTR_ERR(fts->regs); -+ } -+ -+ fts->irq = platform_get_irq(pdev, 0); -+ if (fts->irq < 0) { -+ dev_err(&pdev->dev, "no irq resource?\n"); -+ return fts->irq; /* -ENXIO */ -+ } -+ -+ if (pdev->dev.of_node) { -+ ftsc->clk = devm_clk_get(&pdev->dev, NULL); -+ -+ if (IS_ERR(ftsc->clk)) -+ return PTR_ERR(ftsc->clk); -+ ret = clk_prepare_enable(ftsc->clk); -+ if (ret) -+ return ret; -+ -+ fts->max_freq = clk_get_rate(ftsc->clk); -+ } else if (has_acpi_companion(&pdev->dev)) { -+ fts->max_freq = 48000000; -+ } -+ -+ fts->bus_num = pdev->id; -+ device_property_read_u32(&pdev->dev, "reg-io-width", &fts->reg_io_width); -+ -+ num_cs = 4; -+ device_property_read_u32(&pdev->dev, "num-cs", &num_cs); -+ fts->num_cs = num_cs; -+ -+ device_property_read_u32(&pdev->dev, "global-cs", &global_cs); -+ fts->global_cs = global_cs; -+ -+ /* check is use dma transfer */ -+ if ((device_property_read_string_array(&pdev->dev, "dma-names", -+ NULL, 0) > 0) && -+ device_property_present(&pdev->dev, "dmas")) { -+ fts->dma_en = true; -+ phytium_spi_dmaops_set(fts); -+ } -+ -+ ret = phytium_spi_add_host(&pdev->dev, fts); -+ if (ret) -+ goto out; -+ -+ platform_set_drvdata(pdev, ftsc); -+ return 0; -+ -+out: -+ clk_disable_unprepare(ftsc->clk); -+ return ret; -+} -+ -+static int phytium_spi_remove(struct platform_device *pdev) -+{ -+ struct phytium_spi_clk *ftsc = platform_get_drvdata(pdev); -+ -+ phytium_spi_remove_host(&ftsc->fts); -+ clk_disable_unprepare(ftsc->clk); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int spi_suspend(struct device *dev) -+{ -+ struct phytium_spi_clk *ftsc = dev_get_drvdata(dev); -+ -+ return phytium_spi_suspend_host(&ftsc->fts); -+} -+ -+static int spi_resume(struct device *dev) -+{ -+ struct phytium_spi_clk *ftsc = dev_get_drvdata(dev); -+ -+ return phytium_spi_resume_host(&ftsc->fts); -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_spi_pm_ops, spi_suspend, spi_resume); -+ -+static const struct of_device_id phytium_spi_of_match[] = { -+ { .compatible = "phytium,spi", .data = (void *)0 }, -+ { /* end of table */} -+}; -+MODULE_DEVICE_TABLE(of, phytium_spi_of_match); -+ -+static const struct acpi_device_id phytium_spi_acpi_match[] = { -+ {"PHYT000E", 0}, -+ {} -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_spi_acpi_match); -+ -+static struct platform_driver phytium_spi_driver = { -+ .probe = phytium_spi_probe, -+ .remove = phytium_spi_remove, -+ .driver = { -+ .name = DRIVER_NAME, -+ .of_match_table = of_match_ptr(phytium_spi_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_spi_acpi_match), -+ .pm = &phytium_spi_pm_ops, -+ }, -+}; -+module_platform_driver(phytium_spi_driver); -+ -+MODULE_AUTHOR("Yiqun Zhang "); -+MODULE_DESCRIPTION("Platform Driver for Phytium SPI controller core"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/spi/spi-phytium-qspi.c b/drivers/spi/spi-phytium-qspi.c -new file mode 100644 -index 000000000..d97e3b705 ---- /dev/null -+++ b/drivers/spi/spi-phytium-qspi.c -@@ -0,0 +1,857 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium Quad SPI controller driver. -+ * -+ * Copyright (c) 2022-2023, Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+ -+ -+#define QSPI_FLASH_CAP_REG 0x00 -+#define QSPI_FLASH_CAP_NUM_SHIFT 3 -+#define QSPI_FLASH_CAP_NUM_MASK (0x3 << QSPI_FLASH_CAP_NUM_SHIFT) -+#define QSPI_FLASH_CAP_CAP_SHIFT 0 -+#define QSPI_FLASH_CAP_CAP_MASK (0x7 << QSPI_FLASH_CAP_CAP_SHIFT) -+ -+#define QSPI_RD_CFG_REG 0x04 -+#define QSPI_RD_CFG_RD_CMD_SHIFT 24 -+#define QSPI_RD_CFG_RD_CMD_MASK (0xff << QSPI_RD_CFG_RD_CMD_SHIFT) -+#define QSPI_RD_CFG_RD_THROUGH_SHIFT 23 -+#define QSPI_RD_CFG_RD_THROUGH_MASK (0x1 << QSPI_RD_CFG_RD_THROUGH_SHIFT) -+#define QSPI_RD_CFG_RD_TRANSFER_SHIFT 20 -+#define QSPI_RD_CFG_RD_TRANSFER_MASK (0x7 << QSPI_RD_CFG_RD_TRANSFER_SHIFT) -+#define QSPI_RD_CFG_RD_ADDR_SEL_SHIFT 19 -+#define QSPI_RD_CFG_RD_ADDR_SEL_MASK (0x1 << QSPI_RD_CFG_RD_ADDR_SEL_SHIFT) -+#define QSPI_RD_CFG_RD_LATENCY_SHIFT 18 -+#define QSPI_RD_CFG_RD_LATENCY_MASK (0x1 << QSPI_RD_CFG_RD_LATENCY_SHIFT) -+#define QSPI_RD_CFG_MODE_BYTE_SHIFT 17 -+#define QSPI_RD_CFG_MODE_BYTE_MASK (0x1 << QSPI_RD_CFG_MODE_BYTE_SHIFT) -+#define QSPI_RD_CFG_CMD_SIGN_SHIFT 9 -+#define QSPI_RD_CFG_CMD_SIGN_MASK (0xff << QSPI_RD_CFG_CMD_SIGN_SHIFT) -+#define QSPI_RD_CFG_DUMMY_SHIFT 4 -+#define QSPI_RD_CFG_DUMMY_MASK (0x1f << QSPI_RD_CFG_DUMMY_SHIFT) -+#define QSPI_RD_CFG_D_BUFFER_SHIFT 3 -+#define QSPI_RD_CFG_D_BUFFER_MASK (0x1 << QSPI_RD_CFG_D_BUFFER_SHIFT) -+#define QSPI_RD_CFG_RD_SCK_SEL_SHIFT 0 -+#define QSPI_RD_CFG_RD_SCK_SEL_MASK (0x7 << QSPI_RD_CFG_RD_SCK_SEL_SHIFT) -+ -+#define QSPI_WR_CFG_REG 0x08 -+#define QSPI_WR_CFG_WR_CMD_SHIFT 24 -+#define QSPI_WR_CFG_WR_CMD_MASK (0xff << QSPI_WR_CFG_WR_CMD_SHIFT) -+#define QSPI_WR_CFG_WR_WAIT_SHIFT 9 -+#define QSPI_WR_CFG_WR_WAIT_MASK (0x01 << QSPI_WR_CFG_WR_WAIT_SHIFT) -+#define QSPI_WR_CFG_WR_THROUGH_SHIFT 8 -+#define QSPI_WR_CFG_WR_THROUGH_MASK (0x01 << QSPI_WR_CFG_WR_THROUGH_SHIFT) -+#define QSPI_WR_CFG_WR_TRANSFER_SHIFT 5 -+#define QSPI_WR_CFG_WR_TRANSFER_MASK (0X7 << QSPI_WR_CFG_WR_TRANSFER_SHIFT) -+#define QSPI_WR_CFG_WR_ADDR_SEL_SHIFT 4 -+#define QSPI_WR_CFG_WR_ADDR_SEL_MASK (0x1 << QSPI_WR_CFG_WR_ADDR_SEL_SHIFT) -+#define QSPI_WR_CFG_WR_MODE_SHIFT 3 -+#define QSPI_WR_CFG_WR_MODE_MASK (0x1 << QSPI_WR_CFG_WR_MODE_SHIFT) -+#define QSPI_WR_CFG_WR_SCK_SEL_SHIFT 0 -+#define QSPI_WR_CFG_WR_SCK_SEL_MASK (0x7 << QSPI_WR_CFG_WR_SCK_SEL_SHIFT) -+ -+#define QSPI_FLUSH_REG 0x0c -+#define QSPI_FLUSH_EN (0x1 << 0) -+ -+#define QSPI_CMD_PORT_REG 0x10 -+#define QSPI_CMD_PORT_CMD_SHIFT 24 -+#define QSPI_CMD_PORT_CMD_MASK (0xff << QSPI_CMD_PORT_CMD_SHIFT) -+#define QSPI_CMD_PORT_WAIT_SHIFT 22 -+#define QSPI_CMD_PORT_WAIT_MASK (0x1 << QSPI_CMD_PORT_WAIT_SHIFT) -+#define QSPI_CMD_PORT_THROUGH_SHIFT 21 -+#define QSPI_CMD_PORT_THROUGH_MASK (0x1 << QSPI_CMD_PORT_THROUGH_SHIFT) -+#define QSPI_CMD_PORT_CS_SHIFT 19 -+#define QSPI_CMD_PORT_CS_MASK (0x3 << QSPI_CMD_PORT_CS_SHIFT) -+#define QSPI_CMD_PORT_TRANSFER_SHIFT 16 -+#define QSPI_CMD_PORT_TRANSFER_MASK (0x7 << QSPI_CMD_PORT_TRANSFER_SHIFT) -+#define QSPI_CMD_PORT_CMD_ADDR_SHIFT 15 -+#define QSPI_CMD_PORT_CMD_ADDR_MASK (0x1 << QSPI_CMD_PORT_CMD_ADDR_SHIFT) -+#define QSPI_CMD_PORT_LATENCY_SHIFT 14 -+#define QSPI_CMD_PORT_LATENCY_MASK (0x1 << QSPI_CMD_PORT_LATENCY_SHIFT) -+#define QSPI_CMD_PORT_DATA_XFER_SHIFT 13 -+#define QSPI_CMD_PORT_DATA_XFER_MASK (0x1 << QSPI_CMD_PORT_DATA_XFER_SHIFT) -+#define QSPI_CMD_PORT_ADDR_SEL_SHIFT 12 -+#define QSPI_CMD_PORT_ADDR_SEL_MASK (0x1 << QSPI_CMD_PORT_ADDR_SEL_SHIFT) -+#define QSPI_CMD_PORT_DUMMY_SHIFT 7 -+#define QSPI_CMD_PORT_DUMMY_MASK (0x1f << QSPI_CMD_PORT_DUMMY_SHIFT) -+#define QSPI_CMD_PORT_P_BUFFER_SHIFT 6 -+#define QSPI_CMD_PORT_P_BUFFER_MASK (0x1 << QSPI_CMD_PORT_P_BUFFER_SHIFT) -+#define QSPI_CMD_PORT_RW_NUM_SHIFT 3 -+#define QSPI_CMD_PORT_RW_NUM_MASK (0x7 << QSPI_CMD_PORT_RW_NUM_SHIFT) -+#define QSPI_CMD_PORT_SCK_SEL_SHIFT 0 -+#define QSPI_CMD_PORT_SCK_SEL_MASK (0x7 << QSPI_CMD_PORT_SCK_SEL_SHIFT) -+ -+#define QSPI_ADDR_PORT_REG 0x14 -+#define QSPI_HD_PORT_REG 0x18 -+#define QSPI_LD_PORT_REG 0x1c -+ -+#define QSPI_FUN_SET_REG 0x20 -+#define QSPI_FUN_SET_HOLD_SHIFT 24 -+#define QSPI_FUN_SET_HOLD_MASK (0xff << QSPI_FUN_SET_HOLD_SHIFT) -+#define QSPI_FUN_SET_SETUP_SHIFT 16 -+#define QSPI_FUN_SET_SETUP_MASK (0xff << QSPI_FUN_SET_SETUP_SHIFT) -+#define QSPI_FUN_SET_DELAY_SHIFT 0 -+#define QSPI_FUN_SET_DELAY_MASK (0xffff << QSPI_FUN_SET_DELAY_SHIFT) -+ -+#define QSPI_WIP_REG 0x24 -+#define QSPI_WIP_W_CMD_SHIFT 24 -+#define QSPI_WIP_W_CMD_MASK (0xff << QSPI_WIP_W_CMD_SHIFT) -+#define QSPI_WIP_W_TRANSFER_SHIFT 3 -+#define QSPI_WIP_W_TRANSFER_MASK (0x3 << QSPI_WIP_W_TRANSFER_SHIFT) -+#define QSPI_WIP_W_SCK_SEL_SHIFT 0 -+#define QSPI_WIP_W_SCK_SEL_MASK (0x7 << QSPI_WIP_W_SCK_SEL_SHIFT) -+ -+#define QSPI_WP_REG 0x28 -+#define QSPI_WP_EN_SHIFT 17 -+#define QSPI_WP_EN_MASK (0x1 << QSPI_WP_EN_SHIFT) -+#define QSPI_WP_IO2_SHIFT 16 -+#define QSPI_WP_IO2_MASK (0x1 << QSPI_WP_IO2_SHIFT) -+#define QSPI_WP_HOLD_SHIFT 8 -+#define QSPI_WP_HOLD_MASK (0xff << QSPI_WP_HOLD_SHIFT) -+#define QSPI_WP_SETUP_SHIFT 0 -+#define QSPI_WP_SETUP_MASK (0xff << QSPI_WP_SETUP_SHIFT) -+ -+#define QSPI_MODE_REG 0x2c -+#define QSPI_MODE_VALID_SHIFT 8 -+#define QSPI_MODE_VALID_MASK (0xff << QSPI_MODE_VALID_SHIFT) -+#define QSPI_MODE_SHIFT 0 -+#define QSPI_MODE_MASK (0xff << QSPI_MODE_SHIFT) -+ -+#define PHYTIUM_QSPI_MAX_NORCHIP 4 -+#define PHYTIUM_QSPI_MAX_MMAP_SZ (SZ_256M * PHYTIUM_QSPI_MAX_NORCHIP) -+#define PHYTIUM_QSPI_MAX_XFER_SZ 8 -+#define PHYTIUM_QSPI_DEFAULT_SCK_SEL 5 -+ -+#define XFER_PROTO_1_1_1 0x0 -+#define XFER_PROTO_1_1_2 0x1 -+#define XFER_PROTO_1_1_4 0x2 -+#define XFER_PROTO_1_2_2 0x3 -+#define XFER_PROTO_1_4_4 0x4 -+#define XFER_PROTO_2_2_2 0x5 -+#define XFER_PROTO_4_4_4 0x6 -+ -+struct phytium_qspi_flash { -+ u32 cs; -+ u32 clk_div; -+ -+ void __iomem *base; -+ resource_size_t size; -+ struct spi_device *spi; -+}; -+ -+struct phytium_qspi { -+ struct device *dev; -+ struct spi_controller *ctrl; -+ -+ void __iomem *io_base; -+ void __iomem *mm_base; -+ resource_size_t mm_size; -+ resource_size_t used_size; -+ -+ struct clk *clk; -+ u32 clk_rate; -+ -+ struct phytium_qspi_flash flash[PHYTIUM_QSPI_MAX_NORCHIP]; -+ u8 fnum; -+ bool nodirmap; -+ -+ u32 wr_cfg_reg; -+ u32 rd_cfg_reg; -+ u32 flash_cap; -+}; -+ -+static bool phytium_qspi_check_buswidth(u8 width) -+{ -+ switch (width) { -+ case 1: -+ case 2: -+ case 4: -+ return 0; -+ } -+ -+ return -EOPNOTSUPP; -+} -+ -+static uint phytium_spi_nor_clac_clk_div(int div) -+{ -+ uint clk_div = 0; -+ -+ if (div <= 2) -+ clk_div = 1; -+ else if (div <= 4) -+ clk_div = 2; -+ else if (div <= 8) -+ clk_div = 3; -+ else if (div <= 16) -+ clk_div = 4; -+ else if (div <= 32) -+ clk_div = 5; -+ else if (div <= 64) -+ clk_div = 6; -+ else if (div <= 128) -+ clk_div = 7; -+ else -+ clk_div = 65535; -+ -+ return clk_div; -+} -+ -+static int phytium_spi_nor_protocol_encode(const struct spi_mem_op *op, u32 *code) -+{ -+ int ret = 0; -+ -+ if (op->cmd.buswidth == 1 && -+ op->addr.buswidth == 1 && -+ op->data.buswidth == 1) -+ *code = XFER_PROTO_1_1_1; -+ else if (op->cmd.buswidth == 1 && -+ op->addr.buswidth == 1 && -+ op->data.buswidth == 2) -+ *code = XFER_PROTO_1_1_2; -+ else if (op->cmd.buswidth == 1 && -+ op->addr.buswidth == 1 && -+ op->data.buswidth == 4) -+ *code = XFER_PROTO_1_1_4; -+ else if (op->cmd.buswidth == 1 && -+ op->addr.buswidth == 2 && -+ op->data.buswidth == 2) -+ *code = XFER_PROTO_1_2_2; -+ else if (op->cmd.buswidth == 1 && -+ op->addr.buswidth == 4 && -+ op->data.buswidth == 4) -+ *code = XFER_PROTO_1_4_4; -+ else if (op->cmd.buswidth == 2 && -+ op->addr.buswidth == 2 && -+ op->data.buswidth == 2) -+ *code = XFER_PROTO_2_2_2; -+ else if (op->cmd.buswidth == 4 && -+ op->addr.buswidth == 4 && -+ op->data.buswidth == 4) -+ *code = XFER_PROTO_4_4_4; -+ else -+ *code = XFER_PROTO_1_1_1; -+ -+ return ret; -+} -+ -+static int phytium_qspi_flash_capacity_encode(u32 size, u32 *cap) -+{ -+ int ret = 0; -+ -+ switch (size) { -+ case SZ_4M: -+ *cap = 0x0; -+ break; -+ case SZ_8M: -+ *cap = 0x1; -+ break; -+ case SZ_16M: -+ *cap = 0x2; -+ break; -+ case SZ_32M: -+ *cap = 0x3; -+ break; -+ case SZ_64M: -+ *cap = 0x4; -+ break; -+ case SZ_128M: -+ *cap = 0x5; -+ break; -+ case SZ_256M: -+ *cap = 0x6; -+ break; -+ case SZ_512M: -+ *cap = 0x7; -+ break; -+ default: -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+static void phytium_qspi_clear_wr(struct phytium_qspi *qspi, -+ struct phytium_qspi_flash *flash) -+{ -+ u32 cmd = 0; -+ -+ cmd |= 0x05 << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= BIT(QSPI_CMD_PORT_TRANSFER_SHIFT); -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); -+ -+ /* clear wr_cfg */ -+ writel_relaxed(0, qspi->io_base + QSPI_WR_CFG_REG); -+} -+ -+static int phytium_qspi_write_port(struct phytium_qspi *qspi, -+ const u8 *buf, const size_t len) -+{ -+ u32 bouncebuf[2] = { 0 }; -+ -+ if (len > PHYTIUM_QSPI_MAX_XFER_SZ) { -+ dev_err(qspi->dev, "WRITE data exceeds 8 bytes.\n"); -+ return -EINVAL; -+ } -+ -+ memcpy(bouncebuf, buf, len); -+ -+ if (len > 4) -+ writel_relaxed(bouncebuf[1], qspi->io_base + QSPI_HD_PORT_REG); -+ writel_relaxed(bouncebuf[0], qspi->io_base + QSPI_LD_PORT_REG); -+ -+ return 0; -+} -+ -+static int phytium_qspi_read_port(struct phytium_qspi *qspi, -+ u8 *buf, size_t len) -+{ -+ u32 bouncebuf[2] = { 0 }; -+ -+ if (len > PHYTIUM_QSPI_MAX_XFER_SZ) { -+ dev_err(qspi->dev, "READ data exceeds 8 bytes.\n"); -+ return -EINVAL; -+ } -+ -+ /* Dummy write to LD_PORT register and issue READ ops*/ -+ writel_relaxed(0, qspi->io_base + QSPI_LD_PORT_REG); -+ -+ /* Read data */ -+ bouncebuf[0] = readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); -+ if (len > 4) -+ bouncebuf[1] = readl_relaxed(qspi->io_base + QSPI_HD_PORT_REG); -+ -+ memcpy(buf, bouncebuf, len); -+ -+ return 0; -+} -+ -+static int phytium_qspi_adjust_op_size(struct spi_mem *mem, -+ struct spi_mem_op *op) -+{ -+ if (op->data.nbytes > PHYTIUM_QSPI_MAX_XFER_SZ) -+ op->data.nbytes = PHYTIUM_QSPI_MAX_XFER_SZ; -+ -+ return 0; -+} -+ -+static bool phytium_qspi_supports_op(struct spi_mem *mem, -+ const struct spi_mem_op *op) -+{ -+ int ret; -+ -+ ret = phytium_qspi_check_buswidth(op->cmd.buswidth); -+ -+ if (op->addr.nbytes) -+ ret |= phytium_qspi_check_buswidth(op->addr.buswidth); -+ -+ if (op->dummy.nbytes) -+ ret |= phytium_qspi_check_buswidth(op->dummy.buswidth); -+ -+ if (op->data.nbytes) -+ ret |= phytium_qspi_check_buswidth(op->data.buswidth); -+ -+ if (ret) -+ return false; -+ -+ /* Max 32 dummy clock cycles supported */ -+ if (op->dummy.nbytes && -+ (op->dummy.nbytes * 8 / op->dummy.buswidth > 32)) -+ return false; -+ -+ return spi_mem_default_supports_op(mem, op); -+} -+ -+static int phytium_qspi_exec_op(struct spi_mem *mem, -+ const struct spi_mem_op *op) -+{ -+ struct phytium_qspi *qspi = spi_controller_get_devdata(mem->spi->master); -+ struct phytium_qspi_flash *flash = &qspi->flash[mem->spi->chip_select]; -+ u32 cmd, transfer; -+ int ret; -+ -+ dev_dbg(qspi->dev, "cmd:%#x mode: %d.%d.%d.%d addr:%#llx len:%#x\n", -+ op->cmd.opcode, op->cmd.buswidth, op->addr.buswidth, -+ op->dummy.buswidth, op->data.buswidth, op->addr.val, -+ op->data.nbytes); -+ -+ cmd = op->cmd.opcode << QSPI_CMD_PORT_CMD_SHIFT; -+ cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; -+ -+ ret = phytium_spi_nor_protocol_encode(op, &transfer); -+ if (ret) { -+ dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); -+ goto out; -+ } -+ cmd |= transfer << QSPI_CMD_PORT_TRANSFER_SHIFT; -+ -+ if (op->addr.nbytes) { -+ cmd |= QSPI_CMD_PORT_CMD_ADDR_MASK; -+ if (op->addr.nbytes == 4) -+ cmd |= QSPI_CMD_PORT_ADDR_SEL_MASK; -+ -+ /* Write target address to ADDR_PORT register */ -+ writel_relaxed(op->addr.val, qspi->io_base + QSPI_ADDR_PORT_REG); -+ } -+ -+ if (op->dummy.nbytes) { -+ cmd |= QSPI_CMD_PORT_LATENCY_MASK; -+ cmd |= ((op->dummy.nbytes * 8) / op->dummy.buswidth) << -+ QSPI_CMD_PORT_LATENCY_SHIFT; -+ } -+ -+ if (op->data.nbytes) { -+ cmd |= QSPI_CMD_PORT_DATA_XFER_MASK; -+ cmd &= ~QSPI_CMD_PORT_P_BUFFER_MASK; -+ cmd |= (op->data.nbytes-1) << QSPI_CMD_PORT_RW_NUM_SHIFT; -+ } -+ -+ cmd |= flash->clk_div; -+ writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); -+ -+ if (op->data.dir == SPI_MEM_DATA_IN) { -+ ret = phytium_qspi_read_port(qspi, op->data.buf.in, op->data.nbytes); -+ if (ret) { -+ dev_err(qspi->dev, "Failed to read data from the port.\n"); -+ goto out; -+ } -+ } else if (op->data.dir == SPI_MEM_DATA_OUT) { -+ ret = phytium_qspi_write_port(qspi, op->data.buf.out, op->data.nbytes); -+ if (ret) { -+ dev_err(qspi->dev, "Failed to write data to the port.\n"); -+ goto out; -+ } -+ } else { -+ /* Dummy write to LD_PORT register and issue the command */ -+ writel_relaxed(0, qspi->io_base + QSPI_LD_PORT_REG); -+ } -+ -+out: -+ return ret; -+} -+ -+static int phytium_qspi_dirmap_create(struct spi_mem_dirmap_desc *desc) -+{ -+ struct spi_device *spi = desc->mem->spi; -+ struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); -+ struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; -+ struct spi_nor *nor = spi_mem_get_drvdata(desc->mem); -+ u32 cmd, transfer; -+ int ret = 0; -+ -+ if (!qspi->mm_base || !qspi->mm_size) { -+ ret = -EOPNOTSUPP; -+ goto out; -+ } -+ -+ if (!flash->base) { -+ flash->base = qspi->mm_base + qspi->used_size; -+ qspi->used_size += nor->mtd.size; -+ } -+ -+ /* Setup RD/WR_CFG register */ -+ if (desc->info.op_tmpl.data.dir == SPI_MEM_DATA_IN) { -+ cmd = desc->info.op_tmpl.cmd.opcode << QSPI_RD_CFG_RD_CMD_SHIFT; -+ ret = phytium_spi_nor_protocol_encode(&desc->info.op_tmpl, &transfer); -+ if (ret) { -+ dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); -+ goto out; -+ } -+ cmd |= transfer << QSPI_RD_CFG_RD_TRANSFER_SHIFT; -+ -+ if (desc->info.op_tmpl.addr.nbytes == 4) -+ cmd |= QSPI_RD_CFG_RD_ADDR_SEL_MASK; -+ -+ if (nor->read_dummy) { -+ cmd |= QSPI_RD_CFG_RD_LATENCY_MASK; -+ cmd |= (nor->read_dummy - 1) << QSPI_RD_CFG_DUMMY_SHIFT; -+ } -+ -+ cmd |= QSPI_RD_CFG_D_BUFFER_MASK; -+ cmd |= flash->clk_div & QSPI_RD_CFG_RD_SCK_SEL_MASK; -+ -+ writel_relaxed(cmd, qspi->io_base + QSPI_RD_CFG_REG); -+ qspi->rd_cfg_reg = cmd; -+ -+ dev_dbg(qspi->dev, "Create read dirmap and setup RD_CFG_REG [%#x].\n", cmd); -+ } else if (desc->info.op_tmpl.data.dir == SPI_MEM_DATA_OUT) { -+ cmd = desc->info.op_tmpl.cmd.opcode << QSPI_WR_CFG_WR_CMD_SHIFT; -+ ret = phytium_spi_nor_protocol_encode(&desc->info.op_tmpl, &transfer); -+ if (ret) { -+ dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); -+ goto out; -+ } -+ cmd |= transfer << QSPI_WR_CFG_WR_TRANSFER_SHIFT; -+ -+ if (desc->info.op_tmpl.addr.nbytes == 4) -+ cmd |= QSPI_WR_CFG_WR_ADDR_SEL_MASK; -+ -+ cmd |= QSPI_WR_CFG_WR_MODE_MASK; -+ cmd |= flash->clk_div & QSPI_WR_CFG_WR_SCK_SEL_MASK; -+ qspi->wr_cfg_reg = cmd; -+ } else { -+ ret = -EINVAL; -+ } -+ -+out: -+ return ret; -+} -+ -+static ssize_t phytium_qspi_dirmap_read(struct spi_mem_dirmap_desc *desc, -+ u64 offs, size_t len, void *buf) -+{ -+ struct spi_device *spi = desc->mem->spi; -+ struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); -+ struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; -+ -+ void __iomem *src = flash->base + offs; -+ u8 *buf_rx = buf; -+ -+ memcpy_fromio(buf_rx, src, len); -+ -+ return len; -+} -+ -+static ssize_t phytium_qspi_dirmap_write(struct spi_mem_dirmap_desc *desc, -+ u64 offs, size_t len, const void *buf) -+{ -+ struct spi_device *spi = desc->mem->spi; -+ struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); -+ struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; -+ -+ void __iomem *dst = flash->base + offs; -+ void __iomem *addr; -+ int i; -+ size_t mask = 0x03; -+ u_char tmp[4] = {0}; -+ -+ /* set wr_cfg for drimap write */ -+ writel_relaxed(qspi->wr_cfg_reg, qspi->io_base + QSPI_WR_CFG_REG); -+ -+ if (offs & 0x03) { -+ dev_err(qspi->dev, "Addr not four-byte aligned!\n"); -+ return -EINVAL; -+ } -+ -+ for (i = 0; i < len / 4; i++) -+ writel_relaxed(*(u32 *)(buf + 4 * i), dst + 4 * i); -+ -+ if (len & mask) { -+ addr = dst + (len & ~mask); -+ memcpy(tmp, buf + (len & ~mask), len & mask); -+ writel_relaxed(*(u32 *)(tmp), addr); -+ } -+ -+ //write cache data to flash -+ writel_relaxed(QSPI_FLUSH_EN, qspi->io_base + QSPI_FLUSH_REG); -+ -+ phytium_qspi_clear_wr(qspi, flash); -+ -+ return len; -+} -+ -+static int phytium_qspi_setup(struct spi_device *spi) -+{ -+ struct spi_controller *ctrl = spi->master; -+ struct phytium_qspi *qspi = spi_controller_get_devdata(ctrl); -+ struct phytium_qspi_flash *flash; -+ uint clk_div; -+ -+ if (ctrl->busy) -+ return -EBUSY; -+ -+ flash = &qspi->flash[spi->chip_select]; -+ -+ flash->cs = spi->chip_select; -+ flash->spi = spi; -+ if (flash->cs >= PHYTIUM_QSPI_MAX_NORCHIP) { -+ dev_err(qspi->dev, "Flash CS is out of range.\n"); -+ return -EINVAL; -+ } -+ qspi->fnum++; -+ -+ -+ if (spi->max_speed_hz) { -+ clk_div = DIV_ROUND_UP(qspi->clk_rate, spi->max_speed_hz); -+ flash->clk_div = phytium_spi_nor_clac_clk_div(clk_div); -+ if (flash->clk_div == 65535) { -+ dev_err(qspi->dev, "qspi maximum frequency setting is error.\n"); -+ return -EINVAL; -+ } -+ } else -+ flash->clk_div = PHYTIUM_QSPI_DEFAULT_SCK_SEL; -+ -+ return 0; -+} -+ -+static struct spi_controller_mem_ops phytium_qspi_mem_ops = { -+ .adjust_op_size = phytium_qspi_adjust_op_size, -+ .supports_op = phytium_qspi_supports_op, -+ .exec_op = phytium_qspi_exec_op, -+ .dirmap_create = phytium_qspi_dirmap_create, -+ .dirmap_read = phytium_qspi_dirmap_read, -+ .dirmap_write = phytium_qspi_dirmap_write, -+}; -+ -+/** -+ * Direct mapping is supported only when all flashes under the controller -+ * are of the same size and the mapping address is continuous. For those -+ * cases which flashes are of different sizes, the driver offered a non-dirmap -+ * mem_ops with which read/write ops is executed through command port. -+ */ -+static struct spi_controller_mem_ops phytium_qspi_mem_ops_nodirmap = { -+ .adjust_op_size = phytium_qspi_adjust_op_size, -+ .supports_op = phytium_qspi_supports_op, -+ .exec_op = phytium_qspi_exec_op, -+}; -+ -+/** -+ * phytium_qspi_probe - Probe method for the QSPI driver -+ * @pdev: Pointer to the platform_device structure -+ * -+ * This function initializes the driver data structures and the hardware. -+ * -+ * Return: 0 on success and error value on failure -+ */ -+static int phytium_qspi_probe(struct platform_device *pdev) -+{ -+ struct device *dev = &pdev->dev; -+ struct spi_controller *ctrl; -+ struct resource *res; -+ struct phytium_qspi *qspi; -+ int i, ret; -+ struct spi_mem *mem; -+ struct spi_nor *nor; -+ const char **reg_name_array; -+ -+ ctrl = spi_alloc_master(dev, sizeof(*qspi)); -+ if (!ctrl) -+ return -ENOMEM; -+ -+ ctrl->mode_bits = SPI_CPOL | SPI_CPHA | -+ SPI_RX_DUAL | SPI_RX_QUAD | -+ SPI_TX_DUAL | SPI_TX_QUAD; -+ ctrl->setup = phytium_qspi_setup; -+ ctrl->num_chipselect = PHYTIUM_QSPI_MAX_NORCHIP; -+ if (IS_ENABLED(CONFIG_OF)) -+ ctrl->dev.of_node = dev->of_node; -+ else if (IS_ENABLED(CONFIG_ACPI) && has_acpi_companion(dev)) -+ ctrl->dev.fwnode = dev->fwnode; -+ -+ qspi = spi_controller_get_devdata(ctrl); -+ qspi->ctrl = ctrl; -+ -+ reg_name_array = kcalloc(4, sizeof(*reg_name_array), GFP_KERNEL); -+ if (dev->of_node) -+ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi"); -+ else if (has_acpi_companion(dev)) { -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ fwnode_property_read_string_array(dev->fwnode, -+ "reg-names", reg_name_array, 2); -+ res->name = reg_name_array[0]; -+ } -+ qspi->io_base = devm_ioremap_resource(dev, res); -+ if (IS_ERR(qspi->io_base)) { -+ ret = PTR_ERR(qspi->io_base); -+ goto probe_master_put; -+ } -+ -+ if (dev->of_node) -+ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi_mm"); -+ else if (has_acpi_companion(dev)) { -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ res->name = reg_name_array[1]; -+ } -+ -+ qspi->mm_base = devm_ioremap_resource(dev, res); -+ if (IS_ERR(qspi->mm_base)) { -+ ret = PTR_ERR(qspi->mm_base); -+ goto probe_master_put; -+ } -+ -+ qspi->mm_size = resource_size(res); -+ if (qspi->mm_size > PHYTIUM_QSPI_MAX_MMAP_SZ) { -+ ret = -EINVAL; -+ goto probe_master_put; -+ } -+ qspi->used_size = 0; -+ -+ if (dev->of_node) { -+ qspi->clk = devm_clk_get(dev, NULL); -+ if (IS_ERR(qspi->clk)) { -+ ret = PTR_ERR(qspi->clk); -+ goto probe_master_put; -+ } -+ -+ qspi->clk_rate = clk_get_rate(qspi->clk); -+ if (!qspi->clk_rate) { -+ ret = -EINVAL; -+ goto probe_master_put; -+ } -+ -+ pm_runtime_enable(dev); -+ ret = pm_runtime_get_sync(dev); -+ if (ret < 0) { -+ pm_runtime_put_noidle(dev); -+ goto probe_master_put; -+ } -+ -+ ret = clk_prepare_enable(qspi->clk); -+ if (ret) { -+ dev_err(dev, "Failed to enable PCLK of the controller.\n"); -+ goto probe_clk_failed; -+ } -+ } else if (has_acpi_companion(dev)) { -+ qspi->clk_rate = 50000000; -+ } -+ qspi->nodirmap = device_property_present(dev, "no-direct-mapping"); -+ ctrl->mem_ops = qspi->nodirmap ? -+ &phytium_qspi_mem_ops_nodirmap : -+ &phytium_qspi_mem_ops; -+ -+ qspi->dev = dev; -+ platform_set_drvdata(pdev, qspi); -+ -+ ret = devm_spi_register_controller(dev, ctrl); -+ if (ret) { -+ dev_err(dev, "failed to register SPI controller: %d\n", ret); -+ goto probe_setup_failed; -+ } -+ -+ if (!qspi->nodirmap) { -+ /* -+ * The controller supports direct mapping access only if all -+ * flashes are of same size. -+ */ -+ -+ i = 0; -+ for (i = 0; qspi->fnum > i && i < PHYTIUM_QSPI_MAX_NORCHIP; i++) { -+ if (qspi->flash[i].spi) { -+ mem = spi_get_drvdata(qspi->flash[i].spi); -+ if (mem) { -+ nor = spi_mem_get_drvdata(mem); -+ if (nor) -+ qspi->flash[i].size = nor->mtd.size; -+ } -+ } -+ } -+ -+ for (i = 1; qspi->fnum > i && i < PHYTIUM_QSPI_MAX_NORCHIP; i++) { -+ if (qspi->flash[i].size != qspi->flash[0].size) { -+ dev_err(dev, "Flashes are of different sizes.\n"); -+ ret = -EINVAL; -+ goto probe_setup_failed; -+ } -+ } -+ -+ ret = phytium_qspi_flash_capacity_encode(qspi->flash[0].size, -+ &qspi->flash_cap); -+ if (ret) { -+ dev_err(dev, "Flash size is invalid.\n"); -+ goto probe_setup_failed; -+ } -+ -+ qspi->flash_cap |= qspi->fnum << QSPI_FLASH_CAP_NUM_SHIFT; -+ -+ writel_relaxed(qspi->flash_cap, qspi->io_base + QSPI_FLASH_CAP_REG); -+ } -+ -+ return 0; -+ -+probe_setup_failed: -+ clk_disable_unprepare(qspi->clk); -+probe_clk_failed: -+ pm_runtime_put_sync(dev); -+ pm_runtime_disable(dev); -+probe_master_put: -+ -+ return ret; -+} -+ -+/** -+ * phytium_qspi_remove - Remove method for the QSPI driver -+ * @pdev: Pointer to the platform_device structure -+ * -+ * This function is called if a device is physically removed from the system -+ * or if the driver module is being unloaded. It free all resources allocated -+ * to the device. -+ * -+ * Return: 0 on success and error value on failure -+ */ -+static int phytium_qspi_remove(struct platform_device *pdev) -+{ -+ struct phytium_qspi *qspi = platform_get_drvdata(pdev); -+ -+ clk_disable_unprepare(qspi->clk); -+ -+ pm_runtime_put_sync(&pdev->dev); -+ pm_runtime_disable(&pdev->dev); -+ -+ return 0; -+} -+ -+static int __maybe_unused phytium_qspi_suspend(struct device *dev) -+{ -+ return pm_runtime_force_suspend(dev); -+} -+ -+static int __maybe_unused phytium_qspi_resume(struct device *dev) -+{ -+ struct phytium_qspi *qspi = dev_get_drvdata(dev); -+ -+ /* set rd_cfg reg and flash_capacity reg after resume */ -+ writel_relaxed(qspi->rd_cfg_reg, qspi->io_base + QSPI_RD_CFG_REG); -+ writel_relaxed(qspi->flash_cap, qspi->io_base + QSPI_FLASH_CAP_REG); -+ return pm_runtime_force_resume(dev); -+} -+ -+static const struct dev_pm_ops phytium_qspi_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_qspi_suspend, -+ phytium_qspi_resume) -+}; -+ -+static const struct of_device_id phytium_qspi_of_match[] = { -+ { .compatible = "phytium,qspi-nor" }, -+ { } -+}; -+static const struct acpi_device_id phytium_qspi_acpi_match[] = { -+ { "PHYT0011", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_qspi_of_match); -+MODULE_DEVICE_TABLE(acpi, phytium_qspi_acpi_match); -+ -+static struct platform_driver phytium_qspi_driver = { -+ .probe = phytium_qspi_probe, -+ .remove = phytium_qspi_remove, -+ .driver = { -+ .name = "phytium-qspi", -+ .of_match_table = of_match_ptr(phytium_qspi_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_qspi_acpi_match), -+ .pm = &phytium_qspi_pm_ops, -+ }, -+}; -+module_platform_driver(phytium_qspi_driver); -+ -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium Quad SPI driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/spi/spi-phytium.c b/drivers/spi/spi-phytium.c -new file mode 100644 -index 000000000..131baeacd ---- /dev/null -+++ b/drivers/spi/spi-phytium.c -@@ -0,0 +1,501 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium SPI core controller driver. -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from drivers/spi/spi-dw.c -+ * Copyright (c) 2009, Intel Corporation. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "spi-phytium.h" -+ -+struct phytium_spi_chip { -+ u8 poll_mode; -+ u8 type; -+ void (*cs_control)(u32 command); -+}; -+ -+struct chip_data { -+ u8 cs; -+ u8 tmode; -+ u8 type; -+ -+ u8 poll_mode; -+ -+ u16 clk_div; -+ u32 speed_hz; -+ void (*cs_control)(u32 command); -+}; -+ -+static void phytium_spi_set_cs(struct spi_device *spi, bool enable) -+{ -+ struct phytium_spi *fts = spi_master_get_devdata(spi->master); -+ struct chip_data *chip = spi_get_ctldata(spi); -+ u32 origin; -+ -+ if (chip && chip->cs_control) -+ chip->cs_control(!enable); -+ -+ if (!enable) { -+ phytium_writel(fts, SER, BIT(spi->chip_select)); -+ if (fts->global_cs) { -+ origin = phytium_readl(fts, GCSR); -+ phytium_writel(fts, GCSR, origin | (1 << spi->chip_select)); -+ } -+ } else { -+ if (fts->global_cs) { -+ origin = phytium_readl(fts, GCSR); -+ phytium_writel(fts, GCSR, origin & ~(1 << spi->chip_select)); -+ } -+ } -+} -+ -+static inline u32 tx_max(struct phytium_spi *fts) -+{ -+ u32 tx_left, tx_room, rxtx_gap; -+ -+ tx_left = (fts->tx_end - fts->tx) / fts->n_bytes; -+ tx_room = fts->fifo_len - phytium_readl(fts, TXFLR); -+ -+ rxtx_gap = ((fts->rx_end - fts->rx) - (fts->tx_end - fts->tx)) -+ / fts->n_bytes; -+ -+ return min3(tx_left, tx_room, (u32) (fts->fifo_len - rxtx_gap)); -+} -+ -+static inline u32 rx_max(struct phytium_spi *fts) -+{ -+ u32 rx_left = (fts->rx_end - fts->rx) / fts->n_bytes; -+ -+ return min_t(u32, rx_left, phytium_readl(fts, RXFLR)); -+} -+ -+static void phytium_writer(struct phytium_spi *fts) -+{ -+ u32 max = tx_max(fts); -+ u16 txw = 0; -+ -+ while (max--) { -+ if (fts->tx_end - fts->len) { -+ if (fts->n_bytes == 1) -+ txw = *(u8 *)(fts->tx); -+ else -+ txw = *(u16 *)(fts->tx); -+ } -+ phytium_write_io_reg(fts, DR, txw); -+ fts->tx += fts->n_bytes; -+ } -+} -+ -+static void phytium_reader(struct phytium_spi *fts) -+{ -+ u32 max = rx_max(fts); -+ u16 rxw; -+ -+ while (max--) { -+ rxw = phytium_read_io_reg(fts, DR); -+ if (fts->rx_end - fts->len) { -+ if (fts->n_bytes == 1) -+ *(u8 *)(fts->rx) = rxw; -+ else -+ *(u16 *)(fts->rx) = rxw; -+ } -+ fts->rx += fts->n_bytes; -+ } -+} -+int phytium_spi_check_status(struct phytium_spi *fts, bool raw) -+{ -+ u32 irq_status; -+ int ret = 0; -+ -+ if (raw) -+ irq_status = phytium_readl(fts, RISR); -+ else -+ irq_status = phytium_readl(fts, ISR); -+ -+ if (irq_status & INT_RXOI) { -+ dev_err(&fts->master->dev, "RX FIFO overflow detected\n"); -+ ret = -EIO; -+ } -+ -+ if (irq_status & INT_RXUI) { -+ dev_err(&fts->master->dev, "RX FIFO underflow detected\n"); -+ ret = -EIO; -+ } -+ -+ if (irq_status & INT_TXOI) { -+ dev_err(&fts->master->dev, "TX FIFO overflow detected\n"); -+ ret = -EIO; -+ } -+ -+ /* Generically handle the erroneous situation */ -+ if (ret) { -+ spi_reset_chip(fts); -+ if (fts->master->cur_msg) -+ fts->master->cur_msg->status = ret; -+ } -+ return ret; -+} -+EXPORT_SYMBOL_GPL(phytium_spi_check_status); -+ -+static void int_error_stop(struct phytium_spi *fts, const char *msg) -+{ -+ spi_reset_chip(fts); -+ -+ dev_err(&fts->master->dev, "%s\n", msg); -+ fts->master->cur_msg->status = -EIO; -+ spi_finalize_current_transfer(fts->master); -+} -+ -+static irqreturn_t interrupt_transfer(struct phytium_spi *fts) -+{ -+ u16 irq_status = phytium_readl(fts, ISR); -+ -+ if (irq_status & (INT_TXOI | INT_RXOI | INT_RXUI)) { -+ phytium_readl(fts, ICR); -+ int_error_stop(fts, "irq transfer: fifo overrun/underrun"); -+ return IRQ_HANDLED; -+ } -+ -+ phytium_reader(fts); -+ if (fts->rx_end == fts->rx) { -+ spi_mask_intr(fts, INT_TXEI); -+ spi_finalize_current_transfer(fts->master); -+ return IRQ_HANDLED; -+ } -+ if (irq_status & INT_TXEI) { -+ spi_mask_intr(fts, INT_TXEI); -+ phytium_writer(fts); -+ spi_umask_intr(fts, INT_TXEI); -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static irqreturn_t phytium_spi_irq(int irq, void *dev_id) -+{ -+ struct spi_master *master = dev_id; -+ struct phytium_spi *fts = spi_master_get_devdata(master); -+ u16 irq_status = phytium_readl(fts, ISR) & 0x3f; -+ -+ if (!irq_status) -+ return IRQ_NONE; -+ -+ if (!master->cur_msg) { -+ spi_mask_intr(fts, INT_TXEI); -+ return IRQ_HANDLED; -+ } -+ -+ if (fts->transfer_handler) -+ return fts->transfer_handler(fts); -+ else -+ return IRQ_HANDLED; -+} -+ -+static int poll_transfer(struct phytium_spi *fts) -+{ -+ do { -+ phytium_writer(fts); -+ phytium_reader(fts); -+ cpu_relax(); -+ } while (fts->rx_end > fts->rx); -+ -+ return 0; -+} -+ -+static int phytium_spi_transfer_one(struct spi_master *master, -+ struct spi_device *spi, struct spi_transfer *transfer) -+{ -+ struct phytium_spi *fts = spi_master_get_devdata(master); -+ struct chip_data *chip = spi_get_ctldata(spi); -+ u8 imask = 0; -+ u16 txlevel = 0; -+ u16 clk_div; -+ u32 cr0; -+ int ret = 0; -+ -+ fts->dma_mapped = 0; -+ fts->tx = (void *)transfer->tx_buf; -+ fts->tx_end = fts->tx + transfer->len; -+ fts->rx = transfer->rx_buf; -+ fts->rx_end = fts->rx + transfer->len; -+ fts->len = transfer->len; -+ -+ spi_enable_chip(fts, 0); -+ -+ if (transfer->speed_hz != fts->current_freq) { -+ if (transfer->speed_hz != chip->speed_hz) { -+ clk_div = (fts->max_freq / transfer->speed_hz + 1) & -+ 0xfffe; -+ -+ chip->speed_hz = transfer->speed_hz; -+ chip->clk_div = clk_div; -+ } -+ fts->current_freq = transfer->speed_hz; -+ spi_set_clk(fts, chip->clk_div); -+ } -+ -+ if (transfer->bits_per_word == 8) -+ fts->n_bytes = 1; -+ else if (transfer->bits_per_word == 16) -+ fts->n_bytes = 2; -+ else -+ return -EINVAL; -+ -+ cr0 = (transfer->bits_per_word - 1) -+ | (chip->type << FRF_OFFSET) -+ | (spi->mode << MODE_OFFSET) -+ | (chip->tmode << TMOD_OFFSET); -+ -+ if (chip->cs_control) { -+ if (fts->rx && fts->tx) -+ chip->tmode = TMOD_TR; -+ else if (fts->rx) -+ chip->tmode = TMOD_RO; -+ else -+ chip->tmode = TMOD_TO; -+ -+ cr0 &= ~TMOD_MASK; -+ cr0 |= (chip->tmode << TMOD_OFFSET); -+ } -+ -+ phytium_writel(fts, CTRLR0, cr0); -+ -+ /* check if current transfer is a DMA transcation */ -+ if (master->can_dma && master->can_dma(master, spi, transfer)) -+ fts->dma_mapped = master->cur_msg_mapped; -+ -+ spi_mask_intr(fts, 0xff); -+ -+ /* DMA setup */ -+ if (fts->dma_mapped) { -+ ret = fts->dma_ops->dma_setup(fts, transfer); -+ if (ret) -+ return ret; -+ } -+ /* interrupt transfer mode setup */ -+ if (!chip->poll_mode && !fts->dma_mapped) { -+ txlevel = min_t(u16, fts->fifo_len / 2, fts->len / fts->n_bytes); -+ phytium_writel(fts, TXFLTR, txlevel); -+ -+ imask |= INT_TXEI | INT_TXOI | -+ INT_RXUI | INT_RXOI; -+ spi_umask_intr(fts, imask); -+ -+ fts->transfer_handler = interrupt_transfer; -+ } -+ -+ spi_enable_chip(fts, 1); -+ -+ if (fts->dma_mapped) -+ return fts->dma_ops->dma_transfer(fts, transfer); -+ -+ if (chip->poll_mode) -+ return poll_transfer(fts); -+ -+ return 1; -+} -+ -+static void phytium_spi_handle_err(struct spi_master *master, -+ struct spi_message *msg) -+{ -+ struct phytium_spi *fts = spi_master_get_devdata(master); -+ -+ if (fts->dma_mapped) -+ fts->dma_ops->dma_stop(fts); -+ -+ spi_reset_chip(fts); -+} -+ -+static int phytium_spi_setup(struct spi_device *spi) -+{ -+ struct phytium_spi_chip *chip_info = NULL; -+ struct chip_data *chip; -+ struct spi_master *master = spi->master; -+ struct phytium_spi *fts = spi_master_get_devdata(master); -+ u32 cr0; -+ -+ spi_enable_chip(fts, 0); -+ -+ chip = spi_get_ctldata(spi); -+ if (!chip) { -+ chip = kzalloc(sizeof(struct chip_data), GFP_KERNEL); -+ if (!chip) -+ return -ENOMEM; -+ spi_set_ctldata(spi, chip); -+ } -+ -+ chip_info = spi->controller_data; -+ -+ if (chip_info) { -+ if (chip_info->cs_control) -+ chip->cs_control = chip_info->cs_control; -+ -+ chip->poll_mode = chip_info->poll_mode; -+ chip->type = chip_info->type; -+ } -+ -+ chip->tmode = 0; -+ -+ cr0 = (spi->bits_per_word - 1) | (chip->type << FRF_OFFSET) | -+ (spi->mode << MODE_OFFSET) | (chip->tmode << TMOD_OFFSET); -+ -+ phytium_writel(fts, CTRLR0, cr0); -+ -+ spi_enable_chip(fts, 1); -+ -+ return 0; -+} -+ -+static void phytium_spi_cleanup(struct spi_device *spi) -+{ -+ struct chip_data *chip = spi_get_ctldata(spi); -+ -+ kfree(chip); -+ spi_set_ctldata(spi, NULL); -+} -+ -+static void spi_hw_init(struct device *dev, struct phytium_spi *fts) -+{ -+ spi_reset_chip(fts); -+ -+ if (!fts->fifo_len) { -+ u32 fifo; -+ -+ for (fifo = 1; fifo < 256; fifo++) { -+ phytium_writel(fts, TXFLTR, fifo); -+ if (fifo != phytium_readl(fts, TXFLTR)) -+ break; -+ } -+ phytium_writel(fts, TXFLTR, 0); -+ -+ fts->fifo_len = (fifo == 1) ? 0 : fifo; -+ dev_dbg(dev, "Detected FIFO size: %u bytes\n", fts->fifo_len); -+ } -+} -+ -+int phytium_spi_add_host(struct device *dev, struct phytium_spi *fts) -+{ -+ struct spi_master *master; -+ int ret; -+ -+ WARN_ON(fts == NULL); -+ -+ master = spi_alloc_master(dev, 0); -+ if (!master) -+ return -ENOMEM; -+ -+ fts->master = master; -+ fts->dma_addr = (dma_addr_t)(fts->paddr + DR); -+ snprintf(fts->name, sizeof(fts->name), "phytium_spi%d", fts->bus_num); -+ -+ spi_hw_init(dev, fts); -+ -+ ret = request_irq(fts->irq, phytium_spi_irq, IRQF_SHARED, fts->name, master); -+ if (ret < 0) { -+ dev_err(dev, "can not get IRQ\n"); -+ goto err_free_master; -+ } -+ -+ master->use_gpio_descriptors = true; -+ master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_LOOP; -+ master->bits_per_word_mask = SPI_BPW_MASK(8) | SPI_BPW_MASK(16); -+ master->bus_num = fts->bus_num; -+ master->num_chipselect = fts->num_cs; -+ master->setup = phytium_spi_setup; -+ master->cleanup = phytium_spi_cleanup; -+ master->set_cs = phytium_spi_set_cs; -+ master->transfer_one = phytium_spi_transfer_one; -+ master->handle_err = phytium_spi_handle_err; -+ master->max_speed_hz = fts->max_freq; -+ master->dev.of_node = dev->of_node; -+ master->dev.fwnode = dev->fwnode; -+ master->flags = SPI_CONTROLLER_GPIO_SS; -+ -+ if (fts->dma_ops && fts->dma_ops->dma_init) { -+ ret = fts->dma_ops->dma_init(dev, fts); -+ if (ret) { -+ dev_warn(dev, "DMA init failed\n"); -+ } else { -+ master->can_dma = fts->dma_ops->can_dma; -+ master->flags |= SPI_CONTROLLER_MUST_TX; -+ } -+ } -+ -+ spi_master_set_devdata(master, fts); -+ ret = spi_register_controller(master); -+ if (ret) { -+ dev_err(&master->dev, "problem registering spi master\n"); -+ goto err_exit; -+ } -+ -+ return 0; -+ -+err_exit: -+ if (fts->dma_ops && fts->dma_ops->dma_exit) -+ fts->dma_ops->dma_exit(fts); -+ spi_enable_chip(fts, 0); -+ free_irq(fts->irq, master); -+err_free_master: -+ spi_master_put(master); -+ return ret; -+} -+EXPORT_SYMBOL_GPL(phytium_spi_add_host); -+ -+void phytium_spi_remove_host(struct phytium_spi *fts) -+{ -+ if (fts->dma_ops && fts->dma_ops->dma_exit) -+ fts->dma_ops->dma_exit(fts); -+ spi_shutdown_chip(fts); -+ -+ spi_unregister_controller(fts->master); -+ -+ free_irq(fts->irq, fts->master); -+} -+EXPORT_SYMBOL_GPL(phytium_spi_remove_host); -+ -+int phytium_spi_suspend_host(struct phytium_spi *fts) -+{ -+ int ret; -+ -+ ret = spi_controller_suspend(fts->master); -+ if (ret) -+ return ret; -+ -+ spi_shutdown_chip(fts); -+ return 0; -+} -+EXPORT_SYMBOL_GPL(phytium_spi_suspend_host); -+ -+int phytium_spi_resume_host(struct phytium_spi *fts) -+{ -+ int ret; -+ -+ spi_hw_init(&fts->master->dev, fts); -+ ret = spi_controller_resume(fts->master); -+ if (ret) -+ dev_err(&fts->master->dev, "fail to start queue (%d)\n", ret); -+ return ret; -+} -+EXPORT_SYMBOL_GPL(phytium_spi_resume_host); -+ -+MODULE_AUTHOR("Zhu Mingshuai "); -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Driver for Phytium SPI controller core"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/spi/spi-phytium.h b/drivers/spi/spi-phytium.h -new file mode 100644 -index 000000000..781a4fae5 ---- /dev/null -+++ b/drivers/spi/spi-phytium.h -@@ -0,0 +1,197 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Phytium SPI controller driver. -+ * -+ * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. -+ */ -+#ifndef PHYTIUM_SPI_HEADER_H -+#define PHYTIUM_SPI_HEADER_H -+ -+#include -+#include -+#include -+ -+#define CTRLR0 0x00 -+#define SSIENR 0x08 -+#define SER 0x10 -+#define BAUDR 0x14 -+#define TXFLTR 0x18 -+#define TXFLR 0x20 -+#define RXFLR 0x24 -+#define SR 0x28 -+#define IMR 0x2c -+#define ISR 0x30 -+#define RISR 0x34 -+#define ICR 0x48 -+#define DMACR 0x4C -+#define DMATDLR 0x50 -+#define DMARDLR 0x54 -+#define DR 0x60 -+#define GCSR 0x100 -+ -+#define FRF_OFFSET 4 -+#define MODE_OFFSET 6 -+#define TMOD_OFFSET 8 -+ -+#define TMOD_MASK (0x3 << TMOD_OFFSET) -+#define TMOD_TR 0x0 -+#define TMOD_TO 0x1 -+#define TMOD_RO 0x2 -+ -+#define INT_TXEI (1 << 0) -+#define INT_TXOI (1 << 1) -+#define INT_RXUI (1 << 2) -+#define INT_RXOI (1 << 3) -+/* Bit fields in SR, 7 bits */ -+#define SR_MASK 0x7f /* cover 7 bits */ -+#define SR_BUSY (1 << 0) -+#define SR_TF_NOT_FULL (1 << 1) -+#define SR_TF_EMPT (1 << 2) -+#define SR_RF_NOT_EMPT (1 << 3) -+#define SR_RF_FULL (1 << 4) -+#define SR_TX_ERR (1 << 5) -+#define SR_DCOL (1 << 6) -+/* Bit fields in DMACR */ -+#define SPI_DMA_RDMAE (1 << 0) -+#define SPI_DMA_TDMAE (1 << 1) -+#define SPI_WAIT_RETRIES 5 -+struct phytium_spi; -+struct phytium_spi_dma_ops { -+ int (*dma_init)(struct device *dev, struct phytium_spi *fts); -+ void (*dma_exit)(struct phytium_spi *fts); -+ int (*dma_setup)(struct phytium_spi *fts, struct spi_transfer *xfer); -+ bool (*can_dma)(struct spi_controller *master, struct spi_device *spi, -+ struct spi_transfer *xfer); -+ int (*dma_transfer)(struct phytium_spi *fts, struct spi_transfer *xfer); -+ void (*dma_stop)(struct phytium_spi *fts); -+}; -+ -+struct phytium_spi { -+ struct spi_master *master; -+ char name[16]; -+ -+ void __iomem *regs; -+ bool global_cs; -+ bool dma_en; -+ unsigned long paddr; -+ int irq; -+ u32 fifo_len; -+ u32 max_freq; -+ -+ u32 reg_io_width; -+ u16 bus_num; -+ u16 num_cs; -+ int *cs; -+ -+ size_t len; -+ void *tx; -+ void *tx_end; -+ void *rx; -+ void *rx_end; -+ u8 n_bytes; -+ int dma_mapped; -+ irqreturn_t (*transfer_handler)(struct phytium_spi *fts); -+ /* DMA info */ -+ u32 current_freq; /* frequency in hz */ -+ struct dma_chan *txchan; -+ u32 txburst; -+ struct dma_chan *rxchan; -+ u32 rxburst; -+ u32 dma_sg_burst; -+ unsigned long dma_chan_busy; -+ dma_addr_t dma_addr; /* phy address of the Data register */ -+ const struct phytium_spi_dma_ops *dma_ops; -+ struct completion dma_completion; -+}; -+ -+static inline u32 phytium_readl(struct phytium_spi *fts, u32 offset) -+{ -+ return __raw_readl(fts->regs + offset); -+} -+static inline u16 phytium_readw(struct phytium_spi *fts, u32 offset) -+{ -+ return __raw_readw(fts->regs + offset); -+} -+static inline void phytium_writel(struct phytium_spi *fts, u32 offset, u32 val) -+{ -+ __raw_writel(val, fts->regs + offset); -+} -+static inline void phytium_writew(struct phytium_spi *fts, u32 offset, u16 val) -+{ -+ __raw_writew(val, fts->regs + offset); -+} -+static inline u32 phytium_read_io_reg(struct phytium_spi *fts, u32 offset) -+{ -+ switch (fts->reg_io_width) { -+ case 2: -+ return phytium_readw(fts, offset); -+ case 4: -+ default: -+ return phytium_readl(fts, offset); -+ } -+} -+static inline void phytium_write_io_reg(struct phytium_spi *fts, -+ u32 offset, u32 val) -+{ -+ switch (fts->reg_io_width) { -+ case 2: -+ phytium_writew(fts, offset, val); -+ break; -+ case 4: -+ default: -+ phytium_writel(fts, offset, val); -+ break; -+ } -+} -+static inline void spi_enable_chip(struct phytium_spi *fts, int enable) -+{ -+ phytium_writel(fts, SSIENR, (enable ? 1 : 0)); -+} -+static inline void spi_set_clk(struct phytium_spi *fts, u16 div) -+{ -+ phytium_writel(fts, BAUDR, div); -+} -+static inline void spi_mask_intr(struct phytium_spi *fts, u32 mask) -+{ -+ u32 new_mask; -+ -+ new_mask = phytium_readl(fts, IMR) & ~mask; -+ phytium_writel(fts, IMR, new_mask); -+} -+static inline void spi_umask_intr(struct phytium_spi *fts, u32 mask) -+{ -+ u32 new_mask; -+ -+ new_mask = phytium_readl(fts, IMR) | mask; -+ phytium_writel(fts, IMR, new_mask); -+} -+static inline void spi_global_cs(struct phytium_spi *fts) -+{ -+ u32 global_cs_en, mask, setmask; -+ -+ mask = GENMASK(fts->num_cs-1, 0) << fts->num_cs; -+ setmask = ~GENMASK(fts->num_cs-1, 0); -+ global_cs_en = (phytium_readl(fts, GCSR) | mask) & setmask; -+ phytium_writel(fts, GCSR, global_cs_en); -+} -+static inline void spi_reset_chip(struct phytium_spi *fts) -+{ -+ spi_enable_chip(fts, 0); -+ if (fts->global_cs) -+ spi_global_cs(fts); -+ spi_mask_intr(fts, 0xff); -+ spi_enable_chip(fts, 1); -+} -+static inline void spi_shutdown_chip(struct phytium_spi *fts) -+{ -+ spi_enable_chip(fts, 0); -+ spi_set_clk(fts, 0); -+ fts->current_freq = 0; -+} -+extern int phytium_spi_add_host(struct device *dev, struct phytium_spi *fts); -+extern void phytium_spi_remove_host(struct phytium_spi *fts); -+extern int phytium_spi_suspend_host(struct phytium_spi *fts); -+extern int phytium_spi_resume_host(struct phytium_spi *fts); -+extern void phytium_spi_dmaops_set(struct phytium_spi *fts); -+extern int phytium_spi_check_status(struct phytium_spi *fts, bool raw); -+#endif /* PHYTIUM_SPI_HEADER_H */ -diff --git a/drivers/staging/Kconfig b/drivers/staging/Kconfig -index 5dc634897..c86417920 100644 ---- a/drivers/staging/Kconfig -+++ b/drivers/staging/Kconfig -@@ -87,4 +87,6 @@ source "drivers/staging/hisysevent/Kconfig" - source "drivers/staging/zerohung/Kconfig" - - source "drivers/staging/hungtask/Kconfig" -+ -+source "drivers/staging/android/Kconfig" - endif # STAGING -diff --git a/drivers/staging/Makefile b/drivers/staging/Makefile -index aec6e94a3..e37614535 100644 ---- a/drivers/staging/Makefile -+++ b/drivers/staging/Makefile -@@ -33,3 +33,4 @@ obj-$(CONFIG_HIEVENT) += hievent/ - obj-$(CONFIG_HISYSEVENT) += hisysevent/ - obj-$(CONFIG_DFX_ZEROHUNG) += zerohung/ - obj-$(CONFIG_DFX_HUNGTASK) += hungtask/ -+obj-$(CONFIG_ANDROID) += android/ -diff --git a/drivers/staging/android/Kconfig b/drivers/staging/android/Kconfig -new file mode 100644 -index 000000000..8d8fd5c29 ---- /dev/null -+++ b/drivers/staging/android/Kconfig -@@ -0,0 +1,21 @@ -+# SPDX-License-Identifier: GPL-2.0 -+menu "Android" -+ -+if ANDROID -+ -+config ASHMEM -+ bool "Enable the Anonymous Shared Memory Subsystem" -+ depends on SHMEM -+ help -+ The ashmem subsystem is a new shared memory allocator, similar to -+ POSIX SHM but with different behavior and sporting a simpler -+ file-based API. -+ -+ It is, in theory, a good memory allocator for low-memory devices, -+ because it can discard shared memory units when under memory pressure. -+ -+source "drivers/staging/android/ion/Kconfig" -+ -+endif # if ANDROID -+ -+endmenu -diff --git a/drivers/staging/android/Makefile b/drivers/staging/android/Makefile -new file mode 100644 -index 000000000..3b66cd0b0 ---- /dev/null -+++ b/drivers/staging/android/Makefile -@@ -0,0 +1,6 @@ -+# SPDX-License-Identifier: GPL-2.0 -+ccflags-y += -I$(src) # needed for trace events -+ -+obj-y += ion/ -+ -+obj-$(CONFIG_ASHMEM) += ashmem.o -diff --git a/drivers/staging/android/TODO b/drivers/staging/android/TODO -new file mode 100644 -index 000000000..80eccfaf6 ---- /dev/null -+++ b/drivers/staging/android/TODO -@@ -0,0 +1,13 @@ -+TODO: -+ - sparse fixes -+ - rename files to be not so "generic" -+ - add proper arch dependencies as needed -+ - audit userspace interfaces to make sure they are sane -+ -+ -+ion/ -+ - Split /dev/ion up into multiple nodes (e.g. /dev/ion/heap0) -+ - Better test framework (integration with VGEM was suggested) -+ -+Please send patches to Greg Kroah-Hartman and Cc: -+Arve Hjønnevåg and Riley Andrews -diff --git a/drivers/staging/android/ashmem.c b/drivers/staging/android/ashmem.c -new file mode 100644 -index 000000000..a1d11cc23 ---- /dev/null -+++ b/drivers/staging/android/ashmem.c -@@ -0,0 +1,1192 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* mm/ashmem.c -+ * -+ * Anonymous Shared Memory Subsystem, ashmem -+ * -+ * Copyright (C) 2008 Google, Inc. -+ * -+ * Robert Love -+ */ -+ -+#define pr_fmt(fmt) "ashmem: " fmt -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "ashmem.h" -+ -+#define ASHMEM_NAME_PREFIX "dev/ashmem/" -+#define ASHMEM_NAME_PREFIX_LEN (sizeof(ASHMEM_NAME_PREFIX) - 1) -+#define ASHMEM_FULL_NAME_LEN (ASHMEM_NAME_LEN + ASHMEM_NAME_PREFIX_LEN) -+ -+#ifdef CONFIG_PURGEABLE_ASHMEM -+#define PURGEABLE_ASHMEM_INIT_REFCOUNT 1 -+#define PURGEABLE_ASHMEM_UNPIN_REFCOUNT 0 -+#define PURGEABLE_ASHMEM_PIN_OFFSET 0 -+#define PURGEABLE_ASHMEM_PIN_LEN 0 -+#endif -+ -+/** -+ * struct ashmem_area - The anonymous shared memory area -+ * @name: The optional name in /proc/pid/maps -+ * @unpinned_list: The list of all ashmem areas -+ * @file: The shmem-based backing file -+ * @size: The size of the mapping, in bytes -+ * @prot_mask: The allowed protection bits, as vm_flags -+ * -+ * The lifecycle of this structure is from our parent file's open() until -+ * its release(). It is also protected by 'ashmem_mutex' -+ * -+ * Warning: Mappings do NOT pin this structure; It dies on close() -+ */ -+struct ashmem_area { -+ char name[ASHMEM_FULL_NAME_LEN]; -+ struct list_head unpinned_list; -+ struct file *file; -+ size_t size; -+ unsigned long prot_mask; -+#ifdef CONFIG_PURGEABLE_ASHMEM -+ bool is_purgeable; -+ bool purged; -+ unsigned int id; -+ unsigned int create_time; -+ int ref_count; -+#endif -+}; -+ -+/** -+ * struct ashmem_range - A range of unpinned/evictable pages -+ * @lru: The entry in the LRU list -+ * @unpinned: The entry in its area's unpinned list -+ * @asma: The associated anonymous shared memory area. -+ * @pgstart: The starting page (inclusive) -+ * @pgend: The ending page (inclusive) -+ * @purged: The purge status (ASHMEM_NOT or ASHMEM_WAS_PURGED) -+ * -+ * The lifecycle of this structure is from unpin to pin. -+ * It is protected by 'ashmem_mutex' -+ */ -+struct ashmem_range { -+ struct list_head lru; -+ struct list_head unpinned; -+ struct ashmem_area *asma; -+ size_t pgstart; -+ size_t pgend; -+ unsigned int purged; -+}; -+ -+/* LRU list of unpinned pages, protected by ashmem_mutex */ -+static LIST_HEAD(ashmem_lru_list); -+ -+static atomic_t ashmem_shrink_inflight = ATOMIC_INIT(0); -+static DECLARE_WAIT_QUEUE_HEAD(ashmem_shrink_wait); -+ -+/* -+ * long lru_count - The count of pages on our LRU list. -+ * -+ * This is protected by ashmem_mutex. -+ */ -+static unsigned long lru_count; -+ -+/* -+ * ashmem_mutex - protects the list of and each individual ashmem_area -+ * -+ * Lock Ordering: ashmex_mutex -> i_mutex -> i_alloc_sem -+ */ -+static DEFINE_MUTEX(ashmem_mutex); -+ -+static struct kmem_cache *ashmem_area_cachep __read_mostly; -+static struct kmem_cache *ashmem_range_cachep __read_mostly; -+ -+/* -+ * A separate lockdep class for the backing shmem inodes to resolve the lockdep -+ * warning about the race between kswapd taking fs_reclaim before inode_lock -+ * and write syscall taking inode_lock and then fs_reclaim. -+ * Note that such race is impossible because ashmem does not support write -+ * syscalls operating on the backing shmem. -+ */ -+static struct lock_class_key backing_shmem_inode_class; -+ -+void ashmem_mutex_lock(void) -+{ -+ mutex_lock(&ashmem_mutex); -+} -+ -+void ashmem_mutex_unlock(void) -+{ -+ mutex_unlock(&ashmem_mutex); -+} -+ -+static inline unsigned long range_size(struct ashmem_range *range) -+{ -+ return range->pgend - range->pgstart + 1; -+} -+ -+static inline bool range_on_lru(struct ashmem_range *range) -+{ -+ return range->purged == ASHMEM_NOT_PURGED; -+} -+ -+static inline bool page_range_subsumes_range(struct ashmem_range *range, -+ size_t start, size_t end) -+{ -+ return (range->pgstart >= start) && (range->pgend <= end); -+} -+ -+static inline bool page_range_subsumed_by_range(struct ashmem_range *range, -+ size_t start, size_t end) -+{ -+ return (range->pgstart <= start) && (range->pgend >= end); -+} -+ -+static inline bool page_in_range(struct ashmem_range *range, size_t page) -+{ -+ return (range->pgstart <= page) && (range->pgend >= page); -+} -+ -+static inline bool page_range_in_range(struct ashmem_range *range, -+ size_t start, size_t end) -+{ -+ return page_in_range(range, start) || page_in_range(range, end) || -+ page_range_subsumes_range(range, start, end); -+} -+ -+static inline bool range_before_page(struct ashmem_range *range, -+ size_t page) -+{ -+ return range->pgend < page; -+} -+ -+#ifdef CONFIG_PURGEABLE_ASHMEM -+static inline bool is_purgeable_ashmem(const struct ashmem_area *asma) -+{ -+ return (asma && asma->is_purgeable); -+} -+#endif -+#define PROT_MASK (PROT_EXEC | PROT_READ | PROT_WRITE) -+ -+/** -+ * lru_add() - Adds a range of memory to the LRU list -+ * @range: The memory range being added. -+ * -+ * The range is first added to the end (tail) of the LRU list. -+ * After this, the size of the range is added to @lru_count -+ */ -+static inline void lru_add(struct ashmem_range *range) -+{ -+ list_add_tail(&range->lru, &ashmem_lru_list); -+ lru_count += range_size(range); -+} -+ -+/** -+ * lru_del() - Removes a range of memory from the LRU list -+ * @range: The memory range being removed -+ * -+ * The range is first deleted from the LRU list. -+ * After this, the size of the range is removed from @lru_count -+ */ -+static inline void lru_del(struct ashmem_range *range) -+{ -+ list_del(&range->lru); -+ lru_count -= range_size(range); -+} -+ -+/** -+ * range_alloc() - Allocates and initializes a new ashmem_range structure -+ * @asma: The associated ashmem_area -+ * @prev_range: The previous ashmem_range in the sorted asma->unpinned list -+ * @purged: Initial purge status (ASMEM_NOT_PURGED or ASHMEM_WAS_PURGED) -+ * @start: The starting page (inclusive) -+ * @end: The ending page (inclusive) -+ * -+ * This function is protected by ashmem_mutex. -+ */ -+static void range_alloc(struct ashmem_area *asma, -+ struct ashmem_range *prev_range, unsigned int purged, -+ size_t start, size_t end, -+ struct ashmem_range **new_range) -+{ -+ struct ashmem_range *range = *new_range; -+ -+ *new_range = NULL; -+ range->asma = asma; -+ range->pgstart = start; -+ range->pgend = end; -+ range->purged = purged; -+ -+ list_add_tail(&range->unpinned, &prev_range->unpinned); -+ -+ if (range_on_lru(range)) -+ lru_add(range); -+} -+ -+/** -+ * range_del() - Deletes and deallocates an ashmem_range structure -+ * @range: The associated ashmem_range that has previously been allocated -+ */ -+static void range_del(struct ashmem_range *range) -+{ -+ list_del(&range->unpinned); -+ if (range_on_lru(range)) -+ lru_del(range); -+ kmem_cache_free(ashmem_range_cachep, range); -+} -+ -+/** -+ * range_shrink() - Shrinks an ashmem_range -+ * @range: The associated ashmem_range being shrunk -+ * @start: The starting byte of the new range -+ * @end: The ending byte of the new range -+ * -+ * This does not modify the data inside the existing range in any way - It -+ * simply shrinks the boundaries of the range. -+ * -+ * Theoretically, with a little tweaking, this could eventually be changed -+ * to range_resize, and expand the lru_count if the new range is larger. -+ */ -+static inline void range_shrink(struct ashmem_range *range, -+ size_t start, size_t end) -+{ -+ size_t pre = range_size(range); -+ -+ range->pgstart = start; -+ range->pgend = end; -+ -+ if (range_on_lru(range)) -+ lru_count -= pre - range_size(range); -+} -+ -+/** -+ * ashmem_open() - Opens an Anonymous Shared Memory structure -+ * @inode: The backing file's index node(?) -+ * @file: The backing file -+ * -+ * Please note that the ashmem_area is not returned by this function - It is -+ * instead written to "file->private_data". -+ * -+ * Return: 0 if successful, or another code if unsuccessful. -+ */ -+static int ashmem_open(struct inode *inode, struct file *file) -+{ -+ struct ashmem_area *asma; -+ int ret; -+ -+ ret = generic_file_open(inode, file); -+ if (ret) -+ return ret; -+ -+ asma = kmem_cache_zalloc(ashmem_area_cachep, GFP_KERNEL); -+ if (!asma) -+ return -ENOMEM; -+ -+ INIT_LIST_HEAD(&asma->unpinned_list); -+ memcpy(asma->name, ASHMEM_NAME_PREFIX, ASHMEM_NAME_PREFIX_LEN); -+ asma->prot_mask = PROT_MASK; -+ file->private_data = asma; -+#ifdef CONFIG_PURGEABLE_ASHMEM -+ asma->ref_count = PURGEABLE_ASHMEM_INIT_REFCOUNT; -+ asma->is_purgeable = false; -+ asma->purged = false; -+ asma->id = current->pid; -+ asma->create_time = ktime_get(); -+#endif -+ return 0; -+} -+ -+/** -+ * ashmem_release() - Releases an Anonymous Shared Memory structure -+ * @ignored: The backing file's Index Node(?) - It is ignored here. -+ * @file: The backing file -+ * -+ * Return: 0 if successful. If it is anything else, go have a coffee and -+ * try again. -+ */ -+static int ashmem_release(struct inode *ignored, struct file *file) -+{ -+ struct ashmem_area *asma = file->private_data; -+ struct ashmem_range *range, *next; -+ -+ mutex_lock(&ashmem_mutex); -+ list_for_each_entry_safe(range, next, &asma->unpinned_list, unpinned) -+ range_del(range); -+ mutex_unlock(&ashmem_mutex); -+ -+ if (asma->file) -+ fput(asma->file); -+ kmem_cache_free(ashmem_area_cachep, asma); -+ -+ return 0; -+} -+ -+static ssize_t ashmem_read_iter(struct kiocb *iocb, struct iov_iter *iter) -+{ -+ struct ashmem_area *asma = iocb->ki_filp->private_data; -+ int ret = 0; -+ -+ mutex_lock(&ashmem_mutex); -+ -+ /* If size is not set, or set to 0, always return EOF. */ -+ if (asma->size == 0) -+ goto out_unlock; -+ -+ if (!asma->file) { -+ ret = -EBADF; -+ goto out_unlock; -+ } -+ -+ /* -+ * asma and asma->file are used outside the lock here. We assume -+ * once asma->file is set it will never be changed, and will not -+ * be destroyed until all references to the file are dropped and -+ * ashmem_release is called. -+ */ -+ mutex_unlock(&ashmem_mutex); -+ ret = vfs_iter_read(asma->file, iter, &iocb->ki_pos, 0); -+ mutex_lock(&ashmem_mutex); -+ if (ret > 0) -+ asma->file->f_pos = iocb->ki_pos; -+out_unlock: -+ mutex_unlock(&ashmem_mutex); -+ return ret; -+} -+ -+static loff_t ashmem_llseek(struct file *file, loff_t offset, int origin) -+{ -+ struct ashmem_area *asma = file->private_data; -+ loff_t ret; -+ -+ mutex_lock(&ashmem_mutex); -+ -+ if (asma->size == 0) { -+ mutex_unlock(&ashmem_mutex); -+ return -EINVAL; -+ } -+ -+ if (!asma->file) { -+ mutex_unlock(&ashmem_mutex); -+ return -EBADF; -+ } -+ -+ mutex_unlock(&ashmem_mutex); -+ -+ ret = vfs_llseek(asma->file, offset, origin); -+ if (ret < 0) -+ return ret; -+ -+ /** Copy f_pos from backing file, since f_ops->llseek() sets it */ -+ file->f_pos = asma->file->f_pos; -+ return ret; -+} -+ -+static inline vm_flags_t calc_vm_may_flags(unsigned long prot) -+{ -+ return _calc_vm_trans(prot, PROT_READ, VM_MAYREAD) | -+ _calc_vm_trans(prot, PROT_WRITE, VM_MAYWRITE) | -+ _calc_vm_trans(prot, PROT_EXEC, VM_MAYEXEC); -+} -+ -+static int ashmem_vmfile_mmap(struct file *file, struct vm_area_struct *vma) -+{ -+ /* do not allow to mmap ashmem backing shmem file directly */ -+ return -EPERM; -+} -+ -+static unsigned long -+ashmem_vmfile_get_unmapped_area(struct file *file, unsigned long addr, -+ unsigned long len, unsigned long pgoff, -+ unsigned long flags) -+{ -+ return current->mm->get_unmapped_area(file, addr, len, pgoff, flags); -+} -+ -+static int ashmem_mmap(struct file *file, struct vm_area_struct *vma) -+{ -+ static struct file_operations vmfile_fops; -+ struct ashmem_area *asma = file->private_data; -+ int ret = 0; -+ -+ mutex_lock(&ashmem_mutex); -+ -+ /* user needs to SET_SIZE before mapping */ -+ if (!asma->size) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ /* requested mapping size larger than object size */ -+ if (vma->vm_end - vma->vm_start > PAGE_ALIGN(asma->size)) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ /* requested protection bits must match our allowed protection mask */ -+ if ((vma->vm_flags & ~calc_vm_prot_bits(asma->prot_mask, 0)) & -+ calc_vm_prot_bits(PROT_MASK, 0)) { -+ ret = -EPERM; -+ goto out; -+ } -+ vm_flags_clear(vma, calc_vm_may_flags(~asma->prot_mask)); -+ -+ if (!asma->file) { -+ char *name = ASHMEM_NAME_DEF; -+ struct file *vmfile; -+ struct inode *inode; -+ -+ if (asma->name[ASHMEM_NAME_PREFIX_LEN] != '\0') -+ name = asma->name; -+ -+ /* ... and allocate the backing shmem file */ -+ vmfile = shmem_file_setup(name, asma->size, vma->vm_flags); -+ if (IS_ERR(vmfile)) { -+ ret = PTR_ERR(vmfile); -+ goto out; -+ } -+ vmfile->f_mode |= FMODE_LSEEK; -+ inode = file_inode(vmfile); -+ lockdep_set_class(&inode->i_rwsem, &backing_shmem_inode_class); -+ asma->file = vmfile; -+ /* -+ * override mmap operation of the vmfile so that it can't be -+ * remapped which would lead to creation of a new vma with no -+ * asma permission checks. Have to override get_unmapped_area -+ * as well to prevent VM_BUG_ON check for f_ops modification. -+ */ -+ if (!vmfile_fops.mmap) { -+ vmfile_fops = *vmfile->f_op; -+ vmfile_fops.mmap = ashmem_vmfile_mmap; -+ vmfile_fops.get_unmapped_area = -+ ashmem_vmfile_get_unmapped_area; -+ } -+ vmfile->f_op = &vmfile_fops; -+ } -+ get_file(asma->file); -+ -+ /* -+ * XXX - Reworked to use shmem_zero_setup() instead of -+ * shmem_set_file while we're in staging. -jstultz -+ */ -+ if (vma->vm_flags & VM_SHARED) { -+ ret = shmem_zero_setup(vma); -+ if (ret) { -+ fput(asma->file); -+ goto out; -+ } -+ } else { -+ vma_set_anonymous(vma); -+ } -+ -+ if (vma->vm_file) -+ fput(vma->vm_file); -+ vma->vm_file = asma->file; -+ -+out: -+ mutex_unlock(&ashmem_mutex); -+ return ret; -+} -+ -+/* -+ * ashmem_shrink - our cache shrinker, called from mm/vmscan.c -+ * -+ * 'nr_to_scan' is the number of objects to scan for freeing. -+ * -+ * 'gfp_mask' is the mask of the allocation that got us into this mess. -+ * -+ * Return value is the number of objects freed or -1 if we cannot -+ * proceed without risk of deadlock (due to gfp_mask). -+ * -+ * We approximate LRU via least-recently-unpinned, jettisoning unpinned partial -+ * chunks of ashmem regions LRU-wise one-at-a-time until we hit 'nr_to_scan' -+ * pages freed. -+ */ -+static unsigned long -+ashmem_shrink_scan(struct shrinker *shrink, struct shrink_control *sc) -+{ -+ unsigned long freed = 0; -+ -+ /* We might recurse into filesystem code, so bail out if necessary */ -+ if (!(sc->gfp_mask & __GFP_FS)) -+ return SHRINK_STOP; -+ -+ if (!mutex_trylock(&ashmem_mutex)) -+ return -1; -+ -+ while (!list_empty(&ashmem_lru_list)) { -+ struct ashmem_range *range = -+ list_first_entry(&ashmem_lru_list, typeof(*range), lru); -+ loff_t start = range->pgstart * PAGE_SIZE; -+ loff_t end = (range->pgend + 1) * PAGE_SIZE; -+ struct file *f = range->asma->file; -+ -+ get_file(f); -+ atomic_inc(&ashmem_shrink_inflight); -+ range->purged = ASHMEM_WAS_PURGED; -+#ifdef CONFIG_PURGEABLE_ASHMEM -+ if (is_purgeable_ashmem(range->asma)) -+ range->asma->purged = true; -+#endif -+ lru_del(range); -+ -+ freed += range_size(range); -+ mutex_unlock(&ashmem_mutex); -+ f->f_op->fallocate(f, -+ FALLOC_FL_PUNCH_HOLE | FALLOC_FL_KEEP_SIZE, -+ start, end - start); -+ fput(f); -+ if (atomic_dec_and_test(&ashmem_shrink_inflight)) -+ wake_up_all(&ashmem_shrink_wait); -+ if (!mutex_trylock(&ashmem_mutex)) -+ goto out; -+ if (--sc->nr_to_scan <= 0) -+ break; -+ } -+ mutex_unlock(&ashmem_mutex); -+out: -+ return freed; -+} -+ -+static unsigned long -+ashmem_shrink_count(struct shrinker *shrink, struct shrink_control *sc) -+{ -+ /* -+ * note that lru_count is count of pages on the lru, not a count of -+ * objects on the list. This means the scan function needs to return the -+ * number of pages freed, not the number of objects scanned. -+ */ -+ return lru_count; -+} -+ -+static struct shrinker ashmem_shrinker = { -+ .count_objects = ashmem_shrink_count, -+ .scan_objects = ashmem_shrink_scan, -+ /* -+ * XXX (dchinner): I wish people would comment on why they need on -+ * significant changes to the default value here -+ */ -+ .seeks = DEFAULT_SEEKS * 4, -+}; -+ -+static int set_prot_mask(struct ashmem_area *asma, unsigned long prot) -+{ -+ int ret = 0; -+ -+ mutex_lock(&ashmem_mutex); -+ -+ /* the user can only remove, not add, protection bits */ -+ if ((asma->prot_mask & prot) != prot) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ /* does the application expect PROT_READ to imply PROT_EXEC? */ -+ if ((prot & PROT_READ) && (current->personality & READ_IMPLIES_EXEC)) -+ prot |= PROT_EXEC; -+ -+ asma->prot_mask = prot; -+ -+out: -+ mutex_unlock(&ashmem_mutex); -+ return ret; -+} -+ -+static int set_name(struct ashmem_area *asma, void __user *name) -+{ -+ int len; -+ int ret = 0; -+ char local_name[ASHMEM_NAME_LEN]; -+ -+ /* -+ * Holding the ashmem_mutex while doing a copy_from_user might cause -+ * an data abort which would try to access mmap_lock. If another -+ * thread has invoked ashmem_mmap then it will be holding the -+ * semaphore and will be waiting for ashmem_mutex, there by leading to -+ * deadlock. We'll release the mutex and take the name to a local -+ * variable that does not need protection and later copy the local -+ * variable to the structure member with lock held. -+ */ -+ len = strncpy_from_user(local_name, name, ASHMEM_NAME_LEN); -+ if (len < 0) -+ return len; -+ -+ mutex_lock(&ashmem_mutex); -+ /* cannot change an existing mapping's name */ -+ if (asma->file) -+ ret = -EINVAL; -+ else -+ strscpy(asma->name + ASHMEM_NAME_PREFIX_LEN, local_name, -+ ASHMEM_NAME_LEN); -+ -+ mutex_unlock(&ashmem_mutex); -+ return ret; -+} -+ -+static int get_name(struct ashmem_area *asma, void __user *name) -+{ -+ int ret = 0; -+ size_t len; -+ /* -+ * Have a local variable to which we'll copy the content -+ * from asma with the lock held. Later we can copy this to the user -+ * space safely without holding any locks. So even if we proceed to -+ * wait for mmap_lock, it won't lead to deadlock. -+ */ -+ char local_name[ASHMEM_NAME_LEN]; -+ -+ mutex_lock(&ashmem_mutex); -+ if (asma->name[ASHMEM_NAME_PREFIX_LEN] != '\0') { -+ /* -+ * Copying only `len', instead of ASHMEM_NAME_LEN, bytes -+ * prevents us from revealing one user's stack to another. -+ */ -+ len = strlen(asma->name + ASHMEM_NAME_PREFIX_LEN) + 1; -+ memcpy(local_name, asma->name + ASHMEM_NAME_PREFIX_LEN, len); -+ } else { -+ len = sizeof(ASHMEM_NAME_DEF); -+ memcpy(local_name, ASHMEM_NAME_DEF, len); -+ } -+ mutex_unlock(&ashmem_mutex); -+ -+ /* -+ * Now we are just copying from the stack variable to userland -+ * No lock held -+ */ -+ if (copy_to_user(name, local_name, len)) -+ ret = -EFAULT; -+ return ret; -+} -+ -+/* -+ * ashmem_pin - pin the given ashmem region, returning whether it was -+ * previously purged (ASHMEM_WAS_PURGED) or not (ASHMEM_NOT_PURGED). -+ * -+ * Caller must hold ashmem_mutex. -+ */ -+static int ashmem_pin(struct ashmem_area *asma, size_t pgstart, size_t pgend, -+ struct ashmem_range **new_range) -+{ -+ struct ashmem_range *range, *next; -+ int ret = ASHMEM_NOT_PURGED; -+#ifdef CONFIG_PURGEABLE_ASHMEM -+ if (is_purgeable_ashmem(asma)) { -+ asma->ref_count++; -+ if (asma->ref_count > 1) -+ return PM_SUCCESS; -+ } -+#endif -+ list_for_each_entry_safe(range, next, &asma->unpinned_list, unpinned) { -+ /* moved past last applicable page; we can short circuit */ -+ if (range_before_page(range, pgstart)) -+ break; -+ -+ /* -+ * The user can ask us to pin pages that span multiple ranges, -+ * or to pin pages that aren't even unpinned, so this is messy. -+ * -+ * Four cases: -+ * 1. The requested range subsumes an existing range, so we -+ * just remove the entire matching range. -+ * 2. The requested range overlaps the start of an existing -+ * range, so we just update that range. -+ * 3. The requested range overlaps the end of an existing -+ * range, so we just update that range. -+ * 4. The requested range punches a hole in an existing range, -+ * so we have to update one side of the range and then -+ * create a new range for the other side. -+ */ -+ if (page_range_in_range(range, pgstart, pgend)) { -+ ret |= range->purged; -+ -+ /* Case #1: Easy. Just nuke the whole thing. */ -+ if (page_range_subsumes_range(range, pgstart, pgend)) { -+ range_del(range); -+ continue; -+ } -+ -+ /* Case #2: We overlap from the start, so adjust it */ -+ if (range->pgstart >= pgstart) { -+ range_shrink(range, pgend + 1, range->pgend); -+ continue; -+ } -+ -+ /* Case #3: We overlap from the rear, so adjust it */ -+ if (range->pgend <= pgend) { -+ range_shrink(range, range->pgstart, -+ pgstart - 1); -+ continue; -+ } -+ -+ /* -+ * Case #4: We eat a chunk out of the middle. A bit -+ * more complicated, we allocate a new range for the -+ * second half and adjust the first chunk's endpoint. -+ */ -+ range_alloc(asma, range, range->purged, -+ pgend + 1, range->pgend, new_range); -+ range_shrink(range, range->pgstart, pgstart - 1); -+ break; -+ } -+ } -+ -+ return ret; -+} -+ -+/* -+ * ashmem_unpin - unpin the given range of pages. Returns zero on success. -+ * -+ * Caller must hold ashmem_mutex. -+ */ -+static int ashmem_unpin(struct ashmem_area *asma, size_t pgstart, size_t pgend, -+ struct ashmem_range **new_range) -+{ -+ struct ashmem_range *range, *next; -+ unsigned int purged = ASHMEM_NOT_PURGED; -+#ifdef CONFIG_PURGEABLE_ASHMEM -+ if (is_purgeable_ashmem(asma)) { -+ if (asma->ref_count > PURGEABLE_ASHMEM_UNPIN_REFCOUNT && -+ !(--asma->ref_count == PURGEABLE_ASHMEM_UNPIN_REFCOUNT)) -+ return PM_SUCCESS; -+ if (asma->ref_count < PURGEABLE_ASHMEM_UNPIN_REFCOUNT) { -+ asma->ref_count = PURGEABLE_ASHMEM_UNPIN_REFCOUNT; -+ return PM_FAIL; -+ } -+ } -+#endif -+restart: -+ list_for_each_entry_safe(range, next, &asma->unpinned_list, unpinned) { -+ /* short circuit: this is our insertion point */ -+ if (range_before_page(range, pgstart)) -+ break; -+ -+ /* -+ * The user can ask us to unpin pages that are already entirely -+ * or partially pinned. We handle those two cases here. -+ */ -+ if (page_range_subsumed_by_range(range, pgstart, pgend)) -+ return 0; -+ if (page_range_in_range(range, pgstart, pgend)) { -+ pgstart = min(range->pgstart, pgstart); -+ pgend = max(range->pgend, pgend); -+ purged |= range->purged; -+ range_del(range); -+ goto restart; -+ } -+ } -+ -+ range_alloc(asma, range, purged, pgstart, pgend, new_range); -+ return 0; -+} -+ -+/* -+ * ashmem_get_pin_status - Returns ASHMEM_IS_UNPINNED if _any_ pages in the -+ * given interval are unpinned and ASHMEM_IS_PINNED otherwise. -+ * -+ * Caller must hold ashmem_mutex. -+ */ -+static int ashmem_get_pin_status(struct ashmem_area *asma, size_t pgstart, -+ size_t pgend) -+{ -+ struct ashmem_range *range; -+ int ret = ASHMEM_IS_PINNED; -+#ifdef CONFIG_PURGEABLE_ASHMEM -+ if (is_purgeable_ashmem(asma)) -+ return asma->ref_count; -+#endif -+ list_for_each_entry(range, &asma->unpinned_list, unpinned) { -+ if (range_before_page(range, pgstart)) -+ break; -+ if (page_range_in_range(range, pgstart, pgend)) { -+ ret = ASHMEM_IS_UNPINNED; -+ break; -+ } -+ } -+ -+ return ret; -+} -+ -+static int ashmem_pin_unpin(struct ashmem_area *asma, unsigned long cmd, -+ void __user *p) -+{ -+ struct ashmem_pin pin; -+ size_t pgstart, pgend; -+ int ret = -EINVAL; -+ struct ashmem_range *range = NULL; -+ -+ if (copy_from_user(&pin, p, sizeof(pin))) -+ return -EFAULT; -+ -+ if (cmd == ASHMEM_PIN || cmd == ASHMEM_UNPIN) { -+ range = kmem_cache_zalloc(ashmem_range_cachep, GFP_KERNEL); -+ if (!range) -+ return -ENOMEM; -+ } -+ -+ mutex_lock(&ashmem_mutex); -+ wait_event(ashmem_shrink_wait, !atomic_read(&ashmem_shrink_inflight)); -+#ifdef CONFIG_PURGEABLE_ASHMEM -+ if (is_purgeable_ashmem(asma)) { -+ if (pin.offset != PURGEABLE_ASHMEM_PIN_OFFSET || -+ pin.len != PURGEABLE_ASHMEM_PIN_LEN) { -+ ret = -EINVAL; -+ goto out_unlock; -+ } -+ } -+#endif -+ if (!asma->file) -+ goto out_unlock; -+ -+ /* per custom, you can pass zero for len to mean "everything onward" */ -+ if (!pin.len) -+ pin.len = PAGE_ALIGN(asma->size) - pin.offset; -+ -+ if ((pin.offset | pin.len) & ~PAGE_MASK) -+ goto out_unlock; -+ -+ if (((__u32)-1) - pin.offset < pin.len) -+ goto out_unlock; -+ -+ if (PAGE_ALIGN(asma->size) < pin.offset + pin.len) -+ goto out_unlock; -+ -+ pgstart = pin.offset / PAGE_SIZE; -+ pgend = pgstart + (pin.len / PAGE_SIZE) - 1; -+ -+ switch (cmd) { -+ case ASHMEM_PIN: -+ ret = ashmem_pin(asma, pgstart, pgend, &range); -+ break; -+ case ASHMEM_UNPIN: -+ ret = ashmem_unpin(asma, pgstart, pgend, &range); -+ break; -+ case ASHMEM_GET_PIN_STATUS: -+ ret = ashmem_get_pin_status(asma, pgstart, pgend); -+ break; -+ } -+ -+out_unlock: -+ mutex_unlock(&ashmem_mutex); -+ if (range) -+ kmem_cache_free(ashmem_range_cachep, range); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_PURGEABLE_ASHMEM -+void ashmem_shrinkall(void) -+{ -+ struct shrink_control sc = { -+ .gfp_mask = GFP_KERNEL, -+ .nr_to_scan = LONG_MAX, -+ }; -+ -+ ashmem_shrink_scan(&ashmem_shrinker, &sc); -+} -+ -+void ashmem_shrink_by_id(const unsigned int ashmem_id, const unsigned int create_time) -+{ -+ struct ashmem_range *range, *next; -+ bool found = false; -+ -+ if (!mutex_trylock(&ashmem_mutex)) -+ return; -+ -+ list_for_each_entry_safe(range, next, &ashmem_lru_list, lru) { -+ if (!is_purgeable_ashmem(range->asma)) -+ continue; -+ if (range->asma->id != ashmem_id || -+ range->asma->create_time != create_time) -+ continue; -+ found = true; -+ range->asma->purged = true; -+ break; -+ } -+ if (!found) -+ goto out_unlock; -+ -+ loff_t start = range->pgstart * PAGE_SIZE; -+ loff_t end = (range->pgend + 1) * PAGE_SIZE; -+ struct file *f = range->asma->file; -+ -+ if (!f) -+ goto out_unlock; -+ get_file(f); -+ atomic_inc(&ashmem_shrink_inflight); -+ range->purged = ASHMEM_WAS_PURGED; -+ -+ lru_del(range); -+ mutex_unlock(&ashmem_mutex); -+ f->f_op->fallocate(f, FALLOC_FL_PUNCH_HOLE | FALLOC_FL_KEEP_SIZE, -+ start, end - start); -+ fput(f); -+ if (atomic_dec_and_test(&ashmem_shrink_inflight)) -+ wake_up_all(&ashmem_shrink_wait); -+ return; -+ -+out_unlock: -+ mutex_unlock(&ashmem_mutex); -+} -+ -+static bool is_ashmem_unpin(struct ashmem_area *asma) -+{ -+ struct ashmem_range *range, *next; -+ int count = 0; -+ -+ mutex_lock(&ashmem_mutex); -+ if (!asma) { -+ mutex_unlock(&ashmem_mutex); -+ return false; -+ } -+ list_for_each_entry_safe(range, next, &asma->unpinned_list, unpinned) -+ count++; -+ mutex_unlock(&ashmem_mutex); -+ return count > 0 ? true : false; -+} -+ -+static long purgeable_ashmem_cmd(struct ashmem_area *asma, unsigned int cmd) -+{ -+ int ret = -EINVAL; -+ -+ if (!is_purgeable_ashmem(asma)) -+ return ret; -+ mutex_lock(&ashmem_mutex); -+ switch (cmd) { -+ case ASHMEM_GET_PURGEABLE: -+ ret = asma->is_purgeable; -+ break; -+ case PURGEABLE_ASHMEM_IS_PURGED: -+ ret = asma->purged; -+ break; -+ case PURGEABLE_ASHMEM_REBUILD_SUCCESS: -+ asma->purged = false; -+ ret = PM_SUCCESS; -+ break; -+ } -+ mutex_unlock(&ashmem_mutex); -+ return ret; -+} -+ -+bool get_purgeable_ashmem_metadata(struct file *f, struct purgeable_ashmem_metadata *pmdata) -+{ -+ struct ashmem_area *asma = f->private_data; -+ -+ if (!asma) { -+ return false; -+ } -+ pmdata->name = asma->name; -+ pmdata->size = asma->size; -+ pmdata->refc = asma->ref_count; -+ pmdata->purged = asma->purged; -+ pmdata->is_purgeable = asma->is_purgeable; -+ pmdata->id = asma->id; -+ pmdata->create_time = asma->create_time; -+ return true; -+} -+#endif -+static long ashmem_ioctl(struct file *file, unsigned int cmd, unsigned long arg) -+{ -+ struct ashmem_area *asma = file->private_data; -+ long ret = -ENOTTY; -+ -+ switch (cmd) { -+ case ASHMEM_SET_NAME: -+ ret = set_name(asma, (void __user *)arg); -+ break; -+ case ASHMEM_GET_NAME: -+ ret = get_name(asma, (void __user *)arg); -+ break; -+ case ASHMEM_SET_SIZE: -+ ret = -EINVAL; -+ mutex_lock(&ashmem_mutex); -+ if (!asma->file) { -+ ret = 0; -+ asma->size = (size_t)arg; -+ } -+ mutex_unlock(&ashmem_mutex); -+ break; -+ case ASHMEM_GET_SIZE: -+ ret = asma->size; -+ break; -+ case ASHMEM_SET_PROT_MASK: -+ ret = set_prot_mask(asma, arg); -+ break; -+ case ASHMEM_GET_PROT_MASK: -+ ret = asma->prot_mask; -+ break; -+ case ASHMEM_PIN: -+ case ASHMEM_UNPIN: -+ case ASHMEM_GET_PIN_STATUS: -+ ret = ashmem_pin_unpin(asma, cmd, (void __user *)arg); -+ break; -+ case ASHMEM_PURGE_ALL_CACHES: -+ ret = -EPERM; -+ if (capable(CAP_SYS_ADMIN)) { -+ struct shrink_control sc = { -+ .gfp_mask = GFP_KERNEL, -+ .nr_to_scan = LONG_MAX, -+ }; -+ ret = ashmem_shrink_count(&ashmem_shrinker, &sc); -+ ashmem_shrink_scan(&ashmem_shrinker, &sc); -+ } -+ break; -+#ifdef CONFIG_PURGEABLE_ASHMEM -+ case ASHMEM_SET_PURGEABLE: -+ if (is_ashmem_unpin(asma)) { -+ ret = PM_FAIL; -+ break; -+ } -+ mutex_lock(&ashmem_mutex); -+ if (asma) { -+ asma->is_purgeable = true; -+ ret = PM_SUCCESS; -+ } -+ mutex_unlock(&ashmem_mutex); -+ break; -+ case ASHMEM_GET_PURGEABLE: -+ fallthrough; -+ case PURGEABLE_ASHMEM_IS_PURGED: -+ fallthrough; -+ case PURGEABLE_ASHMEM_REBUILD_SUCCESS: -+ ret = purgeable_ashmem_cmd(asma, cmd); -+ break; -+#endif -+ } -+ return ret; -+} -+ -+/* support of 32bit userspace on 64bit platforms */ -+#ifdef CONFIG_COMPAT -+static long compat_ashmem_ioctl(struct file *file, unsigned int cmd, -+ unsigned long arg) -+{ -+ switch (cmd) { -+ case COMPAT_ASHMEM_SET_SIZE: -+ cmd = ASHMEM_SET_SIZE; -+ break; -+ case COMPAT_ASHMEM_SET_PROT_MASK: -+ cmd = ASHMEM_SET_PROT_MASK; -+ break; -+ } -+ return ashmem_ioctl(file, cmd, arg); -+} -+#endif -+#ifdef CONFIG_PROC_FS -+static void ashmem_show_fdinfo(struct seq_file *m, struct file *file) -+{ -+ struct ashmem_area *asma = file->private_data; -+ -+ mutex_lock(&ashmem_mutex); -+ -+ if (asma->file) -+ seq_printf(m, "inode:\t%ld\n", file_inode(asma->file)->i_ino); -+ -+ if (asma->name[ASHMEM_NAME_PREFIX_LEN] != '\0') -+ seq_printf(m, "name:\t%s\n", -+ asma->name + ASHMEM_NAME_PREFIX_LEN); -+ -+ mutex_unlock(&ashmem_mutex); -+} -+#endif -+static const struct file_operations ashmem_fops = { -+ .owner = THIS_MODULE, -+ .open = ashmem_open, -+ .release = ashmem_release, -+ .read_iter = ashmem_read_iter, -+ .llseek = ashmem_llseek, -+ .mmap = ashmem_mmap, -+ .unlocked_ioctl = ashmem_ioctl, -+#ifdef CONFIG_COMPAT -+ .compat_ioctl = compat_ashmem_ioctl, -+#endif -+#ifdef CONFIG_PROC_FS -+ .show_fdinfo = ashmem_show_fdinfo, -+#endif -+}; -+ -+int is_ashmem_file(struct file *file) -+{ -+ return file->f_op == &ashmem_fops; -+} -+ -+static struct miscdevice ashmem_misc = { -+ .minor = MISC_DYNAMIC_MINOR, -+ .name = "ashmem", -+ .fops = &ashmem_fops, -+}; -+ -+size_t get_ashmem_size_by_file(struct file *f) -+{ -+ struct ashmem_area *asma = f->private_data; -+ -+ if (asma) -+ return asma->size; -+ return 0; -+} -+ -+char *get_ashmem_name_by_file(struct file *f) -+{ -+ struct ashmem_area *asma = f->private_data; -+ -+ if (asma) -+ return asma->name; -+ return NULL; -+} -+ -+static int __init ashmem_init(void) -+{ -+ int ret = -ENOMEM; -+ -+ ashmem_area_cachep = kmem_cache_create("ashmem_area_cache", -+ sizeof(struct ashmem_area), -+ 0, 0, NULL); -+ if (!ashmem_area_cachep) { -+ pr_err("failed to create slab cache\n"); -+ goto out; -+ } -+ -+ ashmem_range_cachep = kmem_cache_create("ashmem_range_cache", -+ sizeof(struct ashmem_range), -+ 0, 0, NULL); -+ if (!ashmem_range_cachep) { -+ pr_err("failed to create slab cache\n"); -+ goto out_free1; -+ } -+ -+ ret = misc_register(&ashmem_misc); -+ if (ret) { -+ pr_err("failed to register misc device!\n"); -+ goto out_free2; -+ } -+ -+ ret = register_shrinker(&ashmem_shrinker, "ashmem-shrinker"); -+ if (ret) { -+ pr_err("failed to register shrinker!\n"); -+ goto out_demisc; -+ } -+ init_ashmem_process_info(); -+#ifdef CONFIG_PURGEABLE_ASHMEM -+ init_purgeable_ashmem_trigger(); -+#endif -+ pr_info("initialized\n"); -+ -+ return 0; -+ -+out_demisc: -+ misc_deregister(&ashmem_misc); -+out_free2: -+ kmem_cache_destroy(ashmem_range_cachep); -+out_free1: -+ kmem_cache_destroy(ashmem_area_cachep); -+out: -+ return ret; -+} -+device_initcall(ashmem_init); -diff --git a/drivers/staging/android/ashmem.h b/drivers/staging/android/ashmem.h -new file mode 100644 -index 000000000..2f04163c6 ---- /dev/null -+++ b/drivers/staging/android/ashmem.h -@@ -0,0 +1,47 @@ -+/* SPDX-License-Identifier: GPL-2.0 OR Apache-2.0 */ -+/* -+ * include/linux/ashmem.h -+ * -+ * Copyright 2008 Google Inc. -+ * Author: Robert Love -+ */ -+ -+#ifndef _LINUX_ASHMEM_H -+#define _LINUX_ASHMEM_H -+ -+#include -+#include -+#include -+ -+#include "uapi/ashmem.h" -+ -+/* support of 32bit userspace on 64bit platforms */ -+#ifdef CONFIG_COMPAT -+#define COMPAT_ASHMEM_SET_SIZE _IOW(__ASHMEMIOC, 3, compat_size_t) -+#define COMPAT_ASHMEM_SET_PROT_MASK _IOW(__ASHMEMIOC, 5, unsigned int) -+#endif -+ -+int is_ashmem_file(struct file *file); -+size_t get_ashmem_size_by_file(struct file *f); -+char *get_ashmem_name_by_file(struct file *f); -+void ashmem_mutex_lock(void); -+void ashmem_mutex_unlock(void); -+ -+#ifdef CONFIG_PURGEABLE_ASHMEM -+struct purgeable_ashmem_metadata { -+ char *name; -+ size_t size; -+ int refc; -+ bool purged; -+ bool is_purgeable; -+ unsigned int id; -+ unsigned int create_time; -+}; -+ -+void ashmem_shrinkall(void); -+void ashmem_shrink_by_id(const unsigned int ashmem_id, -+ const unsigned int create_time); -+bool get_purgeable_ashmem_metadata(struct file *f, -+ struct purgeable_ashmem_metadata *pmdata); -+#endif -+#endif /* _LINUX_ASHMEM_H */ -diff --git a/drivers/staging/android/ion/Kconfig b/drivers/staging/android/ion/Kconfig -new file mode 100644 -index 000000000..7b7da9799 ---- /dev/null -+++ b/drivers/staging/android/ion/Kconfig -@@ -0,0 +1,14 @@ -+# SPDX-License-Identifier: GPL-2.0 -+menuconfig ION -+ bool "Ion Memory Manager" -+ depends on HAS_DMA && MMU -+ select GENERIC_ALLOCATOR -+ select DMA_SHARED_BUFFER -+ help -+ Choose this option to enable the ION Memory Manager, -+ used by Android to efficiently allocate buffers -+ from userspace that can be shared between drivers. -+ If you're not using Android its probably safe to -+ say N here. -+ -+source "drivers/staging/android/ion/heaps/Kconfig" -diff --git a/drivers/staging/android/ion/Makefile b/drivers/staging/android/ion/Makefile -new file mode 100644 -index 000000000..7f8fd0f53 ---- /dev/null -+++ b/drivers/staging/android/ion/Makefile -@@ -0,0 +1,4 @@ -+# SPDX-License-Identifier: GPL-2.0 -+obj-$(CONFIG_ION) += ion.o ion_buffer.o ion_dma_buf.o ion_heap.o -+CFLAGS_ion_buffer.o = -I$(src) -+obj-y += heaps/ -diff --git a/drivers/staging/android/ion/heaps/Kconfig b/drivers/staging/android/ion/heaps/Kconfig -new file mode 100644 -index 000000000..5034c45a3 ---- /dev/null -+++ b/drivers/staging/android/ion/heaps/Kconfig -@@ -0,0 +1,15 @@ -+# SPDX-License-Identifier: GPL-2.0 -+config ION_SYSTEM_HEAP -+ tristate "Ion system heap" -+ depends on ION -+ help -+ Choose this option to enable the Ion system heap. The system heap -+ is backed by pages from the buddy allocator. If in doubt, say Y. -+ -+config ION_CMA_HEAP -+ tristate "Ion CMA heap support" -+ depends on ION && DMA_CMA -+ help -+ Choose this option to enable CMA heaps with Ion. This heap is backed -+ by the Contiguous Memory Allocator (CMA). If your system has these -+ regions, you should say Y here. -diff --git a/drivers/staging/android/ion/heaps/Makefile b/drivers/staging/android/ion/heaps/Makefile -new file mode 100644 -index 000000000..82e36e89e ---- /dev/null -+++ b/drivers/staging/android/ion/heaps/Makefile -@@ -0,0 +1,5 @@ -+# SPDX-License-Identifier: GPL-2.0 -+obj-$(CONFIG_ION_SYSTEM_HEAP) += ion_sys_heap.o -+ion_sys_heap-y := ion_system_heap.o ion_page_pool.o -+ -+obj-$(CONFIG_ION_CMA_HEAP) += ion_cma_heap.o -diff --git a/drivers/staging/android/ion/heaps/ion_cma_heap.c b/drivers/staging/android/ion/heaps/ion_cma_heap.c -new file mode 100644 -index 000000000..6ba7fd84c ---- /dev/null -+++ b/drivers/staging/android/ion/heaps/ion_cma_heap.c -@@ -0,0 +1,151 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * ION Memory Allocator CMA heap exporter -+ * -+ * Copyright (C) Linaro 2012 -+ * Author: for ST-Ericsson. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+struct ion_cma_heap { -+ struct ion_heap heap; -+ struct cma *cma; -+} cma_heaps[MAX_CMA_AREAS]; -+ -+#define to_cma_heap(x) container_of(x, struct ion_cma_heap, heap) -+ -+/* ION CMA heap operations functions */ -+static int ion_cma_allocate(struct ion_heap *heap, struct ion_buffer *buffer, -+ unsigned long len, -+ unsigned long flags) -+{ -+ struct ion_cma_heap *cma_heap = to_cma_heap(heap); -+ struct sg_table *table; -+ struct page *pages; -+ unsigned long size = PAGE_ALIGN(len); -+ unsigned long nr_pages = size >> PAGE_SHIFT; -+ unsigned long align = get_order(size); -+ int ret; -+ -+ if (align > CONFIG_CMA_ALIGNMENT) -+ align = CONFIG_CMA_ALIGNMENT; -+ -+ pages = cma_alloc(cma_heap->cma, nr_pages, align, false); -+ if (!pages) -+ return -ENOMEM; -+ -+ if (PageHighMem(pages)) { -+ unsigned long nr_clear_pages = nr_pages; -+ struct page *page = pages; -+ -+ while (nr_clear_pages > 0) { -+ void *vaddr = kmap_atomic(page); -+ -+ memset(vaddr, 0, PAGE_SIZE); -+ kunmap_atomic(vaddr); -+ page++; -+ nr_clear_pages--; -+ } -+ } else { -+ memset(page_address(pages), 0, size); -+ } -+ -+ table = kmalloc(sizeof(*table), GFP_KERNEL); -+ if (!table) -+ goto err; -+ -+ ret = sg_alloc_table(table, 1, GFP_KERNEL); -+ if (ret) -+ goto free_mem; -+ -+ sg_set_page(table->sgl, pages, size, 0); -+ -+ buffer->priv_virt = pages; -+ buffer->sg_table = table; -+ -+ ion_buffer_prep_noncached(buffer); -+ -+ return 0; -+ -+free_mem: -+ kfree(table); -+err: -+ cma_release(cma_heap->cma, pages, nr_pages); -+ return -ENOMEM; -+} -+ -+static void ion_cma_free(struct ion_buffer *buffer) -+{ -+ struct ion_cma_heap *cma_heap = to_cma_heap(buffer->heap); -+ struct page *pages = buffer->priv_virt; -+ unsigned long nr_pages = PAGE_ALIGN(buffer->size) >> PAGE_SHIFT; -+ -+ /* release memory */ -+ cma_release(cma_heap->cma, pages, nr_pages); -+ /* release sg table */ -+ sg_free_table(buffer->sg_table); -+ kfree(buffer->sg_table); -+} -+ -+static struct ion_heap_ops ion_cma_ops = { -+ .allocate = ion_cma_allocate, -+ .free = ion_cma_free, -+}; -+ -+static int __ion_add_cma_heap(struct cma *cma, void *data) -+{ -+ int *cma_nr = data; -+ struct ion_cma_heap *cma_heap; -+ int ret; -+ -+ if (*cma_nr >= MAX_CMA_AREAS) -+ return -EINVAL; -+ -+ cma_heap = &cma_heaps[*cma_nr]; -+ cma_heap->heap.ops = &ion_cma_ops; -+ cma_heap->heap.type = ION_HEAP_TYPE_DMA; -+ cma_heap->heap.name = cma_get_name(cma); -+ -+ ret = ion_device_add_heap(&cma_heap->heap); -+ if (ret) -+ goto out; -+ -+ cma_heap->cma = cma; -+ *cma_nr += 1; -+out: -+ return 0; -+} -+ -+static int __init ion_cma_heap_init(void) -+{ -+ int ret; -+ int nr = 0; -+ -+ ret = cma_for_each_area(__ion_add_cma_heap, &nr); -+ if (ret) { -+ for (nr = 0; nr < MAX_CMA_AREAS && cma_heaps[nr].cma; nr++) -+ ion_device_remove_heap(&cma_heaps[nr].heap); -+ } -+ -+ return ret; -+} -+ -+static void __exit ion_cma_heap_exit(void) -+{ -+ int nr; -+ -+ for (nr = 0; nr < MAX_CMA_AREAS && cma_heaps[nr].cma; nr++) -+ ion_device_remove_heap(&cma_heaps[nr].heap); -+} -+ -+module_init(ion_cma_heap_init); -+module_exit(ion_cma_heap_exit); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/staging/android/ion/heaps/ion_page_pool.c b/drivers/staging/android/ion/heaps/ion_page_pool.c -new file mode 100644 -index 000000000..efd6ce4cc ---- /dev/null -+++ b/drivers/staging/android/ion/heaps/ion_page_pool.c -@@ -0,0 +1,172 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * ION Memory Allocator page pool helpers -+ * -+ * Copyright (C) 2011 Google, Inc. -+ */ -+ -+#include -+#include -+#include -+#include -+ -+#include "ion_page_pool.h" -+ -+static inline struct page *ion_page_pool_alloc_pages(struct ion_page_pool *pool) -+{ -+ if (fatal_signal_pending(current)) -+ return NULL; -+ return alloc_pages(pool->gfp_mask, pool->order); -+} -+ -+static void ion_page_pool_free_pages(struct ion_page_pool *pool, -+ struct page *page) -+{ -+ __free_pages(page, pool->order); -+} -+ -+static void ion_page_pool_add(struct ion_page_pool *pool, struct page *page) -+{ -+ mutex_lock(&pool->mutex); -+ if (PageHighMem(page)) { -+ list_add_tail(&page->lru, &pool->high_items); -+ pool->high_count++; -+ } else { -+ list_add_tail(&page->lru, &pool->low_items); -+ pool->low_count++; -+ } -+ -+ mod_node_page_state(page_pgdat(page), NR_KERNEL_MISC_RECLAIMABLE, -+ 1 << pool->order); -+ mutex_unlock(&pool->mutex); -+} -+ -+static struct page *ion_page_pool_remove(struct ion_page_pool *pool, bool high) -+{ -+ struct page *page; -+ -+ if (high) { -+ BUG_ON(!pool->high_count); -+ page = list_first_entry(&pool->high_items, struct page, lru); -+ pool->high_count--; -+ } else { -+ BUG_ON(!pool->low_count); -+ page = list_first_entry(&pool->low_items, struct page, lru); -+ pool->low_count--; -+ } -+ -+ list_del(&page->lru); -+ mod_node_page_state(page_pgdat(page), NR_KERNEL_MISC_RECLAIMABLE, -+ -(1 << pool->order)); -+ return page; -+} -+ -+struct page *ion_page_pool_alloc(struct ion_page_pool *pool) -+{ -+ struct page *page = NULL; -+ -+ BUG_ON(!pool); -+ -+ mutex_lock(&pool->mutex); -+ if (pool->high_count) -+ page = ion_page_pool_remove(pool, true); -+ else if (pool->low_count) -+ page = ion_page_pool_remove(pool, false); -+ mutex_unlock(&pool->mutex); -+ -+ if (!page) -+ page = ion_page_pool_alloc_pages(pool); -+ -+ return page; -+} -+EXPORT_SYMBOL_GPL(ion_page_pool_alloc); -+ -+void ion_page_pool_free(struct ion_page_pool *pool, struct page *page) -+{ -+ BUG_ON(pool->order != compound_order(page)); -+ -+ ion_page_pool_add(pool, page); -+} -+EXPORT_SYMBOL_GPL(ion_page_pool_free); -+ -+static int ion_page_pool_total(struct ion_page_pool *pool, bool high) -+{ -+ int count = pool->low_count; -+ -+ if (high) -+ count += pool->high_count; -+ -+ return count << pool->order; -+} -+ -+int ion_page_pool_nr_pages(struct ion_page_pool *pool) -+{ -+ int nr_total_pages; -+ -+ mutex_lock(&pool->mutex); -+ nr_total_pages = ion_page_pool_total(pool, true); -+ mutex_unlock(&pool->mutex); -+ -+ return nr_total_pages; -+} -+EXPORT_SYMBOL_GPL(ion_page_pool_nr_pages); -+ -+int ion_page_pool_shrink(struct ion_page_pool *pool, gfp_t gfp_mask, -+ int nr_to_scan) -+{ -+ int freed = 0; -+ bool high; -+ -+ if (current_is_kswapd()) -+ high = true; -+ else -+ high = !!(gfp_mask & __GFP_HIGHMEM); -+ -+ if (nr_to_scan == 0) -+ return ion_page_pool_total(pool, high); -+ -+ while (freed < nr_to_scan) { -+ struct page *page; -+ -+ mutex_lock(&pool->mutex); -+ if (pool->low_count) { -+ page = ion_page_pool_remove(pool, false); -+ } else if (high && pool->high_count) { -+ page = ion_page_pool_remove(pool, true); -+ } else { -+ mutex_unlock(&pool->mutex); -+ break; -+ } -+ mutex_unlock(&pool->mutex); -+ ion_page_pool_free_pages(pool, page); -+ freed += (1 << pool->order); -+ } -+ -+ return freed; -+} -+EXPORT_SYMBOL_GPL(ion_page_pool_shrink); -+ -+struct ion_page_pool *ion_page_pool_create(gfp_t gfp_mask, unsigned int order) -+{ -+ struct ion_page_pool *pool = kmalloc(sizeof(*pool), GFP_KERNEL); -+ -+ if (!pool) -+ return NULL; -+ pool->high_count = 0; -+ pool->low_count = 0; -+ INIT_LIST_HEAD(&pool->low_items); -+ INIT_LIST_HEAD(&pool->high_items); -+ pool->gfp_mask = gfp_mask | __GFP_COMP; -+ pool->order = order; -+ mutex_init(&pool->mutex); -+ plist_node_init(&pool->list, order); -+ -+ return pool; -+} -+EXPORT_SYMBOL_GPL(ion_page_pool_create); -+ -+void ion_page_pool_destroy(struct ion_page_pool *pool) -+{ -+ kfree(pool); -+} -+EXPORT_SYMBOL_GPL(ion_page_pool_destroy); -diff --git a/drivers/staging/android/ion/heaps/ion_page_pool.h b/drivers/staging/android/ion/heaps/ion_page_pool.h -new file mode 100644 -index 000000000..10c79090c ---- /dev/null -+++ b/drivers/staging/android/ion/heaps/ion_page_pool.h -@@ -0,0 +1,67 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * ION Page Pool kernel interface header -+ * -+ * Copyright (C) 2011 Google, Inc. -+ */ -+ -+#ifndef _ION_PAGE_POOL_H -+#define _ION_PAGE_POOL_H -+ -+#include -+#include -+#include -+#include -+ -+/** -+ * functions for creating and destroying a heap pool -- allows you -+ * to keep a pool of pre allocated memory to use from your heap. Keeping -+ * a pool of memory that is ready for dma, ie any cached mapping have been -+ * invalidated from the cache, provides a significant performance benefit on -+ * many systems -+ */ -+ -+/** -+ * struct ion_page_pool - pagepool struct -+ * @high_count: number of highmem items in the pool -+ * @low_count: number of lowmem items in the pool -+ * @high_items: list of highmem items -+ * @low_items: list of lowmem items -+ * @mutex: lock protecting this struct and especially the count -+ * item list -+ * @gfp_mask: gfp_mask to use from alloc -+ * @order: order of pages in the pool -+ * @list: plist node for list of pools -+ * -+ * Allows you to keep a pool of pre allocated pages to use from your heap. -+ * Keeping a pool of pages that is ready for dma, ie any cached mapping have -+ * been invalidated from the cache, provides a significant performance benefit -+ * on many systems -+ */ -+struct ion_page_pool { -+ int high_count; -+ int low_count; -+ struct list_head high_items; -+ struct list_head low_items; -+ struct mutex mutex; -+ gfp_t gfp_mask; -+ unsigned int order; -+ struct plist_node list; -+}; -+ -+struct ion_page_pool *ion_page_pool_create(gfp_t gfp_mask, unsigned int order); -+void ion_page_pool_destroy(struct ion_page_pool *pool); -+struct page *ion_page_pool_alloc(struct ion_page_pool *pool); -+void ion_page_pool_free(struct ion_page_pool *pool, struct page *page); -+int ion_page_pool_nr_pages(struct ion_page_pool *pool); -+ -+/** ion_page_pool_shrink - shrinks the size of the memory cached in the pool -+ * @pool: the pool -+ * @gfp_mask: the memory type to reclaim -+ * @nr_to_scan: number of items to shrink in pages -+ * -+ * returns the number of items freed in pages -+ */ -+int ion_page_pool_shrink(struct ion_page_pool *pool, gfp_t gfp_mask, -+ int nr_to_scan); -+#endif /* _ION_PAGE_POOL_H */ -diff --git a/drivers/staging/android/ion/heaps/ion_system_heap.c b/drivers/staging/android/ion/heaps/ion_system_heap.c -new file mode 100644 -index 000000000..45d23bea3 ---- /dev/null -+++ b/drivers/staging/android/ion/heaps/ion_system_heap.c -@@ -0,0 +1,344 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * ION Memory Allocator system heap exporter -+ * -+ * Copyright (C) 2011 Google, Inc. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "ion_page_pool.h" -+ -+#define NUM_ORDERS ARRAY_SIZE(orders) -+ -+static gfp_t high_order_gfp_flags = (GFP_HIGHUSER | __GFP_ZERO | __GFP_NOWARN | -+ __GFP_NORETRY) & ~__GFP_RECLAIM; -+static gfp_t low_order_gfp_flags = GFP_HIGHUSER | __GFP_ZERO; -+static const unsigned int orders[] = {8, 4, 0}; -+ -+static int order_to_index(unsigned int order) -+{ -+ int i; -+ -+ for (i = 0; i < NUM_ORDERS; i++) -+ if (order == orders[i]) -+ return i; -+ BUG(); -+ return -1; -+} -+ -+static inline unsigned int order_to_size(int order) -+{ -+ return PAGE_SIZE << order; -+} -+ -+struct ion_system_heap { -+ struct ion_heap heap; -+ struct ion_page_pool *pools[NUM_ORDERS]; -+}; -+ -+static struct page *alloc_buffer_page(struct ion_system_heap *heap, -+ struct ion_buffer *buffer, -+ unsigned long order) -+{ -+ struct ion_page_pool *pool = heap->pools[order_to_index(order)]; -+ -+ return ion_page_pool_alloc(pool); -+} -+ -+static void free_buffer_page(struct ion_system_heap *heap, -+ struct ion_buffer *buffer, struct page *page) -+{ -+ struct ion_page_pool *pool; -+ unsigned int order = compound_order(page); -+ -+ /* go to system */ -+ if (buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE) { -+ __free_pages(page, order); -+ return; -+ } -+ -+ pool = heap->pools[order_to_index(order)]; -+ -+ ion_page_pool_free(pool, page); -+} -+ -+static struct page *alloc_largest_available(struct ion_system_heap *heap, -+ struct ion_buffer *buffer, -+ unsigned long size, -+ unsigned int max_order) -+{ -+ struct page *page; -+ int i; -+ -+ for (i = 0; i < NUM_ORDERS; i++) { -+ if (size < order_to_size(orders[i])) -+ continue; -+ if (max_order < orders[i]) -+ continue; -+ -+ page = alloc_buffer_page(heap, buffer, orders[i]); -+ if (!page) -+ continue; -+ -+ return page; -+ } -+ -+ return NULL; -+} -+ -+static int ion_system_heap_allocate(struct ion_heap *heap, -+ struct ion_buffer *buffer, -+ unsigned long size, -+ unsigned long flags) -+{ -+ struct ion_system_heap *sys_heap = container_of(heap, -+ struct ion_system_heap, -+ heap); -+ struct sg_table *table; -+ struct scatterlist *sg; -+ struct list_head pages; -+ struct page *page, *tmp_page; -+ int i = 0; -+ unsigned long size_remaining = PAGE_ALIGN(size); -+ unsigned int max_order = orders[0]; -+ struct list_head lists[8]; -+ unsigned int block_index[8] = {0}; -+ unsigned int block_1M = 0; -+ unsigned int block_64K = 0; -+ unsigned int maximum; -+ int j; -+ -+ if (size / PAGE_SIZE > totalram_pages() / 2) -+ return -ENOMEM; -+ -+ INIT_LIST_HEAD(&pages); -+ for (i = 0; i < 8; i++) -+ INIT_LIST_HEAD(&lists[i]); -+ -+ i = 0; -+ while (size_remaining > 0) { -+ page = alloc_largest_available(sys_heap, buffer, size_remaining, -+ max_order); -+ if (!page) -+ goto free_pages; -+ -+ size_remaining -= page_size(page); -+ max_order = compound_order(page); -+ if (max_order) { -+ if (max_order == 8) -+ block_1M++; -+ if (max_order == 4) -+ block_64K++; -+ list_add_tail(&page->lru, &pages); -+ } else { -+ dma_addr_t phys = page_to_phys(page); -+ unsigned int bit12_14 = (phys >> 12) & 0x7; -+ -+ list_add_tail(&page->lru, &lists[bit12_14]); -+ block_index[bit12_14]++; -+ } -+ -+ i++; -+ } -+ -+ pr_debug("%s, %d, i = %d, size = %ld\n", __func__, __LINE__, i, size); -+ -+ table = kmalloc(sizeof(*table), GFP_KERNEL); -+ if (!table) -+ goto free_pages; -+ -+ if (sg_alloc_table(table, i, GFP_KERNEL)) -+ goto free_table; -+ -+ maximum = block_index[0]; -+ for (i = 1; i < 8; i++) -+ maximum = max(maximum, block_index[i]); -+ -+ pr_debug("%s, %d, maximum = %d, block_1M = %d, block_64K = %d\n", -+ __func__, __LINE__, maximum, block_1M, block_64K); -+ -+ for (i = 0; i < 8; i++) -+ pr_debug("block_index[%d] = %d\n", i, block_index[i]); -+ -+ sg = table->sgl; -+ list_for_each_entry_safe(page, tmp_page, &pages, lru) { -+ sg_set_page(sg, page, page_size(page), 0); -+ sg = sg_next(sg); -+ list_del(&page->lru); -+ } -+ -+ for (i = 0; i < maximum; i++) { -+ for (j = 0; j < 8; j++) { -+ if (!list_empty(&lists[j])) { -+ page = list_first_entry(&lists[j], struct page, -+ lru); -+ sg_set_page(sg, page, PAGE_SIZE, 0); -+ sg = sg_next(sg); -+ list_del(&page->lru); -+ } -+ } -+ } -+ -+ buffer->sg_table = table; -+ -+ ion_buffer_prep_noncached(buffer); -+ -+ return 0; -+ -+free_table: -+ kfree(table); -+free_pages: -+ list_for_each_entry_safe(page, tmp_page, &pages, lru) -+ free_buffer_page(sys_heap, buffer, page); -+ -+ for (i = 0; i < 8; i++) { -+ list_for_each_entry_safe(page, tmp_page, &lists[i], lru) -+ free_buffer_page(sys_heap, buffer, page); -+ } -+ return -ENOMEM; -+} -+ -+static void ion_system_heap_free(struct ion_buffer *buffer) -+{ -+ struct ion_system_heap *sys_heap = container_of(buffer->heap, -+ struct ion_system_heap, -+ heap); -+ struct sg_table *table = buffer->sg_table; -+ struct scatterlist *sg; -+ int i; -+ -+ /* zero the buffer before goto page pool */ -+ if (!(buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE)) -+ ion_buffer_zero(buffer); -+ -+ for_each_sgtable_sg(table, sg, i) -+ free_buffer_page(sys_heap, buffer, sg_page(sg)); -+ sg_free_table(table); -+ kfree(table); -+} -+ -+static int ion_system_heap_shrink(struct ion_heap *heap, gfp_t gfp_mask, -+ int nr_to_scan) -+{ -+ struct ion_page_pool *pool; -+ struct ion_system_heap *sys_heap; -+ int nr_total = 0; -+ int i, nr_freed; -+ int only_scan = 0; -+ -+ sys_heap = container_of(heap, struct ion_system_heap, heap); -+ -+ if (!nr_to_scan) -+ only_scan = 1; -+ -+ for (i = 0; i < NUM_ORDERS; i++) { -+ pool = sys_heap->pools[i]; -+ -+ if (only_scan) { -+ nr_total += ion_page_pool_shrink(pool, -+ gfp_mask, -+ nr_to_scan); -+ -+ } else { -+ nr_freed = ion_page_pool_shrink(pool, -+ gfp_mask, -+ nr_to_scan); -+ nr_to_scan -= nr_freed; -+ nr_total += nr_freed; -+ if (nr_to_scan <= 0) -+ break; -+ } -+ } -+ return nr_total; -+} -+ -+static long ion_system_get_pool_size(struct ion_heap *heap) -+{ -+ struct ion_system_heap *sys_heap; -+ long total_pages = 0; -+ int i; -+ -+ sys_heap = container_of(heap, struct ion_system_heap, heap); -+ for (i = 0; i < NUM_ORDERS; i++) -+ total_pages += ion_page_pool_nr_pages(sys_heap->pools[i]); -+ -+ return total_pages; -+} -+ -+static void ion_system_heap_destroy_pools(struct ion_page_pool **pools) -+{ -+ int i; -+ -+ for (i = 0; i < NUM_ORDERS; i++) -+ if (pools[i]) -+ ion_page_pool_destroy(pools[i]); -+} -+ -+static int ion_system_heap_create_pools(struct ion_page_pool **pools) -+{ -+ int i; -+ -+ for (i = 0; i < NUM_ORDERS; i++) { -+ struct ion_page_pool *pool; -+ gfp_t gfp_flags = low_order_gfp_flags; -+ -+ if (orders[i] > 4) -+ gfp_flags = high_order_gfp_flags; -+ -+ pool = ion_page_pool_create(gfp_flags, orders[i]); -+ if (!pool) -+ goto err_create_pool; -+ pools[i] = pool; -+ } -+ -+ return 0; -+ -+err_create_pool: -+ ion_system_heap_destroy_pools(pools); -+ return -ENOMEM; -+} -+ -+static struct ion_heap_ops system_heap_ops = { -+ .allocate = ion_system_heap_allocate, -+ .free = ion_system_heap_free, -+ .shrink = ion_system_heap_shrink, -+ .get_pool_size = ion_system_get_pool_size, -+}; -+ -+static struct ion_system_heap system_heap = { -+ .heap = { -+ .ops = &system_heap_ops, -+ .type = ION_HEAP_TYPE_SYSTEM, -+ .flags = ION_HEAP_FLAG_DEFER_FREE, -+ .name = "ion_system_heap", -+ } -+}; -+ -+static int __init ion_system_heap_init(void) -+{ -+ int ret = ion_system_heap_create_pools(system_heap.pools); -+ if (ret) -+ return ret; -+ -+ return ion_device_add_heap(&system_heap.heap); -+} -+ -+static void __exit ion_system_heap_exit(void) -+{ -+ ion_device_remove_heap(&system_heap.heap); -+ ion_system_heap_destroy_pools(system_heap.pools); -+} -+ -+module_init(ion_system_heap_init); -+module_exit(ion_system_heap_exit); -+MODULE_LICENSE("GPL v2"); -diff --git a/drivers/staging/android/ion/ion.c b/drivers/staging/android/ion/ion.c -new file mode 100644 -index 000000000..3d9ec5f10 ---- /dev/null -+++ b/drivers/staging/android/ion/ion.c -@@ -0,0 +1,518 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * ION Memory Allocator -+ * -+ * Copyright (C) 2011 Google, Inc. -+ * Copyright (c) 2019, The Linux Foundation. All rights reserved. -+ * -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "ion_private.h" -+ -+#define ION_CURRENT_ABI_VERSION 2 -+ -+static struct ion_device *internal_dev; -+ -+/* Entry into ION allocator for rest of the kernel */ -+struct dma_buf *ion_alloc(size_t len, unsigned int heap_id_mask, -+ unsigned int flags) -+{ -+ return ion_dmabuf_alloc(internal_dev, len, heap_id_mask, flags); -+} -+EXPORT_SYMBOL_GPL(ion_alloc); -+ -+int ion_free(struct ion_buffer *buffer) -+{ -+ return ion_buffer_destroy(internal_dev, buffer); -+} -+EXPORT_SYMBOL_GPL(ion_free); -+ -+static int ion_alloc_fd(size_t len, unsigned int heap_id_mask, -+ unsigned int flags) -+{ -+ int fd; -+ struct dma_buf *dmabuf; -+ -+ dmabuf = ion_dmabuf_alloc(internal_dev, len, heap_id_mask, flags); -+ if (IS_ERR(dmabuf)) -+ return PTR_ERR(dmabuf); -+ -+ fd = dma_buf_fd(dmabuf, O_CLOEXEC); -+ if (fd < 0) -+ dma_buf_put(dmabuf); -+ -+ return fd; -+} -+ -+size_t ion_query_heaps_kernel(struct ion_heap_data *hdata, size_t size) -+{ -+ struct ion_device *dev = internal_dev; -+ size_t i = 0, num_heaps = 0; -+ struct ion_heap *heap; -+ -+ down_read(&dev->lock); -+ -+ // If size is 0, return without updating hdata. -+ if (size == 0) { -+ num_heaps = dev->heap_cnt; -+ goto out; -+ } -+ -+ plist_for_each_entry(heap, &dev->heaps, node) { -+ strncpy(hdata[i].name, heap->name, MAX_HEAP_NAME); -+ hdata[i].name[MAX_HEAP_NAME - 1] = '\0'; -+ hdata[i].type = heap->type; -+ hdata[i].heap_id = heap->id; -+ -+ i++; -+ if (i >= size) -+ break; -+ } -+ -+ num_heaps = i; -+out: -+ up_read(&dev->lock); -+ return num_heaps; -+} -+EXPORT_SYMBOL_GPL(ion_query_heaps_kernel); -+ -+static int ion_query_heaps(struct ion_heap_query *query) -+{ -+ struct ion_device *dev = internal_dev; -+ struct ion_heap_data __user *buffer = u64_to_user_ptr(query->heaps); -+ int ret = -EINVAL, cnt = 0, max_cnt; -+ struct ion_heap *heap; -+ struct ion_heap_data hdata; -+ -+ memset(&hdata, 0, sizeof(hdata)); -+ -+ down_read(&dev->lock); -+ if (!buffer) { -+ query->cnt = dev->heap_cnt; -+ ret = 0; -+ goto out; -+ } -+ -+ if (query->cnt <= 0) -+ goto out; -+ -+ max_cnt = query->cnt; -+ -+ plist_for_each_entry(heap, &dev->heaps, node) { -+ strncpy(hdata.name, heap->name, MAX_HEAP_NAME); -+ hdata.name[sizeof(hdata.name) - 1] = '\0'; -+ hdata.type = heap->type; -+ hdata.heap_id = heap->id; -+ -+ if (copy_to_user(&buffer[cnt], &hdata, sizeof(hdata))) { -+ ret = -EFAULT; -+ goto out; -+ } -+ -+ cnt++; -+ if (cnt >= max_cnt) -+ break; -+ } -+ -+ query->cnt = cnt; -+ ret = 0; -+out: -+ up_read(&dev->lock); -+ return ret; -+} -+ -+union ion_ioctl_arg { -+ struct ion_allocation_data allocation; -+ struct ion_heap_query query; -+ u32 ion_abi_version; -+}; -+ -+static int validate_ioctl_arg(unsigned int cmd, union ion_ioctl_arg *arg) -+{ -+ switch (cmd) { -+ case ION_IOC_HEAP_QUERY: -+ if (arg->query.reserved0 || -+ arg->query.reserved1 || -+ arg->query.reserved2) -+ return -EINVAL; -+ break; -+ default: -+ break; -+ } -+ -+ return 0; -+} -+ -+static long ion_ioctl(struct file *filp, unsigned int cmd, unsigned long arg) -+{ -+ int ret = 0; -+ union ion_ioctl_arg data; -+ -+ if (_IOC_SIZE(cmd) > sizeof(data)) -+ return -EINVAL; -+ -+ /* -+ * The copy_from_user is unconditional here for both read and write -+ * to do the validate. If there is no write for the ioctl, the -+ * buffer is cleared -+ */ -+ if (copy_from_user(&data, (void __user *)arg, _IOC_SIZE(cmd))) -+ return -EFAULT; -+ -+ ret = validate_ioctl_arg(cmd, &data); -+ if (ret) { -+ pr_warn_once("%s: ioctl validate failed\n", __func__); -+ return ret; -+ } -+ -+ if (!(_IOC_DIR(cmd) & _IOC_WRITE)) -+ memset(&data, 0, sizeof(data)); -+ -+ switch (cmd) { -+ case ION_IOC_ALLOC: -+ { -+ int fd; -+ -+ fd = ion_alloc_fd(data.allocation.len, -+ data.allocation.heap_id_mask, -+ data.allocation.flags); -+ if (fd < 0) -+ return fd; -+ -+ data.allocation.fd = fd; -+ -+ break; -+ } -+ case ION_IOC_HEAP_QUERY: -+ ret = ion_query_heaps(&data.query); -+ break; -+ case ION_IOC_ABI_VERSION: -+ data.ion_abi_version = ION_CURRENT_ABI_VERSION; -+ break; -+ default: -+ return -ENOTTY; -+ } -+ -+ if (_IOC_DIR(cmd) & _IOC_READ) { -+ if (copy_to_user((void __user *)arg, &data, _IOC_SIZE(cmd))) -+ return -EFAULT; -+ } -+ return ret; -+} -+ -+static const struct file_operations ion_fops = { -+ .owner = THIS_MODULE, -+ .unlocked_ioctl = ion_ioctl, -+ .compat_ioctl = compat_ptr_ioctl, -+}; -+ -+static int debug_shrink_set(void *data, u64 val) -+{ -+ struct ion_heap *heap = data; -+ struct shrink_control sc; -+ int objs; -+ -+ sc.gfp_mask = GFP_HIGHUSER; -+ sc.nr_to_scan = val; -+ -+ if (!val) { -+ objs = heap->shrinker.count_objects(&heap->shrinker, &sc); -+ sc.nr_to_scan = objs; -+ } -+ -+ heap->shrinker.scan_objects(&heap->shrinker, &sc); -+ return 0; -+} -+ -+static int debug_shrink_get(void *data, u64 *val) -+{ -+ struct ion_heap *heap = data; -+ struct shrink_control sc; -+ int objs; -+ -+ sc.gfp_mask = GFP_HIGHUSER; -+ sc.nr_to_scan = 0; -+ -+ objs = heap->shrinker.count_objects(&heap->shrinker, &sc); -+ *val = objs; -+ return 0; -+} -+ -+DEFINE_SIMPLE_ATTRIBUTE(debug_shrink_fops, debug_shrink_get, -+ debug_shrink_set, "%llu\n"); -+ -+static int ion_assign_heap_id(struct ion_heap *heap, struct ion_device *dev) -+{ -+ int id_bit = -EINVAL; -+ int start_bit = -1, end_bit = -1; -+ -+ switch (heap->type) { -+ case ION_HEAP_TYPE_SYSTEM: -+ id_bit = __ffs(ION_HEAP_SYSTEM); -+ break; -+ case ION_HEAP_TYPE_DMA: -+ start_bit = __ffs(ION_HEAP_DMA_START); -+ end_bit = __ffs(ION_HEAP_DMA_END); -+ break; -+ case ION_HEAP_TYPE_CUSTOM ... ION_HEAP_TYPE_MAX: -+ start_bit = __ffs(ION_HEAP_CUSTOM_START); -+ end_bit = __ffs(ION_HEAP_CUSTOM_END); -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ /* For carveout, dma & custom heaps, we first let the heaps choose their -+ * own IDs. This allows the old behaviour of knowing the heap ids -+ * of these type of heaps in advance in user space. If a heap with -+ * that ID already exists, it is an error. -+ * -+ * If the heap hasn't picked an id by itself, then we assign it -+ * one. -+ */ -+ if (id_bit < 0) { -+ if (heap->id) { -+ id_bit = __ffs(heap->id); -+ if (id_bit < start_bit || id_bit > end_bit) -+ return -EINVAL; -+ } else { -+ id_bit = find_next_zero_bit(dev->heap_ids, end_bit + 1, -+ start_bit); -+ if (id_bit > end_bit) -+ return -ENOSPC; -+ } -+ } -+ -+ if (test_and_set_bit(id_bit, dev->heap_ids)) -+ return -EEXIST; -+ heap->id = id_bit; -+ dev->heap_cnt++; -+ -+ return 0; -+} -+ -+int __ion_device_add_heap(struct ion_heap *heap, struct module *owner) -+{ -+ struct ion_device *dev = internal_dev; -+ int ret; -+ struct dentry *heap_root; -+ char debug_name[64]; -+ -+ if (!heap || !heap->ops || !heap->ops->allocate || !heap->ops->free) { -+ pr_err("%s: invalid heap or heap_ops\n", __func__); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ heap->owner = owner; -+ spin_lock_init(&heap->free_lock); -+ spin_lock_init(&heap->stat_lock); -+ heap->free_list_size = 0; -+ -+ if (heap->flags & ION_HEAP_FLAG_DEFER_FREE) { -+ ret = ion_heap_init_deferred_free(heap); -+ if (ret) -+ goto out_heap_cleanup; -+ } -+ -+ if ((heap->flags & ION_HEAP_FLAG_DEFER_FREE) || heap->ops->shrink) { -+ ret = ion_heap_init_shrinker(heap); -+ if (ret) { -+ pr_err("%s: Failed to register shrinker\n", __func__); -+ goto out_heap_cleanup; -+ } -+ } -+ -+ heap->num_of_buffers = 0; -+ heap->num_of_alloc_bytes = 0; -+ heap->alloc_bytes_wm = 0; -+ -+ heap_root = debugfs_create_dir(heap->name, dev->debug_root); -+ debugfs_create_u64("num_of_buffers", -+ 0444, heap_root, -+ &heap->num_of_buffers); -+ debugfs_create_u64("num_of_alloc_bytes", -+ 0444, -+ heap_root, -+ &heap->num_of_alloc_bytes); -+ debugfs_create_u64("alloc_bytes_wm", -+ 0444, -+ heap_root, -+ &heap->alloc_bytes_wm); -+ -+ if (heap->shrinker.count_objects && -+ heap->shrinker.scan_objects) { -+ snprintf(debug_name, 64, "%s_shrink", heap->name); -+ debugfs_create_file(debug_name, -+ 0644, -+ heap_root, -+ heap, -+ &debug_shrink_fops); -+ } -+ -+ heap->debugfs_dir = heap_root; -+ down_write(&dev->lock); -+ ret = ion_assign_heap_id(heap, dev); -+ if (ret) { -+ pr_err("%s: Failed to assign heap id for heap type %x\n", -+ __func__, heap->type); -+ up_write(&dev->lock); -+ goto out_debugfs_cleanup; -+ } -+ -+ /* -+ * use negative heap->id to reverse the priority -- when traversing -+ * the list later attempt higher id numbers first -+ */ -+ plist_node_init(&heap->node, -heap->id); -+ plist_add(&heap->node, &dev->heaps); -+ -+ up_write(&dev->lock); -+ -+ return 0; -+ -+out_debugfs_cleanup: -+ debugfs_remove_recursive(heap->debugfs_dir); -+out_heap_cleanup: -+ ion_heap_cleanup(heap); -+out: -+ return ret; -+} -+EXPORT_SYMBOL_GPL(__ion_device_add_heap); -+ -+void ion_device_remove_heap(struct ion_heap *heap) -+{ -+ struct ion_device *dev = internal_dev; -+ -+ if (!heap) { -+ pr_err("%s: Invalid argument\n", __func__); -+ return; -+ } -+ -+ // take semaphore and remove the heap from dev->heap list -+ down_write(&dev->lock); -+ /* So no new allocations can happen from this heap */ -+ plist_del(&heap->node, &dev->heaps); -+ if (ion_heap_cleanup(heap) != 0) { -+ pr_warn("%s: failed to cleanup heap (%s)\n", -+ __func__, heap->name); -+ } -+ debugfs_remove_recursive(heap->debugfs_dir); -+ clear_bit(heap->id, dev->heap_ids); -+ dev->heap_cnt--; -+ up_write(&dev->lock); -+} -+EXPORT_SYMBOL_GPL(ion_device_remove_heap); -+ -+static ssize_t -+total_heaps_kb_show(struct kobject *kobj, struct kobj_attribute *attr, -+ char *buf) -+{ -+ return sprintf(buf, "%llu\n", -+ div_u64(ion_get_total_heap_bytes(), 1024)); -+} -+ -+static ssize_t -+total_pools_kb_show(struct kobject *kobj, struct kobj_attribute *attr, -+ char *buf) -+{ -+ struct ion_device *dev = internal_dev; -+ struct ion_heap *heap; -+ u64 total_pages = 0; -+ -+ down_read(&dev->lock); -+ plist_for_each_entry(heap, &dev->heaps, node) -+ if (heap->ops->get_pool_size) -+ total_pages += heap->ops->get_pool_size(heap); -+ up_read(&dev->lock); -+ -+ return sprintf(buf, "%llu\n", total_pages * (PAGE_SIZE / 1024)); -+} -+ -+static struct kobj_attribute total_heaps_kb_attr = -+ __ATTR_RO(total_heaps_kb); -+ -+static struct kobj_attribute total_pools_kb_attr = -+ __ATTR_RO(total_pools_kb); -+ -+static struct attribute *ion_device_attrs[] = { -+ &total_heaps_kb_attr.attr, -+ &total_pools_kb_attr.attr, -+ NULL, -+}; -+ -+ATTRIBUTE_GROUPS(ion_device); -+ -+static int ion_init_sysfs(void) -+{ -+ struct kobject *ion_kobj; -+ int ret; -+ -+ ion_kobj = kobject_create_and_add("ion", kernel_kobj); -+ if (!ion_kobj) -+ return -ENOMEM; -+ -+ ret = sysfs_create_groups(ion_kobj, ion_device_groups); -+ if (ret) { -+ kobject_put(ion_kobj); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static int ion_device_create(void) -+{ -+ struct ion_device *idev; -+ int ret; -+ -+ idev = kzalloc(sizeof(*idev), GFP_KERNEL); -+ if (!idev) -+ return -ENOMEM; -+ -+ idev->dev.minor = MISC_DYNAMIC_MINOR; -+ idev->dev.name = "ion"; -+ idev->dev.fops = &ion_fops; -+ idev->dev.parent = NULL; -+ ret = misc_register(&idev->dev); -+ if (ret) { -+ pr_err("ion: failed to register misc device.\n"); -+ goto err_reg; -+ } -+ -+ ret = ion_init_sysfs(); -+ if (ret) { -+ pr_err("ion: failed to add sysfs attributes.\n"); -+ goto err_sysfs; -+ } -+ -+ idev->debug_root = debugfs_create_dir("ion", NULL); -+ init_rwsem(&idev->lock); -+ plist_head_init(&idev->heaps); -+ internal_dev = idev; -+ return 0; -+ -+err_sysfs: -+ misc_deregister(&idev->dev); -+err_reg: -+ kfree(idev); -+ return ret; -+} -+subsys_initcall(ion_device_create); -diff --git a/drivers/staging/android/ion/ion_buffer.c b/drivers/staging/android/ion/ion_buffer.c -new file mode 100644 -index 000000000..9baca1a47 ---- /dev/null -+++ b/drivers/staging/android/ion/ion_buffer.c -@@ -0,0 +1,278 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * ION Memory Allocator - buffer interface -+ * -+ * Copyright (c) 2019, Google, Inc. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+ -+#define CREATE_TRACE_POINTS -+#include "ion_trace.h" -+#include "ion_private.h" -+ -+static atomic_long_t total_heap_bytes; -+ -+static void track_buffer_created(struct ion_buffer *buffer) -+{ -+ long total = atomic_long_add_return(buffer->size, &total_heap_bytes); -+ -+ trace_ion_stat(buffer->sg_table, buffer->size, total); -+} -+ -+static void track_buffer_destroyed(struct ion_buffer *buffer) -+{ -+ long total = atomic_long_sub_return(buffer->size, &total_heap_bytes); -+ -+ trace_ion_stat(buffer->sg_table, -buffer->size, total); -+} -+ -+/* this function should only be called while dev->lock is held */ -+static struct ion_buffer *ion_buffer_create(struct ion_heap *heap, -+ struct ion_device *dev, -+ unsigned long len, -+ unsigned long flags) -+{ -+ struct ion_buffer *buffer; -+ int ret; -+ -+ buffer = kzalloc(sizeof(*buffer), GFP_KERNEL); -+ if (!buffer) -+ return ERR_PTR(-ENOMEM); -+ -+ buffer->heap = heap; -+ buffer->flags = flags; -+ buffer->size = len; -+ -+ ret = heap->ops->allocate(heap, buffer, len, flags); -+ -+ if (ret) { -+ if (!(heap->flags & ION_HEAP_FLAG_DEFER_FREE)) -+ goto err2; -+ -+ ion_heap_freelist_drain(heap, 0); -+ ret = heap->ops->allocate(heap, buffer, len, flags); -+ if (ret) -+ goto err2; -+ } -+ -+ if (!buffer->sg_table) { -+ WARN_ONCE(1, "This heap needs to set the sgtable"); -+ ret = -EINVAL; -+ goto err1; -+ } -+ -+ spin_lock(&heap->stat_lock); -+ heap->num_of_buffers++; -+ heap->num_of_alloc_bytes += len; -+ if (heap->num_of_alloc_bytes > heap->alloc_bytes_wm) -+ heap->alloc_bytes_wm = heap->num_of_alloc_bytes; -+ if (heap->num_of_buffers == 1) { -+ /* This module reference lasts as long as at least one -+ * buffer is allocated from the heap. We are protected -+ * against ion_device_remove_heap() with dev->lock, so we can -+ * safely assume the module reference is going to* succeed. -+ */ -+ __module_get(heap->owner); -+ } -+ spin_unlock(&heap->stat_lock); -+ -+ INIT_LIST_HEAD(&buffer->attachments); -+ mutex_init(&buffer->lock); -+ track_buffer_created(buffer); -+ return buffer; -+ -+err1: -+ heap->ops->free(buffer); -+err2: -+ kfree(buffer); -+ return ERR_PTR(ret); -+} -+ -+static int ion_clear_pages(struct page **pages, int num, pgprot_t pgprot) -+{ -+ void *addr = vmap(pages, num, VM_MAP, pgprot); -+ -+ if (!addr) -+ return -ENOMEM; -+ memset(addr, 0, PAGE_SIZE * num); -+ vunmap(addr); -+ -+ return 0; -+} -+ -+static int ion_sglist_zero(struct scatterlist *sgl, unsigned int nents, -+ pgprot_t pgprot) -+{ -+ int p = 0; -+ int ret = 0; -+ struct sg_page_iter piter; -+ struct page *pages[32]; -+ -+ for_each_sg_page(sgl, &piter, nents, 0) { -+ pages[p++] = sg_page_iter_page(&piter); -+ if (p == ARRAY_SIZE(pages)) { -+ ret = ion_clear_pages(pages, p, pgprot); -+ if (ret) -+ return ret; -+ p = 0; -+ } -+ } -+ if (p) -+ ret = ion_clear_pages(pages, p, pgprot); -+ -+ return ret; -+} -+ -+struct ion_buffer *ion_buffer_alloc(struct ion_device *dev, size_t len, -+ unsigned int heap_id_mask, -+ unsigned int flags) -+{ -+ struct ion_buffer *buffer = NULL; -+ struct ion_heap *heap; -+ -+ if (!dev || !len) { -+ return ERR_PTR(-EINVAL); -+ } -+ -+ /* -+ * traverse the list of heaps available in this system in priority -+ * order. If the heap type is supported by the client, and matches the -+ * request of the caller allocate from it. Repeat until allocate has -+ * succeeded or all heaps have been tried -+ */ -+ len = PAGE_ALIGN(len); -+ if (!len) -+ return ERR_PTR(-EINVAL); -+ -+ down_read(&dev->lock); -+ plist_for_each_entry(heap, &dev->heaps, node) { -+ /* if the caller didn't specify this heap id */ -+ if (!((1 << heap->id) & heap_id_mask)) -+ continue; -+ buffer = ion_buffer_create(heap, dev, len, flags); -+ if (!IS_ERR(buffer)) -+ break; -+ } -+ up_read(&dev->lock); -+ -+ if (!buffer) -+ return ERR_PTR(-ENODEV); -+ -+ if (IS_ERR(buffer)) -+ return ERR_CAST(buffer); -+ -+ return buffer; -+} -+ -+int ion_buffer_zero(struct ion_buffer *buffer) -+{ -+ struct sg_table *table; -+ pgprot_t pgprot; -+ -+ if (!buffer) -+ return -EINVAL; -+ -+ table = buffer->sg_table; -+ if (buffer->flags & ION_FLAG_CACHED) -+ pgprot = PAGE_KERNEL; -+ else -+ pgprot = pgprot_writecombine(PAGE_KERNEL); -+ -+ return ion_sglist_zero(table->sgl, table->nents, pgprot); -+} -+EXPORT_SYMBOL_GPL(ion_buffer_zero); -+ -+void ion_buffer_prep_noncached(struct ion_buffer *buffer) -+{ -+ struct scatterlist *sg; -+ struct sg_table *table; -+ int i; -+ -+ if (WARN_ONCE(!buffer || !buffer->sg_table, -+ "%s needs a buffer and a sg_table", __func__) || -+ buffer->flags & ION_FLAG_CACHED) -+ return; -+ -+ table = buffer->sg_table; -+ -+ for_each_sg(table->sgl, sg, table->orig_nents, i) -+ arch_dma_prep_coherent(sg_page(sg), sg->length); -+} -+EXPORT_SYMBOL_GPL(ion_buffer_prep_noncached); -+ -+void ion_buffer_release(struct ion_buffer *buffer) -+{ -+ if (buffer->kmap_cnt > 0) { -+ pr_warn_once("%s: buffer still mapped in the kernel\n", -+ __func__); -+ ion_heap_unmap_kernel(buffer->heap, buffer); -+ } -+ buffer->heap->ops->free(buffer); -+ spin_lock(&buffer->heap->stat_lock); -+ buffer->heap->num_of_buffers--; -+ buffer->heap->num_of_alloc_bytes -= buffer->size; -+ if (buffer->heap->num_of_buffers == 0) -+ module_put(buffer->heap->owner); -+ spin_unlock(&buffer->heap->stat_lock); -+ /* drop reference to the heap module */ -+ -+ kfree(buffer); -+} -+ -+int ion_buffer_destroy(struct ion_device *dev, struct ion_buffer *buffer) -+{ -+ struct ion_heap *heap; -+ -+ if (!dev || !buffer) { -+ pr_warn("%s: invalid argument\n", __func__); -+ return -EINVAL; -+ } -+ -+ heap = buffer->heap; -+ track_buffer_destroyed(buffer); -+ -+ if (heap->flags & ION_HEAP_FLAG_DEFER_FREE) -+ ion_heap_freelist_add(heap, buffer); -+ else -+ ion_buffer_release(buffer); -+ -+ return 0; -+} -+ -+void *ion_buffer_kmap_get(struct ion_buffer *buffer) -+{ -+ void *vaddr; -+ -+ if (buffer->kmap_cnt) { -+ buffer->kmap_cnt++; -+ return buffer->vaddr; -+ } -+ vaddr = ion_heap_map_kernel(buffer->heap, buffer); -+ if (WARN_ONCE(!vaddr, -+ "heap->ops->map_kernel should return ERR_PTR on error")) -+ return ERR_PTR(-EINVAL); -+ if (IS_ERR(vaddr)) -+ return vaddr; -+ buffer->vaddr = vaddr; -+ buffer->kmap_cnt++; -+ return vaddr; -+} -+ -+void ion_buffer_kmap_put(struct ion_buffer *buffer) -+{ -+ buffer->kmap_cnt--; -+ if (!buffer->kmap_cnt) { -+ ion_heap_unmap_kernel(buffer->heap, buffer); -+ buffer->vaddr = NULL; -+ } -+} -+ -+u64 ion_get_total_heap_bytes(void) -+{ -+ return atomic_long_read(&total_heap_bytes); -+} -diff --git a/drivers/staging/android/ion/ion_dma_buf.c b/drivers/staging/android/ion/ion_dma_buf.c -new file mode 100644 -index 000000000..47ae54af5 ---- /dev/null -+++ b/drivers/staging/android/ion/ion_dma_buf.c -@@ -0,0 +1,359 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * ION Memory Allocator - dmabuf interface -+ * -+ * Copyright (c) 2019, Google, Inc. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+ -+#include "ion_private.h" -+ -+static struct sg_table *dup_sg_table(struct sg_table *table) -+{ -+ struct sg_table *new_table; -+ int ret, i; -+ struct scatterlist *sg, *new_sg; -+ -+ new_table = kzalloc(sizeof(*new_table), GFP_KERNEL); -+ if (!new_table) -+ return ERR_PTR(-ENOMEM); -+ -+ ret = sg_alloc_table(new_table, table->nents, GFP_KERNEL); -+ if (ret) { -+ kfree(new_table); -+ return ERR_PTR(-ENOMEM); -+ } -+ -+ new_sg = new_table->sgl; -+ for_each_sg(table->sgl, sg, table->nents, i) { -+ memcpy(new_sg, sg, sizeof(*sg)); -+ new_sg->dma_address = 0; -+ new_sg = sg_next(new_sg); -+ } -+ -+ return new_table; -+} -+ -+static void free_duped_table(struct sg_table *table) -+{ -+ sg_free_table(table); -+ kfree(table); -+} -+ -+static int ion_dma_buf_attach(struct dma_buf *dmabuf, -+ struct dma_buf_attachment *attachment) -+{ -+ struct ion_dma_buf_attachment *a; -+ struct sg_table *table; -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ -+ if (heap->buf_ops.attach) -+ return heap->buf_ops.attach(dmabuf, attachment); -+ -+ a = kzalloc(sizeof(*a), GFP_KERNEL); -+ if (!a) -+ return -ENOMEM; -+ -+ table = dup_sg_table(buffer->sg_table); -+ if (IS_ERR(table)) { -+ kfree(a); -+ return -ENOMEM; -+ } -+ -+ a->table = table; -+ a->dev = attachment->dev; -+ INIT_LIST_HEAD(&a->list); -+ a->mapped = false; -+ -+ attachment->priv = a; -+ -+ mutex_lock(&buffer->lock); -+ list_add(&a->list, &buffer->attachments); -+ mutex_unlock(&buffer->lock); -+ -+ return 0; -+} -+ -+static void ion_dma_buf_detatch(struct dma_buf *dmabuf, -+ struct dma_buf_attachment *attachment) -+{ -+ struct ion_dma_buf_attachment *a = attachment->priv; -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ -+ if (heap->buf_ops.detach) -+ return heap->buf_ops.detach(dmabuf, attachment); -+ -+ mutex_lock(&buffer->lock); -+ list_del(&a->list); -+ mutex_unlock(&buffer->lock); -+ free_duped_table(a->table); -+ -+ kfree(a); -+} -+ -+static struct sg_table *ion_map_dma_buf(struct dma_buf_attachment *attachment, -+ enum dma_data_direction direction) -+{ -+ struct ion_buffer *buffer = attachment->dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ struct ion_dma_buf_attachment *a; -+ struct sg_table *table; -+ unsigned long attrs = attachment->dma_map_attrs; -+ -+ if (heap->buf_ops.map_dma_buf) -+ return heap->buf_ops.map_dma_buf(attachment, direction); -+ -+ a = attachment->priv; -+ table = a->table; -+ -+ if (!(buffer->flags & ION_FLAG_CACHED)) -+ attrs |= DMA_ATTR_SKIP_CPU_SYNC; -+ -+ if (!dma_map_sg_attrs(attachment->dev, table->sgl, table->nents, -+ direction, attrs)) -+ return ERR_PTR(-ENOMEM); -+ -+ a->mapped = true; -+ -+ return table; -+} -+ -+static void ion_unmap_dma_buf(struct dma_buf_attachment *attachment, -+ struct sg_table *table, -+ enum dma_data_direction direction) -+{ -+ struct ion_buffer *buffer = attachment->dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ struct ion_dma_buf_attachment *a = attachment->priv; -+ unsigned long attrs = attachment->dma_map_attrs; -+ -+ if (heap->buf_ops.unmap_dma_buf) -+ return heap->buf_ops.unmap_dma_buf(attachment, table, -+ direction); -+ -+ a->mapped = false; -+ -+ if (!(buffer->flags & ION_FLAG_CACHED)) -+ attrs |= DMA_ATTR_SKIP_CPU_SYNC; -+ -+ dma_unmap_sg_attrs(attachment->dev, table->sgl, table->nents, -+ direction, attrs); -+} -+ -+static void ion_dma_buf_release(struct dma_buf *dmabuf) -+{ -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ -+ if (heap->buf_ops.release) -+ return heap->buf_ops.release(dmabuf); -+ -+ ion_free(buffer); -+} -+ -+static int ion_dma_buf_begin_cpu_access(struct dma_buf *dmabuf, -+ enum dma_data_direction direction) -+{ -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ struct ion_dma_buf_attachment *a; -+ -+ if (heap->buf_ops.begin_cpu_access) -+ return heap->buf_ops.begin_cpu_access(dmabuf, direction); -+ -+ mutex_lock(&buffer->lock); -+ if (!(buffer->flags & ION_FLAG_CACHED)) -+ goto unlock; -+ -+ list_for_each_entry(a, &buffer->attachments, list) { -+ if (!a->mapped) -+ continue; -+ dma_sync_sg_for_cpu(a->dev, a->table->sgl, a->table->nents, -+ direction); -+ } -+ -+unlock: -+ mutex_unlock(&buffer->lock); -+ return 0; -+} -+ -+static int -+ion_dma_buf_begin_cpu_access_partial(struct dma_buf *dmabuf, -+ enum dma_data_direction direction, -+ unsigned int offset, unsigned int len) -+{ -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ -+ /* This is done to make sure partial buffer cache flush / invalidate is -+ * allowed. The implementation may be vendor specific in this case, so -+ * ion core does not provide a default implementation -+ */ -+ if (!heap->buf_ops.begin_cpu_access_partial) -+ return -EOPNOTSUPP; -+ -+ return heap->buf_ops.begin_cpu_access_partial(dmabuf, direction, offset, -+ len); -+} -+ -+static int ion_dma_buf_end_cpu_access(struct dma_buf *dmabuf, -+ enum dma_data_direction direction) -+{ -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ struct ion_dma_buf_attachment *a; -+ -+ if (heap->buf_ops.end_cpu_access) -+ return heap->buf_ops.end_cpu_access(dmabuf, direction); -+ -+ mutex_lock(&buffer->lock); -+ if (!(buffer->flags & ION_FLAG_CACHED)) -+ goto unlock; -+ -+ list_for_each_entry(a, &buffer->attachments, list) { -+ if (!a->mapped) -+ continue; -+ dma_sync_sg_for_device(a->dev, a->table->sgl, a->table->nents, -+ direction); -+ } -+unlock: -+ mutex_unlock(&buffer->lock); -+ -+ return 0; -+} -+ -+static int ion_dma_buf_end_cpu_access_partial(struct dma_buf *dmabuf, -+ enum dma_data_direction direction, -+ unsigned int offset, -+ unsigned int len) -+{ -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ -+ /* This is done to make sure partial buffer cache flush / invalidate is -+ * allowed. The implementation may be vendor specific in this case, so -+ * ion core does not provide a default implementation -+ */ -+ if (!heap->buf_ops.end_cpu_access_partial) -+ return -EOPNOTSUPP; -+ -+ return heap->buf_ops.end_cpu_access_partial(dmabuf, direction, offset, -+ len); -+} -+ -+static int ion_dma_buf_mmap(struct dma_buf *dmabuf, struct vm_area_struct *vma) -+{ -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ int ret; -+ -+ /* now map it to userspace */ -+ if (heap->buf_ops.mmap) { -+ ret = heap->buf_ops.mmap(dmabuf, vma); -+ } else { -+ mutex_lock(&buffer->lock); -+ if (!(buffer->flags & ION_FLAG_CACHED)) -+ vma->vm_page_prot = -+ pgprot_writecombine(vma->vm_page_prot); -+ -+ ret = ion_heap_map_user(heap, buffer, vma); -+ mutex_unlock(&buffer->lock); -+ } -+ -+ if (ret) -+ pr_err("%s: failure mapping buffer to userspace\n", __func__); -+ -+ return ret; -+} -+ -+static void *ion_dma_buf_vmap(struct dma_buf *dmabuf) -+{ -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ void *vaddr; -+ -+ if (heap->buf_ops.vmap) -+ return heap->buf_ops.vmap(dmabuf); -+ -+ mutex_lock(&buffer->lock); -+ vaddr = ion_buffer_kmap_get(buffer); -+ mutex_unlock(&buffer->lock); -+ -+ return vaddr; -+} -+ -+static void ion_dma_buf_vunmap(struct dma_buf *dmabuf, void *vaddr) -+{ -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ -+ if (heap->buf_ops.vunmap) { -+ heap->buf_ops.vunmap(dmabuf, vaddr); -+ return; -+ } -+ -+ mutex_lock(&buffer->lock); -+ ion_buffer_kmap_put(buffer); -+ mutex_unlock(&buffer->lock); -+} -+ -+static int ion_dma_buf_get_flags(struct dma_buf *dmabuf, unsigned long *flags) -+{ -+ struct ion_buffer *buffer = dmabuf->priv; -+ struct ion_heap *heap = buffer->heap; -+ -+ if (!heap->buf_ops.get_flags) -+ return -EOPNOTSUPP; -+ -+ return heap->buf_ops.get_flags(dmabuf, flags); -+} -+ -+static const struct dma_buf_ops dma_buf_ops = { -+ .attach = ion_dma_buf_attach, -+ .detach = ion_dma_buf_detatch, -+ .map_dma_buf = ion_map_dma_buf, -+ .unmap_dma_buf = ion_unmap_dma_buf, -+ .release = ion_dma_buf_release, -+ .begin_cpu_access = ion_dma_buf_begin_cpu_access, -+ .begin_cpu_access_partial = ion_dma_buf_begin_cpu_access_partial, -+ .end_cpu_access = ion_dma_buf_end_cpu_access, -+ .end_cpu_access_partial = ion_dma_buf_end_cpu_access_partial, -+ .mmap = ion_dma_buf_mmap, -+ .vmap = ion_dma_buf_vmap, -+ .vunmap = ion_dma_buf_vunmap, -+ .get_flags = ion_dma_buf_get_flags, -+}; -+ -+struct dma_buf *ion_dmabuf_alloc(struct ion_device *dev, size_t len, -+ unsigned int heap_id_mask, -+ unsigned int flags) -+{ -+ struct ion_buffer *buffer; -+ DEFINE_DMA_BUF_EXPORT_INFO(exp_info); -+ struct dma_buf *dmabuf; -+ -+ pr_debug("%s: len %zu heap_id_mask %u flags %x\n", __func__, -+ len, heap_id_mask, flags); -+ -+ buffer = ion_buffer_alloc(dev, len, heap_id_mask, flags); -+ if (IS_ERR(buffer)) -+ return ERR_CAST(buffer); -+ -+ exp_info.ops = &dma_buf_ops; -+ exp_info.size = buffer->size; -+ exp_info.flags = O_RDWR; -+ exp_info.priv = buffer; -+ -+ dmabuf = dma_buf_export(&exp_info); -+ if (IS_ERR(dmabuf)) -+ ion_buffer_destroy(dev, buffer); -+ -+ return dmabuf; -+} -diff --git a/drivers/staging/android/ion/ion_heap.c b/drivers/staging/android/ion/ion_heap.c -new file mode 100644 -index 000000000..aa29a4ee4 ---- /dev/null -+++ b/drivers/staging/android/ion/ion_heap.c -@@ -0,0 +1,291 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * ION Memory Allocator generic heap helpers -+ * -+ * Copyright (C) 2011 Google, Inc. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "ion_private.h" -+ -+static unsigned long ion_heap_shrink_count(struct shrinker *shrinker, -+ struct shrink_control *sc) -+{ -+ struct ion_heap *heap = container_of(shrinker, struct ion_heap, -+ shrinker); -+ int total = 0; -+ -+ total = ion_heap_freelist_size(heap) / PAGE_SIZE; -+ -+ if (heap->ops->shrink) -+ total += heap->ops->shrink(heap, sc->gfp_mask, 0); -+ -+ return total; -+} -+ -+static unsigned long ion_heap_shrink_scan(struct shrinker *shrinker, -+ struct shrink_control *sc) -+{ -+ struct ion_heap *heap = container_of(shrinker, struct ion_heap, -+ shrinker); -+ int freed = 0; -+ int to_scan = sc->nr_to_scan; -+ -+ if (to_scan == 0) -+ return 0; -+ -+ /* -+ * shrink the free list first, no point in zeroing the memory if we're -+ * just going to reclaim it. Also, skip any possible page pooling. -+ */ -+ if (heap->flags & ION_HEAP_FLAG_DEFER_FREE) -+ freed = ion_heap_freelist_shrink(heap, to_scan * PAGE_SIZE) / -+ PAGE_SIZE; -+ -+ to_scan -= freed; -+ if (to_scan <= 0) -+ return freed; -+ -+ if (heap->ops->shrink) -+ freed += heap->ops->shrink(heap, sc->gfp_mask, to_scan); -+ -+ return freed; -+} -+ -+static size_t _ion_heap_freelist_drain(struct ion_heap *heap, size_t size, -+ bool skip_pools) -+{ -+ struct ion_buffer *buffer; -+ size_t total_drained = 0; -+ -+ if (ion_heap_freelist_size(heap) == 0) -+ return 0; -+ -+ spin_lock(&heap->free_lock); -+ if (size == 0) -+ size = heap->free_list_size; -+ -+ while (!list_empty(&heap->free_list)) { -+ if (total_drained >= size) -+ break; -+ buffer = list_first_entry(&heap->free_list, struct ion_buffer, -+ list); -+ list_del(&buffer->list); -+ heap->free_list_size -= buffer->size; -+ if (skip_pools) -+ buffer->private_flags |= ION_PRIV_FLAG_SHRINKER_FREE; -+ total_drained += buffer->size; -+ spin_unlock(&heap->free_lock); -+ ion_buffer_release(buffer); -+ spin_lock(&heap->free_lock); -+ } -+ spin_unlock(&heap->free_lock); -+ -+ return total_drained; -+} -+ -+static int ion_heap_deferred_free(void *data) -+{ -+ struct ion_heap *heap = data; -+ -+ while (true) { -+ struct ion_buffer *buffer; -+ -+ wait_event_freezable(heap->waitqueue, -+ (ion_heap_freelist_size(heap) > 0 || -+ kthread_should_stop())); -+ -+ spin_lock(&heap->free_lock); -+ if (list_empty(&heap->free_list)) { -+ spin_unlock(&heap->free_lock); -+ if (!kthread_should_stop()) -+ continue; -+ break; -+ } -+ buffer = list_first_entry(&heap->free_list, struct ion_buffer, -+ list); -+ list_del(&buffer->list); -+ heap->free_list_size -= buffer->size; -+ spin_unlock(&heap->free_lock); -+ ion_buffer_release(buffer); -+ } -+ -+ return 0; -+} -+ -+void *ion_heap_map_kernel(struct ion_heap *heap, -+ struct ion_buffer *buffer) -+{ -+ struct scatterlist *sg; -+ int i, j; -+ void *vaddr; -+ pgprot_t pgprot; -+ struct sg_table *table = buffer->sg_table; -+ int npages = PAGE_ALIGN(buffer->size) / PAGE_SIZE; -+ struct page **pages = vmalloc(array_size(npages, -+ sizeof(struct page *))); -+ struct page **tmp = pages; -+ -+ if (!pages) -+ return ERR_PTR(-ENOMEM); -+ -+ if (buffer->flags & ION_FLAG_CACHED) -+ pgprot = PAGE_KERNEL; -+ else -+ pgprot = pgprot_writecombine(PAGE_KERNEL); -+ -+ for_each_sg(table->sgl, sg, table->nents, i) { -+ int npages_this_entry = PAGE_ALIGN(sg->length) / PAGE_SIZE; -+ struct page *page = sg_page(sg); -+ -+ BUG_ON(i >= npages); -+ for (j = 0; j < npages_this_entry; j++) -+ *(tmp++) = page++; -+ } -+ vaddr = vmap(pages, npages, VM_MAP, pgprot); -+ vfree(pages); -+ -+ if (!vaddr) -+ return ERR_PTR(-ENOMEM); -+ -+ return vaddr; -+} -+EXPORT_SYMBOL_GPL(ion_heap_map_kernel); -+ -+void ion_heap_unmap_kernel(struct ion_heap *heap, -+ struct ion_buffer *buffer) -+{ -+ vunmap(buffer->vaddr); -+} -+EXPORT_SYMBOL_GPL(ion_heap_unmap_kernel); -+ -+int ion_heap_map_user(struct ion_heap *heap, struct ion_buffer *buffer, -+ struct vm_area_struct *vma) -+{ -+ struct sg_table *table = buffer->sg_table; -+ unsigned long addr = vma->vm_start; -+ unsigned long offset = vma->vm_pgoff * PAGE_SIZE; -+ struct scatterlist *sg; -+ int i; -+ int ret; -+ -+ for_each_sg(table->sgl, sg, table->nents, i) { -+ struct page *page = sg_page(sg); -+ unsigned long remainder = vma->vm_end - addr; -+ unsigned long len = sg->length; -+ -+ if (offset >= sg->length) { -+ offset -= sg->length; -+ continue; -+ } else if (offset) { -+ page += offset / PAGE_SIZE; -+ len = sg->length - offset; -+ offset = 0; -+ } -+ len = min(len, remainder); -+ ret = remap_pfn_range(vma, addr, page_to_pfn(page), len, -+ vma->vm_page_prot); -+ if (ret) -+ return ret; -+ addr += len; -+ if (addr >= vma->vm_end) -+ return 0; -+ } -+ -+ return 0; -+} -+EXPORT_SYMBOL_GPL(ion_heap_map_user); -+ -+void ion_heap_freelist_add(struct ion_heap *heap, struct ion_buffer *buffer) -+{ -+ spin_lock(&heap->free_lock); -+ list_add(&buffer->list, &heap->free_list); -+ heap->free_list_size += buffer->size; -+ spin_unlock(&heap->free_lock); -+ wake_up(&heap->waitqueue); -+} -+ -+size_t ion_heap_freelist_size(struct ion_heap *heap) -+{ -+ size_t size; -+ -+ spin_lock(&heap->free_lock); -+ size = heap->free_list_size; -+ spin_unlock(&heap->free_lock); -+ -+ return size; -+} -+ -+size_t ion_heap_freelist_drain(struct ion_heap *heap, size_t size) -+{ -+ return _ion_heap_freelist_drain(heap, size, false); -+} -+ -+size_t ion_heap_freelist_shrink(struct ion_heap *heap, size_t size) -+{ -+ return _ion_heap_freelist_drain(heap, size, true); -+} -+ -+int ion_heap_init_deferred_free(struct ion_heap *heap) -+{ -+ INIT_LIST_HEAD(&heap->free_list); -+ init_waitqueue_head(&heap->waitqueue); -+ heap->task = kthread_run(ion_heap_deferred_free, heap, -+ "%s", heap->name); -+ if (IS_ERR(heap->task)) { -+ pr_err("%s: creating thread for deferred free failed\n", -+ __func__); -+ return PTR_ERR_OR_ZERO(heap->task); -+ } -+ sched_set_normal(heap->task, 19); -+ -+ return 0; -+} -+ -+int ion_heap_init_shrinker(struct ion_heap *heap) -+{ -+ heap->shrinker.count_objects = ion_heap_shrink_count; -+ heap->shrinker.scan_objects = ion_heap_shrink_scan; -+ heap->shrinker.seeks = DEFAULT_SEEKS; -+ heap->shrinker.batch = 0; -+ -+ return register_shrinker(&heap->shrinker); -+} -+ -+int ion_heap_cleanup(struct ion_heap *heap) -+{ -+ int ret; -+ -+ if (heap->flags & ION_HEAP_FLAG_DEFER_FREE && -+ !IS_ERR_OR_NULL(heap->task)) { -+ size_t free_list_size = ion_heap_freelist_size(heap); -+ size_t total_drained = ion_heap_freelist_drain(heap, 0); -+ -+ if (total_drained != free_list_size) { -+ pr_err("%s: %s heap drained %zu bytes, requested %zu\n", -+ __func__, heap->name, free_list_size, -+ total_drained); -+ return -EBUSY; -+ } -+ ret = kthread_stop(heap->task); -+ if (ret < 0) { -+ pr_err("%s: failed to stop heap free thread\n", -+ __func__); -+ return ret; -+ } -+ } -+ -+ if ((heap->flags & ION_HEAP_FLAG_DEFER_FREE) || heap->ops->shrink) -+ unregister_shrinker(&heap->shrinker); -+ -+ return 0; -+} -diff --git a/drivers/staging/android/ion/ion_private.h b/drivers/staging/android/ion/ion_private.h -new file mode 100644 -index 000000000..db4e90683 ---- /dev/null -+++ b/drivers/staging/android/ion/ion_private.h -@@ -0,0 +1,58 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * ION Memory Allocator - Internal header -+ * -+ * Copyright (C) 2019 Google, Inc. -+ */ -+ -+#ifndef _ION_PRIVATE_H -+#define _ION_PRIVATE_H -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/** -+ * struct ion_device - the metadata of the ion device node -+ * @dev: the actual misc device -+ * @lock: rwsem protecting the tree of heaps, heap_bitmap and -+ * clients -+ * @heap_ids: bitmap of register heap ids -+ */ -+struct ion_device { -+ struct miscdevice dev; -+ struct rw_semaphore lock; -+ DECLARE_BITMAP(heap_ids, ION_NUM_MAX_HEAPS); -+ struct plist_head heaps; -+ struct dentry *debug_root; -+ int heap_cnt; -+}; -+ -+/* ion_buffer manipulators */ -+extern struct ion_buffer *ion_buffer_alloc(struct ion_device *dev, size_t len, -+ unsigned int heap_id_mask, -+ unsigned int flags); -+extern void ion_buffer_release(struct ion_buffer *buffer); -+extern int ion_buffer_destroy(struct ion_device *dev, -+ struct ion_buffer *buffer); -+extern void *ion_buffer_kmap_get(struct ion_buffer *buffer); -+extern void ion_buffer_kmap_put(struct ion_buffer *buffer); -+ -+/* ion dmabuf allocator */ -+extern struct dma_buf *ion_dmabuf_alloc(struct ion_device *dev, size_t len, -+ unsigned int heap_id_mask, -+ unsigned int flags); -+extern int ion_free(struct ion_buffer *buffer); -+ -+/* ion heap helpers */ -+extern int ion_heap_cleanup(struct ion_heap *heap); -+ -+u64 ion_get_total_heap_bytes(void); -+ -+#endif /* _ION_PRIVATE_H */ -diff --git a/drivers/staging/android/ion/ion_protected_heap.c b/drivers/staging/android/ion/ion_protected_heap.c -new file mode 100644 -index 000000000..c7f25373a ---- /dev/null -+++ b/drivers/staging/android/ion/ion_protected_heap.c -@@ -0,0 +1,526 @@ -+// SPDX-License-Identifier: GPL-2.0-only -+/* -+ * Copyright (c) 2021 Rockchip Electronics Co. Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "ion.h" -+ -+#define ION_HEAP_TYPE_PROTECTED (ION_HEAP_TYPE_CUSTOM + 1) -+ -+#define NUM_ORDERS ARRAY_SIZE(orders) -+ -+static unsigned int orders[] = {8, 4, 0}; -+ -+static struct reserved_mem *protected_reserved_memory; -+ -+#ifdef CONFIG_OF_RESERVED_MEM -+static int __init protected_dma_setup(struct reserved_mem *rmem) -+{ -+ protected_reserved_memory = rmem; -+ -+ pr_info("ION: created protected pool at %pa, size %ld MiB\n", -+ &rmem->base, (unsigned long)rmem->size / SZ_1M); -+ -+ return 0; -+} -+ -+RESERVEDMEM_OF_DECLARE(protected, "protected-dma-pool", protected_dma_setup); -+#endif -+ -+static int order_to_index(unsigned int order) -+{ -+ int i; -+ -+ for (i = 0; i < NUM_ORDERS; i++) -+ if (order == orders[i]) -+ return i; -+ -+ return 0; -+} -+ -+static inline unsigned int order_to_size(int order) -+{ -+ return PAGE_SIZE << order; -+} -+ -+static void protected_pool_add(struct ion_page_pool *pool, struct page *page) -+{ -+ mutex_lock(&pool->mutex); -+ if (PageHighMem(page)) { -+ list_add_tail(&page->lru, &pool->high_items); -+ pool->high_count++; -+ } else { -+ list_add_tail(&page->lru, &pool->low_items); -+ pool->low_count++; -+ } -+ mutex_unlock(&pool->mutex); -+} -+ -+static struct page *protected_pool_remove(struct ion_page_pool *pool, -+ bool high) -+{ -+ struct page *page; -+ -+ if (high) { -+ page = list_first_entry(&pool->high_items, struct page, lru); -+ pool->high_count--; -+ } else { -+ page = list_first_entry(&pool->low_items, struct page, lru); -+ pool->low_count--; -+ } -+ list_del(&page->lru); -+ -+ return page; -+} -+ -+static struct page *protected_pool_alloc(struct ion_page_pool *pool) -+{ -+ struct page *page = NULL; -+ -+ mutex_lock(&pool->mutex); -+ if (pool->high_count) -+ page = protected_pool_remove(pool, true); -+ else if (pool->low_count) -+ page = protected_pool_remove(pool, false); -+ mutex_unlock(&pool->mutex); -+ -+ return page; -+} -+ -+static void protected_pool_free(struct ion_page_pool *pool, -+ struct page *page) -+{ -+ protected_pool_add(pool, page); -+} -+ -+static int protected_pool_total(struct ion_page_pool *pool) -+{ -+ return (pool->low_count + pool->high_count) << pool->order; -+} -+ -+static int protected_pool_shrink(struct ion_page_pool *pool, -+ struct gen_pool *rmem, -+ int nr_to_scan) -+{ -+ int freed = 0; -+ -+ if (nr_to_scan == 0) -+ return protected_pool_total(pool); -+ -+ while (freed < nr_to_scan) { -+ struct page *page; -+ -+ mutex_lock(&pool->mutex); -+ if (pool->low_count) { -+ page = protected_pool_remove(pool, false); -+ } else if (pool->high_count) { -+ page = protected_pool_remove(pool, true); -+ } else { -+ mutex_unlock(&pool->mutex); -+ break; -+ } -+ mutex_unlock(&pool->mutex); -+ gen_pool_free(rmem, page_to_phys(page), -+ order_to_size(pool->order)); -+ freed += (1 << pool->order); -+ } -+ -+ return freed; -+} -+ -+static struct ion_page_pool *protected_pool_create(unsigned int order) -+{ -+ struct ion_page_pool *pool = kzalloc(sizeof(*pool), GFP_KERNEL); -+ -+ if (!pool) -+ return NULL; -+ -+ pool->high_count = 0; -+ pool->low_count = 0; -+ INIT_LIST_HEAD(&pool->low_items); -+ INIT_LIST_HEAD(&pool->high_items); -+ pool->order = order; -+ mutex_init(&pool->mutex); -+ plist_node_init(&pool->list, order); -+ -+ return pool; -+} -+ -+static void protected_pool_destroy(struct ion_page_pool *pool) -+{ -+ kfree(pool); -+} -+ -+struct ion_protected_heap { -+ struct ion_heap heap; -+ struct gen_pool *rmem; -+ struct ion_page_pool *pools[NUM_ORDERS]; -+}; -+ -+struct page_info { -+ struct page *page; -+ struct list_head list; -+ unsigned long order; -+}; -+ -+static void free_buffer_page(struct ion_heap *heap, -+ struct ion_buffer *buffer, -+ struct page *page, -+ unsigned long order) -+{ -+ struct ion_page_pool *pool; -+ struct ion_protected_heap *pheap; -+ -+ pheap = container_of(heap, struct ion_protected_heap, heap); -+ if (buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE) { -+ gen_pool_free(pheap->rmem, page_to_phys(page), -+ order_to_size(order)); -+ return; -+ } -+ -+ pool = pheap->pools[order_to_index(order)]; -+ protected_pool_free(pool, page); -+} -+ -+static struct page *alloc_buffer_page(struct ion_heap *heap, -+ struct ion_buffer *buffer, -+ unsigned long order) -+{ -+ struct ion_page_pool *pool; -+ struct ion_protected_heap *pheap; -+ struct page *page; -+ unsigned long paddr; -+ -+ pheap = container_of(heap, struct ion_protected_heap, heap); -+ pool = pheap->pools[order_to_index(order)]; -+ page = protected_pool_alloc(pool); -+ if (!page) { -+ paddr = gen_pool_alloc(pheap->rmem, order_to_size(order)); -+ if (WARN_ON(!paddr)) -+ return NULL; -+ page = phys_to_page(paddr); -+ } -+ -+ return page; -+} -+ -+static struct page_info *alloc_largest_available(struct ion_heap *heap, -+ struct ion_buffer *buffer, -+ unsigned long size, -+ unsigned int max_order) -+{ -+ struct page_info *info; -+ struct page *page; -+ int i; -+ -+ info = kmalloc(sizeof(*info), GFP_KERNEL); -+ if (!info) -+ return NULL; -+ -+ for (i = 0; i < NUM_ORDERS; i++) { -+ if (size < order_to_size(orders[i])) -+ continue; -+ if (max_order < orders[i]) -+ continue; -+ -+ page = alloc_buffer_page(heap, buffer, orders[i]); -+ if (IS_ERR(page)) -+ continue; -+ -+ info->page = page; -+ info->order = orders[i]; -+ INIT_LIST_HEAD(&info->list); -+ return info; -+ } -+ kfree(info); -+ -+ return NULL; -+} -+ -+static int ion_protected_heap_allocate(struct ion_heap *heap, -+ struct ion_buffer *buffer, -+ unsigned long size, -+ unsigned long flags) -+{ -+ struct list_head pages; -+ struct list_head lists[8]; -+ struct page_info *info, *tmp; -+ struct scatterlist *sg; -+ struct sg_table *table; -+ unsigned int block_index[8] = {0}; -+ unsigned int max_order = orders[0], maximum; -+ unsigned long size_remaining = PAGE_ALIGN(size); -+ int i, j; -+ -+ if (size / PAGE_SIZE > totalram_pages / 2) -+ return -ENOMEM; -+ -+ INIT_LIST_HEAD(&pages); -+ for (i = 0; i < 8; i++) -+ INIT_LIST_HEAD(&lists[i]); -+ -+ i = 0; -+ while (size_remaining > 0) { -+ info = alloc_largest_available(heap, buffer, size_remaining, -+ max_order); -+ if (!info) -+ goto free_pages; -+ -+ size_remaining -= PAGE_SIZE << info->order; -+ max_order = info->order; -+ if (max_order) { -+ list_add_tail(&info->list, &pages); -+ } else { -+ dma_addr_t phys = page_to_phys(info->page); -+ unsigned int bit12_14 = (phys >> 12) & 0x7; -+ -+ list_add_tail(&info->list, &lists[bit12_14]); -+ block_index[bit12_14]++; -+ } -+ -+ i++; -+ } -+ -+ table = kmalloc(sizeof(*table), GFP_KERNEL); -+ if (!table) -+ goto free_pages; -+ -+ if (sg_alloc_table(table, i, GFP_KERNEL)) -+ goto free_table; -+ -+ maximum = block_index[0]; -+ for (i = 1; i < 8; i++) -+ maximum = max(maximum, block_index[i]); -+ -+ sg = table->sgl; -+ list_for_each_entry_safe(info, tmp, &pages, list) { -+ sg_set_page(sg, info->page, PAGE_SIZE << info->order, 0); -+ sg = sg_next(sg); -+ list_del(&info->list); -+ } -+ -+ for (i = 0; i < maximum; i++) { -+ for (j = 0; j < 8; j++) { -+ if (list_empty(&lists[j])) -+ continue; -+ -+ info = list_first_entry(&lists[j], struct page_info, -+ list); -+ sg_set_page(sg, info->page, PAGE_SIZE, 0); -+ sg = sg_next(sg); -+ list_del(&info->list); -+ } -+ } -+ buffer->sg_table = table; -+ -+ return 0; -+free_table: -+ kfree(table); -+free_pages: -+ list_for_each_entry_safe(info, tmp, &pages, list) -+ free_buffer_page(heap, buffer, info->page, info->order); -+ -+ for (i = 0; i < 8; i++) { -+ list_for_each_entry_safe(info, tmp, &lists[i], list) -+ free_buffer_page(heap, buffer, info->page, info->order); -+ } -+ -+ return -ENOMEM; -+} -+ -+static void ion_protected_heap_free(struct ion_buffer *buffer) -+{ -+ struct sg_table *table = buffer->sg_table; -+ struct scatterlist *sg; -+ int i; -+ -+ /* zero the buffer before goto page pool */ -+ if (!(buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE)) -+ ion_heap_buffer_zero(buffer); -+ -+ for_each_sg(table->sgl, sg, table->nents, i) -+ free_buffer_page(buffer->heap, buffer, sg_page(sg), -+ get_order(sg->length)); -+ sg_free_table(table); -+ kfree(table); -+} -+ -+static int ion_protected_heap_shrink(struct ion_heap *heap, gfp_t gfp_mask, -+ int nr_to_scan) -+{ -+ struct ion_page_pool *pool; -+ struct ion_protected_heap *pheap; -+ int nr_total = 0; -+ int i, nr_freed; -+ int only_scan = 0; -+ -+ pheap = container_of(heap, struct ion_protected_heap, heap); -+ if (!nr_to_scan) -+ only_scan = 1; -+ -+ for (i = 0; i < NUM_ORDERS; i++) { -+ pool = pheap->pools[i]; -+ -+ if (only_scan) { -+ nr_total += protected_pool_shrink(pool, -+ pheap->rmem, -+ nr_to_scan); -+ -+ } else { -+ nr_freed = protected_pool_shrink(pool, -+ pheap->rmem, -+ nr_to_scan); -+ nr_to_scan -= nr_freed; -+ nr_total += nr_freed; -+ if (nr_to_scan <= 0) -+ break; -+ } -+ } -+ -+ return nr_total; -+} -+ -+static struct ion_heap_ops protected_heap_ops = { -+ .allocate = ion_protected_heap_allocate, -+ .free = ion_protected_heap_free, -+ .map_kernel = ion_heap_map_kernel, -+ .unmap_kernel = ion_heap_unmap_kernel, -+ .map_user = ion_heap_map_user, -+ .shrink = ion_protected_heap_shrink, -+}; -+ -+static int ion_protected_heap_debug_show(struct ion_heap *heap, -+ struct seq_file *s, -+ void *unused) -+{ -+ struct ion_protected_heap *pheap; -+ struct ion_page_pool *pool; -+ int i; -+ -+ pheap = container_of(heap, struct ion_protected_heap, heap); -+ for (i = 0; i < NUM_ORDERS; i++) { -+ pool = pheap->pools[i]; -+ -+ seq_printf(s, "%d order %u highmem pages %lu total\n", -+ pool->high_count, pool->order, -+ (PAGE_SIZE << pool->order) * pool->high_count); -+ seq_printf(s, "%d order %u lowmem pages %lu total\n", -+ pool->low_count, pool->order, -+ (PAGE_SIZE << pool->order) * pool->low_count); -+ } -+ -+ return 0; -+} -+ -+static void ion_protected_heap_destroy_pools(struct ion_page_pool **pools) -+{ -+ int i; -+ -+ for (i = 0; i < NUM_ORDERS; i++) -+ if (pools[i]) -+ protected_pool_destroy(pools[i]); -+} -+ -+static int ion_protected_heap_create_pools(struct ion_page_pool **pools) -+{ -+ struct ion_page_pool *pool; -+ int i; -+ -+ for (i = 0; i < NUM_ORDERS; i++) { -+ pool = protected_pool_create(orders[i]); -+ if (!pool) -+ goto err_create_pool; -+ -+ pools[i] = pool; -+ } -+ -+ return 0; -+err_create_pool: -+ ion_protected_heap_destroy_pools(pools); -+ -+ return -ENOMEM; -+} -+ -+static int ion_protected_heap_create_rmem(struct gen_pool **pool) -+{ -+ struct gen_pool *mpool; -+ struct reserved_mem *rmem = protected_reserved_memory; -+ int ret; -+ -+ if (!rmem) -+ return -ENOENT; -+ -+ mpool = gen_pool_create(PAGE_SHIFT, -1); -+ if (!mpool) -+ return -ENOMEM; -+ -+ ret = gen_pool_add(mpool, rmem->base, rmem->size, -1); -+ if (ret) { -+ gen_pool_destroy(mpool); -+ return ret; -+ } -+ *pool = mpool; -+ -+ return 0; -+} -+ -+static struct ion_heap *__ion_protected_heap_create(void) -+{ -+ struct ion_protected_heap *heap; -+ -+ heap = kzalloc(sizeof(*heap), GFP_KERNEL); -+ if (!heap) -+ return ERR_PTR(-ENOMEM); -+ -+ heap->heap.ops = &protected_heap_ops; -+ heap->heap.type = ION_HEAP_TYPE_PROTECTED; -+ heap->heap.flags = ION_HEAP_FLAG_DEFER_FREE; -+ heap->heap.name = "ion_protected_heap"; -+ -+ if (ion_protected_heap_create_pools(heap->pools)) -+ goto free_heap; -+ -+ if (ion_protected_heap_create_rmem(&heap->rmem)) -+ goto destroy_pool; -+ -+ heap->heap.debug_show = ion_protected_heap_debug_show; -+ -+ return &heap->heap; -+destroy_pool: -+ ion_protected_heap_destroy_pools(heap->pools); -+free_heap: -+ kfree(heap); -+ -+ return ERR_PTR(-ENOMEM); -+} -+ -+int ion_protected_heap_create(void) -+{ -+ struct ion_heap *heap; -+ -+ heap = __ion_protected_heap_create(); -+ if (IS_ERR(heap)) -+ return PTR_ERR(heap); -+ -+ ion_device_add_heap(heap); -+ -+ return 0; -+} -+ -+#ifndef CONFIG_ION_MODULE -+device_initcall(ion_protected_heap_create); -+#endif -diff --git a/drivers/staging/android/ion/ion_trace.h b/drivers/staging/android/ion/ion_trace.h -new file mode 100644 -index 000000000..eacb47d4f ---- /dev/null -+++ b/drivers/staging/android/ion/ion_trace.h -@@ -0,0 +1,55 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * drivers/staging/android/ion/ion-trace.h -+ * -+ * Copyright (C) 2020 Google, Inc. -+ */ -+ -+#undef TRACE_SYSTEM -+#define TRACE_SYSTEM ion -+ -+#if !defined(_ION_TRACE_H) || defined(TRACE_HEADER_MULTI_READ) -+#define _ION_TRACE_H -+ -+#include -+ -+#ifndef __ION_PTR_TO_HASHVAL -+static unsigned int __maybe_unused __ion_ptr_to_hash(const void *ptr) -+{ -+ unsigned long hashval; -+ -+ if (ptr_to_hashval(ptr, &hashval)) -+ return 0; -+ -+ /* The hashed value is only 32-bit */ -+ return (unsigned int)hashval; -+} -+ -+#define __ION_PTR_TO_HASHVAL -+#endif -+ -+TRACE_EVENT(ion_stat, -+ TP_PROTO(const void *addr, long len, -+ unsigned long total_allocated), -+ TP_ARGS(addr, len, total_allocated), -+ TP_STRUCT__entry(__field(unsigned int, buffer_id) -+ __field(long, len) -+ __field(unsigned long, total_allocated) -+ ), -+ TP_fast_assign(__entry->buffer_id = __ion_ptr_to_hash(addr); -+ __entry->len = len; -+ __entry->total_allocated = total_allocated; -+ ), -+ TP_printk("buffer_id=%u len=%ldB total_allocated=%ldB", -+ __entry->buffer_id, -+ __entry->len, -+ __entry->total_allocated) -+ ); -+ -+#endif /* _ION_TRACE_H */ -+ -+/* This part must be outside protection */ -+#undef TRACE_INCLUDE_PATH -+#define TRACE_INCLUDE_PATH . -+#define TRACE_INCLUDE_FILE ion_trace -+#include -diff --git a/drivers/staging/android/ion/rockchip/Makefile b/drivers/staging/android/ion/rockchip/Makefile -new file mode 100644 -index 000000000..89265fcbb ---- /dev/null -+++ b/drivers/staging/android/ion/rockchip/Makefile -@@ -0,0 +1,3 @@ -+# SPDX-License-Identifier: GPL-2.0 -+obj-y += rockchip_ion.o -+obj-$(CONFIG_ION_ROCKCHIP_SNAPSHOT) += rockchip_ion_snapshot.o -diff --git a/drivers/staging/android/ion/rockchip/rockchip_ion.c b/drivers/staging/android/ion/rockchip/rockchip_ion.c -new file mode 100644 -index 000000000..d3c3d0685 ---- /dev/null -+++ b/drivers/staging/android/ion/rockchip/rockchip_ion.c -@@ -0,0 +1,224 @@ -+/* -+ * drivers/staging/android/ion/rockchip/rockchip_ion.c -+ * -+ * Copyright (C) 2014 ROCKCHIP, Inc. -+ * -+ * This software is licensed under the terms of the GNU General Public -+ * License version 2, as published by the Free Software Foundation, and -+ * may be copied, distributed, and modified under those terms. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT 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 -+#include -+#include -+#include -+#include -+ -+#include "../ion_priv.h" -+ -+struct ion_device *rockchip_ion_dev; -+static struct ion_heap **heaps; -+ -+struct ion_heap_desc { -+ unsigned int id; -+ enum ion_heap_type type; -+ const char *name; -+}; -+ -+static struct ion_heap_desc ion_heap_meta[] = { -+ { -+ .id = ION_HEAP_TYPE_SYSTEM, -+ .type = ION_HEAP_TYPE_SYSTEM, -+ .name = "system-heap", -+ }, { -+ .id = ION_HEAP_TYPE_CARVEOUT, -+ .type = ION_HEAP_TYPE_CARVEOUT, -+ .name = "carveout-heap", -+ }, { -+ .id = ION_HEAP_TYPE_DMA, -+ .type = ION_HEAP_TYPE_DMA, -+ .name = "cma-heap", -+ }, -+}; -+ -+/* Return result of step for heap array. */ -+static int rk_ion_of_heap(struct ion_platform_heap *myheap, -+ struct device_node *node) -+{ -+ unsigned int reg[2] = {0,}; -+ int itype; -+ -+ for (itype = 0; itype < ARRAY_SIZE(ion_heap_meta); itype++) { -+ if (strcmp(ion_heap_meta[itype].name, node->name)) -+ continue; -+ -+ myheap->name = node->name; -+ myheap->align = SZ_1M; -+ myheap->id = ion_heap_meta[itype].id; -+ if (!strcmp("cma-heap", node->name)) { -+ myheap->type = ION_HEAP_TYPE_DMA; -+ if (!of_property_read_u32_array(node, "reg", reg, 2)) { -+ myheap->base = reg[0]; -+ myheap->size = reg[1]; -+ } -+ return 1; -+ } -+ -+ if (!strcmp("system-heap", node->name)) { -+ myheap->type = ION_HEAP_TYPE_SYSTEM; -+ return 1; -+ } -+ } -+ -+ return 0; -+} -+ -+static struct ion_platform_data *rk_ion_of(struct device_node *node) -+{ -+ struct ion_platform_data *pdata; -+ int iheap = 0; -+ struct device_node *child; -+ struct ion_platform_heap *myheap; -+ -+ pdata = kzalloc(sizeof(*pdata), GFP_KERNEL); -+ if (!pdata) -+ return NULL; -+ -+ pdata->nr = of_get_child_count(node); -+again: -+ pdata->heaps = kcalloc(pdata->nr, sizeof(*myheap), GFP_KERNEL); -+ for_each_child_of_node(node, child) { -+ iheap += rk_ion_of_heap(&pdata->heaps[iheap], child); -+ } -+ -+ if (pdata->nr != iheap) { -+ pdata->nr = iheap; -+ iheap = 0; -+ kfree(pdata->heaps); -+ pr_err("%s: mismatch, repeating\n", __func__); -+ goto again; -+ } -+ -+ return pdata; -+} -+ -+static int rk_ion_probe(struct platform_device *pdev) -+{ -+ int err; -+ int i; -+ struct ion_platform_data *pdata = pdev->dev.platform_data; -+ struct ion_device *idev; -+ -+ err = of_reserved_mem_device_init(&pdev->dev); -+ if (err) -+ pr_debug("No reserved memory region assign to ion\n"); -+ -+ if (!pdata) { -+ pdata = rk_ion_of(pdev->dev.of_node); -+ pdev->dev.platform_data = pdata; -+ } -+ -+ heaps = kcalloc(pdata->nr, sizeof(*heaps), GFP_KERNEL); -+ -+ idev = ion_device_create(NULL); -+ if (IS_ERR_OR_NULL(idev)) { -+ kfree(heaps); -+ return PTR_ERR(idev); -+ } -+ -+ ion_device_set_platform(idev, &pdev->dev); -+ rockchip_ion_dev = idev; -+ -+ /* create the heaps as specified in the board file */ -+ for (i = 0; i < pdata->nr; i++) { -+ struct ion_platform_heap *heap_data = &pdata->heaps[i]; -+ -+ heap_data->priv = &pdev->dev; -+ heaps[i] = ion_heap_create(heap_data); -+ if (IS_ERR_OR_NULL(heaps[i])) { -+ err = PTR_ERR(heaps[i]); -+ goto err; -+ } -+ pr_info("rockchip ion: success to create - %s\n", -+ heaps[i]->name); -+ ion_device_add_heap(idev, heaps[i]); -+ } -+ platform_set_drvdata(pdev, idev); -+ -+ return 0; -+err: -+ for (i = 0; i < pdata->nr; i++) { -+ if (heaps[i]) -+ ion_heap_destroy(heaps[i]); -+ } -+ -+ kfree(heaps); -+ return err; -+} -+ -+static int rk_ion_remove(struct platform_device *pdev) -+{ -+ struct ion_platform_data *pdata = pdev->dev.platform_data; -+ struct ion_device *idev = platform_get_drvdata(pdev); -+ int i; -+ -+ ion_device_destroy(idev); -+ for (i = 0; i < pdata->nr; i++) -+ ion_heap_destroy(heaps[i]); -+ -+ kfree(heaps); -+ return 0; -+} -+ -+struct ion_client *rockchip_ion_client_create(const char *name) -+{ -+ if (!rockchip_ion_dev) { -+ pr_err("rockchip ion idev is NULL\n"); -+ return NULL; -+ } -+ -+ return ion_client_create(rockchip_ion_dev, name); -+} -+EXPORT_SYMBOL_GPL(rockchip_ion_client_create); -+ -+static const struct of_device_id rk_ion_match[] = { -+ { .compatible = "rockchip,ion", }, -+ {} -+}; -+ -+static struct platform_driver ion_driver = { -+ .probe = rk_ion_probe, -+ .remove = rk_ion_remove, -+ .driver = { -+ .name = "ion-rk", -+ .owner = THIS_MODULE, -+ .of_match_table = of_match_ptr(rk_ion_match), -+ }, -+}; -+ -+static int __init rk_ion_init(void) -+{ -+ return platform_driver_register(&ion_driver); -+} -+ -+static void __exit rk_ion_exit(void) -+{ -+ platform_driver_unregister(&ion_driver); -+} -+ -+subsys_initcall(rk_ion_init); -+module_exit(rk_ion_exit); -+ -+MODULE_AUTHOR("Meiyou.chen "); -+MODULE_DESCRIPTION("ROCKCHIP Ion driver"); -+MODULE_LICENSE("GPL v2"); -+MODULE_DEVICE_TABLE(of, rk_ion_match); -diff --git a/drivers/staging/android/ion/rockchip/rockchip_ion_snapshot.c b/drivers/staging/android/ion/rockchip/rockchip_ion_snapshot.c -new file mode 100644 -index 000000000..ab27d0531 ---- /dev/null -+++ b/drivers/staging/android/ion/rockchip/rockchip_ion_snapshot.c -@@ -0,0 +1,145 @@ -+/* -+ * drivers/staging/android/ion/rockchip/rockchip_ion_snapshot.c -+ * -+ * Copyright (C) 2011-2014 ROCKCHIP, Inc. -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 as -+ * published by the Free Software Foundation. -+ */ -+ -+#define pr_fmt(fmt) "ion_snapshot: " fmt -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define LOG_BUF_LEN (1 << CONFIG_ION_SNAPSHOT_BUF_SHIFT) -+#define LOG_BUF_PAGE_ORDER (CONFIG_ION_SNAPSHOT_BUF_SHIFT - PAGE_SHIFT) -+// snapshot for last -+static char last_ion_buf[LOG_BUF_LEN]; -+// snapshot for current -+static char* ion_snapshot_buf; -+ -+static ssize_t last_ion_read(struct file *file, char __user *buf, -+ size_t len, loff_t *offset) -+{ -+ loff_t pos = *offset; -+ ssize_t count; -+ -+ if (pos >= LOG_BUF_LEN || last_ion_buf[0]==0) -+ return 0; -+ -+ count = min(len, (size_t)(LOG_BUF_LEN - pos)); -+ if (copy_to_user(buf, &last_ion_buf[pos], count)) -+ return -EFAULT; -+ -+ *offset += count; -+ return count; -+} -+ -+static const struct file_operations last_ion_fops = { -+ .owner = THIS_MODULE, -+ .read = last_ion_read, -+}; -+ -+static ssize_t ion_snapshot_read(struct file *file, char __user *buf, -+ size_t len, loff_t *offset) -+{ -+ loff_t pos = *offset; -+ ssize_t count; -+ -+ if (pos >= LOG_BUF_LEN || ion_snapshot_buf[0]==0) -+ return 0; -+ -+ count = min(len, (size_t)(LOG_BUF_LEN - pos)); -+ if (copy_to_user(buf, &ion_snapshot_buf[pos], count)) -+ return -EFAULT; -+ -+ *offset += count; -+ return count; -+} -+ -+static const struct file_operations ion_snapshot_fops = { -+ .owner = THIS_MODULE, -+ .read = ion_snapshot_read, -+}; -+ -+char *rockchip_ion_snapshot_get(size_t *size) -+{ -+ *size = LOG_BUF_LEN; -+ return ion_snapshot_buf; -+} -+ -+int rockchip_ion_snapshot_debugfs(struct dentry* root) -+{ -+ struct dentry* last_ion_dentry; -+ struct dentry* ion_snapshot_dentry; -+ -+ last_ion_dentry = debugfs_create_file("last_ion", 0664, -+ root, -+ NULL, &last_ion_fops); -+ if (!last_ion_dentry) { -+ char buf[256], *path; -+ path = dentry_path(root, buf, 256); -+ pr_err("Failed to create client debugfs at %s/%s\n", -+ path, "last_ion"); -+ } -+ -+ ion_snapshot_dentry = debugfs_create_file("ion_snapshot", 0664, -+ root, -+ NULL, &ion_snapshot_fops); -+ if (!ion_snapshot_dentry) { -+ char buf[256], *path; -+ path = dentry_path(root, buf, 256); -+ pr_err("Failed to create client debugfs at %s/%s\n", -+ path, "ion_snapshot"); -+ } -+ -+ return 0; -+} -+ -+static void * __init last_ion_vmap(phys_addr_t start, unsigned int page_count) -+{ -+ struct page *pages[page_count + 1]; -+ unsigned int i; -+ -+ for (i = 0; i < page_count; i++) { -+ phys_addr_t addr = start + i * PAGE_SIZE; -+ pages[i] = pfn_to_page(addr >> PAGE_SHIFT); -+ } -+ pages[page_count] = pfn_to_page(start >> PAGE_SHIFT); -+ return vmap(pages, page_count + 1, VM_MAP, pgprot_writecombine(PAGE_KERNEL)); -+} -+ -+static int __init rockchip_ion_snapshot_init(void) -+{ -+ char *log_buf; -+ -+ log_buf = (char *)__get_free_pages(GFP_KERNEL, LOG_BUF_PAGE_ORDER); -+ if (!log_buf) { -+ pr_err("failed to __get_free_pages(%d)\n", LOG_BUF_PAGE_ORDER); -+ return 0; -+ } -+ -+ ion_snapshot_buf = last_ion_vmap(virt_to_phys(log_buf), 1 << LOG_BUF_PAGE_ORDER); -+ if (!ion_snapshot_buf) { -+ pr_err("failed to map %d pages at 0x%lx\n", 1 << LOG_BUF_PAGE_ORDER, -+ (unsigned long)virt_to_phys(log_buf)); -+ return 0; -+ } -+ -+ pr_info("0x%lx map to 0x%p and copy to 0x%p (version 0.1)\n", -+ (unsigned long)virt_to_phys(log_buf), ion_snapshot_buf, -+ last_ion_buf); -+ -+ memcpy(last_ion_buf, ion_snapshot_buf, LOG_BUF_LEN); -+ memset(ion_snapshot_buf, 0, LOG_BUF_LEN); -+ -+ return 0; -+} -+ -+postcore_initcall(rockchip_ion_snapshot_init); -diff --git a/drivers/staging/android/uapi/ashmem.h b/drivers/staging/android/uapi/ashmem.h -new file mode 100644 -index 000000000..2d4673b60 ---- /dev/null -+++ b/drivers/staging/android/uapi/ashmem.h -@@ -0,0 +1,54 @@ -+/* SPDX-License-Identifier: GPL-2.0 OR Apache-2.0 */ -+/* -+ * drivers/staging/android/uapi/ashmem.h -+ * -+ * Copyright 2008 Google Inc. -+ * Author: Robert Love -+ */ -+ -+#ifndef _UAPI_LINUX_ASHMEM_H -+#define _UAPI_LINUX_ASHMEM_H -+ -+#include -+#include -+ -+#define ASHMEM_NAME_LEN 256 -+ -+#define ASHMEM_NAME_DEF "dev/ashmem" -+ -+/* Return values from ASHMEM_PIN: Was the mapping purged while unpinned? */ -+#define ASHMEM_NOT_PURGED 0 -+#define ASHMEM_WAS_PURGED 1 -+ -+/* Return values from ASHMEM_GET_PIN_STATUS: Is the mapping pinned? */ -+#define ASHMEM_IS_UNPINNED 0 -+#define ASHMEM_IS_PINNED 1 -+ -+struct ashmem_pin { -+ __u32 offset; /* offset into region, in bytes, page-aligned */ -+ __u32 len; /* length forward from offset, in bytes, page-aligned */ -+}; -+ -+#define __ASHMEMIOC 0x77 -+ -+#define ASHMEM_SET_NAME _IOW(__ASHMEMIOC, 1, char[ASHMEM_NAME_LEN]) -+#define ASHMEM_GET_NAME _IOR(__ASHMEMIOC, 2, char[ASHMEM_NAME_LEN]) -+#define ASHMEM_SET_SIZE _IOW(__ASHMEMIOC, 3, size_t) -+#define ASHMEM_GET_SIZE _IO(__ASHMEMIOC, 4) -+#define ASHMEM_SET_PROT_MASK _IOW(__ASHMEMIOC, 5, unsigned long) -+#define ASHMEM_GET_PROT_MASK _IO(__ASHMEMIOC, 6) -+#define ASHMEM_PIN _IOW(__ASHMEMIOC, 7, struct ashmem_pin) -+#define ASHMEM_UNPIN _IOW(__ASHMEMIOC, 8, struct ashmem_pin) -+#define ASHMEM_GET_PIN_STATUS _IO(__ASHMEMIOC, 9) -+#define ASHMEM_PURGE_ALL_CACHES _IO(__ASHMEMIOC, 10) -+ -+#ifdef CONFIG_PURGEABLE_ASHMEM -+#define PM_SUCCESS 0 -+#define PM_FAIL 1 -+ -+#define ASHMEM_SET_PURGEABLE _IO(__ASHMEMIOC, 11) -+#define ASHMEM_GET_PURGEABLE _IO(__ASHMEMIOC, 12) -+#define PURGEABLE_ASHMEM_IS_PURGED _IO(__ASHMEMIOC, 13) -+#define PURGEABLE_ASHMEM_REBUILD_SUCCESS _IO(__ASHMEMIOC, 14) -+#endif -+#endif /* _UAPI_LINUX_ASHMEM_H */ -diff --git a/drivers/staging/android/uapi/ion.h b/drivers/staging/android/uapi/ion.h -new file mode 100644 -index 000000000..46c93fcb4 ---- /dev/null -+++ b/drivers/staging/android/uapi/ion.h -@@ -0,0 +1,127 @@ -+/* SPDX-License-Identifier: GPL-2.0 WITH Linux-syscall-note */ -+/* -+ * drivers/staging/android/uapi/ion.h -+ * -+ * Copyright (C) 2011 Google, Inc. -+ */ -+ -+#ifndef _UAPI_LINUX_ION_H -+#define _UAPI_LINUX_ION_H -+ -+#include -+#include -+ -+/** -+ * enum ion_heap_types - list of all possible types of heaps -+ * @ION_HEAP_TYPE_SYSTEM: memory allocated via vmalloc -+ * @ION_HEAP_TYPE_SYSTEM_CONTIG: memory allocated via kmalloc -+ * @ION_HEAP_TYPE_CARVEOUT: memory allocated from a prereserved -+ * carveout heap, allocations are physically -+ * contiguous -+ * @ION_HEAP_TYPE_DMA: memory allocated via DMA API -+ * @ION_NUM_HEAPS: helper for iterating over heaps, a bit mask -+ * is used to identify the heaps, so only 32 -+ * total heap types are supported -+ */ -+enum ion_heap_type { -+ ION_HEAP_TYPE_SYSTEM, -+ ION_HEAP_TYPE_SYSTEM_CONTIG, -+ ION_HEAP_TYPE_CARVEOUT, -+ ION_HEAP_TYPE_CHUNK, -+ ION_HEAP_TYPE_DMA, -+ ION_HEAP_TYPE_CUSTOM, /* -+ * must be last so device specific heaps always -+ * are at the end of this enum -+ */ -+}; -+ -+#define ION_NUM_HEAP_IDS (sizeof(unsigned int) * 8) -+ -+/** -+ * allocation flags - the lower 16 bits are used by core ion, the upper 16 -+ * bits are reserved for use by the heaps themselves. -+ */ -+ -+/* -+ * mappings of this buffer should be cached, ion will do cache maintenance -+ * when the buffer is mapped for dma -+ */ -+#define ION_FLAG_CACHED 1 -+ -+/** -+ * DOC: Ion Userspace API -+ * -+ * create a client by opening /dev/ion -+ * most operations handled via following ioctls -+ * -+ */ -+ -+/** -+ * struct ion_allocation_data - metadata passed from userspace for allocations -+ * @len: size of the allocation -+ * @heap_id_mask: mask of heap ids to allocate from -+ * @flags: flags passed to heap -+ * @handle: pointer that will be populated with a cookie to use to -+ * refer to this allocation -+ * -+ * Provided by userspace as an argument to the ioctl -+ */ -+struct ion_allocation_data { -+ __u64 len; -+ __u32 heap_id_mask; -+ __u32 flags; -+ __u32 fd; -+ __u32 unused; -+}; -+ -+#define MAX_HEAP_NAME 32 -+ -+/** -+ * struct ion_heap_data - data about a heap -+ * @name - first 32 characters of the heap name -+ * @type - heap type -+ * @heap_id - heap id for the heap -+ */ -+struct ion_heap_data { -+ char name[MAX_HEAP_NAME]; -+ __u32 type; -+ __u32 heap_id; -+ __u32 reserved0; -+ __u32 reserved1; -+ __u32 reserved2; -+}; -+ -+/** -+ * struct ion_heap_query - collection of data about all heaps -+ * @cnt - total number of heaps to be copied -+ * @heaps - buffer to copy heap data -+ */ -+struct ion_heap_query { -+ __u32 cnt; /* Total number of heaps to be copied */ -+ __u32 reserved0; /* align to 64bits */ -+ __u64 heaps; /* buffer to be populated */ -+ __u32 reserved1; -+ __u32 reserved2; -+}; -+ -+#define ION_IOC_MAGIC 'I' -+ -+/** -+ * DOC: ION_IOC_ALLOC - allocate memory -+ * -+ * Takes an ion_allocation_data struct and returns it with the handle field -+ * populated with the opaque handle for the allocation. -+ */ -+#define ION_IOC_ALLOC _IOWR(ION_IOC_MAGIC, 0, \ -+ struct ion_allocation_data) -+ -+/** -+ * DOC: ION_IOC_HEAP_QUERY - information about available heaps -+ * -+ * Takes an ion_heap_query structure and populates information about -+ * available Ion heaps. -+ */ -+#define ION_IOC_HEAP_QUERY _IOWR(ION_IOC_MAGIC, 8, \ -+ struct ion_heap_query) -+ -+#endif /* _UAPI_LINUX_ION_H */ -diff --git a/drivers/tee/optee/Kconfig b/drivers/tee/optee/Kconfig -index 70898bbd5..dc097c286 100644 ---- a/drivers/tee/optee/Kconfig -+++ b/drivers/tee/optee/Kconfig -@@ -24,3 +24,33 @@ config OPTEE_INSECURE_LOAD_IMAGE - - Additional documentation on kernel security risks are at - Documentation/staging/tee.rst. -+ -+if OPTEE -+ -+choice -+ prompt "Default conduit method" -+ default OPTEE_DEFAULT_METHOD_NONE -+ help -+ This option sets the default conduit method for OP-TEE in case -+ firmware misses "method" property. If in doubt, select "none" -+ which depends on firmware to provide the value. -+ -+config OPTEE_DEFAULT_METHOD_NONE -+ bool "none" -+ help -+ There is no default conduit method used by the driver. Require -+ firmware to provide the method explicitly. -+ -+config OPTEE_DEFAULT_METHOD_HVC -+ bool "hvc" -+ help -+ Use the "hvc" as default conduit method. -+ -+config OPTEE_DEFAULT_METHOD_SMC -+ bool "smc" -+ help -+ Use the "hvc" as default conduit method. -+ -+endchoice -+ -+endif -diff --git a/drivers/tee/optee/smc_abi.c b/drivers/tee/optee/smc_abi.c -index d5b28fd35..e2b16275d 100644 ---- a/drivers/tee/optee/smc_abi.c -+++ b/drivers/tee/optee/smc_abi.c -@@ -6,6 +6,7 @@ - - #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt - -+#include - #include - #include - #include -@@ -1424,6 +1425,14 @@ static void optee_smccc_hvc(unsigned long a0, unsigned long a1, - arm_smccc_hvc(a0, a1, a2, a3, a4, a5, a6, a7, res); - } - -+#if defined(CONFIG_OPTEE_DEFAULT_METHOD_HVC) -+#define DEFAULT_CONDUIT_METHOD optee_smccc_hvc -+#elif defined(CONFIG_OPTEE_DEFAULT_METHOD_SMC) -+#define DEFAULT_CONDUIT_METHOD optee_smccc_smc -+#else -+#define DEFAULT_CONDUIT_METHOD ERR_PTR(-ENXIO) -+#endif -+ - static optee_invoke_fn *get_invoke_func(struct device *dev) - { - const char *method; -@@ -1432,7 +1441,7 @@ static optee_invoke_fn *get_invoke_func(struct device *dev) - - if (device_property_read_string(dev, "method", &method)) { - pr_warn("missing \"method\" property\n"); -- return ERR_PTR(-ENXIO); -+ return DEFAULT_CONDUIT_METHOD; - } - - if (!strcmp("hvc", method)) -@@ -1820,6 +1829,14 @@ static const struct of_device_id optee_dt_match[] = { - }; - MODULE_DEVICE_TABLE(of, optee_dt_match); - -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id optee_acpi_match[] = { -+ { "PHYT8003" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, optee_acpi_match); -+#endif -+ - static struct platform_driver optee_driver = { - .probe = optee_probe, - .remove = optee_smc_remove, -@@ -1827,6 +1844,7 @@ static struct platform_driver optee_driver = { - .driver = { - .name = "optee", - .of_match_table = optee_dt_match, -+ .acpi_match_table = ACPI_PTR(optee_acpi_match), - }, - }; - -diff --git a/drivers/tty/serial/Kconfig b/drivers/tty/serial/Kconfig -index bdc568a4a..998980961 100644 ---- a/drivers/tty/serial/Kconfig -+++ b/drivers/tty/serial/Kconfig -@@ -73,6 +73,17 @@ config SERIAL_AMBA_PL011_CONSOLE - your boot loader (lilo or loadlin) about how to pass options to the - kernel at boot time.) - -+config SERIAL_PHYTIUM_PCI -+ tristate "Phytium PCI serial port support" -+ depends on PCI -+ select SERIAL_CORE -+ help -+ This driver supports the Phytium UART controller on PCI/PCIe adapters. -+ If you want to compile this driver into the kernel, say Y here. To -+ compile this driver as a module, choose M here. -+ -+ If unsure, say N. -+ - config SERIAL_EARLYCON_SEMIHOST - bool "Early console using Arm compatible semihosting" - depends on ARM64 || ARM || RISCV -@@ -765,7 +776,7 @@ config SERIAL_CPM - depends on CPM2 || CPM1 - select SERIAL_CORE - help -- This driver supports the SCC and SMC serial ports on Motorola -+ This driver supports the SCC and SMC serial ports on Motorola - embedded PowerPC that contain a CPM1 (8xx) or CPM2 (8xxx) - - config SERIAL_CPM_CONSOLE -diff --git a/drivers/tty/serial/Makefile b/drivers/tty/serial/Makefile -index 138abbc89..cd1d9c759 100644 ---- a/drivers/tty/serial/Makefile -+++ b/drivers/tty/serial/Makefile -@@ -88,6 +88,7 @@ obj-$(CONFIG_SERIAL_MILBEAUT_USIO) += milbeaut_usio.o - obj-$(CONFIG_SERIAL_SIFIVE) += sifive.o - obj-$(CONFIG_SERIAL_LITEUART) += liteuart.o - obj-$(CONFIG_SERIAL_SUNPLUS) += sunplus-uart.o -+obj-$(CONFIG_SERIAL_PHYTIUM_PCI) += phytium-uart.o - - # GPIOLIB helpers for modem control lines - obj-$(CONFIG_SERIAL_MCTRL_GPIO) += serial_mctrl_gpio.o -diff --git a/drivers/tty/serial/phytium-uart.c b/drivers/tty/serial/phytium-uart.c -new file mode 100644 -index 000000000..c21cf9021 ---- /dev/null -+++ b/drivers/tty/serial/phytium-uart.c -@@ -0,0 +1,927 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Driver for Phytium PCI UART controller -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from drivers/tty/serial/amba-pl011.c -+ * Copyright 1999 ARM Limited -+ * Copyright (C) 2000 Deep Blue Solutions Ltd. -+ * Copyright (C) 2010 ST-Ericsson SA -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define DRV_NAME "phytium_uart" -+ -+#define REG_DR 0x00 -+#define REG_FR 0x18 -+#define REG_IBRD 0x24 -+#define REG_FBRD 0x28 -+#define REG_LCRH_RX 0x2c -+#define REG_LCRH_TX 0x2c -+#define REG_CR 0x30 -+#define REG_IFLS 0x34 -+#define REG_IMSC 0x38 -+#define REG_RIS 0x3c -+#define REG_MIS 0x40 -+#define REG_ICR 0x44 -+ -+#define REG_DR_OE (1 << 11) -+#define REG_DR_BE (1 << 10) -+#define REG_DR_PE (1 << 9) -+#define REG_DR_FE (1 << 8) -+ -+#define REG_LCRH_SPS 0x80 -+#define REG_LCRH_WLEN_8 0x60 -+#define REG_LCRH_WLEN_7 0x40 -+#define REG_LCRH_WLEN_6 0x20 -+#define REG_LCRH_WLEN_5 0x00 -+#define REG_LCRH_FEN 0x10 -+#define REG_LCRH_STP2 0x08 -+#define REG_LCRH_EPS 0x04 -+#define REG_LCRH_PEN 0x02 -+#define REG_LCRH_BRK 0x01 -+ -+#define REG_FR_RI 0x100 -+#define REG_FR_TXFE 0x080 -+#define REG_FR_RXFF 0x040 -+#define REG_FR_TXFF 0x020 -+#define REG_FR_RXFE 0x010 -+#define REG_FR_BUSY 0x008 -+#define REG_FR_DCD 0x004 -+#define REG_FR_DSR 0x002 -+#define REG_FR_CTS 0x001 -+#define REG_FR_TMSK (REG_FR_TXFF + REG_FR_BUSY) -+ -+#define REG_CR_CTSEN 0x8000 /* CTS hardware flow control */ -+#define REG_CR_RTSEN 0x4000 /* RTS hardware flow control */ -+#define REG_CR_OUT2 0x2000 /* OUT2 */ -+#define REG_CR_OUT1 0x1000 /* OUT1 */ -+#define REG_CR_RTS 0x0800 /* RTS */ -+#define REG_CR_DTR 0x0400 /* DTR */ -+#define REG_CR_RXE 0x0200 /* receive enable */ -+#define REG_CR_TXE 0x0100 /* transmit enable */ -+#define REG_CR_LBE 0x0080 /* loopback enable */ -+#define REG_CR_RTIE 0x0040 -+#define REG_CR_TIE 0x0020 -+#define REG_CR_RIE 0x0010 -+#define REG_CR_MSIE 0x0008 -+#define REG_CR_IIRLP 0x0004 /* SIR low power mode */ -+#define REG_CR_SIREN 0x0002 /* SIR enable */ -+#define REG_CR_UARTEN 0x0001 /* UART enable */ -+ -+#define REG_IFLS_RX1_8 (0 << 3) -+#define REG_IFLS_RX2_8 (1 << 3) -+#define REG_IFLS_RX4_8 (2 << 3) -+#define REG_IFLS_RX6_8 (3 << 3) -+#define REG_IFLS_RX7_8 (4 << 3) -+#define REG_IFLS_TX1_8 (0 << 0) -+#define REG_IFLS_TX2_8 (1 << 0) -+#define REG_IFLS_TX4_8 (2 << 0) -+#define REG_IFLS_TX6_8 (3 << 0) -+ -+#define REG_IMSC_OEIM (1 << 10) /* overrun error interrupt mask */ -+#define REG_IMSC_BEIM (1 << 9) /* break error interrupt mask */ -+#define REG_IMSC_PEIM (1 << 8) /* parity error interrupt mask */ -+#define REG_IMSC_FEIM (1 << 7) /* framing error interrupt mask */ -+#define REG_IMSC_RTIM (1 << 6) /* receive timeout interrupt mask */ -+#define REG_IMSC_TXIM (1 << 5) /* transmit interrupt mask */ -+#define REG_IMSC_RXIM (1 << 4) /* receive interrupt mask */ -+#define REG_IMSC_DSRMIM (1 << 3) /* DSR interrupt mask */ -+#define REG_IMSC_DCDMIM (1 << 2) /* DCD interrupt mask */ -+#define REG_IMSC_CTSMIM (1 << 1) /* CTS interrupt mask */ -+#define REG_IMSC_RIMIM (1 << 0) /* RI interrupt mask */ -+ -+#define REG_ICR_OEIS (1 << 10) /* overrun error interrupt status */ -+#define REG_ICR_BEIS (1 << 9) /* break error interrupt status */ -+#define REG_ICR_PEIS (1 << 8) /* parity error interrupt status */ -+#define REG_ICR_FEIS (1 << 7) /* framing error interrupt status */ -+#define REG_ICR_RTIS (1 << 6) /* receive timeout interrupt status */ -+#define REG_ICR_TXIS (1 << 5) /* transmit interrupt status */ -+#define REG_ICR_RXIS (1 << 4) /* receive interrupt status */ -+#define REG_ICR_DSRMIS (1 << 3) /* DSR interrupt status */ -+#define REG_ICR_DCDMIS (1 << 2) /* DCD interrupt status */ -+#define REG_ICR_CTSMIS (1 << 1) /* CTS interrupt status */ -+#define REG_ICR_RIMIS (1 << 0) /* RI interrupt status */ -+ -+#define UART_NR 12 -+ -+#define UART_DR_ERROR (REG_DR_OE|REG_DR_BE|REG_DR_PE|REG_DR_FE) -+#define UART_DUMMY_DR_RX (1 << 16) -+ -+#define DEFAULT_UARTCLK 48000000 /* 48 MHz */ -+ -+/* -+ * We wrap our port structure around the generic uart_port. -+ */ -+struct phytium_uart_port { -+ struct uart_port port; -+ unsigned int im; /* interrupt mask */ -+ unsigned int old_status; -+ unsigned int old_cr; /* state during shutdown */ -+ char type[12]; -+}; -+ -+static unsigned int phytium_uart_read(const struct phytium_uart_port *pup, -+ unsigned int reg) -+{ -+ void __iomem *addr = pup->port.membase + reg; -+ -+ return readl_relaxed(addr); -+} -+ -+static void phytium_uart_write(unsigned int val, const struct phytium_uart_port *pup, -+ unsigned int reg) -+{ -+ void __iomem *addr = pup->port.membase + reg; -+ -+ writel_relaxed(val, addr); -+} -+ -+static int phytium_fifo_to_tty(struct phytium_uart_port *pup) -+{ -+ u16 status; -+ unsigned int ch, flag, fifotaken; -+ -+ for (fifotaken = 0; fifotaken < 256; fifotaken++) { -+ status = phytium_uart_read(pup, REG_FR); -+ if (status & REG_FR_RXFE) -+ break; -+ -+ /* Take chars from the FIFO and update status */ -+ ch = phytium_uart_read(pup, REG_DR) | UART_DUMMY_DR_RX; -+ flag = TTY_NORMAL; -+ pup->port.icount.rx++; -+ -+ if (unlikely(ch & UART_DR_ERROR)) { -+ if (ch & REG_DR_BE) { -+ ch &= ~(REG_DR_FE | REG_DR_PE); -+ pup->port.icount.brk++; -+ if (uart_handle_break(&pup->port)) -+ continue; -+ } else if (ch & REG_DR_PE) -+ pup->port.icount.parity++; -+ else if (ch & REG_DR_FE) -+ pup->port.icount.frame++; -+ if (ch & REG_DR_OE) -+ pup->port.icount.overrun++; -+ -+ ch &= pup->port.read_status_mask; -+ -+ if (ch & REG_DR_BE) -+ flag = TTY_BREAK; -+ else if (ch & REG_DR_PE) -+ flag = TTY_PARITY; -+ else if (ch & REG_DR_FE) -+ flag = TTY_FRAME; -+ } -+ -+ if (uart_handle_sysrq_char(&pup->port, ch & 255)) -+ continue; -+ -+ uart_insert_char(&pup->port, ch, REG_DR_OE, ch, flag); -+ } -+ -+ return fifotaken; -+} -+ -+static void phytium_rx_chars(struct phytium_uart_port *pup) -+__releases(&pup->port.lock) -+__acquires(&pup->port.lock) -+{ -+ phytium_fifo_to_tty(pup); -+ -+ spin_unlock(&pup->port.lock); -+ tty_flip_buffer_push(&pup->port.state->port); -+ spin_lock(&pup->port.lock); -+} -+ -+static void phytium_stop_tx(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ pup->im &= ~REG_IMSC_TXIM; -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+} -+ -+static bool phytium_tx_char(struct phytium_uart_port *pup, unsigned char c, -+ bool from_irq) -+{ -+ -+ if (unlikely(!from_irq) && -+ phytium_uart_read(pup, REG_FR) & REG_FR_TXFF) -+ return false; /* unable to transmit character */ -+ -+ phytium_uart_write(c, pup, REG_DR); -+ pup->port.icount.tx++; -+ -+ return true; -+} -+ -+static bool phytium_tx_chars(struct phytium_uart_port *pup, bool from_irq) -+{ -+ struct circ_buf *xmit = &pup->port.state->xmit; -+ int count = pup->port.fifosize >> 1; -+ -+ if (pup->port.x_char) { -+ if (!phytium_tx_char(pup, pup->port.x_char, from_irq)) -+ return true; -+ pup->port.x_char = 0; -+ --count; -+ } -+ if (uart_circ_empty(xmit) || uart_tx_stopped(&pup->port)) { -+ phytium_stop_tx(&pup->port); -+ return false; -+ } -+ -+ do { -+ if (likely(from_irq) && count-- == 0) -+ break; -+ -+ if (!phytium_tx_char(pup, xmit->buf[xmit->tail], from_irq)) -+ break; -+ -+ xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1); -+ } while (!uart_circ_empty(xmit)); -+ -+ if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) -+ uart_write_wakeup(&pup->port); -+ -+ if (uart_circ_empty(xmit)) { -+ phytium_stop_tx(&pup->port); -+ return false; -+ } -+ return true; -+} -+ -+static void phytium_modem_status(struct phytium_uart_port *pup) -+{ -+ unsigned int status, delta; -+ -+ status = phytium_uart_read(pup, REG_FR) & (REG_FR_DCD|REG_FR_DSR|REG_FR_CTS); -+ -+ delta = status ^ pup->old_status; -+ pup->old_status = status; -+ -+ if (!delta) -+ return; -+ -+ if (delta & REG_FR_DCD) -+ uart_handle_dcd_change(&pup->port, status & REG_FR_DCD); -+ -+ if (delta & REG_FR_DSR) -+ pup->port.icount.dsr++; -+ -+ if (delta & REG_FR_CTS) -+ uart_handle_cts_change(&pup->port, status & REG_FR_CTS); -+ -+ wake_up_interruptible(&pup->port.state->port.delta_msr_wait); -+} -+ -+static irqreturn_t phytium_uart_interrupt(int irq, void *dev_id) -+{ -+ struct phytium_uart_port *pup = dev_id; -+ unsigned long flags; -+ unsigned int status, pass_counter = 256; -+ int handled = 0; -+ -+ spin_lock_irqsave(&pup->port.lock, flags); -+ status = phytium_uart_read(pup, REG_RIS) & pup->im; -+ if (status) { -+ do { -+ phytium_uart_write(status & ~(REG_ICR_TXIS|REG_ICR_RTIS|REG_ICR_RXIS), -+ pup, REG_ICR); -+ -+ if (status & (REG_ICR_RTIS|REG_ICR_RXIS)) -+ phytium_rx_chars(pup); -+ -+ if (status & (REG_ICR_DSRMIS|REG_ICR_DCDMIS| -+ REG_ICR_CTSMIS|REG_ICR_RIMIS)) -+ phytium_modem_status(pup); -+ if (status & REG_ICR_TXIS) -+ phytium_tx_chars(pup, true); -+ -+ if (pass_counter-- == 0) -+ break; -+ -+ status = phytium_uart_read(pup, REG_RIS) & pup->im; -+ } while (status != 0); -+ handled = 1; -+ } -+ spin_unlock_irqrestore(&pup->port.lock, flags); -+ -+ return IRQ_RETVAL(handled); -+} -+ -+static unsigned int phytium_tx_empty(struct uart_port *port) -+{ -+ unsigned int status; -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ status = phytium_uart_read(pup, REG_FR) & (REG_FR_BUSY | REG_FR_TXFF); -+ -+ return status ? 0 : TIOCSER_TEMT; -+} -+ -+static void phytium_set_mctrl(struct uart_port *port, unsigned int mctrl) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ unsigned int cr; -+ -+ cr = phytium_uart_read(pup, REG_CR); -+ -+#define TIOCMBIT(tiocmbit, uartbit) \ -+ do { \ -+ if (mctrl & tiocmbit) \ -+ cr |= uartbit; \ -+ else \ -+ cr &= ~uartbit; \ -+ } while (0) -+ -+ TIOCMBIT(TIOCM_RTS, REG_CR_RTS); -+ TIOCMBIT(TIOCM_DTR, REG_CR_DTR); -+ TIOCMBIT(TIOCM_OUT1, REG_CR_OUT1); -+ TIOCMBIT(TIOCM_OUT2, REG_CR_OUT2); -+ TIOCMBIT(TIOCM_LOOP, REG_CR_LBE); -+ -+ if (port->status & UPSTAT_AUTORTS) { -+ /* We need to disable auto-RTS if we want to turn RTS off */ -+ TIOCMBIT(TIOCM_RTS, REG_CR_RTSEN); -+ } -+#undef TIOCMBIT -+ -+ phytium_uart_write(cr, pup, REG_CR); -+} -+ -+static unsigned int phytium_get_mctrl(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ unsigned int cr = 0; -+ unsigned int status = phytium_uart_read(pup, REG_FR); -+ -+#define TIOCMBIT(uartbit, tiocmbit) \ -+ do { \ -+ if (status & uartbit) \ -+ cr |= tiocmbit; \ -+ } while (0) -+ -+ TIOCMBIT(REG_FR_DCD, TIOCM_CAR); -+ TIOCMBIT(REG_FR_DSR, TIOCM_DSR); -+ TIOCMBIT(REG_FR_CTS, TIOCM_CTS); -+ TIOCMBIT(REG_FR_RI, TIOCM_RNG); -+#undef TIOCMBIT -+ return cr; -+} -+ -+static void phytium_start_tx(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ if (phytium_tx_chars(pup, false)) { -+ pup->im |= REG_IMSC_TXIM; -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+ } -+} -+ -+static void phytium_stop_rx(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ pup->im &= ~(REG_IMSC_RXIM|REG_IMSC_RTIM|REG_IMSC_FEIM| -+ REG_IMSC_PEIM|REG_IMSC_BEIM|REG_IMSC_OEIM); -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+} -+ -+static void phytium_enable_ms(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ pup->im |= REG_IMSC_RIMIM|REG_IMSC_CTSMIM|REG_IMSC_DCDMIM|REG_IMSC_DSRMIM; -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+} -+ -+static void phytium_break_ctl(struct uart_port *port, int break_state) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ unsigned long flags; -+ unsigned int lcr_h; -+ -+ spin_lock_irqsave(&pup->port.lock, flags); -+ lcr_h = phytium_uart_read(pup, REG_LCRH_TX); -+ if (break_state == -1) -+ lcr_h |= REG_LCRH_BRK; -+ else -+ lcr_h &= ~REG_LCRH_BRK; -+ phytium_uart_write(lcr_h, pup, REG_LCRH_TX); -+ spin_unlock_irqrestore(&pup->port.lock, flags); -+} -+ -+static int phytium_hwinit(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ /* XXX: more configurable setup method in future */ -+ pup->port.uartclk = DEFAULT_UARTCLK; -+ -+ /* Clear pending error and receive interrupts */ -+ phytium_uart_write(REG_ICR_OEIS | REG_ICR_BEIS | REG_ICR_PEIS | -+ REG_ICR_FEIS | REG_ICR_RTIS | REG_ICR_RXIS, -+ pup, REG_ICR); -+ -+ /* -+ * Save interrupts enable mask, and enable RX interrupts in case if -+ * the interrupt is used for NMI entry. -+ */ -+ pup->im = phytium_uart_read(pup, REG_IMSC); -+ phytium_uart_write(REG_IMSC_RTIM | REG_IMSC_RXIM, pup, REG_IMSC); -+ -+ return 0; -+} -+ -+static int phytium_uart_allocate_irq(struct phytium_uart_port *pup) -+{ -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+ -+ return request_irq(pup->port.irq, phytium_uart_interrupt, IRQF_SHARED, DRV_NAME, pup); -+} -+ -+static void phytium_enable_interrtups(struct phytium_uart_port *pup) -+{ -+ unsigned int i; -+ -+ spin_lock_irq(&pup->port.lock); -+ -+ /* Clear out any spuriously appearing RX interrupts */ -+ phytium_uart_write(REG_ICR_RTIS | REG_ICR_RXIS, pup, REG_ICR); -+ -+ /* -+ * RXIS is asserted only when the RX FIFO transitions from below -+ * to above the trigger threshold. If the RX FIFO is already -+ * full to the threashold this can't happen and RXIS will now be -+ * stuck off. Drain the RX FIFO explicitly to fix this: -+ */ -+ for (i = 0; i < pup->port.fifosize * 2; i++) { -+ if (phytium_uart_read(pup, REG_FR) & REG_FR_RXFE) -+ break; -+ -+ phytium_uart_read(pup, REG_DR); -+ } -+ -+ pup->im = REG_IMSC_RTIM | REG_IMSC_RXIM; -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+ spin_unlock_irq(&pup->port.lock); -+} -+ -+static int phytium_startup(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ unsigned int cr; -+ int ret = 0; -+ -+ ret = phytium_hwinit(port); -+ if (ret) -+ goto out; -+ -+ ret = phytium_uart_allocate_irq(pup); -+ if (ret) -+ goto out; -+ -+ phytium_uart_write(REG_IFLS_RX4_8|REG_IFLS_TX4_8, pup, REG_IFLS); -+ -+ spin_lock_irq(&pup->port.lock); -+ -+ /* restore RTS and DTR */ -+ cr = pup->old_cr & (REG_CR_RTS | REG_CR_DTR); -+ cr |= REG_CR_UARTEN | REG_CR_RXE | REG_CR_TXE; -+ phytium_uart_write(cr, pup, REG_CR); -+ -+ spin_unlock_irq(&pup->port.lock); -+ -+ /* initialise the old status of the modem signals */ -+ pup->old_status = phytium_uart_read(pup, REG_FR) & (REG_FR_DCD|REG_FR_DSR|REG_FR_CTS); -+ -+ phytium_enable_interrtups(pup); -+ -+out: -+ return ret; -+} -+ -+static void phytium_shutdown_channel(struct phytium_uart_port *pup, -+ unsigned int lcrh) -+{ -+ unsigned long val; -+ -+ val = phytium_uart_read(pup, lcrh); -+ val &= ~(REG_LCRH_BRK | REG_LCRH_FEN); -+ phytium_uart_write(val, pup, lcrh); -+} -+ -+static void phytium_disable_uart(struct phytium_uart_port *pup) -+{ -+ unsigned int cr; -+ -+ pup->port.status &= ~(UPSTAT_AUTOCTS | UPSTAT_AUTORTS); -+ spin_lock_irq(&pup->port.lock); -+ cr = phytium_uart_read(pup, REG_CR); -+ pup->old_cr = cr; -+ cr &= REG_CR_RTS | REG_CR_DTR; -+ cr |= REG_CR_UARTEN | REG_CR_TXE; -+ phytium_uart_write(cr, pup, REG_CR); -+ spin_unlock_irq(&pup->port.lock); -+ -+ /* -+ * disable break condition and fifos -+ */ -+ phytium_shutdown_channel(pup, REG_LCRH_RX); -+} -+ -+static void phytium_disable_interrupts(struct phytium_uart_port *pup) -+{ -+ spin_lock_irq(&pup->port.lock); -+ -+ /* mask all interrupts and clear all pending ones */ -+ pup->im = 0; -+ phytium_uart_write(pup->im, pup, REG_IMSC); -+ phytium_uart_write(0xffff, pup, REG_ICR); -+ -+ spin_unlock_irq(&pup->port.lock); -+} -+ -+static void phytium_shutdown(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ -+ phytium_disable_interrupts(pup); -+ -+ free_irq(pup->port.irq, pup); -+ -+ phytium_disable_uart(pup); -+ -+ if (pup->port.ops->flush_buffer) -+ pup->port.ops->flush_buffer(port); -+} -+ -+static void -+phytium_setup_status_masks(struct uart_port *port, struct ktermios *termios) -+{ -+ port->read_status_mask = REG_DR_OE | 255; -+ if (termios->c_iflag & INPCK) -+ port->read_status_mask |= REG_DR_FE | REG_DR_PE; -+ if (termios->c_iflag & (IGNBRK | BRKINT | PARMRK)) -+ port->read_status_mask |= REG_DR_BE; -+ -+ /* -+ * Characters to ignore -+ */ -+ port->ignore_status_mask = 0; -+ if (termios->c_iflag & IGNPAR) -+ port->ignore_status_mask |= REG_DR_FE | REG_DR_PE; -+ if (termios->c_iflag & IGNBRK) { -+ port->ignore_status_mask |= REG_DR_BE; -+ /* -+ * If we're ignoring parity and break indicators, -+ * ignore overruns too (for real raw support). -+ */ -+ if (termios->c_iflag & IGNPAR) -+ port->ignore_status_mask |= REG_DR_OE; -+ } -+ -+ /* -+ * Ignore all characters if CREAD is not set. -+ */ -+ if ((termios->c_cflag & CREAD) == 0) -+ port->ignore_status_mask |= UART_DUMMY_DR_RX; -+} -+ -+static void -+phytium_set_termios(struct uart_port *port, struct ktermios *termios, const struct ktermios *old) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ unsigned int lcr_h, old_cr; -+ unsigned long flags; -+ unsigned int baud, quot; -+ -+ /* Ask the core to calculate the divisor for us. */ -+ baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16); -+ -+ if (baud > port->uartclk/16) -+ quot = DIV_ROUND_CLOSEST(port->uartclk * 8, baud); -+ else -+ quot = DIV_ROUND_CLOSEST(port->uartclk * 4, baud); -+ -+ switch (termios->c_cflag & CSIZE) { -+ case CS5: -+ lcr_h = REG_LCRH_WLEN_5; -+ break; -+ case CS6: -+ lcr_h = REG_LCRH_WLEN_6; -+ break; -+ case CS7: -+ lcr_h = REG_LCRH_WLEN_7; -+ break; -+ default: /* CS8 */ -+ lcr_h = REG_LCRH_WLEN_8; -+ break; -+ } -+ if (termios->c_cflag & CSTOPB) -+ lcr_h |= REG_LCRH_STP2; -+ if (termios->c_cflag & PARENB) { -+ lcr_h |= REG_LCRH_PEN; -+ if (!(termios->c_cflag & PARODD)) -+ lcr_h |= REG_LCRH_EPS; -+ if (termios->c_cflag & CMSPAR) -+ lcr_h |= REG_LCRH_SPS; -+ } -+ if (pup->port.fifosize > 1) -+ lcr_h |= REG_LCRH_FEN; -+ -+ spin_lock_irqsave(&port->lock, flags); -+ -+ /* -+ * Update the per-port timeout. -+ */ -+ uart_update_timeout(port, termios->c_cflag, baud); -+ -+ phytium_setup_status_masks(port, termios); -+ -+ if (UART_ENABLE_MS(port, termios->c_cflag)) -+ phytium_enable_ms(port); -+ -+ /* first, disable everything */ -+ old_cr = phytium_uart_read(pup, REG_CR); -+ phytium_uart_write(0, pup, REG_CR); -+ -+ if (termios->c_cflag & CRTSCTS) { -+ if (old_cr & REG_CR_RTS) -+ old_cr |= REG_CR_RTSEN; -+ -+ old_cr |= REG_CR_CTSEN; -+ port->status |= UPSTAT_AUTOCTS | UPSTAT_AUTORTS; -+ } else { -+ old_cr &= ~(REG_CR_CTSEN | REG_CR_RTSEN); -+ port->status &= ~(UPSTAT_AUTOCTS | UPSTAT_AUTORTS); -+ } -+ -+ /* Set baud rate */ -+ phytium_uart_write(quot & 0x3f, pup, REG_FBRD); -+ phytium_uart_write(quot >> 6, pup, REG_IBRD); -+ -+ phytium_uart_write(lcr_h, pup, REG_LCRH_RX); -+ phytium_uart_write(old_cr, pup, REG_CR); -+ -+ spin_unlock_irqrestore(&port->lock, flags); -+} -+ -+static const char *phytium_type(struct uart_port *port) -+{ -+ struct phytium_uart_port *pup = -+ container_of(port, struct phytium_uart_port, port); -+ return pup->port.type == PORT_PHYTIUM ? pup->type : NULL; -+} -+ -+static void phytium_release_port(struct uart_port *port) -+{ -+ /* Nothing to release ... */ -+} -+ -+static int phytium_request_port(struct uart_port *port) -+{ -+ /* UARTs always present */ -+ return 0; -+} -+ -+static void phytium_config_port(struct uart_port *port, int flags) -+{ -+ if (flags & UART_CONFIG_TYPE) { -+ port->type = PORT_PHYTIUM; -+ phytium_request_port(port); -+ } -+} -+ -+static int phytium_verify_port(struct uart_port *port, struct serial_struct *ser) -+{ -+ int ret = 0; -+ -+ if (ser->type != PORT_UNKNOWN && ser->type != PORT_PHYTIUM) -+ ret = -EINVAL; -+ if (ser->irq < 0 || ser->irq >= nr_irqs) -+ ret = -EINVAL; -+ if (ser->baud_base < 9600) -+ ret = -EINVAL; -+ -+ return ret; -+} -+ -+static const struct uart_ops phytium_uart_ops = { -+ .tx_empty = phytium_tx_empty, -+ .set_mctrl = phytium_set_mctrl, -+ .get_mctrl = phytium_get_mctrl, -+ .stop_tx = phytium_stop_tx, -+ .start_tx = phytium_start_tx, -+ .stop_rx = phytium_stop_rx, -+ .enable_ms = phytium_enable_ms, -+ .break_ctl = phytium_break_ctl, -+ .startup = phytium_startup, -+ .shutdown = phytium_shutdown, -+ .set_termios = phytium_set_termios, -+ .type = phytium_type, -+ .release_port = phytium_release_port, -+ .request_port = phytium_request_port, -+ .config_port = phytium_config_port, -+ .verify_port = phytium_verify_port, -+}; -+ -+static struct phytium_uart_port *uart_ports[UART_NR]; -+ -+static struct uart_driver phytium_uart = { -+ .owner = THIS_MODULE, -+ .driver_name = DRV_NAME, -+ .dev_name = "ttyFTX", -+ .nr = UART_NR, -+}; -+ -+void phytium_unregister_port(struct phytium_uart_port *pup) -+{ -+ int i; -+ bool busy = false; -+ -+ for (i = 0; i < ARRAY_SIZE(uart_ports); i++) { -+ if (uart_ports[i] == pup) -+ uart_ports[i] = NULL; -+ else if (uart_ports[i]) -+ busy = true; -+ } -+ -+ if (!busy) -+ uart_unregister_driver(&phytium_uart); -+} -+ -+static int phytium_find_free_port(void) -+{ -+ int i; -+ -+ for (i = 0; i < ARRAY_SIZE(uart_ports); i++) -+ if (uart_ports[i] == NULL) -+ return i; -+ -+ return -EBUSY; -+} -+ -+static int phytium_register_port(struct phytium_uart_port *pup) -+{ -+ int rc; -+ -+ /* Ensure interrupts from this UART are masked and cleared */ -+ phytium_uart_write(0, pup, REG_IMSC); -+ phytium_uart_write(0xffff, pup, REG_ICR); -+ -+ if (!phytium_uart.state) { -+ rc = uart_register_driver(&phytium_uart); -+ if (rc < 0) { -+ dev_err(pup->port.dev, -+ "Failed to register Phytium PCI UART driver\n"); -+ return rc; -+ } -+ } -+ -+ rc = uart_add_one_port(&phytium_uart, &pup->port); -+ if (rc) -+ phytium_unregister_port(pup); -+ -+ return rc; -+} -+ -+static int phytium_uart_probe(struct pci_dev *pdev, -+ const struct pci_device_id *id) -+{ -+ struct phytium_uart_port *pup; -+ int portnr, rc; -+ -+ portnr = phytium_find_free_port(); -+ if (portnr < 0) -+ return portnr; -+ -+ pup = devm_kzalloc(&pdev->dev, sizeof(struct phytium_uart_port), -+ GFP_KERNEL); -+ if (!pup) -+ return -ENOMEM; -+ -+ rc = pcim_enable_device(pdev); -+ if (rc) -+ return rc; -+ -+ rc = pcim_iomap_regions_request_all(pdev, 0x01, pci_name(pdev)); -+ if (rc) -+ return rc; -+ -+ pup->port.iotype = UPIO_MEM32; -+ pup->port.irq = pdev->irq; -+ pup->port.mapbase = pci_resource_start(pdev, 0); -+ pup->port.membase = pcim_iomap_table(pdev)[0]; -+ pup->port.ops = &phytium_uart_ops; -+ pup->port.dev = &pdev->dev; -+ pup->port.fifosize = 32; -+ pup->port.flags = UPF_BOOT_AUTOCONF; -+ pup->port.line = portnr; -+ -+ uart_ports[portnr] = pup; -+ -+ pup->old_cr = 0; -+ snprintf(pup->type, sizeof(pup->type), "pci-uart"); -+ -+ pci_set_drvdata(pdev, pup); -+ -+ return phytium_register_port(pup); -+} -+ -+static void phytium_uart_remove(struct pci_dev *pdev) -+{ -+ struct phytium_uart_port *pup = pci_get_drvdata(pdev); -+ -+ uart_remove_one_port(&phytium_uart, &pup->port); -+ phytium_unregister_port(pup); -+} -+ -+#ifdef CONFIG_PM_SLEEP -+static int phytium_uart_suspend(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_uart_port *pup = pci_get_drvdata(pdev); -+ -+ if (pup) -+ uart_suspend_port(&phytium_uart, &pup->port); -+ -+ return 0; -+} -+ -+static int phytium_uart_resume(struct device *dev) -+{ -+ struct pci_dev *pdev = to_pci_dev(dev); -+ struct phytium_uart_port *pup = pci_get_drvdata(pdev); -+ -+ if (pup) -+ uart_resume_port(&phytium_uart, &pup->port); -+ -+ return 0; -+} -+#endif -+ -+static SIMPLE_DEV_PM_OPS(phytium_dev_pm_ops, phytium_uart_suspend, phytium_uart_resume); -+ -+static const struct pci_device_id pci_ids[] = { -+ { PCI_VDEVICE(PHYTIUM, 0xdc2e) }, -+ { 0 } -+}; -+MODULE_DEVICE_TABLE(pci, pci_ids); -+ -+static struct pci_driver phytium_uart_pci_driver = { -+ .name = DRV_NAME, -+ .probe = phytium_uart_probe, -+ .remove = phytium_uart_remove, -+ .driver = { -+ .pm = &phytium_dev_pm_ops, -+ }, -+ .id_table = pci_ids, -+}; -+ -+static int __init phytium_uart_init(void) -+{ -+ pr_info("Serial: Phytium PCI UART driver\n"); -+ -+ return pci_register_driver(&phytium_uart_pci_driver); -+} -+ -+static void __exit phytium_uart_exit(void) -+{ -+ pci_unregister_driver(&phytium_uart_pci_driver); -+} -+ -+module_init(phytium_uart_init); -+module_exit(phytium_uart_exit); -+ -+MODULE_AUTHOR("Chen Baozi "); -+MODULE_DESCRIPTION("Phytium PCI serial port driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/usb/Kconfig b/drivers/usb/Kconfig -index 7f33bcc31..7eaccbc6a 100644 ---- a/drivers/usb/Kconfig -+++ b/drivers/usb/Kconfig -@@ -129,6 +129,8 @@ source "drivers/usb/chipidea/Kconfig" - - source "drivers/usb/isp1760/Kconfig" - -+source "drivers/usb/phytium/Kconfig" -+ - comment "USB port drivers" - - if USB -diff --git a/drivers/usb/Makefile b/drivers/usb/Makefile -index 3a9a0dd4b..30d193473 100644 ---- a/drivers/usb/Makefile -+++ b/drivers/usb/Makefile -@@ -17,6 +17,8 @@ obj-$(CONFIG_USB_CDNS_SUPPORT) += cdns3/ - obj-$(CONFIG_USB_CDNS3) += cdns3/ - obj-$(CONFIG_USB_CDNSP_PCI) += cdns3/ - -+obj-$(CONFIG_USB_PHYTIUM) += phytium/ -+ - obj-$(CONFIG_USB_FOTG210) += fotg210/ - - obj-$(CONFIG_USB_MON) += mon/ -diff --git a/drivers/usb/host/xhci-mem.c b/drivers/usb/host/xhci-mem.c -index 0a37f0d51..0a6ca2e5f 100644 ---- a/drivers/usb/host/xhci-mem.c -+++ b/drivers/usb/host/xhci-mem.c -@@ -1996,6 +1996,10 @@ static void xhci_add_in_port(struct xhci_hcd *xhci, unsigned int num_ports, - return; - } - -+ if (xhci->quirks & XHCI_SLOWDOWN_QUIRK) -+ if (major_revision == 0x03) -+ rhub->min_rev = 0; -+ - /* Port offset and count in the third dword, see section 7.2 */ - temp = readl(addr + 2); - port_offset = XHCI_EXT_PORT_OFF(temp); -diff --git a/drivers/usb/host/xhci-pci.c b/drivers/usb/host/xhci-pci.c -index d6fc08e5d..c9c2e7062 100644 ---- a/drivers/usb/host/xhci-pci.c -+++ b/drivers/usb/host/xhci-pci.c -@@ -62,6 +62,8 @@ - #define PCI_DEVICE_ID_INTEL_ALDER_LAKE_PCH_XHCI 0x51ed - #define PCI_DEVICE_ID_INTEL_ALDER_LAKE_N_PCH_XHCI 0x54ed - -+#define PCI_DEVICE_ID_PHYTIUM_XHCI 0xdc27 -+ - #define PCI_DEVICE_ID_AMD_RENOIR_XHCI 0x1639 - #define PCI_DEVICE_ID_AMD_PROMONTORYA_4 0x43b9 - #define PCI_DEVICE_ID_AMD_PROMONTORYA_3 0x43ba -@@ -474,6 +476,12 @@ static void xhci_pci_quirks(struct device *dev, struct xhci_hcd *xhci) - if (pdev->vendor == PCI_VENDOR_ID_VIA) - xhci->quirks |= XHCI_RESET_ON_RESUME; - -+ if (pdev->vendor == PCI_VENDOR_ID_PHYTIUM || -+ pdev->device == PCI_DEVICE_ID_PHYTIUM_XHCI) { -+ xhci->quirks |= XHCI_RESET_ON_RESUME; -+ xhci->quirks |= XHCI_SLOWDOWN_QUIRK; -+ } -+ - /* See https://bugzilla.kernel.org/show_bug.cgi?id=79511 */ - if (pdev->vendor == PCI_VENDOR_ID_VIA && - pdev->device == 0x3432) -diff --git a/drivers/usb/host/xhci-plat.c b/drivers/usb/host/xhci-plat.c -index d68e9abcd..9420d7a56 100644 ---- a/drivers/usb/host/xhci-plat.c -+++ b/drivers/usb/host/xhci-plat.c -@@ -113,6 +113,10 @@ static const struct xhci_plat_priv xhci_plat_brcm = { - .quirks = XHCI_RESET_ON_RESUME | XHCI_SUSPEND_RESUME_CLKS, - }; - -+static const struct xhci_plat_priv xhci_plat_phytium_pe220x = { -+ .quirks = XHCI_RESET_ON_RESUME, -+}; -+ - static const struct of_device_id usb_xhci_of_match[] = { - { - .compatible = "generic-xhci", -@@ -133,6 +137,9 @@ static const struct of_device_id usb_xhci_of_match[] = { - }, { - .compatible = "brcm,bcm7445-xhci", - .data = &xhci_plat_brcm, -+ }, { -+ .compatible = "phytium,pe220x-xhci", -+ .data = &xhci_plat_phytium_pe220x, - }, - {}, - }; -@@ -394,7 +401,9 @@ static int xhci_generic_plat_probe(struct platform_device *pdev) - return ret; - } - -- if (pdev->dev.of_node) -+ if (has_acpi_companion(&pdev->dev)) -+ priv_match = acpi_device_get_match_data(&pdev->dev); -+ else if (pdev->dev.of_node) - priv_match = of_device_get_match_data(&pdev->dev); - else - priv_match = dev_get_platdata(&pdev->dev); -@@ -554,6 +563,7 @@ EXPORT_SYMBOL_GPL(xhci_plat_pm_ops); - static const struct acpi_device_id usb_xhci_acpi_match[] = { - /* XHCI-compliant USB Controller */ - { "PNP0D10", }, -+ { "PHYT0039", (kernel_ulong_t)&xhci_plat_phytium_pe220x }, - { } - }; - MODULE_DEVICE_TABLE(acpi, usb_xhci_acpi_match); -diff --git a/drivers/usb/host/xhci.h b/drivers/usb/host/xhci.h -index 31088602c..b3124c20b 100644 ---- a/drivers/usb/host/xhci.h -+++ b/drivers/usb/host/xhci.h -@@ -1907,6 +1907,7 @@ struct xhci_hcd { - #define XHCI_RESET_TO_DEFAULT BIT_ULL(44) - #define XHCI_ZHAOXIN_TRB_FETCH BIT_ULL(45) - #define XHCI_ZHAOXIN_HOST BIT_ULL(46) -+#define XHCI_SLOWDOWN_QUIRK BIT_ULL(47) - - unsigned int num_active_eps; - unsigned int limit_active_eps; -diff --git a/drivers/usb/phytium/Kconfig b/drivers/usb/phytium/Kconfig -new file mode 100644 -index 000000000..797d7b4ee ---- /dev/null -+++ b/drivers/usb/phytium/Kconfig -@@ -0,0 +1,20 @@ -+config USB_PHYTIUM -+ tristate "PHYTIUM USB Support" -+ depends on USB -+ depends on USB_GADGET -+ help -+ Say Y or M here if your system has a OTG USB Controller based on PHYTIUM SOC. -+ -+ If you choose to build this driver is a dynamically linked modules, the module will -+ be called phytium-usb.ko -+ -+config USB_PHYTIUM_PCI -+ tristate "PHYTIUM PCI USB Support" -+ default n -+ depends on USB -+ depends on USB_GADGET -+ help -+ Say Y or M here if your system has a OTG USB Controller based on PHYTIUM SOC. -+ -+ If you choose to build this driver is a dynamically linked modules, the module will -+ be called phytium-usb-pci.ko -diff --git a/drivers/usb/phytium/Makefile b/drivers/usb/phytium/Makefile -new file mode 100644 -index 000000000..e176c334c ---- /dev/null -+++ b/drivers/usb/phytium/Makefile -@@ -0,0 +1,7 @@ -+# SPDX-License-Identifier: GPL-2.0 -+ -+obj-$(CONFIG_USB_PHYTIUM) += phytium-usb.o -+obj-$(CONFIG_USB_PHYTIUM_PCI) += phytium-usb-pci.o -+ -+phytium-usb-y := core.o dma.o platform.o host.o gadget.o -+phytium-usb-pci-y := core.o dma.o pci.o host.o gadget.o -diff --git a/drivers/usb/phytium/core.c b/drivers/usb/phytium/core.c -new file mode 100644 -index 000000000..c0182c077 ---- /dev/null -+++ b/drivers/usb/phytium/core.c -@@ -0,0 +1,44 @@ -+// SPDX-License-Identifier: GPL-2.0 -+ -+#include "core.h" -+ -+int phytium_core_reset(struct phytium_cusb *config, bool skip_wait) -+{ -+ if (!config) -+ return 0; -+ -+ spin_lock_init(&config->lock); -+ -+ return 0; -+} -+ -+uint32_t phytium_read32(uint32_t *address) -+{ -+ return readl(address); -+} -+ -+void phytium_write32(uint32_t *address, uint32_t value) -+{ -+ writel(value, address); -+} -+ -+uint16_t phytium_read16(uint16_t *address) -+{ -+ return readw(address); -+} -+ -+void phytium_write16(uint16_t *address, uint16_t value) -+{ -+ writew(value, address); -+} -+ -+uint8_t phytium_read8(uint8_t *address) -+{ -+ return readb(address); -+} -+ -+void phytium_write8(uint8_t *address, uint8_t value) -+{ -+ writeb(value, address); -+} -+ -diff --git a/drivers/usb/phytium/core.h b/drivers/usb/phytium/core.h -new file mode 100644 -index 000000000..f563672cc ---- /dev/null -+++ b/drivers/usb/phytium/core.h -@@ -0,0 +1,98 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+ -+#ifndef __PHYTIUM_CORE_H__ -+#define __PHYTIUM_CORE_H__ -+ -+#include -+#include -+#include "host_api.h" -+#include "gadget.h" -+ -+#define MAX_EPS_CHANNELS 16 -+ -+struct phytium_ep { -+ struct phytium_cusb *config; -+ u16 max_packet; -+ u8 ep_num; -+ struct GADGET_EP *gadget_ep; -+ struct list_head req_list; -+ struct usb_ep end_point; -+ char name[12]; -+ u8 is_tx; -+ const struct usb_endpoint_descriptor *desc; -+ u8 busy; -+}; -+ -+struct phytium_request { -+ struct usb_request request; -+ struct GADGET_REQ *gadget_request; -+ struct list_head list; -+ struct phytium_ep *ep; -+ struct phytium_cusb *config; -+ u8 is_tx; -+ u8 epnum; -+}; -+ -+struct phytium_cusb { -+ struct device *dev; -+ void __iomem *regs; -+ void __iomem *phy_regs; -+ int irq; -+ spinlock_t lock; -+ enum usb_dr_mode dr_mode; -+ -+ struct GADGET_OBJ *gadget_obj; -+ struct GADGET_CFG gadget_cfg; -+ struct GADGET_CALLBACKS gadget_callbacks; -+ struct GADGET_SYSREQ gadget_sysreq; -+ struct GADGET_DEV *gadget_dev; -+ void *gadget_priv; -+ -+ struct usb_gadget gadget; -+ struct usb_gadget_driver *gadget_driver; -+ struct phytium_ep endpoints_tx[MAX_EPS_CHANNELS]; -+ struct phytium_ep endpoints_rx[MAX_EPS_CHANNELS]; -+ u8 ep0_data_stage_is_tx; -+ -+ struct HOST_OBJ *host_obj; -+ struct HOST_CFG host_cfg; -+ struct HOST_CALLBACKS host_callbacks; -+ struct HOST_SYSREQ host_sysreq; -+ void *host_priv; -+ struct usb_hcd *hcd; -+ -+ struct DMA_OBJ *dma_obj; -+ struct DMA_CFG dma_cfg; -+ struct DMA_CALLBACKS dma_callbacks; -+ struct DMA_SYSREQ dma_sysreq; -+ bool isVhubHost; -+}; -+ -+int phytium_core_reset(struct phytium_cusb *config, bool skip_wait); -+ -+int phytium_host_init(struct phytium_cusb *config); -+int phytium_host_uninit(struct phytium_cusb *config); -+ -+#ifdef CONFIG_PM -+int phytium_host_resume(void *priv); -+int phytium_host_suspend(void *priv); -+int phytium_gadget_resume(void *priv); -+int phytium_gadget_suspend(void *priv); -+#endif -+ -+int phytium_gadget_init(struct phytium_cusb *config); -+int phytium_gadget_uninit(struct phytium_cusb *config); -+ -+uint32_t phytium_read32(uint32_t *address); -+ -+void phytium_write32(uint32_t *address, uint32_t value); -+ -+uint16_t phytium_read16(uint16_t *address); -+ -+void phytium_write16(uint16_t *address, uint16_t value); -+ -+uint8_t phytium_read8(uint8_t *address); -+ -+void phytium_write8(uint8_t *address, uint8_t value); -+ -+#endif -diff --git a/drivers/usb/phytium/dma.c b/drivers/usb/phytium/dma.c -new file mode 100644 -index 000000000..acc0674cf ---- /dev/null -+++ b/drivers/usb/phytium/dma.c -@@ -0,0 +1,784 @@ -+// SPDX-License-Identifier: GPL-2.0 -+ -+#include -+#include -+#include "core.h" -+#include "dma.h" -+#include "hw-regs.h" -+ -+#define TRB_POOL_SIZE (sizeof(struct DMA_Trb) * (NUM_OF_TRB)) -+#define TRB_BURST_LENGTH (0x80 << 24) -+ -+#define BUILD_NORMAL_TRB_NO_IOC(trb, data_ptr, data_size, stream_id) { \ -+ trb.dmaAddr = data_ptr; \ -+ trb.dmaSize = data_size; \ -+ trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT; } -+ -+#define BUILD_NORMAL_TRB_NO_IOC_CHAIN(trb, data_ptr, data_size, stream_id) { \ -+ trb.dmaAddr = data_ptr; \ -+ trb.dmaSize = data_size; \ -+ trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT | TDF_CHAIN_BIT; } -+ -+#define BUILD_NORMAL_TRB(trb, data_ptr, data_size, stream_id) { \ -+ trb.dmaAddr = data_ptr; \ -+ trb.dmaSize = (data_size) | TRB_BURST_LENGTH; \ -+ trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT |\ -+ TDF_INT_ON_COMPLECTION | TDF_INT_ON_SHORT_PACKET; } -+ -+#define BUILD_LINK_TRB(trb, target_ptr) { \ -+ trb.dmaAddr = target_ptr; \ -+ trb.dmaSize = 0; \ -+ trb.ctrl = TD_TYPE_LINK | TDF_CYCLE_BIT | TDF_CHAIN_BIT; } -+ -+#define BUILD_EMPTY_TRB(trb) { \ -+ trb.dmaAddr = 0; \ -+ trb.dmaSize = 0; \ -+ trb.ctrl = 0; } -+ -+ -+uint32_t divRoundUp(uint32_t divident, uint32_t divisor) -+{ -+ return divisor ? ((divident + divisor - 1) / divisor) : 0; -+} -+ -+static inline struct DMA_TrbChainDesc *GetTrbChainDescEntry(struct list_head *list) -+{ -+ return (struct DMA_TrbChainDesc *)((uintptr_t)list - -+ (uintptr_t)&(((struct DMA_TrbChainDesc *)0)->chainNode)); -+} -+ -+static int32_t phytium_dma_probe(struct DMA_CFG *config, struct DMA_SYSREQ *sysReq) -+{ -+ if (!sysReq) -+ return -EINVAL; -+ -+ sysReq->trbMemSize = TRB_POOL_SIZE; -+ sysReq->privDataSize = sizeof(struct DMA_CONTROLLER); -+ -+ return 0; -+} -+ -+static int32_t phytium_dma_init(struct DMA_CONTROLLER *priv, -+ const struct DMA_CFG *config, struct DMA_CALLBACKS *callbacks) -+{ -+ if (!priv || !config || !callbacks) -+ return -EINVAL; -+ -+ if (!config->trbAddr || !config->trbDmaAddr) -+ return -EINVAL; -+ -+ memset((void *)priv, 0, sizeof(struct DMA_CONTROLLER)); -+ memset((void *)config->trbAddr, 0, TRB_POOL_SIZE); -+ -+ priv->trbDMAPoolAddr = config->trbDmaAddr; -+ priv->trbPoolAddr = config->trbAddr; -+ priv->regs = (struct DMARegs *)config->regBase; -+ priv->dmaCfg = *config; -+ priv->dmaDrv = DMA_GetInstance(); -+ priv->dmaCallbacks = *callbacks; -+ priv->isHostCtrlMode = 0; -+ return 0; -+} -+ -+static void phytium_dma_destroy(struct DMA_CONTROLLER *priv) -+{ -+ -+} -+ -+static int32_t phytium_dma_start(struct DMA_CONTROLLER *priv) -+{ -+ int i; -+ -+ if (!priv) -+ return -EINVAL; -+ -+ priv->dmaMode = DMA_MODE_CHANNEL_INDIVIDUAL; -+ if ((priv->dmaCfg.dmaModeRx & priv->dmaCfg.dmaModeTx) == 0xFFFF) { -+ priv->dmaMode = DMA_MODE_GLOBAL_DMULT; -+ phytium_write32(&priv->regs->conf, DMARF_DMULT); -+ } else if ((priv->dmaCfg.dmaModeRx | priv->dmaCfg.dmaModeTx)) { -+ priv->dmaMode = DMA_MODE_GLOBAL_DSING; -+ phytium_write32(&priv->regs->conf, DMARF_DSING); -+ } -+ -+ for (i = 0; i < MAX_DMA_CHANNELS; i++) { -+ if (priv->dmaCfg.dmaModeRx & (1 << i)) { -+ priv->rx[i].dmultEnabled = 1; -+ priv->rx[i].maxTrbLen = TD_DMULT_MAX_TRB_DATA_SIZE; -+ priv->rx[i].maxTdLen = TD_DMULT_MAX_TD_DATA_SIZE; -+ } else { -+ priv->rx[i].dmultEnabled = 0; -+ priv->rx[i].maxTrbLen = TD_SING_MAX_TRB_DATA_SIZE; -+ priv->rx[i].maxTdLen = TD_SING_MAX_TD_DATA_SIZE; -+ } -+ priv->rx[i].lastTransferLength = 0; -+ -+ if (priv->dmaCfg.dmaModeTx & (1 << i)) { -+ priv->tx[i].dmultEnabled = 1; -+ priv->tx[i].maxTrbLen = TD_DMULT_MAX_TRB_DATA_SIZE; -+ priv->tx[i].maxTdLen = TD_DMULT_MAX_TD_DATA_SIZE; -+ } else { -+ priv->tx[i].dmultEnabled = 0; -+ priv->tx[i].maxTrbLen = TD_SING_MAX_TRB_DATA_SIZE; -+ priv->tx[i].maxTdLen = TD_SING_MAX_TD_DATA_SIZE; -+ } -+ priv->tx[i].lastTransferLength = 0; -+ } -+ -+ return 0; -+} -+ -+static uint32_t phytium_dma_stop(struct DMA_CONTROLLER *priv) -+{ -+ -+ return 0; -+} -+ -+static int32_t updateDescBuffer(struct DMA_CONTROLLER *priv, -+ struct DMA_TrbChainDesc *trbChainDesc, uint16_t status) -+{ -+ uint32_t ep_sel, i; -+ struct DMA_Channel *channel; -+ -+ if (!priv || !trbChainDesc) -+ return -EINVAL; -+ -+ channel = trbChainDesc->channel; -+ if (!channel) -+ return -EINVAL; -+ -+ if (channel->isIsoc && trbChainDesc->lastTrbIsLink) { -+ if (channel->trbChainDescList.prev == channel->trbChainDescList.next) -+ return 0; -+ } -+ -+ for (i = 0; i < trbChainDesc->numOfTrbs; i++) { -+ if (trbChainDesc->framesDesc) { -+ if (trbChainDesc->isoError) -+ trbChainDesc->framesDesc[i].length = 0; -+ else -+ trbChainDesc->framesDesc[i].length = -+ (uint32_t)trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK; -+ } -+ -+ trbChainDesc->actualLen += -+ (uint32_t)trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK; -+ } -+ -+ if (trbChainDesc->isoError) -+ trbChainDesc->actualLen = 0; -+ -+ ep_sel = phytium_read32(&priv->regs->ep_sel); -+ channel->lastTransferLength = trbChainDesc->actualLen; -+ -+ if (!trbChainDesc->lastTrbIsLink) { -+ if (!list_empty(&trbChainDesc->chainNode)) { -+ for (i = 0; i < trbChainDesc->mapSize; i++) -+ priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; -+ -+ trbChainDesc->channel->numOfTrbChain--; -+ trbChainDesc->reserved = 0; -+ list_del(&trbChainDesc->chainNode); -+ trbChainDesc = NULL; -+ } -+ } -+ -+ if (channel->trbChainDescList.prev == &channel->trbChainDescList) -+ channel->status = DMA_STATUS_FREE; -+ -+ if (priv->dmaCallbacks.complete) -+ priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, -+ channel->isDirTx, false); -+ -+ if (channel->trbChainDescList.next != &channel->trbChainDescList) { -+ trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); -+ if (trbChainDesc && trbChainDesc->lastTrbIsLink) { -+ if (!list_empty(&trbChainDesc->chainNode)) { -+ for (i = 0; i < trbChainDesc->mapSize; i++) -+ priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; -+ -+ trbChainDesc->channel->numOfTrbChain--; -+ trbChainDesc->reserved = 0; -+ list_del(&trbChainDesc->chainNode); -+ } -+ } -+ } -+ phytium_write32(&priv->regs->ep_sel, ep_sel); -+ -+ return 0; -+} -+ -+static void phytium_dma_isr(struct DMA_CONTROLLER *priv) -+{ -+ uint32_t ep_sts, ep_ists, ep_cfg; -+ int i; -+ uint8_t isDirTx, epNum; -+ struct DMA_Channel *channel; -+ struct DMA_TrbChainDesc *trbChainDesc; -+ -+ if (!priv) -+ return; -+ -+ ep_ists = phytium_read32(&priv->regs->ep_ists); -+ if (!ep_ists) { -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | -+ DMARF_EP_ISP | DMARF_EP_TRBERR); -+ return; -+ } -+ -+ for (i = 0; i < 32; i++) { -+ if (!(ep_ists & (1 << i))) -+ continue; -+ -+ isDirTx = i > 15 ? DMARD_EP_TX : 0u; -+ epNum = isDirTx ? i - 16 : i; -+ phytium_write32(&priv->regs->ep_sel, epNum | isDirTx); -+ -+ if (isDirTx) -+ channel = &priv->tx[epNum]; -+ else -+ channel = &priv->rx[epNum]; -+ -+ ep_sts = phytium_read32(&priv->regs->ep_sts); -+ -+ if (ep_sts & DMARF_EP_TRBERR) -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); -+ -+ if ((ep_sts & DMARF_EP_IOC) || (ep_sts & DMARF_EP_ISP) || (channel->dmultGuard -+ & DMARF_EP_IOC) || (channel->dmultGuard & DMARF_EP_ISP)) { -+retransmit: -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP); -+ trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); -+ if (!(ep_sts & DMARF_EP_TRBERR) && channel->dmultEnabled -+ && !trbChainDesc->lastTrbIsLink) { -+ if (!priv->isHostCtrlMode && !channel->isDirTx) { -+ channel->dmultGuard = 0; -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); -+ ep_cfg = phytium_read32(&priv->regs->ep_cfg); -+ ep_cfg &= ~DMARV_EP_ENABLED; -+ phytium_write32(&priv->regs->ep_cfg, (uint32_t)ep_cfg); -+ updateDescBuffer(priv, trbChainDesc, 0); -+ break; -+ } -+ channel->dmultGuard = ep_sts; -+ break; -+ } -+ -+ channel->dmultGuard = 0; -+ updateDescBuffer(priv, trbChainDesc, 0); -+ } -+ -+ if (ep_sts & DMARF_EP_OUTSMM) -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_OUTSMM); -+ -+ if (ep_sts & DMARF_EP_DESCMIS) -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_DESCMIS); -+ -+ if (ep_sts & DMARF_EP_ISOERR) { -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_ISOERR); -+ trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); -+ trbChainDesc->isoError = 1; -+ goto retransmit; -+ } -+ } -+} -+ -+static void phytium_dma_errIsr(struct DMA_CONTROLLER *priv, uint8_t irqNr, uint8_t isDirTx) -+{ -+ struct DMA_Channel *channel; -+ -+ if (!priv) -+ return; -+ -+ if (isDirTx) -+ channel = &priv->tx[irqNr]; -+ else -+ channel = &priv->rx[irqNr]; -+ -+ if (channel->status >= DMA_STATUS_BUSY) -+ channel->status = DMA_STATUS_ABORT; -+ -+ if (priv->dmaCallbacks.complete) { -+ if (!irqNr && priv->resubmit) { -+ priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, -+ channel->isDirTx, true); -+ priv->resubmit = false; -+ } else -+ priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, -+ channel->isDirTx, false); -+ } -+} -+ -+static void *phytium_dma_channelAlloc(struct DMA_CONTROLLER *priv, -+ uint8_t isDirTx, uint8_t hwEpNum, uint8_t isIsoc) -+{ -+ struct DMA_Channel *channel; -+ uint32_t ep_ien, ep_cfg; -+ uint16_t dmaMode; -+ -+ if (!priv || (hwEpNum >= MAX_DMA_CHANNELS)) -+ return NULL; -+ -+ if (!priv->regs) { -+ pr_err("dma regs is null\n"); -+ return NULL; -+ } -+ -+ ep_ien = phytium_read32(&priv->regs->ep_ien); -+ -+ if (isDirTx) { -+ if (priv->tx[hwEpNum].status > DMA_STATUS_FREE) -+ return NULL; -+ -+ channel = &priv->tx[hwEpNum]; -+ channel->isDirTx = 0x80; -+ ep_ien |= (0x01 << (hwEpNum + 16)); -+ dmaMode = priv->dmaCfg.dmaModeTx; -+ } else { -+ if (priv->rx[hwEpNum].status > DMA_STATUS_FREE) -+ return NULL; -+ -+ channel = &priv->rx[hwEpNum]; -+ channel->isDirTx = 0x00; -+ ep_ien |= (0x01 << hwEpNum); -+ dmaMode = priv->dmaCfg.dmaModeRx; -+ } -+ -+ channel->isIsoc = 0; -+ if (isIsoc) -+ channel->isIsoc = 1; -+ -+ INIT_LIST_HEAD(&channel->trbChainDescList); -+ channel->numOfTrbChain = 0; -+ channel->controller = priv; -+ channel->dmultGuard = 0; -+ channel->status = DMA_STATUS_FREE; -+ channel->hwUsbEppNum = hwEpNum; -+ -+ phytium_write32(&priv->regs->ep_sel, (uint32_t)hwEpNum | channel->isDirTx); -+ ep_cfg = phytium_read32(&priv->regs->ep_cfg); -+ -+ if (priv->dmaMode == DMA_MODE_CHANNEL_INDIVIDUAL) { -+ if (dmaMode & (1 << hwEpNum)) -+ ep_cfg |= DMARV_EP_DMULT; -+ else -+ ep_cfg |= DMARV_EP_DSING; -+ } -+ -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP | DMARF_EP_TRBERR); -+ phytium_write32(&priv->regs->ep_cfg, (uint32_t)DMARV_EP_ENABLED | ep_cfg); -+ phytium_write32(&priv->regs->ep_ien, ep_ien); -+ phytium_write32(&priv->regs->ep_sts_en, DMARF_EP_TRBERR); -+ -+ return channel; -+} -+ -+static int32_t phytium_dma_channelRelease(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) -+{ -+ uint32_t ep_ien, i; -+ struct DMA_TrbChainDesc *trbChainDesc; -+ -+ if (!channel || !priv) -+ return -EINVAL; -+ -+ ep_ien = phytium_read32(&priv->regs->ep_ien); -+ if (channel->isDirTx) -+ ep_ien &= ~(0x01 << (channel->hwUsbEppNum + 16)); -+ else -+ ep_ien &= ~(0x01 << channel->hwUsbEppNum); -+ -+ phytium_write32(&priv->regs->ep_sel, (uint32_t)channel->hwUsbEppNum | channel->isDirTx); -+ phytium_write32(&priv->regs->ep_cfg, (uint32_t)0); -+ phytium_write32(&priv->regs->ep_ien, ep_ien); -+ phytium_write32(&priv->regs->ep_sts_en, 0x0); -+ phytium_write32(&priv->regs->ep_cmd, DMARF_EP_EPRST); -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP | -+ DMARF_EP_TRBERR | DMARF_EP_ISOERR); -+ -+ if (channel->status >= DMA_STATUS_BUSY) -+ channel->status = DMA_STATUS_ABORT; -+ -+ priv->dmaDrv->dma_channelAbort(priv, channel); -+ -+ while (channel->trbChainDescList.next != &channel->trbChainDescList) { -+ trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); -+ if (trbChainDesc) { -+ if (!list_empty(&trbChainDesc->chainNode)) { -+ for (i = 0; i < trbChainDesc->mapSize; i++) -+ priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; -+ -+ trbChainDesc->channel->numOfTrbChain--; -+ trbChainDesc->reserved = 0; -+ list_del(&trbChainDesc->chainNode); -+ } -+ } -+ } -+ -+ channel->status = DMA_STATUS_UNKNOWN; -+ -+ return 0; -+} -+ -+static void ShowTrbChain(struct DMA_TrbChainDesc *trbChainDesc) -+{ -+ int i; -+ -+ if (!trbChainDesc) -+ return; -+ pr_debug("Trb Chain %p for channel %p\n", trbChainDesc, trbChainDesc->channel); -+ pr_debug("idx | trb size | trb addr | FLAG: NORMAL LINK CHAIN ALL\n"); -+ for (i = 0; i < trbChainDesc->numOfTrbs + 2; i++) -+ pr_debug("%02d | %08x | %08x | %d %d %d %08x\n", -+ i, -+ trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK, -+ trbChainDesc->trbPool[i].dmaAddr, -+ (trbChainDesc->trbPool[i].ctrl & TD_TYPE_NORMAL) ? 1 : 0, -+ (trbChainDesc->trbPool[i].ctrl & TD_TYPE_LINK) ? 1 : 0, -+ (trbChainDesc->trbPool[i].ctrl & TDF_CHAIN_BIT) ? 1 : 0, -+ trbChainDesc->trbPool[i].ctrl); -+} -+ -+static uint32_t phytium_dma_NewTd(struct DMA_CONTROLLER *priv, -+ struct DMA_TrbChainDesc *trbChainDesc) -+{ -+ uint32_t startAddress, dataSize; -+ struct DMA_Channel *channel; -+ int i = 0; -+ uint32_t tmp = 0; -+ -+ if (!priv || !trbChainDesc) -+ return 0; -+ -+ startAddress = trbChainDesc->dwStartAddress; -+ channel = trbChainDesc->channel; -+ dataSize = channel->maxTrbLen; -+ -+ if (trbChainDesc->numOfTrbs > 1) { -+ for (i = 0; i < (trbChainDesc->numOfTrbs - 1); i++) { -+ if (channel->dmultEnabled) { -+ if (trbChainDesc->framesDesc && priv->isHostCtrlMode -+ && channel->isIsoc) { -+ BUILD_NORMAL_TRB_NO_IOC(trbChainDesc->trbPool[i], -+ trbChainDesc->dwStartAddress + -+ trbChainDesc->framesDesc[i].offset, -+ trbChainDesc->framesDesc[i].length, 0); -+ continue; -+ } else -+ BUILD_NORMAL_TRB_NO_IOC(trbChainDesc->trbPool[i], -+ startAddress, dataSize, 0); -+ } else -+ BUILD_NORMAL_TRB_NO_IOC_CHAIN(trbChainDesc->trbPool[i], -+ startAddress, dataSize, 0); -+ startAddress += dataSize; -+ tmp += dataSize; -+ } -+ } -+ -+ if (trbChainDesc->framesDesc && priv->isHostCtrlMode && channel->isIsoc) { -+ BUILD_NORMAL_TRB(trbChainDesc->trbPool[i], -+ trbChainDesc->dwStartAddress + trbChainDesc->framesDesc[i].offset, -+ trbChainDesc->framesDesc[i].length, 0); -+ } else -+ BUILD_NORMAL_TRB(trbChainDesc->trbPool[i], startAddress, -+ trbChainDesc->len - tmp, 0); -+ -+ trbChainDesc->lastTrbIsLink = 0; -+ if (channel->dmultEnabled) { -+ if (channel->isIsoc) { -+ trbChainDesc->lastTrbIsLink = 1; -+ BUILD_LINK_TRB(trbChainDesc->trbPool[i + 1], trbChainDesc->trbDMAAddr); -+ } else -+ BUILD_EMPTY_TRB(trbChainDesc->trbPool[i + 1]); -+ } -+ -+ ShowTrbChain(trbChainDesc); -+ -+ return 0; -+} -+ -+static void phytium_dma_ArmTd(struct DMA_CONTROLLER *priv, struct DMA_TrbChainDesc *trbChainDesc) -+{ -+ uint32_t ep_sts, ep_cfg, ep_cmd; -+ struct DMA_TrbChainDesc *startedChain; -+ struct DMA_Trb *lastPrevTrb; -+ struct DMA_Channel *channel; -+ -+ if (!priv || !trbChainDesc) -+ return; -+ -+ channel = trbChainDesc->channel; -+ phytium_write32(&priv->regs->ep_sel, (channel->isDirTx | channel->hwUsbEppNum)); -+ -+ ep_sts = phytium_read32(&priv->regs->ep_sts); -+ -+ if (channel->status == DMA_STATUS_FREE) { -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); -+ phytium_write32(&priv->regs->traddr, trbChainDesc->trbDMAAddr); -+ phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); -+ -+ ep_cfg = phytium_read32(&priv->regs->ep_cfg); -+ phytium_write32(&priv->regs->ep_cmd, DMARF_EP_DRDY); -+ if (!(ep_cfg & DMARV_EP_ENABLED)) { -+ ep_cfg |= DMARV_EP_ENABLED; -+ phytium_write32(&priv->regs->ep_cfg, ep_cfg); -+ } -+ } else { -+ if (channel->trbChainDescList.prev != channel->trbChainDescList.next) { -+ startedChain = GetTrbChainDescEntry(channel->trbChainDescList.prev->prev); -+ lastPrevTrb = &startedChain->trbPool[startedChain->numOfTrbs]; -+ startedChain->lastTrbIsLink = 1; -+ BUILD_LINK_TRB((*lastPrevTrb), trbChainDesc->trbDMAAddr); -+ ep_cmd = phytium_read32(&priv->regs->ep_cmd); -+ if (!(ep_cmd & DMARF_EP_DRDY)) { -+ phytium_write32(&priv->regs->traddr, trbChainDesc->trbDMAAddr); -+ phytium_write32(&priv->regs->ep_cmd, DMARF_EP_DRDY); -+ } -+ ShowTrbChain(startedChain); -+ } -+ } -+} -+ -+static int32_t phytium_dma_TrbChainAlloc(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel, uint32_t numOfTrbs, struct DMA_TrbChainDesc **chain) -+{ -+ struct DMA_TrbChainDesc *trbChainDesc = NULL; -+ int i, j; -+ uint32_t mapcount, count = 0; -+ -+ if (!priv || !channel) -+ return -ENOMEM; -+ -+ for (i = 0; i < TAB_SIZE_OF_DMA_CHAIN; i++) { -+ if (!priv->trbChainDesc[i].reserved) { -+ trbChainDesc = &priv->trbChainDesc[i]; -+ break; -+ } -+ } -+ -+ if (!trbChainDesc) { -+ pr_err("No Free TRB Chain Descriptor\n"); -+ return -ENOMEM; -+ } -+ -+ INIT_LIST_HEAD(&trbChainDesc->chainNode); -+ *chain = NULL; -+ mapcount = (numOfTrbs + 2 + 7) >> 3; -+ -+ for (i = 0; i < TRB_MAP_SIZE; i++) { -+ if (priv->trbChainFreeMap[i] == 0x0) -+ count++; -+ else -+ count = 0; -+ -+ if (count == mapcount) -+ break; -+ } -+ -+ if (count != mapcount) { -+ pr_err("No Free TRBs count:0x%x, mapcount:0x%x\n", count, mapcount); -+ return -ENOMEM; -+ } -+ -+ trbChainDesc->reserved = 1; -+ trbChainDesc->channel = channel; -+ trbChainDesc->actualLen = 0; -+ trbChainDesc->mapSize = mapcount; -+ trbChainDesc->numOfTrbs = numOfTrbs; -+ trbChainDesc->start = (i + 1 - mapcount) << 3; -+ trbChainDesc->end = trbChainDesc->start; -+ trbChainDesc->trbPool = (struct DMA_Trb *)priv->trbPoolAddr + trbChainDesc->start; -+ trbChainDesc->trbDMAAddr = (uint32_t)(uintptr_t)((struct DMA_Trb *)priv->trbDMAPoolAddr -+ + trbChainDesc->start); -+ trbChainDesc->isoError = 0; -+ -+ list_add_tail(&trbChainDesc->chainNode, &channel->trbChainDescList); -+ -+ channel->numOfTrbChain++; -+ -+ for (j = 0; j < count; j++) -+ priv->trbChainFreeMap[i - j] = 0xFF; -+ -+ *chain = trbChainDesc; -+ -+ return 0; -+} -+ -+static int32_t phytium_dma_channelProgram(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel, uint16_t packetSize, uintptr_t dmaAddr, -+ uint32_t len, void *framesDesc, uint32_t framesNumber) -+{ -+ uint32_t numOfTrbs; -+ uint8_t retval; -+ struct DMA_TrbChainDesc *trbChainDesc; -+ -+ if (!priv || !channel) -+ return -EINVAL; -+ -+ //printk(KERN_ERR "%s %d\n",__func__,__LINE__); -+ if (framesDesc && priv->isHostCtrlMode && channel->isIsoc) -+ numOfTrbs = framesNumber; -+ else -+ numOfTrbs = divRoundUp(len, channel->maxTrbLen); -+ -+ retval = phytium_dma_TrbChainAlloc(priv, channel, numOfTrbs, &trbChainDesc); -+ if (retval) -+ return retval; -+ -+ trbChainDesc->dwStartAddress = dmaAddr; -+ trbChainDesc->len = len; -+ trbChainDesc->framesDesc = framesDesc; -+ -+ channel->wMaxPacketSize = packetSize; -+ phytium_dma_NewTd(priv, trbChainDesc); -+ channel->lastTransferLength = 0; -+ phytium_dma_ArmTd(priv, trbChainDesc); -+ -+ channel->status = DMA_STATUS_BUSY; -+ -+ return 0; -+} -+ -+static enum DMA_Status phytium_dma_getChannelStatus(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel) -+{ -+ uint32_t ep_cmd, ep_sts; -+ -+ if (!priv || !channel) -+ return DMA_STATUS_UNKNOWN; -+ -+ if (channel->status >= DMA_STATUS_BUSY) { -+ phytium_write32(&priv->regs->ep_sel, channel->isDirTx | channel->hwUsbEppNum); -+ ep_cmd = phytium_read32(&priv->regs->ep_cmd); -+ ep_sts = phytium_read32(&priv->regs->ep_sts); -+ -+ if ((ep_cmd & DMARF_EP_DRDY) || (ep_sts & DMARF_EP_DBUSY)) -+ channel->status = DMA_STATUS_ARMED; -+ else -+ channel->status = DMA_STATUS_BUSY; -+ } -+ -+ return channel->status; -+} -+ -+static int32_t phytium_dma_channelAbort(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) -+{ -+ struct DMA_TrbChainDesc *trbChainDesc; -+ uint32_t ep_cfg, i; -+ -+ if (!priv || !channel) -+ return -EINVAL; -+ -+ if (phytium_dma_getChannelStatus(priv, channel) >= DMA_STATUS_BUSY) -+ phytium_write32(&priv->regs->conf, DMARF_RESET); -+ -+ phytium_write32(&priv->regs->ep_sel, (uint32_t)(channel->isDirTx | channel->hwUsbEppNum)); -+ ep_cfg = phytium_read32(&priv->regs->ep_cfg); -+ ep_cfg &= ~DMARV_EP_ENABLED; -+ phytium_write32(&priv->regs->ep_cfg, ep_cfg); -+ phytium_write32(&priv->regs->ep_sts, 0xFFFFFFFF); -+ -+ while (channel->trbChainDescList.next != &channel->trbChainDescList) { -+ trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); -+ if (trbChainDesc) { -+ if (!list_empty(&trbChainDesc->chainNode)) { -+ for (i = 0; i < trbChainDesc->mapSize; i++) -+ priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; -+ -+ trbChainDesc->channel->numOfTrbChain--; -+ trbChainDesc->reserved = 0; -+ list_del(&trbChainDesc->chainNode); -+ } -+ } -+ } -+ if (channel->status != DMA_STATUS_UNKNOWN) -+ channel->status = DMA_STATUS_FREE; -+ -+ return 0; -+} -+ -+static int32_t phytium_dma_getActualLength(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) -+{ -+ if (!priv || !channel) -+ return -EINVAL; -+ -+ return channel->lastTransferLength; -+} -+ -+static int32_t phytium_dma_getMaxLength(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) -+{ -+ if (!priv || !channel) -+ return -EINVAL; -+ -+ return channel->maxTdLen; -+} -+ -+static int32_t phytium_dma_setMaxLength(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel, uint32_t val) -+{ -+ if (!priv || !channel) -+ return -EINVAL; -+ -+ if (channel->dmultEnabled) -+ channel->maxTrbLen = val; -+ else -+ channel->maxTrbLen = (val > TD_SING_MAX_TRB_DATA_SIZE) ? -+ TD_SING_MAX_TRB_DATA_SIZE : val; -+ -+ return 0; -+} -+ -+static void phytium_dma_setParentPriv(struct DMA_CONTROLLER *priv, void *parent) -+{ -+ if (!priv) -+ return; -+ -+ priv->parent = parent; -+} -+ -+void phytium_dma_controllerReset(struct DMA_CONTROLLER *priv) -+{ -+ uint32_t conf; -+ -+ if (!priv) -+ return; -+ -+ conf = phytium_read32(&priv->regs->conf); -+ conf |= DMARF_RESET; -+ phytium_write32(&priv->regs->conf, conf); -+ -+ priv->resubmit = true; -+} -+ -+void phytium_dma_setHostMode(struct DMA_CONTROLLER *priv) -+{ -+ if (!priv) -+ return; -+ -+ priv->isHostCtrlMode = 1; -+} -+ -+struct DMA_OBJ phytium_dma_Drv = { -+ .dma_probe = phytium_dma_probe, -+ .dma_init = phytium_dma_init, -+ .dma_destroy = phytium_dma_destroy, -+ .dma_start = phytium_dma_start, -+ .dma_stop = phytium_dma_stop, -+ .dma_isr = phytium_dma_isr, -+ .dma_errIsr = phytium_dma_errIsr, -+ .dma_channelAlloc = phytium_dma_channelAlloc, -+ .dma_channelRelease = phytium_dma_channelRelease, -+ .dma_channelProgram = phytium_dma_channelProgram, -+ .dma_channelAbort = phytium_dma_channelAbort, -+ .dma_getChannelStatus = phytium_dma_getChannelStatus, -+ .dma_getActualLength = phytium_dma_getActualLength, -+ .dma_getMaxLength = phytium_dma_getMaxLength, -+ .dma_setMaxLength = phytium_dma_setMaxLength, -+ .dma_setParentPriv = phytium_dma_setParentPriv, -+ .dma_controllerReset = phytium_dma_controllerReset, -+ .dma_setHostMode = phytium_dma_setHostMode, -+}; -+ -+struct DMA_OBJ *DMA_GetInstance(void) -+{ -+ return &phytium_dma_Drv; -+} -diff --git a/drivers/usb/phytium/dma.h b/drivers/usb/phytium/dma.h -new file mode 100644 -index 000000000..f2c25e600 ---- /dev/null -+++ b/drivers/usb/phytium/dma.h -@@ -0,0 +1,198 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+ -+#ifndef __PHYTIUM_DMA_H__ -+#define __PHYTIUM_DMA_H__ -+ -+#include -+//#include "list.h" -+ -+#define NUM_OF_TRB 1024 -+#define TRB_MAP_SIZE ((NUM_OF_TRB + (sizeof(uint8_t) * 8) - 1) / (sizeof(uint8_t) * 8)) -+#define MAX_DMA_CHANNELS 16 -+#define TAB_SIZE_OF_DMA_CHAIN (MAX_DMA_CHANNELS * 2) -+ -+#define DMARD_EP_TX 0x80ul -+#define DMARD_EP_RX 0x00ul -+ -+#define DMARF_EP_EPRST 0x00000001ul -+#define DMARF_EP_DRDY 0x00000040ul -+#define DMARF_EP_DFLUSH 0x00000080ul -+ -+#define DMARF_EP_IOC 0x4ul -+#define DMARF_EP_ISP 0x8ul -+#define DMARF_EP_DESCMIS 0x10ul -+#define DMARF_EP_TRBERR 0x80ul -+#define DMARF_EP_DBUSY 0x200ul -+#define DMARF_EP_CCS 0x800ul -+#define DMARF_EP_OUTSMM 0x4000ul -+#define DMARF_EP_ISOERR 0x8000ul -+#define DMARF_EP_DTRANS 0x80000000ul -+ -+#define DMARV_EP_DISABLED 0ul -+#define DMARV_EP_ENABLED 1ul -+#define DMARV_EP_DSING 0x1000ul -+#define DMARV_EP_DMULT 0x2000ul -+ -+#define TD_SIZE_MASK 0x00001FFFF -+ -+#define DMARF_RESET 0x00000001ul -+#define DMARF_DSING 0x00000100ul -+#define DMARF_DMULT 0x00000200ul -+ -+#define TD_DMULT_MAX_TRB_DATA_SIZE 65536u -+#define TD_DMULT_MAX_TD_DATA_SIZE (~1u) -+#define TD_SING_MAX_TRB_DATA_SIZE 65536u -+#define TD_SING_MAX_TD_DATA_SIZE 65536u -+ -+#define TD_TYPE_NORMAL 0x400L -+#define TD_TYPE_LINK 0x1800L -+#define TDF_CYCLE_BIT 0x1L -+#define TDF_TOGGLE_CYCLE_BIT 0x2L -+#define TDF_INT_ON_SHORT_PACKET 0x4L -+#define TDF_FIFO_MODE 0x8L -+#define TDF_CHAIN_BIT 0x10L -+#define TDF_INT_ON_COMPLECTION 0x20L -+#define TDF_STREAMID_VALID 0x200L -+ -+struct DMA_Trb { -+ uint32_t dmaAddr; -+ uint32_t dmaSize; -+ uint32_t ctrl; -+}; -+ -+enum DMA_Status { -+ DMA_STATUS_UNKNOWN, -+ DMA_STATUS_FREE, -+ DMA_STATUS_ABORT, -+ DMA_STATUS_BUSY, -+ DMA_STATUS_ARMED -+}; -+ -+struct DMA_CFG { -+ uintptr_t regBase; -+ uint16_t dmaModeTx; -+ uint16_t dmaModeRx; -+ void *trbAddr; -+ uintptr_t trbDmaAddr; -+}; -+ -+struct DMA_SYSREQ { -+ uint32_t privDataSize; -+ uint32_t trbMemSize; -+}; -+ -+struct DMA_CALLBACKS { -+ void (*complete)(void *pD, uint8_t epNum, uint8_t dir, bool resubmit); -+}; -+ -+struct DMA_CONTROLLER; -+ -+struct DMA_Channel { -+ struct DMA_CONTROLLER *controller; -+ uint16_t wMaxPacketSize; -+ uint8_t hwUsbEppNum; -+ uint8_t isDirTx; -+ uint32_t maxTdLen; -+ uint32_t maxTrbLen; -+ enum DMA_Status status; -+ void *priv; -+ uint32_t dmultGuard; -+ uint8_t dmultEnabled; -+ uint8_t numOfTrbChain; -+ struct list_head trbChainDescList; -+ uint32_t lastTransferLength; -+ uint8_t isIsoc; -+}; -+ -+struct DMA_OBJ { -+ int32_t (*dma_probe)(struct DMA_CFG *config, struct DMA_SYSREQ *sysReq); -+ -+ int32_t (*dma_init)(struct DMA_CONTROLLER *priv, const struct DMA_CFG *config, -+ struct DMA_CALLBACKS *callbacks); -+ -+ void (*dma_destroy)(struct DMA_CONTROLLER *priv); -+ -+ int32_t (*dma_start)(struct DMA_CONTROLLER *priv); -+ -+ uint32_t (*dma_stop)(struct DMA_CONTROLLER *priv); -+ -+ void (*dma_isr)(struct DMA_CONTROLLER *priv); -+ -+ void (*dma_errIsr)(struct DMA_CONTROLLER *priv, uint8_t irqNr, uint8_t isDirTx); -+ -+ void * (*dma_channelAlloc)(struct DMA_CONTROLLER *priv, -+ uint8_t isDirTx, uint8_t hwEpNum, uint8_t isIso); -+ -+ int32_t (*dma_channelRelease)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); -+ -+ int32_t (*dma_channelProgram)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel, -+ uint16_t packetSize, uintptr_t dmaAddr, -+ uint32_t len, void *framesDesc, uint32_t framesNumber); -+ -+ int32_t (*dma_channelAbort)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); -+ -+ enum DMA_Status (*dma_getChannelStatus)(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel); -+ -+ int32_t (*dma_getActualLength)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); -+ -+ int32_t (*dma_getMaxLength)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); -+ -+ int32_t (*dma_setMaxLength)(struct DMA_CONTROLLER *priv, -+ struct DMA_Channel *channel, uint32_t val); -+ -+ void (*dma_setParentPriv)(struct DMA_CONTROLLER *priv, void *parent); -+ -+ void (*dma_controllerReset)(struct DMA_CONTROLLER *priv); -+ -+ void (*dma_setHostMode)(struct DMA_CONTROLLER *priv); -+}; -+ -+enum DMA_Mode { -+ DMA_MODE_GLOBAL_DMULT, -+ DMA_MODE_GLOBAL_DSING, -+ DMA_MODE_CHANNEL_INDIVIDUAL, -+}; -+ -+struct DMA_TrbFrameDesc { -+ uint32_t length; -+ uint32_t offset; -+}; -+ -+struct DMA_TrbChainDesc { -+ uint8_t reserved; -+ struct DMA_Channel *channel; -+ struct DMA_Trb *trbPool; -+ uint32_t trbDMAAddr; -+ uint32_t len; -+ uint32_t dwStartAddress; -+ uint32_t actualLen; -+ uint8_t isoError; -+ uint8_t lastTrbIsLink; -+ uint32_t mapSize; -+ uint32_t numOfTrbs; -+ uint32_t start; -+ uint32_t end; -+ struct DMA_TrbFrameDesc *framesDesc; -+ struct list_head chainNode; -+}; -+ -+struct DMA_CONTROLLER { -+ struct DMARegs *regs; -+ struct DMA_OBJ *dmaDrv; -+ struct DMA_CFG dmaCfg; -+ struct DMA_CALLBACKS dmaCallbacks; -+ struct DMA_Channel rx[MAX_DMA_CHANNELS]; -+ struct DMA_Channel tx[MAX_DMA_CHANNELS]; -+ enum DMA_Mode dmaMode; -+ uint8_t isHostCtrlMode; -+ void *parent; -+ void *trbPoolAddr; -+ uintptr_t trbDMAPoolAddr; -+ uint8_t trbChainFreeMap[TRB_MAP_SIZE]; -+ struct DMA_TrbChainDesc trbChainDesc[TAB_SIZE_OF_DMA_CHAIN]; -+ bool resubmit; -+}; -+ -+struct DMA_OBJ *DMA_GetInstance(void); -+#endif -diff --git a/drivers/usb/phytium/gadget.c b/drivers/usb/phytium/gadget.c -new file mode 100644 -index 000000000..e5e1625d7 ---- /dev/null -+++ b/drivers/usb/phytium/gadget.c -@@ -0,0 +1,2538 @@ -+// SPDX-License-Identifier: GPL-2.0 -+ -+#include -+#include "gadget.h" -+#include "dma.h" -+#include "core.h" -+#include "hw-regs.h" -+ -+#define DRV_NAME "phytium_gadget" -+ -+#define GADGET_PRIV_BUFFER_SIZE 64 -+#define GADGET_USB_EP_NUMBER_MASK 0xf -+#define DMA_ADDR_INVALID (~(dma_addr_t)0) -+ -+#define GADGET_ESTALL 1 -+#define GADGET_EUNHANDLED 2 -+#define GADGET_EAUTOACK 3 -+#define GADGET_ESHUTDOWN 4 -+#define GADGET_ECONNRESET 5 -+#define GADGET_EAGAIN 6 -+ -+static inline struct GadgetEp *toGadgetEp(struct GADGET_EP *gadget_Ep) -+{ -+ return (struct GadgetEp *)((uintptr_t)gadget_Ep - -+ ((uintptr_t)&((struct GadgetEp *)0)->gadgetEp)); -+} -+ -+static inline struct GadgetRequest *requestToGadgetRequest(struct GADGET_REQ *req) -+{ -+ return (struct GadgetRequest *)((uintptr_t)req - -+ ((uintptr_t)&((struct GadgetRequest *)0)->request)); -+} -+ -+static inline struct GADGET_REQ *listToGadgetRequest(struct list_head *list) -+{ -+ return (struct GADGET_REQ *)((uintptr_t)list - -+ ((uintptr_t)&((struct GADGET_REQ *)0)->list)); -+} -+ -+#define listBrowsingRequest(iterator, head, memeber) \ -+ for (iterator = listToGadgetRequest((head)->next); \ -+ &iterator->list != (head); \ -+ iterator = listToGadgetRequest(iterator->list.next)) -+ -+static inline struct GADGET_REQ *gadgetGetNextReq(struct GadgetEp *gadgetEp) -+{ -+ struct list_head *list = &gadgetEp->request; -+ -+ if (list_empty(list)) { -+ pr_debug("no request available for %s\n", gadgetEp->gadgetEp.name); -+ return NULL; -+ } -+ -+ return listToGadgetRequest(list->next); -+} -+ -+static inline struct GADGET_REQ *gadgetGetNextEp0Req(struct GADGET_CTRL *priv) -+{ -+ struct list_head *queue; -+ -+ if (!priv) -+ return NULL; -+ -+ queue = &priv->in[0].request; -+ -+ if (list_empty(queue)) -+ return NULL; -+ -+ return listToGadgetRequest(queue->next); -+} -+ -+void gadget_giveback(struct phytium_ep *phy_ep, struct usb_request *usb_req, int status) -+{ -+ struct phytium_request *phy_req; -+ struct phytium_cusb *config; -+ int busy; -+ -+ if (!phy_ep || !usb_req) -+ return; -+ -+ busy = phy_ep->busy; -+ phy_req = usb_req ? container_of(usb_req, struct phytium_request, request) : NULL; -+ config = phy_req->config; -+ -+ list_del(&phy_req->list); -+ -+ if (usb_req->status == -EINPROGRESS) { -+ if (status == GADGET_ESHUTDOWN) -+ usb_req->status = -ESHUTDOWN; -+ else if (status == GADGET_ECONNRESET) -+ usb_req->status = -ECONNRESET; -+ else -+ usb_req->status = -phy_req->gadget_request->status; -+ } -+ -+ if (usb_req->status == 0) -+ pr_debug("%s done request %p, %d/%d\n", phy_ep->end_point.name, -+ usb_req, usb_req->actual, usb_req->length); -+ else -+ pr_debug("%s request %p, %d/%d fault %d\n", phy_ep->end_point.name, -+ usb_req, usb_req->actual, usb_req->length, usb_req->status); -+ -+ usb_gadget_unmap_request(&config->gadget, &phy_req->request, phy_req->is_tx); -+ -+ busy = phy_ep->busy; -+ phy_ep->busy = 1; -+ -+ spin_unlock(&config->lock); -+ -+ if (phy_req->request.complete) -+ phy_req->request.complete(&phy_req->ep->end_point, usb_req); -+ -+ spin_lock(&config->lock); -+ -+ phy_ep->busy = busy; -+} -+ -+static void gadget_callback_complete(struct GADGET_EP *gadget_ep, struct GADGET_REQ *gadget_req) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_request *phy_req; -+ struct usb_request *usb_req; -+ -+ if (!gadget_ep || !gadget_req) -+ return; -+ -+ phy_req = gadget_req->context; -+ usb_req = &phy_req->request; -+ phy_ep = phy_req->ep; -+ usb_req->actual = gadget_req->actual; -+ usb_req->length = gadget_req->length; -+ -+ gadget_giveback(phy_ep, usb_req, gadget_req->status); -+} -+ -+static void gadgetDisconnect(struct GADGET_CTRL *priv) -+{ -+ pr_info("Disconnect USB Device Driver\n"); -+ -+ if (!priv) -+ return; -+ -+ priv->gadgetDev.speed = USB_SPEED_UNKNOWN; -+ priv->gadgetDev.state = USB_STATE_NOTATTACHED; -+ -+ if (priv->eventCallback.disconnect) -+ priv->eventCallback.disconnect(priv); -+} -+ -+static int gadget_get_frame(struct usb_gadget *gadget) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return 0; -+} -+ -+static int gadget_wakeup(struct usb_gadget *gadget) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return 0; -+} -+ -+static int gadget_vbus_session(struct usb_gadget *gadget, int is_active) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return 0; -+} -+ -+static int gadget_vbus_draw(struct usb_gadget *gadget, unsigned int mA) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return 0; -+} -+ -+static int gadget_pullup(struct usb_gadget *gadget, int is_on) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ return 0; -+} -+ -+static int gadget_udc_start(struct usb_gadget *gadget, struct usb_gadget_driver *driver) -+{ -+ unsigned long flags; -+ struct phytium_cusb *config; -+ struct GADGET_CTRL *priv; -+ uint32_t gen_cfg; -+ -+ if (!gadget || !driver) -+ return -EINVAL; -+ -+ if (driver->max_speed < USB_SPEED_HIGH) -+ return -EINVAL; -+ -+ config = container_of(gadget, struct phytium_cusb, gadget); -+ -+ pr_info("registering driver %s\n", driver->function); -+ -+ spin_lock_irqsave(&config->lock, flags); -+ config->gadget_driver = driver; -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ config->gadget_obj->gadget_start(config->gadget_priv); -+ -+ priv = (struct GADGET_CTRL *)config->gadget_priv; -+ if (priv->phy_regs) { -+ gen_cfg = phytium_read32(&priv->phy_regs->gen_cfg); -+ gen_cfg = gen_cfg & (~BIT(7)); -+ phytium_write32(&priv->phy_regs->gen_cfg, gen_cfg); -+ } -+ -+ return 0; -+} -+ -+static int gadget_udc_stop(struct usb_gadget *gadget) -+{ -+ struct phytium_cusb *config; -+ unsigned long flags; -+ struct GADGET_CTRL *priv; -+ uint32_t gen_cfg; -+ -+ if (!gadget) -+ return -EINVAL; -+ -+ config = container_of(gadget, struct phytium_cusb, gadget); -+ -+ priv = (struct GADGET_CTRL *)config->gadget_priv; -+ if (priv->phy_regs) { -+ gen_cfg = phytium_read32(&priv->phy_regs->gen_cfg); -+ gen_cfg = gen_cfg | BIT(7); -+ phytium_write32(&priv->phy_regs->gen_cfg, gen_cfg); -+ } -+ spin_lock_irqsave(&config->lock, flags); -+ config->gadget_driver = NULL; -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static struct usb_gadget_ops phytium_gadget_ops = { -+ .get_frame = gadget_get_frame, -+ .wakeup = gadget_wakeup, -+ .vbus_session = gadget_vbus_session, -+ .vbus_draw = gadget_vbus_draw, -+ .pullup = gadget_pullup, -+ .udc_start = gadget_udc_start, -+ .udc_stop = gadget_udc_stop, -+}; -+ -+static int gadget_ep_enable(struct usb_ep *ls_ep, const struct usb_endpoint_descriptor *desc) -+{ -+ struct phytium_ep *phy_ep = NULL; -+ struct phytium_cusb *config; -+ unsigned long flags; -+ -+ if (!ls_ep || !desc) -+ return -EINVAL; -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ -+ if (phy_ep->desc) -+ return -EBUSY; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ phy_ep->desc = desc; -+ phy_ep->busy = 0; -+ config->gadget_obj->gadget_epEnable(config->gadget_priv, phy_ep->gadget_ep, desc); -+ -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static int gadget_ep_disable(struct usb_ep *ls_ep) -+{ -+ struct phytium_ep *phy_ep = NULL; -+ struct phytium_cusb *config; -+ unsigned long flags; -+ -+ if (!ls_ep) -+ return -EBUSY; -+ -+ pr_info("%s %d\n", __func__, __LINE__); -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ phy_ep->desc = NULL; -+ phy_ep->busy = 0; -+ phy_ep->end_point.desc = NULL; -+ config->gadget_obj->gadget_epDisable(config->gadget_priv, phy_ep->gadget_ep); -+ -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static struct usb_request *gadget_ep_alloc_request(struct usb_ep *ls_ep, gfp_t gfp_flags) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_cusb *config; -+ struct GADGET_EP *gadget_ep; -+ struct phytium_request *phy_request; -+ -+ if (!ls_ep) -+ return NULL; -+ -+ pr_info("%s %d\n", __func__, __LINE__); -+ phy_request = kzalloc(sizeof(*phy_request), gfp_flags); -+ if (!phy_request) { -+ pr_err("not enough momory\n"); -+ return NULL; -+ } -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ gadget_ep = phy_ep->gadget_ep; -+ -+ INIT_LIST_HEAD(&phy_request->list); -+ phy_request->request.dma = DMA_ADDR_INVALID; -+ phy_request->epnum = phy_ep->ep_num; -+ phy_request->ep = phy_ep; -+ phy_request->config = phy_ep->config; -+ -+ config->gadget_obj->gadget_reqAlloc(config->gadget_priv, gadget_ep, -+ &phy_request->gadget_request); -+ -+ return &phy_request->request; -+} -+ -+static void gadget_ep_free_request(struct usb_ep *ls_ep, struct usb_request *ls_req) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_cusb *config; -+ struct phytium_request *phy_request; -+ -+ if (!ls_ep || !ls_req) -+ return; -+ -+ pr_info("%s %d\n", __func__, __LINE__); -+ phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; -+ config = phy_request->config; -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ -+ config->gadget_obj->gadget_reqFree(config->gadget_priv, phy_ep->gadget_ep, -+ phy_request->gadget_request); -+ kfree(phy_request); -+} -+ -+static int gadget_ep_enqueue(struct usb_ep *ls_ep, struct usb_request *ls_req, gfp_t gfp_flags) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_cusb *config; -+ struct phytium_request *phy_request; -+ unsigned long flags; -+ int status = 0; -+ -+ if (!ls_ep || !ls_req) -+ return -EINVAL; -+ -+ if (!ls_req->buf) -+ return -ENODATA; -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; -+ phy_request->config = config; -+ -+ if (phy_request->ep != phy_ep) -+ return -EINVAL; -+ -+ phy_request->request.actual = 0; -+ phy_request->request.status = -EINPROGRESS; -+ phy_request->epnum = phy_ep->ep_num; -+ phy_request->is_tx = phy_ep->is_tx; -+ -+ phy_request->gadget_request->length = ls_req->length; -+ phy_request->gadget_request->status = 0; -+ phy_request->gadget_request->complete = gadget_callback_complete; -+ phy_request->gadget_request->buf = ls_req->buf; -+ phy_request->gadget_request->context = ls_req; -+ -+ status = usb_gadget_map_request(&config->gadget, &phy_request->request, phy_request->is_tx); -+ -+ if (!phy_ep->desc) { -+ pr_debug("req %p queued to %s while ep %s\n", phy_request, ls_ep->name, "disabled"); -+ status = -ESHUTDOWN; -+ usb_gadget_unmap_request(&config->gadget, &phy_request->request, -+ phy_request->is_tx); -+ return status; -+ } -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ phy_request->gadget_request->dma = phy_request->request.dma; -+ list_add_tail(&phy_request->list, &phy_ep->req_list); -+ -+ pr_debug("queue to %s (%s), length = %d\n", phy_ep->name, -+ phy_ep->is_tx ? "IN/TX" : "OUT/RX", phy_request->request.length); -+ -+ status = config->gadget_obj->gadget_reqQueue(config->gadget_priv, phy_ep->gadget_ep, -+ phy_request->gadget_request); -+ -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return status; -+} -+ -+static int gadget_ep_dequeue(struct usb_ep *ls_ep, struct usb_request *ls_req) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_cusb *config; -+ unsigned long flags; -+ int status = 0; -+ struct phytium_request *phy_request; -+ struct phytium_request *phy_next_request; -+ -+ if (!ls_ep || !ls_req) -+ return -EINVAL; -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; -+ -+ if (phy_request->ep != phy_ep) -+ return -EINVAL; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ list_for_each_entry(phy_next_request, &phy_ep->req_list, list) { -+ if (phy_next_request == phy_request) -+ break; -+ } -+ -+ if (phy_next_request != phy_request) { -+ pr_info("request %p not queued to %s\n", phy_request, ls_ep->name); -+ status = -EINVAL; -+ goto done; -+ } -+ -+ status = config->gadget_obj->gadget_reqDequeue(config->gadget_priv, phy_ep->gadget_ep, -+ phy_request->gadget_request); -+done: -+ spin_unlock_irqrestore(&config->lock, flags); -+ return status; -+} -+ -+static int gadget_ep_set_halt(struct usb_ep *ls_ep, int value) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_cusb *config; -+ struct GADGET_EP *gadget_ep = NULL; -+ unsigned long flags; -+ int status = 0; -+ -+ if (!ls_ep) -+ return -EINVAL; -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ gadget_ep = phy_ep->gadget_ep; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ status = config->gadget_obj->gadget_epSetHalt(config->gadget_priv, -+ phy_ep->gadget_ep, value); -+ if (status > 0) { -+ spin_unlock_irqrestore(&config->lock, flags); -+ return -status; -+ } -+ -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static const struct usb_ep_ops gadget_ep_ops = { -+ .enable = gadget_ep_enable, -+ .disable = gadget_ep_disable, -+ .alloc_request = gadget_ep_alloc_request, -+ .free_request = gadget_ep_free_request, -+ .queue = gadget_ep_enqueue, -+ .dequeue = gadget_ep_dequeue, -+ .set_halt = gadget_ep_set_halt, -+}; -+ -+static int gadget_ep0_enable(struct usb_ep *ep, const struct usb_endpoint_descriptor *desc) -+{ -+ return -EINVAL; -+} -+ -+static int gadget_ep0_disable(struct usb_ep *ep) -+{ -+ return -EINVAL; -+} -+ -+static int gadget_ep0_enqueue(struct usb_ep *ls_ep, struct usb_request *ls_req, gfp_t gfp_flags) -+{ -+ struct phytium_ep *phy_ep; -+ struct phytium_request *phy_request; -+ struct phytium_cusb *config; -+ int status = 0; -+ unsigned long flags; -+ -+ if (!ls_ep || !ls_req) -+ return -EINVAL; -+ -+ phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; -+ config = phy_ep->config; -+ phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ -+ if (!list_empty(&phy_ep->req_list)) { -+ status = -EBUSY; -+ goto cleanup; -+ } -+ -+ phy_request->config = config; -+ phy_request->request.actual = 0; -+ phy_request->gadget_request->actual = 0; -+ phy_request->is_tx = config->ep0_data_stage_is_tx; -+ phy_request->gadget_request->length = phy_request->request.length; -+ phy_request->gadget_request->status = 0; -+ phy_request->gadget_request->complete = gadget_callback_complete; -+ phy_request->gadget_request->buf = phy_request->request.buf; -+ phy_request->gadget_request->context = phy_request; -+ -+ status = usb_gadget_map_request(&config->gadget, &phy_request->request, phy_request->is_tx); -+ if (status) { -+ pr_info("failed to map request\n"); -+ status = -EINVAL; -+ goto cleanup; -+ } -+ -+ phy_request->gadget_request->dma = phy_request->request.dma; -+ list_add_tail(&phy_request->list, &phy_ep->req_list); -+ -+ pr_debug("queue to %s (%s), length = %d\n", phy_ep->name, -+ phy_ep->is_tx ? "IN/TX" : "OUT/RX", phy_request->request.length); -+ -+ status = config->gadget_obj->gadget_reqQueue(config->gadget_priv, phy_ep->gadget_ep, -+ phy_request->gadget_request); -+ if (status > 0) { -+ status = -status; -+ usb_gadget_unmap_request(&config->gadget, &phy_request->request, -+ phy_request->is_tx); -+ list_del(&phy_request->list); -+ goto cleanup; -+ } -+ -+cleanup: -+ spin_unlock_irqrestore(&config->lock, flags); -+ return status; -+} -+ -+static int gadget_ep0_dequeue(struct usb_ep *ep, struct usb_request *ls_request) -+{ -+ return -EOPNOTSUPP; -+} -+ -+static int gadget_ep0_set_halt(struct usb_ep *ep, int value) -+{ -+ return -EINVAL; -+} -+ -+ -+static const struct usb_ep_ops gadget_ep0_ops = { -+ .enable = gadget_ep0_enable, -+ .disable = gadget_ep0_disable, -+ .alloc_request = gadget_ep_alloc_request, -+ .free_request = gadget_ep_free_request, -+ .queue = gadget_ep0_enqueue, -+ .dequeue = gadget_ep0_dequeue, -+ .set_halt = gadget_ep0_set_halt, -+}; -+ -+static int32_t gadgetWaitForBusyBit(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) -+{ -+ struct GadgetEp *gadgetEp; -+ uint8_t epNum; -+ uint8_t txcs = CS_BUSY; -+ uint8_t buf = 0; -+ uint8_t bufflag = 0; -+ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ epNum = gadgetEp->hwEpNum; -+ -+ if (gadgetEp->isInEp || gadgetEp->hwEpNum == 0) -+ return 0; -+ -+ buf = phytium_read8(&priv->regs->ep[epNum - 1].txcon) & CON_BUF; -+ -+ while ((txcs & CS_BUSY) || (bufflag == 0)) { -+ txcs = phytium_read8(&priv->regs->ep[epNum - 1].txcs); -+ -+ if (((txcs & CS_NPAK) >> CS_NPAK_OFFSET) == buf || buf == 0) -+ bufflag = 1; -+ else -+ bufflag = 0; -+ } -+ -+ return 0; -+} -+ -+static inline void gadgetEpXDataReceive(struct GADGET_CTRL *priv, -+ struct GadgetRequest *gadgetRequest) -+{ -+ struct GadgetEp *gadgetEp; -+ struct GADGET_REQ *gadgetReq; -+ uint8_t epType; -+ uint32_t requestSize, channelStatus, chMaxLen; -+ -+ if (!priv || !gadgetRequest) -+ return; -+ -+ gadgetEp = gadgetRequest->ep; -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); -+ epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ channelStatus = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, gadgetEp->channel); -+ -+ gadgetReq = &gadgetRequest->request; -+ if (gadgetReq->actual < gadgetReq->length || gadgetRequest->zlp) { -+ gadgetRequest->zlp = 0; -+ if ((gadgetReq->length - gadgetReq->actual) < chMaxLen) -+ requestSize = gadgetReq->length - gadgetReq->actual; -+ else -+ requestSize = chMaxLen; -+ -+ priv->dmaDrv->dma_channelProgram(priv->dmaController, gadgetEp->channel, -+ gadgetEp->gadgetEp.maxPacket, -+ gadgetReq->dma + gadgetReq->actual, requestSize, NULL, 0); -+ } -+} -+ -+static inline void gadgetEpXDataSend(struct GADGET_CTRL *priv, struct GadgetRequest *gadgetRequest) -+{ -+ struct GadgetEp *gadgetEp; -+ struct GADGET_REQ *gadgetReq; -+ uint8_t epType; -+ uint32_t requestSize, channelStatus, chMaxLen; -+ -+ if (!priv || !gadgetRequest) -+ return; -+ -+ gadgetEp = gadgetRequest->ep; -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); -+ epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ channelStatus = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, gadgetEp->channel); -+ -+ gadgetReq = &gadgetRequest->request; -+ if ((gadgetReq->length - gadgetReq->actual) < chMaxLen) -+ requestSize = gadgetReq->length - gadgetReq->actual; -+ else -+ requestSize = chMaxLen; -+ pr_debug("Transmit/IN %s gadgetReq %p gadgetRequest:%p requestSize:0x%x packetSize:0x%x\n", -+ gadgetEp->gadgetEp.name, gadgetReq, gadgetRequest, -+ requestSize, gadgetEp->gadgetEp.maxPacket); -+ -+ gadgetRequest->zlp = 0; -+ priv->dmaDrv->dma_channelProgram(priv->dmaController, gadgetEp->channel, -+ gadgetEp->gadgetEp.maxPacket, -+ gadgetReq->dma + gadgetReq->actual, requestSize, NULL, 0); -+} -+ -+static int32_t gadgetEpXSetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ uint8_t value) -+{ -+ struct GadgetEp *gadgetEp; -+ uint8_t epType; -+ struct GADGET_REQ *req = NULL; -+ struct GadgetRequest *gadgetRequest = NULL; -+ uint8_t epNum, txcon, rxcon; -+ uint32_t status = DMA_STATUS_ARMED; -+ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ if (epType == USB_ENDPOINT_XFER_ISOC) -+ return -EINVAL; -+ -+ pr_debug("%s: %s stall\n", gadget_Ep->name, value ? "set" : "clear"); -+ req = gadgetGetNextReq(gadgetEp); -+ -+ if (!value) -+ gadgetEp->wedged = 0; -+ -+ if (value && gadgetEp->isInEp && req && gadgetEp->state == GADGET_EP_BUSY) { -+ while (status == DMA_STATUS_ARMED) -+ status = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, -+ gadgetEp->channel); -+ -+ gadgetWaitForBusyBit(priv, gadget_Ep); -+ } -+ -+ epNum = gadgetEp->hwEpNum; -+ -+ if (gadgetEp->isInEp) { -+ txcon = phytium_read8(&priv->regs->ep[epNum - 1].txcon); -+ if (value) { -+ phytium_write8(&priv->regs->ep[epNum - 1].txcon, txcon | CON_STALL); -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, -+ ENDPRST_IO_TX | epNum | ENDPRST_FIFORST); -+ -+ } else { -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, -+ ENDPRST_IO_TX | epNum | ENDPRST_TOGRST); -+ phytium_write8(&priv->regs->ep[epNum - 1].txcon, txcon & (~CON_STALL)); -+ } -+ } else { -+ rxcon = phytium_read8(&priv->regs->ep[epNum - 1].rxcon); -+ if (value) { -+ phytium_write8(&priv->regs->ep[epNum - 1].rxcon, rxcon | CON_STALL); -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, epNum | ENDPRST_FIFORST); -+ } else { -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, -+ epNum | ENDPRST_TOGRST | ENDPRST_FIFORST); -+ phytium_write8(&priv->regs->ep[epNum - 1].rxcon, rxcon & (~CON_STALL)); -+ } -+ } -+ -+ if (gadgetEp->state != GADGET_EP_BUSY && !value && req) { -+ gadgetRequest = requestToGadgetRequest(req); -+ if (gadgetEp->isInEp) -+ gadgetEpXDataSend(priv, gadgetRequest); -+ else -+ gadgetEpXDataReceive(priv, gadgetRequest); -+ } -+ -+ return 0; -+} -+ -+static int32_t gadgetEp0SetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ uint8_t value) -+{ -+ struct GadgetEp *gadgetEp; -+ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ if (!list_empty(&gadgetEp->request)) -+ return -EBUSY; -+ -+ switch (priv->ep0State) { -+ case GADGET_EP0_STAGE_IN: -+ case GADGET_EP0_STAGE_OUT: -+ case GADGET_EP0_STAGE_ACK: -+ case GADGET_EP0_STAGE_STATUSIN: -+ case GADGET_EP0_STAGE_STATUSOUT: -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+ -+static void gadgetEp0Callback(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req, uint8_t status) -+{ -+ if (!priv || !gadgetEp || !req) -+ return; -+ -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ list_del(&req->list); -+ gadgetEp->requestsInList--; -+ -+ if (req->status == EINPROGRESS) -+ req->status = status; -+ -+ if (req->complete) -+ req->complete(&gadgetEp->gadgetEp, req); -+} -+ -+static enum usb_device_speed gadgetGetActualSpeed(struct GADGET_CTRL *priv) -+{ -+ uint8_t speedctrl; -+ -+ if (!priv) -+ return USB_SPEED_UNKNOWN; -+ -+ speedctrl = phytium_read8(&priv->regs->speedctrl) & (~SPEEDCTRL_HSDISABLE); -+ switch (speedctrl) { -+ case SPEEDCTRL_HS: -+ return USB_SPEED_HIGH; -+ case SPEEDCTRL_FS: -+ return USB_SPEED_FULL; -+ case SPEEDCTRL_LS: -+ return USB_SPEED_LOW; -+ default: -+ return USB_SPEED_UNKNOWN; -+ } -+} -+ -+static int32_t gadgetServiceSetFeatureReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) -+{ -+ uint8_t epNum, isIn; -+ struct GadgetEp *gadgetEp; -+ -+ if (!priv || !setup) -+ return 0; -+ -+ switch (setup->bRequestType & USB_RECIP_MASK) { -+ case USB_RECIP_DEVICE: -+ switch (setup->wValue) { -+ case USB_DEVICE_REMOTE_WAKEUP: -+ pr_info("set feature - remote wakup\n"); -+ priv->isRemoteWakeup = 1; -+ break; -+ case USB_DEVICE_B_HNP_ENABLE: -+ pr_info("set feature - B HNP Enable\n"); -+ pr_info("otg not implement\n"); -+ return -EINVAL; -+ case USB_DEVICE_A_HNP_SUPPORT: -+ pr_info("set feature - A HNP support\n"); -+ pr_info("otg not implete\n"); -+ return -EINVAL; -+ } -+ break; -+ case USB_RECIP_INTERFACE: -+ break; -+ case USB_RECIP_ENDPOINT: -+ epNum = setup->wIndex & 0x0f; -+ isIn = setup->wIndex & USB_DIR_IN; -+ if (epNum == 0 || epNum > 15 || setup->wValue != 0) -+ return -EINVAL; -+ -+ gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; -+ -+ gadgetEpXSetHalt(priv, &gadgetEp->gadgetEp, 1); -+ break; -+ default: -+ return -EINVAL; -+ } -+ return 0; -+} -+ -+static int32_t gadgetServiceClearFeatureReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) -+{ -+ uint8_t epNum, isIn; -+ struct GadgetEp *gadgetEp; -+ -+ if (!priv || !setup) -+ return -EINVAL; -+ -+ switch (setup->bRequestType & USB_RECIP_MASK) { -+ case USB_RECIP_DEVICE: -+ if (setup->wValue == USB_DEVICE_B_HNP_ENABLE) { -+ pr_err("otg not implement\n"); -+ return -EINVAL; -+ } -+ -+ if (setup->wValue != USB_DEVICE_REMOTE_WAKEUP) -+ return GADGET_EUNHANDLED; -+ -+ priv->isRemoteWakeup = 0; -+ return GADGET_EAUTOACK; -+ case USB_RECIP_INTERFACE: -+ break; -+ case USB_RECIP_ENDPOINT: -+ pr_info("clear feature wIndex:0x%x wValue:0x%x\n", setup->wIndex, setup->wValue); -+ epNum = setup->wIndex & 0x7f; -+ isIn = setup->wIndex & USB_DIR_IN; -+ if (epNum == 0 || epNum > 15 || setup->wValue != 0) -+ return GADGET_EUNHANDLED; -+ -+ gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; -+ if (!gadgetEp->gadgetEp.desc) -+ return -EINVAL; -+ -+ if (gadgetEp->wedged) -+ break; -+ gadgetEpXSetHalt(priv, &gadgetEp->gadgetEp, 0); -+ break; -+ default: -+ return GADGET_EUNHANDLED; -+ } -+ -+ return 0; -+} -+ -+static int32_t gadgetServiceSetupReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) -+{ -+ struct GadgetEp *gadgetEp; -+ uint8_t isIn, epNum; -+ uint8_t rxcon, txcon; -+ int len; -+ -+ if (!priv || !setup) -+ return -EINVAL; -+ -+ if ((setup->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) { -+ if (setup->bRequest != USB_REQ_GET_STATUS) -+ return GADGET_EUNHANDLED; -+ } else -+ return GADGET_EUNHANDLED; -+ -+ priv->privBuffAddr[1] = 0; -+ priv->privBuffAddr[0] = 0; -+ -+ switch (setup->bRequest & USB_RECIP_MASK) { -+ case USB_RECIP_DEVICE: -+ pr_info("wIndex:0x%x isSelfPowered:%d isRomoteWakeup:%d\n", -+ setup->wIndex, priv->isSelfPowered, priv->isRemoteWakeup); -+ -+ if (setup->wIndex == OTG_STS_SELECTOR) -+ priv->privBuffAddr[0] = priv->hostRequestFlag; -+ else { -+ priv->privBuffAddr[0] = priv->isSelfPowered ? USB_DEVICE_SELF_POWERED : 0; -+ priv->privBuffAddr[1] = priv->isRemoteWakeup ? USB_DEVICE_REMOTE_WAKEUP : 0; -+ } -+ break; -+ case USB_RECIP_INTERFACE: -+ break; -+ case USB_RECIP_ENDPOINT: -+ epNum = setup->wIndex & 0x0f; -+ if (!epNum) -+ break; -+ -+ isIn = setup->wIndex & USB_DIR_IN; -+ -+ gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; -+ if (!gadgetEp->gadgetEp.desc) -+ return -EINVAL; -+ -+ if (isIn) { -+ txcon = phytium_read8(&priv->regs->ep[epNum - 1].txcon); -+ priv->privBuffAddr[0] = (txcon & CON_STALL) ? 1 : 0; -+ } else { -+ rxcon = phytium_read8(&priv->regs->ep[epNum - 1].rxcon); -+ priv->privBuffAddr[0] = (rxcon & CON_STALL) ? 1 : 0; -+ } -+ break; -+ default: -+ return GADGET_EUNHANDLED; -+ } -+ -+ len = setup->wLength; -+ if (len > 2) -+ len = 2; -+ -+ priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->in[0].channel, -+ priv->in[0].gadgetEp.maxPacket, priv->privBuffDma, len, NULL, 0); -+ -+ return 0; -+} -+ -+static int32_t gadgetGetSetup(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) -+{ -+ int i; -+ uint8_t ep0cs; -+ struct GADGET_REQ *request = NULL; -+ struct GadgetRequest *gadgetRequest; -+ -+ if (!priv || !setup) -+ return -EINVAL; -+ -+ phytium_write8(&priv->regs->ep0cs, EP0CS_CHGSET); -+ -+ for (i = 0; i < 8; i++) -+ ((char *)setup)[i] = phytium_read8(&priv->regs->setupdat[i]); -+ -+ ep0cs = phytium_read8(&priv->regs->ep0cs); -+ if (ep0cs & EP0CS_CHGSET) { -+ pr_info("setup flags change: not error\n"); -+ return GADGET_EAUTOACK; -+ } -+ -+ phytium_write8(&priv->regs->usbirq, USBIR_SUDAV); -+ pr_debug("setup packet: req%02x.%02x v:%04x i:%04x I%d\n", setup->bRequestType, -+ setup->bRequest, setup->wValue, setup->wIndex, setup->wLength); -+ -+ request = gadgetGetNextEp0Req(priv); -+ if (request) { -+ gadgetRequest = requestToGadgetRequest(request); -+ pr_info("Previous request has not been finished but new was received\n"); -+ gadgetEp0Callback(priv, gadgetRequest->ep, request, 0); -+ } -+ -+ if (setup->wLength) { -+ if (setup->bRequestType & USB_DIR_IN) -+ priv->ep0State = GADGET_EP0_STAGE_IN; -+ else -+ priv->ep0State = GADGET_EP0_STAGE_OUT; -+ } else -+ priv->ep0State = GADGET_EP0_STAGE_ACK; -+ -+ return 0; -+} -+ -+static void gadgetEp0StageSetup(struct GADGET_CTRL *priv) -+{ -+ struct usb_ctrlrequest setup; -+ int32_t retval; -+ uint8_t ep0cs; -+ -+ if (!priv) -+ return; -+ -+ retval = gadgetGetSetup(priv, &setup); -+ -+ priv->gadgetDev.speed = gadgetGetActualSpeed(priv); -+ -+ switch (priv->ep0State) { -+ case GADGET_EP0_STAGE_ACK: -+ if ((setup.bRequestType & USB_TYPE_MASK) != USB_TYPE_STANDARD) -+ retval = GADGET_EUNHANDLED; -+ else { -+ switch (setup.bRequest) { -+ case USB_REQ_SET_ADDRESS: -+ priv->deviceAddress = setup.wValue & 0x7F; -+ priv->gadgetDev.state = USB_STATE_ADDRESS; -+ pr_info("set address: %d\n", priv->deviceAddress); -+ retval = GADGET_EAUTOACK; -+ break; -+ case USB_REQ_SET_FEATURE: -+ retval = gadgetServiceSetFeatureReq(priv, &setup); -+ break; -+ case USB_REQ_CLEAR_FEATURE: -+ retval = gadgetServiceClearFeatureReq(priv, &setup); -+ break; -+ default: -+ retval = GADGET_EUNHANDLED; -+ break; -+ } -+ } -+ -+ if (retval == GADGET_EUNHANDLED) -+ break; -+ else if (retval == 0) -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); -+ -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ break; -+ case GADGET_EP0_STAGE_IN: -+ pr_debug("setup data stage in\n"); -+ retval = gadgetServiceSetupReq(priv, &setup); -+ -+ if (retval == 0) -+ priv->ep0State = GADGET_EP0_STAGE_STATUSOUT; -+ break; -+ case GADGET_EP0_STAGE_OUT: -+ pr_debug("setup data stage out\n"); -+ phytium_write8(&priv->regs->ep0Rxbc, 0); -+ retval = GADGET_EUNHANDLED; -+ break; -+ default: -+ if (retval == GADGET_EAUTOACK) -+ return; -+ -+ pr_debug("forward request\n"); -+ retval = GADGET_EUNHANDLED; -+ break; -+ } -+ -+ if (retval == GADGET_EUNHANDLED) { -+ if (priv->eventCallback.setup) -+ retval = priv->eventCallback.setup(priv, &setup); -+ -+ if (retval == 0x7FFF) { -+ pr_debug("Respond Delayed not finished yet\n"); -+ return; -+ } -+ -+ if (retval) -+ retval = GADGET_ESTALL; -+ } -+ -+ if (retval == GADGET_EUNHANDLED || retval == GADGET_ESTALL) { -+ pr_debug("request not handled - send stall\n"); -+ ep0cs = phytium_read8(&priv->regs->ep0cs); -+ ep0cs |= EP0CS_STALL; -+ phytium_write8(&priv->regs->ep0cs, ep0cs); -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ } else if (priv->ep0State == GADGET_EP0_STAGE_ACK) { -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); -+ pr_debug("setup transfer completed\n"); -+ } -+} -+static void gadgetEp0DataSend(struct GADGET_CTRL *priv) -+{ -+ struct GADGET_REQ *request; -+ uint32_t chMaxLen, requestSize; -+ -+ if (!priv) -+ return; -+ -+ request = gadgetGetNextEp0Req(priv); -+ if (!request) { -+ pr_debug("Ep0 queue is empty\n"); -+ return; -+ } -+ -+ if (priv->dmaDrv->dma_getChannelStatus(priv->dmaController, priv->in[0].channel) -+ >= DMA_STATUS_BUSY) { -+ pr_err("transfer is pending now\n"); -+ return; -+ } -+ -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, priv->in[0].channel); -+ requestSize = (request->length < chMaxLen) ? request->length : chMaxLen; -+ pr_debug("usbRequest;%p requestSize:%d packetSize:%d\n", request, requestSize, -+ priv->in[0].gadgetEp.maxPacket); -+ priv->ep0State = GADGET_EP0_STAGE_STATUSOUT; -+ -+ priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->in[0].channel, -+ priv->in[0].gadgetEp.maxPacket, request->dma, requestSize, NULL, 0); -+} -+ -+static void gadgetEp0DataReceive(struct GADGET_CTRL *priv) -+{ -+ uint32_t chMaxLen, requestSize; -+ struct GADGET_REQ *request; -+ -+ if (!priv) -+ return; -+ -+ request = gadgetGetNextEp0Req(priv); -+ if (!request) { -+ pr_debug("Ep0 queue is empty\n"); -+ return; -+ } -+ -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, priv->out[0].channel); -+ requestSize = (request->length < chMaxLen) ? request->length : chMaxLen; -+ pr_debug("usbRequest;%p requestSize:%d packetSize:%d\n", request, requestSize, -+ priv->out[0].gadgetEp.maxPacket); -+ priv->ep0State = GADGET_EP0_STAGE_STATUSIN; -+ -+ priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->out[0].channel, -+ priv->out[0].gadgetEp.maxPacket, request->dma, requestSize, NULL, 0); -+} -+ -+static uint32_t gadgetEp0Irq(struct GADGET_CTRL *priv) -+{ -+ uint8_t usbcs; -+ struct GADGET_REQ *request; -+ -+ if (!priv) -+ return 0; -+ -+ switch (priv->ep0State) { -+ case GADGET_EP0_STAGE_IN://send data -+ pr_debug("DATA Stage IN\n"); -+ gadgetEp0DataSend(priv); -+ break; -+ case GADGET_EP0_STAGE_OUT://receive data -+ pr_debug("DATA Stage OUT\n"); -+ gadgetEp0DataReceive(priv); -+ break; -+ case GADGET_EP0_STAGE_STATUSIN: -+ pr_debug("DATA Stage STATUS IN\n"); -+ request = gadgetGetNextEp0Req(priv); -+ if (request) -+ request->actual = priv->dmaDrv->dma_getActualLength(priv->dmaController, -+ priv->out[0].channel); -+ -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); -+ gadgetEp0Callback(priv, &priv->out[0], request, 0); -+ break; -+ case GADGET_EP0_STAGE_STATUSOUT: -+ pr_debug("DATA Stage STATUS OUT\n"); -+ request = gadgetGetNextEp0Req(priv); -+ if (request) -+ request->actual = priv->dmaDrv->dma_getActualLength(priv->dmaController, -+ priv->in[0].channel); -+ -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); -+ if (request) -+ gadgetEp0Callback(priv, &priv->in[0], request, 0); -+ else -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ break; -+ case GADGET_EP0_STAGE_SETUP: -+ pr_debug("DATA Stage SETUP\n"); -+ gadgetEp0StageSetup(priv); -+ break; -+ case GADGET_EP0_STAGE_ACK: -+ pr_debug("DATA Stage ACK\n"); -+ break; -+ default: -+ pr_debug("DATA Stage UNKNOWN\n"); -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs |= EP0CS_STALL; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+ break; -+ } -+ -+ return 0; -+} -+ -+static void gadgetEpXCallback(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req, uint32_t status) -+{ -+ if (!gadgetEp || !req) -+ return; -+ -+ list_del(&req->list); -+ gadgetEp->requestsInList--; -+ req->status = status; -+ -+ if (req->complete) -+ req->complete(&gadgetEp->gadgetEp, req); -+} -+ -+static void gadgetEpXDataCallback(struct GADGET_CTRL *priv, uint8_t epNum, uint8_t epDir) -+{ -+ struct GadgetEp *gadgetEp; -+ struct GADGET_REQ *gadgetReq; -+ uint32_t actual_length = 0; -+ uint32_t chMaxLen = 0; -+ uint8_t epType; -+ -+ if (!priv) -+ return; -+ -+ pr_debug("%s %d epNum:%d epDir:%d\n", __func__, __LINE__, epNum, epDir); -+ gadgetEp = epDir ? &priv->in[epNum] : &priv->out[epNum]; -+ -+ gadgetReq = gadgetGetNextReq(gadgetEp); -+ if (!gadgetReq) { -+ pr_debug("%s queue is empty\n", gadgetEp->gadgetEp.name); -+ return; -+ } -+ -+ if (gadgetEp->channel) { -+ actual_length = priv->dmaDrv->dma_getActualLength(priv->dmaController, -+ gadgetEp->channel); -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); -+ gadgetReq->actual += actual_length; -+ } -+ -+ if (gadgetReq->actual == gadgetReq->length || actual_length < chMaxLen) { -+ gadgetEpXCallback(priv, gadgetEp, gadgetReq, 0); -+ -+ if (gadgetEp->gadgetEp.desc) { -+ epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ if (epType == USB_ENDPOINT_XFER_ISOC) -+ return; -+ -+ gadgetReq = gadgetGetNextReq(gadgetEp); -+ gadgetEp->state = GADGET_EP_ALLOCATED; -+ if (!gadgetReq) { -+ pr_debug("%s queue is empty\n", gadgetEp->gadgetEp.name); -+ return; -+ } -+ gadgetEp->state = GADGET_EP_BUSY; -+ if (epDir) -+ gadgetEpXDataSend(priv, requestToGadgetRequest(gadgetReq)); -+ else -+ gadgetEpXDataReceive(priv, requestToGadgetRequest(gadgetReq)); -+ } -+ } else { -+ if (epDir) -+ gadgetEpXDataSend(priv, requestToGadgetRequest(gadgetReq)); -+ else -+ gadgetEpXDataReceive(priv, requestToGadgetRequest(gadgetReq)); -+ } -+} -+ -+void gadget_CallbackTransfer(void *priv, uint8_t epNum, uint8_t epDir, bool resubmit) -+{ -+ if (!epNum) -+ gadgetEp0Irq(priv); -+ else -+ gadgetEpXDataCallback(priv, epNum, epDir); -+} -+ -+static void gadgetAbortEndpoint(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) -+{ -+ struct GADGET_REQ *gadgetReq; -+ -+ pr_debug("Abort Device endpoint: %s, dma channel: %p\n", gadgetEp->gadgetEp.name, -+ gadgetEp->channel); -+ -+ if (gadgetEp->channel && gadgetEp->hwEpNum != 0) { -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, gadgetEp->channel); -+ gadgetEp->channel = NULL; -+ } -+ -+ if (gadgetEp->channel && gadgetEp->hwEpNum == 0) { -+ if (priv->releaseEp0Flag == 1) { -+ priv->dmaDrv->dma_channelAbort(priv->dmaController, gadgetEp->channel); -+ priv->dmaDrv->dma_channelAlloc(priv->dmaController, gadgetEp->isInEp, -+ gadgetEp->hwEpNum, 0); -+ } -+ } -+ -+ while (gadgetEp->request.next != &gadgetEp->request) { -+ gadgetReq = listToGadgetRequest(gadgetEp->request.next); -+ pr_debug("shutdown request %p form epName:%s\n", gadgetReq, -+ gadgetEp->gadgetEp.name); -+ if (!gadgetEp->gadgetEp.address) -+ gadgetEp0Callback(priv, gadgetEp, gadgetReq, GADGET_ESHUTDOWN); -+ else -+ gadgetEpXCallback(priv, gadgetEp, gadgetReq, GADGET_ESHUTDOWN); -+ } -+ -+ gadgetEp->state = GADGET_EP_FREE; -+} -+ -+static void gadgetStopActivity(struct GADGET_CTRL *priv) -+{ -+ int i = 0; -+ struct GadgetEp *gadgetEp; -+ -+ pr_debug("USB Stop Activity\n"); -+ -+ if (!priv) -+ return; -+ -+ for (i = 0; i < 16; i++) { -+ gadgetEp = &priv->in[i]; -+ if (gadgetEp->state != GADGET_EP_NOT_IMPLEMENTED) -+ gadgetAbortEndpoint(priv, gadgetEp); -+ -+ gadgetEp = &priv->out[i]; -+ if (gadgetEp->state != GADGET_EP_NOT_IMPLEMENTED) -+ gadgetAbortEndpoint(priv, gadgetEp); -+ } -+} -+ -+ -+static int32_t gadgetEp0Enable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) -+{ -+ uint8_t txien, rxien; -+ -+ if (!priv || !gadgetEp) -+ return -EINVAL; -+ -+ if (gadgetEp->state != GADGET_EP_FREE) -+ return -EBUSY; -+ -+ if (!gadgetEp->isInEp) { -+ rxien = phytium_read16(&priv->regs->rxien); -+ rxien &= ~(1 << gadgetEp->hwEpNum); -+ phytium_write16(&priv->regs->rxien, rxien); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_IO_TX | FIFOCTRL_FIFOAUTO); -+ } else { -+ txien = phytium_read16(&priv->regs->txien); -+ txien &= ~(1 << gadgetEp->hwEpNum); -+ phytium_write16(&priv->regs->txien, txien); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO); -+ } -+ -+ gadgetEp->gadgetEp.desc = NULL; -+ gadgetEp->state = GADGET_EP_ALLOCATED; -+ gadgetEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, -+ gadgetEp->isInEp, gadgetEp->hwEpNum, 0); -+ phytium_write8(&priv->regs->ep0maxpack, 0x40); -+ -+ return 0; -+} -+ -+static int32_t gadgetEpXEnable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ const struct usb_endpoint_descriptor *desc) -+{ -+ uint32_t status = -EINVAL; -+ uint32_t payload; -+ uint16_t type, iso = 0; -+ uint8_t epNum = 0; -+ -+ if (!priv || !gadgetEp || !desc) -+ return -EINVAL; -+ -+ pr_debug("enable endpoint %s\n", gadgetEp->gadgetEp.name); -+ if (gadgetEp->state != GADGET_EP_FREE) { -+ status = -EBUSY; -+ goto fail; -+ } -+ -+ payload = desc->wMaxPacketSize & 0x7ff; -+ if (!payload) { -+ status = -EINVAL; -+ goto fail; -+ } -+ -+ epNum = gadgetEp->hwEpNum; -+ -+ type = desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ switch (type) { -+ case USB_ENDPOINT_XFER_ISOC: -+ type = CON_TYPE_ISOC; -+ switch (payload >> 11) { -+ case 0: -+ iso = CON_TYPE_ISOC_1_ISOD; -+ break; -+ case 1: -+ payload *= 2; -+ iso = CON_TYPE_ISOC_2_ISOD; -+ break; -+ case 2: -+ payload *= 3; -+ iso = CON_TYPE_ISOC_3_ISOD; -+ break; -+ } -+ break; -+ case USB_ENDPOINT_XFER_INT: -+ type = CON_TYPE_INT; -+ break; -+ case USB_ENDPOINT_XFER_BULK: -+ type = CON_TYPE_BULK; -+ break; -+ } -+ -+ if (desc->bEndpointAddress & USB_DIR_IN) { -+ if (!gadgetEp->isInEp) { -+ status = -ENODEV; -+ goto fail; -+ } -+ -+ if (payload > priv->gadgetCfg.epIN[epNum].maxPacketSize) { -+ status = -EINVAL; -+ goto fail; -+ } -+ -+ phytium_write16(&priv->regs->txmaxpack[epNum - 1], payload); -+ phytium_write8(&priv->regs->ep[epNum - 1].txcon, CON_VAL | type -+ | iso | (priv->gadgetCfg.epIN[epNum - 1].bufferingValue - 1)); -+ -+ phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum | -+ ENDPRST_FIFORST | ENDPRST_TOGRST); -+ } else { -+ if (gadgetEp->isInEp) { -+ status = -ENODEV; -+ goto fail; -+ } -+ -+ if (payload > priv->gadgetCfg.epOUT[epNum].maxPacketSize) { -+ status = -EINVAL; -+ goto fail; -+ } -+ -+ phytium_write16(&priv->regs->rxmaxpack[epNum - 1], payload); -+ phytium_write8(&priv->regs->ep[epNum - 1].rxcon, CON_VAL | type -+ | iso | (priv->gadgetCfg.epIN[epNum - 1].bufferingValue - 1)); -+ -+ phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | epNum); -+ phytium_write8(&priv->regs->endprst, epNum); -+ phytium_write8(&priv->regs->endprst, epNum | ENDPRST_FIFORST | ENDPRST_TOGRST); -+ } -+ -+ if (priv->dmaController) -+ gadgetEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, -+ gadgetEp->isInEp, epNum, (type == CON_TYPE_ISOC) ? 1 : 0); -+ -+ if (type == CON_TYPE_ISOC) { -+ if (gadgetEp->isInEp) { -+ phytium_write16(&priv->regs->isoautodump, 1 << epNum); -+ phytium_write16(&priv->regs->isodctrl, 1 << epNum); -+ } -+ -+ priv->dmaDrv->dma_setMaxLength(priv->dmaController, gadgetEp->channel, payload); -+ } -+ -+ gadgetEp->state = GADGET_EP_ALLOCATED; -+ gadgetEp->gadgetEp.desc = desc; -+fail: -+ return status; -+} -+ -+static int32_t gadgetEpEnable(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ const struct usb_endpoint_descriptor *desc) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ -+ if (!priv || !gadget_Ep || !desc) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ gadgetEp->wedged = 0; -+ -+ if (gadgetEp->hwEpNum) -+ return gadgetEpXEnable(priv, gadgetEp, desc); -+ else -+ return gadgetEp0Enable(priv, gadgetEp); -+} -+ -+static int32_t gadgetEpXDisable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) -+{ -+ uint8_t txcon, rxcon; -+ -+ if (!priv || !gadgetEp) -+ return -EINVAL; -+ -+ pr_debug("disable endpoint %s\n", gadgetEp->gadgetEp.name); -+ if (gadgetEp->isInEp) { -+ txcon = phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon); -+ txcon &= ~CON_VAL; -+ phytium_write8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon, txcon); -+ } else { -+ rxcon = phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon); -+ rxcon &= ~CON_VAL; -+ phytium_write8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon, rxcon); -+ } -+ gadgetAbortEndpoint(priv, gadgetEp); -+ gadgetEp->gadgetEp.desc = 0; -+ gadgetEp->state = GADGET_EP_FREE; -+ return 0; -+} -+ -+static int32_t gadgetEp0Disable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) -+{ -+ if (!priv || !gadgetEp) -+ return -EINVAL; -+ -+ pr_debug("disable endpoint %s\n", gadgetEp->gadgetEp.name); -+ gadgetAbortEndpoint(priv, gadgetEp); -+ -+ return 0; -+} -+ -+static int32_t gadgetEpDisable(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ if (gadget_Ep->address == 0) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ gadgetEp->wedged = 0; -+ if (gadgetEp->hwEpNum) -+ return gadgetEpXDisable(priv, gadgetEp); -+ else -+ return gadgetEp0Disable(priv, gadgetEp); -+} -+ -+static int32_t gadgetEpXQueue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetRequest *gadgetRequest; -+ -+ if (!priv || !gadgetEp || !req) -+ return -EINVAL; -+ -+ req->actual = 0; -+ req->status = EINPROGRESS; -+ -+ gadgetRequest = requestToGadgetRequest(req); -+ gadgetRequest->ep = gadgetEp; -+ -+ if (req->length == 0) -+ gadgetRequest->zlp = 1; -+ -+ if (gadgetEp->gadgetEp.desc == NULL) { -+ pr_info("%s is disabled - can not queue request %p\n", -+ gadgetEp->gadgetEp.name, req); -+ return -EINVAL; -+ } -+ -+ list_add_tail(&req->list, &gadgetEp->request); -+ pr_debug("queue to %s (%s), length:%d\n", gadgetEp->gadgetEp.name, -+ (gadgetEp->isInEp ? "IN/TX" : "OUT/RX"), req->length); -+ -+ if ((gadgetEp->state == GADGET_EP_ALLOCATED) && (&req->list == gadgetEp->request.next)) { -+ if (gadgetEp->isInEp) { -+ if (!(phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon) -+ & CON_STALL)) { -+ gadgetEp->state = GADGET_EP_BUSY; -+ gadgetEpXDataSend(priv, gadgetRequest); -+ } -+ } else { -+ if (!(phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon) -+ & CON_STALL)) { -+ gadgetEp->state = GADGET_EP_BUSY; -+ gadgetEpXDataReceive(priv, gadgetRequest); -+ } -+ } -+ } else if (gadgetEp->state == GADGET_EP_BUSY) { -+ if (usb_endpoint_xfer_isoc(gadgetEp->gadgetEp.desc)) { -+ if (gadgetEp->isInEp) -+ gadgetEpXDataSend(priv, gadgetRequest); -+ else -+ gadgetEpXDataReceive(priv, gadgetRequest); -+ } -+ } -+ -+ pr_debug("endpoint %s (%s) now is busy - transfer will be waiting in Queue\n", -+ gadgetEp->gadgetEp.name, (gadgetEp->isInEp ? "IN/TX" : "OUT/RX")); -+ -+ return 0; -+} -+ -+static int32_t gadgetEp0Queue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetRequest *gadgetRequest; -+ -+ if (!priv || !gadgetEp || !req) -+ return -EINVAL; -+ -+ req->actual = 0; -+ req->status = EINPROGRESS; -+ -+ if (!list_empty(&gadgetEp->request)) -+ return -EBUSY; -+ -+ gadgetRequest = requestToGadgetRequest(req); -+ gadgetRequest->ep = gadgetEp; -+ -+ switch (priv->ep0State) { -+ case GADGET_EP0_STAGE_OUT: -+ case GADGET_EP0_STAGE_IN: -+ case GADGET_EP0_STAGE_ACK: -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ list_add_tail(&req->list, &gadgetEp->request); -+ gadgetEp->requestsInList++; -+ -+ pr_debug("queue to %s (%s), length:%d stage:%d\n", gadgetEp->gadgetEp.name, -+ gadgetEp->isInEp ? "IN/TX" : "OUT/RX", req->length, priv->ep0State); -+ -+ switch (priv->ep0State) { -+ case GADGET_EP0_STAGE_OUT: -+ gadgetEp0DataReceive(priv); -+ break; -+ case GADGET_EP0_STAGE_IN: -+ gadgetEp0DataSend(priv); -+ break; -+ case GADGET_EP0_STAGE_ACK: -+ if (req->length) -+ return -EINVAL; -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); -+ gadgetEp0Callback(priv, gadgetRequest->ep, req, 0); -+ pr_info("control transfer completed\n"); -+ break; -+ default: -+ break; -+ } -+ -+ return 0; -+} -+ -+static int32_t gadgetEpQueue(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ -+ if (!priv || !gadget_Ep || !req) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ -+ if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) -+ return gadgetEpXQueue(priv, gadgetEp, req); -+ else -+ return gadgetEp0Queue(priv, gadgetEp, req); -+} -+ -+static int32_t gadgetEpXDequeue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetRequest *gadgetRequest; -+ struct GADGET_REQ *iterator; -+ -+ if (!priv || !gadgetEp || !req) -+ return -EINVAL; -+ -+ gadgetRequest = requestToGadgetRequest(req); -+ if (gadgetRequest->ep != gadgetEp) -+ return -EINVAL; -+ -+ pr_debug("Dequeue request %p form %s\n", req, gadgetEp->gadgetEp.name); -+ -+ listBrowsingRequest(iterator, &gadgetEp->request, list) { -+ if (req == iterator) -+ break; -+ } -+ -+ if (req != iterator) { -+ pr_info("request %p not queued to %s\n", req, gadgetEp->gadgetEp.name); -+ return -EINVAL; -+ } -+ -+ if (gadgetEp->state == GADGET_EP_BUSY) { -+ priv->dmaDrv->dma_channelAbort(priv->dmaController, gadgetEp->channel); -+ gadgetEp->state = GADGET_EP_ALLOCATED; -+ } -+ -+ gadgetEpXCallback(priv, gadgetEp, req, GADGET_ECONNRESET); -+ -+ return 0; -+} -+ -+static int32_t gadgetEp0Dequeue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, -+ struct GADGET_REQ *req) -+{ -+ return 0; -+} -+ -+static int32_t gadgetEpDequeue(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ -+ if (!priv || !gadget_Ep || !req) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ -+ if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) -+ return gadgetEpXDequeue(priv, gadgetEp, req); -+ else -+ return gadgetEp0Dequeue(priv, gadgetEp, req); -+} -+ -+static int32_t gadgetEpSetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, uint8_t value) -+{ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) -+ return gadgetEpXSetHalt(priv, gadget_Ep, value); -+ else -+ return gadgetEp0SetHalt(priv, gadget_Ep, value); -+} -+ -+static int32_t gadgetEpSetWedge(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ gadgetEp->wedged = 1; -+ -+ return gadgetEpSetHalt(priv, gadget_Ep, 1); -+} -+ -+static int32_t gadgetEpFifoStatus(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) -+{ -+ if (!priv || !gadget_Ep) -+ return -EINVAL; -+ -+ return 0; -+} -+ -+static void gadgetEpFifoFlush(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) -+{ -+ if (!priv || !gadget_Ep) -+ return; -+} -+ -+static int32_t gadgetEpAllocRequest(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ struct GADGET_REQ **req) -+{ -+ struct GadgetEp *gadgetEp = NULL; -+ struct GadgetRequest *gadgetRequest = NULL; -+ -+ if (!priv || !gadget_Ep || !req) -+ return -EINVAL; -+ -+ gadgetEp = toGadgetEp(gadget_Ep); -+ if (priv->eventCallback.usbRequestMemAlloc) -+ gadgetRequest = priv->eventCallback.usbRequestMemAlloc(priv, -+ sizeof(*gadgetRequest)); -+ if (!gadgetRequest) -+ return -ENOMEM; -+ -+ memset(gadgetRequest, 0, sizeof(*gadgetRequest)); -+ *req = &gadgetRequest->request; -+ INIT_LIST_HEAD(&gadgetRequest->request.list); -+ gadgetRequest->ep = gadgetEp; -+ -+ return 0; -+} -+ -+static void gadgetEpFreeRequest(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, -+ struct GADGET_REQ *req) -+{ -+ struct GadgetRequest *gadgetRequest = NULL; -+ -+ if (!priv || !gadget_Ep || !req) -+ return; -+ -+ gadgetRequest = requestToGadgetRequest(req); -+ -+ if (priv->eventCallback.usbRequestMemFree) -+ priv->eventCallback.usbRequestMemFree(priv, gadgetRequest); -+} -+ -+static struct GADGET_EP_OPS gadgetEpOps = { -+ .epEnable = gadgetEpEnable, -+ .epDisable = gadgetEpDisable, -+ .reqQueue = gadgetEpQueue, -+ .reqDequeue = gadgetEpDequeue, -+ .epSetHalt = gadgetEpSetHalt, -+ .epSetWedge = gadgetEpSetWedge, -+ .epFifoStatus = gadgetEpFifoStatus, -+ .reqAlloc = gadgetEpAllocRequest, -+ .reqFree = gadgetEpFreeRequest -+}; -+ -+static void gadgetInitDeviceEp(struct GADGET_CTRL *priv, uint8_t isInEp) -+{ -+ uint8_t num; -+ struct GadgetEp *gadgetEp; -+ struct GADGET_EP_CFG epCfg; -+ -+ if (!priv) -+ return; -+ -+ for (num = 0; num < 16; num++) { -+ gadgetEp = isInEp ? &priv->in[num] : &priv->out[num]; -+ if (num) { -+ epCfg = isInEp ? priv->gadgetCfg.epIN[num] : priv->gadgetCfg.epOUT[num]; -+ if (!epCfg.bufferingValue) { -+ gadgetEp->state = GADGET_EP_NOT_IMPLEMENTED; -+ gadgetEp->hwEpNum = num; -+ continue; -+ } -+ } -+ INIT_LIST_HEAD(&gadgetEp->gadgetEp.epList); -+ INIT_LIST_HEAD(&gadgetEp->request); -+ gadgetEp->state = GADGET_EP_FREE; -+ gadgetEp->hwEpNum = num; -+ gadgetEp->isInEp = isInEp; -+ gadgetEp->requestsInList = 0; -+ snprintf(gadgetEp->gadgetEp.name, sizeof(gadgetEp->gadgetEp.name), -+ "Ep%d%s", num, isInEp ? "in" : "out"); -+ if (!num) { -+ gadgetEp->gadgetEp.maxPacket = priv->gadgetCfg.epIN[num].maxPacketSize; -+ if (isInEp) -+ priv->gadgetDev.ep0 = &gadgetEp->gadgetEp; -+ gadgetEp->gadgetEp.ops = &gadgetEpOps; -+ gadgetEp0Enable(priv, gadgetEp); -+ continue; -+ } -+ -+ if (isInEp) { -+ if (epCfg.startBuf) -+ phytium_write16(&priv->regs->txstaddr[num - 1].addr, -+ epCfg.startBuf); -+ phytium_write8(&priv->regs->ep[num - 1].txcon, 0); -+ gadgetEp->gadgetEp.maxPacket = epCfg.maxPacketSize; -+ } else { -+ if (epCfg.startBuf) -+ phytium_write16(&priv->regs->rxstaddr[num - 1].addr, -+ epCfg.startBuf); -+ phytium_write8(&priv->regs->ep[num - 1].rxcon, 0); -+ gadgetEp->gadgetEp.maxPacket = epCfg.maxPacketSize; -+ } -+ -+ gadgetEp->gadgetEp.ops = &gadgetEpOps; -+ gadgetEp->gadgetEp.address = isInEp ? (0x80 | num) : num; -+ gadgetEp->gadgetEp.maxburst = 0; -+ gadgetEp->gadgetEp.mult = 0; -+ gadgetEp->gadgetEp.maxStreams = 0; -+ priv->endpointInList++; -+ list_add_tail(&gadgetEp->gadgetEp.epList, &priv->gadgetDev.epList); -+ } -+} -+ -+static void gadgetInitEndpoint(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return; -+ -+ gadgetInitDeviceEp(priv, 1); -+ gadgetInitDeviceEp(priv, 0); -+} -+ -+static void gadgetSetup(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return; -+ -+ INIT_LIST_HEAD(&priv->gadgetDev.epList); -+ priv->gadgetDev.state = USB_STATE_NOTATTACHED; -+ priv->gadgetDev.maxSpeed = USB_SPEED_HIGH; -+ priv->gadgetDev.speed = USB_SPEED_FULL; -+ snprintf(priv->gadgetDev.name, sizeof(priv->gadgetDev.name), "Phytium USB SD Driver"); -+ -+ gadgetInitEndpoint(priv); -+ -+ phytium_write8(&priv->regs->ep0maxpack, 0x40); -+ phytium_write16(&priv->regs->rxien, 0); -+ phytium_write16(&priv->regs->txien, 0); -+ phytium_write16(&priv->regs->rxirq, 0xFFFF); -+ phytium_write16(&priv->regs->txirq, 0xFFFF); -+ phytium_write8(&priv->regs->usbirq, 0xEF); -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); -+ priv->isReady = 1; -+} -+int32_t gadgetInit(struct GADGET_CTRL *priv, struct GADGET_CFG *config, -+ struct GADGET_CALLBACKS *callbacks, struct device *pdev) -+{ -+ struct DMA_SYSREQ dmaSysReq; -+ uint8_t usbcs; -+ -+ if (!priv || !config || !callbacks) -+ return -EINVAL; -+ -+ priv->dev = pdev; -+ priv->eventCallback = *callbacks; -+ priv->gadgetCfg = *config; -+ priv->regs = (struct HW_REGS *)config->regBase; -+ priv->phy_regs = (struct VHUB_REGS *)config->phy_regBase; -+ priv->gadgetDrv = GADGET_GetInstance(); -+ priv->dmaDrv = DMA_GetInstance(); -+ priv->dmaController = (void *)(priv + 1); -+ priv->dmaCfg.dmaModeRx = 0xFFFF; -+ priv->dmaCfg.dmaModeTx = 0xFFFF; -+ priv->dmaCfg.regBase = config->regBase + 0x400; -+ priv->dmaCfg.trbAddr = config->trbAddr; -+ priv->dmaCfg.trbDmaAddr = config->trbDmaAddr; -+ -+ priv->dmaDrv->dma_probe(NULL, &dmaSysReq); -+ priv->privBuffAddr = (uint8_t *)((uintptr_t)config->trbAddr + dmaSysReq.trbMemSize); -+ priv->privBuffDma = (uintptr_t)((uintptr_t)config->trbDmaAddr + dmaSysReq.trbMemSize); -+ priv->dmaCallback.complete = gadget_CallbackTransfer; -+ priv->dmaDrv->dma_init(priv->dmaController, &priv->dmaCfg, &priv->dmaCallback); -+ priv->dmaDrv->dma_setParentPriv(priv->dmaController, priv); -+ -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs |= USBCS_DISCON | USBCS_LPMNYET; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+ -+ gadgetSetup(priv); -+ -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs &= USBCS_DISCON; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+ -+ return 0; -+} -+ -+static void gadgetDestroy(struct GADGET_CTRL *priv) -+{ -+ pr_debug("Destroy Device Controller driver\n"); -+ -+ if (priv) -+ return; -+ gadgetDisconnect(priv); -+ -+ gadgetStopActivity(priv); -+ -+ phytium_write8(&priv->regs->usbcs, USBCS_DISCON); -+ -+ priv->isReady = 0; -+} -+ -+static void gadgetStart(struct GADGET_CTRL *priv) -+{ -+ uint8_t usbien, usbcs; -+ -+ pr_debug("Usb Device Controller start\n"); -+ if (!priv) -+ return; -+ -+ usbien = phytium_read8(&priv->regs->usbien); -+ usbien |= USBIR_URES | USBIR_SUDAV | USBIR_LPMIR; -+ phytium_write8(&priv->regs->usbien, usbien); -+ -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs &= ~USBCS_DISCON; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+ -+ priv->dmaDrv->dma_start(priv->dmaController); -+} -+ -+static void gadgetReset(struct GADGET_CTRL *priv) -+{ -+ int i = 0; -+ -+ pr_debug("Usb Disable Device Activity\n"); -+ -+ if (!priv) -+ return; -+ -+ if (priv->gadgetDev.speed != USB_SPEED_UNKNOWN) -+ gadgetDisconnect(priv); -+ -+ priv->gadgetDev.aHnpSupport = 0; -+ priv->gadgetDev.bHnpEnable = 0; -+ priv->gadgetDev.state = USB_STATE_DEFAULT; -+ priv->deviceAddress = 0; -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ -+ gadgetStopActivity(priv); -+ -+ for (i = 0; i < 1000; i++) { -+ priv->gadgetDev.speed = gadgetGetActualSpeed(priv); -+ if (priv->gadgetDev.speed == USB_SPEED_HIGH) -+ return; -+ } -+} -+ -+static void gadgetStop(struct GADGET_CTRL *priv) -+{ -+ pr_debug("Usb Device Controller stop\n"); -+ -+ if (!priv) -+ return; -+ -+ if (!priv->isReady) -+ return; -+ -+ gadgetReset(priv); -+ -+ phytium_write8(&priv->regs->usbien, 0); -+ priv->dmaDrv->dma_stop(priv->dmaController); -+ -+ priv->isReady = 0; -+} -+ -+static void gadgetIsr(struct GADGET_CTRL *priv) -+{ -+ uint8_t usbirq, usbien, usbcs; -+ -+ if (!priv) -+ return; -+ -+ usbirq = phytium_read8(&priv->regs->usbirq); -+ usbien = phytium_read8(&priv->regs->usbien); -+ -+ pr_debug("usbirq:0x%x usbien:0x%x\n", usbirq, usbien); -+ -+ usbirq = usbirq & usbien; -+ -+ if (!usbirq) -+ goto DMA_IRQ; -+ -+ if (usbirq & USBIR_LPMIR) { -+ pr_debug("USBIRQ LPM\n"); -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs &= ~USBCS_LPMNYET; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+ phytium_write8(&priv->regs->usbirq, USBIR_LPMIR); -+ } -+ -+ if (usbirq & USBIR_URES) { -+ pr_debug("USBIRQ RESET\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_URES); -+ priv->releaseEp0Flag = 1; -+ gadgetReset(priv); -+ priv->releaseEp0Flag = 0; -+ priv->gadgetDev.state = USB_STATE_DEFAULT; -+ if (priv->eventCallback.connect) -+ priv->eventCallback.connect(priv); -+ } -+ -+ if (usbirq & USBIR_HSPEED) { -+ pr_debug("USBIRQ HighSpeed\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_HSPEED); -+ priv->gadgetDev.speed = USB_SPEED_HIGH; -+ } -+ -+ if (usbirq & USBIR_SUDAV) { -+ pr_debug("USBIRQ SUDAV\n"); -+ priv->ep0State = GADGET_EP0_STAGE_SETUP; -+ gadgetEp0Irq(priv); -+ } -+ -+ if (usbirq & USBIR_SOF) { -+ pr_debug("USBIRQ SOF\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_SOF); -+ } -+ -+ if (usbirq & USBIR_SUTOK) { -+ pr_debug("USBIRQ SUTOK\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_SUTOK); -+ } -+ -+ if (usbirq & USBIR_SUSP) { -+ pr_debug("USBIRQ SUSPEND\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_SUSP); -+ } -+ -+ return; -+DMA_IRQ: -+ priv->dmaDrv->dma_isr(priv->dmaController); -+} -+ -+static void gadgetGetDevInstance(struct GADGET_CTRL *priv, struct GADGET_DEV **dev) -+{ -+ if (!priv || !dev) -+ return; -+ -+ *dev = &priv->gadgetDev; -+} -+ -+static int32_t gadgetGetFrame(struct GADGET_CTRL *priv, uint32_t *numOfFrame) -+{ -+ if (!priv || !numOfFrame) -+ return -EINVAL; -+ -+ *numOfFrame = phytium_read16(&priv->regs->frmnr); -+ -+ return 0; -+} -+ -+static int32_t gadgetWakeUp(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ return -EOPNOTSUPP; -+} -+ -+static int32_t gadgetSetSelfPowered(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ priv->isSelfPowered = 1; -+ -+ return 0; -+} -+ -+static int32_t gadgetClearSelfPowered(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ priv->isSelfPowered = 0; -+ -+ return 0; -+} -+ -+static int32_t gadgetVbusSession(struct GADGET_CTRL *priv, uint8_t isActive) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ return -EOPNOTSUPP; -+} -+ -+static int32_t gadgetVbusDraw(struct GADGET_CTRL *priv, uint8_t mA) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ return -EOPNOTSUPP; -+} -+ -+static int32_t gadgetPullUp(struct GADGET_CTRL *priv, uint8_t isOn) -+{ -+ if (!priv) -+ return -EINVAL; -+ -+ return -EOPNOTSUPP; -+} -+ -+struct GADGET_OBJ GadgetObj = { -+ .gadget_init = gadgetInit, -+ .gadget_destroy = gadgetDestroy, -+ .gadget_start = gadgetStart, -+ .gadget_stop = gadgetStop, -+ .gadget_isr = gadgetIsr, -+ //endpoint operation -+ .gadget_epEnable = gadgetEpEnable, -+ .gadget_epDisable = gadgetEpDisable, -+ .gadget_epSetHalt = gadgetEpSetHalt, -+ .gadget_epSetWedge = gadgetEpSetWedge, -+ .gadget_epFifoStatus = gadgetEpFifoStatus, -+ .gadget_epFifoFlush = gadgetEpFifoFlush, -+ .gadget_reqQueue = gadgetEpQueue, -+ .gadget_reqDequeue = gadgetEpDequeue, -+ .gadget_reqAlloc = gadgetEpAllocRequest, -+ .gadget_reqFree = gadgetEpFreeRequest, -+ -+ //Device operations -+ .gadget_getDevInstance = gadgetGetDevInstance, -+ .gadget_dGetFrame = gadgetGetFrame, -+ .gadget_dWakeUp = gadgetWakeUp, -+ .gadget_dSetSelfpowered = gadgetSetSelfPowered, -+ .gadget_dClearSelfpowered = gadgetClearSelfPowered, -+ .gadget_dVbusSession = gadgetVbusSession, -+ .gadget_dVbusDraw = gadgetVbusDraw, -+ .gadget_dPullUp = gadgetPullUp, -+}; -+ -+struct GADGET_OBJ *GADGET_GetInstance(void) -+{ -+ return &GadgetObj; -+} -+ -+static int phytium_gadget_set_default_cfg(struct phytium_cusb *config) -+{ -+ int index; -+ -+ config->gadget_cfg.regBase = (uintptr_t)config->regs; -+ config->gadget_cfg.phy_regBase = (uintptr_t)config->phy_regs; -+ config->gadget_cfg.dmaInterfaceWidth = GADGET_DMA_32_WIDTH; -+ -+ for (index = 0; index < 16; index++) { -+ if (index == 0) { -+ config->gadget_cfg.epIN[index].bufferingValue = 1; -+ config->gadget_cfg.epIN[index].maxPacketSize = 64; -+ config->gadget_cfg.epIN[index].startBuf = 0; -+ -+ config->gadget_cfg.epOUT[index].bufferingValue = 1; -+ config->gadget_cfg.epOUT[index].maxPacketSize = 64; -+ config->gadget_cfg.epOUT[index].startBuf = 0; -+ } else { -+ config->gadget_cfg.epIN[index].bufferingValue = 4; -+ config->gadget_cfg.epIN[index].maxPacketSize = 1024; -+ config->gadget_cfg.epIN[index].startBuf = 64 + 4096 * (index - 1); -+ -+ config->gadget_cfg.epOUT[index].bufferingValue = 4; -+ config->gadget_cfg.epOUT[index].maxPacketSize = 1024; -+ config->gadget_cfg.epOUT[index].startBuf = 64 + 4096 * (index - 1); -+ } -+ } -+ -+ return 0; -+} -+ -+void gadget_callback_connect(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return; -+} -+ -+void gadget_callback_disconnect(struct GADGET_CTRL *priv) -+{ -+ if (!priv) -+ return; -+} -+ -+int32_t gadget_callback_setup(struct GADGET_CTRL *priv, struct usb_ctrlrequest *ctrl) -+{ -+ struct phytium_cusb *config; -+ int ret = 0; -+ -+ if (!priv || !ctrl) -+ return -EINVAL; -+ -+ config = dev_get_drvdata(priv->dev); -+ if (!config) -+ return -1; -+ -+ if (!config->gadget_driver) -+ return -EOPNOTSUPP; -+ -+ if (ctrl->bRequestType & USB_DIR_IN) -+ config->ep0_data_stage_is_tx = 1; -+ else -+ config->ep0_data_stage_is_tx = 0; -+ -+ spin_unlock(&config->lock); -+ ret = config->gadget_driver->setup(&config->gadget, ctrl); -+ spin_lock(&config->lock); -+ -+ if (ret == 0x7FFF) -+ return ret; -+ -+ if (ret < 0) -+ return 1; -+ -+ return 0; -+} -+ -+void *gadget_callback_usbRequestMemAlloc(struct GADGET_CTRL *priv, u32 size) -+{ -+ struct GADGET_REQ *gadget_req = NULL; -+ -+ gadget_req = kzalloc(size, GFP_NOWAIT); -+ if (!gadget_req) -+ return NULL; -+ -+ return gadget_req; -+} -+ -+void gadget_callback_usbRequestMemFree(struct GADGET_CTRL *priv, void *usbReq) -+{ -+ if (!usbReq) -+ return; -+ -+ kfree(usbReq); -+} -+ -+static void init_peripheral_ep(struct phytium_cusb *config, -+ struct phytium_ep *phy_ep, struct GADGET_EP *gadget_ep, int is_tx) -+{ -+ if (!config || !phy_ep || !gadget_ep) -+ return; -+ -+ memset(phy_ep, 0, sizeof(*phy_ep)); -+ phy_ep->config = config; -+ phy_ep->is_tx = is_tx; -+ phy_ep->gadget_ep = gadget_ep; -+ phy_ep->ep_num = gadget_ep->address & 0xF; -+ phy_ep->end_point.maxpacket = gadget_ep->maxPacket; -+ phy_ep->end_point.maxpacket_limit = 1024; -+ -+ INIT_LIST_HEAD(&phy_ep->req_list); -+ sprintf(phy_ep->name, "ep%d%s", phy_ep->ep_num, is_tx ? "in" : "out"); -+ -+ switch (phy_ep->ep_num) { -+ case 0: -+ phy_ep->end_point.caps.type_control = 1; -+ break; -+ case 1: -+ phy_ep->end_point.caps.type_bulk = 1; -+ break; -+ case 2: -+ phy_ep->end_point.caps.type_int = 1; -+ break; -+ case 3: -+ phy_ep->end_point.caps.type_iso = 1; -+ break; -+ default: -+ phy_ep->end_point.caps.type_int = 1; -+ phy_ep->end_point.caps.type_bulk = 1; -+ break; -+ } -+ -+ if (is_tx) { -+ phy_ep->end_point.caps.dir_in = 1; -+ phy_ep->end_point.caps.dir_out = 0; -+ } else { -+ phy_ep->end_point.caps.dir_in = 0; -+ phy_ep->end_point.caps.dir_out = 1; -+ } -+ -+ phy_ep->end_point.name = phy_ep->name; -+ -+ INIT_LIST_HEAD(&phy_ep->end_point.ep_list); -+ -+ if (!phy_ep->ep_num) { -+ phy_ep->end_point.ops = &gadget_ep0_ops; -+ config->gadget.ep0 = &phy_ep->end_point; -+ -+ if (config->gadget_dev->maxSpeed > USB_SPEED_HIGH) -+ config->gadget.ep0->maxpacket = 9; -+ } else { -+ phy_ep->end_point.ops = &gadget_ep_ops; -+ list_add_tail(&phy_ep->end_point.ep_list, &config->gadget.ep_list); -+ } -+} -+ -+static void gadget_init_endpoint(struct phytium_cusb *config) -+{ -+ struct list_head *list; -+ struct GADGET_EP *gadget_ep; -+ -+ if (!config) -+ return; -+ -+ INIT_LIST_HEAD(&(config->gadget.ep_list)); -+ -+ init_peripheral_ep(config, &config->endpoints_tx[0], config->gadget_dev->ep0, 1); -+ init_peripheral_ep(config, &config->endpoints_rx[0], config->gadget_dev->ep0, 0); -+ -+ list_for_each(list, &config->gadget_dev->epList) { -+ gadget_ep = (struct GADGET_EP *)list; -+ if (gadget_ep->address & USB_DIR_IN) -+ init_peripheral_ep(config, &config->endpoints_tx[gadget_ep->address & 0xf], -+ gadget_ep, 1); -+ else -+ init_peripheral_ep(config, &config->endpoints_rx[gadget_ep->address & 0xf], -+ gadget_ep, 0); -+ } -+} -+ -+static int gadget_setup(struct phytium_cusb *config) -+{ -+ int ret = -1; -+ -+ config->gadget_obj->gadget_getDevInstance(config->gadget_priv, &config->gadget_dev); -+ config->gadget.ops = &phytium_gadget_ops; -+ config->gadget.max_speed = config->gadget_dev->maxSpeed; -+ config->gadget.speed = USB_SPEED_HIGH; -+ config->gadget.name = "phytium_gadget"; -+ config->gadget.is_otg = 0; -+ -+ gadget_init_endpoint(config); -+ -+ ret = usb_add_gadget_udc(config->dev, &config->gadget); -+ if (ret) -+ goto err; -+ -+ return 0; -+ -+err: -+ config->gadget.dev.parent = NULL; -+ device_unregister(&config->gadget.dev); -+ return ret; -+} -+ -+int phytium_gadget_reinit(struct phytium_cusb *config) -+{ -+ struct GADGET_CTRL *ctrl; -+ -+ if (!config) -+ return 0; -+ -+ ctrl = (struct GADGET_CTRL *)config->gadget_priv; -+ if (!ctrl) -+ return 0; -+ -+ gadgetStop(ctrl); -+ -+ config->gadget_obj->gadget_init(config->gadget_priv, &config->gadget_cfg, -+ &config->gadget_callbacks, config->dev); -+ -+ return 0; -+} -+ -+int phytium_gadget_init(struct phytium_cusb *config) -+{ -+ int ret; -+ -+ if (!config) -+ return 0; -+ -+ phytium_gadget_set_default_cfg(config); -+ config->gadget_obj = &GadgetObj; -+ -+ config->dma_cfg.regBase = config->gadget_cfg.regBase + 0x400; -+ config->dma_obj = DMA_GetInstance(); -+ config->dma_obj->dma_probe(&config->dma_cfg, &config->dma_sysreq); -+ -+ config->gadget_sysreq.privDataSize = sizeof(struct GADGET_CTRL); -+ config->gadget_sysreq.trbMemSize = config->dma_sysreq.trbMemSize + GADGET_PRIV_BUFFER_SIZE; -+ config->gadget_sysreq.privDataSize += config->dma_sysreq.privDataSize; -+ -+ config->gadget_priv = devm_kzalloc(config->dev, -+ config->gadget_sysreq.privDataSize, GFP_KERNEL); -+ if (!config->gadget_priv) { -+ ret = -ENOMEM; -+ goto err_probe; -+ } -+ config->gadget_cfg.trbAddr = dma_alloc_coherent(config->dev, -+ config->gadget_sysreq.trbMemSize, -+ (dma_addr_t *)&config->gadget_cfg.trbDmaAddr, GFP_KERNEL); -+ if (!config->gadget_cfg.trbAddr) { -+ ret = -ENOMEM; -+ goto err_dma_coherent; -+ } -+ -+ config->gadget_callbacks.connect = gadget_callback_connect; -+ config->gadget_callbacks.disconnect = gadget_callback_disconnect; -+ config->gadget_callbacks.setup = gadget_callback_setup; -+ config->gadget_callbacks.usbRequestMemAlloc = gadget_callback_usbRequestMemAlloc; -+ config->gadget_callbacks.usbRequestMemFree = gadget_callback_usbRequestMemFree; -+ -+ ret = config->gadget_obj->gadget_init(config->gadget_priv, &config->gadget_cfg, -+ &config->gadget_callbacks, config->dev); -+ if (ret) { -+ ret = -ENODEV; -+ goto err_init; -+ } -+ -+ //dev_set_drvdata(config->dev, config); -+ -+ gadget_setup(config); -+ -+ return 0; -+ -+err_init: -+ dma_free_coherent(config->dev, config->gadget_sysreq.trbMemSize, -+ config->gadget_cfg.trbAddr, config->gadget_cfg.trbDmaAddr); -+err_dma_coherent: -+err_probe: -+ dev_set_drvdata(config->dev, NULL); -+ -+ return ret; -+} -+ -+int phytium_gadget_uninit(struct phytium_cusb *config) -+{ -+ if (config) -+ usb_del_gadget_udc(&config->gadget); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_PM -+int phytium_gadget_resume(void *priv) -+{ -+ struct GADGET_CTRL *ctrl; -+ uint32_t gen_cfg; -+ unsigned long flags = 0; -+ struct phytium_cusb *config = (struct phytium_cusb *)priv; -+ -+ if (!config) -+ return 0; -+ -+ ctrl = (struct GADGET_CTRL *)config->gadget_priv; -+ if (!ctrl) -+ return 0; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ phytium_gadget_reinit(config); -+ -+ if (config->gadget_driver) { -+ config->gadget_obj->gadget_start(config->gadget_priv); -+ if (ctrl->phy_regs) { -+ gen_cfg = phytium_read32(&ctrl->phy_regs->gen_cfg); -+ gen_cfg = gen_cfg & (~BIT(7)); -+ phytium_write32(&ctrl->phy_regs->gen_cfg, gen_cfg); -+ } -+ } -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+int phytium_gadget_suspend(void *priv) -+{ -+ return 0; -+} -+#endif -diff --git a/drivers/usb/phytium/gadget.h b/drivers/usb/phytium/gadget.h -new file mode 100644 -index 000000000..d87b55ade ---- /dev/null -+++ b/drivers/usb/phytium/gadget.h -@@ -0,0 +1,253 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+ -+#ifndef __PHYTIUM_GADGET_H_ -+#define __PHYTIUM_GADGET_H_ -+ -+#include -+#include -+#include "dma.h" -+ -+struct GADGET_CTRL; -+struct GADGET_EP; -+struct GADGET_REQ; -+ -+enum GADGET_EP_STATE { -+ GADGET_EP_FREE, -+ GADGET_EP_ALLOCATED, -+ GADGET_EP_BUSY, -+ GADGET_EP_NOT_IMPLEMENTED -+}; -+ -+enum GADGET_EP0_STAGE { -+ GADGET_EP0_STAGE_SETUP, -+ GADGET_EP0_STAGE_IN, -+ GADGET_EP0_STAGE_OUT, -+ GADGET_EP0_STAGE_STATUSIN, -+ GADGET_EP0_STAGE_STATUSOUT, -+ GADGET_EP0_STAGE_ACK -+}; -+ -+struct GADGET_EP_OPS { -+ int32_t (*epEnable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ const struct usb_endpoint_descriptor *desc); -+ -+ int32_t (*epDisable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*epSetHalt)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, uint8_t value); -+ -+ int32_t (*epSetWedge)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*epFifoStatus)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*epFifoFlush)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*reqQueue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+ -+ int32_t (*reqDequeue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+ -+ int32_t (*reqAlloc)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ **req); -+ -+ void (*reqFree)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+}; -+ -+struct GADGET_EP { -+ struct list_head epList; -+ char name[255]; -+ struct GADGET_EP_OPS *ops; -+ uint16_t maxPacket; -+ uint16_t maxStreams; -+ uint8_t mult; -+ uint8_t maxburst; -+ uint8_t address; -+ const struct usb_endpoint_descriptor *desc; -+ const struct usb_ss_ep_comp_descriptor *compDesc; -+}; -+ -+enum GADGET_DMAInterfaceWidth { -+ GADGET_DMA_32_WIDTH = 4, -+ GADGET_DMA_64_WIDTH = 8, -+}; -+ -+struct GADGET_EP_CFG { -+ uint8_t bufferingValue; -+ uint16_t startBuf; -+ uint16_t maxPacketSize; -+}; -+ -+struct GADGET_CFG { -+ uintptr_t regBase; -+ uintptr_t phy_regBase; -+ struct GADGET_EP_CFG epIN[16]; -+ struct GADGET_EP_CFG epOUT[16]; -+ enum GADGET_DMAInterfaceWidth dmaInterfaceWidth; -+ void *trbAddr; -+ uintptr_t trbDmaAddr; -+}; -+ -+struct GADGET_SYSREQ { -+ uint32_t privDataSize; -+ uint32_t trbMemSize; -+}; -+ -+struct GadgetEp { -+ struct GADGET_EP gadgetEp; -+ enum GADGET_EP_STATE state; -+ uint8_t hwEpNum; -+ uint8_t isInEp; -+ struct list_head request; -+ uint8_t iso_flag; -+ void *channel; -+ uint32_t requestsInList; -+ uint8_t wedged; -+}; -+ -+struct GADGET_DEV { -+ struct list_head epList; -+ struct GADGET_EP *ep0; -+ unsigned int speed; -+ unsigned int maxSpeed; -+ enum usb_device_state state; -+ uint8_t sgSupported; -+ uint8_t bHnpEnable; -+ uint8_t aHnpSupport; -+ char name[255]; -+}; -+ -+struct GADGET_SgList { -+ uintptr_t link; -+ uint32_t offset; -+ uint32_t length; -+ uintptr_t dmaAddress; -+}; -+ -+struct GADGET_REQ { -+ struct list_head list; -+ void *buf; -+ uint32_t length; -+ uintptr_t dma; -+ uint32_t numOfSgs; -+ uint32_t numMappedSgs; -+ uint16_t streamId; -+ uint8_t oInterrupt; -+ uint8_t zero; -+ uint8_t shortNotOk; -+ void *context; -+ uint32_t status; -+ uint32_t actual; -+ struct GADGET_SgList *sg; -+ void (*complete)(struct GADGET_EP *ep, struct GADGET_REQ *req); -+}; -+ -+ -+struct GADGET_CALLBACKS { -+ void (*disconnect)(struct GADGET_CTRL *priv); -+ -+ void (*connect)(struct GADGET_CTRL *priv); -+ -+ int32_t (*setup)(struct GADGET_CTRL *priv, -+ struct usb_ctrlrequest *ctrl); -+ -+ void *(*usbRequestMemAlloc)(struct GADGET_CTRL *priv, -+ uint32_t requiredSize); -+ -+ void (*usbRequestMemFree)(struct GADGET_CTRL *priv, void *usbRequest); -+}; -+ -+struct GADGET_OBJ { -+ int32_t (*gadget_init)(struct GADGET_CTRL *priv, struct GADGET_CFG *config, -+ struct GADGET_CALLBACKS *callbacks, struct device *pdev); -+ -+ void (*gadget_destroy)(struct GADGET_CTRL *priv); -+ -+ void (*gadget_start)(struct GADGET_CTRL *priv); -+ -+ void (*gadget_stop)(struct GADGET_CTRL *priv); -+ -+ void (*gadget_isr)(struct GADGET_CTRL *priv); -+ -+ int32_t (*gadget_epEnable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ const struct usb_endpoint_descriptor *desc); -+ -+ int32_t (*gadget_epDisable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*gadget_epSetHalt)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, uint8_t value); -+ -+ int32_t (*gadget_epSetWedge)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*gadget_epFifoStatus)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ void (*gadget_epFifoFlush)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); -+ -+ int32_t (*gadget_reqQueue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+ -+ int32_t (*gadget_reqDequeue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+ -+ int32_t (*gadget_reqAlloc)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ **req); -+ -+ void (*gadget_reqFree)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, -+ struct GADGET_REQ *req); -+ -+ void (*gadget_getDevInstance)(struct GADGET_CTRL *priv, struct GADGET_DEV **dev); -+ -+ int32_t (*gadget_dGetFrame)(struct GADGET_CTRL *priv, uint32_t *numOfFrame); -+ -+ int32_t (*gadget_dWakeUp)(struct GADGET_CTRL *priv); -+ -+ int32_t (*gadget_dSetSelfpowered)(struct GADGET_CTRL *priv); -+ -+ int32_t (*gadget_dClearSelfpowered)(struct GADGET_CTRL *priv); -+ -+ int32_t (*gadget_dVbusSession)(struct GADGET_CTRL *priv, uint8_t isActive); -+ -+ int32_t (*gadget_dVbusDraw)(struct GADGET_CTRL *priv, uint8_t mA); -+ -+ int32_t (*gadget_dPullUp)(struct GADGET_CTRL *priv, uint8_t isOn); -+ -+ void (*gadget_dGetConfigParams)(struct GADGET_CTRL *priv, -+ struct usb_dcd_config_params *configParams); -+}; -+ -+struct GADGET_CTRL { -+ struct device *dev; -+ struct GADGET_DEV gadgetDev; -+ struct HW_REGS *regs; -+ struct GADGET_OBJ *gadgetDrv; -+ struct GADGET_CFG gadgetCfg; -+ struct GADGET_CALLBACKS eventCallback; -+ struct GadgetEp in[16]; -+ struct GadgetEp out[16]; -+ enum GADGET_EP0_STAGE ep0State; -+ uint8_t isRemoteWakeup; -+ uint8_t isSelfPowered; -+ uint8_t deviceAddress; -+ struct DMA_OBJ *dmaDrv; -+ void *dmaController; -+ struct DMA_CFG dmaCfg; -+ struct DMA_CALLBACKS dmaCallback; -+ uint8_t releaseEp0Flag; -+ uint8_t isReady; -+ uint8_t *privBuffAddr; -+ uintptr_t privBuffDma; -+ uint8_t endpointInList; -+ uint8_t hostRequestFlag; -+ struct VHUB_REGS *phy_regs; -+}; -+ -+struct GadgetRequest { -+ struct GADGET_REQ request; -+ struct GadgetEp *ep; -+ struct GADGET_DEV *dev; -+ uint8_t zlp; -+}; -+ -+struct GADGET_OBJ *GADGET_GetInstance(void); -+ -+#endif /* __LINUX_PHYTIUM_GADGET */ -+ -diff --git a/drivers/usb/phytium/host.c b/drivers/usb/phytium/host.c -new file mode 100644 -index 000000000..8d58eaa99 ---- /dev/null -+++ b/drivers/usb/phytium/host.c -@@ -0,0 +1,2780 @@ -+// SPDX-License-Identifier: GPL-2.0 -+ -+#include -+#include -+#include -+#include -+//#include "list.h" -+#include "core.h" -+#include "dma.h" -+#include "hw-regs.h" -+ -+#define DRV_NAME "phytium_usb" -+ -+#define HOST_GENERIC_EP_CONTROL 0x00 -+#define HOST_GENERIC_EP_ISOC 0x01 -+#define HOST_GENERIC_EP_BULK 0x02 -+#define HOST_GENERIC_EP_INT 0x03 -+ -+#define HOST_ESTALL 1 -+#define HOST_EUNHANDLED 2 -+#define HOST_EAUTOACK 3 -+#define HOST_ESHUTDOWN 4 -+ -+#define HOST_EP_NUM 16 -+ -+static void dump_ep_remap_pool(struct HOST_CTRL *priv, bool dirIn) -+{ -+ int index, dir = 0; -+ -+ if (!dirIn) -+ dir = 1; -+ -+ pr_info("%s dir endpoint remap table\n", dir ? "OUT" : "IN"); -+ -+ for (index = 1; index <= MAX_INSTANCE_EP_NUM; index++) -+ pr_info("ep_remap_pool[%d][%d]->%d\n", dir, index, -+ priv->ep_remap_pool[dir][index]); -+} -+ -+static int get_epnum_from_pool(struct HOST_CTRL *priv, int real_epNum, bool dirIn) -+{ -+ int index, dir = 0; -+ int ret = 0; -+ -+ if (!priv || real_epNum == 0) -+ return 0; -+ -+ if (!dirIn) -+ dir = 1; -+ -+ for (index = 1; index <= MAX_INSTANCE_EP_NUM; index++) { -+ if (priv->ep_remap_pool[dir][index] == real_epNum) { -+ ret = index; -+ goto out; -+ } -+ } -+ -+ for (index = 1; index <= MAX_INSTANCE_EP_NUM; index++) { -+ if (!priv->ep_remap_pool[dir][index]) { -+ priv->ep_remap_pool[dir][index] = real_epNum; -+ ret = index; -+ goto out; -+ } -+ } -+ -+ if (index > MAX_INSTANCE_EP_NUM) -+ return index; -+ -+out: -+ return ret; -+} -+ -+static int release_epnum_from_pool(struct HOST_CTRL *priv, int real_epNum, bool dirIn) -+{ -+ int index = 0; -+ int dir = 0; -+ -+ if (!priv || real_epNum == 0) -+ return 0; -+ -+ if (!dirIn) -+ dir = 1; -+ -+ for (index = 1; index <= MAX_INSTANCE_EP_NUM; index++) { -+ if (priv->ep_remap_pool[dir][index] == real_epNum) { -+ priv->ep_remap_pool[dir][index] = 0; -+ -+ return 0; -+ } -+ } -+ -+ return 0; -+} -+ -+static inline struct HOST_REQ *getUsbRequestEntry(struct list_head *list) -+{ -+ return (struct HOST_REQ *)((uintptr_t)list - (uintptr_t)&(((struct HOST_REQ *)0)->list)); -+} -+ -+static inline struct HOST_EP_PRIV *getUsbHEpPrivEntry(struct list_head *list) -+{ -+ struct HOST_EP_PRIV *hostEpPriv; -+ -+ if (list_empty(list)) -+ return NULL; -+ -+ hostEpPriv = (struct HOST_EP_PRIV *)((uintptr_t)list - -+ (uintptr_t)&(((struct HOST_EP_PRIV *)0)->node)); -+ -+ return hostEpPriv; -+} -+ -+static struct HOST_REQ *getNextReq(struct HOST_EP *usbEp) -+{ -+ struct list_head *queue; -+ -+ if (!usbEp) -+ return NULL; -+ -+ queue = &usbEp->reqList; -+ -+ if (list_empty(queue)) -+ return NULL; -+ -+ return getUsbRequestEntry(queue->next); -+} -+ -+static void host_SetVbus(struct HOST_CTRL *priv, uint8_t isOn) -+{ -+ uint8_t otgctrl = phytium_read8(&priv->regs->otgctrl); -+ -+ if (isOn) { -+ if (!(otgctrl & OTGCTRL_BUSREQ) || (otgctrl & OTGCTRL_ABUSDROP)) { -+ otgctrl &= ~OTGCTRL_ABUSDROP; -+ otgctrl |= OTGCTRL_BUSREQ; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ } -+ priv->otgState = HOST_OTG_STATE_A_WAIT_BCON; -+ } else { -+ if ((otgctrl & OTGCTRL_BUSREQ) || (otgctrl & OTGCTRL_ABUSDROP)) { -+ otgctrl |= OTGCTRL_ABUSDROP; -+ otgctrl &= ~OTGCTRL_BUSREQ; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ } -+ priv->otgState = HOST_OTG_STATE_A_IDLE; -+ } -+} -+ -+static inline void disconnectHostDetect(struct HOST_CTRL *priv) -+{ -+ uint8_t otgctrl, otgstate; -+ uint32_t gen_cfg; -+ -+ if (!priv) -+ return; -+ -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ if ((otgctrl & OTGCTRL_ASETBHNPEN) && priv->otgState == HOST_OTG_STATE_A_SUSPEND) -+ pr_info("Device no Response\n"); -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); -+retry: -+ otgstate = phytium_read8(&priv->regs->otgstate); -+ if ((otgstate == HOST_OTG_STATE_A_HOST || otgstate == HOST_OTG_STATE_B_HOST)) { -+ pr_info("IRQ OTG: DisconnIrq Babble\n"); -+ goto retry; -+ } -+ -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x04); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | 0 | 0x04); -+ -+ priv->portStatus = USB_PORT_STAT_POWER; -+ priv->portStatus |= USB_PORT_STAT_C_CONNECTION << 16; -+ -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); -+ -+ if (priv->otgState == HOST_OTG_STATE_A_SUSPEND) -+ host_SetVbus(priv, 1); -+ -+ priv->otgState = HOST_OTG_STATE_A_IDLE; -+ if (priv->custom_regs) { -+ phytium_write32(&priv->custom_regs->wakeup, 1); -+ } else { -+ gen_cfg = phytium_read32(&priv->vhub_regs->gen_cfg); -+ gen_cfg |= BIT(1); -+ phytium_write32(&priv->vhub_regs->gen_cfg, gen_cfg); -+ } -+} -+ -+static inline void A_IdleDetect(struct HOST_CTRL *priv, uint8_t otgstate) -+{ -+ uint8_t otgctrl; -+ -+ if (!priv) -+ return; -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); -+ -+ if (otgstate != HOST_OTG_STATE_A_IDLE) { -+ pr_info("IRQ OTG: A_IDLE Babble\n"); -+ return; -+ } -+ -+ priv->portStatus = 0; -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ otgctrl &= ~OTGCTRL_ASETBHNPEN; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ -+ host_SetVbus(priv, 1); -+ -+ priv->otgState = HOST_OTG_STATE_A_IDLE; -+} -+ -+static inline void B_IdleDetect(struct HOST_CTRL *priv, uint8_t otgstate) -+{ -+ uint8_t otgctrl, usbcs; -+ -+ if (!priv) -+ return; -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); -+ -+ if (otgstate != HOST_OTG_STATE_B_IDLE) { -+ pr_info("IRQ OTG: B_IDLE Babble\n"); -+ return; -+ } -+ -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ otgctrl &= ~OTGCTRL_ASETBHNPEN; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ -+ host_SetVbus(priv, 0); -+ -+ priv->otgState = HOST_OTG_STATE_B_IDLE; -+ -+ usbcs = phytium_read8(&priv->regs->usbcs); -+ usbcs &= ~USBCS_DISCON; -+ phytium_write8(&priv->regs->usbcs, usbcs); -+} -+ -+static uint32_t waitForBusyBit(struct HOST_CTRL *priv, struct HostEp *hwEp) -+{ -+ uint8_t *csReg; -+ uint8_t flag = CS_BUSY; -+ uint8_t buf = 0; -+ uint8_t val = CS_BUSY; -+ uint8_t otgstate; -+ uint8_t bufflag = 0; -+ -+ if (!priv || !hwEp) -+ return 0; -+ -+ if (hwEp->isInEp) -+ return 0; -+ -+ if (hwEp->hwEpNum == 0) { -+ csReg = &priv->regs->ep0cs; -+ flag = EP0CS_TXBUSY_MASK; -+ buf = 0; -+ } else { -+ csReg = &priv->regs->ep[hwEp->hwEpNum - 1].txcs; -+ buf = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon) & CON_BUF; -+ } -+ -+ while ((val & flag) || bufflag == 0) { -+ otgstate = phytium_read8(&priv->regs->otgstate); -+ if (otgstate != HOST_OTG_STATE_B_HOST && otgstate != HOST_OTG_STATE_A_HOST) { -+ priv->ep0State = HOST_EP0_STAGE_IDLE; -+ return HOST_ESHUTDOWN; -+ } -+ -+ val = phytium_read8(csReg); -+ if (((val & CS_NPAK) >> CS_NPAK_OFFSET) == buf || buf == 0) -+ bufflag = 1; -+ else -+ bufflag = 0; -+ } -+ -+ return 0; -+} -+ -+static inline void connectHostDetect(struct HOST_CTRL *priv, uint8_t otgState) -+{ -+ uint32_t gen_cfg; -+ -+ if (!priv) -+ return; -+ -+ memset(priv->ep_remap_pool, 0, sizeof(priv->ep_remap_pool)); -+ pr_debug("otgState:0x%x pirv->otgState:0x%x\n", otgState, priv->otgState); -+ if (priv->custom_regs) { -+ phytium_write32(&priv->custom_regs->wakeup, 0); -+ } else { -+ gen_cfg = phytium_read32(&priv->vhub_regs->gen_cfg); -+ gen_cfg &= ~BIT(1); -+ phytium_write32(&priv->vhub_regs->gen_cfg, gen_cfg); -+ } -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); -+ -+ if ((otgState != HOST_OTG_STATE_A_HOST) && (otgState != HOST_OTG_STATE_B_HOST)) -+ return; -+ -+ if ((priv->otgState == HOST_OTG_STATE_A_PERIPHERAL) -+ || (priv->otgState == HOST_OTG_STATE_B_PERIPHERAL)) -+ priv->otgState = otgState; -+ -+ priv->ep0State = HOST_EP0_STAGE_IDLE; -+ -+ priv->portStatus &= ~(USB_PORT_STAT_LOW_SPEED | USB_PORT_STAT_HIGH_SPEED | -+ USB_PORT_STAT_ENABLE); -+ -+ priv->portStatus |= USB_PORT_STAT_C_CONNECTION | (USB_PORT_STAT_C_CONNECTION << 16); -+ priv->dmaDrv->dma_controllerReset(priv->dmaController); -+ priv->port_resetting = 1; -+ host_SetVbus(priv, 1); -+ -+ switch (phytium_read8(&priv->regs->speedctrl)) { -+ case SPEEDCTRL_HS: -+ priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; -+ pr_debug("detect High speed device\n"); -+ break; -+ case SPEEDCTRL_FS: -+ priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); -+ pr_debug("detect Full speed device\n"); -+ break; -+ case SPEEDCTRL_LS: -+ priv->portStatus |= USB_PORT_STAT_LOW_SPEED; -+ pr_debug("detect Low speed device\n"); -+ break; -+ } -+ -+ priv->vBusErrCnt = 0; -+ priv->dmaDrv->dma_setHostMode(priv->dmaController); -+ -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); -+ -+ priv->otgState = otgState; -+} -+ -+static void hostOtgIrq(struct HOST_CTRL *priv) -+{ -+ uint8_t otgirq, otgien; -+ uint8_t otgstatus, otgstate; -+ uint8_t otgctrl; -+ -+ if (!priv) -+ return; -+ -+ otgirq = phytium_read8(&priv->regs->otgirq); -+ otgien = phytium_read8(&priv->regs->otgien); -+ otgstatus = phytium_read8(&priv->regs->otgstatus); -+ otgstate = phytium_read8(&priv->regs->otgstate); -+ otgirq &= otgien; -+ -+ if (!otgirq) -+ return; -+ -+ if (otgirq & OTGIRQ_BSE0SRPIRQ) { -+ otgirq &= ~OTGIRQ_BSE0SRPIRQ; -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_BSE0SRPIRQ); -+ -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ otgctrl &= ~OTGIRQ_BSE0SRPIRQ; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ } -+ -+ if (otgirq & OTGIRQ_SRPDETIRQ) { -+ otgirq &= ~OTGIRQ_SRPDETIRQ; -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_SRPDETIRQ); -+ -+ otgctrl = phytium_read8(&priv->regs->otgctrl); -+ otgctrl &= ~OTGIRQ_SRPDETIRQ; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ } -+ -+ if (otgirq & OTGIRQ_VBUSERRIRQ) { -+ otgirq &= ~OTGIRQ_VBUSERRIRQ; -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_VBUSERRIRQ); -+ -+ if (otgstate != HOST_OTG_STATE_A_VBUS_ERR) { -+ pr_info("IRQ OTG: VBUS ERROR Babble\n"); -+ return; -+ } -+ -+ host_SetVbus(priv, 0); -+ priv->otgState = HOST_OTG_STATE_A_VBUS_ERR; -+ if (priv->portStatus & USB_PORT_STAT_CONNECTION) { -+ priv->portStatus = USB_PORT_STAT_POWER | (USB_PORT_STAT_C_CONNECTION << 16); -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); -+ return; -+ } -+ -+ if (priv->vBusErrCnt >= 3) { -+ priv->vBusErrCnt = 0; -+ pr_info("%s %d VBUS OVER CURRENT\n", __func__, __LINE__); -+ priv->portStatus |= USB_PORT_STAT_OVERCURRENT | -+ (USB_PORT_STAT_C_OVERCURRENT << 16); -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); -+ } else { -+ priv->vBusErrCnt++; -+ host_SetVbus(priv, 1); -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); -+ } -+ } -+ -+ if (otgirq & OTGIRQ_CONIRQ) { -+ if (priv->otgState == HOST_OTG_STATE_A_HOST || -+ priv->otgState == HOST_OTG_STATE_B_HOST || -+ priv->otgState == HOST_OTG_STATE_A_SUSPEND) { -+ if (otgstate == HOST_OTG_STATE_A_WAIT_VFALL || -+ otgstate == HOST_OTG_STATE_A_WAIT_BCON || -+ otgstate == HOST_OTG_STATE_A_SUSPEND) -+ disconnectHostDetect(priv); -+ } else if (priv->otgState != HOST_OTG_STATE_A_HOST && -+ priv->otgState != HOST_OTG_STATE_B_HOST && -+ priv->otgState != HOST_OTG_STATE_A_SUSPEND) -+ connectHostDetect(priv, otgstate); -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); -+ } -+ -+ if (otgirq & OTGIRQ_IDLEIRQ) { -+ if (!(otgstatus & OTGSTATUS_ID)) -+ A_IdleDetect(priv, otgstate); -+ else -+ B_IdleDetect(priv, otgstate); -+ } -+ -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDCHANGEIRQ | -+ OTGIRQ_SRPDETIRQ); -+} -+ -+static void hostErrorIrq(struct HOST_CTRL *priv) -+{ -+ uint16_t txerrirq, txerrien; -+ uint16_t rxerrirq, rxerrien; -+ uint16_t i, mask; -+ -+ if (!priv) -+ return; -+ -+ txerrirq = phytium_read16(&priv->regs->txerrirq); -+ txerrien = phytium_read16(&priv->regs->txerrien); -+ txerrirq &= txerrien; -+ -+ rxerrirq = phytium_read16(&priv->regs->rxerrirq); -+ rxerrien = phytium_read16(&priv->regs->rxerrien); -+ rxerrirq &= rxerrirq; -+ if (!txerrirq && !rxerrirq) -+ return; -+ -+ for (i = 0; i < HOST_EP_NUM; i++) { -+ mask = 1 << i; -+ if (rxerrirq & mask) { -+ phytium_write16(&priv->regs->rxerrirq, mask); -+ rxerrien &= ~mask; -+ phytium_write16(&priv->regs->rxerrien, rxerrien); -+ priv->dmaDrv->dma_errIsr(priv->dmaController, i, 0); -+ } -+ -+ if (txerrirq & mask) { -+ phytium_write16(&priv->regs->txerrirq, mask); -+ txerrien &= ~mask; -+ phytium_write16(&priv->regs->txerrien, txerrien); -+ priv->dmaDrv->dma_errIsr(priv->dmaController, i, 1); -+ } -+ } -+} -+ -+static uint32_t decodeErrorCode(uint8_t code) -+{ -+ uint32_t status = 0; -+ -+ switch (code) { -+ case ERR_NONE: -+ status = 0; -+ break; -+ case ERR_CRC: -+ pr_info("CRC Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ case ERR_DATA_TOGGLE_MISMATCH: -+ pr_info("Toggle MisMatch Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ case ERR_STALL: -+ pr_debug("Stall Error\n"); -+ status = HOST_ESTALL; -+ break; -+ case ERR_TIMEOUT: -+ pr_debug("Timeout Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ case ERR_PID: -+ pr_info("PID Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ case ERR_TOO_LONG_PACKET: -+ pr_info("TOO_LONG_PACKET Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ case ERR_DATA_UNDERRUN: -+ pr_info("UNDERRUN Error\n"); -+ status = HOST_ESHUTDOWN; -+ break; -+ } -+ -+ return status; -+} -+ -+static struct HOST_EP_PRIV *getIntTransfer(struct list_head *head) -+{ -+ struct list_head *listEntry = NULL; -+ struct HOST_EP_PRIV *usbHEpPriv = NULL; -+ struct HOST_EP_PRIV *usbHEpPrivActual = NULL; -+ -+ list_for_each(listEntry, head) { -+ usbHEpPriv = getUsbHEpPrivEntry(listEntry); -+ if (!usbHEpPrivActual) -+ usbHEpPrivActual = usbHEpPriv; -+ -+ if (usbHEpPriv->frame < usbHEpPrivActual->frame) -+ usbHEpPrivActual = usbHEpPriv; -+ } -+ -+ return usbHEpPrivActual; -+} -+ -+static void givebackRequest(struct HOST_CTRL *priv, struct HOST_REQ *usbReq, uint32_t status) -+{ -+ if (!priv || !usbReq) -+ return; -+ -+ list_del(&usbReq->list); -+ -+ if (usbReq->status == EINPROGRESS) -+ usbReq->status = status; -+ -+ if (priv->hostCallbacks.givebackRequest) -+ priv->hostCallbacks.givebackRequest(priv, usbReq, status); -+} -+ -+static void hostEpProgram(struct HOST_CTRL *priv, struct HostEp *hwEp, -+ struct HOST_REQ *usbReq, uintptr_t dmaBuff, uint32_t length) -+{ -+ struct HOST_EP *usbHEp; -+ struct HOST_EP_PRIV *usbEpPriv; -+ uint32_t chMaxLen; -+ uint8_t regCon = 0; -+ uint8_t ep0cs; -+ uint16_t txerrien = 0; -+ uint16_t rxerrien = 0; -+ uint32_t result; -+ uint8_t txsoftimer, rxsoftimer; -+ u8 retval = 0; -+ -+ if (!priv || !hwEp || !usbReq) -+ return; -+ -+ usbHEp = hwEp->scheduledUsbHEp; -+ usbEpPriv = (struct HOST_EP_PRIV *)usbHEp->hcPriv; -+ -+ if (!hwEp->channel) { -+ if (usbEpPriv->type == USB_ENDPOINT_XFER_ISOC) -+ hwEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, -+ !hwEp->isInEp, hwEp->hwEpNum, 1); -+ else -+ hwEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, -+ !hwEp->isInEp, hwEp->hwEpNum, 0); -+ } -+ -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, hwEp->channel); -+ -+ pr_debug("chMaxLen:0x%x buffLength:0x%x\n", chMaxLen, usbReq->buffLength); -+ if (usbReq->buffLength > chMaxLen) -+ length = chMaxLen; -+ -+ switch (usbEpPriv->type) { -+ case USB_ENDPOINT_XFER_CONTROL: -+ regCon = CON_TYPE_CONTROL; -+ break; -+ case USB_ENDPOINT_XFER_BULK: -+ regCon = CON_TYPE_BULK; -+ break; -+ case USB_ENDPOINT_XFER_INT: -+ regCon = CON_TYPE_INT; -+ break; -+ case USB_ENDPOINT_XFER_ISOC: -+ if (usbEpPriv->isocEpConfigured) -+ goto dma_program; -+ -+ usbEpPriv->isocEpConfigured = 1; -+ regCon = CON_TYPE_ISOC; -+ switch (usbHEp->desc.wMaxPacketSize >> 11) { -+ case 0: -+ regCon |= CON_TYPE_ISOC_1_ISOD; -+ priv->dmaDrv->dma_setMaxLength(priv->dmaController, -+ hwEp->channel, usbEpPriv->maxPacketSize); -+ break; -+ case 1: -+ regCon |= CON_TYPE_ISOC_2_ISOD; -+ priv->dmaDrv->dma_setMaxLength(priv->dmaController, -+ hwEp->channel, 2 * 1024); -+ break; -+ case 2: -+ priv->dmaDrv->dma_setMaxLength(priv->dmaController, -+ hwEp->channel, 3 * 1024); -+ regCon |= CON_TYPE_ISOC_3_ISOD; -+ break; -+ } -+ break; -+ } -+ -+ if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { -+ if (!hwEp->hwEpNum) { -+ if (phytium_read8(&priv->regs->ep0cs) & 0x4) { -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | -+ 0 | 0x4); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | -+ FIFOCTRL_IO_TX | 0 | 0x4); -+ } -+ } -+ if (waitForBusyBit(priv, hwEp) > 0) { -+ usbReq->status = HOST_ESHUTDOWN; -+ givebackRequest(priv, usbReq, HOST_ESHUTDOWN); -+ pr_info("something error happen\n"); -+ return; -+ } -+ } -+ -+ if (!hwEp->isInEp) { -+ if (hwEp->hwEpNum) { -+ regCon |= hwEp->hwBuffers - 1; -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, regCon); -+ if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { -+ retval = priv->hostCallbacks.getEpToggle(priv, -+ usbReq->usbDev, usbHEp->device_epNum, 0); -+ if (retval) { -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_IO_TX); -+ -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_TOGSETQ | ENDPRST_IO_TX | ENDPRST_FIFORST); -+ } else { -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_IO_TX); -+ -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_TOGRST | ENDPRST_IO_TX | ENDPRST_FIFORST); -+ } -+ } -+ -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, regCon | CON_VAL); -+ phytium_write16(&priv->regs->txmaxpack[hwEp->hwEpNum - 1], -+ usbEpPriv->maxPacketSize); -+ -+ phytium_write8(&priv->regs->epExt[hwEp->hwEpNum - 1].txctrl, -+ usbHEp->device_epNum); -+ -+ phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); -+ -+ // if (usbEpPriv->type == USB_ENDPOINT_XFER_INT) -+ txsoftimer = phytium_read8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl); -+ txsoftimer = txsoftimer | BIT(1); -+ phytium_write8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl, txsoftimer); -+ -+ phytium_write16(&priv->regs->txsoftimer[hwEp->hwEpNum].timer, -+ usbEpPriv->frame); -+ -+ phytium_write8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl, 0x83); -+ } else { -+ phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); -+ phytium_write8(&priv->regs->ep0maxpack, usbEpPriv->maxPacketSize); -+ phytium_write8(&priv->regs->ep0ctrl, usbEpPriv->epNum); -+ -+ if (priv->ep0State == HOST_EP0_STAGE_SETUP) { -+ ep0cs = phytium_read8(&priv->regs->ep0cs); -+ ep0cs |= EP0CS_HCSET; -+ phytium_write8(&priv->regs->ep0cs, ep0cs); -+ } -+ } -+ -+ phytium_write16(&priv->regs->txerrirq, 1 << hwEp->hwEpNum); -+ txerrien = phytium_read16(&priv->regs->txerrien); -+ txerrien |= 1 << hwEp->hwEpNum; -+ phytium_write16(&priv->regs->txerrien, txerrien); -+ } else { -+ if (hwEp->hwEpNum) { -+ regCon |= hwEp->hwBuffers - 1; -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, regCon); -+ -+ if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { -+ if (priv->hostCallbacks.getEpToggle) { -+ retval = priv->hostCallbacks.getEpToggle(priv, -+ usbReq->usbDev, usbHEp->device_epNum, 1); -+ if (retval) { -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_TOGSETQ | ENDPRST_FIFORST); -+ } else { -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | -+ ENDPRST_TOGRST | ENDPRST_FIFORST); -+ } -+ } -+ } -+ -+ phytium_write16(&priv->regs->rxmaxpack[hwEp->hwEpNum - 1], -+ usbEpPriv->maxPacketSize); -+ -+ phytium_write8(&priv->regs->epExt[hwEp->hwEpNum - 1].rxctrl, -+ usbHEp->device_epNum); -+ -+ phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); -+ -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); -+ -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, regCon | CON_VAL); -+ rxsoftimer = phytium_read8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl); -+ rxsoftimer = rxsoftimer | BIT(1); -+ phytium_write8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl, rxsoftimer); -+ -+ phytium_write16(&priv->regs->rxsoftimer[hwEp->hwEpNum].timer, -+ usbEpPriv->frame); -+ -+ phytium_write8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl, 0x83); -+ } else { -+ phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); -+ phytium_write8(&priv->regs->ep0maxpack, usbEpPriv->maxPacketSize); -+ phytium_write8(&priv->regs->ep0ctrl, usbEpPriv->epNum); -+ -+ if (priv->ep0State == HOST_EP0_STAGE_IN -+ || priv->ep0State == HOST_EP0_STAGE_STATUSIN) -+ phytium_write8(&priv->regs->ep0cs, EP0CS_HCSETTOGGLE); -+ } -+ -+ phytium_write16(&priv->regs->rxerrirq, 1 << hwEp->hwEpNum); -+ rxerrien = phytium_read16(&priv->regs->rxerrien); -+ rxerrien |= 1 << hwEp->hwEpNum; -+ phytium_write16(&priv->regs->rxerrien, rxerrien); -+ } -+dma_program: -+ result = priv->dmaDrv->dma_channelProgram(priv->dmaController, hwEp->channel, -+ usbEpPriv->maxPacketSize, dmaBuff, length, -+ (void *)usbReq->isoFramesDesc, usbReq->isoFramesNumber); -+ if (result) { -+ if (!hwEp->isInEp) { -+ txerrien &= ~(1 << hwEp->hwEpNum); -+ if (hwEp->hwEpNum) -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, 0x08); -+ phytium_write16(&priv->regs->txerrien, txerrien); -+ } else { -+ rxerrien &= ~(1 << hwEp->hwEpNum); -+ if (hwEp->hwEpNum) -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, 0x08); -+ phytium_write16(&priv->regs->rxerrien, rxerrien); -+ } -+ -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); -+ hwEp->channel = NULL; -+ } -+} -+ -+static void hostStartReq(struct HOST_CTRL *priv, struct HOST_REQ *req) -+{ -+ uintptr_t dmaBuff; -+ uint32_t length; -+ struct HOST_EP *hostEp; -+ struct HOST_EP_PRIV *hostEpPriv; -+ struct HOST_EP_PRIV *hostNewEpPriv; -+ struct HOST_REQ *usbReq = NULL; -+ struct HostEp *hwEp = NULL; -+ int num; -+ -+ if (!priv || !req) -+ return; -+ -+ hostEp = req->hcPriv; -+ if (hostEp) { -+ hostEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; -+ if (hostEpPriv) { -+ hostEpPriv->genericHwEp->state = HOST_EP_BUSY; -+ switch (hostEpPriv->type) { -+ case USB_ENDPOINT_XFER_CONTROL: -+ usbReq = getNextReq(hostEp); -+ -+ priv->in[HOST_GENERIC_EP_CONTROL].scheduledUsbHEp = hostEp; -+ priv->ep0State = HOST_EP0_STAGE_SETUP; -+ hostEpPriv->currentHwEp = hostEpPriv->genericHwEp; -+ hostEpPriv->genericHwEp->scheduledUsbHEp = hostEp; -+ dmaBuff = usbReq->setupDma; -+ length = 8; -+ pr_debug("packet info: %02x %02x %04x %04x %04x\n", -+ usbReq->setup->bRequestType, -+ usbReq->setup->bRequest, -+ usbReq->setup->wValue, -+ usbReq->setup->wIndex, -+ usbReq->setup->wLength); -+ hostEpProgram(priv, hostEpPriv->genericHwEp, -+ usbReq, dmaBuff, length); -+ break; -+ case USB_ENDPOINT_XFER_BULK: -+ hwEp = hostEpPriv->genericHwEp; -+ usbReq = getNextReq(hostEp); -+ hostEpPriv->currentHwEp = hwEp; -+ hwEp->scheduledUsbHEp = hostEp; -+ dmaBuff = usbReq->buffDma + usbReq->actualLength; -+ length = usbReq->buffLength - usbReq->actualLength; -+ hostEpProgram(priv, hwEp, usbReq, dmaBuff, length); -+ break; -+ case USB_ENDPOINT_XFER_INT: -+ if (hostEpPriv->genericHwEp->scheduledUsbHEp) -+ return; -+ -+ num = req->epNum - 1; -+ if (hostEpPriv->isIn) -+ hostNewEpPriv = getIntTransfer(&priv->intInHEpQueue[num]); -+ else -+ hostNewEpPriv = getIntTransfer(&priv->intOutHEpQueue[num]); -+ -+ hostNewEpPriv->currentHwEp = hostEpPriv->genericHwEp; -+ hostEpPriv->genericHwEp->scheduledUsbHEp = hostNewEpPriv->usbHEp; -+ usbReq = getNextReq(hostEp); -+ dmaBuff = usbReq->buffDma + usbReq->actualLength; -+ length = usbReq->buffLength - usbReq->actualLength; -+ hostEpProgram(priv, hostEpPriv->genericHwEp, -+ usbReq, dmaBuff, length); -+ break; -+ case USB_ENDPOINT_XFER_ISOC: -+ hostEpPriv->currentHwEp = hostEpPriv->genericHwEp; -+ hostEpPriv->genericHwEp->scheduledUsbHEp = hostEp; -+ dmaBuff = req->buffDma + req->actualLength; -+ length = req->buffLength - req->actualLength; -+ hostEpProgram(priv, hostEpPriv->genericHwEp, req, dmaBuff, length); -+ break; -+ } -+ } -+ } -+} -+ -+static void abortTransfer(struct HOST_CTRL *priv, -+ struct HOST_REQ *usbReq, struct HostEp *hwEp) -+{ -+ struct HOST_EP *usbEp; -+ struct HOST_EP_PRIV *usbHEpPriv; -+ uint32_t status; -+ -+ if (!priv || !usbReq || !hwEp || !hwEp->scheduledUsbHEp) -+ return; -+ -+ usbEp = hwEp->scheduledUsbHEp; -+ usbHEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; -+ if (!usbHEpPriv) -+ return; -+ -+ status = (usbReq->status == EINPROGRESS) ? 0 : usbReq->status; -+ givebackRequest(priv, usbReq, status); -+ -+ if (list_empty(&usbEp->reqList)) { -+ usbHEpPriv->epIsReady = 0; -+ usbHEpPriv->currentHwEp = NULL; -+ hwEp->scheduledUsbHEp = NULL; -+ -+ if (hwEp->channel) { -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); -+ hwEp->channel = NULL; -+ } -+ -+ if (usb_endpoint_xfer_int(&usbEp->desc)) -+ list_del(&usbHEpPriv->node); -+ } -+} -+ -+static void scheduleNextTransfer(struct HOST_CTRL *priv, -+ struct HOST_REQ *usbReq, struct HostEp *hwEp) -+{ -+ struct HOST_EP *usbEp; -+ struct HOST_EP_PRIV *usbHEpPriv; -+ uint8_t endprst; -+ uint32_t status; -+ struct HOST_REQ *usbNextReq = NULL; -+ -+ if (!priv || !usbReq || !hwEp) -+ return; -+ -+ usbEp = hwEp->scheduledUsbHEp; -+ usbHEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; -+ if (!usbHEpPriv) -+ return; -+ -+ status = (usbReq->status == EINPROGRESS) ? 0 : usbReq->status; -+ switch (usbHEpPriv->type) { -+ case USB_ENDPOINT_XFER_BULK: -+ case USB_ENDPOINT_XFER_INT: -+ if (hwEp->isInEp) { -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); -+ endprst = (phytium_read8(&priv->regs->endprst) & ENDPRST_TOGSETQ) ? 1 : 0; -+ if (priv->hostCallbacks.setEpToggle) -+ priv->hostCallbacks.setEpToggle(priv, usbReq->usbDev, -+ usbEp->device_epNum, usbHEpPriv->isIn, endprst); -+ } else { -+ if (waitForBusyBit(priv, hwEp) > 0) { -+ usbReq->status = HOST_ESHUTDOWN; -+ givebackRequest(priv, usbReq, HOST_ESHUTDOWN); -+ return; -+ } -+ -+ phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | ENDPRST_IO_TX); -+ endprst = (phytium_read8(&priv->regs->endprst) & ENDPRST_TOGSETQ) ? 1 : 0; -+ if (priv->hostCallbacks.setEpToggle) -+ priv->hostCallbacks.setEpToggle(priv, usbReq->usbDev, -+ usbEp->device_epNum, usbHEpPriv->isIn, endprst); -+ } -+ break; -+ } -+ -+ if (usbHEpPriv->transferFinished) -+ givebackRequest(priv, usbReq, status); -+ -+ if (list_empty(&usbEp->reqList)) { -+ if (usbHEpPriv->type == USB_ENDPOINT_XFER_CONTROL) -+ hwEp->state = HOST_EP_ALLOCATED; -+ else { -+ if (usbHEpPriv->genericHwEp == hwEp) -+ hwEp->state = HOST_EP_ALLOCATED; -+ else -+ hwEp->state = HOST_EP_FREE; -+ } -+ -+ usbHEpPriv->epIsReady = 0; -+ usbHEpPriv->currentHwEp = NULL; -+ hwEp->scheduledUsbHEp = NULL; -+ -+ if (hwEp->channel) { -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); -+ hwEp->channel = NULL; -+ } -+ -+ if (usb_endpoint_xfer_int(&usbEp->desc)) -+ list_del(&usbHEpPriv->node); -+ usbHEpPriv = NULL; -+ } else { -+ if (usbHEpPriv->type == USB_ENDPOINT_XFER_INT) { -+ usbHEpPriv->currentHwEp = NULL; -+ hwEp->scheduledUsbHEp = NULL; -+ } -+ -+ if (usbHEpPriv->type == USB_ENDPOINT_XFER_ISOC) -+ return; -+ } -+ -+ if (usbHEpPriv) { -+ usbNextReq = getNextReq(usbHEpPriv->usbHEp); -+ hostStartReq(priv, usbNextReq); -+ } -+} -+ -+static int32_t hostEp0Irq(struct HOST_CTRL *priv, uint8_t isIn) -+{ -+ struct HostEp *hwEp; -+ struct HOST_EP *hostEp; -+ struct HOST_REQ *usbReq = NULL; -+ struct HOST_EP_PRIV *usbHEpPriv; -+ uint32_t status, length; -+ uint8_t usbError; -+ uint8_t nextStage = 0; -+ int ret = 0; -+ -+ if (!priv) -+ return 0; -+ -+ hwEp = isIn ? &priv->in[HOST_GENERIC_EP_CONTROL] : &priv->out[HOST_GENERIC_EP_CONTROL]; -+ hostEp = hwEp->scheduledUsbHEp; -+ usbHEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; -+ -+ usbReq = getNextReq(hostEp); -+ if (!usbReq) -+ return 0; -+ -+ usbError = isIn ? phytium_read8(&priv->regs->rx0err) : phytium_read8(&priv->regs->tx0err); -+ usbError = (usbError & ERR_TYPE) >> 2; -+ status = decodeErrorCode(usbError); -+ if (status) { -+ usbReq->status = status; -+ -+ if (status == HOST_ESTALL) { -+ ret = 1; -+ priv->dmaDrv->dma_controllerReset(priv->dmaController); -+ } -+ -+ phytium_write16(&priv->regs->rxerrirq, 1 << hwEp->hwEpNum); -+ phytium_write16(&priv->regs->txerrirq, 1 << hwEp->hwEpNum); -+ -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x4); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | -+ FIFOCTRL_IO_TX | 0 | 0x4); -+ } -+ -+ length = priv->dmaDrv->dma_getActualLength(priv->dmaController, hwEp->channel); -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); -+ hwEp->channel = NULL; -+ -+ if (usbReq->status == EINPROGRESS && priv->ep0State < HOST_EP0_STAGE_STATUSIN) { -+ nextStage = 0; -+ switch (priv->ep0State) { -+ case HOST_EP0_STAGE_IN: -+ pr_debug("Ep0 Data IN\n"); -+ usbHEpPriv->currentHwEp = &priv->out[HOST_GENERIC_EP_CONTROL]; -+ usbReq->actualLength = length; -+ priv->ep0State = HOST_EP0_STAGE_STATUSOUT; -+ break; -+ case HOST_EP0_STAGE_OUT: -+ pr_debug("Ep0 Data OUT\n"); -+ usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROL]; -+ usbReq->actualLength = length; -+ priv->ep0State = HOST_EP0_STAGE_STATUSIN; -+ break; -+ case HOST_EP0_STAGE_SETUP: -+ pr_debug("Ep0 Stage Setup\n"); -+ if (!usbReq->setup->wLength) { -+ pr_debug("EP0_STAGE_STATUSIN\n"); -+ priv->ep0State = HOST_EP0_STAGE_STATUSIN; -+ usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROL]; -+ break; -+ } else if (usbReq->setup->bRequestType & USB_DIR_IN) { -+ pr_debug("EP0_STAGE_STAGE_IN\n"); -+ priv->ep0State = HOST_EP0_STAGE_IN; -+ usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROL]; -+ nextStage = 1; -+ break; -+ } -+ priv->ep0State = HOST_EP0_STAGE_OUT; -+ nextStage = 1; -+ break; -+ case HOST_EP0_STAGE_STATUSIN: -+ case HOST_EP0_STAGE_STATUSOUT: -+ case HOST_EP0_STAGE_ACK: -+ case HOST_EP0_STAGE_IDLE: -+ default: -+ pr_debug("EP0 STAGE is %d\n", priv->ep0State); -+ break; -+ } -+ -+ if (nextStage) { -+ length = usbReq->buffLength; -+ hostEpProgram(priv, usbHEpPriv->currentHwEp, usbReq, -+ usbReq->buffDma, length); -+ } else -+ hostEpProgram(priv, usbHEpPriv->currentHwEp, usbReq, usbReq->setupDma, 0); -+ } else -+ priv->ep0State = HOST_EP0_STAGE_IDLE; -+ -+ if (priv->ep0State == HOST_EP0_STAGE_IDLE || usbReq->status != EINPROGRESS) { -+ usbHEpPriv->transferFinished = 1; -+ scheduleNextTransfer(priv, usbReq, hwEp); -+ } -+ -+ return ret; -+} -+ -+static void updateTimeIntTransfer(struct list_head *head, struct HOST_EP_PRIV *lastFinished) -+{ -+ struct list_head *listEntry = NULL; -+ struct HOST_EP_PRIV *usbHEpPriv = NULL; -+ uint16_t time = lastFinished->frame; -+ -+ list_for_each(listEntry, head) { -+ usbHEpPriv = getUsbHEpPrivEntry(listEntry); -+ if (usbHEpPriv == lastFinished) { -+ lastFinished->frame = lastFinished->interval; -+ continue; -+ } -+ -+ if (usbHEpPriv->frame < time) -+ usbHEpPriv->frame = 0; -+ else -+ lastFinished->interval = usbHEpPriv->frame; -+ } -+} -+ -+static int32_t hostEpXIrq(struct HOST_CTRL *priv, uint8_t hwEpNum, uint8_t isIn, bool resubmit) -+{ -+ struct HostEp *hwEp; -+ struct HOST_EP *hostEp; -+ struct HOST_EP_PRIV *usbHEpPriv; -+ struct HOST_REQ *usbReq; -+ -+ uint8_t usbError, rxcon, txcon; -+ uint32_t status, length, chMaxLen; -+ -+ if (!priv) -+ return -EINVAL; -+ -+ hwEp = isIn ? &priv->in[hwEpNum] : &priv->out[hwEpNum]; -+ hostEp = hwEp->scheduledUsbHEp; -+ if (!hostEp) -+ return -EINVAL; -+ -+ usbHEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; -+ -+ usbReq = getNextReq(hostEp); -+ if (!usbReq) -+ return 0; -+ -+ if (isIn) -+ usbError = phytium_read8(&priv->regs->epExt[hwEpNum - 1].rxerr); -+ else -+ usbError = phytium_read8(&priv->regs->epExt[hwEpNum - 1].txerr); -+ -+ usbError = (usbError & ERR_TYPE) >> 2; -+ status = decodeErrorCode(usbError); -+ if (status) { -+ pr_debug("%s %d Aborting\n", __func__, __LINE__); -+ if (isIn) -+ phytium_write16(&priv->regs->rxerrirq, 1 << hwEpNum); -+ else -+ phytium_write16(&priv->regs->txerrirq, 1 << hwEpNum); -+ priv->dmaDrv->dma_channelAbort(priv->dmaController, hwEp->channel); -+ } -+ -+ length = priv->dmaDrv->dma_getActualLength(priv->dmaController, hwEp->channel); -+ chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, hwEp->channel); -+ -+ if (status != 0) -+ usbReq->status = status; -+ -+ usbReq->actualLength += length; -+ -+ if (!resubmit) -+ usbHEpPriv->transferFinished = 1; -+ -+ if (length == chMaxLen) { -+ if ((usbReq->buffLength - usbReq->actualLength) == 0) -+ usbHEpPriv->transferFinished = 1; -+ else -+ usbHEpPriv->transferFinished = 0; -+ } -+ -+ if (usbHEpPriv->type != USB_ENDPOINT_XFER_ISOC) { -+ if (!hwEp->isInEp) { -+ txcon = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon); -+ txcon &= ~CON_VAL; -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, txcon); -+ } else { -+ rxcon = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon); -+ rxcon &= ~CON_VAL; -+ phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, rxcon); -+ } -+ priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); -+ hwEp->channel = NULL; -+ } -+ -+ if (usbHEpPriv->type == USB_ENDPOINT_XFER_INT) { -+ if (usbHEpPriv->isIn) -+ updateTimeIntTransfer(&priv->intInHEpQueue[hwEp->hwEpNum - 1], usbHEpPriv); -+ else -+ updateTimeIntTransfer(&priv->intOutHEpQueue[hwEp->hwEpNum - 1], usbHEpPriv); -+ } -+ -+ scheduleNextTransfer(priv, usbReq, hwEp); -+ -+ return 0; -+} -+ -+ -+static void host_CallbackTransfer(void *priv, uint8_t epNum, uint8_t isDirTx, bool resubmit) -+{ -+ struct HOST_CTRL *host_priv = (struct HOST_CTRL *)priv; -+ int i; -+ int ret = 0; -+ -+ if (!epNum) { -+ ret = hostEp0Irq(host_priv, !isDirTx); -+ if (resubmit | ret) { -+ for (i = 1; i < HOST_EP_NUM; i++) { -+ hostEpXIrq(host_priv, i, !isDirTx, true); -+ hostEpXIrq(host_priv, i, isDirTx, true); -+ } -+ } -+ } else -+ hostEpXIrq(host_priv, epNum, !isDirTx, false); -+} -+ -+static int hc_reset(struct usb_hcd *hcd) -+{ -+ hcd->speed = HCD_USB2; -+ hcd->self.root_hub->speed = USB_SPEED_HIGH; -+ -+ return 0; -+} -+ -+static int hc_start(struct usb_hcd *hcd) -+{ -+ hcd->state = HC_STATE_RUNNING; -+ return 0; -+} -+ -+static void hc_stop(struct usb_hcd *hcd) -+{ -+ struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; -+ -+ if (config) -+ config->host_obj->host_stop(config->host_priv); -+ -+ if (config->host_cfg.trbAddr) { -+ dma_free_coherent(config->dev, config->host_sysreq.trbMemSize, -+ config->host_cfg.trbAddr, config->host_cfg.trbDmaAddr); -+ config->host_cfg.trbAddr = NULL; -+ } -+ -+ if (config->host_priv) { -+ devm_kfree(config->dev, config->host_priv); -+ config->host_priv = NULL; -+ } -+ -+ hcd->state = HC_STATE_HALT; -+} -+ -+static void hc_shutdown(struct usb_hcd *hcd) -+{ -+} -+ -+static void host_endpoint_update(struct phytium_cusb *config, -+ struct HOST_USB_DEVICE *udev, struct usb_host_endpoint *ep) -+{ -+ int epnum; -+ struct HOST_EP *hostEp; -+ -+ if (!config || !udev || !ep) -+ return; -+ -+ epnum = get_epnum_from_pool(config->host_priv, usb_endpoint_num(&ep->desc), -+ usb_endpoint_dir_in(&ep->desc)); -+ -+ if (usb_endpoint_dir_out(&ep->desc)) { -+ if (udev->out_ep[epnum] == NULL) { -+ hostEp = kzalloc(sizeof(struct HOST_EP) + -+ config->host_obj->host_epGetPrivateDataSize(config->host_priv), -+ GFP_ATOMIC); -+ udev->out_ep[epnum] = hostEp; -+ } else -+ hostEp = udev->out_ep[epnum]; -+ } else { -+ if (udev->in_ep[epnum] == NULL) { -+ hostEp = kzalloc(sizeof(struct HOST_EP) + -+ config->host_obj->host_epGetPrivateDataSize(config->host_priv), -+ GFP_ATOMIC); -+ udev->in_ep[epnum] = hostEp; -+ } else -+ hostEp = udev->in_ep[epnum]; -+ } -+ -+ hostEp->desc = *(struct usb_endpoint_descriptor *)(&ep->desc); -+ hostEp->userExt = (void *)ep; -+ INIT_LIST_HEAD(&hostEp->reqList); -+ hostEp->hcPriv = &((uint8_t *)hostEp)[sizeof(struct HOST_EP)]; -+} -+ -+static int hc_urb_enqueue(struct usb_hcd *hcd, struct urb *urb, gfp_t mem_flags) -+{ -+ unsigned long flags; -+ u32 isoFrameSize; -+ int retval; -+ int index; -+ struct HOST_REQ *req; -+ struct HOST_CTRL *priv; -+ struct HOST_USB_DEVICE *usbDev; -+ struct usb_host_endpoint *host_ep; -+ struct usb_endpoint_descriptor *host_ep_desc; -+ struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; -+ -+ if (!config) -+ return -ENODEV; -+ -+ priv = config->host_priv; -+ if (!priv) -+ return -ENODEV; -+ -+ usbDev = priv->host_devices_table[urb->dev->slot_id]; -+ if (!usbDev) -+ return -ENODEV; -+ -+ host_ep = urb->ep; -+ host_ep_desc = &host_ep->desc; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ retval = usb_hcd_link_urb_to_ep(hcd, urb); -+ if (retval < 0) { -+ spin_unlock_irqrestore(&config->lock, flags); -+ return retval; -+ } -+ spin_unlock_irqrestore(&config->lock, flags); -+ isoFrameSize = urb->number_of_packets * sizeof(struct HOST_ISOFRAMESDESC); -+ req = kzalloc((sizeof(struct HOST_REQ) + -+ isoFrameSize), mem_flags); -+ if (!req) { -+ spin_lock_irqsave(&config->lock, flags); -+ usb_hcd_unlink_urb_from_ep(hcd, urb); -+ spin_unlock_irqrestore(&config->lock, flags); -+ return -ENOMEM; -+ } -+ -+ req->isoFramesDesc = NULL; -+ req->isoFramesNumber = urb->number_of_packets; -+ req->epNum = get_epnum_from_pool(config->host_priv, usb_endpoint_num(host_ep_desc), -+ usb_endpoint_dir_in(host_ep_desc)); -+ if (req->epNum > MAX_INSTANCE_EP_NUM) { -+ pr_err("Not enough endpoint resource for remap\n"); -+ dump_ep_remap_pool(priv, usb_endpoint_dir_in(host_ep_desc)); -+ req->epNum = MAX_INSTANCE_EP_NUM; -+ } -+ -+ if (usb_endpoint_dir_in(host_ep_desc)) { -+ if (!usbDev->in_ep[req->epNum]) -+ host_endpoint_update(config, usbDev, host_ep); -+ } else { -+ if (!usbDev->out_ep[req->epNum]) -+ host_endpoint_update(config, usbDev, host_ep); -+ } -+ -+ if (usb_endpoint_xfer_isoc(host_ep_desc)) { -+ req->isoFramesDesc = (struct HOST_ISOFRAMESDESC *)(&req[1]); -+ for (index = 0; index < urb->number_of_packets; index++) { -+ req->isoFramesDesc[index].length = urb->iso_frame_desc[index].length; -+ req->isoFramesDesc[index].offset = urb->iso_frame_desc[index].offset; -+ } -+ } -+ -+ spin_lock_irqsave(&config->lock, flags); -+ INIT_LIST_HEAD(&req->list); -+ req->userExt = (void *)urb; -+ req->actualLength = urb->actual_length; -+ req->bufAddress = urb->transfer_buffer; -+ req->buffDma = urb->transfer_dma; -+ req->buffLength = urb->transfer_buffer_length; -+ req->epIsIn = usb_endpoint_dir_in(host_ep_desc); -+ req->eptype = usb_endpoint_type(host_ep_desc); -+ req->faddress = usb_pipedevice(urb->pipe); -+ req->interval = urb->interval; -+ req->reqUnlinked = 0; -+ req->setup = (struct usb_ctrlrequest *)urb->setup_packet; -+ req->setupDma = urb->setup_dma; -+ req->status = EINPROGRESS; -+ req->usbDev = &usbDev->udev; -+ req->usbEp = req->epIsIn ? usbDev->in_ep[req->epNum] : usbDev->out_ep[req->epNum]; -+ req->usbEp->device_epNum = usb_endpoint_num(host_ep_desc); -+ if (!req->epNum) -+ usbDev->ep0_hep.desc.wMaxPacketSize = urb->dev->ep0.desc.wMaxPacketSize; -+ -+ req->hcPriv = (void *)req->usbEp; -+ urb->hcpriv = req; -+ host_ep->hcpriv = (void *)usbDev; -+ retval = config->host_obj->host_reqQueue(config->host_priv, req); -+ if (retval) { -+ usb_hcd_unlink_urb_from_ep(hcd, urb); -+ urb->hcpriv = NULL; -+ spin_unlock_irqrestore(&config->lock, flags); -+ kfree(req); -+ return -retval; -+ } -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+ -+static int hc_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status) -+{ -+ unsigned long flags; -+ struct HOST_CTRL *priv; -+ int ret = 0; -+ struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; -+ -+ if (!config) -+ return -ENODEV; -+ -+ priv = config->host_priv; -+ if (!priv->host_devices_table[urb->dev->slot_id]) -+ return -ENODEV; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ if (usb_hcd_check_unlink_urb(hcd, urb, status)) -+ goto done; -+ -+ if (!urb->hcpriv) -+ goto err_giveback; -+ -+ ret = config->host_obj->host_reqDequeue(priv, urb->hcpriv, status); -+ -+ release_epnum_from_pool(config->host_priv, usb_pipeendpoint(urb->pipe), -+ usb_pipein(urb->pipe)); -+ -+ kfree(urb->hcpriv); -+ urb->hcpriv = NULL; -+done: -+ spin_unlock_irqrestore(&config->lock, flags); -+ return ret; -+ -+err_giveback: -+ kfree(urb->hcpriv); -+ usb_hcd_unlink_urb_from_ep(hcd, urb); -+ spin_unlock_irqrestore(&config->lock, flags); -+ usb_hcd_giveback_urb(hcd, urb, -ESHUTDOWN); -+ return ret; -+} -+ -+static void hc_endpoint_disable(struct usb_hcd *hcd, struct usb_host_endpoint *ld_ep) -+{ -+ struct HOST_USB_DEVICE *usbDev; -+ int ep_num; -+ struct phytium_cusb *config; -+ struct HOST_CTRL *priv; -+ -+ config = *(struct phytium_cusb **)hcd->hcd_priv; -+ if (!config) -+ return; -+ -+ ep_num = get_epnum_from_pool(config->host_priv, usb_endpoint_num(&ld_ep->desc), -+ usb_endpoint_dir_in(&ld_ep->desc)); -+ -+ priv = config->host_priv; -+ -+ usbDev = (struct HOST_USB_DEVICE *)ld_ep->hcpriv; -+ if (!usbDev) -+ return; -+ -+ if (ld_ep->desc.bEndpointAddress) { -+ if (usb_endpoint_dir_in(&ld_ep->desc)) { -+ if (usbDev->in_ep[ep_num]) { -+ usbDev->in_ep[ep_num]->userExt = NULL; -+ INIT_LIST_HEAD(&usbDev->in_ep[ep_num]->reqList); -+ kfree(usbDev->in_ep[ep_num]); -+ usbDev->in_ep[ep_num] = NULL; -+ priv->ep_remap_pool[0][ep_num] = 0; -+ } -+ } else { -+ if (usbDev->out_ep[ep_num]) { -+ usbDev->out_ep[ep_num]->userExt = NULL; -+ INIT_LIST_HEAD(&usbDev->out_ep[ep_num]->reqList); -+ kfree(usbDev->out_ep[ep_num]); -+ usbDev->out_ep[ep_num] = NULL; -+ priv->ep_remap_pool[1][ep_num] = 0; -+ } -+ } -+ } -+} -+ -+static int hc_get_frame(struct usb_hcd *hcd) -+{ -+ return 0; -+} +diff --git a/arch/arm64/configs/defconfig b/arch/arm64/configs/defconfig +deleted file mode 100644 +index a789119e6..000000000 +--- a/arch/arm64/configs/defconfig ++++ /dev/null +@@ -1,1586 +0,0 @@ +-CONFIG_SYSVIPC=y +-CONFIG_POSIX_MQUEUE=y +-CONFIG_AUDIT=y +-CONFIG_NO_HZ_IDLE=y +-CONFIG_HIGH_RES_TIMERS=y +-CONFIG_BPF_SYSCALL=y +-CONFIG_BPF_JIT=y +-CONFIG_PREEMPT=y +-CONFIG_IRQ_TIME_ACCOUNTING=y +-CONFIG_BSD_PROCESS_ACCT=y +-CONFIG_BSD_PROCESS_ACCT_V3=y +-CONFIG_TASKSTATS=y +-CONFIG_TASK_XACCT=y +-CONFIG_TASK_IO_ACCOUNTING=y +-CONFIG_IKCONFIG=y +-CONFIG_IKCONFIG_PROC=y +-CONFIG_NUMA_BALANCING=y +-CONFIG_MEMCG=y +-CONFIG_BLK_CGROUP=y +-CONFIG_CGROUP_PIDS=y +-CONFIG_CGROUP_FREEZER=y +-CONFIG_CGROUP_HUGETLB=y +-CONFIG_CPUSETS=y +-CONFIG_CGROUP_DEVICE=y +-CONFIG_CGROUP_CPUACCT=y +-CONFIG_CGROUP_PERF=y +-CONFIG_CGROUP_BPF=y +-CONFIG_USER_NS=y +-CONFIG_SCHED_AUTOGROUP=y +-CONFIG_BLK_DEV_INITRD=y +-CONFIG_KALLSYMS_ALL=y +-CONFIG_PROFILING=y +-CONFIG_ARCH_ACTIONS=y +-CONFIG_ARCH_SUNXI=y +-CONFIG_ARCH_ALPINE=y +-CONFIG_ARCH_APPLE=y +-CONFIG_ARCH_BCM=y +-CONFIG_ARCH_BCM2835=y +-CONFIG_ARCH_BCM_IPROC=y +-CONFIG_ARCH_BCMBCA=y +-CONFIG_ARCH_BRCMSTB=y +-CONFIG_ARCH_BERLIN=y +-CONFIG_ARCH_EXYNOS=y +-CONFIG_ARCH_SPARX5=y +-CONFIG_ARCH_K3=y +-CONFIG_ARCH_LG1K=y +-CONFIG_ARCH_HISI=y +-CONFIG_ARCH_KEEMBAY=y +-CONFIG_ARCH_MEDIATEK=y +-CONFIG_ARCH_MESON=y +-CONFIG_ARCH_MVEBU=y +-CONFIG_ARCH_NXP=y +-CONFIG_ARCH_LAYERSCAPE=y +-CONFIG_ARCH_MXC=y +-CONFIG_ARCH_S32=y +-CONFIG_ARCH_MA35=y +-CONFIG_ARCH_NPCM=y +-CONFIG_ARCH_QCOM=y +-CONFIG_ARCH_REALTEK=y +-CONFIG_ARCH_RENESAS=y +-CONFIG_ARCH_ROCKCHIP=y +-CONFIG_ARCH_SEATTLE=y +-CONFIG_ARCH_INTEL_SOCFPGA=y +-CONFIG_ARCH_STM32=y +-CONFIG_ARCH_SYNQUACER=y +-CONFIG_ARCH_TEGRA=y +-CONFIG_ARCH_TESLA_FSD=y +-CONFIG_ARCH_SPRD=y +-CONFIG_ARCH_THUNDER=y +-CONFIG_ARCH_THUNDER2=y +-CONFIG_ARCH_UNIPHIER=y +-CONFIG_ARCH_VEXPRESS=y +-CONFIG_ARCH_VISCONTI=y +-CONFIG_ARCH_XGENE=y +-CONFIG_ARCH_ZYNQMP=y +-CONFIG_ARM64_VA_BITS_48=y +-CONFIG_SCHED_MC=y +-CONFIG_SCHED_SMT=y +-CONFIG_NUMA=y +-CONFIG_KEXEC=y +-CONFIG_KEXEC_FILE=y +-CONFIG_CRASH_DUMP=y +-CONFIG_XEN=y +-CONFIG_COMPAT=y +-CONFIG_RANDOMIZE_BASE=y +-CONFIG_HIBERNATION=y +-CONFIG_WQ_POWER_EFFICIENT_DEFAULT=y +-CONFIG_ENERGY_MODEL=y +-CONFIG_ARM_PSCI_CPUIDLE=y +-CONFIG_CPU_FREQ=y +-CONFIG_CPU_FREQ_STAT=y +-CONFIG_CPU_FREQ_GOV_POWERSAVE=m +-CONFIG_CPU_FREQ_GOV_USERSPACE=y +-CONFIG_CPU_FREQ_GOV_ONDEMAND=y +-CONFIG_CPU_FREQ_GOV_CONSERVATIVE=m +-CONFIG_CPUFREQ_DT=y +-CONFIG_ACPI_CPPC_CPUFREQ=m +-CONFIG_ARM_ALLWINNER_SUN50I_CPUFREQ_NVMEM=m +-CONFIG_ARM_ARMADA_37XX_CPUFREQ=y +-CONFIG_ARM_SCPI_CPUFREQ=y +-CONFIG_ARM_IMX_CPUFREQ_DT=m +-CONFIG_ARM_MEDIATEK_CPUFREQ=y +-CONFIG_ARM_QCOM_CPUFREQ_NVMEM=y +-CONFIG_ARM_QCOM_CPUFREQ_HW=y +-CONFIG_ARM_RASPBERRYPI_CPUFREQ=m +-CONFIG_ARM_SCMI_CPUFREQ=y +-CONFIG_ARM_TEGRA186_CPUFREQ=y +-CONFIG_QORIQ_CPUFREQ=y +-CONFIG_ACPI=y +-CONFIG_ACPI_HOTPLUG_MEMORY=y +-CONFIG_ACPI_HMAT=y +-CONFIG_ACPI_APEI=y +-CONFIG_ACPI_APEI_GHES=y +-CONFIG_ACPI_APEI_PCIEAER=y +-CONFIG_ACPI_APEI_MEMORY_FAILURE=y +-CONFIG_ACPI_APEI_EINJ=y +-CONFIG_VIRTUALIZATION=y +-CONFIG_KVM=y +-CONFIG_JUMP_LABEL=y +-CONFIG_MODULES=y +-CONFIG_MODULE_UNLOAD=y +-CONFIG_IOSCHED_BFQ=y +-# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set +-# CONFIG_COMPAT_BRK is not set +-CONFIG_MEMORY_HOTPLUG=y +-CONFIG_MEMORY_HOTREMOVE=y +-CONFIG_KSM=y +-CONFIG_MEMORY_FAILURE=y +-CONFIG_TRANSPARENT_HUGEPAGE=y +-CONFIG_NET=y +-CONFIG_PACKET=y +-CONFIG_UNIX=y +-CONFIG_INET=y +-CONFIG_IP_MULTICAST=y +-CONFIG_IP_PNP=y +-CONFIG_IP_PNP_DHCP=y +-CONFIG_IP_PNP_BOOTP=y +-CONFIG_IPV6=m +-CONFIG_NETFILTER=y +-CONFIG_BRIDGE_NETFILTER=m +-CONFIG_NF_CONNTRACK=m +-CONFIG_NF_CONNTRACK_EVENTS=y +-CONFIG_NETFILTER_XT_MARK=m +-CONFIG_NETFILTER_XT_TARGET_CHECKSUM=m +-CONFIG_NETFILTER_XT_TARGET_LOG=m +-CONFIG_NETFILTER_XT_MATCH_ADDRTYPE=m +-CONFIG_NETFILTER_XT_MATCH_CONNTRACK=m +-CONFIG_NETFILTER_XT_MATCH_IPVS=m +-CONFIG_IP_VS=m +-CONFIG_IP_NF_IPTABLES=m +-CONFIG_IP_NF_FILTER=m +-CONFIG_IP_NF_TARGET_REJECT=m +-CONFIG_IP_NF_NAT=m +-CONFIG_IP_NF_TARGET_MASQUERADE=m +-CONFIG_IP_NF_MANGLE=m +-CONFIG_IP6_NF_IPTABLES=m +-CONFIG_IP6_NF_FILTER=m +-CONFIG_IP6_NF_TARGET_REJECT=m +-CONFIG_IP6_NF_MANGLE=m +-CONFIG_IP6_NF_NAT=m +-CONFIG_IP6_NF_TARGET_MASQUERADE=m +-CONFIG_BRIDGE=m +-CONFIG_BRIDGE_VLAN_FILTERING=y +-CONFIG_NET_DSA=m +-CONFIG_VLAN_8021Q=m +-CONFIG_VLAN_8021Q_GVRP=y +-CONFIG_VLAN_8021Q_MVRP=y +-CONFIG_NET_SCHED=y +-CONFIG_NET_SCH_CBS=m +-CONFIG_NET_SCH_ETF=m +-CONFIG_NET_SCH_TAPRIO=m +-CONFIG_NET_SCH_MQPRIO=m +-CONFIG_NET_SCH_INGRESS=m +-CONFIG_NET_CLS_BASIC=m +-CONFIG_NET_CLS_FLOWER=m +-CONFIG_NET_CLS_ACT=y +-CONFIG_NET_ACT_GACT=m +-CONFIG_NET_ACT_MIRRED=m +-CONFIG_NET_ACT_GATE=m +-CONFIG_QRTR_SMD=m +-CONFIG_QRTR_TUN=m +-CONFIG_CAN=m +-CONFIG_CAN_M_CAN=m +-CONFIG_CAN_M_CAN_PLATFORM=m +-CONFIG_BT=m +-CONFIG_BT_HIDP=m +-# CONFIG_BT_LE is not set +-CONFIG_BT_LEDS=y +-# CONFIG_BT_DEBUGFS is not set +-CONFIG_BT_HCIBTUSB=m +-CONFIG_BT_HCIBTUSB_MTK=y +-CONFIG_BT_HCIUART=m +-CONFIG_BT_HCIUART_LL=y +-CONFIG_BT_HCIUART_BCM=y +-CONFIG_BT_HCIUART_QCA=y +-CONFIG_BT_HCIUART_MRVL=y +-CONFIG_BT_MRVL=m +-CONFIG_BT_MRVL_SDIO=m +-CONFIG_BT_QCOMSMD=m +-CONFIG_BT_NXPUART=m +-CONFIG_CFG80211=m +-CONFIG_MAC80211=m +-CONFIG_MAC80211_LEDS=y +-CONFIG_RFKILL=m +-CONFIG_NET_9P=y +-CONFIG_NET_9P_VIRTIO=y +-CONFIG_NFC=m +-CONFIG_NFC_NCI=m +-CONFIG_NFC_S3FWRN5_I2C=m +-CONFIG_PCI=y +-CONFIG_PCIEPORTBUS=y +-CONFIG_PCIEAER=y +-CONFIG_PCI_IOV=y +-CONFIG_PCI_PASID=y +-CONFIG_HOTPLUG_PCI=y +-CONFIG_HOTPLUG_PCI_ACPI=y +-CONFIG_PCI_AARDVARK=y +-CONFIG_PCI_TEGRA=y +-CONFIG_PCIE_RCAR_HOST=y +-CONFIG_PCIE_RCAR_EP=y +-CONFIG_PCI_HOST_GENERIC=y +-CONFIG_PCI_XGENE=y +-CONFIG_PCIE_ALTERA=y +-CONFIG_PCIE_ALTERA_MSI=y +-CONFIG_PCI_HOST_THUNDER_PEM=y +-CONFIG_PCI_HOST_THUNDER_ECAM=y +-CONFIG_PCIE_ROCKCHIP_HOST=m +-CONFIG_PCIE_MEDIATEK_GEN3=m +-CONFIG_PCIE_BRCMSTB=m +-CONFIG_PCI_IMX6_HOST=y +-CONFIG_PCI_LAYERSCAPE=y +-CONFIG_PCI_HISI=y +-CONFIG_PCIE_QCOM=y +-CONFIG_PCIE_ARMADA_8K=y +-CONFIG_PCIE_ROCKCHIP_DW_HOST=y +-CONFIG_PCIE_KIRIN=y +-CONFIG_PCIE_HISI_STB=y +-CONFIG_PCIE_TEGRA194_HOST=m +-CONFIG_PCIE_VISCONTI_HOST=y +-CONFIG_PCIE_LAYERSCAPE_GEN4=y +-CONFIG_PCI_ENDPOINT=y +-CONFIG_PCI_ENDPOINT_CONFIGFS=y +-CONFIG_PCI_EPF_TEST=m +-CONFIG_DEVTMPFS=y +-CONFIG_DEVTMPFS_MOUNT=y +-CONFIG_FW_LOADER_USER_HELPER=y +-CONFIG_HISILICON_LPC=y +-CONFIG_TEGRA_ACONNECT=m +-CONFIG_MHI_BUS_PCI_GENERIC=m +-CONFIG_ARM_SCMI_PROTOCOL=y +-CONFIG_ARM_SCPI_PROTOCOL=y +-CONFIG_RASPBERRYPI_FIRMWARE=y +-CONFIG_INTEL_STRATIX10_SERVICE=y +-CONFIG_INTEL_STRATIX10_RSU=m +-CONFIG_EFI_CAPSULE_LOADER=y +-CONFIG_IMX_SCU=y +-CONFIG_IMX_SCU_PD=y +-CONFIG_GNSS=m +-CONFIG_GNSS_MTK_SERIAL=m +-CONFIG_MTD=y +-CONFIG_MTD_BLOCK=y +-CONFIG_MTD_CFI=y +-CONFIG_MTD_CFI_ADV_OPTIONS=y +-CONFIG_MTD_CFI_INTELEXT=y +-CONFIG_MTD_CFI_AMDSTD=y +-CONFIG_MTD_CFI_STAA=y +-CONFIG_MTD_PHYSMAP=y +-CONFIG_MTD_PHYSMAP_OF=y +-CONFIG_MTD_DATAFLASH=y +-CONFIG_MTD_SST25L=y +-CONFIG_MTD_RAW_NAND=y +-CONFIG_MTD_NAND_DENALI_DT=y +-CONFIG_MTD_NAND_MARVELL=y +-CONFIG_MTD_NAND_BRCMNAND=m +-CONFIG_MTD_NAND_FSL_IFC=y +-CONFIG_MTD_NAND_QCOM=y +-CONFIG_MTD_SPI_NOR=y +-CONFIG_MTD_UBI=m +-CONFIG_UBIFS_FS=m +-CONFIG_BLK_DEV_LOOP=y +-CONFIG_BLK_DEV_NBD=m +-CONFIG_VIRTIO_BLK=y +-CONFIG_BLK_DEV_NVME=m +-CONFIG_QCOM_COINCELL=m +-CONFIG_QCOM_FASTRPC=m +-CONFIG_BATTERY_QCOM_BATTMGR=m +-CONFIG_UCSI_PMIC_GLINK=m +-CONFIG_SRAM=y +-CONFIG_PCI_ENDPOINT_TEST=m +-CONFIG_EEPROM_AT24=m +-CONFIG_EEPROM_AT25=m +-CONFIG_UACCE=m +-# CONFIG_SCSI_PROC_FS is not set +-CONFIG_BLK_DEV_SD=y +-CONFIG_SCSI_SAS_ATA=y +-CONFIG_SCSI_HISI_SAS=y +-CONFIG_SCSI_HISI_SAS_PCI=y +-CONFIG_MEGARAID_SAS=y +-CONFIG_SCSI_MPT3SAS=m +-CONFIG_ATA=y +-CONFIG_SATA_AHCI=y +-CONFIG_SATA_AHCI_PLATFORM=y +-CONFIG_AHCI_BRCM=m +-CONFIG_AHCI_DWC=m +-CONFIG_AHCI_CEVA=y +-CONFIG_AHCI_MVEBU=y +-CONFIG_AHCI_XGENE=y +-CONFIG_AHCI_QORIQ=y +-CONFIG_SATA_SIL24=y +-CONFIG_SATA_RCAR=y +-CONFIG_PATA_PLATFORM=y +-CONFIG_PATA_OF_PLATFORM=y +-CONFIG_MD=y +-CONFIG_BLK_DEV_MD=m +-CONFIG_BLK_DEV_DM=m +-CONFIG_DM_MIRROR=m +-CONFIG_DM_ZERO=m +-CONFIG_NETDEVICES=y +-CONFIG_MACVLAN=m +-CONFIG_MACVTAP=m +-CONFIG_TUN=y +-CONFIG_VETH=m +-CONFIG_VIRTIO_NET=y +-CONFIG_MHI_NET=m +-CONFIG_NET_DSA_BCM_SF2=m +-CONFIG_NET_DSA_MSCC_FELIX=m +-CONFIG_AMD_XGBE=y +-CONFIG_NET_XGENE=y +-CONFIG_ATL1C=m +-CONFIG_BCMGENET=m +-CONFIG_BNX2X=m +-CONFIG_SYSTEMPORT=m +-CONFIG_MACB=y +-CONFIG_THUNDER_NIC_PF=y +-CONFIG_FEC=y +-CONFIG_FSL_FMAN=y +-CONFIG_FSL_DPAA_ETH=y +-CONFIG_FSL_DPAA2_ETH=y +-CONFIG_FSL_ENETC=y +-CONFIG_FSL_ENETC_VF=y +-CONFIG_FSL_ENETC_QOS=y +-CONFIG_HIX5HD2_GMAC=y +-CONFIG_HNS_DSAF=y +-CONFIG_HNS_ENET=y +-CONFIG_HNS3=y +-CONFIG_HNS3_HCLGE=y +-CONFIG_HNS3_ENET=y +-CONFIG_E1000=y +-CONFIG_E1000E=y +-CONFIG_IGB=y +-CONFIG_IGBVF=y +-CONFIG_MVNETA=y +-CONFIG_MVPP2=y +-CONFIG_SKY2=y +-CONFIG_MLX4_EN=m +-CONFIG_MLX5_CORE=m +-CONFIG_MLX5_CORE_EN=y +-CONFIG_QCOM_EMAC=m +-CONFIG_RMNET=m +-CONFIG_R8169=m +-CONFIG_SH_ETH=y +-CONFIG_RAVB=y +-CONFIG_RENESAS_ETHER_SWITCH=y +-CONFIG_SMC91X=y +-CONFIG_SMSC911X=y +-CONFIG_SNI_AVE=y +-CONFIG_SNI_NETSEC=y +-CONFIG_STMMAC_ETH=m +-CONFIG_DWMAC_TEGRA=m +-CONFIG_TI_K3_AM65_CPSW_NUSS=y +-CONFIG_QCOM_IPA=m +-CONFIG_MESON_GXL_PHY=m +-CONFIG_AQUANTIA_PHY=y +-CONFIG_BCM54140_PHY=m +-CONFIG_MARVELL_PHY=m +-CONFIG_MARVELL_10G_PHY=y +-CONFIG_MICREL_PHY=y +-CONFIG_MICROSEMI_PHY=y +-CONFIG_AT803X_PHY=y +-CONFIG_REALTEK_PHY=y +-CONFIG_ROCKCHIP_PHY=y +-CONFIG_DP83867_PHY=y +-CONFIG_DP83869_PHY=m +-CONFIG_DP83TD510_PHY=y +-CONFIG_VITESSE_PHY=y +-CONFIG_CAN_FLEXCAN=m +-CONFIG_CAN_RCAR=m +-CONFIG_CAN_RCAR_CANFD=m +-CONFIG_CAN_MCP251XFD=m +-CONFIG_MDIO_GPIO=y +-CONFIG_MDIO_BUS_MUX_MULTIPLEXER=y +-CONFIG_MDIO_BUS_MUX_MMIOREG=y +-CONFIG_USB_PEGASUS=m +-CONFIG_USB_RTL8150=m +-CONFIG_USB_RTL8152=m +-CONFIG_USB_LAN78XX=m +-CONFIG_USB_USBNET=m +-CONFIG_USB_NET_DM9601=m +-CONFIG_USB_NET_SR9800=m +-CONFIG_USB_NET_SMSC75XX=m +-CONFIG_USB_NET_SMSC95XX=m +-CONFIG_USB_NET_PLUSB=m +-CONFIG_USB_NET_MCS7830=m +-CONFIG_ATH10K=m +-CONFIG_ATH10K_PCI=m +-CONFIG_ATH10K_SDIO=m +-CONFIG_ATH10K_SNOC=m +-CONFIG_WCN36XX=m +-CONFIG_ATH11K=m +-CONFIG_ATH11K_AHB=m +-CONFIG_ATH11K_PCI=m +-CONFIG_BRCMFMAC=m +-CONFIG_MWIFIEX=m +-CONFIG_MWIFIEX_SDIO=m +-CONFIG_MWIFIEX_PCIE=m +-CONFIG_MT7921E=m +-CONFIG_RSI_91X=m +-CONFIG_WL18XX=m +-CONFIG_WLCORE_SDIO=m +-CONFIG_WWAN=m +-CONFIG_MHI_WWAN_CTRL=m +-CONFIG_MHI_WWAN_MBIM=m +-CONFIG_INPUT_EVDEV=y +-CONFIG_KEYBOARD_ADC=m +-CONFIG_KEYBOARD_GPIO=y +-CONFIG_KEYBOARD_SNVS_PWRKEY=m +-CONFIG_KEYBOARD_IMX_SC_KEY=m +-CONFIG_KEYBOARD_CROS_EC=y +-CONFIG_KEYBOARD_MTK_PMIC=m +-CONFIG_MOUSE_ELAN_I2C=m +-CONFIG_INPUT_TOUCHSCREEN=y +-CONFIG_TOUCHSCREEN_ATMEL_MXT=m +-CONFIG_TOUCHSCREEN_GOODIX=m +-CONFIG_TOUCHSCREEN_ELAN=m +-CONFIG_TOUCHSCREEN_EDT_FT5X06=m +-CONFIG_INPUT_MISC=y +-CONFIG_INPUT_BBNSM_PWRKEY=m +-CONFIG_INPUT_PM8941_PWRKEY=y +-CONFIG_INPUT_PM8XXX_VIBRATOR=m +-CONFIG_INPUT_TPS65219_PWRBUTTON=m +-CONFIG_INPUT_PWM_BEEPER=m +-CONFIG_INPUT_PWM_VIBRA=m +-CONFIG_INPUT_RK805_PWRKEY=m +-CONFIG_INPUT_HISI_POWERKEY=y +-# CONFIG_SERIO_SERPORT is not set +-CONFIG_SERIO_AMBAKMI=y +-CONFIG_LEGACY_PTY_COUNT=16 +-CONFIG_SERIAL_8250=y +-CONFIG_SERIAL_8250_CONSOLE=y +-CONFIG_SERIAL_8250_EXTENDED=y +-CONFIG_SERIAL_8250_SHARE_IRQ=y +-CONFIG_SERIAL_8250_BCM2835AUX=y +-CONFIG_SERIAL_8250_DW=y +-CONFIG_SERIAL_8250_EM=y +-CONFIG_SERIAL_8250_OMAP=y +-CONFIG_SERIAL_8250_MT6577=y +-CONFIG_SERIAL_8250_UNIPHIER=y +-CONFIG_SERIAL_OF_PLATFORM=y +-CONFIG_SERIAL_AMBA_PL011=y +-CONFIG_SERIAL_AMBA_PL011_CONSOLE=y +-CONFIG_SERIAL_MESON=y +-CONFIG_SERIAL_MESON_CONSOLE=y +-CONFIG_SERIAL_SAMSUNG=y +-CONFIG_SERIAL_SAMSUNG_CONSOLE=y +-CONFIG_SERIAL_TEGRA=y +-CONFIG_SERIAL_TEGRA_TCU=y +-CONFIG_SERIAL_IMX=y +-CONFIG_SERIAL_IMX_CONSOLE=y +-CONFIG_SERIAL_SH_SCI=y +-CONFIG_SERIAL_MSM=y +-CONFIG_SERIAL_MSM_CONSOLE=y +-CONFIG_SERIAL_QCOM_GENI=y +-CONFIG_SERIAL_QCOM_GENI_CONSOLE=y +-CONFIG_SERIAL_XILINX_PS_UART=y +-CONFIG_SERIAL_XILINX_PS_UART_CONSOLE=y +-CONFIG_SERIAL_FSL_LPUART=y +-CONFIG_SERIAL_FSL_LPUART_CONSOLE=y +-CONFIG_SERIAL_FSL_LINFLEXUART=y +-CONFIG_SERIAL_FSL_LINFLEXUART_CONSOLE=y +-CONFIG_SERIAL_STM32=y +-CONFIG_SERIAL_STM32_CONSOLE=y +-CONFIG_SERIAL_MVEBU_UART=y +-CONFIG_SERIAL_OWL=y +-CONFIG_SERIAL_DEV_BUS=y +-CONFIG_VIRTIO_CONSOLE=y +-CONFIG_IPMI_HANDLER=m +-CONFIG_IPMI_DEVICE_INTERFACE=m +-CONFIG_IPMI_SI=m +-CONFIG_HW_RANDOM=y +-CONFIG_HW_RANDOM_VIRTIO=y +-CONFIG_TCG_TPM=y +-CONFIG_TCG_TIS=m +-CONFIG_TCG_TIS_SPI=m +-CONFIG_TCG_TIS_SPI_CR50=y +-CONFIG_TCG_TIS_I2C_CR50=m +-CONFIG_TCG_TIS_I2C_INFINEON=y +-CONFIG_I2C_CHARDEV=y +-CONFIG_I2C_MUX=y +-CONFIG_I2C_MUX_PCA954x=y +-CONFIG_I2C_BCM2835=m +-CONFIG_I2C_CADENCE=m +-CONFIG_I2C_DESIGNWARE_PLATFORM=y +-CONFIG_I2C_GPIO=m +-CONFIG_I2C_IMX=y +-CONFIG_I2C_IMX_LPI2C=y +-CONFIG_I2C_MESON=y +-CONFIG_I2C_MT65XX=y +-CONFIG_I2C_MV64XXX=y +-CONFIG_I2C_OMAP=y +-CONFIG_I2C_OWL=y +-CONFIG_I2C_PXA=y +-CONFIG_I2C_QCOM_CCI=m +-CONFIG_I2C_QCOM_GENI=m +-CONFIG_I2C_QUP=y +-CONFIG_I2C_RIIC=y +-CONFIG_I2C_RK3X=y +-CONFIG_I2C_RZV2M=m +-CONFIG_I2C_S3C2410=y +-CONFIG_I2C_SH_MOBILE=y +-CONFIG_I2C_TEGRA=y +-CONFIG_I2C_UNIPHIER_F=y +-CONFIG_I2C_RCAR=y +-CONFIG_I2C_CROS_EC_TUNNEL=y +-CONFIG_SPI=y +-CONFIG_SPI_ARMADA_3700=y +-CONFIG_SPI_BCM2835=m +-CONFIG_SPI_BCM2835AUX=m +-CONFIG_SPI_CADENCE_QUADSPI=y +-CONFIG_SPI_DESIGNWARE=m +-CONFIG_SPI_DW_DMA=y +-CONFIG_SPI_DW_MMIO=m +-CONFIG_SPI_FSL_LPSPI=y +-CONFIG_SPI_FSL_QUADSPI=y +-CONFIG_SPI_NXP_FLEXSPI=y +-CONFIG_SPI_IMX=m +-CONFIG_SPI_FSL_DSPI=y +-CONFIG_SPI_MESON_SPICC=m +-CONFIG_SPI_MESON_SPIFC=m +-CONFIG_SPI_MT65XX=y +-CONFIG_SPI_MTK_NOR=m +-CONFIG_SPI_OMAP24XX=m +-CONFIG_SPI_ORION=y +-CONFIG_SPI_PL022=y +-CONFIG_SPI_ROCKCHIP=y +-CONFIG_SPI_ROCKCHIP_SFC=m +-CONFIG_SPI_RPCIF=m +-CONFIG_SPI_RSPI=m +-CONFIG_SPI_RZV2M_CSI=m +-CONFIG_SPI_QCOM_QSPI=m +-CONFIG_SPI_QUP=y +-CONFIG_SPI_QCOM_GENI=m +-CONFIG_SPI_S3C64XX=y +-CONFIG_SPI_SH_MSIOF=m +-CONFIG_SPI_SUN6I=y +-CONFIG_SPI_TEGRA210_QUAD=m +-CONFIG_SPI_TEGRA114=m +-CONFIG_SPI_SPIDEV=m +-CONFIG_SPMI=y +-CONFIG_SPMI_MTK_PMIF=m +-CONFIG_PINCTRL_MAX77620=y +-CONFIG_PINCTRL_RK805=m +-CONFIG_PINCTRL_SINGLE=y +-CONFIG_PINCTRL_OWL=y +-CONFIG_PINCTRL_S700=y +-CONFIG_PINCTRL_S900=y +-CONFIG_PINCTRL_IMX8MM=y +-CONFIG_PINCTRL_IMX8MN=y +-CONFIG_PINCTRL_IMX8MP=y +-CONFIG_PINCTRL_IMX8MQ=y +-CONFIG_PINCTRL_IMX8QM=y +-CONFIG_PINCTRL_IMX8QXP=y +-CONFIG_PINCTRL_IMX8DXL=y +-CONFIG_PINCTRL_IMX8ULP=y +-CONFIG_PINCTRL_IMX93=y +-CONFIG_PINCTRL_MSM=y +-CONFIG_PINCTRL_IPQ8074=y +-CONFIG_PINCTRL_IPQ5018=y +-CONFIG_PINCTRL_IPQ5332=y +-CONFIG_PINCTRL_IPQ6018=y +-CONFIG_PINCTRL_IPQ9574=y +-CONFIG_PINCTRL_MSM8916=y +-CONFIG_PINCTRL_MSM8953=y +-CONFIG_PINCTRL_MSM8976=y +-CONFIG_PINCTRL_MSM8994=y +-CONFIG_PINCTRL_MSM8996=y +-CONFIG_PINCTRL_MSM8998=y +-CONFIG_PINCTRL_QCM2290=y +-CONFIG_PINCTRL_QCS404=y +-CONFIG_PINCTRL_QDF2XXX=y +-CONFIG_PINCTRL_QCOM_SPMI_PMIC=y +-CONFIG_PINCTRL_QDU1000=y +-CONFIG_PINCTRL_SA8775P=y +-CONFIG_PINCTRL_SC7180=y +-CONFIG_PINCTRL_SC7280=y +-CONFIG_PINCTRL_SC7280_LPASS_LPI=m +-CONFIG_PINCTRL_SC8180X=y +-CONFIG_PINCTRL_SC8280XP=y +-CONFIG_PINCTRL_SDM660=y +-CONFIG_PINCTRL_SDM670=y +-CONFIG_PINCTRL_SDM845=y +-CONFIG_PINCTRL_SM6115=y +-CONFIG_PINCTRL_SM6125=y +-CONFIG_PINCTRL_SM6350=y +-CONFIG_PINCTRL_SM6375=y +-CONFIG_PINCTRL_SM8150=y +-CONFIG_PINCTRL_SM8250=y +-CONFIG_PINCTRL_SM8250_LPASS_LPI=m +-CONFIG_PINCTRL_SM8350=y +-CONFIG_PINCTRL_SM8450=y +-CONFIG_PINCTRL_SM8450_LPASS_LPI=m +-CONFIG_PINCTRL_SC8280XP_LPASS_LPI=m +-CONFIG_PINCTRL_SM8550=y +-CONFIG_PINCTRL_SM8550_LPASS_LPI=m +-CONFIG_PINCTRL_LPASS_LPI=m +-CONFIG_GPIO_ALTERA=m +-CONFIG_GPIO_DAVINCI=y +-CONFIG_GPIO_DWAPB=y +-CONFIG_GPIO_MB86S7X=y +-CONFIG_GPIO_MPC8XXX=y +-CONFIG_GPIO_MXC=y +-CONFIG_GPIO_PL061=y +-CONFIG_GPIO_RCAR=y +-CONFIG_GPIO_UNIPHIER=y +-CONFIG_GPIO_VISCONTI=y +-CONFIG_GPIO_WCD934X=m +-CONFIG_GPIO_XGENE=y +-CONFIG_GPIO_XGENE_SB=y +-CONFIG_GPIO_MAX732X=y +-CONFIG_GPIO_PCA953X=y +-CONFIG_GPIO_PCA953X_IRQ=y +-CONFIG_GPIO_BD9571MWV=m +-CONFIG_GPIO_MAX77620=y +-CONFIG_GPIO_SL28CPLD=m +-CONFIG_GPIO_SYSCON=y +-CONFIG_POWER_RESET_MSM=y +-CONFIG_POWER_RESET_QCOM_PON=m +-CONFIG_POWER_RESET_XGENE=y +-CONFIG_POWER_RESET_SYSCON=y +-CONFIG_POWER_RESET_SYSCON_POWEROFF=y +-CONFIG_SYSCON_REBOOT_MODE=y +-CONFIG_NVMEM_REBOOT_MODE=m +-CONFIG_BATTERY_SBS=m +-CONFIG_BATTERY_BQ27XXX=y +-CONFIG_BATTERY_MAX17042=m +-CONFIG_CHARGER_MT6360=m +-CONFIG_CHARGER_BQ25890=m +-CONFIG_CHARGER_BQ25980=m +-CONFIG_CHARGER_RK817=m +-CONFIG_SENSORS_ARM_SCMI=y +-CONFIG_SENSORS_ARM_SCPI=y +-CONFIG_SENSORS_GPIO_FAN=m +-CONFIG_SENSORS_JC42=m +-CONFIG_SENSORS_LM75=m +-CONFIG_SENSORS_LM90=m +-CONFIG_SENSORS_PWM_FAN=m +-CONFIG_SENSORS_RASPBERRYPI_HWMON=m +-CONFIG_SENSORS_SL28CPLD=m +-CONFIG_SENSORS_INA2XX=m +-CONFIG_SENSORS_INA3221=m +-CONFIG_THERMAL_GOV_POWER_ALLOCATOR=y +-CONFIG_CPU_THERMAL=y +-CONFIG_DEVFREQ_THERMAL=y +-CONFIG_THERMAL_EMULATION=y +-CONFIG_IMX_SC_THERMAL=m +-CONFIG_IMX8MM_THERMAL=m +-CONFIG_QORIQ_THERMAL=m +-CONFIG_K3_THERMAL=m +-CONFIG_SUN8I_THERMAL=y +-CONFIG_ROCKCHIP_THERMAL=m +-CONFIG_RCAR_THERMAL=y +-CONFIG_RCAR_GEN3_THERMAL=y +-CONFIG_RZG2L_THERMAL=y +-CONFIG_ARMADA_THERMAL=y +-CONFIG_BCM2711_THERMAL=m +-CONFIG_BCM2835_THERMAL=m +-CONFIG_BRCMSTB_THERMAL=m +-CONFIG_EXYNOS_THERMAL=y +-CONFIG_TEGRA_SOCTHERM=m +-CONFIG_TEGRA_BPMP_THERMAL=m +-CONFIG_GENERIC_ADC_THERMAL=m +-CONFIG_QCOM_TSENS=y +-CONFIG_QCOM_SPMI_ADC_TM5=m +-CONFIG_QCOM_SPMI_TEMP_ALARM=m +-CONFIG_QCOM_LMH=m +-CONFIG_UNIPHIER_THERMAL=y +-CONFIG_WATCHDOG=y +-CONFIG_SL28CPLD_WATCHDOG=m +-CONFIG_ARM_SP805_WATCHDOG=y +-CONFIG_ARM_SBSA_WATCHDOG=y +-CONFIG_S3C2410_WATCHDOG=y +-CONFIG_DW_WATCHDOG=y +-CONFIG_SUNXI_WATCHDOG=m +-CONFIG_NPCM7XX_WATCHDOG=y +-CONFIG_IMX2_WDT=y +-CONFIG_IMX_SC_WDT=m +-CONFIG_IMX7ULP_WDT=m +-CONFIG_QCOM_WDT=m +-CONFIG_MESON_GXBB_WATCHDOG=m +-CONFIG_MESON_WATCHDOG=m +-CONFIG_ARM_SMC_WATCHDOG=y +-CONFIG_RENESAS_WDT=y +-CONFIG_RENESAS_RZG2LWDT=y +-CONFIG_UNIPHIER_WATCHDOG=y +-CONFIG_PM8916_WATCHDOG=m +-CONFIG_BCM2835_WDT=y +-CONFIG_BCM7038_WDT=m +-CONFIG_K3_RTI_WATCHDOG=m +-CONFIG_MFD_ALTERA_SYSMGR=y +-CONFIG_MFD_BD9571MWV=y +-CONFIG_MFD_AXP20X_I2C=y +-CONFIG_MFD_AXP20X_RSB=y +-CONFIG_MFD_EXYNOS_LPASS=m +-CONFIG_MFD_HI6421_PMIC=y +-CONFIG_MFD_HI655X_PMIC=y +-CONFIG_MFD_MAX77620=y +-CONFIG_MFD_MT6360=y +-CONFIG_MFD_MT6397=y +-CONFIG_MFD_SPMI_PMIC=y +-CONFIG_MFD_RK8XX_I2C=y +-CONFIG_MFD_RK8XX_SPI=y +-CONFIG_MFD_SEC_CORE=y +-CONFIG_MFD_SL28CPLD=y +-CONFIG_RZ_MTU3=y +-CONFIG_MFD_TPS65219=y +-CONFIG_MFD_TI_AM335X_TSCADC=m +-CONFIG_MFD_ROHM_BD718XX=y +-CONFIG_MFD_WCD934X=m +-CONFIG_REGULATOR_FIXED_VOLTAGE=y +-CONFIG_REGULATOR_AXP20X=y +-CONFIG_REGULATOR_BD718XX=y +-CONFIG_REGULATOR_BD9571MWV=y +-CONFIG_REGULATOR_CROS_EC=y +-CONFIG_REGULATOR_FAN53555=y +-CONFIG_REGULATOR_GPIO=y +-CONFIG_REGULATOR_HI6421V530=y +-CONFIG_REGULATOR_HI655X=y +-CONFIG_REGULATOR_MAX77620=y +-CONFIG_REGULATOR_MAX8973=y +-CONFIG_REGULATOR_MP8859=y +-CONFIG_REGULATOR_MT6315=m +-CONFIG_REGULATOR_MT6357=y +-CONFIG_REGULATOR_MT6358=y +-CONFIG_REGULATOR_MT6359=y +-CONFIG_REGULATOR_MT6360=y +-CONFIG_REGULATOR_MT6397=y +-CONFIG_REGULATOR_PCA9450=y +-CONFIG_REGULATOR_PF8X00=y +-CONFIG_REGULATOR_PFUZE100=y +-CONFIG_REGULATOR_PWM=y +-CONFIG_REGULATOR_QCOM_RPMH=y +-CONFIG_REGULATOR_QCOM_SMD_RPM=y +-CONFIG_REGULATOR_QCOM_SPMI=y +-CONFIG_REGULATOR_RAA215300=y +-CONFIG_REGULATOR_RK808=y +-CONFIG_REGULATOR_S2MPS11=y +-CONFIG_REGULATOR_TPS65132=m +-CONFIG_REGULATOR_TPS65219=y +-CONFIG_REGULATOR_VCTRL=m +-CONFIG_RC_CORE=m +-CONFIG_RC_DECODERS=y +-CONFIG_RC_DEVICES=y +-CONFIG_IR_GPIO_CIR=m +-CONFIG_IR_MESON=m +-CONFIG_IR_SUNXI=m +-CONFIG_MEDIA_SUPPORT=m +-CONFIG_MEDIA_CAMERA_SUPPORT=y +-CONFIG_MEDIA_ANALOG_TV_SUPPORT=y +-CONFIG_MEDIA_DIGITAL_TV_SUPPORT=y +-CONFIG_MEDIA_SDR_SUPPORT=y +-CONFIG_MEDIA_PLATFORM_SUPPORT=y +-# CONFIG_DVB_NET is not set +-CONFIG_MEDIA_USB_SUPPORT=y +-CONFIG_USB_VIDEO_CLASS=m +-CONFIG_V4L_PLATFORM_DRIVERS=y +-CONFIG_SDR_PLATFORM_DRIVERS=y +-CONFIG_V4L_MEM2MEM_DRIVERS=y +-CONFIG_VIDEO_MEDIATEK_JPEG=m +-CONFIG_VIDEO_MEDIATEK_VCODEC=m +-CONFIG_VIDEO_IMX7_CSI=m +-CONFIG_VIDEO_IMX_MIPI_CSIS=m +-CONFIG_VIDEO_IMX8_ISI=m +-CONFIG_VIDEO_IMX8_ISI_M2M=y +-CONFIG_VIDEO_QCOM_CAMSS=m +-CONFIG_VIDEO_QCOM_VENUS=m +-CONFIG_VIDEO_RCAR_ISP=m +-CONFIG_VIDEO_RCAR_CSI2=m +-CONFIG_VIDEO_RCAR_VIN=m +-CONFIG_VIDEO_RZG2L_CSI2=m +-CONFIG_VIDEO_RZG2L_CRU=m +-CONFIG_VIDEO_RENESAS_FCP=m +-CONFIG_VIDEO_RENESAS_FDP1=m +-CONFIG_VIDEO_RENESAS_VSP1=m +-CONFIG_VIDEO_RCAR_DRIF=m +-CONFIG_VIDEO_SAMSUNG_EXYNOS_GSC=m +-CONFIG_VIDEO_SAMSUNG_S5P_JPEG=m +-CONFIG_VIDEO_SAMSUNG_S5P_MFC=m +-CONFIG_VIDEO_SUN6I_CSI=m +-CONFIG_VIDEO_HANTRO=m +-CONFIG_VIDEO_IMX219=m +-CONFIG_VIDEO_IMX412=m +-CONFIG_VIDEO_OV5640=m +-CONFIG_VIDEO_OV5645=m +-CONFIG_DRM=m +-CONFIG_DRM_I2C_NXP_TDA998X=m +-CONFIG_DRM_HDLCD=m +-CONFIG_DRM_MALI_DISPLAY=m +-CONFIG_DRM_KOMEDA=m +-CONFIG_DRM_NOUVEAU=m +-CONFIG_DRM_EXYNOS=m +-CONFIG_DRM_EXYNOS5433_DECON=y +-CONFIG_DRM_EXYNOS7_DECON=y +-CONFIG_DRM_EXYNOS_DSI=y +-# CONFIG_DRM_EXYNOS_DP is not set +-CONFIG_DRM_EXYNOS_HDMI=y +-CONFIG_DRM_EXYNOS_MIC=y +-CONFIG_DRM_ROCKCHIP=m +-CONFIG_ROCKCHIP_VOP2=y +-CONFIG_ROCKCHIP_ANALOGIX_DP=y +-CONFIG_ROCKCHIP_CDN_DP=y +-CONFIG_ROCKCHIP_DW_HDMI=y +-CONFIG_ROCKCHIP_DW_MIPI_DSI=y +-CONFIG_ROCKCHIP_INNO_HDMI=y +-CONFIG_ROCKCHIP_LVDS=y +-CONFIG_DRM_RCAR_DU=m +-CONFIG_DRM_RCAR_DW_HDMI=m +-CONFIG_DRM_RCAR_MIPI_DSI=m +-CONFIG_DRM_RZG2L_MIPI_DSI=m +-CONFIG_DRM_SUN4I=m +-CONFIG_DRM_SUN6I_DSI=m +-CONFIG_DRM_SUN8I_DW_HDMI=m +-CONFIG_DRM_SUN8I_MIXER=m +-CONFIG_DRM_MSM=m +-CONFIG_DRM_TEGRA=m +-CONFIG_DRM_PANEL_BOE_TV101WUM_NL6=m +-CONFIG_DRM_PANEL_LVDS=m +-CONFIG_DRM_PANEL_SIMPLE=m +-CONFIG_DRM_PANEL_EDP=m +-CONFIG_DRM_PANEL_MANTIX_MLAF057WE51=m +-CONFIG_DRM_PANEL_RAYDIUM_RM67191=m +-CONFIG_DRM_PANEL_SITRONIX_ST7703=m +-CONFIG_DRM_PANEL_TRULY_NT35597_WQXGA=m +-CONFIG_DRM_PANEL_VISIONOX_VTDR6130=m +-CONFIG_DRM_LONTIUM_LT8912B=m +-CONFIG_DRM_LONTIUM_LT9611=m +-CONFIG_DRM_LONTIUM_LT9611UXC=m +-CONFIG_DRM_ITE_IT66121=m +-CONFIG_DRM_NWL_MIPI_DSI=m +-CONFIG_DRM_PARADE_PS8640=m +-CONFIG_DRM_SII902X=m +-CONFIG_DRM_SIMPLE_BRIDGE=m +-CONFIG_DRM_THINE_THC63LVD1024=m +-CONFIG_DRM_TOSHIBA_TC358768=m +-CONFIG_DRM_TI_TFP410=m +-CONFIG_DRM_TI_SN65DSI83=m +-CONFIG_DRM_TI_SN65DSI86=m +-CONFIG_DRM_ANALOGIX_ANX7625=m +-CONFIG_DRM_I2C_ADV7511=m +-CONFIG_DRM_I2C_ADV7511_AUDIO=y +-CONFIG_DRM_CDNS_MHDP8546=m +-CONFIG_DRM_DW_HDMI_AHB_AUDIO=m +-CONFIG_DRM_DW_HDMI_CEC=m +-CONFIG_DRM_IMX_DCSS=m +-CONFIG_DRM_V3D=m +-CONFIG_DRM_VC4=m +-CONFIG_DRM_ETNAVIV=m +-CONFIG_DRM_HISI_HIBMC=m +-CONFIG_DRM_HISI_KIRIN=m +-CONFIG_DRM_MEDIATEK=m +-CONFIG_DRM_MEDIATEK_HDMI=m +-CONFIG_DRM_MXSFB=m +-CONFIG_DRM_MESON=m +-CONFIG_DRM_IMX_LCDIF=m +-CONFIG_DRM_PL111=m +-CONFIG_DRM_LIMA=m +-CONFIG_DRM_PANFROST=m +-CONFIG_DRM_TIDSS=m +-CONFIG_FB=y +-CONFIG_FB_MODE_HELPERS=y +-CONFIG_FB_EFI=y +-CONFIG_BACKLIGHT_PWM=m +-CONFIG_BACKLIGHT_LP855X=m +-CONFIG_LOGO=y +-# CONFIG_LOGO_LINUX_MONO is not set +-# CONFIG_LOGO_LINUX_VGA16 is not set +-CONFIG_SOUND=y +-CONFIG_SND=y +-CONFIG_SND_ALOOP=m +-CONFIG_SND_HDA_TEGRA=m +-CONFIG_SND_HDA_CODEC_HDMI=m +-CONFIG_SND_SOC=y +-CONFIG_SND_BCM2835_SOC_I2S=m +-CONFIG_SND_SOC_FSL_ASRC=m +-CONFIG_SND_SOC_FSL_MICFIL=m +-CONFIG_SND_SOC_FSL_EASRC=m +-CONFIG_SND_IMX_SOC=m +-CONFIG_SND_SOC_IMX_SGTL5000=m +-CONFIG_SND_SOC_IMX_SPDIF=m +-CONFIG_SND_SOC_FSL_ASOC_CARD=m +-CONFIG_SND_SOC_IMX_AUDMIX=m +-CONFIG_SND_SOC_MT8183=m +-CONFIG_SND_SOC_MT8183_MT6358_TS3A227E_MAX98357A=m +-CONFIG_SND_SOC_MT8183_DA7219_MAX98357A=m +-CONFIG_SND_SOC_MT8192=m +-CONFIG_SND_SOC_MT8192_MT6359_RT1015_RT5682=m +-CONFIG_SND_MESON_AXG_SOUND_CARD=m +-CONFIG_SND_MESON_GX_SOUND_CARD=m +-CONFIG_SND_SOC_QCOM=m +-CONFIG_SND_SOC_APQ8016_SBC=m +-CONFIG_SND_SOC_MSM8996=m +-CONFIG_SND_SOC_SDM845=m +-CONFIG_SND_SOC_SM8250=m +-CONFIG_SND_SOC_SC7180=m +-CONFIG_SND_SOC_SC7280=m +-CONFIG_SND_SOC_ROCKCHIP=m +-CONFIG_SND_SOC_ROCKCHIP_I2S_TDM=m +-CONFIG_SND_SOC_ROCKCHIP_SPDIF=m +-CONFIG_SND_SOC_ROCKCHIP_RT5645=m +-CONFIG_SND_SOC_RK3399_GRU_SOUND=m +-CONFIG_SND_SOC_SAMSUNG=y +-CONFIG_SND_SOC_RCAR=m +-CONFIG_SND_SOC_RZ=m +-CONFIG_SND_SUN8I_CODEC=m +-CONFIG_SND_SUN8I_CODEC_ANALOG=m +-CONFIG_SND_SUN50I_CODEC_ANALOG=m +-CONFIG_SND_SUN4I_I2S=m +-CONFIG_SND_SUN4I_SPDIF=m +-CONFIG_SND_SOC_TEGRA=m +-CONFIG_SND_SOC_TEGRA210_AHUB=m +-CONFIG_SND_SOC_TEGRA210_DMIC=m +-CONFIG_SND_SOC_TEGRA210_I2S=m +-CONFIG_SND_SOC_TEGRA210_OPE=m +-CONFIG_SND_SOC_TEGRA186_ASRC=m +-CONFIG_SND_SOC_TEGRA186_DSPK=m +-CONFIG_SND_SOC_TEGRA210_ADMAIF=m +-CONFIG_SND_SOC_TEGRA210_MVC=m +-CONFIG_SND_SOC_TEGRA210_SFC=m +-CONFIG_SND_SOC_TEGRA210_AMX=m +-CONFIG_SND_SOC_TEGRA210_ADX=m +-CONFIG_SND_SOC_TEGRA210_MIXER=m +-CONFIG_SND_SOC_TEGRA_AUDIO_GRAPH_CARD=m +-CONFIG_SND_SOC_DAVINCI_MCASP=m +-CONFIG_SND_SOC_AK4613=m +-CONFIG_SND_SOC_DA7213=m +-CONFIG_SND_SOC_ES7134=m +-CONFIG_SND_SOC_ES7241=m +-CONFIG_SND_SOC_ES8316=m +-CONFIG_SND_SOC_GTM601=m +-CONFIG_SND_SOC_MSM8916_WCD_ANALOG=m +-CONFIG_SND_SOC_MSM8916_WCD_DIGITAL=m +-CONFIG_SND_SOC_PCM3168A_I2C=m +-CONFIG_SND_SOC_RK817=m +-CONFIG_SND_SOC_RT5640=m +-CONFIG_SND_SOC_J721E_EVM=m +-CONFIG_SND_SOC_RT5659=m +-CONFIG_SND_SOC_SIMPLE_AMPLIFIER=m +-CONFIG_SND_SOC_SIMPLE_MUX=m +-CONFIG_SND_SOC_TAS2552=m +-CONFIG_SND_SOC_TAS571X=m +-CONFIG_SND_SOC_TLV320AIC32X4_I2C=m +-CONFIG_SND_SOC_TLV320AIC3X_I2C=m +-CONFIG_SND_SOC_WCD9335=m +-CONFIG_SND_SOC_WCD934X=m +-CONFIG_SND_SOC_WM8524=m +-CONFIG_SND_SOC_WM8904=m +-CONFIG_SND_SOC_WM8960=m +-CONFIG_SND_SOC_WM8962=m +-CONFIG_SND_SOC_WM8978=m +-CONFIG_SND_SOC_WSA881X=m +-CONFIG_SND_SOC_NAU8822=m +-CONFIG_SND_SOC_LPASS_WSA_MACRO=m +-CONFIG_SND_SOC_LPASS_VA_MACRO=m +-CONFIG_SND_SOC_LPASS_RX_MACRO=m +-CONFIG_SND_SOC_LPASS_TX_MACRO=m +-CONFIG_SND_SIMPLE_CARD=m +-CONFIG_SND_AUDIO_GRAPH_CARD=m +-CONFIG_SND_AUDIO_GRAPH_CARD2=m +-CONFIG_HID_MULTITOUCH=m +-CONFIG_I2C_HID_ACPI=m +-CONFIG_I2C_HID_OF=m +-CONFIG_USB=y +-CONFIG_USB_OTG=y +-CONFIG_USB_XHCI_HCD=y +-CONFIG_USB_XHCI_PCI_RENESAS=m +-CONFIG_USB_XHCI_RZV2M=y +-CONFIG_USB_XHCI_TEGRA=y +-CONFIG_USB_BRCMSTB=m +-CONFIG_USB_EHCI_HCD=y +-CONFIG_USB_EHCI_EXYNOS=y +-CONFIG_USB_EHCI_HCD_PLATFORM=y +-CONFIG_USB_OHCI_HCD=y +-CONFIG_USB_OHCI_EXYNOS=y +-CONFIG_USB_OHCI_HCD_PLATFORM=y +-CONFIG_USB_RENESAS_USBHS_HCD=m +-CONFIG_USB_RENESAS_USBHS=m +-CONFIG_USB_ACM=m +-CONFIG_USB_STORAGE=y +-CONFIG_USB_CDNS_SUPPORT=m +-CONFIG_USB_CDNS3=m +-CONFIG_USB_CDNS3_GADGET=y +-CONFIG_USB_CDNS3_HOST=y +-CONFIG_USB_MTU3=y +-CONFIG_USB_MUSB_HDRC=y +-CONFIG_USB_MUSB_SUNXI=y +-CONFIG_USB_DWC3=y +-CONFIG_USB_DWC2=y +-CONFIG_USB_CHIPIDEA=y +-CONFIG_USB_CHIPIDEA_UDC=y +-CONFIG_USB_CHIPIDEA_HOST=y +-CONFIG_USB_ISP1760=y +-CONFIG_USB_SERIAL=m +-CONFIG_USB_SERIAL_CP210X=m +-CONFIG_USB_SERIAL_FTDI_SIO=m +-CONFIG_USB_SERIAL_OPTION=m +-CONFIG_USB_QCOM_EUD=m +-CONFIG_USB_HSIC_USB3503=y +-CONFIG_USB_ONBOARD_HUB=m +-CONFIG_NOP_USB_XCEIV=y +-CONFIG_USB_GADGET=y +-CONFIG_USB_RENESAS_USBHS_UDC=m +-CONFIG_USB_RZV2M_USB3DRD=y +-CONFIG_USB_RENESAS_USB3=m +-CONFIG_USB_TEGRA_XUDC=m +-CONFIG_USB_CONFIGFS=m +-CONFIG_USB_CONFIGFS_SERIAL=y +-CONFIG_USB_CONFIGFS_ACM=y +-CONFIG_USB_CONFIGFS_OBEX=y +-CONFIG_USB_CONFIGFS_NCM=y +-CONFIG_USB_CONFIGFS_ECM=y +-CONFIG_USB_CONFIGFS_ECM_SUBSET=y +-CONFIG_USB_CONFIGFS_RNDIS=y +-CONFIG_USB_CONFIGFS_EEM=y +-CONFIG_USB_CONFIGFS_MASS_STORAGE=y +-CONFIG_USB_CONFIGFS_F_FS=y +-CONFIG_TYPEC=m +-CONFIG_TYPEC_TCPM=m +-CONFIG_TYPEC_TCPCI=m +-CONFIG_TYPEC_FUSB302=m +-CONFIG_TYPEC_TPS6598X=m +-CONFIG_TYPEC_HD3SS3220=m +-CONFIG_TYPEC_UCSI=m +-CONFIG_TYPEC_MUX_FSA4480=m +-CONFIG_UCSI_CCG=m +-CONFIG_TYPEC_MUX_GPIO_SBU=m +-CONFIG_MMC=y +-CONFIG_MMC_BLOCK_MINORS=32 +-CONFIG_MMC_ARMMMCI=y +-CONFIG_MMC_SDHCI=y +-CONFIG_MMC_SDHCI_ACPI=y +-CONFIG_MMC_SDHCI_PLTFM=y +-CONFIG_MMC_SDHCI_OF_ARASAN=y +-CONFIG_MMC_SDHCI_OF_ESDHC=y +-CONFIG_MMC_SDHCI_OF_DWCMSHC=y +-CONFIG_MMC_SDHCI_OF_SPARX5=y +-CONFIG_MMC_SDHCI_CADENCE=y +-CONFIG_MMC_SDHCI_ESDHC_IMX=y +-CONFIG_MMC_SDHCI_TEGRA=y +-CONFIG_MMC_SDHCI_F_SDH30=y +-CONFIG_MMC_MESON_GX=y +-CONFIG_MMC_SDHCI_MSM=y +-CONFIG_MMC_SPI=y +-CONFIG_MMC_SDHI=y +-CONFIG_MMC_UNIPHIER=y +-CONFIG_MMC_DW=y +-CONFIG_MMC_DW_EXYNOS=y +-CONFIG_MMC_DW_HI3798CV200=y +-CONFIG_MMC_DW_K3=y +-CONFIG_MMC_DW_ROCKCHIP=y +-CONFIG_MMC_SUNXI=y +-CONFIG_MMC_BCM2835=y +-CONFIG_MMC_MTK=y +-CONFIG_MMC_SDHCI_XENON=y +-CONFIG_MMC_SDHCI_AM654=y +-CONFIG_MMC_OWL=y +-CONFIG_SCSI_UFSHCD=y +-CONFIG_SCSI_UFS_BSG=y +-CONFIG_SCSI_UFSHCD_PLATFORM=y +-CONFIG_SCSI_UFS_CDNS_PLATFORM=m +-CONFIG_SCSI_UFS_QCOM=m +-CONFIG_SCSI_UFS_HISI=y +-CONFIG_SCSI_UFS_RENESAS=m +-CONFIG_SCSI_UFS_TI_J721E=m +-CONFIG_SCSI_UFS_EXYNOS=y +-CONFIG_NEW_LEDS=y +-CONFIG_LEDS_CLASS=y +-CONFIG_LEDS_CLASS_MULTICOLOR=m +-CONFIG_LEDS_LM3692X=m +-CONFIG_LEDS_PCA9532=m +-CONFIG_LEDS_GPIO=y +-CONFIG_LEDS_PWM=y +-CONFIG_LEDS_SYSCON=y +-CONFIG_LEDS_QCOM_LPG=m +-CONFIG_LEDS_TRIGGER_TIMER=y +-CONFIG_LEDS_TRIGGER_DISK=y +-CONFIG_LEDS_TRIGGER_HEARTBEAT=y +-CONFIG_LEDS_TRIGGER_CPU=y +-CONFIG_LEDS_TRIGGER_DEFAULT_ON=y +-CONFIG_LEDS_TRIGGER_PANIC=y +-CONFIG_EDAC=y +-CONFIG_EDAC_GHES=y +-CONFIG_EDAC_LAYERSCAPE=m +-CONFIG_RTC_CLASS=y +-CONFIG_RTC_DRV_DS1307=m +-CONFIG_RTC_DRV_HYM8563=m +-CONFIG_RTC_DRV_MAX77686=y +-CONFIG_RTC_DRV_RK808=m +-CONFIG_RTC_DRV_ISL1208=m +-CONFIG_RTC_DRV_PCF85063=m +-CONFIG_RTC_DRV_PCF85363=m +-CONFIG_RTC_DRV_M41T80=m +-CONFIG_RTC_DRV_BQ32K=m +-CONFIG_RTC_DRV_RX8581=m +-CONFIG_RTC_DRV_RV3028=m +-CONFIG_RTC_DRV_RV8803=m +-CONFIG_RTC_DRV_S5M=y +-CONFIG_RTC_DRV_DS3232=y +-CONFIG_RTC_DRV_PCF2127=m +-CONFIG_RTC_DRV_EFI=y +-CONFIG_RTC_DRV_CROS_EC=y +-CONFIG_RTC_DRV_FSL_FTM_ALARM=m +-CONFIG_RTC_DRV_S3C=y +-CONFIG_RTC_DRV_PL031=y +-CONFIG_RTC_DRV_SUN6I=y +-CONFIG_RTC_DRV_ARMADA38X=y +-CONFIG_RTC_DRV_PM8XXX=m +-CONFIG_RTC_DRV_TEGRA=y +-CONFIG_RTC_DRV_SNVS=m +-CONFIG_RTC_DRV_BBNSM=m +-CONFIG_RTC_DRV_IMX_SC=m +-CONFIG_RTC_DRV_MT6397=m +-CONFIG_RTC_DRV_XGENE=y +-CONFIG_RTC_DRV_TI_K3=m +-CONFIG_DMADEVICES=y +-CONFIG_DMA_BCM2835=y +-CONFIG_DMA_SUN6I=m +-CONFIG_FSL_EDMA=y +-CONFIG_IMX_SDMA=m +-CONFIG_K3_DMA=y +-CONFIG_MV_XOR=y +-CONFIG_MV_XOR_V2=y +-CONFIG_OWL_DMA=y +-CONFIG_PL330_DMA=y +-CONFIG_TEGRA186_GPC_DMA=y +-CONFIG_TEGRA20_APB_DMA=y +-CONFIG_TEGRA210_ADMA=m +-CONFIG_QCOM_BAM_DMA=y +-CONFIG_QCOM_GPI_DMA=m +-CONFIG_QCOM_HIDMA_MGMT=y +-CONFIG_QCOM_HIDMA=y +-CONFIG_RCAR_DMAC=y +-CONFIG_RENESAS_USB_DMAC=m +-CONFIG_RZ_DMAC=y +-CONFIG_TI_K3_UDMA=y +-CONFIG_TI_K3_UDMA_GLUE_LAYER=y +-CONFIG_VFIO=y +-CONFIG_VFIO_PCI=y +-CONFIG_VIRTIO_PCI=y +-CONFIG_VIRTIO_BALLOON=y +-CONFIG_VIRTIO_MMIO=y +-CONFIG_XEN_GNTDEV=y +-CONFIG_XEN_GRANT_DEV_ALLOC=y +-CONFIG_STAGING=y +-CONFIG_STAGING_MEDIA=y +-CONFIG_VIDEO_MAX96712=m +-CONFIG_CHROME_PLATFORMS=y +-CONFIG_CROS_EC=y +-CONFIG_CROS_EC_I2C=y +-CONFIG_CROS_EC_RPMSG=m +-CONFIG_CROS_EC_SPI=y +-CONFIG_CROS_EC_CHARDEV=m +-CONFIG_COMMON_CLK_RK808=y +-CONFIG_COMMON_CLK_SCMI=y +-CONFIG_COMMON_CLK_SCPI=y +-CONFIG_COMMON_CLK_CS2000_CP=y +-CONFIG_COMMON_CLK_FSL_SAI=y +-CONFIG_COMMON_CLK_S2MPS11=y +-CONFIG_COMMON_CLK_PWM=y +-CONFIG_COMMON_CLK_RS9_PCIE=y +-CONFIG_COMMON_CLK_VC5=y +-CONFIG_COMMON_CLK_BD718XX=m +-CONFIG_CLK_RASPBERRYPI=m +-CONFIG_CLK_IMX8MM=y +-CONFIG_CLK_IMX8MN=y +-CONFIG_CLK_IMX8MP=y +-CONFIG_CLK_IMX8MQ=y +-CONFIG_CLK_IMX8QXP=y +-CONFIG_CLK_IMX8ULP=y +-CONFIG_CLK_IMX93=y +-CONFIG_TI_SCI_CLK=y +-CONFIG_COMMON_CLK_MT8192_AUDSYS=y +-CONFIG_COMMON_CLK_MT8192_CAMSYS=y +-CONFIG_COMMON_CLK_MT8192_IMGSYS=y +-CONFIG_COMMON_CLK_MT8192_IMP_IIC_WRAP=y +-CONFIG_COMMON_CLK_MT8192_IPESYS=y +-CONFIG_COMMON_CLK_MT8192_MDPSYS=y +-CONFIG_COMMON_CLK_MT8192_MFGCFG=y +-CONFIG_COMMON_CLK_MT8192_MMSYS=y +-CONFIG_COMMON_CLK_MT8192_MSDC=y +-CONFIG_COMMON_CLK_MT8192_SCP_ADSP=y +-CONFIG_COMMON_CLK_MT8192_VDECSYS=y +-CONFIG_COMMON_CLK_MT8192_VENCSYS=y +-CONFIG_COMMON_CLK_QCOM=y +-CONFIG_QCOM_A53PLL=y +-CONFIG_QCOM_CLK_APCS_MSM8916=y +-CONFIG_QCOM_CLK_APCC_MSM8996=y +-CONFIG_QCOM_CLK_SMD_RPM=y +-CONFIG_QCOM_CLK_RPMH=y +-CONFIG_IPQ_APSS_6018=y +-CONFIG_IPQ_GCC_5332=y +-CONFIG_IPQ_APSS_5018=y +-CONFIG_IPQ_GCC_5018=y +-CONFIG_IPQ_GCC_6018=y +-CONFIG_IPQ_GCC_8074=y +-CONFIG_IPQ_GCC_9574=y +-CONFIG_MSM_GCC_8916=y +-CONFIG_MSM_GCC_8994=y +-CONFIG_MSM_GCC_8996=y +-CONFIG_MSM_MMCC_8994=m +-CONFIG_MSM_MMCC_8996=m +-CONFIG_MSM_MMCC_8998=m +-CONFIG_MSM_GCC_8998=y +-CONFIG_QCM_GCC_2290=y +-CONFIG_QCM_DISPCC_2290=m +-CONFIG_QCS_GCC_404=y +-CONFIG_SA_GCC_8775P=y +-CONFIG_SC_DISPCC_8280XP=m +-CONFIG_SA_GPUCC_8775P=m +-CONFIG_SC_GCC_7180=y +-CONFIG_SC_GCC_7280=y +-CONFIG_SC_GCC_8180X=y +-CONFIG_SC_GCC_8280XP=y +-CONFIG_SC_GPUCC_8280XP=m +-CONFIG_SC_LPASSCC_8280XP=m +-CONFIG_SDM_CAMCC_845=m +-CONFIG_SDM_GPUCC_845=y +-CONFIG_SDM_VIDEOCC_845=y +-CONFIG_SDM_DISPCC_845=y +-CONFIG_SDM_LPASSCC_845=m +-CONFIG_SM_CAMCC_8250=m +-CONFIG_SM_DISPCC_6115=m +-CONFIG_SM_DISPCC_8250=y +-CONFIG_SM_DISPCC_8450=m +-CONFIG_SM_DISPCC_8550=m +-CONFIG_SM_GCC_6115=y +-CONFIG_SM_GCC_8350=y +-CONFIG_SM_GCC_8450=y +-CONFIG_SM_GCC_8550=y +-CONFIG_SM_TCSRCC_8550=y +-CONFIG_SM_GPUCC_6115=m +-CONFIG_SM_GPUCC_8150=y +-CONFIG_SM_GPUCC_8250=y +-CONFIG_SM_VIDEOCC_8250=y +-CONFIG_QCOM_HFPLL=y +-CONFIG_CLK_GFM_LPASS_SM8250=m +-CONFIG_CLK_RCAR_USB2_CLOCK_SEL=y +-CONFIG_HWSPINLOCK=y +-CONFIG_HWSPINLOCK_QCOM=y +-CONFIG_TEGRA186_TIMER=y +-CONFIG_RENESAS_OSTM=y +-CONFIG_ARM_MHU=y +-CONFIG_IMX_MBOX=y +-CONFIG_OMAP2PLUS_MBOX=m +-CONFIG_PLATFORM_MHU=y +-CONFIG_BCM2835_MBOX=y +-CONFIG_QCOM_APCS_IPC=y +-CONFIG_QCOM_IPCC=y +-CONFIG_ROCKCHIP_IOMMU=y +-CONFIG_TEGRA_IOMMU_SMMU=y +-CONFIG_ARM_SMMU=y +-CONFIG_ARM_SMMU_V3=y +-CONFIG_MTK_IOMMU=y +-CONFIG_QCOM_IOMMU=y +-CONFIG_REMOTEPROC=y +-CONFIG_IMX_REMOTEPROC=y +-CONFIG_TI_K3_R5_REMOTEPROC=m +-CONFIG_TI_K3_DSP_REMOTEPROC=m +-CONFIG_MTK_SCP=m +-CONFIG_QCOM_Q6V5_ADSP=m +-CONFIG_QCOM_Q6V5_MSS=m +-CONFIG_QCOM_Q6V5_PAS=m +-CONFIG_QCOM_SYSMON=m +-CONFIG_QCOM_WCNSS_PIL=m +-CONFIG_RPMSG_CHAR=m +-CONFIG_RPMSG_CTRL=m +-CONFIG_RPMSG_QCOM_GLINK_RPM=y +-CONFIG_RPMSG_QCOM_GLINK_SMEM=m +-CONFIG_RPMSG_QCOM_SMD=y +-CONFIG_RPMSG_VIRTIO=y +-CONFIG_SOUNDWIRE=m +-CONFIG_SOUNDWIRE_QCOM=m +-CONFIG_OWL_PM_DOMAINS=y +-CONFIG_RASPBERRYPI_POWER=y +-CONFIG_FSL_DPAA=y +-CONFIG_FSL_MC_DPIO=y +-CONFIG_FSL_RCPM=y +-CONFIG_MTK_CMDQ=m +-CONFIG_MTK_DEVAPC=m +-CONFIG_MTK_PMIC_WRAP=y +-CONFIG_MTK_SVS=m +-CONFIG_QCOM_AOSS_QMP=y +-CONFIG_QCOM_COMMAND_DB=y +-CONFIG_QCOM_CPR=y +-CONFIG_QCOM_GENI_SE=y +-CONFIG_QCOM_LLCC=m +-CONFIG_QCOM_OCMEM=m +-CONFIG_QCOM_PMIC_GLINK=m +-CONFIG_QCOM_RMTFS_MEM=m +-CONFIG_QCOM_RPMH=y +-CONFIG_QCOM_RPMHPD=y +-CONFIG_QCOM_RPMPD=y +-CONFIG_QCOM_SMEM=y +-CONFIG_QCOM_SMD_RPM=y +-CONFIG_QCOM_SMP2P=y +-CONFIG_QCOM_SMSM=y +-CONFIG_QCOM_SOCINFO=m +-CONFIG_QCOM_SPM=m +-CONFIG_QCOM_STATS=m +-CONFIG_QCOM_WCNSS_CTRL=m +-CONFIG_QCOM_APR=m +-CONFIG_QCOM_ICC_BWMON=m +-CONFIG_ARCH_R8A77995=y +-CONFIG_ARCH_R8A77990=y +-CONFIG_ARCH_R8A77951=y +-CONFIG_ARCH_R8A77965=y +-CONFIG_ARCH_R8A77960=y +-CONFIG_ARCH_R8A77961=y +-CONFIG_ARCH_R8A779F0=y +-CONFIG_ARCH_R8A77980=y +-CONFIG_ARCH_R8A77970=y +-CONFIG_ARCH_R8A779A0=y +-CONFIG_ARCH_R8A779G0=y +-CONFIG_ARCH_R8A774C0=y +-CONFIG_ARCH_R8A774E1=y +-CONFIG_ARCH_R8A774A1=y +-CONFIG_ARCH_R8A774B1=y +-CONFIG_ARCH_R9A07G043=y +-CONFIG_ARCH_R9A07G044=y +-CONFIG_ARCH_R9A07G054=y +-CONFIG_ARCH_R9A09G011=y +-CONFIG_ROCKCHIP_IODOMAIN=y +-CONFIG_ROCKCHIP_PM_DOMAINS=y +-CONFIG_ARCH_TEGRA_132_SOC=y +-CONFIG_ARCH_TEGRA_210_SOC=y +-CONFIG_ARCH_TEGRA_186_SOC=y +-CONFIG_ARCH_TEGRA_194_SOC=y +-CONFIG_ARCH_TEGRA_234_SOC=y +-CONFIG_TI_SCI_PM_DOMAINS=y +-CONFIG_TI_PRUSS=m +-CONFIG_ARM_IMX_BUS_DEVFREQ=y +-CONFIG_ARM_IMX8M_DDRC_DEVFREQ=m +-CONFIG_ARM_MEDIATEK_CCI_DEVFREQ=m +-CONFIG_EXTCON_PTN5150=m +-CONFIG_EXTCON_USB_GPIO=y +-CONFIG_EXTCON_USBC_CROS_EC=y +-CONFIG_RENESAS_RPCIF=m +-CONFIG_IIO=y +-CONFIG_EXYNOS_ADC=y +-CONFIG_IMX93_ADC=m +-CONFIG_MAX9611=m +-CONFIG_MEDIATEK_MT6577_AUXADC=m +-CONFIG_QCOM_SPMI_VADC=m +-CONFIG_QCOM_SPMI_ADC5=m +-CONFIG_ROCKCHIP_SARADC=m +-CONFIG_RZG2L_ADC=m +-CONFIG_TI_ADS1015=m +-CONFIG_TI_AM335X_ADC=m +-CONFIG_IIO_CROS_EC_SENSORS_CORE=m +-CONFIG_IIO_CROS_EC_SENSORS=m +-CONFIG_IIO_ST_LSM6DSX=m +-CONFIG_IIO_CROS_EC_LIGHT_PROX=m +-CONFIG_SENSORS_ISL29018=m +-CONFIG_VCNL4000=m +-CONFIG_IIO_ST_MAGN_3AXIS=m +-CONFIG_IIO_CROS_EC_BARO=m +-CONFIG_MPL3115=m +-CONFIG_PWM=y +-CONFIG_PWM_BCM2835=m +-CONFIG_PWM_BRCMSTB=m +-CONFIG_PWM_CROS_EC=m +-CONFIG_PWM_IMX27=m +-CONFIG_PWM_MESON=m +-CONFIG_PWM_MTK_DISP=m +-CONFIG_PWM_MEDIATEK=m +-CONFIG_PWM_RCAR=m +-CONFIG_PWM_RENESAS_TPU=m +-CONFIG_PWM_ROCKCHIP=y +-CONFIG_PWM_RZ_MTU3=m +-CONFIG_PWM_SAMSUNG=y +-CONFIG_PWM_SL28CPLD=m +-CONFIG_PWM_SUN4I=m +-CONFIG_PWM_TEGRA=m +-CONFIG_PWM_TIECAP=m +-CONFIG_PWM_TIEHRPWM=m +-CONFIG_PWM_VISCONTI=m +-CONFIG_SL28CPLD_INTC=y +-CONFIG_QCOM_PDC=y +-CONFIG_QCOM_MPM=y +-CONFIG_RESET_IMX7=y +-CONFIG_RESET_QCOM_AOSS=y +-CONFIG_RESET_QCOM_PDC=m +-CONFIG_RESET_RZG2L_USBPHY_CTRL=y +-CONFIG_RESET_TI_SCI=y +-CONFIG_PHY_XGENE=y +-CONFIG_PHY_CAN_TRANSCEIVER=m +-CONFIG_PHY_SUN4I_USB=y +-CONFIG_PHY_CADENCE_TORRENT=m +-CONFIG_PHY_CADENCE_SIERRA=m +-CONFIG_PHY_MIXEL_MIPI_DPHY=m +-CONFIG_PHY_FSL_IMX8M_PCIE=y +-CONFIG_PHY_HI6220_USB=y +-CONFIG_PHY_HISTB_COMBPHY=y +-CONFIG_PHY_HISI_INNO_USB2=y +-CONFIG_PHY_MVEBU_CP110_COMPHY=y +-CONFIG_PHY_MTK_TPHY=y +-CONFIG_PHY_QCOM_EDP=m +-CONFIG_PHY_QCOM_EUSB2_REPEATER=m +-CONFIG_PHY_QCOM_PCIE2=m +-CONFIG_PHY_QCOM_QMP=m +-CONFIG_PHY_QCOM_QUSB2=m +-CONFIG_PHY_QCOM_SNPS_EUSB2=m +-CONFIG_PHY_QCOM_USB_HS=m +-CONFIG_PHY_QCOM_USB_SNPS_FEMTO_V2=m +-CONFIG_PHY_QCOM_USB_HS_28NM=m +-CONFIG_PHY_QCOM_USB_SS=m +-CONFIG_PHY_QCOM_SGMII_ETH=m +-CONFIG_PHY_R8A779F0_ETHERNET_SERDES=y +-CONFIG_PHY_RCAR_GEN3_PCIE=y +-CONFIG_PHY_RCAR_GEN3_USB2=y +-CONFIG_PHY_RCAR_GEN3_USB3=m +-CONFIG_PHY_ROCKCHIP_EMMC=y +-CONFIG_PHY_ROCKCHIP_INNO_HDMI=m +-CONFIG_PHY_ROCKCHIP_INNO_USB2=y +-CONFIG_PHY_ROCKCHIP_INNO_DSIDPHY=m +-CONFIG_PHY_ROCKCHIP_NANENG_COMBO_PHY=m +-CONFIG_PHY_ROCKCHIP_PCIE=m +-CONFIG_PHY_ROCKCHIP_SNPS_PCIE3=y +-CONFIG_PHY_ROCKCHIP_TYPEC=y +-CONFIG_PHY_SAMSUNG_UFS=y +-CONFIG_PHY_UNIPHIER_USB2=y +-CONFIG_PHY_UNIPHIER_USB3=y +-CONFIG_PHY_TEGRA_XUSB=y +-CONFIG_PHY_AM654_SERDES=m +-CONFIG_PHY_J721E_WIZ=m +-CONFIG_ARM_CCI_PMU=m +-CONFIG_ARM_CCN=m +-CONFIG_ARM_CMN=m +-CONFIG_ARM_CORESIGHT_PMU_ARCH_SYSTEM_PMU=m +-CONFIG_ARM_SMMU_V3_PMU=m +-CONFIG_ARM_DSU_PMU=m +-CONFIG_FSL_IMX8_DDR_PMU=m +-CONFIG_QCOM_L2_PMU=y +-CONFIG_QCOM_L3_PMU=y +-CONFIG_ARM_SPE_PMU=m +-CONFIG_ARM_DMC620_PMU=m +-CONFIG_HISI_PMU=y +-CONFIG_NVMEM_LAYOUT_SL28_VPD=m +-CONFIG_NVMEM_IMX_OCOTP=y +-CONFIG_NVMEM_IMX_OCOTP_ELE=m +-CONFIG_NVMEM_IMX_OCOTP_SCU=y +-CONFIG_NVMEM_LAYERSCAPE_SFP=m +-CONFIG_NVMEM_MESON_EFUSE=m +-CONFIG_NVMEM_MTK_EFUSE=y +-CONFIG_NVMEM_QCOM_QFPROM=y +-CONFIG_NVMEM_RMEM=m +-CONFIG_NVMEM_ROCKCHIP_EFUSE=y +-CONFIG_NVMEM_ROCKCHIP_OTP=y +-CONFIG_NVMEM_SNVS_LPGPR=y +-CONFIG_NVMEM_SPMI_SDAM=m +-CONFIG_NVMEM_SUNXI_SID=y +-CONFIG_NVMEM_UNIPHIER_EFUSE=y +-CONFIG_FPGA=y +-CONFIG_FPGA_MGR_ALTERA_CVP=m +-CONFIG_FPGA_MGR_STRATIX10_SOC=m +-CONFIG_FPGA_BRIDGE=m +-CONFIG_ALTERA_FREEZE_BRIDGE=m +-CONFIG_FPGA_REGION=m +-CONFIG_OF_FPGA_REGION=m +-CONFIG_TEE=y +-CONFIG_OPTEE=y +-CONFIG_MUX_GPIO=m +-CONFIG_MUX_MMIO=y +-CONFIG_SLIMBUS=m +-CONFIG_SLIM_QCOM_CTRL=m +-CONFIG_SLIM_QCOM_NGD_CTRL=m +-CONFIG_INTERCONNECT=y +-CONFIG_INTERCONNECT_IMX=y +-CONFIG_INTERCONNECT_IMX8MM=m +-CONFIG_INTERCONNECT_IMX8MN=m +-CONFIG_INTERCONNECT_IMX8MQ=m +-CONFIG_INTERCONNECT_IMX8MP=y +-CONFIG_INTERCONNECT_QCOM=y +-CONFIG_INTERCONNECT_QCOM_MSM8916=m +-CONFIG_INTERCONNECT_QCOM_MSM8996=m +-CONFIG_INTERCONNECT_QCOM_OSM_L3=m +-CONFIG_INTERCONNECT_QCOM_QCM2290=m +-CONFIG_INTERCONNECT_QCOM_QCS404=m +-CONFIG_INTERCONNECT_QCOM_SA8775P=y +-CONFIG_INTERCONNECT_QCOM_SC7180=y +-CONFIG_INTERCONNECT_QCOM_SC7280=y +-CONFIG_INTERCONNECT_QCOM_SC8180X=y +-CONFIG_INTERCONNECT_QCOM_SC8280XP=y +-CONFIG_INTERCONNECT_QCOM_SDM845=y +-CONFIG_INTERCONNECT_QCOM_SM8150=m +-CONFIG_INTERCONNECT_QCOM_SM8250=m +-CONFIG_INTERCONNECT_QCOM_SM8350=m +-CONFIG_INTERCONNECT_QCOM_SM8450=y +-CONFIG_INTERCONNECT_QCOM_SM8550=y +-CONFIG_COUNTER=m +-CONFIG_RZ_MTU3_CNT=m +-CONFIG_HTE=y +-CONFIG_HTE_TEGRA194=y +-CONFIG_HTE_TEGRA194_TEST=m +-CONFIG_EXT2_FS=y +-CONFIG_EXT3_FS=y +-CONFIG_EXT4_FS_POSIX_ACL=y +-CONFIG_BTRFS_FS=m +-CONFIG_BTRFS_FS_POSIX_ACL=y +-CONFIG_FANOTIFY=y +-CONFIG_FANOTIFY_ACCESS_PERMISSIONS=y +-CONFIG_QUOTA=y +-CONFIG_AUTOFS_FS=y +-CONFIG_FUSE_FS=m +-CONFIG_CUSE=m +-CONFIG_OVERLAY_FS=m +-CONFIG_VFAT_FS=y +-CONFIG_TMPFS_POSIX_ACL=y +-CONFIG_HUGETLBFS=y +-CONFIG_CONFIGFS_FS=y +-CONFIG_EFIVAR_FS=y +-CONFIG_SQUASHFS=y +-CONFIG_NFS_FS=y +-CONFIG_NFS_V4=y +-CONFIG_NFS_V4_1=y +-CONFIG_NFS_V4_2=y +-CONFIG_ROOT_NFS=y +-CONFIG_9P_FS=y +-CONFIG_NLS_CODEPAGE_437=y +-CONFIG_NLS_ISO8859_1=y +-CONFIG_SECURITY=y +-CONFIG_CRYPTO_USER=y +-CONFIG_CRYPTO_TEST=m +-CONFIG_CRYPTO_ECHAINIV=y +-CONFIG_CRYPTO_MICHAEL_MIC=m +-CONFIG_CRYPTO_ANSI_CPRNG=y +-CONFIG_CRYPTO_USER_API_RNG=m +-CONFIG_CRYPTO_CHACHA20_NEON=m +-CONFIG_CRYPTO_GHASH_ARM64_CE=y +-CONFIG_CRYPTO_SHA1_ARM64_CE=y +-CONFIG_CRYPTO_SHA2_ARM64_CE=y +-CONFIG_CRYPTO_SHA512_ARM64_CE=m +-CONFIG_CRYPTO_SHA3_ARM64=m +-CONFIG_CRYPTO_SM3_ARM64_CE=m +-CONFIG_CRYPTO_AES_ARM64_CE_BLK=y +-CONFIG_CRYPTO_AES_ARM64_BS=m +-CONFIG_CRYPTO_AES_ARM64_CE_CCM=y +-CONFIG_CRYPTO_CRCT10DIF_ARM64_CE=m +-CONFIG_CRYPTO_DEV_SUN8I_CE=m +-CONFIG_CRYPTO_DEV_FSL_CAAM=m +-CONFIG_CRYPTO_DEV_FSL_DPAA2_CAAM=m +-CONFIG_CRYPTO_DEV_QCE=m +-CONFIG_CRYPTO_DEV_QCOM_RNG=m +-CONFIG_CRYPTO_DEV_CCREE=m +-CONFIG_CRYPTO_DEV_HISI_SEC2=m +-CONFIG_CRYPTO_DEV_HISI_ZIP=m +-CONFIG_CRYPTO_DEV_HISI_HPRE=m +-CONFIG_CRYPTO_DEV_HISI_TRNG=m +-CONFIG_CRYPTO_DEV_SA2UL=m +-CONFIG_DMA_RESTRICTED_POOL=y +-CONFIG_CMA_SIZE_MBYTES=32 +-CONFIG_PRINTK_TIME=y +-CONFIG_DEBUG_KERNEL=y +-CONFIG_DEBUG_INFO_DWARF_TOOLCHAIN_DEFAULT=y +-CONFIG_DEBUG_INFO_REDUCED=y +-CONFIG_MAGIC_SYSRQ=y +-CONFIG_DEBUG_FS=y +-# CONFIG_SCHED_DEBUG is not set +-# CONFIG_DEBUG_PREEMPT is not set +-# CONFIG_FTRACE is not set +-CONFIG_CORESIGHT=m +-CONFIG_CORESIGHT_LINK_AND_SINK_TMC=m +-CONFIG_CORESIGHT_CATU=m +-CONFIG_CORESIGHT_SINK_TPIU=m +-CONFIG_CORESIGHT_SINK_ETBV10=m +-CONFIG_CORESIGHT_STM=m +-CONFIG_CORESIGHT_CPU_DEBUG=m +-CONFIG_CORESIGHT_CTI=m +-CONFIG_MEMTEST=y +diff --git a/arch/arm64/configs/virt.config b/arch/arm64/configs/virt.config +deleted file mode 100644 +index c47c36f8f..000000000 +--- a/arch/arm64/configs/virt.config ++++ /dev/null +@@ -1,61 +0,0 @@ +-# Help: Virtualization guest +-# +-# Base options for platforms +-# +- +-# CONFIG_ARCH_ACTIONS is not set +-# CONFIG_ARCH_SUNXI is not set +-# CONFIG_ARCH_ALPINE is not set +-# CONFIG_ARCH_APPLE is not set +-# CONFIG_ARCH_BCM is not set +-# CONFIG_ARCH_BCM2835 is not set +-# CONFIG_ARCH_BCMBCA is not set +-# CONFIG_ARCH_BCM_IPROC is not set +-# CONFIG_ARCH_BERLIN is not set +-# CONFIG_ARCH_BRCMSTB is not set +-# CONFIG_ARCH_EXYNOS is not set +-# CONFIG_ARCH_K3 is not set +-# CONFIG_ARCH_LAYERSCAPE is not set +-# CONFIG_ARCH_LG1K is not set +-# CONFIG_ARCH_HISI is not set +-# CONFIG_ARCH_KEEMBAY is not set +-# CONFIG_ARCH_MEDIATEK is not set +-# CONFIG_ARCH_MESON is not set +-# CONFIG_ARCH_MVEBU is not set +-# CONFIG_ARCH_NXP is not set +-# CONFIG_ARCH_MXC is not set +-# CONFIG_ARCH_NPCM is not set +-# CONFIG_ARCH_QCOM is not set +-# CONFIG_ARCH_RENESAS is not set +-# CONFIG_ARCH_ROCKCHIP is not set +-# CONFIG_ARCH_S32 is not set +-# CONFIG_ARCH_SEATTLE is not set +-# CONFIG_ARCH_INTEL_SOCFPGA is not set +-# CONFIG_ARCH_SYNQUACER is not set +-# CONFIG_ARCH_TEGRA is not set +-# CONFIG_ARCH_TESLA_FSD is not set +-# CONFIG_ARCH_SPRD is not set +-# CONFIG_ARCH_THUNDER is not set +-# CONFIG_ARCH_THUNDER2 is not set +-# CONFIG_ARCH_UNIPHIER is not set +-# CONFIG_ARCH_VEXPRESS is not set +-# CONFIG_ARCH_VISCONTI is not set +-# CONFIG_ARCH_XGENE is not set +-# CONFIG_ARCH_ZYNQMP is not set +- +-# +-# Subsystems which can't be used in mach-virt +-# +-# CONFIG_CHROME_PLATFORMS is not set +-# CONFIG_EXTCON is not set +-# CONFIG_IIO is not set +-# CONFIG_MTD is not set +-# CONFIG_NEW_LEDS is not set +-# CONFIG_PWM is not set +-# CONFIG_REGULATOR is not set +-# CONFIG_SLIMBUS is not set +-# CONFIG_SND_SOC is not set +-# CONFIG_SOUNDWIRE is not set +-# CONFIG_SPI is not set +-# CONFIG_SURFACE_PLATFORMS is not set +-# CONFIG_THERMAL is not set +diff --git a/arch/arm64/include/asm/cputype.h b/arch/arm64/include/asm/cputype.h +index 52f076afe..18f70359a 100644 +--- a/arch/arm64/include/asm/cputype.h ++++ b/arch/arm64/include/asm/cputype.h +@@ -62,6 +62,7 @@ + #define ARM_CPU_IMP_APPLE 0x61 + #define ARM_CPU_IMP_AMPERE 0xC0 + #define ARM_CPU_IMP_MICROSOFT 0x6D ++#define ARM_CPU_IMP_PHYTIUM 0x70 + + #define ARM_CPU_PART_AEM_V8 0xD0F + #define ARM_CPU_PART_FOUNDATION 0xD00 +@@ -136,6 +137,13 @@ + + #define AMPERE_CPU_PART_AMPERE1 0xAC3 + ++#define PHYTIUM_CPU_PART_FTC310 0x660 ++#define PHYTIUM_CPU_PART_FTC660 0x660 ++#define PHYTIUM_CPU_PART_FTC661 0x661 ++#define PHYTIUM_CPU_PART_FTC662 0x662 ++#define PHYTIUM_CPU_PART_FTC663 0x663 ++#define PHYTIUM_CPU_PART_FTC664 0x664 + -+static int hc_alloc_dev(struct usb_hcd *hcd, struct usb_device *udev) -+{ -+ struct HOST_USB_DEVICE *usbDev; -+ struct phytium_cusb *config; -+ struct HOST_CTRL *priv; -+ unsigned long flags = 0; -+ int index; -+ int slot = -EINVAL; + #define MICROSOFT_CPU_PART_AZURE_COBALT_100 0xD49 /* Based on r0p0 of ARM Neoverse N2 */ + + #define MIDR_CORTEX_A53 MIDR_CPU_MODEL(ARM_CPU_IMP_ARM, ARM_CPU_PART_CORTEX_A53) +@@ -197,6 +205,12 @@ + #define MIDR_APPLE_M2_AVALANCHE_MAX MIDR_CPU_MODEL(ARM_CPU_IMP_APPLE, APPLE_CPU_PART_M2_AVALANCHE_MAX) + #define MIDR_AMPERE1 MIDR_CPU_MODEL(ARM_CPU_IMP_AMPERE, AMPERE_CPU_PART_AMPERE1) + #define MIDR_MICROSOFT_AZURE_COBALT_100 MIDR_CPU_MODEL(ARM_CPU_IMP_MICROSOFT, MICROSOFT_CPU_PART_AZURE_COBALT_100) ++#define MIDR_PHYTIUM_FTC310 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC310) ++#define MIDR_PHYTIUM_FTC660 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC660) ++#define MIDR_PHYTIUM_FTC661 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC661) ++#define MIDR_PHYTIUM_PS17064 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC662) ++#define MIDR_PHYTIUM_FTC663 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC663) ++#define MIDR_PHYTIUM_FTC664 MIDR_CPU_MODEL(ARM_CPU_IMP_PHYTIUM, PHYTIUM_CPU_PART_FTC664) + + /* Fujitsu Erratum 010001 affects A64FX 1.0 and 1.1, (v0r0 and v1r0) */ + #define MIDR_FUJITSU_ERRATUM_010001 MIDR_FUJITSU_A64FX +diff --git a/arch/arm64/include/asm/ras.h b/arch/arm64/include/asm/ras.h +new file mode 100644 +index 000000000..5453c1f9b +--- /dev/null ++++ b/arch/arm64/include/asm/ras.h +@@ -0,0 +1,13 @@ ++/* SPDX-License-Identifier: GPL-2.0 */ ++/* ++ * ARM64 SEA error recoery support ++ * ++ * Copyright (c) 2019-2023, Phytium Technology Co., Ltd. ++ */ + -+ if (!hcd || !udev) -+ return -EINVAL; ++#ifndef _ASM_RAS_H ++#define _ASM_RAS_H + -+ config = *(struct phytium_cusb **)hcd->hcd_priv; -+ if (!config) -+ return 0; ++extern void sea_notify_process(void); + -+ spin_lock_irqsave(&config->lock, flags); -+ priv = config->host_priv; -+ for (index = 0; index < MAX_SUPPORTED_DEVICES; index++) { -+ if (priv->host_devices_table[index] == NULL) { -+ slot = index; -+ break; -+ } -+ } -+ spin_unlock_irqrestore(&config->lock, flags); ++#endif /*_ASM_RAS_H*/ +diff --git a/arch/arm64/include/asm/thread_info.h b/arch/arm64/include/asm/thread_info.h +index 553d1bc55..c5e3459f1 100644 +--- a/arch/arm64/include/asm/thread_info.h ++++ b/arch/arm64/include/asm/thread_info.h +@@ -64,6 +64,7 @@ void arch_setup_new_exec(void); + #define TIF_UPROBE 4 /* uprobe breakpoint or singlestep */ + #define TIF_MTE_ASYNC_FAULT 5 /* MTE Asynchronous Tag Check Fault */ + #define TIF_NOTIFY_SIGNAL 6 /* signal notifications exist */ ++#define TIF_SEA_NOTIFY 7 /* notify to do an error recovery */ + #define TIF_SYSCALL_TRACE 8 /* syscall trace active */ + #define TIF_SYSCALL_AUDIT 9 /* syscall auditing */ + #define TIF_SYSCALL_TRACEPOINT 10 /* syscall tracepoint for ftrace */ +@@ -85,6 +86,7 @@ void arch_setup_new_exec(void); + #define _TIF_NEED_RESCHED (1 << TIF_NEED_RESCHED) + #define _TIF_NOTIFY_RESUME (1 << TIF_NOTIFY_RESUME) + #define _TIF_FOREIGN_FPSTATE (1 << TIF_FOREIGN_FPSTATE) ++#define _TIF_SEA_NOTIFY (1 << TIF_SEA_NOTIFY) + #define _TIF_SYSCALL_TRACE (1 << TIF_SYSCALL_TRACE) + #define _TIF_SYSCALL_AUDIT (1 << TIF_SYSCALL_AUDIT) + #define _TIF_SYSCALL_TRACEPOINT (1 << TIF_SYSCALL_TRACEPOINT) +@@ -100,7 +102,7 @@ void arch_setup_new_exec(void); + #define _TIF_WORK_MASK (_TIF_NEED_RESCHED | _TIF_SIGPENDING | \ + _TIF_NOTIFY_RESUME | _TIF_FOREIGN_FPSTATE | \ + _TIF_UPROBE | _TIF_MTE_ASYNC_FAULT | \ +- _TIF_NOTIFY_SIGNAL) ++ _TIF_NOTIFY_SIGNAL | _TIF_SEA_NOTIFY) + + #define _TIF_SYSCALL_WORK (_TIF_SYSCALL_TRACE | _TIF_SYSCALL_AUDIT | \ + _TIF_SYSCALL_TRACEPOINT | _TIF_SECCOMP | \ +diff --git a/arch/arm64/kernel/Makefile b/arch/arm64/kernel/Makefile +index d95b3d6b4..eca1f9012 100644 +--- a/arch/arm64/kernel/Makefile ++++ b/arch/arm64/kernel/Makefile +@@ -54,6 +54,7 @@ obj-$(CONFIG_EFI) += efi.o efi-rt-wrapper.o + obj-$(CONFIG_PCI) += pci.o + obj-$(CONFIG_ARMV8_DEPRECATED) += armv8_deprecated.o + obj-$(CONFIG_ACPI) += acpi.o ++obj-$(CONFIG_ARM64_ERR_RECOV) += ras.o + obj-$(CONFIG_ACPI_NUMA) += acpi_numa.o + obj-$(CONFIG_ARM64_ACPI_PARKING_PROTOCOL) += acpi_parking_protocol.o + obj-$(CONFIG_PARAVIRT) += paravirt.o +diff --git a/arch/arm64/kernel/cpufeature.c b/arch/arm64/kernel/cpufeature.c +index 444a73c2e..abb864868 100644 +--- a/arch/arm64/kernel/cpufeature.c ++++ b/arch/arm64/kernel/cpufeature.c +@@ -1686,6 +1686,12 @@ static bool unmap_kernel_at_el0(const struct arm64_cpu_capabilities *entry, + MIDR_ALL_VERSIONS(MIDR_CORTEX_A73), + MIDR_ALL_VERSIONS(MIDR_HISI_TSV110), + MIDR_ALL_VERSIONS(MIDR_NVIDIA_CARMEL), ++ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC310), ++ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC660), ++ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC661), ++ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_PS17064), ++ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC663), ++ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC664), + MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_2XX_GOLD), + MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_2XX_SILVER), + MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_3XX_SILVER), +diff --git a/arch/arm64/kernel/proton-pack.c b/arch/arm64/kernel/proton-pack.c +index 05f40c4e1..5854a5b3d 100644 +--- a/arch/arm64/kernel/proton-pack.c ++++ b/arch/arm64/kernel/proton-pack.c +@@ -160,6 +160,7 @@ static enum mitigation_state spectre_v2_get_cpu_hw_mitigation_state(void) + MIDR_ALL_VERSIONS(MIDR_CORTEX_A55), + MIDR_ALL_VERSIONS(MIDR_BRAHMA_B53), + MIDR_ALL_VERSIONS(MIDR_HISI_TSV110), ++ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC310), + MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_2XX_SILVER), + MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_3XX_SILVER), + MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_4XX_SILVER), +@@ -470,6 +471,7 @@ static enum mitigation_state spectre_v4_get_cpu_hw_mitigation_state(void) + MIDR_ALL_VERSIONS(MIDR_CORTEX_A53), + MIDR_ALL_VERSIONS(MIDR_CORTEX_A55), + MIDR_ALL_VERSIONS(MIDR_BRAHMA_B53), ++ MIDR_ALL_VERSIONS(MIDR_PHYTIUM_FTC310), + MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_3XX_SILVER), + MIDR_ALL_VERSIONS(MIDR_QCOM_KRYO_4XX_SILVER), + { /* sentinel */ }, +diff --git a/arch/arm64/kernel/ras.c b/arch/arm64/kernel/ras.c +new file mode 100644 +index 000000000..bec6c8a73 +--- /dev/null ++++ b/arch/arm64/kernel/ras.c +@@ -0,0 +1,164 @@ ++// SPDX-License-Identifier: GPL-2.0 ++/* ++ * ARM64 SEA error recoery support ++ * ++ * Copyright (c) 2019-2023, Phytium Technology Co., Ltd. ++ */ + -+ if (slot < 0) -+ return -ENOMEM; ++#include ++#include ++#include ++#include ++#include ++#include ++#include + -+ usbDev = kzalloc((sizeof(struct HOST_USB_DEVICE) + -+ config->host_obj->host_epGetPrivateDataSize(priv)), GFP_KERNEL); -+ if (!usbDev) -+ return -ENOMEM; ++#include ++#include ++#include + -+ usbDev->ep0_hep.hcPriv = &((uint8_t *)usbDev)[sizeof(struct HOST_USB_DEVICE)]; -+ usbDev->udev.userExt = (void *)usbDev; -+ usbDev->ld_udev = udev; -+ usbDev->ld_udev->slot_id = slot; -+ usbDev->ep0_hep.desc.bLength = 7; -+ usbDev->ep0_hep.desc.bDescriptorType = USB_DT_ENDPOINT; -+ usbDev->in_ep[0] = &usbDev->ep0_hep; -+ usbDev->out_ep[0] = &usbDev->ep0_hep; -+ INIT_LIST_HEAD(&usbDev->ep0_hep.reqList); ++#include ++#include ++#include + -+ priv->host_devices_table[slot] = usbDev; ++/* ++ * Need to save faulting physical address associated with a process ++ * in the sea ghes handler some place where we can grab it back ++ * later in sea_notify_process() ++ */ ++#define SEA_INFO_MAX 16 + -+ return 1; -+} ++struct sea_info { ++ atomic_t inuse; ++ struct task_struct *t; ++ __u64 paddr; ++} sea_info[SEA_INFO_MAX]; + -+static void hc_free_dev(struct usb_hcd *hcd, struct usb_device *udev) ++static bool sea_save_info(__u64 addr) +{ -+ struct HOST_CTRL *priv; -+ struct HOST_USB_DEVICE *usbDev; -+ struct phytium_cusb *config; -+ int i; -+ -+ if (!hcd || !udev) -+ return; -+ -+ config = *(struct phytium_cusb **)(hcd->hcd_priv); -+ if (!config) -+ return; -+ -+ priv = (struct HOST_CTRL *)config->host_priv; -+ usbDev = priv->host_devices_table[udev->slot_id]; -+ if (!usbDev) -+ return; ++ struct sea_info *si; + -+ usbDev->in_ep[0] = NULL; -+ usbDev->out_ep[0] = NULL; -+ for (i = 1; i < HOST_EP_NUM; i++) { -+ if (usbDev->in_ep[i]) -+ hc_endpoint_disable(hcd, -+ (struct usb_host_endpoint *)usbDev->in_ep[i]->userExt); -+ if (usbDev->out_ep[i]) -+ hc_endpoint_disable(hcd, -+ (struct usb_host_endpoint *)usbDev->out_ep[i]->userExt); ++ for (si = sea_info; si < &sea_info[SEA_INFO_MAX]; si++) { ++ if (atomic_cmpxchg(&si->inuse, 0, 1) == 0) { ++ si->t = current; ++ si->paddr = addr; ++ return true; ++ } + } + -+ priv->host_devices_table[udev->slot_id] = NULL; -+ usbDev->ld_udev->slot_id = 0; -+ usbDev->udev.userExt = (void *)NULL; -+ kfree(usbDev); -+} -+ -+static int hc_reset_device(struct usb_hcd *hcd, struct usb_device *udev) -+{ -+ struct HOST_CTRL *priv; -+ struct HOST_USB_DEVICE *usb_device; -+ struct phytium_cusb *config; -+ -+ if (!hcd || !udev) -+ return -EINVAL; -+ -+ config = *(struct phytium_cusb **)hcd->hcd_priv; -+ priv = (struct HOST_CTRL *)config->host_priv; -+ usb_device = priv->host_devices_table[udev->slot_id]; -+ if (!usb_device) -+ return -ENODEV; -+ -+ usb_device->udev.speed = usb_device->ld_udev->speed; -+ usb_device->udev.devnum = usb_device->ld_udev->devnum; -+ -+ if (USB_SPEED_HIGH == usb_device->udev.speed || USB_SPEED_FULL == usb_device->udev.speed) -+ usb_device->ep0_hep.desc.wMaxPacketSize = 64; -+ else -+ usb_device->ep0_hep.desc.wMaxPacketSize = 8; -+ -+ pr_debug("speed:%d ep0 wMaxPacketSize:%d\n", usb_device->udev.speed, -+ usb_device->ep0_hep.desc.wMaxPacketSize); -+ -+ return 0; -+} -+ -+static int hc_update_device(struct usb_hcd *hcd, struct usb_device *udev) -+{ -+ struct HOST_CTRL *priv; -+ struct HOST_USB_DEVICE *usb_device; -+ struct phytium_cusb *config; -+ -+ if (!hcd || !udev) -+ return -EINVAL; -+ -+ config = *(struct phytium_cusb **)(hcd->hcd_priv); -+ priv = (struct HOST_CTRL *)config->host_priv; -+ -+ usb_device = priv->host_devices_table[udev->slot_id]; -+ if (!usb_device) -+ return -ENODEV; -+ -+ usb_device->udev.devnum = udev->devnum; -+ -+ return 0; ++ pr_err("Too many concurrent recoverable errors\n"); ++ return false; +} + -+static int hc_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev, -+ struct usb_host_endpoint *ep) ++static struct sea_info *sea_find_info(void) +{ -+ return 0; -+} ++ struct sea_info *si; + -+static int hc_drop_endpoint(struct usb_hcd *hcd, struct usb_device *udev, -+ struct usb_host_endpoint *ep) -+{ -+ return 0; ++ for (si = sea_info; si < &sea_info[SEA_INFO_MAX]; si++) ++ if (atomic_read(&si->inuse) && si->t == current) ++ return si; ++ return NULL; +} + -+static int hc_hub_status_data(struct usb_hcd *hcd, char *buf) ++static void sea_clear_info(struct sea_info *si) +{ -+ struct HOST_CTRL *priv; -+ struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; -+ -+ if (!config) -+ return 0; -+ -+ priv = (struct HOST_CTRL *)config->host_priv; -+ if (!priv) -+ return 0; -+ -+ if (priv->portStatus & 0xffff0000) { -+ *buf = 0x02; -+ return 1; -+ } -+ -+ return 0; ++ atomic_set(&si->inuse, 0); +} + -+#ifdef CONFIG_PM -+static int hc_bus_suspend(struct usb_hcd *hcd) ++/* ++ * Called in process context that interrupted by SEA and marked with ++ * TIF_SEA_NOTIFY, just before returning to erroneous userland. ++ * This code is allowed to sleep. ++ * Attempt possible recovery such as calling the high level VM handler to ++ * process any corrupted pages, and kill/signal current process if required. ++ * Action required errors are handled here. ++ */ ++void sea_notify_process(void) +{ -+ unsigned long flags; -+ struct phytium_cusb *config = *(struct phytium_cusb **)(hcd->hcd_priv); -+ -+ if (!config) -+ return 0; -+ -+ spin_lock_irqsave(&config->lock, flags); -+ hcd->state = HC_STATE_SUSPENDED; -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} ++ unsigned long pfn; ++ int fail = 0, flags = MF_ACTION_REQUIRED; ++ struct sea_info *si = sea_find_info(); + -+static int hc_bus_resume(struct usb_hcd *hcd) -+{ -+ unsigned long flags; -+ struct phytium_cusb *config = *(struct phytium_cusb **)(hcd->hcd_priv); ++ if (!si) ++ panic("Lost physical address for consumed uncorrectable error"); + -+ if (!config) -+ return 0; ++ clear_thread_flag(TIF_SEA_NOTIFY); ++ do { ++ pfn = si->paddr >> PAGE_SHIFT; + -+ spin_lock_irqsave(&config->lock, flags); -+ hcd->state = HC_STATE_RESUMING; -+ spin_unlock_irqrestore(&config->lock, flags); -+ return 0; -+} -+#endif ++ pr_err("Uncorrected hardware memory error in user-access at %llx\n", ++ si->paddr); ++ /* ++ * We must call memory_failure() here even if the current process is ++ * doomed. We still need to mark the page as poisoned and alert any ++ * other users of the page. ++ */ ++ if (memory_failure(pfn, flags) < 0) ++ fail++; + -+static void host_giveback_request(struct HOST_CTRL *priv, -+ struct HOST_REQ *req, uint32_t status) -+{ -+ struct urb *urb_req; -+ int urb_status = 0; -+ int i = 0; -+ struct phytium_cusb *config; ++ sea_clear_info(si); + -+ if (!priv || !req) -+ return; ++ si = sea_find_info(); ++ } while (si); + -+ urb_req = req->userExt; -+ urb_req->actual_length = req->actualLength; ++ if (fail) { ++ pr_err("Memory error not recovered\n"); + -+ switch (status) { -+ case HOST_ESTALL: -+ urb_status = -EPIPE; -+ break; -+ case HOST_EUNHANDLED: -+ urb_status = -EPROTO; -+ break; -+ case HOST_ESHUTDOWN: -+ urb_status = -ESHUTDOWN; -+ break; -+ default: -+ urb_status = status; -+ } -+ pr_debug("complete %p %pS (%d) dev%d ep%d%s %d/%d\n", -+ urb_req, urb_req->complete, urb_status, -+ usb_pipedevice(urb_req->pipe), -+ usb_pipeendpoint(urb_req->pipe), -+ usb_pipein(urb_req->pipe) ? "in" : "out", -+ urb_req->actual_length, -+ urb_req->transfer_buffer_length); -+ -+ if (usb_endpoint_xfer_isoc(&urb_req->ep->desc)) { -+ for (i = 0; i < urb_req->number_of_packets; i++) { -+ urb_req->iso_frame_desc[i].status = 0; -+ urb_req->iso_frame_desc[i].actual_length = req->isoFramesDesc[i].length; -+ } ++ force_sig(SIGBUS); + } -+ -+ config = dev_get_drvdata(priv->dev); -+ usb_hcd_unlink_urb_from_ep(config->hcd, urb_req); -+ spin_unlock(&config->lock); -+ usb_hcd_giveback_urb(config->hcd, urb_req, urb_status); -+ kfree(req); -+ spin_lock(&config->lock); +} + -+static void host_rh_port_status_change(struct HOST_CTRL *priv) ++void ghes_arm_process_error(struct ghes *ghes, ++ struct cper_sec_proc_arm *err, int sec_sev) +{ -+ uint32_t statusHub; -+ char *status; -+ uint32_t retval; -+ struct usb_ctrlrequest setup; -+ struct phytium_cusb *config; -+ -+ if (!priv) -+ return; -+ -+ config = dev_get_drvdata(priv->dev); -+ if (!config) -+ return; -+ -+ status = (char *)&statusHub; -+ hc_hub_status_data(config->hcd, status); -+ -+ if (status) { -+ setup.bRequestType = USB_TYPE_CLASS | USB_RECIP_OTHER | USB_DIR_IN;//to host -+ setup.bRequest = USB_REQ_GET_STATUS; -+ setup.wValue = 0; -+ setup.wIndex = 1; -+ setup.wLength = 4; -+ retval = config->host_obj->host_vhubControl(priv, &setup, (uint8_t *)&statusHub); -+ if (retval) -+ return; -+ -+ if (status[1] & USB_PORT_STAT_C_CONNECTION) { -+ if (status[0] & USB_PORT_STAT_CONNECTION) { -+ if (config->hcd->status_urb) -+ usb_hcd_poll_rh_status(config->hcd); -+ else -+ usb_hcd_resume_root_hub(config->hcd); -+ } else { -+ usb_hcd_resume_root_hub(config->hcd); -+ usb_hcd_poll_rh_status(config->hcd); -+ } -+ } -+ } else -+ usb_hcd_resume_root_hub(config->hcd); -+} ++ int i; ++ bool info_saved = false; ++ struct cper_arm_err_info *err_info; + -+static void host_set_ep_toggle(struct HOST_CTRL *priv, -+ struct HOST_DEVICE *udev, u8 ep_num, u8 is_in, u8 toggle) -+{ -+ struct HOST_USB_DEVICE *device; ++ log_arm_hw_error(err, sec_sev); + -+ if (!priv || !udev) ++ if ((ghes->generic->notify.type != ACPI_HEST_NOTIFY_SEA) || ++ (ghes->estatus->error_severity != CPER_SEV_RECOVERABLE)) + return; + -+ device = (struct HOST_USB_DEVICE *)udev->userExt; ++ err_info = (struct cper_arm_err_info *)(err + 1); ++ for (i = 0; i < err->err_info_num; i++, err_info++) { ++ if ((err_info->validation_bits & CPER_ARM_INFO_VALID_PHYSICAL_ADDR) && ++ (err_info->type == CPER_ARM_CACHE_ERROR)) ++ info_saved |= sea_save_info(err_info->physical_fault_addr); ++ } + -+ usb_settoggle(device->ld_udev, ep_num, !is_in, toggle); ++ if (info_saved) ++ set_thread_flag(TIF_SEA_NOTIFY); +} + -+static u8 host_get_ep_toggle(struct HOST_CTRL *priv, -+ struct HOST_DEVICE *udev, u8 ep_num, u8 is_in) ++int ghes_mem_err_callback(struct notifier_block *nb, unsigned long val, void *data) +{ -+ struct HOST_USB_DEVICE *device; ++ bool info_saved = false; ++ struct ghes_mem_err *ghes_mem = (struct ghes_mem_err *)data; ++ struct cper_sec_mem_err *mem_err = ghes_mem->mem_err; + -+ if (!priv || !udev) ++ if ((ghes_mem->notify_type != ACPI_HEST_NOTIFY_SEA) || ++ (ghes_mem->severity != CPER_SEV_RECOVERABLE)) + return 0; + -+ device = (struct HOST_USB_DEVICE *)udev->userExt; -+ -+ return usb_gettoggle(device->ld_udev, ep_num, !is_in); -+} -+ -+static uint32_t initEndpoints(struct HOST_CTRL *priv) -+{ -+ int epNum; -+ -+ if (!priv) -+ return 0; ++ if (mem_err->validation_bits & CPER_MEM_VALID_PA) ++ info_saved = sea_save_info(mem_err->physical_addr); + -+ priv->hwEpInCount = 0; -+ priv->hwEpOutCount = 0; -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | 0); -+ memset(priv->ep_remap_pool, 0, sizeof(priv->ep_remap_pool)); -+ -+ for (epNum = 0; epNum < HOST_EP_NUM; epNum++) { -+ priv->in[epNum].isInEp = 1; -+ priv->in[epNum].hwEpNum = epNum; -+ if (priv->hostCfg.epIN[epNum].bufferingValue) { -+ priv->in[epNum].hwMaxPacketSize = priv->hostCfg.epIN[epNum].maxPacketSize; -+ priv->in[epNum].hwBuffers = priv->hostCfg.epIN[epNum].bufferingValue; -+ priv->in[epNum].state = HOST_EP_FREE; -+ priv->in[epNum].channel = NULL; -+ priv->hwEpInCount++; -+ -+ if (epNum) { -+ phytium_write16(&priv->regs->rxstaddr[epNum - 1].addr, -+ priv->hostCfg.epIN[epNum].startBuf); -+ phytium_write8(&priv->regs->ep[epNum - 1].rxcon, 0x08); -+ phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | epNum); -+ phytium_write8(&priv->regs->irqmode[epNum - 1].inirqmode, 0x80); -+ } -+ } else -+ priv->in[epNum].state = HOST_EP_NOT_IMPLEMENTED; -+ -+ priv->out[epNum].isInEp = 0; -+ priv->out[epNum].hwEpNum = epNum; -+ if (priv->hostCfg.epOUT[epNum].bufferingValue) { -+ priv->out[epNum].hwMaxPacketSize = priv->hostCfg.epOUT[epNum].maxPacketSize; -+ priv->out[epNum].hwBuffers = priv->hostCfg.epOUT[epNum].bufferingValue; -+ priv->out[epNum].state = HOST_EP_FREE; -+ priv->out[epNum].channel = NULL; -+ priv->hwEpInCount++; -+ -+ if (epNum) { -+ phytium_write16(&priv->regs->txstaddr[epNum - 1].addr, -+ priv->hostCfg.epOUT[epNum].startBuf); -+ phytium_write8(&priv->regs->ep[epNum - 1].txcon, 0x08); -+ phytium_write8(&priv->regs->fifoctrl, -+ FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | epNum); -+ phytium_write8(&priv->regs->irqmode[epNum - 1].outirqmode, 0x80); -+ } -+ } else -+ priv->out[epNum].state = HOST_EP_NOT_IMPLEMENTED; -+ } ++ if (info_saved) ++ set_thread_flag(TIF_SEA_NOTIFY); + + return 0; +} + -+int32_t hostInit(struct HOST_CTRL *priv, struct HOST_CFG *config, -+ struct HOST_CALLBACKS *callbacks, struct device *pdev, bool isVhubHost) -+{ -+ int index; -+ -+ if (!config || !priv || !callbacks || !pdev) -+ return -EINVAL; -+ -+ priv->dev = pdev; -+ priv->hostCallbacks = *callbacks; -+ priv->hostCfg = *config; -+ priv->regs = (struct HW_REGS *)config->regBase; -+ priv->hostDrv = HOST_GetInstance(); -+ -+ priv->dmaDrv = DMA_GetInstance(); -+ priv->dmaCfg.dmaModeRx = 0xFFFF; -+ priv->dmaCfg.dmaModeTx = 0xFFFF; -+ priv->dmaCfg.regBase = config->regBase + 0x400; -+ priv->dmaCfg.trbAddr = config->trbAddr; -+ priv->dmaCfg.trbDmaAddr = config->trbDmaAddr; -+ priv->dmaCallback.complete = host_CallbackTransfer; -+ -+ priv->dmaController = (void *)(priv + 1); -+ priv->dmaDrv->dma_init(priv->dmaController, &priv->dmaCfg, &priv->dmaCallback); -+ priv->dmaDrv->dma_setParentPriv(priv->dmaController, priv); -+ -+ INIT_LIST_HEAD(&priv->ctrlHEpQueue); -+ -+ for (index = 0; index < MAX_INSTANCE_EP_NUM; index++) { -+ INIT_LIST_HEAD(&priv->isoInHEpQueue[index]); -+ INIT_LIST_HEAD(&priv->isoOutHEpQueue[index]); -+ INIT_LIST_HEAD(&priv->intInHEpQueue[index]); -+ INIT_LIST_HEAD(&priv->intOutHEpQueue[index]); -+ INIT_LIST_HEAD(&priv->bulkInHEpQueue[index]); -+ INIT_LIST_HEAD(&priv->bulkOutHEpQueue[index]); -+ } -+ -+ phytium_write8(&priv->regs->cpuctrl, BIT(1)); -+ phytium_write8(&priv->regs->otgctrl, OTGCTRL_ABUSDROP); -+ phytium_write8(&priv->regs->ep0maxpack, 0x40); -+ -+ //disable interrupts -+ phytium_write8(&priv->regs->otgien, 0x0); -+ phytium_write8(&priv->regs->usbien, 0x0); -+ phytium_write16(&priv->regs->txerrien, 0x0); -+ phytium_write16(&priv->regs->rxerrien, 0x0); -+ -+ //clear all interrupt except otg idle irq -+ phytium_write8(&priv->regs->otgirq, 0xFE); -+ phytium_write8(&priv->regs->usbirq, 0xFF); -+ phytium_write16(&priv->regs->txerrirq, 0xFF); -+ phytium_write16(&priv->regs->rxerrirq, 0xFF); -+ -+ phytium_write8(&priv->regs->tawaitbcon, 0x80); -+ -+ initEndpoints(priv); -+ priv->otgState = HOST_OTG_STATE_B_IDLE; -+ -+ //reset all endpoint -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); -+ -+ if (isVhubHost) -+ priv->vhub_regs = (struct VHUB_REGS *)(config->phy_regBase); -+ else -+ priv->custom_regs = (struct CUSTOM_REGS *)(config->phy_regBase); -+ -+ return 0; -+} ++static struct notifier_block ghes_mem_err_nb = { ++ .notifier_call = ghes_mem_err_callback, ++}; + -+void hostDestroy(struct HOST_CTRL *priv) ++static int arm64_err_recov_init(void) +{ ++ atomic_notifier_chain_register(&ghes_mem_err_chain, &ghes_mem_err_nb); ++ return 0; +} + -+void hostStart(struct HOST_CTRL *priv) -+{ -+ uint8_t otgstate, usbien; ++late_initcall(arm64_err_recov_init); +diff --git a/arch/arm64/kernel/signal.c b/arch/arm64/kernel/signal.c +index 425b1bc17..0e1dbc6d2 100644 +--- a/arch/arm64/kernel/signal.c ++++ b/arch/arm64/kernel/signal.c +@@ -33,6 +33,7 @@ + #include + #include + #include ++#include + + /* + * Do a signal return; undo the signal stack. These are aligned to 128-bit. +@@ -1280,6 +1281,11 @@ static void do_signal(struct pt_regs *regs) + + void do_notify_resume(struct pt_regs *regs, unsigned long thread_flags) + { ++#ifdef CONFIG_ARM64_ERR_RECOV ++ /* notify userspace of pending SEAs */ ++ if (unlikely(thread_flags & _TIF_SEA_NOTIFY)) ++ sea_notify_process(); ++#endif /* CONFIG_ARM64_ERR_RECOV */ + do { + if (thread_flags & _TIF_NEED_RESCHED) { + /* Unmask Debug and SError for the next task */ +diff --git a/arch/arm64/kernel/traps.c b/arch/arm64/kernel/traps.c +index 8b70759cd..79935d0ad 100644 +--- a/arch/arm64/kernel/traps.c ++++ b/arch/arm64/kernel/traps.c +@@ -49,6 +49,8 @@ + #include + #include + ++#include + -+ if (!priv) -+ return; + static bool __kprobes __check_eq(unsigned long pstate) + { + return (pstate & PSR_Z_BIT) != 0; +@@ -968,6 +970,13 @@ void __noreturn arm64_serror_panic(struct pt_regs *regs, unsigned long esr) + bool arm64_is_fatal_ras_serror(struct pt_regs *regs, unsigned long esr) + { + unsigned long aet = arm64_ras_serror_get_severity(esr); ++ int ret = ENOENT; + -+ priv->dmaDrv->dma_start(priv->dmaController); -+ usbien = phytium_read8(&priv->regs->usbien); -+ usbien = usbien | USBIR_URES | USBIR_SUSP; -+ phytium_write8(&priv->regs->usbien, usbien); -+retry: -+ otgstate = phytium_read8(&priv->regs->otgstate); -+ switch (otgstate) { -+ case HOST_OTG_STATE_A_IDLE: -+ priv->ep0State = HOST_EP0_STAGE_IDLE; -+ priv->otgState = HOST_OTG_STATE_A_IDLE; -+ phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); -+ host_SetVbus(priv, 1); -+ break; -+ case HOST_OTG_STATE_B_IDLE: -+ host_SetVbus(priv, 1); -+ break; -+ case HOST_OTG_STATE_A_WAIT_VFALL: -+ goto retry; ++ if (IS_ENABLED(CONFIG_ACPI_APEI_SEI)) { ++ ret = ghes_notify_sei(); ++ if (!ret) ++ return false; + } + + switch (aet) { + case ESR_ELx_AET_CE: /* corrected error */ +diff --git a/block/partitions/cmdline.c b/block/partitions/cmdline.c +index c03bc105e..152c85df9 100644 +--- a/block/partitions/cmdline.c ++++ b/block/partitions/cmdline.c +@@ -70,8 +70,8 @@ static int parse_subpart(struct cmdline_subpart **subpart, char *partdef) + } + + if (*partdef == '(') { +- int length; +- char *next = strchr(++partdef, ')'); ++ partdef++; ++ char *next = strsep(&partdef, ")"); + + if (!next) { + pr_warn("cmdline partition format is invalid."); +@@ -79,11 +79,7 @@ static int parse_subpart(struct cmdline_subpart **subpart, char *partdef) + goto fail; + } + +- length = min_t(int, next - partdef, +- sizeof(new_subpart->name) - 1); +- strscpy(new_subpart->name, partdef, length); +- +- partdef = ++next; ++ strscpy(new_subpart->name, next, sizeof(new_subpart->name)); + } else + new_subpart->name[0] = '\0'; + +@@ -117,14 +113,12 @@ static void free_subpart(struct cmdline_parts *parts) + } + } + +-static int parse_parts(struct cmdline_parts **parts, const char *bdevdef) ++static int parse_parts(struct cmdline_parts **parts, char *bdevdef) + { + int ret = -EINVAL; + char *next; +- int length; + struct cmdline_subpart **next_subpart; + struct cmdline_parts *newparts; +- char buf[BDEVNAME_SIZE + 32 + 4]; + + *parts = NULL; + +@@ -132,28 +126,19 @@ static int parse_parts(struct cmdline_parts **parts, const char *bdevdef) + if (!newparts) + return -ENOMEM; + +- next = strchr(bdevdef, ':'); ++ next = strsep(&bdevdef, ":"); + if (!next) { + pr_warn("cmdline partition has no block device."); + goto fail; + } + +- length = min_t(int, next - bdevdef, sizeof(newparts->name) - 1); +- strscpy(newparts->name, bdevdef, length); ++ strscpy(newparts->name, next, sizeof(newparts->name)); + newparts->nr_subparts = 0; + + next_subpart = &newparts->subpart; + +- while (next && *(++next)) { +- bdevdef = next; +- next = strchr(bdevdef, ','); +- +- length = (!next) ? (sizeof(buf) - 1) : +- min_t(int, next - bdevdef, sizeof(buf) - 1); +- +- strscpy(buf, bdevdef, length); +- +- ret = parse_subpart(next_subpart, buf); ++ while ((next = strsep(&bdevdef, ","))) { ++ ret = parse_subpart(next_subpart, next); + if (ret) + goto fail; + +@@ -199,24 +184,17 @@ static int cmdline_parts_parse(struct cmdline_parts **parts, + + *parts = NULL; + +- next = pbuf = buf = kstrdup(cmdline, GFP_KERNEL); ++ pbuf = buf = kstrdup(cmdline, GFP_KERNEL); + if (!buf) + return -ENOMEM; + + next_parts = parts; + +- while (next && *pbuf) { +- next = strchr(pbuf, ';'); +- if (next) +- *next = '\0'; +- +- ret = parse_parts(next_parts, pbuf); ++ while ((next = strsep(&pbuf, ";"))) { ++ ret = parse_parts(next_parts, next); + if (ret) + goto fail; + +- if (next) +- pbuf = ++next; +- + next_parts = &(*next_parts)->next_parts; + } + +@@ -250,7 +228,6 @@ static struct cmdline_parts *bdev_parts; + static int add_part(int slot, struct cmdline_subpart *subpart, + struct parsed_partitions *state) + { +- int label_min; + struct partition_meta_info *info; + char tmp[sizeof(info->volname) + 4]; + +@@ -262,9 +239,7 @@ static int add_part(int slot, struct cmdline_subpart *subpart, + + info = &state->parts[slot].info; + +- label_min = min_t(int, sizeof(info->volname) - 1, +- sizeof(subpart->name)); +- strscpy(info->volname, subpart->name, label_min); ++ strscpy(info->volname, subpart->name, sizeof(info->volname)); + + snprintf(tmp, sizeof(tmp), "(%s)", info->volname); + strlcat(state->pp_buf, tmp, PAGE_SIZE); +diff --git a/drivers/acpi/acpi_apd.c b/drivers/acpi/acpi_apd.c +index 80f945cbe..9e265b3ba 100644 +--- a/drivers/acpi/acpi_apd.c ++++ b/drivers/acpi/acpi_apd.c +@@ -162,6 +162,16 @@ static const struct apd_device_desc hip08_lite_i2c_desc = { + .fixed_clk_rate = 125000000, + }; + ++static const struct apd_device_desc phytium_i2c_desc = { ++ .setup = acpi_apd_setup, ++ .fixed_clk_rate = 200000000, ++}; + -+ phytium_write8(&priv->regs->otgien, OTGIRQ_CONIRQ | -+ OTGIRQ_VBUSERRIRQ | OTGIRQ_SRPDETIRQ); -+} -+ -+void hostStop(struct HOST_CTRL *priv) -+{ -+ if (!priv) -+ return; -+ -+ phytium_write8(&priv->regs->otgien, 0x0); -+ phytium_write8(&priv->regs->usbien, 0x0); -+ phytium_write16(&priv->regs->txerrien, 0x0); -+ phytium_write16(&priv->regs->rxerrien, 0x0); -+ -+ phytium_write8(&priv->regs->otgirq, 0xFE); -+ phytium_write8(&priv->regs->usbirq, 0xFF); -+ phytium_write16(&priv->regs->txerrirq, 0xFF); -+ phytium_write16(&priv->regs->rxerrirq, 0xFF); -+ -+ host_SetVbus(priv, 0); -+ priv->dmaDrv->dma_stop(priv->dmaController); -+} ++static const struct apd_device_desc phytium_pe220x_i2c_desc = { ++ .setup = acpi_apd_setup, ++ .fixed_clk_rate = 50000000, ++}; + -+static void handleReset(struct HOST_CTRL *priv) -+{ -+ if (!priv) -+ return; + static const struct apd_device_desc thunderx2_i2c_desc = { + .setup = acpi_apd_setup, + .fixed_clk_rate = 125000000, +@@ -246,6 +256,8 @@ static const struct acpi_device_id acpi_apd_device_ids[] = { + { "HISI02A3", APD_ADDR(hip08_lite_i2c_desc) }, + { "HISI0173", APD_ADDR(hip08_spi_desc) }, + { "NXP0001", APD_ADDR(nxp_i2c_desc) }, ++ { "PHYT0003", APD_ADDR(phytium_i2c_desc) }, ++ { "PHYT0038", APD_ADDR(phytium_pe220x_i2c_desc) }, + #endif + { } + }; +diff --git a/drivers/acpi/apei/Kconfig b/drivers/acpi/apei/Kconfig +index 6b18f8bc7..49e181f5a 100644 +--- a/drivers/acpi/apei/Kconfig ++++ b/drivers/acpi/apei/Kconfig +@@ -45,6 +45,21 @@ config ACPI_APEI_SEA + depends on ARM64 && ACPI_APEI_GHES + default y + ++config ACPI_APEI_SEI ++ bool "APEI SError(System Error) Interrupt logging/recovering support" ++ depends on ARM64 && ACPI_APEI_GHES ++ default y ++ help ++ This option should be enabled if the system supports ++ firmware first handling of SEI(SError interrupt) + -+ if (priv->otgState == HOST_OTG_STATE_A_WAIT_BCON -+ || priv->otgState == HOST_OTG_STATE_B_WAIT_ACON) { -+ switch (phytium_read8(&priv->regs->speedctrl)) { -+ case SPEEDCTRL_HS: -+ priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; -+ break; -+ case SPEEDCTRL_FS: -+ priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); -+ break; -+ case SPEEDCTRL_LS: -+ priv->portStatus |= USB_PORT_STAT_LOW_SPEED; -+ break; -+ } ++ SEI happens with asynchronous external abort for errors on device ++ memory reads on ARMv8 systems. If a system supports firmware first ++ handling of SEI, the platform analyzes and handles hardware error ++ notifications from SEI, and it may then form a hardware error record ++ for the OS to parse and handle. This option allows the OS to look ++ for such hardware error record, and take appropriate action. + -+ priv->dmaDrv->dma_setHostMode(priv->dmaController); + config ACPI_APEI_MEMORY_FAILURE + bool "APEI memory error recovering support" + depends on ACPI_APEI && MEMORY_FAILURE +diff --git a/drivers/acpi/apei/ghes.c b/drivers/acpi/apei/ghes.c +index ab2a82cb1..2a7aa5e87 100644 +--- a/drivers/acpi/apei/ghes.c ++++ b/drivers/acpi/apei/ghes.c +@@ -148,6 +148,9 @@ static DEFINE_MUTEX(ghes_list_mutex); + static LIST_HEAD(ghes_devs); + static DEFINE_MUTEX(ghes_devs_mutex); + ++ATOMIC_NOTIFIER_HEAD(ghes_mem_err_chain); ++EXPORT_SYMBOL_GPL(ghes_mem_err_chain); + -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); + /* + * Because the memory area used to transfer hardware error information + * from BIOS to Linux can be determined only in NMI, IRQ or timer +@@ -534,9 +537,8 @@ static bool ghes_handle_arm_hw_error(struct acpi_hest_generic_data *gdata, + int sec_sev, i; + char *p; + +- log_arm_hw_error(err); +- + sec_sev = ghes_severity(gdata->error_severity); ++ log_arm_hw_error(err, sec_sev); + if (sev != GHES_SEV_RECOVERABLE || sec_sev != GHES_SEV_RECOVERABLE) + return false; + +@@ -696,6 +698,11 @@ static bool ghes_do_proc(struct ghes *ghes, + + if (guid_equal(sec_type, &CPER_SEC_PLATFORM_MEM)) { + struct cper_sec_mem_err *mem_err = acpi_hest_get_payload(gdata); ++ struct ghes_mem_err mem; + -+ switch (phytium_read8(&priv->regs->otgstate)) { -+ case HOST_OTG_STATE_B_HOST: -+ priv->otgState = HOST_OTG_STATE_B_HOST; -+ break; -+ case HOST_OTG_STATE_A_HOST: -+ break; -+ default: -+ priv->otgState = HOST_OTG_STATE_A_HOST; -+ break; -+ } -+ } -+} ++ mem.notify_type = ghes->generic->notify.type; ++ mem.severity = gdata->error_severity; ++ mem.mem_err = mem_err; + + atomic_notifier_call_chain(&ghes_report_chain, sev, mem_err); + +@@ -1204,6 +1211,46 @@ static inline void ghes_sea_add(struct ghes *ghes) { } + static inline void ghes_sea_remove(struct ghes *ghes) { } + #endif /* CONFIG_ACPI_APEI_SEA */ + ++#ifdef CONFIG_ACPI_APEI_SEI ++static LIST_HEAD(ghes_sei); + -+void hostIsr(struct HOST_CTRL *priv) ++/* ++ * Return 0 only if one of the SEI error sources successfully reported an error ++ * record sent from the firmware. ++ */ ++int ghes_notify_sei(void) +{ -+ uint8_t usbirq, usbien; -+ -+ if (!priv) -+ return; -+ -+ usbirq = phytium_read8(&priv->regs->usbirq); -+ usbien = phytium_read8(&priv->regs->usbien); -+ pr_debug("raw usbirq:0x%x usbien:0x%x\n", usbirq, usbien); -+ usbirq = usbirq & usbien; -+ -+ hostErrorIrq(priv); -+ hostOtgIrq(priv); -+ -+ if (!usbirq) -+ goto DMA_IRQ; -+ -+ if (usbirq & USBIR_URES) { -+ phytium_write8(&priv->regs->usbirq, USBIR_URES); -+ priv->port_resetting = 0; -+ handleReset(priv); -+ } -+ -+ if (usbirq & USBIR_SOF) -+ phytium_write8(&priv->regs->usbirq, USBIR_SOF); ++ struct ghes *ghes; ++ int ret = -ENOENT; + -+ if (usbirq & USBIR_SUSP) { -+ pr_debug("clear suspend irq\n"); -+ phytium_write8(&priv->regs->usbirq, USBIR_SUSP); -+ phytium_write8(&priv->regs->clkgate, 0x7); ++ rcu_read_lock(); ++ list_for_each_entry_rcu(ghes, &ghes_sei, list) { ++ if (!ghes_proc(ghes)) ++ ret = 0; + } -+ -+ return; -+DMA_IRQ: -+ priv->dmaDrv->dma_isr(priv->dmaController); ++ rcu_read_unlock(); ++ return ret; +} + -+int32_t hostEpDisable(struct HOST_CTRL *priv, struct HOST_EP *ep) ++static void ghes_sei_add(struct ghes *ghes) +{ -+ return 0; ++ mutex_lock(&ghes_list_mutex); ++ list_add_rcu(&ghes->list, &ghes_sei); ++ mutex_unlock(&ghes_list_mutex); +} + -+unsigned int get_endpoint_interval(struct usb_endpoint_descriptor desc, -+ int speed) ++static void ghes_sei_remove(struct ghes *ghes) +{ -+ unsigned int interval = 0; -+ -+ switch (speed) { -+ case USB_SPEED_HIGH: -+ if (usb_endpoint_xfer_control(&desc) || usb_endpoint_xfer_bulk(&desc)) { -+ if (desc.bInterval == 0) -+ return interval; -+ interval = fls(desc.bInterval) - 1; -+ interval = clamp_val(interval, 0, 15); -+ interval = 1 << interval; -+ if ((1 << interval) != desc.bInterval) -+ pr_debug("rounding to %d microframes, desc %d microframes\n", -+ 1 << interval, desc.bInterval); -+ break; -+ } ++ mutex_lock(&ghes_list_mutex); ++ list_del_rcu(&ghes->list); ++ mutex_unlock(&ghes_list_mutex); ++ synchronize_rcu(); ++} ++#else /* CONFIG_ACPI_APEI_SEI */ ++static inline void ghes_sei_add(struct ghes *ghes) { } ++static inline void ghes_sei_remove(struct ghes *ghes) { } ++#endif /*CONFIG_ACPI_APEI_SEI */ + -+ if (usb_endpoint_xfer_isoc(&desc) || usb_endpoint_xfer_int(&desc)) { -+ interval = clamp_val(desc.bInterval, 1, 16) - 1; -+ interval = 1 << interval; -+ if (interval != desc.bInterval - 1) -+ pr_debug("rounding to %d %sframes\n", 1 << interval, -+ speed == USB_SPEED_FULL ? "" : "micro"); + #ifdef CONFIG_HAVE_ACPI_APEI_NMI + /* + * NMI may be triggered on any CPU, so ghes_in_nmi is used for +@@ -1347,6 +1394,13 @@ static int ghes_probe(struct platform_device *ghes_dev) + goto err; + } + break; ++ case ACPI_HEST_NOTIFY_SEI: ++ if (!IS_ENABLED(CONFIG_ACPI_APEI_SEI)) { ++ pr_warn(GHES_PFX "Generic hardware error source: %d notified via SEI is not supported\n", ++ generic->header.source_id); ++ goto err; + } + break; -+ case USB_SPEED_FULL: -+ if (usb_endpoint_xfer_isoc(&desc)) { -+ interval = clamp_val(desc.bInterval, 1, 16) - 1; -+ if (interval != desc.bInterval - 1) -+ pr_debug("rounding to %d %sframes\n", 1 << interval, -+ speed == USB_SPEED_FULL ? "" : "micro"); -+ interval += 3; -+ break; -+ } -+ fallthrough; -+ case USB_SPEED_LOW: -+ if (usb_endpoint_xfer_int(&desc) || usb_endpoint_xfer_isoc(&desc)) { -+ interval = fls(desc.bInterval * 8) - 1; -+ interval = clamp_val(interval, 3, 10); -+ if ((1 << interval) != desc.bInterval * 8) -+ pr_debug("rounding to %d microframes, desc %d microframes\n", -+ 1 << interval, desc.bInterval); -+ } -+ } -+ -+ return interval; + case ACPI_HEST_NOTIFY_NMI: + if (!IS_ENABLED(CONFIG_HAVE_ACPI_APEI_NMI)) { + pr_warn(GHES_PFX "Generic hardware error source: %d notified via NMI interrupt is not supported!\n", +@@ -1420,6 +1474,9 @@ static int ghes_probe(struct platform_device *ghes_dev) + case ACPI_HEST_NOTIFY_SEA: + ghes_sea_add(ghes); + break; ++ case ACPI_HEST_NOTIFY_SEI: ++ ghes_sei_add(ghes); ++ break; + case ACPI_HEST_NOTIFY_NMI: + ghes_nmi_add(ghes); + break; +@@ -1487,6 +1544,9 @@ static int ghes_remove(struct platform_device *ghes_dev) + case ACPI_HEST_NOTIFY_SEA: + ghes_sea_remove(ghes); + break; ++ case ACPI_HEST_NOTIFY_SEI: ++ ghes_sei_remove(ghes); ++ break; + case ACPI_HEST_NOTIFY_NMI: + ghes_nmi_remove(ghes); + break; +diff --git a/drivers/acpi/internal.h b/drivers/acpi/internal.h +index 866c7c4ed..19e7dd17c 100644 +--- a/drivers/acpi/internal.h ++++ b/drivers/acpi/internal.h +@@ -85,6 +85,18 @@ bool acpi_scan_is_offline(struct acpi_device *adev, bool uevent); + acpi_status acpi_sysfs_table_handler(u32 event, void *table, void *context); + void acpi_scan_table_notify(void); + ++#ifdef CONFIG_ACPI_GENERIC_GSI ++int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, ++ int polarity, struct fwnode_handle *fwnode); ++#else ++static inline ++int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, ++ int polarity, struct fwnode_handle *fwnode) ++{ ++ return acpi_register_gsi(dev, hwirq, trigger, polarity); +} ++#endif ++ + /* -------------------------------------------------------------------------- + Device Node Initialization / Removal + -------------------------------------------------------------------------- */ +diff --git a/drivers/acpi/irq.c b/drivers/acpi/irq.c +index 1687483ff..ceed87bb1 100644 +--- a/drivers/acpi/irq.c ++++ b/drivers/acpi/irq.c +@@ -10,6 +10,8 @@ + #include + #include + ++#include "internal.h" + -+int32_t hostReqQueue(struct HOST_CTRL *priv, struct HOST_REQ *req) + enum acpi_irq_model_id acpi_irq_model; + + static struct fwnode_handle *(*acpi_get_gsi_domain_id)(u32 gsi); +@@ -43,6 +45,24 @@ int acpi_gsi_to_irq(u32 gsi, unsigned int *irq) + } + EXPORT_SYMBOL_GPL(acpi_gsi_to_irq); + ++int acpi_register_irq(struct device *dev, u32 hwirq, int trigger, ++ int polarity, struct fwnode_handle *fwnode) +{ -+ struct HOST_EP_PRIV *hostEpPriv; -+ struct list_head *hEpQueue = NULL; -+ uint8_t idleQueue = 0; ++ struct irq_fwspec fwspec; + -+ if (!priv || !req) ++ if (!fwnode) { ++ dev_warn(dev, "No registered irqchip for hwirq %d\n", hwirq); + return -EINVAL; ++ } + -+ list_add_tail((struct list_head *)&req->list, (struct list_head *)&req->usbEp->reqList); -+ hostEpPriv = (struct HOST_EP_PRIV *)req->usbEp->hcPriv; ++ fwspec.fwnode = fwnode; ++ fwspec.param[0] = hwirq; ++ fwspec.param[1] = acpi_dev_get_irq_type(trigger, polarity); ++ fwspec.param_count = 2; + -+ if (hostEpPriv->epIsReady) { -+ if (usb_endpoint_xfer_isoc(&req->usbEp->desc)) { -+ hostEpPriv->isocEpConfigured = 1; -+ hostStartReq(priv, req); -+ } -+ return 0; -+ } ++ return irq_create_fwspec_mapping(&fwspec); ++} + -+ hostEpPriv->epIsReady = 1; -+ hostEpPriv->maxPacketSize = req->usbEp->desc.wMaxPacketSize; -+ hostEpPriv->interval = req->interval; -+ hostEpPriv->epNum = req->usbEp->desc.bEndpointAddress & 0xf; -+ hostEpPriv->faddress = req->faddress; -+ hostEpPriv->usbHEp = req->usbEp; -+ hostEpPriv->isIn = req->epIsIn; -+ -+ hostEpPriv->frame = get_endpoint_interval(req->usbEp->desc, req->usbDev->speed); -+ hostEpPriv->interval = hostEpPriv->frame; -+ switch (usb_endpoint_type(&req->usbEp->desc)) { -+ case USB_ENDPOINT_XFER_CONTROL: -+ hostEpPriv->isIn = 0; -+ hEpQueue = &priv->ctrlHEpQueue; -+ hostEpPriv->type = USB_ENDPOINT_XFER_CONTROL; -+ break; -+ case USB_ENDPOINT_XFER_BULK: -+ hEpQueue = hostEpPriv->isIn ? &priv->bulkInHEpQueue[req->epNum - 1] : -+ &priv->bulkOutHEpQueue[req->epNum - 1]; -+ hostEpPriv->type = USB_ENDPOINT_XFER_BULK; -+ break; -+ case USB_ENDPOINT_XFER_INT: -+ hEpQueue = hostEpPriv->isIn ? &priv->intInHEpQueue[req->epNum - 1] : -+ &priv->intOutHEpQueue[req->epNum - 1]; -+ hostEpPriv->type = USB_ENDPOINT_XFER_INT; -+ break; -+ case USB_ENDPOINT_XFER_ISOC: -+ hEpQueue = hostEpPriv->isIn ? &priv->isoInHEpQueue[req->epNum - 1] : -+ &priv->isoOutHEpQueue[req->epNum - 1]; -+ hostEpPriv->type = USB_ENDPOINT_XFER_ISOC; -+ break; -+ default: -+ break; -+ } + /** + * acpi_register_gsi() - Map a GSI to a linux IRQ number + * @dev: device for which IRQ has to be mapped +@@ -56,24 +76,7 @@ EXPORT_SYMBOL_GPL(acpi_gsi_to_irq); + int acpi_register_gsi(struct device *dev, u32 gsi, int trigger, + int polarity) + { +- struct irq_fwspec fwspec; +- unsigned int irq; +- +- fwspec.fwnode = acpi_get_gsi_domain_id(gsi); +- if (WARN_ON(!fwspec.fwnode)) { +- pr_warn("GSI: No registered irqchip, giving up\n"); +- return -EINVAL; +- } +- +- fwspec.param[0] = gsi; +- fwspec.param[1] = acpi_dev_get_irq_type(trigger, polarity); +- fwspec.param_count = 2; +- +- irq = irq_create_fwspec_mapping(&fwspec); +- if (!irq) +- return -EINVAL; +- +- return irq; ++ return acpi_register_irq(dev, gsi, trigger, polarity, acpi_get_gsi_domain_id(gsi)); + } + EXPORT_SYMBOL_GPL(acpi_register_gsi); + +@@ -108,7 +111,7 @@ EXPORT_SYMBOL_GPL(acpi_unregister_gsi); + * Return: + * The referenced device fwhandle or NULL on failure + */ +-static struct fwnode_handle * ++struct fwnode_handle * + acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source, + u32 gsi) + { +diff --git a/drivers/acpi/pci_irq.c b/drivers/acpi/pci_irq.c +index ff30ceca2..c6fc738f7 100644 +--- a/drivers/acpi/pci_irq.c ++++ b/drivers/acpi/pci_irq.c +@@ -23,6 +23,8 @@ + #include + #include + ++#include "internal.h" + -+ if (hostEpPriv->isIn) -+ hostEpPriv->genericHwEp = &priv->in[req->epNum]; -+ else -+ hostEpPriv->genericHwEp = &priv->out[req->epNum]; + struct acpi_prt_entry { + struct acpi_pci_id id; + u8 pin; +@@ -400,6 +402,7 @@ int acpi_pci_irq_enable(struct pci_dev *dev) + char *link = NULL; + char link_desc[16]; + int rc; ++ struct fwnode_handle *rs_fwnode; + + pin = dev->pin; + if (!pin) { +@@ -426,7 +429,8 @@ int acpi_pci_irq_enable(struct pci_dev *dev) + gsi = acpi_pci_link_allocate_irq(entry->link, + entry->index, + &triggering, &polarity, +- &link); ++ &link, ++ &rs_fwnode); + else + gsi = entry->index; + } else +@@ -450,7 +454,7 @@ int acpi_pci_irq_enable(struct pci_dev *dev) + return 0; + } + +- rc = acpi_register_gsi(&dev->dev, gsi, triggering, polarity); ++ rc = acpi_register_irq(&dev->dev, gsi, triggering, polarity, rs_fwnode); + if (rc < 0) { + dev_warn(&dev->dev, "PCI INT %c: failed to register GSI\n", + pin_name(pin)); +diff --git a/drivers/acpi/pci_link.c b/drivers/acpi/pci_link.c +index aa1038b8a..3af04e839 100644 +--- a/drivers/acpi/pci_link.c ++++ b/drivers/acpi/pci_link.c +@@ -59,6 +59,7 @@ struct acpi_pci_link_irq { + u8 resource_type; + u8 possible_count; + u32 possible[ACPI_PCI_LINK_MAX_POSSIBLE]; ++ struct acpi_resource_source resource_source; + u8 initialized:1; + u8 reserved:7; + }; +@@ -121,6 +122,8 @@ static acpi_status acpi_pci_link_check_possible(struct acpi_resource *resource, + { + struct acpi_resource_extended_irq *p = + &resource->data.extended_irq; ++ struct acpi_resource_source *rs = ++ &link->irq.resource_source; + if (!p->interrupt_count) { + acpi_handle_debug(handle, + "Blank _PRS EXT IRQ resource\n"); +@@ -141,6 +144,12 @@ static acpi_status acpi_pci_link_check_possible(struct acpi_resource *resource, + link->irq.triggering = p->triggering; + link->irq.polarity = p->polarity; + link->irq.resource_type = ACPI_RESOURCE_TYPE_EXTENDED_IRQ; ++ if (p->resource_source.string_length) { ++ rs->index = p->resource_source.index; ++ rs->string_length = p->resource_source.string_length; ++ rs->string_ptr = kstrdup(p->resource_source.string_ptr, ++ GFP_KERNEL); ++ } + break; + } + default: +@@ -327,7 +336,8 @@ static int acpi_pci_link_set(struct acpi_pci_link *link, int irq) + resource->res.data.extended_irq.shareable = ACPI_SHARED; + resource->res.data.extended_irq.interrupt_count = 1; + resource->res.data.extended_irq.interrupts[0] = irq; +- /* ignore resource_source, it's optional */ ++ resource->res.data.extended_irq.resource_source = ++ link->irq.resource_source; + break; + default: + acpi_handle_err(handle, "Invalid resource type %d\n", +@@ -604,7 +614,7 @@ static int acpi_pci_link_allocate(struct acpi_pci_link *link) + * failure: return -1 + */ + int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, +- int *polarity, char **name) ++ int *polarity, char **name, struct fwnode_handle **rs_fwnode) + { + struct acpi_device *device = acpi_fetch_acpi_dev(handle); + struct acpi_pci_link *link; +@@ -646,6 +656,13 @@ int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, + *polarity = link->irq.polarity; + if (name) + *name = acpi_device_bid(link->device); ++ if (rs_fwnode) ++ /* TODO: acpi_get_irq_source_fwhandle() requires a GSI as the second argument, ++ * which is not applicable for a hierarchical INTx. However, multiple GSI domains ++ * are only for LoongArch. Therefore, passing any value makes no differences for us. ++ * Need some reconstruction for this function to meet the real semantic. ++ */ ++ *rs_fwnode = acpi_get_irq_source_fwhandle(&link->irq.resource_source, 0); + acpi_handle_debug(handle, "Link is referenced\n"); + return link->irq.active; + } +diff --git a/drivers/cpufreq/scpi-cpufreq.c b/drivers/cpufreq/scpi-cpufreq.c +index d33be5698..989f99e26 100644 +--- a/drivers/cpufreq/scpi-cpufreq.c ++++ b/drivers/cpufreq/scpi-cpufreq.c +@@ -48,7 +48,7 @@ scpi_cpufreq_set_target(struct cpufreq_policy *policy, unsigned int index) + if (ret) + return ret; + +- if (clk_get_rate(priv->clk) != rate) ++ if (clk_get_rate(priv->clk) / 1000 * 1000 != rate) + return -EIO; + + return 0; +diff --git a/drivers/firmware/arm_scmi/driver.c b/drivers/firmware/arm_scmi/driver.c +index 87383c054..6a16007c6 100644 +--- a/drivers/firmware/arm_scmi/driver.c ++++ b/drivers/firmware/arm_scmi/driver.c +@@ -51,6 +51,8 @@ static DEFINE_SPINLOCK(protocol_lock); + static LIST_HEAD(scmi_list); + /* Protection for the entire list */ + static DEFINE_MUTEX(scmi_list_mutex); ++/* Protection for scmi xfer, prevent transmission timeout */ ++static DEFINE_MUTEX(scmi_xfer_mutex); + /* Track the unique id for the transfers for debug & profiling purpose */ + static atomic_t transfer_last_id; + +@@ -1030,6 +1032,7 @@ static int scmi_wait_for_reply(struct device *dev, const struct scmi_desc *desc, + struct scmi_xfer *xfer, unsigned int timeout_ms) + { + int ret = 0; ++ struct scmi_info *info = handle_to_scmi_info(cinfo->handle); + + if (xfer->hdr.poll_completion) { + /* +@@ -1045,7 +1048,10 @@ static int scmi_wait_for_reply(struct device *dev, const struct scmi_desc *desc, + + spin_until_cond(scmi_xfer_done_no_timeout(cinfo, + xfer, stop)); +- if (ktime_after(ktime_get(), stop)) { + -+ hostEpPriv->genericHwEp->state = HOST_EP_ALLOCATED; -+ hostEpPriv->genericHwEp->refCount++; ++ /* Poll again, timeout maybe caused by preempted */ ++ if (ktime_after(ktime_get(), stop) && ++ !info->desc->ops->poll_done(cinfo, xfer)) { + dev_err(dev, + "timed out in resp(caller: %pS) - polling\n", + (void *)_RET_IP_); +@@ -1211,8 +1217,11 @@ static int do_xfer(const struct scmi_protocol_handle *ph, + */ + smp_mb(); + ++ /* lock scmi xfer, too many scmi xfers may cause timeout */ ++ mutex_lock(&scmi_xfer_mutex); + ret = info->desc->ops->send_message(cinfo, xfer); + if (ret < 0) { ++ mutex_unlock(&scmi_xfer_mutex); + dev_dbg(dev, "Failed to send message %d\n", ret); + return ret; + } +@@ -1228,6 +1237,8 @@ static int do_xfer(const struct scmi_protocol_handle *ph, + if (info->desc->ops->mark_txdone) + info->desc->ops->mark_txdone(cinfo, ret, xfer); + ++ mutex_unlock(&scmi_xfer_mutex); + -+ if (list_empty(hEpQueue)) { -+ if (hostEpPriv->genericHwEp->state == HOST_EP_BUSY) { -+ pr_err("Error:Hardware endpoint %d is busy\n", -+ hostEpPriv->genericHwEp->hwEpNum); -+ return -EINVAL; -+ } -+ idleQueue = 1; + trace_scmi_xfer_end(xfer->transfer_id, xfer->hdr.id, + xfer->hdr.protocol_id, xfer->hdr.seq, ret); + +diff --git a/drivers/firmware/arm_scmi/mailbox.c b/drivers/firmware/arm_scmi/mailbox.c +index b8d470417..1a1580a8b 100644 +--- a/drivers/firmware/arm_scmi/mailbox.c ++++ b/drivers/firmware/arm_scmi/mailbox.c +@@ -167,6 +167,7 @@ static int mailbox_chan_setup(struct scmi_chan_info *cinfo, struct device *dev, + struct mbox_client *cl; + resource_size_t size; + struct resource res; ++ struct of_phandle_args args; + + ret = mailbox_chan_validate(cdev, &a2p_rx_chan, &p2a_chan); + if (ret) +@@ -226,6 +227,16 @@ static int mailbox_chan_setup(struct scmi_chan_info *cinfo, struct device *dev, + } + } + ++ ret = of_parse_phandle_with_args(cdev->of_node, "mboxes", ++ "#mbox-cells", tx ? 0 : p2a_chan, &args); ++ if (ret) { ++ dev_err(cdev, "failed to get SCMI %s mailbox\n", desc); ++ return ret; + } + -+ if (usb_endpoint_xfer_int(&req->usbEp->desc)) -+ list_add_tail(&hostEpPriv->node, hEpQueue); ++ if (of_device_is_compatible(args.np, "phytium,mbox")) ++ cinfo->no_completion_irq = true; + -+ if (idleQueue) -+ hostStartReq(priv, req); + cinfo->transport_info = smbox; + smbox->cinfo = cinfo; + +diff --git a/drivers/gpu/drm/amd/display/Kconfig b/drivers/gpu/drm/amd/display/Kconfig +index 901d1961b..74d45d9ae 100644 +--- a/drivers/gpu/drm/amd/display/Kconfig ++++ b/drivers/gpu/drm/amd/display/Kconfig +@@ -8,7 +8,7 @@ config DRM_AMD_DC + depends on BROKEN || !CC_IS_CLANG || ARM64 || RISCV || SPARC64 || X86_64 + select SND_HDA_COMPONENT if SND_HDA_CORE + # !CC_IS_CLANG: https://github.com/ClangBuiltLinux/linux/issues/1752 +- select DRM_AMD_DC_FP if (X86 || LOONGARCH || (PPC64 && ALTIVEC) || (ARM64 && KERNEL_MODE_NEON && !CC_IS_CLANG)) ++ select DRM_AMD_DC_FP if (X86 || LOONGARCH || (PPC64 && ALTIVEC) || (ARM64 && KERNEL_MODE_NEON)) + help + Choose this option if you want to use the new display engine + support for AMDGPU. This adds required support for Vega and +diff --git a/drivers/i2c/busses/i2c-designware-platdrv.c b/drivers/i2c/busses/i2c-designware-platdrv.c +index 855b698e9..6ab38151c 100644 +--- a/drivers/i2c/busses/i2c-designware-platdrv.c ++++ b/drivers/i2c/busses/i2c-designware-platdrv.c +@@ -57,6 +57,7 @@ static const struct acpi_device_id dw_i2c_acpi_match[] = { + { "HISI02A2", 0 }, + { "HISI02A3", 0 }, + { "HYGO0010", ACCESS_INTR_MASK }, ++ { "PHYT0003", 0 }, + { } + }; + MODULE_DEVICE_TABLE(acpi, dw_i2c_acpi_match); +diff --git a/drivers/i3c/Makefile b/drivers/i3c/Makefile +index 11982efbc..02d9b450f 100644 +--- a/drivers/i3c/Makefile ++++ b/drivers/i3c/Makefile +@@ -1,4 +1,5 @@ + # SPDX-License-Identifier: GPL-2.0 + i3c-y := device.o master.o + obj-$(CONFIG_I3C) += i3c.o ++i3c-$(CONFIG_ACPI) += i3c_master_acpi.o + obj-$(CONFIG_I3C) += master/ +diff --git a/drivers/i3c/i3c_master_acpi.c b/drivers/i3c/i3c_master_acpi.c +new file mode 100644 +index 000000000..9346d882a +--- /dev/null ++++ b/drivers/i3c/i3c_master_acpi.c +@@ -0,0 +1,95 @@ ++// SPDX-License-Identifier: GPL-2.0 ++/* ++ * Driver for I3C ACPI Interface ++ * ++ * Copyright (C) 2021-2023 Phytium Technology Co., Ltd. ++ */ + -+ return 0; -+} ++#include ++#include ++#include ++#include ++#include ++#include "i3c_master_acpi.h" + -+static int abortActuallyUsbRequest(struct HOST_CTRL *priv, -+ struct HOST_REQ *req, struct HOST_EP *usbEp) ++static int i3c_master_acpi_parse_val(union acpi_object *store_elements, char *method, ++ int count, u32 *value) +{ -+ struct HOST_EP_PRIV *usbEpPriv; -+ struct HostEp *hostEp; -+ uint8_t rxcon, txcon; -+ -+ if (!priv || !req || !usbEp) -+ return -EINVAL; ++ int i, package_count, ret = -1; ++ union acpi_object *acpi_elements; + -+ usbEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; -+ hostEp = usbEpPriv->currentHwEp; ++ for (i = 0; i < count; i++) { ++ acpi_elements = store_elements; ++ if (acpi_elements[i].type == ACPI_TYPE_PACKAGE) { ++ package_count = acpi_elements[i].package.count; + -+ usbEpPriv->transferFinished = 1; -+ if (hostEp->isInEp) { -+ if (hostEp->hwEpNum) { -+ rxcon = phytium_read8(&priv->regs->ep[hostEp->hwEpNum - 1].rxcon); -+ rxcon = rxcon & (~BIT(7)); -+ phytium_write8(&priv->regs->ep[hostEp->hwEpNum - 1].rxcon, rxcon); -+ } -+ } else { -+ if (hostEp->hwEpNum) { -+ txcon = phytium_read8(&priv->regs->ep[hostEp->hwEpNum - 1].txcon); -+ txcon = txcon & (~BIT(7)); -+ phytium_write8(&priv->regs->ep[hostEp->hwEpNum - 1].txcon, txcon); ++ if (package_count == 2) { ++ acpi_elements = acpi_elements[i].package.elements; ++ if (acpi_elements[0].type == ACPI_TYPE_STRING) { ++ if (!strcmp(acpi_elements[0].string.pointer, method)) { ++ *value = acpi_elements[1].integer.value; ++ ret = 0; ++ break; ++ } ++ } ++ } + } + } -+ abortTransfer(priv, req, hostEp); -+ -+ return 0; -+} -+ -+int32_t hostReqDequeue(struct HOST_CTRL *priv, struct HOST_REQ *req, uint32_t status) -+{ -+ struct HOST_EP *usbEp; -+ struct HOST_EP_PRIV *usbEpPriv; -+ int ret = 0; -+ -+ if (!priv || !req) -+ return -EINVAL; -+ -+ usbEp = req->usbEp; -+ usbEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; -+ -+ pr_debug("Dequeue usbReq:%p dev%d usbEp%d%s\n", req, req->faddress, req->epNum, -+ req->epIsIn ? "in" : "out"); -+ -+ if (!usbEpPriv->epIsReady) -+ return 0; -+ -+ if (!usbEpPriv->currentHwEp || req->list.prev != &usbEp->reqList) { -+ givebackRequest(priv, req, status); -+ if (list_empty(&usbEp->reqList)) { -+ usbEpPriv->epIsReady = 0; -+ usbEpPriv->currentHwEp = NULL; -+ if (usb_endpoint_xfer_int(&usbEp->desc)) -+ list_del(&usbEpPriv->node); -+ } -+ } else -+ ret = abortActuallyUsbRequest(priv, req, usbEp); -+ -+ if (usbEpPriv->isocEpConfigured) -+ usbEpPriv->isocEpConfigured = 0; -+ + return ret; +} + -+int32_t hostVHubStatusData(struct HOST_CTRL *priv, uint8_t *status) -+{ -+ return 0; -+} -+ -+int32_t hostGetDevicePD(struct HOST_CTRL *priv) -+{ -+ return 0; -+} -+ -+int32_t hostGetPrivateDataSize(struct HOST_CTRL *priv) -+{ -+ if (!priv) -+ return 0; -+ -+ return sizeof(struct HOST_EP_PRIV); -+} -+ -+static int hub_descriptor(struct usb_hub_descriptor *buf) -+{ -+ buf->bDescLength = 9; -+ buf->bDescriptorType = 0x29; -+ buf->bNbrPorts = 1; -+ buf->wHubCharacteristics = 0x11; -+ buf->bPwrOn2PwrGood = 5; -+ buf->bHubContrCurrent = 0; -+ buf->u.hs.DeviceRemovable[0] = 0x2; -+ -+ return 0; -+} -+ -+static int HubPortSuspend(struct HOST_CTRL *priv, u16 on) ++int i3c_master_acpi_get_params(acpi_handle handle, char *method, u32 *value) +{ -+ uint8_t otgctrl; ++ struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER }; ++ acpi_status status = 0; ++ union acpi_object *obj; ++ int count, ret = -1; + -+ if (!priv) -+ return 0; ++ status = acpi_evaluate_object(handle, "_DSD", NULL, &buf); ++ if (ACPI_FAILURE(status)) { ++ kfree(buf.pointer); ++ return -2; ++ } + -+ otgctrl = phytium_read8(&priv->regs->otgctrl); ++ obj = (union acpi_object *)buf.pointer; + -+ if (on) { -+ otgctrl &= ~OTGCTRL_BUSREQ; -+ otgctrl &= ~OTGCTRL_BHNPEN; ++ if (obj->type == ACPI_TYPE_PACKAGE) { ++ union acpi_object *acpi_elements; ++ union acpi_object *store_elements; + -+ priv->portStatus |= USB_PORT_STAT_SUSPEND; ++ acpi_elements = obj->package.elements; ++ if ((obj->package.count >= 2) && (acpi_elements[1].type == ACPI_TYPE_PACKAGE)) { ++ count = acpi_elements[1].package.count; ++ acpi_elements = acpi_elements[1].package.elements; + -+ switch (phytium_read8(&priv->regs->otgstate)) { -+ case HOST_OTG_STATE_A_HOST: -+ priv->otgState = HOST_OTG_STATE_A_SUSPEND; -+ otgctrl |= OTGCTRL_ASETBHNPEN; -+ break; -+ case HOST_OTG_STATE_B_HOST: -+ priv->otgState = HOST_OTG_STATE_B_HOST_2; -+ break; -+ default: -+ break; ++ store_elements = acpi_elements; ++ ret = i3c_master_acpi_parse_val(store_elements, method, count, value); + } -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ } else { -+ otgctrl |= OTGCTRL_BUSREQ; -+ otgctrl &= ~OTGCTRL_ASETBHNPEN; -+ phytium_write8(&priv->regs->otgctrl, otgctrl); -+ priv->portStatus |= USB_PORT_STAT_RESUME; + } -+ return 0; ++ ++ kfree(buf.pointer); ++ return ret; +} ++EXPORT_SYMBOL_GPL(i3c_master_acpi_get_params); + -+static void HubPortReset(struct HOST_CTRL *priv, uint8_t on) ++void i3c_master_acpi_clk_params(acpi_handle handle, char *method, ++ u32 *pres_ctrl0, u32 *pres_ctrl1, u32 *thd_delay) +{ -+ uint8_t speed; ++ struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER }; ++ union acpi_object *obj; + -+ if (!priv) ++ if (ACPI_FAILURE(acpi_evaluate_object(handle, method, NULL, &buf))) + return; + -+ if (on) { -+ phytium_write16(&priv->regs->txerrirq, 0xFFFF); -+ phytium_write16(&priv->regs->txirq, 0xFFFF); -+ phytium_write16(&priv->regs->rxerrirq, 0xFFFF); -+ phytium_write16(&priv->regs->rxirq, 0xFFFF); -+ -+ phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | -+ ENDPRST_TOGRST | ENDPRST_IO_TX); -+ phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x04); -+ phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | -+ FIFOCTRL_IO_TX | 0 | 0x04); -+ -+ priv->portStatus |= USB_PORT_STAT_RESET; -+ priv->portStatus &= ~USB_PORT_STAT_ENABLE; -+ priv->port_resetting = 0; -+ } else { -+ speed = phytium_read8(&priv->regs->speedctrl); -+ if (speed == SPEEDCTRL_HS) -+ priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; -+ else if (speed == SPEEDCTRL_FS) -+ priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); -+ else -+ priv->portStatus |= USB_PORT_STAT_LOW_SPEED; -+ -+ priv->portStatus &= ~USB_PORT_STAT_RESET; -+ priv->portStatus |= USB_PORT_STAT_ENABLE | (USB_PORT_STAT_C_RESET << 16) -+ | (USB_PORT_STAT_C_ENABLE << 16); ++ obj = (union acpi_object *)buf.pointer; ++ if (obj->type == ACPI_TYPE_PACKAGE && obj->package.count == 3) { ++ const union acpi_object *objs = obj->package.elements; + -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); ++ *pres_ctrl0 = (u32)objs[0].integer.value; ++ *pres_ctrl1 = (u32)objs[1].integer.value; ++ *thd_delay = (u32)objs[2].integer.value; + } -+} -+ -+static int get_PortStatus(struct HOST_CTRL *priv, u16 wIndex, uint8_t *buff) -+{ -+ uint32_t temp = 0; -+ -+ if (!priv || !buff) -+ return 0; + -+ if ((wIndex & 0xff) != 1) -+ return 1; ++ kfree(buf.pointer); ++} ++EXPORT_SYMBOL_GPL(i3c_master_acpi_clk_params); +diff --git a/drivers/i3c/i3c_master_acpi.h b/drivers/i3c/i3c_master_acpi.h +new file mode 100644 +index 000000000..61fa62ff1 +--- /dev/null ++++ b/drivers/i3c/i3c_master_acpi.h +@@ -0,0 +1,18 @@ ++/* SPDX-License-Identifier: GPL-2.0 */ ++/* ++ * Driver for I3C ACPI Interface ++ * ++ * Copyright (C) 2021-2023 Phytium Technology Co., Ltd. ++ */ + -+ if (priv->portStatus & USB_PORT_STAT_RESET) { -+ if (!priv->port_resetting) -+ HubPortReset(priv, 0); -+ } ++#ifndef __I3C_MASTER_ACPI_H ++#define __I3C_MASTER_ACPI_H + -+ if (priv->portStatus & USB_PORT_STAT_RESUME) { -+ priv->portStatus &= ~(USB_PORT_STAT_SUSPEND | USB_PORT_STAT_RESUME); -+ priv->portStatus |= USB_PORT_STAT_C_SUSPEND << 16; -+ if (priv->hostCallbacks.portStatusChange) -+ priv->hostCallbacks.portStatusChange(priv); -+ } ++#include ++#include + -+ temp = priv->portStatus & (~USB_PORT_STAT_RESUME); -+ buff[0] = temp; -+ buff[1] = temp >> 8; -+ buff[2] = temp >> 16; -+ buff[3] = temp >> 24; ++int i3c_master_acpi_get_params(acpi_handle handle, char *method, u32 *value); ++void i3c_master_acpi_clk_params(acpi_handle handle, char *method, ++ u32 *pres_ctrl0, u32 *pres_ctrl1, u32 *thd_delay); + -+ return 0; -+} ++#endif +diff --git a/drivers/i3c/master.c b/drivers/i3c/master.c +index 0e9ff5500..826f2877d 100644 +--- a/drivers/i3c/master.c ++++ b/drivers/i3c/master.c +@@ -5,6 +5,8 @@ + * Author: Boris Brezillon + */ + ++#include ++#include + #include + #include + #include +@@ -17,8 +19,25 @@ + #include + #include + ++#ifdef CONFIG_ACPI ++#include "i3c_master_acpi.h" ++#endif + #include "internals.h" + ++struct i3c_acpi_lookup { ++ u64 pid; ++ acpi_handle adapter_handle; ++ acpi_handle device_handle; ++ acpi_handle search_handle; ++ int n; ++ int index; ++ u32 speed; ++ u32 min_speed; ++ u32 force_speed; ++ u32 slave_address; ++ u32 lvr; ++}; + -+static int set_PortFeature(struct HOST_CTRL *priv, u16 wValue, u16 wIndex) + static DEFINE_IDR(i3c_bus_idr); + static DEFINE_MUTEX(i3c_core_lock); + static int __i3c_first_dynamic_bus_num; +@@ -263,6 +282,88 @@ static ssize_t modalias_show(struct device *dev, + } + static DEVICE_ATTR_RO(modalias); + ++static ssize_t reg_read_store(struct device *dev, ++ struct device_attribute *da, ++ const char *buf, size_t size) +{ -+// struct HW_Regs *regs = priv->regs; ++ struct i3c_device *i3c = dev_to_i3cdev(dev); ++ struct i3c_priv_xfer xfers[2]; ++ u8 status = 0; ++ long value; ++ __u8 reg; ++ __u8 val; + -+ if ((wIndex & 0xff) != 1) -+ return 1; ++ status = kstrtol(buf, 0, &value); ++ if (status) ++ return status; + -+ switch (wValue) { -+ case USB_PORT_FEAT_CONNECTION: -+ break; -+ case USB_PORT_FEAT_ENABLE: -+ break; -+ case USB_PORT_FEAT_SUSPEND: -+ HubPortSuspend(priv, 1); -+ break; -+ case USB_PORT_FEAT_OVER_CURRENT: -+ break; -+ case USB_PORT_FEAT_RESET: -+ HubPortReset(priv, 1); -+ break; -+ case USB_PORT_FEAT_L1: -+ break; -+ case USB_PORT_FEAT_POWER: -+ hostStart(priv); -+ break; -+ case USB_PORT_FEAT_LOWSPEED: -+ break; -+ case USB_PORT_FEAT_C_CONNECTION: -+ break; -+ case USB_PORT_FEAT_C_ENABLE: -+ break; -+ case USB_PORT_FEAT_C_SUSPEND: -+ break; -+ case USB_PORT_FEAT_C_OVER_CURRENT: -+ break; -+ case USB_PORT_FEAT_INDICATOR: -+ break; -+ case USB_PORT_FEAT_C_PORT_L1: -+ break; -+ default: -+ break; -+ } -+ priv->portStatus |= 1 << wValue; ++ reg = (__u8)value; + -+ return 0; -+} ++ xfers[0].rnw = false; ++ xfers[0].len = 1; ++ xfers[0].data.out = ® + -+static int Clear_PortFeature(struct HOST_CTRL *priv, u16 wValue, u16 wIndex) -+{ -+ if ((wIndex & 0xff) != 1) -+ return 1; ++ xfers[1].rnw = true; ++ xfers[1].len = 1; ++ xfers[1].data.in = &val; + -+ switch (wValue) { -+ case USB_PORT_FEAT_CONNECTION: -+ break; -+ case USB_PORT_FEAT_ENABLE: -+ break; -+ case USB_PORT_FEAT_SUSPEND: -+ HubPortSuspend(priv, 0); -+ break; -+ case USB_PORT_FEAT_OVER_CURRENT: -+ break; -+ case USB_PORT_FEAT_RESET: -+ break; -+ case USB_PORT_FEAT_L1: -+ break; -+ case USB_PORT_FEAT_POWER: -+ break; -+ case USB_PORT_FEAT_LOWSPEED: -+ break; -+ case USB_PORT_FEAT_C_CONNECTION: -+ break; -+ case USB_PORT_FEAT_C_ENABLE: -+ break; -+ case USB_PORT_FEAT_C_SUSPEND: -+ break; -+ case USB_PORT_FEAT_C_OVER_CURRENT: -+ break; -+ case USB_PORT_FEAT_INDICATOR: -+ break; -+ case USB_PORT_FEAT_C_PORT_L1: -+ break; -+ default: -+ break; -+ } -+ priv->portStatus &= ~(1 << wValue); ++ i3c_bus_normaluse_lock(i3c->bus); ++ i3c_device_do_priv_xfers(i3c, xfers, 2); ++ dev_info(dev, "reg read reg =0x%x, val=%x\n", reg, val); ++ i3c_bus_normaluse_unlock(i3c->bus); + -+ return 0; ++ return size; +} ++static DEVICE_ATTR_WO(reg_read); + -+static int hc_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue, -+ u16 wIndex, char *buf, u16 wLength) ++static ssize_t reg_write_store(struct device *dev, ++ struct device_attribute *da, ++ const char *buf, size_t size) +{ -+ unsigned long flags = 0; -+ int retval = 0; -+ struct HOST_CTRL *priv; -+ struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; ++ struct i3c_device *i3c = dev_to_i3cdev(dev); ++ struct i3c_priv_xfer xfers[2]; ++ u8 status = 0; ++ char *p; ++ char *token; ++ long value; ++ __u8 reg; ++ u16 val; + -+ if (!config) -+ return -EINVAL; ++ p = kmalloc(size, GFP_KERNEL); ++ strscpy(p, buf, size); ++ token = strsep(&p, " "); + -+ if (!buf) ++ if (!token) + return -EINVAL; + -+ if (unlikely(!HCD_HW_ACCESSIBLE(hcd))) { -+ spin_unlock_irqrestore(&config->lock, flags); -+ return -ESHUTDOWN; -+ } ++ status = kstrtol(token, 0, &value); ++ if (status) ++ return status; + -+ priv = (struct HOST_CTRL *)config->host_priv; -+ if (!priv) ++ reg = (u8)value; ++ token = strsep(&p, " "); ++ if (!token) + return -EINVAL; + -+ spin_lock_irqsave(&config->lock, flags); -+ switch (typeReq) { -+ case GetHubStatus: -+ break; -+ case GetPortStatus: -+ get_PortStatus(priv, wIndex, (uint8_t *)buf); -+ break; -+ case GetHubDescriptor: -+ hub_descriptor((struct usb_hub_descriptor *)buf); -+ break; -+ case SetPortFeature: -+ set_PortFeature(priv, wValue, wIndex); -+ break; -+ case ClearPortFeature: -+ retval = Clear_PortFeature(priv, wValue, wIndex); -+ break; -+ case SetHubFeature: -+ break; -+ case ClearHubFeature: -+ break; -+ default: -+ break; -+ } -+ -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return retval; -+} -+ -+int32_t hostVHubControl(struct HOST_CTRL *priv, struct usb_ctrlrequest *setup, uint8_t *buff) -+{ -+ uint16_t request; -+ uint32_t retval = 0; ++ status = kstrtol(token, 0, &value); ++ if (status) ++ return status; + -+ if (!priv || !setup || !buff) -+ return -EINVAL; ++ val = ((u8)value << 8) | reg; ++ xfers[0].rnw = false; ++ xfers[0].len = 2; ++ xfers[0].data.out = &val; + -+ request = setup->bRequestType << 0x08 | setup->bRequest; -+ switch (request) { -+ case ClearHubFeature: -+ break; -+ case SetHubFeature: -+ break; -+ case ClearPortFeature: -+ retval = Clear_PortFeature(priv, setup->wValue, setup->wIndex); -+ break; -+ case SetPortFeature: -+ retval = set_PortFeature(priv, setup->wValue, setup->wIndex); -+ break; -+ case GetHubDescriptor: -+ retval = hub_descriptor((struct usb_hub_descriptor *)buff); -+ break; -+ case GetHubStatus: -+ break; -+ case GetPortStatus: -+ retval = get_PortStatus(priv, setup->wIndex, (uint8_t *)buff); -+ break; -+ default: -+ retval = EOPNOTSUPP; -+ break; -+ } ++ i3c_bus_normaluse_lock(i3c->bus); ++ i3c_device_do_priv_xfers(i3c, xfers, 1); ++ dev_info(dev, "reg write reg =0x%x, val=%x\n", reg, val); ++ i3c_bus_normaluse_unlock(i3c->bus); + -+ return retval; ++ kfree(p); ++ return size; +} ++static DEVICE_ATTR_WO(reg_write); + -+struct HOST_OBJ hostDrv = { -+ .host_init = hostInit, -+ .host_destroy = hostDestroy, -+ .host_start = hostStart, -+ .host_stop = hostStop, -+ .host_isr = hostIsr, -+ -+ //endpoint operation -+ .host_epDisable = hostEpDisable, -+ .host_reqQueue = hostReqQueue, -+ .host_reqDequeue = hostReqDequeue, -+ .host_vhubStatusData = hostVHubStatusData, -+ .host_vhubControl = hostVHubControl, -+ .host_getDevicePD = hostGetDevicePD, -+ .host_epGetPrivateDataSize = hostGetPrivateDataSize, -+}; -+ -+static struct hc_driver host_driver = { -+ .description = "phytium-hcd", -+ .product_desc = "Phytium Host USB Driver", -+ .hcd_priv_size = sizeof(struct phytium_cusb *), -+ .flags = HCD_MEMORY | HCD_USB2 | HCD_DMA, -+ .reset = hc_reset, -+ .start = hc_start, -+ .stop = hc_stop, -+ .shutdown = hc_shutdown, -+ .urb_enqueue = hc_urb_enqueue, -+ .urb_dequeue = hc_urb_dequeue, -+ .endpoint_disable = hc_endpoint_disable, -+ .get_frame_number = hc_get_frame, -+ .alloc_dev = hc_alloc_dev, -+ .free_dev = hc_free_dev, -+ .reset_device = hc_reset_device, -+ .update_device = hc_update_device, -+ .add_endpoint = hc_add_endpoint, -+ .drop_endpoint = hc_drop_endpoint, -+ .hub_status_data = hc_hub_status_data, -+ .hub_control = hc_hub_control, -+#ifdef CONFIG_PM -+ .bus_suspend = hc_bus_suspend, -+ .bus_resume = hc_bus_resume, -+#endif -+}; -+ -+static int phytium_host_set_default_cfg(struct phytium_cusb *config) + static struct attribute *i3c_device_attrs[] = { + &dev_attr_bcr.attr, + &dev_attr_dcr.attr, +@@ -270,6 +371,8 @@ static struct attribute *i3c_device_attrs[] = { + &dev_attr_dynamic_address.attr, + &dev_attr_hdrcap.attr, + &dev_attr_modalias.attr, ++ &dev_attr_reg_read.attr, ++ &dev_attr_reg_write.attr, + NULL, + }; + ATTRIBUTE_GROUPS(i3c_device); +@@ -1521,9 +1624,10 @@ i3c_master_register_new_i3c_devs(struct i3c_master_controller *master) + dev_set_name(&desc->dev->dev, "%d-%llx", master->bus.id, + desc->info.pid); + +- if (desc->boardinfo) ++ if (desc->boardinfo) { + desc->dev->dev.of_node = desc->boardinfo->of_node; +- ++ desc->dev->dev.fwnode = desc->boardinfo->fwnode; ++ } + ret = device_register(&desc->dev->dev); + if (ret) { + dev_err(&master->dev, +@@ -2148,6 +2252,183 @@ static int of_populate_i3c_bus(struct i3c_master_controller *master) + return 0; + } + ++#ifdef CONFIG_ACPI ++static int i3c_acpi_master_add_i2c_boardinfo(struct i3c_master_controller *master, ++ struct acpi_device *adev, struct i3c_acpi_lookup *look_up) +{ -+ int index; -+ -+ config->host_cfg.regBase = (uintptr_t)config->regs; -+ config->host_cfg.phy_regBase = (uintptr_t)config->phy_regs; -+ config->host_cfg.dmultEnabled = 1; -+ config->host_cfg.memoryAlignment = 0; -+ config->host_cfg.dmaSupport = 1; -+ config->host_cfg.isEmbeddedHost = 1; -+ -+ for (index = 0; index < HOST_EP_NUM; index++) { -+ if (index == 0) { -+ config->host_cfg.epIN[index].bufferingValue = 1; -+ config->host_cfg.epIN[index].maxPacketSize = 64; -+ config->host_cfg.epIN[index].startBuf = 0; -+ -+ config->host_cfg.epOUT[index].bufferingValue = 1; -+ config->host_cfg.epOUT[index].maxPacketSize = 64; -+ config->host_cfg.epOUT[index].startBuf = 0; -+ } else { -+ config->host_cfg.epIN[index].bufferingValue = 2; -+ config->host_cfg.epIN[index].maxPacketSize = 1024; -+ config->host_cfg.epIN[index].startBuf = 64 + 2 * 1024 * (index - 1); -+ -+ config->host_cfg.epOUT[index].bufferingValue = 2; -+ config->host_cfg.epOUT[index].maxPacketSize = 1024; -+ config->host_cfg.epOUT[index].startBuf = 64 + 2 * 1024 * (index - 1); -+ } -+ } -+ -+ return 0; -+} ++ struct i2c_dev_boardinfo *boardinfo; ++ struct device *dev = &master->dev; ++ u32 addr = look_up->slave_address; + -+static int phytium_host_reinit(struct phytium_cusb *config) -+{ -+ struct HOST_CTRL *ctrl; ++ boardinfo = devm_kzalloc(dev, sizeof(*boardinfo), GFP_KERNEL); ++ if (!boardinfo) ++ return -ENOMEM; + -+ if (!config || !config->host_priv) -+ return 0; ++ boardinfo->base.addr = addr; ++ acpi_set_modalias(adev, dev_name(&adev->dev), boardinfo->base.type, ++ sizeof(boardinfo->base.type)); ++ boardinfo->base.fwnode = acpi_fwnode_handle(adev); + -+ ctrl = (struct HOST_CTRL *)config->host_priv; ++ /* ++ * The I3C Specification does not clearly say I2C devices with 10-bit ++ * address are supported. These devices can't be passed properly through ++ * DEFSLVS command. ++ */ ++ if (boardinfo->base.flags & I2C_CLIENT_TEN) { ++ dev_err(dev, "I2C device with 10 bit address not supported."); ++ return -EOPNOTSUPP; ++ } + -+ usb_root_hub_lost_power(config->hcd->self.root_hub); -+ hostStop(ctrl); ++ boardinfo->lvr = look_up->lvr; + -+ ctrl->portStatus = 0; ++ /* If the client speed is smaller than controller speed, ++ * then set the controller speed to the client speed ++ */ ++ if (look_up->speed && look_up->speed < master->bus.scl_rate.i2c) ++ master->bus.scl_rate.i2c = look_up->speed; + -+ config->host_obj->host_init(config->host_priv, &config->host_cfg, -+ &config->host_callbacks, config->dev, config->isVhubHost); ++ list_add_tail(&boardinfo->node, &master->boardinfo.i2c); + + return 0; +} + -+int phytium_host_init(struct phytium_cusb *config) ++static int i3c_acpi_master_add_i3c_boardinfo(struct i3c_master_controller *master, ++ struct acpi_device *adev, acpi_handle handle, struct i3c_acpi_lookup *look_up) +{ -+ int ret; -+ -+ if (!config) -+ return 0; -+ -+ phytium_host_set_default_cfg(config); -+ config->host_obj = HOST_GetInstance(); -+ config->dma_cfg.regBase = config->host_cfg.regBase + 0x400; -+ -+ config->dma_obj = DMA_GetInstance(); -+ config->dma_obj->dma_probe(&config->dma_cfg, &config->dma_sysreq); ++ struct i3c_dev_boardinfo *boardinfo; ++ struct device *dev = &master->dev; ++ enum i3c_addr_slot_status addrstatus; ++ u32 init_dyn_addr = 0; + -+ config->host_sysreq.privDataSize = sizeof(struct HOST_CTRL); -+ config->host_sysreq.trbMemSize = config->dma_sysreq.trbMemSize; -+ config->host_sysreq.privDataSize += config->dma_sysreq.privDataSize; ++ boardinfo = devm_kzalloc(dev, sizeof(*boardinfo), GFP_KERNEL); ++ if (!boardinfo) ++ return -ENOMEM; + -+ config->host_priv = devm_kzalloc(config->dev, config->host_sysreq.privDataSize, GFP_KERNEL); -+ if (!config->host_priv) { -+ ret = -ENOMEM; -+ goto err_probe; -+ } ++ if (look_up->slave_address) { ++ if (look_up->slave_address > I3C_MAX_ADDR) ++ return -EINVAL; + -+ config->host_cfg.trbAddr = dma_alloc_coherent(config->dev, config->host_sysreq.trbMemSize, -+ (dma_addr_t *)&config->host_cfg.trbDmaAddr, GFP_KERNEL); -+ if (!config->host_cfg.trbAddr) { -+ ret = -ENOMEM; -+ goto err_dma_coherent; ++ addrstatus = i3c_bus_get_addr_slot_status(&master->bus, look_up->slave_address); ++ if (addrstatus != I3C_ADDR_SLOT_FREE) ++ return -EINVAL; + } + -+ config->host_callbacks.portStatusChange = host_rh_port_status_change; -+ config->host_callbacks.getEpToggle = host_get_ep_toggle; -+ config->host_callbacks.setEpToggle = host_set_ep_toggle; -+ config->host_callbacks.givebackRequest = host_giveback_request; -+ -+ config->host_obj->host_init(config->host_priv, &config->host_cfg, -+ &config->host_callbacks, config->dev, config->isVhubHost); ++ boardinfo->static_addr = look_up->slave_address; ++ boardinfo->pid = look_up->pid; + -+ config->hcd = usb_create_hcd(&host_driver, config->dev, dev_name(config->dev)); -+ if (!config->hcd) { -+ ret = -ENODEV; -+ goto err_host; -+ } ++ if ((boardinfo->pid & GENMASK_ULL(63, 48)) || ++ I3C_PID_RND_LOWER_32BITS(boardinfo->pid)) ++ return -EINVAL; + -+ *config->hcd->hcd_priv = (unsigned long)config; -+ config->hcd->self.uses_pio_for_control = 0; -+ config->hcd->uses_new_polling = 1; -+ config->hcd->has_tt = 1; ++ boardinfo->init_dyn_addr = init_dyn_addr; ++ boardinfo->fwnode = acpi_fwnode_handle(adev); + -+ dev_set_drvdata(config->dev, config); ++ /* If the client speed is smaller than controller speed, ++ * then set the controller speed to the client speed ++ */ ++ if (look_up->speed && look_up->speed < master->bus.scl_rate.i3c) ++ master->bus.scl_rate.i3c = look_up->speed; + -+ config->hcd->self.otg_port = 1; -+ config->hcd->power_budget = 500; -+ ret = usb_add_hcd(config->hcd, 0, 0); -+ if (ret < 0) -+ goto err_setup; ++ list_add_tail(&boardinfo->node, &master->boardinfo.i3c); + + return 0; -+err_setup: -+ usb_put_hcd(config->hcd); -+err_host: -+ config->host_obj->host_destroy(config->host_priv); -+ dma_free_coherent(config->dev, config->host_sysreq.trbMemSize, -+ config->host_cfg.trbAddr, config->host_cfg.trbDmaAddr); -+err_dma_coherent: -+err_probe: -+ dev_set_drvdata(config->dev, NULL); -+ return ret; +} + -+int phytium_host_uninit(struct phytium_cusb *config) ++static int i3c_acpi_master_get_resource(struct acpi_resource *ares, void *data) +{ -+ if (!config) -+ return 0; ++ struct i3c_acpi_lookup *look_up = (struct i3c_acpi_lookup *)data; ++ struct acpi_resource_i2c_serialbus *sb; ++ bool ret; + -+ if (config->hcd) { -+ usb_remove_hcd(config->hcd); -+ usb_put_hcd(config->hcd); -+ config->hcd = NULL; ++ ret = i2c_acpi_get_i2c_resource(ares, &sb); ++ if (ret == true) { ++ look_up->slave_address = sb->slave_address; ++ look_up->speed = sb->connection_speed; + } + + return 0; +} + -+#ifdef CONFIG_PM -+int phytium_host_resume(void *priv) ++static int i3c_acpi_master_get_slave_info(struct i3c_master_controller *master, ++ struct acpi_device *adev, struct i3c_acpi_lookup *look_up) +{ -+ int otgctrl; -+ struct phytium_cusb *config = (struct phytium_cusb *)priv; -+ struct HOST_CTRL *ctrl = (struct HOST_CTRL *)config->host_priv; -+ -+ if (!ctrl) -+ return -EINVAL; -+ -+ otgctrl = phytium_read8(&ctrl->regs->otgctrl); -+ otgctrl |= 1; -+ phytium_write8(&ctrl->regs->otgctrl, otgctrl); ++ struct list_head resource_list; ++ int ret; + -+ phytium_host_reinit(config); ++ /* Look up for I2cSerialBus resource */ ++ INIT_LIST_HEAD(&resource_list); ++ ret = acpi_dev_get_resources(adev, &resource_list, ++ i3c_acpi_master_get_resource, look_up); ++ acpi_dev_free_resource_list(&resource_list); + -+ return 0; ++ return ret; +} + -+int phytium_host_suspend(void *priv) ++ ++static bool i3c_master_check_cpu_workaround(void) +{ -+ int otgctrl; -+ struct phytium_cusb *config = (struct phytium_cusb *)priv; -+ struct HOST_CTRL *ctrl = (struct HOST_CTRL *)config->host_priv; ++ u32 cpu_implementor; + -+ if (!ctrl) -+ return -EINVAL; ++ cpu_implementor = read_cpuid_implementor(); + -+ otgctrl = phytium_read8(&ctrl->regs->otgctrl); -+ otgctrl = otgctrl & (~1); -+ phytium_write8(&ctrl->regs->otgctrl, otgctrl); ++ if (cpu_implementor == ARM_CPU_IMP_PHYTIUM) ++ return true; + -+ return 0; ++ return false; +} -+#endif + -+struct HOST_OBJ *HOST_GetInstance(void) ++static int i3c_acpi_master_add_dev(struct acpi_device *adev, void *data) +{ -+ return &hostDrv; -+} -diff --git a/drivers/usb/phytium/host_api.h b/drivers/usb/phytium/host_api.h -new file mode 100644 -index 000000000..b99d2b498 ---- /dev/null -+++ b/drivers/usb/phytium/host_api.h -@@ -0,0 +1,251 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+ -+#ifndef __PHYTIUM_HOST_API_H_ -+#define __PHYTIUM_HOST_API_H_ -+ -+#include -+//#include "list.h" -+#include "dma.h" -+ -+#define MAX_SUPPORTED_DEVICES 16 -+#define USB_PORT_STAT_RESUME (1 << 31) -+#define MAX_INSTANCE_EP_NUM 6 -+#define ENDPOINT_DIR 2 -+ -+enum HOST_OtgState { -+ HOST_OTG_STATE_A_IDLE, -+ HOST_OTG_STATE_A_WAIT_VRISE, -+ HOST_OTG_STATE_A_WAIT_BCON, -+ HOST_OTG_STATE_A_HOST, -+ HOST_OTG_STATE_A_SUSPEND, -+ HOST_OTG_STATE_A_PERIPHERAL, -+ HOST_OTG_STATE_A_VBUS_ERR, -+ HOST_OTG_STATE_A_WAIT_VFALL, -+ HOST_OTG_STATE_B_IDLE = 0x10, -+ HOST_OTG_STATE_B_PERIPHERAL, -+ HOST_OTG_STATE_B_WAIT_ACON, -+ HOST_OTG_STATE_B_HOST, -+ HOST_OTG_STATE_B_HOST_2, -+ HOST_OTG_STATE_B_SRP_INT1, -+ HOST_OTG_STATE_B_SRP_INT2, -+ HOST_OTG_STATE_B_DISCHRG1, -+ HOST_OTG_STATE_B_DISCHRG2, -+ HOST_OTG_STATE_UNKNOWN, -+}; -+ -+enum HOST_EP0_STAGE { -+ HOST_EP0_STAGE_IDLE, -+ HOST_EP0_STAGE_SETUP, -+ HOST_EP0_STAGE_IN, -+ HOST_EP0_STAGE_OUT, -+ HOST_EP0_STAGE_STATUSIN, -+ HOST_EP0_STAGE_STATUSOUT, -+ HOST_EP0_STAGE_ACK, -+}; -+ -+enum HOST_EP_STATE { -+ HOST_EP_FREE, -+ HOST_EP_ALLOCATED, -+ HOST_EP_BUSY, -+ HOST_EP_NOT_IMPLEMENTED -+}; -+ -+struct HOST_DEVICE { -+ uint8_t devnum; -+ uint8_t hubPort; -+ unsigned int speed; -+ struct HOST_DEVICE *parent; -+ void *hcPriv; -+ void *userExt; -+}; -+ -+struct HOST_EP { -+ struct usb_endpoint_descriptor desc; -+ struct list_head reqList; -+ void *userExt; -+ uint8_t *hcPriv; -+ uint8_t device_epNum; -+}; -+ -+struct HOST_USB_DEVICE { -+ struct HOST_EP ep0_hep; -+ struct HOST_EP *in_ep[16]; -+ struct HOST_EP *out_ep[16]; -+ struct HOST_DEVICE udev; -+ struct usb_device *ld_udev; -+}; -+ -+struct HostEp { -+ uint8_t name[255]; -+ uint8_t hwEpNum; -+ uint8_t hwBuffers; -+ uint16_t hwMaxPacketSize; -+ uint8_t isInEp; -+ void *channel; -+ uint8_t usbEpNum; -+ uint8_t type; -+ uint8_t usbPacketSize; -+ enum HOST_EP_STATE state; -+ struct HOST_EP *scheduledUsbHEp; -+ uint8_t refCount; -+}; -+ -+struct HOST_ISOFRAMESDESC { -+ uint32_t length; -+ uint32_t offset; -+}; -+ -+struct HOST_EP_PRIV { -+ struct list_head node; -+ struct HostEp *genericHwEp; -+ struct HostEp *currentHwEp; -+ uint8_t epIsReady; -+ uint8_t isIn; -+ uint8_t type; -+ uint8_t interval; -+ uint8_t epNum; -+ uint8_t faddress; -+ uint16_t maxPacketSize; -+ uint32_t frame; -+ uint8_t hubAddress; -+ uint8_t portAddress; -+ uint8_t split; -+ struct HOST_EP *usbHEp; -+ uint8_t isocEpConfigured; -+ uint8_t transferFinished; -+}; -+ -+struct HOST_REQ { -+ struct list_head list; -+ struct HOST_EP *usbEp; -+ void *userExt; -+ void *hcPriv; -+ struct HOST_DEVICE *usbDev; -+ struct usb_ctrlrequest *setup; -+ uintptr_t setupDma; -+ void *bufAddress; -+ uintptr_t buffDma; -+ uint32_t buffLength; -+ uint32_t actualLength; -+ uint8_t epIsIn; -+ uint8_t eptype; -+ uint8_t epNum; -+ uint8_t faddress; -+ uint8_t interval; -+ uint8_t status; -+ uint8_t reqUnlinked; -+ struct HOST_ISOFRAMESDESC *isoFramesDesc; -+ uint32_t isoFramesNumber; -+}; -+ -+struct HOST_SYSREQ { -+ uint32_t privDataSize; -+ uint32_t trbMemSize; -+}; -+ -+struct HOST_EP_CFG { -+ uint8_t bufferingValue; -+ uint16_t startBuf; -+ uint16_t maxPacketSize; -+}; -+ -+struct HOST_CFG { -+ uintptr_t regBase; -+ uintptr_t phy_regBase; -+ struct HOST_EP_CFG epIN[16]; -+ struct HOST_EP_CFG epOUT[16]; -+ uint8_t dmultEnabled; -+ uint8_t memoryAlignment; -+ uint8_t dmaSupport; -+ uint8_t isEmbeddedHost; -+ void *trbAddr; -+ uintptr_t trbDmaAddr; -+}; -+ -+struct HOST_CTRL; -+ -+struct HOST_CALLBACKS { -+ void (*portStatusChange)(struct HOST_CTRL *priv); -+ -+ uint8_t (*getEpToggle)(struct HOST_CTRL *priv, -+ struct HOST_DEVICE *usbDev, uint8_t epNum, uint8_t isIn); -+ -+ void (*setEpToggle)(struct HOST_CTRL *priv, struct HOST_DEVICE *usbDev, -+ uint8_t epNum, uint8_t isIn, uint8_t toggle); -+ -+ void (*givebackRequest)(struct HOST_CTRL *priv, -+ struct HOST_REQ *usbReq, uint32_t status); -+ -+ void (*setTimer)(struct HOST_CTRL *priv, uint32_t time, uint8_t id); -+}; -+ -+struct HOST_OBJ { -+ int32_t (*host_probe)(struct HOST_CFG *config, struct HOST_SYSREQ *sysReq); -+ -+ int32_t (*host_init)(struct HOST_CTRL *priv, struct HOST_CFG *config, -+ struct HOST_CALLBACKS *callbacks, struct device *pdev, bool isVhubHost); -+ -+ void (*host_destroy)(struct HOST_CTRL *priv); -+ -+ void (*host_start)(struct HOST_CTRL *priv); -+ -+ void (*host_stop)(struct HOST_CTRL *priv); -+ -+ void (*host_isr)(struct HOST_CTRL *priv); ++ int ret = -1; ++ acpi_handle handle = adev->handle; ++ acpi_status status; ++ struct i3c_master_controller *master = (struct i3c_master_controller *)data; ++ u64 pid, lvr; ++ struct i3c_acpi_lookup look_up; ++ u32 mode_val; + -+ int32_t (*host_epDisable)(struct HOST_CTRL *priv, struct HOST_EP *ep); ++ i3c_acpi_master_get_slave_info(master, adev, &look_up); + -+ int32_t (*host_reqQueue)(struct HOST_CTRL *priv, struct HOST_REQ *req); ++ status = acpi_evaluate_integer(handle, "_ADR", NULL, &pid); + -+ int32_t (*host_reqDequeue)(struct HOST_CTRL *priv, -+ struct HOST_REQ *req, uint32_t status); ++ if (ACPI_SUCCESS(status)) ++ look_up.pid = pid; ++ else ++ look_up.pid = 0x202a0a0a0a0; + -+ int32_t (*host_vhubStatusData)(struct HOST_CTRL *priv, uint8_t *status); ++ if (i3c_master_check_cpu_workaround() == true) { ++ dev_info(&master->dev, "I3C ACPI SPECIAL KEYS\n"); ++ status = acpi_evaluate_integer(handle, "_LVR", NULL, &lvr); + -+ int32_t (*host_vhubControl)(struct HOST_CTRL *priv, -+ struct usb_ctrlrequest *setup, uint8_t *buff); ++ if (ACPI_SUCCESS(status)) ++ look_up.lvr = (u32)lvr; ++ else ++ look_up.lvr = 0; + -+ int32_t (*host_getDevicePD)(struct HOST_CTRL *priv); ++ ret = i3c_master_acpi_get_params(handle, "i3c-mode", &mode_val); ++ if (!ret) { ++ if (!mode_val) ++ i3c_acpi_master_add_i2c_boardinfo(master, adev, &look_up); ++ else ++ i3c_acpi_master_add_i3c_boardinfo(master, adev, handle, &look_up); ++ } ++ } ++ return 0; ++} + -+ int32_t (*host_epGetPrivateDataSize)(struct HOST_CTRL *priv); -+}; ++static void i3c_acpi_register_devices(struct i3c_master_controller *master) ++{ ++ struct acpi_device *adev = NULL; + -+struct HOST_CTRL { -+ struct device *dev; -+ struct HW_REGS *regs; -+ struct HOST_OBJ *hostDrv; -+ struct HOST_CFG hostCfg; -+ struct HOST_CALLBACKS hostCallbacks; -+ struct HostEp in[16]; -+ struct HostEp out[16]; -+ uint32_t portStatus; -+ struct list_head ctrlHEpQueue; -+ struct list_head isoInHEpQueue[MAX_INSTANCE_EP_NUM]; -+ struct list_head isoOutHEpQueue[MAX_INSTANCE_EP_NUM]; -+ struct list_head intInHEpQueue[MAX_INSTANCE_EP_NUM]; -+ struct list_head intOutHEpQueue[MAX_INSTANCE_EP_NUM]; -+ struct list_head bulkInHEpQueue[MAX_INSTANCE_EP_NUM]; -+ struct list_head bulkOutHEpQueue[MAX_INSTANCE_EP_NUM]; -+ uint8_t hwEpInCount; -+ uint8_t hwEpOutCount; -+ unsigned int speed; -+ enum HOST_OtgState otgState; -+ enum HOST_EP0_STAGE ep0State; -+ uint8_t vBusErrCnt; -+ uint8_t isRemoteWakeup; -+ uint8_t isSelfPowered; -+ uint8_t deviceAddress; -+ struct DMA_OBJ *dmaDrv; -+ void *dmaController; -+ struct DMA_CFG dmaCfg; -+ struct DMA_CALLBACKS dmaCallback; -+ uint8_t port_resetting; -+ struct HOST_USB_DEVICE *host_devices_table[MAX_SUPPORTED_DEVICES]; -+ struct CUSTOM_REGS *custom_regs; -+ struct VHUB_REGS *vhub_regs; -+ int ep_remap_pool[ENDPOINT_DIR][MAX_INSTANCE_EP_NUM + 1]; -+}; ++ if (!has_acpi_companion(master->dev.parent)) ++ return; + -+struct HOST_OBJ *HOST_GetInstance(void); ++ adev = acpi_fetch_acpi_dev(ACPI_HANDLE(master->dev.parent)); ++ if (adev) ++ acpi_dev_for_each_child(adev, i3c_acpi_master_add_dev, master); ++} ++#endif + + static int i3c_master_i2c_adapter_xfer(struct i2c_adapter *adap, + struct i2c_msg *xfers, int nxfers) + { +@@ -2311,7 +2592,7 @@ static int i3c_master_i2c_adapter_init(struct i3c_master_controller *master) + adap->dev.parent = master->dev.parent; + adap->owner = master->dev.parent->driver->owner; + adap->algo = &i3c_master_i2c_algo; +- strncpy(adap->name, dev_name(master->dev.parent), sizeof(adap->name)); ++ strscpy(adap->name, dev_name(master->dev.parent), sizeof(adap->name)); + + /* FIXME: Should we allow i3c masters to override these values? */ + adap->timeout = 1000; +@@ -2616,6 +2897,7 @@ int i3c_master_register(struct i3c_master_controller *master, + + master->dev.parent = parent; + master->dev.of_node = of_node_get(parent->of_node); ++ master->dev.fwnode = parent->fwnode; + master->dev.bus = &i3c_bus_type; + master->dev.type = &i3c_masterdev_type; + master->dev.release = i3c_masterdev_release; +@@ -2634,7 +2916,9 @@ int i3c_master_register(struct i3c_master_controller *master, + ret = of_populate_i3c_bus(master); + if (ret) + goto err_put_dev; +- ++#ifdef CONFIG_ACPI ++ i3c_acpi_register_devices(master); +#endif -diff --git a/drivers/usb/phytium/hw-regs.h b/drivers/usb/phytium/hw-regs.h -new file mode 100644 -index 000000000..8da9f8e9b ---- /dev/null -+++ b/drivers/usb/phytium/hw-regs.h -@@ -0,0 +1,297 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+#ifndef __LINUX_PHYTIUM_HW_REGS -+#define __LINUX_PHYTIUM_HW_REGS -+ -+#define USBIEN 0x198 -+#define USBIEN_SUDAVIE BIT(0) -+#define USBIEN_SOFIE BIT(1) -+#define USBIEN_SUTOKIE BIT(2) -+#define USBIEN_SUSPIE BIT(3) -+#define USBIEN_URESIE BIT(4) -+#define USBIEN_HSPEEDIE BIT(5) -+#define USBIEN_LPMIE BIT(7) -+ -+#define USBCS 0x1a3 -+#define USBCS_LSMODE BIT(0) -+#define USBCS_LPMNYET BIT(1) -+#define USBCS_SIGSUME BIT(5) -+#define USBCS_DISCON BIT(6) -+#define USBCS_WAKESRC BIT(7) -+ -+#define USBIR_SOF BIT(1) -+#define USBIR_SUSP BIT(3) -+#define USBIR_URES BIT(4) -+#define USBIR_HSPEED BIT(5) -+ -+#define USBIR_SUDAV BIT(0) -+#define USBIR_SUTOK BIT(2) -+#define USBIR_LPMIR BIT(7) -+ -+#define OTGIRQ_IDLEIRQ BIT(0) -+#define OTGIRQ_SRPDETIRQ BIT(1) -+#define OTGIRQ_CONIRQ BIT(2) -+#define OTGIRQ_LOCSOFIRQ BIT(2) -+#define OTGIRQ_VBUSERRIRQ BIT(3) -+#define OTGIRQ_PERIPHIRQ BIT(4) -+#define OTGIRQ_IDCHANGEIRQ BIT(5) -+#define OTGIRQ_HOSTDISCON BIT(6) -+#define OTGIRQ_BSE0SRPIRQ BIT(7) -+ -+#define OTGCTRL_BUSREQ BIT(0) -+#define OTGCTRL_ABUSDROP BIT(1) -+#define OTGCTRL_ASETBHNPEN BIT(2) -+#define OTGCTRL_BHNPEN BIT(3) -+#define OTGCTRL_SRPVBUSDETEN BIT(4) -+#define OTGCTRL_SRPDATDETEN BIT(5) -+#define OTGCTRL_FORCEBCONN BIT(7) -+ -+#define OTGSTATUS_ID BIT(6) -+ -+#define ENDPRST_EP 0x0f -+#define ENDPRST_IO_TX BIT(4) -+#define ENDPRST_TOGRST BIT(5) -+#define ENDPRST_FIFORST BIT(6) -+#define ENDPRST_TOGSETQ BIT(7) -+ -+#define FIFOCTRL_EP 0x0f -+#define FIFOCTRL_IO_TX BIT(4) -+#define FIFOCTRL_FIFOAUTO BIT(5) -+ -+#define SPEEDCTRL_LS BIT(0) -+#define SPEEDCTRL_FS BIT(1) -+#define SPEEDCTRL_HS BIT(2) -+#define SPEEDCTRL_HSDISABLE BIT(7) -+ -+#define CON_TYPE_CONTROL 0x00 -+#define CON_TYPE_ISOC 0x04 -+#define CON_TYPE_BULK 0x08 -+#define CON_TYPE_INT 0x0C -+#define CON_TYPE_ISOC_1_ISOD 0x00 -+#define CON_TYPE_ISOC_2_ISOD 0x10 -+#define CON_TYPE_ISOC_3_ISOD 0x20 -+#define CON_STALL 0x40 -+#define CON_VAL 0x80 -+ -+#define ERR_TYPE 0x1c -+#define ERR_COUNT 0x03 -+#define ERR_RESEND BIT(6) -+#define ERR_UNDERRIEN BIT(7) -+ -+#define ERR_NONE 0 -+#define ERR_CRC 1 -+#define ERR_DATA_TOGGLE_MISMATCH 2 -+#define ERR_STALL 3 -+#define ERR_TIMEOUT 4 -+#define ERR_PID 5 -+#define ERR_TOO_LONG_PACKET 6 -+#define ERR_DATA_UNDERRUN 7 -+ -+#define EP0CS_HCSETTOGGLE BIT(6) -+#define EP0CS_HCSET BIT(4) -+#define EP0CS_RXBUSY_MASK BIT(3) -+#define EP0CS_TXBUSY_MASK BIT(2) -+#define EP0CS_STALL BIT(0) -+#define EP0CS_HSNAK BIT(1) -+#define EP0CS_DSTALL BIT(4) -+#define EP0CS_CHGSET BIT(7) -+ -+#define CS_ERR 0x01 -+#define CS_BUSY 0x02 -+#define CS_NPAK 0x0c -+#define CS_NPAK_OFFSET 0x02 -+#define CS_AUTO 0x10 -+ -+#define CON_BUF_SINGLE 0x00 -+#define CON_BUF_DOUBLE 0x01 -+#define CON_BUF_TRIPLE 0x02 -+#define CON_BUF_QUAD 0x03 -+#define CON_BUF 0x03 -+ -+struct HW_REGS { -+ uint8_t ep0Rxbc; /*address 0x00*/ -+ uint8_t ep0Txbc; /*address 0x01*/ -+ uint8_t ep0cs; /*address 0x02*/ -+ int8_t reserved0; /*address 0x03*/ -+ uint8_t lpmctrll; /*address 0x04*/ -+ uint8_t lpmctrlh; /*address 0x05*/ -+ uint8_t lpmclock; -+ uint8_t ep0fifoctrl; -+ struct ep { /*address 0x08*/ -+ uint16_t rxbc; //outbc (hcinbc) -+ uint8_t rxcon; -+ uint8_t rxcs; -+ uint16_t txbc; //inbc (hcoutbc -+ uint8_t txcon; -+ uint8_t txcs; -+ } ep[15]; -+ uint8_t reserved1[4]; -+ uint32_t fifodat[15]; /*address 0x84*/ -+ uint8_t ep0ctrl; /*address 0xC0*/ -+ uint8_t tx0err; /*address 0xC1*/ -+ uint8_t reserved2; -+ uint8_t rx0err; /*address 0xC3*/ -+ struct epExt { -+ uint8_t txctrl; -+ uint8_t txerr; -+ uint8_t rxctrl; -+ uint8_t rxerr; -+ } epExt[15]; -+ uint8_t ep0datatx[64]; /*address 0x100*/ -+ uint8_t ep0datarx[64]; /*address 0x140*/ -+ uint8_t setupdat[8]; /*address 0x180*/ -+ uint16_t txirq; /*address 0x188*/ -+ uint16_t rxirq; /*address 0x18A*/ -+ uint8_t usbirq; /*address 0x18C*/ -+ uint8_t reserved4; -+ uint16_t rxpngirq; /*address 0x18E*/ -+ uint16_t txfullirq; /*address 0x190*/ -+ uint16_t rxemptirq; /*address 0x192*/ -+ uint16_t txien; /*address 0x194*/ -+ uint16_t rxien; /*address 0x196*/ -+ uint8_t usbien; /*address 0x198*/ -+ uint8_t reserved6; -+ uint16_t rxpngien; /*address 0x19A*/ -+ uint16_t txfullien; /*address 0x19C*/ -+ uint16_t rxemptien; /*address 0x19E*/ -+ uint8_t usbivect; /*address 0x1A0*/ -+ uint8_t fifoivect; /*address 0x1A1*/ -+ uint8_t endprst; /*address 0x1A2*/ -+ uint8_t usbcs; /*address 0x1A3*/ -+ uint16_t frmnr; /*address 0x1A4*/ -+ uint8_t fnaddr; /*address 0x1A6*/ -+ uint8_t clkgate; /*address 0x1A7*/ -+ uint8_t fifoctrl; /*address 0x1A8*/ -+ uint8_t speedctrl; /*address 0x1A9*/ -+ uint8_t reserved8[1]; /*address 0x1AA*/ -+ uint8_t portctrl; /*address 0x1AB*/ -+ uint16_t hcfrmnr; /*address 0x1AC*/ -+ uint16_t hcfrmremain; /*address 0x1AE*/ -+ uint8_t reserved9[4]; /*address 0x1B0*/ -+ uint16_t rxerrirq; /*address 0x1B4*/ -+ uint16_t txerrirq; /*address 0x1B6*/ -+ uint16_t rxerrien; /*address 0x1B8*/ -+ uint16_t txerrien; /*address 0x1BA*/ -+ /*OTG extension*/ -+ uint8_t otgirq; /*address 0x1BC*/ -+ uint8_t otgstate; /*address 0x1BD*/ -+ uint8_t otgctrl; /*address 0x1BE*/ -+ uint8_t otgstatus; /*address 0x1BF*/ -+ uint8_t otgien; /*address 0x1C0*/ -+ uint8_t taaidlbdis; /*address 0x1C1*/ -+ uint8_t tawaitbcon; /*address 0x1C2*/ -+ uint8_t tbvbuspls; /*address 0x1C3*/ -+ uint8_t otg2ctrl; /*address 0x1C4*/ -+ uint8_t reserved10[2]; /*address 0x1C5*/ -+ uint8_t tbvbusdispls; /*address 0x1C7*/ -+ uint8_t traddr; /*address 0x1C8*/ -+ uint8_t trwdata; /*address 0x1C9*/ -+ uint8_t trrdata; /*address 0x1CA*/ -+ uint8_t trctrl; /*address 0x1CB*/ -+ uint16_t isoautoarm; /*address 0x1CC*/ -+ uint8_t adpbc1ien; /*address 0x1CE*/ -+ uint8_t adpbc2ien; /*address 0x1CF*/ -+ uint8_t adpbcctr0; /*address 0x1D0*/ -+ uint8_t adpbcctr1; /*address 0x1D1*/ -+ uint8_t adpbcctr2; /*address 0x1D2*/ -+ uint8_t adpbc1irq; /*address 0x1D3*/ -+ uint8_t adpbc0status; /*address 0x1D4*/ -+ uint8_t adpbc1status; /*address 0x1D5*/ -+ uint8_t adpbc2status; /*address 0x1D6*/ -+ uint8_t adpbc2irq; /*address 0x1D7*/ -+ uint16_t isodctrl; /*address 0x1D8*/ -+ uint8_t reserved11[2]; -+ uint16_t isoautodump; /*address 0x1DC*/ -+ uint8_t reserved12[2]; -+ uint8_t ep0maxpack; /*address 0x1E0*/ -+ uint8_t reserved13; -+ uint16_t rxmaxpack[15]; /*address 0x1E2*/ -+ struct rxsoftimer { /*address 0x200 to 0x23F*/ -+ uint16_t timer; -+ uint8_t reserved; -+ uint8_t ctrl; -+ } rxsoftimer[16]; -+ -+ struct txsoftimer { /*address 0x240 to 0x27F*/ -+ uint16_t timer; -+ uint8_t reserved; -+ uint8_t ctrl; -+ } txsoftimer[16]; -+ uint8_t reserved14[132]; -+ struct rxstaddr { /*address 0x304*/ -+ uint16_t addr; -+ uint16_t reserved; -+ } rxstaddr[15]; -+ uint8_t reserved15[4]; -+ struct txstaddr { /*address 0x344*/ -+ uint16_t addr; -+ uint16_t reserved; -+ } txstaddr[15]; -+ int8_t reserved16[4]; /*address 0x380*/ -+ struct irqmode { /*address 0x384*/ -+ int8_t inirqmode; -+ int8_t reserved21; -+ int8_t outirqmode; -+ int8_t reserved22; -+ } irqmode[15]; -+ /*The Microprocessor control*/ -+ uint8_t cpuctrl; /*address 0x3C0*/ -+ int8_t reserved17[15]; -+ /*The debug counters and workarounds*/ -+ uint8_t debug_rx_bcl; /*address 0x3D0*/ -+ uint8_t debug_rx_bch; /*address 0x3D1*/ -+ uint8_t debug_rx_status; /*address 0x3D2*/ -+ uint8_t debug_irq; /*address 0x3D3*/ -+ uint8_t debug_tx_bcl; /*address 0x3D4*/ -+ uint8_t debug_tx_bch; /*address 0x3D5*/ -+ uint8_t debug_tx_status; /*address 0x3D6*/ -+ uint8_t debug_ien; /*address 0x3D7*/ -+ uint8_t phywa_en; /*address 0x3D8*/ -+ /*endian*/ -+ uint8_t wa1_cnt; /*address 0x3D9*/ -+ int8_t reserved18[2]; /*address 0x3DA*/ -+ uint8_t endian_sfr_cs; /*address 0x3DC*/ -+ int8_t reserved19[2]; /*address 0x3DD*/ -+ uint8_t endian_sfr_s; /*address 0x3DF*/ -+ int8_t reserved20[2]; /*address 0x3E0*/ -+ uint16_t txmaxpack[15]; /*address 0x3E2*/ -+}; + list_for_each_entry(i2cbi, &master->boardinfo.i2c, node) { + switch (i2cbi->lvr & I3C_LVR_I2C_INDEX_MASK) { + case I3C_LVR_I2C_INDEX(0): +diff --git a/drivers/i3c/master/Kconfig b/drivers/i3c/master/Kconfig +index 90dee3ec5..f39122918 100644 +--- a/drivers/i3c/master/Kconfig ++++ b/drivers/i3c/master/Kconfig +@@ -57,3 +57,12 @@ config MIPI_I3C_HCI + + This driver can also be built as a module. If so, the module will be + called mipi-i3c-hci. + -+struct CUSTOM_REGS { -+ uint32_t secure_ctrl; /*address 0x80000*/ -+ uint32_t secsid_atst; /*address 0x80004*/ -+ uint32_t nsaid_smmuid; /*address 0x80008*/ -+ uint32_t ace; /*address 0x8000c*/ -+ uint32_t wakeup; /*address 0x80010*/ -+ uint32_t debug; /*address 0x80014*/ -+}; ++config PHYTIUM_I3C_MASTER ++ tristate "Phytium I3C master driver" ++ depends on I3C ++ depends on HAS_IOMEM ++ depends on !(ALPHA || PARISC) ++ help ++ Enable this driver if you want to support phytium I3C master block. ++ +diff --git a/drivers/i3c/master/Makefile b/drivers/i3c/master/Makefile +index 3e9796016..3819a4dab 100644 +--- a/drivers/i3c/master/Makefile ++++ b/drivers/i3c/master/Makefile +@@ -4,3 +4,4 @@ obj-$(CONFIG_DW_I3C_MASTER) += dw-i3c-master.o + obj-$(CONFIG_AST2600_I3C_MASTER) += ast2600-i3c-master.o + obj-$(CONFIG_SVC_I3C_MASTER) += svc-i3c-master.o + obj-$(CONFIG_MIPI_I3C_HCI) += mipi-i3c-hci/ ++obj-$(CONFIG_PHYTIUM_I3C_MASTER) += i3c-master-phytium.o +diff --git a/drivers/i3c/master/i3c-master-cdns.c b/drivers/i3c/master/i3c-master-cdns.c +index fa5aaaf44..925deb746 100644 +--- a/drivers/i3c/master/i3c-master-cdns.c ++++ b/drivers/i3c/master/i3c-master-cdns.c +@@ -393,6 +393,7 @@ struct cdns_i3c_xfer { + + struct cdns_i3c_data { + u8 thd_delay_ns; ++ u8 halt_disable; + }; + + struct cdns_i3c_master { +@@ -724,6 +725,19 @@ static int cdns_i3c_master_send_ccc_cmd(struct i3c_master_controller *m, + if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) + cdns_i3c_master_unqueue_xfer(master, xfer); + ++ /*GETMXDS format 1 need retransmission*/ ++ if ((xfer->ret) && (cmd->id == I3C_CCC_GETMXDS)) { ++ if (cmd->dests[0].payload.len == 5) { ++ cmd->dests[0].payload.len = 2; ++ ccmd->rx_len = cmd->dests[0].payload.len; ++ ccmd->cmd0 &= 0xfff000fff; ++ ccmd->cmd0 |= CMD0_FIFO_PL_LEN(cmd->dests[0].payload.len); ++ cdns_i3c_master_queue_xfer(master, xfer); ++ if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) ++ cdns_i3c_master_unqueue_xfer(master, xfer); ++ } ++ } + -+struct VHUB_REGS { -+ uint32_t gen_cfg; /*address 0x00*/ -+ uint32_t gen_st; /*address 0x04*/ -+ uint32_t bc_cfg; /*address 0x08*/ -+ uint32_t bc_st; /*address 0x0c*/ -+ uint32_t adp_cfg; /*address 0x10*/ -+ uint32_t adp_st; /*address 0x14*/ -+ uint32_t dbg_cfg; /*address 0x18*/ -+ uint32_t dbg_st; /*address 0x1c*/ -+ uint32_t utmip_cfg; /*address 0x20*/ -+ uint32_t utmip_st; /*address 0x24*/ + ret = xfer->ret; + cmd->err = cdns_i3c_cmd_get_err(&xfer->cmds[0]); + cdns_i3c_master_free_xfer(xfer); +@@ -1285,7 +1299,10 @@ static int cdns_i3c_master_bus_init(struct i3c_master_controller *m) + * + * We will issue ENTDAA afterwards from the threaded IRQ handler. + */ +- ctrl |= CTRL_HJ_ACK | CTRL_HJ_DISEC | CTRL_HALT_EN | CTRL_MCS_EN; ++ if (master->devdata->halt_disable) ++ ctrl |= CTRL_HJ_DISEC | CTRL_MCS_EN; ++ else ++ ctrl |= CTRL_HJ_ACK | CTRL_HJ_DISEC | CTRL_HALT_EN | CTRL_MCS_EN; + + /* + * Configure data hold delay based on device-specific data. +@@ -1556,10 +1573,17 @@ static void cdns_i3c_master_hj(struct work_struct *work) + + static struct cdns_i3c_data cdns_i3c_devdata = { + .thd_delay_ns = 10, ++ .halt_disable = 0, +}; + -+struct DMARegs { -+ uint32_t conf; /*address 0x400*/ -+ uint32_t sts; /*address 0x404*/ -+ uint32_t reserved5[5]; -+ uint32_t ep_sel; /*address 0x41C*/ -+ uint32_t traddr; /*address 0x420*/ -+ uint32_t ep_cfg; /*address 0x424*/ -+ uint32_t ep_cmd; /*address 0x428*/ -+ uint32_t ep_sts; /*address 0x42c*/ -+ uint32_t ep_sts_sid;/*address 0x430*/ -+ uint32_t ep_sts_en; /*address 0x434*/ -+ uint32_t drbl; /*address 0x438*/ -+ uint32_t ep_ien; /*address 0x43C*/ -+ uint32_t ep_ists; /*address 0x440*/ -+}; ++static struct cdns_i3c_data phytium_i3c_devdata = { ++ .thd_delay_ns = 10, ++ .halt_disable = 1, + }; + + static const struct of_device_id cdns_i3c_master_of_ids[] = { + { .compatible = "cdns,i3c-master", .data = &cdns_i3c_devdata }, ++ { .compatible = "phytium,cdns-i3c-master", .data = &phytium_i3c_devdata}, + { /* sentinel */ }, + }; + +@@ -1651,6 +1675,8 @@ static int cdns_i3c_master_probe(struct platform_device *pdev) + if (ret) + goto err_disable_sysclk; + ++ writel(readl(master->regs + CTRL) | CTRL_HJ_ACK, master->regs + CTRL); + -+#endif -diff --git a/drivers/usb/phytium/pci.c b/drivers/usb/phytium/pci.c + return 0; + + err_disable_sysclk: +diff --git a/drivers/i3c/master/i3c-master-phytium.c b/drivers/i3c/master/i3c-master-phytium.c new file mode 100644 -index 000000000..b4d675eff +index 000000000..50f3f6c98 --- /dev/null -+++ b/drivers/usb/phytium/pci.c -@@ -0,0 +1,208 @@ ++++ b/drivers/i3c/master/i3c-master-phytium.c +@@ -0,0 +1,1848 @@ +// SPDX-License-Identifier: GPL-2.0 ++/* ++ * Copyright (C) 2022 Phytium Technology Co.,Ltd. ++ * ++ */ + -+#include -+#include ++#include ++#include ++#include ++#include ++#include ++#include +#include -+#include -+#include -+#include -+#include -+#include "core.h" ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include "../i3c_master_acpi.h" + -+#define PHYTIUM_OTG_USB_LOADED 3 ++#define DEV_ID 0x0 ++#define DEV_ID_I3C_MASTER 0x5034 + -+static bool phytium_hw_is_device(struct phytium_cusb *config) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); ++#define CONF_STATUS0 0x4 ++#define CONF_STATUS0_CMDR_DEPTH(x) (4 << (((x) & GENMASK(31, 29)) >> 29)) ++#define CONF_STATUS0_ECC_CHK BIT(28) ++#define CONF_STATUS0_INTEG_CHK BIT(27) ++#define CONF_STATUS0_CSR_DAP_CHK BIT(26) ++#define CONF_STATUS0_TRANS_TOUT_CHK BIT(25) ++#define CONF_STATUS0_PROT_FAULTS_CHK BIT(24) ++#define CONF_STATUS0_GPO_NUM(x) (((x) & GENMASK(23, 16)) >> 16) ++#define CONF_STATUS0_GPI_NUM(x) (((x) & GENMASK(15, 8)) >> 8) ++#define CONF_STATUS0_IBIR_DEPTH(x) (4 << (((x) & GENMASK(7, 6)) >> 7)) ++#define CONF_STATUS0_SUPPORTS_DDR BIT(5) ++#define CONF_STATUS0_SEC_MASTER BIT(4) ++#define CONF_STATUS0_DEVS_NUM(x) ((x) & GENMASK(3, 0)) + -+ return false; -+} ++#define CONF_STATUS1 0x8 ++#define CONF_STATUS1_IBI_HW_RES(x) ((((x) & GENMASK(31, 28)) >> 28) + 1) ++#define CONF_STATUS1_CMD_DEPTH(x) (4 << (((x) & GENMASK(27, 26)) >> 26)) ++#define CONF_STATUS1_SLVDDR_RX_DEPTH(x) (8 << (((x) & GENMASK(25, 21)) >> 21)) ++#define CONF_STATUS1_SLVDDR_TX_DEPTH(x) (8 << (((x) & GENMASK(20, 16)) >> 16)) ++#define CONF_STATUS1_IBI_DEPTH(x) (2 << (((x) & GENMASK(12, 10)) >> 10)) ++#define CONF_STATUS1_RX_DEPTH(x) (8 << (((x) & GENMASK(9, 5)) >> 5)) ++#define CONF_STATUS1_TX_DEPTH(x) (8 << ((x) & GENMASK(4, 0))) + -+static bool phytium_hw_is_host(struct phytium_cusb *config) -+{ -+ pr_info("%s %d\n", __func__, __LINE__); ++#define REV_ID 0xc ++#define REV_ID_VID(id) (((id) & GENMASK(31, 20)) >> 20) ++#define REV_ID_PID(id) (((id) & GENMASK(19, 8)) >> 8) ++#define REV_ID_REV_MAJOR(id) (((id) & GENMASK(7, 4)) >> 4) ++#define REV_ID_REV_MINOR(id) ((id) & GENMASK(3, 0)) + -+ return true; -+} ++#define CTRL 0x10 ++#define CTRL_DEV_EN BIT(31) ++#define CTRL_HALT_EN BIT(30) ++#define CTRL_MCS BIT(29) ++#define CTRL_MCS_EN BIT(28) ++#define CTRL_THD_DELAY(x) (((x) << 24) & GENMASK(25, 24)) ++#define CTRL_HJ_DISEC BIT(8) ++#define CTRL_MST_ACK BIT(7) ++#define CTRL_HJ_ACK BIT(6) ++#define CTRL_HJ_INIT BIT(5) ++#define CTRL_MST_INIT BIT(4) ++#define CTRL_AHDR_OPT BIT(3) ++#define CTRL_PURE_BUS_MODE 0 ++#define CTRL_MIXED_FAST_BUS_MODE 2 ++#define CTRL_MIXED_SLOW_BUS_MODE 3 ++#define CTRL_BUS_MODE_MASK GENMASK(1, 0) ++#define THD_DELAY_MAX 3 + -+static int phytium_get_dr_mode(struct phytium_cusb *config) -+{ -+ enum usb_dr_mode mode; ++#define PRESCL_CTRL0 0x14 ++#define PRESCL_CTRL0_I2C(x) ((x) << 16) ++#define PRESCL_CTRL0_I3C(x) (x) ++#define PRESCL_CTRL0_MAX GENMASK(9, 0) + -+ config->dr_mode = usb_get_dr_mode(config->dev); -+ if (config->dr_mode == USB_DR_MODE_UNKNOWN) -+ config->dr_mode = USB_DR_MODE_OTG; ++#define PRESCL_CTRL1 0x18 ++#define PRESCL_CTRL1_PP_LOW_MASK GENMASK(15, 8) ++#define PRESCL_CTRL1_PP_LOW(x) ((x) << 8) ++#define PRESCL_CTRL1_OD_LOW_MASK GENMASK(7, 0) ++#define PRESCL_CTRL1_OD_LOW(x) (x) + -+ mode = config->dr_mode; -+ if (phytium_hw_is_device(config)) { -+ if (IS_ENABLED(CONFIG_USB_PHYTIUM_HOST)) { -+ dev_err(config->dev, "Controller does not support host mode.\n"); -+ return -EINVAL; -+ } ++#define MST_IER 0x20 ++#define MST_IDR 0x24 ++#define MST_IMR 0x28 ++#define MST_ICR 0x2c ++#define MST_ISR 0x30 ++#define MST_INT_HALTED BIT(18) ++#define MST_INT_MR_DONE BIT(17) ++#define MST_INT_IMM_COMP BIT(16) ++#define MST_INT_TX_THR BIT(15) ++#define MST_INT_TX_OVF BIT(14) ++#define MST_INT_IBID_THR BIT(12) ++#define MST_INT_IBID_UNF BIT(11) ++#define MST_INT_IBIR_THR BIT(10) ++#define MST_INT_IBIR_UNF BIT(9) ++#define MST_INT_IBIR_OVF BIT(8) ++#define MST_INT_RX_THR BIT(7) ++#define MST_INT_RX_UNF BIT(6) ++#define MST_INT_CMDD_EMP BIT(5) ++#define MST_INT_CMDD_THR BIT(4) ++#define MST_INT_CMDD_OVF BIT(3) ++#define MST_INT_CMDR_THR BIT(2) ++#define MST_INT_CMDR_UNF BIT(1) ++#define MST_INT_CMDR_OVF BIT(0) + -+ mode = USB_DR_MODE_PERIPHERAL; -+ } else if (phytium_hw_is_host(config)) { -+ if (IS_ENABLED(CONFIG_USB_PHYTIUM_PERIPHERAL)) { -+ dev_err(config->dev, "Controller does not support device mode.\n"); -+ return -EINVAL; -+ } -+ mode = USB_DR_MODE_HOST; -+ } else { -+ if (IS_ENABLED(CONFIG_USB_PHYTIUM_HOST)) -+ mode = USB_DR_MODE_HOST; -+ else if (IS_ENABLED(CONFIG_USB_PHYTIUM_PERIPHERAL)) -+ mode = USB_DR_MODE_PERIPHERAL; -+ } ++#define MST_STATUS0 0x34 ++#define MST_STATUS0_IDLE BIT(18) ++#define MST_STATUS0_HALTED BIT(17) ++#define MST_STATUS0_MASTER_MODE BIT(16) ++#define MST_STATUS0_TX_FULL BIT(13) ++#define MST_STATUS0_IBID_FULL BIT(12) ++#define MST_STATUS0_IBIR_FULL BIT(11) ++#define MST_STATUS0_RX_FULL BIT(10) ++#define MST_STATUS0_CMDD_FULL BIT(9) ++#define MST_STATUS0_CMDR_FULL BIT(8) ++#define MST_STATUS0_TX_EMP BIT(5) ++#define MST_STATUS0_IBID_EMP BIT(4) ++#define MST_STATUS0_IBIR_EMP BIT(3) ++#define MST_STATUS0_RX_EMP BIT(2) ++#define MST_STATUS0_CMDD_EMP BIT(1) ++#define MST_STATUS0_CMDR_EMP BIT(0) + -+ if (mode != config->dr_mode) { -+ dev_warn(config->dev, "Configuration mismatch. dr_mode forced to %s\n", -+ mode == USB_DR_MODE_HOST ? "host" : "device"); -+ config->dr_mode = mode; -+ } ++#define CMDR 0x38 ++#define CMDR_NO_ERROR 0 ++#define CMDR_DDR_PREAMBLE_ERROR 1 ++#define CMDR_DDR_PARITY_ERROR 2 ++#define CMDR_DDR_RX_FIFO_OVF 3 ++#define CMDR_DDR_TX_FIFO_UNF 4 ++#define CMDR_M0_ERROR 5 ++#define CMDR_M1_ERROR 6 ++#define CMDR_M2_ERROR 7 ++#define CMDR_MST_ABORT 8 ++#define CMDR_NACK_RESP 9 ++#define CMDR_INVALID_DA 10 ++#define CMDR_DDR_DROPPED 11 ++#define CMDR_ERROR(x) (((x) & GENMASK(27, 24)) >> 24) ++#define CMDR_XFER_BYTES(x) (((x) & GENMASK(19, 8)) >> 8) ++#define CMDR_CMDID_HJACK_DISEC 0xfe ++#define CMDR_CMDID_HJACK_ENTDAA 0xff ++#define CMDR_CMDID(x) ((x) & GENMASK(7, 0)) ++ ++#define IBIR 0x3c ++#define IBIR_ACKED BIT(12) ++#define IBIR_SLVID(x) (((x) & GENMASK(11, 8)) >> 8) ++#define IBIR_ERROR BIT(7) ++#define IBIR_XFER_BYTES(x) (((x) & GENMASK(6, 2)) >> 2) ++#define IBIR_TYPE_IBI 0 ++#define IBIR_TYPE_HJ 1 ++#define IBIR_TYPE_MR 2 ++#define IBIR_TYPE(x) ((x) & GENMASK(1, 0)) ++ ++#define SLV_IER 0x40 ++#define SLV_IDR 0x44 ++#define SLV_IMR 0x48 ++#define SLV_ICR 0x4c ++#define SLV_ISR 0x50 ++#define SLV_INT_TM BIT(20) ++#define SLV_INT_ERROR BIT(19) ++#define SLV_INT_EVENT_UP BIT(18) ++#define SLV_INT_HJ_DONE BIT(17) ++#define SLV_INT_MR_DONE BIT(16) ++#define SLV_INT_DA_UPD BIT(15) ++#define SLV_INT_SDR_FAIL BIT(14) ++#define SLV_INT_DDR_FAIL BIT(13) ++#define SLV_INT_M_RD_ABORT BIT(12) ++#define SLV_INT_DDR_RX_THR BIT(11) ++#define SLV_INT_DDR_TX_THR BIT(10) ++#define SLV_INT_SDR_RX_THR BIT(9) ++#define SLV_INT_SDR_TX_THR BIT(8) ++#define SLV_INT_DDR_RX_UNF BIT(7) ++#define SLV_INT_DDR_TX_OVF BIT(6) ++#define SLV_INT_SDR_RX_UNF BIT(5) ++#define SLV_INT_SDR_TX_OVF BIT(4) ++#define SLV_INT_DDR_RD_COMP BIT(3) ++#define SLV_INT_DDR_WR_COMP BIT(2) ++#define SLV_INT_SDR_RD_COMP BIT(1) ++#define SLV_INT_SDR_WR_COMP BIT(0) + -+ return 0; -+} ++#define SLV_STATUS0 0x54 ++#define SLV_STATUS0_REG_ADDR(s) (((s) & GENMASK(23, 16)) >> 16) ++#define SLV_STATUS0_XFRD_BYTES(s) ((s) & GENMASK(15, 0)) + -+static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) -+{ -+ struct phytium_cusb *config; -+ int retval = 0; ++#define SLV_STATUS1 0x58 ++#define SLV_STATUS1_AS(s) (((s) & GENMASK(21, 20)) >> 20) ++#define SLV_STATUS1_VEN_TM BIT(19) ++#define SLV_STATUS1_HJ_DIS BIT(18) ++#define SLV_STATUS1_MR_DIS BIT(17) ++#define SLV_STATUS1_PROT_ERR BIT(16) ++#define SLV_STATUS1_DA(x) (((s) & GENMASK(15, 9)) >> 9) ++#define SLV_STATUS1_HAS_DA BIT(8) ++#define SLV_STATUS1_DDR_RX_FULL BIT(7) ++#define SLV_STATUS1_DDR_TX_FULL BIT(6) ++#define SLV_STATUS1_DDR_RX_EMPTY BIT(5) ++#define SLV_STATUS1_DDR_TX_EMPTY BIT(4) ++#define SLV_STATUS1_SDR_RX_FULL BIT(3) ++#define SLV_STATUS1_SDR_TX_FULL BIT(2) ++#define SLV_STATUS1_SDR_RX_EMPTY BIT(1) ++#define SLV_STATUS1_SDR_TX_EMPTY BIT(0) + -+ if (usb_disabled()) -+ return -ENODEV; ++#define CMD0_FIFO 0x60 ++#define CMD0_FIFO_IS_DDR BIT(31) ++#define CMD0_FIFO_IS_CCC BIT(30) ++#define CMD0_FIFO_BCH BIT(29) ++#define XMIT_BURST_STATIC_SUBADDR 0 ++#define XMIT_SINGLE_INC_SUBADDR 1 ++#define XMIT_SINGLE_STATIC_SUBADDR 2 ++#define XMIT_BURST_WITHOUT_SUBADDR 3 ++#define CMD0_FIFO_PRIV_XMIT_MODE(m) ((m) << 27) ++#define CMD0_FIFO_SBCA BIT(26) ++#define CMD0_FIFO_RSBC BIT(25) ++#define CMD0_FIFO_IS_10B BIT(24) ++#define CMD0_FIFO_PL_LEN(l) ((l) << 12) ++#define CMD0_FIFO_PL_LEN_MAX 4095 ++#define CMD0_FIFO_DEV_ADDR(a) ((a) << 1) ++#define CMD0_FIFO_RNW BIT(0) + -+ retval = pcim_enable_device(pdev); -+ if (retval < 0) { -+ dev_err(&pdev->dev, "pcim_enable_device failed\n"); -+ return -ENODEV; -+ } -+ pci_set_master(pdev); ++#define CMD1_FIFO 0x64 ++#define CMD1_FIFO_CMDID(id) ((id) << 24) ++#define CMD1_FIFO_CSRADDR(a) (a) ++#define CMD1_FIFO_CCC(id) (id) + -+ config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL); -+ if (!config) -+ return -ENOMEM; ++#define TX_FIFO 0x68 + -+ spin_lock_init(&config->lock); -+ config->dev = &pdev->dev; ++#define IMD_CMD0 0x70 ++#define IMD_CMD0_PL_LEN(l) ((l) << 12) ++#define IMD_CMD0_DEV_ADDR(a) ((a) << 1) ++#define IMD_CMD0_RNW BIT(0) + -+ config->irq = pdev->irq; -+ if (config->irq <= 0) { -+ dev_err(config->dev, "getting usb irq failed\n"); -+ return config->irq; -+ } ++#define IMD_CMD1 0x74 ++#define IMD_CMD1_CCC(id) (id) + -+ config->regs = pci_iomap(pdev, 0, 0); -+ if (IS_ERR(config->regs)) { -+ dev_err(config->dev, "map IOMEM resource failed\n"); -+ return -1; -+ } ++#define IMD_DATA 0x78 ++#define RX_FIFO 0x80 ++#define IBI_DATA_FIFO 0x84 ++#define SLV_DDR_TX_FIFO 0x88 ++#define SLV_DDR_RX_FIFO 0x8c + -+ if (!pdev->dev.dma_mask) -+ pdev->dev.dma_mask = &pdev->dev.coherent_dma_mask; ++#define CMD_IBI_THR_CTRL 0x90 ++#define IBIR_THR(t) ((t) << 24) ++#define CMDR_THR(t) ((t) << 16) ++#define IBI_THR(t) ((t) << 8) ++#define CMD_THR(t) (t) + -+ if (dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64))) -+ dev_err(&pdev->dev, "failed to set 64-bit dma\n"); -+ else if (dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32))) -+ dev_err(&pdev->dev, "failed to set 32-bit dma\n"); ++#define TX_RX_THR_CTRL 0x94 ++#define RX_THR(t) ((t) << 16) ++#define TX_THR(t) (t) + -+ pci_enable_msi(pdev); ++#define SLV_DDR_TX_RX_THR_CTRL 0x98 ++#define SLV_DDR_RX_THR(t) ((t) << 16) ++#define SLV_DDR_TX_THR(t) (t) + -+ phytium_get_dr_mode(config); ++#define FLUSH_CTRL 0x9c ++#define FLUSH_IBI_RESP BIT(23) ++#define FLUSH_CMD_RESP BIT(22) ++#define FLUSH_SLV_DDR_RX_FIFO BIT(22) ++#define FLUSH_SLV_DDR_TX_FIFO BIT(21) ++#define FLUSH_IMM_FIFO BIT(20) ++#define FLUSH_IBI_FIFO BIT(19) ++#define FLUSH_RX_FIFO BIT(18) ++#define FLUSH_TX_FIFO BIT(17) ++#define FLUSH_CMD_FIFO BIT(16) + -+ phytium_core_reset(config, false); ++#define TTO_PRESCL_CTRL0 0xb0 ++#define TTO_PRESCL_CTRL0_DIVB(x) ((x) << 16) ++#define TTO_PRESCL_CTRL0_DIVA(x) (x) + -+ if (config->dr_mode == USB_DR_MODE_HOST || config->dr_mode == USB_DR_MODE_OTG) -+ phytium_host_init(config); ++#define TTO_PRESCL_CTRL1 0xb4 ++#define TTO_PRESCL_CTRL1_DIVB(x) ((x) << 16) ++#define TTO_PRESCL_CTRL1_DIVA(x) (x) + -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) -+ phytium_gadget_init(config); ++#define DEVS_CTRL 0xb8 ++#define DEVS_CTRL_DEV_CLR_SHIFT 16 ++#define DEVS_CTRL_DEV_CLR_ALL GENMASK(31, 16) ++#define DEVS_CTRL_DEV_CLR(dev) BIT(16 + (dev)) ++#define DEVS_CTRL_DEV_ACTIVE(dev) BIT(dev) ++#define DEVS_CTRL_DEVS_ACTIVE_MASK GENMASK(15, 0) ++#define MAX_DEVS 16 + -+ dev_set_drvdata(config->dev, config); ++#define DEV_ID_RR0(d) (0xc0 + ((d) * 0x10)) ++#define DEV_ID_RR0_LVR_EXT_ADDR BIT(11) ++#define DEV_ID_RR0_HDR_CAP BIT(10) ++#define DEV_ID_RR0_IS_I3C BIT(9) ++#define DEV_ID_RR0_DEV_ADDR_MASK (GENMASK(6, 0) | GENMASK(15, 13)) ++#define DEV_ID_RR0_SET_DEV_ADDR(a) (((a) & GENMASK(6, 0)) | \ ++ (((a) & GENMASK(9, 7)) << 6)) ++#define DEV_ID_RR0_GET_DEV_ADDR(x) ((((x) >> 1) & GENMASK(6, 0)) | \ ++ (((x) >> 6) & GENMASK(9, 7))) + -+ return 0; -+} ++#define DEV_ID_RR1(d) (0xc4 + ((d) * 0x10)) ++#define DEV_ID_RR1_PID_MSB(pid) (pid) + -+static void phytium_pci_remove(struct pci_dev *pdev) -+{ -+ struct phytium_cusb *config = dev_get_drvdata(&pdev->dev); ++#define DEV_ID_RR2(d) (0xc8 + ((d) * 0x10)) ++#define DEV_ID_RR2_PID_LSB(pid) ((pid) << 16) ++#define DEV_ID_RR2_BCR(bcr) ((bcr) << 8) ++#define DEV_ID_RR2_DCR(dcr) (dcr) ++#define DEV_ID_RR2_LVR(lvr) (lvr) + -+ phytium_get_dr_mode(config); -+ if (config->dr_mode == USB_DR_MODE_HOST || config->dr_mode == USB_DR_MODE_OTG) -+ phytium_host_uninit(config); ++#define SIR_MAP(x) (0x180 + ((x) * 4)) ++#define SIR_MAP_DEV_REG(d) SIR_MAP((d) / 2) ++#define SIR_MAP_DEV_SHIFT(d, fs) ((fs) + (((d) % 2) ? 16 : 0)) ++#define SIR_MAP_DEV_CONF_MASK(d) (GENMASK(15, 0) << (((d) % 2) ? 16 : 0)) ++#define SIR_MAP_DEV_CONF(d, c) ((c) << (((d) % 2) ? 16 : 0)) ++#define DEV_ROLE_SLAVE 0 ++#define DEV_ROLE_MASTER 1 ++#define SIR_MAP_DEV_ROLE(role) ((role) << 14) ++#define SIR_MAP_DEV_SLOW BIT(13) ++#define SIR_MAP_DEV_PL(l) ((l) << 8) ++#define SIR_MAP_PL_MAX GENMASK(4, 0) ++#define SIR_MAP_DEV_DA(a) ((a) << 1) ++#define SIR_MAP_DEV_ACK BIT(0) + -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) -+ phytium_gadget_uninit(config); ++#define GPIR_WORD(x) (0x200 + ((x) * 4)) ++#define GPI_REG(val, id) \ ++ (((val) >> (((id) % 4) * 8)) & GENMASK(7, 0)) + -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) -+ usb_del_gadget_udc(&config->gadget); ++#define GPOR_WORD(x) (0x220 + ((x) * 4)) ++#define GPO_REG(val, id) \ ++ (((val) >> (((id) % 4) * 8)) & GENMASK(7, 0)) + -+ dev_set_drvdata(&pdev->dev, NULL); -+ pr_info("%s %d\n", __func__, __LINE__); -+} ++#define ASF_INT_STATUS 0x300 ++#define ASF_INT_RAW_STATUS 0x304 ++#define ASF_INT_MASK 0x308 ++#define ASF_INT_TEST 0x30c ++#define ASF_INT_FATAL_SELECT 0x310 ++#define ASF_INTEGRITY_ERR BIT(6) ++#define ASF_PROTOCOL_ERR BIT(5) ++#define ASF_TRANS_TIMEOUT_ERR BIT(4) ++#define ASF_CSR_ERR BIT(3) ++#define ASF_DAP_ERR BIT(2) ++#define ASF_SRAM_UNCORR_ERR BIT(1) ++#define ASF_SRAM_CORR_ERR BIT(0) + -+static void phytium_pci_shutdown(struct pci_dev *pdev) -+{ -+ struct phytium_cusb *config; ++#define ASF_SRAM_CORR_FAULT_STATUS 0x320 ++#define ASF_SRAM_UNCORR_FAULT_STATUS 0x324 ++#define ASF_SRAM_CORR_FAULT_INSTANCE(x) ((x) >> 24) ++#define ASF_SRAM_CORR_FAULT_ADDR(x) ((x) & GENMASK(23, 0)) + -+ config = dev_get_drvdata(&pdev->dev); ++#define ASF_SRAM_FAULT_STATS 0x328 ++#define ASF_SRAM_FAULT_UNCORR_STATS(x) ((x) >> 16) ++#define ASF_SRAM_FAULT_CORR_STATS(x) ((x) & GENMASK(15, 0)) + -+ phytium_get_dr_mode(config); ++#define ASF_TRANS_TOUT_CTRL 0x330 ++#define ASF_TRANS_TOUT_EN BIT(31) ++#define ASF_TRANS_TOUT_VAL(x) (x) + -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) -+ usb_del_gadget_udc(&config->gadget); -+} ++#define ASF_TRANS_TOUT_FAULT_MASK 0x334 ++#define ASF_TRANS_TOUT_FAULT_STATUS 0x338 ++#define ASF_TRANS_TOUT_FAULT_APB BIT(3) ++#define ASF_TRANS_TOUT_FAULT_SCL_LOW BIT(2) ++#define ASF_TRANS_TOUT_FAULT_SCL_HIGH BIT(1) ++#define ASF_TRANS_TOUT_FAULT_FSCL_HIGH BIT(0) + -+#ifdef CONFIG_PM -+static int phytium_pci_resume(struct pci_dev *pdev) -+{ -+ unsigned long flags = 0; -+ struct phytium_cusb *config; -+ int ret = 0; ++#define ASF_PROTO_FAULT_MASK 0x340 ++#define ASF_PROTO_FAULT_STATUS 0x344 ++#define ASF_PROTO_FAULT_SLVSDR_RD_ABORT BIT(31) ++#define ASF_PROTO_FAULT_SLVDDR_FAIL BIT(30) ++#define ASF_PROTO_FAULT_S(x) BIT(16 + (x)) ++#define ASF_PROTO_FAULT_MSTSDR_RD_ABORT BIT(15) ++#define ASF_PROTO_FAULT_MSTDDR_FAIL BIT(14) ++#define ASF_PROTO_FAULT_M(x) BIT(x) + -+ config = dev_get_drvdata(&pdev->dev); ++#define I3C_CONTROL_DEFAULT_I2C_SCL (1000000) ++#define I3C_CONTROL_DEFAULT_I3C_SCL (1000000) ++#define PHYTIUM_I3C_DEV_MAX_NUM (12) ++#define PHYTIUM_I3C_CMDR_MAX_TIMES (32) + -+ spin_lock_irqsave(&config->lock, flags); -+ ret = phytium_host_resume(config); -+ spin_unlock_irqrestore(&config->lock, flags); ++struct phytium_i3c_master_caps { ++ u32 cmdfifodepth; ++ u32 cmdrfifodepth; ++ u32 txfifodepth; ++ u32 rxfifodepth; ++ u32 ibirfifodepth; ++}; + -+ return ret; -+} ++struct phytium_i3c_cmd { ++ u32 cmd0; ++ u32 cmd1; ++ u32 tx_len; ++ const void *tx_buf; ++ u32 rx_len; ++ void *rx_buf; ++ u32 error; ++}; + -+static int phytium_pci_suspend(struct pci_dev *pdev, pm_message_t state) -+{ -+ unsigned long flags = 0; -+ struct phytium_cusb *config; ++struct phytium_i3c_xfer { ++ struct list_head node; ++ struct completion comp; + int ret; -+ -+ config = dev_get_drvdata(&pdev->dev); -+ -+ spin_lock_irqsave(&config->lock, flags); -+ ret = phytium_host_suspend(config); -+ spin_unlock_irqrestore(&config->lock, flags); -+ -+ return 0; -+} -+#endif -+ -+const struct pci_device_id phytium_pci_id_table[] = { -+ {0x10ee, 0x8012, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, -+ {} ++ unsigned int ncmds; ++ struct phytium_i3c_cmd cmds[]; +}; + -+static struct pci_driver phytium_otg_driver = { -+ .name = "phytium_usb", -+ .id_table = phytium_pci_id_table, -+ .probe = phytium_pci_probe, -+ .remove = phytium_pci_remove, -+ .shutdown = phytium_pci_shutdown, -+#ifdef CONFIG_PM -+ .resume = phytium_pci_resume, -+ .suspend = phytium_pci_suspend, -+#endif ++struct phytium_i3c_data { ++ u8 thd_delay_ns; +}; + -+module_pci_driver(phytium_otg_driver); -+ -+MODULE_AUTHOR("Chen Zhenhua "); -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium usb pci wrapper"); -diff --git a/drivers/usb/phytium/platform.c b/drivers/usb/phytium/platform.c -new file mode 100644 -index 000000000..48f35b19a ---- /dev/null -+++ b/drivers/usb/phytium/platform.c -@@ -0,0 +1,217 @@ -+// SPDX-License-Identifier: GPL-2.0 -+#include -+#include -+//#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "core.h" -+#include "hw-regs.h" -+ -+#define PHYTIUM_OTG_USB_LOADED 3 -+#define USB2_2_BASE_ADDRESS 0x31800000 -+ -+static const struct of_device_id phytium_otg_of_match[] = { -+ { -+ .compatible = "phytium,usb2", -+ }, -+ {}, ++struct phytium_i3c_slave_dev { ++ u32 dev_rr0; ++ u32 dev_rr1; ++ u32 dev_rr2; +}; -+MODULE_DEVICE_TABLE(of, phytium_otg_of_match); + -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_otg_acpi_match[] = { -+ { "PHYT0037", 0 }, -+ { } ++struct phytium_i3c_master { ++ struct work_struct hj_work; ++ struct i3c_master_controller base; ++ u32 free_rr_slots; ++ unsigned int maxdevs; ++ struct { ++ unsigned int num_slots; ++ struct i3c_dev_desc **slots; ++ spinlock_t lock; ++ } ibi; ++ struct { ++ struct list_head list; ++ struct phytium_i3c_xfer *cur; ++ spinlock_t lock; ++ } xferqueue; ++ void __iomem *regs; ++ struct clk *sysclk; ++ struct clk *pclk; ++ u32 sysclk_rate; ++ u32 prescl0; ++ u32 prescl1; ++ u32 ctrl_thd_del; ++ u32 ctrl_info; ++ u32 dev_valid; ++ struct device *dev; ++ struct phytium_i3c_master_caps caps; ++ unsigned long i3c_scl_lim; ++ const struct phytium_i3c_data *devdata; ++ struct phytium_i3c_slave_dev devinfo[PHYTIUM_I3C_DEV_MAX_NUM]; +}; -+MODULE_DEVICE_TABLE(acpi, phytium_otg_acpi_match); -+#endif + -+static int phytium_get_dr_mode(struct phytium_cusb *config) ++static inline struct phytium_i3c_master * ++to_phytium_i3c_master(struct i3c_master_controller *master) +{ -+ config->dr_mode = usb_get_dr_mode(config->dev); -+ if (config->dr_mode == USB_DR_MODE_UNKNOWN) -+ config->dr_mode = USB_DR_MODE_PERIPHERAL; -+ -+ return 0; ++ return container_of(master, struct phytium_i3c_master, base); +} + -+static irqreturn_t platform_usb_irq(int irq, void *dev_id) ++static void phytium_i3c_master_wr_to_tx_fifo(struct phytium_i3c_master *master, ++ const u8 *bytes, int nbytes) +{ -+ unsigned long flags; -+ uint8_t otgstate; -+ -+ struct phytium_cusb *config = (struct phytium_cusb *)dev_id; -+ struct GADGET_CTRL *gadget_ctrl = config->gadget_priv; -+ struct HOST_CTRL *host_ctrl = config->host_priv; -+ -+ if (gadget_ctrl || host_ctrl) { -+ if (host_ctrl) -+ otgstate = phytium_read8(&host_ctrl->regs->otgstate); -+ else -+ otgstate = phytium_read8(&gadget_ctrl->regs->otgstate); ++ writesl(master->regs + TX_FIFO, bytes, nbytes / 4); ++ if (nbytes & 3) { ++ u32 tmp = 0; + -+ spin_lock_irqsave(&config->lock, flags); -+ if (otgstate > HOST_OTG_STATE_A_WAIT_VFALL) -+ config->gadget_obj->gadget_isr(config->gadget_priv); -+ else -+ config->host_obj->host_isr(config->host_priv); -+ spin_unlock_irqrestore(&config->lock, flags); ++ memcpy(&tmp, bytes + (nbytes & ~3), nbytes & 3); ++ writesl(master->regs + TX_FIFO, &tmp, 1); + } -+ -+ return IRQ_HANDLED; +} + -+static int phytium_driver_probe(struct platform_device *pdev) ++static void phytium_i3c_master_rd_from_rx_fifo(struct phytium_i3c_master *master, ++ u8 *bytes, int nbytes) +{ -+ struct phytium_cusb *config; -+ struct resource *res, *phy_res; -+ int retval = 0; -+ -+ config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL); -+ if (!config) -+ return -ENOMEM; -+ -+ spin_lock_init(&config->lock); -+ config->dev = &pdev->dev; -+ config->isVhubHost = false; -+ -+ config->irq = platform_get_irq(pdev, 0); -+ if (config->irq <= 0) { -+ dev_err(config->dev, "getting usb irq failed\n"); -+ return config->irq; -+ } -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ config->regs = devm_ioremap(&pdev->dev, res->start, resource_size(res)); -+ if (IS_ERR(config->regs)) { -+ dev_err(config->dev, "map IOMEM resource failed\n"); -+ return -1; -+ } -+ -+ phy_res = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ config->phy_regs = devm_ioremap(&pdev->dev, phy_res->start, resource_size(phy_res)); -+ if (IS_ERR(config->phy_regs)) { -+ dev_err(config->dev, "map IOMEM phy resource failed\n"); -+ return -1; -+ } -+ -+ phytium_get_dr_mode(config); -+ -+ phytium_core_reset(config, false); -+ -+ if (config->dr_mode == USB_DR_MODE_HOST || -+ config->dr_mode == USB_DR_MODE_OTG) { -+ if (res->start == USB2_2_BASE_ADDRESS) -+ config->isVhubHost = true; ++ readsl(master->regs + RX_FIFO, bytes, nbytes / 4); ++ if (nbytes & 3) { ++ u32 tmp; + -+ phytium_host_init(config); ++ readsl(master->regs + RX_FIFO, &tmp, 1); ++ memcpy(bytes + (nbytes & ~3), &tmp, nbytes & 3); + } ++} + -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || -+ config->dr_mode == USB_DR_MODE_OTG) -+ phytium_gadget_init(config); -+ -+ dev_set_drvdata(&pdev->dev, config); ++static bool phytium_i3c_master_supports_ccc_cmd(struct i3c_master_controller *m, ++ const struct i3c_ccc_cmd *cmd) ++{ ++ if (cmd->ndests > 1) ++ return false; + -+ if (config->irq > 0) { -+ retval = devm_request_irq(config->dev, config->irq, platform_usb_irq, -+ IRQF_SHARED, "phytium_otg", config); -+ if (retval != 0) { -+ dev_err(config->dev, "request irq %d err %d\n", config->irq, retval); -+ config->irq = 0; -+ } ++ switch (cmd->id) { ++ case I3C_CCC_ENEC(true): ++ case I3C_CCC_ENEC(false): ++ case I3C_CCC_DISEC(true): ++ case I3C_CCC_DISEC(false): ++ case I3C_CCC_ENTAS(0, true): ++ case I3C_CCC_ENTAS(0, false): ++ case I3C_CCC_RSTDAA(true): ++ case I3C_CCC_RSTDAA(false): ++ case I3C_CCC_ENTDAA: ++ case I3C_CCC_SETMWL(true): ++ case I3C_CCC_SETMWL(false): ++ case I3C_CCC_SETMRL(true): ++ case I3C_CCC_SETMRL(false): ++ case I3C_CCC_DEFSLVS: ++ case I3C_CCC_ENTHDR(0): ++ case I3C_CCC_SETDASA: ++ case I3C_CCC_SETNEWDA: ++ case I3C_CCC_GETMWL: ++ case I3C_CCC_GETMRL: ++ case I3C_CCC_GETPID: ++ case I3C_CCC_GETBCR: ++ case I3C_CCC_GETDCR: ++ case I3C_CCC_GETSTATUS: ++ case I3C_CCC_GETACCMST: ++ case I3C_CCC_GETMXDS: ++ case I3C_CCC_GETHDRCAP: ++ return true; ++ default: ++ break; + } + -+ return retval; ++ return false; +} + -+static int phytium_driver_remove(struct platform_device *dev) ++static int phytium_i3c_master_disable(struct phytium_i3c_master *master) +{ -+ struct phytium_cusb *config = platform_get_drvdata(dev); -+ -+ if (!config) -+ return 0; -+ -+ phytium_get_dr_mode(config); -+ -+ if (config->dr_mode == USB_DR_MODE_HOST || -+ config->dr_mode == USB_DR_MODE_OTG) -+ phytium_host_uninit(config); ++ u32 status; + -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || -+ config->dr_mode == USB_DR_MODE_OTG) -+ phytium_gadget_uninit(config); ++ writel(readl(master->regs + CTRL) & ~CTRL_DEV_EN, master->regs + CTRL); + -+ dev_set_drvdata(&dev->dev, NULL); -+ return 0; ++ return readl_poll_timeout(master->regs + MST_STATUS0, status, ++ status & MST_STATUS0_IDLE, 10, 1000000); +} + -+static void phytium_driver_shutdown(struct platform_device *dev) ++static void phytium_i3c_master_enable(struct phytium_i3c_master *master) +{ -+ pr_info("%s %d\n", __func__, __LINE__); ++ writel(readl(master->regs + CTRL) | CTRL_DEV_EN, master->regs + CTRL); +} + -+#ifdef CONFIG_PM -+static int phytium_driver_suspend(struct device *dev) ++static struct phytium_i3c_xfer * ++phytium_i3c_master_alloc_xfer(struct phytium_i3c_master *master, unsigned int ncmds) +{ -+ struct phytium_cusb *config; -+ int ret = 0; -+ -+ config = dev_get_drvdata(dev); ++ struct phytium_i3c_xfer *xfer; + -+ if (config->dr_mode == USB_DR_MODE_HOST || -+ config->dr_mode == USB_DR_MODE_OTG) -+ ret = phytium_host_suspend(config); ++ xfer = kzalloc(struct_size(xfer, cmds, ncmds), GFP_KERNEL); ++ if (!xfer) ++ return NULL; + -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || -+ config->dr_mode == USB_DR_MODE_OTG) -+ ret = phytium_gadget_suspend(config); ++ INIT_LIST_HEAD(&xfer->node); ++ xfer->ncmds = ncmds; ++ xfer->ret = -ETIMEDOUT; + -+ return ret; ++ return xfer; +} + -+static int phytium_driver_resume(struct device *dev) ++static void phytium_i3c_master_free_xfer(struct phytium_i3c_xfer *xfer) +{ -+ struct phytium_cusb *config; -+ int ret = 0; -+ -+ config = dev_get_drvdata(dev); -+ if (config->dr_mode == USB_DR_MODE_HOST || -+ config->dr_mode == USB_DR_MODE_OTG) -+ ret = phytium_host_resume(config); ++ kfree(xfer); ++} + -+ if (config->dr_mode == USB_DR_MODE_PERIPHERAL || -+ config->dr_mode == USB_DR_MODE_OTG) -+ ret = phytium_gadget_resume(config); ++static void phytium_i3c_master_start_xfer_locked(struct phytium_i3c_master *master) ++{ ++ struct phytium_i3c_xfer *xfer = master->xferqueue.cur; ++ unsigned int i; + -+ return ret; -+} ++ if (!xfer) ++ return; + -+static const struct dev_pm_ops phytium_usb_pm_ops = { -+ SET_SYSTEM_SLEEP_PM_OPS(phytium_driver_suspend, phytium_driver_resume) -+}; -+#endif ++ phytium_i3c_master_enable(master); + -+static struct platform_driver phytium_otg_driver = { -+ .driver = { -+ .name = "phytium-otg", -+ .of_match_table = of_match_ptr(phytium_otg_of_match), -+ .acpi_match_table = ACPI_PTR(phytium_otg_acpi_match), -+#ifdef CONFIG_PM -+ .pm = &phytium_usb_pm_ops, -+#endif -+ }, -+ .probe = phytium_driver_probe, -+ .remove = phytium_driver_remove, -+ .shutdown = phytium_driver_shutdown, -+}; ++ writel(MST_INT_CMDD_EMP, master->regs + MST_ICR); ++ for (i = 0; i < xfer->ncmds; i++) { ++ struct phytium_i3c_cmd *cmd = &xfer->cmds[i]; + -+module_platform_driver(phytium_otg_driver); ++ phytium_i3c_master_wr_to_tx_fifo(master, cmd->tx_buf, ++ cmd->tx_len); ++ } ++ for (i = 0; i < xfer->ncmds; i++) { ++ struct phytium_i3c_cmd *cmd = &xfer->cmds[i]; + -+MODULE_AUTHOR("Chen Zhenhua "); -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Phytium usb platform wrapper"); -diff --git a/drivers/w1/masters/Kconfig b/drivers/w1/masters/Kconfig -index ad3165732..8f2675c38 100644 ---- a/drivers/w1/masters/Kconfig -+++ b/drivers/w1/masters/Kconfig -@@ -58,6 +58,16 @@ config HDQ_MASTER_OMAP - Say Y here if you want support for the 1-wire or HDQ Interface - on an OMAP processor. - -+config W1_MASTER_PHYTIUM -+ bool "Phytium 1-wire driver" -+ depends on ARCH_PHYTIUM || COMPILE_TEST -+ help -+ Say Y here if you want to get support for the 1-wire interface -+ on an Phytium SoC. ++ writel(cmd->cmd1 | CMD1_FIFO_CMDID(i), ++ master->regs + CMD1_FIFO); ++ writel(cmd->cmd0, master->regs + CMD0_FIFO); ++ } + -+ This driver can also be built as a module. If so, the module -+ will be called phytium-w1. ++ writel(readl(master->regs + CTRL) | CTRL_MCS, ++ master->regs + CTRL); ++ writel(MST_INT_CMDD_EMP, master->regs + MST_IER); ++} + - config W1_MASTER_SGI - tristate "SGI ASIC driver" - help -diff --git a/drivers/w1/masters/Makefile b/drivers/w1/masters/Makefile -index c5d85a827..60bf6070c 100644 ---- a/drivers/w1/masters/Makefile -+++ b/drivers/w1/masters/Makefile -@@ -10,4 +10,5 @@ obj-$(CONFIG_W1_MASTER_MXC) += mxc_w1.o - - obj-$(CONFIG_W1_MASTER_GPIO) += w1-gpio.o - obj-$(CONFIG_HDQ_MASTER_OMAP) += omap_hdq.o -+obj-$(CONFIG_W1_MASTER_PHYTIUM) += phytium_w1.o - obj-$(CONFIG_W1_MASTER_SGI) += sgi_w1.o -diff --git a/drivers/w1/masters/phytium_w1.c b/drivers/w1/masters/phytium_w1.c -new file mode 100644 -index 000000000..0cb62258d ---- /dev/null -+++ b/drivers/w1/masters/phytium_w1.c -@@ -0,0 +1,643 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium 1-wire bus master driver -+ * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ ++static void phytium_i3c_master_end_xfer_locked(struct phytium_i3c_master *master, ++ u32 isr) ++{ ++ struct phytium_i3c_xfer *xfer = master->xferqueue.cur; ++ int i, ret = 0; ++ u32 status0; + -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include ++ if (!xfer) ++ return; + -+#include ++ if (!(isr & MST_INT_CMDD_EMP)) ++ return; + -+#define PHY_W1M_CTL 0x08 ++ writel(MST_INT_CMDD_EMP, master->regs + MST_IDR); + -+/* Simplify mode */ -+#define PHY_W1M_CMD 0x04 -+#define PHY_W1M_PWM0_START_B 0x30 -+#define PHY_W1M_PWM0_END_B 0x34 -+#define PHY_W1M_PWM1_START_B 0x38 -+#define PHY_W1M_PWM1_END_B 0x3c -+#define PHY_W1M_SAMPLE_B 0x40 -+#define PHY_W1M_INT_EN_B 0x64 -+#define PHY_W1M_INT_STATUS_B 0x74 -+#define PHY_W1M_DATA_REG 0x70 ++ for (status0 = readl(master->regs + MST_STATUS0); ++ !(status0 & MST_STATUS0_CMDR_EMP); ++ status0 = readl(master->regs + MST_STATUS0)) { ++ struct phytium_i3c_cmd *cmd; ++ u32 cmdr, rx_len, id; + -+#define PHY_W1M_CMD_ROM_SEARCH 0xF0 -+#define PHY_W1M_CMD_WRITE_BIT 0x35 -+#define PHY_W1M_CMD_WRITE_BYTE 0x36 -+#define PHY_W1M_CMD_RESET_BUS 0x37 -+#define PHY_W1M_CMD_READ_BIT 0x3A -+#define PHY_W1M_CMD_READ_BYTE 0x3B -+#define PHY_W1M_SLAVE_ROM_ID 0x160 ++ cmdr = readl(master->regs + CMDR); ++ id = CMDR_CMDID(cmdr); ++ if (id == CMDR_CMDID_HJACK_DISEC || ++ id == CMDR_CMDID_HJACK_ENTDAA || ++ WARN_ON(id >= xfer->ncmds)) ++ continue; + -+#define PHY_W1M_INT_EN_TXCOMPLETE BIT(6) -+#define PHY_W1M_INT_EN_RXCOMPLETE BIT(7) ++ cmd = &xfer->cmds[CMDR_CMDID(cmdr)]; ++ rx_len = min_t(u32, CMDR_XFER_BYTES(cmdr), cmd->rx_len); ++ phytium_i3c_master_rd_from_rx_fifo(master, cmd->rx_buf, rx_len); ++ cmd->error = CMDR_ERROR(cmdr); ++ } + -+#define PHY_W1M_INT_STATUS_TXCOMPLETE BIT(6) -+#define PHY_W1M_INT_STATUS_RXCOMPLETE BIT(7) ++ for (i = 0; i < xfer->ncmds; i++) { ++ switch (xfer->cmds[i].error) { ++ case CMDR_NO_ERROR: ++ break; + -+#define W1M_MOD_W1 1 -+#define W1M_MOD_PECI 0 ++ case CMDR_DDR_PREAMBLE_ERROR: ++ case CMDR_DDR_PARITY_ERROR: ++ case CMDR_M0_ERROR: ++ case CMDR_M1_ERROR: ++ case CMDR_M2_ERROR: ++ case CMDR_MST_ABORT: ++ case CMDR_NACK_RESP: ++ case CMDR_DDR_DROPPED: ++ ret = -EIO; ++ break; + -+#define PHY_W1M_FLAG_CLEAR 0 -+#define PHY_W1M_FLAG_SET 1 -+#define PHY_W1M_TIMEOUT (HZ/5) ++ case CMDR_DDR_RX_FIFO_OVF: ++ case CMDR_DDR_TX_FIFO_UNF: ++ ret = -ENOSPC; ++ break; + -+#define PHY_W1M_MAX_USER 4 ++ case CMDR_INVALID_DA: ++ default: ++ ret = -EINVAL; ++ break; ++ } ++ } + -+static DECLARE_WAIT_QUEUE_HEAD(w1m_wait_queue); ++ xfer->ret = ret; ++ complete(&xfer->comp); + -+struct w1m_data { -+ struct device *dev; -+ void __iomem *w1m_base; -+ /* lock status update */ -+ struct mutex w1m_mutex; -+ int w1m_usecount; -+ u8 w1m_irqstatus; -+ /* device lock */ -+ spinlock_t w1m_spinlock; -+ /* -+ * Used to control the call to phytium_w1m_get and phytium_w1m_put. -+ * Non-w1 Protocol: Write the CMD|REG_address first, followed by -+ * the data wrire or read. -+ */ -+ int init_trans; -+}; ++ xfer = list_first_entry_or_null(&master->xferqueue.list, ++ struct phytium_i3c_xfer, node); ++ if (xfer) ++ list_del_init(&xfer->node); + -+/* W1 register I/O routines */ -+static inline u8 phytium_w1m_read(struct w1m_data *w1m_data, u32 offset) -+{ -+ return readl(w1m_data->w1m_base + offset); ++ master->xferqueue.cur = xfer; ++ phytium_i3c_master_start_xfer_locked(master); +} + -+static inline void phytium_w1m_write(struct w1m_data *w1m_data, u32 offset, u8 val) ++static void phytium_i3c_master_queue_xfer(struct phytium_i3c_master *master, ++ struct phytium_i3c_xfer *xfer) +{ -+ writel(val, w1m_data->w1m_base + offset); ++ unsigned long flags; ++ ++ init_completion(&xfer->comp); ++ spin_lock_irqsave(&master->xferqueue.lock, flags); ++ if (master->xferqueue.cur) { ++ list_add_tail(&xfer->node, &master->xferqueue.list); ++ } else { ++ master->xferqueue.cur = xfer; ++ phytium_i3c_master_start_xfer_locked(master); ++ } ++ spin_unlock_irqrestore(&master->xferqueue.lock, flags); +} + -+static inline u8 phytium_w1m_merge(struct w1m_data *w1m_data, u32 offset, -+ u8 val, u8 mask) ++static void phytium_i3c_master_unqueue_xfer(struct phytium_i3c_master *master, ++ struct phytium_i3c_xfer *xfer) +{ -+ u8 new_val = (__raw_readl(w1m_data->w1m_base + offset) & ~mask) -+ | (val & mask); -+ writel(new_val, w1m_data->w1m_base + offset); ++ unsigned long flags; + -+ return new_val; ++ spin_lock_irqsave(&master->xferqueue.lock, flags); ++ if (master->xferqueue.cur == xfer) { ++ u32 status; ++ ++ writel(readl(master->regs + CTRL) & ~CTRL_DEV_EN, ++ master->regs + CTRL); ++ readl_poll_timeout_atomic(master->regs + MST_STATUS0, status, ++ status & MST_STATUS0_IDLE, 10, ++ 1000000); ++ master->xferqueue.cur = NULL; ++ writel(FLUSH_RX_FIFO | FLUSH_TX_FIFO | FLUSH_CMD_FIFO | ++ FLUSH_CMD_RESP, ++ master->regs + FLUSH_CTRL); ++ writel(MST_INT_CMDD_EMP, master->regs + MST_IDR); ++ writel(readl(master->regs + CTRL) | CTRL_DEV_EN, ++ master->regs + CTRL); ++ } else { ++ list_del_init(&xfer->node); ++ } ++ spin_unlock_irqrestore(&master->xferqueue.lock, flags); +} + -+static void w1m_disable_interrupt(struct w1m_data *w1m_data, u32 offset, -+ u32 mask) ++static enum i3c_error_code phytium_i3c_cmd_get_err(struct phytium_i3c_cmd *cmd) +{ -+ u32 ie; ++ switch (cmd->error) { ++ case CMDR_M0_ERROR: ++ return I3C_ERROR_M0; + -+ ie = readl(w1m_data->w1m_base + offset); -+ writel(ie & mask, w1m_data->w1m_base + offset); ++ case CMDR_M1_ERROR: ++ return I3C_ERROR_M1; ++ ++ case CMDR_M2_ERROR: ++ case CMDR_NACK_RESP: ++ return I3C_ERROR_M2; ++ ++ default: ++ break; ++ } ++ ++ return I3C_ERROR_UNKNOWN; +} + -+/* write out a byte or bit and fill *status with W1M_INT_STATUS */ -+static int phytium_write_data(struct w1m_data *w1m_data, u8 val, u8 *status, bool is_bit) ++static int phytium_i3c_master_send_ccc_cmd(struct i3c_master_controller *m, ++ struct i3c_ccc_cmd *cmd) +{ ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ struct phytium_i3c_xfer *xfer; ++ struct phytium_i3c_cmd *ccmd; + int ret; -+ unsigned long irqflags; -+ -+ *status = 0; + -+ spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); -+ /* clear interrupt flags via a dummy read */ -+ phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); -+ /* ISR loads it with new INT_STATUS */ -+ w1m_data->w1m_irqstatus = 0; -+ spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); ++ xfer = phytium_i3c_master_alloc_xfer(master, 1); ++ if (!xfer) ++ return -ENOMEM; + -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_TXCOMPLETE, -+ PHY_W1M_INT_EN_TXCOMPLETE); ++ ccmd = xfer->cmds; ++ ccmd->cmd1 = CMD1_FIFO_CCC(cmd->id); ++ ccmd->cmd0 = CMD0_FIFO_IS_CCC | ++ CMD0_FIFO_PL_LEN(cmd->dests[0].payload.len); + -+ phytium_w1m_write(w1m_data, PHY_W1M_DATA_REG, val); -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, is_bit ? PHY_W1M_CMD_WRITE_BIT : PHY_W1M_CMD_WRITE_BYTE); ++ if (cmd->id & I3C_CCC_DIRECT) ++ ccmd->cmd0 |= CMD0_FIFO_DEV_ADDR(cmd->dests[0].addr); + -+ /* wait for the TXCOMPLETE bit */ -+ ret = wait_event_timeout(w1m_wait_queue, -+ w1m_data->w1m_irqstatus, PHY_W1M_TIMEOUT); -+ if (ret == 0) { -+ dev_err(w1m_data->dev, "TX wait elapsed\n"); -+ ret = -ETIMEDOUT; -+ goto out; ++ if (cmd->rnw) { ++ ccmd->cmd0 |= CMD0_FIFO_RNW; ++ ccmd->rx_buf = cmd->dests[0].payload.data; ++ ccmd->rx_len = cmd->dests[0].payload.len; ++ } else { ++ ccmd->tx_buf = cmd->dests[0].payload.data; ++ ccmd->tx_len = cmd->dests[0].payload.len; + } + -+ *status = w1m_data->w1m_irqstatus; -+ /* check irqstatus */ -+ if (!(*status & PHY_W1M_INT_STATUS_TXCOMPLETE)) { -+ dev_err(w1m_data->dev, -+ "timeout waiting for TXCOMPLETE/RXCOMPLETE, %x", *status); -+ ret = -ETIMEDOUT; ++ phytium_i3c_master_queue_xfer(master, xfer); ++ if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) ++ phytium_i3c_master_unqueue_xfer(master, xfer); ++ ++ /*GETMXDS format 1 need retransmission*/ ++ if ((xfer->ret) && (cmd->id == I3C_CCC_GETMXDS)) { ++ if (cmd->dests[0].payload.len == 5) { ++ cmd->dests[0].payload.len = 2; ++ ccmd->rx_len = cmd->dests[0].payload.len; ++ ccmd->cmd0 &= 0xfff000fff; ++ ccmd->cmd0 |= CMD0_FIFO_PL_LEN(cmd->dests[0].payload.len); ++ phytium_i3c_master_queue_xfer(master, xfer); ++ if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) ++ phytium_i3c_master_unqueue_xfer(master, xfer); ++ } + } ++ ret = xfer->ret; ++ cmd->err = phytium_i3c_cmd_get_err(&xfer->cmds[0]); ++ phytium_i3c_master_free_xfer(xfer); + -+out: + return ret; +} + -+static irqreturn_t w1m_isr(int irq, void *_w1m) ++static int phytium_i3c_master_priv_xfers(struct i3c_dev_desc *dev, ++ struct i3c_priv_xfer *xfers, ++ int nxfers) +{ -+ struct w1m_data *w1m_data = _w1m; -+ unsigned long irqflags; -+ -+ spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); -+ w1m_data->w1m_irqstatus = phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); -+ spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); ++ struct i3c_master_controller *m = i3c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ int txslots = 0, rxslots = 0, i, ret; ++ struct phytium_i3c_xfer *phytium_xfer; + -+ phytium_w1m_write(w1m_data, PHY_W1M_INT_STATUS_B, 0x00); -+ if (w1m_data->w1m_irqstatus & -+ (PHY_W1M_INT_STATUS_TXCOMPLETE | PHY_W1M_INT_STATUS_RXCOMPLETE)) { -+ /* wake up sleeping process */ -+ wake_up(&w1m_wait_queue); ++ for (i = 0; i < nxfers; i++) { ++ if (xfers[i].len > CMD0_FIFO_PL_LEN_MAX) ++ return -EOPNOTSUPP; + } + -+ return IRQ_HANDLED; -+} -+ ++ if (!nxfers) ++ return 0; + -+static int phytium_read_data(struct w1m_data *w1m_data, u8 *val, bool is_bit) -+{ -+ int ret = 0; -+ u8 status; -+ unsigned long irqflags; ++ if (nxfers > master->caps.cmdfifodepth || ++ nxfers > master->caps.cmdrfifodepth) ++ return -EOPNOTSUPP; + -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ ret = -EINTR; -+ goto rtn; ++ /* ++ * First make sure that all transactions (block of transfers separated ++ * by a STOP marker) fit in the FIFOs. ++ */ ++ for (i = 0; i < nxfers; i++) { ++ if (xfers[i].rnw) ++ rxslots += DIV_ROUND_UP(xfers[i].len, 4); ++ else ++ txslots += DIV_ROUND_UP(xfers[i].len, 4); + } + -+ if (!w1m_data->w1m_usecount) { -+ ret = -EINVAL; -+ goto out; -+ } ++ if (rxslots > master->caps.rxfifodepth || ++ txslots > master->caps.txfifodepth) ++ return -EOPNOTSUPP; ++ ++ phytium_xfer = phytium_i3c_master_alloc_xfer(master, nxfers); ++ if (!phytium_xfer) ++ return -ENOMEM; ++ ++ for (i = 0; i < nxfers; i++) { ++ struct phytium_i3c_cmd *ccmd = &phytium_xfer->cmds[i]; ++ u32 pl_len = xfers[i].len; + -+ spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); -+ /* clear interrupt flags via a dummy read */ -+ phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); -+ /* ISR loads it with new INT_STATUS */ -+ w1m_data->w1m_irqstatus = 0; -+ spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); ++ ccmd->cmd0 = CMD0_FIFO_DEV_ADDR(dev->info.dyn_addr) | ++ CMD0_FIFO_PRIV_XMIT_MODE(XMIT_BURST_WITHOUT_SUBADDR); + -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_RXCOMPLETE, -+ PHY_W1M_INT_EN_RXCOMPLETE); ++ if (xfers[i].rnw) { ++ ccmd->cmd0 |= CMD0_FIFO_RNW; ++ ccmd->rx_buf = xfers[i].data.in; ++ ccmd->rx_len = xfers[i].len; ++ pl_len++; ++ } else { ++ ccmd->tx_buf = xfers[i].data.out; ++ ccmd->tx_len = xfers[i].len; ++ } + -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, is_bit ? PHY_W1M_CMD_READ_BIT : PHY_W1M_CMD_READ_BYTE); ++ ccmd->cmd0 |= CMD0_FIFO_PL_LEN(pl_len); + -+ wait_event_timeout(w1m_wait_queue, -+ (w1m_data->w1m_irqstatus & PHY_W1M_INT_STATUS_RXCOMPLETE), -+ PHY_W1M_TIMEOUT); ++ if (i < nxfers - 1) ++ ccmd->cmd0 |= CMD0_FIFO_RSBC; + -+ status = w1m_data->w1m_irqstatus; -+ /* check irqstatus */ -+ if (!(status & PHY_W1M_INT_STATUS_RXCOMPLETE)) { -+ dev_err(w1m_data->dev, "timeout waiting for RXCOMPLETE, %x", status); -+ ret = -ETIMEDOUT; -+ goto out; ++ if (!i) ++ ccmd->cmd0 |= CMD0_FIFO_BCH; + } + -+ /* the data is ready. Read it in! */ -+ *val = phytium_w1m_read(w1m_data, PHY_W1M_DATA_REG); -+out: -+ mutex_unlock(&w1m_data->w1m_mutex); -+rtn: -+ return ret; -+} -+ ++ phytium_i3c_master_queue_xfer(master, phytium_xfer); ++ if (!wait_for_completion_timeout(&phytium_xfer->comp, ++ msecs_to_jiffies(1000))) ++ phytium_i3c_master_unqueue_xfer(master, phytium_xfer); + -+static int phytium_w1m_get(struct w1m_data *w1m_data) -+{ -+ int ret = 0; ++ ret = phytium_xfer->ret; + -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ ret = -EINTR; -+ goto rtn; -+ } ++ for (i = 0; i < nxfers; i++) ++ xfers[i].err = phytium_i3c_cmd_get_err(&phytium_xfer->cmds[i]); + -+ if (w1m_data->w1m_usecount == PHY_W1M_MAX_USER) { -+ dev_warn(w1m_data->dev, "attempt to exceed the max use count"); -+ ret = -EINVAL; -+ goto out; -+ } else { -+ w1m_data->w1m_usecount++; -+ try_module_get(THIS_MODULE); -+ if (w1m_data->w1m_usecount == 1) -+ pm_runtime_get_sync(w1m_data->dev); -+ } ++ phytium_i3c_master_free_xfer(phytium_xfer); + -+out: -+ mutex_unlock(&w1m_data->w1m_mutex); -+rtn: + return ret; +} + -+/* Disable clocks to the module */ -+static int phytium_w1m_put(struct w1m_data *w1m_data) ++static int phytium_i3c_master_i2c_xfers(struct i2c_dev_desc *dev, ++ const struct i2c_msg *xfers, int nxfers) +{ -+ int ret = 0; ++ struct i3c_master_controller *m = i2c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ unsigned int nrxwords = 0, ntxwords = 0; ++ struct phytium_i3c_xfer *xfer; ++ int i, ret = 0; + -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) -+ return -EINTR; ++ if (nxfers > master->caps.cmdfifodepth) ++ return -EOPNOTSUPP; + -+ if (w1m_data->w1m_usecount == 0) { -+ dev_warn(w1m_data->dev, -+ "attempt to decrement use count when it is zero"); -+ ret = -EINVAL; -+ } else { -+ w1m_data->w1m_usecount--; -+ module_put(THIS_MODULE); -+ if (w1m_data->w1m_usecount == 0) -+ pm_runtime_put_sync(w1m_data->dev); ++ for (i = 0; i < nxfers; i++) { ++ if (xfers[i].len > CMD0_FIFO_PL_LEN_MAX) ++ return -EOPNOTSUPP; ++ ++ if (xfers[i].flags & I2C_M_RD) ++ nrxwords += DIV_ROUND_UP(xfers[i].len, 4); ++ else ++ ntxwords += DIV_ROUND_UP(xfers[i].len, 4); + } -+ mutex_unlock(&w1m_data->w1m_mutex); + -+ return ret; -+} ++ if (ntxwords > master->caps.txfifodepth || ++ nrxwords > master->caps.rxfifodepth) ++ return -EOPNOTSUPP; + -+/* -+ * W1 triplet callback function - used for searching ROM addresses. -+ * Registered only when controller is in 1-wire mode. -+ */ -+static u8 phytium_w1_triplet(void *_w1m, u8 bdir) -+{ -+ u8 id_bit, comp_bit; -+ int err; -+ u8 ret = 0x3; /* no slaves responded */ -+ struct w1m_data *w1m_data = _w1m; ++ xfer = phytium_i3c_master_alloc_xfer(master, nxfers); ++ if (!xfer) ++ return -ENOMEM; + -+ phytium_w1m_get(_w1m); ++ for (i = 0; i < nxfers; i++) { ++ struct phytium_i3c_cmd *ccmd = &xfer->cmds[i]; + -+ err = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (err < 0) { -+ dev_err(w1m_data->dev, "Could not acquire mutex\n"); -+ goto rtn; -+ } ++ ccmd->cmd0 = CMD0_FIFO_DEV_ADDR(xfers[i].addr) | ++ CMD0_FIFO_PL_LEN(xfers[i].len) | ++ CMD0_FIFO_PRIV_XMIT_MODE(XMIT_BURST_WITHOUT_SUBADDR); + -+ w1m_data->w1m_irqstatus = 0; -+ /* read id_bit */ -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_RXCOMPLETE, -+ PHY_W1M_INT_EN_RXCOMPLETE); -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); ++ if (xfers[i].flags & I2C_M_TEN) ++ ccmd->cmd0 |= CMD0_FIFO_IS_10B; + -+ err = wait_event_timeout(w1m_wait_queue, -+ (w1m_data->w1m_irqstatus -+ & PHY_W1M_INT_STATUS_RXCOMPLETE), -+ PHY_W1M_TIMEOUT); -+ if (err == 0) { -+ dev_err(w1m_data->dev, "RX wait elapsed\n"); -+ goto out; ++ if (xfers[i].flags & I2C_M_RD) { ++ ccmd->cmd0 |= CMD0_FIFO_RNW; ++ ccmd->rx_buf = xfers[i].buf; ++ ccmd->rx_len = xfers[i].len; ++ } else { ++ ccmd->tx_buf = xfers[i].buf; ++ ccmd->tx_len = xfers[i].len; ++ } + } -+ id_bit = (phytium_w1m_read(_w1m, PHY_W1M_DATA_REG) & 0x01); + -+ w1m_data->w1m_irqstatus = 0; -+ /* read comp_bit */ -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_RXCOMPLETE, -+ PHY_W1M_INT_EN_RXCOMPLETE); -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); -+ err = wait_event_timeout(w1m_wait_queue, -+ (w1m_data->w1m_irqstatus -+ & PHY_W1M_INT_STATUS_RXCOMPLETE), -+ PHY_W1M_TIMEOUT); -+ if (err == 0) { -+ dev_err(w1m_data->dev, "RX wait elapsed\n"); -+ goto out; -+ } -+ comp_bit = (phytium_w1m_read(_w1m, PHY_W1M_DATA_REG) & 0x01); ++ phytium_i3c_master_queue_xfer(master, xfer); ++ if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) ++ phytium_i3c_master_unqueue_xfer(master, xfer); + -+ if (id_bit && comp_bit) { -+ ret = 0x03; /* no slaves responded */ -+ goto out; -+ } -+ if (!id_bit && !comp_bit) { -+ /* Both bits are valid, take the direction given */ -+ ret = bdir ? 0x04 : 0; -+ } else { -+ /* Only one bit is valid, take that direction */ -+ bdir = id_bit; -+ ret = id_bit ? 0x05 : 0x02; -+ } ++ ret = xfer->ret; ++ phytium_i3c_master_free_xfer(xfer); + -+ w1m_data->w1m_irqstatus = 0; -+ /* write bdir bit */ -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_TXCOMPLETE, -+ PHY_W1M_INT_EN_TXCOMPLETE); ++ return ret; ++} + -+ phytium_w1m_write(w1m_data, PHY_W1M_DATA_REG, bdir); -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x35); ++struct phytium_i3c_i2c_dev_data { ++ u16 id; ++ s16 ibi; ++ struct i3c_generic_ibi_pool *ibi_pool; ++}; + -+ err = wait_event_timeout(w1m_wait_queue, -+ (w1m_data->w1m_irqstatus -+ & PHY_W1M_INT_STATUS_TXCOMPLETE), -+ PHY_W1M_TIMEOUT); -+ if (err == 0) { -+ dev_err(w1m_data->dev, "TX wait elapsed\n"); -+ goto out; -+ } ++static u32 prepare_rr0_dev_address(u32 addr) ++{ ++ u32 ret = (addr << 1) & 0xff; ++ ++ /* RR0[7:1] = addr[6:0] */ ++ ret |= (addr & GENMASK(6, 0)) << 1; ++ ++ /* RR0[15:13] = addr[9:7] */ ++ ret |= (addr & GENMASK(9, 7)) << 6; ++ ++ /* RR0[0] = ~XOR(addr[6:0]) */ ++ if (!(hweight8(addr & 0x7f) & 1)) ++ ret |= 1; + -+out: -+ mutex_unlock(&w1m_data->w1m_mutex); -+rtn: -+ phytium_w1m_put(_w1m); + return ret; +} + -+static u8 phytium_w1_touch_bit(void *_w1m, u8 bit) ++static void phytium_i3c_master_upd_i3c_addr(struct i3c_dev_desc *dev) +{ -+ u8 result = 0; -+ int err; -+ struct w1m_data *w1m_data = _w1m; -+ -+ phytium_w1m_get(w1m_data); -+ -+ w1m_data->init_trans++; ++ struct i3c_master_controller *m = i3c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); ++ u32 rr; + -+ err = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (err < 0) { -+ dev_err(w1m_data->dev, "Could not acquired mutex\n"); -+ goto rtn; -+ } ++ rr = prepare_rr0_dev_address(dev->info.dyn_addr ? ++ dev->info.dyn_addr : ++ dev->info.static_addr); ++ writel(DEV_ID_RR0_IS_I3C | rr, master->regs + DEV_ID_RR0(data->id)); ++} + -+ w1m_data->w1m_irqstatus = 0; ++static int phytium_i3c_master_get_rr_slot(struct phytium_i3c_master *master, ++ u8 dyn_addr) ++{ ++ unsigned long activedevs; ++ u32 rr; ++ int i; + -+ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, -+ PHY_W1M_INT_EN_RXCOMPLETE, -+ PHY_W1M_INT_EN_RXCOMPLETE); -+ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); ++ if (!dyn_addr) { ++ if (!master->free_rr_slots) ++ return -ENOSPC; + -+ err = wait_event_timeout(w1m_wait_queue, -+ (w1m_data->w1m_irqstatus & PHY_W1M_INT_STATUS_RXCOMPLETE), -+ PHY_W1M_TIMEOUT); -+ if (err == 0) { -+ dev_info(w1m_data->dev, "Rx wait elapsed\n"); -+ goto out; ++ return ffs(master->free_rr_slots) - 1; + } + -+ result = (phytium_w1m_read(w1m_data, PHY_W1M_DATA_REG) & 0x01); ++ activedevs = readl(master->regs + DEVS_CTRL) & DEVS_CTRL_DEVS_ACTIVE_MASK; ++ activedevs &= ~BIT(0); + -+ w1m_data->w1m_irqstatus = 0; ++ for_each_set_bit(i, &activedevs, master->maxdevs + 1) { ++ rr = readl(master->regs + DEV_ID_RR0(i)); ++ if (!(rr & DEV_ID_RR0_IS_I3C) || ++ DEV_ID_RR0_GET_DEV_ADDR(rr) != dyn_addr) ++ continue; + -+out: -+ mutex_unlock(&w1m_data->w1m_mutex); -+rtn: -+ phytium_w1m_put(w1m_data); ++ return i; ++ } + -+ return result; ++ return -EINVAL; +} + -+/* reset callback */ -+static u8 phytium_w1_reset_bus(void *_w1m) ++static int phytium_i3c_master_reattach_i3c_dev(struct i3c_dev_desc *dev, ++ u8 old_dyn_addr) +{ -+ phytium_w1m_get(_w1m); -+ phytium_w1m_write(_w1m, PHY_W1M_CMD, 0x37); -+ mdelay(1); -+ phytium_w1m_put(_w1m); ++ phytium_i3c_master_upd_i3c_addr(dev); ++ + return 0; +} + -+/* Read a byte of data from the device */ -+static u8 phytium_w1_read_data(void *_w1m, bool is_bit) ++static int phytium_i3c_master_attach_i3c_dev(struct i3c_dev_desc *dev) +{ -+ struct w1m_data *w1m_data = _w1m; -+ u8 val = 0; -+ int ret; ++ struct i3c_master_controller *m = i3c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ struct phytium_i3c_i2c_dev_data *data; ++ int slot; + -+ /* First write to initialize the transfer */ -+ if (w1m_data->init_trans == 0) -+ phytium_w1m_get(w1m_data); ++ data = kzalloc(sizeof(*data), GFP_KERNEL); ++ if (!data) ++ return -ENOMEM; + -+ w1m_data->init_trans++; -+ ret = phytium_read_data(w1m_data, &val, is_bit); -+ if (ret) { -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ dev_err(w1m_data->dev, "Could not acquire mutex\n"); -+ return -EINTR; -+ } -+ w1m_data->init_trans = 0; -+ mutex_unlock(&w1m_data->w1m_mutex); -+ phytium_w1m_put(w1m_data); -+ return -1; ++ slot = phytium_i3c_master_get_rr_slot(master, dev->info.dyn_addr); ++ if (slot < 0) { ++ kfree(data); ++ return slot; + } + -+ w1m_disable_interrupt(w1m_data, PHY_W1M_INT_EN_B, -+ ~((u32)PHY_W1M_INT_EN_RXCOMPLETE)); ++ data->ibi = -1; ++ data->id = slot; ++ i3c_dev_set_master_data(dev, data); ++ master->free_rr_slots &= ~BIT(slot); + -+ /* Write followed by a read, release the module */ -+ if (w1m_data->init_trans) { -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ dev_err(w1m_data->dev, "Could not acquire mutex\n"); -+ return -EINTR; -+ } -+ w1m_data->init_trans = 0; -+ mutex_unlock(&w1m_data->w1m_mutex); -+ phytium_w1m_put(w1m_data); ++ if (!dev->info.dyn_addr) { ++ phytium_i3c_master_upd_i3c_addr(dev); ++ writel(readl(master->regs + DEVS_CTRL) | ++ DEVS_CTRL_DEV_ACTIVE(data->id), ++ master->regs + DEVS_CTRL); + } + -+ return val; ++ return 0; +} + -+static u8 phytium_w1_read_bit(void *_w1m) ++static void phytium_i3c_master_detach_i3c_dev(struct i3c_dev_desc *dev) +{ -+ return phytium_w1_read_data(_w1m, true); -+} ++ struct i3c_master_controller *m = i3c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); + -+static u8 phytium_w1_read_byte(void *_w1m) -+{ -+ return phytium_w1_read_data(_w1m, false); ++ writel(readl(master->regs + DEVS_CTRL) | ++ DEVS_CTRL_DEV_CLR(data->id), ++ master->regs + DEVS_CTRL); ++ ++ i3c_dev_set_master_data(dev, NULL); ++ master->free_rr_slots |= BIT(data->id); ++ kfree(data); +} + -+/* Write a byte of data to the device */ -+static void phytium_w1_write_data(void *_w1m, u8 byte, bool is_bit) ++static int phytium_i3c_master_attach_i2c_dev(struct i2c_dev_desc *dev) +{ -+ struct w1m_data *w1m_data = _w1m; -+ int ret; -+ u8 status; ++ struct i3c_master_controller *m = i2c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ struct phytium_i3c_i2c_dev_data *data; ++ int slot; + -+ /* First write to initialize the transfer */ -+ if (w1m_data->init_trans == 0) -+ phytium_w1m_get(w1m_data); ++ slot = phytium_i3c_master_get_rr_slot(master, 0); ++ if (slot < 0) ++ return slot; + -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ dev_err(w1m_data->dev, "Could not acquire mutex\n"); -+ return; -+ } -+ mutex_unlock(&w1m_data->w1m_mutex); ++ data = kzalloc(sizeof(*data), GFP_KERNEL); ++ if (!data) ++ return -ENOMEM; + -+ ret = phytium_write_data(w1m_data, byte, &status, is_bit); -+ if (ret < 0) { -+ dev_err(w1m_data->dev, "TX failure:Ctrl status %x\n", status); -+ return; -+ } ++ data->id = slot; ++ master->free_rr_slots &= ~BIT(slot); ++ i2c_dev_set_master_data(dev, data); + -+ w1m_data->init_trans++; -+ w1m_disable_interrupt(w1m_data, PHY_W1M_INT_EN_B, -+ ~((u32)PHY_W1M_INT_EN_TXCOMPLETE)); -+ /* Second write, data transferred. Release the module */ -+ if (w1m_data->init_trans > 1) { -+ phytium_w1m_put(w1m_data); -+ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); -+ if (ret < 0) { -+ dev_err(w1m_data->dev, "Could not acquire mutex\n"); -+ return; -+ } -+ w1m_data->init_trans = 0; -+ mutex_unlock(&w1m_data->w1m_mutex); -+ } ++ writel(prepare_rr0_dev_address(dev->addr), ++ master->regs + DEV_ID_RR0(data->id)); ++ writel(dev->lvr, master->regs + DEV_ID_RR2(data->id)); ++ writel(readl(master->regs + DEVS_CTRL) | ++ DEVS_CTRL_DEV_ACTIVE(data->id), ++ master->regs + DEVS_CTRL); ++ ++ return 0; +} + -+static void phytium_w1_write_bit(void *_w1m, u8 bit) ++static void phytium_i3c_master_detach_i2c_dev(struct i2c_dev_desc *dev) +{ -+ phytium_w1_write_data(_w1m, bit, true); ++ struct i3c_master_controller *m = i2c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ struct phytium_i3c_i2c_dev_data *data = i2c_dev_get_master_data(dev); ++ ++ writel(readl(master->regs + DEVS_CTRL) | ++ DEVS_CTRL_DEV_CLR(data->id), ++ master->regs + DEVS_CTRL); ++ master->free_rr_slots |= BIT(data->id); ++ ++ i2c_dev_set_master_data(dev, NULL); ++ kfree(data); +} + -+static void phytium_w1_write_byte(void *_w1m, u8 bit) ++static void phytium_i3c_master_bus_cleanup(struct i3c_master_controller *m) +{ -+ phytium_w1_write_data(_w1m, bit, false); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ ++ phytium_i3c_master_disable(master); +} + -+static struct w1_bus_master phytium_w1_master = { -+ .read_byte = phytium_w1_read_byte, -+ .write_byte = phytium_w1_write_byte, -+ .read_bit = phytium_w1_read_bit, -+ .write_bit = phytium_w1_write_bit, -+ .reset_bus = phytium_w1_reset_bus, -+ .touch_bit = phytium_w1_touch_bit, -+}; ++static void phytium_i3c_master_dev_rr_to_info(struct phytium_i3c_master *master, ++ unsigned int slot, ++ struct i3c_device_info *info) ++{ ++ u32 rr; + -+static int phytium_w1m_probe(struct platform_device *pdev) ++ memset(info, 0, sizeof(*info)); ++ rr = readl(master->regs + DEV_ID_RR0(slot)); ++ info->dyn_addr = DEV_ID_RR0_GET_DEV_ADDR(rr); ++ rr = readl(master->regs + DEV_ID_RR2(slot)); ++ info->dcr = rr; ++ info->bcr = rr >> 8; ++ info->pid = rr >> 16; ++ info->pid |= (u64)readl(master->regs + DEV_ID_RR1(slot)) << 16; ++} ++ ++static void phytium_i3c_master_upd_i3c_scl_lim(struct phytium_i3c_master *master) +{ -+ struct device *dev = &pdev->dev; -+ struct w1m_data *w1m_data; -+ struct resource *res; -+ int ret, irq; ++ struct i3c_master_controller *m = &master->base; ++ unsigned long i3c_lim_period, pres_step, ncycles; ++ struct i3c_bus *bus = i3c_master_get_bus(m); ++ unsigned long new_i3c_scl_lim = 0; ++ struct i3c_dev_desc *dev; ++ u32 prescl1, ctrl; ++ ++ i3c_bus_for_each_i3cdev(bus, dev) { ++ unsigned long max_fscl; ++ ++ max_fscl = max(I3C_CCC_MAX_SDR_FSCL(dev->info.max_read_ds), ++ I3C_CCC_MAX_SDR_FSCL(dev->info.max_write_ds)); ++ switch (max_fscl) { ++ case I3C_SDR1_FSCL_8MHZ: ++ max_fscl = 8000000; ++ break; ++ case I3C_SDR2_FSCL_6MHZ: ++ max_fscl = 6000000; ++ break; ++ case I3C_SDR3_FSCL_4MHZ: ++ max_fscl = 4000000; ++ break; ++ case I3C_SDR4_FSCL_2MHZ: ++ max_fscl = 2000000; ++ break; ++ case I3C_SDR0_FSCL_MAX: ++ default: ++ max_fscl = 0; ++ break; ++ } + -+ w1m_data = devm_kzalloc(dev, sizeof(*w1m_data), GFP_KERNEL); -+ if (!w1m_data) -+ return -ENOMEM; ++ if (max_fscl && ++ (new_i3c_scl_lim > max_fscl || !new_i3c_scl_lim)) ++ new_i3c_scl_lim = max_fscl; ++ } + -+ w1m_data->dev = dev; -+ platform_set_drvdata(pdev, w1m_data); ++ /* Only update PRESCL_CTRL1 if the I3C SCL limitation has changed. */ ++ if (new_i3c_scl_lim == master->i3c_scl_lim) ++ return; ++ master->i3c_scl_lim = new_i3c_scl_lim; ++ if (!new_i3c_scl_lim) ++ return; ++ pres_step = 1000000000UL / (bus->scl_rate.i3c * 4); + -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ w1m_data->w1m_base = devm_ioremap_resource(dev, res); -+ if (IS_ERR(w1m_data->w1m_base)) -+ return PTR_ERR(w1m_data->w1m_base); ++ /* Configure PP_LOW to meet I3C slave limitations. */ ++ prescl1 = readl(master->regs + PRESCL_CTRL1) & ++ ~PRESCL_CTRL1_PP_LOW_MASK; ++ ctrl = readl(master->regs + CTRL); + -+ w1m_data->w1m_usecount = 0; -+ mutex_init(&w1m_data->w1m_mutex); ++ i3c_lim_period = DIV_ROUND_UP(1000000000, master->i3c_scl_lim); ++ ncycles = DIV_ROUND_UP(i3c_lim_period, pres_step); ++ if (ncycles < 4) ++ ncycles = 0; ++ else ++ ncycles -= 4; + -+ pm_runtime_enable(&pdev->dev); -+ ret = pm_runtime_get_sync(&pdev->dev); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "pm_runtime_get_sync failed\n"); -+ goto err_w1; -+ } ++ prescl1 |= PRESCL_CTRL1_PP_LOW(ncycles); + -+ spin_lock_init(&w1m_data->w1m_spinlock); ++ /* Disable I3C master before updating PRESCL_CTRL1. */ ++ if (ctrl & CTRL_DEV_EN) ++ phytium_i3c_master_disable(master); + -+ irq = platform_get_irq(pdev, 0); -+ if (irq < 0) { -+ dev_err(&pdev->dev, "Failed to get IRQ: %d\n", irq); -+ ret = irq; -+ goto err_irq; -+ } ++ writel(prescl1, master->regs + PRESCL_CTRL1); + -+ ret = devm_request_irq(dev, irq, w1m_isr, 0, "phytium-w1", w1m_data); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "could not request irq\n"); -+ goto err_irq; -+ } ++ if (ctrl & CTRL_DEV_EN) ++ phytium_i3c_master_enable(master); ++} + -+ pm_runtime_put_sync(&pdev->dev); ++static int phytium_i3c_master_do_daa(struct i3c_master_controller *m) ++{ ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ unsigned long olddevs, newdevs; ++ int ret, slot; ++ u8 addrs[MAX_DEVS] = { }; ++ u8 last_addr = 0; + -+ phytium_w1_master.triplet = phytium_w1_triplet; -+ phytium_w1m_write(w1m_data, PHY_W1M_CTL, 0x10); -+ phytium_w1m_write(w1m_data, PHY_W1M_INT_EN_B, 0x00); ++ olddevs = readl(master->regs + DEVS_CTRL) & DEVS_CTRL_DEVS_ACTIVE_MASK; ++ olddevs |= BIT(0); + -+ phytium_w1_master.data = w1m_data; ++ /* Prepare RR slots before launching DAA. */ ++ for_each_clear_bit(slot, &olddevs, master->maxdevs + 1) { ++ ret = i3c_master_get_free_addr(m, last_addr + 1); ++ if (ret < 0) ++ return -ENOSPC; + -+ ret = w1_add_master_device(&phytium_w1_master); -+ if (ret) { -+ dev_err(&pdev->dev, "Failure in registering w1 master\n"); -+ goto err_w1; ++ last_addr = ret; ++ addrs[slot] = last_addr; ++ writel(prepare_rr0_dev_address(last_addr) | DEV_ID_RR0_IS_I3C, ++ master->regs + DEV_ID_RR0(slot)); ++ writel(0, master->regs + DEV_ID_RR1(slot)); ++ writel(0, master->regs + DEV_ID_RR2(slot)); + } + -+ return 0; -+ -+err_irq: -+ pm_runtime_put_sync(&pdev->dev); -+err_w1: -+ pm_runtime_disable(&pdev->dev); -+ -+ return ret; -+} ++ ret = i3c_master_entdaa_locked(&master->base); ++ if (ret && ret != I3C_ERROR_M2) ++ return ret; + -+static int phytium_w1m_remove(struct platform_device *pdev) -+{ -+ struct w1m_data *w1m_data = platform_get_drvdata(pdev); ++ newdevs = readl(master->regs + DEVS_CTRL) & DEVS_CTRL_DEVS_ACTIVE_MASK; ++ newdevs &= ~olddevs; + -+ mutex_lock(&w1m_data->w1m_mutex); ++ /* ++ * Clear all retaining registers filled during DAA. We already ++ * have the addressed assigned to them in the addrs array. ++ */ ++ for_each_set_bit(slot, &newdevs, master->maxdevs + 1) ++ i3c_master_add_i3c_dev_locked(m, addrs[slot]); + -+ if (w1m_data->w1m_usecount) { -+ dev_warn(&pdev->dev, "removed when use count is not zero\n"); -+ mutex_unlock(&w1m_data->w1m_mutex); -+ return -EBUSY; -+ } ++ /* ++ * Clear slots that ended up not being used. Can be caused by I3C ++ * device creation failure or when the I3C device was already known ++ * by the system but with a different address (in this case the device ++ * already has a slot and does not need a new one). ++ */ ++ writel(readl(master->regs + DEVS_CTRL) | ++ master->free_rr_slots << DEVS_CTRL_DEV_CLR_SHIFT, ++ master->regs + DEVS_CTRL); ++ i3c_master_defslvs_locked(&master->base); + -+ mutex_unlock(&w1m_data->w1m_mutex); ++ phytium_i3c_master_upd_i3c_scl_lim(master); + -+ /* remove module dependency */ -+ pm_runtime_disable(&pdev->dev); ++ /* Unmask Hot-Join and Mastership request interrupts. */ ++ i3c_master_enec_locked(m, I3C_BROADCAST_ADDR, ++ I3C_CCC_EVENT_HJ | I3C_CCC_EVENT_MR); + + return 0; +} + -+static const struct of_device_id phytium_w1m_dt_ids[] = { -+ { .compatible = "phytium,w1" }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, phytium_w1m_dt_ids); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_w1m_acpi_ids[] = { -+ { "PHYT0034", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_w1m_acpi_ids); -+#endif -+ -+static struct platform_driver phytium_w1m_driver = { -+ .probe = phytium_w1m_probe, -+ .remove = phytium_w1m_remove, -+ .driver = { -+ .name = "phytium-w1", -+ .of_match_table = phytium_w1m_dt_ids, -+ .acpi_match_table = ACPI_PTR(phytium_w1m_acpi_ids), -+ }, -+}; -+module_platform_driver(phytium_w1m_driver); ++static u8 phytium_i3c_master_calculate_thd_delay(struct phytium_i3c_master *master) ++{ ++ unsigned long sysclk_rate = clk_get_rate(master->sysclk); ++ u8 thd_delay = DIV_ROUND_UP(master->devdata->thd_delay_ns, ++ (NSEC_PER_SEC / sysclk_rate)); + -+MODULE_AUTHOR("Zhu Mingshuai "); -+MODULE_DESCRIPTION("Phytium w1 bus master driver"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/watchdog/dw_wdt.c b/drivers/watchdog/dw_wdt.c -index 84dca3695..c444082e0 100644 ---- a/drivers/watchdog/dw_wdt.c -+++ b/drivers/watchdog/dw_wdt.c -@@ -12,6 +12,7 @@ - * heartbeat requests after the watchdog device has been closed. - */ - -+#include - #include - #include - #include -@@ -83,7 +84,7 @@ struct dw_wdt { - void __iomem *regs; - struct clk *clk; - struct clk *pclk; -- unsigned long rate; -+ u64 rate; - enum dw_wdt_rmod rmod; - struct dw_wdt_timeout timeouts[DW_WDT_NUM_TOPS]; - struct watchdog_device wdd; -@@ -560,33 +561,45 @@ static int dw_wdt_drv_probe(struct platform_device *pdev) - if (IS_ERR(dw_wdt->regs)) - return PTR_ERR(dw_wdt->regs); - -- /* -- * Try to request the watchdog dedicated timer clock source. It must -- * be supplied if asynchronous mode is enabled. Otherwise fallback -- * to the common timer/bus clocks configuration, in which the very -- * first found clock supply both timer and APB signals. -- */ -- dw_wdt->clk = devm_clk_get_enabled(dev, "tclk"); -- if (IS_ERR(dw_wdt->clk)) { -- dw_wdt->clk = devm_clk_get_enabled(dev, NULL); -- if (IS_ERR(dw_wdt->clk)) -- return PTR_ERR(dw_wdt->clk); -- } -+ if (dev->of_node) { -+ /* -+ * Try to request the watchdog dedicated timer clock source. It must -+ * be supplied if asynchronous mode is enabled. Otherwise fallback -+ * to the common timer/bus clocks configuration, in which the very -+ * first found clock supply both timer and APB signals. -+ */ -+ dw_wdt->clk = devm_clk_get_enabled(dev, "tclk"); -+ if (IS_ERR(dw_wdt->clk)) { -+ dw_wdt->clk = devm_clk_get_enabled(dev, NULL); -+ if (IS_ERR(dw_wdt->clk)) -+ return PTR_ERR(dw_wdt->clk); -+ } - -- dw_wdt->rate = clk_get_rate(dw_wdt->clk); -- if (dw_wdt->rate == 0) -- return -EINVAL; -+ dw_wdt->rate = clk_get_rate(dw_wdt->clk); -+ if (dw_wdt->rate == 0) -+ return -EINVAL; - -- /* -- * Request APB clock if device is configured with async clocks mode. -- * In this case both tclk and pclk clocks are supposed to be specified. -- * Alas we can't know for sure whether async mode was really activated, -- * so the pclk phandle reference is left optional. If it couldn't be -- * found we consider the device configured in synchronous clocks mode. -- */ -- dw_wdt->pclk = devm_clk_get_optional_enabled(dev, "pclk"); -- if (IS_ERR(dw_wdt->pclk)) -- return PTR_ERR(dw_wdt->pclk); -+ /* -+ * Request APB clock if device is configured with async clocks mode. -+ * In this case both tclk and pclk clocks are supposed to be specified. -+ * Alas we can't know for sure whether async mode was really activated, -+ * so the pclk phandle reference is left optional. If it couldn't be -+ * found we consider the device configured in synchronous clocks mode. -+ */ -+ dw_wdt->pclk = devm_clk_get_optional_enabled(dev, "pclk"); -+ if (IS_ERR(dw_wdt->pclk)) -+ return PTR_ERR(dw_wdt->pclk); -+ } else if (has_acpi_companion(&pdev->dev)) { -+ /* -+ * When Driver probe with ACPI device, clock devices -+ * are not available, so watchdog rate get from -+ * clock-frequency property given in _DSD object. -+ */ -+ device_property_read_u64(dev, "clock-frequency", -+ &dw_wdt->rate); -+ if (dw_wdt->rate == 0) ++ /* Every value greater than 3 is not valid. */ ++ if (thd_delay > THD_DELAY_MAX) ++ thd_delay = THD_DELAY_MAX; ++ ++ /* CTLR_THD_DEL value is encoded. */ ++ return (THD_DELAY_MAX - thd_delay); ++} ++ ++static int phytium_i3c_master_bus_init(struct i3c_master_controller *m) ++{ ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ unsigned long pres_step, sysclk_rate, max_i2cfreq; ++ struct i3c_bus *bus = i3c_master_get_bus(m); ++ u32 ctrl, prescl0, prescl1, pres, low; ++ struct i3c_device_info info = { }; ++ int ret, ncycles; ++ ++ switch (bus->mode) { ++ case I3C_BUS_MODE_PURE: ++ ctrl = CTRL_PURE_BUS_MODE; ++ break; ++ ++ case I3C_BUS_MODE_MIXED_FAST: ++ ctrl = CTRL_MIXED_FAST_BUS_MODE; ++ break; ++ ++ case I3C_BUS_MODE_MIXED_SLOW: ++ ctrl = CTRL_MIXED_SLOW_BUS_MODE; ++ break; ++ ++ default: ++ return -EINVAL; ++ } ++ ++ if (has_acpi_companion(master->dev)) { ++ writel(master->prescl0, master->regs + PRESCL_CTRL0); ++ writel(master->prescl1, master->regs + PRESCL_CTRL1); ++ } else { ++ sysclk_rate = clk_get_rate(master->sysclk); ++ ++ if (!sysclk_rate) + return -EINVAL; ++ ++ pres = DIV_ROUND_UP(sysclk_rate, (bus->scl_rate.i3c * 4)) - 1; ++ if (pres > PRESCL_CTRL0_MAX) ++ return -ERANGE; ++ ++ bus->scl_rate.i3c = sysclk_rate / ((pres + 1) * 4); ++ ++ prescl0 = PRESCL_CTRL0_I3C(pres); ++ ++ low = ((I3C_BUS_TLOW_OD_MIN_NS * sysclk_rate) / (pres + 1)) - 2; ++ prescl1 = PRESCL_CTRL1_OD_LOW(low); ++ ++ max_i2cfreq = bus->scl_rate.i2c; ++ ++ pres = (sysclk_rate / (max_i2cfreq * 5)) - 1; ++ if (pres > PRESCL_CTRL0_MAX) ++ return -ERANGE; ++ ++ bus->scl_rate.i2c = sysclk_rate / ((pres + 1) * 5); ++ ++ prescl0 |= PRESCL_CTRL0_I2C(pres); ++ writel(prescl0, master->regs + PRESCL_CTRL0); ++ master->prescl0 = prescl0; ++ ++ /* Calculate OD and PP low. */ ++ pres_step = 1000000000 / (bus->scl_rate.i3c * 4); ++ ncycles = DIV_ROUND_UP(I3C_BUS_TLOW_OD_MIN_NS, pres_step) - 2; ++ if (ncycles < 0) ++ ncycles = 0; ++ prescl1 = PRESCL_CTRL1_OD_LOW(ncycles); ++ writel(prescl1, master->regs + PRESCL_CTRL1); ++ master->prescl1 = prescl1; + } - - dw_wdt->rst = devm_reset_control_get_optional_shared(&pdev->dev, NULL); - if (IS_ERR(dw_wdt->rst)) -@@ -674,6 +687,12 @@ static void dw_wdt_drv_remove(struct platform_device *pdev) - reset_control_assert(dw_wdt->rst); - } - -+static const struct acpi_device_id dw_wdt_acpi_match[] = { -+ { "PHYT0014", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, dw_wdt_acpi_match); ++ /* Get an address for the master. */ ++ ret = i3c_master_get_free_addr(m, 0); ++ if (ret < 0) ++ return ret; + - #ifdef CONFIG_OF - static const struct of_device_id dw_wdt_of_match[] = { - { .compatible = "snps,dw-wdt", }, -@@ -688,6 +707,7 @@ static struct platform_driver dw_wdt_driver = { - .driver = { - .name = "dw_wdt", - .of_match_table = of_match_ptr(dw_wdt_of_match), -+ .acpi_match_table = ACPI_PTR(dw_wdt_acpi_match), - .pm = pm_sleep_ptr(&dw_wdt_pm_ops), - }, - }; -diff --git a/include/acpi/acpi_drivers.h b/include/acpi/acpi_drivers.h -index b14d16563..0feb61171 100644 ---- a/include/acpi/acpi_drivers.h -+++ b/include/acpi/acpi_drivers.h -@@ -51,7 +51,7 @@ - - int acpi_irq_penalty_init(void); - int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, -- int *polarity, char **name); -+ int *polarity, char **name, struct fwnode_handle **rs_fwnode); - int acpi_pci_link_free_irq(acpi_handle handle); - - /* ACPI PCI Device Binding */ -diff --git a/include/acpi/ghes.h b/include/acpi/ghes.h -index be1dd4c1a..e9180206d 100644 ---- a/include/acpi/ghes.h -+++ b/include/acpi/ghes.h -@@ -130,6 +130,20 @@ int ghes_notify_sea(void); - static inline int ghes_notify_sea(void) { return -ENOENT; } - #endif - -+#ifdef CONFIG_ACPI_APEI_SEI -+int ghes_notify_sei(void); -+#else -+static inline int ghes_notify_sei(void) { return -ENOENT; } -+#endif ++ writel(prepare_rr0_dev_address(ret) | DEV_ID_RR0_IS_I3C, ++ master->regs + DEV_ID_RR0(0)); + -+struct ghes_mem_err { -+ int notify_type; -+ int severity; -+ struct cper_sec_mem_err *mem_err; -+}; ++ phytium_i3c_master_dev_rr_to_info(master, 0, &info); ++ if (info.bcr & I3C_BCR_HDR_CAP) ++ info.hdr_cap = I3C_CCC_HDR_MODE(I3C_HDR_DDR); + -+extern struct atomic_notifier_head ghes_mem_err_chain; ++ ret = i3c_master_set_info(&master->base, &info); ++ if (ret) ++ return ret; + - struct notifier_block; - extern void ghes_register_report_chain(struct notifier_block *nb); - extern void ghes_unregister_report_chain(struct notifier_block *nb); -diff --git a/include/linux/acpi.h b/include/linux/acpi.h -index afd94c9b8..78ff80550 100644 ---- a/include/linux/acpi.h -+++ b/include/linux/acpi.h -@@ -358,6 +358,18 @@ struct irq_domain *acpi_irq_create_hierarchy(unsigned int flags, - const struct irq_domain_ops *ops, - void *host_data); - -+#ifdef CONFIG_ACPI_GENERIC_GSI -+struct fwnode_handle *acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source, -+ u32 gsi); -+#else -+static inline -+struct fwnode_handle *acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source, -+ u32 gsi) -+{ -+ return NULL; -+} -+#endif ++ /* ++ * Enable Hot-Join, and, when a Hot-Join request happens, disable all ++ * events coming from this device. ++ * ++ * We will issue ENTDAA afterwards from the threaded IRQ handler. ++ */ + - #ifdef CONFIG_X86_IO_APIC - extern int acpi_get_override_irq(u32 gsi, int *trigger, int *polarity); - #else -diff --git a/include/linux/cpuhotplug.h b/include/linux/cpuhotplug.h -index 624d4a38c..2f979c03d 100644 ---- a/include/linux/cpuhotplug.h -+++ b/include/linux/cpuhotplug.h -@@ -256,6 +256,8 @@ enum cpuhp_state { - CPUHP_AP_MM_DEMOTION_ONLINE, - CPUHP_AP_X86_HPET_ONLINE, - CPUHP_AP_X86_KVM_CLK_ONLINE, -+ CPUHP_AP_DTPM_CPU_ONLINE, -+ CPUHP_AP_HOMO_RPROC_STARTING, - CPUHP_AP_ACTIVE, - CPUHP_ONLINE, - }; -diff --git a/include/linux/i3c/master.h b/include/linux/i3c/master.h -index 0b52da4f2..c55be28cf 100644 ---- a/include/linux/i3c/master.h -+++ b/include/linux/i3c/master.h -@@ -182,6 +182,7 @@ struct i3c_dev_boardinfo { - u8 static_addr; - u64 pid; - struct device_node *of_node; -+ struct fwnode_handle *fwnode; - }; - - /** -diff --git a/include/linux/irqchip/arm-gic-phytium-2500.h b/include/linux/irqchip/arm-gic-phytium-2500.h -new file mode 100644 -index 000000000..c80a65f28 ---- /dev/null -+++ b/include/linux/irqchip/arm-gic-phytium-2500.h -@@ -0,0 +1,661 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ ++ ctrl |= CTRL_HJ_DISEC | CTRL_MCS_EN; ++ /* ++ * Configure data hold delay based on device-specific data. ++ * ++ * MIPI I3C Specification 1.0 defines non-zero minimal tHD_PP timing on ++ * master output. This setting allows to meet this timing on master's ++ * SoC outputs, regardless of PCB balancing. ++ */ ++ if (has_acpi_companion(master->dev)) ++ ctrl |= CTRL_THD_DELAY(master->ctrl_thd_del); ++ else ++ ctrl |= CTRL_THD_DELAY(phytium_i3c_master_calculate_thd_delay(master)); + -+#ifndef __LINUX_IRQCHIP_ARM_GIC_PHYTIUM_2500_H -+#define __LINUX_IRQCHIP_ARM_GIC_PHYTIUM_2500_H ++ writel(ctrl, master->regs + CTRL); + -+/* -+ * Distributor registers. We assume we're running non-secure, with ARE -+ * being set. Secure-only and non-ARE registers are not described. -+ */ -+#define GICD_CTLR 0x0000 -+#define GICD_TYPER 0x0004 -+#define GICD_IIDR 0x0008 -+#define GICD_TYPER2 0x000C -+#define GICD_STATUSR 0x0010 -+#define GICD_SETSPI_NSR 0x0040 -+#define GICD_CLRSPI_NSR 0x0048 -+#define GICD_SETSPI_SR 0x0050 -+#define GICD_CLRSPI_SR 0x0058 -+#define GICD_IGROUPR 0x0080 -+#define GICD_ISENABLER 0x0100 -+#define GICD_ICENABLER 0x0180 -+#define GICD_ISPENDR 0x0200 -+#define GICD_ICPENDR 0x0280 -+#define GICD_ISACTIVER 0x0300 -+#define GICD_ICACTIVER 0x0380 -+#define GICD_IPRIORITYR 0x0400 -+#define GICD_ICFGR 0x0C00 -+#define GICD_IGRPMODR 0x0D00 -+#define GICD_NSACR 0x0E00 -+#define GICD_IGROUPRnE 0x1000 -+#define GICD_ISENABLERnE 0x1200 -+#define GICD_ICENABLERnE 0x1400 -+#define GICD_ISPENDRnE 0x1600 -+#define GICD_ICPENDRnE 0x1800 -+#define GICD_ISACTIVERnE 0x1A00 -+#define GICD_ICACTIVERnE 0x1C00 -+#define GICD_IPRIORITYRnE 0x2000 -+#define GICD_ICFGRnE 0x3000 -+#define GICD_IROUTER 0x6000 -+#define GICD_IROUTERnE 0x8000 -+#define GICD_IDREGS 0xFFD0 -+#define GICD_PIDR2 0xFFE8 ++ phytium_i3c_master_enable(master); + -+#define ESPI_BASE_INTID 4096 ++ return 0; ++} + -+/* -+ * Those registers are actually from GICv2, but the spec demands that they -+ * are implemented as RES0 if ARE is 1 (which we do in KVM's emulated GICv3). -+ */ -+#define GICD_ITARGETSR 0x0800 -+#define GICD_SGIR 0x0F00 -+#define GICD_CPENDSGIR 0x0F10 -+#define GICD_SPENDSGIR 0x0F20 ++static void phytium_i3c_master_handle_ibi(struct phytium_i3c_master *master, ++ u32 ibir) ++{ ++ struct phytium_i3c_i2c_dev_data *data; ++ bool data_consumed = false; ++ struct i3c_ibi_slot *slot; ++ u32 id = IBIR_SLVID(ibir); ++ struct i3c_dev_desc *dev; ++ size_t nbytes; ++ u8 *buf; + -+#define GICD_CTLR_RWP (1U << 31) -+#define GICD_CTLR_nASSGIreq (1U << 8) -+#define GICD_CTLR_DS (1U << 6) -+#define GICD_CTLR_ARE_NS (1U << 4) -+#define GICD_CTLR_ENABLE_G1A (1U << 1) -+#define GICD_CTLR_ENABLE_G1 (1U << 0) ++ /* ++ * FIXME: maybe we should report the FIFO OVF errors to the upper ++ * layer. ++ */ ++ if (id >= master->ibi.num_slots || (ibir & IBIR_ERROR)) ++ goto out; + -+#define GICD_IIDR_IMPLEMENTER_SHIFT 0 -+#define GICD_IIDR_IMPLEMENTER_MASK (0xfff << GICD_IIDR_IMPLEMENTER_SHIFT) -+#define GICD_IIDR_REVISION_SHIFT 12 -+#define GICD_IIDR_REVISION_MASK (0xf << GICD_IIDR_REVISION_SHIFT) -+#define GICD_IIDR_VARIANT_SHIFT 16 -+#define GICD_IIDR_VARIANT_MASK (0xf << GICD_IIDR_VARIANT_SHIFT) -+#define GICD_IIDR_PRODUCT_ID_SHIFT 24 -+#define GICD_IIDR_PRODUCT_ID_MASK (0xff << GICD_IIDR_PRODUCT_ID_SHIFT) ++ dev = master->ibi.slots[id]; ++ spin_lock(&master->ibi.lock); + ++ data = i3c_dev_get_master_data(dev); ++ slot = i3c_generic_ibi_get_free_slot(data->ibi_pool); ++ if (!slot) ++ goto out_unlock; + -+/* -+ * In systems with a single security state (what we emulate in KVM) -+ * the meaning of the interrupt group enable bits is slightly different -+ */ -+#define GICD_CTLR_ENABLE_SS_G1 (1U << 1) -+#define GICD_CTLR_ENABLE_SS_G0 (1U << 0) ++ buf = slot->data; + -+#define GICD_TYPER_RSS (1U << 26) -+#define GICD_TYPER_LPIS (1U << 17) -+#define GICD_TYPER_MBIS (1U << 16) -+#define GICD_TYPER_ESPI (1U << 8) ++ nbytes = IBIR_XFER_BYTES(ibir); ++ readsl(master->regs + IBI_DATA_FIFO, buf, nbytes / 4); ++ if (nbytes % 3) { ++ u32 tmp = __raw_readl(master->regs + IBI_DATA_FIFO); + -+#define GICD_TYPER_ID_BITS(typer) ((((typer) >> 19) & 0x1f) + 1) -+#define GICD_TYPER_NUM_LPIS(typer) ((((typer) >> 11) & 0x1f) + 1) -+#define GICD_TYPER_SPIS(typer) ((((typer) & 0x1f) + 1) * 32) -+#define GICD_TYPER_ESPIS(typer) \ -+ (((typer) & GICD_TYPER_ESPI) ? GICD_TYPER_SPIS((typer) >> 27) : 0) ++ memcpy(buf + (nbytes & ~3), &tmp, nbytes & 3); ++ } + -+#define GICD_TYPER2_nASSGIcap (1U << 8) -+#define GICD_TYPER2_VIL (1U << 7) -+#define GICD_TYPER2_VID GENMASK(4, 0) ++ slot->len = min_t(unsigned int, IBIR_XFER_BYTES(ibir), ++ dev->ibi->max_payload_len); ++ i3c_master_queue_ibi(dev, slot); ++ data_consumed = true; + -+#define GICD_IROUTER_SPI_MODE_ONE (0U << 31) -+#define GICD_IROUTER_SPI_MODE_ANY (1U << 31) ++out_unlock: ++ spin_unlock(&master->ibi.lock); + -+#define GIC_PIDR2_ARCH_MASK 0xf0 -+#define GIC_PIDR2_ARCH_GICv3 0x30 -+#define GIC_PIDR2_ARCH_GICv4 0x40 ++out: ++ /* Consume data from the FIFO if it's not been done already. */ ++ if (!data_consumed) { ++ int i; + -+#define GIC_V3_DIST_SIZE 0x10000 ++ for (i = 0; i < IBIR_XFER_BYTES(ibir); i += 4) ++ readl(master->regs + IBI_DATA_FIFO); ++ } ++} + -+#define GIC_PAGE_SIZE_4K 0ULL -+#define GIC_PAGE_SIZE_16K 1ULL -+#define GIC_PAGE_SIZE_64K 2ULL -+#define GIC_PAGE_SIZE_MASK 3ULL ++static void phytium_i3c_master_demux_ibis(struct phytium_i3c_master *master) ++{ ++ u32 status0; + -+/* -+ * Re-Distributor registers, offsets from RD_base -+ */ -+#define GICR_CTLR GICD_CTLR -+#define GICR_IIDR 0x0004 -+#define GICR_TYPER 0x0008 -+#define GICR_STATUSR GICD_STATUSR -+#define GICR_WAKER 0x0014 -+#define GICR_SETLPIR 0x0040 -+#define GICR_CLRLPIR 0x0048 -+#define GICR_PROPBASER 0x0070 -+#define GICR_PENDBASER 0x0078 -+#define GICR_INVLPIR 0x00A0 -+#define GICR_INVALLR 0x00B0 -+#define GICR_SYNCR 0x00C0 -+#define GICR_IDREGS GICD_IDREGS -+#define GICR_PIDR2 GICD_PIDR2 ++ writel(MST_INT_IBIR_THR, master->regs + MST_ICR); + -+#define GICR_CTLR_ENABLE_LPIS (1UL << 0) -+#define GICR_CTLR_CES (1UL << 1) -+#define GICR_CTLR_IR (1UL << 2) -+#define GICR_CTLR_RWP (1UL << 3) ++ for (status0 = readl(master->regs + MST_STATUS0); ++ !(status0 & MST_STATUS0_IBIR_EMP); ++ status0 = readl(master->regs + MST_STATUS0)) { ++ u32 ibir = readl(master->regs + IBIR); + -+#define GICR_TYPER_CPU_NUMBER(r) (((r) >> 8) & 0xffff) ++ switch (IBIR_TYPE(ibir)) { ++ case IBIR_TYPE_IBI: ++ phytium_i3c_master_handle_ibi(master, ibir); ++ break; + -+#define EPPI_BASE_INTID 1056 ++ case IBIR_TYPE_HJ: ++ WARN_ON(IBIR_XFER_BYTES(ibir) || (ibir & IBIR_ERROR)); ++ queue_work(master->base.wq, &master->hj_work); ++ break; + -+#define GICR_TYPER_NR_PPIS(r) \ -+ ({ \ -+ unsigned int __ppinum = ((r) >> 27) & 0x1f; \ -+ unsigned int __nr_ppis = 16; \ -+ if (__ppinum == 1 || __ppinum == 2) \ -+ __nr_ppis += __ppinum * 32; \ -+ \ -+ __nr_ppis; \ -+ }) ++ case IBIR_TYPE_MR: ++ WARN_ON(IBIR_XFER_BYTES(ibir) || (ibir & IBIR_ERROR)); ++ break; ++ default: ++ break; ++ } ++ } ++} + -+#define GICR_WAKER_ProcessorSleep (1U << 1) -+#define GICR_WAKER_ChildrenAsleep (1U << 2) ++static irqreturn_t phytium_i3c_master_interrupt(int irq, void *data) ++{ ++ struct phytium_i3c_master *master = data; ++ u32 status; + -+#define GIC_BASER_CACHE_nCnB 0ULL -+#define GIC_BASER_CACHE_SameAsInner 0ULL -+#define GIC_BASER_CACHE_nC 1ULL -+#define GIC_BASER_CACHE_RaWt 2ULL -+#define GIC_BASER_CACHE_RaWb 3ULL -+#define GIC_BASER_CACHE_WaWt 4ULL -+#define GIC_BASER_CACHE_WaWb 5ULL -+#define GIC_BASER_CACHE_RaWaWt 6ULL -+#define GIC_BASER_CACHE_RaWaWb 7ULL -+#define GIC_BASER_CACHE_MASK 7ULL -+#define GIC_BASER_NonShareable 0ULL -+#define GIC_BASER_InnerShareable 1ULL -+#define GIC_BASER_OuterShareable 2ULL -+#define GIC_BASER_SHAREABILITY_MASK 3ULL ++ status = readl(master->regs + MST_ISR); ++ if (!(status & readl(master->regs + MST_IMR))) ++ return IRQ_NONE; + -+#define GIC_BASER_CACHEABILITY(reg, inner_outer, type) \ -+ (GIC_BASER_CACHE_##type << reg##_##inner_outer##_CACHEABILITY_SHIFT) ++ spin_lock(&master->xferqueue.lock); ++ phytium_i3c_master_end_xfer_locked(master, status); ++ spin_unlock(&master->xferqueue.lock); + -+#define GIC_BASER_SHAREABILITY(reg, type) \ -+ (GIC_BASER_##type << reg##_SHAREABILITY_SHIFT) ++ if (status & MST_INT_IBIR_THR) ++ phytium_i3c_master_demux_ibis(master); + -+/* encode a size field of width @w containing @n - 1 units */ -+#define GIC_ENCODE_SZ(n, w) (((unsigned long)(n) - 1) & GENMASK_ULL(((w) - 1), 0)) ++ return IRQ_HANDLED; ++} + -+#define GICR_PROPBASER_SHAREABILITY_SHIFT (10) -+#define GICR_PROPBASER_INNER_CACHEABILITY_SHIFT (7) -+#define GICR_PROPBASER_OUTER_CACHEABILITY_SHIFT (56) -+#define GICR_PROPBASER_SHAREABILITY_MASK \ -+ GIC_BASER_SHAREABILITY(GICR_PROPBASER, SHAREABILITY_MASK) -+#define GICR_PROPBASER_INNER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, MASK) -+#define GICR_PROPBASER_OUTER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GICR_PROPBASER, OUTER, MASK) -+#define GICR_PROPBASER_CACHEABILITY_MASK GICR_PROPBASER_INNER_CACHEABILITY_MASK ++static int phytium_i3c_master_disable_ibi(struct i3c_dev_desc *dev) ++{ ++ struct i3c_master_controller *m = i3c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); ++ unsigned long flags; ++ u32 sirmap; ++ int ret; + -+#define GICR_PROPBASER_InnerShareable \ -+ GIC_BASER_SHAREABILITY(GICR_PROPBASER, InnerShareable) ++ ret = i3c_master_disec_locked(m, dev->info.dyn_addr, ++ I3C_CCC_EVENT_SIR); ++ if (ret) ++ return ret; + -+#define GICR_PROPBASER_nCnB GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, nCnB) -+#define GICR_PROPBASER_nC GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, nC) -+#define GICR_PROPBASER_RaWt GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, RaWt) -+#define GICR_PROPBASER_RaWb GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, RaWb) -+#define GICR_PROPBASER_WaWt GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, WaWt) -+#define GICR_PROPBASER_WaWb GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, WaWb) -+#define GICR_PROPBASER_RaWaWt GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, RaWaWt) -+#define GICR_PROPBASER_RaWaWb GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, RaWaWb) ++ spin_lock_irqsave(&master->ibi.lock, flags); ++ sirmap = readl(master->regs + SIR_MAP_DEV_REG(data->ibi)); ++ sirmap &= ~SIR_MAP_DEV_CONF_MASK(data->ibi); ++ sirmap |= SIR_MAP_DEV_CONF(data->ibi, ++ SIR_MAP_DEV_DA(I3C_BROADCAST_ADDR)); ++ writel(sirmap, master->regs + SIR_MAP_DEV_REG(data->ibi)); ++ spin_unlock_irqrestore(&master->ibi.lock, flags); + -+#define GICR_PROPBASER_IDBITS_MASK (0x1f) -+#define GICR_PROPBASER_ADDRESS(x) ((x) & GENMASK_ULL(51, 12)) -+#define GICR_PENDBASER_ADDRESS(x) ((x) & GENMASK_ULL(51, 16)) ++ return ret; ++} + -+#define GICR_PENDBASER_SHAREABILITY_SHIFT (10) -+#define GICR_PENDBASER_INNER_CACHEABILITY_SHIFT (7) -+#define GICR_PENDBASER_OUTER_CACHEABILITY_SHIFT (56) -+#define GICR_PENDBASER_SHAREABILITY_MASK \ -+ GIC_BASER_SHAREABILITY(GICR_PENDBASER, SHAREABILITY_MASK) -+#define GICR_PENDBASER_INNER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, MASK) -+#define GICR_PENDBASER_OUTER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GICR_PENDBASER, OUTER, MASK) -+#define GICR_PENDBASER_CACHEABILITY_MASK GICR_PENDBASER_INNER_CACHEABILITY_MASK ++static int phytium_i3c_master_enable_ibi(struct i3c_dev_desc *dev) ++{ ++ struct i3c_master_controller *m = i3c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); ++ unsigned long flags; ++ u32 sircfg, sirmap; ++ int ret; + -+#define GICR_PENDBASER_InnerShareable \ -+ GIC_BASER_SHAREABILITY(GICR_PENDBASER, InnerShareable) ++ spin_lock_irqsave(&master->ibi.lock, flags); ++ sirmap = readl(master->regs + SIR_MAP_DEV_REG(data->ibi)); ++ sirmap &= ~SIR_MAP_DEV_CONF_MASK(data->ibi); ++ sircfg = SIR_MAP_DEV_ROLE(dev->info.bcr >> 6) | ++ SIR_MAP_DEV_DA(dev->info.dyn_addr) | ++ SIR_MAP_DEV_PL(dev->info.max_ibi_len) | ++ SIR_MAP_DEV_ACK; + -+#define GICR_PENDBASER_nCnB GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, nCnB) -+#define GICR_PENDBASER_nC GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, nC) -+#define GICR_PENDBASER_RaWt GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, RaWt) -+#define GICR_PENDBASER_RaWb GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, RaWb) -+#define GICR_PENDBASER_WaWt GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, WaWt) -+#define GICR_PENDBASER_WaWb GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, WaWb) -+#define GICR_PENDBASER_RaWaWt GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, RaWaWt) -+#define GICR_PENDBASER_RaWaWb GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, RaWaWb) ++ if (dev->info.bcr & I3C_BCR_MAX_DATA_SPEED_LIM) ++ sircfg |= SIR_MAP_DEV_SLOW; + -+#define GICR_PENDBASER_PTZ BIT_ULL(62) ++ sirmap |= SIR_MAP_DEV_CONF(data->ibi, sircfg); ++ writel(sirmap, master->regs + SIR_MAP_DEV_REG(data->ibi)); ++ spin_unlock_irqrestore(&master->ibi.lock, flags); + -+/* -+ * Re-Distributor registers, offsets from SGI_base -+ */ -+#define GICR_IGROUPR0 GICD_IGROUPR -+#define GICR_ISENABLER0 GICD_ISENABLER -+#define GICR_ICENABLER0 GICD_ICENABLER -+#define GICR_ISPENDR0 GICD_ISPENDR -+#define GICR_ICPENDR0 GICD_ICPENDR -+#define GICR_ISACTIVER0 GICD_ISACTIVER -+#define GICR_ICACTIVER0 GICD_ICACTIVER -+#define GICR_IPRIORITYR0 GICD_IPRIORITYR -+#define GICR_ICFGR0 GICD_ICFGR -+#define GICR_IGRPMODR0 GICD_IGRPMODR -+#define GICR_NSACR GICD_NSACR ++ ret = i3c_master_enec_locked(m, dev->info.dyn_addr, ++ I3C_CCC_EVENT_SIR); ++ if (ret) { ++ spin_lock_irqsave(&master->ibi.lock, flags); ++ sirmap = readl(master->regs + SIR_MAP_DEV_REG(data->ibi)); ++ sirmap &= ~SIR_MAP_DEV_CONF_MASK(data->ibi); ++ sirmap |= SIR_MAP_DEV_CONF(data->ibi, ++ SIR_MAP_DEV_DA(I3C_BROADCAST_ADDR)); ++ writel(sirmap, master->regs + SIR_MAP_DEV_REG(data->ibi)); ++ spin_unlock_irqrestore(&master->ibi.lock, flags); ++ } + -+#define GICR_TYPER_PLPIS (1U << 0) -+#define GICR_TYPER_VLPIS (1U << 1) -+#define GICR_TYPER_DIRTY (1U << 2) -+#define GICR_TYPER_DirectLPIS (1U << 3) -+#define GICR_TYPER_LAST (1U << 4) -+#define GICR_TYPER_RVPEID (1U << 7) -+#define GICR_TYPER_COMMON_LPI_AFF GENMASK_ULL(25, 24) -+#define GICR_TYPER_AFFINITY GENMASK_ULL(63, 32) ++ return ret; ++} + -+#define GICR_INVLPIR_INTID GENMASK_ULL(31, 0) -+#define GICR_INVLPIR_VPEID GENMASK_ULL(47, 32) -+#define GICR_INVLPIR_V GENMASK_ULL(63, 63) ++static int phytium_i3c_master_request_ibi(struct i3c_dev_desc *dev, ++ const struct i3c_ibi_setup *req) ++{ ++ struct i3c_master_controller *m = i3c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); ++ unsigned long flags; ++ unsigned int i; + -+#define GICR_INVALLR_VPEID GICR_INVLPIR_VPEID -+#define GICR_INVALLR_V GICR_INVLPIR_V ++ data->ibi_pool = i3c_generic_ibi_alloc_pool(dev, req); ++ if (IS_ERR(data->ibi_pool)) ++ return PTR_ERR(data->ibi_pool); + -+#define GIC_V3_REDIST_SIZE 0x20000 ++ spin_lock_irqsave(&master->ibi.lock, flags); ++ for (i = 0; i < master->ibi.num_slots; i++) { ++ if (!master->ibi.slots[i]) { ++ data->ibi = i; ++ master->ibi.slots[i] = dev; ++ break; ++ } ++ } ++ spin_unlock_irqrestore(&master->ibi.lock, flags); + -+#define LPI_PROP_GROUP1 (1 << 1) -+#define LPI_PROP_ENABLED (1 << 0) ++ if (i < master->ibi.num_slots) ++ return 0; + -+/* -+ * Re-Distributor registers, offsets from VLPI_base -+ */ -+#define GICR_VPROPBASER 0x0070 ++ i3c_generic_ibi_free_pool(data->ibi_pool); ++ data->ibi_pool = NULL; + -+#define GICR_VPROPBASER_IDBITS_MASK 0x1f ++ return -ENOSPC; ++} + -+#define GICR_VPROPBASER_SHAREABILITY_SHIFT (10) -+#define GICR_VPROPBASER_INNER_CACHEABILITY_SHIFT (7) -+#define GICR_VPROPBASER_OUTER_CACHEABILITY_SHIFT (56) ++static void phytium_i3c_master_free_ibi(struct i3c_dev_desc *dev) ++{ ++ struct i3c_master_controller *m = i3c_dev_get_master(dev); ++ struct phytium_i3c_master *master = to_phytium_i3c_master(m); ++ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); ++ unsigned long flags; + -+#define GICR_VPROPBASER_SHAREABILITY_MASK \ -+ GIC_BASER_SHAREABILITY(GICR_VPROPBASER, SHAREABILITY_MASK) -+#define GICR_VPROPBASER_INNER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, MASK) -+#define GICR_VPROPBASER_OUTER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GICR_VPROPBASER, OUTER, MASK) -+#define GICR_VPROPBASER_CACHEABILITY_MASK \ -+ GICR_VPROPBASER_INNER_CACHEABILITY_MASK ++ spin_lock_irqsave(&master->ibi.lock, flags); ++ master->ibi.slots[data->ibi] = NULL; ++ data->ibi = -1; ++ spin_unlock_irqrestore(&master->ibi.lock, flags); + -+#define GICR_VPROPBASER_InnerShareable \ -+ GIC_BASER_SHAREABILITY(GICR_VPROPBASER, InnerShareable) ++ i3c_generic_ibi_free_pool(data->ibi_pool); ++} + -+#define GICR_VPROPBASER_nCnB GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, nCnB) -+#define GICR_VPROPBASER_nC GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, nC) -+#define GICR_VPROPBASER_RaWt GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, RaWt) -+#define GICR_VPROPBASER_RaWb GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, RaWb) -+#define GICR_VPROPBASER_WaWt GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, WaWt) -+#define GICR_VPROPBASER_WaWb GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, WaWb) -+#define GICR_VPROPBASER_RaWaWt GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, RaWaWt) -+#define GICR_VPROPBASER_RaWaWb GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, RaWaWb) ++static void phytium_i3c_master_recycle_ibi_slot(struct i3c_dev_desc *dev, ++ struct i3c_ibi_slot *slot) ++{ ++ struct phytium_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev); + -+/* -+ * GICv4.1 VPROPBASER reinvention. A subtle mix between the old -+ * VPROPBASER and ITS_BASER. Just not quite any of the two. -+ */ -+#define GICR_VPROPBASER_4_1_VALID (1ULL << 63) -+#define GICR_VPROPBASER_4_1_ENTRY_SIZE GENMASK_ULL(61, 59) -+#define GICR_VPROPBASER_4_1_INDIRECT (1ULL << 55) -+#define GICR_VPROPBASER_4_1_PAGE_SIZE GENMASK_ULL(54, 53) -+#define GICR_VPROPBASER_4_1_Z (1ULL << 52) -+#define GICR_VPROPBASER_4_1_ADDR GENMASK_ULL(51, 12) -+#define GICR_VPROPBASER_4_1_SIZE GENMASK_ULL(6, 0) ++ i3c_generic_ibi_recycle_slot(data->ibi_pool, slot); ++} + -+#define GICR_VPENDBASER 0x0078 ++static const struct i3c_master_controller_ops phytium_i3c_master_ops = { ++ .bus_init = phytium_i3c_master_bus_init, ++ .bus_cleanup = phytium_i3c_master_bus_cleanup, ++ .do_daa = phytium_i3c_master_do_daa, ++ .attach_i3c_dev = phytium_i3c_master_attach_i3c_dev, ++ .reattach_i3c_dev = phytium_i3c_master_reattach_i3c_dev, ++ .detach_i3c_dev = phytium_i3c_master_detach_i3c_dev, ++ .attach_i2c_dev = phytium_i3c_master_attach_i2c_dev, ++ .detach_i2c_dev = phytium_i3c_master_detach_i2c_dev, ++ .supports_ccc_cmd = phytium_i3c_master_supports_ccc_cmd, ++ .send_ccc_cmd = phytium_i3c_master_send_ccc_cmd, ++ .priv_xfers = phytium_i3c_master_priv_xfers, ++ .i2c_xfers = phytium_i3c_master_i2c_xfers, ++ .enable_ibi = phytium_i3c_master_enable_ibi, ++ .disable_ibi = phytium_i3c_master_disable_ibi, ++ .request_ibi = phytium_i3c_master_request_ibi, ++ .free_ibi = phytium_i3c_master_free_ibi, ++ .recycle_ibi_slot = phytium_i3c_master_recycle_ibi_slot, ++}; + -+#define GICR_VPENDBASER_SHAREABILITY_SHIFT (10) -+#define GICR_VPENDBASER_INNER_CACHEABILITY_SHIFT (7) -+#define GICR_VPENDBASER_OUTER_CACHEABILITY_SHIFT (56) -+#define GICR_VPENDBASER_SHAREABILITY_MASK \ -+ GIC_BASER_SHAREABILITY(GICR_VPENDBASER, SHAREABILITY_MASK) -+#define GICR_VPENDBASER_INNER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, MASK) -+#define GICR_VPENDBASER_OUTER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GICR_VPENDBASER, OUTER, MASK) -+#define GICR_VPENDBASER_CACHEABILITY_MASK \ -+ GICR_VPENDBASER_INNER_CACHEABILITY_MASK ++static void phytium_i3c_master_hj(struct work_struct *work) ++{ ++ struct phytium_i3c_master *master = container_of(work, ++ struct phytium_i3c_master, ++ hj_work); + -+#define GICR_VPENDBASER_NonShareable \ -+ GIC_BASER_SHAREABILITY(GICR_VPENDBASER, NonShareable) ++ i3c_master_do_daa(&master->base); ++} + -+#define GICR_VPENDBASER_InnerShareable \ -+ GIC_BASER_SHAREABILITY(GICR_VPENDBASER, InnerShareable) ++static struct phytium_i3c_data phytium_i3c_devdata = { ++ .thd_delay_ns = 10, ++}; + -+#define GICR_VPENDBASER_nCnB GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, nCnB) -+#define GICR_VPENDBASER_nC GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, nC) -+#define GICR_VPENDBASER_RaWt GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, RaWt) -+#define GICR_VPENDBASER_RaWb GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, RaWb) -+#define GICR_VPENDBASER_WaWt GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, WaWt) -+#define GICR_VPENDBASER_WaWb GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, WaWb) -+#define GICR_VPENDBASER_RaWaWt GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, RaWaWt) -+#define GICR_VPENDBASER_RaWaWb GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, RaWaWb) ++static const struct of_device_id phytium_i3c_master_of_ids[] = { ++ { .compatible = "phytium,cdns-i3c-master", .data = &phytium_i3c_devdata }, ++ { /* sentinel */ }, ++}; + -+#define GICR_VPENDBASER_Dirty (1ULL << 60) -+#define GICR_VPENDBASER_PendingLast (1ULL << 61) -+#define GICR_VPENDBASER_IDAI (1ULL << 62) -+#define GICR_VPENDBASER_Valid (1ULL << 63) ++#ifdef CONFIG_ACPI ++static const struct acpi_device_id phytium_i3c_master_acpi_ids[] = { ++ { "PHYT0035", 0 }, ++ { } ++}; ++MODULE_DEVICE_TABLE(acpi, phytium_i3c_master_acpi_ids); ++#endif + -+/* -+ * GICv4.1 VPENDBASER, used for VPE residency. On top of these fields, -+ * also use the above Valid, PendingLast and Dirty. -+ */ -+#define GICR_VPENDBASER_4_1_DB (1ULL << 62) -+#define GICR_VPENDBASER_4_1_VGRP0EN (1ULL << 59) -+#define GICR_VPENDBASER_4_1_VGRP1EN (1ULL << 58) -+#define GICR_VPENDBASER_4_1_VPEID GENMASK_ULL(15, 0) ++static void phytium_i3c_master_controller_init(struct phytium_i3c_master *master) ++{ ++ int i; + -+#define GICR_VSGIR 0x0080 ++ phytium_i3c_master_disable(master); + -+#define GICR_VSGIR_VPEID GENMASK(15, 0) ++ writel(FLUSH_RX_FIFO | FLUSH_TX_FIFO | FLUSH_CMD_FIFO | ++ FLUSH_CMD_RESP, ++ master->regs + FLUSH_CTRL); + -+#define GICR_VSGIPENDR 0x0088 ++ writel(0xffffffff, master->regs + MST_IDR); ++ writel(0xffffffff, master->regs + SLV_IDR); + -+#define GICR_VSGIPENDR_BUSY (1U << 31) -+#define GICR_VSGIPENDR_PENDING GENMASK(15, 0) ++ writel(master->prescl0, master->regs + PRESCL_CTRL0); ++ writel(master->prescl1, master->regs + PRESCL_CTRL1); + -+/* -+ * ITS registers, offsets from ITS_base -+ */ -+#define GITS_CTLR 0x0000 -+#define GITS_IIDR 0x0004 -+#define GITS_TYPER 0x0008 -+#define GITS_MPIDR 0x0018 -+#define GITS_CBASER 0x0080 -+#define GITS_CWRITER 0x0088 -+#define GITS_CREADR 0x0090 -+#define GITS_BASER 0x0100 -+#define GITS_IDREGS_BASE 0xffd0 -+#define GITS_PIDR0 0xffe0 -+#define GITS_PIDR1 0xffe4 -+#define GITS_PIDR2 GICR_PIDR2 -+#define GITS_PIDR4 0xffd0 -+#define GITS_CIDR0 0xfff0 -+#define GITS_CIDR1 0xfff4 -+#define GITS_CIDR2 0xfff8 -+#define GITS_CIDR3 0xfffc ++ writel(IBIR_THR(1), master->regs + CMD_IBI_THR_CTRL); ++ writel(MST_INT_IBIR_THR, master->regs + MST_IER); ++ writel(master->dev_valid, master->regs + DEVS_CTRL); + -+#define GITS_TRANSLATER 0x10040 ++ for (i = 0; i < PHYTIUM_I3C_DEV_MAX_NUM; i++) { ++ writel(master->devinfo[i].dev_rr0, master->regs + DEV_ID_RR0(i)); ++ writel(master->devinfo[i].dev_rr1, master->regs + DEV_ID_RR1(i)); ++ writel(master->devinfo[i].dev_rr2, master->regs + DEV_ID_RR2(i)); ++ } + -+#define GITS_SGIR 0x20020 ++ for (i = 0; i < PHYTIUM_I3C_CMDR_MAX_TIMES; i++) ++ readl(master->regs + CMDR); + -+#define GITS_SGIR_VPEID GENMASK_ULL(47, 32) -+#define GITS_SGIR_VINTID GENMASK_ULL(3, 0) ++ writel(master->ctrl_info, master->regs + CTRL); + -+#define GITS_CTLR_ENABLE (1U << 0) -+#define GITS_CTLR_ImDe (1U << 1) -+#define GITS_CTLR_ITS_NUMBER_SHIFT 4 -+#define GITS_CTLR_ITS_NUMBER (0xFU << GITS_CTLR_ITS_NUMBER_SHIFT) -+#define GITS_CTLR_QUIESCENT (1U << 31) ++ phytium_i3c_master_enable(master); ++} + -+#define GITS_TYPER_PLPIS (1UL << 0) -+#define GITS_TYPER_VLPIS (1UL << 1) -+#define GITS_TYPER_ITT_ENTRY_SIZE_SHIFT 4 -+#define GITS_TYPER_ITT_ENTRY_SIZE GENMASK_ULL(7, 4) -+#define GITS_TYPER_IDBITS_SHIFT 8 -+#define GITS_TYPER_DEVBITS_SHIFT 13 -+#define GITS_TYPER_DEVBITS GENMASK_ULL(17, 13) -+#define GITS_TYPER_PTA (1UL << 19) -+#define GITS_TYPER_HCC_SHIFT 24 -+#define GITS_TYPER_HCC(r) (((r) >> GITS_TYPER_HCC_SHIFT) & 0xff) -+#define GITS_TYPER_VMOVP (1ULL << 37) -+#define GITS_TYPER_VMAPP (1ULL << 40) -+#define GITS_TYPER_SVPET GENMASK_ULL(42, 41) ++static void phytium_i3c_master_store_dev(struct phytium_i3c_master *master) ++{ ++ int i; + -+#define GITS_IIDR_REV_SHIFT 12 -+#define GITS_IIDR_REV_MASK (0xf << GITS_IIDR_REV_SHIFT) -+#define GITS_IIDR_REV(r) (((r) >> GITS_IIDR_REV_SHIFT) & 0xf) -+#define GITS_IIDR_PRODUCTID_SHIFT 24 ++ master->ctrl_info = readl(master->regs + CTRL); ++ master->dev_valid = readl(master->regs + DEVS_CTRL); + -+#define GITS_CBASER_VALID (1ULL << 63) -+#define GITS_CBASER_SHAREABILITY_SHIFT (10) -+#define GITS_CBASER_INNER_CACHEABILITY_SHIFT (59) -+#define GITS_CBASER_OUTER_CACHEABILITY_SHIFT (53) -+#define GITS_CBASER_SHAREABILITY_MASK \ -+ GIC_BASER_SHAREABILITY(GITS_CBASER, SHAREABILITY_MASK) -+#define GITS_CBASER_INNER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, MASK) -+#define GITS_CBASER_OUTER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GITS_CBASER, OUTER, MASK) -+#define GITS_CBASER_CACHEABILITY_MASK GITS_CBASER_INNER_CACHEABILITY_MASK ++ for (i = 0; i < PHYTIUM_I3C_DEV_MAX_NUM; i++) { ++ master->devinfo[i].dev_rr0 = readl(master->regs + DEV_ID_RR0(i)); ++ master->devinfo[i].dev_rr1 = readl(master->regs + DEV_ID_RR1(i)); ++ master->devinfo[i].dev_rr2 = readl(master->regs + DEV_ID_RR2(i)); ++ } ++} + -+#define GITS_CBASER_InnerShareable \ -+ GIC_BASER_SHAREABILITY(GITS_CBASER, InnerShareable) ++static int phytium_i3c_master_probe(struct platform_device *pdev) ++{ ++ struct phytium_i3c_master *master; ++ struct resource *res; ++ int ret, irq; ++ u32 val; + -+#define GITS_CBASER_nCnB GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, nCnB) -+#define GITS_CBASER_nC GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, nC) -+#define GITS_CBASER_RaWt GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWt) -+#define GITS_CBASER_RaWb GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWb) -+#define GITS_CBASER_WaWt GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, WaWt) -+#define GITS_CBASER_WaWb GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, WaWb) -+#define GITS_CBASER_RaWaWt GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWaWt) -+#define GITS_CBASER_RaWaWb GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWaWb) ++ master = devm_kzalloc(&pdev->dev, sizeof(*master), GFP_KERNEL); ++ if (!master) ++ return -ENOMEM; + -+#define GITS_CBASER_ADDRESS(cbaser) ((cbaser) & GENMASK_ULL(51, 12)) ++ master->dev = &pdev->dev; ++ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); ++ master->regs = devm_ioremap_resource(&pdev->dev, res); + -+#define GITS_BASER_NR_REGS 8 ++ if (IS_ERR(master->regs)) ++ return PTR_ERR(master->regs); + -+#define GITS_BASER_VALID (1ULL << 63) -+#define GITS_BASER_INDIRECT (1ULL << 62) ++ if (pdev->dev.of_node) { ++ master->devdata = of_device_get_match_data(&pdev->dev); + -+#define GITS_BASER_INNER_CACHEABILITY_SHIFT (59) -+#define GITS_BASER_OUTER_CACHEABILITY_SHIFT (53) -+#define GITS_BASER_INNER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GITS_BASER, INNER, MASK) -+#define GITS_BASER_CACHEABILITY_MASK GITS_BASER_INNER_CACHEABILITY_MASK -+#define GITS_BASER_OUTER_CACHEABILITY_MASK \ -+ GIC_BASER_CACHEABILITY(GITS_BASER, OUTER, MASK) -+#define GITS_BASER_SHAREABILITY_MASK \ -+ GIC_BASER_SHAREABILITY(GITS_BASER, SHAREABILITY_MASK) ++ if (!master->devdata) ++ return -EINVAL; + -+#define GITS_BASER_nCnB GIC_BASER_CACHEABILITY(GITS_BASER, INNER, nCnB) -+#define GITS_BASER_nC GIC_BASER_CACHEABILITY(GITS_BASER, INNER, nC) -+#define GITS_BASER_RaWt GIC_BASER_CACHEABILITY(GITS_BASER, INNER, RaWt) -+#define GITS_BASER_RaWb GIC_BASER_CACHEABILITY(GITS_BASER, INNER, RaWb) -+#define GITS_BASER_WaWt GIC_BASER_CACHEABILITY(GITS_BASER, INNER, WaWt) -+#define GITS_BASER_WaWb GIC_BASER_CACHEABILITY(GITS_BASER, INNER, WaWb) -+#define GITS_BASER_RaWaWt GIC_BASER_CACHEABILITY(GITS_BASER, INNER, RaWaWt) -+#define GITS_BASER_RaWaWb GIC_BASER_CACHEABILITY(GITS_BASER, INNER, RaWaWb) + -+#define GITS_BASER_TYPE_SHIFT (56) -+#define GITS_BASER_TYPE(r) (((r) >> GITS_BASER_TYPE_SHIFT) & 7) -+#define GITS_BASER_ENTRY_SIZE_SHIFT (48) -+#define GITS_BASER_ENTRY_SIZE(r) ((((r) >> GITS_BASER_ENTRY_SIZE_SHIFT) & 0x1f) + 1) -+#define GITS_BASER_ENTRY_SIZE_MASK GENMASK_ULL(52, 48) -+#define GITS_BASER_PHYS_52_to_48(phys) \ -+ (((phys) & GENMASK_ULL(47, 16)) | (((phys) >> 48) & 0xf) << 12) -+#define GITS_BASER_ADDR_48_to_52(baser) \ -+ (((baser) & GENMASK_ULL(47, 16)) | (((baser) >> 12) & 0xf) << 48) ++ master->pclk = devm_clk_get(&pdev->dev, "pclk"); ++ if (IS_ERR(master->pclk)) ++ return PTR_ERR(master->pclk); + -+#define GITS_BASER_SHAREABILITY_SHIFT (10) -+#define GITS_BASER_InnerShareable \ -+ GIC_BASER_SHAREABILITY(GITS_BASER, InnerShareable) -+#define GITS_BASER_PAGE_SIZE_SHIFT (8) -+#define __GITS_BASER_PSZ(sz) (GIC_PAGE_SIZE_ ## sz << GITS_BASER_PAGE_SIZE_SHIFT) -+#define GITS_BASER_PAGE_SIZE_4K __GITS_BASER_PSZ(4K) -+#define GITS_BASER_PAGE_SIZE_16K __GITS_BASER_PSZ(16K) -+#define GITS_BASER_PAGE_SIZE_64K __GITS_BASER_PSZ(64K) -+#define GITS_BASER_PAGE_SIZE_MASK __GITS_BASER_PSZ(MASK) -+#define GITS_BASER_PAGES_MAX 256 -+#define GITS_BASER_PAGES_SHIFT (0) -+#define GITS_BASER_NR_PAGES(r) (((r) & 0xff) + 1) ++ master->sysclk = devm_clk_get(&pdev->dev, "sysclk"); ++ if (IS_ERR(master->sysclk)) ++ return PTR_ERR(master->sysclk); + -+#define GITS_BASER_TYPE_NONE 0 -+#define GITS_BASER_TYPE_DEVICE 1 -+#define GITS_BASER_TYPE_VCPU 2 -+#define GITS_BASER_TYPE_RESERVED3 3 -+#define GITS_BASER_TYPE_COLLECTION 4 -+#define GITS_BASER_TYPE_RESERVED5 5 -+#define GITS_BASER_TYPE_RESERVED6 6 -+#define GITS_BASER_TYPE_RESERVED7 7 ++ ret = clk_prepare_enable(master->pclk); ++ if (ret) ++ return ret; + -+#define GITS_LVL1_ENTRY_SIZE (8UL) ++ ret = clk_prepare_enable(master->sysclk); ++ if (ret) ++ goto err_disable_pclk; ++#ifdef CONFIG_ACPI ++ } else if (has_acpi_companion(&pdev->dev)) { ++ i3c_master_acpi_clk_params(ACPI_HANDLE(&pdev->dev), "SCLK", &master->prescl0, ++ &master->prescl1, &master->ctrl_thd_del); + -+/* -+ * ITS commands -+ */ -+#define GITS_CMD_MAPD 0x08 -+#define GITS_CMD_MAPC 0x09 -+#define GITS_CMD_MAPTI 0x0a -+#define GITS_CMD_MAPI 0x0b -+#define GITS_CMD_MOVI 0x01 -+#define GITS_CMD_DISCARD 0x0f -+#define GITS_CMD_INV 0x0c -+#define GITS_CMD_MOVALL 0x0e -+#define GITS_CMD_INVALL 0x0d -+#define GITS_CMD_INT 0x03 -+#define GITS_CMD_CLEAR 0x04 -+#define GITS_CMD_SYNC 0x05 ++ if (!master->prescl0) ++ goto err_disable_sysclk; + -+/* -+ * GICv4 ITS specific commands -+ */ -+#define GITS_CMD_GICv4(x) ((x) | 0x20) -+#define GITS_CMD_VINVALL GITS_CMD_GICv4(GITS_CMD_INVALL) -+#define GITS_CMD_VMAPP GITS_CMD_GICv4(GITS_CMD_MAPC) -+#define GITS_CMD_VMAPTI GITS_CMD_GICv4(GITS_CMD_MAPTI) -+#define GITS_CMD_VMOVI GITS_CMD_GICv4(GITS_CMD_MOVI) -+#define GITS_CMD_VSYNC GITS_CMD_GICv4(GITS_CMD_SYNC) -+/* VMOVP, VSGI and INVDB are the odd ones, as they dont have a physical counterpart */ -+#define GITS_CMD_VMOVP GITS_CMD_GICv4(2) -+#define GITS_CMD_VSGI GITS_CMD_GICv4(3) -+#define GITS_CMD_INVDB GITS_CMD_GICv4(0xe) ++ master->base.bus.scl_rate.i2c = I3C_CONTROL_DEFAULT_I2C_SCL; ++ master->base.bus.scl_rate.i3c = I3C_BUS_MAX_I3C_SCL_RATE; ++ ACPI_COMPANION_SET(master->dev, ACPI_COMPANION(&pdev->dev)); ++#endif ++ } + -+/* -+ * ITS error numbers -+ */ -+#define E_ITS_MOVI_UNMAPPED_INTERRUPT 0x010107 -+#define E_ITS_MOVI_UNMAPPED_COLLECTION 0x010109 -+#define E_ITS_INT_UNMAPPED_INTERRUPT 0x010307 -+#define E_ITS_CLEAR_UNMAPPED_INTERRUPT 0x010507 -+#define E_ITS_MAPD_DEVICE_OOR 0x010801 -+#define E_ITS_MAPD_ITTSIZE_OOR 0x010802 -+#define E_ITS_MAPC_PROCNUM_OOR 0x010902 -+#define E_ITS_MAPC_COLLECTION_OOR 0x010903 -+#define E_ITS_MAPTI_UNMAPPED_DEVICE 0x010a04 -+#define E_ITS_MAPTI_ID_OOR 0x010a05 -+#define E_ITS_MAPTI_PHYSICALID_OOR 0x010a06 -+#define E_ITS_INV_UNMAPPED_INTERRUPT 0x010c07 -+#define E_ITS_INVALL_UNMAPPED_COLLECTION 0x010d09 -+#define E_ITS_MOVALL_PROCNUM_OOR 0x010e01 -+#define E_ITS_DISCARD_UNMAPPED_INTERRUPT 0x010f07 ++ irq = platform_get_irq(pdev, 0); ++ if (irq < 0) ++ return irq; + -+/* -+ * CPU interface registers -+ */ -+#define ICC_CTLR_EL1_EOImode_SHIFT (1) -+#define ICC_CTLR_EL1_EOImode_drop_dir (0U << ICC_CTLR_EL1_EOImode_SHIFT) -+#define ICC_CTLR_EL1_EOImode_drop (1U << ICC_CTLR_EL1_EOImode_SHIFT) -+#define ICC_CTLR_EL1_EOImode_MASK (1 << ICC_CTLR_EL1_EOImode_SHIFT) -+#define ICC_CTLR_EL1_CBPR_SHIFT 0 -+#define ICC_CTLR_EL1_CBPR_MASK (1 << ICC_CTLR_EL1_CBPR_SHIFT) -+#define ICC_CTLR_EL1_PMHE_SHIFT 6 -+#define ICC_CTLR_EL1_PMHE_MASK (1 << ICC_CTLR_EL1_PMHE_SHIFT) -+#define ICC_CTLR_EL1_PRI_BITS_SHIFT 8 -+#define ICC_CTLR_EL1_PRI_BITS_MASK (0x7 << ICC_CTLR_EL1_PRI_BITS_SHIFT) -+#define ICC_CTLR_EL1_ID_BITS_SHIFT 11 -+#define ICC_CTLR_EL1_ID_BITS_MASK (0x7 << ICC_CTLR_EL1_ID_BITS_SHIFT) -+#define ICC_CTLR_EL1_SEIS_SHIFT 14 -+#define ICC_CTLR_EL1_SEIS_MASK (0x1 << ICC_CTLR_EL1_SEIS_SHIFT) -+#define ICC_CTLR_EL1_A3V_SHIFT 15 -+#define ICC_CTLR_EL1_A3V_MASK (0x1 << ICC_CTLR_EL1_A3V_SHIFT) -+#define ICC_CTLR_EL1_RSS (0x1 << 18) -+#define ICC_CTLR_EL1_ExtRange (0x1 << 19) -+#define ICC_PMR_EL1_SHIFT 0 -+#define ICC_PMR_EL1_MASK (0xff << ICC_PMR_EL1_SHIFT) -+#define ICC_BPR0_EL1_SHIFT 0 -+#define ICC_BPR0_EL1_MASK (0x7 << ICC_BPR0_EL1_SHIFT) -+#define ICC_BPR1_EL1_SHIFT 0 -+#define ICC_BPR1_EL1_MASK (0x7 << ICC_BPR1_EL1_SHIFT) -+#define ICC_IGRPEN0_EL1_SHIFT 0 -+#define ICC_IGRPEN0_EL1_MASK (1 << ICC_IGRPEN0_EL1_SHIFT) -+#define ICC_IGRPEN1_EL1_SHIFT 0 -+#define ICC_IGRPEN1_EL1_MASK (1 << ICC_IGRPEN1_EL1_SHIFT) -+#define ICC_SRE_EL1_DIB (1U << 2) -+#define ICC_SRE_EL1_DFB (1U << 1) -+#define ICC_SRE_EL1_SRE (1U << 0) ++ if (readl(master->regs + DEV_ID) != DEV_ID_I3C_MASTER) { ++ ret = -EINVAL; ++ goto err_disable_sysclk; ++ } ++ ++ spin_lock_init(&master->xferqueue.lock); ++ INIT_LIST_HEAD(&master->xferqueue.list); ++ ++ INIT_WORK(&master->hj_work, phytium_i3c_master_hj); ++ phytium_i3c_master_disable(master); ++ ++ writel(FLUSH_RX_FIFO | FLUSH_TX_FIFO | FLUSH_CMD_FIFO | ++ FLUSH_CMD_RESP, ++ master->regs + FLUSH_CTRL); ++ writel(0xffffffff, master->regs + MST_IDR); ++ writel(0xffffffff, master->regs + SLV_IDR); ++ ret = devm_request_irq(&pdev->dev, irq, phytium_i3c_master_interrupt, 0, ++ dev_name(&pdev->dev), master); ++ if (ret) ++ goto err_disable_sysclk; + -+/* These are for GICv2 emulation only */ -+#define GICH_LR_VIRTUALID (0x3ffUL << 0) -+#define GICH_LR_PHYSID_CPUID_SHIFT (10) -+#define GICH_LR_PHYSID_CPUID (7UL << GICH_LR_PHYSID_CPUID_SHIFT) ++ platform_set_drvdata(pdev, master); + -+#define ICC_IAR1_EL1_SPURIOUS 0x3ff ++ val = readl(master->regs + CONF_STATUS0); + -+#define ICC_SRE_EL2_SRE (1 << 0) -+#define ICC_SRE_EL2_ENABLE (1 << 3) ++ /* Device ID0 is reserved to describe this master. */ ++ master->maxdevs = CONF_STATUS0_DEVS_NUM(val); ++ master->free_rr_slots = GENMASK(master->maxdevs, 1); + -+#define ICC_SGI1R_TARGET_LIST_SHIFT 0 -+#define ICC_SGI1R_TARGET_LIST_MASK (0xffff << ICC_SGI1R_TARGET_LIST_SHIFT) -+#define ICC_SGI1R_AFFINITY_1_SHIFT 16 -+#define ICC_SGI1R_AFFINITY_1_MASK (0xff << ICC_SGI1R_AFFINITY_1_SHIFT) -+#define ICC_SGI1R_SGI_ID_SHIFT 24 -+#define ICC_SGI1R_SGI_ID_MASK (0xfULL << ICC_SGI1R_SGI_ID_SHIFT) -+#define ICC_SGI1R_AFFINITY_2_SHIFT 32 -+#define ICC_SGI1R_AFFINITY_2_MASK (0xffULL << ICC_SGI1R_AFFINITY_2_SHIFT) -+#define ICC_SGI1R_IRQ_ROUTING_MODE_BIT 40 -+#define ICC_SGI1R_RS_SHIFT 44 -+#define ICC_SGI1R_RS_MASK (0xfULL << ICC_SGI1R_RS_SHIFT) -+#define ICC_SGI1R_AFFINITY_3_SHIFT 48 -+#define ICC_SGI1R_AFFINITY_3_MASK (0xffULL << ICC_SGI1R_AFFINITY_3_SHIFT) ++ val = readl(master->regs + CONF_STATUS1); ++ master->caps.cmdfifodepth = CONF_STATUS1_CMD_DEPTH(val); ++ master->caps.rxfifodepth = CONF_STATUS1_RX_DEPTH(val); ++ master->caps.txfifodepth = CONF_STATUS1_TX_DEPTH(val); ++ master->caps.ibirfifodepth = CONF_STATUS0_IBIR_DEPTH(val); ++ master->caps.cmdrfifodepth = CONF_STATUS0_CMDR_DEPTH(val); + -+#include ++ spin_lock_init(&master->ibi.lock); ++ master->ibi.num_slots = CONF_STATUS1_IBI_HW_RES(val); ++ master->ibi.slots = devm_kcalloc(&pdev->dev, master->ibi.num_slots, ++ sizeof(*master->ibi.slots), ++ GFP_KERNEL); ++ if (!master->ibi.slots) { ++ ret = -ENOMEM; ++ goto err_disable_sysclk; ++ } + -+#ifndef __ASSEMBLY__ ++ writel(IBIR_THR(1), master->regs + CMD_IBI_THR_CTRL); ++ writel(MST_INT_IBIR_THR, master->regs + MST_IER); ++ writel(DEVS_CTRL_DEV_CLR_ALL, master->regs + DEVS_CTRL); + -+/* -+ * We need a value to serve as a irq-type for LPIs. Choose one that will -+ * hopefully pique the interest of the reviewer. -+ */ -+#define GIC_IRQ_TYPE_LPI 0xa110c8ed ++ ret = i3c_master_register(&master->base, &pdev->dev, ++ &phytium_i3c_master_ops, false); ++ if (ret) ++ goto err_disable_sysclk; ++ writel(readl(master->regs + CTRL) | CTRL_HJ_ACK, master->regs + CTRL); ++ phytium_i3c_master_store_dev(master); + -+struct rdists { -+ struct { -+ raw_spinlock_t rd_lock; -+ void __iomem *rd_base; -+ struct page *pend_page; -+ phys_addr_t phys_base; -+ u64 flags; -+ cpumask_t *vpe_table_mask; -+ void *vpe_l1_base; -+ } __percpu *rdist; -+ phys_addr_t prop_table_pa; -+ void *prop_table_va; -+ u64 flags; -+ u32 gicd_typer; -+ u32 gicd_typer2; -+ int cpuhp_memreserve_state; -+ bool has_vlpis; -+ bool has_rvpeid; -+ bool has_direct_lpi; -+ bool has_vpend_valid_dirty; -+}; ++ return 0; + -+struct irq_domain; -+struct fwnode_handle; -+int __init phytium_its_lpi_memreserve_init(void); -+int phytium_its_cpu_init(void); -+int phytium_its_init(struct fwnode_handle *handle, struct rdists *rdists, -+ struct irq_domain *domain); -+int mbi_init(struct fwnode_handle *fwnode, struct irq_domain *parent); ++err_disable_sysclk: ++ clk_disable_unprepare(master->sysclk); + -+static inline bool gic_enable_sre(void) ++err_disable_pclk: ++ clk_disable_unprepare(master->pclk); ++ ++ return ret; ++} ++ ++static int phytium_i3c_master_remove(struct platform_device *pdev) +{ -+ u32 val; ++ struct phytium_i3c_master *master = platform_get_drvdata(pdev); + -+ val = gic_read_sre(); -+ if (val & ICC_SRE_EL1_SRE) -+ return true; ++ i3c_master_unregister(&master->base); + -+ val |= ICC_SRE_EL1_SRE; -+ gic_write_sre(val); -+ val = gic_read_sre(); ++ clk_disable_unprepare(master->sysclk); ++ clk_disable_unprepare(master->pclk); + -+ return !!(val & ICC_SRE_EL1_SRE); ++ return 0; +} + -+#endif ++static int __maybe_unused phytium_i3c_plat_suspend(struct device *dev) ++{ ++ struct phytium_i3c_master *master = dev_get_drvdata(dev); + -+#endif -diff --git a/include/linux/memcheck.h b/include/linux/memcheck.h -new file mode 100644 -index 000000000..087cd760e ---- /dev/null -+++ b/include/linux/memcheck.h -@@ -0,0 +1,22 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * include/linux/memcheck.h -+ * -+ * Copyright (c) 2022 Huawei Technologies Co., Ltd. -+ */ -+#ifndef _MEMCHECK_H -+#define _MEMCHECK_H + -+#ifdef CONFIG_MEMTRACE_ASHMEM -+void init_ashmem_process_info(void); -+#else -+static inline void init_ashmem_process_info(void) {} -+#endif ++ phytium_i3c_master_disable(master); + -+#ifdef CONFIG_PURGEABLE_ASHMEM -+void init_purgeable_ashmem_trigger(void); -+#else -+static inline void init_purgeable_ashmem_trigger(void) {} -+#endif -+#endif /* _MEMCHECK_H */ ++ clk_disable_unprepare(master->sysclk); ++ clk_disable_unprepare(master->pclk); + -diff --git a/include/linux/mtd/partitions.h b/include/linux/mtd/partitions.h -index b74a539ec..73f16747d 100644 ---- a/include/linux/mtd/partitions.h -+++ b/include/linux/mtd/partitions.h -@@ -51,6 +51,7 @@ struct mtd_partition { - uint32_t mask_flags; /* master MTD flags to mask out for this partition */ - uint32_t add_flags; /* flags to add to the partition */ - struct device_node *of_node; -+ struct fwnode_handle *fwnode; - }; - - #define MTDPART_OFS_RETAIN (-3) -@@ -61,6 +62,8 @@ struct mtd_partition { - - struct mtd_info; - struct device_node; -+struct acpi_device; -+struct hwnode_handle; - - /** - * struct mtd_part_parser_data - used to pass data to MTD partition parsers. -@@ -80,6 +83,7 @@ struct mtd_part_parser { - struct module *owner; - const char *name; - const struct of_device_id *of_match_table; -+ const struct acpi_device_id *acpi_match_table; - int (*parse_fn)(struct mtd_info *, const struct mtd_partition **, - struct mtd_part_parser_data *); - void (*cleanup)(const struct mtd_partition *pparts, int nr_parts); -diff --git a/include/linux/pci_ids.h b/include/linux/pci_ids.h -index a6c66ea80..b69da9209 100644 ---- a/include/linux/pci_ids.h -+++ b/include/linux/pci_ids.h -@@ -3213,4 +3213,6 @@ - - #define PCI_VENDOR_ID_NCUBE 0x10ff ++ return 0; ++} ++ ++static int __maybe_unused phytium_i3c_plat_resume(struct device *dev) ++{ ++ struct phytium_i3c_master *master = dev_get_drvdata(dev); ++ ++ phytium_i3c_master_controller_init(master); ++ ++ clk_prepare_enable(master->sysclk); ++ clk_prepare_enable(master->pclk); ++ ++ return 0; ++} ++ ++static const struct dev_pm_ops phytium_i3c_dev_pm_ops = { ++ SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_i3c_plat_suspend, ++ phytium_i3c_plat_resume) ++}; ++ ++static struct platform_driver phytium_i3c_master = { ++ .probe = phytium_i3c_master_probe, ++ .remove = phytium_i3c_master_remove, ++ .driver = { ++ .name = "phytium-i3c-master", ++ .of_match_table = phytium_i3c_master_of_ids, ++ .acpi_match_table = ACPI_PTR(phytium_i3c_master_acpi_ids), ++ .pm = &phytium_i3c_dev_pm_ops, ++ }, ++}; ++module_platform_driver(phytium_i3c_master); ++ ++MODULE_AUTHOR("Feng Jun "); ++MODULE_DESCRIPTION("Phytium I3C master driver"); ++MODULE_LICENSE("GPL"); ++MODULE_ALIAS("platform:phytium-i3c-master"); +diff --git a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c +index bd0a596f9..6b96ac3b9 100644 +--- a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c ++++ b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.c +@@ -3154,6 +3154,13 @@ static void arm_smmu_write_msi_msg(struct msi_desc *desc, struct msi_msg *msg) + doorbell = (((u64)msg->address_hi) << 32) | msg->address_lo; + doorbell &= MSI_CFG0_ADDR_MASK; -+#define PCI_VENDOR_ID_PHYTIUM 0x1db7 ++#ifdef CONFIG_PM_SLEEP ++ /* Saves the msg (base addr of msi irq) and restores it during resume */ ++ desc->msg.address_lo = msg->address_lo; ++ desc->msg.address_hi = msg->address_hi; ++ desc->msg.data = msg->data; ++#endif + - #endif /* _LINUX_PCI_IDS_H */ -diff --git a/include/linux/ras.h b/include/linux/ras.h -index 1f4048bf2..f695e7e76 100644 ---- a/include/linux/ras.h -+++ b/include/linux/ras.h -@@ -24,7 +24,7 @@ int __init parse_cec_param(char *str); - void log_non_standard_event(const guid_t *sec_type, - const guid_t *fru_id, const char *fru_text, - const u8 sev, const u8 *err, const u32 len); --void log_arm_hw_error(struct cper_sec_proc_arm *err); -+void log_arm_hw_error(struct cper_sec_proc_arm *err, const u8 sev); - #else - static inline void - log_non_standard_event(const guid_t *sec_type, -@@ -32,7 +32,18 @@ log_non_standard_event(const guid_t *sec_type, - const u8 sev, const u8 *err, const u32 len) - { return; } - static inline void --log_arm_hw_error(struct cper_sec_proc_arm *err) { return; } -+log_arm_hw_error(struct cper_sec_proc_arm *err, const u8 sev) { return; } - #endif + writeq_relaxed(doorbell, smmu->base + cfg[0]); + writel_relaxed(msg->data, smmu->base + cfg[1]); + writel_relaxed(ARM_SMMU_MEMATTR_DEVICE_nGnRE, smmu->base + cfg[2]); +@@ -3196,11 +3203,53 @@ static void arm_smmu_setup_msis(struct arm_smmu_device *smmu) + devm_add_action(dev, arm_smmu_free_msis, dev); + } -+#if defined(CONFIG_ARM) || defined(CONFIG_ARM64) -+#include -+/* -+ * Include ARM specific SMP header which provides a function mapping mpidr to -+ * cpu logical index -+ */ -+#define GET_LOGICAL_INDEX(mpidr) get_logical_index(mpidr & MPIDR_HWID_BITMASK) +-static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu) ++#ifdef CONFIG_PM_SLEEP ++static void arm_smmu_resume_msis(struct arm_smmu_device *smmu) ++{ ++ struct msi_desc *desc; ++ struct device *dev = smmu->dev; ++ ++ if (!dev->msi.domain) ++ return; ++ ++ msi_for_each_desc(desc, dev, MSI_DESC_ASSOCIATED) { ++ switch (desc->msi_index) { ++ case EVTQ_MSI_INDEX: ++ case GERROR_MSI_INDEX: ++ case PRIQ_MSI_INDEX: { ++ phys_addr_t *cfg = arm_smmu_msi_cfg[desc->msi_index]; ++ struct msi_msg *msg = &desc->msg; ++ phys_addr_t doorbell = (((u64)msg->address_hi) << 32) | msg->address_lo; ++ ++ doorbell &= MSI_CFG0_ADDR_MASK; ++ writeq_relaxed(doorbell, smmu->base + cfg[0]); ++ writel_relaxed(msg->data, smmu->base + cfg[1]); ++ writel_relaxed(ARM_SMMU_MEMATTR_DEVICE_nGnRE, ++ smmu->base + cfg[2]); ++ break; ++ } ++ default: ++ continue; ++ } ++ } ++} +#else -+#define GET_LOGICAL_INDEX(mpidr) -EINVAL -+#endif /* CONFIG_ARM || CONFIG_ARM64 */ ++static void arm_smmu_resume_msis(struct arm_smmu_device *smmu) ++{ ++} ++#endif + - #endif /* __RAS_H__ */ -diff --git a/include/ras/ras_event.h b/include/ras/ras_event.h -index cbd3ddd7c..417c7fb99 100644 ---- a/include/ras/ras_event.h -+++ b/include/ras/ras_event.h -@@ -168,11 +168,24 @@ TRACE_EVENT(mc_event, - * This event is generated when hardware detects an ARM processor error - * has occurred. UEFI 2.6 spec section N.2.4.4. - */ -+#define APEIL "ARM Processor Err Info data len" -+#define APEID "ARM Processor Err Info raw data" -+#define APECIL "ARM Processor Err Context Info data len" -+#define APECID "ARM Processor Err Context Info raw data" -+#define VSEIL "Vendor Specific Err Info data len" -+#define VSEID "Vendor Specific Err Info raw data" - TRACE_EVENT(arm_event, ++static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu, bool resume) + { + int irq, ret; -- TP_PROTO(const struct cper_sec_proc_arm *proc), -+ TP_PROTO(const struct cper_sec_proc_arm *proc, const u8 *pei_err, -+ const u32 pei_len, -+ const u8 *ctx_err, -+ const u32 ctx_len, -+ const u8 *oem, -+ const u32 oem_len, -+ u8 sev, -+ int cpu), +- arm_smmu_setup_msis(smmu); ++ if (!resume) ++ arm_smmu_setup_msis(smmu); ++ else { ++ /* The irq doesn't need to be re-requested during resume */ ++ arm_smmu_resume_msis(smmu); ++ return; ++ } -- TP_ARGS(proc), -+ TP_ARGS(proc, pei_err, pei_len, ctx_err, ctx_len, oem, oem_len, sev, cpu), + /* Request interrupt lines */ + irq = smmu->evtq.q.irq; +@@ -3242,7 +3291,7 @@ static void arm_smmu_setup_unique_irqs(struct arm_smmu_device *smmu) + } + } - TP_STRUCT__entry( - __field(u64, mpidr) -@@ -180,6 +193,14 @@ TRACE_EVENT(arm_event, - __field(u32, running_state) - __field(u32, psci_state) - __field(u8, affinity) -+ __field(u32, pei_len) -+ __dynamic_array(u8, buf, pei_len) -+ __field(u32, ctx_len) -+ __dynamic_array(u8, buf1, ctx_len) -+ __field(u32, oem_len) -+ __dynamic_array(u8, buf2, oem_len) -+ __field(u8, sev) -+ __field(int, cpu) - ), +-static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu) ++static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu, bool resume) + { + int ret, irq; + u32 irqen_flags = IRQ_CTRL_EVTQ_IRQEN | IRQ_CTRL_GERROR_IRQEN; +@@ -3269,7 +3318,7 @@ static int arm_smmu_setup_irqs(struct arm_smmu_device *smmu) + if (ret < 0) + dev_warn(smmu->dev, "failed to enable combined irq\n"); + } else +- arm_smmu_setup_unique_irqs(smmu); ++ arm_smmu_setup_unique_irqs(smmu, resume); - TP_fast_assign( -@@ -199,12 +220,29 @@ TRACE_EVENT(arm_event, - __entry->running_state = ~0; - __entry->psci_state = ~0; + if (smmu->features & ARM_SMMU_FEAT_PRI) + irqen_flags |= IRQ_CTRL_PRIQ_IRQEN; +@@ -3294,7 +3343,7 @@ static int arm_smmu_device_disable(struct arm_smmu_device *smmu) + return ret; + } + +-static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) ++static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool resume) + { + int ret; + u32 reg, enables; +@@ -3402,7 +3451,7 @@ static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) } -+ __entry->pei_len = pei_len; -+ memcpy(__get_dynamic_array(buf), pei_err, pei_len); -+ __entry->ctx_len = ctx_len; -+ memcpy(__get_dynamic_array(buf1), ctx_err, ctx_len); -+ __entry->oem_len = oem_len; -+ memcpy(__get_dynamic_array(buf2), oem, oem_len); -+ __entry->sev = sev; -+ __entry->cpu = cpu; - ), + } -- TP_printk("affinity level: %d; MPIDR: %016llx; MIDR: %016llx; " -- "running state: %d; PSCI state: %d", -+ TP_printk("cpu:%d; error: %d; affinity level: %d; MPIDR: %016llx; MIDR: %016llx; " -+ "running state: %d; PSCI state: %d; " -+ "%s: %d; %s: %s; %s: %d; %s: %s; %s: %d; %s: %s", -+ __entry->cpu, -+ __entry->sev, - __entry->affinity, __entry->mpidr, __entry->midr, -- __entry->running_state, __entry->psci_state) -+ __entry->running_state, __entry->psci_state, -+ APEIL, __entry->pei_len, APEID, -+ __print_hex(__get_dynamic_array(buf), __entry->pei_len), -+ APECIL, __entry->ctx_len, APECID, -+ __print_hex(__get_dynamic_array(buf1), __entry->ctx_len), -+ VSEIL, __entry->oem_len, VSEID, -+ __print_hex(__get_dynamic_array(buf2), __entry->oem_len)) - ); +- ret = arm_smmu_setup_irqs(smmu); ++ ret = arm_smmu_setup_irqs(smmu, resume); + if (ret) { + dev_err(smmu->dev, "failed to setup irqs\n"); + return ret; +@@ -3412,7 +3461,7 @@ static int arm_smmu_device_reset(struct arm_smmu_device *smmu, bool bypass) + enables &= ~(CR0_EVTQEN | CR0_PRIQEN); - /* -diff --git a/include/sound/hdaudio.h b/include/sound/hdaudio.h -index 32c59053b..65d58c647 100644 ---- a/include/sound/hdaudio.h -+++ b/include/sound/hdaudio.h -@@ -350,6 +350,7 @@ struct hdac_bus { - bool needs_damn_long_delay:1; - bool not_use_interrupts:1; /* prohibiting the RIRB IRQ */ - bool access_sdnctl_in_dword:1; /* accessing the sdnctl register by dword */ -+ bool cmd_resend; /* command resend */ + /* Enable the SMMU interface, or ensure bypass */ +- if (!bypass || disable_bypass) { ++ if (!smmu->bypass || disable_bypass) { + enables |= CR0_SMMUEN; + } else { + ret = arm_smmu_update_gbpa(smmu, 0, GBPA_ABORT); +@@ -3797,6 +3846,26 @@ static void arm_smmu_rmr_install_bypass_ste(struct arm_smmu_device *smmu) + iort_put_rmr_sids(dev_fwnode(smmu->dev), &rmr_list); + } - int poll_count; ++#ifdef CONFIG_PM_SLEEP ++static int arm_smmu_suspend(struct device *dev) ++{ ++ /* ++ * The smmu is powered off and related registers are automatically ++ * cleared when suspend. No need to do anything. ++ */ ++ return 0; ++} ++ ++static int arm_smmu_resume(struct device *dev) ++{ ++ struct arm_smmu_device *smmu = dev_get_drvdata(dev); ++ ++ arm_smmu_device_reset(smmu, true); ++ ++ return 0; ++} ++#endif ++ + static int arm_smmu_device_probe(struct platform_device *pdev) + { + int irq, ret; +@@ -3804,7 +3873,6 @@ static int arm_smmu_device_probe(struct platform_device *pdev) + resource_size_t ioaddr; + struct arm_smmu_device *smmu; + struct device *dev = &pdev->dev; +- bool bypass; -diff --git a/include/uapi/linux/serial_core.h b/include/uapi/linux/serial_core.h -index add349889..3db2a19df 100644 ---- a/include/uapi/linux/serial_core.h -+++ b/include/uapi/linux/serial_core.h -@@ -245,4 +245,7 @@ - /* Sunplus UART */ - #define PORT_SUNPLUS 123 + smmu = devm_kzalloc(dev, sizeof(*smmu), GFP_KERNEL); + if (!smmu) +@@ -3820,7 +3888,7 @@ static int arm_smmu_device_probe(struct platform_device *pdev) + } -+/* Phytium PCI UART */ -+#define PORT_PHYTIUM 124 -+ - #endif /* _UAPILINUX_SERIAL_CORE_H */ -diff --git a/scripts/dtc/checks.c b/scripts/dtc/checks.c -index 9f31d2607..e4d23040a 100644 ---- a/scripts/dtc/checks.c -+++ b/scripts/dtc/checks.c -@@ -1502,7 +1502,7 @@ static bool prop_is_gpio(struct property *prop) - * *-gpios and *-gpio can appear in property names, - * so skip over any false matches (only one known ATM) - */ -- if (strends(prop->name, ",nr-gpios")) -+ if (strends(prop->name, "nr-gpios")) - return false; + /* Set bypass mode according to firmware probing result */ +- bypass = !!ret; ++ smmu->bypass = !!ret; + + /* Base address */ + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); +@@ -3884,7 +3952,7 @@ static int arm_smmu_device_probe(struct platform_device *pdev) + arm_smmu_rmr_install_bypass_ste(smmu); + + /* Reset the device */ +- ret = arm_smmu_device_reset(smmu, bypass); ++ ret = arm_smmu_device_reset(smmu, false); + if (ret) + return ret; - return strends(prop->name, "-gpios") || -diff --git a/sound/hda/hdac_controller.c b/sound/hda/hdac_controller.c -index 7f3a000fa..c3515079d 100644 ---- a/sound/hda/hdac_controller.c -+++ b/sound/hda/hdac_controller.c -@@ -146,6 +146,9 @@ int snd_hdac_bus_send_cmd(struct hdac_bus *bus, unsigned int val) +@@ -3928,6 +3996,16 @@ static const struct of_device_id arm_smmu_of_match[] = { + }; + MODULE_DEVICE_TABLE(of, arm_smmu_of_match); + ++#ifdef CONFIG_PM_SLEEP ++static const struct dev_pm_ops arm_smmu_pm_ops = { ++ SET_SYSTEM_SLEEP_PM_OPS(arm_smmu_suspend, ++ arm_smmu_resume) ++}; ++#define ARM_SMMU_PM_OPS (&arm_smmu_pm_ops) ++#else ++#define ARM_SMMU_PM_OPS NULL ++#endif ++ + static void arm_smmu_driver_unregister(struct platform_driver *drv) { - unsigned int addr = azx_command_addr(val); - unsigned int wp, rp; -+ unsigned long timeout; -+ unsigned int rirb_wp; -+ int i = 0; + arm_smmu_sva_notifier_synchronize(); +@@ -3938,6 +4016,7 @@ static struct platform_driver arm_smmu_driver = { + .driver = { + .name = "arm-smmu-v3", + .of_match_table = arm_smmu_of_match, ++ .pm = ARM_SMMU_PM_OPS, + .suppress_bind_attrs = true, + }, + .probe = arm_smmu_device_probe, +diff --git a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h +index 9915850dd..07f2b0941 100644 +--- a/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h ++++ b/drivers/iommu/arm/arm-smmu-v3/arm-smmu-v3.h +@@ -682,6 +682,8 @@ struct arm_smmu_device { - spin_lock_irq(&bus->reg_lock); + struct rb_root streams; + struct mutex streams_mutex; ++ ++ bool bypass; + }; -@@ -172,6 +175,42 @@ int snd_hdac_bus_send_cmd(struct hdac_bus *bus, unsigned int val) - bus->corb.buf[wp] = cpu_to_le32(val); - snd_hdac_chip_writew(bus, CORBWP, wp); + struct arm_smmu_stream { +diff --git a/drivers/iommu/arm/arm-smmu/arm-smmu.c b/drivers/iommu/arm/arm-smmu/arm-smmu.c +index d6d1a2a55..ee910444b 100644 +--- a/drivers/iommu/arm/arm-smmu/arm-smmu.c ++++ b/drivers/iommu/arm/arm-smmu/arm-smmu.c +@@ -1363,6 +1363,19 @@ static struct iommu_device *arm_smmu_probe_device(struct device *dev) + return ERR_PTR(-ENODEV); + } -+ if (bus->cmd_resend) { -+ timeout = jiffies + msecs_to_jiffies(1000); -+ udelay(80); -+ rirb_wp = snd_hdac_chip_readw(bus, RIRBWP); -+ while (rirb_wp == bus->rirb.wp) { -+ udelay(80); -+ rirb_wp = snd_hdac_chip_readw(bus, RIRBWP); -+ if (rirb_wp != bus->rirb.wp) -+ break; -+ if (i > 5) -+ break; -+ if (time_after(jiffies, timeout)) -+ break; ++#ifdef CONFIG_ARCH_PHYTIUM ++ /* Phytium Ps17064 workaround patch */ ++ if ((read_cpuid_id() & MIDR_CPU_MODEL_MASK) == MIDR_PHYTIUM_PS17064) { ++ int num = fwspec->num_ids; + -+ /* add command to corb */ -+ wp = snd_hdac_chip_readw(bus, CORBWP); -+ if (wp == 0xffff) { -+ /* something wrong, controller likely turned to D3 */ -+ spin_unlock_irq(&bus->reg_lock); -+ return -EIO; -+ } -+ wp++; -+ wp %= AZX_MAX_CORB_ENTRIES; ++ for (i = 0; i < num; i++) { ++ u32 fwid = FWID_READ(fwspec->ids[i]); + -+ rp = snd_hdac_chip_readw(bus, CORBRP); -+ if (wp == rp) { -+ /* oops, it's full */ -+ spin_unlock_irq(&bus->reg_lock); -+ return -EAGAIN; -+ } -+ bus->corb.buf[wp] = cpu_to_le32(val); -+ snd_hdac_chip_writew(bus, CORBWP, wp); -+ i++; ++ iommu_fwspec_add_ids(dev, &fwid, 1); + } + } ++#endif + - spin_unlock_irq(&bus->reg_lock); + ret = -EINVAL; + for (i = 0; i < fwspec->num_ids; i++) { + u16 sid = FIELD_GET(ARM_SMMU_SMR_ID, fwspec->ids[i]); +diff --git a/drivers/iommu/arm/arm-smmu/arm-smmu.h b/drivers/iommu/arm/arm-smmu/arm-smmu.h +index 703fd5817..723532e24 100644 +--- a/drivers/iommu/arm/arm-smmu/arm-smmu.h ++++ b/drivers/iommu/arm/arm-smmu/arm-smmu.h +@@ -10,6 +10,7 @@ + #ifndef _ARM_SMMU_H + #define _ARM_SMMU_H - return 0; -diff --git a/sound/hda/hdac_stream.c b/sound/hda/hdac_stream.c -index fe0958f99..21a9435fb 100644 ---- a/sound/hda/hdac_stream.c -+++ b/sound/hda/hdac_stream.c -@@ -134,7 +134,11 @@ void snd_hdac_stream_start(struct hdac_stream *azx_dev) ++#include + #include + #include + #include +@@ -23,6 +24,10 @@ + #include + #include - trace_snd_hdac_stream_start(bus, azx_dev); ++#ifdef CONFIG_ARCH_PHYTIUM ++#define FWID_READ(id) (((u16)(id) >> 3) | (((id) >> 16 | 0x7000) << 16)) ++#endif ++ + /* Configuration registers */ + #define ARM_SMMU_GR0_sCR0 0x0 + #define ARM_SMMU_sCR0_VMID16EN BIT(31) +diff --git a/drivers/iommu/iommu.c b/drivers/iommu/iommu.c +index 3a67e6362..3a7e65742 100644 +--- a/drivers/iommu/iommu.c ++++ b/drivers/iommu/iommu.c +@@ -32,6 +32,9 @@ + #include + #include + #include ++#ifdef CONFIG_ARCH_PHYTIUM ++#include ++#endif -+#ifdef CONFIG_SND_HDA_PHYTIUM -+ azx_dev->start_wallclk = snd_hdac_chip_readl(bus, WALLCLK) / 15; -+#else - azx_dev->start_wallclk = snd_hdac_chip_readl(bus, WALLCLK); + #include "dma-iommu.h" + #include "iommu-priv.h" +@@ -198,6 +201,15 @@ static int __init iommu_subsys_init(void) + iommu_set_default_passthrough(false); + else + iommu_set_default_translated(false); ++#ifdef CONFIG_ARCH_PHYTIUM ++ /* ++ * Always set default iommu type to IOMMU_DOMAIN_IDENTITY ++ * on Phytium Ps17064 SoC to avoid unnecessary troubles ++ * introduced by the SMMU workaround. ++ */ ++ if ((read_cpuid_id() & MIDR_CPU_MODEL_MASK) == MIDR_PHYTIUM_PS17064) ++ iommu_set_default_passthrough(true); +#endif - /* enable SIE */ - snd_hdac_chip_updatel(bus, INTCTL, -@@ -611,7 +615,11 @@ static u64 azx_cc_read(const struct cyclecounter *cc) + if (iommu_default_passthrough() && cc_platform_has(CC_ATTR_MEM_ENCRYPT)) { + pr_info("Memory encryption detected - Disabling default IOMMU Passthrough\n"); +@@ -648,6 +660,19 @@ static int __init iommu_set_def_domain_type(char *str) + if (ret) + return ret; + ++#ifdef CONFIG_ARCH_PHYTIUM ++ /* ++ * Always set default iommu type to IOMMU_DOMAIN_IDENTITY ++ * on Phytium Ps17064 SoC to avoid unnecessary troubles ++ * introduced by the SMMU workaround. ++ */ ++ if ((read_cpuid_id() & MIDR_CPU_MODEL_MASK) == MIDR_PHYTIUM_PS17064) { ++ iommu_def_domain_type = IOMMU_DOMAIN_IDENTITY; ++ iommu_set_default_passthrough(true); ++ return 0; ++ } ++#endif ++ + if (pt) + iommu_set_default_passthrough(true); + else +diff --git a/drivers/irqchip/irq-gic-v3-its.c b/drivers/irqchip/irq-gic-v3-its.c +index 676c9250d..6005e1bad 100644 +--- a/drivers/irqchip/irq-gic-v3-its.c ++++ b/drivers/irqchip/irq-gic-v3-its.c +@@ -1730,7 +1730,8 @@ static void its_irq_compose_msi_msg(struct irq_data *d, struct msi_msg *msg) + msg->address_hi = upper_32_bits(addr); + msg->data = its_get_event_id(d); + +- iommu_dma_compose_msi_msg(irq_data_get_msi_desc(d), msg); ++ if ((read_cpuid_id() & MIDR_CPU_MODEL_MASK) != MIDR_PHYTIUM_PS17064) ++ iommu_dma_compose_msi_msg(irq_data_get_msi_desc(d), msg); + } + + static int its_irq_set_irqchip_state(struct irq_data *d, +@@ -4893,6 +4894,7 @@ static void its_restore_enable(void) { - struct hdac_stream *azx_dev = container_of(cc, struct hdac_stream, cc); + struct its_node *its; + int ret; ++ int cpu; + + raw_spin_lock(&its_lock); + list_for_each_entry(its, &its_nodes, entry) { +@@ -4946,6 +4948,23 @@ static void its_restore_enable(void) + GITS_TYPER_HCC(gic_read_typer(base + GITS_TYPER))) + its_cpu_init_collection(its); + } ++ ++ /* ++ * Enable LPIs:firmware just restore GICR_CTLR_ENABLE_LPIs of boot ++ * CPU, the other CPUs also should be restored. ++ */ ++ for_each_possible_cpu(cpu) { ++ void __iomem *rbase = gic_data_rdist_cpu(cpu)->rd_base; ++ u32 val; ++ ++ /* Enable LPIs */ ++ val = readl_relaxed(rbase + GICR_CTLR); ++ if (val & GICR_CTLR_ENABLE_LPIS) ++ continue; ++ ++ val |= GICR_CTLR_ENABLE_LPIS; ++ writel_relaxed(val, rbase + GICR_CTLR); ++ } + raw_spin_unlock(&its_lock); + } + +diff --git a/drivers/mtd/mtdcore.c b/drivers/mtd/mtdcore.c +index 9bd661be3..a1911ac53 100644 +--- a/drivers/mtd/mtdcore.c ++++ b/drivers/mtd/mtdcore.c +@@ -742,7 +742,8 @@ int add_mtd_device(struct mtd_info *mtd) + dev_set_name(&mtd->dev, "mtd%d", i); + dev_set_drvdata(&mtd->dev, mtd); + mtd_check_of_node(mtd); +- of_node_get(mtd_get_of_node(mtd)); ++ if (mtd->dev.of_node) ++ of_node_get(mtd_get_of_node(mtd)); + error = device_register(&mtd->dev); + if (error) { + put_device(&mtd->dev); +@@ -903,7 +904,8 @@ static struct nvmem_device *mtd_otp_nvmem_register(struct mtd_info *mtd, + config.ignore_wp = true; + config.reg_read = reg_read; + config.size = size; +- config.of_node = np; ++ if (IS_ENABLED(CONFIG_OF)) ++ config.of_node = np; + config.priv = mtd; + + nvmem = nvmem_register(&config); +@@ -911,7 +913,8 @@ static struct nvmem_device *mtd_otp_nvmem_register(struct mtd_info *mtd, + if (IS_ERR(nvmem) && PTR_ERR(nvmem) == -EOPNOTSUPP) + nvmem = NULL; + +- of_node_put(np); ++ if (IS_ENABLED(CONFIG_OF)) ++ of_node_put(np); -+#ifdef CONFIG_SND_HDA_PHYTIUM -+ return snd_hdac_chip_readl(azx_dev->bus, WALLCLK) / 25; -+#else - return snd_hdac_chip_readl(azx_dev->bus, WALLCLK); -+#endif + return nvmem; } +diff --git a/drivers/mtd/mtdpart.c b/drivers/mtd/mtdpart.c +index 23483db8f..17a44b31c 100644 +--- a/drivers/mtd/mtdpart.c ++++ b/drivers/mtd/mtdpart.c +@@ -19,6 +19,8 @@ + #include + #include - static void azx_timecounter_init(struct hdac_stream *azx_dev, -diff --git a/sound/pci/hda/Kconfig b/sound/pci/hda/Kconfig -index 21046f72c..7d2e4cb59 100644 ---- a/sound/pci/hda/Kconfig -+++ b/sound/pci/hda/Kconfig -@@ -26,6 +26,22 @@ config SND_HDA_INTEL - To compile this driver as a module, choose M here: the module - will be called snd-hda-intel. ++#include ++#include + #include "mtdcore.h" -+config SND_HDA_PHYTIUM -+ tristate "PHYTIUM HD Audio" -+ depends on SOUND -+ select SND_HDA -+ select SND_HDA_ALIGNED_MMIO -+ help -+ Say Y here to support the HDA controller present in PHYTIUM -+ SoCs -+ -+ This options enables support for the HD Audio controller -+ present in some PHYTIUM SoCs, used to communicate audio -+ to the "High Definition Audio" codec. -+ -+ To compile this driver as a module, choose M here: the module -+ will be called snd-hda-phytium. -+ - config SND_HDA_TEGRA - tristate "NVIDIA Tegra HD Audio" - depends on ARCH_TEGRA -diff --git a/sound/pci/hda/Makefile b/sound/pci/hda/Makefile -index f00fc9ed6..5671283da 100644 ---- a/sound/pci/hda/Makefile -+++ b/sound/pci/hda/Makefile -@@ -1,6 +1,7 @@ - # SPDX-License-Identifier: GPL-2.0 - snd-hda-intel-objs := hda_intel.o - snd-hda-tegra-objs := hda_tegra.o -+snd-hda-phytium-objs := hda_phytium.o + /* +@@ -504,12 +506,14 @@ EXPORT_SYMBOL_GPL(deregister_mtd_parser); + static const char * const default_mtd_part_types[] = { + "cmdlinepart", + "ofpart", ++ "acpipart", + NULL + }; - snd-hda-codec-y := hda_bind.o hda_codec.o hda_jack.o hda_auto_parser.o hda_sysfs.o - snd-hda-codec-y += hda_controller.o -@@ -70,3 +71,4 @@ obj-$(CONFIG_SND_HDA_SCODEC_TAS2781_I2C) += snd-hda-scodec-tas2781-i2c.o - # when built in kernel - obj-$(CONFIG_SND_HDA_INTEL) += snd-hda-intel.o - obj-$(CONFIG_SND_HDA_TEGRA) += snd-hda-tegra.o -+obj-$(CONFIG_SND_HDA_PHYTIUM) += snd-hda-phytium.o -diff --git a/sound/pci/hda/hda_controller.c b/sound/pci/hda/hda_controller.c -index 406779625..86aa86e0c 100644 ---- a/sound/pci/hda/hda_controller.c -+++ b/sound/pci/hda/hda_controller.c -@@ -17,6 +17,8 @@ - #include - #include + /* Check DT only when looking for subpartitions. */ + static const char * const default_subpartition_types[] = { + "ofpart", ++ "acpipart", + NULL + }; -+#include "hda_phytium.h" -+ - #ifdef CONFIG_X86 - /* for art-tsc conversion */ - #include -@@ -156,6 +158,9 @@ static int azx_pcm_prepare(struct snd_pcm_substream *substream) - struct hda_spdif_out *spdif = - snd_hda_spdif_out_of_nid(apcm->codec, hinfo->nid); - unsigned short ctls = spdif ? spdif->ctls : 0; -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ -+ hda->substream = substream; +@@ -573,6 +577,44 @@ static struct mtd_part_parser *mtd_part_get_compatible_parser(const char *compat + return ret; + } - trace_azx_pcm_prepare(chip, azx_dev); - dsp_lock(azx_dev); -diff --git a/sound/pci/hda/hda_phytium.c b/sound/pci/hda/hda_phytium.c -new file mode 100644 -index 000000000..86cd17120 ---- /dev/null -+++ b/sound/pci/hda/hda_phytium.c -@@ -0,0 +1,1086 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Implementation of primary ALSA driver code for Phytium HD Audio. -+ * -+ * Copyright (c) 2018-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#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 "hda_controller.h" -+#include "hda_phytium.h" -+ -+#include "hda_intel_trace.h" -+ -+/* position fix mode */ -+enum { -+ POS_FIX_AUTO, -+ POS_FIX_LPIB, -+ POS_FIX_POSBUF, -+ POS_FIX_VIACOMBO, -+ POS_FIX_COMBO, -+}; -+ -+/* Define IN stream 0 FIFO size offset in VIA controller */ -+#define VIA_IN_STREAM0_FIFO_SIZE_OFFSET 0x90 -+ -+/* FT have 4 playback and 4 capture */ -+#define FT4C_NUM_CAPTURE 4 -+#define FT4C_NUM_PLAYBACK 4 -+ -+#define DWORD_BYTE_WIDTH 4 -+#define BYTE_BIT_WIDTH 8 -+ -+static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; -+static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; -+static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; -+static char *model[SNDRV_CARDS]; -+static int position_fix[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = 1}; -+static int bdl_pos_adj[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = -1}; -+static int probe_mask[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = -1}; -+static int probe_only[SNDRV_CARDS]; -+static int jackpoll_ms[SNDRV_CARDS]; -+static int single_cmd = -1; -+static int enable_msi = -1; -+#ifdef CONFIG_SND_HDA_INPUT_BEEP -+static bool beep_mode[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = -+ CONFIG_SND_HDA_INPUT_BEEP_MODE}; -+#endif -+ -+module_param_array(index, int, NULL, 0444); -+MODULE_PARM_DESC(index, "Index value for Intel HD audio interface."); -+module_param_array(id, charp, NULL, 0444); -+MODULE_PARM_DESC(id, "ID string for Intel HD audio interface."); -+module_param_array(enable, bool, NULL, 0444); -+MODULE_PARM_DESC(enable, "Enable Intel HD audio interface."); -+module_param_array(model, charp, NULL, 0444); -+MODULE_PARM_DESC(model, "Use the given board model."); -+module_param_array(position_fix, int, NULL, 0444); -+MODULE_PARM_DESC(position_fix, "DMA pointer read method. (-1 = system default, 0 = auto, 1 = LPIB, 2 = POSBUF, 3 = VIACOMBO, 4 = COMBO)."); -+module_param_array(bdl_pos_adj, int, NULL, 0644); -+MODULE_PARM_DESC(bdl_pos_adj, "BDL position adjustment offset."); -+module_param_array(probe_mask, int, NULL, 0444); -+MODULE_PARM_DESC(probe_mask, "Bitmask to probe codecs (default = -1)."); -+module_param_array(probe_only, int, NULL, 0444); -+MODULE_PARM_DESC(probe_only, "Only probing and no codec initialization."); -+module_param_array(jackpoll_ms, int, NULL, 0444); -+MODULE_PARM_DESC(jackpoll_ms, "Ms between polling for jack events (default = 0, using unsol events only)"); -+module_param(single_cmd, bint, 0444); -+MODULE_PARM_DESC(single_cmd, "Use single command to communicate with codecs (for debugging only)."); -+module_param(enable_msi, bint, 0444); -+MODULE_PARM_DESC(enable_msi, "Enable Message Signaled Interrupt (MSI)"); -+#ifdef CONFIG_SND_HDA_INPUT_BEEP -+module_param_array(beep_mode, bool, NULL, 0444); -+MODULE_PARM_DESC(beep_mode, "Select HDA Beep registration mode (0=off, 1=on) (default=1)."); -+#endif -+ -+#define power_save 0 -+ -+static int align_buffer_size = -1; -+module_param(align_buffer_size, bint, 0644); -+MODULE_PARM_DESC(align_buffer_size, -+ "Force buffer and period sizes to be multiple of 128 bytes."); -+ -+/* driver types */ -+enum { -+ AZX_DRIVER_ICH, -+ AZX_DRIVER_PCH, -+ AZX_DRIVER_SCH, -+ AZX_DRIVER_HDMI, -+ AZX_DRIVER_ATI, -+ AZX_DRIVER_ATIHDMI, -+ AZX_DRIVER_ATIHDMI_NS, -+ AZX_DRIVER_VIA, -+ AZX_DRIVER_SIS, -+ AZX_DRIVER_ULI, -+ AZX_DRIVER_NVIDIA, -+ AZX_DRIVER_TERA, -+ AZX_DRIVER_CTX, -+ AZX_DRIVER_CTHDA, -+ AZX_DRIVER_CMEDIA, -+ AZX_DRIVER_GENERIC, -+ AZX_DRIVER_FT, -+ AZX_NUM_DRIVERS, /* keep this as last entry */ -+}; -+ -+/* NOP for other archs */ -+static inline void mark_pages_wc(struct azx *chip, struct snd_dma_buffer *buf, -+ bool on) -+{ -+} -+ -+static inline void mark_runtime_wc(struct azx *chip, struct azx_dev *azx_dev, -+ struct snd_pcm_substream *substream, bool on) -+{ -+} -+ -+static int azx_acquire_irq(struct azx *chip, int do_disconnect); -+ -+/* calculate runtime delay from LPIB */ -+static int azx_get_delay_from_lpib(struct azx *chip, struct azx_dev *azx_dev, -+ unsigned int pos) -+{ -+ struct snd_pcm_substream *substream = azx_dev->core.substream; -+ int stream = substream->stream; -+ unsigned int lpib_pos = azx_get_pos_lpib(chip, azx_dev); -+ int delay; -+ -+ if (stream == SNDRV_PCM_STREAM_PLAYBACK) -+ delay = pos - lpib_pos; -+ else -+ delay = lpib_pos - pos; -+ if (delay < 0) { -+ if (delay >= azx_dev->core.delay_negative_threshold) -+ delay = 0; -+ else -+ delay += azx_dev->core.bufsize; -+ } -+ -+ if (delay >= azx_dev->core.period_bytes) { -+ dev_info(chip->card->dev, -+ "Unstable LPIB (%d >= %d); disabling LPIB delay counting\n", -+ delay, azx_dev->core.period_bytes); -+ delay = 0; -+ chip->driver_caps &= ~AZX_DCAPS_COUNT_LPIB_DELAY; -+ chip->get_delay[stream] = NULL; -+ } -+ -+ return bytes_to_frames(substream->runtime, delay); -+} -+ -+static int azx_position_ok(struct azx *chip, struct azx_dev *azx_dev); -+ -+/* called from IRQ */ -+static int azx_position_check(struct azx *chip, struct azx_dev *azx_dev) -+{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ int ok; -+ -+ ok = azx_position_ok(chip, azx_dev); -+ if (ok == 1) { -+ azx_dev->irq_pending = 0; -+ return ok; -+ } else if (ok == 0) { -+ /* bogus IRQ, process it later */ -+ azx_dev->irq_pending = 1; -+ schedule_work(&hda->irq_pending_work); -+ } -+ return 0; -+} -+ -+static int azx_ft_link_power(struct azx *chip, bool enable) -+{ -+ return 0; -+} -+ -+/* -+ * Check whether the current DMA position is acceptable for updating -+ * periods. Returns non-zero if it's OK. -+ * -+ * Many HD-audio controllers appear pretty inaccurate about -+ * the update-IRQ timing. The IRQ is issued before actually the -+ * data is processed. So, we need to process it afterwords in a -+ * workqueue. -+ */ -+static int azx_position_ok(struct azx *chip, struct azx_dev *azx_dev) ++static int mtd_part_acpi_parse(struct mtd_info *master, ++ struct mtd_partitions *pparts) +{ -+ struct snd_pcm_substream *substream = azx_dev->core.substream; -+ int stream = substream->stream; -+ u32 wallclk; -+ unsigned int pos; -+ -+ wallclk = (azx_readl(chip, WALLCLK) - azx_dev->core.start_wallclk); -+ -+ if (wallclk < (azx_dev->core.period_wallclk * 2) / 3) -+ return -1; /* bogus (too early) interrupt */ -+ -+ if (chip->get_position[stream]) -+ pos = chip->get_position[stream](chip, azx_dev); -+ else { /* use the position buffer as default */ -+ pos = azx_get_pos_posbuf(chip, azx_dev); -+ if (!pos || pos == (u32)-1) { -+ dev_info(chip->card->dev, -+ "Invalid position buffer, using LPIB read method instead.\n"); -+ chip->get_position[stream] = azx_get_pos_lpib; -+ if (chip->get_position[0] == azx_get_pos_lpib && -+ chip->get_position[1] == azx_get_pos_lpib) -+ azx_bus(chip)->use_posbuf = false; -+ pos = azx_get_pos_lpib(chip, azx_dev); -+ chip->get_delay[stream] = NULL; -+ } else { -+ chip->get_position[stream] = azx_get_pos_posbuf; -+ if (chip->driver_caps & AZX_DCAPS_COUNT_LPIB_DELAY) -+ chip->get_delay[stream] = azx_get_delay_from_lpib; -+ } -+ } -+ -+ if (pos >= azx_dev->core.bufsize) -+ pos = 0; -+ -+ if (WARN_ONCE(!azx_dev->core.period_bytes, -+ "hda-ft: zero azx_dev->period_bytes")) -+ return -1; /* this shouldn't happen! */ -+ if (wallclk < (azx_dev->core.period_wallclk * 5) / 4 && -+ pos % azx_dev->core.period_bytes > azx_dev->core.period_bytes / 2) -+ /* NG - it's below the first next period boundary */ -+ return chip->bdl_pos_adj ? 0 : -1; -+ -+ azx_dev->core.start_wallclk += wallclk; -+ -+ return 1; /* OK, it's fine */ -+} ++ struct mtd_part_parser *parser; ++ struct acpi_device *adev; ++ struct fwnode_handle *child; ++ const char *compat = NULL; ++ const char *fixed = "acpi-partitions"; ++ int ret, err = 0; ++ int compare = 1; ++ struct device *dev = &master->dev; + -+/* The work for pending PCM period updates. */ -+static void azx_irq_pending_work(struct work_struct *work) -+{ -+ struct hda_ft *hda = container_of(work, struct hda_ft, irq_pending_work); -+ struct azx *chip = &hda->chip; -+ struct hdac_bus *bus = azx_bus(chip); -+ struct hdac_stream *s; -+ int pending, ok; -+ -+ if (!hda->irq_pending_warned) { -+ dev_info(chip->card->dev, -+ "IRQ timing workaround is activated for card #%d. Suggest a bigger bdl_pos_adj.\n", -+ chip->card->number); -+ hda->irq_pending_warned = 1; ++ if (has_acpi_companion(dev)) ++ adev = ACPI_COMPANION(dev); ++ if (!mtd_is_partition(master)) { ++ fwnode_property_read_string(dev->fwnode, "fixed", &compat); ++ if (compat) ++ compare = strcmp(compat, fixed); + } + -+ for (;;) { -+ pending = 0; -+ spin_lock_irq(&bus->reg_lock); -+ list_for_each_entry(s, &bus->stream_list, list) { -+ struct azx_dev *azx_dev = stream_to_azx_dev(s); -+ -+ if (!azx_dev->irq_pending || -+ !s->substream || !s->running) -+ continue; -+ ok = azx_position_ok(chip, azx_dev); -+ if (ok > 0) { -+ azx_dev->irq_pending = 0; -+ spin_unlock(&bus->reg_lock); -+ snd_pcm_period_elapsed(s->substream); -+ spin_lock(&bus->reg_lock); -+ } else if (ok < 0) { -+ pending = 0; /* too early */ -+ } else { -+ pending++; ++ device_for_each_child_node(dev, child) { ++ if (compat && !compare) { ++ parser = mtd_part_parser_get(fixed); ++ if (!parser && !request_module("%s", fixed)) ++ parser = mtd_part_parser_get(fixed); ++ if (parser) { ++ ret = mtd_part_do_parse(parser, master, pparts, NULL); ++ if (ret > 0) ++ return ret; ++ mtd_part_parser_put(parser); ++ if (ret < 0 && !err) ++ err = ret; + } + } -+ spin_unlock_irq(&bus->reg_lock); -+ if (!pending) -+ return; -+ udelay(1000); -+ } -+} -+ -+/* clear irq_pending flags and assure no on-going workq */ -+static void azx_clear_irq_pending(struct azx *chip) -+{ -+ struct hdac_bus *bus = azx_bus(chip); -+ struct hdac_stream *s; -+ -+ spin_lock_irq(&bus->reg_lock); -+ list_for_each_entry(s, &bus->stream_list, list) { -+ struct azx_dev *azx_dev = stream_to_azx_dev(s); -+ -+ azx_dev->irq_pending = 0; + } -+ spin_unlock_irq(&bus->reg_lock); ++ return err; +} + -+static int azx_acquire_irq(struct azx *chip, int do_disconnect) -+{ -+ struct hdac_bus *bus = azx_bus(chip); + static int mtd_part_of_parse(struct mtd_info *master, + struct mtd_partitions *pparts) + { +@@ -591,7 +633,7 @@ static int mtd_part_of_parse(struct mtd_info *master, + dev = master->dev.parent; + + np = mtd_get_of_node(master); +- if (mtd_is_partition(master)) ++ if (mtd_is_partition(master) && np) + of_node_get(np); + else + np = of_get_child_by_name(np, "partitions"); +@@ -612,7 +654,8 @@ static int mtd_part_of_parse(struct mtd_info *master, + ret = mtd_part_do_parse(parser, master, pparts, NULL); + if (ret > 0) { + of_platform_populate(np, NULL, NULL, dev); +- of_node_put(np); ++ if (np) ++ of_node_put(np); + return ret; + } + mtd_part_parser_put(parser); +@@ -620,7 +663,8 @@ static int mtd_part_of_parse(struct mtd_info *master, + err = ret; + } + of_platform_populate(np, NULL, NULL, dev); +- of_node_put(np); ++ if (np) ++ of_node_put(np); + + /* + * For backward compatibility we have to try the "fixed-partitions" +@@ -678,7 +722,9 @@ int parse_mtd_partitions(struct mtd_info *master, const char *const *types, + * should be used. It requires a bit different logic so it is + * handled in a separated function. + */ +- if (!strcmp(*types, "ofpart")) { ++ if (!strcmp(*types, "acpipart")) { ++ ret = mtd_part_acpi_parse(master, &pparts); ++ } else if (!strcmp(*types, "ofpart")) { + ret = mtd_part_of_parse(master, &pparts); + } else { + pr_debug("%s: parsing partitions %s\n", master->name, +diff --git a/drivers/mtd/parsers/Kconfig b/drivers/mtd/parsers/Kconfig +index 60738edcd..ae1870d27 100644 +--- a/drivers/mtd/parsers/Kconfig ++++ b/drivers/mtd/parsers/Kconfig +@@ -96,6 +96,15 @@ config MTD_OF_PARTS_LINKSYS_NS + two "firmware" partitions. Currently used firmware has to be detected + using CFE environment variable. + ++config MTD_ACPI_PARTS ++ tristate "ACPI partitioning parser" ++ default y ++ depends on ACPI ++ help ++ This provides an acpi partition parser, which is used to parse the ++ partition map described in ACPI table, as the children of the flash ++ memory struct. + -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ struct platform_device *pdev = to_platform_device(hda->dev); -+ int irq_id = platform_get_irq(pdev, 0); -+ int err; + config MTD_PARSER_IMAGETAG + tristate "Parser for BCM963XX Image Tag format partitions" + depends on BCM63XX || BMIPS_GENERIC || COMPILE_TEST +diff --git a/drivers/mtd/parsers/Makefile b/drivers/mtd/parsers/Makefile +index 0e70b621a..2679fd766 100644 +--- a/drivers/mtd/parsers/Makefile ++++ b/drivers/mtd/parsers/Makefile +@@ -8,6 +8,8 @@ obj-$(CONFIG_MTD_OF_PARTS) += ofpart.o + ofpart-y += ofpart_core.o + ofpart-$(CONFIG_MTD_OF_PARTS_BCM4908) += ofpart_bcm4908.o + ofpart-$(CONFIG_MTD_OF_PARTS_LINKSYS_NS)+= ofpart_linksys_ns.o ++obj-$(CONFIG_MTD_ACPI_PARTS) += acpipart.o ++acpipart-y += acpipart_core.o + obj-$(CONFIG_MTD_PARSER_IMAGETAG) += parser_imagetag.o + obj-$(CONFIG_MTD_AFS_PARTS) += afs.o + obj-$(CONFIG_MTD_PARSER_TPLINK_SAFELOADER) += tplink_safeloader.o +diff --git a/drivers/mtd/parsers/acpipart_core.c b/drivers/mtd/parsers/acpipart_core.c +new file mode 100644 +index 000000000..dde80407a +--- /dev/null ++++ b/drivers/mtd/parsers/acpipart_core.c +@@ -0,0 +1,142 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * Flash partitions described by the acpi table ++ * ++ * Author: Wang Hanmo ++ */ + -+ err = request_irq(irq_id, azx_interrupt, -+ IRQF_SHARED, KBUILD_MODNAME, chip); -+ if (err) { -+ dev_err(chip->card->dev, -+ "unable to request IRQ %d, disabling device\n", -+ irq_id); -+ if (do_disconnect) -+ snd_card_disconnect(chip->card); -+ return err; -+ } -+ bus->irq = irq_id; ++#include ++#include ++#include ++#include ++#include ++#include ++#include + -+ return 0; -+} ++static const struct acpi_device_id parse_acpipart_match_table[]; + -+/* get the current DMA position with correction on VIA chips */ -+static unsigned int azx_via_get_position(struct azx *chip, -+ struct azx_dev *azx_dev) ++static int parse_acpi_fixed_partitions(struct mtd_info *master, ++ const struct mtd_partition **pparts, ++ struct mtd_part_parser_data *data) +{ -+ unsigned int link_pos, mini_pos, bound_pos; -+ unsigned int mod_link_pos, mod_dma_pos, mod_mini_pos; -+ unsigned int fifo_size; -+ -+ link_pos = snd_hdac_stream_get_pos_lpib(azx_stream(azx_dev)); -+ if (azx_dev->core.substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { -+ /* Playback, no problem using link position */ -+ return link_pos; -+ } -+ -+ /* Capture */ -+ /* For new chipset, -+ * use mod to get the DMA position just like old chipset -+ */ -+ mod_dma_pos = le32_to_cpu(*azx_dev->core.posbuf); -+ mod_dma_pos %= azx_dev->core.period_bytes; -+ -+ /* azx_dev->fifo_size can't get FIFO size of in stream. -+ * Get from base address + offset. -+ */ -+ fifo_size = readw(azx_bus(chip)->remap_addr + -+ VIA_IN_STREAM0_FIFO_SIZE_OFFSET); -+ -+ if (azx_dev->insufficient) { -+ /* Link position never gather than FIFO size */ -+ if (link_pos <= fifo_size) -+ return 0; ++ struct mtd_partition *parts; ++ const struct acpi_device_id *acpi_id; ++ const char *partname; ++ int nr_parts, i, ret = 0; ++ struct acpi_device *adev; ++ struct fwnode_handle *child_handle; ++ bool dedicated = true; ++ struct device *dev; + -+ azx_dev->insufficient = 0; -+ } ++ dev = &master->dev; ++ adev = ACPI_COMPANION(&master->dev); + -+ if (link_pos <= fifo_size) -+ mini_pos = azx_dev->core.bufsize + link_pos - fifo_size; -+ else -+ mini_pos = link_pos - fifo_size; -+ -+ /* Find nearest previous boudary */ -+ mod_mini_pos = mini_pos % azx_dev->core.period_bytes; -+ mod_link_pos = link_pos % azx_dev->core.period_bytes; -+ if (mod_link_pos >= fifo_size) -+ bound_pos = link_pos - mod_link_pos; -+ else if (mod_dma_pos >= mod_mini_pos) -+ bound_pos = mini_pos - mod_mini_pos; -+ else { -+ bound_pos = mini_pos - mod_mini_pos + azx_dev->core.period_bytes; -+ if (bound_pos >= azx_dev->core.bufsize) -+ bound_pos = 0; ++ if (!master->parent) {/*master*/ ++ device_get_next_child_node(dev, child_handle); ++ if (!child_handle) { ++ pr_debug("%s: 'partitions' subnode not found on %pOF. Trying to parse direct subnodes as partitions.\n", ++ master->name, child_handle); ++ dedicated = false; ++ } + } + -+ /* Calculate real DMA position we want */ -+ return bound_pos + mod_dma_pos; -+} -+ -+#ifdef CONFIG_PM -+static DEFINE_MUTEX(card_list_lock); -+static LIST_HEAD(card_list); -+ -+static void azx_add_card_list(struct azx *chip) -+{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ -+ mutex_lock(&card_list_lock); -+ list_add(&hda->list, &card_list); -+ mutex_unlock(&card_list_lock); -+} -+ -+static void azx_del_card_list(struct azx *chip) -+{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ -+ mutex_lock(&card_list_lock); -+ list_del_init(&hda->list); -+ mutex_unlock(&card_list_lock); -+} -+ -+#else -+#define azx_add_card_list(chip) /* NOP */ -+#define azx_del_card_list(chip) /* NOP */ -+#endif /* CONFIG_PM */ -+ -+#if defined(CONFIG_PM_SLEEP) -+/* power management */ -+static int azx_suspend(struct device *dev) -+{ -+ struct snd_card *card = dev_get_drvdata(dev); -+ struct azx *chip; -+ struct hda_ft *hda; -+ struct hdac_bus *bus; -+ -+ if (!card) -+ return 0; -+ -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ if (chip->disabled || !chip->running) ++ acpi_id = acpi_match_device(parse_acpipart_match_table, dev); ++ if (dedicated && !acpi_id) + return 0; + -+ bus = azx_bus(chip); -+ snd_power_change_state(card, SNDRV_CTL_POWER_D3hot); -+ azx_clear_irq_pending(chip); -+ azx_stop_chip(chip); -+ if (bus->irq >= 0) { -+ free_irq(bus->irq, (void *)chip); -+ bus->irq = -1; ++ nr_parts = 0; ++ device_for_each_child_node(dev, child_handle) { ++ nr_parts++; + } + -+ return 0; -+} -+ -+static int azx_resume(struct device *dev) -+{ -+ struct snd_card *card = dev_get_drvdata(dev); -+ struct azx *chip; -+ struct hda_ft *hda; -+ struct hdac_bus *bus; -+ int index; -+ struct snd_pcm_substream *substream; -+ struct azx_dev *azx_dev; -+ int err; -+ -+ if (!card) -+ return 0; -+ -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ bus = azx_bus(chip); -+ if (chip->disabled || !chip->running) ++ if (nr_parts == 0) + return 0; ++ parts = kcalloc(nr_parts, sizeof(*parts), GFP_KERNEL); ++ if (!parts) ++ return -ENOMEM; + -+ if (azx_acquire_irq(chip, 1) < 0) -+ return -EIO; -+ -+ index = chip->dev_index; -+ -+ snd_hdac_bus_exit_link_reset(bus); -+ usleep_range(1000, 1200); -+ -+ azx_init_chip(chip, 0); -+ -+ snd_power_change_state(card, SNDRV_CTL_POWER_D0); -+ -+ if (hda->substream && hda->substream->runtime) { -+ substream = hda->substream; ++ i = 0; ++ device_for_each_child_node(dev, child_handle) { ++ u64 offset, length; ++ bool bool_match; + -+ if (substream->runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) { -+ substream->runtime->status->state = -+ substream->runtime->status->suspended_state; -+ err = substream->ops->prepare(substream); -+ if (err < 0) -+ return err; ++ fwnode_property_read_u64(child_handle, "offset", &offset); ++ fwnode_property_read_u64(child_handle, "length", &length); ++ if (!offset && !length) { ++ if (dedicated) { ++ pr_debug("%s: acpipart partition %pOF (%pOF) missing reg property.\n", ++ master->name, child_handle, ++ dev->fwnode); ++ goto acpipart_fail; ++ } else { ++ nr_parts--; ++ continue; ++ } + } + -+ azx_dev = get_azx_dev(substream); -+ hda->substream = NULL; ++ parts[i].offset = offset; ++ parts[i].size = length; ++ parts[i].fwnode = child_handle; ++ if (!fwnode_property_read_string(child_handle, "label", &partname)) ++ parts[i].name = partname; ++ bool_match = fwnode_property_read_bool(child_handle, "read-only"); ++ if (bool_match) ++ parts[i].mask_flags |= MTD_WRITEABLE; ++ bool_match = fwnode_property_read_bool(child_handle, "lock"); ++ if (bool_match) ++ parts[i].mask_flags |= MTD_POWERUP_LOCK; ++ bool_match = fwnode_property_read_bool(child_handle, "slc-mode"); ++ if (bool_match) ++ parts[i].mask_flags |= MTD_SLC_ON_MLC_EMULATION; ++ i++; + } + -+ return 0; -+} -+#endif /* CONFIG_PM_SLEEP */ ++ if (!nr_parts) ++ goto acpipart_none; + -+#ifdef CONFIG_PM -+static int azx_runtime_suspend(struct device *dev) -+{ -+ struct snd_card *card = dev_get_drvdata(dev); -+ struct azx *chip; -+ struct hda_ft *hda; ++ *pparts = parts; ++ ret = nr_parts; ++ return ret; + -+ if (!card) -+ return 0; ++acpipart_fail: ++ pr_err("%s: error parsing acpipart partition %pOF (%pOF)\n", ++ master->name, child_handle, dev->fwnode); ++ ret = -EINVAL; ++acpipart_none: ++ kfree(parts); ++ return ret; ++} + -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ if (chip->disabled) -+ return 0; ++static const struct acpi_device_id parse_acpipart_match_table[] = { ++ /* Generic */ ++ { "acpi-partitions", 0 }, ++ /* Customized */ ++ {}, ++}; + -+ if (!azx_has_pm_runtime(chip)) -+ return 0; ++MODULE_DEVICE_TABLE(acpi, parse_acpipart_match_table); + -+ azx_stop_chip(chip); -+ azx_enter_link_reset(chip); -+ azx_clear_irq_pending(chip); ++static struct mtd_part_parser acpipart_parser = { ++ .parse_fn = parse_acpi_fixed_partitions, ++ .name = "acpi-fixed-partitions", ++ .acpi_match_table = ACPI_PTR(parse_acpipart_match_table), ++}; + ++static int __init acpipart_parser_init(void) ++{ ++ register_mtd_parser(&acpipart_parser); + return 0; +} + -+static int azx_runtime_resume(struct device *dev) ++static void __exit acpipart_parser_exit(void) +{ -+ struct snd_card *card = dev_get_drvdata(dev); -+ struct azx *chip; -+ struct hda_ft *hda; -+ struct hdac_bus *bus; -+ struct hda_codec *codec; -+ int status; -+ int index; -+ -+ if (!card) -+ return 0; -+ -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ bus = azx_bus(chip); -+ if (chip->disabled) -+ return 0; -+ -+ if (!azx_has_pm_runtime(chip)) -+ return 0; -+ -+ /* Read STATESTS before controller reset */ -+ status = azx_readw(chip, STATESTS); -+ -+ index = chip->dev_index; -+ -+ snd_hdac_bus_exit_link_reset(bus); -+ usleep_range(1000, 1200); -+ -+ azx_init_chip(chip, 0); -+ -+ if (status) { -+ list_for_each_codec(codec, &chip->bus) -+ if (status & (1 << codec->addr)) -+ schedule_delayed_work(&codec->jackpoll_work, -+ codec->jackpoll_interval); -+ } -+ -+ return 0; ++ deregister_mtd_parser(&acpipart_parser); +} + -+static int azx_runtime_idle(struct device *dev) -+{ -+ struct snd_card *card = dev_get_drvdata(dev); -+ struct azx *chip; -+ struct hda_ft *hda; ++module_init(acpipart_parser_init); ++module_exit(acpipart_parser_exit); + -+ if (!card) -+ return 0; ++MODULE_LICENSE("GPL"); ++MODULE_DESCRIPTION("Parser for MTD partitioning information in acpi table"); ++MODULE_AUTHOR("Wang Hanmo "); ++MODULE_ALIAS("acpi-partitions"); +diff --git a/drivers/mtd/spi-nor/Makefile b/drivers/mtd/spi-nor/Makefile +index e347b435a..cc12acf1f 100644 +--- a/drivers/mtd/spi-nor/Makefile ++++ b/drivers/mtd/spi-nor/Makefile +@@ -17,6 +17,7 @@ spi-nor-objs += sst.o + spi-nor-objs += winbond.o + spi-nor-objs += xilinx.o + spi-nor-objs += xmc.o ++spi-nor-objs += boya.o + spi-nor-$(CONFIG_DEBUG_FS) += debugfs.o + obj-$(CONFIG_MTD_SPI_NOR) += spi-nor.o + +diff --git a/drivers/mtd/spi-nor/boya.c b/drivers/mtd/spi-nor/boya.c +new file mode 100644 +index 000000000..71d361ccf +--- /dev/null ++++ b/drivers/mtd/spi-nor/boya.c +@@ -0,0 +1,26 @@ ++// SPDX-License-Identifier: GPL-2.0 ++/* ++ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. ++ */ + -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ if (chip->disabled) -+ return 0; ++#include + -+ if (!azx_has_pm_runtime(chip) || -+ azx_bus(chip)->codec_powered || !chip->running) -+ return -EBUSY; ++#include "core.h" + -+ return 0; -+} ++static const struct flash_info boya_nor_parts[] = { ++ /* Boya */ ++ { "by25q64as", INFO(0x684017, 0, 64 * 1024, 128) ++ FLAGS(SPI_NOR_HAS_LOCK | SPI_NOR_HAS_TB) ++ NO_SFDP_FLAGS(SECT_4K | SPI_NOR_DUAL_READ | ++ SPI_NOR_QUAD_READ) }, ++ { "by25q128as", INFO(0x684018, 0, 64 * 1024, 256) ++ FLAGS(SPI_NOR_HAS_LOCK | SPI_NOR_HAS_TB) ++ NO_SFDP_FLAGS(SECT_4K | SPI_NOR_DUAL_READ | ++ SPI_NOR_QUAD_READ) }, ++}; ++ ++const struct spi_nor_manufacturer spi_nor_boya = { ++ .name = "boya", ++ .parts = boya_nor_parts, ++ .nparts = ARRAY_SIZE(boya_nor_parts), ++}; +diff --git a/drivers/mtd/spi-nor/core.c b/drivers/mtd/spi-nor/core.c +index 1b0c6770c..0810e27d9 100644 +--- a/drivers/mtd/spi-nor/core.c ++++ b/drivers/mtd/spi-nor/core.c +@@ -7,6 +7,7 @@ + * Copyright (C) 2014, Freescale Semiconductor, Inc. + */ + ++#include + #include + #include + #include +@@ -17,6 +18,7 @@ + #include + #include + #include ++#include + #include + #include + #include +@@ -2015,6 +2017,7 @@ static const struct spi_nor_manufacturer *manufacturers[] = { + &spi_nor_winbond, + &spi_nor_xilinx, + &spi_nor_xmc, ++ &spi_nor_boya, + }; + + static const struct flash_info spi_nor_generic_flash = { +@@ -3621,6 +3624,7 @@ static int spi_nor_probe(struct spi_mem *spimem) + struct spi_device *spi = spimem->spi; + struct flash_platform_data *data = dev_get_platdata(&spi->dev); + struct spi_nor *nor; ++ struct acpi_device *adev; + /* + * Enable all caps by default. The core will mask them after + * checking what's really supported using spi_mem_supports_op(). +@@ -3636,6 +3640,10 @@ static int spi_nor_probe(struct spi_mem *spimem) + nor->spimem = spimem; + nor->dev = &spi->dev; + spi_nor_set_flash_node(nor, spi->dev.of_node); ++ adev = ACPI_COMPANION(nor->dev); ++ nor->mtd.dev.fwnode = spi->dev.fwnode; + -+static const struct dev_pm_ops azx_pm = { -+ SET_SYSTEM_SLEEP_PM_OPS(azx_suspend, azx_resume) -+ SET_RUNTIME_PM_OPS(azx_runtime_suspend, azx_runtime_resume, azx_runtime_idle) ++ device_property_read_string(&spi->dev, "_HID", &nor->mtd.name); + + spi_mem_set_drvdata(spimem, nor); + +@@ -3775,6 +3783,11 @@ static const struct of_device_id spi_nor_of_table[] = { + }; + MODULE_DEVICE_TABLE(of, spi_nor_of_table); + ++static const struct acpi_device_id spi_nor_acpi_table[] = { ++ {"PHYT8009", 0}, ++ { }, +}; ++MODULE_DEVICE_TABLE(acpi, spi_nor_acpi_table); + /* + * REVISIT: many of these chips have deep power-down modes, which + * should clearly be entered on suspend() to minimize power use. +@@ -3786,6 +3799,7 @@ static struct spi_mem_driver spi_nor_driver = { + .name = "spi-nor", + .of_match_table = spi_nor_of_table, + .dev_groups = spi_nor_sysfs_groups, ++ .acpi_match_table = spi_nor_acpi_table, + }, + .id_table = spi_nor_dev_ids, + }, +diff --git a/drivers/mtd/spi-nor/core.h b/drivers/mtd/spi-nor/core.h +index 9217379b9..36252b89e 100644 +--- a/drivers/mtd/spi-nor/core.h ++++ b/drivers/mtd/spi-nor/core.h +@@ -647,6 +647,7 @@ extern const struct spi_nor_manufacturer spi_nor_sst; + extern const struct spi_nor_manufacturer spi_nor_winbond; + extern const struct spi_nor_manufacturer spi_nor_xilinx; + extern const struct spi_nor_manufacturer spi_nor_xmc; ++extern const struct spi_nor_manufacturer spi_nor_boya; + + extern const struct attribute_group *spi_nor_sysfs_groups[]; + +diff --git a/drivers/net/ethernet/cadence/macb.h b/drivers/net/ethernet/cadence/macb.h +index 78c972bb1..3a5441dcc 100644 +--- a/drivers/net/ethernet/cadence/macb.h ++++ b/drivers/net/ethernet/cadence/macb.h +@@ -85,6 +85,7 @@ + #define GEM_PBUFRXCUT 0x0044 /* RX Partial Store and Forward */ + #define GEM_JML 0x0048 /* Jumbo Max Length */ + #define GEM_HS_MAC_CONFIG 0x0050 /* GEM high speed config */ ++#define GEM_AXI_PIPE 0x0054 /* Axi max pipeline register*/ + #define GEM_HRB 0x0080 /* Hash Bottom */ + #define GEM_HRT 0x0084 /* Hash Top */ + #define GEM_SA1B 0x0088 /* Specific1 Bottom */ +@@ -220,6 +221,36 @@ + #define GEM_IDR(hw_q) (0x0620 + ((hw_q) << 2)) + #define GEM_IMR(hw_q) (0x0640 + ((hw_q) << 2)) + ++#define GEM_SRC_SEL_LN 0x1C04 ++#define GEM_DIV_SEL0_LN 0x1C08 ++#define GEM_DIV_SEL1_LN 0x1C0C ++#define GEM_PMA_XCVR_POWER_STATE 0x1C10 ++#define GEM_SPEED_MODE 0x1C14 ++#define GEM_MII_SELECT 0x1C18 ++#define GEM_SEL_MII_ON_RGMII 0x1C1C ++#define GEM_TX_CLK_SEL0 0x1C20 ++#define GEM_TX_CLK_SEL1 0x1C24 ++#define GEM_TX_CLK_SEL2 0x1C28 ++#define GEM_TX_CLK_SEL3 0x1C2C ++#define GEM_RX_CLK_SEL0 0x1C30 ++#define GEM_RX_CLK_SEL1 0x1C34 ++#define GEM_CLK_250M_DIV10_DIV100_SEL 0x1C38 ++#define GEM_TX_CLK_SEL5 0x1C3C ++#define GEM_TX_CLK_SEL6 0x1C40 ++#define GEM_RX_CLK_SEL4 0x1C44 ++#define GEM_RX_CLK_SEL5 0x1C48 ++#define GEM_TX_CLK_SEL3_0 0x1C70 ++#define GEM_TX_CLK_SEL4_0 0x1C74 ++#define GEM_RX_CLK_SEL3_0 0x1C78 ++#define GEM_RX_CLK_SEL4_0 0x1C7C ++#define GEM_RGMII_TX_CLK_SEL0 0x1C80 ++#define GEM_RGMII_TX_CLK_SEL1 0x1C84 + -+#define hda_ft_pm (&azx_pm) -+#else -+#define hda_ft_pm NULL -+#endif /* CONFIG_PM */ -+ -+static int azx_probe_continue(struct azx *chip); -+ -+/* -+ * destructor -+ */ -+static int azx_free(struct azx *chip) -+{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ struct hdac_bus *bus = azx_bus(chip); -+ struct platform_device *pdev = to_platform_device(hda->dev); -+ struct device *hddev = hda->dev; -+ -+ if (azx_has_pm_runtime(chip) && chip->running) -+ pm_runtime_get_noresume(&pdev->dev); -+ -+ azx_del_card_list(chip); -+ -+ complete_all(&hda->probe_wait); -+ -+ if (bus->chip_init) { -+ azx_clear_irq_pending(chip); -+ azx_stop_all_streams(chip); -+ azx_stop_chip(chip); -+ } -+ -+ if (bus->irq >= 0) { -+ free_irq(bus->irq, (void *)chip); -+ bus->irq = -1; -+ } -+ -+ devm_iounmap(hddev, bus->remap_addr); -+ -+ azx_free_stream_pages(chip); -+ azx_free_streams(chip); -+ snd_hdac_bus_exit(bus); -+ -+ return 0; -+} -+ -+static int azx_dev_disconnect(struct snd_device *device) -+{ -+ struct azx *chip = device->device_data; -+ -+ chip->bus.shutdown = 1; -+ return 0; -+} ++#define GEM_PHY_INT_ENABLE 0x1C88 ++#define GEM_PHY_INT_CLEAR 0x1C8C ++#define GEM_PHY_INT_STATE 0x1C90 ++#define GEM_INTX_IRQ_MASK 0x1C7C /* Phytium: irq mask */ + -+static int azx_dev_free(struct snd_device *device) -+{ -+ return azx_free(device->device_data); -+} + /* Bitfields in NCR */ + #define MACB_LB_OFFSET 0 /* reserved */ + #define MACB_LB_SIZE 1 +@@ -254,6 +285,8 @@ + #define MACB_OSSMODE_SIZE 1 + #define MACB_MIIONRGMII_OFFSET 28 /* MII Usage on RGMII Interface */ + #define MACB_MIIONRGMII_SIZE 1 ++#define MACB_2PT5G_OFFSET 29 /* 2.5G operation selected */ ++#define MACB_2PT5G_SIZE 1 + + /* Bitfields in NCFGR */ + #define MACB_SPD_OFFSET 0 /* Speed */ +@@ -562,6 +595,8 @@ + #define GEM_RX_SCR_BYPASS_SIZE 1 + #define GEM_TX_SCR_BYPASS_OFFSET 8 + #define GEM_TX_SCR_BYPASS_SIZE 1 ++#define GEM_RX_SYNC_RESET_OFFSET 2 ++#define GEM_RX_SYNC_RESET_SIZE 1 + #define GEM_TX_EN_OFFSET 1 + #define GEM_TX_EN_SIZE 1 + #define GEM_SIGNAL_OK_OFFSET 0 +@@ -731,8 +766,10 @@ + #define MACB_CAPS_GEM_HAS_PTP 0x00000040 + #define MACB_CAPS_BD_RD_PREFETCH 0x00000080 + #define MACB_CAPS_NEEDS_RSTONUBR 0x00000100 ++#define MACB_CAPS_SEL_CLK 0x00000800 + #define MACB_CAPS_MIIONRGMII 0x00000200 + #define MACB_CAPS_NEED_TSUCLK 0x00000400 ++#define MACB_CAPS_SEL_CLK 0x00000800 + #define MACB_CAPS_PCS 0x01000000 + #define MACB_CAPS_HIGH_SPEED 0x02000000 + #define MACB_CAPS_CLK_HW_CHG 0x04000000 +@@ -741,6 +778,8 @@ + #define MACB_CAPS_GIGABIT_MODE_AVAILABLE 0x20000000 + #define MACB_CAPS_SG_DISABLED 0x40000000 + #define MACB_CAPS_MACB_IS_GEM 0x80000000 ++#define MACB_CAPS_PCS 0x01000000 ++#define MACB_CAPS_HIGH_SPEED 0x02000000 + + /* LSO settings */ + #define MACB_LSO_UFO_ENABLE 0x01 +@@ -783,6 +822,8 @@ + #define gem_readl_n(port, reg, idx) (port)->macb_reg_readl((port), GEM_##reg + idx * 4) + #define gem_writel_n(port, reg, idx, value) (port)->macb_reg_writel((port), GEM_##reg + idx * 4, (value)) + ++#define PTP_TS_BUFFER_SIZE 128 /* must be power of 2 */ + -+static int check_position_fix(struct azx *chip, int fix) -+{ -+ switch (fix) { -+ case POS_FIX_AUTO: -+ case POS_FIX_LPIB: -+ case POS_FIX_POSBUF: -+ case POS_FIX_VIACOMBO: -+ case POS_FIX_COMBO: -+ return fix; -+ } + /* Conditional GEM/MACB macros. These perform the operation to the correct + * register dependent on whether the device is a GEM or a MACB. For registers + * and bitfields that are common across both devices, use macb_{read,write}l +@@ -832,6 +873,11 @@ struct macb_dma_desc_ptp { + u32 ts_1; + u32 ts_2; + }; + -+ if (chip->driver_caps & AZX_DCAPS_POSFIX_LPIB) { -+ dev_dbg(chip->card->dev, "Using LPIB position fix\n"); -+ return POS_FIX_LPIB; -+ } -+ return POS_FIX_AUTO; -+} ++struct gem_tx_ts { ++ struct sk_buff *skb; ++ struct macb_dma_desc_ptp desc_ptp; ++}; + #endif + + /* DMA descriptor bitfields */ +@@ -1193,6 +1239,7 @@ struct macb_config { + unsigned int max_tx_length; + int jumbo_max_len; + const struct macb_usrio_config *usrio; ++ void (*sel_clk_hw)(struct macb *bp, int speed); + }; + + struct tsu_incr { +@@ -1231,8 +1278,15 @@ struct macb_queue { + struct macb_dma_desc *rx_ring; + struct sk_buff **rx_skbuff; + void *rx_buffers; ++ struct napi_struct napi; + struct napi_struct napi_rx; + struct queue_stats stats; + -+static void assign_position_fix(struct azx *chip, int fix) -+{ -+ static azx_get_pos_callback_t callbacks[] = { -+ [POS_FIX_AUTO] = NULL, -+ [POS_FIX_LPIB] = azx_get_pos_lpib, -+ [POS_FIX_POSBUF] = azx_get_pos_posbuf, -+ [POS_FIX_VIACOMBO] = azx_via_get_position, -+ [POS_FIX_COMBO] = azx_get_pos_lpib, -+ }; ++#ifdef CONFIG_MACB_USE_HWSTAMP ++ struct work_struct tx_ts_task; ++ unsigned int tx_ts_head, tx_ts_tail; ++ struct gem_tx_ts tx_timestamps[PTP_TS_BUFFER_SIZE]; ++#endif + }; + + struct ethtool_rx_fs_item { +@@ -1270,6 +1324,7 @@ struct macb { + struct clk *rx_clk; + struct clk *tsu_clk; + struct net_device *dev; ++ struct ncsi_dev *ndev; + union { + struct macb_stats macb; + struct gem_stats gem; +@@ -1282,6 +1337,10 @@ struct macb { + struct phylink_config phylink_config; + struct phylink_pcs phylink_usx_pcs; + struct phylink_pcs phylink_sgmii_pcs; ++ int link; ++ int speed; ++ int duplex; ++ int use_ncsi; + + u32 caps; + unsigned int dma_burst_length; +@@ -1330,6 +1389,8 @@ struct macb { + + struct macb_pm_data pm_data; + const struct macb_usrio_config *usrio; + -+ chip->get_position[0] = chip->get_position[1] = callbacks[fix]; ++ void (*sel_clk_hw)(struct macb *bp, int speed); + }; + + #ifdef CONFIG_MACB_USE_HWSTAMP +diff --git a/drivers/net/ethernet/cadence/macb_main.c b/drivers/net/ethernet/cadence/macb_main.c +index b940dcd3a..683d2095c 100644 +--- a/drivers/net/ethernet/cadence/macb_main.c ++++ b/drivers/net/ethernet/cadence/macb_main.c +@@ -26,6 +26,7 @@ + #include + #include + #include ++#include + #include + #include + #include +@@ -38,6 +39,8 @@ + #include + #include + #include ++#include ++#include + #include "macb.h" + + /* This structure is only used for MACB on SiFive FU540 devices */ +@@ -47,6 +50,9 @@ struct sifive_fu540_macb_mgmt { + struct clk_hw hw; + }; + ++#define MAX_RING_ADDR_ALLOC_TIMES 3 ++#define RING_ADDR_INTERVAL 128 + -+ /* combo mode uses LPIB only for playback */ -+ if (fix == POS_FIX_COMBO) -+ chip->get_position[1] = NULL; + #define MACB_RX_BUFFER_SIZE 128 + #define RX_BUFFER_MULTIPLE 64 /* bytes */ + +@@ -87,7 +93,12 @@ struct sifive_fu540_macb_mgmt { + #define MACB_WOL_HAS_MAGIC_PACKET (0x1 << 0) + #define MACB_WOL_ENABLED (0x1 << 1) + +-#define HS_SPEED_10000M 4 ++#define HS_SPEED_100M 0 ++#define HS_SPEED_1000M 1 ++#define HS_SPEED_2500M 2 ++#define HS_SPEED_5000M 3 ++#define HS_SPEED_10000M 4 ++#define MACB_SERDES_RATE_5G 0 + #define MACB_SERDES_RATE_10G 1 + + /* Graceful stop timeouts in us. We should allow up to +@@ -98,6 +109,10 @@ struct sifive_fu540_macb_mgmt { + + #define MACB_MDIO_TIMEOUT 1000000 /* in usecs */ + ++static void macb_tx_unmap(struct macb *bp, ++ struct macb_tx_skb *tx_skb, ++ int budget); + -+ if (fix == POS_FIX_POSBUF && -+ (chip->driver_caps & AZX_DCAPS_COUNT_LPIB_DELAY)) { -+ chip->get_delay[0] = chip->get_delay[1] = -+ azx_get_delay_from_lpib; + /* DMA buffer descriptor might be different size + * depends on hardware configuration: + * +@@ -562,7 +577,7 @@ static void macb_set_tx_clk(struct macb *bp, int speed) + netdev_err(bp->dev, "adjusting tx_clk failed.\n"); + } + +-static void macb_usx_pcs_link_up(struct phylink_pcs *pcs, unsigned int neg_mode, ++static void macb_usx_pcs_link_up(struct phylink_pcs *pcs, unsigned int mode, + phy_interface_t interface, int speed, + int duplex) + { +@@ -570,10 +585,25 @@ static void macb_usx_pcs_link_up(struct phylink_pcs *pcs, unsigned int neg_mode, + u32 config; + + config = gem_readl(bp, USX_CONTROL); +- config = GEM_BFINS(SERDES_RATE, MACB_SERDES_RATE_10G, config); +- config = GEM_BFINS(USX_CTRL_SPEED, HS_SPEED_10000M, config); ++ if (speed == SPEED_10000) { ++ config = GEM_BFINS(SERDES_RATE, MACB_SERDES_RATE_10G, config); ++ config = GEM_BFINS(USX_CTRL_SPEED, HS_SPEED_10000M, config); ++ } else if (speed == SPEED_5000) { ++ config = GEM_BFINS(SERDES_RATE, MACB_SERDES_RATE_5G, config); ++ config = GEM_BFINS(USX_CTRL_SPEED, HS_SPEED_5000M, config); + } + -+} + config &= ~(GEM_BIT(TX_SCR_BYPASS) | GEM_BIT(RX_SCR_BYPASS)); +- config |= GEM_BIT(TX_EN); ++ /* reset */ ++ config &= ~(GEM_BIT(SIGNAL_OK) | GEM_BIT(TX_EN)); ++ config |= GEM_BIT(RX_SYNC_RESET); + -+#define AZX_FORCE_CODEC_MASK 0x100 ++ gem_writel(bp, USX_CONTROL, config); + -+static void check_probe_mask(struct azx *chip, int dev) -+{ -+ chip->codec_probe_mask = probe_mask[dev]; -+ -+ /* check forced option */ -+ if (chip->codec_probe_mask != -1 && -+ (chip->codec_probe_mask & AZX_FORCE_CODEC_MASK)) { -+ azx_bus(chip)->codec_mask = chip->codec_probe_mask & 0xff; -+ dev_info(chip->card->dev, "codec_mask forced to 0x%x\n", -+ (int)azx_bus(chip)->codec_mask); -+ } -+} ++ /* enable rx and tx */ ++ config &= ~(GEM_BIT(RX_SYNC_RESET)); ++ config |= GEM_BIT(SIGNAL_OK) | GEM_BIT(TX_EN); + -+static void azx_probe_work(struct work_struct *work) -+{ -+ struct hda_ft *hda = container_of(work, struct hda_ft, probe_work); + gem_writel(bp, USX_CONTROL, config); + } + +@@ -583,7 +613,12 @@ static void macb_usx_pcs_get_state(struct phylink_pcs *pcs, + struct macb *bp = container_of(pcs, struct macb, phylink_usx_pcs); + u32 val; + +- state->speed = SPEED_10000; ++ if (state->interface == PHY_INTERFACE_MODE_5GBASER) ++ state->speed = SPEED_5000; ++ else if (state->interface == PHY_INTERFACE_MODE_10GBASER || ++ state->interface == PHY_INTERFACE_MODE_USXGMII) ++ state->speed = bp->speed; + -+ azx_probe_continue(&hda->chip); -+} + state->duplex = 1; + state->an_complete = 1; + +@@ -661,9 +696,12 @@ static void macb_mac_config(struct phylink_config *config, unsigned int mode, + ctrl &= ~(GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL)); + ncr &= ~GEM_BIT(ENABLE_HS_MAC); + +- if (state->interface == PHY_INTERFACE_MODE_SGMII) { ++ if (state->interface == PHY_INTERFACE_MODE_SGMII || ++ state->interface == PHY_INTERFACE_MODE_2500BASEX) { + ctrl |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL); +- } else if (state->interface == PHY_INTERFACE_MODE_10GBASER) { ++ } else if (state->interface == PHY_INTERFACE_MODE_10GBASER || ++ state->interface == PHY_INTERFACE_MODE_USXGMII || ++ state->interface == PHY_INTERFACE_MODE_5GBASER) { + ctrl |= GEM_BIT(PCSSEL); + ncr |= GEM_BIT(ENABLE_HS_MAC); + } else if (bp->caps & MACB_CAPS_MIIONRGMII && +@@ -683,7 +721,8 @@ static void macb_mac_config(struct phylink_config *config, unsigned int mode, + * Must be written after PCSSEL is set in NCFGR, + * otherwise writes will not take effect. + */ +- if (macb_is_gem(bp) && state->interface == PHY_INTERFACE_MODE_SGMII) { ++ if (macb_is_gem(bp) && (state->interface == PHY_INTERFACE_MODE_SGMII || ++ state->interface == PHY_INTERFACE_MODE_2500BASEX)) { + u32 pcsctrl, old_pcsctrl; + + old_pcsctrl = gem_readl(bp, PCSCNTRL); +@@ -703,9 +742,14 @@ static void macb_mac_link_down(struct phylink_config *config, unsigned int mode, + { + struct net_device *ndev = to_net_dev(config->dev); + struct macb *bp = netdev_priv(ndev); ++ struct macb_tx_skb *tx_skb; + struct macb_queue *queue; + unsigned int q; + u32 ctrl; ++ int i; + -+/* -+ * constructor -+ */ -+static const struct hda_controller_ops axi_hda_ops; ++ if (bp->use_ncsi) ++ ncsi_stop_dev(bp->ndev); + + if (!(bp->caps & MACB_CAPS_MACB_IS_EMAC)) + for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) +@@ -713,12 +757,172 @@ static void macb_mac_link_down(struct phylink_config *config, unsigned int mode, + bp->rx_intr_mask | MACB_TX_INT_FLAGS | MACB_BIT(HRESP)); + + /* Disable Rx and Tx */ +- ctrl = macb_readl(bp, NCR) & ~(MACB_BIT(RE) | MACB_BIT(TE)); ++ ctrl = macb_readl(bp, NCR) & ~(MACB_BIT(RE) | ++ MACB_BIT(TE)) & ~(MACB_BIT(2PT5G)); + macb_writel(bp, NCR, ctrl); + ++ /* Tx clean */ ++ for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) { ++ for (i = 0; i < bp->tx_ring_size; i++) { ++ tx_skb = macb_tx_skb(queue, i); ++ /* free unsent skb buffers */ ++ if (tx_skb) ++ macb_tx_unmap(bp, tx_skb, 0); ++ } ++ } + -+static int hda_ft_create(struct snd_card *card, struct platform_device *pdev, -+ int dev, unsigned int driver_caps, -+ struct azx **rchip) + netif_tx_stop_all_queues(ndev); + } + ++static void phytium_gem1p0_sel_clk(struct macb *bp, int speed) +{ -+ static struct snd_device_ops ops = { -+ .dev_disconnect = azx_dev_disconnect, -+ .dev_free = azx_dev_free, -+ }; -+ struct hda_ft *hda; -+ struct azx *chip; -+ int err; -+ -+ *rchip = NULL; -+ -+ hda = devm_kzalloc(&pdev->dev, sizeof(*hda), GFP_KERNEL); -+ if (!hda) -+ return -ENOMEM; -+ hda->dev = &pdev->dev; -+ chip = &hda->chip; -+ mutex_init(&chip->open_mutex); -+ chip->card = card; -+ chip->ops = &axi_hda_ops; -+ chip->driver_caps = driver_caps; -+ chip->driver_type = driver_caps & 0xff; -+ chip->dev_index = dev; -+ if (jackpoll_ms[dev] >= 50 && jackpoll_ms[dev] <= 60000) -+ chip->jackpoll_interval = msecs_to_jiffies(jackpoll_ms[dev]); -+ INIT_LIST_HEAD(&chip->pcm_list); -+ INIT_WORK(&hda->irq_pending_work, azx_irq_pending_work); -+ INIT_LIST_HEAD(&hda->list); -+ -+ init_completion(&hda->probe_wait); -+ assign_position_fix(chip, check_position_fix(chip, position_fix[dev])); -+ check_probe_mask(chip, dev); -+ -+ if (single_cmd < 0) /* allow fallback to single_cmd at errors */ -+ chip->fallback_to_single_cmd = 0; -+ else /* explicitly set to single_cmd or not */ -+ chip->single_cmd = single_cmd; -+ -+ if (bdl_pos_adj[dev] < 0) { -+ switch (chip->driver_type) { -+ case AZX_DRIVER_FT: -+ bdl_pos_adj[dev] = 32; -+ break; -+ default: -+ bdl_pos_adj[dev] = 32; -+ break; ++ if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER || ++ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ if (speed == SPEED_5000) { ++ gem_writel(bp, DIV_SEL0_LN, 0x8); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x0); /*0x1c10*/ ++ } else { ++ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x1); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ ++ } ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ gem_writel(bp, DIV_SEL0_LN, 0x8); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x0); /*0x1c10*/ ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ gem_writel(bp, DIV_SEL0_LN, 0x1); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x2); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x1); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ ++ gem_writel(bp, TX_CLK_SEL3_0, 0x0); /*0x1c70*/ ++ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ ++ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ ++ gem_writel(bp, RX_CLK_SEL4_0, 0x0); /*0x1c7c*/ ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { ++ if (speed == SPEED_1000) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x8); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x0); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ ++ gem_writel(bp, TX_CLK_SEL3_0, 0x0); /*0x1c70*/ ++ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ ++ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ ++ gem_writel(bp, RX_CLK_SEL4_0, 0x0); /*0x1c7c*/ ++ } else if (speed == SPEED_100 || speed == SPEED_10) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ gem_writel(bp, DIV_SEL0_LN, 0x4); /*0x1c08*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x8); /*0x1c0c*/ ++ gem_writel(bp, PMA_XCVR_POWER_STATE, 0x1); /*0x1c10*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x0); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x1); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x1); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x1); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x0); /*0x1c34*/ ++ gem_writel(bp, TX_CLK_SEL3_0, 0x1); /*0x1c70*/ ++ gem_writel(bp, TX_CLK_SEL4_0, 0x0); /*0x1c74*/ ++ gem_writel(bp, RX_CLK_SEL3_0, 0x0); /*0x1c78*/ ++ gem_writel(bp, RX_CLK_SEL4_0, 0x1); /*0x1c7c*/ ++ } ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_RGMII || ++ bp->phy_interface == PHY_INTERFACE_MODE_RGMII_ID) { ++ if (speed == SPEED_1000) { ++ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ ++ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ ++ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x0); /*0x1c38*/ ++ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x1); /*0x1c80*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ ++ } else if (speed == SPEED_100) { ++ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ ++ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ ++ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x0); /*0x1c38*/ ++ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x0); /*0x1c80*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ ++ } else { ++ gem_writel(bp, MII_SELECT, 0x1); /*0x1c18*/ ++ gem_writel(bp, SEL_MII_ON_RGMII, 0x0); /*0x1c1c*/ ++ gem_writel(bp, TX_CLK_SEL0, 0x0); /*0x1c20*/ ++ gem_writel(bp, TX_CLK_SEL1, 0x1); /*0x1c24*/ ++ gem_writel(bp, TX_CLK_SEL2, 0x0); /*0x1c28*/ ++ gem_writel(bp, TX_CLK_SEL3, 0x0); /*0x1c2c*/ ++ gem_writel(bp, RX_CLK_SEL0, 0x0); /*0x1c30*/ ++ gem_writel(bp, RX_CLK_SEL1, 0x1); /*0x1c34*/ ++ gem_writel(bp, CLK_250M_DIV10_DIV100_SEL, 0x1); /*0x1c38*/ ++ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL0, 0x0); /*0x1c80*/ ++ gem_writel(bp, RGMII_TX_CLK_SEL1, 0x0); /*0x1c84*/ + } ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_RMII) { ++ gem_writel(bp, RX_CLK_SEL5, 0x1); /*0x1c48*/ + } -+ chip->bdl_pos_adj = bdl_pos_adj[dev]; -+ -+ err = azx_bus_init(chip, model[dev]); -+ if (err < 0) { -+ return err; -+ } -+ -+ chip->bus.core.aligned_mmio = 1; -+ -+ err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops); -+ if (err < 0) { -+ dev_err(card->dev, "Error creating device [card]!\n"); -+ azx_free(chip); -+ return err; -+ } -+ -+ /* continue probing in work context as may trigger request module */ -+ INIT_WORK(&hda->probe_work, azx_probe_work); + -+ *rchip = chip; -+ -+ return 0; ++ if (speed == SPEED_100) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_100M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_1000) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_1000M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_2500) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_2500M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_5000) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_10000) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_10000M, ++ gem_readl(bp, HS_MAC_CONFIG))); +} + -+static int azx_first_init(struct azx *chip) ++static void phytium_gem2p0_sel_clk(struct macb *bp, int speed) +{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ struct platform_device *pdev = to_platform_device(hda->dev); -+ struct device *hddev = hda->dev; ++ if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { ++ if (speed == SPEED_100 || speed == SPEED_10) { ++ gem_writel(bp, SRC_SEL_LN, 0x1); /*0x1c04*/ ++ gem_writel(bp, DIV_SEL1_LN, 0x1); /*0x1c0c*/ ++ } ++ } + -+ int dev = chip->dev_index; -+ bool full_reset; ++ if (speed == SPEED_100 || speed == SPEED_10) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_100M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_1000) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_1000M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ else if (speed == SPEED_2500) ++ gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_2500M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++} + -+ struct snd_card *card = chip->card; -+ struct hdac_bus *bus = azx_bus(chip); + static void macb_mac_link_up(struct phylink_config *config, + struct phy_device *phy, + unsigned int mode, phy_interface_t interface, +@@ -731,9 +935,13 @@ static void macb_mac_link_up(struct phylink_config *config, + unsigned long flags; + unsigned int q; + u32 ctrl; + int err; -+ unsigned short gcap; -+ unsigned int dma_bits = 64; -+ -+ struct resource *res; -+ const struct acpi_device_id *match; -+ -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ hda->regs = devm_ioremap_resource(hddev, res); -+ if (IS_ERR(hda->regs)) -+ return PTR_ERR(hda->regs); -+ -+ bus->addr = res->start; -+ bus->remap_addr = hda->regs; -+ if (bus->remap_addr == NULL) { -+ dev_err(card->dev, "ioremap error\n"); -+ return -ENXIO; -+ } -+ -+ bus->cmd_resend = 1; + + spin_lock_irqsave(&bp->lock, flags); + ++ if (bp->caps & MACB_CAPS_SEL_CLK) ++ bp->sel_clk_hw(bp, speed); + -+ synchronize_irq(bus->irq); + ctrl = macb_or_gem_readl(bp, NCFGR); + + ctrl &= ~(MACB_BIT(SPD) | MACB_BIT(FD)); +@@ -749,13 +957,15 @@ static void macb_mac_link_up(struct phylink_config *config, + if (macb_is_gem(bp)) { + ctrl &= ~GEM_BIT(GBE); + +- if (speed == SPEED_1000) ++ if (speed == SPEED_1000 || speed == SPEED_2500) + ctrl |= GEM_BIT(GBE); + } + + if (rx_pause) + ctrl |= MACB_BIT(PAE); + ++ macb_set_tx_clk(bp, speed); + -+ gcap = azx_readw(chip, GCAP); -+ dev_dbg(card->dev, "chipset global capabilities = 0x%x\n", gcap); + /* Initialize rings & buffers as clearing MACB_BIT(TE) in link down + * cleared the pipeline and control registers. + */ +@@ -769,9 +979,28 @@ static void macb_mac_link_up(struct phylink_config *config, + + macb_or_gem_writel(bp, NCFGR, ctrl); + +- if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER) +- gem_writel(bp, HS_MAC_CONFIG, GEM_BFINS(HS_MAC_SPEED, HS_SPEED_10000M, +- gem_readl(bp, HS_MAC_CONFIG))); ++ if (speed == SPEED_2500) { ++ u32 network_ctrl; + -+ /* disable 64bit DMA address on some devices */ -+ if (chip->driver_caps & AZX_DCAPS_NO_64BIT) { -+ dev_dbg(card->dev, "Disabling 64bit DMA\n"); -+ gcap &= ~AZX_GCAP_64OK; ++ network_ctrl = macb_readl(bp, NCR); ++ network_ctrl |= MACB_BIT(2PT5G); ++ macb_writel(bp, NCR, network_ctrl); + } + -+ /* disable buffer size rounding to 128-byte multiples if supported */ -+ if (align_buffer_size >= 0) -+ chip->align_buffer_size = !!align_buffer_size; -+ else { -+ if (chip->driver_caps & AZX_DCAPS_NO_ALIGN_BUFSIZE) -+ chip->align_buffer_size = 0; ++ if (bp->phy_interface == PHY_INTERFACE_MODE_10GBASER || ++ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { ++ if (speed == SPEED_5000) ++ gem_writel(bp, HS_MAC_CONFIG, ++ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, ++ gem_readl(bp, HS_MAC_CONFIG))); + else -+ chip->align_buffer_size = 1; -+ } -+ -+ if (has_acpi_companion(hddev)) { -+ match = acpi_match_device(hddev->driver->acpi_match_table, hddev); -+ if (!match) { -+ dev_err(hddev, "Error ACPI match data is missing\n"); -+ return -ENODEV; ++ gem_writel(bp, HS_MAC_CONFIG, ++ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_10000M, ++ gem_readl(bp, HS_MAC_CONFIG))); ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) ++ gem_writel(bp, HS_MAC_CONFIG, ++ GEM_BFINS(HS_MAC_SPEED, HS_SPEED_5000M, ++ gem_readl(bp, HS_MAC_CONFIG))); + + spin_unlock_irqrestore(&bp->lock, flags); + +@@ -785,6 +1014,15 @@ static void macb_mac_link_up(struct phylink_config *config, + + macb_writel(bp, NCR, ctrl | MACB_BIT(RE) | MACB_BIT(TE)); + ++ if (bp->use_ncsi) { ++ /* Start the NCSI device */ ++ err = ncsi_start_dev(bp->ndev); ++ if (err) { ++ netdev_err(bp->dev, "Ncsi start dev failed (error %d)\n", err); ++ return; + } -+ set_dma_ops(hddev, NULL); -+ acpi_dma_configure(hddev, DEV_DMA_NON_COHERENT); + } + -+ /* allow 64bit DMA address if supported by H/W */ -+ if (!(gcap & AZX_GCAP_64OK)) -+ dma_bits = 32; -+ if (!dma_set_mask(hddev, DMA_BIT_MASK(dma_bits))) { -+ dma_set_coherent_mask(hddev, DMA_BIT_MASK(dma_bits)); + netif_tx_wake_all_queues(ndev); + } + +@@ -794,12 +1032,16 @@ static struct phylink_pcs *macb_mac_select_pcs(struct phylink_config *config, + struct net_device *ndev = to_net_dev(config->dev); + struct macb *bp = netdev_priv(ndev); + +- if (interface == PHY_INTERFACE_MODE_10GBASER) ++ if (interface == PHY_INTERFACE_MODE_10GBASER || ++ interface == PHY_INTERFACE_MODE_5GBASER || ++ interface == PHY_INTERFACE_MODE_USXGMII) { + return &bp->phylink_usx_pcs; +- else if (interface == PHY_INTERFACE_MODE_SGMII) ++ } else if (interface == PHY_INTERFACE_MODE_SGMII || ++ interface == PHY_INTERFACE_MODE_2500BASEX) { + return &bp->phylink_sgmii_pcs; +- else + } else { -+ dma_set_mask(hddev, DMA_BIT_MASK(32)); -+ dma_set_coherent_mask(hddev, DMA_BIT_MASK(32)); -+ } -+ -+ /* read number of streams from GCAP register instead of using -+ * hardcoded value -+ */ -+ chip->capture_streams = (gcap >> 8) & 0x0f; -+ chip->playback_streams = (gcap >> 12) & 0x0f; -+ if (!chip->playback_streams && !chip->capture_streams) { -+ /* gcap didn't give any info, switching to old method */ -+ chip->playback_streams = FT4C_NUM_PLAYBACK; -+ chip->capture_streams = FT4C_NUM_CAPTURE; + return NULL; + } -+ chip->capture_index_offset = 0; -+ chip->playback_index_offset = chip->capture_streams; -+ chip->num_streams = chip->playback_streams + chip->capture_streams; -+ -+ /* initialize streams */ -+ err = azx_init_streams(chip); -+ if (err < 0) -+ return err; + } + + static const struct phylink_mac_ops macb_phylink_ops = { +@@ -821,7 +1063,7 @@ static int macb_phylink_connect(struct macb *bp) + struct device_node *dn = bp->pdev->dev.of_node; + struct net_device *dev = bp->dev; + struct phy_device *phydev; +- int ret; ++ int ret = 0; + + if (dn) + ret = phylink_of_phy_connect(bp->phylink, dn, 0); +@@ -834,7 +1076,8 @@ static int macb_phylink_connect(struct macb *bp) + } + + /* attach the mac to the phy */ +- ret = phylink_connect_phy(bp->phylink, phydev); ++ if (phylink_expects_phy(bp->phylink)) ++ ret = phylink_connect_phy(bp->phylink, phydev); + } + + if (ret) { +@@ -856,6 +1099,20 @@ static void macb_get_pcs_fixed_state(struct phylink_config *config, + state->link = (macb_readl(bp, NSR) & MACB_BIT(NSR_LINK)) != 0; + } + ++static void macb_get_usx_pcs_fixed_state(struct phylink_config *config, ++ struct phylink_link_state *state) ++{ ++ u32 val; ++ struct net_device *ndev = to_net_dev(config->dev); ++ struct macb *bp = netdev_priv(ndev); + -+ err = azx_alloc_stream_pages(chip); -+ if (err < 0) -+ return err; ++ val = gem_readl(bp, USX_STATUS); ++ state->link = !!(val & GEM_BIT(USX_BLOCK_LOCK)); ++ val = gem_readl(bp, NCFGR); ++ if (val & GEM_BIT(PAE)) ++ state->pause = MLO_PAUSE_RX; ++} + -+ full_reset = (probe_only[dev] & 2) ? false : true; -+ azx_init_chip(chip, full_reset); + /* based on au1000_eth. c*/ + static int macb_mii_probe(struct net_device *dev) + { +@@ -873,6 +1130,10 @@ static int macb_mii_probe(struct net_device *dev) + if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { + bp->phylink_config.poll_fixed_state = true; + bp->phylink_config.get_fixed_state = macb_get_pcs_fixed_state; ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX || ++ bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { ++ bp->phylink_config.poll_fixed_state = true; ++ bp->phylink_config.get_fixed_state = macb_get_usx_pcs_fixed_state; + } + + bp->phylink_config.mac_capabilities = MAC_ASYM_PAUSE | +@@ -900,10 +1161,18 @@ static int macb_mii_probe(struct net_device *dev) + if (bp->caps & MACB_CAPS_HIGH_SPEED) { + __set_bit(PHY_INTERFACE_MODE_10GBASER, + bp->phylink_config.supported_interfaces); ++ __set_bit(PHY_INTERFACE_MODE_USXGMII, ++ bp->phylink_config.supported_interfaces); + bp->phylink_config.mac_capabilities |= MAC_10000FD; + } + } + ++ if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII || ++ bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { ++ bp->phylink_config.poll_fixed_state = true; ++ bp->phylink_config.get_fixed_state = macb_get_pcs_fixed_state; ++ } + -+ /* codec detection */ -+ if (!azx_bus(chip)->codec_mask) { -+ dev_err(card->dev, "no codecs found!\n"); -+ return -ENODEV; + bp->phylink = phylink_create(&bp->phylink_config, bp->pdev->dev.fwnode, + bp->phy_interface, &macb_phylink_ops); + if (IS_ERR(bp->phylink)) { +@@ -1316,6 +1585,7 @@ static void gem_rx_refill(struct macb_queue *queue) + /* Make hw descriptor updates visible to CPU */ + rmb(); + ++ queue->rx_prepared_head++; + desc = macb_rx_desc(queue, entry); + + if (!queue->rx_skbuff[entry]) { +@@ -1354,7 +1624,6 @@ static void gem_rx_refill(struct macb_queue *queue) + dma_wmb(); + desc->addr &= ~MACB_BIT(RX_USED); + } +- queue->rx_prepared_head++; + } + + /* Make descriptor updates visible to hardware */ +@@ -2473,27 +2742,48 @@ static void macb_free_rx_buffers(struct macb *bp) + + static void macb_free_consistent(struct macb *bp) + { ++ struct macb_dma_desc *tx_ring_base = NULL; ++ struct macb_dma_desc *rx_ring_base = NULL; ++ dma_addr_t tx_ring_base_addr; ++ dma_addr_t rx_ring_base_addr; + struct macb_queue *queue; + unsigned int q; + int size; + + bp->macbgem_ops.mog_free_rx_buffers(bp); + ++ queue = bp->queues; ++ if (queue->tx_ring) { ++ tx_ring_base = queue->tx_ring; ++ tx_ring_base_addr = queue->tx_ring_dma; + } -+ -+ if (azx_acquire_irq(chip, 0) < 0) -+ return -EBUSY; -+ -+ strscpy(card->driver, "ft-hda", sizeof(card->driver)); -+ strscpy(card->shortname, "ft-hda", sizeof(card->shortname)); -+ snprintf(card->longname, sizeof(card->longname), -+ "%s at 0x%lx irq %i", -+ card->shortname, bus->addr, bus->irq); -+ -+ return 0; -+} -+ -+ -+static const struct hda_controller_ops axi_hda_ops = { -+ .position_check = azx_position_check, -+ .link_power = azx_ft_link_power, -+}; -+ -+static DECLARE_BITMAP(probed_devs, SNDRV_CARDS); -+ -+static int hda_ft_probe(struct platform_device *pdev) -+{ -+ const unsigned int driver_flags = AZX_DRIVER_FT; -+ struct snd_card *card; -+ struct hda_ft *hda; -+ struct azx *chip; -+ bool schedule_probe; -+ int err; -+ int dev; -+ -+ dev = find_first_zero_bit(probed_devs, SNDRV_CARDS); -+ -+ if (dev >= SNDRV_CARDS) -+ return -ENODEV; -+ if (!enable[dev]) { -+ set_bit(dev, probed_devs); -+ return -ENOENT; ++ if (queue->rx_ring) { ++ rx_ring_base = queue->rx_ring; ++ rx_ring_base_addr = queue->rx_ring_dma; + } + -+ err = snd_card_new(&pdev->dev, index[dev], id[dev], THIS_MODULE, -+ 0, &card); -+ if (err < 0) { -+ dev_err(&pdev->dev, "Error creating card!\n"); -+ return err; + for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) { + kfree(queue->tx_skb); + queue->tx_skb = NULL; +- if (queue->tx_ring) { +- size = TX_RING_BYTES(bp) + bp->tx_bd_rd_prefetch; +- dma_free_coherent(&bp->pdev->dev, size, +- queue->tx_ring, queue->tx_ring_dma); ++ if (queue->tx_ring) + queue->tx_ring = NULL; +- } +- if (queue->rx_ring) { +- size = RX_RING_BYTES(bp) + bp->rx_bd_rd_prefetch; +- dma_free_coherent(&bp->pdev->dev, size, +- queue->rx_ring, queue->rx_ring_dma); ++ if (queue->rx_ring) + queue->rx_ring = NULL; +- } + } + -+ err = hda_ft_create(card, pdev, dev, driver_flags, &chip); -+ if (err < 0) -+ goto out_free; -+ card->private_data = chip; -+ hda = container_of(chip, struct hda_ft, chip); -+ -+ dev_set_drvdata(&pdev->dev, card); -+ -+ schedule_probe = !chip->disabled; -+ -+ if (schedule_probe) -+ schedule_work(&hda->probe_work); -+ -+ set_bit(dev, probed_devs); -+ if (chip->disabled) -+ complete_all(&hda->probe_wait); -+ return 0; -+ -+out_free: -+ snd_card_free(card); -+ return err; -+} -+ -+/* number of codec slots for each chipset: 0 = default slots (i.e. 4) */ -+static unsigned int azx_max_codecs[AZX_NUM_DRIVERS] = { -+ [AZX_DRIVER_FT] = 4, -+}; -+ -+static int azx_probe_continue(struct azx *chip) -+{ -+ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); -+ struct device *hddev = hda->dev; -+ int dev = chip->dev_index; -+ int err; -+ struct hdac_bus *bus = azx_bus(chip); -+ -+ hda->probe_continued = 1; -+ -+ err = azx_first_init(chip); -+ if (err < 0) -+ goto out_free; -+ -+#ifdef CONFIG_SND_HDA_INPUT_BEEP -+ chip->beep_mode = beep_mode[dev]; -+#endif -+ -+ /* create codec instances */ -+ err = azx_probe_codecs(chip, azx_max_codecs[chip->driver_type]); -+ if (err < 0) -+ goto out_free; -+ -+ if ((probe_only[dev] & 1) == 0) { -+ err = azx_codec_configure(chip); -+ if (err < 0) -+ goto out_free; ++ if (tx_ring_base) { ++ size = bp->num_queues * (TX_RING_BYTES(bp) + ++ bp->tx_bd_rd_prefetch + ++ RING_ADDR_INTERVAL); ++ dma_free_coherent(&bp->pdev->dev, size, tx_ring_base, ++ tx_ring_base_addr); + } ++ if (rx_ring_base) { ++ size = bp->num_queues * (RX_RING_BYTES(bp) + ++ bp->rx_bd_rd_prefetch + ++ RING_ADDR_INTERVAL); ++ dma_free_coherent(&bp->pdev->dev, size, rx_ring_base, ++ rx_ring_base_addr); + } + } + +@@ -2533,17 +2823,87 @@ static int macb_alloc_rx_buffers(struct macb *bp) + return 0; + } + ++static int macb_queue_phyaddr_check(struct macb *bp, dma_addr_t ring_base_addr, ++ int offset) ++{ ++ u32 bus_addr_high; ++ int i; + -+ err = snd_card_register(chip->card); -+ if (err < 0) -+ goto out_free; -+ -+ chip->running = 1; -+ azx_add_card_list(chip); -+ snd_hda_set_power_save(&chip->bus, power_save * 1000); -+ -+ if (azx_has_pm_runtime(chip)) -+ pm_runtime_put_noidle(hddev); -+ return err; -+ -+out_free: -+ if (bus->irq >= 0) { -+ free_irq(bus->irq, (void *)chip); -+ bus->irq = -1; ++ bus_addr_high = upper_32_bits(ring_base_addr); ++ for (i = 1; i < bp->num_queues; i++) { ++ ring_base_addr += offset; ++ if (bus_addr_high != upper_32_bits(ring_base_addr)) ++ return -1; + } -+ return err; -+} + -+static int hda_ft_remove(struct platform_device *pdev) -+{ -+ struct snd_card *card = dev_get_drvdata(&pdev->dev); -+ struct azx *chip; -+ struct hda_ft *hda; -+ -+ if (card) { -+ /* cancel the pending probing work */ -+ chip = card->private_data; -+ hda = container_of(chip, struct hda_ft, chip); -+ cancel_work_sync(&hda->probe_work); -+ clear_bit(chip->dev_index, probed_devs); -+ -+ snd_card_free(card); -+ return 0; -+ } + return 0; +} + -+static void hda_ft_shutdown(struct platform_device *pdev) -+{ -+ struct snd_card *card = dev_get_drvdata(&pdev->dev); -+ struct azx *chip; -+ -+ if (!card) -+ return; -+ chip = card->private_data; -+ if (chip && chip->running) -+ azx_stop_chip(chip); -+} -+ -+static const struct of_device_id hda_ft_of_match[] = { -+ { .compatible = "phytium,hda" }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, hda_ft_of_match); -+ -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id hda_ft_acpi_match[] = { -+ { .id = "PHYT0006" }, -+ {} -+}; -+MODULE_DEVICE_TABLE(acpi, hda_ft_acpi_match); -+#else -+#define hda_ft_acpi_match NULL -+#endif -+ -+static struct platform_driver ft_platform_hda = { -+ .driver = { -+ .name = "ft-hda", -+ .pm = hda_ft_pm, -+ .of_match_table = hda_ft_of_match, -+ .acpi_match_table = hda_ft_acpi_match, -+ }, -+ .probe = hda_ft_probe, -+ .remove = hda_ft_remove, -+ .shutdown = hda_ft_shutdown, -+}; -+ -+module_platform_driver(ft_platform_hda); -+ -+MODULE_DESCRIPTION("FT HDA bus driver"); -+MODULE_LICENSE("GPL"); -diff --git a/sound/pci/hda/hda_phytium.h b/sound/pci/hda/hda_phytium.h -new file mode 100644 -index 000000000..ec1f3e7f7 ---- /dev/null -+++ b/sound/pci/hda/hda_phytium.h -@@ -0,0 +1,34 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Implementation of primary ALSA driver code base for Phytium HD Audio. -+ * -+ * Copyright (c) 2018-2024 Phytium Technology Co., Ltd. -+ */ -+#ifndef __SOUND_HDA_PHYTIUM_H__ -+#define __SOUND_HDA_PHYTIUM_H__ -+ -+#include "hda_controller.h" -+ -+struct hda_ft { -+ struct azx chip; -+ struct snd_pcm_substream *substream; -+ struct device *dev; -+ void __iomem *regs; -+ -+ /* for pending irqs */ -+ struct work_struct irq_pending_work; -+ -+ /* sync probing */ -+ struct completion probe_wait; -+ struct work_struct probe_work; -+ -+ /* card list (for power_save trigger) */ -+ struct list_head list; -+ -+ /* extra flags */ -+ unsigned int irq_pending_warned:1; -+ unsigned int probe_continued:1; -+ -+}; -+ -+#endif -diff --git a/sound/soc/Kconfig b/sound/soc/Kconfig -index 439fa631c..e70e61755 100644 ---- a/sound/soc/Kconfig -+++ b/sound/soc/Kconfig -@@ -96,6 +96,7 @@ source "sound/soc/intel/Kconfig" - source "sound/soc/mediatek/Kconfig" - source "sound/soc/meson/Kconfig" - source "sound/soc/mxs/Kconfig" -+source "sound/soc/phytium/Kconfig" - source "sound/soc/pxa/Kconfig" - source "sound/soc/qcom/Kconfig" - source "sound/soc/rockchip/Kconfig" -diff --git a/sound/soc/Makefile b/sound/soc/Makefile -index 8376fdb21..9b39526bf 100644 ---- a/sound/soc/Makefile -+++ b/sound/soc/Makefile -@@ -53,6 +53,7 @@ obj-$(CONFIG_SND_SOC) += mediatek/ - obj-$(CONFIG_SND_SOC) += meson/ - obj-$(CONFIG_SND_SOC) += mxs/ - obj-$(CONFIG_SND_SOC) += kirkwood/ -+obj-$(CONFIG_SND_SOC) += phytium/ - obj-$(CONFIG_SND_SOC) += pxa/ - obj-$(CONFIG_SND_SOC) += qcom/ - obj-$(CONFIG_SND_SOC) += rockchip/ -diff --git a/sound/soc/codecs/Kconfig b/sound/soc/codecs/Kconfig -index f1e1dbc50..1de59b63a 100644 ---- a/sound/soc/codecs/Kconfig -+++ b/sound/soc/codecs/Kconfig -@@ -1071,6 +1071,15 @@ config SND_SOC_ES8328_SPI - depends on SPI_MASTER - select SND_SOC_ES8328 - -+config SND_SOC_ES8336 -+ tristate "Everest Semi ES8336 CODEC" -+ depends on I2C -+ select GPIO_PHYTIUM_PCI -+ -+config SND_SOC_ES8388 -+ tristate "Everest Semi ES8388 CODEC" -+ depends on I2C -+ - config SND_SOC_GTM601 - tristate 'GTM601 UMTS modem audio codec' + static int macb_alloc_consistent(struct macb *bp) + { ++ struct macb_dma_desc *tx_ring_base, *rx_ring_base; ++ dma_addr_t tx_ring_base_addr, rx_ring_base_addr; + struct macb_queue *queue; ++ int tx_offset, rx_offset; ++ int tx_size, rx_size; + unsigned int q; ++ int ret, i; + int size; -diff --git a/sound/soc/codecs/Makefile b/sound/soc/codecs/Makefile -index a87e56938..7dc577a72 100644 ---- a/sound/soc/codecs/Makefile -+++ b/sound/soc/codecs/Makefile -@@ -119,6 +119,8 @@ snd-soc-es8326-objs := es8326.o - snd-soc-es8328-objs := es8328.o - snd-soc-es8328-i2c-objs := es8328-i2c.o - snd-soc-es8328-spi-objs := es8328-spi.o -+snd-soc-es8336-objs := es8336.o -+snd-soc-es8388-objs := es8388.o - snd-soc-gtm601-objs := gtm601.o - snd-soc-hdac-hdmi-objs := hdac_hdmi.o - snd-soc-hdac-hda-objs := hdac_hda.o -@@ -505,6 +507,8 @@ obj-$(CONFIG_SND_SOC_ES8326) += snd-soc-es8326.o - obj-$(CONFIG_SND_SOC_ES8328) += snd-soc-es8328.o - obj-$(CONFIG_SND_SOC_ES8328_I2C)+= snd-soc-es8328-i2c.o - obj-$(CONFIG_SND_SOC_ES8328_SPI)+= snd-soc-es8328-spi.o -+obj-$(CONFIG_SND_SOC_ES8336)+= snd-soc-es8336.o -+obj-$(CONFIG_SND_SOC_ES8388) += snd-soc-es8388.o - obj-$(CONFIG_SND_SOC_GTM601) += snd-soc-gtm601.o - obj-$(CONFIG_SND_SOC_HDAC_HDMI) += snd-soc-hdac-hdmi.o - obj-$(CONFIG_SND_SOC_HDAC_HDA) += snd-soc-hdac-hda.o -diff --git a/sound/soc/codecs/es8336.c b/sound/soc/codecs/es8336.c -new file mode 100644 -index 000000000..2d666ab28 ---- /dev/null -+++ b/sound/soc/codecs/es8336.c -@@ -0,0 +1,1073 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * es8336 ALSA SoC audio driver -+ * -+ * Copyright (C) Everest Semiconductor Co.,Ltd -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "es8336.h" -+#define ES8336_MUTE (1 << 5) -+ -+static struct snd_soc_component *es8336_component; -+ -+static const struct reg_default es8336_reg_defaults[] = { -+ {0x00, 0x03}, {0x01, 0x03}, {0x02, 0x00}, {0x03, 0x20}, -+ {0x04, 0x11}, {0x05, 0x00}, {0x06, 0x11}, {0x07, 0x00}, -+ {0x08, 0x00}, {0x09, 0x01}, {0x0a, 0x00}, {0x0b, 0x00}, -+ {0x0c, 0xf8}, {0x0d, 0x3f}, {0x0e, 0x00}, {0x0f, 0x00}, -+ {0x10, 0x01}, {0x11, 0xfc}, {0x12, 0x28}, {0x13, 0x00}, -+ {0x14, 0x00}, {0x15, 0x33}, {0x16, 0x00}, {0x17, 0x00}, -+ {0x18, 0x88}, {0x19, 0x06}, {0x1a, 0x22}, {0x1b, 0x03}, -+ {0x1c, 0x0f}, {0x1d, 0x00}, {0x1e, 0x80}, {0x1f, 0x80}, -+ {0x20, 0x00}, {0x21, 0x00}, {0x22, 0xc0}, {0x23, 0x00}, -+ {0x24, 0x01}, {0x25, 0x08}, {0x26, 0x10}, {0x27, 0xc0}, -+ {0x28, 0x00}, {0x29, 0x1c}, {0x2a, 0x00}, {0x2b, 0xb0}, -+ {0x2c, 0x32}, {0x2d, 0x03}, {0x2e, 0x00}, {0x2f, 0x11}, -+ {0x30, 0x10}, {0x31, 0x00}, {0x32, 0x00}, {0x33, 0xc0}, -+ {0x34, 0xc0}, {0x35, 0x1f}, {0x36, 0xf7}, {0x37, 0xfd}, -+ {0x38, 0xff}, {0x39, 0x1f}, {0x3a, 0xf7}, {0x3b, 0xfd}, -+ {0x3c, 0xff}, {0x3d, 0x1f}, {0x3e, 0xf7}, {0x3f, 0xfd}, -+ {0x40, 0xff}, {0x41, 0x1f}, {0x42, 0xf7}, {0x43, 0xfd}, -+ {0x44, 0xff}, {0x45, 0x1f}, {0x46, 0xf7}, {0x47, 0xfd}, -+ {0x48, 0xff}, {0x49, 0x1f}, {0x4a, 0xf7}, {0x4b, 0xfd}, -+ {0x4c, 0xff}, {0x4d, 0x00}, {0x4e, 0x00}, {0x4f, 0xff}, -+ {0x50, 0x00}, {0x51, 0x00}, {0x52, 0x00}, {0x53, 0x00}, -+}; -+ -+/* codec private data */ -+struct es8336_priv { -+ struct regmap *regmap; -+ unsigned int dmic_amic; -+ unsigned int sysclk; -+ struct snd_pcm_hw_constraint_list *sysclk_constraints; -+ struct clk *mclk; -+ int debounce_time; -+ struct delayed_work work; -+ -+ struct gpio_desc *spk_ctl_gpio; -+ struct gpio_desc *hp_det_gpio; -+ bool muted; -+ bool hp_inserted; -+ bool spk_active_level; -+ u8 mic_src; -+ int pwr_count; -+}; -+ -+/* -+ * es8336_reset -+ * write value 0xff to reg0x00, the chip will be in reset mode -+ * then, writer 0x00 to reg0x00, unreset the chip -+ */ -+static int es8336_reset(struct snd_soc_component *component) -+{ -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0x3F); -+ usleep_range(5000, 5500); -+ return snd_soc_component_write(component, ES8336_RESET_REG00, 0x03); -+} -+ -+static void es8336_enable_spk(struct es8336_priv *es8336, bool enable) -+{ -+ bool level; -+ level = enable ? es8336->spk_active_level : !es8336->spk_active_level; -+ gpiod_set_value(es8336->spk_ctl_gpio, level); -+} -+ -+static const DECLARE_TLV_DB_SCALE(dac_vol_tlv, -9600, 50, 1); -+static const DECLARE_TLV_DB_SCALE(adc_vol_tlv, -9600, 50, 1); -+static const DECLARE_TLV_DB_SCALE(hpmixer_gain_tlv, -1200, 150, 0); -+static const DECLARE_TLV_DB_SCALE(mic_bst_tlv, 0, 1200, 0); -+ -+static unsigned int linin_pga_tlv[] = { -+ TLV_DB_RANGE_HEAD(9), -+ 0, 0, TLV_DB_SCALE_ITEM(0, 0, 0), -+ 1, 1, TLV_DB_SCALE_ITEM(300, 0, 0), -+ 2, 2, TLV_DB_SCALE_ITEM(600, 0, 0), -+ 3, 3, TLV_DB_SCALE_ITEM(900, 0, 0), -+ 4, 4, TLV_DB_SCALE_ITEM(1200, 0, 0), -+ 5, 5, TLV_DB_SCALE_ITEM(1500, 0, 0), -+ 6, 6, TLV_DB_SCALE_ITEM(1800, 0, 0), -+ 7, 7, TLV_DB_SCALE_ITEM(2100, 0, 0), -+ 8, 8, TLV_DB_SCALE_ITEM(2400, 0, 0), -+}; -+ -+static unsigned int hpout_vol_tlv[] = { -+ TLV_DB_RANGE_HEAD(1), -+ 0, 3, TLV_DB_SCALE_ITEM(-4800, 1200, 0), -+}; -+ -+static const char *const alc_func_txt[] = { "Off", "On" }; -+ -+static const struct soc_enum alc_func = -+ SOC_ENUM_SINGLE(ES8336_ADC_ALC1_REG29, 6, 2, alc_func_txt); -+ -+static const char *const ng_type_txt[] = { -+ "Constant PGA Gain", "Mute ADC Output" }; -+ -+static const struct soc_enum ng_type = -+ SOC_ENUM_SINGLE(ES8336_ADC_ALC6_REG2E, 6, 2, ng_type_txt); -+ -+static const char *const adcpol_txt[] = { "Normal", "Invert" }; -+ -+static const struct soc_enum adcpol = -+ SOC_ENUM_SINGLE(ES8336_ADC_MUTE_REG26, 1, 2, adcpol_txt); -+ -+static const char *const dacpol_txt[] = { -+ "Normal", "R Invert", "L Invert", "L + R Invert" }; -+ -+static const struct soc_enum dacpol = -+ SOC_ENUM_SINGLE(ES8336_DAC_SET1_REG30, 0, 4, dacpol_txt); -+ -+static const struct snd_kcontrol_new es8336_snd_controls[] = { -+ /* HP OUT VOLUME */ -+ SOC_DOUBLE_TLV("HP Playback Volume", ES8336_CPHP_ICAL_VOL_REG18, -+ 4, 0, 4, 1, hpout_vol_tlv), -+ /* HPMIXER VOLUME Control */ -+ SOC_DOUBLE_TLV("HPMixer Gain", ES8336_HPMIX_VOL_REG16, -+ 0, 4, 7, 0, hpmixer_gain_tlv), -+ -+ /* DAC Digital controls */ -+ SOC_DOUBLE_R_TLV("DAC Playback Volume", ES8336_DAC_VOLL_REG33, -+ ES8336_DAC_VOLR_REG34, 0, 0xC0, 1, dac_vol_tlv), -+ -+ SOC_SINGLE("Enable DAC Soft Ramp", ES8336_DAC_SET1_REG30, 4, 1, 1), -+ SOC_SINGLE("DAC Soft Ramp Rate", ES8336_DAC_SET1_REG30, 2, 4, 0), -+ -+ SOC_ENUM("Playback Polarity", dacpol), -+ SOC_SINGLE("DAC Notch Filter", ES8336_DAC_SET2_REG31, 6, 1, 0), -+ SOC_SINGLE("DAC Double Fs Mode", ES8336_DAC_SET2_REG31, 7, 1, 0), -+ SOC_SINGLE("DAC Volume Control-LeR", ES8336_DAC_SET2_REG31, 2, 1, 0), -+ SOC_SINGLE("DAC Stereo Enhancement", ES8336_DAC_SET3_REG32, 0, 7, 0), -+ -+ /* +20dB D2SE PGA Control */ -+ SOC_SINGLE_TLV("MIC Boost", ES8336_ADC_D2SEPGA_REG24, -+ 0, 1, 0, mic_bst_tlv), -+ /* 0-+24dB Lineinput PGA Control */ -+ SOC_SINGLE_TLV("Input PGA", ES8336_ADC_PGAGAIN_REG23, -+ 4, 8, 0, linin_pga_tlv), -+}; -+ -+/* Analog Input MUX */ -+static const char * const es8336_analog_in_txt[] = { -+ "lin1-rin1", -+ "lin2-rin2", -+ "lin1-rin1 with 15db Boost", -+ "lin2-rin2 with 15db Boost" -+}; -+ -+static const unsigned int es8336_analog_in_values[] = { 0, 1, 2, 3 }; -+ -+static const struct soc_enum es8336_analog_input_enum = -+ SOC_VALUE_ENUM_SINGLE(ES8336_ADC_PDN_LINSEL_REG22, 4, 3, -+ ARRAY_SIZE(es8336_analog_in_txt), -+ es8336_analog_in_txt, -+ es8336_analog_in_values); -+ -+static const struct snd_kcontrol_new es8336_analog_in_mux_controls = -+ SOC_DAPM_ENUM("Route", es8336_analog_input_enum); -+ -+/* Dmic MUX */ -+static const char * const es8336_dmic_txt[] = { -+ "dmic disable", -+ "dmic data at high level", -+ "dmic data at low level", -+}; -+ -+static const unsigned int es8336_dmic_values[] = { 0, 2, 3 }; -+ -+static const struct soc_enum es8336_dmic_src_enum = -+ SOC_VALUE_ENUM_SINGLE(ES8336_ADC_DMIC_REG25, 0, 3, -+ ARRAY_SIZE(es8336_dmic_txt), -+ es8336_dmic_txt, -+ es8336_dmic_values); -+ -+static const struct snd_kcontrol_new es8336_dmic_src_controls = -+ SOC_DAPM_ENUM("Route", es8336_dmic_src_enum); -+ -+/* hp mixer mux */ -+static const char *const es8336_hpmux_texts[] = { -+ "lin1-rin1", -+ "lin2-rin2", -+ "lin-rin with Boost", -+ "lin-rin with Boost and PGA" -+}; -+ -+static const unsigned int es8336_hpmux_values[] = { 0, 1, 2, 3 }; -+ -+static const struct soc_enum es8336_left_hpmux_enum = -+ SOC_VALUE_ENUM_SINGLE(ES8336_HPMIX_SEL_REG13, 4, 7, -+ ARRAY_SIZE(es8336_hpmux_texts), -+ es8336_hpmux_texts, -+ es8336_hpmux_values); -+ -+static const struct snd_kcontrol_new es8336_left_hpmux_controls = -+ SOC_DAPM_ENUM("Route", es8336_left_hpmux_enum); -+ -+static const struct soc_enum es8336_right_hpmux_enum = -+ SOC_VALUE_ENUM_SINGLE(ES8336_HPMIX_SEL_REG13, 0, 7, -+ ARRAY_SIZE(es8336_hpmux_texts), -+ es8336_hpmux_texts, -+ es8336_hpmux_values); -+ -+static const struct snd_kcontrol_new es8336_right_hpmux_controls = -+ SOC_DAPM_ENUM("Route", es8336_right_hpmux_enum); -+ -+/* headphone Output Mixer */ -+static const struct snd_kcontrol_new es8336_out_left_mix[] = { -+ SOC_DAPM_SINGLE("LLIN Switch", ES8336_HPMIX_SWITCH_REG14, -+ 6, 1, 0), -+ SOC_DAPM_SINGLE("Left DAC Switch", ES8336_HPMIX_SWITCH_REG14, -+ 7, 1, 0), -+}; -+ -+static const struct snd_kcontrol_new es8336_out_right_mix[] = { -+ SOC_DAPM_SINGLE("RLIN Switch", ES8336_HPMIX_SWITCH_REG14, -+ 2, 1, 0), -+ SOC_DAPM_SINGLE("Right DAC Switch", ES8336_HPMIX_SWITCH_REG14, -+ 3, 1, 0), -+}; -+ -+/* DAC data source mux */ -+static const char * const es8336_dacsrc_texts[] = { -+ "LDATA TO LDAC, RDATA TO RDAC", -+ "LDATA TO LDAC, LDATA TO RDAC", -+ "RDATA TO LDAC, RDATA TO RDAC", -+ "RDATA TO LDAC, LDATA TO RDAC", -+}; -+ -+static const unsigned int es8336_dacsrc_values[] = { 0, 1, 2, 3 }; -+ -+static const struct soc_enum es8336_dacsrc_mux_enum = -+ SOC_VALUE_ENUM_SINGLE(ES8336_DAC_SET1_REG30, 6, 4, -+ ARRAY_SIZE(es8336_dacsrc_texts), -+ es8336_dacsrc_texts, -+ es8336_dacsrc_values); -+static const struct snd_kcontrol_new es8336_dacsrc_mux_controls = -+ SOC_DAPM_ENUM("Route", es8336_dacsrc_mux_enum); -+ -+static const struct snd_soc_dapm_widget es8336_dapm_widgets[] = { -+ /* Input Lines */ -+ SND_SOC_DAPM_INPUT("DMIC"), -+ SND_SOC_DAPM_INPUT("MIC1"), -+ SND_SOC_DAPM_INPUT("MIC2"), -+ -+ SND_SOC_DAPM_MICBIAS("micbias", SND_SOC_NOPM, -+ 0, 0), -+ /* Input MUX */ -+ SND_SOC_DAPM_MUX("Differential Mux", SND_SOC_NOPM, 0, 0, -+ &es8336_analog_in_mux_controls), -+ -+ SND_SOC_DAPM_PGA("Line input PGA", ES8336_ADC_PDN_LINSEL_REG22, -+ 7, 1, NULL, 0), -+ -+ /* ADCs */ -+ SND_SOC_DAPM_ADC("Mono ADC", NULL, ES8336_ADC_PDN_LINSEL_REG22, 6, 1), -+ -+ /* Dmic MUX */ -+ SND_SOC_DAPM_MUX("Digital Mic Mux", SND_SOC_NOPM, 0, 0, -+ &es8336_dmic_src_controls), -+ -+ /* Digital Interface */ -+ SND_SOC_DAPM_AIF_OUT("I2S OUT", "I2S1 Capture", 1, -+ SND_SOC_NOPM, 0, 0), -+ -+ SND_SOC_DAPM_AIF_IN("I2S IN", "I2S1 Playback", 0, -+ SND_SOC_NOPM, 0, 0), -+ -+ /* DACs DATA SRC MUX */ -+ SND_SOC_DAPM_MUX("DAC SRC Mux", SND_SOC_NOPM, 0, 0, -+ &es8336_dacsrc_mux_controls), -+ /* DACs */ -+ SND_SOC_DAPM_DAC("Right DAC", NULL, ES8336_DAC_PDN_REG2F, 0, 1), -+ SND_SOC_DAPM_DAC("Left DAC", NULL, ES8336_DAC_PDN_REG2F, 4, 1), -+ -+ /* Headphone Output Side */ -+ /* hpmux for hp mixer */ -+ SND_SOC_DAPM_MUX("Left Hp mux", SND_SOC_NOPM, 0, 0, -+ &es8336_left_hpmux_controls), -+ SND_SOC_DAPM_MUX("Right Hp mux", SND_SOC_NOPM, 0, 0, -+ &es8336_right_hpmux_controls), -+ /* Output mixer */ -+ SND_SOC_DAPM_MIXER("Left Hp mixer", ES8336_HPMIX_PDN_REG15, -+ 4, 1, &es8336_out_left_mix[0], -+ ARRAY_SIZE(es8336_out_left_mix)), -+ SND_SOC_DAPM_MIXER("Right Hp mixer", ES8336_HPMIX_PDN_REG15, -+ 0, 1, &es8336_out_right_mix[0], -+ ARRAY_SIZE(es8336_out_right_mix)), -+ -+ /* Output charge pump */ -+ SND_SOC_DAPM_PGA("HPCP L", ES8336_CPHP_OUTEN_REG17, -+ 6, 0, NULL, 0), -+ SND_SOC_DAPM_PGA("HPCP R", ES8336_CPHP_OUTEN_REG17, -+ 2, 0, NULL, 0), -+ -+ /* Output Driver */ -+ SND_SOC_DAPM_PGA("HPVOL L", ES8336_CPHP_OUTEN_REG17, -+ 5, 0, NULL, 0), -+ SND_SOC_DAPM_PGA("HPVOL R", ES8336_CPHP_OUTEN_REG17, -+ 1, 0, NULL, 0), -+ /* Output Lines */ -+ SND_SOC_DAPM_OUTPUT("HPOL"), -+ SND_SOC_DAPM_OUTPUT("HPOR"), -+}; -+ -+static const struct snd_soc_dapm_route es8336_dapm_routes[] = { -+ /* -+ * record route map -+ */ -+ {"MIC1", NULL, "micbias"}, -+ {"MIC2", NULL, "micbias"}, -+ {"DMIC", NULL, "micbias"}, -+ -+ {"Differential Mux", "lin1-rin1", "MIC1"}, -+ {"Differential Mux", "lin2-rin2", "MIC2"}, -+ {"Differential Mux", "lin1-rin1 with 15db Boost", "MIC1"}, -+ {"Differential Mux", "lin2-rin2 with 15db Boost", "MIC2"}, -+ {"Line input PGA", NULL, "Differential Mux"}, -+ -+ {"Mono ADC", NULL, "Line input PGA"}, -+ -+ {"Digital Mic Mux", "dmic disable", "Mono ADC"}, -+ {"Digital Mic Mux", "dmic data at high level", "DMIC"}, -+ {"Digital Mic Mux", "dmic data at low level", "DMIC"}, -+ -+ {"I2S OUT", NULL, "Digital Mic Mux"}, -+ /* -+ * playback route map -+ */ -+ {"DAC SRC Mux", "LDATA TO LDAC, RDATA TO RDAC", "I2S IN"}, -+ {"DAC SRC Mux", "LDATA TO LDAC, LDATA TO RDAC", "I2S IN"}, -+ {"DAC SRC Mux", "RDATA TO LDAC, RDATA TO RDAC", "I2S IN"}, -+ {"DAC SRC Mux", "RDATA TO LDAC, LDATA TO RDAC", "I2S IN"}, -+ -+ {"Left DAC", NULL, "DAC SRC Mux"}, -+ {"Right DAC", NULL, "DAC SRC Mux"}, -+ -+ {"Left Hp mux", "lin1-rin1", "MIC1"}, -+ {"Left Hp mux", "lin2-rin2", "MIC2"}, -+ {"Left Hp mux", "lin-rin with Boost", "Differential Mux"}, -+ {"Left Hp mux", "lin-rin with Boost and PGA", "Line input PGA"}, -+ -+ {"Right Hp mux", "lin1-rin1", "MIC1"}, -+ {"Right Hp mux", "lin2-rin2", "MIC2"}, -+ {"Right Hp mux", "lin-rin with Boost", "Differential Mux"}, -+ {"Right Hp mux", "lin-rin with Boost and PGA", "Line input PGA"}, -+ -+ {"Left Hp mixer", "LLIN Switch", "Left Hp mux"}, -+ {"Left Hp mixer", "Left DAC Switch", "Left DAC"}, ++ tx_offset = TX_RING_BYTES(bp) + bp->tx_bd_rd_prefetch + ++ RING_ADDR_INTERVAL; ++ tx_size = bp->num_queues * tx_offset; ++ for (i = 0; i < MAX_RING_ADDR_ALLOC_TIMES + 1; i++) { ++ if (i == MAX_RING_ADDR_ALLOC_TIMES) ++ return -ENOMEM; + -+ {"Right Hp mixer", "RLIN Switch", "Right Hp mux"}, -+ {"Right Hp mixer", "Right DAC Switch", "Right DAC"}, ++ tx_ring_base = dma_alloc_coherent(&bp->pdev->dev, tx_size, ++ &tx_ring_base_addr, ++ GFP_KERNEL); ++ if (!tx_ring_base) ++ continue; + -+ {"HPCP L", NULL, "Left Hp mixer"}, -+ {"HPCP R", NULL, "Right Hp mixer"}, ++ ret = macb_queue_phyaddr_check(bp, tx_ring_base_addr, ++ tx_offset); ++ if (ret) { ++ dma_free_coherent(&bp->pdev->dev, tx_size, tx_ring_base, ++ tx_ring_base_addr); ++ continue; ++ } else { ++ break; ++ } ++ } + -+ {"HPVOL L", NULL, "HPCP L"}, -+ {"HPVOL R", NULL, "HPCP R"}, ++ rx_offset = RX_RING_BYTES(bp) + bp->rx_bd_rd_prefetch + ++ RING_ADDR_INTERVAL; ++ rx_size = bp->num_queues * rx_offset; ++ for (i = 0; i < MAX_RING_ADDR_ALLOC_TIMES + 1; i++) { ++ if (i == MAX_RING_ADDR_ALLOC_TIMES) { ++ dma_free_coherent(&bp->pdev->dev, tx_size, tx_ring_base, ++ tx_ring_base_addr); ++ return -ENOMEM; ++ } + -+ {"HPOL", NULL, "HPVOL L"}, -+ {"HPOR", NULL, "HPVOL R"}, -+}; ++ rx_ring_base = dma_alloc_coherent(&bp->pdev->dev, rx_size, ++ &rx_ring_base_addr, ++ GFP_KERNEL); ++ if (!rx_ring_base) ++ continue; + ++ ret = macb_queue_phyaddr_check(bp, rx_ring_base_addr, ++ rx_offset); ++ if (ret) { ++ dma_free_coherent(&bp->pdev->dev, rx_size, rx_ring_base, ++ rx_ring_base_addr); ++ continue; ++ } else { ++ break; ++ } ++ } + -+/* The set of rates we can generate from the above for each SYSCLK */ + for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) { +- size = TX_RING_BYTES(bp) + bp->tx_bd_rd_prefetch; +- queue->tx_ring = dma_alloc_coherent(&bp->pdev->dev, size, +- &queue->tx_ring_dma, +- GFP_KERNEL); ++ queue->tx_ring = (void *)tx_ring_base + q * tx_offset; ++ queue->tx_ring_dma = tx_ring_base_addr + q * tx_offset; + if (!queue->tx_ring) + goto out_err; + netdev_dbg(bp->dev, +@@ -2552,13 +2912,12 @@ static int macb_alloc_consistent(struct macb *bp) + queue->tx_ring); + + size = bp->tx_ring_size * sizeof(struct macb_tx_skb); +- queue->tx_skb = kmalloc(size, GFP_KERNEL); ++ queue->tx_skb = kzalloc(size, GFP_KERNEL); + if (!queue->tx_skb) + goto out_err; + +- size = RX_RING_BYTES(bp) + bp->rx_bd_rd_prefetch; +- queue->rx_ring = dma_alloc_coherent(&bp->pdev->dev, size, +- &queue->rx_ring_dma, GFP_KERNEL); ++ queue->rx_ring = (void *)rx_ring_base + q * rx_offset; ++ queue->rx_ring_dma = rx_ring_base_addr + q * rx_offset; + if (!queue->rx_ring) + goto out_err; + netdev_dbg(bp->dev, +@@ -2592,6 +2951,15 @@ static void gem_init_rings(struct macb *bp) + queue->tx_head = 0; + queue->tx_tail = 0; + ++ for (i = 0; i < bp->rx_ring_size; i++) { ++ desc = macb_rx_desc(queue, i); ++ desc->ctrl = 0; ++ /* make sure ctrl is cleared first, ++ * and bit RX_USED is set to avoid a race. ++ */ ++ dma_wmb(); ++ desc->addr |= MACB_BIT(RX_USED); ++ } + queue->rx_tail = 0; + queue->rx_prepared_head = 0; + +@@ -2768,6 +3136,46 @@ static void macb_configure_dma(struct macb *bp) + } + } + ++static int phytium_mac_config(struct macb *bp) ++{ ++ u32 old_ctrl, ctrl; ++ u32 old_ncr, ncr; + -+static unsigned int rates_12288[] = { -+ 8000, 12000, 16000, 24000, 24000, 32000, 48000, 96000, -+}; ++ netdev_dbg(bp->dev, "phytium mac config"); + -+static struct snd_pcm_hw_constraint_list constraints_12288 = { -+ .count = ARRAY_SIZE(rates_12288), -+ .list = rates_12288, -+}; ++ ncr = macb_readl(bp, NCR); ++ old_ncr = ncr; ++ ctrl = macb_or_gem_readl(bp, NCFGR); ++ old_ctrl = ctrl; + -+static unsigned int rates_112896[] = { -+ 8000, 11025, 22050, 44100, -+}; ++ ncr &= ~(GEM_BIT(ENABLE_HS_MAC) | MACB_BIT(2PT5G)); ++ ctrl &= ~(GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL) | ++ MACB_BIT(SPD) | MACB_BIT(FD)); ++ if (macb_is_gem(bp)) ++ ctrl &= ~GEM_BIT(GBE); + -+static struct snd_pcm_hw_constraint_list constraints_112896 = { -+ .count = ARRAY_SIZE(rates_112896), -+ .list = rates_112896, -+}; ++ if (bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { ++ ctrl |= GEM_BIT(PCSSEL) | GEM_BIT(SGMIIEN); ++ ncr |= MACB_BIT(2PT5G); ++ } else if (bp->phy_interface == PHY_INTERFACE_MODE_USXGMII || ++ bp->phy_interface == PHY_INTERFACE_MODE_5GBASER) { ++ ctrl |= GEM_BIT(PCSSEL); ++ ncr |= GEM_BIT(ENABLE_HS_MAC); ++ } + -+static unsigned int rates_12[] = { -+ 8000, 11025, 12000, 16000, 22050, 24000, 32000, 44100, 48000, -+ 48000, 88235, 96000, -+}; ++ if (bp->duplex) ++ ctrl |= MACB_BIT(FD); + -+static struct snd_pcm_hw_constraint_list constraints_12 = { -+ .count = ARRAY_SIZE(rates_12), -+ .list = rates_12, -+}; ++ /* Apply the new configuration, if any */ ++ if (old_ctrl ^ ctrl) ++ macb_or_gem_writel(bp, NCFGR, ctrl); + -+/* -+ * Note that this should be called from init rather than from hw_params. -+ */ -+static int es8336_set_dai_sysclk(struct snd_soc_dai *codec_dai, -+ int clk_id, unsigned int freq, int dir) -+{ -+ struct snd_soc_component *component = codec_dai->component; -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ -+ switch (freq) { -+ case 11289600: -+ case 18432000: -+ case 22579200: -+ case 36864000: -+ es8336->sysclk_constraints = &constraints_112896; -+ es8336->sysclk = freq; -+ return 0; -+ case 12288000: -+ case 19200000: -+ case 16934400: -+ case 24576000: -+ case 33868800: -+ es8336->sysclk_constraints = &constraints_12288; -+ es8336->sysclk = freq; -+ return 0; -+ case 12000000: -+ case 24000000: -+ es8336->sysclk_constraints = &constraints_12; -+ es8336->sysclk = freq; -+ return 0; -+ } ++ if (old_ncr ^ ncr) ++ macb_or_gem_writel(bp, NCR, ncr); + + return 0; +} + -+static int es8336_set_dai_fmt(struct snd_soc_dai *codec_dai, -+ unsigned int fmt) -+{ -+ struct snd_soc_component *component = codec_dai->component; -+ u8 iface = 0; -+ u8 adciface = 0; -+ u8 daciface = 0; -+ -+ iface = snd_soc_component_read(component, ES8336_IFACE); -+ adciface = snd_soc_component_read(component, ES8336_ADC_IFACE); -+ daciface = snd_soc_component_read(component, ES8336_DAC_IFACE); -+ -+ /* set master/slave audio interface */ -+ switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { -+ case SND_SOC_DAIFMT_CBM_CFM: -+ iface |= 0x80; -+ break; -+ case SND_SOC_DAIFMT_CBS_CFS: -+ iface &= 0x7F; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ /* interface format */ -+ switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { -+ case SND_SOC_DAIFMT_I2S: -+ adciface &= 0xFC; -+ daciface &= 0xFC; -+ break; -+ case SND_SOC_DAIFMT_RIGHT_J: -+ return -EINVAL; -+ case SND_SOC_DAIFMT_LEFT_J: -+ adciface &= 0xFC; -+ daciface &= 0xFC; -+ adciface |= 0x01; -+ daciface |= 0x01; -+ break; -+ case SND_SOC_DAIFMT_DSP_A: -+ adciface &= 0xDC; -+ daciface &= 0xDC; -+ adciface |= 0x03; -+ daciface |= 0x03; -+ break; -+ case SND_SOC_DAIFMT_DSP_B: -+ adciface &= 0xDC; -+ daciface &= 0xDC; -+ adciface |= 0x23; -+ daciface |= 0x23; -+ break; -+ default: -+ return -EINVAL; -+ } + static void macb_init_hw(struct macb *bp) + { + u32 config; +@@ -2796,11 +3204,24 @@ static void macb_init_hw(struct macb *bp) + if (bp->caps & MACB_CAPS_JUMBO) + bp->rx_frm_len_mask = MACB_RX_JFRMLEN_MASK; + +- macb_configure_dma(bp); ++ gem_writel(bp, AXI_PIPE, 0x1010); + -+ /* clock inversion */ -+ switch (fmt & SND_SOC_DAIFMT_INV_MASK) { -+ case SND_SOC_DAIFMT_NB_NF: -+ iface &= 0xDF; -+ adciface &= 0xDF; -+ daciface &= 0xDF; -+ break; -+ case SND_SOC_DAIFMT_IB_IF: -+ iface |= 0x20; -+ adciface |= 0x20; -+ daciface |= 0x20; -+ break; -+ case SND_SOC_DAIFMT_IB_NF: -+ iface |= 0x20; -+ adciface &= 0xDF; -+ daciface &= 0xDF; -+ break; -+ case SND_SOC_DAIFMT_NB_IF: -+ iface &= 0xDF; -+ adciface |= 0x20; -+ daciface |= 0x20; -+ break; -+ default: -+ return -EINVAL; ++ if (bp->phy_interface == PHY_INTERFACE_MODE_USXGMII || ++ bp->phy_interface == PHY_INTERFACE_MODE_5GBASER || ++ bp->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { ++ /* phytium need hwclock */ ++ if (bp->caps & MACB_CAPS_SEL_CLK) ++ bp->sel_clk_hw(bp, bp->speed); ++ phytium_mac_config(bp); ++ if (bp->link) ++ macb_usx_pcs_link_up(&bp->phylink_usx_pcs, 0, ++ bp->phy_interface, bp->speed, bp->duplex); ++ } else { ++ bp->speed = SPEED_10; ++ bp->duplex = DUPLEX_HALF; + } -+ snd_soc_component_write(component, ES8336_IFACE, iface); -+ snd_soc_component_write(component, ES8336_ADC_IFACE, adciface); -+ snd_soc_component_write(component, ES8336_DAC_IFACE, daciface); -+ return 0; -+} -+ -+static int es8336_pcm_startup(struct snd_pcm_substream *substream, -+ struct snd_soc_dai *dai) + +- /* Enable RX partial store and forward and set watermark */ +- if (bp->rx_watermark) +- gem_writel(bp, PBUFRXCUT, (bp->rx_watermark | GEM_BIT(ENCUTTHRU))); ++ macb_configure_dma(bp); + } + + /* The hash address register is 64 bits long and takes up two +@@ -2924,7 +3345,10 @@ static void macb_set_rx_mode(struct net_device *dev) + + static int macb_open(struct net_device *dev) + { +- size_t bufsz = dev->mtu + ETH_HLEN + ETH_FCS_LEN + NET_IP_ALIGN; ++ /* adjust bufsz to be at least the size of a standard frame, ++ * to fix rx error when set small size mtu. ++ */ ++ size_t bufsz = (dev->mtu < ETH_DATA_LEN ? ETH_DATA_LEN : dev->mtu) + ETH_HLEN + ETH_FCS_LEN + NET_IP_ALIGN; + struct macb *bp = netdev_priv(dev); + struct macb_queue *queue; + unsigned int q; +@@ -2951,6 +3375,7 @@ static int macb_open(struct net_device *dev) + napi_enable(&queue->napi_tx); + } + ++ macb_writel(bp, NCR, macb_readl(bp, NCR) | MACB_BIT(MPE)); + macb_init_hw(bp); + + err = phy_power_on(bp->sgmii_phy); +@@ -3884,6 +4309,8 @@ static const struct net_device_ops macb_netdev_ops = { + #endif + .ndo_set_features = macb_set_features, + .ndo_features_check = macb_features_check, ++ .ndo_vlan_rx_add_vid = ncsi_vlan_rx_add_vid, ++ .ndo_vlan_rx_kill_vid = ncsi_vlan_rx_kill_vid, + }; + + /* Configure peripheral capabilities according to device tree +@@ -4048,6 +4475,97 @@ static int macb_clk_init(struct platform_device *pdev, struct clk **pclk, + return err; + } + ++static int phytium_clk_init(struct platform_device *pdev, struct clk **pclk, ++ struct clk **hclk, struct clk **tx_clk, ++ struct clk **rx_clk, struct clk **tsu_clk) +{ -+ struct snd_soc_component *component = dai->component; -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ bool playback = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK); -+ -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0xC0); -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); -+ /* es8336: both playback and capture need dac mclk */ -+ snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, -+ ES8336_CLKMGR_MCLK_DIV_MASK | -+ ES8336_CLKMGR_DAC_MCLK_MASK, -+ ES8336_CLKMGR_MCLK_DIV_NML | -+ ES8336_CLKMGR_DAC_MCLK_EN); -+ es8336->pwr_count++; -+ -+ if (playback) { -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x3F); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x1F); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x88); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0xBB); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x10); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x30); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x02); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x00); -+ snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x66); -+ snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, -+ ES8336_CLKMGR_DAC_MCLK_MASK | -+ ES8336_CLKMGR_DAC_ANALOG_MASK, -+ ES8336_CLKMGR_DAC_MCLK_EN | -+ ES8336_CLKMGR_DAC_ANALOG_EN); -+ msleep(50); ++ struct macb_platform_data *pdata; ++ struct device_node *np = pdev->dev.of_node; ++ int err; ++ ++ pdata = dev_get_platdata(&pdev->dev); ++ if (pdata) { ++ *pclk = pdata->pclk; ++ *hclk = pdata->hclk; + } else { -+ snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0x00); -+ snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, -+ ES8336_CLKMGR_ADC_MCLK_MASK | -+ ES8336_CLKMGR_ADC_ANALOG_MASK, -+ ES8336_CLKMGR_ADC_MCLK_EN | -+ ES8336_CLKMGR_ADC_ANALOG_EN); ++ if (has_acpi_companion(&pdev->dev)) { ++ *pclk = NULL; ++ *hclk = NULL; ++ } else if (np) { ++ *pclk = devm_clk_get(&pdev->dev, "pclk"); ++ *hclk = devm_clk_get(&pdev->dev, "hclk"); ++ } + } + -+ return 0; -+} ++ if (IS_ERR(*pclk)) ++ return dev_err_probe(&pdev->dev, ++ IS_ERR(*pclk) ? PTR_ERR(*pclk) : -ENODEV, ++ "failed to get pclk\n"); ++ ++ if (IS_ERR(*hclk)) ++ return dev_err_probe(&pdev->dev, ++ IS_ERR(*hclk) ? PTR_ERR(*hclk) : -ENODEV, ++ "failed to get hclk\n"); ++ ++ *tx_clk = devm_clk_get_optional(&pdev->dev, "tx_clk"); ++ if (IS_ERR(*tx_clk)) ++ return PTR_ERR(*tx_clk); ++ ++ *rx_clk = devm_clk_get_optional(&pdev->dev, "rx_clk"); ++ if (IS_ERR(*rx_clk)) ++ return PTR_ERR(*rx_clk); ++ ++ *tsu_clk = devm_clk_get_optional(&pdev->dev, "tsu_clk"); ++ if (IS_ERR(*tsu_clk)) ++ return PTR_ERR(*tsu_clk); + -+static void es8336_pcm_shutdown(struct snd_pcm_substream *substream, -+ struct snd_soc_dai *dai) -+{ -+ struct snd_soc_component *component = dai->component; -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ bool playback = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK); -+ -+ if (playback) { -+ snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); -+ snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, -+ ES8336_CLKMGR_DAC_ANALOG_MASK, -+ ES8336_CLKMGR_DAC_ANALOG_DIS); -+ } else { -+ snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xc0); -+ snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, -+ ES8336_CLKMGR_ADC_MCLK_MASK | -+ ES8336_CLKMGR_ADC_ANALOG_MASK, -+ ES8336_CLKMGR_ADC_MCLK_DIS | -+ ES8336_CLKMGR_ADC_ANALOG_DIS); ++ err = clk_prepare_enable(*pclk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable pclk (%d)\n", err); ++ return err; + } + -+ if (--es8336->pwr_count == 0) { -+ if (!es8336->hp_inserted) -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); -+ snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); ++ err = clk_prepare_enable(*hclk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable hclk (%d)\n", err); ++ goto err_disable_pclk; + } -+} -+ + -+static int es8336_pcm_hw_params(struct snd_pcm_substream *substream, -+ struct snd_pcm_hw_params *params, -+ struct snd_soc_dai *dai) -+{ -+ struct snd_soc_component *component = dai->component; -+ int val = 0; ++ err = clk_prepare_enable(*tx_clk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable tx_clk (%d)\n", err); ++ goto err_disable_hclk; ++ } + -+ switch (params_format(params)) { -+ case SNDRV_PCM_FORMAT_S16_LE: -+ val = ES8336_DACWL_16; -+ break; -+ case SNDRV_PCM_FORMAT_S20_3LE: -+ val = ES8336_DACWL_20; -+ break; -+ case SNDRV_PCM_FORMAT_S24_LE: -+ val = ES8336_DACWL_24; -+ break; -+ case SNDRV_PCM_FORMAT_S32_LE: -+ val = ES8336_DACWL_32; -+ break; -+ default: -+ val = ES8336_DACWL_16; -+ break; ++ err = clk_prepare_enable(*rx_clk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable rx_clk (%d)\n", err); ++ goto err_disable_txclk; + } + -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ snd_soc_component_update_bits(component, ES8336_SDP_DACFMT_REG0B, -+ ES8336_DACWL_MASK, val); -+ else -+ snd_soc_component_update_bits(component, ES8336_SDP_ADCFMT_REG0A, -+ ES8336_ADCWL_MASK, val); ++ err = clk_prepare_enable(*tsu_clk); ++ if (err) { ++ dev_err(&pdev->dev, "failed to enable tsu_clk (%d)\n", err); ++ goto err_disable_rxclk; ++ } + + return 0; -+} -+ -+static int es8336_mute(struct snd_soc_dai *dai, int mute, int direction) -+{ -+ struct snd_soc_component *component = dai->component; -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ -+ es8336->muted = mute; -+ if (!es8336->hp_inserted) -+ es8336_enable_spk(es8336, true); -+ else -+ es8336_enable_spk(es8336, false); -+ if (direction) -+ return snd_soc_component_update_bits(dai->component, ES8336_ADC_MUTE_REG26, -+ ES8336_MUTE, -+ mute ? ES8336_MUTE : 0); -+ else -+ return snd_soc_component_update_bits(dai->component, ES8336_DAC_SET1_REG30, -+ ES8336_MUTE, -+ mute ? ES8336_MUTE : 0); -+} -+ -+static int es8336_set_bias_level(struct snd_soc_component *component, -+ enum snd_soc_bias_level level) -+{ -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + -+ switch (level) { -+ case SND_SOC_BIAS_ON: -+ break; ++err_disable_rxclk: ++ clk_disable_unprepare(*rx_clk); + -+ case SND_SOC_BIAS_PREPARE: -+ break; ++err_disable_txclk: ++ clk_disable_unprepare(*tx_clk); + -+ case SND_SOC_BIAS_STANDBY: -+ break; ++err_disable_hclk: ++ clk_disable_unprepare(*hclk); + -+ case SND_SOC_BIAS_OFF: -+ snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); -+ snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); -+ if (!es8336->hp_inserted) -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x3F); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x1F); -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0x00); -+ break; -+ } ++err_disable_pclk: ++ clk_disable_unprepare(*pclk); + -+ return 0; ++ return err; +} + -+#define es8336_RATES SNDRV_PCM_RATE_8000_96000 -+ -+#define es8336_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ -+ SNDRV_PCM_FMTBIT_S24_LE) -+ -+static const struct snd_soc_dai_ops es8336_ops = { -+ .startup = es8336_pcm_startup, -+ .hw_params = es8336_pcm_hw_params, -+ .set_fmt = es8336_set_dai_fmt, -+ .set_sysclk = es8336_set_dai_sysclk, -+ .mute_stream = es8336_mute, -+ .shutdown = es8336_pcm_shutdown, -+ .no_capture_mute = 1, + static int macb_init(struct platform_device *pdev) + { + struct net_device *dev = platform_get_drvdata(pdev); +@@ -4126,12 +4644,14 @@ static int macb_init(struct platform_device *pdev) + + /* setup appropriated routines according to adapter type */ + if (macb_is_gem(bp)) { ++ bp->max_tx_length = GEM_MAX_TX_LEN; + bp->macbgem_ops.mog_alloc_rx_buffers = gem_alloc_rx_buffers; + bp->macbgem_ops.mog_free_rx_buffers = gem_free_rx_buffers; + bp->macbgem_ops.mog_init_rings = gem_init_rings; + bp->macbgem_ops.mog_rx = gem_rx; + dev->ethtool_ops = &gem_ethtool_ops; + } else { ++ bp->max_tx_length = MACB_MAX_TX_LEN; + bp->macbgem_ops.mog_alloc_rx_buffers = macb_alloc_rx_buffers; + bp->macbgem_ops.mog_free_rx_buffers = macb_free_rx_buffers; + bp->macbgem_ops.mog_init_rings = macb_init_rings; +@@ -4901,6 +5421,34 @@ static const struct macb_config versal_config = { + .usrio = &macb_default_usrio, + }; + ++static const struct macb_config phytium_gem1p0_config = { ++ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | ++ MACB_CAPS_JUMBO | ++ MACB_CAPS_GEM_HAS_PTP | ++ MACB_CAPS_BD_RD_PREFETCH | ++ MACB_CAPS_SEL_CLK, ++ .dma_burst_length = 16, ++ .clk_init = phytium_clk_init, ++ .init = macb_init, ++ .jumbo_max_len = 16360, ++ .sel_clk_hw = phytium_gem1p0_sel_clk, ++ .usrio = &macb_default_usrio, +}; + -+static struct snd_soc_dai_driver es8336_dai = { -+ .name = "es8336-hifi", -+ .playback = { -+ .stream_name = "Playback", -+ .channels_min = 1, -+ .channels_max = 2, -+ .rates = es8336_RATES, -+ .formats = es8336_FORMATS, -+ }, -+ .capture = { -+ .stream_name = "Capture", -+ .channels_min = 1, -+ .channels_max = 2, -+ .rates = es8336_RATES, -+ .formats = es8336_FORMATS, -+ }, -+ .ops = &es8336_ops, -+ .symmetric_rate = 1, ++static const struct macb_config phytium_gem2p0_config = { ++ .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | ++ MACB_CAPS_JUMBO | ++ MACB_CAPS_GEM_HAS_PTP | ++ MACB_CAPS_BD_RD_PREFETCH | ++ MACB_CAPS_SEL_CLK, ++ .dma_burst_length = 16, ++ .clk_init = phytium_clk_init, ++ .init = macb_init, ++ .jumbo_max_len = 10240, ++ .sel_clk_hw = phytium_gem2p0_sel_clk, ++ .usrio = &macb_default_usrio, +}; + -+static int es8336_init_regs(struct snd_soc_component *component) -+{ -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0x3f); -+ usleep_range(5000, 5500); -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0x00); -+ snd_soc_component_write(component, ES8336_SYS_VMIDSEL_REG0C, 0xFF); -+ msleep(30); -+ snd_soc_component_write(component, ES8336_CLKMGR_CLKSEL_REG02, 0x08); -+ snd_soc_component_write(component, ES8336_CLKMGR_ADCOSR_REG03, 0x20); -+ snd_soc_component_write(component, ES8336_CLKMGR_ADCDIV1_REG04, 0x11); -+ snd_soc_component_write(component, ES8336_CLKMGR_ADCDIV2_REG05, 0x00); -+ snd_soc_component_write(component, ES8336_CLKMGR_DACDIV1_REG06, 0x11); -+ snd_soc_component_write(component, ES8336_CLKMGR_DACDIV2_REG07, 0x00); -+ snd_soc_component_write(component, ES8336_CLKMGR_CPDIV_REG08, 0x00); -+ snd_soc_component_write(component, ES8336_SDP_MS_BCKDIV_REG09, 0x04); -+ snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0x7F); -+ snd_soc_component_write(component, ES8336_CAL_TYPE_REG1C, 0x0F); -+ snd_soc_component_write(component, ES8336_CAL_HPLIV_REG1E, 0x90); -+ snd_soc_component_write(component, ES8336_CAL_HPRIV_REG1F, 0x90); -+ snd_soc_component_write(component, ES8336_ADC_VOLUME_REG27, 0x00); -+ snd_soc_component_write(component, ES8336_ADC_PDN_LINSEL_REG22, es8336->mic_src); -+ snd_soc_component_write(component, ES8336_ADC_D2SEPGA_REG24, 0x00); -+ snd_soc_component_write(component, ES8336_ADC_DMIC_REG25, 0x08); -+ snd_soc_component_write(component, ES8336_DAC_SET2_REG31, 0x20); -+ snd_soc_component_write(component, ES8336_DAC_SET3_REG32, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_VOLL_REG33, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_VOLR_REG34, 0x00); -+ snd_soc_component_write(component, ES8336_SDP_ADCFMT_REG0A, 0x00); -+ snd_soc_component_write(component, ES8336_SDP_DACFMT_REG0B, 0x00); -+ snd_soc_component_write(component, ES8336_SYS_VMIDLOW_REG10, 0x11); -+ snd_soc_component_write(component, ES8336_SYS_VSEL_REG11, 0xFC); -+ snd_soc_component_write(component, ES8336_SYS_REF_REG12, 0x28); -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x04); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x0C); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); -+ snd_soc_component_write(component, ES8336_HPMIX_SEL_REG13, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x88); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0xBB); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x10); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x30); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x02); -+ snd_soc_component_write(component, ES8336_CPHP_ICAL_VOL_REG18, 0x00); -+ snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); -+ snd_soc_component_write(component, ES8336_GPIO_DEBUNCE_INT_REG4E, 0x02); -+ snd_soc_component_write(component, ES8336_TESTMODE_REG50, 0xA0); -+ snd_soc_component_write(component, ES8336_TEST1_REG51, 0x00); -+ snd_soc_component_write(component, ES8336_TEST2_REG52, 0x00); -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); -+ snd_soc_component_write(component, ES8336_RESET_REG00, 0xC0); -+ msleep(50); -+ snd_soc_component_write(component, ES8336_ADC_PGAGAIN_REG23, 0x60); -+ snd_soc_component_write(component, ES8336_ADC_D2SEPGA_REG24, 0x01); -+ /* adc ds mode, HPF enable */ -+ snd_soc_component_write(component, ES8336_ADC_DMIC_REG25, 0x08); -+ snd_soc_component_write(component, ES8336_ADC_ALC1_REG29, 0xcd); -+ snd_soc_component_write(component, ES8336_ADC_ALC2_REG2A, 0x08); -+ snd_soc_component_write(component, ES8336_ADC_ALC3_REG2B, 0xa0); -+ snd_soc_component_write(component, ES8336_ADC_ALC4_REG2C, 0x05); -+ snd_soc_component_write(component, ES8336_ADC_ALC5_REG2D, 0x06); -+ snd_soc_component_write(component, ES8336_ADC_ALC6_REG2E, 0x61); -+ return 0; -+} -+ -+static int es8336_suspend(struct snd_soc_component *component) -+{ -+ return 0; -+} -+ -+static int es8336_resume(struct snd_soc_component *component) -+{ -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ int ret; + static const struct of_device_id macb_dt_ids[] = { + { .compatible = "cdns,at91sam9260-macb", .data = &at91sam9260_config }, + { .compatible = "cdns,macb" }, +@@ -4924,11 +5472,25 @@ static const struct of_device_id macb_dt_ids[] = { + { .compatible = "xlnx,zynqmp-gem", .data = &zynqmp_config}, + { .compatible = "xlnx,zynq-gem", .data = &zynq_config }, + { .compatible = "xlnx,versal-gem", .data = &versal_config}, ++ { .compatible = "cdns,phytium-gem", .data = &phytium_gem1p0_config }, /* old version */ ++ { .compatible = "cdns,phytium-gem-1.0", .data = &phytium_gem1p0_config }, ++ { .compatible = "cdns,phytium-gem-2.0", .data = &phytium_gem2p0_config }, + { /* sentinel */ } + }; + MODULE_DEVICE_TABLE(of, macb_dt_ids); + #endif /* CONFIG_OF */ + ++#ifdef CONFIG_ACPI ++static const struct acpi_device_id macb_acpi_ids[] = { ++ { .id = "PHYT0036", .driver_data = (kernel_ulong_t)&phytium_gem1p0_config }, ++ { } ++}; + -+ es8336_reset(component); /* UPDATED BY DAVID,15-3-5 */ -+ ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); -+ if (!ret) { -+ es8336_init_regs(component); -+ snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); -+ /* max debance time, enable interrupt, low active */ -+ snd_soc_component_write(component, ES8336_GPIO_DEBUNCE_INT_REG4E, 0xf3); -+ /* es8336_set_bias_level(component, SND_SOC_BIAS_OFF); */ -+ snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); -+ if (!es8336->hp_inserted) -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); -+ snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); -+ snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); -+ } -+ return 0; -+} ++MODULE_DEVICE_TABLE(acpi, macb_acpi_ids); ++#else ++#define macb_acpi_ids NULL ++#endif + -+static irqreturn_t es8336_irq_handler(int irq, void *data) + static const struct macb_config default_gem_config = { + .caps = MACB_CAPS_GIGABIT_MODE_AVAILABLE | + MACB_CAPS_JUMBO | +@@ -4940,6 +5502,32 @@ static const struct macb_config default_gem_config = { + .jumbo_max_len = 10240, + }; + ++static void gem_ncsi_handler(struct ncsi_dev *nd) +{ -+ struct es8336_priv *es8336 = data; -+ -+ queue_delayed_work(system_power_efficient_wq, &es8336->work, -+ msecs_to_jiffies(es8336->debounce_time)); ++ if (unlikely(nd->state != ncsi_dev_state_functional)) ++ return; + -+ return IRQ_HANDLED; ++ netdev_dbg(nd->dev, "NCSI interface %s\n", ++ nd->link_up ? "up" : "down"); +} + -+static void hp_work(struct work_struct *work) ++static int macb_get_phy_mode(struct platform_device *pdev) +{ -+ struct es8336_priv *es8336; -+ -+ es8336 = container_of(work, struct es8336_priv, work.work); -+ -+ es8336->hp_inserted = gpiod_get_value(es8336->hp_det_gpio); -+ if (!es8336->muted) { -+ if (es8336->hp_inserted) -+ es8336_enable_spk(es8336, false); -+ else -+ es8336_enable_spk(es8336, true); -+ } -+} ++ const char *pm; ++ int err, i; + -+static int es8336_probe(struct snd_soc_component *component) -+{ -+ struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); -+ int ret = 0; ++ err = device_property_read_string(&pdev->dev, "phy-mode", &pm); ++ if (err < 0) ++ return err; + -+ es8336_component = component; -+ ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); -+ if (!ret) { -+ es8336_reset(component); /* UPDATED BY DAVID,15-3-5 */ -+ ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); -+ if (!ret) { -+ es8336_init_regs(component); -+ snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); -+ /* max debance time, enable interrupt, low active */ -+ snd_soc_component_write(component, -+ ES8336_GPIO_DEBUNCE_INT_REG4E, 0xf3); -+ -+ /* es8336_set_bias_level(codec, SND_SOC_BIAS_OFF); */ -+ snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); -+ snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); -+ snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); -+ snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); -+ snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); -+ snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); -+ snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); -+ snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); -+ if (!es8336->hp_inserted) -+ snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, -+ 0x3F); -+ snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); -+ snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); -+ snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); -+ snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); -+ } ++ for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) { ++ if (!strcasecmp(pm, phy_modes(i))) ++ return i; + } + -+ return ret; -+} -+ -+static void es8336_remove(struct snd_soc_component *component) -+{ -+ es8336_set_bias_level(component, SND_SOC_BIAS_OFF); ++ return -ENODEV; +} + -+const struct regmap_config es8336_regmap_config = { -+ .reg_bits = 8, -+ .val_bits = 8, -+ .max_register = ES8336_TEST3_REG53, -+ .cache_type = REGCACHE_RBTREE, -+ .reg_defaults = es8336_reg_defaults, -+ .num_reg_defaults = ARRAY_SIZE(es8336_reg_defaults), -+}; -+ -+static const struct snd_soc_component_driver soc_component_dev_es8336 = { -+ .probe = es8336_probe, -+ .remove = es8336_remove, -+ .suspend = es8336_suspend, -+ .resume = es8336_resume, -+ .set_bias_level = es8336_set_bias_level, -+ -+ .controls = es8336_snd_controls, -+ .num_controls = ARRAY_SIZE(es8336_snd_controls), -+ .dapm_widgets = es8336_dapm_widgets, -+ .num_dapm_widgets = ARRAY_SIZE(es8336_dapm_widgets), -+ .dapm_routes = es8336_dapm_routes, -+ .num_dapm_routes = ARRAY_SIZE(es8336_dapm_routes), -+}; -+ -+static int es8336_i2c_probe(struct i2c_client *i2c) -+{ -+ struct es8336_priv *es8336; -+ int ret = -1; -+ int hp_irq; -+ int active_level = 0; -+ -+ es8336 = devm_kzalloc(&i2c->dev, sizeof(*es8336), GFP_KERNEL); -+ if (!es8336) -+ return -ENOMEM; -+ -+ es8336->debounce_time = 200; -+ es8336->pwr_count = 0; -+ es8336->hp_inserted = false; -+ es8336->muted = true; -+ -+ es8336->regmap = devm_regmap_init_i2c(i2c, &es8336_regmap_config); -+ if (IS_ERR(es8336->regmap)) { -+ ret = PTR_ERR(es8336->regmap); -+ dev_err(&i2c->dev, "Failed to init regmap: %d\n", ret); -+ return ret; -+ } -+ -+ i2c_set_clientdata(i2c, es8336); -+ -+ es8336->spk_ctl_gpio = devm_gpiod_get_index_optional(&i2c->dev, "sel", 0, -+ GPIOD_OUT_HIGH); -+ device_property_read_u32(&i2c->dev, "spk-active-level", &active_level); -+ ret = of_property_read_u8(i2c->dev.of_node, "mic-src", &es8336->mic_src); -+ if (ret != 0) { -+ dev_dbg(&i2c->dev, "mic1-src return %d", ret); -+ es8336->mic_src = 0x20; -+ } -+ dev_dbg(&i2c->dev, "mic1-src %x", es8336->mic_src); + static int macb_probe(struct platform_device *pdev) + { + const struct macb_config *macb_config = &default_gem_config; +@@ -4952,7 +5540,6 @@ static int macb_probe(struct platform_device *pdev) + struct clk *tsu_clk = NULL; + unsigned int queue_mask, num_queues; + bool native_io; +- phy_interface_t interface; + struct net_device *dev; + struct resource *regs; + u32 wtrmrk_rst_val; +@@ -4973,6 +5560,15 @@ static int macb_probe(struct platform_device *pdev) + clk_init = macb_config->clk_init; + init = macb_config->init; + } ++ } else if (has_acpi_companion(&pdev->dev)) { ++ const struct acpi_device_id *match; + -+ if (IS_ERR_OR_NULL(es8336->spk_ctl_gpio)) -+ dev_info(&i2c->dev, "Can not get spk_ctl_gpio\n"); -+ else { -+ es8336->spk_active_level = active_level; -+ es8336_enable_spk(es8336, false); -+ } ++ match = acpi_match_device(macb_acpi_ids, &pdev->dev); ++ if (match && match->driver_data) { ++ macb_config = (void *)match->driver_data; ++ clk_init = macb_config->clk_init; ++ init = macb_config->init; ++ } + } + + err = clk_init(pdev, &pclk, &hclk, &tx_clk, &rx_clk, &tsu_clk); +@@ -5021,6 +5617,9 @@ static int macb_probe(struct platform_device *pdev) + if (macb_config) + bp->jumbo_max_len = macb_config->jumbo_max_len; + ++ if (macb_config) ++ bp->sel_clk_hw = macb_config->sel_clk_hw; + -+ es8336->hp_det_gpio = devm_gpiod_get_index_optional(&i2c->dev, "det", 0, -+ GPIOD_IN); + if (!hw_is_gem(bp->regs, bp->native_io)) + bp->max_tx_length = MACB_MAX_TX_LEN; + else if (macb_config->max_tx_length) +@@ -5029,7 +5628,7 @@ static int macb_probe(struct platform_device *pdev) + bp->max_tx_length = GEM_MAX_TX_LEN; + + bp->wol = 0; +- if (of_property_read_bool(np, "magic-packet")) ++ if (device_property_read_bool(&pdev->dev, "magic-packet")) + bp->wol |= MACB_WOL_HAS_MAGIC_PACKET; + device_set_wakeup_capable(&pdev->dev, bp->wol & MACB_WOL_HAS_MAGIC_PACKET); + +@@ -5102,12 +5701,12 @@ static int macb_probe(struct platform_device *pdev) + else if (err) + macb_get_hwaddr(bp); + +- err = of_get_phy_mode(np, &interface); +- if (err) +- /* not found in DT, MII by default */ ++ err = macb_get_phy_mode(pdev); ++ if (err < 0) + bp->phy_interface = PHY_INTERFACE_MODE_MII; + else +- bp->phy_interface = interface; ++ bp->phy_interface = err; + -+ if (IS_ERR_OR_NULL(es8336->hp_det_gpio)) { -+ dev_info(&i2c->dev, "Can not get hp_det_gpio\n"); -+ } else { -+ INIT_DELAYED_WORK(&es8336->work, hp_work); -+ hp_irq = gpiod_to_irq(es8336->hp_det_gpio); -+ ret = devm_request_threaded_irq(&i2c->dev, hp_irq, NULL, -+ es8336_irq_handler, -+ IRQF_TRIGGER_FALLING | -+ IRQF_TRIGGER_RISING | -+ IRQF_ONESHOT, -+ "es8336_interrupt", es8336); -+ if (ret < 0) { -+ dev_err(&i2c->dev, "request_irq failed: %d\n", ret); -+ return ret; + + /* IP specific init */ + err = init(pdev); +@@ -5118,6 +5717,20 @@ static int macb_probe(struct platform_device *pdev) + if (err) + goto err_out_phy_exit; + ++ if (device_property_read_bool(&pdev->dev, "use-ncsi")) { ++ if (!IS_ENABLED(CONFIG_NET_NCSI)) { ++ dev_err(&pdev->dev, "NCSI stack not enabled\n"); ++ goto err_out_free_netdev; + } -+ -+ schedule_delayed_work(&es8336->work, -+ msecs_to_jiffies(es8336->debounce_time)); -+ } -+ -+ ret = devm_snd_soc_register_component(&i2c->dev, -+ &soc_component_dev_es8336, -+ &es8336_dai, 1); -+ -+ return ret; -+} -+ -+static void es8336_i2c_remove(struct i2c_client *client) -+{ -+ -+} -+ -+static void es8336_i2c_shutdown(struct i2c_client *client) -+{ -+ struct es8336_priv *es8336 = i2c_get_clientdata(client); -+ -+ if (es8336_component != NULL) { -+ es8336_enable_spk(es8336, false); -+ msleep(20); -+ es8336_set_bias_level(es8336_component, SND_SOC_BIAS_OFF); ++ dev_notice(&pdev->dev, "Using NCSI interface\n"); ++ bp->use_ncsi = 1; ++ bp->ndev = ncsi_register_dev(dev, gem_ncsi_handler); ++ if (!bp->ndev) ++ goto err_out_free_netdev; ++ } else { ++ bp->use_ncsi = 0; + } -+} -+ -+static const struct i2c_device_id es8336_i2c_id[] = { -+ {"es8336", 0}, -+ {"10ES8336:00", 0}, -+ {"10ES8336", 0}, -+ { } -+}; -+MODULE_DEVICE_TABLE(i2c, es8336_i2c_id); -+ -+static const struct of_device_id es8336_of_match[] = { -+ { .compatible = "everest,es8336", }, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, es8336_of_match); -+ -+static const struct acpi_device_id es8336_acpi_match[] = { -+ { "ESSX8336", 0}, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, es8336_acpi_match); -+ -+static struct i2c_driver es8336_i2c_driver = { -+ .driver = { -+ .name = "es8336", -+ .of_match_table = es8336_of_match, -+ .acpi_match_table = es8336_acpi_match, -+ }, -+ .probe = es8336_i2c_probe, -+ .remove = es8336_i2c_remove, -+ .shutdown = es8336_i2c_shutdown, -+ .id_table = es8336_i2c_id, -+}; -+ -+module_i2c_driver(es8336_i2c_driver); -+MODULE_DESCRIPTION("ASoC es8336 driver"); -+MODULE_LICENSE("GPL"); -diff --git a/sound/soc/codecs/es8336.h b/sound/soc/codecs/es8336.h -new file mode 100644 -index 000000000..2bcf67b8a ---- /dev/null -+++ b/sound/soc/codecs/es8336.h -@@ -0,0 +1,153 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Copyright (C) Everest Semiconductor Co.,Ltd -+ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. -+ */ + -+#ifndef _ES8336_H -+#define _ES8336_H + netif_carrier_off(dev); + + err = register_netdev(dev); +@@ -5349,6 +5962,8 @@ static int __maybe_unused macb_resume(struct device *dev) + macb_set_rx_mode(netdev); + macb_restore_features(bp); + rtnl_lock(); ++ if (!device_may_wakeup(&bp->dev->dev)) ++ phy_init(bp->sgmii_phy); + + phylink_start(bp->phylink); + rtnl_unlock(); +@@ -5402,6 +6017,7 @@ static struct platform_driver macb_driver = { + .driver = { + .name = "macb", + .of_match_table = of_match_ptr(macb_dt_ids), ++ .acpi_match_table = macb_acpi_ids, + .pm = &macb_pm_ops, + }, + }; +diff --git a/drivers/net/ethernet/stmicro/stmmac/Kconfig b/drivers/net/ethernet/stmicro/stmmac/Kconfig +index 25f2d42de..bd1a3a9dd 100644 +--- a/drivers/net/ethernet/stmicro/stmmac/Kconfig ++++ b/drivers/net/ethernet/stmicro/stmmac/Kconfig +@@ -121,6 +121,16 @@ config DWMAC_MESON + the stmmac device driver. This driver is used for Meson6, + Meson8, Meson8b and GXBB SoCs. + ++config DWMAC_PHYTIUM ++ tristate "Phytium dwmac support" ++ default ARCH_PHYTIUM ++ depends on (OF || ACPI) && (ARCH_PHYTIUM || COMPILE_TEST) ++ help ++ Support for GMAC controller on Phytium SoCs. + -+/* ES8336 register space */ -+/* -+ * RESET Control -+ */ -+#define ES8336_RESET_REG00 0x00 -+/* -+ * Clock Managerment -+ */ -+#define ES8336_CLKMGR_CLKSW_REG01 0x01 -+#define ES8336_CLKMGR_CLKSEL_REG02 0x02 -+#define ES8336_CLKMGR_ADCOSR_REG03 0x03 -+#define ES8336_CLKMGR_ADCDIV1_REG04 0x04 -+#define ES8336_CLKMGR_ADCDIV2_REG05 0x05 -+#define ES8336_CLKMGR_DACDIV1_REG06 0x06 -+#define ES8336_CLKMGR_DACDIV2_REG07 0x07 -+#define ES8336_CLKMGR_CPDIV_REG08 0x08 -+/* -+ * SDP Control -+ */ -+#define ES8336_SDP_MS_BCKDIV_REG09 0x09 -+#define ES8336_SDP_ADCFMT_REG0A 0x0a -+#define ES8336_SDP_DACFMT_REG0B 0x0b -+/* -+ * System Control -+ */ -+#define ES8336_SYS_VMIDSEL_REG0C 0x0c -+#define ES8336_SYS_PDN_REG0D 0x0d -+#define ES8336_SYS_LP1_REG0E 0x0e -+#define ES8336_SYS_LP2_REG0F 0x0f -+#define ES8336_SYS_VMIDLOW_REG10 0x10 -+#define ES8336_SYS_VSEL_REG11 0x11 -+#define ES8336_SYS_REF_REG12 0x12 -+/* -+ * HP Mixer -+ */ -+#define ES8336_HPMIX_SEL_REG13 0x13 -+#define ES8336_HPMIX_SWITCH_REG14 0x14 -+#define ES8336_HPMIX_PDN_REG15 0x15 -+#define ES8336_HPMIX_VOL_REG16 0x16 -+/* -+ * Charge Pump Headphone driver -+ */ -+#define ES8336_CPHP_OUTEN_REG17 0x17 -+#define ES8336_CPHP_ICAL_VOL_REG18 0x18 -+#define ES8336_CPHP_PDN1_REG19 0x19 -+#define ES8336_CPHP_PDN2_REG1A 0x1a -+#define ES8336_CPHP_LDOCTL_REG1B 0x1b -+/* -+ * Calibration -+ */ -+#define ES8336_CAL_TYPE_REG1C 0x1c -+#define ES8336_CAL_SET_REG1D 0x1d -+#define ES8336_CAL_HPLIV_REG1E 0x1e -+#define ES8336_CAL_HPRIV_REG1F 0x1f -+#define ES8336_CAL_HPLMV_REG20 0x20 -+#define ES8336_CAL_HPRMV_REG21 0x21 -+/* -+ * ADC Control -+ */ -+#define ES8336_ADC_PDN_LINSEL_REG22 0x22 -+#define ES8336_ADC_PGAGAIN_REG23 0x23 -+#define ES8336_ADC_D2SEPGA_REG24 0x24 -+#define ES8336_ADC_DMIC_REG25 0x25 -+#define ES8336_ADC_MUTE_REG26 0x26 -+#define ES8336_ADC_VOLUME_REG27 0x27 -+#define ES8336_ADC_ALC1_REG29 0x29 -+#define ES8336_ADC_ALC2_REG2A 0x2a -+#define ES8336_ADC_ALC3_REG2B 0x2b -+#define ES8336_ADC_ALC4_REG2C 0x2c -+#define ES8336_ADC_ALC5_REG2D 0x2d -+#define ES8336_ADC_ALC6_REG2E 0x2e -+/* -+ * DAC Control -+ */ -+#define ES8336_DAC_PDN_REG2F 0x2f -+#define ES8336_DAC_SET1_REG30 0x30 -+#define ES8336_DAC_SET2_REG31 0x31 -+#define ES8336_DAC_SET3_REG32 0x32 -+#define ES8336_DAC_VOLL_REG33 0x33 -+#define ES8336_DAC_VOLR_REG34 0x34 -+/* -+ * GPIO -+ */ -+#define ES8336_GPIO_SEL_REG4D 0x4D -+#define ES8336_GPIO_DEBUNCE_INT_REG4E 0x4E -+#define ES8336_GPIO_FLAG 0x4F -+/* -+ * TEST MODE -+ */ -+#define ES8336_TESTMODE_REG50 0x50 -+#define ES8336_TEST1_REG51 0x51 -+#define ES8336_TEST2_REG52 0x52 -+#define ES8336_TEST3_REG53 0x53 -+ -+#define ES8336_IFACE ES8336_SDP_MS_BCKDIV_REG09 -+#define ES8336_ADC_IFACE ES8336_SDP_ADCFMT_REG0A -+#define ES8336_DAC_IFACE ES8336_SDP_DACFMT_REG0B -+ -+#define ES8336_REGNUM 84 -+ -+/* REGISTER 0X01 CLOCK MANAGER */ -+#define ES8336_CLKMGR_MCLK_DIV_MASK (0X1<<7) -+#define ES8336_CLKMGR_MCLK_DIV_NML (0X0<<7) -+#define ES8336_CLKMGR_MCLK_DIV_1 (0X1<<7) -+#define ES8336_CLKMGR_ADC_MCLK_MASK (0X1<<3) -+#define ES8336_CLKMGR_ADC_MCLK_EN (0X1<<3) -+#define ES8336_CLKMGR_ADC_MCLK_DIS (0X0<<3) -+#define ES8336_CLKMGR_DAC_MCLK_MASK (0X1<<2) -+#define ES8336_CLKMGR_DAC_MCLK_EN (0X1<<2) -+#define ES8336_CLKMGR_DAC_MCLK_DIS (0X0<<2) -+#define ES8336_CLKMGR_ADC_ANALOG_MASK (0X1<<1) -+#define ES8336_CLKMGR_ADC_ANALOG_EN (0X1<<1) -+#define ES8336_CLKMGR_ADC_ANALOG_DIS (0X0<<1) -+#define ES8336_CLKMGR_DAC_ANALOG_MASK (0X1<<0) -+#define ES8336_CLKMGR_DAC_ANALOG_EN (0X1<<0) -+#define ES8336_CLKMGR_DAC_ANALOG_DIS (0X0<<0) -+ -+/* REGISTER 0X0A */ -+#define ES8336_ADCWL_MASK (0x7 << 2) -+#define ES8336_ADCWL_32 (0x4 << 2) -+#define ES8336_ADCWL_24 (0x0 << 2) -+#define ES8336_ADCWL_20 (0x1 << 2) -+#define ES8336_ADCWL_18 (0x2 << 2) -+#define ES8336_ADCWL_16 (0x3 << 2) -+#define ES8336_ADCFMT_MASK (0x3 << 0) -+#define ES8336_ADCFMT_I2S (0x0 << 0) -+#define ES8336_ADCWL_LEFT (0x1 << 0) -+#define ES8336_ADCWL_RIGHT (0x2 << 0) -+#define ES8336_ADCWL_PCM (0x3 << 0) -+ -+/* REGISTER 0X0B */ -+#define ES8336_DACWL_MASK (0x7 << 2) -+#define ES8336_DACWL_32 (0x4 << 2) -+#define ES8336_DACWL_24 (0x0 << 2) -+#define ES8336_DACWL_20 (0x1 << 2) -+#define ES8336_DACWL_18 (0x2 << 2) -+#define ES8336_DACWL_16 (0x3 << 2) -+#define ES8336_DACFMT_MASK (0x3 << 0) -+#define ES8336_DACFMT_I2S (0x0 << 0) -+#define ES8336_DACWL_LEFT (0x1 << 0) -+#define ES8336_DACWL_RIGHT (0x2 << 0) -+#define ES8336_DACWL_PCM (0x3 << 0) ++ This selects the Phytium GMAC glue layer support for the ++ stmmac device driver. + -+#endif -diff --git a/sound/soc/codecs/es8388.c b/sound/soc/codecs/es8388.c + config DWMAC_QCOM_ETHQOS + tristate "Qualcomm ETHQOS support" + default ARCH_QCOM +diff --git a/drivers/net/ethernet/stmicro/stmmac/Makefile b/drivers/net/ethernet/stmicro/stmmac/Makefile +index 5b57aee19..91b1cf9bc 100644 +--- a/drivers/net/ethernet/stmicro/stmmac/Makefile ++++ b/drivers/net/ethernet/stmicro/stmmac/Makefile +@@ -19,6 +19,7 @@ obj-$(CONFIG_DWMAC_IPQ806X) += dwmac-ipq806x.o + obj-$(CONFIG_DWMAC_LPC18XX) += dwmac-lpc18xx.o + obj-$(CONFIG_DWMAC_MEDIATEK) += dwmac-mediatek.o + obj-$(CONFIG_DWMAC_MESON) += dwmac-meson.o dwmac-meson8b.o ++obj-$(CONFIG_DWMAC_PHYTIUM) += dwmac-phytium.o + obj-$(CONFIG_DWMAC_QCOM_ETHQOS) += dwmac-qcom-ethqos.o + obj-$(CONFIG_DWMAC_ROCKCHIP) += dwmac-rk.o + obj-$(CONFIG_DWMAC_SOCFPGA) += dwmac-altr-socfpga.o +diff --git a/drivers/net/ethernet/stmicro/stmmac/common.h b/drivers/net/ethernet/stmicro/stmmac/common.h +index b0dd8adce..e4294c606 100644 +--- a/drivers/net/ethernet/stmicro/stmmac/common.h ++++ b/drivers/net/ethernet/stmicro/stmmac/common.h +@@ -50,10 +50,10 @@ + */ + #define DMA_MIN_TX_SIZE 64 + #define DMA_MAX_TX_SIZE 1024 +-#define DMA_DEFAULT_TX_SIZE 512 ++#define DMA_DEFAULT_TX_SIZE 1024 + #define DMA_MIN_RX_SIZE 64 + #define DMA_MAX_RX_SIZE 1024 +-#define DMA_DEFAULT_RX_SIZE 512 ++#define DMA_DEFAULT_RX_SIZE 1024 + #define STMMAC_GET_ENTRY(x, size) ((x + 1) & (size - 1)) + + #undef FRAME_FILTER_DEBUG +diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c b/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c new file mode 100644 -index 000000000..11959e97e +index 000000000..6e8e44730 --- /dev/null -+++ b/sound/soc/codecs/es8388.c -@@ -0,0 +1,819 @@ ++++ b/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c +@@ -0,0 +1,221 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * es8388.c -- ES8388 ALSA SoC Audio driver ++ * Phytium DWMAC specific glue layer + * -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. ++ * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. ++ * ++ * Chen Baozi + */ + -+#include -+#include -+#include ++#include ++#include ++#include +#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "es8388.h" -+#include -+#include -+ -+static const unsigned int rates_12288[] = { -+ 8000, 12000, 16000, 24000, 32000, 48000, 96000, -+}; ++#include ++#include + -+static const int ratios_12288[] = { -+ 10, 7, 6, 4, 3, 2, 0, -+}; ++#include "stmmac.h" ++#include "stmmac_platform.h" + -+static const struct snd_pcm_hw_constraint_list constraints_12288 = { -+ .count = ARRAY_SIZE(rates_12288), -+ .list = rates_12288, -+}; ++static int phytium_get_mac_mode(struct fwnode_handle *fwnode) ++{ ++ const char *pm; ++ int err, i; + -+static const unsigned int rates_11289[] = { -+ 8018, 11025, 22050, 44100, 88200, -+}; ++ err = fwnode_property_read_string(fwnode, "mac-mode", &pm); ++ if (err < 0) ++ return err; + -+static const int ratios_11289[] = { -+ 9, 7, 4, 2, 0, -+}; ++ for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) { ++ if (!strcasecmp(pm, phy_modes(i))) ++ return i; ++ } + -+static const struct snd_pcm_hw_constraint_list constraints_11289 = { -+ .count = ARRAY_SIZE(rates_11289), -+ .list = rates_11289, -+}; ++ return -ENODEV; ++} + -+#define ES8388_RATES (SNDRV_PCM_RATE_192000 | \ -+ SNDRV_PCM_RATE_96000 | \ -+ SNDRV_PCM_RATE_88200 | \ -+ SNDRV_PCM_RATE_8000_48000) -+#define ES8388_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \ -+ SNDRV_PCM_FMTBIT_S18_3LE | \ -+ SNDRV_PCM_FMTBIT_S20_3LE | \ -+ SNDRV_PCM_FMTBIT_S24_LE | \ -+ SNDRV_PCM_FMTBIT_S32_LE) -+ -+struct es8388_priv { -+ struct regmap *regmap; -+ struct clk *clk; -+ int playback_fs; -+ bool deemph; -+ int mclkdiv2; -+ const struct snd_pcm_hw_constraint_list *sysclk_constraints; -+ const int *mclk_ratios; -+ bool master; -+}; ++static int phytium_dwmac_acpi_phy(struct plat_stmmacenet_data *plat, ++ struct fwnode_handle *np, struct device *dev) ++{ ++ plat->mdio_bus_data = devm_kzalloc(dev, sizeof(struct stmmac_mdio_bus_data), GFP_KERNEL); + -+/* -+ * ES8388 Controls -+ */ -+static const char * const adcpol_txt[] = {"Normal", "L Invert", "R Invert", -+ "L + R Invert"}; -+static SOC_ENUM_SINGLE_DECL(adcpol, -+ ES8388_ADCCONTROL6, 6, adcpol_txt); -+ -+static const DECLARE_TLV_DB_SCALE(play_tlv, -3000, 100, 0); -+static const DECLARE_TLV_DB_SCALE(dac_adc_tlv, -9600, 50, 0); -+static const DECLARE_TLV_DB_SCALE(pga_tlv, 0, 300, 0); -+static const DECLARE_TLV_DB_SCALE(bypass_tlv, -1500, 300, 0); -+static const DECLARE_TLV_DB_SCALE(mic_tlv, 0, 300, 0); -+ -+static const struct { -+ int rate; -+ unsigned int val; -+} deemph_settings[] = { -+ { 0, ES8388_DACCONTROL6_DEEMPH_OFF }, -+ { 32000, ES8388_DACCONTROL6_DEEMPH_32k }, -+ { 44100, ES8388_DACCONTROL6_DEEMPH_44_1k }, -+ { 48000, ES8388_DACCONTROL6_DEEMPH_48k }, -+}; ++ if (!plat->mdio_bus_data) ++ return -ENOMEM; ++ ++ return 0; ++} + -+static int es8388_set_deemph(struct snd_soc_component *component) ++static int phytium_dwmac_probe(struct platform_device *pdev) +{ -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ int val, i, best; ++ struct fwnode_handle *fwnode = dev_fwnode(&pdev->dev); ++ struct plat_stmmacenet_data *plat; ++ struct stmmac_resources stmmac_res; ++ struct device_node *np = pdev->dev.of_node; ++ u64 clk_freq; ++ char clk_name[20]; ++ int ret; + -+ /* -+ * If we're using deemphasis select the nearest available sample -+ * rate. -+ */ -+ if (es8388->deemph) { -+ best = 0; -+ for (i = 1; i < ARRAY_SIZE(deemph_settings); i++) { -+ if (abs(deemph_settings[i].rate - es8388->playback_fs) < -+ abs(deemph_settings[best].rate - es8388->playback_fs)) -+ best = i; -+ } ++ plat = devm_kzalloc(&pdev->dev, sizeof(*plat), GFP_KERNEL); ++ if (!plat) ++ return -ENOMEM; + -+ val = deemph_settings[best].val; -+ } else { -+ val = ES8388_DACCONTROL6_DEEMPH_OFF; -+ } ++ plat->dma_cfg = devm_kzalloc(&pdev->dev, sizeof(*plat->dma_cfg), GFP_KERNEL); ++ if (!plat->dma_cfg) ++ return -ENOMEM; + -+ dev_dbg(component->dev, "Set deemphasis %d\n", val); ++ plat->axi = devm_kzalloc(&pdev->dev, sizeof(*plat->axi), GFP_KERNEL); ++ if (!plat->axi) ++ return -ENOMEM; + -+ return snd_soc_component_update_bits(component, ES8388_DACCONTROL6, -+ ES8388_DACCONTROL6_DEEMPH_MASK, val); -+} ++ plat->phy_interface = device_get_phy_mode(&pdev->dev); ++ if (plat->phy_interface < 0) ++ return plat->phy_interface; + -+static int es8388_get_deemph(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) -+{ -+ struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); ++ plat->mac_interface = phytium_get_mac_mode(fwnode); ++ if (plat->mac_interface < 0) ++ plat->mac_interface = plat->phy_interface; ++ ++ /* Configure PHY if using device-tree */ ++ if (pdev->dev.of_node) { ++ plat->phy_node = of_parse_phandle(np, "phy-handle", 0); ++ plat->port_node = of_fwnode_handle(np); ++ } ++ ++ if (pdev->dev.of_node) { ++ plat->bus_id = of_alias_get_id(np, "ethernet"); ++ if (plat->bus_id < 0) ++ plat->bus_id = 0; ++ } else if (fwnode_property_read_u32(fwnode, "bus_id", &plat->bus_id)) { ++ plat->bus_id = 2; ++ } ++ ++ plat->phy_addr = -1; ++ plat->clk_csr = -1; ++ plat->has_gmac = 1; ++ plat->enh_desc = 1; ++ plat->bugged_jumbo = 1; ++ plat->pmt = 1; ++ plat->force_sf_dma_mode = 1; + -+ ucontrol->value.integer.value[0] = es8388->deemph; -+ return 0; -+} ++ if (fwnode_property_read_u32(fwnode, "max-speed", &plat->max_speed)) ++ plat->max_speed = -1; + -+static int es8388_put_deemph(struct snd_kcontrol *kcontrol, -+ struct snd_ctl_elem_value *ucontrol) -+{ -+ struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ unsigned int deemph = ucontrol->value.integer.value[0]; -+ int ret; ++ if (fwnode_property_read_u32(fwnode, "max-frame-size", &plat->maxmtu)) ++ plat->maxmtu = JUMBO_LEN; + -+ if (deemph > 1) -+ return -EINVAL; ++ if (fwnode_property_read_u32(fwnode, "snps,multicast-filter-bins", ++ &plat->multicast_filter_bins)) ++ plat->multicast_filter_bins = HASH_TABLE_SIZE; + -+ ret = es8388_set_deemph(component); -+ if (ret < 0) -+ return ret; ++ if (fwnode_property_read_u32(fwnode, "snps,perfect-filter-entries", ++ &plat->unicast_filter_entries)) ++ plat->unicast_filter_entries = 1; + -+ es8388->deemph = deemph; ++ if (fwnode_property_read_u32(fwnode, "tx-fifo-depth", &plat->tx_fifo_size)) ++ plat->tx_fifo_size = 0x1000; + -+ return 0; -+} ++ if (fwnode_property_read_u32(fwnode, "rx-fifo-depth", &plat->rx_fifo_size)) ++ plat->rx_fifo_size = 0x1000; + -+static const struct snd_kcontrol_new es8388_snd_controls[] = { -+ SOC_DOUBLE_R_TLV("Capture Digital Volume", -+ ES8388_ADCCONTROL8, ES8388_ADCCONTROL9, -+ 0, 0xc0, 1, dac_adc_tlv), ++ if (phytium_dwmac_acpi_phy(plat, fwnode, &pdev->dev)) ++ return -ENODEV; + -+ SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0, -+ es8388_get_deemph, es8388_put_deemph), ++ plat->rx_queues_to_use = 1; ++ plat->tx_queues_to_use = 1; ++ plat->rx_queues_cfg[0].mode_to_use = MTL_QUEUE_DCB; ++ plat->tx_queues_cfg[0].mode_to_use = MTL_QUEUE_DCB; + -+ SOC_ENUM("Capture Polarity", adcpol), ++ if (fwnode_property_read_u64(fwnode, "clock-frequency", &clk_freq)) ++ clk_freq = 125000000; + -+ SOC_SINGLE_TLV("Left Mixer Left Bypass Volume", -+ ES8388_DACCONTROL17, 3, 7, 1, bypass_tlv), -+ SOC_SINGLE_TLV("Left Mixer Right Bypass Volume", -+ ES8388_DACCONTROL19, 3, 7, 1, bypass_tlv), -+ SOC_SINGLE_TLV("Right Mixer Left Bypass Volume", -+ ES8388_DACCONTROL18, 3, 7, 1, bypass_tlv), -+ SOC_SINGLE_TLV("Right Mixer Right Bypass Volume", -+ ES8388_DACCONTROL20, 3, 7, 1, bypass_tlv), ++ /* Set system clock */ ++ snprintf(clk_name, sizeof(clk_name), "%s-%d", "stmmaceth", plat->bus_id); + -+ SOC_DOUBLE_R_TLV("PCM Volume", -+ ES8388_LDACVOL, ES8388_RDACVOL, -+ 0, ES8388_DACVOL_MAX, 1, dac_adc_tlv), ++ plat->stmmac_clk = clk_register_fixed_rate(&pdev->dev, clk_name, NULL, 0, clk_freq); ++ if (IS_ERR(plat->stmmac_clk)) { ++ dev_warn(&pdev->dev, "Fail to register stmmac-clk\n"); ++ plat->stmmac_clk = NULL; ++ } + -+ SOC_DOUBLE_R_TLV("Output 1 Playback Volume", -+ ES8388_LOUT1VOL, ES8388_ROUT1VOL, -+ 0, ES8388_OUT1VOL_MAX, 0, play_tlv), ++ ret = clk_prepare_enable(plat->stmmac_clk); ++ if (ret) { ++ clk_unregister_fixed_rate(plat->stmmac_clk); ++ return ret; ++ } + -+ SOC_DOUBLE_R_TLV("Output 2 Playback Volume", -+ ES8388_LOUT2VOL, ES8388_ROUT2VOL, -+ 0, ES8388_OUT2VOL_MAX, 0, play_tlv), ++ plat->clk_ptp_rate = clk_get_rate(plat->stmmac_clk); ++ plat->clk_ptp_ref = NULL; + -+ SOC_DOUBLE_TLV("Mic PGA Volume", ES8388_ADCCONTROL1, -+ 4, 0, 8, 0, mic_tlv), -+}; ++ if (fwnode_property_read_u32(fwnode, "snps,pbl", &plat->dma_cfg->pbl)) ++ plat->dma_cfg->pbl = 16; + -+/* -+ * DAPM Controls -+ */ -+static const char * const es8388_line_texts[] = { -+ "Line 1", "Line 2", "PGA", "Differential"}; -+ -+static const struct soc_enum es8388_lline_enum = -+ SOC_ENUM_SINGLE(ES8388_DACCONTROL16, 3, -+ ARRAY_SIZE(es8388_line_texts), -+ es8388_line_texts); -+static const struct snd_kcontrol_new es8388_left_line_controls = -+ SOC_DAPM_ENUM("Route", es8388_lline_enum); -+ -+static const struct soc_enum es8388_rline_enum = -+ SOC_ENUM_SINGLE(ES8388_DACCONTROL16, 0, -+ ARRAY_SIZE(es8388_line_texts), -+ es8388_line_texts); -+static const struct snd_kcontrol_new es8388_right_line_controls = -+ SOC_DAPM_ENUM("Route", es8388_lline_enum); -+ -+/* Left Mixer */ -+static const struct snd_kcontrol_new es8388_left_mixer_controls[] = { -+ SOC_DAPM_SINGLE("Playback Switch", ES8388_DACCONTROL17, 7, 1, 0), -+ SOC_DAPM_SINGLE("Left Bypass Switch", ES8388_DACCONTROL17, 6, 1, 0), -+ SOC_DAPM_SINGLE("Right Playback Switch", ES8388_DACCONTROL18, 7, 1, 0), -+ SOC_DAPM_SINGLE("Right Bypass Switch", ES8388_DACCONTROL18, 6, 1, 0), -+}; ++ fwnode_property_read_u32(fwnode, "snps,txpbl", &plat->dma_cfg->txpbl); ++ fwnode_property_read_u32(fwnode, "snps,rxpbl", &plat->dma_cfg->rxpbl); + -+/* Right Mixer */ -+static const struct snd_kcontrol_new es8388_right_mixer_controls[] = { -+ SOC_DAPM_SINGLE("Left Playback Switch", ES8388_DACCONTROL19, 7, 1, 0), -+ SOC_DAPM_SINGLE("Left Bypass Switch", ES8388_DACCONTROL19, 6, 1, 0), -+ SOC_DAPM_SINGLE("Playback Switch", ES8388_DACCONTROL20, 7, 1, 0), -+ SOC_DAPM_SINGLE("Right Bypass Switch", ES8388_DACCONTROL20, 6, 1, 0), -+}; ++ plat->dma_cfg->pblx8 = !fwnode_property_read_bool(fwnode, "snps,no-pbl-x8"); ++ plat->dma_cfg->aal = fwnode_property_read_bool(fwnode, "snps,aal"); ++ plat->dma_cfg->fixed_burst = fwnode_property_read_bool(fwnode, "snps,fixed-burst"); ++ plat->dma_cfg->mixed_burst = fwnode_property_read_bool(fwnode, "snps,mixed-burst"); + -+static const char * const es8388_pga_sel[] = { -+ "Line 1", "Line 2", "Line 3", "Differential"}; -+ -+/* Left PGA Mux */ -+static const struct soc_enum es8388_lpga_enum = -+ SOC_ENUM_SINGLE(ES8388_ADCCONTROL2, 6, -+ ARRAY_SIZE(es8388_pga_sel), -+ es8388_pga_sel); -+static const struct snd_kcontrol_new es8388_left_pga_controls = -+ SOC_DAPM_ENUM("Route", es8388_lpga_enum); -+ -+/* Right PGA Mux */ -+static const struct soc_enum es8388_rpga_enum = -+ SOC_ENUM_SINGLE(ES8388_ADCCONTROL2, 4, -+ ARRAY_SIZE(es8388_pga_sel), -+ es8388_pga_sel); -+static const struct snd_kcontrol_new es8388_right_pga_controls = -+ SOC_DAPM_ENUM("Route", es8388_rpga_enum); -+ -+/* Differential Mux */ -+static const char * const es8388_diff_sel[] = {"Line 1", "Line 2"}; -+static SOC_ENUM_SINGLE_DECL(diffmux, -+ ES8388_ADCCONTROL3, 7, es8388_diff_sel); -+static const struct snd_kcontrol_new es8388_diffmux_controls = -+ SOC_DAPM_ENUM("Route", diffmux); -+ -+/* Mono ADC Mux */ -+static const char * const es8388_mono_mux[] = {"Stereo", "Mono (Left)", -+ "Mono (Right)", "Digital Mono"}; -+static SOC_ENUM_SINGLE_DECL(monomux, -+ ES8388_ADCCONTROL3, 3, es8388_mono_mux); -+static const struct snd_kcontrol_new es8388_monomux_controls = -+ SOC_DAPM_ENUM("Route", monomux); -+ -+static const struct snd_soc_dapm_widget es8388_dapm_widgets[] = { -+ SND_SOC_DAPM_MUX("Differential Mux", SND_SOC_NOPM, 0, 0, -+ &es8388_diffmux_controls), -+ SND_SOC_DAPM_MUX("Left ADC Mux", SND_SOC_NOPM, 0, 0, -+ &es8388_monomux_controls), -+ SND_SOC_DAPM_MUX("Right ADC Mux", SND_SOC_NOPM, 0, 0, -+ &es8388_monomux_controls), -+ -+ SND_SOC_DAPM_MUX("Left PGA Mux", ES8388_ADCPOWER, -+ ES8388_ADCPOWER_AINL_OFF, 1, -+ &es8388_left_pga_controls), -+ SND_SOC_DAPM_MUX("Right PGA Mux", ES8388_ADCPOWER, -+ ES8388_ADCPOWER_AINR_OFF, 1, -+ &es8388_right_pga_controls), -+ -+ SND_SOC_DAPM_MUX("Left Line Mux", SND_SOC_NOPM, 0, 0, -+ &es8388_left_line_controls), -+ SND_SOC_DAPM_MUX("Right Line Mux", SND_SOC_NOPM, 0, 0, -+ &es8388_right_line_controls), -+ -+ SND_SOC_DAPM_ADC("Right ADC", "Right Capture", ES8388_ADCPOWER, -+ ES8388_ADCPOWER_ADCR_OFF, 1), -+ SND_SOC_DAPM_ADC("Left ADC", "Left Capture", ES8388_ADCPOWER, -+ ES8388_ADCPOWER_ADCL_OFF, 1), -+ -+ SND_SOC_DAPM_SUPPLY("DAC STM", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_DACSTM_RESET, 1, NULL, 0), -+ SND_SOC_DAPM_SUPPLY("ADC STM", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_ADCSTM_RESET, 1, NULL, 0), -+ -+ SND_SOC_DAPM_SUPPLY("DAC DIG", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_DACDIG_OFF, 1, NULL, 0), -+ SND_SOC_DAPM_SUPPLY("ADC DIG", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_ADCDIG_OFF, 1, NULL, 0), -+ -+ SND_SOC_DAPM_SUPPLY("DAC DLL", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_DACDLL_OFF, 1, NULL, 0), -+ SND_SOC_DAPM_SUPPLY("ADC DLL", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_ADCDLL_OFF, 1, NULL, 0), -+ -+ SND_SOC_DAPM_SUPPLY("ADC Vref", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_ADCVREF_OFF, 1, NULL, 0), -+ SND_SOC_DAPM_SUPPLY("DAC Vref", ES8388_CHIPPOWER, -+ ES8388_CHIPPOWER_DACVREF_OFF, 1, NULL, 0), -+ -+ SND_SOC_DAPM_DAC("Right DAC", "Right Playback", ES8388_DACPOWER, -+ ES8388_DACPOWER_RDAC_OFF, 1), -+ SND_SOC_DAPM_DAC("Left DAC", "Left Playback", ES8388_DACPOWER, -+ ES8388_DACPOWER_LDAC_OFF, 1), -+ -+ SND_SOC_DAPM_MIXER("Left Mixer", SND_SOC_NOPM, 0, 0, -+ &es8388_left_mixer_controls[0], -+ ARRAY_SIZE(es8388_left_mixer_controls)), -+ SND_SOC_DAPM_MIXER("Right Mixer", SND_SOC_NOPM, 0, 0, -+ &es8388_right_mixer_controls[0], -+ ARRAY_SIZE(es8388_right_mixer_controls)), -+ -+ SND_SOC_DAPM_PGA("Right Out 2", ES8388_DACPOWER, -+ ES8388_DACPOWER_ROUT2_ON, 0, NULL, 0), -+ SND_SOC_DAPM_PGA("Left Out 2", ES8388_DACPOWER, -+ ES8388_DACPOWER_LOUT2_ON, 0, NULL, 0), -+ SND_SOC_DAPM_PGA("Right Out 1", ES8388_DACPOWER, -+ ES8388_DACPOWER_ROUT1_ON, 0, NULL, 0), -+ SND_SOC_DAPM_PGA("Left Out 1", ES8388_DACPOWER, -+ ES8388_DACPOWER_LOUT1_ON, 0, NULL, 0), -+ -+ SND_SOC_DAPM_OUTPUT("LOUT1"), -+ SND_SOC_DAPM_OUTPUT("ROUT1"), -+ SND_SOC_DAPM_OUTPUT("LOUT2"), -+ SND_SOC_DAPM_OUTPUT("ROUT2"), -+ -+ SND_SOC_DAPM_INPUT("LINPUT1"), -+ SND_SOC_DAPM_INPUT("LINPUT2"), -+ SND_SOC_DAPM_INPUT("RINPUT1"), -+ SND_SOC_DAPM_INPUT("RINPUT2"), -+}; ++ plat->axi->axi_lpi_en = false; ++ plat->axi->axi_xit_frm = false; ++ plat->axi->axi_wr_osr_lmt = 7; ++ plat->axi->axi_rd_osr_lmt = 7; ++ plat->axi->axi_blen[0] = 16; + -+static const struct snd_soc_dapm_route es8388_dapm_routes[] = { -+ { "Left Line Mux", "Line 1", "LINPUT1" }, -+ { "Left Line Mux", "Line 2", "LINPUT2" }, -+ { "Left Line Mux", "PGA", "Left PGA Mux" }, -+ { "Left Line Mux", "Differential", "Differential Mux" }, -+ -+ { "Right Line Mux", "Line 1", "RINPUT1" }, -+ { "Right Line Mux", "Line 2", "RINPUT2" }, -+ { "Right Line Mux", "PGA", "Right PGA Mux" }, -+ { "Right Line Mux", "Differential", "Differential Mux" }, -+ -+ { "Left PGA Mux", "Line 1", "LINPUT1" }, -+ { "Left PGA Mux", "Line 2", "LINPUT2" }, -+ { "Left PGA Mux", "Differential", "Differential Mux" }, -+ -+ { "Right PGA Mux", "Line 1", "RINPUT1" }, -+ { "Right PGA Mux", "Line 2", "RINPUT2" }, -+ { "Right PGA Mux", "Differential", "Differential Mux" }, -+ -+ { "Differential Mux", "Line 1", "LINPUT1" }, -+ { "Differential Mux", "Line 1", "RINPUT1" }, -+ { "Differential Mux", "Line 2", "LINPUT2" }, -+ { "Differential Mux", "Line 2", "RINPUT2" }, -+ -+ { "Left ADC Mux", "Stereo", "Left PGA Mux" }, -+ { "Left ADC Mux", "Mono (Left)", "Left PGA Mux" }, -+ { "Left ADC Mux", "Digital Mono", "Left PGA Mux" }, -+ -+ { "Right ADC Mux", "Stereo", "Right PGA Mux" }, -+ { "Right ADC Mux", "Mono (Right)", "Right PGA Mux" }, -+ { "Right ADC Mux", "Digital Mono", "Right PGA Mux" }, -+ -+ { "Left ADC", NULL, "Left ADC Mux" }, -+ { "Right ADC", NULL, "Right ADC Mux" }, -+ -+ { "ADC DIG", NULL, "ADC STM" }, -+ { "ADC DIG", NULL, "ADC Vref" }, -+ { "ADC DIG", NULL, "ADC DLL" }, -+ -+ { "Left ADC", NULL, "ADC DIG" }, -+ { "Right ADC", NULL, "ADC DIG" }, -+ -+ { "Left Line Mux", "Line 1", "LINPUT1" }, -+ { "Left Line Mux", "Line 2", "LINPUT2" }, -+ { "Left Line Mux", "PGA", "Left PGA Mux" }, -+ { "Left Line Mux", "Differential", "Differential Mux" }, -+ -+ { "Right Line Mux", "Line 1", "RINPUT1" }, -+ { "Right Line Mux", "Line 2", "RINPUT2" }, -+ { "Right Line Mux", "PGA", "Right PGA Mux" }, -+ { "Right Line Mux", "Differential", "Differential Mux" }, -+ -+ { "Left Out 1", NULL, "Left DAC" }, -+ { "Right Out 1", NULL, "Right DAC" }, -+ { "Left Out 2", NULL, "Left DAC" }, -+ { "Right Out 2", NULL, "Right DAC" }, -+ -+ { "Left Mixer", "Playback Switch", "Left DAC" }, -+ { "Left Mixer", "Left Bypass Switch", "Left Line Mux" }, -+ { "Left Mixer", "Right Playback Switch", "Right DAC" }, -+ { "Left Mixer", "Right Bypass Switch", "Right Line Mux" }, -+ -+ { "Right Mixer", "Left Playback Switch", "Left DAC" }, -+ { "Right Mixer", "Left Bypass Switch", "Left Line Mux" }, -+ { "Right Mixer", "Playback Switch", "Right DAC" }, -+ { "Right Mixer", "Right Bypass Switch", "Right Line Mux" }, -+ -+ { "DAC DIG", NULL, "DAC STM" }, -+ { "DAC DIG", NULL, "DAC Vref" }, -+ { "DAC DIG", NULL, "DAC DLL" }, -+ -+ { "Left DAC", NULL, "DAC DIG" }, -+ { "Right DAC", NULL, "DAC DIG" }, -+ -+ { "Left Out 1", NULL, "Left Mixer" }, -+ { "LOUT1", NULL, "Left Out 1" }, -+ { "Right Out 1", NULL, "Right Mixer" }, -+ { "ROUT1", NULL, "Right Out 1" }, -+ -+ { "Left Out 2", NULL, "Left Mixer" }, -+ { "LOUT2", NULL, "Left Out 2" }, -+ { "Right Out 2", NULL, "Right Mixer" }, -+ { "ROUT2", NULL, "Right Out 2" }, -+}; ++ memset(&stmmac_res, 0, sizeof(stmmac_res)); ++ stmmac_res.addr = devm_platform_ioremap_resource(pdev, 0); ++ stmmac_res.irq = platform_get_irq(pdev, 0); ++ if (stmmac_res.irq < 0) { ++ dev_err(&pdev->dev, "IRQ not found.\n"); ++ return -ENXIO; ++ } ++ stmmac_res.wol_irq = stmmac_res.irq; ++ stmmac_res.lpi_irq = -1; + -+static int es8388_mute(struct snd_soc_dai *dai, int mute, int direction) -+{ -+ if (direction) -+ return snd_soc_component_update_bits(dai->component, ES8388_ADCCONTROL7, -+ ES8388_ADCCONTROL7_ADC_MUTE, -+ mute ? ES8388_ADCCONTROL7_ADC_MUTE : 0); -+ else -+ return snd_soc_component_update_bits(dai->component, ES8388_DACCONTROL3, -+ ES8388_DACCONTROL3_DACMUTE, -+ mute ? ES8388_DACCONTROL3_DACMUTE : 0); ++ return stmmac_dvr_probe(&pdev->dev, plat, &stmmac_res); +} + -+static int es8388_startup(struct snd_pcm_substream *substream, -+ struct snd_soc_dai *dai) ++int phytium_dwmac_remove(struct platform_device *pdev) +{ -+ struct snd_soc_component *component = dai->component; -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); ++ struct net_device *ndev = platform_get_drvdata(pdev); ++ struct stmmac_priv *priv = netdev_priv(ndev); ++ struct plat_stmmacenet_data *plat = priv->plat; + -+ if (es8388->master && es8388->sysclk_constraints) -+ snd_pcm_hw_constraint_list(substream->runtime, 0, -+ SNDRV_PCM_HW_PARAM_RATE, -+ es8388->sysclk_constraints); ++ stmmac_pltfr_remove(pdev); ++ clk_unregister_fixed_rate(plat->stmmac_clk); + + return 0; +} + -+static int es8388_hw_params(struct snd_pcm_substream *substream, -+ struct snd_pcm_hw_params *params, -+ struct snd_soc_dai *dai) -+{ -+ struct snd_soc_component *component = dai->component; -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ int i; -+ int reg; -+ int wl; -+ int ratio; -+ -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ reg = ES8388_DACCONTROL2; -+ else -+ reg = ES8388_ADCCONTROL5; -+ -+ if (es8388->master) { -+ if (!es8388->sysclk_constraints) { -+ dev_err(component->dev, "No MCLK configured\n"); -+ return -EINVAL; -+ } -+ -+ for (i = 0; i < es8388->sysclk_constraints->count; i++) -+ if (es8388->sysclk_constraints->list[i] == -+ params_rate(params)) -+ break; -+ -+ if (i == es8388->sysclk_constraints->count) { -+ dev_err(component->dev, -+ "LRCLK %d unsupported with current clock\n", -+ params_rate(params)); -+ return -EINVAL; -+ } -+ ratio = es8388->mclk_ratios[i]; -+ } else { -+ ratio = 0; -+ es8388->mclkdiv2 = 0; -+ } -+ -+ snd_soc_component_update_bits(component, ES8388_MASTERMODE, -+ ES8388_MASTERMODE_MCLKDIV2, -+ es8388->mclkdiv2 ? ES8388_MASTERMODE_MCLKDIV2 : 0); ++#ifdef CONFIG_OF ++static const struct of_device_id phytium_dwmac_of_match[] = { ++ { .compatible = "phytium,gmac" }, ++ { } ++}; ++MODULE_DEVICE_TABLE(of, phytium_dwmac_of_match); ++#endif + -+ switch (params_width(params)) { -+ case 16: -+ wl = 3; -+ break; -+ case 18: -+ wl = 2; -+ break; -+ case 20: -+ wl = 1; -+ break; -+ case 24: -+ wl = 0; -+ break; -+ case 32: -+ wl = 4; -+ break; -+ default: -+ return -EINVAL; -+ } ++#ifdef CONFIG_ACPI ++static const struct acpi_device_id phytium_dwmac_acpi_ids[] = { ++ { .id = "PHYT0004" }, ++ { } ++}; ++MODULE_DEVICE_TABLE(acpi, phytium_dwmac_acpi_ids); ++#endif + -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { -+ snd_soc_component_update_bits(component, ES8388_DACCONTROL1, -+ ES8388_DACCONTROL1_DACWL_MASK, -+ wl << ES8388_DACCONTROL1_DACWL_SHIFT); ++static struct platform_driver phytium_dwmac_driver = { ++ .probe = phytium_dwmac_probe, ++ .remove = phytium_dwmac_remove, ++ .driver = { ++ .name = "phytium-dwmac", ++ .pm = &stmmac_pltfr_pm_ops, ++ .of_match_table = of_match_ptr(phytium_dwmac_of_match), ++ .acpi_match_table = ACPI_PTR(phytium_dwmac_acpi_ids), ++ }, ++}; ++module_platform_driver(phytium_dwmac_driver); + -+ es8388->playback_fs = params_rate(params); -+ es8388_set_deemph(component); -+ } else -+ snd_soc_component_update_bits(component, ES8388_ADCCONTROL4, -+ ES8388_ADCCONTROL4_ADCWL_MASK, -+ wl << ES8388_ADCCONTROL4_ADCWL_SHIFT); ++MODULE_AUTHOR("Chen Baozi "); ++MODULE_DESCRIPTION("Phytium DWMAC specific glue layer"); ++MODULE_LICENSE("GPL"); +diff --git a/drivers/net/ethernet/stmicro/stmmac/norm_desc.c b/drivers/net/ethernet/stmicro/stmmac/norm_desc.c +index 68a7cfcb1..40088a390 100644 +--- a/drivers/net/ethernet/stmicro/stmmac/norm_desc.c ++++ b/drivers/net/ethernet/stmicro/stmmac/norm_desc.c +@@ -200,6 +200,10 @@ static void ndesc_prepare_tx_desc(struct dma_desc *p, int is_fs, int len, + else + norm_set_tx_desc_len_on_ring(p, len); + ++ /* The own bit must be the latest setting done when prepare the ++ * descriptor and then barrier is needed to make sure that all is coherent. ++ */ ++ wmb(); + if (tx_own) + p->des0 |= cpu_to_le32(TDES0_OWN); + } +diff --git a/drivers/net/phy/at803x.c b/drivers/net/phy/at803x.c +index ef203b080..32ac18d6e 100644 +--- a/drivers/net/phy/at803x.c ++++ b/drivers/net/phy/at803x.c +@@ -868,6 +868,9 @@ static int at803x_probe(struct phy_device *phydev) + if (ret) + return ret; + ++ /* dwmac-phytium need disable hibernate mode */ ++ priv->flags |= AT803X_DISABLE_HIBERNATION_MODE; + -+ return snd_soc_component_update_bits(component, reg, ES8388_RATEMASK, ratio); + if (phydev->drv->phy_id == ATH8031_PHY_ID) { + int ccr = phy_read(phydev, AT803X_REG_CHIP_CONFIG); + int mode_cfg; +diff --git a/drivers/net/phy/phylink.c b/drivers/net/phy/phylink.c +index b5f012619..fead84822 100644 +--- a/drivers/net/phy/phylink.c ++++ b/drivers/net/phy/phylink.c +@@ -3739,6 +3739,11 @@ static int __init phylink_init(void) + return 0; + } + ++static void __exit phylink_exit(void) ++{ +} + -+static int es8388_set_sysclk(struct snd_soc_dai *codec_dai, -+ int clk_id, unsigned int freq, int dir) -+{ -+ struct snd_soc_component *component = codec_dai->component; -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ int mclkdiv2 = 0; -+ -+ switch (freq) { -+ case 0: -+ es8388->sysclk_constraints = NULL; -+ es8388->mclk_ratios = NULL; -+ break; -+ case 22579200: -+ mclkdiv2 = 1; -+ fallthrough; -+ case 11289600: -+ es8388->sysclk_constraints = &constraints_11289; -+ es8388->mclk_ratios = ratios_11289; -+ break; -+ case 24576000: -+ mclkdiv2 = 1; -+ fallthrough; -+ case 12288000: -+ es8388->sysclk_constraints = &constraints_12288; -+ es8388->mclk_ratios = ratios_12288; -+ break; -+ default: -+ return -EINVAL; + module_init(phylink_init); ++module_exit(phylink_exit); + + MODULE_LICENSE("GPL v2"); +diff --git a/drivers/net/wireless/realtek/rtw88/mac.c b/drivers/net/wireless/realtek/rtw88/mac.c +index 298663b03..0c1c1ff31 100644 +--- a/drivers/net/wireless/realtek/rtw88/mac.c ++++ b/drivers/net/wireless/realtek/rtw88/mac.c +@@ -309,6 +309,13 @@ static int rtw_mac_power_switch(struct rtw_dev *rtwdev, bool pwr_on) + pwr_seq = pwr_on ? chip->pwr_on_seq : chip->pwr_off_seq; + ret = rtw_pwr_seq_parser(rtwdev, pwr_seq); + ++ if (pwr_on && rtw_hci_type(rtwdev) == RTW_HCI_TYPE_USB) { ++ if (chip->id == RTW_CHIP_TYPE_8822C || ++ chip->id == RTW_CHIP_TYPE_8822B || ++ chip->id == RTW_CHIP_TYPE_8821C) ++ rtw_write8_clr(rtwdev, REG_SYS_STATUS1 + 1, BIT(0)); + } + -+ es8388->mclkdiv2 = mclkdiv2; -+ return 0; -+} + if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) + rtw_write32(rtwdev, REG_SDIO_HIMR, imr); + +diff --git a/drivers/net/wireless/realtek/rtw88/rtw8821cu.c b/drivers/net/wireless/realtek/rtw88/rtw8821cu.c +index 7a5cbdc31..e2c7d9f87 100644 +--- a/drivers/net/wireless/realtek/rtw88/rtw8821cu.c ++++ b/drivers/net/wireless/realtek/rtw88/rtw8821cu.c +@@ -9,24 +9,36 @@ + #include "usb.h" + + static const struct usb_device_id rtw_8821cu_id_table[] = { +- { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb82b, 0xff, 0xff, 0xff), +- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ ++ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x2006, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, ++ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x8731, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, ++ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x8811, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb820, 0xff, 0xff, 0xff), +- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ +- { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc821, 0xff, 0xff, 0xff), +- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, ++ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb82b, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, ++ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc80c, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, ++ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc811, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc820, 0xff, 0xff, 0xff), +- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, ++ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc821, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82a, 0xff, 0xff, 0xff), +- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82b, 0xff, 0xff, 0xff), +- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ +- { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc811, 0xff, 0xff, 0xff), +- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8811CU */ +- { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x8811, 0xff, 0xff, 0xff), +- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8811CU */ +- { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x2006, 0xff, 0xff, 0xff), +- .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* TOTOLINK A650UA v3 */ ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, ++ { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82c, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, ++ { USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x331d, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* D-Link */ ++ { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xc811, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* Edimax */ ++ { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xd811, 0xff, 0xff, 0xff), ++ .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* Edimax */ + {}, + }; + MODULE_DEVICE_TABLE(usb, rtw_8821cu_id_table); +diff --git a/drivers/pci/quirks.c b/drivers/pci/quirks.c +index b5b96d2a9..4a2c10df8 100644 +--- a/drivers/pci/quirks.c ++++ b/drivers/pci/quirks.c +@@ -31,6 +31,7 @@ + #include + #include + #include ++#include + #include "pci.h" + + /* +@@ -4047,7 +4048,7 @@ static int nvme_disable_and_flr(struct pci_dev *dev, bool probe) + pcie_reset_flr(dev, PCI_RESET_PROBE) || !pci_resource_start(dev, 0)) + return -ENOTTY; + +- if (probe) ++ if (probe & !is_kdump_kernel()) + return 0; + + bar = pci_iomap(dev, 0, NVME_REG_CC + sizeof(cfg)); +@@ -4195,6 +4196,7 @@ static const struct pci_dev_reset_methods pci_dev_reset_methods[] = { + { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_IVB_M2_VGA, + reset_ivb_igd }, + { PCI_VENDOR_ID_SAMSUNG, 0xa804, nvme_disable_and_flr }, ++ { PCI_VENDOR_ID_SAMSUNG, 0xa809, nvme_disable_and_flr }, + { PCI_VENDOR_ID_INTEL, 0x0953, delay_250ms_after_flr }, + { PCI_VENDOR_ID_INTEL, 0x0a54, delay_250ms_after_flr }, + { PCI_VENDOR_ID_SOLIDIGM, 0xf1ac, delay_250ms_after_flr }, +@@ -5527,6 +5529,7 @@ DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0142, quirk_no_ext_tags); + DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0144, quirk_no_ext_tags); + DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0420, quirk_no_ext_tags); + DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, 0x0422, quirk_no_ext_tags); ++DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_PHYTIUM, 0xdc3a, quirk_no_ext_tags); + + #ifdef CONFIG_PCI_ATS + static void quirk_no_ats(struct pci_dev *pdev) +diff --git a/drivers/pci/setup-bus.c b/drivers/pci/setup-bus.c +index dae490f25..1d877793b 100644 +--- a/drivers/pci/setup-bus.c ++++ b/drivers/pci/setup-bus.c +@@ -576,6 +576,9 @@ static void pci_setup_bridge_io(struct pci_dev *bridge) + u8 io_base_lo, io_limit_lo; + u16 l; + u32 io_upper16; ++#ifdef CONFIG_ARCH_PHYTIUM ++ u32 io_base_limit = 0; ++#endif + + io_mask = PCI_IO_RANGE_MASK; + if (bridge->io_window_1k) +@@ -603,6 +606,19 @@ static void pci_setup_bridge_io(struct pci_dev *bridge) + pci_write_config_word(bridge, PCI_IO_BASE, l); + /* Update upper 16 bits of I/O base/limit */ + pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, io_upper16); + -+static int es8388_set_dai_fmt(struct snd_soc_dai *codec_dai, -+ unsigned int fmt) -+{ -+ struct snd_soc_component *component = codec_dai->component; -+ struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); -+ u8 dac_mode = 0; -+ u8 adc_mode = 0; -+ -+ switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { -+ case SND_SOC_DAIFMT_CBM_CFM: -+ /* Master serial port mode, with BCLK generated automatically */ -+ snd_soc_component_update_bits(component, ES8388_MASTERMODE, -+ ES8388_MASTERMODE_MSC, -+ ES8388_MASTERMODE_MSC); -+ es8388->master = true; -+ break; -+ case SND_SOC_DAIFMT_CBS_CFS: -+ /* Slave serial port mode */ -+ snd_soc_component_update_bits(component, ES8388_MASTERMODE, -+ ES8388_MASTERMODE_MSC, 0); -+ es8388->master = false; -+ break; -+ default: -+ return -EINVAL; ++#ifdef CONFIG_ARCH_PHYTIUM ++ if (bridge->dev.parent) { ++ if (!fwnode_property_read_u32(dev_fwnode(bridge->dev.parent), ++ "io-upper", &io_base_limit)) ++ pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, io_base_limit); + } -+ -+ /* interface format */ -+ switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { -+ case SND_SOC_DAIFMT_I2S: -+ dac_mode |= ES8388_DACCONTROL1_DACFORMAT_I2S; -+ adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_I2S; -+ break; -+ case SND_SOC_DAIFMT_RIGHT_J: -+ dac_mode |= ES8388_DACCONTROL1_DACFORMAT_RJUST; -+ adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_RJUST; -+ break; -+ case SND_SOC_DAIFMT_LEFT_J: -+ dac_mode |= ES8388_DACCONTROL1_DACFORMAT_LJUST; -+ adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_LJUST; -+ break; -+ default: -+ return -EINVAL; ++ if (bridge->dev.parent->parent) { ++ if (!fwnode_property_read_u32(dev_fwnode(bridge->dev.parent->parent), ++ "io-upper", &io_base_limit)) ++ pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, io_base_limit); + } ++#endif + } + + static void pci_setup_bridge_mmio(struct pci_dev *bridge) +diff --git a/drivers/pwm/sysfs.c b/drivers/pwm/sysfs.c +index 8d1254761..0180ee80a 100644 +--- a/drivers/pwm/sysfs.c ++++ b/drivers/pwm/sysfs.c +@@ -260,7 +260,7 @@ static int pwm_export_child(struct device *parent, struct pwm_device *pwm) + export->child.parent = parent; + export->child.devt = MKDEV(0, 0); + export->child.groups = pwm_groups; +- dev_set_name(&export->child, "pwm%u", pwm->hwpwm); ++ dev_set_name(&export->child, "pwm%u", pwm->pwm); + + ret = device_register(&export->child); + if (ret) { +diff --git a/drivers/ras/ras.c b/drivers/ras/ras.c +index 95540ea8d..e8094b931 100644 +--- a/drivers/ras/ras.c ++++ b/drivers/ras/ras.c +@@ -21,9 +21,53 @@ void log_non_standard_event(const guid_t *sec_type, const guid_t *fru_id, + trace_non_standard_event(sec_type, fru_id, fru_text, sev, err, len); + } + +-void log_arm_hw_error(struct cper_sec_proc_arm *err) ++void log_arm_hw_error(struct cper_sec_proc_arm *err, const u8 sev) + { +- trace_arm_event(err); ++ u32 pei_len; ++ u32 ctx_len = 0; ++ u32 vsei_len; ++ u8 *pei_err; ++ u8 *ctx_err; ++ u8 *ven_err_data; ++ struct cper_arm_err_info *err_info; ++ struct cper_arm_ctx_info *ctx_info; ++ int n, sz; ++ int cpu; + -+ /* clock inversion */ -+ if ((fmt & SND_SOC_DAIFMT_INV_MASK) != SND_SOC_DAIFMT_NB_NF) -+ return -EINVAL; -+ -+ snd_soc_component_update_bits(component, ES8388_DACCONTROL1, -+ ES8388_DACCONTROL1_DACFORMAT_MASK, dac_mode); -+ snd_soc_component_update_bits(component, ES8388_ADCCONTROL4, -+ ES8388_ADCCONTROL4_ADCFORMAT_MASK, adc_mode); -+ -+ return 0; -+} -+ -+static int es8388_set_bias_level(struct snd_soc_component *component, -+ enum snd_soc_bias_level level) -+{ -+ switch (level) { -+ case SND_SOC_BIAS_ON: -+ break; -+ -+ case SND_SOC_BIAS_PREPARE: -+ /* VREF, VMID=2x50k, digital enabled */ -+ snd_soc_component_write(component, ES8388_CHIPPOWER, 0); -+ snd_soc_component_update_bits(component, ES8388_CONTROL1, -+ ES8388_CONTROL1_VMIDSEL_MASK | -+ ES8388_CONTROL1_ENREF, -+ ES8388_CONTROL1_VMIDSEL_50k | -+ ES8388_CONTROL1_ENREF); -+ break; -+ -+ case SND_SOC_BIAS_STANDBY: -+ if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) { -+ snd_soc_component_update_bits(component, ES8388_CONTROL1, -+ ES8388_CONTROL1_VMIDSEL_MASK | -+ ES8388_CONTROL1_ENREF, -+ ES8388_CONTROL1_VMIDSEL_5k | -+ ES8388_CONTROL1_ENREF); -+ -+ /* Charge caps */ -+ msleep(100); -+ } -+ -+ snd_soc_component_write(component, ES8388_CONTROL2, -+ ES8388_CONTROL2_OVERCURRENT_ON | -+ ES8388_CONTROL2_THERMAL_SHUTDOWN_ON); -+ -+ /* VREF, VMID=2*500k, digital stopped */ -+ snd_soc_component_update_bits(component, ES8388_CONTROL1, -+ ES8388_CONTROL1_VMIDSEL_MASK | -+ ES8388_CONTROL1_ENREF, -+ ES8388_CONTROL1_VMIDSEL_500k | -+ ES8388_CONTROL1_ENREF); -+ break; ++ pei_len = sizeof(struct cper_arm_err_info) * err->err_info_num; ++ pei_err = (u8 *)err + sizeof(struct cper_sec_proc_arm); + -+ case SND_SOC_BIAS_OFF: -+ snd_soc_component_update_bits(component, ES8388_CONTROL1, -+ ES8388_CONTROL1_VMIDSEL_MASK | -+ ES8388_CONTROL1_ENREF, -+ 0); -+ break; ++ err_info = (struct cper_arm_err_info *)(err + 1); ++ ctx_info = (struct cper_arm_ctx_info *)(err_info + err->err_info_num); ++ ctx_err = (u8 *)ctx_info; ++ for (n = 0; n < err->context_info_num; n++) { ++ sz = sizeof(struct cper_arm_ctx_info) + ctx_info->size; ++ ctx_info = (struct cper_arm_ctx_info *)((long)ctx_info + sz); ++ ctx_len += sz; + } -+ return 0; -+} -+ -+static const struct snd_soc_dai_ops es8388_dai_ops = { -+ .startup = es8388_startup, -+ .hw_params = es8388_hw_params, -+ .mute_stream = es8388_mute, -+ .set_sysclk = es8388_set_sysclk, -+ .set_fmt = es8388_set_dai_fmt, -+ .no_capture_mute = 1, -+}; + -+static struct snd_soc_dai_driver es8388_dai = { -+ .name = "es8388-hifi", -+ .playback = { -+ .stream_name = "Playback", -+ .channels_min = 2, -+ .channels_max = 2, -+ .rates = ES8388_RATES, -+ .formats = ES8388_FORMATS, -+ }, -+ .capture = { -+ .stream_name = "Capture", -+ .channels_min = 2, -+ .channels_max = 2, -+ .rates = ES8388_RATES, -+ .formats = ES8388_FORMATS, -+ }, -+ .ops = &es8388_dai_ops, -+ .symmetric_rate = 1, -+}; -+ -+static int es8388_suspend(struct snd_soc_component *component) -+{ -+ return 0; -+} -+ -+static int es8388_resume(struct snd_soc_component *component) -+{ -+ struct regmap *regmap = dev_get_regmap(component->dev, NULL); -+ struct es8388_priv *es8388; -+ int ret; -+ -+ es8388 = snd_soc_component_get_drvdata(component); ++ vsei_len = err->section_length - (sizeof(struct cper_sec_proc_arm) + ++ pei_len + ctx_len); + -+ regcache_mark_dirty(regmap); -+ ret = regcache_sync(regmap); -+ if (ret) { -+ dev_err(component->dev, "unable to sync regcache\n"); -+ return ret; ++ if (vsei_len < 0) { ++ pr_warn(FW_BUG ++ "section length: %d\n", err->section_length); ++ pr_warn(FW_BUG ++ "section length is too small\n"); ++ pr_warn(FW_BUG ++ "firmware-generated error record is incorrect\n"); ++ vsei_len = 0; + } ++ ven_err_data = (u8 *)ctx_info; + -+ return 0; -+} -+ -+static int es8388_component_probe(struct snd_soc_component *component) -+{ -+ snd_soc_component_write(component, ES8388_ADCPOWER, 0xf0); -+ snd_soc_component_write(component, ES8388_CONTROL1, 0x30); -+ snd_soc_component_write(component, ES8388_DACCONTROL21, 0x80); -+ snd_soc_component_write(component, ES8388_ADCCONTROL10, 0xda); -+ -+ return 0; -+} -+ -+static void es8388_remove(struct snd_soc_component *component) -+{ -+} -+ -+const struct regmap_config es8388_regmap_config = { -+ .reg_bits = 8, -+ .val_bits = 8, -+ .max_register = ES8388_REG_MAX, -+ .cache_type = REGCACHE_RBTREE, -+ .use_single_read = true, -+ .use_single_write = true, -+}; -+EXPORT_SYMBOL_GPL(es8388_regmap_config); -+ -+static const struct snd_soc_component_driver es8388_component_driver = { -+ .probe = es8388_component_probe, -+ .remove = es8388_remove, -+ .suspend = es8388_suspend, -+ .resume = es8388_resume, -+ .set_bias_level = es8388_set_bias_level, -+ .controls = es8388_snd_controls, -+ .num_controls = ARRAY_SIZE(es8388_snd_controls), -+ .dapm_widgets = es8388_dapm_widgets, -+ .num_dapm_widgets = ARRAY_SIZE(es8388_dapm_widgets), -+ .dapm_routes = es8388_dapm_routes, -+ .num_dapm_routes = ARRAY_SIZE(es8388_dapm_routes), -+ .suspend_bias_off = 1, -+ .idle_bias_on = 1, -+ .use_pmdown_time = 1, -+ .endianness = 1, -+}; -+ -+int es8388_probe(struct device *dev, struct regmap *regmap) -+{ -+ struct es8388_priv *es8388; -+ -+ if (IS_ERR(regmap)) -+ return PTR_ERR(regmap); -+ -+ es8388 = devm_kzalloc(dev, sizeof(*es8388), GFP_KERNEL); -+ if (es8388 == NULL) -+ return -ENOMEM; -+ -+ es8388->regmap = regmap; -+ -+ dev_set_drvdata(dev, es8388); -+ -+ return devm_snd_soc_register_component(dev, -+ &es8388_component_driver, &es8388_dai, 1); -+} -+EXPORT_SYMBOL_GPL(es8388_probe); ++ cpu = GET_LOGICAL_INDEX(err->mpidr); ++ /* when return value is invalid, set cpu index to -1 */ ++ if (cpu < 0) ++ cpu = -1; + -+static const struct i2c_device_id es8388_id[] = { -+ { "es8388", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(i2c, es8388_id); + -+static const struct of_device_id es8388_of_match[] = { -+ { .compatible = "everest,es8388", }, ++ trace_arm_event(err, pei_err, pei_len, ctx_err, ctx_len, ++ ven_err_data, vsei_len, sev, cpu); + } + + static int __init ras_init(void) +diff --git a/drivers/rtc/rtc-ds1307.c b/drivers/rtc/rtc-ds1307.c +index 506b7d1c2..479706161 100644 +--- a/drivers/rtc/rtc-ds1307.c ++++ b/drivers/rtc/rtc-ds1307.c +@@ -8,12 +8,14 @@ + * Copyright (C) 2012 Bertrand Achard (nvram access fixes) + */ + ++#include + #include + #include + #include + #include + #include + #include ++#include + #include + #include + #include +@@ -1146,6 +1148,31 @@ static const struct of_device_id ds1307_of_match[] = { + }; + MODULE_DEVICE_TABLE(of, ds1307_of_match); + ++#ifdef CONFIG_ACPI ++static const struct acpi_device_id ds1307_acpi_ids[] = { ++ { .id = "DS1307", .driver_data = ds_1307 }, ++ { .id = "DS1308", .driver_data = ds_1308 }, ++ { .id = "DS1337", .driver_data = ds_1337 }, ++ { .id = "DS1338", .driver_data = ds_1338 }, ++ { .id = "DS1339", .driver_data = ds_1339 }, ++ { .id = "DS1388", .driver_data = ds_1388 }, ++ { .id = "DS1340", .driver_data = ds_1340 }, ++ { .id = "DS1341", .driver_data = ds_1341 }, ++ { .id = "DS3231", .driver_data = ds_3231 }, ++ { .id = "M41T0", .driver_data = m41t0 }, ++ { .id = "M41T00", .driver_data = m41t00 }, ++ { .id = "M41T11", .driver_data = m41t11 }, ++ { .id = "MCP7940X", .driver_data = mcp794xx }, ++ { .id = "MCP7941X", .driver_data = mcp794xx }, ++ { .id = "PT7C4338", .driver_data = ds_1307 }, ++ { .id = "RX8025", .driver_data = rx_8025 }, ++ { .id = "ISL12057", .driver_data = ds_1337 }, ++ { .id = "RX8130", .driver_data = rx_8130 }, + { } +}; -+MODULE_DEVICE_TABLE(of, es8388_of_match); -+ -+static struct acpi_device_id es8388_acpi_match[] = { -+ {"ESSX8388", 0 }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(acpi, es8388_acpi_match); -+ -+static int es8388_i2c_probe(struct i2c_client *i2c) -+{ -+ return es8388_probe(&i2c->dev, -+ devm_regmap_init_i2c(i2c, &es8388_regmap_config)); -+} -+ -+static struct i2c_driver es8388_i2c_driver = { -+ .driver = { -+ .name = "es8388", -+ .of_match_table = es8388_of_match, -+ .acpi_match_table = es8388_acpi_match, -+ }, -+ .probe = es8388_i2c_probe, -+ .id_table = es8388_id, -+}; -+ -+module_i2c_driver(es8388_i2c_driver); ++MODULE_DEVICE_TABLE(acpi, ds1307_acpi_ids); ++#endif + -+MODULE_DESCRIPTION("ASoC ES8388 driver"); -+MODULE_AUTHOR("Yiqun Zhang "); -+MODULE_LICENSE("GPL"); -diff --git a/sound/soc/codecs/es8388.h b/sound/soc/codecs/es8388.h -new file mode 100644 -index 000000000..5858a7126 ---- /dev/null -+++ b/sound/soc/codecs/es8388.h -@@ -0,0 +1,290 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * es8388.h -- ES8388 ALSA SoC Audio driver -+ */ + /* + * The ds1337 and ds1339 both have two alarms, but we only use the first + * one (with a "seconds" field). For ds1337 we expect nINTA is our alarm +@@ -2010,6 +2037,7 @@ static struct i2c_driver ds1307_driver = { + .driver = { + .name = "rtc-ds1307", + .of_match_table = ds1307_of_match, ++ .acpi_match_table = ACPI_PTR(ds1307_acpi_ids), + }, + .probe = ds1307_probe, + .id_table = ds1307_id, +diff --git a/drivers/tee/optee/Kconfig b/drivers/tee/optee/Kconfig +index 70898bbd5..dc097c286 100644 +--- a/drivers/tee/optee/Kconfig ++++ b/drivers/tee/optee/Kconfig +@@ -24,3 +24,33 @@ config OPTEE_INSECURE_LOAD_IMAGE + + Additional documentation on kernel security risks are at + Documentation/staging/tee.rst. + -+#ifndef _ES8388_H -+#define _ES8388_H -+ -+#include -+ -+struct device; -+ -+extern const struct regmap_config es8388_regmap_config; -+int es8388_probe(struct device *dev, struct regmap *regmap); -+ -+#define ES8388_DACLVOL 46 -+#define ES8388_DACRVOL 47 -+#define ES8388_DACCTL 28 -+#define ES8388_RATEMASK (0x1f << 0) -+ -+#define ES8388_CONTROL1 0x00 -+#define ES8388_CONTROL1_VMIDSEL_OFF (0 << 0) -+#define ES8388_CONTROL1_VMIDSEL_50k (1 << 0) -+#define ES8388_CONTROL1_VMIDSEL_500k (2 << 0) -+#define ES8388_CONTROL1_VMIDSEL_5k (3 << 0) -+#define ES8388_CONTROL1_VMIDSEL_MASK (3 << 0) -+#define ES8388_CONTROL1_ENREF (1 << 2) -+#define ES8388_CONTROL1_SEQEN (1 << 3) -+#define ES8388_CONTROL1_SAMEFS (1 << 4) -+#define ES8388_CONTROL1_DACMCLK_ADC (0 << 5) -+#define ES8388_CONTROL1_DACMCLK_DAC (1 << 5) -+#define ES8388_CONTROL1_LRCM (1 << 6) -+#define ES8388_CONTROL1_SCP_RESET (1 << 7) -+ -+#define ES8388_CONTROL2 0x01 -+#define ES8388_CONTROL2_VREF_BUF_OFF (1 << 0) -+#define ES8388_CONTROL2_VREF_LOWPOWER (1 << 1) -+#define ES8388_CONTROL2_IBIASGEN_OFF (1 << 2) -+#define ES8388_CONTROL2_ANALOG_OFF (1 << 3) -+#define ES8388_CONTROL2_VREF_BUF_LOWPOWER (1 << 4) -+#define ES8388_CONTROL2_VCM_MOD_LOWPOWER (1 << 5) -+#define ES8388_CONTROL2_OVERCURRENT_ON (1 << 6) -+#define ES8388_CONTROL2_THERMAL_SHUTDOWN_ON (1 << 7) -+ -+#define ES8388_CHIPPOWER 0x02 -+#define ES8388_CHIPPOWER_DACVREF_OFF 0 -+#define ES8388_CHIPPOWER_ADCVREF_OFF 1 -+#define ES8388_CHIPPOWER_DACDLL_OFF 2 -+#define ES8388_CHIPPOWER_ADCDLL_OFF 3 -+#define ES8388_CHIPPOWER_DACSTM_RESET 4 -+#define ES8388_CHIPPOWER_ADCSTM_RESET 5 -+#define ES8388_CHIPPOWER_DACDIG_OFF 6 -+#define ES8388_CHIPPOWER_ADCDIG_OFF 7 -+ -+#define ES8388_ADCPOWER 0x03 -+#define ES8388_ADCPOWER_INT1_LOWPOWER 0 -+#define ES8388_ADCPOWER_FLASH_ADC_LOWPOWER 1 -+#define ES8388_ADCPOWER_ADC_BIAS_GEN_OFF 2 -+#define ES8388_ADCPOWER_MIC_BIAS_OFF 3 -+#define ES8388_ADCPOWER_ADCR_OFF 4 -+#define ES8388_ADCPOWER_ADCL_OFF 5 -+#define ES8388_ADCPOWER_AINR_OFF 6 -+#define ES8388_ADCPOWER_AINL_OFF 7 -+ -+#define ES8388_DACPOWER 0x04 -+#define ES8388_DACPOWER_OUT3_ON 0 -+#define ES8388_DACPOWER_MONO_ON 1 -+#define ES8388_DACPOWER_ROUT2_ON 2 -+#define ES8388_DACPOWER_LOUT2_ON 3 -+#define ES8388_DACPOWER_ROUT1_ON 4 -+#define ES8388_DACPOWER_LOUT1_ON 5 -+#define ES8388_DACPOWER_RDAC_OFF 6 -+#define ES8388_DACPOWER_LDAC_OFF 7 -+ -+#define ES8388_CHIPLOPOW1 0x05 -+#define ES8388_CHIPLOPOW2 0x06 -+#define ES8388_ANAVOLMANAG 0x07 -+ -+#define ES8388_MASTERMODE 0x08 -+#define ES8388_MASTERMODE_BCLKDIV (0 << 0) -+#define ES8388_MASTERMODE_BCLK_INV (1 << 5) -+#define ES8388_MASTERMODE_MCLKDIV2 (1 << 6) -+#define ES8388_MASTERMODE_MSC (1 << 7) -+ -+#define ES8388_ADCCONTROL1 0x09 -+#define ES8388_ADCCONTROL2 0x0a -+#define ES8388_ADCCONTROL3 0x0b -+ -+#define ES8388_ADCCONTROL4 0x0c -+#define ES8388_ADCCONTROL4_ADCFORMAT_MASK (3 << 0) -+#define ES8388_ADCCONTROL4_ADCFORMAT_I2S (0 << 0) -+#define ES8388_ADCCONTROL4_ADCFORMAT_LJUST (1 << 0) -+#define ES8388_ADCCONTROL4_ADCFORMAT_RJUST (2 << 0) -+#define ES8388_ADCCONTROL4_ADCFORMAT_PCM (3 << 0) -+#define ES8388_ADCCONTROL4_ADCWL_SHIFT 2 -+#define ES8388_ADCCONTROL4_ADCWL_MASK (7 << 2) -+#define ES8388_ADCCONTROL4_ADCLRP_I2S_POL_NORMAL (0 << 5) -+#define ES8388_ADCCONTROL4_ADCLRP_I2S_POL_INV (1 << 5) -+#define ES8388_ADCCONTROL4_ADCLRP_PCM_MSB_CLK2 (0 << 5) -+#define ES8388_ADCCONTROL4_ADCLRP_PCM_MSB_CLK1 (1 << 5) -+ -+#define ES8388_ADCCONTROL5 0x0d -+#define ES8388_ADCCONTROL5_RATEMASK (0x1f << 0) -+ -+#define ES8388_ADCCONTROL6 0x0e -+ -+#define ES8388_ADCCONTROL7 0x0f -+#define ES8388_ADCCONTROL7_ADC_MUTE (1 << 2) -+#define ES8388_ADCCONTROL7_ADC_LER (1 << 3) -+#define ES8388_ADCCONTROL7_ADC_ZERO_CROSS (1 << 4) -+#define ES8388_ADCCONTROL7_ADC_SOFT_RAMP (1 << 5) -+#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_4 (0 << 6) -+#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_8 (1 << 6) -+#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_16 (2 << 6) -+#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_32 (3 << 6) -+ -+#define ES8388_ADCCONTROL8 0x10 -+#define ES8388_ADCCONTROL9 0x11 -+#define ES8388_ADCCONTROL10 0x12 -+#define ES8388_ADCCONTROL11 0x13 -+#define ES8388_ADCCONTROL12 0x14 -+#define ES8388_ADCCONTROL13 0x15 -+#define ES8388_ADCCONTROL14 0x16 -+ -+#define ES8388_DACCONTROL1 0x17 -+#define ES8388_DACCONTROL1_DACFORMAT_MASK (3 << 1) -+#define ES8388_DACCONTROL1_DACFORMAT_I2S (0 << 1) -+#define ES8388_DACCONTROL1_DACFORMAT_LJUST (1 << 1) -+#define ES8388_DACCONTROL1_DACFORMAT_RJUST (2 << 1) -+#define ES8388_DACCONTROL1_DACFORMAT_PCM (3 << 1) -+#define ES8388_DACCONTROL1_DACWL_SHIFT 3 -+#define ES8388_DACCONTROL1_DACWL_MASK (7 << 3) -+#define ES8388_DACCONTROL1_DACLRP_I2S_POL_NORMAL (0 << 6) -+#define ES8388_DACCONTROL1_DACLRP_I2S_POL_INV (1 << 6) -+#define ES8388_DACCONTROL1_DACLRP_PCM_MSB_CLK2 (0 << 6) -+#define ES8388_DACCONTROL1_DACLRP_PCM_MSB_CLK1 (1 << 6) -+#define ES8388_DACCONTROL1_LRSWAP (1 << 7) -+ -+#define ES8388_DACCONTROL2 0x18 -+#define ES8388_DACCONTROL2_RATEMASK (0x1f << 0) -+#define ES8388_DACCONTROL2_DOUBLESPEED (1 << 5) -+ -+#define ES8388_DACCONTROL3 0x19 -+#define ES8388_DACCONTROL3_AUTOMUTE (1 << 2) -+#define ES8388_DACCONTROL3_DACMUTE (1 << 2) -+#define ES8388_DACCONTROL3_LEFTGAINVOL (1 << 3) -+#define ES8388_DACCONTROL3_DACZEROCROSS (1 << 4) -+#define ES8388_DACCONTROL3_DACSOFTRAMP (1 << 5) -+#define ES8388_DACCONTROL3_DACRAMPRATE (3 << 6) -+ -+#define ES8388_LDACVOL 0x1a -+#define ES8388_LDACVOL_MASK (0 << 0) -+#define ES8388_LDACVOL_MAX (0xc0) -+ -+#define ES8388_RDACVOL 0x1b -+#define ES8388_RDACVOL_MASK (0 << 0) -+#define ES8388_RDACVOL_MAX (0xc0) -+ -+#define ES8388_DACVOL_MAX (0xc0) -+ -+#define ES8388_DACCONTROL4 0x1a -+#define ES8388_DACCONTROL5 0x1b -+ -+#define ES8388_DACCONTROL6 0x1c -+#define ES8388_DACCONTROL6_CLICKFREE (1 << 3) -+#define ES8388_DACCONTROL6_DAC_INVR (1 << 4) -+#define ES8388_DACCONTROL6_DAC_INVL (1 << 5) -+#define ES8388_DACCONTROL6_DEEMPH_MASK (3 << 6) -+#define ES8388_DACCONTROL6_DEEMPH_OFF (0 << 6) -+#define ES8388_DACCONTROL6_DEEMPH_32k (1 << 6) -+#define ES8388_DACCONTROL6_DEEMPH_44_1k (2 << 6) -+#define ES8388_DACCONTROL6_DEEMPH_48k (3 << 6) -+ -+#define ES8388_DACCONTROL7 0x1d -+#define ES8388_DACCONTROL7_VPP_SCALE_3p5 (0 << 0) -+#define ES8388_DACCONTROL7_VPP_SCALE_4p0 (1 << 0) -+#define ES8388_DACCONTROL7_VPP_SCALE_3p0 (2 << 0) -+#define ES8388_DACCONTROL7_VPP_SCALE_2p5 (3 << 0) -+#define ES8388_DACCONTROL7_SHELVING_STRENGTH (1 << 2) /* In eights */ -+#define ES8388_DACCONTROL7_MONO (1 << 5) -+#define ES8388_DACCONTROL7_ZEROR (1 << 6) -+#define ES8388_DACCONTROL7_ZEROL (1 << 7) -+ -+/* Shelving filter */ -+#define ES8388_DACCONTROL8 0x1e -+#define ES8388_DACCONTROL9 0x1f -+#define ES8388_DACCONTROL10 0x20 -+#define ES8388_DACCONTROL11 0x21 -+#define ES8388_DACCONTROL12 0x22 -+#define ES8388_DACCONTROL13 0x23 -+#define ES8388_DACCONTROL14 0x24 -+#define ES8388_DACCONTROL15 0x25 -+ -+#define ES8388_DACCONTROL16 0x26 -+#define ES8388_DACCONTROL16_RMIXSEL_RIN1 (0 << 0) -+#define ES8388_DACCONTROL16_RMIXSEL_RIN2 (1 << 0) -+#define ES8388_DACCONTROL16_RMIXSEL_RIN3 (2 << 0) -+#define ES8388_DACCONTROL16_RMIXSEL_RADC (3 << 0) -+#define ES8388_DACCONTROL16_LMIXSEL_LIN1 (0 << 3) -+#define ES8388_DACCONTROL16_LMIXSEL_LIN2 (1 << 3) -+#define ES8388_DACCONTROL16_LMIXSEL_LIN3 (2 << 3) -+#define ES8388_DACCONTROL16_LMIXSEL_LADC (3 << 3) -+ -+#define ES8388_DACCONTROL17 0x27 -+#define ES8388_DACCONTROL17_LI2LOVOL (7 << 3) -+#define ES8388_DACCONTROL17_LI2LO (1 << 6) -+#define ES8388_DACCONTROL17_LD2LO (1 << 7) -+ -+#define ES8388_DACCONTROL18 0x28 -+#define ES8388_DACCONTROL18_RI2LOVOL (7 << 3) -+#define ES8388_DACCONTROL18_RI2LO (1 << 6) -+#define ES8388_DACCONTROL18_RD2LO (1 << 7) -+ -+#define ES8388_DACCONTROL19 0x29 -+#define ES8388_DACCONTROL19_LI2ROVOL (7 << 3) -+#define ES8388_DACCONTROL19_LI2RO (1 << 6) -+#define ES8388_DACCONTROL19_LD2RO (1 << 7) -+ -+#define ES8388_DACCONTROL20 0x2a -+#define ES8388_DACCONTROL20_RI2ROVOL (7 << 3) -+#define ES8388_DACCONTROL20_RI2RO (1 << 6) -+#define ES8388_DACCONTROL20_RD2RO (1 << 7) -+ -+#define ES8388_DACCONTROL21 0x2b -+#define ES8388_DACCONTROL21_LI2MOVOL (7 << 3) -+#define ES8388_DACCONTROL21_LI2MO (1 << 6) -+#define ES8388_DACCONTROL21_LD2MO (1 << 7) -+ -+#define ES8388_DACCONTROL22 0x2c -+#define ES8388_DACCONTROL22_RI2MOVOL (7 << 3) -+#define ES8388_DACCONTROL22_RI2MO (1 << 6) -+#define ES8388_DACCONTROL22_RD2MO (1 << 7) -+ -+#define ES8388_DACCONTROL23 0x2d -+#define ES8388_DACCONTROL23_MOUTINV (1 << 1) -+#define ES8388_DACCONTROL23_HPSWPOL (1 << 2) -+#define ES8388_DACCONTROL23_HPSWEN (1 << 3) -+#define ES8388_DACCONTROL23_VROI_1p5k (0 << 4) -+#define ES8388_DACCONTROL23_VROI_40k (1 << 4) -+#define ES8388_DACCONTROL23_OUT3_VREF (0 << 5) -+#define ES8388_DACCONTROL23_OUT3_ROUT1 (1 << 5) -+#define ES8388_DACCONTROL23_OUT3_MONOOUT (2 << 5) -+#define ES8388_DACCONTROL23_OUT3_RIGHT_MIXER (3 << 5) -+#define ES8388_DACCONTROL23_ROUT2INV (1 << 7) -+ -+/* LOUT1 Amplifier */ -+#define ES8388_LOUT1VOL 0x2e -+#define ES8388_LOUT1VOL_MASK (0 << 5) -+#define ES8388_LOUT1VOL_MAX (0x24) -+ -+/* ROUT1 Amplifier */ -+#define ES8388_ROUT1VOL 0x2f -+#define ES8388_ROUT1VOL_MASK (0 << 5) -+#define ES8388_ROUT1VOL_MAX (0x24) -+ -+#define ES8388_OUT1VOL_MAX (0x24) -+ -+/* LOUT2 Amplifier */ -+#define ES8388_LOUT2VOL 0x30 -+#define ES8388_LOUT2VOL_MASK (0 << 5) -+#define ES8388_LOUT2VOL_MAX (0x24) -+ -+/* ROUT2 Amplifier */ -+#define ES8388_ROUT2VOL 0x31 -+#define ES8388_ROUT2VOL_MASK (0 << 5) -+#define ES8388_ROUT2VOL_MAX (0x24) -+ -+#define ES8388_OUT2VOL_MAX (0x24) -+ -+/* Mono Out Amplifier */ -+#define ES8388_MONOOUTVOL 0x32 -+#define ES8388_MONOOUTVOL_MASK (0 << 5) -+#define ES8388_MONOOUTVOL_MAX (0x24) -+ -+#define ES8388_DACCONTROL29 0x33 -+#define ES8388_DACCONTROL30 0x34 -+ -+#define ES8388_SYSCLK 0 -+ -+#define ES8388_REG_MAX 0x35 -+ -+#define ES8388_1536FS 1536 -+#define ES8388_1024FS 1024 -+#define ES8388_768FS 768 -+#define ES8388_512FS 512 -+#define ES8388_384FS 384 -+#define ES8388_256FS 256 -+#define ES8388_128FS 128 ++if OPTEE + -+#endif -diff --git a/sound/soc/phytium/Kconfig b/sound/soc/phytium/Kconfig -new file mode 100644 -index 000000000..b4fd9ae0b ---- /dev/null -+++ b/sound/soc/phytium/Kconfig -@@ -0,0 +1,32 @@ -+# SPDX-License-Identifier: GPL-2.0 -+config SND_SOC_PHYTIUM_I2S -+ tristate "Phytium I2S Device Driver" -+ depends on ARCH_PHYTIUM -+ help -+ Say Y or M if you want to add support for I2S driver for -+ Phytium I2S device . The device supports 2 channels each -+ for play and record. -+ -+config SND_PMDK_ES8388 -+ tristate "Phytium machine support with ES8388" -+ depends on I2C && SND_SOC_PHYTIUM_I2S -+ select SND_SOC_ES8388 ++choice ++ prompt "Default conduit method" ++ default OPTEE_DEFAULT_METHOD_NONE + help -+ Say Y if you want to add Phytium machine support for -+ ES8388 codecs. ++ This option sets the default conduit method for OP-TEE in case ++ firmware misses "method" property. If in doubt, select "none" ++ which depends on firmware to provide the value. + -+config SND_PMDK_ES8336 -+ tristate "Phytium machine support with ES8336" -+ depends on I2C && SND_SOC_PHYTIUM_I2S -+ select SND_SOC_ES8336 ++config OPTEE_DEFAULT_METHOD_NONE ++ bool "none" + help -+ Say Y if you want to add Phytium machine support for -+ ES8336 codecs. ++ There is no default conduit method used by the driver. Require ++ firmware to provide the method explicitly. + -+config SND_PMDK_DP -+ tristate "Phytium machine support with DP" -+ depends on I2C && SND_SOC_PHYTIUM_I2S -+ select SND_SOC_HDMI_CODEC ++config OPTEE_DEFAULT_METHOD_HVC ++ bool "hvc" + help -+ Say Y if you want to add Phytium machine support for -+ Displayport. -diff --git a/sound/soc/phytium/Makefile b/sound/soc/phytium/Makefile -new file mode 100644 -index 000000000..45cd2ed9d ---- /dev/null -+++ b/sound/soc/phytium/Makefile -@@ -0,0 +1,14 @@ -+# SPDX-License-Identifier: GPL-2.0 -+# PHYTIUM Platform Support -+ -+snd-soc-phytium-i2s-objs :=phytium_i2s.o -+obj-$(CONFIG_SND_SOC_PHYTIUM_I2S) += snd-soc-phytium-i2s.o -+ -+snd-soc-pmdk-es8388-objs :=pmdk_es8388.o -+obj-$(CONFIG_SND_PMDK_ES8388) += snd-soc-pmdk-es8388.o -+ -+snd-soc-pmdk-es8336-objs :=pmdk_es8336.o -+obj-$(CONFIG_SND_PMDK_ES8336) += snd-soc-pmdk-es8336.o -+ -+snd-soc-pmdk-dp-objs :=pmdk_dp.o -+obj-$(CONFIG_SND_PMDK_DP) += snd-soc-pmdk-dp.o -diff --git a/sound/soc/phytium/local.h b/sound/soc/phytium/local.h -new file mode 100644 -index 000000000..8cc80d1d1 ---- /dev/null -+++ b/sound/soc/phytium/local.h -@@ -0,0 +1,319 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#ifndef __PHYTIUM_I2S_LOCAL_H -+#define __PHYTIUM_I2S_LOCAL_H -+ -+#include -+#include -+#include -+#include -+ -+/* I2S clk setting*/ -+#define CLK_CFG0 0xc00 -+#define CLK_CFG1 0xc04 -+ -+/* Common register for all channel */ -+#define I2S_IER 0x000 -+#define IRER 0x004 -+#define ITER 0x008 -+#define CER 0x00C -+ -+#define RXFFR 0x014 -+#define TXFFR 0x018 -+ -+/* Interrupt status register fields */ -+#define ISR_TXFO BIT(5) -+#define ISR_TXFE BIT(4) -+#define ISR_RXFO BIT(1) -+#define ISR_RXDA BIT(0) -+ -+/* I2STxRxRegisters for all channels */ -+#define LRBR_LTHR(x) (0x40 * x + 0x020) -+#define RRBR_RTHR(x) (0x40 * x + 0x024) -+#define RER(x) (0x40 * x + 0x028) -+ -+#define RCR(x) (0x40 * x + 0x030) -+ -+#define ISR(x) (0x40 * x + 0x038) -+#define IMR(x) (0x40 * x + 0x03C) -+#define ROR(x) (0x40 * x + 0x040) -+#define TOR(x) (0x40 * x + 0x044) -+#define RFCR(x) (0x40 * x + 0x048) -+#define TFCR(x) (0x40 * x + 0x04C) -+#define RFF(x) (0x40 * x + 0x050) -+#define TFF(x) (0x40 * x + 0x054) -+ -+/* Enable txd and rxd block channel0~3 */ -+#define TER(x) (0x40 * x + 0x02C) -+#define CCR 0x010 -+#define TCR(x) (0x40 * x + 0x034) ++ Use the "hvc" as default conduit method. + -+/* I2SCOMPRegisters */ -+#define I2S_COMP_PARAM_2 0x01F0 -+#define I2S_COMP_PARAM_1 0x01F4 -+#define I2S_COMP_VERSION 0x01F8 -+#define I2S_COMP_TYPE 0x01FC ++config OPTEE_DEFAULT_METHOD_SMC ++ bool "smc" ++ help ++ Use the "hvc" as default conduit method. + -+/* I2S AND DMA */ -+#define DMA_GCAP 0x0024 ++endchoice + -+#define DMA_CHAL_CONFG1 0x0028 ++endif +diff --git a/drivers/tee/optee/smc_abi.c b/drivers/tee/optee/smc_abi.c +index d5b28fd35..e2b16275d 100644 +--- a/drivers/tee/optee/smc_abi.c ++++ b/drivers/tee/optee/smc_abi.c +@@ -6,6 +6,7 @@ + + #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt + ++#include + #include + #include + #include +@@ -1424,6 +1425,14 @@ static void optee_smccc_hvc(unsigned long a0, unsigned long a1, + arm_smccc_hvc(a0, a1, a2, a3, a4, a5, a6, a7, res); + } + ++#if defined(CONFIG_OPTEE_DEFAULT_METHOD_HVC) ++#define DEFAULT_CONDUIT_METHOD optee_smccc_hvc ++#elif defined(CONFIG_OPTEE_DEFAULT_METHOD_SMC) ++#define DEFAULT_CONDUIT_METHOD optee_smccc_smc ++#else ++#define DEFAULT_CONDUIT_METHOD ERR_PTR(-ENXIO) ++#endif + -+#define DMA_CHAL_CONFG0 0x0004 -+#define DMA_MASK_INT 0x000c -+#define DMA_BDLPU(x) (0x40 * x + 0x0040) -+#define DMA_BDLPL(x) (0x40 * x + 0x0044) -+#define DMA_CHALX_DEV_ADDR(x) (0x40 * x + 0x0048) -+#define DMA_CHALX_CBL(x) (0x40 * x + 0x0054) -+#define DMA_CHALX_LVI(x) (0x40 * x + 0x004c) + static optee_invoke_fn *get_invoke_func(struct device *dev) + { + const char *method; +@@ -1432,7 +1441,7 @@ static optee_invoke_fn *get_invoke_func(struct device *dev) + + if (device_property_read_string(dev, "method", &method)) { + pr_warn("missing \"method\" property\n"); +- return ERR_PTR(-ENXIO); ++ return DEFAULT_CONDUIT_METHOD; + } + + if (!strcmp("hvc", method)) +@@ -1820,6 +1829,14 @@ static const struct of_device_id optee_dt_match[] = { + }; + MODULE_DEVICE_TABLE(of, optee_dt_match); + ++#ifdef CONFIG_ACPI ++static const struct acpi_device_id optee_acpi_match[] = { ++ { "PHYT8003" }, ++ { } ++}; ++MODULE_DEVICE_TABLE(acpi, optee_acpi_match); ++#endif + -+#define DMA_CHALX_DSIZE(x) (0x40 * x + 0x0064) -+#define DMA_CHALX_DLENTH(x) (0x40 * x + 0x0068) -+#define DMA_CHALX_CTL(x) (0x40 * x + 0x0058) + static struct platform_driver optee_driver = { + .probe = optee_probe, + .remove = optee_smc_remove, +@@ -1827,6 +1844,7 @@ static struct platform_driver optee_driver = { + .driver = { + .name = "optee", + .of_match_table = optee_dt_match, ++ .acpi_match_table = ACPI_PTR(optee_acpi_match), + }, + }; + +diff --git a/drivers/usb/host/xhci-mem.c b/drivers/usb/host/xhci-mem.c +index 0a37f0d51..0a6ca2e5f 100644 +--- a/drivers/usb/host/xhci-mem.c ++++ b/drivers/usb/host/xhci-mem.c +@@ -1996,6 +1996,10 @@ static void xhci_add_in_port(struct xhci_hcd *xhci, unsigned int num_ports, + return; + } + ++ if (xhci->quirks & XHCI_SLOWDOWN_QUIRK) ++ if (major_revision == 0x03) ++ rhub->min_rev = 0; + + /* Port offset and count in the third dword, see section 7.2 */ + temp = readl(addr + 2); + port_offset = XHCI_EXT_PORT_OFF(temp); +diff --git a/drivers/usb/host/xhci-pci.c b/drivers/usb/host/xhci-pci.c +index d6fc08e5d..c9c2e7062 100644 +--- a/drivers/usb/host/xhci-pci.c ++++ b/drivers/usb/host/xhci-pci.c +@@ -62,6 +62,8 @@ + #define PCI_DEVICE_ID_INTEL_ALDER_LAKE_PCH_XHCI 0x51ed + #define PCI_DEVICE_ID_INTEL_ALDER_LAKE_N_PCH_XHCI 0x54ed + ++#define PCI_DEVICE_ID_PHYTIUM_XHCI 0xdc27 + -+#define DMA_CTL 0x0000 + #define PCI_DEVICE_ID_AMD_RENOIR_XHCI 0x1639 + #define PCI_DEVICE_ID_AMD_PROMONTORYA_4 0x43b9 + #define PCI_DEVICE_ID_AMD_PROMONTORYA_3 0x43ba +@@ -474,6 +476,12 @@ static void xhci_pci_quirks(struct device *dev, struct xhci_hcd *xhci) + if (pdev->vendor == PCI_VENDOR_ID_VIA) + xhci->quirks |= XHCI_RESET_ON_RESUME; + ++ if (pdev->vendor == PCI_VENDOR_ID_PHYTIUM || ++ pdev->device == PCI_DEVICE_ID_PHYTIUM_XHCI) { ++ xhci->quirks |= XHCI_RESET_ON_RESUME; ++ xhci->quirks |= XHCI_SLOWDOWN_QUIRK; ++ } + -+#define DMA_LPIB(x) (0x40 * x + 0x0050) + /* See https://bugzilla.kernel.org/show_bug.cgi?id=79511 */ + if (pdev->vendor == PCI_VENDOR_ID_VIA && + pdev->device == 0x3432) +diff --git a/drivers/usb/host/xhci-plat.c b/drivers/usb/host/xhci-plat.c +index d68e9abcd..9420d7a56 100644 +--- a/drivers/usb/host/xhci-plat.c ++++ b/drivers/usb/host/xhci-plat.c +@@ -113,6 +113,10 @@ static const struct xhci_plat_priv xhci_plat_brcm = { + .quirks = XHCI_RESET_ON_RESUME | XHCI_SUSPEND_RESUME_CLKS, + }; + ++static const struct xhci_plat_priv xhci_plat_phytium_pe220x = { ++ .quirks = XHCI_RESET_ON_RESUME, ++}; + -+#define DMA_STS 0x0008 + static const struct of_device_id usb_xhci_of_match[] = { + { + .compatible = "generic-xhci", +@@ -133,6 +137,9 @@ static const struct of_device_id usb_xhci_of_match[] = { + }, { + .compatible = "brcm,bcm7445-xhci", + .data = &xhci_plat_brcm, ++ }, { ++ .compatible = "phytium,pe220x-xhci", ++ .data = &xhci_plat_phytium_pe220x, + }, + {}, + }; +@@ -394,7 +401,9 @@ static int xhci_generic_plat_probe(struct platform_device *pdev) + return ret; + } + +- if (pdev->dev.of_node) ++ if (has_acpi_companion(&pdev->dev)) ++ priv_match = acpi_device_get_match_data(&pdev->dev); ++ else if (pdev->dev.of_node) + priv_match = of_device_get_match_data(&pdev->dev); + else + priv_match = dev_get_platdata(&pdev->dev); +@@ -554,6 +563,7 @@ EXPORT_SYMBOL_GPL(xhci_plat_pm_ops); + static const struct acpi_device_id usb_xhci_acpi_match[] = { + /* XHCI-compliant USB Controller */ + { "PNP0D10", }, ++ { "PHYT0039", (kernel_ulong_t)&xhci_plat_phytium_pe220x }, + { } + }; + MODULE_DEVICE_TABLE(acpi, usb_xhci_acpi_match); +diff --git a/drivers/usb/host/xhci.h b/drivers/usb/host/xhci.h +index 31088602c..b3124c20b 100644 +--- a/drivers/usb/host/xhci.h ++++ b/drivers/usb/host/xhci.h +@@ -1907,6 +1907,7 @@ struct xhci_hcd { + #define XHCI_RESET_TO_DEFAULT BIT_ULL(44) + #define XHCI_ZHAOXIN_TRB_FETCH BIT_ULL(45) + #define XHCI_ZHAOXIN_HOST BIT_ULL(46) ++#define XHCI_SLOWDOWN_QUIRK BIT_ULL(47) + + unsigned int num_active_eps; + unsigned int limit_active_eps; +diff --git a/drivers/w1/masters/Kconfig b/drivers/w1/masters/Kconfig +index ad3165732..8f2675c38 100644 +--- a/drivers/w1/masters/Kconfig ++++ b/drivers/w1/masters/Kconfig +@@ -58,6 +58,16 @@ config HDQ_MASTER_OMAP + Say Y here if you want support for the 1-wire or HDQ Interface + on an OMAP processor. + ++config W1_MASTER_PHYTIUM ++ bool "Phytium 1-wire driver" ++ depends on ARCH_PHYTIUM || COMPILE_TEST ++ help ++ Say Y here if you want to get support for the 1-wire interface ++ on an Phytium SoC. + -+/* max number of fragments - we may use more if allocating more pages for BDL */ -+#define BDL_SIZE 4096 -+#define AZX_MAX_BDL_ENTRIES (BDL_SIZE / 16) ++ This driver can also be built as a module. If so, the module ++ will be called phytium-w1. + + config W1_MASTER_SGI + tristate "SGI ASIC driver" + help +diff --git a/drivers/w1/masters/Makefile b/drivers/w1/masters/Makefile +index c5d85a827..60bf6070c 100644 +--- a/drivers/w1/masters/Makefile ++++ b/drivers/w1/masters/Makefile +@@ -10,4 +10,5 @@ obj-$(CONFIG_W1_MASTER_MXC) += mxc_w1.o + + obj-$(CONFIG_W1_MASTER_GPIO) += w1-gpio.o + obj-$(CONFIG_HDQ_MASTER_OMAP) += omap_hdq.o ++obj-$(CONFIG_W1_MASTER_PHYTIUM) += phytium_w1.o + obj-$(CONFIG_W1_MASTER_SGI) += sgi_w1.o +diff --git a/drivers/w1/masters/phytium_w1.c b/drivers/w1/masters/phytium_w1.c +new file mode 100644 +index 000000000..0cb62258d +--- /dev/null ++++ b/drivers/w1/masters/phytium_w1.c +@@ -0,0 +1,643 @@ ++// SPDX-License-Identifier: GPL-2.0 +/* -+ * Component parameter register fields - define the I2S block's -+ * configuration. ++ * Phytium 1-wire bus master driver ++ * ++ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ -+#define COMP1_TX_WORDSIZE_3(r) (((r) & GENMASK(27, 25)) >> 25) -+#define COMP1_TX_WORDSIZE_2(r) (((r) & GENMASK(24, 22)) >> 22) -+#define COMP1_TX_WORDSIZE_1(r) (((r) & GENMASK(21, 19)) >> 19) -+#define COMP1_TX_WORDSIZE_0(r) (((r) & GENMASK(18, 16)) >> 16) -+#define COMP1_TX_CHANNELS(r) (((r) & GENMASK(10, 9)) >> 9) -+#define COMP1_RX_CHANNELS(r) (((r) & GENMASK(8, 7)) >> 7) -+#define COMP1_RX_ENABLED(r) (((r) & BIT(6)) >> 6) -+#define COMP1_TX_ENABLED(r) (((r) & BIT(5)) >> 5) -+#define COMP1_MODE_EN(r) (((r) & BIT(4)) >> 4) -+#define COMP1_FIFO_DEPTH_GLOBAL(r) (((r) & GENMASK(3, 2)) >> 2) -+#define COMP1_APB_DATA_WIDTH(r) (((r) & GENMASK(1, 0)) >> 0) -+ -+#define COMP2_RX_WORDSIZE_3(r) (((r) & GENMASK(12, 10)) >> 10) -+#define COMP2_RX_WORDSIZE_2(r) (((r) & GENMASK(9, 7)) >> 7) -+#define COMP2_RX_WORDSIZE_1(r) (((r) & GENMASK(5, 3)) >> 3) -+#define COMP2_RX_WORDSIZE_0(r) (((r) & GENMASK(2, 0)) >> 0) -+ -+/* Number of entries in WORDSIZE and DATA_WIDTH parameter registers */ -+#define COMP_MAX_WORDSIZE (1 << 3) -+#define COMP_MAX_DATA_WIDTH (1 << 2) -+ -+#define MAX_CHANNEL_NUM 8 -+#define MIN_CHANNEL_NUM 2 -+ -+#define azx_bus(chip) (&(chip)->bus.core) -+#define bus_to_azx(_bus) container_of(_bus, struct azx, bus.core) -+ -+#define I2S_UNSOL_QUEUE_SIZE 64 -+#define I2S_MAX_CODECS 8 /* limit by controller side */ -+ -+#define azx_stream(dev) (&(dev)->core) -+ -+struct i2s_clk_config_data { -+ int chan_nr; -+ u32 data_width; -+ u32 sample_rate; -+}; + -+struct i2sc_bus { -+ struct device *dev; -+ const struct i2s_bus_ops *ops; -+ const struct i2s_io_ops *io_ops; -+ const struct i2s_ext_bus_ops *ext_ops; -+ -+ /* h/w resources */ -+ unsigned long addr; -+ void __iomem *remap_addr; -+ int irq; -+ -+ /* codec linked list */ -+ struct list_head codec_list; -+ unsigned int num_codecs; -+ -+ unsigned int unsol_rp, unsol_wp; -+ struct work_struct unsol_work; -+ -+ struct snd_dma_buffer bdl0; -+ struct snd_dma_buffer bdl1; -+ -+ /* i2s_stream linked list */ -+ struct list_head stream_list; -+ -+ bool reverse_assign; /* assign devices in reverse order */ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include + -+ int bdl_pos_adj; /* BDL position adjustment */ ++#include + -+ /* locks */ -+ spinlock_t reg_lock; -+}; ++#define PHY_W1M_CTL 0x08 + -+struct i2s_bus { -+ struct i2sc_bus core; ++/* Simplify mode */ ++#define PHY_W1M_CMD 0x04 ++#define PHY_W1M_PWM0_START_B 0x30 ++#define PHY_W1M_PWM0_END_B 0x34 ++#define PHY_W1M_PWM1_START_B 0x38 ++#define PHY_W1M_PWM1_END_B 0x3c ++#define PHY_W1M_SAMPLE_B 0x40 ++#define PHY_W1M_INT_EN_B 0x64 ++#define PHY_W1M_INT_STATUS_B 0x74 ++#define PHY_W1M_DATA_REG 0x70 + -+ struct snd_card *card; ++#define PHY_W1M_CMD_ROM_SEARCH 0xF0 ++#define PHY_W1M_CMD_WRITE_BIT 0x35 ++#define PHY_W1M_CMD_WRITE_BYTE 0x36 ++#define PHY_W1M_CMD_RESET_BUS 0x37 ++#define PHY_W1M_CMD_READ_BIT 0x3A ++#define PHY_W1M_CMD_READ_BYTE 0x3B ++#define PHY_W1M_SLAVE_ROM_ID 0x160 + -+ struct pci_dev *pci; ++#define PHY_W1M_INT_EN_TXCOMPLETE BIT(6) ++#define PHY_W1M_INT_EN_RXCOMPLETE BIT(7) + -+ struct mutex prepare_mutex; -+}; ++#define PHY_W1M_INT_STATUS_TXCOMPLETE BIT(6) ++#define PHY_W1M_INT_STATUS_RXCOMPLETE BIT(7) + ++#define W1M_MOD_W1 1 ++#define W1M_MOD_PECI 0 + -+/* -+ * i2s stream -+ */ -+struct i2s_stream { -+ struct i2sc_bus *bus; -+ struct snd_dma_buffer bdl; /* BDL buffer */ -+ __le32 *posbuf; /* position buffer pointer */ -+ int direction; /* playback / capture (SNDRV_PCM_STREAM_*) */ -+ -+ unsigned int bufsize; /* size of the play buffer in bytes */ -+ unsigned int period_bytes; /* size of the period in bytes */ -+ unsigned int frags; /* number for period in the play buffer */ -+ unsigned int fifo_size; /* FIFO size */ -+ -+ void __iomem *sd_addr; /* stream descriptor pointer */ -+ -+ u32 sd_int_sta_mask; /* stream int status mask */ -+ -+ /* pcm support */ -+ struct snd_pcm_substream *substream; /* assigned substream, -+ * set in PCM open -+ */ -+ unsigned int format_val; /* format value to be set in the -+ * controller and the codec -+ */ -+ unsigned char stream_tag; /* assigned stream */ -+ unsigned char index; /* stream index */ -+ int assigned_key; /* last device# key assigned to */ -+ -+ bool opened; -+ bool running; -+ bool prepared; -+ bool no_period_wakeup; -+ -+ int delay_negative_threshold; ++#define PHY_W1M_FLAG_CLEAR 0 ++#define PHY_W1M_FLAG_SET 1 ++#define PHY_W1M_TIMEOUT (HZ/5) + -+ struct list_head list; ++#define PHY_W1M_MAX_USER 4 + -+}; ++static DECLARE_WAIT_QUEUE_HEAD(w1m_wait_queue); + -+struct azx_dev { -+ struct i2s_stream core; -+ unsigned int irq_pending:1; ++struct w1m_data { ++ struct device *dev; ++ void __iomem *w1m_base; ++ /* lock status update */ ++ struct mutex w1m_mutex; ++ int w1m_usecount; ++ u8 w1m_irqstatus; ++ /* device lock */ ++ spinlock_t w1m_spinlock; ++ /* ++ * Used to control the call to phytium_w1m_get and phytium_w1m_put. ++ * Non-w1 Protocol: Write the CMD|REG_address first, followed by ++ * the data wrire or read. ++ */ ++ int init_trans; +}; + -+/* PCM setup */ -+static inline struct azx_dev *get_azx_dev(struct snd_pcm_substream *substream) ++/* W1 register I/O routines */ ++static inline u8 phytium_w1m_read(struct w1m_data *w1m_data, u32 offset) +{ -+ return substream->runtime->private_data; ++ return readl(w1m_data->w1m_base + offset); +} + -+#define AZX_MAX_CODECS HDA_MAX_CODECS -+#define AZX_DEFAULT_CODECS 4 -+ -+#define stream_to_azx_dev(s) container_of(s, struct azx_dev, core) -+ -+struct azx; -+ -+struct i2s_controller_ops { -+ int (*substream_alloc_pages)(struct azx *chip, -+ struct snd_pcm_substream *substream, -+ size_t size); -+ int (*substream_free_pages)(struct azx *chip, -+ struct snd_pcm_substream *substream); -+ int (*position_check)(struct azx *chip, struct azx_dev *azx_dev); -+}; -+ -+struct i2s_io_ops { -+ int (*dma_alloc_pages)(struct i2sc_bus *bus, int type, size_t size, -+ struct snd_dma_buffer *buf); -+ void (*dma_free_pages)(struct i2sc_bus *bus, -+ struct snd_dma_buffer *buf); -+}; -+ -+struct azx { -+ struct i2s_bus bus; -+ -+ struct snd_card *card; -+ struct pci_dev *pci; -+ int dev_index; -+ -+ int playback_streams; -+ int playback_index_offset; -+ int capture_streams; -+ int capture_index_offset; -+ int num_streams; ++static inline void phytium_w1m_write(struct w1m_data *w1m_data, u32 offset, u8 val) ++{ ++ writel(val, w1m_data->w1m_base + offset); ++} + -+ /* Register interaction. */ -+ const struct i2s_controller_ops *ops; ++static inline u8 phytium_w1m_merge(struct w1m_data *w1m_data, u32 offset, ++ u8 val, u8 mask) ++{ ++ u8 new_val = (__raw_readl(w1m_data->w1m_base + offset) & ~mask) ++ | (val & mask); ++ writel(new_val, w1m_data->w1m_base + offset); + -+ /* locks */ -+ struct mutex open_mutex; /* Prevents concurrent open/close operations */ ++ return new_val; ++} + -+ /* PCM */ -+ struct list_head pcm_list; /* azx_pcm list */ ++static void w1m_disable_interrupt(struct w1m_data *w1m_data, u32 offset, ++ u32 mask) ++{ ++ u32 ie; + -+ /* flags */ -+ int bdl_pos_adj; -+ unsigned int running:1; -+ unsigned int region_requested:1; -+ unsigned int disabled:1; -+}; ++ ie = readl(w1m_data->w1m_base + offset); ++ writel(ie & mask, w1m_data->w1m_base + offset); ++} + -+struct i2s_phytium { -+ struct azx chip; -+ struct snd_pcm_substream *substream; -+ struct device *dev; -+ struct device *pdev; -+ u32 paddr; -+ void __iomem *regs; -+ void __iomem *regs_db; -+ int irq_id; ++/* write out a byte or bit and fill *status with W1M_INT_STATUS */ ++static int phytium_write_data(struct w1m_data *w1m_data, u8 val, u8 *status, bool is_bit) ++{ ++ int ret; ++ unsigned long irqflags; + -+ /* for pending irqs */ -+ struct work_struct irq_pending_work; ++ *status = 0; + -+ /* sync probing */ -+ struct completion probe_wait; -+ struct work_struct probe_work; ++ spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); ++ /* clear interrupt flags via a dummy read */ ++ phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); ++ /* ISR loads it with new INT_STATUS */ ++ w1m_data->w1m_irqstatus = 0; ++ spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); + -+ /* extra flags */ -+ unsigned int pcie:1; -+ unsigned int irq_pending_warned:1; -+ unsigned int probe_continued:1; -+ unsigned int i2s_dp:1; -+ -+ unsigned int i2s_reg_comp1; -+ unsigned int i2s_reg_comp2; -+ struct clk *clk; -+ unsigned int capability; -+ unsigned int quirks; -+ u32 fifo_th; -+ int active; -+ u32 xfer_resolution; -+ u32 ccr; -+ u32 clk_base; -+ u32 cfg; -+ struct i2s_clk_config_data config; -+ -+ /*azx_dev*/ -+ struct i2s_stream core; -+}; ++ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, ++ PHY_W1M_INT_EN_TXCOMPLETE, ++ PHY_W1M_INT_EN_TXCOMPLETE); + -+#define azx_alloc_stream_pages(chip) \ -+ snd_i2s_bus_alloc_stream_pages(azx_bus(chip)) ++ phytium_w1m_write(w1m_data, PHY_W1M_DATA_REG, val); ++ phytium_w1m_write(w1m_data, PHY_W1M_CMD, is_bit ? PHY_W1M_CMD_WRITE_BIT : PHY_W1M_CMD_WRITE_BYTE); + -+#endif -diff --git a/sound/soc/phytium/phytium_i2s.c b/sound/soc/phytium/phytium_i2s.c -new file mode 100644 -index 000000000..9119cdae1 ---- /dev/null -+++ b/sound/soc/phytium/phytium_i2s.c -@@ -0,0 +1,1433 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Phytium I2S ASoC driver -+ * -+ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. -+ * -+ * Derived from sound/soc/dwc/dwc-i2s.c -+ * Copyright (C) 2010 ST Microelectronics -+ */ ++ /* wait for the TXCOMPLETE bit */ ++ ret = wait_event_timeout(w1m_wait_queue, ++ w1m_data->w1m_irqstatus, PHY_W1M_TIMEOUT); ++ if (ret == 0) { ++ dev_err(w1m_data->dev, "TX wait elapsed\n"); ++ ret = -ETIMEDOUT; ++ goto out; ++ } + -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "local.h" -+ -+#define NUM_CAPTURE 1 -+#define NUM_PLAYBACK 1 -+ -+#define PHYTIUM_I2S_PLAY (1 << 0) -+#define PHYTIUM_I2S_RECORD (1 << 1) -+#define PHYTIUM_I2S_SLAVE (1 << 2) -+#define PHYTIUM_I2S_MASTER (1 << 3) -+ -+#define PHYTIUM_I2S_QUIRK_16BIT_IDX_OVERRIDE (1 << 2) -+ -+#define TWO_CHANNEL_SUPPORT 2 /* up to 2.0 */ -+#define FOUR_CHANNEL_SUPPORT 4 /* up to 3.1 */ -+#define SIX_CHANNEL_SUPPORT 6 /* up to 5.1 */ -+#define EIGHT_CHANNEL_SUPPORT 8 /* up to 7.1 */ -+ -+struct pdata_px210_mfd { -+ struct device *dev; -+ char *name; -+ int clk_base; -+}; ++ *status = w1m_data->w1m_irqstatus; ++ /* check irqstatus */ ++ if (!(*status & PHY_W1M_INT_STATUS_TXCOMPLETE)) { ++ dev_err(w1m_data->dev, ++ "timeout waiting for TXCOMPLETE/RXCOMPLETE, %x", *status); ++ ret = -ETIMEDOUT; ++ } + -+static inline void i2s_write_reg(void __iomem *io_base, int reg, u32 val) -+{ -+ writel(val, io_base + reg); ++out: ++ return ret; +} + -+static inline u32 i2s_read_reg(void __iomem *io_base, int reg) ++static irqreturn_t w1m_isr(int irq, void *_w1m) +{ -+ return readl(io_base + reg); -+} ++ struct w1m_data *w1m_data = _w1m; ++ unsigned long irqflags; + -+static inline void i2s_disable_channels(struct i2s_phytium *dev, u32 stream) -+{ -+ u32 i = 0; ++ spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); ++ w1m_data->w1m_irqstatus = phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); ++ spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); + -+ if (stream == SNDRV_PCM_STREAM_PLAYBACK) { -+ for (i = 0; i < 4; i++) -+ i2s_write_reg(dev->regs, TER(i), 0); -+ } else { -+ for (i = 0; i < 4; i++) -+ i2s_write_reg(dev->regs, RER(i), 0); ++ phytium_w1m_write(w1m_data, PHY_W1M_INT_STATUS_B, 0x00); ++ if (w1m_data->w1m_irqstatus & ++ (PHY_W1M_INT_STATUS_TXCOMPLETE | PHY_W1M_INT_STATUS_RXCOMPLETE)) { ++ /* wake up sleeping process */ ++ wake_up(&w1m_wait_queue); + } -+} + -+static int substream_free_pages(struct azx *chip, -+ struct snd_pcm_substream *substream) -+{ -+ return snd_pcm_lib_free_pages(substream); ++ return IRQ_HANDLED; +} + -+static void stream_update(struct i2sc_bus *bus, struct i2s_stream *s) -+{ -+ struct azx *chip = bus_to_azx(bus); + -+ struct azx_dev *azx_dev = stream_to_azx_dev(s); ++static int phytium_read_data(struct w1m_data *w1m_data, u8 *val, bool is_bit) ++{ ++ int ret = 0; ++ u8 status; ++ unsigned long irqflags; + -+ /* check whether this IRQ is really acceptable */ -+ if (!chip->ops->position_check || -+ chip->ops->position_check(chip, azx_dev)) { -+ spin_unlock(&bus->reg_lock); -+ snd_pcm_period_elapsed(azx_stream(azx_dev)->substream); -+ spin_lock(&bus->reg_lock); ++ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); ++ if (ret < 0) { ++ ret = -EINTR; ++ goto rtn; + } -+} + -+int snd_i2s_bus_handle_stream_irq(struct i2sc_bus *bus, unsigned int status, -+ void (*ack)(struct i2sc_bus *, struct i2s_stream *)) -+{ -+ struct i2s_stream *azx_dev; -+ u32 sd_status, qc_sd_status; -+ int handled = 0; -+ -+ list_for_each_entry(azx_dev, &bus->stream_list, list) { -+ if (status & azx_dev->sd_int_sta_mask) { -+ sd_status = i2s_read_reg(azx_dev->sd_addr, DMA_STS); -+ i2s_write_reg(azx_dev->sd_addr, DMA_STS, azx_dev->sd_int_sta_mask); -+ qc_sd_status = i2s_read_reg(azx_dev->sd_addr, DMA_STS); -+ handled |= 1 << azx_dev->index; -+ azx_dev->running = 1; -+ if (!azx_dev->substream || !azx_dev->running || -+ !(sd_status & 0xffffffff)) { -+ continue; -+ } -+ if (ack) -+ ack(bus, azx_dev); -+ } ++ if (!w1m_data->w1m_usecount) { ++ ret = -EINVAL; ++ goto out; + } + -+ return handled; -+} -+ -+irqreturn_t azx_i2s_interrupt(int irq, void *dev_id) -+{ -+ struct azx *chip = dev_id; -+ struct i2sc_bus *bus = azx_bus(chip); -+ u32 status; -+ bool active, handled = false; -+ int repeat = 0; /* count for avoiding endless loop */ -+ -+ spin_lock(&bus->reg_lock); -+ -+ if (chip->disabled) -+ goto unlock; -+ -+ do { -+ status = i2s_read_reg(bus->remap_addr, DMA_STS); -+ -+ if (status == 0) -+ break; -+ -+ handled = true; -+ active = false; -+ if (snd_i2s_bus_handle_stream_irq(bus, status, stream_update)) -+ active = true; -+ } while (active && ++repeat < 1); ++ spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); ++ /* clear interrupt flags via a dummy read */ ++ phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); ++ /* ISR loads it with new INT_STATUS */ ++ w1m_data->w1m_irqstatus = 0; ++ spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); + -+ unlock: -+ spin_unlock(&bus->reg_lock); -+ return IRQ_RETVAL(handled); -+} ++ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, ++ PHY_W1M_INT_EN_RXCOMPLETE, ++ PHY_W1M_INT_EN_RXCOMPLETE); + -+static int azx_acquire_irq(struct azx *chip, int do_disconnect) -+{ -+ struct i2sc_bus *bus = azx_bus(chip); -+ struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); -+ int err; ++ phytium_w1m_write(w1m_data, PHY_W1M_CMD, is_bit ? PHY_W1M_CMD_READ_BIT : PHY_W1M_CMD_READ_BYTE); + -+ err = devm_request_irq(i2s->dev, i2s->irq_id, azx_i2s_interrupt, IRQF_SHARED, -+ "phytium i2s", chip); ++ wait_event_timeout(w1m_wait_queue, ++ (w1m_data->w1m_irqstatus & PHY_W1M_INT_STATUS_RXCOMPLETE), ++ PHY_W1M_TIMEOUT); + -+ if (err < 0) { -+ dev_err(i2s->dev, "failed to request irq\n"); -+ return err; ++ status = w1m_data->w1m_irqstatus; ++ /* check irqstatus */ ++ if (!(status & PHY_W1M_INT_STATUS_RXCOMPLETE)) { ++ dev_err(w1m_data->dev, "timeout waiting for RXCOMPLETE, %x", status); ++ ret = -ETIMEDOUT; ++ goto out; + } + -+ bus->irq = i2s->irq_id; -+ -+ return 0; ++ /* the data is ready. Read it in! */ ++ *val = phytium_w1m_read(w1m_data, PHY_W1M_DATA_REG); ++out: ++ mutex_unlock(&w1m_data->w1m_mutex); ++rtn: ++ return ret; +} + -+static void i2s_start(struct i2s_phytium *dev, -+ struct snd_pcm_substream *substream) -+{ -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ i2s_write_reg(dev->regs, ITER, 1); -+ else -+ i2s_write_reg(dev->regs, IRER, 1); -+ -+ /*enable the clock*/ -+ i2s_write_reg(dev->regs, CER, 1); -+ -+ /*enable the i2s*/ -+ i2s_write_reg(dev->regs, I2S_IER, 1); -+} + -+static void i2s_stop(struct i2s_phytium *dev, struct snd_pcm_substream *substream) ++static int phytium_w1m_get(struct w1m_data *w1m_data) +{ -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ i2s_write_reg(dev->regs, ITER, 0); -+ else -+ i2s_write_reg(dev->regs, IRER, 0); ++ int ret = 0; + -+ if (!dev->active) { -+ i2s_write_reg(dev->regs, CER, 0); -+ i2s_write_reg(dev->regs, I2S_IER, 0); ++ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); ++ if (ret < 0) { ++ ret = -EINTR; ++ goto rtn; ++ } ++ ++ if (w1m_data->w1m_usecount == PHY_W1M_MAX_USER) { ++ dev_warn(w1m_data->dev, "attempt to exceed the max use count"); ++ ret = -EINVAL; ++ goto out; ++ } else { ++ w1m_data->w1m_usecount++; ++ try_module_get(THIS_MODULE); ++ if (w1m_data->w1m_usecount == 1) ++ pm_runtime_get_sync(w1m_data->dev); + } ++ ++out: ++ mutex_unlock(&w1m_data->w1m_mutex); ++rtn: ++ return ret; +} + -+static void phytium_i2s_config(struct i2s_phytium *dev, int stream) ++/* Disable clocks to the module */ ++static int phytium_w1m_put(struct w1m_data *w1m_data) +{ -+ i2s_disable_channels(dev, stream); ++ int ret = 0; ++ ++ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); ++ if (ret < 0) ++ return -EINTR; + -+ if (stream == SNDRV_PCM_STREAM_PLAYBACK) { -+ i2s_write_reg(dev->regs, TCR(0), dev->xfer_resolution); -+ i2s_write_reg(dev->regs, TER(0), 1); ++ if (w1m_data->w1m_usecount == 0) { ++ dev_warn(w1m_data->dev, ++ "attempt to decrement use count when it is zero"); ++ ret = -EINVAL; + } else { -+ i2s_write_reg(dev->regs, RCR(0), dev->xfer_resolution); -+ i2s_write_reg(dev->regs, RER(0), 1); ++ w1m_data->w1m_usecount--; ++ module_put(THIS_MODULE); ++ if (w1m_data->w1m_usecount == 0) ++ pm_runtime_put_sync(w1m_data->dev); + } ++ mutex_unlock(&w1m_data->w1m_mutex); ++ ++ return ret; +} + -+static int phytium_i2s_hw_params(struct snd_pcm_substream *substream, -+ struct snd_pcm_hw_params *params, -+ struct snd_soc_dai *dai) ++/* ++ * W1 triplet callback function - used for searching ROM addresses. ++ * Registered only when controller is in 1-wire mode. ++ */ ++static u8 phytium_w1_triplet(void *_w1m, u8 bdir) +{ -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); -+ struct i2s_clk_config_data *config = &dev->config; -+ u64 fix, point; -+ u32 cfg = 0; -+ -+ switch (params_format(params)) { -+ case SNDRV_PCM_FORMAT_S16_LE: -+ config->data_width = 16; -+ dev->ccr = 0x00; -+ dev->xfer_resolution = 0x02; -+ break; -+ -+ case SNDRV_PCM_FORMAT_S24_LE: -+ config->data_width = 24; -+ dev->ccr = 0x08; -+ dev->xfer_resolution = 0x04; -+ break; ++ u8 id_bit, comp_bit; ++ int err; ++ u8 ret = 0x3; /* no slaves responded */ ++ struct w1m_data *w1m_data = _w1m; + -+ case SNDRV_PCM_FORMAT_S32_LE: -+ config->data_width = 32; -+ dev->ccr = 0x10; -+ dev->xfer_resolution = 0x05; -+ break; ++ phytium_w1m_get(_w1m); + -+ default: -+ dev_err(dev->dev, "phytium-i2s: unsupported PCM fmt"); -+ return -EINVAL; ++ err = mutex_lock_interruptible(&w1m_data->w1m_mutex); ++ if (err < 0) { ++ dev_err(w1m_data->dev, "Could not acquire mutex\n"); ++ goto rtn; + } + -+ config->chan_nr = params_channels(params); ++ w1m_data->w1m_irqstatus = 0; ++ /* read id_bit */ ++ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, ++ PHY_W1M_INT_EN_RXCOMPLETE, ++ PHY_W1M_INT_EN_RXCOMPLETE); ++ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); + -+ switch (config->chan_nr) { -+ case EIGHT_CHANNEL_SUPPORT: -+ case SIX_CHANNEL_SUPPORT: -+ case FOUR_CHANNEL_SUPPORT: -+ case TWO_CHANNEL_SUPPORT: -+ break; -+ default: -+ dev_err(dev->dev, "channel not supported\n"); -+ return -EINVAL; ++ err = wait_event_timeout(w1m_wait_queue, ++ (w1m_data->w1m_irqstatus ++ & PHY_W1M_INT_STATUS_RXCOMPLETE), ++ PHY_W1M_TIMEOUT); ++ if (err == 0) { ++ dev_err(w1m_data->dev, "RX wait elapsed\n"); ++ goto out; + } ++ id_bit = (phytium_w1m_read(_w1m, PHY_W1M_DATA_REG) & 0x01); + -+ phytium_i2s_config(dev, substream->stream); -+ -+ i2s_write_reg(dev->regs, CCR, dev->ccr); -+ -+ config->sample_rate = params_rate(params); -+ if (dev->capability & PHYTIUM_I2S_MASTER) { -+ fix = dev->clk_base / config->sample_rate / config->data_width / 32; -+ point = ((dev->clk_base / config->sample_rate) << 10) / config->data_width / 32; -+ point = (point - (fix << 10)) * 10; -+ cfg = ((u16) fix << 16) | (u16) point; -+ i2s_write_reg(dev->regs, CLK_CFG0, cfg); -+ i2s_write_reg(dev->regs, CLK_CFG1, 0xf); ++ w1m_data->w1m_irqstatus = 0; ++ /* read comp_bit */ ++ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, ++ PHY_W1M_INT_EN_RXCOMPLETE, ++ PHY_W1M_INT_EN_RXCOMPLETE); ++ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); ++ err = wait_event_timeout(w1m_wait_queue, ++ (w1m_data->w1m_irqstatus ++ & PHY_W1M_INT_STATUS_RXCOMPLETE), ++ PHY_W1M_TIMEOUT); ++ if (err == 0) { ++ dev_err(w1m_data->dev, "RX wait elapsed\n"); ++ goto out; + } -+ dev->cfg = cfg; -+ return 0; -+} -+ -+static int phytium_i2s_prepare(struct snd_pcm_substream *substream, -+ struct snd_soc_dai *dai) -+{ -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); ++ comp_bit = (phytium_w1m_read(_w1m, PHY_W1M_DATA_REG) & 0x01); + -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ i2s_write_reg(dev->regs, TXFFR, 1); -+ else -+ i2s_write_reg(dev->regs, RXFFR, 1); ++ if (id_bit && comp_bit) { ++ ret = 0x03; /* no slaves responded */ ++ goto out; ++ } ++ if (!id_bit && !comp_bit) { ++ /* Both bits are valid, take the direction given */ ++ ret = bdir ? 0x04 : 0; ++ } else { ++ /* Only one bit is valid, take that direction */ ++ bdir = id_bit; ++ ret = id_bit ? 0x05 : 0x02; ++ } + -+ return 0; -+} ++ w1m_data->w1m_irqstatus = 0; ++ /* write bdir bit */ ++ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, ++ PHY_W1M_INT_EN_TXCOMPLETE, ++ PHY_W1M_INT_EN_TXCOMPLETE); + -+static int phytium_i2s_trigger(struct snd_pcm_substream *substream, -+ int cmd, struct snd_soc_dai *dai) -+{ -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); -+ int ret = 0; ++ phytium_w1m_write(w1m_data, PHY_W1M_DATA_REG, bdir); ++ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x35); + -+ switch (cmd) { -+ case SNDRV_PCM_TRIGGER_START: -+ case SNDRV_PCM_TRIGGER_RESUME: -+ case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: -+ dev->active++; -+ i2s_start(dev, substream); -+ break; -+ case SNDRV_PCM_TRIGGER_STOP: -+ case SNDRV_PCM_TRIGGER_SUSPEND: -+ case SNDRV_PCM_TRIGGER_PAUSE_PUSH: -+ dev->active--; -+ i2s_stop(dev, substream); -+ break; -+ default: -+ ret = -EINVAL; -+ break; ++ err = wait_event_timeout(w1m_wait_queue, ++ (w1m_data->w1m_irqstatus ++ & PHY_W1M_INT_STATUS_TXCOMPLETE), ++ PHY_W1M_TIMEOUT); ++ if (err == 0) { ++ dev_err(w1m_data->dev, "TX wait elapsed\n"); ++ goto out; + } + ++out: ++ mutex_unlock(&w1m_data->w1m_mutex); ++rtn: ++ phytium_w1m_put(_w1m); + return ret; +} + -+static int phytium_i2s_set_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt) ++static u8 phytium_w1_touch_bit(void *_w1m, u8 bit) +{ -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(cpu_dai); -+ int ret = 0; -+ -+ switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { -+ case SND_SOC_DAIFMT_BC_FC: -+ if (dev->capability & PHYTIUM_I2S_SLAVE) -+ ret = 0; -+ else -+ ret = -EINVAL; -+ break; -+ case SND_SOC_DAIFMT_BP_FP: -+ if (dev->capability & PHYTIUM_I2S_MASTER) -+ ret = 0; -+ else -+ ret = -EINVAL; -+ break; -+ case SND_SOC_DAIFMT_CBM_CFS: -+ case SND_SOC_DAIFMT_CBS_CFM: -+ ret = -EINVAL; -+ break; -+ default: -+ dev_dbg(dev->dev, "phytium/i2s: Invalid master/slave format\n"); -+ ret = -EINVAL; -+ break; -+ } -+ return ret; -+} ++ u8 result = 0; ++ int err; ++ struct w1m_data *w1m_data = _w1m; + -+static const struct snd_soc_dai_ops phytium_i2s_dai_ops = { -+ .hw_params = phytium_i2s_hw_params, -+ .prepare = phytium_i2s_prepare, -+ .trigger = phytium_i2s_trigger, -+ .set_fmt = phytium_i2s_set_fmt, -+}; ++ phytium_w1m_get(w1m_data); + -+#ifdef CONFIG_PM -+static int phytium_i2s_suspend(struct snd_soc_component *component) -+{ -+ return 0; -+} ++ w1m_data->init_trans++; + -+static int phytium_i2s_resume(struct snd_soc_component *component) -+{ -+ struct i2s_phytium *dev = snd_soc_component_get_drvdata(component); -+ struct snd_soc_dai *dai; -+ -+ for_each_component_dais(component, dai) { -+ if (snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_PLAYBACK)) -+ phytium_i2s_config(dev, SNDRV_PCM_STREAM_PLAYBACK); -+ if (snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_CAPTURE)) -+ phytium_i2s_config(dev, SNDRV_PCM_STREAM_CAPTURE); ++ err = mutex_lock_interruptible(&w1m_data->w1m_mutex); ++ if (err < 0) { ++ dev_err(w1m_data->dev, "Could not acquired mutex\n"); ++ goto rtn; + } -+ i2s_write_reg(dev->regs, CLK_CFG0, dev->cfg); -+ i2s_write_reg(dev->regs, CLK_CFG1, 0xf); -+ return 0; -+} -+#else -+#define phytium_i2s_suspend NULL -+#define phytium_i2s_resume NULL -+#endif -+ -+static struct snd_soc_dai_driver phytium_i2s_dai = { -+ .playback = { -+ .stream_name = "i2s-Playback", -+ .channels_min = 2, -+ .channels_max = 2, -+ .rates = SNDRV_PCM_RATE_8000_192000, -+ .formats = SNDRV_PCM_FMTBIT_S8 | -+ SNDRV_PCM_FMTBIT_S16_LE | -+ SNDRV_PCM_FMTBIT_S20_LE | -+ SNDRV_PCM_FMTBIT_S24_LE | -+ SNDRV_PCM_FMTBIT_S32_LE, -+ }, -+ .capture = { -+ .stream_name = "i2s-Capture", -+ .channels_min = 2, -+ .channels_max = 2, -+ .rates = SNDRV_PCM_RATE_8000_192000, -+ .formats = SNDRV_PCM_FMTBIT_S8 | -+ SNDRV_PCM_FMTBIT_S16_LE | -+ SNDRV_PCM_FMTBIT_S20_LE | -+ SNDRV_PCM_FMTBIT_S24_LE | -+ SNDRV_PCM_FMTBIT_S32_LE, -+ }, -+ .ops = &phytium_i2s_dai_ops, -+ .symmetric_rate = 1, -+}; + -+static const struct snd_pcm_hardware phytium_pcm_hardware = { -+ .info = SNDRV_PCM_INFO_INTERLEAVED | -+ SNDRV_PCM_INFO_MMAP | -+ SNDRV_PCM_INFO_MMAP_VALID | -+ SNDRV_PCM_INFO_BLOCK_TRANSFER, -+ .rates = SNDRV_PCM_RATE_8000 | -+ SNDRV_PCM_RATE_32000 | -+ SNDRV_PCM_RATE_44100 | -+ SNDRV_PCM_RATE_48000, -+ .rate_min = 8000, -+ .rate_max = 48000, -+ .formats = (SNDRV_PCM_FMTBIT_S8 | -+ SNDRV_PCM_FMTBIT_S16_LE | -+ SNDRV_PCM_FMTBIT_S20_LE | -+ SNDRV_PCM_FMTBIT_S24_LE | -+ SNDRV_PCM_FMTBIT_S32_LE), -+ .channels_min = 2, -+ .channels_max = 2, -+ .buffer_bytes_max = 4096*16, -+ .period_bytes_min = 1024, -+ .period_bytes_max = 4096*4, -+ .periods_min = 2, -+ .periods_max = 16, -+ .fifo_size = 16, -+}; -+ -+struct i2s_stream *snd_i2s_stream_assign(struct i2sc_bus *bus, -+ struct snd_pcm_substream *substream) -+{ -+ struct i2s_stream *azx_dev; -+ struct i2s_stream *res = NULL; -+ -+ /* make a non-zero unique key for the substream */ -+ int key = (substream->pcm->device << 16) | (substream->number << 2) | -+ (substream->stream + 1); ++ w1m_data->w1m_irqstatus = 0; + -+ list_for_each_entry(azx_dev, &bus->stream_list, list) { -+ if (azx_dev->direction != substream->stream) -+ continue; ++ phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, ++ PHY_W1M_INT_EN_RXCOMPLETE, ++ PHY_W1M_INT_EN_RXCOMPLETE); ++ phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); + -+ azx_dev->opened = 0; ++ err = wait_event_timeout(w1m_wait_queue, ++ (w1m_data->w1m_irqstatus & PHY_W1M_INT_STATUS_RXCOMPLETE), ++ PHY_W1M_TIMEOUT); ++ if (err == 0) { ++ dev_info(w1m_data->dev, "Rx wait elapsed\n"); ++ goto out; ++ } + -+ if (azx_dev->assigned_key == key) { -+ res = azx_dev; -+ break; -+ } ++ result = (phytium_w1m_read(w1m_data, PHY_W1M_DATA_REG) & 0x01); + -+ if (!res || bus->reverse_assign) -+ res = azx_dev; -+ } ++ w1m_data->w1m_irqstatus = 0; + -+ if (res) { -+ spin_lock_irq(&bus->reg_lock); -+ res->opened = 1; -+ res->running = 0; -+ res->assigned_key = key; -+ res->substream = substream; -+ spin_unlock_irq(&bus->reg_lock); -+ } ++out: ++ mutex_unlock(&w1m_data->w1m_mutex); ++rtn: ++ phytium_w1m_put(w1m_data); + -+ return res; ++ return result; +} + -+/* assign a stream for the PCM */ -+static inline struct azx_dev * -+azx_assign_device(struct azx *chip, struct snd_pcm_substream *substream) ++/* reset callback */ ++static u8 phytium_w1_reset_bus(void *_w1m) +{ -+ struct i2s_stream *s; -+ -+ s = snd_i2s_stream_assign(azx_bus(chip), substream); -+ if (!s) -+ return NULL; -+ return stream_to_azx_dev(s); ++ phytium_w1m_get(_w1m); ++ phytium_w1m_write(_w1m, PHY_W1M_CMD, 0x37); ++ mdelay(1); ++ phytium_w1m_put(_w1m); ++ return 0; +} + -+static int phytium_pcm_open(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream) ++/* Read a byte of data from the device */ ++static u8 phytium_w1_read_data(void *_w1m, bool is_bit) +{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); ++ struct w1m_data *w1m_data = _w1m; ++ u8 val = 0; ++ int ret; + -+ struct azx *chip = &dev->chip; -+ struct azx_dev *azx_dev; -+ struct snd_pcm_runtime *runtime = substream->runtime; ++ /* First write to initialize the transfer */ ++ if (w1m_data->init_trans == 0) ++ phytium_w1m_get(w1m_data); + -+ azx_dev = azx_assign_device(chip, substream); -+ if (azx_dev == NULL) -+ return -EBUSY; ++ w1m_data->init_trans++; ++ ret = phytium_read_data(w1m_data, &val, is_bit); ++ if (ret) { ++ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); ++ if (ret < 0) { ++ dev_err(w1m_data->dev, "Could not acquire mutex\n"); ++ return -EINTR; ++ } ++ w1m_data->init_trans = 0; ++ mutex_unlock(&w1m_data->w1m_mutex); ++ phytium_w1m_put(w1m_data); ++ return -1; ++ } ++ ++ w1m_disable_interrupt(w1m_data, PHY_W1M_INT_EN_B, ++ ~((u32)PHY_W1M_INT_EN_RXCOMPLETE)); + -+ snd_soc_set_runtime_hwparams(substream, &phytium_pcm_hardware); -+ snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); -+ snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 128); -+ runtime->private_data = azx_dev; ++ /* Write followed by a read, release the module */ ++ if (w1m_data->init_trans) { ++ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); ++ if (ret < 0) { ++ dev_err(w1m_data->dev, "Could not acquire mutex\n"); ++ return -EINTR; ++ } ++ w1m_data->init_trans = 0; ++ mutex_unlock(&w1m_data->w1m_mutex); ++ phytium_w1m_put(w1m_data); ++ } + -+ return 0; ++ return val; +} + -+static int phytium_pcm_close(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream) ++static u8 phytium_w1_read_bit(void *_w1m) +{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ struct azx *chip = &dev->chip; -+ struct azx_dev *azx_dev = get_azx_dev(substream); -+ -+ mutex_lock(&chip->open_mutex); -+ azx_stream(azx_dev)->opened = 0; -+ azx_stream(azx_dev)->running = 0; -+ azx_stream(azx_dev)->substream = NULL; -+ -+ mutex_unlock(&chip->open_mutex); -+ return 0; ++ return phytium_w1_read_data(_w1m, true); +} + -+static int phytium_pcm_new(struct snd_soc_component *component, -+ struct snd_soc_pcm_runtime *rtd) ++static u8 phytium_w1_read_byte(void *_w1m) +{ -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ size_t size = phytium_pcm_hardware.buffer_bytes_max; -+ -+ snd_pcm_set_managed_buffer_all(rtd->pcm, -+ SNDRV_DMA_TYPE_DEV, -+ dev->pdev, size, size); -+ -+ return 0; ++ return phytium_w1_read_data(_w1m, false); +} + -+static const struct i2s_io_ops axi_i2s_io_ops; -+static const struct i2s_controller_ops axi_i2s_ops; -+ -+static int phytium_pcm_hw_params(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream, -+ struct snd_pcm_hw_params *hw_params) ++/* Write a byte of data to the device */ ++static void phytium_w1_write_data(void *_w1m, u8 byte, bool is_bit) +{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ struct azx *chip = &dev->chip; -+ struct azx_dev *azx_dev = get_azx_dev(substream); ++ struct w1m_data *w1m_data = _w1m; + int ret; ++ u8 status; + -+ azx_dev->core.bufsize = 0; -+ azx_dev->core.period_bytes = 0; -+ azx_dev->core.format_val = 0; -+ -+ switch (params_format(hw_params)) { -+ case SNDRV_PCM_FORMAT_S16_LE: -+ azx_dev->core.format_val = 2; -+ break; -+ -+ case SNDRV_PCM_FORMAT_S24_LE: -+ azx_dev->core.format_val = 0; -+ break; -+ -+ case SNDRV_PCM_FORMAT_S32_LE: -+ azx_dev->core.format_val = 0; -+ break; ++ /* First write to initialize the transfer */ ++ if (w1m_data->init_trans == 0) ++ phytium_w1m_get(w1m_data); + -+ default: -+ dev_err(dev->dev, "phytium-i2s: unsupported PCM fmt"); -+ return -EINVAL; ++ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); ++ if (ret < 0) { ++ dev_err(w1m_data->dev, "Could not acquire mutex\n"); ++ return; + } ++ mutex_unlock(&w1m_data->w1m_mutex); + ++ ret = phytium_write_data(w1m_data, byte, &status, is_bit); ++ if (ret < 0) { ++ dev_err(w1m_data->dev, "TX failure:Ctrl status %x\n", status); ++ return; ++ } + -+ ret = chip->ops->substream_alloc_pages(chip, substream, -+ params_buffer_bytes(hw_params)); -+ -+ return ret; ++ w1m_data->init_trans++; ++ w1m_disable_interrupt(w1m_data, PHY_W1M_INT_EN_B, ++ ~((u32)PHY_W1M_INT_EN_TXCOMPLETE)); ++ /* Second write, data transferred. Release the module */ ++ if (w1m_data->init_trans > 1) { ++ phytium_w1m_put(w1m_data); ++ ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); ++ if (ret < 0) { ++ dev_err(w1m_data->dev, "Could not acquire mutex\n"); ++ return; ++ } ++ w1m_data->init_trans = 0; ++ mutex_unlock(&w1m_data->w1m_mutex); ++ } +} -+/* -+ * set up a BDL entry -+ */ -+static int setup_bdle(struct i2sc_bus *bus, -+ struct snd_dma_buffer *dmab, -+ struct i2s_stream *azx_dev, __le32 **bdlp, -+ int ofs, int size, int with_ioc) -+{ -+ struct snd_pcm_substream *substream = azx_dev->substream; -+ struct snd_pcm_runtime *runtime = substream->runtime; -+ __le32 *bdl = *bdlp; -+ -+ dmab->addr = runtime->dma_addr; -+ while (size > 0) { -+ dma_addr_t addr; -+ int chunk; -+ -+ if (azx_dev->frags >= AZX_MAX_BDL_ENTRIES) -+ return -EINVAL; -+ -+ addr = snd_sgbuf_get_addr(dmab, ofs); -+ -+ /* program the address field of the BDL entry */ -+ bdl[0] = cpu_to_le32((u32)addr); -+ -+ bdl[1] = cpu_to_le32(upper_32_bits(addr)); + -+ /* program the size field of the BDL entry */ -+ chunk = snd_sgbuf_get_chunk_size(dmab, ofs, size); -+ -+ bdl[2] = cpu_to_le32(chunk); -+ -+ /* program the IOC to enable interrupt -+ * only when the whole fragment is processed -+ */ -+ size -= chunk; -+ bdl[3] = (size || !with_ioc) ? 0 : cpu_to_le32(0x01); ++static void phytium_w1_write_bit(void *_w1m, u8 bit) ++{ ++ phytium_w1_write_data(_w1m, bit, true); ++} + -+ bdl += 4; -+ azx_dev->frags++; -+ ofs += chunk; -+ } -+ *bdlp = bdl; -+ return ofs; ++static void phytium_w1_write_byte(void *_w1m, u8 bit) ++{ ++ phytium_w1_write_data(_w1m, bit, false); +} + -+int snd_i2s_stream_setup_periods(struct i2s_stream *azx_dev) ++static struct w1_bus_master phytium_w1_master = { ++ .read_byte = phytium_w1_read_byte, ++ .write_byte = phytium_w1_write_byte, ++ .read_bit = phytium_w1_read_bit, ++ .write_bit = phytium_w1_write_bit, ++ .reset_bus = phytium_w1_reset_bus, ++ .touch_bit = phytium_w1_touch_bit, ++}; ++ ++static int phytium_w1m_probe(struct platform_device *pdev) +{ -+ struct i2sc_bus *bus = azx_dev->bus; -+ struct snd_pcm_substream *substream = azx_dev->substream; -+ struct snd_pcm_runtime *runtime = substream->runtime; -+ __le32 *bdl; -+ int i, ofs, periods, period_bytes; -+ int pos_adj, pos_align; ++ struct device *dev = &pdev->dev; ++ struct w1m_data *w1m_data; ++ struct resource *res; ++ int ret, irq; + -+ period_bytes = azx_dev->period_bytes; -+ periods = azx_dev->bufsize / period_bytes; ++ w1m_data = devm_kzalloc(dev, sizeof(*w1m_data), GFP_KERNEL); ++ if (!w1m_data) ++ return -ENOMEM; + -+ /* program the initial BDL entries */ -+ bdl = (__le32 *)azx_dev->bdl.area; ++ w1m_data->dev = dev; ++ platform_set_drvdata(pdev, w1m_data); + -+ ofs = 0; -+ azx_dev->frags = 0; ++ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); ++ w1m_data->w1m_base = devm_ioremap_resource(dev, res); ++ if (IS_ERR(w1m_data->w1m_base)) ++ return PTR_ERR(w1m_data->w1m_base); + -+ pos_adj = bus->bdl_pos_adj; ++ w1m_data->w1m_usecount = 0; ++ mutex_init(&w1m_data->w1m_mutex); + -+ if (!azx_dev->no_period_wakeup && pos_adj > 0) { ++ pm_runtime_enable(&pdev->dev); ++ ret = pm_runtime_get_sync(&pdev->dev); ++ if (ret < 0) { ++ dev_err(&pdev->dev, "pm_runtime_get_sync failed\n"); ++ goto err_w1; ++ } + -+ pos_align = pos_adj; -+ pos_adj = (pos_adj * runtime->rate + 47999) / 48000; ++ spin_lock_init(&w1m_data->w1m_spinlock); + -+ if (!pos_adj) -+ pos_adj = pos_align; -+ else -+ pos_adj = ((pos_adj + pos_align - 1) / pos_align) * -+ pos_align; -+ -+ pos_adj = frames_to_bytes(runtime, pos_adj); -+ if (pos_adj >= period_bytes) { -+ dev_warn(bus->dev, "Too big adjustment %d\n", -+ pos_adj); -+ pos_adj = 0; -+ } else { -+ ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), -+ azx_dev, -+ &bdl, ofs, pos_adj, true); -+ if (ofs < 0) -+ goto error; -+ } -+ } else { -+ pos_adj = 0; ++ irq = platform_get_irq(pdev, 0); ++ if (irq < 0) { ++ dev_err(&pdev->dev, "Failed to get IRQ: %d\n", irq); ++ ret = irq; ++ goto err_irq; + } + -+ for (i = 0; i < periods; i++) { -+ if (i == periods - 1 && pos_adj) -+ ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), -+ azx_dev, &bdl, ofs, -+ period_bytes - pos_adj, 0); -+ else -+ ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), -+ azx_dev, &bdl, ofs, -+ period_bytes, -+ !azx_dev->no_period_wakeup); -+ if (ofs < 0) -+ goto error; ++ ret = devm_request_irq(dev, irq, w1m_isr, 0, "phytium-w1", w1m_data); ++ if (ret < 0) { ++ dev_err(&pdev->dev, "could not request irq\n"); ++ goto err_irq; + } + -+ return 0; -+ error: -+ dev_err(bus->dev, "Too many BDL entries: buffer=%d, period=%d\n", -+ azx_dev->bufsize, period_bytes); -+ return -EINVAL; -+} ++ pm_runtime_put_sync(&pdev->dev); + -+int snd_i2s_stream_set_params(struct i2s_stream *azx_dev, -+ unsigned int format_val) -+{ -+ unsigned int bufsize, period_bytes; -+ struct snd_pcm_substream *substream = azx_dev->substream; -+ struct snd_pcm_runtime *runtime; -+ int err; ++ phytium_w1_master.triplet = phytium_w1_triplet; ++ phytium_w1m_write(w1m_data, PHY_W1M_CTL, 0x10); ++ phytium_w1m_write(w1m_data, PHY_W1M_INT_EN_B, 0x00); + -+ if (!substream) -+ return -EINVAL; ++ phytium_w1_master.data = w1m_data; + -+ runtime = substream->runtime; -+ bufsize = snd_pcm_lib_buffer_bytes(substream); -+ period_bytes = snd_pcm_lib_period_bytes(substream); -+ if (bufsize != azx_dev->bufsize || -+ period_bytes != azx_dev->period_bytes || -+ runtime->no_period_wakeup != azx_dev->no_period_wakeup) { -+ azx_dev->bufsize = bufsize; -+ azx_dev->period_bytes = period_bytes; -+ azx_dev->no_period_wakeup = runtime->no_period_wakeup; -+ err = snd_i2s_stream_setup_periods(azx_dev); -+ if (err < 0) -+ return err; ++ ret = w1_add_master_device(&phytium_w1_master); ++ if (ret) { ++ dev_err(&pdev->dev, "Failure in registering w1 master\n"); ++ goto err_w1; + } + + return 0; -+} -+ -+int snd_i2s_stream_setup(struct i2s_stream *azx_dev, int pcie, u32 paddr) -+{ -+ struct snd_pcm_runtime *runtime; -+ -+ if (azx_dev->substream) -+ runtime = azx_dev->substream->runtime; -+ else -+ runtime = NULL; -+ -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHAL_CONFG0, 0x8081); -+ i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, 0x80000003); -+ -+ if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) { -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(1), (u32)azx_dev->bdl.addr); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(1), upper_32_bits(azx_dev->bdl.addr)); -+ if (pcie) -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(1), 0x1c8); -+ else -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(1), paddr + 0x1c8); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CBL(1), azx_dev->bufsize); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_LVI(1), azx_dev->frags - 1); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DSIZE(1), azx_dev->format_val);//0x2 -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DLENTH(1), 0x0);//0x0 -+ } else { -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(0), (u32)azx_dev->bdl.addr); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(0), upper_32_bits(azx_dev->bdl.addr)); -+ if (pcie) -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(0), 0x1c0); -+ else -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(0), paddr + 0x1c0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CBL(0), azx_dev->bufsize); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_LVI(0), azx_dev->frags - 1); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DSIZE(0), azx_dev->format_val << 2);//0x8 -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DLENTH(0), 0x0); -+ } + -+ if (runtime && runtime->period_size > 64) -+ azx_dev->delay_negative_threshold = -+ -frames_to_bytes(runtime, 64); -+ else -+ azx_dev->delay_negative_threshold = 0; ++err_irq: ++ pm_runtime_put_sync(&pdev->dev); ++err_w1: ++ pm_runtime_disable(&pdev->dev); + -+ return 0; ++ return ret; +} + -+static int phytium_pcm_prepare(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream) ++static int phytium_w1m_remove(struct platform_device *pdev) +{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ struct azx *chip = &dev->chip; -+ struct azx_dev *azx_dev = get_azx_dev(substream); -+ struct i2sc_bus *bus = azx_bus(chip); -+ struct i2s_stream *hstr_p; -+ int err; -+ -+ dev->substream = substream; -+ azx_dev->core.substream = substream; -+ azx_dev->core.sd_addr = dev->regs_db; -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { -+ azx_dev->core.bdl.area = bus->bdl0.area; -+ azx_dev->core.bdl.addr = bus->bdl0.addr; -+ } else { -+ azx_dev->core.bdl.area = bus->bdl1.area; -+ azx_dev->core.bdl.addr = bus->bdl1.addr; -+ } -+ -+ if (!substream) -+ return -EINVAL; -+ -+ hstr_p = azx_stream(azx_dev); -+ hstr_p->direction = substream->stream; -+ -+ err = snd_i2s_stream_set_params(azx_stream(azx_dev), 0); -+ if (err < 0) -+ goto unlock; -+ -+ snd_i2s_stream_setup(azx_stream(azx_dev), dev->pcie, dev->paddr); ++ struct w1m_data *w1m_data = platform_get_drvdata(pdev); + -+ unlock: -+ if (!err) -+ azx_stream(azx_dev)->prepared = 1; ++ mutex_lock(&w1m_data->w1m_mutex); + -+ return err; -+} ++ if (w1m_data->w1m_usecount) { ++ dev_warn(&pdev->dev, "removed when use count is not zero\n"); ++ mutex_unlock(&w1m_data->w1m_mutex); ++ return -EBUSY; ++ } + -+void snd_i2s_stream_clear(struct i2s_stream *azx_dev) -+{ -+ if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0x0); -+ else -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0x0); ++ mutex_unlock(&w1m_data->w1m_mutex); + -+ azx_dev->running = false; -+} ++ /* remove module dependency */ ++ pm_runtime_disable(&pdev->dev); + -+void snd_i2s_stream_stop(struct i2s_stream *azx_dev) -+{ -+ snd_i2s_stream_clear(azx_dev); ++ return 0; +} + -+void snd_i2s_stream_start(struct i2s_stream *azx_dev, bool fresh_start) -+{ -+ if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0x1); -+ else -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0x5); ++static const struct of_device_id phytium_w1m_dt_ids[] = { ++ { .compatible = "phytium,w1" }, ++ { } ++}; ++MODULE_DEVICE_TABLE(of, phytium_w1m_dt_ids); + -+ azx_dev->running = true; -+} ++#ifdef CONFIG_ACPI ++static const struct acpi_device_id phytium_w1m_acpi_ids[] = { ++ { "PHYT0034", 0 }, ++ { } ++}; ++MODULE_DEVICE_TABLE(acpi, phytium_w1m_acpi_ids); ++#endif + -+static int phytium_pcm_trigger(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream, int cmd) -+{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ struct azx *chip = &dev->chip; -+ struct i2sc_bus *bus = azx_bus(chip); -+ struct azx_dev *azx_dev = get_azx_dev(substream); -+ struct snd_pcm_substream *s; -+ struct i2s_stream *hstr; -+ bool start; -+ int sbits = 0; -+ -+ hstr = azx_stream(azx_dev); -+ hstr->direction = substream->stream; -+ -+ switch (cmd) { -+ case SNDRV_PCM_TRIGGER_START: -+ case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: -+ case SNDRV_PCM_TRIGGER_RESUME: -+ start = true; -+ break; -+ case SNDRV_PCM_TRIGGER_PAUSE_PUSH: -+ case SNDRV_PCM_TRIGGER_SUSPEND: -+ case SNDRV_PCM_TRIGGER_STOP: -+ start = false; -+ break; -+ default: -+ return -EINVAL; -+ } ++static struct platform_driver phytium_w1m_driver = { ++ .probe = phytium_w1m_probe, ++ .remove = phytium_w1m_remove, ++ .driver = { ++ .name = "phytium-w1", ++ .of_match_table = phytium_w1m_dt_ids, ++ .acpi_match_table = ACPI_PTR(phytium_w1m_acpi_ids), ++ }, ++}; ++module_platform_driver(phytium_w1m_driver); + -+ snd_pcm_group_for_each_entry(s, substream) { -+ if (s->pcm->card != substream->pcm->card) -+ continue; -+ azx_dev = get_azx_dev(s); -+ sbits |= 1 << azx_dev->core.index; -+ snd_pcm_trigger_done(s, substream); ++MODULE_AUTHOR("Zhu Mingshuai "); ++MODULE_DESCRIPTION("Phytium w1 bus master driver"); ++MODULE_LICENSE("GPL"); +diff --git a/drivers/watchdog/dw_wdt.c b/drivers/watchdog/dw_wdt.c +index 84dca3695..c444082e0 100644 +--- a/drivers/watchdog/dw_wdt.c ++++ b/drivers/watchdog/dw_wdt.c +@@ -12,6 +12,7 @@ + * heartbeat requests after the watchdog device has been closed. + */ + ++#include + #include + #include + #include +@@ -83,7 +84,7 @@ struct dw_wdt { + void __iomem *regs; + struct clk *clk; + struct clk *pclk; +- unsigned long rate; ++ u64 rate; + enum dw_wdt_rmod rmod; + struct dw_wdt_timeout timeouts[DW_WDT_NUM_TOPS]; + struct watchdog_device wdd; +@@ -560,33 +561,45 @@ static int dw_wdt_drv_probe(struct platform_device *pdev) + if (IS_ERR(dw_wdt->regs)) + return PTR_ERR(dw_wdt->regs); + +- /* +- * Try to request the watchdog dedicated timer clock source. It must +- * be supplied if asynchronous mode is enabled. Otherwise fallback +- * to the common timer/bus clocks configuration, in which the very +- * first found clock supply both timer and APB signals. +- */ +- dw_wdt->clk = devm_clk_get_enabled(dev, "tclk"); +- if (IS_ERR(dw_wdt->clk)) { +- dw_wdt->clk = devm_clk_get_enabled(dev, NULL); +- if (IS_ERR(dw_wdt->clk)) +- return PTR_ERR(dw_wdt->clk); +- } ++ if (dev->of_node) { ++ /* ++ * Try to request the watchdog dedicated timer clock source. It must ++ * be supplied if asynchronous mode is enabled. Otherwise fallback ++ * to the common timer/bus clocks configuration, in which the very ++ * first found clock supply both timer and APB signals. ++ */ ++ dw_wdt->clk = devm_clk_get_enabled(dev, "tclk"); ++ if (IS_ERR(dw_wdt->clk)) { ++ dw_wdt->clk = devm_clk_get_enabled(dev, NULL); ++ if (IS_ERR(dw_wdt->clk)) ++ return PTR_ERR(dw_wdt->clk); ++ } + +- dw_wdt->rate = clk_get_rate(dw_wdt->clk); +- if (dw_wdt->rate == 0) +- return -EINVAL; ++ dw_wdt->rate = clk_get_rate(dw_wdt->clk); ++ if (dw_wdt->rate == 0) ++ return -EINVAL; + +- /* +- * Request APB clock if device is configured with async clocks mode. +- * In this case both tclk and pclk clocks are supposed to be specified. +- * Alas we can't know for sure whether async mode was really activated, +- * so the pclk phandle reference is left optional. If it couldn't be +- * found we consider the device configured in synchronous clocks mode. +- */ +- dw_wdt->pclk = devm_clk_get_optional_enabled(dev, "pclk"); +- if (IS_ERR(dw_wdt->pclk)) +- return PTR_ERR(dw_wdt->pclk); ++ /* ++ * Request APB clock if device is configured with async clocks mode. ++ * In this case both tclk and pclk clocks are supposed to be specified. ++ * Alas we can't know for sure whether async mode was really activated, ++ * so the pclk phandle reference is left optional. If it couldn't be ++ * found we consider the device configured in synchronous clocks mode. ++ */ ++ dw_wdt->pclk = devm_clk_get_optional_enabled(dev, "pclk"); ++ if (IS_ERR(dw_wdt->pclk)) ++ return PTR_ERR(dw_wdt->pclk); ++ } else if (has_acpi_companion(&pdev->dev)) { ++ /* ++ * When Driver probe with ACPI device, clock devices ++ * are not available, so watchdog rate get from ++ * clock-frequency property given in _DSD object. ++ */ ++ device_property_read_u64(dev, "clock-frequency", ++ &dw_wdt->rate); ++ if (dw_wdt->rate == 0) ++ return -EINVAL; + } + + dw_wdt->rst = devm_reset_control_get_optional_shared(&pdev->dev, NULL); + if (IS_ERR(dw_wdt->rst)) +@@ -674,6 +687,12 @@ static void dw_wdt_drv_remove(struct platform_device *pdev) + reset_control_assert(dw_wdt->rst); + } + ++static const struct acpi_device_id dw_wdt_acpi_match[] = { ++ { "PHYT0014", 0 }, ++ { } ++}; ++MODULE_DEVICE_TABLE(acpi, dw_wdt_acpi_match); + -+ spin_lock(&bus->reg_lock); -+ -+ snd_pcm_group_for_each_entry(s, substream) { -+ if (s->pcm->card != substream->pcm->card) -+ continue; -+ azx_dev = get_azx_dev(s); -+ if (start) -+ snd_i2s_stream_start(azx_stream(azx_dev), true); -+ else -+ snd_i2s_stream_stop(azx_stream(azx_dev)); + #ifdef CONFIG_OF + static const struct of_device_id dw_wdt_of_match[] = { + { .compatible = "snps,dw-wdt", }, +@@ -688,6 +707,7 @@ static struct platform_driver dw_wdt_driver = { + .driver = { + .name = "dw_wdt", + .of_match_table = of_match_ptr(dw_wdt_of_match), ++ .acpi_match_table = ACPI_PTR(dw_wdt_acpi_match), + .pm = pm_sleep_ptr(&dw_wdt_pm_ops), + }, + }; +diff --git a/fs/hmdfs/comm/connection.c b/fs/hmdfs/comm/connection.c +index 046688747..44a4cb933 100644 +--- a/fs/hmdfs/comm/connection.c ++++ b/fs/hmdfs/comm/connection.c +@@ -640,11 +640,6 @@ void connection_handshake_recv_handler(struct connection *conn_impl, void *buf, + hmdfs_info( + "Recved handshake response: device_id = %llu, cmd->status = %hhu, tcp->fd = %d", + conn_impl->node->device_id, status, fd); +- if (status == CONNECT_STAT_WAIT_REQUEST) { +- // must be 10.1 device, no need to set ktls +- connection_to_working(conn_impl->node); +- goto out; +- } + + ret = hs_proc_msg_data(conn_impl, ops, data, data_len); + if (ret) +diff --git a/fs/hmdfs/comm/socket_adapter.c b/fs/hmdfs/comm/socket_adapter.c +index 6ed430268..b9f35b9e1 100644 +--- a/fs/hmdfs/comm/socket_adapter.c ++++ b/fs/hmdfs/comm/socket_adapter.c +@@ -281,7 +281,7 @@ static struct hmdfs_msg_parasite *mp_alloc(struct hmdfs_peer *peer, + return ERR_PTR(-ENOMEM); + + ret = hmdfs_alloc_msg_idr(peer, MSG_IDR_MESSAGE_ASYNC, mp, +- mp->head.send_cmd_operations); ++ req->operations); + if (unlikely(ret)) { + kfree(mp); + return ERR_PTR(ret); +diff --git a/fs/hmdfs/file_merge.c b/fs/hmdfs/file_merge.c +index 8fb439d3b..2a2998e32 100644 +--- a/fs/hmdfs/file_merge.c ++++ b/fs/hmdfs/file_merge.c +@@ -19,12 +19,12 @@ struct hmdfs_iterate_callback_merge { + /* + * Record the return value of 'caller->actor': + * +- * -EINVAL, buffer is exhausted +- * -EINTR, current task is pending +- * -EFAULT, something is wrong +- * 0, success and can do more ++ * false, buffer is exhausted ++ * false, current task is pending ++ * false, something is wrong ++ * true, success and can do more + */ +- int result; ++ bool result ; + struct rb_root *root; + uint64_t dev_id; + }; +@@ -210,7 +210,7 @@ static bool hmdfs_actor_merge(struct dir_context *ctx, const char *name, + int namelen, long long offset, unsigned long long ino, + unsigned int d_type) + { +- int ret = 0; ++ bool ret = true; + int insert_res = 0; + int max_devid_len = 2; + char *dentry_name = NULL; +@@ -219,14 +219,20 @@ static bool hmdfs_actor_merge(struct dir_context *ctx, const char *name, + struct hmdfs_iterate_callback_merge *iterate_callback_merge = NULL; + struct dir_context *org_ctx = NULL; + +- if (hmdfs_file_type(name) != HMDFS_TYPE_COMMON) +- return 0; ++ if (hmdfs_file_type(name) != HMDFS_TYPE_COMMON) { ++ /* ++ * return true here, so that the caller can continue to next ++ * dentry even if failed on this dentry somehow. ++ */ ++ return true; + } + -+ i2s_write_reg(dev->regs_db, DMA_CTL, 0x1); -+ spin_unlock(&bus->reg_lock); -+ -+ return 0; -+} -+ -+void snd_i2s_stream_cleanup(struct i2s_stream *azx_dev) -+{ -+ int cnt = 10; -+ u32 mask; -+ -+ if (azx_dev->sd_addr) { -+ if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) { -+ mask = i2s_read_reg(azx_dev->sd_addr, DMA_MASK_INT); -+ mask &= ~BIT(1); -+ i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, mask); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0); -+ while (cnt--) { -+ if (i2s_read_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1)) == 0) -+ break; -+ } -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 2); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(1), 0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(1), 0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_STS, azx_dev->sd_int_sta_mask); -+ } else { -+ mask = i2s_read_reg(azx_dev->sd_addr, DMA_MASK_INT); -+ mask &= ~BIT(0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, mask); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0); -+ while (cnt--) { -+ if (i2s_read_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0)) == 0) -+ break; -+ } -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 2); -+ i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(0), 0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(0), 0); -+ i2s_write_reg(azx_dev->sd_addr, DMA_STS, azx_dev->sd_int_sta_mask); + + if (namelen > NAME_MAX) +- return -EINVAL; ++ return false; + dentry_name = kzalloc(NAME_MAX + 1, GFP_KERNEL); + if (!dentry_name) +- return -ENOMEM; ++ return false; + + strncpy(dentry_name, name, dentry_len); + +@@ -245,7 +251,7 @@ static bool hmdfs_actor_merge(struct dir_context *ctx, const char *name, + } else if (d_type == DT_DIR && + (insert_res == DT_REG || insert_res == DT_LNK)) { + if (strlen(CONFLICTING_DIR_SUFFIX) > NAME_MAX - dentry_len) { +- ret = -ENAMETOOLONG; ++ ret = false; + goto delete; + } + rename_conflicting_directory(dentry_name, &dentry_len); +@@ -253,7 +259,7 @@ static bool hmdfs_actor_merge(struct dir_context *ctx, const char *name, + } else if ((d_type == DT_REG || d_type == DT_LNK) && insert_res > 0) { + if (strlen(CONFLICTING_FILE_SUFFIX) + max_devid_len > + NAME_MAX - dentry_len) { +- ret = -ENAMETOOLONG; ++ ret = false; + goto delete; + } + rename_conflicting_file(dentry_name, &dentry_len, +@@ -268,13 +274,12 @@ static bool hmdfs_actor_merge(struct dir_context *ctx, const char *name, + * different situations. + */ + iterate_callback_merge->result = ret; +- ret = ret == 0 ? 0 : 1; +- if (ret && d_type == DT_DIR && cache_entry->file_type == DT_DIR && ++ if (!ret && d_type == DT_DIR && cache_entry->file_type == DT_DIR && + (insert_res == DT_REG || insert_res == DT_LNK)) + cache_entry->file_type = DT_REG; + + delete: +- if (ret && !insert_res) ++ if (!ret && !insert_res) + delete_filename(iterate_callback_merge->root, cache_entry); + done: + kfree(dentry_name); +diff --git a/fs/hmdfs/hmdfs.h b/fs/hmdfs/hmdfs.h +index 61da068bb..5d1eec787 100644 +--- a/fs/hmdfs/hmdfs.h ++++ b/fs/hmdfs/hmdfs.h +@@ -43,7 +43,7 @@ + + // 20 digits +'\0', Converted from a u64 integer + #define HMDFS_ACCOUNT_HASH_MAX_LEN 21 +-#define CTRL_PATH_MAX_LEN 21 ++#define CTRL_PATH_MAX_LEN 11 + + #define HMDFS_SUPER_MAGIC 0x20200302 + +diff --git a/fs/hmdfs/hmdfs_dentryfile.c b/fs/hmdfs/hmdfs_dentryfile.c +index 2da6bd8ad..fda2f034b 100644 +--- a/fs/hmdfs/hmdfs_dentryfile.c ++++ b/fs/hmdfs/hmdfs_dentryfile.c +@@ -26,17 +26,6 @@ + #define HMDFS_HASH_COL_BIT ((0x1ULL) << 63) + #define DELTA 0x9E3779B9 + +-static bool is_dot_dotdot(const unsigned char *name, __u32 len) +-{ +- if (len == 1 && name[0] == '.') +- return true; +- +- if (len == 2 && name[0] == '.' && name[1] == '.') +- return true; +- +- return false; +-} +- + static void str2hashbuf(const unsigned char *msg, size_t len, unsigned int *buf, + int num, bool case_sense) + { +@@ -1827,25 +1816,25 @@ static bool cache_file_iterate(struct dir_context *ctx, const char *name, + + if (name_len > NAME_MAX) { + hmdfs_err("name_len:%d NAME_MAX:%u", name_len, NAME_MAX); +- return 0; ++ return true; + } + + if (d_type != DT_REG) +- return 0; ++ return true; + + cfi = kmalloc(sizeof(*cfi), GFP_KERNEL); + if (!cfi) +- return -ENOMEM; ++ return false; + + cfi->name = kstrndup(name, name_len, GFP_KERNEL); + if (!cfi->name) { + kfree(cfi); +- return -ENOMEM; ++ return false; + } + + list_add_tail(&cfi->list, &cb->list); + +- return 0; ++ return true; + } + + void hmdfs_do_load(struct hmdfs_sb_info *sbi, const char *fullname, bool server) +diff --git a/fs/hmdfs/hmdfs_server.c b/fs/hmdfs/hmdfs_server.c +index d7c4d98cf..b1217f476 100644 +--- a/fs/hmdfs/hmdfs_server.c ++++ b/fs/hmdfs/hmdfs_server.c +@@ -1463,10 +1463,10 @@ static bool hmdfs_filldir_real(struct dir_context *ctx, const char *name, + + out: + /* +- * we always return 0 here, so that the caller can continue to next ++ * we always return true here, so that the caller can continue to next + * dentry even if failed on this dentry somehow. + */ +- return 0; ++ return true; + } + + static void hmdfs_server_set_header(struct hmdfs_dcache_header *header, +diff --git a/fs/hmdfs/inode_cloud.c b/fs/hmdfs/inode_cloud.c +index 4f1caf7bd..6099f1336 100644 +--- a/fs/hmdfs/inode_cloud.c ++++ b/fs/hmdfs/inode_cloud.c +@@ -286,6 +286,10 @@ static struct dentry *hmdfs_lookup_cloud_dentry(struct inode *parent_inode, + if (in_share_dir(child_dentry)) + gdi->file_type = HM_SHARE; + inode = fill_inode_cloud(sb, lookup_result, parent_inode); ++ if (IS_ERR(inode)) { ++ ret = ERR_CAST(inode); ++ goto out; + } + + check_and_fixup_ownership_remote(parent_inode, + inode, +@@ -296,7 +300,7 @@ static struct dentry *hmdfs_lookup_cloud_dentry(struct inode *parent_inode, + } else { + ret = ERR_PTR(-ENOENT); + } +- ++out: + kfree(lookup_result); + return ret; + } +diff --git a/fs/hmdfs/inode_local.c b/fs/hmdfs/inode_local.c +index 4fd799a21..4509d3e40 100644 +--- a/fs/hmdfs/inode_local.c ++++ b/fs/hmdfs/inode_local.c +@@ -38,7 +38,6 @@ int init_hmdfs_dentry_info(struct hmdfs_sb_info *sbi, struct dentry *dentry, + + if (!info) + return -ENOMEM; +- dentry->d_fsdata = info; + INIT_LIST_HEAD(&info->cache_list_head); + INIT_LIST_HEAD(&info->remote_cache_list_head); + spin_lock_init(&info->cache_list_lock); +@@ -47,6 +46,7 @@ int init_hmdfs_dentry_info(struct hmdfs_sb_info *sbi, struct dentry *dentry, + spin_lock_init(&info->lock); + info->dentry_type = dentry_type; + info->device_id = 0; ++ dentry->d_fsdata = info; + if (dentry_type == HMDFS_LAYER_ZERO || + dentry_type == HMDFS_LAYER_FIRST_DEVICE || + dentry_type == HMDFS_LAYER_SECOND_LOCAL || +@@ -183,9 +183,9 @@ static bool hmdfs_name_match(struct dir_context *ctx, const char *name, + memcpy(buf->name, name, namelen); + buf->name[namelen] = 0; + buf->found = true; +- return 1; ++ return false; + } +- return 0; ++ return true; + } + + static int __lookup_nosensitive(struct path *lower_parent_path, +@@ -920,8 +920,13 @@ static int hmdfs_getattr_local(struct mnt_idmap *idmap, const struct path *path, + struct path lower_path; + int ret; + ++ if (path->dentry == NULL || hmdfs_d(path->dentry) == NULL) { ++ hmdfs_err("dentry is NULL"); ++ return -ENOENT; + } -+} -+ -+static int phytium_pcm_hw_free(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream) -+{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ struct azx *chip = &dev->chip; -+ struct i2s_stream *hstr_p; -+ struct azx_dev *azx_dev = get_azx_dev(substream); -+ int err; -+ -+ hstr_p = azx_stream(azx_dev); -+ hstr_p->direction = substream->stream; -+ snd_i2s_stream_cleanup(azx_stream(azx_dev)); -+ -+ err = chip->ops->substream_free_pages(chip, substream); -+ azx_stream(azx_dev)->prepared = 0; -+ -+ return err; -+} -+ -+static snd_pcm_uframes_t phytium_pcm_pointer(struct snd_soc_component *component, -+ struct snd_pcm_substream *substream) -+{ -+ struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); -+ struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); -+ u32 pos = 0; + -+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) -+ pos = i2s_read_reg(dev->regs_db, DMA_LPIB(1)); -+ else -+ pos = i2s_read_reg(dev->regs_db, DMA_LPIB(0)); -+ -+ return bytes_to_frames(substream->runtime, pos); -+} + hmdfs_get_lower_path(path->dentry, &lower_path); +- ret = vfs_getattr(&lower_path, stat, request_mask, flags); ++ ret = vfs_getattr_nosec(&lower_path, stat, request_mask, flags); + stat->ino = d_inode(path->dentry)->i_ino; + stat->uid = d_inode(path->dentry)->i_uid; + stat->gid = d_inode(path->dentry)->i_gid; +diff --git a/fs/hmdfs/inode_merge.c b/fs/hmdfs/inode_merge.c +index f090de1e4..7c1e1e4f8 100644 +--- a/fs/hmdfs/inode_merge.c ++++ b/fs/hmdfs/inode_merge.c +@@ -785,7 +785,7 @@ int hmdfs_getattr_merge(struct mnt_idmap *idmap, const struct path *path, struct + goto out; + } + +- ret = vfs_getattr(&lower_path, stat, request_mask, flags); ++ ret = vfs_getattr_nosec(&lower_path, stat, request_mask, flags); + out: + dput(lower_path.dentry); + return ret; +diff --git a/fs/hmdfs/main.c b/fs/hmdfs/main.c +index f08ed9fd9..7e0952990 100644 +--- a/fs/hmdfs/main.c ++++ b/fs/hmdfs/main.c +@@ -865,7 +865,6 @@ static int hmdfs_fill_super(struct super_block *sb, void *data, int silent) + struct super_block *lower_sb; + struct dentry *root_dentry; + char ctrl_path[CTRL_PATH_MAX_LEN]; +- uint64_t ctrl_hash; + + if (!raw_data) + return -EINVAL; +@@ -902,9 +901,8 @@ static int hmdfs_fill_super(struct super_block *sb, void *data, int silent) + goto out_freesbi; + + // add ctrl sysfs node +- ctrl_hash = path_hash(sbi->local_dst, strlen(sbi->local_dst), true); +- scnprintf(ctrl_path, CTRL_PATH_MAX_LEN, "%llu", ctrl_hash); +- hmdfs_debug("hash %llu", ctrl_hash); ++ scnprintf(ctrl_path, CTRL_PATH_MAX_LEN, "%u", sb->s_dev); ++ hmdfs_debug("s_dev %u", sb->s_dev); + err = hmdfs_register_sysfs(ctrl_path, sbi); + if (err) + goto out_freesbi; +diff --git a/fs/hmdfs/stash.c b/fs/hmdfs/stash.c +index c6c88b026..21c5fac34 100644 +--- a/fs/hmdfs/stash.c ++++ b/fs/hmdfs/stash.c +@@ -1022,10 +1022,10 @@ static bool hmdfs_has_stash_file(struct dir_context *dctx, const char *name, + err = hmdfs_parse_stash_file_name(dctx, name, namelen, + d_type, &stash_inum); + if (!err) +- return 0; ++ return true; + + ctx->tbl->cnt++; +- return 1; ++ return false; + } + + static bool hmdfs_fill_stash_file(struct dir_context *dctx, const char *name, +@@ -1040,13 +1040,13 @@ static bool hmdfs_fill_stash_file(struct dir_context *dctx, const char *name, + err = hmdfs_parse_stash_file_name(dctx, name, namelen, + d_type, &stash_inum); + if (!err) +- return 0; ++ return true; + if (ctx->tbl->cnt >= ctx->tbl->max) +- return 1; ++ return false; + + ctx->tbl->inodes[ctx->tbl->cnt++] = stash_inum; + +- return 0; ++ return true; + } + + static int hmdfs_del_stash_file(struct dentry *parent, struct dentry *child) +diff --git a/fs/sharefs/authentication.c b/fs/sharefs/authentication.c +index bc6e82509..39997c632 100644 +--- a/fs/sharefs/authentication.c ++++ b/fs/sharefs/authentication.c +@@ -95,4 +95,4 @@ void sharefs_revert_fsids(const struct cred *old_cred) + revert_creds(old_cred); + put_cred(cur_cred); + } +-#endif ++#endif +\ No newline at end of file +diff --git a/fs/sharefs/authentication.h b/fs/sharefs/authentication.h +index 165b66fc9..c9875d376 100644 +--- a/fs/sharefs/authentication.h ++++ b/fs/sharefs/authentication.h +@@ -4,6 +4,8 @@ + * + * Copyright (c) 2023 Huawei Device Co., Ltd. + */ ++#ifndef AUTHENTICATION_H ++#define AUTHENTICATION_H + + #include "sharefs.h" + +@@ -73,3 +75,5 @@ static inline int get_bundle_uid(struct sharefs_sb_info *sbi, const char *bname) + { + return sbi->user_id * BASE_USER_RANGE + get_bid_config(bname); + } + -+static const struct snd_soc_component_driver phytium_i2s_component = { -+ .name = "phytium-i2s", -+ .pcm_construct = phytium_pcm_new, -+ .open = phytium_pcm_open, -+ .close = phytium_pcm_close, -+ .hw_params = phytium_pcm_hw_params, -+ .hw_free = phytium_pcm_hw_free, -+ .prepare = phytium_pcm_prepare, -+ .trigger = phytium_pcm_trigger, -+ .pointer = phytium_pcm_pointer, -+ .suspend = phytium_i2s_suspend, -+ .resume = phytium_i2s_resume, -+ .legacy_dai_naming = 1, -+}; ++#endif //_AUTHENTICATION_H_ +\ No newline at end of file +diff --git a/fs/sharefs/file.c b/fs/sharefs/file.c +index 97547da44..bf5dbb346 100644 +--- a/fs/sharefs/file.c ++++ b/fs/sharefs/file.c +@@ -157,8 +157,7 @@ static loff_t sharefs_file_llseek(struct file *file, loff_t offset, int whence) + /* + * Sharefs read_iter, redirect modified iocb to lower read_iter + */ +-ssize_t +-sharefs_read_iter(struct kiocb *iocb, struct iov_iter *iter) ++ssize_t sharefs_read_iter(struct kiocb *iocb, struct iov_iter *iter) + { + int err; + struct file *file = iocb->ki_filp; +@@ -188,8 +187,7 @@ sharefs_read_iter(struct kiocb *iocb, struct iov_iter *iter) + /* + * Sharefs write_iter, redirect modified iocb to lower write_iter + */ +-ssize_t +-sharefs_write_iter(struct kiocb *iocb, struct iov_iter *iter) ++ssize_t sharefs_write_iter(struct kiocb *iocb, struct iov_iter *iter) + { + int err; + struct file *file = iocb->ki_filp; +diff --git a/fs/sharefs/inode.c b/fs/sharefs/inode.c +index 79a3f841e..546082924 100644 +--- a/fs/sharefs/inode.c ++++ b/fs/sharefs/inode.c +@@ -14,50 +14,6 @@ + #include "authentication.h" + #endif + +-static const char *sharefs_get_link(struct dentry *dentry, struct inode *inode, +- struct delayed_call *done) +-{ +- DEFINE_DELAYED_CALL(lower_done); +- struct dentry *lower_dentry; +- struct path lower_path; +- char *buf; +- const char *lower_link; +- +- if (!dentry) +- return ERR_PTR(-ECHILD); +- +- sharefs_get_lower_path(dentry, &lower_path); +- lower_dentry = lower_path.dentry; +- +- /* +- * get link from lower file system, but use a separate +- * delayed_call callback. +- */ +- lower_link = vfs_get_link(lower_dentry, &lower_done); +- if (IS_ERR(lower_link)) { +- buf = ERR_CAST(lower_link); +- goto out; +- } +- +- /* +- * we can't pass lower link up: have to make private copy and +- * pass that. +- */ +- buf = kstrdup(lower_link, GFP_KERNEL); +- do_delayed_call(&lower_done); +- if (!buf) { +- buf = ERR_PTR(-ENOMEM); +- goto out; +- } +- +- fsstack_copy_attr_atime(d_inode(dentry), d_inode(lower_dentry)); +- +- set_delayed_call(done, kfree_link, buf); +-out: +- sharefs_put_lower_path(dentry, &lower_path); +- return buf; +-} +- + static int sharefs_getattr(struct mnt_idmap *idmap, const struct path *path, struct kstat *stat, + u32 request_mask, unsigned int flags) + { +@@ -65,7 +21,7 @@ static int sharefs_getattr(struct mnt_idmap *idmap, const struct path *path, str + int ret; + + sharefs_get_lower_path(path->dentry, &lower_path); +- ret = vfs_getattr(&lower_path, stat, request_mask, flags); ++ ret = vfs_getattr_nosec(&lower_path, stat, request_mask, flags); + stat->ino = d_inode(path->dentry)->i_ino; + stat->uid = d_inode(path->dentry)->i_uid; + stat->gid = d_inode(path->dentry)->i_gid; +@@ -77,8 +33,7 @@ static int sharefs_getattr(struct mnt_idmap *idmap, const struct path *path, str + return ret; + } + +-static ssize_t +-sharefs_listxattr(struct dentry *dentry, char *buffer, size_t buffer_size) ++static ssize_t sharefs_listxattr(struct dentry *dentry, char *buffer, size_t buffer_size) + { + int err; + struct dentry *lower_dentry; +@@ -122,7 +77,7 @@ static int sharefs_permission(struct mnt_idmap *idmap, struct inode *inode, int + } + + #ifdef CONFIG_SHAREFS_SUPPORT_WRITE +-static int sharefs_create(struct inode *dir, struct dentry *dentry, ++static int sharefs_create(struct mnt_idmap *idmap, struct inode *dir, struct dentry *dentry, + umode_t mode, bool want_excl) + { + int err; +@@ -141,7 +96,7 @@ static int sharefs_create(struct inode *dir, struct dentry *dentry, + sharefs_get_lower_path(dentry, &lower_path); + lower_dentry = lower_path.dentry; + lower_parent_dentry = lock_parent(lower_dentry); +- err = vfs_create(d_inode(lower_parent_dentry), lower_dentry, mode, ++ err = vfs_create(&nop_mnt_idmap, d_inode(lower_parent_dentry), lower_dentry, mode, + want_excl); + if (err) + goto out; +@@ -158,7 +113,7 @@ static int sharefs_create(struct inode *dir, struct dentry *dentry, + return err; + } + +-static int sharefs_mkdir(struct inode *dir, struct dentry *dentry, umode_t mode) ++static int sharefs_mkdir(struct mnt_idmap *idmap, struct inode *dir, struct dentry *dentry, umode_t mode) + { + int err; + struct dentry *lower_dentry; +@@ -176,7 +131,7 @@ static int sharefs_mkdir(struct inode *dir, struct dentry *dentry, umode_t mode) + sharefs_get_lower_path(dentry, &lower_path); + lower_dentry = lower_path.dentry; + lower_parent_dentry = lock_parent(lower_dentry); +- err = vfs_mkdir(d_inode(lower_parent_dentry), lower_dentry, mode); ++ err = vfs_mkdir(&nop_mnt_idmap, d_inode(lower_parent_dentry), lower_dentry, mode); + if (err) + goto out; + +@@ -208,14 +163,14 @@ static int sharefs_unlink(struct inode *dir, struct dentry *dentry) + lower_dentry = lower_path.dentry; + dget(lower_dentry); + lower_dir_dentry = lock_parent(lower_dentry); +- err = vfs_unlink(lower_dir_inode, lower_dentry, NULL); ++ err = vfs_unlink(&nop_mnt_idmap, lower_dir_inode, lower_dentry, NULL); + if (err) + goto out; + fsstack_copy_attr_times(dir, lower_dir_inode); + fsstack_copy_inode_size(dir, lower_dir_inode); + set_nlink(dentry->d_inode, + sharefs_lower_inode(dentry->d_inode)->i_nlink); +- dentry->d_inode->i_ctime = dir->i_ctime; ++ dentry->d_inode->__i_ctime = dir->__i_ctime; + d_drop(dentry); + + out: +@@ -235,7 +190,7 @@ static int sharefs_rmdir(struct inode *dir, struct dentry *dentry) + sharefs_get_lower_path(dentry, &lower_path); + lower_dentry = lower_path.dentry; + lower_dir_dentry = lock_parent(lower_dentry); +- err = vfs_rmdir(lower_dir_dentry->d_inode, lower_dentry); ++ err = vfs_rmdir(&nop_mnt_idmap, lower_dir_dentry->d_inode, lower_dentry); + if (err) + goto out; + +@@ -252,7 +207,7 @@ static int sharefs_rmdir(struct inode *dir, struct dentry *dentry) + return err; + } + +-static int sharefs_rename(struct inode *old_dir, struct dentry *old_dentry, ++static int sharefs_rename(struct mnt_idmap *idmap, struct inode *old_dir, struct dentry *old_dentry, + struct inode *new_dir, struct dentry *new_dentry, + unsigned int flags) + { +@@ -263,6 +218,7 @@ static int sharefs_rename(struct inode *old_dir, struct dentry *old_dentry, + struct dentry *lower_new_dir_dentry = NULL; + struct dentry *trap = NULL; + struct path lower_old_path, lower_new_path; ++ struct renamedata rename_data; + + if (flags) + return -EINVAL; +@@ -285,9 +241,14 @@ static int sharefs_rename(struct inode *old_dir, struct dentry *old_dentry, + goto out; + } + +- err = vfs_rename(lower_old_dir_dentry->d_inode, lower_old_dentry, +- lower_new_dir_dentry->d_inode, lower_new_dentry, +- NULL, 0); ++ rename_data.old_mnt_idmap = &nop_mnt_idmap; ++ rename_data.old_dir = lower_old_dir_dentry->d_inode; ++ rename_data.old_dentry = lower_old_dentry; ++ rename_data.new_mnt_idmap = &nop_mnt_idmap; ++ rename_data.new_dir = lower_new_dir_dentry->d_inode; ++ rename_data.new_dentry = lower_new_dentry; ++ rename_data.flags = flags; ++ err = vfs_rename(&rename_data); + if (err) + goto out; + +@@ -308,8 +269,9 @@ static int sharefs_rename(struct inode *old_dir, struct dentry *old_dentry, + sharefs_put_lower_path(new_dentry, &lower_new_path); + return err; + } ++#endif + +-static int sharefs_setattr(struct dentry *dentry, struct iattr *ia) ++static int sharefs_setattr(struct mnt_idmap *idmap, struct dentry *dentry, struct iattr *ia) + { + int err; + struct dentry *lower_dentry; +@@ -325,7 +287,7 @@ static int sharefs_setattr(struct dentry *dentry, struct iattr *ia) + * calling notify_change on the lower inode. + */ + +- err = setattr_prepare(dentry, ia); ++ err = setattr_prepare(&nop_mnt_idmap, dentry, ia); + if (err) + goto out_err; + +@@ -353,12 +315,7 @@ static int sharefs_setattr(struct dentry *dentry, struct iattr *ia) + truncate_setsize(inode, ia->ia_size); + } + +- /* +- * mode change is for clearing setuid/setgid bits. Allow lower fs +- * to interpret this in its own way. +- */ +- if (lower_ia.ia_valid & (ATTR_KILL_SUID | ATTR_KILL_SGID)) +- lower_ia.ia_valid &= ~ATTR_MODE; ++ lower_ia.ia_valid &= ~(ATTR_MODE|ATTR_UID|ATTR_GID); + + /* notify the (possibly copied-up) lower inode */ + /* +@@ -368,7 +325,7 @@ static int sharefs_setattr(struct dentry *dentry, struct iattr *ia) + */ + + inode_lock(d_inode(lower_dentry)); +- err = notify_change(lower_dentry, &lower_ia, /* note: lower_ia */ ++ err = notify_change(&nop_mnt_idmap, lower_dentry, &lower_ia, /* note: lower_ia */ + NULL); + inode_unlock(d_inode(lower_dentry)); + +@@ -388,12 +345,11 @@ static int sharefs_setattr(struct dentry *dentry, struct iattr *ia) + out_err: + return err; + } +-#endif + + const struct inode_operations sharefs_symlink_iops = { + .permission = sharefs_permission, + .getattr = sharefs_getattr, +- .get_link = sharefs_get_link, ++ .get_link = NULL, + .listxattr = sharefs_listxattr, + }; + +@@ -402,13 +358,13 @@ const struct inode_operations sharefs_dir_iops = { + .permission = sharefs_permission, + .getattr = sharefs_getattr, + .listxattr = sharefs_listxattr, ++ .setattr = sharefs_setattr, + #ifdef CONFIG_SHAREFS_SUPPORT_WRITE + .unlink = sharefs_unlink, + .rmdir = sharefs_rmdir, + .rename = sharefs_rename, + .create = sharefs_create, + .mkdir = sharefs_mkdir, +- .setattr = sharefs_setattr, + #endif + }; + +@@ -416,7 +372,5 @@ const struct inode_operations sharefs_main_iops = { + .permission = sharefs_permission, + .getattr = sharefs_getattr, + .listxattr = sharefs_listxattr, +-#ifdef CONFIG_SHAREFS_SUPPORT_WRITE + .setattr = sharefs_setattr, +-#endif + }; +diff --git a/fs/sharefs/main.c b/fs/sharefs/main.c +index 6a858b49f..f83d5e71d 100644 +--- a/fs/sharefs/main.c ++++ b/fs/sharefs/main.c +@@ -145,7 +145,6 @@ static struct file_system_type sharefs_fs_type = { + .kill_sb = generic_shutdown_super, + .fs_flags = 0, + }; +-MODULE_ALIAS_FS(SHAREFS_NAME); + + static int __init init_sharefs_fs(void) + { +@@ -182,12 +181,13 @@ static void __exit exit_sharefs_fs(void) + sharefs_destroy_inode_cache(); + sharefs_destroy_dentry_cache(); + unregister_filesystem(&sharefs_fs_type); ++ sharefs_exit_configfs(); + pr_info("Completed sharefs module unload\n"); + } + +-MODULE_AUTHOR("Jingjing Mao"); +-MODULE_DESCRIPTION("Sharefs"); +-MODULE_LICENSE("GPL"); +- + module_init(init_sharefs_fs); + module_exit(exit_sharefs_fs); + -+/* Maximum bit resolution of a channel - not uniformly spaced */ -+static const u32 fifo_width[COMP_MAX_WORDSIZE] = { -+ 12, 16, 20, 24, 32, 0, 0, 0 -+}; ++MODULE_LICENSE("GPL V2"); ++MODULE_DESCRIPTION("Share File System"); ++MODULE_ALIAS_FS("sharefs"); +\ No newline at end of file +diff --git a/fs/sharefs/sharefs.h b/fs/sharefs/sharefs.h +index 5ac090fc9..fe3067ce5 100644 +--- a/fs/sharefs/sharefs.h ++++ b/fs/sharefs/sharefs.h +@@ -64,6 +64,8 @@ struct sharefs_sb_info { + struct super_block *lower_sb; + /* multi user */ + unsigned int user_id; ++ bool override; ++ bool override_support_delete; + }; + + /* operations vectors defined in specific files */ +diff --git a/fs/sharefs/super.c b/fs/sharefs/super.c +index bbe659446..cba0d2206 100644 +--- a/fs/sharefs/super.c ++++ b/fs/sharefs/super.c +@@ -13,12 +13,16 @@ + + enum { + OPT_USER_ID, +- OPT_ERR, ++ OPT_OVERRIDE, ++ OPT_OVERRIDE_SUPPORT_DELETE, ++ OPT_ERR, + }; + + static match_table_t sharefs_tokens = { + { OPT_USER_ID, "user_id=%s" }, +- { OPT_ERR, NULL } ++ { OPT_OVERRIDE, "override" }, ++ { OPT_OVERRIDE_SUPPORT_DELETE, "override_support_delete" }, ++ { OPT_ERR, NULL } + }; + + int sharefs_parse_options(struct sharefs_sb_info *sbi, const char *data) +@@ -58,6 +62,12 @@ int sharefs_parse_options(struct sharefs_sb_info *sbi, const char *data) + sbi->user_id = user_id; + } + break; ++ case OPT_OVERRIDE: ++ sbi->override = true; ++ break; ++ case OPT_OVERRIDE_SUPPORT_DELETE: ++ sbi->override_support_delete = true; ++ break; + default: + err = -EINVAL; + goto out; +diff --git a/include/acpi/acpi_drivers.h b/include/acpi/acpi_drivers.h +index b14d16563..0feb61171 100644 +--- a/include/acpi/acpi_drivers.h ++++ b/include/acpi/acpi_drivers.h +@@ -51,7 +51,7 @@ + + int acpi_irq_penalty_init(void); + int acpi_pci_link_allocate_irq(acpi_handle handle, int index, int *triggering, +- int *polarity, char **name); ++ int *polarity, char **name, struct fwnode_handle **rs_fwnode); + int acpi_pci_link_free_irq(acpi_handle handle); + + /* ACPI PCI Device Binding */ +diff --git a/include/acpi/ghes.h b/include/acpi/ghes.h +index be1dd4c1a..e9180206d 100644 +--- a/include/acpi/ghes.h ++++ b/include/acpi/ghes.h +@@ -130,6 +130,20 @@ int ghes_notify_sea(void); + static inline int ghes_notify_sea(void) { return -ENOENT; } + #endif + ++#ifdef CONFIG_ACPI_APEI_SEI ++int ghes_notify_sei(void); ++#else ++static inline int ghes_notify_sei(void) { return -ENOENT; } ++#endif + -+/* Width of (DMA) bus */ -+static const u32 bus_widths[COMP_MAX_DATA_WIDTH] = { -+ DMA_SLAVE_BUSWIDTH_1_BYTE, -+ DMA_SLAVE_BUSWIDTH_2_BYTES, -+ DMA_SLAVE_BUSWIDTH_4_BYTES, -+ DMA_SLAVE_BUSWIDTH_UNDEFINED ++struct ghes_mem_err { ++ int notify_type; ++ int severity; ++ struct cper_sec_mem_err *mem_err; +}; + -+/* PCM format to support channel resolution */ -+static const u32 formats[COMP_MAX_WORDSIZE] = { -+ SNDRV_PCM_FMTBIT_S16_LE, -+ SNDRV_PCM_FMTBIT_S16_LE, -+ SNDRV_PCM_FMTBIT_S24_LE, -+ SNDRV_PCM_FMTBIT_S24_LE, -+ SNDRV_PCM_FMTBIT_S32_LE, -+ 0, -+ 0, -+ 0 -+}; ++extern struct atomic_notifier_head ghes_mem_err_chain; + -+static int phytium_configure_dai(struct i2s_phytium *dev) + struct notifier_block; + extern void ghes_register_report_chain(struct notifier_block *nb); + extern void ghes_unregister_report_chain(struct notifier_block *nb); +diff --git a/include/linux/acpi.h b/include/linux/acpi.h +index afd94c9b8..78ff80550 100644 +--- a/include/linux/acpi.h ++++ b/include/linux/acpi.h +@@ -358,6 +358,18 @@ struct irq_domain *acpi_irq_create_hierarchy(unsigned int flags, + const struct irq_domain_ops *ops, + void *host_data); + ++#ifdef CONFIG_ACPI_GENERIC_GSI ++struct fwnode_handle *acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source, ++ u32 gsi); ++#else ++static inline ++struct fwnode_handle *acpi_get_irq_source_fwhandle(const struct acpi_resource_source *source, ++ u32 gsi) +{ -+ u32 comp1 = i2s_read_reg(dev->regs, dev->i2s_reg_comp1); -+ u32 comp2 = i2s_read_reg(dev->regs, dev->i2s_reg_comp2); -+ u32 fifo_depth = 1 << (1 + COMP1_FIFO_DEPTH_GLOBAL(comp1)); -+ u32 idx; -+ -+ if (COMP1_TX_ENABLED(comp1)) { -+ dev_dbg(dev->dev, " phytium: play supported\n"); -+ idx = COMP1_TX_WORDSIZE_0(comp1); -+ if (WARN_ON(idx >= ARRAY_SIZE(formats))) -+ return -EINVAL; -+ } -+ -+ if (COMP1_RX_ENABLED(comp1)) { -+ dev_dbg(dev->dev, "phytium: record supported\n"); -+ idx = COMP2_RX_WORDSIZE_0(comp2); -+ if (WARN_ON(idx >= ARRAY_SIZE(formats))) -+ return -EINVAL; -+ if (dev->quirks & PHYTIUM_I2S_QUIRK_16BIT_IDX_OVERRIDE) -+ idx = 1; -+ } -+ -+ if (COMP1_MODE_EN(comp1)) { -+ dev_dbg(dev->dev, "phytium: i2s master mode supported\n"); -+ dev->capability |= PHYTIUM_I2S_MASTER; -+ } else { -+ dev_dbg(dev->dev, "phytium: i2s slave mode supported\n"); -+ dev->capability |= PHYTIUM_I2S_SLAVE; -+ } -+ -+ dev->fifo_th = fifo_depth / 2; -+ return 0; ++ return NULL; +} ++#endif + -+static int phytium_configure_dai_by_dt(struct i2s_phytium *dev) + #ifdef CONFIG_X86_IO_APIC + extern int acpi_get_override_irq(u32 gsi, int *trigger, int *polarity); + #else +diff --git a/include/linux/cpuhotplug.h b/include/linux/cpuhotplug.h +index 624d4a38c..2f979c03d 100644 +--- a/include/linux/cpuhotplug.h ++++ b/include/linux/cpuhotplug.h +@@ -256,6 +256,8 @@ enum cpuhp_state { + CPUHP_AP_MM_DEMOTION_ONLINE, + CPUHP_AP_X86_HPET_ONLINE, + CPUHP_AP_X86_KVM_CLK_ONLINE, ++ CPUHP_AP_DTPM_CPU_ONLINE, ++ CPUHP_AP_HOMO_RPROC_STARTING, + CPUHP_AP_ACTIVE, + CPUHP_ONLINE, + }; +diff --git a/include/linux/fs.h b/include/linux/fs.h +index 62102f869..730f9088c 100644 +--- a/include/linux/fs.h ++++ b/include/linux/fs.h +@@ -2838,6 +2838,17 @@ extern bool path_is_under(const struct path *, const struct path *); + + extern char *file_path(struct file *, char *, int); + ++/** ++ * is_dot_dotdot - returns true only if @name is "." or ".." ++ * @name: file name to check ++ * @len: length of file name, in bytes ++ */ ++static inline bool is_dot_dotdot(const char *name, size_t len) +{ -+ u32 comp1 = i2s_read_reg(dev->regs, I2S_COMP_PARAM_1); -+ u32 comp2 = i2s_read_reg(dev->regs, I2S_COMP_PARAM_2); -+ u32 idx = COMP1_APB_DATA_WIDTH(comp1); -+ u32 idx2; -+ int ret; -+ -+ if (WARN_ON(idx >= ARRAY_SIZE(bus_widths))) -+ return -EINVAL; -+ -+ ret = phytium_configure_dai(dev); -+ if (ret < 0) -+ return ret; -+ -+ if (COMP1_TX_ENABLED(comp1)) { -+ idx2 = COMP1_TX_WORDSIZE_0(comp1); -+ dev->capability |= PHYTIUM_I2S_PLAY; -+ } -+ if (COMP1_RX_ENABLED(comp1)) { -+ idx2 = COMP2_RX_WORDSIZE_0(comp2); -+ dev->capability |= PHYTIUM_I2S_RECORD; -+ } -+ -+ return 0; ++ return len && unlikely(name[0] == '.') && ++ (len == 1 || (len == 2 && name[1] == '.')); +} + -+static int phytium_i2s_dma_alloc_pages(struct i2sc_bus *bus, int type, size_t size, -+ struct snd_dma_buffer *buf) -+{ -+ int err; -+ -+ err = snd_dma_alloc_pages(type, bus->dev, size, buf); -+ if (err < 0) -+ return err; -+ -+ return 0; -+} + #include + + /* needed for stackable file system support */ +diff --git a/include/linux/i3c/master.h b/include/linux/i3c/master.h +index 0b52da4f2..c55be28cf 100644 +--- a/include/linux/i3c/master.h ++++ b/include/linux/i3c/master.h +@@ -182,6 +182,7 @@ struct i3c_dev_boardinfo { + u8 static_addr; + u64 pid; + struct device_node *of_node; ++ struct fwnode_handle *fwnode; + }; + + /** +diff --git a/include/linux/irqchip/arm-gic-phytium-2500.h b/include/linux/irqchip/arm-gic-phytium-2500.h +new file mode 100644 +index 000000000..c80a65f28 +--- /dev/null ++++ b/include/linux/irqchip/arm-gic-phytium-2500.h +@@ -0,0 +1,661 @@ ++/* SPDX-License-Identifier: GPL-2.0 */ ++/* ++ * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. ++ */ + -+int snd_i2s_bus_alloc_stream_pages(struct i2sc_bus *bus) -+{ -+ struct i2s_stream *s; -+ int num_streams = 0; -+ int err; ++#ifndef __LINUX_IRQCHIP_ARM_GIC_PHYTIUM_2500_H ++#define __LINUX_IRQCHIP_ARM_GIC_PHYTIUM_2500_H + -+ list_for_each_entry(s, &bus->stream_list, list) { -+ /* allocate memory for the BDL for each stream */ -+ err = bus->io_ops->dma_alloc_pages(bus, SNDRV_DMA_TYPE_DEV, -+ BDL_SIZE, &s->bdl); -+ if (num_streams == 0) { -+ bus->bdl0.addr = s->bdl.addr; -+ bus->bdl0.area = s->bdl.area; -+ } else { -+ bus->bdl1.addr = s->bdl.addr; -+ bus->bdl1.area = s->bdl.area; -+ } -+ num_streams++; -+ if (err < 0) -+ return -ENOMEM; -+ } ++/* ++ * Distributor registers. We assume we're running non-secure, with ARE ++ * being set. Secure-only and non-ARE registers are not described. ++ */ ++#define GICD_CTLR 0x0000 ++#define GICD_TYPER 0x0004 ++#define GICD_IIDR 0x0008 ++#define GICD_TYPER2 0x000C ++#define GICD_STATUSR 0x0010 ++#define GICD_SETSPI_NSR 0x0040 ++#define GICD_CLRSPI_NSR 0x0048 ++#define GICD_SETSPI_SR 0x0050 ++#define GICD_CLRSPI_SR 0x0058 ++#define GICD_IGROUPR 0x0080 ++#define GICD_ISENABLER 0x0100 ++#define GICD_ICENABLER 0x0180 ++#define GICD_ISPENDR 0x0200 ++#define GICD_ICPENDR 0x0280 ++#define GICD_ISACTIVER 0x0300 ++#define GICD_ICACTIVER 0x0380 ++#define GICD_IPRIORITYR 0x0400 ++#define GICD_ICFGR 0x0C00 ++#define GICD_IGRPMODR 0x0D00 ++#define GICD_NSACR 0x0E00 ++#define GICD_IGROUPRnE 0x1000 ++#define GICD_ISENABLERnE 0x1200 ++#define GICD_ICENABLERnE 0x1400 ++#define GICD_ISPENDRnE 0x1600 ++#define GICD_ICPENDRnE 0x1800 ++#define GICD_ISACTIVERnE 0x1A00 ++#define GICD_ICACTIVERnE 0x1C00 ++#define GICD_IPRIORITYRnE 0x2000 ++#define GICD_ICFGRnE 0x3000 ++#define GICD_IROUTER 0x6000 ++#define GICD_IROUTERnE 0x8000 ++#define GICD_IDREGS 0xFFD0 ++#define GICD_PIDR2 0xFFE8 + -+ if (WARN_ON(!num_streams)) -+ return -EINVAL; ++#define ESPI_BASE_INTID 4096 + -+ return 0; -+} ++/* ++ * Those registers are actually from GICv2, but the spec demands that they ++ * are implemented as RES0 if ARE is 1 (which we do in KVM's emulated GICv3). ++ */ ++#define GICD_ITARGETSR 0x0800 ++#define GICD_SGIR 0x0F00 ++#define GICD_CPENDSGIR 0x0F10 ++#define GICD_SPENDSGIR 0x0F20 + -+static int stream_direction(struct azx *chip, unsigned char index) -+{ -+ if (index >= chip->playback_index_offset && -+ index < chip->playback_index_offset + chip->playback_streams) -+ return SNDRV_PCM_STREAM_PLAYBACK; -+ return SNDRV_PCM_STREAM_CAPTURE; -+} ++#define GICD_CTLR_RWP (1U << 31) ++#define GICD_CTLR_nASSGIreq (1U << 8) ++#define GICD_CTLR_DS (1U << 6) ++#define GICD_CTLR_ARE_NS (1U << 4) ++#define GICD_CTLR_ENABLE_G1A (1U << 1) ++#define GICD_CTLR_ENABLE_G1 (1U << 0) + -+void snd_i2s_stream_init(struct i2sc_bus *bus, struct i2s_stream *stream, -+ int idx, int direction, int tag) -+{ -+ stream->bus = bus; -+ stream->sd_addr = bus->remap_addr; ++#define GICD_IIDR_IMPLEMENTER_SHIFT 0 ++#define GICD_IIDR_IMPLEMENTER_MASK (0xfff << GICD_IIDR_IMPLEMENTER_SHIFT) ++#define GICD_IIDR_REVISION_SHIFT 12 ++#define GICD_IIDR_REVISION_MASK (0xf << GICD_IIDR_REVISION_SHIFT) ++#define GICD_IIDR_VARIANT_SHIFT 16 ++#define GICD_IIDR_VARIANT_MASK (0xf << GICD_IIDR_VARIANT_SHIFT) ++#define GICD_IIDR_PRODUCT_ID_SHIFT 24 ++#define GICD_IIDR_PRODUCT_ID_MASK (0xff << GICD_IIDR_PRODUCT_ID_SHIFT) + -+ if (idx == 0) -+ stream->sd_int_sta_mask = 1 << 8; -+ else -+ stream->sd_int_sta_mask = 1; + -+ stream->index = idx; -+ stream->direction = direction; -+ stream->stream_tag = tag; ++/* ++ * In systems with a single security state (what we emulate in KVM) ++ * the meaning of the interrupt group enable bits is slightly different ++ */ ++#define GICD_CTLR_ENABLE_SS_G1 (1U << 1) ++#define GICD_CTLR_ENABLE_SS_G0 (1U << 0) + -+ list_add_tail(&stream->list, &bus->stream_list); -+} ++#define GICD_TYPER_RSS (1U << 26) ++#define GICD_TYPER_LPIS (1U << 17) ++#define GICD_TYPER_MBIS (1U << 16) ++#define GICD_TYPER_ESPI (1U << 8) + -+int azx_i2s_init_streams(struct azx *chip) -+{ -+ int i; ++#define GICD_TYPER_ID_BITS(typer) ((((typer) >> 19) & 0x1f) + 1) ++#define GICD_TYPER_NUM_LPIS(typer) ((((typer) >> 11) & 0x1f) + 1) ++#define GICD_TYPER_SPIS(typer) ((((typer) & 0x1f) + 1) * 32) ++#define GICD_TYPER_ESPIS(typer) \ ++ (((typer) & GICD_TYPER_ESPI) ? GICD_TYPER_SPIS((typer) >> 27) : 0) + -+ for (i = 0; i < chip->num_streams; i++) { -+ struct azx_dev *azx_dev = kzalloc(sizeof(*azx_dev), GFP_KERNEL); -+ int dir, tag; ++#define GICD_TYPER2_nASSGIcap (1U << 8) ++#define GICD_TYPER2_VIL (1U << 7) ++#define GICD_TYPER2_VID GENMASK(4, 0) + -+ if (!azx_dev) -+ return -ENOMEM; ++#define GICD_IROUTER_SPI_MODE_ONE (0U << 31) ++#define GICD_IROUTER_SPI_MODE_ANY (1U << 31) + -+ dir = stream_direction(chip, i); ++#define GIC_PIDR2_ARCH_MASK 0xf0 ++#define GIC_PIDR2_ARCH_GICv3 0x30 ++#define GIC_PIDR2_ARCH_GICv4 0x40 + -+ tag = i + 1; ++#define GIC_V3_DIST_SIZE 0x10000 + -+ snd_i2s_stream_init(azx_bus(chip), azx_stream(azx_dev), i, dir, tag); -+ } ++#define GIC_PAGE_SIZE_4K 0ULL ++#define GIC_PAGE_SIZE_16K 1ULL ++#define GIC_PAGE_SIZE_64K 2ULL ++#define GIC_PAGE_SIZE_MASK 3ULL + -+ return 0; -+} ++/* ++ * Re-Distributor registers, offsets from RD_base ++ */ ++#define GICR_CTLR GICD_CTLR ++#define GICR_IIDR 0x0004 ++#define GICR_TYPER 0x0008 ++#define GICR_STATUSR GICD_STATUSR ++#define GICR_WAKER 0x0014 ++#define GICR_SETLPIR 0x0040 ++#define GICR_CLRLPIR 0x0048 ++#define GICR_PROPBASER 0x0070 ++#define GICR_PENDBASER 0x0078 ++#define GICR_INVLPIR 0x00A0 ++#define GICR_INVALLR 0x00B0 ++#define GICR_SYNCR 0x00C0 ++#define GICR_IDREGS GICD_IDREGS ++#define GICR_PIDR2 GICD_PIDR2 + -+static int azx_first_init(struct azx *chip) -+{ -+ struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); -+ struct platform_device *pdev = to_platform_device(i2s->dev); -+ struct device *i2sdev = i2s->dev; -+ struct i2sc_bus *bus = azx_bus(chip); -+ struct resource *res; -+ int err; -+ unsigned int dma_bits = 64; ++#define GICR_CTLR_ENABLE_LPIS (1UL << 0) ++#define GICR_CTLR_CES (1UL << 1) ++#define GICR_CTLR_IR (1UL << 2) ++#define GICR_CTLR_RWP (1UL << 3) + -+ chip->region_requested = 1; -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ bus->addr = res->start; -+ bus->remap_addr = i2s->regs_db; -+ bus->dev = i2s->pdev; ++#define GICR_TYPER_CPU_NUMBER(r) (((r) >> 8) & 0xffff) + -+ if (bus->remap_addr == NULL) { -+ dev_err(i2sdev, "ioremap error\n"); -+ return -ENXIO; -+ } ++#define EPPI_BASE_INTID 1056 + -+ if (azx_acquire_irq(chip, 0) < 0) -+ return -EBUSY; ++#define GICR_TYPER_NR_PPIS(r) \ ++ ({ \ ++ unsigned int __ppinum = ((r) >> 27) & 0x1f; \ ++ unsigned int __nr_ppis = 16; \ ++ if (__ppinum == 1 || __ppinum == 2) \ ++ __nr_ppis += __ppinum * 32; \ ++ \ ++ __nr_ppis; \ ++ }) + -+ synchronize_irq(bus->irq); ++#define GICR_WAKER_ProcessorSleep (1U << 1) ++#define GICR_WAKER_ChildrenAsleep (1U << 2) + -+ spin_lock_init(&bus->reg_lock); ++#define GIC_BASER_CACHE_nCnB 0ULL ++#define GIC_BASER_CACHE_SameAsInner 0ULL ++#define GIC_BASER_CACHE_nC 1ULL ++#define GIC_BASER_CACHE_RaWt 2ULL ++#define GIC_BASER_CACHE_RaWb 3ULL ++#define GIC_BASER_CACHE_WaWt 4ULL ++#define GIC_BASER_CACHE_WaWb 5ULL ++#define GIC_BASER_CACHE_RaWaWt 6ULL ++#define GIC_BASER_CACHE_RaWaWb 7ULL ++#define GIC_BASER_CACHE_MASK 7ULL ++#define GIC_BASER_NonShareable 0ULL ++#define GIC_BASER_InnerShareable 1ULL ++#define GIC_BASER_OuterShareable 2ULL ++#define GIC_BASER_SHAREABILITY_MASK 3ULL + -+ if (!dma_set_mask(i2sdev, DMA_BIT_MASK(dma_bits))) { -+ err = dma_set_coherent_mask(i2sdev, DMA_BIT_MASK(dma_bits)); -+ } else { -+ err = dma_set_mask(i2sdev, DMA_BIT_MASK(32)); -+ err = dma_set_coherent_mask(i2sdev, DMA_BIT_MASK(32)); -+ } ++#define GIC_BASER_CACHEABILITY(reg, inner_outer, type) \ ++ (GIC_BASER_CACHE_##type << reg##_##inner_outer##_CACHEABILITY_SHIFT) + -+ chip->playback_streams = NUM_PLAYBACK; -+ chip->capture_streams = NUM_CAPTURE; ++#define GIC_BASER_SHAREABILITY(reg, type) \ ++ (GIC_BASER_##type << reg##_SHAREABILITY_SHIFT) + -+ chip->playback_index_offset = 0; -+ chip->capture_index_offset = chip->playback_streams; -+ chip->num_streams = chip->playback_streams + chip->capture_streams; ++/* encode a size field of width @w containing @n - 1 units */ ++#define GIC_ENCODE_SZ(n, w) (((unsigned long)(n) - 1) & GENMASK_ULL(((w) - 1), 0)) + -+ err = azx_i2s_init_streams(chip); -+ if (err < 0) -+ return err; ++#define GICR_PROPBASER_SHAREABILITY_SHIFT (10) ++#define GICR_PROPBASER_INNER_CACHEABILITY_SHIFT (7) ++#define GICR_PROPBASER_OUTER_CACHEABILITY_SHIFT (56) ++#define GICR_PROPBASER_SHAREABILITY_MASK \ ++ GIC_BASER_SHAREABILITY(GICR_PROPBASER, SHAREABILITY_MASK) ++#define GICR_PROPBASER_INNER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, MASK) ++#define GICR_PROPBASER_OUTER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GICR_PROPBASER, OUTER, MASK) ++#define GICR_PROPBASER_CACHEABILITY_MASK GICR_PROPBASER_INNER_CACHEABILITY_MASK + -+ err = azx_alloc_stream_pages(chip); -+ if (err < 0) -+ return err; ++#define GICR_PROPBASER_InnerShareable \ ++ GIC_BASER_SHAREABILITY(GICR_PROPBASER, InnerShareable) + -+ return 0; -+} ++#define GICR_PROPBASER_nCnB GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, nCnB) ++#define GICR_PROPBASER_nC GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, nC) ++#define GICR_PROPBASER_RaWt GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, RaWt) ++#define GICR_PROPBASER_RaWb GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, RaWb) ++#define GICR_PROPBASER_WaWt GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, WaWt) ++#define GICR_PROPBASER_WaWb GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, WaWb) ++#define GICR_PROPBASER_RaWaWt GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, RaWaWt) ++#define GICR_PROPBASER_RaWaWb GIC_BASER_CACHEABILITY(GICR_PROPBASER, INNER, RaWaWb) + -+static int azx_probe_continue(struct azx *chip) -+{ -+ struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); -+ int err; ++#define GICR_PROPBASER_IDBITS_MASK (0x1f) ++#define GICR_PROPBASER_ADDRESS(x) ((x) & GENMASK_ULL(51, 12)) ++#define GICR_PENDBASER_ADDRESS(x) ((x) & GENMASK_ULL(51, 16)) + -+ i2s->probe_continued = 1; ++#define GICR_PENDBASER_SHAREABILITY_SHIFT (10) ++#define GICR_PENDBASER_INNER_CACHEABILITY_SHIFT (7) ++#define GICR_PENDBASER_OUTER_CACHEABILITY_SHIFT (56) ++#define GICR_PENDBASER_SHAREABILITY_MASK \ ++ GIC_BASER_SHAREABILITY(GICR_PENDBASER, SHAREABILITY_MASK) ++#define GICR_PENDBASER_INNER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, MASK) ++#define GICR_PENDBASER_OUTER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GICR_PENDBASER, OUTER, MASK) ++#define GICR_PENDBASER_CACHEABILITY_MASK GICR_PENDBASER_INNER_CACHEABILITY_MASK + -+ err = azx_first_init(chip); -+ if (err < 0) -+ goto out_free; ++#define GICR_PENDBASER_InnerShareable \ ++ GIC_BASER_SHAREABILITY(GICR_PENDBASER, InnerShareable) + -+ chip->running = 1; ++#define GICR_PENDBASER_nCnB GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, nCnB) ++#define GICR_PENDBASER_nC GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, nC) ++#define GICR_PENDBASER_RaWt GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, RaWt) ++#define GICR_PENDBASER_RaWb GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, RaWb) ++#define GICR_PENDBASER_WaWt GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, WaWt) ++#define GICR_PENDBASER_WaWb GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, WaWb) ++#define GICR_PENDBASER_RaWaWt GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, RaWaWt) ++#define GICR_PENDBASER_RaWaWb GIC_BASER_CACHEABILITY(GICR_PENDBASER, INNER, RaWaWb) + -+out_free: -+ return err; -+} ++#define GICR_PENDBASER_PTZ BIT_ULL(62) + -+static void azx_probe_work(struct work_struct *work) -+{ -+ struct i2s_phytium *i2s = container_of(work, struct i2s_phytium, probe_work); ++/* ++ * Re-Distributor registers, offsets from SGI_base ++ */ ++#define GICR_IGROUPR0 GICD_IGROUPR ++#define GICR_ISENABLER0 GICD_ISENABLER ++#define GICR_ICENABLER0 GICD_ICENABLER ++#define GICR_ISPENDR0 GICD_ISPENDR ++#define GICR_ICPENDR0 GICD_ICPENDR ++#define GICR_ISACTIVER0 GICD_ISACTIVER ++#define GICR_ICACTIVER0 GICD_ICACTIVER ++#define GICR_IPRIORITYR0 GICD_IPRIORITYR ++#define GICR_ICFGR0 GICD_ICFGR ++#define GICR_IGRPMODR0 GICD_IGRPMODR ++#define GICR_NSACR GICD_NSACR + -+ azx_probe_continue(&i2s->chip); -+} ++#define GICR_TYPER_PLPIS (1U << 0) ++#define GICR_TYPER_VLPIS (1U << 1) ++#define GICR_TYPER_DIRTY (1U << 2) ++#define GICR_TYPER_DirectLPIS (1U << 3) ++#define GICR_TYPER_LAST (1U << 4) ++#define GICR_TYPER_RVPEID (1U << 7) ++#define GICR_TYPER_COMMON_LPI_AFF GENMASK_ULL(25, 24) ++#define GICR_TYPER_AFFINITY GENMASK_ULL(63, 32) + -+int azx_i2s_bus_init(struct azx *chip, -+ const struct i2s_io_ops *io_ops) -+{ -+ struct i2s_bus *bus = &chip->bus; ++#define GICR_INVLPIR_INTID GENMASK_ULL(31, 0) ++#define GICR_INVLPIR_VPEID GENMASK_ULL(47, 32) ++#define GICR_INVLPIR_V GENMASK_ULL(63, 63) + -+ bus->core.io_ops = io_ops; ++#define GICR_INVALLR_VPEID GICR_INVLPIR_VPEID ++#define GICR_INVALLR_V GICR_INVLPIR_V + -+ INIT_LIST_HEAD(&bus->core.stream_list); -+ bus->card = chip->card; -+ mutex_init(&bus->prepare_mutex); -+ bus->pci = chip->pci; ++#define GIC_V3_REDIST_SIZE 0x20000 + -+ bus->core.bdl_pos_adj = chip->bdl_pos_adj; -+ return 0; -+} ++#define LPI_PROP_GROUP1 (1 << 1) ++#define LPI_PROP_ENABLED (1 << 0) + -+static int i2s_phytium_create(struct platform_device *pdev, -+ int dev, struct azx **rchip, struct i2s_phytium *i2s) -+{ -+ struct azx *chip; -+ int err; ++/* ++ * Re-Distributor registers, offsets from VLPI_base ++ */ ++#define GICR_VPROPBASER 0x0070 + -+ *rchip = NULL; ++#define GICR_VPROPBASER_IDBITS_MASK 0x1f + -+ if (!i2s) -+ return -ENOMEM; -+ chip = &i2s->chip; ++#define GICR_VPROPBASER_SHAREABILITY_SHIFT (10) ++#define GICR_VPROPBASER_INNER_CACHEABILITY_SHIFT (7) ++#define GICR_VPROPBASER_OUTER_CACHEABILITY_SHIFT (56) + -+ mutex_init(&chip->open_mutex); ++#define GICR_VPROPBASER_SHAREABILITY_MASK \ ++ GIC_BASER_SHAREABILITY(GICR_VPROPBASER, SHAREABILITY_MASK) ++#define GICR_VPROPBASER_INNER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, MASK) ++#define GICR_VPROPBASER_OUTER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GICR_VPROPBASER, OUTER, MASK) ++#define GICR_VPROPBASER_CACHEABILITY_MASK \ ++ GICR_VPROPBASER_INNER_CACHEABILITY_MASK + -+ chip->ops = &axi_i2s_ops; -+ chip->dev_index = dev; ++#define GICR_VPROPBASER_InnerShareable \ ++ GIC_BASER_SHAREABILITY(GICR_VPROPBASER, InnerShareable) + -+ INIT_LIST_HEAD(&chip->pcm_list); -+ init_completion(&i2s->probe_wait); ++#define GICR_VPROPBASER_nCnB GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, nCnB) ++#define GICR_VPROPBASER_nC GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, nC) ++#define GICR_VPROPBASER_RaWt GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, RaWt) ++#define GICR_VPROPBASER_RaWb GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, RaWb) ++#define GICR_VPROPBASER_WaWt GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, WaWt) ++#define GICR_VPROPBASER_WaWb GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, WaWb) ++#define GICR_VPROPBASER_RaWaWt GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, RaWaWt) ++#define GICR_VPROPBASER_RaWaWb GIC_BASER_CACHEABILITY(GICR_VPROPBASER, INNER, RaWaWb) + -+ chip->bdl_pos_adj = 32; -+ err = azx_i2s_bus_init(chip, &axi_i2s_io_ops); -+ if (err < 0) { -+ kfree(i2s); -+ return err; -+ } ++/* ++ * GICv4.1 VPROPBASER reinvention. A subtle mix between the old ++ * VPROPBASER and ITS_BASER. Just not quite any of the two. ++ */ ++#define GICR_VPROPBASER_4_1_VALID (1ULL << 63) ++#define GICR_VPROPBASER_4_1_ENTRY_SIZE GENMASK_ULL(61, 59) ++#define GICR_VPROPBASER_4_1_INDIRECT (1ULL << 55) ++#define GICR_VPROPBASER_4_1_PAGE_SIZE GENMASK_ULL(54, 53) ++#define GICR_VPROPBASER_4_1_Z (1ULL << 52) ++#define GICR_VPROPBASER_4_1_ADDR GENMASK_ULL(51, 12) ++#define GICR_VPROPBASER_4_1_SIZE GENMASK_ULL(6, 0) + -+ INIT_WORK(&i2s->probe_work, azx_probe_work); -+ *rchip = chip; -+ return 0; -+} ++#define GICR_VPENDBASER 0x0078 + -+static int substream_alloc_pages(struct azx *chip, -+ struct snd_pcm_substream *substream, -+ size_t size) -+{ -+ int ret; ++#define GICR_VPENDBASER_SHAREABILITY_SHIFT (10) ++#define GICR_VPENDBASER_INNER_CACHEABILITY_SHIFT (7) ++#define GICR_VPENDBASER_OUTER_CACHEABILITY_SHIFT (56) ++#define GICR_VPENDBASER_SHAREABILITY_MASK \ ++ GIC_BASER_SHAREABILITY(GICR_VPENDBASER, SHAREABILITY_MASK) ++#define GICR_VPENDBASER_INNER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, MASK) ++#define GICR_VPENDBASER_OUTER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GICR_VPENDBASER, OUTER, MASK) ++#define GICR_VPENDBASER_CACHEABILITY_MASK \ ++ GICR_VPENDBASER_INNER_CACHEABILITY_MASK + -+ ret = snd_pcm_lib_malloc_pages(substream, size); -+ if (ret < 0) -+ return ret; ++#define GICR_VPENDBASER_NonShareable \ ++ GIC_BASER_SHAREABILITY(GICR_VPENDBASER, NonShareable) + -+ return 0; -+} ++#define GICR_VPENDBASER_InnerShareable \ ++ GIC_BASER_SHAREABILITY(GICR_VPENDBASER, InnerShareable) + -+static void phytium_i2s_dma_free_pages(struct i2sc_bus *bus, -+ struct snd_dma_buffer *buf) -+{ -+ snd_dma_free_pages(buf); -+} ++#define GICR_VPENDBASER_nCnB GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, nCnB) ++#define GICR_VPENDBASER_nC GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, nC) ++#define GICR_VPENDBASER_RaWt GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, RaWt) ++#define GICR_VPENDBASER_RaWb GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, RaWb) ++#define GICR_VPENDBASER_WaWt GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, WaWt) ++#define GICR_VPENDBASER_WaWb GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, WaWb) ++#define GICR_VPENDBASER_RaWaWt GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, RaWaWt) ++#define GICR_VPENDBASER_RaWaWb GIC_BASER_CACHEABILITY(GICR_VPENDBASER, INNER, RaWaWb) + -+static const struct i2s_io_ops axi_i2s_io_ops = { -+ .dma_alloc_pages = phytium_i2s_dma_alloc_pages, -+ .dma_free_pages = phytium_i2s_dma_free_pages, -+}; ++#define GICR_VPENDBASER_Dirty (1ULL << 60) ++#define GICR_VPENDBASER_PendingLast (1ULL << 61) ++#define GICR_VPENDBASER_IDAI (1ULL << 62) ++#define GICR_VPENDBASER_Valid (1ULL << 63) + -+static const struct i2s_controller_ops axi_i2s_ops = { -+ .substream_alloc_pages = substream_alloc_pages, -+ .substream_free_pages = substream_free_pages, -+}; ++/* ++ * GICv4.1 VPENDBASER, used for VPE residency. On top of these fields, ++ * also use the above Valid, PendingLast and Dirty. ++ */ ++#define GICR_VPENDBASER_4_1_DB (1ULL << 62) ++#define GICR_VPENDBASER_4_1_VGRP0EN (1ULL << 59) ++#define GICR_VPENDBASER_4_1_VGRP1EN (1ULL << 58) ++#define GICR_VPENDBASER_4_1_VPEID GENMASK_ULL(15, 0) + -+static int phytium_i2s_probe(struct platform_device *pdev) -+{ -+ struct i2s_phytium *i2s; -+ struct azx *chip; -+ struct resource *res; -+ struct pdata_px210_mfd *pdata; -+ struct snd_soc_dai_driver *dai_drv; -+ struct clk *clk; -+ int err, ret; -+ int card_num = 1; -+ bool schedule_probe; -+ struct fwnode_handle *np; -+ -+ i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL); -+ if (!i2s) -+ return -ENOMEM; ++#define GICR_VSGIR 0x0080 + -+ dai_drv = devm_kzalloc(&pdev->dev, sizeof(*dai_drv), GFP_KERNEL); -+ if (!dai_drv) -+ return -ENOMEM; -+ memcpy(dai_drv, &phytium_i2s_dai, sizeof(phytium_i2s_dai)); ++#define GICR_VSGIR_VPEID GENMASK(15, 0) + -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -+ i2s->paddr = res->start; -+ i2s->regs = devm_ioremap_resource(&pdev->dev, res); ++#define GICR_VSGIPENDR 0x0088 + -+ res = platform_get_resource(pdev, IORESOURCE_MEM, 1); -+ i2s->regs_db = devm_ioremap_resource(&pdev->dev, res); ++#define GICR_VSGIPENDR_BUSY (1U << 31) ++#define GICR_VSGIPENDR_PENDING GENMASK(15, 0) + -+ if (IS_ERR(i2s->regs)) -+ return PTR_ERR(i2s->regs); ++/* ++ * ITS registers, offsets from ITS_base ++ */ ++#define GITS_CTLR 0x0000 ++#define GITS_IIDR 0x0004 ++#define GITS_TYPER 0x0008 ++#define GITS_MPIDR 0x0018 ++#define GITS_CBASER 0x0080 ++#define GITS_CWRITER 0x0088 ++#define GITS_CREADR 0x0090 ++#define GITS_BASER 0x0100 ++#define GITS_IDREGS_BASE 0xffd0 ++#define GITS_PIDR0 0xffe0 ++#define GITS_PIDR1 0xffe4 ++#define GITS_PIDR2 GICR_PIDR2 ++#define GITS_PIDR4 0xffd0 ++#define GITS_CIDR0 0xfff0 ++#define GITS_CIDR1 0xfff4 ++#define GITS_CIDR2 0xfff8 ++#define GITS_CIDR3 0xfffc + -+ i2s->irq_id = platform_get_irq(pdev, 0); ++#define GITS_TRANSLATER 0x10040 + -+ if (i2s->irq_id < 0) -+ return i2s->irq_id; ++#define GITS_SGIR 0x20020 + -+ i2s->i2s_reg_comp1 = I2S_COMP_PARAM_1; -+ i2s->i2s_reg_comp2 = I2S_COMP_PARAM_2; ++#define GITS_SGIR_VPEID GENMASK_ULL(47, 32) ++#define GITS_SGIR_VINTID GENMASK_ULL(3, 0) + -+ ret = phytium_configure_dai_by_dt(i2s); -+ if (ret < 0) -+ return ret; ++#define GITS_CTLR_ENABLE (1U << 0) ++#define GITS_CTLR_ImDe (1U << 1) ++#define GITS_CTLR_ITS_NUMBER_SHIFT 4 ++#define GITS_CTLR_ITS_NUMBER (0xFU << GITS_CTLR_ITS_NUMBER_SHIFT) ++#define GITS_CTLR_QUIESCENT (1U << 31) + -+ err = i2s_phytium_create(pdev, card_num, &chip, i2s); -+ if (err < 0) -+ return err; -+ schedule_probe = !chip->disabled; ++#define GITS_TYPER_PLPIS (1UL << 0) ++#define GITS_TYPER_VLPIS (1UL << 1) ++#define GITS_TYPER_ITT_ENTRY_SIZE_SHIFT 4 ++#define GITS_TYPER_ITT_ENTRY_SIZE GENMASK_ULL(7, 4) ++#define GITS_TYPER_IDBITS_SHIFT 8 ++#define GITS_TYPER_DEVBITS_SHIFT 13 ++#define GITS_TYPER_DEVBITS GENMASK_ULL(17, 13) ++#define GITS_TYPER_PTA (1UL << 19) ++#define GITS_TYPER_HCC_SHIFT 24 ++#define GITS_TYPER_HCC(r) (((r) >> GITS_TYPER_HCC_SHIFT) & 0xff) ++#define GITS_TYPER_VMOVP (1ULL << 37) ++#define GITS_TYPER_VMAPP (1ULL << 40) ++#define GITS_TYPER_SVPET GENMASK_ULL(42, 41) + -+ dev_set_drvdata(&pdev->dev, i2s); ++#define GITS_IIDR_REV_SHIFT 12 ++#define GITS_IIDR_REV_MASK (0xf << GITS_IIDR_REV_SHIFT) ++#define GITS_IIDR_REV(r) (((r) >> GITS_IIDR_REV_SHIFT) & 0xf) ++#define GITS_IIDR_PRODUCTID_SHIFT 24 + -+ pdata = dev_get_platdata(&pdev->dev); -+ i2s->dev = &pdev->dev; -+ if (pdata) { -+ dai_drv->name = pdata->name; -+ i2s->pdev = pdata->dev; -+ i2s->clk_base = pdata->clk_base; -+ i2s->pcie = 1; -+ } else if (pdev->dev.of_node) { -+ device_property_read_string(&pdev->dev, "dai-name", &dai_drv->name); -+ i2s->pdev = &pdev->dev; -+ clk = devm_clk_get(&pdev->dev, NULL); -+ i2s->clk_base = clk_get_rate(clk); -+ } else if (has_acpi_companion(&pdev->dev)) { -+ np = dev_fwnode(&(pdev->dev)); -+ ret = fwnode_property_read_string(np, "dai-name", &dai_drv->name); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing dai-name property from acpi\n"); -+ goto failed_get_dai_name; -+ } ++#define GITS_CBASER_VALID (1ULL << 63) ++#define GITS_CBASER_SHAREABILITY_SHIFT (10) ++#define GITS_CBASER_INNER_CACHEABILITY_SHIFT (59) ++#define GITS_CBASER_OUTER_CACHEABILITY_SHIFT (53) ++#define GITS_CBASER_SHAREABILITY_MASK \ ++ GIC_BASER_SHAREABILITY(GITS_CBASER, SHAREABILITY_MASK) ++#define GITS_CBASER_INNER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, MASK) ++#define GITS_CBASER_OUTER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GITS_CBASER, OUTER, MASK) ++#define GITS_CBASER_CACHEABILITY_MASK GITS_CBASER_INNER_CACHEABILITY_MASK + -+ i2s->pdev = &pdev->dev; -+ ret = fwnode_property_read_u32(np, "i2s_clk", &i2s->clk_base); -+ if (ret < 0) { -+ dev_err(&pdev->dev, "missing i2s_clk property from acpi\n"); -+ goto failed_get_dai_name; -+ } -+ } ++#define GITS_CBASER_InnerShareable \ ++ GIC_BASER_SHAREABILITY(GITS_CBASER, InnerShareable) + -+ ret = devm_snd_soc_register_component(&pdev->dev, &phytium_i2s_component, -+ dai_drv, 1); -+ if (ret != 0) -+ dev_err(&pdev->dev, "not able to register dai\n"); ++#define GITS_CBASER_nCnB GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, nCnB) ++#define GITS_CBASER_nC GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, nC) ++#define GITS_CBASER_RaWt GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWt) ++#define GITS_CBASER_RaWb GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWb) ++#define GITS_CBASER_WaWt GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, WaWt) ++#define GITS_CBASER_WaWb GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, WaWb) ++#define GITS_CBASER_RaWaWt GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWaWt) ++#define GITS_CBASER_RaWaWb GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWaWb) + -+ if (schedule_probe) -+ schedule_work(&i2s->probe_work); ++#define GITS_CBASER_ADDRESS(cbaser) ((cbaser) & GENMASK_ULL(51, 12)) + -+ if (chip->disabled) -+ complete_all(&i2s->probe_wait); ++#define GITS_BASER_NR_REGS 8 + -+ return 0; ++#define GITS_BASER_VALID (1ULL << 63) ++#define GITS_BASER_INDIRECT (1ULL << 62) + -+failed_get_dai_name: -+ return ret; -+} ++#define GITS_BASER_INNER_CACHEABILITY_SHIFT (59) ++#define GITS_BASER_OUTER_CACHEABILITY_SHIFT (53) ++#define GITS_BASER_INNER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GITS_BASER, INNER, MASK) ++#define GITS_BASER_CACHEABILITY_MASK GITS_BASER_INNER_CACHEABILITY_MASK ++#define GITS_BASER_OUTER_CACHEABILITY_MASK \ ++ GIC_BASER_CACHEABILITY(GITS_BASER, OUTER, MASK) ++#define GITS_BASER_SHAREABILITY_MASK \ ++ GIC_BASER_SHAREABILITY(GITS_BASER, SHAREABILITY_MASK) + -+static int phytium_i2s_remove(struct platform_device *pdev) -+{ -+ pm_runtime_disable(&pdev->dev); -+ return 0; -+} ++#define GITS_BASER_nCnB GIC_BASER_CACHEABILITY(GITS_BASER, INNER, nCnB) ++#define GITS_BASER_nC GIC_BASER_CACHEABILITY(GITS_BASER, INNER, nC) ++#define GITS_BASER_RaWt GIC_BASER_CACHEABILITY(GITS_BASER, INNER, RaWt) ++#define GITS_BASER_RaWb GIC_BASER_CACHEABILITY(GITS_BASER, INNER, RaWb) ++#define GITS_BASER_WaWt GIC_BASER_CACHEABILITY(GITS_BASER, INNER, WaWt) ++#define GITS_BASER_WaWb GIC_BASER_CACHEABILITY(GITS_BASER, INNER, WaWb) ++#define GITS_BASER_RaWaWt GIC_BASER_CACHEABILITY(GITS_BASER, INNER, RaWaWt) ++#define GITS_BASER_RaWaWb GIC_BASER_CACHEABILITY(GITS_BASER, INNER, RaWaWb) + -+static const struct of_device_id phytium_i2s_of_match[] = { -+ { .compatible = "phytium,i2s", }, -+ {}, -+}; -+MODULE_DEVICE_TABLE(of, phytium_i2s_of_match); ++#define GITS_BASER_TYPE_SHIFT (56) ++#define GITS_BASER_TYPE(r) (((r) >> GITS_BASER_TYPE_SHIFT) & 7) ++#define GITS_BASER_ENTRY_SIZE_SHIFT (48) ++#define GITS_BASER_ENTRY_SIZE(r) ((((r) >> GITS_BASER_ENTRY_SIZE_SHIFT) & 0x1f) + 1) ++#define GITS_BASER_ENTRY_SIZE_MASK GENMASK_ULL(52, 48) ++#define GITS_BASER_PHYS_52_to_48(phys) \ ++ (((phys) & GENMASK_ULL(47, 16)) | (((phys) >> 48) & 0xf) << 12) ++#define GITS_BASER_ADDR_48_to_52(baser) \ ++ (((baser) & GENMASK_ULL(47, 16)) | (((baser) >> 12) & 0xf) << 48) + -+#ifdef CONFIG_ACPI -+static const struct acpi_device_id phytium_i2s_acpi_match[] = { -+ { "PHYT0016", 0 }, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, phytium_i2s_acpi_match); -+#else -+#define phytium_i2s_acpi_match NULL -+#endif ++#define GITS_BASER_SHAREABILITY_SHIFT (10) ++#define GITS_BASER_InnerShareable \ ++ GIC_BASER_SHAREABILITY(GITS_BASER, InnerShareable) ++#define GITS_BASER_PAGE_SIZE_SHIFT (8) ++#define __GITS_BASER_PSZ(sz) (GIC_PAGE_SIZE_ ## sz << GITS_BASER_PAGE_SIZE_SHIFT) ++#define GITS_BASER_PAGE_SIZE_4K __GITS_BASER_PSZ(4K) ++#define GITS_BASER_PAGE_SIZE_16K __GITS_BASER_PSZ(16K) ++#define GITS_BASER_PAGE_SIZE_64K __GITS_BASER_PSZ(64K) ++#define GITS_BASER_PAGE_SIZE_MASK __GITS_BASER_PSZ(MASK) ++#define GITS_BASER_PAGES_MAX 256 ++#define GITS_BASER_PAGES_SHIFT (0) ++#define GITS_BASER_NR_PAGES(r) (((r) & 0xff) + 1) + -+static struct platform_driver phytium_i2s_driver = { -+ .probe = phytium_i2s_probe, -+ .remove = phytium_i2s_remove, -+ .driver = { -+ .name = "phytium-i2s", -+ .of_match_table = of_match_ptr(phytium_i2s_of_match), -+ .acpi_match_table = phytium_i2s_acpi_match, -+ }, -+}; ++#define GITS_BASER_TYPE_NONE 0 ++#define GITS_BASER_TYPE_DEVICE 1 ++#define GITS_BASER_TYPE_VCPU 2 ++#define GITS_BASER_TYPE_RESERVED3 3 ++#define GITS_BASER_TYPE_COLLECTION 4 ++#define GITS_BASER_TYPE_RESERVED5 5 ++#define GITS_BASER_TYPE_RESERVED6 6 ++#define GITS_BASER_TYPE_RESERVED7 7 + -+module_platform_driver(phytium_i2s_driver); ++#define GITS_LVL1_ENTRY_SIZE (8UL) + -+MODULE_DESCRIPTION("Phytium I2S Driver"); -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Zhang Yiqun "); -diff --git a/sound/soc/phytium/pmdk_dp.c b/sound/soc/phytium/pmdk_dp.c -new file mode 100644 -index 000000000..85ff8e566 ---- /dev/null -+++ b/sound/soc/phytium/pmdk_dp.c -@@ -0,0 +1,214 @@ -+// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. ++ * ITS commands + */ ++#define GITS_CMD_MAPD 0x08 ++#define GITS_CMD_MAPC 0x09 ++#define GITS_CMD_MAPTI 0x0a ++#define GITS_CMD_MAPI 0x0b ++#define GITS_CMD_MOVI 0x01 ++#define GITS_CMD_DISCARD 0x0f ++#define GITS_CMD_INV 0x0c ++#define GITS_CMD_MOVALL 0x0e ++#define GITS_CMD_INVALL 0x0d ++#define GITS_CMD_INT 0x03 ++#define GITS_CMD_CLEAR 0x04 ++#define GITS_CMD_SYNC 0x05 + -+#include -+#include -+#include -+#include -+ -+#define DAI_CNT(pmdk_dai_) sizeof(pmdk_dai_)/sizeof(struct snd_soc_dai_link) -+ -+struct pmdk_dp_private { -+ struct snd_soc_jack jack0; -+ struct snd_soc_jack jack1; -+ struct snd_soc_jack jack2; -+}; ++/* ++ * GICv4 ITS specific commands ++ */ ++#define GITS_CMD_GICv4(x) ((x) | 0x20) ++#define GITS_CMD_VINVALL GITS_CMD_GICv4(GITS_CMD_INVALL) ++#define GITS_CMD_VMAPP GITS_CMD_GICv4(GITS_CMD_MAPC) ++#define GITS_CMD_VMAPTI GITS_CMD_GICv4(GITS_CMD_MAPTI) ++#define GITS_CMD_VMOVI GITS_CMD_GICv4(GITS_CMD_MOVI) ++#define GITS_CMD_VSYNC GITS_CMD_GICv4(GITS_CMD_SYNC) ++/* VMOVP, VSGI and INVDB are the odd ones, as they dont have a physical counterpart */ ++#define GITS_CMD_VMOVP GITS_CMD_GICv4(2) ++#define GITS_CMD_VSGI GITS_CMD_GICv4(3) ++#define GITS_CMD_INVDB GITS_CMD_GICv4(0xe) + -+/* PMDK widgets */ -+static const struct snd_soc_dapm_widget pmdk_dp_dapm_widgets[] = { -+ SND_SOC_DAPM_LINE("DP", NULL), -+}; ++/* ++ * ITS error numbers ++ */ ++#define E_ITS_MOVI_UNMAPPED_INTERRUPT 0x010107 ++#define E_ITS_MOVI_UNMAPPED_COLLECTION 0x010109 ++#define E_ITS_INT_UNMAPPED_INTERRUPT 0x010307 ++#define E_ITS_CLEAR_UNMAPPED_INTERRUPT 0x010507 ++#define E_ITS_MAPD_DEVICE_OOR 0x010801 ++#define E_ITS_MAPD_ITTSIZE_OOR 0x010802 ++#define E_ITS_MAPC_PROCNUM_OOR 0x010902 ++#define E_ITS_MAPC_COLLECTION_OOR 0x010903 ++#define E_ITS_MAPTI_UNMAPPED_DEVICE 0x010a04 ++#define E_ITS_MAPTI_ID_OOR 0x010a05 ++#define E_ITS_MAPTI_PHYSICALID_OOR 0x010a06 ++#define E_ITS_INV_UNMAPPED_INTERRUPT 0x010c07 ++#define E_ITS_INVALL_UNMAPPED_COLLECTION 0x010d09 ++#define E_ITS_MOVALL_PROCNUM_OOR 0x010e01 ++#define E_ITS_DISCARD_UNMAPPED_INTERRUPT 0x010f07 + -+/* PMDK control */ -+static const struct snd_kcontrol_new pmdk_controls[] = { -+ SOC_DAPM_PIN_SWITCH("DP"), -+}; ++/* ++ * CPU interface registers ++ */ ++#define ICC_CTLR_EL1_EOImode_SHIFT (1) ++#define ICC_CTLR_EL1_EOImode_drop_dir (0U << ICC_CTLR_EL1_EOImode_SHIFT) ++#define ICC_CTLR_EL1_EOImode_drop (1U << ICC_CTLR_EL1_EOImode_SHIFT) ++#define ICC_CTLR_EL1_EOImode_MASK (1 << ICC_CTLR_EL1_EOImode_SHIFT) ++#define ICC_CTLR_EL1_CBPR_SHIFT 0 ++#define ICC_CTLR_EL1_CBPR_MASK (1 << ICC_CTLR_EL1_CBPR_SHIFT) ++#define ICC_CTLR_EL1_PMHE_SHIFT 6 ++#define ICC_CTLR_EL1_PMHE_MASK (1 << ICC_CTLR_EL1_PMHE_SHIFT) ++#define ICC_CTLR_EL1_PRI_BITS_SHIFT 8 ++#define ICC_CTLR_EL1_PRI_BITS_MASK (0x7 << ICC_CTLR_EL1_PRI_BITS_SHIFT) ++#define ICC_CTLR_EL1_ID_BITS_SHIFT 11 ++#define ICC_CTLR_EL1_ID_BITS_MASK (0x7 << ICC_CTLR_EL1_ID_BITS_SHIFT) ++#define ICC_CTLR_EL1_SEIS_SHIFT 14 ++#define ICC_CTLR_EL1_SEIS_MASK (0x1 << ICC_CTLR_EL1_SEIS_SHIFT) ++#define ICC_CTLR_EL1_A3V_SHIFT 15 ++#define ICC_CTLR_EL1_A3V_MASK (0x1 << ICC_CTLR_EL1_A3V_SHIFT) ++#define ICC_CTLR_EL1_RSS (0x1 << 18) ++#define ICC_CTLR_EL1_ExtRange (0x1 << 19) ++#define ICC_PMR_EL1_SHIFT 0 ++#define ICC_PMR_EL1_MASK (0xff << ICC_PMR_EL1_SHIFT) ++#define ICC_BPR0_EL1_SHIFT 0 ++#define ICC_BPR0_EL1_MASK (0x7 << ICC_BPR0_EL1_SHIFT) ++#define ICC_BPR1_EL1_SHIFT 0 ++#define ICC_BPR1_EL1_MASK (0x7 << ICC_BPR1_EL1_SHIFT) ++#define ICC_IGRPEN0_EL1_SHIFT 0 ++#define ICC_IGRPEN0_EL1_MASK (1 << ICC_IGRPEN0_EL1_SHIFT) ++#define ICC_IGRPEN1_EL1_SHIFT 0 ++#define ICC_IGRPEN1_EL1_MASK (1 << ICC_IGRPEN1_EL1_SHIFT) ++#define ICC_SRE_EL1_DIB (1U << 2) ++#define ICC_SRE_EL1_DFB (1U << 1) ++#define ICC_SRE_EL1_SRE (1U << 0) + -+/* PMDK connections */ -+static const struct snd_soc_dapm_route pmdk_dp_audio_map[] = { -+ {"DP", NULL, "TX"}, -+}; ++/* These are for GICv2 emulation only */ ++#define GICH_LR_VIRTUALID (0x3ffUL << 0) ++#define GICH_LR_PHYSID_CPUID_SHIFT (10) ++#define GICH_LR_PHYSID_CPUID (7UL << GICH_LR_PHYSID_CPUID_SHIFT) + -+#define SMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ -+ SND_SOC_DAIFMT_CBS_CFS) ++#define ICC_IAR1_EL1_SPURIOUS 0x3ff + -+static int pmdk_dp0_init(struct snd_soc_pcm_runtime *runtime) -+{ -+ struct snd_soc_card *card = runtime->card; -+ struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); -+ struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; -+ int ret; ++#define ICC_SRE_EL2_SRE (1 << 0) ++#define ICC_SRE_EL2_ENABLE (1 << 3) + -+ ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=0", SND_JACK_LINEOUT, -+ &priv->jack0); ++#define ICC_SGI1R_TARGET_LIST_SHIFT 0 ++#define ICC_SGI1R_TARGET_LIST_MASK (0xffff << ICC_SGI1R_TARGET_LIST_SHIFT) ++#define ICC_SGI1R_AFFINITY_1_SHIFT 16 ++#define ICC_SGI1R_AFFINITY_1_MASK (0xff << ICC_SGI1R_AFFINITY_1_SHIFT) ++#define ICC_SGI1R_SGI_ID_SHIFT 24 ++#define ICC_SGI1R_SGI_ID_MASK (0xfULL << ICC_SGI1R_SGI_ID_SHIFT) ++#define ICC_SGI1R_AFFINITY_2_SHIFT 32 ++#define ICC_SGI1R_AFFINITY_2_MASK (0xffULL << ICC_SGI1R_AFFINITY_2_SHIFT) ++#define ICC_SGI1R_IRQ_ROUTING_MODE_BIT 40 ++#define ICC_SGI1R_RS_SHIFT 44 ++#define ICC_SGI1R_RS_MASK (0xfULL << ICC_SGI1R_RS_SHIFT) ++#define ICC_SGI1R_AFFINITY_3_SHIFT 48 ++#define ICC_SGI1R_AFFINITY_3_MASK (0xffULL << ICC_SGI1R_AFFINITY_3_SHIFT) + -+ if (ret) { -+ dev_err(card->dev, "Jack creation failed %d\n", ret); -+ return ret; -+ } ++#include + -+ snd_soc_component_set_jack(component, &priv->jack0, NULL); -+ return ret; -+} ++#ifndef __ASSEMBLY__ + -+static int pmdk_dp1_init(struct snd_soc_pcm_runtime *runtime) -+{ -+ struct snd_soc_card *card = runtime->card; -+ struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); -+ struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; -+ int ret; ++/* ++ * We need a value to serve as a irq-type for LPIs. Choose one that will ++ * hopefully pique the interest of the reviewer. ++ */ ++#define GIC_IRQ_TYPE_LPI 0xa110c8ed + -+ ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=1", SND_JACK_LINEOUT, -+ &priv->jack1); ++struct rdists { ++ struct { ++ raw_spinlock_t rd_lock; ++ void __iomem *rd_base; ++ struct page *pend_page; ++ phys_addr_t phys_base; ++ u64 flags; ++ cpumask_t *vpe_table_mask; ++ void *vpe_l1_base; ++ } __percpu *rdist; ++ phys_addr_t prop_table_pa; ++ void *prop_table_va; ++ u64 flags; ++ u32 gicd_typer; ++ u32 gicd_typer2; ++ int cpuhp_memreserve_state; ++ bool has_vlpis; ++ bool has_rvpeid; ++ bool has_direct_lpi; ++ bool has_vpend_valid_dirty; ++}; + -+ if (ret) { -+ dev_err(card->dev, "Jack creation failed %d\n", ret); -+ return ret; -+ } -+ snd_soc_component_set_jack(component, &priv->jack1, NULL); -+ return ret; -+} ++struct irq_domain; ++struct fwnode_handle; ++int __init phytium_its_lpi_memreserve_init(void); ++int phytium_its_cpu_init(void); ++int phytium_its_init(struct fwnode_handle *handle, struct rdists *rdists, ++ struct irq_domain *domain); ++int mbi_init(struct fwnode_handle *fwnode, struct irq_domain *parent); + -+static int pmdk_dp2_init(struct snd_soc_pcm_runtime *runtime) ++static inline bool gic_enable_sre(void) +{ -+ struct snd_soc_card *card = runtime->card; -+ struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); -+ struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; -+ int ret; ++ u32 val; + -+ ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=2", SND_JACK_LINEOUT, -+ &priv->jack2); ++ val = gic_read_sre(); ++ if (val & ICC_SRE_EL1_SRE) ++ return true; + -+ if (ret) { -+ dev_err(card->dev, "Jack creation failed %d\n", ret); -+ return ret; -+ } -+ snd_soc_component_set_jack(component, &priv->jack2, NULL); -+ return ret; ++ val |= ICC_SRE_EL1_SRE; ++ gic_write_sre(val); ++ val = gic_read_sre(); ++ ++ return !!(val & ICC_SRE_EL1_SRE); +} + -+SND_SOC_DAILINK_DEFS(pmdk_dp0_dai, -+ DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp0")), -+ DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918656", "i2s-hifi")), -+ DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); ++#endif ++ ++#endif +diff --git a/include/linux/memcheck.h b/include/linux/memcheck.h +new file mode 100644 +index 000000000..087cd760e +--- /dev/null ++++ b/include/linux/memcheck.h +@@ -0,0 +1,22 @@ ++/* SPDX-License-Identifier: GPL-2.0 */ ++/* ++ * include/linux/memcheck.h ++ * ++ * Copyright (c) 2022 Huawei Technologies Co., Ltd. ++ */ ++#ifndef _MEMCHECK_H ++#define _MEMCHECK_H + -+SND_SOC_DAILINK_DEFS(pmdk_dp1_dai, -+ DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp1")), -+ DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918657", "i2s-hifi")), -+ DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); ++#ifdef CONFIG_MEMTRACE_ASHMEM ++void init_ashmem_process_info(void); ++#else ++static inline void init_ashmem_process_info(void) {} ++#endif + -+SND_SOC_DAILINK_DEFS(pmdk_dp2_dai, -+ DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp2")), -+ DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918658", "i2s-hifi")), -+ DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); ++#ifdef CONFIG_PURGEABLE_ASHMEM ++void init_purgeable_ashmem_trigger(void); ++#else ++static inline void init_purgeable_ashmem_trigger(void) {} ++#endif ++#endif /* _MEMCHECK_H */ + -+static struct snd_soc_dai_link pmdk_dai_local[] = { -+{ -+ .name = "Phytium dp0-audio", -+ .stream_name = "Playback", -+ .dai_fmt = SMDK_DAI_FMT, -+ .init = pmdk_dp0_init, -+ .playback_only = true, -+ SND_SOC_DAILINK_REG(pmdk_dp0_dai), -+},{ -+ .name = "Phytium dp1-audio", -+ .stream_name = "Playback", -+ .dai_fmt = SMDK_DAI_FMT, -+ .init = pmdk_dp1_init, -+ .playback_only = true, -+ SND_SOC_DAILINK_REG(pmdk_dp1_dai), -+}, -+{ -+ .name = "Phytium dp2-audio", -+ .stream_name = "Playback", -+ .dai_fmt = SMDK_DAI_FMT, -+ .init = pmdk_dp2_init, -+ .playback_only = true, -+ SND_SOC_DAILINK_REG(pmdk_dp2_dai), -+}, -+}; +diff --git a/include/linux/mtd/partitions.h b/include/linux/mtd/partitions.h +index b74a539ec..73f16747d 100644 +--- a/include/linux/mtd/partitions.h ++++ b/include/linux/mtd/partitions.h +@@ -51,6 +51,7 @@ struct mtd_partition { + uint32_t mask_flags; /* master MTD flags to mask out for this partition */ + uint32_t add_flags; /* flags to add to the partition */ + struct device_node *of_node; ++ struct fwnode_handle *fwnode; + }; + + #define MTDPART_OFS_RETAIN (-3) +@@ -61,6 +62,8 @@ struct mtd_partition { + + struct mtd_info; + struct device_node; ++struct acpi_device; ++struct hwnode_handle; + + /** + * struct mtd_part_parser_data - used to pass data to MTD partition parsers. +@@ -80,6 +83,7 @@ struct mtd_part_parser { + struct module *owner; + const char *name; + const struct of_device_id *of_match_table; ++ const struct acpi_device_id *acpi_match_table; + int (*parse_fn)(struct mtd_info *, const struct mtd_partition **, + struct mtd_part_parser_data *); + void (*cleanup)(const struct mtd_partition *pparts, int nr_parts); +diff --git a/include/linux/pci_ids.h b/include/linux/pci_ids.h +index a6c66ea80..b69da9209 100644 +--- a/include/linux/pci_ids.h ++++ b/include/linux/pci_ids.h +@@ -3213,4 +3213,6 @@ + + #define PCI_VENDOR_ID_NCUBE 0x10ff + ++#define PCI_VENDOR_ID_PHYTIUM 0x1db7 + -+static struct snd_soc_card pmdk = { -+ .name = "PMDK-I2S", -+ .owner = THIS_MODULE, + #endif /* _LINUX_PCI_IDS_H */ +diff --git a/include/linux/ras.h b/include/linux/ras.h +index 1f4048bf2..f695e7e76 100644 +--- a/include/linux/ras.h ++++ b/include/linux/ras.h +@@ -24,7 +24,7 @@ int __init parse_cec_param(char *str); + void log_non_standard_event(const guid_t *sec_type, + const guid_t *fru_id, const char *fru_text, + const u8 sev, const u8 *err, const u32 len); +-void log_arm_hw_error(struct cper_sec_proc_arm *err); ++void log_arm_hw_error(struct cper_sec_proc_arm *err, const u8 sev); + #else + static inline void + log_non_standard_event(const guid_t *sec_type, +@@ -32,7 +32,18 @@ log_non_standard_event(const guid_t *sec_type, + const u8 sev, const u8 *err, const u32 len) + { return; } + static inline void +-log_arm_hw_error(struct cper_sec_proc_arm *err) { return; } ++log_arm_hw_error(struct cper_sec_proc_arm *err, const u8 sev) { return; } + #endif + ++#if defined(CONFIG_ARM) || defined(CONFIG_ARM64) ++#include ++/* ++ * Include ARM specific SMP header which provides a function mapping mpidr to ++ * cpu logical index ++ */ ++#define GET_LOGICAL_INDEX(mpidr) get_logical_index(mpidr & MPIDR_HWID_BITMASK) ++#else ++#define GET_LOGICAL_INDEX(mpidr) -EINVAL ++#endif /* CONFIG_ARM || CONFIG_ARM64 */ + -+ .dapm_widgets = pmdk_dp_dapm_widgets, -+ .num_dapm_widgets = ARRAY_SIZE(pmdk_dp_dapm_widgets), -+ .controls = pmdk_controls, -+ .num_controls = ARRAY_SIZE(pmdk_controls), -+ .dapm_routes = pmdk_dp_audio_map, -+ .num_dapm_routes = ARRAY_SIZE(pmdk_dp_audio_map), -+}; + #endif /* __RAS_H__ */ +diff --git a/include/ras/ras_event.h b/include/ras/ras_event.h +index cbd3ddd7c..417c7fb99 100644 +--- a/include/ras/ras_event.h ++++ b/include/ras/ras_event.h +@@ -168,11 +168,24 @@ TRACE_EVENT(mc_event, + * This event is generated when hardware detects an ARM processor error + * has occurred. UEFI 2.6 spec section N.2.4.4. + */ ++#define APEIL "ARM Processor Err Info data len" ++#define APEID "ARM Processor Err Info raw data" ++#define APECIL "ARM Processor Err Context Info data len" ++#define APECID "ARM Processor Err Context Info raw data" ++#define VSEIL "Vendor Specific Err Info data len" ++#define VSEID "Vendor Specific Err Info raw data" + TRACE_EVENT(arm_event, + +- TP_PROTO(const struct cper_sec_proc_arm *proc), ++ TP_PROTO(const struct cper_sec_proc_arm *proc, const u8 *pei_err, ++ const u32 pei_len, ++ const u8 *ctx_err, ++ const u32 ctx_len, ++ const u8 *oem, ++ const u32 oem_len, ++ u8 sev, ++ int cpu), + +- TP_ARGS(proc), ++ TP_ARGS(proc, pei_err, pei_len, ctx_err, ctx_len, oem, oem_len, sev, cpu), + + TP_STRUCT__entry( + __field(u64, mpidr) +@@ -180,6 +193,14 @@ TRACE_EVENT(arm_event, + __field(u32, running_state) + __field(u32, psci_state) + __field(u8, affinity) ++ __field(u32, pei_len) ++ __dynamic_array(u8, buf, pei_len) ++ __field(u32, ctx_len) ++ __dynamic_array(u8, buf1, ctx_len) ++ __field(u32, oem_len) ++ __dynamic_array(u8, buf2, oem_len) ++ __field(u8, sev) ++ __field(int, cpu) + ), + + TP_fast_assign( +@@ -199,12 +220,29 @@ TRACE_EVENT(arm_event, + __entry->running_state = ~0; + __entry->psci_state = ~0; + } ++ __entry->pei_len = pei_len; ++ memcpy(__get_dynamic_array(buf), pei_err, pei_len); ++ __entry->ctx_len = ctx_len; ++ memcpy(__get_dynamic_array(buf1), ctx_err, ctx_len); ++ __entry->oem_len = oem_len; ++ memcpy(__get_dynamic_array(buf2), oem, oem_len); ++ __entry->sev = sev; ++ __entry->cpu = cpu; + ), + +- TP_printk("affinity level: %d; MPIDR: %016llx; MIDR: %016llx; " +- "running state: %d; PSCI state: %d", ++ TP_printk("cpu:%d; error: %d; affinity level: %d; MPIDR: %016llx; MIDR: %016llx; " ++ "running state: %d; PSCI state: %d; " ++ "%s: %d; %s: %s; %s: %d; %s: %s; %s: %d; %s: %s", ++ __entry->cpu, ++ __entry->sev, + __entry->affinity, __entry->mpidr, __entry->midr, +- __entry->running_state, __entry->psci_state) ++ __entry->running_state, __entry->psci_state, ++ APEIL, __entry->pei_len, APEID, ++ __print_hex(__get_dynamic_array(buf), __entry->pei_len), ++ APECIL, __entry->ctx_len, APECID, ++ __print_hex(__get_dynamic_array(buf1), __entry->ctx_len), ++ VSEIL, __entry->oem_len, VSEID, ++ __print_hex(__get_dynamic_array(buf2), __entry->oem_len)) + ); + + /* +diff --git a/include/sound/hdaudio.h b/include/sound/hdaudio.h +index 32c59053b..65d58c647 100644 +--- a/include/sound/hdaudio.h ++++ b/include/sound/hdaudio.h +@@ -350,6 +350,7 @@ struct hdac_bus { + bool needs_damn_long_delay:1; + bool not_use_interrupts:1; /* prohibiting the RIRB IRQ */ + bool access_sdnctl_in_dword:1; /* accessing the sdnctl register by dword */ ++ bool cmd_resend; /* command resend */ + + int poll_count; + +diff --git a/include/uapi/linux/serial_core.h b/include/uapi/linux/serial_core.h +index add349889..3db2a19df 100644 +--- a/include/uapi/linux/serial_core.h ++++ b/include/uapi/linux/serial_core.h +@@ -245,4 +245,7 @@ + /* Sunplus UART */ + #define PORT_SUNPLUS 123 + ++/* Phytium PCI UART */ ++#define PORT_PHYTIUM 124 + -+static int pmdk_sound_probe(struct platform_device *pdev) -+{ -+ struct snd_soc_card *card = &pmdk; -+ struct pmdk_dp_private *priv; -+ struct snd_soc_dai_link *pmdk_dai; -+ int num_dp = 2; -+ char dp_mask = 0x7; -+ int i,j = 0; -+ card->dev = &pdev->dev; -+ -+ device_property_read_u32(&pdev->dev, "num-dp", &num_dp); -+ device_property_read_u8(&pdev->dev, "dp-mask", &dp_mask); -+ pmdk_dai = devm_kzalloc(&pdev->dev, num_dp * sizeof(*pmdk_dai), GFP_KERNEL); -+ if (!pmdk_dai) -+ return -ENOMEM; + #endif /* _UAPILINUX_SERIAL_CORE_H */ +diff --git a/scripts/dtc/checks.c b/scripts/dtc/checks.c +index 9f31d2607..e4d23040a 100644 +--- a/scripts/dtc/checks.c ++++ b/scripts/dtc/checks.c +@@ -1502,7 +1502,7 @@ static bool prop_is_gpio(struct property *prop) + * *-gpios and *-gpio can appear in property names, + * so skip over any false matches (only one known ATM) + */ +- if (strends(prop->name, ",nr-gpios")) ++ if (strends(prop->name, "nr-gpios")) + return false; + + return strends(prop->name, "-gpios") || +diff --git a/sound/hda/hdac_controller.c b/sound/hda/hdac_controller.c +index 7f3a000fa..c3515079d 100644 +--- a/sound/hda/hdac_controller.c ++++ b/sound/hda/hdac_controller.c +@@ -146,6 +146,9 @@ int snd_hdac_bus_send_cmd(struct hdac_bus *bus, unsigned int val) + { + unsigned int addr = azx_command_addr(val); + unsigned int wp, rp; ++ unsigned long timeout; ++ unsigned int rirb_wp; ++ int i = 0; + + spin_lock_irq(&bus->reg_lock); + +@@ -172,6 +175,42 @@ int snd_hdac_bus_send_cmd(struct hdac_bus *bus, unsigned int val) + bus->corb.buf[wp] = cpu_to_le32(val); + snd_hdac_chip_writew(bus, CORBWP, wp); + ++ if (bus->cmd_resend) { ++ timeout = jiffies + msecs_to_jiffies(1000); ++ udelay(80); ++ rirb_wp = snd_hdac_chip_readw(bus, RIRBWP); ++ while (rirb_wp == bus->rirb.wp) { ++ udelay(80); ++ rirb_wp = snd_hdac_chip_readw(bus, RIRBWP); ++ if (rirb_wp != bus->rirb.wp) ++ break; ++ if (i > 5) ++ break; ++ if (time_after(jiffies, timeout)) ++ break; + -+ if (!num_dp || num_dp > DAI_CNT(pmdk_dai_local)) -+ return -EINVAL; ++ /* add command to corb */ ++ wp = snd_hdac_chip_readw(bus, CORBWP); ++ if (wp == 0xffff) { ++ /* something wrong, controller likely turned to D3 */ ++ spin_unlock_irq(&bus->reg_lock); ++ return -EIO; ++ } ++ wp++; ++ wp %= AZX_MAX_CORB_ENTRIES; + -+ for(i = 0; i < num_dp; i++) { -+ for (; j < DAI_CNT(pmdk_dai_local); j++) { -+ if (BIT(j) & dp_mask) { -+ pmdk_dai[i] = pmdk_dai_local[j]; -+ j++; -+ break; ++ rp = snd_hdac_chip_readw(bus, CORBRP); ++ if (wp == rp) { ++ /* oops, it's full */ ++ spin_unlock_irq(&bus->reg_lock); ++ return -EAGAIN; + } ++ bus->corb.buf[wp] = cpu_to_le32(val); ++ snd_hdac_chip_writew(bus, CORBWP, wp); ++ i++; + } + } + -+ card->dai_link = pmdk_dai; -+ card->num_links = num_dp; -+ -+ priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); -+ if (!priv) -+ return -ENOMEM; -+ -+ snd_soc_card_set_drvdata(card, priv); -+ -+ return devm_snd_soc_register_card(&pdev->dev, card); -+} -+ -+static const struct of_device_id pmdk_sound_of_match[] = { -+ { .compatible = "phytium,pmdk-dp",}, -+ { } -+}; -+MODULE_DEVICE_TABLE(of, pmdk_sound_of_match); -+ -+static const struct acpi_device_id pmdk_sound_acpi_match[] = { -+ { "PHYT8006", 0}, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); -+ -+static struct platform_driver pmdk_sound_driver = { -+ .probe = pmdk_sound_probe, -+ .driver = { -+ .name = "pmdk_dp", -+ .acpi_match_table = pmdk_sound_acpi_match, -+ .of_match_table = pmdk_sound_of_match, -+#ifdef CONFIG_PM -+ .pm = &snd_soc_pm_ops, + spin_unlock_irq(&bus->reg_lock); + + return 0; +diff --git a/sound/hda/hdac_stream.c b/sound/hda/hdac_stream.c +index fe0958f99..21a9435fb 100644 +--- a/sound/hda/hdac_stream.c ++++ b/sound/hda/hdac_stream.c +@@ -134,7 +134,11 @@ void snd_hdac_stream_start(struct hdac_stream *azx_dev) + + trace_snd_hdac_stream_start(bus, azx_dev); + ++#ifdef CONFIG_SND_HDA_PHYTIUM ++ azx_dev->start_wallclk = snd_hdac_chip_readl(bus, WALLCLK) / 15; ++#else + azx_dev->start_wallclk = snd_hdac_chip_readl(bus, WALLCLK); +#endif -+ }, -+}; -+ -+module_platform_driver(pmdk_sound_driver); -+ -+MODULE_AUTHOR("Zhang Yiqun"); -+MODULE_DESCRIPTION("ALSA SoC PMDK DP"); -+MODULE_LICENSE("GPL"); -diff --git a/sound/soc/phytium/pmdk_es8336.c b/sound/soc/phytium/pmdk_es8336.c -new file mode 100644 -index 000000000..258aa6403 ---- /dev/null -+++ b/sound/soc/phytium/pmdk_es8336.c -@@ -0,0 +1,97 @@ -+// SPDX-License-Identifier: GPL-2.0 -+/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. -+ */ -+ -+#include -+#include -+#include -+#include -+ -+ -+/* PMDK widgets */ -+static const struct snd_soc_dapm_widget pmdk_es8336_dapm_widgets[] = { -+ SND_SOC_DAPM_HP("HP", NULL), -+ SND_SOC_DAPM_MIC("Int Mic", NULL), -+ SND_SOC_DAPM_MIC("Mic In", NULL), -+}; -+ -+/* PMDK control */ -+static const struct snd_kcontrol_new pmdk_controls[] = { -+ SOC_DAPM_PIN_SWITCH("HP"), -+ SOC_DAPM_PIN_SWITCH("Int Mic"), -+ SOC_DAPM_PIN_SWITCH("Mic In"), -+}; -+ -+/* PMDK connections */ -+static const struct snd_soc_dapm_route pmdk_es8336_audio_map[] = { -+ {"DMIC", NULL, "Int Mic"}, -+ {"MIC1", NULL, "Mic In"}, -+ {"MIC2", NULL, "Mic In"}, -+ -+ {"HP", NULL, "HPOL"}, -+ {"HP", NULL, "HPOR"}, -+}; -+ -+#define PMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ -+ SND_SOC_DAIFMT_CBS_CFS) -+ -+SND_SOC_DAILINK_DEFS(pmdk_es8366, -+ DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-lsd")), -+ DAILINK_COMP_ARRAY(COMP_CODEC("i2c-ESSX8336:00", "es8336-hifi")), -+ DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); -+ -+static struct snd_soc_dai_link pmdk_dai[] = { -+ { -+ .name = "ES8336 HIFI", -+ .stream_name = "ES8336 HIFI", -+ .dai_fmt = PMDK_DAI_FMT, -+ SND_SOC_DAILINK_REG(pmdk_es8366), -+ }, -+}; -+ -+static struct snd_soc_card pmdk = { -+ .name = "PMDK-I2S", -+ .owner = THIS_MODULE, -+ .dai_link = pmdk_dai, -+ .num_links = ARRAY_SIZE(pmdk_dai), -+ -+ .dapm_widgets = pmdk_es8336_dapm_widgets, -+ .num_dapm_widgets = ARRAY_SIZE(pmdk_es8336_dapm_widgets), -+ .controls = pmdk_controls, -+ .num_controls = ARRAY_SIZE(pmdk_controls), -+ .dapm_routes = pmdk_es8336_audio_map, -+ .num_dapm_routes = ARRAY_SIZE(pmdk_es8336_audio_map), -+}; -+ -+static int pmdk_sound_probe(struct platform_device *pdev) -+{ -+ struct snd_soc_card *card = &pmdk; -+ struct device *dev = &pdev->dev; -+ -+ card->dev = dev; -+ -+ return devm_snd_soc_register_card(&pdev->dev, card); -+} -+ -+static const struct acpi_device_id pmdk_sound_acpi_match[] = { -+ { "PHYT8005", 0}, -+ { } -+}; -+MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); -+ -+static struct platform_driver pmdk_sound_driver = { -+ .probe = pmdk_sound_probe, -+ .driver = { -+ .name = "pmdk_es8336", -+ .acpi_match_table = pmdk_sound_acpi_match, -+#ifdef CONFIG_PM -+ .pm = &snd_soc_pm_ops, + + /* enable SIE */ + snd_hdac_chip_updatel(bus, INTCTL, +@@ -611,7 +615,11 @@ static u64 azx_cc_read(const struct cyclecounter *cc) + { + struct hdac_stream *azx_dev = container_of(cc, struct hdac_stream, cc); + ++#ifdef CONFIG_SND_HDA_PHYTIUM ++ return snd_hdac_chip_readl(azx_dev->bus, WALLCLK) / 25; ++#else + return snd_hdac_chip_readl(azx_dev->bus, WALLCLK); +#endif -+ }, -+}; + } + + static void azx_timecounter_init(struct hdac_stream *azx_dev, +diff --git a/sound/pci/hda/hda_controller.c b/sound/pci/hda/hda_controller.c +index 406779625..86aa86e0c 100644 +--- a/sound/pci/hda/hda_controller.c ++++ b/sound/pci/hda/hda_controller.c +@@ -17,6 +17,8 @@ + #include + #include + ++#include "hda_phytium.h" + -+module_platform_driver(pmdk_sound_driver); -+MODULE_AUTHOR("Zhang Yiqun "); -+MODULE_DESCRIPTION("ALSA SoC PMDK ES8336"); -+MODULE_LICENSE("GPL"); -diff --git a/sound/soc/phytium/pmdk_es8388.c b/sound/soc/phytium/pmdk_es8388.c + #ifdef CONFIG_X86 + /* for art-tsc conversion */ + #include +@@ -156,6 +158,9 @@ static int azx_pcm_prepare(struct snd_pcm_substream *substream) + struct hda_spdif_out *spdif = + snd_hda_spdif_out_of_nid(apcm->codec, hinfo->nid); + unsigned short ctls = spdif ? spdif->ctls : 0; ++ struct hda_ft *hda = container_of(chip, struct hda_ft, chip); ++ ++ hda->substream = substream; + + trace_azx_pcm_prepare(chip, azx_dev); + dsp_lock(azx_dev); +diff --git a/sound/pci/hda/hda_phytium.h b/sound/pci/hda/hda_phytium.h new file mode 100644 -index 000000000..dcee078b1 +index 000000000..ec1f3e7f7 --- /dev/null -+++ b/sound/soc/phytium/pmdk_es8388.c -@@ -0,0 +1,169 @@ -+// SPDX-License-Identifier: GPL-2.0 ++++ b/sound/pci/hda/hda_phytium.h +@@ -0,0 +1,34 @@ ++/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. ++ * Implementation of primary ALSA driver code base for Phytium HD Audio. ++ * ++ * Copyright (c) 2018-2024 Phytium Technology Co., Ltd. + */ ++#ifndef __SOUND_HDA_PHYTIUM_H__ ++#define __SOUND_HDA_PHYTIUM_H__ + -+#include -+#include -+#include -+#include -+#include -+ -+static struct snd_soc_jack hs_jack; -+ -+/* Headset jack detection DAPM pins */ -+static struct snd_soc_jack_pin hs_jack_pins[] = { -+ { -+ .pin = "FrontIn", -+ .mask = SND_JACK_MICROPHONE, -+ }, -+ { -+ .pin = "RearIn", -+ .mask = SND_JACK_MICROPHONE, -+ .invert = 1 -+ }, -+ { -+ .pin = "Front", -+ .mask = SND_JACK_HEADPHONE, -+ }, -+ { -+ .pin = "Rear", -+ .mask = SND_JACK_HEADPHONE, -+ .invert = 1 -+ }, -+}; -+ -+/* Headset jack detection gpios */ -+static struct snd_soc_jack_gpio hs_jack_gpios[] = { -+ { -+ .name = "det", -+ .report = SND_JACK_HEADSET, -+ .debounce_time = 200, -+ .invert = 1, -+ }, -+}; -+ -+/* PMDK widgets */ -+static const struct snd_soc_dapm_widget pmdk_es8388_dapm_widgets[] = { -+ SND_SOC_DAPM_HP("Front", NULL), -+ SND_SOC_DAPM_HP("Rear", NULL), -+ -+ SND_SOC_DAPM_MIC("FrontIn", NULL), -+ SND_SOC_DAPM_MIC("RearIn", NULL), -+}; -+ -+/* PMDK control */ -+static const struct snd_kcontrol_new pmdk_controls[] = { -+ SOC_DAPM_PIN_SWITCH("Front"), -+ SOC_DAPM_PIN_SWITCH("Rear"), -+ SOC_DAPM_PIN_SWITCH("FrontIn"), -+ SOC_DAPM_PIN_SWITCH("RearIn"), -+}; -+ -+/* PMDK connections */ -+static const struct snd_soc_dapm_route pmdk_es8388_audio_map[] = { -+ {"LINPUT1", NULL, "FrontIn"}, -+ {"RINPUT1", NULL, "FrontIn"}, -+ -+ {"LINPUT2", NULL, "RearIn"}, -+ {"RINPUT2", NULL, "RearIn"}, -+ -+ {"Front", NULL, "LOUT1"}, -+ {"Front", NULL, "ROUT1"}, -+ -+ {"Rear", NULL, "LOUT2"}, -+ {"Rear", NULL, "ROUT2"}, -+}; -+ -+static int pmdk_es8388_init(struct snd_soc_pcm_runtime *rtd) -+{ -+ int ret; -+ -+ /* Jack detection API stuff */ -+ ret = snd_soc_card_jack_new_pins(rtd->card, "Headset Jack", -+ SND_JACK_HEADSET, &hs_jack, -+ hs_jack_pins, ARRAY_SIZE(hs_jack_pins)); -+ if (ret) -+ goto err; -+ -+ ret = snd_soc_jack_add_gpios(&hs_jack, ARRAY_SIZE(hs_jack_gpios), -+ hs_jack_gpios); -+ if (ret) -+ goto err; -+ -+ return 0; -+ -+err: -+ return ret; -+} -+ -+#define PMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ -+ SND_SOC_DAIFMT_CBS_CFS) -+ -+SND_SOC_DAILINK_DEFS(pmdk_es8388, -+ DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-lsd")), -+ DAILINK_COMP_ARRAY(COMP_CODEC("i2c-ESSX8388:00", "es8388-hifi")), -+ DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); -+ -+static struct snd_soc_dai_link pmdk_dai[] = { -+ { -+ .name = "ES8388 HIFI", -+ .stream_name = "ES8388 HIFI", -+ .dai_fmt = PMDK_DAI_FMT, -+ .init = pmdk_es8388_init, -+ SND_SOC_DAILINK_REG(pmdk_es8388), -+ }, -+}; ++#include "hda_controller.h" + -+static struct snd_soc_card pmdk = { -+ .name = "PMDK-I2S", -+ .owner = THIS_MODULE, -+ .dai_link = pmdk_dai, -+ .num_links = ARRAY_SIZE(pmdk_dai), -+ -+ .dapm_widgets = pmdk_es8388_dapm_widgets, -+ .num_dapm_widgets = ARRAY_SIZE(pmdk_es8388_dapm_widgets), -+ .controls = pmdk_controls, -+ .num_controls = ARRAY_SIZE(pmdk_controls), -+ .dapm_routes = pmdk_es8388_audio_map, -+ .num_dapm_routes = ARRAY_SIZE(pmdk_es8388_audio_map), -+}; ++struct hda_ft { ++ struct azx chip; ++ struct snd_pcm_substream *substream; ++ struct device *dev; ++ void __iomem *regs; + -+static int pmdk_sound_probe(struct platform_device *pdev) -+{ -+ struct snd_soc_card *card = &pmdk; -+ struct device *dev = &pdev->dev; -+ int n; ++ /* for pending irqs */ ++ struct work_struct irq_pending_work; + -+ card->dev = dev; -+ hs_jack_gpios[0].gpiod_dev = dev; -+ n = gpiod_count(dev, "det"); ++ /* sync probing */ ++ struct completion probe_wait; ++ struct work_struct probe_work; + -+ if (n < 0) -+ pmdk_dai[0].init = NULL; ++ /* card list (for power_save trigger) */ ++ struct list_head list; + -+ return devm_snd_soc_register_card(&pdev->dev, card); -+} ++ /* extra flags */ ++ unsigned int irq_pending_warned:1; ++ unsigned int probe_continued:1; + -+static const struct acpi_device_id pmdk_sound_acpi_match[] = { -+ { "PHYT8004", 0}, -+ { } +}; -+MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); + -+static struct platform_driver pmdk_sound_driver = { -+ .probe = pmdk_sound_probe, -+ .driver = { -+ .name = "pmdk_es8388", -+ .acpi_match_table = pmdk_sound_acpi_match, -+#ifdef CONFIG_PM -+ .pm = &snd_soc_pm_ops, +#endif -+ }, -+}; -+ -+module_platform_driver(pmdk_sound_driver); -+ -+MODULE_AUTHOR("Zhang Yiqun"); -+MODULE_DESCRIPTION("ALSA SoC PMDK ES8388"); -+MODULE_LICENSE("GPL"); diff --git a/device_board_phytium/common/kernel_source/linux-6.6/phytium_standard_defconfig b/device_board_phytium/common/kernel_source/linux-6.6/phytium_standard_defconfig index e72ecef1122fcfebde38fa7cc54e1a3a7f4e8c9c..a34d01d0bd0fb037a47e389257380e94d184fe07 100644 --- a/device_board_phytium/common/kernel_source/linux-6.6/phytium_standard_defconfig +++ b/device_board_phytium/common/kernel_source/linux-6.6/phytium_standard_defconfig @@ -5146,7 +5146,7 @@ CONFIG_DRM_PHYTIUMVR_OCTOPUS=y # CONFIG_DRM_PHYTIUMVR_DVFS is not set CONFIG_DRM_PHYTIUMVR_OCTOPUS_DMA=y CONFIG_DRM_PHYTIUM=y -# CONFIG_DRM_LEGACY is not set +CONFIG_DRM_LEGACY=y CONFIG_DRM_PANEL_ORIENTATION_QUIRKS=y # @@ -8831,3 +8831,7 @@ CONFIG_MEMTEST=y # # end of Rust hacking # end of Kernel hacking +CONFIG_VIDEO_PHYTIUM_VPU=y + +CONFIG_OHOS_VENDOR=n +CONFIG_DRM_MWV207=y diff --git a/device_board_phytium/common/patch/0001=build=add_phytium_whitelist.patch b/device_board_phytium/common/patch/0001=build=add_phytium_whitelist.patch index 7410a4e73ec9626954a0f9c577ee2f39bf3bcfcd..42cb7ce5e9d293f2c3d24fd11c368ca81fbbbe3c 100755 --- a/device_board_phytium/common/patch/0001=build=add_phytium_whitelist.patch +++ b/device_board_phytium/common/patch/0001=build=add_phytium_whitelist.patch @@ -1,17 +1,26 @@ diff --git a/compile_standard_whitelist.json b/compile_standard_whitelist.json -index 6a5175cb..a807fa3f 100644 +index 6a5175cb..09cf38e8 100644 --- a/compile_standard_whitelist.json +++ b/compile_standard_whitelist.json -@@ -6,6 +6,8 @@ +@@ -6,6 +6,9 @@ "device/qemu/arm_virt/linux/ohos.build", "third_party/flutter/glfw/bundle.json", "vendor/hihope/rk3568/ohos.build", + "device/board/phytium/tenglong_e/ohos.build", + "device/board/phytium/tengrui_d/ohos.build", ++ "device/board/phytium/phytiumpi-firefly/ohos.build", "vendor/hihope/ipcamera/ohos.build" ], "subsystem_components": [], -@@ -28,6 +30,12 @@ +@@ -22,6 +25,7 @@ + "//device/board/hihope/rk3568/camera/vdi_impl/v4l2/pipeline_core:camera_pipeline_core", + "//device/board/hihope/rk3568/camera/vdi_impl/v4l2:camera_host_vdi_impl_1.0", + "//device/board/hihope/rk3568/camera/vdi_impl/v4l2:camera_pipeline_config", ++ "//device/board/phytium/common/wifi/rtw8821:rtw88", + "//device/soc/rockchip/rk3568/hardware/codec/jpeg:libjpeg_vdi_impl", + "//device/soc/rockchip/rk3568/hardware/codec:libcodec_oem_interface", + "//device/soc/rockchip/rk3568/hardware/display:display_composer_vendor", +@@ -29,6 +33,12 @@ "//device/soc/rockchip/rk3568/hardware/display:libdisplay_buffer_vdi_impl", "//device/soc/rockchip/rk3568/hardware/display:libdisplay_buffer_vendor", "//device/soc/rockchip/rk3568/hardware/display:libdisplay_composer_vdi_impl", @@ -24,7 +33,14 @@ index 6a5175cb..a807fa3f 100644 "//device/soc/rockchip/rk3568/hardware/mpp/mpp/legacy:librockchip_vpu", "//device/soc/rockchip/rk3568/hardware/omx_il/component/common:libRkOMX_Resourcemanager", "//device/soc/rockchip/rk3568/hardware/omx_il/component/video/dec:libomxvpu_dec", -@@ -120,6 +128,12 @@ +@@ -116,12 +126,19 @@ + "//developtools/syscap_codec:syscap_tool_bin", + "//device/board/hihope/rk3568/camera/vdi_impl/v4l2/pipeline_core:camera_pipeline_core", + "//device/board/hihope/rk3568/camera/vdi_impl/v4l2:camera_host_vdi_impl_1.0", ++ "//device/board/phytium/common/wifi/rtw8821:rtw88", + "//device/soc/rockchip/rk3568/hardware/codec:libcodec_oem_interface", + "//device/soc/rockchip/rk3568/hardware/display:display_composer_vendor", + "//device/soc/rockchip/rk3568/hardware/display:display_gfx", "//device/soc/rockchip/rk3568/hardware/display:libdisplay_buffer_vdi_impl", "//device/soc/rockchip/rk3568/hardware/display:libdisplay_buffer_vendor", "//device/soc/rockchip/rk3568/hardware/display:libdisplay_composer_vdi_impl", @@ -37,7 +53,15 @@ index 6a5175cb..a807fa3f 100644 "//device/soc/rockchip/rk3568/hardware/mpp/mpp/hdi_mpp:hdi_mpp", "//device/soc/rockchip/rk3568/hardware/mpp/mpp/legacy:librockchip_vpu", "//device/soc/rockchip/rk3568/hardware/mpp/mpp/legacy:rockchip_vpu_src", -@@ -410,6 +424,12 @@ +@@ -405,6 +422,7 @@ + "//device/board/hihope/rk3568/camera/vdi_impl/v4l2/pipeline_core:camera_ipp_algo_example", + "//device/board/hihope/rk3568/camera/vdi_impl/v4l2/pipeline_core:camera_pipeline_core", + "//device/board/hihope/rk3568/camera/vdi_impl/v4l2:camera_host_vdi_impl_1.0", ++ "//device/board/phytium/common/wifi/rtw8821:rtw88", + "//device/soc/rockchip/rk3568/hardware/codec/jpeg:libjpeg_vdi_impl", + "//device/soc/rockchip/rk3568/hardware/codec:libcodec_oem_interface", + "//device/soc/rockchip/rk3568/hardware/display:display_composer_vendor", +@@ -413,6 +431,12 @@ "//device/soc/rockchip/rk3568/hardware/display:libdisplay_buffer_vendor", "//device/soc/rockchip/rk3568/hardware/display:libdisplay_composer_vdi_impl", "//device/soc/rockchip/rk3568/hardware/display:libhigbm_vendor", @@ -50,7 +74,11 @@ index 6a5175cb..a807fa3f 100644 "//device/soc/rockchip/rk3568/hardware/mpp/mpp/hdi_mpp:hdi_mpp", "//device/soc/rockchip/rk3568/hardware/mpp/mpp/legacy:rockchip_vpu_src", "//device/soc/rockchip/rk3568/hardware/omx_il/component/common:RkOMX_Basecomponent", -@@ -458,6 +478,12 @@ +@@ -459,9 +483,16 @@ + "//base/update/updateservice/services/engine:updateservice", + "//developtools/hdc/test:hdc_common", + "//device/board/hihope/rk3568/camera/vdi_impl/v4l2/pipeline_core:camera_pipeline_core", ++ "//device/board/phytium/common/wifi/rtw8821:rtw88", "//device/soc/rockchip/rk3568/hardware/display:display_composer_vendor", "//device/soc/rockchip/rk3568/hardware/display:libdisplay_buffer_vendor", "//device/soc/rockchip/rk3568/hardware/display:libhigbm_vendor", diff --git a/device_board_phytium/common/patch/0004=drivers-peripheral=support_alsa.patch b/device_board_phytium/common/patch/0004=drivers-peripheral=support_alsa.patch index f89661dcbe48a13d6064d66d79af2781eaf56d8c..6b74ca9d171b0c1a5c9ee78cee4ee45b94228bfb 100755 --- a/device_board_phytium/common/patch/0004=drivers-peripheral=support_alsa.patch +++ b/device_board_phytium/common/patch/0004=drivers-peripheral=support_alsa.patch @@ -13,10 +13,21 @@ index 24baed4d0..2b7e7011e 100755 "test": [ "//drivers/peripheral/audio/test:audio_test_entry", diff --git a/audio/hdi_service/supportlibs/BUILD.gn b/audio/hdi_service/supportlibs/BUILD.gn -index 080713fca..0600677fe 100644 +index 080713fca..d0086955c 100644 --- a/audio/hdi_service/supportlibs/BUILD.gn +++ b/audio/hdi_service/supportlibs/BUILD.gn -@@ -154,7 +154,6 @@ if (defined(ohos_lite)) { +@@ -84,7 +84,9 @@ if (defined(ohos_lite)) { + "//device/hmos_emulator/hardware/audio/audio_alsa/vendor_capture.c", + ] + } else { +- sources += [ "//device/board/${product_company}/${device_name}/audio_alsa/vendor_capture.c" ] ++ sources += [ "//device/board/${product_company}/common/audio_alsa/vendor_capture.c", ++ "//device/board/${product_company}/common/audio_alsa/common.c", ++ ] + } + } else { + sources += [ +@@ -154,7 +156,6 @@ if (defined(ohos_lite)) { "$hdf_audio_path/supportlibs/alsa_adapter/src/alsa_lib_render.c", "$hdf_audio_path/supportlibs/alsa_adapter/src/alsa_snd_render.c", "$hdf_audio_path/supportlibs/alsa_adapter/src/alsa_soundcard.c", @@ -24,3 +35,112 @@ index 080713fca..0600677fe 100644 "//third_party/cJSON/cJSON.c", ] if (defined(is_emulator) && is_emulator) { +@@ -162,7 +163,9 @@ if (defined(ohos_lite)) { + "//device/hmos_emulator/hardware/audio/audio_alsa/vendor_render.c", + ] + } else { +- sources += [ "//device/board/${product_company}/${device_name}/audio_alsa/vendor_render.c" ] ++ sources += [ "//device/board/${product_company}/common/audio_alsa/vendor_render.c", ++ "//device/board/${product_company}/common/audio_alsa/common.c" ++ ] + } + } else { + sources += [ +diff --git a/audio/supportlibs/alsa_adapter/include/alsa_soundcard.h b/audio/supportlibs/alsa_adapter/include/alsa_soundcard.h +index 850408a66..ab4c87bc1 100755 +--- a/audio/supportlibs/alsa_adapter/include/alsa_soundcard.h ++++ b/audio/supportlibs/alsa_adapter/include/alsa_soundcard.h +@@ -121,6 +121,8 @@ void SndCloseHandle(struct AlsaSoundCard *cardIns); + void SndElementItemInit(struct AlsaMixerCtlElement *m); + int32_t SndElementReadInt(struct AlsaSoundCard *cardIns, + const struct AlsaMixerCtlElement *ctlElem, long *value); ++int32_t SndElementReadNumid(struct AlsaSoundCard *cardIns, ++ struct AlsaMixerCtlElement *ctlElem,unsigned int *numid); + int32_t SndElementReadEnum(struct AlsaSoundCard *cardIns, + const struct AlsaMixerCtlElement *ctlElem, unsigned int *item); + int32_t SndElementReadRange(struct AlsaSoundCard *cardIns, +@@ -144,4 +146,4 @@ int32_t SndTraversalMixerElement(struct AlsaSoundCard *cardIns, + } + #endif + +-#endif /* ALSA_SOUNDCARD_H */ +\ No newline at end of file ++#endif /* ALSA_SOUNDCARD_H */ +diff --git a/audio/supportlibs/alsa_adapter/src/alsa_soundcard.c b/audio/supportlibs/alsa_adapter/src/alsa_soundcard.c +index dab1bdb30..159eb3ae9 100644 +--- a/audio/supportlibs/alsa_adapter/src/alsa_soundcard.c ++++ b/audio/supportlibs/alsa_adapter/src/alsa_soundcard.c +@@ -887,6 +887,48 @@ static int32_t SetElementInfo(snd_ctl_t *alsaHandle, const struct AlsaMixerCtlEl + return HDF_SUCCESS; + } + ++int32_t SndElementReadNumid(struct AlsaSoundCard *cardIns,struct AlsaMixerCtlElement *ctlElem,unsigned int *numid) ++{ ++ int ret; ++ snd_ctl_t *alsaHandle = NULL; ++ snd_ctl_elem_id_t *elem_id; ++ snd_ctl_elem_list_t *elem_list = NULL; ++ CHECK_NULL_PTR_RETURN_DEFAULT(cardIns); ++ CHECK_NULL_PTR_RETURN_DEFAULT(ctlElem); ++ ++ ret = snd_ctl_open(&alsaHandle, cardIns->ctrlName, 0); ++ if (ret < 0) { ++ AUDIO_FUNC_LOGE("snd_ctl_open error: %{public}s", snd_strerror(ret)); ++ return HDF_FAILURE; ++ } ++ ++ snd_ctl_elem_list_malloc(&elem_list); ++ snd_ctl_elem_list_alloc_space(elem_list, 1024); ++ snd_ctl_elem_list(alsaHandle, elem_list); ++ ++ snd_ctl_elem_id_alloca(&elem_id); ++ ++ unsigned int count = snd_ctl_elem_list_get_used(elem_list); ++ for (unsigned int i = 0; i < count; i++) { ++ snd_ctl_elem_list_set_offset(elem_list, i); ++ snd_ctl_elem_list_get_id(elem_list, i, elem_id); ++ ++ const char *current_name = snd_ctl_elem_id_get_name(elem_id); ++ int current_numid = snd_ctl_elem_id_get_numid(elem_id); ++ ++ if (current_name && strcmp(current_name, ctlElem->name) == 0) { ++ *numid = current_numid; ++ break; ++ } ++ } ++ ++ snd_ctl_elem_list_free_space(elem_list); ++ snd_ctl_elem_list_free(elem_list); ++ ++ AUDIO_FUNC_LOGE("SndElementReadNumid numid=%d", *numid); ++ return HDF_SUCCESS; ++} ++ + int32_t SndElementReadInt(struct AlsaSoundCard *cardIns, + const struct AlsaMixerCtlElement *ctlElem, long *value) + { +@@ -1098,6 +1140,7 @@ int32_t SndElementWriteInt( + struct AlsaSoundCard *cardIns, const struct AlsaMixerCtlElement *ctlElem, long value) + { + int ret; ++ unsigned int i,count; + snd_ctl_t *alsaHandle = NULL; + snd_ctl_elem_id_t *elem_id; + snd_ctl_elem_info_t *elem_info; +@@ -1128,11 +1171,14 @@ int32_t SndElementWriteInt( + } + + snd_ctl_elem_value_set_id(elem_value, elem_id); ++ count = snd_ctl_elem_info_get_count(elem_info); + type = snd_ctl_elem_info_get_type(elem_info); + if (type == SND_CTL_ELEM_TYPE_INTEGER) { +- snd_ctl_elem_value_set_integer(elem_value, 0, value); ++ for(i=0; i < count; i++) ++ snd_ctl_elem_value_set_integer(elem_value, i, value); + } else if (type == SND_CTL_ELEM_TYPE_INTEGER64) { +- snd_ctl_elem_value_set_integer64(elem_value, 0, (long long)value); ++ for(i=0; i < count; i++) ++ snd_ctl_elem_value_set_integer64(elem_value, i, (long long)value); + } else { + AUDIO_FUNC_LOGE("Element value is not integer type!\n"); + return HDF_FAILURE; diff --git a/device_board_phytium/common/patch/0008=build=make_boot_image.patch b/device_board_phytium/common/patch/0008=build=make_boot_image.patch index c543672ab471792a970cbeacab05102d3bf1a5e8..13b0a1c90a9e471da74ed6ba2cdfef88d5a598f9 100755 --- a/device_board_phytium/common/patch/0008=build=make_boot_image.patch +++ b/device_board_phytium/common/patch/0008=build=make_boot_image.patch @@ -1,14 +1,41 @@ -diff --git a/ohos/images/mkimage/mkimages.py b/ohos/images/mkimage/mkimages.py -index dfa56711..312904c5 100755 ---- a/ohos/images/mkimage/mkimages.py -+++ b/ohos/images/mkimage/mkimages.py -@@ -134,6 +134,9 @@ def mk_images(args): - mk_system_img(mkfs_tools, mk_configs, device, src_dir, is_sparse) - elif image_name == "ramdisk.img": - mk_ramdisk_img(mkfs_tools, mk_configs, device, src_dir, is_sparse) -+ ret = os.system('sh ./packages/phone/images/make_boot.sh ./packages/phone/images/') -+ if ret: -+ print("execute make_boot.sh fail, ret: %s" % str(ret)) - elif image_name == "updater_ramdisk.img": - if config.get('component_type', '') == 'system_component': - return +diff --git a/core/gn/BUILD.gn b/core/gn/BUILD.gn +index b2be1014..366f3def 100755 +--- a/core/gn/BUILD.gn ++++ b/core/gn/BUILD.gn +@@ -18,6 +18,8 @@ print("current_toolchain=$current_toolchain") + print("host_toolchain=$host_toolchain") + + import("//build/ohos_var.gni") ++import("//build/ohos/build_var.gni") ++import("${build_configs_path}/platforms_list.gni") + + # gn target defined + if (product_name == "ohos-sdk") { +@@ -49,6 +51,7 @@ if (product_name == "ohos-sdk") { + if (!is_llvm_build) { + group("images") { + deps = [ "//build/ohos/images:make_images" ] ++ deps += [ ":mk_boot_img" ] + } + } + +@@ -81,4 +84,19 @@ if (product_name == "ohos-sdk") { + deps += [ "//build/ohos/testfwk:archive_testcase" ] + } + } ++ ++ action("mk_boot_img") { ++ script = "//device/board/phytium/common/tools/generate_image/make_boot.sh" ++ args = [ ++ rebase_path("$root_out_dir/packages/phone/images/", root_build_dir) ++ ] ++ deps = [] ++ foreach(_platform, target_platform_list) { ++ deps += [ ++ "//build/ohos/images:${_platform}_updater_ramdisk_image", ++ "//build/ohos/images:${_platform}_ramdisk_image", ++ ] ++ } ++ outputs = [ "$target_out_dir/mk_boot_img.log" ] ++ } + } diff --git a/device_board_phytium/common/patch/0016=build=ohos_var_add_gn_args_gpu_model.patch b/device_board_phytium/common/patch/0016=build=ohos_var_add_gn_args_gpu_model.patch deleted file mode 100755 index 9f28bac173e241174cc0b2e99ac9785f0e24b450..0000000000000000000000000000000000000000 --- a/device_board_phytium/common/patch/0016=build=ohos_var_add_gn_args_gpu_model.patch +++ /dev/null @@ -1,14 +0,0 @@ -diff --git a/ohos_var.gni b/ohos_var.gni -index ee36fb74..a910c473 100755 ---- a/ohos_var.gni -+++ b/ohos_var.gni -@@ -210,6 +210,9 @@ declare_args() { - is_opensource = true - } - -+declare_args() { -+ gpu_model = "default" -+} - # Upgrade Skia version - use_new_skia = true - diff --git a/device_board_phytium/common/patch/0024=build=vendor_image_conf.patch b/device_board_phytium/common/patch/0024=build=vendor_image_conf.patch index 99e94a7e15d20f9fa8e88d7ef2b60ff266239597..3ea7e4b606983f64def0a4896e3510493583bf21 100755 --- a/device_board_phytium/common/patch/0024=build=vendor_image_conf.patch +++ b/device_board_phytium/common/patch/0024=build=vendor_image_conf.patch @@ -5,7 +5,7 @@ index 5897e178..4f0b5c44 100644 @@ -1,5 +1,5 @@ /vendor -268434944 -+368434944 ++768434944 --fs_type=ext4 --dac_config ../../build/ohos/images/mkimage/dac.txt --file_context obj/base/security/selinux_adapter/file_contexts.bin diff --git a/device_board_phytium/common/patch/0025=build=add_execscripts.patch b/device_board_phytium/common/patch/0025=build=add_execscripts.patch index fdc0500b1132ad35b2180ec425316737f5c0b2c3..a17960ff79eae99e2fefddaf146d29fa59cae435 100755 --- a/device_board_phytium/common/patch/0025=build=add_execscripts.patch +++ b/device_board_phytium/common/patch/0025=build=add_execscripts.patch @@ -1,12 +1,13 @@ diff --git a/core/gn/ohos_exec_script_allowlist.gni b/core/gn/ohos_exec_script_allowlist.gni -index 0a986f4..2641850 100644 +index 8b97f4a1..aa4e7e65 100644 --- a/core/gn/ohos_exec_script_allowlist.gni +++ b/core/gn/ohos_exec_script_allowlist.gni -@@ -198,5 +198,7 @@ ohos_exec_script_config = { +@@ -199,5 +199,8 @@ ohos_exec_script_config = { "//build_plugins/config/ios/ios_sdk.gni", "//build_plugins/templates/java/rules.gni", "//build_plugins/templates/java/internal_rules.gni", + "//vendor/phytium/tenglong_e/hdf_config/uhdf/BUILD.gn", + "//vendor/phytium/tengrui_d/hdf_config/uhdf/BUILD.gn", ++ "//vendor/phytium/phytiumpi-firefly/hdf_config/uhdf/BUILD.gn", ] } diff --git a/device_board_phytium/common/patch/0026=drivers-peripheral=amixer_cset_two_values.patch b/device_board_phytium/common/patch/0026=drivers-peripheral=amixer_cset_two_values.patch deleted file mode 100755 index f53e68c5a618f6de701a72881fa3e7799f4c440f..0000000000000000000000000000000000000000 --- a/device_board_phytium/common/patch/0026=drivers-peripheral=amixer_cset_two_values.patch +++ /dev/null @@ -1,86 +0,0 @@ -diff --git a/audio/supportlibs/alsa_adapter/include/alsa_soundcard.h b/audio/supportlibs/alsa_adapter/include/alsa_soundcard.h -index 850408a66..f2f4887f0 100755 ---- a/audio/supportlibs/alsa_adapter/include/alsa_soundcard.h -+++ b/audio/supportlibs/alsa_adapter/include/alsa_soundcard.h -@@ -129,6 +129,8 @@ int32_t SndElementReadSwitch(struct AlsaSoundCard *cardIns, - const struct AlsaMixerCtlElement *ctlElem, bool *on); - int32_t SndElementWriteInt(struct AlsaSoundCard *cardIns, - const struct AlsaMixerCtlElement *ctlElem, long value); -+int32_t SndElementWriteIntExt(struct AlsaSoundCard *cardIns, -+ const struct AlsaMixerCtlElement *ctlElem, long value); - int32_t SndElementWriteEnum(struct AlsaSoundCard *cardIns, - const struct AlsaMixerCtlElement *ctlElem, unsigned int item); - int32_t SndElementWriteSwitch(struct AlsaSoundCard *cardIns, -@@ -144,4 +146,4 @@ int32_t SndTraversalMixerElement(struct AlsaSoundCard *cardIns, - } - #endif - --#endif /* ALSA_SOUNDCARD_H */ -\ No newline at end of file -+#endif /* ALSA_SOUNDCARD_H */ -diff --git a/audio/supportlibs/alsa_adapter/src/alsa_soundcard.c b/audio/supportlibs/alsa_adapter/src/alsa_soundcard.c -index dab1bdb30..85b145fd2 100644 ---- a/audio/supportlibs/alsa_adapter/src/alsa_soundcard.c -+++ b/audio/supportlibs/alsa_adapter/src/alsa_soundcard.c -@@ -1094,6 +1094,61 @@ int32_t SndElementReadSwitch( - return HDF_SUCCESS; - } - -+int32_t SndElementWriteIntExt( -+ struct AlsaSoundCard *cardIns, const struct AlsaMixerCtlElement *ctlElem, long value) -+{ -+ int ret; -+ snd_ctl_t *alsaHandle = NULL; -+ snd_ctl_elem_id_t *elem_id; -+ snd_ctl_elem_info_t *elem_info; -+ snd_ctl_elem_value_t *elem_value; -+ snd_ctl_elem_type_t type; -+ -+ CHECK_NULL_PTR_RETURN_DEFAULT(cardIns); -+ CHECK_NULL_PTR_RETURN_DEFAULT(ctlElem); -+ -+ ret = snd_ctl_open(&alsaHandle, cardIns->ctrlName, 0); -+ if (ret < 0) { -+ AUDIO_FUNC_LOGE("snd_ctl_open error: %{public}s", snd_strerror(ret)); -+ return HDF_FAILURE; -+ } -+ -+ snd_ctl_elem_id_alloca(&elem_id); -+ snd_ctl_elem_info_alloca(&elem_info); -+ snd_ctl_elem_value_alloca(&elem_value); -+ ret = SetElementInfo(alsaHandle, ctlElem, elem_info, elem_id); -+ if (ret != HDF_SUCCESS) { -+ AUDIO_FUNC_LOGE("Set element %{public}s elem_info failed!\n", ctlElem->name); -+ return HDF_FAILURE; -+ } -+ -+ if (!snd_ctl_elem_info_is_writable(elem_info)) { -+ AUDIO_FUNC_LOGE("Element write enable\n"); -+ return HDF_FAILURE; -+ } -+ -+ snd_ctl_elem_value_set_id(elem_value, elem_id); -+ type = snd_ctl_elem_info_get_type(elem_info); -+ if (type == SND_CTL_ELEM_TYPE_INTEGER) { -+ snd_ctl_elem_value_set_integer(elem_value, 0, value); -+ snd_ctl_elem_value_set_integer(elem_value, 1, value); -+ } else if (type == SND_CTL_ELEM_TYPE_INTEGER64) { -+ snd_ctl_elem_value_set_integer64(elem_value, 0, (long long)value); -+ snd_ctl_elem_value_set_integer64(elem_value, 1, (long long)value); -+ } else { -+ AUDIO_FUNC_LOGE("Element value is not integer type!\n"); -+ return HDF_FAILURE; -+ } -+ -+ ret = snd_ctl_elem_write(alsaHandle, elem_value); -+ if (ret < 0) { -+ AUDIO_FUNC_LOGE("snd_ctl_elem_write failed!\n"); -+ return HDF_FAILURE; -+ } -+ -+ return HDF_SUCCESS; -+} -+ - int32_t SndElementWriteInt( - struct AlsaSoundCard *cardIns, const struct AlsaMixerCtlElement *ctlElem, long value) - { diff --git a/device_board_phytium/common/patch/0027=foundation-graphic-graphic_2d=gpu_mwv207.patch b/device_board_phytium/common/patch/0027=foundation-graphic-graphic_2d=gpu_mwv207.patch deleted file mode 100755 index b5a735132f86f096c88f4b2b86ccc7b2278993fc..0000000000000000000000000000000000000000 --- a/device_board_phytium/common/patch/0027=foundation-graphic-graphic_2d=gpu_mwv207.patch +++ /dev/null @@ -1,39 +0,0 @@ -diff --git a/graphic_config.gni b/graphic_config.gni -index 58fe888d4b..52e43fba21 100644 ---- a/graphic_config.gni -+++ b/graphic_config.gni -@@ -12,6 +12,7 @@ - # limitations under the License. - - import("//build/config/components/multimodalinput/cursor_config.gni") -+import("//build/ohos.gni") - declare_args() { - graphic_2d_feature_product = "default" - graphic_2d_feature_enable_pgo = false -@@ -383,3 +384,9 @@ if (defined(use_clang_coverage) && use_clang_coverage) { - if (defined(input_ext_feature_magiccursor) && input_ext_feature_magiccursor) { - gpu_defines += [ "OHOS_BUILD_ENABLE_MAGICCURSOR" ] - } -+ -+if (gpu_model == "jm" || gpu_model == "amd") { -+ gpu_defines += [ -+ "JM_MWV207", -+ ] -+} -diff --git a/rosen/modules/render_service/core/pipeline/rs_base_render_util.h b/rosen/modules/render_service/core/pipeline/rs_base_render_util.h -index d91716635c..639ffe2a41 100644 ---- a/rosen/modules/render_service/core/pipeline/rs_base_render_util.h -+++ b/rosen/modules/render_service/core/pipeline/rs_base_render_util.h -@@ -117,7 +117,11 @@ public: - static BufferRequestConfig GetFrameBufferRequestConfig(const ScreenInfo& screenInfo, bool isPhysical = true, - bool isProtected = false, - GraphicColorGamut colorGamut = GRAPHIC_COLOR_GAMUT_SRGB, -- GraphicPixelFormat pixelFormat = GRAPHIC_PIXEL_FMT_RGBA_8888); -+ #ifdef JM_MWV207 -+ GraphicPixelFormat pixelFormat = GRAPHIC_PIXEL_FMT_BGRA_8888); -+ #else -+ GraphicPixelFormat pixelFormat = GRAPHIC_PIXEL_FMT_RGBA_8888); -+ #endif - - static GraphicTransformType GetSurfaceBufferTransformType( - const sptr& consumer, const sptr& buffer); diff --git a/device_board_phytium/common/patch/0027=foundation-graphic-graphic_2d=multi-gpu-support.patch b/device_board_phytium/common/patch/0027=foundation-graphic-graphic_2d=multi-gpu-support.patch new file mode 100755 index 0000000000000000000000000000000000000000..e5a7c2e6e3d869fc337bf7abe520b3586f4537f1 --- /dev/null +++ b/device_board_phytium/common/patch/0027=foundation-graphic-graphic_2d=multi-gpu-support.patch @@ -0,0 +1,186 @@ +diff --git a/bundle.json b/bundle.json +index 663faa6a1e..8d4232905b 100644 +--- a/bundle.json ++++ b/bundle.json +@@ -103,12 +103,15 @@ + ], + "third_party": [ + "flutter", +- "skia" ++ "skia", ++ "libdrm", ++ "cJSON" + ] + }, + "build": { + "group_type": { + "base_group": [ ++ "//foundation/graphic/graphic_2d/frameworks/opengl_wrapper:Phy_EGL_impl", + "//third_party/libpng:libpng", + "//foundation/graphic/graphic_2d/interfaces/kits/napi:napi_packages", + "//foundation/graphic/graphic_2d/interfaces/kits/cj:ffi_packages", +diff --git a/frameworks/opengl_wrapper/BUILD.gn b/frameworks/opengl_wrapper/BUILD.gn +index 3ef38985f8..df1ff18187 100644 +--- a/frameworks/opengl_wrapper/BUILD.gn ++++ b/frameworks/opengl_wrapper/BUILD.gn +@@ -35,6 +35,7 @@ config("egl_config") { + "-Wall", + "-Werror", + "-g3", ++ "-DPHY_EGL_LOADER", + ] + } + +@@ -113,6 +114,14 @@ if (current_os != "ohos") { + if (is_emulator) { + defines += [ "IS_EMULATOR" ] + } ++ ++ deps = [ ++ ":Phy_EGL_impl", ++ ] ++ include_dirs = [ ++ "//vendor/phytium/gpu_model/egl_loader/include", ++ ] ++ + output_name = "EGL" + output_extension = "so" + +@@ -123,6 +132,13 @@ if (current_os != "ohos") { + + ## Build libEGL.so }}} + ++ohos_prebuilt_shared_library("Phy_EGL_impl") { ++ source = "//vendor/phytium/gpu_model/egl_loader/libPhy_EGL.so" ++ install_enable = true ++ part_name = "graphic_2d" ++ subsystem_name = "graphic" ++} ++ + ## Build libGLESv1.so {{{ + config("glesv1_config") { + visibility = [ ":*" ] +diff --git a/frameworks/opengl_wrapper/src/EGL/egl_core.cpp b/frameworks/opengl_wrapper/src/EGL/egl_core.cpp +index 167e01fae1..aeb7e910f4 100644 +--- a/frameworks/opengl_wrapper/src/EGL/egl_core.cpp ++++ b/frameworks/opengl_wrapper/src/EGL/egl_core.cpp +@@ -19,7 +19,11 @@ + #include "egl_defs.h" + #include "egl_pre_initializer.h" + #include "egl_wrapper_layer.h" ++#ifdef PHY_EGL_LOADER ++#include "egl_phytium_wrapper_loader.h" ++#else + #include "egl_wrapper_loader.h" ++#endif + #if USE_IGRAPHICS_EXTENDS_HOOKS + #include "egl_wrapper_hook.h" + #endif +@@ -102,7 +106,11 @@ bool EglCoreInit() + } + + WrapperHookTableInit(); ++ #ifdef PHY_EGL_LOADER ++ EglPhyWrapperLoader& loader(EglPhyWrapperLoader::GetInstance()); ++ #else + EglWrapperLoader& loader(EglWrapperLoader::GetInstance()); ++ #endif + if (!loader.Load(&gWrapperHook)) { + WLOGE("EglWrapperLoader Load Failed."); + return false; +diff --git a/frameworks/opengl_wrapper/src/EGL/egl_wrapper_entry.cpp b/frameworks/opengl_wrapper/src/EGL/egl_wrapper_entry.cpp +index af40b70efd..5566ea59af 100644 +--- a/frameworks/opengl_wrapper/src/EGL/egl_wrapper_entry.cpp ++++ b/frameworks/opengl_wrapper/src/EGL/egl_wrapper_entry.cpp +@@ -24,7 +24,11 @@ + #include "egl_defs.h" + #include "egl_wrapper_context.h" + #include "egl_wrapper_display.h" ++#ifdef PHY_EGL_LOADER ++#include "egl_phytium_wrapper_loader.h" ++#else + #include "egl_wrapper_loader.h" ++#endif + #include "thread_private_data_ctl.h" + #include "window.h" + #include "wrapper_log.h" +@@ -325,7 +329,11 @@ __eglMustCastToProperFunctionPointerType EglGetProcAddressImpl(const char *procn + return __eglMustCastToProperFunctionPointerType(addr); + } + ++ #ifdef PHY_EGL_LOADER ++ EglPhyWrapperLoader& loader(EglPhyWrapperLoader::GetInstance()); ++ #else + EglWrapperLoader& loader(EglWrapperLoader::GetInstance()); ++ #endif + void *func = loader.GetProcAddrFromDriver(procname); + + if (!func) { +diff --git a/rosen/modules/render_service/core/pipeline/rs_base_render_util.cpp b/rosen/modules/render_service/core/pipeline/rs_base_render_util.cpp +index 6b3bcb295a..b03a8f2e31 100644 +--- a/rosen/modules/render_service/core/pipeline/rs_base_render_util.cpp ++++ b/rosen/modules/render_service/core/pipeline/rs_base_render_util.cpp +@@ -848,6 +848,51 @@ bool RSBaseRenderUtil::IsNeedClient(RSRenderNode& node, const ComposeInfo& info) + return false; + } + ++static char *gpu_env_path = nullptr; ++static int ginit_gpu = -1; ++static bool isJMgpu(){ ++ if(ginit_gpu == -1){ ++ RS_LOGD("ginit_gpu is not initialized\n"); ++ FILE *file; ++ ++ file = fopen("/data/system/gpu_cur", "r"); ++ if (file == nullptr) { ++ RS_LOGE("Failed to open file for multi gpu path"); ++ return false; ++ } ++ ++ fseek(file, 0, SEEK_END); ++ long filesize = ftell(file); ++ fseek(file, 0, SEEK_SET); ++ ++ gpu_env_path = (char *)malloc(filesize + 1); ++ if (gpu_env_path == nullptr) { ++ RS_LOGE("Failed to allocate memory"); ++ fclose(file); ++ return false; ++ } ++ memset(gpu_env_path, 0, filesize + 1); ++ size_t bytesRead = fread(gpu_env_path, 1, filesize, file); ++ if (bytesRead != filesize) { ++ RS_LOGE("Get multi gpu path failed"); ++ free(gpu_env_path); ++ gpu_env_path = nullptr; ++ fclose(file); ++ return false; ++ } ++ fclose(file); ++ ginit_gpu = 0; ++ } ++ if((gpu_env_path) && (strlen(gpu_env_path) > 0)){ ++ RS_LOGD("open_library_by_path %{public}s", gpu_env_path); ++ if(strstr(gpu_env_path,"jm") != nullptr){ ++ return true; ++ } ++ } ++ ++ return false; ++} ++ + BufferRequestConfig RSBaseRenderUtil::GetFrameBufferRequestConfig(const ScreenInfo& screenInfo, bool isPhysical, + bool isProtected, GraphicColorGamut colorGamut, GraphicPixelFormat pixelFormat) + { +@@ -858,6 +903,11 @@ BufferRequestConfig RSBaseRenderUtil::GetFrameBufferRequestConfig(const ScreenIn + config.height = static_cast(height); + config.strideAlignment = 0x8; // default stride is 8 Bytes. + config.colorGamut = isPhysical ? colorGamut : static_cast(screenInfo.colorGamut); ++ if(isJMgpu()){ ++ pixelFormat = GRAPHIC_PIXEL_FMT_BGRA_8888; ++ }else{ ++ pixelFormat = GRAPHIC_PIXEL_FMT_RGBA_8888; ++ } + config.format = isPhysical ? pixelFormat : screenInfo.pixelFormat; + config.usage = BUFFER_USAGE_CPU_READ | BUFFER_USAGE_MEM_DMA | BUFFER_USAGE_MEM_FB; + if (isProtected) { diff --git a/device_board_phytium/common/patch/0028=foundation-graphic-graphic_surface=gpu_mwv207.patch b/device_board_phytium/common/patch/0028=foundation-graphic-graphic_surface=gpu_mwv207.patch deleted file mode 100755 index fb3575733944d572b22b0e2abe6503c5e4d4fcb3..0000000000000000000000000000000000000000 --- a/device_board_phytium/common/patch/0028=foundation-graphic-graphic_surface=gpu_mwv207.patch +++ /dev/null @@ -1,17 +0,0 @@ -diff --git a/surface/src/native_window.cpp b/surface/src/native_window.cpp -index d1a7acb..3af22e0 100644 ---- a/surface/src/native_window.cpp -+++ b/surface/src/native_window.cpp -@@ -104,7 +104,11 @@ OHNativeWindow* CreateNativeWindowFromSurface(void* pSurface) - windowConfig->width = nativeWindow->surface->GetDefaultWidth(); - windowConfig->height = nativeWindow->surface->GetDefaultHeight(); - windowConfig->usage = BUFFER_USAGE_CPU_READ | BUFFER_USAGE_MEM_DMA; -- windowConfig->format = GRAPHIC_PIXEL_FMT_RGBA_8888; -+ #ifdef JM_MWV207 -+ windowConfig->format = GRAPHIC_PIXEL_FMT_BGRA_8888; -+ #else -+ windowConfig->format = GRAPHIC_PIXEL_FMT_RGBA_8888; -+ #endif - windowConfig->strideAlignment = 8; // default stride is 8 - windowConfig->timeout = 3000; // default timeout is 3000 ms - windowConfig->colorGamut = GraphicColorGamut::GRAPHIC_COLOR_GAMUT_SRGB; diff --git a/device_board_phytium/common/patch/0028=third_party-musl=multi-gpu-support.patch b/device_board_phytium/common/patch/0028=third_party-musl=multi-gpu-support.patch new file mode 100755 index 0000000000000000000000000000000000000000..e40266c4ce22aa305133c1573fa318a1be305df1 --- /dev/null +++ b/device_board_phytium/common/patch/0028=third_party-musl=multi-gpu-support.patch @@ -0,0 +1,83 @@ +diff --git a/ldso/linux/dynlink.c b/ldso/linux/dynlink.c +index 53b70f00..40f84b2d 100644 +--- a/ldso/linux/dynlink.c ++++ b/ldso/linux/dynlink.c +@@ -153,6 +153,8 @@ static struct dso ldso; + static struct dso *head, *tail, *fini_head, *syms_tail, *lazy_head; + static struct dso_debug_info *debug_tail = NULL; + static char *env_path, *sys_path; ++static char *gpu_env_path = NULL; ++static int ginit_gpu = -1; + static unsigned long long gencnt; + static unsigned long long subcnt; + static int runtime; +@@ -2139,6 +2141,44 @@ UT_STATIC struct dso *find_library_by_fstat(const struct stat *st, const ns_t *n + return NULL; + } + ++static int _dl_load_gl(const char *name, struct loadtask *task, struct zip_info *z_info){ ++ if(ginit_gpu == -1){ ++ LD_LOGD("ginit_gpu is not initialized\n"); ++ FILE *file; ++ file = fopen("/data/system/gpu_cur", "r"); ++ if (file == NULL) { ++ LD_LOGE("Failed to open file for multi gpu path"); ++ return -1; ++ } ++ fseek(file, 0, SEEK_END); ++ long filesize = ftell(file); ++ fseek(file, 0, SEEK_SET); ++ ++ gpu_env_path = (char *)malloc(filesize + 1); ++ if (gpu_env_path == NULL) { ++ LD_LOGE("Failed to allocate memory"); ++ fclose(file); ++ return -1; ++ } ++ memset(gpu_env_path, 0, filesize + 1); ++ size_t bytesRead = fread(gpu_env_path, 1, filesize, file); ++ if (bytesRead != filesize) { ++ LD_LOGE("Get multi gpu path failed"); ++ free(gpu_env_path); ++ gpu_env_path = NULL; ++ fclose(file); ++ return -1; ++ } ++ fclose(file); ++ ginit_gpu = 0; ++ } ++ if((gpu_env_path) && (strlen(gpu_env_path) > 0)){ ++ LD_LOGD("open_library_by_path %{public}s", gpu_env_path); ++ open_library_by_path(name, gpu_env_path, task, z_info); ++ } ++ return 0; ++} ++ + #ifndef LOAD_ORDER_RANDOMIZATION + /* add namespace function */ + struct dso *load_library( +@@ -2243,6 +2283,13 @@ struct dso *load_library( + pathname = buf; + LD_LOGD("load_library lib_paths pathname:%{public}s.", pathname); + } ++ if(fd < 0){ ++ LD_LOGI("load_library search multi_gpu_path"); ++ fd = _dl_load_gl(name, buf, sizeof buf); ++ if(fd < 0){ ++ LD_LOGI("load_library %{public}s search multi_gpu_path", name); ++ } ++ } + if (fd < 0) { + if (!check_inherited || !namespace->ns_inherits) return 0; + /* Load lib in inherited namespace. Do not check inherited again.*/ +@@ -5612,6 +5659,10 @@ static bool load_library_header(struct loadtask *task) + LD_LOGD("load_library no asan lib_paths path_open fd:%{public}d.", task->fd); + } + } ++ if (task->fd < 0) { ++ LD_LOGI("_dl_load_gl"); ++ _dl_load_gl(name, task, &z_info); ++ } + task->pathname = task->buf; + } + if (task->fd < 0) { diff --git a/device_board_phytium/common/patch/0031=base-startup-init=fix_cannot_read_vendor_etc_files_under_64_bit.patch b/device_board_phytium/common/patch/0031=base-startup-init=fix_cannot_read_vendor_etc_files_under_64_bit.patch new file mode 100755 index 0000000000000000000000000000000000000000..d7adc97a23c304d50b029481903890eeac9d4e9f --- /dev/null +++ b/device_board_phytium/common/patch/0031=base-startup-init=fix_cannot_read_vendor_etc_files_under_64_bit.patch @@ -0,0 +1,19 @@ +diff --git a/services/sandbox/system-sandbox64.json b/services/sandbox/system-sandbox64.json +index bb2c774b..18092709 100644 +--- a/services/sandbox/system-sandbox64.json ++++ b/services/sandbox/system-sandbox64.json +@@ -93,8 +93,12 @@ + "sandbox-path" : "/sys_prod", + "sandbox-flags" : [ "bind", "rec", "private" ] + }, { +- "src-path" : "/vendor", +- "sandbox-path" : "/chipset", ++ "src-path" : "/vendor", ++ "sandbox-path" : "/vendor", ++ "sandbox-flags" : [ "bind", "rec", "private" ] ++ }, { ++ "src-path" : "/chipset", ++ "sandbox-path" : "/chipset", + "sandbox-flags" : [ "bind", "rec", "private" ] + }, { + "src-path" : "/chip_prod", diff --git a/device_board_phytium/common/patch/0032=foundation-arkui-napi=fix_libjsvm_may_compile_fail.patch b/device_board_phytium/common/patch/0032=foundation-arkui-napi=fix_libjsvm_may_compile_fail.patch new file mode 100755 index 0000000000000000000000000000000000000000..73eaaf3c73f228bbb9fe65099e7183c5fc481a72 --- /dev/null +++ b/device_board_phytium/common/patch/0032=foundation-arkui-napi=fix_libjsvm_may_compile_fail.patch @@ -0,0 +1,16 @@ +diff --git a/jsvm/build_jsvm_inter.sh b/jsvm/build_jsvm_inter.sh +index 0f13004..1df3e3d 100755 +--- a/jsvm/build_jsvm_inter.sh ++++ b/jsvm/build_jsvm_inter.sh +@@ -111,7 +111,10 @@ do_env() { + out_dir=${TARGET_GEN_DIR}/out + workdir=${NODE_PATH} + [ -d "${out_dir}" ] || mkdir -p ${out_dir} +- [ -L "${workdir}/out" ] || ln -s ${out_dir} ${workdir}/out ++ # make sure ${workdir}/out is linked to the right path ${out_dir} ++ if [ ! -L "${workdir}/out" ] || [ "$(readlink -f "${workdir}/out")" != "$(readlink -f "${out_dir}")" ]; then ++ ln -sfn "$(readlink -f "${out_dir}")" "${workdir}/out" ++ fi + + argurment+=" -fstack-protector-strong" + argurment+=" -Wl,-z,noexecstack" diff --git a/device_board_phytium/common/patch/0033=foundation-communication-wifi=disable-p2p.patch b/device_board_phytium/common/patch/0033=foundation-communication-wifi=disable-p2p.patch new file mode 100755 index 0000000000000000000000000000000000000000..0275065d393fa1e77b0e7f7564486c6d99b0eebe --- /dev/null +++ b/device_board_phytium/common/patch/0033=foundation-communication-wifi=disable-p2p.patch @@ -0,0 +1,13 @@ +diff --git a/wifi/wifi.gni b/wifi/wifi.gni +index 5cd865d71..5a8f75df5 100644 +--- a/wifi/wifi.gni ++++ b/wifi/wifi.gni +@@ -19,7 +19,7 @@ DHCP_ROOT_DIR = "$SUBSYSTEM_DIR/dhcp" + CONFIG_CTRL_IFACE = "unix" + + declare_args() { +- wifi_feature_with_p2p = true ++ wifi_feature_with_p2p = false + wifi_feature_with_ap_intf = "wlan" + wifi_feature_with_ap_num = 1 + wifi_feature_with_sta_num = 1 diff --git a/device_board_phytium/common/patch/0034=foundation-communication-wifi=disable-hdi-chip-supported.patch b/device_board_phytium/common/patch/0034=foundation-communication-wifi=disable-hdi-chip-supported.patch new file mode 100755 index 0000000000000000000000000000000000000000..a944c4ae573bd07997095d817b63cc7a353035d2 --- /dev/null +++ b/device_board_phytium/common/patch/0034=foundation-communication-wifi=disable-hdi-chip-supported.patch @@ -0,0 +1,16 @@ +diff --git a/wifi/wifi.gni b/wifi/wifi.gni +index 5a8f75df5..9cf531294 100644 +--- a/wifi/wifi.gni ++++ b/wifi/wifi.gni +@@ -48,10 +48,7 @@ declare_args() { + wifi_feature_p2p_random_mac_addr = true + wifi_feature_powermgr_support = false + wifi_feature_with_sta_asset = true +- if (defined(global_parts_info) && +- defined(global_parts_info.hdf_drivers_interface_wlan)) { +- wifi_feature_with_hdi_chip_supported = true +- } ++ wifi_feature_with_hdi_chip_supported = false + } + + memory_optimization_cflags = [ diff --git a/device_board_phytium/common/patch/0035=base-update-updater=support_OTA_ui.patch b/device_board_phytium/common/patch/0035=base-update-updater=support_OTA_ui.patch new file mode 100644 index 0000000000000000000000000000000000000000..91d032c84ffea09cafd74eb7d9115cc963a59a78 --- /dev/null +++ b/device_board_phytium/common/patch/0035=base-update-updater=support_OTA_ui.patch @@ -0,0 +1,180 @@ +diff --git a/resources/BUILD.gn b/resources/BUILD.gn +index 887a375e..66c6b84e 100755 +--- a/resources/BUILD.gn ++++ b/resources/BUILD.gn +@@ -13,7 +13,7 @@ + + import("//base/update/updater/updater_default_cfg.gni") + import("//build/ohos.gni") +- ++phytium_resources_path = "../../../../device/board/phytium/common/updater_resources/phytium" + updater_resources_list = [ + "font.png", + "icon_error.png", +@@ -83,68 +83,63 @@ updater_resources_list = [ + "loop00061.png", + "font/HarmonyOS_Sans_SC_Regular_Small.ttf", + "font/line_cj.brk", ++ "${phytium_resources_path}/images/icon/darkOUCOHlogo.png", ++ "${phytium_resources_path}/images/icon/lightOUCOHlogo.png", ++ "${phytium_resources_path}/images/icon/icon_failed.png", ++ "${phytium_resources_path}/images/icon/icon_ok.png", ++ "${phytium_resources_path}/images/warn/tips.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00000.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00001.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00002.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00003.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00004.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00005.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00006.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00007.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00008.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00009.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00010.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00011.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00012.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00013.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00014.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00015.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00016.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00017.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00018.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00019.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00020.png", ++ "${phytium_resources_path}/images/progress/dark_flash_00021.png", ++ "${phytium_resources_path}/images/progress/flash_00000.png", ++ "${phytium_resources_path}/images/progress/flash_00001.png", ++ "${phytium_resources_path}/images/progress/flash_00002.png", ++ "${phytium_resources_path}/images/progress/flash_00003.png", ++ "${phytium_resources_path}/images/progress/flash_00004.png", ++ "${phytium_resources_path}/images/progress/flash_00005.png", ++ "${phytium_resources_path}/images/progress/flash_00006.png", ++ "${phytium_resources_path}/images/progress/flash_00007.png", ++ "${phytium_resources_path}/images/progress/flash_00008.png", ++ "${phytium_resources_path}/images/progress/flash_00009.png", ++ "${phytium_resources_path}/images/progress/flash_00010.png", ++ "${phytium_resources_path}/images/progress/flash_00011.png", ++ "${phytium_resources_path}/images/progress/flash_00012.png", ++ "${phytium_resources_path}/images/progress/flash_00013.png", ++ "${phytium_resources_path}/images/progress/flash_00014.png", ++ "${phytium_resources_path}/images/progress/flash_00015.png", ++ "${phytium_resources_path}/images/progress/flash_00016.png", ++ "${phytium_resources_path}/images/progress/flash_00017.png", ++ "${phytium_resources_path}/images/progress/flash_00018.png", ++ "${phytium_resources_path}/images/progress/flash_00019.png", ++ "${phytium_resources_path}/images/progress/flash_00020.png", ++ "${phytium_resources_path}/images/progress/flash_00021.png", ++ "${phytium_resources_path}/pages/config.json", ++ "${phytium_resources_path}/pages/phytium.json", ++ "${phytium_resources_path}/pages/confirm.json", ++ "${phytium_resources_path}/pages/menu.json", ++ "${phytium_resources_path}/pages/upd.json", ++ "${phytium_resources_path}/string/string.json", + ] + +-if (product_name == "rk3568") { +- updater_resources_list += [ +- "${product_name}/images/icon/darkOUCOHlogo.png", +- "${product_name}/images/icon/lightOUCOHlogo.png", +- "${product_name}/images/icon/icon_failed.png", +- "${product_name}/images/icon/icon_ok.png", +- "${product_name}/images/warn/tips.png", +- "${product_name}/images/progress/dark_flash_00000.png", +- "${product_name}/images/progress/dark_flash_00001.png", +- "${product_name}/images/progress/dark_flash_00002.png", +- "${product_name}/images/progress/dark_flash_00003.png", +- "${product_name}/images/progress/dark_flash_00004.png", +- "${product_name}/images/progress/dark_flash_00005.png", +- "${product_name}/images/progress/dark_flash_00006.png", +- "${product_name}/images/progress/dark_flash_00007.png", +- "${product_name}/images/progress/dark_flash_00008.png", +- "${product_name}/images/progress/dark_flash_00009.png", +- "${product_name}/images/progress/dark_flash_00010.png", +- "${product_name}/images/progress/dark_flash_00011.png", +- "${product_name}/images/progress/dark_flash_00012.png", +- "${product_name}/images/progress/dark_flash_00013.png", +- "${product_name}/images/progress/dark_flash_00014.png", +- "${product_name}/images/progress/dark_flash_00015.png", +- "${product_name}/images/progress/dark_flash_00016.png", +- "${product_name}/images/progress/dark_flash_00017.png", +- "${product_name}/images/progress/dark_flash_00018.png", +- "${product_name}/images/progress/dark_flash_00019.png", +- "${product_name}/images/progress/dark_flash_00020.png", +- "${product_name}/images/progress/dark_flash_00021.png", +- "${product_name}/images/progress/flash_00000.png", +- "${product_name}/images/progress/flash_00001.png", +- "${product_name}/images/progress/flash_00002.png", +- "${product_name}/images/progress/flash_00003.png", +- "${product_name}/images/progress/flash_00004.png", +- "${product_name}/images/progress/flash_00005.png", +- "${product_name}/images/progress/flash_00006.png", +- "${product_name}/images/progress/flash_00007.png", +- "${product_name}/images/progress/flash_00008.png", +- "${product_name}/images/progress/flash_00009.png", +- "${product_name}/images/progress/flash_00010.png", +- "${product_name}/images/progress/flash_00011.png", +- "${product_name}/images/progress/flash_00012.png", +- "${product_name}/images/progress/flash_00013.png", +- "${product_name}/images/progress/flash_00014.png", +- "${product_name}/images/progress/flash_00015.png", +- "${product_name}/images/progress/flash_00016.png", +- "${product_name}/images/progress/flash_00017.png", +- "${product_name}/images/progress/flash_00018.png", +- "${product_name}/images/progress/flash_00019.png", +- "${product_name}/images/progress/flash_00020.png", +- "${product_name}/images/progress/flash_00021.png", +- "${product_name}/pages/config.json", +- "${product_name}/pages/rk3568.json", +- "${product_name}/pages/confirm.json", +- "${product_name}/pages/menu.json", +- "${product_name}/pages/upd.json", +- "${product_name}/string/string.json", +- ] +-} +- + updater_resources_target = [] + + if (!updater_ui_support) { +@@ -161,7 +156,7 @@ foreach(file, updater_resources_list) { + module_install_dir = "user/data" + } else if (get_path_info(file, "dir") != ".") { + module_install_dir = +- get_path_info(string_replace(file, "${product_name}", "resources"), ++ get_path_info(string_replace(file, "${phytium_resources_path}", "resources"), + "dir") + } + install_images = [ "updater" ] +diff --git a/services/ui/driver/drm_driver.cpp b/services/ui/driver/drm_driver.cpp +index 681ec535..ed7c70c0 100644 +--- a/services/ui/driver/drm_driver.cpp ++++ b/services/ui/driver/drm_driver.cpp +@@ -271,13 +271,28 @@ int DrmDriver::DrmInit(void) + } + + // 2 : get connected connector +- uint32_t modeId; ++ uint32_t modeId = 0; + conn_ = GetConnector(*res_, fd_, modeId); + if (conn_ == nullptr) { + LOG(ERROR) << "DrmInit: GetConnector failed"; + return -1; + } + ++ bool found = false; ++ for (int i = 0; i < conn_->count_modes; i++) { ++ if (conn_->modes[i].hdisplay == 1280 && ++ conn_->modes[i].vdisplay == 720) { ++ modeId = i; ++ found = true; ++ LOG(INFO) << "Using preset mode: 1280x720"; ++ break; ++ } ++ } ++ if (!found) { ++ LOG(ERROR) << "1280x720 mode not supported"; ++ return -1; ++ } ++ + // 3: get vaild encoder and crtc + crtc_ = GetCrtc(*res_, fd_, *conn_); + if (crtc_ == nullptr) { diff --git a/device_board_phytium/common/patch/0036=build=updater_ramdisk_image_conf_size.patch b/device_board_phytium/common/patch/0036=build=updater_ramdisk_image_conf_size.patch new file mode 100644 index 0000000000000000000000000000000000000000..a907becfedb1b0129b43bacf36b06b721de0c421 --- /dev/null +++ b/device_board_phytium/common/patch/0036=build=updater_ramdisk_image_conf_size.patch @@ -0,0 +1,11 @@ +diff --git a/ohos/images/mkimage/updater_ramdisk_image_conf.txt b/ohos/images/mkimage/updater_ramdisk_image_conf.txt +index 18705178..8dbbfb17 100644 +--- a/ohos/images/mkimage/updater_ramdisk_image_conf.txt ++++ b/ohos/images/mkimage/updater_ramdisk_image_conf.txt +@@ -1,5 +1,5 @@ + /updater +-33554432 ++46573375 + --fs_type=cpio + --dac_config ../../build/ohos/images/mkimage/dac.txt + --file_context obj/base/security/selinux_adapter/file_contexts.bin diff --git a/device_board_phytium/common/patch/unused/0031=foundation-multimedia-player_framework=disable-audio-for-histreamer.patch b/device_board_phytium/common/patch/unused/0031=foundation-multimedia-player_framework=disable-audio-for-histreamer.patch deleted file mode 100755 index dd5d5eaf6661fc08e07aa814d6ff9f574b55cd10..0000000000000000000000000000000000000000 --- a/device_board_phytium/common/patch/unused/0031=foundation-multimedia-player_framework=disable-audio-for-histreamer.patch +++ /dev/null @@ -1,14 +0,0 @@ -diff --git a/services/engine/histreamer/player/hiplayer_impl.cpp b/services/engine/histreamer/player/hiplayer_impl.cpp -index a205f7203..3eb38c4db 100755 ---- a/services/engine/histreamer/player/hiplayer_impl.cpp -+++ b/services/engine/histreamer/player/hiplayer_impl.cpp -@@ -2444,9 +2444,7 @@ Status HiPlayerImpl::OnCallback(std::shared_ptr filter, const FilterCall - case StreamType::STREAMTYPE_SUBTITLE: - return LinkSubtitleSinkFilter(filter, outType); - case StreamType::STREAMTYPE_RAW_AUDIO: -- return LinkAudioSinkFilter(filter, outType); - case StreamType::STREAMTYPE_ENCODED_AUDIO: -- return LinkAudioDecoderFilter(filter, outType); - #ifdef SUPPORT_VIDEO - case StreamType::STREAMTYPE_RAW_VIDEO: - break; diff --git a/device_board_phytium/common/tools/generate_image/make_boot.sh b/device_board_phytium/common/tools/generate_image/make_boot.sh index 01c5e6e0b57d0b0f1fd7e9a8bee2c8a4a1001e6f..ab56d52ddb464fdf6e5f284f25b6799fa91b9711 100755 --- a/device_board_phytium/common/tools/generate_image/make_boot.sh +++ b/device_board_phytium/common/tools/generate_image/make_boot.sh @@ -40,6 +40,10 @@ if [ -e ${OUT_PATH}/ramdisk.img ]; then cp ${OUT_PATH}/ramdisk.img ${BOOT_PATH} fi +if [ -e ${OUT_PATH}/updater.img ]; then + cp ${OUT_PATH}/updater.img ${BOOT_PATH} +fi + function make_uboot_boot_image() { src=$1 @@ -122,7 +126,9 @@ function check_boot_files() check_Image="Image " check_ramdisk="ramdisk.img " check_efi="EFI " - check_dtb="dtb " + #check_dtb="dtb " + check_dtb="" + check_updater="updater.img " for FILE in `ls ${src}` do @@ -134,14 +140,16 @@ function check_boot_files() check_dtb="" elif [[ $FILE = "EFI" ]]; then check_efi="" + elif [[ $FILE = "updater.img" ]]; then + check_updater="" fi done - if [ -z $check_Image ]&&[ -z $check_ramdisk ]&&[ -z $check_dtb ]&&[ -z $check_efi ]; then + if [ -z $check_Image ]&&[ -z $check_ramdisk ]&&[ -z $check_dtb ]&&[ -z $check_efi ]&&[ -z $check_updater ]; then FILE_CHECK="sucess" else - echo -e "${red}check files in ${BOOT_PATH} failed,${check_Image}${check_ramdisk}${check_dtb}${check_efi}is needed.${normal}" - echo "ls ${src}:["`ls ${src}`"]" + echo -e "${red}check files in ${BOOT_PATH} failed,${check_Image}${check_ramdisk}${check_dtb}${check_efi}${check_updater}is needed.${normal}" + echo "ls ${src}:["`ls ${src}`"]" fi } diff --git a/device_board_phytium/common/tools/generate_image/uboot/phytiumpi-firefly/fip-all-v2.1hw-2GB-tee-240516.bin b/device_board_phytium/common/tools/generate_image/uboot/phytiumpi-firefly/fip-all-v2.1hw-2GB-tee-240516.bin new file mode 100755 index 0000000000000000000000000000000000000000..fd0e4b09ecec027cb0a5d4daad01755892a0fdc7 Binary files /dev/null and b/device_board_phytium/common/tools/generate_image/uboot/phytiumpi-firefly/fip-all-v2.1hw-2GB-tee-240516.bin differ diff --git a/device_board_phytium/common/tools/generate_image/uboot/phytiumpi-firefly/fip-all-v2.1hw-4GB-tee-240516.bin b/device_board_phytium/common/tools/generate_image/uboot/phytiumpi-firefly/fip-all-v2.1hw-4GB-tee-240516.bin new file mode 100755 index 0000000000000000000000000000000000000000..12f62778a55cdffa8f77744bd37b1e574fff69e7 Binary files /dev/null and b/device_board_phytium/common/tools/generate_image/uboot/phytiumpi-firefly/fip-all-v2.1hw-4GB-tee-240516.bin differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/icon/darkOUCOHlogo.png b/device_board_phytium/common/updater_resources/phytium/images/icon/darkOUCOHlogo.png new file mode 100644 index 0000000000000000000000000000000000000000..1f707dfaad5bce85b577d9f132ea66be0dbcc3df Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/icon/darkOUCOHlogo.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/icon/icon_failed.png b/device_board_phytium/common/updater_resources/phytium/images/icon/icon_failed.png new file mode 100644 index 0000000000000000000000000000000000000000..83f3e0eee7070c0d6977545798734f8e916912eb Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/icon/icon_failed.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/icon/icon_ok.png b/device_board_phytium/common/updater_resources/phytium/images/icon/icon_ok.png new file mode 100644 index 0000000000000000000000000000000000000000..db8bf9b006b871784bbce4436e67d0c9d5a8a4a4 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/icon/icon_ok.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/icon/lightOUCOHlogo.png b/device_board_phytium/common/updater_resources/phytium/images/icon/lightOUCOHlogo.png new file mode 100644 index 0000000000000000000000000000000000000000..bde9acbc38661d71606589b13240870ebac89e2d Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/icon/lightOUCOHlogo.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00000.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00000.png new file mode 100644 index 0000000000000000000000000000000000000000..ca31e3b323b7b554a9648bcfb3f18c6c687ab24f Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00000.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00001.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00001.png new file mode 100644 index 0000000000000000000000000000000000000000..bfdcbe88c2ff506de15e8dd9ee7cc519776aa0c2 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00001.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00002.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00002.png new file mode 100644 index 0000000000000000000000000000000000000000..2060808eacadda164c65c413adada11a2f44a07d Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00002.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00003.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00003.png new file mode 100644 index 0000000000000000000000000000000000000000..73dd8c5702afbf8c6ae0489048090f877729a20f Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00003.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00004.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00004.png new file mode 100644 index 0000000000000000000000000000000000000000..8324fcc70f623d216415dd4dfb060a3ac14b579f Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00004.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00005.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00005.png new file mode 100644 index 0000000000000000000000000000000000000000..e4aee1170e66d236c5eb1ab9fc7fec2ecc5dfafd Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00005.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00006.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00006.png new file mode 100644 index 0000000000000000000000000000000000000000..8392b8fd479ea17cecaf0f12203ac274258822a6 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00006.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00007.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00007.png new file mode 100644 index 0000000000000000000000000000000000000000..c895f50361477e92ea4f4d2cf15f96d86f97fb21 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00007.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00008.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00008.png new file mode 100644 index 0000000000000000000000000000000000000000..6d06042cf2a0168b4fe61d0f89cb32b0b4fa4738 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00008.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00009.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00009.png new file mode 100644 index 0000000000000000000000000000000000000000..1fbfa8cbd9cff2b51e4bb98e013ae4902cd65b1b Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00009.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00010.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00010.png new file mode 100644 index 0000000000000000000000000000000000000000..639469dc71e9518a928c94c3d8ffc0edc669d0bf Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00010.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00011.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00011.png new file mode 100644 index 0000000000000000000000000000000000000000..6c75bb75f181c3c0028cc565f45f25945e276349 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00011.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00012.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00012.png new file mode 100644 index 0000000000000000000000000000000000000000..7abde9543491a8b3c620fba6e52b3545cc92fa20 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00012.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00013.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00013.png new file mode 100644 index 0000000000000000000000000000000000000000..b4fae2c8aa9fa0afe731a4319403a52fa3e89440 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00013.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00014.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00014.png new file mode 100644 index 0000000000000000000000000000000000000000..1c68b33d9be63dd8172b1cb044228c17bd733d3d Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00014.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00015.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00015.png new file mode 100644 index 0000000000000000000000000000000000000000..5e988eddd9366e4c9a26167ac4f05ecf63be2f21 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00015.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00016.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00016.png new file mode 100644 index 0000000000000000000000000000000000000000..b1cb5ab530724261e05af0eeb53cb7a3d2404879 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00016.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00017.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00017.png new file mode 100644 index 0000000000000000000000000000000000000000..8be7e36476e5c14310e651339cfc365e6f6268c4 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00017.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00018.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00018.png new file mode 100644 index 0000000000000000000000000000000000000000..c47a5c892ed392ec145cf420775fb99666710029 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00018.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00019.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00019.png new file mode 100644 index 0000000000000000000000000000000000000000..1d3d7813b8158b6dfab616b1c8253925fb66fb42 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00019.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00020.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00020.png new file mode 100644 index 0000000000000000000000000000000000000000..e72124610a3879c7caa1f43fd9bde20d8a924418 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00020.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00021.png b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00021.png new file mode 100644 index 0000000000000000000000000000000000000000..25230d44d5fa1530954040d8d704c4b4a74f16a8 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/dark_flash_00021.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00000.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00000.png new file mode 100644 index 0000000000000000000000000000000000000000..3c409623c456d7cf7fc0cde3e0ad8d3062f7be21 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00000.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00001.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00001.png new file mode 100644 index 0000000000000000000000000000000000000000..21a0311cbb1d8a83909911a128b1cd0057ac9e81 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00001.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00002.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00002.png new file mode 100644 index 0000000000000000000000000000000000000000..c7d6ce0a4e02ca875faf5660c0c89c748035b9d1 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00002.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00003.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00003.png new file mode 100644 index 0000000000000000000000000000000000000000..0682491c658bebcc08f407f7a4da95da522376c7 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00003.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00004.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00004.png new file mode 100644 index 0000000000000000000000000000000000000000..dd783cffa91430659acb68a24b459cd1b1b288c0 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00004.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00005.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00005.png new file mode 100644 index 0000000000000000000000000000000000000000..d36b95b73370e8ce07cfabd8cac8ec376047b3e6 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00005.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00006.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00006.png new file mode 100644 index 0000000000000000000000000000000000000000..0fcc792c7e44a836bfeaa783046321e92a2c0219 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00006.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00007.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00007.png new file mode 100644 index 0000000000000000000000000000000000000000..9f7de7661f98913f2788c8e77146dc4b68098a62 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00007.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00008.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00008.png new file mode 100644 index 0000000000000000000000000000000000000000..bb95b83d66ab44e1d8ffcd2bb784d70c99cd7ed1 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00008.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00009.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00009.png new file mode 100644 index 0000000000000000000000000000000000000000..26245585c34d23084d8f97af8845d2428bee35d8 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00009.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00010.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00010.png new file mode 100644 index 0000000000000000000000000000000000000000..15da6bdad5fd8cfc539a3bce5832dda96d300b47 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00010.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00011.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00011.png new file mode 100644 index 0000000000000000000000000000000000000000..45515ab6d61073f5d48dd735f72495838136927e Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00011.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00012.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00012.png new file mode 100644 index 0000000000000000000000000000000000000000..6a0177c676de8b0f4fe0bf94bb685ac8e02fa6c6 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00012.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00013.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00013.png new file mode 100644 index 0000000000000000000000000000000000000000..43f498b27005765854e7ffc16b16c733a016ae95 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00013.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00014.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00014.png new file mode 100644 index 0000000000000000000000000000000000000000..180f3095b9fda1e432a74871aa2d60bd3816acbd Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00014.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00015.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00015.png new file mode 100644 index 0000000000000000000000000000000000000000..954c65cdb8753e221c17f26f02d994c91e5156a2 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00015.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00016.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00016.png new file mode 100644 index 0000000000000000000000000000000000000000..526d58fd5e1d1ef7a2e3aff392133b8092ff00e2 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00016.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00017.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00017.png new file mode 100644 index 0000000000000000000000000000000000000000..b6710482870f4e33bcf600676c7a4145b7434b73 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00017.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00018.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00018.png new file mode 100644 index 0000000000000000000000000000000000000000..b7154ac4e285704ad47135df96c10796d2c11692 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00018.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00019.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00019.png new file mode 100644 index 0000000000000000000000000000000000000000..6e23b756da8a429010eb4267bfea859ac81e48b5 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00019.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00020.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00020.png new file mode 100644 index 0000000000000000000000000000000000000000..9cae7d005e8f1a2511bda3bdc2dac317c7cf6956 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00020.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00021.png b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00021.png new file mode 100644 index 0000000000000000000000000000000000000000..91025ff383715ba0378dd4a2828e3805f58fe803 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/progress/flash_00021.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/images/warn/tips.png b/device_board_phytium/common/updater_resources/phytium/images/warn/tips.png new file mode 100644 index 0000000000000000000000000000000000000000..5eeffdb8d7aa54f12bfc54bc8a2bdd4da8308c84 Binary files /dev/null and b/device_board_phytium/common/updater_resources/phytium/images/warn/tips.png differ diff --git a/device_board_phytium/common/updater_resources/phytium/pages/config.json b/device_board_phytium/common/updater_resources/phytium/pages/config.json new file mode 100644 index 0000000000000000000000000000000000000000..b555a659f6f97b74a8e98536509d1a5f948aab13 --- /dev/null +++ b/device_board_phytium/common/updater_resources/phytium/pages/config.json @@ -0,0 +1,3 @@ +{ + "config" : "/resources/pages/phytium.json" +} \ No newline at end of file diff --git a/device_board_phytium/common/updater_resources/phytium/pages/confirm.json b/device_board_phytium/common/updater_resources/phytium/pages/confirm.json new file mode 100644 index 0000000000000000000000000000000000000000..3acaf17ef1f0bfa31e64ba54c1ac7680fa682cac --- /dev/null +++ b/device_board_phytium/common/updater_resources/phytium/pages/confirm.json @@ -0,0 +1,78 @@ +{ + "id": "confirm", + "bgColor" : "#f1f3f5ff", + "default": { + "Common": { + "visible": true + }, + "UILabel": { + "bgColor": "#f1f3f5ff", + "fontColor": "#000000e6", + "align" : "center" + }, + "UIImageView": { + "imgCnt" : 1, + "updInterval": 0, + "filePrefix" : "" + }, + "UILabelButton": { + "bgColor": "#e5e7e9ff", + "txtColor": "#007dffff", + "focusedBgColor": "#007dffff", + "focusedTxtColor": "#ffffffff", + "focusable" : true + } + }, + "coms": [ + { + "type": "UIImageView", + "id": "OHOSIcon_Image", + "x": 240, + "y": 853, + "w": 270, + "h": 34, + "resPath": "/resources/images/icon/lightOUCOHlogo.png" + }, + { + "type": "UILabel", + "id": "InformTitle_Label", + "text": "[LABEL_RESET_CONFIRM_TITLE]", + "x": 308, + "y": 124, + "w": 335, + "h": 21, + "fontSize": 18 + }, + { + "type": "UILabel", + "id": "Inform_Label", + "text": "[LABEL_RESET_INFORM]", + "x": 338, + "y": 124, + "w": 335, + "h": 90, + "fontSize": 16, + "fontColor": "#00000099" + }, + { + "type": "UILabelButton", + "id": "Cancel_Button", + "text": "[LABEL_NOTE_CANCEL]", + "x": 636, + "y": 107, + "w": 351, + "h": 45, + "fontSize": 18 + }, + { + "type": "UILabelButton", + "id": "Reset_Button", + "text": "[LABEL_USER_DATA_RESET]", + "x": 574, + "y": 107, + "w": 351, + "h": 45, + "fontSize": 18 + } + ] +} \ No newline at end of file diff --git a/device_board_phytium/common/updater_resources/phytium/pages/menu.json b/device_board_phytium/common/updater_resources/phytium/pages/menu.json new file mode 100644 index 0000000000000000000000000000000000000000..bda16b3ea2071c9122394864e1d019522200d8ea --- /dev/null +++ b/device_board_phytium/common/updater_resources/phytium/pages/menu.json @@ -0,0 +1,122 @@ +{ + "id": "menu", + "bgColor" : "#000000ff", + "subpages" : [ + { + "id":"normal", + "coms":[ + "OHOSIcon_Image", + "SdUpdate_Button", + "FactoryRstNormal_Button", + "Reboot_Button", + "Shutdown_Button", + "Usage_Label" + ], + "bgColor" : "#f1f3f5ff" + } + ], + "default": { + "Common": { + "visible": false + }, + "UILabel": { + "bgColor": "#f1f3f5ff", + "fontColor": "#000000e6", + "align" : "center" + }, + "UIImageView": { + "imgCnt" : 1, + "updInterval": 0, + "filePrefix" : "" + }, + "UILabelButton": { + "bgColor": "#e5e7e9ff", + "txtColor": "#007dffff", + "focusedBgColor": "#007dffff", + "focusedTxtColor": "#ffffffff", + "focusable" : true + } + }, + "coms": [ + { + "type": "UIImageView", + "id": "OHOSIcon_Image", + "x": 457, + "y": 151, + "w": 320, + "h": 40, + "resPath": "/resources/images/icon/lightOUCOHlogo.png" + }, + { + "type": "UILabelButton", + "id": "SdUpdate_Button", + "text": "[LABEL_UPDATE_FROM_SDCARD]", + "x": 432, + "y": 400, + "w": 416, + "h": 53, + "fontSize": 18 + }, + { + "type": "UILabelButton", + "id": "RebootDevice_Button", + "text": "[LABEL_REBOOT_DEVICE]", + "x": 432, + "y": 620, + "w": 416, + "h": 40, + "fontSize": 18 + }, + { + "type": "UILabelButton", + "id": "FactoryRstNormal_Button", + "text": "[LABEL_USER_DATA_RESET]", + "x": 432, + "y": 473, + "w": 416, + "h": 53, + "fontSize": 18 + }, + { + "type": "UILabelButton", + "id": "FactoryRst_Button", + "text": "[LABEL_USER_DATA_RESET]", + "x": 432, + "y": 473, + "w": 416, + "h": 53, + "fontSize": 18 + }, + { + "type": "UILabelButton", + "id": "Reboot_Button", + "text": "[LABEL_REBOOT]", + "x": 432, + "y": 547, + "w": 416, + "h": 53, + "fontSize": 18 + }, + { + "type": "UILabelButton", + "id": "Shutdown_Button", + "text": "[LABEL_SHUTDOWN]", + "x": 432, + "y": 620, + "w": 416, + "h": 53, + "fontSize": 18 + }, + { + "type": "UILabel", + "id": "Usage_Label", + "text": "[LABEL_MENU_USAGE]", + "x": 441, + "y": 232, + "w": 397, + "h": 25, + "fontSize": 16, + "fontColor": "#00000099" + } + ] +} \ No newline at end of file diff --git a/device_board_phytium/common/updater_resources/phytium/pages/phytium.json b/device_board_phytium/common/updater_resources/phytium/pages/phytium.json new file mode 100644 index 0000000000000000000000000000000000000000..c3b822b790a1888b38b9188a9e8c5b27a97a043d --- /dev/null +++ b/device_board_phytium/common/updater_resources/phytium/pages/phytium.json @@ -0,0 +1,169 @@ +{ + "screenWidth": 1280, + "screenHeight": 720, + "dir":"/resources/pages", + "pages":[ + "menu.json", + "confirm.json", + "upd.json" + ], + "enableFoucs": true, + "entry":"menu:normal", + "strategy" : { + "default" : { + "confirmPageId" : "confirm", + "labelLogId" : { + "pageId" : "", + "comId" : "" + }, + "labelLogResId" : { + "pageId" : "upd", + "comId" : "UpdateAutoReboot_Label" + }, + "labelUpdId" : { + "pageId" : "", + "comId" : "" + }, + "progressPage" : { + "progressPageId" : "upd:update", + "progressComId" : "ProgressUpdBoxDark_Progress", + "progressType" : "bar", + "logoComId" : "OHOSIconDark_Image", + "logoType" : "img", + "warningComId" : "PowerLongPressWarning_Image" + }, + "resPage" : { + "successPageId" : "upd:updateSuccess", + "failPageId" : "upd:normalUpdateFailed" + } + }, + "sdcard" : { + "progressPage" : { + "progressPageId" : "upd:sdUpdate", + "progressComId" : "UpdBox_Progress", + "progressType" : "bar", + "logoComId" : "OHOSIcon_Image", + "logoType" : "img" + }, + "labelLogResId" : { + "pageId" : "upd", + "comId" : "UpdateInfoDark_Label" + }, + "resPage" : { + "successPageId" : "upd:updateSuccess", + "failPageId" : "upd:updateFailedNoButton" + } + }, + "factoryRst" : { + "labelLogResId" : { + "pageId" : "upd", + "comId" : "UpdateInfoDark_Label" + }, + "labelUpdId" : { + "pageId" : "upd", + "comId" : "RstInfo_Label" + }, + "progressPage" : { + "progressPageId" : "upd:reset", + "progressComId" : "UpdBox_Progress", + "progressType" : "bar", + "logoComId" : "OHOSIcon_Image", + "logoType" : "img", + "warningComId" : "" + }, + "resPage" : { + "successPageId" : "upd:FactoryRstSucc", + "failPageId" : "upd:FactoryRstFailed" + } + }, + "rebootFactoryRst" : { + "labelLogResId" : { + "pageId" : "upd", + "comId" : "RstInfo_Label" + }, + "progressPage" : { + "progressPageId" : "upd:reset", + "progressComId" : "UpdBox_Progress", + "progressType" : "bar", + "logoComId" : "OHOSIcon_Image", + "logoType" : "img", + "warningComId" : "" + }, + "resPage" : { + "successPageId" : "upd:FactoryRstSucc", + "failPageId" : "upd:FactoryRstFailed" + } + } + }, + "locale" : { + "res" : [ + { + "path" : "/resources/string/string.json", + "level" : 0 + } + ], + "localeFile" : "/data/updater/locale" + }, + "callbacks": [ + { + "pageId" : "menu", + "comId" : "FactoryRst_Button", + "type" : "CLICKEVENT", + "func" : "OnLabelResetEvt" + }, + { + "pageId" : "menu", + "comId" : "FactoryRstNormal_Button", + "type" : "CLICKEVENT", + "func" : "OnLabelResetEvt" + }, + { + "pageId" : "menu", + "comId" : "Reboot_Button", + "type" : "CLICKEVENT", + "func" : "OnRebootEvt" + }, + { + "pageId" : "menu", + "comId" : "RebootDevice_Button", + "type" : "CLICKEVENT", + "func" : "OnRebootEvt" + }, + { + "pageId" : "menu:normal", + "comId" : "Shutdown_Button", + "type" : "CLICKEVENT", + "func" : "OnMenuShutdownEvt" + }, + { + "pageId" : "confirm", + "comId" : "Cancel_Button", + "type" : "CLICKEVENT", + "func" : "OnLabelCancelEvt" + }, + { + "pageId" : "menu:normal", + "comId" : "SdUpdate_Button", + "type" : "CLICKEVENT", + "func" : "OnLabelSDCardNoDelayEvt" + }, + { + "pageId" : "confirm", + "comId" : "Reset_Button", + "type" : "CLICKEVENT", + "func" : "OnConfirmRstEvt" + }, + { + "pageId" : "upd", + "comId" : "FailReboot_Button", + "type" : "CLICKEVENT", + "func" : "OnRebootEvt" + }, + { + "pageId" : "upd", + "comId" : "ReturnToMain_Button", + "type" : "CLICKEVENT", + "func" : "OnReturnToMainEvt" + } + ] +} \ No newline at end of file diff --git a/device_board_phytium/common/updater_resources/phytium/pages/upd.json b/device_board_phytium/common/updater_resources/phytium/pages/upd.json new file mode 100755 index 0000000000000000000000000000000000000000..588c2355402642c7b3264afbe2bbf01df6c54d3b --- /dev/null +++ b/device_board_phytium/common/updater_resources/phytium/pages/upd.json @@ -0,0 +1,325 @@ +{ + "id": "upd", + "bgColor" : "#000000ff", + "subpages": [ + { + "id": "update", + "coms": [ + "OHOSIconDark_Image", + "ProgressUpdBoxDark_Progress", + "UpdateInfoDark_Label", + "PowerLongPressWarning_Image", + "FlashPointDark_Image" + ], + "bgColor" : "#000000ff" + }, + { + "id": "sdUpdate", + "coms": [ + "OHOSIcon_Image", + "UpdBox_Progress", + "SDUpdateInfo_Label", + "PowerLongPressWarning_Image", + "FlashPoint_Image" + ], + "bgColor" : "#f1f3f5ff" + }, + { + "id": "reset", + "coms": [ + "OHOSIcon_Image", + "UpdBox_Progress", + "RstInfo_Label", + "FlashPoint_Image" + ], + "bgColor" : "#f1f3f5ff" + }, + { + "id": "updateSuccess", + "coms": [ + "SuccessIcon_Image", + "UpdateSuccessRes_Label", + "UpdateAutoReboot_Label" + ], + "bgColor" : "#000000ff" + }, + { + "id": "normalUpdateFailed", + "coms": [ + "FailIcon_Image", + "FailReboot_Button", + "UpdateFailedRes_Label" + ], + "bgColor" : "#000000ff" + }, + { + "id": "updateFailedNoButton", + "coms": [ + "FailIcon_Image", + "UpdateInfoDark_Label" + ], + "bgColor" : "#000000ff" + }, + { + "id": "FactoryRstFailed", + "coms": [ + "FailIcon_Image", + "FactoryRstFailedRes_Label", + "ReturnToMain_Button" + ], + "bgColor" : "#f1f3f5ff" + }, + { + "id": "FactoryRstSucc", + "coms": [ + "SuccessIcon_Image", + "FactoryRstSuccRes_Label", + "FactoryRstSuccReboot_Label" + ], + "bgColor" : "#f1f3f5ff" + } + ], + "default": { + "Common": { + "visible": false + }, + "UILabel": { + "bgColor": "#000000ff", + "fontColor": "#ffffffe6", + "align" : "center" + }, + "UIImageView": { + "imgCnt" : 1, + "updInterval": 0, + "filePrefix" : "" + }, + "UILabelButton": { + "bgColor": "#007dffff", + "txtColor": "#ffffffff", + "focusedBgColor": "#007dffff", + "focusedTxtColor": "#ffffffff", + "focusable" : true + }, + "UIBoxProgress": { + "defaultValue": 0, + "bgColor": "#cdcfd0ff", + "fgColor": "#0a59f7ff", + "endPoint" : "", + "hasEp" : false + } + }, + "coms": [ + { + "type": "UIImageView", + "id": "OHOSIconDark_Image", + "x": 213, + "y": 240, + "w": 853, + "h": 34, + "resPath": "/resources/images/icon/darkOUCOHlogo.png" + }, + { + "type": "UIImageView", + "id": "OHOSIcon_Image", + "x": 213, + "y": 240, + "w": 853, + "h": 34, + "resPath": "/resources/images/icon/lightOUCOHlogo.png" + }, + { + "type": "UILabel", + "id": "UpdateInfoDark_Label", + "text": "[LABEL_UPD_INFO]", + "x": 406, + "y": 585, + "w": 472, + "h": 24, + "fontSize": 18 + }, + { + "type": "UILabel", + "id": "SDUpdateInfo_Label", + "text": "[LABEL_UPD_SDCARD_INFO]", + "x": 213, + "y": 585, + "w": 853, + "h": 24, + "fontSize": 18, + "bgColor": "#f1f3f5ff", + "fontColor": "#000000e6" + }, + { + "type": "UILabel", + "id": "RstInfo_Label", + "text": "[LABEL_RESET_PROGRESS_INFO]", + "x": 213, + "y": 585, + "w": 853, + "h": 24, + "fontSize": 18, + "bgColor": "#f1f3f5ff", + "fontColor": "#000000e6" + }, + { + "type": "UIImageView", + "id": "FailIcon_Image", + "x": 469, + "y": 240, + "w": 341, + "h": 108, + "resPath": "/resources/images/icon/icon_failed.png" + }, + { + "type": "UIImageView", + "id": "SuccessIcon_Image", + "x": 469, + "y": 240, + "w": 341, + "h": 108, + "resPath": "/resources/images/icon/icon_ok.png" + }, + { + "type": "UILabelButton", + "id": "FailReboot_Button", + "text": "[LABEL_UPD_FAIL_REBOOT]", + "x": 85, + "y": 639, + "w": 1109, + "h": 45, + "fontSize": 18 + }, + { + "type": "UILabelButton", + "id": "ReturnToMain_Button", + "text": "[LABEL_RETURN_TO_MAIN]", + "x": 85, + "y": 639, + "w": 1109, + "h": 45, + "fontSize": 18 + }, + { + "type": "UILabel", + "id": "UpdateFailedRes_Label", + "text": "[LABEL_UPD_FAIL_TIP]", + "x": 528, + "y": 585, + "w": 228, + "h": 24, + "fontSize": 18 + }, + { + "type": "UILabel", + "id": "UpdateSuccessRes_Label", + "text": "[LABEL_UPD_OK_DONE]", + "x": 524, + "y": 585, + "w": 228, + "h": 24, + "fontSize": 18 + }, + { + "type": "UILabel", + "id": "FactoryRstSuccRes_Label", + "text": "[LOGRES_WIPE_FINISH]", + "x": 213, + "y": 585, + "w": 853, + "h": 24, + "fontSize": 18, + "bgColor":"#f1f3f5ff", + "fontColor":"#000000e6" + }, + { + "type": "UILabel", + "id": "FactoryRstSuccReboot_Label", + "text": "[LABEL_UPD_OK_REBOOT]", + "x": 387, + "y": 617, + "w": 501, + "h": 21, + "fontSize": 16, + "bgColor":"#f1f3f5ff", + "fontColor":"#00000099" + }, + { + "type": "UILabel", + "id": "UpdateAutoReboot_Label", + "text": "[LABEL_UPD_OK_REBOOT]", + "x": 387, + "y": 617, + "w": 501, + "h": 21, + "fontSize": 16, + "fontColor": "#ffffff96" + }, + { + "type": "UILabel", + "id": "FactoryRstFailedRes_Label", + "text": "[LOG_WIPE_FAIL]", + "x": 213, + "y": 585, + "w": 853, + "h": 24, + "fontSize": 18, + "bgColor" : "#f1f3f5ff", + "fontColor": "#000000e6" + }, + { + "type": "UIImageView", + "id": "PowerLongPressWarning_Image", + "x": 43, + "y": 27, + "w": 1195, + "h": 81, + "resPath": "/resources/images/warn/tips.png" + }, + { + "type": "UIBoxProgress", + "id": "UpdBox_Progress", + "x": 256, + "y": 308, + "w": 768, + "h": 2, + "endPoint" : "FlashPoint_Image", + "hasEp" : true + }, + { + "type": "UIBoxProgress", + "id": "ProgressUpdBoxDark_Progress", + "x": 256, + "y": 308, + "w": 768, + "h": 2, + "bgColor": "#262626ff", + "fgColor": "#b4b4b4ff", + "endPoint" : "FlashPointDark_Image", + "hasEp" : true + }, + { + "type": "UIImageView", + "id": "FlashPoint_Image", + "x": 1431, + "y": 336, + "w": 80, + "h": 25, + "resPath": "/resources/images/progress/", + "filePrefix": "flash_", + "imgCnt" : 22, + "updInterval": 10 + }, + { + "type": "UIImageView", + "id": "FlashPointDark_Image", + "x": 1431, + "y": 336, + "w": 160, + "h": 51, + "resPath": "/resources/images/progress/", + "filePrefix": "dark_flash_", + "imgCnt" : 22, + "updInterval": 10 + } + ] +} \ No newline at end of file diff --git a/device_board_phytium/common/updater_resources/phytium/string/string.json b/device_board_phytium/common/updater_resources/phytium/string/string.json new file mode 100644 index 0000000000000000000000000000000000000000..201d42079ef60b85d2cb4ce7df4a60fa32ffbb32 --- /dev/null +++ b/device_board_phytium/common/updater_resources/phytium/string/string.json @@ -0,0 +1,164 @@ +{ + "LABEL_UPDATE_FROM_SDCARD": { + "type": "UIString", + "zh":"SD卡升级", + "en":"Update via SD card", + "spa":"" + }, + "LABEL_REBOOT_DEVICE": { + "type": "UIString", + "zh":"重启设备", + "en":"Restart", + "spa":"" + }, + "LABEL_USER_DATA_RESET": { + "type": "UIString", + "zh":"恢复出厂设置", + "en":"Factory reset", + "spa":"" + }, + "LABEL_CLEAR_CACHE": { + "type": "UIString", + "zh":"", + "en":"", + "spa":"" + }, + "LABEL_REBOOT": { + "type": "UIString", + "zh":"重新启动", + "en":"Restart", + "spa":"" + }, + "LABEL_SAFE_MODE": { + "type": "UIString", + "zh":"", + "en":"", + "spa":"" + }, + "LABEL_SHUTDOWN": { + "type": "UIString", + "zh":"关机", + "en":"Power off", + "spa":"" + }, + "LABEL_MENU_TITLE" : { + "type": "UIString", + "zh":"系统恢复", + "en":"System recovery", + "spa":"" + }, + "LABEL_MENU_USAGE" : { + "type": "UIString", + "zh":"", + "en":"", + "spa":"" + }, + "LABEL_RESET_INFORM" : { + "type": "UIString", + "zh":"恢复完成之后用户数据将清除,请确认是否恢复出厂设置?", + "en":"", + "spa":"" + }, + "LABEL_RESET_CONFIRM_TITLE" : { + "type": "UIString", + "zh":"重要提醒", + "en":"Important", + "spa":"" + }, + "LABEL_UPD_FAIL_TIP": { + "type": "UIString", + "zh":"升级失败", + "en":"Software install failed", + "spa":"" + }, + "LABEL_UPD_OK_REBOOT" : { + "type": "UIString", + "zh":"设备将自动重启", + "en":"The device will restart", + "spa":"" + }, + "LABEL_UPD_OK_SHUTDOWN" : { + "type": "UIString", + "zh":"设备将自动关机", + "en":"The device will poweroff", + "spa":"" + }, + "LABEL_UPD_FAIL_REBOOT" : { + "type": "UIString", + "zh":"重启设备", + "en":"Restart", + "spa":"" + }, + "LABEL_UPD_SDCARD_INFO" : { + "type": "UIString", + "zh":"SD卡升级 请勿重启", + "en":"Updating via SD card. Do not restart the device", + "spa":"" + }, + "LABEL_RESET_PROGRESS_INFO" : { + "type": "UIString", + "zh":"工厂级恢复出厂设置...", + "en":"Factory reset...", + "spa":"" + }, + "LABEL_NOTE_CANCEL" : { + "type": "UIString", + "zh":"取消", + "en":"Go back", + "spa":"" + }, + "LABEL_UPD_OK_DONE" : { + "type": "UIString", + "zh":"升级完成", + "en":"", + "spa":"" + }, + "LABEL_UPD_INFO" : { + "type": "UIString", + "zh":"正在更新 请勿重启", + "en":"Updating...Please don't restart", + "spa":"" + }, + "LOGRES_VERIFY_FAILED" : { + "type": "UIString", + "zh":"校验失败", + "en":"Verification failed", + "spa":"" + }, + "LOGRES_UPDATE_FAILED" : { + "type": "UIString", + "zh":"升级失败", + "en":"Software install failed", + "spa":"" + }, + "LOGRES_WIPE_FINISH" : { + "type": "UIString", + "zh":"恢复出厂设置成功!", + "en":"Reset successful!", + "spa":"" + }, + "LOG_CLEAR_CAHCE" : { + "type": "UIString", + "zh":"", + "en":"", + "spa":"" + }, + "LOG_WIPE_FAIL" : { + "type": "UIString", + "zh":"恢复出厂设置失败", + "en":"Reset failed", + "spa":"" + }, + "LABEL_RETURN_TO_MAIN" : { + "type": "UIString", + "zh":"返回主界面", + "en":"Back to main screen", + "spa":"" + }, + "DEFAULT_STRING" : { + "type": "UIString", + "zh":"*", + "en":"*", + "spa":"" + } +} diff --git a/device_board_phytium/common/wifi/rtw8821/BUILD.gn b/device_board_phytium/common/wifi/rtw8821/BUILD.gn new file mode 100755 index 0000000000000000000000000000000000000000..05138bfeb77502342e93ae5d237bb307391325d5 --- /dev/null +++ b/device_board_phytium/common/wifi/rtw8821/BUILD.gn @@ -0,0 +1,28 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//build/ohos.gni") + +ohos_prebuilt_shared_library("rtw8821c_fw.bin") { + source = "rtw8821c_fw.bin" + install_images = [ "ramdisk" ] + module_install_dir = "lib/firmware/rtw88" + part_name = "device_${device_name}" + install_enable = true +} + +group("rtw88") { + deps = [ + ":rtw8821c_fw.bin", + ] +} diff --git a/device_board_phytium/common/wifi/rtw8821/rtw8821c_fw.bin b/device_board_phytium/common/wifi/rtw8821/rtw8821c_fw.bin new file mode 100644 index 0000000000000000000000000000000000000000..9beeb38c4bfb767aed5584ade886bc18e0fd61a0 Binary files /dev/null and b/device_board_phytium/common/wifi/rtw8821/rtw8821c_fw.bin differ diff --git a/device_board_phytium/phytiumpi-firefly/BUILD.gn b/device_board_phytium/phytiumpi-firefly/BUILD.gn new file mode 100755 index 0000000000000000000000000000000000000000..e4d8389cf28753bb5214f95b38fb2b3e6a9ab56a --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/BUILD.gn @@ -0,0 +1,28 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//build/ohos.gni") + +print("${device_name}_group in") +group("${device_name}_group") { + deps = [ + "cfg:init_configs", + "//device/board/phytium/common/distributedhardware:distributedhardware", + "//device/board/phytium/common/build_kernel:build_kernel", + "//device/board/phytium/common/wifi/rtw8821:rtw88", + "//vendor/phytium/gpu_model/sw:gpu_group", + "//device/soc/phytium/common/hardware/display:display_buffer_model", + "//device/soc/phytium/common/hardware/display:display_composer_model", + "updater:updater_files", + ] +} diff --git a/device_board_phytium/phytiumpi-firefly/cfg/BUILD.gn b/device_board_phytium/phytiumpi-firefly/cfg/BUILD.gn new file mode 100755 index 0000000000000000000000000000000000000000..2058346f68b9109b5afdb1c23b9b3dee9a1a744b --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/cfg/BUILD.gn @@ -0,0 +1,63 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//build/ohos.gni") + +ohos_prebuilt_etc("init.${device_name}.cfg") { + source = "init.${device_name}.cfg" + part_name = "device_${device_name}" + install_images = [ chipset_base_dir ] + install_enable = true +} + +ohos_prebuilt_etc("init.${device_name}.usb.cfg") { + source = "init.${device_name}.usb.cfg" + part_name = "device_${device_name}" + install_images = [ chipset_base_dir ] + install_enable = true +} + +ohos_prebuilt_etc("fstab.${device_name}") { + source = "fstab.${device_name}" + part_name = "device_${device_name}" + install_images = [ vendor_base_dir ] + install_enable = true +} + +if (enable_ramdisk) { + ohos_prebuilt_etc("fstab.required") { + source = "fstab.required" + part_name = "device_${device_name}" + install_enable = true + install_images = [ + "ramdisk", + ] + } +} else { + ohos_prebuilt_etc("fstab.required") { + source = "fstab.required" + part_name = "device_${device_name}" + install_images = [ "system" ] + install_enable = true + } +} + + +group("init_configs") { + deps = [ + ":fstab.required", + ":fstab.${device_name}", + ":init.${device_name}.cfg", + ":init.${device_name}.usb.cfg", + ] +} diff --git a/device_board_phytium/phytiumpi-firefly/cfg/fstab.phytiumpi-firefly b/device_board_phytium/phytiumpi-firefly/cfg/fstab.phytiumpi-firefly new file mode 100755 index 0000000000000000000000000000000000000000..e85bd39cc41f2bef8e01d1be1a645b0ecab1ba7f --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/cfg/fstab.phytiumpi-firefly @@ -0,0 +1,18 @@ +# fstab file. +# + +#SATA hard disk and USB disk config +#/dev/block/sda2 /usr ext4 ro,barrier=1 wait,required +#/dev/block/sda3 /vendor ext4 ro,barrier=1 wait,required +#/dev/block/sda4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 + +#NVME disk config +#/dev/block/nvme0n1p2 /usr ext4 ro,barrier=1 wait,required +#/dev/block/nvme0n1p3 /vendor ext4 ro,barrier=1 wait,required +#/dev/block/nvme0n1p4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 + +#SD card config +/dev/block/mmcblk0p2 /usr ext4 ro,barrier=1 wait,required +/dev/block/mmcblk0p3 /vendor ext4 ro,barrier=1 wait,required +/dev/block/mmcblk0p4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 +/dev/block/mmcblk0p5 /misc ext4 none wait,required \ No newline at end of file diff --git a/device_board_phytium/phytiumpi-firefly/cfg/fstab.required b/device_board_phytium/phytiumpi-firefly/cfg/fstab.required new file mode 100755 index 0000000000000000000000000000000000000000..1f7a1c5fe1854c47899a5b28a913d2dbfbd03163 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/cfg/fstab.required @@ -0,0 +1,17 @@ +# fstab file. +# + +#SATA hard disk and USB disk config +#/dev/block/sda2 /usr ext4 ro,barrier=1 wait,required +#/dev/block/sda3 /vendor ext4 ro,barrier=1 wait,required +#/dev/block/sda4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 + +#NVME disk config +#/dev/block/nvme0n1p2 /usr ext4 ro,barrier=1 wait,required +#/dev/block/nvme0n1p3 /vendor ext4 ro,barrier=1 wait,required +#/dev/block/nvme0n1p4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 + +#SD card config +/dev/block/mmcblk0p2 /usr ext4 ro,barrier=1 wait,required +/dev/block/mmcblk0p3 /vendor ext4 ro,barrier=1 wait,required +/dev/block/mmcblk0p4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 diff --git a/device_board_phytium/phytiumpi-firefly/cfg/init.phytiumpi-firefly.cfg b/device_board_phytium/phytiumpi-firefly/cfg/init.phytiumpi-firefly.cfg new file mode 100755 index 0000000000000000000000000000000000000000..dd3c6c923973b5545c2a26dd8304a4f89006e58d --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/cfg/init.phytiumpi-firefly.cfg @@ -0,0 +1,59 @@ +{ + "import" : [ + "init.${ohos.boot.hardware}.usb.cfg" + ], + "jobs" : [{ + "name" : "pre-init", + "cmds" : [ + "write /proc/sys/vm/min_free_kbytes 10240", + "mount debugfs /sys/kernel/debug /sys/kernel/debug mode=755", + "write /sys/kernel/debug/hisi_inno_phy/role peripheral", + "export GST_OMX_CONFIG_DIR /system/lib64/media/plugins/", + "insmod /system/lib64/media/plugins/img_mem.ko", + "insmod /system/lib64/media/plugins/vxd.ko" + ] + }, { + "name" : "init", + "cmds" : [ + "write /proc/1/oom_score_adj -1000", + "write /proc/sys/kernel/hung_task_timeout_secs 90", + "write /sys/kernel/hungtask/enable on", + "write /sys/kernel/hungtask/monitorlist whitelist,init,appspawn", + "symlink /dev/block/platform/soc/28000000.mmc/ /dev/block/by-name", + "chown system system /sys/kernel/hungtask/userlist", + "chmod 0666 /dev/pvr_sync", + "chmod 0666 /dev/vxd0", + "chmod 0666 /dev/dri/card1" + ] + }, { + "name" : "boot", + "cmds" : [ + "chmod 777 /dev/ttyAMA2", + "chmod 0440 /proc/interrupts", + "chmod 0440 /proc/stat", + "chown system graphics /dev/graphics/fb0", + "start ispserver", + "setparam persist.hdc.mode tcp", + "setparam persist.hdc.port 8710", + "setparam persist.hdc.root 1", + "setparam persist.hdc.mode.tcp enable", + "setparam const.security.developermode.state true" + ] + }, { + "name" : "post-fs-data", + "cmds" : [ + "copy /system/etc/gpu_cur /data/system/gpu_cur", + "chown system system /data/system/gpu_cur", + "chmod 0664 /data/system/gpu_cur", + "restorecon", + "restorecon /data/updater" + ] + } + ], + "services" : [{ + "name" : "ispserver", + "path" : ["/vendor/bin/ispserver"], + "once" : 1 + } + ] +} diff --git a/device_board_phytium/phytiumpi-firefly/cfg/init.phytiumpi-firefly.usb.cfg b/device_board_phytium/phytiumpi-firefly/cfg/init.phytiumpi-firefly.usb.cfg new file mode 100755 index 0000000000000000000000000000000000000000..59cfed979d50933639ab0decb72600ab2ecaa3d6 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/cfg/init.phytiumpi-firefly.usb.cfg @@ -0,0 +1,51 @@ +{ + "jobs" : [{ + "name" : "boot", + "cmds" : [ + "mkdir /dev/usb-ffs 0770 shell shell", + "mkdir /dev/usb-ffs/hdc 0770 shell shell", + "mount configfs none /config", + "mkdir /config/usb_gadget/g1 0770 shell shell", + "write /config/usb_gadget/g1/idVendor 0x2207", + "write /config/usb_gadget/g1/idProduct 0x0018", + "write /config/usb_gadget/g1/os_desc/use 1", + "write /config/usb_gadget/g1/bcdDevice 0x0223", + "write /config/usb_gadget/g1/bcdUSB 0x0200", + "mkdir /config/usb_gadget/g1/strings/0x409 0770", + "copy /sys/block/mmcblk0/device/cid /config/usb_gadget/g1/strings/0x409/serialnumber", + "write /config/usb_gadget/g1/strings/0x409/manufacturer Phytium", + "write /config/usb_gadget/g1/strings/0x409/product \"HDC Device\"", + "mkdir /config/usb_gadget/g1/functions/ffs.hdc", + "mkdir /config/usb_gadget/g1/configs/b.1 0770 shell shell", + "mkdir /config/usb_gadget/g1/configs/b.1/strings/0x409 0770 shell shell", + "write /config/usb_gadget/g1/os_desc/b_vendor_code 0x1", + "write /config/usb_gadget/g1/os_desc/qw_sign MSFT100", + "write /config/usb_gadget/g1/configs/b.1/MaxPower 500", + "symlink /config/usb_gadget/g1/configs/b.1 /config/usb_gadget/g1/os_desc/b.1", + "mount functionfs hdc /dev/usb-ffs/hdc uid=2000,gid=2000", + "setparam sys.usb.configfs 1", + "setparam sys.usb.controller fcc00000.dwc3" + ] + }, { + "name" : "param:sys.usb.config=none && param:sys.usb.configfs=1", + "condition" : "sys.usb.config=none && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/os_desc/use 0", + "setparam sys.usb.ffs.ready 0" + ] + }, { + "name" : "param:init.svc.hdcd=stopped", + "condition" : "init.svc.hdcd=stopped", + "cmds" : [ + "setparam sys.usb.ffs.ready 0" + ] + }, { + "name" : "param:sys.usb.config=hdc && param:sys.usb.configfs=1", + "condition" : "sys.usb.config=hdc && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/idProduct 0x5000", + "write /config/usb_gadget/g1/os_desc/use 1" + ] + } + ] +} diff --git a/device_board_phytium/phytiumpi-firefly/device.gni b/device_board_phytium/phytiumpi-firefly/device.gni new file mode 100755 index 0000000000000000000000000000000000000000..0982a035eda655fbd945d651f1cd79aedcaf4a89 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/device.gni @@ -0,0 +1,24 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +soc_company = "phytium" +soc_name = "phytiumpi" + +import("//device/soc/${soc_company}/${soc_name}/soc.gni") + +import("//build/ohos.gni") +if (!defined(defines)) { + defines = [] +} + + diff --git a/device_board_phytium/phytiumpi-firefly/dts/Makefile b/device_board_phytium/phytiumpi-firefly/dts/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..7555a24ec6d4b9e7bdf46621c7a6aeb0e3f1ff40 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/dts/Makefile @@ -0,0 +1,5 @@ +dtb-$(CONFIG_ARCH_PHYTIUM) += phytiumpi_firefly.dtb + +always := $(dtb-y) +subdir-y := $(dts-dirs) +clean-files := *.dtb \ No newline at end of file diff --git a/device_board_phytium/phytiumpi-firefly/dts/pe2204.dtsi b/device_board_phytium/phytiumpi-firefly/dts/pe2204.dtsi new file mode 100644 index 0000000000000000000000000000000000000000..5d8f2d6fffee3f6292e2af81e742f086690cb5c6 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/dts/pe2204.dtsi @@ -0,0 +1,276 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * dts file for Phytium Pe2204 SoC + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +#include "pe220x.dtsi" +#include + +/ { + compatible = "phytium,pe2204"; + + aliases { + ethernet0 = &macb0; + ethernet1 = &macb1; + ethernet2 = &macb2; + ethernet3 = &macb3; + }; +}; + +&thermal_zones { + sensor0 { + trips { + threshod: trip-point@0 { + temperature = <75000>; + hysteresis = <0>; + type = "passive"; + }; + target: trip-point@1 { + temperature = <90000>; + hysteresis = <0>; + type = "passive"; + }; + cpu_crit: cpu_crit { + temperature = <100000>; + hysteresis = <2000>; + type = "critical"; + }; + }; + + cooling-maps { + map0 { + trip = <&target>; + cooling-device = + <&cpu_l0 THERMAL_NO_LIMIT THERMAL_NO_LIMIT>, + <&cpu_b0 THERMAL_NO_LIMIT THERMAL_NO_LIMIT>; + }; + }; + }; + + sensor1 { + trips { + threshod1: trip-point@0 { + temperature = <75000>; + hysteresis = <0>; + type = "passive"; + }; + target1: trip-point@1 { + temperature = <90000>; + hysteresis = <0>; + type = "passive"; + }; + cpu_crit1: cpu_crit { + temperature = <100000>; + hysteresis = <2000>; + type = "critical"; + }; + }; + }; +}; + +&cpu { + cpu-map { + cluster0 { + core0 { + cpu = <&cpu_l0>; + }; + + core1 { + cpu = <&cpu_l1>; + }; + }; + + cluster1 { + core0 { + cpu = <&cpu_b0>; + }; + }; + + cluster2 { + core0 { + cpu = <&cpu_b1>; + }; + }; + }; + + cpu_l0: cpu@0 { + device_type = "cpu"; + compatible = "phytium,ftc310", "arm,armv8"; + reg = <0x0 0x200>; + enable-method = "psci"; + clocks = <&scmi_dvfs 2>; + #cooling-cells = <2>; + capacity-dmips-mhz = <2850>; + }; + + cpu_l1: cpu@1 { + device_type = "cpu"; + compatible = "phytium,ftc310", "arm,armv8"; + reg = <0x0 0x201>; + enable-method = "psci"; + clocks = <&scmi_dvfs 2>; + capacity-dmips-mhz = <2850>; + }; + + cpu_b0: cpu@100 { + device_type = "cpu"; + compatible = "phytium,ftc664", "arm,armv8"; + reg = <0x0 0x0>; + enable-method = "psci"; + clocks = <&scmi_dvfs 0>; + #cooling-cells = <2>; + capacity-dmips-mhz = <5660>; + }; + + cpu_b1: cpu@101 { + device_type = "cpu"; + compatible = "phytium,ftc664", "arm,armv8"; + reg = <0x0 0x100>; + enable-method = "psci"; + clocks = <&scmi_dvfs 1>; + capacity-dmips-mhz = <5660>; + }; +}; + +&soc { + hda0: hda@28006000 { + compatible = "phytium,hda"; + reg = <0x0 0x28006000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + i2s0: i2s@28009000 { + compatible = "phytium,i2s"; + reg = <0x0 0x28009000 0x0 0x1000>, + <0x0 0x28005000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_600mhz>; + clock-names = "i2s_clk"; + status = "disabled"; + }; + + can0: can@2800a000 { + compatible = "phytium,canfd"; + reg = <0x0 0x2800a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_200mhz>; + clock-names = "can_clk"; + tx-fifo-depth = <64>; + rx-fifo-depth = <64>; + status = "disabled"; + }; + + can1: can@2800b000 { + compatible = "phytium,canfd"; + reg = <0x0 0x2800b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_200mhz>; + clock-names = "can_clk"; + tx-fifo-depth = <64>; + rx-fifo-depth = <64>; + status = "disabled"; + }; + + keypad: keypad@2807a000 { + compatible = "phytium,keypad"; + reg = <0x0 0x2807a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + usb3_0: usb3@31a08000 { + compatible = "phytium,pe220x-xhci"; + reg = <0x0 0x31a08000 0x0 0x18000>; + interrupts = ; + status = "disabled"; + }; + + usb3_1: usb3@31a28000 { + compatible = "phytium,pe220x-xhci"; + reg = <0x0 0x31a28000 0x0 0x18000>; + interrupts = ; + status = "disabled"; + }; + + sata0: sata@31a40000 { + compatible = "generic-ahci"; + reg = <0x0 0x31a40000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + sata1: sata@32014000 { + compatible = "generic-ahci"; + reg = <0x0 0x32014000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + macb0: ethernet@3200c000 { + compatible = "cdns,phytium-gem"; + reg = <0x0 0x3200c000 0x0 0x2000>; + interrupts = , + , + , + , + , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + support-tsn; + status = "disabled"; + }; + + macb1: ethernet@3200e000 { + compatible = "cdns,phytium-gem"; + reg = <0x0 0x3200e000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + status = "disabled"; + }; + + macb2: ethernet@32010000 { + compatible = "cdns,phytium-gem"; + reg = <0x0 0x32010000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + status = "disabled"; + }; + + macb3: ethernet@32012000 { + compatible = "cdns,phytium-gem"; + reg = <0x0 0x32012000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + status = "disabled"; + }; + + vpu0: vpu@32b00000 { + compatible = "phytium,vpu"; + reg = <0x0 0x32b00000 0x0 0x20000>; + interrupts = ; + status = "disabled"; + }; +}; diff --git a/device_board_phytium/phytiumpi-firefly/dts/pe220x.dtsi b/device_board_phytium/phytiumpi-firefly/dts/pe220x.dtsi new file mode 100644 index 0000000000000000000000000000000000000000..ad6a1846315d34b630b67a51632046a02d5a2451 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/dts/pe220x.dtsi @@ -0,0 +1,1012 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * dts file for Phytium Pe220x SoC + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include + +/ { + compatible = "phytium,pe220x"; + interrupt-parent = <&gic>; + #address-cells = <2>; + #size-cells = <2>; + + aliases { + serial0 = &uart0; + serial1 = &uart1; + serial2 = &uart2; + serial3 = &uart3; + }; + + psci { + compatible = "arm,psci-1.0"; + method = "smc"; + cpu_suspend = <0xc4000001>; + cpu_off = <0x84000002>; + cpu_on = <0xc4000003>; + sys_poweroff = <0x84000008>; + sys_reset = <0x84000009>; + }; + + firmware { + scmi: scmi { + compatible = "arm,scmi"; + mboxes = <&mbox 0>; + mbox-names = "tx"; + shmem = <&cpu_scp_hpri>; + #address-cells = <1>; + #size-cells = <0>; + + scmi_dvfs: protocol@13 { + reg = <0x13>; + #clock-cells = <1>; + }; + + scmi_sensors0: protocol@15 { + reg = <0x15>; + #thermal-sensor-cells = <1>; + }; + }; + optee { + compatible = "linaro,optee-tz"; + method = "smc"; + }; + }; + + thermal_zones: thermal-zones { + sensor0 { + polling-delay-passive = <100>; + polling-delay = <1000>; + thermal-sensors = <&scmi_sensors0 0>; + }; + + sensor1 { + polling-delay-passive = <100>; + polling-delay = <1000>; + thermal-sensors = <&scmi_sensors0 1>; + }; + }; + + cpu: cpus { + #address-cells = <0x2>; + #size-cells = <0x0>; + }; + + gic: interrupt-controller@30800000 { + compatible = "arm,gic-v3"; + #interrupt-cells = <3>; + #address-cells = <2>; + #size-cells = <2>; + ranges; + interrupt-controller; + reg = <0x0 0x30800000 0 0x20000>, /* GICD */ + <0x0 0x30880000 0 0x80000>, /* GICR */ + <0x0 0x30840000 0 0x10000>, /* GICC */ + <0x0 0x30850000 0 0x10000>, /* GICH */ + <0x0 0x30860000 0 0x10000>; /* GICV */ + interrupts = ; + + its: gic-its@30820000 { + compatible = "arm,gic-v3-its"; + msi-controller; + reg = <0x0 0x30820000 0x0 0x20000>; + }; + }; + + pmu { + compatible = "arm,armv8-pmuv3"; + interrupts = ; + }; + + timer { + compatible = "arm,armv8-timer"; + interrupts = , + , + , + ; + clock-frequency = <50000000>; + }; + + clocks { + #address-cells = <2>; + #size-cells = <2>; + ranges; + + sysclk_48mhz: clk48mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <48000000>; + }; + + sysclk_50mhz: clk50mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <50000000>; + }; + + sysclk_100mhz: clk100mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <100000000>; + }; + + sysclk_200mhz: clk200mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <200000000>; + }; + + sysclk_250mhz: clk250mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <250000000>; + }; + + sysclk_300mhz: clk300mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <300000000>; + }; + + sysclk_600mhz: clk600mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <600000000>; + }; + + sysclk_1200mhz: clk1200mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <1200000000>; + }; + }; + + smmu: iommu@30000000 { + compatible = "arm,smmu-v3"; + reg = <0x0 0x30000000 0x0 0x800000>; + interrupts = , + , + , + ; + interrupt-names = "eventq", "priq", "cmdq-sync", "gerror"; + dma-coherent; + #iommu-cells = <1>; + }; + + soc: soc { + compatible = "simple-bus"; + #address-cells = <2>; + #size-cells = <2>; + dma-coherent; + ranges; + + mmc0: mmc@28000000 { + compatible = "phytium,mci"; + reg = <0x0 0x28000000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_1200mhz>; + clock-names = "phytium_mci_clk"; + status = "disabled"; + }; + + mmc1: mmc@28001000 { + compatible = "phytium,mci"; + reg = <0x0 0x28001000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_1200mhz>; + clock-names = "phytium_mci_clk"; + status = "disabled"; + }; + + nand0: nand@28002000 { + compatible = "phytium,nfc"; + reg = <0x0 0x28002000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + qspi0: spi@28008000 { + compatible = "phytium,qspi-nor"; + reg = <0x0 0x28008000 0x0 0x1000>, + <0x0 0x0 0x0 0x0fffffff>; + reg-names = "qspi", "qspi_mm"; + clocks = <&sysclk_300mhz>; + status = "disabled"; + + #address-cells = <1>; + #size-cells = <0>; + + flash@0 { + compatible = "jedec,spi-nor"; + reg = <0x00>; + spi-rx-bus-width = <1>; + spi-max-frequency = <20000000>; + }; + }; + + uart0: uart@2800c000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2800c000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz &sysclk_100mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "disabled"; + }; + + uart1: uart@2800d000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2800d000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz &sysclk_100mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "disabled"; + }; + + uart2: uart@2800e000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2800e000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz &sysclk_100mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "disabled"; + }; + + uart3: uart@2800f000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2800f000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz &sysclk_100mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "disabled"; + }; + + ddma0: dma-controller@28003000 { + compatible = "phytium,ddma"; + reg = <0x0 0x28003000 0x0 0x1000>; + interrupts = ; + #dma-cells = <2>; + dma-channels = <8>; + }; + + ddma1: dma-controller@28004000 { + compatible = "phytium,ddma"; + reg = <0x0 0x28004000 0x0 0x1000>; + interrupts = ; + #dma-cells = <2>; + dma-channels = <8>; + }; + + lpc: lpc@28010000 { + compatible = "simple-mfd", "syscon"; + reg = <0x0 0x28010000 0x0 0x1000>; + reg-io-width = <4>; + + #address-cells = <1>; + #size-cells = <1>; + ranges = <0x0 0x0 0x28010000 0x1000>; + + kcs0: kcs@24 { + compatible = "phytium,kcs-bmc"; + reg = <0x24 0x1>, <0x30 0x1>, <0x3c 0x1>; + interrupts = ; + status = "disabled"; + }; + + kcs1: kcs@28 { + compatible = "phytium,kcs-bmc"; + reg = <0x28 0x1>, <0x34 0x1>, <0x40 0x1>; + interrupts = ; + status = "disabled"; + }; + + kcs2: kcs@2c { + compatible = "phytium,kcs-bmc"; + reg = <0x2c 0x1>, <0x38 0x1>, <0x44 0x1>; + interrupts = ; + status = "disabled"; + }; + + kcs3: kcs@8c { + compatible = "phytium,kcs-bmc"; + reg = <0x8c 0x1>, <0x90 0x1>, <0x94 0x1>; + interrupts = ; + status = "disabled"; + }; + + bt: bt@48 { + compatible = "phytium,bt-bmc"; + reg = <0x48 0x20>; + interrupts = ; + status = "disabled"; + }; + }; + + /* MIO */ + + gpio0: gpio@28034000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28034000 0x0 0x1000>; + interrupts = , + , + , + , + , + , + , + , + , + , + , + , + , + , + , + ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + gpio1: gpio@28035000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28035000 0x0 0x1000>; + interrupts = , + , + , + , + , + , + , + , + , + , + , + , + , + , + , + ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + gpio2: gpio@28036000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28036000 0x0 0x1000>; + interrupts = , + , + , + , + , + , + , + , + , + , + , + , + , + , + , + ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + gpio3: gpio@28037000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28037000 0x0 0x1000>; + interrupts = ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + gpio4: gpio@28038000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28038000 0x0 0x1000>; + interrupts = ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + gpio5: gpio@28039000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28039000 0x0 0x1000>; + interrupts = ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + spi0: spi@2803a000 { + compatible = "phytium,spi"; + reg = <0x0 0x2803a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + num-cs = <4>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + }; + + spi1: spi@2803b000 { + compatible = "phytium,spi"; + reg = <0x0 0x2803b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + num-cs = <4>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + }; + + spi2: spi@2803c000 { + compatible = "phytium,spi"; + reg = <0x0 0x2803c000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + num-cs = <4>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + }; + + spi3: spi@2803d000 { + compatible = "phytium,spi"; + reg = <0x0 0x2803d000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + num-cs = <4>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + }; + + watchdog0: watchdog@28040000 { + compatible = "arm,sbsa-gwdt"; + reg = <0x0 0x28041000 0x0 0x1000>, + <0x0 0x28040000 0x0 0x1000>; + interrupts = ; + timeout-sec = <30>; + status = "disabled"; + }; + + watchdog1: watchdog@28042000 { + compatible = "arm,sbsa-gwdt"; + reg = <0x0 0x28043000 0x0 0x1000>, + <0x0 0x28042000 0x0 0x1000>; + interrupts = ; + timeout-sec = <30>; + status = "disabled"; + }; + + pwm0: pwm@2804a000 { + compatible = "phytium,pwm"; + reg = <0x0 0x2804a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + pwm1: pwm@2804b000 { + compatible = "phytium,pwm"; + reg = <0x0 0x2804b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + tacho0: tacho@28054000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28054000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho1: tacho@28055000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28055000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho2: tacho@28056000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28056000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho3: tacho@28057000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28057000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho4: tacho@28058000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28058000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho5: tacho@28059000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28059000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho6: tacho@2805a000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho7: tacho@2805b000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho8: tacho@2805c000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805c000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho9: tacho@2805d000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805d000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho10: tacho@2805e000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805e000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho11: tacho@2805f000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805f000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho12: tacho@28060000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28060000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho13: tacho@28061000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28061000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho14: tacho@28062000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28062000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho15: tacho@28063000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28063000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho16: tacho@28064000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28064000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho17: tacho@28065000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28065000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho18: tacho@28066000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28066000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho19: tacho@28067000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28067000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho20: tacho@28068000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28068000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho21: tacho@28069000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28069000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho22: tacho@2806a000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho23: tacho@2806b000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho24: tacho@2806c000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806c000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho25: tacho@2806d000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806d000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho26: tacho@2806e000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806e000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho27: tacho@2806f000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806f000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho28: tacho@28070000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28070000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho29: tacho@28071000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28071000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho30: tacho@28072000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28072000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho31: tacho@28073000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28073000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho32: tacho@28074000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28074000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho33: tacho@28075000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28075000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho34: tacho@28076000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28076000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho35: tacho@28077000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28077000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho36: tacho@28078000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28078000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho37: tacho@28079000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28079000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + usb2_0: usb2@31800000 { + compatible = "phytium,usb2"; + reg = <0x0 0x31800000 0x0 0x80000>, + <0x0 0x31990000 0x0 0x10000>; + interrupts = ; + status = "disabled"; + }; + + usb2_1: usb2@31880000 { + compatible = "phytium,usb2"; + reg = <0x0 0x31880000 0x0 0x80000>, + <0x0 0x319a0000 0x0 0x10000>; + interrupts = ; + status = "disabled"; + }; + + usb2_2: usb2@31900000 { + compatible = "phytium,usb2"; + reg = <0x0 0x31900000 0x0 0x80000>, + <0x0 0x319b0000 0x0 0x10000>; + interrupts = ; + status = "disabled"; + }; + + usb2_3: usb2@32800000 { + compatible = "phytium,usb2"; + reg = <0x0 0x32800000 0x0 0x40000>, + <0x0 0x32880000 0x0 0x40000>; + interrupts = ; + status = "disabled"; + }; + + usb2_4: usb2@32840000 { + compatible = "phytium,usb2"; + reg = <0x0 0x32840000 0x0 0x40000>, + <0x0 0x328c0000 0x0 0x40000>; + interrupts = ; + status = "disabled"; + }; + + dc0: dc@32000000 { + compatible = "phytium,dc"; + reg = <0x0 0x32000000 0x0 0x8000>; + interrupts = ; + status = "disabled"; + }; + + i2s_dp0: i2s_dp0@32009000 { + compatible = "phytium,i2s"; + reg = <0x0 0x32009000 0x0 0x1000>, + <0x0 0x32008000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_600mhz>; + clock-names = "i2s_clk"; + dai-name = "phytium-i2s-dp0"; + status = "disabled"; + }; + + i2s_dp1: i2s_dp1@3200B000 { + compatible = "phytium,i2s"; + reg = <0x0 0x3200B000 0x0 0x1000>, + <0x0 0x3200A000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_600mhz>; + clock-names = "i2s_clk"; + dai-name = "phytium-i2s-dp1"; + status = "disabled"; + }; + + pmdk_dp: pmdk_dp { + compatible = "phytium,pmdk-dp"; + status = "disabled"; + }; + + mbox: mailbox@32a00000 { + compatible = "phytium,mbox"; + reg = <0x0 0x32a00000 0x0 0x1000>; + interrupts = ; + #mbox-cells = <1>; + }; + + rng0: rng@32a36000 { + compatible = "phytium,rng"; + reg = <0x0 0x32a36000 0x0 0x1000>; + status = "disabled"; + }; + + sram: sram@32a10000 { + compatible = "phytium,pe220x-sram-ns", "mmio-sram"; + reg = <0x0 0x32a10000 0x0 0x2000>; + + #address-cells = <1>; + #size-cells = <1>; + ranges = <0x0 0x0 0x32a10000 0x2000>; + + cpu_scp_lpri: scp-shmem@0 { + compatible = "arm,scmi-shmem"; + reg = <0x1000 0x400>; + }; + + cpu_scp_hpri: scp-shmem@1 { + compatible = "arm,scmi-shmem"; + reg = <0x1400 0x400>; + }; + }; + + edac: edac@32b28000 { + compatible = "phytium,pe220x-edac"; + reg = <0x0 0x32b28000 0x0 0x1000>, + <0x0 0x31400000 0x0 0x1000>, + <0x0 0x31401000 0x0 0x1000>; + interrupts = , + ; + status = "disabled"; + }; + + gdma: gdma@32b34000 { + compatible = "phytium,gdma"; + dma-channels = <16>; + max-outstanding = <16>; + reg = <0x0 0x32b34000 0x0 0x1000>; + interrupts = ; + #dma-cells = <1>; + }; + + hwspinlock: spinlock@32b36000 { + compatible = "phytium,hwspinlock"; + reg = <0x0 0x32b36000 0x0 0x1000>; + #hwlock-cells = <1>; + nr-locks = <32>; + status = "disabled"; + }; + + pcie: pcie@40000000 { + compatible = "pci-host-ecam-generic"; + device_type = "pci"; + #address-cells = <3>; + #size-cells = <2>; + #interrupt-cells = <1>; + reg = <0x0 0x40000000 0x0 0x10000000>; + msi-parent = <&its>; + bus-range = <0x0 0xff>; + interrupt-map-mask = <0x0 0x0 0x0 0x7>; + interrupt-map = + <0x0 0x0 0x0 0x1 &gic 0x0 0x0 GIC_SPI 4 IRQ_TYPE_LEVEL_HIGH>, + <0x0 0x0 0x0 0x2 &gic 0x0 0x0 GIC_SPI 5 IRQ_TYPE_LEVEL_HIGH>, + <0x0 0x0 0x0 0x3 &gic 0x0 0x0 GIC_SPI 6 IRQ_TYPE_LEVEL_HIGH>, + <0x0 0x0 0x0 0x4 &gic 0x0 0x0 GIC_SPI 7 IRQ_TYPE_LEVEL_HIGH>; + ranges = <0x01000000 0x00 0x00000000 0x0 0x50000000 0x0 0x00f00000>, + <0x02000000 0x00 0x58000000 0x0 0x58000000 0x0 0x28000000>, + <0x03000000 0x10 0x00000000 0x10 0x00000000 0x10 0x00000000>; + iommu-map = <0x0 &smmu 0x0 0x10000>; + status = "disabled"; + }; + }; +}; diff --git a/device_board_phytium/phytiumpi-firefly/dts/phytiumpi_firefly.dts b/device_board_phytium/phytiumpi-firefly/dts/phytiumpi_firefly.dts new file mode 100644 index 0000000000000000000000000000000000000000..3da250486d101bf685873ecf989c4e888178f6ff --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/dts/phytiumpi_firefly.dts @@ -0,0 +1,323 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pi development board. + * + * Copyright (c) 2023-2024 Phytium Technology Co., Ltd. + * + * Shaojun Yang + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2204.dtsi" +#include "dt-bindings/gpio/gpio.h" + +/{ + model = "Phytium Pi Board"; + compatible = "phytium,pe2204"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + aliases { + serial4 = &mio0; + serial5 = &mio11; + serial6 = &mio15; + }; + + memory@0{ + device_type = "memory"; + reg = <0x0 0x80000000 0x2 0x00000000>; + }; + + leds { + compatible = "gpio-leds"; + sysled { + label = "sysled"; + gpios = <&gpio1 5 0>; + linux,default-trigger = "none"; + }; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + simple-audio-card,pin-switches = "mic-in"; + simple-audio-card,widgets = + "Microphone","mic-in", + "Headphone","Headphones"; + simple-audio-card,routing = "MIC2","mic-in"; + simple-audio-card,hp-det-gpio = <&gpio2 11 GPIO_ACTIVE_LOW>; + + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + simple-audio-card,codec{ + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + codec0: es8336@10 { + #sound-dai-cells = <0>; + compatible = "everest,es8336"; + reg = <0x10>; + }; + }; + + + mio0: uart@28014000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28014000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio1: i2c@28016000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28016000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + }; + + mio8: i2c@28024000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28024000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + }; + + mio11: uart@2802A000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x2802A000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio15: uart@28032000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28032000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; +}; + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; + +&watchdog0 { + status = "okay"; +}; + +&watchdog1 { + status = "okay"; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "peripheral"; + status = "disabled"; +}; + +&usb2_2 { + dr_mode = "peripheral"; + status = "disabled"; +}; + +&usb2_3 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_4 { + dr_mode = "host"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb1 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&dc0 { + pipe_mask = /bits/ 8 <0x1>; + edp_mask = /bits/ 8 <0x0>; + status = "okay"; +}; + +&i2s0 { + #sound-dai-cells = <0>; + dai-name = "phytium-i2s-lsd"; + status = "okay"; +}; + +&i2s_dp0 { + dai-name = "phytium-i2s-dp0"; + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi0 { + global-cs = <1>; + status = "okay"; + + spidev0: spidev@0 { + compatible = "spidev"; + reg = <0>; + spi-max-frequency = <50000000>; + status = "disabled"; + }; +}; + +&mmc0 { + bus-width = <0x00000004>; + max-frequency = <50000000>; + cap-sdio-irq; + cap-sd-highspeed; + no-mmc; + status = "okay"; +}; + +&mmc1 { + bus-width = <0x00000004>; + max-frequency = <25000000>; + cap-sdio-irq; + cap-sd-highspeed; + no-mmc; + no-sd; + non-removable; + status = "okay"; +}; + +&pwm0 { + phytium,db = <0 0 100 1000 1000 0>; + status = "okay"; +}; + +&pwm1 { + phytium,db = <0 0 100 1000 1000 0>; + status = "okay"; +}; + +&uart0 { + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&uart3 { + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&pmdk_dp { + num-dp = <1>; + dp-mask = /bits/ 8 <0x1>; + status = "okay"; +}; + +&rng0 { + status = "okay"; +}; + +&vpu0 { + status = "okay"; +}; diff --git a/device_board_phytium/phytiumpi-firefly/loader/EFI/BOOT/bootaa64.efi b/device_board_phytium/phytiumpi-firefly/loader/EFI/BOOT/bootaa64.efi new file mode 100755 index 0000000000000000000000000000000000000000..1a7f4e5294da5ee58b6077d5e4736a7b1494d4f3 Binary files /dev/null and b/device_board_phytium/phytiumpi-firefly/loader/EFI/BOOT/bootaa64.efi differ diff --git a/device_board_phytium/phytiumpi-firefly/loader/EFI/BOOT/grub.cfg b/device_board_phytium/phytiumpi-firefly/loader/EFI/BOOT/grub.cfg new file mode 100755 index 0000000000000000000000000000000000000000..e10dc85c10cbdf7e9f91d4c6c1cd3138efb22f71 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/loader/EFI/BOOT/grub.cfg @@ -0,0 +1,15 @@ +# Automatically created by OE +serial --unit=0 --speed=115200 --word=8 --parity=no --stop=1 +search --no-floppy --set=root -l 'boot' +default="OpenHarmony" +timeout=3 + +menuentry 'OpenHarmony'{ +linux /Image LABEL=boot root=/dev/ram0 hardware=phytiumpi_firefly selinux=0 rootfstype=ext4 loglevel=1 +initrd /ramdisk.img +} + +menuentry 'Updater'{ +linux /Image LABEL=boot root=/dev/ram0 selinux=0 rootfstype=ext4 loglevel=1 +initrd /updater.img +} diff --git a/device_board_phytium/phytiumpi-firefly/ohos.build b/device_board_phytium/phytiumpi-firefly/ohos.build new file mode 100755 index 0000000000000000000000000000000000000000..777c47eb31a19c8f77ae220dffc7ff6c42febeec --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/ohos.build @@ -0,0 +1,10 @@ +{ + "subsystem": "phytium_products", + "parts": { + "device_phytiumpi-firefly": { + "module_list": [ + "//device/board/phytium/${device_name}:${device_name}_group" + ] + } + } +} diff --git a/device_board_phytium/phytiumpi-firefly/updater/BUILD.gn b/device_board_phytium/phytiumpi-firefly/updater/BUILD.gn new file mode 100644 index 0000000000000000000000000000000000000000..34c3bd7f7f5b045b0011948e8bb07462ed339d77 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/updater/BUILD.gn @@ -0,0 +1,76 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//build/ohos.gni") +partname="device_${device_name}" +updater_ueventd_cfg = "//base/startup/init/services/etc/ueventd.cfg" + +ohos_prebuilt_etc("updater_ueventd.cfg") { + source = "${updater_ueventd_cfg}" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("updater_init.cfg") { + source = "config/init.cfg" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("updater_init_usb.cfg") { + source = "config/init.usb.cfg" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("signing_cert.crt") { + source = "config/signing_cert.crt" + module_install_dir = "etc/certificate" + install_images = [ + "system", + "updater", + ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("fstab.updater") { + source = "config/fstab.updater" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("hdc_network.sh") { + source = "config/hdc_network.sh" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_executable("busybox") { + source = "config/busybox" + module_install_dir = "bin" + install_enable = true + install_images = [ "updater" ] + part_name = "${partname}" +} + +group("updater_files") { + deps = [ + ":fstab.updater", + ":signing_cert.crt", + ":updater_init.cfg", + ":updater_init_usb.cfg", + ":updater_ueventd.cfg", + ":hdc_network.sh", + ":busybox", + ] +} diff --git a/device_board_phytium/phytiumpi-firefly/updater/config/busybox b/device_board_phytium/phytiumpi-firefly/updater/config/busybox new file mode 100644 index 0000000000000000000000000000000000000000..e26fb0d1643035461592c2da824cc163e6d03f77 Binary files /dev/null and b/device_board_phytium/phytiumpi-firefly/updater/config/busybox differ diff --git a/device_board_phytium/phytiumpi-firefly/updater/config/fstab.updater b/device_board_phytium/phytiumpi-firefly/updater/config/fstab.updater new file mode 100644 index 0000000000000000000000000000000000000000..3eed6a0d16548c27b231cf569b660d61cade2e1f --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/updater/config/fstab.updater @@ -0,0 +1,6 @@ +#SD card config +/dev/block/mmcblk0p2 /usr ext4 ro,barrier=1 wait +/dev/block/mmcblk0p3 /vendor ext4 ro,barrier=1 wait +/dev/block/mmcblk0p4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 +/dev/block/mmcblk0p5 /misc none none wait +/dev/block/mmcblk0p6 /sdcard ext4 rw wait \ No newline at end of file diff --git a/device_board_phytium/phytiumpi-firefly/updater/config/hdc_network.sh b/device_board_phytium/phytiumpi-firefly/updater/config/hdc_network.sh new file mode 100644 index 0000000000000000000000000000000000000000..97f4d087c2f93f1ec8cf5fef528aea632af7802a --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/updater/config/hdc_network.sh @@ -0,0 +1,26 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +#!/bin/bash +mkdir /mnt +chmod a+x /bin/busybox + +echo 0 99999999 | tee /proc/sys/net/ipv4/ping_group_range #放宽ICMP权限 +ifconfig eth0 192.168.3.128 #配置ip,示例使用的是路由器。如果不是路由器,手动配置还需添加网关、子网掩码 + +param set const.security.developermode.state true +param set persist.hdc.port 8710 +param set persist.hdc.mode.tcp enable + +sleep 5 #等待hdc服务重启 +hdcd -t #使能tcp功能 \ No newline at end of file diff --git a/device_board_phytium/phytiumpi-firefly/updater/config/init.cfg b/device_board_phytium/phytiumpi-firefly/updater/config/init.cfg new file mode 100644 index 0000000000000000000000000000000000000000..28449ed2db8c2dcc78be2fe116cc068ffd1eea57 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/updater/config/init.cfg @@ -0,0 +1,37 @@ +{ + "import" : [ + "/etc/ueventd.cfg", + "/etc/updater_common.cfg", + "/etc/init.usb.cfg" + ], + "jobs" : [{ + "name" : "pre-init", + "cmds" : [ + "start ueventd" + ] + }, { + "name" : "init", + "cmds" : [ + "exec /bin/sh /etc/hdc_network.sh", + "wait /dev/block/platform/soc/28000000.mmc", + "symlink /dev/block/mmcblk0p5 /dev/block/by-name/misc" + ] + }, { + "name" : "post-fs-data", + "cmds" : [ + "exec /system/bin/hilog -w start -n 10 -f updater", + "exec /system/bin/hilog -w start -t kmsg -f updater_kmsg" + ] + } + ], + "services" : [{ + "name" : "updater", + "path" : ["/bin/updater"], + "uid" : 0, + "gid" : [0, "update", "input_user_host", "shell", "graphics", "system"], + "importance" : 0, + "secon" : "u:r:updater:s0", + "caps" : [0, 1] + } + ] +} diff --git a/device_board_phytium/phytiumpi-firefly/updater/config/init.usb.cfg b/device_board_phytium/phytiumpi-firefly/updater/config/init.usb.cfg new file mode 100644 index 0000000000000000000000000000000000000000..8db2d7a0b1a0276d7fc2083e25e46a49d65d90b2 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/updater/config/init.usb.cfg @@ -0,0 +1,74 @@ +{ + "jobs" : [{ + "name" : "boot", + "cmds" : [ + "mkdir /config 0770 shell shell", + "mkdir /dev/usb-ffs 0770 shell shell", + "mkdir /dev/usb-ffs/hdc 0770 shell shell", + "mount configfs none /config", + "mkdir /config/usb_gadget/g1 0770 shell shell", + "write /config/usb_gadget/g1/idVendor 0x2207", + "write /config/usb_gadget/g1/idProduct 0x0018", + "write /config/usb_gadget/g1/os_desc/use 1", + "write /config/usb_gadget/g1/bcdDevice 0x0223", + "write /config/usb_gadget/g1/bcdUSB 0x0200", + "mkdir /config/usb_gadget/g1/strings/0x409 0770", + "copy /sys/block/mmcblk0/device/cid /config/usb_gadget/g1/strings/0x409/serialnumber", + "write /config/usb_gadget/g1/strings/0x409/manufacturer Rockchip", + "write /config/usb_gadget/g1/strings/0x409/product \"HDC Device\"", + "mkdir /config/usb_gadget/g1/functions/ffs.hdc", + "mkdir /config/usb_gadget/g1/configs/b.1 0770 shell shell", + "mkdir /config/usb_gadget/g1/configs/b.1/strings/0x409 0770 shell shell", + "write /config/usb_gadget/g1/os_desc/b_vendor_code 0x1", + "write /config/usb_gadget/g1/os_desc/qw_sign MSFT100", + "write /config/usb_gadget/g1/configs/b.1/MaxPower 500", + "symlink /config/usb_gadget/g1/configs/b.1 /config/usb_gadget/g1/os_desc/b.1", + "mount functionfs hdc /dev/usb-ffs/hdc uid=2000,gid=2000", + "setparam sys.usb.configfs 1", + "setparam sys.usb.controller fcc00000.dwc3" + ] + }, { + "name" : "param:sys.usb.config=none && param:sys.usb.configfs=1", + "condition" : "sys.usb.config=none && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/os_desc/use 0", + "setparam sys.usb.ffs.ready 0" + ] + }, { + "name" : "param:init.svc.hdcd=stopped", + "condition" : "init.svc.hdcd=stopped", + "cmds" : [ + "setparam sys.usb.ffs.ready 0" + ] + }, { + "name" : "param:updater.hdc.configfs=1", + "condition" : "updater.hdc.configfs=1", + "cmds" : [ + "setparam sys.usb.config hdc" + ] + }, { + "name" : "param:updater.flashd.configfs=1", + "condition" : "updater.flashd.configfs=1", + "cmds" : [ + "stop hdcd", + "setparam sys.usb.config flashd" + ] + }, { + "name" : "param:sys.usb.ffs.ready=1 && param:sys.usb.config=flashd && param:sys.usb.configfs=1", + "condition" : "sys.usb.ffs.ready=1 && sys.usb.config=flashd && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/configs/b.1/strings/0x409/configuration hdc", + "symlink /config/usb_gadget/g1/functions/ffs.hdc /config/usb_gadget/g1/configs/b.1/f1", + "write /config/usb_gadget/g1/UDC ${sys.usb.controller}", + "setparam sys.usb.state ${sys.usb.config}" + ] + }, { + "name" : "param:sys.usb.config=hdc && param:sys.usb.configfs=1", + "condition" : "sys.usb.config=hdc && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/idProduct 0x5000", + "write /config/usb_gadget/g1/os_desc/use 1" + ] + } + ] +} diff --git a/device_board_phytium/phytiumpi-firefly/updater/config/lastword.sh b/device_board_phytium/phytiumpi-firefly/updater/config/lastword.sh new file mode 100644 index 0000000000000000000000000000000000000000..eec6883eae463a8102d0039b514b2109cad726d5 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/updater/config/lastword.sh @@ -0,0 +1,32 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. +mkdir /backdata +mount /dev/block/by-name/userdata /backdata + +if [ -d "/backdata/updater/log/faultlog" ]; +then + rm -rf /backdata/updater/log/faultlog/* + cp /data/log/faultlog/temp/cpp* /backdata/updater/log/faultlog +else + mkdir /backdata/updater/log/faultlog + cp /data/log/faultlog/temp/cpp* /backdata/updater/log/faultlog +fi + +if [ -d "/backdata/updater/log/hilog" ]; +then + rm -rf /backdata/updater/log/hilog/* + cp /data/log/hilog/updater* /backdata/updater/log/hilog +else + mkdir /backdata/updater/log/hilog + cp /data/log/hilog/updater* /backdata/updater/log/hilog +fi diff --git a/device_board_phytium/phytiumpi-firefly/updater/config/signing_cert.crt b/device_board_phytium/phytiumpi-firefly/updater/config/signing_cert.crt new file mode 100644 index 0000000000000000000000000000000000000000..eca5d72cea8e87bc4b41f4e85570e32fbc23f69e --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/updater/config/signing_cert.crt @@ -0,0 +1,21 @@ +-----BEGIN CERTIFICATE----- +MIIDazCCAlOgAwIBAgIUDbbfN0ry6xlKrFyylM9asKzjANYwDQYJKoZIhvcNAQEL +BQAwRTELMAkGA1UEBhMCQVUxEzARBgNVBAgMClNvbWUtU3RhdGUxITAfBgNVBAoM +GEludGVybmV0IFdpZGdpdHMgUHR5IEx0ZDAeFw0yMTAyMjUxMjA2MTNaFw0yMjAy +MjUxMjA2MTNaMEUxCzAJBgNVBAYTAkFVMRMwEQYDVQQIDApTb21lLVN0YXRlMSEw +HwYDVQQKDBhJbnRlcm5ldCBXaWRnaXRzIFB0eSBMdGQwggEiMA0GCSqGSIb3DQEB +AQUAA4IBDwAwggEKAoIBAQDj1JSf1YKWT/CEZtUtVzyiXgWJK3+PDkRnxP09UWJi +KsB/gKZHT9sFmGUaIe18VI54fB52caF1sNU9v11mX9r1LCG4I+GFBUgKd7xG+rOA +kWyCk7kIHFbXGykz8cO7P1zmA4ue7X51/cQBKy/nrGHqEfUs57lCQYQDlA9n1ahG +U4lo/lOd1n4ESKHgg+BCzBGUJEWnH8h2K/yCLhuD1nGYnwJUy6xI8cabrh2+WSf4 +tJn0oyG+FYVJkAW1wcr2HPnnBDAyuE34sKNVkD4w9S9pTUv5xPRkOH6rEfQxC4vX +BuCR3Vsd9gJS77wParQ8t+Th3qdxlG+OIKFqVfmDaZUtAgMBAAGjUzBRMB0GA1Ud +DgQWBBQR55YSUMEzkyqHQKGQ51bBcqbvazAfBgNVHSMEGDAWgBQR55YSUMEzkyqH +QKGQ51bBcqbvazAPBgNVHRMBAf8EBTADAQH/MA0GCSqGSIb3DQEBCwUAA4IBAQBy +30XquNfGVCOlXBaJJ/gyl5TP0nFZ9iQ9P0Tk6Ya6tN+Nh4lqA4uG1rUqPrQCd0+N +DUnJlwdto8E2fznfJQ0ojkQdlPv3zkqW25QSYTb9wegQ6CnWq2ANnvoXPcSebHXE +yXcEXybgaWkBg3h8VHcwVns5psXSDsprisFGyETBwMIqM15Z81bEpejKz2viW5ow ++c3ToGs8VhymfG3Pbls3nFeFYSD/A4sOOzM+O/ioG4YI6cGfSBztrAShtdvadHL6 +Cbp6X36ZSveGOkfS/Yrq4z/yE2V0kCJXBMo+9SrhxUrwACjMDIdE5YLlw9qpkLQV +t5MJhDWJe6tCRSBSmoA4 +-----END CERTIFICATE----- diff --git a/device_board_phytium/phytiumpi-firefly/updater/updater_ramdisk_resource_config.ini b/device_board_phytium/phytiumpi-firefly/updater/updater_ramdisk_resource_config.ini new file mode 100644 index 0000000000000000000000000000000000000000..83356235ad9a9eedbc53c562d72c6b3aa8fd9766 --- /dev/null +++ b/device_board_phytium/phytiumpi-firefly/updater/updater_ramdisk_resource_config.ini @@ -0,0 +1,5 @@ +# current path: "out/ohos-arm-release/" +# Modification and deletion of section name is not allowed + +[board] +boot_type = two_stages diff --git a/device_board_phytium/tenglong_e/BUILD.gn b/device_board_phytium/tenglong_e/BUILD.gn index 80729e5a6dad02b3e748c8e0b064c5acb275cd0d..db555e5dfe16dc39dc3978e7ffeb55bdfcb547b5 100755 --- a/device_board_phytium/tenglong_e/BUILD.gn +++ b/device_board_phytium/tenglong_e/BUILD.gn @@ -19,8 +19,12 @@ group("${device_name}_group") { "cfg:init_configs", "//device/board/phytium/common/distributedhardware:distributedhardware", "//device/board/phytium/common/build_kernel:build_kernel", - "//vendor/phytium/gpu_model/$gpu_model:gpu_group", + "//vendor/phytium/gpu_model/x100:gpu_group", + "//vendor/phytium/gpu_model/jm:gpu_group", + "//vendor/phytium/gpu_model/amd:gpu_group", + "//vendor/phytium/gpu_model/sw:gpu_group", "//device/soc/phytium/common/hardware/display:display_buffer_model", "//device/soc/phytium/common/hardware/display:display_composer_model", + "updater:updater_files", ] } diff --git a/device_board_phytium/tenglong_e/audio_alsa/alc662_common.h b/device_board_phytium/tenglong_e/audio_alsa/alc662_common.h deleted file mode 100755 index 53912d6cdb92bc1ff5acf40ea56f721feebca3af..0000000000000000000000000000000000000000 --- a/device_board_phytium/tenglong_e/audio_alsa/alc662_common.h +++ /dev/null @@ -1,68 +0,0 @@ -/* - * Copyright (c) 2024 Phyitum Technology Co., Ltd. - * Licensed under the Apache License, Version 2.0 (the "License"); - * you may not use this file except in compliance with the License. - * You may obtain a copy of the License at - * - * http://www.apache.org/licenses/LICENSE-2.0 - * - * Unless required by applicable law or agreed to in writing, software - * distributed under the License is distributed on an "AS IS" BASIS, - * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. - * See the License for the specific language governing permissions and - * limitations under the License. - */ - -#ifndef ALSA_SND_COMMON_H -#define ALSA_SND_COMMON_H - -/* AUDIO CODEC ALC662 amxier definitions */ - -/* SND playback path */ -#define SND_NUMID_MASTER_PLAYBACK_SWICH 31 -#define SND_ELEM_MASTER_PLAYBACK_SWICH "Master Playback Switch" -#define SND_OUT_CARD_ON "on" -#define SND_OUT_CARD_OFF "off" - -/* SND Master Playback Volume */ -#define SND_NUMID_MASTER_PLAYBACK_VOLUME 30 -#define SND_ELEM_MASTER_PLAYBACK_VOLUME "Master Playback Volume" -#define SND_OUT_PLAYBACK_DEFAULT_VOLUME "77" /* min:0 max:87 77=0.6*max */ - -/* SND Front Playback Switch */ -#define SND_NUMID_FRONT_PLAYBACK_SWITCH 3 -#define SND_ELEM_FRONT_PLAYBACK_SWITCH "Front Playback Switch" -#define SND_OUT_CARD_DACR_DACL_ON "on,on" -#define SND_OUT_CARD_DACR_DACL_OFF "off,off" - -/* Front Playback Volume */ -#define SND_NUMID_FRONT_PLAYBACK_VOLUME 2 -#define SND_ELEM_FRONT_PLAYBACK_VOLUME "Front Playback Volume" -#define SND_OUT_FRONT_PLAYBACK_DEFAULT_VOLUME "87" /* min:0 max:87 */ - - -/* Capture Intput Source Path */ -#define SND_NUMID_INPUT_SOURCE 19 -#define SND_ELEM_INPUT_SOURCE "Input Source" -#define SND_IN_CARD_FRONT_MIC "0" /* Front Mic */ -#define SND_IN_CARD_REAR_MIC "1" /* Rear Mic */ -#define SND_IN_CARD_LINE "2" /* Line */ - -/* Capture Input Switch */ -#define SND_NUMID_CAPTURE_SWITCH 22 -#define SND_ELEM_CAPTURE_SWITCH "Capture Switch" -#define SND_IN_CAPTURE_SWITCH_ON "on,on" -#define SND_IN_CAPTURE_SWITCH_OFF "off,off" - -/* cature Volume */ -#define SND_NUMID_CAPTURE_VOLUME 21 -#define SND_ELEM_CAPTURE_VOLUME "Capture Volume" -#define SND_IN_CAPTURE_DEFAULT_VOLUME "58" /* min:0, max:63 */ - -/* Front Playback Volume */ -#define SND_NUMID_REAR_MIC_BOOST_VOLUME 26 -#define SND_ELEM_REAR_MIC_BOOST_VOLUME "Rear Mic Boost Volume" -#define SND_IN_REAR_MIC_BOOST_DEFAULT_VOLUME "1,1" /* min:0,0 max:3,3 step:1,1 */ - - -#endif /* ALSA_SND_COMMON_H */ diff --git a/device_board_phytium/tenglong_e/audio_alsa/common.h b/device_board_phytium/tenglong_e/audio_alsa/common.h deleted file mode 100755 index e489fc535c5a2820a10af302d5c776e69b256d01..0000000000000000000000000000000000000000 --- a/device_board_phytium/tenglong_e/audio_alsa/common.h +++ /dev/null @@ -1,68 +0,0 @@ -/* - * Copyright (c) 2024 Phyitum Technology Co., Ltd. - * Licensed under the Apache License, Version 2.0 (the "License"); - * you may not use this file except in compliance with the License. - * You may obtain a copy of the License at - * - * http://www.apache.org/licenses/LICENSE-2.0 - * - * Unless required by applicable law or agreed to in writing, software - * distributed under the License is distributed on an "AS IS" BASIS, - * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. - * See the License for the specific language governing permissions and - * limitations under the License. - */ - -#ifndef ALSA_SND_COMMON_H -#define ALSA_SND_COMMON_H - -/* AUDIO CODEC ALC897 amxier definitions */ - -/* SND playback path */ -#define SND_NUMID_MASTER_PLAYBACK_SWICH 36 -#define SND_ELEM_MASTER_PLAYBACK_SWICH "Master Playback Switch" -#define SND_OUT_CARD_ON "on" -#define SND_OUT_CARD_OFF "off" - -/* SND Master Playback Volume */ -#define SND_NUMID_MASTER_PLAYBACK_VOLUME 35 -#define SND_ELEM_MASTER_PLAYBACK_VOLUME "Master Playback Volume" -#define SND_OUT_PLAYBACK_DEFAULT_VOLUME "77" /* min:0 max:87 77=0.6*max */ - -/* SND Front Playback Switch */ -#define SND_NUMID_FRONT_PLAYBACK_SWITCH 2 -#define SND_ELEM_FRONT_PLAYBACK_SWITCH "Front Playback Switch" -#define SND_OUT_CARD_DACR_DACL_ON "on,on" -#define SND_OUT_CARD_DACR_DACL_OFF "off,off" - -/* Front Playback Volume */ -#define SND_NUMID_FRONT_PLAYBACK_VOLUME 1 -#define SND_ELEM_FRONT_PLAYBACK_VOLUME "Front Playback Volume" -#define SND_OUT_FRONT_PLAYBACK_DEFAULT_VOLUME "87" /* min:0 max:87 */ - - -/* Capture Intput Source Path */ -#define SND_NUMID_INPUT_SOURCE 21 -#define SND_ELEM_INPUT_SOURCE "Input Source" -#define SND_IN_CARD_FRONT_MIC "0" /* Front Mic */ -#define SND_IN_CARD_REAR_MIC "1" /* Rear Mic */ -#define SND_IN_CARD_LINE "2" /* Line */ - -/* Capture Input Switch */ -#define SND_NUMID_CAPTURE_SWITCH 24 -#define SND_ELEM_CAPTURE_SWITCH "Capture Switch" -#define SND_IN_CAPTURE_SWITCH_ON "on,on" -#define SND_IN_CAPTURE_SWITCH_OFF "off,off" - -/* cature Volume */ -#define SND_NUMID_CAPTURE_VOLUME 23 -#define SND_ELEM_CAPTURE_VOLUME "Capture Volume" -#define SND_IN_CAPTURE_DEFAULT_VOLUME "58" /* min:0, max:63 */ - -/* MIC Boost Volume */ -#define SND_NUMID_REAR_MIC_BOOST_VOLUME 28 -#define SND_ELEM_REAR_MIC_BOOST_VOLUME "Rear Mic Boost Volume" -#define SND_IN_REAR_MIC_BOOST_DEFAULT_VOLUME "1,1" /* min:0,0 max:3,3 step:1,1 */ - - -#endif /* ALSA_SND_COMMON_H */ diff --git a/device_board_phytium/tenglong_e/audio_alsa/vendor_capture.c b/device_board_phytium/tenglong_e/audio_alsa/vendor_capture.c deleted file mode 100755 index 364b9e167351552af7f61b0a1821f884a605fd28..0000000000000000000000000000000000000000 --- a/device_board_phytium/tenglong_e/audio_alsa/vendor_capture.c +++ /dev/null @@ -1,224 +0,0 @@ -/* - * Copyright (c) 2024 Phyitum Technology Co., Ltd. - * Licensed under the Apache License, Version 2.0 (the "License"); - * you may not use this file except in compliance with the License. - * You may obtain a copy of the License at - * - * http://www.apache.org/licenses/LICENSE-2.0 - * - * Unless required by applicable law or agreed to in writing, software - * distributed under the License is distributed on an "AS IS" BASIS, - * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. - * See the License for the specific language governing permissions and - * limitations under the License. - */ - -#include "alsa_snd_capture.h" -#include "common.h" - -#define HDF_LOG_TAG HDF_AUDIO_HAL_CAPTURE - -typedef struct _CAPTURE_DATA_ { - struct AlsaMixerCtlElement ctrlVolume; - long tempVolume; -}CaptureData; - -static int32_t CaptureInitImpl(struct AlsaCapture* captureIns) -{ - struct AlsaMixerCtlElement mixerItem; - if (captureIns->priData != NULL) { - return HDF_SUCCESS; - } - CHECK_NULL_PTR_RETURN_DEFAULT(captureIns); - - CaptureData *priData = (CaptureData *)OsalMemCalloc(sizeof(CaptureData)); - if (priData == NULL) { - AUDIO_FUNC_LOGE("Failed to allocate memory!"); - return HDF_FAILURE; - } - - SndElementItemInit(&priData->ctrlVolume); - priData->ctrlVolume.numid = SND_NUMID_CAPTURE_VOLUME; - priData->ctrlVolume.name = SND_ELEM_CAPTURE_VOLUME; - CaptureSetPriData(captureIns, (CapturePriData)priData); - - SndElementItemInit(&mixerItem); - mixerItem.numid = SND_NUMID_INPUT_SOURCE; - mixerItem.name = SND_ELEM_INPUT_SOURCE; - mixerItem.value = SND_IN_CARD_REAR_MIC; - SndElementWrite(&captureIns->soundCard, &mixerItem); - - SndElementItemInit(&mixerItem); - mixerItem.numid = SND_NUMID_REAR_MIC_BOOST_VOLUME; - mixerItem.name = SND_ELEM_REAR_MIC_BOOST_VOLUME; - mixerItem.value = SND_IN_REAR_MIC_BOOST_DEFAULT_VOLUME; - SndElementWrite(&captureIns->soundCard, &mixerItem); - - AUDIO_FUNC_LOGI("CaptureInitImpl init success!!!"); - - return HDF_SUCCESS; -} - -static int32_t CaptureSelectSceneImpl(struct AlsaCapture *captureIns, enum AudioPortPin descPins, - const struct PathDeviceInfo *deviceInfo) -{ - return HDF_SUCCESS; -} - -static int32_t CaptureGetVolThresholdImpl(struct AlsaCapture *captureIns, long *volMin, long *volMax) -{ - int32_t ret; - long _volMin = 0; - long _volMax = 0; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)captureIns; - CaptureData *priData = CaptureGetPriData(captureIns); - CHECK_NULL_PTR_RETURN_DEFAULT(cardIns); - CHECK_NULL_PTR_RETURN_DEFAULT(priData); - - ret = SndElementReadRange(cardIns, &priData->ctrlVolume, &_volMin, &_volMax); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("SndElementReadRange fail!"); - return HDF_FAILURE; - } - *volMin = _volMin; - *volMax = _volMax; - - return HDF_SUCCESS; -} - -static int32_t CaptureGetVolumeImpl(struct AlsaCapture *captureIns, long *volume) -{ - int32_t ret; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)captureIns; - CaptureData *priData = CaptureGetPriData(captureIns); - CHECK_NULL_PTR_RETURN_DEFAULT(cardIns); - CHECK_NULL_PTR_RETURN_DEFAULT(priData); - - ret = SndElementReadInt(cardIns, &priData->ctrlVolume, volume); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("Read volume fail!"); - return HDF_FAILURE; - } - AUDIO_FUNC_LOGI("Read volume %ld!!!",*volume); - return HDF_SUCCESS; -} - -static int32_t CaptureSetVolumeImpl(struct AlsaCapture *captureIns, long volume) -{ - int32_t ret; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)captureIns; - CaptureData *priData = CaptureGetPriData(captureIns); - CHECK_NULL_PTR_RETURN_DEFAULT(cardIns); - CHECK_NULL_PTR_RETURN_DEFAULT(priData); - ret = SndElementWriteIntExt(cardIns, &priData->ctrlVolume, volume); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("Write volume fail!"); - return HDF_FAILURE; - } - AUDIO_FUNC_LOGI("Set volume %ld!!!",volume); - return HDF_SUCCESS; -} - -static int32_t CaptureSetMuteImpl(struct AlsaCapture *captureIns, bool muteFlag) -{ - int32_t ret; - long vol, setVol; - CaptureData *priData = CaptureGetPriData(captureIns); - CHECK_NULL_PTR_RETURN_DEFAULT(captureIns); - CHECK_NULL_PTR_RETURN_DEFAULT(priData); - ret = captureIns->GetVolume(captureIns, &vol); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("GetVolume failed!"); - return HDF_FAILURE; - } - - if (muteFlag) { - priData->tempVolume = vol; - setVol = 0; - } else { - setVol = priData->tempVolume; - } - captureIns->SetVolume(captureIns, setVol); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("SetVolume failed!"); - return HDF_FAILURE; - } - captureIns->muteState = muteFlag; - return HDF_SUCCESS; -} - -static int32_t CaptureStartImpl(struct AlsaCapture *captureIns) -{ - struct AlsaMixerCtlElement mixerItem; - CHECK_NULL_PTR_RETURN_DEFAULT(captureIns); - - SndElementItemInit(&mixerItem); - mixerItem.numid = SND_NUMID_CAPTURE_SWITCH; - mixerItem.name = SND_ELEM_CAPTURE_SWITCH; - mixerItem.value = SND_IN_CAPTURE_SWITCH_ON; - SndElementWrite(&captureIns->soundCard, &mixerItem); - - return HDF_SUCCESS; -} - -static int32_t CaptureStopImpl(struct AlsaCapture *captureIns) -{ - struct AlsaMixerCtlElement mixerItem; - CHECK_NULL_PTR_RETURN_DEFAULT(captureIns); - - SndElementItemInit(&mixerItem); - mixerItem.numid = SND_NUMID_CAPTURE_SWITCH; - mixerItem.name = SND_ELEM_CAPTURE_SWITCH; - mixerItem.value = SND_IN_CAPTURE_SWITCH_OFF; - SndElementWrite(&captureIns->soundCard, &mixerItem); - snd_pcm_drop(captureIns->soundCard.pcmHandle); - return HDF_SUCCESS; -} - -static int32_t CaptureGetGainThresholdImpl(struct AlsaCapture *captureIns, float *gainMin, float *gainMax) -{ - AUDIO_FUNC_LOGE("8541e not support gain operation"); - return HDF_SUCCESS; -} - -static int32_t CaptureGetGainImpl(struct AlsaCapture *captureIns, float *volume) -{ - AUDIO_FUNC_LOGE("8541e not support gain operation"); - return HDF_SUCCESS; -} - -static int32_t CaptureSetGainImpl(struct AlsaCapture *captureIns, float volume) -{ - AUDIO_FUNC_LOGE("8541e not support gain operation"); - return HDF_SUCCESS; -} - -static bool CaptureGetMuteImpl(struct AlsaCapture *captureIns) -{ - return captureIns->muteState; -} - -int32_t CaptureOverrideFunc(struct AlsaCapture *captureIns) -{ - if (captureIns == NULL) { - return HDF_FAILURE; - } - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)captureIns; - - if (cardIns->cardType == SND_CARD_PRIMARY) { - captureIns->Init = CaptureInitImpl; - captureIns->SelectScene = CaptureSelectSceneImpl; - captureIns->Start = CaptureStartImpl; - captureIns->Stop = CaptureStopImpl; - captureIns->GetVolThreshold = CaptureGetVolThresholdImpl; - captureIns->GetVolume = CaptureGetVolumeImpl; - captureIns->SetVolume = CaptureSetVolumeImpl; - captureIns->GetGainThreshold = CaptureGetGainThresholdImpl; - captureIns->GetGain = CaptureGetGainImpl; - captureIns->SetGain = CaptureSetGainImpl; - captureIns->GetMute = CaptureGetMuteImpl; - captureIns->SetMute = CaptureSetMuteImpl; - } - - return HDF_SUCCESS; -} diff --git a/device_board_phytium/tenglong_e/cfg/fstab.tenglong_e b/device_board_phytium/tenglong_e/cfg/fstab.tenglong_e index 3d01c257dab9e065e38ab16e90c18124b80bb586..7af15907f721a1541a084ad689e12fa7a330c608 100755 --- a/device_board_phytium/tenglong_e/cfg/fstab.tenglong_e +++ b/device_board_phytium/tenglong_e/cfg/fstab.tenglong_e @@ -5,6 +5,7 @@ /dev/block/sda2 /usr ext4 ro,barrier=1 wait,required /dev/block/sda3 /vendor ext4 ro,barrier=1 wait,required /dev/block/sda4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 +/dev/block/sda5 /misc ext4 none wait,required #NVME disk config #/dev/block/nvme0n1p2 /usr ext4 ro,barrier=1 wait,required diff --git a/device_board_phytium/tenglong_e/cfg/init.tenglong_e.cfg b/device_board_phytium/tenglong_e/cfg/init.tenglong_e.cfg index b84e065d3e97cdba4f1e93634dfcae7ade3fec73..42586573f1965303d5ba5a567a6a380a5560e56d 100755 --- a/device_board_phytium/tenglong_e/cfg/init.tenglong_e.cfg +++ b/device_board_phytium/tenglong_e/cfg/init.tenglong_e.cfg @@ -19,7 +19,7 @@ "write /proc/sys/kernel/hung_task_timeout_secs 90", "write /sys/kernel/hungtask/enable on", "write /sys/kernel/hungtask/monitorlist whitelist,init,appspawn", - "symlink /dev/block/platform/soc/40000000.pcie/by-name /dev/block/by-name", + "symlink /dev/block/platform/soc/32014000.sata/ /dev/block/by-name", "chown system system /sys/kernel/hungtask/userlist", "chmod 0666 /dev/pvr_sync", "chmod 0666 /dev/vxd0", @@ -32,13 +32,21 @@ "chmod 0440 /proc/interrupts", "chmod 0440 /proc/stat", "chown system graphics /dev/graphics/fb0", - "start ispserver" + "start ispserver", + "setparam persist.hdc.mode tcp", + "setparam persist.hdc.port 8710", + "setparam persist.hdc.root 1", + "setparam persist.hdc.mode.tcp enable", + "setparam const.security.developermode.state true" ] }, { "name" : "post-fs-data", "cmds" : [ + "copy /system/etc/gpu_cur /data/system/gpu_cur", + "chown system system /data/system/gpu_cur", + "chmod 0664 /data/system/gpu_cur", "restorecon", - "param set const.security.developermode.state true" + "restorecon /data/updater" ] } ], diff --git a/device_board_phytium/tenglong_e/dts/Makefile b/device_board_phytium/tenglong_e/dts/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..0e31249668539e012182878cb4751c3a591812f6 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/Makefile @@ -0,0 +1,27 @@ +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-demo-ddr4.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-demo-ddr4-nopb.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-demo-ddr4-local.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2202-demo-ddr4.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2202-demo-ddr4-local.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2201-demo-ddr4.dtb + +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-miniitx-board.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2202-miniitx-board.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-vpx-board.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-edu-board.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-come-board.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2202-power-board.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2204-hanwei-board.dtb +dtb-$(CONFIG_ARCH_PHYTIUM) += pe2202-chillipi-edu-board.dtb + +always := $(dtb-y) +subdir-y := $(dts-dirs) +clean-files := *.dtb + +#Enable support for device-tree overlay +DTC_FLAGS_pe2204-come-board += -@ +DTC_FLAGS_pe2204-demo-ddr4 += -@ +DTC_FLAGS_pe2204-edu-board += -@ +DTC_FLAGS_pe2204-hanwei-board += -@ +DTC_FLAGS_pe2204-miniitx-board += -@ +DTC_FLAGS_pe2204-vpx-board += -@ diff --git a/device_board_phytium/tenglong_e/dts/pe2201-demo-ddr4.dts b/device_board_phytium/tenglong_e/dts/pe2201-demo-ddr4.dts new file mode 100644 index 0000000000000000000000000000000000000000..7e8e51fc4180c3afd792780ec931a96ce47f4bc9 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2201-demo-ddr4.dts @@ -0,0 +1,82 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2201 demo board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2201.dtsi" + +/{ + model = "Pe2201 DEMO DDR4"; + compatible = "phytium,pe2201"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0 { + device_type = "memory"; + reg = <0x0 0x80000000 0x0 0x80000000>; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + }; +}; + +&pcie { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_2 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&spi2 { + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&mmc0 { + status = "okay"; +}; + +&mmc1 { + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2201.dtsi b/device_board_phytium/tenglong_e/dts/pe2201.dtsi new file mode 100644 index 0000000000000000000000000000000000000000..ed4b674b317ccbc25260670d3ef80610467f10b8 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2201.dtsi @@ -0,0 +1,284 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * dts file for Phytium Pe2201 SoC + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +#include "pe220x.dtsi" + +/ { + compatible = "phytium,pe2201"; + + aliases { + ethernet0 = &macb0; + ethernet1 = &macb1; + }; +}; + +&cpu { + cpu0: cpu@0 { + device_type = "cpu"; + compatible = "phytium,ftc310", "arm,armv8"; + reg = <0x0 0x200>; + enable-method = "psci"; + clocks = <&scmi_dvfs 2>; + }; +}; + +&soc { + i2c0: i2c@28011000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28011000 0x0 0x1000>; + interrupts = ; + interrupt-names = "smbus_alert"; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + i2c1: i2c@28012000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28012000 0x0 0x1000>; + interrupts = ; + interrupt-names = "smbus_alert"; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + i2c2: i2c@28013000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28013000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + onewire0: onewire@2803f000 { + compatible = "phytium,w1"; + reg = <0x0 0x2803f000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + i3c0: i3c-master@28045000 { + compatible = "phytium,cdns-i3c-master"; + reg = <0x0 0x28045000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz>, <&sysclk_100mhz>; + clock-names = "pclk", "sysclk"; + #address-cells = <1>; + #size-cells = <0>; + i2c-scl-hz = <400000>; + i3c-scl-hz = <1000000>; + status = "disabled"; + }; + + i3c1: i3c-master@28046000 { + compatible = "phytium,cdns-i3c-master"; + reg = <0x0 0x28046000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz>, <&sysclk_100mhz>; + clock-names = "pclk", "sysclk"; + #address-cells = <1>; + #size-cells = <0>; + i2c-scl-hz = <400000>; + i3c-scl-hz = <1000000>; + status = "disabled"; + }; + + i3c2: i3c-master@28047000 { + compatible = "phytium,cdns-i3c-master"; + reg = <0x0 0x28047000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz>, <&sysclk_100mhz>; + clock-names = "pclk", "sysclk"; + #address-cells = <1>; + #size-cells = <0>; + i2c-scl-hz = <400000>; + i3c-scl-hz = <1000000>; + status = "disabled"; + }; + + i3c3: i3c-master@28048000 { + compatible = "phytium,cdns-i3c-master"; + reg = <0x0 0x28048000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz>, <&sysclk_100mhz>; + clock-names = "pclk", "sysclk"; + #address-cells = <1>; + #size-cells = <0>; + i2c-scl-hz = <400000>; + i3c-scl-hz = <1000000>; + status = "disabled"; + }; + + pwm2: pwm@2804c000 { + compatible = "phytium,pwm"; + reg = <0x0 0x2804c000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + pwm3: pwm@2804d000 { + compatible = "phytium,pwm"; + reg = <0x0 0x2804d000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + pwm4: pwm@2804e000 { + compatible = "phytium,pwm"; + reg = <0x0 0x2804e000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + pwm5: pwm@2804f000 { + compatible = "phytium,pwm"; + reg = <0x0 0x2804f000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + pwm6: pwm@28050000 { + compatible = "phytium,pwm"; + reg = <0x0 0x28050000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + pwm7: pwm@28051000 { + compatible = "phytium,pwm"; + reg = <0x0 0x28051000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + adc0: adc@2807b000 { + compatible = "phytium,adc"; + reg = <0x0 0x2807b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + + #address-cells = <1>; + #size-cells = <0>; + + channel@0 { + reg = <0>; + }; + channel@1 { + reg = <1>; + }; + channel@2 { + reg = <2>; + }; + channel@3 { + reg = <3>; + }; + channel@4 { + reg = <4>; + }; + channel@5 { + reg = <5>; + }; + channel@6 { + reg = <6>; + }; + channel@7 { + reg = <7>; + }; + }; + + adc1: adc@2807c000 { + compatible = "phytium,adc"; + reg = <0x0 0x2807c000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + + #address-cells = <1>; + #size-cells = <0>; + + channel@0 { + reg = <0>; + }; + channel@1 { + reg = <1>; + }; + channel@2 { + reg = <2>; + }; + channel@3 { + reg = <3>; + }; + channel@4 { + reg = <4>; + }; + channel@5 { + reg = <5>; + }; + channel@6 { + reg = <6>; + }; + channel@7 { + reg = <7>; + }; + }; + + sgpio: sgpio@2807d000 { + compatible = "phytium,sgpio"; + reg = <0x0 0x2807d000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + ngpios = <96>; + bus-frequency = <48000>; + gpio-controller; + #gpio-cells = <2>; + status = "disabled"; + }; + + macb0: ethernet@32010000 { + compatible = "cdns,phytium-gem-1.0"; + reg = <0x0 0x32010000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + status = "disabled"; + }; + + macb1: ethernet@32012000 { + compatible = "cdns,phytium-gem-1.0"; + reg = <0x0 0x32012000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + status = "disabled"; + }; + + jpeg0: jpeg@32b32000 { + compatible = "phytium,jpeg"; + reg = <0x0 0x32b32000 0 0x1000>, + <0x0 0x28072000 0 0x30>, + <0x0 0x28073000 0 0x30>; + interrupts = , + , + ; + phytium,ocm-buf-addr = <0x30c40000 0x30c60000>; + status = "disabled"; + }; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2202-chillipi-edu-board.dts b/device_board_phytium/tenglong_e/dts/pe2202-chillipi-edu-board.dts new file mode 100644 index 0000000000000000000000000000000000000000..e358e7c2393d304467b9031bfb8e8e40a4f7a95b --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2202-chillipi-edu-board.dts @@ -0,0 +1,339 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2202 chillipi education board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + * + * 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. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2202.dtsi" +#include "dt-bindings/gpio/gpio.h" + + +/{ + model = "Pe2202 CHILLIPI EDUCATION BOARD"; + compatible = "phytium,pe2202"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0{ + device_type = "memory"; + reg = <0x0 0x80000000 0x0 0x80000000>; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + simple-audio-card,pin-switches = "mic-in"; + simple-audio-card,widgets = "Microphone","mic-in"; + simple-audio-card,routing = "MIC2","mic-in"; + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + simple-audio-card,codec{ + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio6: i2c@28020000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28020000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + oled@3c { + compatible = "SinoWealth,sh1106"; + reg = <0x3c>; + }; + + pcf8591@48 { + compatible = "philips,pcf8591"; + reg = <0x48>; + }; + }; + + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + /* localized chillipi education board use this rtc device */ + rtc@32 { + compatible = "wave,sd3068"; + reg = <0x32>; + status = "disabled"; + }; + + rtc@68 { + compatible = "dallas,ds1339"; + reg = <0x68>; + status = "disabled"; + }; + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + codec0: es8336@10 { + det-gpios = <&gpio2 5 GPIO_ACTIVE_LOW>; + sel-gpios = <&gpio2 11 GPIO_ACTIVE_LOW>; + #sound-dai-cells = <0>; + compatible = "everest,es8336"; + reg = <0x10>; + status = "disabled"; + }; + }; +}; + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + interrupt-controller; + #interrupt-cells = <2>; + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; + +&watchdog0 { + status = "okay"; +}; + +&watchdog1 { + status = "okay"; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "host"; + status = "disabled"; +}; + +&usb2_2 { + dr_mode = "host"; + status = "disabled"; +}; + +&usb2_3 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_4 { + dr_mode = "host"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +/* + * In chillipi education board, M.2 interface may insert two types of disks: PCIE (nvme protocol) or SATA (ahci protocol), + * so here enable 'sata0' node by default to correspond to the sata drive case. Pin multiplexing exists + * in PCIE2 and SATA0, when used as a boot disk, the BIOS can automatically recognize these two conditions. + */ +&sata0 { + status = "disabled"; +}; + +&sata1 { + status = "disabled"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi0 { + global-cs = <1>; + status = "okay"; + + ILI9488@0 { + compatible = "ilitek,ili9488"; + reg = <0>; + spi-max-frequency = <50000000>; + + rotate = <0>; + fps = <30>; + buswidth = <8>; + regwidth = <8>; + bgr; + reset-gpios = <&gpio0 15 GPIO_ACTIVE_LOW>; + dc-gpios = <&gpio3 2 GPIO_ACTIVE_LOW>; + //cs-gpios = <&gpio3 2 GPIO_ACTIVE_LOW>; + + //backlight = <&backlight>; + debug = <0>; + }; + + ADS7843@1 { + compatible = "ti,ads7843"; + spi-max-frequency = <1000000>; + reg = <1>; + //cs-gpios = <&gpio4 10 GPIO_ACTIVE_LOW>; + interrupt-parent = <&gpio4>; + interrupts = <12 0>; + pendown-gpio = <&gpio4 12 0>; + + ti,x-min = /bits/ 16 <0>; + //ti,x-max = /bits/ 16 <8000>; + ti,x-max = /bits/ 16 <3200>; + ti,y-min = /bits/ 16 <0>; + //ti,y-max = /bits/ 16 <4800>; + ti,y-max = /bits/ 16 <4800>; + ti,x-plate-ohms = /bits/ 16 <40>; + ti,pressure-max = /bits/ 16 <255>; + + wakeup-source; + }; +}; + +&spi2 { + global-cs = <1>; + status = "okay"; + + mpu6500@0 { + compatible = "InvenSense,mpu6500"; + spi-max-frequency = <500000>; + reg = <0>; + spi-cpol; + spi-cpha; + }; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&mmc0 { + bus-width = <0x00000008>; + max-frequency = <100000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + mmc-hs200-1_8v; + no-sdio; + no-sd; + non-removable; + status = "okay"; +}; + +&mmc1 { + bus-width = <0x00000004>; + max-frequency = <50000000>; + cap-sdio-irq; + cap-sd-highspeed; + no-sdio; + no-mmc; + status = "okay"; +}; + +&i2s0 { + #sound-dai-cells = <0>; + status = "okay"; +}; + +&dc0 { + pipe_mask = /bits/ 8 <0x2>; + edp_mask = /bits/ 8 <0x0>; + status = "okay"; +}; + +&i2s_dp1 { + status = "okay"; +}; + +&pmdk_dp { + num-dp = <1>; + dp-mask = /bits/ 8 <0x2>; + status = "okay"; +}; + +&rng0 { + status = "okay"; +}; + +&pwm0 { + phytium,db = <0 0 0 1000 1000 0>; + status = "okay"; +}; + +&pwm1 { + phytium,db = <0 0 0 1000 1000 0>; + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2202-demo-ddr4-local.dts b/device_board_phytium/tenglong_e/dts/pe2202-demo-ddr4-local.dts new file mode 100644 index 0000000000000000000000000000000000000000..0684e91f7b83784cbde989f3ed64a17b620588e3 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2202-demo-ddr4-local.dts @@ -0,0 +1,167 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2202 demo board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2202.dtsi" + +/{ + model = "Pe2202 DEMO LOCAL DDR4"; + compatible = "phytium,pe2202"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0 { + device_type = "memory"; + reg = <0x0 0x80000000 0x0 0x80000000>; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + simple-audio-card,pin-switches = "mic-in"; + simple-audio-card,widgets = "Microphone", "mic-in"; + simple-audio-card,routing = "MIC2", "mic-in"; + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + simple-audio-card,codec { + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + rtc@32 { + compatible = "wave,sd3078"; + reg = <0x32>; + }; + + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + codec0: es8336@10 { + #sound-dai-cells = <0>; + compatible = "everest,es8336"; + reg = <0x10>; + }; + }; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_2 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&spi2 { + dmas = <&ddma0 0 8>, + <&ddma0 1 21>; + dma-names = "tx", "rx"; + status = "okay"; +}; + +&uart1 { + dmas = <&ddma0 2 3>; + dma-names = "tx"; + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&mmc0 { + bus-width = <0x00000008>; + max-frequency = <50000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + no-sdio; + no-sd; + non-removable; + status = "okay"; +}; + +&mmc1 { + bus-width = <0x00000004>; + max-frequency = <50000000>; + cap-sdio-irq; + cap-sd-highspeed; + sd-uhs-sdr25; + no-mmc; + status = "okay"; +}; + +&i2s0 { + #sound-dai-cells = <0>; + status = "okay"; +}; + +&dc0 { + pipe_mask = /bits/ 8 <0x2>; + edp_mask = /bits/ 8 <0x0>; + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2202-demo-ddr4.dts b/device_board_phytium/tenglong_e/dts/pe2202-demo-ddr4.dts new file mode 100644 index 0000000000000000000000000000000000000000..f9dacea116950f721124720ce7d404df91991506 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2202-demo-ddr4.dts @@ -0,0 +1,232 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2202 demo board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2202.dtsi" +#include "dt-bindings/gpio/gpio.h" + +/{ + model = "Pe2202 DEMO DDR4"; + compatible = "phytium,pe2202"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0 { + device_type = "memory"; + reg = <0x0 0x80000000 0x0 0x80000000>; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + simple-audio-card,pin-switches = "mic-in"; + simple-audio-card,widgets = "Microphone", "mic-in"; + simple-audio-card,routing = "MIC2", "mic-in"; + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + simple-audio-card,codec { + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + rtc@68 { + compatible = "dallas,ds1339"; + reg = <0x68>; + }; + + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + codec0: es8336@10 { + det-gpios = <&gpio2 5 GPIO_ACTIVE_LOW>; + sel-gpios = <&gpio2 11 GPIO_ACTIVE_LOW>; + #sound-dai-cells = <0>; + compatible = "everest,es8336"; + reg = <0x10>; + }; + }; +}; + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; + +&watchdog0 { + status = "okay"; +}; + +&watchdog1 { + status = "okay"; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_2 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +/* + * In demo board, M.2 interface may insert two types of disks: PCIE (nvme protocol) or SATA (ahci protocol), + * so here enable 'sata0' node by default to correspond to the sata drive case. Pin multiplexing exists + * in PCIE2 and SATA0, when used as a boot disk, the BIOS can automatically recognize these two conditions. + */ +&sata0 { + status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi2 { + dmas = <&ddma0 0 8>, + <&ddma0 1 21>; + dma-names = "tx", "rx"; + global-cs = <1>; + status = "okay"; +}; + +&uart1 { + dmas = <&ddma0 2 3>; + dma-names = "tx"; + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&mmc0 { + bus-width = <0x00000008>; + max-frequency = <100000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + mmc-hs200-1_8v; + no-sdio; + no-sd; + non-removable; + status = "okay"; +}; + +&mmc1 { + bus-width = <0x00000004>; + max-frequency = <50000000>; + cap-sdio-irq; + cap-sd-highspeed; + no-sdio; + no-mmc; + status = "okay"; +}; + +&i2s0 { + #sound-dai-cells = <0>; + status = "okay"; +}; + +&dc0 { + pipe_mask = /bits/ 8 <0x2>; + edp_mask = /bits/ 8 <0x0>; + status = "okay"; +}; + +&i2s_dp1 { + status = "okay"; +}; + +&pmdk_dp { + num-dp = <1>; + dp-mask = /bits/ 8 <0x2>; + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2202-miniitx-board.dts b/device_board_phytium/tenglong_e/dts/pe2202-miniitx-board.dts new file mode 100644 index 0000000000000000000000000000000000000000..7d06f07cc0fc704672f605393cc5a32883c718bc --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2202-miniitx-board.dts @@ -0,0 +1,296 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2202 miniitx board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + * + * Hongmin Qi + * + * 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. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2202.dtsi" + +/{ + model = "Pe2202 MINIITX Board"; + compatible = "phytium,pe2202"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0{ + device_type = "memory"; + reg = <0x0 0x80000000 0x1 0x00000000>; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + simple-audio-card,codec { + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio0: uart@28014000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28014000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "disabled"; + }; + + mio1: uart@28016000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28016000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "disabled"; + }; + + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + rtc@68 { + compatible = "dallas,ds1339"; + reg = <0x68>; + }; + }; + + mio6: uart@28020000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28020000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio7: uart@28022000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28022000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + codec0: es8336@10 { + det-gpios = <&gpio2 5 0>; + sel-gpios = <&gpio2 6 0>; + #sound-dai-cells = <0>; + compatible = "everest,es8336"; + reg = <0x10>; + mic-src = [20]; + }; + }; + + mio15: uart@28032000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28032000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "otg"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "host"; + status = "disabled"; +}; + +&usb2_2 { + dr_mode = "host"; + status = "disabled"; +}; + +&usb2_3 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_4 { + dr_mode = "host"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb1 { + phy-mode = "sgmii"; + use-mii; + status = "disabled"; +}; + +&macb2 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb3 { + phy-mode = "sgmii"; + use-mii; + status = "disabled"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi0 { + global-cs = <1>; + status = "disabled"; + + flash: w25q128@0 { + compatible = "winbond,w25q128", "jedec,spi-nor"; + spi-tx-bus-width = <1>; + spi-rx-bus-width = <1>; + spi-max-frequency = <12000000>; + reg = <0x00>; + status = "disabled"; + }; +}; + +&spi2 { + global-cs = <1>; + status = "disabled"; +}; + +&spi3 { + global-cs = <1>; + status = "disabled"; +}; + +&mmc0 { + status = "okay"; + bus-width = <0x4>; + max-frequency = <50000000>; + cap-sdio-irq; + cap-sd-highspeed; + no-mmc; +}; + +&mmc1 { + status = "okay"; +}; + +&uart0 { + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&uart3 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&sata0 { + status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&dc0 { + status = "okay"; + pipe_mask = [02]; + edp_mask = [00]; +}; + +&i2s0 { + #sound-dai-cells = <0>; + dai-name = "phytium-i2s-lsd"; + status = "okay"; +}; + +&pwm1 { + phytium,db = <0 0 0 1000 1000 0>; + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2202-power-board.dts b/device_board_phytium/tenglong_e/dts/pe2202-power-board.dts new file mode 100644 index 0000000000000000000000000000000000000000..b0294d02d9505c8cd30d8e6648b425afc0e33a0d --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2202-power-board.dts @@ -0,0 +1,243 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2202 power board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + * + * Hongmin Qi + * + * 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. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2202.dtsi" + +/{ + model = "Pe2202S power Board"; + compatible = "phytium,pe2202"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0{ + device_type = "memory"; + reg = <0x0 0x80000000 0x1 0x00000000>; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = <0x0 0x65 0x4>; + clocks = <&sysclk_50mhz>; + #address-cells = <0x1>; + #size-cells = <0x0>; + status = "okay"; + + rtc@68 { + compatible = "dallas,ds1339"; + reg = <0x68>; + }; + }; + + mio6: i2c@28020000 { + status = "okay"; + compatible = "phytium,i2c"; + reg = <0x0 0x28020000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <0x1>; + #size-cells = <0x0>; + eeprom@50 { + compatible = "atmel,24c02"; + reg = <0x50>; + pagesize = <1>; + }; + }; + + mio10: uart@28028000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28028000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio11: uart@2802a000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2802a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio13: uart@2802e000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2802e000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio14: uart@28030000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio15: uart@28032000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28032000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "otg"; + status = "okay"; +}; + +&usb2_3 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_4 { + dr_mode = "host"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb1 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb2 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb3 { + phy-mode = "sgmii"; + use-mii; + status = "disabled"; +}; + +&dc0 { + pipe_mask = [02]; + edp_mask = [00]; + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi0 { + global-cs = <1>; + status = "disabled"; +}; + +&mmc0 { + bus-width = <8>; + max-frequency = <50000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + no-sdio; + no-sd; + non-removable; + status = "okay"; +}; + +&mmc1 { + status = "okay"; +}; + +&uart0 { + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&uart3 { + status = "okay"; +}; + + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2202.dtsi b/device_board_phytium/tenglong_e/dts/pe2202.dtsi new file mode 100644 index 0000000000000000000000000000000000000000..4e6446da32901c573073749efa08ffc73c67d046 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2202.dtsi @@ -0,0 +1,235 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * dts file for Phytium Pe2202 SoC + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +#include "pe220x.dtsi" +#include + +/ { + compatible = "phytium,pe2202"; + + aliases { + ethernet0 = &macb0; + ethernet1 = &macb1; + ethernet2 = &macb2; + ethernet3 = &macb3; + }; +}; + +&thermal_zones { + sensor0 { + trips { + threshod: trip-point@0 { + temperature = <75000>; + hysteresis = <0>; + type = "passive"; + }; + target: trip-point@1 { + temperature = <90000>; + hysteresis = <0>; + type = "passive"; + }; + cpu_crit: cpu_crit { + temperature = <100000>; + hysteresis = <2000>; + type = "critical"; + }; + }; + cooling-maps { + map0 { + trip = <&target>; + cooling-device = <&cpu_l0 THERMAL_NO_LIMIT THERMAL_NO_LIMIT>; + }; + }; + }; + + sensor1 { + trips { + threshod1: trip-point@0 { + temperature = <75000>; + hysteresis = <0>; + type = "passive"; + }; + target1: trip-point@1 { + temperature = <90000>; + hysteresis = <0>; + type = "passive"; + }; + cpu_crit1: cpu_crit { + temperature = <100000>; + hysteresis = <2000>; + type = "critical"; + }; + }; + }; +}; + +&cpu { + cpu-map { + cluster0 { + core0 { + cpu = <&cpu_l0>; + }; + + core1 { + cpu = <&cpu_l1>; + }; + }; + }; + + cpu_l0: cpu@0 { + device_type = "cpu"; + compatible = "phytium,ftc310", "arm,armv8"; + reg = <0x0 0x200>; + enable-method = "psci"; + clocks = <&scmi_dvfs 2>; + #cooling-cells = <2>; + dynamic-power-coefficient = <100>; + }; + + cpu_l1: cpu@1 { + device_type = "cpu"; + compatible = "phytium,ftc310", "arm,armv8"; + reg = <0x0 0x201>; + enable-method = "psci"; + clocks = <&scmi_dvfs 2>; + }; +}; + +&soc { + hda0: hda@28006000 { + compatible = "phytium,hda"; + reg = <0x0 0x28006000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + i2s0: i2s@28009000 { + compatible = "phytium,i2s"; + reg = <0x0 0x28009000 0x0 0x1000>, + <0x0 0x28005000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_600mhz>; + clock-names = "i2s_clk"; + status = "disabled"; + }; + + can0: can@2800a000 { + compatible = "phytium,canfd"; + reg = <0x0 0x2800a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_200mhz>; + clock-names = "can_clk"; + tx-fifo-depth = <64>; + rx-fifo-depth = <64>; + status = "disabled"; + }; + + can1: can@2800b000 { + compatible = "phytium,canfd"; + reg = <0x0 0x2800b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_200mhz>; + clock-names = "can_clk"; + tx-fifo-depth = <64>; + rx-fifo-depth = <64>; + status = "disabled"; + }; + + keypad: keypad@2807a000 { + compatible = "phytium,keypad"; + reg = <0x0 0x2807a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + usb3_0: usb3@31a08000 { + compatible = "phytium,pe220x-xhci"; + reg = <0x0 0x31a08000 0x0 0x18000>; + interrupts = ; + status = "disabled"; + }; + + usb3_1: usb3@31a28000 { + compatible = "phytium,pe220x-xhci"; + reg = <0x0 0x31a28000 0x0 0x18000>; + interrupts = ; + status = "disabled"; + }; + + sata0: sata@31a40000 { + compatible = "generic-ahci"; + reg = <0x0 0x31a40000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + sata1: sata@32014000 { + compatible = "generic-ahci"; + reg = <0x0 0x32014000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + macb0: ethernet@3200c000 { + compatible = "cdns,phytium-gem-1.0"; + reg = <0x0 0x3200c000 0x0 0x2000>; + interrupts = , + , + , + , + , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + status = "disabled"; + }; + + macb1: ethernet@3200e000 { + compatible = "cdns,phytium-gem-1.0"; + reg = <0x0 0x3200e000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + status = "disabled"; + }; + + macb2: ethernet@32010000 { + compatible = "cdns,phytium-gem-1.0"; + reg = <0x0 0x32010000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + use-mii; + status = "disabled"; + }; + + macb3: ethernet@32012000 { + compatible = "cdns,phytium-gem-1.0"; + reg = <0x0 0x32012000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + use-mii; + status = "disabled"; + }; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2204-come-board.dts b/device_board_phytium/tenglong_e/dts/pe2204-come-board.dts new file mode 100644 index 0000000000000000000000000000000000000000..e87b2607822485bb3d9b9a5d30cfc7a7149ec021 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2204-come-board.dts @@ -0,0 +1,268 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2204 come board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + * + * Hongmin Qi + * + * 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. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2204.dtsi" + +/{ + model = "Pe2204 come Board"; + compatible = "phytium,pe2204"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0{ + device_type = "memory"; + reg = <0x0 0x80000000 0x2 0x00000000>; + }; +}; + +&soc { + mio3: i2c@2801a000 { + status = "okay"; + compatible = "phytium,i2c"; + reg = <0x0 0x2801a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + + eeprom@50 { + compatible = "atmel,24c02"; + reg = <0x50>; + pagesize = <1>; + }; + }; + + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + rtc@32 { + compatible = "wave,sd3068"; + reg = <0x32>; + }; + }; + + mio6: uart@28020000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28020000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio10: uart@28028000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28028000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio14: uart@28030000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio15: uart@28032000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28032000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "otg"; + status = "okay"; +}; + +&usb2_3 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_4 { + dr_mode = "host"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb1 { + phy-mode = "sgmii"; + use-mii; + status = "disabled"; +}; + +&macb2 { + phy-mode = "rgmii"; + use-mii; + status = "disabled"; +}; + +&macb3 { + phy-mode = "rgmii"; + use-mii; + status = "disabled"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi0 { + global-cs = <1>; + status = "disabled"; +}; + +&spi2 { + global-cs = <1>; + status = "okay"; + + flash: w25q128@0 { + compatible = "winbond,w25q128", "jedec,spi-nor"; + spi-tx-bus-width = <1>; + spi-rx-bus-width = <1>; + spi-max-frequency = <12000000>; + reg = <0x00>; + }; +}; + +&mmc0 { + bus-width = <4>; + max-frequency = <25000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + no-sdio; + no-sd; + non-removable; + status = "okay"; +}; + +&mmc1 { + status = "okay"; +}; + +&uart0 { + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&uart3 { + status = "okay"; +}; + +&sata0 { + status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&hda0 { + status = "okay"; +}; + +&dc0 { + status = "okay"; + pipe_mask = [03]; + edp_mask = [00]; +}; + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; + +&pwm1 { + phytium,db = <0 0 0 1000 1000 0>; + status = "okay"; +}; + +&vpu0 { + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2204-demo-ddr4-local.dts b/device_board_phytium/tenglong_e/dts/pe2204-demo-ddr4-local.dts new file mode 100644 index 0000000000000000000000000000000000000000..402d07735b863c5c9363254390d52abd6609af30 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2204-demo-ddr4-local.dts @@ -0,0 +1,166 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2204 demo board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2204.dtsi" + +/{ + model = "Pe2204 DEMO LOCAL DDR4"; + compatible = "phytium,pe2204"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0 { + device_type = "memory"; + reg = <0x0 0x80000000 0x0 0x80000000>; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + simple-audio-card,pin-switches = "mic-in"; + simple-audio-card,widgets = "Microphone", "mic-in"; + simple-audio-card,routing = "MIC2", "mic-in"; + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + simple-audio-card,codec { + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + rtc@32 { + compatible = "wave,sd3078"; + reg = <0x32>; + }; + + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + codec0: es8336@10 { + #sound-dai-cells = <0x0>; + compatible = "everest,es8336"; + reg = <0x10>; + }; + }; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_2 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&spi2 { + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&mmc0 { + bus-width = <0x00000008>; + max-frequency = <50000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + no-sdio; + no-sd; + non-removable; + status = "okay"; +}; + +&mmc1 { + bus-width = <0x00000004>; + max-frequency = <50000000>; + cap-sdio-irq; + cap-sd-highspeed; + sd-uhs-sdr25; + no-mmc; + status = "okay"; +}; + +&i2s0 { + #sound-dai-cells = <0>; + status = "okay"; +}; + +&dc0 { + pipe_mask = /bits/ 8 <0x3>; + edp_mask = /bits/ 8 <0x0>; + status = "okay"; +}; + +&vpu0 { + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2204-demo-ddr4-nopb.dts b/device_board_phytium/tenglong_e/dts/pe2204-demo-ddr4-nopb.dts new file mode 100644 index 0000000000000000000000000000000000000000..56dfd9540be1d4a632489a34cab40537737da8c6 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2204-demo-ddr4-nopb.dts @@ -0,0 +1,244 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2204 demo board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2204.dtsi" +#include "dt-bindings/gpio/gpio.h" + +/{ + model = "Pe2204 DEMO DDR4"; + compatible = "phytium,pe2204"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0 { + device_type = "memory"; + reg = <0x0 0x80000000 0x0 0x80000000>; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + simple-audio-card,pin-switches = "mic-in"; + simple-audio-card,widgets = "Microphone", "mic-in"; + simple-audio-card,routing = "MIC2", "mic-in"; + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + simple-audio-card,codec { + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + rtc@68 { + compatible = "dallas,ds1339"; + reg = <0x68>; + }; + + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + codec0: es8336@10 { + det-gpios = <&gpio2 5 GPIO_ACTIVE_LOW>; + sel-gpios = <&gpio2 11 GPIO_ACTIVE_LOW>; + #sound-dai-cells = <0x0>; + compatible = "everest,es8336"; + reg = <0x10>; + }; + }; +}; + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; + +&watchdog0 { + status = "okay"; +}; + +&watchdog1 { + status = "okay"; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_2 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +/* + * In demo board, M.2 interface may insert two types of disks: PCIE (nvme protocol) or SATA (ahci protocol), + * so here enable 'sata0' node by default to correspond to the sata drive case. Pin multiplexing exists + * in PCIE2 and SATA0, when used as a boot disk, the BIOS can automatically recognize these two conditions. + */ +&sata0 { + status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi2 { + global-cs = <1>; + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&mmc0 { + bus-width = <0x00000008>; + max-frequency = <100000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + mmc-hs200-1_8v; + no-sdio; + no-sd; + non-removable; + status = "okay"; +}; + +&mmc1 { + bus-width = <0x00000004>; + max-frequency = <50000000>; + cap-sdio-irq; + cap-sd-highspeed; + no-sdio; + no-mmc; + status = "okay"; +}; + +&i2s0 { + #sound-dai-cells = <0>; + dai-name = "phytium-i2s-lsd"; + status = "okay"; +}; + +&dc0 { + pipe_mask = /bits/ 8 <0x3>; + edp_mask = /bits/ 8 <0x0>; + status = "okay"; +}; + +&i2s_dp0 { + status = "okay"; +}; + +&i2s_dp1 { + status = "okay"; +}; + +&pmdk_dp { + num-dp = <2>; + dp-mask = /bits/ 8 <0x3>; + status = "okay"; +}; + +&vpu0 { + status = "disabled"; +}; + +&smmu { + status = "disabled"; +}; + +&dc0 { + status = "disabled"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2204-demo-ddr4.dts b/device_board_phytium/tenglong_e/dts/pe2204-demo-ddr4.dts new file mode 100644 index 0000000000000000000000000000000000000000..c12eb5810524d7597f038e92cbe9d441548c7ab1 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2204-demo-ddr4.dts @@ -0,0 +1,236 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2204 demo board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2204.dtsi" +#include "dt-bindings/gpio/gpio.h" + +/{ + model = "Pe2204 DEMO DDR4"; + compatible = "phytium,pe2204"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0 { + device_type = "memory"; + reg = <0x0 0x80000000 0x0 0x80000000>; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + simple-audio-card,pin-switches = "mic-in"; + simple-audio-card,widgets = "Microphone", "mic-in"; + simple-audio-card,routing = "MIC2", "mic-in"; + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + simple-audio-card,codec { + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + rtc@68 { + compatible = "dallas,ds1339"; + reg = <0x68>; + }; + + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + codec0: es8336@10 { + det-gpios = <&gpio2 5 GPIO_ACTIVE_LOW>; + sel-gpios = <&gpio2 11 GPIO_ACTIVE_LOW>; + #sound-dai-cells = <0x0>; + compatible = "everest,es8336"; + reg = <0x10>; + }; + }; +}; + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; + +&watchdog0 { + status = "okay"; +}; + +&watchdog1 { + status = "okay"; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&usb2_2 { + dr_mode = "peripheral"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +/* + * In demo board, M.2 interface may insert two types of disks: PCIE (nvme protocol) or SATA (ahci protocol), + * so here enable 'sata0' node by default to correspond to the sata drive case. Pin multiplexing exists + * in PCIE2 and SATA0, when used as a boot disk, the BIOS can automatically recognize these two conditions. + */ +&sata0 { + status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi2 { + global-cs = <1>; + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&mmc0 { + bus-width = <0x00000008>; + max-frequency = <100000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + mmc-hs200-1_8v; + no-sdio; + no-sd; + non-removable; + status = "okay"; +}; + +&mmc1 { + bus-width = <0x00000004>; + max-frequency = <50000000>; + cap-sdio-irq; + cap-sd-highspeed; + no-sdio; + no-mmc; + status = "okay"; +}; + +&i2s0 { + #sound-dai-cells = <0>; + dai-name = "phytium-i2s-lsd"; + status = "okay"; +}; + +&dc0 { + pipe_mask = /bits/ 8 <0x3>; + edp_mask = /bits/ 8 <0x0>; + status = "okay"; +}; + +&i2s_dp0 { + status = "okay"; +}; + +&i2s_dp1 { + status = "okay"; +}; + +&pmdk_dp { + num-dp = <2>; + dp-mask = /bits/ 8 <0x3>; + status = "okay"; +}; + +&vpu0 { + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2204-edu-board.dts b/device_board_phytium/tenglong_e/dts/pe2204-edu-board.dts new file mode 100644 index 0000000000000000000000000000000000000000..7a47cbc375a2f7c9ca414bb964e692a0a16395f8 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2204-edu-board.dts @@ -0,0 +1,347 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2204 edu board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + * + * Hongmin Qi + * + * 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. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2204.dtsi" + +/{ + model = "Pe2204 edu Board"; + compatible = "phytium,pe2204"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0{ + device_type = "memory"; + reg = <0x0 0x80000000 0x2 0x00000000>; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + simple-audio-card,codec { + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <0x1>; + #size-cells = <0x0>; + status = "okay"; + + rtc@68 { + compatible = "dallas,ds1339"; + reg = <0x68>; + }; + }; + + mio8: i2c@28024000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28024000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <0x1>; + #size-cells = <0x0>; + status = "okay"; + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <0x1>; + #size-cells = <0x0>; + status = "okay"; + + codec0:es8336@10 { + det-gpios = <&gpio2 5 0>; + sel-gpios = <&gpio2 6 0>; + #sound-dai-cells = <0x0>; + compatible = "everest,es8336"; + reg = <0x10>; + mic-src = [30]; + }; + }; + + mio0: uart@28014000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28014000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio1: uart@28016000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28016000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio11: uart@2802A000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2802a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio15: uart@28032000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28032000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; +}; + +&gpio2 { + status = "okay"; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + //status = "okay"; +}; + +&usb2_0 { + dr_mode = "otg"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "host"; + //status = "okay"; +}; + +&usb2_2 { + dr_mode = "host"; + //status = "okay"; +}; + +&usb2_3 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_4 { + dr_mode = "host"; + //status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + //status = "okay"; +}; + +&macb1 { + phy-mode = "sgmii"; + use-mii; + //status = "okay"; +}; + +&macb2 { + phy-mode = "sgmii"; + use-mii; + //status = "okay"; +}; + +&macb3 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi0 { + global-cs = <1>; + status = "okay"; + + flash: w25q128@0 { + compatible = "jedec,spi-nor"; + spi-tx-bus-width = <1>; + spi-rx-bus-width = <1>; + spi-max-frequency = <12000000>; + reg = <0x00>; + status = "okay"; + }; +}; + +&mmc0 { + bus-width = <0x8>; + max-frequency = <50000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + no-sdio; + no-sd; + non-removable; + status = "okay"; +}; + +&mmc1 { + bus-width = <0x4>; + max-frequency = <25000000>; + cap-sdio-irq; + cap-sd-highspeed; + status = "okay"; +}; + +&uart0 { + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&uart3 { + status = "okay"; +}; + +&sata0 { + //status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&dc0 { + status = "okay"; + pipe_mask = [01]; + edp_mask = [00]; +}; + +&vpu0 { + status = "okay"; +}; + +&i2s0 { + #sound-dai-cells = <0>; + dai-name = "phytium-i2s-lsd"; + status = "okay"; +}; + +&i2s_dp0 { + status = "okay"; +}; + +&pmdk_dp { + num-dp = <1>; + dp-mask = /bits/ 8 <0x1>; + status = "okay"; +}; + +&pwm0 { + phytium,db = <0 0 0 0 0 0>; + status = "okay"; +}; + +&pwm1 { + phytium,db = <0 0 0 0 0 0>; + status = "okay"; +}; + + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; + +&keypad { + keypad,num-rows = <4>; + keypad,num-columns = <4>; + linux,keymap = <0x00000011 + 0x00010012 + 0x00020013 + 0x00030014 + 0x01000021 /*KEY_21*/ + 0x01010022 /*KEY_22*/ + 0x01020023 /*KEY_23*/ + 0x01030024 /*KEY_24*/ + 0x02000031 /*KEY_31*/ + 0x02010032 /*KEY_32*/ + 0x02020033 /*KEY_33*/ + 0x02030034 /*KEY_34*/ + 0x03000041 /*KEY_41*/ + 0x03010042 /*KEY_42*/ + 0x03020043 /*KEY_43*/ + 0x03030044 /*KEY_44*/>; + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2204-hanwei-board.dts b/device_board_phytium/tenglong_e/dts/pe2204-hanwei-board.dts new file mode 100644 index 0000000000000000000000000000000000000000..d9e1eae59d982aa021686de696736316637ebf00 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2204-hanwei-board.dts @@ -0,0 +1,218 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2204 hanwei board + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + * + * Hongmin Qi + * + * 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. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2204.dtsi" + +/{ + model = "Pe2204 hanwei Board"; + compatible = "phytium,pe2204"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0{ + device_type = "memory"; + reg = <0x0 0x80000000 0x2 0x00000000>; + }; +}; + +&soc { + mio3: uart@2801a000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2801a000 0x0 0x1000>; + interrupts = <0x0 0x5f 0x4>; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio8: uart@28024000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28024000 0x0 0x1000>; + interrupts = <0x0 0x64 0x4>; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio10: uart@28028000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28028000 0x0 0x1000>; + interrupts = <0x0 0x66 0x4>; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio14: uart@28030000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = <0x0 0x6a 0x4>; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio15: uart@28032000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x28032000 0x0 0x1000>; + interrupts = <0x0 0x6b 0x4>; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; +}; + +&pcie { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "otg"; + status = "okay"; +}; + +&usb2_3 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_4 { + dr_mode = "host"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb1 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb2 { + phy-mode = "rgmii"; + use-mii; + status = "okay"; +}; + +&macb3 { + phy-mode = "rgmii"; + use-mii; + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi0 { + global-cs = <1>; + status = "disabled"; +}; + +&mmc0 { + bus-width = <8>; + max-frequency = <25000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + no-sdio; + no-sd; + non-removable; + status = "disabled"; +}; + +&mmc1 { + status = "okay"; +}; + +&uart0 { + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&uart3 { + status = "okay"; +}; + +&sata0 { + status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; + +&vpu0 { + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2204-miniitx-board.dts b/device_board_phytium/tenglong_e/dts/pe2204-miniitx-board.dts new file mode 100644 index 0000000000000000000000000000000000000000..fe9288f6a175e222f39ceaef4f1bdabf89fadf10 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2204-miniitx-board.dts @@ -0,0 +1,343 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium miniITX-Pe2204 development board. + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + * + * Shaojun Yang + * + * 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. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2204.dtsi" + +/{ + model = "miniITX-Pe2204 Board"; + compatible = "phytium,pe2204"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + aliases { + serial4 = &mio0; + serial5 = &mio1; + serial6 = &mio8; + serial7 = &mio11; + serial8 = &mio15; + }; + + memory@0{ + device_type = "memory"; + reg = <0x0 0x80000000 0x2 0x00000000>; + }; + + reserved-memory { + #address-cells = <2>; + #size-cells = <2>; + ranges; + + display_reserved: share@f4000000 { + no-map; + reg = <0x00 0xf4000000 0x0 0x4000000>; + }; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + + simple-audio-card,codec{ + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + rtc@68 { + compatible = "dallas,ds1339"; + reg = <0x68>; + }; + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + codec0: es8336@10 { + det-gpios = <&gpio2 5 0>; + sel-gpios = <&gpio2 6 0>; + #sound-dai-cells = <0>; + compatible = "everest,es8336"; + reg = <0x10>; + mic-src = [20]; + }; + }; + + + mio0: uart@28014000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28014000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio1: uart@28016000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28016000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio8: uart@28024000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28024000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio11: uart@2802A000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x2802A000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio15: uart@28032000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28032000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; +}; + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; + +&watchdog0 { + status = "okay"; +}; + +&watchdog1 { + status = "okay"; +}; + +&pcie { + status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "otg"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "peripheral"; + status = "disabled"; +}; + +&usb2_2 { + dr_mode = "peripheral"; + status = "disabled"; +}; + +&usb2_3 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_4 { + dr_mode = "host"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb2 { + phy-mode = "rgmii"; + use-mii; + status = "okay"; +}; + +&dc0 { + memory-region = <&display_reserved>; + pipe_mask = /bits/ 8 <0x3>; + edp_mask = /bits/ 8 <0x0>; + status = "okay"; +}; + +&i2s0 { + #sound-dai-cells = <0>; + dai-name = "phytium-i2s-lsd"; + status = "okay"; +}; + +&i2s_dp0 { + dai-name = "phytium-i2s-dp0"; + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi0 { + global-cs = <1>; + status = "disabled"; + + flash: w25q128@0 { + compatible = "winbond,w25q128", "jedec,spi-nor"; + spi-tx-bus-width = <1>; + spi-rx-bus-width = <1>; + spi-max-frequency = <12000000>; + reg = <0x00>; + status = "disabled"; + }; +}; + +&spi1 { + global-cs = <1>; + status = "disabled"; +}; + +&spi2 { + global-cs = <1>; + status = "disabled"; +}; + +&mmc0 { + bus-width = <0x00000004>; + max-frequency = <50000000>; + cap-sdio-irq; + cap-sd-highspeed; + no-mmc; + status = "okay"; +}; + +&mmc1 { + bus-width = <0x00000008>; + max-frequency = <50000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + no-sdio; + no-sd; + non-removable; + status = "disabled"; +}; + +&pwm0 { + phytium,db = <0 0 0 1000 1000 0>; + status = "okay"; +}; + +&pwm1 { + phytium,db = <0 0 0 1000 1000 0>; + status = "okay"; +}; + +&uart0 { + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&uart3 { + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&rng0 { + status = "okay"; +}; + +&vpu0 { + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2204-vpx-board.dts b/device_board_phytium/tenglong_e/dts/pe2204-vpx-board.dts new file mode 100644 index 0000000000000000000000000000000000000000..22c3c4395b9b0acb2d1addd8b575371c9944d09e --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2204-vpx-board.dts @@ -0,0 +1,325 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DTS file for Phytium Pe2204 vpx board. + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + * + * Tianyu Liu + * + * 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. + */ + +/dts-v1/; +/memreserve/ 0x80000000 0x10000; + +#include "pe2204.dtsi" + +/{ + model = "Pe2204 vpx board"; + compatible = "phytium,pe2204"; + + chosen { + stdout-path = "serial1:115200n8"; + }; + + memory@0{ + device_type = "memory"; + reg = <0x0 0x80000000 0x2 0x00000000>; + }; + aliases { + serial4 = &mio3; + serial5 = &mio8; + serial6 = &mio10; + serial7 = &mio11; + serial8 = &mio15; + }; + + sound_card: sound { + compatible = "simple-audio-card"; + simple-audio-card,format = "i2s"; + simple-audio-card,name = "phytium,pe220x-i2s-audio"; + simple-audio-card,cpu { + sound-dai = <&i2s0>; + }; + simple-audio-card,codec{ + sound-dai = <&codec0>; + }; + }; +}; + +&soc { + mio9: i2c@28026000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28026000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + rtc@68 { + compatible = "dallas,ds1339"; + reg = <0x68>; + }; + }; + + mio14: i2c@28030000 { + compatible = "phytium,i2c"; + reg = <0x0 0x28030000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + #address-cells = <1>; + #size-cells = <0>; + status = "okay"; + + codec0: es8336@10 { + det-gpios = <&gpio2 5 0>; + sel-gpios = <&gpio2 6 0>; + #sound-dai-cells = <0>; + compatible = "everest,es8336"; + reg = <0x10>; + mic-src = [30]; + }; + }; + + mio3: uart@2801A000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x2801A000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio8: uart@28024000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28024000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio10: uart@28028000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28028000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio11: uart@2802A000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x2802A000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio13: uart@2802E000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x2802E000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; + + mio15: uart@28032000 { + compatible = "arm,pl011","arm,primecell"; + reg = <0x0 0x28032000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz &sysclk_50mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "okay"; + }; +}; + +&gpio0 { + status = "okay"; +}; + +&gpio1 { + status = "okay"; +}; + +&gpio2 { + status = "okay"; +}; + +&gpio3 { + status = "okay"; +}; + +&gpio4 { + status = "okay"; +}; + +&gpio5 { + status = "okay"; +}; + +&pcie { + status = "okay"; +}; + +&sata0 { + status = "okay"; +}; + +&sata1 { + status = "okay"; +}; + +&usb3_0 { + status = "okay"; +}; + +&usb3_1 { + status = "okay"; +}; + +&usb2_0 { + dr_mode = "otg"; + status = "okay"; +}; + +&usb2_1 { + dr_mode = "host"; + status = "disabled"; +}; + +&usb2_2 { + dr_mode = "host"; + status = "disabled"; +}; + +&usb2_3 { + dr_mode = "host"; + status = "okay"; +}; + +&usb2_4 { + dr_mode = "host"; + status = "okay"; +}; + +&macb0 { + phy-mode = "sgmii"; + use-mii; + status = "okay"; +}; + +&macb2 { + phy-mode = "rgmii"; + use-mii; + force-phy-mode; + status = "okay"; +}; + +&macb3 { + phy-mode = "rgmii"; + use-mii; + status = "okay"; +}; + +&dc0 { + pipe_mask = [03]; + edp_mask = [00]; + status = "okay"; +}; + +&i2s0 { + #sound-dai-cells = <0>; + dai-name = "phytium-i2s-lsd"; + status = "okay"; +}; + +&i2s_dp0 { + status = "okay"; +}; + +&i2s_dp1 { + status = "okay"; +}; + +&pmdk_dp { + num-dp = <2>; + dp-mask = /bits/ 8 <0x3>; + status = "okay"; +}; + +&qspi0 { + status = "okay"; + + flash@0 { + status = "okay"; + }; +}; + +&spi0 { + global-cs = <1>; + status = "disabled"; + + flash: w25q128@0 { + compatible = "winbond,w25q128", "jedec,spi-nor"; + spi-tx-bus-width = <1>; + spi-rx-bus-width = <1>; + spi-max-frequency = <12000000>; + reg = <0x00>; + status = "disabled"; + }; +}; + +&spi2 { + global-cs = <1>; + status = "disabled"; +}; + +&mmc0 { + bus-width = <0x00000008>; + max-frequency = <25000000>; + cap-mmc-hw-reset; + cap-mmc-highspeed; + no-sdio; + no-sd; + non-removable; + status = "okay"; +}; + +&uart0 { + status = "okay"; +}; + +&uart1 { + status = "okay"; +}; + +&uart2 { + status = "okay"; +}; + +&uart3 { + status = "okay"; +}; + +&can0 { + status = "okay"; +}; + +&can1 { + status = "okay"; +}; + +&rng0 { + status = "okay"; +}; + +&vpu0 { + status = "okay"; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe2204.dtsi b/device_board_phytium/tenglong_e/dts/pe2204.dtsi new file mode 100644 index 0000000000000000000000000000000000000000..228264b282ee3985002e963df92ff70bd41eaa81 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe2204.dtsi @@ -0,0 +1,276 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * dts file for Phytium Pe2204 SoC + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +#include "pe220x.dtsi" +#include + +/ { + compatible = "phytium,pe2204"; + + aliases { + ethernet0 = &macb0; + ethernet1 = &macb1; + ethernet2 = &macb2; + ethernet3 = &macb3; + }; +}; + +&thermal_zones { + sensor0 { + trips { + threshod: trip-point@0 { + temperature = <75000>; + hysteresis = <0>; + type = "passive"; + }; + target: trip-point@1 { + temperature = <90000>; + hysteresis = <0>; + type = "passive"; + }; + cpu_crit: cpu_crit { + temperature = <100000>; + hysteresis = <2000>; + type = "critical"; + }; + }; + + cooling-maps { + map0 { + trip = <&target>; + cooling-device = + <&cpu_l0 THERMAL_NO_LIMIT THERMAL_NO_LIMIT>, + <&cpu_b0 THERMAL_NO_LIMIT THERMAL_NO_LIMIT>; + }; + }; + }; + + sensor1 { + trips { + threshod1: trip-point@0 { + temperature = <75000>; + hysteresis = <0>; + type = "passive"; + }; + target1: trip-point@1 { + temperature = <90000>; + hysteresis = <0>; + type = "passive"; + }; + cpu_crit1: cpu_crit { + temperature = <100000>; + hysteresis = <2000>; + type = "critical"; + }; + }; + }; +}; + +&cpu { + cpu-map { + cluster0 { + core0 { + cpu = <&cpu_l0>; + }; + + core1 { + cpu = <&cpu_l1>; + }; + }; + + cluster1 { + core0 { + cpu = <&cpu_b0>; + }; + }; + + cluster2 { + core0 { + cpu = <&cpu_b1>; + }; + }; + }; + + cpu_l0: cpu@0 { + device_type = "cpu"; + compatible = "phytium,ftc310", "arm,armv8"; + reg = <0x0 0x200>; + enable-method = "psci"; + clocks = <&scmi_dvfs 2>; + #cooling-cells = <2>; + capacity-dmips-mhz = <2850>; + }; + + cpu_l1: cpu@1 { + device_type = "cpu"; + compatible = "phytium,ftc310", "arm,armv8"; + reg = <0x0 0x201>; + enable-method = "psci"; + clocks = <&scmi_dvfs 2>; + capacity-dmips-mhz = <2850>; + }; + + cpu_b0: cpu@100 { + device_type = "cpu"; + compatible = "phytium,ftc664", "arm,armv8"; + reg = <0x0 0x0>; + enable-method = "psci"; + clocks = <&scmi_dvfs 0>; + #cooling-cells = <2>; + capacity-dmips-mhz = <5660>; + }; + + cpu_b1: cpu@101 { + device_type = "cpu"; + compatible = "phytium,ftc664", "arm,armv8"; + reg = <0x0 0x100>; + enable-method = "psci"; + clocks = <&scmi_dvfs 1>; + capacity-dmips-mhz = <5660>; + }; +}; + +&soc { + hda0: hda@28006000 { + compatible = "phytium,hda"; + reg = <0x0 0x28006000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + i2s0: i2s@28009000 { + compatible = "phytium,i2s"; + reg = <0x0 0x28009000 0x0 0x1000>, + <0x0 0x28005000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_600mhz>; + clock-names = "i2s_clk"; + status = "disabled"; + }; + + can0: can@2800a000 { + compatible = "phytium,canfd"; + reg = <0x0 0x2800a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_200mhz>; + clock-names = "can_clk"; + tx-fifo-depth = <64>; + rx-fifo-depth = <64>; + status = "disabled"; + }; + + can1: can@2800b000 { + compatible = "phytium,canfd"; + reg = <0x0 0x2800b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_200mhz>; + clock-names = "can_clk"; + tx-fifo-depth = <64>; + rx-fifo-depth = <64>; + status = "disabled"; + }; + + keypad: keypad@2807a000 { + compatible = "phytium,keypad"; + reg = <0x0 0x2807a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + usb3_0: usb3@31a08000 { + compatible = "phytium,pe220x-xhci"; + reg = <0x0 0x31a08000 0x0 0x18000>; + interrupts = ; + status = "disabled"; + }; + + usb3_1: usb3@31a28000 { + compatible = "phytium,pe220x-xhci"; + reg = <0x0 0x31a28000 0x0 0x18000>; + interrupts = ; + status = "disabled"; + }; + + sata0: sata@31a40000 { + compatible = "generic-ahci"; + reg = <0x0 0x31a40000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + sata1: sata@32014000 { + compatible = "generic-ahci"; + reg = <0x0 0x32014000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + macb0: ethernet@3200c000 { + compatible = "cdns,phytium-gem-1.0"; + reg = <0x0 0x3200c000 0x0 0x2000>; + interrupts = , + , + , + , + , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + support-tsn; + status = "disabled"; + }; + + macb1: ethernet@3200e000 { + compatible = "cdns,phytium-gem-1.0"; + reg = <0x0 0x3200e000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + status = "disabled"; + }; + + macb2: ethernet@32010000 { + compatible = "cdns,phytium-gem-1.0"; + reg = <0x0 0x32010000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + status = "disabled"; + }; + + macb3: ethernet@32012000 { + compatible = "cdns,phytium-gem-1.0"; + reg = <0x0 0x32012000 0x0 0x2000>; + interrupts = , + , + , + ; + clock-names = "pclk", "hclk", "tx_clk", "tsu_clk"; + clocks = <&sysclk_250mhz>, <&sysclk_48mhz>, <&sysclk_48mhz>, <&sysclk_250mhz>; + magic-packet; + status = "disabled"; + }; + + vpu0: vpu@32b00000 { + compatible = "phytium,vpu"; + reg = <0x0 0x32b00000 0x0 0x20000>; + interrupts = ; + status = "disabled"; + }; +}; diff --git a/device_board_phytium/tenglong_e/dts/pe220x.dtsi b/device_board_phytium/tenglong_e/dts/pe220x.dtsi new file mode 100644 index 0000000000000000000000000000000000000000..ad6a1846315d34b630b67a51632046a02d5a2451 --- /dev/null +++ b/device_board_phytium/tenglong_e/dts/pe220x.dtsi @@ -0,0 +1,1012 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * dts file for Phytium Pe220x SoC + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include + +/ { + compatible = "phytium,pe220x"; + interrupt-parent = <&gic>; + #address-cells = <2>; + #size-cells = <2>; + + aliases { + serial0 = &uart0; + serial1 = &uart1; + serial2 = &uart2; + serial3 = &uart3; + }; + + psci { + compatible = "arm,psci-1.0"; + method = "smc"; + cpu_suspend = <0xc4000001>; + cpu_off = <0x84000002>; + cpu_on = <0xc4000003>; + sys_poweroff = <0x84000008>; + sys_reset = <0x84000009>; + }; + + firmware { + scmi: scmi { + compatible = "arm,scmi"; + mboxes = <&mbox 0>; + mbox-names = "tx"; + shmem = <&cpu_scp_hpri>; + #address-cells = <1>; + #size-cells = <0>; + + scmi_dvfs: protocol@13 { + reg = <0x13>; + #clock-cells = <1>; + }; + + scmi_sensors0: protocol@15 { + reg = <0x15>; + #thermal-sensor-cells = <1>; + }; + }; + optee { + compatible = "linaro,optee-tz"; + method = "smc"; + }; + }; + + thermal_zones: thermal-zones { + sensor0 { + polling-delay-passive = <100>; + polling-delay = <1000>; + thermal-sensors = <&scmi_sensors0 0>; + }; + + sensor1 { + polling-delay-passive = <100>; + polling-delay = <1000>; + thermal-sensors = <&scmi_sensors0 1>; + }; + }; + + cpu: cpus { + #address-cells = <0x2>; + #size-cells = <0x0>; + }; + + gic: interrupt-controller@30800000 { + compatible = "arm,gic-v3"; + #interrupt-cells = <3>; + #address-cells = <2>; + #size-cells = <2>; + ranges; + interrupt-controller; + reg = <0x0 0x30800000 0 0x20000>, /* GICD */ + <0x0 0x30880000 0 0x80000>, /* GICR */ + <0x0 0x30840000 0 0x10000>, /* GICC */ + <0x0 0x30850000 0 0x10000>, /* GICH */ + <0x0 0x30860000 0 0x10000>; /* GICV */ + interrupts = ; + + its: gic-its@30820000 { + compatible = "arm,gic-v3-its"; + msi-controller; + reg = <0x0 0x30820000 0x0 0x20000>; + }; + }; + + pmu { + compatible = "arm,armv8-pmuv3"; + interrupts = ; + }; + + timer { + compatible = "arm,armv8-timer"; + interrupts = , + , + , + ; + clock-frequency = <50000000>; + }; + + clocks { + #address-cells = <2>; + #size-cells = <2>; + ranges; + + sysclk_48mhz: clk48mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <48000000>; + }; + + sysclk_50mhz: clk50mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <50000000>; + }; + + sysclk_100mhz: clk100mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <100000000>; + }; + + sysclk_200mhz: clk200mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <200000000>; + }; + + sysclk_250mhz: clk250mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <250000000>; + }; + + sysclk_300mhz: clk300mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <300000000>; + }; + + sysclk_600mhz: clk600mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <600000000>; + }; + + sysclk_1200mhz: clk1200mhz { + compatible = "fixed-clock"; + #clock-cells = <0>; + clock-frequency = <1200000000>; + }; + }; + + smmu: iommu@30000000 { + compatible = "arm,smmu-v3"; + reg = <0x0 0x30000000 0x0 0x800000>; + interrupts = , + , + , + ; + interrupt-names = "eventq", "priq", "cmdq-sync", "gerror"; + dma-coherent; + #iommu-cells = <1>; + }; + + soc: soc { + compatible = "simple-bus"; + #address-cells = <2>; + #size-cells = <2>; + dma-coherent; + ranges; + + mmc0: mmc@28000000 { + compatible = "phytium,mci"; + reg = <0x0 0x28000000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_1200mhz>; + clock-names = "phytium_mci_clk"; + status = "disabled"; + }; + + mmc1: mmc@28001000 { + compatible = "phytium,mci"; + reg = <0x0 0x28001000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_1200mhz>; + clock-names = "phytium_mci_clk"; + status = "disabled"; + }; + + nand0: nand@28002000 { + compatible = "phytium,nfc"; + reg = <0x0 0x28002000 0x0 0x1000>; + interrupts = ; + status = "disabled"; + }; + + qspi0: spi@28008000 { + compatible = "phytium,qspi-nor"; + reg = <0x0 0x28008000 0x0 0x1000>, + <0x0 0x0 0x0 0x0fffffff>; + reg-names = "qspi", "qspi_mm"; + clocks = <&sysclk_300mhz>; + status = "disabled"; + + #address-cells = <1>; + #size-cells = <0>; + + flash@0 { + compatible = "jedec,spi-nor"; + reg = <0x00>; + spi-rx-bus-width = <1>; + spi-max-frequency = <20000000>; + }; + }; + + uart0: uart@2800c000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2800c000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz &sysclk_100mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "disabled"; + }; + + uart1: uart@2800d000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2800d000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz &sysclk_100mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "disabled"; + }; + + uart2: uart@2800e000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2800e000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz &sysclk_100mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "disabled"; + }; + + uart3: uart@2800f000 { + compatible = "arm,pl011", "arm,primecell"; + reg = <0x0 0x2800f000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_100mhz &sysclk_100mhz>; + clock-names = "uartclk", "apb_pclk"; + status = "disabled"; + }; + + ddma0: dma-controller@28003000 { + compatible = "phytium,ddma"; + reg = <0x0 0x28003000 0x0 0x1000>; + interrupts = ; + #dma-cells = <2>; + dma-channels = <8>; + }; + + ddma1: dma-controller@28004000 { + compatible = "phytium,ddma"; + reg = <0x0 0x28004000 0x0 0x1000>; + interrupts = ; + #dma-cells = <2>; + dma-channels = <8>; + }; + + lpc: lpc@28010000 { + compatible = "simple-mfd", "syscon"; + reg = <0x0 0x28010000 0x0 0x1000>; + reg-io-width = <4>; + + #address-cells = <1>; + #size-cells = <1>; + ranges = <0x0 0x0 0x28010000 0x1000>; + + kcs0: kcs@24 { + compatible = "phytium,kcs-bmc"; + reg = <0x24 0x1>, <0x30 0x1>, <0x3c 0x1>; + interrupts = ; + status = "disabled"; + }; + + kcs1: kcs@28 { + compatible = "phytium,kcs-bmc"; + reg = <0x28 0x1>, <0x34 0x1>, <0x40 0x1>; + interrupts = ; + status = "disabled"; + }; + + kcs2: kcs@2c { + compatible = "phytium,kcs-bmc"; + reg = <0x2c 0x1>, <0x38 0x1>, <0x44 0x1>; + interrupts = ; + status = "disabled"; + }; + + kcs3: kcs@8c { + compatible = "phytium,kcs-bmc"; + reg = <0x8c 0x1>, <0x90 0x1>, <0x94 0x1>; + interrupts = ; + status = "disabled"; + }; + + bt: bt@48 { + compatible = "phytium,bt-bmc"; + reg = <0x48 0x20>; + interrupts = ; + status = "disabled"; + }; + }; + + /* MIO */ + + gpio0: gpio@28034000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28034000 0x0 0x1000>; + interrupts = , + , + , + , + , + , + , + , + , + , + , + , + , + , + , + ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + gpio1: gpio@28035000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28035000 0x0 0x1000>; + interrupts = , + , + , + , + , + , + , + , + , + , + , + , + , + , + , + ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + gpio2: gpio@28036000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28036000 0x0 0x1000>; + interrupts = , + , + , + , + , + , + , + , + , + , + , + , + , + , + , + ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + gpio3: gpio@28037000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28037000 0x0 0x1000>; + interrupts = ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + gpio4: gpio@28038000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28038000 0x0 0x1000>; + interrupts = ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + gpio5: gpio@28039000 { + compatible = "phytium,gpio"; + reg = <0x0 0x28039000 0x0 0x1000>; + interrupts = ; + gpio-controller; + #gpio-cells = <2>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + + porta { + compatible = "phytium,gpio-port"; + reg = <0>; + ngpios = <16>; + }; + }; + + spi0: spi@2803a000 { + compatible = "phytium,spi"; + reg = <0x0 0x2803a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + num-cs = <4>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + }; + + spi1: spi@2803b000 { + compatible = "phytium,spi"; + reg = <0x0 0x2803b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + num-cs = <4>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + }; + + spi2: spi@2803c000 { + compatible = "phytium,spi"; + reg = <0x0 0x2803c000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + num-cs = <4>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + }; + + spi3: spi@2803d000 { + compatible = "phytium,spi"; + reg = <0x0 0x2803d000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + num-cs = <4>; + #address-cells = <1>; + #size-cells = <0>; + status = "disabled"; + }; + + watchdog0: watchdog@28040000 { + compatible = "arm,sbsa-gwdt"; + reg = <0x0 0x28041000 0x0 0x1000>, + <0x0 0x28040000 0x0 0x1000>; + interrupts = ; + timeout-sec = <30>; + status = "disabled"; + }; + + watchdog1: watchdog@28042000 { + compatible = "arm,sbsa-gwdt"; + reg = <0x0 0x28043000 0x0 0x1000>, + <0x0 0x28042000 0x0 0x1000>; + interrupts = ; + timeout-sec = <30>; + status = "disabled"; + }; + + pwm0: pwm@2804a000 { + compatible = "phytium,pwm"; + reg = <0x0 0x2804a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + pwm1: pwm@2804b000 { + compatible = "phytium,pwm"; + reg = <0x0 0x2804b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz>; + status = "disabled"; + }; + + tacho0: tacho@28054000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28054000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho1: tacho@28055000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28055000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho2: tacho@28056000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28056000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho3: tacho@28057000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28057000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho4: tacho@28058000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28058000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho5: tacho@28059000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28059000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho6: tacho@2805a000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho7: tacho@2805b000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho8: tacho@2805c000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805c000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho9: tacho@2805d000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805d000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho10: tacho@2805e000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805e000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho11: tacho@2805f000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2805f000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho12: tacho@28060000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28060000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho13: tacho@28061000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28061000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho14: tacho@28062000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28062000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho15: tacho@28063000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28063000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho16: tacho@28064000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28064000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho17: tacho@28065000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28065000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho18: tacho@28066000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28066000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho19: tacho@28067000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28067000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho20: tacho@28068000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28068000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho21: tacho@28069000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28069000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho22: tacho@2806a000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806a000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho23: tacho@2806b000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806b000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho24: tacho@2806c000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806c000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho25: tacho@2806d000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806d000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho26: tacho@2806e000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806e000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho27: tacho@2806f000 { + compatible = "phytium,tacho"; + reg = <0x0 0x2806f000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho28: tacho@28070000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28070000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho29: tacho@28071000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28071000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho30: tacho@28072000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28072000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho31: tacho@28073000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28073000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho32: tacho@28074000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28074000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho33: tacho@28075000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28075000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho34: tacho@28076000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28076000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho35: tacho@28077000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28077000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho36: tacho@28078000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28078000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + tacho37: tacho@28079000 { + compatible = "phytium,tacho"; + reg = <0x0 0x28079000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_50mhz >; + status = "disabled"; + }; + + usb2_0: usb2@31800000 { + compatible = "phytium,usb2"; + reg = <0x0 0x31800000 0x0 0x80000>, + <0x0 0x31990000 0x0 0x10000>; + interrupts = ; + status = "disabled"; + }; + + usb2_1: usb2@31880000 { + compatible = "phytium,usb2"; + reg = <0x0 0x31880000 0x0 0x80000>, + <0x0 0x319a0000 0x0 0x10000>; + interrupts = ; + status = "disabled"; + }; + + usb2_2: usb2@31900000 { + compatible = "phytium,usb2"; + reg = <0x0 0x31900000 0x0 0x80000>, + <0x0 0x319b0000 0x0 0x10000>; + interrupts = ; + status = "disabled"; + }; + + usb2_3: usb2@32800000 { + compatible = "phytium,usb2"; + reg = <0x0 0x32800000 0x0 0x40000>, + <0x0 0x32880000 0x0 0x40000>; + interrupts = ; + status = "disabled"; + }; + + usb2_4: usb2@32840000 { + compatible = "phytium,usb2"; + reg = <0x0 0x32840000 0x0 0x40000>, + <0x0 0x328c0000 0x0 0x40000>; + interrupts = ; + status = "disabled"; + }; + + dc0: dc@32000000 { + compatible = "phytium,dc"; + reg = <0x0 0x32000000 0x0 0x8000>; + interrupts = ; + status = "disabled"; + }; + + i2s_dp0: i2s_dp0@32009000 { + compatible = "phytium,i2s"; + reg = <0x0 0x32009000 0x0 0x1000>, + <0x0 0x32008000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_600mhz>; + clock-names = "i2s_clk"; + dai-name = "phytium-i2s-dp0"; + status = "disabled"; + }; + + i2s_dp1: i2s_dp1@3200B000 { + compatible = "phytium,i2s"; + reg = <0x0 0x3200B000 0x0 0x1000>, + <0x0 0x3200A000 0x0 0x1000>; + interrupts = ; + clocks = <&sysclk_600mhz>; + clock-names = "i2s_clk"; + dai-name = "phytium-i2s-dp1"; + status = "disabled"; + }; + + pmdk_dp: pmdk_dp { + compatible = "phytium,pmdk-dp"; + status = "disabled"; + }; + + mbox: mailbox@32a00000 { + compatible = "phytium,mbox"; + reg = <0x0 0x32a00000 0x0 0x1000>; + interrupts = ; + #mbox-cells = <1>; + }; + + rng0: rng@32a36000 { + compatible = "phytium,rng"; + reg = <0x0 0x32a36000 0x0 0x1000>; + status = "disabled"; + }; + + sram: sram@32a10000 { + compatible = "phytium,pe220x-sram-ns", "mmio-sram"; + reg = <0x0 0x32a10000 0x0 0x2000>; + + #address-cells = <1>; + #size-cells = <1>; + ranges = <0x0 0x0 0x32a10000 0x2000>; + + cpu_scp_lpri: scp-shmem@0 { + compatible = "arm,scmi-shmem"; + reg = <0x1000 0x400>; + }; + + cpu_scp_hpri: scp-shmem@1 { + compatible = "arm,scmi-shmem"; + reg = <0x1400 0x400>; + }; + }; + + edac: edac@32b28000 { + compatible = "phytium,pe220x-edac"; + reg = <0x0 0x32b28000 0x0 0x1000>, + <0x0 0x31400000 0x0 0x1000>, + <0x0 0x31401000 0x0 0x1000>; + interrupts = , + ; + status = "disabled"; + }; + + gdma: gdma@32b34000 { + compatible = "phytium,gdma"; + dma-channels = <16>; + max-outstanding = <16>; + reg = <0x0 0x32b34000 0x0 0x1000>; + interrupts = ; + #dma-cells = <1>; + }; + + hwspinlock: spinlock@32b36000 { + compatible = "phytium,hwspinlock"; + reg = <0x0 0x32b36000 0x0 0x1000>; + #hwlock-cells = <1>; + nr-locks = <32>; + status = "disabled"; + }; + + pcie: pcie@40000000 { + compatible = "pci-host-ecam-generic"; + device_type = "pci"; + #address-cells = <3>; + #size-cells = <2>; + #interrupt-cells = <1>; + reg = <0x0 0x40000000 0x0 0x10000000>; + msi-parent = <&its>; + bus-range = <0x0 0xff>; + interrupt-map-mask = <0x0 0x0 0x0 0x7>; + interrupt-map = + <0x0 0x0 0x0 0x1 &gic 0x0 0x0 GIC_SPI 4 IRQ_TYPE_LEVEL_HIGH>, + <0x0 0x0 0x0 0x2 &gic 0x0 0x0 GIC_SPI 5 IRQ_TYPE_LEVEL_HIGH>, + <0x0 0x0 0x0 0x3 &gic 0x0 0x0 GIC_SPI 6 IRQ_TYPE_LEVEL_HIGH>, + <0x0 0x0 0x0 0x4 &gic 0x0 0x0 GIC_SPI 7 IRQ_TYPE_LEVEL_HIGH>; + ranges = <0x01000000 0x00 0x00000000 0x0 0x50000000 0x0 0x00f00000>, + <0x02000000 0x00 0x58000000 0x0 0x58000000 0x0 0x28000000>, + <0x03000000 0x10 0x00000000 0x10 0x00000000 0x10 0x00000000>; + iommu-map = <0x0 &smmu 0x0 0x10000>; + status = "disabled"; + }; + }; +}; diff --git a/device_board_phytium/tenglong_e/loader/EFI/BOOT/grub.cfg b/device_board_phytium/tenglong_e/loader/EFI/BOOT/grub.cfg index 65b33a54ca68196fb4ddeb14e3b29b9340045c0d..4b2c8bf7e3303e26189a83a8c301f43adec7a2c7 100755 --- a/device_board_phytium/tenglong_e/loader/EFI/BOOT/grub.cfg +++ b/device_board_phytium/tenglong_e/loader/EFI/BOOT/grub.cfg @@ -1,10 +1,15 @@ # Automatically created by OE serial --unit=0 --speed=115200 --word=8 --parity=no --stop=1 search --no-floppy --set=root -l 'boot' -default=boot -timeout=10 +default="OpenHarmony" +timeout=3 -menuentry 'boot'{ +menuentry 'OpenHarmony'{ linux /Image LABEL=boot root=/dev/ram0 hardware=tenglong_e selinux=0 rootfstype=ext4 loglevel=1 initrd /ramdisk.img } + +menuentry 'Updater'{ +linux /Image LABEL=boot root=/dev/ram0 selinux=0 rootfstype=ext4 loglevel=1 +initrd /updater.img +} diff --git a/device_board_phytium/tenglong_e/updater/BUILD.gn b/device_board_phytium/tenglong_e/updater/BUILD.gn new file mode 100644 index 0000000000000000000000000000000000000000..34c3bd7f7f5b045b0011948e8bb07462ed339d77 --- /dev/null +++ b/device_board_phytium/tenglong_e/updater/BUILD.gn @@ -0,0 +1,76 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//build/ohos.gni") +partname="device_${device_name}" +updater_ueventd_cfg = "//base/startup/init/services/etc/ueventd.cfg" + +ohos_prebuilt_etc("updater_ueventd.cfg") { + source = "${updater_ueventd_cfg}" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("updater_init.cfg") { + source = "config/init.cfg" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("updater_init_usb.cfg") { + source = "config/init.usb.cfg" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("signing_cert.crt") { + source = "config/signing_cert.crt" + module_install_dir = "etc/certificate" + install_images = [ + "system", + "updater", + ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("fstab.updater") { + source = "config/fstab.updater" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("hdc_network.sh") { + source = "config/hdc_network.sh" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_executable("busybox") { + source = "config/busybox" + module_install_dir = "bin" + install_enable = true + install_images = [ "updater" ] + part_name = "${partname}" +} + +group("updater_files") { + deps = [ + ":fstab.updater", + ":signing_cert.crt", + ":updater_init.cfg", + ":updater_init_usb.cfg", + ":updater_ueventd.cfg", + ":hdc_network.sh", + ":busybox", + ] +} diff --git a/device_board_phytium/tenglong_e/updater/config/busybox b/device_board_phytium/tenglong_e/updater/config/busybox new file mode 100644 index 0000000000000000000000000000000000000000..e26fb0d1643035461592c2da824cc163e6d03f77 Binary files /dev/null and b/device_board_phytium/tenglong_e/updater/config/busybox differ diff --git a/device_board_phytium/tenglong_e/updater/config/fstab.updater b/device_board_phytium/tenglong_e/updater/config/fstab.updater new file mode 100644 index 0000000000000000000000000000000000000000..3dcebb698722f94eb447ef88794428fc8dcd8413 --- /dev/null +++ b/device_board_phytium/tenglong_e/updater/config/fstab.updater @@ -0,0 +1,6 @@ +#SATA hard disk and USB disk config +/dev/block/sda2 /usr ext4 ro,barrier=1 wait +/dev/block/sda3 /vendor ext4 ro,barrier=1 wait +/dev/block/sda4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 +/dev/block/sda5 /misc none none wait +/dev/block/sda6 /sdcard ext4 rw wait \ No newline at end of file diff --git a/device_board_phytium/tenglong_e/updater/config/hdc_network.sh b/device_board_phytium/tenglong_e/updater/config/hdc_network.sh new file mode 100644 index 0000000000000000000000000000000000000000..97f4d087c2f93f1ec8cf5fef528aea632af7802a --- /dev/null +++ b/device_board_phytium/tenglong_e/updater/config/hdc_network.sh @@ -0,0 +1,26 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +#!/bin/bash +mkdir /mnt +chmod a+x /bin/busybox + +echo 0 99999999 | tee /proc/sys/net/ipv4/ping_group_range #放宽ICMP权限 +ifconfig eth0 192.168.3.128 #配置ip,示例使用的是路由器。如果不是路由器,手动配置还需添加网关、子网掩码 + +param set const.security.developermode.state true +param set persist.hdc.port 8710 +param set persist.hdc.mode.tcp enable + +sleep 5 #等待hdc服务重启 +hdcd -t #使能tcp功能 \ No newline at end of file diff --git a/device_board_phytium/tenglong_e/updater/config/init.cfg b/device_board_phytium/tenglong_e/updater/config/init.cfg new file mode 100644 index 0000000000000000000000000000000000000000..a48b5102346df437de7eb83a33c0dc53b004a96a --- /dev/null +++ b/device_board_phytium/tenglong_e/updater/config/init.cfg @@ -0,0 +1,37 @@ +{ + "import" : [ + "/etc/ueventd.cfg", + "/etc/updater_common.cfg", + "/etc/init.usb.cfg" + ], + "jobs" : [{ + "name" : "pre-init", + "cmds" : [ + "start ueventd" + ] + }, { + "name" : "init", + "cmds" : [ + "exec /bin/sh /etc/hdc_network.sh", + "wait /dev/block/platform/soc/40000000.pcie", + "symlink /dev/block/sda5 /dev/block/by-name/misc" + ] + }, { + "name" : "post-fs-data", + "cmds" : [ + "exec /system/bin/hilog -w start -n 10 -f updater", + "exec /system/bin/hilog -w start -t kmsg -f updater_kmsg" + ] + } + ], + "services" : [{ + "name" : "updater", + "path" : ["/bin/updater"], + "uid" : 0, + "gid" : [0, "update", "input_user_host", "shell", "graphics", "system"], + "importance" : 0, + "secon" : "u:r:updater:s0", + "caps" : [0, 1] + } + ] +} diff --git a/device_board_phytium/tenglong_e/updater/config/init.usb.cfg b/device_board_phytium/tenglong_e/updater/config/init.usb.cfg new file mode 100644 index 0000000000000000000000000000000000000000..8db2d7a0b1a0276d7fc2083e25e46a49d65d90b2 --- /dev/null +++ b/device_board_phytium/tenglong_e/updater/config/init.usb.cfg @@ -0,0 +1,74 @@ +{ + "jobs" : [{ + "name" : "boot", + "cmds" : [ + "mkdir /config 0770 shell shell", + "mkdir /dev/usb-ffs 0770 shell shell", + "mkdir /dev/usb-ffs/hdc 0770 shell shell", + "mount configfs none /config", + "mkdir /config/usb_gadget/g1 0770 shell shell", + "write /config/usb_gadget/g1/idVendor 0x2207", + "write /config/usb_gadget/g1/idProduct 0x0018", + "write /config/usb_gadget/g1/os_desc/use 1", + "write /config/usb_gadget/g1/bcdDevice 0x0223", + "write /config/usb_gadget/g1/bcdUSB 0x0200", + "mkdir /config/usb_gadget/g1/strings/0x409 0770", + "copy /sys/block/mmcblk0/device/cid /config/usb_gadget/g1/strings/0x409/serialnumber", + "write /config/usb_gadget/g1/strings/0x409/manufacturer Rockchip", + "write /config/usb_gadget/g1/strings/0x409/product \"HDC Device\"", + "mkdir /config/usb_gadget/g1/functions/ffs.hdc", + "mkdir /config/usb_gadget/g1/configs/b.1 0770 shell shell", + "mkdir /config/usb_gadget/g1/configs/b.1/strings/0x409 0770 shell shell", + "write /config/usb_gadget/g1/os_desc/b_vendor_code 0x1", + "write /config/usb_gadget/g1/os_desc/qw_sign MSFT100", + "write /config/usb_gadget/g1/configs/b.1/MaxPower 500", + "symlink /config/usb_gadget/g1/configs/b.1 /config/usb_gadget/g1/os_desc/b.1", + "mount functionfs hdc /dev/usb-ffs/hdc uid=2000,gid=2000", + "setparam sys.usb.configfs 1", + "setparam sys.usb.controller fcc00000.dwc3" + ] + }, { + "name" : "param:sys.usb.config=none && param:sys.usb.configfs=1", + "condition" : "sys.usb.config=none && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/os_desc/use 0", + "setparam sys.usb.ffs.ready 0" + ] + }, { + "name" : "param:init.svc.hdcd=stopped", + "condition" : "init.svc.hdcd=stopped", + "cmds" : [ + "setparam sys.usb.ffs.ready 0" + ] + }, { + "name" : "param:updater.hdc.configfs=1", + "condition" : "updater.hdc.configfs=1", + "cmds" : [ + "setparam sys.usb.config hdc" + ] + }, { + "name" : "param:updater.flashd.configfs=1", + "condition" : "updater.flashd.configfs=1", + "cmds" : [ + "stop hdcd", + "setparam sys.usb.config flashd" + ] + }, { + "name" : "param:sys.usb.ffs.ready=1 && param:sys.usb.config=flashd && param:sys.usb.configfs=1", + "condition" : "sys.usb.ffs.ready=1 && sys.usb.config=flashd && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/configs/b.1/strings/0x409/configuration hdc", + "symlink /config/usb_gadget/g1/functions/ffs.hdc /config/usb_gadget/g1/configs/b.1/f1", + "write /config/usb_gadget/g1/UDC ${sys.usb.controller}", + "setparam sys.usb.state ${sys.usb.config}" + ] + }, { + "name" : "param:sys.usb.config=hdc && param:sys.usb.configfs=1", + "condition" : "sys.usb.config=hdc && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/idProduct 0x5000", + "write /config/usb_gadget/g1/os_desc/use 1" + ] + } + ] +} diff --git a/device_board_phytium/tenglong_e/updater/config/lastword.sh b/device_board_phytium/tenglong_e/updater/config/lastword.sh new file mode 100644 index 0000000000000000000000000000000000000000..eec6883eae463a8102d0039b514b2109cad726d5 --- /dev/null +++ b/device_board_phytium/tenglong_e/updater/config/lastword.sh @@ -0,0 +1,32 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. +mkdir /backdata +mount /dev/block/by-name/userdata /backdata + +if [ -d "/backdata/updater/log/faultlog" ]; +then + rm -rf /backdata/updater/log/faultlog/* + cp /data/log/faultlog/temp/cpp* /backdata/updater/log/faultlog +else + mkdir /backdata/updater/log/faultlog + cp /data/log/faultlog/temp/cpp* /backdata/updater/log/faultlog +fi + +if [ -d "/backdata/updater/log/hilog" ]; +then + rm -rf /backdata/updater/log/hilog/* + cp /data/log/hilog/updater* /backdata/updater/log/hilog +else + mkdir /backdata/updater/log/hilog + cp /data/log/hilog/updater* /backdata/updater/log/hilog +fi diff --git a/device_board_phytium/tenglong_e/updater/config/signing_cert.crt b/device_board_phytium/tenglong_e/updater/config/signing_cert.crt new file mode 100644 index 0000000000000000000000000000000000000000..eca5d72cea8e87bc4b41f4e85570e32fbc23f69e --- /dev/null +++ b/device_board_phytium/tenglong_e/updater/config/signing_cert.crt @@ -0,0 +1,21 @@ +-----BEGIN CERTIFICATE----- +MIIDazCCAlOgAwIBAgIUDbbfN0ry6xlKrFyylM9asKzjANYwDQYJKoZIhvcNAQEL +BQAwRTELMAkGA1UEBhMCQVUxEzARBgNVBAgMClNvbWUtU3RhdGUxITAfBgNVBAoM +GEludGVybmV0IFdpZGdpdHMgUHR5IEx0ZDAeFw0yMTAyMjUxMjA2MTNaFw0yMjAy +MjUxMjA2MTNaMEUxCzAJBgNVBAYTAkFVMRMwEQYDVQQIDApTb21lLVN0YXRlMSEw +HwYDVQQKDBhJbnRlcm5ldCBXaWRnaXRzIFB0eSBMdGQwggEiMA0GCSqGSIb3DQEB +AQUAA4IBDwAwggEKAoIBAQDj1JSf1YKWT/CEZtUtVzyiXgWJK3+PDkRnxP09UWJi +KsB/gKZHT9sFmGUaIe18VI54fB52caF1sNU9v11mX9r1LCG4I+GFBUgKd7xG+rOA +kWyCk7kIHFbXGykz8cO7P1zmA4ue7X51/cQBKy/nrGHqEfUs57lCQYQDlA9n1ahG +U4lo/lOd1n4ESKHgg+BCzBGUJEWnH8h2K/yCLhuD1nGYnwJUy6xI8cabrh2+WSf4 +tJn0oyG+FYVJkAW1wcr2HPnnBDAyuE34sKNVkD4w9S9pTUv5xPRkOH6rEfQxC4vX +BuCR3Vsd9gJS77wParQ8t+Th3qdxlG+OIKFqVfmDaZUtAgMBAAGjUzBRMB0GA1Ud +DgQWBBQR55YSUMEzkyqHQKGQ51bBcqbvazAfBgNVHSMEGDAWgBQR55YSUMEzkyqH +QKGQ51bBcqbvazAPBgNVHRMBAf8EBTADAQH/MA0GCSqGSIb3DQEBCwUAA4IBAQBy +30XquNfGVCOlXBaJJ/gyl5TP0nFZ9iQ9P0Tk6Ya6tN+Nh4lqA4uG1rUqPrQCd0+N +DUnJlwdto8E2fznfJQ0ojkQdlPv3zkqW25QSYTb9wegQ6CnWq2ANnvoXPcSebHXE +yXcEXybgaWkBg3h8VHcwVns5psXSDsprisFGyETBwMIqM15Z81bEpejKz2viW5ow ++c3ToGs8VhymfG3Pbls3nFeFYSD/A4sOOzM+O/ioG4YI6cGfSBztrAShtdvadHL6 +Cbp6X36ZSveGOkfS/Yrq4z/yE2V0kCJXBMo+9SrhxUrwACjMDIdE5YLlw9qpkLQV +t5MJhDWJe6tCRSBSmoA4 +-----END CERTIFICATE----- diff --git a/device_board_phytium/tenglong_e/updater/updater_ramdisk_resource_config.ini b/device_board_phytium/tenglong_e/updater/updater_ramdisk_resource_config.ini new file mode 100644 index 0000000000000000000000000000000000000000..83356235ad9a9eedbc53c562d72c6b3aa8fd9766 --- /dev/null +++ b/device_board_phytium/tenglong_e/updater/updater_ramdisk_resource_config.ini @@ -0,0 +1,5 @@ +# current path: "out/ohos-arm-release/" +# Modification and deletion of section name is not allowed + +[board] +boot_type = two_stages diff --git a/device_board_phytium/tengrui_d/BUILD.gn b/device_board_phytium/tengrui_d/BUILD.gn index 80729e5a6dad02b3e748c8e0b064c5acb275cd0d..db555e5dfe16dc39dc3978e7ffeb55bdfcb547b5 100755 --- a/device_board_phytium/tengrui_d/BUILD.gn +++ b/device_board_phytium/tengrui_d/BUILD.gn @@ -19,8 +19,12 @@ group("${device_name}_group") { "cfg:init_configs", "//device/board/phytium/common/distributedhardware:distributedhardware", "//device/board/phytium/common/build_kernel:build_kernel", - "//vendor/phytium/gpu_model/$gpu_model:gpu_group", + "//vendor/phytium/gpu_model/x100:gpu_group", + "//vendor/phytium/gpu_model/jm:gpu_group", + "//vendor/phytium/gpu_model/amd:gpu_group", + "//vendor/phytium/gpu_model/sw:gpu_group", "//device/soc/phytium/common/hardware/display:display_buffer_model", "//device/soc/phytium/common/hardware/display:display_composer_model", + "updater:updater_files", ] } diff --git a/device_board_phytium/tengrui_d/audio_alsa/alc662_common.h b/device_board_phytium/tengrui_d/audio_alsa/alc662_common.h deleted file mode 100644 index 53912d6cdb92bc1ff5acf40ea56f721feebca3af..0000000000000000000000000000000000000000 --- a/device_board_phytium/tengrui_d/audio_alsa/alc662_common.h +++ /dev/null @@ -1,68 +0,0 @@ -/* - * Copyright (c) 2024 Phyitum Technology Co., Ltd. - * Licensed under the Apache License, Version 2.0 (the "License"); - * you may not use this file except in compliance with the License. - * You may obtain a copy of the License at - * - * http://www.apache.org/licenses/LICENSE-2.0 - * - * Unless required by applicable law or agreed to in writing, software - * distributed under the License is distributed on an "AS IS" BASIS, - * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. - * See the License for the specific language governing permissions and - * limitations under the License. - */ - -#ifndef ALSA_SND_COMMON_H -#define ALSA_SND_COMMON_H - -/* AUDIO CODEC ALC662 amxier definitions */ - -/* SND playback path */ -#define SND_NUMID_MASTER_PLAYBACK_SWICH 31 -#define SND_ELEM_MASTER_PLAYBACK_SWICH "Master Playback Switch" -#define SND_OUT_CARD_ON "on" -#define SND_OUT_CARD_OFF "off" - -/* SND Master Playback Volume */ -#define SND_NUMID_MASTER_PLAYBACK_VOLUME 30 -#define SND_ELEM_MASTER_PLAYBACK_VOLUME "Master Playback Volume" -#define SND_OUT_PLAYBACK_DEFAULT_VOLUME "77" /* min:0 max:87 77=0.6*max */ - -/* SND Front Playback Switch */ -#define SND_NUMID_FRONT_PLAYBACK_SWITCH 3 -#define SND_ELEM_FRONT_PLAYBACK_SWITCH "Front Playback Switch" -#define SND_OUT_CARD_DACR_DACL_ON "on,on" -#define SND_OUT_CARD_DACR_DACL_OFF "off,off" - -/* Front Playback Volume */ -#define SND_NUMID_FRONT_PLAYBACK_VOLUME 2 -#define SND_ELEM_FRONT_PLAYBACK_VOLUME "Front Playback Volume" -#define SND_OUT_FRONT_PLAYBACK_DEFAULT_VOLUME "87" /* min:0 max:87 */ - - -/* Capture Intput Source Path */ -#define SND_NUMID_INPUT_SOURCE 19 -#define SND_ELEM_INPUT_SOURCE "Input Source" -#define SND_IN_CARD_FRONT_MIC "0" /* Front Mic */ -#define SND_IN_CARD_REAR_MIC "1" /* Rear Mic */ -#define SND_IN_CARD_LINE "2" /* Line */ - -/* Capture Input Switch */ -#define SND_NUMID_CAPTURE_SWITCH 22 -#define SND_ELEM_CAPTURE_SWITCH "Capture Switch" -#define SND_IN_CAPTURE_SWITCH_ON "on,on" -#define SND_IN_CAPTURE_SWITCH_OFF "off,off" - -/* cature Volume */ -#define SND_NUMID_CAPTURE_VOLUME 21 -#define SND_ELEM_CAPTURE_VOLUME "Capture Volume" -#define SND_IN_CAPTURE_DEFAULT_VOLUME "58" /* min:0, max:63 */ - -/* Front Playback Volume */ -#define SND_NUMID_REAR_MIC_BOOST_VOLUME 26 -#define SND_ELEM_REAR_MIC_BOOST_VOLUME "Rear Mic Boost Volume" -#define SND_IN_REAR_MIC_BOOST_DEFAULT_VOLUME "1,1" /* min:0,0 max:3,3 step:1,1 */ - - -#endif /* ALSA_SND_COMMON_H */ diff --git a/device_board_phytium/tengrui_d/audio_alsa/common.h b/device_board_phytium/tengrui_d/audio_alsa/common.h deleted file mode 100644 index e489fc535c5a2820a10af302d5c776e69b256d01..0000000000000000000000000000000000000000 --- a/device_board_phytium/tengrui_d/audio_alsa/common.h +++ /dev/null @@ -1,68 +0,0 @@ -/* - * Copyright (c) 2024 Phyitum Technology Co., Ltd. - * Licensed under the Apache License, Version 2.0 (the "License"); - * you may not use this file except in compliance with the License. - * You may obtain a copy of the License at - * - * http://www.apache.org/licenses/LICENSE-2.0 - * - * Unless required by applicable law or agreed to in writing, software - * distributed under the License is distributed on an "AS IS" BASIS, - * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. - * See the License for the specific language governing permissions and - * limitations under the License. - */ - -#ifndef ALSA_SND_COMMON_H -#define ALSA_SND_COMMON_H - -/* AUDIO CODEC ALC897 amxier definitions */ - -/* SND playback path */ -#define SND_NUMID_MASTER_PLAYBACK_SWICH 36 -#define SND_ELEM_MASTER_PLAYBACK_SWICH "Master Playback Switch" -#define SND_OUT_CARD_ON "on" -#define SND_OUT_CARD_OFF "off" - -/* SND Master Playback Volume */ -#define SND_NUMID_MASTER_PLAYBACK_VOLUME 35 -#define SND_ELEM_MASTER_PLAYBACK_VOLUME "Master Playback Volume" -#define SND_OUT_PLAYBACK_DEFAULT_VOLUME "77" /* min:0 max:87 77=0.6*max */ - -/* SND Front Playback Switch */ -#define SND_NUMID_FRONT_PLAYBACK_SWITCH 2 -#define SND_ELEM_FRONT_PLAYBACK_SWITCH "Front Playback Switch" -#define SND_OUT_CARD_DACR_DACL_ON "on,on" -#define SND_OUT_CARD_DACR_DACL_OFF "off,off" - -/* Front Playback Volume */ -#define SND_NUMID_FRONT_PLAYBACK_VOLUME 1 -#define SND_ELEM_FRONT_PLAYBACK_VOLUME "Front Playback Volume" -#define SND_OUT_FRONT_PLAYBACK_DEFAULT_VOLUME "87" /* min:0 max:87 */ - - -/* Capture Intput Source Path */ -#define SND_NUMID_INPUT_SOURCE 21 -#define SND_ELEM_INPUT_SOURCE "Input Source" -#define SND_IN_CARD_FRONT_MIC "0" /* Front Mic */ -#define SND_IN_CARD_REAR_MIC "1" /* Rear Mic */ -#define SND_IN_CARD_LINE "2" /* Line */ - -/* Capture Input Switch */ -#define SND_NUMID_CAPTURE_SWITCH 24 -#define SND_ELEM_CAPTURE_SWITCH "Capture Switch" -#define SND_IN_CAPTURE_SWITCH_ON "on,on" -#define SND_IN_CAPTURE_SWITCH_OFF "off,off" - -/* cature Volume */ -#define SND_NUMID_CAPTURE_VOLUME 23 -#define SND_ELEM_CAPTURE_VOLUME "Capture Volume" -#define SND_IN_CAPTURE_DEFAULT_VOLUME "58" /* min:0, max:63 */ - -/* MIC Boost Volume */ -#define SND_NUMID_REAR_MIC_BOOST_VOLUME 28 -#define SND_ELEM_REAR_MIC_BOOST_VOLUME "Rear Mic Boost Volume" -#define SND_IN_REAR_MIC_BOOST_DEFAULT_VOLUME "1,1" /* min:0,0 max:3,3 step:1,1 */ - - -#endif /* ALSA_SND_COMMON_H */ diff --git a/device_board_phytium/tengrui_d/audio_alsa/vendor_render.c b/device_board_phytium/tengrui_d/audio_alsa/vendor_render.c deleted file mode 100644 index 132e5261de7ffa4d7878976a952ddf1ab99cc276..0000000000000000000000000000000000000000 --- a/device_board_phytium/tengrui_d/audio_alsa/vendor_render.c +++ /dev/null @@ -1,264 +0,0 @@ -/* - * Copyright (c) 2024 Phyitum Technology Co., Ltd. - * Licensed under the Apache License, Version 2.0 (the "License"); - * you may not use this file except in compliance with the License. - * You may obtain a copy of the License at - * - * http://www.apache.org/licenses/LICENSE-2.0 - * - * Unless required by applicable law or agreed to in writing, software - * distributed under the License is distributed on an "AS IS" BASIS, - * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. - * See the License for the specific language governing permissions and - * limitations under the License. - */ - -#include "alsa_snd_render.h" -#include "common.h" - -#define HDF_LOG_TAG HDF_AUDIO_HAL_RENDER - -typedef struct _RENDER_DATA_ { - struct AlsaMixerCtlElement ctrlVolume; - long tempVolume; -}RenderData; - -static int32_t RenderInitImpl(struct AlsaRender *renderIns) -{ - int32_t ret; - struct AlsaMixerCtlElement elem; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)renderIns; - - if (renderIns->priData != NULL) { - return HDF_SUCCESS; - } - CHECK_NULL_PTR_RETURN_DEFAULT(renderIns); - - RenderData *priData = (RenderData *)OsalMemCalloc(sizeof(RenderData)); - if (priData == NULL) { - AUDIO_FUNC_LOGE("Failed to allocate memory!"); - return HDF_FAILURE; - } - - SndElementItemInit(&priData->ctrlVolume); - priData->ctrlVolume.numid = SND_NUMID_MASTER_PLAYBACK_VOLUME; - priData->ctrlVolume.name = SND_ELEM_MASTER_PLAYBACK_VOLUME; - RenderSetPriData(renderIns, (RenderPriData)priData); - - - SndElementItemInit(&elem); - elem.numid = SND_NUMID_FRONT_PLAYBACK_SWITCH; - elem.name = SND_ELEM_FRONT_PLAYBACK_SWITCH; - elem.value = SND_OUT_CARD_DACR_DACL_ON; - ret = SndElementWrite(cardIns, &elem); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("open front playback switch fail!"); - return HDF_FAILURE; - } - - SndElementItemInit(&elem); - elem.numid = SND_NUMID_MASTER_PLAYBACK_VOLUME; - elem.name = SND_ELEM_MASTER_PLAYBACK_VOLUME; - elem.value = SND_OUT_PLAYBACK_DEFAULT_VOLUME; - ret = SndElementWrite(cardIns, &elem); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("set default volume fail!"); - return HDF_FAILURE; - } - - AUDIO_FUNC_LOGI("RenderInitImpl success!"); - return HDF_SUCCESS; -} - -static int32_t RenderSelectSceneImpl(struct AlsaRender *renderIns, enum AudioPortPin descPins, - const struct PathDeviceInfo *deviceInfo) -{ - AUDIO_FUNC_LOGI("Not support descPins"); - return HDF_SUCCESS; -} - -static int32_t RenderGetVolThresholdImpl(struct AlsaRender *renderIns, long *volMin, long *volMax) -{ - int32_t ret; - long _volMin = 0; - long _volMax = 0; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)renderIns; - RenderData *priData = RenderGetPriData(renderIns); - CHECK_NULL_PTR_RETURN_DEFAULT(cardIns); - CHECK_NULL_PTR_RETURN_DEFAULT(priData); - - ret = SndElementReadRange(cardIns, &priData->ctrlVolume, &_volMin, &_volMax); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("SndElementReadRange fail!"); - return HDF_FAILURE; - } - *volMin = _volMin; - *volMax = _volMax; - AUDIO_FUNC_LOGI("RenderGetVolumeImpl min=%ld max=%ld !",_volMin,_volMax); - return HDF_SUCCESS; -} - -static int32_t RenderGetVolumeImpl(struct AlsaRender *renderIns, long *volume) -{ - int32_t ret; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)renderIns; - RenderData *priData = RenderGetPriData(renderIns); - CHECK_NULL_PTR_RETURN_DEFAULT(cardIns); - CHECK_NULL_PTR_RETURN_DEFAULT(priData); - - ret = SndElementReadInt(cardIns, &priData->ctrlVolume, volume); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("Read Volume fail!"); - return HDF_FAILURE; - } - - AUDIO_FUNC_LOGI("RenderGetVolumeImpl %ld !!!!!",*volume); - return HDF_SUCCESS; -} - -static int32_t RenderSetVolumeImpl(struct AlsaRender *renderIns, long volume) -{ - int32_t ret; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)renderIns; - RenderData *priData = RenderGetPriData(renderIns); - CHECK_NULL_PTR_RETURN_DEFAULT(cardIns); - CHECK_NULL_PTR_RETURN_DEFAULT(priData); - - ret = SndElementWriteInt(cardIns, &priData->ctrlVolume, volume); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("Write volume fail!"); - return HDF_FAILURE; - } - AUDIO_FUNC_LOGI("RenderSetVolumeImpl %ld !!!!!",volume); - return HDF_SUCCESS; -} - -static bool RenderGetMuteImpl(struct AlsaRender *renderIns) -{ - return renderIns->muteState; -} - -static int32_t RenderSetMuteImpl(struct AlsaRender *renderIns, bool muteFlag) -{ - int32_t ret; - long vol, setVol; - RenderData *priData = RenderGetPriData(renderIns); - CHECK_NULL_PTR_RETURN_DEFAULT(renderIns); - CHECK_NULL_PTR_RETURN_DEFAULT(priData); - - ret = renderIns->GetVolume(renderIns, &vol); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("GetVolume failed!"); - return HDF_FAILURE; - } - - if (muteFlag) { - priData->tempVolume = vol; - setVol = 0; - } else { - setVol = priData->tempVolume; - } - - renderIns->SetVolume(renderIns, setVol); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("SetVolume failed!"); - return HDF_FAILURE; - } - renderIns->muteState = muteFlag; - - return HDF_SUCCESS; -} - -static int32_t RenderStartImpl(struct AlsaRender *renderIns) -{ - int32_t ret; - struct AlsaMixerCtlElement elem; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)renderIns; - - SndElementItemInit(&elem); - elem.numid = SND_NUMID_MASTER_PLAYBACK_SWICH; - elem.name = SND_ELEM_MASTER_PLAYBACK_SWICH; - elem.value = SND_OUT_CARD_ON; - - ret = SndElementWrite(cardIns, &elem); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("write render fail!"); - return HDF_FAILURE; - } - - AUDIO_FUNC_LOGI("RenderStartImpl success!"); - return HDF_SUCCESS; -} - -static int32_t RenderStopImpl(struct AlsaRender *renderIns) -{ - int32_t ret; - struct AlsaMixerCtlElement elem; - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)renderIns; - - SndElementItemInit(&elem); - elem.numid = SND_NUMID_MASTER_PLAYBACK_SWICH; - elem.name = SND_ELEM_MASTER_PLAYBACK_SWICH; - elem.value = SND_OUT_CARD_OFF; - ret = SndElementWrite(cardIns, &elem); - if (ret != HDF_SUCCESS) { - AUDIO_FUNC_LOGE("write render fail!"); - return HDF_FAILURE; - } - - snd_pcm_drain(renderIns->soundCard.pcmHandle); - AUDIO_FUNC_LOGI("RenderStopImpl success!"); - return HDF_SUCCESS; -} - -static int32_t RenderGetGainThresholdImpl(struct AlsaRender *renderIns, float *gainMin, float *gainMax) -{ - AUDIO_FUNC_LOGI("Not support gain operation"); - return HDF_SUCCESS; -} - -static int32_t RenderGetGainImpl(struct AlsaRender *renderIns, float *volume) -{ - AUDIO_FUNC_LOGI("Not support gain operation"); - return HDF_SUCCESS; -} - -static int32_t RenderSetGainImpl(struct AlsaRender *renderIns, float volume) -{ - AUDIO_FUNC_LOGI("Not support gain operation"); - return HDF_SUCCESS; -} - -static int32_t RenderGetChannelModeImpl(struct AlsaRender *renderIns, enum AudioChannelMode *mode) -{ - return HDF_SUCCESS; -} - -static int32_t RenderSetChannelModeImpl(struct AlsaRender *renderIns, enum AudioChannelMode mode) -{ - return HDF_SUCCESS; -} - -int32_t RenderOverrideFunc(struct AlsaRender *renderIns) -{ - struct AlsaSoundCard *cardIns = (struct AlsaSoundCard *)renderIns; - - if (cardIns->cardType == SND_CARD_PRIMARY) { - renderIns->Init = RenderInitImpl; - renderIns->SelectScene = RenderSelectSceneImpl; - renderIns->Start = RenderStartImpl; - renderIns->Stop = RenderStopImpl; - renderIns->GetVolThreshold = RenderGetVolThresholdImpl; - renderIns->GetVolume = RenderGetVolumeImpl; - renderIns->SetVolume = RenderSetVolumeImpl; - renderIns->GetGainThreshold = RenderGetGainThresholdImpl; - renderIns->GetGain = RenderGetGainImpl; - renderIns->SetGain = RenderSetGainImpl; - renderIns->GetMute = RenderGetMuteImpl; - renderIns->SetMute = RenderSetMuteImpl; - renderIns->GetChannelMode = RenderGetChannelModeImpl; - renderIns->SetChannelMode = RenderSetChannelModeImpl; - } - - return HDF_SUCCESS; -} diff --git a/device_board_phytium/tengrui_d/cfg/fstab.tengrui_d b/device_board_phytium/tengrui_d/cfg/fstab.tengrui_d index d70943add5777d1d5a5b2ae85fbf9715de7787bb..4b816b75cd912c79b857ef3907d27c12f91e81e8 100755 --- a/device_board_phytium/tengrui_d/cfg/fstab.tengrui_d +++ b/device_board_phytium/tengrui_d/cfg/fstab.tengrui_d @@ -6,7 +6,7 @@ #/dev/block/sda3 /vendor ext4 ro,barrier=1 wait,required #/dev/block/sda4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 /dev/block/sda4 /data ext4 discard,noatime,nosuid,nodev,usrquota wait,check,fileencryption=software,quota - +/dev/block/sda5 /misc ext4 none wait,required #NVME disk config #/dev/block/nvme0n1p2 /usr ext4 ro,barrier=1 wait,required diff --git a/device_board_phytium/tengrui_d/cfg/init.tengrui_d.cfg b/device_board_phytium/tengrui_d/cfg/init.tengrui_d.cfg index b84e065d3e97cdba4f1e93634dfcae7ade3fec73..1e6c85aa96b48e6f5db3de8f05db2fa90f9f5f0c 100755 --- a/device_board_phytium/tengrui_d/cfg/init.tengrui_d.cfg +++ b/device_board_phytium/tengrui_d/cfg/init.tengrui_d.cfg @@ -19,7 +19,7 @@ "write /proc/sys/kernel/hung_task_timeout_secs 90", "write /sys/kernel/hungtask/enable on", "write /sys/kernel/hungtask/monitorlist whitelist,init,appspawn", - "symlink /dev/block/platform/soc/40000000.pcie/by-name /dev/block/by-name", + "symlink /dev/block/platform/soc/40000000.pcie/ /dev/block/by-name", "chown system system /sys/kernel/hungtask/userlist", "chmod 0666 /dev/pvr_sync", "chmod 0666 /dev/vxd0", @@ -32,13 +32,21 @@ "chmod 0440 /proc/interrupts", "chmod 0440 /proc/stat", "chown system graphics /dev/graphics/fb0", - "start ispserver" + "start ispserver", + "setparam persist.hdc.mode tcp", + "setparam persist.hdc.port 8710", + "setparam persist.hdc.root 1", + "setparam persist.hdc.mode.tcp enable", + "setparam const.security.developermode.state true" ] }, { "name" : "post-fs-data", "cmds" : [ + "copy /system/etc/gpu_cur /data/system/gpu_cur", + "chown system system /data/system/gpu_cur", + "chmod 0664 /data/system/gpu_cur", "restorecon", - "param set const.security.developermode.state true" + "restorecon /data/updater" ] } ], diff --git a/device_board_phytium/tengrui_d/loader/EFI/BOOT/grub.cfg b/device_board_phytium/tengrui_d/loader/EFI/BOOT/grub.cfg index ea90fad71ef313c49414298d899d2f524d018a2c..c21ca19f9f5e1c991c10815437d8e335e8c90b54 100755 --- a/device_board_phytium/tengrui_d/loader/EFI/BOOT/grub.cfg +++ b/device_board_phytium/tengrui_d/loader/EFI/BOOT/grub.cfg @@ -1,10 +1,15 @@ # Automatically created by OE serial --unit=0 --speed=115200 --word=8 --parity=no --stop=1 search --no-floppy --set=root -l 'boot' -default=boot -timeout=10 +default="OpenHarmony" +timeout=3 -menuentry 'boot'{ +menuentry 'OpenHarmony'{ linux /Image LABEL=boot root=/dev/ram0 hardware=tengrui_d selinux=0 rootfstype=ext4 loglevel=1 initrd /ramdisk.img } + +menuentry 'Updater'{ +linux /Image LABEL=boot root=/dev/ram0 selinux=0 rootfstype=ext4 loglevel=1 +initrd /updater.img +} diff --git a/device_board_phytium/tengrui_d/updater/BUILD.gn b/device_board_phytium/tengrui_d/updater/BUILD.gn new file mode 100644 index 0000000000000000000000000000000000000000..34c3bd7f7f5b045b0011948e8bb07462ed339d77 --- /dev/null +++ b/device_board_phytium/tengrui_d/updater/BUILD.gn @@ -0,0 +1,76 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//build/ohos.gni") +partname="device_${device_name}" +updater_ueventd_cfg = "//base/startup/init/services/etc/ueventd.cfg" + +ohos_prebuilt_etc("updater_ueventd.cfg") { + source = "${updater_ueventd_cfg}" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("updater_init.cfg") { + source = "config/init.cfg" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("updater_init_usb.cfg") { + source = "config/init.usb.cfg" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("signing_cert.crt") { + source = "config/signing_cert.crt" + module_install_dir = "etc/certificate" + install_images = [ + "system", + "updater", + ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("fstab.updater") { + source = "config/fstab.updater" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_etc("hdc_network.sh") { + source = "config/hdc_network.sh" + install_images = [ "updater" ] + part_name = "${partname}" +} + +ohos_prebuilt_executable("busybox") { + source = "config/busybox" + module_install_dir = "bin" + install_enable = true + install_images = [ "updater" ] + part_name = "${partname}" +} + +group("updater_files") { + deps = [ + ":fstab.updater", + ":signing_cert.crt", + ":updater_init.cfg", + ":updater_init_usb.cfg", + ":updater_ueventd.cfg", + ":hdc_network.sh", + ":busybox", + ] +} diff --git a/device_board_phytium/tengrui_d/updater/config/busybox b/device_board_phytium/tengrui_d/updater/config/busybox new file mode 100644 index 0000000000000000000000000000000000000000..e26fb0d1643035461592c2da824cc163e6d03f77 Binary files /dev/null and b/device_board_phytium/tengrui_d/updater/config/busybox differ diff --git a/device_board_phytium/tengrui_d/updater/config/fstab.updater b/device_board_phytium/tengrui_d/updater/config/fstab.updater new file mode 100644 index 0000000000000000000000000000000000000000..3dcebb698722f94eb447ef88794428fc8dcd8413 --- /dev/null +++ b/device_board_phytium/tengrui_d/updater/config/fstab.updater @@ -0,0 +1,6 @@ +#SATA hard disk and USB disk config +/dev/block/sda2 /usr ext4 ro,barrier=1 wait +/dev/block/sda3 /vendor ext4 ro,barrier=1 wait +/dev/block/sda4 /data ext4 nosuid,nodev,noatime,barrier=1,data=ordered,noauto_da_alloc wait,reservedsize=104857600 +/dev/block/sda5 /misc none none wait +/dev/block/sda6 /sdcard ext4 rw wait \ No newline at end of file diff --git a/device_board_phytium/tengrui_d/updater/config/hdc_network.sh b/device_board_phytium/tengrui_d/updater/config/hdc_network.sh new file mode 100644 index 0000000000000000000000000000000000000000..97f4d087c2f93f1ec8cf5fef528aea632af7802a --- /dev/null +++ b/device_board_phytium/tengrui_d/updater/config/hdc_network.sh @@ -0,0 +1,26 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +#!/bin/bash +mkdir /mnt +chmod a+x /bin/busybox + +echo 0 99999999 | tee /proc/sys/net/ipv4/ping_group_range #放宽ICMP权限 +ifconfig eth0 192.168.3.128 #配置ip,示例使用的是路由器。如果不是路由器,手动配置还需添加网关、子网掩码 + +param set const.security.developermode.state true +param set persist.hdc.port 8710 +param set persist.hdc.mode.tcp enable + +sleep 5 #等待hdc服务重启 +hdcd -t #使能tcp功能 \ No newline at end of file diff --git a/device_board_phytium/tengrui_d/updater/config/init.cfg b/device_board_phytium/tengrui_d/updater/config/init.cfg new file mode 100644 index 0000000000000000000000000000000000000000..a48b5102346df437de7eb83a33c0dc53b004a96a --- /dev/null +++ b/device_board_phytium/tengrui_d/updater/config/init.cfg @@ -0,0 +1,37 @@ +{ + "import" : [ + "/etc/ueventd.cfg", + "/etc/updater_common.cfg", + "/etc/init.usb.cfg" + ], + "jobs" : [{ + "name" : "pre-init", + "cmds" : [ + "start ueventd" + ] + }, { + "name" : "init", + "cmds" : [ + "exec /bin/sh /etc/hdc_network.sh", + "wait /dev/block/platform/soc/40000000.pcie", + "symlink /dev/block/sda5 /dev/block/by-name/misc" + ] + }, { + "name" : "post-fs-data", + "cmds" : [ + "exec /system/bin/hilog -w start -n 10 -f updater", + "exec /system/bin/hilog -w start -t kmsg -f updater_kmsg" + ] + } + ], + "services" : [{ + "name" : "updater", + "path" : ["/bin/updater"], + "uid" : 0, + "gid" : [0, "update", "input_user_host", "shell", "graphics", "system"], + "importance" : 0, + "secon" : "u:r:updater:s0", + "caps" : [0, 1] + } + ] +} diff --git a/device_board_phytium/tengrui_d/updater/config/init.usb.cfg b/device_board_phytium/tengrui_d/updater/config/init.usb.cfg new file mode 100644 index 0000000000000000000000000000000000000000..8db2d7a0b1a0276d7fc2083e25e46a49d65d90b2 --- /dev/null +++ b/device_board_phytium/tengrui_d/updater/config/init.usb.cfg @@ -0,0 +1,74 @@ +{ + "jobs" : [{ + "name" : "boot", + "cmds" : [ + "mkdir /config 0770 shell shell", + "mkdir /dev/usb-ffs 0770 shell shell", + "mkdir /dev/usb-ffs/hdc 0770 shell shell", + "mount configfs none /config", + "mkdir /config/usb_gadget/g1 0770 shell shell", + "write /config/usb_gadget/g1/idVendor 0x2207", + "write /config/usb_gadget/g1/idProduct 0x0018", + "write /config/usb_gadget/g1/os_desc/use 1", + "write /config/usb_gadget/g1/bcdDevice 0x0223", + "write /config/usb_gadget/g1/bcdUSB 0x0200", + "mkdir /config/usb_gadget/g1/strings/0x409 0770", + "copy /sys/block/mmcblk0/device/cid /config/usb_gadget/g1/strings/0x409/serialnumber", + "write /config/usb_gadget/g1/strings/0x409/manufacturer Rockchip", + "write /config/usb_gadget/g1/strings/0x409/product \"HDC Device\"", + "mkdir /config/usb_gadget/g1/functions/ffs.hdc", + "mkdir /config/usb_gadget/g1/configs/b.1 0770 shell shell", + "mkdir /config/usb_gadget/g1/configs/b.1/strings/0x409 0770 shell shell", + "write /config/usb_gadget/g1/os_desc/b_vendor_code 0x1", + "write /config/usb_gadget/g1/os_desc/qw_sign MSFT100", + "write /config/usb_gadget/g1/configs/b.1/MaxPower 500", + "symlink /config/usb_gadget/g1/configs/b.1 /config/usb_gadget/g1/os_desc/b.1", + "mount functionfs hdc /dev/usb-ffs/hdc uid=2000,gid=2000", + "setparam sys.usb.configfs 1", + "setparam sys.usb.controller fcc00000.dwc3" + ] + }, { + "name" : "param:sys.usb.config=none && param:sys.usb.configfs=1", + "condition" : "sys.usb.config=none && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/os_desc/use 0", + "setparam sys.usb.ffs.ready 0" + ] + }, { + "name" : "param:init.svc.hdcd=stopped", + "condition" : "init.svc.hdcd=stopped", + "cmds" : [ + "setparam sys.usb.ffs.ready 0" + ] + }, { + "name" : "param:updater.hdc.configfs=1", + "condition" : "updater.hdc.configfs=1", + "cmds" : [ + "setparam sys.usb.config hdc" + ] + }, { + "name" : "param:updater.flashd.configfs=1", + "condition" : "updater.flashd.configfs=1", + "cmds" : [ + "stop hdcd", + "setparam sys.usb.config flashd" + ] + }, { + "name" : "param:sys.usb.ffs.ready=1 && param:sys.usb.config=flashd && param:sys.usb.configfs=1", + "condition" : "sys.usb.ffs.ready=1 && sys.usb.config=flashd && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/configs/b.1/strings/0x409/configuration hdc", + "symlink /config/usb_gadget/g1/functions/ffs.hdc /config/usb_gadget/g1/configs/b.1/f1", + "write /config/usb_gadget/g1/UDC ${sys.usb.controller}", + "setparam sys.usb.state ${sys.usb.config}" + ] + }, { + "name" : "param:sys.usb.config=hdc && param:sys.usb.configfs=1", + "condition" : "sys.usb.config=hdc && sys.usb.configfs=1", + "cmds" : [ + "write /config/usb_gadget/g1/idProduct 0x5000", + "write /config/usb_gadget/g1/os_desc/use 1" + ] + } + ] +} diff --git a/device_board_phytium/tengrui_d/updater/config/lastword.sh b/device_board_phytium/tengrui_d/updater/config/lastword.sh new file mode 100644 index 0000000000000000000000000000000000000000..eec6883eae463a8102d0039b514b2109cad726d5 --- /dev/null +++ b/device_board_phytium/tengrui_d/updater/config/lastword.sh @@ -0,0 +1,32 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. +mkdir /backdata +mount /dev/block/by-name/userdata /backdata + +if [ -d "/backdata/updater/log/faultlog" ]; +then + rm -rf /backdata/updater/log/faultlog/* + cp /data/log/faultlog/temp/cpp* /backdata/updater/log/faultlog +else + mkdir /backdata/updater/log/faultlog + cp /data/log/faultlog/temp/cpp* /backdata/updater/log/faultlog +fi + +if [ -d "/backdata/updater/log/hilog" ]; +then + rm -rf /backdata/updater/log/hilog/* + cp /data/log/hilog/updater* /backdata/updater/log/hilog +else + mkdir /backdata/updater/log/hilog + cp /data/log/hilog/updater* /backdata/updater/log/hilog +fi diff --git a/device_board_phytium/tengrui_d/updater/config/signing_cert.crt b/device_board_phytium/tengrui_d/updater/config/signing_cert.crt new file mode 100644 index 0000000000000000000000000000000000000000..eca5d72cea8e87bc4b41f4e85570e32fbc23f69e --- /dev/null +++ b/device_board_phytium/tengrui_d/updater/config/signing_cert.crt @@ -0,0 +1,21 @@ +-----BEGIN CERTIFICATE----- +MIIDazCCAlOgAwIBAgIUDbbfN0ry6xlKrFyylM9asKzjANYwDQYJKoZIhvcNAQEL +BQAwRTELMAkGA1UEBhMCQVUxEzARBgNVBAgMClNvbWUtU3RhdGUxITAfBgNVBAoM +GEludGVybmV0IFdpZGdpdHMgUHR5IEx0ZDAeFw0yMTAyMjUxMjA2MTNaFw0yMjAy +MjUxMjA2MTNaMEUxCzAJBgNVBAYTAkFVMRMwEQYDVQQIDApTb21lLVN0YXRlMSEw +HwYDVQQKDBhJbnRlcm5ldCBXaWRnaXRzIFB0eSBMdGQwggEiMA0GCSqGSIb3DQEB +AQUAA4IBDwAwggEKAoIBAQDj1JSf1YKWT/CEZtUtVzyiXgWJK3+PDkRnxP09UWJi +KsB/gKZHT9sFmGUaIe18VI54fB52caF1sNU9v11mX9r1LCG4I+GFBUgKd7xG+rOA +kWyCk7kIHFbXGykz8cO7P1zmA4ue7X51/cQBKy/nrGHqEfUs57lCQYQDlA9n1ahG +U4lo/lOd1n4ESKHgg+BCzBGUJEWnH8h2K/yCLhuD1nGYnwJUy6xI8cabrh2+WSf4 +tJn0oyG+FYVJkAW1wcr2HPnnBDAyuE34sKNVkD4w9S9pTUv5xPRkOH6rEfQxC4vX +BuCR3Vsd9gJS77wParQ8t+Th3qdxlG+OIKFqVfmDaZUtAgMBAAGjUzBRMB0GA1Ud +DgQWBBQR55YSUMEzkyqHQKGQ51bBcqbvazAfBgNVHSMEGDAWgBQR55YSUMEzkyqH +QKGQ51bBcqbvazAPBgNVHRMBAf8EBTADAQH/MA0GCSqGSIb3DQEBCwUAA4IBAQBy +30XquNfGVCOlXBaJJ/gyl5TP0nFZ9iQ9P0Tk6Ya6tN+Nh4lqA4uG1rUqPrQCd0+N +DUnJlwdto8E2fznfJQ0ojkQdlPv3zkqW25QSYTb9wegQ6CnWq2ANnvoXPcSebHXE +yXcEXybgaWkBg3h8VHcwVns5psXSDsprisFGyETBwMIqM15Z81bEpejKz2viW5ow ++c3ToGs8VhymfG3Pbls3nFeFYSD/A4sOOzM+O/ioG4YI6cGfSBztrAShtdvadHL6 +Cbp6X36ZSveGOkfS/Yrq4z/yE2V0kCJXBMo+9SrhxUrwACjMDIdE5YLlw9qpkLQV +t5MJhDWJe6tCRSBSmoA4 +-----END CERTIFICATE----- diff --git a/device_board_phytium/tengrui_d/updater/updater_ramdisk_resource_config.ini b/device_board_phytium/tengrui_d/updater/updater_ramdisk_resource_config.ini new file mode 100644 index 0000000000000000000000000000000000000000..83356235ad9a9eedbc53c562d72c6b3aa8fd9766 --- /dev/null +++ b/device_board_phytium/tengrui_d/updater/updater_ramdisk_resource_config.ini @@ -0,0 +1,5 @@ +# current path: "out/ohos-arm-release/" +# Modification and deletion of section name is not allowed + +[board] +boot_type = two_stages diff --git a/device_soc_phytium/common/hardware/display/BUILD.gn b/device_soc_phytium/common/hardware/display/BUILD.gn index 0ee008c8c5e804f4c763dde10a53acd1f3cabf75..03afbf5ae64c208c58e47f9c3e20f09addf7bc40 100755 --- a/device_soc_phytium/common/hardware/display/BUILD.gn +++ b/device_soc_phytium/common/hardware/display/BUILD.gn @@ -208,6 +208,7 @@ ohos_shared_library("display_composer_vendor") { ] deps = [ + ":libdisplay_buffer_vendor", ":libdisplay_buffer_vdi_impl", "${root_path}/third_party/libdrm:libdrm", ] diff --git a/device_soc_phytium/common/hardware/display/src/display_device/drm_connector.cpp b/device_soc_phytium/common/hardware/display/src/display_device/drm_connector.cpp index 23c76c76156a82eec94d080e0dae0fcdce8cae55..353541adca8bc9c189b672f8b2fb521d8872dbd0 100755 --- a/device_soc_phytium/common/hardware/display/src/display_device/drm_connector.cpp +++ b/device_soc_phytium/common/hardware/display/src/display_device/drm_connector.cpp @@ -104,6 +104,7 @@ int32_t DrmConnector::Init(DrmDevice &drmDevice) } else { DISPLAY_LOGW("can not get the brightness prop, can not set the brightness"); } + mDrmDevice = &drmDevice; return DISPLAY_SUCCESS; } @@ -352,6 +353,16 @@ int32_t DrmConnector::GetDisplaySupportedModes(uint32_t *num, DisplayModeInfo *m return DISPLAY_SUCCESS; } + +uint64_t DrmConnector::GetDpmsState(void) +{ + DISPLAY_LOGD("mDpmsState %{public}lu", mDpmsState); + DrmProperty prop; + mDrmDevice->GetConnectorProperty(*this, PROP_DPMS, prop); + mDpmsState = prop.value; + return mDpmsState; +} + int32_t DrmConnector::SetDpmsState(uint64_t dmps) { DISPLAY_LOGD("dmps %{public}" PRIu64 "", dmps); diff --git a/device_soc_phytium/common/hardware/display/src/display_device/drm_connector.h b/device_soc_phytium/common/hardware/display/src/display_device/drm_connector.h index 13f5d28b267b8c9fd04a5b5cbe78672530ff6a2d..dcd4d444de20c5850162e13d9732cffbfcd6e1ff 100755 --- a/device_soc_phytium/common/hardware/display/src/display_device/drm_connector.h +++ b/device_soc_phytium/common/hardware/display/src/display_device/drm_connector.h @@ -108,10 +108,7 @@ public: int32_t UpdateModes(); std::unique_ptr GetModeBlockFromId(int32_t id); int32_t GetModeFromId(int32_t id, DrmMode &mode); - uint64_t GetDpmsState() const - { - return mDpmsState; - } + uint64_t GetDpmsState(void); int32_t SetDpmsState(uint64_t dmps); bool IsConnected() const; bool HandleHotplug(IdMapPtr &encoders, IdMapPtr &crtcs, bool &plugIn); @@ -154,6 +151,7 @@ private: int32_t mPreferenceId = INVALID_MODE_ID; FdPtr mDrmFdPtr; + class DrmDevice *mDrmDevice = nullptr; }; } // namespace OHOS } // namespace HDI diff --git a/device_soc_phytium/common/hardware/display/src/display_device/drm_device.cpp b/device_soc_phytium/common/hardware/display/src/display_device/drm_device.cpp index cece5b2ff3c252fe2ae3dbe8938d1aadf52129f4..ce84eabcbf683c8ca3862e673cd5909753a5b10c 100755 --- a/device_soc_phytium/common/hardware/display/src/display_device/drm_device.cpp +++ b/device_soc_phytium/common/hardware/display/src/display_device/drm_device.cpp @@ -24,6 +24,7 @@ #include "phytium_display_log.h" #include "drm_display.h" #include "drm_vsync_worker.h" +#include "display_gralloc_gbm.h" namespace OHOS { namespace HDI { @@ -31,62 +32,13 @@ namespace DISPLAY { FdPtr DrmDevice::mDrmFd = nullptr; std::shared_ptr DrmDevice::mInstance; -static int OpenKmsCard(DIR *dir, struct dirent *d) { - int fd; - drmModeResPtr res; - - fd = openat(dirfd(dir), d->d_name, O_RDWR | O_CLOEXEC); - - if (fd < 0) { - goto err; - } - res = drmModeGetResources(fd); - if (res == NULL) { - goto err_fd; - } - if (res->count_crtcs <= 0 || - res->count_connectors <= 0 || - res->count_encoders <= 0) { - goto err_res; - } - drmModeFreeResources(res); - return fd; - -err_res: - drmModeFreeResources(res); -err_fd: - close(fd); -err: - return -1; -} - -static int FindAndOpenKmsCard() { - DIR *dir; - struct dirent *d; - int fd = -1; - - dir = opendir("/dev/dri"); - if (!dir) { - return -1; - } - while ((d = readdir(dir))) { - if (strncmp(d->d_name, "card", 4)) { - continue; - } - fd = OpenKmsCard(dir, d); - if (fd >= 0) { - break; - } - } - closedir(dir); - return fd; -} - std::shared_ptr DrmDevice::Create() { DISPLAY_LOGD(); if (mDrmFd == nullptr) { - int drmFd = FindAndOpenKmsCard(); + const char* devicePath = GetDrmFileNodePath(); + DISPLAY_LOGI("Create Device Open Node:%{public}s", devicePath); + int drmFd = open(devicePath, O_RDWR | O_CLOEXEC); if (drmFd < 0) { DISPLAY_LOGE("can't open drm card device"); return nullptr; diff --git a/device_soc_phytium/common/hardware/display/src/display_device/hdi_display.cpp b/device_soc_phytium/common/hardware/display/src/display_device/hdi_display.cpp index 6600a232633ac5770d42c6139a401353c4b9329a..078d9318f8ccddbe7eac601f0655d4bf8611011f 100755 --- a/device_soc_phytium/common/hardware/display/src/display_device/hdi_display.cpp +++ b/device_soc_phytium/common/hardware/display/src/display_device/hdi_display.cpp @@ -226,6 +226,10 @@ int32_t HdiDisplay::Commit(int32_t *fence) int32_t HdiDisplay::SetDisplayClientBuffer(const BufferHandle *buffer, int32_t fence) { mClientLayer->SetLayerBuffer(buffer, fence); + + IRect rect = {0, 0, buffer->width, buffer->height}; + mClientLayer->SetLayerRegion(&rect); + return DISPLAY_SUCCESS; } diff --git a/device_soc_phytium/common/hardware/display/src/display_device/hdi_drm_composition.cpp b/device_soc_phytium/common/hardware/display/src/display_device/hdi_drm_composition.cpp index 9dfdb5ed0e3bb68983744d4b607a507da12b39a5..f9948127acab5043d7becfd2e541e81581897612 100755 --- a/device_soc_phytium/common/hardware/display/src/display_device/hdi_drm_composition.cpp +++ b/device_soc_phytium/common/hardware/display/src/display_device/hdi_drm_composition.cpp @@ -224,9 +224,11 @@ int32_t HdiDrmComposition::Apply(bool modeSet) ret = UpdateMode(modeBlock, *(atomicReqPtr.Get())); DISPLAY_CHK_RETURN((ret != DISPLAY_SUCCESS), DISPLAY_FAILURE, DISPLAY_LOGE("update mode failed")); uint32_t flags = DRM_MODE_ATOMIC_ALLOW_MODESET; + DISPLAY_LOGD("before commit dpms state %{public}lu", mConnector->GetDpmsState()); ret = drmModeAtomicCommit(drmFd, atomicReqPtr.Get(), flags, nullptr); DISPLAY_CHK_RETURN((ret != 0), DISPLAY_FAILURE, DISPLAY_LOGE("drmModeAtomicCommit failed %{public}d errno %{public}d", ret, errno)); + DISPLAY_LOGD("after commit dpms state %{public}lu", mConnector->GetDpmsState()); DISPLAY_LOGD("drmModeAtomicCommit success"); // set the release fence for (auto layer : mCompLayers) { @@ -256,6 +258,8 @@ int32_t HdiDrmComposition::Apply(bool modeSet) mLastCursorGemBuffer = mCurrentCursorGemBuffer; #endif + // mConnector->AtomicChangeDpmsState(); + return DISPLAY_SUCCESS; } int32_t HdiDrmComposition::SetCrtcProperty(DrmPlane &drmPlane, diff --git a/device_soc_phytium/common/hardware/display/src/display_gralloc/display_gralloc_gbm.cpp b/device_soc_phytium/common/hardware/display/src/display_gralloc/display_gralloc_gbm.cpp index d16909d0716361f5ec77996f3a057078b0ef95ca..5143ce04642f8283e8a8cbf07f78917fa9ae5245 100755 --- a/device_soc_phytium/common/hardware/display/src/display_gralloc/display_gralloc_gbm.cpp +++ b/device_soc_phytium/common/hardware/display/src/display_gralloc/display_gralloc_gbm.cpp @@ -1,491 +1,469 @@ -/* - * Copyright (c) 2024 Phytium Technology Co., Ltd. - * Licensed under the Apache License, Version 2.0 (the "License"); - * you may not use this file except in compliance with the License. - * You may obtain a copy of the License at - * - * http://www.apache.org/licenses/LICENSE-2.0 - * - * Unless required by applicable law or agreed to in writing, software - * distributed under the License is distributed on an "AS IS" BASIS, - * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. - * See the License for the specific language governing permissions and - * limitations under the License. - */ - -#include "display_gralloc_gbm.h" -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include "drm_fourcc.h" -#include "phytium_gbm.h" -#include "hdf_dlist.h" -#include "display_gralloc_private.h" -#include "phytium_display_log.h" -#include "v1_0/display_composer_type.h" - -namespace OHOS { -namespace HDI { -namespace DISPLAY { -using namespace OHOS::HDI::Display::Composer::V1_0; -using namespace OHOS::HDI::Display::Buffer::V1_0; - -const char *g_drmFileNode = "/dev/dri/card0"; -const char *g_drmFileNode1 = "/dev/dri/card1"; -static GrallocManager *g_grallocManager = nullptr; -static pthread_mutex_t g_lock; - -using PixelFormatConvertTbl = struct { - uint32_t drmFormat; - PixelFormat pixFormat; -}; - -using ValueStrMap = struct { - uint32_t value; - const char *str; -}; - -static GrallocManager *GetGrallocManager(void) -{ - if (g_grallocManager == nullptr) { - g_grallocManager = (GrallocManager *)malloc(sizeof(GrallocManager)); - errno_t eok = memset_s(g_grallocManager, sizeof(GrallocManager), 0, sizeof(GrallocManager)); - if (eok != EOK) { - DISPLAY_LOGE("memset_s failed"); - } - if (g_grallocManager == nullptr) { - DISPLAY_LOGE("gralloc manager malloc failed"); - } - } - return g_grallocManager; -} - -const char *GetPixelFmtStr(PixelFormat format) -{ - static const ValueStrMap pixelStrMaps[] = { - {PIXEL_FMT_CLUT8, "PIXEL_FMT_CLUT8"}, {PIXEL_FMT_CLUT1, "PIXEL_FMT_CLUT1"}, - {PIXEL_FMT_CLUT4, "PIXEL_FMT_CLUT4"}, {PIXEL_FMT_RGB_565, "PIXEL_FMT_RGB_565"}, - {PIXEL_FMT_RGBA_5658, "IXEL_FMT_RGBA_5658"}, {PIXEL_FMT_RGBX_4444, "PIXEL_FMT_RGBX_4444"}, - {PIXEL_FMT_RGBA_4444, "PIXEL_FMT_RGBA_4444"}, {PIXEL_FMT_RGB_444, "PIXEL_FMT_RGB_444"}, - {PIXEL_FMT_RGBX_5551, "PIXEL_FMT_RGBX_5551"}, {PIXEL_FMT_RGBA_5551, "PIXEL_FMT_RGBA_5551"}, - {PIXEL_FMT_RGB_555, "PIXEL_FMT_RGB_555"}, {PIXEL_FMT_RGBX_8888, "PIXEL_FMT_RGBX_8888"}, - {PIXEL_FMT_RGBA_8888, "PIXEL_FMT_RGBA_8888"}, {PIXEL_FMT_RGB_888, "PIXEL_FMT_RGB_888"}, - {PIXEL_FMT_BGR_565, "PIXEL_FMT_BGR_565"}, {PIXEL_FMT_BGRX_4444, "PIXEL_FMT_BGRX_4444"}, - {PIXEL_FMT_BGRA_4444, "PIXEL_FMT_BGRA_4444"}, {PIXEL_FMT_BGRX_5551, "PIXEL_FMT_BGRX_5551"}, - {PIXEL_FMT_BGRA_5551, "PIXEL_FMT_BGRA_5551"}, {PIXEL_FMT_BGRX_8888, "PIXEL_FMT_BGRX_8888"}, - {PIXEL_FMT_BGRA_8888, "PIXEL_FMT_BGRA_8888"}, {PIXEL_FMT_YUV_422_I, "PIXEL_FMT_YUV_422_I"}, - {PIXEL_FMT_YUV_422_I, "PIXEL_FMT_YUV_422_I"}, {PIXEL_FMT_YCBCR_422_SP, "PIXEL_FMT_YCBCR_422_SP"}, - {PIXEL_FMT_YCRCB_422_SP, "PIXEL_FMT_YCRCB_422_SP"}, {PIXEL_FMT_YCBCR_420_SP, "PIXEL_FMT_YCBCR_420_SP"}, - {PIXEL_FMT_YCRCB_420_SP, "PIXEL_FMT_YCRCB_420_SP"}, {PIXEL_FMT_YCBCR_422_P, "PIXEL_FMT_YCBCR_422_P"}, - {PIXEL_FMT_YCRCB_422_P, "PIXEL_FMT_YCRCB_422_P"}, {PIXEL_FMT_YCBCR_420_P, "PIXEL_FMT_YCBCR_420_P"}, - {PIXEL_FMT_YCRCB_420_P, "PIXEL_FMT_YCRCB_420_P"}, {PIXEL_FMT_YUYV_422_PKG, "PIXEL_FMT_YUYV_422_PKG"}, - {PIXEL_FMT_UYVY_422_PKG, "PIXEL_FMT_UYVY_422_PKG"}, {PIXEL_FMT_YVYU_422_PKG, "PIXEL_FMT_YVYU_422_PKG"}, - {PIXEL_FMT_VYUY_422_PKG, "PIXEL_FMT_VYUY_422_PKG"}, {PIXEL_FMT_BUTT, "PIXEL_FMT_BUTT"}, - }; - static const char *unknown = "unknown format"; - for (uint32_t i = 0; i < sizeof(pixelStrMaps) / sizeof(pixelStrMaps[0]); i++) { - if (pixelStrMaps[i].value == format) { - return pixelStrMaps[i].str; - } - } - DISPLAY_LOGE("GetPixelFmtStr unknown format %{public}d", format); - return unknown; -} - -const char *GetDrmFmtStr(uint32_t format) -{ - static const ValueStrMap formatStrMaps[] = { - {DRM_FORMAT_C8, "DRM_FORMAT_C8" }, {DRM_FORMAT_R8, "DRM_FORMAT_R8" }, - {DRM_FORMAT_R16, "DRM_FORMAT_R16"}, {DRM_FORMAT_RG88, "DRM_FORMAT_RG88"}, - {DRM_FORMAT_GR88, "DRM_FORMAT_GR88"}, {DRM_FORMAT_RG1616, "DRM_FORMAT_RG1616"}, - {DRM_FORMAT_GR1616, "DRM_FORMAT_GR1616"}, {DRM_FORMAT_RGB332, "DRM_FORMAT_RGB332"}, - {DRM_FORMAT_BGR233, "DRM_FORMAT_BGR233"}, {DRM_FORMAT_XRGB4444, "DRM_FORMAT_XRGB4444"}, - {DRM_FORMAT_XBGR4444, "DRM_FORMAT_XBGR4444"}, {DRM_FORMAT_RGBX4444, "DRM_FORMAT_RGBX4444"}, - {DRM_FORMAT_BGRX4444, "DRM_FORMAT_BGRX4444"}, {DRM_FORMAT_ARGB4444, "DRM_FORMAT_ARGB4444"}, - {DRM_FORMAT_ABGR4444, "DRM_FORMAT_ABGR4444"}, {DRM_FORMAT_RGBA4444, "DRM_FORMAT_RGBA4444"}, - {DRM_FORMAT_BGRA4444, "DRM_FORMAT_BGRA4444"}, {DRM_FORMAT_XRGB1555, "DRM_FORMAT_XRGB1555"}, - {DRM_FORMAT_XBGR1555, "DRM_FORMAT_XBGR1555"}, {DRM_FORMAT_RGBX5551, "DRM_FORMAT_RGBX5551"}, - {DRM_FORMAT_BGRX5551, "DRM_FORMAT_BGRX5551"}, {DRM_FORMAT_ARGB1555, "DRM_FORMAT_ARGB1555"}, - {DRM_FORMAT_ABGR1555, "DRM_FORMAT_ABGR1555"}, {DRM_FORMAT_RGBA5551, "DRM_FORMAT_RGBA5551"}, - {DRM_FORMAT_BGRA5551, "DRM_FORMAT_BGRA5551"}, {DRM_FORMAT_RGB565, "DRM_FORMAT_RGB565"}, - {DRM_FORMAT_BGR565, "DRM_FORMAT_BGR565"}, {DRM_FORMAT_RGB888, "DRM_FORMAT_RGB888"}, - {DRM_FORMAT_BGR888, "DRM_FORMAT_BGR888"}, {DRM_FORMAT_XRGB8888, "DRM_FORMAT_XRGB8888"}, - {DRM_FORMAT_XBGR8888, "DRM_FORMAT_XBGR8888"}, {DRM_FORMAT_RGBX8888, "DRM_FORMAT_RGBX8888"}, - {DRM_FORMAT_BGRX8888, "DRM_FORMAT_BGRX8888"}, {DRM_FORMAT_ARGB8888, "DRM_FORMAT_ARGB8888"}, - {DRM_FORMAT_ABGR8888, "DRM_FORMAT_ABGR8888"}, {DRM_FORMAT_RGBA8888, "DRM_FORMAT_RGBA8888"}, - {DRM_FORMAT_BGRA8888, "DRM_FORMAT_BGRA8888"}, {DRM_FORMAT_XRGB2101010, "DRM_FORMAT_XRGB2101010"}, - {DRM_FORMAT_BGRX1010102, "DRM_FORMAT_BGRX1010102"}, {DRM_FORMAT_ARGB2101010, "DRM_FORMAT_ARGB2101010"}, - {DRM_FORMAT_ABGR2101010, "DRM_FORMAT_ABGR2101010"}, {DRM_FORMAT_RGBA1010102, "DRM_FORMAT_RGBA1010102"}, - {DRM_FORMAT_YVYU, "DRM_FORMAT_YVYU"}, {DRM_FORMAT_UYVY, "DRM_FORMAT_UYVY"}, - {DRM_FORMAT_VYUY, "DRM_FORMAT_VYUY"}, {DRM_FORMAT_AYUV, "DRM_FORMAT_AYUV"}, - {DRM_FORMAT_NV12, "DRM_FORMAT_NV12"}, {DRM_FORMAT_NV21, "DRM_FORMAT_NV21"}, - {DRM_FORMAT_NV16, "DRM_FORMAT_NV16"}, {DRM_FORMAT_NV61, "DRM_FORMAT_NV61"}, - {DRM_FORMAT_NV24, "DRM_FORMAT_NV24"}, {DRM_FORMAT_NV42, "DRM_FORMAT_NV42"}, - {DRM_FORMAT_YUV410, "DRM_FORMAT_YUV410"}, {DRM_FORMAT_YVU410, "DRM_FORMAT_YVU410"}, - {DRM_FORMAT_YUV411, "DRM_FORMAT_YUV411"}, {DRM_FORMAT_YVU411, "DRM_FORMAT_YVU411"}, - {DRM_FORMAT_YUV420, "DRM_FORMAT_YUV420"}, {DRM_FORMAT_YVU420, "DRM_FORMAT_YVU420"}, - {DRM_FORMAT_YUV422, "DRM_FORMAT_YUV422"}, {DRM_FORMAT_YVU422, "DRM_FORMAT_YVU422"}, - {DRM_FORMAT_YUV444, "DRM_FORMAT_YUV444"}, {DRM_FORMAT_YVU444, "DRM_FORMAT_YVU444"}, - }; - - static const char *unknown = "unknown drm format"; - for (uint32_t i = 0; i < sizeof(formatStrMaps) / sizeof(formatStrMaps[0]); i++) { - if (formatStrMaps[i].value == format) { - return formatStrMaps[i].str; - } - } - DISPLAY_LOGE("GetDrmFmtStr unknown format %{public}d", format); - return unknown; -} - -static uint32_t ConvertFormatToDrm(PixelFormat fmtIn) -{ - static const PixelFormatConvertTbl convertTable[] = { - {DRM_FORMAT_RGBX8888, PIXEL_FMT_RGBX_8888}, {DRM_FORMAT_RGBA8888, PIXEL_FMT_RGBA_8888}, - {DRM_FORMAT_RGB888, PIXEL_FMT_RGB_888}, {DRM_FORMAT_RGB565, PIXEL_FMT_BGR_565}, - {DRM_FORMAT_BGRX4444, PIXEL_FMT_BGRX_4444}, {DRM_FORMAT_BGRA4444, PIXEL_FMT_BGRA_4444}, - {DRM_FORMAT_RGBA4444, PIXEL_FMT_RGBA_4444}, {DRM_FORMAT_RGBX4444, PIXEL_FMT_RGBX_4444}, - {DRM_FORMAT_BGRX5551, PIXEL_FMT_BGRX_5551}, {DRM_FORMAT_BGRA5551, PIXEL_FMT_BGRA_5551}, - {DRM_FORMAT_BGRX8888, PIXEL_FMT_BGRX_8888}, {DRM_FORMAT_BGRA8888, PIXEL_FMT_BGRA_8888}, - {DRM_FORMAT_NV12, PIXEL_FMT_YCBCR_420_SP}, {DRM_FORMAT_NV21, PIXEL_FMT_YCRCB_420_SP}, - {DRM_FORMAT_YUV420, PIXEL_FMT_YCBCR_420_P}, {DRM_FORMAT_YVU420, PIXEL_FMT_YCRCB_420_P}, - {DRM_FORMAT_NV16, PIXEL_FMT_YCBCR_422_SP}, {DRM_FORMAT_NV61, PIXEL_FMT_YCRCB_422_SP}, - {DRM_FORMAT_YUV422, PIXEL_FMT_YCBCR_422_P}, {DRM_FORMAT_YVU422, PIXEL_FMT_YCRCB_422_P}, - }; - uint32_t fmtOut = 0; - for (uint32_t i = 0; i < sizeof(convertTable) / sizeof(convertTable[0]); i++) { - if (convertTable[i].pixFormat == fmtIn) { - fmtOut = convertTable[i].drmFormat; - } - } - DISPLAY_LOGD("fmtIn %{public}d : %{public}s, outFmt %{public}d : %{public}s", fmtIn, - GetPixelFmtStr(fmtIn), fmtOut, GetDrmFmtStr(fmtOut)); - return fmtOut; -} - -static uint64_t ConvertUsageToGbm(uint64_t inUsage) -{ - uint64_t outUsage = GBM_BO_USE_TEXTURING; - if (inUsage & HBM_USE_CPU_READ) { - outUsage |= GBM_BO_USE_SW_READ_OFTEN; - } - if (inUsage & HBM_USE_CPU_WRITE) { - outUsage |= GBM_BO_USE_SW_WRITE_OFTEN; - } - DISPLAY_LOGD("outUsage 0x%{public}" PRIx64 "", outUsage); - return outUsage; -} - -static int32_t InitGbmDevice(const char *drmFile, GrallocManager *grallocManager) -{ - DISPLAY_LOGD(); - char path[PATH_MAX] = {0}; - if (grallocManager->gbmDevice == nullptr) { - if (realpath(drmFile, path) == nullptr) { - DISPLAY_LOGE(" drm File : %{public}s is not a realpath, errno: %{public}s", drmFile, strerror(errno)); - return HDF_ERR_INVALID_PARAM; - } - int drmFd = open(path, O_RDWR); - if (drmFd < 0) { - DISPLAY_LOGE("drm file:%{public}s open failed %{public}s", drmFile, strerror(errno)); - return HDF_ERR_BAD_FD; - } - drmDropMaster(drmFd); - struct gbm_device *gbmDevice = hdi_gbm_create_device(drmFd); - grallocManager->drmFd = drmFd; - if (gbmDevice == nullptr) { - close(drmFd); - grallocManager->drmFd = -1; - DISPLAY_LOGE("gbm device create failed"); - return HDF_FAILURE; - } - grallocManager->gbmDevice = gbmDevice; - grallocManager->drmFd = drmFd; - DListHeadInit(&grallocManager->gbmBoHead); - } - return HDF_SUCCESS; -} - -static void DeInitGbmDevice(GrallocManager *grallocManager) -{ - DISPLAY_LOGD(); - hdi_gbm_device_destroy(grallocManager->gbmDevice); - if (grallocManager->drmFd > 0) { - close(grallocManager->drmFd); - grallocManager->drmFd = -1; - } - grallocManager->gbmDevice = nullptr; -} - -static int32_t DmaBufferSync(const BufferHandle *handle, bool start) -{ - DISPLAY_LOGD(); - struct dma_buf_sync syncPrm; - errno_t eok = memset_s(&syncPrm, sizeof(syncPrm), 0, sizeof(syncPrm)); - DISPLAY_CHK_RETURN((eok != EOK), HDF_ERR_INVALID_PARAM, DISPLAY_LOGE("dma buffer sync memset_s failed")); - - if (handle->usage & HBM_USE_CPU_WRITE) { - syncPrm.flags |= DMA_BUF_SYNC_WRITE; - } - - if (handle->usage & HBM_USE_CPU_READ) { - syncPrm.flags |= DMA_BUF_SYNC_READ; - } - - if (start) { - syncPrm.flags |= DMA_BUF_SYNC_START; - } else { - syncPrm.flags |= DMA_BUF_SYNC_END; - } - int retry = 6; - int ret; - do { - ret = ioctl(handle->fd, DMA_BUF_IOCTL_SYNC, &syncPrm); - } while ((retry--) && (ret != -EAGAIN) && (ret != -EINTR)); - - if (ret < 0) { - DISPLAY_LOGE("sync failed"); - return HDF_ERR_DEVICE_BUSY; - } - return HDF_SUCCESS; -} - -static void InitBufferHandle(struct gbm_bo *bo, int fd, const AllocInfo *info, PriBufferHandle *buffer) -{ - BufferHandle *bufferHandle = &(buffer->hdl); - bufferHandle->fd = fd; - bufferHandle->reserveFds = 0; - bufferHandle->reserveInts = 0; - bufferHandle->stride = hdi_gbm_bo_get_stride(bo); - bufferHandle->width = hdi_gbm_bo_get_width(bo); - bufferHandle->height = hdi_gbm_bo_get_height(bo); - bufferHandle->usage = info->usage; - bufferHandle->format = info->format; - bufferHandle->virAddr = nullptr; - bufferHandle->size = hdi_gbm_bo_get_size(bo); -} - -int32_t GbmAllocMem(const AllocInfo *info, BufferHandle **buffer) -{ - DISPLAY_CHK_RETURN((info == nullptr), HDF_FAILURE, DISPLAY_LOGE("info is null")); - DISPLAY_CHK_RETURN((buffer == nullptr), HDF_FAILURE, DISPLAY_LOGE("buffer is null")); - PriBufferHandle *priBuffer = nullptr; - uint32_t drmFmt = ConvertFormatToDrm(static_cast(info->format)); - DISPLAY_CHK_RETURN((drmFmt == INVALID_PIXEL_FMT), HDF_ERR_NOT_SUPPORT, - DISPLAY_LOGE("format %{public}d can not support", info->format)); - DISPLAY_LOGD("requeset width %{public}d, heigt %{public}d, format %{public}d", - info->width, info->height, drmFmt); - - GRALLOC_LOCK(); - GrallocManager *grallocManager = GetGrallocManager(); - DISPLAY_CHK_RETURN((grallocManager == nullptr), HDF_ERR_INVALID_PARAM, DISPLAY_LOGE("gralloc manager failed"); - GRALLOC_UNLOCK()); - struct gbm_bo *bo = - hdi_gbm_bo_create(grallocManager->gbmDevice, info->width, info->height, drmFmt, ConvertUsageToGbm(info->usage)); - DISPLAY_CHK_RETURN((bo == nullptr), HDF_DEV_ERR_NO_MEMORY, DISPLAY_LOGE("gbm create bo failed"); \ - GRALLOC_UNLOCK()); - - int fd = hdi_gbm_bo_get_fd(bo); - DISPLAY_CHK_RETURN((fd < 0), HDF_ERR_BAD_FD, DISPLAY_LOGE("gbm can not get fd"); \ - hdi_gbm_bo_destroy(bo); \ - GRALLOC_UNLOCK()); - - priBuffer = (PriBufferHandle *)malloc(sizeof(PriBufferHandle)); - if (priBuffer == nullptr) { - DISPLAY_LOGE("bufferhandle malloc failed"); - close(fd); - hdi_gbm_bo_destroy(bo); - GRALLOC_UNLOCK(); - return HDF_FAILURE; - } - - errno_t eok = memset_s(priBuffer, sizeof(PriBufferHandle), 0, sizeof(PriBufferHandle)); - if (eok != EOK) { - DISPLAY_LOGE("memset_s failed"); - close(fd); - hdi_gbm_bo_destroy(bo); - if (priBuffer != nullptr) { - free(priBuffer); - } - GRALLOC_UNLOCK(); - return HDF_FAILURE; - } - - InitBufferHandle(bo, fd, info, priBuffer); - *buffer = &priBuffer->hdl; - hdi_gbm_bo_destroy(bo); - GRALLOC_UNLOCK(); - return HDF_SUCCESS; -} - -static void CloseBufferHandle(BufferHandle *handle) -{ - DISPLAY_CHK_RETURN_NOT_VALUE((handle == nullptr), DISPLAY_LOGE("buffer is null")); - if (handle->fd >= 0) { - close(handle->fd); - handle->fd = -1; - } - const uint32_t reserveFds = handle->reserveFds; - for (uint32_t i = 0; i < reserveFds; i++) { - if (handle->reserve[i] >= 0) { - close(handle->reserve[i]); - handle->reserve[i] = -1; - } - } -} - -void GbmFreeMem(BufferHandle *buffer) -{ - DISPLAY_LOGD(); - DISPLAY_CHK_RETURN_NOT_VALUE((buffer == nullptr), DISPLAY_LOGE("buffer is null")); - if ((buffer->virAddr != nullptr) && (GbmUnmap(buffer) != HDF_SUCCESS)) { - DISPLAY_LOGE("freeMem unmap buffer failed"); - } - CloseBufferHandle(buffer); - free(buffer); -} - -void *GbmMmap(BufferHandle *buffer) -{ - void *virAddr = nullptr; - DISPLAY_LOGD(); - if (buffer == nullptr) { - DISPLAY_LOGE("gbmmap the buffer handle is nullptr"); - return nullptr; - } - if (buffer->virAddr != nullptr) { - DISPLAY_LOGD("the buffer has virtual addr"); - return buffer->virAddr; - } - virAddr = mmap(nullptr, buffer->size, PROT_READ | PROT_WRITE, MAP_SHARED, buffer->fd, 0); - if (virAddr == reinterpret_cast(MAP_FAILED)) { - DISPLAY_LOGE("mmap failed errno %{public}s, fd : %{public}d", strerror(errno), buffer->fd); - } - buffer->virAddr = virAddr; - return virAddr; -} - -int32_t GbmUnmap(BufferHandle *buffer) -{ - DISPLAY_LOGD(); - if (buffer == nullptr) { - DISPLAY_LOGE("gbmumap the buffer handle is null"); - return HDF_FAILURE; - } - - if (buffer->virAddr == nullptr) { - DISPLAY_LOGE("virAddr is nullptr , has not map the buffer"); - return HDF_ERR_INVALID_PARAM; - } - int ret = munmap(buffer->virAddr, buffer->size); - if (ret != 0) { - DISPLAY_LOGE("munmap failed err: %{public}s", strerror(errno)); - return HDF_FAILURE; - } - buffer->virAddr = nullptr; - return HDF_SUCCESS; -} - -int32_t GbmInvalidateCache(BufferHandle *buffer) -{ - DISPLAY_LOGD(); - return DmaBufferSync(buffer, true); -} - -int32_t GbmFlushCache(BufferHandle *buffer) -{ - DISPLAY_LOGD(); - return DmaBufferSync(buffer, false); -} - -int32_t GbmGrallocUninitialize(void) -{ - DISPLAY_LOGD(); - GRALLOC_LOCK(); - GrallocManager *grallocManager = GetGrallocManager(); - DISPLAY_CHK_RETURN((grallocManager == nullptr), HDF_ERR_INVALID_PARAM, DISPLAY_LOGE("gralloc manager failed"); \ - GRALLOC_UNLOCK()); - grallocManager->referCount--; - if (grallocManager->referCount < 0) { - DeInitGbmDevice(grallocManager); - free(g_grallocManager); - g_grallocManager = nullptr; - } - GRALLOC_UNLOCK(); - return HDF_SUCCESS; -} - -static bool isPvrCard(const char *drmFile){ - char *driver; - int fd = open(drmFile, O_RDWR | O_CLOEXEC); - if (fd < 0) { - perror("open"); - DISPLAY_LOGE("failed to open %{public}s: %{public}s", drmFile, strerror(errno)); - return false; - } - drmVersionPtr version = drmGetVersion(fd); - - if (!version) { - DISPLAY_LOGE("failed drmGetVersion for drmFile %{public}s fd %{public}d", drmFile, fd); - close(fd); - return false; - } - - driver = strndup(version->name, version->name_len); - DISPLAY_LOGE("using driver %{public}s for %{public}d", - driver, fd); - - drmFreeVersion(version); - close(fd); - if(strcmp("pvr", driver) == 0){ - DISPLAY_LOGE("drmFile:%{public}s is pvr card", drmFile); - return true; - } - return false; -} - -int32_t GbmGrallocInitialize(void) -{ - DISPLAY_LOGD(); - GRALLOC_LOCK(); - GrallocManager *grallocManager = GetGrallocManager(); - DISPLAY_CHK_RETURN((grallocManager == nullptr), HDF_ERR_INVALID_PARAM, DISPLAY_LOGE("gralloc manager failed"); \ - GRALLOC_UNLOCK()); - /** - * @brief - * 逻辑处理如下: - * 1.首先判断card1是否存在,存在如果不是pvr gpu的节点,则使用card1 - * 2.如果不存在,则使用card0 - */ - int ret = -1; - if (access(g_drmFileNode1, F_OK) != -1) {//card1存在,还要处理D2000上的逻辑 - if(isPvrCard(g_drmFileNode1)){//使用card0 - DISPLAY_LOGI("card1 is pvr gpu, so use card0"); - ret = InitGbmDevice(g_drmFileNode, grallocManager); - }else{//使用card1 - DISPLAY_LOGI("use card1"); - ret = InitGbmDevice(g_drmFileNode1, grallocManager); - } - } else { - ret = InitGbmDevice(g_drmFileNode, grallocManager); - DISPLAY_LOGI("only g_drmFileNode exist, so use g_drmFileNode"); - } - DISPLAY_CHK_RETURN((ret != HDF_SUCCESS), ret, DISPLAY_LOGE("gralloc manager failed"); \ - GRALLOC_UNLOCK()); - grallocManager->referCount++; - GRALLOC_UNLOCK(); - return HDF_SUCCESS; -} -} // namespace DISPLAY -} // namespace HDI -} // namespace OHOS +/* + * Copyright (c) 2024 Phytium Technology Co., Ltd. + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#include "display_gralloc_gbm.h" +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "drm_fourcc.h" +#include "phytium_gbm.h" +#include "hdf_dlist.h" +#include "display_gralloc_private.h" +#include "phytium_display_log.h" +#include "v1_0/display_composer_type.h" + +namespace OHOS { +namespace HDI { +namespace DISPLAY { +using namespace OHOS::HDI::Display::Composer::V1_0; +using namespace OHOS::HDI::Display::Buffer::V1_0; + +const char *g_drmFileNode0 = "/dev/dri/card0"; +const char *g_drmFileNode1 = "/dev/dri/card1"; +const char *g_drmFileNode2 = "/dev/dri/card2"; +static GrallocManager *g_grallocManager = nullptr; +static pthread_mutex_t g_lock; + +using PixelFormatConvertTbl = struct { + uint32_t drmFormat; + PixelFormat pixFormat; +}; + +using ValueStrMap = struct { + uint32_t value; + const char *str; +}; + +/** +* @brief +* hck: +* tenglong_e: tenglong_e-card0 +* tenglong_e+amdgpu: amdgpu-card0 amdgpu-renderD128 tendlong_e-card1 +* tenglong_e+x100: tenglong_e-card0 x100_dc-card1 x100_pvr-card2 x100-renderD128 +* tengrui_d+amdgpu: amdgpu-card0 amdgpu-renderD128 +* tengrui_d+x100: x100_dc-card0 x100_pvr-card1 x100-renderD128 +*/ +const char* GetDrmFileNodePath(void) { + DISPLAY_LOGD(); + if (access(g_drmFileNode2, F_OK) != -1) { + DISPLAY_LOGI("tenglonge+x100: use card1"); + return g_drmFileNode1; + } else { + DISPLAY_LOGI("use card0"); + return g_drmFileNode0; + } +} + +static GrallocManager *GetGrallocManager(void) +{ + if (g_grallocManager == nullptr) { + g_grallocManager = (GrallocManager *)malloc(sizeof(GrallocManager)); + errno_t eok = memset_s(g_grallocManager, sizeof(GrallocManager), 0, sizeof(GrallocManager)); + if (eok != EOK) { + DISPLAY_LOGE("memset_s failed"); + } + if (g_grallocManager == nullptr) { + DISPLAY_LOGE("gralloc manager malloc failed"); + } + } + return g_grallocManager; +} + +const char *GetPixelFmtStr(PixelFormat format) +{ + static const ValueStrMap pixelStrMaps[] = { + {PIXEL_FMT_CLUT8, "PIXEL_FMT_CLUT8"}, {PIXEL_FMT_CLUT1, "PIXEL_FMT_CLUT1"}, + {PIXEL_FMT_CLUT4, "PIXEL_FMT_CLUT4"}, {PIXEL_FMT_RGB_565, "PIXEL_FMT_RGB_565"}, + {PIXEL_FMT_RGBA_5658, "IXEL_FMT_RGBA_5658"}, {PIXEL_FMT_RGBX_4444, "PIXEL_FMT_RGBX_4444"}, + {PIXEL_FMT_RGBA_4444, "PIXEL_FMT_RGBA_4444"}, {PIXEL_FMT_RGB_444, "PIXEL_FMT_RGB_444"}, + {PIXEL_FMT_RGBX_5551, "PIXEL_FMT_RGBX_5551"}, {PIXEL_FMT_RGBA_5551, "PIXEL_FMT_RGBA_5551"}, + {PIXEL_FMT_RGB_555, "PIXEL_FMT_RGB_555"}, {PIXEL_FMT_RGBX_8888, "PIXEL_FMT_RGBX_8888"}, + {PIXEL_FMT_RGBA_8888, "PIXEL_FMT_RGBA_8888"}, {PIXEL_FMT_RGB_888, "PIXEL_FMT_RGB_888"}, + {PIXEL_FMT_BGR_565, "PIXEL_FMT_BGR_565"}, {PIXEL_FMT_BGRX_4444, "PIXEL_FMT_BGRX_4444"}, + {PIXEL_FMT_BGRA_4444, "PIXEL_FMT_BGRA_4444"}, {PIXEL_FMT_BGRX_5551, "PIXEL_FMT_BGRX_5551"}, + {PIXEL_FMT_BGRA_5551, "PIXEL_FMT_BGRA_5551"}, {PIXEL_FMT_BGRX_8888, "PIXEL_FMT_BGRX_8888"}, + {PIXEL_FMT_BGRA_8888, "PIXEL_FMT_BGRA_8888"}, {PIXEL_FMT_YUV_422_I, "PIXEL_FMT_YUV_422_I"}, + {PIXEL_FMT_YUV_422_I, "PIXEL_FMT_YUV_422_I"}, {PIXEL_FMT_YCBCR_422_SP, "PIXEL_FMT_YCBCR_422_SP"}, + {PIXEL_FMT_YCRCB_422_SP, "PIXEL_FMT_YCRCB_422_SP"}, {PIXEL_FMT_YCBCR_420_SP, "PIXEL_FMT_YCBCR_420_SP"}, + {PIXEL_FMT_YCRCB_420_SP, "PIXEL_FMT_YCRCB_420_SP"}, {PIXEL_FMT_YCBCR_422_P, "PIXEL_FMT_YCBCR_422_P"}, + {PIXEL_FMT_YCRCB_422_P, "PIXEL_FMT_YCRCB_422_P"}, {PIXEL_FMT_YCBCR_420_P, "PIXEL_FMT_YCBCR_420_P"}, + {PIXEL_FMT_YCRCB_420_P, "PIXEL_FMT_YCRCB_420_P"}, {PIXEL_FMT_YUYV_422_PKG, "PIXEL_FMT_YUYV_422_PKG"}, + {PIXEL_FMT_UYVY_422_PKG, "PIXEL_FMT_UYVY_422_PKG"}, {PIXEL_FMT_YVYU_422_PKG, "PIXEL_FMT_YVYU_422_PKG"}, + {PIXEL_FMT_VYUY_422_PKG, "PIXEL_FMT_VYUY_422_PKG"}, {PIXEL_FMT_BUTT, "PIXEL_FMT_BUTT"}, + }; + static const char *unknown = "unknown format"; + for (uint32_t i = 0; i < sizeof(pixelStrMaps) / sizeof(pixelStrMaps[0]); i++) { + if (pixelStrMaps[i].value == format) { + return pixelStrMaps[i].str; + } + } + DISPLAY_LOGE("GetPixelFmtStr unknown format %{public}d", format); + return unknown; +} + +const char *GetDrmFmtStr(uint32_t format) +{ + static const ValueStrMap formatStrMaps[] = { + {DRM_FORMAT_C8, "DRM_FORMAT_C8" }, {DRM_FORMAT_R8, "DRM_FORMAT_R8" }, + {DRM_FORMAT_R16, "DRM_FORMAT_R16"}, {DRM_FORMAT_RG88, "DRM_FORMAT_RG88"}, + {DRM_FORMAT_GR88, "DRM_FORMAT_GR88"}, {DRM_FORMAT_RG1616, "DRM_FORMAT_RG1616"}, + {DRM_FORMAT_GR1616, "DRM_FORMAT_GR1616"}, {DRM_FORMAT_RGB332, "DRM_FORMAT_RGB332"}, + {DRM_FORMAT_BGR233, "DRM_FORMAT_BGR233"}, {DRM_FORMAT_XRGB4444, "DRM_FORMAT_XRGB4444"}, + {DRM_FORMAT_XBGR4444, "DRM_FORMAT_XBGR4444"}, {DRM_FORMAT_RGBX4444, "DRM_FORMAT_RGBX4444"}, + {DRM_FORMAT_BGRX4444, "DRM_FORMAT_BGRX4444"}, {DRM_FORMAT_ARGB4444, "DRM_FORMAT_ARGB4444"}, + {DRM_FORMAT_ABGR4444, "DRM_FORMAT_ABGR4444"}, {DRM_FORMAT_RGBA4444, "DRM_FORMAT_RGBA4444"}, + {DRM_FORMAT_BGRA4444, "DRM_FORMAT_BGRA4444"}, {DRM_FORMAT_XRGB1555, "DRM_FORMAT_XRGB1555"}, + {DRM_FORMAT_XBGR1555, "DRM_FORMAT_XBGR1555"}, {DRM_FORMAT_RGBX5551, "DRM_FORMAT_RGBX5551"}, + {DRM_FORMAT_BGRX5551, "DRM_FORMAT_BGRX5551"}, {DRM_FORMAT_ARGB1555, "DRM_FORMAT_ARGB1555"}, + {DRM_FORMAT_ABGR1555, "DRM_FORMAT_ABGR1555"}, {DRM_FORMAT_RGBA5551, "DRM_FORMAT_RGBA5551"}, + {DRM_FORMAT_BGRA5551, "DRM_FORMAT_BGRA5551"}, {DRM_FORMAT_RGB565, "DRM_FORMAT_RGB565"}, + {DRM_FORMAT_BGR565, "DRM_FORMAT_BGR565"}, {DRM_FORMAT_RGB888, "DRM_FORMAT_RGB888"}, + {DRM_FORMAT_BGR888, "DRM_FORMAT_BGR888"}, {DRM_FORMAT_XRGB8888, "DRM_FORMAT_XRGB8888"}, + {DRM_FORMAT_XBGR8888, "DRM_FORMAT_XBGR8888"}, {DRM_FORMAT_RGBX8888, "DRM_FORMAT_RGBX8888"}, + {DRM_FORMAT_BGRX8888, "DRM_FORMAT_BGRX8888"}, {DRM_FORMAT_ARGB8888, "DRM_FORMAT_ARGB8888"}, + {DRM_FORMAT_ABGR8888, "DRM_FORMAT_ABGR8888"}, {DRM_FORMAT_RGBA8888, "DRM_FORMAT_RGBA8888"}, + {DRM_FORMAT_BGRA8888, "DRM_FORMAT_BGRA8888"}, {DRM_FORMAT_XRGB2101010, "DRM_FORMAT_XRGB2101010"}, + {DRM_FORMAT_BGRX1010102, "DRM_FORMAT_BGRX1010102"}, {DRM_FORMAT_ARGB2101010, "DRM_FORMAT_ARGB2101010"}, + {DRM_FORMAT_ABGR2101010, "DRM_FORMAT_ABGR2101010"}, {DRM_FORMAT_RGBA1010102, "DRM_FORMAT_RGBA1010102"}, + {DRM_FORMAT_YVYU, "DRM_FORMAT_YVYU"}, {DRM_FORMAT_UYVY, "DRM_FORMAT_UYVY"}, + {DRM_FORMAT_VYUY, "DRM_FORMAT_VYUY"}, {DRM_FORMAT_AYUV, "DRM_FORMAT_AYUV"}, + {DRM_FORMAT_NV12, "DRM_FORMAT_NV12"}, {DRM_FORMAT_NV21, "DRM_FORMAT_NV21"}, + {DRM_FORMAT_NV16, "DRM_FORMAT_NV16"}, {DRM_FORMAT_NV61, "DRM_FORMAT_NV61"}, + {DRM_FORMAT_NV24, "DRM_FORMAT_NV24"}, {DRM_FORMAT_NV42, "DRM_FORMAT_NV42"}, + {DRM_FORMAT_YUV410, "DRM_FORMAT_YUV410"}, {DRM_FORMAT_YVU410, "DRM_FORMAT_YVU410"}, + {DRM_FORMAT_YUV411, "DRM_FORMAT_YUV411"}, {DRM_FORMAT_YVU411, "DRM_FORMAT_YVU411"}, + {DRM_FORMAT_YUV420, "DRM_FORMAT_YUV420"}, {DRM_FORMAT_YVU420, "DRM_FORMAT_YVU420"}, + {DRM_FORMAT_YUV422, "DRM_FORMAT_YUV422"}, {DRM_FORMAT_YVU422, "DRM_FORMAT_YVU422"}, + {DRM_FORMAT_YUV444, "DRM_FORMAT_YUV444"}, {DRM_FORMAT_YVU444, "DRM_FORMAT_YVU444"}, + }; + + static const char *unknown = "unknown drm format"; + for (uint32_t i = 0; i < sizeof(formatStrMaps) / sizeof(formatStrMaps[0]); i++) { + if (formatStrMaps[i].value == format) { + return formatStrMaps[i].str; + } + } + DISPLAY_LOGE("GetDrmFmtStr unknown format %{public}d", format); + return unknown; +} + +static uint32_t ConvertFormatToDrm(PixelFormat fmtIn) +{ + static const PixelFormatConvertTbl convertTable[] = { + {DRM_FORMAT_RGBX8888, PIXEL_FMT_RGBX_8888}, {DRM_FORMAT_RGBA8888, PIXEL_FMT_RGBA_8888}, + {DRM_FORMAT_RGB888, PIXEL_FMT_RGB_888}, {DRM_FORMAT_RGB565, PIXEL_FMT_BGR_565}, + {DRM_FORMAT_BGRX4444, PIXEL_FMT_BGRX_4444}, {DRM_FORMAT_BGRA4444, PIXEL_FMT_BGRA_4444}, + {DRM_FORMAT_RGBA4444, PIXEL_FMT_RGBA_4444}, {DRM_FORMAT_RGBX4444, PIXEL_FMT_RGBX_4444}, + {DRM_FORMAT_BGRX5551, PIXEL_FMT_BGRX_5551}, {DRM_FORMAT_BGRA5551, PIXEL_FMT_BGRA_5551}, + {DRM_FORMAT_BGRX8888, PIXEL_FMT_BGRX_8888}, {DRM_FORMAT_BGRA8888, PIXEL_FMT_BGRA_8888}, + {DRM_FORMAT_NV12, PIXEL_FMT_YCBCR_420_SP}, {DRM_FORMAT_NV21, PIXEL_FMT_YCRCB_420_SP}, + {DRM_FORMAT_YUV420, PIXEL_FMT_YCBCR_420_P}, {DRM_FORMAT_YVU420, PIXEL_FMT_YCRCB_420_P}, + {DRM_FORMAT_NV16, PIXEL_FMT_YCBCR_422_SP}, {DRM_FORMAT_NV61, PIXEL_FMT_YCRCB_422_SP}, + {DRM_FORMAT_YUV422, PIXEL_FMT_YCBCR_422_P}, {DRM_FORMAT_YVU422, PIXEL_FMT_YCRCB_422_P}, + }; + uint32_t fmtOut = 0; + for (uint32_t i = 0; i < sizeof(convertTable) / sizeof(convertTable[0]); i++) { + if (convertTable[i].pixFormat == fmtIn) { + fmtOut = convertTable[i].drmFormat; + } + } + DISPLAY_LOGD("fmtIn %{public}d : %{public}s, outFmt %{public}d : %{public}s", fmtIn, + GetPixelFmtStr(fmtIn), fmtOut, GetDrmFmtStr(fmtOut)); + return fmtOut; +} + +static uint64_t ConvertUsageToGbm(uint64_t inUsage) +{ + uint64_t outUsage = GBM_BO_USE_TEXTURING; + if (inUsage & HBM_USE_CPU_READ) { + outUsage |= GBM_BO_USE_SW_READ_OFTEN; + } + if (inUsage & HBM_USE_CPU_WRITE) { + outUsage |= GBM_BO_USE_SW_WRITE_OFTEN; + } + DISPLAY_LOGD("outUsage 0x%{public}" PRIx64 "", outUsage); + return outUsage; +} + +static int32_t InitGbmDevice(const char *drmFile, GrallocManager *grallocManager) +{ + DISPLAY_LOGD(); + char path[PATH_MAX] = {0}; + if (grallocManager->gbmDevice == nullptr) { + if (realpath(drmFile, path) == nullptr) { + DISPLAY_LOGE(" drm File : %{public}s is not a realpath, errno: %{public}s", drmFile, strerror(errno)); + return HDF_ERR_INVALID_PARAM; + } + int drmFd = open(path, O_RDWR); + if (drmFd < 0) { + DISPLAY_LOGE("drm file:%{public}s open failed %{public}s", drmFile, strerror(errno)); + return HDF_ERR_BAD_FD; + } + drmDropMaster(drmFd); + struct gbm_device *gbmDevice = hdi_gbm_create_device(drmFd); + grallocManager->drmFd = drmFd; + if (gbmDevice == nullptr) { + close(drmFd); + grallocManager->drmFd = -1; + DISPLAY_LOGE("gbm device create failed"); + return HDF_FAILURE; + } + grallocManager->gbmDevice = gbmDevice; + grallocManager->drmFd = drmFd; + DListHeadInit(&grallocManager->gbmBoHead); + } + return HDF_SUCCESS; +} + +static void DeInitGbmDevice(GrallocManager *grallocManager) +{ + DISPLAY_LOGD(); + hdi_gbm_device_destroy(grallocManager->gbmDevice); + if (grallocManager->drmFd > 0) { + close(grallocManager->drmFd); + grallocManager->drmFd = -1; + } + grallocManager->gbmDevice = nullptr; +} + +static int32_t DmaBufferSync(const BufferHandle *handle, bool start) +{ + DISPLAY_LOGD(); + struct dma_buf_sync syncPrm; + errno_t eok = memset_s(&syncPrm, sizeof(syncPrm), 0, sizeof(syncPrm)); + DISPLAY_CHK_RETURN((eok != EOK), HDF_ERR_INVALID_PARAM, DISPLAY_LOGE("dma buffer sync memset_s failed")); + + if (handle->usage & HBM_USE_CPU_WRITE) { + syncPrm.flags |= DMA_BUF_SYNC_WRITE; + } + + if (handle->usage & HBM_USE_CPU_READ) { + syncPrm.flags |= DMA_BUF_SYNC_READ; + } + + if (start) { + syncPrm.flags |= DMA_BUF_SYNC_START; + } else { + syncPrm.flags |= DMA_BUF_SYNC_END; + } + int retry = 6; + int ret; + do { + ret = ioctl(handle->fd, DMA_BUF_IOCTL_SYNC, &syncPrm); + } while ((retry--) && (ret != -EAGAIN) && (ret != -EINTR)); + + if (ret < 0) { + DISPLAY_LOGE("sync failed"); + return HDF_ERR_DEVICE_BUSY; + } + return HDF_SUCCESS; +} + +static void InitBufferHandle(struct gbm_bo *bo, int fd, const AllocInfo *info, PriBufferHandle *buffer) +{ + BufferHandle *bufferHandle = &(buffer->hdl); + bufferHandle->fd = fd; + bufferHandle->reserveFds = 0; + bufferHandle->reserveInts = 0; + bufferHandle->stride = hdi_gbm_bo_get_stride(bo); + bufferHandle->width = hdi_gbm_bo_get_width(bo); + bufferHandle->height = hdi_gbm_bo_get_height(bo); + bufferHandle->usage = info->usage; + bufferHandle->format = info->format; + bufferHandle->virAddr = nullptr; + bufferHandle->size = hdi_gbm_bo_get_size(bo); +} + +int32_t GbmAllocMem(const AllocInfo *info, BufferHandle **buffer) +{ + DISPLAY_CHK_RETURN((info == nullptr), HDF_FAILURE, DISPLAY_LOGE("info is null")); + DISPLAY_CHK_RETURN((buffer == nullptr), HDF_FAILURE, DISPLAY_LOGE("buffer is null")); + PriBufferHandle *priBuffer = nullptr; + uint32_t drmFmt = ConvertFormatToDrm(static_cast(info->format)); + DISPLAY_CHK_RETURN((drmFmt == INVALID_PIXEL_FMT), HDF_ERR_NOT_SUPPORT, + DISPLAY_LOGE("format %{public}d can not support", info->format)); + DISPLAY_LOGD("requeset width %{public}d, heigt %{public}d, format %{public}d", + info->width, info->height, drmFmt); + + GRALLOC_LOCK(); + GrallocManager *grallocManager = GetGrallocManager(); + DISPLAY_CHK_RETURN((grallocManager == nullptr), HDF_ERR_INVALID_PARAM, DISPLAY_LOGE("gralloc manager failed"); + GRALLOC_UNLOCK()); + struct gbm_bo *bo = + hdi_gbm_bo_create(grallocManager->gbmDevice, info->width, info->height, drmFmt, ConvertUsageToGbm(info->usage)); + DISPLAY_CHK_RETURN((bo == nullptr), HDF_DEV_ERR_NO_MEMORY, DISPLAY_LOGE("gbm create bo failed"); \ + GRALLOC_UNLOCK()); + + int fd = hdi_gbm_bo_get_fd(bo); + DISPLAY_CHK_RETURN((fd < 0), HDF_ERR_BAD_FD, DISPLAY_LOGE("gbm can not get fd"); \ + hdi_gbm_bo_destroy(bo); \ + GRALLOC_UNLOCK()); + + priBuffer = (PriBufferHandle *)malloc(sizeof(PriBufferHandle)); + if (priBuffer == nullptr) { + DISPLAY_LOGE("bufferhandle malloc failed"); + close(fd); + hdi_gbm_bo_destroy(bo); + GRALLOC_UNLOCK(); + return HDF_FAILURE; + } + + errno_t eok = memset_s(priBuffer, sizeof(PriBufferHandle), 0, sizeof(PriBufferHandle)); + if (eok != EOK) { + DISPLAY_LOGE("memset_s failed"); + close(fd); + hdi_gbm_bo_destroy(bo); + if (priBuffer != nullptr) { + free(priBuffer); + } + GRALLOC_UNLOCK(); + return HDF_FAILURE; + } + + InitBufferHandle(bo, fd, info, priBuffer); + *buffer = &priBuffer->hdl; + hdi_gbm_bo_destroy(bo); + GRALLOC_UNLOCK(); + return HDF_SUCCESS; +} + +static void CloseBufferHandle(BufferHandle *handle) +{ + DISPLAY_CHK_RETURN_NOT_VALUE((handle == nullptr), DISPLAY_LOGE("buffer is null")); + if (handle->fd >= 0) { + close(handle->fd); + handle->fd = -1; + } + const uint32_t reserveFds = handle->reserveFds; + for (uint32_t i = 0; i < reserveFds; i++) { + if (handle->reserve[i] >= 0) { + close(handle->reserve[i]); + handle->reserve[i] = -1; + } + } +} + +void GbmFreeMem(BufferHandle *buffer) +{ + DISPLAY_LOGD(); + DISPLAY_CHK_RETURN_NOT_VALUE((buffer == nullptr), DISPLAY_LOGE("buffer is null")); + if ((buffer->virAddr != nullptr) && (GbmUnmap(buffer) != HDF_SUCCESS)) { + DISPLAY_LOGE("freeMem unmap buffer failed"); + } + CloseBufferHandle(buffer); + free(buffer); +} + +void *GbmMmap(BufferHandle *buffer) +{ + void *virAddr = nullptr; + DISPLAY_LOGD(); + if (buffer == nullptr) { + DISPLAY_LOGE("gbmmap the buffer handle is nullptr"); + return nullptr; + } + if (buffer->virAddr != nullptr) { + DISPLAY_LOGD("the buffer has virtual addr"); + return buffer->virAddr; + } + virAddr = mmap(nullptr, buffer->size, PROT_READ | PROT_WRITE, MAP_SHARED, buffer->fd, 0); + if (virAddr == reinterpret_cast(MAP_FAILED)) { + DISPLAY_LOGE("mmap failed errno %{public}s, fd : %{public}d", strerror(errno), buffer->fd); + } + buffer->virAddr = virAddr; + return virAddr; +} + +int32_t GbmUnmap(BufferHandle *buffer) +{ + DISPLAY_LOGD(); + if (buffer == nullptr) { + DISPLAY_LOGE("gbmumap the buffer handle is null"); + return HDF_FAILURE; + } + + if (buffer->virAddr == nullptr) { + DISPLAY_LOGE("virAddr is nullptr , has not map the buffer"); + return HDF_ERR_INVALID_PARAM; + } + int ret = munmap(buffer->virAddr, buffer->size); + if (ret != 0) { + DISPLAY_LOGE("munmap failed err: %{public}s", strerror(errno)); + return HDF_FAILURE; + } + buffer->virAddr = nullptr; + return HDF_SUCCESS; +} + +int32_t GbmInvalidateCache(BufferHandle *buffer) +{ + DISPLAY_LOGD(); + return DmaBufferSync(buffer, true); +} + +int32_t GbmFlushCache(BufferHandle *buffer) +{ + DISPLAY_LOGD(); + return DmaBufferSync(buffer, false); +} + +int32_t GbmGrallocUninitialize(void) +{ + DISPLAY_LOGD(); + GRALLOC_LOCK(); + GrallocManager *grallocManager = GetGrallocManager(); + DISPLAY_CHK_RETURN((grallocManager == nullptr), HDF_ERR_INVALID_PARAM, DISPLAY_LOGE("gralloc manager failed"); \ + GRALLOC_UNLOCK()); + grallocManager->referCount--; + if (grallocManager->referCount < 0) { + DeInitGbmDevice(grallocManager); + free(g_grallocManager); + g_grallocManager = nullptr; + } + GRALLOC_UNLOCK(); + return HDF_SUCCESS; +} + +int32_t GbmGrallocInitialize(void) +{ + DISPLAY_LOGD(); + GRALLOC_LOCK(); + GrallocManager *grallocManager = GetGrallocManager(); + DISPLAY_CHK_RETURN((grallocManager == nullptr), HDF_ERR_INVALID_PARAM, DISPLAY_LOGE("gralloc manager failed"); \ + GRALLOC_UNLOCK()); + + const char* drmPath = GetDrmFileNodePath(); + DISPLAY_LOGI("GbmGrallocInitialize Using DRM Node: %{public}s", drmPath); + int ret = InitGbmDevice(drmPath, grallocManager); + + DISPLAY_CHK_RETURN((ret != HDF_SUCCESS), ret, DISPLAY_LOGE("gralloc manager failed"); \ + GRALLOC_UNLOCK()); + grallocManager->referCount++; + GRALLOC_UNLOCK(); + return HDF_SUCCESS; +} +} // namespace DISPLAY +} // namespace HDI +} // namespace OHOS diff --git a/device_soc_phytium/common/hardware/display/src/display_gralloc/display_gralloc_gbm.h b/device_soc_phytium/common/hardware/display/src/display_gralloc/display_gralloc_gbm.h index 3f29e1264d8543a740ccd171348e2f493597495a..3031e25f79a798620b45d226161a3195a0622d1e 100755 --- a/device_soc_phytium/common/hardware/display/src/display_gralloc/display_gralloc_gbm.h +++ b/device_soc_phytium/common/hardware/display/src/display_gralloc/display_gralloc_gbm.h @@ -15,6 +15,7 @@ #ifndef DISPLAY_GRALLOC_GBM_H #define DISPLAY_GRALLOC_GBM_H +#include #include "buffer_handle.h" #include "hdf_dlist.h" #include "hdf_log.h" @@ -46,6 +47,7 @@ int32_t GbmInvalidateCache(BufferHandle *buffer); int32_t GbmFlushCache(BufferHandle *buffer); int32_t GbmGrallocUninitialize(void); int32_t GbmGrallocInitialize(void); +const char* GetDrmFileNodePath(void); #ifdef GRALLOC_LOCK_DEBUG #define GRALLOC_LOCK(format, ...) \ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/char/hw_random/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/hw_random/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..d820d6ea46bcb82ca25bd9a5d47b1bd38543527e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/hw_random/Kconfig @@ -0,0 +1,12 @@ +config HW_RANDOM_PHYTIUM + tristate "Phytium Random Number Generator support" + depends on ARCH_PHYTIUM || COMPILE_TEST + help + This driver provides kernel-side support for the Random Number + Generator hardware found on Phytium SoCs. + + To compile this driver as a module, choose M here: the + module will be called phytium-rng. + + If unsure, say Y. + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/char/hw_random/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/hw_random/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..5571b11e1a98c5d251a793e485ae9013a0d50bed --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/hw_random/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_HW_RANDOM_PHYTIUM) += phytium-rng.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/char/hw_random/phytium-rng.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/hw_random/phytium-rng.c new file mode 100644 index 0000000000000000000000000000000000000000..f8ab17f33d0b7a49263abecd977f4201a7757630 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/hw_random/phytium-rng.c @@ -0,0 +1,155 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SoC RNG Driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define TRNG_CR 0x00 +#define TRNG_CR_RNGEN BIT(0) +#define TRNG_CR_ROSEN_MASK GENMASK(7, 4) +#define TRNG_CR_DIEN BIT(16) +#define TRNG_CR_ERIEN BIT(17) +#define TRNG_CR_IRQEN BIT(24) +#define TRNG_MSEL 0x04 +#define TRNG_MSEL_MSEL BIT(0) +#define TRNG_SR 0x08 +#define TRNG_SR_HTF BIT(0) +#define TRNG_SR_DRDY BIT(1) +#define TRNG_SR_ERERR BIT(3) +#define TRNG_DR 0x0C +#define TRNG_RESEED 0x40 +#define TRNG_RESEED_RSED BIT(0) + +#define DELAY 10 +#define TIMEOUT 100 + +static int msel; +module_param(msel, int, 0444); +MODULE_PARM_DESC(msel, "Phytium RNG mode selection: 0 - TRNG. 1 - PRNG."); + +struct phytium_rng { + struct hwrng rng; + void __iomem *base; +}; + +static int phytium_rng_init(struct hwrng *rng) +{ + struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); + u32 reg; + + /* Mode Selection */ + reg = msel ? TRNG_MSEL_MSEL : 0; + writel(reg, priv->base + TRNG_MSEL); + + /* If PRGN mode is on, do reseed operations */ + if (msel) + writel(TRNG_RESEED_RSED, priv->base + TRNG_RESEED); + + /* Clear status */ + writel(0x7, priv->base + TRNG_SR); + + /* Enable TRNG */ + reg = readl(priv->base + TRNG_CR) | TRNG_CR_ROSEN_MASK | TRNG_CR_RNGEN; + writel(reg, priv->base + TRNG_CR); + + return 0; +} + +static void phytium_rng_cleanup(struct hwrng *rng) +{ + struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); + + writel(0x7, priv->base + TRNG_SR); +} + +static int phytium_rng_read(struct hwrng *rng, void *buf, size_t max, bool wait) +{ + struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); + u32 reg; + int ret = 0; + + /* TRNG can generate at most 8*32bit random number per time */ + max = max > 32 ? 32 : max; + + reg = readl(priv->base + TRNG_SR); + if (!(reg & TRNG_SR_DRDY) && wait) { + ret = readl_poll_timeout(priv->base + TRNG_SR, reg, + reg & TRNG_SR_DRDY, DELAY, TIMEOUT); + if (ret) { + dev_err((struct device *)priv->rng.priv, + "%s: timeout %x!\n", __func__, reg); + return -EIO; + } + } + + while (max >= 4) { + *(u32 *)buf = readl(priv->base + TRNG_DR); + + ret += sizeof(u32); + buf += sizeof(u32); + max -= sizeof(u32); + } + + /* Clear DRDY by writing 1 */ + writel(reg | TRNG_SR_DRDY, priv->base + TRNG_SR); + + return ret; +} + +static int phytium_rng_probe(struct platform_device *pdev) +{ + struct phytium_rng *priv; + struct resource *mem; + + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); + if (!priv) + return -ENOMEM; + + platform_set_drvdata(pdev, priv); + + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); + priv->base = devm_ioremap_resource(&pdev->dev, mem); + if (IS_ERR(priv->base)) + return PTR_ERR(priv->base); + + priv->rng.name = pdev->name; + priv->rng.init = phytium_rng_init; + priv->rng.cleanup = phytium_rng_cleanup; + priv->rng.read = phytium_rng_read; + priv->rng.priv = (unsigned long)&pdev->dev; + priv->rng.quality = 1000; + + return devm_hwrng_register(&pdev->dev, &priv->rng); +} + +static const struct of_device_id phytium_rng_dt_ids[] = { + { .compatible = "phytium,rng" }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_rng_dt_ids); + +static struct platform_driver phytium_rng_driver = { + .probe = phytium_rng_probe, + .driver = { + .name = "phytium-rng", + .of_match_table = of_match_ptr(phytium_rng_dt_ids), + } +}; +module_platform_driver(phytium_rng_driver); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium random number generator driver"); +MODULE_AUTHOR("Chen Baozi "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/char/ipmi/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/ipmi/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..e1c26928c397d4cbb5bccdba30fde8c2ea889b68 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/ipmi/Kconfig @@ -0,0 +1,22 @@ +config PHYTIUM_KCS_IPMI_BMC + depends on ARCH_PHYTIUM + select IPMI_KCS_BMC + select REGMAP_MMIO + tristate "PHYTIUM KCS IPMI BMC driver" + help + Provides a driver for the KCS (Kerboard Controller Style) IPMI + interface found on Phytium SOCs. + + The driver implements the BMC side of the KCS controller, it + provides the access of KCS IO space for BMC side. + +config PHYTIUM_BT_IPMI_BMC + depends on ARCH_PHYTIUM + depends on REGMAP && REGMAP_MMIO && MFD_SYSCON + tristate "PHYTIUM BT BMC driver" + help + Provides a driver for the BT (Block Transfer) IPMI interface + found on Phytium SOCs. The driver implements the BMC + side of the BT interface. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/char/ipmi/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/ipmi/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..949b07180e80669a0284afb55f11aadc0658317b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/ipmi/Makefile @@ -0,0 +1,2 @@ +obj-$(CONFIG_PHYTIUM_KCS_IPMI_BMC) += kcs_bmc_phytium.o +obj-$(CONFIG_PHYTIUM_BT_IPMI_BMC) += bt_bmc_phytium.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/char/ipmi/bt_bmc_phytium.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/ipmi/bt_bmc_phytium.c new file mode 100755 index 0000000000000000000000000000000000000000..d66b6b3dd9c6ac523d2bccb681caf3fe06d502be --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/char/ipmi/bt_bmc_phytium.c @@ -0,0 +1,533 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + * + * Derived from drivers/char/ipmi/bt-bmc.c + * Copyright (c) 2015-2016, IBM Corporation. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +/* + * This is a BMC device used to communicate to the host + */ +#define DEVICE_NAME "ipmi-bt-host" + +#define BT_IO_BASE 0xe4 +#define BT_IRQ 10 + +#define LPC_HICR0 0x00 +#define LPC_HICR0_LPC3E BIT(7) +#define LPC_HICR0_LPC2E BIT(6) +#define LPC_HICR0_LPC1E BIT(5) +#define LPC_HICR0_SDWNE BIT(3) /* 0:disable, 1:enable for HICR1_SDWNB */ +#define LPC_HICR0_PMEE BIT(2) /* 0:disable, 1:enable for HICR1_PMEB */ + +#define LPC_HICR2 0x08 +#define LPC_HICR2_IBFIF3 BIT(3) /* 0:normal, 1:enable irq 3*/ + +#define LPC_HICR4 0x10 +#define LPC_HICR4_LADR12AS BIT(7) +#define LPC_HICR4_KCSENBL BIT(2) +#define LPC_BTENABLE BIT(0) /* share bt channel enable, 0:disable, 1:enable */ +#define LPC_LADR3H_BT 0x014 +#define LPC_LADR3L_BT 0x018 + +#define BT_CR1 0x4C +#define BT_CR1_IRQ_H2B 0x04 +#define BT_CR1_IRQ_HWRST 0x40 + +#define BT_CSR1 0x54 +#define BT_CSR1_IRQ_H2B 0x04 +#define BT_CSR1_IRQ_HWRST 0x40 + +#define BT_CTRL 0x58 +#define BT_CTRL_B_BUSY 0x80 +#define BT_CTRL_H_BUSY 0x40 +#define BT_CTRL_OEM0 0x20 +#define BT_CTRL_SMS_ATN 0x10 +#define BT_CTRL_B2H_ATN 0x08 +#define BT_CTRL_H2B_ATN 0x04 +#define BT_CTRL_CLR_RD_PTR 0x02 +#define BT_CTRL_CLR_WR_PTR 0x01 +#define BT_BMC2HOST 0x5C +#define BT_HOST2BMC 0x98 +#define BT_INTMASK 0x60 +#define BT_INTMASK_B2H_IRQEN 0x01 +#define BT_INTMASK_B2H_IRQ 0x02 +#define BT_INTMASK_BMC_HWRST 0x80 + +#define BT_BMC_BUFFER_SIZE 256 + +struct bt_bmc { + struct device dev; + struct miscdevice miscdev; + struct regmap *map; + int irq; + wait_queue_head_t queue; + struct timer_list poll_timer; + struct mutex mutex; +}; + +static atomic_t open_count = ATOMIC_INIT(0); + +static const struct regmap_config bt_regmap_cfg = { + .reg_bits = 32, + .val_bits = 32, + .reg_stride = 4, +}; + +static u8 bt_inb(struct bt_bmc *bt_bmc, int reg) +{ + uint32_t val = 0; + int rc; + + rc = regmap_read(bt_bmc->map, reg, &val); + WARN(rc != 0, "regmap_read() failed: %d\n", rc); + + return rc == 0 ? (u8) val : 0; +} + +static void bt_outb(struct bt_bmc *bt_bmc, u8 data, int reg) +{ + int rc; + + rc = regmap_write(bt_bmc->map, reg, data); + WARN(rc != 0, "regmap_write() failed: %d\n", rc); +} + +static void clr_rd_ptr(struct bt_bmc *bt_bmc) +{ + bt_outb(bt_bmc, BT_CTRL_CLR_RD_PTR, BT_CTRL); +} + +static void clr_wr_ptr(struct bt_bmc *bt_bmc) +{ + bt_outb(bt_bmc, BT_CTRL_CLR_WR_PTR, BT_CTRL); +} + +static void clr_h2b_atn(struct bt_bmc *bt_bmc) +{ + bt_outb(bt_bmc, 0, BT_CTRL); +} + +static void set_b_busy(struct bt_bmc *bt_bmc) +{ + if (!(bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_B_BUSY)) + bt_outb(bt_bmc, BT_CTRL_B_BUSY, BT_CTRL); +} + +static void clr_b_busy(struct bt_bmc *bt_bmc) +{ + if (bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_B_BUSY) + bt_outb(bt_bmc, 0, BT_CTRL); +} + +static void set_b2h_atn(struct bt_bmc *bt_bmc) +{ + bt_outb(bt_bmc, BT_CTRL_B2H_ATN, BT_CTRL); +} + +static u8 bt_read(struct bt_bmc *bt_bmc) +{ + return bt_inb(bt_bmc, BT_HOST2BMC); +} + +static ssize_t bt_readn(struct bt_bmc *bt_bmc, u8 *buf, size_t n) +{ + int i; + + for (i = 0; i < n; i++) + buf[i] = bt_read(bt_bmc); + return n; +} + +static void bt_write(struct bt_bmc *bt_bmc, u8 c) +{ + bt_outb(bt_bmc, c, BT_BMC2HOST); +} + +static ssize_t bt_writen(struct bt_bmc *bt_bmc, u8 *buf, size_t n) +{ + int i; + + for (i = 0; i < n; i++) + bt_write(bt_bmc, buf[i]); + return n; +} + +static void set_sms_atn(struct bt_bmc *bt_bmc) +{ + bt_outb(bt_bmc, BT_CTRL_SMS_ATN, BT_CTRL); +} + +static struct bt_bmc *file_bt_bmc(struct file *file) +{ + return container_of(file->private_data, struct bt_bmc, miscdev); +} + +static int bt_bmc_open(struct inode *inode, struct file *file) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + + if (atomic_inc_return(&open_count) == 1) { + clr_b_busy(bt_bmc); + return 0; + } + + atomic_dec(&open_count); + + return -EBUSY; +} + +/* + * The BT (Block Transfer) interface means that entire messages are + * buffered by the host before a notification is sent to the BMC that + * there is data to be read. The first byte is the length and the + * message data follows. The read operation just tries to capture the + * whole before returning it to userspace. + * + * BT Message format : + * + * Byte 1 Byte 2 Byte 3 Byte 4 Byte 5:N + * Length NetFn/LUN Seq Cmd Data + * + */ +static ssize_t bt_bmc_read(struct file *file, char __user *buf, + size_t count, loff_t *ppos) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + u8 len; + int len_byte = 1; + u8 kbuffer[BT_BMC_BUFFER_SIZE]; + ssize_t ret = 0; + ssize_t nread; + + WARN_ON(*ppos); + + if (wait_event_interruptible(bt_bmc->queue, + bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_H2B_ATN)) + return -ERESTARTSYS; + + mutex_lock(&bt_bmc->mutex); + + if (unlikely(!(bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_H2B_ATN))) { + ret = -EIO; + goto out_unlock; + } + + set_b_busy(bt_bmc); + clr_h2b_atn(bt_bmc); + clr_rd_ptr(bt_bmc); + + /* + * The BT frames start with the message length, which does not + * include the length byte. + */ + kbuffer[0] = bt_read(bt_bmc); + len = kbuffer[0]; + + /* We pass the length back to userspace as well */ + if (len + 1 > count) + len = count - 1; + + while (len) { + nread = min_t(ssize_t, len, sizeof(kbuffer) - len_byte); + + bt_readn(bt_bmc, kbuffer + len_byte, nread); + + if (copy_to_user(buf, kbuffer, nread + len_byte)) { + ret = -EFAULT; + break; + } + len -= nread; + buf += nread + len_byte; + ret += nread + len_byte; + len_byte = 0; + } + + clr_b_busy(bt_bmc); + +out_unlock: + mutex_unlock(&bt_bmc->mutex); + return ret; +} + +/* + * BT Message response format : + * + * Byte 1 Byte 2 Byte 3 Byte 4 Byte 5 Byte 6:N + * Length NetFn/LUN Seq Cmd Code Data + */ +static ssize_t bt_bmc_write(struct file *file, const char __user *buf, + size_t count, loff_t *ppos) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + u8 kbuffer[BT_BMC_BUFFER_SIZE]; + ssize_t ret = 0; + ssize_t nwritten; + + /* + * send a minimum response size + */ + if (count < 5) + return -EINVAL; + + WARN_ON(*ppos); + + /* + * There's no interrupt for clearing bmc busy so we have to + * poll + */ + if (wait_event_interruptible(bt_bmc->queue, + !(bt_inb(bt_bmc, BT_CTRL) & + (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN)))) + return -ERESTARTSYS; + + mutex_lock(&bt_bmc->mutex); + + if (unlikely(bt_inb(bt_bmc, BT_CTRL) & + (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN))) { + ret = -EIO; + goto out_unlock; + } + + clr_wr_ptr(bt_bmc); + + while (count) { + nwritten = min_t(ssize_t, count, sizeof(kbuffer)); + if (copy_from_user(&kbuffer, buf, nwritten)) { + ret = -EFAULT; + break; + } + + bt_writen(bt_bmc, kbuffer, nwritten); + + count -= nwritten; + buf += nwritten; + ret += nwritten; + } + + set_b2h_atn(bt_bmc); + +out_unlock: + mutex_unlock(&bt_bmc->mutex); + return ret; +} + +static long bt_bmc_ioctl(struct file *file, unsigned int cmd, + unsigned long param) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + + switch (cmd) { + case BT_BMC_IOCTL_SMS_ATN: + set_sms_atn(bt_bmc); + return 0; + } + return -EINVAL; +} + +static int bt_bmc_release(struct inode *inode, struct file *file) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + + atomic_dec(&open_count); + set_b_busy(bt_bmc); + return 0; +} + +static __poll_t bt_bmc_poll(struct file *file, poll_table *wait) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + __poll_t mask = 0; + u8 ctrl; + + poll_wait(file, &bt_bmc->queue, wait); + + ctrl = bt_inb(bt_bmc, BT_CTRL); + + if (ctrl & BT_CTRL_H2B_ATN) + mask |= EPOLLIN; + + if (!(ctrl & (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN))) + mask |= EPOLLOUT; + + return mask; +} + +static const struct file_operations bt_bmc_fops = { + .owner = THIS_MODULE, + .open = bt_bmc_open, + .read = bt_bmc_read, + .write = bt_bmc_write, + .release = bt_bmc_release, + .poll = bt_bmc_poll, + .unlocked_ioctl = bt_bmc_ioctl, +}; + +static void poll_timer(struct timer_list *t) +{ + struct bt_bmc *bt_bmc = from_timer(bt_bmc, t, poll_timer); + + bt_bmc->poll_timer.expires += msecs_to_jiffies(500); + wake_up(&bt_bmc->queue); + add_timer(&bt_bmc->poll_timer); +} + +static irqreturn_t bt_bmc_irq(int irq, void *arg) +{ + struct bt_bmc *bt_bmc = arg; + u32 reg, intmsk; + int rc; + + rc = regmap_read(bt_bmc->map, BT_CR1, ®); + if (rc) + return IRQ_NONE; + + reg &= BT_CR1_IRQ_H2B | BT_CR1_IRQ_HWRST; + if (!reg) + return IRQ_NONE; + + /* ack pending IRQs */ + regmap_write(bt_bmc->map, BT_CR1, 0); + + if (reg & BT_CR1_IRQ_HWRST) { + regmap_read(bt_bmc->map, BT_INTMASK, &intmsk); + if (intmsk & BT_INTMASK_BMC_HWRST) + regmap_write(bt_bmc->map, BT_INTMASK, 0); + } + + wake_up(&bt_bmc->queue); + return IRQ_HANDLED; +} + +static int bt_bmc_config_irq(struct bt_bmc *bt_bmc, + struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + int rc; + + bt_bmc->irq = platform_get_irq(pdev, 0); + if (!bt_bmc->irq) + return -ENODEV; + + rc = devm_request_irq(dev, bt_bmc->irq, bt_bmc_irq, IRQF_SHARED, + DEVICE_NAME, bt_bmc); + if (rc < 0) { + dev_warn(dev, "Unable to request IRQ %d\n", bt_bmc->irq); + bt_bmc->irq = 0; + return rc; + } + + /* + * Configure IRQs on the bmc clearing the H2B and HBUSY bits; + * H2B will be asserted when the bmc has data for us; HBUSY + * will be cleared (along with B2H) when we can write the next + * message to the BT buffer + */ + rc = regmap_update_bits(bt_bmc->map, BT_CSR1, + BT_CSR1_IRQ_H2B | BT_CSR1_IRQ_HWRST, + BT_CSR1_IRQ_H2B | BT_CSR1_IRQ_HWRST); + + return rc; +} + +static int bt_bmc_probe(struct platform_device *pdev) +{ + struct bt_bmc *bt_bmc; + struct device *dev; + int rc; + + if (!pdev || !pdev->dev.of_node) + return -ENODEV; + + dev = &pdev->dev; + dev_info(dev, "Found bt bmc device\n"); + + bt_bmc = devm_kzalloc(dev, sizeof(*bt_bmc), GFP_KERNEL); + if (!bt_bmc) + return -ENOMEM; + + dev_set_drvdata(&pdev->dev, bt_bmc); + + bt_bmc->map = syscon_node_to_regmap(pdev->dev.parent->of_node); + + mutex_init(&bt_bmc->mutex); + init_waitqueue_head(&bt_bmc->queue); + + bt_bmc->miscdev.minor = MISC_DYNAMIC_MINOR, + bt_bmc->miscdev.name = DEVICE_NAME, + bt_bmc->miscdev.fops = &bt_bmc_fops, + bt_bmc->miscdev.parent = dev; + rc = misc_register(&bt_bmc->miscdev); + if (rc) { + dev_err(dev, "Unable to register misc device\n"); + return rc; + } + + bt_bmc_config_irq(bt_bmc, pdev); + + if (bt_bmc->irq) { + dev_info(dev, "Using IRQ %d\n", bt_bmc->irq); + } else { + dev_info(dev, "No IRQ; using timer\n"); + timer_setup(&bt_bmc->poll_timer, poll_timer, 0); + bt_bmc->poll_timer.expires = jiffies + msecs_to_jiffies(10); + add_timer(&bt_bmc->poll_timer); + } + + regmap_update_bits(bt_bmc->map, LPC_HICR0, LPC_HICR0_LPC3E, LPC_HICR0_LPC3E); + regmap_update_bits(bt_bmc->map, LPC_HICR4, LPC_BTENABLE, LPC_BTENABLE); + regmap_write(bt_bmc->map, LPC_LADR3H_BT, BT_IO_BASE >> 8); + regmap_write(bt_bmc->map, LPC_LADR3L_BT, BT_IO_BASE); + regmap_update_bits(bt_bmc->map, LPC_HICR2, LPC_HICR2_IBFIF3, LPC_HICR2_IBFIF3); + clr_b_busy(bt_bmc); + + return 0; +} + +static int bt_bmc_remove(struct platform_device *pdev) +{ + struct bt_bmc *bt_bmc = dev_get_drvdata(&pdev->dev); + + misc_deregister(&bt_bmc->miscdev); + if (!bt_bmc->irq) + del_timer_sync(&bt_bmc->poll_timer); + + return 0; +} + +static const struct of_device_id bt_bmc_match[] = { + { .compatible = "phytium,bt-bmc" }, + { }, +}; +MODULE_DEVICE_TABLE(of, bt_bmc_match); + +static struct platform_driver bt_bmc_driver = { + .driver = { + .name = DEVICE_NAME, + .of_match_table = bt_bmc_match, + }, + .probe = bt_bmc_probe, + .remove = bt_bmc_remove, +}; + +module_platform_driver(bt_bmc_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Cheng Quan +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "kcs_bmc.h" + +#define DEVICE_NAME "phytium-kcs-bmc" + +#define KCS_CHANNEL_MAX 4 + +/* mapped to lpc-bmc@0 IO space */ +#define LPC_HICR0 0x000 +#define LPC_HICR0_LPC3E BIT(7) +#define LPC_HICR0_LPC2E BIT(6) +#define LPC_HICR0_LPC1E BIT(5) +#define LPC_HICR0_SDWNE BIT(3) /* 0:disable, 1:enable for HICR1_SDWNB */ +#define LPC_HICR0_PMEE BIT(2) /* 0:disable, 1:enable for HICR1_PMEB */ +#define LPC_HICR1 0x004 +#define LPC_HICR1_LPCBSY BIT(7) /* 0:idle, 1:trans busy */ +#define LPC_HICR1_IRQBSY BIT(5) /* 0:idle, 1:trans data */ +#define LPC_HICR1_LPCSWRST BIT(4) /* 0:normal, 1:reset */ +#define LPC_HICR1_SDWNB BIT(3) /* 0:normal, 1:software shutdown */ +#define LPC_HICR1_PMEB BIT(2) /* 0:LPCPD low, 1:LPCPD high */ +#define LPC_HICR2 0x008 +#define LPC_LPCSWRST_ERRIRQ BIT(6) /* 0:normal, 1:reset irq */ +#define LPC_SDWN_ERRIRQ BIT(5) /* 0:normal, 1:lpcpd irq */ +#define LPC_ABRT_ERRIRQ BIT(4) /* 0:normal, 1:lframe low when busy*/ +#define LPC_HICR2_IBFIF3 BIT(3) /* 0:normal, 1:enable irq 3*/ +#define LPC_HICR2_IBFIF2 BIT(2) +#define LPC_HICR2_IBFIF1 BIT(1) +/* 0:normal,1:enable err irq-reset,power down,abort */ +#define LPC_HICR2_ERRIE BIT(0) +#define LPC_HICR3 0x00C +#define LPC_LFRAME_STATUS BIT(7) /* R */ +#define LPC_SERIRQ_STATUS BIT(5) /* R */ +#define LPC_LREST_STATUS BIT(4) /* R */ +#define LPC_LPCPD_STATUS BIT(3) /* R */ +#define LPC_PME_STATUS BIT(2) /* R */ +#define LPC_HICR4 0x010 +#define LPC_HICR4_LADR12AS BIT(7) +#define LPC_HICR4_KCSENBL BIT(2) +#define LPC_BTENABLE BIT(0) /* share bt channel enable, 0:disable, 1:enable */ +#define LPC_LADR3H 0x014 +#define LPC_LADR3L 0x018 +#define LPC_LADR12H 0x01C +#define LPC_LADR12L 0x020 +#define LPC_IDR1 0x024 +#define LPC_IDR2 0x028 +#define LPC_IDR3 0x02C +#define LPC_ODR1 0x030 +#define LPC_ODR2 0x034 +#define LPC_ODR3 0x038 +#define LPC_STR1 0x03C +#define LPC_STR2 0x040 +#define LPC_STR3 0x044 + +#define LPC_HICRB 0x80 +#define LPC_HICRB_IBFIF4 BIT(1) +#define LPC_HICRB_LPC4E BIT(0) +#define LPC_LADR4 0x88 +#define LPC_IDR4 0x8c +#define LPC_ODR4 0x90 +#define LPC_STR4 0x94 + +struct phytium_kcs_bmc { + struct regmap *map; +}; + +static u8 phytium_kcs_inb(struct kcs_bmc *kcs_bmc, u32 reg) +{ + struct phytium_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc); + u32 val = 0; + int rc; + + rc = regmap_read(priv->map, reg, &val); + WARN(rc != 0, "regmap_read() failed: %d\n", rc); + + return rc == 0 ? (u8) val : 0; +} + +static void phytium_kcs_outb(struct kcs_bmc *kcs_bmc, u32 reg, u8 data) +{ + struct phytium_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc); + int rc; + + rc = regmap_write(priv->map, reg, data); + WARN(rc != 0, "regmap_write() failed: %d\n", rc); +} + +/* + * Background: + * we note D for Data, and C for Cmd/Status, default rules are + * A. KCS1 / KCS2 ( D / C:X / X+4 ) + * D / C : CA0h / CA4h + * D / C : CA8h / CACh + * B. KCS3 ( D / C:XX2h / XX3h ) + * D / C : CA2h / CA3h + * D / C : CB2h / CB3h -use + * C. KCS4 + * D / C : CA4h / CA5h + * D / C : CB0h / CB1h -use + */ +static void phytium_kcs_set_address(struct kcs_bmc *kcs_bmc, u16 addr) +{ + struct phytium_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc); + + switch (kcs_bmc->channel) { + case 1: + regmap_update_bits(priv->map, LPC_HICR4, LPC_HICR4_LADR12AS, 0); + regmap_write(priv->map, LPC_LADR12H, addr >> 8); + regmap_write(priv->map, LPC_LADR12L, addr & 0xFF); + break; + case 2: + regmap_update_bits(priv->map, LPC_HICR4, + LPC_HICR4_LADR12AS, LPC_HICR4_LADR12AS); + regmap_write(priv->map, LPC_LADR12H, addr >> 8); + regmap_write(priv->map, LPC_LADR12L, addr & 0xFF); + break; + case 3: + regmap_write(priv->map, LPC_LADR3H, addr >> 8); + regmap_write(priv->map, LPC_LADR3L, addr & 0xFF); + break; + case 4: + regmap_write(priv->map, LPC_LADR4, ((addr + 1) << 16) | + addr); + break; + default: + break; + } +} + +static void phytium_kcs_enable_channel(struct kcs_bmc *kcs_bmc, bool enable) +{ + struct phytium_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc); + + switch (kcs_bmc->channel) { + case 1: + if (enable) { + regmap_update_bits(priv->map, LPC_HICR2, + LPC_HICR2_IBFIF1, LPC_HICR2_IBFIF1); + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC1E, LPC_HICR0_LPC1E); + } else { + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC1E, 0); + regmap_update_bits(priv->map, LPC_HICR2, + LPC_HICR2_IBFIF1, 0); + } + break; + case 2: + if (enable) { + regmap_update_bits(priv->map, LPC_HICR2, + LPC_HICR2_IBFIF2, LPC_HICR2_IBFIF2); + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC2E, LPC_HICR0_LPC2E); + } else { + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC2E, 0); + regmap_update_bits(priv->map, LPC_HICR2, + LPC_HICR2_IBFIF2, 0); + } + break; + case 3: + if (enable) { + regmap_update_bits(priv->map, LPC_HICR2, + LPC_HICR2_IBFIF3, LPC_HICR2_IBFIF3); + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC3E, LPC_HICR0_LPC3E); + regmap_update_bits(priv->map, LPC_HICR4, + LPC_HICR4_KCSENBL, LPC_HICR4_KCSENBL); + } else { + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC3E, 0); + regmap_update_bits(priv->map, LPC_HICR4, + LPC_HICR4_KCSENBL, 0); + regmap_update_bits(priv->map, LPC_HICR2, + LPC_HICR2_IBFIF3, 0); + } + break; + case 4: + if (enable) + regmap_update_bits(priv->map, LPC_HICRB, + LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E, + LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E); + else + regmap_update_bits(priv->map, LPC_HICRB, + LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E, + 0); + break; + default: + break; + } +} + +static irqreturn_t phytium_kcs_irq(int irq, void *arg) +{ + struct kcs_bmc *kcs_bmc = arg; + + if (!kcs_bmc_handle_event(kcs_bmc)) + return IRQ_HANDLED; + + return IRQ_NONE; +} + +static int phytium_kcs_config_irq(struct kcs_bmc *kcs_bmc, struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + int irq; + + irq = platform_get_irq(pdev, 0); + if (irq < 0) + return irq; + + return devm_request_irq(dev, irq, phytium_kcs_irq, IRQF_SHARED, + dev_name(dev), kcs_bmc); +} + +static const struct kcs_ioreg phytium_kcs_bmc_ioregs[KCS_CHANNEL_MAX] = { + { .idr = LPC_IDR1, .odr = LPC_ODR1, .str = LPC_STR1 }, + { .idr = LPC_IDR2, .odr = LPC_ODR2, .str = LPC_STR2 }, + { .idr = LPC_IDR3, .odr = LPC_ODR3, .str = LPC_STR3 }, + { .idr = LPC_IDR4, .odr = LPC_ODR4, .str = LPC_STR4 }, +}; + +static int phytium_kcs_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct phytium_kcs_bmc *priv; + struct kcs_bmc *kcs_bmc; + u32 chan, addr; + int rc; + + rc = of_property_read_u32(dev->of_node, "kcs_chan", &chan); + if ((rc != 0) || (chan == 0 || chan > KCS_CHANNEL_MAX)) { + dev_err(dev, "no valid 'kcs_chan' configured\n"); + return -ENODEV; + } + + rc = of_property_read_u32(dev->of_node, "kcs_addr", &addr); + if (rc) { + dev_err(dev, "no valid 'kcs_addr' configured\n"); + return -ENODEV; + } + + kcs_bmc = kcs_bmc_alloc(dev, sizeof(*priv), chan); + if (!kcs_bmc) + return -ENOMEM; + + priv = kcs_bmc_priv(kcs_bmc); + priv->map = syscon_node_to_regmap(dev->parent->of_node); + if (IS_ERR(priv->map)) { + dev_err(dev, "Couldn't get regmap\n"); + return -ENODEV; + } + + kcs_bmc->ioreg = phytium_kcs_bmc_ioregs[chan - 1]; + kcs_bmc->io_inputb = phytium_kcs_inb; + kcs_bmc->io_outputb = phytium_kcs_outb; + + dev_set_drvdata(dev, kcs_bmc); + + phytium_kcs_set_address(kcs_bmc, addr); + phytium_kcs_enable_channel(kcs_bmc, true); + rc = phytium_kcs_config_irq(kcs_bmc, pdev); + if (rc) + return rc; + + rc = misc_register(&kcs_bmc->miscdev); + if (rc) { + dev_err(dev, "Unable to register device\n"); + return rc; + } + + pr_info("channel=%u addr=0x%x idr=0x%x odr=0x%x str=0x%x\n", + chan, addr, kcs_bmc->ioreg.idr, kcs_bmc->ioreg.odr, kcs_bmc->ioreg.str); + + return 0; +} + +static int phytium_kcs_remove(struct platform_device *pdev) +{ + struct kcs_bmc *kcs_bmc = dev_get_drvdata(&pdev->dev); + + misc_deregister(&kcs_bmc->miscdev); + + return 0; +} + +static const struct of_device_id phytium_kcs_bmc_match[] = { + { .compatible = "phytium,kcs-bmc" }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_kcs_bmc_match); + +static struct platform_driver phytium_kcs_bmc_driver = { + .driver = { + .name = DEVICE_NAME, + .of_match_table = phytium_kcs_bmc_match, + }, + .probe = phytium_kcs_probe, + .remove = phytium_kcs_remove, +}; +module_platform_driver(phytium_kcs_bmc_driver); + +MODULE_LICENSE("GPL v2"); +MODULE_AUTHOR("Cheng Quan "); +MODULE_DESCRIPTION("Phytium device interface to the KCS BMC device"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..b79c6156606ea8a9fd89e8cd334ba42739e90856 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/Kconfig @@ -0,0 +1,16 @@ +config PHYTIUM_PCI_DMAC + bool "Phytium px210 PCI DMA support" + depends on OF || COMPILE_TEST + select DMA_ENGINE + select DMA_VIRTUAL_CHANNELS + help + Enable support for Phytium px210 DMA controller + + +config PHYTIUM_DDMA + bool "Phytium PE220x DDMA support" + depends on (ARCH_PHYTIUM || COMPILE_TEST) + select DMA_ENGINE + select DMA_VIRTUAL_CHANNELS + help + Enable support for Phytium PE220x DDMA controller. diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..2698bbe8b26f32b109f4c4af1bba650e00e73d86 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/Makefile @@ -0,0 +1,2 @@ +obj-$(CONFIG_PHYTIUM_PCI_DMAC) += phytium-dmac-pci.o +obj-$(CONFIG_PHYTIUM_DDMA) += phytium-ddmac.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-ddmac.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-ddmac.c new file mode 100644 index 0000000000000000000000000000000000000000..c4d8578a823a09f3c02601ca0a87a0a4d6e2ac5c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-ddmac.c @@ -0,0 +1,945 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium Device DDMA Controller driver. + * + * Copyright (c) 2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytium-ddmac.h" + + +static inline struct phytium_ddma_device *to_ddma_device(struct dma_chan *chan) +{ + return container_of(chan->device, struct phytium_ddma_device, dma_dev); +} + +static inline struct phytium_ddma_chan *to_ddma_chan(struct dma_chan *chan) +{ + return container_of(chan, struct phytium_ddma_chan, vchan.chan); +} + +static inline struct phytium_ddma_desc *to_ddma_desc(struct virt_dma_desc *vd) +{ + return container_of(vd, struct phytium_ddma_desc, vdesc); +} + +static inline struct device *chan_to_dev(struct phytium_ddma_chan *chan) +{ + return chan->vchan.chan.device->dev; +} + +static inline struct phytium_ddma_device *chan_to_ddma( + struct phytium_ddma_chan *chan) +{ + return to_ddma_device(&chan->vchan.chan); +} + +static inline void phytium_ddma_iowrite32( + const struct phytium_ddma_device *ddma, + const u32 reg, const u32 val) +{ + iowrite32(val, ddma->base + reg); +} + +static inline u32 phytium_ddma_ioread32(const struct phytium_ddma_device *ddma, + const u32 reg) +{ + return ioread32(ddma->base + reg); +} + +static inline void phytium_chan_iowrite32(const struct phytium_ddma_chan *chan, + const u32 reg, const u32 val) +{ + iowrite32(val, chan->base + reg); +} + +static inline u32 phytium_chan_ioread32(const struct phytium_ddma_chan *chan, + const u32 reg) +{ + return ioread32(chan->base + reg); +} + +static void phytium_ddma_disable(const struct phytium_ddma_device *ddma) +{ + dev_dbg(ddma->dev, "ddma disable\n"); + phytium_ddma_iowrite32(ddma, DMA_CTL, !DMA_CTL_EN); +} + +static void phytium_ddma_enable(const struct phytium_ddma_device *ddma) +{ + dev_dbg(ddma->dev, "ddma enable\n"); + phytium_ddma_iowrite32(ddma, DMA_CTL, DMA_CTL_EN); +} + +static void phytium_ddma_reset(const struct phytium_ddma_device *ddma) +{ + u32 val = 0; + + dev_dbg(ddma->dev, "dma reset\n"); + val = phytium_ddma_ioread32(ddma, DMA_CTL); + val |= DMA_CTL_SRST; + phytium_ddma_iowrite32(ddma, DMA_CTL, val); + + udelay(10); + val &= ~DMA_CTL_SRST; + phytium_ddma_iowrite32(ddma, DMA_CTL, val); +} + +static void phytium_ddma_irq_disable(const struct phytium_ddma_device *ddma) +{ + u32 val = 0; + + dev_dbg(ddma->dev, "ddma irq disable\n"); + val = phytium_ddma_ioread32(ddma, DMA_MASK_INT); + val |= DMA_INT_EN; + phytium_ddma_iowrite32(ddma, DMA_MASK_INT, val); +} + +static void phytium_ddma_irq_enable(const struct phytium_ddma_device *ddma) +{ + u32 val = 0; + + dev_dbg(ddma->dev, "ddma irq enable\n"); + val = phytium_ddma_ioread32(ddma, DMA_MASK_INT); + val &= ~DMA_INT_EN; + phytium_ddma_iowrite32(ddma, DMA_MASK_INT, val); +} + +static u32 phytium_ddma_irq_read(const struct phytium_ddma_device *ddma) +{ + u32 val = 0; + + val = phytium_ddma_ioread32(ddma, DMA_STAT); + + return val; +} + +static void phytium_chan_irq_disable(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d irq disable\n", chan->id); + val = phytium_ddma_ioread32(chan_to_ddma(chan), DMA_MASK_INT); + val |= DMA_INT_CHAL_EN(chan->id); + phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_MASK_INT, val); +} + +static void phytium_chan_irq_enable(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d irq enable\n", chan->id); + val = phytium_ddma_ioread32(chan_to_ddma(chan), DMA_MASK_INT); + val &= ~DMA_INT_CHAL_EN(chan->id); + phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_MASK_INT, val); +} + +static void phytium_chan_irq_clear(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d irq clear\n", chan->id); + val = DMA_STAT_CHAL(chan->id); + phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_STAT, val); +} + +static int phytium_chan_disable(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + int ret = 0; + + dev_dbg(chan_to_dev(chan), "channel %d disable\n", chan->id); + val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); + if (val | DMA_CHAL_EN) { + val &= ~DMA_CHAL_EN; + phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); + + ret = readl_relaxed_poll_timeout_atomic( + chan->base + DMA_CHALX_CTL, val, + !(val & DMA_CHAL_EN), 0, 100000); + } + return ret; +} + +static void phytium_chan_enable(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d enable\n", chan->id); + val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); + val |= DMA_CHAL_EN; + phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); +} + +static bool phytium_chan_is_running(const struct phytium_ddma_chan *chan) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); + + if (val & DMA_CHAL_EN) + return true; + else + return false; +} + +static void phytium_chan_reset(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d reset\n", chan->id); + val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); + val |= DMA_CHAL_SRST; + phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); + + udelay(10); + val &= ~DMA_CHAL_SRST; + phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); +} + +static void phytium_ddma_vdesc_free(struct virt_dma_desc *vd) +{ + kfree(to_ddma_desc(vd)); +} + +static int phytium_chan_pause(struct dma_chan *chan) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + int ret = 0; + + ret = phytium_chan_disable(pchan); + pchan->busy = false; + pchan->is_pasued = true; + + return ret; +} + +static int phytium_chan_resume(struct dma_chan *chan) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + + phytium_chan_enable(pchan); + pchan->is_pasued = false; + + return 0; +} + +static void phytium_chan_start_xfer(struct phytium_ddma_chan *chan) +{ + struct virt_dma_desc *vdesc = NULL; + struct phytium_ddma_sg_req *sg_req = NULL; + char *tmp = NULL; + int i = 0; + unsigned long flags = 0; + + /* chan first xfer settings */ + if (!chan->desc) { + vdesc = vchan_next_desc(&chan->vchan); + if (!vdesc) + return; + + list_del(&vdesc->node); + chan->desc = to_ddma_desc(vdesc); + chan->next_sg = 0; + chan->current_sg = NULL; + dev_dbg(chan_to_dev(chan), "xfer start\n"); + } + + if (chan->next_sg == chan->desc->num_sgs) + chan->next_sg = 0; + + sg_req = &chan->desc->sg_req[chan->next_sg]; + chan->current_sg = sg_req; + /* fill to 4 bytes */ + switch (sg_req->direction) { + case DMA_MEM_TO_DEV: + tmp = phys_to_virt(sg_req->mem_addr_l); + memset(chan->buf, 0, sg_req->len * 4); + for (i = 0; i < sg_req->len; i++) + chan->buf[i * 4] = tmp[i]; + break; + + case DMA_DEV_TO_MEM: + memset(chan->buf, 0, sg_req->len * 4); + break; + + default: + break; + } + + /* start transfer */ + phytium_chan_iowrite32(chan, DMA_CHALX_DDR_LWADDR, + chan->paddr & 0xFFFFFFFF); + phytium_chan_iowrite32(chan, DMA_CHALX_DDR_UPADDR, + (chan->paddr >> 32) & 0xFFFFFFFF); + phytium_chan_iowrite32(chan, DMA_CHALX_DEV_ADDR, sg_req->dev_addr); + phytium_chan_iowrite32(chan, DMA_CHALX_TS, sg_req->len * 4); + + spin_lock_irqsave(&chan_to_ddma(chan)->lock, flags); + phytium_chan_irq_enable(chan); + spin_unlock_irqrestore(&chan_to_ddma(chan)->lock, flags); + phytium_chan_enable(chan); + + chan->next_sg++; + chan->busy = true; +} + +static void phytium_chan_xfer_done(struct phytium_ddma_chan *chan) +{ + struct phytium_ddma_sg_req *sg_req = chan->current_sg; + char *tmp = NULL; + int i = 0; + + if (chan->desc) { + if (sg_req->direction == DMA_DEV_TO_MEM) { + tmp = phys_to_virt(sg_req->mem_addr_l); + for (i = 0; i < sg_req->len; i++) + tmp[i] = chan->buf[i * 4]; + } + + chan->busy = false; + if (chan->next_sg == chan->desc->num_sgs) { + dev_dbg(chan_to_dev(chan), "xfer complete\n"); + vchan_cookie_complete(&chan->desc->vdesc); + chan->desc = NULL; + chan->current_sg = NULL; + } + phytium_chan_disable(chan); + phytium_chan_irq_clear(chan); + phytium_chan_start_xfer(chan); + } +} + +static void phytium_dma_hw_init(struct phytium_ddma_device *ddma) +{ + u32 i = 0; + int ret = 0; + + phytium_ddma_disable(ddma); + phytium_ddma_reset(ddma); + phytium_ddma_irq_enable(ddma); + phytium_ddma_enable(ddma); + + for (i = 0; i < ddma->dma_channels; i++) { + phytium_chan_irq_disable(&ddma->chan[i]); + ret = phytium_chan_disable(&ddma->chan[i]); + if (ret) + dev_err(ddma->dev, "can't disable channel %d\n", i); + } +} + +static size_t phytium_ddma_desc_residue(struct phytium_ddma_chan *chan) +{ + u32 trans_cnt = 0; + u32 residue = 0; + int i = 0; + + trans_cnt = phytium_chan_ioread32(chan, DMA_CHALX_TRANS_CNT); + residue = chan->current_sg->len - trans_cnt; + + for (i = chan->next_sg; i < chan->desc->num_sgs; i++) + residue += chan->desc->sg_req[i].len; + + return residue; +} + +static enum dma_status phytium_ddma_tx_status(struct dma_chan *chan, + dma_cookie_t cookie, + struct dma_tx_state *txstate) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + struct virt_dma_desc *vd = NULL; + enum dma_status ret = 0; + unsigned long flags = 0; + size_t residue = 0; + + ret = dma_cookie_status(chan, cookie, txstate); + if ((ret == DMA_COMPLETE) || !txstate) + return ret; + + spin_lock_irqsave(&pchan->vchan.lock, flags); + vd = vchan_find_desc(&pchan->vchan, cookie); + if (pchan->desc && cookie == pchan->desc->vdesc.tx.cookie) + residue = phytium_ddma_desc_residue(pchan); + + dma_set_residue(txstate, residue); + spin_unlock_irqrestore(&pchan->vchan.lock, flags); + + if (pchan->is_pasued && ret == DMA_IN_PROGRESS) + ret = DMA_PAUSED; + + return ret; +} + +static void phytium_ddma_issue_pending(struct dma_chan *chan) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + unsigned long flags = 0; + + spin_lock_irqsave(&pchan->vchan.lock, flags); + + if (vchan_issue_pending(&pchan->vchan) && !pchan->desc && !pchan->busy) + phytium_chan_start_xfer(pchan); + + spin_unlock_irqrestore(&pchan->vchan.lock, flags); +} + +static int phytium_ddma_terminate_all(struct dma_chan *chan) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + unsigned long flags = 0; + LIST_HEAD(head); + + spin_lock_irqsave(&pchan->vchan.lock, flags); + if (pchan->desc) { + vchan_terminate_vdesc(&pchan->desc->vdesc); + if (pchan->busy) { + u32 tmp_ctl, timeout; + phytium_chan_disable(pchan); + /* save some registers, reset will clear it */ + timeout = phytium_chan_ioread32(pchan, + DMA_CHALX_TIMEOUT_CNT); + tmp_ctl = phytium_chan_ioread32(pchan, + DMA_CHALX_CTL); + spin_lock(&chan_to_ddma(pchan)->lock); + phytium_chan_irq_disable(pchan); + spin_unlock(&chan_to_ddma(pchan)->lock); + /* need reset when terminate */ + phytium_chan_reset(pchan); + phytium_chan_irq_clear(pchan); + /* recover it */ + phytium_chan_iowrite32(pchan, + DMA_CHALX_CTL, tmp_ctl); + phytium_chan_iowrite32(pchan, + DMA_CHALX_TIMEOUT_CNT, timeout); + pchan->busy = false; + } + pchan->desc = NULL; + } + + vchan_get_all_descriptors(&pchan->vchan, &head); + spin_unlock_irqrestore(&pchan->vchan.lock, flags); + vchan_dma_desc_free_list(&pchan->vchan, &head); + + return 0; +} + +static int phytium_ddma_alloc_chan_resources(struct dma_chan *chan) +{ + struct phytium_ddma_device *ddma = to_ddma_device(chan); + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + u32 bind_status = 0; + int ret = 0; + unsigned long flags = 0; + + bind_status = phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); + + if ((pchan->is_used) || (bind_status & BIT(pchan->id))) { + dev_err(ddma->dev, "channel %d already used\n", pchan->id); + ret = -EBUSY; + goto out; + } + + /* prepare channel */ + ret = phytium_chan_disable(pchan); + if (ret) { + dev_err(ddma->dev, "can't disable channel %d\n", pchan->id); + goto out; + } + phytium_chan_reset(pchan); + phytium_chan_irq_clear(pchan); + + /* channel bind */ + spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); + bind_status |= BIT(pchan->id); + phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, bind_status); + pchan->is_used = true; + spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); + + /* alloc dma memory */ + pchan->buf = dma_alloc_coherent(ddma->dev, 4 * PAGE_SIZE, &pchan->paddr, + GFP_KERNEL); + if (!pchan->buf) { + ret = -EBUSY; + dev_err(ddma->dev, "failed to alloc dma memory\n"); + } + + dev_info(ddma->dev, "alloc channel %d\n", pchan->id); + +out: + return ret; +} + +static void phytium_ddma_free_chan_resources(struct dma_chan *chan) +{ + struct phytium_ddma_device *ddma = to_ddma_device(chan); + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + u32 bind_status = 0; + unsigned long flags = 0; + + if (!pchan->is_used) + return; + + dev_dbg(ddma->dev, "free channel %d\n", pchan->id); + spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); + bind_status = phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); + bind_status &= ~BIT(pchan->id); + phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, bind_status); + spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); + + phytium_chan_disable(pchan); + + spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); + phytium_chan_irq_disable(pchan); + spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); + + vchan_free_chan_resources(to_virt_chan(chan)); + pchan->is_used = false; + + if (pchan->buf) + dma_free_coherent(ddma->dev, 4 * PAGE_SIZE, + pchan->buf, pchan->paddr); +} + +static int phytium_ddma_slave_config(struct dma_chan *chan, + struct dma_slave_config *config) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + u32 chal_cfg = 0; + u32 req_mode = 0; + const u32 timeout = 0xffff; + unsigned long flag = 0; + + /* Check if chan will be configured for slave transfers */ + if (!is_slave_direction(config->direction)) + return -EINVAL; + + memcpy(&pchan->dma_config, config, sizeof(*config)); + + /* set channel config reg */ + spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flag); + if (pchan->id > 3) { + chal_cfg = phytium_ddma_ioread32(chan_to_ddma(pchan), + DMA_CHAL_CFG_H); + chal_cfg &= ~(0xFF << ((pchan->id - 4) * 8)); + chal_cfg |= DMA_CHAL_SEL((pchan->id - 4), pchan->request_line); + chal_cfg |= DMA_CHAL_SEL_EN(pchan->id - 4); + phytium_ddma_iowrite32(chan_to_ddma(pchan), DMA_CHAL_CFG_H, + chal_cfg); + } else { + chal_cfg = phytium_ddma_ioread32(chan_to_ddma(pchan), + DMA_CHAL_CFG_L); + chal_cfg &= ~(0xFF << (pchan->id * 8)); + chal_cfg |= DMA_CHAL_SEL((pchan->id), pchan->request_line); + chal_cfg |= DMA_CHAL_SEL_EN(pchan->id); + phytium_ddma_iowrite32(chan_to_ddma(pchan), DMA_CHAL_CFG_L, + chal_cfg); + } + spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flag); + + /* set channel mode */ + req_mode = (config->direction == DMA_DEV_TO_MEM) ? + DMA_RX_REQ : DMA_TX_REQ; + phytium_chan_iowrite32(pchan, DMA_CHALX_CTL, req_mode << 2); + + /* set channel timeout */ + phytium_chan_iowrite32(pchan, DMA_CHALX_TIMEOUT_CNT, + timeout | DMA_CHAL_TIMEOUT_EN); + + return 0; +} + +static struct dma_async_tx_descriptor *phytium_ddma_prep_slave_sg( + struct dma_chan *chan, struct scatterlist *sgl, + u32 sg_len, enum dma_transfer_direction direction, + unsigned long flags, void *context) +{ + struct phytium_ddma_device *ddma = to_ddma_device(chan); + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + struct dma_slave_config *sconfig = &pchan->dma_config; + struct phytium_ddma_desc *desc = NULL; + struct scatterlist *sg = NULL; + int i = 0; + char *tmp; + + if (unlikely(!is_slave_direction(direction))) { + dev_err(ddma->dev, "invalid dma direction\n"); + return NULL; + } + + if (unlikely(sg_len < 1)) { + dev_err(ddma->dev, "invalid segment length: %d\n", sg_len); + return NULL; + } + + desc = kzalloc(struct_size(desc, sg_req, sg_len), GFP_NOWAIT); + if (!desc) + return NULL; + + /* set sg list */ + for_each_sg(sgl, sg, sg_len, i) { + tmp = phys_to_virt(sg_dma_address(sg)); + desc->sg_req[i].direction = direction; + + switch (direction) { + case DMA_MEM_TO_DEV: + desc->sg_req[i].len = sg_dma_len(sg); + desc->sg_req[i].mem_addr_l = + sg_dma_address(sg) & 0xFFFFFFFF; + desc->sg_req[i].mem_addr_h = + (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; + desc->sg_req[i].dev_addr = + sconfig->dst_addr & 0xFFFFFFFF; + break; + + case DMA_DEV_TO_MEM: + desc->sg_req[i].len = sg_dma_len(sg); + desc->sg_req[i].mem_addr_l = + sg_dma_address(sg) & 0xFFFFFFFF; + desc->sg_req[i].mem_addr_h = + (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; + desc->sg_req[i].dev_addr = + sconfig->src_addr & 0xFFFFFFFF; + break; + + default: + return NULL; + } + } + + desc->num_sgs = sg_len; + + return vchan_tx_prep(&pchan->vchan, &desc->vdesc, flags); +} + +static irqreturn_t phytium_dma_interrupt(int irq, void *dev_id) +{ + struct phytium_ddma_device *ddma = dev_id; + struct phytium_ddma_chan *chan; + u32 irq_status = 0; + u32 i = 0; + u32 val = 0; + + phytium_ddma_irq_disable(ddma); + + irq_status = phytium_ddma_irq_read(ddma); + val = phytium_ddma_ioread32(ddma, DMA_CTL); + + /* Poll, clear and process every chanel interrupt status */ + for (i = 0; i < ddma->dma_channels; i++) { + if (!(irq_status & BIT(i * 4))) + continue; + + chan = &ddma->chan[i]; + phytium_chan_xfer_done(chan); + } + + phytium_ddma_irq_enable(ddma); + + return IRQ_HANDLED; +} + + +static struct dma_chan *phytium_ddma_of_xlate(struct of_phandle_args *dma_spec, + struct of_dma *ofdma) +{ + struct phytium_ddma_device *ddma = ofdma->of_dma_data; + struct device *dev = ddma->dev; + struct phytium_ddma_chan *chan = NULL; + struct dma_chan *c = NULL; + u32 channel_id = 0; + + channel_id = dma_spec->args[0]; + + if (channel_id > ddma->dma_channels) { + dev_err(dev, "bad channel %d\n", channel_id); + return NULL; + } + + chan = &ddma->chan[channel_id]; + chan->request_line = dma_spec->args[1]; + c = dma_get_slave_channel(&chan->vchan.chan); + if (!c) { + dev_err(dev, "no more channels available\n"); + return NULL; + } + + return c; +} + +static int phytium_ddma_probe(struct platform_device *pdev) +{ + struct phytium_ddma_device *ddma; + struct dma_device *dma_dev; + struct resource *mem; + u32 i = 0; + int ret = 0; + u32 nr_channels = 0; + + ddma = devm_kzalloc(&pdev->dev, sizeof(*ddma), GFP_KERNEL); + if (!ddma) { + ret = -ENOMEM; + goto out; + } + + dma_dev = &ddma->dma_dev; + ddma->dev = &pdev->dev; + + spin_lock_init(&ddma->lock); + + ddma->irq = platform_get_irq(pdev, 0); + if (ddma->irq < 0) { + dev_err(&pdev->dev, "no irq resource\n"); + ret = -EINVAL; + goto out; + } + + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); + ddma->base = devm_ioremap_resource(&pdev->dev, mem); + if (IS_ERR(ddma->base)) { + dev_err(&pdev->dev, "no resource address"); + ret = PTR_ERR(ddma->base); + goto out; + } + + ret = of_property_read_u32(pdev->dev.of_node, "dma-channels", + &nr_channels); + if (ret < 0) { + dev_err(&pdev->dev, + "can't get the number of dma channels: %d\n", ret); + goto out; + } + + if (nr_channels > DDMA_MAX_NR_PCHANNELS) { + dev_warn(&pdev->dev, "over the max number of channels\n"); + nr_channels = DDMA_MAX_NR_PCHANNELS; + } + + ddma->dma_channels = DDMA_MAX_NR_PCHANNELS; + + ret = devm_request_irq(&pdev->dev, ddma->irq, phytium_dma_interrupt, + IRQF_SHARED, dev_name(&pdev->dev), ddma); + if (ret) { + dev_err(&pdev->dev, "could not to request irq %d", ddma->irq); + goto out; + } + + /* Set capabilities */ + dma_cap_set(DMA_SLAVE, ddma->dma_dev.cap_mask); + + /* DMA capabilities */ + dma_dev->dev = ddma->dev; + dma_dev->chancnt = ddma->dma_channels; + dma_dev->src_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_4_BYTES); + dma_dev->dst_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_4_BYTES); + dma_dev->directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV); + dma_dev->residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; + + /* function callback */ + dma_dev->device_tx_status = phytium_ddma_tx_status; + dma_dev->device_issue_pending = phytium_ddma_issue_pending; + dma_dev->device_terminate_all = phytium_ddma_terminate_all; + dma_dev->device_alloc_chan_resources = + phytium_ddma_alloc_chan_resources; + dma_dev->device_free_chan_resources = phytium_ddma_free_chan_resources; + dma_dev->device_config = phytium_ddma_slave_config; + dma_dev->device_prep_slave_sg = phytium_ddma_prep_slave_sg; + dma_dev->device_pause = phytium_chan_pause; + dma_dev->device_resume = phytium_chan_resume; + + /* init dma physical channels */ + INIT_LIST_HEAD(&dma_dev->channels); + ddma->chan = devm_kcalloc(ddma->dev, ddma->dma_channels, + sizeof(*ddma->chan), GFP_KERNEL); + if (!ddma->chan) { + ret = -ENOMEM; + goto out; + } + for (i = 0; i < ddma->dma_channels; i++) { + ddma->chan[i].id = i; + ddma->chan[i].buf = NULL; + ddma->chan[i].base = ddma->base + DMA_REG_LEN + + i * CHAN_REG_LEN; + ddma->chan[i].vchan.desc_free = phytium_ddma_vdesc_free; + ddma->chan[i].desc = NULL; + ddma->chan[i].current_sg = NULL; + vchan_init(&ddma->chan[i].vchan, dma_dev); + } + + phytium_dma_hw_init(ddma); + + ret = dma_async_device_register(dma_dev); + if (ret) + goto out; + + ret = of_dma_controller_register(pdev->dev.of_node, + phytium_ddma_of_xlate, ddma); + if (ret < 0) { + dev_err(&pdev->dev, + "phytium ddma of register failed %d\n", ret); + goto err_unregister; + } + + platform_set_drvdata(pdev, ddma); + dev_info(ddma->dev, "phytium DDMA Controller registered\n"); + + return 0; + +err_unregister: + dma_async_device_unregister(dma_dev); + +out: + return ret; +} + +static void phytium_ddma_chan_remove(struct phytium_ddma_chan *chan) +{ + phytium_chan_irq_disable(chan); + phytium_chan_disable(chan); + + if (chan->buf) + dma_free_coherent(chan_to_dev(chan), 4 * PAGE_SIZE, chan->buf, + chan->paddr); + + tasklet_kill(&chan->vchan.task); + list_del(&chan->vchan.chan.device_node); +} + +static int phytium_ddma_remove(struct platform_device *pdev) +{ + struct phytium_ddma_device *ddma = platform_get_drvdata(pdev); + struct phytium_ddma_chan *chan = NULL; + int i = 0; + + of_dma_controller_free(pdev->dev.of_node); + dma_async_device_unregister(&ddma->dma_dev); + + for (i = 0; i < ddma->dma_channels; i++) { + chan = &ddma->chan[i]; + phytium_ddma_chan_remove(chan); + } + + phytium_ddma_irq_disable(ddma); + phytium_ddma_disable(ddma); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_ddma_suspend(struct device *dev) +{ + struct phytium_ddma_device *ddma = dev_get_drvdata(dev); + int i = 0; + + for (i = 0; i < ddma->dma_channels; i++) { + if (phytium_chan_is_running(&ddma->chan[i])) { + dev_warn(dev, + "suspend is prevented by channel %d\n", i); + return -EBUSY; + } + } + + ddma->dma_reg.dma_chal_cfg0 = + phytium_ddma_ioread32(ddma, DMA_CHAL_CFG_L); + ddma->dma_reg.dma_chal_bind = + phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); + ddma->dma_reg.dma_chal_cfg1 = + phytium_ddma_ioread32(ddma, DMA_CHAL_CFG_H); + + for (i = 0; i < ddma->dma_channels; i++) { + struct phytium_ddma_chan *chan = &ddma->chan[i]; + + if (!chan->is_used) + continue; + ddma->dma_chal_reg[i].dma_chalx_ctl = + phytium_chan_ioread32(chan, DMA_CHALX_CTL); + ddma->dma_chal_reg[i].dma_chalx_timeout_cnt = + phytium_chan_ioread32(chan, DMA_CHALX_TIMEOUT_CNT); + } + + phytium_ddma_irq_disable(ddma); + phytium_ddma_disable(ddma); + pm_runtime_force_suspend(dev); + + return 0; +} + +static int phytium_ddma_resume(struct device *dev) +{ + struct phytium_ddma_device *ddma = dev_get_drvdata(dev); + u32 i = 0; + int ret = 0; + + phytium_dma_hw_init(ddma); + phytium_ddma_iowrite32(ddma, DMA_CHAL_CFG_L, + ddma->dma_reg.dma_chal_cfg0); + phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, + ddma->dma_reg.dma_chal_bind); + phytium_ddma_iowrite32(ddma, DMA_CHAL_CFG_H, + ddma->dma_reg.dma_chal_cfg1); + + for (i = 0; i < ddma->dma_channels; i++) { + struct phytium_ddma_chan *chan = &ddma->chan[i]; + + if (!chan->is_used) + continue; + phytium_chan_iowrite32(chan, DMA_CHALX_CTL, + ddma->dma_chal_reg[i].dma_chalx_ctl); + phytium_chan_iowrite32(chan, DMA_CHALX_TIMEOUT_CNT, + ddma->dma_chal_reg[i].dma_chalx_timeout_cnt); + } + + ret = pm_runtime_force_resume(dev); + + return ret; +} +#endif + +static const struct dev_pm_ops phytium_ddma_pm_ops = { + SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_ddma_suspend, + phytium_ddma_resume) +}; + +static const struct of_device_id phytium_dma_of_id_table[] = { + { .compatible = "phytium,ddma" }, + {} +}; +MODULE_DEVICE_TABLE(of, phytium_dma_of_id_table); + +static struct platform_driver phytium_driver = { + .probe = phytium_ddma_probe, + .remove = phytium_ddma_remove, + .driver = { + .name = "phytium-ddma", + .of_match_table = of_match_ptr(phytium_dma_of_id_table), + .pm = &phytium_ddma_pm_ops, + }, +}; + +module_platform_driver(phytium_driver); + +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium DDMA Controller platform driver"); +MODULE_AUTHOR("HuangJie "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-ddmac.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-ddmac.h new file mode 100644 index 0000000000000000000000000000000000000000..d99cd5756484c5f7e7edcd0cc0c36b50292a1047 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-ddmac.h @@ -0,0 +1,164 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ +/* + * Phytium Device DDMA Controller driver. + * + * Copyright (c) 2024 Phytium Technology Co., Ltd. + */ + +#ifndef _PHYTIUM_DDMAC_H +#define _PHYTIUM_DDMAC_H + +#include +#include +#include +#include +#include +#include "../virt-dma.h" + +/* the number of physical channel */ +#define DDMA_MAX_NR_PCHANNELS 8 + +#define DMAC_MAX_MASTERS 1 +#define DMAC_MAX_BLK_SIZE PAGE_SIZE + +#define CHAN_REG_LEN 0x40 +#define DMA_REG_LEN 0x40 + +#define DMA_CTL 0x00 +#define DMA_CHAL_CFG_L 0x04 +#define DMA_CHAL_CFG_H 0x28 +#define DMA_STAT 0x08 +#define DMA_MASK_INT 0x0C +#define DMA_CHAL_BIND 0x20 +#define DMA_GCAP 0x24 + +#define DMA_CHALX_DDR_UPADDR 0x00 +#define DMA_CHALX_DDR_LWADDR 0x04 +#define DMA_CHALX_DEV_ADDR 0x08 +#define DMA_CHALX_TS 0x0C +#define DMA_CHALX_CRT_UPADDR 0x10 +#define DMA_CHALX_CRT_LWADDR 0x14 +#define DMA_CHALX_CTL 0x18 +#define DMA_CHALX_STS 0x1C +#define DMA_CHALX_TIMEOUT_CNT 0x20 +#define DMA_CHALX_TRANS_CNT 0x24 + +#define DMA_CTL_EN BIT(0) +#define DMA_CTL_SRST BIT(1) + +#define DMA_CHAL_SEL(id, x) (min_t(unsigned int, x, 0x7F) << ((id) * 8)) +#define DMA_CHAL_SEL_EN(id) BIT((id) * 8 + 7) + +#define DMA_STAT_CHAL(id) BIT((id) * 4) + +#define DMA_INT_EN BIT(31) +#define DMA_INT_CHAL_EN(id) BIT(id) + +#define DMA_CHAL_EN BIT(0) +#define DMA_CHAL_SRST BIT(1) +#define DMA_CHAL_MODE BIT(2) + +#define DMA_RX_REQ 1 +#define DMA_TX_REQ 0 + +#define DMA_CHAL_TIMEOUT_EN BIT(31) +#define DMA_CHAL_TIMEOUT_CNT(x) min_t(unsigned int, x, 0xFFFFF) + +#define DMA_TIMEOUT 10 + +/** + * struct phytium_ddma_sg_req - scatter-gatter list data info + * @len: number of bytes to transform + * @mem_addr_l: bus address low 32bit + * @mem_addr_h: bus address high 32bit + * @dev_addr: dma cousumer data reg addr + * @direction: dma transmit direction + */ +struct phytium_ddma_sg_req { + u32 len; + u32 mem_addr_l; + u32 mem_addr_h; + u32 dev_addr; + enum dma_transfer_direction direction; +}; + +/** + * struct phytium_ddma_desc - the struct holding info describing ddma request + * descriptor + * @vdesc: ddma request descriptor + * @num_sgs: the size of scatter-gatter list + * @sg_req: use to save scatter-gatter list info + */ +struct phytium_ddma_desc { + struct virt_dma_desc vdesc; + u32 num_sgs; + struct phytium_ddma_sg_req sg_req[]; +}; + +/** + * struct phytium_ddma_chan - the struct holding info describing dma channel + * @vchan: virtual dma channel + * @base: the mapped register I/O of dma physical channel + * @id: the id of ddma physical channel + * @request_line: the request line of ddma channel + * @desc: the transform request descriptor + * @dma_config: config parameters for dma channel + * @busy: the channel busy flag, this flag set when channel is tansferring + * @is_used: the channel bind flag, this flag set when channel binded + * @next_sg: the index of next scatter-gatter + * @current_sg: use to save the current transfer scatter-gatter info + * @paddr: use to align data between dma provider and consumer + */ +struct phytium_ddma_chan { + struct virt_dma_chan vchan; + void __iomem *base; + u32 id; + u32 request_line; + struct phytium_ddma_desc *desc; + struct dma_slave_config dma_config; + bool busy; + bool is_used; + bool is_pasued; + u32 next_sg; + struct phytium_ddma_sg_req *current_sg; + dma_addr_t paddr; + char *buf; +}; + +struct global_reg { + u32 dma_chal_cfg0; + u32 dma_chal_bind; + u32 dma_chal_cfg1; +}; + +struct channel_reg { + u32 dma_chalx_ctl; + u32 dma_chalx_timeout_cnt; +}; + +/** + * struct phytium_ddma_device - the struct holding info describing DDMA device + * @dma_dev: an instance for struct dma_device + * @irq: the irq that DDMA using + * @base: the mapped register I/O base of this DDMA + * @core_clk: DDMA clock + * @dma_channels: the number of DDMA physical channels + * @chan: the phyical channels of DDMA + * @lock: spinlock to lock when set global registers + * @dma_reg: store global register value which need recover after resume + * @dma_chal_reg: store channel register value which need recover after resume + */ +struct phytium_ddma_device { + struct dma_device dma_dev; + struct device *dev; + int irq; + void __iomem *base; + struct clk *core_clk; + u32 dma_channels; + struct phytium_ddma_chan *chan; + spinlock_t lock; + struct global_reg dma_reg; + struct channel_reg dma_chal_reg[DDMA_MAX_NR_PCHANNELS]; +}; + +#endif /* _PHYTIUM_DDMAC_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-dmac-pci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-dmac-pci.c new file mode 100644 index 0000000000000000000000000000000000000000..2d296e285331c107daaae2f5677bd12b4be5eefe --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-dmac-pci.c @@ -0,0 +1,1053 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + * + * Phytium PCI DMA Controller driver. + * + * 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 +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + +#include +#include +#include +#include + +#include "phytium-dmac-pci.h" +#include "../dmaengine.h" +#include "../virt-dma.h" + +static const struct dma_slave_map ft_px210gpu_slave_map[] = { + {"px210-dma", "tx", 0}, + {"px210-dma", "rx", 0}, +}; + +bool px210_filter_fn(struct dma_chan *chan, void *param); + +static inline void +phytium_dma_iowrite32(struct phytium_dma_chip *chip, u32 reg, u32 val) +{ + iowrite32(val, chip->regs + reg); +} + +static inline u32 phytium_dma_ioread32(struct phytium_dma_chip *chip, u32 reg) +{ + return ioread32(chip->regs + reg); +} + +static inline void +phytium_chan_iowrite32(struct phytium_dma_chan *chan, u32 reg, u32 val) +{ + iowrite32(val, chan->chan_regs + reg); +} + +static inline u32 phytium_chan_ioread32(struct phytium_dma_chan *chan, u32 reg) +{ + return ioread32(chan->chan_regs + reg); +} + +static inline void phytium_dma_irq_disable(struct phytium_dma_chip *chip) +{ + u32 val; + + val = 0; + phytium_dma_iowrite32(chip, DMA_IRQ_MASK, val); +} + +static inline void phytium_dma_irq_enable(struct phytium_dma_chip *chip) +{ + u32 val; + + val = 0x4077FFFF; + phytium_dma_iowrite32(chip, DMA_IRQ_MASK, val); +} + +static inline void phytium_dma_irq_clear(struct phytium_dma_chip *chip, + u32 irq_status) +{ + phytium_dma_iowrite32(chip, DMA_IRQ_STATUS, irq_status); +} + +static inline u32 phytium_dma_irq_read(struct phytium_dma_chip *chip) +{ + u32 val; + + val = phytium_dma_ioread32(chip, DMA_IRQ_STATUS); + + return val; +} + +static inline u32 phytium_dma_irq_mask_read(struct phytium_dma_chip *chip) +{ + u32 val; + + val = phytium_dma_ioread32(chip, DMA_IRQ_MASK); + + return val; +} + + +static inline void phytium_chan_irq_disable(struct phytium_dma_chan *chan, u32 irq_mask) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CONTROL); + val &= ~irq_mask; + phytium_chan_iowrite32(chan, DMA_CONTROL, val); +} + +static inline void phytium_chan_irq_set(struct phytium_dma_chan *chan, u32 irq_mask) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CONTROL); + val &= ~DMA_CTRL_IRQ_MASK(0xF); + val |= irq_mask; + val |= DMA_CTRL_IRQ_ID(1); + phytium_chan_iowrite32(chan, DMA_CONTROL, val); +} + +static inline void phytium_chan_irq_clear(struct phytium_dma_chan *chan, u32 irq_mask) +{ + u32 val; + + val = phytium_dma_ioread32(chan->chip, DMA_IRQ_STATUS); + val &= ~irq_mask; + phytium_chan_iowrite32(chan, DMA_IRQ_STATUS, val); +} + +static inline u32 phytium_chan_irq_read(struct phytium_dma_chan *chan) +{ + u32 val; + + val = phytium_dma_ioread32(chan->chip, DMA_IRQ_STATUS); + val &= ((chan->id << 0) | (chan->id << 8)); + + return val; +} + +static inline u32 phytium_chan_status_read(struct phytium_dma_chan *chan) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_STATUS); + + return val; +} + +static inline void phytium_chan_disable(struct phytium_dma_chan *chan) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CONTROL); + val &= ~DMA_CTRL_START; + phytium_chan_iowrite32(chan, DMA_CONTROL, val); +} + +static inline void phytium_chan_enable(struct phytium_dma_chan *chan) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CONTROL); + val |= DMA_CTRL_START; + phytium_chan_iowrite32(chan, DMA_CONTROL, val); +} + +static inline const char *phytium_chan_name(struct phytium_dma_chan *chan) +{ + return dma_chan_name(&chan->vc.chan); +} + +static struct phytium_dma_desc *phytium_desc_get(struct phytium_dma_chan *chan) +{ + struct phytium_dma_desc *desc = NULL; + + desc = kmalloc(sizeof(*desc), GFP_KERNEL); + if (unlikely(!desc)) { + dev_err(chan2dev(chan), "%s: not enough descriptors available\n", + phytium_chan_name(chan)); + return NULL; + } + + memset(desc, 0, sizeof(*desc)); + + INIT_LIST_HEAD(&desc->xfer_list); + + return desc; +} + +static void phytium_desc_put(struct phytium_dma_desc *desc) +{ + unsigned int descs_put = 0; + + kfree(desc); + + descs_put++; +} + +static void phytium_vchan_desc_put(struct virt_dma_desc *vdesc) +{ + phytium_desc_put(vd_to_desc(vdesc)); +} + +static inline bool phytium_chan_is_running(struct phytium_dma_chan *chan) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CONTROL); + + if (val & DMA_CTRL_START) + return true; + else + return false; +} + +/* Called in chan locked context */ +static void phytium_chan_block_xfer_start(struct phytium_dma_chan *chan, + struct phytium_dma_desc *desc) +{ + u32 irq_mask; + u32 val; + + chan->is_idle = false; + if (phytium_chan_is_running(chan)) { + dev_err(chan2dev(chan), "%s is non-idle!\n", phytium_chan_name(chan)); + return; + } + + phytium_chan_iowrite32(chan, DMA_SRCPARAM, desc->dma_srcparam); + phytium_chan_iowrite32(chan, DMA_DESTPARAM, desc->dma_destparam); + phytium_chan_iowrite32(chan, DMA_SRCADDR_L, desc->dma_srcaddr_l); + phytium_chan_iowrite32(chan, DMA_SRCADDR_H, desc->dma_srcaddr_h); + phytium_chan_iowrite32(chan, DMA_DESTADDR_L, desc->dma_destaddr_l); + phytium_chan_iowrite32(chan, DMA_DESTADDR_H, desc->dma_destaddr_h); + phytium_chan_iowrite32(chan, DMA_LENGTH, desc->dma_len); + + /* SG_TYPE & IRQ_ID & SE_COND & SG_EN */ + val = phytium_chan_ioread32(chan, DMA_CONTROL); + val |= desc->dma_ctrl; + val |= DMA_CTRL_COND_LEN | DMA_CTRL_COND_EOP | DMA_CTRL_COND_ERR; + + phytium_chan_iowrite32(chan, DMA_CONTROL, val); + + irq_mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; + phytium_chan_irq_set(chan, irq_mask); + + phytium_chan_enable(chan); +} + +static void phytium_chan_start_first_queued(struct phytium_dma_chan *chan) +{ + struct phytium_dma_desc *desc = NULL; + struct virt_dma_desc *vd = NULL; + + vd = vchan_next_desc(&chan->vc); + if (!vd) + return; + + desc = vd_to_desc(vd); + dev_dbg(chan2dev(chan), "%s: started %u\n", phytium_chan_name(chan), + vd->tx.cookie); + + phytium_chan_block_xfer_start(chan, desc); +} + +static void phytium_dma_hw_init(struct phytium_dma_chip *chip) +{ + u32 i; + + for (i = 0; i < chip->hdata->nr_channels; i++) { + phytium_chan_irq_disable(&chip->dmac->chan[i], DMA_CTRL_IRQ_MASK(0xF)); + phytium_chan_disable(&chip->dmac->chan[i]); + } +} + + +static enum dma_status phytium_dma_tx_status(struct dma_chan *dchan, + dma_cookie_t cookie, + struct dma_tx_state *state) +{ + enum dma_status ret; + + ret = dma_cookie_status(dchan, cookie, state); + + return ret; +} + +static void phytium_dma_issue_pending(struct dma_chan *dchan) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + unsigned long flags; + + spin_lock_irqsave(&chan->vc.lock, flags); + if (vchan_issue_pending(&chan->vc) && chan->is_idle) + phytium_chan_start_first_queued(chan); + spin_unlock_irqrestore(&chan->vc.lock, flags); +} + +static void phytium_dma_synchronize(struct dma_chan *dchan) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + + vchan_synchronize(&chan->vc); +} + +static int phytium_dma_terminate_all(struct dma_chan *dchan) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + unsigned long flags; + LIST_HEAD(head); + + spin_lock_irqsave(&chan->vc.lock, flags); + + phytium_chan_disable(chan); + + vchan_get_all_descriptors(&chan->vc, &head); + + /* + * As vchan_dma_desc_free_list can access to desc_allocated list + * we need to call it in vc.lock context. + */ + vchan_dma_desc_free_list(&chan->vc, &head); + + spin_unlock_irqrestore(&chan->vc.lock, flags); + + dev_vdbg(dchan2dev(dchan), "terminated: %s\n", phytium_chan_name(chan)); + + return 0; +} + +static int phytium_dma_alloc_chan_resources(struct dma_chan *dchan) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + + /* ASSERT: channel is idle */ + if (chan->is_used) { + dev_err(chan2dev(chan), "%s is non-idle!\n", + phytium_chan_name(chan)); + return -EBUSY; + } + + chan->is_used = true; + atomic_set(&chan->releasing, 0); + + return 0; +} + +static void phytium_dma_free_chan_resources(struct dma_chan *dchan) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + + atomic_set(&chan->releasing, 1); + /* ASSERT: channel is idle */ + if (chan->is_used) + dev_err(dchan2dev(dchan), "%s is non-idle!\n", + phytium_chan_name(chan)); + + phytium_chan_disable(chan); + phytium_chan_irq_disable(chan, DMA_CTRL_IRQ_MASK(0xF)); + + vchan_free_chan_resources(&chan->vc); + + dev_vdbg(dchan2dev(dchan), + "%s: free resources, descriptor still allocated: %u\n", + phytium_chan_name(chan), atomic_read(&chan->descs_allocated)); + + chan->is_used = false; +} + +static int phytium_dma_slave_config(struct dma_chan *dchan, + struct dma_slave_config *sconfig) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + + /* Check if chan will be configured for slave transfers */ + if (!is_slave_direction(sconfig->direction)) + return -EINVAL; + + memcpy(&chan->dma_sconfig, sconfig, sizeof(*sconfig)); + + return 0; +} + +static struct dma_async_tx_descriptor *phytium_dma_prep_dma_memcpy( + struct dma_chan *dchan, dma_addr_t dst_adr, + dma_addr_t src_adr, size_t len, unsigned long flags) +{ + struct phytium_dma_desc *desc = NULL; + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + struct dma_slave_config *sconfig = &chan->dma_sconfig; + size_t block_ts, max_block_ts, xfer_len; + + chan = dchan_to_dma_chan(dchan); + + dev_info(chan2dev(chan), "%s: memcpy: src: %pad dst: %pad length: %zd flags: %#lx", + phytium_chan_name(chan), &src_adr, &dst_adr, len, flags); + + max_block_ts = chan->chip->hdata->block_size[chan->id]; + if (len > max_block_ts) { + dev_err(chan2dev(chan), "The data length(%zd) is too long!\n", len); + return NULL; + } + + xfer_len = len; + block_ts = xfer_len >> DMA_SLAVE_BUSWIDTH_4_BYTES; + xfer_len = block_ts << DMA_SLAVE_BUSWIDTH_4_BYTES; + + desc = phytium_desc_get(chan); + if (unlikely(!desc)) + goto err_desc_get; + + switch (sconfig->direction) { + case DMA_MEM_TO_DEV: + desc->dma_srcparam = DMA_SRCP_SRC_ID(0); + desc->dma_destparam = DMA_DESTP_DEST_ID(5); + break; + case DMA_DEV_TO_MEM: + desc->dma_srcparam = DMA_SRCP_SRC_ID(5); + desc->dma_destparam = DMA_DESTP_DEST_ID(0); + break; + default: + return NULL; + } + + desc->dma_ctrl |= DMA_CTRL_SG_EN; + desc->dma_ctrl |= DMA_CTRL_SG_TYPE(0); + + desc->dma_ctrl |= DMA_CTRL_SG_ID(0); + desc->dma_ctrl |= DMA_CTRL_SG2_ID(0); + desc->dma_ctrl |= DMA_CTRL_IRQ_ID(0); + + desc->dma_srcaddr_l = src_adr & 0xFFFFFFFF; + desc->dma_srcaddr_h = (src_adr >> 32) & 0xFFFFFFFF; + desc->dma_destaddr_l = dst_adr & 0xFFFFFFFF; + desc->dma_destaddr_h = (dst_adr >> 32) & 0xFFFFFFFF; + desc->dma_len = xfer_len; + + return vchan_tx_prep(&chan->vc, &desc->vd, flags); + +err_desc_get: + phytium_desc_put(desc); + return NULL; +} + +static struct dma_async_tx_descriptor *phytium_dma_prep_slave_sg( + struct dma_chan *dchan, struct scatterlist *sgl, + u32 sg_len, enum dma_transfer_direction direction, + unsigned long flags, void *context) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + struct dma_slave_config *sconfig = &chan->dma_sconfig; + struct phytium_dma_desc *desc = NULL; + struct phytium_chan_desc *chan_desc = NULL; + dma_addr_t reg; + unsigned int i = 0; + struct scatterlist *sg = NULL; + size_t total_len = 0; + u32 offset = 0; + + if (unlikely(!is_slave_direction(direction) || !sg_len)) { + dev_err(chan2dev(chan), "%s: bad direction\n", __func__); + return NULL; + } + + if (atomic_read(&chan->releasing)) { + dev_err(chan2dev(chan), "%s: channel is scheduled for release\n", __func__); + return NULL; + } + + desc = phytium_desc_get(chan); + if (unlikely(!desc)) + goto err_desc_get; + + chan_desc = kzalloc((sg_len + 1) * sizeof(struct phytium_chan_desc), + GFP_KERNEL | GFP_DMA); + if (unlikely(!chan_desc)) { + dev_err(chan->chip->dev, "Malloc space for chan_desc failed\n"); + goto err_desc_get; + } + + desc->cdesc = chan_desc; + + /* Must be aligned on 32-byte boundary */ + offset = (u64)chan_desc & 0x1F; + if (offset) + chan_desc = chan_desc + 32 - offset; + + for_each_sg(sgl, sg, sg_len, i) { + if (!sg) + break; + + if (direction == DMA_MEM_TO_DEV) { + chan_desc[i].desc_src_addr_l = sg_dma_address(sg) & 0xFFFFFFFF; + chan_desc[i].desc_src_addr_h = (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; + } else if (direction == DMA_DEV_TO_MEM) { + chan_desc[i].desc_dst_addr_l = sg_dma_address(sg) & 0xFFFFFFFF; + chan_desc[i].desc_dst_addr_h = (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; + } else { + kfree(desc->cdesc); + goto err_desc_get; + } + + chan_desc[i].desc_control = 0; + chan_desc[i].desc_control |= sg_dma_len(sg) << 8; + + if (sg_is_last(sg)) { + chan_desc[i].desc_next_addr_l = 0x01; + chan_desc[i].desc_next_addr_h = 0; + chan_desc[i].desc_control |= 0x03 << 4; + } else { + chan_desc[i].desc_next_addr_l = virt_to_phys(&chan_desc[i+1]) & 0xFFFFFFFF; + chan_desc[i].desc_next_addr_l |= 0x01 << 4; + chan_desc[i].desc_next_addr_l |= 0x02; + chan_desc[i].desc_next_addr_h = + (virt_to_phys(&chan_desc[i+1]) >> 32) & 0xFFFFFFFF; + } + total_len += sg_dma_len(sg); + } + + switch (direction) { + case DMA_MEM_TO_DEV: + reg = sconfig->dst_addr; + + desc->dma_srcparam = DMA_SRCP_SRC_ID(0); + desc->dma_destparam = DMA_DESTP_DEST_ID(5); + desc->dma_ctrl |= DMA_CTRL_SG_TYPE(1); + + desc->dma_srcaddr_l = virt_to_phys(chan_desc) & 0xFFFFFFFF; + desc->dma_srcaddr_h = (virt_to_phys(chan_desc) >> 32) & 0xFFFFFFFF; + desc->dma_destaddr_l = sconfig->dst_addr & 0xFFFFFFFF; + desc->dma_destaddr_h = (sconfig->dst_addr >> 32) & 0xFFFFFFFF; + break; + case DMA_DEV_TO_MEM: + reg = sconfig->src_addr; + + /* memcpy from device */ + desc->dma_srcparam = DMA_SRCP_SRC_ID(5); + desc->dma_destparam = DMA_DESTP_DEST_ID(0); + desc->dma_ctrl |= DMA_CTRL_SG_TYPE(2); + + desc->dma_srcaddr_l = sconfig->src_addr & 0xFFFFFFFF; + desc->dma_srcaddr_h = (sconfig->src_addr >> 32) & 0xFFFFFFFF; + desc->dma_destaddr_l = virt_to_phys(chan_desc) & 0xFFFFFFFF; + desc->dma_destaddr_h = (virt_to_phys(chan_desc) >> 32) & 0xFFFFFFFF; + break; + default: + return NULL; + } + + desc->dma_ctrl |= DMA_CTRL_SG_EN; + + desc->dma_ctrl |= DMA_CTRL_SG_ID(0); + desc->dma_ctrl |= DMA_CTRL_SG2_ID(0); + desc->dma_ctrl |= DMA_CTRL_IRQ_ID(0); + + desc->dma_len = total_len; + + return vchan_tx_prep(&chan->vc, &desc->vd, flags); + +err_desc_get: + dev_err(chan2dev(chan), + "not enough descriptors available. Direction %d\n", direction); + phytium_desc_put(desc); + return NULL; +} + +static void phytium_chan_block_xfer_complete_msi(struct phytium_dma_chan *chan) +{ + struct virt_dma_desc *vd = NULL; + struct phytium_dma_desc *desc = NULL; + + chan->is_idle = true; + if (phytium_chan_is_running(chan)) { + dev_err(chan2dev(chan), "DMA %s is not idle!\n", + phytium_chan_name(chan)); + phytium_chan_disable(chan); + } + + /* The completed descriptor currently is in the head of vc list */ + vd = vchan_next_desc(&chan->vc); + if (!vd) { + dev_err(chan2dev(chan), "complete vchan next desc failed\n"); + return; + } + + desc = vd_to_desc(vd); + if (!desc) { + dev_err(chan2dev(chan), "vd to desc failed\n"); + return; + } + + if (desc->cdesc) + kfree(desc->cdesc); + + /* Remove the completed descriptor from issued list before completing */ + list_del(&vd->node); + vchan_cookie_complete(vd); + + /* Submit queued descriptors after processing the completed ones */ + phytium_chan_start_first_queued(chan); +} + +static void phytium_chan_block_xfer_complete_intx(struct phytium_dma_chan *chan) +{ + struct virt_dma_desc *vd = NULL; + struct phytium_dma_desc *desc = NULL; + unsigned long flags; + + spin_lock_irqsave(&chan->vc.lock, flags); + chan->is_idle = true; + if (phytium_chan_is_running(chan)) { + dev_err(chan2dev(chan), "DMA %s is not idle!\n", + phytium_chan_name(chan)); + phytium_chan_disable(chan); + } + + /* The completed descriptor currently is in the head of vc list */ + vd = vchan_next_desc(&chan->vc); + if (!vd) { + dev_err(chan2dev(chan), "complete vchan next desc failed\n"); + return; + } + + desc = vd_to_desc(vd); + if (!desc) { + dev_err(chan2dev(chan), "vd to desc failed\n"); + return; + } + + if (desc->cdesc) + kfree(desc->cdesc); + + /* Remove the completed descriptor from issued list before completing */ + list_del(&vd->node); + vchan_cookie_complete(vd); + + /* Submit queued descriptors after processing the completed ones */ + phytium_chan_start_first_queued(chan); + spin_unlock_irqrestore(&chan->vc.lock, flags); +} + +static irqreturn_t phytium_dma_interrupt_msi(int irq, void *dev_id) +{ + unsigned long flags; + struct phytium_dma_chan *chan = dev_id; + struct phytium_dma_chip *chip = chan->chip; + + u32 irq_status; + u32 irq_mask = 0xffff; + u32 chan_status; + u32 mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; + + spin_lock_irqsave(&chan->vc.lock, flags); + + chan_status = phytium_chan_status_read(chan); + irq_status = phytium_dma_irq_read(chip); + + if (!(irq_status & irq_mask)) { + dev_err(chan2dev(chan), "irq_status = 0x%x, irq_mask = 0x%x, chan_status = 0x%x", + irq_status, irq_mask, chan_status); + if ((chan_status & DMA_STAT_END) | (chan_status & DMA_STAT_EOP) | + (chan_status & DMA_STAT_EOC) | + (chan_status & DMA_STAT_ERR)) { + irq_status = phytium_dma_irq_read(chip); + goto next; + } else { + return IRQ_NONE; + } + } + +next: + /* Disable DMAC inerrupts. We'll enable them after processing chanels */ + phytium_dma_irq_disable(chip); + phytium_chan_irq_disable(chan, mask); + phytium_chan_irq_clear(chan, mask); + phytium_dma_irq_clear(chip, irq_status); + + if ((chan_status & DMA_STAT_ERR)) { + dev_err(chan2dev(chan), "chan handle err, chan status is %x\n", + chan_status); + } else if ((chan_status & DMA_STAT_END) | (chan_status & DMA_STAT_EOP) | + (chan_status & DMA_STAT_EOC)) { + phytium_chan_block_xfer_complete_msi(chan); + } else { + dev_err(chan2dev(chan), "irq_status = 0x%x, ----unknown reason:%x\n", + irq_status, chan_status); + } + + /* Re-enable interrupts */ + phytium_dma_irq_enable(chip); + + spin_unlock_irqrestore(&chan->vc.lock, flags); + + return IRQ_HANDLED; +} + +static irqreturn_t phytium_dma_interrupt_intx(int irq, void *dev_id) +{ + struct phytium_dma_chip *chip = dev_id; + struct phytium_dma *dmac = chip->dmac; + struct phytium_dma_chan *chan; + u32 irq_status = 0; + u32 irq_mask = 0; + u32 chan_status = 0; + u32 mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; + u32 i; + + irq_status = phytium_dma_irq_read(chip); + irq_status = irq_status & 0xffff; + irq_mask = phytium_dma_irq_mask_read(chip); + + if (!(irq_status & irq_mask)) + return IRQ_NONE; + + /* Disable DMAC inerrupts. We'll enable them after processing chanels */ + phytium_dma_irq_disable(chip); + phytium_dma_irq_clear(chip, irq_status); + + /* Poll, clear and process every chanel interrupt status */ + for (i = 0; i < chip->hdata->nr_channels; i++) { + if (!(irq_status & BIT(i)) && !(irq_status & BIT(i + 8))) + continue; + + chan = &dmac->chan[i]; + + chan_status = phytium_chan_status_read(chan); + + phytium_chan_irq_disable(chan, mask); + if ((chan_status & DMA_STAT_ERR)) + dev_err(chan2dev(chan), "chan handle err, chan status is %x\n", + chan_status); + else if ((chan_status & DMA_STAT_END) | (chan_status & DMA_STAT_EOP) | + (chan_status & DMA_STAT_EOC)) + phytium_chan_block_xfer_complete_intx(chan); + else + dev_err(chan2dev(chan), "irq_status = 0x%x, ----unknown reason:%x\n", + irq_status, chan_status); + + phytium_chan_irq_set(chan, mask); + } + + /* Re-enable interrupts */ + phytium_dma_irq_enable(chip); + + return IRQ_HANDLED; +} + +struct phytium_dma_hcfg phytium_octopus_dma_hdata = { + .nr_channels = 4, + .nr_masters = 1, + .m_data_width = DMA_SLAVE_BUSWIDTH_4_BYTES, + .block_size[0] = 0x2000000, + .block_size[1] = 0x2000000, + .priority[0] = 0, + .priority[1] = 1, + .axi_rw_burst_len = 0, + .restrict_axi_burst_len = false, +}; + +static int phytium_dma_probe(struct phytium_dma_chip *chip) +{ + struct phytium_dma_chan *chan; + struct pci_dev *pdev = chip->pdev; + struct phytium_dma *dmac; + struct phytium_dma_hcfg *hdata; + u32 i; + int ret = -1; + + chip->dev = &pdev->dev; + dmac = devm_kzalloc(chip->dev, sizeof(*dmac), GFP_KERNEL); + if (!dmac) { + dev_err(chip->dev, "dmac zalloc failed\n"); + return -ENOMEM; + } + + hdata = devm_kzalloc(chip->dev, sizeof(*hdata), GFP_KERNEL); + if (!hdata) { + dev_err(chip->dev, "hdata zalloc failed\n"); + return -ENOMEM; + } + + hdata->nr_channels = 4; + memcpy(hdata, &phytium_octopus_dma_hdata, sizeof(phytium_octopus_dma_hdata)); + + chip->dmac = dmac; + chip->hdata = hdata; + + dmac->chan = devm_kcalloc(chip->dev, hdata->nr_channels, + sizeof(*dmac->chan), GFP_KERNEL); + if (!dmac->chan) { + dev_err(chip->dev, "hdata zalloc failed\n"); + return -ENOMEM; + } + + /* Set capabilities */ + dma_cap_set(DMA_MEMCPY, dmac->dma.cap_mask); + dma_cap_set(DMA_SLAVE, dmac->dma.cap_mask); + dma_cap_set(DMA_PRIVATE, dmac->dma.cap_mask); + + /* DMA capabilities */ + dmac->dma.chancnt = hdata->nr_channels; + dmac->dma.src_addr_widths = DMA_SLAVE_BUSWIDTH_4_BYTES; + dmac->dma.dst_addr_widths = DMA_SLAVE_BUSWIDTH_4_BYTES; + dmac->dma.directions = BIT(DMA_MEM_TO_MEM) | BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV) ; + dmac->dma.residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; + + dmac->dma.dev = chip->dev; + dmac->dma.device_tx_status = phytium_dma_tx_status; + dmac->dma.device_issue_pending = phytium_dma_issue_pending; + dmac->dma.device_terminate_all = phytium_dma_terminate_all; + dmac->dma.device_synchronize = phytium_dma_synchronize; + + dmac->dma.device_alloc_chan_resources = phytium_dma_alloc_chan_resources; + dmac->dma.device_free_chan_resources = phytium_dma_free_chan_resources; + + dmac->dma.device_prep_dma_memcpy = phytium_dma_prep_dma_memcpy; + dmac->dma.device_config = phytium_dma_slave_config; + dmac->dma.device_prep_slave_sg = phytium_dma_prep_slave_sg; + + + INIT_LIST_HEAD(&dmac->dma.channels); + for (i = 0; i < chip->hdata->nr_channels; i++) { + chan = &dmac->chan[i]; + chan->chip = chip; + chan->id = i; + chan->chan_regs = chip->regs + i * CHAN_REG_LEN; + chan->is_used = false; + chan->is_idle = true; + chan->is_paused = false; + + chan->vc.desc_free = phytium_vchan_desc_put; + vchan_init(&chan->vc, &dmac->dma); + } + + /* ----lt add begin--- */ + dmac->dma.filter.map = ft_px210gpu_slave_map; + dmac->dma.filter.mapcnt = ARRAY_SIZE(ft_px210gpu_slave_map); + dmac->dma.filter.fn = px210_filter_fn; + /*----lt add end----*/ + + phytium_dma_hw_init(chip); + + ret = dma_async_device_register(&dmac->dma); + if (ret) + goto err_pm_disable; + + ret = pci_alloc_irq_vectors(pdev, 4, 4, PCI_IRQ_MSI); + if (ret < 0) { + dev_err(&pdev->dev, "fialed to allocate MSI entry"); + goto intx; + } + + for (i = 0; i < chip->hdata->nr_channels; i++) { + chan = &dmac->chan[i]; + chan->irq = pci_irq_vector(pdev, i); + dev_err(&pdev->dev, "desc->irq = 0x%x", chan->irq); + + ret = devm_request_irq(&pdev->dev, chan->irq, phytium_dma_interrupt_msi, 0, dev_name(chan2dev(chan)), chan); + if (ret) { + dev_err(&pdev->dev, "request irq faild %d channal with err %d", i, ret); + goto intx; + } + } + goto irq_done; + +intx: + chip->irq = pdev->irq; + ret = devm_request_irq(chip->dev, chip->irq, phytium_dma_interrupt_intx, + IRQF_SHARED, dev_name(chip->dev), chip); + if (ret) { + dev_err(&pdev->dev, "no interrupt used\n"); + return ret; + } + +irq_done: + return 0; + +err_pm_disable: + pm_runtime_disable(chip->dev); + + return ret; +} + +static int phytium_dma_remove(struct phytium_dma_chip *chip) +{ + struct phytium_dma *dmac = chip->dmac; + struct phytium_dma_chan *chan, *_chan; + + list_for_each_entry_safe(chan, _chan, &dmac->dma.channels, + vc.chan.device_node) { + list_del(&chan->vc.chan.device_node); + tasklet_kill(&chan->vc.task); + } + + dma_async_device_unregister(&dmac->dma); + + return 0; +} + +static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) +{ + struct phytium_dma_chip *chip; + int ret; + + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + ret = pcim_iomap_regions(pdev, 1 << 0, pci_name(pdev)); + if (ret) { + dev_err(&pdev->dev, "I/O memory remapping failed\n"); + return ret; + } + + pci_set_master(pdev); + pci_try_set_mwi(pdev); + + ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); + if (ret) + return ret; + + ret = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); + if (ret) + return ret; + + chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); + if (!chip) + return -ENOMEM; + + chip->pdev = pdev; + chip->dev = &pdev->dev; + chip->id = pdev->devfn; + chip->regs = pcim_iomap_table(pdev)[0] + COMMON_REG_LEN; + + ret = phytium_dma_probe(chip); + if (ret) + return ret; + + pci_set_drvdata(pdev, chip); + + dev_dbg(&pdev->dev, "Phytium dma device at 0x%p 0x%llx\n", + chip->regs, pdev->resource[0].start); + return 0; +} + +static void phytium_pci_remove(struct pci_dev *pdev) +{ + struct phytium_dma_chip *chip = pci_get_drvdata(pdev); + int ret; + + ret = phytium_dma_remove(chip); + if (ret) + dev_warn(&pdev->dev, "can't remove device properly: %d\n", ret); +} + +static const struct pci_device_id phytium_pci_id_table[] = { + { + vendor: 0x1DB7, + device : 0xDC3C, + subvendor : PCI_ANY_ID, + subdevice : PCI_ANY_ID, + class : 0, + class_mask : 0, + driver_data : (kernel_ulong_t)&phytium_octopus_dma_hdata, + }, + { } +}; +MODULE_DEVICE_TABLE(pci, phytium_pci_id_table); +#ifdef CONFIG_PM_SLEEP + +static int phytium_pci_prepare(struct device *dev) +{ + u32 i; + struct pci_dev *pci = to_pci_dev(dev); + struct phytium_dma_chip *chip = pci_get_drvdata(pci); + struct phytium_dma_chan *chan; + + phytium_dma_hw_init(chip); + + for (i = 0; i < chip->hdata->nr_channels; i++) { + chan = &chip->dmac->chan[i]; + if (phytium_chan_is_running(chan)) { + dev_err(chan2dev(chan), "DMA driver would suspend," + "DMA client need to wait data transfer done!\n"); + return -1; + } + + } + return 0; +}; + +static int phytium_pci_suspend_late(struct device *dev) +{ + struct pci_dev *pci = to_pci_dev(dev); + struct phytium_dma_chip *chip = pci_get_drvdata(pci); + + phytium_dma_hw_init(chip); + return 0; +}; + +static int phytium_pci_resume_early(struct device *dev) +{ + struct pci_dev *pci = to_pci_dev(dev); + struct phytium_dma_chip *chip = pci_get_drvdata(pci); + + phytium_dma_hw_init(chip); + return 0; +}; + +#endif + +static const struct dev_pm_ops phytium_pci_dev_pm_ops = { + .prepare = phytium_pci_prepare, + SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_pci_suspend_late, + phytium_pci_resume_early) +}; + +static struct pci_driver phytium_pci_driver = { + .name = "phytium_dmac_pci", + .id_table = phytium_pci_id_table, + .probe = phytium_pci_probe, + .remove = phytium_pci_remove, + .driver = { + .pm = &phytium_pci_dev_pm_ops, + }, +}; + +bool px210_filter_fn(struct dma_chan *chan, void *param) +{ + if (chan->device->dev->driver != &phytium_pci_driver.driver) + return false; + + return true; +} + +module_pci_driver(phytium_pci_driver); + +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium DMA Controller platform driver"); +MODULE_AUTHOR("Zhu mingshuai "); +MODULE_AUTHOR("Li Wenxiang "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-dmac-pci.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-dmac-pci.h new file mode 100644 index 0000000000000000000000000000000000000000..68c9045dfc4d7c67036829a29599e12cf7ed5867 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/dma/phytium/phytium-dmac-pci.h @@ -0,0 +1,186 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Synopsys DesignWare AXI DMA Controller driver. + * + * 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. + */ + +#ifndef _AXI_DMA_PLATFORM_H +#define _AXI_DMA_PLATFORM_H + +#include +#include +#include +#include +#include + +#include "../virt-dma.h" + +#define DMAC_MAX_CHANNELS 4 +#define DMAC_MAX_MASTERS 1 +#define DMAC_MAX_BLK_SIZE (1024 * 1024 * 2) + +struct phytium_dma_hcfg { + u32 nr_channels; + u32 nr_masters; + u32 m_data_width; + u32 block_size[DMAC_MAX_CHANNELS]; + u32 priority[DMAC_MAX_CHANNELS]; + /* maximum supported axi burst length */ + u32 axi_rw_burst_len; + bool restrict_axi_burst_len; +}; + +struct phytium_dma_chan { + struct phytium_dma_chip *chip; + void __iomem *chan_regs; + u8 id; + unsigned int irq; + atomic_t descs_allocated; + atomic_t releasing; + + struct virt_dma_chan vc; + + struct dma_slave_config dma_sconfig; + + bool is_used; + bool is_idle; + /* these other elements are all protected by vc.lock */ + bool is_paused; +}; + +struct phytium_dma { + struct dma_device dma; + //const struct phytium_dma_hcfg *hdata; + + /* channels */ + struct phytium_dma_chan *chan; +}; + +struct phytium_dma_chip { + struct pci_dev *pdev; + struct device *dev; + void __iomem *regs; + struct clk *core_clk; + struct phytium_dma *dmac; + + int irq; + int id; + struct completion complete; + + const struct phytium_dma_hcfg *hdata; + struct phytium_dma_chan chan[4]; +}; + +struct phytium_chan_desc { + u32 desc_status; + u32 desc_control; + u32 desc_next_addr_l; + u32 desc_next_addr_h; + u32 desc_src_addr_l; + u32 desc_src_addr_h; + u32 desc_dst_addr_l; + u32 desc_dst_addr_h; +} __attribute__ ((__packed__)); + +struct phytium_dma_desc { + struct virt_dma_desc vd; + struct phytium_dma_chan *chan; + struct list_head xfer_list; + struct dma_async_tx_descriptor *txd; + struct phytium_chan_desc *cdesc; + struct scatterlist *end_sg; + u32 dma_srcparam; + u32 dma_destparam; + u32 dma_srcaddr_l; + u32 dma_srcaddr_h; + u32 dma_destaddr_l; + u32 dma_destaddr_h; + u32 dma_len; + u32 dma_ctrl; + u32 sg_len; +}; + +static inline struct device *dchan2dev(struct dma_chan *dchan) +{ + return &dchan->dev->device; +} + +static inline struct device *chan2dev(struct phytium_dma_chan *chan) +{ + return &chan->vc.chan.dev->device; +} + +static inline struct phytium_dma_desc *vd_to_desc(struct virt_dma_desc *vd) +{ + return container_of(vd, struct phytium_dma_desc, vd); +} + +static inline struct phytium_dma_chan *vc_to_dma_chan(struct virt_dma_chan *vc) +{ + return container_of(vc, struct phytium_dma_chan, vc); +} + +static inline struct phytium_dma_chan *dchan_to_dma_chan(struct dma_chan *dchan) +{ + return vc_to_dma_chan(to_virt_chan(dchan)); +} + +#define TX_SG_LEN (1024 * 32) +#define PAGE_SIZE2 (PAGE_SIZE << 1) + +#define COMMON_REG_LEN 0 +#define CHAN_REG_LEN 0x40 + +#define DMA_IRQ_MASK 0x180 +#define DMA_IRQ_STATUS 0x184 +#define DMA_SRCPARAM 0x400 +#define DMA_DESTPARAM 0x404 +#define DMA_SRCADDR_L 0x408 +#define DMA_SRCADDR_H 0x40C +#define DMA_DESTADDR_L 0x410 +#define DMA_DESTADDR_H 0x414 +#define DMA_LENGTH 0x418 +#define DMA_CONTROL 0x41C +#define DMA_STATUS 0x420 +#define DMA_PRC_LEN 0x424 +#define DMA_SHARE_ACCESS 0x428 + +#define DMA_SRCP_SRC_ID(x) min_t(unsigned int, x, 0xF) +#define DMA_SRCP_TRSF_PARAM(x) (min_t(unsigned int, x, 0xFFF) << 16) +#define DMA_DESTP_DEST_ID(x) min_t(unsigned int, x, 0xF) +#define DMA_DESTP_TRSF_PARAM(x) (min_t(unsigned int, x, 0xFFF) << 16) +#define DMA_CTRL_START BIT(0) +#define DMA_CTRL_PAUSE BIT(1) +#define DMA_CTRL_SG_EN BIT(3) +#define DMA_CTRL_COND_LEN BIT(5) +#define DMA_CTRL_COND_EOP BIT(6) +#define DMA_CTRL_COND_ERR BIT(7) +#define DMA_CTRL_COND_MASK(x) (min_t(unsigned int, x, 0xF) << 4) +#define DMA_CTRL_IRQ_END BIT(8) +#define DMA_CTRL_IRQ_ERR BIT(9) +#define DMA_CTRL_IRQ_EOP BIT(10) +#define DMA_CTRL_IRQ_MASK(x) (min_t(unsigned int, x, 0xF) << 8) +#define DMA_CTRL_IRQ_ID(x) (min_t(unsigned int, x, 0x3) << 12) +#define DMA_CTRL_DESC_UPDT BIT(23) +#define DMA_CTRL_SG_TYPE(x) (min_t(unsigned int, x, 0x3) << 24) +#define DMA_CTRL_SG_ID(x) (min_t(unsigned int, x, 0x5) << 26) +#define DMA_CTRL_SG2_ID(x) (min_t(unsigned int, x, 0x5) << 29) +#define DMA_STAT_MASK(x) (min_t(unsigned int, x, 0xFF) << 0) +#define DMA_STAT_END BIT(0) +#define DMA_STAT_EOP BIT(1) +#define DMA_STAT_EOC BIT(2) +#define DMA_STAT_ERR BIT(3) +#define DMA_STAT_OVER BIT(4) +#define DMA_STAT_STOP BIT(6) +#define DMA_STAT_INCORRECT BIT(7) +#define DMA_SRC_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 8) +#define DMA_DEST_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 16) +#define DMA_DESC_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 24) + +#define DMA_TIMEOUT 200 + +#endif /* _AXI_DMA_PLATFORM_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..2fea29350907c31d418cddd792c50f65c717569a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/Kconfig @@ -0,0 +1,36 @@ +# This symbol is selected by both MMIO and PCI expanders +config GPIO_PHYTIUM_CORE + tristate + +config GPIO_PHYTIUM_PLAT + tristate "Phytium GPIO Platform support" + default y if ARCH_PHYTIUM + depends on ARM64 + select GPIO_PHYTIUM_CORE + select IRQ_DOMAIN + select GENERIC_IRQ_CHIP + select GPIOLIB_IRQCHIP + help + Say yes here to enable GPIO support for Phytium SoCs. + +config GPIO_PHYTIUM_SGPIO + tristate "Phytium SGPIO support" + default y if ARCH_PHYTIUM + depends on ARM64 + select IRQ_DOMAIN + select GENERIC_IRQ_CHIP + help + Say yes here to enable SGPIO support for Phytium SoCs. + +config GPIO_PHYTIUM_PCI + tristate "Phytium GPIO PCI support" + select GPIO_PHYTIUM_CORE + select IRQ_DOMAIN + select GENERIC_IRQ_CHIP + select GPIOLIB_IRQCHIP + help + Say Y here to support Phytium PCI GPIO controller on px210 chipset. + An interrupt is generated when any of the inputs change state + (low to high or high to low). + + This driver can be used for Phytium px210. diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..f97ee48808be16dc40bd4c8a090e346e3004853b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/Makefile @@ -0,0 +1,8 @@ +# SPDX-License-Identifier: GPL-2.0 +# generic gpio support: platform drivers, dedicated expander chips, etc + +obj-$(CONFIG_GPIO_PHYTIUM_CORE) += gpio-phytium-core.o +obj-$(CONFIG_GPIO_PHYTIUM_PCI) += gpio-phytium-pci.o +obj-$(CONFIG_GPIO_PHYTIUM_PLAT) += gpio-phytium-platform.o +obj-$(CONFIG_GPIO_PHYTIUM_SGPIO) += gpio-phytium-sgpio.o + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-core.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-core.c new file mode 100644 index 0000000000000000000000000000000000000000..a1794f55a5a01971c14f2eba779d9bf3c6847c8d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-core.c @@ -0,0 +1,363 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include + +#include "gpio-phytium-core.h" + +static int get_pin_location(struct phytium_gpio *gpio, unsigned int offset, + struct pin_loc *pl) +{ + int ret; + + if (offset < gpio->ngpio[0]) { + pl->port = 0; + pl->offset = offset; + ret = 0; + } else if (offset < (gpio->ngpio[0] + gpio->ngpio[1])) { + pl->port = 1; + pl->offset = offset - gpio->ngpio[0]; + ret = 0; + } else { + ret = -EINVAL; + } + + return ret; +} + +static void phytium_gpio_toggle_trigger(struct phytium_gpio *gpio, + unsigned int offset) +{ + struct gpio_chip *gc; + u32 pol; + int val; + + /* Only port A can provide interrupt source */ + if (offset >= gpio->ngpio[0]) + return; + + gc = &gpio->gc; + + pol = readl(gpio->regs + GPIO_INT_POLARITY); + /* Just read the current value right out of the data register */ + val = gc->get(gc, offset); + if (val) + pol &= ~BIT(offset); + else + pol |= BIT(offset); + + writel(pol, gpio->regs + GPIO_INT_POLARITY); +} + +int phytium_gpio_get(struct gpio_chip *gc, unsigned int offset) +{ + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct pin_loc loc; + void __iomem *dat; + + if (get_pin_location(gpio, offset, &loc)) + return -EINVAL; + + dat = gpio->regs + GPIO_EXT_PORTA + (loc.port * GPIO_PORT_STRIDE); + + return !!(readl(dat) & BIT(loc.offset)); +} +EXPORT_SYMBOL_GPL(phytium_gpio_get); + +void phytium_gpio_set(struct gpio_chip *gc, unsigned int offset, int value) +{ + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct pin_loc loc; + void __iomem *dr; + unsigned long flags; + u32 mask; + + if (get_pin_location(gpio, offset, &loc)) + return; + dr = gpio->regs + GPIO_SWPORTA_DR + (loc.port * GPIO_PORT_STRIDE); + + raw_spin_lock_irqsave(&gpio->lock, flags); + + if (value) + mask = readl(dr) | BIT(loc.offset); + else + mask = readl(dr) & ~BIT(loc.offset); + + writel(mask, dr); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); +} +EXPORT_SYMBOL_GPL(phytium_gpio_set); + +int phytium_gpio_direction_input(struct gpio_chip *gc, unsigned int offset) +{ + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct pin_loc loc; + unsigned long flags; + void __iomem *ddr; + + if (get_pin_location(gpio, offset, &loc)) + return -EINVAL; + ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); + + raw_spin_lock_irqsave(&gpio->lock, flags); + + writel(readl(ddr) & ~(BIT(loc.offset)), ddr); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_gpio_direction_input); + +int phytium_gpio_direction_output(struct gpio_chip *gc, unsigned int offset, + int value) +{ + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct pin_loc loc; + unsigned long flags; + void __iomem *ddr; + + if (get_pin_location(gpio, offset, &loc)) + return -EINVAL; + ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); + + raw_spin_lock_irqsave(&gpio->lock, flags); + + writel(readl(ddr) | BIT(loc.offset), ddr); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + phytium_gpio_set(gc, offset, value); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_gpio_direction_output); + +void phytium_gpio_irq_ack(struct irq_data *d) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + u32 val = BIT(irqd_to_hwirq(d)); + + raw_spin_lock(&gpio->lock); + + writel(val, gpio->regs + GPIO_PORTA_EOI); + + raw_spin_unlock(&gpio->lock); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_ack); + +void phytium_gpio_irq_mask(struct irq_data *d) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + u32 val; + + /* Only port A can provide interrupt source */ + if (irqd_to_hwirq(d) >= gpio->ngpio[0]) + return; + + raw_spin_lock(&gpio->lock); + + val = readl(gpio->regs + GPIO_INTMASK); + val |= BIT(irqd_to_hwirq(d)); + writel(val, gpio->regs + GPIO_INTMASK); + + raw_spin_unlock(&gpio->lock); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_mask); + +void phytium_gpio_irq_unmask(struct irq_data *d) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + u32 val; + + /* Only port A can provide interrupt source */ + if (irqd_to_hwirq(d) >= gpio->ngpio[0]) + return; + + raw_spin_lock(&gpio->lock); + + val = readl(gpio->regs + GPIO_INTMASK); + val &= ~BIT(irqd_to_hwirq(d)); + writel(val, gpio->regs + GPIO_INTMASK); + + raw_spin_unlock(&gpio->lock); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_unmask); + +int phytium_gpio_irq_set_type(struct irq_data *d, unsigned int flow_type) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + int hwirq = irqd_to_hwirq(d); + unsigned long flags, lvl, pol; + + if (hwirq < 0 || hwirq >= gpio->ngpio[0]) + return -EINVAL; + + if ((flow_type & (IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW)) && + (flow_type & (IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING))) { + dev_err(gc->parent, + "trying to configure line %d for both level and edge detection, choose one!\n", + hwirq); + return -EINVAL; + } + + raw_spin_lock_irqsave(&gpio->lock, flags); + + lvl = readl(gpio->regs + GPIO_INTTYPE_LEVEL); + pol = readl(gpio->regs + GPIO_INT_POLARITY); + + switch (flow_type) { + case IRQ_TYPE_EDGE_BOTH: + lvl |= BIT(hwirq); + phytium_gpio_toggle_trigger(gpio, hwirq); + irq_set_handler_locked(d, handle_edge_irq); + dev_dbg(gc->parent, "line %d: IRQ on both edges\n", hwirq); + break; + case IRQ_TYPE_EDGE_RISING: + lvl |= BIT(hwirq); + pol |= BIT(hwirq); + irq_set_handler_locked(d, handle_edge_irq); + dev_dbg(gc->parent, "line %d: IRQ on RISING edge\n", hwirq); + break; + case IRQ_TYPE_EDGE_FALLING: + lvl |= BIT(hwirq); + pol &= ~BIT(hwirq); + irq_set_handler_locked(d, handle_edge_irq); + dev_dbg(gc->parent, "line %d: IRQ on FALLING edge\n", hwirq); + break; + case IRQ_TYPE_LEVEL_HIGH: + lvl &= ~BIT(hwirq); + pol |= BIT(hwirq); + irq_set_handler_locked(d, handle_level_irq); + dev_dbg(gc->parent, "line %d: IRQ on HIGH level\n", hwirq); + break; + case IRQ_TYPE_LEVEL_LOW: + lvl &= ~BIT(hwirq); + pol &= ~BIT(hwirq); + irq_set_handler_locked(d, handle_level_irq); + dev_dbg(gc->parent, "line %d: IRQ on LOW level\n", hwirq); + break; + } + + writel(lvl, gpio->regs + GPIO_INTTYPE_LEVEL); + if (flow_type != IRQ_TYPE_EDGE_BOTH) + writel(pol, gpio->regs + GPIO_INT_POLARITY); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_set_type); + +void phytium_gpio_irq_enable(struct irq_data *d) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + unsigned long flags; + u32 val; + + /* Only port A can provide interrupt source */ + if (irqd_to_hwirq(d) >= gpio->ngpio[0]) + return; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + val = readl(gpio->regs + GPIO_INTEN); + val |= BIT(irqd_to_hwirq(d)); + writel(val, gpio->regs + GPIO_INTEN); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_enable); + +void phytium_gpio_irq_disable(struct irq_data *d) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + unsigned long flags; + u32 val; + + /* Only port A can provide interrupt source */ + if (irqd_to_hwirq(d) >= gpio->ngpio[0]) + return; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + val = readl(gpio->regs + GPIO_INTEN); + val &= ~BIT(irqd_to_hwirq(d)); + writel(val, gpio->regs + GPIO_INTEN); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_disable); + +void phytium_gpio_irq_handler(struct irq_desc *desc) +{ + struct gpio_chip *gc = irq_desc_get_handler_data(desc); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct irq_chip *irqchip = irq_desc_get_chip(desc); + unsigned long pending; + int offset; + + chained_irq_enter(irqchip, desc); + + pending = readl(gpio->regs + GPIO_INTSTATUS); + if (pending) { + for_each_set_bit(offset, &pending, gpio->ngpio[0]) { + int gpio_irq = irq_find_mapping(gc->irq.domain, + offset); + generic_handle_irq(gpio_irq); + + if ((irq_get_trigger_type(gpio_irq) & + IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH) + phytium_gpio_toggle_trigger(gpio, offset); + } + } + + chained_irq_exit(irqchip, desc); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_handler); + +int phytium_gpio_get_direction(struct gpio_chip *gc, unsigned int offset) +{ + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct pin_loc loc; + void __iomem *ddr; + + if (get_pin_location(gpio, offset, &loc)) + return -EINVAL; + ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); + + return !(readl(ddr) & BIT(loc.offset)); +} +EXPORT_SYMBOL_GPL(phytium_gpio_get_direction); + +#if CONFIG_SMP +int +phytium_gpio_irq_set_affinity(struct irq_data *d, const struct cpumask *mask_val, bool force) +{ + struct gpio_chip *chip_data = irq_data_get_irq_chip_data(d); + struct irq_chip *chip = irq_get_chip(*(chip_data->irq.parents)); + struct irq_data *data = irq_get_irq_data(*(chip_data->irq.parents)); + + if (chip && chip->irq_set_affinity) + return chip->irq_set_affinity(data, mask_val, force); + + return -EINVAL; +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_set_affinity); +#endif + +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium GPIO Controller core"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-core.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-core.h new file mode 100644 index 0000000000000000000000000000000000000000..d45a9ab11944bff8b98efdab1b80893831454b3d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-core.h @@ -0,0 +1,87 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _GPIO_PHYTIUM_H +#define _GPIO_PHYTIUM_H + +#include +#include + +#include "gpiolib.h" + +#define GPIO_SWPORTA_DR 0x00 /* WR Port A Output Data Register */ +#define GPIO_SWPORTA_DDR 0x04 /* WR Port A Data Direction Register */ +#define GPIO_EXT_PORTA 0x08 /* RO Port A Input Data Register */ +#define GPIO_SWPORTB_DR 0x0c /* WR Port B Output Data Register */ +#define GPIO_SWPORTB_DDR 0x10 /* WR Port B Data Direction Register */ +#define GPIO_EXT_PORTB 0x14 /* RO Port B Input Data Register */ + +#define GPIO_INTEN 0x18 /* WR Port A Interrput Enable Register */ +#define GPIO_INTMASK 0x1c /* WR Port A Interrupt Mask Register */ +#define GPIO_INTTYPE_LEVEL 0x20 /* WR Port A Interrupt Level Register */ +#define GPIO_INT_POLARITY 0x24 /* WR Port A Interrupt Polarity Register */ +#define GPIO_INTSTATUS 0x28 /* RO Port A Interrupt Status Register */ +#define GPIO_RAW_INTSTATUS 0x2c /* RO Port A Raw Interrupt Status Register */ +#define GPIO_LS_SYNC 0x30 /* WR Level-sensitive Synchronization Enable Register */ +#define GPIO_DEBOUNCE 0x34 /* WR Debounce Enable Register */ +#define GPIO_PORTA_EOI 0x38 /* WO Port A Clear Interrupt Register */ + +#define MAX_NPORTS 2 +#define NGPIO_DEFAULT 8 +#define NGPIO_MAX 32 +#define GPIO_PORT_STRIDE (GPIO_EXT_PORTB - GPIO_EXT_PORTA) + +struct pin_loc { + unsigned int port; + unsigned int offset; +}; + +#ifdef CONFIG_PM_SLEEP +struct phytium_gpio_ctx { + u32 swporta_dr; + u32 swporta_ddr; + u32 ext_porta; + u32 swportb_dr; + u32 swportb_ddr; + u32 ext_portb; + u32 inten; + u32 intmask; + u32 inttype_level; + u32 int_polarity; + u32 intstatus; + u32 raw_intstatus; + u32 ls_sync; + u32 debounce; +}; +#endif + +struct phytium_gpio { + raw_spinlock_t lock; + void __iomem *regs; + struct gpio_chip gc; + struct irq_chip irq_chip; + unsigned int ngpio[2]; + int irq[32]; +#ifdef CONFIG_PM_SLEEP + struct phytium_gpio_ctx ctx; +#endif +}; + +int phytium_gpio_get(struct gpio_chip *gc, unsigned int offset); +void phytium_gpio_set(struct gpio_chip *gc, unsigned int offset, int value); + +int phytium_gpio_get_direction(struct gpio_chip *gc, unsigned int offset); +int phytium_gpio_direction_input(struct gpio_chip *gc, unsigned int offset); +int phytium_gpio_direction_output(struct gpio_chip *gc, unsigned int offset, int value); + +void phytium_gpio_irq_ack(struct irq_data *d); +void phytium_gpio_irq_mask(struct irq_data *d); +void phytium_gpio_irq_unmask(struct irq_data *d); +int phytium_gpio_irq_set_type(struct irq_data *d, unsigned int flow_type); +void phytium_gpio_irq_enable(struct irq_data *d); +void phytium_gpio_irq_disable(struct irq_data *d); +void phytium_gpio_irq_handler(struct irq_desc *desc); +int phytium_gpio_irq_set_affinity(struct irq_data *d, const struct cpumask *mask_val, bool force); +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-pci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-pci.c new file mode 100644 index 0000000000000000000000000000000000000000..e68772dd7a88be0628b72ebe5067f5ededa239f4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-pci.c @@ -0,0 +1,187 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include + +#include "gpio-phytium-core.h" + +static int phytium_gpio_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) +{ + struct device *dev = &pdev->dev; + struct phytium_gpio *gpio; + struct gpio_irq_chip *girq; + int err; + + gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL); + if (!gpio) + return -ENOMEM; + + err = pcim_enable_device(pdev); + if (err) { + dev_err(dev, "Failed to enable PCI device: err %d\n", err); + goto out; + } + + err = pcim_iomap_regions(pdev, 1 << 0, pci_name(pdev)); + if (err) { + dev_err(dev, "Failed to iomap PCI device: err %d\n", err); + goto out; + } + + gpio->regs = pcim_iomap_table(pdev)[0]; + if (!gpio->regs) { + dev_err(dev, "Cannot map PCI resource\n"); + err = -ENOMEM; + goto out; + } + + err = pci_enable_msi(pdev); + if (err < 0) + goto out; + + pci_set_master(pdev); + + gpio->irq[0] = pdev->irq; + if (gpio->irq[0] < 0) + dev_warn(dev, "no irq is found.\n"); + + /* There is only one group of Pins at the moment. */ + gpio->ngpio[0] = NGPIO_MAX; + + /* irq_chip support */ + gpio->irq_chip.name = dev_name(dev); + gpio->irq_chip.irq_ack = phytium_gpio_irq_ack; + gpio->irq_chip.irq_mask = phytium_gpio_irq_mask; + gpio->irq_chip.irq_unmask = phytium_gpio_irq_unmask; + gpio->irq_chip.irq_set_type = phytium_gpio_irq_set_type; + gpio->irq_chip.irq_enable = phytium_gpio_irq_enable; + gpio->irq_chip.irq_disable = phytium_gpio_irq_disable; + + raw_spin_lock_init(&gpio->lock); + + gpio->gc.base = -1; + gpio->gc.get_direction = phytium_gpio_get_direction; + gpio->gc.direction_input = phytium_gpio_direction_input; + gpio->gc.direction_output = phytium_gpio_direction_output; + gpio->gc.get = phytium_gpio_get; + gpio->gc.set = phytium_gpio_set; + gpio->gc.ngpio = gpio->ngpio[0] + gpio->ngpio[1]; + gpio->gc.label = dev_name(dev); + gpio->gc.parent = dev; + gpio->gc.owner = THIS_MODULE; + + girq = &gpio->gc.irq; + girq->handler = handle_bad_irq; + girq->default_type = IRQ_TYPE_NONE; + + girq->num_parents = 1; + girq->parents = devm_kcalloc(&pdev->dev, girq->num_parents, + sizeof(*girq->parents), GFP_KERNEL); + if (!girq->parents) + return -ENOMEM; + girq->parents[0] = gpio->irq[0]; + girq->parent_handler = phytium_gpio_irq_handler; + + girq->chip = &gpio->irq_chip; + + err = devm_gpiochip_add_data(dev, &gpio->gc, gpio); + if (err) + goto out; + + dev_info(dev, "Phytium PCI GPIO controller @%pa registered\n", + &gpio->regs); + + pci_set_drvdata(pdev, gpio); + +out: + return err; +} + +static const struct pci_device_id phytium_gpio_pci_ids[] = { + { PCI_DEVICE(0x1DB7, 0xDC31) }, + { 0 } +}; +MODULE_DEVICE_TABLE(pci, phytium_gpio_pci_ids); + +#ifdef CONFIG_PM_SLEEP +static int phytium_gpio_pci_suspend(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_gpio *gpio = pci_get_drvdata(pdev); + unsigned long flags; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + gpio->ctx.swporta_dr = readl(gpio->regs + GPIO_SWPORTA_DR); + gpio->ctx.swporta_ddr = readl(gpio->regs + GPIO_SWPORTA_DDR); + gpio->ctx.ext_porta = readl(gpio->regs + GPIO_EXT_PORTA); + gpio->ctx.swportb_dr = readl(gpio->regs + GPIO_SWPORTB_DR); + gpio->ctx.swportb_ddr = readl(gpio->regs + GPIO_SWPORTB_DDR); + gpio->ctx.ext_portb = readl(gpio->regs + GPIO_EXT_PORTB); + + gpio->ctx.inten = readl(gpio->regs + GPIO_INTEN); + gpio->ctx.intmask = readl(gpio->regs + GPIO_INTMASK); + gpio->ctx.inttype_level = readl(gpio->regs + GPIO_INTTYPE_LEVEL); + gpio->ctx.int_polarity = readl(gpio->regs + GPIO_INT_POLARITY); + gpio->ctx.debounce = readl(gpio->regs + GPIO_DEBOUNCE); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} + +static int phytium_gpio_pci_resume(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_gpio *gpio = pci_get_drvdata(pdev); + unsigned long flags; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + writel(gpio->ctx.swporta_dr, gpio->regs + GPIO_SWPORTA_DR); + writel(gpio->ctx.swporta_ddr, gpio->regs + GPIO_SWPORTA_DDR); + writel(gpio->ctx.ext_porta, gpio->regs + GPIO_EXT_PORTA); + writel(gpio->ctx.swportb_dr, gpio->regs + GPIO_SWPORTB_DR); + writel(gpio->ctx.swportb_ddr, gpio->regs + GPIO_SWPORTB_DDR); + writel(gpio->ctx.ext_portb, gpio->regs + GPIO_EXT_PORTB); + + writel(gpio->ctx.inten, gpio->regs + GPIO_INTEN); + writel(gpio->ctx.intmask, gpio->regs + GPIO_INTMASK); + writel(gpio->ctx.inttype_level, gpio->regs + GPIO_INTTYPE_LEVEL); + writel(gpio->ctx.int_polarity, gpio->regs + GPIO_INT_POLARITY); + writel(gpio->ctx.debounce, gpio->regs + GPIO_DEBOUNCE); + + writel(0xffffffff, gpio->regs + GPIO_PORTA_EOI); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_gpio_pci_pm_ops, + phytium_gpio_pci_suspend, + phytium_gpio_pci_resume); + +static struct pci_driver phytium_gpio_pci_driver = { + .name = "gpio-phytium-pci", + .id_table = phytium_gpio_pci_ids, + .probe = phytium_gpio_pci_probe, + .driver = { + .pm = &phytium_gpio_pci_pm_ops, + }, +}; + +module_pci_driver(phytium_gpio_pci_driver); + +MODULE_LICENSE("GPL v2"); +MODULE_AUTHOR("Cheng Quan "); +MODULE_DESCRIPTION("Phytium GPIO PCI Driver"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-platform.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-platform.c new file mode 100644 index 0000000000000000000000000000000000000000..9fe3191f789d6af73e5639f8f839a34a19daaed7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-platform.c @@ -0,0 +1,204 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Support functions for Phytium GPIO + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + * + * Derived from drivers/gpio/gpio-pl061.c + * Copyright (C) 2008, 2009 Provigent Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "gpio-phytium-core.h" + +static const struct of_device_id phytium_gpio_of_match[] = { + { .compatible = "phytium,gpio", }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_gpio_of_match); + +static const struct acpi_device_id phytium_gpio_acpi_match[] = { + { "PHYT0001", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, phytium_gpio_acpi_match); + +static int phytium_gpio_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct resource *res; + struct phytium_gpio *gpio; + struct gpio_irq_chip *girq; + struct fwnode_handle *fwnode; + int err, irq_count; + + gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL); + if (!gpio) + return -ENOMEM; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + gpio->regs = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(gpio->regs)) + return PTR_ERR(gpio->regs); + + if (!device_get_child_node_count(dev)) + return -ENODEV; + + device_for_each_child_node(dev, fwnode) { + int idx; + + if (fwnode_property_read_u32(fwnode, "reg", &idx) || + idx >= MAX_NPORTS) { + dev_err(dev, "missing/invalid port index\n"); + fwnode_handle_put(fwnode); + return -EINVAL; + } + + if (fwnode_property_read_u32(fwnode, "ngpios", &gpio->ngpio[idx]) && + fwnode_property_read_u32(fwnode, "nr-gpios", &gpio->ngpio[idx])) { + dev_info(dev, + "failed to get number of gpios for Port%c\n", + idx ? 'B' : 'A'); + gpio->ngpio[idx] = NGPIO_DEFAULT; + } + } + + /* irq_chip support */ + gpio->irq_chip.name = dev_name(dev); + gpio->irq_chip.irq_ack = phytium_gpio_irq_ack; + gpio->irq_chip.irq_mask = phytium_gpio_irq_mask; + gpio->irq_chip.irq_unmask = phytium_gpio_irq_unmask; + gpio->irq_chip.irq_set_type = phytium_gpio_irq_set_type; + gpio->irq_chip.irq_enable = phytium_gpio_irq_enable; + gpio->irq_chip.irq_disable = phytium_gpio_irq_disable; +#ifdef CONFIG_SMP + /* TODO: use irq_chip_set_affinity_parent instead? */ + gpio->irq_chip.irq_set_affinity = phytium_gpio_irq_set_affinity; +#endif + raw_spin_lock_init(&gpio->lock); + + gpio->gc.base = -1; + gpio->gc.get_direction = phytium_gpio_get_direction; + gpio->gc.direction_input = phytium_gpio_direction_input; + gpio->gc.direction_output = phytium_gpio_direction_output; + gpio->gc.get = phytium_gpio_get; + gpio->gc.set = phytium_gpio_set; + gpio->gc.ngpio = gpio->ngpio[0] + gpio->ngpio[1]; + gpio->gc.label = dev_name(dev); + gpio->gc.parent = dev; + gpio->gc.owner = THIS_MODULE; + + girq = &gpio->gc.irq; + girq->handler = handle_bad_irq; + girq->default_type = IRQ_TYPE_NONE; + + for (irq_count = 0; irq_count < platform_irq_count(pdev); irq_count++) { + gpio->irq[irq_count] = -ENXIO; + gpio->irq[irq_count] = platform_get_irq(pdev, irq_count); + if (gpio->irq[irq_count] < 0) { + //dev_warn(dev, "no irq is found.\n"); + break; + } + }; + + girq->num_parents = irq_count; + girq->parents = gpio->irq; + girq->parent_handler = phytium_gpio_irq_handler; + + girq->chip = &gpio->irq_chip; + + err = devm_gpiochip_add_data(dev, &gpio->gc, gpio); + if (err) + return err; + + platform_set_drvdata(pdev, gpio); + dev_info(dev, "Phytium GPIO controller @%pa registered\n", + &res->start); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_gpio_suspend(struct device *dev) +{ + struct platform_device *pdev = to_platform_device(dev); + struct phytium_gpio *gpio = platform_get_drvdata(pdev); + unsigned long flags; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + gpio->ctx.swporta_dr = readl(gpio->regs + GPIO_SWPORTA_DR); + gpio->ctx.swporta_ddr = readl(gpio->regs + GPIO_SWPORTA_DDR); + gpio->ctx.ext_porta = readl(gpio->regs + GPIO_EXT_PORTA); + gpio->ctx.swportb_dr = readl(gpio->regs + GPIO_SWPORTB_DR); + gpio->ctx.swportb_ddr = readl(gpio->regs + GPIO_SWPORTB_DDR); + gpio->ctx.ext_portb = readl(gpio->regs + GPIO_EXT_PORTB); + + gpio->ctx.inten = readl(gpio->regs + GPIO_INTEN); + gpio->ctx.intmask = readl(gpio->regs + GPIO_INTMASK); + gpio->ctx.inttype_level = readl(gpio->regs + GPIO_INTTYPE_LEVEL); + gpio->ctx.int_polarity = readl(gpio->regs + GPIO_INT_POLARITY); + gpio->ctx.debounce = readl(gpio->regs + GPIO_DEBOUNCE); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} + +static int phytium_gpio_resume(struct device *dev) +{ + struct platform_device *pdev = to_platform_device(dev); + struct phytium_gpio *gpio = platform_get_drvdata(pdev); + unsigned long flags; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + writel(gpio->ctx.swporta_dr, gpio->regs + GPIO_SWPORTA_DR); + writel(gpio->ctx.swporta_ddr, gpio->regs + GPIO_SWPORTA_DDR); + writel(gpio->ctx.ext_porta, gpio->regs + GPIO_EXT_PORTA); + writel(gpio->ctx.swportb_dr, gpio->regs + GPIO_SWPORTB_DR); + writel(gpio->ctx.swportb_ddr, gpio->regs + GPIO_SWPORTB_DDR); + writel(gpio->ctx.ext_portb, gpio->regs + GPIO_EXT_PORTB); + + writel(gpio->ctx.inten, gpio->regs + GPIO_INTEN); + writel(gpio->ctx.intmask, gpio->regs + GPIO_INTMASK); + writel(gpio->ctx.inttype_level, gpio->regs + GPIO_INTTYPE_LEVEL); + writel(gpio->ctx.int_polarity, gpio->regs + GPIO_INT_POLARITY); + writel(gpio->ctx.debounce, gpio->regs + GPIO_DEBOUNCE); + + writel(0xffffffff, gpio->regs + GPIO_PORTA_EOI); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_gpio_pm_ops, phytium_gpio_suspend, + phytium_gpio_resume); + +static struct platform_driver phytium_gpio_driver = { + .driver = { + .name = "gpio-phytium-platform", + .pm = &phytium_gpio_pm_ops, + .of_match_table = of_match_ptr(phytium_gpio_of_match), + .acpi_match_table = ACPI_PTR(phytium_gpio_acpi_match), + }, + .probe = phytium_gpio_probe, +}; + +module_platform_driver(phytium_gpio_driver); + +MODULE_LICENSE("GPL v2"); +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium GPIO driver"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-sgpio.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-sgpio.c new file mode 100644 index 0000000000000000000000000000000000000000..4785ca45f79ec4e0d1ef160cbf7a47b1a86dd2ea --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpio-phytium-sgpio.c @@ -0,0 +1,302 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SGPIO Driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define SGPIO_CTL0_REG 0x00 +#define SGPIO_CTL0_REG_ENABLE BIT(0) +#define SGPIO_CTL0_REG_RX_DISABLE BIT(1) +#define SGPIO_CTL0_REG_L3_L0 GENMASK(11, 8) +#define SGPIO_CTL0_REG_CLK_DIV_NUM GENMASK(31, 12) +#define SGPIO_CTL1_REG 0x04 +#define SGPIO_CTL1_REG_READY BIT(0) +#define SGPIO_CTL1_REG_W_UPDATA BIT(1) +#define SGPIO_CTL1_REG_OP_MODE BIT(2) +#define SGPIO_CTL1_REG_OP_STATE BIT(3) +#define SGPIO_CTL1_REG_BIT_NUM GENMASK(14, 8) +#define SGPIO_CTL1_REG_INTERVAL_TIMER GENMASK(31, 16) +#define SGPIO_SOFT_RESET_REG 0x08 +#define SGPIO_SOFT_RESET_REG_MASK BIT(0) +#define SGPIO_IRQ_REG 0x0c +#define SGPIO_IRQ_REG_MASK BIT(0) +#define SGPIO_IRQ_M_REG 0x10 +#define SGPIO_IRQ_M_REG_MASK BIT(0) +#define SGPIO_WDATA0_REG 0x14 +#define SGPIO_WDATA_REG(x) (SGPIO_WDATA0_REG + ((x) == 2 ? 3 : (x))* 4) // 0x14, 0x18, 0x20 +#define SGPIO_RDATA0_REG 0x24 +#define SGPIO_RDATA_REG(x) (SGPIO_RDATA0_REG + (x) * 4) + +#define DEFAULT_L3_L0 0 + +#define GPIO_GROUP(x) ((x) >> 6) +#define GPIO_OFFSET(x) ((x) & GENMASK(5, 0)) +#define GPIO_BIT(x) BIT(GPIO_OFFSET(x) >> 1) + +struct phytium_sgpio { + struct gpio_chip gc; + void __iomem *regs; + unsigned int ngpios; + struct clk *pclk; + + struct mutex lock; + struct completion completion; +}; + +static bool phytium_sgpio_is_input(unsigned int offset) +{ + return !(offset % 2); +} + +static int sgpio_set_value(struct gpio_chip *gc, unsigned int offset, int val) +{ + struct phytium_sgpio *gpio = gpiochip_get_data(gc); + u32 reg; + int rc = 0; + + if (phytium_sgpio_is_input(offset)) + return -EINVAL; + + reinit_completion(&gpio->completion); + + /* + * Since this is an output, read the cached value from rdata, + * then update value. + */ + /* cached data from wdata? */ + reg = readl(gpio->regs + SGPIO_WDATA_REG(GPIO_GROUP(offset))); + if (val) + reg |= GPIO_BIT(offset); + else + reg &= GPIO_BIT(offset); + writel(reg, gpio->regs + SGPIO_WDATA_REG(GPIO_GROUP(offset))); + + /* Start transmission and wait for completion */ + writel(readl(gpio->regs + SGPIO_CTL1_REG) | SGPIO_CTL1_REG_W_UPDATA, + gpio->regs + SGPIO_CTL1_REG); + if (!wait_for_completion_timeout(&gpio->completion, msecs_to_jiffies(1000))) + rc = -EINVAL; + + return rc; +} + +static int phytium_sgpio_direction_input(struct gpio_chip *gc, unsigned int offset) +{ + return phytium_sgpio_is_input(offset) ? 0 : -EINVAL; +} + +static int phytium_sgpio_direction_output(struct gpio_chip *gc, unsigned int offset, int val) +{ + struct phytium_sgpio *gpio = gpiochip_get_data(gc); + int rc; + + mutex_lock(&gpio->lock); + + /* + * No special action is required for setting the direction; we'll + * error-out in sgpio_set_value if this isn't an output GPIO + */ + rc = sgpio_set_value(&gpio->gc, offset, val); + + mutex_unlock(&gpio->lock); + + return rc; +} + +static int phytium_sgpio_get_direction(struct gpio_chip *gc, unsigned int offset) +{ + return !!phytium_sgpio_is_input(offset); +} + +static int phytium_sgpio_get(struct gpio_chip *gc, unsigned int offset) +{ + struct phytium_sgpio *gpio = gpiochip_get_data(gc); + int rc = 0; + u32 val, ctl0; + + mutex_lock(&gpio->lock); + + if (!phytium_sgpio_is_input(offset)) { + val = readl(gpio->regs + SGPIO_WDATA_REG(GPIO_GROUP(offset))); + rc = !!(val & GPIO_BIT(offset)); + mutex_unlock(&gpio->lock); + return rc; + } + + reinit_completion(&gpio->completion); + + /* Enable Rx */ + ctl0 = readl(gpio->regs + SGPIO_CTL0_REG); + writel(ctl0 & ~SGPIO_CTL0_REG_RX_DISABLE, gpio->regs + SGPIO_CTL0_REG); + + /* Start reading transaction and wait for completion */ + writel(readl(gpio->regs + SGPIO_CTL1_REG) | SGPIO_CTL1_REG_W_UPDATA, + gpio->regs + SGPIO_CTL1_REG); + if (!wait_for_completion_timeout(&gpio->completion, msecs_to_jiffies(1000))) { + rc = -EINVAL; + goto err; + } + + val = readl(gpio->regs + SGPIO_RDATA_REG(GPIO_GROUP(offset))); + rc = !!(val & GPIO_BIT(offset)); + +err: + /* Disalbe Rx to hold the value */ + writel(ctl0 | SGPIO_CTL0_REG_RX_DISABLE, gpio->regs + SGPIO_CTL0_REG); + mutex_unlock(&gpio->lock); + + return rc; +} + +static void phytium_sgpio_set(struct gpio_chip *gc, unsigned int offset, int val) +{ + struct phytium_sgpio *gpio = gpiochip_get_data(gc); + + mutex_lock(&gpio->lock); + + sgpio_set_value(gc, offset, val); + + mutex_unlock(&gpio->lock); +} + +static irqreturn_t phytium_sgpio_irq_handler(int irq, void *data) +{ + struct phytium_sgpio *gpio = data; + + if (!readl(gpio->regs + SGPIO_IRQ_REG)) + return IRQ_NONE; + + /* Clear the interrupt */ + writel(0, gpio->regs + SGPIO_IRQ_REG); + + /* Check if tx/rx has been done */ + if (!(readl(gpio->regs + SGPIO_CTL1_REG) & SGPIO_CTL1_REG_OP_STATE)) + complete(&gpio->completion); + + return IRQ_HANDLED; +} + +static int phytium_sgpio_probe(struct platform_device *pdev) +{ + u32 pclk_freq, sclk_freq, clk_div; + struct phytium_sgpio *gpio; + struct resource *res; + struct device *dev = &pdev->dev; + int rc; + + gpio = devm_kzalloc(dev, sizeof(*gpio), GFP_KERNEL); + if (!gpio) + return -ENOMEM; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + gpio->regs = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(gpio->regs)) + return PTR_ERR(gpio->regs); + + if (devm_request_irq(dev, platform_get_irq(pdev, 0), + phytium_sgpio_irq_handler, + IRQF_SHARED, dev_name(dev), gpio)) { + dev_err(dev, "failed to request IRQ\n"); + return -ENOENT; + } + + rc = fwnode_property_read_u32(dev_fwnode(dev), "ngpios", &gpio->ngpios); + if (rc < 0) { + dev_err(dev, "Could not read ngpios property\n"); + return -EINVAL; + } else if (gpio->ngpios % 32) { + dev_err(&pdev->dev, "Number of GPIOs not multiple of 32: %d\n", + gpio->ngpios); + return -EINVAL; + } + + rc = fwnode_property_read_u32(dev_fwnode(dev), "bus-frequency", &sclk_freq); + if (rc < 0) { + dev_err(dev, "Could not read bus-frequency property\n"); + return -EINVAL; + } + + gpio->pclk = devm_clk_get(dev, NULL); + if (IS_ERR(gpio->pclk)) { + dev_err(dev, "Could not get the APB clock property\n"); + return PTR_ERR(gpio->pclk); + } + rc = clk_prepare_enable(gpio->pclk); + if (rc) { + dev_err(dev, "failed to enable pclk: %d\n", rc); + return rc; + } + pclk_freq = clk_get_rate(gpio->pclk); + + /* + * From the datasheet: + * (pclk / 2) / (clk_div + 1) = sclk + */ + if (sclk_freq == 0) { + dev_err(dev, "SCLK should not be 0\n"); + return -EINVAL; + } + + clk_div = (pclk_freq / (sclk_freq * 2)) - 1; + if (clk_div > (1 << 20) - 1) { + dev_err(dev, "clk_div is overflow\n"); + return -EINVAL; + } + + writel(FIELD_PREP(SGPIO_CTL0_REG_CLK_DIV_NUM, clk_div) | + FIELD_PREP(SGPIO_CTL0_REG_L3_L0, DEFAULT_L3_L0) | + SGPIO_CTL0_REG_RX_DISABLE | SGPIO_CTL0_REG_ENABLE, + gpio->regs + SGPIO_CTL0_REG); + + writel(FIELD_PREP(SGPIO_CTL1_REG_BIT_NUM, gpio->ngpios) | + SGPIO_CTL1_REG_READY, gpio->regs + SGPIO_CTL1_REG); + + mutex_init(&gpio->lock); + init_completion(&gpio->completion); + platform_set_drvdata(pdev, gpio); + + gpio->gc.parent = dev; + gpio->gc.base = -1; + gpio->gc.ngpio = gpio->ngpios * 2; + gpio->gc.label = dev_name(dev); + gpio->gc.direction_input = phytium_sgpio_direction_input; + gpio->gc.direction_output = phytium_sgpio_direction_output; + gpio->gc.get_direction = phytium_sgpio_get_direction; + gpio->gc.get = phytium_sgpio_get; + gpio->gc.set = phytium_sgpio_set; + + return devm_gpiochip_add_data(dev, &gpio->gc, gpio); +} + +static const struct of_device_id phytium_sgpio_of_match[] = { + { .compatible = "phytium,sgpio", }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_sgpio_of_match); + +static struct platform_driver phytium_sgpio_driver = { + .driver = { + .name = KBUILD_MODNAME, + .of_match_table = of_match_ptr(phytium_sgpio_of_match), + }, + .probe = phytium_sgpio_probe, +}; +module_platform_driver(phytium_sgpio_driver); + +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium SGPIO driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpiolib.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpiolib.h new file mode 100644 index 0000000000000000000000000000000000000000..b674b5bb980e28bd80aeffd8789a5f4d93997bf8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpio/gpiolib.h @@ -0,0 +1,184 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Internal GPIO functions. + * + * Copyright (C) 2013, Intel Corporation + * Author: Mika Westerberg + */ + +#ifndef GPIOLIB_H +#define GPIOLIB_H + +#include +#include /* for enum gpiod_flags */ +#include +#include +#include +#include + +#define GPIOCHIP_NAME "gpiochip" + +/** + * struct gpio_device - internal state container for GPIO devices + * @id: numerical ID number for the GPIO chip + * @dev: the GPIO device struct + * @chrdev: character device for the GPIO device + * @mockdev: class device used by the deprecated sysfs interface (may be + * NULL) + * @owner: helps prevent removal of modules exporting active GPIOs + * @chip: pointer to the corresponding gpiochip, holding static + * data for this device + * @descs: array of ngpio descriptors. + * @ngpio: the number of GPIO lines on this GPIO device, equal to the size + * of the @descs array. + * @base: GPIO base in the DEPRECATED global Linux GPIO numberspace, assigned + * at device creation time. + * @label: a descriptive name for the GPIO device, such as the part number + * or name of the IP component in a System on Chip. + * @data: per-instance data assigned by the driver + * @list: links gpio_device:s together for traversal + * + * This state container holds most of the runtime variable data + * for a GPIO device and can hold references and live on after the + * GPIO chip has been removed, if it is still being used from + * userspace. + */ +struct gpio_device { + int id; + struct device dev; + struct cdev chrdev; + struct device *mockdev; + struct module *owner; + struct gpio_chip *chip; + struct gpio_desc *descs; + int base; + u16 ngpio; + const char *label; + void *data; + struct list_head list; + struct blocking_notifier_head notifier; + +#ifdef CONFIG_PINCTRL + /* + * If CONFIG_PINCTRL is enabled, then gpio controllers can optionally + * describe the actual pin range which they serve in an SoC. This + * information would be used by pinctrl subsystem to configure + * corresponding pins for gpio usage. + */ + struct list_head pin_ranges; +#endif +}; + +/* gpio suffixes used for ACPI and device tree lookup */ +static __maybe_unused const char * const gpio_suffixes[] = { "gpios", "gpio" }; + +struct gpio_array { + struct gpio_desc **desc; + unsigned int size; + struct gpio_chip *chip; + unsigned long *get_mask; + unsigned long *set_mask; + unsigned long invert_mask[]; +}; + +struct gpio_desc *gpiochip_get_desc(struct gpio_chip *gc, unsigned int hwnum); +int gpiod_get_array_value_complex(bool raw, bool can_sleep, + unsigned int array_size, + struct gpio_desc **desc_array, + struct gpio_array *array_info, + unsigned long *value_bitmap); +int gpiod_set_array_value_complex(bool raw, bool can_sleep, + unsigned int array_size, + struct gpio_desc **desc_array, + struct gpio_array *array_info, + unsigned long *value_bitmap); + +extern spinlock_t gpio_lock; +extern struct list_head gpio_devices; + +struct gpio_desc { + struct gpio_device *gdev; + unsigned long flags; +/* flag symbols are bit numbers */ +#define FLAG_REQUESTED 0 +#define FLAG_IS_OUT 1 +#define FLAG_EXPORT 2 /* protected by sysfs_lock */ +#define FLAG_SYSFS 3 /* exported via /sys/class/gpio/control */ +#define FLAG_ACTIVE_LOW 6 /* value has active low */ +#define FLAG_OPEN_DRAIN 7 /* Gpio is open drain type */ +#define FLAG_OPEN_SOURCE 8 /* Gpio is open source type */ +#define FLAG_USED_AS_IRQ 9 /* GPIO is connected to an IRQ */ +#define FLAG_IRQ_IS_ENABLED 10 /* GPIO is connected to an enabled IRQ */ +#define FLAG_IS_HOGGED 11 /* GPIO is hogged */ +#define FLAG_TRANSITORY 12 /* GPIO may lose value in sleep or reset */ +#define FLAG_PULL_UP 13 /* GPIO has pull up enabled */ +#define FLAG_PULL_DOWN 14 /* GPIO has pull down enabled */ +#define FLAG_BIAS_DISABLE 15 /* GPIO has pull disabled */ +#define FLAG_EDGE_RISING 16 /* GPIO CDEV detects rising edge events */ +#define FLAG_EDGE_FALLING 17 /* GPIO CDEV detects falling edge events */ + + /* Connection label */ + const char *label; + /* Name of the GPIO */ + const char *name; +#ifdef CONFIG_OF_DYNAMIC + struct device_node *hog; +#endif +#ifdef CONFIG_GPIO_CDEV + /* debounce period in microseconds */ + unsigned int debounce_period_us; +#endif +}; + +int gpiod_request(struct gpio_desc *desc, const char *label); +void gpiod_free(struct gpio_desc *desc); +int gpiod_configure_flags(struct gpio_desc *desc, const char *con_id, + unsigned long lflags, enum gpiod_flags dflags); +int gpiod_hog(struct gpio_desc *desc, const char *name, + unsigned long lflags, enum gpiod_flags dflags); + +/* + * Return the GPIO number of the passed descriptor relative to its chip + */ +static inline int gpio_chip_hwgpio(const struct gpio_desc *desc) +{ + return desc - &desc->gdev->descs[0]; +} + +/* With descriptor prefix */ + +#define gpiod_emerg(desc, fmt, ...) \ + pr_emerg("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?",\ + ##__VA_ARGS__) +#define gpiod_crit(desc, fmt, ...) \ + pr_crit("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?", \ + ##__VA_ARGS__) +#define gpiod_err(desc, fmt, ...) \ + pr_err("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?", \ + ##__VA_ARGS__) +#define gpiod_warn(desc, fmt, ...) \ + pr_warn("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?", \ + ##__VA_ARGS__) +#define gpiod_info(desc, fmt, ...) \ + pr_info("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?", \ + ##__VA_ARGS__) +#define gpiod_dbg(desc, fmt, ...) \ + pr_debug("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?",\ + ##__VA_ARGS__) + +/* With chip prefix */ + +#define chip_emerg(gc, fmt, ...) \ + dev_emerg(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) +#define chip_crit(gc, fmt, ...) \ + dev_crit(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) +#define chip_err(gc, fmt, ...) \ + dev_err(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) +#define chip_warn(gc, fmt, ...) \ + dev_warn(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) +#define chip_info(gc, fmt, ...) \ + dev_info(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) +#define chip_dbg(gc, fmt, ...) \ + dev_dbg(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) + +#endif /* GPIOLIB_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..e3024feb69d0e02d3f6c3f2a5257d21f367aeaaa --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/Kconfig @@ -0,0 +1,7 @@ +config DRM_PHYTIUM + tristate "DRM Support for Phytium Graphics Card" + depends on DRM + select DRM_KMS_HELPER + help + Choose this option if you have a phytium graphics card. + This driver provides kernel mode setting and buffer management to userspace. diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..39511a56bc6b5cd772c134966edb9387398e6c71 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/Makefile @@ -0,0 +1,18 @@ +phytium-dc-drm-y := phytium_display_drv.o \ + phytium_plane.o \ + phytium_crtc.o \ + phytium_dp.o \ + phytium_fb.o \ + phytium_gem.o \ + phytium_fbdev.o \ + phytium_debugfs.o \ + px210_dp.o \ + phytium_panel.o \ + px210_dc.o \ + phytium_pci.o \ + pe220x_dp.o \ + pe220x_dc.o \ + phytium_platform.o + +obj-$(CONFIG_DRM_PHYTIUM) += phytium-dc-drm.o +CFLAGS_REMOVE_phytium_crtc.o += -mgeneral-regs-only \ No newline at end of file diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dc.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dc.c new file mode 100644 index 0000000000000000000000000000000000000000..cfdecad43561b3943a04ce3d782e211f1099f449 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dc.c @@ -0,0 +1,297 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium Pe220x display controller DRM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#if defined(__arm__) || defined(__aarch64__) +#include +#endif +#include +#include "phytium_display_drv.h" +#include "pe220x_reg.h" +#include "phytium_crtc.h" +#include "phytium_plane.h" +#include "phytium_fb.h" +#include "phytium_gem.h" + +void pe220x_dc_hw_disable(struct drm_crtc *crtc); + +static const unsigned int pe220x_primary_formats[] = { + DRM_FORMAT_ARGB2101010, + DRM_FORMAT_ABGR2101010, + DRM_FORMAT_RGBA1010102, + DRM_FORMAT_BGRA1010102, + DRM_FORMAT_ARGB8888, + DRM_FORMAT_ABGR8888, + DRM_FORMAT_RGBA8888, + DRM_FORMAT_BGRA8888, + DRM_FORMAT_XRGB8888, + DRM_FORMAT_XBGR8888, + DRM_FORMAT_RGBX8888, + DRM_FORMAT_BGRX8888, + DRM_FORMAT_ARGB4444, + DRM_FORMAT_ABGR4444, + DRM_FORMAT_RGBA4444, + DRM_FORMAT_BGRA4444, + DRM_FORMAT_XRGB4444, + DRM_FORMAT_XBGR4444, + DRM_FORMAT_RGBX4444, + DRM_FORMAT_BGRX4444, + DRM_FORMAT_ARGB1555, + DRM_FORMAT_ABGR1555, + DRM_FORMAT_RGBA5551, + DRM_FORMAT_BGRA5551, + DRM_FORMAT_XRGB1555, + DRM_FORMAT_XBGR1555, + DRM_FORMAT_RGBX5551, + DRM_FORMAT_BGRX5551, + DRM_FORMAT_RGB565, + DRM_FORMAT_BGR565, + DRM_FORMAT_YUYV, + DRM_FORMAT_UYVY, + DRM_FORMAT_NV16, + DRM_FORMAT_NV12, + DRM_FORMAT_NV21, +}; + +static const unsigned int pe220x_bmc_primary_formats[] = { + DRM_FORMAT_XRGB8888, +}; + +static uint64_t pe220x_primary_formats_modifiers[] = { + DRM_FORMAT_MOD_LINEAR, + DRM_FORMAT_MOD_INVALID +}; + +static uint64_t pe220x_cursor_formats_modifiers[] = { + DRM_FORMAT_MOD_LINEAR, + DRM_FORMAT_MOD_INVALID +}; + +static const unsigned int pe220x_cursor_formats[] = { + DRM_FORMAT_ARGB8888, +}; + +void pe220x_dc_hw_vram_init(struct phytium_display_private *priv, resource_size_t vram_addr, + resource_size_t vram_size) +{ + uint32_t config; + uint32_t group_offset = priv->address_transform_base; + + phytium_writel_reg(priv, (vram_addr & SRC_ADDR_MASK) >> SRC_ADDR_OFFSET, + group_offset, PE220X_DC_ADDRESS_TRANSFORM_SRC_ADDR); + phytium_writel_reg(priv, (vram_size >> SIZE_OFFSET) | ADDRESS_TRANSFORM_ENABLE, + group_offset, PE220X_DC_ADDRESS_TRANSFORM_SIZE); + config = phytium_readl_reg(priv, group_offset, PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR); + phytium_writel_reg(priv, config, group_offset, PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR); +} + +void pe220x_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + int ret = 0; + + /* config pix clock */ + phytium_writel_reg(priv, FLAG_REQUEST | CMD_PIXEL_CLOCK | (clock & PIXEL_CLOCK_MASK), + 0, PE220X_DC_CMD_REGISTER(phys_pipe)); + ret = phytium_wait_cmd_done(priv, PE220X_DC_CMD_REGISTER(phys_pipe), + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to set pixel clock\n", __func__); +} + +void pe220x_dc_hw_reset(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int config = 0; + int phys_pipe = phytium_crtc->phys_pipe; + + config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); + + if (priv->info.bmc_mode) { + pe220x_dc_hw_disable(crtc); + config &= (~(DC0_CORE_RESET | DC1_CORE_RESET | AHB_RESET)); + if (phys_pipe == 0) { + phytium_writel_reg(priv, config | DC0_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC0_CORE_RESET | AHB_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC0_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + } else { + phytium_writel_reg(priv, config | DC1_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC1_CORE_RESET | AHB_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC1_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + } + + } else { + config &= (~(DC0_CORE_RESET | DC1_CORE_RESET | AXI_RESET | AHB_RESET)); + if (phys_pipe == 0) { + phytium_writel_reg(priv, config | DC0_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET | AHB_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC0_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + } else { + phytium_writel_reg(priv, config | DC1_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET | AHB_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC1_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + } + } +} + +void pe220x_dc_hw_disable(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int config = 0; + int phys_pipe = phytium_crtc->phys_pipe; + + /* clear framebuffer */ + phytium_writel_reg(priv, CLEAR_VALUE_BLACK, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE); + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); + config |= FRAMEBUFFER_CLEAR; + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); + + /* disable cursor */ + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); + config = ((config & (~CURSOR_FORMAT_MASK)) | CURSOR_FORMAT_DISABLED); + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); + mdelay(20); + + /* reset pix clock */ + pe220x_dc_hw_config_pix_clock(crtc, 0); + + if (phys_pipe == 0) { + config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, config | DC0_CORE_RESET, 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config & (~DC0_CORE_RESET), 0, PE220X_DC_CLOCK_CONTROL); + } else { + config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, config | DC1_CORE_RESET, 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config & (~DC1_CORE_RESET), 0, PE220X_DC_CLOCK_CONTROL); + } + udelay(20); +} + +int pe220x_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count) +{ + int ret = 0; + + if (mode_cmd->modifier[count] != DRM_FORMAT_MOD_LINEAR) { + DRM_ERROR("unsupported fb modifier 0x%llx\n", mode_cmd->modifier[count]); + ret = -EINVAL; + } + + return ret; +} + +void pe220x_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count) +{ + *format_modifiers = pe220x_primary_formats_modifiers; + *formats = pe220x_primary_formats; + *format_count = ARRAY_SIZE(pe220x_primary_formats); +} + +void pe220x_dc_bmc_hw_plane_get_primary_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count) +{ + *format_modifiers = pe220x_primary_formats_modifiers; + *formats = pe220x_bmc_primary_formats; + *format_count = ARRAY_SIZE(pe220x_bmc_primary_formats); +} + +void pe220x_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count) +{ + *format_modifiers = pe220x_cursor_formats_modifiers; + *formats = pe220x_cursor_formats; + *format_count = ARRAY_SIZE(pe220x_cursor_formats); +} + +void pe220x_dc_hw_update_primary_hi_addr(struct drm_plane *plane) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + int phys_pipe = phytium_plane->phys_pipe; + + phytium_writel_reg(priv, (phytium_plane->iova[0] >> PREFIX_SHIFT) & PREFIX_MASK, + priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_Y_HI_ADDRESS); + + phytium_writel_reg(priv, (phytium_plane->iova[1] >> U_PREFIX_SHIFT) & U_PREFIX_MASK, + priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_U_HI_ADDRESS); + + phytium_writel_reg(priv, (phytium_plane->iova[2] >> V_PREFIX_SHIFT) & V_PREFIX_MASK, + priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_V_HI_ADDRESS); +} + +void pe220x_dc_hw_update_cursor_hi_addr(struct drm_plane *plane, uint64_t iova) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + int phys_pipe = phytium_plane->phys_pipe; + int config; + + config = ((iova >> CURSOR_PREFIX_SHIFT) & CURSOR_PREFIX_MASK); + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PE220X_DC_CURSOR_HI_ADDRESS); +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dc.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dc.h new file mode 100644 index 0000000000000000000000000000000000000000..1fd0db3b8d3fa92bd10b38877f0a3cb184887e67 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dc.h @@ -0,0 +1,34 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium Pe220x display controller DRM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PE220X_DC_H__ +#define __PE220X_DC_H__ + +#define PE220X_DC_PIX_CLOCK_MAX (594000) +#define PE220X_DC_HDISPLAY_MAX 3840 +#define PE220X_DC_VDISPLAY_MAX 2160 +#define PE220X_DC_ADDRESS_MASK 0x7f + +extern void pe220x_dc_hw_vram_init(struct phytium_display_private *priv, + resource_size_t vram_addr, + resource_size_t vram_size); +extern void pe220x_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock); +extern void pe220x_dc_hw_disable(struct drm_crtc *crtc); +extern int pe220x_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count); +extern void pe220x_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); +extern void pe220x_dc_bmc_hw_plane_get_primary_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); +extern void pe220x_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); +extern void pe220x_dc_hw_update_primary_hi_addr(struct drm_plane *plane); +extern void pe220x_dc_hw_update_cursor_hi_addr(struct drm_plane *plane, uint64_t iova); +void pe220x_dc_hw_reset(struct drm_crtc *crtc); +#endif /* __PE220X_DC_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dp.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dp.c new file mode 100644 index 0000000000000000000000000000000000000000..b56484361084d2a5f70a8ab4e71f5586333b291e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dp.c @@ -0,0 +1,508 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium display port DRM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include "phytium_display_drv.h" +#include "pe220x_reg.h" +#include "phytium_dp.h" +#include "pe220x_dp.h" + +static uint8_t pe220x_dp_source_lane_count[2] = {1, 1}; + +/* [reg][ling_rate 1.62->8.1] */ +static int vco_val[12][4] = { + {0x0509, 0x0509, 0x0509, 0x0509}, /* CP_PADJ */ + {0x0f00, 0x0f00, 0x0f00, 0x0f00}, /* CP_IADJ */ + {0x0F08, 0x0F08, 0x0F08, 0x0F08}, /* FILT_PADJ */ + {0x0061, 0x006C, 0x006C, 0x0051}, /* INTDIV */ + {0x3333, 0x0000, 0x0000, 0x0000}, /* FRACDIVL */ + {0x0000, 0x0000, 0x0000, 0x0000}, /* FRACDIVH */ + {0x0042, 0x0048, 0x0048, 0x0036}, /* HIGH_THR */ + {0x0002, 0x0002, 0x0002, 0x0002}, /* PDIAG_CTRL */ + {0x0c5e, 0x0c5e, 0x0c5e, 0x0c5e}, /* VCOCAL_PLLCNT_START */ + {0x00c7, 0x00c7, 0x00c7, 0x00c7}, /* LOCK_PEFCNT */ + {0x00c7, 0x00c7, 0x00c7, 0x00c7}, /* LOCK_PLLCNT_START */ + {0x0005, 0x0005, 0x0005, 0x0005}, /* LOCK_PLLCNT_THR */ +}; + +/* [link_rate][swing][emphasis] */ +static int mgnfs_val[4][4][4] = { + /* 1.62Gbps */ + { + {0x0026, 0x001f, 0x0012, 0x0000}, + {0x0013, 0x0013, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 2.7Gbps */ + { + {0x0026, 0x001f, 0x0012, 0x0000}, + {0x0013, 0x0013, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 5.4Gbps */ + { + {0x001f, 0x0013, 0x005, 0x0000}, + {0x0018, 0x006, 0x0000, 0x0000}, + {0x000c, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 8.1Gbps */ + { + {0x0026, 0x0013, 0x005, 0x0000}, + {0x0013, 0x006, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, +}; + +/* [link_rate][swing][emphasis] */ +static int cpost_val[4][4][4] = { + /* 1.62Gbps */ + { + {0x0000, 0x0014, 0x0020, 0x002a}, + {0x0000, 0x0010, 0x001f, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 2.7Gbps */ + { + {0x0000, 0x0014, 0x0020, 0x002a}, + {0x0000, 0x0010, 0x001f, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 5.4Gbps */ + { + {0x0005, 0x0014, 0x0022, 0x002e}, + {0x0000, 0x0013, 0x0020, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 8.1Gbps */ + { + {0x0000, 0x0014, 0x0022, 0x002e}, + {0x0000, 0x0013, 0x0020, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, +}; + +static int pe220x_dp_hw_set_phy_lane_and_rate(struct phytium_dp_device *phytium_dp, + uint8_t link_lane_count, uint32_t link_rate) +{ + int port = phytium_dp->port%2; + int i = 0, data, tmp, tmp1, index = 0, mask = 0; + int timeout = 500, ret = 0; + + /* set pma powerdown */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (A3_POWERDOWN3 << (i * A3_POWERDOWN3_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); + + /* lane pll disable */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) { + data |= (PLL_EN << (i * PLL_EN_SHIFT)); + mask |= (((1<source_max_lane_count; i++) + data |= (PLL_EN << (i * PLL_EN_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_EN(port), data); + + /* set pma power active */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (A0_ACTIVE << (i * A0_ACTIVE_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); + + mask = PLL0_LOCK_DONE; + do { + mdelay(1); + timeout--; + tmp = phytium_phy_readl(phytium_dp, PE220X_PHY_PMA_CONTROL2(port)); + } while ((!(tmp & mask)) && timeout); + + if (timeout == 0) { + DRM_ERROR("dp(%d) phy pll lock failed\n", port); + ret = -1; + } + udelay(1); + + return ret; +} + +static void pe220x_dp_hw_set_phy_lane_setting(struct phytium_dp_device *phytium_dp, + uint32_t link_rate, uint8_t train_set) +{ + int port = phytium_dp->port % 3; + int voltage_swing = 0; + int pre_emphasis = 0, link_rate_index = 0; + + switch (train_set & DP_TRAIN_VOLTAGE_SWING_MASK) { + case DP_TRAIN_VOLTAGE_SWING_LEVEL_1: + voltage_swing = 1; + break; + case DP_TRAIN_VOLTAGE_SWING_LEVEL_2: + voltage_swing = 2; + break; + case DP_TRAIN_VOLTAGE_SWING_LEVEL_3: + voltage_swing = 3; + break; + default: + voltage_swing = 0; + break; + } + + switch (train_set & DP_TRAIN_PRE_EMPHASIS_MASK) { + case DP_TRAIN_PRE_EMPH_LEVEL_1: + pre_emphasis = 1; + break; + case DP_TRAIN_PRE_EMPH_LEVEL_2: + pre_emphasis = 2; + break; + case DP_TRAIN_PRE_EMPH_LEVEL_3: + pre_emphasis = 3; + break; + default: + pre_emphasis = 0; + break; + } + + switch (link_rate) { + case 810000: + link_rate_index = 3; + break; + case 540000: + link_rate_index = 2; + break; + case 270000: + link_rate_index = 1; + break; + case 162000: + link_rate_index = 0; + break; + default: + DRM_ERROR("phytium dp rate(%d) not support\n", link_rate); + link_rate_index = 2; + break; + } + + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DIAG_ACYA(port), LOCK); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_TXCC_CTRL(port), TX_TXCC_CTRL); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DRV(port), TX_DRV); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_MGNFS(port), + mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_CPOST(port), + cpost_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DIAG_ACYA(port), UNLOCK); +} + +static int pe220x_dp_hw_init_phy(struct phytium_dp_device *phytium_dp) +{ + int port = phytium_dp->port; + int i = 0, data, tmp, mask; + int timeout = 500, ret = 0; + + phytium_phy_writel(phytium_dp, PE220X_PHY_APB_RESET(port), APB_RESET); + phytium_phy_writel(phytium_dp, PE220X_PHY_PIPE_RESET(port), RESET); + + /* config lane to dp mode */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (LANE_BIT << (i * LANE_BIT_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_MODE(port), data); + + /* pll clock enable */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (PLL_EN << (i * PLL_EN_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_EN(port), data); + + /* config input 20 bit */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (BIT_20 << (i * BIT_20_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PMA_WIDTH(port), data); + + /* config lane active power state */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (A0_ACTIVE << (i * A0_ACTIVE_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); + + /* link reset */ + phytium_phy_writel(phytium_dp, PE220X_PHY_LINK_RESET(port), LINK_RESET); + + phytium_phy_writel(phytium_dp, PE220X_PHY_SGMII_DPSEL_INIT(port), DP_SEL); + + /* config single link */ + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_CFG(port), SINGLE_LINK); + + /* pipe reset */ + phytium_phy_writel(phytium_dp, PE220X_PHY_PIPE_RESET(port), RESET_DEASSERT); + + mask = PLL0_LOCK_DONE; + do { + mdelay(1); + timeout--; + tmp = phytium_phy_readl(phytium_dp, PE220X_PHY_PMA_CONTROL2(port)); + } while ((!(tmp & mask)) && timeout); + + if (timeout == 0) { + DRM_ERROR("reset dp(%d) phy failed\n", port); + ret = -1; + } + udelay(1); + + return ret; +} + +static void pe220x_dp_hw_poweron_panel(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int ret = 0; + + gpiod_set_value(priv->edp_power_en, 1); + if (ret < 0) + DRM_ERROR("%s: failed to poweron panel\n", __func__); +} + +static void pe220x_dp_hw_poweroff_panel(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int ret = 0; + + gpiod_set_value(priv->edp_power_en, 0); + if (ret < 0) + DRM_ERROR("%s: failed to poweroff panel\n", __func__); +} + +static void pe220x_dp_hw_enable_backlight(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + struct pwm_state state; + int ret = 0; + + pwm_get_state(phytium_dp->pwm, &state); + state.enabled = true; + pwm_set_relative_duty_cycle(&state, 50, 100); + ret = pwm_apply_state(phytium_dp->pwm, &state); + + gpiod_set_value(priv->edp_bl_en, 1); + if (ret < 0) + DRM_ERROR("%s: failed to enable backlight\n", __func__); +} + +static void pe220x_dp_hw_disable_backlight(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int ret = 0; + + gpiod_set_value(priv->edp_bl_en, 0); + if (ret < 0) + DRM_ERROR("%s: failed to disable backlight, ret = %d\n", __func__, ret); +} + +static uint32_t pe220x_dp_hw_get_backlight(struct phytium_dp_device *phytium_dp) +{ + struct pwm_state state; + uint32_t level; + + pwm_get_state(phytium_dp->pwm, &state); + level = pwm_get_relative_duty_cycle(&state, 100); + return level; +} + +static int pe220x_dp_hw_set_backlight(struct phytium_dp_device *phytium_dp, uint32_t level) +{ + struct pwm_state state; + int ret = 0; + + if (level > PE220X_DP_BACKLIGHT_MAX) { + ret = -EINVAL; + goto out; + } + pwm_get_state(phytium_dp->pwm, &state); + state.enabled = true; + state.period = phytium_dp->pwm->args.period; + if (state.period == 0) + DRM_ERROR("%s: set pwm period to 0\n", __func__); + + pwm_set_relative_duty_cycle(&state, level, 100); + + ret = pwm_apply_state(phytium_dp->pwm, &state); + if (ret < 0) + DRM_ERROR("%s: failed to set backlight\n", __func__); +out: + return ret; +} + +bool pe220x_dp_hw_spread_is_enable(struct phytium_dp_device *phytium_dp) +{ + return false; +} + +int pe220x_dp_hw_reset(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, DP_RESET, group_offset, PE220X_DP_CONTROLLER_RESET); + udelay(500); + phytium_writel_reg(priv, AUX_CLK_DIVIDER_100, group_offset, PHYTIUM_DP_AUX_CLK_DIVIDER); + phytium_writel_reg(priv, SUPPORT_EDP_1_4, group_offset, PHYTIUM_EDP_CRC_ENABLE); + + return 0; +} + +uint8_t pe220x_dp_hw_get_source_lane_count(struct phytium_dp_device *phytium_dp) +{ + return pe220x_dp_source_lane_count[phytium_dp->port]; +} + +static struct phytium_dp_func pe220x_dp_funcs = { + .dp_hw_get_source_lane_count = pe220x_dp_hw_get_source_lane_count, + .dp_hw_reset = pe220x_dp_hw_reset, + .dp_hw_spread_is_enable = pe220x_dp_hw_spread_is_enable, + .dp_hw_set_backlight = pe220x_dp_hw_set_backlight, + .dp_hw_get_backlight = pe220x_dp_hw_get_backlight, + .dp_hw_disable_backlight = pe220x_dp_hw_disable_backlight, + .dp_hw_enable_backlight = pe220x_dp_hw_enable_backlight, + .dp_hw_poweroff_panel = pe220x_dp_hw_poweroff_panel, + .dp_hw_poweron_panel = pe220x_dp_hw_poweron_panel, + .dp_hw_init_phy = pe220x_dp_hw_init_phy, + .dp_hw_set_phy_lane_setting = pe220x_dp_hw_set_phy_lane_setting, + .dp_hw_set_phy_lane_and_rate = pe220x_dp_hw_set_phy_lane_and_rate, +}; + +void pe220x_dp_func_register(struct phytium_dp_device *phytium_dp) +{ + phytium_dp->funcs = &pe220x_dp_funcs; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dp.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dp.h new file mode 100644 index 0000000000000000000000000000000000000000..f9cf8a0d4f51d3fa5c589c3ac36f4a8f1751db65 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_dp.h @@ -0,0 +1,15 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium display port DRM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PE220X_DP_H__ +#define __PE220X_DP_H__ + +#define PE220X_DP_BACKLIGHT_MAX 99 +#define PE220X_DP_BACKLIGHT_MIN 2 + +void pe220x_dp_func_register(struct phytium_dp_device *phytium_dp); +#endif /* __PE220X_DP_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_reg.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_reg.h new file mode 100644 index 0000000000000000000000000000000000000000..696be3006734fb5633558e9dde25c78ffdcdfeb0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/pe220x_reg.h @@ -0,0 +1,209 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium Pe220x display engine register + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PE220X_REG_H__ +#define __PE220X_REG_H__ + +#include "phytium_reg.h" + +/* dc register */ +#define PE220X_DC_CLOCK_CONTROL 0x0000 +#define DC1_CORE_RESET (1<<18) +#define DC0_CORE_RESET (1<<17) +#define AXI_RESET (1<<16) +#define AHB_RESET (1<<12) + +#define PE220X_DC_CMD_REGISTER(pipe) (PE220X_DC_BASE(0) + 0x00F0 + 0x4*(pipe)) +#define FLAG_REPLY (1<<31) +#define FLAG_REQUEST (1<<30) +#define CMD_PIXEL_CLOCK (0x0 << 28) +#define CMD_BACKLIGHT (0x1 << 28) +#define CMD_DC_DP_RESET (0x3 << 28) +#define BACKLIGHT_SHIFT 21 +#define BACKLIGHT_MASK 0x7f +#define BACKLIGHT_MAX 100 +#define BACKLIGHT_ENABLE (101 << BACKLIGHT_SHIFT) +#define BACKLIGHT_DISABLE (102 << BACKLIGHT_SHIFT) +#define PANEL_POWER_ENABLE (103 << BACKLIGHT_SHIFT) +#define PANEL_POWER_DISABLE (104 << BACKLIGHT_SHIFT) +#define PIXEL_CLOCK_MASK (0x1fffff) + +#define PE220X_DC_FRAMEBUFFER_Y_HI_ADDRESS 0x1404 +#define PREFIX_MASK 0xff +#define PREFIX_SHIFT 32 + +#define PE220X_DC_CURSOR_HI_ADDRESS 0x1490 +#define CURSOR_PREFIX_MASK 0xff +#define CURSOR_PREFIX_SHIFT 32 + +#define PE220X_DC_FRAMEBUFFER_U_HI_ADDRESS 0x1534 +#define U_PREFIX_MASK 0xff +#define U_PREFIX_SHIFT 32 + +#define PE220X_DC_FRAMEBUFFER_V_HI_ADDRESS 0x153c +#define V_PREFIX_MASK 0xff +#define V_PREFIX_SHIFT 32 + +/* dp register */ +#define PE220X_DP_CONTROLLER_RESET 0x0850 +#define DP_RESET 0x1 + +/* address transform register */ +#define PE220X_DC_ADDRESS_TRANSFORM_SRC_ADDR 0x0 +#define SRC_ADDR_OFFSET 22 +#define SRC_ADDR_MASK 0xffffffffff + +#define PE220X_DC_ADDRESS_TRANSFORM_SIZE 0x4 +#define ADDRESS_TRANSFORM_ENABLE (0x1 << 31) +#define SIZE_OFFSET 22 + +#define PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR 0x8 +#define DST_ADDR_OFFSET 22 + +#define PE220X_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS 0x48 +#define DC_DP_RESET_STATUS(pipe) (1 << pipe) +#define DP_SPREAD_ENABLE(pipe) (0x8 << pipe) + +#define PE220X_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE 0x4c +#define BACKLIGHT_VALUE_MASK (0x7f) +#define BACKLIGHT_VALUE_SHIFT 16 + +/* phy register start */ +#define PE220X_PHY_BASE(pipe) (0x100000*pipe) + +#define PE220X_PHY_PIPE_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40254) +#define RESET 0x0 +#define RESET_DEASSERT 0x1 + +#define PE220X_PHY_MODE(pipe) (PE220X_PHY_BASE(pipe) + 0x40034) +#define LANE_BIT (0x3) +#define LANE_BIT_SHIFT 0x2 + +#define PE220X_PHY_LINK_CFG(pipe) (PE220X_PHY_BASE(pipe) + 0x40044) +#define LANE_MASTER 0x1 +#define LANE_MASTER_SHIFT 1 + +#define PE220X_PHY_PLL_EN(pipe) (PE220X_PHY_BASE(pipe) + 0x40214) +#define PLL_EN 0x1 +#define PLL_EN_SHIFT 1 + +#define PE220X_PHY_PMA_WIDTH(pipe) (PE220X_PHY_BASE(pipe) + 0x4021c) +#define BIT_20 0x5 +#define BIT_20_SHIFT 4 + +#define PE220X_PHY_PLL_SOURCE_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0x4004C) + +#define PE220X_PHY_PMA0_POWER(pipe) (PE220X_PHY_BASE(pipe) + 0x402bc) +#define A0_ACTIVE 0x1 +#define A0_ACTIVE_SHIFT 8 +#define A3_POWERDOWN3 0x8 +#define A3_POWERDOWN3_SHIFT 8 + +#define PE220X_PHY_LINK_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40258) +#define LINK_RESET 0x1 +#define LINK_RESET_MASK 0x1 +#define LINTK_RESET_SHIFT 0x1 + +#define PE220X_PHY_SGMII_DPSEL_INIT(pipe) (PE220X_PHY_BASE(pipe) + 0x40260) +#define DP_SEL 0x1 + +#define PE220X_PHY_APB_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40250) +#define APB_RESET 0x1 + +/* phy origin register */ +#define PE220X_PHY_PLL_CFG(pipe) (PE220X_PHY_BASE(pipe) + 0x30038) +#define SINGLE_LINK 0x0 + +#define PE220X_PHY_PMA_CONTROL(pipe) (PE220X_PHY_BASE(pipe) + 0x3800c) +#define CONTROL_ENABLE 0x1 +#define CONTROL_ENABLE_MASK 0x1 +#define CONTROL_ENABLE_SHIFT 0x1 + +#define PE220X_PHY_PMA_CONTROL2(pipe) (PE220X_PHY_BASE(pipe) + 0x38004) +#define PLL0_LOCK_DONE (0x1 << 6) + +#define PE220X_PHY_PLL0_CLK_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0X684) +#define PLL_LINK_RATE_162000 0xf01 +#define PLL_LINK_RATE_270000 0x701 +#define PLL_LINK_RATE_540000 0x301 +#define PLL_LINK_RATE_810000 0x200 + +#define PE220X_PHY_HSCLK0_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0x18398) +#define HSCLK_LINK_0 0x0 +#define HSCLK_LINK_1 0x1 + +#define PE220X_PHY_HSCLK0_DIV(pipe) (PE220X_PHY_BASE(pipe) + 0x1839c) +#define HSCLK_LINK_RATE_162000 0x2 +#define HSCLK_LINK_RATE_270000 0x1 +#define HSCLK_LINK_RATE_540000 0x0 +#define HSCLK_LINK_RATE_810000 0x0 + +#define PE220X_PHY_PLLDRC0_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x18394) +#define PLLDRC_LINK0 0x1 +#define PLLDRC_LINK1 0x9 + +#define PE220X_PHY_PLL0_DSM_M0(pipe) (PE220X_PHY_BASE(pipe) + 0x250) +#define PLL0_DSM_M0 0x4 +#define PE220X_PHY_PLL0_VCOCAL_START(pipe) (PE220X_PHY_BASE(pipe) + 0x218) +#define PLL0_VCOCAL_START 0xc5e +#define PE220X_PHY_PLL0_VCOCAL_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x208) +#define PLL0_VCOCAL_CTRL 0x3 + +#define PE220X_PHY_PLL0_CP_PADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x690) +#define PE220X_PHY_PLL0_CP_IADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x694) +#define PE220X_PHY_PLL0_CP_FILT_PADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x698) +#define PE220X_PHY_PLL0_INTDIV(pipe) (PE220X_PHY_BASE(pipe) + 0x240) +#define PE220X_PHY_PLL0_FRACDIVL(pipe) (PE220X_PHY_BASE(pipe) + 0x244) +#define PE220X_PHY_PLL0_FRACDIVH(pipe) (PE220X_PHY_BASE(pipe) + 0x248) +#define PE220X_PHY_PLL0_HIGH_THR(pipe) (PE220X_PHY_BASE(pipe) + 0x24c) +#define PE220X_PHY_PLL0_PDIAG_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x680) +#define PE220X_PHY_PLL0_VCOCAL_PLLCNT_START(pipe) (PE220X_PHY_BASE(pipe) + 0x220) +#define PE220X_PHY_PLL0_LOCK_PEFCNT(pipe) (PE220X_PHY_BASE(pipe) + 0x270) +#define PE220X_PHY_PLL0_LOCK_PLLCNT_START(pipe) (PE220X_PHY_BASE(pipe) + 0x278) +#define PE220X_PHY_PLL0_LOCK_PLLCNT_THR(pipe) (PE220X_PHY_BASE(pipe) + 0x27c) + +#define PE220X_PHY_PLL0_TX_PSC_A0(pipe) (PE220X_PHY_BASE(pipe) + 0x18400) +#define PLL0_TX_PSC_A0 0xfb +#define PE220X_PHY_PLL0_TX_PSC_A2(pipe) (PE220X_PHY_BASE(pipe) + 0x18408) +#define PLL0_TX_PSC_A2 0x4aa +#define PE220X_PHY_PLL0_TX_PSC_A3(pipe) (PE220X_PHY_BASE(pipe) + 0x1840c) +#define PLL0_TX_PSC_A3 0x4aa +#define PE220X_PHY_PLL0_RX_PSC_A0(pipe) (PE220X_PHY_BASE(pipe) + 0x28000) +#define PLL0_RX_PSC_A0 0x0 +#define PE220X_PHY_PLL0_RX_PSC_A2(pipe) (PE220X_PHY_BASE(pipe) + 0x28008) +#define PLL0_RX_PSC_A2 0x0 +#define PE220X_PHY_PLL0_RX_PSC_A3(pipe) (PE220X_PHY_BASE(pipe) + 0x2800C) +#define PLL0_RX_PSC_A3 0x0 +#define PE220X_PHY_PLL0_RX_PSC_CAL(pipe) (PE220X_PHY_BASE(pipe) + 0x28018) +#define PLL0_RX_PSC_CAL 0x0 + +#define PE220X_PHY_PLL0_XCVR_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x183a8) +#define PLL0_XCVR_CTRL 0xf + +#define PE220X_PHY_PLL0_RX_GCSM1_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28420) +#define PLL0_RX_GCSM1_CTRL 0x0 +#define PE220X_PHY_PLL0_RX_GCSM2_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28440) +#define PLL0_RX_GCSM2_CTRL 0x0 +#define PE220X_PHY_PLL0_RX_PERGCSM_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28460) +#define PLL0_RX_PERGCSM_CTRL 0x0 + +/* swing and emphasis */ +#define PE220X_PHY_PLL0_TX_DIAG_ACYA(pipe) (PE220X_PHY_BASE(pipe) + 0x1879c) +#define LOCK 1 +#define UNLOCK 0 + +#define PE220X_PHY_PLL0_TX_TXCC_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x18100) +#define TX_TXCC_CTRL 0x8a4 + +#define PE220X_PHY_PLL0_TX_DRV(pipe) (PE220X_PHY_BASE(pipe) + 0x18318) +#define TX_DRV 0x3 + +#define PE220X_PHY_PLL0_TX_MGNFS(pipe) (PE220X_PHY_BASE(pipe) + 0x18140) + +#define PE220X_PHY_PLL0_TX_CPOST(pipe) (PE220X_PHY_BASE(pipe) + 0x18130) + +#endif /* __PE220X_REG_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_crtc.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_crtc.c new file mode 100644 index 0000000000000000000000000000000000000000..2e932418d98138d403393170f092666e88f03649 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_crtc.c @@ -0,0 +1,856 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#if defined(__arm__) || defined(__aarch64__) +#include +#elif defined(__x86_64) +#include +#endif +#include +#include "phytium_display_drv.h" +#include "phytium_crtc.h" +#include "phytium_plane.h" +#include "phytium_dp.h" +#include "px210_dc.h" +#include "pe220x_dc.h" +#include "phytium_reg.h" + +#define MAXKERNELSIZE 9 +#define SUBPIXELINDEXBITS 5 +#define SUBPIXELCOUNT (1 << SUBPIXELINDEXBITS) +#define SUBPIXELLOADCOUNT (SUBPIXELCOUNT / 2 + 1) +#define WEIGHTSTATECOUNT (((SUBPIXELLOADCOUNT * MAXKERNELSIZE + 1) & ~1) / 2) +#define KERNELTABLESIZE (SUBPIXELLOADCOUNT * MAXKERNELSIZE * sizeof(uint16_t)) +#define PHYALIGN(n, align) (((n) + ((align) - 1)) & ~((align) - 1)) +#define KERNELSTATES (PHYALIGN(KERNELTABLESIZE + 4, 8)) +#define PHYPI 3.14159265358979323846f + +#define MATH_Add(X, Y) (float)((X) + (Y)) +#define MATH_Multiply(X, Y) (float)((X) * (Y)) +#define MATH_Divide(X, Y) (float)((X) / (Y)) +#define MATH_DivideFromUInteger(X, Y) ((float)(X) / (float)(Y)) +#define MATH_I2Float(X) (float)(X) + +struct filter_blit_array { + uint8_t kernelSize; + uint32_t scaleFactor; + uint32_t *kernelStates; +}; + +static uint32_t dc_scaling_get_factor(uint32_t src_size, uint32_t dst_size) +{ + uint32_t factor = 0; + + factor = ((src_size - 1) << SCALE_FACTOR_SRC_OFFSET) / (dst_size - 1); + + return factor; +} + +static float dc_sint(float x) +{ + const float B = 1.2732395477; + const float C = -0.4052847346; + const float P = 0.2310792853; + float y; + + if (x < 0) + y = B*x - C*x*x; + else + y = B*x + C*x*x; + if (y < 0) + y = P * (y * (0 - y) - y) + y; + else + y = P * (y * y - y) + y; + return y; +} + +static float dc_sinc_filter(float x, int radius) +{ + float pit, pitd, f1, f2, result; + float f_radius = MATH_I2Float(radius); + + if (x == 0.0f) { + result = 1.0f; + } else if ((x < -f_radius) || (x > f_radius)) { + result = 0.0f; + } else { + pit = MATH_Multiply(PHYPI, x); + pitd = MATH_Divide(pit, f_radius); + f1 = MATH_Divide(dc_sint(pit), pit); + f2 = MATH_Divide(dc_sint(pitd), pitd); + result = MATH_Multiply(f1, f2); + } + + return result; +} + +static int dc_calculate_sync_table( + uint8_t kernel_size, + uint32_t src_size, + uint32_t dst_size, + struct filter_blit_array *kernel_info) +{ + uint32_t scale_factor; + float f_scale; + int kernel_half; + float f_subpixel_step; + float f_subpixel_offset; + uint32_t subpixel_pos; + int kernel_pos; + int padding; + uint16_t *kernel_array; + int range = 0; + + do { + /* Compute the scale factor. */ + scale_factor = dc_scaling_get_factor(src_size, dst_size); + + /* Same kernel size and ratio as before? */ + if ((kernel_info->kernelSize == kernel_size) && + (kernel_info->scaleFactor == kernel_size)) { + break; + } + + /* check the array */ + if (kernel_info->kernelStates == NULL) + break; + + /* Store new parameters. */ + kernel_info->kernelSize = kernel_size; + kernel_info->scaleFactor = scale_factor; + + /* Compute the scale factor. */ + f_scale = MATH_DivideFromUInteger(dst_size, src_size); + + /* Adjust the factor for magnification. */ + if (f_scale > 1.0f) + f_scale = 1.0f; + + /* Calculate the kernel half. */ + kernel_half = (int) (kernel_info->kernelSize >> 1); + + /* Calculate the subpixel step. */ + f_subpixel_step = MATH_Divide(1.0f, MATH_I2Float(SUBPIXELCOUNT)); + + /* Init the subpixel offset. */ + f_subpixel_offset = 0.5f; + + /* Determine kernel padding size. */ + padding = (MAXKERNELSIZE - kernel_info->kernelSize) / 2; + + /* Set initial kernel array pointer. */ + kernel_array = (uint16_t *) (kernel_info->kernelStates + 1); + + /* Loop through each subpixel. */ + for (subpixel_pos = 0; subpixel_pos < SUBPIXELLOADCOUNT; subpixel_pos++) { + /* Define a temporary set of weights. */ + float fSubpixelSet[MAXKERNELSIZE]; + + /* Init the sum of all weights for the current subpixel. */ + float fWeightSum = 0.0f; + uint16_t weightSum = 0; + short int adjustCount, adjustFrom; + short int adjustment; + + /* Compute weights. */ + for (kernel_pos = 0; kernel_pos < MAXKERNELSIZE; kernel_pos++) { + /* Determine the current index. */ + int index = kernel_pos - padding; + + /* Pad with zeros. */ + if ((index < 0) || (index >= kernel_info->kernelSize)) { + fSubpixelSet[kernel_pos] = 0.0f; + } else { + if (kernel_info->kernelSize == 1) { + fSubpixelSet[kernel_pos] = 1.0f; + } else { + /* Compute the x position for filter function. */ + float fX = MATH_Add( + MATH_I2Float(index - kernel_half), + f_subpixel_offset); + fX = MATH_Multiply(fX, f_scale); + + /* Compute the weight. */ + fSubpixelSet[kernel_pos] = dc_sinc_filter(fX, + kernel_half); + } + + /* Update the sum of weights. */ + fWeightSum = MATH_Add(fWeightSum, + fSubpixelSet[kernel_pos]); + } + } + + /* Adjust weights so that the sum will be 1.0. */ + for (kernel_pos = 0; kernel_pos < MAXKERNELSIZE; kernel_pos++) { + /* Normalize the current weight. */ + float fWeight = MATH_Divide(fSubpixelSet[kernel_pos], + fWeightSum); + + /* Convert the weight to fixed point and store in the table. */ + if (fWeight == 0.0f) + kernel_array[kernel_pos] = 0x0000; + else if (fWeight >= 1.0f) + kernel_array[kernel_pos] = 0x4000; + else if (fWeight <= -1.0f) + kernel_array[kernel_pos] = 0xC000; + else + kernel_array[kernel_pos] = + (int16_t) MATH_Multiply(fWeight, 16384.0f); + weightSum += kernel_array[kernel_pos]; + } + + /* Adjust the fixed point coefficients. */ + adjustCount = 0x4000 - weightSum; + if (adjustCount < 0) { + adjustCount = -adjustCount; + adjustment = -1; + } else { + adjustment = 1; + } + + adjustFrom = (MAXKERNELSIZE - adjustCount) / 2; + for (kernel_pos = 0; kernel_pos < adjustCount; kernel_pos++) { + range = (MAXKERNELSIZE*subpixel_pos + adjustFrom + kernel_pos) * + sizeof(uint16_t); + if ((range >= 0) && (range < KERNELTABLESIZE)) + kernel_array[adjustFrom + kernel_pos] += adjustment; + else + DRM_ERROR("%s failed\n", __func__); + } + + kernel_array += MAXKERNELSIZE; + + /* Advance to the next subpixel. */ + f_subpixel_offset = MATH_Add(f_subpixel_offset, -f_subpixel_step); + } + } while (0); + + return 0; +} + +static void phytium_dc_scaling_config(struct drm_crtc *crtc, + struct drm_crtc_state *old_state) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct drm_display_mode *mode = &crtc->state->adjusted_mode; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + uint32_t scale_factor_x, scale_factor_y, i; + uint32_t kernelStates[128]; + struct filter_blit_array kernel_info_width; + void *tmp = NULL; + + if (mode->hdisplay != mode->crtc_hdisplay || mode->vdisplay != mode->crtc_vdisplay) { + phytium_crtc->src_width = mode->hdisplay; + phytium_crtc->src_height = mode->vdisplay; + phytium_crtc->dst_width = mode->crtc_hdisplay; + phytium_crtc->dst_height = mode->crtc_vdisplay; + + phytium_crtc->dst_x = (mode->crtc_hdisplay - phytium_crtc->dst_width) / 2; + phytium_crtc->dst_y = (mode->crtc_vdisplay - phytium_crtc->dst_height) / 2; + + scale_factor_x = dc_scaling_get_factor(phytium_crtc->src_width, + phytium_crtc->dst_width); + scale_factor_y = dc_scaling_get_factor(phytium_crtc->src_height, + phytium_crtc->dst_height); + if (scale_factor_y > (SCALE_FACTOR_Y_MAX << SCALE_FACTOR_SRC_OFFSET)) + scale_factor_y = (SCALE_FACTOR_Y_MAX << SCALE_FACTOR_SRC_OFFSET); + + phytium_writel_reg(priv, scale_factor_x & SCALE_FACTOR_X_MASK, + group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_X); + phytium_writel_reg(priv, scale_factor_y & SCALE_FACTOR_Y_MASK, + group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_Y); + phytium_writel_reg(priv, FRAMEBUFFER_TAP, + group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALECONFIG); + + tmp = kmalloc(KERNELSTATES, GFP_KERNEL); + if (!tmp) { + DRM_ERROR("malloc %ld failed\n", KERNELSTATES); + return; + } + + memset(&kernel_info_width, 0, sizeof(struct filter_blit_array)); + kernel_info_width.kernelStates = tmp; + memset(kernel_info_width.kernelStates, 0, KERNELSTATES); +#if defined(__arm__) || defined(__aarch64__) + kernel_neon_begin(); +#elif defined(__x86_64__) + kernel_fpu_begin(); +#endif + dc_calculate_sync_table(FRAMEBUFFER_HORIZONTAL_FILTER_TAP, + phytium_crtc->src_width, + phytium_crtc->dst_width, + &kernel_info_width); + memset(kernelStates, 0, sizeof(kernelStates)); + memcpy(kernelStates, kernel_info_width.kernelStates + 1, KERNELSTATES - 4); +#if defined(__arm__) || defined(__aarch64__) + kernel_neon_end(); +#elif defined(__x86_64__) + kernel_fpu_end(); +#endif + phytium_writel_reg(priv, HORI_FILTER_INDEX, + group_offset, PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER_INDEX); + for (i = 0; i < 128; i++) { + phytium_writel_reg(priv, kernelStates[i], + group_offset, PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER); + } + + memset(&kernel_info_width, 0, sizeof(struct filter_blit_array)); + kernel_info_width.kernelStates = tmp; + memset(kernel_info_width.kernelStates, 0, KERNELSTATES); +#if defined(__arm__) || defined(__aarch64__) + kernel_neon_begin(); +#elif defined(__x86_64__) + kernel_fpu_begin(); +#endif + dc_calculate_sync_table(FRAMEBUFFER_FILTER_TAP, phytium_crtc->src_height, + phytium_crtc->dst_height, &kernel_info_width); + memset(kernelStates, 0, sizeof(kernelStates)); + memcpy(kernelStates, kernel_info_width.kernelStates + 1, KERNELSTATES - 4); +#if defined(__arm__) || defined(__aarch64__) + kernel_neon_end(); +#elif defined(__x86_64__) + kernel_fpu_end(); +#endif + phytium_writel_reg(priv, VERT_FILTER_INDEX, + group_offset, PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER_INDEX); + for (i = 0; i < 128; i++) + phytium_writel_reg(priv, kernelStates[i], + group_offset, PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER); + phytium_writel_reg(priv, INITIALOFFSET, + group_offset, PHYTIUM_DC_FRAMEBUFFER_INITIALOFFSET); + kfree(tmp); + phytium_crtc->scale_enable = true; + } else { + phytium_crtc->scale_enable = false; + } +} + +static void phytium_crtc_gamma_set(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + uint32_t config = 0, data; + struct drm_crtc_state *state = crtc->state; + struct drm_color_lut *lut; + unsigned long flags; + uint32_t active_line = 0, timeout = 500; + int i; + + if (state->gamma_lut) { + if (WARN((state->gamma_lut->length/sizeof(struct drm_color_lut) != GAMMA_INDEX_MAX), + "gamma size is not match\n")) + return; + lut = (struct drm_color_lut *)state->gamma_lut->data; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + if (config & FRAMEBUFFER_OUTPUT) { + struct drm_display_mode *mode = &state->adjusted_mode; + uint32_t frame_time; + uint32_t value_a, value_b; + + frame_time = mode->crtc_vtotal * mode->crtc_htotal / mode->crtc_clock; + value_b = (frame_time - 2) * mode->crtc_vtotal; + local_irq_save(flags); + do { + active_line = phytium_readl_reg(priv, group_offset, + PHYTIUM_DC_LOCATION); + active_line = active_line >> LOVATION_Y_SHIFT; + value_a = (mode->crtc_vblank_end - mode->crtc_vblank_start + + active_line) * frame_time; + if (value_a < value_b) + break; + local_irq_restore(flags); + udelay(1000); + timeout--; + local_irq_save(flags); + } while (timeout); + + if (timeout == 0) + DRM_ERROR("wait gamma active line timeout\n"); + } + + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DC_GAMMA_INDEX); + for (i = 0; i < GAMMA_INDEX_MAX; i++) { + data = ((lut[i].red >> 6) & GAMMA_RED_MASK) << GAMMA_RED_SHIFT; + data |= (((lut[i].green >> 6) & GAMMA_GREEN_MASK) << GAMMA_GREEN_SHIFT); + data |= (((lut[i].blue >> 6) & GAMMA_BLUE_MASK) << GAMMA_BLUE_SHIFT); + phytium_writel_reg(priv, data, group_offset, PHYTIUM_DC_GAMMA_DATA); + } + + if (config & FRAMEBUFFER_OUTPUT) + local_irq_restore(flags); + } +} + +static void phytium_crtc_gamma_init(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + struct drm_crtc_state *state = crtc->state; + uint32_t config = 0, data; + uint16_t *red, *green, *blue; + unsigned long flags; + uint32_t active_line = 0, timeout = 500; + int i; + + if (WARN((crtc->gamma_size != GAMMA_INDEX_MAX), "gamma size is not match\n")) + return; + + red = crtc->gamma_store; + green = red + crtc->gamma_size; + blue = green + crtc->gamma_size; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + if (config & FRAMEBUFFER_OUTPUT) { + struct drm_display_mode *mode = &state->adjusted_mode; + uint32_t frame_time; + uint32_t value_a, value_b; + + frame_time = mode->crtc_vtotal * mode->crtc_htotal / mode->crtc_clock; + value_b = (frame_time - 2) * mode->crtc_vtotal; + local_irq_save(flags); + do { + active_line = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_LOCATION); + active_line = active_line >> LOVATION_Y_SHIFT; + value_a = (mode->crtc_vblank_end - mode->crtc_vblank_start + + active_line) * frame_time; + if (value_a < value_b) + break; + local_irq_restore(flags); + udelay(1000); + timeout--; + local_irq_save(flags); + } while (timeout); + + if (timeout == 0) + DRM_ERROR("wait gamma active line timeout\n"); + } + + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DC_GAMMA_INDEX); + for (i = 0; i < GAMMA_INDEX_MAX; i++) { + data = ((*red++ >> 6) & GAMMA_RED_MASK) << GAMMA_RED_SHIFT; + data |= (((*green++ >> 6) & GAMMA_GREEN_MASK) << GAMMA_GREEN_SHIFT); + data |= (((*blue++ >> 6) & GAMMA_BLUE_MASK) << GAMMA_BLUE_SHIFT); + phytium_writel_reg(priv, data, group_offset, PHYTIUM_DC_GAMMA_DATA); + } + + if (config & FRAMEBUFFER_OUTPUT) + local_irq_restore(flags); +} + +static void phytium_crtc_destroy(struct drm_crtc *crtc) +{ + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + + drm_crtc_cleanup(crtc); + kfree(phytium_crtc); +} + +struct drm_crtc_state * +phytium_crtc_atomic_duplicate_state(struct drm_crtc *crtc) +{ + struct phytium_crtc_state *phytium_crtc_state = NULL; + + phytium_crtc_state = kmemdup(crtc->state, sizeof(*phytium_crtc_state), + GFP_KERNEL); + if (!phytium_crtc_state) + return NULL; + __drm_atomic_helper_crtc_duplicate_state(crtc, + &phytium_crtc_state->base); + + return &phytium_crtc_state->base; +} + +void +phytium_crtc_atomic_destroy_state(struct drm_crtc *crtc, + struct drm_crtc_state *state) +{ + struct phytium_crtc_state *phytium_crtc_state = + to_phytium_crtc_state(state); + + phytium_crtc_state = to_phytium_crtc_state(state); + __drm_atomic_helper_crtc_destroy_state(state); + kfree(phytium_crtc_state); +} + +static int phytium_enable_vblank(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + + phytium_writel_reg(priv, INT_ENABLE, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_INT_ENABLE); + + return 0; +} + +static void phytium_disable_vblank(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + + phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_INT_ENABLE); +} + +static const struct drm_crtc_funcs phytium_crtc_funcs = { + .gamma_set = drm_atomic_helper_legacy_gamma_set, + .set_config = drm_atomic_helper_set_config, + .destroy = phytium_crtc_destroy, + .page_flip = drm_atomic_helper_page_flip, + .reset = drm_atomic_helper_crtc_reset, + .atomic_duplicate_state = phytium_crtc_atomic_duplicate_state, + .atomic_destroy_state = phytium_crtc_atomic_destroy_state, + .enable_vblank = phytium_enable_vblank, + .disable_vblank = phytium_disable_vblank, +}; + +static void +phytium_crtc_atomic_enable(struct drm_crtc *crtc, + struct drm_crtc_state *old_state) +{ + struct drm_atomic_state *state = old_state->state; + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct drm_display_mode *mode = &crtc->state->adjusted_mode; + struct drm_connector_state *new_conn_state; + struct drm_connector *conn; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + int config = 0, i = 0; + + for_each_new_connector_in_state(state, conn, new_conn_state, i) { + if (new_conn_state->crtc != crtc) + continue; + + switch (conn->display_info.bpc) { + case 10: + phytium_crtc->bpc = DP_RGB101010; + break; + case 6: + phytium_crtc->bpc = DP_RGB666; + break; + default: + phytium_crtc->bpc = DP_RGB888; + break; + } + } + + /* config pix clock */ + phytium_crtc->dc_hw_config_pix_clock(crtc, mode->clock); + + phytium_dc_scaling_config(crtc, old_state); + config = ((mode->crtc_hdisplay & HDISPLAY_END_MASK) << HDISPLAY_END_SHIFT) + | ((mode->crtc_htotal&HDISPLAY_TOTAL_MASK) << HDISPLAY_TOTAL_SHIFT); + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_HDISPLAY); + config = ((mode->crtc_hsync_start & HSYNC_START_MASK) << HSYNC_START_SHIFT) + | ((mode->crtc_hsync_end & HSYNC_END_MASK) << HSYNC_END_SHIFT) + | HSYNC_PULSE_ENABLED; + config |= (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : HSYNC_NEGATIVE; + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_HSYNC); + config = ((mode->crtc_vdisplay & VDISPLAY_END_MASK) << VDISPLAY_END_SHIFT) + | ((mode->crtc_vtotal & VDISPLAY_TOTAL_MASK) << VDISPLAY_TOTAL_SHIFT); + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_VDISPLAY); + config = ((mode->crtc_vsync_start & VSYNC_START_MASK) << VSYNC_START_SHIFT) + | ((mode->crtc_vsync_end & VSYNC_END_MASK) << VSYNC_END_SHIFT) + | VSYNC_PULSE_ENABLED; + config |= (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : VSYNC_NEGATIVE; + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_VSYNC); + config = PANEL_DATAENABLE_ENABLE | PANEL_DATA_ENABLE | PANEL_CLOCK_ENABLE; + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_PANEL_CONFIG); + config = phytium_crtc->bpc | OUTPUT_DP; + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_DP_CONFIG); + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + + if (crtc->state->active) + config |= FRAMEBUFFER_OUTPUT | FRAMEBUFFER_RESET; + else + config &= (~(FRAMEBUFFER_OUTPUT | FRAMEBUFFER_RESET)); + + if (phytium_crtc->scale_enable) + config |= FRAMEBUFFER_SCALE_ENABLE; + else + config &= (~FRAMEBUFFER_SCALE_ENABLE); + + if (!priv->info.bmc_mode) + config |= FRAMEBUFFER_GAMMA_ENABLE; + + if (crtc->state->gamma_lut) + phytium_crtc_gamma_set(crtc); + else + phytium_crtc_gamma_init(crtc); + + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + drm_crtc_vblank_on(crtc); +} + +static void +phytium_crtc_atomic_disable(struct drm_crtc *crtc, + struct drm_crtc_state *old_state) +{ + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + + drm_crtc_vblank_off(crtc); + phytium_crtc->dc_hw_disable(crtc); +} + +static void phytium_crtc_update_timing_for_drm_display_mode(struct drm_display_mode *drm_mode, + const struct drm_display_mode *native_mode) +{ + if (native_mode->clock == drm_mode->clock && + native_mode->htotal == drm_mode->htotal && + native_mode->vtotal == drm_mode->vtotal) { + drm_mode->crtc_hdisplay = native_mode->crtc_hdisplay; + drm_mode->crtc_vdisplay = native_mode->crtc_vdisplay; + drm_mode->crtc_clock = native_mode->crtc_clock; + drm_mode->crtc_hblank_start = native_mode->crtc_hblank_start; + drm_mode->crtc_hblank_end = native_mode->crtc_hblank_end; + drm_mode->crtc_hsync_start = native_mode->crtc_hsync_start; + drm_mode->crtc_hsync_end = native_mode->crtc_hsync_end; + drm_mode->crtc_htotal = native_mode->crtc_htotal; + drm_mode->crtc_hskew = native_mode->crtc_hskew; + drm_mode->crtc_vblank_start = native_mode->crtc_vblank_start; + drm_mode->crtc_vblank_end = native_mode->crtc_vblank_end; + drm_mode->crtc_vsync_start = native_mode->crtc_vsync_start; + drm_mode->crtc_vsync_end = native_mode->crtc_vsync_end; + drm_mode->crtc_vtotal = native_mode->crtc_vtotal; + } +} + +static int +phytium_crtc_atomic_check(struct drm_crtc *crtc, struct drm_crtc_state *crtc_state) +{ + struct drm_atomic_state *state = crtc_state->state; + struct drm_plane_state *new_plane_state = NULL; + int ret = 0; + struct drm_connector *connector; + struct drm_connector_state *new_con_state; + uint32_t i; + struct phytium_dp_device *phytium_dp = NULL; + + for_each_new_connector_in_state(state, connector, new_con_state, i) { + if (new_con_state->crtc == crtc) { + phytium_dp = connector_to_dp_device(connector); + break; + } + } + if (phytium_dp) + phytium_crtc_update_timing_for_drm_display_mode(&crtc_state->adjusted_mode, + &phytium_dp->native_mode); + + new_plane_state = drm_atomic_get_new_plane_state(crtc_state->state, + crtc->primary); + if (crtc_state->enable && new_plane_state && !new_plane_state->crtc) { + ret = -EINVAL; + goto fail; + } + + return 0; +fail: + return ret; +} + +static void +phytium_crtc_atomic_begin(struct drm_crtc *crtc, + struct drm_crtc_state *old_crtc_state) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe, config; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + if (config & FRAMEBUFFER_RESET) { + phytium_writel_reg(priv, config | FRAMEBUFFER_VALID_PENDING, + group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + } +} + +static void phytium_crtc_atomic_flush(struct drm_crtc *crtc, + struct drm_crtc_state *old_crtc_state) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + struct phytium_crtc_state *phytium_crtc_state = NULL; + int phys_pipe = phytium_crtc->phys_pipe, config; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + + DRM_DEBUG_KMS("crtc->state active:%d enable:%d\n", + crtc->state->active, crtc->state->enable); + phytium_crtc_state = to_phytium_crtc_state(crtc->state); + + if (crtc->state->color_mgmt_changed) + phytium_crtc_gamma_set(crtc); + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + phytium_writel_reg(priv, config&(~FRAMEBUFFER_VALID_PENDING), + group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + + if (crtc->state->event) { + DRM_DEBUG_KMS("vblank->refcount:%d\n", + atomic_read(&dev->vblank[0].refcount)); + spin_lock_irq(&dev->event_lock); + if (drm_crtc_vblank_get(crtc) == 0) + drm_crtc_arm_vblank_event(crtc, crtc->state->event); + else + drm_crtc_send_vblank_event(crtc, crtc->state->event); + crtc->state->event = NULL; + spin_unlock_irq(&dev->event_lock); + } +} + +static enum drm_mode_status +phytium_crtc_mode_valid(struct drm_crtc *crtc, const struct drm_display_mode *mode) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + + if (mode->crtc_clock > priv->info.crtc_clock_max) + return MODE_CLOCK_HIGH; + + if (mode->hdisplay > priv->info.hdisplay_max) + return MODE_BAD_HVALUE; + + if (mode->vdisplay > priv->info.vdisplay_max) + return MODE_BAD_VVALUE; + + if (mode->flags & DRM_MODE_FLAG_INTERLACE) + return MODE_NO_INTERLACE; + + return MODE_OK; +} + +static const struct drm_crtc_helper_funcs phytium_crtc_helper_funcs = { + .mode_valid = phytium_crtc_mode_valid, + .atomic_check = phytium_crtc_atomic_check, + .atomic_begin = phytium_crtc_atomic_begin, + .atomic_flush = phytium_crtc_atomic_flush, + .atomic_enable = phytium_crtc_atomic_enable, + .atomic_disable = phytium_crtc_atomic_disable, +}; + +void phytium_crtc_resume(struct drm_device *drm_dev) +{ + struct drm_crtc *crtc; + struct phytium_crtc *phytium_crtc = NULL; + + drm_for_each_crtc(crtc, drm_dev) { + phytium_crtc = to_phytium_crtc(crtc); + if (phytium_crtc->dc_hw_reset) + phytium_crtc->dc_hw_reset(crtc); + phytium_crtc_gamma_init(crtc); + } +} + +int phytium_crtc_init(struct drm_device *dev, int phys_pipe) +{ + struct phytium_crtc *phytium_crtc; + struct phytium_crtc_state *phytium_crtc_state; + struct phytium_plane *phytium_primary_plane = NULL; + struct phytium_plane *phytium_cursor_plane = NULL; + struct drm_plane *cursor_base = NULL; + struct phytium_display_private *priv = dev->dev_private; + int ret; + + phytium_crtc = kzalloc(sizeof(*phytium_crtc), GFP_KERNEL); + if (!phytium_crtc) { + ret = -ENOMEM; + goto failed_malloc_crtc; + } + + phytium_crtc_state = kzalloc(sizeof(*phytium_crtc_state), GFP_KERNEL); + if (!phytium_crtc_state) { + ret = -ENOMEM; + goto failed_malloc_crtc_state; + } + + phytium_crtc_state->base.crtc = &phytium_crtc->base; + phytium_crtc->base.state = &phytium_crtc_state->base; + phytium_crtc->phys_pipe = phys_pipe; + + if (IS_PX210(priv)) { + phytium_crtc->dc_hw_config_pix_clock = px210_dc_hw_config_pix_clock; + phytium_crtc->dc_hw_disable = px210_dc_hw_disable; + phytium_crtc->dc_hw_reset = NULL; + priv->dc_reg_base[phys_pipe] = PX210_DC_BASE(phys_pipe); + priv->dcreq_reg_base[phys_pipe] = PX210_DCREQ_BASE(phys_pipe); + priv->address_transform_base = PX210_ADDRESS_TRANSFORM_BASE; + } else if (IS_PE220X(priv)) { + phytium_crtc->dc_hw_config_pix_clock = pe220x_dc_hw_config_pix_clock; + phytium_crtc->dc_hw_disable = pe220x_dc_hw_disable; + phytium_crtc->dc_hw_reset = pe220x_dc_hw_reset; + priv->dc_reg_base[phys_pipe] = PE220X_DC_BASE(phys_pipe); + priv->dcreq_reg_base[phys_pipe] = 0x0; + priv->address_transform_base = PE220X_ADDRESS_TRANSFORM_BASE; + } + + phytium_primary_plane = phytium_primary_plane_create(dev, phys_pipe); + if (IS_ERR(phytium_primary_plane)) { + ret = PTR_ERR(phytium_primary_plane); + DRM_ERROR("create primary plane failed, phys_pipe(%d)\n", phys_pipe); + goto failed_create_primary; + } + + if (priv->info.bmc_mode) { + cursor_base = NULL; + } else { + phytium_cursor_plane = phytium_cursor_plane_create(dev, phys_pipe); + if (IS_ERR(phytium_cursor_plane)) { + ret = PTR_ERR(phytium_cursor_plane); + DRM_ERROR("create cursor plane failed, phys_pipe(%d)\n", phys_pipe); + goto failed_create_cursor; + } + cursor_base = &phytium_cursor_plane->base; + } + + ret = drm_crtc_init_with_planes(dev, &phytium_crtc->base, + &phytium_primary_plane->base, + cursor_base, + &phytium_crtc_funcs, + "phys_pipe %d", phys_pipe); + + if (ret) { + DRM_ERROR("init crtc with plane failed, phys_pipe(%d)\n", phys_pipe); + goto failed_crtc_init; + } + drm_crtc_helper_add(&phytium_crtc->base, &phytium_crtc_helper_funcs); + drm_crtc_vblank_reset(&phytium_crtc->base); + drm_mode_crtc_set_gamma_size(&phytium_crtc->base, GAMMA_INDEX_MAX); + drm_crtc_enable_color_mgmt(&phytium_crtc->base, 0, false, GAMMA_INDEX_MAX); + if (phytium_crtc->dc_hw_reset) + phytium_crtc->dc_hw_reset(&phytium_crtc->base); + + return 0; + +failed_crtc_init: +failed_create_cursor: + /* drm_mode_config_cleanup() will free any crtcs/planes already initialized */ +failed_create_primary: + kfree(phytium_crtc_state); +failed_malloc_crtc_state: + kfree(phytium_crtc); +failed_malloc_crtc: + return ret; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_crtc.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_crtc.h new file mode 100644 index 0000000000000000000000000000000000000000..8c5b2eb0ec0a25d0ca9df18a3f6684387d8e0a91 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_crtc.h @@ -0,0 +1,39 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_CRTC_H__ +#define __PHYTIUM_CRTC_H__ + +struct phytium_crtc { + struct drm_crtc base; + int phys_pipe; + unsigned int bpc; + + /* scale */ + uint32_t src_width; + uint32_t src_height; + uint32_t dst_width; + uint32_t dst_height; + uint32_t dst_x; + uint32_t dst_y; + bool scale_enable; + bool reserve[3]; + + void (*dc_hw_config_pix_clock)(struct drm_crtc *crtc, int clock); + void (*dc_hw_disable)(struct drm_crtc *crtc); + void (*dc_hw_reset)(struct drm_crtc *crtc); +}; + +struct phytium_crtc_state { + struct drm_crtc_state base; +}; + +#define to_phytium_crtc(x) container_of(x, struct phytium_crtc, base) +#define to_phytium_crtc_state(x) container_of(x, struct phytium_crtc_state, base) + +void phytium_crtc_resume(struct drm_device *drm_dev); +int phytium_crtc_init(struct drm_device *dev, int pipe); +#endif /* __PHYTIUM_CRTC_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_debugfs.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_debugfs.c new file mode 100644 index 0000000000000000000000000000000000000000..8cd6c338d28c0e5efffd1af910399aae767e1222 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_debugfs.c @@ -0,0 +1,456 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_dp.h" +#include "phytium_reg.h" + +const char *const mem_state[PHYTIUM_MEM_STATE_TYPE_COUNT] = { + "Memory_Vram_Total", + "Memory_Vram_Alloc", + "Memory_System_Carveout_Total", + "Memory_System_Carveout_Alloc", + "Memory_System_Alloc", +}; + +static ssize_t +phytium_dp_register_write(struct file *filp, + const char __user *ubuf, + size_t len, + loff_t *ppos) +{ + char tmp[16]; + + if (len >= sizeof(tmp)) + return -EINVAL; + + memset(tmp, 0, sizeof(tmp)); + if (copy_from_user(tmp, ubuf, len)) + return -EFAULT; + tmp[len] = '\0'; + + return len; +} + +static int phytium_dp_register_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_M_VID, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_M_VID)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_N_VID, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_N_VID)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_TRANSFER_UNIT_SIZE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_TRANSFER_UNIT_SIZE)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_DATA_COUNT, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_DATA_COUNT)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HTOTAL, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HTOTAL)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HRES, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HRES)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HSWIDTH, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HSWIDTH)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HSTART, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HSTART)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VTOTAL, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VTOTAL)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VRES, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VRES)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VSWIDTH, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VSWIDTH)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VSTART, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VSTART)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_POLARITY, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_POLARITY)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_MISC0, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_MISC0)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_MISC1, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_MISC1)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_USER_SYNC_POLARITY, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_USER_SYNC_POLARITY)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_VIDEO_STREAM_ENABLE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SECONDARY_STREAM_ENABLE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE)); + seq_puts(m, "audio:\n"); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_INPUT_SELECT, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_INPUT_SELECT)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_DIRECT_CLKDIV, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_DIRECT_CLKDIV)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CHANNEL_COUNT, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CHANNEL_COUNT)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CHANNEL_MAP, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CHANNEL_MAP)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_DATA_WINDOW, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_CATEGORY_CODE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_CATEGORY_CODE)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_MAUD, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_MAUD)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_NAUD, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_NAUD)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CLOCK_MODE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CLOCK_MODE)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_SOURCE_FORMAT, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_SOURCE_FORMAT)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_AUDIO_ENABLE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE)); + + return 0; +} + +static int phytium_dp_register_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_dp_register_show, inode->i_private); +} + +static const struct file_operations phytium_dp_register_fops = { + .owner = THIS_MODULE, + .open = phytium_dp_register_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, + .write = phytium_dp_register_write, +}; + +static ssize_t +phytium_dp_trigger_train_fail_write(struct file *filp, + const char __user *ubuf, + size_t len, + loff_t *ppos) +{ + struct seq_file *m = filp->private_data; + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + char tmp[16]; + + if (len >= sizeof(tmp)) + return -EINVAL; + + memset(tmp, 0, sizeof(tmp)); + if (copy_from_user(tmp, ubuf, len)) + return -EFAULT; + tmp[len] = '\0'; + + if (kstrtouint(tmp, 10, &phytium_dp->trigger_train_fail) != 0) + return -EINVAL; + + return len; +} + +static int phytium_dp_trigger_train_fail_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + seq_printf(m, "trigger_train_fail: %d\n", phytium_dp->trigger_train_fail); + seq_printf(m, "train_retry_count: %d\n", phytium_dp->train_retry_count); + + return 0; +} + +static int phytium_dp_trigger_train_fail_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_dp_trigger_train_fail_show, inode->i_private); +} + +static const struct file_operations phytium_dp_trigger_train_fail_fops = { + .owner = THIS_MODULE, + .open = phytium_dp_trigger_train_fail_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, + .write = phytium_dp_trigger_train_fail_write, +}; + +static int phytium_edp_backlight_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + if (!phytium_dp->is_edp) + return -ENODEV; + + mutex_lock(&phytium_dp->panel.panel_lock); + seq_printf(m, "backlight: %s\n", phytium_dp->panel.backlight_enabled?"enabled":"disabled"); + mutex_unlock(&phytium_dp->panel.panel_lock); + + return 0; +} + +static int phytium_edp_backlight_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_edp_backlight_show, inode->i_private); +} + +static const struct file_operations phytium_edp_backlight_fops = { + .owner = THIS_MODULE, + .open = phytium_edp_backlight_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static int phytium_edp_power_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + if (!phytium_dp->is_edp) + return -ENODEV; + + mutex_lock(&phytium_dp->panel.panel_lock); + seq_printf(m, "power: %s\n", phytium_dp->panel.power_enabled?"enabled":"disabled"); + mutex_unlock(&phytium_dp->panel.panel_lock); + + return 0; +} + +static int phytium_edp_power_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_edp_power_show, inode->i_private); +} + +static const struct file_operations phytium_edp_power_fops = { + .owner = THIS_MODULE, + .open = phytium_edp_power_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +struct dpcd_block { + /* DPCD dump start address. */ + unsigned int offset; + /* DPCD dump end address, inclusive. If unset, .size will be used. */ + unsigned int end; + /* DPCD dump size. Used if .end is unset. If unset, defaults to 1. */ + size_t size; + /* Only valid for eDP. */ + bool edp; +}; + +static const struct dpcd_block phytium_dpcd_debug[] = { + { .offset = DP_DPCD_REV, .size = DP_RECEIVER_CAP_SIZE }, + { .offset = DP_PSR_SUPPORT, .end = DP_PSR_CAPS }, + { .offset = DP_DOWNSTREAM_PORT_0, .size = 16 }, + { .offset = DP_LINK_BW_SET, .end = DP_EDP_CONFIGURATION_SET }, + { .offset = DP_SINK_COUNT, .end = DP_ADJUST_REQUEST_LANE2_3 }, + { .offset = DP_SET_POWER }, + { .offset = DP_EDP_DPCD_REV }, + { .offset = DP_EDP_GENERAL_CAP_1, .end = DP_EDP_GENERAL_CAP_3 }, + { .offset = DP_EDP_DISPLAY_CONTROL_REGISTER, .end = DP_EDP_BACKLIGHT_FREQ_CAP_MAX_LSB }, + { .offset = DP_EDP_DBC_MINIMUM_BRIGHTNESS_SET, .end = DP_EDP_DBC_MAXIMUM_BRIGHTNESS_SET }, + { .offset = DP_DEVICE_SERVICE_IRQ_VECTOR, .size = 1 }, + { .offset = DP_TEST_REQUEST, .end = DP_TEST_PATTERN }, +}; + +static int phytium_dpcd_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + uint8_t buf[16], i; + ssize_t err; + + if (connector->status != connector_status_connected) + return -ENODEV; + + for (i = 0; i < ARRAY_SIZE(phytium_dpcd_debug); i++) { + const struct dpcd_block *b = &phytium_dpcd_debug[i]; + size_t size = b->end ? b->end - b->offset + 1 : (b->size ?: 1); + + if (WARN_ON(size > sizeof(buf))) + continue; + + err = drm_dp_dpcd_read(&phytium_dp->aux, b->offset, buf, size); + if (err <= 0) { + DRM_ERROR("dpcd read (%zu bytes at %u) failed (%zd)\n", + size, b->offset, err); + continue; + } + + seq_printf(m, "%04x: %*ph\n", b->offset, (int) size, buf); + } + + return 0; +} + +static int phytium_dpcd_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_dpcd_show, inode->i_private); +} + +static const struct file_operations phytium_dpcd_fops = { + .owner = THIS_MODULE, + .open = phytium_dpcd_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static ssize_t +phytium_dp_state_write(struct file *filp, + const char __user *ubuf, + size_t len, + loff_t *ppos) +{ + char tmp[16]; + + if (len >= sizeof(tmp)) + return -EINVAL; + + memset(tmp, 0, sizeof(tmp)); + if (copy_from_user(tmp, ubuf, len)) + return -EFAULT; + tmp[len] = '\0'; + + return len; +} + +static int phytium_dp_state_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + seq_printf(m, "port number: %d\n", phytium_dp->port); + seq_printf(m, "source_max_lane_count: %d\n", phytium_dp->source_max_lane_count); + seq_printf(m, "max_source_rates: %d\n", + phytium_dp->source_rates[phytium_dp->num_source_rates-1]); + if (connector->status == connector_status_connected) { + seq_printf(m, "sink_max_lane_count: %d\n", phytium_dp->sink_max_lane_count); + seq_printf(m, "max_sink_rates: %d\n", + phytium_dp->sink_rates[phytium_dp->num_sink_rates-1]); + seq_printf(m, "link_rate: %d\n", phytium_dp->link_rate); + seq_printf(m, "link_lane_count: %d\n", phytium_dp->link_lane_count); + seq_printf(m, "train_set[0]: %d\n", phytium_dp->train_set[0]); + seq_printf(m, "has_audio: %s\n", phytium_dp->has_audio?"yes":"no"); + } + + return 0; +} + +static int phytium_dp_state_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_dp_state_show, inode->i_private); +} + +static const struct file_operations phytium_dp_state_fops = { + .owner = THIS_MODULE, + .open = phytium_dp_state_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, + .write = phytium_dp_state_write, +}; + +static const struct phytium_debugfs_files { + const char *name; + const struct file_operations *fops; +} phytium_debugfs_connector_files[] = { + {"dp_state", &phytium_dp_state_fops}, + {"dpcd", &phytium_dpcd_fops}, + {"dp_register", &phytium_dp_register_fops}, + {"dp_trigger_train_fail", &phytium_dp_trigger_train_fail_fops}, +}; + +static const struct phytium_debugfs_files phytium_edp_debugfs_connector_files[] = { + {"edp_power", &phytium_edp_power_fops}, + {"edp_backlight", &phytium_edp_backlight_fops}, +}; + +int phytium_debugfs_connector_add(struct drm_connector *connector) +{ + struct dentry *root = connector->debugfs_entry; + struct dentry *ent; + int i; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + if (!root) + return -ENODEV; + + for (i = 0; i < ARRAY_SIZE(phytium_debugfs_connector_files); i++) { + ent = debugfs_create_file(phytium_debugfs_connector_files[i].name, + 0644, + root, + connector, + phytium_debugfs_connector_files[i].fops); + if (!ent) + return -ENOMEM; + } + + if (phytium_dp->is_edp) + for (i = 0; i < ARRAY_SIZE(phytium_edp_debugfs_connector_files); i++) { + ent = debugfs_create_file(phytium_edp_debugfs_connector_files[i].name, + 0644, + root, + connector, + phytium_edp_debugfs_connector_files[i].fops); + if (!ent) + return -ENOMEM; + } + + return 0; +} + +static int phytium_mem_state_show(struct seq_file *m, void *data) +{ + struct phytium_display_private *priv = m->private; + uint8_t i; + + for (i = 0; i < ARRAY_SIZE(mem_state); i++) + seq_printf(m, "%-34s %10lld\n", mem_state[i], priv->mem_state[i]); + + return 0; +} + +static int phytium_mem_state_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_mem_state_show, inode->i_private); +} + +static const struct file_operations phytium_mem_state_fops = { + .owner = THIS_MODULE, + .open = phytium_mem_state_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static const struct phytium_debugfs_files phytium_debugfs_display_files[] = { + {"mem_state", &phytium_mem_state_fops}, +}; + +int phytium_debugfs_display_register(struct phytium_display_private *priv) +{ + struct drm_minor *minor = priv->dev->primary; + struct dentry *root = minor->debugfs_root; + struct dentry *ent; + + if (!root) + return -ENODEV; + + ent = debugfs_create_file(phytium_debugfs_display_files[0].name, + 0644, + root, + priv, + phytium_debugfs_display_files[0].fops); + if (!ent) + return -ENOMEM; + + return 0; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_debugfs.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_debugfs.h new file mode 100644 index 0000000000000000000000000000000000000000..7e632bf9c521cc02340b439b9e7e106389e03794 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_debugfs.h @@ -0,0 +1,13 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_DEBUGFS_H__ +#define __PHYTIUM_DEBUGFS_H__ + +int phytium_debugfs_connector_add(struct drm_connector *connector); +int phytium_debugfs_display_register(struct phytium_display_private *priv); + +#endif /* __PHYTIUM_DEBUGFS_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_display_drv.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_display_drv.c new file mode 100644 index 0000000000000000000000000000000000000000..3f0084610fb1a043dee53da9c5dfdcbb9cfe25ae --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_display_drv.c @@ -0,0 +1,475 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_plane.h" +#include "phytium_crtc.h" +#include "phytium_dp.h" +#include "phytium_gem.h" +#include "phytium_fb.h" +#include "phytium_fbdev.h" +#include "phytium_reg.h" +#include "phytium_pci.h" +#include "phytium_platform.h" +#include "phytium_debugfs.h" + +int dc_fake_mode_enable; +module_param(dc_fake_mode_enable, int, 0644); +MODULE_PARM_DESC(dc_fake_mode_enable, "Enable DC fake mode (0-disabled; 1-enabled; default-0)"); + +int dc_fast_training_check = 1; +module_param(dc_fast_training_check, int, 0644); +MODULE_PARM_DESC(dc_fast_training_check, "Check dp fast training (0-disabled; 1-enabled; default-1)"); + +int num_source_rates = 4; +module_param(num_source_rates, int, 0644); +MODULE_PARM_DESC(num_source_rates, "set the source max rates (1-1.62Gbps; 2-2.7Gbps; 3-5.4Gbps; 4-8.1Gbps; default-4)"); + +int source_max_lane_count = 4; +module_param(source_max_lane_count, int, 0644); +MODULE_PARM_DESC(source_max_lane_count, "set the source lane count (1-1lane; 2-2lane; 4-4lane; default-4)"); + +int link_dynamic_adjust; +module_param(link_dynamic_adjust, int, 0644); +MODULE_PARM_DESC(link_dynamic_adjust, "dynamic select the train pamameter according to the display mode (0-disabled; 1-enabled; default-1)"); + +int phytium_wait_cmd_done(struct phytium_display_private *priv, + uint32_t register_offset, + uint32_t request_bit, + uint32_t reply_bit) +{ + int timeout = 1000, config = 0, ret = 0; + + do { + mdelay(1); + timeout--; + config = phytium_readl_reg(priv, 0, register_offset); + } while ((!(config & reply_bit)) && timeout); + + phytium_writel_reg(priv, config & (~request_bit), 0, register_offset); + + if (timeout == 0) { + DRM_ERROR("wait cmd reply timeout\n"); + ret = -EBUSY; + } else { + timeout = 500; + do { + mdelay(1); + timeout--; + config = phytium_readl_reg(priv, 0, register_offset); + } while ((config & reply_bit) && timeout); + if (timeout == 0) { + DRM_ERROR("clear cmd timeout\n"); + ret = -EBUSY; + } + } + mdelay(5); + + return ret; +} + +static void phytium_irq_preinstall(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + int i, status; + + for_each_pipe_masked(priv, i) { + status = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); + phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[i], PHYTIUM_DC_INT_ENABLE); + } +} + +static void phytium_irq_uninstall(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + int i, status; + + for_each_pipe_masked(priv, i) { + status = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); + phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[i], PHYTIUM_DC_INT_ENABLE); + } +} + +static irqreturn_t phytium_display_irq_handler(int irq, void *data) +{ + struct drm_device *dev = data; + struct phytium_display_private *priv = dev->dev_private; + bool enabled = 0; + int i = 0, virt_pipe = 0; + irqreturn_t ret = IRQ_NONE, ret1 = IRQ_NONE; + + for_each_pipe_masked(priv, i) { + enabled = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); + if (enabled & INT_STATUS) { + virt_pipe = phytium_get_virt_pipe(priv, i); + if (virt_pipe < 0) + return IRQ_NONE; + drm_handle_vblank(dev, virt_pipe); + ret = IRQ_HANDLED; + if (priv->dc_hw_clear_msi_irq) + priv->dc_hw_clear_msi_irq(priv, i); + } + } + + ret1 = phytium_dp_hpd_irq_handler(priv); + if (ret == IRQ_HANDLED || ret1 == IRQ_HANDLED) + return IRQ_HANDLED; + + return IRQ_NONE; +} + +static const struct drm_mode_config_funcs phytium_mode_funcs = { + .fb_create = phytium_fb_create, + .output_poll_changed = drm_fb_helper_output_poll_changed, + .atomic_check = drm_atomic_helper_check, + .atomic_commit = drm_atomic_helper_commit, +}; + +static void phytium_atomic_commit_tail(struct drm_atomic_state *state) +{ + struct drm_device *dev = state->dev; + + drm_atomic_helper_commit_modeset_disables(dev, state); + drm_atomic_helper_commit_planes(dev, state, false); + drm_atomic_helper_commit_modeset_enables(dev, state); + drm_atomic_helper_commit_hw_done(state); + drm_atomic_helper_wait_for_flip_done(dev, state); + drm_atomic_helper_cleanup_planes(dev, state); +} + +static struct drm_mode_config_helper_funcs phytium_mode_config_helpers = { + .atomic_commit_tail = phytium_atomic_commit_tail, +}; + +static int phytium_modeset_init(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + int i = 0, ret; + + drm_mode_config_init(dev); + dev->mode_config.min_width = 0; + dev->mode_config.min_height = 0; + dev->mode_config.max_width = 16384; + dev->mode_config.max_height = 16384; + dev->mode_config.cursor_width = 32; + dev->mode_config.cursor_height = 32; + + dev->mode_config.preferred_depth = 24; + dev->mode_config.prefer_shadow = 1; + dev->mode_config.allow_fb_modifiers = true; + + dev->mode_config.funcs = &phytium_mode_funcs; + dev->mode_config.helper_private = &phytium_mode_config_helpers; + + for_each_pipe_masked(priv, i) { + ret = phytium_crtc_init(dev, i); + if (ret) { + DRM_ERROR("phytium_crtc_init(pipe %d) return failed\n", i); + goto failed_crtc_init; + } + } + + for_each_pipe_masked(priv, i) { + ret = phytium_dp_init(dev, i); + if (ret) { + DRM_ERROR("phytium_dp_init(pipe %d) return failed\n", i); + goto failed_dp_init; + } + } + + drm_mode_config_reset(dev); + + return 0; +failed_dp_init: +failed_crtc_init: + drm_mode_config_cleanup(dev); + return ret; +} + +int phytium_get_virt_pipe(struct phytium_display_private *priv, int phys_pipe) +{ + int i = 0; + int virt_pipe = 0; + + for_each_pipe_masked(priv, i) { + if (i != phys_pipe) + virt_pipe++; + else + return virt_pipe; + } + + DRM_ERROR("%s %d failed\n", __func__, phys_pipe); + return -EINVAL; +} + +int phytium_get_phys_pipe(struct phytium_display_private *priv, int virt_pipe) +{ + int i = 0; + int tmp = 0; + + for_each_pipe_masked(priv, i) { + if (tmp != virt_pipe) + tmp++; + else + return i; + } + + DRM_ERROR("%s %d failed\n", __func__, virt_pipe); + return -EINVAL; +} + +static int phytium_display_load(struct drm_device *dev, unsigned long flags) +{ + struct phytium_display_private *priv = dev->dev_private; + int ret = 0; + + ret = drm_vblank_init(dev, priv->info.num_pipes); + if (ret) { + DRM_ERROR("vblank init failed\n"); + goto failed_vblank_init; + } + + ret = phytium_modeset_init(dev); + if (ret) { + DRM_ERROR("phytium_modeset_init failed\n"); + goto failed_modeset_init; + } + + if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) + priv->vram_hw_init(priv); + + ret = drm_irq_install(dev, priv->irq); + if (ret) { + DRM_ERROR("install irq failed\n"); + goto failed_irq_install; + } + + ret = phytium_drm_fbdev_init(dev); + if (ret) + DRM_ERROR("failed to init dev\n"); + + phytium_debugfs_display_register(priv); + + return ret; + +failed_irq_install: + drm_mode_config_cleanup(dev); +failed_modeset_init: +failed_vblank_init: + return ret; +} + +static void phytium_display_unload(struct drm_device *dev) +{ + phytium_drm_fbdev_fini(dev); + drm_irq_uninstall(dev); + drm_mode_config_cleanup(dev); +} + +static const struct vm_operations_struct phytium_vm_ops = { + .open = drm_gem_vm_open, + .close = drm_gem_vm_close, +}; + +/* phytium display specific ioctls + * The device specific ioctl range is 0x40 to 0x79. + */ +#define DRM_PHYTIUM_VRAM_TYPE_DEVICE 0x0 +#define DRM_PHYTIUM_BMC_DEVICE 0x1 +#define DRM_IOCTL_PHYTIUM_VRAM_TYPE_DEVICE DRM_IO(DRM_COMMAND_BASE\ + + DRM_PHYTIUM_VRAM_TYPE_DEVICE) +#define DRM_IOCTL_PHYTIUM_IS_BMC_DEVICE DRM_IO(DRM_COMMAND_BASE\ + + DRM_PHYTIUM_BMC_DEVICE) + +static int phytium_ioctl_check_vram_device(struct drm_device *dev, void *data, + struct drm_file *file_priv) +{ + struct phytium_display_private *priv = dev->dev_private; + + return ((priv->support_memory_type == MEMORY_TYPE_VRAM_DEVICE) ? 1 : 0); +} + +static int phytium_ioctl_check_bmc_device(struct drm_device *dev, void *data, + struct drm_file *file_priv) +{ + struct phytium_display_private *priv = dev->dev_private; + + return priv->info.bmc_mode ? 1 : 0; +} + +static const struct drm_ioctl_desc phytium_ioctls[] = { + /* for test, none so far */ + DRM_IOCTL_DEF_DRV(PHYTIUM_VRAM_TYPE_DEVICE, phytium_ioctl_check_vram_device, + DRM_AUTH|DRM_UNLOCKED), + DRM_IOCTL_DEF_DRV(PHYTIUM_IS_BMC_DEVICE, phytium_ioctl_check_bmc_device, + DRM_AUTH|DRM_UNLOCKED), +}; + +static const struct file_operations phytium_drm_driver_fops = { + .owner = THIS_MODULE, + .open = drm_open, + .release = drm_release, + .unlocked_ioctl = drm_ioctl, + .compat_ioctl = drm_compat_ioctl, + .poll = drm_poll, + .read = drm_read, + .llseek = no_llseek, + .mmap = phytium_gem_mmap, +}; + +struct drm_driver phytium_display_drm_driver = { + .driver_features = DRIVER_HAVE_IRQ | + DRIVER_MODESET | + DRIVER_ATOMIC | + DRIVER_GEM, + .load = phytium_display_load, + .unload = phytium_display_unload, + .lastclose = drm_fb_helper_lastclose, + .irq_handler = phytium_display_irq_handler, + .irq_preinstall = phytium_irq_preinstall, + .irq_uninstall = phytium_irq_uninstall, + .prime_handle_to_fd = drm_gem_prime_handle_to_fd, + .prime_fd_to_handle = drm_gem_prime_fd_to_handle, + .gem_prime_export = drm_gem_prime_export, + .gem_prime_import = drm_gem_prime_import, + .gem_prime_import_sg_table = phytium_gem_prime_import_sg_table, + .gem_prime_mmap = phytium_gem_prime_mmap, + .dumb_create = phytium_gem_dumb_create, + .dumb_destroy = phytium_gem_dumb_destroy, + .ioctls = phytium_ioctls, + .num_ioctls = ARRAY_SIZE(phytium_ioctls), + .fops = &phytium_drm_driver_fops, + .name = DRV_NAME, + .desc = DRV_DESC, + .date = DRV_DATE, + .major = DRV_MAJOR, + .minor = DRV_MINOR, +}; + +static void phytium_display_shutdown(struct drm_device *dev) +{ + drm_atomic_helper_shutdown(dev); +} + +static int phytium_display_pm_suspend(struct drm_device *dev) +{ + struct drm_atomic_state *state; + struct phytium_display_private *priv = dev->dev_private; + int ret, ret1; + + phytium_dp_hpd_irq_setup(dev, false); + cancel_work_sync(&priv->hotplug_work); + drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 1); + state = drm_atomic_helper_suspend(dev); + if (IS_ERR(state)) { + DRM_ERROR("drm_atomic_helper_suspend failed: %ld\n", PTR_ERR(state)); + ret = PTR_ERR(state); + goto suspend_failed; + } + dev->mode_config.suspend_state = state; + ret = phytium_gem_suspend(dev); + if (ret) { + DRM_ERROR("phytium_gem_suspend failed: %d\n", ret); + goto gem_suspend_failed; + } + + return 0; + +gem_suspend_failed: + ret1 = drm_atomic_helper_resume(dev, dev->mode_config.suspend_state); + if (ret1) + DRM_ERROR("Failed to resume (%d)\n", ret1); + dev->mode_config.suspend_state = NULL; +suspend_failed: + drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 0); + phytium_dp_hpd_irq_setup(dev, true); + + return ret; +} + +static int phytium_display_pm_resume(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + int ret = 0; + + if (WARN_ON(!dev->mode_config.suspend_state)) + return -EINVAL; + + ret = phytium_dp_resume(dev); + if (ret) + return -EIO; + + phytium_crtc_resume(dev); + phytium_gem_resume(dev); + + if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) + priv->vram_hw_init(priv); + + ret = drm_atomic_helper_resume(dev, dev->mode_config.suspend_state); + if (ret) { + DRM_ERROR("Failed to resume (%d)\n", ret); + return ret; + } + + dev->mode_config.suspend_state = NULL; + drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 0); + phytium_dp_hpd_irq_setup(dev, true); + + return 0; +} + +void phytium_display_private_init(struct phytium_display_private *priv, struct drm_device *dev) +{ + INIT_LIST_HEAD(&priv->gem_list_head); + spin_lock_init(&priv->hotplug_irq_lock); + INIT_WORK(&priv->hotplug_work, phytium_dp_hpd_work_func); + memset(priv->mem_state, 0, sizeof(priv->mem_state)); + priv->dev = dev; + priv->display_shutdown = phytium_display_shutdown; + priv->display_pm_suspend = phytium_display_pm_suspend; + priv->display_pm_resume = phytium_display_pm_resume; +} + +static int __init phytium_display_init(void) +{ + int ret = 0; + + ret = platform_driver_register(&phytium_platform_driver); + if (ret) + return ret; + + ret = pci_register_driver(&phytium_pci_driver); + + return ret; +} + +static void __exit phytium_display_exit(void) +{ + pci_unregister_driver(&phytium_pci_driver); + + platform_driver_unregister(&phytium_platform_driver); +} + +module_init(phytium_display_init); +module_exit(phytium_display_exit); + +MODULE_LICENSE("GPL"); +MODULE_VERSION(DC_DRIVER_VERSION); +MODULE_AUTHOR("Yang Xun "); +MODULE_AUTHOR("Shaojun Yang "); +MODULE_DESCRIPTION("Phytium Display Controller"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_display_drv.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_display_drv.h new file mode 100644 index 0000000000000000000000000000000000000000..e15fc6aba2ac7bd52b81deb9b3a4d102b1680bac --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_display_drv.h @@ -0,0 +1,187 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_DISPLAY_DRV_H__ +#define __PHYTIUM_DISPLAY_DRV_H__ + +#include +#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) +#include +#endif +#include +#include +#include + +#define DEBUG_LOG 0 + +#define PHYTIUM_FORMAT_MAX_PLANE 3 +#define DP_MAX_DOWNSTREAM_PORTS 0x10 + +#define DRV_NAME "dc" +#define DRV_DESC "phytium dc" +#define DRV_DATE "20201220" +#define DRV_MAJOR 1 +#define DRV_MINOR 1 +#define DC_DRIVER_VERSION "1.0.0" + +/* come from GPU */ +#define DRM_FORMAT_MOD_VENDOR_PHYTIUM 0x92 + +/* dc:mode0 8x8 16bpp gpu: FBCDC_8X8_V10 */ +#define DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC fourcc_mod_code(PHYTIUM, 21) +/* dc:mode3 8x4 32bpp gpu: FBCDC_16X4_v10 */ +#define DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC fourcc_mod_code(PHYTIUM, 22) + +#define PIPE_MASK_SHIFT 0x0 +#define PIPE_MASK_MASK 0x7 +#define EDP_MASK_SHIFT 0x3 +#define EDP_MASK_MASK 0x7 + +enum phytium_platform { + PHYTIUM_PLATFORM_UNINITIALIZED = 0, + PHYTIUM_PLATFORM_PX210, + PHYTIUM_PLATFORM_PE220X, +}; + +enum phytium_mem_state_type { + PHYTIUM_MEM_VRAM_TOTAL = 0, + PHYTIUM_MEM_VRAM_ALLOC, + PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL, + PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC, + PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC, + PHYTIUM_MEM_STATE_TYPE_COUNT, +}; + +#define MEMORY_TYPE_VRAM_WC 0x1 +#define MEMORY_TYPE_SYSTEM_CARVEOUT 0x2 +#define MEMORY_TYPE_SYSTEM_UNIFIED 0x4 +#define MEMORY_TYPE_VRAM_DEVICE 0x8 + +#define IS_PLATFORM(priv, p) ((priv)->info.platform_mask & BIT(p)) + +#define IS_PX210(priv) IS_PLATFORM(priv, PHYTIUM_PLATFORM_PX210) +#define IS_PE220X(priv) IS_PLATFORM(priv, PHYTIUM_PLATFORM_PE220X) + +struct phytium_device_info { + unsigned char platform_mask; + unsigned char pipe_mask; + unsigned char num_pipes; + unsigned char total_pipes; + unsigned char edp_mask; + bool bmc_mode; + unsigned char reserve[2]; + unsigned int crtc_clock_max; + unsigned int hdisplay_max; + unsigned int vdisplay_max; + unsigned int backlight_max; + unsigned int backlight_min; + unsigned long address_mask; + struct pwm_device *pwm; +}; + +struct phytium_display_private { + /* hw */ + void __iomem *regs; + void __iomem *vram_addr; + struct phytium_device_info info; + char support_memory_type; + char reserve[3]; + uint32_t dc_reg_base[3]; + uint32_t dcreq_reg_base[3]; + uint32_t dp_reg_base[3]; + uint32_t address_transform_base; + uint32_t phy_access_base[3]; + + /* drm */ + struct drm_device *dev; + int irq; + + /* fb_dev */ + struct drm_fb_helper fbdev_helper; + struct phytium_gem_object *fbdev_phytium_gem; + + int save_reg[3]; + struct list_head gem_list_head; + + struct work_struct hotplug_work; + spinlock_t hotplug_irq_lock; + + void (*vram_hw_init)(struct phytium_display_private *priv); + void (*display_shutdown)(struct drm_device *dev); + int (*display_pm_suspend)(struct drm_device *dev); + int (*display_pm_resume)(struct drm_device *dev); + void (*dc_hw_clear_msi_irq)(struct phytium_display_private *priv, uint32_t phys_pipe); + int (*dc_hw_fb_format_check)(const struct drm_mode_fb_cmd2 *mode_cmd, int count); + + struct gen_pool *memory_pool; + resource_size_t pool_phys_addr; + resource_size_t pool_size; + void *pool_virt_addr; + uint64_t mem_state[PHYTIUM_MEM_STATE_TYPE_COUNT]; + + /* DMA info */ + int dma_inited; + struct dma_chan *dma_chan; + /*BL GPIO info*/ + struct gpio_desc *edp_bl_en, *edp_power_en; +}; + +static inline unsigned int +phytium_readl_reg(struct phytium_display_private *priv, uint32_t group_offset, uint32_t reg_offset) +{ + unsigned int data; + + data = readl(priv->regs + group_offset + reg_offset); +#if DEBUG_LOG + pr_info("Read 32'h%08x 32'h%08x\n", group_offset + reg_offset, data); +#endif + return data; +} + +static inline void +phytium_writel_reg(struct phytium_display_private *priv, uint32_t data, + uint32_t group_offset, uint32_t reg_offset) +{ + + writel(data, priv->regs + group_offset + reg_offset); +#if DEBUG_LOG + pr_info("Write 32'h%08x 32'h%08x\n", group_offset + reg_offset, data); +#endif +} + +static inline void +phytium_writeb_reg(struct phytium_display_private *priv, uint8_t data, + uint32_t group_offset, uint32_t reg_offset) +{ + writeb(data, priv->regs + group_offset + reg_offset); +#if DEBUG_LOG + pr_info("Write 32'h%08x 8'h%08x\n", group_offset + reg_offset, data); +#endif +} + +#define for_each_pipe(__dev_priv, __p) \ + for ((__p) = 0; (__p) < __dev_priv->info.total_pipes; (__p)++) + +#define for_each_pipe_masked(__dev_priv, __p) \ + for ((__p) = 0; (__p) < __dev_priv->info.total_pipes; (__p)++) \ + for_each_if((__dev_priv->info.pipe_mask) & BIT(__p)) + +int phytium_get_virt_pipe(struct phytium_display_private *priv, int phys_pipe); +int phytium_get_phys_pipe(struct phytium_display_private *priv, int virt_pipe); +int phytium_wait_cmd_done(struct phytium_display_private *priv, + uint32_t register_offset, + uint32_t request_bit, + uint32_t reply_bit); +void phytium_display_private_init(struct phytium_display_private *priv, struct drm_device *dev); + +extern struct drm_driver phytium_display_drm_driver; +extern int dc_fake_mode_enable; +extern int dc_fast_training_check; +extern int num_source_rates; +extern int source_max_lane_count; +extern int link_dynamic_adjust; + +#endif /* __PHYTIUM_DISPLAY_DRV_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_dp.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_dp.c new file mode 100644 index 0000000000000000000000000000000000000000..92ad326d06fbbb7e6518be5f628e1613e4f7ed7f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_dp.c @@ -0,0 +1,2666 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) +#include +#endif +#include "phytium_display_drv.h" +#include "phytium_dp.h" +#include "phytium_debugfs.h" +#include "px210_dp.h" +#include "pe220x_dp.h" +#include "phytium_panel.h" +#include "phytium_reg.h" + +static void phytium_dp_aux_init(struct phytium_dp_device *phytium_dp); +static void handle_plugged_change(struct phytium_dp_device *phytium_dp, bool plugged); +static bool phytium_edp_init_connector(struct phytium_dp_device *phytium_dp); +static void phytium_edp_fini_connector(struct phytium_dp_device *phytium_dp); +static void phytium_edp_panel_poweroff(struct phytium_dp_device *phytium_dp); +static void phytium_dp_audio_codec_fini(struct phytium_dp_device *phytium_dp); + +static int phytium_rate[] = {162000, 270000, 540000, 810000}; +static int codec_id = PHYTIUM_DP_AUDIO_ID; + +void phytium_phy_writel(struct phytium_dp_device *phytium_dp, uint32_t address, uint32_t data) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->phy_access_base[port]; + +#if DEBUG_LOG + pr_info("phy address write: 0x%x data:0x%x\n", address, data); +#endif + phytium_writel_reg(priv, address, group_offset, PHYTIUM_PHY_ACCESS_ADDRESS); + phytium_writel_reg(priv, data, group_offset, PHYTIUM_PHY_WRITE_DATA); + phytium_writel_reg(priv, ACCESS_WRITE, group_offset, PHYTIUM_PHY_ACCESS_CTRL); + udelay(10); +} + +uint32_t phytium_phy_readl(struct phytium_dp_device *phytium_dp, uint32_t address) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->phy_access_base[port]; + uint32_t data; + + phytium_writel_reg(priv, address, group_offset, PHYTIUM_PHY_ACCESS_ADDRESS); + phytium_writel_reg(priv, ACCESS_READ, group_offset, PHYTIUM_PHY_ACCESS_CTRL); + udelay(10); + data = phytium_readl_reg(priv, group_offset, PHYTIUM_PHY_READ_DATA); +#if DEBUG_LOG + pr_info("phy address read: 0x%x data:0x%x\n", address, data); +#endif + + return data; +} + +static int +phytium_dp_hw_aux_transfer_write(struct phytium_dp_device *phytium_dp, struct drm_dp_aux_msg *msg) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + unsigned int i = 0, j = 0; + unsigned int cmd = 0; + unsigned int aux_status = 0, interrupt_status = 0; + unsigned char *data = msg->buffer; + int count_timeout = 0; + long ret = 0; + + for (i = 0; i < 3; i++) { + /* clear PX210_DP_INTERRUPT_RAW_STATUS */ + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); + phytium_writel_reg(priv, msg->address, group_offset, PHYTIUM_DP_AUX_ADDRESS); + for (j = 0; j < msg->size; j++) + phytium_writeb_reg(priv, data[j], group_offset, PHYTIUM_DP_AUX_WRITE_FIFO); + + cmd = ((msg->request & COMMAND_MASK) << COMMAND_SHIFT); + if (msg->size == 0) + cmd |= ADDRESS_ONLY; + else + cmd |= (msg->size-1) & BYTE_COUNT_MASK; + phytium_writel_reg(priv, cmd, group_offset, PHYTIUM_DP_AUX_COMMAND); + + count_timeout = 0; + do { + mdelay(5); + interrupt_status = phytium_readl_reg(priv, group_offset, + PHYTIUM_DP_INTERRUPT_RAW_STATUS); + aux_status = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_STATUS); + if ((aux_status & REPLY_RECEIVED) || (aux_status & REPLY_ERROR) + || (interrupt_status & REPLY_TIMEOUT)) { + DRM_DEBUG_KMS("aux wait exit\n"); + break; + } + count_timeout++; + } while (count_timeout < 6); + + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); + if (interrupt_status & REPLY_TIMEOUT) { + DRM_DEBUG_KMS("aux write reply timeout\n"); + continue; + } else if (aux_status & REPLY_ERROR) { + DRM_DEBUG_KMS("aux write reply error\n"); + continue; + } else if (aux_status & REPLY_RECEIVED) { + DRM_DEBUG_KMS("aux write reply received succussful\n"); + break; + } + } + + if (interrupt_status & REPLY_TIMEOUT) { + DRM_NOTE("aux(%d) write reply timeout\n", phytium_dp->port); + ret = -EIO; + goto out; + } else if (aux_status & REPLY_ERROR) { + DRM_ERROR("aux(%d) write reply error\n", phytium_dp->port); + ret = -EIO; + goto out; + } else if ((aux_status & REPLY_RECEIVED) != REPLY_RECEIVED) { + DRM_ERROR("aux(%d) write reply no response\n", phytium_dp->port); + ret = -EIO; + goto out; + } + + msg->reply = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_CODE); + ret = msg->size; +out: + return ret; +} + +static int +phytium_dp_hw_aux_transfer_read(struct phytium_dp_device *phytium_dp, struct drm_dp_aux_msg *msg) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + unsigned int i = 0; + unsigned int cmd = 0; + unsigned int aux_status = 0, interrupt_status = 0; + unsigned char *data = msg->buffer; + int count_timeout = 0; + long ret = 0; + + for (i = 0; i < 3; i++) { + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); + phytium_writel_reg(priv, msg->address, group_offset, PHYTIUM_DP_AUX_ADDRESS); + cmd = ((msg->request & COMMAND_MASK) << COMMAND_SHIFT); + if (msg->size == 0) + cmd |= ADDRESS_ONLY; + else + cmd |= ((msg->size-1) & BYTE_COUNT_MASK); + phytium_writel_reg(priv, cmd, group_offset, PHYTIUM_DP_AUX_COMMAND); + + count_timeout = 0; + do { + mdelay(5); + interrupt_status = phytium_readl_reg(priv, group_offset, + PHYTIUM_DP_INTERRUPT_RAW_STATUS); + aux_status = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_STATUS); + if ((aux_status & REPLY_RECEIVED) || (aux_status & REPLY_ERROR) + || (interrupt_status & REPLY_TIMEOUT)) { + DRM_DEBUG_KMS("aux wait exit\n"); + break; + } + count_timeout++; + } while (count_timeout < 6); + + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); + if (interrupt_status & REPLY_TIMEOUT) { + DRM_DEBUG_KMS("aux read reply timeout\n"); + continue; + } else if (aux_status & REPLY_ERROR) { + DRM_DEBUG_KMS("aux read reply error\n"); + continue; + } else if (aux_status & REPLY_RECEIVED) { + DRM_DEBUG_KMS("aux read reply received succussful\n"); + break; + } + } + + if (interrupt_status & REPLY_TIMEOUT) { + DRM_NOTE("aux(%d) read reply timeout\n", phytium_dp->port); + ret = -EIO; + goto out; + } else if (aux_status & REPLY_ERROR) { + DRM_ERROR("aux(%d) read reply error\n", phytium_dp->port); + ret = -EIO; + goto out; + } else if ((aux_status & REPLY_RECEIVED) != REPLY_RECEIVED) { + DRM_ERROR("aux(%d) read reply no response\n", phytium_dp->port); + ret = -EIO; + goto out; + } + + msg->reply = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_CODE); + ret = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_DATA_COUNT); + + if (ret > msg->size) { + ret = msg->size; + } else if (ret != msg->size) { + DRM_DEBUG_KMS("aux read count error(ret:0x%lx != 0x%lx)\n", ret, msg->size); + ret = -EBUSY; + goto out; + } + + for (i = 0; i < ret; i++) + data[i] = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_DATA); + +out: + return ret; +} + +static void phytium_get_native_mode(struct phytium_dp_device *phytium_dp) +{ + struct drm_display_mode *t, *mode; + struct drm_connector *connector = &phytium_dp->connector; + struct drm_display_mode *native_mode = &phytium_dp->native_mode; + + list_for_each_entry_safe(mode, t, &connector->probed_modes, head) { + if (mode->type & DRM_MODE_TYPE_PREFERRED) { + if (mode->hdisplay != native_mode->hdisplay || + mode->vdisplay != native_mode->vdisplay) { + memcpy(native_mode, mode, sizeof(*mode)); + drm_mode_set_crtcinfo(native_mode, 0); + } + break; + } + } + + if (&mode->head == &connector->probed_modes) + native_mode->clock = 0; +} + +static int phytium_connector_add_common_modes(struct phytium_dp_device *phytium_dp) +{ + int i = 0, ret = 0; + struct drm_device *dev = phytium_dp->dev; + struct drm_display_mode *mode = NULL, *current_mode = NULL; + struct drm_display_mode *native_mode = &phytium_dp->native_mode; + bool mode_existed = false; + struct mode_size { + char name[DRM_DISPLAY_MODE_LEN]; + int w; + int h; + } common_mode[] = { + { "640x480", 640, 480}, + { "800x600", 800, 600}, + { "1024x768", 1024, 768}, + { "1280x720", 1280, 720}, + { "1280x800", 1280, 800}, + {"1280x1024", 1280, 1024}, + { "1440x900", 1440, 900}, + {"1680x1050", 1680, 1050}, + {"1600x1200", 1600, 1200}, + {"1920x1080", 1920, 1080}, + {"1920x1200", 1920, 1200} + }; + + if (native_mode->clock == 0) + return ret; + + for (i = 0; i < ARRAY_SIZE(common_mode); i++) { + mode_existed = false; + + if (common_mode[i].w > native_mode->hdisplay || + common_mode[i].h > native_mode->vdisplay || + (common_mode[i].w == native_mode->hdisplay && + common_mode[i].h == native_mode->vdisplay)) + continue; + + list_for_each_entry(current_mode, &phytium_dp->connector.probed_modes, head) { + if (common_mode[i].w == current_mode->hdisplay && + common_mode[i].h == current_mode->vdisplay) { + mode_existed = true; + break; + } + } + + if (mode_existed) + continue; + + mode = drm_mode_duplicate(dev, native_mode); + if (mode == NULL) + continue; + + mode->hdisplay = common_mode[i].w; + mode->vdisplay = common_mode[i].h; + mode->type &= ~DRM_MODE_TYPE_PREFERRED; + strncpy(mode->name, common_mode[i].name, DRM_DISPLAY_MODE_LEN); + drm_mode_probed_add(&phytium_dp->connector, mode); + ret++; + } + + return ret; +} + +static int phytium_connector_get_modes(struct drm_connector *connector) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + struct edid *edid; + int ret = 0; + + if (phytium_dp->is_edp) + edid = phytium_dp->edp_edid; + else + edid = drm_get_edid(connector, &phytium_dp->aux.ddc); + + if (edid && drm_edid_is_valid(edid)) { + drm_connector_update_edid_property(connector, edid); + ret = drm_add_edid_modes(connector, edid); + phytium_dp->has_audio = drm_detect_monitor_audio(edid); + phytium_get_native_mode(phytium_dp); + if (dc_fake_mode_enable) + ret += phytium_connector_add_common_modes(phytium_dp); + } else { + drm_connector_update_edid_property(connector, NULL); + phytium_dp->has_audio = false; + } + + if (!phytium_dp->is_edp) + kfree(edid); + + return ret; +} + +static struct drm_encoder *phytium_dp_best_encoder(struct drm_connector *connector) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + return &phytium_dp->encoder; +} + +static const +struct drm_connector_helper_funcs phytium_connector_helper_funcs = { + .get_modes = phytium_connector_get_modes, + .best_encoder = phytium_dp_best_encoder, +}; + +static void phytium_dp_set_sink_rates(struct phytium_dp_device *phytium_dp) +{ + static const int dp_rates[] = {162000, 270000, 540000, 810000}; + int i, max_rate; + + max_rate = drm_dp_bw_code_to_link_rate(phytium_dp->dpcd[DP_MAX_LINK_RATE]); + for (i = 0; i < ARRAY_SIZE(dp_rates); i++) { + if (dp_rates[i] > max_rate) + break; + phytium_dp->sink_rates[i] = dp_rates[i]; + } + phytium_dp->num_sink_rates = i; +} + +static int get_common_rates(const int *source_rates, int source_len, const int *sink_rates, + int sink_len, int *common_rates) +{ + int i = 0, j = 0, k = 0; + + while (i < source_len && j < sink_len) { + if (source_rates[i] == sink_rates[j]) { + if (WARN_ON(k >= DP_MAX_SUPPORTED_RATES)) + return k; + common_rates[k] = source_rates[i]; + ++k; + ++i; + ++j; + } else if (source_rates[i] < sink_rates[j]) { + ++i; + } else { + ++j; + } + } + return k; +} + +static void phytium_dp_set_common_rates(struct phytium_dp_device *phytium_dp) +{ + WARN_ON(!phytium_dp->num_source_rates || !phytium_dp->num_sink_rates); + + phytium_dp->num_common_rates = get_common_rates(phytium_dp->source_rates, + phytium_dp->num_source_rates, + phytium_dp->sink_rates, + phytium_dp->num_sink_rates, + phytium_dp->common_rates); + + if (WARN_ON(phytium_dp->num_common_rates == 0)) { + phytium_dp->common_rates[0] = 162000; + phytium_dp->num_common_rates = 1; + } +} + +static bool phytium_dp_get_dpcd(struct phytium_dp_device *phytium_dp) +{ + int ret; + unsigned char sink_count = 0; + + /* get dpcd capability,but don't check data error; so check revision */ + ret = drm_dp_dpcd_read(&phytium_dp->aux, 0x00, phytium_dp->dpcd, + sizeof(phytium_dp->dpcd)); + if (ret < 0) { + DRM_ERROR("port %d get DPCD capability fail\n", phytium_dp->port); + return false; + } + + if (phytium_dp->dpcd[DP_DPCD_REV] == 0) { + DRM_ERROR("DPCD data error: 0x%x\n", phytium_dp->dpcd[DP_DPCD_REV]); + return false; + } + + /* parse sink support link */ + phytium_dp_set_sink_rates(phytium_dp); + phytium_dp_set_common_rates(phytium_dp); + phytium_dp->sink_max_lane_count = drm_dp_max_lane_count(phytium_dp->dpcd); + phytium_dp->common_max_lane_count = min(phytium_dp->source_max_lane_count, + phytium_dp->sink_max_lane_count); + + /* get dpcd sink count */ + if (drm_dp_dpcd_readb(&phytium_dp->aux, DP_SINK_COUNT, &sink_count) <= 0) { + DRM_ERROR("get DPCD sink_count fail\n"); + return false; + } + + phytium_dp->sink_count = DP_GET_SINK_COUNT(sink_count); + if (!phytium_dp->sink_count) { + DRM_ERROR("DPCD sink_count should not be zero\n"); + return false; + } + + if (!drm_dp_is_branch(phytium_dp->dpcd)) + return true; + + if (phytium_dp->dpcd[DP_DPCD_REV] == 0x10) + return true; + + /* get downstream port for branch device */ + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_DOWNSTREAM_PORT_0, + phytium_dp->downstream_ports, DP_MAX_DOWNSTREAM_PORTS); + if (ret < 0) { + DRM_ERROR("get DPCD DFP fail\n"); + return false; + } + + return true; +} + +static enum drm_connector_status +phytium_dp_detect_dpcd(struct phytium_dp_device *phytium_dp) +{ + if (!phytium_dp_get_dpcd(phytium_dp)) + return connector_status_disconnected; + + if (!drm_dp_is_branch(phytium_dp->dpcd)) + return connector_status_connected; + + if (phytium_dp->downstream_ports[0] & DP_DS_PORT_HPD) { + return phytium_dp->sink_count ? connector_status_connected + : connector_status_disconnected; + } + return connector_status_connected; +} + +static void phytium_get_adjust_train(struct phytium_dp_device *phytium_dp, + const uint8_t link_status[DP_LINK_STATUS_SIZE], uint8_t lane_count) +{ + unsigned char v = 0; + unsigned char p = 0; + int lane; + unsigned char voltage_max; + unsigned char preemph_max; + + /* find max value */ + for (lane = 0; lane < lane_count; lane++) { + uint8_t this_v = drm_dp_get_adjust_request_voltage(link_status, lane); + uint8_t this_p = drm_dp_get_adjust_request_pre_emphasis(link_status, lane); + + if (this_v > v) + v = this_v; + if (this_p > p) + p = this_p; + } + voltage_max = DP_TRAIN_VOLTAGE_SWING_LEVEL_3; + if (v >= voltage_max) + v = voltage_max | DP_TRAIN_MAX_SWING_REACHED; + + preemph_max = DP_TRAIN_PRE_EMPH_LEVEL_3; + if (p >= preemph_max) + p = preemph_max | DP_TRAIN_MAX_PRE_EMPHASIS_REACHED; + + for (lane = 0; lane < 4; lane++) + phytium_dp->train_set[lane] = v | p; +} + +bool phytium_dp_coding_8b10b_need_enable(unsigned char test_pattern) +{ + switch (test_pattern) { + case PHYTIUM_PHY_TP_D10_2: + case PHYTIUM_PHY_TP_SYMBOL_ERROR: + case PHYTIUM_PHY_TP_CP2520_1: + case PHYTIUM_PHY_TP_CP2520_2: + case PHYTIUM_PHY_TP_CP2520_3: + return true; + case PHYTIUM_PHY_TP_PRBS7: + case PHYTIUM_PHY_TP_80BIT_CUSTOM: + return false; + default: + return false; + } +} + +bool phytium_dp_scrambled_need_enable(unsigned char test_pattern) +{ + switch (test_pattern) { + case PHYTIUM_PHY_TP_SYMBOL_ERROR: + case PHYTIUM_PHY_TP_CP2520_1: + case PHYTIUM_PHY_TP_CP2520_2: + case PHYTIUM_PHY_TP_CP2520_3: + return true; + case PHYTIUM_PHY_TP_D10_2: + case PHYTIUM_PHY_TP_PRBS7: + case PHYTIUM_PHY_TP_80BIT_CUSTOM: + return false; + default: + return false; + } +} + +static void phytium_dp_hw_set_lane_setting(struct phytium_dp_device *phytium_dp, + uint32_t link_rate, + uint8_t train_set) +{ + phytium_dp->funcs->dp_hw_set_phy_lane_setting(phytium_dp, link_rate, train_set); +} + +static void phytium_dp_hw_set_link(struct phytium_dp_device *phytium_dp, + uint8_t lane_count, + uint32_t link_rate) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, ret = 0, retry = 3; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, lane_count, + group_offset, PHYTIUM_DP_LANE_COUNT_SET); + phytium_writel_reg(priv, + drm_dp_link_rate_to_bw_code(link_rate), + group_offset, PHYTIUM_DP_LINK_BW_SET); + + if (drm_dp_enhanced_frame_cap(phytium_dp->dpcd)) + phytium_writel_reg(priv, ENHANCED_FRAME_ENABLE, + group_offset, PHYTIUM_DP_ENHANCED_FRAME_EN); + else + phytium_writel_reg(priv, ENHANCED_FRAME_DISABLE, + group_offset, PHYTIUM_DP_ENHANCED_FRAME_EN); + +try_again: + ret = phytium_dp->funcs->dp_hw_set_phy_lane_and_rate(phytium_dp, lane_count, link_rate); + if ((ret < 0) && retry) { + retry--; + goto try_again; + } +} + +static void phytium_dp_hw_set_test_pattern(struct phytium_dp_device *phytium_dp, + uint8_t lane_count, + uint8_t test_pattern, + uint8_t *custom_pattern, + uint32_t custom_pattern_size) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, val = 0, tmp = 0, i; + uint32_t group_offset = priv->dp_reg_base[port]; + + if ((test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) + && custom_pattern && (custom_pattern_size > 0)) { + val = *(int *)custom_pattern; + phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_0); + val = *(int *)(custom_pattern + 4); + phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_1); + val = *(short int *)(custom_pattern + 8); + phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_2); + } + + if (test_pattern == PHYTIUM_PHY_TP_D10_2 || test_pattern == PHYTIUM_PHY_TP_PRBS7 + || test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) + phytium_writel_reg(priv, SCRAMBLING_DISABLE, group_offset, + PHYTIUM_DP_SCRAMBLING_DISABLE); + else + phytium_writel_reg(priv, SCRAMBLING_ENABLE, group_offset, + PHYTIUM_DP_SCRAMBLING_DISABLE); + + tmp = test_pattern - PHYTIUM_PHY_TP_NONE + TEST_PATTERN_NONE; + val = 0; + for (i = 0; i < lane_count; i++) + val |= (tmp << (TEST_PATTERN_LANE_SHIFT * i)); + phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_LINK_QUAL_PATTERN_SET); +} + +static void phytium_dp_hw_set_train_pattern(struct phytium_dp_device *phytium_dp, + uint8_t train_pattern) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, tmp = 0; + uint32_t group_offset = priv->dp_reg_base[port]; + + /* Scrambling is disabled for TPS1/TPS2/3 and enabled for TPS4 */ + if (train_pattern == DP_TRAINING_PATTERN_4 + || train_pattern == DP_TRAINING_PATTERN_DISABLE) { + phytium_writel_reg(priv, SCRAMBLING_ENABLE, group_offset, + PHYTIUM_DP_SCRAMBLING_DISABLE); + phytium_writel_reg(priv, SCRAMBLER_RESET, group_offset, + PHYTIUM_DP_FORCE_SCRAMBLER_RESET); + } else { + phytium_writel_reg(priv, SCRAMBLING_DISABLE, group_offset, + PHYTIUM_DP_SCRAMBLING_DISABLE); + } + switch (train_pattern) { + case DP_TRAINING_PATTERN_DISABLE: + tmp = TRAINING_OFF; + break; + case DP_TRAINING_PATTERN_1: + tmp = TRAINING_PATTERN_1; + break; + case DP_TRAINING_PATTERN_2: + tmp = TRAINING_PATTERN_2; + break; + case DP_TRAINING_PATTERN_3: + tmp = TRAINING_PATTERN_3; + break; + case DP_TRAINING_PATTERN_4: + tmp = TRAINING_PATTERN_4; + break; + default: + tmp = TRAINING_OFF; + break; + } + + phytium_writel_reg(priv, tmp, group_offset, PHYTIUM_DP_TRAINING_PATTERN_SET); +} + +void phytium_dp_hw_enable_audio(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + int config = 0, config1, data_window = 0; + const struct dp_audio_n_m *n_m = NULL; + uint32_t group_offset = priv->dp_reg_base[port]; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); + phytium_writel_reg(priv, CHANNEL_MUTE_ENABLE, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); + + data_window = 90*(phytium_dp->link_rate)/100 + *(phytium_dp->mode.htotal - phytium_dp->mode.hdisplay) + /phytium_dp->mode.clock/4; + + phytium_writel_reg(priv, data_window, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW); + + n_m = phytium_dp_audio_get_n_m(phytium_dp->link_rate, phytium_dp->audio_info.sample_rate); + if (n_m == NULL) { + DRM_NOTE("can not get n_m for link_rate(%d) and sample_rate(%d)\n", + phytium_dp->link_rate, phytium_dp->audio_info.sample_rate); + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_MAUD); + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_NAUD); + } else { + phytium_writel_reg(priv, n_m->m, group_offset, PHYTIUM_DP_SEC_MAUD); + phytium_writel_reg(priv, n_m->n, group_offset, PHYTIUM_DP_SEC_NAUD); + } + + config1 = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); + phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, + group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); + phytium_writel_reg(priv, config1, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); +} + +static void phytium_dp_hw_audio_shutdown(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, + group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); +} + +static void phytium_dp_hw_audio_digital_mute(struct phytium_dp_device *phytium_dp, bool enable) +{ + struct phytium_display_private *priv = phytium_dp->dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + if (enable) + phytium_writel_reg(priv, CHANNEL_MUTE_ENABLE, + group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); + else + phytium_writel_reg(priv, SEC_AUDIO_ENABLE, + group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); +} + +static int +phytium_dp_hw_audio_hw_params(struct phytium_dp_device *phytium_dp, struct audio_info audio_info) +{ + struct phytium_display_private *priv = phytium_dp->dev->dev_private; + int port = phytium_dp->port; + int ret = 0, data_window = 0; + const struct dp_audio_n_m *n_m = NULL; + uint32_t fs, ws, fs_accurac; + uint32_t group_offset = priv->dp_reg_base[port]; + + DRM_DEBUG_KMS("%s:set port%d sample_rate(%d) channels(%d) sample_width(%d)\n", + __func__, phytium_dp->port, audio_info.sample_rate, + audio_info.channels, audio_info.sample_width); + + phytium_writel_reg(priv, INPUT_SELECT_I2S, group_offset, PHYTIUM_DP_SEC_INPUT_SELECT); + phytium_writel_reg(priv, APB_CLOCK/audio_info.sample_rate, + group_offset, PHYTIUM_DP_SEC_DIRECT_CLKDIV); + phytium_writel_reg(priv, audio_info.channels & CHANNEL_MASK, + group_offset, PHYTIUM_DP_SEC_CHANNEL_COUNT); + phytium_writel_reg(priv, CHANNEL_MAP_DEFAULT, group_offset, PHYTIUM_DP_SEC_CHANNEL_MAP); + data_window = 90*(phytium_dp->link_rate)/100 + *(phytium_dp->mode.htotal - phytium_dp->mode.hdisplay) + /phytium_dp->mode.clock/4; + phytium_writel_reg(priv, data_window, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW); + phytium_writel_reg(priv, 0xb5, group_offset, PHYTIUM_DP_SEC_CS_CATEGORY_CODE); + + phytium_writel_reg(priv, CLOCK_MODE_SYNC, group_offset, PHYTIUM_DP_SEC_CLOCK_MODE); + phytium_writel_reg(priv, CS_SOURCE_FORMAT_DEFAULT, + group_offset, PHYTIUM_DP_SEC_CS_SOURCE_FORMAT); + + switch (audio_info.sample_rate) { + case 32000: + fs = ORIG_FREQ_32000; + fs_accurac = SAMPLING_FREQ_32000; + break; + case 44100: + fs = ORIG_FREQ_44100; + fs_accurac = SAMPLING_FREQ_44100; + break; + case 48000: + fs = ORIG_FREQ_48000; + fs_accurac = SAMPLING_FREQ_48000; + break; + case 96000: + fs = ORIG_FREQ_96000; + fs_accurac = SAMPLING_FREQ_96000; + break; + case 176400: + fs = ORIG_FREQ_176400; + fs_accurac = SAMPLING_FREQ_176400; + break; + case 192000: + fs = ORIG_FREQ_192000; + fs_accurac = SAMPLING_FREQ_192000; + break; + default: + DRM_ERROR("dp not support sample_rate %d\n", audio_info.sample_rate); + goto out; + } + + switch (audio_info.sample_width) { + case 16: + ws = WORD_LENGTH_16; + break; + case 18: + ws = WORD_LENGTH_18; + break; + case 20: + ws = WORD_LENGTH_20; + break; + case 24: + ws = WORD_LENGTH_24; + break; + default: + DRM_ERROR("dp not support sample_width %d\n", audio_info.sample_width); + goto out; + } + + phytium_writel_reg(priv, ((fs&ORIG_FREQ_MASK)<link_rate, audio_info.sample_rate); + if (n_m == NULL) { + DRM_NOTE("can not get n_m for link_rate(%d) and sample_rate(%d)\n", + phytium_dp->link_rate, audio_info.sample_rate); + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_MAUD); + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_NAUD); + + } else { + phytium_writel_reg(priv, n_m->m, group_offset, PHYTIUM_DP_SEC_MAUD); + phytium_writel_reg(priv, n_m->n, group_offset, PHYTIUM_DP_SEC_NAUD); + } + phytium_writel_reg(priv, SECONDARY_STREAM_ENABLE, + group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); + phytium_dp->audio_info = audio_info; + + return 0; + +out: + phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, + group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); + + return ret; +} + +void phytium_dp_hw_disable_video(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, SST_MST_SOURCE_0_DISABLE, + group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); +} + +bool phytium_dp_hw_video_is_enable(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, config; + uint32_t group_offset = priv->dp_reg_base[port]; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); + return config ? true : false; +} + +void phytium_dp_hw_enable_video(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, SST_MST_SOURCE_0_ENABLE, + group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); + phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); +} + +void phytium_dp_hw_config_video(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + unsigned long link_bw, date_rate = 0; + struct drm_display_info *display_info = &phytium_dp->connector.display_info; + unsigned char tu_size = 64; + unsigned long data_per_tu = 0; + int symbols_per_tu, frac_symbols_per_tu, symbol_count, udc, value; + + /* cal M/N and tu_size */ + phytium_writel_reg(priv, phytium_dp->mode.crtc_clock/10, group_offset, PHYTIUM_DP_M_VID); + phytium_writel_reg(priv, phytium_dp->link_rate/10, group_offset, PHYTIUM_DP_N_VID); + link_bw = phytium_dp->link_rate * phytium_dp->link_lane_count; + date_rate = (phytium_dp->mode.crtc_clock * display_info->bpc * 3)/8; + + /* mul 10 for register setting */ + data_per_tu = 10*tu_size * date_rate/link_bw; + symbols_per_tu = (data_per_tu/10)&0xff; + if (symbols_per_tu == 63) + frac_symbols_per_tu = 0; + else + frac_symbols_per_tu = (data_per_tu%10*16/10) & 0xf; + phytium_writel_reg(priv, frac_symbols_per_tu<<24 | symbols_per_tu<<16 | tu_size, + group_offset, PHYTIUM_DP_TRANSFER_UNIT_SIZE); + + symbol_count = (phytium_dp->mode.crtc_hdisplay*display_info->bpc*3 + 7)/8; + udc = (symbol_count + phytium_dp->link_lane_count - 1)/phytium_dp->link_lane_count; + phytium_writel_reg(priv, udc, group_offset, PHYTIUM_DP_DATA_COUNT); + + /* config main stream attributes */ + phytium_writel_reg(priv, phytium_dp->mode.crtc_htotal, + group_offset, PHYTIUM_DP_MAIN_LINK_HTOTAL); + phytium_writel_reg(priv, phytium_dp->mode.crtc_hdisplay, + group_offset, PHYTIUM_DP_MAIN_LINK_HRES); + phytium_writel_reg(priv, + phytium_dp->mode.crtc_hsync_end - phytium_dp->mode.crtc_hsync_start, + group_offset, PHYTIUM_DP_MAIN_LINK_HSWIDTH); + phytium_writel_reg(priv, phytium_dp->mode.crtc_htotal - phytium_dp->mode.crtc_hsync_start, + group_offset, PHYTIUM_DP_MAIN_LINK_HSTART); + phytium_writel_reg(priv, phytium_dp->mode.crtc_vtotal, + group_offset, PHYTIUM_DP_MAIN_LINK_VTOTAL); + phytium_writel_reg(priv, phytium_dp->mode.crtc_vdisplay, + group_offset, PHYTIUM_DP_MAIN_LINK_VRES); + phytium_writel_reg(priv, + phytium_dp->mode.crtc_vsync_end - phytium_dp->mode.crtc_vsync_start, + group_offset, PHYTIUM_DP_MAIN_LINK_VSWIDTH); + phytium_writel_reg(priv, phytium_dp->mode.crtc_vtotal - phytium_dp->mode.crtc_vsync_start, + group_offset, PHYTIUM_DP_MAIN_LINK_VSTART); + + value = 0; + if (phytium_dp->mode.flags & DRM_MODE_FLAG_PHSYNC) + value = value & (~HSYNC_POLARITY_LOW); + else + value = value | HSYNC_POLARITY_LOW; + + if (phytium_dp->mode.flags & DRM_MODE_FLAG_PVSYNC) + value = value & (~VSYNC_POLARITY_LOW); + else + value = value | VSYNC_POLARITY_LOW; + phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_MAIN_LINK_POLARITY); + + switch (display_info->bpc) { + case 10: + value = (MISC0_BIT_DEPTH_10BIT << MISC0_BIT_DEPTH_OFFSET); + break; + case 6: + value = (MISC0_BIT_DEPTH_6BIT << MISC0_BIT_DEPTH_OFFSET); + break; + default: + value = (MISC0_BIT_DEPTH_8BIT << MISC0_BIT_DEPTH_OFFSET); + break; + } + value |= (MISC0_COMPONENT_FORMAT_RGB << MISC0_COMPONENT_FORMAT_SHIFT) + | MISC0_SYNCHRONOUS_CLOCK; + phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_MAIN_LINK_MISC0); + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_MAIN_LINK_MISC1); + + value = USER_ODDEVEN_POLARITY_HIGH | USER_DATA_ENABLE_POLARITY_HIGH; + if (phytium_dp->mode.flags & DRM_MODE_FLAG_PHSYNC) + value = value | USER_HSYNC_POLARITY_HIGH; + else + value = value & (~USER_HSYNC_POLARITY_HIGH); + if (phytium_dp->mode.flags & DRM_MODE_FLAG_PVSYNC) + value = value | USER_VSYNC_POLARITY_HIGH; + else + value = value & (~USER_VSYNC_POLARITY_HIGH); + phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_USER_SYNC_POLARITY); +} + +void phytium_dp_hw_disable_output(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, TRANSMITTER_OUTPUT_DISABLE, + group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); + phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); +} + +void phytium_dp_hw_enable_output(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); + phytium_writel_reg(priv, TRANSMITTER_OUTPUT_ENABLE, + group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); +} + +void phytium_dp_hw_enable_input_source(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, VIRTUAL_SOURCE_0_ENABLE, + group_offset, PHYTIUM_INPUT_SOURCE_ENABLE); +} + +void phytium_dp_hw_disable_input_source(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + + phytium_writel_reg(priv, (~VIRTUAL_SOURCE_0_ENABLE)&VIRTUAL_SOURCE_0_ENABLE_MASK, + priv->dp_reg_base[port], PHYTIUM_INPUT_SOURCE_ENABLE); +} + +bool phytium_dp_hw_output_is_enable(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + int config = 0; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); + return config ? true : false; +} + +static void phytium_dp_hw_get_hpd_state(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t val = 0, raw_state = 0; + uint32_t group_offset = priv->dp_reg_base[port]; + + val = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_RAW_STATUS); + + /* maybe miss hpd, so used for clear PHYTIUM_DP_INTERRUPT_RAW_STATUS */ + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); + raw_state = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SINK_HPD_STATE); + if (val & HPD_EVENT) + phytium_dp->dp_hpd_state.hpd_event_state = true; + + if (val & HPD_IRQ) + phytium_dp->dp_hpd_state.hpd_irq_state = true; + + if (raw_state & HPD_CONNECT) + phytium_dp->dp_hpd_state.hpd_raw_state = true; + else + phytium_dp->dp_hpd_state.hpd_raw_state = false; +} + +void phytium_dp_hw_hpd_irq_setup(struct phytium_dp_device *phytium_dp, bool enable) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_dp->dp_hpd_state.hpd_irq_enable = enable; + if (enable) + phytium_writel_reg(priv, HPD_OTHER_MASK, group_offset, PHYTIUM_DP_INTERRUPT_MASK); + else + phytium_writel_reg(priv, HPD_IRQ_MASK|HPD_EVENT_MASK|HPD_OTHER_MASK, + group_offset, PHYTIUM_DP_INTERRUPT_MASK); +} + +int phytium_dp_hw_init(struct phytium_dp_device *phytium_dp) +{ + int ret = 0; + uint8_t count = 0; + + phytium_dp->source_rates = phytium_rate; + phytium_dp->num_source_rates = num_source_rates; + count = phytium_dp->funcs->dp_hw_get_source_lane_count(phytium_dp); + phytium_dp->source_max_lane_count = count; + + ret = phytium_dp->funcs->dp_hw_reset(phytium_dp); + if (ret) + goto out; + ret = phytium_dp->funcs->dp_hw_init_phy(phytium_dp); + if (ret) + goto out; + + phytium_dp->fast_train_support = false; + phytium_dp->hw_spread_enable = phytium_dp->funcs->dp_hw_spread_is_enable(phytium_dp); + +out: + return ret; +} + +static int phytium_dp_dpcd_get_tp_link(struct phytium_dp_device *phytium_dp, + uint8_t *test_lane_count, + uint32_t *test_link_rate) +{ + uint8_t test_link_bw; + int ret; + + ret = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_LANE_COUNT, + test_lane_count); + if (ret <= 0) { + DRM_DEBUG_KMS("test pattern Lane count read failed(%d)\n", ret); + goto failed; + } + + ret = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_LINK_RATE, + &test_link_bw); + if (ret <= 0) { + DRM_DEBUG_KMS("test pattern link rate read failed(%d)\n", ret); + goto failed; + } + *test_link_rate = drm_dp_bw_code_to_link_rate(test_link_bw); + + return 0; +failed: + return ret; +} + +static int phytium_dp_dpcd_set_link(struct phytium_dp_device *phytium_dp, + uint8_t lane_count, uint32_t link_rate) +{ + uint8_t link_config[2]; + int ret = 0; + + link_config[0] = drm_dp_link_rate_to_bw_code(link_rate); + link_config[1] = lane_count; + if (drm_dp_enhanced_frame_cap(phytium_dp->dpcd)) { + link_config[1] |= DP_LANE_COUNT_ENHANCED_FRAME_EN; + } + ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_LINK_BW_SET, link_config, 2); + if (ret < 0) { + DRM_NOTE("write dpcd DP_LINK_BW_SET fail: ret:%d\n", ret); + goto failed; + } + + if (phytium_dp->hw_spread_enable) + link_config[0] = DP_SPREAD_AMP_0_5; + else + link_config[0] = 0; + link_config[1] = DP_SET_ANSI_8B10B; + ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_DOWNSPREAD_CTRL, link_config, 2); + if (ret < 0) { + DRM_ERROR("write DP_DOWNSPREAD_CTRL fail: ret:%d\n", ret); + goto failed; + } + + return 0; +failed: + return ret; +} + +static int phytium_dp_dpcd_set_test_pattern(struct phytium_dp_device *phytium_dp, + uint8_t test_pattern) +{ + unsigned char value; + int ret; + + if (phytium_dp_coding_8b10b_need_enable(test_pattern)) + value = DP_SET_ANSI_8B10B; + else + value = 0; + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_MAIN_LINK_CHANNEL_CODING_SET, value); + if (ret < 0) { + DRM_ERROR("write DP_MAIN_LINK_CHANNEL_CODING_SET fail: ret:%d\n", ret); + goto failed; + } + + if (phytium_dp_scrambled_need_enable(test_pattern)) + value = DP_TRAINING_PATTERN_DISABLE; + else + value = (DP_TRAINING_PATTERN_DISABLE | DP_LINK_SCRAMBLING_DISABLE); + + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TRAINING_PATTERN_SET, value); + if (ret < 0) { + DRM_ERROR("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); + goto failed; + } + + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_LINK_QUAL_LANE0_SET, test_pattern); + if (ret < 0) { + DRM_ERROR("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); + goto failed; + } + + return 0; +failed: + return ret; +} + +static int phytium_dp_dpcd_set_train_pattern(struct phytium_dp_device *phytium_dp, + uint8_t train_pattern) +{ + uint8_t value; + int ret; + + /* Scrambling is disabled for TPS1/2/3 and enabled for TPS4 */ + if (train_pattern == DP_TRAINING_PATTERN_4 || train_pattern == DP_TRAINING_PATTERN_DISABLE) + value = train_pattern; + else + value = (train_pattern | DP_LINK_SCRAMBLING_DISABLE); + + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TRAINING_PATTERN_SET, value); + if (ret < 0) { + DRM_NOTE("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); + goto failed; + } + + return 0; +failed: + return ret; +} + +static int +phytium_dp_dpcd_set_lane_setting(struct phytium_dp_device *phytium_dp, uint8_t *train_set) +{ + int ret = 0; + + ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_TRAINING_LANE0_SET, + phytium_dp->train_set, 4); + if (ret < 0) { + DRM_ERROR("write DP_TRAINING_LANE0_SET fail: ret:%d\n", ret); + return ret; + } + + return 0; +} + +static int +phytium_dp_dpcd_get_adjust_request(struct phytium_dp_device *phytium_dp, uint8_t lane_count) +{ + int ret = 0; + uint8_t link_status[DP_LINK_STATUS_SIZE]; + + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, + link_status, DP_LINK_STATUS_SIZE); + if (ret < 0) { + DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); + goto failed; + } + phytium_get_adjust_train(phytium_dp, link_status, lane_count); + + return 0; +failed: + return ret; +} + +void phytium_dp_dpcd_sink_dpms(struct phytium_dp_device *phytium_dp, int mode) +{ + int ret, i; + + if (phytium_dp->dpcd[DP_DPCD_REV] < 0x11) + return; + if (mode != DRM_MODE_DPMS_ON) { + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_SET_POWER, DP_SET_POWER_D3); + } else { + for (i = 0; i < 3; i++) { + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_SET_POWER, DP_SET_POWER_D0); + if (ret == 1) + break; + msleep(20); + } + } + + if (ret != 1) + DRM_DEBUG_KMS("failed to %s sink power state\n", + mode == DRM_MODE_DPMS_ON ? "enable" : "disable"); +} + +static bool phytium_dp_link_training_clock_recovery(struct phytium_dp_device *phytium_dp) +{ + int ret; + unsigned char voltage, max_vswing_tries; + int voltage_tries; + + /* clear the test pattern */ + phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->link_lane_count, + PHYTIUM_PHY_TP_NONE, NULL, 0); + + /* config source and sink's link rate and lane count */ + phytium_dp_hw_set_link(phytium_dp, phytium_dp->link_lane_count, phytium_dp->link_rate); + ret = phytium_dp_dpcd_set_link(phytium_dp, phytium_dp->link_lane_count, + phytium_dp->link_rate); + if (ret < 0) { + DRM_NOTE("phytium_dp_dpcd_set_link failed(ret=%d)\n", ret); + return false; + } + + /* config source's voltage swing and pre-emphasis(103-106) */ + memset(phytium_dp->train_set, 0, sizeof(phytium_dp->train_set)); + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, + phytium_dp->train_set[0]); + + /* config train pattern */ + phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); + ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); + return false; + } + + /* config sink's voltage swing and pre-emphasis(103-106) */ + ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); + return false; + } + + voltage_tries = 1; + max_vswing_tries = 0; + for (;;) { + unsigned char link_status[DP_LINK_STATUS_SIZE]; + drm_dp_link_train_clock_recovery_delay(phytium_dp->dpcd); + /* get link status 0x202-0x207 */ + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, + link_status, DP_LINK_STATUS_SIZE); + if (ret < 0) { + DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); + return false; + } + + if (drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("clock revorery ok\n"); + return true; + } + + if (voltage_tries == 5) { + DRM_DEBUG_KMS("Same voltage tried 5 times\n"); + return false; + } + + if (max_vswing_tries == 1) { + DRM_DEBUG_KMS("Max Voltage Swing reached\n"); + return false; + } + + voltage = phytium_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK; + + /* config source and sink's voltage swing and pre-emphasis(103-106) */ + phytium_get_adjust_train(phytium_dp, link_status, phytium_dp->link_lane_count); + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, + phytium_dp->train_set[0]); + ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); + return false; + } + + if ((phytium_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK) == voltage) + ++voltage_tries; + else + voltage_tries = 1; + + if (phytium_dp->train_set[0] & DP_TRAIN_MAX_SWING_REACHED) + ++max_vswing_tries; + + DRM_DEBUG_KMS("try train_set:0x%x voltage_tries:%d max_vswing_tries:%d\n", + phytium_dp->train_set[0], voltage_tries, max_vswing_tries); + } +} + +static unsigned int phytium_dp_get_training_pattern(struct phytium_dp_device *phytium_dp) +{ + bool sink_tps3, sink_tps4; + + sink_tps4 = drm_dp_tps4_supported(phytium_dp->dpcd); + if (sink_tps4) + return DP_TRAINING_PATTERN_4; + else if (phytium_dp->link_rate == 810000) + DRM_DEBUG_KMS("8.1 Gbps link rate without sink TPS4 support\n"); + + sink_tps3 = drm_dp_tps3_supported(phytium_dp->dpcd); + if (sink_tps3) + return DP_TRAINING_PATTERN_3; + else if (phytium_dp->link_rate >= 540000) + DRM_DEBUG_KMS(">=5.4/6.48 Gbps link rate without sink TPS3 support\n"); + + return DP_TRAINING_PATTERN_2; +} + +static bool phytium_dp_link_training_channel_equalization(struct phytium_dp_device *phytium_dp) +{ + unsigned int training_pattern; + int tries, ret; + unsigned char link_status[DP_LINK_STATUS_SIZE]; + bool channel_eq = false; + + /* config source and sink's voltage swing and pre-emphasis(103-106), from clock recovery */ + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, + phytium_dp->train_set[0]); + ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); + return channel_eq; + } + + /* config source and sink's train_pattern x */ + training_pattern = phytium_dp_get_training_pattern(phytium_dp); + phytium_dp_hw_set_train_pattern(phytium_dp, training_pattern); + ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, training_pattern); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); + return channel_eq; + } + + for (tries = 0; tries < 5; tries++) { + drm_dp_link_train_channel_eq_delay(phytium_dp->dpcd); + + /* get link status 0x202-0x207 */ + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, + link_status, DP_LINK_STATUS_SIZE); + if (ret < 0) { + DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); + break; + } + + /* Make sure clock is still ok */ + if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("CR check failed, cannot continue channel equalization\n"); + break; + } + + if (drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { + channel_eq = true; + DRM_DEBUG_KMS("Channel EQ done. DP Training successful\n"); + break; + } + + /* config source and sink's voltage swing and pre-emphasis(103-106) */ + phytium_get_adjust_train(phytium_dp, link_status, phytium_dp->link_lane_count); + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, + phytium_dp->train_set[0]); + ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); + break; + } + } + + /* Try 5 times, else fail and try at lower BW */ + if (tries == 5) + DRM_DEBUG_KMS("Channel equalization failed 5 times\n"); + + return channel_eq; +} + +static void phytium_dp_train_retry_work_fn(struct work_struct *work) +{ + struct phytium_dp_device *phytium_dp = train_retry_to_dp_device(work); + struct drm_connector *connector; + + connector = &phytium_dp->connector; + DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector->base.id, connector->name); + mutex_lock(&connector->dev->mode_config.mutex); + drm_connector_set_link_status_property(connector, DRM_MODE_LINK_STATUS_BAD); + mutex_unlock(&connector->dev->mode_config.mutex); + drm_kms_helper_hotplug_event(connector->dev); +} + +/* return index of rate in rates array, or -1 if not found */ +static int phytium_dp_rate_index(const int *rates, int len, int rate) +{ + int i; + + for (i = 0; i < len; i++) + if (rate == rates[i]) + return i; + + return -1; +} + +int phytium_dp_get_link_train_fallback_values(struct phytium_dp_device *phytium_dp) +{ + int index, ret = 0; + + if (phytium_dp->is_edp) { + phytium_dp->train_retry_count++; + DRM_INFO("Retrying Link training for eDP(%d) with same parameters\n", + phytium_dp->port); + goto out; + } else { + index = phytium_dp_rate_index(phytium_dp->common_rates, + phytium_dp->num_common_rates, + phytium_dp->link_rate); + if (index > 0) { + phytium_dp->link_rate = phytium_dp->common_rates[index - 1]; + } else if (phytium_dp->link_lane_count > 1) { + phytium_dp->link_rate = phytium_dp->max_link_rate; + phytium_dp->link_lane_count = phytium_dp->link_lane_count >> 1; + } else { + phytium_dp->train_retry_count++; + phytium_dp->link_rate = phytium_dp->max_link_rate; + phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; + DRM_INFO("Retrying Link training for DP(%d) with maximal parameters\n", + phytium_dp->port); + ret = -1; + } + } + +out: + return ret; +} + +static int +phytium_dp_stop_link_train(struct phytium_dp_device *phytium_dp) +{ + int ret; + + /* config source and sink's train_pattern x: DP_TRAINING_PATTERN_DISABLE */ + phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); + + ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); + if (ret < 0) { + DRM_NOTE("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); + return ret; + } + + return 0; +} + +int phytium_dp_start_link_train(struct phytium_dp_device *phytium_dp) +{ + int ret = 0; + + phytium_dp_hw_disable_output(phytium_dp); + phytium_dp_hw_disable_input_source(phytium_dp); + phytium_dp_hw_disable_video(phytium_dp); + phytium_dp_hw_enable_input_source(phytium_dp); + phytium_dp_hw_enable_output(phytium_dp); + phytium_dp_dpcd_sink_dpms(phytium_dp, DRM_MODE_DPMS_OFF); + phytium_dp_dpcd_sink_dpms(phytium_dp, DRM_MODE_DPMS_ON); + + if (!phytium_dp_link_training_clock_recovery(phytium_dp)) + goto failure_handling; + + if (!phytium_dp_link_training_channel_equalization(phytium_dp)) + goto failure_handling; + + ret = phytium_dp_stop_link_train(phytium_dp); + if (ret < 0) { + DRM_NOTE("phytium_dp_stop_link_train failed: ret = %d\n", ret); + goto out; + } + + if (phytium_dp->trigger_train_fail) { + phytium_dp->trigger_train_fail--; + goto failure_handling; + } + phytium_dp->train_retry_count = 0; + + DRM_DEBUG_KMS("[CONNECTOR:%d:%s] Link Training Pass at Link Rate = %d, Lane count = %d\n", + phytium_dp->connector.base.id, + phytium_dp->connector.name, phytium_dp->link_rate, + phytium_dp->link_lane_count); + + return 0; + +failure_handling: + DRM_INFO("[CONNECTOR:%d:%s] Link Training failed at Link Rate = %d, Lane count = %d", + phytium_dp->connector.base.id, + phytium_dp->connector.name, + phytium_dp->link_rate, phytium_dp->link_lane_count); + + ret = phytium_dp_stop_link_train(phytium_dp); + if (ret < 0) { + DRM_NOTE("phytium_dp_stop_link_train failed: ret = %d\n", ret); + goto out; + } + + phytium_dp_get_link_train_fallback_values(phytium_dp); + if (phytium_dp->train_retry_count < 5) + schedule_work(&phytium_dp->train_retry_work); + else + DRM_ERROR("DP(%d) Link Training Unsuccessful, and stop Training\n", + phytium_dp->port); + +out: + return -1; +} + +static bool phytium_dp_needs_link_retrain(struct phytium_dp_device *phytium_dp) +{ + unsigned char link_status[DP_LINK_STATUS_SIZE]; + int ret = 0; + + /* get link status 0x202-0x207 */ + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, + link_status, DP_LINK_STATUS_SIZE); + if (ret < 0) { + DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); + return true; + } + + if ((phytium_dp->link_rate == 0) || (phytium_dp->link_lane_count == 0)) { + DRM_DEBUG_KMS("link_rate(%d) or lane_count(%d) is invalid\n", + phytium_dp->link_rate, phytium_dp->link_lane_count); + return true; + } + + /* Make sure clock is still ok */ + if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("Clock recovery check failed\n"); + return true; + } + + if (!drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("Channel EQ check failed\n"); + return true; + } + + if (!phytium_dp_hw_output_is_enable(phytium_dp)) { + DRM_DEBUG_KMS("check DP output enable failed\n"); + return true; + } + return false; +} + +static bool +phytium_dp_get_sink_irq(struct phytium_dp_device *phytium_dp, u8 *sink_irq_vector) +{ + return drm_dp_dpcd_readb(&phytium_dp->aux, DP_DEVICE_SERVICE_IRQ_VECTOR, + sink_irq_vector) == 1; +} + +static uint8_t phytium_dp_autotest_phy_pattern(struct phytium_dp_device *phytium_dp) +{ + union phytium_phy_tp phytium_phy_tp; + int ret; + unsigned char test_80_bit_pattern[ + (DP_TEST_80BIT_CUSTOM_PATTERN_79_72 - + DP_TEST_80BIT_CUSTOM_PATTERN_7_0)+1] = {0}; + unsigned char test_pattern; + unsigned int offset; + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) + offset = DP_TEST_PHY_PATTERN; +#else + offset = DP_PHY_TEST_PATTERN; +#endif + + ret = drm_dp_dpcd_read(&phytium_dp->aux, offset, + &phytium_phy_tp.raw, + sizeof(phytium_phy_tp)); + if (ret <= 0) { + DRM_DEBUG_KMS("Could not read DP_TEST_PHY_PATTERN\n"); + goto failed; + } + + test_pattern = phytium_phy_tp.bits.PATTERN; + + if (test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) { + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_TEST_80BIT_CUSTOM_PATTERN_7_0, + test_80_bit_pattern, + sizeof(test_80_bit_pattern)); + if (ret <= 0) { + DRM_DEBUG_KMS("Could not read DP_TEST_PHY_PATTERN\n"); + goto failed; + } + } + + /* config source and sink's link rate and link count */ + ret = phytium_dp_dpcd_get_tp_link(phytium_dp, &phytium_dp->compliance.test_lane_count, + &phytium_dp->compliance.test_link_rate); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_get_tp_link fail: ret:%d\n", ret); + goto failed; + } + + phytium_dp_hw_set_link(phytium_dp, phytium_dp->compliance.test_lane_count, + phytium_dp->compliance.test_link_rate); + ret = phytium_dp_dpcd_set_link(phytium_dp, phytium_dp->compliance.test_lane_count, + phytium_dp->compliance.test_link_rate); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_link fail: ret:%d\n", ret); + goto failed_dpcd_set_link; + } + + /* config source and sink's lane setting: voltage swing and pre-emphasis */ + ret = phytium_dp_dpcd_get_adjust_request(phytium_dp, + phytium_dp->compliance.test_lane_count); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_get_adjust_request fail: ret:%d\n", ret); + goto failed_dpcd_get_adjust_request; + } + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->compliance.test_link_rate, + phytium_dp->train_set[0]); + ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); + goto failed_dpcd_set_lane_setting; + } + + /* config test pattern */ + phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->compliance.test_lane_count, + test_pattern, test_80_bit_pattern, + sizeof(test_80_bit_pattern)); + ret = phytium_dp_dpcd_set_test_pattern(phytium_dp, test_pattern); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_test_pattern fail: ret:%d\n", ret); + goto failed_dpcd_set_tp; + } + + return DP_TEST_ACK; + +failed_dpcd_set_tp: + phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->compliance.test_lane_count, + PHYTIUM_PHY_TP_NONE, test_80_bit_pattern, + sizeof(test_80_bit_pattern)); +failed_dpcd_set_link: +failed_dpcd_set_lane_setting: +failed_dpcd_get_adjust_request: +failed: + return DP_TEST_NAK; +} + +static void phytium_dp_handle_test_request(struct phytium_dp_device *phytium_dp) +{ + uint8_t response = DP_TEST_NAK; + uint8_t request = 0; + int status; + + status = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_REQUEST, &request); + if (status <= 0) { + DRM_DEBUG_KMS("Could not read test request from sink\n"); + goto update_status; + } + + switch (request) { + case DP_TEST_LINK_TRAINING: + case DP_TEST_LINK_VIDEO_PATTERN: + case DP_TEST_LINK_EDID_READ: + DRM_DEBUG_KMS("Not support test request '%02x'\n", request); + response = DP_TEST_NAK; + break; + case DP_TEST_LINK_PHY_TEST_PATTERN: + DRM_DEBUG_KMS("PHY_PATTERN test requested\n"); + response = phytium_dp_autotest_phy_pattern(phytium_dp); + break; + default: + DRM_DEBUG_KMS("Invalid test request '%02x'\n", request); + break; + } + +update_status: + status = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TEST_RESPONSE, response); + if (status <= 0) + DRM_DEBUG_KMS("Could not write test response to sink\n"); + +} + +static int phytium_dp_long_pulse(struct drm_connector *connector, bool hpd_raw_state) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + enum drm_connector_status status = connector->status; + bool video_enable = false; + uint32_t index = 0; + + if (phytium_dp->is_edp) + status = connector_status_connected; + else if (hpd_raw_state) { + if (!phytium_dp_needs_link_retrain(phytium_dp)) { + status = connector_status_connected; + goto out; + } + } else { + status = connector_status_disconnected; + goto out; + } + + if (!phytium_dp->is_edp) { + status = phytium_dp_detect_dpcd(phytium_dp); + if (status == connector_status_disconnected) + goto out; + + index = phytium_dp->num_common_rates-1; + phytium_dp->max_link_rate = phytium_dp->common_rates[index]; + phytium_dp->max_link_lane_count = phytium_dp->common_max_lane_count; + phytium_dp->link_rate = phytium_dp->max_link_rate; + phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; + DRM_DEBUG_KMS("common_max_lane_count: %d, common_max_rate:%d\n", + phytium_dp->max_link_lane_count, phytium_dp->max_link_rate); + + video_enable = phytium_dp_hw_video_is_enable(phytium_dp); + phytium_dp_start_link_train(phytium_dp); + + if (video_enable) { + mdelay(2); + phytium_dp_hw_enable_video(phytium_dp); + } + } + +out: + return status; +} + +static int phytium_dp_short_pulse(struct drm_connector *connector) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + enum drm_connector_status status = connector->status; + u8 sink_irq_vector = 0; + bool video_enable = false; + + /* handle the test pattern */ + if (phytium_dp_get_sink_irq(phytium_dp, &sink_irq_vector) && + sink_irq_vector != 0) { + drm_dp_dpcd_writeb(&phytium_dp->aux, + DP_DEVICE_SERVICE_IRQ_VECTOR, + sink_irq_vector); + if (sink_irq_vector & DP_AUTOMATED_TEST_REQUEST) + phytium_dp_handle_test_request(phytium_dp); + if (sink_irq_vector & (DP_CP_IRQ | DP_SINK_SPECIFIC_IRQ)) + DRM_DEBUG_DRIVER("CP or sink specific irq unhandled\n"); + } + if (!phytium_dp_needs_link_retrain(phytium_dp)) { + status = connector_status_connected; + goto out; + } + + video_enable = phytium_dp_hw_video_is_enable(phytium_dp); + phytium_dp_start_link_train(phytium_dp); + if (video_enable) { + mdelay(2); + phytium_dp_hw_enable_video(phytium_dp); + } + +out: + return status; +} + +void phytium_dp_hpd_poll_handler(struct phytium_display_private *priv) +{ + struct drm_device *dev = priv->dev; + struct drm_connector_list_iter conn_iter; + struct drm_connector *connector; + enum drm_connector_status old_status; + bool changed = false; + + mutex_lock(&dev->mode_config.mutex); + DRM_DEBUG_KMS("running encoder hotplug poll functions\n"); + drm_connector_list_iter_begin(dev, &conn_iter); + drm_for_each_connector_iter(connector, &conn_iter) { + if (connector->force) + continue; + old_status = connector->status; + connector->status = drm_helper_probe_detect(connector, NULL, false); + if (old_status != connector->status) { + const char *old, *new; + + old = drm_get_connector_status_name(old_status); + new = drm_get_connector_status_name(connector->status); + DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n", + connector->base.id, + connector->name, + old, new); + changed = true; + } + } + drm_connector_list_iter_end(&conn_iter); + mutex_unlock(&dev->mode_config.mutex); + + if (changed) + drm_kms_helper_hotplug_event(dev); +} + +void phytium_dp_hpd_irq_setup(struct drm_device *dev, bool enable) +{ + struct phytium_dp_device *phytium_dp; + struct drm_encoder *encoder; + struct phytium_display_private *priv = dev->dev_private; + bool handler = false; + bool hpd_raw_state_old = false; + + /* We might have missed any hotplugs that happened, so polling and handler */ + if (enable) { + spin_lock_irq(&priv->hotplug_irq_lock); + + drm_for_each_encoder(encoder, dev) { + phytium_dp = encoder_to_dp_device(encoder); + if (!phytium_dp->dp_hpd_state.hpd_irq_enable) { + hpd_raw_state_old = phytium_dp->dp_hpd_state.hpd_raw_state; + phytium_dp_hw_get_hpd_state(phytium_dp); + if (phytium_dp->dp_hpd_state.hpd_event_state + || phytium_dp->dp_hpd_state.hpd_irq_state + || (hpd_raw_state_old != phytium_dp->dp_hpd_state.hpd_raw_state)) { + handler = true; + } + } + } + spin_unlock_irq(&priv->hotplug_irq_lock); + if (handler) + phytium_dp_hpd_poll_handler(priv); + } + + drm_for_each_encoder(encoder, dev) { + phytium_dp = encoder_to_dp_device(encoder); + phytium_dp_hw_hpd_irq_setup(phytium_dp, enable); + } +} + +void phytium_dp_hpd_work_func(struct work_struct *work) +{ + struct phytium_display_private *priv = + container_of(work, struct phytium_display_private, hotplug_work); + struct drm_device *dev = priv->dev; + struct drm_connector_list_iter conn_iter; + struct drm_connector *connector; + enum drm_connector_status old_status; + bool changed = false; + + mutex_lock(&dev->mode_config.mutex); + DRM_DEBUG_KMS("running encoder hotplug work functions\n"); + drm_connector_list_iter_begin(dev, &conn_iter); + drm_for_each_connector_iter(connector, &conn_iter) { + if (connector->force) + continue; + old_status = connector->status; + connector->status = drm_helper_probe_detect(connector, NULL, false); + if (old_status != connector->status) { + const char *old, *new; + + old = drm_get_connector_status_name(old_status); + new = drm_get_connector_status_name(connector->status); + DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n", + connector->base.id, + connector->name, + old, new); + changed = true; + } + } + drm_connector_list_iter_end(&conn_iter); + mutex_unlock(&dev->mode_config.mutex); + + if (changed) + drm_kms_helper_hotplug_event(dev); + + phytium_dp_hpd_irq_setup(dev, true); +} + +irqreturn_t phytium_dp_hpd_irq_handler(struct phytium_display_private *priv) +{ + struct drm_encoder *encoder = NULL; + struct phytium_dp_device *phytium_dp = NULL; + struct drm_device *dev = priv->dev; + bool handler = false; + + spin_lock(&priv->hotplug_irq_lock); + + drm_for_each_encoder(encoder, dev) { + phytium_dp = encoder_to_dp_device(encoder); + if (phytium_dp->dp_hpd_state.hpd_irq_enable) { + phytium_dp_hw_get_hpd_state(phytium_dp); + if (phytium_dp->dp_hpd_state.hpd_event_state + || phytium_dp->dp_hpd_state.hpd_irq_state) { + handler = true; + } + } + } + spin_unlock(&priv->hotplug_irq_lock); + + if (handler) { + phytium_dp_hpd_irq_setup(dev, false); + schedule_work(&priv->hotplug_work); + return IRQ_HANDLED; + } + return IRQ_NONE; +} + + +static void phytium_dp_fast_link_train_detect(struct phytium_dp_device *phytium_dp) +{ + phytium_dp->fast_train_support = !!(phytium_dp->dpcd[DP_MAX_DOWNSPREAD] + & DP_NO_AUX_HANDSHAKE_LINK_TRAINING); + DRM_DEBUG_KMS("fast link training %s\n", + phytium_dp->fast_train_support ? "supported" : "unsupported"); +} + +bool phytium_dp_fast_link_train(struct phytium_dp_device *phytium_dp) +{ + int ret = 0; + unsigned int training_pattern; + + /* clear the test pattern */ + phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->link_lane_count, + PHYTIUM_PHY_TP_NONE, NULL, 0); + + /* config source and sink's link rate and lane count */ + phytium_dp_hw_set_link(phytium_dp, phytium_dp->link_lane_count, phytium_dp->link_rate); + + /* config source and sink's voltage swing and pre-emphasis(103-106) */ + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, + phytium_dp->train_set[0]); + + /* config train pattern */ + phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); + usleep_range(500, 600); + + training_pattern = phytium_dp_get_training_pattern(phytium_dp); + phytium_dp_hw_set_train_pattern(phytium_dp, training_pattern); + usleep_range(500, 600); + + phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); + + if (dc_fast_training_check) { + unsigned char link_status[DP_LINK_STATUS_SIZE]; + + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, + link_status, DP_LINK_STATUS_SIZE); + if (ret < 0) { + DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); + return false; + } + + if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("check clock recovery failed\n"); + return false; + } + + if (!drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("check channel equalization failed\n"); + return false; + } + } + + return true; +} + +static enum drm_connector_status +phytium_connector_detect(struct drm_connector *connector, bool force) +{ + enum drm_connector_status status = connector->status; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + bool hpd_event_state, hpd_irq_state, hpd_raw_state; + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + bool plugged = true; + + spin_lock_irq(&priv->hotplug_irq_lock); + hpd_event_state = phytium_dp->dp_hpd_state.hpd_event_state; + hpd_irq_state = phytium_dp->dp_hpd_state.hpd_irq_state; + hpd_raw_state = phytium_dp->dp_hpd_state.hpd_raw_state; + phytium_dp->dp_hpd_state.hpd_event_state = false; + phytium_dp->dp_hpd_state.hpd_irq_state = false; + spin_unlock_irq(&priv->hotplug_irq_lock); + + if (hpd_event_state) + status = phytium_dp_long_pulse(connector, hpd_raw_state); + + if (hpd_irq_state) + status = phytium_dp_short_pulse(connector); + + if (status == connector_status_unknown) + status = connector_status_disconnected; + + if ((!phytium_dp->is_edp) && (!hpd_raw_state)) + status = connector_status_disconnected; + + if (connector->status != status) { + if ((status == connector_status_connected) && phytium_dp->has_audio) + plugged = true; + else + plugged = false; + + handle_plugged_change(phytium_dp, plugged); + } + + return status; +} + +static void +phytium_connector_destroy(struct drm_connector *connector) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + drm_connector_cleanup(connector); + kfree(phytium_dp); +} + +static int +phytium_dp_connector_register(struct drm_connector *connector) +{ + int ret; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + phytium_dp_aux_init(phytium_dp); + if (phytium_dp->is_edp) { + phytium_edp_init_connector(phytium_dp); + ret = phytium_edp_backlight_device_register(phytium_dp); + if (ret) + DRM_ERROR("failed to register port(%d) backlight device(ret=%d)\n", + phytium_dp->port, ret); + } + + ret = phytium_debugfs_connector_add(connector); + if (ret) + DRM_ERROR("failed to register phytium connector debugfs(ret=%d)\n", ret); + + return 0; +} + +static void +phytium_dp_connector_unregister(struct drm_connector *connector) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + if (phytium_dp->is_edp) { + phytium_edp_backlight_device_unregister(phytium_dp); + phytium_edp_fini_connector(phytium_dp); + } + drm_dp_aux_unregister(&phytium_dp->aux); +} + +static const struct drm_connector_funcs phytium_connector_funcs = { + .dpms = drm_helper_connector_dpms, + .detect = phytium_connector_detect, + .fill_modes = drm_helper_probe_single_connector_modes, + .destroy = phytium_connector_destroy, + .reset = drm_atomic_helper_connector_reset, + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, + .late_register = phytium_dp_connector_register, + .early_unregister = phytium_dp_connector_unregister, +}; + +static void phytium_dp_encoder_mode_set(struct drm_encoder *encoder, + struct drm_display_mode *mode, + struct drm_display_mode *adjusted) +{ + struct phytium_dp_device *dp = encoder_to_dp_device(encoder); + + drm_mode_copy(&dp->mode, adjusted); +} + +static void phytium_edp_panel_poweron(struct phytium_dp_device *phytium_dp) +{ + phytium_panel_poweron(&phytium_dp->panel); +} + +static void phytium_edp_panel_poweroff(struct phytium_dp_device *phytium_dp) +{ + phytium_panel_poweroff(&phytium_dp->panel); +} + +static void phytium_edp_backlight_on(struct phytium_dp_device *phytium_dp) +{ + phytium_panel_enable_backlight(&phytium_dp->panel); +} + +static void phytium_edp_backlight_off(struct phytium_dp_device *phytium_dp) +{ + phytium_panel_disable_backlight(&phytium_dp->panel); +} + +static void phytium_encoder_disable(struct drm_encoder *encoder) +{ + struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); + + if (phytium_dp->is_edp) + phytium_edp_backlight_off(phytium_dp); + + phytium_dp_hw_disable_video(phytium_dp); + + mdelay(50); + + if (phytium_dp->is_edp) + phytium_edp_panel_poweroff(phytium_dp); +} + +void phytium_dp_adjust_link_train_parameter(struct phytium_dp_device *phytium_dp) +{ + struct drm_display_info *display_info = &phytium_dp->connector.display_info; + unsigned long link_bw, date_rate = 0, bs_limit, bs_request; + int rate = 0; + + bs_request = phytium_dp->mode.crtc_htotal/(phytium_dp->mode.crtc_clock/1000); + date_rate = (phytium_dp->mode.crtc_clock * display_info->bpc * 3)/8; + + for (;;) { + bs_limit = 8192 / (phytium_dp->link_rate/1000); + link_bw = phytium_dp->link_rate * phytium_dp->link_lane_count; + rate = 10 * date_rate / link_bw; + DRM_DEBUG_KMS("adjust link rate(%d), lane count(%d)\n", + phytium_dp->link_rate, phytium_dp->link_lane_count); + DRM_DEBUG_KMS("for crtc_clock(%d) bs_request(%ld) bs_limit(%ld) rate(%d)\n", + phytium_dp->mode.crtc_clock, bs_request, bs_limit, rate); + if ((link_dynamic_adjust && (bs_request < bs_limit) && rate < 10) || + ((!link_dynamic_adjust) && (rate < 10))) + break; + phytium_dp_get_link_train_fallback_values(phytium_dp); + } + + DRM_DEBUG_KMS("Try link training at Link Rate = %d, Lane count = %d\n", + phytium_dp->link_rate, phytium_dp->link_lane_count); +} + +static void phytium_encoder_enable(struct drm_encoder *encoder) +{ + struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); + int ret = 0; + + phytium_dp_hw_disable_video(phytium_dp); + + if (phytium_dp->is_edp) { + phytium_edp_panel_poweron(phytium_dp); + if (phytium_dp->fast_train_support) + phytium_dp_fast_link_train(phytium_dp); + else + ret = phytium_dp_start_link_train(phytium_dp); + mdelay(2); + phytium_dp_fast_link_train_detect(phytium_dp); + } else { + phytium_dp_adjust_link_train_parameter(phytium_dp); + ret = phytium_dp_start_link_train(phytium_dp); + mdelay(2); + } + + phytium_dp_hw_config_video(phytium_dp); + if (ret == 0) { + phytium_dp_hw_enable_video(phytium_dp); + if (phytium_dp->has_audio) + phytium_dp_hw_enable_audio(phytium_dp); + } + + if (phytium_dp->is_edp) { + phytium_edp_backlight_on(phytium_dp); + } +} + +enum drm_mode_status +phytium_encoder_mode_valid(struct drm_encoder *encoder, const struct drm_display_mode *mode) +{ + struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); + struct drm_display_info *display_info = &phytium_dp->connector.display_info; + unsigned int requested, actual; + + switch (display_info->bpc) { + case 10: + case 6: + case 8: + break; + default: + DRM_DEBUG_KMS("not support bpc(%d)\n", display_info->bpc); + display_info->bpc = 8; + break; + } + + if ((display_info->color_formats & DRM_COLOR_FORMAT_RGB444) == 0) { + DRM_DEBUG_KMS("not support color_format(%d)\n", display_info->color_formats); + display_info->color_formats = DRM_COLOR_FORMAT_RGB444; + } + + requested = mode->clock * display_info->bpc * 3 / 1000; + actual = phytium_dp->max_link_rate * phytium_dp->max_link_lane_count / 100; + actual = actual * 8 / 10; + if (requested >= actual) { + DRM_DEBUG_KMS("requested=%d, actual=%d, clock=%d\n", requested, actual, + mode->clock); + return MODE_CLOCK_HIGH; + } + + if (dc_fake_mode_enable && + (phytium_dp->native_mode.clock == mode->clock) && + (phytium_dp->native_mode.htotal == mode->htotal) && + (phytium_dp->native_mode.vtotal == mode->vtotal)) + return MODE_OK; + + if ((mode->hdisplay == 1600) && (mode->vdisplay == 900)) + return MODE_BAD_HVALUE; + + if ((mode->hdisplay == 1024) && (mode->clock > 78000)) + return MODE_BAD_HVALUE; + + if ((mode->hdisplay < 640) || (mode->vdisplay < 480)) + return MODE_BAD_HVALUE; + + return MODE_OK; +} + +static const struct drm_encoder_helper_funcs phytium_encoder_helper_funcs = { + .mode_set = phytium_dp_encoder_mode_set, + .disable = phytium_encoder_disable, + .enable = phytium_encoder_enable, + .mode_valid = phytium_encoder_mode_valid, +}; + +void phytium_dp_encoder_destroy(struct drm_encoder *encoder) +{ + struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); + + phytium_dp_audio_codec_fini(phytium_dp); + drm_encoder_cleanup(encoder); +} + +static const struct drm_encoder_funcs phytium_encoder_funcs = { + .destroy = phytium_dp_encoder_destroy, +}; + +static const struct dp_audio_n_m phytium_dp_audio_n_m[] = { + { 32000, 162000, 1024, 10125 }, + { 44100, 162000, 784, 5625 }, + { 48000, 162000, 512, 3375 }, + { 64000, 162000, 2048, 10125 }, + { 88200, 162000, 1568, 5625 }, + { 96000, 162000, 1024, 3375 }, + { 128000, 162000, 4096, 10125 }, + { 176400, 162000, 3136, 5625 }, + { 192000, 162000, 2048, 3375 }, + { 32000, 270000, 1024, 16875 }, + { 44100, 270000, 784, 9375 }, + { 48000, 270000, 512, 5625 }, + { 64000, 270000, 2048, 16875 }, + { 88200, 270000, 1568, 9375 }, + { 96000, 270000, 1024, 5625 }, + { 128000, 270000, 4096, 16875 }, + { 176400, 270000, 3136, 9375 }, + { 192000, 270000, 2048, 5625 }, + { 32000, 540000, 1024, 33750 }, + { 44100, 540000, 784, 18750 }, + { 48000, 540000, 512, 11250 }, + { 64000, 540000, 2048, 33750 }, + { 88200, 540000, 1568, 18750 }, + { 96000, 540000, 1024, 11250 }, + { 128000, 540000, 4096, 33750 }, + { 176400, 540000, 3136, 18750 }, + { 192000, 540000, 2048, 11250 }, + { 32000, 810000, 1024, 50625 }, + { 44100, 810000, 784, 28125 }, + { 48000, 810000, 512, 16875 }, + { 64000, 810000, 2048, 50625 }, + { 88200, 810000, 1568, 28125 }, + { 96000, 810000, 1024, 16875 }, + { 128000, 810000, 4096, 50625 }, + { 176400, 810000, 3136, 28125 }, + { 192000, 810000, 2048, 16875 }, +}; + +static int phytium_dp_audio_get_eld(struct device *dev, void *data, u8 *buf, size_t len) +{ + struct phytium_dp_device *phytium_dp = data; + + memcpy(buf, phytium_dp->connector.eld, min(sizeof(phytium_dp->connector.eld), len)); + + return 0; +} + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) +static int phytium_dp_audio_digital_mute(struct device *dev, void *data, bool enable) +{ + struct phytium_dp_device *phytium_dp = data; + + phytium_dp_hw_audio_digital_mute(phytium_dp, enable); + + return 0; +} +#else +static int phytium_dp_audio_mute_stream(struct device *dev, void *data, bool enable, int direction) +{ + struct phytium_dp_device *phytium_dp = data; + + phytium_dp_hw_audio_digital_mute(phytium_dp, enable); + + return 0; +} +#endif + +const struct dp_audio_n_m *phytium_dp_audio_get_n_m(int link_rate, int sample_rate) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(phytium_dp_audio_n_m); i++) { + if (sample_rate == phytium_dp_audio_n_m[i].sample_rate + && link_rate == phytium_dp_audio_n_m[i].link_rate) + return &phytium_dp_audio_n_m[i]; + } + + return NULL; +} + +static int phytium_dp_audio_hw_params(struct device *dev, void *data, + struct hdmi_codec_daifmt *daifmt, + struct hdmi_codec_params *params) +{ + struct phytium_dp_device *phytium_dp = data; + int ret = 0; + struct audio_info audio_info = { + .sample_width = params->sample_width, + .sample_rate = params->sample_rate, + .channels = params->channels, + }; + + if (daifmt->fmt != HDMI_I2S) { + DRM_ERROR("invalid audio format %d\n", daifmt->fmt); + ret = -EINVAL; + goto failed; + } + + ret = phytium_dp_hw_audio_hw_params(phytium_dp, audio_info); + +failed: + return ret; +} + +static void phytium_dp_audio_shutdown(struct device *dev, void *data) +{ + struct phytium_dp_device *phytium_dp = data; + + phytium_dp_hw_audio_shutdown(phytium_dp); +} + +static void handle_plugged_change(struct phytium_dp_device *phytium_dp, bool plugged) +{ + if (phytium_dp->plugged_cb && phytium_dp->codec_dev) + phytium_dp->plugged_cb(phytium_dp->codec_dev, plugged); +} + +static int phytium_dp_audio_hook_plugged_cb(struct device *dev, void *data, + hdmi_codec_plugged_cb fn, + struct device *codec_dev) +{ + struct phytium_dp_device *phytium_dp = data; + bool plugged; + + phytium_dp->plugged_cb = fn; + phytium_dp->codec_dev = codec_dev; + + if ((phytium_dp->connector.status == connector_status_connected) && phytium_dp->has_audio) + plugged = true; + else + plugged = false; + + handle_plugged_change(phytium_dp, plugged); + return 0; +} + + +static const struct hdmi_codec_ops phytium_audio_codec_ops = { + .hw_params = phytium_dp_audio_hw_params, + .audio_shutdown = phytium_dp_audio_shutdown, +#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) + .digital_mute = phytium_dp_audio_digital_mute, +#else + .mute_stream = phytium_dp_audio_mute_stream, +#endif + .get_eld = phytium_dp_audio_get_eld, + .hook_plugged_cb = phytium_dp_audio_hook_plugged_cb, +}; + +static int phytium_dp_audio_codec_init(struct phytium_dp_device *phytium_dp) +{ + struct device *dev = phytium_dp->dev->dev; + struct hdmi_codec_pdata codec_data = { + .i2s = 1, + .spdif = 0, + .ops = &phytium_audio_codec_ops, + .max_i2s_channels = 2, + .data = phytium_dp, + }; + + phytium_dp->audio_pdev = platform_device_register_data(dev, HDMI_CODEC_DRV_NAME, + codec_id, + &codec_data, sizeof(codec_data)); + + if (!PTR_ERR_OR_ZERO(phytium_dp->audio_pdev)) + codec_id += 1; + + return PTR_ERR_OR_ZERO(phytium_dp->audio_pdev); +} + +static void phytium_dp_audio_codec_fini(struct phytium_dp_device *phytium_dp) +{ + if (!PTR_ERR_OR_ZERO(phytium_dp->audio_pdev)) + platform_device_unregister(phytium_dp->audio_pdev); + phytium_dp->audio_pdev = NULL; + codec_id -= 1; +} + +static long phytium_dp_aux_transfer(struct drm_dp_aux *aux, struct drm_dp_aux_msg *msg) +{ + struct phytium_dp_device *phytium_dp = container_of(aux, struct phytium_dp_device, aux); + long ret = 0; + + DRM_DEBUG_KMS("msg->size: 0x%lx\n", msg->size); + + if (WARN_ON(msg->size > 16)) + return -E2BIG; + + switch (msg->request & ~DP_AUX_I2C_MOT) { + case DP_AUX_NATIVE_WRITE: + case DP_AUX_I2C_WRITE: + case DP_AUX_I2C_WRITE_STATUS_UPDATE: + ret = phytium_dp_hw_aux_transfer_write(phytium_dp, msg); + DRM_DEBUG_KMS("aux write reply:0x%x ret:0x%lx\n", msg->reply, ret); + break; + case DP_AUX_NATIVE_READ: + case DP_AUX_I2C_READ: + ret = phytium_dp_hw_aux_transfer_read(phytium_dp, msg); + DRM_DEBUG_KMS("aux read ret:0x%lx\n", ret); + break; + default: + ret = -EINVAL; + break; + } + + return ret; +} + +static void phytium_dp_aux_init(struct phytium_dp_device *phytium_dp) +{ + drm_dp_aux_init(&phytium_dp->aux); + phytium_dp->aux.name = kasprintf(GFP_KERNEL, "dp-%d", phytium_dp->port); + phytium_dp->aux.transfer = phytium_dp_aux_transfer; +} + +int phytium_get_encoder_crtc_mask(struct phytium_dp_device *phytium_dp, int port) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int i, mask = 0; + + for_each_pipe_masked(priv, i) { + if (i != port) + mask++; + else + break; + } + + return BIT(mask); +} + +static bool phytium_dp_is_edp(struct phytium_dp_device *phytium_dp, int port) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + + if (priv->info.edp_mask & BIT(port)) + return true; + else + return false; +} + +static bool phytium_edp_init_connector(struct phytium_dp_device *phytium_dp) +{ + enum drm_connector_status status; + struct drm_connector *connector = &phytium_dp->connector; + + phytium_edp_panel_poweron(phytium_dp); + + status = phytium_dp_detect_dpcd(phytium_dp); + if (status == connector_status_disconnected) { + DRM_ERROR("detect edp dpcd failed\n"); + return false; + } + + phytium_dp->edp_edid = drm_get_edid(connector, &phytium_dp->aux.ddc); + if (!phytium_dp->edp_edid) { + DRM_ERROR("get edp edid failed\n"); + return false; + } + + connector->status = status; + phytium_dp->max_link_rate = phytium_dp->common_rates[phytium_dp->num_common_rates-1]; + phytium_dp->max_link_lane_count = phytium_dp->common_max_lane_count; + phytium_dp->link_rate = phytium_dp->max_link_rate; + phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; + DRM_DEBUG_KMS("common_max_lane_count: %d, common_max_rate:%d\n", + phytium_dp->max_link_lane_count, phytium_dp->max_link_rate); + + return true; +} + +static void phytium_edp_fini_connector(struct phytium_dp_device *phytium_dp) +{ + if (phytium_dp->edp_edid) + kfree(phytium_dp->edp_edid); + + phytium_dp->edp_edid = NULL; + phytium_edp_panel_poweroff(phytium_dp); + + return; +} + +int phytium_dp_resume(struct drm_device *drm_dev) +{ + struct phytium_dp_device *phytium_dp; + struct drm_encoder *encoder; + int ret = 0; + + drm_for_each_encoder(encoder, drm_dev) { + phytium_dp = encoder_to_dp_device(encoder); + if (phytium_dp->is_edp) { + phytium_edp_backlight_off(phytium_dp); + phytium_edp_panel_poweroff(phytium_dp); + } + ret = phytium_dp_hw_init(phytium_dp); + if (ret) { + DRM_ERROR("failed to initialize dp %d\n", phytium_dp->port); + return -EIO; + } + } + + return 0; +} + +int phytium_dp_init(struct drm_device *dev, int port) +{ + struct phytium_display_private *priv = dev->dev_private; + struct phytium_dp_device *phytium_dp = NULL; + int ret, type; + + DRM_DEBUG_KMS("%s: port %d\n", __func__, port); + phytium_dp = kzalloc(sizeof(*phytium_dp), GFP_KERNEL); + if (!phytium_dp) { + ret = -ENOMEM; + goto failed_malloc_dp; + } + + phytium_dp->dev = dev; + phytium_dp->port = port; + + if (IS_PX210(priv)) { + px210_dp_func_register(phytium_dp); + priv->dp_reg_base[port] = PX210_DP_BASE(port); + priv->phy_access_base[port] = PX210_PHY_ACCESS_BASE(port); + } else if (IS_PE220X(priv)) { + pe220x_dp_func_register(phytium_dp); + priv->dp_reg_base[port] = PE220X_DP_BASE(port); + priv->phy_access_base[port] = PE220X_PHY_ACCESS_BASE(port); + } + + if (phytium_dp_is_edp(phytium_dp, port)) { + phytium_dp->is_edp = true; + type = DRM_MODE_CONNECTOR_eDP; + phytium_dp->pwm = priv->info.pwm; + phytium_dp_panel_init_backlight_funcs(phytium_dp); + phytium_edp_backlight_off(phytium_dp); + phytium_edp_panel_poweroff(phytium_dp); + } else { + phytium_dp->is_edp = false; + type = DRM_MODE_CONNECTOR_DisplayPort; + } + + ret = phytium_dp_hw_init(phytium_dp); + if (ret) { + DRM_ERROR("failed to initialize dp %d\n", phytium_dp->port); + goto failed_init_dp; + } + + ret = drm_encoder_init(dev, &phytium_dp->encoder, + &phytium_encoder_funcs, + DRM_MODE_ENCODER_TMDS, "DP %d", port); + if (ret) { + DRM_ERROR("failed to initialize encoder with drm\n"); + goto failed_encoder_init; + } + drm_encoder_helper_add(&phytium_dp->encoder, &phytium_encoder_helper_funcs); + phytium_dp->encoder.possible_crtcs = phytium_get_encoder_crtc_mask(phytium_dp, port); + + phytium_dp->connector.dpms = DRM_MODE_DPMS_OFF; + phytium_dp->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; + ret = drm_connector_init(dev, &phytium_dp->connector, &phytium_connector_funcs, + type); + if (ret) { + DRM_ERROR("failed to initialize connector with drm\n"); + goto failed_connector_init; + } + drm_connector_helper_add(&phytium_dp->connector, &phytium_connector_helper_funcs); + drm_connector_attach_encoder(&phytium_dp->connector, &phytium_dp->encoder); + + ret = phytium_dp_audio_codec_init(phytium_dp); + if (ret) { + DRM_ERROR("failed to initialize audio codec\n"); + goto failed_connector_init; + } + + phytium_dp->train_retry_count = 0; + INIT_WORK(&phytium_dp->train_retry_work, phytium_dp_train_retry_work_fn); + drm_connector_register(&phytium_dp->connector); + + return 0; +failed_connector_init: +failed_encoder_init: +failed_init_dp: + kfree(phytium_dp); +failed_malloc_dp: + return ret; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_dp.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_dp.h new file mode 100644 index 0000000000000000000000000000000000000000..bbcf133d66638b6e3ff7ffdfd2e58e37d228fe60 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_dp.h @@ -0,0 +1,156 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_DP_H__ +#define __PHYTIUM_DP_H__ + +#include +#include +#include + +struct phytium_dp_device; + +#include "phytium_panel.h" + +struct audio_info { + int sample_rate; + int channels; + int sample_width; +}; + +struct dp_audio_n_m { + int sample_rate; + int link_rate; + u16 m; + u16 n; +}; + +struct phytium_dp_compliance { + unsigned long test_type; + uint32_t test_link_rate; + u8 test_lane_count; + bool test_active; + u8 reserve[2]; +}; + +struct phytium_dp_func { + uint8_t (*dp_hw_get_source_lane_count)(struct phytium_dp_device *phytium_dp); + int (*dp_hw_reset)(struct phytium_dp_device *phytium_dp); + bool (*dp_hw_spread_is_enable)(struct phytium_dp_device *phytium_dp); + int (*dp_hw_set_backlight)(struct phytium_dp_device *phytium_dp, uint32_t level); + uint32_t (*dp_hw_get_backlight)(struct phytium_dp_device *phytium_dp); + void (*dp_hw_disable_backlight)(struct phytium_dp_device *phytium_dp); + void (*dp_hw_enable_backlight)(struct phytium_dp_device *phytium_dp); + void (*dp_hw_poweroff_panel)(struct phytium_dp_device *phytium_dp); + void (*dp_hw_poweron_panel)(struct phytium_dp_device *phytium_dp); + int (*dp_hw_init_phy)(struct phytium_dp_device *phytium_dp); + void (*dp_hw_set_phy_lane_setting)(struct phytium_dp_device *phytium_dp, + uint32_t link_rate, uint8_t train_set); + int (*dp_hw_set_phy_lane_and_rate)(struct phytium_dp_device *phytium_dp, + uint8_t link_lane_count, + uint32_t link_rate); +}; + +struct phytium_dp_hpd_state { + bool hpd_event_state; + bool hpd_irq_state; + bool hpd_raw_state; + bool hpd_irq_enable; +}; + +struct phytium_dp_device { + struct drm_device *dev; + struct drm_encoder encoder; + struct drm_connector connector; + int port; + struct drm_display_mode mode; + bool link_trained; + bool detect_done; + bool is_edp; + bool reserve0; + struct drm_dp_aux aux; + unsigned char dpcd[DP_RECEIVER_CAP_SIZE]; + uint8_t edp_dpcd[EDP_DISPLAY_CTL_CAP_SIZE]; + unsigned char downstream_ports[DP_MAX_DOWNSTREAM_PORTS]; + unsigned char sink_count; + + int *source_rates; + int num_source_rates; + int sink_rates[DP_MAX_SUPPORTED_RATES]; + int num_sink_rates; + int common_rates[DP_MAX_SUPPORTED_RATES]; + int num_common_rates; + + int source_max_lane_count; + int sink_max_lane_count; + int common_max_lane_count; + + int max_link_rate; + int max_link_lane_count; + int link_rate; + int link_lane_count; + struct work_struct train_retry_work; + int train_retry_count; + uint32_t trigger_train_fail; + + unsigned char train_set[4]; + struct edid *edp_edid; + bool has_audio; + bool fast_train_support; + bool hw_spread_enable; + bool reserve[1]; + struct platform_device *audio_pdev; + struct audio_info audio_info; + hdmi_codec_plugged_cb plugged_cb; + struct device *codec_dev; + struct phytium_dp_compliance compliance; + struct phytium_dp_func *funcs; + struct phytium_dp_hpd_state dp_hpd_state; + + struct phytium_panel panel; + struct drm_display_mode native_mode; + struct pwm_device *pwm; +}; + +union phytium_phy_tp { + struct { + /* DpcdPhyTestPatterns. This field is 2 bits for DP1.1 + * and 3 bits for DP1.2. + */ + uint8_t PATTERN :3; + uint8_t RESERVED :5; + } bits; + uint8_t raw; +}; + +/* PHY test patterns + * The order of test patterns follows DPCD register PHY_TEST_PATTERN (0x248) + */ +enum phytium_dpcd_phy_tp { + PHYTIUM_PHY_TP_NONE = 0, + PHYTIUM_PHY_TP_D10_2, + PHYTIUM_PHY_TP_SYMBOL_ERROR, + PHYTIUM_PHY_TP_PRBS7, + PHYTIUM_PHY_TP_80BIT_CUSTOM, + PHYTIUM_PHY_TP_CP2520_1, + PHYTIUM_PHY_TP_CP2520_2, + PHYTIUM_PHY_TP_CP2520_3, +}; +#define PHYTIUM_DP_AUDIO_ID (('P' << 24) + ('H' << 16) + ('Y' << 8)) +#define encoder_to_dp_device(x) container_of(x, struct phytium_dp_device, encoder) +#define connector_to_dp_device(x) container_of(x, struct phytium_dp_device, connector) +#define panel_to_dp_device(x) container_of(x, struct phytium_dp_device, panel) +#define train_retry_to_dp_device(x) container_of(x, struct phytium_dp_device, train_retry_work) +void phytium_phy_writel(struct phytium_dp_device *phytium_dp, uint32_t address, uint32_t data); +uint32_t phytium_phy_readl(struct phytium_dp_device *phytium_dp, uint32_t address); + +int phytium_dp_init(struct drm_device *dev, int pipe); +int phytium_dp_resume(struct drm_device *drm_dev); +void phytium_dp_hpd_irq_setup(struct drm_device *dev, bool enable); +irqreturn_t phytium_dp_hpd_irq_handler(struct phytium_display_private *priv); +void phytium_dp_hpd_work_func(struct work_struct *work); +const struct dp_audio_n_m *phytium_dp_audio_get_n_m(int link_rate, int sample_rate); +#endif /* __PHYTIUM_DP_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fb.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fb.c new file mode 100644 index 0000000000000000000000000000000000000000..feb17920a9861a45dc822fec7e0ee668ba4aaf18 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fb.c @@ -0,0 +1,146 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_fb.h" +#include "phytium_gem.h" + +static int +phytium_fb_create_handle(struct drm_framebuffer *fb, struct drm_file *file_priv, + unsigned int *handle) +{ + struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); + + return drm_gem_handle_create(file_priv, &phytium_fb->phytium_gem_obj[0]->base, handle); +} + +static void phytium_fb_destroy(struct drm_framebuffer *fb) +{ + struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); + int i, num_planes; + struct drm_gem_object *obj = NULL; + const struct drm_format_info *info; + + info = drm_format_info(fb->format->format); + num_planes = info ? info->num_planes : 1; + + for (i = 0; i < num_planes; i++) { + obj = &phytium_fb->phytium_gem_obj[i]->base; + if (obj) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) + drm_gem_object_put(obj); +#else + drm_gem_object_unreference_unlocked(obj); +#endif + } + + drm_framebuffer_cleanup(fb); + kfree(phytium_fb); +} + +static struct drm_framebuffer_funcs viv_fb_funcs = { + .create_handle = phytium_fb_create_handle, + .destroy = phytium_fb_destroy, +}; + +struct phytium_framebuffer * +phytium_fb_alloc(struct drm_device *dev, const struct drm_mode_fb_cmd2 *mode_cmd, + struct phytium_gem_object **phytium_gem_obj, unsigned int num_planes) +{ + struct phytium_framebuffer *phytium_fb; + int ret = 0, i; + + phytium_fb = kzalloc(sizeof(*phytium_fb), GFP_KERNEL); + if (!phytium_fb) + return ERR_PTR(-ENOMEM); + + drm_helper_mode_fill_fb_struct(dev, &phytium_fb->base, mode_cmd); + + /* In UEFI, efifb may also use dc hardware, remove it and use dcdrmfb */ + drm_fb_helper_remove_conflicting_framebuffers(NULL, "dcdrmfb", false); + + ret = drm_framebuffer_init(dev, &phytium_fb->base, &viv_fb_funcs); + + if (ret) { + DRM_ERROR("Failed to initialize framebuffer: %d\n", ret); + kfree(phytium_fb); + return ERR_PTR(ret); + } + + for (i = 0; i < num_planes; i++) { + phytium_fb->phytium_gem_obj[i] = phytium_gem_obj[i]; + phytium_fb->base.obj[i] = &phytium_gem_obj[i]->base; + } + return phytium_fb; +} + +struct drm_framebuffer * +phytium_fb_create(struct drm_device *dev, struct drm_file *file_priv, + const struct drm_mode_fb_cmd2 *mode_cmd) +{ + int ret = 0, i, num_planes; + struct drm_gem_object *obj; + unsigned int hsub, vsub, size; + struct phytium_gem_object *phytium_gem_obj[PHYTIUM_FORMAT_MAX_PLANE] = {0}; + struct phytium_framebuffer *phytium_fb; + struct phytium_display_private *priv = dev->dev_private; + const struct drm_format_info *info; + + info = drm_format_info(mode_cmd->pixel_format); + hsub = info ? info->hsub : 1; + vsub = info ? info->vsub : 1; + num_planes = info ? info->num_planes : 1; + num_planes = min(num_planes, PHYTIUM_FORMAT_MAX_PLANE); + + for (i = 0; i < num_planes; i++) { + unsigned int height = mode_cmd->height / (i ? vsub : 1); + + size = height * mode_cmd->pitches[i] + mode_cmd->offsets[i]; + obj = drm_gem_object_lookup(file_priv, mode_cmd->handles[i]); + if (!obj) { + DRM_ERROR("Failed to lookup GEM object\n"); + ret = -ENXIO; + goto error; + } + + if (obj->size < size) { +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) + drm_gem_object_put(obj); +#else + drm_gem_object_unreference_unlocked(obj); +#endif + ret = -EINVAL; + goto error; + } + + phytium_gem_obj[i] = to_phytium_gem_obj(obj); + + ret = priv->dc_hw_fb_format_check(mode_cmd, i); + if (ret < 0) + goto error; + } + + phytium_fb = phytium_fb_alloc(dev, mode_cmd, phytium_gem_obj, i); + if (IS_ERR(phytium_fb)) { + DRM_DEBUG_KMS("phytium_fb_alloc failed\n"); + ret = PTR_ERR(phytium_fb); + goto error; + } + + return &phytium_fb->base; +error: + for (i--; i >= 0; i--) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) + drm_gem_object_put(&phytium_gem_obj[i]->base); +#else + drm_gem_object_unreference_unlocked(&phytium_gem_obj[i]->base); +#endif + + return ERR_PTR(ret); +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fb.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fb.h new file mode 100644 index 0000000000000000000000000000000000000000..eb7903f3a10a4f04b36c0f39221a0a065ca20752 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fb.h @@ -0,0 +1,26 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_FB_H__ +#define __PHYTIUM_FB_H__ + +#include + +struct phytium_framebuffer { + struct drm_framebuffer base; + struct phytium_gem_object *phytium_gem_obj[PHYTIUM_FORMAT_MAX_PLANE]; +}; + +#define to_phytium_framebuffer(fb) container_of(fb, struct phytium_framebuffer, base) + +struct phytium_framebuffer *phytium_fb_alloc(struct drm_device *dev, + const struct drm_mode_fb_cmd2 *mode_cmd, + struct phytium_gem_object **phytium_gem_obj, + unsigned int num_planes); + +struct drm_framebuffer *phytium_fb_create(struct drm_device *dev, struct drm_file *file_priv, + const struct drm_mode_fb_cmd2 *mode_cmd); +#endif /* __PHYTIUM_FB_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fbdev.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fbdev.c new file mode 100644 index 0000000000000000000000000000000000000000..a74b2d08180f126ae99b23f274243cea3a7fc2f8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fbdev.c @@ -0,0 +1,168 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_gem.h" +#include "phytium_fb.h" + + +#define PHYTIUM_MAX_CONNECTOR 1 +#define helper_to_drm_private(x) container_of(x, struct phytium_display_private, fbdev_helper) + +static int phytium_fbdev_mmap(struct fb_info *info, struct vm_area_struct *vma) +{ + struct drm_fb_helper *helper = info->par; + struct phytium_display_private *priv = helper_to_drm_private(helper); + + return phytium_gem_mmap_obj(&priv->fbdev_phytium_gem->base, vma); +} + +static struct fb_ops phytium_fbdev_ops = { + .owner = THIS_MODULE, + DRM_FB_HELPER_DEFAULT_OPS, + .fb_mmap = phytium_fbdev_mmap, + .fb_fillrect = drm_fb_helper_cfb_fillrect, + .fb_copyarea = drm_fb_helper_cfb_copyarea, + .fb_imageblit = drm_fb_helper_cfb_imageblit, +}; + +static int +phytium_drm_fbdev_create(struct drm_fb_helper *helper, struct drm_fb_helper_surface_size *sizes) +{ + struct phytium_display_private *priv = helper_to_drm_private(helper); + struct drm_device *dev = helper->dev; + unsigned int bytes_per_pixel; + struct drm_mode_fb_cmd2 mode_cmd = {0}; + struct phytium_framebuffer *phytium_fb = NULL; + struct fb_info *fbi = NULL; + struct drm_framebuffer *fb = NULL; + size_t size = 0; + int ret = 0; + unsigned long offset; + + bytes_per_pixel = DIV_ROUND_UP(sizes->surface_bpp, 8); + mode_cmd.width = sizes->surface_width; + mode_cmd.height = sizes->surface_height; + mode_cmd.pitches[0] = ALIGN(sizes->surface_width * bytes_per_pixel, 128); + mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, sizes->surface_depth); + size = PAGE_ALIGN(mode_cmd.pitches[0] * mode_cmd.height); + + ret = mutex_lock_interruptible(&dev->struct_mutex); + if (ret < 0) { + DRM_ERROR("failed to get mutex lock\n"); + return ret; + } + + priv->fbdev_phytium_gem = phytium_gem_create_object(dev, size); + if (!priv->fbdev_phytium_gem) { + DRM_ERROR("failed to create gem object\n"); + return -ENOMEM; + } + mutex_unlock(&dev->struct_mutex); + + fbi = drm_fb_helper_alloc_fbi(helper); + if (IS_ERR(fbi)) { + DRM_DEV_ERROR(dev->dev, "Failed to create framebuffer info."); + ret = PTR_ERR(fbi); + goto out; + } + + phytium_fb = phytium_fb_alloc(dev, &mode_cmd, &priv->fbdev_phytium_gem, 1); + if (IS_ERR(phytium_fb)) { + DRM_DEV_ERROR(dev->dev, "Failed to alloc DRM framebuffer.\n"); + ret = PTR_ERR(phytium_fb); + goto out; + } + + helper->fb = &(phytium_fb->base); + fbi->par = helper; + fbi->flags = FBINFO_FLAG_DEFAULT; + fbi->fbops = &phytium_fbdev_ops; + + fb = helper->fb; +#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) + drm_fb_helper_fill_fix(fbi, fb->pitches[0], fb->format->depth); + drm_fb_helper_fill_var(fbi, helper, sizes->fb_width, sizes->fb_height); +#else + drm_fb_helper_fill_info(fbi, helper, sizes); +#endif + + offset = fbi->var.xoffset * bytes_per_pixel; + offset += fbi->var.yoffset * fb->pitches[0]; + dev->mode_config.fb_base = 0; + fbi->screen_base = priv->fbdev_phytium_gem->vaddr + offset; + fbi->screen_size = priv->fbdev_phytium_gem->base.size; + fbi->fix.smem_len = priv->fbdev_phytium_gem->base.size; + DRM_DEBUG_KMS("FB [%dx%d]-%d kvaddr=%pa offset=%ld size=%zu\n", fb->width, fb->height, + fb->format->depth, &priv->fbdev_phytium_gem->iova, offset, size); + fbi->skip_vt_switch = true; + + return 0; +out: + phytium_gem_free_object(&priv->fbdev_phytium_gem->base); + return ret; +} + +static const struct drm_fb_helper_funcs phytium_drm_fb_helper_funcs = { + .fb_probe = phytium_drm_fbdev_create, +}; + +int phytium_drm_fbdev_init(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + struct drm_fb_helper *helper; + int ret; + + if (!dev->mode_config.num_crtc || !dev->mode_config.num_connector) + return -EINVAL; + + helper = &priv->fbdev_helper; + drm_fb_helper_prepare(dev, helper, &phytium_drm_fb_helper_funcs); + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) + ret = drm_fb_helper_init(dev, helper, PHYTIUM_MAX_CONNECTOR); +#else + ret = drm_fb_helper_init(dev, helper); +#endif + if (ret < 0) { + DRM_DEV_ERROR(dev->dev, "Failed to initialize drm fb helper -ret %d\n", ret); + return ret; + } + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) + ret = drm_fb_helper_single_add_all_connectors(helper); + if (ret < 0) { + DRM_DEV_ERROR(dev->dev, "Failed to add connectors - %d/\n", ret); + goto err_drm_fb_helper_fini; + } +#endif + ret = drm_fb_helper_initial_config(helper, 32); + return ret; + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 10, 0)) +err_drm_fb_helper_fini: + drm_fb_helper_fini(helper); + return ret; +#endif +} + +void phytium_drm_fbdev_fini(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + struct drm_fb_helper *helper; + + helper = &priv->fbdev_helper; + drm_fb_helper_unregister_fbi(helper); + + if (helper->fb) + drm_framebuffer_put(helper->fb); + + drm_fb_helper_fini(helper); +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fbdev.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fbdev.h new file mode 100644 index 0000000000000000000000000000000000000000..ff63ba84d7728c76635193db762b627ba4a0ac42 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_fbdev.h @@ -0,0 +1,13 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _PHYTIUM_FBDEV_H +#define _PHYTIUM_FBDEV_H + +int phytium_drm_fbdev_init(struct drm_device *dev); +void phytium_drm_fbdev_fini(struct drm_device *dev); + +#endif /* _PHYTIUM_FBDEV_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_gem.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_gem.c new file mode 100644 index 0000000000000000000000000000000000000000..d6f5494d940cd2dd0262a1a58c368276c1b66c60 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_gem.c @@ -0,0 +1,544 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_gem.h" + +#define VRAM_POOL_ALLOC_ORDER 12 + +int phytium_memory_pool_alloc(struct phytium_display_private *priv, void **pvaddr, + phys_addr_t *phys_addr, uint64_t size) +{ + unsigned long vaddr; + + vaddr = gen_pool_alloc(priv->memory_pool, size); + if (!vaddr) + return -ENOMEM; + + *phys_addr = gen_pool_virt_to_phys(priv->memory_pool, vaddr); + + *pvaddr = (void *)vaddr; + return 0; +} + +void phytium_memory_pool_free(struct phytium_display_private *priv, void *vaddr, uint64_t size) +{ + gen_pool_free(priv->memory_pool, (unsigned long)vaddr, size); +} + +int phytium_memory_pool_init(struct device *dev, struct phytium_display_private *priv) +{ + int ret = 0; + + priv->memory_pool = gen_pool_create(VRAM_POOL_ALLOC_ORDER, -1); + if (priv->memory_pool == NULL) { + DRM_ERROR("fail to create memory pool\n"); + ret = -1; + goto failed_create_pool; + } + + ret = gen_pool_add_virt(priv->memory_pool, (unsigned long)priv->pool_virt_addr, + priv->pool_phys_addr, priv->pool_size, -1); + if (ret) { + DRM_ERROR("fail to add vram pool\n"); + ret = -1; + goto failed_add_pool_virt; + } + + return 0; + +failed_add_pool_virt: + gen_pool_destroy(priv->memory_pool); + +failed_create_pool: + return ret; +} + +void phytium_memory_pool_fini(struct device *dev, struct phytium_display_private *priv) +{ + gen_pool_destroy(priv->memory_pool); +} + +struct sg_table * +phytium_gem_prime_get_sg_table(struct drm_gem_object *obj) +{ + struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); + struct sg_table *sgt; + struct drm_device *dev = obj->dev; + int ret; + struct page *page = NULL; + + sgt = kzalloc(sizeof(*sgt), GFP_KERNEL); + if (!sgt) { + DRM_DEBUG_KMS("malloc sgt fail\n"); + return ERR_PTR(-ENOMEM); + } + + if ((phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) || + (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE) || + (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT)) { + ret = sg_alloc_table(sgt, 1, GFP_KERNEL); + if (ret) { + DRM_ERROR("failed to allocate sg\n"); + goto sgt_free; + } + page = pfn_to_page(__phys_to_pfn(phytium_gem_obj->phys_addr)); + sg_set_page(sgt->sgl, page, PAGE_ALIGN(phytium_gem_obj->size), 0); + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { + ret = dma_get_sgtable_attrs(dev->dev, sgt, phytium_gem_obj->vaddr, + phytium_gem_obj->iova, phytium_gem_obj->size, + DMA_ATTR_WRITE_COMBINE); + if (ret) { + DRM_ERROR("failed to allocate sgt, %d\n", ret); + goto sgt_free; + } + } + + return sgt; +sgt_free: + kfree(sgt); + return ERR_PTR(ret); +} + +struct drm_gem_object * +phytium_gem_prime_import_sg_table(struct drm_device *dev, + struct dma_buf_attachment *attach, + struct sg_table *sgt) +{ + struct phytium_gem_object *phytium_gem_obj = NULL; + struct scatterlist *s; + dma_addr_t expected; + int ret, i; + + phytium_gem_obj = kzalloc(sizeof(*phytium_gem_obj), GFP_KERNEL); + if (!phytium_gem_obj) { + DRM_ERROR("failed to allocate phytium_gem_obj\n"); + ret = -ENOMEM; + goto failed_malloc; + } + + ret = drm_gem_object_init(dev, &phytium_gem_obj->base, attach->dmabuf->size); + if (ret) { + DRM_ERROR("failed to initialize drm gem object: %d\n", ret); + goto failed_object_init; + } + + expected = sg_dma_address(sgt->sgl); + for_each_sg(sgt->sgl, s, sgt->nents, i) { + if (sg_dma_address(s) != expected) { + DRM_ERROR("sg_table is not contiguous"); + ret = -EINVAL; + goto failed_check_continue; + } + expected = sg_dma_address(s) + sg_dma_len(s); + } + + phytium_gem_obj->iova = sg_dma_address(sgt->sgl); + phytium_gem_obj->sgt = sgt; + + return &phytium_gem_obj->base; +failed_check_continue: + drm_gem_object_release(&phytium_gem_obj->base); +failed_object_init: + kfree(phytium_gem_obj); +failed_malloc: + return ERR_PTR(ret); +} + +void *phytium_gem_prime_vmap(struct drm_gem_object *obj) +{ + struct phytium_gem_object *phytium_obj = to_phytium_gem_obj(obj); + + return phytium_obj->vaddr; +} + +void phytium_gem_prime_vunmap(struct drm_gem_object *obj, void *vaddr) +{ + return; +} + +int phytium_gem_prime_mmap(struct drm_gem_object *obj, struct vm_area_struct *vma) +{ + int ret = 0; + + ret = drm_gem_mmap_obj(obj, obj->size, vma); + if (ret < 0) + return ret; + + return phytium_gem_mmap_obj(obj, vma); +} + +static void phytium_dma_callback(void *callback_param) +{ + struct completion *comp = callback_param; + + complete(comp); +} + +int phytium_dma_transfer(struct drm_device *drm_dev, int dev_to_mem, void *addr, + dma_addr_t iova, uint64_t size) +{ + struct phytium_display_private *priv = drm_dev->dev_private; + struct dma_chan *dma_chan = priv->dma_chan; + struct sg_table st; + struct scatterlist *sgl; + int ret = 0, timeout; + uint32_t nents, i; + struct dma_slave_config cfg = {0}; + struct dma_async_tx_descriptor *desc; + struct completion comp; + enum dma_data_direction dir; + size_t min = 0; + + nents = DIV_ROUND_UP(size, PAGE_SIZE); + ret = sg_alloc_table(&st, nents, GFP_KERNEL); + if (ret) { + DRM_ERROR("failed to allocate sg_table\n"); + ret = -ENOMEM; + goto failed_sg_alloc_table; + } + + for_each_sg(st.sgl, sgl, st.nents, i) { + min = min_t(size_t, size, PAGE_SIZE - offset_in_page(addr)); + sg_set_page(sgl, vmalloc_to_page(addr), min, offset_in_page(addr)); + addr += min; + size -= min; + } + + memset(&cfg, 0, sizeof(cfg)); + if (dev_to_mem) { + cfg.direction = DMA_DEV_TO_MEM; + cfg.src_addr = iova; + cfg.dst_addr = 0; + dir = DMA_FROM_DEVICE; + } else { + cfg.direction = DMA_MEM_TO_DEV; + cfg.src_addr = 0; + cfg.dst_addr = iova; + dir = DMA_TO_DEVICE; + } + + dmaengine_slave_config(dma_chan, &cfg); + + nents = dma_map_sg(dma_chan->device->dev, st.sgl, st.nents, dir); + if (!nents) { + DRM_DEV_ERROR(drm_dev->dev, "failed to dma_map_sg for dmaengine\n"); + ret = -EINVAL; + goto failed_dma_map_sg; + } + st.nents = nents; + dma_sync_sg_for_device(dma_chan->device->dev, st.sgl, st.nents, dir); + + sgl = st.sgl; + desc = dmaengine_prep_slave_sg(dma_chan, + st.sgl, + st.nents, + cfg.direction, + DMA_PREP_INTERRUPT | DMA_CTRL_ACK); + if (!desc) { + DRM_DEV_ERROR(drm_dev->dev, "failed to dmaengine_prep_slave_sg\n"); + ret = -EINVAL; + goto failed_prep_slave_sg; + } + init_completion(&comp); + desc->callback = phytium_dma_callback; + desc->callback_param = ∁ + + dmaengine_submit(desc); + dma_async_issue_pending(dma_chan); + + timeout = wait_for_completion_timeout(&comp, 2 * HZ); + if (timeout == 0) { + DRM_DEV_ERROR(drm_dev->dev, "wait for dma callback timeout\n"); + ret = -EIO; + } + dma_sync_sg_for_cpu(dma_chan->device->dev, st.sgl, st.nents, dir); + +failed_prep_slave_sg: + dma_unmap_sg(dma_chan->device->dev, st.sgl, st.nents, dir); +failed_dma_map_sg: + sg_free_table(&st); +failed_sg_alloc_table: + return ret; +} + +int phytium_gem_suspend(struct drm_device *drm_dev) +{ + struct phytium_display_private *priv = drm_dev->dev_private; + struct phytium_gem_object *phytium_gem_obj = NULL; + int ret = 0; + + list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { + if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && + (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) + continue; + + phytium_gem_obj->vaddr_save = vmalloc(phytium_gem_obj->size); + if (!phytium_gem_obj->vaddr_save) + goto malloc_failed; + + if (priv->dma_inited) + ret = phytium_dma_transfer(drm_dev, 1, phytium_gem_obj->vaddr_save, + phytium_gem_obj->iova, phytium_gem_obj->size); + + if ((!priv->dma_inited) || ret) + memcpy(phytium_gem_obj->vaddr_save, phytium_gem_obj->vaddr, + phytium_gem_obj->size); + } + + return 0; +malloc_failed: + list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { + if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && + (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) + continue; + + if (phytium_gem_obj->vaddr_save) { + vfree(phytium_gem_obj->vaddr_save); + phytium_gem_obj->vaddr_save = NULL; + } + } + return -ENOMEM; +} + +void phytium_gem_resume(struct drm_device *drm_dev) +{ + struct phytium_display_private *priv = drm_dev->dev_private; + struct phytium_gem_object *phytium_gem_obj = NULL; + + list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { + if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && + (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) + continue; + + memcpy(phytium_gem_obj->vaddr, phytium_gem_obj->vaddr_save, phytium_gem_obj->size); + vfree(phytium_gem_obj->vaddr_save); + phytium_gem_obj->vaddr_save = NULL; + } +} + +void phytium_gem_free_object(struct drm_gem_object *obj) +{ + struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); + struct drm_device *dev = obj->dev; + struct phytium_display_private *priv = dev->dev_private; + uint64_t size = phytium_gem_obj->size; + + DRM_DEBUG_KMS("free phytium_gem_obj iova:0x%pa size:0x%lx\n", + &phytium_gem_obj->iova, phytium_gem_obj->size); + if (phytium_gem_obj->vaddr) { + if ((phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) || + (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE)) { + phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); + priv->mem_state[PHYTIUM_MEM_VRAM_ALLOC] -= size; + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { + dma_unmap_page(dev->dev, phytium_gem_obj->iova, size, DMA_TO_DEVICE); + phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); + priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC] -= size; + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { + dma_free_attrs(dev->dev, size, phytium_gem_obj->vaddr, + phytium_gem_obj->iova, 0); + priv->mem_state[PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC] -= size; + } + list_del(&phytium_gem_obj->list); + } else if (obj->import_attach) + drm_prime_gem_destroy(obj, phytium_gem_obj->sgt); + drm_gem_object_release(obj); + kfree(phytium_gem_obj); +} + +int phytium_gem_mmap_obj(struct drm_gem_object *obj, struct vm_area_struct *vma) +{ + int ret = 0; + struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); + unsigned long pfn = PHYS_PFN(phytium_gem_obj->phys_addr); + /* + * Clear the VM_PFNMAP flag that was set by drm_gem_mmap(), and set the + * vm_pgoff (used as a fake buffer offset by DRM) to 0 as we want to map + * the whole buffer. + */ + vma->vm_flags &= ~VM_PFNMAP; + vma->vm_pgoff = 0; + vma->vm_page_prot = vm_get_page_prot(vma->vm_flags); + + if (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) { + vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot); + ret = remap_pfn_range(vma, vma->vm_start, pfn, + vma->vm_end - vma->vm_start, vma->vm_page_prot); + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE) { + vma->vm_page_prot = pgprot_device(vma->vm_page_prot); + ret = remap_pfn_range(vma, vma->vm_start, pfn, + vma->vm_end - vma->vm_start, vma->vm_page_prot); + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { + ret = remap_pfn_range(vma, vma->vm_start, pfn, + vma->vm_end - vma->vm_start, vma->vm_page_prot); + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { + ret = dma_mmap_attrs(obj->dev->dev, vma, phytium_gem_obj->vaddr, + phytium_gem_obj->iova, vma->vm_end - vma->vm_start, 0); + } + if (ret) + drm_gem_vm_close(vma); + + return ret; +} + +int phytium_gem_mmap(struct file *filp, struct vm_area_struct *vma) +{ + int ret = 0; + + ret = drm_gem_mmap(filp, vma); + if (ret < 0) + return ret; + + return phytium_gem_mmap_obj(vma->vm_private_data, vma); +} + +int phytium_gem_dumb_destroy(struct drm_file *file, struct drm_device *dev, uint32_t handle) +{ + return drm_gem_dumb_destroy(file, dev, handle); +} + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) +static const struct vm_operations_struct phytium_vm_ops = { + .open = drm_gem_vm_open, + .close = drm_gem_vm_close, +}; + +static const struct drm_gem_object_funcs phytium_drm_gem_object_funcs = { + .free = phytium_gem_free_object, + .get_sg_table = phytium_gem_prime_get_sg_table, + .vmap = phytium_gem_prime_vmap, + .vunmap = phytium_gem_prime_vunmap, + .vm_ops = &phytium_vm_ops, +}; +#endif + +struct phytium_gem_object *phytium_gem_create_object(struct drm_device *dev, unsigned long size) +{ + struct phytium_gem_object *phytium_gem_obj = NULL; + struct phytium_display_private *priv = dev->dev_private; + struct page *page = NULL; + int ret = 0; + + phytium_gem_obj = kzalloc(sizeof(*phytium_gem_obj), GFP_KERNEL); + if (!phytium_gem_obj) { + DRM_ERROR("failed to allocate phytium_gem_obj\n"); + ret = -ENOMEM; + goto error; + } + + ret = drm_gem_object_init(dev, &phytium_gem_obj->base, size); + if (ret) { + DRM_ERROR("failed to initialize drm gem object: %d\n", ret); + goto failed_object_init; + } + + if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) { + ret = phytium_memory_pool_alloc(priv, &phytium_gem_obj->vaddr, + &phytium_gem_obj->phys_addr, size); + if (ret) { + DRM_ERROR("fail to allocate vram buffer with size %lx\n", size); + goto failed_dma_alloc; + } + phytium_gem_obj->iova = phytium_gem_obj->phys_addr; + phytium_gem_obj->memory_type = priv->support_memory_type; + priv->mem_state[PHYTIUM_MEM_VRAM_ALLOC] += size; + } else if (priv->support_memory_type & MEMORY_TYPE_SYSTEM_CARVEOUT) { + ret = phytium_memory_pool_alloc(priv, &phytium_gem_obj->vaddr, + &phytium_gem_obj->phys_addr, size); + if (ret) { + DRM_ERROR("fail to allocate carveout memory with size %lx\n", size); + goto failed_dma_alloc; + } + page = pfn_to_page(__phys_to_pfn(phytium_gem_obj->phys_addr)); + phytium_gem_obj->iova = dma_map_page(dev->dev, page, 0, size, DMA_TO_DEVICE); + if (dma_mapping_error(dev->dev, phytium_gem_obj->iova)) { + DRM_ERROR("fail to dma map carveout memory with size %lx\n", size); + phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); + ret = -ENOMEM; + goto failed_dma_alloc; + } + phytium_gem_obj->memory_type = MEMORY_TYPE_SYSTEM_CARVEOUT; + priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC] += size; + } else if (priv->support_memory_type & MEMORY_TYPE_SYSTEM_UNIFIED) { + phytium_gem_obj->vaddr = dma_alloc_attrs(dev->dev, size, &phytium_gem_obj->iova, + GFP_KERNEL, 0); + if (!phytium_gem_obj->vaddr) { + DRM_ERROR("fail to allocate unified buffer with size %lx\n", size); + ret = -ENOMEM; + goto failed_dma_alloc; + } + phytium_gem_obj->memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; + priv->mem_state[PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC] += size; + } else { + DRM_ERROR("fail to allocate buffer with size %lx\n", size); + ret = -ENOMEM; + goto failed_dma_alloc; + } + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) + phytium_gem_obj->base.funcs = &phytium_drm_gem_object_funcs; +#endif + + phytium_gem_obj->size = size; + list_add_tail(&phytium_gem_obj->list, &priv->gem_list_head); + DRM_DEBUG_KMS("phytium_gem_obj iova:0x%pa size:0x%lx\n", + &phytium_gem_obj->iova, phytium_gem_obj->size); + return phytium_gem_obj; + +failed_dma_alloc: +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) + drm_gem_object_put(&phytium_gem_obj->base); +#else + drm_gem_object_unreference_unlocked(&phytium_gem_obj->base); +#endif + + return ERR_PTR(ret); +failed_object_init: + kfree(phytium_gem_obj); +error: + return ERR_PTR(ret); +} + +int phytium_gem_dumb_create(struct drm_file *file, struct drm_device *dev, + struct drm_mode_create_dumb *args) +{ + int size = 0; + struct phytium_gem_object *phytium_gem_obj = NULL; + int ret = 0; + + args->pitch = ALIGN(args->width*DIV_ROUND_UP(args->bpp, 8), 128); + args->size = args->pitch * args->height; + size = PAGE_ALIGN(args->size); + phytium_gem_obj = phytium_gem_create_object(dev, size); + if (IS_ERR(phytium_gem_obj)) + return PTR_ERR(phytium_gem_obj); + ret = drm_gem_handle_create(file, &phytium_gem_obj->base, &args->handle); + if (ret) { + DRM_ERROR("failed to drm_gem_handle_create\n"); + goto failed_gem_handle; + } +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)) + drm_gem_object_put(&phytium_gem_obj->base); +#else + drm_gem_object_unreference_unlocked(&phytium_gem_obj->base); +#endif + + return 0; +failed_gem_handle: + phytium_gem_free_object(&phytium_gem_obj->base); + return ret; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_gem.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_gem.h new file mode 100644 index 0000000000000000000000000000000000000000..50fb4f4f7b6b6f80a77958671d0dc1bf677332b3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_gem.h @@ -0,0 +1,45 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_GEM_H__ +#define __PHYTIUM_GEM_H__ + +#include + +struct phytium_gem_object { + struct drm_gem_object base; + phys_addr_t phys_addr; + dma_addr_t iova; + void *vaddr; + unsigned long size; + struct sg_table *sgt; + char memory_type; + char reserve[3]; + struct list_head list; + void *vaddr_save; +}; + +#define to_phytium_gem_obj(obj) container_of(obj, struct phytium_gem_object, base) + +int phytium_memory_pool_init(struct device *dev, struct phytium_display_private *priv); +void phytium_memory_pool_fini(struct device *dev, struct phytium_display_private *priv); +int phytium_gem_mmap_obj(struct drm_gem_object *obj, struct vm_area_struct *vma); +int phytium_gem_mmap(struct file *filp, struct vm_area_struct *vma); +void phytium_gem_free_object(struct drm_gem_object *obj); +struct sg_table *phytium_gem_prime_get_sg_table(struct drm_gem_object *obj); +struct drm_gem_object *phytium_gem_prime_import_sg_table(struct drm_device *dev, + struct dma_buf_attachment *attach, struct sg_table *sgt); +void phytium_gem_free_object(struct drm_gem_object *obj); +int phytium_gem_dumb_destroy(struct drm_file *file, struct drm_device *dev, unsigned int handle); +struct phytium_gem_object *phytium_gem_create_object(struct drm_device *dev, unsigned long size); +int phytium_gem_dumb_create(struct drm_file *file, struct drm_device *dev, + struct drm_mode_create_dumb *args); +void *phytium_gem_prime_vmap(struct drm_gem_object *obj); +void phytium_gem_prime_vunmap(struct drm_gem_object *obj, void *vaddr); +int phytium_gem_prime_mmap(struct drm_gem_object *obj, struct vm_area_struct *vma); +int phytium_gem_suspend(struct drm_device *drm_dev); +void phytium_gem_resume(struct drm_device *drm_dev); +#endif /* __PHYTIUM_GEM_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_panel.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_panel.c new file mode 100644 index 0000000000000000000000000000000000000000..60a20b9e645ced07eb4be482bfca7e78cb3dad12 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_panel.c @@ -0,0 +1,420 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_dp.h" +#include "phytium_panel.h" + +static int +phytium_dp_aux_set_backlight(struct phytium_panel *panel, unsigned int level) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + unsigned char vals[2] = { 0x0 }; + + vals[0] = level; + if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) { + vals[0] = (level & 0xFF00) >> 8; + vals[1] = (level & 0xFF); + } + + if (drm_dp_dpcd_write(&phytium_dp->aux, DP_EDP_BACKLIGHT_BRIGHTNESS_MSB, + vals, sizeof(vals)) < 0) { + DRM_DEBUG_KMS("Failed to write aux backlight level\n"); + return -EIO; + } + + return 0; +} + +static unsigned int phytium_dp_aux_get_backlight(struct phytium_panel *panel) +{ + unsigned char read_val[2] = { 0x0 }; + unsigned char level = 0; + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + if (drm_dp_dpcd_read(&phytium_dp->aux, DP_EDP_BACKLIGHT_BRIGHTNESS_MSB, + &read_val, sizeof(read_val)) < 0) { + DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", + DP_EDP_BACKLIGHT_BRIGHTNESS_MSB); + return 0; + } + + level = read_val[0]; + if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) + level = (read_val[0] << 8 | read_val[1]); + + return level; +} + +static void set_aux_backlight_enable(struct phytium_panel *panel, bool enable) +{ + u8 reg_val = 0; + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + if (!(phytium_dp->edp_dpcd[1] & DP_EDP_BACKLIGHT_AUX_ENABLE_CAP)) + return; + + if (drm_dp_dpcd_readb(&phytium_dp->aux, DP_EDP_DISPLAY_CONTROL_REGISTER, + ®_val) < 0) { + DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", + DP_EDP_DISPLAY_CONTROL_REGISTER); + return; + } + + if (enable) + reg_val |= DP_EDP_BACKLIGHT_ENABLE; + else + reg_val &= ~(DP_EDP_BACKLIGHT_ENABLE); + + if (drm_dp_dpcd_writeb(&phytium_dp->aux, DP_EDP_DISPLAY_CONTROL_REGISTER, + reg_val) != 1) { + DRM_DEBUG_KMS("Failed to %s aux backlight\n", + enable ? "enable" : "disable"); + } +} + +static void phytium_dp_aux_enable_backlight(struct phytium_panel *panel) +{ + unsigned char dpcd_buf, new_dpcd_buf, edp_backlight_mode; + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + if (drm_dp_dpcd_readb(&phytium_dp->aux, + DP_EDP_BACKLIGHT_MODE_SET_REGISTER, &dpcd_buf) != 1) { + DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", + DP_EDP_BACKLIGHT_MODE_SET_REGISTER); + return; + } + + new_dpcd_buf = dpcd_buf; + edp_backlight_mode = dpcd_buf & DP_EDP_BACKLIGHT_CONTROL_MODE_MASK; + + switch (edp_backlight_mode) { + case DP_EDP_BACKLIGHT_CONTROL_MODE_PWM: + case DP_EDP_BACKLIGHT_CONTROL_MODE_PRESET: + case DP_EDP_BACKLIGHT_CONTROL_MODE_PRODUCT: + new_dpcd_buf &= ~DP_EDP_BACKLIGHT_CONTROL_MODE_MASK; + new_dpcd_buf |= DP_EDP_BACKLIGHT_CONTROL_MODE_DPCD; + break; + + /* Do nothing when it is already DPCD mode */ + case DP_EDP_BACKLIGHT_CONTROL_MODE_DPCD: + default: + break; + } + + if (new_dpcd_buf != dpcd_buf) { + if (drm_dp_dpcd_writeb(&phytium_dp->aux, + DP_EDP_BACKLIGHT_MODE_SET_REGISTER, new_dpcd_buf) < 0) { + DRM_DEBUG_KMS("Failed to write aux backlight mode\n"); + } + } + + set_aux_backlight_enable(panel, true); + phytium_dp_aux_set_backlight(panel, panel->level); +} + +static void phytium_dp_aux_disable_backlight(struct phytium_panel *panel) +{ + set_aux_backlight_enable(panel, false); +} + +static void phytium_dp_aux_setup_backlight(struct phytium_panel *panel) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) + phytium_dp->panel.max = 0xFFFF; + else + phytium_dp->panel.max = 0xFF; + + phytium_dp->panel.min = 0; + phytium_dp->panel.level = phytium_dp_aux_get_backlight(panel); + phytium_dp->panel.backlight_enabled = (phytium_dp->panel.level != 0); +} + +static void phytium_dp_hw_poweron_panel(struct phytium_panel *panel) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + phytium_dp->funcs->dp_hw_poweron_panel(phytium_dp); +} + +static void phytium_dp_hw_poweroff_panel(struct phytium_panel *panel) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + phytium_dp->funcs->dp_hw_poweroff_panel(phytium_dp); +} + +static int +phytium_dp_hw_set_backlight(struct phytium_panel *panel, uint32_t level) +{ + int ret; + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + ret = phytium_dp->funcs->dp_hw_set_backlight(phytium_dp, level); + + return ret; +} + +static uint32_t phytium_dp_hw_get_backlight(struct phytium_panel *panel) +{ + uint32_t ret; + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + ret = phytium_dp->funcs->dp_hw_get_backlight(phytium_dp); + + return ret; +} + +static void phytium_dp_hw_enable_backlight(struct phytium_panel *panel) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + phytium_dp->funcs->dp_hw_set_backlight(phytium_dp, phytium_dp->panel.level); + phytium_dp->funcs->dp_hw_enable_backlight(phytium_dp); +} + +static void phytium_dp_hw_disable_backlight(struct phytium_panel *panel) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + phytium_dp->funcs->dp_hw_disable_backlight(phytium_dp); +} + +static void phytium_dp_hw_setup_backlight(struct phytium_panel *panel) +{ + struct drm_device *dev = panel->dev; + struct phytium_display_private *priv = dev->dev_private; + + panel->max = priv->info.backlight_max; + panel->min = priv->info.backlight_min; + panel->level = phytium_dp_hw_get_backlight(panel); +} + +void phytium_dp_panel_init_backlight_funcs(struct phytium_dp_device *phytium_dp) +{ + if (phytium_dp->edp_dpcd[1] & DP_EDP_TCON_BACKLIGHT_ADJUSTMENT_CAP && + (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_AUX_SET_CAP) && + !(phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_PWM_PIN_CAP)) { + DRM_DEBUG_KMS("AUX Backlight Control Supported!\n"); + phytium_dp->panel.setup_backlight = phytium_dp_aux_setup_backlight; + phytium_dp->panel.enable_backlight = phytium_dp_aux_enable_backlight; + phytium_dp->panel.disable_backlight = phytium_dp_aux_disable_backlight; + phytium_dp->panel.set_backlight = phytium_dp_aux_set_backlight; + phytium_dp->panel.get_backlight = phytium_dp_aux_get_backlight; + } else { + DRM_DEBUG_KMS("PWM Backlight Control Supported!\n"); + phytium_dp->panel.setup_backlight = phytium_dp_hw_setup_backlight; + phytium_dp->panel.enable_backlight = phytium_dp_hw_enable_backlight; + phytium_dp->panel.disable_backlight = phytium_dp_hw_disable_backlight; + phytium_dp->panel.set_backlight = phytium_dp_hw_set_backlight; + phytium_dp->panel.get_backlight = phytium_dp_hw_get_backlight; + } + phytium_dp->panel.poweron = phytium_dp_hw_poweron_panel; + phytium_dp->panel.poweroff = phytium_dp_hw_poweroff_panel; + mutex_init(&phytium_dp->panel.panel_lock); + phytium_dp->panel.dev = phytium_dp->dev; + + /* Upper limits from eDP 1.3 spec */ + phytium_dp->panel.panel_power_up_delay = 210; /* t1_t3 */ + phytium_dp->panel.backlight_on_delay = 50; /* t7 */ + phytium_dp->panel.backlight_off_delay = 50; + phytium_dp->panel.panel_power_down_delay = 0; /* t10 */ + phytium_dp->panel.panel_power_cycle_delay = 510; /* t11 + t12 */ +} + +void phytium_dp_panel_release_backlight_funcs(struct phytium_dp_device *phytium_dp) +{ + phytium_dp->panel.setup_backlight = NULL; + phytium_dp->panel.enable_backlight = NULL; + phytium_dp->panel.disable_backlight = NULL; + phytium_dp->panel.set_backlight = NULL; + phytium_dp->panel.get_backlight = NULL; + phytium_dp->panel.poweron = NULL; + phytium_dp->panel.poweroff = NULL; +} + +void phytium_panel_enable_backlight(struct phytium_panel *panel) +{ + + if (panel->enable_backlight) { + mutex_lock(&panel->panel_lock); + msleep(panel->backlight_on_delay); + panel->enable_backlight(panel); + panel->backlight_enabled = true; + mutex_unlock(&panel->panel_lock); + } +} + +void phytium_panel_disable_backlight(struct phytium_panel *panel) +{ + if (panel->disable_backlight) { + mutex_lock(&panel->panel_lock); + panel->disable_backlight(panel); + panel->backlight_enabled = false; + msleep(panel->backlight_off_delay); + mutex_unlock(&panel->panel_lock); + } +} + +void phytium_panel_poweron(struct phytium_panel *panel) +{ + if (panel->poweron) { + mutex_lock(&panel->panel_lock); + panel->poweron(panel); + panel->power_enabled = true; + msleep(panel->panel_power_up_delay); + mutex_unlock(&panel->panel_lock); + } +} + +void phytium_panel_poweroff(struct phytium_panel *panel) +{ + if (panel->poweroff) { + mutex_lock(&panel->panel_lock); + msleep(panel->panel_power_down_delay); + panel->poweroff(panel); + panel->power_enabled = false; + mutex_unlock(&panel->panel_lock); + } +} + +static uint32_t phytium_scale(uint32_t source_val, + uint32_t source_min, uint32_t source_max, + uint32_t target_min, uint32_t target_max) +{ + uint64_t target_val; + + WARN_ON(source_min > source_max); + WARN_ON(target_min > target_max); + + /* defensive */ + source_val = clamp(source_val, source_min, source_max); + + /* avoid overflows */ + target_val = mul_u32_u32(source_val - source_min, target_max - target_min); + target_val = DIV_ROUND_CLOSEST_ULL(target_val, source_max - source_min); + target_val += target_min; + + return target_val; +} + +static inline uint32_t +phytium_scale_hw_to_user(struct phytium_panel *panel, uint32_t hw_level, uint32_t user_max) +{ + return phytium_scale(hw_level, panel->min, panel->max, + 0, user_max); +} + +static inline uint32_t +phytium_scale_user_to_hw(struct phytium_panel *panel, u32 user_level, u32 user_max) +{ + return phytium_scale(user_level, 0, user_max, + panel->min, panel->max); +} + +static int phytium_backlight_device_update_status(struct backlight_device *bd) +{ + struct phytium_panel *panel = bl_get_data(bd); + struct drm_device *dev = panel->dev; + uint32_t hw_level = 0; + int ret = 0; + + DRM_DEBUG_KMS("updating phytium_backlight, brightness=%d/%d\n", + bd->props.brightness, bd->props.max_brightness); + drm_modeset_lock(&dev->mode_config.connection_mutex, NULL); + hw_level = phytium_scale_user_to_hw(panel, bd->props.brightness, bd->props.max_brightness); + + if ((panel->set_backlight) && (panel->backlight_enabled)) { + mutex_lock(&panel->panel_lock); + ret = panel->set_backlight(panel, hw_level); + panel->level = hw_level; + mutex_unlock(&panel->panel_lock); + } + drm_modeset_unlock(&dev->mode_config.connection_mutex); + + return ret; +} + +static int phytium_backlight_device_get_brightness(struct backlight_device *bd) +{ + struct phytium_panel *panel = bl_get_data(bd); + struct drm_device *dev = panel->dev; + uint32_t hw_level = 0; + int ret; + + drm_modeset_lock(&dev->mode_config.connection_mutex, NULL); + if (panel->get_backlight && panel->backlight_enabled) { + mutex_lock(&panel->panel_lock); + hw_level = panel->get_backlight(panel); + panel->level = hw_level; + mutex_unlock(&panel->panel_lock); + } + drm_modeset_unlock(&dev->mode_config.connection_mutex); + ret = phytium_scale_hw_to_user(panel, hw_level, bd->props.max_brightness); + DRM_DEBUG_KMS("get phytium_backlight, brightness=%d/%d\n", + ret, bd->props.max_brightness); + + return ret; +} + +static const struct backlight_ops phytium_backlight_device_ops = { + .update_status = phytium_backlight_device_update_status, + .get_brightness = phytium_backlight_device_get_brightness, +}; + +int phytium_edp_backlight_device_register(struct phytium_dp_device *phytium_dp) +{ + struct backlight_properties props; + char bl_name[16]; + + if (phytium_dp->panel.setup_backlight) { + mutex_lock(&phytium_dp->panel.panel_lock); + phytium_dp->panel.setup_backlight(&phytium_dp->panel); + mutex_unlock(&phytium_dp->panel.panel_lock); + } else { + return -EINVAL; + } + + memset(&props, 0, sizeof(props)); + props.max_brightness = PHYTIUM_MAX_BL_LEVEL; + props.type = BACKLIGHT_RAW; + props.brightness = phytium_scale_hw_to_user(&phytium_dp->panel, phytium_dp->panel.level, + props.max_brightness); + snprintf(bl_name, sizeof(bl_name), "phytium_bl%d", phytium_dp->port); + + phytium_dp->panel.bl_device = + backlight_device_register(bl_name, + phytium_dp->connector.kdev, + &phytium_dp->panel, + &phytium_backlight_device_ops, + &props); + + if (IS_ERR(phytium_dp->panel.bl_device)) { + DRM_ERROR("Failed to register backlight: %ld\n", + PTR_ERR(phytium_dp->panel.bl_device)); + phytium_dp->panel.bl_device = NULL; + return -ENODEV; + } + + DRM_DEBUG_KMS("Connector %s backlight sysfs interface registered\n", + phytium_dp->connector.name); + + return 0; +} + +void phytium_edp_backlight_device_unregister(struct phytium_dp_device *phytium_dp) +{ + if (phytium_dp->panel.bl_device) { + backlight_device_unregister(phytium_dp->panel.bl_device); + phytium_dp->panel.bl_device = NULL; + } +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_panel.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_panel.h new file mode 100644 index 0000000000000000000000000000000000000000..ff4d760d8400766e932fe7657ed82412f9665e83 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_panel.h @@ -0,0 +1,46 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_PANEL_H__ +#define __PHYTIUM_PANEL_H__ +#include "phytium_dp.h" + +#define PHYTIUM_MAX_BL_LEVEL 0xFF + +struct phytium_panel { + struct drm_device *dev; + bool backlight_enabled; + bool power_enabled; + bool reserve1[2]; + unsigned int min; + unsigned int level; + unsigned int max; + struct backlight_device *bl_device; + void (*setup_backlight)(struct phytium_panel *panel); + uint32_t (*get_backlight)(struct phytium_panel *panel); + int (*set_backlight)(struct phytium_panel *panel, uint32_t level); + void (*disable_backlight)(struct phytium_panel *panel); + void (*enable_backlight)(struct phytium_panel *panel); + void (*poweron)(struct phytium_panel *panel); + void (*poweroff)(struct phytium_panel *panel); + struct mutex panel_lock; + uint32_t panel_power_up_delay; + uint32_t backlight_on_delay; + uint32_t backlight_off_delay; + uint32_t panel_power_down_delay; + uint32_t panel_power_cycle_delay; +}; + +void phytium_dp_panel_init_backlight_funcs(struct phytium_dp_device *phytium_dp); +void phytium_panel_release_backlight_funcs(struct phytium_dp_device *phytium_dp); +int phytium_edp_backlight_device_register(struct phytium_dp_device *phytium_dp); +void phytium_edp_backlight_device_unregister(struct phytium_dp_device *phytium_dp); +void phytium_panel_enable_backlight(struct phytium_panel *panel); +void phytium_panel_disable_backlight(struct phytium_panel *panel); +void phytium_panel_poweron(struct phytium_panel *panel); +void phytium_panel_poweroff(struct phytium_panel *panel); + +#endif /* __PHYTIUM_PANEL_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_pci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_pci.c new file mode 100644 index 0000000000000000000000000000000000000000..bafb8410701ed73bca1ef0dd25bc3c20ec1197b7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_pci.c @@ -0,0 +1,446 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_pci.h" +#include "phytium_dp.h" +#include "phytium_gem.h" +#include "px210_dc.h" +#include "px210_dp.h" +#include "pe220x_dc.h" +#include "pe220x_dp.h" + +int dc_msi_enable; +module_param(dc_msi_enable, int, 0644); +MODULE_PARM_DESC(dc_msi_enable, "Enable DC msi interrupt (0-disabled; 1-enabled; default-0)"); + +void phytium_pci_vram_hw_init(struct phytium_display_private *priv) +{ + struct phytium_pci_private *pci_priv = to_pci_priv(priv); + + pci_priv->dc_hw_vram_init(priv, priv->pool_phys_addr, priv->pool_size); +} + +static bool phytium_pci_host_is_5c01(struct pci_bus *bus) +{ + struct pci_bus *child = bus; + struct pci_dev *root = NULL; + + while (child) { + if (child->parent->parent) + child = child->parent; + else + break; + } + + root = child->self; + if ((root->vendor == 0x1db7) && (root->device == 0x5c01)) + return true; + return false; +} + +int phytium_pci_vram_init(struct pci_dev *pdev, struct phytium_display_private *priv) +{ + int ret = 0; + + priv->pool_phys_addr = pci_resource_start(pdev, 2); + priv->pool_size = pci_resource_len(pdev, 2); + if ((priv->pool_phys_addr != 0) && (priv->pool_size != 0)) { + if ((pdev->device == 0xdc3e) && phytium_pci_host_is_5c01(pdev->bus)) { + priv->pool_virt_addr = devm_ioremap(&pdev->dev, priv->pool_phys_addr, + priv->pool_size); + priv->support_memory_type = MEMORY_TYPE_VRAM_DEVICE; + } else { + priv->pool_virt_addr = devm_ioremap_wc(&pdev->dev, priv->pool_phys_addr, + priv->pool_size); + priv->support_memory_type = MEMORY_TYPE_VRAM_WC; + } + if (priv->pool_virt_addr == NULL) { + DRM_ERROR("pci vram ioremap fail, addr:0x%llx, size:0x%llx\n", + priv->pool_phys_addr, priv->pool_size); + ret = -EINVAL; + goto failed_ioremap; + } + ret = phytium_memory_pool_init(&pdev->dev, priv); + if (ret) + goto failed_init_memory_pool; + + priv->mem_state[PHYTIUM_MEM_VRAM_TOTAL] = priv->pool_size; + priv->vram_hw_init = phytium_pci_vram_hw_init; + } else { + DRM_DEBUG_KMS("not support vram\n"); + priv->pool_virt_addr = NULL; + priv->mem_state[PHYTIUM_MEM_VRAM_TOTAL] = 0; + priv->support_memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; + priv->vram_hw_init = NULL; + } + + return 0; + +failed_init_memory_pool: + devm_iounmap(&pdev->dev, priv->pool_virt_addr); +failed_ioremap: + return ret; +} + +void phytium_pci_vram_fini(struct pci_dev *pdev, struct phytium_display_private *priv) +{ + if ((priv->support_memory_type == MEMORY_TYPE_VRAM_WC) || + (priv->support_memory_type == MEMORY_TYPE_VRAM_DEVICE)) { + phytium_memory_pool_fini(&pdev->dev, priv); + devm_iounmap(&pdev->dev, priv->pool_virt_addr); + } +} + +static bool phytium_pci_dma_chan_filter(struct dma_chan *chan, void *param) +{ + struct phytium_dma_slave *s = param; + + if (s->dma_dev != chan->device->dev) + return false; + + if (s->chan_id == chan->chan_id) + return true; + else + return false; +} + +int phytium_pci_dma_init(struct phytium_display_private *priv) +{ + struct pci_dev *dma_dev, *gpu_dev; + struct drm_device *drm_dev = priv->dev; + dma_cap_mask_t mask; + struct phytium_dma_slave s; + int ret = 0; + u16 cmd; + + /* check px210 gpu enable */ + gpu_dev = pci_get_device(PCI_VENDOR_ID_PHYTIUM, 0xdc20, NULL); + if (!gpu_dev) { + DRM_INFO("failed to get gpu_dev\n"); + ret = -ENODEV; + goto failed; + } + + pci_read_config_word(gpu_dev, PCI_COMMAND, &cmd); + if (!(cmd & PCI_COMMAND_MASTER)) { + DRM_INFO("gpu_dev master is disabled\n"); + ret = -ENODEV; + goto failed; + } + + dma_dev = pci_get_device(PCI_VENDOR_ID_PHYTIUM, 0xdc3c, NULL); + if (!dma_dev) { + DRM_INFO("failed to get dma_dev\n"); + ret = -ENODEV; + goto failed; + } + + dma_cap_zero(mask); + dma_cap_set(DMA_SLAVE, mask); + + s.dma_dev = &dma_dev->dev; + s.chan_id = 2; + priv->dma_chan = dma_request_channel(mask, phytium_pci_dma_chan_filter, &s); + if (!priv->dma_chan) { + DRM_DEV_ERROR(drm_dev->dev, "failed to request dma chan\n"); + ret = -EBUSY; + goto failed; + } + priv->dma_inited = 1; + +failed: + return ret; +} + +void phytium_pci_dma_fini(struct phytium_display_private *priv) +{ + if (priv->dma_inited) + dma_release_channel(priv->dma_chan); + priv->dma_inited = 0; + priv->dma_chan = NULL; +} + +static struct phytium_display_private* +phytium_pci_private_init(struct pci_dev *pdev, const struct pci_device_id *ent) +{ + struct drm_device *dev = pci_get_drvdata(pdev); + struct phytium_display_private *priv = NULL; + struct phytium_pci_private *pci_priv = NULL; + struct phytium_device_info *phytium_info = (struct phytium_device_info *)ent->driver_data; + int i = 0; + resource_size_t io_addr, io_size; + + pci_priv = devm_kzalloc(&pdev->dev, sizeof(*pci_priv), GFP_KERNEL); + if (!pci_priv) { + DRM_ERROR("no memory to allocate for drm_display_private\n"); + goto failed_malloc_priv; + } + + memset(pci_priv, 0, sizeof(*pci_priv)); + priv = &pci_priv->base; + phytium_display_private_init(priv, dev); + + memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); + DRM_DEBUG_KMS("priv->info.num_pipes :%d\n", priv->info.num_pipes); + priv->info.pipe_mask = ((pdev->subsystem_device >> PIPE_MASK_SHIFT) & PIPE_MASK_MASK); + priv->info.edp_mask = ((pdev->subsystem_device >> EDP_MASK_SHIFT) & EDP_MASK_MASK); + priv->info.num_pipes = 0; + for_each_pipe_masked(priv, i) + priv->info.num_pipes++; + if (priv->info.num_pipes == 0) { + DRM_ERROR("num_pipes is zero, so exit init\n"); + goto failed_init_numpipe; + } + + io_addr = pci_resource_start(pdev, 0); + io_size = pci_resource_len(pdev, 0); + priv->regs = ioremap(io_addr, io_size); + if (priv->regs == NULL) { + DRM_ERROR("pci bar0 ioremap fail, addr:0x%llx, size:0x%llx\n", io_addr, io_size); + goto failed_ioremap; + } + + priv->irq = pdev->irq; + if (IS_PX210(priv)) { + pci_priv->dc_hw_vram_init = px210_dc_hw_vram_init; + priv->dc_hw_clear_msi_irq = px210_dc_hw_clear_msi_irq; + priv->dc_hw_fb_format_check = px210_dc_hw_fb_format_check; + } else if (IS_PE220X(priv)) { + pci_priv->dc_hw_vram_init = pe220x_dc_hw_vram_init; + priv->dc_hw_clear_msi_irq = NULL; + priv->dc_hw_fb_format_check = pe220x_dc_hw_fb_format_check; + } + + return priv; + +failed_ioremap: +failed_init_numpipe: + devm_kfree(&pdev->dev, pci_priv); +failed_malloc_priv: + return NULL; +} + +static void +phytium_pci_private_fini(struct pci_dev *pdev, struct phytium_display_private *priv) +{ + struct phytium_pci_private *pci_priv = to_pci_priv(priv); + + if (priv->regs) + iounmap(priv->regs); + + devm_kfree(&pdev->dev, pci_priv); +} + +static int phytium_kick_out_firmware_fb(struct pci_dev *pdev) +{ + struct apertures_struct *ap; + + ap = alloc_apertures(1); + if (!ap) + return -ENOMEM; + + ap->ranges[0].base = pci_resource_start(pdev, 2); + ap->ranges[0].size = pci_resource_len(pdev, 2); + + drm_fb_helper_remove_conflicting_framebuffers(ap, "phytiumdrmfb", + false); + kfree(ap); + + return 0; +} + +static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent) +{ + struct phytium_display_private *priv = NULL; + struct drm_device *dev = NULL; + int ret = 0; + struct phytium_device_info *phytium_info = (struct phytium_device_info *)ent->driver_data; + + if (phytium_info) { + if (phytium_info->platform_mask & BIT(PHYTIUM_PLATFORM_PE220X)) + phytium_display_drm_driver.name = "pe220x"; + } + + ret = phytium_kick_out_firmware_fb(pdev); + if (ret) + DRM_ERROR("failed to remove conflicting framebuffers\n"); + + dev = drm_dev_alloc(&phytium_display_drm_driver, &pdev->dev); + if (IS_ERR(dev)) { + DRM_ERROR("failed to allocate drm_device\n"); + return PTR_ERR(dev); + } + dev->pdev = pdev; + pci_set_drvdata(pdev, dev); + pci_set_master(pdev); + ret = pci_enable_device(pdev); + if (ret) { + DRM_ERROR("pci enbale device fail\n"); + goto failed_enable_device; + } + + if (dc_msi_enable) { + ret = pci_enable_msi(pdev); + if (ret) + DRM_ERROR("pci enbale msi fail\n"); + } + + dma_set_mask(&pdev->dev, DMA_BIT_MASK(40)); + + priv = phytium_pci_private_init(pdev, ent); + if (priv) + dev->dev_private = priv; + else + goto failed_pci_private_init; + + ret = phytium_pci_vram_init(pdev, priv); + if (ret) { + DRM_ERROR("failed to init pci vram\n"); + goto failed_pci_vram_init; + } + + ret = drm_dev_register(dev, 0); + if (ret) { + DRM_ERROR("failed to register drm dev\n"); + goto failed_register_drm; + } + + phytium_dp_hpd_irq_setup(dev, true); + + return 0; + +failed_register_drm: + phytium_pci_vram_fini(pdev, priv); +failed_pci_vram_init: + phytium_pci_private_fini(pdev, priv); +failed_pci_private_init: + if (pdev->msi_enabled) + pci_disable_msi(pdev); + pci_disable_device(pdev); +failed_enable_device: + pci_set_drvdata(pdev, NULL); + drm_dev_put(dev); + + return -1; +} + +static void phytium_pci_remove(struct pci_dev *pdev) +{ + struct drm_device *dev = pci_get_drvdata(pdev); + struct phytium_display_private *priv = dev->dev_private; + + phytium_dp_hpd_irq_setup(dev, false); + cancel_work_sync(&priv->hotplug_work); + drm_dev_unregister(dev); + phytium_pci_vram_fini(pdev, priv); + phytium_pci_private_fini(pdev, priv); + if (pdev->msi_enabled) + pci_disable_msi(pdev); + pci_disable_device(pdev); + pci_set_drvdata(pdev, NULL); + drm_dev_put(dev); +} + +static void phytium_pci_shutdown(struct pci_dev *pdev) +{ + struct drm_device *dev = pci_get_drvdata(pdev); + struct phytium_display_private *priv = dev->dev_private; + + priv->display_shutdown(dev); +} + +static int phytium_pci_pm_suspend(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct drm_device *drm_dev = pci_get_drvdata(pdev); + struct phytium_display_private *priv = drm_dev->dev_private; + int ret = 0; + + if (IS_PX210(priv)) + phytium_pci_dma_init(priv); + + ret = priv->display_pm_suspend(drm_dev); + if (ret < 0) + goto out; + + pci_save_state(pdev); + pci_disable_device(pdev); + pci_set_power_state(pdev, PCI_D3hot); + udelay(200); + +out: + return ret; +} + +static int phytium_pci_pm_resume(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct drm_device *drm_dev = pci_get_drvdata(pdev); + struct phytium_display_private *priv = drm_dev->dev_private; + int ret = 0; + + pci_set_power_state(pdev, PCI_D0); + pci_restore_state(pdev); + ret = pci_enable_device(pdev); + if (ret) + return ret; + pci_set_master(pdev); + + ret = priv->display_pm_resume(drm_dev); + if (IS_PX210(priv)) + phytium_pci_dma_fini(priv); + + return ret; +} + +static const struct dev_pm_ops phytium_pci_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_pci_pm_suspend, phytium_pci_pm_resume) +}; + +static const struct phytium_device_info px210_info = { + .platform_mask = BIT(PHYTIUM_PLATFORM_PX210), + .total_pipes = 3, + .crtc_clock_max = PX210_DC_PIX_CLOCK_MAX, + .hdisplay_max = PX210_DC_HDISPLAY_MAX, + .vdisplay_max = PX210_DC_VDISPLAY_MAX, + .address_mask = PX210_DC_ADDRESS_MASK, + .backlight_max = PX210_DP_BACKLIGHT_MAX, + .backlight_min = PX210_DP_BACKLIGHT_MIN, + .bmc_mode = false, +}; + +static const struct phytium_device_info pe220x_info = { + .platform_mask = BIT(PHYTIUM_PLATFORM_PE220X), + .total_pipes = 2, + .crtc_clock_max = PE220X_DC_PIX_CLOCK_MAX, + .hdisplay_max = PE220X_DC_HDISPLAY_MAX, + .vdisplay_max = PE220X_DC_VDISPLAY_MAX, + .address_mask = PE220X_DC_ADDRESS_MASK, + .backlight_max = PE220X_DP_BACKLIGHT_MAX, + .backlight_min = PE220X_DP_BACKLIGHT_MIN, + .bmc_mode = false, +}; + +static const struct pci_device_id phytium_display_pci_ids[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc22), (kernel_ulong_t)&px210_info }, + { PCI_VDEVICE(PHYTIUM, 0xdc3e), (kernel_ulong_t)&pe220x_info }, + { /* End: all zeroes */ } +}; +MODULE_DEVICE_TABLE(pci, phytium_display_pci_ids); + +struct pci_driver phytium_pci_driver = { + .name = "phytium_display_pci", + .id_table = phytium_display_pci_ids, + .probe = phytium_pci_probe, + .remove = phytium_pci_remove, + .shutdown = phytium_pci_shutdown, + .driver.pm = &phytium_pci_pm_ops, +}; diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_pci.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_pci.h new file mode 100644 index 0000000000000000000000000000000000000000..7ac37971759c812d67f9e22768745394d6ad020a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_pci.h @@ -0,0 +1,26 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_PCI_H__ +#define __PHYTIUM_PCI_H__ + +#include "phytium_display_drv.h" + +struct phytium_pci_private { + struct phytium_display_private base; + void (*dc_hw_vram_init)(struct phytium_display_private *priv, resource_size_t vram_addr, + resource_size_t vram_size); +}; + +struct phytium_dma_slave { + struct device *dma_dev; + u32 chan_id; +}; + +#define to_pci_priv(priv) container_of(priv, struct phytium_pci_private, base) + +extern struct pci_driver phytium_pci_driver; +#endif /* __PHYTIUM_PCI_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_plane.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_plane.c new file mode 100644 index 0000000000000000000000000000000000000000..d5b3d9544f85162a92afca2c5e46555f4bc642a7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_plane.c @@ -0,0 +1,688 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include + +#include + +#include "phytium_display_drv.h" +#include "phytium_plane.h" +#include "phytium_fb.h" +#include "phytium_gem.h" +#include "phytium_crtc.h" +#include "px210_dc.h" +#include "pe220x_dc.h" +#include "phytium_reg.h" + +#define PHYTIUM_CURS_W_SIZE 32 +#define PHYTIUM_CURS_H_SIZE 32 + +void phytium_plane_destroy(struct drm_plane *plane) +{ + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + + drm_plane_cleanup(plane); + kfree(phytium_plane); +} + +/** + * phytium_plane_atomic_get_property - fetch plane property value + * @plane: plane to fetch property for + * @state: state containing the property value + * @property: property to look up + * @val: pointer to write property value into + * + * The DRM core does not store shadow copies of properties for + * atomic-capable drivers. This entrypoint is used to fetch + * the current value of a driver-specific plane property. + */ +static int +phytium_plane_atomic_get_property(struct drm_plane *plane, + const struct drm_plane_state *state, + struct drm_property *property, + uint64_t *val) +{ + DRM_DEBUG_KMS("Unknown plane property [PROP:%d:%s]\n", property->base.id, property->name); + return -EINVAL; +} + +/** + * phytium_plane_atomic_set_property - set plane property value + * @plane: plane to set property for + * @state: state to update property value in + * @property: property to set + * @val: value to set property to + * + * Writes the specified property value for a plane into the provided atomic + * state object. + * + * Returns 0 on success, -EINVAL on unrecognized properties + */ +int +phytium_plane_atomic_set_property(struct drm_plane *plane, + struct drm_plane_state *state, + struct drm_property *property, + uint64_t val) +{ + DRM_DEBUG_KMS("Unknown plane property [PROP:%d:%s]\n", property->base.id, property->name); + return -EINVAL; +} + +struct drm_plane_state * +phytium_plane_atomic_duplicate_state(struct drm_plane *plane) +{ + struct drm_plane_state *state = NULL; + struct phytium_plane_state *phytium_state = NULL; + + phytium_state = kmemdup(plane->state, sizeof(*phytium_state), GFP_KERNEL); + + if (!phytium_state) + return NULL; + + state = &phytium_state->base; + if (state->fb) + drm_framebuffer_get(state->fb); + + state->fence = NULL; + state->commit = NULL; + + return state; +} + +void +phytium_plane_atomic_destroy_state(struct drm_plane *plane, struct drm_plane_state *state) +{ + struct phytium_plane_state *phytium_state = to_phytium_plane_state(state); + + __drm_atomic_helper_plane_destroy_state(state); + kfree(phytium_state); +} + +static bool phytium_plane_format_mod_supported(struct drm_plane *plane, + uint32_t format, uint64_t modifier) +{ + if (modifier == DRM_FORMAT_MOD_LINEAR) + return true; + + if (modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC) { + switch (format) { + case DRM_FORMAT_ARGB2101010: + case DRM_FORMAT_ABGR2101010: + case DRM_FORMAT_RGBA1010102: + case DRM_FORMAT_BGRA1010102: + case DRM_FORMAT_ARGB8888: + case DRM_FORMAT_ABGR8888: + case DRM_FORMAT_RGBA8888: + case DRM_FORMAT_BGRA8888: + case DRM_FORMAT_XRGB8888: + case DRM_FORMAT_XBGR8888: + case DRM_FORMAT_RGBX8888: + case DRM_FORMAT_BGRX8888: + return true; + default: + return false; + } + } + + return false; +} + +const struct drm_plane_funcs phytium_plane_funcs = { + .update_plane = drm_atomic_helper_update_plane, + .disable_plane = drm_atomic_helper_disable_plane, + .destroy = phytium_plane_destroy, + .reset = drm_atomic_helper_plane_reset, + .atomic_get_property = phytium_plane_atomic_get_property, + .atomic_set_property = phytium_plane_atomic_set_property, + .atomic_duplicate_state = phytium_plane_atomic_duplicate_state, + .atomic_destroy_state = phytium_plane_atomic_destroy_state, + .format_mod_supported = phytium_plane_format_mod_supported, +}; + +static int phytium_plane_prepare_fb(struct drm_plane *plane, + struct drm_plane_state *state) +{ + struct dma_buf *dma_buf; + struct dma_fence *fence; + + if (!state->fb) + return 0; + dma_buf = to_phytium_framebuffer(state->fb)->phytium_gem_obj[0]->base.dma_buf; + if (dma_buf) { + fence = dma_resv_get_excl_rcu(dma_buf->resv); + drm_atomic_set_fence_for_plane(state, fence); + } + + return 0; +} + +static int +phytium_plane_atomic_check(struct drm_plane *plane, struct drm_plane_state *state) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct drm_framebuffer *fb = state->fb; + struct drm_crtc *crtc = state->crtc; + struct drm_crtc_state *crtc_state; + int src_x, src_y, src_w, src_h; + unsigned long base_offset; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + + if ((!fb) || (!crtc)) + return 0; + + crtc_state = drm_atomic_get_crtc_state(state->state, crtc); + if (IS_ERR(crtc_state)) + return PTR_ERR(crtc_state); + + if (plane->type == DRM_PLANE_TYPE_CURSOR) { + src_w = state->src_w >> 16; + src_h = state->src_h >> 16; + if (phytium_crtc->scale_enable) + return -EINVAL; + if ((src_w != PHYTIUM_CURS_W_SIZE) || (src_h != PHYTIUM_CURS_W_SIZE)) { + DRM_INFO("Invalid cursor size(%d, %d)\n", src_w, src_h); + return -EINVAL; + } + } else if (plane->type == DRM_PLANE_TYPE_PRIMARY) { + src_x = state->src_x >> 16; + src_y = state->src_y >> 16; + src_w = state->src_w >> 16; + src_h = state->src_h >> 16; + + base_offset = src_x * fb->format->cpp[0] + src_y*fb->pitches[0]; + if (base_offset & (priv->info.address_mask)) { + DRM_ERROR("fb base address is not aligned by 0x%lx byte\n", + priv->info.address_mask); + return -EINVAL; + } + + if (src_w != state->crtc_w || src_h != state->crtc_h) { + DRM_ERROR("scale not support: crtc_w(0x%x)/h(0x%x) src_w(0x%x)/h(0x%x)\n", + state->crtc_w, state->crtc_h, src_w, src_h); + return -EINVAL; + } + + if ((state->crtc_x < 0) || (state->crtc_y < 0)) { + DRM_ERROR("crtc_x(0x%x)/y(0x%x) of drm plane state is invalid\n", + state->crtc_x, state->crtc_y); + return -EINVAL; + } + + if ((state->crtc_x + state->crtc_w > crtc_state->adjusted_mode.hdisplay) + || (state->crtc_y + state->crtc_h > crtc_state->adjusted_mode.vdisplay)) { + DRM_ERROR("plane out of crtc region\n"); + return -EINVAL; + } + } + + return 0; +} + +static void phytium_dc_get_plane_parameter(struct drm_plane *plane) +{ + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + struct drm_framebuffer *fb = plane->state->fb; + struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); + struct phytium_gem_object *phytium_gem_obj = NULL; + int i, num_planes = 0; + const struct drm_format_info *info; + + info = drm_format_info(fb->format->format); + num_planes = info ? info->num_planes : 1; + + for (i = 0; i < num_planes; i++) { + phytium_gem_obj = phytium_fb->phytium_gem_obj[i]; + phytium_plane->iova[i] = phytium_gem_obj->iova + fb->offsets[i]; + phytium_plane->size[i] = phytium_gem_obj->size - fb->offsets[i]; + + if (fb->modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC) + phytium_plane->tiling[i] = FRAMEBUFFER_TILE_MODE0; + else if (fb->modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC) + phytium_plane->tiling[i] = FRAMEBUFFER_TILE_MODE3; + else if (fb->modifier == DRM_FORMAT_MOD_LINEAR) + phytium_plane->tiling[i] = FRAMEBUFFER_LINEAR; + else + phytium_plane->tiling[i] = FRAMEBUFFER_LINEAR; + + if (i == 0) { + switch (fb->format->format) { + case DRM_FORMAT_ARGB2101010: + case DRM_FORMAT_ABGR2101010: + case DRM_FORMAT_RGBA1010102: + case DRM_FORMAT_BGRA1010102: + phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB2101010; + break; + + case DRM_FORMAT_ARGB8888: + case DRM_FORMAT_ABGR8888: + case DRM_FORMAT_RGBA8888: + case DRM_FORMAT_BGRA8888: + phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB8888; + break; + + case DRM_FORMAT_XRGB8888: + case DRM_FORMAT_XBGR8888: + case DRM_FORMAT_RGBX8888: + case DRM_FORMAT_BGRX8888: + phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB8888; + break; + + case DRM_FORMAT_ARGB4444: + case DRM_FORMAT_ABGR4444: + case DRM_FORMAT_RGBA4444: + case DRM_FORMAT_BGRA4444: + phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB4444; + break; + + case DRM_FORMAT_XRGB4444: + case DRM_FORMAT_XBGR4444: + case DRM_FORMAT_RGBX4444: + case DRM_FORMAT_BGRX4444: + phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB4444; + break; + + case DRM_FORMAT_ARGB1555: + case DRM_FORMAT_ABGR1555: + case DRM_FORMAT_RGBA5551: + case DRM_FORMAT_BGRA5551: + phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB1555; + break; + + case DRM_FORMAT_XRGB1555: + case DRM_FORMAT_XBGR1555: + case DRM_FORMAT_RGBX5551: + case DRM_FORMAT_BGRX5551: + phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB1555; + break; + + case DRM_FORMAT_RGB565: + case DRM_FORMAT_BGR565: + phytium_plane->format = FRAMEBUFFER_FORMAT_RGB565; + break; + + case DRM_FORMAT_YUYV: + phytium_plane->format = FRAMEBUFFER_FORMAT_YUYV; + break; + + case DRM_FORMAT_UYVY: + phytium_plane->format = FRAMEBUFFER_FORMAT_UYVY; + break; + case DRM_FORMAT_NV16: + phytium_plane->format = FRAMEBUFFER_FORMAT_NV16; + break; + case DRM_FORMAT_NV12: + phytium_plane->format = FRAMEBUFFER_FORMAT_NV12; + break; + case DRM_FORMAT_NV21: + phytium_plane->format = FRAMEBUFFER_FORMAT_NV12; + break; + default: + DRM_ERROR("unsupported pixel format (format = %d)\n", + fb->format->format); + return; + } + + switch (fb->format->format) { + case DRM_FORMAT_ARGB2101010: + case DRM_FORMAT_ARGB8888: + case DRM_FORMAT_XRGB8888: + case DRM_FORMAT_ARGB4444: + case DRM_FORMAT_XRGB4444: + case DRM_FORMAT_ARGB1555: + case DRM_FORMAT_XRGB1555: + case DRM_FORMAT_RGB565: + phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ARGB; + phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; + break; + + case DRM_FORMAT_ABGR2101010: + case DRM_FORMAT_ABGR8888: + case DRM_FORMAT_XBGR8888: + case DRM_FORMAT_ABGR4444: + case DRM_FORMAT_XBGR4444: + case DRM_FORMAT_ABGR1555: + case DRM_FORMAT_XBGR1555: + case DRM_FORMAT_BGR565: + phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ABGR; + phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; + break; + + case DRM_FORMAT_RGBA1010102: + case DRM_FORMAT_RGBA8888: + case DRM_FORMAT_RGBX8888: + case DRM_FORMAT_RGBA4444: + case DRM_FORMAT_RGBX4444: + case DRM_FORMAT_RGBA5551: + case DRM_FORMAT_RGBX5551: + phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_RGBA; + phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; + break; + + case DRM_FORMAT_BGRA1010102: + case DRM_FORMAT_BGRA8888: + case DRM_FORMAT_BGRX8888: + case DRM_FORMAT_BGRA4444: + case DRM_FORMAT_BGRX4444: + case DRM_FORMAT_BGRA5551: + case DRM_FORMAT_BGRX5551: + phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_BGRA; + phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; + break; + + case DRM_FORMAT_YUYV: + case DRM_FORMAT_UYVY: + case DRM_FORMAT_NV16: + case DRM_FORMAT_NV12: + phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ARGB; + phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; + break; + + default: + DRM_ERROR("unsupported pixel format (format = %d)\n", + fb->format->format); + return; + } + } + } +} + +static void phytium_dc_primary_plane_update(struct drm_plane *plane) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + struct drm_framebuffer *fb = plane->state->fb; + int phys_pipe = phytium_plane->phys_pipe; + int src_x, src_y, crtc_x, crtc_y, crtc_w, crtc_h; + unsigned long base_offset; + int config; + + src_x = plane->state->src_x >> 16; + src_y = plane->state->src_y >> 16; + crtc_x = plane->state->crtc_x; + crtc_y = plane->state->crtc_y; + crtc_w = plane->state->crtc_w; + crtc_h = plane->state->crtc_h; + + if (phytium_plane->dc_hw_update_dcreq) + phytium_plane->dc_hw_update_dcreq(plane); + phytium_plane->dc_hw_update_primary_hi_addr(plane); + + /* config dc */ + /* Y */ + base_offset = src_x * fb->format->cpp[0] + src_y*fb->pitches[0]; + phytium_writel_reg(priv, (phytium_plane->iova[0] + base_offset) & ADDRESS_MASK, + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_Y_ADDRESS); + phytium_writel_reg(priv, ALIGN(fb->pitches[0], 128), + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_Y_STRIDE); + + /* U */ + phytium_writel_reg(priv, phytium_plane->iova[1] & 0xffffffff, + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_U_ADDRESS); + phytium_writel_reg(priv, ALIGN(fb->pitches[1], 128), + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_U_STRIDE); + + /* V */ + phytium_writel_reg(priv, phytium_plane->iova[2] & 0xffffffff, + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_V_ADDRESS); + phytium_writel_reg(priv, ALIGN(fb->pitches[2], 128), + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_V_STRIDE); + + /* size */ + phytium_writel_reg(priv, (crtc_w & WIDTH_MASK) | ((crtc_h&HEIGHT_MASK) << HEIGHT_SHIFT), + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_SIZE); + /* config */ + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); + config &= ~(FRAMEBUFFER_FORMAT_MASK << FRAMEBUFFER_FORMAT_SHIFT); + config |= (phytium_plane->format << FRAMEBUFFER_FORMAT_SHIFT); + config &= ~(1 << FRAMEBUFFER_UVSWIZZLE_SHIFT); + config |= (phytium_plane->uv_swizzle << FRAMEBUFFER_UVSWIZZLE_SHIFT); + config &= ~(FRAMEBUFFER_SWIZZLE_MASK << FRAMEBUFFER_SWIZZLE_SHIFT); + config |= (phytium_plane->swizzle << FRAMEBUFFER_SWIZZLE_SHIFT); + config &= ~(FRAMEBUFFER_TILE_MODE_MASK << FRAMEBUFFER_TILE_MODE_SHIFT); + config |= (phytium_plane->tiling[0] << FRAMEBUFFER_TILE_MODE_SHIFT); + config &= (~FRAMEBUFFER_CLEAR); + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); +} + +static void phytium_dc_cursor_plane_update(struct drm_plane *plane) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + struct drm_framebuffer *fb = plane->state->fb; + int phys_pipe = phytium_plane->phys_pipe; + int config; + unsigned long iova; + + phytium_plane->enable = 1; + phytium_plane->cursor_hot_x = fb->hot_x; + phytium_plane->cursor_hot_y = fb->hot_y; + phytium_plane->cursor_x = plane->state->crtc_x + fb->hot_x; + phytium_plane->cursor_y = plane->state->crtc_y + fb->hot_y; + + if (phytium_plane->cursor_x < 0) { + phytium_plane->cursor_hot_x = plane->state->crtc_w - 1; + phytium_plane->cursor_x = plane->state->crtc_x + phytium_plane->cursor_hot_x; + } + + if (phytium_plane->cursor_y < 0) { + phytium_plane->cursor_hot_y = plane->state->crtc_h - 1; + phytium_plane->cursor_y = plane->state->crtc_y + phytium_plane->cursor_hot_y; + } + + config = CURSOR_FORMAT_ARGB8888 | + ((phytium_plane->cursor_hot_y & CURSOR_HOT_Y_MASK) << CURSOR_HOT_Y_SHIFT) | + ((phytium_plane->cursor_hot_x & CURSOR_HOT_X_MASK) << CURSOR_HOT_X_SHIFT); + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); + + config = ((phytium_plane->cursor_x & CURSOR_X_MASK) << CURSOR_X_SHIFT) | + ((phytium_plane->cursor_y & CURSOR_Y_MASK) << CURSOR_Y_SHIFT); + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_CURSOR_LOCATION); + iova = phytium_plane->iova[0]; + phytium_writel_reg(priv, iova & 0xffffffff, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_CURSOR_ADDRESS); + if (phytium_plane->dc_hw_update_cursor_hi_addr) + phytium_plane->dc_hw_update_cursor_hi_addr(plane, iova); +} + +static void phytium_plane_atomic_update(struct drm_plane *plane, + struct drm_plane_state *old_state) +{ + struct drm_framebuffer *fb, *old_fb; + + DRM_DEBUG_KMS("update plane: type=%d\n", plane->type); + if (!plane->state->crtc || !plane->state->fb) + return; + + fb = plane->state->fb; + old_fb = old_state->fb; + + if (fb) + drm_framebuffer_get(fb); + if (old_fb) + drm_framebuffer_put(old_fb); + + phytium_dc_get_plane_parameter(plane); + + if (plane->type == DRM_PLANE_TYPE_PRIMARY) + phytium_dc_primary_plane_update(plane); + else if (plane->type == DRM_PLANE_TYPE_CURSOR) + phytium_dc_cursor_plane_update(plane); +} + +static void phytium_plane_atomic_disable(struct drm_plane *plane, + struct drm_plane_state *old_state) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + int phys_pipe = phytium_plane->phys_pipe; + int config; + struct drm_framebuffer *old_fb; + + old_fb = old_state->fb; + if (old_fb) + drm_framebuffer_put(old_fb); + + if (plane->type == DRM_PLANE_TYPE_PRIMARY) { + phytium_writel_reg(priv, CLEAR_VALUE_RED, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE); + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); + config |= FRAMEBUFFER_CLEAR; + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); + } else if (plane->type == DRM_PLANE_TYPE_CURSOR) { + phytium_writel_reg(priv, CURSOR_FORMAT_DISABLED, + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); + } +} + +const struct drm_plane_helper_funcs phytium_plane_helper_funcs = { + .prepare_fb = phytium_plane_prepare_fb, + .atomic_check = phytium_plane_atomic_check, + .atomic_update = phytium_plane_atomic_update, + .atomic_disable = phytium_plane_atomic_disable, +}; + +struct phytium_plane *phytium_primary_plane_create(struct drm_device *dev, int phys_pipe) +{ + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = NULL; + struct phytium_plane_state *phytium_plane_state = NULL; + int ret = 0; + unsigned int flags = 0; + const uint32_t *formats = NULL; + uint32_t format_count; + const uint64_t *format_modifiers; + + phytium_plane = kzalloc(sizeof(*phytium_plane), GFP_KERNEL); + if (!phytium_plane) { + ret = -ENOMEM; + goto failed_malloc_plane; + } + + phytium_plane_state = kzalloc(sizeof(*phytium_plane_state), GFP_KERNEL); + if (!phytium_plane_state) { + ret = -ENOMEM; + goto failed_malloc_plane_state; + } + phytium_plane_state->base.plane = &phytium_plane->base; + phytium_plane_state->base.rotation = DRM_MODE_ROTATE_0; + phytium_plane->base.state = &phytium_plane_state->base; + phytium_plane->phys_pipe = phys_pipe; + + if (IS_PX210(priv)) { + phytium_plane->dc_hw_plane_get_format = px210_dc_hw_plane_get_primary_format; + phytium_plane->dc_hw_update_dcreq = px210_dc_hw_update_dcreq; + phytium_plane->dc_hw_update_primary_hi_addr = px210_dc_hw_update_primary_hi_addr; + phytium_plane->dc_hw_update_cursor_hi_addr = NULL; + } else if (IS_PE220X(priv)) { + if (priv->info.bmc_mode) + phytium_plane->dc_hw_plane_get_format = + pe220x_dc_bmc_hw_plane_get_primary_format; + else + phytium_plane->dc_hw_plane_get_format = + pe220x_dc_hw_plane_get_primary_format; + phytium_plane->dc_hw_update_dcreq = NULL; + phytium_plane->dc_hw_update_primary_hi_addr = pe220x_dc_hw_update_primary_hi_addr; + phytium_plane->dc_hw_update_cursor_hi_addr = NULL; + } + + phytium_plane->dc_hw_plane_get_format(&format_modifiers, &formats, &format_count); + ret = drm_universal_plane_init(dev, &phytium_plane->base, 0x0, + &phytium_plane_funcs, formats, + format_count, + format_modifiers, + DRM_PLANE_TYPE_PRIMARY, "primary %d", phys_pipe); + + if (ret) + goto failed_plane_init; + + flags = DRM_MODE_ROTATE_0; + drm_plane_create_rotation_property(&phytium_plane->base, DRM_MODE_ROTATE_0, flags); + drm_plane_helper_add(&phytium_plane->base, &phytium_plane_helper_funcs); + + return phytium_plane; +failed_plane_init: + kfree(phytium_plane_state); +failed_malloc_plane_state: + kfree(phytium_plane); +failed_malloc_plane: + return ERR_PTR(ret); +} + +struct phytium_plane *phytium_cursor_plane_create(struct drm_device *dev, int phys_pipe) +{ + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = NULL; + struct phytium_plane_state *phytium_plane_state = NULL; + int ret = 0; + unsigned int flags = 0; + const uint32_t *formats = NULL; + uint32_t format_count; + const uint64_t *format_modifiers; + + phytium_plane = kzalloc(sizeof(*phytium_plane), GFP_KERNEL); + if (!phytium_plane) { + ret = -ENOMEM; + goto failed_malloc_plane; + } + + phytium_plane_state = kzalloc(sizeof(*phytium_plane_state), GFP_KERNEL); + if (!phytium_plane_state) { + ret = -ENOMEM; + goto failed_malloc_plane_state; + } + phytium_plane_state->base.plane = &phytium_plane->base; + phytium_plane_state->base.rotation = DRM_MODE_ROTATE_0; + phytium_plane->base.state = &phytium_plane_state->base; + phytium_plane->phys_pipe = phys_pipe; + + if (IS_PX210(priv)) { + phytium_plane->dc_hw_plane_get_format = px210_dc_hw_plane_get_cursor_format; + phytium_plane->dc_hw_update_dcreq = NULL; + phytium_plane->dc_hw_update_primary_hi_addr = NULL; + phytium_plane->dc_hw_update_cursor_hi_addr = NULL; + } else if (IS_PE220X(priv)) { + phytium_plane->dc_hw_plane_get_format = pe220x_dc_hw_plane_get_cursor_format; + phytium_plane->dc_hw_update_dcreq = NULL; + phytium_plane->dc_hw_update_primary_hi_addr = NULL; + phytium_plane->dc_hw_update_cursor_hi_addr = pe220x_dc_hw_update_cursor_hi_addr; + } + + phytium_plane->dc_hw_plane_get_format(&format_modifiers, &formats, &format_count); + ret = drm_universal_plane_init(dev, &phytium_plane->base, 0x0, + &phytium_plane_funcs, + formats, format_count, + format_modifiers, + DRM_PLANE_TYPE_CURSOR, "cursor %d", phys_pipe); + + if (ret) + goto failed_plane_init; + + flags = DRM_MODE_ROTATE_0; + drm_plane_create_rotation_property(&phytium_plane->base, DRM_MODE_ROTATE_0, flags); + drm_plane_helper_add(&phytium_plane->base, &phytium_plane_helper_funcs); + + return phytium_plane; +failed_plane_init: + kfree(phytium_plane_state); +failed_malloc_plane_state: + kfree(phytium_plane); +failed_malloc_plane: + return ERR_PTR(ret); +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_plane.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_plane.h new file mode 100644 index 0000000000000000000000000000000000000000..25b6bba6c87d3b815e6c30b6f4e553dde33b851e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_plane.h @@ -0,0 +1,46 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_PLANE_H__ +#define __PHYTIUM_PLANE_H__ + +struct phytium_plane { + struct drm_plane base; + int phys_pipe; + unsigned long iova[PHYTIUM_FORMAT_MAX_PLANE]; + unsigned long size[PHYTIUM_FORMAT_MAX_PLANE]; + unsigned int format; + unsigned int tiling[PHYTIUM_FORMAT_MAX_PLANE]; + unsigned int swizzle; + unsigned int uv_swizzle; + unsigned int rot_angle; + + /* only for cursor */ + bool enable; + bool reserve[3]; + int cursor_x; + int cursor_y; + int cursor_hot_x; + int cursor_hot_y; + + void (*dc_hw_plane_get_format)(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); + void (*dc_hw_update_dcreq)(struct drm_plane *plane); + void (*dc_hw_update_primary_hi_addr)(struct drm_plane *plane); + void (*dc_hw_update_cursor_hi_addr)(struct drm_plane *plane, uint64_t iova); +}; + +struct phytium_plane_state { + struct drm_plane_state base; +}; + +#define to_phytium_plane(x) container_of(x, struct phytium_plane, base) +#define to_phytium_plane_state(x) container_of(x, struct phytium_plane_state, base) + +struct phytium_plane *phytium_primary_plane_create(struct drm_device *dev, int pipe); +struct phytium_plane *phytium_cursor_plane_create(struct drm_device *dev, int pipe); +#endif /* __PHYTIUM_PLANE_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_platform.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_platform.c new file mode 100644 index 0000000000000000000000000000000000000000..42aa8206353aba725422256fe4adacb053f48941 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_platform.c @@ -0,0 +1,388 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium display engine DRM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_platform.h" +#include "phytium_dp.h" +#include "phytium_gem.h" +#include "pe220x_dc.h" +#include "pe220x_dp.h" + +int phytium_platform_carveout_mem_init(struct platform_device *pdev, + struct phytium_display_private *priv) +{ + struct device_node *np; + struct resource res; + struct resource *pres; + int ret = 0; + + if (pdev->dev.of_node) { + np = of_parse_phandle(pdev->dev.of_node, "memory-region", 0); + if(!np) + goto next; + ret = of_address_to_resource(np, 0, &res); + if(ret) + DRM_ERROR("No memory address assigned to the region\n"); + else { + priv->pool_size = resource_size(&res); + priv->pool_phys_addr = res.start; + } + } + +next: + pres = platform_get_resource(pdev, IORESOURCE_MEM, 1); + if (pres) { + priv->pool_size = resource_size(pres); + priv->pool_phys_addr = pres->start; + } + + if ((priv->pool_phys_addr != 0) && (priv->pool_size != 0)) { + priv->pool_virt_addr = ioremap_cache(priv->pool_phys_addr, priv->pool_size); + if (priv->pool_virt_addr == NULL) { + DRM_ERROR("failed to remap carveout mem(0x%llx)\n", priv->pool_phys_addr); + ret = -EINVAL; + goto failed_ioremap; + } + ret = phytium_memory_pool_init(&pdev->dev, priv); + if (ret) + goto failed_init_memory_pool; + + priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL] = priv->pool_size; + priv->support_memory_type = MEMORY_TYPE_SYSTEM_CARVEOUT; + priv->vram_hw_init = NULL; + } else { + DRM_DEBUG_KMS("not support carveout memory\n"); + priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL] = 0; + priv->support_memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; + priv->vram_hw_init = NULL; + } + + return 0; + +failed_init_memory_pool: + iounmap(priv->pool_virt_addr); +failed_ioremap: + return ret; +} + +void phytium_platform_carveout_mem_fini(struct platform_device *pdev, + struct phytium_display_private *priv) +{ + if (priv->support_memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { + phytium_memory_pool_fini(&pdev->dev, priv); + iounmap(priv->pool_virt_addr); + } +} + +static struct phytium_display_private * +phytium_platform_private_init(struct platform_device *pdev) +{ + struct drm_device *dev = dev_get_drvdata(&pdev->dev); + struct device_node *node; + struct fwnode_handle *np; + struct phytium_display_private *priv = NULL; + struct phytium_platform_private *platform_priv = NULL; + struct phytium_device_info *phytium_info = NULL; + int i = 0, ret = 0; + struct resource *res; + + platform_priv = devm_kzalloc(&pdev->dev, sizeof(*platform_priv), GFP_KERNEL); + if (!platform_priv) { + DRM_ERROR("no memory to allocate for phytium_platform_private\n"); + goto exit; + } + + memset(platform_priv, 0, sizeof(*platform_priv)); + priv = &platform_priv->base; + phytium_display_private_init(priv, dev); + + if (pdev->dev.of_node) { + phytium_info = (struct phytium_device_info *)of_device_get_match_data(&pdev->dev); + if (!phytium_info) { + DRM_ERROR("failed to get dts id data(phytium_info)\n"); + goto failed; + } + + memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); + node = pdev->dev.of_node; + ret = of_property_read_u8(node, "pipe_mask", &priv->info.pipe_mask); + if (ret < 0) { + dev_err(&pdev->dev, "missing pipe_mask property from dts\n"); + goto failed; + } + + ret = of_property_read_u8(node, "edp_mask", &priv->info.edp_mask); + if (ret < 0) { + dev_err(&pdev->dev, "missing edp_mask property from dts\n"); + goto failed; + } + if (priv->info.edp_mask) { + priv->info.pwm = devm_pwm_get(&pdev->dev, NULL); + if (IS_ERR(priv->info.pwm)) { + dev_err(&pdev->dev, "Failed to request PWM device: %ld\n", + PTR_ERR(priv->info.pwm)); + goto failed; + } + priv->edp_bl_en = gpiod_get(&pdev->dev, "edp-bl-en", GPIOD_OUT_HIGH); + if (!priv->edp_bl_en) { + dev_err(&pdev->dev, "Failed to get edp_en gpio\n"); + goto failed; + } + priv->edp_power_en = gpiod_get(&pdev->dev, "edp-power-en", GPIOD_OUT_HIGH); + if (!priv->edp_power_en) { + dev_err(&pdev->dev, "Failed to get edp_pwr_en gpio\n"); + goto failed; + } + // set GPIO pin output + gpiod_direction_output(priv->edp_power_en, 0); + gpiod_direction_output(priv->edp_bl_en, 0); + } + } else if (has_acpi_companion(&pdev->dev)) { + phytium_info = (struct phytium_device_info *)acpi_device_get_match_data(&pdev->dev); + if (!phytium_info) { + DRM_ERROR("failed to get acpi id data(phytium_info)\n"); + goto failed; + } + + memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); + np = dev_fwnode(&(pdev->dev)); + ret = fwnode_property_read_u8(np, "pipe_mask", &priv->info.pipe_mask); + if (ret < 0) { + dev_err(&pdev->dev, "missing pipe_mask property from acpi\n"); + goto failed; + } + ret = fwnode_property_read_u8(np, "edp_mask", &priv->info.edp_mask); + if (ret < 0) { + dev_err(&pdev->dev, "missing edp_mask property from acpi\n"); + goto failed; + } + if (priv->info.edp_mask) { + priv->info.pwm = devm_pwm_get(&pdev->dev, NULL); + if (IS_ERR(priv->info.pwm)) { + dev_err(&pdev->dev, "Failed to request PWM device: %ld\n", + PTR_ERR(priv->info.pwm)); + goto failed; + } + priv->edp_bl_en = gpiod_get(&pdev->dev, "edp-bl-en", GPIOD_OUT_HIGH); + if (!priv->edp_bl_en) { + dev_err(&pdev->dev, "Failed to get edp_en gpio\n"); + goto failed; + } + priv->edp_power_en = gpiod_get(&pdev->dev, "edp-power-en", GPIOD_OUT_HIGH); + if (!priv->edp_power_en) { + dev_err(&pdev->dev, "Failed to get edp_pwr_en gpio\n"); + goto failed; + } + // set GPIO pin output + gpiod_direction_output(priv->edp_power_en, 0); + gpiod_direction_output(priv->edp_bl_en, 0); + } + } + + priv->info.num_pipes = 0; + for_each_pipe_masked(priv, i) + priv->info.num_pipes++; + if (priv->info.num_pipes == 0) { + DRM_ERROR("num_pipes is zero, so exit init\n"); + goto failed; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + priv->regs = devm_ioremap_resource(&pdev->dev, res); + if (priv->regs == NULL) { + DRM_ERROR("ioremap fail, addr:0x%llx, size:0x%llx\n", res->start, res->end); + goto failed; + } + + priv->irq = platform_get_irq(pdev, 0); + if (priv->irq < 0) { + dev_err(&pdev->dev, "failed to get irq\n"); + goto failed; + } + + if (IS_PE220X(priv)) { + priv->dc_hw_clear_msi_irq = NULL; + priv->dc_hw_fb_format_check = pe220x_dc_hw_fb_format_check; + } + + return priv; + +failed: + devm_kfree(&pdev->dev, platform_priv); +exit: + return NULL; +} + +static void phytium_platform_private_fini(struct platform_device *pdev) +{ + struct drm_device *dev = dev_get_drvdata(&pdev->dev); + struct phytium_display_private *priv = dev->dev_private; + struct phytium_platform_private *platform_priv = to_platform_priv(priv); + + devm_kfree(&pdev->dev, platform_priv); +} + +static int phytium_platform_probe(struct platform_device *pdev) +{ + struct phytium_display_private *priv = NULL; + struct drm_device *dev = NULL; + struct phytium_device_info *phytium_info = NULL; + int ret = 0; + + if (pdev->dev.of_node) { + phytium_info = (struct phytium_device_info *)of_device_get_match_data(&pdev->dev); + if (phytium_info) { + if (phytium_info->platform_mask & BIT(PHYTIUM_PLATFORM_PE220X)) + phytium_display_drm_driver.name = "pe220x"; + } + } else if (has_acpi_companion(&pdev->dev)) { + phytium_info = (struct phytium_device_info *)acpi_device_get_match_data(&pdev->dev); + if (phytium_info) { + if (phytium_info->platform_mask & BIT(PHYTIUM_PLATFORM_PE220X)) + phytium_display_drm_driver.name = "pe220x"; + } + } + + dev = drm_dev_alloc(&phytium_display_drm_driver, &pdev->dev); + if (IS_ERR(dev)) { + DRM_ERROR("failed to allocate drm_device\n"); + return PTR_ERR(dev); + } + + dev_set_drvdata(&pdev->dev, dev); + dma_set_mask(&pdev->dev, DMA_BIT_MASK(40)); + + priv = phytium_platform_private_init(pdev); + if (priv) + dev->dev_private = priv; + else + goto failed_platform_private_init; + + ret = phytium_platform_carveout_mem_init(pdev, priv); + if (ret) { + DRM_ERROR("failed to init system carveout memory\n"); + goto failed_carveout_mem_init; + } + + ret = drm_dev_register(dev, 0); + if (ret) { + DRM_ERROR("failed to register drm dev\n"); + goto failed_register_drm; + } + + phytium_dp_hpd_irq_setup(dev, true); + + return 0; + +failed_register_drm: + phytium_platform_carveout_mem_fini(pdev, priv); +failed_carveout_mem_init: + phytium_platform_private_fini(pdev); +failed_platform_private_init: + dev_set_drvdata(&pdev->dev, NULL); + drm_dev_put(dev); + return -1; +} + +static int phytium_platform_remove(struct platform_device *pdev) +{ + struct drm_device *dev = dev_get_drvdata(&pdev->dev); + struct phytium_display_private *priv = dev->dev_private; + + phytium_dp_hpd_irq_setup(dev, false); + cancel_work_sync(&priv->hotplug_work); + drm_dev_unregister(dev); + phytium_platform_private_fini(pdev); + dev_set_drvdata(&pdev->dev, NULL); + drm_dev_put(dev); + + return 0; +} + +static void phytium_platform_shutdown(struct platform_device *pdev) +{ + struct drm_device *dev = dev_get_drvdata(&pdev->dev); + struct phytium_display_private *priv = dev->dev_private; + + priv->display_shutdown(dev); +} + +static int phytium_platform_pm_suspend(struct device *dev) +{ + struct drm_device *drm_dev = dev_get_drvdata(dev); + struct phytium_display_private *priv = drm_dev->dev_private; + + return priv->display_pm_suspend(drm_dev); +} + +static int phytium_platform_pm_resume(struct device *dev) +{ + struct drm_device *drm_dev = dev_get_drvdata(dev); + struct phytium_display_private *priv = drm_dev->dev_private; + + return priv->display_pm_resume(drm_dev); +} + +static const struct dev_pm_ops phytium_platform_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_platform_pm_suspend, phytium_platform_pm_resume) +}; + +static const struct phytium_device_info pe220x_info = { + .platform_mask = BIT(PHYTIUM_PLATFORM_PE220X), + .total_pipes = 2, + .crtc_clock_max = PE220X_DC_PIX_CLOCK_MAX, + .hdisplay_max = PE220X_DC_HDISPLAY_MAX, + .vdisplay_max = PE220X_DC_VDISPLAY_MAX, + .address_mask = PE220X_DC_ADDRESS_MASK, + .backlight_max = PE220X_DP_BACKLIGHT_MAX, + .backlight_min = PE220X_DP_BACKLIGHT_MIN, + .bmc_mode = false, +}; + +static const struct of_device_id display_of_match[] = { + { + .compatible = "phytium,dc", + .data = (void*)&pe220x_info, + }, + { } +}; + +MODULE_DEVICE_TABLE(of, display_of_match); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id display_acpi_ids[] = { + { + .id = "PHYT0015", + .driver_data = (kernel_ulong_t)&pe220x_info, + }, + {}, +}; + +MODULE_DEVICE_TABLE(acpi, display_acpi_ids); +#else +#define display_acpi_ids NULL +#endif + +struct platform_driver phytium_platform_driver = { + .driver = { + .name = "phytium_display_platform", + .of_match_table = of_match_ptr(display_of_match), + .acpi_match_table = ACPI_PTR(display_acpi_ids), + }, + .probe = phytium_platform_probe, + .remove = phytium_platform_remove, + .shutdown = phytium_platform_shutdown, + .driver.pm = &phytium_platform_pm_ops, +}; diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_platform.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_platform.h new file mode 100644 index 0000000000000000000000000000000000000000..b754ef0a137a3a21a45c62c9aa313b0c6aee18d1 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_platform.h @@ -0,0 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_PLATFORM_H__ +#define __PHYTIUM_PLATFORM_H__ + +struct phytium_platform_private { + struct phytium_display_private base; +}; + +#define to_platform_priv(priv) container_of(priv, struct phytium_platform_private, base) + +extern struct platform_driver phytium_platform_driver; + +#endif /* __PHYTIUM_PLATFORM_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_reg.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_reg.h new file mode 100644 index 0000000000000000000000000000000000000000..f5d4a6945c35b6313156955c56ef4367f86da5dc --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/phytium_reg.h @@ -0,0 +1,366 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_REG_H__ +#define __PHYTIUM_REG_H__ + +/******************************register base******************************************/ +#define PX210_PIPE_BASE(pipe) (0x8000*pipe) +#define PX210_DC_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x0000) +#define PX210_DCREQ_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x2000) +#define PX210_DP_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x3000) +#define PX210_ADDRESS_TRANSFORM_BASE 0x4000 +#define PX210_PHY_ACCESS_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x5000) + +#define PE220X_DC_BASE(pipe) (0x1000*pipe) +#define PE220X_DP_BASE(pipe) (0x4000 + 0x1000*pipe) +#define PE220X_ADDRESS_TRANSFORM_BASE 0x8000 +#define PE220X_PHY_ACCESS_BASE(pipe) (0x6000 + 0x1000*pipe) +/******************************register base end******************************************/ + +/******************************dc register start******************************************/ +#define PHYTIUM_DC_FRAMEBUFFER_Y_ADDRESS 0x1400 + #define ADDRESS_MASK 0xffffff80 +#define PHYTIUM_DC_FRAMEBUFFER_Y_STRIDE 0x1408 +#define PHYTIUM_DC_PANEL_CONFIG 0x1418 + #define PANEL_DATAENABLE_ENABLE (1<<0) + #define PANEL_DATA_ENABLE (1<<4) + #define PANEL_CLOCK_ENABLE (1<<8) +#define PHYTIUM_DC_HDISPLAY 0x1430 + #define HDISPLAY_END_SHIFT 0 + #define HDISPLAY_END_MASK 0x7fff + #define HDISPLAY_TOTAL_SHIFT 16 + #define HDISPLAY_TOTAL_MASK 0x7fff +#define PHYTIUM_DC_HSYNC 0x1438 + #define HSYNC_START_SHIFT 0 + #define HSYNC_START_MASK 0x7fff + #define HSYNC_END_SHIFT 15 + #define HSYNC_END_MASK 0x7fff + #define HSYNC_PULSE_ENABLED (1<<30) + #define HSYNC_NEGATIVE (1<<31) +#define PHYTIUM_DC_VDISPLAY 0x1440 + #define VDISPLAY_END_SHIFT 0 + #define VDISPLAY_END_MASK 0x7fff + #define VDISPLAY_TOTAL_SHIFT 16 + #define VDISPLAY_TOTAL_MASK 0x7fff +#define PHYTIUM_DC_VSYNC 0x1448 + #define VSYNC_START_SHIFT 0 + #define VSYNC_START_MASK 0x7fff + #define VSYNC_END_SHIFT 15 + #define VSYNC_END_MASK 0x7fff + #define VSYNC_PULSE_ENABLED (1<<30) + #define VSYNC_NEGATIVE (1<<31) +#define PHYTIUM_DC_LOCATION 0x1450 + #define LOVATION_Y_SHIFT 16 +#define PHYTIUM_DC_GAMMA_INDEX 0x1458 + #define GAMMA_INDEX_MAX 256 +#define PHYTIUM_DC_GAMMA_DATA 0x1460 + #define GAMMA_BLUE_SHIFT 0 + #define GAMMA_BLUE_MASK 0x3ff + #define GAMMA_GREEN_SHIFT 10 + #define GAMMA_GREEN_MASK 0x3ff + #define GAMMA_RED_SHIFT 20 + #define GAMMA_RED_MASK 0x3ff +#define PHYTIUM_DC_CURSOR_CONFIG 0x1468 + #define CURSOR_FORMAT_DISABLED 0x0 + #define CURSOR_FORMAT_MASKMODE 0x3 + #define CURSOR_FORMAT_ARGB8888 0x2 + #define CURSOR_FORMAT_MASK 0x3 + #define CURSOR_HOT_Y_SHIFT 8 + #define CURSOR_HOT_Y_MASK 0x1f + #define CURSOR_HOT_X_SHIFT 16 + #define CURSOR_HOT_X_MASK 0x1f +#define PHYTIUM_DC_CURSOR_ADDRESS 0x146c +#define PHYTIUM_DC_CURSOR_LOCATION 0x1470 + #define CURSOR_X_SHIFT 0 + #define CURSOR_X_MASK 0x7fff + #define CURSOR_Y_SHIFT 16 + #define CURSOR_Y_MASK 0x7fff +#define PHYTIUM_DC_CURSOR_BACKGROUND 0x1474 +#define PHYTIUM_DC_CURSOR_FOREGROUND 0x1478 +#define PHYTIUM_DC_INT_STATUS 0x147c + #define INT_STATUS 0x1 +#define PHYTIUM_DC_INT_ENABLE 0x1480 + #define INT_ENABLE 0x1 + #define INT_DISABLE 0x0 + +#define PHYTIUM_DC_FRAMEBUFFER_CONFIG 0x1518 + #define FRAMEBUFFER_OUTPUT BIT(0) + #define FRAMEBUFFER_GAMMA_ENABLE BIT(2) + #define FRAMEBUFFER_VALID_PENDING BIT(3) + #define FRAMEBUFFER_RESET BIT(4) + #define FRAMEBUFFER_PROGRESS BIT(6) + #define FRAMEBUFFER_ROT_ANGLE_SHIFT (11) + #define FRAMEBUFFER_ROT_ANGLE_MASK (0x7) + #define FRAMEBUFFER_ROT_ANGLE_ROT0 (0) + #define FRAMEBUFFER_ROT_ANGLE_FLIP_X (1) + #define FRAMEBUFFER_ROT_ANGLE_FLIP_Y (2) + #define FRAMEBUFFER_TILE_MODE_SHIFT (17) + #define FRAMEBUFFER_TILE_MODE_MASK (0x1f) + #define FRAMEBUFFER_LINEAR 0 + #define FRAMEBUFFER_TILE_MODE0 4 + #define FRAMEBUFFER_TILE_MODE3 7 + #define FRAMEBUFFER_FORMAT_SHIFT 26 + #define FRAMEBUFFER_FORMAT_MASK 0x3f + #define FRAMEBUFFER_FORMAT_XRGB4444 0x0 + #define FRAMEBUFFER_FORMAT_ARGB4444 0x1 + #define FRAMEBUFFER_FORMAT_XRGB1555 0x2 + #define FRAMEBUFFER_FORMAT_ARGB1555 0x3 + #define FRAMEBUFFER_FORMAT_RGB565 0x4 + #define FRAMEBUFFER_FORMAT_XRGB8888 0x5 + #define FRAMEBUFFER_FORMAT_ARGB8888 0x6 + #define FRAMEBUFFER_FORMAT_YUYV 0x7 + #define FRAMEBUFFER_FORMAT_UYVY 0x8 + #define FRAMEBUFFER_FORMAT_NV12 0x11 + #define FRAMEBUFFER_FORMAT_NV16 0x12 + #define FRAMEBUFFER_FORMAT_ARGB2101010 0x16 + #define FRAMEBUFFER_SWIZZLE_SHIFT 23 + #define FRAMEBUFFER_SWIZZLE_MASK 0x3 + #define FRAMEBUFFER_SWIZZLE_ARGB 0 + #define FRAMEBUFFER_SWIZZLE_RGBA 1 + #define FRAMEBUFFER_SWIZZLE_ABGR 2 + #define FRAMEBUFFER_SWIZZLE_BGRA 3 + #define FRAMEBUFFER_UVSWIZZLE_SHIFT 25 + #define FRAMEBUFFER_UVSWIZZLE_DISABLE 0 + #define FRAMEBUFFER_UVSWIZZLE_ENABLE 1 + #define FRAMEBUFFER_CLEAR BIT(8) + #define FRAMEBUFFER_SCALE_ENABLE BIT(22) +#define PHYTIUM_DC_FRAMEBUFFER_SCALECONFIG 0x1520 + #define FRAMEBUFFER_FILTER_TAP 3 + #define FRAMEBUFFER_HORIZONTAL_FILTER_TAP 3 + #define FRAMEBUFFER_TAP 0x33 +#define PHYTIUM_DC_FRAMEBUFFER_U_ADDRESS 0x1530 +#define PHYTIUM_DC_FRAMEBUFFER_V_ADDRESS 0x1538 +#define PHYTIUM_DC_OVERLAY_CONFIG 0x1540 + #define PX210_DC_OVERLAY_ENABLE BIT(24) + +#define PHYTIUM_DC_FRAMEBUFFER_U_STRIDE 0x1800 +#define PHYTIUM_DC_FRAMEBUFFER_V_STRIDE 0x1808 +#define PHYTIUM_DC_FRAMEBUFFER_SIZE 0x1810 + #define WIDTH_SHIFT 0 + #define WIDTH_MASK 0x7fff + #define HEIGHT_SHIFT 15 + #define HEIGHT_MASK 0x7fff + +#define PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_X 0x1828 + #define SCALE_FACTOR_X_MASK 0x7fffffff +#define PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_Y 0x1830 + #define SCALE_FACTOR_Y_MASK 0x7fffffff + #define SCALE_FACTOR_Y_MAX 0x3 + #define SCALE_FACTOR_SRC_OFFSET 16 + +#define PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER_INDEX 0x1838 + #define HORI_FILTER_INDEX 0x0 +#define PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER 0x1a00 +#define PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER_INDEX 0x1a08 + #define VERT_FILTER_INDEX 0x0 +#define PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER 0x1a10 +#define PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE 0x1a18 + #define CLEAR_VALUE_RED 0x00ff0000 + #define CLEAR_VALUE_GREEN 0x0000ff00 + #define CLEAR_VALUE_BLACK 0x00000000 +#define PHYTIUM_DC_FRAMEBUFFER_INITIALOFFSET 0x1a20 + #define INITIALOFFSET (0x8000 | (0X8000 << 16)) +#define PHYTIUM_DC_DP_CONFIG 0x1cd0 + #define OUTPUT_DP (1<<3) + #define DP_RGB666 (0x1) + #define DP_RGB888 (0x2) + #define DP_RGB101010 (0x3) +/******************************dc register end********************************************/ + +/******************************phy access register****************************************/ +#define PHYTIUM_PHY_ACCESS_ADDRESS 0x0000 +#define PHYTIUM_PHY_WRITE_DATA 0x0004 +#define PHYTIUM_PHY_READ_DATA 0x0008 +#define PHYTIUM_PHY_ACCESS_CTRL 0x000c + #define ACCESS_WRITE (1<<0) + #define ACCESS_READ (1<<1) +/******************************phy access register end*************************************/ + +/******************************dp register start******************************************/ +#define PHYTIUM_DP_LINK_BW_SET 0x0000 +#define PHYTIUM_DP_LANE_COUNT_SET 0x0004 +#define PHYTIUM_DP_ENHANCED_FRAME_EN 0x0008 + #define ENHANCED_FRAME_ENABLE 0x1 + #define ENHANCED_FRAME_DISABLE 0x0 +#define PHYTIUM_DP_TRAINING_PATTERN_SET 0x000c + #define TRAINING_OFF 0x0 + #define TRAINING_PATTERN_1 0x1 + #define TRAINING_PATTERN_2 0x2 + #define TRAINING_PATTERN_3 0x3 + #define TRAINING_PATTERN_4 0x4 +#define PHYTIUM_DP_LINK_QUAL_PATTERN_SET 0x0010 + #define TEST_PATTERN_NONE 0x0 + #define TEST_PATTERN_D10_2 0x1 + #define TEST_PATTERN_SYMBOL_ERROR 0x2 + #define TEST_PATTERN_PRBS7 0x3 + #define TEST_PATTERN_80BIT_CUSTOM 0x4 + #define TEST_PATTERN_CP2520_1 0x5 + #define TEST_PATTERN_CP2520_2 0x6 + #define TEST_PATTERN_CP2520_3 0x7 + #define TEST_PATTERN_LANE_SHIFT 8 +#define PHYTIUM_DP_SCRAMBLING_DISABLE 0x0014 + #define SCRAMBLING_ENABLE 0x0 + #define SCRAMBLING_DISABLE 0x1 +#define PHYTIUM_DP_DOWNSPREAD_CTRL 0x0018 +#define PHYTIUM_DP_ALT_SCRAMBLER_RESET 0x001c +#define PHYTIUM_DP_HBR2_SCRAMBLER_RESET 0x0020 +#define PHYTIUM_DP_DISPLAYPORT_VERSION 0x0024 +#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_0 0x0030 +#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_1 0x0034 +#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_2 0x0038 +#define PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE 0x0080 + #define TRANSMITTER_OUTPUT_ENABLE BIT(0) + #define TRANSMITTER_OUTPUT_DISABLE 0 +#define PHYTIUM_DP_VIDEO_STREAM_ENABLE 0x0084 + #define SST_MST_SOURCE_0_ENABLE BIT(0) + #define SST_MST_SOURCE_0_ENABLE_MASK 0x1 + #define SST_MST_SOURCE_0_DISABLE 0 +#define PHYTIUM_DP_SECONDARY_STREAM_ENABLE 0x0088 + #define SECONDARY_STREAM_ENABLE 0x1 + #define SECONDARY_STREAM_DISABLE 0x0 +#define PHYTIUM_DP_SEC_DATA_WINDOW 0x008C +#define PHYTIUM_DP_SOFT_RESET 0x0090 + #define LINK_SOFT_RESET (0x1 << 0) + #define VIDEO_SOFT_RESET (0x1 << 1) +#define PHYTIUM_INPUT_SOURCE_ENABLE 0x0094 + #define VIRTUAL_SOURCE_0_ENABLE BIT(0) + #define VIRTUAL_SOURCE_0_ENABLE_MASK 0x1 +#define PHYTIUM_DP_FORCE_SCRAMBLER_RESET 0x00C0 + #define SCRAMBLER_RESET BIT(0) +#define PHYTIUM_DP_SOURCE_CONTROL_STATUS 0x00C4 +#define PHYTIUM_DP_DATA_CONTROL 0x00C8 +#define PHYTIUM_DP_CORE_CAPABILITY 0x00F8 +#define PHYTIUM_DP_CORE_ID 0x00FC +#define PHYTIUM_DP_AUX_COMMAND 0x0100 + #define BYTE_COUNT_MASK 0xf + #define COMMAND_SHIFT 8 + #define COMMAND_MASK 0xf + #define ADDRESS_ONLY (1<<12) +#define PHYTIUM_DP_AUX_WRITE_FIFO 0x0104 +#define PHYTIUM_DP_AUX_ADDRESS 0x0108 +#define PHYTIUM_DP_AUX_CLK_DIVIDER 0x010C + #define AUX_CLK_DIVIDER 48 + #define AUX_CLK_DIVIDER_100 100 +#define PHYTIUM_DP_SINK_HPD_STATE 0x0128 + #define HPD_CONNECT 0x1 + #define HPD_DISCONNECT 0x0 +#define PHYTIUM_DP_INTERRUPT_RAW_STATUS 0x0130 + #define REPLY_TIMEOUT (1<<3) + #define DP_STATUS_REQUEST_IN_PROGRESS (1<<1) + #define HPD_STATE (0<<1) +#define PHYTIUM_DP_AUX_REPLY_DATA 0x0134 +#define PHYTIUM_DP_AUX_REPLY_CODE 0x0138 + #define AUX_NATIVE_ACK (0x0<<0) + #define AUX_NATIVE_NACK (0x1<<0) + #define AUX_NATIVE_DEFER (0x2<<0) + #define AUX_NATIVE_MASK (0x3 << 0) + #define AUX_I2C_ACK (0x0<<2) + #define AUX_I2C_NACK (0x1<<2) + #define AUX_I2C_DEFER (0x2<<2) + #define AUX_I2C_MASK (0x3 << 2) +#define PHYTIUM_DP_INTERRUPT_STATUS 0x0140 + #define HPD_IRQ (1<<1) + #define HPD_EVENT (1<<0) +#define PHYTIUM_DP_INTERRUPT_MASK 0x0144 + #define HPD_IRQ_MASK (1<<1) + #define HPD_EVENT_MASK (1<<0) + #define HPD_OTHER_MASK 0x7c +#define PHYTIUM_DP_AUX_REPLY_DATA_COUNT 0x0148 +#define PHYTIUM_DP_AUX_STATUS 0x014C + #define REPLY_RECEIVED 0x1 + #define REPLY_IN_PROGRESS 0x2 + #define REQUEST_IN_PROGRESS 0x4 + #define REPLY_ERROR 0x8 +#define PHYTIUM_DP_AUX_TIMER 0x0158 +#define PHYTIUM_DP_MAIN_LINK_HTOTAL 0x0180 +#define PHYTIUM_DP_MAIN_LINK_VTOTAL 0x0184 +#define PHYTIUM_DP_MAIN_LINK_POLARITY 0x0188 + #define VSYNC_POLARITY_LOW BIT(1) + #define HSYNC_POLARITY_LOW BIT(0) +#define PHYTIUM_DP_MAIN_LINK_HSWIDTH 0x018C +#define PHYTIUM_DP_MAIN_LINK_VSWIDTH 0x0190 +#define PHYTIUM_DP_MAIN_LINK_HRES 0x0194 +#define PHYTIUM_DP_MAIN_LINK_VRES 0x0198 +#define PHYTIUM_DP_MAIN_LINK_HSTART 0x019C +#define PHYTIUM_DP_MAIN_LINK_VSTART 0x01A0 +#define PHYTIUM_DP_MAIN_LINK_MISC0 0x01A4 + #define MISC0_SYNCHRONOUS_CLOCK BIT(0) + #define MISC0_BIT_DEPTH_OFFSET 5 + #define MISC0_BIT_DEPTH_6BIT 0x0 + #define MISC0_BIT_DEPTH_8BIT 0x1 + #define MISC0_BIT_DEPTH_10BIT 0x2 + #define MISC0_COMPONENT_FORMAT_SHIFT 1 + #define MISC0_COMPONENT_FORMAT_RGB 0x0 +#define PHYTIUM_DP_MAIN_LINK_MISC1 0x01A8 +#define PHYTIUM_DP_M_VID 0x01AC +#define PHYTIUM_DP_TRANSFER_UNIT_SIZE 0x01B0 +#define PHYTIUM_DP_N_VID 0x01B4 +#define PHYTIUM_DP_USER_PIXEL_WIDTH 0x01B8 +#define PHYTIUM_DP_DATA_COUNT 0x01BC +#define PHYTIUM_DP_INTERLACED 0x01C0 +#define PHYTIUM_DP_USER_SYNC_POLARITY 0x01C4 + #define USER_ODDEVEN_POLARITY_HIGH BIT(3) + #define USER_DATA_ENABLE_POLARITY_HIGH BIT(2) + #define USER_VSYNC_POLARITY_HIGH BIT(1) + #define USER_HSYNC_POLARITY_HIGH BIT(0) +#define PHYTIUM_DP_USER_CONTROL 0x01C8 +#define PHYTIUM_EDP_CRC_ENABLE 0x01D0 + #define SUPPORT_EDP_1_4 BIT(1) +#define PHYTIUM_EDP_CRC_RED 0x01D4 +#define PHYTIUM_EDP_CRC_GREEN 0x01D8 +#define PHYTIUM_EDP_CRC_BLUE 0x01DC +#define PHYTIUM_DP_SEC_AUDIO_ENABLE 0x0300 + #define SEC_AUDIO_ENABLE BIT(0) + #define CHANNEL_MUTE_ENABLE BIT(1) +#define PHYTIUM_DP_SEC_INPUT_SELECT 0x0304 + #define INPUT_SELECT_I2S 0x0 +#define PHYTIUM_DP_SEC_CHANNEL_COUNT 0x0308 + #define CHANNEL_2 0x2 + #define CHANNEL_2_LFE 0x3 + #define CHANNEL_5_1 0x6 + #define CHANNEL_7_1 0x7 + #define CHANNEL_MASK 0xf +#define PHYTIUM_DP_SEC_DIRECT_CLKDIV 0x030c + #define APB_CLOCK 48000000 +#define PHYTIUM_DP_SEC_MAUD 0x0318 +#define PHYTIUM_DP_SEC_NAUD 0x031c +#define PHYTIUM_DP_SEC_CLOCK_MODE 0x0320 + #define CLOCK_MODE_SYNC 0x1 +#define PHYTIUM_DP_SEC_CS_SOURCE_FORMAT 0x0340 + #define CS_SOURCE_FORMAT_DEFAULT 0x0 +#define PHYTIUM_DP_SEC_CS_CATEGORY_CODE 0x0344 +#define PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ 0x0348 + #define ORIG_FREQ_32000 0xc + #define ORIG_FREQ_44100 0xf + #define ORIG_FREQ_48000 0xd + #define ORIG_FREQ_88200 0x7 + #define ORIG_FREQ_96000 0x5 + #define ORIG_FREQ_176400 0x3 + #define ORIG_FREQ_192000 0x1 + #define ORIG_FREQ_MASK 0xf + #define ORIG_FREQ_SHIFT 0 + #define WORD_LENGTH_16 0x4 + #define WORD_LENGTH_18 0x2 + #define WORD_LENGTH_20 0xc + #define WORD_LENGTH_24 0xd + #define WORD_LENGTH_MASK 0xf + #define WORD_LENGTH_SHIFT 4 +#define PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY 0x034c // not used + #define SAMPLING_FREQ_32000 0xc + #define SAMPLING_FREQ_44100 0x0 + #define SAMPLING_FREQ_48000 0x4 + #define SAMPLING_FREQ_88200 0x1 + #define SAMPLING_FREQ_96000 0x5 + #define SAMPLING_FREQ_176400 0x3 + #define SAMPLING_FREQ_192000 0x7 + #define SAMPLING_FREQ_MASK 0xf + #define SAMPLING_FREQ_SHIFT 4 +#define PHYTIUM_DP_SEC_CHANNEL_MAP 0x035C + #define CHANNEL_MAP_DEFAULT 0x87654321 +/******************************dp register end********************************************/ + +#endif /* __PHYTIUM_REG_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dc.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dc.c new file mode 100644 index 0000000000000000000000000000000000000000..6b416fc7737e3615d5ad19826f1f237e04acc468 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dc.c @@ -0,0 +1,328 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#if defined(__arm__) || defined(__aarch64__) +#include +#endif +#include +#include "phytium_display_drv.h" +#include "px210_reg.h" +#include "phytium_crtc.h" +#include "phytium_plane.h" +#include "phytium_fb.h" +#include "phytium_gem.h" + +static const unsigned int px210_primary_formats[] = { + DRM_FORMAT_ARGB2101010, + DRM_FORMAT_ABGR2101010, + DRM_FORMAT_RGBA1010102, + DRM_FORMAT_BGRA1010102, + DRM_FORMAT_ARGB8888, + DRM_FORMAT_ABGR8888, + DRM_FORMAT_RGBA8888, + DRM_FORMAT_BGRA8888, + DRM_FORMAT_XRGB8888, + DRM_FORMAT_XBGR8888, + DRM_FORMAT_RGBX8888, + DRM_FORMAT_BGRX8888, + DRM_FORMAT_ARGB4444, + DRM_FORMAT_ABGR4444, + DRM_FORMAT_RGBA4444, + DRM_FORMAT_BGRA4444, + DRM_FORMAT_XRGB4444, + DRM_FORMAT_XBGR4444, + DRM_FORMAT_RGBX4444, + DRM_FORMAT_BGRX4444, + DRM_FORMAT_ARGB1555, + DRM_FORMAT_ABGR1555, + DRM_FORMAT_RGBA5551, + DRM_FORMAT_BGRA5551, + DRM_FORMAT_XRGB1555, + DRM_FORMAT_XBGR1555, + DRM_FORMAT_RGBX5551, + DRM_FORMAT_BGRX5551, + DRM_FORMAT_RGB565, + DRM_FORMAT_BGR565, + DRM_FORMAT_YUYV, + DRM_FORMAT_UYVY, +}; + +static uint64_t px210_primary_formats_modifiers[] = { + DRM_FORMAT_MOD_LINEAR, + DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC, + DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC, + DRM_FORMAT_MOD_INVALID +}; + +static uint64_t px210_cursor_formats_modifiers[] = { + DRM_FORMAT_MOD_LINEAR, + DRM_FORMAT_MOD_INVALID +}; + +static const unsigned int px210_cursor_formats[] = { + DRM_FORMAT_ARGB8888, +}; + +void px210_dc_hw_vram_init(struct phytium_display_private *priv, resource_size_t vram_addr, + resource_size_t vram_size) +{ + uint32_t config; + uint32_t group_offset = priv->address_transform_base; + + config = phytium_readl_reg(priv, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR); + if (config) + phytium_writel_reg(priv, config, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR); + + config = phytium_readl_reg(priv, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_SIZE); + if (config) + phytium_writel_reg(priv, config, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_SIZE); + + config = phytium_readl_reg(priv, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR); + if (config) + phytium_writel_reg(priv, config, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR); + + phytium_writel_reg(priv, (vram_addr & SRC_ADDR_MASK) >> SRC_ADDR_OFFSET, + group_offset, PX210_DC_ADDRESS_TRANSFORM_SRC_ADDR); + phytium_writel_reg(priv, (vram_size >> SIZE_OFFSET) | ADDRESS_TRANSFORM_ENABLE, + group_offset, PX210_DC_ADDRESS_TRANSFORM_SIZE); + config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DST_ADDR); + phytium_writel_reg(priv, config, group_offset, PX210_DC_ADDRESS_TRANSFORM_DST_ADDR); +} + +void px210_dc_hw_clear_msi_irq(struct phytium_display_private *priv, uint32_t phys_pipe) +{ + phytium_writel_reg(priv, MSI_CLEAR, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_MSI_CLEAR); +} + +void px210_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + uint32_t group_offset = priv->dcreq_reg_base[phys_pipe]; + int ret = 0; + + /* config pix clock */ + phytium_writel_reg(priv, FLAG_REQUEST | CMD_PIXEL_CLOCK | (clock & PIXEL_CLOCK_MASK), + group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to set pixel clock\n", __func__); +} + +void px210_dc_hw_disable(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int reset_timeout = 100; + int config = 0; + int phys_pipe = phytium_crtc->phys_pipe; + + // reset dc + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, config | SOFT_RESET, priv->dc_reg_base[phys_pipe], + PX210_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, 0, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); + do { + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_IDLE); + if (config | IS_IDLE) + break; + mdelay(1); + reset_timeout--; + } while (reset_timeout); + + /* reset pix clock */ + px210_dc_hw_config_pix_clock(crtc, 0); + + // reset dc + reset_timeout = 100; + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, config | SOFT_RESET, priv->dc_reg_base[phys_pipe], + PX210_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, 0, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); + do { + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_IDLE); + if (config | IS_IDLE) + break; + mdelay(1); + reset_timeout--; + } while (reset_timeout); + + /* reset dcreq */ + phytium_writel_reg(priv, DCREQ_PLAN_A, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_PLAN); + phytium_writel_reg(priv, 0, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_CONTROL); + phytium_writel_reg(priv, DCREQ_RESET, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_RESET); + msleep(20); + phytium_writel_reg(priv, (~DCREQ_RESET)&DCREQ_RESET_MASK, + priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_RESET); +} + +int px210_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count) +{ + int ret = 0; + + switch (mode_cmd->modifier[count]) { + case DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC: + switch (mode_cmd->pixel_format) { + case DRM_FORMAT_ARGB4444: + case DRM_FORMAT_ABGR4444: + case DRM_FORMAT_RGBA4444: + case DRM_FORMAT_BGRA4444: + case DRM_FORMAT_XRGB4444: + case DRM_FORMAT_XBGR4444: + case DRM_FORMAT_RGBX4444: + case DRM_FORMAT_BGRX4444: + case DRM_FORMAT_ARGB1555: + case DRM_FORMAT_ABGR1555: + case DRM_FORMAT_RGBA5551: + case DRM_FORMAT_BGRA5551: + case DRM_FORMAT_XRGB1555: + case DRM_FORMAT_XBGR1555: + case DRM_FORMAT_RGBX5551: + case DRM_FORMAT_BGRX5551: + case DRM_FORMAT_RGB565: + case DRM_FORMAT_BGR565: + case DRM_FORMAT_YUYV: + case DRM_FORMAT_UYVY: + break; + default: + DRM_ERROR("TILE_MODE0_FBCDC not support DRM_FORMAT %d", + mode_cmd->pixel_format); + ret = -EINVAL; + goto error; + } + break; + case DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC: + switch (mode_cmd->pixel_format) { + case DRM_FORMAT_ARGB2101010: + case DRM_FORMAT_ABGR2101010: + case DRM_FORMAT_RGBA1010102: + case DRM_FORMAT_BGRA1010102: + case DRM_FORMAT_ARGB8888: + case DRM_FORMAT_ABGR8888: + case DRM_FORMAT_RGBA8888: + case DRM_FORMAT_BGRA8888: + case DRM_FORMAT_XRGB8888: + case DRM_FORMAT_XBGR8888: + case DRM_FORMAT_RGBX8888: + case DRM_FORMAT_BGRX8888: + break; + default: + DRM_ERROR("TILE_MODE3_FBCDC not support DRM_FORMAT %d", + mode_cmd->pixel_format); + ret = -EINVAL; + goto error; + } + break; + case DRM_FORMAT_MOD_LINEAR: + break; + default: + DRM_ERROR("unsupported fb modifier 0x%llx\n", mode_cmd->modifier[0]); + ret = -EINVAL; + goto error; + } + + return 0; +error: + return ret; +} + +void px210_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count) +{ + *format_modifiers = px210_primary_formats_modifiers; + *formats = px210_primary_formats; + *format_count = ARRAY_SIZE(px210_primary_formats); +} + +void px210_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count) +{ + *format_modifiers = px210_cursor_formats_modifiers; + *formats = px210_cursor_formats; + *format_count = ARRAY_SIZE(px210_cursor_formats); +} + +void px210_dc_hw_update_dcreq(struct drm_plane *plane) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + int phys_pipe = phytium_plane->phys_pipe; + uint32_t group_offset = priv->dcreq_reg_base[phys_pipe]; + int config; + + if (phytium_plane->tiling[0] == FRAMEBUFFER_LINEAR) { + phytium_writel_reg(priv, DCREQ_MODE_LINEAR, + group_offset, PX210_DCREQ_PLANE0_CONFIG); + } else { + config = DCREQ_NO_LOSSY; + if (phytium_plane->tiling[0] == FRAMEBUFFER_TILE_MODE0) + config |= DCREQ_TILE_TYPE_MODE0; + else if (phytium_plane->tiling[0] == FRAMEBUFFER_TILE_MODE3) + config |= DCREQ_TILE_TYPE_MODE3; + else + config |= DCREQ_TILE_TYPE_MODE0; + + switch (phytium_plane->format) { + case FRAMEBUFFER_FORMAT_ARGB8888: + case FRAMEBUFFER_FORMAT_XRGB8888: + config |= DCREQ_COLOURFORMAT_BGRA8888; + break; + case FRAMEBUFFER_FORMAT_ARGB2101010: + config |= DCREQ_COLOURFORMAT_ARGB2101010; + break; + case FRAMEBUFFER_FORMAT_XRGB4444: + case FRAMEBUFFER_FORMAT_ARGB4444: + config |= DCREQ_COLOURFORMAT_ARGB4444; + break; + case FRAMEBUFFER_FORMAT_XRGB1555: + case FRAMEBUFFER_FORMAT_ARGB1555: + config |= DCREQ_COLOURFORMAT_ARGB1555; + break; + case FRAMEBUFFER_FORMAT_RGB565: + config |= DCREQ_COLOURFORMAT_RGB565; + break; + case FRAMEBUFFER_FORMAT_YUYV: + config |= DCREQ_COLOURFORMAT_YUYV; + break; + case FRAMEBUFFER_FORMAT_UYVY: + config |= DCREQ_COLOURFORMAT_UYVY; + break; + } + config |= DCREQ_ARGBSWIZZLE_ARGB; + config |= DCREQ_MODE_TILE; + phytium_writel_reg(priv, phytium_plane->iova[0] & 0xffffffff, + group_offset, PX210_DCREQ_PLANE0_ADDR_START); + phytium_writel_reg(priv, (phytium_plane->iova[0] + phytium_plane->size[0]) & + 0xffffffff, group_offset, PX210_DCREQ_PLANE0_ADDR_END); + phytium_writel_reg(priv, config, group_offset, PX210_DCREQ_PLANE0_CONFIG); + } +} + +void px210_dc_hw_update_primary_hi_addr(struct drm_plane *plane) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + int phys_pipe = phytium_plane->phys_pipe; + + phytium_writel_reg(priv, (phytium_plane->iova[0] >> PREFIX_SHIFT) & PREFIX_MASK, + priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_PIX_DMA_PREFIX); +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dc.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dc.h new file mode 100644 index 0000000000000000000000000000000000000000..ef2208bf4f3019e464854831581ac5321aba2a0d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dc.h @@ -0,0 +1,30 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PX210_DC_H__ +#define __PX210_DC_H__ + +#define PX210_DC_PIX_CLOCK_MAX (594000) +#define PX210_DC_HDISPLAY_MAX 3840 +#define PX210_DC_VDISPLAY_MAX 2160 +#define PX210_DC_ADDRESS_MASK 0x7f + +extern void px210_dc_hw_vram_init(struct phytium_display_private *priv, + resource_size_t vram_addr, + resource_size_t vram_size); +extern void px210_dc_hw_clear_msi_irq(struct phytium_display_private *priv, uint32_t phys_pipe); +extern void px210_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock); +extern void px210_dc_hw_disable(struct drm_crtc *crtc); +extern int px210_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count); +extern void px210_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); +extern void px210_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); +void px210_dc_hw_update_dcreq(struct drm_plane *plane); +void px210_dc_hw_update_primary_hi_addr(struct drm_plane *plane); +#endif /* __PX210_DC_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dp.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dp.c new file mode 100644 index 0000000000000000000000000000000000000000..7c655563132a83c0b615ee12d1768d1b702f5056 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dp.c @@ -0,0 +1,920 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include "phytium_display_drv.h" +#include "px210_reg.h" +#include "phytium_dp.h" +#include "px210_dp.h" + +static uint8_t px210_dp_source_lane_count[3] = {4, 4, 1}; + +/* [reg][ling_rate 1.62->8.1] */ +static int vco_val[12][4] = { + {0x0509, 0x0509, 0x0509, 0x0509}, // CP_PADJ + {0x0f00, 0x0f00, 0x0f00, 0x0f00}, // CP_IADJ + {0x0F08, 0x0F08, 0x0F08, 0x0F08}, // FILT_PADJ + {0x0061, 0x006C, 0x006C, 0x0051}, // INTDIV + {0x3333, 0x0000, 0x0000, 0x0000}, // FRACDIVL + {0x0000, 0x0000, 0x0000, 0x0000}, // FRACDIVH + {0x0042, 0x0048, 0x0048, 0x0036}, // HIGH_THR + {0x0002, 0x0002, 0x0002, 0x0002}, // PDIAG_CTRL + {0x0c5e, 0x0c5e, 0x0c5e, 0x0c5e}, // VCOCAL_PLLCNT_START + {0x00c7, 0x00c7, 0x00c7, 0x00c7}, // LOCK_PEFCNT + {0x00c7, 0x00c7, 0x00c7, 0x00c7}, // LOCK_PLLCNT_START + {0x0005, 0x0005, 0x0005, 0x0005}, // LOCK_PLLCNT_THR +}; + +static int mgnfs_val[4][4][4] = // [link_rate][swing][emphasis] +{ + /* 1.62Gbps */ + { + {0x0026, 0x001f, 0x0012, 0x0000}, + {0x0013, 0x0013, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 2.7Gbps */ + { + {0x0026, 0x001f, 0x0012, 0x0000}, + {0x0013, 0x0013, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 5.4Gbps */ + { + {0x0026, 0x0013, 0x005, 0x0000}, + {0x0018, 0x006, 0x0000, 0x0000}, + {0x000c, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 8.1Gbps */ + { + {0x0026, 0x0013, 0x005, 0x0000}, + {0x0013, 0x006, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, +}; + +static int cpost_val[4][4][4] = // [link_rate][swing][emphasis] +{ + /* 1.62Gbps */ + { + {0x0000, 0x0014, 0x0020, 0x002a}, + {0x0000, 0x0010, 0x001f, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 2.7Gbps */ + { + {0x0000, 0x0014, 0x0020, 0x002a}, + {0x0000, 0x0010, 0x001f, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 5.4Gbps */ + { + {0x0000, 0x0014, 0x0022, 0x002e}, + {0x0000, 0x0013, 0x0020, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 8.1Gbps */ + { + {0x0000, 0x0014, 0x0022, 0x002e}, + {0x0000, 0x0013, 0x0020, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, +}; + +static int px210_dp_hw_set_phy_lane_and_rate(struct phytium_dp_device *phytium_dp, + uint8_t link_lane_count, + uint32_t link_rate) +{ + int port = phytium_dp->port%3; + int i = 0, data, tmp, tmp1, index = 0, mask; + int timeout = 500, ret = 0; + + if (port == 0 || port == 1) { + /* set pma powerdown */ + data = 0; + mask = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) { + data |= (A3_POWERDOWN3 << i*A3_POWERDOWN3_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (PLL_EN << i*PLL_EN_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (PLL_EN << i*PLL_EN_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (A0_ACTIVE << i*A0_ACTIVE_SHIFT); + mask |= (((1<port%3; + int voltage_swing = 0; + int pre_emphasis = 0, link_rate_index = 0; + + switch (train_set & DP_TRAIN_VOLTAGE_SWING_MASK) { + case DP_TRAIN_VOLTAGE_SWING_LEVEL_0: + default: + voltage_swing = 0; + break; + case DP_TRAIN_VOLTAGE_SWING_LEVEL_1: + voltage_swing = 1; + break; + case DP_TRAIN_VOLTAGE_SWING_LEVEL_2: + voltage_swing = 2; + break; + case DP_TRAIN_VOLTAGE_SWING_LEVEL_3: + voltage_swing = 3; + break; + } + switch (train_set & DP_TRAIN_PRE_EMPHASIS_MASK) { + case DP_TRAIN_PRE_EMPH_LEVEL_0: + default: + pre_emphasis = 0; + break; + case DP_TRAIN_PRE_EMPH_LEVEL_1: + pre_emphasis = 1; + break; + case DP_TRAIN_PRE_EMPH_LEVEL_2: + pre_emphasis = 2; + break; + case DP_TRAIN_PRE_EMPH_LEVEL_3: + pre_emphasis = 3; + break; + } + + switch (link_rate) { + case 810000: + link_rate_index = 3; + break; + case 540000: + link_rate_index = 2; + break; + case 270000: + link_rate_index = 1; + break; + case 162000: + link_rate_index = 0; + break; + default: + DRM_ERROR("phytium dp rate(%d) not support\n", link_rate); + link_rate_index = 2; + break; + } + + if (port == 0) { + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DIAG_ACYA, LOCK); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_TXCC_CTRL, TX_TXCC_CTRL); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DRV, TX_DRV); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_MGNFS, + mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_CPOST, + cpost_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DIAG_ACYA, UNLOCK); + + } else if (port == 1) { + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DIAG_ACYA, LOCK); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_TXCC_CTRL, TX_TXCC_CTRL); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DRV, TX_DRV); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_MGNFS, + mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_CPOST, + cpost_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_CPOST1, + cpost_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DIAG_ACYA, UNLOCK); + } else { + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DIAG_ACYA, LOCK); + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_TXCC_CTRL, TX_TXCC_CTRL); + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DRV, TX_DRV); + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_MGNFS, + mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_CPOST, + cpost_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DIAG_ACYA, UNLOCK); + } +} + +static int px210_dp_hw_init_phy(struct phytium_dp_device *phytium_dp) +{ + int port = phytium_dp->port; + int i = 0, data, tmp, mask; + int timeout = 500, ret = 0; + + if (port == 0 || port == 1) { + phytium_phy_writel(phytium_dp, PX210_PHY0_APB_RESET, APB_RESET); + + phytium_phy_writel(phytium_dp, PX210_PHY0_PIPE_RESET, RESET); + + /* config lane to dp mode */ + data = 0; + mask = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) { + data |= (LANE_BIT << i*LANE_BIT_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (LANE_MASTER << i*LANE_MASTER_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (PLL_EN << i*PLL_EN_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (BIT_20 << i*BIT_20_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (A0_ACTIVE << i*A0_ACTIVE_SHIFT); + mask |= (((1<dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dcreq_reg_base[port]; + int ret = 0; + + phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | PANEL_POWER_ENABLE, + group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to poweron panel\n", __func__); +} + +static void px210_dp_hw_poweroff_panel(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dcreq_reg_base[port]; + int ret = 0; + + phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | PANEL_POWER_DISABLE, + group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to poweroff panel\n", __func__); +} + +static void px210_dp_hw_enable_backlight(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, ret = 0; + uint32_t group_offset = priv->dcreq_reg_base[port]; + + phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | BACKLIGHT_ENABLE, + group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to enable backlight\n", __func__); +} + +static void px210_dp_hw_disable_backlight(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dcreq_reg_base[port]; + int ret = 0; + + phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | BACKLIGHT_DISABLE, + group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to disable backlight\n", __func__); +} + +static uint32_t px210_dp_hw_get_backlight(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int config; + uint32_t group_offset = priv->address_transform_base; + + config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE); + return ((config >> BACKLIGHT_VALUE_SHIFT) & BACKLIGHT_VALUE_MASK); +} + +static int px210_dp_hw_set_backlight(struct phytium_dp_device *phytium_dp, uint32_t level) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dcreq_reg_base[port]; + int config = 0; + int ret = 0; + + if (level > PX210_DP_BACKLIGHT_MAX) { + ret = -EINVAL; + goto out; + } + + config = FLAG_REQUEST | CMD_BACKLIGHT | ((level & BACKLIGHT_MASK) << BACKLIGHT_SHIFT); + phytium_writel_reg(priv, config, group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to set backlight\n", __func__); + +out: + return ret; +} + +bool px210_dp_hw_spread_is_enable(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, config; + uint32_t group_offset = priv->address_transform_base; + + config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); + + return ((config & DP_SPREAD_ENABLE(port)) ? true:false); +} + +int px210_dp_hw_reset(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + int timeout = 100, config, ret = 0; + uint32_t group_offset = priv->address_transform_base; + uint32_t group_offset_dp = priv->dp_reg_base[port]; + + config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); + config &= (~DC_DP_RESET_STATUS(port)); + + phytium_writel_reg(priv, config, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); + phytium_writel_reg(priv, FLAG_REQUEST | CMD_DC_DP_RESET, + priv->dcreq_reg_base[port], PX210_DCREQ_CMD_REGISTER); + do { + mdelay(10); + timeout--; + config = phytium_readl_reg(priv, group_offset, + PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); + if (config & DC_DP_RESET_STATUS(port)) + break; + } while (timeout); + if (timeout == 0) { + DRM_ERROR("reset dc/dp pipe(%d) failed\n", port); + ret = -1; + } + + phytium_writel_reg(priv, AUX_CLK_DIVIDER, group_offset_dp, PHYTIUM_DP_AUX_CLK_DIVIDER); + + return ret; +} + +uint8_t px210_dp_hw_get_source_lane_count(struct phytium_dp_device *phytium_dp) +{ + return px210_dp_source_lane_count[phytium_dp->port]; +} + +static struct phytium_dp_func px210_dp_funcs = { + .dp_hw_get_source_lane_count = px210_dp_hw_get_source_lane_count, + .dp_hw_reset = px210_dp_hw_reset, + .dp_hw_spread_is_enable = px210_dp_hw_spread_is_enable, + .dp_hw_set_backlight = px210_dp_hw_set_backlight, + .dp_hw_get_backlight = px210_dp_hw_get_backlight, + .dp_hw_disable_backlight = px210_dp_hw_disable_backlight, + .dp_hw_enable_backlight = px210_dp_hw_enable_backlight, + .dp_hw_poweroff_panel = px210_dp_hw_poweroff_panel, + .dp_hw_poweron_panel = px210_dp_hw_poweron_panel, + .dp_hw_init_phy = px210_dp_hw_init_phy, + .dp_hw_set_phy_lane_setting = px210_dp_hw_set_phy_lane_setting, + .dp_hw_set_phy_lane_and_rate = px210_dp_hw_set_phy_lane_and_rate, +}; + +void px210_dp_func_register(struct phytium_dp_device *phytium_dp) +{ + phytium_dp->funcs = &px210_dp_funcs; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dp.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dp.h new file mode 100644 index 0000000000000000000000000000000000000000..b62a3c833ac7fbb74be44d35f9e227d103f0a887 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_dp.h @@ -0,0 +1,14 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PX210_DP_H__ +#define __PX210_DP_H__ + +#define PX210_DP_BACKLIGHT_MAX 100 +#define PX210_DP_BACKLIGHT_MIN 0 + +void px210_dp_func_register(struct phytium_dp_device *phytium_dp); +#endif /* __PX210_DP_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_reg.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_reg.h new file mode 100644 index 0000000000000000000000000000000000000000..dbe1e537fc4a9db8e0aa5bbfc6686751a5e0bd6b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/gpu/drm/phytium/px210_reg.h @@ -0,0 +1,349 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PX210_REG_H__ +#define __PX210_REG_H__ + +#include "phytium_reg.h" + +/******************************dc register start******************************************/ +#define PX210_DC_CLOCK_CONTROL 0x0000 + #define SOFT_RESET (1<<12) +#define PX210_DC_CLOCK_IDLE 0x0004 + #define IS_IDLE (1<<16) +/******************************dc register end********************************************/ + +/******************************dcreq register start**************************************/ +#define PX210_DCREQ_PLANE0_ADDR_START 0x00 +#define PX210_DCREQ_PLANE0_ADDR_END 0x04 +#define PX210_DCREQ_PLANE1_ADDR_START 0x08 +#define PX210_DCREQ_PLANE1_ADDR_END 0x0c +#define PX210_DCREQ_PLANE0_CONFIG 0x10 + #define DCREQ_NO_LOSSY (0 << 0) + #define DCREQ_LOSSY (1 << 0) + #define DCREQ_TILE_TYPE_MASK (0x3 << 1) + #define DCREQ_TILE_TYPE_MODE0 (0x1 << 1) + #define DCREQ_TILE_TYPE_MODE3 (0x2 << 1) + #define DCREQ_COLOURFORMAT_MASK (0x7f << 8) + #define DCREQ_COLOURFORMAT_RGB565 (0x5 << 8) + #define DCREQ_COLOURFORMAT_ARGB1555 (0x4 << 8) + #define DCREQ_COLOURFORMAT_ARGB4444 (0x02 << 8) + #define DCREQ_COLOURFORMAT_BGRA8888 (0x29 << 8) + #define DCREQ_COLOURFORMAT_ARGB2101010 (0xe << 8) + #define DCREQ_COLOURFORMAT_YUYV (0x59 << 8) + #define DCREQ_COLOURFORMAT_UYVY (0x5b << 8) + #define DCREQ_ARGBSWIZZLE_MASK (0xf << 4) + #define DCREQ_ARGBSWIZZLE_ARGB (0X0 << 4) + #define DCREQ_ARGBSWIZZLE_BGRA (0XC << 4) + #define DCREQ_MODE_MASK (1 << 16) + #define DCREQ_MODE_LINEAR (0 << 16) + #define DCREQ_MODE_TILE (1 << 16) +#define PX210_DCREQ_PLANE1_CONFIG(pipe) 0x14 +#define PX210_DCREQ_PLANE0_CLEAR_COLOR_L 0x18 +#define PX210_DCREQ_PLANE0_CLEAR_COLOR_H 0x1C +#define PX210_DCREQ_PLANE1_CLEAR_COLOR_L 0x20 +#define PX210_DCREQ_PLANE1_CLEAR_COLOR_H 0x24 +#define PX210_DCREQ_CMD_REGISTER 0x38 + #define FLAG_REPLY (1<<31) + #define FLAG_REQUEST (1<<30) + #define CMD_PIXEL_CLOCK (0x0 << 28) + #define CMD_BACKLIGHT (0x1 << 28) + #define CMD_DC_DP_RESET (0x3 << 28) + #define BACKLIGHT_SHIFT 21 + #define BACKLIGHT_MASK 0x7f + #define BACKLIGHT_MAX 100 + #define BACKLIGHT_ENABLE (101 << BACKLIGHT_SHIFT) + #define BACKLIGHT_DISABLE (102 << BACKLIGHT_SHIFT) + #define PANEL_POWER_ENABLE (103 << BACKLIGHT_SHIFT) + #define PANEL_POWER_DISABLE (104 << BACKLIGHT_SHIFT) + #define PIXEL_CLOCK_MASK (0x1fffff) +#define PX210_DCREQ_FBCD_CLOCK_CONFIG 0x3c +#define PX210_DCREQ_PIX_DMA_PREFIX 0x50 + #define PREFIX_MASK 0xff + #define PREFIX_SHIFT 32 +#define PX210_DCREQ_FRAME_START 0x54 +#define PX210_DCREQ_FILTER_CONFIG 0x58 +#define PX210_DCREQ_CONTROL 0x5C + #define DC_REQ_ENABLE (1<<0) +#define PX210_DCREQ_MSI_CLEAR 0x60 + #define MSI_CLEAR 0x0 +#define PX210_DCREQ_RESET 0x68 + #define DCREQ_RESET (0x3 << 0) + #define DCREQ_RESET_MASK 0x3 +#define PX210_DCREQ_PLAN 0x94 + #define DCREQ_PLAN_A 0x0 + #define DCREQ_PLAN_B 0X5 +/******************************dcreq register end**************************************/ + +/******************************address transform register start**************************/ +#define PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR 0x0 +#define PX210_GPU_ADDRESS_TRANSFORM_SIZE 0x4 +#define PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR 0x8 + +#define PX210_DC_ADDRESS_TRANSFORM_SRC_ADDR 0x24 + #define SRC_ADDR_OFFSET 22 + #define SRC_ADDR_MASK 0xffffffffff +#define PX210_DC_ADDRESS_TRANSFORM_SIZE 0x28 + #define ADDRESS_TRANSFORM_ENABLE (0x1 << 31) + #define SIZE_OFFSET 22 +#define PX210_DC_ADDRESS_TRANSFORM_DST_ADDR 0x2c + #define DST_ADDR_OFFSET 22 +#define PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS 0x48 + #define DC_DP_RESET_STATUS(pipe) (1 << pipe) + #define DP_SPREAD_ENABLE(pipe) (0x8 << pipe) +#define PX210_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE 0x4c + #define BACKLIGHT_VALUE_MASK (0x7f) + #define BACKLIGHT_VALUE_SHIFT 16 +/******************************address transform register end**************************/ + +/******************************phy register start******************************************/ +/* self define */ +#define PX210_PHY0_PIPE_RESET 0x40104 + #define RESET 0x0 + #define RESET_DEASSERT 0x1 +#define PX210_PHY1_PIPE_RESET 0x100100 + #define PHY1_PIPE_RESET 0x0 + #define PHY1_PIPE_RESET_DEASSERT 0x4 + +#define PX210_PHY1_EN_REFCLK 0x100070 + +#define PX210_PHY0_MODE 0x40088 + #define LANE_BIT (0x3) + #define LANE_BIT_SHIFT 0x2 +#define PX210_PHY1_SEL 0x100004 + #define PHY1_DP_LANE_BIT 0x1 + #define PHY1_DP_LANE_BIT_SHIFT 2 + +#define PX210_PHY0_LINK_CFG 0x40044 + #define LANE_MASTER 0x1 + #define LANE_MASTER_SHIFT 1 + +#define PX210_PHY0_PLL_EN 0x40010 + #define PLL_EN 0x1 + #define PLL_EN_SHIFT 1 +#define PX210_PHY0_PMA_WIDTH 0x40020 + #define BIT_20 0x5 + #define BIT_20_SHIFT 4 + +#define PX210_PHY0_PMA0_POWER 0x40014 +#define PX210_PHY0_PMA1_POWER 0x40018 + #define A0_ACTIVE 0x1 + #define A0_ACTIVE_SHIFT 8 + #define A3_POWERDOWN3 0x8 + #define A3_POWERDOWN3_SHIFT 8 + +#define PX210_PHY1_PMA_MISC 0x1000a0 + #define PHY1_PLL_EN 0x1 + #define PHY1_PLL_EN_MASK 1 + #define PHY1_PLL_EN_SHIFT 8 + #define PHY1_BIT_20 0x5 + #define PHY1_BIT_20_SHIFT 9 + #define PHY1_A0_ACTIVE 0x1 + #define PHY1_A0_ACTIVE_SHIFT 2 + #define PHY1_A0_ACTIVE_MASK 0x3f + #define PHY1_A3_POWERDOWN3 0x8 + #define PHY1_A3_POWERDOWN3_MASK 0x3f + #define PHY1_A3_POWERDOWN3_SHIFT 2 + +#define PX210_PHY0_LINK_RESET 0x40108 + #define LINK_RESET 0x1 + #define LINK_RESET_MASK 0x1 + #define LINTK_RESET_SHIFT 0x1 + +#define PX210_PHY0_APB_RESET 0x40100 + #define APB_RESET 0x1 +#define PX210_PHY1_APB_RESET 0x100104 + #define PHY1_APB_RESET 0x4 + +/* phy origin register */ +#define PX210_PHY0_PLL_CFG 0x30038 +#define PX210_PHY1_PLL_CFG 0xb0038 + #define SINGLE_LINK 0x0 + #define DOUBLE_LINK 0x2 + +#define PX210_PHY0_PMA_CONTROL 0x3800c +#define PX210_PHY1_PMA_CONTROL 0xb800c + #define CONTROL_ENABLE 0x1 + #define CONTROL_ENABLE_MASK 0x1 + #define CONTROL_ENABLE_SHIFT 0x1 + +#define PX210_PHY0_PMA_CONTROL2 0x38004 +#define PX210_PHY1_PMA_CONTROL2 0xb8004 + #define PLL0_LOCK_DONE (0x1 << 6) + #define PLL1_LOCK_DONE (0x1 << 7) + +#define PX210_PHY0_PLL0_CLK_SEL 0X684 +#define PX210_PHY0_PLL1_CLK_SEL 0x704 +#define PX210_PHY1_PLL_CLK_SEL 0X80684 + #define PLL_LINK_RATE_162000 0xf01 + #define PLL_LINK_RATE_270000 0x701 + #define PLL_LINK_RATE_540000 0x301 + #define PLL_LINK_RATE_810000 0x200 + +#define PX210_PHY0_HSCLK0_SEL 0x18398 +#define PX210_PHY0_HSCLK1_SEL 0x1a398 +#define PX210_PHY1_HSCLK_SEL 0x90398 + #define HSCLK_LINK_0 0x0 + #define HSCLK_LINK_1 0x1 + +#define PX210_PHY0_HSCLK0_DIV 0x1839c +#define PX210_PHY0_HSCLK1_DIV 0x1a39c +#define PX210_PHY1_HSCLK_DIV 0x9039c + #define HSCLK_LINK_RATE_162000 0x2 + #define HSCLK_LINK_RATE_270000 0x1 + #define HSCLK_LINK_RATE_540000 0x0 + #define HSCLK_LINK_RATE_810000 0x0 + +#define PX210_PHY0_PLLDRC0_CTRL 0x18394 +#define PX210_PHY0_PLLDRC1_CTRL 0x1a394 +#define PX210_PHY1_PLLDRC_CTRL 0x90394 + #define PLLDRC_LINK0 0x1 + #define PLLDRC_LINK1 0x9 + +#define PX210_PHY0_PLL0_DSM_M0 0x250 +#define PX210_PHY1_PLL0_DSM_M0 0x80250 + #define PLL0_DSM_M0 0x4 +#define PX210_PHY0_PLL0_VCOCAL_START 0x218 +#define PX210_PHY1_PLL0_VCOCAL_START 0x80218 + #define PLL0_VCOCAL_START 0xc5e +#define PX210_PHY0_PLL0_VCOCAL_CTRL 0x208 +#define PX210_PHY1_PLL0_VCOCAL_CTRL 0x80208 + #define PLL0_VCOCAL_CTRL 0x3 + +#define PX210_PHY0_PLL1_DSM_M0 0x350 + #define PLL1_DSM_M0 0x4 +#define PX210_PHY0_PLL1_VCOCAL_START 0x318 + #define PLL1_VCOCAL_START 0xc5e +#define PX210_PHY0_PLL1_VCOCAL_CTRL 0x308 + #define PLL1_VCOCAL_CTRL 0x3 + +#define PX210_PHY0_PLL0_CP_PADJ 0x690 +#define PX210_PHY0_PLL0_CP_IADJ 0x694 +#define PX210_PHY0_PLL0_CP_FILT_PADJ 0x698 +#define PX210_PHY0_PLL0_INTDIV 0x240 +#define PX210_PHY0_PLL0_FRACDIVL 0x244 +#define PX210_PHY0_PLL0_FRACDIVH 0x248 +#define PX210_PHY0_PLL0_HIGH_THR 0x24c +#define PX210_PHY0_PLL0_PDIAG_CTRL 0x680 +#define PX210_PHY0_PLL0_VCOCAL_PLLCNT_START 0x220 +#define PX210_PHY0_PLL0_LOCK_PEFCNT 0x270 +#define PX210_PHY0_PLL0_LOCK_PLLCNT_START 0x278 +#define PX210_PHY0_PLL0_LOCK_PLLCNT_THR 0x27c + +#define PX210_PHY0_PLL1_CP_PADJ 0x710 +#define PX210_PHY0_PLL1_CP_IADJ 0x714 +#define PX210_PHY0_PLL1_CP_FILT_PADJ 0x718 +#define PX210_PHY0_PLL1_INTDIV 0x340 +#define PX210_PHY0_PLL1_FRACDIVL 0x344 +#define PX210_PHY0_PLL1_FRACDIVH 0x348 +#define PX210_PHY0_PLL1_HIGH_THR 0x34c +#define PX210_PHY0_PLL1_PDIAG_CTRL 0x700 +#define PX210_PHY0_PLL1_VCOCAL_PLLCNT_START 0x320 +#define PX210_PHY0_PLL1_LOCK_PEFCNT 0x370 +#define PX210_PHY0_PLL1_LOCK_PLLCNT_START 0x378 +#define PX210_PHY0_PLL1_LOCK_PLLCNT_THR 0x37c + +#define PX210_PHY1_PLL0_CP_PADJ 0x80690 +#define PX210_PHY1_PLL0_CP_IADJ 0x80694 +#define PX210_PHY1_PLL0_CP_FILT_PADJ 0x80698 +#define PX210_PHY1_PLL0_INTDIV 0x80240 +#define PX210_PHY1_PLL0_FRACDIVL 0x80244 +#define PX210_PHY1_PLL0_FRACDIVH 0x80248 +#define PX210_PHY1_PLL0_HIGH_THR 0x8024c +#define PX210_PHY1_PLL0_PDIAG_CTRL 0x80680 +#define PX210_PHY1_PLL0_VCOCAL_PLLCNT_START 0x80220 +#define PX210_PHY1_PLL0_LOCK_PEFCNT 0x80270 +#define PX210_PHY1_PLL0_LOCK_PLLCNT_START 0x80278 +#define PX210_PHY1_PLL0_LOCK_PLLCNT_THR 0x8027c + +#define PX210_PHY0_PLL0_TX_PSC_A0 0x18400 +#define PX210_PHY1_PLL0_TX_PSC_A0 0x90400 + #define PLL0_TX_PSC_A0 0xfb +#define PX210_PHY0_PLL0_TX_PSC_A2 0x18408 +#define PX210_PHY1_PLL0_TX_PSC_A2 0x90408 + #define PLL0_TX_PSC_A2 0x4aa +#define PX210_PHY0_PLL0_TX_PSC_A3 0x1840c +#define PX210_PHY1_PLL0_TX_PSC_A3 0x9040c + #define PLL0_TX_PSC_A3 0x4aa +#define PX210_PHY0_PLL0_RX_PSC_A0 0x28000 +#define PX210_PHY1_PLL0_RX_PSC_A0 0xa0000 + #define PLL0_RX_PSC_A0 0x0 +#define PX210_PHY0_PLL0_RX_PSC_A2 0x28008 +#define PX210_PHY1_PLL0_RX_PSC_A2 0xa0008 + #define PLL0_RX_PSC_A2 0x0 +#define PX210_PHY0_PLL0_RX_PSC_A3 0x2800C +#define PX210_PHY1_PLL0_RX_PSC_A3 0xa000C + #define PLL0_RX_PSC_A3 0x0 +#define PX210_PHY0_PLL0_RX_PSC_CAL 0x28018 +#define PX210_PHY1_PLL0_RX_PSC_CAL 0xa0018 + #define PLL0_RX_PSC_CAL 0x0 + +#define PX210_PHY0_PLL1_TX_PSC_A0 0x1a400 + #define PLL1_TX_PSC_A0 0xfb +#define PX210_PHY0_PLL1_TX_PSC_A2 0x1a408 + #define PLL1_TX_PSC_A2 0x4aa +#define PX210_PHY0_PLL1_TX_PSC_A3 0x1a40c + #define PLL1_TX_PSC_A3 0x4aa +#define PX210_PHY0_PLL1_RX_PSC_A0 0x2a000 + #define PLL1_RX_PSC_A0 0x0 +#define PX210_PHY0_PLL1_RX_PSC_A2 0x2a008 + #define PLL1_RX_PSC_A2 0x0 +#define PX210_PHY0_PLL1_RX_PSC_A3 0x2a00C + #define PLL1_RX_PSC_A3 0x0 +#define PX210_PHY0_PLL1_RX_PSC_CAL 0x2a018 + #define PLL1_RX_PSC_CAL 0x0 + +#define PX210_PHY0_PLL0_XCVR_CTRL 0x183a8 +#define PX210_PHY1_PLL0_XCVR_CTRL 0x903a8 + #define PLL0_XCVR_CTRL 0xf +#define PX210_PHY0_PLL1_XCVR_CTRL 0x1a3a8 + #define PLL1_XCVR_CTRL 0xf + +#define PX210_PHY0_PLL0_RX_GCSM1_CTRL 0x28420 +#define PX210_PHY1_PLL0_RX_GCSM1_CTRL 0xa0420 + #define PLL0_RX_GCSM1_CTRL 0x0 +#define PX210_PHY0_PLL0_RX_GCSM2_CTRL 0x28440 +#define PX210_PHY1_PLL0_RX_GCSM2_CTRL 0xa0440 + #define PLL0_RX_GCSM2_CTRL 0x0 +#define PX210_PHY0_PLL0_RX_PERGCSM_CTRL 0x28460 +#define PX210_PHY1_PLL0_RX_PERGCSM_CTRL 0xa0460 + #define PLL0_RX_PERGCSM_CTRL 0x0 + +#define PX210_PHY0_PLL1_RX_GCSM1_CTRL 0x2a420 + #define PLL1_RX_GCSM1_CTRL 0x0 +#define PX210_PHY0_PLL1_RX_GCSM2_CTRL 0x2a440 + #define PLL1_RX_GCSM2_CTRL 0x0 +#define PX210_PHY0_PLL1_RX_PERGCSM_CTRL 0x2a460 + #define PLL1_RX_PERGCSM_CTRL 0x0 + +/* swing and emphasis */ +#define PX210_PHY0_PLL0_TX_DIAG_ACYA 0x1879c +#define PX210_PHY0_PLL1_TX_DIAG_ACYA 0x1a79c +#define PX210_PHY1_PLL0_TX_DIAG_ACYA 0x9079c + #define LOCK 1 + #define UNLOCK 0 + +#define PX210_PHY0_PLL0_TX_TXCC_CTRL 0x18100 +#define PX210_PHY0_PLL1_TX_TXCC_CTRL 0x1a100 +#define PX210_PHY1_PLL0_TX_TXCC_CTRL 0x90100 + #define TX_TXCC_CTRL 0x8a4 + +#define PX210_PHY0_PLL0_TX_DRV 0x18318 +#define PX210_PHY0_PLL1_TX_DRV 0x1a318 +#define PX210_PHY1_PLL0_TX_DRV 0x90318 + #define TX_DRV 0x3 + +#define PX210_PHY0_PLL0_TX_MGNFS 0x18140 +#define PX210_PHY0_PLL1_TX_MGNFS 0x1a140 +#define PX210_PHY1_PLL0_TX_MGNFS 0x90140 + +#define PX210_PHY0_PLL0_TX_CPOST 0x18130 +#define PX210_PHY0_PLL1_TX_CPOST 0x1a130 +#define PX210_PHY0_PLL1_TX_CPOST1 0x1a13c +#define PX210_PHY1_PLL0_TX_CPOST 0x90130 + +/******************************phy register end********************************************/ +#endif /* __PX210_REG_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/hwmon/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwmon/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..8cb5b6c96668f4143f53ad8b100b6736aee143c4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwmon/Kconfig @@ -0,0 +1,10 @@ +config SENSORS_PHYTIUM + tristate "Phytium Fan tach and capture counter driver" + help + This driver provides support for Phytium Fan Tacho and capture + counter controllers. + + This driver can also be built as a module. If so, the module + will be called tacho-phytium. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/hwmon/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwmon/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..0023d8f1206dc17c93fb451beb90aee1805368e6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwmon/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_SENSORS_PHYTIUM) += tacho-phytium.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/hwmon/tacho-phytium.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwmon/tacho-phytium.c new file mode 100644 index 0000000000000000000000000000000000000000..c89251f3595a3a3146832e735d6ef06ebd932d46 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwmon/tacho-phytium.c @@ -0,0 +1,391 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Hwmon driver for Phytium tachometer. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define TIMER_CTRL_REG 0x00 +#define TIMER_CTRL_MODE_SHIFT 0//0:1 +#define TIMER_CTRL_RESET_SHIFT BIT(2) +#define TIMER_CTRL_FORCE_SHIFT BIT(3) +#define TIMER_CTRL_CAPTURE_EN_SHIFT BIT(4) +#define TIMER_CTRL_CAPTURE_CNT_SHIFT 5//5:11 +#define TIMER_CTRL_ANTI_JITTER_SHIFT 18//18:19 +#define TIMER_CTRL_TACHO_MODE_SHIFT 20//20:21 +#define TIMER_CTRL_TIMER_CNT_MODE_SHIFT BIT(22) +#define TIMER_CTRL_BIT_SET_SHIFT 24 +#define TIMER_CTRL_CNT_EN_SHIFT BIT(25) +#define TIMER_CTRL_CNT_CLR_SHIFT BIT(26) +#define TIMER_CTRL_TIMER_MODE_SHIFT BIT(27) +#define TIMER_CTRL_PULSE_NUM_SHIFT 28//28:30 +#define TIMER_CTRL_TACHO_EN_SHIFT BIT(31) +#define TIMER_TACHO_RES_REG 0x04 +#define TIMER_TACHO_RES_VALID_SHIFT BIT(31) +#define TIMER_TACHO_RES_MASK GENMASK(30, 0) +#define TIMER_CMP_VALUE_UP_REG 0x08 +#define TIMER_CMP_VALUE_LOW_REG 0x1C +#define TIMER_CNT_VALUE_UP_REG 0x20 +#define TIMER_CNT_VALUE_LOW_REG 0x24 +#define TIMER_INT_MASK_REG 0x28 +#define TIMER_INT_STAT_REG 0x2C +#define TIMER_INT_CAPTURE_SHIFT BIT(5) +#define TIMER_INT_CYC_COMP_SHIFT BIT(4) +#define TIMER_INT_ONE_COMP_SHIFT BIT(3) +#define TIMER_INT_ROLLOVER_SHIFT BIT(2) +#define TIMER_INT_TACHO_UNDER_SHIFT BIT(1) +#define TIMER_INT_TACHO_OVER_SHIFT BIT(0) +#define TIMER_TACHO_OVER_REG 0x30 +#define TIMER_TACHO_UNDER_REG 0x34 +#define TIMER_START_VALUE_REG 0x38 + +#define TIMER_INT_CLR_MASK GENMASK(5, 0) + +enum tacho_modes { +tacho_mode = 1, +capture_mode, +}; + +enum edge_modes { +rising_edge, +falling_edge, +double_edge, +}; + +struct phytium_tacho { + struct device *dev; + struct device *hwmon; + void __iomem *base; + struct clk *clk; + u32 freq; + int irq; + u8 work_mode; + u8 edge_mode; + u32 debounce; +}; + +static u16 capture_count; + +static void phytium_tacho_init(struct phytium_tacho *tacho) +{ + u32 val; + + if (tacho->work_mode == tacho_mode) { + val = (TIMER_CTRL_TACHO_EN_SHIFT | + TIMER_CTRL_CNT_EN_SHIFT | + (tacho->edge_mode << TIMER_CTRL_TACHO_MODE_SHIFT) | + (tacho->debounce << TIMER_CTRL_ANTI_JITTER_SHIFT) | + (tacho->work_mode << TIMER_CTRL_MODE_SHIFT)); + writel_relaxed(val, tacho->base + TIMER_CTRL_REG); + writel_relaxed(0x2faf07f, tacho->base + TIMER_CMP_VALUE_LOW_REG); + } else { + val = (TIMER_CTRL_TACHO_EN_SHIFT | + TIMER_CTRL_CNT_EN_SHIFT | + (tacho->edge_mode << TIMER_CTRL_TACHO_MODE_SHIFT) | + (tacho->debounce << TIMER_CTRL_ANTI_JITTER_SHIFT) | + TIMER_CTRL_CAPTURE_EN_SHIFT | + (0x7f << TIMER_CTRL_CAPTURE_CNT_SHIFT) | + (tacho->work_mode << TIMER_CTRL_MODE_SHIFT)), + writel_relaxed(val, tacho->base + TIMER_CTRL_REG); + writel_relaxed(0x20, tacho->base + TIMER_INT_MASK_REG); + } +} + +static int phytium_get_fan_tach_rpm(struct phytium_tacho *priv) +{ + u64 raw_data, tach_div, clk_source; + u8 mode, both; + unsigned long timeout; + unsigned long loopcounter; + + timeout = jiffies + msecs_to_jiffies(500); + + for (loopcounter = 0;; loopcounter++) { + raw_data = readl_relaxed(priv->base + TIMER_TACHO_RES_REG); + + if (raw_data & TIMER_TACHO_RES_VALID_SHIFT) + break; + + if (time_after(jiffies, timeout)) + return -ETIMEDOUT; + + if (loopcounter > 3000) + msleep(20); + else { + udelay(100); + cond_resched(); + } + } + + raw_data = raw_data & TIMER_TACHO_RES_MASK; + clk_source = priv->freq; + mode = priv->edge_mode; + both = (mode == double_edge) ? 1 : 0; + tach_div = 1 << both; + + if (raw_data == 0) + return 0; + + return (clk_source * 60 * raw_data) / 0x2faf080 / tach_div; +} + +static ssize_t show_rpm(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int rpm; + struct phytium_tacho *priv = dev_get_drvdata(dev); + + rpm = phytium_get_fan_tach_rpm(priv); + if (rpm < 0) + return rpm; + + return sprintf(buf, "%d\n", rpm); +} + +static SENSOR_DEVICE_ATTR(fan_input, 0444, + show_rpm, NULL, 0); + +static struct attribute *tacho_dev_attrs[] = { + &sensor_dev_attr_fan_input.dev_attr.attr, + NULL +}; + +static umode_t tacho_dev_is_visible(struct kobject *kobj, + struct attribute *a, int index) +{ + return a->mode; +} + +static const struct attribute_group tacho_group = { + .attrs = tacho_dev_attrs, + .is_visible = tacho_dev_is_visible, +}; + +static const struct attribute_group *tacho_groups[] = { + &tacho_group, + NULL +}; + +static irqreturn_t capture_irq_handler(int irq, void *dev_id) +{ + struct phytium_tacho *priv = dev_id; + u32 status = readl_relaxed(priv->base + TIMER_INT_STAT_REG); + + if (status & TIMER_INT_CAPTURE_SHIFT) { + capture_count++; + + if (capture_count == 0) + dev_err(priv->dev, "Capture counter is overflowed"); + + writel_relaxed(status, priv->base + TIMER_INT_STAT_REG); + return IRQ_HANDLED; + } + return IRQ_NONE; +} + +static ssize_t show_capture(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int cnt; + struct phytium_tacho *priv = dev_get_drvdata(dev); + + cnt = capture_count * 0x7f + readl_relaxed(priv->base + TIMER_CNT_VALUE_LOW_REG); + + return sprintf(buf, "%d\n", cnt); +} + +static SENSOR_DEVICE_ATTR(capture_input, 0444, + show_capture, NULL, 0); + +static struct attribute *capture_dev_attrs[] = { + &sensor_dev_attr_capture_input.dev_attr.attr, + NULL +}; + +static umode_t capture_dev_is_visible(struct kobject *kobj, + struct attribute *a, int index) +{ + return a->mode; +} + +static const struct attribute_group capture_group = { + .attrs = capture_dev_attrs, + .is_visible = capture_dev_is_visible, +}; + +static const struct attribute_group *capture_groups[] = { + &capture_group, + NULL +}; + +static int phytium_tacho_get_work_mode(struct phytium_tacho *tacho) +{ + struct fwnode_handle *nc = dev_fwnode(tacho->dev); + + if (fwnode_property_read_bool(nc, "tacho")) + return tacho_mode; + if (fwnode_property_read_bool(nc, "capture")) + return capture_mode; + return tacho_mode; +} + +static int phytium_tacho_get_edge_mode(struct phytium_tacho *tacho) +{ + struct fwnode_handle *nc = dev_fwnode(tacho->dev); + + if (fwnode_property_read_bool(nc, "up")) + return rising_edge; + if (fwnode_property_read_bool(nc, "down")) + return falling_edge; + if (fwnode_property_read_bool(nc, "double")) + return double_edge; + return rising_edge; +} + +static int phytium_tacho_get_debounce(struct phytium_tacho *tacho) +{ + u32 value; + struct fwnode_handle *nc = dev_fwnode(tacho->dev); + + if (!fwnode_property_read_u32(nc, "debounce-level", &value)) + return value; + else + return 0; +} + +static void phytium_tacho_get_of_data(struct phytium_tacho *tacho) +{ + tacho->work_mode = phytium_tacho_get_work_mode(tacho); + tacho->edge_mode = phytium_tacho_get_edge_mode(tacho); + tacho->debounce = phytium_tacho_get_debounce(tacho); +} + +static int phytium_tacho_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct resource *res; + struct phytium_tacho *tacho; + int ret; + + tacho = devm_kzalloc(dev, sizeof(*tacho), GFP_KERNEL); + if (!tacho) + return -ENOMEM; + + tacho->dev = &pdev->dev; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res) + return -ENOENT; + + tacho->base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(tacho->base)) { + dev_err(&pdev->dev, "region map failed\n"); + return PTR_ERR(tacho->base); + } + if (dev->of_node) { + tacho->clk = devm_clk_get(&pdev->dev, NULL); + if (IS_ERR(tacho->clk)) + return PTR_ERR(tacho->clk); + ret = clk_prepare_enable(tacho->clk); + if (ret) + return ret; + + tacho->freq = clk_get_rate(tacho->clk); + } else if (has_acpi_companion(dev)){ + if(fwnode_property_read_u32(dev_fwnode(dev),"clock-frequency", (u32 *)&(tacho->freq) ) <0) + tacho->freq = 50000000; + } + + tacho->irq = platform_get_irq(pdev, 0); + if (tacho->irq < 0) { + dev_err(&pdev->dev, "no irq resource?\n"); + return tacho->irq; + } + + ret = devm_request_irq(dev, tacho->irq, capture_irq_handler, + 0, "phytium_tacho", tacho); + if (ret) { + dev_err(&pdev->dev, "Cannot request IRQ\n"); + return ret; + } + + phytium_tacho_get_of_data(tacho); + + phytium_tacho_init(tacho); + + if (tacho->work_mode == tacho_mode) + tacho->hwmon = devm_hwmon_device_register_with_groups(dev, + "phytium_tacho", + tacho, tacho_groups); + else + tacho->hwmon = devm_hwmon_device_register_with_groups(dev, + "phytium_capture", + tacho, capture_groups); + + platform_set_drvdata(pdev, tacho); + + return PTR_ERR_OR_ZERO(tacho->hwmon); +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_tacho_suspend(struct device *dev) +{ + return 0; +} + +static int phytium_tacho_resume(struct device *dev) +{ + struct phytium_tacho *tacho = dev_get_drvdata(dev); + + phytium_tacho_init(tacho); + + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_tacho_pm, phytium_tacho_suspend, phytium_tacho_resume); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_tacho_acpi_ids[] = { + { "PHYT0033", 0 }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(acpi, phytium_tacho_acpi_ids); +#endif + +static const struct of_device_id tacho_of_match[] = { + { .compatible = "phytium,tacho", }, + {}, +}; +MODULE_DEVICE_TABLE(of, tacho_of_match); + +static struct platform_driver phytium_tacho_driver = { + .probe = phytium_tacho_probe, + .driver = { + .name = "phytium_tacho", + .pm = &phytium_tacho_pm, + .of_match_table = of_match_ptr(tacho_of_match), + .acpi_match_table = ACPI_PTR(phytium_tacho_acpi_ids), + }, +}; + +module_platform_driver(phytium_tacho_driver); + +MODULE_AUTHOR("Zhang Yiqun "); +MODULE_DESCRIPTION("Phytium tachometer driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/hwspinlock/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwspinlock/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..9671c560beffe94878e6dec4780f7696f5d170cd --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwspinlock/Kconfig @@ -0,0 +1,10 @@ +config HWSPINLOCK_PHYTIUM + tristate "Phytium Hardware Spinlock device" + depends on HWSPINLOCK + depends on ARCH_PHYTIUM + help + Say y here to support the Phytium Hardware Spinlock device. + + If unsure, say N. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/hwspinlock/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwspinlock/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..16c328e1ccae5a7c171a6c2655f1c7633bed2b0a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwspinlock/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_HWSPINLOCK_PHYTIUM) += phytium_hwspinlock.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/hwspinlock/phytium_hwspinlock.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwspinlock/phytium_hwspinlock.c new file mode 100644 index 0000000000000000000000000000000000000000..07bf47442e19a0839ca290e4a2051f51de2b2be3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/hwspinlock/phytium_hwspinlock.c @@ -0,0 +1,223 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium hardware spinlock driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "../../../drivers/hwspinlock/hwspinlock_internal.h" + +/* Spinlock register offsets */ +#define LOCK_BASE 0x10 + +#define SEMA_NOTTAKEN (0) /* free */ +#define SEMA_TAKEN (1) /* locked */ + +static int phytium_hwspinlock_trylock(struct hwspinlock *lock) +{ + void __iomem *lock_addr = lock->priv; + + /* attempt to acquire the lock by reading its value */ + return (readl(lock_addr) == SEMA_NOTTAKEN); +} + +static void phytium_hwspinlock_unlock(struct hwspinlock *lock) +{ + void __iomem *lock_addr = lock->priv; + + /* release the lock by writing 0 to it */ + writel(SEMA_NOTTAKEN, lock_addr); +} + +static void phytium_hwspinlock_relax(struct hwspinlock *lock) +{ + ndelay(50); +} + +static const struct hwspinlock_ops phytium_hwspinlock_ops = { + .trylock = phytium_hwspinlock_trylock, + .unlock = phytium_hwspinlock_unlock, + .relax = phytium_hwspinlock_relax, +}; + +static ssize_t phytium_hwlock_test_store(struct device *dev, + struct device_attribute *attr, const char *buf, size_t count) +{ + struct hwspinlock *hwlock = NULL; + int ret; + + /* dynamically assign a hwspinlock */ + hwlock = hwspin_lock_request(); + if (!hwlock) { + pr_err("%s can't request hwlock\n", __func__); + return -ENODEV; + } + ret = hwspin_lock_timeout(hwlock, 1000); + if (ret < 0) { + pr_err("do lock fail\n"); + goto err; + } + pr_info("do lock success\n"); + + ret = hwspin_trylock(hwlock); + if (ret == -EINVAL) { + pr_err("lock invalid\n"); + goto err; + } + else + pr_info("lock status is %s before, than unlock it\n", ret ? "locked" : "no use"); + + pr_info("do lock test pass\n"); +err: + hwspin_unlock(hwlock); + hwspin_lock_free(hwlock); + return count; +} + +static DEVICE_ATTR_WO(phytium_hwlock_test); + + +static int phytium_hwspinlock_probe(struct platform_device *pdev) +{ + struct fwnode_handle *np = dev_fwnode(&(pdev->dev)); + struct hwspinlock_device *bank; + struct hwspinlock *hwlock; + struct resource *res; + void __iomem *io_base; + int num_locks, i, ret; + + if (!np) + return -ENODEV; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res) + return -ENODEV; + + io_base = ioremap(res->start, resource_size(res)); + if (!io_base) + return -ENOMEM; + + /* + * make sure the module is enabled and clocked before reading + * the module SYSSTATUS register + */ + pm_runtime_enable(&pdev->dev); + ret = pm_runtime_get_sync(&pdev->dev); + if (ret < 0) { + pm_runtime_put_noidle(&pdev->dev); + goto iounmap_base; + } + + /* Determine number of locks */ + if (fwnode_property_read_u32(np, "nr-locks", &num_locks)) { + dev_err(&pdev->dev, "missing/invalid number of locks\n"); + ret = -EINVAL; + goto iounmap_base; + } + + /* + * runtime PM will make sure the clock of this module is + * enabled again iff at least one lock is requested + */ + ret = pm_runtime_put(&pdev->dev); + if (ret < 0) + goto iounmap_base; + + bank = kzalloc(struct_size(bank, lock, num_locks), GFP_KERNEL); + if (!bank) { + ret = -ENOMEM; + goto iounmap_base; + } + + platform_set_drvdata(pdev, bank); + + for (i = 0, hwlock = &bank->lock[0]; i < num_locks; i++, hwlock++) { + /* Set register address of each lock */ + hwlock->priv = io_base + LOCK_BASE + sizeof(u32) * i; + } + + ret = hwspin_lock_register(bank, &pdev->dev, &phytium_hwspinlock_ops, + 0, num_locks); + if (ret) + goto reg_fail; + + ret = device_create_file(&pdev->dev, &dev_attr_phytium_hwlock_test); + return ret; +reg_fail: + kfree(bank); +iounmap_base: + iounmap(io_base); + return ret; +} + +static int phytium_hwspinlock_remove(struct platform_device *pdev) +{ + struct hwspinlock_device *bank = platform_get_drvdata(pdev); + void __iomem *io_base = bank->lock[0].priv - LOCK_BASE; + int ret; + + ret = hwspin_lock_unregister(bank); + if (ret) { + dev_err(&pdev->dev, "%s failed: %d\n", __func__, ret); + return ret; + } + + iounmap(io_base); + kfree(bank); + + return 0; +} + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_hwspinlock_acpi_ids[] = { + { "PHYT0027", 0 }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(acpi, phytium_hwspinlock_acpi_ids); +#endif + +static const struct of_device_id phytium_hwspinlock_of_match[] = { + { .compatible = "phytium,hwspinlock", }, + { /* end */ }, +}; +MODULE_DEVICE_TABLE(of, phytium_hwspinlock_of_match); + +static struct platform_driver phytium_hwspinlock_driver = { + .probe = phytium_hwspinlock_probe, + .remove = phytium_hwspinlock_remove, + .driver = { + .name = "phytium_hwspinlock", + .of_match_table = of_match_ptr(phytium_hwspinlock_of_match), + .acpi_match_table = ACPI_PTR(phytium_hwspinlock_acpi_ids), + }, +}; + +static int __init phytium_hwspinlock_init(void) +{ + return platform_driver_register(&phytium_hwspinlock_driver); +} +postcore_initcall(phytium_hwspinlock_init); + +static void __exit phytium_hwspinlock_exit(void) +{ + platform_driver_unregister(&phytium_hwspinlock_driver); +} +module_exit(phytium_hwspinlock_exit); + +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Hardware spinlock driver for Phytium"); +MODULE_AUTHOR("Chen Baozi "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..7ebaef6574c45971d5c71497b15d99f2a89e23c8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/Kconfig @@ -0,0 +1,29 @@ +config I2C_PHYTIUM_CORE + tristate + +config I2C_PHYTIUM_PCI + tristate "Phytium I2C PCI" + depends on PCI && ARCH_PHYTIUM + select I2C_PHYTIUM_CORE + select I2C_SMBUS + help + If you say yes to this option, support will be included for the + Phytium I2C adapter. Only master mode is supported. + + This driver can also be built as a module. If so, the module + will be called i2c-phytium-pci. + +config I2C_PHYTIUM_PLATFORM + tristate "Phytium I2C Platform" + depends on (ACPI && COMMON_CLK) || !ACPI + select I2C_SLAVE + select I2C_PHYTIUM_CORE + select I2C_SMBUS + help + If you say yes to this option, support will be included for the + Phytium I2C adapter. Only master mode is supported. + + This driver can also be built as a module. If so, the module + will be called i2c-phytium-platform. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..7c84153daf0961ae12fdaacafab0db8a861bda6c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/Makefile @@ -0,0 +1,4 @@ +obj-$(CONFIG_I2C_PHYTIUM_CORE) += i2c-phytium-core.o +i2c-phytium-core-objs := i2c-phytium-common.o i2c-phytium-master.o i2c-phytium-slave.o +obj-$(CONFIG_I2C_PHYTIUM_PCI) += i2c-phytium-pci.o +obj-$(CONFIG_I2C_PHYTIUM_PLATFORM) += i2c-phytium-platform.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-common.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-common.c new file mode 100644 index 0000000000000000000000000000000000000000..d5f1ce24695fa0cc09425db28ec50479851b95e3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-common.c @@ -0,0 +1,203 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * Phytium I2C adapter driver. + * + * Based on the TI DAVINCI I2C adapter driver. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "i2c-phytium-core.h" + +static char *abort_sources[] = { + [ABRT_7B_ADDR_NOACK] = + "slave address not acknowledged (7bit mode)", + [ABRT_10ADDR1_NOACK] = + "first address byte not acknowledged (10bit mode)", + [ABRT_10ADDR2_NOACK] = + "second address byte not acknowledged (10bit mode)", + [ABRT_TXDATA_NOACK] = + "data not acknowledged", + [ABRT_GCALL_NOACK] = + "no acknowledgment for a general call", + [ABRT_GCALL_READ] = + "read after general call", + [ABRT_SBYTE_ACKDET] = + "start byte acknowledged", + [ABRT_SBYTE_NORSTRT] = + "trying to send start byte when restart is disabled", + [ABRT_10B_RD_NORSTRT] = + "trying to read when restart is disabled (10bit mode)", + [ABRT_MASTER_DIS] = + "trying to use disabled adapter", + [ARB_LOST] = + "lost arbitration", + [ABRT_SLAVE_FLUSH_TXFIFO] = + "read command so flush old data in the TX FIFO", + [ABRT_SLAVE_ARBLOST] = + "slave lost the bus while transmitting data to a remote master", + [ABRT_SLAVE_RD_INTX] = + "incorrect slave-transmitter mode configuration", +}; + +u32 phytium_readl(struct phytium_i2c_dev *dev, int offset) +{ + return readl_relaxed(dev->base + offset); +} + +void phytium_writel(struct phytium_i2c_dev *dev, u32 b, int offset) +{ + writel_relaxed(b, dev->base + offset); +} + +u32 i2c_phytium_scl_hcnt(u32 ic_clk, u32 tSYMBOL, u32 tf, int cond, int offset) +{ + if (cond) + return (ic_clk * tSYMBOL + 500000) / 1000000 - 8 + offset; + else + return (ic_clk * (tSYMBOL + tf) + 500000) / 1000000 - 3 + offset; +} + +u32 i2c_phytium_scl_lcnt(u32 ic_clk, u32 tLOW, u32 tf, int offset) +{ + return ((ic_clk * (tLOW + tf) + 500000) / 1000000) - 1 + offset; +} + +int i2c_phytium_set_sda_hold(struct phytium_i2c_dev *dev) +{ + if (!dev->sda_hold_time) { + /* Keep previous hold time setting if no one set it */ + dev->sda_hold_time = phytium_readl(dev, IC_SDA_HOLD); + } + + if (!(dev->sda_hold_time & IC_SDA_HOLD_RX_MASK)) + dev->sda_hold_time |= 1 << IC_SDA_HOLD_RX_SHIFT; + + dev_dbg(dev->dev, "SDA Hold Time TX:RX = %d:%d\n", + dev->sda_hold_time & ~(u32)IC_SDA_HOLD_RX_MASK, + dev->sda_hold_time >> IC_SDA_HOLD_RX_SHIFT); + + return 0; +} + +void __i2c_phytium_disable(struct phytium_i2c_dev *dev) +{ + int timeout = 100; + + do { + __i2c_phytium_disable_nowait(dev); + if ((phytium_readl(dev, IC_ENABLE_STATUS) & 1) == 0) + return; + + /* + * Wait 10 times the signaling period of the highest I2C + * transfer supported by the driver (for 400KHz this is + * 25us). + */ + usleep_range(25, 250); + } while (timeout--); + + dev_warn(dev->dev, "timeout in disabling adapter\n"); +} + +unsigned long i2c_phytium_clk_rate(struct phytium_i2c_dev *dev) +{ + if (WARN_ON_ONCE(!dev->get_clk_rate_khz)) + return 0; + return dev->get_clk_rate_khz(dev); +} + +int i2c_phytium_prepare_clk(struct phytium_i2c_dev *dev, bool prepare) +{ + if (IS_ERR(dev->clk)) + return PTR_ERR(dev->clk); + + if (prepare) + return clk_prepare_enable(dev->clk); + + clk_disable_unprepare(dev->clk); + return 0; +} +EXPORT_SYMBOL_GPL(i2c_phytium_prepare_clk); + +int i2c_phytium_wait_bus_not_busy(struct phytium_i2c_dev *dev) +{ + int timeout = 20; /* 20 ms */ + + while (phytium_readl(dev, IC_STATUS) & IC_STATUS_ACTIVITY) { + if (timeout <= 0) { + dev_warn(dev->dev, "timeout waiting for bus ready\n"); + i2c_recover_bus(&dev->adapter); + + if (phytium_readl(dev, IC_STATUS) & IC_STATUS_ACTIVITY) + return -ETIMEDOUT; + return 0; + } + timeout--; + usleep_range(1000, 1100); + } + + return 0; +} + +int i2c_phytium_handle_tx_abort(struct phytium_i2c_dev *dev) +{ + unsigned long abort_source = dev->abort_source; + int i; + + if (abort_source & IC_TX_ABRT_NOACK) { + for_each_set_bit(i, &abort_source, ARRAY_SIZE(abort_sources)) + dev_dbg(dev->dev, + "%s: %s\n", __func__, abort_sources[i]); + return -EREMOTEIO; + } + + for_each_set_bit(i, &abort_source, ARRAY_SIZE(abort_sources)) + dev_err(dev->dev, "%s: %s\n", __func__, abort_sources[i]); + + if (abort_source & IC_TX_ARB_LOST) + return -EAGAIN; + else if (abort_source & IC_TX_ABRT_GCALL_READ) + return -EINVAL; + else + return -EIO; + + return 0; +} + +u32 i2c_phytium_func(struct i2c_adapter *adapter) +{ + struct phytium_i2c_dev *dev = i2c_get_adapdata(adapter); + + return dev->functionality; +} + +void i2c_phytium_disable(struct phytium_i2c_dev *dev) +{ + /* Disable controller */ + __i2c_phytium_disable(dev); + + /* Disable all interrupts */ + phytium_writel(dev, 0, IC_INTR_MASK); + phytium_readl(dev, IC_CLR_INTR); +} + +void i2c_phytium_disable_int(struct phytium_i2c_dev *dev) +{ + phytium_writel(dev, 0, IC_INTR_MASK); +} + +MODULE_AUTHOR("Cheng Quan "); +MODULE_DESCRIPTION("Phytium I2C bus adapter core"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-core.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-core.h new file mode 100644 index 0000000000000000000000000000000000000000..726a4f9f4f17285c1a60be38f047d4419df5c24c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-core.h @@ -0,0 +1,254 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium I2C adapter driver. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include + +#define IC_DEFAULT_FUNCTIONALITY (I2C_FUNC_I2C | \ + I2C_FUNC_SMBUS_BYTE | \ + I2C_FUNC_SMBUS_BYTE_DATA | \ + I2C_FUNC_SMBUS_WORD_DATA | \ + I2C_FUNC_SMBUS_BLOCK_DATA | \ + I2C_FUNC_SMBUS_I2C_BLOCK) + +#define IC_CON_MASTER 0x1 +#define IC_CON_SPEED_STD 0x2 +#define IC_CON_SPEED_FAST 0x4 +#define IC_CON_SPEED_HIGH 0x6 +#define IC_CON_SPEED_MASK 0x6 +#define IC_CON_10BITADDR_SLAVE 0x8 +#define IC_CON_10BITADDR_MASTER 0x10 +#define IC_CON_RESTART_EN 0x20 +#define IC_CON_SLAVE_DISABLE 0x40 +#define IC_CON_STOP_DET_IFADDRESSED 0x80 +#define IC_CON_TX_EMPTY_CTRL 0x100 +#define IC_CON_RX_FIFO_FULL_HLD_CTRL 0x200 + +#define IC_CON 0x0 +#define IC_TAR 0x4 +#define IC_SAR 0x8 +#define IC_DATA_CMD 0x10 +#define IC_SS_SCL_HCNT 0x14 +#define IC_SS_SCL_LCNT 0x18 +#define IC_FS_SCL_HCNT 0x1c +#define IC_FS_SCL_LCNT 0x20 +#define IC_HS_SCL_HCNT 0x24 +#define IC_HS_SCL_LCNT 0x28 +#define IC_INTR_STAT 0x2c +#define IC_INTR_MASK 0x30 +#define IC_RAW_INTR_STAT 0x34 +#define IC_RX_TL 0x38 +#define IC_TX_TL 0x3c +#define IC_CLR_INTR 0x40 +#define IC_CLR_RX_UNDER 0x44 +#define IC_CLR_RX_OVER 0x48 +#define IC_CLR_TX_OVER 0x4c +#define IC_CLR_RD_REQ 0x50 +#define IC_CLR_TX_ABRT 0x54 +#define IC_CLR_RX_DONE 0x58 +#define IC_CLR_ACTIVITY 0x5c +#define IC_CLR_STOP_DET 0x60 +#define IC_CLR_START_DET 0x64 +#define IC_CLR_GEN_CALL 0x68 +#define IC_ENABLE 0x6c +#define IC_STATUS 0x70 +#define IC_TXFLR 0x74 +#define IC_RXFLR 0x78 +#define IC_SDA_HOLD 0x7c +#define IC_TX_ABRT_SOURCE 0x80 +#define IC_ENABLE_STATUS 0x9c +#define IC_SMBCLK_LOW_MEXT 0xa8 +#define IC_SMBCLK_LOW_TIMEOUT 0xac +#define IC_SMBDAT_STUCK_TIMEOUT 0xb4 +#define IC_CLR_SMBCLK_EXT_LOW_TIMEOUT 0xbc +#define IC_CLR_SMBCLK_TMO_LOW_TIMEOUT 0xc0 +#define IC_CLR_SMBDAT_LOW_TIMEOUT 0xc4 +#define IC_CLR_SMBALERT_IN_N 0xd0 + +#define IC_INTR_RX_UNDER 0x001 +#define IC_INTR_RX_OVER 0x002 +#define IC_INTR_RX_FULL 0x004 +#define IC_INTR_TX_OVER 0x008 +#define IC_INTR_TX_EMPTY 0x010 +#define IC_INTR_RD_REQ 0x020 +#define IC_INTR_TX_ABRT 0x040 +#define IC_INTR_RX_DONE 0x080 +#define IC_INTR_ACTIVITY 0x100 +#define IC_INTR_STOP_DET 0x200 +#define IC_INTR_START_DET 0x400 +#define IC_INTR_GEN_CALL 0x800 +#define IC_INTR_SMBCLK_EXT_LOW_TIMEOUT 0x1000 +#define IC_INTR_SMBCLK_TMO_LOW_TIMEOUT 0x2000 +#define IC_INTR_SMBSDA_LOW_TIMEOUT 0x4000 +#define IC_INTR_SMBALERT_IN_N 0x20000 + +#define IC_INTR_DEFAULT_MASK (IC_INTR_RX_FULL | \ + IC_INTR_TX_ABRT | \ + IC_INTR_STOP_DET) +#define IC_INTR_MASTER_MASK (IC_INTR_DEFAULT_MASK | \ + IC_INTR_TX_EMPTY) +#define IC_INTR_SLAVE_MASK (IC_INTR_DEFAULT_MASK | \ + IC_INTR_RX_DONE | \ + IC_INTR_RX_UNDER | \ + IC_INTR_RD_REQ) +#define IC_INTR_SMBUS_MASK (IC_INTR_MASTER_MASK | \ + IC_INTR_SMBCLK_EXT_LOW_TIMEOUT | \ + IC_INTR_SMBCLK_TMO_LOW_TIMEOUT | \ + IC_INTR_SMBSDA_LOW_TIMEOUT) + +#define IC_STATUS_ACTIVITY 0x1 +#define IC_STATUS_TFE BIT(2) +#define IC_STATUS_MASTER_ACTIVITY BIT(5) +#define IC_STATUS_SLAVE_ACTIVITY BIT(6) + +#define IC_SDA_HOLD_RX_SHIFT 16 +#define IC_SDA_HOLD_RX_MASK GENMASK(23, IC_SDA_HOLD_RX_SHIFT) + +#define IC_ERR_TX_ABRT 0x1 + +#define IC_TAR_10BITADDR_MASTER BIT(12) + +#define IC_COMP_PARAM_1_SPEED_MODE_HIGH (BIT(2) | BIT(3)) +#define IC_COMP_PARAM_1_SPEED_MODE_MASK GENMASK(3, 2) + +#define STATUS_IDLE 0x0 +#define STATUS_WRITE_IN_PROGRESS 0x1 +#define STATUS_READ_IN_PROGRESS 0x2 + +/* + * operation modes + */ +#define PHYTIUM_IC_MASTER 0 +#define PHYTIUM_IC_SLAVE 1 + +#define ABRT_7B_ADDR_NOACK 0 +#define ABRT_10ADDR1_NOACK 1 +#define ABRT_10ADDR2_NOACK 2 +#define ABRT_TXDATA_NOACK 3 +#define ABRT_GCALL_NOACK 4 +#define ABRT_GCALL_READ 5 +#define ABRT_SBYTE_ACKDET 7 +#define ABRT_SBYTE_NORSTRT 9 +#define ABRT_10B_RD_NORSTRT 10 +#define ABRT_MASTER_DIS 11 +#define ARB_LOST 12 +#define ABRT_SLAVE_FLUSH_TXFIFO 13 +#define ABRT_SLAVE_ARBLOST 14 +#define ABRT_SLAVE_RD_INTX 15 + +#define IC_TX_ABRT_7B_ADDR_NOACK (1UL << ABRT_7B_ADDR_NOACK) +#define IC_TX_ABRT_10ADDR1_NOACK (1UL << ABRT_10ADDR1_NOACK) +#define IC_TX_ABRT_10ADDR2_NOACK (1UL << ABRT_10ADDR2_NOACK) +#define IC_TX_ABRT_TXDATA_NOACK (1UL << ABRT_TXDATA_NOACK) +#define IC_TX_ABRT_GCALL_NOACK (1UL << ABRT_GCALL_NOACK) +#define IC_TX_ABRT_GCALL_READ (1UL << ABRT_GCALL_READ) +#define IC_TX_ABRT_SBYTE_ACKDET (1UL << ABRT_SBYTE_ACKDET) +#define IC_TX_ABRT_SBYTE_NORSTRT (1UL << ABRT_SBYTE_NORSTRT) +#define IC_TX_ABRT_10B_RD_NORSTRT (1UL << ABRT_10B_RD_NORSTRT) +#define IC_TX_ABRT_MASTER_DIS (1UL << ABRT_MASTER_DIS) +#define IC_TX_ARB_LOST (1UL << ARB_LOST) +#define IC_RX_ABRT_SLAVE_RD_INTX (1UL << ABRT_SLAVE_RD_INTX) +#define IC_RX_ABRT_SLAVE_ARBLOST (1UL << ABRT_SLAVE_ARBLOST) +#define IC_RX_ABRT_SLAVE_FLUSH_TXFIFO (1UL << ABRT_SLAVE_FLUSH_TXFIFO) + +#define IC_TX_ABRT_NOACK (IC_TX_ABRT_7B_ADDR_NOACK | \ + IC_TX_ABRT_10ADDR1_NOACK | \ + IC_TX_ABRT_10ADDR2_NOACK | \ + IC_TX_ABRT_TXDATA_NOACK | \ + IC_TX_ABRT_GCALL_NOACK) +#define CONTROLLER_TYPE_IIC 0 +#define CONTROLLER_TYPE_SMBUS 1 + +struct phytium_i2c_dev { + struct device *dev; + void __iomem *base; + int irq; + u32 flags; + struct completion cmd_complete; + struct clk *clk; + struct reset_control *rst; + int mode; + struct i2c_client *slave; + u32 (*get_clk_rate_khz)(struct phytium_i2c_dev *dev); + + struct i2c_adapter adapter; + struct i2c_client *ara; + struct i2c_smbus_alert_setup alert_data; + + struct phytium_pci_i2c *controller; + + unsigned int status; + int cmd_err; + u32 abort_source; + + struct i2c_msg *msgs; + int msgs_num; + int msg_write_idx; + int msg_read_idx; + int msg_err; + u32 tx_buf_len; + u8 *tx_buf; + u32 rx_buf_len; + u8 *rx_buf; + + u32 master_cfg; + u32 slave_cfg; + u32 functionality; + unsigned int tx_fifo_depth; + unsigned int rx_fifo_depth; + int rx_outstanding; + + struct i2c_timings timings; + u32 sda_hold_time; + u16 ss_hcnt; + u16 ss_lcnt; + u16 fs_hcnt; + u16 fs_lcnt; + u16 fp_hcnt; + u16 fp_lcnt; + u16 hs_hcnt; + u16 hs_lcnt; + + bool pm_disabled; + void (*disable)(struct phytium_i2c_dev *dev); + void (*disable_int)(struct phytium_i2c_dev *dev); + int (*init)(struct phytium_i2c_dev *dev); +}; + +#define ACCESS_INTR_MASK 0x00000004 + +#define DEFAULT_CLOCK_FREQUENCY 48000000 + +u32 phytium_readl(struct phytium_i2c_dev *dev, int offset); +void phytium_writel(struct phytium_i2c_dev *dev, u32 b, int offset); +unsigned long i2c_phytium_clk_rate(struct phytium_i2c_dev *dev); +int i2c_phytium_prepare_clk(struct phytium_i2c_dev *dev, bool prepare); +int i2c_phytium_wait_bus_not_busy(struct phytium_i2c_dev *dev); +int i2c_phytium_handle_tx_abort(struct phytium_i2c_dev *dev); +u32 i2c_phytium_func(struct i2c_adapter *adap); +void i2c_phytium_disable(struct phytium_i2c_dev *dev); +void i2c_phytium_disable_int(struct phytium_i2c_dev *dev); +int i2c_phytium_set_sda_hold(struct phytium_i2c_dev *dev); +u32 i2c_phytium_scl_hcnt(u32 ic_clk, u32 tSYMBOL, u32 tf, int cond, int offset); +u32 i2c_phytium_scl_lcnt(u32 ic_clk, u32 tLOW, u32 tf, int offset); + +static inline void __i2c_phytium_enable(struct phytium_i2c_dev *dev) +{ + phytium_writel(dev, 1, IC_ENABLE); +} + +static inline void __i2c_phytium_disable_nowait(struct phytium_i2c_dev *dev) +{ + phytium_writel(dev, 0, IC_ENABLE); +} + +void __i2c_phytium_disable(struct phytium_i2c_dev *dev); + +extern int i2c_phytium_probe(struct phytium_i2c_dev *dev); + +extern int i2c_phytium_probe_slave(struct phytium_i2c_dev *dev); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-master.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-master.c new file mode 100644 index 0000000000000000000000000000000000000000..b478e5a53b2f629f517986760181416acb4dd5e8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-master.c @@ -0,0 +1,578 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium I2C adapter driver. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "i2c-phytium-core.h" + +static int i2c_phytium_init_master(struct phytium_i2c_dev *dev) +{ + /* Disable the adapter */ + __i2c_phytium_disable(dev); + + /* Write standard speed timing parameters */ + phytium_writel(dev, dev->ss_hcnt, IC_SS_SCL_HCNT); + phytium_writel(dev, dev->ss_lcnt, IC_SS_SCL_LCNT); + + /* Write fast mode/fast mode plus timing parameters */ + phytium_writel(dev, dev->fs_hcnt, IC_FS_SCL_HCNT); + phytium_writel(dev, dev->fs_lcnt, IC_FS_SCL_LCNT); + + /* Write high speed timing parameters if supported */ + if (dev->hs_hcnt && dev->hs_hcnt) { + phytium_writel(dev, dev->hs_hcnt, IC_HS_SCL_HCNT); + phytium_writel(dev, dev->hs_lcnt, IC_HS_SCL_LCNT); + } + + /* Write SDA hold time if supported */ + if (dev->sda_hold_time) + phytium_writel(dev, dev->sda_hold_time, IC_SDA_HOLD); + + /* Configure Tx/Rx FIFO threshold levels */ + phytium_writel(dev, dev->tx_fifo_depth >> 1, IC_TX_TL); + phytium_writel(dev, 0, IC_RX_TL); + + /* Configure the I2C master */ + phytium_writel(dev, dev->master_cfg, IC_CON); + + return 0; +} + +static void i2c_phytium_xfer_init(struct phytium_i2c_dev *dev) +{ + struct i2c_msg *msgs = dev->msgs; + u32 ic_con, ic_tar = 0; + + /* Disable the adapter */ + __i2c_phytium_disable(dev); + + /* If the slave address is 10-bit address, enable 10BITADDR */ + ic_con = phytium_readl(dev, IC_CON); + if (msgs[dev->msg_write_idx].flags & I2C_M_TEN) { + ic_con |= IC_CON_10BITADDR_MASTER; + ic_tar = IC_TAR_10BITADDR_MASTER; + } else { + ic_con &= ~IC_CON_10BITADDR_MASTER; + } + + phytium_writel(dev, ic_con, IC_CON); + + /* + * Set the slave (target) address and enable 10-bit addressing mode + * if applicable. + */ + phytium_writel(dev, msgs[dev->msg_write_idx].addr | ic_tar, IC_TAR); + + /* Enforce disabled interrupts */ + i2c_phytium_disable_int(dev); + + /* Enable the adapter */ + __i2c_phytium_enable(dev); + + /* Dummy read */ + phytium_readl(dev, IC_ENABLE_STATUS); + + /* Clear and enable interrupts */ + phytium_readl(dev, IC_CLR_INTR); + phytium_writel(dev, IC_INTR_SMBUS_MASK, IC_INTR_MASK); +} + +static void i2c_phytium_xfer_msg(struct phytium_i2c_dev *dev) +{ + struct i2c_msg *msgs = dev->msgs; + u32 intr_mask; + int tx_limit, rx_limit; + u32 addr = msgs[dev->msg_write_idx].addr; + u32 buf_len = dev->tx_buf_len; + u8 *buf = dev->tx_buf; + bool need_restart = false; + + intr_mask = IC_INTR_MASTER_MASK; + + for (; dev->msg_write_idx < dev->msgs_num; dev->msg_write_idx++) { + u32 flags = msgs[dev->msg_write_idx].flags; + + if (msgs[dev->msg_write_idx].addr != addr) { + dev_err(dev->dev, + "%s: invalid target address\n", __func__); + dev->msg_err = -EINVAL; + break; + } + + if (!(dev->status & STATUS_WRITE_IN_PROGRESS)) { + /* new i2c_msg */ + buf = msgs[dev->msg_write_idx].buf; + buf_len = msgs[dev->msg_write_idx].len; + + if ((dev->master_cfg & IC_CON_RESTART_EN) && + (dev->msg_write_idx > 0)) + need_restart = true; + } + + tx_limit = dev->tx_fifo_depth - phytium_readl(dev, IC_TXFLR); + rx_limit = dev->tx_fifo_depth - phytium_readl(dev, IC_RXFLR); + + while (buf_len > 0 && tx_limit > 0 && rx_limit > 0) { + u32 cmd = 0; + + if (dev->msg_write_idx == dev->msgs_num - 1 && + buf_len == 1 && !(flags & I2C_M_RECV_LEN)) + cmd |= BIT(9); + + if (need_restart) { + cmd |= BIT(10); + need_restart = false; + } + + if (msgs[dev->msg_write_idx].flags & I2C_M_RD) { + /* avoid rx buffer overrun */ + if (dev->rx_outstanding >= dev->rx_fifo_depth) + break; + + phytium_writel(dev, cmd | 0x100, IC_DATA_CMD); + rx_limit--; + dev->rx_outstanding++; + } else { + phytium_writel(dev, cmd | *buf++, IC_DATA_CMD); + } + tx_limit--; + buf_len--; + } + + dev->tx_buf = buf; + dev->tx_buf_len = buf_len; + + /* + * Because we don't know the buffer length in the + * I2C_FUNC_SMBUS_BLOCK_DATA case, we can't stop + * the transaction here. + */ + if (buf_len > 0 || flags & I2C_M_RECV_LEN) { + /* more bytes to be written */ + dev->status |= STATUS_WRITE_IN_PROGRESS; + break; + } + + dev->status &= ~STATUS_WRITE_IN_PROGRESS; + } + + if (dev->msg_write_idx == dev->msgs_num) + intr_mask &= ~IC_INTR_TX_EMPTY; + + if (dev->msg_err) + intr_mask = 0; + + phytium_writel(dev, intr_mask, IC_INTR_MASK); +} + +static u8 i2c_phytium_recv_len(struct phytium_i2c_dev *dev, u8 len) +{ + struct i2c_msg *msgs = dev->msgs; + u32 flags = msgs[dev->msg_read_idx].flags; + + /* + * Adjust the buffer length and mask the flag + * after receiving the first byte. + */ + len += (flags & I2C_CLIENT_PEC) ? 2 : 1; + dev->tx_buf_len = len - min_t(u8, len, dev->rx_outstanding); + msgs[dev->msg_read_idx].len = len; + msgs[dev->msg_read_idx].flags &= ~I2C_M_RECV_LEN; + + return len; +} + +static void i2c_phytium_read(struct phytium_i2c_dev *dev) +{ + struct i2c_msg *msgs = dev->msgs; + int rx_valid; + + for (; dev->msg_read_idx < dev->msgs_num; dev->msg_read_idx++) { + u32 len; + u8 *buf; + + if (!(msgs[dev->msg_read_idx].flags & I2C_M_RD)) + continue; + + if (!(dev->status & STATUS_READ_IN_PROGRESS)) { + len = msgs[dev->msg_read_idx].len; + buf = msgs[dev->msg_read_idx].buf; + } else { + len = dev->rx_buf_len; + buf = dev->rx_buf; + } + + rx_valid = phytium_readl(dev, IC_RXFLR); + + for (; len > 0 && rx_valid > 0; len--, rx_valid--) { + u32 flags = msgs[dev->msg_read_idx].flags; + + *buf = phytium_readl(dev, IC_DATA_CMD); + /* Ensure length byte is a valid value */ + if (flags & I2C_M_RECV_LEN && + *buf <= I2C_SMBUS_BLOCK_MAX && *buf > 0) { + len = i2c_phytium_recv_len(dev, *buf); + } + buf++; + dev->rx_outstanding--; + } + + if (len > 0) { + dev->status |= STATUS_READ_IN_PROGRESS; + dev->rx_buf_len = len; + dev->rx_buf = buf; + break; + } + + dev->status &= ~STATUS_READ_IN_PROGRESS; + } +} + +static int i2c_phytium_xfer(struct i2c_adapter *adapter, struct i2c_msg msgs[], int num) +{ + struct phytium_i2c_dev *dev = i2c_get_adapdata(adapter); + int ret; + + dev_dbg(dev->dev, "%s: msgs: %d\n", __func__, num); + + pm_runtime_get_sync(dev->dev); + + reinit_completion(&dev->cmd_complete); + dev->msgs = msgs; + dev->msgs_num = num; + dev->cmd_err = 0; + dev->msg_write_idx = 0; + dev->msg_read_idx = 0; + dev->msg_err = 0; + dev->status = STATUS_IDLE; + dev->abort_source = 0; + dev->rx_outstanding = 0; + + ret = i2c_phytium_wait_bus_not_busy(dev); + if (ret < 0) + goto done; + + /* Start the transfers */ + i2c_phytium_xfer_init(dev); + + /* Wait for tx to complete */ + if (!wait_for_completion_timeout(&dev->cmd_complete, adapter->timeout)) { + dev_err(dev->dev, "controller timed out\n"); + i2c_recover_bus(&dev->adapter); + i2c_phytium_init_master(dev); + ret = -ETIMEDOUT; + goto done; + } + + __i2c_phytium_disable_nowait(dev); + + if (dev->msg_err) { + ret = dev->msg_err; + goto done; + } + + if (likely(!dev->cmd_err && !dev->status)) { + ret = num; + goto done; + } + + /* We have got an error */ + if (dev->cmd_err == IC_ERR_TX_ABRT) { + ret = i2c_phytium_handle_tx_abort(dev); + goto done; + } + + if (dev->status) + dev_err(dev->dev, "transfer terminated early.\n"); + + ret = -EIO; + +done: + pm_runtime_mark_last_busy(dev->dev); + pm_runtime_put_autosuspend(dev->dev); + + return ret; +} + +static const struct i2c_algorithm i2c_phytium_algo = { + .master_xfer = i2c_phytium_xfer, + .functionality = i2c_phytium_func, +}; + +static const struct i2c_adapter_quirks i2c_phytium_quirks = { + .flags = I2C_AQ_NO_ZERO_LEN, +}; + +static u32 i2c_phytium_read_clear_intrbits(struct phytium_i2c_dev *dev) +{ + u32 stat; + + stat = phytium_readl(dev, IC_INTR_STAT); + + if (stat & IC_INTR_RX_UNDER) + phytium_readl(dev, IC_CLR_RX_UNDER); + if (stat & IC_INTR_RX_OVER) + phytium_readl(dev, IC_CLR_RX_OVER); + if (stat & IC_INTR_TX_OVER) + phytium_readl(dev, IC_CLR_TX_OVER); + if (stat & IC_INTR_RD_REQ) + phytium_readl(dev, IC_CLR_RD_REQ); + if (stat & IC_INTR_TX_ABRT) { + dev->abort_source = phytium_readl(dev, IC_TX_ABRT_SOURCE); + phytium_readl(dev, IC_CLR_TX_ABRT); + } + if (stat & IC_INTR_RX_DONE) + phytium_readl(dev, IC_CLR_RX_DONE); + if (stat & IC_INTR_ACTIVITY) + phytium_readl(dev, IC_CLR_ACTIVITY); + if (stat & IC_INTR_STOP_DET) + phytium_readl(dev, IC_CLR_STOP_DET); + if (stat & IC_INTR_START_DET) + phytium_readl(dev, IC_CLR_START_DET); + if (stat & IC_INTR_GEN_CALL) + phytium_readl(dev, IC_CLR_GEN_CALL); + if (stat & IC_INTR_SMBCLK_EXT_LOW_TIMEOUT) + phytium_readl(dev, IC_CLR_SMBCLK_EXT_LOW_TIMEOUT); + if (stat & IC_INTR_SMBCLK_TMO_LOW_TIMEOUT) + phytium_readl(dev, IC_CLR_SMBCLK_TMO_LOW_TIMEOUT); + if (stat & IC_INTR_SMBSDA_LOW_TIMEOUT) + phytium_readl(dev, IC_CLR_SMBDAT_LOW_TIMEOUT); + if (stat & IC_INTR_SMBALERT_IN_N) + phytium_readl(dev, IC_CLR_SMBALERT_IN_N); + + return stat; +} + +static int i2c_phytium_irq_handler_master(struct phytium_i2c_dev *dev) +{ + u32 stat; + + stat = i2c_phytium_read_clear_intrbits(dev); + + /* SMBus interrupt */ + if (stat & (IC_INTR_SMBCLK_EXT_LOW_TIMEOUT | IC_INTR_SMBCLK_TMO_LOW_TIMEOUT)) { + phytium_writel(dev, phytium_readl(dev, IC_ENABLE) & (~BIT(6)), + IC_ENABLE); + phytium_writel(dev, phytium_readl(dev, IC_ENABLE) | BIT(4), + IC_ENABLE); + goto abort; + } + + if (stat & IC_INTR_SMBSDA_LOW_TIMEOUT) { + phytium_writel(dev, phytium_readl(dev, IC_ENABLE) | BIT(6), + IC_ENABLE); + goto abort; + } + + if (stat & IC_INTR_SMBALERT_IN_N && dev->ara) + i2c_handle_smbus_alert(dev->ara); + + if (stat & IC_INTR_TX_ABRT) { + dev->cmd_err |= IC_ERR_TX_ABRT; + dev->status = STATUS_IDLE; + + /* Anytime TX_ABRT is set, the contents of the tx/rx + * buffers are flushed. Make sure to skip them. + */ + phytium_writel(dev, 0, IC_INTR_MASK); + goto abort; + } + + if (stat & IC_INTR_RX_FULL) + i2c_phytium_read(dev); + + if (stat & IC_INTR_TX_EMPTY) + i2c_phytium_xfer_msg(dev); + +abort: + if ((stat & (IC_INTR_TX_ABRT | IC_INTR_STOP_DET)) || + dev->msg_err) + complete(&dev->cmd_complete); + else if (unlikely(dev->flags & ACCESS_INTR_MASK)) { + /* Workaround to trigger pending interrupt */ + stat = phytium_readl(dev, IC_INTR_MASK); + i2c_phytium_disable_int(dev); + phytium_writel(dev, stat, IC_INTR_MASK); + } + + return 0; +} + +static int i2c_phytium_set_timings_master(struct phytium_i2c_dev *dev) +{ + const char *mode_str, *fp_str = ""; + u32 sda_falling_time, scl_falling_time; + struct i2c_timings *t = &dev->timings; + u32 ic_clk; + int ret; + + /* Set standard and fast speed dividers for high/low periods */ + sda_falling_time = t->sda_fall_ns ?: 300; /* ns */ + scl_falling_time = t->scl_fall_ns ?: 300; /* ns */ + + /* Calculate SCL timing parameters for standard mode if not set */ + if (!dev->ss_hcnt || !dev->ss_lcnt) { + ic_clk = i2c_phytium_clk_rate(dev); + dev->ss_hcnt = + i2c_phytium_scl_hcnt(ic_clk, + 4000, /* tHD;STA = tHIGH = 4.0 us */ + sda_falling_time, + 0, /* 0: DW default, 1: Ideal */ + 0); /* No offset */ + dev->ss_lcnt = + i2c_phytium_scl_lcnt(ic_clk, + 4700, /* tLOW = 4.7 us */ + scl_falling_time, + 0); /* No offset */ + } + dev_dbg(dev->dev, "Standard Mode HCNT:LCNT = %d:%d\n", + dev->ss_hcnt, dev->ss_lcnt); + /* + * Set SCL timing parameters for fast mode or fast mode plus. Only + * difference is the timing parameter values since the registers are + * the same. + */ + if (t->bus_freq_hz == 1000000) { + /* + * Check are fast mode plus parameters available and use + * fast mode if not. + */ + if (dev->fp_hcnt && dev->fp_lcnt) { + dev->fs_hcnt = dev->fp_hcnt; + dev->fs_lcnt = dev->fp_lcnt; + fp_str = " Plus"; + } + } + /* + * Calculate SCL timing parameters for fast mode if not set. They are + * needed also in high speed mode. + */ + if (!dev->fs_hcnt || !dev->fs_lcnt) { + ic_clk = i2c_phytium_clk_rate(dev); + dev->fs_hcnt = + i2c_phytium_scl_hcnt(ic_clk, + 600, /* tHD;STA = tHIGH = 0.6 us */ + sda_falling_time, + 0, /* 0: DW default, 1: Ideal */ + 0); /* No offset */ + dev->fs_lcnt = + i2c_phytium_scl_lcnt(ic_clk, + 1300, /* tLOW = 1.3 us */ + scl_falling_time, + 0); /* No offset */ + } + dev_dbg(dev->dev, "Fast Mode%s HCNT:LCNT = %d:%d\n", + fp_str, dev->fs_hcnt, dev->fs_lcnt); + + if (dev->hs_hcnt && dev->hs_lcnt) + dev_dbg(dev->dev, "High Speed Mode HCNT:LCNT = %d:%d\n", + dev->hs_hcnt, dev->hs_lcnt); + + ret = i2c_phytium_set_sda_hold(dev); + if (ret) + goto out; + + switch (dev->master_cfg & IC_CON_SPEED_MASK) { + case IC_CON_SPEED_STD: + mode_str = "Standard Mode"; + break; + case IC_CON_SPEED_HIGH: + mode_str = "High Speed Mode"; + break; + default: + mode_str = "Fast Mode"; + } + dev_dbg(dev->dev, "Bus speed: %s%s\n", mode_str, fp_str); + +out: + return ret; +} + +static irqreturn_t i2c_phytium_isr(int this_irq, void *dev_id) +{ + struct phytium_i2c_dev *dev = dev_id; + u32 stat, enabled; + + enabled = phytium_readl(dev, IC_ENABLE); + stat = phytium_readl(dev, IC_RAW_INTR_STAT); + if (!enabled || !(stat & ~IC_INTR_ACTIVITY)) + return IRQ_NONE; + + i2c_phytium_irq_handler_master(dev); + + return IRQ_HANDLED; +} + +int i2c_phytium_probe(struct phytium_i2c_dev *dev) +{ + struct i2c_adapter *adapter = &dev->adapter; + unsigned long irq_flags; + int ret; + + init_completion(&dev->cmd_complete); + + dev->init = i2c_phytium_init_master; + dev->disable = i2c_phytium_disable; + dev->disable_int = i2c_phytium_disable_int; + + ret = i2c_phytium_set_timings_master(dev); + if (ret) + return ret; + + ret = dev->init(dev); + if (ret) + return ret; + + /* XXX: should be initialized in firmware, remove it in future */ +#define DEFAULT_TIMEOUT (DEFAULT_CLOCK_FREQUENCY / 1000 * 35) + phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBCLK_LOW_MEXT); + phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBCLK_LOW_TIMEOUT); + phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBDAT_STUCK_TIMEOUT); + + snprintf(adapter->name, sizeof(adapter->name), "Phytium I2C adapter"); + adapter->retries = 3; + adapter->algo = &i2c_phytium_algo; + adapter->quirks = &i2c_phytium_quirks; + adapter->dev.parent = dev->dev; + i2c_set_adapdata(adapter, dev); + + irq_flags = IRQF_SHARED | IRQF_COND_SUSPEND; + + i2c_phytium_disable_int(dev); + ret = devm_request_irq(dev->dev, dev->irq, i2c_phytium_isr, irq_flags, + dev_name(dev->dev), dev); + if (ret) { + dev_err(dev->dev, "failed to request irq %i: %d\n", dev->irq, ret); + return ret; + } + + /* + * Increment PM usage count during adapter registration in order to + * avoid possible spurious runtime suspend when adapter device is + * registered to the device core and immediate resume in case bus has + * registered I2C slaves that do I2C transfers in their probe. + */ + pm_runtime_get_noresume(dev->dev); + ret = i2c_add_numbered_adapter(adapter); + if (ret) + dev_err(dev->dev, "fail to add adapter: %d\n", ret); + pm_runtime_put_noidle(dev->dev); + + return ret; +} +EXPORT_SYMBOL_GPL(i2c_phytium_probe); + +MODULE_DESCRIPTION("Phytium I2C bus master adapter"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-pci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-pci.c new file mode 100644 index 0000000000000000000000000000000000000000..3ef199b1ab850624d2f5b79a3399ce5288ac8f1a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-pci.c @@ -0,0 +1,240 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * PCI driver for Phytium I2C adapter. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "i2c-phytium-core.h" + +#define DRV_NAME "i2c-phytium-pci" + +enum phytium_pci_ctl_id_t { + octopus_i2c, +}; + +struct scl_sda_cfg { + u32 ss_hcnt; + u32 fs_hcnt; + u32 ss_lcnt; + u32 fs_lcnt; + u32 sda_hold; +}; + +struct phytium_pci_i2c { + u32 bus_num; + u32 bus_cfg; + u32 tx_fifo_depth; + u32 rx_fifo_depth; + u32 clk_khz; + u32 functionality; + u32 flags; + struct scl_sda_cfg *scl_sda_cfg; + int (*setup)(struct pci_dev *pdev, struct phytium_pci_i2c *c); +}; + +/* Octopus HCNT/LCNT/SDA hold time */ +static struct scl_sda_cfg octopus_config = { + .ss_hcnt = 0x190, + .ss_lcnt = 0x1d6, + .fs_hcnt = 0x3c, + .fs_lcnt = 0x82, + .sda_hold = 0x0, // XXX +}; + +static int octopus_setup(struct pci_dev *pdev, struct phytium_pci_i2c *c) +{ + struct phytium_i2c_dev *i2c = pci_get_drvdata(pdev); + struct i2c_client *ara; + + if (pdev->device == 0xdc32) { + /* + * Since we have already register the adapter, the dev->irq + * must be valid. + */ + i2c->alert_data.irq = i2c->irq; + + ara = i2c_new_smbus_alert_device(&i2c->adapter, &i2c->alert_data); + if (IS_ERR(ara)) + return PTR_ERR(ara); + + i2c->ara = ara; + } + + return 0; +} + +static struct phytium_pci_i2c pci_ctrl_info[] = { + [octopus_i2c] = { + .bus_num = -1, + .bus_cfg = IC_CON_MASTER | IC_CON_SLAVE_DISABLE | + IC_CON_RESTART_EN | IC_CON_SPEED_FAST, + .tx_fifo_depth = 7, + .rx_fifo_depth = 7, + .functionality = I2C_FUNC_10BIT_ADDR, + .clk_khz = 48000000, + .scl_sda_cfg = &octopus_config, + .setup = octopus_setup, + }, +}; + +#ifdef CONFIG_PM +static int i2c_phytium_pci_suspend(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_i2c_dev *i_dev = pci_get_drvdata(pdev); + + i_dev->disable(i_dev); + + return 0; +} + +static int i2c_phytium_pci_resume(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_i2c_dev *i_dev = pci_get_drvdata(pdev); + + return i_dev->init(i_dev); +} +#endif + +static UNIVERSAL_DEV_PM_OPS(i2c_phytium_pm_ops, i2c_phytium_pci_suspend, + i2c_phytium_pci_resume, NULL); + +static u32 i2c_phytium_get_clk_rate_khz(struct phytium_i2c_dev *dev) +{ + return dev->controller->clk_khz; +} + +static int i2c_phytium_pci_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct phytium_i2c_dev *dev; + struct i2c_adapter *adapter; + struct phytium_pci_i2c *controller; + struct scl_sda_cfg *cfg; + int ret; + + if (id->driver_data >= ARRAY_SIZE(pci_ctrl_info)) { + dev_err(&pdev->dev, "%s: invalid driver data %ld\n", __func__, + id->driver_data); + ret = -EINVAL; + goto out; + } + + controller = &pci_ctrl_info[id->driver_data]; + + ret = pcim_enable_device(pdev); + if (ret) { + dev_err(&pdev->dev, "Failed to enable I2C PCI device (%d)\n", ret); + goto out; + } + + ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); + if (ret) { + dev_err(&pdev->dev, "I/O memory remapping failed\n"); + goto out; + } + + dev = devm_kzalloc(&pdev->dev, sizeof(struct phytium_i2c_dev), GFP_KERNEL); + if (!dev) { + ret = -ENOMEM; + goto out; + } + + dev->controller = controller; + dev->get_clk_rate_khz = i2c_phytium_get_clk_rate_khz; + dev->base = pcim_iomap_table(pdev)[0]; + dev->dev = &pdev->dev; + dev->irq = pdev->irq; + dev->flags |= controller->flags; + + dev->functionality = controller->functionality | IC_DEFAULT_FUNCTIONALITY; + dev->master_cfg = controller->bus_cfg; + if (controller->scl_sda_cfg) { + cfg = controller->scl_sda_cfg; + dev->ss_hcnt = cfg->ss_hcnt; + dev->fs_hcnt = cfg->fs_hcnt; + dev->ss_lcnt = cfg->ss_lcnt; + dev->fs_lcnt = cfg->fs_lcnt; + dev->sda_hold_time = cfg->sda_hold; + } + + pci_set_drvdata(pdev, dev); + + dev->tx_fifo_depth = controller->tx_fifo_depth; + dev->rx_fifo_depth = controller->rx_fifo_depth; + + adapter = &dev->adapter; + adapter->owner = THIS_MODULE; + adapter->class = 0; + ACPI_COMPANION_SET(&adapter->dev, ACPI_COMPANION(&pdev->dev)); + adapter->nr = controller->bus_num; + + ret = i2c_phytium_probe(dev); + if (ret) + goto out; + + if (controller->setup) { + ret = controller->setup(pdev, controller); + if (ret) + goto out; + } + + pm_runtime_set_autosuspend_delay(&pdev->dev, 1000); + pm_runtime_use_autosuspend(&pdev->dev); + pm_runtime_put_autosuspend(&pdev->dev); + pm_runtime_allow(&pdev->dev); + +out: + return ret; +} + +static void i2c_phytium_pci_remove(struct pci_dev *pdev) +{ + struct phytium_i2c_dev *dev = pci_get_drvdata(pdev); + + dev->disable(dev); + pm_runtime_forbid(&pdev->dev); + pm_runtime_get_noresume(&pdev->dev); + + i2c_del_adapter(&dev->adapter); +} + +static const struct pci_device_id i2_phytium_pci_ids[] = { + { PCI_DEVICE(0x1db7, 0xdc32), 0, 0, octopus_i2c }, + { PCI_DEVICE(0x1db7, 0xdc30), 0, 0, octopus_i2c }, + { } +}; +MODULE_DEVICE_TABLE(pci, i2_phytium_pci_ids); + +static struct pci_driver phytium_i2c_driver = { + .name = DRV_NAME, + .id_table = i2_phytium_pci_ids, + .probe = i2c_phytium_pci_probe, + .remove = i2c_phytium_pci_remove, + .driver = { + .pm = &i2c_phytium_pm_ops, + }, +}; + +module_pci_driver(phytium_i2c_driver); + +MODULE_ALIAS("i2c-phytium-pci"); +MODULE_AUTHOR("Cheng Quan "); +MODULE_DESCRIPTION("Phytium PCI I2C bus adapter"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-platform.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-platform.c new file mode 100644 index 0000000000000000000000000000000000000000..d9160c428c2485add1e5e169dc223ef4eb27625b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-platform.c @@ -0,0 +1,364 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * Phytium I2C adapter driver. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "i2c-phytium-core.h" + +#define DRV_NAME "i2c-phytium-platform" + +static u32 i2c_phytium_get_clk_rate_khz(struct phytium_i2c_dev *dev) +{ + return clk_get_rate(dev->clk)/1000; +} + +#ifdef CONFIG_ACPI +static void phytium_i2c_acpi_params(struct platform_device *pdev, char method[], + u16 *hcnt, u16 *lcnt, u32 *sda_hold) +{ + struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER }; + acpi_handle handle = ACPI_HANDLE(&pdev->dev); + union acpi_object *obj; + + if (ACPI_FAILURE(acpi_evaluate_object(handle, method, NULL, &buf))) + return; + + obj = (union acpi_object *)buf.pointer; + if (obj->type == ACPI_TYPE_PACKAGE && obj->package.count == 3) { + const union acpi_object *objs = obj->package.elements; + + *hcnt = (u16)objs[0].integer.value; + *lcnt = (u16)objs[1].integer.value; + *sda_hold = (u32)objs[2].integer.value; + } + + kfree(buf.pointer); +} + +static int phytium_i2c_acpi_configure(struct platform_device *pdev) +{ + struct phytium_i2c_dev *dev = platform_get_drvdata(pdev); + struct i2c_timings *t = &dev->timings; + u32 ss_ht = 0, fp_ht = 0, hs_ht = 0, fs_ht = 0; + acpi_handle handle = ACPI_HANDLE(&pdev->dev); + const struct acpi_device_id *id; + struct acpi_device *adev; + + dev->adapter.nr = -1; + dev->tx_fifo_depth = 32; + dev->rx_fifo_depth = 32; + + /* + * Try to get SDA hold time and *CNT values from an ACPI method for + * selected speed modes. + */ + phytium_i2c_acpi_params(pdev, "SSCN", &dev->ss_hcnt, &dev->ss_lcnt, &ss_ht); + phytium_i2c_acpi_params(pdev, "FPCN", &dev->fp_hcnt, &dev->fp_lcnt, &fp_ht); + phytium_i2c_acpi_params(pdev, "HSCN", &dev->hs_hcnt, &dev->hs_lcnt, &hs_ht); + phytium_i2c_acpi_params(pdev, "FMCN", &dev->fs_hcnt, &dev->fs_lcnt, &fs_ht); + + switch (t->bus_freq_hz) { + case 100000: + dev->sda_hold_time = ss_ht; + break; + case 1000000: + dev->sda_hold_time = fp_ht; + break; + case 3400000: + dev->sda_hold_time = hs_ht; + break; + case 400000: + default: + dev->sda_hold_time = fs_ht; + break; + } + + id = acpi_match_device(pdev->dev.driver->acpi_match_table, &pdev->dev); + if (id && id->driver_data) + dev->flags |= (u32)id->driver_data; + + if (acpi_bus_get_device(handle, &adev)) + return -ENODEV; + + return 0; +} + +static const struct acpi_device_id phytium_i2c_acpi_match[] = { + { "PHYT0038", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, phytium_i2c_acpi_match); +#else +static inline int phytium_i2c_acpi_configure(struct platform_device *pdev) +{ + return -ENODEV; +} +#endif + +static void i2c_phytium_configure_master(struct phytium_i2c_dev *dev) +{ + struct i2c_timings *t = &dev->timings; + + dev->functionality = I2C_FUNC_10BIT_ADDR | IC_DEFAULT_FUNCTIONALITY; + + dev->master_cfg = IC_CON_MASTER | IC_CON_SLAVE_DISABLE | + IC_CON_RESTART_EN; + + dev->mode = PHYTIUM_IC_MASTER; + + switch (t->bus_freq_hz) { + case 100000: + dev->master_cfg |= IC_CON_SPEED_STD; + break; + case 3400000: + dev->master_cfg |= IC_CON_SPEED_HIGH; + break; + default: + dev->master_cfg |= IC_CON_SPEED_FAST; + } +} + +static void i2c_phytium_configure_slave(struct phytium_i2c_dev *dev) +{ + dev->functionality = I2C_FUNC_SLAVE | IC_DEFAULT_FUNCTIONALITY; + + dev->slave_cfg = IC_CON_RX_FIFO_FULL_HLD_CTRL | + IC_CON_RESTART_EN | IC_CON_STOP_DET_IFADDRESSED; + + dev->mode = PHYTIUM_IC_SLAVE; +} + +static int phytium_i2c_plat_probe(struct platform_device *pdev) +{ + struct i2c_adapter *adap; + struct phytium_i2c_dev *dev; + struct i2c_timings *t; + u32 acpi_speed; + struct resource *mem; + int irq, ret, i; + static const int supported_speeds[] = { + 0, 100000, 400000, 1000000, 3400000 + }; + + + irq = platform_get_irq(pdev, 0); + if (irq < 0) + return irq; + + dev = devm_kzalloc(&pdev->dev, sizeof(struct phytium_i2c_dev), GFP_KERNEL); + if (!dev) + return -ENOMEM; + + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); + dev->base = devm_ioremap_resource(&pdev->dev, mem); + if (IS_ERR(dev->base)) + return PTR_ERR(dev->base); + + dev->dev = &pdev->dev; + dev->irq = irq; + platform_set_drvdata(pdev, dev); + + dev->rst = devm_reset_control_get_optional_exclusive(&pdev->dev, NULL); + if (IS_ERR(dev->rst)) { + if (PTR_ERR(dev->rst) == -EPROBE_DEFER) + return -EPROBE_DEFER; + } else { + reset_control_deassert(dev->rst); + } + + t = &dev->timings; + i2c_parse_fw_timings(&pdev->dev, t, false); + + acpi_speed = i2c_acpi_find_bus_speed(&pdev->dev); + /* + * Some DSTDs use a non standard speed, round down to the lowest + * standard speed. + */ + for (i = 1; i < ARRAY_SIZE(supported_speeds); i++) { + if (acpi_speed < supported_speeds[i]) + break; + } + acpi_speed = supported_speeds[i - 1]; + + /* + * Find bus speed from the "clock-frequency" device property, ACPI + * or by using fast mode if neither is set. + */ + if (acpi_speed && t->bus_freq_hz) + t->bus_freq_hz = min(t->bus_freq_hz, acpi_speed); + else if (acpi_speed || t->bus_freq_hz) + t->bus_freq_hz = max(t->bus_freq_hz, acpi_speed); + else + t->bus_freq_hz = 400000; + + if (has_acpi_companion(&pdev->dev)) + phytium_i2c_acpi_configure(pdev); + + /* + * Only standard mode at 100kHz, fast mode at 400kHz, + * fast mode plus at 1MHz and high speed mode at 3.4MHz are supported. + */ + if (t->bus_freq_hz != 100000 && t->bus_freq_hz != 400000 && + t->bus_freq_hz != 1000000 && t->bus_freq_hz != 3400000) { + dev_err(&pdev->dev, + "%d Hz is unsupported, only 100kHz, 400kHz, 1MHz and 3.4MHz are supported\n", + t->bus_freq_hz); + ret = -EINVAL; + goto exit_reset; + } + + if (i2c_detect_slave_mode(&pdev->dev)) + i2c_phytium_configure_slave(dev); + else + i2c_phytium_configure_master(dev); + + dev->clk = devm_clk_get(&pdev->dev, NULL); + if (!i2c_phytium_prepare_clk(dev, true)) { + u64 clk_khz; + + dev->get_clk_rate_khz = i2c_phytium_get_clk_rate_khz; + clk_khz = dev->get_clk_rate_khz(dev); + + if (!dev->sda_hold_time && t->sda_hold_ns) + dev->sda_hold_time = + div_u64(clk_khz * t->sda_hold_ns + 500000, 1000000); + } + + dev->tx_fifo_depth = 7; + dev->rx_fifo_depth = 7; + dev->adapter.nr = pdev->id; + + adap = &dev->adapter; + adap->owner = THIS_MODULE; + adap->class = I2C_CLASS_DEPRECATED; + ACPI_COMPANION_SET(&adap->dev, ACPI_COMPANION(&pdev->dev)); + adap->dev.of_node = pdev->dev.of_node; + + dev_pm_set_driver_flags(&pdev->dev, + DPM_FLAG_SMART_PREPARE | + DPM_FLAG_SMART_SUSPEND | + DPM_FLAG_MAY_SKIP_RESUME); + + /* The code below assumes runtime PM to be disabled. */ + WARN_ON(pm_runtime_enabled(&pdev->dev)); + + pm_runtime_set_autosuspend_delay(&pdev->dev, 1000); + pm_runtime_use_autosuspend(&pdev->dev); + pm_runtime_set_active(&pdev->dev); + + pm_runtime_enable(&pdev->dev); + + if (dev->mode == PHYTIUM_IC_SLAVE) + ret = i2c_phytium_probe_slave(dev); + else + ret = i2c_phytium_probe(dev); + + if (ret) + goto exit_probe; + + return ret; + +exit_probe: + pm_runtime_disable(dev->dev); +exit_reset: + if (!IS_ERR_OR_NULL(dev->rst)) + reset_control_assert(dev->rst); + return ret; +} + +static int phytium_i2c_plat_remove(struct platform_device *pdev) +{ + struct phytium_i2c_dev *dev = platform_get_drvdata(pdev); + + pm_runtime_get_sync(&pdev->dev); + + i2c_del_adapter(&dev->adapter); + + dev->disable(dev); + + pm_runtime_dont_use_autosuspend(&pdev->dev); + pm_runtime_put_sync(&pdev->dev); + pm_runtime_disable(dev->dev); + + if (!IS_ERR_OR_NULL(dev->rst)) + reset_control_assert(dev->rst); + + return 0; +} + +#ifdef CONFIG_OF +static const struct of_device_id phytium_i2c_of_match[] = { + { .compatible = "phytium,i2c", }, + {}, +}; +MODULE_DEVICE_TABLE(of, phytium_i2c_of_match); +#endif + +static int __maybe_unused phytium_i2c_plat_suspend(struct device *dev) +{ + struct phytium_i2c_dev *idev = dev_get_drvdata(dev); + + idev->disable(idev); + i2c_phytium_prepare_clk(idev, false); + + return 0; +} + +static int __maybe_unused phytium_i2c_plat_resume(struct device *dev) +{ + struct phytium_i2c_dev *idev = dev_get_drvdata(dev); + + i2c_phytium_prepare_clk(idev, true); + + idev->init(idev); + + return 0; +} + +static const struct dev_pm_ops phytium_i2c_dev_pm_ops = { + SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_i2c_plat_suspend, + phytium_i2c_plat_resume) + SET_RUNTIME_PM_OPS(phytium_i2c_plat_suspend, + phytium_i2c_plat_resume, NULL) +}; + +static struct platform_driver phytium_i2c_driver = { + .probe = phytium_i2c_plat_probe, + .remove = phytium_i2c_plat_remove, + .driver = { + .name = DRV_NAME, + .of_match_table = of_match_ptr(phytium_i2c_of_match), + .acpi_match_table = ACPI_PTR(phytium_i2c_acpi_match), + .pm = &phytium_i2c_dev_pm_ops, + }, +}; +module_platform_driver(phytium_i2c_driver); + +MODULE_ALIAS("platform:i2c-phytium"); +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium I2C bus adapter"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-slave.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-slave.c new file mode 100644 index 0000000000000000000000000000000000000000..e6d25ca1b6a5b5291db65b3e82be2b8c4632f14d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/i2c/busses/i2c-phytium-slave.c @@ -0,0 +1,262 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium I2C adapter driver (slave only). + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +#include "i2c-phytium-core.h" + +static void i2c_phytium_configure_fifo_slave(struct phytium_i2c_dev *dev) +{ + /* Configure Tx/Rx FIFO threshold levels. */ + phytium_writel(dev, 0, IC_TX_TL); + phytium_writel(dev, 0, IC_RX_TL); + + /* Configure the I2C slave. */ + phytium_writel(dev, dev->slave_cfg, IC_CON); + phytium_writel(dev, IC_INTR_SLAVE_MASK, IC_INTR_MASK); +} + +static int i2c_phytium_init_slave(struct phytium_i2c_dev *dev) +{ + /* Disable the adapter. */ + __i2c_phytium_disable(dev); + + /* Write SDA hold time if supported */ + if (dev->sda_hold_time) + phytium_writel(dev, dev->sda_hold_time, IC_SDA_HOLD); + + i2c_phytium_configure_fifo_slave(dev); + + return 0; +} + +static int i2c_phytium_reg_slave(struct i2c_client *slave) +{ + struct phytium_i2c_dev *dev = i2c_get_adapdata(slave->adapter); + + if (dev->slave) + return -EBUSY; + if (slave->flags & I2C_CLIENT_TEN) + return -EAFNOSUPPORT; + pm_runtime_get_sync(dev->dev); + + /* + * Set slave address in the IC_SAR register, + * the address to which the i2c responds. + */ + __i2c_phytium_disable_nowait(dev); + phytium_writel(dev, slave->addr, IC_SAR); + dev->slave = slave; + + __i2c_phytium_enable(dev); + + dev->cmd_err = 0; + dev->msg_write_idx = 0; + dev->msg_read_idx = 0; + dev->msg_err = 0; + dev->status = STATUS_IDLE; + dev->abort_source = 0; + dev->rx_outstanding = 0; + + return 0; +} + +static int i2c_phytium_unreg_slave(struct i2c_client *slave) +{ + struct phytium_i2c_dev *dev = i2c_get_adapdata(slave->adapter); + + dev->disable_int(dev); + dev->disable(dev); + dev->slave = NULL; + pm_runtime_put(dev->dev); + + return 0; +} + +static u32 i2c_phytium_read_clear_intrbits_slave(struct phytium_i2c_dev *dev) +{ + u32 stat; + + /* + * The IC_INTR_STAT register just indicates "enabled" interrupts. + * Ths unmasked raw version of interrupt status bits are available + * in the IC_RAW_INTR_STAT register. + * + * That is, + * stat = phytium_readl(IC_INTR_STAT); + * equals to, + * stat = phytium_readl(IC_RAW_INTR_STAT) & phytium_readl(IC_INTR_MASK); + * + * The raw version might be useful for debugging purposes. + */ + stat = phytium_readl(dev, IC_INTR_STAT); + + /* + * Do not use the IC_CLR_INTR register to clear interrupts, or + * you'll miss some interrupts, triggered during the period from + * phytium_readl(IC_INTR_STAT) to phytium_readl(IC_CLR_INTR). + * + * Instead, use the separately-prepared IC_CLR_* registers. + */ + if (stat & IC_INTR_TX_ABRT) + phytium_readl(dev, IC_CLR_TX_ABRT); + if (stat & IC_INTR_RX_UNDER) + phytium_readl(dev, IC_CLR_RX_UNDER); + if (stat & IC_INTR_RX_OVER) + phytium_readl(dev, IC_CLR_RX_OVER); + if (stat & IC_INTR_TX_OVER) + phytium_readl(dev, IC_CLR_TX_OVER); + if (stat & IC_INTR_RX_DONE) + phytium_readl(dev, IC_CLR_RX_DONE); + if (stat & IC_INTR_ACTIVITY) + phytium_readl(dev, IC_CLR_ACTIVITY); + if (stat & IC_INTR_STOP_DET) + phytium_readl(dev, IC_CLR_STOP_DET); + if (stat & IC_INTR_START_DET) + phytium_readl(dev, IC_CLR_START_DET); + if (stat & IC_INTR_GEN_CALL) + phytium_readl(dev, IC_CLR_GEN_CALL); + + return stat; +} + +/* + * Interrupt service routine. This gets called whenever an I2C slave interrupt + * occurs. + */ +static int i2c_phytium_irq_handler_slave(struct phytium_i2c_dev *dev) +{ + u32 raw_stat, stat, enabled; + u8 val, slave_activity; + + stat = phytium_readl(dev, IC_INTR_STAT); + enabled = phytium_readl(dev, IC_ENABLE); + raw_stat = phytium_readl(dev, IC_RAW_INTR_STAT); + slave_activity = ((phytium_readl(dev, IC_STATUS) & + IC_STATUS_SLAVE_ACTIVITY) >> 6); + + if (!enabled || !(raw_stat & ~IC_INTR_ACTIVITY) || !dev->slave) + return 0; + + dev_dbg(dev->dev, + "%#x STATUS SLAVE_ACTIVITY=%#x : RAW_INTR_STAT=%#x : INTR_STAT=%#x\n", + enabled, slave_activity, raw_stat, stat); + + if ((stat & IC_INTR_RX_FULL) && (stat & IC_INTR_STOP_DET)) + i2c_slave_event(dev->slave, I2C_SLAVE_WRITE_REQUESTED, &val); + + if (stat & IC_INTR_RD_REQ) { + if (slave_activity) { + if (stat & IC_INTR_RX_FULL) { + val = phytium_readl(dev, IC_DATA_CMD); + + if (!i2c_slave_event(dev->slave, + I2C_SLAVE_WRITE_RECEIVED, + &val)) { + dev_vdbg(dev->dev, "Byte %X acked!", + val); + } + phytium_readl(dev, IC_CLR_RD_REQ); + stat = i2c_phytium_read_clear_intrbits_slave(dev); + } else { + phytium_readl(dev, IC_CLR_RD_REQ); + phytium_readl(dev, IC_CLR_RX_UNDER); + stat = i2c_phytium_read_clear_intrbits_slave(dev); + } + if (!i2c_slave_event(dev->slave, + I2C_SLAVE_READ_REQUESTED, + &val)) + phytium_writel(dev, val, IC_DATA_CMD); + } + } + + if (stat & IC_INTR_RX_DONE) { + if (!i2c_slave_event(dev->slave, I2C_SLAVE_READ_PROCESSED, + &val)) + phytium_readl(dev, IC_CLR_RX_DONE); + + i2c_slave_event(dev->slave, I2C_SLAVE_STOP, &val); + stat = i2c_phytium_read_clear_intrbits_slave(dev); + return 1; + } + + if (stat & IC_INTR_RX_FULL) { + val = phytium_readl(dev, IC_DATA_CMD); + if (!i2c_slave_event(dev->slave, I2C_SLAVE_WRITE_RECEIVED, + &val)) + dev_vdbg(dev->dev, "Byte %X acked!", val); + } else { + i2c_slave_event(dev->slave, I2C_SLAVE_STOP, &val); + stat = i2c_phytium_read_clear_intrbits_slave(dev); + } + + return 1; +} + +static irqreturn_t i2c_phytium_isr_slave(int this_irq, void *dev_id) +{ + struct phytium_i2c_dev *dev = dev_id; + int ret; + + i2c_phytium_read_clear_intrbits_slave(dev); + ret = i2c_phytium_irq_handler_slave(dev); + if (ret > 0) + complete(&dev->cmd_complete); + + return IRQ_RETVAL(ret); +} + +static const struct i2c_algorithm i2c_phytium_algo = { + .functionality = i2c_phytium_func, + .reg_slave = i2c_phytium_reg_slave, + .unreg_slave = i2c_phytium_unreg_slave, +}; + +int i2c_phytium_probe_slave(struct phytium_i2c_dev *dev) +{ + struct i2c_adapter *adap = &dev->adapter; + int ret; + + init_completion(&dev->cmd_complete); + + dev->init = i2c_phytium_init_slave; + dev->disable = i2c_phytium_disable; + dev->disable_int = i2c_phytium_disable_int; + + ret = dev->init(dev); + if (ret) + return ret; + + snprintf(adap->name, sizeof(adap->name), + "Phytium I2C Slave adapter"); + adap->retries = 3; + adap->algo = &i2c_phytium_algo; + adap->dev.parent = dev->dev; + i2c_set_adapdata(adap, dev); + + ret = devm_request_irq(dev->dev, dev->irq, i2c_phytium_isr_slave, + IRQF_SHARED, dev_name(dev->dev), dev); + if (ret) { + dev_err(dev->dev, "failure requesting irq %i: %d\n", + dev->irq, ret); + return ret; + } + + ret = i2c_add_numbered_adapter(adap); + if (ret) + dev_err(dev->dev, "failure adding adapter: %d\n", ret); + + return ret; +} +EXPORT_SYMBOL_GPL(i2c_phytium_probe_slave); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/iio/adc/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/iio/adc/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..edd18f92d08407d3ed5fbdf288a7d07f870c43fb --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/iio/adc/Kconfig @@ -0,0 +1,13 @@ +config PHYTIUM_ADC + tristate "Phytium ADC driver" + depends on ARCH_PHYTIUM || COMPILE_TEST + select IIO_BUFFER + select IIO_TRIGGERED_BUFFER + help + Say yes here to build support for Phytium analog to digital + converters (ADC). + + To compile this driver as a module, choose M here: the module + will be called phytium-adc. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/iio/adc/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/iio/adc/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..5047e36da2d3eaa296bf63be0407dc71905a66ad --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/iio/adc/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_PHYTIUM_ADC) += phytium-adc.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/iio/adc/phytium-adc.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/iio/adc/phytium-adc.c new file mode 100755 index 0000000000000000000000000000000000000000..b9b044c2a8a19ee4040da56b8fbb6c71ff634695 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/iio/adc/phytium-adc.c @@ -0,0 +1,688 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium ADC device driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include +#include +#include +#include + +/* ADC register */ +#define ADC_CTRL_REG 0x00 +#define ADC_CTRL_REG_PD_EN BIT(31) +#define ADC_CTRL_REG_CH_ONLY_S(x) ((x & 0x7) << 16) +#define ADC_CTRL_REG_CLK_DIV(x) ((x) << 12) +#define ADC_CTRL_REG_CHANNEL_EN(x) BIT((x) + 4) +#define ADC_CTRL_REG_CH_ONLY_EN BIT(3) +#define ADC_CTRL_REG_SINGLE_EN BIT(2) +#define ADC_CTRL_REG_SINGLE_SEL BIT(1) +#define ADC_CTRL_REG_SOC_EN BIT(0) +#define ADC_INTER_REG 0x04 +#define ADC_STATE_REG 0x08 +#define ADC_STATE_REG_B_STA(x) ((x) << 8) +#define ADC_STATE_REG_EOC_STA BIT(7) +#define ADC_STATE_REG_S_STA(x) ((x) << 4) +#define ADC_STATE_REG_SOC_STA BIT(3) +#define ADC_STATE_REG_ERR_STA BIT(2) +#define ADC_STATE_REG_COV_FINISH_STA BIT(1) +#define ADC_STATE_REG_ADCCTL_BUSY_STA BIT(0) +#define ADC_ERRCLR_REG 0x0c +#define ADC_LEVEL_REG(x) (0x10 + ((x) << 2)) +#define ADC_LEVEL_REG_HIGH_LEVEL(x) ((x) << 16) +#define ADC_LEVEL_REG_LOW_LEVEL(x) (x) +#define ADC_INTRMASK_REG 0x30 +#define ADC_INTRMASK_REG_ERR_INTR_MASK BIT(24) +#define ADC_INTRMASK_REG_ULIMIT_OFF(x) BIT(9 + ((x) << 1)) +#define ADC_INTRMASK_REG_DLIMIT_MASK(x) BIT(8 + ((x) << 1)) +#define ADC_INTRMASK_REG_COVFIN_MASK(x) BIT((x)) +#define ADC_INTR_REG 0x34 +#define ADC_INTR_REG_ERR BIT(24) +#define ADC_INTR_REG_ULIMIT(x) BIT(9 + ((x) << 1)) +#define ADC_INTR_REG_DLIMIT(x) BIT(8 + ((x) << 1)) +#define ADC_INTR_REG_LIMIT_MASK GENMASK(23, 8) +#define ADC_INTR_REG_COVFIN(x) BIT((x)) +#define ADC_INTR_REG_COVFIN_MASK GENMASK(7, 0) +#define ADC_COV_RESULT_REG(x) (0x38 + ((x) << 2)) +#define ADC_COV_RESULT_REG_MASK GENMASK(9, 0) +#define ADC_FINISH_CNT_REG(x) (0x58 + ((x) << 2)) +#define ADC_HIS_LIMIT_REG(x) (0x78 + ((x) << 2)) + +#define PHYTIUM_MAX_CHANNELS 8 +#define PHYTIUM_ADC_TIMEOUT usecs_to_jiffies(1000 * 1000) + +static const struct iio_event_spec phytium_adc_event[] = { + { + .type = IIO_EV_TYPE_THRESH, + .dir = IIO_EV_DIR_RISING, + .mask_separate = BIT(IIO_EV_INFO_VALUE), + }, { + .type = IIO_EV_TYPE_THRESH, + .dir = IIO_EV_DIR_FALLING, + .mask_separate = BIT(IIO_EV_INFO_VALUE), + }, +}; + +struct phytium_adc_data { + const struct iio_chan_spec *channels; + u8 num_channels; +}; + +struct phytium_adc { + struct device *dev; + void __iomem *regs; + struct clk *adc_clk; + + u32 interval; + u16 thresh_high[PHYTIUM_MAX_CHANNELS]; + u16 thresh_low[PHYTIUM_MAX_CHANNELS]; + u16 last_val[PHYTIUM_MAX_CHANNELS]; + const struct phytium_adc_data *data; + u16 *scan_data; + + struct completion completion; + struct mutex lock; +}; + +static ssize_t phytium_adc_show_conv_interval(struct iio_dev *indio_dev, + uintptr_t priv, + struct iio_chan_spec const *ch, + char *buf) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + + return sprintf(buf, "%u\n", adc->interval); +} + +static ssize_t phytium_adc_store_conv_interval(struct iio_dev *indio_dev, + uintptr_t priv, + struct iio_chan_spec const *ch, + const char *buf, size_t len) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + u32 interval; + int ret; + + ret = kstrtou32(buf, 0, &interval); + if (ret < 0) + return ret; + + mutex_lock(&adc->lock); + adc->interval = interval; + mutex_unlock(&adc->lock); + + return len; +} + +static const struct iio_chan_spec_ext_info phytium_adc_ext_info[] = { + { + .name = "conv_interval", + .read = phytium_adc_show_conv_interval, + .write = phytium_adc_store_conv_interval, + }, + { /* sentinel */ } +}; + +static int phytium_adc_parse_properties(struct platform_device *pdev, struct phytium_adc *adc) +{ + struct iio_chan_spec *chan_array; + struct fwnode_handle *fwnode; + struct phytium_adc_data *data; + unsigned int channel; + int num_channels; + int ret, i = 0; + + data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL); + if (!data) + return -ENOMEM; + + num_channels = device_get_child_node_count(&pdev->dev); + if (!num_channels) { + dev_err(&pdev->dev, "no channel children\n"); + return -ENODEV; + } + + if (num_channels > PHYTIUM_MAX_CHANNELS) { + dev_err(&pdev->dev, "num of channel children out of range\n"); + return -EINVAL; + } + + chan_array = devm_kcalloc(&pdev->dev, num_channels, sizeof(*chan_array), + GFP_KERNEL); + if (!chan_array) + return -ENOMEM; + + device_for_each_child_node(&pdev->dev, fwnode) { + ret = fwnode_property_read_u32(fwnode, "reg", &channel); + if (ret) + return ret; + + if (channel >= PHYTIUM_MAX_CHANNELS) + return -EINVAL; + + chan_array[i].type = IIO_VOLTAGE; + chan_array[i].indexed = 1; + chan_array[i].channel = channel; + chan_array[i].info_mask_separate = BIT(IIO_CHAN_INFO_RAW); + chan_array[i].event_spec = phytium_adc_event; + chan_array[i].num_event_specs = ARRAY_SIZE(phytium_adc_event); + chan_array[i].scan_index = channel; + chan_array[i].scan_type.sign = 'u'; + chan_array[i].scan_type.realbits = 10; + chan_array[i].scan_type.storagebits = 16; + chan_array[i].scan_type.endianness = IIO_LE; + chan_array[i].ext_info = phytium_adc_ext_info; + i++; + } + + data->num_channels = num_channels; + data->channels = chan_array; + adc->data = data; + + return 0; +} + +static void phytium_adc_start_stop(struct phytium_adc *adc, bool start) +{ + u32 ctrl; + + ctrl = readl(adc->regs + ADC_CTRL_REG); + if (start) + ctrl |= ADC_CTRL_REG_SOC_EN | ADC_CTRL_REG_SINGLE_EN; + else + ctrl &= ~ADC_CTRL_REG_SOC_EN; + /* Start conversion */ + writel(ctrl, adc->regs + ADC_CTRL_REG); +} + +static void phytium_adc_power_setup(struct phytium_adc *adc, bool on) +{ + u32 reg; + + reg = readl(adc->regs + ADC_CTRL_REG); + if (on) + reg &= ~ADC_CTRL_REG_PD_EN; + else + reg |= ADC_CTRL_REG_PD_EN; + writel(reg, adc->regs + ADC_CTRL_REG); +} + +static int phytium_adc_hw_init(struct phytium_adc *adc) +{ + int ret; + u32 reg; + + ret = clk_prepare_enable(adc->adc_clk); + if (ret) + return ret; + + /* + * Setup ctrl register: + * - Power up conversion module + * - Set the division by 4 as default + */ + reg = ADC_CTRL_REG_CLK_DIV(4); + writel(reg, adc->regs + ADC_CTRL_REG); + + /* Set all the interrupt mask, unmask them when necessary. */ + writel(0x1ffffff, adc->regs + ADC_INTRMASK_REG); + + /* Set default conversion interval */ + adc->interval = (clk_get_rate(adc->adc_clk) * 1000) / NSEC_PER_SEC; + + phytium_adc_power_setup(adc, true); + + return 0; +} + +static void phytium_adc_intrmask_setup(struct phytium_adc *adc, unsigned long chan_mask, bool on) +{ + u32 reg; + u16 limit_mask = 0; + int ch; + + for_each_set_bit(ch, &chan_mask, PHYTIUM_MAX_CHANNELS) + limit_mask |= BIT(ch << 1) | BIT((ch << 1) + 1); + + reg = readl(adc->regs + ADC_INTRMASK_REG); + if (on) + reg &= ~(ADC_INTRMASK_REG_ERR_INTR_MASK | + (limit_mask << 8) | chan_mask); + else + reg |= (ADC_INTRMASK_REG_ERR_INTR_MASK | + (limit_mask << 8) | chan_mask); + writel(reg, adc->regs + ADC_INTRMASK_REG); +} + +static void phytium_adc_single_conv_setup(struct phytium_adc *adc, u8 ch) +{ + u32 reg; + + /* + * Setup control register: + * - Single conversion mode selection + * - Single conversion enable + * - Fixed channel conversion + * - Target channel + */ + reg = readl(adc->regs + ADC_CTRL_REG); + + /* Clean ch_only_s bits */ + reg &= ~ADC_CTRL_REG_CH_ONLY_S(7); + + /* Clean channel_en bit */ + reg &= 0xFFF00F; + + reg |= ADC_CTRL_REG_SINGLE_SEL | ADC_CTRL_REG_SINGLE_EN | + ADC_CTRL_REG_CH_ONLY_EN | ADC_CTRL_REG_CH_ONLY_S(ch) | ADC_CTRL_REG_CHANNEL_EN(ch); + writel(reg, adc->regs + ADC_CTRL_REG); +} + +static int phytium_adc_single_conv(struct iio_dev *indio_dev, u8 ch) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + int ret; + + ret = iio_device_claim_direct_mode(indio_dev); + if (ret) + return ret; + mutex_lock(&adc->lock); + + phytium_adc_intrmask_setup(adc, BIT(ch), true); + reinit_completion(&adc->completion); + phytium_adc_single_conv_setup(adc, ch); + phytium_adc_start_stop(adc, true); + + if (!wait_for_completion_timeout(&adc->completion, PHYTIUM_ADC_TIMEOUT)) + ret = -ETIMEDOUT; + + phytium_adc_start_stop(adc, false); + phytium_adc_intrmask_setup(adc, BIT(ch), false); + + mutex_unlock(&adc->lock); + iio_device_release_direct_mode(indio_dev); + + return ret; +} + +static int phytium_adc_read_raw(struct iio_dev *indio_dev, + struct iio_chan_spec const *chan, + int *val, int *val2, long mask) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + int ret; + + switch (mask) { + case IIO_CHAN_INFO_RAW: + if (chan->type != IIO_VOLTAGE) + return -EINVAL; + + ret = phytium_adc_single_conv(indio_dev, chan->channel); + if (ret) + return ret; + *val = adc->last_val[chan->channel]; + + return IIO_VAL_INT; + default: + return -EINVAL; + } +} + +static int phytium_read_thresh(struct iio_dev *indio_dev, + const struct iio_chan_spec *chan, + enum iio_event_type type, + enum iio_event_direction dir, + enum iio_event_info iinfo, int *val, int *val2) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + + if (dir == IIO_EV_DIR_FALLING) + *val = adc->thresh_low[chan->channel]; + else + *val = adc->thresh_high[chan->channel]; + + return IIO_VAL_INT; +} + +static int phytium_write_thresh(struct iio_dev *indio_dev, + const struct iio_chan_spec *chan, + enum iio_event_type type, + enum iio_event_direction dir, + enum iio_event_info einfo, int val, int val2) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + u32 thresh; + + switch (dir) { + case IIO_EV_DIR_FALLING: + adc->thresh_low[chan->channel] = val; + thresh = readl(adc->regs + ADC_LEVEL_REG(chan->channel)) & 0x3ff0000; + thresh |= ADC_LEVEL_REG_LOW_LEVEL(val); + writel(thresh, adc->regs + ADC_LEVEL_REG(chan->channel)); + break; + case IIO_EV_DIR_RISING: + adc->thresh_high[chan->channel] = val; + thresh = readl(adc->regs + ADC_LEVEL_REG(chan->channel)) & 0xffff; + thresh |= ADC_LEVEL_REG_HIGH_LEVEL(val); + writel(thresh, adc->regs + ADC_LEVEL_REG(chan->channel)); + break; + default: + return -EINVAL; + } + + return 0; +} + +static int phytium_update_scan_mode(struct iio_dev *indio_dev, const unsigned long *mask) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + unsigned int n; + + n = bitmap_weight(mask, indio_dev->masklength); + + kfree(adc->scan_data); + adc->scan_data = kcalloc(n, sizeof(*adc->scan_data), GFP_KERNEL); + if (!adc->scan_data) + return -ENOMEM; + + return 0; +} + +static const u64 phytium_adc_event_codes[] = { + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 0, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 0, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 1, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 1, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 2, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 2, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 3, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 3, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 4, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 4, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 5, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 5, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 6, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 6, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 7, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 7, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), +}; + +static irqreturn_t phytium_adc_threaded_irq(int irq, void *data) +{ + struct iio_dev *indio_dev = data; + struct phytium_adc *adc = iio_priv(indio_dev); + s64 timestamp = iio_get_time_ns(indio_dev); + unsigned long status; + int ch; + u32 intr; + + intr = readl(adc->regs + ADC_INTR_REG); + + if (intr & ADC_INTR_REG_ERR) { + dev_err(adc->dev, "conversion error: ADC_INTR_REG(0x%x)\n", intr); + writel(ADC_INTR_REG_ERR, adc->regs + ADC_INTR_REG); + return IRQ_HANDLED; + } + + status = (intr & ADC_INTR_REG_LIMIT_MASK) >> 8; + if (status) { + for_each_set_bit(ch, &status, PHYTIUM_MAX_CHANNELS * 2) + iio_push_event(indio_dev, phytium_adc_event_codes[ch], timestamp); + } + + status = intr & ADC_INTR_REG_COVFIN_MASK; + if (status) { + for_each_set_bit(ch, &status, PHYTIUM_MAX_CHANNELS) + adc->last_val[ch] = readl(adc->regs + ADC_COV_RESULT_REG(ch)) & + ADC_COV_RESULT_REG_MASK; + + if (iio_buffer_enabled(indio_dev)) + iio_trigger_poll(indio_dev->trig); + else + complete(&adc->completion); + } + + /* Clear all the interrupts */ + writel(status, adc->regs + ADC_INTR_REG); + + return IRQ_HANDLED; +} + +static void phytium_adc_cont_conv_setup(struct phytium_adc *adc, + unsigned long chan_mask, + u32 interval) +{ + u32 reg; + + /* + * Setup control register: + * - Continuous conversion mode + * - Multi-channel rotation mode + * - Channel enablement + */ + reg = readl(adc->regs + ADC_CTRL_REG); + reg &= ~(ADC_CTRL_REG_SINGLE_SEL | ADC_CTRL_REG_SINGLE_EN | + ADC_CTRL_REG_CH_ONLY_EN); + reg |= chan_mask << 4; + writel(reg, adc->regs + ADC_CTRL_REG); + + /* Setup interval between two conversions */ + writel(interval, adc->regs + ADC_INTER_REG); +} + +static int phytium_adc_preenable(struct iio_dev *indio_dev) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + unsigned long scan_mask = *indio_dev->active_scan_mask; + + phytium_adc_cont_conv_setup(adc, scan_mask & 0xff, adc->interval); + phytium_adc_intrmask_setup(adc, scan_mask & 0xff, true); + + return 0; +} + +static int phytium_adc_postenable(struct iio_dev *indio_dev) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + + phytium_adc_start_stop(adc, true); + + return 0; +} + +static int phytium_adc_postdisable(struct iio_dev *indio_dev) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + unsigned long scan_mask = *indio_dev->active_scan_mask; + + phytium_adc_start_stop(adc, false); + phytium_adc_intrmask_setup(adc, scan_mask & 0xff, false); + + return 0; +} + +static const struct iio_buffer_setup_ops phytium_buffer_setup_ops = { + .preenable = &phytium_adc_preenable, + .postenable = &phytium_adc_postenable, + .postdisable = &phytium_adc_postdisable, +}; + +static irqreturn_t phytium_adc_trigger_handler(int irq, void *p) +{ + struct iio_poll_func *pf = p; + struct iio_dev *indio_dev = pf->indio_dev; + struct phytium_adc *adc = iio_priv(indio_dev); + int i, j = 0; + + if (!adc->scan_data) + goto out; + + for_each_set_bit(i, indio_dev->active_scan_mask, indio_dev->masklength) + adc->scan_data[j++] = adc->last_val[i]; + + iio_push_to_buffers(indio_dev, adc->scan_data); + +out: + iio_trigger_notify_done(indio_dev->trig); + + return IRQ_HANDLED; +} + +static const struct iio_info phytium_adc_iio_info = { + .read_raw = &phytium_adc_read_raw, + .read_event_value = &phytium_read_thresh, + .write_event_value = &phytium_write_thresh, + .update_scan_mode = &phytium_update_scan_mode, +}; + +static int phytium_adc_probe(struct platform_device *pdev) +{ + struct phytium_adc *adc; + struct iio_dev *indio_dev; + struct device *dev = &pdev->dev; + struct resource *res; + int ret; + + indio_dev = devm_iio_device_alloc(dev, sizeof(*adc)); + if (!indio_dev) + return -ENOMEM; + + adc = iio_priv(indio_dev); + adc->dev = dev; + + ret = phytium_adc_parse_properties(pdev, adc); + if (ret) + return ret; + + mutex_init(&adc->lock); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + adc->regs = devm_ioremap_resource(dev, res); + if (IS_ERR(adc->regs)) + return PTR_ERR(adc->regs); + + adc->adc_clk = devm_clk_get(dev, NULL); + if (IS_ERR(adc->adc_clk)) + return PTR_ERR(adc->adc_clk); + + init_completion(&adc->completion); + + indio_dev->name = dev_name(dev); + indio_dev->info = &phytium_adc_iio_info; + indio_dev->modes = INDIO_DIRECT_MODE; + indio_dev->channels = adc->data->channels; + indio_dev->num_channels = adc->data->num_channels; + + platform_set_drvdata(pdev, indio_dev); + + ret = devm_request_threaded_irq(adc->dev, platform_get_irq(pdev, 0), + NULL, phytium_adc_threaded_irq, IRQF_ONESHOT, + dev_name(dev), indio_dev); + if (ret) + return ret; + + ret = devm_iio_triggered_buffer_setup(dev, indio_dev, + &iio_pollfunc_store_time, + phytium_adc_trigger_handler, + &phytium_buffer_setup_ops); + if (ret) + return ret; + + ret = phytium_adc_hw_init(adc); + if (ret) { + dev_err(&pdev->dev, "failed to initialize Phytium ADC, %d\n", ret); + return ret; + } + + return iio_device_register(indio_dev); +} + +static int phytium_adc_remove(struct platform_device *pdev) +{ + struct iio_dev *indio_dev = platform_get_drvdata(pdev); + struct phytium_adc *adc = iio_priv(indio_dev); + + phytium_adc_power_setup(adc, false); + iio_device_unregister(indio_dev); + kfree(adc->scan_data); + + return 0; +} + +static const struct of_device_id phytium_of_match[] = { + { .compatible = "phytium,adc", }, + { /* sentinel */ } +}; +MODULE_DEVICE_TABLE(of, phytium_of_match); + +#ifdef CONFIG_PM +static int phytium_adc_suspend(struct device *dev) +{ + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct phytium_adc *adc = iio_priv(indio_dev); + + phytium_adc_power_setup(adc, false); + clk_disable_unprepare(adc->adc_clk); + + return 0; +} + +static int phytium_adc_resume(struct device *dev) +{ + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct phytium_adc *adc = iio_priv(indio_dev); + + clk_prepare_enable(adc->adc_clk); + phytium_adc_power_setup(adc, true); + + return 0; +} +#endif + +SIMPLE_DEV_PM_OPS(phytium_adc_pm_ops, phytium_adc_suspend, phytium_adc_resume); + +static struct platform_driver phytium_adc_driver = { + .driver = { + .name = "phytium_adc", + .of_match_table = phytium_of_match, + .pm = &phytium_adc_pm_ops, + }, + .probe = phytium_adc_probe, + .remove = phytium_adc_remove, +}; +module_platform_driver(phytium_adc_driver); + +MODULE_AUTHOR("Yang Liu "); +MODULE_DESCRIPTION("Phytium ADC driver"); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/input/keyboard/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/keyboard/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..6851cd0f226487df68b4aa04ada7c38cd87f17f2 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/keyboard/Kconfig @@ -0,0 +1,12 @@ +config KEYBOARD_PHYTIUM + tristate "Phytium keypad support" + depends on ARCH_PHYTIUM + select INPUT_MATRIXKMAP + help + Say Y here if you want to enable support for Phytium keypad + port. + + To compile this driver as a module, choose M here: the + module will be called phytium_keypad. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/input/keyboard/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/keyboard/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..bae46ed876c265a29de845a7ec94d78f8ba74281 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/keyboard/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_KEYBOARD_PHYTIUM) += phytium-keypad.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/input/keyboard/phytium-keypad.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/keyboard/phytium-keypad.c new file mode 100644 index 0000000000000000000000000000000000000000..f34a9cf140728e92e09d3d31f33c5eaffd6c60d3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/keyboard/phytium-keypad.c @@ -0,0 +1,586 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for the Phytium keypad port. + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +/* + * Keypad Controller registers + */ +#define KPCR 0x00 /* Keypad Control Register */ + +#define KPSR 0x04 /* Keypad Status Register */ +#define KBD_STAT_KPKD (0x1 << 0) /* Key Press Interrupt Status bit (w1c) */ +#define KBD_STAT_KPKR (0x1 << 1) /* Key Release Interrupt Status bit (w1c) */ +#define KBD_STAT_KDSC (0x1 << 2) /* Key Depress Synch Chain Status bit (w1c)*/ +#define KBD_STAT_KRSS (0x1 << 3) /* Key Release Synch Status bit (w1c)*/ +#define KBD_STAT_KDIE (0x1 << 8) /* Key Depress Interrupt Enable Status bit */ +#define KBD_STAT_KRIE (0x1 << 9) /* Key Release Interrupt Enable */ + +#define KDDR 0x08 /* Keypad Data Direction Register */ +#define KPDR 0x0C /* Keypad Data Register */ + +#define MAX_MATRIX_KEY_ROWS 8 +#define MAX_MATRIX_KEY_COLS 8 + +#define MAX_MATRIX_KEY_NUM (MAX_MATRIX_KEY_ROWS * MAX_MATRIX_KEY_COLS) + +struct phytium_keypad { + struct input_dev *input_dev; + void __iomem *mmio_base; + + int irq; + struct timer_list check_matrix_timer; + + /* + * The matrix is stable only if no changes are detected after + * PHYTIUM_KEYPAD_SCANS_FOR_STABILITY scans + */ +#define PHYTIUM_KEYPAD_SCANS_FOR_STABILITY 3 + + int stable_count; + + bool enabled; + + unsigned int n_rows; + unsigned int n_cols; + int row_shift; + + /* Masks for enabled rows/cols */ + unsigned short rows_en_mask; + unsigned short cols_en_mask; + + unsigned short keycodes[MAX_MATRIX_KEY_NUM]; + + /* + * Matrix states: + * -stable: achieved after a complete debounce process. + * -unstable: used in the debouncing process. + */ + unsigned short matrix_stable_state[MAX_MATRIX_KEY_COLS]; + unsigned short matrix_unstable_state[MAX_MATRIX_KEY_COLS]; +}; + +static u32 phytium_read(struct phytium_keypad *keypad, int reg) +{ + return readl(keypad->mmio_base + reg); +} + +static void phytium_write(struct phytium_keypad *keypad, u32 value, int reg) +{ + writel(value, keypad->mmio_base + reg); +} + +/* Scan the matrix and return the new state in *matrix_volatile_state. */ +static void phytium_keypad_scan_matrix(struct phytium_keypad *keypad, + unsigned short *matrix_volatile_state) +{ + int col; + u32 reg_val; + + for (col = 0; col < keypad->n_cols; col++) { + if ((keypad->cols_en_mask & (1 << col)) == 0) + continue; + /* + * Discharge keypad capacitance: + * 2. write 0s on KDDR[KCD], configure columns as input. + */ + reg_val = phytium_read(keypad, KDDR); + reg_val = 0x00000000; + phytium_write(keypad, reg_val, KDDR); + + /* + * 3. Write a single column to 0, others to 1. + * 4. Sample row inputs and save data. + * 5. Repeat steps 3 - 4 for remaining columns. + */ + reg_val = 0; + reg_val |= (1 << (16 + col)); + phytium_write(keypad, reg_val, KDDR); + reg_val = phytium_read(keypad, KPDR); + reg_val = 0x00000000; + phytium_write(keypad, reg_val, KPDR); + + /* + * Delay added to avoid propagating the 0 from column to row + * when scanning. + */ + udelay(5); + + /* + * 1s in matrix_volatile_state[col] means key pressures + * throw data from non enabled rows. + */ + reg_val = phytium_read(keypad, KPDR); + matrix_volatile_state[col] = (~reg_val) & keypad->rows_en_mask; + } + + /* + * Return in standby mode: + * 6. write 0s to columns + */ + /* Configure columns as output, output 0 */ + reg_val = 0; + reg_val |= (keypad->cols_en_mask & 0xffff) << 16; + phytium_write(keypad, reg_val, KDDR); + phytium_write(keypad, 0x00000000, KPDR); +} + +/* + * Compare the new matrix state (volatile) with the stable one stored in + * keypad->matrix_stable_state and fire events if changes are detected. + */ +static void phytium_keypad_fire_events(struct phytium_keypad *keypad, + unsigned short *matrix_volatile_state) +{ + struct input_dev *input_dev = keypad->input_dev; + int row, col; + + for (col = 0; col < keypad->n_cols; col++) { + unsigned short bits_changed; + int code; + + if ((keypad->cols_en_mask & (1 << col)) == 0) + continue; /* Column is not enabled */ + + bits_changed = keypad->matrix_stable_state[col] ^ + matrix_volatile_state[col]; + + if (bits_changed == 0) + continue; /* Column does not contain changes */ + + for (row = 0; row < keypad->n_rows; row++) { + if ((keypad->rows_en_mask & (1 << row)) == 0) + continue; /* Row is not enabled */ + if ((bits_changed & (1 << row)) == 0) + continue; /* Row does not contain changes */ + + code = MATRIX_SCAN_CODE(row, col, keypad->row_shift); + input_event(input_dev, EV_MSC, MSC_SCAN, code); + input_report_key(input_dev, keypad->keycodes[code], + matrix_volatile_state[col] & (1 << row)); + dev_dbg(&input_dev->dev, "Event code: %d, val: %d", + keypad->keycodes[code], + matrix_volatile_state[col] & (1 << row)); + } + } + input_sync(input_dev); +} + +/* + * phytium_keypad_check_for_events is the timer handler. + */ +static void phytium_keypad_check_for_events(struct timer_list *t) +{ + struct phytium_keypad *keypad = from_timer(keypad, t, check_matrix_timer); + unsigned short matrix_volatile_state[MAX_MATRIX_KEY_COLS]; + u32 reg_val; + bool state_changed, is_zero_matrix; + int i; + + memset(matrix_volatile_state, 0, sizeof(matrix_volatile_state)); + + phytium_keypad_scan_matrix(keypad, matrix_volatile_state); + + state_changed = false; + for (i = 0; i < keypad->n_cols; i++) { + if ((keypad->cols_en_mask & (1 << i)) == 0) + continue; + + if (keypad->matrix_unstable_state[i] ^ matrix_volatile_state[i]) { + state_changed = true; + break; + } + } + + /* + * If the matrix state is changed from the previous scan + * (Re)Begin the debouncing process, saving the new state in + * keypad->matrix_unstable_state. + * else + * Increase the count of number of scans with a stable state. + */ + if (state_changed) { + memcpy(keypad->matrix_unstable_state, matrix_volatile_state, + sizeof(matrix_volatile_state)); + keypad->stable_count = 0; + } else { + keypad->stable_count++; + } + + /* + * If the matrix is not as stable as we want reschedule scan + * in the near future. + */ + if (keypad->stable_count < PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) { + mod_timer(&keypad->check_matrix_timer, + jiffies + msecs_to_jiffies(10)); + return; + } + + /* + * If the matrix state is stable, fire the events and save the new + * stable state. Note, if the matrix is kept stable for longer + * (keypad->stable_count > PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) all + * events have already been generated. + */ + if (keypad->stable_count == PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) { + phytium_keypad_fire_events(keypad, matrix_volatile_state); + memcpy(keypad->matrix_stable_state, matrix_volatile_state, + sizeof(matrix_volatile_state)); + } + + is_zero_matrix = true; + for (i = 0; i < keypad->n_cols; i++) { + if (matrix_volatile_state[i] != 0) { + is_zero_matrix = false; + break; + } + } + + if (is_zero_matrix) { + /* + * All keys have been released. Enable only the KDI + * interrupt for future key presses (clear the KDI + * status bit and its sync chain before that). + */ + reg_val = phytium_read(keypad, KPSR); + reg_val |= KBD_STAT_KPKD | KBD_STAT_KDSC; + phytium_write(keypad, reg_val, KPSR); + + reg_val = phytium_read(keypad, KPSR); + reg_val |= KBD_STAT_KDIE; + reg_val &= ~KBD_STAT_KRIE; + phytium_write(keypad, reg_val, KPSR); + } else { + /* + * Some keys are still pressed. Schedule a rescan in + * attempt to detect multiple key presses and enable + * the KRI interrupt to react quickly to key release + * event. + */ + mod_timer(&keypad->check_matrix_timer, + jiffies + msecs_to_jiffies(60)); + + reg_val = phytium_read(keypad, KPSR); + reg_val |= KBD_STAT_KPKR | KBD_STAT_KRSS; + phytium_write(keypad, reg_val, KPSR); + + reg_val = phytium_read(keypad, KPSR); + reg_val |= KBD_STAT_KRIE; + reg_val &= ~KBD_STAT_KDIE; + phytium_write(keypad, reg_val, KPSR); + } +} + +static irqreturn_t phytium_keypad_irq_handler(int irq, void *dev_id) +{ + struct phytium_keypad *keypad = dev_id; + u32 reg_val; + + reg_val = phytium_read(keypad, KPSR); + /* Disable both interrupt types */ + reg_val &= ~(KBD_STAT_KRIE | KBD_STAT_KDIE); + /* Clear interrupts status bits */ + reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD; + phytium_write(keypad, reg_val, KPSR); + + if (keypad->enabled) { + /* The matrix is supposed to be changed */ + keypad->stable_count = 0; + + /* Schedule the scanning procedure near in the future */ + mod_timer(&keypad->check_matrix_timer, + jiffies + msecs_to_jiffies(2)); + } + + return IRQ_HANDLED; +} + +static void phytium_keypad_config(struct phytium_keypad *keypad) +{ + u32 reg_val; + + /* + * Include enabled rows in interrupt generation (KPCR[15:0]) + * Configure keypad columns as open-drain (KPCR[31:16]) + */ + reg_val = phytium_read(keypad, KPCR); + reg_val |= keypad->rows_en_mask & 0xffff; /* rows */ + reg_val |= (keypad->cols_en_mask & 0xffff) << 16; /* cols */ + phytium_write(keypad, reg_val, KPCR); + + /* Configure columns as output, output 0 */ + reg_val = 0; + reg_val |= (keypad->cols_en_mask & 0xffff) << 16; + phytium_write(keypad, reg_val, KDDR); + phytium_write(keypad, 0x00000000, KPDR); + + /* + * Clear Key Depress and Key Release status bit. + * Clear both synchronizer chain. + */ + reg_val = phytium_read(keypad, KPSR); + reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD | + KBD_STAT_KDSC | KBD_STAT_KRSS; + phytium_write(keypad, reg_val, KPSR); + + /* Enable KDI and disable KRI (avoid false release events). */ + reg_val |= KBD_STAT_KDIE; + reg_val &= ~KBD_STAT_KRIE; + phytium_write(keypad, reg_val, KPSR); +} + +static void phytium_keypad_inhibit(struct phytium_keypad *keypad) +{ + unsigned short reg_val; + + /* Inhibit KDI and KRI interrupts. */ + reg_val = phytium_read(keypad, KPSR); + reg_val &= ~(KBD_STAT_KRIE | KBD_STAT_KDIE); + reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD; + phytium_write(keypad, reg_val, KPSR); +} + +static void phytium_keypad_close(struct input_dev *dev) +{ + struct phytium_keypad *keypad = input_get_drvdata(dev); + + dev_dbg(&dev->dev, ">%s\n", __func__); + + /* Mark keypad as being inactive */ + keypad->enabled = false; + synchronize_irq(keypad->irq); + del_timer_sync(&keypad->check_matrix_timer); + + phytium_keypad_inhibit(keypad); +} + +static int phytium_keypad_open(struct input_dev *dev) +{ + struct phytium_keypad *keypad = input_get_drvdata(dev); + + dev_dbg(&dev->dev, ">%s\n", __func__); + + /* We became active from now */ + keypad->enabled = true; + + phytium_keypad_config(keypad); + + /* Sanity control, not all the rows must be activated now. */ + if ((phytium_read(keypad, KPDR) & keypad->rows_en_mask) == 0) { + dev_err(&dev->dev, + "too many keys pressed, control pins initialisation\n"); + goto open_err; + } + + return 0; + +open_err: + phytium_keypad_close(dev); + return -EIO; +} + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_keypad_acpi_ids[] = { + { "PHYT0028", 0 }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(acpi, phytium_keypad_acpi_ids); +#endif + +#ifdef CONFIG_OF +static const struct of_device_id phytium_keypad_of_match[] = { + { .compatible = "phytium,keypad", }, + { /* sentinel */ } +}; +MODULE_DEVICE_TABLE(of, phytium_keypad_of_match); +#endif + +static int phytium_keypad_probe(struct platform_device *pdev) +{ + const struct matrix_keymap_data *keymap_data = dev_get_platdata(&pdev->dev); + struct phytium_keypad *keypad; + struct input_dev *input_dev; + struct resource *res; + int irq, error, i, row, col; + + if (!keymap_data && !pdev->dev.of_node && !has_acpi_companion(&pdev->dev)) { + dev_err(&pdev->dev, "no keymap defined\n"); + return -EINVAL; + } + + irq = platform_get_irq(pdev, 0); + if (irq < 0) { + dev_err(&pdev->dev, "no irq defined in platform data\n"); + return irq; + } + + input_dev = devm_input_allocate_device(&pdev->dev); + if (!input_dev) { + dev_err(&pdev->dev, "failed to allocate the input device\n"); + return -ENOMEM; + } + + keypad = devm_kzalloc(&pdev->dev, sizeof(*keypad), GFP_KERNEL); + if (!keypad) + return -ENOMEM; + + keypad->input_dev = input_dev; + keypad->irq = irq; + keypad->stable_count = 0; + + timer_setup(&keypad->check_matrix_timer, + phytium_keypad_check_for_events, 0); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + keypad->mmio_base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(keypad->mmio_base)) + return PTR_ERR(keypad->mmio_base); + + /* Init the Input device */ + input_dev->name = pdev->name; + input_dev->id.bustype = BUS_HOST; + input_dev->dev.parent = &pdev->dev; + input_dev->open = phytium_keypad_open; + input_dev->close = phytium_keypad_close; + + error = matrix_keypad_parse_properties(&pdev->dev, &keypad->n_rows, &keypad->n_cols); + if (error) { + dev_err(&pdev->dev, "failed to parse phytium kp params\n"); + return error; + } + + error = matrix_keypad_build_keymap(keymap_data, NULL, + keypad->n_rows, + keypad->n_cols, + keypad->keycodes, input_dev); + if (error) { + dev_err(&pdev->dev, "failed to build keymap\n"); + return error; + } + + keypad->row_shift = get_count_order(keypad->n_cols); + + /* Search for rows and cols enabled */ + for (row = 0; row < keypad->n_rows; row++) { + for (col = 0; col < keypad->n_cols; col++) { + i = MATRIX_SCAN_CODE(row, col, keypad->row_shift); + if (keypad->keycodes[i] != KEY_RESERVED) { + keypad->rows_en_mask |= 1 << row; + keypad->cols_en_mask |= 1 << col; + } + } + } + + __set_bit(EV_REP, input_dev->evbit); + input_set_capability(input_dev, EV_MSC, MSC_SCAN); + input_set_drvdata(input_dev, keypad); + + phytium_keypad_inhibit(keypad); + + error = devm_request_irq(&pdev->dev, irq, phytium_keypad_irq_handler, 0, + pdev->name, keypad); + if (error) { + dev_err(&pdev->dev, "failed to request IRQ\n"); + return error; + } + + /* Register the input device */ + error = input_register_device(input_dev); + if (error) { + dev_err(&pdev->dev, "failed to register input device\n"); + return error; + } + + platform_set_drvdata(pdev, keypad); + device_init_wakeup(&pdev->dev, 1); + + return 0; +} + +static int phytium_keypad_remove(struct platform_device *pdev) +{ + struct phytium_keypad *keypad = platform_get_drvdata(pdev); + + input_unregister_device(keypad->input_dev); + devm_kfree(&pdev->dev, keypad); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_keypad_suspend(struct device *dev) +{ + struct platform_device *pdev = to_platform_device(dev); + struct phytium_keypad *keypad = platform_get_drvdata(pdev); + struct input_dev *input_dev = keypad->input_dev; + + mutex_lock(&input_dev->mutex); + + if (input_dev->users) + phytium_keypad_inhibit(keypad); + + mutex_unlock(&input_dev->mutex); + + if (device_may_wakeup(&pdev->dev)) + enable_irq_wake(keypad->irq); + + return 0; +} + +static int phytium_keypad_resume(struct device *dev) +{ + struct platform_device *pdev = to_platform_device(dev); + struct phytium_keypad *keypad = platform_get_drvdata(pdev); + struct input_dev *input_dev = keypad->input_dev; + int ret = 0; + + if (device_may_wakeup(&pdev->dev)) + disable_irq_wake(keypad->irq); + + mutex_lock(&input_dev->mutex); + + if (input_dev->users) + phytium_keypad_config(keypad); + + mutex_unlock(&input_dev->mutex); + + return ret; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_keypad_pm_ops, phytium_keypad_suspend, phytium_keypad_resume); + +static struct platform_driver phytium_keypad_driver = { + .driver = { + .name = "phytium-keypad", + .pm = &phytium_keypad_pm_ops, + .of_match_table = of_match_ptr(phytium_keypad_of_match), + .acpi_match_table = ACPI_PTR(phytium_keypad_acpi_ids), + }, + .probe = phytium_keypad_probe, + .remove = phytium_keypad_remove, +}; +module_platform_driver(phytium_keypad_driver); + +MODULE_AUTHOR("Song Wenting "); +MODULE_DESCRIPTION("PHYTIUM Keypad Port Driver"); +MODULE_LICENSE("GPL v2"); +MODULE_ALIAS("platform:phytium-keypad"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/input/serio/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/serio/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..25c414a10541c8cd3cb56f50d453936046b64b1f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/serio/Kconfig @@ -0,0 +1,13 @@ +config SERIO_PHYTIUM_PS2 + depends on SERIO + tristate "PHYTIUM PS/2 (keyboard and mouse)" + default y if ARCH_PHYTIUM + depends on PCI + help + This selects support for the PS/2 Host Controller on + Phytium SoCs. + + To compile this driver as a module, choose M here: the + module will be called phytium-ps2. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/input/serio/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/serio/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..09ab3c8f5df431cadc513f387c7376213cb1be97 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/serio/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_SERIO_PHYTIUM_PS2) += phytium-ps2.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/input/serio/phytium-ps2.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/serio/phytium-ps2.c new file mode 100644 index 0000000000000000000000000000000000000000..902dd7a04f0bd602c201bb338c840a018fa6501b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/input/serio/phytium-ps2.c @@ -0,0 +1,186 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Phytium PS/2 keyboard controller driver. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +#define DRV_NAME "phytium_ps2_pci" + +#define REG_STAT 0x0 +#define REG_STAT_TX_TIMEOUT 0x1 +#define REG_STAT_RX_TIMEOUT 0x2 +#define REG_STAT_TX_FULL 0x4 +#define REG_CTRL 0x4 +#define REG_CTRL_RESET 0x1 +#define REG_CTRL_TX_TIMEOUT 0x2 +#define REG_CTRL_RX_TIMEOUT 0x4 +#define REG_CTRL_RX_INTR 0x8 +#define REG_INTR 0x8 +#define REG_INTR_TIMEOUT 0x1 +#define REG_INTR_RX 0x2 +#define REG_TX 0xc +#define REG_RX 0x10 +#define REG_TIMER_VAL 0x14 + +#define REG_CTRL_ENABLE (REG_CTRL_TX_TIMEOUT|REG_CTRL_RX_TIMEOUT|REG_CTRL_RX_INTR) +#define REG_DATA_PARITY 0x100 + +#define STAT_RX_COUNTER(stat) ((stat >> 8) & 0x1f) + +struct phytium_ps2_data { + void __iomem *base; + struct serio *io; + struct pci_dev *dev; +}; + +static irqreturn_t phytium_ps2_irq(int irq, void *devid) +{ + struct phytium_ps2_data *ps2if = devid; + u32 status, scancode, val = 0; + unsigned int flag; + int i, rxcount; + + status = readl(ps2if->base + REG_STAT); + if (!status) + return IRQ_NONE; + + /* Check if there is timeout interrupt */ + if (status & (REG_STAT_RX_TIMEOUT|REG_STAT_TX_TIMEOUT)) + val |= REG_INTR_TIMEOUT; + + rxcount = STAT_RX_COUNTER(status); + for (i = 0; i < rxcount; i++) { + scancode = readl(ps2if->base + REG_RX) & 0x1ff; + + if (rxcount <= 16 && scancode != 0x1ff) { + flag = ((scancode & REG_DATA_PARITY) ? SERIO_PARITY : 0); + serio_interrupt(ps2if->io, scancode & 0xff, flag); + } + } + + val |= REG_INTR_RX; + writel(val, ps2if->base + REG_INTR); + + return IRQ_HANDLED; +} + +int phytium_ps2_write(struct serio *serio, unsigned char val) +{ + struct phytium_ps2_data *ps2if = serio->port_data; + unsigned int stat; + + do { + stat = readl(ps2if->base + REG_STAT); + cpu_relax(); + } while (stat & REG_STAT_TX_FULL); + + writel(val, ps2if->base + REG_TX); + + return 0; +} + +int phytium_ps2_open(struct serio *io) +{ + struct phytium_ps2_data *ps2if = io->port_data; + + writel(REG_CTRL_RESET, ps2if->base + REG_CTRL); + /* Wait 4ms for the controller to be reset */ + usleep_range(4000, 6000); + writel(REG_CTRL_ENABLE, ps2if->base + REG_CTRL); + + return 0; +} + +void phytium_ps2_close(struct serio *io) +{ + struct phytium_ps2_data *ps2if = io->port_data; + + writel(0, ps2if->base + REG_CTRL); +} + +static int phytium_pci_ps2_probe(struct pci_dev *pdev, const struct pci_device_id *id) +{ + struct phytium_ps2_data *ps2if; + struct serio *serio; + int ret; + + ret = pcim_enable_device(pdev); + if (ret) + goto out; + + ret = pcim_iomap_regions(pdev, 0x1, DRV_NAME); + if (ret) + goto out; + + ps2if = devm_kzalloc(&pdev->dev, sizeof(struct phytium_ps2_data), GFP_KERNEL); + serio = kzalloc(sizeof(struct serio), GFP_KERNEL); + if (!ps2if || !serio) { + ret = -ENOMEM; + goto free; + } + + serio->id.type = SERIO_8042; + serio->write = phytium_ps2_write; + serio->open = phytium_ps2_open; + serio->close = phytium_ps2_close; + strscpy(serio->name, pci_name(pdev), sizeof(serio->name)); + strscpy(serio->phys, dev_name(&pdev->dev), sizeof(serio->phys)); + serio->port_data = ps2if; + serio->dev.parent = &pdev->dev; + ps2if->io = serio; + ps2if->dev = pdev; + ps2if->base = pcim_iomap_table(pdev)[0]; + + ret = devm_request_irq(&pdev->dev, pdev->irq, phytium_ps2_irq, + IRQF_SHARED, DRV_NAME, ps2if); + if (ret) { + dev_err(&pdev->dev, "could not request IRQ %d\n", pdev->irq); + goto free; + } + + pci_set_drvdata(pdev, ps2if); + serio_register_port(ps2if->io); + + return 0; + +free: + kfree(serio); +out: + return ret; +} + +static void phytium_pci_ps2_remove(struct pci_dev *pdev) +{ + struct phytium_ps2_data *ps2if = pci_get_drvdata(pdev); + + serio_unregister_port(ps2if->io); + pcim_iounmap_regions(pdev, 0x1); +} + +static const struct pci_device_id phytium_pci_ps2_ids[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc34) }, + {}, +}; +MODULE_DEVICE_TABLE(pci, phytium_pci_ps2_ids); + +static struct pci_driver phytium_pci_ps2_driver = { + .name = DRV_NAME, + .id_table = phytium_pci_ps2_ids, + .probe = phytium_pci_ps2_probe, + .remove = phytium_pci_ps2_remove, +}; +module_pci_driver(phytium_pci_ps2_driver); + +MODULE_AUTHOR("Cheng Quan "); +MODULE_DESCRIPTION("Phytium PCI PS/2 controller driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/irqchip/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/irqchip/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..c574d405e3df266bab2119d4c629b00f699708ff --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/irqchip/Kconfig @@ -0,0 +1,8 @@ +config PHYTIUM_IXIC + bool "Phytium SoC PCI Legacy Interrupt Controller" + depends on ARCH_PHYTIUM + select IRQ_DOMAIN + select IRQ_DOMAIN_HIERARCHY + help + This enables support PCI Legacy Interrupt on Phytium SoC. + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/irqchip/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/irqchip/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..cb297747e0a4fe4153a2a668e6f471403d4002e9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/irqchip/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_PHYTIUM_IXIC) += irq-phytium-ixic.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/irqchip/irq-phytium-ixic.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/irqchip/irq-phytium-ixic.c new file mode 100755 index 0000000000000000000000000000000000000000..74b1c8c1af1e0c90f812885333fd53c37b5253f9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/irqchip/irq-phytium-ixic.c @@ -0,0 +1,270 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for Phytium PCIe legacy INTx interrupt controller + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +#define NUM_IRQS 4 + +#define CTR_BANK_NUM 6 +#define CTR_BANK_SIZE 0x10000 +#define CTR_BANK_ISTATUS_LOCAL 0x184 + +#define HPB_INTX_STATUS_0 0x0 +#define HPB_INTX_STATUS_1 0x1000 + +struct ixic_irq_data { + void __iomem *ctr; + void __iomem *hpb; + u32 spi_base; +}; + +static void phytium_ixic_irq_eoi(struct irq_data *d) +{ + struct ixic_irq_data *data = irq_data_get_irq_chip_data(d); + unsigned int intx = irqd_to_hwirq(d); + u32 gstatus = readl(data->hpb) | (readl(data->hpb + HPB_INTX_STATUS_1) << 12); + u32 imask, istatus; + int i; + + WARN_ON(intx >= NUM_IRQS); + imask = 1 << (3 - intx); + istatus = (1 << intx) << 24; + for (i = 0; i < CTR_BANK_NUM; i++, gstatus >>= 4) { + if (gstatus & imask) + writel(istatus, data->ctr + CTR_BANK_SIZE*i + CTR_BANK_ISTATUS_LOCAL); + } + + irq_chip_eoi_parent(d); +} + +static struct irq_chip phytium_ixic_irq_chip = { + .name = "IXIU", + .irq_eoi = phytium_ixic_irq_eoi, + .irq_mask = irq_chip_mask_parent, + .irq_unmask = irq_chip_unmask_parent, + .irq_set_type = irq_chip_set_type_parent, + .irq_set_affinity = irq_chip_set_affinity_parent, + .flags = IRQCHIP_MASK_ON_SUSPEND, +}; + +static int phytium_ixic_translate(struct irq_domain *domain, + struct irq_fwspec *fwspec, + unsigned long *hwirq, + unsigned int *type) +{ + struct ixic_irq_data *info = domain->host_data; + + if (is_of_node(fwspec->fwnode)) { + if (fwspec->param_count != 3) + return -EINVAL; + + if (fwspec->param[0] != GIC_SPI) + return -EINVAL; /* No PPI should point to this domain */ + + *hwirq = fwspec->param[1] - info->spi_base; + *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; + } else { + if (fwspec->param_count != 2) + return -EINVAL; + *hwirq = fwspec->param[0] - info->spi_base; + *type = fwspec->param[1] & IRQ_TYPE_SENSE_MASK; + } + + return 0; +} + +static int phytium_ixic_alloc(struct irq_domain *dom, unsigned int virq, + unsigned int nr_irqs, void *data) +{ + struct irq_fwspec *fwspec = data; + struct irq_fwspec parent_fwspec; + struct ixic_irq_data *info = dom->host_data; + irq_hw_number_t hwirq; + + /* We assume the device use the parent's format directly */ + parent_fwspec = *fwspec; + if (is_of_node(dom->parent->fwnode)) { + if (fwspec->param_count != 3) + return -EINVAL; /* Not GIC compliant */ + if (fwspec->param[0] != GIC_SPI) + return -EINVAL; /* No PPI should point to this domain */ + + /* Get the local hwirq of IXIC */ + hwirq = fwspec->param[1] - info->spi_base; + } else { + hwirq = fwspec->param[0] - info->spi_base; + } + WARN_ON(nr_irqs != 1); + irq_domain_set_hwirq_and_chip(dom, virq, hwirq, &phytium_ixic_irq_chip, info); + + parent_fwspec.fwnode = dom->parent->fwnode; + return irq_domain_alloc_irqs_parent(dom, virq, nr_irqs, &parent_fwspec); +} + +static const struct irq_domain_ops ixic_domain_ops = { + .translate = phytium_ixic_translate, + .alloc = phytium_ixic_alloc, + .free = irq_domain_free_irqs_common, +}; + +static struct ixic_irq_data *phytium_ixic_init(const struct fwnode_handle *fwnode, + struct resource *ctr, struct resource *hpb) +{ + struct ixic_irq_data *data; + int err; + + data = kzalloc(sizeof(*data), GFP_KERNEL); + if (!data) + return ERR_PTR(-ENOMEM); + + if (fwnode_property_read_u32_array(fwnode, "intx-spi-base", + &data->spi_base, 1)) { + err = -ENODEV; + goto out_free; + } + + data->ctr = ioremap(ctr->start, resource_size(ctr)); + if (!data->ctr) { + err = -ENODEV; + goto out_free; + } + + data->hpb = ioremap(hpb->start, resource_size(hpb)); + if (!data->hpb) { + err = -ENODEV; + goto out_free; + } + + return data; + +out_free: + kfree(data); + return ERR_PTR(err); +} + +static int __init phytium_ixic_dt_init(struct device_node *node, + struct device_node *parent) +{ + struct irq_domain *pd, *d; + struct ixic_irq_data *data; + struct resource ctr, hpb; + + if (!parent) { + pr_err("%pOF: no parent, giving up\n", node); + return -ENODEV; + } + + pd = irq_find_host(parent); + if (!pd) { + pr_err("%pOF: unable to obtain parent domain\n", node); + return -ENXIO; + } + + if (of_address_to_resource(node, 0, &ctr)) { + pr_err("%pOF: failed to parse 'ctr' memory resource\n", node); + return -ENXIO; + } + + if (of_address_to_resource(node, 1, &hpb)) { + pr_err("%pOF: failed to parse 'hpb' memory resource\n", node); + return -ENXIO; + } + + data = phytium_ixic_init(of_node_to_fwnode(node), &ctr, &hpb); + if (IS_ERR(data)) + return PTR_ERR(data); + + d = irq_domain_add_hierarchy(pd, 0, NUM_IRQS, node, &ixic_domain_ops, data); + if (!d) { + pr_err("%pOF: failed to allocate domain\n", node); + goto out_unmap; + } + + pr_info("%pOF: %d interrupts forwarded to %pOF\n", node, NUM_IRQS, parent); + + return 0; + +out_unmap: + iounmap(data->ctr); + iounmap(data->hpb); + kfree(data); + return -ENOMEM; +} +IRQCHIP_DECLARE(ixic, "phytium,ixic", phytium_ixic_dt_init); + +#ifdef CONFIG_ACPI +static int phytium_ixic_acpi_probe(struct platform_device *pdev) +{ + struct irq_domain *domain; + struct ixic_irq_data *data; + struct resource *ctr, *hpb; + + ctr = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!ctr) { + dev_err(&pdev->dev, "failed to parse 'ctr' memory resource\n"); + return -ENXIO; + } + + hpb = platform_get_resource(pdev, IORESOURCE_MEM, 1); + if (!hpb) { + dev_err(&pdev->dev, "failed to parse 'hpb' memory resource\n"); + return -ENXIO; + } + + data = phytium_ixic_init(dev_fwnode(&pdev->dev), ctr, hpb); + if (IS_ERR(data)) + return PTR_ERR(data); + + domain = acpi_irq_create_hierarchy(0, NUM_IRQS, dev_fwnode(&pdev->dev), + &ixic_domain_ops, data); + if (!domain) { + dev_err(&pdev->dev, "failed to create IRQ domain\n"); + goto out_unmap; + } + + dev_info(&pdev->dev, "%d interrupts forwarded\n", NUM_IRQS); + + return 0; + +out_unmap: + iounmap(data->ctr); + iounmap(data->hpb); + kfree(data); + return -ENOMEM; +} + +static const struct acpi_device_id phytium_ixic_acpi_ids[] = { + { "PHYT0013" }, + { /* sentinel */ } +}; +MODULE_DEVICE_TABLE(acpi, phytium_ixic_acpi_ids); + +static struct platform_driver phytium_ixic_driver = { + .driver = { + .name = "phytium-ixic", + .acpi_match_table = phytium_ixic_acpi_ids, + }, + .probe = phytium_ixic_acpi_probe, +}; + +static int __init phytium_ixic_driver_init(void) +{ + return platform_driver_register(&phytium_ixic_driver); +} + +core_initcall(phytium_ixic_driver_init); +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mailbox/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/mailbox/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..6d47b0c3b2994bea040fb3143ba304729d9b46e6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mailbox/Kconfig @@ -0,0 +1,10 @@ +config PHYTIUM_MBOX + tristate "Phytium SoC Mailbox Support" + depends on ARCH_PHYTIUM || COMPILE_TEST + help + Mailbox driver implementation for the Phytium platform. It is used + to send message between application processors and on-chip management + firmware. Say Y here if you want to build this mailbox controller + driver. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mailbox/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/mailbox/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..28a202ca66b1dccf1469f24cff3938a2497d0ac0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mailbox/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_PHYTIUM_MBOX) += phytium-mailbox.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mailbox/phytium-mailbox.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mailbox/phytium-mailbox.c new file mode 100644 index 0000000000000000000000000000000000000000..c2754f766a209c70af2f4b3b9ff5780eda2d31e4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mailbox/phytium-mailbox.c @@ -0,0 +1,214 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SoC mailbox driver + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define INTR_STAT 0x0 +#define INTR_SET 0x8 +#define INTR_CLR 0x10 + +#define TX_REG 0x100 + +#define NR_CHANS 1 + +static spinlock_t lock; + +struct phytium_mbox_link { + unsigned int irq; + void __iomem *tx_reg; + void __iomem *rx_reg; +}; + +struct phytium_mbox { + void __iomem *base; + struct phytium_mbox_link mlink; + struct mbox_chan chan; + struct mbox_controller mbox; +}; + +static irqreturn_t phytium_mbox_rx_irq(int irq, void *ch) +{ + struct mbox_chan *chan = ch; + struct phytium_mbox_link *mlink = chan->con_priv; + u32 val; + unsigned long flags = 0; + + spin_lock_irqsave(&lock, flags); + val = readl_relaxed(mlink->rx_reg + INTR_STAT); + spin_unlock_irqrestore(&lock, flags); + if (!val) + return IRQ_NONE; + + mbox_chan_received_data(chan, (void *)&val); + + spin_lock_irqsave(&lock, flags); + writel_relaxed(val, mlink->rx_reg + INTR_CLR); + spin_unlock_irqrestore(&lock, flags); + + return IRQ_HANDLED; +} + +static int phytium_mbox_send_data(struct mbox_chan *chan, void *data) +{ + struct phytium_mbox_link *mlink = chan->con_priv; + u32 *arg = data; + unsigned long flags = 0; + + spin_lock_irqsave(&lock, flags); + writel_relaxed(*arg, mlink->tx_reg + INTR_SET); + spin_unlock_irqrestore(&lock, flags); + + return 0; +} + +static int phytium_mbox_startup(struct mbox_chan *chan) +{ + struct phytium_mbox_link *mlink = chan->con_priv; + u32 val; + int ret; + unsigned long flags = 0; + + spin_lock_irqsave(&lock, flags); + val = readl_relaxed(mlink->tx_reg + INTR_STAT); + writel_relaxed(val, mlink->tx_reg + INTR_CLR); + spin_unlock_irqrestore(&lock, flags); + + ret = request_irq(mlink->irq, phytium_mbox_rx_irq, + IRQF_SHARED, "phytium_mbox_link", chan); + if (ret) { + dev_err(chan->mbox->dev, + "Unable to acquire IRQ %d\n", mlink->irq); + } + + return ret; +} + +static void phytium_mbox_shutdown(struct mbox_chan *chan) +{ + struct phytium_mbox_link *mlink = chan->con_priv; + + free_irq(mlink->irq, chan); +} + +static bool phytium_mbox_last_tx_done(struct mbox_chan *chan) +{ + unsigned long flags; + struct phytium_mbox_link *mlink = chan->con_priv; + u32 val; + + spin_lock_irqsave(&lock, flags); + val = readl_relaxed(mlink->tx_reg + INTR_STAT); + spin_unlock_irqrestore(&lock, flags); + + return (val == (u32)(1U << 31)); +} + +static const struct mbox_chan_ops phytium_mbox_ops = { + .send_data = phytium_mbox_send_data, + .startup = phytium_mbox_startup, + .shutdown = phytium_mbox_shutdown, + .last_tx_done = phytium_mbox_last_tx_done, +}; + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_mbox_acpi_match[] = { + { "PHYT0009", 0 }, + { }, +}; +MODULE_DEVICE_TABLE(acpi, phytium_mbox_acpi_match); +#endif + +static const struct of_device_id phytium_mbox_of_match[] = { + { .compatible = "phytium,mbox", }, + { }, +}; +MODULE_DEVICE_TABLE(of, phytium_mbox_of_match); + +static int phytium_mbox_probe(struct platform_device *pdev) +{ + struct phytium_mbox *mbox; + struct resource *res; + int err, irq; + + spin_lock_init(&lock); + + /* Allocate memory for device */ + mbox = devm_kzalloc(&pdev->dev, sizeof(*mbox), GFP_KERNEL); + if (!mbox) + return -ENOMEM; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + mbox->base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(mbox->base)) { + dev_err(&pdev->dev, "ioremap base failed\n"); + return PTR_ERR(mbox->base); + } + + irq = platform_get_irq(pdev, 0); + if (irq < 0) { + dev_err(&pdev->dev, "cannot obtain irq\n"); + return irq; + } + + mbox->chan.con_priv = &mbox->mlink; + mbox->mlink.irq = irq; + mbox->mlink.rx_reg = mbox->base; + mbox->mlink.tx_reg = mbox->mlink.rx_reg + TX_REG; + + mbox->mbox.dev = &pdev->dev; + mbox->mbox.chans = &mbox->chan; + mbox->mbox.num_chans = NR_CHANS; + mbox->mbox.ops = &phytium_mbox_ops; + mbox->mbox.txdone_irq = false; + mbox->mbox.txdone_poll = true; + mbox->mbox.txpoll_period = 1; + + platform_set_drvdata(pdev, mbox); + + err = mbox_controller_register(&mbox->mbox); + if (err) { + dev_err(&pdev->dev, "Failed to register mailboxes %d\n", err); + goto fail; + } + + dev_info(&pdev->dev, "Phytium SoC Mailbox registered\n"); +fail: + return err; +} + +static int phytium_mbox_remove(struct platform_device *pdev) +{ + struct phytium_mbox *mbox = platform_get_drvdata(pdev); + + mbox_controller_unregister(&mbox->mbox); + + return 0; +} + +static struct platform_driver phytium_mbox_driver = { + .probe = phytium_mbox_probe, + .remove = phytium_mbox_remove, + .driver = { + .name = "phytium-mbox", + .of_match_table = of_match_ptr(phytium_mbox_of_match), + .acpi_match_table = ACPI_PTR(phytium_mbox_acpi_match), + }, +}; + +module_platform_driver(phytium_mbox_driver); + +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium SoC Mailbox Driver"); +MODULE_AUTHOR("Chen Baozi "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..041810904302e1ededeb5bcffb2a62adf3997830 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/Kconfig @@ -0,0 +1,12 @@ +config VIDEO_PHYTIUM_JPEG + tristate "Phytium JPEG Encoder driver" + depends on VIDEO_V4L2 + select VIDEOBUF2_DMA_CONTIG + help + Support for the Phytium JPEG Encoder Engine embedded + in the Phytium SOCs. The engine can capture and + compress video data from digital or analog sources. + + + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..d9f50a1aaba3546017f4f69f80be616ee21b4aff --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/Makefile @@ -0,0 +1,3 @@ +# SPDX-License-Identifier: GPL-2.0-only +phytium_jpeg-objs := phytium_jpeg_core.o +obj-$(CONFIG_VIDEO_PHYTIUM_JPEG) += phytium_jpeg.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.c new file mode 100644 index 0000000000000000000000000000000000000000..f37db30301214e40259ff1097cfea5468724b36b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.c @@ -0,0 +1,1379 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for Phytium JPEG Encoder Engine + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include "phytium_jpeg_reg.h" +#include "phytium_jpeg_core.h" +#include + +static u32 phytium_jpeg_header[PHYTIUM_JPEG_HEADER_SIZE] = { + 0xe0ffd8ff, 0x464a0100, 0x01004649, 0x01000001, + 0x00000100, 0x4300dbff, 0x0c0b1000, 0x100a0c0e, + 0x120e0d0e, 0x18131011, 0x16181a28, 0x23311816, + 0x3a281d25, 0x393c3d33, 0x40373833, 0x404e5c48, + 0x37455744, 0x516d5038, 0x67625f57, 0x4d3e6768, + 0x64707971, 0x67655c78, 0x00dbff63, 0x12110143, + 0x18151812, 0x2f1a1a2f, 0x42384263, 0x63636363, + 0x63636363, 0x63636363, 0x63636363, 0x63636363, + 0x63636363, 0x63636363, 0x63636363, 0x63636363, + 0x63636363, 0x63636363, 0x63636363, 0xc0ff6363, + /* h_index(40) indicates high 8 bits of the height + * w_index(41) contains the low 8 bits of the height, + * and the width. For example, height 480(0x01e0) + * locates at 0x<01> 081100 and 0x038002 . + * width 640 (0x0280) locates at 0x03 <80> <02> e0. + */ + + /* 0x0200 <11> 01 is a field marks YUV mode */ + 0x01081100, 0x038002e0, 0x02001101, 0x11030111, + 0x00c4ff01, 0x0100001f, 0x01010105, 0x00010101, + 0x00000000, 0x01000000, 0x05040302, 0x09080706, + 0xc4ff0b0a, 0x00011f00, 0x01010103, 0x01010101, + 0x00000101, 0x00000000, 0x04030201, 0x08070605, + 0xff0b0a09, 0x10b500c4, 0x03010200, 0x03040203, + 0x04040505, 0x7d010000, 0x00030201, 0x12051104, + 0x06413121, 0x07615113, 0x32147122, 0x08a19181, + 0xc1b14223, 0xf0d15215, 0x72623324, 0x160a0982, + 0x1a191817, 0x28272625, 0x35342a29, 0x39383736, + 0x4544433a, 0x49484746, 0x5554534a, 0x59585756, + 0x6564635a, 0x69686766, 0x7574736a, 0x79787776, + 0x8584837a, 0x89888786, 0x9493928a, 0x98979695, + 0xa3a29a99, 0xa7a6a5a4, 0xb2aaa9a8, 0xb6b5b4b3, + 0xbab9b8b7, 0xc5c4c3c2, 0xc9c8c7c6, 0xd4d3d2ca, + 0xd8d7d6d5, 0xe2e1dad9, 0xe6e5e4e3, 0xeae9e8e7, + 0xf4f3f2f1, 0xf8f7f6f5, 0xc4fffaf9, 0x0011b500, + 0x04020102, 0x07040304, 0x00040405, 0x00770201, + 0x11030201, 0x31210504, 0x51411206, 0x13716107, + 0x08813222, 0xa1914214, 0x2309c1b1, 0x15f05233, + 0x0ad17262, 0xe1342416, 0x1817f125, 0x27261a19, + 0x352a2928, 0x39383736, 0x4544433a, 0x49484746, + 0x5554534a, 0x59585756, 0x6564635a, 0x69686766, + 0x7574736a, 0x79787776, 0x8483827a, 0x88878685, + 0x93928a89, 0x97969594, 0xa29a9998, 0xa6a5a4a3, + 0xaaa9a8a7, 0xb5b4b3b2, 0xb9b8b7b6, 0xc4c3c2ba, + 0xc8c7c6c5, 0xd3d2cac9, 0xd7d6d5d4, 0xe2dad9d8, + 0xe6e5e4e3, 0xeae9e8e7, 0xf5f4f3f2, 0xf9f8f7f6, + 0x00fefffa, 0x0000008f, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0xdaff0000, 0x01030c00, 0x03110200, 0x003f0011 +}; + +static char yuv_mode_str[YUV_MODE_STR_LEN] = { "yuv444" }; + +module_param_string(yuv_mode, yuv_mode_str, sizeof(yuv_mode_str), 0444); +MODULE_PARM_DESC(yuv_mode, "Users select one mode from such modes as 'yuv444', or 'yuv422', or 'yuv420'. If no mode is set, the driver adapts defaults mode 'yuv444'."); + +static u32 phytium_jpeg_read(struct phytium_jpeg_dev *jpeg_dev, u32 reg) +{ + u32 reg_val = readl(jpeg_dev->base_addr + reg); + + dev_dbg(jpeg_dev->dev, "read 0x%p + 0x%x -->val[0x%x]\n", + jpeg_dev->base_addr, reg, reg_val); + + return reg_val; +} + +static void phytium_jpeg_write(struct phytium_jpeg_dev *jpeg_dev, + u32 reg, u32 val) +{ + writel(val, jpeg_dev->base_addr + reg); + dev_dbg(jpeg_dev->dev, "write 0x%x to addr 0x%p + 0x%x\n", + val, jpeg_dev->base_addr, reg); +} + +static void phytium_jpeg_update(struct phytium_jpeg_dev *jpeg_dev, u32 reg, + u32 clear, u32 bits) +{ + u32 reg_val = readl(jpeg_dev->base_addr + reg); + u32 tmp = reg_val; + + reg_val &= ~clear; + reg_val |= bits; + writel(reg_val, jpeg_dev->base_addr + reg); + + dev_dbg(jpeg_dev->dev, "the val of addr 0x%p + 0x%x, from 0x%x to 0x%x\n", + jpeg_dev->base_addr, reg, tmp, readl(jpeg_dev->base_addr + reg)); +} + +static void phytium_jpeg_init_regs(struct phytium_jpeg_dev *jpeg_dev) +{ + u32 transform_info = 0; + u32 disable_all_interrupt = 0; + u32 clear_all_interrupt = INT_FIFO_OVERFLOW | INT_OCM_BUF_OVERFLOW | + INT_JPEG_ENCODE_COMPLETE | INT_VIDEO_FORMAT_CHANGE; + u32 rate_to_reg = 0; + + /* First, disable the JPEG engine, set bit0 = 0*/ + phytium_jpeg_write(jpeg_dev, TRANSFORM_INFO_REG, transform_info); + + /* Second, set VGAvideo_source_information. bit1 = 0 marks VGA */ + transform_info |= 0; + + /* Third, set AXI burst length bit[16:22]= 0xf , default value*/ + transform_info |= (0xF << TRANS_AXI_LEN_SHIFT) & TRANSINFO_AXI_LEN; + + /* Fourth, the default sampling format is YUV422, set bit13 to 0 */ + /* ignore setting sampling interval */ + phytium_jpeg_write(jpeg_dev, TRANSFORM_INFO_REG, transform_info); + udelay(5); + + /* Fifth, setting frame rate. + * Linux driver prohibit float point operations. So use the + * format: reg_val = (1 second * 10^8 / frame_rate / 134 *100) + * write reg_val to register. then enable Highest bit31 = 1 + */ + if (jpeg_dev->frame_rate) { + rate_to_reg = 100000000 / jpeg_dev->frame_rate / 134 * 100; + rate_to_reg |= FRAME_SAMPLE_CTRL_EN; + phytium_jpeg_write(jpeg_dev, FRAME_SAMPLE_CTRL, rate_to_reg); + } + /* Sixth, HUFF_MODE, driver needn't to configure, ignore */ + + /* disable all interrupts and then clear all interrupts */ + phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, + disable_all_interrupt); + udelay(5); + phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, clear_all_interrupt); + + /* Seventh, Sample_mode, hardware default is yuv444 */ + jpeg_dev->yuv420 = false; +} + +/* Turn on the clock of the jpeg engine */ +static void phytium_jpeg_on(struct phytium_jpeg_dev *jpeg_dev) +{ + if (test_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status)) + return; + + /* Turn on the relevant clocks */ + set_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status); +} + +/* Disable the jpeg engine */ +static void phytium_jpeg_off(struct phytium_jpeg_dev *jpeg_dev) +{ + u32 disable_all_interrupt = 0; + u32 clear_all_interrupt = INT_FIFO_OVERFLOW | INT_OCM_BUF_OVERFLOW | + INT_JPEG_ENCODE_COMPLETE | INT_VIDEO_FORMAT_CHANGE; + + if (!test_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status)) { + dev_info(jpeg_dev->dev, "JPEG Engine is already off.\n"); + return; + } + + /* disable all interrupt */ + phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, disable_all_interrupt); + /* clear all interrupt */ + phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, clear_all_interrupt); + /* disable JPEG engine */ + phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 0); + + clear_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status); + /* wait 50 ms */ + mdelay(50); + /* C08 bit7 1:busy */ +} + +static inline void phytium_jpeg_enable_source_detecting(struct phytium_jpeg_dev *jpeg_dev) +{ + /* + * Enable the dectection to discovery + * the source resolution is changed + */ + //phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, DETECT_RESOLUTION_CHANGE_EN); + phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, 0, TRANSINFO_SRC_SELECT); +} + +#define res_check(val) \ + test_and_clear_bit(VIDEO_MODE_DETECT_DONE, &(val)->status) + +static void phytium_jpeg_get_resolution(struct phytium_jpeg_dev *jpeg_dev) +{ + u32 source_info; + u32 width; + u32 height; + struct v4l2_bt_timings *detected_timings = &jpeg_dev->detected_timings; + + /* Before get a new resolution, maybe need to wait 10 us */ + detected_timings->width = MIN_WIDTH; + detected_timings->height = MIN_HEIGHT; + jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; + + + phytium_jpeg_enable_source_detecting(jpeg_dev); + source_info = phytium_jpeg_read(jpeg_dev, SRC_VGA_INFO_REG); + width = (source_info & SRC_HOR_PIXELS) >> SRC_WIDTH_SHIFT; + height = (source_info & SRC_VER_PIXELS) >> SRC_HEIGHT_SHIFT; + + if (width * height != 0) { + detected_timings->width = width; + detected_timings->height = height; + } + + jpeg_dev->v4l2_input_status = 0; + + /* + * Resolution is changed will trigger an interrupt, resolution detecting + * also is disable during process interrupt. So re-enable. + */ + phytium_jpeg_enable_source_detecting(jpeg_dev); + dev_info(jpeg_dev->dev, "Change resolution: %uX%u\n", width, height); +} + +static void phytium_jpeg_set_resolution(struct phytium_jpeg_dev *jpeg_dev) +{ + struct v4l2_bt_timings *active_timings = &jpeg_dev->active_timings; + int i; + int src_addrs[OCM_BUF_NUM]; + /* + * The OCM address space is 0x30C0_0000 ~ 0x30C7_FFFF, JPEG Engine uses the + * high-bottom address. src_0 uses 0x30C4_0000 ~ 0x30c6_0000 (total capacity is + * 128KB, greater than the requirements of the largest resolution). src_1 uses + * 0x30C6_0000 ~ 0x30C7_FFFF. + */ + + /* The OCM address should shift right 8 bits */ + for (i = 0; i < OCM_BUF_NUM; i++) + src_addrs[i] = jpeg_dev->src_addrs[i].dma_addr >> OCM_BUF_SHIFT; + + phytium_jpeg_write(jpeg_dev, OCM_BUF0_ADDR, src_addrs[0]); + phytium_jpeg_write(jpeg_dev, OCM_BUF1_ADDR, src_addrs[1]); + + /* + * In the worst case, the size of one image will be compressed to 25% the + * raw image's size. When a pixel is 4-byte, no need to divide 4. + */ + jpeg_dev->max_compressed_size = active_timings->width * active_timings->height; +} + +/* The below functions is implemented for various v4l2 ioctl operations */ +static int phytium_jpeg_querycap(struct file *file, void *priv, + struct v4l2_capability *cap) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + strscpy(cap->driver, PHYTIUM_JPEG_NAME, sizeof(cap->driver)); + strscpy(cap->card, "Phytium JPEG Engine", sizeof(cap->card)); + snprintf(cap->bus_info, sizeof(cap->bus_info), "platform:%s", dev_name(jpeg_dev->dev)); + + return 0; +} + +static int phytium_jpeg_enum_format(struct file *file, void *priv, + struct v4l2_fmtdesc *f) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + if (f->index) { + dev_err(jpeg_dev->dev, "Failed to enum format\n"); + return -EINVAL; + } + + f->pixelformat = V4L2_PIX_FMT_JPEG; + + return 0; +} + +static int phytium_jpeg_get_format(struct file *file, void *priv, + struct v4l2_format *f) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + f->fmt.pix = jpeg_dev->pix_fmt; + + return 0; +} + +static int phytium_jpeg_enum_input(struct file *file, void *priv, + struct v4l2_input *input) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + if (input->index) { + dev_err(jpeg_dev->dev, "failed to enum input\n"); + return -EINVAL; + } + + strscpy(input->name, "Host DC Capture", sizeof(input->name)); + input->type = V4L2_INPUT_TYPE_CAMERA; + input->capabilities = V4L2_IN_CAP_DV_TIMINGS; + input->status = jpeg_dev->v4l2_input_status; + + return 0; +} + +static int phytium_jpeg_get_input(struct file *file, void *priv, + unsigned int *i) +{ + *i = 0; + return 0; +} + +static int phytium_jpeg_set_input(struct file *file, void *priv, + unsigned int i) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + if (i != 0) { + dev_err(jpeg_dev->dev, "Failed to set input\n"); + return -EINVAL; + } + + return 0; +} + +static int phytium_jpeg_get_parm(struct file *file, void *priv, + struct v4l2_streamparm *stream) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + /* Readbuffers num is 3 */ + stream->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; + stream->parm.capture.readbuffers = CAPTURE_BUF_NUMBER; + stream->parm.capture.timeperframe.denominator = 1; + + if (jpeg_dev->frame_rate == 0) + stream->parm.capture.timeperframe.denominator = MAX_FRAME_RATE; + else + stream->parm.capture.timeperframe.denominator = jpeg_dev->frame_rate; + + return 0; +} + +static int phytium_jpeg_set_parm(struct file *file, void *priv, + struct v4l2_streamparm *stream) +{ + unsigned int frame_rate = 0; + u32 rate_to_reg = 0; + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + /* Readbuffers num is 3 */ + stream->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; + stream->parm.capture.readbuffers = CAPTURE_BUF_NUMBER; + + if (stream->parm.capture.timeperframe.numerator) + frame_rate = stream->parm.capture.timeperframe.denominator / + stream->parm.capture.timeperframe.numerator; + + if (frame_rate == 0 || frame_rate > MAX_FRAME_RATE) { + frame_rate = MAX_FRAME_RATE; + stream->parm.capture.timeperframe.denominator = MAX_FRAME_RATE; + stream->parm.capture.timeperframe.numerator = 1; + } + /* + * reg_val = (1 second * 10^9 / frame_rate / 13.4) + * Linux driver prohibit float point operations. So use the + * format: reg_val = (1 second * 10^8 / frame_rate / 134 *100) + * write reg_val to register. then enable Highest bit31 = 1 + */ + if (jpeg_dev->frame_rate != frame_rate) { + jpeg_dev->frame_rate = frame_rate; + rate_to_reg = 100000000 / jpeg_dev->frame_rate / 134 * 100; + rate_to_reg |= FRAME_SAMPLE_CTRL_EN; + phytium_jpeg_write(jpeg_dev, FRAME_SAMPLE_CTRL, rate_to_reg); + } + + return 0; +} + +static int phytium_jpeg_enum_framesizes(struct file *file, void *priv, + struct v4l2_frmsizeenum *fsize) + +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + if (fsize->index != 0) { + dev_err(jpeg_dev->dev, "Failed to enum framesize.\n"); + return -EINVAL; + } + + if (fsize->pixel_format != V4L2_PIX_FMT_JPEG) { + dev_err(jpeg_dev->dev, "enum framesize pixel_format is not JPEG"); + return -EINVAL; + } + + fsize->discrete.width = jpeg_dev->pix_fmt.width; + fsize->discrete.height = jpeg_dev->pix_fmt.height; + fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; + + return 0; + +} + +static int phytium_jpeg_enum_frameintervals(struct file *file, void *priv, + struct v4l2_frmivalenum *fival) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + if (fival->index != 0) { + dev_err(jpeg_dev->dev, "enum frame intervals failed\n"); + return -EINVAL; + } + + if (fival->width != jpeg_dev->detected_timings.width || + fival->height != jpeg_dev->detected_timings.height) { + dev_err(jpeg_dev->dev, "interval isn't same with the detected_timings.\n"); + return -EINVAL; + } + + if (fival->pixel_format != V4L2_PIX_FMT_JPEG) { + dev_err(jpeg_dev->dev, "enum frame interval pixel fomat is incorrect.\n"); + return -EINVAL; + } + + fival->type = V4L2_FRMIVAL_TYPE_CONTINUOUS; + fival->stepwise.min.denominator = MAX_FRAME_RATE; + fival->stepwise.min.numerator = 1; + fival->stepwise.max.denominator = 1; + fival->stepwise.max.numerator = 1; + fival->stepwise.step = fival->stepwise.max; + + return 0; +} + +static int phytium_jpeg_set_dv_timings(struct file *file, void *priv, + struct v4l2_dv_timings *timings) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + /* the params are passed from user space are same with hardware's params */ + if (timings->bt.width == jpeg_dev->active_timings.width && + timings->bt.height == jpeg_dev->active_timings.height) + return 0; + + if (vb2_is_busy(&jpeg_dev->queue)) { + dev_err(jpeg_dev->dev, "queue is busy during setting dv timings.\n"); + return -EBUSY; + } + + jpeg_dev->active_timings = timings->bt; + phytium_jpeg_set_resolution(jpeg_dev); + jpeg_dev->pix_fmt.width = timings->bt.width; + jpeg_dev->pix_fmt.height = timings->bt.height; + jpeg_dev->pix_fmt.sizeimage = jpeg_dev->max_compressed_size; + timings->type = V4L2_DV_BT_656_1120; + + return 0; +} + +static int phytium_jpeg_get_dv_timings(struct file *file, void *priv, + struct v4l2_dv_timings *timings) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + timings->type = V4L2_DV_BT_656_1120; + timings->bt = jpeg_dev->active_timings; + + return 0; +} + +static int phytium_jpeg_query_dv_timings(struct file *file, void *priv, + struct v4l2_dv_timings *timings) +{ + int ret; + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + /* + * This blocks only if the driver is currently in the process of + * detecting a new resolution; in the event of no signal or timeout + * this function is woken up. + */ + if ((file->f_flags & O_NONBLOCK) && + test_bit(VIDEO_RES_CHANGE, &jpeg_dev->status)) + return -EAGAIN; + + ret = wait_event_interruptible(jpeg_dev->wait, !test_bit(VIDEO_RES_CHANGE, + &jpeg_dev->status)); + if (ret) { + dev_err(jpeg_dev->dev, "Failed to query dv timing\n"); + return -EINTR; + } + + timings->type = V4L2_DV_BT_656_1120; + timings->bt = jpeg_dev->detected_timings; + + return jpeg_dev->v4l2_input_status ? -ENOLINK : 0; +} + +static const struct v4l2_dv_timings_cap phytium_jpeg_timings_cap = { + .type = V4L2_DV_BT_656_1120, + .bt = { + .min_width = MIN_WIDTH, + .max_width = MAX_WIDTH, + .min_height = MIN_HEIGHT, + .max_height = MAX_HEIGHT, + .min_pixelclock = 6574080, /* 640 x 480 x 24Hz */ + .max_pixelclock = 1244160000, /* 1920 x 1080 x 60Hz */ + .standards = V4L2_DV_BT_STD_CEA861 | V4L2_DV_BT_STD_DMT | + V4L2_DV_BT_STD_CVT | V4L2_DV_BT_STD_GTF, + .capabilities = V4L2_DV_BT_CAP_PROGRESSIVE | + V4L2_DV_BT_CAP_REDUCED_BLANKING | + V4L2_DV_BT_CAP_CUSTOM, + }, +}; + +static int phytium_jpeg_enum_dv_timings(struct file *file, void *priv, + struct v4l2_enum_dv_timings *timings) +{ + return v4l2_enum_dv_timings_cap(timings, &phytium_jpeg_timings_cap, + NULL, NULL); +} + +static int phytium_jpeg_dv_timings_cap(struct file *file, void *priv, + struct v4l2_dv_timings_cap *cap) +{ + *cap = phytium_jpeg_timings_cap; + + return 0; +} + +/* The function is used to notify DV that video resolution is altered */ +static int phytium_jpeg_sub_event(struct v4l2_fh *fh, + const struct v4l2_event_subscription *sub) +{ + switch (sub->type) { + case V4L2_EVENT_SOURCE_CHANGE: + return v4l2_src_change_event_subscribe(fh, sub); + default: + break; + } + + return v4l2_ctrl_subscribe_event(fh, sub); +} + +static const struct v4l2_ioctl_ops phytium_jpeg_ioctl_ops = { + .vidioc_querycap = phytium_jpeg_querycap, + .vidioc_enum_fmt_vid_cap = phytium_jpeg_enum_format, + .vidioc_g_fmt_vid_cap = phytium_jpeg_get_format, + .vidioc_s_fmt_vid_cap = phytium_jpeg_get_format, + .vidioc_try_fmt_vid_cap = phytium_jpeg_get_format, + .vidioc_reqbufs = vb2_ioctl_reqbufs, + .vidioc_querybuf = vb2_ioctl_querybuf, + .vidioc_qbuf = vb2_ioctl_qbuf, + .vidioc_expbuf = vb2_ioctl_expbuf, + .vidioc_dqbuf = vb2_ioctl_dqbuf, + .vidioc_create_bufs = vb2_ioctl_create_bufs, + .vidioc_prepare_buf = vb2_ioctl_prepare_buf, + .vidioc_streamon = vb2_ioctl_streamon, + .vidioc_streamoff = vb2_ioctl_streamoff, + .vidioc_enum_input = phytium_jpeg_enum_input, + .vidioc_g_input = phytium_jpeg_get_input, + .vidioc_s_input = phytium_jpeg_set_input, + .vidioc_g_parm = phytium_jpeg_get_parm, + .vidioc_s_parm = phytium_jpeg_set_parm, + .vidioc_enum_framesizes = phytium_jpeg_enum_framesizes, + .vidioc_enum_frameintervals = phytium_jpeg_enum_frameintervals, + .vidioc_s_dv_timings = phytium_jpeg_set_dv_timings, + .vidioc_g_dv_timings = phytium_jpeg_get_dv_timings, + .vidioc_query_dv_timings = phytium_jpeg_query_dv_timings, + .vidioc_enum_dv_timings = phytium_jpeg_enum_dv_timings, + .vidioc_dv_timings_cap = phytium_jpeg_dv_timings_cap, + .vidioc_subscribe_event = phytium_jpeg_sub_event, + .vidioc_unsubscribe_event = v4l2_event_unsubscribe, +}; + +static void phytium_jpeg_init_jpeg_quant(struct phytium_jpeg_dev *jpeg_dev) +{ + const u32 y_quant_table[QUANT_REG_NUM] = { + 0x08000000, 0x0ba2e8ba, 0x0aaaaaab, 0x09249249, 0x0aaaaaab, + 0x0ccccccc, 0x08000000, 0x09249249, 0x09d89d8a, 0x09249249, + 0x071c71c7, 0x07878788, 0x08000000, 0x06bca1af, 0x05555555, + 0x03333333, 0x04ec4ec5, 0x05555555, 0x05d1745d, 0x05d1745d, + 0x05555555, 0x029cbc15, 0x03a83a84, 0x03759f23, 0x0469ee58, + 0x03333333, 0x0234f72c, 0x02828283, 0x02192e2a, 0x02222222, + 0x023ee090, 0x02828283, 0x02492492, 0x0253c825, 0x02000000, + 0x01c71c72, 0x01642c86, 0x01a41a42, 0x02000000, 0x01e1e1e2, + 0x0178a4c8, 0x01dae607, 0x0253c825, 0x02492492, 0x0199999a, + 0x012c9fb5, 0x01948b10, 0x0178a4c8, 0x0158ed23, 0x014e5e0a, + 0x013e22cc, 0x013b13b1, 0x013e22cc, 0x02108421, 0x01a98ef6, + 0x0121fb78, 0x010ecf57, 0x01249249, 0x013e22cc, 0x01111111, + 0x01642c86, 0x01446f86, 0x013e22cc, 0x014afd6a + }; + + const u32 c_quant_table[QUANT_REG_NUM] = { + 0x07878788, 0x071c71c7, 0x071c71c7, 0x05555555, 0x06186186, + 0x05555555, 0x02b93105, 0x04ec4ec5, 0x04ec4ec5, 0x02b93105, + 0x014afd6a, 0x01f07c1f, 0x02492492, 0x01f07c1f, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a + }; + int i; + + for (i = 0; i < QUANT_REG_NUM; i++) { + phytium_jpeg_write(jpeg_dev, Y_QUANT_INDEX_ADDR_REG(i), y_quant_table[i]); + phytium_jpeg_write(jpeg_dev, C_QUANT_INDEX_ADDR_REG(i), c_quant_table[i]); + } + +} + +static void phytium_jpeg_start(struct phytium_jpeg_dev *jpeg_dev) +{ + phytium_jpeg_on(jpeg_dev); + phytium_jpeg_init_regs(jpeg_dev); + + /* Resolution set to 640x480 if no signal is found */ + phytium_jpeg_get_resolution(jpeg_dev); + + /* Set timings since the device is being opened for the first tiime */ + jpeg_dev->active_timings = jpeg_dev->detected_timings; + phytium_jpeg_set_resolution(jpeg_dev); + + jpeg_dev->pix_fmt.width = jpeg_dev->active_timings.width; + jpeg_dev->pix_fmt.height = jpeg_dev->active_timings.height; + jpeg_dev->pix_fmt.sizeimage = jpeg_dev->max_compressed_size; +} + +static void phytium_jpeg_stop(struct phytium_jpeg_dev *jpeg_dev) +{ + set_bit(VIDEO_STOPPED, &jpeg_dev->status); + cancel_delayed_work_sync(&jpeg_dev->res_work); + + phytium_jpeg_off(jpeg_dev); + + jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; + jpeg_dev->status = 0; +} + +static int phytium_jpeg_open(struct file *file) +{ + int ret; + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + mutex_lock(&jpeg_dev->video_lock); + + ret = v4l2_fh_open(file); + if (ret != 0) { + mutex_unlock(&jpeg_dev->video_lock); + dev_err(jpeg_dev->dev, "Failed to open the phytium jpeg device.\n"); + return ret; + } + + if (v4l2_fh_is_singular_file(file)) + phytium_jpeg_start(jpeg_dev); + + mutex_unlock(&jpeg_dev->video_lock); + + return 0; +} + +static int phytium_jpeg_release(struct file *file) +{ + int ret; + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + mutex_lock(&jpeg_dev->video_lock); + + if (v4l2_fh_is_singular_file(file)) + phytium_jpeg_stop(jpeg_dev); + + ret = _vb2_fop_release(file, NULL); + mutex_unlock(&jpeg_dev->video_lock); + + return ret; +} + + +static const struct v4l2_file_operations phytium_jpeg_fops = { + .owner = THIS_MODULE, + .read = vb2_fop_read, + .poll = vb2_fop_poll, + .unlocked_ioctl = video_ioctl2, + .mmap = vb2_fop_mmap, + .open = phytium_jpeg_open, + .release = phytium_jpeg_release, +}; + +static void phytium_jpeg_update_jpeg_header(u32 width, u32 height) +{ + const int h_index = PHYTIUM_JPEG_HEADER_H_INDEX; + const int w_index = PHYTIUM_JPEG_HEADER_W_INDEX; + + /* the high 8 bits of the height locates at bit24~bit31 */ + phytium_jpeg_header[h_index] = phytium_jpeg_header[h_index] & 0x00FFFFFF; + phytium_jpeg_header[h_index] |= ((height >> 8) & 0xFF) << 24; + + /* the low 8 bits of the height locates at bit0~bit7 */ + phytium_jpeg_header[w_index] = phytium_jpeg_header[w_index] & 0xFF000000; + phytium_jpeg_header[w_index] |= height & 0xFF; + + /* the high 8 bits of the width locates at bit8~bit15 */ + phytium_jpeg_header[w_index] |= ((width >> 8) & 0xFF) << 8; + /* the low 8 bits of the width locates at bit16~bit24 */ + phytium_jpeg_header[w_index] |= (width & 0xFF) << 16; +} + +static void phytium_jpeg_fill_header(struct phytium_jpeg_dev *jpeg_dev, + struct phytium_jpeg_buffer *jpeg_buf) +{ + void *vbuf = vb2_plane_vaddr(&jpeg_buf->vb.vb2_buf, 0); + u32 width = jpeg_dev->active_timings.width; + u32 height = jpeg_dev->active_timings.height; + + /* update the contents of the phytium jpeg header according to the resolution */ + phytium_jpeg_update_jpeg_header(width, height); + + /* replenish the contents of the JPEG header */ + memcpy(vbuf, phytium_jpeg_header, PHYTIUM_JPEG_HEADER_LEN); +} + +static int phytium_jpeg_start_frame(struct phytium_jpeg_dev *jpeg_dev) +{ + dma_addr_t dst_addr; + unsigned long status; + struct phytium_jpeg_buffer *jpeg_buf; + + if (jpeg_dev->v4l2_input_status) { + dev_err(jpeg_dev->dev, "No signal; needn't start frame\n"); + return 0; + } + + spin_lock_irqsave(&jpeg_dev->hw_lock, status); + jpeg_buf = list_first_entry_or_null(&jpeg_dev->buffers, + struct phytium_jpeg_buffer, link); + if (jpeg_buf == NULL) { + spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); + dev_err(jpeg_dev->dev, "No buffers; doesn't start frame\n"); + return -EPROTO; + } + + set_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); + dst_addr = vb2_dma_contig_plane_dma_addr(&jpeg_buf->vb.vb2_buf, 0); + spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); + + /* + * Because the JPEG Engine is unable to add a JPEG header, the phytium + * jpeg driver is required to fill the contents of a JPEG header before + * the jpeg engine write datas to the dma address. + */ + phytium_jpeg_fill_header(jpeg_dev, jpeg_buf); + dst_addr += PHYTIUM_JPEG_HEADER_LEN; + /* + * The ikvm application only using the last frame, so the driver replenish + * one output register with a dma address. + */ + dst_addr >>= JPEG_DST_ADDR_SHIFT; + phytium_jpeg_write(jpeg_dev, BUF_LIST_INDEX_ADDR(VB_BUF_NO), dst_addr); + /* Enable the validilty of the buffer marked with index */ + phytium_jpeg_write(jpeg_dev, BUF_LIST_INDEX_CTRL_STS_ADDR(VB_BUF_NO), + STS_JPEG_BUF_HIGH_LEVEL_VALID); + /* Enable the interruption which is used to identify an image was compressed */ + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, STS_VE_JPEG_CODE_COMP_EN); + /* Enable JPEG, start to capture and compress */ + phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 1); + + return 0; +} + +static void phytium_jpeg_resolution_work(struct work_struct *work) +{ + struct delayed_work *dwork = to_delayed_work(work); + struct phytium_jpeg_dev *jpeg_dev = container_of(dwork, + struct phytium_jpeg_dev, res_work); + u32 input_status = jpeg_dev->v4l2_input_status; + + phytium_jpeg_on(jpeg_dev); + + /* Exit early in the case no clients remain */ + if (test_bit(VIDEO_STOPPED, &jpeg_dev->status)) + goto done; + + phytium_jpeg_init_regs(jpeg_dev); + phytium_jpeg_get_resolution(jpeg_dev); + + /* if source's resolution is changed, the event should be enqueued */ + if (jpeg_dev->detected_timings.width != jpeg_dev->active_timings.width || + jpeg_dev->detected_timings.height != jpeg_dev->active_timings.height || + input_status != jpeg_dev->v4l2_input_status) { + + static const struct v4l2_event event = { + .type = V4L2_EVENT_SOURCE_CHANGE, + .u.src_change.changes = V4L2_EVENT_SRC_CH_RESOLUTION, + }; + v4l2_event_queue(&jpeg_dev->vdev, &event); + clear_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); + dev_info(jpeg_dev->dev, "event notifies changing resolution\n"); + } else if (test_bit(VIDEO_STREAMING, &jpeg_dev->status)) { + /* No resolution change so just restart streaming */ + dev_info(jpeg_dev->dev, "resolution doesn't change\n"); + phytium_jpeg_set_resolution(jpeg_dev); + phytium_jpeg_start_frame(jpeg_dev); + } + +done: + clear_bit(VIDEO_RES_CHANGE, &jpeg_dev->status); + wake_up_interruptible_all(&jpeg_dev->wait); +} + +static int phytium_jpeg_queue_setup(struct vb2_queue *q, + unsigned int *num_buffers, + unsigned int *num_planes, + unsigned int sizes[], + struct device *alloc_devs[]) +{ + struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); + + if (*num_planes) { + if (sizes[0] < jpeg_dev->max_compressed_size) { + v4l2_err(&jpeg_dev->v4l2_dev, "queue v4l2_buf's size is invalid\n"); + return -EINVAL; + } + } + + *num_planes = 1; + sizes[0] = jpeg_dev->max_compressed_size; + return 0; +} + +static int phytium_jpeg_buf_prepare(struct vb2_buffer *vb) +{ + struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(vb->vb2_queue); + + if (vb2_plane_size(vb, 0) < jpeg_dev->max_compressed_size) { + v4l2_err(&jpeg_dev->v4l2_dev, "failed to prepare buffer\n"); + return -EINVAL; + } + + return 0; +} + +static inline struct phytium_jpeg_buffer * +phytium_vb2buf_to_dstbuf(struct vb2_v4l2_buffer *buf) +{ + return container_of(buf, struct phytium_jpeg_buffer, vb); +} + +static void phytium_jpeg_buf_queue(struct vb2_buffer *vb) +{ + bool empty; + struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(vb->vb2_queue); + struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); + struct phytium_jpeg_buffer *jpeg_buf = phytium_vb2buf_to_dstbuf(vbuf); + unsigned long status; + + spin_lock_irqsave(&jpeg_dev->hw_lock, status); + empty = list_empty(&jpeg_dev->buffers); + list_add_tail(&jpeg_buf->link, &jpeg_dev->buffers); + spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); + + /* the empty ensures the address of the first node's vb2_v4l2_buf + * in the list is written to output register + */ + if (test_bit(VIDEO_STREAMING, &jpeg_dev->status) && + (!test_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status)) && + empty) + phytium_jpeg_start_frame(jpeg_dev); +} + +static void phytium_jpeg_bufs_done(struct phytium_jpeg_dev *jpeg_dev, + enum vb2_buffer_state state) +{ + unsigned long flags; + struct phytium_jpeg_buffer *buf; + + spin_lock_irqsave(&jpeg_dev->hw_lock, flags); + + list_for_each_entry(buf, &jpeg_dev->buffers, link) + vb2_buffer_done(&buf->vb.vb2_buf, state); + + INIT_LIST_HEAD(&jpeg_dev->buffers); + + spin_unlock_irqrestore(&jpeg_dev->hw_lock, flags); +} + +static void phytium_jpeg_irq_res_change(struct phytium_jpeg_dev *jpeg_dev, + ulong delay) +{ + dev_info(jpeg_dev->dev, "Source resolution is changed, resetting\n"); + set_bit(VIDEO_RES_CHANGE, &jpeg_dev->status); + + phytium_jpeg_off(jpeg_dev); + + schedule_delayed_work(&jpeg_dev->res_work, delay); +} + +static irqreturn_t phytium_jpeg_irq(int irq, void *arg) +{ + struct phytium_jpeg_dev *jpeg_dev = arg; + u32 status; + struct phytium_jpeg_buffer *buf; + u32 frame_size; + + if (test_bit(VIDEO_POWEROFF, &jpeg_dev->status)) { + dev_info(jpeg_dev->dev, "jpeg engine is requested to poweroff\n"); + return IRQ_HANDLED; + } + + status = phytium_jpeg_read(jpeg_dev, INT_STATUS_CTRL_REG); + + if (status & INT_VIDEO_FORMAT_CHANGE) { + dev_info(jpeg_dev->dev, "receive resolution changed interrupt\n"); + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, + DETECT_RESOLUTION_CHANGE_EN, 0); + phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, INT_VIDEO_FORMAT_CHANGE); + phytium_jpeg_irq_res_change(jpeg_dev, RESOLUTION_CHANGE_DELAY); + return IRQ_HANDLED; + } + + /* + * JPEG engine finish compressing a image JPEG encoding to trigger + * a interruption. the status identifies the buffer number. Currently, + * the driver uses one buffer. + * + * Note: Because the JPEG doesn't support adding a JPEG header, and + * driver is also unable to add a JPEG header to vb2_buffers. One + * solution is that a JPEG header is added by an application. + */ + if (status & INT_JPEG_COMP_BUF_LIST_NO) { + frame_size = phytium_jpeg_read(jpeg_dev, jpeg_dev->comp_size_read); + frame_size &= JPEG_BUF_CAPACITY_SIZE; + frame_size >>= JPEG_BUF_CAPACITY_SIZE_SHIFT; + spin_lock(&jpeg_dev->hw_lock); + clear_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); + /* Delete first node from the queue */ + buf = list_first_entry_or_null(&jpeg_dev->buffers, + struct phytium_jpeg_buffer, link); + if (buf != NULL) { + frame_size += PHYTIUM_JPEG_HEADER_LEN; + vb2_set_plane_payload(&buf->vb.vb2_buf, 0, frame_size); + if (!list_is_last(&buf->link, &jpeg_dev->buffers)) { + buf->vb.vb2_buf.timestamp = ktime_get_ns(); + buf->vb.sequence = jpeg_dev->sequence++; + buf->vb.field = V4L2_FIELD_NONE; + vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE); + list_del(&buf->link); + } + } + + spin_unlock(&jpeg_dev->hw_lock); + /* Disable JPEG engine */ + phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 0); + /* Disable interruption */ + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, STS_VE_JPEG_CODE_COMP_EN, 0); + /* clear all interruption of the hardware's buffers */ + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, INT_JPEG_ENCODE_COMPLETE, 1); + + status &= ~INT_JPEG_COMP_BUF_LIST_NO; + if (test_bit(VIDEO_STREAMING, &jpeg_dev->status) && buf) + phytium_jpeg_start_frame(jpeg_dev); + } + + return IRQ_HANDLED; +} + +/* VIDIOC_STREAMON, all vb2_v4l2_buf' states are queue */ +static int phytium_jpeg_start_streaming(struct vb2_queue *q, unsigned int count) +{ + int ret; + struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); + + jpeg_dev->sequence = 0; + ret = phytium_jpeg_start_frame(jpeg_dev); + if (ret != 0) { + phytium_jpeg_bufs_done(jpeg_dev, VB2_BUF_STATE_QUEUED); + return ret; + } + + /* set the states of the jpeg engine */ + set_bit(VIDEO_STREAMING, &jpeg_dev->status); + return ret; +} + +static void phytium_jpeg_stop_streaming(struct vb2_queue *q) +{ + int ret; + struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); + + clear_bit(VIDEO_STREAMING, &jpeg_dev->status); + ret = wait_event_timeout(jpeg_dev->wait, + !test_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status), + STOP_TIMEOUT); + + /* time out */ + if (ret == 0) { + dev_err(jpeg_dev->dev, "Timed out when stopping streaming.\n"); + /* + * Need to force stop any DMA and try and get HW into a good states + * for future calls to start streaming again. + */ + phytium_jpeg_off(jpeg_dev); + phytium_jpeg_on(jpeg_dev); + phytium_jpeg_init_regs(jpeg_dev); + phytium_jpeg_get_resolution(jpeg_dev); + } + /* first stop jpeg, wait, the free buffer */ + phytium_jpeg_bufs_done(jpeg_dev, VB2_BUF_STATE_ERROR); +} + +static const struct vb2_ops phytium_jpeg_vb2_ops = { + .queue_setup = phytium_jpeg_queue_setup, + .wait_prepare = vb2_ops_wait_prepare, + .wait_finish = vb2_ops_wait_finish, + .buf_prepare = phytium_jpeg_buf_prepare, + .buf_queue = phytium_jpeg_buf_queue, + .start_streaming = phytium_jpeg_start_streaming, + .stop_streaming = phytium_jpeg_stop_streaming, +}; + +static void phytium_jpeg_set_yuv_mode(struct phytium_jpeg_dev *jpeg_dev) +{ + const char *mode = yuv_mode_str; + enum jpeg_yuv_mode yuv_mode; + + if (strstr(mode, "yuv422") != NULL) + yuv_mode = YUV422; + else if (strstr(mode, "yuv420") != NULL) + yuv_mode = YUV420; + else + yuv_mode = YUV444; + + /* set the yuv mode register */ + phytium_jpeg_write(jpeg_dev, SAMPLE_MODE_REG, yuv_mode); + + /* update the field which indicates YUV mode locates in the JPEG header. */ + phytium_jpeg_header[YUVID] &= 0xFFFF00FF; + if (yuv_mode == YUV422) + phytium_jpeg_header[YUVID] |= 0x2100; + else if (yuv_mode == YUV420) + phytium_jpeg_header[YUVID] |= 0x2200; + else + phytium_jpeg_header[YUVID] |= 0x1100; + +} + +static irqreturn_t phytium_jpeg_timer31_irq(int irq, void *arg) +{ + struct phytium_jpeg_dev *jpeg_dev = arg; + + /* disable timer interrupt */ + writel(0, jpeg_dev->timer31_addr); + + /* clear timer interrupt status */ + writel(0x8, jpeg_dev->timer31_addr + 0x2c); + + /* clear JPEG Engine's poweroff status */ + clear_bit(VIDEO_POWEROFF, &jpeg_dev->status); + dev_info(jpeg_dev->dev, "timer31 set jpeg status 0x%lx\n", jpeg_dev->status); + + /* JPEG Engine is poweron, reconfig quntization table and YUV mode */ + phytium_jpeg_init_jpeg_quant(jpeg_dev); + phytium_jpeg_set_yuv_mode(jpeg_dev); + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, DETECT_RESOLUTION_CHANGE_EN); + phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, 0, TRANSINFO_SRC_SELECT); + + dev_info(jpeg_dev->dev, "reconfigure quant table and yuv mode\n"); + + return IRQ_HANDLED; +} + +static int phytium_jpeg_parser_timer31_irq(struct phytium_jpeg_dev *jpeg_dev) +{ + int irq; + int ret; + struct device *dev = jpeg_dev->dev; + + irq = irq_of_parse_and_map(dev->of_node, 2); + if (!irq) { + dev_err(dev, "Failed to get timer31 IRQ\n"); + return -ENODEV; + } + + ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_timer31_irq, + IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); + if (ret < 0) + dev_err(dev, "Failed to request timer31 IRQ %d\n", irq); + + return ret; +} + +static irqreturn_t phytium_jpeg_timer30_irq(int irq, void *arg) +{ + struct phytium_jpeg_dev *jpeg_dev = arg; + struct arm_smccc_res res; + + /* disable timer interrupt */ + writel(0, jpeg_dev->timer30_addr); + /* clear timer interrupt status */ + writel(0x8, jpeg_dev->timer30_addr + 0x2c); + + /* Disable interruption */ + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, STS_VE_JPEG_CODE_COMP_EN, 0); + + /* call SE to poweroff JPEG Engine */ + arm_smccc_smc(0xc300fff4, 0x9, 0x2, 0x80000020, 0, 0, 0, 0, &res); + + /* set JPEG Engine's status is poweroff */ + set_bit(VIDEO_POWEROFF, &jpeg_dev->status); + dev_info(jpeg_dev->dev, "timer30 set jpeg status 0x%lx\n", jpeg_dev->status); + + return IRQ_HANDLED; +} + +static int phytium_jpeg_parser_timer30_irq(struct phytium_jpeg_dev *jpeg_dev) +{ + int irq; + int ret; + struct device *dev = jpeg_dev->dev; + + irq = irq_of_parse_and_map(dev->of_node, 1); + if (!irq) { + dev_err(dev, "Failed to get timer30 IRQ\n"); + return -ENODEV; + } + + ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_timer30_irq, + IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); + if (ret < 0) + dev_err(dev, "Failed to request timer30 IRQ %d\n", irq); + + return ret; +} + +static int phytium_jpeg_init(struct phytium_jpeg_dev *jpeg_dev) +{ + int irq; + int ret; + struct device *dev = jpeg_dev->dev; + u32 ocm_buf_addr[OCM_BUF_NUM]; + int i; + + irq = irq_of_parse_and_map(dev->of_node, 0); + if (!irq) { + dev_err(dev, "Failed to get IRQ\n"); + return -ENODEV; + } + + ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_irq, + IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); + if (ret < 0) { + dev_err(dev, "Failed to request IRQ %d\n", irq); + return ret; + } + + ret = phytium_jpeg_parser_timer30_irq(jpeg_dev); + if (ret < 0) + return ret; + + ret = phytium_jpeg_parser_timer31_irq(jpeg_dev); + if (ret < 0) + return ret; + + ret = of_property_read_u32_array(dev->of_node, "phytium,ocm-buf-addr", + ocm_buf_addr, OCM_BUF_NUM); + if (ret != 0) { + dev_err(dev, "Failed to get the OCM address from device tree node.\n"); + return ret; + } + + for (i = 0; i < OCM_BUF_NUM; i++) + jpeg_dev->src_addrs[i].dma_addr = ocm_buf_addr[i]; + + /* CMA memory for JPEG device */ + of_reserved_mem_device_init(dev); + ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(32)); + if (ret != 0) { + dev_err(dev, "Failed to set DMA mask\n"); + return ret; + } + + /* Initializing JPEG Y and CbCr quantization table */ + phytium_jpeg_init_jpeg_quant(jpeg_dev); + + /* Select YUV mode */ + phytium_jpeg_set_yuv_mode(jpeg_dev); + dev_info(dev, "successfully initialize jpeg engine\n"); + return 0; + +} + + +static int phytium_jpeg_setup_video(struct phytium_jpeg_dev *jpeg_dev) +{ + struct v4l2_device *v4l2_dev = &jpeg_dev->v4l2_dev; + struct vb2_queue *dst_vq = &jpeg_dev->queue; + struct video_device *vdev = &jpeg_dev->vdev; + int ret; + + jpeg_dev->pix_fmt.pixelformat = V4L2_PIX_FMT_JPEG; + jpeg_dev->pix_fmt.field = V4L2_FIELD_NONE; + jpeg_dev->pix_fmt.colorspace = V4L2_COLORSPACE_SRGB; /* maybe ARGB */ + jpeg_dev->pix_fmt.quantization = V4L2_QUANTIZATION_FULL_RANGE; + jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; + + ret = v4l2_device_register(jpeg_dev->dev, v4l2_dev); + if (ret != 0) { + dev_err(jpeg_dev->dev, "Failed to register v4l2 device\n"); + return ret; + } + + /* Register how many v4l2 controls to a handler */ + dst_vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; + dst_vq->io_modes = VB2_MMAP | VB2_READ | VB2_DMABUF; + dst_vq->dev = v4l2_dev->dev; + dst_vq->lock = &jpeg_dev->video_lock; + dst_vq->ops = &phytium_jpeg_vb2_ops; + dst_vq->mem_ops = &vb2_dma_contig_memops; + dst_vq->drv_priv = jpeg_dev; + dst_vq->buf_struct_size = sizeof(struct phytium_jpeg_buffer); + dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; + dst_vq->min_buffers_needed = CAPTURE_BUF_NUMBER; + ret = vb2_queue_init(dst_vq); + if (ret) { + dev_err(jpeg_dev->dev, "Failed to init vb2 queue\n"); + goto err_v4l2_register; + } + + vdev->queue = dst_vq; + vdev->fops = &phytium_jpeg_fops; + vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE | + V4L2_CAP_STREAMING; + vdev->v4l2_dev = v4l2_dev; + strscpy(vdev->name, PHYTIUM_JPEG_NAME, sizeof(vdev->name)); + vdev->vfl_type = VFL_TYPE_VIDEO; + vdev->vfl_dir = VFL_DIR_RX; + vdev->release = video_device_release_empty; + vdev->ioctl_ops = &phytium_jpeg_ioctl_ops; + vdev->lock = &jpeg_dev->video_lock; + + video_set_drvdata(vdev, jpeg_dev); + ret = video_register_device(vdev, VFL_TYPE_VIDEO, 0); + if (ret != 0) { + dev_err(jpeg_dev->dev, "Failed to register video device\n"); + goto err_video_register; + } + + v4l2_info(v4l2_dev, "phytium JPEG registered as /dev/video%d (%d, %d)\n", + jpeg_dev->vdev.num, VIDEO_MAJOR, jpeg_dev->vdev.minor); + return ret; + +err_video_register: + vb2_queue_release(dst_vq); + +err_v4l2_register: + v4l2_device_unregister(v4l2_dev); + return ret; +} + +static const struct phytium_jpeg_config phytium_jpeg_config = { + .comp_size_read = BUF_LIST_INDEX_CTRL_STS_ADDR(VB_BUF_NO), +}; + +static const struct of_device_id phytium_jpeg_match[] = { + { + .compatible = "phytium,jpeg", + .data = &phytium_jpeg_config, + }, + {}, +}; + +MODULE_DEVICE_TABLE(of, phytium_jpeg_match); + +static int phytium_jpeg_probe(struct platform_device *pdev) +{ + struct phytium_jpeg_dev *jpeg_dev; + const struct of_device_id *match; + const struct phytium_jpeg_config *config; + struct resource *res; + int ret; + + jpeg_dev = devm_kzalloc(&pdev->dev, sizeof(*jpeg_dev), GFP_KERNEL); + if (jpeg_dev == NULL) + return -ENOMEM; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + jpeg_dev->base_addr = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(jpeg_dev->base_addr)) { + dev_err(jpeg_dev->dev, "Failed to ioremap.\n"); + return PTR_ERR(jpeg_dev->base_addr); + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 1); + jpeg_dev->timer30_addr = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(jpeg_dev->base_addr)) { + dev_err(jpeg_dev->dev, "Failed to parse timer30.\n"); + return PTR_ERR(jpeg_dev->timer30_addr); + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 2); + jpeg_dev->timer31_addr = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(jpeg_dev->base_addr)) { + dev_err(jpeg_dev->dev, "Failed to parse timer30.\n"); + return PTR_ERR(jpeg_dev->timer31_addr); + } + match = of_match_node(phytium_jpeg_match, pdev->dev.of_node); + if (match == NULL) { + dev_err(jpeg_dev->dev, "Failed to match.\n"); + return -EINVAL; + } + + config = match->data; + jpeg_dev->comp_size_read = config->comp_size_read; + + jpeg_dev->frame_rate = 30; + jpeg_dev->dev = &pdev->dev; + spin_lock_init(&jpeg_dev->hw_lock); + mutex_init(&jpeg_dev->video_lock); + init_waitqueue_head(&jpeg_dev->wait); + INIT_DELAYED_WORK(&jpeg_dev->res_work, phytium_jpeg_resolution_work); + INIT_LIST_HEAD(&jpeg_dev->buffers); + + ret = phytium_jpeg_init(jpeg_dev); + if (ret != 0) { + dev_err(jpeg_dev->dev, "Failed to initialize the JPEG engine.\n"); + return ret; + } + + ret = phytium_jpeg_setup_video(jpeg_dev); + + return ret; +} + +#define to_phytium_jpeg(x) container_of((x), struct phytium_jpeg_dev, v4l2_dev) +static int phytium_jpeg_remove(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct v4l2_device *v4l2_dev = dev_get_drvdata(dev); + struct phytium_jpeg_dev *jpeg_dev = to_phytium_jpeg(v4l2_dev); + + phytium_jpeg_off(jpeg_dev); + + video_unregister_device(&jpeg_dev->vdev); + + vb2_queue_release(&jpeg_dev->queue); + + v4l2_device_unregister(v4l2_dev); + + of_reserved_mem_device_release(dev); + + return 0; +} + +static struct platform_driver phytium_jpeg_driver = { + .probe = phytium_jpeg_probe, + .remove = phytium_jpeg_remove, + .driver = { + .name = PHYTIUM_JPEG_NAME, + .of_match_table = phytium_jpeg_match, + }, +}; + +module_platform_driver(phytium_jpeg_driver); + +MODULE_DESCRIPTION("Phytium JPEG Encoder driver"); +MODULE_AUTHOR("Wang Min "); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.h new file mode 100644 index 0000000000000000000000000000000000000000..27e32b2d3c435cc9c77250c1fbc36200cd2d5fa1 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/phytium_jpeg_core.h @@ -0,0 +1,147 @@ +/* SPDX-License-Identifier: GPL-2.0-or-later */ +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _PHYTIUM_JPEG_CORE_H +#define _PHYTIUM_JPEG_CORE_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 + +#define PHYTIUM_JPEG_NAME "phytium-jpeg" +#define MAX_FRAME_RATE 60 +#define MAX_HEIGHT 1080 +#define MAX_WIDTH 1920 +#define MIN_HEIGHT 480 +#define MIN_WIDTH 640 +#define MIN_PIXEL_CLOCK (640 * 480 * 60) /* 640 x 480 x 60Hz */ +#define MAX_PIXEL_CLOCK (1920 * 1080 * 60) /* 1920 x 1080 x 60Hz */ + +#define SOURCE_RESOLUTION_DETECT_TIMEOUT msecs_to_jiffies(500) +#define RESOLUTION_CHANGE_DELAY msecs_to_jiffies(0) +#define INVALID_RESOLUTION_DELAY msecs_to_jiffies(250) +#define STOP_TIMEOUT msecs_to_jiffies(1000) + +#define INVALID_RESOLUTION_RETRIES 2 +#define CAPTURE_BUF_NUMBER 3 /* using how many buffers */ +#define VB_BUF_NO 0 /* there are 16 buffer, use which one */ + +/* The below macros are defined for the JPEG header of the phytium JPEG Engine */ +#define PHYTIUM_JPEG_HEADER_LEN (256 * 3) +#define PHYTIUM_JPEG_HEADER_SIZE (PHYTIUM_JPEG_HEADER_LEN / sizeof(u32)) +#define PHYTIUM_JPEG_HEADER_H_INDEX 40 +#define PHYTIUM_JPEG_HEADER_W_INDEX 41 + +/* There are two ocm buffers that are used for storaging the inputing video data */ +#define OCM_BUF_NUM 2 + +enum phytium_jpeg_status { + VIDEO_MODE_DETECT_DONE, + VIDEO_RES_CHANGE, + VIDEO_RES_DETECT, + VIDEO_STREAMING, + VIDEO_FRAME_INPRG, + VIDEO_STOPPED, + VIDEO_CLOCKS_ON, + VIDEO_POWEROFF, +}; + +struct phytium_jpeg_addr { + unsigned int size; + dma_addr_t dma_addr; + void *virt_addr; +}; + +struct phytium_jpeg_buffer { + struct vb2_v4l2_buffer vb; + struct list_head link; +}; + +/** + * struct phytium_jpeg - JPEG IP abstraction + * @lock: the mutex protecting this structure + * @hw_lock: spinlock protecting the hw device resource + * @workqueue: decode work queue + * @dev: JPEG device + * @v4l2_dev: v4l2 device for mem2mem mode + * @m2m_dev: v4l2 mem2mem device data + * @alloc_ctx: videobuf2 memory allocator's context + * @dec_vdev: video device node for decoder mem2mem mode + * @dec_reg_base: JPEG registers mapping + * @clk_jdec: JPEG hw working clock + * @clk_jdec_smi: JPEG SMI bus clock + * @larb: SMI device + */ +struct phytium_jpeg_dev { + void __iomem *base_addr; + struct device *dev; + struct v4l2_device v4l2_dev; + struct v4l2_pix_format pix_fmt; + struct v4l2_bt_timings active_timings; + struct v4l2_bt_timings detected_timings; + u32 v4l2_input_status; + struct vb2_queue queue; + struct video_device vdev; + /* v4l2 and videobuf2 lock, protect the structure*/ + struct mutex video_lock; + u32 jpeg_mode; + u32 comp_size_read; + wait_queue_head_t wait; + /* buffer list lock, protecting the hw device resource */ + spinlock_t hw_lock; + struct delayed_work res_work; + struct list_head buffers; + unsigned long status; + unsigned int sequence; + unsigned int max_compressed_size; + struct phytium_jpeg_addr src_addrs[OCM_BUF_NUM]; + struct phytium_jpeg_addr dst_addrs[16]; + + bool yuv420; + unsigned int frame_rate; + void __iomem *timer30_addr; + void __iomem *timer31_addr; +}; + +struct phytium_jpeg_config { + u32 jpeg_mode; + u32 comp_size_read; +}; + +#define YUV_MODE_STR_LEN 8 +#define YUVID 42 + +enum jpeg_yuv_mode { + YUV444 = 0x0, + YUV422 = 0x1, + YUV420 = 0x2 +}; + +#endif /* _PHYTIUM_JPEG_CORE_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/phytium_jpeg_reg.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/phytium_jpeg_reg.h new file mode 100644 index 0000000000000000000000000000000000000000..b0a27e2b7e89b027d1293daa024fa7f13f748f5c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/media/platform/phytium-jpeg/phytium_jpeg_reg.h @@ -0,0 +1,113 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _PHYTIUM_JPEG_REG_H +#define _PHYTIUM_JPEG_REG_H + +#include +/* define the all kinds of control registers in a JPEG soc */ + +/* The register is used to set the information of the video comes from main memory */ +#define SRC_DDR_INFO_REG 0x00000800 + +/* The register is used to get the information of the video comes from external VGA */ +#define SRC_VGA_INFO_REG 0x00000894 + +#define SRC_FORMAT BIT(0) /* 0:RGB888, 1:RGB565 */ +#define SRC_DE_POLARITY BIT(1) /* 0:low level is effect, other */ +#define SRC_HS_POLARITY BIT(2) /* 0:low level is effect, other */ +#define SRC_VS_POLARITY BIT(3) /* 0:low level is effect, other */ +#define SRC_HOR_PIXELS GENMASK(15, 4) /* the number of the horizontal pixels */ +#define SRC_WIDTH_SHIFT 4 /* shift right to get width */ +#define SRC_VER_PIXELS GENMASK(26, 16) /* the number of the vertical pixels */ +#define SRC_HEIGHT_SHIFT 16 /* shift right to get height */ +/* The below bit fields is only used by image comes from main memory */ +#define SRC_COMP_DDR_IMG_EN BIT(27) /* 0: disable to JPEG compression, others */ + +/* marks which ocm buffer is occupied to store an image */ +#define SRC_DDR_IMG2OCM_VALID GENMASK(29, 28) + +/* The register controls starting work of the JPEG engine */ +#define TRANSFORM_INFO_REG 0x00000804 +#define TRANSINFO_ENABLE_ENGINE BIT(0) /* 1: enable the JPEG engine */ +/* 1: video comes from external VGA, 0: video comes from DDR */ +#define TRANSINFO_SRC_SELECT BIT(1) +/* 0: video comes from external VGA is cached to OCM, 1: DDR */ +#define TRANSINFO_IMAGE_STORE BIT(2) +#define TRANSINFO_FRAME_RATE GENMASK(9, 4) /* the value notes frame rate */ +#define TRANSINFO_BLOCK_SIZE BIT(12) /* 0: 8x8, 1: 16x16 */ +#define TRANSINFO_ENABLE_YUV422 BIT(13) /* 1: JPEG block is populated YUV422 */ +/* support burst with the values such as 1, 2, 4, 8, 16, 32, 64. using default value 0xf */ +#define TRANSINFO_AXI_LEN GENMASK(22, 16) +#define TRANS_AXI_LEN_SHIFT 16 + +/* The interrupt and status register */ +#define INT_STATUS_CTRL_REG 0x00000808 +#define INT_FIFO_OVERFLOW BIT(0) /* video fifo overflow, write 1 to clear */ +#define INT_OCM_BUF_OVERFLOW BIT(1) /* ocm buffer overflow, write 1 to clear */ +/* JPEG engine complete compression, write 1 to clear */ +#define INT_JPEG_ENCODE_COMPLETE BIT(2) +/* in VGA mode, video's format is changed */ +#define INT_VIDEO_FORMAT_CHANGE BIT(3) +/* enable the interrupt of th video fifo overflow and source resolution */ +#define DETECT_RESOLUTION_CHANGE_EN BIT(4) +/* enable the interrupt of the ocm buffer overflow */ +#define STS_VE_OCM_BUF_OVERFLOW_EN BIT(5) +/* enable the interrupt of the JPEG complete compression */ +#define STS_VE_JPEG_CODE_COMP_EN BIT(6) +/* in VGA mode, the bit notes ocm buff is busy */ +#define STS_VE_OCM_BUF_BUSY BIT(7) +/* in VGA mode, the bit notes sequence number of the frame */ +#define STS_VE_CUR_FRAME_NUMBER GENMASK(9, 8) +/* in VGA mode, the bit notes sequence number of the cached frame */ +#define STS_VE_BUF_CACHE_NUMBER GENMASK(11, 10) +/* in VGA mode, the buffer number in buffer list */ +#define STS_JPEG_COMP_BUF_NO GENMASK(15, 12) +#define INT_JPEG_COMP_BUF_LIST_NO GENMASK(31, 16) /* the interrupt number of the buffer */ + +#define OCM_BUF0_ADDR 0x0000080C +#define OCM_BUF1_ADDR 0x00000810 +#define OCM_BUF_SHIFT 8 + +#define BUF_LIST_BASE_ADDR 0x00000814 + +#define PHYTIUM_BUF_LIST_ACTRL_AND_STS_BASE_ADDR_REG 0x00000818 +#define STS_JPEG_BUF_HIGH_LEVEL_VALID BIT(0) /* Hight levle is validity */ +#define JPEG_BUF_CAPACITY_SIZE GENMASK(29, 8) /* the capacity of the buffer */ +#define JPEG_BUF_CAPACITY_SIZE_SHIFT 8 + +/* There are 16 buffers in the buffer list, the width between each other' address is 8 bytes */ +#define BUF_LIST_ADDR_OFFSET 0x8 +#define BUF_LIST_CTRL_AND_STS_OFFSET 0x8 + +/* Get the address of the specific index buffer */ +#define BUF_LIST_INDEX_ADDR(index) \ + (BUF_LIST_BASE_ADDR + (index) * BUF_LIST_ADDR_OFFSET) + +#define JPEG_DST_ADDR_SHIFT 8 + +#define BUF_LIST_INDEX_CTRL_STS_ADDR(index) \ + (PHYTIUM_BUF_LIST_ACTRL_AND_STS_BASE_ADDR_REG + (index) * BUF_LIST_CTRL_AND_STS_OFFSET) + +#define FRAME_SAMPLE_CTRL 0x00000898 +#define FRAME_SAMPLE_CTRL_EN BIT(31) +#define FRAME_SAMPLE_INTERVAL GENMASK(30, 0) + +/* The below registers are all related to quantilize */ +#define HUFF_MODE_REG 0x300 +#define SAMPLE_MODE_REG 0x304 + +#define Y_QUANT_BASE_ADDR_REG 0x400 +#define C_QUANT_BASE_ADDR_REG 0x500 + +#define QUANT_REG_NUM 64 + +#define Y_QUANT_INDEX_ADDR_REG(index) \ + (Y_QUANT_BASE_ADDR_REG + 4 * (index)) + +#define C_QUANT_INDEX_ADDR_REG(index) \ + (C_QUANT_BASE_ADDR_REG + 4 * (index)) + +#endif /* _PHYTIUM_JPEG_REG_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..5bd33c533e04b717e99b5ca5c3e9d99a10d347ec --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/Kconfig @@ -0,0 +1,16 @@ +config MFD_PHYTIUM_I2S_LSD + tristate "PHYTIUM px210 I2S LSD MFD driver" + depends on (PCI && ARCH_PHYTIUM) + select MFD_CORE + help + This enables support for the Phytium px210 LSD I2S controller. + +config MFD_PHYTIUM_I2S_MMD + tristate "PHYTIUM px210 I2S MMD MFD driver" + depends on (PCI && ARCH_PHYTIUM) + select MFD_CORE + help + This enables support for the Phytium px210 MMD I2S controllers + for Display Port. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..279f0d88af6bcd2861eff2024aefa7b2f0f9c296 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/Makefile @@ -0,0 +1,3 @@ +obj-$(CONFIG_MFD_PHYTIUM_I2S_LSD) += phytium_px210_i2s_lsd.o +obj-$(CONFIG_MFD_PHYTIUM_I2S_MMD) += phytium_px210_i2s_mmd.o + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/phytium_px210_i2s_lsd.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/phytium_px210_i2s_lsd.c new file mode 100644 index 0000000000000000000000000000000000000000..ad57c59fb44ae38109c574e55edce7eb633abead --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/phytium_px210_i2s_lsd.c @@ -0,0 +1,131 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium I2S LSD MFD driver over PCI bus + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include + +struct phytium_px210_mfd { + struct device *dev; +}; + +struct pdata_px210_mfd { + struct device *dev; + char *name; + int clk_base; +}; + +static struct resource phytium_px210_i2s_res0[] = { + [0] = { + .flags = IORESOURCE_MEM, + }, + [1] = { + .flags = IORESOURCE_MEM, + }, + [2] = { + .flags = IORESOURCE_IRQ, + }, +}; + +static struct mfd_cell phytium_px210_mfd_cells[] = { + { + .id = 0, + .name = "phytium-i2s", + .of_compatible = "phytium,i2s", + .resources = phytium_px210_i2s_res0, + .num_resources = ARRAY_SIZE(phytium_px210_i2s_res0), + .ignore_resource_conflicts = true, + }, +}; + +static void phytium_px210_i2s_setup(struct pci_dev *pdev) +{ + struct mfd_cell *cell = &phytium_px210_mfd_cells[0]; + struct resource *res = (struct resource *)cell->resources; + struct pdata_px210_mfd *pdata; + + res[0].start = pci_resource_start(pdev, 0); + res[0].end = pci_resource_start(pdev, 0) + 0x0fff; + + res[1].start = pci_resource_start(pdev, 0) + 0x1000; + res[1].end = pci_resource_start(pdev, 0) + 0x1fff; + + res[2].start = pdev->irq; + res[2].end = pdev->irq; + + pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); + + pdata->dev = &pdev->dev; + pdata->name = "phytium-i2s-lsd"; + pdata->clk_base = 480000000; + + cell->platform_data = pdata; + cell->pdata_size = sizeof(*pdata); +} + +static int phytium_px210_mfd_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct phytium_px210_mfd *phytium_mfd; + int ret; + + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + pci_set_master(pdev); + + phytium_mfd = devm_kzalloc(&pdev->dev, sizeof(*phytium_mfd), GFP_KERNEL); + if (!phytium_mfd) + return -ENOMEM; + + phytium_mfd->dev = &pdev->dev; + dev_set_drvdata(&pdev->dev, phytium_mfd); + + phytium_px210_i2s_setup(pdev); + + ret = mfd_add_devices(&pdev->dev, 0, phytium_px210_mfd_cells, + ARRAY_SIZE(phytium_px210_mfd_cells), NULL, 0, + NULL); + if (ret) + return 0; + + return 0; +} + + +static void phytium_px210_mfd_remove(struct pci_dev *pdev) +{ + mfd_remove_devices(&pdev->dev); +} + +static const struct pci_device_id phytium_px210_mfd_ids[] = { + { + .vendor = 0x1DB7, + .device = 0xDC2B, + .subvendor = PCI_ANY_ID, + .subdevice = PCI_ANY_ID, + .class = 0x3, + .class_mask = 0, + }, + {}, +}; +MODULE_DEVICE_TABLE(pci, phytium_px210_mfd_ids); + +static struct pci_driver phytium_i2s_lsd_mfd_driver = { + .name = "phytium_px210_mfd_i2s", + .id_table = phytium_px210_mfd_ids, + .probe = phytium_px210_mfd_probe, + .remove = phytium_px210_mfd_remove, +}; + +module_pci_driver(phytium_i2s_lsd_mfd_driver); + +MODULE_AUTHOR("Yiqun Zhang "); +MODULE_DESCRIPTION("Phytium Px210 MFD PCI driver for I2S-LSD"); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/phytium_px210_i2s_mmd.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/phytium_px210_i2s_mmd.c new file mode 100644 index 0000000000000000000000000000000000000000..c225741bbb9ceb59e4dbf2a7135e723b6915862f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mfd/phytium_px210_i2s_mmd.c @@ -0,0 +1,185 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium I2S MMD MFD driver over PCI bus + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include + +struct phytium_px210_mfd { + struct device *dev; +}; + +struct pdata_px210_mfd { + struct device *dev; + char *name; + int clk_base; +}; + +static struct resource phytium_px210_i2s_res0[] = { + [0] = { + .flags = IORESOURCE_MEM, + }, + [1] = { + .flags = IORESOURCE_MEM, + }, + [2] = { + .flags = IORESOURCE_IRQ, + }, +}; + +static struct resource phytium_px210_i2s_res1[] = { + [0] = { + .flags = IORESOURCE_MEM, + }, + [1] = { + .flags = IORESOURCE_MEM, + }, + [2] = { + .flags = IORESOURCE_IRQ, + }, +}; + +static struct resource phytium_px210_i2s_res2[] = { + [0] = { + .flags = IORESOURCE_MEM, + }, + [1] = { + .flags = IORESOURCE_MEM, + }, + [2] = { + .flags = IORESOURCE_IRQ, + }, +}; + +static struct mfd_cell phytium_px210_mfd_cells[] = { + { + .id = 1, + .name = "phytium-i2s", + .of_compatible = "phytium,i2s", + .resources = phytium_px210_i2s_res0, + .num_resources = ARRAY_SIZE(phytium_px210_i2s_res0), + .ignore_resource_conflicts = true, + }, + { + .id = 2, + .name = "phytium-i2s", + .of_compatible = "phytium,i2s", + .resources = phytium_px210_i2s_res1, + .num_resources = ARRAY_SIZE(phytium_px210_i2s_res1), + .ignore_resource_conflicts = true, + }, + { + .id = 3, + .name = "phytium-i2s", + .of_compatible = "phytium,i2s", + .resources = phytium_px210_i2s_res2, + .num_resources = ARRAY_SIZE(phytium_px210_i2s_res2), + .ignore_resource_conflicts = true, + }, +}; + +static void phytium_px210_i2s_setup(struct pci_dev *pdev, int i) +{ + struct mfd_cell *cell = &phytium_px210_mfd_cells[i]; + struct resource *res = (struct resource *)cell->resources; + struct pdata_px210_mfd *pdata; + + res[0].start = pci_resource_start(pdev, 0) + 0x2000 * i + 0x1000; + res[0].end = pci_resource_start(pdev, 0) + 0x2000 * i + 0x1fff; + + res[1].start = pci_resource_start(pdev, 0) + 0x2000 * i; + res[1].end = pci_resource_start(pdev, 0) + 0x2000 * i + 0x0fff; + + res[2].start = pdev->irq; + res[2].end = pdev->irq; + + pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); + + pdata->dev = &pdev->dev; + pdata->clk_base = 600000000; + switch (i) { + case 0: + pdata->name = "phytium-i2s-dp0"; + break; + case 1: + pdata->name = "phytium-i2s-dp1"; + break; + case 2: + pdata->name = "phytium-i2s-dp2"; + break; + default: + break; + } + + cell->platform_data = pdata; + cell->pdata_size = sizeof(*pdata); +} + +static int phytium_px210_mfd_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct phytium_px210_mfd *phytium_mfd; + int i; + int ret; + + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + pci_set_master(pdev); + + phytium_mfd = devm_kzalloc(&pdev->dev, sizeof(*phytium_mfd), GFP_KERNEL); + if (!phytium_mfd) + return -ENOMEM; + + phytium_mfd->dev = &pdev->dev; + dev_set_drvdata(&pdev->dev, phytium_mfd); + + for (i = 0; i < 3; i++) + phytium_px210_i2s_setup(pdev, i); + + ret = mfd_add_devices(&pdev->dev, 0, phytium_px210_mfd_cells, + ARRAY_SIZE(phytium_px210_mfd_cells), NULL, 0, + NULL); + if (ret) + return 0; + + return 0; +} + + +static void phytium_px210_mfd_remove(struct pci_dev *pdev) +{ + mfd_remove_devices(&pdev->dev); +} + +static const struct pci_device_id phytium_px210_mfd_ids[] = { + { + .vendor = 0x1DB7, + .device = 0xDC23, + .subvendor = PCI_ANY_ID, + .subdevice = PCI_ANY_ID, + .class = 0x3, + .class_mask = 0, + }, + {}, +}; +MODULE_DEVICE_TABLE(pci, phytium_px210_mfd_ids); + +static struct pci_driver phytium_i2s_mmd_mfd_driver = { + .name = "phytium_px210_mfd_mmd", + .id_table = phytium_px210_mfd_ids, + .probe = phytium_px210_mfd_probe, + .remove = phytium_px210_mfd_remove, +}; + +module_pci_driver(phytium_i2s_mmd_mfd_driver); + +MODULE_AUTHOR("Yiqun Zhang "); +MODULE_DESCRIPTION("Phytium Px210 MFD PCI driver for I2S-DP"); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..feb25db4d874ef7cc69ed03ba5622168c5719f11 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/Kconfig @@ -0,0 +1,34 @@ +config MMC_PHYTIUM_SDCI + tristate "Phytium SD Host Controller support" + depends on ARCH_PHYTIUM || COMPILE_TEST + default y if ARCH_PHYTIUM + help + This selects support for the SD/MMC Host Controller on + Phytium SoC family. + + If you have a controller with this interface, say Y or M here. + + If unsure, say N. + +config MMC_PHYTIUM_MCI_PCI + tristate "Phytium octopus PCI MultiMedia Card Interface support" + depends on ARCH_PHYTIUM + default y if ARCH_PHYTIUM + help + This selects support for the PCI MultiMedia Card Interface on Phytium + px210 chipset. + + If you have a controller with this interface, say Y or M here. + + If unsure, say N. + +config MMC_PHYTIUM_MCI_PLTFM + tristate "Phytium MultiMedia Card Interface support" + depends on ARCH_PHYTIUM && OF + default y if ARCH_PHYTIUM + help + This selects support for the MultiMedia Card Interface on Phytium SoCs. + If you have a controller with this interface, say Y or M here. + + If unsure, say N. + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..6d8510cf5597387f8174e9c22f056f22d3bbd44a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/Makefile @@ -0,0 +1,3 @@ +obj-$(CONFIG_MMC_PHYTIUM_SDCI) += phytium-sdci.o +obj-$(CONFIG_MMC_PHYTIUM_MCI_PCI) += phytium-mci-pci.o phytium-mci.o +obj-$(CONFIG_MMC_PHYTIUM_MCI_PLTFM) += phytium-mci-plat.o phytium-mci.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci-pci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci-pci.c new file mode 100644 index 0000000000000000000000000000000000000000..bd193bbd0ccd3b5251ae4f1c6db812d8a47356e6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci-pci.c @@ -0,0 +1,175 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Phytium Multimedia Card Interface PCI driver + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + * + */ + +#include +#include +#include +#include +#include +#include +#include "phytium-mci.h" + +static u32 sd_caps = MMC_CAP_SD_HIGHSPEED | MMC_CAP_WAIT_WHILE_BUSY | MMC_CAP_CMD23 | + MMC_CAP_4_BIT_DATA; +static u32 sd_caps2 = MMC_CAP2_NO_MMC; + +static u32 emmc_caps = MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA | MMC_CAP_WAIT_WHILE_BUSY | + MMC_CAP_CMD23 | MMC_CAP_HW_RESET | MMC_CAP_MMC_HIGHSPEED | + MMC_CAP_NONREMOVABLE; +static u32 emmc_caps2 = MMC_CAP2_NO_SDIO | MMC_CAP2_NO_SD; + +#define PCI_BAR_NO 0 + +#if defined CONFIG_PM && defined CONFIG_PM_SLEEP +static const struct dev_pm_ops phytium_mci_dev_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_mci_suspend, + phytium_mci_resume) + SET_RUNTIME_PM_OPS(phytium_mci_runtime_suspend, + phytium_mci_runtime_resume, NULL) +}; +#else +#define phytium_mci_dev_pm_ops NULL +#endif + +static int +phytium_mci_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) +{ + struct phytium_mci_host *host; + struct mmc_host *mmc; + int ret; + + ret = pcim_enable_device(pdev); + + if (ret) + return ret; + pci_set_master(pdev); + + mmc = mmc_alloc_host(sizeof(struct phytium_mci_host), &pdev->dev); + + if (!mmc) + return -ENOMEM; + + host = mmc_priv(mmc); + + pci_enable_msi(pdev); + + host->irq = pdev->irq; + host->irq_flags = IRQF_SHARED; + host->dev = &pdev->dev; + ret = pcim_iomap_regions(pdev, 1 << PCI_BAR_NO, pci_name(pdev)); + + if (ret) { + dev_err(&pdev->dev, "I/O memory remapping failed\n"); + goto host_free; + } + + host->base = pcim_iomap_table(pdev)[PCI_BAR_NO]; + host->is_use_dma = 1; + host->is_device_x100 = 1; + + if (pdev->devfn == 2) { + host->caps = emmc_caps; + host->caps2 = emmc_caps2; + } else { + host->caps = sd_caps; + host->caps2 = sd_caps2; + mmc->f_max = 25000000; /* stable frequency */ + } + + host->mmc = mmc; + host->clk_rate = MCI_CLK; + + dev_info(&pdev->dev, "%s %d: [bar %d] addr: 0x%llx size: 0x%llx km: 0x%llx devfn:%d\n", + __func__, __LINE__, PCI_BAR_NO, pci_resource_start(pdev, 0), + pci_resource_len(pdev, 0), (uint64_t)host->base, pdev->devfn); + + dev_dbg(&pdev->dev, "%s %d:irq:0x%x\n", __func__, __LINE__, host->irq); + + ret = phytium_mci_common_probe(host); + + if (ret == MCI_REALEASE_MEM) { + ret = -ENOMEM; + goto release_mem; + } else if (ret) { + goto release; + } + pci_set_drvdata(pdev, mmc); + dev_info(&pdev->dev, "%s %d: probe phytium mci successful.\n", __func__, __LINE__); + return 0; + +release: + phytium_mci_deinit_hw(host); +release_mem: + + if (host->dma.adma_table) { + dma_free_coherent(&pdev->dev, + MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), + host->dma.adma_table, host->dma.adma_addr); + } +host_free: + mmc_free_host(mmc); + pci_disable_device(pdev); + return ret; +} + +static void phytium_mci_pci_remove(struct pci_dev *pdev) +{ + struct phytium_mci_host *host; + struct mmc_host *mmc; + + mmc = pci_get_drvdata(pdev); + if (!mmc) { + dev_info(&pdev->dev, "%s %d: mmc is null.\n", __func__, __LINE__); + return; + } + host = mmc_priv(mmc); + if (!host) { + dev_info(&pdev->dev, "%s %d: host is null.\n", __func__, __LINE__); + mmc_remove_host(mmc); + mmc_free_host(mmc); + return; + } + + del_timer(&host->hotplug_timer); + + mmc_remove_host(host->mmc); + + if (host->dma.adma_table) { + dma_free_coherent(&pdev->dev, + MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), + host->dma.adma_table, host->dma.adma_addr); + } + phytium_mci_deinit_hw(host); + mmc_free_host(mmc); + pci_set_drvdata(pdev, NULL); +} + +static const struct pci_device_id phytium_mci_pci_tbl[] = { + { + PCI_DEVICE(PCI_VENDOR_ID_PHYTIUM, 0xdc28), + .class = 0x5, + .class_mask = 0, + }, + {} +}; +MODULE_DEVICE_TABLE(pci, phytium_mci_pci_tbl); + +static struct pci_driver phytium_mci_pci_driver = { + .name = "phytium-mci-pci", + .id_table = phytium_mci_pci_tbl, + .probe = phytium_mci_pci_probe, + .remove = phytium_mci_pci_remove, + .driver = { + .pm = &phytium_mci_dev_pm_ops, + } +}; +module_pci_driver(phytium_mci_pci_driver); + +MODULE_DESCRIPTION("Phytium Multimedia Card Interface PCI driver"); +MODULE_LICENSE("GPL v2"); +MODULE_AUTHOR("Cheng Quan "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci-plat.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci-plat.c new file mode 100644 index 0000000000000000000000000000000000000000..c9d6ebff07aa8506a4a01a6fbe32dd9ce2558086 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci-plat.c @@ -0,0 +1,175 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Phytium Multimedia Card Interface PCI driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include "phytium-mci.h" + +static u32 mci_caps = MMC_CAP_CMD23 | MMC_CAP_WAIT_WHILE_BUSY; + +#if defined CONFIG_PM && defined CONFIG_PM_SLEEP + +static const struct dev_pm_ops phytium_mci_dev_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_mci_suspend, + phytium_mci_resume) + SET_RUNTIME_PM_OPS(phytium_mci_runtime_suspend, + phytium_mci_runtime_resume, NULL) +}; +#else +#define phytium_mci_dev_pm_ops NULL +#endif + +static int phytium_mci_probe(struct platform_device *pdev) +{ + struct mmc_host *mmc; + struct phytium_mci_host *host; + struct resource *res; + const struct acpi_device_id *match; + struct device *dev = &pdev->dev; + int ret; + + mmc = mmc_alloc_host(sizeof(struct phytium_mci_host), &pdev->dev); + if (!mmc) + return -ENOMEM; + host = mmc_priv(mmc); + ret = mmc_of_parse(mmc); + if (ret) + goto host_free; + + if (dev->of_node) { + host->src_clk = devm_clk_get(&pdev->dev, "phytium_mci_clk"); + if (IS_ERR(host->src_clk)) { + ret = PTR_ERR(host->src_clk); + goto host_free; + } + + host->clk_rate = clk_get_rate(host->src_clk); + } else if (has_acpi_companion(dev)) { + match = acpi_match_device(dev->driver->acpi_match_table, dev); + if (!match) { + dev_err(dev, "Error ACPI match data is missing\n"); + return -ENODEV; + } + host->clk_rate = 1200000000; + } + + host->is_use_dma = 1; + host->is_device_x100 = 0; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + host->base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(host->base)) { + ret = PTR_ERR(host->base); + goto host_free; + } + + host->irq = platform_get_irq(pdev, 0); + + if (host->irq < 0) { + ret = -EINVAL; + goto host_free; + } + host->irq_flags = IRQF_SHARED; + dev_dbg(&pdev->dev, "%s %d:irq:%d\n", __func__, __LINE__, host->irq); + host->dev = &pdev->dev; + host->caps = mci_caps; + host->mmc = mmc; + ret = phytium_mci_common_probe(host); + if (ret == MCI_REALEASE_MEM) { + ret = -ENOMEM; + goto release_mem; + } else if (ret) { + goto release; + } + platform_set_drvdata(pdev, mmc); + dev_info(&pdev->dev, "%s %d: probe phytium mci successful.\n", __func__, __LINE__); + return 0; + +release: + phytium_mci_deinit_hw(host); +release_mem: + if (host->dma.adma_table) { + dma_free_coherent(&pdev->dev, + MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), + host->dma.adma_table, host->dma.adma_addr); + } +host_free: + mmc_free_host(mmc); + return ret; +} + +static int phytium_mci_remove(struct platform_device *pdev) +{ + struct mmc_host *mmc; + struct phytium_mci_host *host; + + mmc = platform_get_drvdata(pdev); + if (!mmc) { + dev_info(&pdev->dev, "%s %d: mmc is null.\n", __func__, __LINE__); + return -1; + } + host = mmc_priv(mmc); + if (!host) { + dev_info(&pdev->dev, "%s %d: host is null.\n", __func__, __LINE__); + mmc_remove_host(mmc); + mmc_free_host(mmc); + return -1; + } + del_timer(&host->hotplug_timer); + del_timer_sync(&host->timeout_timer); + mmc_remove_host(host->mmc); + + if (host->dma.adma_table) { + dma_free_coherent(&pdev->dev, + MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), + host->dma.adma_table, host->dma.adma_addr); + } + phytium_mci_deinit_hw(host); + mmc_free_host(mmc); + platform_set_drvdata(pdev, NULL); + return 0; +} + +static const struct of_device_id phytium_mci_of_ids[] = { + { .compatible = "phytium,mci", }, + {} +}; + +MODULE_DEVICE_TABLE(of, phytium_mci_of_ids); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_mci_acpi_ids[] = { + { .id = "PHYT0017" }, + { } +}; + +MODULE_DEVICE_TABLE(acpi, phytium_mci_acpi_ids); +#else +#define phytium_mci_acpi_ids NULL +#endif + +static struct platform_driver phytium_mci_driver = { + .probe = phytium_mci_probe, + .remove = phytium_mci_remove, + .driver = { + .name = "phytium-mci-platform", + .of_match_table = phytium_mci_of_ids, + .acpi_match_table = phytium_mci_acpi_ids, + .pm = &phytium_mci_dev_pm_ops, + }, +}; + +module_platform_driver(phytium_mci_driver); + +MODULE_DESCRIPTION("Phytium Multimedia Card Interface driver"); +MODULE_LICENSE("GPL v2"); +MODULE_AUTHOR("Cheng Quan "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci.c new file mode 100644 index 0000000000000000000000000000000000000000..1ecbd99947e9bc8c1e7a919b6f00f1eb398d8b3f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci.c @@ -0,0 +1,1563 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Driver for Phytium Multimedia Card Interface + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#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 "phytium-mci.h" + +static const u32 cmd_ints_mask = MCI_INT_MASK_RE | MCI_INT_MASK_CMD | MCI_INT_MASK_RCRC | + MCI_INT_MASK_RTO | MCI_INT_MASK_HTO | MCI_RAW_INTS_HLE; + +static const u32 data_ints_mask = MCI_INT_MASK_DTO | MCI_INT_MASK_DCRC | MCI_INT_MASK_DRTO | + MCI_INT_MASK_SBE_BCI; +static const u32 cmd_err_ints_mask = MCI_INT_MASK_RTO | MCI_INT_MASK_RCRC | MCI_INT_MASK_RE | + MCI_INT_MASK_DCRC | MCI_INT_MASK_DRTO | + MCI_MASKED_INTS_SBE_BCI; + +static const u32 dmac_ints_mask = MCI_DMAC_INT_ENA_FBE | MCI_DMAC_INT_ENA_DU | + MCI_DMAC_INT_ENA_NIS | MCI_DMAC_INT_ENA_AIS; +static const u32 dmac_err_ints_mask = MCI_DMAC_INT_ENA_FBE | MCI_DMAC_INT_ENA_DU | + MCI_DMAC_INT_ENA_AIS; + +static void phytium_mci_cmd_next(struct phytium_mci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd); +static void phytium_mci_adma_reset(struct phytium_mci_host *host); +static void phytium_mci_send_cmd(struct phytium_mci_host *host, u32 cmd, u32 arg); +static bool phytium_mci_data_xfer_done(struct phytium_mci_host *host, u32 events, + struct mmc_request *mrq, struct mmc_data *data); +static void phytium_mci_init_adma_table(struct phytium_mci_host *host, + struct phytium_mci_dma *dma); +static void phytium_mci_init_hw(struct phytium_mci_host *host); +static int phytium_mci_get_cd(struct mmc_host *mmc); +static int phytium_mci_err_irq(struct phytium_mci_host *host, u32 dmac_events, u32 events); + +static void sdr_set_bits(void __iomem *reg, u32 bs) +{ + u32 val = readl(reg); + + val |= bs; + writel(val, reg); +} + +static void sdr_clr_bits(void __iomem *reg, u32 bs) +{ + u32 val = readl(reg); + + val &= ~bs; + writel(val, reg); +} + +static void phytium_mci_reset_hw(struct phytium_mci_host *host) +{ + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET); + + while (readl(host->base + MCI_CNTRL) & (MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET)) + cpu_relax(); + phytium_mci_send_cmd(host, MCI_CMD_UPD_CLK, 0); +} + +static void phytium_mci_update_external_clk(struct phytium_mci_host *host, u32 uhs_reg_value) +{ + writel(0, host->base + MCI_UHS_REG_EXT); + writel(uhs_reg_value, host->base + MCI_UHS_REG_EXT); + while (!(readl(host->base + MCI_CCLK_RDY) & 0x1)) + cpu_relax(); +} + +static void phytium_mci_prepare_data(struct phytium_mci_host *host, + struct mmc_request *mrq) +{ + struct mmc_data *data = mrq->data; + + if (!(data->host_cookie & MCI_PREPARE_FLAG)) { + data->host_cookie |= MCI_PREPARE_FLAG; + data->sg_count = dma_map_sg(host->dev, data->sg, data->sg_len, + mmc_get_dma_dir(data)); + } +} + +static void phytium_mci_unprepare_data(struct phytium_mci_host *host, + struct mmc_request *mrq) +{ + struct mmc_data *data = mrq->data; + + if (data->host_cookie & MCI_ASYNC_FLAG) + return; + + if (data->host_cookie & MCI_PREPARE_FLAG) { + dma_unmap_sg(host->dev, data->sg, data->sg_len, mmc_get_dma_dir(data)); + data->host_cookie &= ~MCI_PREPARE_FLAG; + } +} + +static void phytium_mci_send_cmd(struct phytium_mci_host *host, u32 cmd, u32 arg) +{ + int rc; + u32 data; + + writel(arg, host->base + MCI_CMDARG); + wmb(); /* drain writebuffer */ + + rc = readl_relaxed_poll_timeout(host->base + MCI_STATUS, + data, + !(data & MCI_STATUS_CARD_BUSY), + 0, 100 * 1000); + if (rc == -ETIMEDOUT) + pr_debug("%s %d, timeout mci_status: 0x%08x\n", __func__, __LINE__, data); + + writel(MCI_CMD_START | cmd, host->base + MCI_CMD); + + rc = readl_relaxed_poll_timeout(host->base + MCI_CMD, + data, + !(data & MCI_CMD_START), + 0, 100 * 1000); + if (rc == -ETIMEDOUT) + pr_debug("%s %d, timeout mci_cmd: 0x%08x\n", __func__, __LINE__, data); +} + +static void phytium_mci_update_cmd11(struct phytium_mci_host *host, u32 cmd) +{ + writel(MCI_CMD_START | cmd, host->base + MCI_CMD); + + while (readl(host->base + MCI_CMD) & MCI_CMD_START) + cpu_relax(); +} + +static void phytium_mci_set_clk(struct phytium_mci_host *host, struct mmc_ios *ios) +{ + u32 div = 0xff, drv = 0, sample = 0; + unsigned long clk_rate; + u32 mci_cmd_bits = MCI_CMD_UPD_CLK; + u32 cmd_reg; + u32 cur_cmd_index; + u32 first_uhs_div, tmp_ext_reg; + + cmd_reg = readl(host->base + MCI_CMD); + cur_cmd_index = cmd_reg & 0x3F; + + if (cur_cmd_index == SD_SWITCH_VOLTAGE) + mci_cmd_bits |= MCI_CMD_VOLT_SWITCH; + if (ios->clock) { + if (host->current_ios_clk == ios->clock) + return; + + dev_dbg(host->dev, "will change clock, host->clk_rate: %ld, ios->clock: %d\n", + host->clk_rate, ios->clock); + + if (ios->clock >= 25000000) + tmp_ext_reg = 0x202; + else if (ios->clock == 400000) + tmp_ext_reg = 0x502; + else + tmp_ext_reg = 0x302; + + phytium_mci_update_external_clk(host, tmp_ext_reg); + sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + + if (cur_cmd_index == SD_SWITCH_VOLTAGE) + phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); + else + phytium_mci_send_cmd(host, mci_cmd_bits, 0); + + clk_rate = host->clk_rate; + first_uhs_div = 1 + ((tmp_ext_reg >> 8)&0xFF); + div = clk_rate / (2 * first_uhs_div * ios->clock); + if (div > 2) { + sample = div / 2 + 1; + drv = sample - 1; + writel((sample << 16) | (drv << 8) | (div & 0xff), + host->base + MCI_CLKDIV); + } else if (div == 2) { + drv = 0; + sample = 1; + writel((drv << 8) | (sample << 16) | (div & 0xff), + host->base + MCI_CLKDIV); + } + + dev_dbg(host->dev, "UHS_REG_EXT ext: %x, CLKDIV: %x\n", + readl(host->base + MCI_UHS_REG_EXT), readl(host->base + MCI_CLKDIV)); + + sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + + if (cur_cmd_index == SD_SWITCH_VOLTAGE) + phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); + else + phytium_mci_send_cmd(host, mci_cmd_bits, 0); + + host->current_ios_clk = ios->clock; + + dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", + host->clk_rate, ios->clock); + } else { + host->current_ios_clk = 0; + sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + + if (cur_cmd_index == SD_SWITCH_VOLTAGE) + phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); + else + phytium_mci_send_cmd(host, mci_cmd_bits, 0); + + sdr_clr_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); + dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", + host->clk_rate, ios->clock); + } +} + +static inline u32 +phytium_mci_cmd_find_resp(struct phytium_mci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + u32 resp; + + switch (mmc_resp_type(cmd)) { + case MMC_RSP_R1: + case MMC_RSP_R1B: + resp = 0x5; + break; + + case MMC_RSP_R2: + resp = 0x7; + break; + + case MMC_RSP_R3: + resp = 0x1; + break; + + case MMC_RSP_NONE: + default: + resp = 0x0; + break; + } + + return resp; +} + +static inline +u32 phytium_mci_cmd_prepare_raw_cmd(struct phytium_mci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + u32 opcode = cmd->opcode; + u32 resp = phytium_mci_cmd_find_resp(host, mrq, cmd); + u32 rawcmd = ((opcode & 0x3f) | ((resp & 0x7) << 6)); + + if (opcode == MMC_GO_INACTIVE_STATE || + (opcode == SD_IO_RW_DIRECT && ((cmd->arg >> 9) & 0x1FFFF) == SDIO_CCCR_ABORT)) + rawcmd |= (0x1 << 14); + else if (opcode == SD_SWITCH_VOLTAGE) + rawcmd |= (0x1 << 28); + + if (test_and_clear_bit(MCI_CARD_NEED_INIT, &host->flags)) + rawcmd |= (0x1 << 15); + + if (cmd->data) { + struct mmc_data *data = cmd->data; + + rawcmd |= (0x1 << 9); + + if (data->flags & MMC_DATA_WRITE) + rawcmd |= (0x1 << 10); + } + + return (rawcmd | (0x1 << 29) | (0x1 << 31)); +} + +static inline void +phytium_mci_adma_write_desc(struct phytium_mci_host *host, + struct phytium_adma2_64_desc *desc, + dma_addr_t addr, u32 len, u32 attribute) +{ + desc->attribute = attribute; + desc->len = len; + desc->addr_lo = lower_32_bits(addr); + desc->addr_hi = upper_32_bits(addr); + dev_dbg(host->dev, "%s %d:addr_lo:0x%x ddr_hi:0x%x\n", __func__, + __LINE__, desc->addr_lo, desc->addr_hi); + + if ((attribute == 0x80000004) || (attribute == 0x8000000c)) { + desc->desc_lo = 0; + desc->desc_hi = 0; + } +} + +static void +phytium_mci_data_sg_write_2_admc_table(struct phytium_mci_host *host, struct mmc_data *data) +{ + struct phytium_adma2_64_desc *desc; + u32 dma_len, i; + dma_addr_t dma_address; + struct scatterlist *sg; + + phytium_mci_init_adma_table(host, &host->dma); + + desc = host->dma.adma_table; + for_each_sg(data->sg, sg, data->sg_count, i) { + dma_address = sg_dma_address(sg); + dma_len = sg_dma_len(sg); + + if (i == 0) { + if (sg_is_last(sg) || (data->sg_count == 1 && dma_len == SD_BLOCK_SIZE)) + phytium_mci_adma_write_desc(host, desc, dma_address, + dma_len, 0x8000000c); + else + phytium_mci_adma_write_desc(host, desc, dma_address, + dma_len, 0x8000001a); + } else if (sg_is_last(sg)) { + phytium_mci_adma_write_desc(host, desc, dma_address, + dma_len, 0x80000004); + } else { + phytium_mci_adma_write_desc(host, desc, dma_address, + dma_len, 0x80000012); + } + + desc++; + } +} + +static void +phytium_mci_data_sg_write_2_fifo(struct phytium_mci_host *host, struct mmc_data *data) +{ + struct scatterlist *sg; + u32 dma_len, i, j; + u32 *virt_addr; + + if (mmc_get_dma_dir(data) == DMA_TO_DEVICE) { + writel(0x1<<10, host->base + MCI_CMD); + for_each_sg(data->sg, sg, data->sg_count, i) { + dma_len = sg_dma_len(sg); + virt_addr = sg_virt(data->sg); + for (j = 0; j < (dma_len / 4); j++) { + writel(*virt_addr, host->base + MCI_DATA); + virt_addr++; + } + } + } +} + +static void phytium_mci_restart_clk(struct phytium_mci_host *host) +{ + u32 clk_div, uhs; + + while (readl(host->base + MCI_CMD) & MCI_CMD_START) + cpu_relax(); + sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + clk_div = readl(host->base + MCI_CLKDIV); + uhs = readl(host->base + MCI_UHS_REG_EXT); + writel(0, host->base + MCI_UHS_REG_EXT); + writel(uhs, host->base + MCI_UHS_REG_EXT); + while (!(readl(host->base + MCI_CCLK_RDY) & 0x1)) + cpu_relax(); + + writel(clk_div, host->base + MCI_CLKDIV); + sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + writel(MCI_CMD_START | MCI_CMD_UPD_CLK, host->base + MCI_CMD); + while (readl(host->base + MCI_CMD) & MCI_CMD_START) + cpu_relax(); +} + +static int +phytim_mci_start_multiple_write(struct phytium_mci_host *host, + struct mmc_request *mrq, u32 cnts, u32 offset) +{ + u32 rawcmd, cmd_status; + struct mmc_command *cmd = mrq->cmd; + u32 *rsp = cmd->resp; + unsigned long deadline_time; + + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) + return -ESHUTDOWN; + + while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) + cpu_relax(); + + writel(0xffffe, host->base + MCI_RAW_INTS); + rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); + writel(mrq->data->blksz, host->base + MCI_BLKSIZ); + writel(cnts * mrq->data->blksz, host->base + MCI_BYTCNT); + writel(cmd->arg + offset, host->base + MCI_CMDARG); + writel(rawcmd, host->base + MCI_CMD); + deadline_time = jiffies + msecs_to_jiffies(200); + + cmd_status = readl(host->base + MCI_RAW_INTS); + while (!(cmd_status & MCI_MASKED_INTS_CMD)) { + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && + readl(host->base + MCI_CARD_DETECT)) + return -ESHUTDOWN; + + cmd_status = readl(host->base + MCI_RAW_INTS); + if (cmd_err_ints_mask & cmd_status) + return -ESHUTDOWN; + + if (cmd_status & MCI_MASKED_INTS_CMD) + break; + + if (time_after(jiffies, deadline_time)) + return -ESHUTDOWN; + } + + if (cmd_status & MCI_MASKED_INTS_CMD) { + if (cmd->flags & MMC_RSP_136) { + rsp[3] = readl(host->base + MCI_RESP0); + rsp[2] = readl(host->base + MCI_RESP1); + rsp[1] = readl(host->base + MCI_RESP2); + rsp[0] = readl(host->base + MCI_RESP3); + } else { + rsp[0] = readl(host->base + MCI_RESP0); + } + } + deadline_time = jiffies + msecs_to_jiffies(1000); + while (!(cmd_status & MCI_MASKED_INTS_DTO)) { + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && + readl(host->base + MCI_CARD_DETECT)) + return -ESHUTDOWN; + cmd_status = readl(host->base + MCI_RAW_INTS); + if (cmd_err_ints_mask & cmd_status) + return -ESHUTDOWN; + if (cmd_status & MCI_MASKED_INTS_DTO) + return 0; + if (time_after(jiffies, deadline_time)) + return -ESHUTDOWN; + } + return 0; +} + +static int +phytium_mci_start_sbc_stop_cmd(struct phytium_mci_host *host, struct mmc_request *mrq, + struct mmc_command *cmd, u32 arg) +{ + u32 rawcmd, cmd_status; + u32 *rsp = cmd->resp; + unsigned long deadline_time; + + writel(0xffffe, host->base + MCI_RAW_INTS); + + while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) + cpu_relax(); + + rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); + writel(arg, host->base + MCI_CMDARG); + writel(rawcmd, host->base + MCI_CMD); + + deadline_time = jiffies + msecs_to_jiffies(200); + cmd_status = readl(host->base + MCI_RAW_INTS); + while (!(cmd_status & MCI_MASKED_INTS_CMD)) { + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && + readl(host->base + MCI_CARD_DETECT)) + return -ENOMEDIUM; + + cmd_status = readl(host->base + MCI_RAW_INTS); + if (cmd_err_ints_mask & cmd_status) + return -ETIMEDOUT; + + if (cmd_status & MCI_MASKED_INTS_CMD) + break; + + if (time_after(jiffies, deadline_time)) + return -ETIMEDOUT; + } + + if (cmd_status & MCI_MASKED_INTS_CMD) { + if (cmd->flags & MMC_RSP_136) { + rsp[3] = readl(host->base + MCI_RESP0); + rsp[2] = readl(host->base + MCI_RESP1); + rsp[1] = readl(host->base + MCI_RESP2); + rsp[0] = readl(host->base + MCI_RESP3); + } else { + rsp[0] = readl(host->base + MCI_RESP0); + } + } + + if (cmd_err_ints_mask & cmd_status) + return -ETIMEDOUT; + + return 0; +} + +static void +phytium_mci_start_write_multiple_non_dma(struct mmc_host *mmc, struct mmc_request *mrq) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + struct mmc_data *data = mrq->data; + u32 write_cnts, last_cnts; + u32 i, j, k, send_cnt_one_sg, block_offset; + int ret = 0, dma_len; + struct scatterlist *sg; + u32 *virt_addr = NULL; + + write_cnts = data->blocks / 4; + (data->blocks % 4) ? write_cnts++ : write_cnts; + last_cnts = data->blocks % 4; + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { + ret = -ENOMEDIUM; + goto write_err; + } + + dev_dbg(host->dev, "%s: cmd:%d, block counts:%d\n", + __func__, mrq->cmd->opcode, data->blocks); + + sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET); + while (readl(host->base + MCI_CNTRL) & MCI_CNTRL_FIFO_RESET) + cpu_relax(); + sdr_clr_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); + + if (mmc_get_dma_dir(data) == DMA_TO_DEVICE) { + block_offset = 0; + for_each_sg(data->sg, sg, data->sg_count, i) { + /* Each SG data transfor starts */ + dma_len = sg_dma_len(sg); + send_cnt_one_sg = (dma_len / MCI_MAX_FIFO_CNT) + 1; + virt_addr = sg_virt(sg); + for (k = 0; k < send_cnt_one_sg; k++) { + if (dma_len && dma_len >= MCI_MAX_FIFO_CNT) { + /*first write sbc cmd*/ + ret = phytium_mci_start_sbc_stop_cmd(host, mrq, + mrq->sbc, 4); + if (ret) + goto write_err; + writel(0x1 << 10, host->base + MCI_CMD); + for (j = 0; j < (MCI_MAX_FIFO_CNT / 4); j++) { + writel(*virt_addr, host->base + MCI_DATA); + virt_addr++; + } + + /*second write cmd25 here*/ + ret = phytim_mci_start_multiple_write(host, mrq, 4, + block_offset); + if (ret) + goto write_err; + block_offset += 4; + dma_len -= MCI_MAX_FIFO_CNT; + } else if (dma_len > 0) { + /*first write sbc cmd*/ + last_cnts = dma_len / 512; + ret = phytium_mci_start_sbc_stop_cmd(host, mrq, mrq->sbc, + last_cnts); + if (ret) + goto write_err; + writel(0x1 << 10, host->base + MCI_CMD); + for (j = 0; j < (dma_len / 4); j++) { + writel(*virt_addr, host->base + MCI_DATA); + virt_addr++; + } + /*second write cmd25 here*/ + ret = phytim_mci_start_multiple_write(host, mrq, last_cnts, + block_offset); + if (ret) + goto write_err; + block_offset += last_cnts; + dma_len = 0; + } else { + dev_dbg(host->dev, "%s: sg %d end\n", __func__, i); + break; + } + } + } + } + +write_err: + host->data = NULL; + host->cmd = NULL; + host->mrq = NULL; + writel(0xffffe, host->base + MCI_RAW_INTS); + if (ret) { + data->bytes_xfered = 0; + if (ret == -ESHUTDOWN) { + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET); + while (readl(host->base + MCI_CNTRL) & MCI_CNTRL_FIFO_RESET) + cpu_relax(); + + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_CONTROLLER_RESET); + while (readl(host->base + MCI_STATUS) & MCI_STATUS_CARD_BUSY) + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_CONTROLLER_RESET); + phytium_mci_restart_clk(host); + phytium_mci_start_sbc_stop_cmd(host, mrq, mrq->stop, mrq->stop->arg); + } + data->error = -ETIMEDOUT; + mrq->cmd->error = -ETIMEDOUT; + mmc_request_done(host->mmc, mrq); + return; + } + data->bytes_xfered = data->blocks * data->blksz; + mmc_request_done(host->mmc, mrq); +} + +static void +phytium_mci_start_data(struct phytium_mci_host *host, struct mmc_request *mrq, + struct mmc_command *cmd, struct mmc_data *data) +{ + bool read; + u32 rawcmd; + unsigned long flags; + + + WARN_ON(host->cmd); + host->cmd = cmd; + cmd->error = 0; + WARN_ON(host->data); + host->data = data; + read = data->flags & MMC_DATA_READ; + + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { + phytium_mci_err_irq(host, 0, MCI_INT_MASK_RTO); + return; + } + /* clear interrupts */ + writel(0xffffe, host->base + MCI_RAW_INTS); + + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET); + + while (readl(host->base + MCI_CNTRL) & (MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET)) + cpu_relax(); + + if (host->adtc_type == COMMOM_ADTC) + sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); + else + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); + wmb(); /* drain writebuffer */ + sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE); + + rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); + if (host->is_use_dma && host->adtc_type == BLOCK_RW_ADTC) + phytium_mci_data_sg_write_2_admc_table(host, data); + else + phytium_mci_data_sg_write_2_fifo(host, data); + + spin_lock_irqsave(&host->lock, flags); + sdr_set_bits(host->base + MCI_INT_MASK, cmd_ints_mask | data_ints_mask); + if (host->is_use_dma && host->adtc_type == BLOCK_RW_ADTC) { + sdr_set_bits(host->base + MCI_DMAC_INT_ENA, dmac_ints_mask); + /* Enable the IDMAC */ + sdr_set_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); + writel((u32)host->dma.adma_addr, host->base + MCI_DESC_LIST_ADDRL); + writel((u32)(host->dma.adma_addr >> 32), host->base + MCI_DESC_LIST_ADDRH); + } + writel(mrq->data->blksz, host->base + MCI_BLKSIZ); + writel(mrq->data->blocks * mrq->data->blksz, host->base + MCI_BYTCNT); + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE); + writel(cmd->arg, host->base + MCI_CMDARG); + wmb(); /* drain writebuffer */ + writel(rawcmd, host->base + MCI_CMD); + spin_unlock_irqrestore(&host->lock, flags); + + mod_timer(&host->timeout_timer, + jiffies + msecs_to_jiffies(MMC_REQ_TIMEOUT_MS)); +} + +static void phytium_mci_track_cmd_data(struct phytium_mci_host *host, + struct mmc_command *cmd, + struct mmc_data *data) +{ + if (host->error) + dev_dbg(host->dev, "%s: cmd=%d arg=%08X; host->error=0x%08X\n", + __func__, cmd->opcode, cmd->arg, host->error); +} + +static void phytium_mci_request_done(struct phytium_mci_host *host, struct mmc_request *mrq) +{ + unsigned long flags; + + spin_lock_irqsave(&host->lock, flags); + del_timer(&host->timeout_timer); + host->mrq = NULL; + if (host->cmd) + host->cmd = NULL; + spin_unlock_irqrestore(&host->lock, flags); + phytium_mci_track_cmd_data(host, mrq->cmd, mrq->data); + + if (mrq->data) + phytium_mci_unprepare_data(host, mrq); + + mmc_request_done(host->mmc, mrq); +} + +static bool phytium_mci_cmd_done(struct phytium_mci_host *host, int events, + struct mmc_request *mrq, struct mmc_command *cmd) +{ + bool done = false; + unsigned long flags; + u32 *rsp = cmd->resp; + + if (!(events & (MCI_RAW_INTS_RCRC | MCI_RAW_INTS_RE | MCI_RAW_INTS_CMD | + MCI_RAW_INTS_RTO | MCI_INT_MASK_HTO))) { + dev_err(host->dev, "No interrupt generation:h%x\n", events); + return done; + } + + spin_lock_irqsave(&host->lock, flags); + done = !host->cmd; + host->cmd = NULL; + if (done) { + spin_unlock_irqrestore(&host->lock, flags); + return true; + } + sdr_clr_bits(host->base + MCI_INT_MASK, cmd_ints_mask); + spin_unlock_irqrestore(&host->lock, flags); + + if (cmd->flags & MMC_RSP_PRESENT) { + if (cmd->flags & MMC_RSP_136) { + rsp[3] = readl(host->base + MCI_RESP0); + rsp[2] = readl(host->base + MCI_RESP1); + rsp[1] = readl(host->base + MCI_RESP2); + rsp[0] = readl(host->base + MCI_RESP3); + } else { + /* + * Sometimes get ACMD41 cmd done irq but the respose index still the APP_CMD, + * so polling the mci status entill the respose index change. + */ + if (cmd->opcode == SD_APP_OP_COND) { + int polling_cnt = 20; + while (MMC_APP_CMD == MCI_STATUS_RESPOSE_INDEX(readl(host->base + MCI_STATUS))) { + udelay(100); + polling_cnt --; + if (polling_cnt == 0) { + dev_info(host->dev, "hw respose index not equal cmd opcode, respose value may error\n"); + break; + } + } + } + rsp[0] = readl(host->base + MCI_RESP0); + } + + if (cmd->opcode == SD_SEND_RELATIVE_ADDR) + host->current_rca = rsp[0] & 0xFFFF0000; + } + if (!(events & (MCI_RAW_INTS_CMD | MCI_INT_MASK_HTO))) { + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && (events & MCI_RAW_INTS_RTO) + && readl(host->base + MCI_CARD_DETECT)) { + cmd->error = -ENOMEDIUM; + rsp[0] = 0; + } else if (events & MCI_RAW_INTS_RTO || + (cmd->opcode != MMC_SEND_TUNING_BLOCK && + cmd->opcode != MMC_SEND_TUNING_BLOCK_HS200)) { + cmd->error = -ETIMEDOUT; + } else if (events & MCI_RAW_INTS_RCRC) { + cmd->error = -EILSEQ; + } else { + cmd->error = -ETIMEDOUT; + } + } + phytium_mci_cmd_next(host, mrq, cmd); + return true; +} + +static void phytium_mci_start_command(struct phytium_mci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + u32 rawcmd; + unsigned long flags; + + spin_lock_irqsave(&host->lock, flags); + WARN_ON(host->cmd); + host->cmd = cmd; + cmd->error = 0; + writel(0xffffe, host->base + MCI_RAW_INTS); + + rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); + spin_unlock_irqrestore(&host->lock, flags); + + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { + phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, cmd); + return; + } + + spin_lock_irqsave(&host->lock, flags); + sdr_set_bits(host->base + MCI_INT_MASK, cmd_ints_mask); + writel(cmd->arg, host->base + MCI_CMDARG); + writel(rawcmd, host->base + MCI_CMD); + spin_unlock_irqrestore(&host->lock, flags); + + mod_timer(&host->timeout_timer, + jiffies + msecs_to_jiffies(MMC_REQ_TIMEOUT_MS)); +} + +static void +phytium_mci_cmd_next(struct phytium_mci_host *host, struct mmc_request *mrq, + struct mmc_command *cmd) +{ + if ((cmd->error && !(cmd->opcode == MMC_SEND_TUNING_BLOCK || + cmd->opcode == MMC_SEND_TUNING_BLOCK_HS200)) || + (mrq->sbc && mrq->sbc->error)) { + phytium_mci_request_done(host, mrq); + } else if (cmd == mrq->sbc) { + if ((mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK) || + (mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) || + (mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK) || + (mrq->cmd->opcode == MMC_WRITE_BLOCK)) { + dev_dbg(host->dev, "%s %d:sbc done and next cmd :%d length:%d\n", + __func__, __LINE__, mrq->cmd->opcode, mrq->data->sg->length); + phytium_mci_prepare_data(host, mrq); + if (host->is_use_dma) + host->adtc_type = BLOCK_RW_ADTC; + else + host->adtc_type = COMMOM_ADTC; + phytium_mci_start_data(host, mrq, mrq->cmd, mrq->data); + } else { + dev_err(host->dev, "%s %d:ERROR: cmd %d followers the SBC\n", + __func__, __LINE__, cmd->opcode); + } + } else if (!cmd->data) { + phytium_mci_request_done(host, mrq); + } +} + +static void phytium_mci_ops_request(struct mmc_host *mmc, struct mmc_request *mrq) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + u32 data; + int rc; + + host->error = 0; + WARN_ON(host->mrq); + host->mrq = mrq; + + rc = readl_relaxed_poll_timeout(host->base + MCI_STATUS, + data, + !(data & MCI_STATUS_CARD_BUSY), + 0, 500 * 1000); + if (rc == -ETIMEDOUT) + pr_debug("%s %d, timeout mci_status: 0x%08x\n", __func__, __LINE__, data); + + dev_dbg(host->dev, "%s %d: cmd:%d arg:0x%x\n", __func__, __LINE__, + mrq->cmd->opcode, mrq->cmd->arg); + + if (host->is_device_x100 && mrq->sbc && mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) { + phytium_mci_start_write_multiple_non_dma(mmc, mrq); + return; + } + + if (mrq->sbc) { + phytium_mci_start_command(host, mrq, mrq->sbc); + return; + } + if (mrq->data) { + phytium_mci_prepare_data(host, mrq); + + if ((mrq->data->sg->length >= 512) && host->is_use_dma && + ((mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK) || + (mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK) || + (mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) || + (mrq->cmd->opcode == MMC_WRITE_BLOCK) || + (mrq->cmd->opcode == SD_IO_RW_EXTENDED))) + + host->adtc_type = BLOCK_RW_ADTC; + else + host->adtc_type = COMMOM_ADTC; + + phytium_mci_start_data(host, mrq, mrq->cmd, mrq->data); + return; + } + phytium_mci_start_command(host, mrq, mrq->cmd); +} + +static void phytium_mci_pre_req(struct mmc_host *mmc, struct mmc_request *mrq) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + struct mmc_data *data = mrq->data; + + if (!data) + return; + + phytium_mci_prepare_data(host, mrq); + data->host_cookie |= MCI_ASYNC_FLAG; +} + +static void phytium_mci_post_req(struct mmc_host *mmc, struct mmc_request *mrq, + int err) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + struct mmc_data *data = mrq->data; + + if (!data) + return; + + if (data->host_cookie & MCI_ASYNC_FLAG) { + data->host_cookie &= ~MCI_ASYNC_FLAG; + phytium_mci_unprepare_data(host, mrq); + } +} + +static void phytium_mci_data_read_without_dma(struct phytium_mci_host *host, + struct mmc_data *data) +{ + u32 length, i, data_val, dma_len, tmp = 0; + u32 *virt_addr; + unsigned long flags; + struct scatterlist *sg; + + length = data->blocks * data->blksz; + + if (mmc_get_dma_dir(data) == DMA_FROM_DEVICE) { + spin_lock_irqsave(&host->lock, flags); + if (data->host_cookie & MCI_ASYNC_FLAG) { + tmp = MCI_ASYNC_FLAG; + phytium_mci_post_req(host->mmc, data->mrq, 0); + } else { + phytium_mci_unprepare_data(host, data->mrq); + } + + for_each_sg(data->sg, sg, data->sg_count, i) { + dma_len = sg_dma_len(sg); + virt_addr = sg_virt(data->sg); + + for (i = 0; i < (dma_len / 4); i++) { + data_val = readl(host->base + MCI_DATA); + memcpy(virt_addr, &data_val, 4); + ++virt_addr; + } + } + + if (tmp & MCI_ASYNC_FLAG) + phytium_mci_pre_req(host->mmc, data->mrq); + else + phytium_mci_prepare_data(host, data->mrq); + + spin_unlock_irqrestore(&host->lock, flags); + } + data->bytes_xfered = length; +} + +static void phytium_mci_data_xfer_next(struct phytium_mci_host *host, + struct mmc_request *mrq, + struct mmc_data *data) +{ + if (mmc_op_multi(mrq->cmd->opcode) && mrq->stop && + (data->error || !mrq->sbc)) { + while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) + cpu_relax(); + phytium_mci_start_command(host, mrq, mrq->stop); + } else { + phytium_mci_request_done(host, mrq); + } +} + +static bool phytium_mci_data_xfer_done(struct phytium_mci_host *host, u32 events, + struct mmc_request *mrq, struct mmc_data *data) +{ + unsigned long flags; + bool done; + + unsigned int check_data = events & (MCI_RAW_INTS_DTO | MCI_RAW_INTS_RCRC | + MCI_RAW_INTS_DCRC | MCI_RAW_INTS_RE | + MCI_RAW_INTS_DRTO | MCI_RAW_INTS_EBE | + MCI_DMAC_STATUS_AIS | MCI_DMAC_STATUS_DU | + MCI_RAW_INTS_SBE_BCI | MCI_INT_MASK_RTO); + + spin_lock_irqsave(&host->lock, flags); + done = !host->data; + + if (check_data || host->data) + host->data = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + if (done) + return true; + if (check_data) { + spin_lock_irqsave(&host->lock, flags); + sdr_clr_bits(host->base + MCI_DMAC_INT_ENA, dmac_ints_mask); + sdr_clr_bits(host->base + MCI_INT_MASK, data_ints_mask); + /* Stop the IDMAC running */ + sdr_clr_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); + dev_dbg(host->dev, "DMA stop\n"); + spin_unlock_irqrestore(&host->lock, flags); + + if (events & MCI_RAW_INTS_DTO) { + if (!host->is_use_dma || + (host->is_use_dma && host->adtc_type == COMMOM_ADTC && + (mrq->cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC)) + phytium_mci_data_read_without_dma(host, data); + else + data->bytes_xfered = data->blocks * data->blksz; + } else { + data->bytes_xfered = 0; + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) + && readl(host->base + MCI_CARD_DETECT) + && (events & cmd_err_ints_mask)) { + data->error = -ENOMEDIUM; + data->mrq->cmd->error = -ENOMEDIUM; + } else if (events & (MCI_RAW_INTS_DCRC | MCI_RAW_INTS_EBE | + MCI_RAW_INTS_SBE_BCI)) { + data->error = -EILSEQ; + host->cmd = NULL; + } else { + data->error = -ETIMEDOUT; + host->cmd = NULL; + } + } + + phytium_mci_data_xfer_next(host, mrq, data); + done = true; + } + return done; +} + +static int phytium_mci_card_busy(struct mmc_host *mmc) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + u32 status; + + status = readl(host->base + MCI_STATUS); + + return !!(status & MCI_STATUS_CARD_BUSY); +} + +static void __phytium_mci_enable_sdio_irq(struct phytium_mci_host *host, int enable) +{ + if (enable) + sdr_set_bits(host->base + MCI_INT_MASK, MCI_INT_MASK_SDIO); + else + sdr_clr_bits(host->base + MCI_INT_MASK, MCI_INT_MASK_SDIO); +} + +static void phytium_mci_enable_sdio_irq(struct mmc_host *mmc, int enable) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + + __phytium_mci_enable_sdio_irq(host, enable); +} + +static void hotplug_timer_func(struct timer_list *t) +{ + struct phytium_mci_host *host; + u32 status; + + host = from_timer(host, t, hotplug_timer); + if (!host) + return; + + status = readl(host->base + MCI_CARD_DETECT); + + if (status & 0x1) { + if (host->mmc->card) { + cancel_delayed_work(&host->mmc->detect); + mmc_detect_change(host->mmc, msecs_to_jiffies(100)); + } + } else { + cancel_delayed_work(&host->mmc->detect); + mmc_detect_change(host->mmc, msecs_to_jiffies(200)); + } +} + +static void phytium_mci_request_timeout(struct timer_list *t) +{ + struct phytium_mci_host *host = from_timer(host, t, timeout_timer); + + dev_err(host->dev, "request timeout\n"); + if (host->mrq) { + dev_err(host->dev, "aborting mrq=%p cmd=%d\n", + host->mrq, host->mrq->cmd->opcode); + if (host->cmd) { + dev_err(host->dev, "aborting cmd=%d\n", host->cmd->opcode); + phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, host->mrq, host->cmd); + } else if (host->data) { + dev_err(host->dev, "abort data: cmd%d; %d blocks\n", + host->mrq->cmd->opcode, host->data->blocks); + phytium_mci_data_xfer_done(host, MCI_RAW_INTS_RTO, host->mrq, + host->data); + } + } +} + +static int phytium_mci_err_irq(struct phytium_mci_host *host, u32 dmac_events, u32 events) +{ + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + + mrq = host->mrq; + cmd = host->cmd; + data = host->data; + + if (cmd && (cmd == mrq->sbc)) { + phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->sbc); + } else if (cmd && (cmd == mrq->stop)) { + phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->stop); + } else if (data) { + data->error = -ETIMEDOUT; + if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || + (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) + phytium_mci_data_xfer_done(host, events | dmac_events, mrq, data); + } else if (cmd) { + phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->cmd); + } + + return 0; +} + +static irqreturn_t phytium_mci_irq(int irq, void *dev_id) +{ + struct phytium_mci_host *host = (struct phytium_mci_host *) dev_id; + unsigned long flags; + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + u32 events, event_mask, dmac_events, dmac_evt_mask; + + if (!host) + return IRQ_NONE; + writel(0, host->base + 0xfd0); + + spin_lock_irqsave(&host->lock, flags); + events = readl(host->base + MCI_RAW_INTS); + dmac_events = readl(host->base + MCI_DMAC_STATUS); + event_mask = readl(host->base + MCI_INT_MASK); + dmac_evt_mask = readl(host->base + MCI_DMAC_INT_ENA); + if ((!events) && (!(dmac_events&0x1fff))) { + spin_unlock_irqrestore(&host->lock, flags); + return IRQ_NONE; + } + dev_dbg(host->dev, "%s:events:%x,mask:0x%x,dmac_events:%x,dmac_mask:0x%x,cmd:%d\n", + __func__, events, event_mask, dmac_events, dmac_evt_mask, + host->mrq ? host->mrq->cmd->opcode : 255); + + mrq = host->mrq; + cmd = host->cmd; + data = host->data; + +#if 0 + if (((events & event_mask) & MCI_RAW_INTS_SDIO) && + ((events == 0x10001) || (events == 0x10000) || (events == 0x10040))) { + writel(events, host->base + MCI_RAW_INTS); + __phytium_mci_enable_sdio_irq(host, 0); + sdio_signal_irq(host->mmc); + spin_unlock_irqrestore(&host->lock, flags); + goto irq_out; + } +#endif + if ((events & event_mask) & MCI_RAW_INTS_SDIO) { + __phytium_mci_enable_sdio_irq(host, 0); + } + + writel((events & event_mask), host->base + MCI_RAW_INTS); + writel(dmac_events, host->base + MCI_DMAC_STATUS); + spin_unlock_irqrestore(&host->lock, flags); + + if ((events & event_mask) & MCI_RAW_INTS_SDIO) { + sdio_signal_irq(host->mmc); + } + + if (((events & event_mask) == 0) && ((dmac_evt_mask & dmac_events) == 0)) + goto irq_out; + + if (((events & event_mask) & MCI_RAW_INTS_CD) && + !(host->mmc->caps & MMC_CAP_NONREMOVABLE)) { + mod_timer(&host->hotplug_timer, jiffies + usecs_to_jiffies(20000)); + dev_dbg(host->dev, "sd status changed here ! status:[%d] [%s %d]", + readl(host->base + MCI_CARD_DETECT), __func__, __LINE__); + + if ((events & event_mask) == MCI_RAW_INTS_CD) + goto irq_out; + } + + if (!mrq) { + if (events & MCI_RAW_INTS_HLE) + dev_dbg(host->dev, + "%s: MRQ=NULL and HW write locked, events=%08x,event_mask=%08x\n", + __func__, events, event_mask); + else + dev_dbg(host->dev, "%s: MRQ=NULL events:%08X evt_mask=%08X,sd_status:%d\n", + __func__, events, event_mask, readl(host->base + MCI_CARD_DETECT)); + goto irq_out; + } + + if ((dmac_events & dmac_err_ints_mask) || (events & cmd_err_ints_mask)) { + dev_dbg(host->dev, "ERR:events:%x,mask:0x%x,dmac_evts:%x,dmac_mask:0x%x,cmd:%d\n", + events, event_mask, dmac_events, dmac_evt_mask, mrq->cmd->opcode); + phytium_mci_err_irq(host, dmac_events & dmac_err_ints_mask, + events & cmd_err_ints_mask); + goto irq_out; + } + + if ((events & MCI_MASKED_INTS_DTO) && (events & MCI_MASKED_INTS_CMD)) { + phytium_mci_cmd_done(host, events, mrq, cmd); + phytium_mci_data_xfer_done(host, (events & data_ints_mask) | + (dmac_events & dmac_ints_mask), mrq, data); + } else if (events & MCI_MASKED_INTS_CMD || + ((events & MCI_INT_MASK_HTO) && (cmd->opcode == SD_SWITCH_VOLTAGE))) { + phytium_mci_cmd_done(host, events, mrq, cmd); + } else if (events & MCI_MASKED_INTS_DTO) { + phytium_mci_data_xfer_done(host, (events & data_ints_mask) | + (dmac_events & dmac_ints_mask), mrq, data); + } + +irq_out: + return IRQ_HANDLED; +} + +static void phytium_mci_init_hw(struct phytium_mci_host *host) +{ + u32 val; + int uhs_reg_value = 0x502; + + writel(MCI_SET_FIFOTH(0x2, 0x7, 0x100), host->base + MCI_FIFOTH); + writel(0x800001, host->base + MCI_CARD_THRCTL); + sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + phytium_mci_update_external_clk(host, uhs_reg_value); + + sdr_set_bits(host->base + MCI_PWREN, MCI_PWREN_ENABLE); + sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + sdr_set_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); + sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); + + phytium_mci_reset_hw(host); + + if (host->mmc->caps & MMC_CAP_NONREMOVABLE) + sdr_set_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); + else + sdr_clr_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); + + writel(0, host->base + MCI_INT_MASK); + val = readl(host->base + MCI_RAW_INTS); + writel(val, host->base + MCI_RAW_INTS); + writel(0, host->base + MCI_DMAC_INT_ENA); + val = readl(host->base + MCI_DMAC_STATUS); + writel(val, host->base + MCI_DMAC_STATUS); + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE)) + writel(MCI_INT_MASK_CD, host->base + MCI_INT_MASK); + + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE | + MCI_CNTRL_USE_INTERNAL_DMAC); + + writel(0xFFFFFFFF, host->base + MCI_TMOUT); + dev_info(host->dev, "init hardware done!"); + +} + +void phytium_mci_deinit_hw(struct phytium_mci_host *host) +{ + u32 val; + + sdr_clr_bits(host->base + MCI_PWREN, MCI_PWREN_ENABLE); + sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + sdr_clr_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); + sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); + writel(0, host->base + MCI_INT_MASK); + val = readl(host->base + MCI_RAW_INTS); + writel(val, host->base + MCI_RAW_INTS); + writel(0, host->base + MCI_DMAC_INT_ENA); + val = readl(host->base + MCI_DMAC_STATUS); + writel(val, host->base + MCI_DMAC_STATUS); + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE)) + writel(MCI_INT_MASK_CD, host->base + MCI_INT_MASK); +} +EXPORT_SYMBOL_GPL(phytium_mci_deinit_hw); + +static void phytium_mci_adma_reset(struct phytium_mci_host *host) +{ + u32 bmod = readl(host->base + MCI_BUS_MODE); + + bmod |= MCI_BUS_MODE_SWR; + writel(bmod, host->base + MCI_BUS_MODE); +} + +static void phytium_mci_init_adma_table(struct phytium_mci_host *host, + struct phytium_mci_dma *dma) +{ + struct phytium_adma2_64_desc *adma_table = dma->adma_table; + dma_addr_t dma_addr; + int i; + + memset(adma_table, 0, sizeof(struct phytium_adma2_64_desc) * MAX_BD_NUM); + + for (i = 0; i < (MAX_BD_NUM - 1); i++) { + dma_addr = dma->adma_addr + sizeof(*adma_table) * (i + 1); + adma_table[i].desc_lo = lower_32_bits(dma_addr); + adma_table[i].desc_hi = upper_32_bits(dma_addr); + adma_table[i].attribute = 0; + adma_table[i].NON1 = 0; + adma_table[i].len = 0; + adma_table[i].NON2 = 0; + } + + phytium_mci_adma_reset(host); +} + +static void phytium_mci_set_buswidth(struct phytium_mci_host *host, u32 width) +{ + u32 val; + + switch (width) { + case MMC_BUS_WIDTH_1: + val = MCI_BUS_1BITS; + break; + + case MMC_BUS_WIDTH_4: + val = MCI_BUS_4BITS; + break; + + case MMC_BUS_WIDTH_8: + val = MCI_BUS_8BITS; + break; + default: + val = MCI_BUS_4BITS; + break; + } + writel(val, host->base + MCI_CTYPE); + dev_dbg(host->dev, "Bus Width = %d, set value:0x%x\n", width, val); +} + +static void phytium_mci_ops_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + + if (ios->timing == MMC_TIMING_MMC_DDR52 || ios->timing == MMC_TIMING_UHS_DDR50) + sdr_set_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_DDR); + else + sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_DDR); + + phytium_mci_set_buswidth(host, ios->bus_width); + + switch (ios->power_mode) { + case MMC_POWER_UP: + set_bit(MCI_CARD_NEED_INIT, &host->flags); + writel(MCI_POWER_ON, host->base + MCI_PWREN); + break; + + case MMC_POWER_ON: + break; + + case MMC_POWER_OFF: + writel(MCI_POWER_OFF, host->base + MCI_PWREN); + break; + + default: + break; + } + phytium_mci_set_clk(host, ios); +} + +static void phytium_mci_ack_sdio_irq(struct mmc_host *mmc) +{ + unsigned long flags; + struct phytium_mci_host *host = mmc_priv(mmc); + + spin_lock_irqsave(&host->lock, flags); + __phytium_mci_enable_sdio_irq(host, 1); + spin_unlock_irqrestore(&host->lock, flags); +} + +static int phytium_mci_get_cd(struct mmc_host *mmc) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + u32 status; + + if (mmc->caps & MMC_CAP_NONREMOVABLE) + return 1; + + status = readl(host->base + MCI_CARD_DETECT); + + if ((status & 0x1) == 0x1) + return 0; + + return 1; +} + +static int phytium_mci_ops_switch_volt(struct mmc_host *mmc, struct mmc_ios *ios) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + unsigned int is_voltage_180 = 0; + + is_voltage_180 = readl(host->base + MCI_UHS_REG); + if ((mmc->caps & MMC_CAP_NONREMOVABLE) && (ios->signal_voltage != MMC_SIGNAL_VOLTAGE_180)) + return -EINVAL; + + if ((ios->signal_voltage == MMC_SIGNAL_VOLTAGE_330) && (is_voltage_180 & 0x1)) + sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); + else if ((ios->signal_voltage == MMC_SIGNAL_VOLTAGE_180) && (!(is_voltage_180 & 0x1))) + sdr_set_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); + else if (ios->signal_voltage == MMC_SIGNAL_VOLTAGE_120) + return -EINVAL; + return 0; +} + +static void phytium_mci_hw_reset(struct mmc_host *mmc) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + u32 reset_flag; + + if (host->is_use_dma) { + reset_flag = MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET; + phytium_mci_adma_reset(host); + sdr_set_bits(host->base + MCI_CNTRL, reset_flag); + } else { + reset_flag = MCI_CNTRL_FIFO_RESET; + sdr_set_bits(host->base + MCI_CNTRL, reset_flag); + } + + while (readl(host->base + MCI_CNTRL) & reset_flag) + cpu_relax(); + + sdr_clr_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); + udelay(5); + sdr_set_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); + usleep_range(200, 300); +} + +#ifdef CONFIG_PM_SLEEP +int phytium_mci_suspend(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_mci_host *host = mmc_priv(mmc); + + phytium_mci_deinit_hw(host); + return 0; +} +EXPORT_SYMBOL(phytium_mci_suspend); + +int phytium_mci_resume(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_mci_host *host = mmc_priv(mmc); + + phytium_mci_init_hw(host); + return 0; +} +EXPORT_SYMBOL(phytium_mci_resume); + +#endif + +#ifdef CONFIG_PM +int phytium_mci_runtime_suspend(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_mci_host *host = mmc_priv(mmc); + + phytium_mci_deinit_hw(host); + return 0; +} +EXPORT_SYMBOL(phytium_mci_runtime_suspend); + +int phytium_mci_runtime_resume(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_mci_host *host = mmc_priv(mmc); + + phytium_mci_init_hw(host); + return 0; +} +EXPORT_SYMBOL(phytium_mci_runtime_resume); + +#endif + +static struct mmc_host_ops phytium_mci_ops = { + .post_req = phytium_mci_post_req, + .pre_req = phytium_mci_pre_req, + .request = phytium_mci_ops_request, + .set_ios = phytium_mci_ops_set_ios, + .get_cd = phytium_mci_get_cd, + .enable_sdio_irq = phytium_mci_enable_sdio_irq, + .ack_sdio_irq = phytium_mci_ack_sdio_irq, + .card_busy = phytium_mci_card_busy, + .start_signal_voltage_switch = phytium_mci_ops_switch_volt, + .hw_reset = phytium_mci_hw_reset, +}; + +int phytium_mci_common_probe(struct phytium_mci_host *host) +{ + struct mmc_host *mmc = host->mmc; + struct device *dev = host->dev; + int ret; + + dma_set_mask(dev, DMA_BIT_MASK(64)); + dma_set_coherent_mask(dev, DMA_BIT_MASK(64)); + + timer_setup(&host->hotplug_timer, hotplug_timer_func, 0); + timer_setup(&host->timeout_timer, phytium_mci_request_timeout, 0); + + mmc->f_min = MCI_F_MIN; + if (!mmc->f_max) + mmc->f_max = MCI_F_MAX; + + mmc->ops = &phytium_mci_ops; + mmc->ocr_avail_sdio = MMC_VDD_32_33 | MMC_VDD_33_34; + mmc->ocr_avail_sd = MMC_VDD_32_33 | MMC_VDD_33_34; + mmc->ocr_avail_mmc = MMC_VDD_165_195; + mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34 | MMC_VDD_165_195; + mmc->caps |= host->caps; + + if (mmc->caps & MMC_CAP_SDIO_IRQ) { + mmc->caps2 |= MMC_CAP2_SDIO_IRQ_NOTHREAD; + dev_dbg(host->dev, "%s %d: MMC_CAP_SDIO_IRQ\n", __func__, __LINE__); + } + mmc->caps2 |= host->caps2; + if (host->is_use_dma) { + /* MMC core transfer sizes tunable parameters */ + mmc->max_segs = MAX_BD_NUM; + mmc->max_seg_size = 4 * 1024; + mmc->max_blk_size = 512; + mmc->max_req_size = 512 * 1024; + mmc->max_blk_count = mmc->max_req_size / 512; + host->dma.adma_table = dma_alloc_coherent(host->dev, + MAX_BD_NUM * + sizeof(struct phytium_adma2_64_desc), + &host->dma.adma_addr, GFP_KERNEL); + if (!host->dma.adma_table) + return MCI_REALEASE_MEM; + + host->dma.desc_sz = ADMA2_64_DESC_SZ; + phytium_mci_init_adma_table(host, &host->dma); + } else { + mmc->max_segs = MAX_BD_NUM; + mmc->max_seg_size = 4 * 1024; + mmc->max_blk_size = 512; + mmc->max_req_size = 4 * 512; + mmc->max_blk_count = mmc->max_req_size / 512; + } + + spin_lock_init(&host->lock); + + phytium_mci_init_hw(host); + ret = devm_request_irq(host->dev, host->irq, phytium_mci_irq, + host->irq_flags, "phytium-mci", host); + + if (ret) + return ret; + + ret = mmc_add_host(mmc); + + if (ret) { + dev_err(host->dev, "%s %d: mmc add host!\n", __func__, __LINE__); + return ret; + } + return 0; +} +EXPORT_SYMBOL(phytium_mci_common_probe); + +MODULE_DESCRIPTION("Phytium Multimedia Card Interface driver"); +MODULE_LICENSE("GPL v2"); +MODULE_AUTHOR("Cheng Quan "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci.h new file mode 100644 index 0000000000000000000000000000000000000000..c35e6f3b3a859872f9c0702ff715004163c21f91 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-mci.h @@ -0,0 +1,357 @@ +/* SPDX-License-Identifier: GPL-2.0+ */ +/* + * Driver for Phytium Multimedia Card Interface + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_MCI_H +#define __PHYTIUM_MCI_H + +#include +#include +#include +#include +#include +#include +#include + +/*------------------------------------------------------*/ +/* Common Definition */ +/*------------------------------------------------------*/ +#define MAX_BD_NUM 128 +#define SD_BLOCK_SIZE 512 + +#define MCI_BUS_1BITS 0x0 +#define MCI_BUS_4BITS 0x1 +#define MCI_BUS_8BITS (0x1 << 16) + +#define MCI_SD_DRV_VALUE 0 +#define MCI_SD_SAMP_VALUE_MAX 0 +#define MCI_SD_SAMP_VALUE_MIN 0 + +#define MCI_TIMEOUT_CMD_VALUE 0xFFFFFFFF +#define MCI_POWER_ON 1 +#define MCI_POWER_OFF 0 + +#define MCI_PREPARE_FLAG (0x1 << 0) +#define MCI_ASYNC_FLAG (0x1 << 1) +#define MCI_MMAP_FLAG (0x1 << 2) + +#define MCI_CMD_TIMEOUT (HZ/10 * 50) /* 100ms x5 */ +#define MCI_DATA_TIMEOUT (HZ * 10) /* 1000ms x5 */ + +#define MCI_CMD_TYPE_ADTC 0x2 + +#define MCI_F_MIN 400000 +#define MCI_F_MAX 50000000 + +#define MCI_CLK 1200000000 +#define MCI_REALEASE_MEM 0x1 +#define MCI_MAX_FIFO_CNT 0x800 + +/* FIFOTH register defines */ +#define MCI_SET_FIFOTH(m, r, t) (((m) & 0x7) << 28 | \ + ((r) & 0xFFF) << 16 | ((t) & 0xFFF)) +/* Card read threshold */ +#define MCI_SET_THLD(v, x) (((v) & 0xFFF) << 16 | (x)) +#define MCI_CARD_WR_THR_EN BIT(2) +#define MCI_CARD_RD_THR_EN BIT(0) + +/*----------------------------------------------------------------------*/ +/* Register Offset */ +/*----------------------------------------------------------------------*/ +#define MCI_CNTRL 0x00 /* the controller config reg */ +#define MCI_PWREN 0x04 /* the power enable reg */ +#define MCI_CLKDIV 0x08 /* the clock divider reg */ +#define MCI_CLKENA 0x10 /* the clock enable reg */ +#define MCI_TMOUT 0x14 /* the timeout reg */ +#define MCI_CTYPE 0x18 /* the card type reg */ +#define MCI_BLKSIZ 0x1C /* the block size reg */ +#define MCI_BYTCNT 0x20 /* the byte count reg */ +#define MCI_INT_MASK 0x24 /* the interrupt mask reg */ +#define MCI_CMDARG 0x28 /* the command argument reg */ +#define MCI_CMD 0x2C /* the command reg */ +#define MCI_RESP0 0x30 /* the response reg0 */ +#define MCI_RESP1 0x34 /* the response reg1 */ +#define MCI_RESP2 0x38 /* the response reg2 */ +#define MCI_RESP3 0X3C /* the response reg3 */ +#define MCI_MASKED_INTS 0x40 /* the masked interrupt status reg */ +#define MCI_RAW_INTS 0x44 /* the raw interrupt status reg */ +#define MCI_STATUS 0x48 /* the status reg */ +#define MCI_FIFOTH 0x4C /* the FIFO threshold watermark reg */ +#define MCI_CARD_DETECT 0x50 /* the card detect reg */ +#define MCI_CARD_WRTPRT 0x54 /* the card write protect reg */ +#define MCI_CCLK_RDY 0x58 /* first div is ready? 1:ready,0:not ready*/ +#define MCI_TRAN_CARD_CNT 0x5C /* the transferred CIU card byte count reg */ +#define MCI_TRAN_FIFO_CNT 0x60 /* the transferred host to FIFO byte count reg */ +#define MCI_DEBNCE 0x64 /* the debounce count reg */ +#define MCI_UID 0x68 /* the user ID reg */ +#define MCI_VID 0x6C /* the controller version ID reg */ +#define MCI_HWCONF 0x70 /* the hardware configuration reg */ +#define MCI_UHS_REG 0x74 /* the UHS-I reg */ +#define MCI_CARD_RESET 0x78 /* the card reset reg */ +#define MCI_BUS_MODE 0x80 /* the bus mode reg */ +#define MCI_DESC_LIST_ADDRL 0x88 /* the descriptor list low base address reg */ +#define MCI_DESC_LIST_ADDRH 0x8C /* the descriptor list high base address reg */ +#define MCI_DMAC_STATUS 0x90 /* the internal DMAC status reg */ +#define MCI_DMAC_INT_ENA 0x94 /* the internal DMAC interrupt enable reg */ +#define MCI_CUR_DESC_ADDRL 0x98 /* the current host descriptor low address reg */ +#define MCI_CUR_DESC_ADDRH 0x9C /* the current host descriptor high address reg */ +#define MCI_CUR_BUF_ADDRL 0xA0 /* the current buffer low address reg */ +#define MCI_CUR_BUF_ADDRH 0xA4 /* the current buffer high address reg */ +#define MCI_CARD_THRCTL 0x100 /* the card threshold control reg */ +#define MCI_UHS_REG_EXT 0x108 /* the UHS register extension */ +#define MCI_EMMC_DDR_REG 0x10C /* the EMMC DDR reg */ +#define MCI_ENABLE_SHIFT 0x110 /* the enable phase shift reg */ +#define MCI_DATA 0x200 /* the data FIFO access */ + +/* Command register defines */ +#define MCI_CMD_START BIT(31) +#define MCI_CMD_USE_HOLD_REG BIT(29) +#define MCI_CMD_VOLT_SWITCH BIT(28) +#define MCI_CMD_CCS_EXP BIT(23) +#define MCI_CMD_CEATA_RD BIT(22) +#define MCI_CMD_UPD_CLK BIT(21) +#define MCI_CMD_INIT BIT(15) +#define MCI_CMD_STOP BIT(14) +#define MCI_CMD_PRV_DAT_WAIT BIT(13) +#define MCI_CMD_SEND_STOP BIT(12) +#define MCI_CMD_STRM_MODE BIT(11) +#define MCI_CMD_DAT_WR BIT(10) +#define MCI_CMD_DAT_EXP BIT(9) +#define MCI_CMD_RESP_CRC BIT(8) +#define MCI_CMD_RESP_LONG BIT(7) +#define MCI_CMD_RESP_EXP BIT(6) +#define MCI_CMD_INDX(n) ((n) & 0x1F) + +/*------------------------------------------------------*/ +/* Register Mask */ +/*------------------------------------------------------*/ +/* MCI_CNTRL mask */ +#define MCI_CNTRL_CONTROLLER_RESET (0x1 << 0) /* RW */ +#define MCI_CNTRL_FIFO_RESET (0x1 << 1) /* RW */ +#define MCI_CNTRL_DMA_RESET (0x1 << 2) /* RW */ +#define MCI_CNTRL_RES (0x1 << 3) /* */ +#define MCI_CNTRL_INT_ENABLE (0x1 << 4) /* RW */ +#define MCI_CNTRL_DMA_ENABLE (0x1 << 5) /* RW */ +#define MCI_CNTRL_READ_WAIT (0x1 << 6) /* RW */ +#define MCI_CNTRL_SEND_IRQ_RESPONSE (0x1 << 7) /* RW */ +#define MCI_CNTRL_ABORT_READ_DATA (0x1 << 8) /* RW */ +#define MCI_CNTRL_ENDIAN (0x1 << 11) /* RW */ +//#define MCI_CNTRL_CARD_VOLTAGE_A (0xF << 16) /* RW */ +//#define MCI_CNTRL_CARD_VOLTAGE_B (0xF << 20) /* RW */ +#define MCI_CNTRL_ENABLE_OD_PULLUP (0x1 << 24) /* RW */ +#define MCI_CNTRL_USE_INTERNAL_DMAC (0x1 << 25) /* RW */ + +/* MCI_PWREN mask */ +#define MCI_PWREN_ENABLE (0x1 << 0) /* RW */ + +/* MCI_CLKENA mask */ +#define MCI_CLKENA_CCLK_ENABLE (0x1 << 0) /* RW */ +#define MCI_CLKENA_CCLK_LOW_POWER (0x1 << 16) /* RW */ +#define MCI_EXT_CLK_ENABLE (0x1 << 1) + +/* MCI_INT_MASK mask */ +#define MCI_INT_MASK_CD (0x1 << 0) /* RW */ +#define MCI_INT_MASK_RE (0x1 << 1) /* RW */ +#define MCI_INT_MASK_CMD (0x1 << 2) /* RW */ +#define MCI_INT_MASK_DTO (0x1 << 3) /* RW */ +#define MCI_INT_MASK_TXDR (0x1 << 4) /* RW */ +#define MCI_INT_MASK_RXDR (0x1 << 5) /* RW */ +#define MCI_INT_MASK_RCRC (0x1 << 6) /* RW */ +#define MCI_INT_MASK_DCRC (0x1 << 7) /* RW */ +#define MCI_INT_MASK_RTO (0x1 << 8) /* RW */ +#define MCI_INT_MASK_DRTO (0x1 << 9) /* RW */ +#define MCI_INT_MASK_HTO (0x1 << 10) /* RW */ +#define MCI_INT_MASK_FRUN (0x1 << 11) /* RW */ +#define MCI_INT_MASK_HLE (0x1 << 12) /* RW */ +#define MCI_INT_MASK_SBE_BCI (0x1 << 13) /* RW */ +#define MCI_INT_MASK_ACD (0x1 << 14) /* RW */ +#define MCI_INT_MASK_EBE (0x1 << 15) /* RW */ +#define MCI_INT_MASK_SDIO (0x1 << 16) /* RW */ + +/* MCI_MASKED_INTS mask */ +#define MCI_MASKED_INTS_CD (0x1 << 0) /* RO */ +#define MCI_MASKED_INTS_RE (0x1 << 1) /* RO */ +#define MCI_MASKED_INTS_CMD (0x1 << 2) /* RO */ +#define MCI_MASKED_INTS_DTO (0x1 << 3) /* RO */ +#define MCI_MASKED_INTS_TXDR (0x1 << 4) /* RO */ +#define MCI_MASKED_INTS_RXDR (0x1 << 5) /* RO */ +#define MCI_MASKED_INTS_RCRC (0x1 << 6) /* RO */ +#define MCI_MASKED_INTS_DCRC (0x1 << 7) /* RO */ +#define MCI_MASKED_INTS_RTO (0x1 << 8) /* RO */ +#define MCI_MASKED_INTS_DRTO (0x1 << 9) /* RO */ +#define MCI_MASKED_INTS_HTO (0x1 << 10) /* RO */ +#define MCI_MASKED_INTS_FRUN (0x1 << 11) /* RO */ +#define MCI_MASKED_INTS_HLE (0x1 << 12) /* RO */ +#define MCI_MASKED_INTS_SBE_BCI (0x1 << 13) /* RO */ +#define MCI_MASKED_INTS_ACD (0x1 << 14) /* RO */ +#define MCI_MASKED_INTS_EBE (0x1 << 15) /* RO */ +#define MCI_MASKED_INTS_SDIO (0x1 << 16) /* RO */ + +/* MCI_RAW_INTS mask */ +#define MCI_RAW_INTS_CD (0x1 << 0) /* W1C */ +#define MCI_RAW_INTS_RE (0x1 << 1) /* W1C */ +#define MCI_RAW_INTS_CMD (0x1 << 2) /* W1C */ +#define MCI_RAW_INTS_DTO (0x1 << 3) /* W1C */ +#define MCI_RAW_INTS_TXDR (0x1 << 4) /* W1C */ +#define MCI_RAW_INTS_RXDR (0x1 << 5) /* W1C */ +#define MCI_RAW_INTS_RCRC (0x1 << 6) /* W1C */ +#define MCI_RAW_INTS_DCRC (0x1 << 7) /* W1C */ +#define MCI_RAW_INTS_RTO (0x1 << 8) /* W1C */ +#define MCI_RAW_INTS_DRTO (0x1 << 9) /* W1C */ +#define MCI_RAW_INTS_HTO (0x1 << 10) /* W1C */ +#define MCI_RAW_INTS_FRUN (0x1 << 11) /* W1C */ +#define MCI_RAW_INTS_HLE (0x1 << 12) /* W1C */ +#define MCI_RAW_INTS_SBE_BCI (0x1 << 13) /* W1C */ +#define MCI_RAW_INTS_ACD (0x1 << 14) /* W1C */ +#define MCI_RAW_INTS_EBE (0x1 << 15) /* W1C */ +#define MCI_RAW_INTS_SDIO (0x1 << 16) /* W1C */ + +/* MCI_STATUS mask */ +#define MCI_STATUS_FIFO_RX (0x1 << 0) /* RO */ +#define MCI_STATUS_FIFO_TX (0x1 << 1) /* RO */ +#define MCI_STATUS_FIFO_EMPTY (0x1 << 2) /* RO */ +#define MCI_STATUS_FIFO_FULL (0x1 << 3) /* RO */ +#define MCI_STATUS_CARD_STATUS (0x1 << 8) /* RO */ +#define MCI_STATUS_CARD_BUSY (0x1 << 9) /* RO */ +#define MCI_STATUS_DATA_BUSY (0x1 << 10) /* RO */ +#define MCI_STATUS_RESPOSE_INDEX_OFFSET (11) +#define MCI_STATUS_RESPOSE_INDEX_MASK (0x3f << MCI_STATUS_RESPOSE_INDEX_OFFSET) /* RO */ +#define MCI_STATUS_RESPOSE_INDEX(reg) (((reg) & MCI_STATUS_RESPOSE_INDEX_MASK) >> MCI_STATUS_RESPOSE_INDEX_OFFSET) +#define MCI_STATUS_DMA_ACK (0x1 << 31) /* RO */ +#define MCI_STATUS_DMA_REQ (0x1 << 32) /* RO */ + +/* MCI_UHS_REG mask */ +#define MCI_UHS_REG_VOLT (0x1 << 0) /* RW */ +#define MCI_UHS_REG_DDR (0x1 << 16) /* RW */ + +/* MCI_CARD_RESET mask */ +#define MCI_CARD_RESET_ENABLE (0x1 << 0) /* RW */ + +/* MCI_BUS_MODE mask */ +#define MCI_BUS_MODE_SWR (0x1 << 0) /* RW */ +#define MCI_BUS_MODE_FB (0x1 << 1) /* RW */ +#define MCI_BUS_MODE_DE (0x1 << 7) /* RW */ + +/* MCI_DMAC_STATUS mask */ +#define MCI_DMAC_STATUS_TI (0x1 << 0) /* RW */ +#define MCI_DMAC_STATUS_RI (0x1 << 1) /* RW */ +#define MCI_DMAC_STATUS_FBE (0x1 << 2) /* RW */ +#define MCI_DMAC_STATUS_DU (0x1 << 4) /* RW */ +#define MCI_DMAC_STATUS_NIS (0x1 << 8) /* RW */ +#define MCI_DMAC_STATUS_AIS (0x1 << 9) /* RW */ + +/* MCI_DMAC_INT_ENA mask */ +#define MCI_DMAC_INT_ENA_TI (0x1 << 0) /* RW */ +#define MCI_DMAC_INT_ENA_RI (0x1 << 1) /* RW */ +#define MCI_DMAC_INT_ENA_FBE (0x1 << 2) /* RW */ +#define MCI_DMAC_INT_ENA_DU (0x1 << 4) /* RW */ +#define MCI_DMAC_INT_ENA_CES (0x1 << 5) /* RW */ +#define MCI_DMAC_INT_ENA_NIS (0x1 << 8) /* RW */ +#define MCI_DMAC_INT_ENA_AIS (0x1 << 9) /* RW */ + +/* MCI_CARD_THRCTL mask */ +#define MCI_CARD_THRCTL_CARDRD (0x1 << 0) /* RW */ +#define MCI_CARD_THRCTL_BUSY_CLR (0x1 << 1) /* RW */ +#define MCI_CARD_THRCTL_CARDWR (0x1 << 2) /* RW */ + +/* MCI_UHS_REG_EXT mask */ +#define MCI_UHS_REG_EXT_MMC_VOLT (0x1 << 0) /* RW */ +#define MCI_UHS_REG_EXT_CLK_ENA (0x1 << 1) /* RW */ + +/* MCI_EMMC_DDR_REG mask */ +#define MCI_EMMC_DDR_CYCLE (0x1 << 0) /* RW */ + +/*--------------------------------------*/ +/* Structure Type */ +/*--------------------------------------*/ +/* Maximum segments assuming a 512KiB maximum requisition */ +/* size and a minimum4KiB page size. */ +#define MCI_MAX_SEGS 128 +/* ADMA2 64-bit DMA descriptor size */ +#define ADMA2_64_DESC_SZ 32 + +/* mmc request timeout 5000ms */ +#define MMC_REQ_TIMEOUT_MS 5000 + +/* Each descriptor can transfer up to 4KB of data in chained mode */ +/*ADMA2 64-bit descriptor.*/ +struct phytium_adma2_64_desc { + u32 attribute; +#define IDMAC_DES0_DIC BIT(1) +#define IDMAC_DES0_LD BIT(2) +#define IDMAC_DES0_FD BIT(3) +#define IDMAC_DES0_CH BIT(4) +#define IDMAC_DES0_ER BIT(5) +#define IDMAC_DES0_CES BIT(30) +#define IDMAC_DES0_OWN BIT(31) + u32 NON1; + u32 len; + u32 NON2; + u32 addr_lo; /* Lower 32-bits of Buffer Address Pointer 1*/ + u32 addr_hi; /* Upper 32-bits of Buffer Address Pointer 1*/ + u32 desc_lo; /* Lower 32-bits of Next Descriptor Address */ + u32 desc_hi; /* Upper 32-bits of Next Descriptor Address */ +} __packed __aligned(4); + +struct phytium_mci_dma { + struct scatterlist *sg; /* I/O scatter list */ + /* ADMA descriptor table, pointer to adma_table array */ + struct phytium_adma2_64_desc *adma_table; + /* Mapped ADMA descr. table, the physical address of adma_table array */ + dma_addr_t adma_addr; + unsigned int desc_sz; /* ADMA descriptor size */ +}; + +enum adtc_t { + COMMOM_ADTC = 0, + BLOCK_RW_ADTC = 1 +}; + +struct phytium_mci_host { + struct device *dev; + struct mmc_host *mmc; + u32 caps; + u32 caps2; + spinlock_t lock; + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + int error; + void __iomem *base; /* host base address */ + void *adma_table1; + dma_addr_t adma_addr1; + struct phytium_mci_dma dma_rx; /* dma channel */ + struct phytium_mci_dma dma_tx; /* dma channel */ + struct phytium_mci_dma dma; /* dma channel */ + u64 dma_mask; + bool vqmmc_enabled; + u32 *sg_virt_addr; + enum adtc_t adtc_type; /* 0:common adtc cmd; 1:block r/w adtc cmd;*/ + struct timer_list hotplug_timer; + struct timer_list timeout_timer; + struct delayed_work req_timeout; + int irq; /* host interrupt */ + u32 current_rca; /*the current rca value*/ + u32 current_ios_clk; + u32 is_use_dma; + u32 is_device_x100; + struct clk *src_clk; /* phytium_mci source clock */ + unsigned long clk_rate; + unsigned long clk_div; + unsigned long irq_flags; + unsigned long flags; +#define MCI_CARD_NEED_INIT 1 + +}; + +int phytium_mci_common_probe(struct phytium_mci_host *host); +void phytium_mci_deinit_hw(struct phytium_mci_host *host); +int phytium_mci_runtime_suspend(struct device *dev); +int phytium_mci_runtime_resume(struct device *dev); +int phytium_mci_resume(struct device *dev); +int phytium_mci_suspend(struct device *dev); + +#endif /* __PHYTIUM_MCI_HW_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-sdci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-sdci.c new file mode 100755 index 0000000000000000000000000000000000000000..c4248f88b0cb70636c2f5733cc2f63590124d83b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-sdci.c @@ -0,0 +1,1433 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SD Card Interface dirver + * + * Copyright (c) 2019-2024 Phytium Technology Co.,Ltd. + */ + +#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 "phytium-sdci.h" + +static const u32 cmd_ints_mask = SDCI_SDCI_NORMAL_ISER_ECC_EN | SDCI_SDCI_NORMAL_ISER_EEI_EN; +static const u32 data_ints_mask = SDCI_BD_ISER_ETRS_EN; +static const u32 err_ints_mask = SDCI_ERROR_ISER_ECTE_EN | SDCI_ERROR_ISR_CCRCE_EN | + SDCI_ERROR_ISR_CIR_EN | SDCI_ERROR_ISR_CNR_EN; + +static void hotplug_timer_func(struct timer_list *t); +static bool phytium_sdci_private_send_cmd(struct phytium_sdci_host *host, + u32 cmd, u32 resp_type, u32 arg); +static bool phytium_sdci_cmd_done(struct phytium_sdci_host *host, int events, + struct mmc_request *mrq, + struct mmc_command *cmd); +static bool phytium_sdci_data_xfer_done(struct phytium_sdci_host *host, + u32 events, struct mmc_request *mrq, + struct mmc_data *data); +static void phytium_sdci_cmd_next(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd); + +static int phytium_sdci_cmd13_process(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_data *data, + u32 wait_timeout_ms, + u32 send_once_time_ms); + +static int phytium_sd_error(struct phytium_sdci_host *host) +{ + int temp; + + temp = readl(host->base + SDCI_NORMAL_ISR); + dev_err(host->dev, "[%s %d]SDCI_NORMAL_ISR:%x\n", __func__, __LINE__, temp); + temp = readl(host->base + SDCI_BD_ISR); + temp = readl(host->base + SDCI_ERROR_ISR); + dev_err(host->dev, "[%s %d]SDCI_ERROR_ISR:%x\n", __func__, __LINE__, temp); + temp = readl(host->base + SDCI_BD_ISR); + dev_err(host->dev, "[%s %d]SDCI_BD_ISR:%x\n", __func__, __LINE__, temp); + temp = readl(host->base + SDCI_RESP0); + dev_err(host->dev, "[%s %d]SDCI_RESP0:%x\n", __func__, __LINE__, temp); + + return 0; +} + +static void sdr_set_bits(void __iomem *reg, u32 bs) +{ + u32 val; + + val = readl(reg); + val |= bs; + + writel(val, reg); +} + +static void sdr_clr_bits(void __iomem *reg, u32 bs) +{ + u32 val; + + val = readl(reg); + val &= ~bs; + + writel(val, reg); +} + +static void phytium_sdci_reset_hw(struct phytium_sdci_host *host) +{ + sdr_set_bits(host->base + SDCI_SOFTWARE, + SDCI_SOFTWARE_SRST); + sdr_clr_bits(host->base + SDCI_SOFTWARE, + SDCI_SOFTWARE_SRST); + while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) + cpu_relax(); +} + +static void phytium_sdci_prepare_data(struct phytium_sdci_host *host, + struct mmc_request *mrq) +{ + struct mmc_data *data = mrq->data; + bool read; + + read = (data->flags & MMC_DATA_READ) != 0; + data->sg_count = dma_map_sg(host->dev, data->sg, data->sg_len, + read ? DMA_FROM_DEVICE : DMA_TO_DEVICE); +} + +static void phytium_sdci_unprepare_data(struct phytium_sdci_host *host, + struct mmc_request *mrq) +{ + bool read; + struct mmc_data *data = mrq->data; + + read = (data->flags & MMC_DATA_READ) != 0; + dma_unmap_sg(host->dev, data->sg, data->sg_len, + read ? DMA_FROM_DEVICE : DMA_TO_DEVICE); +} + +static void phytium_sdci_set_clk(struct phytium_sdci_host *host, + struct mmc_ios *ios) +{ + unsigned long clk_rate; + u32 div = 0xffffffff, div_reg; + + if (ios->clock) { + clk_rate = host->clk_rate; + div = ((clk_rate / (2 * ios->clock)) - 1); + div_reg = readl(host->base + SDCI_CLOCK_D); + if (div_reg == div) + return; + writel(div, host->base + SDCI_CLOCK_D); + writel(0, host->base + SDCI_SD_DRV); + writel(5, host->base + SDCI_SD_SAMP); + + sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); + sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); + while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) + cpu_relax(); + dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", + host->clk_rate, ios->clock); + } +} + + +static inline u32 phytium_sdci_cmd_find_resp(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + u32 resp; + + switch (mmc_resp_type(cmd)) { + case MMC_RSP_R1: + resp = 0x2; + break; + case MMC_RSP_R1B: + resp = 0x2; + break; + case MMC_RSP_R2: + resp = 0x1; + break; + case MMC_RSP_R3: + resp = 0x3; + break; + case MMC_RSP_NONE: + default: + resp = 0x0; + break; + } + + return resp; +} + +static inline u32 phytium_sdci_cmd_prepare_raw_cmd(struct phytium_sdci_host *host, + struct mmc_request *mrq, struct mmc_command *cmd) +{ + /* + * rawcmd : + * trty << 14 | opcode << 8 | cmdw << 6 | cice << 4 | crce << 3 | resp + */ + u32 resp, rawcmd; + u32 opcode = cmd->opcode; + + resp = phytium_sdci_cmd_find_resp(host, mrq, cmd); + rawcmd = ((opcode << 8) | resp); + + if ((cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC) + rawcmd = (rawcmd | (SDCI_CMD_TYPE_ADTC << 14)); + + return rawcmd; +} + +static void +phytium_sdci_unexpected_error_handler(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_data *data, + int err_type) +{ + unsigned long flags; + int error; + + spin_lock_irqsave(&host->lock, flags); + host->mrq = NULL; + host->cmd = NULL; + host->data = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + if (err_type & ERR_CARD_ABSENT) { + host->mmc->detect_change = 1; + dev_dbg(host->dev, "SD is absent when send cmd:%d\n", mrq->cmd->opcode); + } + + switch (err_type) { + case ERR_CARD_ABSENT: + error = -ENOMEDIUM; + break; + case ERR_TIMEOUT: + error = -ETIMEDOUT; + break; + case ERR_CMD_RESPONED: + error = -EIO; + break; + default: + error = -ETIMEDOUT; + break; + } + + if (data) { + data->error = error; + phytium_sdci_unprepare_data(host, mrq); + + if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || + (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) + phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_R, mrq, data); + } else { + mrq->cmd->error = error; + } + + mmc_request_done(host->mmc, mrq); +} + +static bool phytium_sdci_start_data(struct phytium_sdci_host *host, struct mmc_request *mrq, + struct mmc_command *cmd, struct mmc_data *data) +{ + bool read, res; + u32 sg_dma_addrh, sg_dma_addrl; + u32 sd_block_addrh, sd_block_addrl; + u32 temp, timeout, sd_status; + u32 block_cnt = 0; + u32 sd_block_addr = cmd->arg; + u32 private_cmd, resp_type, arg; + u32 j, dma_len; + unsigned long deadline_time; + dma_addr_t dma_address; + struct scatterlist *sg; + int ret; + + WARN_ON(host->cmd); + host->cmd = cmd; + + WARN_ON(host->data); + host->data = data; + read = data->flags & MMC_DATA_READ; + + for_each_sg(data->sg, sg, data->sg_count, j) { + writel(0, host->base + SDCI_COMMAND); + + dma_address = sg_dma_address(sg); + sg_dma_addrh = (u32) (dma_address >> 32); + sg_dma_addrl = (u32) dma_address; + + dma_len = sg_dma_len(sg); + block_cnt = (dma_len / SD_BLOCK_SIZE); + + sd_block_addrh = 0; + sd_block_addrl = sd_block_addr; + + sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_BDRST); + sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_BDRST); + writel(block_cnt, host->base + SDCI_BLK_CNT); + + if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { + writel(sg_dma_addrl, host->base + SDCI_BD_RX); + writel(sg_dma_addrh, host->base + SDCI_BD_RX); + writel(sd_block_addrl, host->base + SDCI_BD_RX); + writel(sd_block_addrh, host->base + SDCI_BD_RX); + timeout = 100 * block_cnt; + } else { + timeout = 250 * block_cnt; + ret = phytium_sdci_cmd13_process(host, mrq, data, timeout, 1); + if (ret != SDCI_CMD13_OK) + return false; + + writel(sg_dma_addrl, host->base + SDCI_BD_TX); + writel(sg_dma_addrh, host->base + SDCI_BD_TX); + writel(sd_block_addrl, host->base + SDCI_BD_TX); + writel(sd_block_addrh, host->base + SDCI_BD_TX); + } + + deadline_time = jiffies + msecs_to_jiffies(timeout); + + temp = readl(host->base + SDCI_BD_ISR); + if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { + while ((temp & SDCI_BD_ISR_TRS_R) != SDCI_BD_ISR_TRS_R) { + sd_status = readl(host->base + SDCI_STATUS); + if (sd_status & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CARD_ABSENT); + if (temp & SDCI_BD_ISR_DAIS) + writel(1, host->base + SDCI_BD_ISR); + return false; + } + + temp = readl(host->base + SDCI_BD_ISR); + if (time_after(jiffies, deadline_time)) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_TIMEOUT); + dev_err(host->dev, + "Read Data timeout:jiffies:0x%lx,dt_jiffies: 0x%lx, BD_isr_reg:0x%x,cmd:%d, REG_D0:0x%x\n", + jiffies, jiffies - deadline_time, temp, + cmd->opcode, readl(host->base + SDCI_STATUS)); + + return false; + } + } + } else { + while ((temp & SDCI_BD_ISR_TRS_W) != SDCI_BD_ISR_TRS_W) { + sd_status = readl(host->base + SDCI_STATUS); + if (sd_status & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CARD_ABSENT); + dev_err(host->dev, "[%s][%d]: Card absent ! cmd(%d)\n", + __func__, __LINE__, mrq->cmd->opcode); + return false; + } + + temp = readl(host->base + SDCI_BD_ISR); + if (time_after(jiffies, deadline_time)) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_TIMEOUT); + dev_err(host->dev, + "Write Date timeout: jiffies:0x%lx,dt_jiffies: 0x%lx,BD_isr_reg:0x%x\n", + jiffies, jiffies - deadline_time, temp); + return false; + } + } + } + writel(1, host->base + SDCI_BD_ISR); + writel(1, host->base + SDCI_NORMAL_ISR); + sd_block_addr = sd_block_addr + block_cnt; + + if (j < (data->sg_count - 1) && 1 < block_cnt) { + private_cmd = MMC_STOP_TRANSMISSION; + resp_type = 0x2; + arg = 0; + res = phytium_sdci_private_send_cmd(host, private_cmd, + resp_type, arg); + if (!res) { + sd_status = readl(host->base + SDCI_STATUS); + if (sd_status & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CARD_ABSENT); + writel(1, host->base + SDCI_BD_ISR); + dev_err(host->dev, + "[%s][%d]:Card absent ! private_cmd(%d)\n", + __func__, __LINE__, private_cmd); + } else { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CMD_RESPONED); + dev_err(host->dev, + "[%s][%d] cmd(%d) response errored\n", + __func__, __LINE__, mrq->cmd->opcode); + phytium_sd_error(host); + } + writel(1, host->base + SDCI_NORMAL_ISR); + return false; + } + writel(1, host->base + SDCI_NORMAL_ISR); + } + } + + host->is_multi_rw_only_one_blkcnt = false; + + if ((cmd->opcode == MMC_READ_MULTIPLE_BLOCK && block_cnt == 1) || + (cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK && block_cnt == 1)) + host->is_multi_rw_only_one_blkcnt = true; + + phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_CC, mrq, cmd); + if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) + phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_R, + mrq, data); + else + phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_W, + mrq, data); + + return true; +} + +static int phytium_sdci_auto_cmd_done(struct phytium_sdci_host *host, + int events, struct mmc_command *cmd) +{ + u32 *rsp = cmd->resp; + + rsp[0] = readl(host->base + SDCI_RESP0); + + if (events & SDCI_NORMAL_ISR_CC) + cmd->error = 0; + else { + phytium_sdci_reset_hw(host); + dev_err(host->dev, + "%s: AUTO_CMD%d arg=%08X; rsp %08X; cmd_error=%d\n", + __func__, cmd->opcode, cmd->arg, rsp[0], cmd->error); + } + + return cmd->error; +} + +static void phytium_sdci_track_cmd_data(struct phytium_sdci_host *host, + struct mmc_command *cmd, + struct mmc_data *data) +{ + if (host->error) + dev_dbg(host->dev, "%s: cmd=%d arg=%08X; host->error=0x%08X\n", + __func__, cmd->opcode, cmd->arg, host->error); +} + +static void phytium_sdci_request_done(struct phytium_sdci_host *host, + struct mmc_request *mrq) +{ + unsigned long flags; + + dev_dbg(host->dev, + "%s_%d:mrq->cmd->opcode:%d, mrq->cmd->arg:0x%x resp 0x%x 0x%x 0x%x 0x%x\n", + __func__, __LINE__, mrq->cmd->opcode, mrq->cmd->arg, + mrq->cmd->resp[0], mrq->cmd->resp[1], mrq->cmd->resp[2], + mrq->cmd->resp[3]); + + spin_lock_irqsave(&host->lock, flags); + host->mrq = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + phytium_sdci_track_cmd_data(host, mrq->cmd, mrq->data); + if (mrq->data) + phytium_sdci_unprepare_data(host, mrq); + mmc_request_done(host->mmc, mrq); +} + +static bool +phytium_sdci_auto_command_done(struct phytium_sdci_host *host, int events, + struct mmc_request *mrq, struct mmc_command *cmd) +{ + u32 *rsp = cmd->resp; + unsigned long flags; + + spin_lock_irqsave(&host->lock, flags); + host->cmd = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + sdr_clr_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); + + rsp[0] = 0x900; + phytium_sdci_request_done(host, mrq); + return true; +} + +/* returns true if command is fully handled; returns false otherwise */ +static bool phytium_sdci_cmd_done(struct phytium_sdci_host *host, int events, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + bool done = false; + bool sbc_error; + unsigned long flags; + u32 *rsp = cmd->resp; + + if (mrq->sbc && cmd == mrq->cmd && + (events & SDCI_NORMAL_ISR_CC)) + phytium_sdci_auto_cmd_done(host, events, mrq->sbc); + + sbc_error = mrq->sbc && mrq->sbc->error; + + if (!sbc_error && !(events & (SDCI_NORMAL_ISR_CC | + SDCI_NORMAL_ISR_CR | + SDCI_NORMAL_ISR_TIMEOUT))) + return done; + + spin_lock_irqsave(&host->lock, flags); + done = !host->cmd; + host->cmd = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + if (done) + return true; + + sdr_clr_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); + + if (cmd->flags & MMC_RSP_PRESENT) { + if (cmd->flags & MMC_RSP_136) { + rsp[0] = readl(host->base + SDCI_RESP0); + rsp[1] = readl(host->base + SDCI_RESP1); + rsp[2] = readl(host->base + SDCI_RESP2); + rsp[3] = readl(host->base + SDCI_RESP3); + } else + rsp[0] = readl(host->base + SDCI_RESP0); + + if (cmd->opcode == SD_SEND_RELATIVE_ADDR) + host->current_rca = rsp[0] & 0xFFFF0000; + } + + if (!sbc_error && + !(events & SDCI_NORMAL_ISR_CC) && + (events & SDCI_NORMAL_ISR_TIMEOUT)) + cmd->error = -ETIMEDOUT; + + if (cmd->error) + dev_dbg(host->dev, + "%s: cmd=%d arg=%08X; rsp %08X; cmd_error=%d\n", + __func__, cmd->opcode, cmd->arg, rsp[0], + cmd->error); + + phytium_sdci_cmd_next(host, mrq, cmd); + + return true; +} + +static bool set_databus_width(struct phytium_sdci_host *host) +{ + bool res; + u32 cmd, resp_type, arg; + + cmd = SD_APP_SET_BUS_WIDTH; + resp_type = 0x2; + arg = 0x2; + res = phytium_sdci_private_send_cmd(host, cmd, resp_type, arg); + if (!res) + return false; + + cmd = MMC_APP_CMD; + resp_type = 0x2; + arg = host->current_rca; + res = phytium_sdci_private_send_cmd(host, cmd, resp_type, arg); + if (!res) + return false; + + return true; +} + + +static void phytium_sdci_start_command(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + u32 rawcmd; + struct mmc_data *data = mrq->data; + dma_addr_t dma_adtc_buf; + u32 dma_bufh, dma_bufl, block_cnt = 0; + + WARN_ON(host->cmd); + host->cmd = cmd; + + cmd->error = 0; + rawcmd = phytium_sdci_cmd_prepare_raw_cmd(host, mrq, cmd); + if (cmd->opcode == MMC_STOP_TRANSMISSION || + cmd->opcode == MMC_SEND_STATUS) + writel(1, host->base + SDCI_ERROR_ISR); + sdr_set_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); + writel(rawcmd, host->base + SDCI_COMMAND); + + if ((cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC) { + WARN_ON(host->data); + host->data = data; + + dma_adtc_buf = host->dma_rx.bd_addr; + dma_bufh = (u32) (dma_adtc_buf >> 32); + dma_bufl = (u32) dma_adtc_buf; + block_cnt = mrq->data->blocks; + sdr_set_bits(host->base + SDCI_BD_ISER, data_ints_mask); + writel(block_cnt, host->base + SDCI_BLK_CNT); + + if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { + writel(dma_bufl, host->base + SDCI_BD_RX); + writel(dma_bufh, host->base + SDCI_BD_RX); + writel(cmd->arg, host->base + SDCI_BD_RX); + writel(0, host->base + SDCI_BD_RX); + } else { + writel(dma_bufl, host->base + SDCI_BD_TX); + writel(dma_bufh, host->base + SDCI_BD_TX); + writel(cmd->arg, host->base + SDCI_BD_TX); + writel(0, host->base + SDCI_BD_TX); + } + } else { + writel(cmd->arg, host->base + SDCI_ARGUMENT); + } +} + +static void phytium_sdci_cmd_next(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + if (cmd->error || (mrq->sbc && mrq->sbc->error)) + phytium_sdci_request_done(host, mrq); + else if (cmd == mrq->sbc) + phytium_sdci_start_command(host, mrq, mrq->cmd); + else if (!cmd->data) + phytium_sdci_request_done(host, mrq); +} + +static int phytium_sdci_cmd13_process(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_data *data, + u32 wait_timeout_ms, + u32 send_once_time_ms) +{ + u32 private_cmd, resp_type, arg, temp, sd_status; + unsigned long deadline_time; + bool res; + + deadline_time = jiffies + msecs_to_jiffies(wait_timeout_ms); + + do { + private_cmd = MMC_SEND_STATUS; + resp_type = 0x2; + arg = host->current_rca; + + res = phytium_sdci_private_send_cmd(host, private_cmd, resp_type, arg); + if (!res) { + sd_status = readl(host->base + SDCI_STATUS); + if (sd_status & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CARD_ABSENT); + dev_err(host->dev, + "[%s][%d] Card absent! private_cmd(%d)\n", + __func__, __LINE__, private_cmd); + } else { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CMD_RESPONED); + + dev_err(host->dev, + "[%s][%d] private_cmd(%d) response errored\n", + __func__, __LINE__, private_cmd); + phytium_sd_error(host); + } + writel(1, host->base + SDCI_BD_ISR); + return SDCI_CMD13_FAILED; + } + + temp = readl(host->base + SDCI_RESP0); + + if (time_after(jiffies, deadline_time)) { + + if (mrq->cmd->opcode == MMC_SEND_STATUS) + return SDCI_CMD13_OK; + + dev_err(host->dev, + "SD card is not in transfer mode,timeout:%d,rsp[0]:%x\n", + wait_timeout_ms, temp); + + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_TIMEOUT); + phytium_sd_error(host); + return SDCI_CMD13_FAILED; + } + + writel(1, host->base + SDCI_NORMAL_ISR); + + if (CARD_TRAN_STATE != (temp & CARD_CURRENT_STATE) && send_once_time_ms) + mdelay(send_once_time_ms); + + } while (CARD_TRAN_STATE != (temp & CARD_CURRENT_STATE)); + + return SDCI_CMD13_OK; +} + +static void phytium_sdci_ops_request(struct mmc_host *mmc, + struct mmc_request *mrq) +{ + struct phytium_sdci_host *host = mmc_priv(mmc); + unsigned long flags; + bool res; + u32 status_sd; + int res_cmd13; + + host->error = 0; + WARN_ON(host->mrq); + host->mrq = mrq; + + dev_dbg(host->dev, "%s: mrq->cmd->opcode: %d, mrq->cmd->arg: 0x%x\n", + __func__, mrq->cmd->opcode, mrq->cmd->arg); + + if (mrq->cmd->opcode == MMC_SEND_STATUS && + (mrq->cmd->flags & MMC_CMD_MASK) != MMC_CMD_ADTC) { + u32 status = readl(host->base + SDCI_STATUS); + + if (status & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, NULL, + ERR_CARD_ABSENT); + return; + } + + res_cmd13 = phytium_sdci_cmd13_process(host, mrq, NULL, 400, 5); + if (res_cmd13 == SDCI_CMD13_FAILED) + return; + } else if (mrq->cmd->opcode == MMC_STOP_TRANSMISSION) { + status_sd = readl(host->base + SDCI_STATUS); + if (status_sd & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, NULL, + ERR_CARD_ABSENT); + return; + } + } + + if (mrq->data) { + phytium_sdci_prepare_data(host, mrq); + if (mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK || + mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK || + mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK || + mrq->cmd->opcode == MMC_WRITE_BLOCK) { + host->adtc_type = BLOCK_RW_ADTC; + phytium_sdci_start_data(host, mrq, + mrq->cmd, mrq->data); + return; + } + host->adtc_type = COMMOM_ADTC; + } + + if (mrq->cmd->opcode == SD_IO_RW_DIRECT || + mrq->cmd->opcode == SD_IO_SEND_OP_COND) { + spin_lock_irqsave(&host->lock, flags); + host->mrq = NULL; + host->cmd = NULL; + spin_unlock_irqrestore(&host->lock, flags); + mrq->cmd->error = -EINVAL; + mmc_request_done(host->mmc, mrq); + + return; + } + + if (mrq->cmd->opcode == SD_APP_SEND_SCR) { + res = set_databus_width(host); + if (!res) { + phytium_sdci_unexpected_error_handler(host, mrq, NULL, ERR_CMD_RESPONED); + return; + } + } + + /* if SBC is required, we have HW option and SW option. + * if HW option is enabled, and SBC does not have "special" flags, + * use HW option, otherwise use SW option + */ + if (mrq->sbc && + (!mmc_card_mmc(mmc->card) || (mrq->sbc->arg & 0xFFFF0000))) + phytium_sdci_start_command(host, mrq, mrq->sbc); + else + phytium_sdci_start_command(host, mrq, mrq->cmd); +} + +static void phytium_sdci_data_xfer_next(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_data *data) +{ + if (mmc_op_multi(mrq->cmd->opcode) && + mrq->stop && !mrq->stop->error && + !mrq->sbc && host->is_multi_rw_only_one_blkcnt) { + host->is_multi_rw_only_one_blkcnt = false; + phytium_sdci_auto_command_done(host, SDCI_NORMAL_ISR_CC, mrq, mrq->stop); + } else if (mmc_op_multi(mrq->cmd->opcode) && + mrq->stop && !mrq->stop->error && + !mrq->sbc) + phytium_sdci_start_command(host, mrq, mrq->stop); + else + phytium_sdci_request_done(host, mrq); +} + +static inline void get_data_buffer(struct mmc_data *data, + u32 *bytes, u32 **pointer) +{ + struct scatterlist *sg; + + sg = &data->sg[0]; + *bytes = sg->length; + *pointer = sg_virt(sg); +} + +static bool phytium_sdci_data_xfer_done(struct phytium_sdci_host *host, + u32 events, struct mmc_request *mrq, + struct mmc_data *data) +{ + struct mmc_command *stop = data->stop; + unsigned long flags; + bool done; + unsigned int check_data; + u32 sg_length, i; + u32 *sg_virt_addr; + + check_data = events & (SDCI_BD_ISR_TRS_R | SDCI_BD_ISR_TRS_W | SDCI_BD_ISR_EDTE); + + spin_lock_irqsave(&host->lock, flags); + done = !host->data; + if (check_data) + host->data = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + if (done) + return true; + + if (check_data || (stop && stop->error)) { + sdr_clr_bits(host->base + SDCI_BD_ISER, data_ints_mask); + dev_dbg(host->dev, "DMA stop\n"); + + if (((events & SDCI_BD_ISR_TRS_R) || + (events & SDCI_BD_ISR_TRS_W)) && + (!stop || !stop->error)) { + if ((mrq->cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC && + (host->adtc_type == COMMOM_ADTC)) { + get_data_buffer(data, &sg_length, + &host->sg_virt_addr); + sg_virt_addr = host->sg_virt_addr; + + for (i = 0; i < (sg_length/4); i++) { + *sg_virt_addr = host->dma_rx.buf[i]; + sg_virt_addr++; + } + } + data->bytes_xfered = data->blocks * data->blksz; + } else { + dev_dbg(host->dev, "interrupt events: %x\n", events); + phytium_sdci_reset_hw(host); + data->bytes_xfered = 0; + dev_dbg(host->dev, "%s: cmd=%d; blocks=%d", + __func__, mrq->cmd->opcode, data->blocks); + dev_dbg(host->dev, "data_error=%d xfer_size=%d\n", + (int)data->error, data->bytes_xfered); + } + + phytium_sdci_data_xfer_next(host, mrq, data); + done = true; + } + + return done; +} + + +static int phytium_sdci_card_busy(struct mmc_host *mmc) +{ + struct phytium_sdci_host *host = mmc_priv(mmc); + u32 status; + + /* check if any pin between dat[0:3] is low */ + status = readl(host->base + SDCI_STATUS); + if (((status >> 20) & 0xf) != 0xf) + return 1; + + return 0; +} + +static void phytium_sdci_request_timeout(struct work_struct *work) +{ + struct phytium_sdci_host *host; + + host = container_of(work, struct phytium_sdci_host, req_timeout.work); + dev_err(host->dev, "%s: aborting cmd/data/mrq\n", __func__); + if (host->mrq) { + dev_err(host->dev, "%s: aborting mrq=%p cmd=%d\n", __func__, + host->mrq, host->mrq->cmd->opcode); + if (host->cmd) { + dev_err(host->dev, "%s: aborting cmd=%d\n", + __func__, host->cmd->opcode); + phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_TIMEOUT, + host->mrq, host->cmd); + } else if (host->data) { + dev_err(host->dev, "%s: abort data: cmd%d; %d blocks\n", + __func__, host->mrq->cmd->opcode, + host->data->blocks); + phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_EDTE, + host->mrq, host->data); + } + } +} + +static void hotplug_timer_func(struct timer_list *t) +{ + struct phytium_sdci_host *host; + u32 status; + + host = from_timer(host, t, hotplug_timer); + if (!host) + dev_err(host->dev, "%s: Not find host!\n", __func__); + status = readl(host->base + SDCI_STATUS); + + if (status & SDCI_STATUS_CDSL) { /* card absent */ + if (host->mmc->card) { + cancel_delayed_work(&host->mmc->detect); + mmc_detect_change(host->mmc, + msecs_to_jiffies(100)); + } + } else { /* card insert */ + cancel_delayed_work(&host->mmc->detect); + mmc_detect_change(host->mmc, msecs_to_jiffies(200)); + } +} + +static irqreturn_t phytium_sdci_irq(int irq, void *dev_id) +{ + struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; + unsigned long flags; + struct mmc_request *mrq; + struct mmc_command *cmd; + u32 events; + + if (!host) + return IRQ_NONE; + + spin_lock_irqsave(&host->lock, flags); + events = readl(host->base + SDCI_NORMAL_ISR); + /* clear interrupts */ + writel(1, host->base + SDCI_NORMAL_ISR); + + mrq = host->mrq; + cmd = host->cmd; + spin_unlock_irqrestore(&host->lock, flags); + + if (events & (SDCI_NORMAL_ISR_CR | SDCI_NORMAL_ISR_CI)) { + mod_timer(&host->hotplug_timer, + jiffies + usecs_to_jiffies(30000)); + goto irq_out; + } + + if (!(events & cmd_ints_mask)) + goto irq_out; + + if (!mrq) { + dev_err(host->dev, "%s: MRQ=NULL; events=%08X\n", + __func__, events); + WARN_ON(1); + goto irq_out; + } + + dev_dbg(host->dev, "%s: events=%08X\n", __func__, events); + + if (cmd) + phytium_sdci_cmd_done(host, events, mrq, cmd); + +irq_out: + return IRQ_HANDLED; +} + +static irqreturn_t phytium_sdci_dma_irq(int irq, void *dev_id) +{ + struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; + unsigned long flags; + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + u32 events; + + spin_lock_irqsave(&host->lock, flags); + events = readl(host->base + SDCI_BD_ISR); + writel(1, host->base + SDCI_BD_ISR); + + mrq = host->mrq; + cmd = host->cmd; + data = host->data; + spin_unlock_irqrestore(&host->lock, flags); + + if (!(events & data_ints_mask)) + goto dma_irq_out; + + if (!mrq) { + dev_err(host->dev, + "%s: MRQ=NULL; events=%08X\n", + __func__, events); + goto dma_irq_out; + } + + dev_dbg(host->dev, "%s: events=%08X\n", __func__, events); + + if (data) + phytium_sdci_data_xfer_done(host, events, mrq, data); + +dma_irq_out: + return IRQ_HANDLED; +} + +static irqreturn_t phytium_sdci_err_irq(int irq, void *dev_id) +{ + struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; + unsigned long flags; + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + u32 events; + + if (!host) + return IRQ_NONE; + + spin_lock_irqsave(&host->lock, flags); + events = readl(host->base + SDCI_ERROR_ISR); + mrq = host->mrq; + cmd = host->cmd; + data = host->data; + spin_unlock_irqrestore(&host->lock, flags); + + if (!(events&err_ints_mask)) + goto err_irq_out; + + if (!mrq) { + sdr_clr_bits(host->base + SDCI_NORMAL_ISER, SDCI_NORMAL_ISR_EI); + writel(1, host->base + SDCI_ERROR_ISR); + dev_err(host->dev, "%s: MRQ=NULL; events=%08X\n", __func__, events); + goto err_irq_out; + } + sdr_clr_bits(host->base + SDCI_NORMAL_ISER, SDCI_NORMAL_ISR_EI); + if (data) { + dev_err(host->dev, + "[%s][%d]: cmd(%d); %d read blocks, status:%x,flag:%x\n", + __func__, __LINE__, mrq->cmd->opcode, data->blocks, events, data->flags); + data->error = -ETIMEDOUT; + if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || + (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) + phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_EDTE | SDCI_BD_ISR_TRS_R, + mrq, data); + mrq->cmd->error = -ETIMEDOUT; + mmc_request_done(host->mmc, mrq); + } else if (cmd) { + phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_TIMEOUT, mrq, cmd); + } + + writel(1, host->base + SDCI_NORMAL_ISR); + writel(1, host->base + SDCI_ERROR_ISR); +err_irq_out: + return IRQ_HANDLED; +} + +static void phytium_sdci_init_hw(struct phytium_sdci_host *host) +{ + u32 val; + + /* Reset */ + phytium_sdci_reset_hw(host); + + val = SDCI_SEN_CREFR_VAL | SDCI_SEN_DEBNCE_VAL; + writel(val, host->base + SDCI_SD_SEN); + + /* Disable and clear all interrupts */ + writel(0, host->base + SDCI_NORMAL_ISER); + writel(0, host->base + SDCI_ERROR_ISER); + writel(0, host->base + SDCI_BD_ISER); + + writel(1, host->base + SDCI_NORMAL_ISR); + writel(1, host->base + SDCI_ERROR_ISR); + writel(1, host->base + SDCI_BD_ISR); + + sdr_set_bits(host->base + SDCI_NORMAL_ISER, + SDCI_SDCI_NORMAL_ISER_ECI|SDCI_SDCI_NORMAL_ISER_ECR); + /* Configure default cmd timeout to 0.1(s)s = val/25M */ + val = SDCI_F_MAX / 10; + writel(val, host->base + SDCI_TIMEOUT_CMD); + writel(SDCI_TIMEOUT_DATA_VALUE, host->base + SDCI_TIMEOUT_DATA); + + val = 0x0F00; + writel(val, host->base + SDCI_CONTROLLER); + + dev_dbg(host->dev, "init hardware done!"); +} + +static void phytium_sdci_deinit_hw(struct phytium_sdci_host *host) +{ + /* Disable and clear all interrupts */ + writel(0, host->base + SDCI_NORMAL_ISER); + writel(0, host->base + SDCI_ERROR_ISER); + writel(0, host->base + SDCI_BD_ISER); + + writel(0, host->base + SDCI_NORMAL_ISR); + writel(0, host->base + SDCI_ERROR_ISR); + writel(0, host->base + SDCI_BD_ISR); +} + +static void phytium_sdci_ops_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) +{ + struct phytium_sdci_host *host = mmc_priv(mmc); + + if (ios->bus_width == MMC_BUS_WIDTH_4) + mmc->caps = mmc->caps & (~MMC_CAP_4_BIT_DATA); + + /* Suspend/Resume will do power off/on */ + switch (ios->power_mode) { + case MMC_POWER_UP: + writel(SDCI_POWER_ON, host->base + SDCI_POWER); + break; + case MMC_POWER_ON: + phytium_sdci_set_clk(host, ios); + break; + case MMC_POWER_OFF: + writel(SDCI_POWER_OFF, host->base + SDCI_POWER); + break; + default: + break; + } +} + +static int phytium_sdci_get_cd(struct mmc_host *mmc) +{ + struct phytium_sdci_host *host = mmc_priv(mmc); + u32 status = readl(host->base + SDCI_STATUS); + + if (((status >> 19) & 0x1) == 0x1) + return 0; + + return 1; +} + +static void phytium_sdci_hw_reset(struct mmc_host *mmc) +{ + struct phytium_sdci_host *host = mmc_priv(mmc); + + sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); + sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); + while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) + cpu_relax(); +} + +static struct mmc_host_ops phytium_sdci_ops = { + .request = phytium_sdci_ops_request, + .set_ios = phytium_sdci_ops_set_ios, + .get_cd = phytium_sdci_get_cd, + .card_busy = phytium_sdci_card_busy, + .hw_reset = phytium_sdci_hw_reset, +}; + +static bool phytium_sdci_private_send_cmd(struct phytium_sdci_host *host, + u32 cmd, u32 resp_type, u32 arg) +{ + u32 temp, sd_cmd, sd_arg, sd_status; + unsigned long deadline_time; + + writel(1, host->base + SDCI_NORMAL_ISR); + writel(1, host->base + SDCI_ERROR_ISR); + + sd_cmd = (cmd << 8) | resp_type; + sd_arg = arg; + writel(sd_cmd, host->base + SDCI_COMMAND); + writel(sd_arg, host->base + SDCI_ARGUMENT); + + if (cmd == MMC_STOP_TRANSMISSION) + deadline_time = jiffies + msecs_to_jiffies(1000); + else + deadline_time = jiffies + msecs_to_jiffies(100); + + temp = readl(host->base + SDCI_NORMAL_ISR); + while ((temp & SDCI_NORMAL_ISR_CC) != SDCI_NORMAL_ISR_CC) { + sd_status = readl(host->base + SDCI_STATUS); + if (sd_status & SDCI_STATUS_CDSL) + return false; + + temp = readl(host->base + SDCI_NORMAL_ISR); + if (time_after(jiffies, deadline_time)) + return false; + + if (cmd == MMC_STOP_TRANSMISSION) + mdelay(1); + } + + return true; +} + +static int phytium_sdci_probe(struct platform_device *pdev) +{ + struct mmc_host *mmc; + struct phytium_sdci_host *host; + struct resource *res; + int ret; + const struct acpi_device_id *match; + struct device *dev = &pdev->dev; + + /* Allocate MMC host for this device */ + mmc = mmc_alloc_host(sizeof(struct phytium_sdci_host), &pdev->dev); + if (!mmc) + return -ENOMEM; + + host = mmc_priv(mmc); + ret = mmc_of_parse(mmc); + if (ret) + goto host_free; + + if (dev->of_node) { + host->src_clk = devm_clk_get(&pdev->dev, "phytium_sdc_clk"); + if (IS_ERR(host->src_clk)) { + ret = PTR_ERR(host->src_clk); + goto host_free; + } + + host->clk_rate = clk_get_rate(host->src_clk); + if (device_property_read_bool(dev, "no-dma-coherent")) + dev->dma_coherent = false; + } else if (has_acpi_companion(dev)) { + match = acpi_match_device(dev->driver->acpi_match_table, dev); + if (!match) { + dev_err(dev, "Error ACPI match data is missing\n"); + return -ENODEV; + } + + acpi_dma_configure(dev, DEV_DMA_NOT_SUPPORTED); + + host->clk_rate = 600000000; + } else { + dev_err(&pdev->dev, "No DT found\n"); + return -EINVAL; + } + + dma_set_mask(dev, DMA_BIT_MASK(40)); + dma_set_coherent_mask(dev, DMA_BIT_MASK(40)); + + timer_setup(&host->hotplug_timer, hotplug_timer_func, 0); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + host->base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(host->base)) { + ret = PTR_ERR(host->base); + goto host_free; + } + + host->irq = platform_get_irq(pdev, 1); + if (host->irq < 0) { + ret = -EINVAL; + goto host_free; + } + + host->irq_err = platform_get_irq(pdev, 2); + if (host->irq_err < 0) { + ret = -EINVAL; + goto host_free; + } + + host->irq_bd = platform_get_irq(pdev, 0); + if (host->irq_bd < 0) { + ret = -EINVAL; + goto host_free; + } + + host->dev = &pdev->dev; + host->mmc = mmc; + + if ((4 * SDCI_F_MAX) > host->clk_rate) + host->clk_div = 1; + else + host->clk_div = ((host->clk_rate / (2 * SDCI_F_MAX)) - 1); + + /* Set host parameters to mmc */ + mmc->f_min = SDCI_F_MIN; + mmc->f_max = (host->clk_rate / ((host->clk_div + 1) * 2)); + mmc->ops = &phytium_sdci_ops; + mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; + + mmc->caps |= host->caps; + /* MMC core transfer sizes tunable parameters */ + mmc->max_segs = MAX_BD_NUM; + mmc->max_seg_size = 512 * 1024; + mmc->max_blk_size = 512; + mmc->max_req_size = 512 * 1024; + mmc->max_blk_count = mmc->max_req_size / 512; + + host->dma_rx.buf = dma_alloc_coherent(&pdev->dev, + MAX_BD_NUM, + &host->dma_rx.bd_addr, + GFP_KERNEL); + if (!host->dma_rx.buf) { + ret = -ENOMEM; + goto release_mem; + } + + host->cmd_timeout = msecs_to_jiffies(100); + host->data_timeout = msecs_to_jiffies(250); + + INIT_DELAYED_WORK(&host->req_timeout, phytium_sdci_request_timeout); + spin_lock_init(&host->lock); + + platform_set_drvdata(pdev, mmc); + phytium_sdci_init_hw(host); + + ret = devm_request_irq(&pdev->dev, host->irq, phytium_sdci_irq, + IRQF_SHARED, pdev->name, host); + if (ret) + goto release; + + ret = devm_request_irq(&pdev->dev, host->irq_err, phytium_sdci_err_irq, + IRQF_SHARED, pdev->name, host); + if (ret) + goto release; + + ret = devm_request_irq(&pdev->dev, host->irq_bd, phytium_sdci_dma_irq, + IRQF_SHARED, pdev->name, host); + if (ret) + goto release; + + ret = mmc_add_host(mmc); + if (ret) + goto release; + + return 0; + +release: + platform_set_drvdata(pdev, NULL); + phytium_sdci_deinit_hw(host); +release_mem: + if (host->dma_rx.buf) + dma_free_coherent(&pdev->dev, MAX_BD_NUM, + host->dma_rx.buf, + host->dma_rx.bd_addr); +host_free: + mmc_free_host(mmc); + + return ret; +} + +static int phytium_sdci_remove(struct platform_device *pdev) +{ + struct mmc_host *mmc; + struct phytium_sdci_host *host; + + mmc = platform_get_drvdata(pdev); + host = mmc_priv(mmc); + + cancel_delayed_work_sync(&host->req_timeout); + platform_set_drvdata(pdev, NULL); + mmc_remove_host(host->mmc); + phytium_sdci_deinit_hw(host); + + if (host->dma_rx.buf) + dma_free_coherent(&pdev->dev, MAX_BD_NUM, + host->dma_rx.buf, host->dma_rx.bd_addr); + + mmc_free_host(host->mmc); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_sdci_suspend(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_sdci_host *host = mmc_priv(mmc); + + phytium_sdci_deinit_hw(host); + return 0; +} + +static int phytium_sdci_resume(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_sdci_host *host = mmc_priv(mmc); + + phytium_sdci_init_hw(host); + mmc->caps = mmc->caps | MMC_CAP_4_BIT_DATA; + + return 0; +} +#endif + +#ifdef CONFIG_PM +static int phytium_sdci_runtime_suspend(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_sdci_host *host = mmc_priv(mmc); + + phytium_sdci_deinit_hw(host); + + return 0; +} + +static int phytium_sdci_runtime_resume(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_sdci_host *host = mmc_priv(mmc); + + phytium_sdci_init_hw(host); + + return 0; +} + +static const struct dev_pm_ops phytium_sdci_dev_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_sdci_suspend, + phytium_sdci_resume) + SET_RUNTIME_PM_OPS(phytium_sdci_runtime_suspend, + phytium_sdci_runtime_resume, NULL) +}; +#else +#define phytium_sdci_dev_pm_ops NULL +#endif + +static const struct of_device_id phytium_sdci_of_ids[] = { + { .compatible = "phytium,sdci", }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_sdci_of_ids); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_sdci_acpi_ids[] = { + { .id = "PHYT0005" }, + { } +}; + +MODULE_DEVICE_TABLE(acpi, phytium_sdci_acpi_ids); +#else +#define phytium_sdci_acpi_ids NULL +#endif + +static struct platform_driver phytium_sdci_driver = { + .probe = phytium_sdci_probe, + .remove = phytium_sdci_remove, + .driver = { + .name = "sdci-phytium", + .of_match_table = phytium_sdci_of_ids, + .acpi_match_table = phytium_sdci_acpi_ids, + .pm = &phytium_sdci_dev_pm_ops, + }, +}; + +module_platform_driver(phytium_sdci_driver); + +MODULE_LICENSE("GPL v2"); +MODULE_AUTHOR("Cheng Quan "); +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium SD Card Interface driver"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-sdci.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-sdci.h new file mode 100755 index 0000000000000000000000000000000000000000..01cfd89702e077f71e569828f53ce938d4fe318d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mmc/host/phytium-sdci.h @@ -0,0 +1,200 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium SD Card Interface driver + * + * Copyright (c) 2019-2024 Phytium Technology Co.,Ltd. + */ + +/*---------------------------------------------------------------------------*/ +/* Common Definition */ +/*---------------------------------------------------------------------------*/ +#define MAX_BD_NUM 0x1000 +#define SD_BLOCK_SIZE 512 + +/*---------------------------------------------------------------------------*/ +/* Register Offset */ +/*---------------------------------------------------------------------------*/ +#define SDCI_CONTROLLER 0x00 /* controller config reg */ +#define SDCI_ARGUMENT 0x04 /* argument reg */ +#define SDCI_COMMAND 0x08 /* command reg */ +#define SDCI_CLOCK_D 0x0C /* clock divide reg */ +#define SDCI_SOFTWARE 0x10 /* controller reset reg */ +#define SDCI_POWER 0X14 /* POWRE CONTROL REG */ +#define SDCI_TIMEOUT_CMD 0x18 /* cmd timeout config reg */ +#define SDCI_TIMEOUT_DATA 0x1C /* data timeout reg */ +#define SDCI_NORMAL_ISER 0x20 /* normal ISR config reg */ +#define SDCI_ERROR_ISER 0x24 /* erroe ISR config reg */ +#define SDCI_BD_ISER 0x28 /* BD ISR config reg */ +#define SDCI_CAPA 0x2C /* BD ISR config reg */ +#define SDCI_SD_DRV 0x30 /* SD card driving phase position reg */ +#define SDCI_SD_SAMP 0x34 /* SD card sampling phase position reg */ +#define SDCI_SD_SEN 0x38 /* SD card detection reg */ +#define SDCI_HDS_AXI 0x3C /* AXI boundary config reg */ +#define SDCI_BD_RX 0x40 /* BD rx addr reg */ +#define SDCI_BD_TX 0x60 /* BD tx addr reg */ +#define SDCI_BLK_CNT 0x80 /* r/w block num reg */ +#define SDCI_NORMAL_ISR 0xC0 /* normal ISR status reg */ +#define SDCI_ERROR_ISR 0xC4 /* error ISR status reg */ +#define SDCI_BD_ISR 0xC8 /* BD ISR status reg */ +#define SDCI_BD_STATUS 0xCC /* BD descriptor status reg */ +#define SDCI_STATUS 0xD0 /* status reg */ +#define SDCI_BLOCK 0xD4 /* block len reg */ +#define SDCI_RESP0 0xE0 /* response reg0 */ +#define SDCI_RESP1 0xE4 /* response reg1 */ +#define SDCI_RESP2 0xE8 /* response reg2 */ +#define SDCI_RESP3 0XEC /* response reg3 */ + +/*---------------------------------------------------------------------------*/ +/* Register Mask */ +/*---------------------------------------------------------------------------*/ +/* SDCI_CONTROLLER mask */ +#define SDCI_CONTROLLER_ECRCWR (0x1 << 0) /* RW */ +#define SDCI_CONTROLLER_ECRCRD (0x1 << 1) /* RW */ +#define SDCI_CONTROLLER_RESEDE (0x1 << 2) /* RW */ +#define SDCI_CONTROLLER_PERMDR (0x3 << 8) /* RW */ +#define SDCI_CONTROLLER_PERMDX (0x3 << 10) /* RW */ + +/* SDCI_SOFTWARE mask */ +#define SDCI_SOFTWARE_SRST (0x1 << 0) /* RW */ +#define SDCI_SOFTWARE_SCRST (0x1 << 1) /* RW */ +#define SDCI_SOFTWARE_BDRST (0x1 << 2) /* RW */ +#define SDCI_SOFTWARE_CFCLF (0x1 << 3) /* RW */ +#define SDCI_SOFTWARE_SDRST (0x1 << 4) /* RW */ + +/* SDCI_NORMAL_ISER mask */ +#define SDCI_SDCI_NORMAL_ISER_ECC_EN (0x1 << 0) /* RW */ +#define SDCI_SDCI_NORMAL_ISER_ECR (0x1 << 1) /* RW */ +#define SDCI_SDCI_NORMAL_ISER_ECI (0x1 << 2) /* RW */ +#define SDCI_SDCI_NORMAL_ISER_EEI_EN (0x1 << 15) /* RW */ + +/* SDCI_NORMAL_ISR mask */ +#define SDCI_NORMAL_ISR_CC (0x1 << 0) /* R */ +#define SDCI_NORMAL_ISR_CR (0x1 << 1) /* R */ +#define SDCI_NORMAL_ISR_CI (0x1 << 2) /* R */ +#define SDCI_NORMAL_ISR_TIMEOUT (0x1 << 3) /* R */ +#define SDCI_NORMAL_ISR_EI (0x1 << 15) /* R */ + +/* SDCI_ERROR_ISER mask */ +#define SDCI_ERROR_ISER_ECTE_EN (0x1 << 0) /* RW */ +#define SDCI_ERROR_ISR_CCRCE_EN (0x1 << 1) /* RW */ +#define SDCI_ERROR_ISR_CIR_EN (0x1 << 3) /* RW */ +#define SDCI_ERROR_ISR_CNR_EN (0x1 << 4) /* RW */ +/* SDCI_ERROR_ISR mask */ +#define SDCI_ERROR_ISR_CTE (0x1 << 0) /* R */ +#define SDCI_ERROR_ISR_CCRCE (0x1 << 1) /* R */ +#define SDCI_ERROR_ISR_CIR (0x1 << 3) /* R */ +#define SDCI_ERROR_ISR_CNR (0x1 << 4) /* R */ + +/* SDCI_BD_ISER mask */ +#define SDCI_BD_ISER_ETRS_EN (0x1 << 8) /* RW */ +#define SDCI_BD_ISER_DATFRAX_EN (0x1 << 7) /* RW */ + +/* SDCI_BD_ISR mask */ +#define SDCI_BD_ISR_TRS_W (0x1 << 0) /* R */ +#define SDCI_BD_ISR_TRS_R (0x1 << 8) /* R */ +#define SDCI_BD_ISR_EDTE (0x1 << 3) /* R */ +#define SDCI_BD_ISR_DAIS (0x1 << 15) /* R */ +#define SDCI_BD_ISR_DATFRAX (0x1 << 7) /* R */ + +/* SDCI_HDS_AXI mask */ +#define SDCI_HDS_AXI_AWDOMAIN (0x1 << 0) /* RW */ +#define SDCI_HDS_AXI_ARDOMAIN (0x1 << 12) /* RW */ +#define SDCI_HDS_AXI_AWCACHE (0x6 << 24) /* RW */ +#define SDCI_HDS_AXI_ARCACHE (0xB << 28) /* RW */ + +/* SDCI_STATUS mask */ +#define SDCI_STATUS_CMD_BUSY (0x0 << 0) /* R */ +#define SDCI_STATUS_CMD_READY (0x1 << 0) /* R */ +#define SDCI_STATUS_IDIE (0x1 << 12) /* R */ +#define SDCI_CARD_BUSY_IN_PRG (0x1 << 20) /* R D0 BUSY:0,IDLE:1 */ + +/* SDCI_STATUS */ +#define SDCI_STATUS_CDSL (0x1 << 19) /* R */ + +/*---------------------------------------------------------------------------*/ +/* Register Value */ +/*---------------------------------------------------------------------------*/ +#define SDCI_SD_DRV_VALUE 0 +#define SDCI_SD_SAMP_VALUE_MAX 50 +#define SDCI_SD_SAMP_VALUE_MIN 0 + +#define SDCI_TIMEOUT_CMD_VALUE 0xFFFFFFFF +#define SDCI_TIMEOUT_DATA_VALUE 0xFFFFFFFF +#define SDCI_POWER_ON 1 +#define SDCI_POWER_OFF 0 + +#define SDCI_CMD_TIMEOUT 10 +#define SDCI_DAT_TIMEOUT 5000 + +#define SDCI_CMD_TYPE_ADTC 0x2 + +#define SDCI_F_MIN 400000 +#define SDCI_F_MAX 25000000 + +#define SDCI_SEN_CREFR_VAL (0x1 << 1) +#define SDCI_SEN_DEBNCE_VAL (0xB << 8) + +#define CARD_CURRENT_STATE (0xF << 9) +#define CARD_PRG_STATE (0x7 << 9) +#define CARD_TRAN_STATE (0x4 << 9) + +#define SDCI_CMD13_OK 1 +#define SDCI_CMD13_FAILED 0 + +#define ERR_TIMEOUT (0x1 << 0) +#define ERR_CARD_ABSENT (0x1 << 1) +#define ERR_CMD_RESPONED (0x1 << 2) + +/*---------------------------------------------------------------------------*/ +/* Structure Type */ +/*---------------------------------------------------------------------------*/ +struct phytium_sdci_dma { + struct scatterlist *sg; + u32 *buf; + dma_addr_t bd_addr; + size_t bytes; +}; + +enum adtc_type { + COMMOM_ADTC = 0, + BLOCK_RW_ADTC, +}; + +struct phytium_sdci_host { + struct device *dev; + struct mmc_host *mmc; + u32 caps; + spinlock_t lock; + + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + int error; + + void __iomem *base; + + struct phytium_sdci_dma dma_rx; + struct phytium_sdci_dma dma_tx; + + u32 *sg_virt_addr; + enum adtc_type adtc_type; + + struct timer_list hotplug_timer; + + struct delayed_work req_timeout; + u32 cmd_timeout; + u32 data_timeout; + + int irq; + int irq_err; + int irq_bd; + + struct clk *src_clk; + unsigned long clk_rate; + unsigned long clk_div; + unsigned long real_rate; + + u32 current_rca; + bool is_multi_rw_only_one_blkcnt; +}; + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..6be02bc9739c64e7a05c7cd5de26403db351b58a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/Makefile @@ -0,0 +1 @@ +obj-y += raw/ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..522662b15edaa10ed175772bc9df6fbeebef5230 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/Kconfig @@ -0,0 +1,20 @@ +config MTD_NAND_PHYTIUM + tristate + +config MTD_NAND_PHYTIUM_PCI + tristate "Support Phytium NAND controller as a PCI device" + select MTD_NAND_PHYTIUM + depends on PCI + help + Enable the driver for NAND flash controller of Phytium Px210 chipset, + using the Phytium NAND controller core. + +config MTD_NAND_PHYTIUM_PLAT + tristate "Support Phytium NAND controller as a platform device" + select MTD_NAND_PHYTIUM + depends on ARCH_PHYTIUM + help + Enable the driver for NAND flash controller of Phytium CPU chipset, + using the Phytium NAND controller core. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..77ecd2beb72f440e5cdd00500f542137edf69946 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/Makefile @@ -0,0 +1,4 @@ +obj-$(CONFIG_MTD_NAND_PHYTIUM) += phytium_nand.o +obj-$(CONFIG_MTD_NAND_PHYTIUM_PCI) += phytium_nand_pci.o +obj-$(CONFIG_MTD_NAND_PHYTIUM_PLAT) += phytium_nand_plat.o + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand.c new file mode 100644 index 0000000000000000000000000000000000000000..1c8e27d7151c97ba8864a57af60195ce6a870b47 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand.c @@ -0,0 +1,2167 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Core driver for Phytium NAND flash controller + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "phytium_nand.h" + +#define NFC_DATA_CMD_DEBUG 0 + +u16 timing_asy_mode0[TIMING_ASY_NUM] = { /* x100 pass, sample: 1 */ + 0x03, 0x03, 0x28, 0x28, 0x03, 0x03, 0x06, 0x06, 0x28, 0x70, 0x30, 0x50}; +u16 timing_asy_mode1[TIMING_ASY_NUM] = { /* x100 pass, sample: 1 */ + 0x03, 0x03, 0x14, 0x14, 0x03, 0x03, 0x06, 0x06, 0x14, 0x70, 0x30, 0x28}; +u16 timing_asy_mode2[TIMING_ASY_NUM] = { /* x100 pass, sample: 7/8 (unlic) */ + 0x03, 0x03, 0x0D, 0x0D, 0x03, 0x03, 0x06, 0x06, 0x0D, 0x70, 0x20, 0x1A}; +u16 timing_asy_mode3[TIMING_ASY_NUM] = { /* x100 pass, sample: 4-7 */ + 0x03, 0x03, 0x0A, 0x0A, 0x03, 0x03, 0x06, 0x06, 0x0A, 0x70, 0x20, 0x14}; +u16 timing_asy_mode4[TIMING_ASY_NUM] = { /* x100 1.8v pass */ + 0x03, 0x03, 0x08, 0x08, 0x03, 0x03, 0x06, 0x06, 0x08, 0x70, 0x15, 0x10}; +u16 timing_asy_mode5[TIMING_ASY_NUM] = { /* x100 1.8v pass */ + 0x03, 0x03, 0x07, 0x07, 0x03, 0x03, 0x06, 0x06, 0x07, 0x20, 0x15, 0x0E}; +u16 timing_syn_mode0[TIMING_SYN_NUM] = { /* x100 1.8v pass */ + 0x20, 0x41, 0x05, 0x20, 0x10, 0x19, 0x62, 0x40, 0x38, 0x20, 0x00, 0x09, + 0x50, 0x20}; +u16 timing_syn_mode1[TIMING_SYN_NUM] = { /* x100 1.8v pass */ + 0x18, 0x32, 0x06, 0x18, 0x0C, 0x10, 0x76, 0x40, 0x2A, 0x1E, 0x00, 0x12, + 0x24, 0x18}; +u16 timing_syn_mode2[TIMING_SYN_NUM] = { /* x100 1.8v pass */ + 0x10, 0x0A, 0x04, 0x10, 0x08, 0x0A, 0x6E, 0x50, 0x1D, 0x10, 0x00, 0x0C, + 0x18, 0x10}; +u16 timing_syn_mode3[TIMING_SYN_NUM] = { /* x100 1.8v pass */ + 0x0C, 0x1A, 0x02, 0x0C, 0x06, 0x08, 0x78, 0x7C, 0x15, 0x0C, 0x00, 0x08, + 0x12, 0x0C}; +u16 timing_syn_mode4[TIMING_SYN_NUM] = { /* x100 1.8v failed */ + 0x08, 0x17, 0x05, 0x08, 0x04, 0x01, 0x73, 0x40, 0x0C, 0x08, 0x00, 0x06, + 0x0C, 0x10}; +u16 timing_tog_ddr_mode0[TIMING_TOG_NUM] = { /* 600M clk */ + 0x14, 0x0a, 0x08, 0x08, 0xc8, 0xc8, 0x08, 0x08, 0x20, 0x0a, 0x14, 0x08}; + +static u32 nfc_ecc_errover; +static u32 nfc_ecc_err; +static u32 nfc_irq_st; +static u32 nfc_irq_en; +static u32 nfc_irq_complete; + +static DECLARE_WAIT_QUEUE_HEAD(wait_done); + +/* + * Internal helper to conditionnally apply a delay (from the above structure, + * most of the time). + */ +static void cond_delay(unsigned int ns) +{ + if (!ns) + return; + + if (ns < 10000) + ndelay(ns); + else + udelay(DIV_ROUND_UP(ns, 1000)); +} + +static inline struct phytium_nfc *to_phytium_nfc(struct nand_controller *ctrl) +{ + return container_of(ctrl, struct phytium_nfc, controller); +} + +static inline struct phytium_nand_chip *to_phytium_nand(struct nand_chip *chip) +{ + return container_of(chip, struct phytium_nand_chip, chip); +} + +static u32 phytium_read(struct phytium_nfc *nfc, u32 reg) +{ + return readl_relaxed(nfc->regs + reg); +} + +static void phytium_write(struct phytium_nfc *nfc, u32 reg, u32 value) +{ + return writel_relaxed(value, nfc->regs + reg); +} + +static inline int phytium_wait_busy(struct phytium_nfc *nfc) +{ + u32 status; + + if (nfc_ecc_errover) { + nfc_ecc_errover = 0; + return 0; + } + + return readl_relaxed_poll_timeout(nfc->regs + NDSR, status, + !(status & NDSR_BUSY), 10, 10000); +} + +static void phytium_nfc_disable_int(struct phytium_nfc *nfc, u32 int_mask) +{ + u32 reg; + + reg = phytium_read(nfc, NDIR_MASK); + phytium_write(nfc, NDIR_MASK, reg | int_mask); +} + +static void phytium_nfc_enable_int(struct phytium_nfc *nfc, u32 int_mask) +{ + u32 reg; + + reg = phytium_read(nfc, NDIR_MASK); + phytium_write(nfc, NDIR_MASK, reg & (~int_mask)); +} + +static void phytium_nfc_clear_int(struct phytium_nfc *nfc, u32 int_mask) +{ + phytium_write(nfc, NDIR_MASK, int_mask); +} + +static int phytium_nfc_cmd_correct(struct phytium_nfc_op *nfc_op) +{ + if (!nfc_op) + return -EINVAL; + + if (nfc_op->cmd_len == 0x01) { + nfc_op->cmd[1] = nfc_op->cmd[0]; + nfc_op->cmd[0] = 0; + } + + return 0; +} + +static int phytium_nfc_addr_correct(struct phytium_nfc_op *nfc_op) +{ + u32 len; + int i, j; + + if (!nfc_op) + return -EINVAL; + + len = nfc_op->addr_len > PHYTIUM_NFC_ADDR_MAX_LEN ? + PHYTIUM_NFC_ADDR_MAX_LEN : nfc_op->addr_len; + + if (len == PHYTIUM_NFC_ADDR_MAX_LEN) + return 0; + + for (i = len-1, j = PHYTIUM_NFC_ADDR_MAX_LEN - 1; i >= 0; i--, j--) { + nfc_op->addr[j] = nfc_op->addr[i]; + nfc_op->addr[i] = 0; + } + + return 0; +} + +static void phytium_nfc_parse_instructions(struct nand_chip *chip, + const struct nand_subop *subop, + struct phytium_nfc_op *nfc_op) +{ + struct nand_op_instr *instr = NULL; + bool first_cmd = true; + u32 op_id; + int i; + + /* Reset the input structure as most of its fields will be OR'ed */ + memset(nfc_op, 0, sizeof(struct phytium_nfc_op)); + + for (op_id = 0; op_id < subop->ninstrs; op_id++) { + unsigned int offset, naddrs; + const u8 *addrs; + int len; + + instr = (struct nand_op_instr *)&subop->instrs[op_id]; + + switch (instr->type) { + case NAND_OP_CMD_INSTR: + if (first_cmd) { + nfc_op->cmd[0] = instr->ctx.cmd.opcode; + } else { + nfc_op->cmd[1] = instr->ctx.cmd.opcode; + nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; + } + + nfc_op->cle_ale_delay_ns = instr->delay_ns; + first_cmd = false; + nfc_op->cmd_len++; + + break; + + case NAND_OP_ADDR_INSTR: + offset = nand_subop_get_addr_start_off(subop, op_id); + naddrs = nand_subop_get_num_addr_cyc(subop, op_id); + addrs = &instr->ctx.addr.addrs[offset]; + + nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = naddrs; + + for (i = 0; i < min_t(u32, PHYTIUM_NFC_ADDR_MAX_LEN, naddrs); i++) + nfc_op->addr[i] = addrs[i]; + + nfc_op->cle_ale_delay_ns = instr->delay_ns; + + nfc_op->addr_len = naddrs; + break; + + case NAND_OP_DATA_IN_INSTR: + nfc_op->data_instr = instr; + nfc_op->data_instr_idx = op_id; + nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; + len = nand_subop_get_data_len(subop, op_id); + nfc_op->page_cnt = len; + nfc_op->data_delay_ns = instr->delay_ns; + + break; + + case NAND_OP_DATA_OUT_INSTR: + nfc_op->data_instr = instr; + nfc_op->data_instr_idx = op_id; + nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; + len = nand_subop_get_data_len(subop, op_id); + nfc_op->page_cnt = len; + nfc_op->data_delay_ns = instr->delay_ns; + break; + + case NAND_OP_WAITRDY_INSTR: + nfc_op->rdy_timeout_ms = instr->ctx.waitrdy.timeout_ms; + nfc_op->rdy_delay_ns = instr->delay_ns; + break; + } + } +} + +int phytium_nfc_prepare_cmd(struct nand_chip *chip, + struct phytium_nfc_op *nfc_op, + enum dma_data_direction direction) +{ + struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + int i; + + phytium_nfc_cmd_correct(nfc_op); + phytium_nfc_addr_correct(nfc_op); + + nfc_op->cmd_ctrl.nfc_ctrl.csel = 0x0F ^ (0x01 << phytium_nand->selected_die); + + for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) + nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_prepare_cmd); + +#if NFC_DATA_CMD_DEBUG + +static int phytium_nfc_cmd_dump(struct phytium_nfc *nfc, + struct phytium_nfc_op *nfc_op, u8 *buf) +{ + u8 *p; + u8 str[1024] = {0}; + int i; + + sprintf(str, "Phytium NFC cmd dump:\n"); + sprintf(str, "%s cmd0:%x, cmd1:%x, ctrl:%x, page_cnt:%d\n", + str, nfc_op->cmd[0], nfc_op->cmd[1], nfc_op->cmd_ctrl.ctrl, nfc_op->page_cnt); + + p = &nfc_op->addr[0]; + sprintf(str, "%s addr:%02x %02x %02x %02x %02x\n", + str, p[0], p[1], p[2], p[3], p[4]); + + p = &nfc_op->mem_addr_first[0]; + sprintf(str, "%s mem_addr_first:%02x %02x %02x %02x %02x\n", + str, p[0], p[1], p[2], p[3], p[4]); + + for (i = 0; i < PHYTIUM_NFC_DSP_SIZE; i++) + sprintf(str, "%s %02x", str, buf[i]); + + dev_info(nfc->dev, "%s\n", str); + + return 0; +} + +int phytium_nfc_data_dump(struct phytium_nfc *nfc, u8 *buf, u32 len) +{ + u8 str[1024] = {0}; + int i; + + len = len > 512 ? 512 : len; + + sprintf(str, "Phytium NFC data dump: %d\n", len); + for (i = 0; i < len; i++) { + if (i && (i%128 == 0)) { + dev_info(nfc->dev, "next:\n%s\n", str); + memset(str, 0, 1024); + } + + if (i && (i%16 == 0)) + sprintf(str, "%s\n", str); + sprintf(str, "%s %02x", str, buf[i]); + } + + dev_info(nfc->dev, "%s\n", str); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_data_dump); +#else +#define phytium_nfc_cmd_dump(...) +#define phytium_nfc_data_dump(...) +#endif + +int phytium_nfc_send_cmd(struct nand_chip *chip, + struct phytium_nfc_op *nfc_op) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 value = 0; + + memset((u8 *)nfc->dsp_addr, 0, PAGE_SIZE); + memcpy((u8 *)nfc->dsp_addr, (u8 *)nfc_op, PHYTIUM_NFC_DSP_SIZE); + + phytium_nfc_cmd_dump(nfc, nfc_op, (u8 *)nfc->dsp_addr); + + if (phytium_wait_busy(nfc) != 0) { + dev_err(nfc->dev, "NFC was always busy\n"); + dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); + dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); + return 0; + } + + spin_lock(&nfc->spinlock); + value = nfc->dsp_phy_addr & 0xFFFFFFFF; + phytium_write(nfc, NDAR0, value); + + /* Don't modify NDAR1_DMA_RLEN & NDAR1_DMA_WLEN */ + value = phytium_read(nfc, NDAR1); + value |= NDAR1_H8((nfc->dsp_phy_addr >> 32) & 0xFF); + phytium_write(nfc, NDAR1, value); + + phytium_nfc_enable_int(nfc, NDIR_CMD_FINISH_MASK); + + value |= NDAR1_DMA_EN; + phytium_write(nfc, NDAR1, value); + spin_unlock(&nfc->spinlock); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_send_cmd); + +int phytium_nfc_prepare_cmd2(struct nand_chip *chip, + struct phytium_nfc_op *nfc_op, + enum dma_data_direction direction, + u32 cmd_num) +{ + struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); + int i; + + for (i = 0; i < cmd_num; i++) { + phytium_nfc_cmd_correct(nfc_op); + phytium_nfc_addr_correct(nfc_op); + nfc_op->cmd_ctrl.nfc_ctrl.csel = 0x0F ^ (0x01 << phytium_nand->selected_die); + nfc_op++; + } + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_prepare_cmd2); + +int phytium_nfc_send_cmd2(struct nand_chip *chip, + struct phytium_nfc_op *nfc_op, + u32 cmd_num) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 value = 0; + int i; + + memset((u8 *)nfc->dsp_addr, 0, PAGE_SIZE); + + for (i = 0; i < cmd_num; i++) { + memcpy((u8 *)nfc->dsp_addr + i*PHYTIUM_NFC_DSP_SIZE, + (u8 *)nfc_op, PHYTIUM_NFC_DSP_SIZE); + phytium_nfc_cmd_dump(nfc, nfc_op, (u8 *)nfc->dsp_addr + i*PHYTIUM_NFC_DSP_SIZE); + nfc_op++; + } + + if (phytium_wait_busy(nfc) != 0) { + dev_err(nfc->dev, "NFC was always busy\n"); + dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); + dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); + return 0; + } + + spin_lock(&nfc->spinlock); + value = nfc->dsp_phy_addr & 0xFFFFFFFF; + phytium_write(nfc, NDAR0, value); + + /* Don't modify NDAR1_DMA_RLEN & NDAR1_DMA_WLEN */ + value = phytium_read(nfc, NDAR1); + value |= NDAR1_H8((nfc->dsp_phy_addr >> 32) & 0xFF); + phytium_write(nfc, NDAR1, value); + + phytium_nfc_enable_int(nfc, NDIR_DMA_FINISH_MASK | NDIR_ECC_ERR_MASK); + + value |= NDAR1_DMA_EN; + phytium_write(nfc, NDAR1, value); + spin_unlock(&nfc->spinlock); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_send_cmd2); + +int phytium_nfc_wait_op(struct nand_chip *chip, + u32 timeout_ms) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + int ret; + + /* Timeout is expressed in ms */ + if (!timeout_ms) + timeout_ms = IRQ_TIMEOUT; + else if (timeout_ms > 1000) + timeout_ms = 1000; + else if (timeout_ms < 100) + timeout_ms = 100; + + ret = wait_event_interruptible_timeout(wait_done, nfc_irq_complete, + msecs_to_jiffies(timeout_ms)); + nfc_irq_complete = false; + + if (!ret) { + dev_err(nfc->dev, "Timeout waiting for RB signal\n"); + dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); + dev_err(nfc->dev, "NFC irq state: %x, irq en:%x\n", + phytium_read(nfc, NDIR), phytium_read(nfc, NDIR_MASK)); + dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); + + phytium_nfc_clear_int(nfc, NDIR_ALL_INT(nfc->caps->int_mask_bits)); + return -ETIMEDOUT; + } + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_wait_op); + +static int phytium_nfc_xfer_data_pio(struct phytium_nfc *nfc, + const struct nand_subop *subop, + struct phytium_nfc_op *nfc_op) +{ + const struct nand_op_instr *instr = nfc_op->data_instr; + unsigned int op_id = nfc_op->data_instr_idx; + unsigned int len = nand_subop_get_data_len(subop, op_id); + unsigned int offset = nand_subop_get_data_start_off(subop, op_id); + bool reading = (instr->type == NAND_OP_DATA_IN_INSTR); + + if (reading) { + u8 *in = instr->ctx.data.buf.in + offset; + + memcpy(in, nfc->dma_buf, len); + + nfc->dma_offset = 0; + } else { + const u8 *out = instr->ctx.data.buf.out + offset; + + memcpy(nfc->dma_buf, out, len); + } + + return 0; +} + +static int memcpy_to_reg16(struct phytium_nfc *nfc, u32 reg, u16 *buf, size_t len) +{ + int i; + u32 val = 0; + + if (!nfc || !buf || (len >= 16)) + return -EINVAL; + + for (i = 0; i < len; i++) { + val = (val << 16) + buf[i]; + if (i % 2) { + phytium_write(nfc, reg, val); + val = 0; + reg += 4; + } + } + + return 0; +} + +int phytium_nfc_default_data_interface(struct phytium_nfc *nfc) +{ + int value; + + value = phytium_read(nfc, NDCR0); + value &= (~NDCR0_IN_MODE(3)); + value |= NDCR0_IN_MODE(nfc->inter_mode); + phytium_write(nfc, NDCR0, value); + + value = phytium_read(nfc, NDCR1); + value &= (~NDCR1_SAMPL_PHASE(0xFFFF)); + + switch (nfc->inter_mode) { + case ASYN_SDR: + if (nfc->timing_mode == ASY_MODE4) { + memcpy_to_reg16(nfc, NDTR0, timing_asy_mode4, TIMING_ASY_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(4)); + } else if (nfc->timing_mode == ASY_MODE3) { + memcpy_to_reg16(nfc, NDTR0, timing_asy_mode3, TIMING_ASY_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(5)); + } else if (nfc->timing_mode == ASY_MODE2) { + memcpy_to_reg16(nfc, NDTR0, timing_asy_mode2, TIMING_ASY_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(3)); + } else if (nfc->timing_mode == ASY_MODE1) { + memcpy_to_reg16(nfc, NDTR0, timing_asy_mode1, TIMING_ASY_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(2)); + } else { + memcpy_to_reg16(nfc, NDTR0, timing_asy_mode0, TIMING_ASY_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(1)); + } + phytium_write(nfc, ND_INTERVAL_TIME, 0x01); + break; + case ONFI_DDR: + if (nfc->timing_mode == SYN_MODE4) { + memcpy_to_reg16(nfc, NDTR6, timing_syn_mode4, TIMING_SYN_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x0D)); + phytium_write(nfc, ND_INTERVAL_TIME, 0x30); + } else if (nfc->timing_mode == SYN_MODE3) { + memcpy_to_reg16(nfc, NDTR6, timing_syn_mode3, TIMING_SYN_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x05)); + phytium_write(nfc, ND_INTERVAL_TIME, 0x18); + } else if (nfc->timing_mode == SYN_MODE2) { + memcpy_to_reg16(nfc, NDTR6, timing_syn_mode2, TIMING_SYN_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x08)); + phytium_write(nfc, ND_INTERVAL_TIME, 0x20); + } else if (nfc->timing_mode == SYN_MODE1) { + memcpy_to_reg16(nfc, NDTR6, timing_syn_mode1, TIMING_SYN_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x12)); + phytium_write(nfc, ND_INTERVAL_TIME, 0x40); + } else { + memcpy_to_reg16(nfc, NDTR6, timing_syn_mode0, TIMING_SYN_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x12)); + phytium_write(nfc, ND_INTERVAL_TIME, 0x40); + } + break; + case TOG_ASYN_DDR: + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(8)); + phytium_write(nfc, ND_INTERVAL_TIME, 0xC8); + memcpy_to_reg16(nfc, NDTR13, timing_tog_ddr_mode0, TIMING_TOG_NUM); + break; + } + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_default_data_interface); + +static int phytium_nfc_naked_waitrdy_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + int ret = 0; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + + dev_info(nfc->dev, "Phytium nand command 0x%02x 0x%02x.\n", + nfc_op.cmd[0], nfc_op.cmd[1]); + + switch (nfc_op.cmd[0]) { + case NAND_CMD_PARAM: + memset(nfc->dma_buf, 0, PAGE_SIZE); + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_PARAM; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + if (nfc->inter_pro == NAND_ONFI) + nfc_op.page_cnt = 3 * sizeof(struct nand_onfi_params); + else if (nfc->inter_pro == NAND_JEDEC) + nfc_op.page_cnt = 3 * sizeof(struct nand_jedec_params); + if (nfc_op.page_cnt) + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + nfc->dma_offset = 0; + break; + case NAND_CMD_SET_FEATURES: + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_SET_FTR; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + if (nfc->inter_mode != ASYN_SDR) { + dev_err(nfc->dev, "Not support SET_FEATURES command!\n"); + return 0; + } + break; + case NAND_CMD_GET_FEATURES: + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_GET_FTR; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + break; + case NAND_CMD_READ0: + if (nfc_op.cmd[1] == NAND_CMD_READSTART) { /* large page */ + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + } else if (nfc_op.cmd[1] == NAND_CMD_SEQIN) { /* program page begin */ + nfc_op.cmd[0] = NAND_CMD_SEQIN; + nfc_op.cmd[1] = NAND_CMD_PAGEPROG; + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + } else { /* small page */ + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + } + break; + case NAND_CMD_RNDOUT: /* change read column */ + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + break; + case NAND_CMD_READSTART: /* large page */ + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + break; + case NAND_CMD_RNDOUTSTART: /* change read column */ + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc->dma_offset = nfc_op.addr[1]; + nfc->dma_offset = (nfc->dma_offset << 8) + nfc_op.addr[0]; + break; + case NAND_CMD_SEQIN: /* program begin */ + if (nfc_op.cmd[0] == NAND_CMD_READ0) { + nfc_op.cmd[0] = NAND_CMD_SEQIN; + nfc_op.cmd[1] = NAND_CMD_PAGEPROG; + } + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + break; + case NAND_CMD_RNDIN: /* change write column */ + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_WR_COL; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + break; + case NAND_CMD_PAGEPROG: /* program end */ + nfc_op.cmd[0] = NAND_CMD_RNDIN; + nfc_op.cmd[1] = NAND_CMD_PAGEPROG; + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + break; + default: + dev_err(nfc->dev, "Not support cmd %d.\n", nfc_op.cmd[1]); + ret = -EINVAL; + goto out; + } + + if ((nfc_op.data_instr) && (direction == DMA_TO_DEVICE)) + phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); + + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + nfc_op.rdy_timeout_ms = nfc_op.rdy_timeout_ms; + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + goto out; + + cond_delay(nfc_op.rdy_delay_ns); + + if ((nfc_op.data_instr) && (direction == DMA_FROM_DEVICE)) + phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); + +out: + return ret; +} + +static int phytium_nfc_read_id_type_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + u16 read_len = 0; + int ret; + u8 *buf = nfc->dma_buf; + + memset(nfc->dma_buf, 0, PAGE_SIZE); + direction = DMA_FROM_DEVICE; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + read_len = nfc_op.page_cnt; + nfc_op.page_cnt = (read_len & 0x03) ? ((read_len & 0xFFFC) + 4) : read_len; + + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_ID; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 0; + + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + return ret; + + cond_delay(nfc_op.rdy_delay_ns); + + if (!strncmp(nfc->dma_buf, "ONFI", 4)) { + nfc->inter_pro = NAND_ONFI; + } else if (!strncmp(nfc->dma_buf, "JEDEC", 5)) { + nfc->inter_pro = NAND_JEDEC; + if (buf[5] == 1) + nfc->inter_mode = ASYN_SDR; + else if (buf[5] == 2) + nfc->inter_mode = TOG_ASYN_DDR; + else if (buf[5] == 4) + nfc->inter_mode = ASYN_SDR; + } else { + nfc->inter_pro = NAND_OTHER; + } + + dev_info(nfc->dev, "Nand protocol: %d, interface mode: %d\n", + nfc->inter_pro, nfc->inter_mode); + + phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); + + return 0; +} + +static int phytium_nfc_read_status_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + u16 read_len = 0; + u32 timeout, count = 0; + int ret = 0; + + direction = DMA_FROM_DEVICE; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + read_len = nfc_op.page_cnt; + nfc_op.page_cnt = (read_len & 0x03) ? ((read_len & 0xFFFC) + 4) : read_len; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_STATUS; + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + +read_status_retry: + count++; + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + timeout = nfc_op.rdy_timeout_ms ? nfc_op.rdy_timeout_ms : 10; + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + goto out; + + phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); + + if (0xE0 != *(u8 *)(nfc->dma_buf)) { + dev_info(nfc->dev, "Retry to read status (%x)\n", *(u8 *)(nfc->dma_buf)); + + if (count < 10) + goto read_status_retry; + } + +out: + return ret; +} + +static int phytium_nfc_reset_cmd_type_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + + direction = DMA_NONE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_RESET; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + return phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); +} + +static int phytium_nfc_erase_cmd_type_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + direction = DMA_NONE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_ERASE; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + return phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); +} + +static int phytium_nfc_data_in_type_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nfc_op nfc_op; + struct nand_op_instr *instr; + unsigned int op_id; + unsigned int len; + unsigned int offset; + u8 *in = NULL; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + if (nfc_op.data_instr->type != NAND_OP_DATA_IN_INSTR) { + dev_err(nfc->dev, "Phytium nfc instrs parser failed!\n"); + return -EINVAL; + } + + instr = nfc_op.data_instr; + op_id = nfc_op.data_instr_idx; + len = nand_subop_get_data_len(subop, op_id); + offset = nand_subop_get_data_start_off(subop, op_id); + in = instr->ctx.data.buf.in + offset; + + phytium_nfc_cmd_dump(nfc, &nfc_op, (u8 *)nfc->dsp_addr); + + memcpy(in, nfc->dma_buf + nfc->dma_offset, len); + nfc->dma_offset += len; + phytium_nfc_data_dump(nfc, in, len); + + return 0; +} + +static const struct nand_op_parser phytium_nfc_op_parser = NAND_OP_PARSER( + /* Naked commands not supported, use a function for each pattern */ + NAND_OP_PARSER_PATTERN( + phytium_nfc_read_id_type_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, 8)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_erase_cmd_type_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_read_status_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, 1)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_reset_cmd_type_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_naked_waitrdy_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_WAITRDY_ELEM(false), + NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_naked_waitrdy_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_naked_waitrdy_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_DATA_OUT_ELEM(false, 8), + NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_naked_waitrdy_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_data_in_type_exec, + NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), + ); + +static int phytium_nfc_exec_op(struct nand_chip *chip, + const struct nand_operation *op, + bool check_only) +{ + return nand_op_parser_exec_op(chip, &phytium_nfc_op_parser, + op, check_only); +} + +static int phytium_nfc_reset(struct phytium_nfc *nfc) +{ + u32 value; + + phytium_write(nfc, NDIR_MASK, NDIR_ALL_INT(nfc->caps->int_mask_bits)); + phytium_write(nfc, NDSR, NDIR_ALL_INT(nfc->caps->int_mask_bits)); + + phytium_write(nfc, ND_ERR_CLR, 0x0F); + phytium_write(nfc, NDFIFO_CLR, 1); + + value = phytium_read(nfc, NDCR0); + phytium_write(nfc, NDCR0, value & ~(NDCR0_ECC_EN | NDCR0_SPARE_EN)); + + return 0; +} + +static void phytium_nfc_select_chip(struct nand_chip *chip, int die_nr) +{ + struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + + dev_dbg(nfc->dev, "Phytium nand selected chip %d\n", die_nr); + + if (chip == nfc->selected_chip && die_nr == phytium_nand->selected_die) + return; + + if (die_nr < 0 || die_nr >= phytium_nand->nsels) { + nfc->selected_chip = NULL; + phytium_nand->selected_die = -1; + return; + } + + phytium_nfc_reset(nfc); + + nfc->selected_chip = chip; + phytium_nand->selected_die = die_nr; +} + +static int phytium_nand_ooblayout_ecc(struct mtd_info *mtd, int section, + struct mtd_oob_region *oobregion) +{ + struct nand_chip *chip = mtd_to_nand(mtd); + + if (section) + return -ERANGE; + + oobregion->length = chip->ecc.total; + oobregion->offset = mtd->oobsize - oobregion->length; + + return 0; +} + +static int phytium_nand_ooblayout_free(struct mtd_info *mtd, int section, + struct mtd_oob_region *oobregion) +{ + struct nand_chip *chip = mtd_to_nand(mtd); + + if (section) + return -ERANGE; + + /* + * Bootrom looks in bytes 0 & 5 for bad blocks for the + * 4KB page / 4bit BCH combination. + */ + if (mtd->writesize >= SZ_4K) + oobregion->offset = 6; + else + oobregion->offset = 2; + + oobregion->length = mtd->oobsize - chip->ecc.total - oobregion->offset; + + return 0; +} + +static const struct mtd_ooblayout_ops phytium_nand_ooblayout_ops = { + .ecc = phytium_nand_ooblayout_ecc, + .free = phytium_nand_ooblayout_free, +}; + +static void phytium_nfc_enable_hw_ecc(struct nand_chip *chip) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 ndcr0 = phytium_read(nfc, NDCR0); + + if (!(ndcr0 & NDCR0_ECC_EN)) + phytium_write(nfc, NDCR0, ndcr0 | NDCR0_ECC_EN); +} + +static void phytium_nfc_disable_hw_ecc(struct nand_chip *chip) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 ndcr0 = phytium_read(nfc, NDCR0); + + if (ndcr0 & NDCR0_ECC_EN) + phytium_write(nfc, NDCR0, ndcr0 & ~NDCR0_ECC_EN); +} + + +irqreturn_t phytium_nfc_isr(int irq, void *dev_id) +{ + struct phytium_nfc *nfc = dev_id; + u32 st = phytium_read(nfc, NDIR); + u32 ien = (~phytium_read(nfc, NDIR_MASK)) & NDIR_ALL_INT(nfc->caps->int_mask_bits); + + if (!(st & ien)) + return IRQ_NONE; + + nfc_irq_st = st; + nfc_irq_en = ien; + phytium_nfc_disable_int(nfc, st & NDIR_ALL_INT(nfc->caps->int_mask_bits)); + phytium_write(nfc, 0xFD0, 0); + + if (st & (NDIR_CMD_FINISH | NDIR_DMA_FINISH)) { + if (st & NDIR_ECC_ERR) + nfc_ecc_err = 1; + phytium_write(nfc, NDIR, st); + nfc_irq_complete = 1; + } else if (st & (NDIR_FIFO_TIMEOUT | NDIR_PGFINISH)) { + phytium_write(nfc, NDIR, st); + phytium_nfc_enable_int(nfc, (~st) & (NDIR_DMA_FINISH_MASK | + NDIR_PGFINISH_MASK | + NDIR_FIFO_TIMEOUT_MASK | + NDIR_CMD_FINISH_MASK)); + nfc_irq_complete = 0; + } else if (st & NDIR_ECC_ERR) { + phytium_write(nfc, ND_ERR_CLR, 0x08); + phytium_write(nfc, NDIR, st); + phytium_write(nfc, NDFIFO_CLR, 0x01); + nfc_irq_complete = 1; + nfc_ecc_errover = 1; + } else { + phytium_write(nfc, NDIR, st); + nfc_irq_complete = 1; + } + + wake_up(&wait_done); + + return IRQ_HANDLED; +} +EXPORT_SYMBOL(phytium_nfc_isr); + +static int phytium_nfc_hw_ecc_correct(struct nand_chip *chip, + char *buf, int len) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 i, j, value, tmp; + u32 ecc_err_reg_nums; + int stat = 0; + + if (!buf) + return -EINVAL; + + if (nfc->caps->hw_ver == 1) + ecc_err_reg_nums = 2; + else + ecc_err_reg_nums = 4; + + for (i = 0; i < chip->ecc.steps; i++) { + for (j = 0; j < ecc_err_reg_nums; j++) { + value = phytium_read(nfc, 0xB8 + 4 * (ecc_err_reg_nums * i + j)); + dev_info(nfc->dev, "ECC_FLAG: offset:%x value:0x%08x\n", + 0xB8 + 4 * (2 * i + j), value); + + tmp = value & 0xFFFF; + if (tmp && (tmp <= 4096)) { + tmp--; + stat++; + buf[chip->ecc.size * i + (tmp >> 3)] ^= (0x01 << tmp % 8); + dev_info(nfc->dev, "ECC_CORRECT %x %02x\n", + chip->ecc.size * i + (tmp >> 3), + buf[chip->ecc.size * i + (tmp >> 3)]); + dev_info(nfc->dev, "ECC_CORRECT xor %x %02x\n", + 0x01 << (tmp % 8), buf[chip->ecc.size * i + (tmp >> 3)]); + } else if (tmp > 4096) { + dev_info(nfc->dev, "ECC_CORRECT offset > 4096!\n"); + } + + tmp = (value >> 16) & 0xFFFF; + if (tmp && (tmp <= 4096)) { + tmp--; + stat++; + buf[chip->ecc.size * i + (tmp >> 3)] ^= (0x01 << tmp % 8); + dev_info(nfc->dev, "ECC_CORRECT %x %02x\n", + chip->ecc.size * i + (tmp >> 3), + buf[chip->ecc.size * i + (tmp >> 3)]); + dev_info(nfc->dev, "ECC_CORRECT xor %x %02x\n", + chip->ecc.size * i + (tmp >> 3), + buf[chip->ecc.size * i + (tmp >> 3)]); + } else if (tmp > 4096) { + dev_info(nfc->dev, "ECC_CORRECT offset > 4096!\n"); + } + } + } + + return stat; +} + +static int phytium_nand_page_read(struct mtd_info *mtd, struct nand_chip *chip, + u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + int ret = 0; + + memset(&nfc_op, 0, sizeof(nfc_op)); + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); + + memset(nfc->dma_buf, 0x0, mtd->writesize + mtd->oobsize); + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op.cmd[0] = NAND_CMD_READ0; + nfc_op.cmd[1] = NAND_CMD_READSTART; + nfc_op.cmd_len = 2; + nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); + nfc_op.rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); + + nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op.addr[2] = page; + nfc_op.addr[3] = page >> 8; + nfc_op.addr[4] = page >> 16; + nfc_op.addr_len = 5; + nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + + nfc_op.page_cnt = mtd->writesize; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; + + /* For data read/program */ + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + return ret; + + if ((direction == DMA_FROM_DEVICE) && buf) + memcpy(buf, nfc->dma_buf, mtd->writesize); + + return ret; +} + +static int phytium_nand_oob_read(struct mtd_info *mtd, struct nand_chip *chip, + u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + int ret = 0; + + memset(&nfc_op, 0, sizeof(nfc_op)); + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); + + memset(nfc->dma_buf, 0x00, mtd->writesize + mtd->oobsize); + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op.cmd[0] = NAND_CMD_READ0; + nfc_op.cmd[1] = NAND_CMD_READSTART; + nfc_op.cmd_len = 2; + nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); + nfc_op.rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); + + nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op.addr[2] = page; + nfc_op.addr[3] = page >> 8; + nfc_op.addr[4] = page >> 16; + nfc_op.addr_len = 5; + nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + + nfc_op.page_cnt = oob_len; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; + nfc_op.addr[0] = mtd->writesize & 0xFF; + nfc_op.addr[1] = (mtd->writesize >> 8) & 0xFF; + + /* For data read/program */ + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + return ret; + + cond_delay(nfc_op.rdy_delay_ns); + + if (direction == DMA_FROM_DEVICE) + memcpy(oob_buf, nfc->dma_buf, oob_len); + + return ret; +} + +static int phytium_nand_get_ecc_total(struct mtd_info *mtd, + struct nand_ecc_ctrl *ecc) +{ + int ecc_total = 0; + + switch (mtd->writesize) { + case 0x200: + if (ecc->strength == 8) + ecc_total = 0x0D; + else if (ecc->strength == 4) + ecc_total = 7; + else if (ecc->strength == 2) + ecc_total = 4; + else + ecc_total = 0; + break; + case 0x800: + if (ecc->strength == 8) + ecc_total = 0x34; + else if (ecc->strength == 4) + ecc_total = 0x1a; + else if (ecc->strength == 2) + ecc_total = 0xd; + else + ecc_total = 0; + break; + case 0x1000: + if (ecc->strength == 8) + ecc_total = 0x68; + else if (ecc->strength == 4) + ecc_total = 0x34; + else if (ecc->strength == 2) + ecc_total = 0x1a; + else + ecc_total = 0; + break; + case 0x2000: + if (ecc->strength == 8) + ecc_total = 0xD0; + else if (ecc->strength == 4) + ecc_total = 0x68; + else if (ecc->strength == 2) + ecc_total = 0x34; + else + ecc_total = 0; + break; + case 0x4000: + if (ecc->strength == 8) + ecc_total = 0x1A0; + if (ecc->strength == 4) + ecc_total = 0xD0; + else if (ecc->strength == 2) + ecc_total = 0x68; + else + ecc_total = 0; + break; + default: + ecc_total = 0; + break; + } + + return ecc_total; +} + +static int phytium_nand_page_read_hwecc(struct mtd_info *mtd, struct nand_chip *chip, + u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op *nfc_op = NULL; + enum dma_data_direction direction; + u32 ecc_offset; + int max_bitflips = 0; + u32 nfc_state = 0; + int ret = 0; + int i; + + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); + + ecc_offset = phytium_nand->ecc.offset; + memset(nfc->dma_buf, 0x00, mtd->writesize + mtd->oobsize); + nfc_op = kzalloc(2 * sizeof(struct phytium_nfc_op), GFP_KERNEL); + if (!nfc_op) { + dev_err(nfc->dev, "Can't malloc space for phytium_nfc_op\n"); + return 0; + } + + nfc_op->cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op->rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); + nfc_op->rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); + + direction = DMA_FROM_DEVICE; + nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op->cmd[0] = NAND_CMD_READ0; + nfc_op->cmd[1] = NAND_CMD_READSTART; + nfc_op->cmd_len = 2; + nfc_op->addr_len = 5; + nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op->addr[2] = page; + nfc_op->addr[3] = page >> 8; + nfc_op->addr[4] = page >> 16; + nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc_op->page_cnt = mtd->writesize; + nfc_op->cmd_ctrl.nfc_ctrl.nc = 1; + for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) + nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; + + nfc_op++; + memcpy(nfc_op, nfc_op - 1, sizeof(struct phytium_nfc_op)); + nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; + nfc_op->cmd[0] = NAND_CMD_RNDOUT; + nfc_op->cmd[1] = NAND_CMD_RNDOUTSTART; + memset(&nfc_op->addr, 0, PHYTIUM_NFC_ADDR_MAX_LEN); + nfc_op->addr_len = 2; + nfc_op->addr[0] = mtd->writesize + phytium_nand->ecc.offset; + nfc_op->addr[1] = (mtd->writesize + phytium_nand->ecc.offset) >> 8; + nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x02; + nfc_op->page_cnt = phytium_nand_get_ecc_total(mtd, &chip->ecc); + nfc_op->cmd_ctrl.nfc_ctrl.nc = 0; + nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 0; + nfc_op->cmd_ctrl.nfc_ctrl.ecc_en = 1; + for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) + nfc_op->mem_addr_first[i] = + ((nfc->dma_phy_addr + mtd->writesize) >> (8 * i)) & 0xFF; + + nfc_op--; + phytium_nfc_prepare_cmd2(chip, nfc_op, direction, 2); + phytium_nfc_send_cmd2(chip, nfc_op, 2); + cond_delay(nfc_op->cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op->rdy_timeout_ms); + if (ret){ + kfree(nfc_op); + return ret; + } + + cond_delay(nfc_op->rdy_delay_ns*1000); + + if ((direction == DMA_FROM_DEVICE) && buf) { + nfc_state = phytium_read(nfc, NDSR); + if ((nfc_state & NDSR_ECC_ERROVER) || (nfc_ecc_errover == 1)) { + for (i = 0; i < mtd->writesize/16; i++) { + if (0xFF != *(u8 *)(nfc->dma_buf + i)) { + dev_info(nfc->dev, "NFC: NDSR_ECC_ERROVER %x\n", page); + mtd->ecc_stats.failed++; + mtd->ecc_stats.corrected += max_bitflips; + break; + } + } + } else if (nfc_state & NDSR_ECC_ERR) { + max_bitflips = phytium_nfc_hw_ecc_correct(chip, + nfc->dma_buf, mtd->writesize); + mtd->ecc_stats.corrected += max_bitflips; + dev_info(nfc->dev, "NFC: NDSR_ECC_ERR page:%x, bit:%d\n", + page, max_bitflips); + } + + memcpy(buf, nfc->dma_buf, mtd->writesize); + } + + kfree(nfc_op); + return max_bitflips; +} + +static int phytium_nand_page_write(struct mtd_info *mtd, struct nand_chip *chip, + const u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + int ret = 0; + + memset(&nfc_op, 0, sizeof(nfc_op)); + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); + + memcpy(nfc->dma_buf, buf, mtd->writesize); + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op.cmd[0] = NAND_CMD_SEQIN; + nfc_op.cmd[1] = NAND_CMD_PAGEPROG; + nfc_op.cmd_len = 2; + nfc_op.addr_len = 5; + nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tPROG_max); + nfc_op.rdy_delay_ns = 0; + + nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op.addr[2] = page; + nfc_op.addr[3] = page >> 8; + nfc_op.addr[4] = page >> 16; + nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc_op.page_cnt = mtd->writesize; + + /* For data read/program */ + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + goto out; + + cond_delay(nfc_op.rdy_delay_ns); +out: + return ret; +} + +static int phytium_nand_oob_write(struct mtd_info *mtd, struct nand_chip *chip, + u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + int ret = 0; + + memset(&nfc_op, 0, sizeof(nfc_op)); + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); + + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op.cmd[0] = NAND_CMD_SEQIN; + nfc_op.cmd[1] = NAND_CMD_PAGEPROG; + nfc_op.cmd_len = 2; + nfc_op.addr_len = 5; + nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tPROG_max); + nfc_op.rdy_delay_ns = 0; + + nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op.addr[2] = page; + nfc_op.addr[3] = page >> 8; + nfc_op.addr[4] = page >> 16; + nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + + nfc_op.page_cnt = oob_len; + nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; + nfc_op.addr[0] = mtd->writesize & 0xFF; + nfc_op.addr[1] = (mtd->writesize >> 8) & 0xFF; + nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; + memcpy(nfc->dma_buf, oob_buf, mtd->oobsize); + + /* For data read/program */ + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + goto out; + + cond_delay(nfc_op.rdy_delay_ns); +out: + return ret; +} + +static int phytium_nand_page_write_hwecc(struct mtd_info *mtd, struct nand_chip *chip, + const u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op *nfc_op; + enum dma_data_direction direction; + u32 ecc_offset; + int ret = 0; + int i; + + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(chip)); + ecc_offset = phytium_nand->ecc.offset; + + nfc_op = kzalloc(2 * sizeof(struct phytium_nfc_op), GFP_KERNEL); + if (!nfc_op) { + dev_err(nfc->dev, "Can't malloc space for phytium_nfc_op\n"); + return 0; + } + + nfc_op->cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op->rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); + nfc_op->rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); + + direction = DMA_TO_DEVICE; + nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_ROW_ADDR; + nfc_op->cmd[0] = NAND_CMD_SEQIN; + nfc_op->cmd_len = 1; + nfc_op->addr_len = 5; + nfc_op->cmd_ctrl.nfc_ctrl.dbc = 0; + nfc_op->addr[2] = page; + nfc_op->addr[3] = page >> 8; + nfc_op->addr[4] = page >> 16; + nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 0; + nfc_op->cmd_ctrl.nfc_ctrl.nc = 1; + for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) + nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; + + /* The first dsp must have data to transfer */ + memcpy(nfc->dma_buf, buf, mtd->writesize); + nfc_op->page_cnt = mtd->writesize; + nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; + + nfc_op++; + memcpy(nfc_op, nfc_op - 1, sizeof(struct phytium_nfc_op)); + nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc_op->cmd[0] = NAND_CMD_RNDIN; + nfc_op->cmd[1] = NAND_CMD_PAGEPROG; + memset(&nfc_op->addr, 0, PHYTIUM_NFC_ADDR_MAX_LEN); + nfc_op->addr_len = 2; + nfc_op->cmd_len = 2; + nfc_op->addr[0] = mtd->writesize + ecc_offset; + nfc_op->addr[1] = (mtd->writesize + ecc_offset) >> 8; + nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x02; + nfc_op->page_cnt = phytium_nand_get_ecc_total(mtd, &chip->ecc); + nfc_op->cmd_ctrl.nfc_ctrl.nc = 0; + nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op->cmd_ctrl.nfc_ctrl.ecc_en = 1; + for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) + nfc_op->mem_addr_first[i] = + ((nfc->dma_phy_addr + mtd->writesize + ecc_offset) >> (8 * i)) & 0xFF; + + /* when enable ECC, must offer ecc_offset of oob, but no oobdata */ + nfc_op--; + phytium_nfc_prepare_cmd2(chip, nfc_op, direction, 2); + phytium_nfc_send_cmd2(chip, nfc_op, 2); + cond_delay(nfc_op->cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op->rdy_timeout_ms); + if (ret) + goto out; + + cond_delay(nfc_op->rdy_delay_ns*1000); +out: + kfree(nfc_op); + return ret; +} + +static int phytium_nfc_hw_ecc_bch_read_page_raw(struct nand_chip *chip, + u8 *buf, int oob_required, int page) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + u32 oob_len = oob_required ? mtd->oobsize : 0; + int ret; + + ret = phytium_nand_page_read(mtd, chip, buf, NULL, 0, page, true); + if (oob_required) + ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, + oob_len, page, true); + + phytium_nfc_data_dump(to_phytium_nfc(chip->controller), buf, mtd->writesize); + + return ret; +} + +static int phytium_nfc_hw_ecc_bch_read_oob_raw(struct nand_chip *chip, int page) +{ + int ret; + struct mtd_info *mtd = nand_to_mtd(chip); + + /* Invalidate page cache */ + chip->pagecache.page = -1; + memset(chip->oob_poi, 0xFF, mtd->oobsize); + + ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, + mtd->oobsize, page, true); + + phytium_nfc_data_dump(to_phytium_nfc(chip->controller), chip->oob_poi, mtd->oobsize); + + return ret; +} + +static int phytium_nfc_hw_ecc_bch_read_page(struct nand_chip *chip, + u8 *buf, int oob_required, int page) +{ + int ret; + struct mtd_info *mtd = nand_to_mtd(chip); + u32 oob_len = oob_required ? mtd->oobsize : 0; + struct phytium_nand_chip *phytium_nand = NULL; + + phytium_nand = to_phytium_nand(chip); + + phytium_nfc_enable_hw_ecc(chip); + cond_delay(20*1000); + + ret = phytium_nand_page_read_hwecc(mtd, chip, buf, NULL, + 0, page, true); + + phytium_nfc_disable_hw_ecc(chip); + + if (oob_required) { + oob_len = mtd->oobsize; + ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, + oob_len, page, true); + } + + phytium_nfc_data_dump(to_phytium_nfc(chip->controller), buf, mtd->writesize); + + return ret; +} + +static int phytium_nfc_hw_ecc_bch_read_oob(struct nand_chip *chip, + int page) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + u32 oob_len = mtd->oobsize; + int ret; + + ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, + oob_len, page, true); + + phytium_nfc_data_dump(to_phytium_nfc(chip->controller), chip->oob_poi, oob_len); + + return ret; +} + +static int phytium_nfc_hw_ecc_bch_write_page_raw(struct nand_chip *chip, + const u8 *buf, int oob_required, int page) +{ + void *oob_buf = oob_required ? chip->oob_poi : NULL; + struct mtd_info *mtd = nand_to_mtd(chip); + + if (oob_required) + phytium_nand_oob_write(mtd, chip, NULL, oob_buf, + mtd->oobsize, page, false); + + return phytium_nand_page_write(mtd, chip, buf, NULL, + 0, page, false); +} + +static int phytium_nfc_hw_ecc_bch_write_page(struct nand_chip *chip, + const u8 *buf, int oob_required, int page) +{ + int ret; + void *oob_buf = oob_required ? chip->oob_poi : NULL; + u32 oob_len; + struct mtd_info *mtd = nand_to_mtd(chip); + + if (oob_required) { + oob_len = mtd->oobsize; + phytium_nand_oob_write(mtd, chip, NULL, oob_buf, + oob_len, page, false); + } + + phytium_nfc_enable_hw_ecc(chip); + + cond_delay(20*1000); + + ret = phytium_nand_page_write_hwecc(mtd, chip, buf, NULL, + 0, page, false); + + phytium_nfc_disable_hw_ecc(chip); + + return ret; +} + +static int phytium_nfc_hw_ecc_bch_write_oob_raw(struct nand_chip *chip, int page) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + return phytium_nand_oob_write(mtd, chip, NULL, chip->oob_poi, + mtd->oobsize, page, false); +} + +static int phytium_nfc_hw_ecc_bch_write_oob(struct nand_chip *chip, int page) +{ + struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); + struct mtd_info *mtd = nand_to_mtd(chip); + u32 oob_len = mtd->oobsize - phytium_nand->ecc.length; + + return phytium_nand_oob_write(mtd, chip, NULL, chip->oob_poi, + oob_len, page, false); +} + +static int phytium_nand_hw_ecc_ctrl_init(struct mtd_info *mtd, + struct nand_ecc_ctrl *ecc) +{ + struct nand_chip *chip = mtd_to_nand(mtd); + + if ((mtd->writesize + mtd->oobsize > MAX_CHUNK_SIZE)) + return -ENOTSUPP; + + chip->ecc.algo = NAND_ECC_ALGO_BCH; + ecc->read_page_raw = phytium_nfc_hw_ecc_bch_read_page_raw; + ecc->read_page = phytium_nfc_hw_ecc_bch_read_page; + ecc->read_oob_raw = phytium_nfc_hw_ecc_bch_read_oob_raw; + ecc->read_oob = phytium_nfc_hw_ecc_bch_read_oob; + ecc->write_page_raw = phytium_nfc_hw_ecc_bch_write_page_raw; + ecc->write_page = phytium_nfc_hw_ecc_bch_write_page; + ecc->write_oob_raw = phytium_nfc_hw_ecc_bch_write_oob_raw; + ecc->write_oob = phytium_nfc_hw_ecc_bch_write_oob; + + return 0; +} + +static int phytium_nand_ecc_init(struct mtd_info *mtd, + struct nand_ecc_ctrl *ecc) +{ + int ret = 0; + + mtd_set_ooblayout(mtd, &phytium_nand_ooblayout_ops); + + switch (ecc->engine_type) { + case NAND_ECC_ENGINE_TYPE_ON_HOST: + ret = phytium_nand_hw_ecc_ctrl_init(mtd, ecc); + break; + case NAND_ECC_ENGINE_TYPE_NONE: + ecc->read_page_raw = phytium_nfc_hw_ecc_bch_read_page_raw; + ecc->read_oob_raw = phytium_nfc_hw_ecc_bch_read_oob; + ecc->write_page_raw = phytium_nfc_hw_ecc_bch_write_page_raw; + ecc->write_oob_raw = phytium_nfc_hw_ecc_bch_write_oob_raw; + ecc->read_page = ecc->read_page_raw; + ecc->read_oob = ecc->read_oob_raw; + ecc->write_page = ecc->write_page_raw; + ecc->write_oob = ecc->write_oob_raw; + break; + case NAND_ECC_ENGINE_TYPE_SOFT: + case NAND_ECC_ENGINE_TYPE_ON_DIE: + default: + ret = -EINVAL; + break; + } + + return ret; +} + +static u8 bbt_pattern[] = {'P', 'H', 'Y', 'b', 't', '0' }; +static u8 bbt_mirror_pattern[] = {'1', 't', 'b', 'Y', 'H', 'P' }; + +static struct nand_bbt_descr bbt_main_descr = { + .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE | + NAND_BBT_2BIT | NAND_BBT_VERSION, + .offs = 8, + .len = 6, + .veroffs = 14, + .maxblocks = 8, /* Last 8 blocks in each chip */ + .pattern = bbt_pattern +}; + +static struct nand_bbt_descr bbt_mirror_descr = { + .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE | + NAND_BBT_2BIT | NAND_BBT_VERSION, + .offs = 8, + .len = 6, + .veroffs = 14, + .maxblocks = 8, /* Last 8 blocks in each chip */ + .pattern = bbt_mirror_pattern +}; + +static int phytium_nand_attach_chip(struct nand_chip *chip) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 value; + int ret = 0; + + if (nfc->caps->flash_bbt) + chip->bbt_options |= NAND_BBT_USE_FLASH; + + if (chip->bbt_options & NAND_BBT_USE_FLASH) { + /* + * We'll use a bad block table stored in-flash and don't + * allow writing the bad block marker to the flash. + */ + chip->bbt_options |= NAND_BBT_NO_OOB_BBM; + chip->bbt_td = &bbt_main_descr; + chip->bbt_md = &bbt_mirror_descr; + } + + if (chip->options & NAND_BUSWIDTH_16) + phytium_nand->ndcr |= NDCR0_WIDTH; + + /* + * On small page NANDs, only one cycle is needed to pass the + * column address. + */ + if (mtd->writesize <= 512) + phytium_nand->addr_cyc = 1; + else + phytium_nand->addr_cyc = 2; + + /* + * Now add the number of cycles needed to pass the row + * address. + * + * Addressing a chip using CS 2 or 3 should also need the third row + * cycle but due to inconsistance in the documentation and lack of + * hardware to test this situation, this case is not supported. + */ + if (chip->options & NAND_ROW_ADDR_3) + phytium_nand->addr_cyc += 3; + else + phytium_nand->addr_cyc += 2; + + if (nfc->caps) { + if (chip->ecc.engine_type == NAND_ECC_ENGINE_TYPE_ON_HOST) { + chip->ecc.size = nfc->caps->ecc_step_size ? + nfc->caps->ecc_step_size : + chip->ecc.size; + chip->ecc.strength = nfc->caps->ecc_strength ? + nfc->caps->ecc_strength : + chip->ecc.strength; + chip->ecc.strength = nfc->caps->ecc_strength; + chip->ecc.bytes = 7; + } else { + chip->ecc.size = 512; + chip->ecc.strength = 1; + chip->ecc.bytes = 0; + } + chip->ecc.engine_type = NAND_ECC_ENGINE_TYPE_ON_HOST; + } + + if (nfc->caps->hw_ver == 1) { + if (chip->ecc.strength == 0x04) + phytium_nand->ndcr |= NDCR0_ECC_STREN(4); + else if (chip->ecc.strength == 0x02) + phytium_nand->ndcr |= NDCR0_ECC_STREN(2); + else + phytium_nand->ndcr |= NDCR0_ECC_STREN(0); + } else { + if (chip->ecc.strength == 0x08) + phytium_nand->ndcr |= NDCR0_ECC_STREN(7); + else if (chip->ecc.strength == 0x04) + phytium_nand->ndcr |= NDCR0_ECC_STREN(3); + else if (chip->ecc.strength == 0x02) + phytium_nand->ndcr |= NDCR0_ECC_STREN(1); + else + phytium_nand->ndcr |= NDCR0_ECC_STREN(0); + } + + value = phytium_read(nfc, NDCR0); + value &= ~NDCR0_EN; + phytium_write(nfc, NDCR0, value); + + value &= ~NDCR0_ECC_STREN(7); + value |= phytium_nand->ndcr; + phytium_write(nfc, NDCR0, value | NDCR0_EN); + + ret = phytium_nand_ecc_init(mtd, &chip->ecc); + if (ret) { + dev_err(nfc->dev, "ECC init failed: %d\n", ret); + goto out; + } + + /* + * Subpage write not available with hardware ECC, prohibit also + * subpage read as in userspace subpage access would still be + * allowed and subpage write, if used, would lead to numerous + * uncorrectable ECC errors. + */ + if (chip->ecc.engine_type == NAND_ECC_ENGINE_TYPE_ON_HOST) + chip->options |= NAND_NO_SUBPAGE_WRITE; + + /* + * We keep the MTD name unchanged to avoid breaking platforms + * where the MTD cmdline parser is used and the bootloader + * has not been updated to use the new naming scheme. + */ + if (nfc->caps->legacy_of_bindings) + mtd->name = "phytium_nand-0"; + +out: + return ret; +} + +static int phytium_nfc_setup_interface(struct nand_chip *chip, int chipnr, + const struct nand_interface_config *conf) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + unsigned int period_ns = 2; + const struct nand_sdr_timings *sdr; + struct phytium_nfc_timings nfc_tmg; + int read_delay; + + sdr = nand_get_sdr_timings(conf); + if (IS_ERR(sdr)) + return PTR_ERR(sdr); + + nfc_tmg.tRP = TO_CYCLES(DIV_ROUND_UP(sdr->tRC_min, 2), period_ns) - 1; + nfc_tmg.tRH = nfc_tmg.tRP; + nfc_tmg.tWP = TO_CYCLES(DIV_ROUND_UP(sdr->tWC_min, 2), period_ns) - 1; + nfc_tmg.tWH = nfc_tmg.tWP; + nfc_tmg.tCS = TO_CYCLES(sdr->tCS_min, period_ns); + nfc_tmg.tCH = TO_CYCLES(sdr->tCH_min, period_ns) - 1; + nfc_tmg.tADL = TO_CYCLES(sdr->tADL_min, period_ns); + dev_info(nfc->dev, "[nfc_tmg]tRP: %d, tRH:%d, tWP:%d tWH:%d\n", + nfc_tmg.tRP, nfc_tmg.tRH, nfc_tmg.tWP, nfc_tmg.tWH); + dev_info(nfc->dev, "[nfc_tmg]tCS: %d, tCH:%d, tADL:%d\n", + nfc_tmg.tCS, nfc_tmg.tCH, nfc_tmg.tADL); + + read_delay = sdr->tRC_min >= 30000 ? + MIN_RD_DEL_CNT : MIN_RD_DEL_CNT + nfc_tmg.tRH; + + nfc_tmg.tAR = TO_CYCLES(sdr->tAR_min, period_ns); + nfc_tmg.tWHR = TO_CYCLES(max_t(int, sdr->tWHR_min, sdr->tCCS_min), + period_ns) - 2, + nfc_tmg.tRHW = TO_CYCLES(max_t(int, sdr->tRHW_min, sdr->tCCS_min), + period_ns); + dev_info(nfc->dev, "[nfc_tmg]tAR: %d, tWHR:%d, tRHW:%d\n", + nfc_tmg.tAR, nfc_tmg.tWHR, nfc_tmg.tRHW); + + nfc_tmg.tR = TO_CYCLES(sdr->tWB_max, period_ns); + + if (chipnr < 0) + return 0; + + if (nfc_tmg.tWP > 0x10) + nfc->timing_mode = ASY_MODE1; + else if (nfc_tmg.tWP < 0x0D) + nfc->timing_mode = ASY_MODE3; + + if (nfc->inter_mode == ONFI_DDR) + nfc->timing_mode = SYN_MODE3; + + phytium_nfc_default_data_interface(nfc); + + return 0; +} + +static const struct nand_controller_ops phytium_nand_controller_ops = { + .attach_chip = phytium_nand_attach_chip, + .exec_op = phytium_nfc_exec_op, + .setup_interface = phytium_nfc_setup_interface, +}; + +static void phytium_nand_chips_cleanup(struct phytium_nfc *nfc) +{ + struct phytium_nand_chip *entry, *temp; + int ret; + + list_for_each_entry_safe(entry, temp, &nfc->chips, node) { + ret = mtd_device_unregister(nand_to_mtd(&entry->chip)); + WARN_ON(ret); + nand_cleanup(&entry->chip); + list_del(&entry->node); + } +} + +static int phytium_nfc_init_dma(struct phytium_nfc *nfc) +{ + int ret; + + ret = dma_set_mask_and_coherent(nfc->dev, DMA_BIT_MASK(64)); + if (ret) + return ret; + + nfc->dsp_addr = dma_alloc_coherent(nfc->dev, PAGE_SIZE, + &nfc->dsp_phy_addr, GFP_KERNEL | GFP_DMA); + if (!nfc->dsp_addr) + return -ENOMEM; + + nfc->dma_buf = dma_alloc_coherent(nfc->dev, MAX_CHUNK_SIZE, + &nfc->dma_phy_addr, GFP_KERNEL | GFP_DMA); + if (!nfc->dma_buf) + return -ENOMEM; + + dev_info(nfc->dev, "NFC address dsp_phy_addr:%llx, dma_phy_addr:%llx\n", + nfc->dsp_phy_addr, nfc->dma_phy_addr); + + return 0; +} + +int phytium_nfc_init(struct phytium_nfc *nfc) +{ + u32 value; + + nfc->inter_mode = ASYN_SDR; + nfc->timing_mode = ASY_MODE0; + + value = phytium_read(nfc, NDCR1); + value &= (~NDCR1_SAMPL_PHASE(0xFFFF)); + value &= ~NDCR1_ECC_DATA_FIRST_EN; + value |= NDCR1_SAMPL_PHASE(1); + value |= NDCR1_ECC_BYPASS; + phytium_write(nfc, NDCR1, value); + phytium_write(nfc, ND_INTERVAL_TIME, 1); + phytium_write(nfc, NDFIFO_LEVEL0, 4); + phytium_write(nfc, NDFIFO_LEVEL1, 4); + phytium_write(nfc, NDFIFO_CLR, 1); + phytium_write(nfc, ND_ERR_CLR, 1); + + /* Configure the DMA */ + phytium_nfc_init_dma(nfc); + + + + phytium_nfc_reset(nfc); + + value = phytium_read(nfc, NDCR0); + value &= (~NDCR0_IN_MODE(3)); + value |= NDCR0_IN_MODE(nfc->inter_mode); + value |= NDCR0_EN; + + phytium_write(nfc, NDCR0, value); + + nfc_ecc_errover = 0; + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_init); + +static int phytium_nand_chip_init(struct phytium_nfc *nfc) +{ + struct device *dev = nfc->dev; + struct phytium_nand_chip *phytium_nand; + struct mtd_info *mtd; + struct nand_chip *chip; + int ret; + + /* Alloc the nand chip structure */ + phytium_nand = devm_kzalloc(dev, sizeof(*phytium_nand), GFP_KERNEL); + if (!phytium_nand) + return -ENOMEM; + + phytium_nand->nsels = 1; + phytium_nand->selected_die = -1; + + chip = &phytium_nand->chip; + chip->controller = &nfc->controller; + chip->legacy.select_chip = phytium_nfc_select_chip; + phytium_nfc_default_data_interface(nfc); + + mtd = nand_to_mtd(chip); + mtd->dev.parent = dev; + mtd->owner = THIS_MODULE; + + /* + * Default to HW ECC engine mode. If the nand-ecc-mode property is given + * in the DT node, this entry will be overwritten in nand_scan_ident(). + */ + chip->ecc.engine_type = NAND_ECC_ENGINE_TYPE_ON_HOST; + + chip->options |= NAND_BUSWIDTH_AUTO; + chip->options |= NAND_SKIP_BBTSCAN; + chip->bbt_options |= NAND_BBT_NO_OOB; + + ret = nand_scan(chip, phytium_nand->nsels); + if (ret) { + dev_err(dev, "could not scan the nand chip\n"); + goto out; + } + + if (nfc->caps->parts) { + ret = mtd_device_register(mtd, nfc->caps->parts, nfc->caps->nr_parts - 1); + } else if (dev->of_node) { + nand_set_flash_node(chip, dev->of_node); + ret = mtd_device_register(mtd, NULL, 0); + } else { + ret = -EINVAL; + } + + if (ret) { + dev_err(dev, "failed to register mtd device: %d\n", ret); + nand_cleanup(chip); + return ret; + } + + phytium_nand->ecc.length = phytium_nand_get_ecc_total(mtd, &chip->ecc); + phytium_nand->ecc.offset = mtd->oobsize - phytium_nand->ecc.length; + chip->ecc.total = phytium_nand_get_ecc_total(mtd, &chip->ecc); + + mtd_ooblayout_ecc(mtd, 0, &phytium_nand->ecc); + + dev_info(dev, "ooblayout ecc offset: %x, length: %x\n", + phytium_nand->ecc.offset, phytium_nand->ecc.length); + +out: + list_add_tail(&phytium_nand->node, &nfc->chips); + return 0; +} + +int phytium_nand_init(struct phytium_nfc *nfc) +{ + int ret; + + nand_controller_init(&nfc->controller); + nfc->controller.ops = &phytium_nand_controller_ops; + INIT_LIST_HEAD(&nfc->chips); + + /* Init the controller and then probe the chips */ + ret = phytium_nfc_init(nfc); + if (ret) + goto out; + + ret = phytium_nand_chip_init(nfc); + if (ret) + goto out; + + spin_lock_init(&nfc->spinlock); + +out: + return ret; +} +EXPORT_SYMBOL_GPL(phytium_nand_init); + +int phytium_nand_remove(struct phytium_nfc *nfc) +{ + phytium_nand_chips_cleanup(nfc); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nand_remove); + +static int phytium_nfc_wait_ndrun(struct nand_chip *chip) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + int ret = 0; + u32 val; + + ret = readl_relaxed_poll_timeout(nfc->regs + NDSR, val, + (val & NDSR_RB) == 0, + 0, 100 * 1000); + if (ret) { + dev_err(nfc->dev, "Timeout on NAND controller run mode\n"); + ret = -EAGAIN; + } + + return ret; +} + +int phytium_nand_prepare(struct phytium_nfc *nfc) +{ + struct phytium_nand_chip *chip = NULL; + + list_for_each_entry(chip, &nfc->chips, node) + phytium_nfc_wait_ndrun(&chip->chip); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nand_prepare); + +int phytium_nand_resume(struct phytium_nfc *nfc) +{ + nfc->selected_chip = NULL; + phytium_nfc_init(nfc); + phytium_nfc_default_data_interface(nfc); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nand_resume); + +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium NAND controller platform driver"); +MODULE_AUTHOR("Zhu Mingshuai "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand.h new file mode 100644 index 0000000000000000000000000000000000000000..f666cdff594b10231f8a88aadfa1dd8887a6e50d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand.h @@ -0,0 +1,449 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium NAND flash controller driver + * + * Copyright (c) 2020-2024 Phytium Technology, Co., Ltd. + */ +#ifndef PHYTIUM_NAND_H +#define PHYTIUM_NAND_H + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +/* NFC does not support transfers of larger chunks at a time */ +#define MAX_PAGE_NUM 16 +#define MAX_CHUNK_SIZE ((1024 + 76) * 16) + +#define POLL_PERIOD 0 +#define POLL_TIMEOUT 100000 +/* Interrupt maximum wait period in ms */ +#define IRQ_TIMEOUT 1000 + +/* Latency in clock cycles between SoC pins and NFC logic */ +#define MIN_RD_DEL_CNT 3 + +#define PHYTIUM_NFC_ADDR_MAX_LEN 5 +#define PHYTIUM_NFC_DSP_SIZE 16 + +/* NAND controller flash control register */ +#define NDCR0 0x00 +#define NDCR0_EN BIT(0) +#define NDCR0_WIDTH BIT(1) +#define NDCR0_IN_MODE(x) (min_t(u32, x, 0x3) << 2) +#define NDCR0_ECC_EN BIT(4) +#define NDCR0_ECC_STREN(x) (min_t(u32, x, 0x7) << 5) +#define NDCR0_SPARE_EN BIT(8) +#define NDCR0_SPARE_SIZE(x) (min_t(u32, x, 0xFFF) << 9) +#define NDCR0_GENERIC_FIELDS_MASK + +#define NDCR1 0x04 +#define NDCR1_SAMPL_PHASE(x) min_t(u32, x, 0xFFFF) +#define NDCR1_ECC_DATA_FIRST_EN BIT(16) +#define NDCR1_RB_SHARE_EN BIT(17) +#define NDCR1_ECC_BYPASS BIT(18) + +#define NDAR0 0x08 + +#define NDAR1 0x0C +#define NDAR1_H8(x) min_t(u32, x, 0xFF) +#define NDAR1_DMA_EN BIT(8) +#define NDAR1_EMPTY(x) (min_t(u32, x, 0x7F) << 9) +#define NDAR1_DMA_RLEN(x) (min_t(u32, x, 0xFF) << 9) +#define NDAR1_DMA_WLEN(x) (min_t(u32, x, 0xFF) << 9) + +#define NDTR0 0x10 +#define NDTR0_TCS_TCLS(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR0_TCLS_TWP(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR1 0x14 +#define NDTR1_TWH(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR1_TWP(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR2 0x18 +#define NDTR2_TCH_TCLH(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR2_TCLH_TWH(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR3 0x1c +#define NDTR3_TDQ_EN(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR3_TCH_TWH(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR4 0x20 +#define NDTR4_TWHR_SMX(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR4_TREH(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR5 0x24 +#define NDTR5_TRC(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR5_TADL_SMX(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR6 0x28 +#define NDTR6_TCAD_TCS_SMX(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR6_RES(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR7 0x2c +#define NDTR7_TCK(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR7_TDQ_EN(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR8 0x30 +#define NDTR8_TCAD_TCK_SMX(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR8_HF_TCK(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR9 0x34 +#define NDTR9_TWHR(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR9_TCCS_TCALS_SMX(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR10 0x38 +#define NDTR10_TCK(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR10_MTCK(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR11 0x3c +#define NDTR11_TCK_TCALS(x) (min_t(u32, x, 0xFFFF) << 16) +#define NDTR11_RES(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR12 0x40 +#define NDTR12_TWRCK(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR12_RES(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR13 0x44 +#define NDTR13_TWRHCA(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR13_TRLCA(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR14 0x48 +#define NDTR14_TWRHCE(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR14_RES(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR15 0x4c +#define NDTR15_TCDQSS_TWPRE_TDS(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR15_HFTDSC(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR16 0x50 +#define NDTR16_TWPST_TDH(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR16_TWPSTH(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR17 0x54 +#define NDTR17_TCS_TRPRE(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR17_TRELDQS(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR18 0x58 +#define NDTR18_TRPST_TDQSRE(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR18_RES(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDFIFO 0x5c +#define NDFIFO_REV (min_t(u32, x, 0) << 12) +#define NDFIFO_FULL BIT(11) +#define NDFIFO_EMP BIT(10) +#define NDFIFO_CNT(x) (min_t(u32, x, 0x3F) << 0) + +#define ND_INTERVAL_TIME 0x60 +#define NDCMD_INTERVAL_TIME 0x64 +#define NDFIFO_TIMEOUT 0x68 +#define NDFIFO_LEVEL0 0x6c +#define NDFIFO_LEVEL1 0x70 +#define NDWP 0x74 +#define NDFIFO_CLR 0x78 + +#define NDSR 0x7c +#define NDSR_BUSY BIT(0) +#define NDSR_DMA_BUSY BIT(1) +#define NDSR_DMA_PGFINISH BIT(2) +#define NDSR_DMA_FINISH BIT(3) +#define NDSR_FIFO_EMP BIT(4) +#define NDSR_FIFO_FULL BIT(5) +#define NDSR_FIFO_TIMEOUT BIT(6) +#define NDSR_CS(x) (min_t(u32, x, 0xF) << 7) +#define NDSR_CMD_PGFINISH BIT(11) +#define NDSR_PG_PGFINISH BIT(12) +#define NDSR_RE BIT(13) +#define NDSR_DQS BIT(14) +#define NDSR_RB BIT(15) +#define NDSR_ECC_BUSY BIT(16) +#define NDSR_ECC_FINISH BIT(17) +#define NDSR_ECC_RIGHT BIT(18) +#define NDSR_ECC_ERR BIT(19) +#define NDSR_ECC_ERROVER BIT(20) +#define NDSR_AXI_DSP_ERR BIT(21) +#define NDSR_AXI_RD_ERR BIT(22) +#define NDSR_AXI_WR_ERR BIT(23) +#define NDSR_RB_STATUS(x) (min_t(u32, x, 0xF) << 24) +#define NDSR_PROT_ERR BIT(28) +#define NDSR_ECC_BYPASS BIT(29) + +#define NDIR_MASK 0x80 +#define NDIR_BUSY_MASK BIT(0) +#define NDIR_DMA_BUSY_MASK BIT(1) +#define NDIR_DMA_PGFINISH_MASK BIT(2) +#define NDIR_DMA_FINISH_MASK BIT(3) +#define NDIR_FIFO_EMP_MASK BIT(4) +#define NDIR_FIFO_FULL_MASK BIT(5) +#define NDIR_FIFO_TIMEOUT_MASK BIT(6) +#define NDIR_CMD_FINISH_MASK BIT(7) +#define NDIR_PGFINISH_MASK BIT(8) +#define NDIR_RE_MASK BIT(9) +#define NDIR_DQS_MASK BIT(10) +#define NDIR_RB_MASK BIT(11) +#define NDIR_ECC_FINISH_MASK BIT(12) +#define NDIR_ECC_ERR_MASK BIT(13) + +#define NDIR 0x84 +#define NDIR_ALL_INT(x) GENMASK(x, 0) +#define NDIR_BUSY BIT(0) +#define NDIR_DMA_BUSY BIT(1) +#define NDIR_DMA_PGFINISH BIT(2) +#define NDIR_DMA_FINISH BIT(3) +#define NDIR_FIFO_EMP BIT(4) +#define NDIR_FIFO_FULL BIT(5) +#define NDIR_FIFO_TIMEOUT BIT(6) +#define NDIR_CMD_FINISH BIT(7) +#define NDIR_PGFINISH BIT(8) +#define NDIR_RE BIT(9) +#define NDIR_DQS BIT(10) +#define NDIR_RB BIT(11) +#define NDIR_ECC_FINISH BIT(12) +#define NDIR_ECC_ERR BIT(13) + +#define ND_DEBUG 0x88 + +#define ND_ERR_CLR 0x8c +#define ND_DSP_ERR_CLR BIT(0) +#define ND_AXI_RD_ERR_CLR BIT(1) +#define ND_AXI_WR_ERR_CLR BIT(2) +#define ND_ECC_ERR_CLR BIT(3) + +#define NDCR_PAGE_SZ(x) (x >= 2048 ? BIT(24) : 0) + +enum nand_inter_pro { + NAND_ONFI, + NAND_JEDEC, + NAND_OTHER, +}; + +enum nand_inter_mode { + ASYN_SDR, + ONFI_DDR, + TOG_ASYN_DDR, +}; + +enum asy_timing_mode { + ASY_MODE0, + ASY_MODE1, + ASY_MODE2, + ASY_MODE3, + ASY_MODE4, +}; + +enum onfi_syn_timing_mode { + SYN_MODE0 = 0x10, + SYN_MODE1, + SYN_MODE2, + SYN_MODE3, + SYN_MODE4, +}; + +/** + * NAND controller timings expressed in NAND Controller clock cycles + * + * @tRP: ND_nRE pulse width + * @tRH: ND_nRE high duration + * @tWP: ND_nWE pulse time + * @tWH: ND_nWE high duration + * @tCS: Enable signal setup time + * @tCH: Enable signal hold time + * @tADL: Address to write data delay + * @tAR: ND_ALE low to ND_nRE low delay + * @tWHR: ND_nWE high to ND_nRE low for status read + * @tRHW: ND_nRE high duration, read to write delay + * @tR: ND_nWE high to ND_nRE low for read + */ +struct phytium_nfc_timings { + u16 tRP; + u16 tRH; + u16 tWP; /* NDTR1_TWP */ + u16 tWH; /* NDTR1_TWH */ + u16 tCS; + u16 tCH; + u16 tADL; + u16 tAR; + u16 tWHR; + u16 tRHW; + u16 tR; +}; + +/** + * NAND chip structure: stores NAND chip device related information + * + * @chip: Base NAND chip structure + * @node: Used to store NAND chips into a list + * @ndcr: Controller register value for this NAND chip + * @ndtr0: Timing registers 0 value for this NAND chip + * @ndtr1: Timing registers 1 value for this NAND chip + * @selected_die: Current active CS + * @nsels: Number of CS lines required by the NAND chip + */ +struct phytium_nand_chip { + struct nand_chip chip; + struct list_head node; + u32 ndcr; + u32 ndtr0; + u32 ndtr1; + int addr_cyc; + int selected_die; + unsigned int nsels; + struct mtd_oob_region ecc; +}; + +/** + * NAND controller capabilities for distinction between compatible strings + * + * @max_cs_nb: Number of Chip Select lines available + * @max_rb_nb: Number of Ready/Busy lines available + * @legacy_of_bindings: Indicates if DT parsing must be done using the old + * fashion way + * @flash_bbt: + * @ecc_strength: + * @ecc_step_size: + * @parts: + * @nr_parts: + */ +struct phytium_nfc_caps { + unsigned int hw_ver; + unsigned int int_mask_bits; + unsigned int max_cs_nb; + unsigned int max_rb_nb; + bool legacy_of_bindings; + bool flash_bbt; + int ecc_strength; + int ecc_step_size; + struct mtd_partition *parts; + unsigned int nr_parts; +}; + +/** + * NAND controller structure: stores Marvell NAND controller information + * + * @controller: Base controller structure + * @dev: Parent device (used to print error messages) + * @regs: NAND controller registers + * @reg_clk: Regiters clock + * @complete: Completion object to wait for NAND controller events + * @chips: List containing all the NAND chips attached to + * this NAND controller + * @caps: NAND controller capabilities for each compatible string + * @dma_buf: 32-bit aligned buffer for DMA transfers (NFCv1 only) + */ +struct phytium_nfc { + struct nand_controller controller; + struct device *dev; + void __iomem *regs; + int irq; + struct list_head chips; + struct nand_chip *selected_chip; + struct phytium_nfc_caps *caps; + + void *dsp_addr; + dma_addr_t dsp_phy_addr; + + void *dma_buf; + u32 dma_offset; + dma_addr_t dma_phy_addr; + + enum nand_inter_pro inter_pro; + enum nand_inter_mode inter_mode; + u32 timing_mode; + + spinlock_t spinlock; +}; + +/** + * Derives a duration in numbers of clock cycles. + * + * @ps: Duration in pico-seconds + * @period_ns: Clock period in nano-seconds + * + * Convert the duration in nano-seconds, then divide by the period and + * return the number of clock periods. + */ +#define TO_CYCLES(ps, period_ns) (DIV_ROUND_UP(ps / 1000, period_ns)) +#define TO_CYCLES64(ps, period_ns) (DIV_ROUND_UP_ULL(div_u64(ps, 1000), \ + period_ns)) + +struct phytium_nfc_cmd_ctrl { + u16 csel:4; + u16 dbc:1; + u16 addr_cyc:3; + u16 nc:1; +#define TYPE_RESET 0x00 +#define TYPE_SET_FTR 0x01 +#define TYPE_GET_FTR 0x02 +#define TYPE_READ_ID 0x03 +#define TYPE_PAGE_PRO 0x04 +#define TYPE_ERASE 0x05 +#define TYPE_READ 0x06 +#define TYPE_TOGGLE 0x07 +#define TYPE_READ_PARAM 0x02 +#define TYPE_READ_STATUS 0x03 +#define TYPE_CH_READ_COL 0x03 +#define TYPE_CH_ROW_ADDR 0x01 +#define TYPE_CH_WR_COL 0x01 + u16 cmd_type:4; + u16 dc:1; + u16 auto_rs:1; + u16 ecc_en:1; +}; + +/** + * NAND driver structure filled during the parsing of the ->exec_op() subop + * subset of instructions. + * + * @cle_ale_delay_ns: Optional delay after the last CMD or ADDR cycle + * @rdy_timeout_ms: Timeout for waits on Ready/Busy pin + * @rdy_delay_ns: Optional delay after waiting for the RB pin + * @data_delay_ns: Optional delay after the data xfer + * @data_instr_idx: Index of the data instruction in the subop + * @data_instr: Pointer to the data instruction in the subop + */ +struct phytium_nfc_op { + u8 cmd[2]; + union { + u16 ctrl; + struct phytium_nfc_cmd_ctrl nfc_ctrl; + } cmd_ctrl; + u8 addr[PHYTIUM_NFC_ADDR_MAX_LEN]; + u16 page_cnt; + u8 mem_addr_first[PHYTIUM_NFC_ADDR_MAX_LEN]; + + u32 cmd_len; + u32 addr_len; + + u32 cle_ale_delay_ns; + u32 rdy_timeout_ms; + u32 rdy_delay_ns; + u32 data_delay_ns; + u32 data_instr_idx; + struct nand_op_instr *data_instr; +} __attribute__ ((__packed__)); + +#define TIMING_ASY_NUM 12 +#define TIMING_SYN_NUM 14 +#define TIMING_TOG_NUM 12 + +#define TMP_DMA_DEBUG 0 /* Temporary dma space */ + +int phytium_nand_init(struct phytium_nfc *nfc); +int phytium_nand_remove(struct phytium_nfc *nfc); +int phytium_nand_prepare(struct phytium_nfc *nfc); +int phytium_nand_suspend(struct phytium_nfc *nfc); +int phytium_nand_resume(struct phytium_nfc *nfc); + +irqreturn_t phytium_nfc_isr(int irq, void *dev_id); + +#endif /* NAND_PHYTIUM_NAND_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand_pci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand_pci.c new file mode 100644 index 0000000000000000000000000000000000000000..a8f054d669cc60765e2a0887030185f3d36bc6d6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand_pci.c @@ -0,0 +1,158 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * PCI driver for Phytium NAND flash controller + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ +#include +#include +#include + +#include "phytium_nand.h" + +#define DRV_NAME "phytium_nand_pci" + +static struct mtd_partition partition_info[] = { + { + .name = "Flash partition 1", + .offset = 0x0000000, + .size = 0x4000000 }, + { + .name = "Flash partition 2", + .offset = 0x4000000, + .size = 0x8000000 }, + { + .name = "Flash partition 3", + .offset = 0x8000000, + .size = 0x10000000 }, + { + .name = "Flash partition 4", + .offset = 0x10000000, + .size = 0x12000000 }, + { + .name = "Flash partition 5", + .offset = 0x12000000, + .size = 0x14000000 }, +}; + +static struct phytium_nfc_caps x100_nfc_caps = { + .hw_ver = 1, + .int_mask_bits = 13, + .max_cs_nb = 2, + .max_rb_nb = 1, + .legacy_of_bindings = true, + .ecc_strength = 4, + .ecc_step_size = 512, + .nr_parts = 5, + .parts = partition_info, +}; + +static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) +{ + struct phytium_nfc *nfc; + int ret; + + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); + if (ret) { + dev_err(&pdev->dev, "I/O memory remapping failed\n"); + return ret; + } + + pci_set_master(pdev); + pci_try_set_mwi(pdev); + + ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); + if (ret) + return ret; + + ret = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); + if (ret) + return ret; + + nfc = devm_kzalloc(&pdev->dev, sizeof(struct phytium_nfc), + GFP_KERNEL); + if (!nfc) + return -ENOMEM; + + nfc->dev = &pdev->dev; + nfc->regs = pcim_iomap_table(pdev)[0]; + nfc->irq = pdev->irq; + nfc->caps = &x100_nfc_caps; + + ret = devm_request_irq(nfc->dev, nfc->irq, phytium_nfc_isr, + IRQF_SHARED, "phytium-nfc-pci", nfc); + if (ret) { + dev_err(nfc->dev, "Failed to register NFC interrupt.\n"); + return ret; + } + + ret = phytium_nand_init(nfc); + if (ret) + return ret; + + pci_set_drvdata(pdev, nfc); + + return ret; +} + +static void phytium_pci_remove(struct pci_dev *pdev) +{ + struct phytium_nfc *nfc = pci_get_drvdata(pdev); + int ret; + + ret = phytium_nand_remove(nfc); + if (ret) + dev_warn(&pdev->dev, "can't remove device properly: %d\n", ret); +} + +static int __maybe_unused phytium_nfc_prepare(struct device *dev) +{ + struct pci_dev *pci = to_pci_dev(dev); + struct phytium_nfc *nfc = pci_get_drvdata(pci); + int ret; + + ret = phytium_nand_prepare(nfc); + + return 0; +} + +static int __maybe_unused phytium_nfc_resume(struct device *dev) +{ + struct pci_dev *pci = to_pci_dev(dev); + struct phytium_nfc *nfc = pci_get_drvdata(pci); + int ret; + + ret = phytium_nand_resume(nfc); + + return ret; +} + +static const struct dev_pm_ops phytium_pci_dev_pm_ops = { + .prepare = phytium_nfc_prepare, + .resume = phytium_nfc_resume, +}; + +static const struct pci_device_id phytium_pci_id_table[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc29) }, + { } +}; +MODULE_DEVICE_TABLE(pci, phytium_pci_id_table); + +static struct pci_driver phytium_pci_driver = { + .name = DRV_NAME, + .id_table = phytium_pci_id_table, + .probe = phytium_pci_probe, + .remove = phytium_pci_remove, + .driver = { + .pm = &phytium_pci_dev_pm_ops, + }, +}; +module_pci_driver(phytium_pci_driver); + +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("PCI driver for Phytium NAND controller"); +MODULE_AUTHOR("Zhu Mingshuai "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand_plat.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand_plat.c new file mode 100644 index 0000000000000000000000000000000000000000..65504785f33ba1b441e5fa06302a016f7be7d009 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/nand/raw/phytium_nand_plat.c @@ -0,0 +1,138 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Core driver for Phytium NAND flash controller + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "phytium_nand.h" + +#define DRV_NAME "phytium_nand_plat" + +static int phytium_nfc_plat_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct resource *r; + struct phytium_nfc *nfc; + unsigned int ecc_strength; + unsigned int ecc_step_size; + int ret; + + nfc = devm_kzalloc(&pdev->dev, sizeof(struct phytium_nfc), + GFP_KERNEL); + if (!nfc) + return -ENOMEM; + + nfc->dev = dev; + + r = platform_get_resource(pdev, IORESOURCE_MEM, 0); + nfc->regs = devm_ioremap_resource(dev, r); + if (IS_ERR(nfc->regs)) + return PTR_ERR(nfc->regs); + + dev_info(nfc->dev, "NFC register address :%p, phy address:%llx\n", + nfc->regs, r->start); + + nfc->irq = platform_get_irq(pdev, 0); + if (nfc->irq < 0) { + dev_err(dev, "failed to retrieve irq\n"); + return nfc->irq; + } + + ret = devm_request_irq(dev, nfc->irq, phytium_nfc_isr, 0, + "phytium-nfc-plat", nfc); + if (ret) { + dev_err(nfc->dev, "Failed to register NFC interrupt.\n"); + return ret; + } + + nfc->caps = devm_kzalloc(dev, sizeof(struct phytium_nfc_caps), GFP_KERNEL); + if (!nfc->caps) + return -ENOMEM; + + /* Currently hard-coded parameters */ + nfc->caps->hw_ver = 2; + nfc->caps->int_mask_bits = 17; + nfc->caps->max_cs_nb = 4; + nfc->caps->max_rb_nb = 4; + nfc->caps->nr_parts = 0; + nfc->caps->parts = NULL; + + device_property_read_u32(&pdev->dev, "nand-ecc-strength", &ecc_strength); + nfc->caps->ecc_strength = ecc_strength ? ecc_strength : 8; + + device_property_read_u32(&pdev->dev, "nand-ecc-step-size", &ecc_step_size); + nfc->caps->ecc_step_size = ecc_step_size ? ecc_step_size : 512; + + ret = phytium_nand_init(nfc); + if (ret) + return ret; + + platform_set_drvdata(pdev, nfc); + + return ret; +} + +static int phytium_nfc_plat_remove(struct platform_device *pdev) +{ + struct phytium_nfc *nfc = platform_get_drvdata(pdev); + + return phytium_nand_remove(nfc); +} + +static int __maybe_unused phytium_nfc_plat_prepare(struct device *dev) +{ + struct phytium_nfc *nfc = dev_get_drvdata(dev); + + return phytium_nand_prepare(nfc); +} + +static int __maybe_unused phytium_nfc_plat_resume(struct device *dev) +{ + struct phytium_nfc *nfc = dev_get_drvdata(dev); + int ret; + + ret = phytium_nand_resume(nfc); + + return ret; +} + +static const struct dev_pm_ops phytium_dev_pm_ops = { + .prepare = phytium_nfc_plat_prepare, + .resume = phytium_nfc_plat_resume, +}; + +#ifdef CONFIG_OF +static const struct of_device_id phytium_nfc_of_ids[] = { + { .compatible = "phytium,nfc", }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(of, phytium_nfc_of_ids); +#endif + +static struct platform_driver phytium_nfc_plat_driver = { + .driver = { + .name = DRV_NAME, + .of_match_table = phytium_nfc_of_ids, + .pm = &phytium_dev_pm_ops, + }, + .probe = phytium_nfc_plat_probe, + .remove = phytium_nfc_plat_remove, +}; +module_platform_driver(phytium_nfc_plat_driver) + +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium NAND controller Platform driver"); +MODULE_AUTHOR("Zhu Mingshuai "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..5e603be9d985471c24f46cd8650d2a5bb8c6da2d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/Makefile @@ -0,0 +1 @@ +obj-y += controllers/ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/controllers/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/controllers/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..5991937154405625bf58a70b940469f6c40cb19f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/controllers/Kconfig @@ -0,0 +1,8 @@ +config SPI_PHYTIUM_QUADSPI + tristate "Phytium Quad SPI Controller" + depends on ARCH_PHYTIUM || ARM + depends on OF && HAS_IOMEM + help + This enables support for the Quad SPI controller in master mode. + This driver does not support generic SPI. The implementation only + supports SPI NOR. diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/controllers/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/controllers/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..ad7bd05c71795e986a412a67e2b7c7d79367b5c6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/controllers/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_SPI_PHYTIUM_QUADSPI) += phytium-quadspi.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/controllers/phytium-quadspi.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/controllers/phytium-quadspi.c new file mode 100644 index 0000000000000000000000000000000000000000..267590aaa95394efccec988c7d654caa1434fb0d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/mtd/spi-nor/controllers/phytium-quadspi.c @@ -0,0 +1,1024 @@ +/* + * Phytium SPI core controller driver. + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms and conditions of the GNU General Public License, + * version 2, as published by the Free Software Foundation. + * + * This program is distributed in the hope it will be useful, but WITHOUT + * 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 +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define QSPI_FLASH_CAP_REG 0x000 +#define QSPI_RD_CFG_REG 0x004 +#define QSPI_WR_CFG_REG 0x008 +#define QSPI_FLUSH_REG 0x00C +#define QSPI_CMD_PORT_REG 0x010 +#define QSPI_ADDR_PORT_REG 0x014 +#define QSPI_HD_PORT_REG 0x018 +#define QSPI_LD_PORT_REG 0x01C +#define QSPI_FUN_SET_REG 0x020 +#define QSPI_WIP_REG 0x024 +#define QSPI_WP_REG 0x028 +#define QSPI_MODE_REG 0x02C + +#define QSPI_FLASH_CAP_NUM_SHIFT 3 +#define QSPI_FLASH_CAP_NUM_MASK (0x3 << QSPI_FLASH_CAP_NUM_SHIFT) +#define QSPI_FLASH_CAP_CAP_SHIFT 0 +#define QSPI_FLASH_CAP_CAP_MASK (0x7 << QSPI_FLASH_CAP_CAP_SHIFT) + +#define QSPI_RD_CFG_RD_CMD_SHIFT 24 +#define QSPI_RD_CFG_RD_CMD_MASK (0xFF << QSPI_RD_CFG_RD_CMD_SHIFT) +#define QSPI_RD_CFG_RD_THROUGH_SHIFT 23 +#define QSPI_RD_CFG_RD_THROUGH_MASK (0x01 << QSPI_RD_CFG_RD_THROUGH_SHIFT) +#define QSPI_RD_CFG_RD_TRANSFER_SHIFT 20 +#define QSPI_RD_CFG_RD_TRANSFER_MASK (0x07 << QSPI_RD_CFG_RD_TRANSFER_SHIFT) +#define QSPI_RD_CFG_RD_ADDR_SEL_SHIFT 19 +#define QSPI_RD_CFG_RD_ADDR_SEL_MASK (0x1 << QSPI_RD_CFG_RD_ADDR_SEL_SHIFT) +#define QSPI_RD_CFG_RD_LATENCY_SHIFT 18 +#define QSPI_RD_CFG_RD_LATENCY_MASK (0x1 << QSPI_RD_CFG_RD_LATENCY_SHIFT) +#define QSPI_RD_CFG_MODE_BYTE_SHIFT 17 +#define QSPI_RD_CFG_MODE_BYTE_MASK (0x1 << QSPI_RD_CFG_MODE_BYTE_SHIFT) +#define QSPI_RD_CFG_CMD_SIGN_SHIFT 9 +#define QSPI_RD_CFG_CMD_SIGN_MASK (0xFF << QSPI_RD_CFG_CMD_SIGN_SHIFT) +#define QSPI_RD_CFG_DUMMY_SHIFT 4 +#define QSPI_RD_CFG_DUMMY_MASK (0x1F << QSPI_RD_CFG_DUMMY_SHIFT) +#define QSPI_RD_CFG_D_BUFFER_SHIFT 3 +#define QSPI_RD_CFG_D_BUFFER_MASK (0x1 << QSPI_RD_CFG_D_BUFFER_SHIFT) +#define QSPI_RD_CFG_RD_SCK_SEL_SHIFT 0 +#define QSPI_RD_CFG_RD_SCK_SEL_MASK (0x3 << QSPI_RD_CFG_RD_SCK_SEL_SHIFT) + +#define QSPI_WR_CFG_WR_CMD_SHIFT 24 +#define QSPI_WR_CFG_WR_CMD_MASK (0xFF << QSPI_WR_CFG_WR_CMD_SHIFT) +#define QSPI_WR_CFG_WR_WAIT_SHIFT 9 +#define QSPI_WR_CFG_WR_WAIT_MASK (0x01 << QSPI_WR_CFG_WR_WAIT_SHIFT) +#define QSPI_WR_CFG_WR_THROUGH_SHIFT 8 +#define QSPI_WR_CFG_WR_THROUGH_MAS (0x01 << QSPI_WR_CFG_WR_THROUGH_SHIFT) +#define QSPI_WR_CFG_WR_TRANSFER_SHIFT 5 +#define QSPI_WR_CFG_WR_TRANSFER_MASK (0X7 << QSPI_WR_CFG_WR_TRANSFER_SHIFT) +#define QSPI_WR_CFG_WR_ADDR_SEL_SHIFT 4 +#define QSPI_WR_CFG_WR_ADDR_SEL_MASK (0x1 << QSPI_WR_CFG_WR_ADDR_SEL_SHIFT) +#define QSPI_WR_CFG_WR_MODE_SHIFT 3 +#define QSPI_WR_CFG_WR_MODE (0x01 << QSPI_WR_CFG_WR_MODE_SHIFT) +#define QSPI_WR_CFG_WR_SCK_SEL_SHIFT 0 +#define QSPI_WR_CFG_WR_SCK_SEL_MASK (0x7 << QSPI_WR_CFG_WR_SCK_SEL_SHIFT) + +#define QSPI_FLUSH_EN (0x1 << 0) + +#define QSPI_CMD_PORT_CMD_SHIFT 24 +#define QSPI_CMD_PORT_CMD_MASK (0xFF << QSPI_CMD_PORT_CMD_SHIFT) +#define QSPI_CMD_PORT_WAIT_SHIFT 22 +#define QSPI_CMD_PORT_WAIT_MASK (0x1 << QSPI_CMD_PORT_WAIT_SHIFT) +#define QSPI_CMD_PORT_THROUGH_SHIFT 21 +#define QSPI_CMD_PORT_THROUGH_MASK (0x1 << QSPI_CMD_PORT_THROUGH_SHIFT) +#define QSPI_CMD_PORT_CS_SHIFT 19 +#define QSPI_CMD_PORT_CS_MASK (0x3 << QSPI_CMD_PORT_CS_SHIFT) +#define QSPI_CMD_PORT_TRANSFER_SHIFT 16 +#define QSPI_CMD_PORT_TRANSFER_MASK (0x7 << QSPI_CMD_PORT_TRANSFER_SHIFT) +#define QSPI_CMD_PORT_CMD_ADDR_SHIFT 15 +#define QSPI_CMD_PORT_CMD_ADDR_MASK (0x1 << QSPI_CMD_PORT_CMD_ADDR_SHIFT) +#define QSPI_CMD_PORT_LATENCY_SHIFT 14 +#define QSPI_CMD_PORT_LATENCY_MASK (0x1 << QSPI_CMD_PORT_LATENCY_SHIFT) +#define QSPI_CMD_PORT_DATA_TRANSFER_SHIFT 13 +#define QSPI_CMD_PORT_DATA_TRANSFER_MASK (0x1 << 13) +#define QSPI_CMD_PORT_SEL_SHIFT 12 +#define QSPI_CMD_PORT_SEL_MASK (0x1 << QSPI_CMD_PORT_SEL_SHIFT) +#define QSPI_CMD_PORT_DUMMY_SHIFT 7 +#define QSPI_CMD_PORT_DUMMY_MASK (0x1F << QSPI_CMD_PORT_DUMMY_SHIFT) +#define QSPI_CMD_PORT_DUMMY(x) (((x) << QSPI_CMD_PORT_DUMMY_SHIFT) & QSPI_CMD_PORT_DUMMY_MASK) +#define QSPI_CMD_PORT_P_BUFFER_SHIFT 6 +#define QSPI_CMD_PORT_P_BUFFER_MASK (0x1 << QSPI_CMD_PORT_P_BUFFER_SHIFT) +#define QSPI_CMD_PORT_RW_NUM_SHIFT 3 +#define QSPI_CMD_PORT_RW_NUM_MASK (0x7 << QSPI_CMD_PORT_RW_NUM_SHIFT) +#define QSPI_CMD_PORT_SCK_SEL_SHIFT 0 +#define QSPI_CMD_PORT_SCK_SEL_MASK (0x7 << QSPI_CMD_PORT_SCK_SEL_SHIFT) + +#define QSPI_FUN_SET_HOLD_SHIFT 24 +#define QSPI_FUN_SET_HOLD_MASK (0xFF << QSPI_FUN_SET_HOLD_SHIFT) +#define QSPI_FUN_SET_SETUP_SHIFT 16 +#define QSPI_FUN_SET_SETUP_MASK (0xFF << QSPI_FUN_SET_SETUP_SHIFT) +#define QSPI_FUN_SET_DELAY_SHIFT 0 +#define QSPI_FUN_SET_DELAY_MASK (0xFFFF << QSPI_FUN_SET_DELAY_SHIFT) + +#define QSPI_WIP_W_CMD_SHIFT 24 +#define QSPI_WIP_W_CMD_MASK (0xFF << QSPI_WIP_W_CMD_SHIFT) +#define QSPI_WIP_W_TRANSFER_SHIFT 3 +#define QSPI_WIP_W_TRANSFER_MASK (0x3 << QSPI_WIP_W_TRANSFER_SHIFT) +#define QSPI_WIP_W_SCK_SEL_SHIFT 0 +#define QSPI_WIP_W_SCK_SEL_MASK (0x7 << QSPI_WIP_W_SCK_SEL_SHIFT) + +#define QSPI_WP_EN_SHIFT 17 +#define QSPI_WP_EN_MASK (0x1 << QSPI_WP_EN_SHIFT) +#define QSPI_WP_IO2_SHIFT 16 +#define QSPI_WP_IO2_MASK (0x1 << QSPI_WP_IO2_SHIFT) +#define QSPI_WP_HOLD_SHIFT 8 +#define QSPI_WP_HOLD_MASK (0xFF << QSPI_WP_HOLD_SHIFT) +#define QSPI_WP_SETUP_SHIFT 0 +#define QSPI_WP_SETUP_MASK (0xFF << QSPI_WP_SETUP_SHIFT) + +#define QSPI_MODE_VALID_SHIFT 8 +#define QSPI_MODE_VALID_MASK (0xFF << QSPI_MODE_VALID_SHIFT) +#define QSPI_MODE_SHIFT 0 +#define QSPI_MODE_MASK (0xFF << QSPI_MODE_SHIFT) + +#define FSIZE_VAL(size) (__fls(size) - 1) + +#define PHYTIUM_MAX_MMAP_S SZ_512M +#define PHYTIUM_MAX_NORCHIP 4 + +#define PHYTIUM_QSPI_FIFO_SZ 32 +#define PHYTIUM_QSPI_FIFO_TIMEOUT_US 50000 +#define PHYTIUM_QSPI_BUSY_TIMEOUT_US 100000 + +#define PHYTIUM_SCK_SEL 0x05 +#define PHYTIUM_CMD_SCK_SEL 0x07 + +#define PHYTIUM_FMODE_MM 0x01 +#define PHYTIUM_FMODE_IN 0x02 + +/* + * the codes of the different commands + */ +#define CMD_WRDI 0x04 +#define CMD_RDID 0x9F +#define CMD_RDSR 0x05 +#define CMD_WREN 0x06 +#define CMD_RDAR 0x65 +#define CMD_P4E 0x20 +#define CMD_4P4E 0x21 +#define CMD_BE 0x60 +#define CMD_4BE 0xC7 +#define CMD_READ 0x03 +#define CMD_FAST_READ 0x0B +#define CMD_QOR 0x6B +#define CMD_QIOR 0xEB +#define CMD_DDRFR 0x0D +#define CMD_DDRQIOQ 0xED +#define CMD_PP 0x02 +#define CMD_QPP 0x32 +#define CMD_SE 0xD8 +#define CMD_4FAST_READ 0x0C +#define CMD_4READ 0x13 +#define CMD_4QOR 0x6C +#define CMD_4QIOR 0xEC +#define CMD_4DDRFR 0x0E +#define CMD_4DDRQIOR 0xEE +#define CMD_4PP 0x12 +#define CMD_4QPP 0x34 +#define CMD_4SE 0xDC + +#define PHYTIUM_QSPI_1_1_1 0 +#define PHYTIUM_QSPI_1_1_2 1 +#define PHYTIUM_QSPI_1_1_4 2 +#define PHYTIUM_QSPI_1_2_2 3 +#define PHYTIUM_QSPI_1_4_4 4 +#define PHYTIUM_QSPI_2_2_2 5 +#define PHYTIUM_QSPI_4_4_4 6 + +struct phytium_qspi_flash { + struct spi_nor nor; + struct phytium_qspi *qspi; + u32 cs; + u32 fsize; + u32 presc; + u32 clk_div; + u32 read_mode; + bool registered; + u32 prefetch_limit; + u32 addr_width; + u32 read_cmd; +}; + +struct phytium_qspi { + struct device *dev; + void __iomem *io_base; + void __iomem *mm_base; + resource_size_t mm_size; + u32 nor_num; + struct clk *clk; + u32 clk_rate; + struct phytium_qspi_flash flash[PHYTIUM_MAX_NORCHIP]; + + spinlock_t spinlock; + + /* + * to protect device configuration, could be different between + * 2 flash access (bk1, bk2) + */ + struct mutex lock; +}; + +/* Need to enable p_buffer */ +static int memcpy_from_ftreg(struct phytium_qspi *qspi, u_char *buf, size_t len) +{ + int i; + u32 val = 0; + + if (!qspi || !buf) + return -EINVAL; + + for (i = 0; i < len; i++) { + if (0 == i % 4) + val = readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); + + buf[i] = (u_char) (val >> (i % 4) * 8) & 0xFF; + } + + return 0; +} + +/* Not to enable p_buffer */ +static int memcpy_to_ftreg(struct phytium_qspi *qspi, const u8 *buf, size_t len) +{ + u32 val = 0; + + if (!qspi || !buf || (len >= 8)) + return -EINVAL; + + if (1 == len) { + val = buf[0]; + } else if (2 == len) { + val = buf[1]; + val = (val << 8) + buf[0]; + } else if (3 == len) { + val = buf[2]; + val = (val << 8) + buf[1]; + val = (val << 8) + buf[0]; + } else if (4 == len) { + val = buf[3]; + val = (val << 8) + buf[2]; + val = (val << 8) + buf[1]; + val = (val << 8) + buf[0]; + } + + writel_relaxed(val, qspi->io_base + QSPI_LD_PORT_REG); + + return 0; +} + +static int phytium_qspi_wait_cmd(struct phytium_qspi *qspi, + struct phytium_qspi_flash *flash) +{ + u32 cmd = 0; + u32 cnt = 0; + + cmd |= CMD_RDSR << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + + cnt = PHYTIUM_QSPI_BUSY_TIMEOUT_US / 10; + while (readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG) & 0x01) { + udelay(10); + cnt--; + if (!cnt) { + dev_err(qspi->dev, "wait command process timeout\n"); + break; + } + } + + return !cnt; +} + +static int phytium_qspi_cmd_enable(struct phytium_qspi *qspi) +{ + u32 val = 0; + + writel_relaxed(val, qspi->io_base + QSPI_LD_PORT_REG); + + return 0; +} + +static int phytium_qspi_write_enable(struct phytium_qspi *qspi, + struct phytium_qspi_flash *flash) +{ + u32 cmd = 0; + + cmd = CMD_WREN << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + phytium_qspi_cmd_enable(qspi); + + return 0; +} + +static int phytium_qspi_write_disable(struct phytium_qspi *qspi, + struct phytium_qspi_flash *flash) +{ + u32 cmd = 0; + + cmd = CMD_WRDI << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + phytium_qspi_cmd_enable(qspi); + + return 0; +} + +static int phytium_qspi_read_flash_id(struct phytium_qspi *qspi, + struct phytium_qspi_flash *flash, u8 opcode, u8 *buf, int len) +{ + u32 cmd = 0; + unsigned long iflags; + + cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); + cmd |= BIT(QSPI_CMD_PORT_P_BUFFER_SHIFT); + cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + phytium_qspi_cmd_enable(qspi); + + spin_lock_irqsave(&qspi->spinlock, iflags); + memcpy_from_ftreg(qspi, buf, len); + spin_unlock_irqrestore(&qspi->spinlock, iflags); + + dev_dbg(qspi->dev, "read flash id:%x\n", *(u32 *)buf); + return 0; +} + +static int phytium_qspi_read_flash_sfdp(struct phytium_qspi *qspi, + struct phytium_qspi_flash *flash, struct spi_nor *nor, loff_t from, u8 *buf, int len) +{ + unsigned long iflags; + u32 cmd = 0; + u8 opcode = nor->read_opcode; + + cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); + cmd |= BIT(QSPI_CMD_PORT_P_BUFFER_SHIFT); + cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); + cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + cmd |= BIT(QSPI_CMD_PORT_LATENCY_SHIFT); + cmd |= QSPI_CMD_PORT_DUMMY(nor->read_dummy - 1); + + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + writel_relaxed(from, qspi->io_base + QSPI_ADDR_PORT_REG); + phytium_qspi_cmd_enable(qspi); + + spin_lock_irqsave(&qspi->spinlock, iflags); + memcpy_from_ftreg(qspi, buf, len); + spin_unlock_irqrestore(&qspi->spinlock, iflags); + + dev_dbg(qspi->dev, "read flash sfdp:0x%llx 0x%llx\n", + *(u64 *)buf, *(u64 *)(buf + 8)); + return len; +} + +static int phytium_qspi_read_flash_sr1(struct phytium_qspi *qspi, + struct phytium_qspi_flash *flash, u8 opcode, u8 *buf, int len) +{ + u32 cmd = 0; + u32 val; + + cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); + cmd |= (len << QSPI_CMD_PORT_RW_NUM_SHIFT) & QSPI_CMD_PORT_RW_NUM_MASK; + cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + phytium_qspi_cmd_enable(qspi); + + val = readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); + buf[0] = (u8)val; + + return 0; +} + +static int phytium_qspi_read_reg(struct spi_nor *nor, u8 opcode, u8 *buf, size_t len) +{ + struct phytium_qspi_flash *flash = nor->priv; + struct device *dev = flash->qspi->dev; + struct phytium_qspi *qspi = flash->qspi; + unsigned long iflags; + u32 cmd = 0; + + dev_dbg(dev, "read_reg: cmd:%#.2x buf:%pK len:%#lx\n", opcode, buf, len); + + switch (opcode) { + case CMD_RDID: + phytium_qspi_read_flash_id(qspi, flash, opcode, buf, len); + return 0; + case CMD_RDSR: + phytium_qspi_read_flash_sr1(qspi, flash, opcode, buf, len); + return 0; + default: + break; + } + + cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); + cmd |= BIT(QSPI_CMD_PORT_P_BUFFER_SHIFT); + cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + phytium_qspi_cmd_enable(qspi); + + spin_lock_irqsave(&qspi->spinlock, iflags); + memcpy_from_ftreg(qspi, buf, len); + spin_unlock_irqrestore(&qspi->spinlock, iflags); + + return 0; +} + +static int phytium_qspi_write_reg(struct spi_nor *nor, u8 opcode, const u8 *buf, size_t len) +{ + struct phytium_qspi_flash *flash = nor->priv; + struct device *dev = flash->qspi->dev; + struct phytium_qspi *qspi = flash->qspi; + u32 cmd = 0; + + dev_dbg(dev, "write_reg: cmd:%#.2x buf:%pK len:%#lx\n", opcode, buf, len); + + switch (opcode) { + case CMD_WREN: + phytium_qspi_write_enable(qspi, flash); + return 0; + case CMD_WRDI: + phytium_qspi_write_disable(qspi, flash); + return 0; + default: + break; + } + + cmd = opcode << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + if ((len > 8) || (NULL == buf)) { + dev_err(dev, "data length exceed. commad %x, len:%ld \n", opcode, len); + return -EINVAL; + } else if (len > 0) { + cmd |= ((len - 1) << QSPI_CMD_PORT_RW_NUM_SHIFT) & QSPI_CMD_PORT_RW_NUM_MASK; + cmd |= BIT(QSPI_CMD_PORT_DATA_TRANSFER_SHIFT); + } + + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + memcpy_to_ftreg(qspi, buf, len); + + return 0; +} + +static ssize_t phytium_qspi_read_tmp(struct phytium_qspi *qspi, u32 read_cmd, loff_t from, size_t len, u_char *buf) +{ + u32 addr = (u32)from; + u64 val = 0; + + if (!qspi) + return -1; + + dev_dbg(qspi->dev, "read cmd:%x, addr:%x len:%zx\n", read_cmd, addr, len); + writel_relaxed(read_cmd, qspi->io_base + QSPI_RD_CFG_REG); + + memcpy_fromio(buf, qspi->mm_base + addr, len); + + val = *(u64 *)(buf); + dev_dbg(qspi->dev, "read val:%llx\n", val); + + return len; +} + +static ssize_t phytium_qspi_read(struct spi_nor *nor, loff_t from, size_t len, u8 *buf) +{ + struct phytium_qspi_flash *flash = nor->priv; + struct phytium_qspi *qspi = flash->qspi; + u32 cmd = nor->read_opcode; + u32 addr = (u32)from; + + addr = addr + flash->cs * flash->fsize; + + dev_dbg(qspi->dev, "read(%#.2x): buf:%pK from:%#.8x len:%#zx\n", nor->read_opcode, buf, addr, len); + + cmd = cmd << QSPI_RD_CFG_RD_CMD_SHIFT; + cmd |= BIT(QSPI_RD_CFG_D_BUFFER_SHIFT); + cmd |= flash->clk_div << QSPI_CMD_PORT_SCK_SEL_SHIFT; + + cmd &= ~QSPI_RD_CFG_RD_TRANSFER_MASK; + cmd |= (flash->addr_width << QSPI_RD_CFG_RD_TRANSFER_SHIFT); + + switch (nor->read_opcode) { + case CMD_READ: + case CMD_FAST_READ: + case CMD_QIOR: + case CMD_QOR: + cmd &= ~QSPI_RD_CFG_RD_ADDR_SEL_MASK; + break; + case CMD_4READ: + case CMD_4FAST_READ: + case CMD_4QOR: + case CMD_4QIOR: + cmd |= BIT(QSPI_RD_CFG_RD_ADDR_SEL_SHIFT); + break; + case 0x5A: + cmd &= ~QSPI_RD_CFG_RD_ADDR_SEL_MASK; + return phytium_qspi_read_flash_sfdp(qspi, flash, nor, from, buf, len); + break; + default: + break; + } + + if ((PHYTIUM_QSPI_1_1_4 == flash->addr_width) || (PHYTIUM_QSPI_1_4_4 == flash->addr_width)) { + cmd |= BIT(QSPI_RD_CFG_RD_LATENCY_SHIFT); + cmd &= ~QSPI_RD_CFG_DUMMY_MASK; + cmd |= (0x07 << QSPI_RD_CFG_DUMMY_SHIFT); + } + + dev_dbg(qspi->dev, "read(%#.2x): cmd:%#x\n", nor->read_opcode, cmd); + + if (cmd != flash->read_cmd) + flash->read_cmd = cmd; + + writel_relaxed(cmd, qspi->io_base + QSPI_RD_CFG_REG); + + memcpy_fromio(buf, qspi->mm_base + addr, len); + + return len; +} + +static ssize_t phytium_qspi_write(struct spi_nor *nor, loff_t to, size_t len, const u8 *buf) +{ + struct phytium_qspi_flash *flash = nor->priv; + struct device *dev = flash->qspi->dev; + struct phytium_qspi *qspi = flash->qspi; + u32 cmd = nor->program_opcode; + u32 addr = (u32)to; + int i; + u_char tmp[8] = {0}; + size_t mask = 0x03; + + addr = addr + flash->cs * flash->fsize; + + dev_dbg(dev, "write(%#.2x): buf:%p to:%#.8x len:%#zx\n", nor->program_opcode, buf, addr, len); + + if (addr & 0x03) { + dev_err(dev, "Addr not four-byte aligned!\n"); + return -EINVAL; + } + + cmd = cmd << QSPI_WR_CFG_WR_CMD_SHIFT; + cmd |= BIT(QSPI_WR_CFG_WR_MODE_SHIFT); + cmd |= PHYTIUM_CMD_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; + + switch (nor->program_opcode) { + case CMD_PP: + case CMD_QPP: + cmd &= ~QSPI_WR_CFG_WR_ADDR_SEL_MASK; + break; + case CMD_4PP: + case CMD_4QPP: + cmd |= BIT(QSPI_WR_CFG_WR_ADDR_SEL_SHIFT); + break; + default: + dev_err(qspi->dev, "Not support program command:%#x\n", nor->erase_opcode); + return -EINVAL; + } + + dev_dbg(qspi->dev, "write cmd:%x\n", cmd); + + writel_relaxed(cmd, qspi->io_base + QSPI_WR_CFG_REG); + + for (i = 0; i < len/4; i++) + writel_relaxed(*(u32 *)(buf + 4*i), qspi->mm_base + addr + 4*i); + + if (len & mask) { + addr = addr + (len & ~mask); + phytium_qspi_read_tmp(qspi, flash->read_cmd, addr, 4, &tmp[0]); + memcpy(tmp, buf + (len & ~mask), len & mask); + writel_relaxed(*(u32 *)(tmp), qspi->mm_base + addr); + } + + writel_relaxed(QSPI_FLUSH_EN, qspi->io_base + QSPI_FLUSH_REG); + + phytium_qspi_wait_cmd(qspi, flash); + + return len; +} + +static int phytium_qspi_erase(struct spi_nor *nor, loff_t offs) +{ + struct phytium_qspi_flash *flash = nor->priv; + struct device *dev = flash->qspi->dev; + struct phytium_qspi *qspi = flash->qspi; + u32 cmd = nor->erase_opcode; + u32 addr = (u32)offs; + + dev_dbg(dev, "erase(%#.2x):offs:%#x\n", nor->erase_opcode, (u32)offs); + + phytium_qspi_write_enable(qspi, flash); + + cmd = cmd << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= PHYTIUM_SCK_SEL << QSPI_CMD_PORT_SCK_SEL_SHIFT; + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + /* s25fl256s1 not supoort D8, DC, 20, 21 */ + switch (nor->erase_opcode) { + case CMD_SE: + cmd &= ~QSPI_CMD_PORT_SEL_MASK; + cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); + writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); + break; + case CMD_4SE: + cmd |= BIT(QSPI_CMD_PORT_SEL_SHIFT); + cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); + writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); + break; + case CMD_P4E: + cmd &= ~QSPI_CMD_PORT_SEL_MASK; + cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); + writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); + break; + case CMD_4P4E: + cmd |= BIT(QSPI_CMD_PORT_SEL_SHIFT); + cmd |= BIT(QSPI_CMD_PORT_CMD_ADDR_SHIFT); + writel_relaxed(addr, qspi->io_base + QSPI_ADDR_PORT_REG); + break; + case CMD_BE: + cmd &= ~QSPI_CMD_PORT_SEL_MASK; + break; + case CMD_4BE: + cmd |= BIT(QSPI_CMD_PORT_SEL_SHIFT); + break; + default: + dev_err(qspi->dev, "Not support erase command:%#x\n", nor->erase_opcode); + return -EINVAL; + } + + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + phytium_qspi_cmd_enable(qspi); + phytium_qspi_wait_cmd(qspi, flash); + + return 0; +} + +static int phytium_qspi_prep(struct spi_nor *nor) +{ + struct phytium_qspi_flash *flash = nor->priv; + struct phytium_qspi *qspi = flash->qspi; + + mutex_lock(&qspi->lock); + return 0; +} + +static void phytium_qspi_unprep(struct spi_nor *nor) +{ + struct phytium_qspi_flash *flash = nor->priv; + struct phytium_qspi *qspi = flash->qspi; + + mutex_unlock(&qspi->lock); +} + +static int phytium_qspi_get_flash_size(struct phytium_qspi *qspi, u32 size) +{ + int ret = 0; + u32 value; + + switch (size) { + case SZ_4M: + value = 0; + break; + case SZ_8M: + value = 1; + break; + case SZ_16M: + value = 2; + break; + case SZ_32M: + value = 3; + break; + case SZ_64M: + value = 4; + break; + case SZ_128M: + value = 5; + break; + case SZ_256M: + value = 6; + break; + case SZ_512M: + value = 7; + break; + default: + value = 0; + ret = -EINVAL; + return ret; + } + + return value; +} + +static const struct spi_nor_controller_ops phytium_controller_ops = { + .prepare = phytium_qspi_prep, + .unprepare = phytium_qspi_unprep, + .read_reg = phytium_qspi_read_reg, + .write_reg = phytium_qspi_write_reg, + .read = phytium_qspi_read, + .write = phytium_qspi_write, + .erase = phytium_qspi_erase, +}; + +static int phytium_qspi_flash_setup(struct phytium_qspi *qspi, struct fwnode_handle *np) +{ + struct spi_nor_hwcaps hwcaps = { .mask = SNOR_HWCAPS_READ | SNOR_HWCAPS_READ_FAST | SNOR_HWCAPS_PP, }; + u32 width, presc; + u32 cs_num = 0; + u32 max_rate = 0; + u32 clk_div = 0; + u32 flash_cap = 0; + u32 addr_width = PHYTIUM_QSPI_1_1_1; + struct phytium_qspi_flash *flash; + struct mtd_info *mtd; + int ret; + + fwnode_property_read_u32(np, "reg", &cs_num); + if (cs_num >= PHYTIUM_MAX_NORCHIP) + return -EINVAL; + + fwnode_property_read_u32(np, "spi-max-frequency", &max_rate); + if (!max_rate) + return -EINVAL; + + fwnode_property_read_u32(np, "spi-clk-div", &clk_div); + if (!clk_div) + clk_div = PHYTIUM_SCK_SEL; + + if (clk_div < 4) + return -EINVAL; + + presc = DIV_ROUND_UP(qspi->clk_rate, max_rate) - 1; + + fwnode_property_read_u32(np, "spi-rx-bus-width", &width); + if (!width) + width = 1; + + if (width == 4) { + hwcaps.mask |= SNOR_HWCAPS_READ_1_1_4; + addr_width = PHYTIUM_QSPI_1_1_4; + } else if (width == 2) { + hwcaps.mask |= SNOR_HWCAPS_READ_1_1_2; + addr_width = PHYTIUM_QSPI_1_1_2; + } else if (width != 1) + return -EINVAL; + + flash = &qspi->flash[cs_num]; + + flash->qspi = qspi; + flash->cs = cs_num; + flash->presc = presc; + flash->clk_div = clk_div; + flash->addr_width = addr_width; + flash->nor.dev = qspi->dev; + if (qspi->dev->of_node) + spi_nor_set_flash_node(&flash->nor, qspi->dev->of_node); + flash->nor.priv = flash; + flash->nor.controller_ops = &phytium_controller_ops; + + ret = spi_nor_scan(&flash->nor, NULL, &hwcaps); + if (ret) { + dev_err(qspi->dev, "device scan failed\n"); + return ret; + } + + mtd = &flash->nor.mtd; + + flash->fsize = mtd->size; + flash->prefetch_limit = mtd->size - PHYTIUM_QSPI_FIFO_SZ; + + ret = phytium_qspi_get_flash_size(flash->qspi, mtd->size); + if (ret < 0) { + dev_err(qspi->dev, "flash size invalid\n"); + return ret; + } + + flash_cap = cs_num << QSPI_FLASH_CAP_NUM_SHIFT; + flash_cap |= ret; + writel_relaxed(flash_cap, qspi->io_base + QSPI_FLASH_CAP_REG); + + flash->read_mode = PHYTIUM_FMODE_MM; + + ret = mtd_device_register(mtd, NULL, 0); + if (ret) { + dev_err(qspi->dev, "mtd device parse failed\n"); + return ret; + } + + flash->registered = true; + + dev_dbg(qspi->dev, "read mm:%s %px cs:%d bus:%d clk-div:%d\n", + flash->read_mode == PHYTIUM_FMODE_MM ? "yes" : "no", + qspi->mm_base, cs_num, width, clk_div); + + dev_dbg(qspi->dev, "mtd->size:%llx, mtd->erasesize:%x, fsize:%x\n", + mtd->size, mtd->erasesize, flash->fsize); + + return 0; +} + +static void phytium_qspi_mtd_free(struct phytium_qspi *qspi) +{ + int i; + + for (i = 0; i < PHYTIUM_MAX_NORCHIP; i++) + if (qspi->flash[i].registered) + mtd_device_unregister(&qspi->flash[i].nor.mtd); +} + +static ssize_t clk_div_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + struct phytium_qspi *qspi = dev_get_drvdata(dev); + struct phytium_qspi_flash *flash = &qspi->flash[0]; + + return sprintf(buf, "Flash 0 clk-div: %d\n", flash->clk_div); +} + +static ssize_t clk_div_store(struct device *dev, + struct device_attribute *attr, const char *buf, + size_t size) +{ + struct phytium_qspi *qspi = dev_get_drvdata(dev); + struct phytium_qspi_flash *flash = &qspi->flash[0]; + long value; + char *token; + ssize_t status; + + token = strsep ((char **)&buf, " "); + if (!token) + return -EINVAL; + + status = kstrtol(token, 0, &value); + if (status) + return status; + + flash->clk_div = (u8)value; + + return size; +} +static DEVICE_ATTR_RW(clk_div); + +static struct attribute *phytium_qspi_attrs[] = { + &dev_attr_clk_div.attr, + NULL, +}; + +static struct attribute_group phytium_qspi_attr_group = { + .attrs = phytium_qspi_attrs, +}; + +static int phytium_qspi_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct fwnode_handle *flash_np; + struct phytium_qspi *qspi; + struct resource *res; + int ret; + + qspi = devm_kzalloc(dev, sizeof(*qspi), GFP_KERNEL); + if (!qspi) + return -ENOMEM; + + qspi->nor_num = device_get_child_node_count(dev); + if (!qspi->nor_num || qspi->nor_num > PHYTIUM_MAX_NORCHIP) + return -ENODEV; + + if (dev->of_node) + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi"); + else if (has_acpi_companion(dev)) { + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + } + qspi->io_base = devm_ioremap_resource(dev, res); + if (IS_ERR(qspi->io_base)) + return PTR_ERR(qspi->io_base); + + + if (dev->of_node) + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi_mm"); + else if (has_acpi_companion(dev)) + res = platform_get_resource(pdev, IORESOURCE_MEM, 1); + + qspi->mm_base = devm_ioremap_resource(dev, res); + if (IS_ERR(qspi->mm_base)) + return PTR_ERR(qspi->mm_base); + + qspi->mm_size = resource_size(res); + + if (dev->of_node) { + qspi->clk = devm_clk_get(dev, NULL); + if (IS_ERR(qspi->clk)) + return PTR_ERR(qspi->clk); + + qspi->clk_rate = clk_get_rate(qspi->clk); + if (!qspi->clk_rate) + return -EINVAL; + + ret = clk_prepare_enable(qspi->clk); + if (ret) { + dev_err(dev, "can not enable the clock\n"); + return ret; + } + } + else if (has_acpi_companion(dev)) { /* ACPI table not pass clk rate */ + qspi->clk_rate = 50000000; + } + + qspi->dev = dev; + platform_set_drvdata(pdev, qspi); + mutex_init(&qspi->lock); + spin_lock_init(&qspi->spinlock); + + fwnode_for_each_available_child_node(dev_fwnode(dev), flash_np) { + ret = phytium_qspi_flash_setup(qspi, flash_np); + if (ret) { + dev_err(dev, "unable to setup flash chip\n"); + goto err_flash; + } + } + + ret = sysfs_create_group(&qspi->dev->kobj, &phytium_qspi_attr_group); + if (ret) { + dev_err(dev, "unable to create sysfs\n"); + goto err_flash; + } + + return 0; + +err_flash: + mutex_destroy(&qspi->lock); + phytium_qspi_mtd_free(qspi); + + clk_disable_unprepare(qspi->clk); + return ret; +} + +static int phytium_qspi_remove(struct platform_device *pdev) +{ + struct phytium_qspi *qspi = platform_get_drvdata(pdev); + + sysfs_remove_group(&qspi->dev->kobj, &phytium_qspi_attr_group); + + phytium_qspi_mtd_free(qspi); + mutex_destroy(&qspi->lock); + + clk_disable_unprepare(qspi->clk); + return 0; +} + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_qspi_acpi_ids[] = { + { "PHYT0011", 0 }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(acpi, phytium_qspi_acpi_ids); +#endif + +static const struct of_device_id phytium_qspi_match[] = { + { .compatible = "phytium,qspi" }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_qspi_match); + +static struct platform_driver phytium_qspi_driver = { + .probe = phytium_qspi_probe, + .remove = phytium_qspi_remove, + .driver = { + .name = "phytium-quadspi", + .of_match_table = phytium_qspi_match, + .acpi_match_table = ACPI_PTR(phytium_qspi_acpi_ids), + }, +}; +module_platform_driver(phytium_qspi_driver); + +MODULE_AUTHOR("Mingshuai Zhu "); +MODULE_AUTHOR("Shaojun Yang "); +MODULE_DESCRIPTION("Phytium QuadSPI driver"); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..a23216d23c22626a97244e0e48f66411ca4ed1b7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/Kconfig @@ -0,0 +1,34 @@ +# SPDX-License-Identifier: GPL-2.0-only +menuconfig CAN_PHYTIUM + tristate "Phytium CAN support" + help + Say Y here if you want support for Phytium CAN controller framework. + This is common support for devices that embed the Phytium CAN IP. + + To compile this driver as a module, choose M here: the module will + be called phytium_can. + +if CAN_PHYTIUM + +config CAN_PHYTIUM_PLATFORM + tristate "Phytium CAN support for io-mapped devices" + depends on HAS_IOMEM + help + Say Y here is you want to support for IO Mapped Phytium CAN controller. + This support is for devices that have the Phytium CAN controller IP + embedded into the device and the IP is IO Mapped to the processor. + + To compile this driver as a module, choose M here: the module will + be called phytium_can_platform. + +config CAN_PHYTIUM_PCI + tristate "Phytium CAN support for PCI devices" + depends on PCI + help + Say Y here is you want to support for Phytium CAN controller connected + to the PCI bus. This support is for devices that have the Phytium CAN + controller IP embedded into a PCI device. + + To compile this driver as a module, choose M here: the module will + be called phytium_can_pci. +endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..7ef554fca58e4b5ded60b3bcdb6f9c282d5deda3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/Makefile @@ -0,0 +1,8 @@ +# +# Makefile for the Phytium CAN controller drivers. +# +# + +obj-$(CONFIG_CAN_PHYTIUM) += phytium_can.o +obj-$(CONFIG_CAN_PHYTIUM_PLATFORM) += phytium_can_platform.o +obj-$(CONFIG_CAN_PHYTIUM_PCI) += phytium_can_pci.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/phytium_can.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/phytium_can.c new file mode 100644 index 0000000000000000000000000000000000000000..60b3f34a7305494b175ea544caf3e4a7662bb4eb --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/phytium_can.c @@ -0,0 +1,1156 @@ +// SPDX-License-Identifier: GPL-2.0 +/* CAN bus driver for Phytium CAN controller + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include + +#include "phytium_can.h" + +/* register definition */ +enum phytium_can_reg { + CAN_CTRL = 0x00, /* Global control register */ + CAN_INTR = 0x04, /* Interrupt register */ + CAN_ARB_RATE_CTRL = 0x08, /* Arbitration rate control register */ + CAN_DAT_RATE_CTRL = 0x0c, /* Data rate control register */ + CAN_ACC_ID0 = 0x10, /* Acceptance identifier0 register */ + CAN_ACC_ID1 = 0x14, /* Acceptance identifier1 register */ + CAN_ACC_ID2 = 0x18, /* Acceptance identifier2 register */ + CAN_ACC_ID3 = 0x1c, /* Acceptance identifier3 register */ + CAN_ACC_ID0_MASK = 0x20, /* Acceptance identifier0 mask register */ + CAN_ACC_ID1_MASK = 0x24, /* Acceptance identifier1 mask register */ + CAN_ACC_ID2_MASK = 0x28, /* Acceptance identifier2 mask register */ + CAN_ACC_ID3_MASK = 0x2c, /* Acceptance identifier3 mask register */ + CAN_XFER_STS = 0x30, /* Transfer status register */ + CAN_ERR_CNT = 0x34, /* Error counter register */ + CAN_FIFO_CNT = 0x38, /* FIFO counter register */ + CAN_DMA_CTRL = 0x3c, /* DMA request control register */ + CAN_XFER_EN = 0x40, /* Transfer enable register */ + CAN_INTR1 = 0x44, /* Interrupt register 1 */ + CAN_FRM_INFO = 0x48, /* Frame valid number register */ + CAN_TIME_OUT = 0x4c, /* Timeout register */ + CAN_TIME_OUT_CNT = 0x50, /* Timeout counter register */ + CAN_INTR2 = 0x54, /* Interrupt register 2 */ + CAN_TX_FIFO = 0x100, /* TX FIFO shadow register */ + CAN_RX_FIFO = 0x200, /* RX FIFO shadow register */ + CAN_RX_INFO_FIFO = 0x300, /* RX information FIFO shadow register */ + CAN_PIDR4 = 0xfd0, /* Peripheral Identification Register 4 */ + CAN_PIDR0 = 0xfe0, /* Peripheral Identification Register 0 */ + CAN_PIDR1 = 0xfe4, /* Peripheral Identification Register 1 */ + CAN_PIDR2 = 0xfe8, /* Peripheral Identification Register 2 */ + CAN_PIDR3 = 0xfec, /* Peripheral Identification Register 3 */ + CAN_CIDR0 = 0xff0, /* Component Identification Register 0 */ + CAN_CIDR1 = 0xff4, /* Component Identification Register 1 */ + CAN_CIDR2 = 0xff8, /* Component Identification Register 2 */ + CAN_CIDR3 = 0xffc, /* Component Identification Register 3 */ +}; + +/* Global control register (CTRL) */ +#define CTRL_XFER BIT(0) /* Transfer enable */ +#define CTRL_TXREQ BIT(1) /* Transmit request */ +#define CTRL_AIME BIT(2) /* Acceptance identifier mask enable */ +#define CTRL_TTS BIT(3) /* Transmit trigger strategy */ +#define CTRL_RST BIT(7) /* Write 1 to soft reset and self clear */ +#define CTRL_RFEIDF BIT(8) /* Allow RX frame end interrupt during ID filtered frame */ +#define CTRL_RFEDT BIT(9) /* Allow RX frame end interrupt during TX frame */ +#define CTRL_IOF BIT(10) /* Ignore overload flag internally */ +#define CTRL_FDCRC BIT(11) /* CANFD CRC mode */ + +/* Interrupt register (INTR) */ +#define INTR_BOIS BIT(0) /* Bus off interrupt status */ +#define INTR_PWIS BIT(1) /* Passive warning interrupt status */ +#define INTR_PEIS BIT(2) /* Passive error interrupt status */ +#define INTR_RFIS BIT(3) /* RX FIFO full interrupt status */ +#define INTR_TFIS BIT(4) /* TX FIFO empty interrupt status */ +#define INTR_REIS BIT(5) /* RX frame end interrupt status */ +#define INTR_TEIS BIT(6) /* TX frame end interrupt status */ +#define INTR_EIS BIT(7) /* Error interrupt status */ +#define INTR_BOIE BIT(8) /* Bus off interrupt enable */ +#define INTR_PWIE BIT(9) /* Passive warning interrupt enable */ +#define INTR_PEIE BIT(10) /* Passive error interrupt enable */ +#define INTR_RFIE BIT(11) /* RX FIFO full interrupt enable */ +#define INTR_TFIE BIT(12) /* TX FIFO empty interrupt enable */ +#define INTR_REIE BIT(13) /* RX frame end interrupt enable */ +#define INTR_TEIE BIT(14) /* TX frame end interrupt enable */ +#define INTR_EIE BIT(15) /* Error interrupt enable */ +#define INTR_BOIC BIT(16) /* Bus off interrupt clear */ +#define INTR_PWIC BIT(17) /* Passive warning interrupt clear */ +#define INTR_PEIC BIT(18) /* Passive error interrupt clear */ +#define INTR_RFIC BIT(19) /* RX FIFO full interrupt clear */ +#define INTR_TFIC BIT(20) /* TX FIFO empty interrupt clear */ +#define INTR_REIC BIT(21) /* RX frame end interrupt clear */ +#define INTR_TEIC BIT(22) /* TX frame end interrupt clear */ +#define INTR_EIC BIT(23) /* Error interrupt clear */ + +#define INTR_STATUS_MASK (INTR_BOIS | INTR_PWIS | INTR_PEIS | INTR_RFIS | \ + INTR_TFIS | INTR_REIS | INTR_TEIS | INTR_EIS) +#define INTR_EN_MASK (INTR_BOIE | INTR_RFIE | INTR_REIE | INTR_TEIE | \ + INTR_EIE) +#define INTR_CLEAR_MASK (INTR_BOIC | INTR_PWIC | INTR_PEIC | INTR_RFIC | \ + INTR_TFIC | INTR_REIC | INTR_TEIC | INTR_EIC) + +/* Arbitration rate control register (ARB_RATE_CTRL) */ +#define ARB_RATE_CTRL_ARJW GENMASK(1, 0) /* Arbitration field resync jump width */ +#define ARB_RATE_CTRL_APRS GENMASK(4, 2) /* Arbitration field propagation segment */ +#define ARB_RATE_CTRL_APH1S GENMASK(7, 5) /* Arbitration field phase1 segment */ +#define ARB_RATE_CTRL_APH2S GENMASK(10, 8) /* Arbitration field phase2 segment */ +#define ARB_RATE_CTRL_APD GENMASK(28, 16) /* Arbitration field prescaler divider */ + +/* Data rate control register (DAT_RATE_CTRL) */ +#define DAT_RATE_CTRL_DRJW GENMASK(1, 0) /* Data field resync jump width */ +#define DAT_RATE_CTRL_DPRS GENMASK(4, 2) /* Data field propagation segment */ +#define DAT_RATE_CTRL_DPH1S GENMASK(7, 5) /* Data field phase1 segment */ +#define DAT_RATE_CTRL_DPH2S GENMASK(10, 8) /* Data field phase2 segment */ +#define DAT_RATE_CTRL_DPD GENMASK(28, 16) /* Data field prescaler divider */ + +/* Acceptance identifierX register (ACC_IDX) */ +#define ACC_IDX_AID_MASK GENMASK(28, 0) /* Acceptance identifier */ + +/* Acceptance identifier0 mask register (ACC_ID0_MASK) */ +#define ACC_IDX_MASK_AID_MASK GENMASK(28, 0) /* Acceptance identifier mask */ + +/* Transfer status register (XFER_STS) */ +#define XFER_STS_FRAS GENMASK(2, 0) /* Frame status */ +#define XFER_STS_FIES GENMASK(7, 3) /* Field status */ +#define XFER_STS_FIES_IDLE (0x0) /* idle */ +#define XFER_STS_FIES_ARBITRATION (0x1) /* arbitration */ +#define XFER_STS_FIES_TX_CTRL (0x2) /* transmit control */ +#define XFER_STS_FIES_TX_DATA (0x3) /* transmit data */ +#define XFER_STS_FIES_TX_CRC (0x4) /* transmit crc */ +#define XFER_STS_FIES_TX_FRM (0x5) /* transmit frame */ +#define XFER_STS_FIES_RX_CTRL (0x6) /* receive control */ +#define XFER_STS_FIES_RX_DATA (0x7) /* receive data */ +#define XFER_STS_FIES_RX_CRC (0x8) /* receive crc */ +#define XFER_STS_FIES_RX_FRM (0x9) /* receive frame */ +#define XFER_STS_FIES_INTERMISSION (0xa) /* intermission */ +#define XFER_STS_FIES_TX_SUSPD (0xb) /* transmit suspend */ +#define XFER_STS_FIES_BUS_IDLE (0xc) /* bus idle */ +#define XFER_STS_FIES_OVL_FLAG (0xd) /* overload flag */ +#define XFER_STS_FIES_OVL_DLM (0xe) /* overload delimiter */ +#define XFER_STS_FIES_ERR_FLAG (0xf) /* error flag */ +#define XFER_STS_FIES_ERR_DLM (0x10) /* error delimiter */ +#define XFER_STS_FIES_BUS_OFF (0x11) /* bus off */ +#define XFER_STS_TS BIT(8) /* Transmit status */ +#define XFER_STS_RS BIT(9) /* Receive status */ +#define XFER_STS_XFERS BIT(10) /* Transfer status */ + +/* Error counter register (ERR_CNT) */ +#define ERR_CNT_REC GENMASK(8, 0) /* Receive error counter */ +#define ERR_CNT_TEC GENMASK(24, 16) /* Transmit error counter */ + +/* FIFO counter register (FIFO_CNT) */ +#define FIFO_CNT_RFN GENMASK(6, 0) /* Receive FIFO valid data number */ +#define FIFO_CNT_TFN GENMASK(22, 16) /* Transmit FIFO valid data number */ + +/* DMA request control register (DMA_CTRL) */ +#define DMA_CTRL_RFTH GENMASK(5, 0) /* Receive FIFO DMA request threshold */ +#define DMA_CTRL_RFRE BIT(6) /* Receive FIFO DMA request enable */ +#define DMA_CTRL_TFTH GENMASK(21, 16) /* Transmit FIFO DMA request threshold */ +#define DMA_CTRL_TFRE BIT(22) /* Transmit FIFO DMA request enable */ + +/* Transfer enable register (XFER_EN) */ +#define XFER_EN_XFER BIT(0) /* Transfer enable */ + +/* Interrupt register 1 (INTR1) */ +#define INTR1_RF1IS BIT(0) /* RX FIFO 1/4 interrupt status */ +#define INTR1_RF2IS BIT(1) /* RX FIFO 1/2 interrupt status */ +#define INTR1_RF3IS BIT(2) /* RX FIFO 3/4 interrupt status */ +#define INTR1_RF4IS BIT(3) /* RX FIFO full interrupt status */ +#define INTR1_TF1IS BIT(4) /* TX FIFO 1/4 interrupt status */ +#define INTR1_TF2IS BIT(5) /* TX FIFO 1/2 interrupt status */ +#define INTR1_TF3IS BIT(6) /* TX FIFO 3/4 interrupt status */ +#define INTR1_TF4IS BIT(7) /* TX FIFO empty interrupt status */ +#define INTR1_RF1IE BIT(8) /* RX FIFO 1/4 interrupt enable */ +#define INTR1_RF2IE BIT(9) /* RX FIFO 1/2 interrupt enable */ +#define INTR1_RF3IE BIT(10) /* RX FIFO 3/4 interrupt enable */ +#define INTR1_RF4IE BIT(11) /* RX FIFO full interrupt enable */ +#define INTR1_TF1IE BIT(12) /* TX FIFO 1/4 interrupt enable */ +#define INTR1_TF2IE BIT(13) /* TX FIFO 1/2 interrupt enable */ +#define INTR1_TF3IE BIT(14) /* TX FIFO 3/4 interrupt enable */ +#define INTR1_TF4IE BIT(15) /* TX FIFO empty interrupt enable */ +#define INTR1_RF1IC BIT(16) /* RX FIFO 1/4 interrupt clear */ +#define INTR1_RF2IC BIT(17) /* RX FIFO 1/2 interrupt clear */ +#define INTR1_RF3IC BIT(18) /* RX FIFO 3/4 interrupt clear */ +#define INTR1_RF4IC BIT(19) /* RX FIFO full interrupt clear */ +#define INTR1_TF1IC BIT(20) /* TX FIFO 1/4 interrupt clear */ +#define INTR1_TF2IC BIT(21) /* TX FIFO 1/2 interrupt clear */ +#define INTR1_TF3IC BIT(22) /* TX FIFO 3/4 interrupt clear */ +#define INTR1_TF4IC BIT(23) /* TX FIFO empty interrupt clear */ +#define INTR1_RF1RIS BIT(24) /* RX FIFO 1/4 raw interrupt status */ +#define INTR1_RF2RIS BIT(25) /* RX FIFO 1/2 raw interrupt status */ +#define INTR1_RF3RIS BIT(26) /* RX FIFO 3/4 raw interrupt status */ +#define INTR1_RF4RIS BIT(27) /* RX FIFO full raw interrupt status */ +#define INTR1_TF1RIS BIT(28) /* TX FIFO 1/4 raw interrupt status */ +#define INTR1_TF2RIS BIT(29) /* TX FIFO 1/2 raw interrupt status */ +#define INTR1_TF3RIS BIT(30) /* TX FIFO 3/4 raw interrupt status */ +#define INTR1_TF4RIS BIT(31) /* TX FIFO empty raw interrupt status */ + +/* Frame valid number register (FRM_INFO) */ +#define FRM_INFO_RXFC GENMASK(5, 0) /* Valid frame number in RX FIFO */ +#define FRM_INFO_SSPD GENMASK(31, 16) /* Secondary sample point delay */ + +/* Interrupt register 2 (INTR2) */ +#define INTR2_TOIS BIT(0) /* RX FIFO time out interrupt status */ +#define INTR2_TOIM BIT(8) /* RX FIFO time out interrupt mask */ +#define INTR2_TOIC BIT(16) /* RX FIFO time out interrupt clear */ +#define INTR2_TORIS BIT(24) /* RX FIFO time out raw interrupt status */ + +/* RX information FIFO shadow register (RX_INFO_FIFO) */ +#define RX_INFO_FIFO_WNORF GENMASK(4, 0) /* Word (4-byte) number of current receive frame */ +#define RX_INFO_FIFO_RORF BIT(5) /* RTR value of current receive frame */ +#define RX_INFO_FIFO_FORF BIT(6) /* FDF value of current receive frame */ +#define RX_INFO_FIFO_IORF BIT(7) /* IDE value of current receive frame */ + +/* Arbitration Bits */ +#define CAN_ID1_MASK GENMASK(31, 21) /* Base identifer */ +/* Standard Remote Transmission Request */ +#define CAN_ID1_RTR_MASK BIT(20) +/* Extended Substitute remote TXreq */ +#define CAN_ID2_SRR_MASK BIT(20) +#define CAN_IDE_MASK BIT(19) /* IDentifier extension flag */ +#define CAN_ID2_MASK GENMASK(18, 1) /* Identifier extension */ +/* Extended frames remote TX request */ +#define CAN_ID2_RTR_MASK BIT(0) +#define CAN_ID1_FDF_MASK BIT(18) +#define CAN_ID1_DLC_MASK GENMASK(17, 14) +#define CANFD_ID1_BRS_MASK BIT(16) +#define CANFD_ID1_ESI_MASK BIT(15) +#define CANFD_ID1_DLC_MASK GENMASK(14, 11) + +#define CAN_ID2_FDF_MASK BIT(31) +#define CAN_ID2_DLC_MASK GENMASK(29, 26) +#define CANFD_ID2_BRS_MASK BIT(29) +#define CANFD_ID2_ESI_MASK BIT(28) +#define CANFD_ID2_DLC_MASK GENMASK(27, 24) + +#define CAN_ID1_DLC_OFF 14 +#define CANFD_ID1_DLC_OFF 11 +#define CAN_ID2_DLC_OFF 26 +#define CANFD_ID2_DLC_OFF 24 + +#define CAN_IDR_ID1_SHIFT 21 /* Standard Messg Identifier */ +#define CAN_IDR_ID2_SHIFT 1 /* Extended Message Identifier */ +#define CAN_IDR_SDLC_SHIFT 14 +#define CAN_IDR_EDLC_SHIFT 26 + +/* CANFD Standard msg padding 1 */ +#define CANFD_IDR_PAD_MASK 0x000007FF +#define CAN_IDR_PAD_MASK 0x00003FFF /* Standard msg padding 1 */ + +/** + * phytium_can_set_reg_bits - set a bit value to the device register + * @cdev: Driver private data structure + * @reg: Register offset + * @bs: The bit mask + * + * Read data from the particular CAN register + * Return: value read from the CAN register + */ +static void +phytium_can_set_reg_bits(const struct phytium_can_dev *cdev, + enum phytium_can_reg reg, u32 bs) +{ + u32 val = readl(cdev->base + reg); + + val |= bs; + writel(val, cdev->base + reg); +} + +/** + * phytium_can_clr_reg_bits - clear a bit value to the device register + * @cdev: Driver private data structure + * @reg: Register offset + * @bs: The bit mask + * + * Read data from the particular CAN register + * Return: value read from the CAN register + */ +static void +phytium_can_clr_reg_bits(const struct phytium_can_dev *cdev, + enum phytium_can_reg reg, u32 bs) +{ + u32 val = readl(cdev->base + reg); + + val &= ~bs; + writel(val, cdev->base + reg); +} + +static inline u32 phytium_can_read(const struct phytium_can_dev *cdev, enum phytium_can_reg reg) +{ + return readl(cdev->base + reg); +} + +static inline void phytium_can_write(const struct phytium_can_dev *cdev, enum phytium_can_reg reg, + u32 val) +{ + writel(val, cdev->base + reg); +} + +static inline void phytium_can_enable_all_interrupts(struct phytium_can_dev *cdev) +{ + phytium_can_write(cdev, CAN_INTR, INTR_EN_MASK); +} + +static inline void phytium_can_disable_all_interrupt(struct phytium_can_dev *cdev) +{ + phytium_can_write(cdev, CAN_INTR, 0x0); +} + +static int phytium_can_get_berr_counter(const struct net_device *dev, + struct can_berr_counter *bec) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + + bec->rxerr = phytium_can_read(cdev, CAN_ERR_CNT) & ERR_CNT_REC; + bec->txerr = (phytium_can_read(cdev, CAN_ERR_CNT) & ERR_CNT_TEC) >> 16; + + return 0; +} + +static int phytium_can_read_fifo(struct net_device *dev) +{ + struct net_device_stats *stats = &dev->stats; + struct phytium_can_dev *cdev = netdev_priv(dev); + struct canfd_frame *cf; + struct sk_buff *skb; + u32 id, dlc, i; + + /* Read the frame header from FIFO */ + id = phytium_can_read(cdev, CAN_RX_FIFO); + id = be32_to_cpup(&id); + if (id & CAN_IDE_MASK) { + /* Received an extended frame */ + dlc = phytium_can_read(cdev, CAN_RX_FIFO); + dlc = be32_to_cpup(&dlc); + if (dlc & CAN_ID2_FDF_MASK) + skb = alloc_canfd_skb(dev, &cf); + else + skb = alloc_can_skb(dev, (struct can_frame **)&cf); + + if (unlikely(!skb)) { + stats->rx_dropped++; + return 0; + } + + if (dlc & CAN_ID2_FDF_MASK) { + /* CAN FD extended frame */ + if (dlc & CANFD_ID2_BRS_MASK) + cf->flags |= CANFD_BRS; + if (dlc & CANFD_ID2_ESI_MASK) + cf->flags |= CANFD_ESI; + cf->len = can_dlc2len((dlc & CANFD_ID2_DLC_MASK) >> CANFD_ID2_DLC_OFF); + } else { + /* CAN extended frame */ + cf->len = get_can_dlc((dlc & CAN_ID2_DLC_MASK) >> CAN_ID2_DLC_OFF); + } + + cf->can_id = (id & CAN_ID1_MASK) >> 3; + cf->can_id |= (id & CAN_ID2_MASK) >> 1; + cf->can_id |= CAN_EFF_FLAG; + + if (id & CAN_ID2_RTR_MASK) + cf->can_id |= CAN_RTR_FLAG; + } else { + /* Received a standard frame */ + if (id & CAN_ID1_FDF_MASK) + skb = alloc_canfd_skb(dev, &cf); + else + skb = alloc_can_skb(dev, (struct can_frame **)&cf); + + if (unlikely(!skb)) { + stats->rx_dropped++; + return 0; + } + + if (id & CAN_ID1_FDF_MASK) { + /* CAN FD extended frame */ + if (id & CANFD_ID1_BRS_MASK) + cf->flags |= CANFD_BRS; + if (id & CANFD_ID1_ESI_MASK) + cf->flags |= CANFD_ESI; + cf->len = can_dlc2len((id & CANFD_ID1_DLC_MASK) >> CANFD_ID1_DLC_OFF); + } else { + /* CAN extended frame */ + cf->len = get_can_dlc((id & CAN_ID1_DLC_MASK) >> CAN_ID1_DLC_OFF); + } + + cf->can_id = (id & CAN_ID1_MASK) >> 21; + + if (id & CAN_ID1_RTR_MASK) + cf->can_id |= CAN_RTR_FLAG; + } + + if (!(cf->can_id & CAN_RTR_FLAG)) + /* Receive data frames */ + for (i = 0; i < cf->len; i += 4) + *(__be32 *)(cf->data + i) = phytium_can_read(cdev, CAN_RX_FIFO); + + stats->rx_packets++; + stats->rx_bytes += cf->len; + netif_receive_skb(skb); + + return 1; +} + +static int phytium_can_do_rx_poll(struct net_device *dev, int quota) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + u32 rxfs, pkts = 0; + + rxfs = phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_RFN; + if (!rxfs) { + netdev_dbg(dev, "no messages in RX FIFO\n"); + return 0; + } + + while ((rxfs != 0) && (quota > 0)) { + pkts += phytium_can_read_fifo(dev); + quota--; + rxfs = phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_RFN; + netdev_dbg(dev, "Next received %d frame again.\n", rxfs); + } + + if (pkts) + can_led_event(dev, CAN_LED_EVENT_RX); + + return pkts; +} + +static int phytium_can_rx_handler(struct net_device *dev, int quota) +{ + int work_done = 0; + int rx_work_or_err; + + /* Handle RX IRQ */ + rx_work_or_err = phytium_can_do_rx_poll(dev, (quota - work_done)); + if (rx_work_or_err < 0) + return rx_work_or_err; + + work_done += rx_work_or_err; + + return 0; +} + +static int phytium_can_poll(struct napi_struct *napi, int quota) +{ + struct net_device *dev = napi->dev; + struct phytium_can_dev *cdev = netdev_priv(dev); + int work_done; + unsigned long flags; + + netdev_dbg(dev, "The receive processing is going on !\n"); + + work_done = phytium_can_rx_handler(dev, quota); + + /* Don't re-enable interrupts if the driver had a fatal error + * (e.g., FIFO read failure) + */ + if (work_done >= 0 && work_done < quota) { + napi_complete_done(napi, work_done); + spin_lock_irqsave(&cdev->lock, flags); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_REIE); + spin_unlock_irqrestore(&cdev->lock, flags); + } + + return work_done; +} + +static void phytium_can_write_frame(struct phytium_can_dev *cdev) +{ + struct canfd_frame *cf = (struct canfd_frame *)cdev->tx_skb->data; + struct net_device *dev = cdev->net; + struct net_device_stats *stats = &dev->stats; + struct sk_buff *skb = cdev->tx_skb; + u32 i, id, dlc = 0, frame_head[2] = {0, 0}; + u32 data_len; + + data_len = can_len2dlc(cf->len); + cdev->tx_skb = NULL; + + /* Watch carefully on the bit sequence */ + if (cf->can_id & CAN_EFF_FLAG) { + /* Extended CAN ID format */ + id = ((cf->can_id & CAN_EFF_MASK) << 1) & CAN_ID2_MASK; + id |= (((cf->can_id & CAN_EFF_MASK) >> + (CAN_EFF_ID_BITS - CAN_SFF_ID_BITS)) << + CAN_IDR_ID1_SHIFT) & CAN_ID1_MASK; + + /* The substibute remote TX request bit should be "1" + * for extended frames as in the Phytium CAN datasheet + */ + id |= CAN_IDE_MASK | CAN_ID2_SRR_MASK; + + if (cf->can_id & CAN_RTR_FLAG) + /* Extended frames remote TX request */ + id |= CAN_ID2_RTR_MASK; + if ((cdev->can.ctrlmode & CAN_CTRLMODE_FD) && + can_is_canfd_skb(skb)) + dlc = data_len << CANFD_ID2_DLC_OFF; + else + dlc = data_len << CAN_ID2_DLC_OFF; + + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { + dlc |= CAN_ID2_FDF_MASK; + if (cf->flags & CANFD_BRS) + dlc |= CANFD_ID2_BRS_MASK; + if (cf->flags & CANFD_ESI) + dlc |= CANFD_ID2_ESI_MASK; + } + + frame_head[0] = cpu_to_be32p(&id); + frame_head[1] = cpu_to_be32p(&dlc); + + /* Write the Frame to Phytium CAN TX FIFO */ + phytium_can_write(cdev, CAN_TX_FIFO, frame_head[0]); + phytium_can_write(cdev, CAN_TX_FIFO, frame_head[1]); + netdev_dbg(dev, "Write atbitration field [0]:0x%x [1]:0x%x\n", + frame_head[0], frame_head[1]); + } else { + /* Standard CAN ID format */ + id = ((cf->can_id & CAN_SFF_MASK) << CAN_IDR_ID1_SHIFT) + & CAN_ID1_MASK; + + if (cf->can_id & CAN_RTR_FLAG) + /* Standard frames remote TX request */ + id |= CAN_ID1_RTR_MASK; + + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) + dlc = (data_len << CANFD_ID1_DLC_OFF) + | CANFD_IDR_PAD_MASK; + else + dlc = (data_len << CAN_ID1_DLC_OFF) | CAN_IDR_PAD_MASK; + + id |= dlc; + + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { + id |= CAN_ID1_FDF_MASK; + if (cf->flags & CANFD_BRS) + id |= CANFD_ID1_BRS_MASK; + if (cf->flags & CANFD_ESI) + id |= CANFD_ID1_ESI_MASK; + } + + frame_head[0] = cpu_to_be32p(&id); + /* Write the Frame to Phytium CAN TX FIFO */ + phytium_can_write(cdev, CAN_TX_FIFO, frame_head[0]); + netdev_dbg(dev, "Write atbitration field [0] 0x%x\n", + frame_head[0]); + } + + if (!(cf->can_id & CAN_RTR_FLAG)) { + netdev_dbg(dev, "Write CAN data frame\n"); + for (i = 0; i < cf->len; i += 4) { + phytium_can_write(cdev, CAN_TX_FIFO, + *(__be32 *)(cf->data + i)); + netdev_dbg(dev, "[%d]:%x\n", i, + *(__be32 *)(cf->data + i)); + } + } + + stats->tx_bytes += cf->len; + stats->tx_packets++; + netdev_dbg(dev, "Trigger send message!\n"); + can_put_echo_skb(skb, dev, 0); + can_get_echo_skb(dev, 0); + return; +} + +static netdev_tx_t phytium_can_tx_handler(struct phytium_can_dev *cdev) +{ + struct net_device *dev = cdev->net; + u32 tx_fifo_used; + unsigned long flags; + + phytium_can_write_frame(cdev); + + /* Check if the TX buffer is full */ + tx_fifo_used = 4 * ((phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_TFN) >> 16); + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { + if (CAN_FIFO_BYTE_LEN - tx_fifo_used <= KEEP_CANFD_FIFO_MIN_LEN) { + netif_stop_queue(dev); + spin_lock_irqsave(&cdev->lock, flags); + cdev->is_stop_queue_flag = STOP_QUEUE_TRUE; + spin_unlock_irqrestore(&cdev->lock, flags); + } + } else { + if (CAN_FIFO_BYTE_LEN - tx_fifo_used <= KEEP_CAN_FIFO_MIN_LEN) { + netif_stop_queue(dev); + spin_lock_irqsave(&cdev->lock, flags); + cdev->is_stop_queue_flag = STOP_QUEUE_TRUE; + spin_unlock_irqrestore(&cdev->lock, flags); + } + } + + return NETDEV_TX_OK; +} + +/** + * phytium_can_tx_interrupt - Tx Done Isr + * @ndev: net_device pointer + * @isr: Interrupt status register value + */ +static void phytium_can_tx_interrupt(struct net_device *ndev, u32 isr) +{ + struct phytium_can_dev *cdev = netdev_priv(ndev); + struct net_device_stats *stats = &ndev->stats; + u32 tx_fifo_used = 0; + + if (isr & INTR_TEIS) { + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); + } + + /* Check if the TX buffer is full */ + if (cdev->is_stop_queue_flag) { + tx_fifo_used = 4 * ((phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_TFN) >> 16); + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { + if (CAN_FIFO_BYTE_LEN - tx_fifo_used > KEEP_CANFD_FIFO_MIN_LEN) { + netif_wake_queue(ndev); + cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; + } + } else { + if (CAN_FIFO_BYTE_LEN - tx_fifo_used > KEEP_CAN_FIFO_MIN_LEN) { + netif_wake_queue(ndev); + cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; + } + } + } + netdev_dbg(ndev, "Finish transform packets %lu\n", stats->tx_packets); + can_led_event(ndev, CAN_LED_EVENT_TX); +} + +static void phytium_can_err_interrupt(struct net_device *ndev, u32 isr) +{ + struct phytium_can_dev *cdev = netdev_priv(ndev); + struct net_device_stats *stats = &ndev->stats; + struct can_frame *cf; + struct sk_buff *skb; + u32 txerr = 0, rxerr = 0; + + skb = alloc_can_err_skb(ndev, &cf); + + rxerr = phytium_can_read(cdev, CAN_ERR_CNT) & ERR_CNT_REC; + txerr = ((phytium_can_read(cdev, CAN_ERR_CNT) & ERR_CNT_TEC) >> 16); + + if (isr & INTR_BOIS) { + netdev_dbg(ndev, "bus_off %s: txerr :%u rxerr :%u\n", + __func__, txerr, rxerr); + cdev->can.state = CAN_STATE_BUS_OFF; + cdev->can.can_stats.bus_off++; + /* Leave device in Config Mode in bus-off state */ + phytium_can_write(cdev, CAN_CTRL, CTRL_RST); + can_bus_off(ndev); + if (skb) + cf->can_id |= CAN_ERR_BUSOFF; + } else if ((isr & INTR_PEIS) == INTR_PEIS) { + netdev_dbg(ndev, "error_passive %s: txerr :%u rxerr :%u\n", + __func__, txerr, rxerr); + cdev->can.state = CAN_STATE_ERROR_PASSIVE; + cdev->can.can_stats.error_passive++; + /* Clear interrupt condition */ + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PEIC); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PWIC); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_EIC); + if (skb) { + cf->can_id |= CAN_ERR_CRTL; + cf->data[1] = (rxerr > 127) ? + CAN_ERR_CRTL_RX_PASSIVE : + CAN_ERR_CRTL_TX_PASSIVE; + cf->data[6] = txerr; + cf->data[7] = rxerr; + } + } else if (isr & INTR_PWIS) { + netdev_dbg(ndev, "error_warning %s: txerr :%u rxerr :%u\n", + __func__, txerr, rxerr); + cdev->can.state = CAN_STATE_ERROR_WARNING; + cdev->can.can_stats.error_warning++; + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PWIC); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_EIC); + if (skb) { + cf->can_id |= CAN_ERR_CRTL; + cf->data[1] |= (txerr > rxerr) ? + CAN_ERR_CRTL_TX_WARNING : + CAN_ERR_CRTL_RX_WARNING; + cf->data[6] = txerr; + cf->data[7] = rxerr; + } + } + + /* Check for RX FIFO Overflow interrupt */ + if (isr & INTR_RFIS) { + stats->rx_over_errors++; + stats->rx_errors++; + + if (skb) { + cf->can_id |= CAN_ERR_CRTL; + cf->data[1] |= CAN_ERR_CRTL_RX_OVERFLOW; + } + } + + if (skb) { + stats->rx_packets++; + stats->rx_bytes += cf->can_dlc; + netif_rx(skb); + } +} + +/** + * phytium_can_isr - CAN Isr + * @irq: irq number + * @dev_id: device id poniter + * + * This is the phytium CAN Isr. It checks for the type of interrupt + * and invokes the corresponding ISR. + * + * Return: + * * IRQ_NONE - If CAN device is in sleep mode, IRQ_HANDLED otherwise + */ +static irqreturn_t phytium_can_isr(int irq, void *dev_id) +{ + struct net_device *dev = (struct net_device *)dev_id; + struct phytium_can_dev *cdev = netdev_priv(dev); + u32 isr; + + /* Get the interrupt status */ + isr = phytium_can_read(cdev, CAN_INTR) & INTR_STATUS_MASK; + if (!isr) + return IRQ_NONE; + spin_lock(&cdev->lock); + /* Check for FIFO full interrupt and alarm */ + if ((isr & INTR_RFIS)) { + netdev_dbg(dev, "rx_fifo is full!.\n"); + phytium_can_clr_reg_bits(cdev, CAN_INTR, INTR_RFIE); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_RFIC); + napi_schedule(&cdev->napi); + } + + /* Check for the type of error interrupt and Processing it */ + if (isr & (INTR_EIS | INTR_RFIS | INTR_BOIS)) { + phytium_can_clr_reg_bits(cdev, CAN_INTR, (INTR_EIE + | INTR_RFIE | INTR_BOIE)); + phytium_can_err_interrupt(dev, isr); + phytium_can_set_reg_bits(cdev, CAN_INTR, (INTR_EIC + | INTR_RFIC | INTR_BOIC)); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_EIE | INTR_BOIE); + spin_unlock(&cdev->lock); + return IRQ_HANDLED; + } + + /* Check for Tx interrupt and Processing it */ + if (isr & INTR_TEIS) { + phytium_can_tx_interrupt(dev, isr); + } + + /* Check for the type of receive interrupt and Processing it */ + if (isr & INTR_REIS) { + phytium_can_clr_reg_bits(cdev, CAN_INTR, INTR_REIE); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_REIC); + napi_schedule(&cdev->napi); + } + spin_unlock(&cdev->lock); + return IRQ_HANDLED; +} + +/** + * phytium_can_set_bittiming - CAN set bit timing routine + * @dev: Pointer to net_device structure + * + * This is the driver set bittiming routine. + * Return: 0 on success and failure value on error + */ +static int phytium_can_set_bittiming(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + const struct can_bittiming *bt = &cdev->can.bittiming; + const struct can_bittiming *dbt = &cdev->can.data_bittiming; + u32 btr, dbtr; + u32 is_config_mode; + + /** + * Check whether Phytium CAN is in configuration mode. + * It cannot set bit timing if Phytium CAN is not in configuration mode. + */ + is_config_mode = phytium_can_read(cdev, CAN_CTRL) & CTRL_XFER; + if (is_config_mode) { + netdev_alert(dev, "BUG! Cannot set bittiming - CAN is not in config mode\n"); + return -EPERM; + } + + /* Setting Baud Rate prescalar value in BRPR Register */ + btr = (bt->brp - 1) << 16; + + /* Setting Time Segment 1 in BTR Register */ + btr |= (bt->prop_seg - 1) << 2; + + btr |= (bt->phase_seg1 - 1) << 5; + + /* Setting Time Segment 2 in BTR Register */ + btr |= (bt->phase_seg2 - 1) << 8; + + /* Setting Synchronous jump width in BTR Register */ + btr |= (bt->sjw - 1); + + dbtr = (dbt->brp - 1) << 16; + dbtr |= (dbt->prop_seg - 1) << 2; + dbtr |= (dbt->phase_seg1 - 1) << 5; + dbtr |= (dbt->phase_seg2 - 1) << 8; + dbtr |= (dbt->sjw - 1); + + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { + phytium_can_write(cdev, CAN_ARB_RATE_CTRL, btr); + phytium_can_write(cdev, CAN_DAT_RATE_CTRL, dbtr); + } else { + phytium_can_write(cdev, CAN_ARB_RATE_CTRL, btr); + phytium_can_write(cdev, CAN_DAT_RATE_CTRL, btr); + } + + netdev_dbg(dev, "DAT=0x%08x, ARB=0x%08x\n", + phytium_can_read(cdev, CAN_DAT_RATE_CTRL), + phytium_can_read(cdev, CAN_ARB_RATE_CTRL)); + + return 0; +} + +/** + * phytium_can_start - This the drivers start routine + * @dev: Pointer to net_device structure + * + * This is the drivers start routine. + * Based on the State of the CAN device it puts + * the CAN device into a proper mode. + * + * Return: 0 on success and failure value on error + */ +static void phytium_can_start(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + u32 ctrl; + + /* Disable transfer */ + ctrl = phytium_can_read(cdev, CAN_CTRL); + ctrl &= ~CTRL_XFER; + phytium_can_write(cdev, CAN_CTRL, ctrl); + + /* XXX: If CANFD, reset the controller */ + phytium_can_write(cdev, CAN_CTRL, (ctrl | CTRL_RST)); + + /* Bittiming setup */ + phytium_can_set_bittiming(dev); + + /* Acceptance identifier mask setup */ + phytium_can_write(cdev, CAN_ACC_ID0_MASK, ACC_IDX_MASK_AID_MASK); + phytium_can_write(cdev, CAN_ACC_ID1_MASK, ACC_IDX_MASK_AID_MASK); + phytium_can_write(cdev, CAN_ACC_ID2_MASK, ACC_IDX_MASK_AID_MASK); + phytium_can_write(cdev, CAN_ACC_ID3_MASK, ACC_IDX_MASK_AID_MASK); + ctrl |= CTRL_AIME; + + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) + ctrl |= CTRL_IOF | CTRL_FDCRC; + + phytium_can_write(cdev, CAN_CTRL, ctrl); + + cdev->can.state = CAN_STATE_ERROR_ACTIVE; + + phytium_can_enable_all_interrupts(cdev); + + if (cdev->can.ctrlmode & CAN_CTRLMODE_LISTENONLY) + ctrl |= CTRL_XFER; + else + ctrl |= CTRL_XFER | CTRL_TXREQ; + + phytium_can_write(cdev, CAN_CTRL, ctrl); +} + +/** + * phytium_can_stop - Driver stop routine + * @dev: Pointer to net_device structure + * + * This is the drivers stop routine. It will disable the + * interrupts and put the device into configuration mode. + */ +static void phytium_can_stop(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + u32 ctrl; + + /* Disable all interrupts */ + phytium_can_disable_all_interrupt(cdev); + + /* Disable transfer and switch to receive-only mode */ + ctrl = phytium_can_read(cdev, CAN_CTRL); + ctrl &= ~(CTRL_XFER | CTRL_TXREQ); + phytium_can_write(cdev, CAN_CTRL, ctrl); + + /* Set the state as STOPPED */ + cdev->can.state = CAN_STATE_STOPPED; +} + +static void phytium_can_clean(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + + if (cdev->tx_skb) { + dev->stats.tx_errors++; + can_free_echo_skb(cdev->net, 0); + cdev->tx_skb = NULL; + } +} + +static int phytium_can_set_mode(struct net_device *dev, enum can_mode mode) +{ + switch (mode) { + case CAN_MODE_START: + phytium_can_clean(dev); + phytium_can_start(dev); + netif_wake_queue(dev); + break; + default: + return -EOPNOTSUPP; + } + return 0; +} + +/** + * phytium_can_open - Driver open routine + * @dev: Pointer to net_device structure + * + * This is the driver open routine. + * Return: 0 on success and failure value on error + */ +static int phytium_can_open(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + int ret; + + ret = pm_runtime_get_sync(cdev->dev); + if (ret < 0) { + netdev_err(dev, "%s: pm_runtime_get failed(%d)\n", + __func__, ret); + return ret; + } + /* Open the CAN device */ + ret = open_candev(dev); + if (ret) { + netdev_err(dev, "failed to open can device\n"); + goto disable_clk; + } + + /* Register interrupt handler */ + ret = request_irq(dev->irq, phytium_can_isr, + IRQF_SHARED, dev->name, dev); + if (ret < 0) { + netdev_err(dev, "failed to request interrupt\n"); + goto fail; + } + + /* Start the controller */ + phytium_can_start(dev); + + can_led_event(dev, CAN_LED_EVENT_OPEN); + napi_enable(&cdev->napi); + cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; + netif_start_queue(dev); + + return 0; + +fail: + pm_runtime_put(cdev->dev); + close_candev(dev); +disable_clk: + pm_runtime_put_sync(cdev->dev); + return ret; +} + +/** + * phytium_can_close - Driver close routine + * @dev: Pointer to net_device structure + * + * Return: 0 always + */ +static int phytium_can_close(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + + netif_stop_queue(dev); + napi_disable(&cdev->napi); + + phytium_can_stop(dev); + free_irq(dev->irq, dev); + pm_runtime_put_sync(cdev->dev); + + close_candev(dev); + can_led_event(dev, CAN_LED_EVENT_STOP); + + return 0; +} + +/** + * phytium_can_start_xmit - Starts the transmission + * + * Return: 0 on success. + */ +static netdev_tx_t phytium_can_start_xmit(struct sk_buff *skb, struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + + if (can_dropped_invalid_skb(dev, skb)) + return NETDEV_TX_OK; + + cdev->tx_skb = skb; + + return phytium_can_tx_handler(cdev); +} + +static const struct net_device_ops phytium_can_netdev_ops = { + .ndo_open = phytium_can_open, + .ndo_stop = phytium_can_close, + .ndo_start_xmit = phytium_can_start_xmit, + .ndo_change_mtu = can_change_mtu, +}; + +static int register_phytium_can_dev(struct net_device *dev) +{ + dev->flags |= IFF_ECHO; + dev->netdev_ops = &phytium_can_netdev_ops; + + return register_candev(dev); +} + +static int phytium_can_dev_setup(struct phytium_can_dev *cdev) +{ + struct net_device *dev = cdev->net; + + netif_napi_add(dev, &cdev->napi, phytium_can_poll, 64); + + cdev->can.do_set_mode = phytium_can_set_mode; + cdev->can.do_get_berr_counter = phytium_can_get_berr_counter; + + cdev->can.ctrlmode_supported = CAN_CTRLMODE_LISTENONLY | + CAN_CTRLMODE_BERR_REPORTING; + cdev->can.bittiming_const = cdev->bit_timing; + + if (cdev->fdmode) { + cdev->can.ctrlmode_supported |= CAN_CTRLMODE_FD; + dev->mtu = CANFD_MTU; + cdev->can.ctrlmode = CAN_CTRLMODE_FD; + cdev->can.data_bittiming_const = cdev->bit_timing; + } + spin_lock_init(&cdev->lock); + return 0; +} + +struct phytium_can_dev *phytium_can_allocate_dev(struct device *dev, int sizeof_priv, + int tx_fifo_depth) +{ + struct phytium_can_dev *cdev = NULL; + struct net_device *net_dev; + + /* Allocate the can device struct */ + net_dev = alloc_candev(sizeof_priv, tx_fifo_depth); + if (!net_dev) { + dev_err(dev, "Failed to allocate CAN device.\n"); + goto out; + } + + cdev = netdev_priv(net_dev); + cdev->net = net_dev; + cdev->dev = dev; + SET_NETDEV_DEV(net_dev, dev); + +out: + return cdev; +} +EXPORT_SYMBOL(phytium_can_allocate_dev); + +void phytium_can_free_dev(struct net_device *net) +{ + free_candev(net); +} +EXPORT_SYMBOL(phytium_can_free_dev); + +int phytium_can_register(struct phytium_can_dev *cdev) +{ + int ret; + + ret = phytium_can_dev_setup(cdev); + if (ret) + goto fail; + + ret = register_phytium_can_dev(cdev->net); + if (ret) { + dev_err(cdev->dev, "registering %s failed (err=%d)\n", + cdev->net->name, ret); + goto fail; + } + + devm_can_led_init(cdev->net); + + dev_info(cdev->dev, "%s device registered (irq=%d)\n", + KBUILD_MODNAME, cdev->net->irq); + + /* Probe finished + * Stop clocks. They will be reactivated once the device is opened. + */ + pm_runtime_put_sync(cdev->dev); + + return 0; + +fail: + pm_runtime_put_sync(cdev->dev); + return ret; +} +EXPORT_SYMBOL(phytium_can_register); + +void phytium_can_unregister(struct phytium_can_dev *cdev) +{ + unregister_candev(cdev->net); +} +EXPORT_SYMBOL(phytium_can_unregister); + +int phytium_can_suspend(struct device *dev) +{ + struct net_device *ndev = dev_get_drvdata(dev); + struct phytium_can_dev *cdev = netdev_priv(ndev); + + if (netif_running(ndev)) { + netif_stop_queue(ndev); + netif_device_detach(ndev); + phytium_can_stop(ndev); + pm_runtime_put_sync(cdev->dev); + } + + cdev->can.state = CAN_STATE_SLEEPING; + + return 0; +} +EXPORT_SYMBOL(phytium_can_suspend); + +int phytium_can_resume(struct device *dev) +{ + struct net_device *ndev = dev_get_drvdata(dev); + struct phytium_can_dev *cdev = netdev_priv(ndev); + int ret; + + cdev->can.state = CAN_STATE_ERROR_ACTIVE; + + if (netif_running(ndev)) { + ret = pm_runtime_resume(cdev->dev); + if (ret) + return ret; + + phytium_can_start(ndev); + netif_device_attach(ndev); + netif_start_queue(ndev); + } + + return 0; +} +EXPORT_SYMBOL(phytium_can_resume); + +MODULE_AUTHOR("Cheng Quan "); +MODULE_AUTHOR("Chen Baozi "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("CAN bus driver for Phytium CAN controller"); + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/phytium_can.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/phytium_can.h new file mode 100644 index 0000000000000000000000000000000000000000..a13969613fa60a9481284322b00f87f0b96f5762 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/phytium_can.h @@ -0,0 +1,73 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium CAN controller driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _PHYTIUM_CAN_H_ +#define _PHYTIUM_CAN_H_ + +#include +#include + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define KEEP_CAN_FIFO_MIN_LEN 16 +#define KEEP_CANFD_FIFO_MIN_LEN 128 +#define CAN_FIFO_BYTE_LEN 256 +#define STOP_QUEUE_TRUE 1 +#define STOP_QUEUE_FALSE 0 + +enum phytium_can_ip_type { + PHYTIUM_CAN = 0, + PHYTIUM_CANFD, +}; + +struct phytium_can_devtype { + enum phytium_can_ip_type cantype; + const struct can_bittiming_const *bittiming_const; +}; + +struct phytium_can_dev { + struct can_priv can; + unsigned int tx_head; + unsigned int tx_tail; + unsigned int tx_max; + struct napi_struct napi; + struct net_device *net; + struct device *dev; + struct clk *clk; + + struct sk_buff *tx_skb; + + const struct can_bittiming_const *bit_timing; + spinlock_t lock; + int fdmode; + u32 isr; + u32 tx_fifo_depth; + unsigned int is_stop_queue_flag; + struct completion comp; + void __iomem *base; +}; + +struct phytium_can_dev *phytium_can_allocate_dev(struct device *dev, int sizeof_priv, + int tx_fifo_depth); +void phytium_can_free_dev(struct net_device *net); + +int phytium_can_register(struct phytium_can_dev *cdev); +void phytium_can_unregister(struct phytium_can_dev *cdev); + +int phytium_can_suspend(struct device *dev); +int phytium_can_resume(struct device *dev); +#endif /* _PHYTIUM_CAN_H_ */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/phytium_can_pci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/phytium_can_pci.c new file mode 100644 index 0000000000000000000000000000000000000000..73d58009e83db90ac582d8f7bc653a2ff2343ed9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/can/phytium/phytium_can_pci.c @@ -0,0 +1,152 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Platform CAN bus driver for Phytium CAN controller + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include + +#include "phytium_can.h" + +struct phytium_can_pci_config { + const struct phytium_can_devtype *devtype; + unsigned int clock_freq; + unsigned int tx_fifo_depth; +}; + +#define cdev2priv(dev) container_of(dev, struct phytium_can_pci, cdev) + +struct phytium_can_pci { + struct phytium_can_dev cdev; + + void __iomem *base; +}; + +static const struct can_bittiming_const phytium_bittiming_const_8192 = { + .name = "phytium_can", + .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ + .tseg1_max = 16, + .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ + .tseg2_max = 8, + .sjw_max = 4, /* Synchronisation jump width */ + .brp_min = 1, /* Bit-rate prescaler */ + .brp_max = 8192, + .brp_inc = 2, +}; + +static const struct phytium_can_devtype phytium_can_pci = { + .cantype = PHYTIUM_CAN, + .bittiming_const = &phytium_bittiming_const_8192, +}; + +static const struct phytium_can_pci_config phytium_can_pci_data = { + .devtype = &phytium_can_pci, + .clock_freq = 600000000, + .tx_fifo_depth = 64, +}; + +static int phytium_can_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) +{ + const struct phytium_can_pci_config *cfg; + struct phytium_can_dev *cdev; + struct phytium_can_pci *priv; + int ret; + + cfg = (const struct phytium_can_pci_config *)id->driver_data; + + ret = pcim_enable_device(pdev); + if (ret) + goto err; + + ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); + if (ret) + goto err; + + cdev = phytium_can_allocate_dev(&pdev->dev, sizeof(struct phytium_can_pci), + cfg->tx_fifo_depth); + if (!cdev) + return -ENOMEM; + + priv = cdev2priv(cdev); + priv->base = pcim_iomap_table(pdev)[0]; + + cdev->dev = &pdev->dev; + cdev->fdmode = cfg->devtype->cantype; + cdev->bit_timing = cfg->devtype->bittiming_const; + cdev->can.clock.freq = cfg->clock_freq; + cdev->tx_fifo_depth = cfg->tx_fifo_depth; + + cdev->tx_head = 0; + cdev->tx_tail = 0; + cdev->tx_max = cfg->tx_fifo_depth; + + cdev->base = priv->base; + cdev->net->irq = pdev->irq; + + pci_set_drvdata(pdev, cdev->net); + + if (!pm_runtime_enabled(cdev->dev)) + pm_runtime_enable(cdev->dev); + ret = pm_runtime_get_sync(cdev->dev); + if (ret < 0) { + netdev_err(cdev->net, "%s: pm_runtime_get failed(%d)\n", + __func__, ret); + goto err_pmdisable; + } + ret = phytium_can_register(cdev); + if (ret) + goto err; + + return 0; + +err_pmdisable: + pm_runtime_disable(&pdev->dev); +err: + return ret; +} + +static void phytium_can_pci_remove(struct pci_dev *pdev) +{ + struct net_device *dev = pci_get_drvdata(pdev); + struct phytium_can_dev *cdev = netdev_priv(dev); + + pm_runtime_disable(cdev->dev); + + phytium_can_unregister(cdev); + phytium_can_free_dev(cdev->net); +} + +static __maybe_unused int phytium_can_pci_suspend(struct device *dev) +{ + return phytium_can_suspend(dev); +} + +static __maybe_unused int phytium_can_pci_resume(struct device *dev) +{ + return phytium_can_resume(dev); +} + +static SIMPLE_DEV_PM_OPS(phytium_can_pci_pm_ops, + phytium_can_pci_suspend, phytium_can_pci_resume); + +static const struct pci_device_id phytium_can_pci_id_table[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc2d), (kernel_ulong_t)&phytium_can_pci_data, }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(pci, phytium_can_pci_id_table); + +static struct pci_driver phytium_can_pci_driver = { + .name = KBUILD_MODNAME, + .probe = phytium_can_pci_probe, + .remove = phytium_can_pci_remove, + .id_table = phytium_can_pci_id_table, + .driver = { + .pm = &phytium_can_pci_pm_ops, + }, +}; + +module_pci_driver(phytium_can_pci_driver); + +MODULE_AUTHOR("Cheng Quan +#include +#include + +#include "phytium_can.h" + +#define cdev2priv(dev) container_of(dev, struct phytium_can_plat, cdev) + +struct phytium_can_plat { + struct phytium_can_dev cdev; + struct phytium_can_devtype *devtype; + + int irq; + void __iomem *reg_base; +}; + +static const struct can_bittiming_const phytium_bittiming_const_512 = { + .name = "phytium_can", + .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ + .tseg1_max = 16, + .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ + .tseg2_max = 8, + .sjw_max = 4, /* Synchronisation jump width */ + .brp_min = 1, /* Bit-rate prescaler */ + .brp_max = 512, + .brp_inc = 2, +}; + +static const struct can_bittiming_const phytium_bittiming_const_8192 = { + .name = "phytium_can", + .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ + .tseg1_max = 16, + .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ + .tseg2_max = 8, + .sjw_max = 4, /* Synchronisation jump width */ + .brp_min = 1, /* Bit-rate prescaler */ + .brp_max = 8192, + .brp_inc = 2, +}; + +static const struct phytium_can_devtype phytium_can_data = { + .cantype = PHYTIUM_CAN, + .bittiming_const = &phytium_bittiming_const_512, +}; + +static const struct phytium_can_devtype phytium_canfd_data = { + .cantype = PHYTIUM_CANFD, + .bittiming_const = &phytium_bittiming_const_8192, +}; + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_can_acpi_ids[] = { + { "PHYT000A", 0 }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(acpi, phytium_can_acpi_ids); +#endif + +#ifdef CONFIG_OF +static const struct of_device_id phytium_can_of_ids[] = { + { .compatible = "phytium,can", .data = &phytium_can_data }, + { .compatible = "phytium,canfd", .data = &phytium_canfd_data }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(of, phytium_can_of_ids); +#endif + + +static int phytium_can_plat_probe(struct platform_device *pdev) +{ + struct phytium_can_dev *cdev; + struct phytium_can_plat *priv; + struct resource *res; + const struct of_device_id *of_id; + const struct phytium_can_devtype *devtype = &phytium_can_data; + u32 tx_fifo_depth; + int ret; + const char *mode; + + ret = fwnode_property_read_u32(dev_fwnode(&pdev->dev), "tx-fifo-depth", &tx_fifo_depth); + if (ret) + tx_fifo_depth = 64; + + cdev = phytium_can_allocate_dev(&pdev->dev, sizeof(struct phytium_can_plat), + tx_fifo_depth); + if (!cdev) + return -ENOMEM; + + priv = cdev2priv(cdev); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + priv->reg_base = devm_ioremap_resource(&pdev->dev, res); + priv->irq = platform_get_irq(pdev, 0); + if (IS_ERR(priv->reg_base) || cdev->net->irq < 0) { + ret = -EINVAL; + goto fail; + } + + if (pdev->dev.of_node) { + cdev->clk = devm_clk_get(&pdev->dev, "can_clk"); + if (IS_ERR(cdev->clk)) { + dev_err(&pdev->dev, "no clock found\n"); + ret = -ENODEV; + goto fail; + } + cdev->can.clock.freq = clk_get_rate(cdev->clk); + + of_id = of_match_device(phytium_can_of_ids, &pdev->dev); + if (of_id && of_id->data) + devtype = of_id->data; + } else if (has_acpi_companion(&pdev->dev)) { + ret = fwnode_property_read_u32(dev_fwnode(&pdev->dev), + "clock-frequency", + &cdev->can.clock.freq); + if (ret < 0) { + dev_err(&pdev->dev, "failed to get clock frequency.\n"); + goto fail; + } + ret = fwnode_property_read_string(dev_fwnode(&pdev->dev), "mode-select", &mode); + if (ret < 0) { + dev_info(&pdev->dev, "get mode-select ret: %d\n", ret); + } + else { + if (strncmp("canfd", mode, strlen("canfd")) == 0) { + dev_info(&pdev->dev, "use mode-select: canfd\n"); + devtype = &phytium_canfd_data; + } + } + } + + cdev->tx_fifo_depth = tx_fifo_depth; + + if (devtype->cantype == PHYTIUM_CANFD) + cdev->fdmode = 1; + else + cdev->fdmode = 0; + + if (fwnode_property_present(dev_fwnode(&pdev->dev), "extend_brp")) + cdev->bit_timing = &phytium_bittiming_const_8192; + else + cdev->bit_timing = devtype->bittiming_const; + cdev->can.bittiming_const = devtype->bittiming_const; + cdev->base = priv->reg_base; + cdev->net->irq = priv->irq; + + platform_set_drvdata(pdev, cdev->net); + + pm_runtime_enable(cdev->dev); + ret = phytium_can_register(cdev); + if (ret) + goto out_runtime_disable; + + return ret; + +out_runtime_disable: + pm_runtime_disable(cdev->dev); +fail: + phytium_can_free_dev(cdev->net); + return ret; +} + +static __maybe_unused int phytium_can_plat_suspend(struct device *dev) +{ + return phytium_can_suspend(dev); +} + +static __maybe_unused int phytium_can_plat_resume(struct device *dev) +{ + return phytium_can_resume(dev); +} + +static int phytium_can_plat_remove(struct platform_device *pdev) +{ + struct net_device *dev = platform_get_drvdata(pdev); + struct phytium_can_dev *cdev = netdev_priv(dev); + + phytium_can_unregister(cdev); + + phytium_can_free_dev(cdev->net); + + return 0; +} + +static int __maybe_unused phytium_can_runtime_suspend(struct device *dev) +{ + struct net_device *ndev = dev_get_drvdata(dev); + struct phytium_can_dev *cdev = netdev_priv(ndev); + + clk_disable_unprepare(cdev->clk); + + return 0; +} + +static int __maybe_unused phytium_can_runtime_resume(struct device *dev) +{ + struct net_device *ndev = dev_get_drvdata(dev); + struct phytium_can_dev *cdev = netdev_priv(ndev); + + return clk_prepare_enable(cdev->clk); +} + +static const struct dev_pm_ops phytium_can_plat_pm_ops = { + SET_RUNTIME_PM_OPS(phytium_can_runtime_suspend, + phytium_can_runtime_resume, NULL) + SET_SYSTEM_SLEEP_PM_OPS(phytium_can_suspend, phytium_can_resume) +}; + +static struct platform_driver phytium_can_plat_driver = { + .driver = { + .name = KBUILD_MODNAME, + .of_match_table = of_match_ptr(phytium_can_of_ids), + .acpi_match_table = ACPI_PTR(phytium_can_acpi_ids), + .pm = &phytium_can_plat_pm_ops, + }, + .probe = phytium_can_plat_probe, + .remove = phytium_can_plat_remove, +}; + +module_platform_driver(phytium_can_plat_driver); + +MODULE_AUTHOR("Cheng Quan "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium CAN driver for IO Mapped controllers"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..7b63f74763a9e67a90ec7f50fbd763b432e554b8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/Kconfig @@ -0,0 +1,7 @@ +config MACB_TSN + bool "TSN supports" + depends on MACB + help + This is TSN supports for MACB driver. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..9c5e45d5b876cf993811b95cd589db9e99ba89b8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/Makefile @@ -0,0 +1,5 @@ +ifeq ($(CONFIG_MACB_TSN),y) +macb-y += macb_tsn.o +endif + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/macb_tsn.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/macb_tsn.c new file mode 100644 index 0000000000000000000000000000000000000000..890d15db7ef634eee9f199aad2e10e38838040f3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/macb_tsn.c @@ -0,0 +1,1290 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Phytium TSN support driver + * + * Copyright (c) 2024 Phytium Technology Co., Ltd. + */ +//#define DEBUG + +#include +#include +#include +#include +#include +#include + +#include "macb.h" +#include "macb_tsn.h" + +static int phytium_set_cbs_tc(struct net_device *ndev, void *type_data) +{ + struct macb *bp = netdev_priv(ndev); + struct tc_cbs_qopt_offload *cbs = type_data; + u32 cbs_ctrl, idle_slope; + u8 tc = cbs->queue; + u8 tc_nums = netdev_get_num_tc(ndev); + u8 prio_top, prio_next; + + prio_top = tc_nums - 1; + prio_next = tc_nums - 2; + + pr_debug("%s %d cbs->queue %d\n", __func__, __LINE__, cbs->queue); + pr_debug("%s %d tc_nums %d\n", __func__, __LINE__, tc_nums); + + /* CBS is available on the two highest priority active queues */ + if (tc != prio_top && tc != prio_next) + return -EINVAL; + + /* idleslope should be positive, sendslope should be negative */ + if (cbs->idleslope < 0 || cbs->sendslope > 0) + return -EINVAL; + + /* if set sendslope, check idle - send == speed */ + if (cbs->sendslope != 0 && + (cbs->idleslope - cbs->sendslope) != bp->speed * 1000 * 1000) { + pr_warn("idleslope - sendslope != portTransmitRate, please check it\n"); + return -EINVAL; + } + + cbs_ctrl = gem_readl(bp, CBS_CONTROL); + + if (!cbs->enable) { + cbs_ctrl &= (~BIT(prio_top - tc)); + gem_writel(bp, CBS_CONTROL, cbs_ctrl); + return 0; + } + + pr_debug("bp->speed %d\n", bp->speed); + pr_debug("cbs->idleslope %d\n", cbs->idleslope); + + /* calculate idle slope value, cbs->idleslope is kilobit/sec */ + /* reg value in bytes/sec for gigabit operation, and nibbles/sec */ + /* for 10/100 operation, and scaled by 2.5 in 2.5G operation */ + switch (bp->speed) { + case SPEED_10: + case SPEED_100: + idle_slope = 125 * cbs->idleslope * 2; + break; + case SPEED_1000: + idle_slope = 125 * cbs->idleslope; + break; + case SPEED_2500: + idle_slope = 125 * cbs->idleslope * 2 / 5; + break; + default: + pr_info("macb speed %d not support\n", bp->speed); + return -EOPNOTSUPP; + } + + /* cbs should be disabled prior to updating the idle slope value */ + cbs_ctrl &= (~BIT(prio_top - tc)); + gem_writel(bp, CBS_CONTROL, cbs_ctrl); + + if (tc == prio_top) + gem_writel(bp, CBS_IDLESLOPE_Q_A, idle_slope); + else + gem_writel(bp, CBS_IDLESLOPE_Q_B, idle_slope); + + /* after set idle slope, enable cbs */ + cbs_ctrl |= BIT(prio_top - tc); + gem_writel(bp, CBS_CONTROL, cbs_ctrl); + + return 0; +} + +static int phytium_set_mqprio_tc(struct net_device *ndev, void *type_data) +{ + struct macb *bp = netdev_priv(ndev); + struct tc_mqprio_qopt *mqprio = type_data; + u8 num_tc; + int i; + + pr_debug("%s %d\n", __func__, __LINE__); + mqprio->hw = TC_MQPRIO_HW_OFFLOAD_TCS; + num_tc = mqprio->num_tc; + + if (!num_tc) { + netdev_reset_tc(ndev); + return 0; + } + + /* For easier use, num_tc need same as num_queues. */ + if (num_tc != bp->num_queues) { + netdev_err(ndev, "num_tc should same as dev num_queues %d\n", + bp->num_queues); + return -EINVAL; + } + + netdev_set_num_tc(ndev, num_tc); + + /* Each TC is associated with one netdev queue, the queue index is */ + /* used as the priority, where a higher index will have a higher */ + /* priority than a lower index. */ + for (i = 0; i < num_tc; i++) + netdev_set_tc_queue(ndev, i, 1, i); + return 0; +} + +struct queues_enst_setting { + u8 enable; + u32 start_time; + u32 on_time; + u32 off_time; +}; + +#ifdef TSN_DEBUG +static void _dump_taprio_param(struct tc_taprio_qopt_offload *taprio) +{ + int i = 0; + + _dump_param(taprio->enable); + _dump_param(taprio->base_time); + _dump_param(taprio->cycle_time); + _dump_param(taprio->cycle_time_extension); + _dump_param(taprio->num_entries); + for (; i < taprio->num_entries; i++) { + _dump_param(i); + _dump_param(taprio->entries[i].command); + _dump_param(taprio->entries[i].gate_mask); + _dump_param(taprio->entries[i].interval); + } +} + +static void _dump_enst_param(struct queues_enst_setting *setting) +{ + int i = 0; + + for (; i < MACB_MAX_ENST_QUEUES; i++) { + if (!setting[i].enable) + continue; + _dump_param(i); + _dump_param(setting[i].enable); + _dump_param(setting[i].start_time); + _dump_param(setting[i].on_time); + _dump_param(setting[i].off_time); + } +} +#else +#define _dump_taprio_param(taprio) +#define _dump_enst_param(setting) +#endif + +static int _taprio_convert_enst(struct tc_taprio_qopt_offload *taprio, + struct queues_enst_setting *setting) +{ + int i, j; + // TODO: queue start time need add base_time? + u32 queue_start_time = 0; + + for (i = 0; i < taprio->num_entries; i++) { + ulong bitmap = (ulong)taprio->entries[i].gate_mask; + + if (!bitmap) { + pr_warn("gata_mask should not be zero\n"); + return -EINVAL; + } + for_each_set_bit(j, &bitmap, MACB_MAX_ENST_QUEUES) { + /* find this entrie masked queue j */ + if (setting[j].enable) { + pr_warn("not support setting same queue two times, hw assumes with fixed period\n"); + return -EINVAL; + } + setting[j].enable = true; + setting[j].start_time = queue_start_time; + setting[j].on_time = taprio->entries[i].interval; + setting[j].off_time = + taprio->cycle_time - setting[j].on_time; + } + queue_start_time += taprio->entries[i].interval; + } + return 0; +} + +static int phytium_set_taprio(struct net_device *ndev, + struct queues_enst_setting *setting) +{ + struct macb *bp = netdev_priv(ndev); + int i; + int enst_ctrl = 0; + int scale = 8; + + switch (bp->speed) { + case SPEED_10: + scale = 800; + break; + case SPEED_100: + scale = 80; + break; + case SPEED_1000: + scale = 8; + break; + default: + pr_info("macb speed %d not support\n", bp->speed); + return -EOPNOTSUPP; + } + + for (i = 0; i < bp->num_queues; i++) { + if (!setting[i].enable) + continue; + gem_writel_n(bp, ENST_START_TIME, i, setting[i].start_time); + + if (setting[i].on_time > 1048568 || + setting[i].off_time > 1048568) { + pr_warn("queue %d on_time:%d, off_time:%d should small 1048568 ns\n", + i, setting[i].on_time, setting[i].off_time); + return -EINVAL; + } + + if (setting[i].on_time / scale < + ndev->mtu + ETH_HLEN + + ETH_FCS_LEN + NET_IP_ALIGN) + pr_info("tx frame may too long to be transmiited in on-time, it will cause transmission hang\n"); + + gem_writel_n(bp, ENST_ON_TIME, i, setting[i].on_time / scale); + gem_writel_n(bp, ENST_OFF_TIME, i, setting[i].off_time / scale); + enst_ctrl |= BIT(i); + } + gem_writel(bp, ENST_CONTROL, enst_ctrl); + return 0; +} + +static int phytium_set_taprio_tc(struct net_device *ndev, void *type_data) +{ + struct tc_taprio_qopt_offload *taprio = type_data; + struct queues_enst_setting setting[MACB_MAX_ENST_QUEUES] = {0}; + int ret; + + _dump_taprio_param(taprio); + + ret = _taprio_convert_enst(taprio, setting); + if (ret) + return ret; + + _dump_enst_param(setting); + + ret = phytium_set_taprio(ndev, setting); + + return ret; +} + +int phytium_setup_tc(struct net_device *ndev, + enum tc_setup_type type, void *type_data) +{ + switch (type) { + case TC_SETUP_QDISC_CBS: + return phytium_set_cbs_tc(ndev, type_data); + + case TC_SETUP_QDISC_MQPRIO: + return phytium_set_mqprio_tc(ndev, type_data); + + case TC_SETUP_QDISC_TAPRIO: + return phytium_set_taprio_tc(ndev, type_data); + + default: + return -EOPNOTSUPP; + } +}; + +static int phytium_find_stream_id(struct macb *bp, long value, bool print); + +static int phytium_set_cb(struct macb *bp, struct tsn_setting_param *setting) +{ + int frer_reg_ofst, frer_stream_ofst; + int redundancy_tag, frer_control_a, frer_control_b; + + if (setting[CB_HIS_LEN].value > bp->cb_history_len || + setting[CB_OFST].value > bp->num_cb_streams || + setting[CB_SEQ_LEN].value > 16) + return -EINVAL; + + if (phytium_find_stream_id(bp, setting[CB_INDEX].value, false)) + return -EINVAL; + + frer_reg_ofst = (setting[CB_OFST].value > 1) ? + 4 * (setting[CB_OFST].value > 1) : 0; + frer_stream_ofst = setting[CB_OFST].value % 2; + + /* counter of 8192 rx_clk periods, */ + /* in gigabit means 65.536 us, set 1ms here */ + gem_writel(bp, FRER_TIMEOUT, 0xF); + + redundancy_tag = GEM_BFINS(STRIP_R_TAG, setting[CB_STRIP_RTAG].value, + gem_readl(bp, FRER_RED_TAG)); + gem_writel(bp, FRER_RED_TAG, redundancy_tag); + + /* before setting, set en_elimination low */ + frer_control_a = gem_readl_n(bp, FRER_CONTROL_1_A, frer_reg_ofst); + frer_control_a &= (~BIT(31)); + + gem_writel_n(bp, FRER_CONTROL_1_A, frer_reg_ofst, frer_control_a); + + if (setting[CB_ENABLE].value == 0) + return 0; + + /* setting enable, now set frer control b */ + frer_control_b = GEM_BF(SEQ_NUM_LENGTH, setting[CB_SEQ_LEN].value) | + GEM_BF(SEQ_REC_WINDOW, + setting[CB_HIS_LEN].value); + gem_writel_n(bp, FRER_CONTROL_1_B, frer_reg_ofst, frer_control_b); + + /* enable some default config */ + frer_control_a |= 0xF0000000; + if (frer_stream_ofst) + frer_control_a = GEM_BFINS(MEMBER_STREAM2, + setting[CB_INDEX].value, + frer_control_a); + else + frer_control_a = GEM_BFINS(MEMBER_STREAM1, + setting[CB_INDEX].value, + frer_control_a); + + gem_writel_n(bp, FRER_CONTROL_1_A, frer_reg_ofst, frer_control_a); + + return 0; +} + +static ssize_t cb_setting_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct macb *bp = container_of(attr, struct macb, cb_setting_attr); + + return snprintf(buf, PAGE_SIZE, + "help:\n" + " index: stream id handle, if use ethtool to do stream identify, it should same as [loc]\n" + " ofst: set offset of cb streams to hw, valid max to %d (optional, default 0)\n" + " seq_len: number of significant bits of th 802.1CB sequence number, max to 16(optional, default 16)\n" + " his_len: sequence history windows size, max to %d(optional, default %d)\n" + " strip_rtag: set this to 1 will tripping of the R-TAG from received frames(optional, default 1)\n" + " and strip_rtag is globla config, will affect all cb stream setting.\n" + " enable: enable:1, disable:0\n" + "example:\n" + " echo index 1 ofst 0 seq_len 16 his_len 64 strip_rtag 1 enable 1 > cb_setting\n" + " echo index 1 enable 1 > cb_setting\n" + "note:\n" + " if you set ofst 0 first, and set ofst 1 after, the ofst 1's setting will cover ofst 0's\n" + " because ofst 0 & 1(or even & odd) use same cb streams setting register.\n" + , bp->num_cb_streams, bp->cb_history_len, bp->cb_history_len); +} + +static ssize_t cb_setting_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t count) +{ + struct macb *bp = container_of(attr, struct macb, cb_setting_attr); + struct tsn_setting_param cb_setting[] = { + [CB_INDEX] = { .name = "index", 1}, + [CB_OFST] = { .name = "ofst", 0}, + [CB_SEQ_LEN] = { .name = "seq_len", 16}, + [CB_HIS_LEN] = { .name = "his_len", 64}, + [CB_STRIP_RTAG] = { .name = "strip_rtag", 1}, + [CB_ENABLE] = { .name = "enable", 0}, + }; + int i, ret; + + for (i = 0; i < GET_SETTING_SIZE(cb_setting); i++) { + /* find setting name */ + char *tmp = strstr(buf, cb_setting[i].name); + char *end; + int recovery = 0; + + if (!tmp) + continue; + tmp += strlen(cb_setting[i].name); + tmp = skip_spaces(tmp); + end = strpbrk(tmp, " "); + if (end) { + recovery = 1; + *end = '\0'; + } + /* kstrtol input string must be null-terminated */ + ret = kstrtol(tmp, 10, &cb_setting[i].value); + if (recovery) + *end = ' '; + + if (ret < 0) + return ret; + dev_dbg(dev, "get: %s=%ld\n", + cb_setting[i].name, cb_setting[i].value); + } + + ret = phytium_set_cb(bp, cb_setting); + if (ret < 0) + return ret; + return count; +} +DEVICE_ATTR_RW(cb_setting); + +static ssize_t stream_id_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct macb *bp = container_of(attr, struct macb, stream_id_attr); + + return snprintf(buf, PAGE_SIZE, + "help:\n" + " index: tsnStreamIdHandle, decimal\n" + " src_mac: tsnCpeSmacVlanDownSrcMac input format:aabbcc112233\n" + " dst_mac: tsnCpeNullDownDestMac input format:aa1122bbcc33\n" + " src_ip: ipv4 source address input format:192.168.1.2\n" + " dst_ip: ipv4 destination address input format:192.168.1.2\n" + " src_port: ip source port input format:5001\n" + " dst_port: ip destination port input format:5001\n" + " vlan_id: tsnCpeSmacVlanDownVlan or tsnCpeNullDownVlan, decimal\n" + " rx_queue: set the queue num to receive this stream id, max to %d\n" + " also use as IPV (internal priority value),\n" + " higher queue index means higher priority\n" + "p.s.if set src/dst mac, dst/dst ip/port will be ignored\n" + "example:\n" + " echo add index 0 src_mac aabbcc112233 vlan_id 210 > stream_id\n" + " echo del index 0 > stream_id\n" + " echo show index 0 > stream_id\n", bp->num_queues); +} + +static int phytium_set_stream_to_hw(struct macb *bp, + struct tsn_setting_param *stream_id) +{ + unsigned long mac_value; + int is_src_mac = 0; + u16 index = stream_id[STREAM_INDEX].value; + u32 w0, w1, t2_scr; + bool cmp_a = false; + bool cmp_b = false; + bool cmp_c = false; + + /* stream_id param check */ + if (stream_id[STREAM_SRC_MAC].value) { + is_src_mac = 1; + mac_value = stream_id[STREAM_SRC_MAC].value; + } else if (stream_id[STREAM_DST_MAC].value) { + mac_value = stream_id[STREAM_DST_MAC].value; + } else { + return -EINVAL; + } + + /* compare first 4 byte in mac */ + w0 = 0; + w1 = 0; + w0 = __fswab32((u32)((mac_value & (0xFFFFFFFF0000L)) >> 16)); + w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ + w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_SOF, w1); + w1 = GEM_BFINS(T2OFST, is_src_mac * 6, w1); + gem_writel_n(bp, T2CMPW0, T2CMP_OFST(GEM_MAC_FIRST_CMP(index)), w0); + gem_writel_n(bp, T2CMPW1, T2CMP_OFST(GEM_MAC_FIRST_CMP(index)), w1); + cmp_a = true; + + /* compare last 2 byte in mac */ + w0 = 0; + w1 = 0; + w0 = __fswab32((u32)(mac_value & (0xFFFF)) | 0xFFFF0000); + w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_SOF, w1); + w1 = GEM_BFINS(T2OFST, is_src_mac * 6 + 4, w1); + gem_writel_n(bp, T2CMPW0, T2CMP_OFST(GEM_MAC_SECOND_CMP(index)), w0); + gem_writel_n(bp, T2CMPW1, T2CMP_OFST(GEM_MAC_SECOND_CMP(index)), w1); + cmp_b = true; + + /* vlan id!=0, compare vlan id */ + if (stream_id[STREAM_VLAN_ID].value) { + w0 = 0; + w1 = 0; + /* vid 12 bit valid */ + w0 = (stream_id[STREAM_VLAN_ID].value << 16) | 0x0FFF; + w1 = GEM_BFINS(T2VLANID, 1, w1); + w1 = GEM_BFINS(T2CMPOFST, 0, w1); /* 0 C-TAG VID, 1 S-TAG VID */ + gem_writel_n(bp, T2CMPW0, + T2CMP_OFST(GEM_VLAN_ID_CMP(index)), w0); + gem_writel_n(bp, T2CMPW1, + T2CMP_OFST(GEM_VLAN_ID_CMP(index)), w1); + cmp_c = true; + } + + t2_scr = 0; + t2_scr = GEM_BFINS(QUEUE, + stream_id[STREAM_RX_QUEUE].value & 0xFF, t2_scr); + t2_scr = GEM_BFINS(ETHT2IDX, SCRT2_ETHT, t2_scr); + if (cmp_a) { + t2_scr = GEM_BFINS(CMPA, GEM_MAC_FIRST_CMP(index), t2_scr); + t2_scr = GEM_BFINS(CMPAEN, 1, t2_scr); + } + if (cmp_b) { + t2_scr = GEM_BFINS(CMPB, GEM_MAC_SECOND_CMP(index), t2_scr); + t2_scr = GEM_BFINS(CMPBEN, 1, t2_scr); + } + if (cmp_c) { + t2_scr = GEM_BFINS(CMPC, GEM_VLAN_ID_CMP(index), t2_scr); + t2_scr = GEM_BFINS(CMPCEN, 1, t2_scr); + } + gem_writel_n(bp, SCRT2, index, t2_scr); + return 0; +} + +static int phytium_set_ip_to_hw(struct macb *bp, struct tsn_setting_param *id) +{ + u16 index = id[STREAM_INDEX].value; + u32 w0, w1, t2_scr; + bool cmp_a = false; + bool cmp_b = false; + bool cmp_c = false; + + if (id[STREAM_SRC_IP].value) { + /* 1st compare reg - IP source address */ + w0 = 0; + w1 = 0; + w0 = id[STREAM_SRC_IP].value; + w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ + w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_ETYPE, w1); + w1 = GEM_BFINS(T2OFST, ETYPE_SRCIP_OFFSET, w1); + gem_writel_n(bp, T2CMPW0, + T2CMP_OFST(GEM_IP4SRC_CMP(index)), w0); + gem_writel_n(bp, T2CMPW1, + T2CMP_OFST(GEM_IP4SRC_CMP(index)), w1); + cmp_a = true; + } + + if (id[STREAM_DST_IP].value) { + /* 2nd compare reg - IP destination address */ + w0 = 0; + w1 = 0; + w0 = id[STREAM_DST_IP].value; + w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ + w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_ETYPE, w1); + w1 = GEM_BFINS(T2OFST, ETYPE_DSTIP_OFFSET, w1); + gem_writel_n(bp, T2CMPW0, + T2CMP_OFST(GEM_IP4DST_CMP(index)), w0); + gem_writel_n(bp, T2CMPW1, + T2CMP_OFST(GEM_IP4DST_CMP(index)), w1); + cmp_b = true; + } + + if (id[STREAM_SRC_PORT].value || id[STREAM_DST_PORT].value) { + /* 3rd compare reg - source port, destination port */ + w0 = 0; + w1 = 0; + w1 = GEM_BFINS(T2CMPOFST, GEM_T2COMPOFST_IPHDR, w1); + if (id[STREAM_DST_PORT].value && + id[STREAM_SRC_PORT].value) { + w0 = GEM_BFINS(T2MASK, + id[STREAM_SRC_PORT].value, w0); + w0 = GEM_BFINS(T2CMP, + id[STREAM_DST_PORT].value, w0); + w1 = GEM_BFINS(T2DISMSK, 1, w1); /* 32-bit compare */ + w1 = GEM_BFINS(T2OFST, IPHDR_SRCPORT_OFFSET, w1); + } else if (id[STREAM_SRC_PORT].value) { /* src port */ + /* only one port definition */ + w1 = GEM_BFINS(T2DISMSK, 0, w1); /* 16-bit compare */ + w0 = GEM_BFINS(T2MASK, 0xFFFF, w0); + w0 = GEM_BFINS(T2CMP, id[STREAM_SRC_PORT].value, w0); + w1 = GEM_BFINS(T2OFST, IPHDR_SRCPORT_OFFSET, w1); + } else { /* dst port */ + w1 = GEM_BFINS(T2DISMSK, 0, w1); /* 16-bit compare */ + w0 = GEM_BFINS(T2MASK, 0xFFFF, w0); + w0 = GEM_BFINS(T2CMP, id[STREAM_DST_PORT].value, w0); + w1 = GEM_BFINS(T2OFST, IPHDR_DSTPORT_OFFSET, w1); + } + gem_writel_n(bp, T2CMPW0, T2CMP_OFST(GEM_PORT_CMP(index)), w0); + gem_writel_n(bp, T2CMPW1, T2CMP_OFST(GEM_PORT_CMP(index)), w1); + cmp_c = true; + } + + t2_scr = 0; + t2_scr = GEM_BFINS(QUEUE, + id[STREAM_RX_QUEUE].value & 0xFF, t2_scr); + t2_scr = GEM_BFINS(ETHT2IDX, SCRT2_ETHT, t2_scr); + if (cmp_a) { + t2_scr = GEM_BFINS(CMPA, GEM_MAC_FIRST_CMP(index), t2_scr); + t2_scr = GEM_BFINS(CMPAEN, 1, t2_scr); + } + if (cmp_b) { + t2_scr = GEM_BFINS(CMPB, GEM_MAC_SECOND_CMP(index), t2_scr); + t2_scr = GEM_BFINS(CMPBEN, 1, t2_scr); + } + if (cmp_c) { + t2_scr = GEM_BFINS(CMPC, GEM_VLAN_ID_CMP(index), t2_scr); + t2_scr = GEM_BFINS(CMPCEN, 1, t2_scr); + } + gem_writel_n(bp, SCRT2, index, t2_scr); + + return 0; +} + +static int phytium_add_stream_id(struct macb *bp, + struct tsn_setting_param *stream_id) +{ + struct ethtool_rx_fs_item *item, *newfs; + unsigned long flags, mac_value; + int ret = -EINVAL; + bool added = false, is_src_mac, is_ip = false; + + /* stream_id param check */ + if (stream_id[STREAM_SRC_MAC].value) { + is_src_mac = true; + mac_value = stream_id[STREAM_SRC_MAC].value; + } else if (stream_id[STREAM_DST_MAC].value) { + mac_value = stream_id[STREAM_DST_MAC].value; + } else if (stream_id[STREAM_DST_IP].value || + stream_id[STREAM_SRC_IP].value || + stream_id[STREAM_DST_PORT].value || + stream_id[STREAM_SRC_PORT].value) { + is_ip = true; + } else { + return -EINVAL; + } + + ret = phytium_find_stream_id(bp, stream_id[STREAM_INDEX].value, false); + if ((ret != -ENOENT) || + stream_id[STREAM_RX_QUEUE].value >= bp->num_queues) + return -EINVAL; + + newfs = kzalloc(sizeof(*newfs), GFP_KERNEL); + if (!newfs) + return -ENOMEM; + + newfs->fs.location = stream_id[STREAM_INDEX].value; + newfs->fs.ring_cookie = stream_id[STREAM_RX_QUEUE].value; + + if (!is_ip) { + newfs->fs.flow_type = FLOW_MAC_EXT; + newfs->fs.h_ext.data[0] = is_src_mac; + newfs->fs.h_ext.vlan_tci = stream_id[STREAM_VLAN_ID].value; + mac_value = __fswab64(mac_value); + memcpy(newfs->fs.h_ext.h_dest, (char *)&mac_value + 2, 6); + } else { + newfs->fs.flow_type = TCP_V4_FLOW; + newfs->fs.h_u.tcp_ip4_spec.ip4src = + stream_id[STREAM_SRC_IP].value; + newfs->fs.h_u.tcp_ip4_spec.ip4dst = + stream_id[STREAM_DST_IP].value; + newfs->fs.h_u.tcp_ip4_spec.psrc = + stream_id[STREAM_SRC_PORT].value; + newfs->fs.h_u.tcp_ip4_spec.pdst = + stream_id[STREAM_DST_PORT].value; + } + + spin_lock_irqsave(&bp->rx_fs_lock, flags); + + /* find correct place to add in list */ + list_for_each_entry(item, &bp->rx_fs_list.list, list) { + if (item->fs.location > newfs->fs.location) { + list_add_tail(&newfs->list, &item->list); + added = true; + break; + } else if (item->fs.location == stream_id[STREAM_INDEX].value) { + pr_warn("stream id %d not added: not free\n", + item->fs.location); + ret = -EBUSY; + goto err; + } + } + if (!added) + list_add_tail(&newfs->list, &bp->rx_fs_list.list); + + if (!is_ip) + phytium_set_stream_to_hw(bp, stream_id); + else + phytium_set_ip_to_hw(bp, stream_id); + bp->rx_fs_list.count++; + + spin_unlock_irqrestore(&bp->rx_fs_lock, flags); + return 0; + +err: + spin_unlock_irqrestore(&bp->rx_fs_lock, flags); + kfree(newfs); + return ret; +} + +static int phytium_del_stream_id(struct macb *bp, + struct tsn_setting_param *stream_id) +{ + struct ethtool_rx_fs_item *item; + unsigned long flags; + + pr_debug("%s %d\n", __func__, __LINE__); + + spin_lock_irqsave(&bp->rx_fs_lock, flags); + + list_for_each_entry(item, &bp->rx_fs_list.list, list) { + if (item->fs.location == stream_id[STREAM_INDEX].value) { + gem_writel_n(bp, SCRT2, item->fs.location, 0); + list_del(&item->list); + bp->rx_fs_list.count--; + + spin_unlock_irqrestore(&bp->rx_fs_lock, flags); + pr_info("stream id %d: delete\n", item->fs.location); + kfree(item); + return 0; + } + } + + spin_unlock_irqrestore(&bp->rx_fs_lock, flags); + return -EINVAL; +} + +static int phytium_find_stream_id(struct macb *bp, long value, bool print) +{ + struct ethtool_rx_fs_item *item; + unsigned long flags; + + if (value < 0 || value >= bp->max_tuples) + return -EINVAL; + + pr_debug("%s %d\n", __func__, __LINE__); + + spin_lock_irqsave(&bp->rx_fs_lock, flags); + + list_for_each_entry(item, &bp->rx_fs_list.list, list) { + if (item->fs.location == value) { + if (print) { + if (item->fs.flow_type != FLOW_MAC_EXT) { + pr_info("stream id %ld is used by ethtool\n", + value); + } else { + pr_info("stream id %d: %s_mac:%pm vid %d\n", + item->fs.location, + item->fs.h_ext.data[0] ? + "src" : "dst", + (item->fs.h_ext.h_dest), + item->fs.h_ext.vlan_tci); + } + } + spin_unlock_irqrestore(&bp->rx_fs_lock, flags); + return 0; + } + } + if (print) + pr_info("stream id %ld not find\n", value); + + spin_unlock_irqrestore(&bp->rx_fs_lock, flags); + return -ENOENT; +} + +static int phytium_show_stream_id(struct macb *bp, + struct tsn_setting_param *stream_id) +{ + return phytium_find_stream_id(bp, stream_id[STREAM_INDEX].value, true); +} + +static ssize_t stream_id_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t count) +{ + struct macb *bp = container_of(attr, struct macb, stream_id_attr); + struct tsn_setting_param stream_id[] = { + [STREAM_INDEX] = { .name = "index", 1}, + [STREAM_SRC_MAC] = { .name = "src_mac", 0}, + [STREAM_DST_MAC] = { .name = "dst_mac", 0}, + [STREAM_SRC_IP] = { .name = "src_ip", 0}, + [STREAM_DST_IP] = { .name = "dst_ip", 0}, + [STREAM_SRC_PORT] = { .name = "src_port", 0}, + [STREAM_DST_PORT] = { .name = "dst_port", 0}, + [STREAM_TAGGED] = { .name = "tagged", 3}, + [STREAM_VLAN_ID] = { .name = "vlan_id", 0}, + [STREAM_RX_QUEUE] = { .name = "rx_queue", 1}, + }; + int i, ret, action = 0; + + if (strstr(buf, "add")) + action = STREAM_ADD; + else if (strstr(buf, "del")) + action = STREAM_DEL; + else if (strstr(buf, "show")) + action = STREAM_SHOW; + else + return -EINVAL; + + for (i = 0; i < GET_SETTING_SIZE(stream_id); i++) { + /* find setting name */ + char *tmp = strstr(buf, stream_id[i].name); + char *end; + int recovery = 0; + + if (!tmp) + continue; + tmp += strlen(stream_id[i].name); + tmp = skip_spaces(tmp); + end = strpbrk(tmp, " "); + if (end) { + recovery = 1; + *end = '\0'; + } + switch (i) { + case STREAM_SRC_IP: + case STREAM_DST_IP: + stream_id[i].value = in_aton(tmp); + break; + case STREAM_SRC_MAC: + case STREAM_DST_MAC: + ret = kstrtol(tmp, 16, &stream_id[i].value); + break; + case STREAM_SRC_PORT: + case STREAM_DST_PORT: + ret = kstrtol(tmp, 10, &stream_id[i].value); + stream_id[i].value = ntohs((short)stream_id[i].value); + break; + default: + ret = kstrtol(tmp, 10, &stream_id[i].value); + break; + } + if (recovery) + *end = ' '; + + if (ret < 0) + return ret; + dev_dbg(dev, "get: %s=%lx\n", stream_id[i].name, + stream_id[i].value); + } + + switch (action) { + case STREAM_ADD: + ret = phytium_add_stream_id(bp, stream_id); + break; + case STREAM_DEL: + ret = phytium_del_stream_id(bp, stream_id); + break; + case STREAM_SHOW: + ret = phytium_show_stream_id(bp, stream_id); + break; + default: + return -EINVAL; + } + if (ret < 0) + return ret; + return count; +} +DEVICE_ATTR_RW(stream_id); + +static ssize_t qci_setting_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct macb *bp = container_of(attr, struct macb, qci_setting_attr); + (void)bp; + return snprintf(buf, PAGE_SIZE, + "help:\n" + " index: stream id handle, if use ethtool to do stream identify, it should same as [loc]\n" + " max_sdu: maximum SDU(service data unit) size, max to 0xFFFF, byte,\n" + " this param will effect rx queue, not only this stream id handle\n" + " ipv: same as rx_queue in stream_id, it will cover the setting in stream_id\n" + " interval: TimeInterval, ns\n" + " max_rate: IntervalOctetMax, byte\n" + " mark_red: MarkAllFramesRed, all frame in this stream id will drop\n" + "example:\n" + " echo index 0 max_sdu 512 ipv 7 > qci_setting\n" + " echo index 0 ipv 7 interval 500000 max_rate 32768 > qci_setting\n" + " echo index 0 ipv 6 interval 500000 max_rate 16384 > qci_setting\n" + " echo index 0 mark_red 1 > qci_setting\n"); +} + +static int phytium_set_qci(struct macb *bp, struct tsn_setting_param *setting) +{ + int index = setting[QCI_INDEX].value; + u32 queue, t2_scr, max_sdu_size = 0, flush_reg = 0; + u32 rate_limit_reg, scale; + unsigned long flags; + + if (phytium_find_stream_id(bp, setting[QCI_INDEX].value, false) || + setting[QCI_IPV].value >= bp->num_queues || + setting[QCI_MAX_SDU].value > 0xFFFFL) + return -EINVAL; + + /* update screen type 2 register */ + spin_lock_irqsave(&bp->rx_fs_lock, flags); + t2_scr = gem_readl_n(bp, SCRT2, index); + if (setting[QCI_IPV].value > 0) + t2_scr = + GEM_BFINS(QUEUE, setting[QCI_IPV].value & 0xFF, t2_scr); + + if (setting[QCI_MARK_RED].value == 1) + t2_scr = GEM_BFINS(DROP_ON_MATCH, 1, t2_scr); + else + t2_scr = GEM_BFINS(DROP_ON_MATCH, 0, t2_scr); + gem_writel_n(bp, SCRT2, index, t2_scr); + spin_unlock_irqrestore(&bp->rx_fs_lock, flags); + + /* get the queue num in screen type 2 */ + queue = GEM_BFEXT(QUEUE, t2_scr); + + if (setting[QCI_MAX_SDU].value > 0) + max_sdu_size = setting[QCI_MAX_SDU].value & 0xFFFFL; + + /* set rx Qx flush reg */ + if (max_sdu_size) + flush_reg = GEM_BF(MAX_VAL, max_sdu_size) | + GEM_BF(LIMIT_FRAME_SIZE, 1); + gem_writel_n(bp, RX_Q0_FLUSH, queue, flush_reg); + + /* set rate limit reg */ + switch (bp->speed) { + case SPEED_10: + scale = 51200; + break; + case SPEED_100: + scale = 5120; + break; + case SPEED_1000: + scale = 1024; + break; + default: + pr_info("macb speed %d not support\n", bp->speed); + return -EOPNOTSUPP; + } + rate_limit_reg = GEM_BF(MAX_RATE_VAL, setting[QCI_MAX_RATE].value) | + GEM_BF(INTERVAL_TIME, setting[QCI_INTERVAL].value / scale); + gem_writel_n(bp, SCR2_REG0_RATE_LIMIT, index, rate_limit_reg); + + return 0; +} + +static ssize_t qci_setting_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t count) +{ + struct macb *bp = container_of(attr, struct macb, qci_setting_attr); + struct tsn_setting_param qci_setting[] = { + [QCI_INDEX] = { .name = "index", 0}, + [QCI_MAX_SDU] = { .name = "max_sdu", -1}, + [QCI_IPV] = { .name = "ipv", -1}, + [QCI_INTERVAL] = { .name = "interval", 0}, + [QCI_MAX_RATE] = { .name = "max_rate", 0}, + [QCI_MARK_RED] = { .name = "mark_red", 0}, + }; + int i, ret; + + for (i = 0; i < GET_SETTING_SIZE(qci_setting); i++) { + /* find setting name */ + char *tmp = strstr(buf, qci_setting[i].name); + char *end; + int recovery = 0; + + if (!tmp) + continue; + + tmp += strlen(qci_setting[i].name); + tmp = skip_spaces(tmp); + end = strpbrk(tmp, " "); + if (end) { + recovery = 1; + *end = '\0'; + } + /* kstrtol input string must be null-terminated */ + ret = kstrtol(tmp, 10, &qci_setting[i].value); + if (recovery) + *end = ' '; + + if (ret < 0) + return ret; + dev_dbg(dev, "get: %s=%ld\n", qci_setting[i].name, + qci_setting[i].value); + } + + ret = phytium_set_qci(bp, qci_setting); + if (ret < 0) + return ret; + return count; +} +DEVICE_ATTR_RW(qci_setting); + +static ssize_t qav_setting_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct macb *bp = container_of(attr, struct macb, qci_setting_attr); + + return snprintf(buf, PAGE_SIZE, + "help:\n" + " queue: queue index to set cbs, support value:%d, %d\n" + " idleslop: same as tc-cbs, kilobit/sec\n" + " enable: 1: enable, 0: disable, default enable\n" + "example:\n" + " echo queue 7 idleslop 400000 > qav_setting\n" + " echo queue 6 idleslop 200000 > qav_setting\n" + " echo queue 7 enable 0 > qav_setting\n", + bp->num_queues - 2, bp->num_queues - 1); +} + +static int phytium_set_qav(struct macb *bp, struct tsn_setting_param *setting) +{ + int queue = setting[QAV_QUEUE].value; + int idle_slope, cbs_ctrl; + + if (queue != bp->num_queues - 1 && queue != bp->num_queues - 2) + return -EINVAL; + + cbs_ctrl = gem_readl(bp, CBS_CONTROL); + + if (!setting[QAV_ENABLE].value) { + cbs_ctrl &= (~BIT(bp->num_queues - 1 - queue)); + gem_writel(bp, CBS_CONTROL, cbs_ctrl); + return 0; + } + + if (setting[QAV_IDLESLOPE].value < 0 || + setting[QAV_IDLESLOPE].value > bp->speed * 1000 * 1000) { + pr_warn("idleslope invalid, please check it\n"); + return -EINVAL; + } + + /* calculate idle slope value, cbs->idleslope is kilobit/sec */ + /* reg value in bytes/sec for gigabit operation, and nibbles/sec */ + /* for 10/100 operation, and scaled by 2.5 in 2.5G operation */ + switch (bp->speed) { + case SPEED_10: + case SPEED_100: + idle_slope = 125 * setting[QAV_IDLESLOPE].value * 2; + break; + case SPEED_1000: + idle_slope = 125 * setting[QAV_IDLESLOPE].value; + break; + case SPEED_2500: + idle_slope = 125 * setting[QAV_IDLESLOPE].value * 2 / 5; + break; + default: + pr_info("macb speed %d not support\n", bp->speed); + return -EOPNOTSUPP; + } + + /* cbs should be disabled prior to updating the idle slope value */ + cbs_ctrl &= (~BIT(bp->num_queues - 1 - queue)); + gem_writel(bp, CBS_CONTROL, cbs_ctrl); + + if (queue == bp->num_queues - 1) + gem_writel(bp, CBS_IDLESLOPE_Q_A, idle_slope); + else + gem_writel(bp, CBS_IDLESLOPE_Q_B, idle_slope); + + /* after set idle slope, enable cbs */ + cbs_ctrl |= BIT(bp->num_queues - 1 - queue); + gem_writel(bp, CBS_CONTROL, cbs_ctrl); + + return 0; +} + +static ssize_t qav_setting_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t count) +{ + struct macb *bp = container_of(attr, struct macb, qav_setting_attr); + struct tsn_setting_param qav_setting[] = { + [QAV_QUEUE] = { .name = "queue", 0}, + [QAV_IDLESLOPE] = { .name = "idleslop", 0}, + [QAV_ENABLE] = { .name = "enable", 1}, + }; + int i, ret; + + for (i = 0; i < GET_SETTING_SIZE(qav_setting); i++) { + /* find setting name */ + char *tmp = strstr(buf, qav_setting[i].name); + char *end; + int recovery = 0; + + if (!tmp) + continue; + + tmp += strlen(qav_setting[i].name); + tmp = skip_spaces(tmp); + end = strpbrk(tmp, " "); + if (end) { + recovery = 1; + *end = '\0'; + } + /* kstrtol input string must be null-terminated */ + ret = kstrtol(tmp, 10, &qav_setting[i].value); + if (recovery) + *end = ' '; + + if (ret < 0) + return ret; + dev_dbg(dev, "get: %s=%ld\n", qav_setting[i].name, + qav_setting[i].value); + } + + ret = phytium_set_qav(bp, qav_setting); + if (ret < 0) + return ret; + + return count; +} +DEVICE_ATTR_RW(qav_setting); + +static ssize_t qbv_setting_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct macb *bp = container_of(attr, struct macb, qbv_setting_attr); + (void)bp; + return snprintf(buf, PAGE_SIZE, + "help:\n" + " input format: queue [queue_number] [start_time] \\\n" + " [on_time] [off_time]\n" + " queue_number: set qbv this queue\n" + " start_time:after this time, period start\n" + " on_time: gate open time\n" + " off_time: gate close time\n" + "example:\n" + " echo queue 3 0 125000 375000 \\\n" + " queue 2 125000 125000 375000 \\\n" + " queue 1 250000 250000 250000 > qbv_setting\n"); +} + +static ssize_t qbv_setting_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t count) +{ + struct queues_enst_setting setting[MACB_MAX_ENST_QUEUES] = {0}; + char *tmp = (char *)buf; + int ret; + + while ((tmp = strstr(tmp, "queue")) != NULL) { + long q, start_time, on_time, off_time; + char *next; + + tmp += strlen("queue"); + next = skip_spaces(tmp); + tmp = strsep(&next, " "); + if (!tmp) + return -EINVAL; + ret = kstrtol(tmp, 10, &q); + if (ret < 0 || q > MACB_MAX_ENST_QUEUES || q < 0) + return -EINVAL; + setting[q].enable = 1; + + tmp = strsep(&next, " "); + if (!tmp) + return -EINVAL; + ret = kstrtol(tmp, 10, &start_time); + if (ret < 0) + return -EINVAL; + setting[q].start_time = start_time; + + tmp = strsep(&next, " "); + if (!tmp) + return -EINVAL; + ret = kstrtol(tmp, 10, &on_time); + if (ret < 0 || on_time > 1048568 || on_time < 0) + return -EINVAL; + setting[q].on_time = on_time; + + tmp = strsep(&next, " "); + if (!tmp) + return -EINVAL; + ret = kstrtol(tmp, 10, &off_time); + if (ret < 0 || off_time > 1048568 || off_time < 0) + return -EINVAL; + setting[q].off_time = off_time; + + tmp = next; + if (!tmp) + break; + } + + _dump_enst_param(setting); + + ret = phytium_set_taprio(dev_get_drvdata(dev), setting); + if (ret) + return ret; + + return count; +} +DEVICE_ATTR_RW(qbv_setting); + +static void _create_tsn_sysfs_entries(struct device *dev, struct macb *bp) +{ + int ret; + + if (bp->tsn_cap & TSN_CAP_8021CB) { + bp->cb_setting_attr = dev_attr_cb_setting; + sysfs_attr_init(&bp->cb_setting_attr.attr); + ret = device_create_file(dev, &bp->cb_setting_attr); + if (ret < 0) + dev_warn(dev, "create cb_setting_attr failed %d", ret); + else + dev_dbg(dev, "create cb_setting_attr ok\n"); + } + + if (bp->tsn_cap & TSN_CAP_8021QCI) { + bp->qci_setting_attr = dev_attr_qci_setting; + sysfs_attr_init(&bp->qci_setting_attr.attr); + ret = device_create_file(dev, &bp->qci_setting_attr); + if (ret < 0) + dev_warn(dev, "create qci_setting_attr failed %d", ret); + else + dev_dbg(dev, "create qci_setting_attr ok\n"); + } + + if (bp->tsn_cap & TSN_CAP_8021QAV) { + bp->qav_setting_attr = dev_attr_qav_setting; + sysfs_attr_init(&bp->qav_setting_attr.attr); + ret = device_create_file(dev, &bp->qav_setting_attr); + if (ret < 0) + dev_warn(dev, "create qav_setting_attr failed %d", ret); + else + dev_dbg(dev, "create qav_setting_attr ok\n"); + } + + if (bp->tsn_cap & TSN_CAP_8021QBV) { + bp->qbv_setting_attr = dev_attr_qbv_setting; + sysfs_attr_init(&bp->qbv_setting_attr.attr); + ret = device_create_file(dev, &bp->qbv_setting_attr); + if (ret < 0) + dev_warn(dev, "create qbv_setting_attr failed %d", ret); + else + dev_dbg(dev, "create qbv_setting_attr ok\n"); + } + + if (bp->tsn_cap & (TSN_CAP_8021CB | TSN_CAP_8021QCI)) { + bp->stream_id_attr = dev_attr_stream_id; + sysfs_attr_init(&bp->stream_id_attr.attr); + ret = device_create_file(dev, &bp->stream_id_attr); + if (ret < 0) + dev_warn(dev, "create stream_id_attr failed %d", ret); + else + dev_dbg(dev, "create stream_id_attr ok\n"); + } +} + +void phytium_init_tsn(struct platform_device *pdev) +{ + struct net_device *dev = platform_get_drvdata(pdev); + struct macb *bp = netdev_priv(dev); + u32 cfg12; + + if (!device_property_read_bool(&pdev->dev, "support-tsn")) { + dev_dbg(&pdev->dev, "not support tsn, skip it"); + return; + } + pr_debug("%s %d\n", __func__, __LINE__); + + bp->tsn_cap = TSN_CAP_8021QAV | TSN_CAP_8021QBV | TSN_CAP_8021QCI; + dev->hw_features |= NETIF_F_HW_TC; + + cfg12 = gem_readl(bp, DCFG12); + if (cfg12 & GEM_BIT(HAS_CB)) { + bp->tsn_cap |= TSN_CAP_8021CB; + bp->num_cb_streams = GEM_BFEXT(NUM_CB_STREAMS, cfg12); + bp->cb_history_len = GEM_BFEXT(CB_HISTORY_LEN, cfg12); + } + _create_tsn_sysfs_entries(&pdev->dev, bp); +} + +void phytium_deinit_tsn(struct platform_device *pdev) +{ + struct net_device *dev = platform_get_drvdata(pdev); + struct macb *bp = netdev_priv(dev); + + if (!device_property_read_bool(&pdev->dev, "support-tsn")) { + dev_dbg(&pdev->dev, "not support tsn, skip it"); + return; + } + + if (bp->tsn_cap & TSN_CAP_8021CB) + device_remove_file(&pdev->dev, &bp->cb_setting_attr); + + if (bp->tsn_cap & TSN_CAP_8021QCI) + device_remove_file(&pdev->dev, &bp->qci_setting_attr); + + if (bp->tsn_cap & TSN_CAP_8021QAV) + device_remove_file(&pdev->dev, &bp->qav_setting_attr); + + if (bp->tsn_cap & TSN_CAP_8021QBV) + device_remove_file(&pdev->dev, &bp->qbv_setting_attr); + + if (bp->tsn_cap & (TSN_CAP_8021CB | TSN_CAP_8021QCI)) { + device_remove_file(&pdev->dev, &bp->stream_id_attr); + } +} + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/macb_tsn.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/macb_tsn.h new file mode 100644 index 0000000000000000000000000000000000000000..422a854eba351286ffb522e9335bb37d7fbcb9e8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/cadence/macb_tsn.h @@ -0,0 +1,149 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ +/* + * Phytium TSN support driver + * + * Copyright (c) 2024 Phytium Technology Co., Ltd. + */ +#ifndef _MACB_TSN_H +#define _MACB_TSN_H + +#define MACB_MAX_ENST_QUEUES 8 + +#define TSN_CAP_8021QAV 0x00000001 +#define TSN_CAP_8021QBV 0x00000002 +#define TSN_CAP_8021QCI 0x00000004 +#define TSN_CAP_8021CB 0x00000008 +#define TSN_CAP_8023BR 0x00000010 + +/* 802.1Qav */ +#define GEM_CBS_CONTROL 0x04BC +#define GEM_CBS_IDLESLOPE_Q_A 0x04C0 +#define GEM_CBS_IDLESLOPE_Q_B 0x04C4 + +/* 802.1Qbv */ +#define GEM_ENST_START_TIME 0x0800 +#define GEM_ENST_ON_TIME 0x0820 +#define GEM_ENST_OFF_TIME 0x0840 +#define GEM_ENST_CONTROL 0x0880 + +/* 802.1CB */ +/* Bitfields in DCFG12 */ +#define GEM_HAS_CB_OFFSET 16 +#define GEM_HAS_CB_SIZE 1 +#define GEM_CB_HISTORY_LEN_OFFSET 8 +#define GEM_CB_HISTORY_LEN_SIZE 8 +#define GEM_NUM_CB_STREAMS_OFFSET 0 +#define GEM_NUM_CB_STREAMS_SIZE 8 + +#define GEM_FRER_TIMEOUT 0x08A0 +#define GEM_FRER_RED_TAG 0x08A4 +#define GEM_FRER_CONTROL_1_A 0x08C0 +#define GEM_FRER_CONTROL_1_B 0x08C4 +#define GEM_FRER_STATISTICS_1_A 0x08C8 +#define GEM_FRER_STATISTICS_1_B 0x08CC + +/* Bitfields in FRER_RED_TAG */ +#define GEM_STRIP_R_TAG_OFFSET 31 +#define GEM_STRIP_R_TAG_SIZE 1 + +/* Bitfields in FRER_CONTROL_B */ +#define GEM_MEMBER_STREAM2_OFFSET 4 +#define GEM_MEMBER_STREAM2_SIZE 4 +#define GEM_MEMBER_STREAM1_OFFSET 0 +#define GEM_MEMBER_STREAM1_SIZE 4 + +/* Bitfields in FRER_CONTROL_B */ +#define GEM_SEQ_NUM_LENGTH_OFFSET 8 +#define GEM_SEQ_NUM_LENGTH_SIZE 5 +#define GEM_SEQ_REC_WINDOW_OFFSET 0 +#define GEM_SEQ_REC_WINDOW_SIZE 6 + +/* 802.1Qci */ +#define GEM_RX_Q0_FLUSH 0x0B00 +#define GEM_SCR2_REG0_RATE_LIMIT 0x0B40 +#define GEM_SCR2_RATE_STATUS 0x0B80 + +/* Bitfields in rx q0 flush */ +#define GEM_MAX_VAL_OFFSET 16 +#define GEM_MAX_VAL_SIZE 16 +#define GEM_LIMIT_FRAME_SIZE_OFFSET 3 +#define GEM_LIMIT_FRAME_SIZE_SIZE 1 + +/* Bitfields in scr2 reg0 rate limit */ +#define GEM_MAX_RATE_VAL_OFFSET 16 +#define GEM_MAX_RATE_VAL_SIZE 16 +#define GEM_INTERVAL_TIME_OFFSET 0 +#define GEM_INTERVAL_TIME_SIZE 16 + +/* type 2 compare registers + * each location requires 3 compare regs + */ +#define GEM_MAC_FIRST_CMP(idx) ((idx) * 3) +#define GEM_MAC_SECOND_CMP(idx) ((idx) * 3 + 1) +#define GEM_VLAN_ID_CMP(idx) ((idx) * 3 + 2) + +#undef TSN_DEBUG +//#define TSN_DEBUG +#ifdef TSN_DEBUG +#define _dump_param(param) pr_err("%s %ld\n", #param, (unsigned long)param) +#else +#define _dump_param(param) +#endif + +struct tsn_setting_param { + const char *name; + long value; +}; + +enum { + CB_INDEX, + CB_OFST, + CB_SEQ_LEN, + CB_HIS_LEN, + CB_STRIP_RTAG, + CB_ENABLE, +}; + +enum { + STREAM_ADD = 1, + STREAM_DEL, + STREAM_SHOW, +}; + +enum { + STREAM_INDEX, + STREAM_SRC_MAC, + STREAM_DST_MAC, + STREAM_SRC_IP, + STREAM_DST_IP, + STREAM_SRC_PORT, + STREAM_DST_PORT, + STREAM_TAGGED, + STREAM_VLAN_ID, + STREAM_RX_QUEUE, +}; + +enum { + QCI_INDEX, + QCI_MAX_SDU, + QCI_IPV, + QCI_INTERVAL, + QCI_MAX_RATE, + QCI_MARK_RED, +}; + +enum { + QAV_QUEUE, + QAV_IDLESLOPE, + QAV_ENABLE, +}; + +#define GET_SETTING_SIZE(setting) (sizeof(setting) / \ + sizeof(struct tsn_setting_param)) + +void phytium_init_tsn(struct platform_device *pdev); +void phytium_deinit_tsn(struct platform_device *pdev); +int phytium_setup_tc(struct net_device *ndev, + enum tc_setup_type type, void *type_data); + +#endif /* _MACB_TSN_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..66e8c9c99a96663940048402bea767a3d809cfa7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/Makefile @@ -0,0 +1 @@ +obj-y += stmmac/ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/stmmac/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/stmmac/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..f7a887acdd88b6d74981cbac01e94f4e98090745 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/stmmac/Kconfig @@ -0,0 +1,11 @@ +config DWMAC_PHYTIUM + tristate "Phytium dwmac support" + default ARCH_PHYTIUM + depends on (OF || ACPI) && (ARCH_PHYTIUM || COMPILE_TEST) + help + Support for GMAC controller on Phytium SoCs. + + This selects the Phytium GMAC glue layer support for the + stmmac device driver. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/stmmac/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/stmmac/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..b87bcab827abb728e9638fca50457c55920b94ff --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/stmmac/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_DWMAC_PHYTIUM) += dwmac-phytium.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c new file mode 100755 index 0000000000000000000000000000000000000000..0f4c6c22f8c5bd7f22df85830ce54d938e856393 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/ethernet/stmicro/stmmac/dwmac-phytium.c @@ -0,0 +1,221 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SWMAC specific glue layer + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include + +#include "../../../../../drivers/net/ethernet/stmicro/stmmac/stmmac.h" +#include "../../../../../drivers/net/ethernet/stmicro/stmmac/stmmac_platform.h" + +static int phytium_get_mac_mode(struct fwnode_handle *fwnode) +{ + const char *pm; + int err, i; + + err = fwnode_property_read_string(fwnode, "mac-mode", &pm); + if (err < 0) + return err; + + for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) { + if (!strcasecmp(pm, phy_modes(i))) + return i; + } + + return -ENODEV; +} + +static int phytium_dwmac_acpi_phy(struct plat_stmmacenet_data *plat, + struct fwnode_handle *np, struct device *dev) +{ + plat->mdio_bus_data = devm_kzalloc(dev, + sizeof(struct stmmac_mdio_bus_data), + GFP_KERNEL); + + if (!plat->mdio_bus_data) + return -ENOMEM; + + return 0; +} + +static int phytium_dwmac_probe(struct platform_device *pdev) +{ + struct fwnode_handle *fwnode = dev_fwnode(&pdev->dev); + struct plat_stmmacenet_data *plat; + struct stmmac_resources stmmac_res; + struct device_node *np = pdev->dev.of_node; + u64 clk_freq; + char clk_name[20]; + int ret; + + plat = devm_kzalloc(&pdev->dev, sizeof(*plat), GFP_KERNEL); + if (!plat) + return -ENOMEM; + + plat->dma_cfg = devm_kzalloc(&pdev->dev, sizeof(*plat->dma_cfg), GFP_KERNEL); + if (!plat->dma_cfg) + return -ENOMEM; + + plat->axi = devm_kzalloc(&pdev->dev, sizeof(*plat->axi), GFP_KERNEL); + if (!plat->axi) + return -ENOMEM; + + plat->phy_interface = device_get_phy_mode(&pdev->dev); + if (plat->phy_interface < 0) + return plat->phy_interface; + + plat->interface = phytium_get_mac_mode(fwnode); + if (plat->interface < 0) + plat->interface = plat->phy_interface; + + /* Configure PHY if using device-tree */ + if (pdev->dev.of_node) { + plat->phy_node = of_parse_phandle(np, "phy-handle", 0); + plat->phylink_node = np; + } + + if (pdev->dev.of_node) { + plat->bus_id = of_alias_get_id(np, "ethernet"); + if (plat->bus_id < 0) + plat->bus_id = 0; + } else if (fwnode_property_read_u32(fwnode, "bus_id", &plat->bus_id)) { + plat->bus_id = 2; + } + + plat->phy_addr = -1; + plat->clk_csr = -1; + plat->has_gmac = 1; + plat->enh_desc = 1; + plat->bugged_jumbo = 1; + plat->pmt = 1; + plat->force_sf_dma_mode = 1; + + if (fwnode_property_read_u32(fwnode, "max-speed", &plat->max_speed)) + plat->max_speed = -1; + + if (fwnode_property_read_u32(fwnode, "max-frame-size", &plat->maxmtu)) + plat->maxmtu = JUMBO_LEN; + + if (fwnode_property_read_u32(fwnode, "snps,multicast-filter-bins", + &plat->multicast_filter_bins)) + plat->multicast_filter_bins = HASH_TABLE_SIZE; + + if (fwnode_property_read_u32(fwnode, "snps,perfect-filter-entries", + &plat->unicast_filter_entries)) + plat->unicast_filter_entries = 1; + + if (fwnode_property_read_u32(fwnode, "tx-fifo-depth", &plat->tx_fifo_size)) + plat->tx_fifo_size = 0x1000; + + if (fwnode_property_read_u32(fwnode, "rx-fifo-depth", &plat->rx_fifo_size)) + plat->rx_fifo_size = 0x1000; + + if (phytium_dwmac_acpi_phy(plat, fwnode, &pdev->dev)) + return -ENODEV; + + plat->rx_queues_to_use = 1; + plat->tx_queues_to_use = 1; + plat->rx_queues_cfg[0].mode_to_use = MTL_QUEUE_DCB; + plat->tx_queues_cfg[0].mode_to_use = MTL_QUEUE_DCB; + + if (fwnode_property_read_u64(fwnode, "clock-frequency", &clk_freq)) + clk_freq = 125000000; + + /* Set system clock */ + snprintf(clk_name, sizeof(clk_name), "%s-%d", "stmmaceth", plat->bus_id); + + plat->stmmac_clk = clk_register_fixed_rate(&pdev->dev, clk_name, NULL, 0, clk_freq); + if (IS_ERR(plat->stmmac_clk)) { + dev_warn(&pdev->dev, "Fail to register stmmac-clk\n"); + plat->stmmac_clk = NULL; + } + + ret = clk_prepare_enable(plat->stmmac_clk); + if (ret) { + clk_unregister_fixed_rate(plat->stmmac_clk); + return ret; + } + + plat->clk_ptp_rate = clk_get_rate(plat->stmmac_clk); + plat->clk_ptp_ref = NULL; + + if (fwnode_property_read_u32(fwnode, "snps,pbl", &plat->dma_cfg->pbl)) + plat->dma_cfg->pbl = 16; + + fwnode_property_read_u32(fwnode, "snps,txpbl", &plat->dma_cfg->txpbl); + fwnode_property_read_u32(fwnode, "snps,rxpbl", &plat->dma_cfg->rxpbl); + + plat->dma_cfg->pblx8 = !fwnode_property_read_bool(fwnode, "snps,no-pbl-x8"); + plat->dma_cfg->aal = fwnode_property_read_bool(fwnode, "snps,aal"); + plat->dma_cfg->fixed_burst = fwnode_property_read_bool(fwnode, "snps,fixed-burst"); + plat->dma_cfg->mixed_burst = fwnode_property_read_bool(fwnode, "snps,mixed-burst"); + + plat->axi->axi_lpi_en = false; + plat->axi->axi_xit_frm = false; + plat->axi->axi_wr_osr_lmt = 7; + plat->axi->axi_rd_osr_lmt = 7; + plat->axi->axi_blen[0] = 16; + + memset(&stmmac_res, 0, sizeof(stmmac_res)); + stmmac_res.addr = devm_platform_ioremap_resource(pdev, 0); + stmmac_res.irq = platform_get_irq(pdev, 0); + if (stmmac_res.irq < 0) { + dev_err(&pdev->dev, "IRQ not found.\n"); + return -ENXIO; + } + stmmac_res.wol_irq = stmmac_res.irq; + stmmac_res.lpi_irq = -1; + + return stmmac_dvr_probe(&pdev->dev, plat, &stmmac_res); +} + +int phytium_dwmac_remove(struct platform_device *pdev) +{ + int ret; + struct net_device *ndev = platform_get_drvdata(pdev); + struct stmmac_priv *priv = netdev_priv(ndev); + struct plat_stmmacenet_data *plat = priv->plat; + + ret = stmmac_pltfr_remove(pdev); + clk_unregister_fixed_rate(plat->stmmac_clk); + return ret; +} + +#ifdef CONFIG_OF +static const struct of_device_id phytium_dwmac_of_match[] = { + { .compatible = "phytium,gmac" }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_dwmac_of_match); +#endif + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_dwmac_acpi_ids[] = { + { .id = "PHYT0004" }, + {} +}; +MODULE_DEVICE_TABLE(acpi, phytium_dwmac_acpi_ids); +#endif + +static struct platform_driver phytium_dwmac_driver = { + .probe = phytium_dwmac_probe, + .remove = phytium_dwmac_remove, + .driver = { + .name = "phytium-dwmac", + .pm = &stmmac_pltfr_pm_ops, + .of_match_table = of_match_ptr(phytium_dwmac_of_match), + .acpi_match_table = ACPI_PTR(phytium_dwmac_acpi_ids), + }, +}; +module_platform_driver(phytium_dwmac_driver); + +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium DWMAC specific glue layer"); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/phy/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/phy/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..2e83f9642cd8c4825919a1d0eb2835bed2875e1d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/phy/Kconfig @@ -0,0 +1,7 @@ +config MOTORCOMM_PHY + tristate "Motorcomm PHYs" + help + Enables support for Motorcomm network PHYs. + Currently supports the YT8511 gigabit PHY. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/phy/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/phy/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..cc43a4284088400827d2f8419419a892c8dbdee7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/phy/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_MOTORCOMM_PHY) += motorcomm.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/phy/motorcomm.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/phy/motorcomm.c new file mode 100755 index 0000000000000000000000000000000000000000..31a64698beba8bf124e87a88b8f35dd35c975c02 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/phy/motorcomm.c @@ -0,0 +1,2387 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * drivers/net/phy/motorcomm.c + * + * Driver for Motorcomm PHYs + * + * Author: yinghong.zhang + * + * Copyright (c) 2019 Motorcomm, 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. + * + * Support : Motorcomm Phys: + * Giga phys: yt8511, yt8521, yt8531, yt8614, yt8618 + * 100/10 Phys : yt8512, yt8512b, yt8510 + * Automotive 100Mb Phys : yt8010 + * Automotive 100/10 hyper range Phys: yt8510 + */ + +#include +#include +#include +#include +#include +#ifndef LINUX_VERSION_CODE +#include +#else +#define KERNEL_VERSION(a, b, c) (((a) << 16) + ((b) << 8) + (c)) +#endif + +/* for wol feature, 20210604 */ +#include + +#define YT_LINUX_MAJOR 2 +#define YT_LINUX_MINOR 2 +#define YT_LINUX_SUBVERSION 8661 +#define YT_LINUX_VERSIONID "2.2.8661" + +/******************************************** + **** configuration section begin ***********/ + +/* if system depends on ethernet packet to restore from sleep, + * please define this macro to 1 otherwise, define it to 0. + */ +#define SYS_WAKEUP_BASED_ON_ETH_PKT 0 + +/* to enable system WOL feature of phy, please define this macro to 1 + * otherwise, define it to 0. + */ +#define YTPHY_WOL_FEATURE_ENABLE 0 + +/* some GMAC need clock input from PHY, for eg., 125M, + * please enable this macro + * by degault, it is set to 0 + * NOTE: this macro will need macro SYS_WAKEUP_BASED_ON_ETH_PKT to set to 1 + */ +#define GMAC_CLOCK_INPUT_NEEDED 0 + +/* the max number of yt8521 chip on pcb board + * the most case is only 1 chip per board, but + * by default, we support up to 8. + */ +#define YTPHY_BOARD_MAX_NUM_OF_CHIP_8521 8 +#define YTPHY_BOARD_MAX_NUM_OF_CHIP_8614 4 + +/* for YT8531 package A xtal init config */ +#define YTPHY8531A_XTAL_INIT (0) + +/**** configuration section end *********** + ******************************************/ + +/* no need to change below */ +#define MOTORCOMM_PHY_ID_MASK 0x00000fff +#define MOTORCOMM_PHY_ID_8531_MASK 0xffffffff +#define MOTORCOMM_MPHY_ID_MASK 0x0000ffff +#define MOTORCOMM_MPHY_ID_MASK_8614 0xffffffff +#define MOTORCOMM_PHY_ID_MASK_8821 0xffffffff + +#define PHY_ID_YT8010 0x00000309 +#define PHY_ID_YT8010AS 0x4f51eb19 +#define PHY_ID_YT8510 0x00000109 +#define PHY_ID_YT8511 0x0000010a +#define PHY_ID_YT8512 0x00000118 +#define PHY_ID_YT8512B 0x00000128 +#define PHY_ID_YT8521 0x0000011a +#define PHY_ID_YT8531S 0x4f51e91a +#define PHY_ID_YT8531 0x4f51e91b +#define PHY_ID_YT8614 0x4F51E899 +#define PHY_ID_YT8618 0x0000e889 +#define PHY_ID_YT8821 0x4f51ea10 + +#define REG_PHY_SPEC_STATUS 0x11 +#define REG_DEBUG_ADDR_OFFSET 0x1e +#define REG_DEBUG_DATA 0x1f + +#define YT8512_EXTREG_LED0 0x40c0 +#define YT8512_EXTREG_LED1 0x40c3 + +#define YT8512_EXTREG_SLEEP_CONTROL1 0x2027 + +#define YT_SOFTWARE_RESET 0x8000 + +#define YT8512_LED0_ACT_BLK_IND 0x1000 +#define YT8512_LED0_DIS_LED_AN_TRY 0x0001 +#define YT8512_LED0_BT_BLK_EN 0x0002 +#define YT8512_LED0_HT_BLK_EN 0x0004 +#define YT8512_LED0_COL_BLK_EN 0x0008 +#define YT8512_LED0_BT_ON_EN 0x0010 +#define YT8512_LED1_BT_ON_EN 0x0010 +#define YT8512_LED1_TXACT_BLK_EN 0x0100 +#define YT8512_LED1_RXACT_BLK_EN 0x0200 +#define YT8512_SPEED_MODE 0xc000 +#define YT8512_DUPLEX 0x2000 + +#define YT8512_SPEED_MODE_BIT 14 +#define YT8512_DUPLEX_BIT 13 +#define YT8512_EN_SLEEP_SW_BIT 15 + +#define YT8521_EXTREG_SLEEP_CONTROL1 0x27 +#define YT8521_EN_SLEEP_SW_BIT 15 + +#define YT8521_SPEED_MODE 0xc000 +#define YT8521_DUPLEX 0x2000 +#define YT8521_SPEED_MODE_BIT 14 +#define YT8521_DUPLEX_BIT 13 +#define YT8521_LINK_STATUS_BIT 10 + +/* based on yt8521 wol feature config register */ +#define YTPHY_UTP_INTR_REG 0x12 +/* WOL Feature Event Interrupt Enable */ +#define YTPHY_WOL_FEATURE_INTR BIT(6) + +/* Magic Packet MAC address registers */ +#define YTPHY_WOL_FEATURE_MACADDR2_4_MAGIC_PACKET 0xa007 +#define YTPHY_WOL_FEATURE_MACADDR1_4_MAGIC_PACKET 0xa008 +#define YTPHY_WOL_FEATURE_MACADDR0_4_MAGIC_PACKET 0xa009 + +#define YTPHY_WOL_FEATURE_REG_CFG 0xa00a +#define YTPHY_WOL_FEATURE_TYPE_CFG BIT(0) /* WOL TYPE Config */ +#define YTPHY_WOL_FEATURE_ENABLE_CFG BIT(3) /* WOL Enable Config */ +#define YTPHY_WOL_FEATURE_INTR_SEL_CFG BIT(6) /* WOL Event Interrupt Enable Config */ +#define YTPHY_WOL_FEATURE_WIDTH1_CFG BIT(1) /* WOL Pulse Width Config */ +#define YTPHY_WOL_FEATURE_WIDTH2_CFG BIT(2) /* WOL Pulse Width Config */ + +#define YTPHY_REG_SPACE_UTP 0 +#define YTPHY_REG_SPACE_FIBER 2 + +enum ytphy_wol_feature_trigger_type_e { + YTPHY_WOL_FEATURE_PULSE_TRIGGER, + YTPHY_WOL_FEATURE_LEVEL_TRIGGER, + YTPHY_WOL_FEATURE_TRIGGER_TYPE_MAX +}; + +enum ytphy_wol_feature_pulse_width_e { + YTPHY_WOL_FEATURE_672MS_PULSE_WIDTH, + YTPHY_WOL_FEATURE_336MS_PULSE_WIDTH, + YTPHY_WOL_FEATURE_168MS_PULSE_WIDTH, + YTPHY_WOL_FEATURE_84MS_PULSE_WIDTH, + YTPHY_WOL_FEATURE_PULSE_WIDTH_MAX +}; + +struct ytphy_wol_feature_cfg { + bool enable; + int type; + int width; +}; + +#if (YTPHY_WOL_FEATURE_ENABLE) +#undef SYS_WAKEUP_BASED_ON_ETH_PKT +#define SYS_WAKEUP_BASED_ON_ETH_PKT 1 +#endif + +/* YT8521 polling mode */ +#define YT8521_PHY_MODE_FIBER 1 //fiber mode only +#define YT8521_PHY_MODE_UTP 2 //utp mode only +#define YT8521_PHY_MODE_POLL 3 //fiber and utp, poll mode + +/* below are for bitmap */ +#define YT_PHY_MODE_FIBER 1 //fiber/sgmii mode only +#define YT_PHY_MODE_UTP 2 //utp mode only +#define YT_PHY_MODE_QSGMII 4 //qsgmii mode only +#define YT_PHY_MODE_POLL (YT_PHY_MODE_FIBER | YT_PHY_MODE_UTP | YT_PHY_MODE_QSGMII) //qsgmii, fiber/sgmii and utp, poll mode + +/* support automatically check polling mode for yt8521 + * for Fiber only system, please define YT8521_PHY_MODE_CURR 1 + * for UTP only system, please define YT8521_PHY_MODE_CURR 2 + * for combo system, please define YT8521_PHY_MODE_CURR 3 + */ +#define YTPHY_861X_ABC_VER 0 +#if (YTPHY_861X_ABC_VER) +static int yt8614_get_port_from_phydev(struct phy_device *phydev); +#endif +static int yt8521_hw_strap_polling(struct phy_device *phydev); +static int yt8614_hw_strap_polling(struct phy_device *phydev); +#define YT8521_PHY_MODE_CURR yt8521_hw_strap_polling(phydev) +#define YT8614_PHY_MODE_CURR yt8614_hw_strap_polling(phydev) + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) +static int ytphy_config_init(struct phy_device *phydev) +{ + int val; + + val = phy_read(phydev, 3); + + return 0; +} +#endif + + +#if (KERNEL_VERSION(5, 5, 0) > LINUX_VERSION_CODE) +static inline void phy_lock_mdio_bus(struct phy_device *phydev) +{ +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + mutex_lock(&phydev->bus->mdio_lock); +#else + mutex_lock(&phydev->mdio.bus->mdio_lock); +#endif +} + +static inline void phy_unlock_mdio_bus(struct phy_device *phydev) +{ +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + mutex_unlock(&phydev->bus->mdio_lock); +#else + mutex_unlock(&phydev->mdio.bus->mdio_lock); +#endif +} +#endif + +#if (KERNEL_VERSION(4, 16, 0) > LINUX_VERSION_CODE) +static inline int __phy_read(struct phy_device *phydev, u32 regnum) +{ +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + struct mii_bus *bus = phydev->bus; + int addr = phydev->addr; + return bus->read(bus, phydev->addr, regnum); +#else + struct mii_bus *bus = phydev->mdio.bus; + int addr = phydev->mdio.addr; +#endif + return bus->read(bus, addr, regnum); +} + +static inline int __phy_write(struct phy_device *phydev, u32 regnum, u16 val) +{ +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + struct mii_bus *bus = phydev->bus; + int addr = phydev->addr; +#else + struct mii_bus *bus = phydev->mdio.bus; + int addr = phydev->mdio.addr; +#endif + return bus->write(bus, addr, regnum, val); +} +#endif + +static int ytphy_read_ext(struct phy_device *phydev, u32 regnum) +{ + int ret; + + phy_lock_mdio_bus(phydev); + ret = __phy_write(phydev, REG_DEBUG_ADDR_OFFSET, regnum); + if (ret < 0) + goto err_handle; + + ret = __phy_read(phydev, REG_DEBUG_DATA); + if (ret < 0) + goto err_handle; + +err_handle: + phy_unlock_mdio_bus(phydev); + return ret; +} + +static int ytphy_write_ext(struct phy_device *phydev, u32 regnum, u16 val) +{ + int ret; + + phy_lock_mdio_bus(phydev); + ret = __phy_write(phydev, REG_DEBUG_ADDR_OFFSET, regnum); + if (ret < 0) + goto err_handle; + + ret = __phy_write(phydev, REG_DEBUG_DATA, val); + if (ret < 0) + goto err_handle; + +err_handle: + phy_unlock_mdio_bus(phydev); + return ret; +} + +static int ytphy_soft_reset(struct phy_device *phydev) +{ + int ret = 0, val = 0; + + val = phy_read(phydev, MII_BMCR); + if (val < 0) + return val; + + ret = phy_write(phydev, MII_BMCR, val | BMCR_RESET); + if (ret < 0) + return ret; + + return ret; +} + + +#if (YTPHY8531A_XTAL_INIT) +static int yt8531a_xtal_init(struct phy_device *phydev) +{ + int ret = 0; + int val = 0; + bool state = false; + + msleep(50); + + do { + ret = ytphy_write_ext(phydev, 0xa012, 0x88); + if (ret < 0) + return ret; + + msleep(100); + + val = ytphy_read_ext(phydev, 0xa012); + if (val < 0) + return val; + + usleep_range(10000, 20000); + } while (val != 0x88); + + ret = ytphy_write_ext(phydev, 0xa012, 0xc8); + if (ret < 0) + return ret; + + return ret; +} +#endif + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else +int yt8010_soft_reset(struct phy_device *phydev) +{ + ytphy_soft_reset(phydev); + + return 0; +} + +int yt8010AS_soft_reset(struct phy_device *phydev) +{ + int ret = 0; + + /* sgmii */ + ytphy_write_ext(phydev, 0xe, 1); + ret = ytphy_soft_reset(phydev); + if (ret < 0) { + ytphy_write_ext(phydev, 0xe, 0); + return ret; + } + + /* utp */ + ytphy_write_ext(phydev, 0xe, 0); + ret = ytphy_soft_reset(phydev); + if (ret < 0) + return ret; + + return 0; +} +#endif + +#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) +int yt8010_aneg_done(struct phy_device *phydev) +{ + int val = 0; + + val = phy_read(phydev, 0x1); + val = phy_read(phydev, 0x1); + + return (val < 0) ? val : (val & BMSR_LSTATUS); +} +#endif + +static int yt8010_config_aneg(struct phy_device *phydev) +{ + phydev->speed = SPEED_100; + return 0; +} + +static int yt8010_read_status(struct phy_device *phydev) +{ + int ret = 0; + + ret = genphy_update_link(phydev); + if (ret) + return ret; + + /* for 8010, no definition mii reg 0x04, 0x11, here force 100/full */ + phydev->speed = SPEED_100; + phydev->duplex = DUPLEX_FULL; + + return 0; +} + +static int yt8010AS_config_init(struct phy_device *phydev) +{ + phydev->autoneg = AUTONEG_DISABLE; + + return 0; +} + +static int yt8512_led_init(struct phy_device *phydev) +{ + int ret; + int val; + int mask; + + val = ytphy_read_ext(phydev, YT8512_EXTREG_LED0); + if (val < 0) + return val; + + val |= YT8512_LED0_ACT_BLK_IND; + + mask = YT8512_LED0_DIS_LED_AN_TRY | YT8512_LED0_BT_BLK_EN | + YT8512_LED0_HT_BLK_EN | YT8512_LED0_COL_BLK_EN | + YT8512_LED0_BT_ON_EN; + val &= ~mask; + + ret = ytphy_write_ext(phydev, YT8512_EXTREG_LED0, val); + if (ret < 0) + return ret; + + val = ytphy_read_ext(phydev, YT8512_EXTREG_LED1); + if (val < 0) + return val; + + val |= YT8512_LED1_BT_ON_EN; + + mask = YT8512_LED1_TXACT_BLK_EN | YT8512_LED1_RXACT_BLK_EN; + val &= ~mask; + + ret = ytphy_write_ext(phydev, YT8512_EXTREG_LED1, val); + + return ret; +} + +static int yt8512_config_init(struct phy_device *phydev) +{ + int ret; + int val; + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + if (ret < 0) + return ret; + + ret = yt8512_led_init(phydev); + + /* disable auto sleep */ + val = ytphy_read_ext(phydev, YT8512_EXTREG_SLEEP_CONTROL1); + if (val < 0) + return val; + + val &= (~BIT(YT8512_EN_SLEEP_SW_BIT)); + + ret = ytphy_write_ext(phydev, YT8512_EXTREG_SLEEP_CONTROL1, val); + if (ret < 0) + return ret; + + return ret; +} + +static int yt8512_read_status(struct phy_device *phydev) +{ + int ret; + int val; + int speed, speed_mode, duplex; + + ret = genphy_update_link(phydev); + if (ret) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + duplex = (val & YT8512_DUPLEX) >> YT8512_DUPLEX_BIT; + speed_mode = (val & YT8512_SPEED_MODE) >> YT8512_SPEED_MODE_BIT; + switch (speed_mode) { + case 0: + speed = SPEED_10; + break; + case 1: + speed = SPEED_100; + break; + case 2: + case 3: + default: +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + speed = -1; +#else + speed = SPEED_UNKNOWN; +#endif + break; + } + + phydev->speed = speed; + phydev->duplex = duplex; + + return 0; +} + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else +int yt8521_soft_reset(struct phy_device *phydev) +{ + int ret, val; + + if (YT8521_PHY_MODE_CURR == YT8521_PHY_MODE_UTP) { + ytphy_write_ext(phydev, 0xa000, 0); + ytphy_soft_reset(phydev); + } + + if (YT8521_PHY_MODE_CURR == YT8521_PHY_MODE_FIBER) { + ytphy_write_ext(phydev, 0xa000, 2); + ytphy_soft_reset(phydev); + + ytphy_write_ext(phydev, 0xa000, 0); + } + + if (YT8521_PHY_MODE_CURR == YT8521_PHY_MODE_POLL) { + val = ytphy_read_ext(phydev, 0xa001); + ytphy_write_ext(phydev, 0xa001, (val & ~0x8000)); + + ytphy_write_ext(phydev, 0xa000, 0); + ret = ytphy_soft_reset(phydev); + } + + return 0; +} +#endif + +#if GMAC_CLOCK_INPUT_NEEDED +static int ytphy_mii_rd_ext(struct mii_bus *bus, int phy_id, u32 regnum) +{ + int ret; + int val; + + ret = bus->write(bus, phy_id, REG_DEBUG_ADDR_OFFSET, regnum); + if (ret < 0) + return ret; + + val = bus->read(bus, phy_id, REG_DEBUG_DATA); + + return val; +} + +static int ytphy_mii_wr_ext(struct mii_bus *bus + int phy_id, + u32 regnum, + u16 val) +{ + int ret; + + ret = bus->write(bus, phy_id, REG_DEBUG_ADDR_OFFSET, regnum); + if (ret < 0) + return ret; + + ret = bus->write(bus, phy_id, REG_DEBUG_DATA, val); + + return ret; +} + +int yt8511_config_dis_txdelay(struct mii_bus *bus, int phy_id) +{ + int ret; + int val; + + /* disable auto sleep */ + val = ytphy_mii_rd_ext(bus, phy_id, 0x27); + if (val < 0) + return val; + + val &= (~BIT(15)); + + ret = ytphy_mii_wr_ext(bus, phy_id, 0x27, val); + if (ret < 0) + return ret; + + /* enable RXC clock when no wire plug */ + val = ytphy_mii_rd_ext(bus, phy_id, 0xc); + if (val < 0) + return val; + + /* ext reg 0xc b[7:4] + * Tx Delay time = 150ps * N - 250ps + */ + val &= ~(0xf << 4); + ret = ytphy_mii_wr_ext(bus, phy_id, 0xc, val); + + return ret; +} + +int yt8511_config_out_125m(struct mii_bus *bus, int phy_id) +{ + int ret; + int val; + + /* disable auto sleep */ + val = ytphy_mii_rd_ext(bus, phy_id, 0x27); + if (val < 0) + return val; + + val &= (~BIT(15)); + + ret = ytphy_mii_wr_ext(bus, phy_id, 0x27, val); + if (ret < 0) + return ret; + + /* enable RXC clock when no wire plug */ + val = ytphy_mii_rd_ext(bus, phy_id, 0xc); + if (val < 0) + return val; + + /* ext reg 0xc.b[2:1] + * 00-----25M from pll; + * 01---- 25M from xtl;(default) + * 10-----62.5M from pll; + * 11----125M from pll(here set to this value) + */ + val |= (3 << 1); + ret = ytphy_mii_wr_ext(bus, phy_id, 0xc, val); + +#ifdef YT_8511_INIT_TO_MASTER + /* for customer, please enable it based on demand. + * configure to master + */ + + /* master/slave config reg*/ + val = bus->read(bus, phy_id, 0x9); + /* to be manual config and force to be master */ + val |= (0x3<<11); + /* take effect until phy soft reset */ + ret = bus->write(bus, phy_id, 0x9, val); + if (ret < 0) + return ret; +#endif + + return ret; +} + +static int yt8511_config_init(struct phy_device *phydev) +{ + int ret; + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s done, phy addr: %d\n", __func__, phydev->addr); +#else + netdev_info(phydev->attached_dev, "%s done, phy addr: %d\n", __func__, phydev->mdio.addr); +#endif + + return ret; +} +#endif /* GMAC_CLOCK_INPUT_NEEDED */ + +#if (YTPHY_WOL_FEATURE_ENABLE) +static int ytphy_switch_reg_space(struct phy_device *phydev, int space) +{ + int ret; + + if (space == YTPHY_REG_SPACE_UTP) + ret = ytphy_write_ext(phydev, 0xa000, 0); + else + ret = ytphy_write_ext(phydev, 0xa000, 2); + + return ret; +} + +static int ytphy_wol_feature_enable_cfg(struct phy_device *phydev, + struct ytphy_wol_feature_cfg wol_cfg) +{ + int ret = 0; + int val = 0; + + val = ytphy_read_ext(phydev, YTPHY_WOL_FEATURE_REG_CFG); + if (val < 0) + return val; + + if (wol_cfg.enable) { + val |= YTPHY_WOL_FEATURE_ENABLE_CFG; + + if (wol_cfg.type == YTPHY_WOL_FEATURE_LEVEL_TRIGGER) { + val &= ~YTPHY_WOL_FEATURE_TYPE_CFG; + val &= ~YTPHY_WOL_FEATURE_INTR_SEL_CFG; + } else if (wol_cfg.type == YTPHY_WOL_FEATURE_PULSE_TRIGGER) { + val |= YTPHY_WOL_FEATURE_TYPE_CFG; + val |= YTPHY_WOL_FEATURE_INTR_SEL_CFG; + + if (wol_cfg.width == YTPHY_WOL_FEATURE_84MS_PULSE_WIDTH) { + val &= ~YTPHY_WOL_FEATURE_WIDTH1_CFG; + val &= ~YTPHY_WOL_FEATURE_WIDTH2_CFG; + } else if (wol_cfg.width == YTPHY_WOL_FEATURE_168MS_PULSE_WIDTH) { + val |= YTPHY_WOL_FEATURE_WIDTH1_CFG; + val &= ~YTPHY_WOL_FEATURE_WIDTH2_CFG; + } else if (wol_cfg.width == YTPHY_WOL_FEATURE_336MS_PULSE_WIDTH) { + val &= ~YTPHY_WOL_FEATURE_WIDTH1_CFG; + val |= YTPHY_WOL_FEATURE_WIDTH2_CFG; + } else if (wol_cfg.width == YTPHY_WOL_FEATURE_672MS_PULSE_WIDTH) { + val |= YTPHY_WOL_FEATURE_WIDTH1_CFG; + val |= YTPHY_WOL_FEATURE_WIDTH2_CFG; + } + } + } else { + val &= ~YTPHY_WOL_FEATURE_ENABLE_CFG; + val &= ~YTPHY_WOL_FEATURE_INTR_SEL_CFG; + } + + ret = ytphy_write_ext(phydev, YTPHY_WOL_FEATURE_REG_CFG, val); + if (ret < 0) + return ret; + + return 0; +} + +static void ytphy_wol_feature_get(struct phy_device *phydev, + struct ethtool_wolinfo *wol) +{ + int val = 0; + + wol->supported = WAKE_MAGIC; + wol->wolopts = 0; + + val = ytphy_read_ext(phydev, YTPHY_WOL_FEATURE_REG_CFG); + if (val < 0) + return; + + if (val & YTPHY_WOL_FEATURE_ENABLE_CFG) + wol->wolopts |= WAKE_MAGIC; + + //return; +} + +static int ytphy_wol_feature_set(struct phy_device *phydev, + struct ethtool_wolinfo *wol) +{ + int ret, curr_reg_space, val; + struct ytphy_wol_feature_cfg wol_cfg; + struct net_device *p_attached_dev = phydev->attached_dev; + + memset(&wol_cfg, 0, sizeof(struct ytphy_wol_feature_cfg)); + curr_reg_space = ytphy_read_ext(phydev, 0xa000); + if (curr_reg_space < 0) + return curr_reg_space; + + /* Switch to phy UTP page */ + ret = ytphy_switch_reg_space(phydev, YTPHY_REG_SPACE_UTP); + if (ret < 0) + return ret; + + if (wol->wolopts & WAKE_MAGIC) { + /* Enable the WOL feature interrupt */ + val = phy_read(phydev, YTPHY_UTP_INTR_REG); + val |= YTPHY_WOL_FEATURE_INTR; + ret = phy_write(phydev, YTPHY_UTP_INTR_REG, val); + if (ret < 0) + return ret; + + /* Set the WOL feature config */ + wol_cfg.enable = true; + wol_cfg.type = YTPHY_WOL_FEATURE_PULSE_TRIGGER; + wol_cfg.width = YTPHY_WOL_FEATURE_672MS_PULSE_WIDTH; + ret = ytphy_wol_feature_enable_cfg(phydev, wol_cfg); + if (ret < 0) + return ret; + + /* Store the device address for the magic packet */ + ret = ytphy_write_ext(phydev, YTPHY_WOL_FEATURE_MACADDR2_4_MAGIC_PACKET, + ((p_attached_dev->dev_addr[0] << 8) | + p_attached_dev->dev_addr[1])); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, YTPHY_WOL_FEATURE_MACADDR1_4_MAGIC_PACKET, + ((p_attached_dev->dev_addr[2] << 8) | + p_attached_dev->dev_addr[3])); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, YTPHY_WOL_FEATURE_MACADDR0_4_MAGIC_PACKET, + ((p_attached_dev->dev_addr[4] << 8) | + p_attached_dev->dev_addr[5])); + if (ret < 0) + return ret; + } else { + wol_cfg.enable = false; + wol_cfg.type = YTPHY_WOL_FEATURE_TRIGGER_TYPE_MAX; + wol_cfg.width = YTPHY_WOL_FEATURE_PULSE_WIDTH_MAX; + ret = ytphy_wol_feature_enable_cfg(phydev, wol_cfg); + if (ret < 0) + return ret; + } + + /* Recover to previous register space page */ + ret = ytphy_switch_reg_space(phydev, curr_reg_space); + if (ret < 0) + return ret; + + return 0; +} +#endif /*(YTPHY_WOL_FEATURE_ENABLE)*/ + +static int yt8521_hw_strap_polling(struct phy_device *phydev) +{ + int val = 0; + + val = ytphy_read_ext(phydev, 0xa001) & 0x7; + switch (val) { + case 1: + case 4: + case 5: + return YT8521_PHY_MODE_FIBER; + case 2: + case 6: + case 7: + return YT8521_PHY_MODE_POLL; + case 3: + case 0: + default: + return YT8521_PHY_MODE_UTP; + } +} + + +static int yt8521_config_init(struct phy_device *phydev) +{ + int ret; + int val, hw_strap_mode; + +#if (YTPHY_WOL_FEATURE_ENABLE) + struct ethtool_wolinfo wol; + + /* set phy wol enable */ + memset(&wol, 0x0, sizeof(struct ethtool_wolinfo)); + wol.wolopts |= WAKE_MAGIC; + ytphy_wol_feature_set(phydev, &wol); +#endif + if (phydev->force_mode) { + hw_strap_mode = ytphy_read_ext(phydev, 0xa001) & 0x7; + hw_strap_mode = hw_strap_mode & 0x7ff8; + hw_strap_mode = hw_strap_mode |0x140; + ytphy_write_ext(phydev, 0xa001, hw_strap_mode); + } + + phydev->irq = PHY_POLL; + /* NOTE: this function should not be called more than one for each chip. */ + hw_strap_mode = ytphy_read_ext(phydev, 0xa001) & 0x7; + + ytphy_write_ext(phydev, 0xa000, 0); +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + if (ret < 0) + return ret; + + /* disable auto sleep */ + val = ytphy_read_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1); + if (val < 0) + return val; + + val &= (~BIT(YT8521_EN_SLEEP_SW_BIT)); + + ret = ytphy_write_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1, val); + if (ret < 0) + return ret; + + /* enable RXC clock when no wire plug */ + val = ytphy_read_ext(phydev, 0xc); + if (val < 0) + return val; + val &= ~(1 << 12); + ret = ytphy_write_ext(phydev, 0xc, val); + if (ret < 0) + return ret; + +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s done, phy addr: %d, strap mode = %d, polling mode = %d\n", + __func__, phydev->addr, hw_strap_mode, yt8521_hw_strap_polling(phydev)); +#else + netdev_info(phydev->attached_dev, "%s done, phy addr: %d, strap mode = %d, polling mode = %d\n", + __func__, phydev->mdio.addr, hw_strap_mode, yt8521_hw_strap_polling(phydev)); +#endif + return ret; +} + +/* for fiber mode, there is no 10M speed mode and + * this function is for this purpose. + */ +static int yt8521_adjust_status(struct phy_device *phydev, int val, int is_utp) +{ + int speed_mode, duplex; +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + int speed = -1; +#else + int speed = SPEED_UNKNOWN; +#endif + + if (is_utp) + duplex = (val & YT8512_DUPLEX) >> YT8521_DUPLEX_BIT; + else + duplex = 1; + speed_mode = (val & YT8521_SPEED_MODE) >> YT8521_SPEED_MODE_BIT; + switch (speed_mode) { + case 0: + if (is_utp) + speed = SPEED_10; + break; + case 1: + speed = SPEED_100; + break; + case 2: + speed = SPEED_1000; + break; + case 3: + break; + default: +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + speed = -1; +#else + speed = SPEED_UNKNOWN; +#endif + break; + } + + phydev->speed = speed; + phydev->duplex = duplex; + + return 0; +} + +/* for fiber mode, when speed is 100M, there is no definition for + * autonegotiation, and this function handles this case and return + * 1 per linux kernel's polling. + */ +int yt8521_aneg_done(struct phy_device *phydev) +{ + int link_fiber = 0, link_utp = 0; + + /* reading Fiber */ + ytphy_write_ext(phydev, 0xa000, 2); + link_fiber = !!(phy_read(phydev, REG_PHY_SPEC_STATUS) & (BIT(YT8521_LINK_STATUS_BIT))); + + /* reading UTP */ + ytphy_write_ext(phydev, 0xa000, 0); + if (!link_fiber) + link_utp = !!(phy_read(phydev, REG_PHY_SPEC_STATUS) & (BIT(YT8521_LINK_STATUS_BIT))); + +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link_fiber: %d, link_utp: %d\n", + __func__, phydev->addr, link_fiber, link_utp); +#else + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link_fiber: %d, link_utp: %d\n", + __func__, phydev->mdio.addr, link_fiber, link_utp); +#endif + return !!(link_fiber | link_utp); +} + +static int yt8521_read_status(struct phy_device *phydev) +{ + int ret; + int val; + int yt8521_fiber_latch_val; + int yt8521_fiber_curr_val; + int link; + int link_utp = 0, link_fiber = 0; + + if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) { + /* reading UTP */ + ret = ytphy_write_ext(phydev, 0xa000, 0); + if (ret < 0) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if (link) { + link_utp = 1; + yt8521_adjust_status(phydev, val, 1); + } else { + link_utp = 0; + } + } //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) + + if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) { + /* reading Fiber */ + ret = ytphy_write_ext(phydev, 0xa000, 2); + if (ret < 0) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + //note: below debug information is used to check multiple PHy ports. + + /* for fiber, from 1000m to 100m, there is not link down from 0x11, + * and check reg 1 to identify such case this is important for Linux + * kernel for that, missing linkdown event will cause problem. + */ + yt8521_fiber_latch_val = phy_read(phydev, MII_BMSR); + yt8521_fiber_curr_val = phy_read(phydev, MII_BMSR); + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if (link && yt8521_fiber_latch_val != yt8521_fiber_curr_val) { + link = 0; +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", + __func__, phydev->addr, yt8521_fiber_latch_val, yt8521_fiber_curr_val); +#else + netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", + __func__, phydev->mdio.addr, yt8521_fiber_latch_val, yt8521_fiber_curr_val); +#endif + } + + if (link) { + link_fiber = 1; + yt8521_adjust_status(phydev, val, 0); + } else { + link_fiber = 0; + } + } //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) + + if (link_utp || link_fiber) { + if (phydev->link == 0) +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media: %s, mii reg 0x11 = 0x%x\n", + __func__, phydev->addr, (link_utp && link_fiber) ? "UNKNOWN MEDIA" : (link_utp ? "UTP" : "Fiber"), (unsigned int)val); +#else + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media: %s, mii reg 0x11 = 0x%x\n", + __func__, phydev->mdio.addr, (link_utp && link_fiber) ? "UNKNOWN MEDIA" : (link_utp ? "UTP" : "Fiber"), (unsigned int)val); +#endif + phydev->link = 1; + } else { + if (phydev->link == 1) +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->addr); +#else + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->mdio.addr); +#endif + phydev->link = 0; + } + + if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) { //utp or combo + if (link_fiber) + ytphy_write_ext(phydev, 0xa000, 2); + if (link_utp) + ytphy_write_ext(phydev, 0xa000, 0); + } + return 0; +} + +int yt8521_suspend(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_lock(&phydev->lock); +#else + /* no need lock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 2); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 0); + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; +} + +int yt8521_resume(struct phy_device *phydev) +{ + int value, ret; + + /* disable auto sleep */ + value = ytphy_read_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1); + if (value < 0) + return value; + + value &= (~BIT(YT8521_EN_SLEEP_SW_BIT)); + + ret = ytphy_write_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1, value); + if (ret < 0) + return ret; + +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_lock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif + + /* power down both sds & phy in suspend, power up both too */ + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 2); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 0); + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; +} + +static int yt8531S_config_init(struct phy_device *phydev) +{ + int ret = 0; + +#if (YTPHY8531A_XTAL_INIT) + ret = yt8531a_xtal_init(phydev); + if (ret < 0) + return ret; +#endif + + ret = yt8521_config_init(phydev); + + return ret; +} + +static int yt8531_config_init(struct phy_device *phydev) +{ + int ret = 0; + +#if (YTPHY8531A_XTAL_INIT) + ret = yt8531a_xtal_init(phydev); + if (ret < 0) + return ret; +#endif + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + if (ret < 0) + return ret; + + return 0; +} + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else +int yt8618_soft_reset(struct phy_device *phydev) +{ + int ret; + + ytphy_write_ext(phydev, 0xa000, 0); + ret = ytphy_soft_reset(phydev); + if (ret < 0) + return ret; + + return 0; +} + +int yt8614_soft_reset(struct phy_device *phydev) +{ + int ret; + + /* qsgmii */ + ytphy_write_ext(phydev, 0xa000, 2); + ret = ytphy_soft_reset(phydev); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); + return ret; + } + + /* sgmii */ + ytphy_write_ext(phydev, 0xa000, 3); + ret = ytphy_soft_reset(phydev); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); + return ret; + } + + /* utp */ + ytphy_write_ext(phydev, 0xa000, 0); + ret = ytphy_soft_reset(phydev); + if (ret < 0) + return ret; + + return 0; +} +#endif + +static int yt8618_config_init(struct phy_device *phydev) +{ + int ret; + int val; + unsigned int retries = 12; +#if (YTPHY_861X_ABC_VER) + int port = 0; +#endif + + phydev->irq = PHY_POLL; + +#if (YTPHY_861X_ABC_VER) + port = yt8614_get_port_from_phydev(phydev); +#endif + + ytphy_write_ext(phydev, 0xa000, 0); +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + if (ret < 0) + return ret; + + /* for utp to optimize signal */ + ret = ytphy_write_ext(phydev, 0x41, 0x33); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x42, 0x66); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x43, 0xaa); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x44, 0xd0d); + if (ret < 0) + return ret; + +#if (YTPHY_861X_ABC_VER) + if ((port == 2) || (port == 5)) { + ret = ytphy_write_ext(phydev, 0x57, 0x2929); + if (ret < 0) + return ret; + } +#endif + + val = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, val | BMCR_RESET); + do { + msleep(50); + ret = phy_read(phydev, MII_BMCR); + if (ret < 0) + return ret; + } while ((ret & BMCR_RESET) && --retries); + if (ret & BMCR_RESET) + return -ETIMEDOUT; + + /* for QSGMII optimization */ + ytphy_write_ext(phydev, 0xa000, 0x02); + + ret = ytphy_write_ext(phydev, 0x3, 0x4F80); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); + return ret; + } + ret = ytphy_write_ext(phydev, 0xe, 0x4F80); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); + return ret; + } + + ytphy_write_ext(phydev, 0xa000, 0); + +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s done, phy addr: %d\n", __func__, phydev->addr); +#else + netdev_info(phydev->attached_dev, "%s done, phy addr: %d\n", __func__, phydev->mdio.addr); +#endif + return ret; +} + +static int yt8614_hw_strap_polling(struct phy_device *phydev) +{ + int val = 0; + + val = ytphy_read_ext(phydev, 0xa007) & 0xf; + switch (val) { + case 8: //4'b1000, Fiber x4 + Copper x4 + case 12: //4'b1100, QSGMII x1 + Combo x4 mode; + case 13: //4'b1101, QSGMII x1 + Combo x4 mode; + return (YT_PHY_MODE_FIBER | YT_PHY_MODE_UTP); + case 14: //4'b1110, QSGMII x1 + SGMII(MAC) x4 mode; + case 11: //4'b1011, QSGMII x1 + Fiber x4 mode; + return YT_PHY_MODE_FIBER; + case 9: //4'b1001, Reserved. + case 10: //4'b1010, QSGMII x1 + Copper x4 mode + case 15: //4'b1111, SGMII(PHY) x4 + Copper x4 mode + default: + return YT_PHY_MODE_UTP; + } +} + +#if (YTPHY_861X_ABC_VER) +static int yt8614_get_port_from_phydev(struct phy_device *phydev) +{ + int tmp = ytphy_read_ext(phydev, 0xa0ff); + int phy_addr = 0; + +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + phy_addr = (unsigned int)phydev->addr; +#else + phy_addr = (unsigned int)phydev->mdio.addr; +#endif + + if ((phy_addr - tmp) < 0) { + ytphy_write_ext(phydev, 0xa0ff, phy_addr); + tmp = phy_addr; + } + + return (phy_addr - tmp); +} +#endif + +static int yt8614_config_init(struct phy_device *phydev) +{ + int ret = 0; + int val, hw_strap_mode; + unsigned int retries = 12; +#if (YTPHY_861X_ABC_VER) + int port = 0; +#endif + phydev->irq = PHY_POLL; + + /* NOTE: this function should not be called more than one for each chip. */ + hw_strap_mode = ytphy_read_ext(phydev, 0xa007) & 0xf; + +#if (YTPHY_861X_ABC_VER) + port = yt8614_get_port_from_phydev(phydev); +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + if (ret < 0) + return ret; + + /* for utp to optimize signal */ + ret = ytphy_write_ext(phydev, 0x41, 0x33); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x42, 0x66); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x43, 0xaa); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x44, 0xd0d); + if (ret < 0) + return ret; + +#if (YTPHY_861X_ABC_VER) + if (port == 2) { + ret = ytphy_write_ext(phydev, 0x57, 0x2929); + if (ret < 0) + return ret; + } +#endif + + /* soft reset to take config effect */ + val = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, val | BMCR_RESET); + do { + msleep(50); + ret = phy_read(phydev, MII_BMCR); + if (ret < 0) + return ret; + } while ((ret & BMCR_RESET) && --retries); + if (ret & BMCR_RESET) + return -ETIMEDOUT; + + /* for QSGMII optimization */ + ytphy_write_ext(phydev, 0xa000, 0x02); + ret = ytphy_write_ext(phydev, 0x3, 0x4F80); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); + return ret; + } + ret = ytphy_write_ext(phydev, 0xe, 0x4F80); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); + return ret; + } + + /* for SGMII optimization */ + ytphy_write_ext(phydev, 0xa000, 0x03); + ret = ytphy_write_ext(phydev, 0x3, 0x2420); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); + return ret; + } + ret = ytphy_write_ext(phydev, 0xe, 0x24a0); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); + return ret; + } + + /* back up to utp*/ + ytphy_write_ext(phydev, 0xa000, 0); + +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s done, phy addr: %d, chip mode: %d\n", __func__, phydev->addr, hw_strap_mode); +#else + netdev_info(phydev->attached_dev, "%s done, phy addr: %d, chip mode: %d\n", __func__, phydev->mdio.addr, hw_strap_mode); +#endif + return ret; +} + +int yt8618_aneg_done(struct phy_device *phydev) +{ +#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) + return genphy_aneg_done(phydev); +#else + return 1; +#endif +} + +int yt8614_aneg_done(struct phy_device *phydev) +{ + int link_fiber = 0, link_utp = 0; + + if (YT8614_PHY_MODE_CURR & YT_PHY_MODE_FIBER) { + /* reading Fiber */ + ytphy_write_ext(phydev, 0xa000, 3); + link_fiber = !!(phy_read(phydev, REG_PHY_SPEC_STATUS) & (BIT(YT8521_LINK_STATUS_BIT))); + } + + if (YT8614_PHY_MODE_CURR & YT_PHY_MODE_UTP) { + /* reading UTP */ + ytphy_write_ext(phydev, 0xa000, 0); + link_utp = !!(phy_read(phydev, REG_PHY_SPEC_STATUS) & (BIT(YT8521_LINK_STATUS_BIT))); + } + + return !!(link_fiber | link_utp); +} + +static int yt8614_read_status(struct phy_device *phydev) +{ + int ret; + int val, yt8614_fiber_latch_val, yt8614_fiber_curr_val; + int link; + int link_utp = 0, link_fiber = 0; + + if (YT8614_PHY_MODE_CURR & YT_PHY_MODE_UTP) { + /* switch to utp and reading regs */ + ret = ytphy_write_ext(phydev, 0xa000, 0); + if (ret < 0) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if (link) { + link_utp = 1; + // here is same as 8521 and re-use the function; + yt8521_adjust_status(phydev, val, 1); + } else { + link_utp = 0; + } + } + + if (YT8614_PHY_MODE_CURR & YT_PHY_MODE_FIBER) { + /* reading Fiber/sgmii */ + ret = ytphy_write_ext(phydev, 0xa000, 3); + if (ret < 0) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + /* for fiber, from 1000m to 100m, there is not link down from 0x11, + * and check reg 1 to identify such case + */ + yt8614_fiber_latch_val = phy_read(phydev, MII_BMSR); + yt8614_fiber_curr_val = phy_read(phydev, MII_BMSR); + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if (link && yt8614_fiber_latch_val != yt8614_fiber_curr_val) { + link = 0; +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", + __func__, phydev->addr, yt8614_fiber_latch_val, yt8614_fiber_curr_val); +#else + netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", + __func__, phydev->mdio.addr, yt8614_fiber_latch_val, yt8614_fiber_curr_val); +#endif + } + + if (link) { + link_fiber = 1; + yt8521_adjust_status(phydev, val, 0); + } else { + link_fiber = 0; + } + } + + if (link_utp || link_fiber) { + if (phydev->link == 0) +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media %s\n", + __func__, phydev->addr, (link_utp && link_fiber) ? "both UTP and Fiber" : (link_utp ? "UTP" : "Fiber")); +#else + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media %s\n", + __func__, phydev->mdio.addr, (link_utp && link_fiber) ? "both UTP and Fiber" : (link_utp ? "UTP" : "Fiber")); +#endif + phydev->link = 1; + } else { + if (phydev->link == 1) +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->addr); +#else + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->mdio.addr); +#endif + phydev->link = 0; + } + + if (YT8614_PHY_MODE_CURR & YT_PHY_MODE_UTP) { + if (link_utp) + ytphy_write_ext(phydev, 0xa000, 0); + } + return 0; +} + +static int yt8618_read_status(struct phy_device *phydev) +{ + int ret; + /* maybe for 8614 yt8521_fiber_latch_val, yt8521_fiber_curr_val; */ + int val; + int link; + int link_utp = 0, link_fiber = 0; + + /* switch to utp and reading regs */ + ret = ytphy_write_ext(phydev, 0xa000, 0); + if (ret < 0) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if (link) { + link_utp = 1; + yt8521_adjust_status(phydev, val, 1); + } else { + link_utp = 0; + } + + if (link_utp || link_fiber) + phydev->link = 1; + else + phydev->link = 0; + + return 0; +} + +int yt8618_suspend(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_lock(&phydev->lock); +#else + /* no need lock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; +} + +int yt8618_resume(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_lock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; +} + +int yt8614_suspend(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_lock(&phydev->lock); +#else + /* no need lock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 3); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 0); + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; +} + +int yt8614_resume(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_lock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 3); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 0); + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /* !(SYS_WAKEUP_BASED_ON_ETH_PKT) */ + + return 0; +} + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else +int yt8821_soft_reset(struct phy_device *phydev) +{ + int ret, val; + + val = ytphy_read_ext(phydev, 0xa001); + ytphy_write_ext(phydev, 0xa001, (val & ~0x8000)); + + ytphy_write_ext(phydev, 0xa000, 0); + ret = ytphy_soft_reset(phydev); + + return ret; +} +#endif + +static int yt8821_init(struct phy_device *phydev) +{ + int ret = 0; + int val = 0; + + /* sds pll cfg */ + ret = ytphy_write_ext(phydev, 0xa050, 0x1000); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0xa000, 0x2); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x23, 0x47a1); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0xbd, 0x3547); + if (ret < 0) + return ret; + + /* wait 1s */ + msleep(1000); + + /* calibration dcc */ + ret = ytphy_write_ext(phydev, 0xbd, 0xa547); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x29, 0x3003); + if (ret < 0) + return ret; + + /* sds driver swing */ + ret = ytphy_write_ext(phydev, 0x25, 0x788); + if (ret < 0) + return ret; + + /* phy cfg */ + ret = ytphy_write_ext(phydev, 0xa000, 0x0); + if (ret < 0) + return ret; + + /* phy template cfg */ + ret = ytphy_write_ext(phydev, 0x471, 0x4545); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x476, 0x4848); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x477, 0x4848); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x478, 0x4848); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x479, 0x4848); + if (ret < 0) + return ret; + + /* calibrate phy lc pll */ + ret = ytphy_write_ext(phydev, 0x600, 0x2300); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x8, 0x8041); + if (ret < 0) + return ret; + + /* prm_small_lng/med */ + ret = ytphy_write_ext(phydev, 0x388, 0x90); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x387, 0x90); + if (ret < 0) + return ret; + + /* echo_delay_cfg */ + ret = ytphy_write_ext(phydev, 0x3, 0xa026); + if (ret < 0) + return ret; + + /* pbo setting */ + ret = ytphy_write_ext(phydev, 0x47e, 0x3535); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x47f, 0x3535); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x480, 0x3535); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x481, 0x3535); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x483, 0x2a2a); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x484, 0x2a2a); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x485, 0x2a2a); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x486, 0x2a2a); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x488, 0x2121); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x489, 0x2121); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x48a, 0x2121); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x48b, 0x2121); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x48d, 0x1a1a); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x48e, 0x1a1a); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x48f, 0x1a1a); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x490, 0x1a1a); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x492, 0x1515); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x493, 0x1515); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x494, 0x1515); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x495, 0x1515); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x497, 0x1111); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x498, 0x1111); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x499, 0x1111); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x49a, 0x1111); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x49c, 0x0d0d); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x49d, 0x0d0d); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x49e, 0x0d0d); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x49f, 0x0d0d); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0xa052, 0x7); + if (ret < 0) + return ret; + + /* fast link down cfg */ + ret = ytphy_write_ext(phydev, 0x355, 0x7d07); + if (ret < 0) + return ret; + + /* soft reset */ + val = phy_read(phydev, MII_BMCR); + if (val < 0) + return val; + ret = phy_write(phydev, MII_BMCR, val | BMCR_RESET); + + return ret; +} + +static int yt8821_config_init(struct phy_device *phydev) +{ + int ret; + int val, hw_strap_mode; + + phydev->irq = PHY_POLL; + + /* NOTE: this function should not be called more than one for each chip. */ + hw_strap_mode = ytphy_read_ext(phydev, 0xa001) & 0x7; + + ytphy_write_ext(phydev, 0xa000, 0); +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + if (ret < 0) + return ret; + + ret = yt8821_init(phydev); + if (ret < 0) + return ret; + + /* disable auto sleep */ + val = ytphy_read_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1); + if (val < 0) + return val; + + val &= (~BIT(YT8521_EN_SLEEP_SW_BIT)); + + ret = ytphy_write_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1, val); + if (ret < 0) + return ret; + +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s done, phy addr: %d, strap mode = %d\n", __func__, phydev->addr, hw_strap_mode); +#else + netdev_info(phydev->attached_dev, "%s done, phy addr: %d, strap mode = %d\n", __func__, phydev->mdio.addr, hw_strap_mode); +#endif + + return ret; +} + +/* for fiber mode, there is no 10M speed mode and + * this function is for this purpose. + */ +static int yt8821_adjust_status(struct phy_device *phydev, int val, int is_utp) +{ + int speed_mode, duplex; + int speed_mode_bit15_14, speed_mode_bit9; +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + int speed = -1; +#else + int speed = SPEED_UNKNOWN; +#endif + + if (is_utp) + duplex = (val & YT8512_DUPLEX) >> YT8521_DUPLEX_BIT; + else + duplex = 1; + + /* Bit9-Bit15-Bit14 speed mode 100---2.5G; 010---1000M; 001---100M; 000---10M */ + speed_mode_bit15_14 = (val & YT8521_SPEED_MODE) >> YT8521_SPEED_MODE_BIT; + speed_mode_bit9 = (val & BIT(9)) >> 9; + speed_mode = (speed_mode_bit9 << 2) | speed_mode_bit15_14; + switch (speed_mode) { + case 0: + if (is_utp) + speed = SPEED_10; + break; + case 1: + speed = SPEED_100; + break; + case 2: + speed = SPEED_1000; + break; + case 4: + speed = SPEED_2500; + break; + default: +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) + speed = -1; +#else + speed = SPEED_UNKNOWN; +#endif + break; + } + + phydev->speed = speed; + phydev->duplex = duplex; + + return 0; +} + +static int yt8821_read_status(struct phy_device *phydev) +{ + int ret; + int val; + int yt8521_fiber_latch_val; + int yt8521_fiber_curr_val; + int link; + int link_utp = 0, link_fiber = 0; + + if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) { + /* reading UTP */ + ret = ytphy_write_ext(phydev, 0xa000, 0); + if (ret < 0) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if (link) { + link_utp = 1; + yt8821_adjust_status(phydev, val, 1); /* speed(2500), duplex */ + } else { + link_utp = 0; + } + } //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) + + if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) { + /* reading Fiber */ + ret = ytphy_write_ext(phydev, 0xa000, 2); + if (ret < 0) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + //note: below debug information is used to check multiple PHy ports. + + /* for fiber, from 1000m to 100m, there is not link down from 0x11, + * and check reg 1 to identify such case this is important for Linux + * kernel for that, missing linkdown event will cause problem. + */ + yt8521_fiber_latch_val = phy_read(phydev, MII_BMSR); + yt8521_fiber_curr_val = phy_read(phydev, MII_BMSR); + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if (link && yt8521_fiber_latch_val != yt8521_fiber_curr_val) { + link = 0; +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", + __func__, phydev->addr, yt8521_fiber_latch_val, yt8521_fiber_curr_val); +#else + netdev_info(phydev->attached_dev, "%s, phy addr: %d, fiber link down detect, latch = %04x, curr = %04x\n", + __func__, phydev->mdio.addr, yt8521_fiber_latch_val, yt8521_fiber_curr_val); +#endif + } + + if (link) { + link_fiber = 1; + yt8821_adjust_status(phydev, val, 0); + } else { + link_fiber = 0; + } + } //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) + + if (link_utp || link_fiber) { + if (phydev->link == 0) +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media: %s, mii reg 0x11 = 0x%x\n", + __func__, phydev->addr, (link_utp && link_fiber) ? "UNKNOWN MEDIA" : (link_utp ? "UTP" : "Fiber"), (unsigned int)val); +#else + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link up, media: %s, mii reg 0x11 = 0x%x\n", + __func__, phydev->mdio.addr, (link_utp && link_fiber) ? "UNKNOWN MEDIA" : (link_utp ? "UTP" : "Fiber"), (unsigned int)val); +#endif + phydev->link = 1; + } else { + if (phydev->link == 1) +#if (KERNEL_VERSION(4, 5, 0) > LINUX_VERSION_CODE) + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->addr); +#else + netdev_info(phydev->attached_dev, "%s, phy addr: %d, link down\n", __func__, phydev->mdio.addr); +#endif + + phydev->link = 0; + } + + if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) { + if (link_fiber) + ytphy_write_ext(phydev, 0xa000, 2); + if (link_utp) + ytphy_write_ext(phydev, 0xa000, 0); + } + return 0; +} + +#if (KERNEL_VERSION(5, 1, 21) < LINUX_VERSION_CODE) +static int yt8821_get_features(struct phy_device *phydev) +{ + linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->supported, 1); + return genphy_read_abilities(phydev); +} +#endif + +static struct phy_driver ytphy_drvs[] = { + { + .phy_id = PHY_ID_YT8010, + .name = "YT8010 Automotive Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, + .features = PHY_BASIC_FEATURES, + .flags = PHY_POLL, +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else + .soft_reset = yt8010_soft_reset, +#endif + .config_aneg = yt8010_config_aneg, +#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) + .aneg_done = yt8010_aneg_done, +#endif +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) + .config_init = ytphy_config_init, +#else + .config_init = genphy_config_init, +#endif + .read_status = yt8010_read_status, + }, { + .phy_id = PHY_ID_YT8010AS, + .name = "YT8010AS Automotive Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, + .features = PHY_BASIC_FEATURES, + .flags = PHY_POLL, +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else + .soft_reset = yt8010AS_soft_reset, +#endif +#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) + .aneg_done = yt8010_aneg_done, +#endif + .config_init = yt8010AS_config_init, + .read_status = yt8010_read_status, + }, { + .phy_id = PHY_ID_YT8510, + .name = "YT8510 100/10Mb Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, + .features = PHY_BASIC_FEATURES, + .flags = PHY_POLL, + .config_aneg = genphy_config_aneg, +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) + .config_init = ytphy_config_init, +#else + .config_init = genphy_config_init, +#endif + .read_status = genphy_read_status, + }, { + .phy_id = PHY_ID_YT8511, + .name = "YT8511 Gigabit Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, + .features = PHY_GBIT_FEATURES, + .flags = PHY_POLL, + .config_aneg = genphy_config_aneg, +#if GMAC_CLOCK_INPUT_NEEDED + .config_init = yt8511_config_init, +#else +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) || (KERNEL_VERSION(5, 3, 0) < LINUX_VERSION_CODE) + .config_init = ytphy_config_init, +#else + .config_init = genphy_config_init, +#endif +#endif + .read_status = genphy_read_status, + .suspend = genphy_suspend, + .resume = genphy_resume, + }, { + .phy_id = PHY_ID_YT8512, + .name = "YT8512 Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, + .features = PHY_BASIC_FEATURES, + .flags = PHY_POLL, + .config_aneg = genphy_config_aneg, + .config_init = yt8512_config_init, + .read_status = yt8512_read_status, + .suspend = genphy_suspend, + .resume = genphy_resume, + }, { + .phy_id = PHY_ID_YT8512B, + .name = "YT8512B Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, + .features = PHY_BASIC_FEATURES, + .flags = PHY_POLL, + .config_aneg = genphy_config_aneg, + .config_init = yt8512_config_init, + .read_status = yt8512_read_status, + .suspend = genphy_suspend, + .resume = genphy_resume, + }, { + .phy_id = PHY_ID_YT8521, + .name = "YT8521 Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, + .features = PHY_GBIT_FEATURES, + .flags = PHY_POLL, +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else + .soft_reset = yt8521_soft_reset, +#endif + .config_aneg = genphy_config_aneg, +#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) + .aneg_done = yt8521_aneg_done, +#endif + .config_init = yt8521_config_init, + .read_status = yt8521_read_status, + .suspend = yt8521_suspend, + .resume = yt8521_resume, +#if (YTPHY_WOL_FEATURE_ENABLE) + .get_wol = &ytphy_wol_feature_get, + .set_wol = &ytphy_wol_feature_set, +#endif + }, { + /* same as 8521 */ + .phy_id = PHY_ID_YT8531S, + .name = "YT8531S Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, + .features = PHY_GBIT_FEATURES, + .flags = PHY_POLL, +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else + .soft_reset = yt8521_soft_reset, +#endif + .config_aneg = genphy_config_aneg, +#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) + .aneg_done = yt8521_aneg_done, +#endif + .config_init = yt8531S_config_init, + .read_status = yt8521_read_status, + .suspend = yt8521_suspend, + .resume = yt8521_resume, +#if (YTPHY_WOL_FEATURE_ENABLE) + .get_wol = &ytphy_wol_feature_get, + .set_wol = &ytphy_wol_feature_set, +#endif + }, { + /* same as 8511 */ + .phy_id = PHY_ID_YT8531, + .name = "YT8531 Gigabit Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, + .features = PHY_GBIT_FEATURES, + .flags = PHY_POLL, + .config_aneg = genphy_config_aneg, + + .config_init = yt8531_config_init, + .read_status = genphy_read_status, + .suspend = genphy_suspend, + .resume = genphy_resume, +#if (YTPHY_WOL_FEATURE_ENABLE) + .get_wol = &ytphy_wol_feature_get, + .set_wol = &ytphy_wol_feature_set, +#endif + }, { + .phy_id = PHY_ID_YT8618, + .name = "YT8618 Ethernet", + .phy_id_mask = MOTORCOMM_MPHY_ID_MASK, + .features = PHY_GBIT_FEATURES, + .flags = PHY_POLL, +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else + .soft_reset = yt8618_soft_reset, +#endif + .config_aneg = genphy_config_aneg, +#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) + .aneg_done = yt8618_aneg_done, +#endif + .config_init = yt8618_config_init, + .read_status = yt8618_read_status, + .suspend = yt8618_suspend, + .resume = yt8618_resume, + }, + { + .phy_id = PHY_ID_YT8614, + .name = "YT8614 Ethernet", + .phy_id_mask = MOTORCOMM_MPHY_ID_MASK_8614, + .features = PHY_GBIT_FEATURES, + .flags = PHY_POLL, +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else + .soft_reset = yt8614_soft_reset, +#endif + .config_aneg = genphy_config_aneg, +#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) + .aneg_done = yt8614_aneg_done, +#endif + .config_init = yt8614_config_init, + .read_status = yt8614_read_status, + .suspend = yt8614_suspend, + .resume = yt8614_resume, + }, + { + .phy_id = PHY_ID_YT8821, + .name = "YT8821 2.5Gb Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK_8821, +#if (KERNEL_VERSION(5, 2, 0) > LINUX_VERSION_CODE) + .features = PHY_GBIT_FEATURES, +#endif + .flags = PHY_POLL, +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +#else + .soft_reset = yt8821_soft_reset, +#endif + .config_aneg = genphy_config_aneg, +#if (KERNEL_VERSION(3, 14, 79) < LINUX_VERSION_CODE) + .aneg_done = yt8521_aneg_done, +#endif +#if (KERNEL_VERSION(5, 1, 21) < LINUX_VERSION_CODE) + .get_features = yt8821_get_features, +#endif + .config_init = yt8821_config_init, + .read_status = yt8821_read_status, + .suspend = yt8521_suspend, + .resume = yt8521_resume, + }, +}; + +#if (KERNEL_VERSION(4, 0, 0) > LINUX_VERSION_CODE) +static int ytphy_drivers_register(struct phy_driver *phy_drvs, int size) +{ + int i, j; + int ret; + + for (i = 0; i < size; i++) { + ret = phy_driver_register(&phy_drvs[i]); + if (ret) + goto err; + } + + return 0; + +err: + for (j = 0; j < i; j++) + phy_driver_unregister(&phy_drvs[j]); + + return ret; +} + +static void ytphy_drivers_unregister(struct phy_driver *phy_drvs, int size) +{ + int i; + + for (i = 0; i < size; i++) + phy_driver_unregister(&phy_drvs[i]); +} + +static int __init ytphy_init(void) +{ + return ytphy_drivers_register(ytphy_drvs, ARRAY_SIZE(ytphy_drvs)); +} + +static void __exit ytphy_exit(void) +{ + ytphy_drivers_unregister(ytphy_drvs, ARRAY_SIZE(ytphy_drvs)); +} + +module_init(ytphy_init); +module_exit(ytphy_exit); +#else +/* for linux 4.x */ +module_phy_driver(ytphy_drvs); +#endif + +MODULE_DESCRIPTION("Motorcomm PHY driver"); +MODULE_AUTHOR("Leilei Zhao"); +MODULE_LICENSE("GPL"); + +static struct mdio_device_id __maybe_unused motorcomm_tbl[] = { + { PHY_ID_YT8010, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8510, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8511, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8512, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8512B, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8521, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8531S, MOTORCOMM_PHY_ID_8531_MASK }, + { PHY_ID_YT8531, MOTORCOMM_PHY_ID_8531_MASK }, + { PHY_ID_YT8618, MOTORCOMM_MPHY_ID_MASK }, + { PHY_ID_YT8614, MOTORCOMM_MPHY_ID_MASK_8614 }, + { PHY_ID_YT8821, MOTORCOMM_PHY_ID_MASK_8821 }, + { } +}; + +MODULE_DEVICE_TABLE(mdio, motorcomm_tbl); + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..7bede5c18272cf016ac1943eb01e3dbcd6f6f0e7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/Kconfig @@ -0,0 +1,185 @@ +# SPDX-License-Identifier: GPL-2.0-only +menuconfig PHYTIUM_RTW88 + tristate "Realtek 802.11ac wireless chips support" + depends on MAC80211 + help + This module adds support for mac80211-based wireless drivers that + enables Realtek IEEE 802.11ac wireless chipsets. + + If you choose to build a module, it'll be called rtw88. + +if PHYTIUM_RTW88 + +config PHYTIUM_RTW88_CORE + tristate + +config PHYTIUM_RTW88_PCI + tristate + +config PHYTIUM_RTW88_SDIO + tristate + +config PHYTIUM_RTW88_USB + tristate + +config PHYTIUM_RTW88_8822B + tristate + +config PHYTIUM_RTW88_8822C + tristate + +config PHYTIUM_RTW88_8723D + tristate + +config PHYTIUM_RTW88_8821C + tristate + +config PHYTIUM_RTW88_8822BE + tristate "Realtek 8822BE PCI wireless network adapter" + depends on PCI + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_PCI + select PHYTIUM_RTW88_8822B + help + Select this option will enable support for 8822BE chipset + + 802.11ac PCIe wireless network adapter + +config PHYTIUM_RTW88_8822BS + tristate "Realtek 8822BS SDIO wireless network adapter" + depends on MMC + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_SDIO + select PHYTIUM_RTW88_8822B + help + Select this option will enable support for 8822BS chipset + + 802.11ac SDIO wireless network adapter + +config PHYTIUM_RTW88_8822BU + tristate "Realtek 8822BU USB wireless network adapter" + depends on USB + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_USB + select PHYTIUM_RTW88_8822B + help + Select this option will enable support for 8822BU chipset + + 802.11ac USB wireless network adapter + +config PHYTIUM_RTW88_8822CE + tristate "Realtek 8822CE PCI wireless network adapter" + depends on PCI + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_PCI + select PHYTIUM_RTW88_8822C + help + Select this option will enable support for 8822CE chipset + + 802.11ac PCIe wireless network adapter + +config PHYTIUM_RTW88_8822CS + tristate "Realtek 8822CS SDIO wireless network adapter" + depends on MMC + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_SDIO + select PHYTIUM_RTW88_8822C + help + Select this option will enable support for 8822CS chipset + + 802.11ac SDIO wireless network adapter + +config PHYTIUM_RTW88_8822CU + tristate "Realtek 8822CU USB wireless network adapter" + depends on USB + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_USB + select PHYTIUM_RTW88_8822C + help + Select this option will enable support for 8822CU chipset + + 802.11ac USB wireless network adapter + +config PHYTIUM_RTW88_8723DE + tristate "Realtek 8723DE PCI wireless network adapter" + depends on PCI + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_PCI + select PHYTIUM_RTW88_8723D + help + Select this option will enable support for 8723DE chipset + + 802.11n PCIe wireless network adapter + +config PHYTIUM_RTW88_8723DS + tristate "Realtek 8723DS SDIO wireless network adapter" + depends on MMC + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_SDIO + select PHYTIUM_RTW88_8723D + help + Select this option will enable support for 8723DS chipset + + 802.11n SDIO wireless network adapter + +config PHYTIUM_RTW88_8723DU + tristate "Realtek 8723DU USB wireless network adapter" + depends on USB + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_USB + select PHYTIUM_RTW88_8723D + help + Select this option will enable support for 8723DU chipset + + 802.11n USB wireless network adapter + +config PHYTIUM_RTW88_8821CE + tristate "Realtek 8821CE PCI wireless network adapter" + depends on PCI + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_PCI + select PHYTIUM_RTW88_8821C + help + Select this option will enable support for 8821CE chipset + + 802.11ac PCIe wireless network adapter + +config PHYTIUM_RTW88_8821CS + tristate "Realtek 8821CS SDIO wireless network adapter" + depends on MMC + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_SDIO + select PHYTIUM_RTW88_8821C + help + Select this option will enable support for 8821CS chipset + + 802.11ac SDIO wireless network adapter + +config PHYTIUM_RTW88_8821CU + tristate "Realtek 8821CU USB wireless network adapter" + depends on USB + select PHYTIUM_RTW88_CORE + select PHYTIUM_RTW88_USB + select PHYTIUM_RTW88_8821C + help + Select this option will enable support for 8821CU chipset + + 802.11ac USB wireless network adapter + +config PHYTIUM_RTW88_DEBUG + bool "Realtek rtw88 debug support" + depends on PHYTIUM_RTW88_CORE + help + Enable debug support + + If unsure, say Y to simplify debug problems + +config PHYTIUM_RTW88_DEBUGFS + bool "Realtek rtw88 debugfs support" + depends on PHYTIUM_RTW88_CORE + help + Enable debug support + + If unsure, say Y to simplify debug problems + +endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..8372e91b4929f74430cc135d2724c38582e1f049 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/Makefile @@ -0,0 +1,78 @@ +# SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause + +obj-$(CONFIG_PHYTIUM_RTW88_CORE) += rtw88_core.o +rtw88_core-y += main.o \ + mac80211.o \ + util.o \ + debug.o \ + tx.o \ + rx.o \ + mac.o \ + phy.o \ + coex.o \ + efuse.o \ + fw.o \ + ps.o \ + sec.o \ + bf.o \ + sar.o \ + regd.o + +rtw88_core-$(CONFIG_PM) += wow.o + +obj-$(CONFIG_PHYTIUM_RTW88_8822B) += rtw88_8822b.o +rtw88_8822b-objs := rtw8822b.o rtw8822b_table.o + +obj-$(CONFIG_PHYTIUM_RTW88_8822BE) += rtw88_8822be.o +rtw88_8822be-objs := rtw8822be.o + +obj-$(CONFIG_PHYTIUM_RTW88_8822BS) += rtw88_8822bs.o +rtw88_8822bs-objs := rtw8822bs.o + +obj-$(CONFIG_PHYTIUM_RTW88_8822BU) += rtw88_8822bu.o +rtw88_8822bu-objs := rtw8822bu.o + +obj-$(CONFIG_PHYTIUM_RTW88_8822C) += rtw88_8822c.o +rtw88_8822c-objs := rtw8822c.o rtw8822c_table.o + +obj-$(CONFIG_PHYTIUM_RTW88_8822CE) += rtw88_8822ce.o +rtw88_8822ce-objs := rtw8822ce.o + +obj-$(CONFIG_PHYTIUM_RTW88_8822CS) += rtw88_8822cs.o +rtw88_8822cs-objs := rtw8822cs.o + +obj-$(CONFIG_PHYTIUM_RTW88_8822CU) += rtw88_8822cu.o +rtw88_8822cu-objs := rtw8822cu.o + +obj-$(CONFIG_PHYTIUM_RTW88_8723D) += rtw88_8723d.o +rtw88_8723d-objs := rtw8723d.o rtw8723d_table.o + +obj-$(CONFIG_PHYTIUM_RTW88_8723DE) += rtw88_8723de.o +rtw88_8723de-objs := rtw8723de.o + +obj-$(CONFIG_PHYTIUM_RTW88_8723DS) += rtw88_8723ds.o +rtw88_8723ds-objs := rtw8723ds.o + +obj-$(CONFIG_PHYTIUM_RTW88_8723DU) += rtw88_8723du.o +rtw88_8723du-objs := rtw8723du.o + +obj-$(CONFIG_PHYTIUM_RTW88_8821C) += rtw88_8821c.o +rtw88_8821c-objs := rtw8821c.o rtw8821c_table.o + +obj-$(CONFIG_PHYTIUM_RTW88_8821CE) += rtw88_8821ce.o +rtw88_8821ce-objs := rtw8821ce.o + +obj-$(CONFIG_PHYTIUM_RTW88_8821CS) += rtw88_8821cs.o +rtw88_8821cs-objs := rtw8821cs.o + +obj-$(CONFIG_PHYTIUM_RTW88_8821CU) += rtw88_8821cu.o +rtw88_8821cu-objs := rtw8821cu.o + +obj-$(CONFIG_PHYTIUM_RTW88_PCI) += rtw88_pci.o +rtw88_pci-objs := pci.o + +obj-$(CONFIG_PHYTIUM_RTW88_SDIO) += rtw88_sdio.o +rtw88_sdio-objs := sdio.o + +obj-$(CONFIG_PHYTIUM_RTW88_USB) += rtw88_usb.o +rtw88_usb-objs := usb.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/bf.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/bf.c new file mode 100644 index 0000000000000000000000000000000000000000..95de3d3da065d1b7c6f0f6ff9ea6b7fd09d648a5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/bf.c @@ -0,0 +1,418 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation. + */ + +#include "main.h" +#include "reg.h" +#include "bf.h" +#include "debug.h" + +void rtw_bf_disassoc(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct ieee80211_bss_conf *bss_conf) +{ + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + struct rtw_bfee *bfee = &rtwvif->bfee; + struct rtw_bf_info *bfinfo = &rtwdev->bf_info; + + if (bfee->role == RTW_BFEE_NONE) + return; + + if (bfee->role == RTW_BFEE_MU) + bfinfo->bfer_mu_cnt--; + else if (bfee->role == RTW_BFEE_SU) + bfinfo->bfer_su_cnt--; + + rtw_chip_config_bfee(rtwdev, rtwvif, bfee, false); + + bfee->role = RTW_BFEE_NONE; +} + +void rtw_bf_assoc(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct ieee80211_bss_conf *bss_conf) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct ieee80211_hw *hw = rtwdev->hw; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + struct rtw_bfee *bfee = &rtwvif->bfee; + struct rtw_bf_info *bfinfo = &rtwdev->bf_info; + struct ieee80211_sta *sta; + struct ieee80211_sta_vht_cap *vht_cap; + struct ieee80211_sta_vht_cap *ic_vht_cap; + const u8 *bssid = bss_conf->bssid; + u32 sound_dim; + u8 i; + + if (!(chip->band & RTW_BAND_5G)) + return; + + rcu_read_lock(); + + sta = ieee80211_find_sta(vif, bssid); + if (!sta) { + rcu_read_unlock(); + + rtw_warn(rtwdev, "failed to find station entry for bss %pM\n", + bssid); + return; + } + + ic_vht_cap = &hw->wiphy->bands[NL80211_BAND_5GHZ]->vht_cap; +#if LINUX_VERSION_CODE < KERNEL_VERSION(5, 19, 0) + vht_cap = &sta->vht_cap; +#else + vht_cap = &sta->deflink.vht_cap; +#endif + + rcu_read_unlock(); + + if ((ic_vht_cap->cap & IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE) && + (vht_cap->cap & IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE)) { + if (bfinfo->bfer_mu_cnt >= chip->bfer_mu_max_num) { + rtw_dbg(rtwdev, RTW_DBG_BF, "mu bfer number over limit\n"); + return; + } + + ether_addr_copy(bfee->mac_addr, bssid); + bfee->role = RTW_BFEE_MU; + bfee->p_aid = (bssid[5] << 1) | (bssid[4] >> 7); +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) + bfee->aid = vif->cfg.aid; +#else + bfee->aid = bss_conf->aid; +#endif + bfinfo->bfer_mu_cnt++; + + rtw_chip_config_bfee(rtwdev, rtwvif, bfee, true); + } else if ((ic_vht_cap->cap & IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE) && + (vht_cap->cap & IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE)) { + if (bfinfo->bfer_su_cnt >= chip->bfer_su_max_num) { + rtw_dbg(rtwdev, RTW_DBG_BF, "su bfer number over limit\n"); + return; + } + + sound_dim = vht_cap->cap & + IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_MASK; + sound_dim >>= IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_SHIFT; + + ether_addr_copy(bfee->mac_addr, bssid); + bfee->role = RTW_BFEE_SU; + bfee->sound_dim = (u8)sound_dim; + bfee->g_id = 0; + bfee->p_aid = (bssid[5] << 1) | (bssid[4] >> 7); + bfinfo->bfer_su_cnt++; + for (i = 0; i < chip->bfer_su_max_num; i++) { + if (!test_bit(i, bfinfo->bfer_su_reg_maping)) { + set_bit(i, bfinfo->bfer_su_reg_maping); + bfee->su_reg_index = i; + break; + } + } + + rtw_chip_config_bfee(rtwdev, rtwvif, bfee, true); + } +} + +void rtw_bf_init_bfer_entry_mu(struct rtw_dev *rtwdev, + struct mu_bfer_init_para *param) +{ + u16 mu_bf_ctl = 0; + u8 *addr = param->bfer_address; + int i; + + for (i = 0; i < ETH_ALEN; i++) + rtw_write8(rtwdev, REG_ASSOCIATED_BFMER0_INFO + i, addr[i]); + rtw_write16(rtwdev, REG_ASSOCIATED_BFMER0_INFO + 6, param->paid); + rtw_write16(rtwdev, REG_TX_CSI_RPT_PARAM_BW20, param->csi_para); + + mu_bf_ctl = rtw_read16(rtwdev, REG_WMAC_MU_BF_CTL) & 0xC000; + mu_bf_ctl |= param->my_aid | (param->csi_length_sel << 12); + rtw_write16(rtwdev, REG_WMAC_MU_BF_CTL, mu_bf_ctl); +} + +void rtw_bf_cfg_sounding(struct rtw_dev *rtwdev, struct rtw_vif *vif, + enum rtw_trx_desc_rate rate) +{ + u32 psf_ctl = 0; + u8 csi_rsc = 0x1; + + psf_ctl = rtw_read32(rtwdev, REG_BBPSF_CTRL) | + BIT_WMAC_USE_NDPARATE | + (csi_rsc << 13); + + rtw_write8_mask(rtwdev, REG_SND_PTCL_CTRL, BIT_MASK_BEAMFORM, + RTW_SND_CTRL_SOUNDING); + rtw_write8(rtwdev, REG_SND_PTCL_CTRL + 3, 0x26); + rtw_write8_clr(rtwdev, REG_RXFLTMAP1, BIT_RXFLTMAP1_BF_REPORT_POLL); + rtw_write8_clr(rtwdev, REG_RXFLTMAP4, BIT_RXFLTMAP4_BF_REPORT_POLL); + + if (vif->net_type == RTW_NET_AP_MODE) + rtw_write32(rtwdev, REG_BBPSF_CTRL, psf_ctl | BIT(12)); + else + rtw_write32(rtwdev, REG_BBPSF_CTRL, psf_ctl & ~BIT(12)); +} + +void rtw_bf_cfg_mu_bfee(struct rtw_dev *rtwdev, struct cfg_mumimo_para *param) +{ + u8 mu_tbl_sel; + u8 mu_valid; + + mu_valid = rtw_read8(rtwdev, REG_MU_TX_CTL) & + ~BIT_MASK_R_MU_TABLE_VALID; + + rtw_write8(rtwdev, REG_MU_TX_CTL, + (mu_valid | BIT(0) | BIT(1)) & ~(BIT(7))); + + mu_tbl_sel = rtw_read8(rtwdev, REG_MU_TX_CTL + 1) & 0xF8; + + rtw_write8(rtwdev, REG_MU_TX_CTL + 1, mu_tbl_sel); + rtw_write32(rtwdev, REG_MU_STA_GID_VLD, param->given_gid_tab[0]); + rtw_write32(rtwdev, REG_MU_STA_USER_POS_INFO, param->given_user_pos[0]); + rtw_write32(rtwdev, REG_MU_STA_USER_POS_INFO + 4, + param->given_user_pos[1]); + + rtw_write8(rtwdev, REG_MU_TX_CTL + 1, mu_tbl_sel | 1); + rtw_write32(rtwdev, REG_MU_STA_GID_VLD, param->given_gid_tab[1]); + rtw_write32(rtwdev, REG_MU_STA_USER_POS_INFO, param->given_user_pos[2]); + rtw_write32(rtwdev, REG_MU_STA_USER_POS_INFO + 4, + param->given_user_pos[3]); +} + +void rtw_bf_del_bfer_entry_mu(struct rtw_dev *rtwdev) +{ + rtw_write32(rtwdev, REG_ASSOCIATED_BFMER0_INFO, 0); + rtw_write32(rtwdev, REG_ASSOCIATED_BFMER0_INFO + 4, 0); + rtw_write16(rtwdev, REG_WMAC_MU_BF_CTL, 0); + rtw_write8(rtwdev, REG_MU_TX_CTL, 0); +} + +void rtw_bf_del_sounding(struct rtw_dev *rtwdev) +{ + rtw_write8_mask(rtwdev, REG_SND_PTCL_CTRL, BIT_MASK_BEAMFORM, 0); +} + +void rtw_bf_enable_bfee_su(struct rtw_dev *rtwdev, struct rtw_vif *vif, + struct rtw_bfee *bfee) +{ + u8 nc_index = hweight8(rtwdev->hal.antenna_rx) - 1; + u8 nr_index = bfee->sound_dim; + u8 grouping = 0, codebookinfo = 1, coefficientsize = 3; + u32 addr_bfer_info, addr_csi_rpt, csi_param; + u8 i; + + rtw_dbg(rtwdev, RTW_DBG_BF, "config as an su bfee\n"); + + switch (bfee->su_reg_index) { + case 1: + addr_bfer_info = REG_ASSOCIATED_BFMER1_INFO; + addr_csi_rpt = REG_TX_CSI_RPT_PARAM_BW20 + 2; + break; + case 0: + default: + addr_bfer_info = REG_ASSOCIATED_BFMER0_INFO; + addr_csi_rpt = REG_TX_CSI_RPT_PARAM_BW20; + break; + } + + /* Sounding protocol control */ + rtw_write8_mask(rtwdev, REG_SND_PTCL_CTRL, BIT_MASK_BEAMFORM, + RTW_SND_CTRL_SOUNDING); + + /* MAC address/Partial AID of Beamformer */ + for (i = 0; i < ETH_ALEN; i++) + rtw_write8(rtwdev, addr_bfer_info + i, bfee->mac_addr[i]); + + csi_param = (u16)((coefficientsize << 10) | + (codebookinfo << 8) | + (grouping << 6) | + (nr_index << 3) | + nc_index); + rtw_write16(rtwdev, addr_csi_rpt, csi_param); + + /* ndp rx standby timer */ + rtw_write8(rtwdev, REG_SND_PTCL_CTRL + 3, RTW_NDP_RX_STANDBY_TIME); +} +EXPORT_SYMBOL(rtw_bf_enable_bfee_su); + +/* nc index: 1 2T2R 0 1T1R + * nr index: 1 use Nsts 0 use reg setting + * codebookinfo: 1 802.11ac 3 802.11n + */ +void rtw_bf_enable_bfee_mu(struct rtw_dev *rtwdev, struct rtw_vif *vif, + struct rtw_bfee *bfee) +{ + struct rtw_bf_info *bf_info = &rtwdev->bf_info; + struct mu_bfer_init_para param; + u8 nc_index = hweight8(rtwdev->hal.antenna_rx) - 1; + u8 nr_index = 1; + u8 grouping = 0, codebookinfo = 1, coefficientsize = 0; + u32 csi_param; + + rtw_dbg(rtwdev, RTW_DBG_BF, "config as an mu bfee\n"); + + csi_param = (u16)((coefficientsize << 10) | + (codebookinfo << 8) | + (grouping << 6) | + (nr_index << 3) | + nc_index); + + rtw_dbg(rtwdev, RTW_DBG_BF, "nc=%d nr=%d group=%d codebookinfo=%d coefficientsize=%d\n", + nc_index, nr_index, grouping, codebookinfo, + coefficientsize); + + param.paid = bfee->p_aid; + param.csi_para = csi_param; + param.my_aid = bfee->aid & 0xfff; + param.csi_length_sel = HAL_CSI_SEG_4K; + ether_addr_copy(param.bfer_address, bfee->mac_addr); + + rtw_bf_init_bfer_entry_mu(rtwdev, ¶m); + + bf_info->cur_csi_rpt_rate = DESC_RATE6M; + rtw_bf_cfg_sounding(rtwdev, vif, DESC_RATE6M); + + /* accept action_no_ack */ + rtw_write16_set(rtwdev, REG_RXFLTMAP0, BIT_RXFLTMAP0_ACTIONNOACK); + + /* accept NDPA and BF report poll */ + rtw_write16_set(rtwdev, REG_RXFLTMAP1, BIT_RXFLTMAP1_BF); +} +EXPORT_SYMBOL(rtw_bf_enable_bfee_mu); + +void rtw_bf_remove_bfee_su(struct rtw_dev *rtwdev, + struct rtw_bfee *bfee) +{ + struct rtw_bf_info *bfinfo = &rtwdev->bf_info; + + rtw_dbg(rtwdev, RTW_DBG_BF, "remove as a su bfee\n"); + rtw_write8_mask(rtwdev, REG_SND_PTCL_CTRL, BIT_MASK_BEAMFORM, + RTW_SND_CTRL_REMOVE); + + switch (bfee->su_reg_index) { + case 0: + rtw_write32(rtwdev, REG_ASSOCIATED_BFMER0_INFO, 0); + rtw_write16(rtwdev, REG_ASSOCIATED_BFMER0_INFO + 4, 0); + rtw_write16(rtwdev, REG_TX_CSI_RPT_PARAM_BW20, 0); + break; + case 1: + rtw_write32(rtwdev, REG_ASSOCIATED_BFMER1_INFO, 0); + rtw_write16(rtwdev, REG_ASSOCIATED_BFMER1_INFO + 4, 0); + rtw_write16(rtwdev, REG_TX_CSI_RPT_PARAM_BW20 + 2, 0); + break; + } + + clear_bit(bfee->su_reg_index, bfinfo->bfer_su_reg_maping); + bfee->su_reg_index = 0xFF; +} +EXPORT_SYMBOL(rtw_bf_remove_bfee_su); + +void rtw_bf_remove_bfee_mu(struct rtw_dev *rtwdev, + struct rtw_bfee *bfee) +{ + struct rtw_bf_info *bfinfo = &rtwdev->bf_info; + + rtw_write8_mask(rtwdev, REG_SND_PTCL_CTRL, BIT_MASK_BEAMFORM, + RTW_SND_CTRL_REMOVE); + + rtw_bf_del_bfer_entry_mu(rtwdev); + + if (bfinfo->bfer_su_cnt == 0 && bfinfo->bfer_mu_cnt == 0) + rtw_bf_del_sounding(rtwdev); +} +EXPORT_SYMBOL(rtw_bf_remove_bfee_mu); + +void rtw_bf_set_gid_table(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct ieee80211_bss_conf *conf) +{ + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + struct rtw_bfee *bfee = &rtwvif->bfee; + struct cfg_mumimo_para param; + + if (bfee->role != RTW_BFEE_MU) { + rtw_dbg(rtwdev, RTW_DBG_BF, "this vif is not mu bfee\n"); + return; + } + + param.grouping_bitmap = 0; + param.mu_tx_en = 0; + memset(param.sounding_sts, 0, 6); + memcpy(param.given_gid_tab, conf->mu_group.membership, 8); + memcpy(param.given_user_pos, conf->mu_group.position, 16); + rtw_dbg(rtwdev, RTW_DBG_BF, "STA0: gid_valid=0x%x, user_position_l=0x%x, user_position_h=0x%x\n", + param.given_gid_tab[0], param.given_user_pos[0], + param.given_user_pos[1]); + + rtw_dbg(rtwdev, RTW_DBG_BF, "STA1: gid_valid=0x%x, user_position_l=0x%x, user_position_h=0x%x\n", + param.given_gid_tab[1], param.given_user_pos[2], + param.given_user_pos[3]); + + rtw_bf_cfg_mu_bfee(rtwdev, ¶m); +} +EXPORT_SYMBOL(rtw_bf_set_gid_table); + +void rtw_bf_phy_init(struct rtw_dev *rtwdev) +{ + u8 tmp8; + u32 tmp32; + u8 retry_limit = 0xA; + u8 ndpa_rate = 0x10; + u8 ack_policy = 3; + + tmp32 = rtw_read32(rtwdev, REG_MU_TX_CTL); + /* Enable P1 aggr new packet according to P0 transfer time */ + tmp32 |= BIT_MU_P1_WAIT_STATE_EN; + /* MU Retry Limit */ + tmp32 &= ~BIT_MASK_R_MU_RL; + tmp32 |= (retry_limit << BIT_SHIFT_R_MU_RL) & BIT_MASK_R_MU_RL; + /* Disable Tx MU-MIMO until sounding done */ + tmp32 &= ~BIT_EN_MU_MIMO; + /* Clear validity of MU STAs */ + tmp32 &= ~BIT_MASK_R_MU_TABLE_VALID; + rtw_write32(rtwdev, REG_MU_TX_CTL, tmp32); + + /* MU-MIMO Option as default value */ + tmp8 = ack_policy << BIT_SHIFT_WMAC_TXMU_ACKPOLICY; + tmp8 |= BIT_WMAC_TXMU_ACKPOLICY_EN; + rtw_write8(rtwdev, REG_WMAC_MU_BF_OPTION, tmp8); + + /* MU-MIMO Control as default value */ + rtw_write16(rtwdev, REG_WMAC_MU_BF_CTL, 0); + /* Set MU NDPA rate & BW source */ + rtw_write32_set(rtwdev, REG_TXBF_CTRL, BIT_USE_NDPA_PARAMETER); + /* Set NDPA Rate */ + rtw_write8(rtwdev, REG_NDPA_OPT_CTRL, ndpa_rate); + + rtw_write32_mask(rtwdev, REG_BBPSF_CTRL, BIT_MASK_CSI_RATE, + DESC_RATE6M); +} +EXPORT_SYMBOL(rtw_bf_phy_init); + +void rtw_bf_cfg_csi_rate(struct rtw_dev *rtwdev, u8 rssi, u8 cur_rate, + u8 fixrate_en, u8 *new_rate) +{ + u32 csi_cfg; + u16 cur_rrsr; + + csi_cfg = rtw_read32(rtwdev, REG_BBPSF_CTRL) & ~BIT_MASK_CSI_RATE; + cur_rrsr = rtw_read16(rtwdev, REG_RRSR); + + if (rssi >= 40) { + if (cur_rate != DESC_RATE54M) { + cur_rrsr |= BIT(DESC_RATE54M); + csi_cfg |= (DESC_RATE54M & BIT_MASK_CSI_RATE_VAL) << + BIT_SHIFT_CSI_RATE; + rtw_write16(rtwdev, REG_RRSR, cur_rrsr); + rtw_write32(rtwdev, REG_BBPSF_CTRL, csi_cfg); + } + *new_rate = DESC_RATE54M; + } else { + if (cur_rate != DESC_RATE24M) { + cur_rrsr &= ~BIT(DESC_RATE54M); + csi_cfg |= (DESC_RATE54M & BIT_MASK_CSI_RATE_VAL) << + BIT_SHIFT_CSI_RATE; + rtw_write16(rtwdev, REG_RRSR, cur_rrsr); + rtw_write32(rtwdev, REG_BBPSF_CTRL, csi_cfg); + } + *new_rate = DESC_RATE24M; + } +} +EXPORT_SYMBOL(rtw_bf_cfg_csi_rate); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/bf.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/bf.h new file mode 100644 index 0000000000000000000000000000000000000000..7b40c2c0385608ab5e65a868e927d27eadaea8ac --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/bf.h @@ -0,0 +1,117 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation. + */ + +#ifndef __RTW_BF_H_ +#define __RTW_BF_H_ + +#define REG_TXBF_CTRL 0x042C +#define REG_RRSR 0x0440 +#define REG_NDPA_OPT_CTRL 0x045F + +#define REG_ASSOCIATED_BFMER0_INFO 0x06E4 +#define REG_ASSOCIATED_BFMER1_INFO 0x06EC +#define REG_TX_CSI_RPT_PARAM_BW20 0x06F4 +#define REG_SND_PTCL_CTRL 0x0718 +#define BIT_DIS_CHK_VHTSIGB_CRC BIT(6) +#define BIT_DIS_CHK_VHTSIGA_CRC BIT(5) +#define BIT_MASK_BEAMFORM (GENMASK(4, 0) | BIT(7)) +#define REG_MU_TX_CTL 0x14C0 +#define REG_MU_STA_GID_VLD 0x14C4 +#define REG_MU_STA_USER_POS_INFO 0x14C8 +#define REG_CSI_RRSR 0x1678 +#define REG_WMAC_MU_BF_OPTION 0x167C +#define REG_WMAC_MU_BF_CTL 0x1680 + +#define BIT_WMAC_USE_NDPARATE BIT(30) +#define BIT_WMAC_TXMU_ACKPOLICY_EN BIT(6) +#define BIT_USE_NDPA_PARAMETER BIT(30) +#define BIT_MU_P1_WAIT_STATE_EN BIT(16) +#define BIT_EN_MU_MIMO BIT(7) + +#define R_MU_RL 0xf +#define BIT_SHIFT_R_MU_RL 12 +#define BIT_SHIFT_WMAC_TXMU_ACKPOLICY 4 +#define BIT_SHIFT_CSI_RATE 24 + +#define BIT_MASK_R_MU_RL (R_MU_RL << BIT_SHIFT_R_MU_RL) +#define BIT_MASK_R_MU_TABLE_VALID 0x3f +#define BIT_MASK_CSI_RATE_VAL 0x3F +#define BIT_MASK_CSI_RATE (BIT_MASK_CSI_RATE_VAL << BIT_SHIFT_CSI_RATE) + +#define BIT_RXFLTMAP0_ACTIONNOACK BIT(14) +#define BIT_RXFLTMAP1_BF (BIT(4) | BIT(5)) +#define BIT_RXFLTMAP1_BF_REPORT_POLL BIT(4) +#define BIT_RXFLTMAP4_BF_REPORT_POLL BIT(4) + +#define RTW_NDP_RX_STANDBY_TIME 0x70 +#define RTW_SND_CTRL_REMOVE 0x98 +#define RTW_SND_CTRL_SOUNDING 0x9B + +enum csi_seg_len { + HAL_CSI_SEG_4K = 0, + HAL_CSI_SEG_8K = 1, + HAL_CSI_SEG_11K = 2, +}; + +struct cfg_mumimo_para { + u8 sounding_sts[6]; + u16 grouping_bitmap; + u8 mu_tx_en; + u32 given_gid_tab[2]; + u32 given_user_pos[4]; +}; + +struct mu_bfer_init_para { + u16 paid; + u16 csi_para; + u16 my_aid; + enum csi_seg_len csi_length_sel; + u8 bfer_address[ETH_ALEN]; +}; + +void rtw_bf_disassoc(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct ieee80211_bss_conf *bss_conf); +void rtw_bf_assoc(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct ieee80211_bss_conf *bss_conf); +void rtw_bf_init_bfer_entry_mu(struct rtw_dev *rtwdev, + struct mu_bfer_init_para *param); +void rtw_bf_cfg_sounding(struct rtw_dev *rtwdev, struct rtw_vif *vif, + enum rtw_trx_desc_rate rate); +void rtw_bf_cfg_mu_bfee(struct rtw_dev *rtwdev, struct cfg_mumimo_para *param); +void rtw_bf_del_bfer_entry_mu(struct rtw_dev *rtwdev); +void rtw_bf_del_sounding(struct rtw_dev *rtwdev); +void rtw_bf_enable_bfee_su(struct rtw_dev *rtwdev, struct rtw_vif *vif, + struct rtw_bfee *bfee); +void rtw_bf_enable_bfee_mu(struct rtw_dev *rtwdev, struct rtw_vif *vif, + struct rtw_bfee *bfee); +void rtw_bf_remove_bfee_su(struct rtw_dev *rtwdev, struct rtw_bfee *bfee); +void rtw_bf_remove_bfee_mu(struct rtw_dev *rtwdev, struct rtw_bfee *bfee); +void rtw_bf_set_gid_table(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct ieee80211_bss_conf *conf); +void rtw_bf_phy_init(struct rtw_dev *rtwdev); +void rtw_bf_cfg_csi_rate(struct rtw_dev *rtwdev, u8 rssi, u8 cur_rate, + u8 fixrate_en, u8 *new_rate); +static inline void rtw_chip_config_bfee(struct rtw_dev *rtwdev, struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable) +{ + if (rtwdev->chip->ops->config_bfee) + rtwdev->chip->ops->config_bfee(rtwdev, vif, bfee, enable); +} + +static inline void rtw_chip_set_gid_table(struct rtw_dev *rtwdev, + struct ieee80211_vif *vif, + struct ieee80211_bss_conf *conf) +{ + if (rtwdev->chip->ops->set_gid_table) + rtwdev->chip->ops->set_gid_table(rtwdev, vif, conf); +} + +static inline void rtw_chip_cfg_csi_rate(struct rtw_dev *rtwdev, u8 rssi, u8 cur_rate, + u8 fixrate_en, u8 *new_rate) +{ + if (rtwdev->chip->ops->cfg_csi_rate) + rtwdev->chip->ops->cfg_csi_rate(rtwdev, rssi, cur_rate, + fixrate_en, new_rate); +} +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/bitfield.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/bitfield.h new file mode 100644 index 0000000000000000000000000000000000000000..230d2383b16df2ce66eb5b7c04824d21dd0524f4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/bitfield.h @@ -0,0 +1,155 @@ +/* + * Copyright (C) 2014 Felix Fietkau + * Copyright (C) 2004 - 2009 Ivo van Doorn + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 + * as published by the Free Software Foundation + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT 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_BITFIELD_H +#define _LINUX_BITFIELD_H + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 13, 0) +#include +#endif +#include + +/* + * Bitfield access macros + * + * FIELD_{GET,PREP} macros take as first parameter shifted mask + * from which they extract the base mask and shift amount. + * Mask must be a compilation time constant. + * + * Example: + * + * #define REG_FIELD_A GENMASK(6, 0) + * #define REG_FIELD_B BIT(7) + * #define REG_FIELD_C GENMASK(15, 8) + * #define REG_FIELD_D GENMASK(31, 16) + * + * Get: + * a = FIELD_GET(REG_FIELD_A, reg); + * b = FIELD_GET(REG_FIELD_B, reg); + * + * Set: + * reg = FIELD_PREP(REG_FIELD_A, 1) | + * FIELD_PREP(REG_FIELD_B, 0) | + * FIELD_PREP(REG_FIELD_C, c) | + * FIELD_PREP(REG_FIELD_D, 0x40); + * + * Modify: + * reg &= ~REG_FIELD_C; + * reg |= FIELD_PREP(REG_FIELD_C, c); + */ + +#define __bf_shf(x) (__builtin_ffsll(x) - 1) + +#define __BF_FIELD_CHECK(_mask, _reg, _val, _pfx) \ + ({ \ + BUILD_BUG_ON_MSG(!__builtin_constant_p(_mask), \ + _pfx "mask is not constant"); \ + BUILD_BUG_ON_MSG((_mask) == 0, _pfx "mask is zero"); \ + BUILD_BUG_ON_MSG(__builtin_constant_p(_val) ? \ + ~((_mask) >> __bf_shf(_mask)) & (_val) : 0, \ + _pfx "value too large for the field"); \ + BUILD_BUG_ON_MSG((_mask) > (typeof(_reg))~0ull, \ + _pfx "type of reg too small for mask"); \ + __BUILD_BUG_ON_NOT_POWER_OF_2((_mask) + \ + (1ULL << __bf_shf(_mask))); \ + }) + +/** + * FIELD_FIT() - check if value fits in the field + * @_mask: shifted mask defining the field's length and position + * @_val: value to test against the field + * + * Return: true if @_val can fit inside @_mask, false if @_val is too big. + */ +#define FIELD_FIT(_mask, _val) \ + ({ \ + __BF_FIELD_CHECK(_mask, 0ULL, _val, "FIELD_FIT: "); \ + !((((typeof(_mask))_val) << __bf_shf(_mask)) & ~(_mask)); \ + }) + +/** + * FIELD_PREP() - prepare a bitfield element + * @_mask: shifted mask defining the field's length and position + * @_val: value to put in the field + * + * FIELD_PREP() masks and shifts up the value. The result should + * be combined with other fields of the bitfield using logical OR. + */ +#define FIELD_PREP(_mask, _val) \ + ({ \ + __BF_FIELD_CHECK(_mask, 0ULL, _val, "FIELD_PREP: "); \ + ((typeof(_mask))(_val) << __bf_shf(_mask)) & (_mask); \ + }) + +/** + * FIELD_GET() - extract a bitfield element + * @_mask: shifted mask defining the field's length and position + * @_reg: value of entire bitfield + * + * FIELD_GET() extracts the field specified by @_mask from the + * bitfield passed in as @_reg by masking and shifting it down. + */ +#define FIELD_GET(_mask, _reg) \ + ({ \ + __BF_FIELD_CHECK(_mask, _reg, 0U, "FIELD_GET: "); \ + (typeof(_mask))(((_reg) & (_mask)) >> __bf_shf(_mask)); \ + }) + +extern void __compiletime_error("value doesn't fit into mask") +__field_overflow(void); +extern void __compiletime_error("bad bitfield mask") +__bad_mask(void); +static __always_inline u64 field_multiplier(u64 field) +{ + if ((field | (field - 1)) & ((field | (field - 1)) + 1)) + __bad_mask(); + return field & -field; +} +static __always_inline u64 field_mask(u64 field) +{ + return field / field_multiplier(field); +} +#define ____MAKE_OP(type,base,to,from) \ +static __always_inline __##type type##_encode_bits(base v, base field) \ +{ \ + if (__builtin_constant_p(v) && (v & ~field_mask(field))) \ + __field_overflow(); \ + return to((v & field_mask(field)) * field_multiplier(field)); \ +} \ +static __always_inline __##type type##_replace_bits(__##type old, \ + base val, base field) \ +{ \ + return (old & ~to(field)) | type##_encode_bits(val, field); \ +} \ +static __always_inline void type##p_replace_bits(__##type *p, \ + base val, base field) \ +{ \ + *p = (*p & ~to(field)) | type##_encode_bits(val, field); \ +} \ +static __always_inline base type##_get_bits(__##type v, base field) \ +{ \ + return (from(v) & field)/field_multiplier(field); \ +} +#define __MAKE_OP(size) \ + ____MAKE_OP(le##size,u##size,cpu_to_le##size,le##size##_to_cpu) \ + ____MAKE_OP(be##size,u##size,cpu_to_be##size,be##size##_to_cpu) \ + ____MAKE_OP(u##size,u##size,,) +____MAKE_OP(u8,u8,,) +__MAKE_OP(16) +__MAKE_OP(32) +__MAKE_OP(64) +#undef __MAKE_OP +#undef ____MAKE_OP + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/coex.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/coex.c new file mode 100644 index 0000000000000000000000000000000000000000..86467d2f8888ca6fc05f877624d9e0d03088d341 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/coex.c @@ -0,0 +1,4175 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "coex.h" +#include "fw.h" +#include "ps.h" +#include "debug.h" +#include "reg.h" +#include "phy.h" + +static u8 rtw_coex_next_rssi_state(struct rtw_dev *rtwdev, u8 pre_state, + u8 rssi, u8 rssi_thresh) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + u8 tol = chip->rssi_tolerance; + u8 next_state; + + if (pre_state == COEX_RSSI_STATE_LOW || + pre_state == COEX_RSSI_STATE_STAY_LOW) { + if (rssi >= (rssi_thresh + tol)) + next_state = COEX_RSSI_STATE_HIGH; + else + next_state = COEX_RSSI_STATE_STAY_LOW; + } else { + if (rssi < rssi_thresh) + next_state = COEX_RSSI_STATE_LOW; + else + next_state = COEX_RSSI_STATE_STAY_HIGH; + } + + return next_state; +} + +static void rtw_coex_limited_tx(struct rtw_dev *rtwdev, + bool tx_limit_en, bool ampdu_limit_en) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 num_of_active_port = 1; + + if (!chip->scbd_support) + return; + + /* force max tx retry limit = 8 */ + if (coex_stat->wl_tx_limit_en == tx_limit_en && + coex_stat->wl_ampdu_limit_en == ampdu_limit_en) + return; + + if (!coex_stat->wl_tx_limit_en) { + coex_stat->darfrc = rtw_read32(rtwdev, REG_DARFRC); + coex_stat->darfrch = rtw_read32(rtwdev, REG_DARFRCH); + coex_stat->retry_limit = rtw_read16(rtwdev, REG_RETRY_LIMIT); + } + + if (!coex_stat->wl_ampdu_limit_en) + coex_stat->ampdu_max_time = + rtw_read8(rtwdev, REG_AMPDU_MAX_TIME_V1); + + coex_stat->wl_tx_limit_en = tx_limit_en; + coex_stat->wl_ampdu_limit_en = ampdu_limit_en; + + if (tx_limit_en) { + /* set BT polluted packet on for tx rate adaptive, + * not including tx retry broken by PTA + */ + rtw_write8_set(rtwdev, REG_TX_HANG_CTRL, BIT_EN_GNT_BT_AWAKE); + + /* set queue life time to avoid can't reach tx retry limit + * if tx is always broken by GNT_BT + */ + if (num_of_active_port <= 1) + rtw_write8_set(rtwdev, REG_LIFETIME_EN, 0xf); + rtw_write16(rtwdev, REG_RETRY_LIMIT, 0x0808); + + /* auto rate fallback step within 8 retries */ + rtw_write32(rtwdev, REG_DARFRC, 0x1000000); + rtw_write32(rtwdev, REG_DARFRCH, 0x4030201); + } else { + rtw_write8_clr(rtwdev, REG_TX_HANG_CTRL, BIT_EN_GNT_BT_AWAKE); + rtw_write8_clr(rtwdev, REG_LIFETIME_EN, 0xf); + + rtw_write16(rtwdev, REG_RETRY_LIMIT, coex_stat->retry_limit); + rtw_write32(rtwdev, REG_DARFRC, coex_stat->darfrc); + rtw_write32(rtwdev, REG_DARFRCH, coex_stat->darfrch); + } + + if (ampdu_limit_en) + rtw_write8(rtwdev, REG_AMPDU_MAX_TIME_V1, 0x20); + else + rtw_write8(rtwdev, REG_AMPDU_MAX_TIME_V1, + coex_stat->ampdu_max_time); +} + +static void rtw_coex_limited_wl(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + bool tx_limit = false; + bool tx_agg_ctrl = false; + + if (!coex->under_5g && coex_dm->bt_status != COEX_BTSTATUS_NCON_IDLE) { + tx_limit = true; + tx_agg_ctrl = true; + } + + rtw_coex_limited_tx(rtwdev, tx_limit, tx_agg_ctrl); +} + +static bool rtw_coex_freerun_check(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 bt_rssi; + u8 ant_distance = 10; + + if (coex_stat->bt_disabled) + return false; + + if (efuse->share_ant || ant_distance <= 5 || !coex_stat->wl_gl_busy) + return false; + + if (ant_distance >= 40 || coex_stat->bt_hid_pair_num >= 2) + return true; + + /* ant_distance = 5 ~ 40 */ + if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1]) && + COEX_RSSI_HIGH(coex_dm->bt_rssi_state[0])) + return true; + + if (coex_stat->wl_tput_dir == COEX_WL_TPUT_TX) + bt_rssi = coex_dm->bt_rssi_state[0]; + else + bt_rssi = coex_dm->bt_rssi_state[1]; + + if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[3]) && + COEX_RSSI_HIGH(bt_rssi) && + coex_stat->cnt_wl[COEX_CNT_WL_SCANAP] <= 5) + return true; + + return false; +} + +static void rtw_coex_wl_slot_extend(struct rtw_dev *rtwdev, bool enable) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 para[6] = {0}; + + para[0] = COEX_H2C69_WL_LEAKAP; + para[1] = PARA1_H2C69_DIS_5MS; + + if (enable) + para[1] = PARA1_H2C69_EN_5MS; + else + coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] = 0; + + coex_stat->wl_slot_extend = enable; + rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); +} + +static void rtw_coex_wl_ccklock_action(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + + if (coex->manual_control || coex->stop_dm) + return; + + + if (coex_stat->tdma_timer_base == 3 && coex_stat->wl_slot_extend) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], set h2c 0x69 opcode 12 to turn off 5ms WL slot extend!!\n"); + rtw_coex_wl_slot_extend(rtwdev, false); + return; + } + + if (coex_stat->wl_slot_extend && coex_stat->wl_force_lps_ctrl && + !coex_stat->wl_cck_lock_ever) { + if (coex_stat->wl_fw_dbg_info[7] <= 5) + coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND]++; + else + coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] = 0; + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], 5ms WL slot extend cnt = %d!!\n", + coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND]); + + if (coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] == 7) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], set h2c 0x69 opcode 12 to turn off 5ms WL slot extend!!\n"); + rtw_coex_wl_slot_extend(rtwdev, false); + } + } else if (!coex_stat->wl_slot_extend && coex_stat->wl_cck_lock) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], set h2c 0x69 opcode 12 to turn on 5ms WL slot extend!!\n"); + + rtw_coex_wl_slot_extend(rtwdev, true); + } +} + +static void rtw_coex_wl_ccklock_detect(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + + bool is_cck_lock_rate = false; + + if (coex_stat->wl_coex_mode != COEX_WLINK_2G1PORT && + coex_stat->wl_coex_mode != COEX_WLINK_2GFREE) + return; + + if (coex_dm->bt_status == COEX_BTSTATUS_INQ_PAGE || + coex_stat->bt_setup_link) { + coex_stat->wl_cck_lock = false; + coex_stat->wl_cck_lock_pre = false; + return; + } + + if (coex_stat->wl_rx_rate <= COEX_CCK_2 || + coex_stat->wl_rts_rx_rate <= COEX_CCK_2) + is_cck_lock_rate = true; + + if (coex_stat->wl_connected && coex_stat->wl_gl_busy && + COEX_RSSI_HIGH(coex_dm->wl_rssi_state[3]) && + (coex_dm->bt_status == COEX_BTSTATUS_ACL_BUSY || + coex_dm->bt_status == COEX_BTSTATUS_ACL_SCO_BUSY || + coex_dm->bt_status == COEX_BTSTATUS_SCO_BUSY)) { + if (is_cck_lock_rate) { + coex_stat->wl_cck_lock = true; + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], cck locking...\n"); + + } else { + coex_stat->wl_cck_lock = false; + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], cck unlock...\n"); + } + } else { + coex_stat->wl_cck_lock = false; + } + + /* CCK lock identification */ + if (coex_stat->wl_cck_lock && !coex_stat->wl_cck_lock_pre) + ieee80211_queue_delayed_work(rtwdev->hw, &coex->wl_ccklock_work, + 3 * HZ); + + coex_stat->wl_cck_lock_pre = coex_stat->wl_cck_lock; +} + +static void rtw_coex_wl_noisy_detect(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 cnt_cck; + bool wl_cck_lock = false; + + /* wifi noisy environment identification */ + cnt_cck = dm_info->cck_ok_cnt + dm_info->cck_err_cnt; + + if (!coex_stat->wl_gl_busy && !wl_cck_lock) { + if (cnt_cck > 250) { + if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] < 5) + coex_stat->cnt_wl[COEX_CNT_WL_NOISY2]++; + + if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] == 5) { + coex_stat->cnt_wl[COEX_CNT_WL_NOISY0] = 0; + coex_stat->cnt_wl[COEX_CNT_WL_NOISY1] = 0; + } + } else if (cnt_cck < 100) { + if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY0] < 5) + coex_stat->cnt_wl[COEX_CNT_WL_NOISY0]++; + + if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY0] == 5) { + coex_stat->cnt_wl[COEX_CNT_WL_NOISY1] = 0; + coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] = 0; + } + } else { + if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY1] < 5) + coex_stat->cnt_wl[COEX_CNT_WL_NOISY1]++; + + if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY1] == 5) { + coex_stat->cnt_wl[COEX_CNT_WL_NOISY0] = 0; + coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] = 0; + } + } + + if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] == 5) + coex_stat->wl_noisy_level = 2; + else if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY1] == 5) + coex_stat->wl_noisy_level = 1; + else + coex_stat->wl_noisy_level = 0; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], wl_noisy_level = %d\n", + coex_stat->wl_noisy_level); + } +} + +static void rtw_coex_tdma_timer_base(struct rtw_dev *rtwdev, u8 type) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 para[2] = {0}; + u8 times; + u16 tbtt_interval = coex_stat->wl_beacon_interval; + + if (coex_stat->tdma_timer_base == type) + return; + + coex_stat->tdma_timer_base = type; + + para[0] = COEX_H2C69_TDMA_SLOT; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], tbtt_interval = %d\n", + tbtt_interval); + + if (type == TDMA_TIMER_TYPE_4SLOT && tbtt_interval < 120) { + para[1] = PARA1_H2C69_TDMA_4SLOT; /* 4-slot */ + } else if (tbtt_interval < 80 && tbtt_interval > 0) { + times = 100 / tbtt_interval; + if (100 % tbtt_interval != 0) + times++; + + para[1] = FIELD_PREP(PARA1_H2C69_TBTT_TIMES, times); + } else if (tbtt_interval >= 180) { + times = tbtt_interval / 100; + if (tbtt_interval % 100 <= 80) + times--; + + para[1] = FIELD_PREP(PARA1_H2C69_TBTT_TIMES, times) | + FIELD_PREP(PARA1_H2C69_TBTT_DIV100, 1); + } else { + para[1] = PARA1_H2C69_TDMA_2SLOT; + } + + rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): h2c_0x69 = 0x%x\n", + __func__, para[1]); + + /* no 5ms_wl_slot_extend for 4-slot mode */ + if (coex_stat->tdma_timer_base == 3) + rtw_coex_wl_ccklock_action(rtwdev); +} + +static void rtw_coex_set_wl_pri_mask(struct rtw_dev *rtwdev, u8 bitmap, + u8 data) +{ + u32 addr; + + addr = REG_BT_COEX_TABLE_H + (bitmap / 8); + bitmap = bitmap % 8; + + rtw_write8_mask(rtwdev, addr, BIT(bitmap), data); +} + +void rtw_coex_write_scbd(struct rtw_dev *rtwdev, u16 bitpos, bool set) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u16 val = 0x2; + + if (!chip->scbd_support) + return; + + val |= coex_stat->score_board; + + /* for 8822b, scbd[10] is CQDDR on + * for 8822c, scbd[10] is no fix 2M + */ + if (!chip->new_scbd10_def && (bitpos & COEX_SCBD_FIX2M)) { + if (set) + val &= ~COEX_SCBD_FIX2M; + else + val |= COEX_SCBD_FIX2M; + } else { + if (set) + val |= bitpos; + else + val &= ~bitpos; + } + + if (val != coex_stat->score_board) { + coex_stat->score_board = val; + val |= BIT_BT_INT_EN; + rtw_write16(rtwdev, REG_WIFI_BT_INFO, val); + } +} +EXPORT_SYMBOL(rtw_coex_write_scbd); + +static u16 rtw_coex_read_scbd(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + if (!chip->scbd_support) + return 0; + + return (rtw_read16(rtwdev, REG_WIFI_BT_INFO)) & ~(BIT_BT_INT_EN); +} + +static void rtw_coex_check_rfk(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_rfe *coex_rfe = &coex->rfe; + u8 cnt = 0; + u32 wait_cnt; + bool btk, wlk; + + if (coex_rfe->wlg_at_btg && chip->scbd_support && + coex_stat->bt_iqk_state != 0xff) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], (Before Ant Setup) Delay by IQK\n"); + + wait_cnt = COEX_RFK_TIMEOUT / COEX_MIN_DELAY; + do { + /* BT RFK */ + btk = !!(rtw_coex_read_scbd(rtwdev) & COEX_SCBD_BT_RFK); + + /* WL RFK */ + wlk = !!(rtw_read8(rtwdev, REG_ARFR4) & BIT_WL_RFK); + + if (!btk && !wlk) + break; + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], (Before Ant Setup) wlk = %d, btk = %d\n", + wlk, btk); + + mdelay(COEX_MIN_DELAY); + } while (++cnt < wait_cnt); + + if (cnt >= wait_cnt) + coex_stat->bt_iqk_state = 0xff; + } +} + +static void rtw_coex_query_bt_info(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + + if (coex_stat->bt_disabled) + return; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_fw_query_bt_info(rtwdev); +} + +static void rtw_coex_gnt_workaround(struct rtw_dev *rtwdev, bool force, u8 mode) +{ + rtw_coex_set_gnt_fix(rtwdev); +} + +static void rtw_coex_monitor_bt_ctr(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u32 tmp; + + tmp = rtw_read32(rtwdev, REG_BT_ACT_STATISTICS); + coex_stat->hi_pri_tx = FIELD_GET(MASKLWORD, tmp); + coex_stat->hi_pri_rx = FIELD_GET(MASKHWORD, tmp); + + tmp = rtw_read32(rtwdev, REG_BT_ACT_STATISTICS_1); + coex_stat->lo_pri_tx = FIELD_GET(MASKLWORD, tmp); + coex_stat->lo_pri_rx = FIELD_GET(MASKHWORD, tmp); + + rtw_write8(rtwdev, REG_BT_COEX_ENH_INTR_CTRL, + BIT_R_GRANTALL_WLMASK | BIT_STATIS_BT_EN); + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", + coex_stat->hi_pri_rx, coex_stat->hi_pri_tx, + coex_stat->lo_pri_rx, coex_stat->lo_pri_tx); +} + +static void rtw_coex_monitor_bt_enable(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + bool bt_disabled = false; + u16 score_board; + + if (chip->scbd_support) { + score_board = rtw_coex_read_scbd(rtwdev); + bt_disabled = !(score_board & COEX_SCBD_ONOFF); + } + + if (coex_stat->bt_disabled != bt_disabled) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], BT state changed (%d) -> (%d)\n", + coex_stat->bt_disabled, bt_disabled); + + coex_stat->bt_disabled = bt_disabled; + coex_stat->bt_ble_scan_type = 0; + coex_dm->cur_bt_lna_lvl = 0; + + if (!coex_stat->bt_disabled) { + coex_stat->bt_reenable = true; + ieee80211_queue_delayed_work(rtwdev->hw, + &coex->bt_reenable_work, + 15 * HZ); + } else { + coex_stat->bt_mailbox_reply = false; + coex_stat->bt_reenable = false; + } + } +} + +static void rtw_coex_update_wl_link_info(struct rtw_dev *rtwdev, u8 reason) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_traffic_stats *stats = &rtwdev->stats; + bool is_5G = false; + bool wl_busy = false; + bool scan = false, link = false; + int i; + u8 rssi_state; + u8 rssi_step; + u8 rssi; + + scan = test_bit(RTW_FLAG_SCANNING, rtwdev->flags); + coex_stat->wl_connected = !!rtwdev->sta_cnt; + + wl_busy = test_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags); + if (wl_busy != coex_stat->wl_gl_busy) { + if (wl_busy) + coex_stat->wl_gl_busy = true; + else + ieee80211_queue_delayed_work(rtwdev->hw, + &coex->wl_remain_work, + 12 * HZ); + } + + if (stats->tx_throughput > stats->rx_throughput) + coex_stat->wl_tput_dir = COEX_WL_TPUT_TX; + else + coex_stat->wl_tput_dir = COEX_WL_TPUT_RX; + + if (scan || link || reason == COEX_RSN_2GCONSTART || + reason == COEX_RSN_2GSCANSTART || reason == COEX_RSN_2GSWITCHBAND) + coex_stat->wl_linkscan_proc = true; + else + coex_stat->wl_linkscan_proc = false; + + rtw_coex_wl_noisy_detect(rtwdev); + + for (i = 0; i < 4; i++) { + rssi_state = coex_dm->wl_rssi_state[i]; + rssi_step = chip->wl_rssi_step[i]; + rssi = rtwdev->dm_info.min_rssi; + rssi_state = rtw_coex_next_rssi_state(rtwdev, rssi_state, + rssi, rssi_step); + coex_dm->wl_rssi_state[i] = rssi_state; + } + + if (coex_stat->wl_linkscan_proc || coex_stat->wl_hi_pri_task1 || + coex_stat->wl_hi_pri_task2 || coex_stat->wl_gl_busy) + rtw_coex_write_scbd(rtwdev, COEX_SCBD_SCAN, true); + else + rtw_coex_write_scbd(rtwdev, COEX_SCBD_SCAN, false); + + switch (reason) { + case COEX_RSN_5GSCANSTART: + case COEX_RSN_5GSWITCHBAND: + case COEX_RSN_5GCONSTART: + + is_5G = true; + break; + case COEX_RSN_2GSCANSTART: + case COEX_RSN_2GSWITCHBAND: + case COEX_RSN_2GCONSTART: + + is_5G = false; + break; + default: + if (rtwdev->hal.current_band_type == RTW_BAND_5G) + is_5G = true; + else + is_5G = false; + break; + } + + coex->under_5g = is_5G; +} + +static inline u8 *get_payload_from_coex_resp(struct sk_buff *resp) +{ + struct rtw_c2h_cmd *c2h; + u32 pkt_offset; + + pkt_offset = *((u32 *)resp->cb); + c2h = (struct rtw_c2h_cmd *)(resp->data + pkt_offset); + + return c2h->payload; +} + +void rtw_coex_info_response(struct rtw_dev *rtwdev, struct sk_buff *skb) +{ + struct rtw_coex *coex = &rtwdev->coex; + u8 *payload = get_payload_from_coex_resp(skb); + + if (payload[0] != COEX_RESP_ACK_BY_WL_FW) { + dev_kfree_skb_any(skb); + return; + } + + skb_queue_tail(&coex->queue, skb); + wake_up(&coex->wait); +} + +static struct sk_buff *rtw_coex_info_request(struct rtw_dev *rtwdev, + struct rtw_coex_info_req *req) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct sk_buff *skb_resp = NULL; + + lockdep_assert_held(&rtwdev->mutex); + + rtw_fw_query_bt_mp_info(rtwdev, req); + + if (!wait_event_timeout(coex->wait, !skb_queue_empty(&coex->queue), + COEX_REQUEST_TIMEOUT)) { + rtw_err(rtwdev, "coex request time out\n"); + goto out; + } + + skb_resp = skb_dequeue(&coex->queue); + if (!skb_resp) { + rtw_err(rtwdev, "failed to get coex info response\n"); + goto out; + } + +out: + return skb_resp; +} + +static bool rtw_coex_get_bt_scan_type(struct rtw_dev *rtwdev, u8 *scan_type) +{ + struct rtw_coex_info_req req = {0}; + struct sk_buff *skb; + u8 *payload; + + req.op_code = BT_MP_INFO_OP_SCAN_TYPE; + skb = rtw_coex_info_request(rtwdev, &req); + if (!skb) + return false; + + payload = get_payload_from_coex_resp(skb); + *scan_type = GET_COEX_RESP_BT_SCAN_TYPE(payload); + dev_kfree_skb_any(skb); + return true; +} + +static bool rtw_coex_set_lna_constrain_level(struct rtw_dev *rtwdev, + u8 lna_constrain_level) +{ + struct rtw_coex_info_req req = {0}; + struct sk_buff *skb; + + req.op_code = BT_MP_INFO_OP_LNA_CONSTRAINT; + req.para1 = lna_constrain_level; + skb = rtw_coex_info_request(rtwdev, &req); + if (!skb) + return false; + + dev_kfree_skb_any(skb); + return true; +} + +#define case_BTSTATUS(src) \ + case COEX_BTSTATUS_##src: return #src + +static const char *rtw_coex_get_bt_status_string(u8 bt_status) +{ + switch (bt_status) { + case_BTSTATUS(NCON_IDLE); + case_BTSTATUS(CON_IDLE); + case_BTSTATUS(INQ_PAGE); + case_BTSTATUS(ACL_BUSY); + case_BTSTATUS(SCO_BUSY); + case_BTSTATUS(ACL_SCO_BUSY); + default: + return "Unknown"; + } +} + +static void rtw_coex_update_bt_link_info(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + u8 i; + u8 rssi_state; + u8 rssi_step; + u8 rssi; + + /* update wl/bt rssi by btinfo */ + for (i = 0; i < COEX_RSSI_STEP; i++) { + rssi_state = coex_dm->bt_rssi_state[i]; + rssi_step = chip->bt_rssi_step[i]; + rssi = coex_stat->bt_rssi; + rssi_state = rtw_coex_next_rssi_state(rtwdev, rssi_state, rssi, + rssi_step); + coex_dm->bt_rssi_state[i] = rssi_state; + } + + if (coex_stat->bt_ble_scan_en && + coex_stat->cnt_bt[COEX_CNT_BT_INFOUPDATE] % 3 == 0) { + u8 scan_type; + + if (rtw_coex_get_bt_scan_type(rtwdev, &scan_type)) { + coex_stat->bt_ble_scan_type = scan_type; + if ((coex_stat->bt_ble_scan_type & 0x1) == 0x1) + coex_stat->bt_init_scan = true; + else + coex_stat->bt_init_scan = false; + } + } + + coex_stat->bt_profile_num = 0; + + /* set link exist status */ + if (!(coex_stat->bt_info_lb2 & COEX_INFO_CONNECTION)) { + coex_stat->bt_link_exist = false; + coex_stat->bt_pan_exist = false; + coex_stat->bt_a2dp_exist = false; + coex_stat->bt_hid_exist = false; + coex_stat->bt_hfp_exist = false; + } else { + /* connection exists */ + coex_stat->bt_link_exist = true; + if (coex_stat->bt_info_lb2 & COEX_INFO_FTP) { + coex_stat->bt_pan_exist = true; + coex_stat->bt_profile_num++; + } else { + coex_stat->bt_pan_exist = false; + } + + if (coex_stat->bt_info_lb2 & COEX_INFO_A2DP) { + coex_stat->bt_a2dp_exist = true; + coex_stat->bt_profile_num++; + } else { + coex_stat->bt_a2dp_exist = false; + } + + if (coex_stat->bt_info_lb2 & COEX_INFO_HID) { + coex_stat->bt_hid_exist = true; + coex_stat->bt_profile_num++; + } else { + coex_stat->bt_hid_exist = false; + } + + if (coex_stat->bt_info_lb2 & COEX_INFO_SCO_ESCO) { + coex_stat->bt_hfp_exist = true; + coex_stat->bt_profile_num++; + } else { + coex_stat->bt_hfp_exist = false; + } + } + + if (coex_stat->bt_info_lb2 & COEX_INFO_INQ_PAGE) { + coex_dm->bt_status = COEX_BTSTATUS_INQ_PAGE; + } else if (!(coex_stat->bt_info_lb2 & COEX_INFO_CONNECTION)) { + coex_dm->bt_status = COEX_BTSTATUS_NCON_IDLE; + coex_stat->bt_multi_link_remain = false; + } else if (coex_stat->bt_info_lb2 == COEX_INFO_CONNECTION) { + coex_dm->bt_status = COEX_BTSTATUS_CON_IDLE; + } else if ((coex_stat->bt_info_lb2 & COEX_INFO_SCO_ESCO) || + (coex_stat->bt_info_lb2 & COEX_INFO_SCO_BUSY)) { + if (coex_stat->bt_info_lb2 & COEX_INFO_ACL_BUSY) + coex_dm->bt_status = COEX_BTSTATUS_ACL_SCO_BUSY; + else + coex_dm->bt_status = COEX_BTSTATUS_SCO_BUSY; + } else if (coex_stat->bt_info_lb2 & COEX_INFO_ACL_BUSY) { + coex_dm->bt_status = COEX_BTSTATUS_ACL_BUSY; + } else { + coex_dm->bt_status = COEX_BTSTATUS_MAX; + } + + coex_stat->cnt_bt[COEX_CNT_BT_INFOUPDATE]++; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(), %s!!!\n", __func__, + rtw_coex_get_bt_status_string(coex_dm->bt_status)); +} + +static void rtw_coex_update_wl_ch_info(struct rtw_dev *rtwdev, u8 type) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_coex_dm *coex_dm = &rtwdev->coex.dm; + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + u8 link = 0; + u8 center_chan = 0; + u8 bw; + int i; + + bw = rtwdev->hal.current_band_width; + + if (type != COEX_MEDIA_DISCONNECT) + center_chan = rtwdev->hal.current_channel; + + if (center_chan == 0 || + (efuse->share_ant && center_chan <= 14 && + coex_stat->wl_coex_mode != COEX_WLINK_2GFREE)) { + link = 0; + center_chan = 0; + bw = 0; + } else if (center_chan <= 14) { + link = 0x1; + + if (bw == RTW_CHANNEL_WIDTH_40) + bw = chip->bt_afh_span_bw40; + else + bw = chip->bt_afh_span_bw20; + } else if (chip->afh_5g_num > 1) { + for (i = 0; i < chip->afh_5g_num; i++) { + if (center_chan == chip->afh_5g[i].wl_5g_ch) { + link = 0x3; + center_chan = chip->afh_5g[i].bt_skip_ch; + bw = chip->afh_5g[i].bt_skip_span; + break; + } + } + } + + coex_dm->wl_ch_info[0] = link; + coex_dm->wl_ch_info[1] = center_chan; + coex_dm->wl_ch_info[2] = bw; + + rtw_fw_wl_ch_info(rtwdev, link, center_chan, bw); + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s: para[0:2] = 0x%x 0x%x 0x%x\n", __func__, link, + center_chan, bw); +} + +static void rtw_coex_set_bt_tx_power(struct rtw_dev *rtwdev, u8 bt_pwr_dec_lvl) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + + if (bt_pwr_dec_lvl == coex_dm->cur_bt_pwr_lvl) + return; + + coex_dm->cur_bt_pwr_lvl = bt_pwr_dec_lvl; + + rtw_fw_force_bt_tx_power(rtwdev, bt_pwr_dec_lvl); +} + +static void rtw_coex_set_bt_rx_gain(struct rtw_dev *rtwdev, u8 bt_lna_lvl) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + + if (bt_lna_lvl == coex_dm->cur_bt_lna_lvl) + return; + + coex_dm->cur_bt_lna_lvl = bt_lna_lvl; + + /* notify BT rx gain table changed */ + if (bt_lna_lvl < 7) { + rtw_coex_set_lna_constrain_level(rtwdev, bt_lna_lvl); + rtw_coex_write_scbd(rtwdev, COEX_SCBD_RXGAIN, true); + } else { + rtw_coex_write_scbd(rtwdev, COEX_SCBD_RXGAIN, false); + } + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): bt_rx_LNA_level = %d\n", + __func__, bt_lna_lvl); +} + +static void rtw_coex_set_rf_para(struct rtw_dev *rtwdev, + struct coex_rf_para para) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 offset = 0; + + if (coex->freerun && coex_stat->cnt_wl[COEX_CNT_WL_SCANAP] <= 5) + offset = 3; + + rtw_coex_set_wl_tx_power(rtwdev, para.wl_pwr_dec_lvl); + rtw_coex_set_bt_tx_power(rtwdev, para.bt_pwr_dec_lvl + offset); + rtw_coex_set_wl_rx_gain(rtwdev, para.wl_low_gain_en); + rtw_coex_set_bt_rx_gain(rtwdev, para.bt_lna_lvl); +} + +u32 rtw_coex_read_indirect_reg(struct rtw_dev *rtwdev, u16 addr) +{ + u32 val; + + if (!ltecoex_read_reg(rtwdev, addr, &val)) { + rtw_err(rtwdev, "failed to read indirect register\n"); + return 0; + } + + return val; +} +EXPORT_SYMBOL(rtw_coex_read_indirect_reg); + +void rtw_coex_write_indirect_reg(struct rtw_dev *rtwdev, u16 addr, + u32 mask, u32 val) +{ + u32 shift = __ffs(mask); + u32 tmp; + + tmp = rtw_coex_read_indirect_reg(rtwdev, addr); + tmp = (tmp & (~mask)) | ((val << shift) & mask); + + if (!ltecoex_reg_write(rtwdev, addr, tmp)) + rtw_err(rtwdev, "failed to write indirect register\n"); +} +EXPORT_SYMBOL(rtw_coex_write_indirect_reg); + +static void rtw_coex_coex_ctrl_owner(struct rtw_dev *rtwdev, bool wifi_control) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + const struct rtw_hw_reg *btg_reg = chip->btg_reg; + + if (wifi_control) { + rtw_write8_set(rtwdev, REG_SYS_SDIO_CTRL + 3, + BIT_LTE_MUX_CTRL_PATH >> 24); + if (btg_reg) + rtw_write8_set(rtwdev, btg_reg->addr, btg_reg->mask); + } else { + rtw_write8_clr(rtwdev, REG_SYS_SDIO_CTRL + 3, + BIT_LTE_MUX_CTRL_PATH >> 24); + if (btg_reg) + rtw_write8_clr(rtwdev, btg_reg->addr, btg_reg->mask); + } +} + +static void rtw_coex_set_gnt_bt(struct rtw_dev *rtwdev, u8 state) +{ + rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, 0xc000, state); + rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, 0x0c00, state); +} + +static void rtw_coex_set_gnt_wl(struct rtw_dev *rtwdev, u8 state) +{ + rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, 0x3000, state); + rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, 0x0300, state); +} + +static void rtw_coex_mimo_ps(struct rtw_dev *rtwdev, bool force, bool state) +{ + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + + if (!force && state == coex_stat->wl_mimo_ps) + return; + + coex_stat->wl_mimo_ps = state; + + rtw_set_txrx_1ss(rtwdev, state); + + rtw_coex_update_wl_ch_info(rtwdev, (u8)coex_stat->wl_connected); + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s(): state = %d\n", __func__, state); +} + +static void rtw_btc_wltoggle_table_a(struct rtw_dev *rtwdev, bool force, + u8 table_case) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 h2c_para[6] = {0}; + u32 table_wl = 0x5a5a5a5a; + + h2c_para[0] = COEX_H2C69_TOGGLE_TABLE_A; + /* no definition */ + h2c_para[1] = 0x1; + + if (efuse->share_ant) { + if (table_case < chip->table_sant_num) + table_wl = chip->table_sant[table_case].wl; + } else { + if (table_case < chip->table_nsant_num) + table_wl = chip->table_nsant[table_case].wl; + } + + /* tell WL FW WL slot toggle table-A*/ + h2c_para[2] = (u8)u32_get_bits(table_wl, GENMASK(7, 0)); + h2c_para[3] = (u8)u32_get_bits(table_wl, GENMASK(15, 8)); + h2c_para[4] = (u8)u32_get_bits(table_wl, GENMASK(23, 16)); + h2c_para[5] = (u8)u32_get_bits(table_wl, GENMASK(31, 24)); + + rtw_fw_bt_wifi_control(rtwdev, h2c_para[0], &h2c_para[1]); + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s(): H2C = [%02x %02x %02x %02x %02x %02x]\n", + __func__, h2c_para[0], h2c_para[1], h2c_para[2], + h2c_para[3], h2c_para[4], h2c_para[5]); +} + +#define COEX_WL_SLOT_TOGLLE 0x5a5a5aaa +static void rtw_btc_wltoggle_table_b(struct rtw_dev *rtwdev, bool force, + u8 interval, u32 table) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 cur_h2c_para[6] = {0}; + u8 i; + + cur_h2c_para[0] = COEX_H2C69_TOGGLE_TABLE_B; + cur_h2c_para[1] = interval; + cur_h2c_para[2] = (u8)u32_get_bits(table, GENMASK(7, 0)); + cur_h2c_para[3] = (u8)u32_get_bits(table, GENMASK(15, 8)); + cur_h2c_para[4] = (u8)u32_get_bits(table, GENMASK(23, 16)); + cur_h2c_para[5] = (u8)u32_get_bits(table, GENMASK(31, 24)); + + coex_stat->wl_toggle_interval = interval; + + for (i = 0; i <= 5; i++) + coex_stat->wl_toggle_para[i] = cur_h2c_para[i]; + + rtw_fw_bt_wifi_control(rtwdev, cur_h2c_para[0], &cur_h2c_para[1]); + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s(): H2C = [%02x %02x %02x %02x %02x %02x]\n", + __func__, cur_h2c_para[0], cur_h2c_para[1], cur_h2c_para[2], + cur_h2c_para[3], cur_h2c_para[4], cur_h2c_para[5]); +} + +static void rtw_coex_set_table(struct rtw_dev *rtwdev, bool force, u32 table0, + u32 table1) +{ +#define DEF_BRK_TABLE_VAL 0xf0ffffff + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + + /* If last tdma is wl slot toggle, force write table*/ + if (!force && coex_dm->reason != COEX_RSN_LPS) { + if (table0 == rtw_read32(rtwdev, REG_BT_COEX_TABLE0) && + table1 == rtw_read32(rtwdev, REG_BT_COEX_TABLE1)) + return; + } + rtw_write32(rtwdev, REG_BT_COEX_TABLE0, table0); + rtw_write32(rtwdev, REG_BT_COEX_TABLE1, table1); + rtw_write32(rtwdev, REG_BT_COEX_BRK_TABLE, DEF_BRK_TABLE_VAL); + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s(): 0x6c0 = %x, 0x6c4 = %x\n", __func__, table0, + table1); +} + +static void rtw_coex_table(struct rtw_dev *rtwdev, bool force, u8 type) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_coex_stat *coex_stat = &coex->stat; + + coex_dm->cur_table = type; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], Coex_Table - %d\n", type); + + if (efuse->share_ant) { + if (type < chip->table_sant_num) + rtw_coex_set_table(rtwdev, force, + chip->table_sant[type].bt, + chip->table_sant[type].wl); + } else { + type = type - 100; + if (type < chip->table_nsant_num) + rtw_coex_set_table(rtwdev, force, + chip->table_nsant[type].bt, + chip->table_nsant[type].wl); + } + if (coex_stat->wl_slot_toggle_change) + rtw_btc_wltoggle_table_a(rtwdev, true, type); +} + +static void rtw_coex_ignore_wlan_act(struct rtw_dev *rtwdev, bool enable) +{ + struct rtw_coex *coex = &rtwdev->coex; + + if (coex->manual_control || coex->stop_dm) + return; + + rtw_fw_bt_ignore_wlan_action(rtwdev, enable); +} + +static void rtw_coex_power_save_state(struct rtw_dev *rtwdev, u8 ps_type, + u8 lps_val, u8 rpwm_val) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 lps_mode = 0x0; + + lps_mode = rtwdev->lps_conf.mode; + + switch (ps_type) { + case COEX_PS_WIFI_NATIVE: + /* recover to original 32k low power setting */ + coex_stat->wl_force_lps_ctrl = false; + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s(): COEX_PS_WIFI_NATIVE\n", __func__); + rtw_leave_lps(rtwdev); + break; + case COEX_PS_LPS_OFF: + coex_stat->wl_force_lps_ctrl = true; + if (lps_mode) + rtw_fw_coex_tdma_type(rtwdev, 0, 0, 0, 0, 0); + + rtw_leave_lps(rtwdev); + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s(): COEX_PS_LPS_OFF\n", __func__); + break; + default: + break; + } +} + +static void rtw_coex_set_tdma(struct rtw_dev *rtwdev, u8 byte1, u8 byte2, + u8 byte3, u8 byte4, u8 byte5) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 ps_type = COEX_PS_WIFI_NATIVE; + bool ap_enable = false; + + if (ap_enable && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): AP mode\n", + __func__); + + byte1 &= ~BIT(4); + byte1 |= BIT(5); + + byte5 |= BIT(5); + byte5 &= ~BIT(6); + + ps_type = COEX_PS_WIFI_NATIVE; + rtw_coex_power_save_state(rtwdev, ps_type, 0x0, 0x0); + } else if ((byte1 & BIT(4) && !(byte1 & BIT(5))) || + coex_stat->wl_coex_mode == COEX_WLINK_2GFREE) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s(): Force LPS (byte1 = 0x%x)\n", __func__, + byte1); + + if (chip->pstdma_type == COEX_PSTDMA_FORCE_LPSOFF) + ps_type = COEX_PS_LPS_OFF; + else + ps_type = COEX_PS_LPS_ON; + rtw_coex_power_save_state(rtwdev, ps_type, 0x50, 0x4); + } else { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s(): native power save (byte1 = 0x%x)\n", + __func__, byte1); + + ps_type = COEX_PS_WIFI_NATIVE; + rtw_coex_power_save_state(rtwdev, ps_type, 0x0, 0x0); + } + + 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; + + rtw_fw_coex_tdma_type(rtwdev, byte1, byte2, byte3, byte4, byte5); + + if (byte1 & BIT(2)) { + coex_stat->wl_slot_toggle = true; + coex_stat->wl_slot_toggle_change = false; + } else { + coex_stat->wl_slot_toggle_change = coex_stat->wl_slot_toggle; + coex_stat->wl_slot_toggle = false; + } +} + +static void rtw_coex_tdma(struct rtw_dev *rtwdev, bool force, u32 tcase) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 n, type; + bool turn_on; + bool wl_busy = false; + + if (tcase & TDMA_4SLOT) /* 4-slot (50ms) mode */ + rtw_coex_tdma_timer_base(rtwdev, TDMA_TIMER_TYPE_4SLOT); + else + rtw_coex_tdma_timer_base(rtwdev, TDMA_TIMER_TYPE_2SLOT); + + type = (u8)(tcase & 0xff); + + turn_on = (type == 0 || type == 100) ? false : true; + + if (!force && turn_on == coex_dm->cur_ps_tdma_on && + type == coex_dm->cur_ps_tdma) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], Skip TDMA because no change TDMA(%s, %d)\n", + (coex_dm->cur_ps_tdma_on ? "on" : "off"), + coex_dm->cur_ps_tdma); + + return; + } + wl_busy = test_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags); + + if ((coex_stat->bt_a2dp_exist && + (coex_stat->bt_inq_remain || coex_stat->bt_multi_link)) || + !wl_busy) + rtw_coex_write_scbd(rtwdev, COEX_SCBD_TDMA, false); + else + rtw_coex_write_scbd(rtwdev, COEX_SCBD_TDMA, true); + + /* update pre state */ + coex_dm->cur_ps_tdma_on = turn_on; + coex_dm->cur_ps_tdma = type; + + if (efuse->share_ant) { + if (type < chip->tdma_sant_num) + rtw_coex_set_tdma(rtwdev, + chip->tdma_sant[type].para[0], + chip->tdma_sant[type].para[1], + chip->tdma_sant[type].para[2], + chip->tdma_sant[type].para[3], + chip->tdma_sant[type].para[4]); + } else { + n = type - 100; + if (n < chip->tdma_nsant_num) + rtw_coex_set_tdma(rtwdev, + chip->tdma_nsant[n].para[0], + chip->tdma_nsant[n].para[1], + chip->tdma_nsant[n].para[2], + chip->tdma_nsant[n].para[3], + chip->tdma_nsant[n].para[4]); + } + + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], coex tdma type(%s, %d)\n", + turn_on ? "on" : "off", type); +} + +static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_rfe *coex_rfe = &coex->rfe; + struct rtw_coex_dm *coex_dm = &coex->dm; + u8 ctrl_type = COEX_SWITCH_CTRL_MAX; + u8 pos_type = COEX_SWITCH_TO_MAX; + + if (!force && coex_dm->cur_ant_pos_type == phase) + return; + + coex_dm->cur_ant_pos_type = phase; + + /* avoid switch coex_ctrl_owner during BT IQK */ + rtw_coex_check_rfk(rtwdev); + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], coex_stat->bt_disabled = 0x%x\n", + coex_stat->bt_disabled); + + switch (phase) { + case COEX_SET_ANT_POWERON: + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s() - PHASE_COEX_POWERON\n", __func__); + /* set path control owner to BT at power-on */ + if (coex_stat->bt_disabled) + rtw_coex_coex_ctrl_owner(rtwdev, true); + else + rtw_coex_coex_ctrl_owner(rtwdev, false); + + ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; + pos_type = COEX_SWITCH_TO_BT; + break; + case COEX_SET_ANT_INIT: + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s() - PHASE_COEX_INIT\n", __func__); + if (coex_stat->bt_disabled) { + /* set GNT_BT to SW low */ + rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_LOW); + + /* set GNT_WL to SW high */ + rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); + } else { + /* set GNT_BT to SW high */ + rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_HIGH); + + /* set GNT_WL to SW low */ + rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_LOW); + } + + /* set path control owner to wl at initial step */ + rtw_coex_coex_ctrl_owner(rtwdev, true); + + ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; + pos_type = COEX_SWITCH_TO_BT; + break; + case COEX_SET_ANT_WONLY: + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s() - PHASE_WLANONLY_INIT\n", __func__); + /* set GNT_BT to SW Low */ + rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_LOW); + + /* set GNT_WL to SW high */ + rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); + + /* set path control owner to wl at initial step */ + rtw_coex_coex_ctrl_owner(rtwdev, true); + + ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; + pos_type = COEX_SWITCH_TO_WLG; + break; + case COEX_SET_ANT_WOFF: + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s() - PHASE_WLAN_OFF\n", __func__); + /* set path control owner to BT */ + rtw_coex_coex_ctrl_owner(rtwdev, false); + + ctrl_type = COEX_SWITCH_CTRL_BY_BT; + pos_type = COEX_SWITCH_TO_NOCARE; + break; + case COEX_SET_ANT_2G: + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s() - PHASE_2G_RUNTIME\n", __func__); + /* set GNT_BT to PTA */ + rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_HW_PTA); + + /* set GNT_WL to PTA */ + rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_HW_PTA); + + /* set path control owner to wl at runtime step */ + rtw_coex_coex_ctrl_owner(rtwdev, true); + + ctrl_type = COEX_SWITCH_CTRL_BY_PTA; + pos_type = COEX_SWITCH_TO_NOCARE; + break; + case COEX_SET_ANT_5G: + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s() - PHASE_5G_RUNTIME\n", __func__); + + /* set GNT_BT to HW PTA */ + rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_HW_PTA); + + /* set GNT_WL to SW high */ + rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); + + /* set path control owner to wl at runtime step */ + rtw_coex_coex_ctrl_owner(rtwdev, true); + + ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; + pos_type = COEX_SWITCH_TO_WLA; + break; + case COEX_SET_ANT_2G_FREERUN: + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s() - PHASE_2G_FREERUN\n", __func__); + + /* set GNT_BT to HW PTA */ + rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_HW_PTA); + + /* Set GNT_WL to SW high */ + rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); + + /* set path control owner to wl at runtime step */ + rtw_coex_coex_ctrl_owner(rtwdev, true); + + ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; + pos_type = COEX_SWITCH_TO_WLG_BT; + break; + case COEX_SET_ANT_2G_WLBT: + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s() - PHASE_2G_WLBT\n", __func__); + /* set GNT_BT to HW PTA */ + rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_HW_PTA); + + /* Set GNT_WL to HW PTA */ + rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_HW_PTA); + + /* set path control owner to wl at runtime step */ + rtw_coex_coex_ctrl_owner(rtwdev, true); + + ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; + pos_type = COEX_SWITCH_TO_WLG_BT; + break; + default: + WARN(1, "unknown phase when setting antenna path\n"); + return; + } + + if (ctrl_type < COEX_SWITCH_CTRL_MAX && pos_type < COEX_SWITCH_TO_MAX && + coex_rfe->ant_switch_exist) + rtw_coex_set_ant_switch(rtwdev, ctrl_type, pos_type); +} + +#define case_ALGO(src) \ + case COEX_ALGO_##src: return #src + +static const char *rtw_coex_get_algo_string(u8 algo) +{ + switch (algo) { + case_ALGO(NOPROFILE); + case_ALGO(HFP); + case_ALGO(HID); + case_ALGO(A2DP); + case_ALGO(PAN); + case_ALGO(A2DP_HID); + case_ALGO(A2DP_PAN); + case_ALGO(PAN_HID); + case_ALGO(A2DP_PAN_HID); + default: + return "Unknown"; + } +} + +#define case_BT_PROFILE(src) \ + case BPM_##src: return #src + +static const char *rtw_coex_get_bt_profile_string(u8 bt_profile) +{ + switch (bt_profile) { + case_BT_PROFILE(NOPROFILE); + case_BT_PROFILE(HFP); + case_BT_PROFILE(HID); + case_BT_PROFILE(A2DP); + case_BT_PROFILE(PAN); + case_BT_PROFILE(HID_HFP); + case_BT_PROFILE(A2DP_HFP); + case_BT_PROFILE(A2DP_HID); + case_BT_PROFILE(A2DP_HID_HFP); + case_BT_PROFILE(PAN_HFP); + case_BT_PROFILE(PAN_HID); + case_BT_PROFILE(PAN_HID_HFP); + case_BT_PROFILE(PAN_A2DP); + case_BT_PROFILE(PAN_A2DP_HFP); + case_BT_PROFILE(PAN_A2DP_HID); + case_BT_PROFILE(PAN_A2DP_HID_HFP); + default: + return "Unknown"; + } +} + +static u8 rtw_coex_algorithm(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 algorithm = COEX_ALGO_NOPROFILE; + u8 profile_map = 0; + + if (coex_stat->bt_hfp_exist) + profile_map |= BPM_HFP; + if (coex_stat->bt_hid_exist) + profile_map |= BPM_HID; + if (coex_stat->bt_a2dp_exist) + profile_map |= BPM_A2DP; + if (coex_stat->bt_pan_exist) + profile_map |= BPM_PAN; + + switch (profile_map) { + case BPM_HFP: + algorithm = COEX_ALGO_HFP; + break; + case BPM_HID: + case BPM_HFP + BPM_HID: + algorithm = COEX_ALGO_HID; + break; + case BPM_HFP + BPM_A2DP: + case BPM_HID + BPM_A2DP: + case BPM_HFP + BPM_HID + BPM_A2DP: + algorithm = COEX_ALGO_A2DP_HID; + break; + case BPM_HFP + BPM_PAN: + case BPM_HID + BPM_PAN: + case BPM_HFP + BPM_HID + BPM_PAN: + algorithm = COEX_ALGO_PAN_HID; + break; + case BPM_HFP + BPM_A2DP + BPM_PAN: + case BPM_HID + BPM_A2DP + BPM_PAN: + case BPM_HFP + BPM_HID + BPM_A2DP + BPM_PAN: + algorithm = COEX_ALGO_A2DP_PAN_HID; + break; + case BPM_PAN: + algorithm = COEX_ALGO_PAN; + break; + case BPM_A2DP + BPM_PAN: + algorithm = COEX_ALGO_A2DP_PAN; + break; + case BPM_A2DP: + if (coex_stat->bt_multi_link) { + if (coex_stat->bt_hid_pair_num > 0) + algorithm = COEX_ALGO_A2DP_HID; + else + algorithm = COEX_ALGO_A2DP_PAN; + } else { + algorithm = COEX_ALGO_A2DP; + } + break; + default: + algorithm = COEX_ALGO_NOPROFILE; + break; + } + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], BT Profile = %s => Algorithm = %s\n", + rtw_coex_get_bt_profile_string(profile_map), + rtw_coex_get_algo_string(algorithm)); + return algorithm; +} + +static void rtw_coex_action_coex_all_off(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + table_case = 2; + tdma_case = 0; + } else { + /* Non-Shared-Ant */ + table_case = 100; + tdma_case = 100; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_freerun(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 level = 0; + bool bt_afh_loss = true; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + if (efuse->share_ant) + return; + + coex->freerun = true; + + if (bt_afh_loss) + rtw_coex_update_wl_ch_info(rtwdev, COEX_MEDIA_CONNECT); + + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G_FREERUN); + + rtw_coex_write_scbd(rtwdev, COEX_SCBD_FIX2M, false); + + if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[0])) + level = 2; + else if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1])) + level = 3; + else if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[2])) + level = 4; + else + level = 5; + + if (level > chip->wl_rf_para_num - 1) + level = chip->wl_rf_para_num - 1; + + if (coex_stat->wl_tput_dir == COEX_WL_TPUT_TX) + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_tx[level]); + else + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[level]); + + rtw_coex_table(rtwdev, false, 100); + rtw_coex_tdma(rtwdev, false, 100); +} + +static void rtw_coex_action_rf4ce(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + table_case = 9; + tdma_case = 16; + } else { + /* Non-Shared-Ant */ + table_case = 100; + tdma_case = 100; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_bt_whql_test(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + table_case = 2; + tdma_case = 0; + } else { + /* Non-Shared-Ant */ + table_case = 100; + tdma_case = 100; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_bt_relink(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + u32 slot_type = 0; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { /* Shared-Ant */ + if (coex_stat->wl_gl_busy) { + table_case = 26; + if (coex_stat->bt_hid_exist && + coex_stat->bt_profile_num == 1) { + slot_type = TDMA_4SLOT; + tdma_case = 20; + } else { + tdma_case = 20; + } + } else { + table_case = 1; + tdma_case = 0; + } + } else { /* Non-Shared-Ant */ + if (coex_stat->wl_gl_busy) + table_case = 115; + else + table_case = 100; + tdma_case = 100; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); +} + +static void rtw_coex_action_bt_idle(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_coex_rfe *coex_rfe = &coex->rfe; + u8 table_case = 0xff, tdma_case = 0xff; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (coex_rfe->ant_switch_with_bt && + coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { + if (efuse->share_ant && + COEX_RSSI_HIGH(coex_dm->wl_rssi_state[3]) && + coex_stat->wl_gl_busy) { + table_case = 0; + tdma_case = 0; + } else if (!efuse->share_ant) { + table_case = 100; + tdma_case = 100; + } + } + + if (table_case != 0xff && tdma_case != 0xff) { + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G_FREERUN); + goto exit; + } + + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + + if (efuse->share_ant) { + /* Shared-Ant */ + if (!coex_stat->wl_gl_busy) { + table_case = 10; + tdma_case = 3; + } else if (coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { + table_case = 11; + + if (coex_stat->lo_pri_rx + coex_stat->lo_pri_tx > 250) + tdma_case = 17; + else + tdma_case = 7; + } else { + table_case = 12; + tdma_case = 7; + } + } else { + /* Non-Shared-Ant */ + if (!coex_stat->wl_gl_busy) { + table_case = 112; + tdma_case = 104; + } else if ((coex_stat->bt_ble_scan_type & 0x2) && + coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { + table_case = 114; + tdma_case = 103; + } else { + table_case = 112; + tdma_case = 103; + } + } + +exit: + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_bt_inquiry(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + bool wl_hi_pri = false; + u8 table_case, tdma_case; + u32 slot_type = 0; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (coex_stat->wl_linkscan_proc || coex_stat->wl_hi_pri_task1 || + coex_stat->wl_hi_pri_task2) + wl_hi_pri = true; + + if (efuse->share_ant) { + /* Shared-Ant */ + if (wl_hi_pri) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], bt inq/page + wifi hi-pri task\n"); + table_case = 15; + + if (coex_stat->bt_profile_num > 0) + tdma_case = 10; + else if (coex_stat->wl_hi_pri_task1) + tdma_case = 6; + else if (!coex_stat->bt_page) + tdma_case = 8; + else + tdma_case = 9; + } else if (coex_stat->wl_gl_busy) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], bt inq/page + wifi busy\n"); + if (coex_stat->bt_profile_num == 0) { + table_case = 12; + tdma_case = 18; + } else if (coex_stat->bt_profile_num == 1 && + !coex_stat->bt_a2dp_exist) { + slot_type = TDMA_4SLOT; + table_case = 12; + tdma_case = 20; + } else { + slot_type = TDMA_4SLOT; + table_case = 12; + tdma_case = 26; + } + } else if (coex_stat->wl_connected) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], bt inq/page + wifi connected\n"); + table_case = 9; + tdma_case = 27; + } else { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], bt inq/page + wifi not-connected\n"); + table_case = 1; + tdma_case = 0; + } + } else { + /* Non_Shared-Ant */ + if (wl_hi_pri) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], bt inq/page + wifi hi-pri task\n"); + table_case = 114; + + if (coex_stat->bt_profile_num > 0) + tdma_case = 110; + else if (coex_stat->wl_hi_pri_task1) + tdma_case = 106; + else if (!coex_stat->bt_page) + tdma_case = 108; + else + tdma_case = 109; + } else if (coex_stat->wl_gl_busy) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], bt inq/page + wifi busy\n"); + table_case = 114; + tdma_case = 121; + } else if (coex_stat->wl_connected) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], bt inq/page + wifi connected\n"); + table_case = 101; + tdma_case = 100; + } else { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], bt inq/page + wifi not-connected\n"); + table_case = 101; + tdma_case = 100; + } + } + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], wifi hi(%d), bt page(%d)\n", + wl_hi_pri, coex_stat->bt_page); + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); +} + +static void rtw_coex_action_bt_game_hid(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_coex_dm *coex_dm = &coex->dm; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + + if (efuse->share_ant) { + coex_stat->wl_coex_mode = COEX_WLINK_2GFREE; + if (coex_stat->bt_whck_test) + table_case = 2; + else if (coex_stat->wl_linkscan_proc || coex_stat->bt_hid_exist) + table_case = 33; + else if (coex_stat->bt_setup_link || coex_stat->bt_inq_page) + table_case = 0; + else if (coex_stat->bt_a2dp_exist) + table_case = 34; + else + table_case = 33; + + tdma_case = 0; + } else { + if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1])) + tdma_case = 112; + else + tdma_case = 113; + + table_case = 121; + } + + if (coex_stat->wl_coex_mode == COEX_WLINK_2GFREE) { + if (coex_stat->wl_tput_dir == COEX_WL_TPUT_TX) + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_tx[6]); + else + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[5]); + } else { + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_bt_hfp(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + table_case = 10; + tdma_case = 5; + } else { + /* Non-Shared-Ant */ + if (coex_stat->bt_multi_link) { + table_case = 112; + tdma_case = 117; + } else { + table_case = 105; + tdma_case = 100; + } + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_bt_hid(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + u32 slot_type = 0; + bool bt_multi_link_remain = false, is_toggle_table = false; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + if (coex_stat->bt_ble_exist) { + /* RCU */ + if (coex_stat->cnt_wl[COEX_CNT_WL_SCANAP] > 5) { + table_case = 26; + tdma_case = 2; + } else { + table_case = 27; + tdma_case = 9; + } + } else { + /* Legacy HID */ + if (coex_stat->bt_profile_num == 1 && + (coex_stat->bt_multi_link || + (coex_stat->lo_pri_rx + + coex_stat->lo_pri_tx > 360) || + coex_stat->bt_slave || + bt_multi_link_remain)) { + slot_type = TDMA_4SLOT; + table_case = 12; + tdma_case = 20; + } else if (coex_stat->bt_a2dp_active) { + table_case = 9; + tdma_case = 18; + } else if (coex_stat->bt_418_hid_exist && + coex_stat->wl_gl_busy) { + is_toggle_table = true; + slot_type = TDMA_4SLOT; + table_case = 9; + tdma_case = 24; + } else if (coex_stat->bt_ble_hid_exist && + coex_stat->wl_gl_busy) { + table_case = 32; + tdma_case = 9; + } else { + table_case = 9; + tdma_case = 9; + } + } + } else { + /* Non-Shared-Ant */ + if (coex_stat->bt_ble_exist) { + /* BLE */ + if (coex_stat->cnt_wl[COEX_CNT_WL_SCANAP] > 5) { + table_case = 121; + tdma_case = 102; + } else { + table_case = 122; + tdma_case = 109; + } + } else if (coex_stat->bt_a2dp_active) { + table_case = 113; + tdma_case = 118; + } else { + table_case = 113; + tdma_case = 104; + } + } + + rtw_coex_table(rtwdev, false, table_case); + if (is_toggle_table) { + rtw_btc_wltoggle_table_a(rtwdev, true, table_case); + rtw_btc_wltoggle_table_b(rtwdev, false, 1, COEX_WL_SLOT_TOGLLE); + } + + rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); +} + +static void rtw_coex_action_bt_a2dp(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + u32 slot_type = 0; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + slot_type = TDMA_4SLOT; + + if (efuse->share_ant) { + /* Shared-Ant */ + if (coex_stat->wl_gl_busy && coex_stat->wl_noisy_level == 0) + table_case = 12; + else + table_case = 9; + + if (coex_stat->wl_connecting || !coex_stat->wl_gl_busy) + tdma_case = 14; + else + tdma_case = 13; + } else { + /* Non-Shared-Ant */ + table_case = 112; + + if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1])) + tdma_case = 112; + else + tdma_case = 113; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); +} + +static void rtw_coex_action_bt_a2dpsink(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + bool ap_enable = false; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { /* Shared-Ant */ + if (ap_enable) { + table_case = 2; + tdma_case = 0; + } else if (coex_stat->wl_gl_busy) { + table_case = 28; + tdma_case = 20; + } else { + table_case = 28; + tdma_case = 26; + } + } else { /* Non-Shared-Ant */ + if (ap_enable) { + table_case = 100; + tdma_case = 100; + } else { + table_case = 119; + tdma_case = 120; + } + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_bt_pan(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + if (coex_stat->wl_gl_busy && coex_stat->wl_noisy_level == 0) + table_case = 14; + else + table_case = 10; + + if (coex_stat->wl_gl_busy) + tdma_case = 17; + else + tdma_case = 20; + } else { + /* Non-Shared-Ant */ + table_case = 112; + + if (coex_stat->wl_gl_busy) + tdma_case = 117; + else + tdma_case = 119; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_bt_a2dp_hid(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case, interval = 0; + u32 slot_type = 0; + bool is_toggle_table = false; + + slot_type = TDMA_4SLOT; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + if (coex_stat->bt_ble_exist) { + table_case = 26; /* for RCU */ + } else if (coex_stat->bt_418_hid_exist) { + table_case = 9; + interval = 1; + } else { + table_case = 9; + } + + if (coex_stat->wl_connecting || !coex_stat->wl_gl_busy) { + tdma_case = 14; + } else if (coex_stat->bt_418_hid_exist) { + is_toggle_table = true; + tdma_case = 23; + } else { + tdma_case = 13; + } + } else { + /* Non-Shared-Ant */ + if (coex_stat->bt_ble_exist) + table_case = 121; + else + table_case = 113; + + if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1])) + tdma_case = 112; + else + tdma_case = 113; + } + + rtw_coex_table(rtwdev, false, table_case); + if (is_toggle_table) { + rtw_btc_wltoggle_table_a(rtwdev, true, table_case); + rtw_btc_wltoggle_table_b(rtwdev, false, interval, COEX_WL_SLOT_TOGLLE); + } + rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); +} + +static void rtw_coex_action_bt_a2dp_pan(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + bool wl_cpt_test = false, bt_cpt_test = false; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + if (efuse->share_ant) { + /* Shared-Ant */ + if (wl_cpt_test) { + if (coex_stat->wl_gl_busy) { + table_case = 20; + tdma_case = 17; + } else { + table_case = 10; + tdma_case = 15; + } + } else if (bt_cpt_test) { + table_case = 26; + tdma_case = 26; + } else { + if (coex_stat->wl_gl_busy && + coex_stat->wl_noisy_level == 0) + table_case = 14; + else + table_case = 10; + + if (coex_stat->wl_gl_busy) + tdma_case = 15; + else + tdma_case = 20; + } + } else { + /* Non-Shared-Ant */ + table_case = 112; + + if (coex_stat->wl_gl_busy) + tdma_case = 115; + else + tdma_case = 120; + } + + if (wl_cpt_test) + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[1]); + else + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_bt_pan_hid(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + table_case = 9; + + if (coex_stat->wl_gl_busy) + tdma_case = 18; + else + tdma_case = 19; + } else { + /* Non-Shared-Ant */ + table_case = 113; + + if (coex_stat->wl_gl_busy) + tdma_case = 117; + else + tdma_case = 119; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_bt_a2dp_pan_hid(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + table_case = 10; + + if (coex_stat->wl_gl_busy) + tdma_case = 15; + else + tdma_case = 20; + } else { + /* Non-Shared-Ant */ + table_case = 113; + + if (coex_stat->wl_gl_busy) + tdma_case = 115; + else + tdma_case = 120; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_wl_under5g(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + rtw_coex_write_scbd(rtwdev, COEX_SCBD_FIX2M, false); + + if (coex_stat->bt_game_hid_exist && coex_stat->wl_linkscan_proc) + coex_stat->wl_coex_mode = COEX_WLINK_2GFREE; + + if (efuse->share_ant) { + /* Shared-Ant */ + table_case = 0; + tdma_case = 0; + } else { + /* Non-Shared-Ant */ + table_case = 100; + tdma_case = 100; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_wl_only(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + table_case = 2; + tdma_case = 0; + } else { + /* Non-Shared-Ant */ + table_case = 100; + tdma_case = 100; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_wl_native_lps(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 table_case, tdma_case; + + if (coex->under_5g) + return; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + + if (efuse->share_ant) { + /* Shared-Ant */ + table_case = 28; + tdma_case = 0; + } else { + /* Non-Shared-Ant */ + table_case = 100; + tdma_case = 100; + } + + if (coex_stat->bt_game_hid_exist) { + coex_stat->wl_coex_mode = COEX_WLINK_2GFREE; + if (coex_stat->wl_tput_dir == COEX_WL_TPUT_TX) + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_tx[6]); + else + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[5]); + } else { + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_wl_linkscan(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + u32 slot_type = 0; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { /* Shared-Ant */ + if (coex_stat->bt_a2dp_exist) { + slot_type = TDMA_4SLOT; + tdma_case = 11; + if (coex_stat->wl_gl_busy) + table_case = 26; + else + table_case = 9; + } else { + table_case = 9; + tdma_case = 7; + } + } else { /* Non-Shared-Ant */ + if (coex_stat->bt_a2dp_exist) { + slot_type = TDMA_4SLOT; + table_case = 112; + tdma_case = 111; + } else { + table_case = 112; + tdma_case = 107; + } + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); +} + +static void rtw_coex_action_wl_not_connected(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 table_case, tdma_case; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); + rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); + + if (efuse->share_ant) { + /* Shared-Ant */ + table_case = 1; + tdma_case = 0; + } else { + /* Non-Shared-Ant */ + table_case = 100; + tdma_case = 100; + } + + rtw_coex_table(rtwdev, false, table_case); + rtw_coex_tdma(rtwdev, false, tdma_case); +} + +static void rtw_coex_action_wl_connected(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 algorithm; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + algorithm = rtw_coex_algorithm(rtwdev); + + switch (algorithm) { + case COEX_ALGO_HFP: + rtw_coex_action_bt_hfp(rtwdev); + break; + case COEX_ALGO_HID: + if (rtw_coex_freerun_check(rtwdev)) + rtw_coex_action_freerun(rtwdev); + else + rtw_coex_action_bt_hid(rtwdev); + break; + case COEX_ALGO_A2DP: + if (rtw_coex_freerun_check(rtwdev)) + rtw_coex_action_freerun(rtwdev); + else if (coex_stat->bt_a2dp_sink) + rtw_coex_action_bt_a2dpsink(rtwdev); + else + rtw_coex_action_bt_a2dp(rtwdev); + break; + case COEX_ALGO_PAN: + rtw_coex_action_bt_pan(rtwdev); + break; + case COEX_ALGO_A2DP_HID: + if (rtw_coex_freerun_check(rtwdev)) + rtw_coex_action_freerun(rtwdev); + else + rtw_coex_action_bt_a2dp_hid(rtwdev); + break; + case COEX_ALGO_A2DP_PAN: + rtw_coex_action_bt_a2dp_pan(rtwdev); + break; + case COEX_ALGO_PAN_HID: + rtw_coex_action_bt_pan_hid(rtwdev); + break; + case COEX_ALGO_A2DP_PAN_HID: + rtw_coex_action_bt_a2dp_pan_hid(rtwdev); + break; + default: + case COEX_ALGO_NOPROFILE: + rtw_coex_action_bt_idle(rtwdev); + break; + } +} + +static void rtw_coex_run_coex(struct rtw_dev *rtwdev, u8 reason) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_coex_stat *coex_stat = &coex->stat; + bool rf4ce_en = false; + + lockdep_assert_held(&rtwdev->mutex); + + if (!test_bit(RTW_FLAG_RUNNING, rtwdev->flags)) + return; + + coex_dm->reason = reason; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): reason = %d\n", __func__, + reason); + + /* update wifi_link_info_ext variable */ + rtw_coex_update_wl_link_info(rtwdev, reason); + + rtw_coex_monitor_bt_enable(rtwdev); + + if (coex->manual_control) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], return for Manual CTRL!!\n"); + return; + } + + if (coex->stop_dm) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], return for Stop Coex DM!!\n"); + return; + } + + if (coex_stat->wl_under_ips) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], return for wifi is under IPS!!\n"); + return; + } + + if (coex->freeze && coex_dm->reason == COEX_RSN_BTINFO && + !coex_stat->bt_setup_link) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], return for coex_freeze!!\n"); + return; + } + + coex_stat->cnt_wl[COEX_CNT_WL_COEXRUN]++; + coex->freerun = false; + + /* Pure-5G Coex Process */ + if (coex->under_5g) { + coex_stat->wl_coex_mode = COEX_WLINK_5G; + rtw_coex_action_wl_under5g(rtwdev); + goto exit; + } + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], WiFi is single-port 2G!!\n"); + coex_stat->wl_coex_mode = COEX_WLINK_2G1PORT; + + if (coex_stat->bt_disabled) { + if (coex_stat->wl_connected && rf4ce_en) + rtw_coex_action_rf4ce(rtwdev); + else if (!coex_stat->wl_connected) + rtw_coex_action_wl_not_connected(rtwdev); + else + rtw_coex_action_wl_only(rtwdev); + goto exit; + } + + if (coex_stat->wl_under_lps && !coex_stat->wl_force_lps_ctrl) { + rtw_coex_action_wl_native_lps(rtwdev); + goto exit; + } + + if (coex_stat->bt_game_hid_exist && coex_stat->wl_connected) { + rtw_coex_action_bt_game_hid(rtwdev); + goto exit; + } + + if (coex_stat->bt_whck_test) { + rtw_coex_action_bt_whql_test(rtwdev); + goto exit; + } + + if (coex_stat->bt_setup_link) { + rtw_coex_action_bt_relink(rtwdev); + goto exit; + } + + if (coex_stat->bt_inq_page) { + rtw_coex_action_bt_inquiry(rtwdev); + goto exit; + } + + if ((coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE || + coex_dm->bt_status == COEX_BTSTATUS_CON_IDLE) && + coex_stat->wl_connected) { + rtw_coex_action_bt_idle(rtwdev); + goto exit; + } + + if (coex_stat->wl_linkscan_proc && !coex->freerun) { + rtw_coex_action_wl_linkscan(rtwdev); + goto exit; + } + + if (coex_stat->wl_connected) { + rtw_coex_action_wl_connected(rtwdev); + goto exit; + } else { + rtw_coex_action_wl_not_connected(rtwdev); + goto exit; + } + +exit: + + if (chip->wl_mimo_ps_support) { + if (coex_stat->wl_coex_mode == COEX_WLINK_2GFREE) { + if (coex_dm->reason == COEX_RSN_2GMEDIA) + rtw_coex_mimo_ps(rtwdev, true, true); + else + rtw_coex_mimo_ps(rtwdev, false, true); + } else { + rtw_coex_mimo_ps(rtwdev, false, false); + } + } + + rtw_coex_gnt_workaround(rtwdev, false, coex_stat->wl_coex_mode); + rtw_coex_limited_wl(rtwdev); +} + +static void rtw_coex_init_coex_var(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + u8 i; + + memset(coex_dm, 0, sizeof(*coex_dm)); + memset(coex_stat, 0, sizeof(*coex_stat)); + + for (i = 0; i < COEX_CNT_WL_MAX; i++) + coex_stat->cnt_wl[i] = 0; + + for (i = 0; i < COEX_CNT_BT_MAX; i++) + coex_stat->cnt_bt[i] = 0; + + for (i = 0; i < ARRAY_SIZE(coex_dm->bt_rssi_state); i++) + coex_dm->bt_rssi_state[i] = COEX_RSSI_STATE_LOW; + + for (i = 0; i < ARRAY_SIZE(coex_dm->wl_rssi_state); i++) + coex_dm->wl_rssi_state[i] = COEX_RSSI_STATE_LOW; + + coex_stat->wl_coex_mode = COEX_WLINK_MAX; + coex_stat->wl_rx_rate = DESC_RATE5_5M; + coex_stat->wl_rts_rx_rate = DESC_RATE5_5M; +} + +static void __rtw_coex_init_hw_config(struct rtw_dev *rtwdev, bool wifi_only) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + rtw_coex_init_coex_var(rtwdev); + + coex_stat->kt_ver = u8_get_bits(rtw_read8(rtwdev, 0xf1), GENMASK(7, 4)); + + rtw_coex_monitor_bt_enable(rtwdev); + rtw_coex_wl_slot_extend(rtwdev, coex_stat->wl_slot_extend); + + rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); + + rtw_coex_set_rfe_type(rtwdev); + rtw_coex_set_init(rtwdev); + + /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ + rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_TX_RSP, 1); + + /* set Tx beacon = Hi-Pri */ + rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_TX_BEACON, 1); + + /* set Tx beacon queue = Hi-Pri */ + rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_TX_BEACONQ, 1); + + /* antenna config */ + if (coex->wl_rf_off) { + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_WOFF); + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ALL, false); + coex->stop_dm = true; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): RF Off\n", + __func__); + } else if (wifi_only) { + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_WONLY); + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, + true); + coex->stop_dm = true; + } else { + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_INIT); + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, + true); + coex->stop_dm = false; + coex->freeze = true; + } + + /* PTA parameter */ + rtw_coex_table(rtwdev, true, 1); + rtw_coex_tdma(rtwdev, true, 0); + rtw_coex_query_bt_info(rtwdev); +} + +void rtw_coex_power_on_setting(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + u8 table_case = 1; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + + coex->stop_dm = true; + coex->wl_rf_off = false; + + /* enable BB, we can write 0x948 */ + rtw_write8_set(rtwdev, REG_SYS_FUNC_EN, + BIT_FEN_BB_GLB_RST | BIT_FEN_BB_RSTB); + + rtw_coex_monitor_bt_enable(rtwdev); + rtw_coex_set_rfe_type(rtwdev); + + /* set antenna path to BT */ + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_POWERON); + + rtw_coex_table(rtwdev, true, table_case); + /* red x issue */ + rtw_write8(rtwdev, 0xff1a, 0x0); + rtw_coex_set_gnt_debug(rtwdev); +} + +void rtw_coex_power_off_setting(struct rtw_dev *rtwdev) +{ + rtw_write16(rtwdev, REG_WIFI_BT_INFO, BIT_BT_INT_EN); +} + +void rtw_coex_init_hw_config(struct rtw_dev *rtwdev, bool wifi_only) +{ + __rtw_coex_init_hw_config(rtwdev, wifi_only); +} + +void rtw_coex_ips_notify(struct rtw_dev *rtwdev, u8 type) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + + if (coex->manual_control || coex->stop_dm) + return; + + if (type == COEX_IPS_ENTER) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], IPS ENTER notify\n"); + + coex_stat->wl_under_ips = true; + + /* for lps off */ + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ALL, false); + + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_WOFF); + rtw_coex_action_coex_all_off(rtwdev); + } else if (type == COEX_IPS_LEAVE) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], IPS LEAVE notify\n"); + + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, true); + /* run init hw config (exclude wifi only) */ + __rtw_coex_init_hw_config(rtwdev, false); + + coex_stat->wl_under_ips = false; + } +} + +void rtw_coex_lps_notify(struct rtw_dev *rtwdev, u8 type) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + + if (coex->manual_control || coex->stop_dm) + return; + + if (type == COEX_LPS_ENABLE) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], LPS ENABLE notify\n"); + + coex_stat->wl_under_lps = true; + + if (coex_stat->wl_force_lps_ctrl) { + /* for ps-tdma */ + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, true); + } else { + /* for native ps */ + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, false); + rtw_coex_write_scbd(rtwdev, COEX_SCBD_WLBUSY, false); + + rtw_coex_run_coex(rtwdev, COEX_RSN_LPS); + } + } else if (type == COEX_LPS_DISABLE) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], LPS DISABLE notify\n"); + + coex_stat->wl_under_lps = false; + + /* for lps off */ + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, true); + + if (!coex_stat->wl_force_lps_ctrl) + rtw_coex_query_bt_info(rtwdev); + + rtw_coex_run_coex(rtwdev, COEX_RSN_LPS); + } +} + +void rtw_coex_scan_notify(struct rtw_dev *rtwdev, u8 type) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + + if (coex->manual_control || coex->stop_dm) + return; + + coex->freeze = false; + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, true); + + if (type == COEX_SCAN_START_5G) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], SCAN START notify (5G)\n"); + + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); + rtw_coex_run_coex(rtwdev, COEX_RSN_5GSCANSTART); + } else if ((type == COEX_SCAN_START_2G) || (type == COEX_SCAN_START)) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], SCAN START notify (2G)\n"); + + coex_stat->wl_hi_pri_task2 = true; + + /* Force antenna setup for no scan result issue */ + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); + rtw_coex_run_coex(rtwdev, COEX_RSN_2GSCANSTART); + } else { + coex_stat->cnt_wl[COEX_CNT_WL_SCANAP] = 30; /* To do */ + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", + coex_stat->cnt_wl[COEX_CNT_WL_SCANAP]); + + coex_stat->wl_hi_pri_task2 = false; + rtw_coex_run_coex(rtwdev, COEX_RSN_SCANFINISH); + } +} + +void rtw_coex_switchband_notify(struct rtw_dev *rtwdev, u8 type) +{ + struct rtw_coex *coex = &rtwdev->coex; + + if (coex->manual_control || coex->stop_dm) + return; + + if (type == COEX_SWITCH_TO_5G) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): TO_5G\n", + __func__); + } else if (type == COEX_SWITCH_TO_24G_NOFORSCAN) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], %s(): TO_24G_NOFORSCAN\n", __func__); + } else { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): TO_2G\n", + __func__); + } + + if (type == COEX_SWITCH_TO_5G) + rtw_coex_run_coex(rtwdev, COEX_RSN_5GSWITCHBAND); + else if (type == COEX_SWITCH_TO_24G_NOFORSCAN) + rtw_coex_run_coex(rtwdev, COEX_RSN_2GSWITCHBAND); + else + rtw_coex_scan_notify(rtwdev, COEX_SCAN_START_2G); +} + +void rtw_coex_connect_notify(struct rtw_dev *rtwdev, u8 type) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + + if (coex->manual_control || coex->stop_dm) + return; + + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, true); + + if (type == COEX_ASSOCIATE_5G_START) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 5G start\n", + __func__); + + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); + rtw_coex_run_coex(rtwdev, COEX_RSN_5GCONSTART); + } else if (type == COEX_ASSOCIATE_5G_FINISH) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 5G finish\n", + __func__); + + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); + rtw_coex_run_coex(rtwdev, COEX_RSN_5GCONFINISH); + } else if (type == COEX_ASSOCIATE_START) { + coex_stat->wl_hi_pri_task1 = true; + coex_stat->wl_connecting = true; + coex_stat->cnt_wl[COEX_CNT_WL_CONNPKT] = 2; + coex_stat->wl_connecting = true; + ieee80211_queue_delayed_work(rtwdev->hw, + &coex->wl_connecting_work, 2 * HZ); + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 2G start\n", + __func__); + /* Force antenna setup for no scan result issue */ + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); + + rtw_coex_run_coex(rtwdev, COEX_RSN_2GCONSTART); + + /* To keep TDMA case during connect process, + * to avoid changed by Btinfo and runcoexmechanism + */ + coex->freeze = true; + ieee80211_queue_delayed_work(rtwdev->hw, &coex->defreeze_work, + 5 * HZ); + } else { + coex_stat->wl_hi_pri_task1 = false; + coex->freeze = false; + coex_stat->wl_connecting = false; + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 2G finish\n", + __func__); + rtw_coex_run_coex(rtwdev, COEX_RSN_2GCONFINISH); + } +} + +void rtw_coex_media_status_notify(struct rtw_dev *rtwdev, u8 type) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + + if (coex->manual_control || coex->stop_dm) + return; + + if (type == COEX_MEDIA_CONNECT_5G) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 5G\n", __func__); + + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, true); + + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); + rtw_coex_run_coex(rtwdev, COEX_RSN_5GMEDIA); + } else if (type == COEX_MEDIA_CONNECT) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): 2G\n", __func__); + + coex_stat->wl_connecting = false; + + rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, true); + + /* Force antenna setup for no scan result issue */ + rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); + + /* Set CCK Rx high Pri */ + rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_RX_CCK, 1); + rtw_coex_run_coex(rtwdev, COEX_RSN_2GMEDIA); + } else { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s(): disconnect!!\n", + __func__); + rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_RX_CCK, 0); + rtw_coex_run_coex(rtwdev, COEX_RSN_MEDIADISCON); + } + + rtw_coex_update_wl_ch_info(rtwdev, type); +} + +void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + u32 bt_relink_time; + u8 i, rsp_source = 0, type; + bool inq_page = false; + + rsp_source = buf[0] & 0xf; + if (rsp_source >= COEX_BTINFO_SRC_MAX) + return; + coex_stat->cnt_bt_info_c2h[rsp_source]++; + + if (rsp_source == COEX_BTINFO_SRC_BT_IQK) { + coex_stat->bt_iqk_state = buf[1]; + if (coex_stat->bt_iqk_state == 0) + coex_stat->cnt_bt[COEX_CNT_BT_IQK]++; + else if (coex_stat->bt_iqk_state == 2) + coex_stat->cnt_bt[COEX_CNT_BT_IQKFAIL]++; + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], BT IQK by bt_info, data0 = 0x%02x\n", + buf[1]); + + return; + } + + if (rsp_source == COEX_BTINFO_SRC_BT_SCBD) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], BT Scoreboard change notify by WL FW c2h, 0xaa = 0x%02x, 0xab = 0x%02x\n", + buf[1], buf[2]); + + rtw_coex_monitor_bt_enable(rtwdev); + if (coex_stat->bt_disabled != coex_stat->bt_disabled_pre) { + coex_stat->bt_disabled_pre = coex_stat->bt_disabled; + rtw_coex_run_coex(rtwdev, COEX_RSN_BTINFO); + } + return; + } + + if (rsp_source == COEX_BTINFO_SRC_H2C60) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], H2C 0x60 content replied by WL FW: H2C_0x60 = [%02x %02x %02x %02x %02x]\n", + buf[1], buf[2], buf[3], buf[4], buf[5]); + + for (i = 1; i <= COEX_WL_TDMA_PARA_LENGTH; i++) + coex_dm->fw_tdma_para[i - 1] = buf[i]; + return; + } + + if (rsp_source == COEX_BTINFO_SRC_WL_FW) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], bt_info reply by WL FW\n"); + + rtw_coex_update_bt_link_info(rtwdev); + return; + } + + if (rsp_source == COEX_BTINFO_SRC_BT_RSP || + rsp_source == COEX_BTINFO_SRC_BT_ACT) { + if (coex_stat->bt_disabled) { + coex_stat->bt_disabled = false; + coex_stat->bt_reenable = true; + ieee80211_queue_delayed_work(rtwdev->hw, + &coex->bt_reenable_work, + 15 * HZ); + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], BT enable detected by bt_info\n"); + } + } + + if (length != COEX_BTINFO_LENGTH) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], Bt_info length = %d invalid!!\n", length); + + return; + } + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], Bt_info[%d], len=%d, data=[%02x %02x %02x %02x %02x %02x]\n", + buf[0], length, buf[1], buf[2], buf[3], buf[4], buf[5], buf[6]); + + for (i = 0; i < COEX_BTINFO_LENGTH; i++) + coex_stat->bt_info_c2h[rsp_source][i] = buf[i]; + + /* get the same info from bt, skip it */ + if (coex_stat->bt_info_c2h[rsp_source][1] == coex_stat->bt_info_lb2 && + coex_stat->bt_info_c2h[rsp_source][2] == coex_stat->bt_info_lb3 && + coex_stat->bt_info_c2h[rsp_source][3] == coex_stat->bt_info_hb0 && + coex_stat->bt_info_c2h[rsp_source][4] == coex_stat->bt_info_hb1 && + coex_stat->bt_info_c2h[rsp_source][5] == coex_stat->bt_info_hb2 && + coex_stat->bt_info_c2h[rsp_source][6] == coex_stat->bt_info_hb3) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], Return because Btinfo duplicate!!\n"); + return; + } + + coex_stat->bt_info_lb2 = coex_stat->bt_info_c2h[rsp_source][1]; + coex_stat->bt_info_lb3 = coex_stat->bt_info_c2h[rsp_source][2]; + coex_stat->bt_info_hb0 = coex_stat->bt_info_c2h[rsp_source][3]; + coex_stat->bt_info_hb1 = coex_stat->bt_info_c2h[rsp_source][4]; + coex_stat->bt_info_hb2 = coex_stat->bt_info_c2h[rsp_source][5]; + coex_stat->bt_info_hb3 = coex_stat->bt_info_c2h[rsp_source][6]; + + /* 0xff means BT is under WHCK test */ + coex_stat->bt_whck_test = (coex_stat->bt_info_lb2 == 0xff); + + inq_page = ((coex_stat->bt_info_lb2 & BIT(2)) == BIT(2)); + + if (inq_page != coex_stat->bt_inq_page) { + cancel_delayed_work_sync(&coex->bt_remain_work); + coex_stat->bt_inq_page = inq_page; + + if (inq_page) + coex_stat->bt_inq_remain = true; + else + ieee80211_queue_delayed_work(rtwdev->hw, + &coex->bt_remain_work, + 4 * HZ); + } + coex_stat->bt_acl_busy = ((coex_stat->bt_info_lb2 & BIT(3)) == BIT(3)); + if (chip->ble_hid_profile_support) { + if (coex_stat->bt_info_lb2 & BIT(5)) { + if (coex_stat->bt_info_hb1 & BIT(0)) { + /*BLE HID*/ + coex_stat->bt_ble_hid_exist = true; + } else { + coex_stat->bt_ble_hid_exist = false; + } + coex_stat->bt_ble_exist = false; + } else if (coex_stat->bt_info_hb1 & BIT(0)) { + /*RCU*/ + coex_stat->bt_ble_hid_exist = false; + coex_stat->bt_ble_exist = true; + } else { + coex_stat->bt_ble_hid_exist = false; + coex_stat->bt_ble_exist = false; + } + } else { + if (coex_stat->bt_info_hb1 & BIT(0)) { + if (coex_stat->bt_hid_slot == 1 && + coex_stat->hi_pri_rx + 100 < coex_stat->hi_pri_tx && + coex_stat->hi_pri_rx < 100) { + coex_stat->bt_ble_hid_exist = true; + coex_stat->bt_ble_exist = false; + } else { + coex_stat->bt_ble_hid_exist = false; + coex_stat->bt_ble_exist = true; + } + } else { + coex_stat->bt_ble_hid_exist = false; + coex_stat->bt_ble_exist = false; + } + } + + coex_stat->cnt_bt[COEX_CNT_BT_RETRY] = coex_stat->bt_info_lb3 & 0xf; + if (coex_stat->cnt_bt[COEX_CNT_BT_RETRY] >= 1) + coex_stat->cnt_bt[COEX_CNT_BT_POPEVENT]++; + + coex_stat->bt_fix_2M = ((coex_stat->bt_info_lb3 & BIT(4)) == BIT(4)); + coex_stat->bt_inq = ((coex_stat->bt_info_lb3 & BIT(5)) == BIT(5)); + if (coex_stat->bt_inq) + coex_stat->cnt_bt[COEX_CNT_BT_INQ]++; + + coex_stat->bt_page = ((coex_stat->bt_info_lb3 & BIT(7)) == BIT(7)); + if (coex_stat->bt_page) + coex_stat->cnt_bt[COEX_CNT_BT_PAGE]++; + + /* unit: % (value-100 to translate to unit: dBm in coex info) */ + if (chip->bt_rssi_type == COEX_BTRSSI_RATIO) { + coex_stat->bt_rssi = coex_stat->bt_info_hb0 * 2 + 10; + } else { + if (coex_stat->bt_info_hb0 <= 127) + coex_stat->bt_rssi = 100; + else if (256 - coex_stat->bt_info_hb0 <= 100) + coex_stat->bt_rssi = 100 - (256 - coex_stat->bt_info_hb0); + else + coex_stat->bt_rssi = 0; + } + + if (coex_stat->bt_info_hb1 & BIT(1)) + coex_stat->cnt_bt[COEX_CNT_BT_REINIT]++; + + if (coex_stat->bt_info_hb1 & BIT(2)) { + coex_stat->cnt_bt[COEX_CNT_BT_SETUPLINK]++; + coex_stat->bt_setup_link = true; + if (coex_stat->bt_reenable) + bt_relink_time = 6 * HZ; + else + bt_relink_time = 1 * HZ; + + ieee80211_queue_delayed_work(rtwdev->hw, + &coex->bt_relink_work, + bt_relink_time); + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], Re-Link start in BT info!!\n"); + } + + if (coex_stat->bt_info_hb1 & BIT(3)) + coex_stat->cnt_bt[COEX_CNT_BT_IGNWLANACT]++; + + coex_stat->bt_ble_voice = ((coex_stat->bt_info_hb1 & BIT(4)) == BIT(4)); + coex_stat->bt_ble_scan_en = ((coex_stat->bt_info_hb1 & BIT(5)) == BIT(5)); + if (coex_stat->bt_info_hb1 & BIT(6)) + coex_stat->cnt_bt[COEX_CNT_BT_ROLESWITCH]++; + + coex_stat->bt_multi_link = ((coex_stat->bt_info_hb1 & BIT(7)) == BIT(7)); + /* for multi_link = 0 but bt pkt remain exist */ + /* Use PS-TDMA to protect WL RX */ + if (!coex_stat->bt_multi_link && coex_stat->bt_multi_link_pre) { + coex_stat->bt_multi_link_remain = true; + ieee80211_queue_delayed_work(rtwdev->hw, + &coex->bt_multi_link_remain_work, + 3 * HZ); + } + coex_stat->bt_multi_link_pre = coex_stat->bt_multi_link; + + /* resend wifi info to bt, it is reset and lost the info */ + if (coex_stat->bt_info_hb1 & BIT(1)) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], BT Re-init, send wifi BW & Chnl to BT!!\n"); + + if (coex_stat->wl_connected) + type = COEX_MEDIA_CONNECT; + else + type = COEX_MEDIA_DISCONNECT; + rtw_coex_update_wl_ch_info(rtwdev, type); + } + + /* if ignore_wlan_act && not set_up_link */ + if ((coex_stat->bt_info_hb1 & BIT(3)) && + (!(coex_stat->bt_info_hb1 & BIT(2)))) { + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); + rtw_coex_ignore_wlan_act(rtwdev, false); + } + + coex_stat->bt_opp_exist = ((coex_stat->bt_info_hb2 & BIT(0)) == BIT(0)); + if (coex_stat->bt_info_hb2 & BIT(1)) + coex_stat->cnt_bt[COEX_CNT_BT_AFHUPDATE]++; + + coex_stat->bt_a2dp_active = (coex_stat->bt_info_hb2 & BIT(2)) == BIT(2); + coex_stat->bt_slave = ((coex_stat->bt_info_hb2 & BIT(3)) == BIT(3)); + coex_stat->bt_hid_slot = (coex_stat->bt_info_hb2 & 0x30) >> 4; + coex_stat->bt_hid_pair_num = (coex_stat->bt_info_hb2 & 0xc0) >> 6; + if (coex_stat->bt_hid_pair_num > 0 && coex_stat->bt_hid_slot >= 2) + coex_stat->bt_418_hid_exist = true; + else if (coex_stat->bt_hid_pair_num == 0 || coex_stat->bt_hid_slot == 1) + coex_stat->bt_418_hid_exist = false; + + if ((coex_stat->bt_info_lb2 & 0x49) == 0x49) + coex_stat->bt_a2dp_bitpool = (coex_stat->bt_info_hb3 & 0x7f); + else + coex_stat->bt_a2dp_bitpool = 0; + + coex_stat->bt_a2dp_sink = ((coex_stat->bt_info_hb3 & BIT(7)) == BIT(7)); + + rtw_coex_update_bt_link_info(rtwdev); + rtw_coex_run_coex(rtwdev, COEX_RSN_BTINFO); +} + +#define COEX_BT_HIDINFO_MTK 0x46 +static const u8 coex_bt_hidinfo_ps[] = {0x57, 0x69, 0x72}; +static const u8 coex_bt_hidinfo_xb[] = {0x58, 0x62, 0x6f}; + +void rtw_coex_bt_hid_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_hid *hidinfo; + struct rtw_coex_hid_info_a *hida; + struct rtw_coex_hid_handle_list *hl, *bhl; + u8 sub_id = buf[2], gamehid_cnt = 0, handle, i; + bool cur_game_hid_exist, complete; + + if (!chip->wl_mimo_ps_support && + (sub_id == COEX_BT_HIDINFO_LIST || sub_id == COEX_BT_HIDINFO_A)) + return; + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], HID info notify, sub_id = 0x%x\n", sub_id); + + switch (sub_id) { + case COEX_BT_HIDINFO_LIST: + hl = &coex_stat->hid_handle_list; + bhl = (struct rtw_coex_hid_handle_list *)buf; + if (!memcmp(hl, bhl, sizeof(*hl))) + return; + coex_stat->hid_handle_list = *bhl; + memset(&coex_stat->hid_info, 0, sizeof(coex_stat->hid_info)); + for (i = 0; i < COEX_BT_HIDINFO_HANDLE_NUM; i++) { + hidinfo = &coex_stat->hid_info[i]; + if (hl->handle[i] != COEX_BT_HIDINFO_NOTCON && + hl->handle[i] != 0) + hidinfo->hid_handle = hl->handle[i]; + } + break; + case COEX_BT_HIDINFO_A: + hida = (struct rtw_coex_hid_info_a *)buf; + handle = hida->handle; + for (i = 0; i < COEX_BT_HIDINFO_HANDLE_NUM; i++) { + hidinfo = &coex_stat->hid_info[i]; + if (hidinfo->hid_handle == handle) { + hidinfo->hid_vendor = hida->vendor; + memcpy(hidinfo->hid_name, hida->name, + sizeof(hidinfo->hid_name)); + hidinfo->hid_info_completed = true; + break; + } + } + break; + } + for (i = 0; i < COEX_BT_HIDINFO_HANDLE_NUM; i++) { + hidinfo = &coex_stat->hid_info[i]; + complete = hidinfo->hid_info_completed; + handle = hidinfo->hid_handle; + if (!complete || handle == COEX_BT_HIDINFO_NOTCON || + handle == 0 || handle >= COEX_BT_BLE_HANDLE_THRS) { + hidinfo->is_game_hid = false; + continue; + } + + if (hidinfo->hid_vendor == COEX_BT_HIDINFO_MTK) { + if ((memcmp(hidinfo->hid_name, + coex_bt_hidinfo_ps, + COEX_BT_HIDINFO_NAME)) == 0) + hidinfo->is_game_hid = true; + else if ((memcmp(hidinfo->hid_name, + coex_bt_hidinfo_xb, + COEX_BT_HIDINFO_NAME)) == 0) + hidinfo->is_game_hid = true; + else + hidinfo->is_game_hid = false; + } else { + hidinfo->is_game_hid = false; + } + if (hidinfo->is_game_hid) + gamehid_cnt++; + } + + if (gamehid_cnt > 0) + cur_game_hid_exist = true; + else + cur_game_hid_exist = false; + + if (cur_game_hid_exist != coex_stat->bt_game_hid_exist) { + coex_stat->bt_game_hid_exist = cur_game_hid_exist; + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], HID info changed!bt_game_hid_exist = %d!\n", + coex_stat->bt_game_hid_exist); + rtw_coex_run_coex(rtwdev, COEX_RSN_BTSTATUS); + } +} + +void rtw_coex_query_bt_hid_list(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_hid *hidinfo; + u8 i, handle; + bool complete; + + if (!chip->wl_mimo_ps_support || coex_stat->wl_under_ips || + (coex_stat->wl_under_lps && !coex_stat->wl_force_lps_ctrl)) + return; + + if (!coex_stat->bt_hid_exist && + !((coex_stat->bt_info_lb2 & COEX_INFO_CONNECTION) && + (coex_stat->hi_pri_tx + coex_stat->hi_pri_rx > + COEX_BT_GAMEHID_CNT))) + return; + + rtw_fw_coex_query_hid_info(rtwdev, COEX_BT_HIDINFO_LIST, 0); + + for (i = 0; i < COEX_BT_HIDINFO_HANDLE_NUM; i++) { + hidinfo = &coex_stat->hid_info[i]; + complete = hidinfo->hid_info_completed; + handle = hidinfo->hid_handle; + if (handle == 0 || handle == COEX_BT_HIDINFO_NOTCON || + handle >= COEX_BT_BLE_HANDLE_THRS || complete) + continue; + + rtw_fw_coex_query_hid_info(rtwdev, + COEX_BT_HIDINFO_A, + handle); + } +} + +void rtw_coex_wl_fwdbginfo_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u8 val; + int i; + + rtw_dbg(rtwdev, RTW_DBG_COEX, + "[BTCoex], WiFi Fw Dbg info = %8ph (len = %d)\n", + buf, length); + if (WARN(length < 8, "invalid wl info c2h length\n")) + return; + + if (buf[0] != 0x08) + return; + + for (i = 1; i < 8; i++) { + val = coex_stat->wl_fw_dbg_info_pre[i]; + if (buf[i] >= val) + coex_stat->wl_fw_dbg_info[i] = buf[i] - val; + else + coex_stat->wl_fw_dbg_info[i] = 255 - val + buf[i]; + + coex_stat->wl_fw_dbg_info_pre[i] = buf[i]; + } + + coex_stat->cnt_wl[COEX_CNT_WL_FW_NOTIFY]++; + rtw_coex_wl_ccklock_action(rtwdev); + rtw_coex_wl_ccklock_detect(rtwdev); +} + +void rtw_coex_wl_status_change_notify(struct rtw_dev *rtwdev, u32 type) +{ + rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); +} + +void rtw_coex_wl_status_check(struct rtw_dev *rtwdev) +{ + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + + if ((coex_stat->wl_under_lps && !coex_stat->wl_force_lps_ctrl) || + coex_stat->wl_under_ips) + return; + + rtw_coex_monitor_bt_ctr(rtwdev); +} + +void rtw_coex_bt_relink_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + coex.bt_relink_work.work); + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + + mutex_lock(&rtwdev->mutex); + coex_stat->bt_setup_link = false; + rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); + mutex_unlock(&rtwdev->mutex); +} + +void rtw_coex_bt_reenable_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + coex.bt_reenable_work.work); + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + + mutex_lock(&rtwdev->mutex); + coex_stat->bt_reenable = false; + mutex_unlock(&rtwdev->mutex); +} + +void rtw_coex_defreeze_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + coex.defreeze_work.work); + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + + mutex_lock(&rtwdev->mutex); + coex->freeze = false; + coex_stat->wl_hi_pri_task1 = false; + rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); + mutex_unlock(&rtwdev->mutex); +} + +void rtw_coex_wl_remain_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + coex.wl_remain_work.work); + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + + mutex_lock(&rtwdev->mutex); + coex_stat->wl_gl_busy = test_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags); + rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); + mutex_unlock(&rtwdev->mutex); +} + +void rtw_coex_bt_remain_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + coex.bt_remain_work.work); + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + + mutex_lock(&rtwdev->mutex); + coex_stat->bt_inq_remain = coex_stat->bt_inq_page; + rtw_coex_run_coex(rtwdev, COEX_RSN_BTSTATUS); + mutex_unlock(&rtwdev->mutex); +} + +void rtw_coex_wl_connecting_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + coex.wl_connecting_work.work); + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + + mutex_lock(&rtwdev->mutex); + coex_stat->wl_connecting = false; + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], WL connecting stop!!\n"); + rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); + mutex_unlock(&rtwdev->mutex); +} + +void rtw_coex_bt_multi_link_remain_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + coex.bt_multi_link_remain_work.work); + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + + mutex_lock(&rtwdev->mutex); + coex_stat->bt_multi_link_remain = false; + mutex_unlock(&rtwdev->mutex); +} + +void rtw_coex_wl_ccklock_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + coex.wl_ccklock_work.work); + struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; + + mutex_lock(&rtwdev->mutex); + coex_stat->wl_cck_lock = false; + mutex_unlock(&rtwdev->mutex); +} + +#ifdef CONFIG_RTW88_DEBUGFS +#define INFO_SIZE 80 + +#define case_BTINFO(src) \ + case COEX_BTINFO_SRC_##src: return #src + +static const char *rtw_coex_get_bt_info_src_string(u8 bt_info_src) +{ + switch (bt_info_src) { + case_BTINFO(WL_FW); + case_BTINFO(BT_RSP); + case_BTINFO(BT_ACT); + default: + return "Unknown"; + } +} + +#define case_RSN(src) \ + case COEX_RSN_##src: return #src + +static const char *rtw_coex_get_reason_string(u8 reason) +{ + switch (reason) { + case_RSN(2GSCANSTART); + case_RSN(5GSCANSTART); + case_RSN(SCANFINISH); + case_RSN(2GSWITCHBAND); + case_RSN(5GSWITCHBAND); + case_RSN(2GCONSTART); + case_RSN(5GCONSTART); + case_RSN(2GCONFINISH); + case_RSN(5GCONFINISH); + case_RSN(2GMEDIA); + case_RSN(5GMEDIA); + case_RSN(MEDIADISCON); + case_RSN(BTINFO); + case_RSN(LPS); + case_RSN(WLSTATUS); + default: + return "Unknown"; + } +} + +static u8 rtw_coex_get_table_index(struct rtw_dev *rtwdev, u32 wl_reg_6c0, + u32 wl_reg_6c4) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 ans = 0xFF; + u8 n, i; + u32 load_bt_val; + u32 load_wl_val; + bool share_ant = efuse->share_ant; + + if (share_ant) + n = chip->table_sant_num; + else + n = chip->table_nsant_num; + + for (i = 0; i < n; i++) { + if (share_ant) { + load_bt_val = chip->table_sant[i].bt; + load_wl_val = chip->table_sant[i].wl; + } else { + load_bt_val = chip->table_nsant[i].bt; + load_wl_val = chip->table_nsant[i].wl; + } + + if (wl_reg_6c0 == load_bt_val && + wl_reg_6c4 == load_wl_val) { + ans = i; + if (!share_ant) + ans += 100; + break; + } + } + + return ans; +} + +static u8 rtw_coex_get_tdma_index(struct rtw_dev *rtwdev, u8 *tdma_para) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 ans = 0xFF; + u8 n, i, j; + u8 load_cur_tab_val; + bool valid = false; + bool share_ant = efuse->share_ant; + + if (share_ant) + n = chip->tdma_sant_num; + else + n = chip->tdma_nsant_num; + + for (i = 0; i < n; i++) { + valid = false; + for (j = 0; j < 5; j++) { + if (share_ant) + load_cur_tab_val = chip->tdma_sant[i].para[j]; + else + load_cur_tab_val = chip->tdma_nsant[i].para[j]; + + if (*(tdma_para + j) != load_cur_tab_val) + break; + + if (j == 4) + valid = true; + } + if (valid) { + ans = i; + break; + } + } + + return ans; +} + +static int rtw_coex_addr_info(struct rtw_dev *rtwdev, + const struct rtw_reg_domain *reg, + char addr_info[], int n) +{ + const char *rf_prefix = ""; + const char *sep = n == 0 ? "" : "/ "; + int ffs, fls; + int max_fls; + + if (INFO_SIZE - n <= 0) + return 0; + + switch (reg->domain) { + case RTW_REG_DOMAIN_MAC32: + max_fls = 31; + break; + case RTW_REG_DOMAIN_MAC16: + max_fls = 15; + break; + case RTW_REG_DOMAIN_MAC8: + max_fls = 7; + break; + case RTW_REG_DOMAIN_RF_A: + case RTW_REG_DOMAIN_RF_B: + rf_prefix = "RF_"; + max_fls = 19; + break; + default: + return 0; + } + + ffs = __ffs(reg->mask); + fls = __fls(reg->mask); + + if (ffs == 0 && fls == max_fls) + return scnprintf(addr_info + n, INFO_SIZE - n, "%s%s%x", + sep, rf_prefix, reg->addr); + else if (ffs == fls) + return scnprintf(addr_info + n, INFO_SIZE - n, "%s%s%x[%d]", + sep, rf_prefix, reg->addr, ffs); + else + return scnprintf(addr_info + n, INFO_SIZE - n, "%s%s%x[%d:%d]", + sep, rf_prefix, reg->addr, fls, ffs); +} + +static int rtw_coex_val_info(struct rtw_dev *rtwdev, + const struct rtw_reg_domain *reg, + char val_info[], int n) +{ + const char *sep = n == 0 ? "" : "/ "; + u8 rf_path; + + if (INFO_SIZE - n <= 0) + return 0; + + switch (reg->domain) { + case RTW_REG_DOMAIN_MAC32: + return scnprintf(val_info + n, INFO_SIZE - n, "%s0x%x", sep, + rtw_read32_mask(rtwdev, reg->addr, reg->mask)); + case RTW_REG_DOMAIN_MAC16: + return scnprintf(val_info + n, INFO_SIZE - n, "%s0x%x", sep, + rtw_read16_mask(rtwdev, reg->addr, reg->mask)); + case RTW_REG_DOMAIN_MAC8: + return scnprintf(val_info + n, INFO_SIZE - n, "%s0x%x", sep, + rtw_read8_mask(rtwdev, reg->addr, reg->mask)); + case RTW_REG_DOMAIN_RF_A: + rf_path = RF_PATH_A; + break; + case RTW_REG_DOMAIN_RF_B: + rf_path = RF_PATH_B; + break; + default: + return 0; + } + + /* only RF go through here */ + return scnprintf(val_info + n, INFO_SIZE - n, "%s0x%x", sep, + rtw_read_rf(rtwdev, rf_path, reg->addr, reg->mask)); +} + +static void rtw_coex_set_coexinfo_hw(struct rtw_dev *rtwdev, struct seq_file *m) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + const struct rtw_reg_domain *reg; + char addr_info[INFO_SIZE]; + int n_addr = 0; + char val_info[INFO_SIZE]; + int n_val = 0; + int i; + + for (i = 0; i < chip->coex_info_hw_regs_num; i++) { + reg = &chip->coex_info_hw_regs[i]; + + n_addr += rtw_coex_addr_info(rtwdev, reg, addr_info, n_addr); + n_val += rtw_coex_val_info(rtwdev, reg, val_info, n_val); + + if (reg->domain == RTW_REG_DOMAIN_NL) { + seq_printf(m, "%-40s = %s\n", addr_info, val_info); + n_addr = 0; + n_val = 0; + } + } + + if (n_addr != 0 && n_val != 0) + seq_printf(m, "%-40s = %s\n", addr_info, val_info); +} + +static bool rtw_coex_get_bt_reg(struct rtw_dev *rtwdev, + u8 type, u16 addr, u16 *val) +{ + struct rtw_coex_info_req req = {0}; + struct sk_buff *skb; + __le16 le_addr; + u8 *payload; + + le_addr = cpu_to_le16(addr); + req.op_code = BT_MP_INFO_OP_READ_REG; + req.para1 = type; + req.para2 = le16_get_bits(le_addr, GENMASK(7, 0)); + req.para3 = le16_get_bits(le_addr, GENMASK(15, 8)); + skb = rtw_coex_info_request(rtwdev, &req); + if (!skb) { + *val = 0xeaea; + return false; + } + + payload = get_payload_from_coex_resp(skb); + *val = GET_COEX_RESP_BT_REG_VAL(payload); + dev_kfree_skb_any(skb); + + return true; +} + +static bool rtw_coex_get_bt_patch_version(struct rtw_dev *rtwdev, + u32 *patch_version) +{ + struct rtw_coex_info_req req = {0}; + struct sk_buff *skb; + u8 *payload; + + req.op_code = BT_MP_INFO_OP_PATCH_VER; + skb = rtw_coex_info_request(rtwdev, &req); + if (!skb) + return false; + + payload = get_payload_from_coex_resp(skb); + *patch_version = GET_COEX_RESP_BT_PATCH_VER(payload); + dev_kfree_skb_any(skb); + + return true; +} + +static bool rtw_coex_get_bt_supported_version(struct rtw_dev *rtwdev, + u32 *supported_version) +{ + struct rtw_coex_info_req req = {0}; + struct sk_buff *skb; + u8 *payload; + + req.op_code = BT_MP_INFO_OP_SUPP_VER; + skb = rtw_coex_info_request(rtwdev, &req); + if (!skb) + return false; + + payload = get_payload_from_coex_resp(skb); + *supported_version = GET_COEX_RESP_BT_SUPP_VER(payload); + dev_kfree_skb_any(skb); + + return true; +} + +static bool rtw_coex_get_bt_supported_feature(struct rtw_dev *rtwdev, + u32 *supported_feature) +{ + struct rtw_coex_info_req req = {0}; + struct sk_buff *skb; + u8 *payload; + + req.op_code = BT_MP_INFO_OP_SUPP_FEAT; + skb = rtw_coex_info_request(rtwdev, &req); + if (!skb) + return false; + + payload = get_payload_from_coex_resp(skb); + *supported_feature = GET_COEX_RESP_BT_SUPP_FEAT(payload); + dev_kfree_skb_any(skb); + + return true; +} + +struct rtw_coex_sta_stat_iter_data { + struct rtw_vif *rtwvif; + struct seq_file *file; +}; + +static void rtw_coex_sta_stat_iter(void *data, struct ieee80211_sta *sta) +{ + struct rtw_coex_sta_stat_iter_data *sta_iter_data = data; + struct rtw_vif *rtwvif = sta_iter_data->rtwvif; + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + struct seq_file *m = sta_iter_data->file; + struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif); + u8 rssi; + + if (si->vif != vif) + return; + + rssi = ewma_rssi_read(&si->avg_rssi); + seq_printf(m, "\tPeer %3d\n", si->mac_id); + seq_printf(m, "\t\t%-24s = %d\n", "RSSI", rssi); + seq_printf(m, "\t\t%-24s = %d\n", "BW mode", si->bw_mode); +} + +struct rtw_coex_vif_stat_iter_data { + struct rtw_dev *rtwdev; + struct seq_file *file; +}; + +static void rtw_coex_vif_stat_iter(void *data, u8 *mac, + struct ieee80211_vif *vif) +{ + struct rtw_coex_vif_stat_iter_data *vif_iter_data = data; + struct rtw_coex_sta_stat_iter_data sta_iter_data; + struct rtw_dev *rtwdev = vif_iter_data->rtwdev; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + struct seq_file *m = vif_iter_data->file; + struct ieee80211_bss_conf *bss_conf = &vif->bss_conf; + + seq_printf(m, "Iface on Port (%d)\n", rtwvif->port); + seq_printf(m, "\t%-32s = %d\n", + "Beacon interval", bss_conf->beacon_int); + seq_printf(m, "\t%-32s = %d\n", + "Network Type", rtwvif->net_type); + + sta_iter_data.rtwvif = rtwvif; + sta_iter_data.file = m; + rtw_iterate_stas_atomic(rtwdev, rtw_coex_sta_stat_iter, + &sta_iter_data); +} + +#define case_WLINK(src) \ + case COEX_WLINK_##src: return #src + +static const char *rtw_coex_get_wl_coex_mode(u8 coex_wl_link_mode) +{ + switch (coex_wl_link_mode) { + case_WLINK(2G1PORT); + case_WLINK(5G); + case_WLINK(2GFREE); + default: + return "Unknown"; + } +} + +void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_fw_state *fw = &rtwdev->fw; + struct rtw_coex_vif_stat_iter_data vif_iter_data; + u8 reason = coex_dm->reason; + u8 sys_lte; + u16 score_board_WB, score_board_BW; + u32 wl_reg_6c0, wl_reg_6c4, wl_reg_6c8, wl_reg_778, wl_reg_6cc; + u32 lte_coex, bt_coex; + int i; + + score_board_BW = rtw_coex_read_scbd(rtwdev); + score_board_WB = coex_stat->score_board; + wl_reg_6c0 = rtw_read32(rtwdev, REG_BT_COEX_TABLE0); + wl_reg_6c4 = rtw_read32(rtwdev, REG_BT_COEX_TABLE1); + wl_reg_6c8 = rtw_read32(rtwdev, REG_BT_COEX_BRK_TABLE); + wl_reg_6cc = rtw_read32(rtwdev, REG_BT_COEX_TABLE_H); + wl_reg_778 = rtw_read8(rtwdev, REG_BT_STAT_CTRL); + + sys_lte = rtw_read8(rtwdev, 0x73); + lte_coex = rtw_coex_read_indirect_reg(rtwdev, 0x38); + bt_coex = rtw_coex_read_indirect_reg(rtwdev, 0x54); + + if (!coex_stat->bt_disabled && !coex_stat->bt_mailbox_reply) { + rtw_coex_get_bt_supported_version(rtwdev, + &coex_stat->bt_supported_version); + rtw_coex_get_bt_patch_version(rtwdev, &coex_stat->patch_ver); + rtw_coex_get_bt_supported_feature(rtwdev, + &coex_stat->bt_supported_feature); + rtw_coex_get_bt_reg(rtwdev, 3, 0xae, &coex_stat->bt_reg_vendor_ae); + rtw_coex_get_bt_reg(rtwdev, 3, 0xac, &coex_stat->bt_reg_vendor_ac); + + if (coex_stat->patch_ver != 0) + coex_stat->bt_mailbox_reply = true; + } + + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], %s()\n", __func__); + seq_printf(m, "**********************************************\n"); + seq_printf(m, "\t\tBT Coexist info %x\n", chip->id); + seq_printf(m, "**********************************************\n"); + + if (coex->manual_control) { + seq_puts(m, "============[Under Manual Control]============\n"); + seq_puts(m, "==========================================\n"); + + } else if (coex->stop_dm) { + seq_puts(m, "============[Coex is STOPPED]============\n"); + seq_puts(m, "==========================================\n"); + + } else if (coex->freeze) { + seq_puts(m, "============[coex_freeze]============\n"); + seq_puts(m, "==========================================\n"); + } + + seq_printf(m, "%-40s = %s/ %d\n", + "Mech/ RFE", + efuse->share_ant ? "Shared" : "Non-Shared", + efuse->rfe_option); + seq_printf(m, "%-40s = %08x/ 0x%02x/ 0x%08x %s\n", + "Coex Ver/ BT Dez/ BT Rpt", + chip->coex_para_ver, chip->bt_desired_ver, + coex_stat->bt_supported_version, + coex_stat->bt_disabled ? "(BT disabled)" : + coex_stat->bt_supported_version >= chip->bt_desired_ver ? + "(Match)" : "(Mismatch)"); + seq_printf(m, "%-40s = %s/ %u/ %d\n", + "Role/ RoleSwCnt/ IgnWL/ Feature", + coex_stat->bt_slave ? "Slave" : "Master", + coex_stat->cnt_bt[COEX_CNT_BT_ROLESWITCH], + coex_dm->ignore_wl_act); + seq_printf(m, "%-40s = %u.%u/ 0x%x/ 0x%x/ %c\n", + "WL FW/ BT FW/ BT FW Desired/ KT", + fw->version, fw->sub_version, + coex_stat->patch_ver, + chip->wl_fw_desired_ver, coex_stat->kt_ver + 65); + seq_printf(m, "%-40s = %u/ %u/ %u/ ch-(%u)\n", + "AFH Map", + coex_dm->wl_ch_info[0], coex_dm->wl_ch_info[1], + coex_dm->wl_ch_info[2], hal->current_channel); + + rtw_debugfs_get_simple_phy_info(m); + seq_printf(m, "**********************************************\n"); + seq_printf(m, "\t\tBT Status\n"); + seq_printf(m, "**********************************************\n"); + seq_printf(m, "%-40s = %s/ %ddBm/ %u/ %u\n", + "BT status/ rssi/ retry/ pop", + coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE ? "non-conn" : + coex_dm->bt_status == COEX_BTSTATUS_CON_IDLE ? "conn-idle" : "busy", + coex_stat->bt_rssi - 100, + coex_stat->cnt_bt[COEX_CNT_BT_RETRY], + coex_stat->cnt_bt[COEX_CNT_BT_POPEVENT]); + seq_printf(m, "%-40s = %s%s%s%s%s (multi-link %d)\n", + "Profiles", + coex_stat->bt_a2dp_exist ? (coex_stat->bt_a2dp_sink ? + "A2DP sink," : "A2DP,") : "", + coex_stat->bt_hfp_exist ? "HFP," : "", + coex_stat->bt_hid_exist ? + (coex_stat->bt_ble_exist ? "HID(RCU)," : + coex_stat->bt_hid_slot >= 2 ? "HID(4/18)" : + coex_stat->bt_ble_hid_exist ? "HID(BLE)" : + "HID(2/18),") : "", + coex_stat->bt_pan_exist ? coex_stat->bt_opp_exist ? + "OPP," : "PAN," : "", + coex_stat->bt_ble_voice ? "Voice," : "", + coex_stat->bt_multi_link); + seq_printf(m, "%-40s = %u/ %u/ %u/ 0x%08x\n", + "Reinit/ Relink/ IgnWl/ Feature", + coex_stat->cnt_bt[COEX_CNT_BT_REINIT], + coex_stat->cnt_bt[COEX_CNT_BT_SETUPLINK], + coex_stat->cnt_bt[COEX_CNT_BT_IGNWLANACT], + coex_stat->bt_supported_feature); + seq_printf(m, "%-40s = %u/ %u/ %u/ %u\n", + "Page/ Inq/ iqk/ iqk fail", + coex_stat->cnt_bt[COEX_CNT_BT_PAGE], + coex_stat->cnt_bt[COEX_CNT_BT_INQ], + coex_stat->cnt_bt[COEX_CNT_BT_IQK], + coex_stat->cnt_bt[COEX_CNT_BT_IQKFAIL]); + seq_printf(m, "%-40s = 0x%04x/ 0x%04x/ 0x%04x/ 0x%04x\n", + "0xae/ 0xac/ score board (W->B)/ (B->W)", + coex_stat->bt_reg_vendor_ae, + coex_stat->bt_reg_vendor_ac, + score_board_WB, score_board_BW); + seq_printf(m, "%-40s = %u/%u, %u/%u\n", + "Hi-Pri TX/RX, Lo-Pri TX/RX", + coex_stat->hi_pri_tx, coex_stat->hi_pri_rx, + coex_stat->lo_pri_tx, coex_stat->lo_pri_rx); + for (i = 0; i < COEX_BTINFO_SRC_BT_IQK; i++) + seq_printf(m, "%-40s = %7ph\n", + rtw_coex_get_bt_info_src_string(i), + coex_stat->bt_info_c2h[i]); + + seq_printf(m, "**********************************************\n"); + seq_printf(m, "\t\tWiFi Status\n"); + seq_printf(m, "**********************************************\n"); + seq_printf(m, "%-40s = %d\n", + "Scanning", test_bit(RTW_FLAG_SCANNING, rtwdev->flags)); + seq_printf(m, "%-40s = %u/ TX %d Mbps/ RX %d Mbps\n", + "G_busy/ TX/ RX", + coex_stat->wl_gl_busy, + rtwdev->stats.tx_throughput, rtwdev->stats.rx_throughput); + seq_printf(m, "%-40s = %u/ %u/ %u\n", + "IPS/ Low Power/ PS mode", + !test_bit(RTW_FLAG_POWERON, rtwdev->flags), + test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags), + rtwdev->lps_conf.mode); + + vif_iter_data.rtwdev = rtwdev; + vif_iter_data.file = m; + rtw_iterate_vifs_atomic(rtwdev, rtw_coex_vif_stat_iter, &vif_iter_data); + + if (coex->manual_control) { + seq_printf(m, "**********************************************\n"); + seq_printf(m, "\t\tMechanism (Under Manual)\n"); + seq_printf(m, "**********************************************\n"); + seq_printf(m, "%-40s = %5ph (%d)\n", + "TDMA Now", + coex_dm->fw_tdma_para, + rtw_coex_get_tdma_index(rtwdev, + &coex_dm->fw_tdma_para[0])); + } else { + seq_printf(m, "**********************************************\n"); + seq_printf(m, "\t\tMechanism\n"); + seq_printf(m, "**********************************************\n"); + seq_printf(m, "%-40s = %5ph (case-%d)\n", + "TDMA", + coex_dm->ps_tdma_para, coex_dm->cur_ps_tdma); + } + seq_printf(m, "%-40s = %s/ %s/ %d\n", + "Coex Mode/Free Run/Timer base", + rtw_coex_get_wl_coex_mode(coex_stat->wl_coex_mode), + coex->freerun ? "Yes" : "No", + coex_stat->tdma_timer_base); + seq_printf(m, "%-40s = %d(%d)/ 0x%08x/ 0x%08x/ 0x%08x\n", + "Table/ 0x6c0/ 0x6c4/ 0x6c8", + coex_dm->cur_table, + rtw_coex_get_table_index(rtwdev, wl_reg_6c0, wl_reg_6c4), + wl_reg_6c0, wl_reg_6c4, wl_reg_6c8); + seq_printf(m, "%-40s = 0x%08x/ 0x%08x/ %d/ reason (%s)\n", + "0x778/ 0x6cc/ Run Count/ Reason", + wl_reg_778, wl_reg_6cc, + coex_stat->cnt_wl[COEX_CNT_WL_COEXRUN], + rtw_coex_get_reason_string(reason)); + seq_printf(m, "%-40s = %3ph\n", + "AFH Map to BT", + coex_dm->wl_ch_info); + seq_printf(m, "%-40s = %s/ %d\n", + "AntDiv/ BtCtrlLPS/ g_busy", + coex_stat->wl_force_lps_ctrl ? "On" : "Off", + coex_stat->wl_gl_busy); + seq_printf(m, "%-40s = %u/ %u/ %u/ %u/ %u\n", + "Null All/ Retry/ Ack/ BT Empty/ BT Late", + coex_stat->wl_fw_dbg_info[1], coex_stat->wl_fw_dbg_info[2], + coex_stat->wl_fw_dbg_info[3], coex_stat->wl_fw_dbg_info[4], + coex_stat->wl_fw_dbg_info[5]); + seq_printf(m, "%-40s = %u/ %u/ %s/ %u\n", + "Cnt TDMA Toggle/ Lk 5ms/ Lk 5ms on/ FW", + coex_stat->wl_fw_dbg_info[6], + coex_stat->wl_fw_dbg_info[7], + coex_stat->wl_slot_extend ? "Yes" : "No", + coex_stat->cnt_wl[COEX_CNT_WL_FW_NOTIFY]); + seq_printf(m, "%-40s = %d/ %d/ %s/ %d\n", + "WL_TxPw/ BT_TxPw/ WL_Rx/ BT_LNA_Lvl", + coex_dm->cur_wl_pwr_lvl, + coex_dm->cur_bt_pwr_lvl, + coex_dm->cur_wl_rx_low_gain_en ? "On" : "Off", + coex_dm->cur_bt_lna_lvl); + + seq_printf(m, "**********************************************\n"); + seq_printf(m, "\t\tHW setting\n"); + seq_printf(m, "**********************************************\n"); + seq_printf(m, "%-40s = %s/ %s\n", + "LTE Coex/ Path Owner", + lte_coex & BIT(7) ? "ON" : "OFF", + sys_lte & BIT(2) ? "WL" : "BT"); + seq_printf(m, "%-40s = RF:%s_BB:%s/ RF:%s_BB:%s/ %s\n", + "GNT_WL_CTRL/ GNT_BT_CTRL/ Dbg", + lte_coex & BIT(12) ? "SW" : "HW", + lte_coex & BIT(8) ? "SW" : "HW", + lte_coex & BIT(14) ? "SW" : "HW", + lte_coex & BIT(10) ? "SW" : "HW", + sys_lte & BIT(3) ? "On" : "Off"); + seq_printf(m, "%-40s = %lu/ %lu\n", + "GNT_WL/ GNT_BT", + (bt_coex & BIT(2)) >> 2, (bt_coex & BIT(3)) >> 3); + seq_printf(m, "%-40s = %u/ %u/ %u/ %u\n", + "CRC OK CCK/ OFDM/ HT/ VHT", + dm_info->cck_ok_cnt, dm_info->ofdm_ok_cnt, + dm_info->ht_ok_cnt, dm_info->vht_ok_cnt); + seq_printf(m, "%-40s = %u/ %u/ %u/ %u\n", + "CRC ERR CCK/ OFDM/ HT/ VHT", + dm_info->cck_err_cnt, dm_info->ofdm_err_cnt, + dm_info->ht_err_cnt, dm_info->vht_err_cnt); + seq_printf(m, "%-40s = %s/ %s/ %s/ %u\n", + "HiPr/ Locking/ Locked/ Noisy", + coex_stat->wl_hi_pri_task1 ? "Y" : "N", + coex_stat->wl_cck_lock ? "Y" : "N", + coex_stat->wl_cck_lock_ever ? "Y" : "N", + coex_stat->wl_noisy_level); + + rtw_coex_set_coexinfo_hw(rtwdev, m); + seq_printf(m, "%-40s = %d/ %d/ %d/ %d\n", + "EVM A/ EVM B/ SNR A/ SNR B", + -dm_info->rx_evm_dbm[RF_PATH_A], + -dm_info->rx_evm_dbm[RF_PATH_B], + -dm_info->rx_snr[RF_PATH_A], + -dm_info->rx_snr[RF_PATH_B]); + seq_printf(m, "%-40s = %d/ %d/ %d/ %d\n", + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + dm_info->cck_cca_cnt, dm_info->cck_fa_cnt, + dm_info->ofdm_cca_cnt, dm_info->ofdm_fa_cnt); + seq_printf(m, "%-40s = %d/ %d/ %d/ %d\n", "CRC OK CCK/11g/11n/11ac", + dm_info->cck_ok_cnt, dm_info->ofdm_ok_cnt, + dm_info->ht_ok_cnt, dm_info->vht_ok_cnt); + seq_printf(m, "%-40s = %d/ %d/ %d/ %d\n", "CRC Err CCK/11g/11n/11ac", + dm_info->cck_err_cnt, dm_info->ofdm_err_cnt, + dm_info->ht_err_cnt, dm_info->vht_err_cnt); + +} +#endif /* CONFIG_RTW88_DEBUGFS */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/coex.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/coex.h new file mode 100644 index 0000000000000000000000000000000000000000..57cf29da9ea4e34e777e98ca3f6f52885b173991 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/coex.h @@ -0,0 +1,422 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_COEX_H__ +#define __RTW_COEX_H__ + +#define COEX_CCK_2 0x1 +#define COEX_RESP_ACK_BY_WL_FW 0x1 +#define COEX_REQUEST_TIMEOUT msecs_to_jiffies(10) + +#define COEX_MIN_DELAY 10 /* delay unit in ms */ +#define COEX_RFK_TIMEOUT 600 /* RFK timeout in ms */ +#define COEX_BT_GAMEHID_CNT 800 + +#define COEX_RF_OFF 0x0 +#define COEX_RF_ON 0x1 + +#define COEX_H2C69_WL_LEAKAP 0xc +#define PARA1_H2C69_DIS_5MS 0x1 +#define PARA1_H2C69_EN_5MS 0x0 + +#define COEX_H2C69_TDMA_SLOT 0xb +#define PARA1_H2C69_TDMA_4SLOT 0xc1 +#define PARA1_H2C69_TDMA_2SLOT 0x1 +#define PARA1_H2C69_TBTT_TIMES GENMASK(5, 0) +#define PARA1_H2C69_TBTT_DIV100 BIT(7) + +#define COEX_H2C69_TOGGLE_TABLE_A 0xd +#define COEX_H2C69_TOGGLE_TABLE_B 0x7 + +#define TDMA_4SLOT BIT(8) + +#define TDMA_TIMER_TYPE_2SLOT 0 +#define TDMA_TIMER_TYPE_4SLOT 3 + +#define COEX_RSSI_STEP 4 + +#define COEX_RSSI_HIGH(rssi) \ + ({ typeof(rssi) __rssi__ = rssi; \ + (__rssi__ == COEX_RSSI_STATE_HIGH || \ + __rssi__ == COEX_RSSI_STATE_STAY_HIGH ? true : false); }) + +#define COEX_RSSI_MEDIUM(rssi) \ + ({ typeof(rssi) __rssi__ = rssi; \ + (__rssi__ == COEX_RSSI_STATE_MEDIUM || \ + __rssi__ == COEX_RSSI_STATE_STAY_MEDIUM ? true : false); }) + +#define COEX_RSSI_LOW(rssi) \ + ({ typeof(rssi) __rssi__ = rssi; \ + (__rssi__ == COEX_RSSI_STATE_LOW || \ + __rssi__ == COEX_RSSI_STATE_STAY_LOW ? true : false); }) + +#define GET_COEX_RESP_BT_SUPP_VER(payload) \ + le64_get_bits(*((__le64 *)(payload)), GENMASK_ULL(39, 32)) +#define GET_COEX_RESP_BT_SUPP_FEAT(payload) \ + le64_get_bits(*((__le64 *)(payload)), GENMASK_ULL(39, 24)) +#define GET_COEX_RESP_BT_PATCH_VER(payload) \ + le64_get_bits(*((__le64 *)(payload)), GENMASK_ULL(55, 24)) +#define GET_COEX_RESP_BT_REG_VAL(payload) \ + le64_get_bits(*((__le64 *)(payload)), GENMASK_ULL(39, 24)) +#define GET_COEX_RESP_BT_SCAN_TYPE(payload) \ + le64_get_bits(*((__le64 *)(payload)), GENMASK(31, 24)) + +enum coex_mp_info_op { + BT_MP_INFO_OP_PATCH_VER = 0x00, + BT_MP_INFO_OP_READ_REG = 0x11, + BT_MP_INFO_OP_SUPP_FEAT = 0x2a, + BT_MP_INFO_OP_SUPP_VER = 0x2b, + BT_MP_INFO_OP_SCAN_TYPE = 0x2d, + BT_MP_INFO_OP_LNA_CONSTRAINT = 0x32, +}; + +enum coex_set_ant_phase { + COEX_SET_ANT_INIT, + COEX_SET_ANT_WONLY, + COEX_SET_ANT_WOFF, + COEX_SET_ANT_2G, + COEX_SET_ANT_5G, + COEX_SET_ANT_POWERON, + COEX_SET_ANT_2G_WLBT, + COEX_SET_ANT_2G_FREERUN, + + COEX_SET_ANT_MAX +}; + +enum coex_runreason { + COEX_RSN_2GSCANSTART = 0, + COEX_RSN_5GSCANSTART = 1, + COEX_RSN_SCANFINISH = 2, + COEX_RSN_2GSWITCHBAND = 3, + COEX_RSN_5GSWITCHBAND = 4, + COEX_RSN_2GCONSTART = 5, + COEX_RSN_5GCONSTART = 6, + COEX_RSN_2GCONFINISH = 7, + COEX_RSN_5GCONFINISH = 8, + COEX_RSN_2GMEDIA = 9, + COEX_RSN_5GMEDIA = 10, + COEX_RSN_MEDIADISCON = 11, + COEX_RSN_BTINFO = 12, + COEX_RSN_LPS = 13, + COEX_RSN_WLSTATUS = 14, + COEX_RSN_BTSTATUS = 15, + + COEX_RSN_MAX +}; + +enum coex_lte_coex_table_type { + COEX_CTT_WL_VS_LTE, + COEX_CTT_BT_VS_LTE, +}; + +enum coex_gnt_setup_state { + COEX_GNT_SET_HW_PTA = 0x0, + COEX_GNT_SET_SW_LOW = 0x1, + COEX_GNT_SET_SW_HIGH = 0x3, +}; + +enum coex_ext_ant_switch_pos_type { + COEX_SWITCH_TO_BT, + COEX_SWITCH_TO_WLG, + COEX_SWITCH_TO_WLA, + COEX_SWITCH_TO_NOCARE, + COEX_SWITCH_TO_WLG_BT, + + COEX_SWITCH_TO_MAX +}; + +enum coex_ext_ant_switch_ctrl_type { + COEX_SWITCH_CTRL_BY_BBSW, + COEX_SWITCH_CTRL_BY_PTA, + COEX_SWITCH_CTRL_BY_ANTDIV, + COEX_SWITCH_CTRL_BY_MAC, + COEX_SWITCH_CTRL_BY_BT, + COEX_SWITCH_CTRL_BY_FW, + + COEX_SWITCH_CTRL_MAX +}; + +enum coex_algorithm { + COEX_ALGO_NOPROFILE = 0, + COEX_ALGO_HFP = 1, + COEX_ALGO_HID = 2, + COEX_ALGO_A2DP = 3, + COEX_ALGO_PAN = 4, + COEX_ALGO_A2DP_HID = 5, + COEX_ALGO_A2DP_PAN = 6, + COEX_ALGO_PAN_HID = 7, + COEX_ALGO_A2DP_PAN_HID = 8, + + COEX_ALGO_MAX +}; + +enum coex_bt_profile { + BPM_NOPROFILE = 0, + BPM_HFP = BIT(0), + BPM_HID = BIT(1), + BPM_A2DP = BIT(2), + BPM_PAN = BIT(3), + BPM_HID_HFP = BPM_HID | BPM_HFP, + BPM_A2DP_HFP = BPM_A2DP | BPM_HFP, + BPM_A2DP_HID = BPM_A2DP | BPM_HID, + BPM_A2DP_HID_HFP = BPM_A2DP | BPM_HID | BPM_HFP, + BPM_PAN_HFP = BPM_PAN | BPM_HFP, + BPM_PAN_HID = BPM_PAN | BPM_HID, + BPM_PAN_HID_HFP = BPM_PAN | BPM_HID | BPM_HFP, + BPM_PAN_A2DP = BPM_PAN | BPM_A2DP, + BPM_PAN_A2DP_HFP = BPM_PAN | BPM_A2DP | BPM_HFP, + BPM_PAN_A2DP_HID = BPM_PAN | BPM_A2DP | BPM_HID, + BPM_PAN_A2DP_HID_HFP = BPM_PAN | BPM_A2DP | BPM_HID | BPM_HFP, +}; + +enum coex_wl_link_mode { + COEX_WLINK_2G1PORT = 0x0, + COEX_WLINK_5G = 0x3, + COEX_WLINK_2GFREE = 0x7, + COEX_WLINK_MAX +}; + +enum coex_wl2bt_scoreboard { + COEX_SCBD_ACTIVE = BIT(0), + COEX_SCBD_ONOFF = BIT(1), + COEX_SCBD_SCAN = BIT(2), + COEX_SCBD_UNDERTEST = BIT(3), + COEX_SCBD_RXGAIN = BIT(4), + COEX_SCBD_BT_RFK = BIT(5), + COEX_SCBD_WLBUSY = BIT(6), + COEX_SCBD_EXTFEM = BIT(8), + COEX_SCBD_TDMA = BIT(9), + COEX_SCBD_FIX2M = BIT(10), + COEX_SCBD_ALL = GENMASK(15, 0), +}; + +enum coex_power_save_type { + COEX_PS_WIFI_NATIVE = 0, + COEX_PS_LPS_ON = 1, + COEX_PS_LPS_OFF = 2, +}; + +enum coex_rssi_state { + COEX_RSSI_STATE_HIGH, + COEX_RSSI_STATE_MEDIUM, + COEX_RSSI_STATE_LOW, + COEX_RSSI_STATE_STAY_HIGH, + COEX_RSSI_STATE_STAY_MEDIUM, + COEX_RSSI_STATE_STAY_LOW, +}; + +enum coex_notify_type_ips { + COEX_IPS_LEAVE = 0x0, + COEX_IPS_ENTER = 0x1, +}; + +enum coex_notify_type_lps { + COEX_LPS_DISABLE = 0x0, + COEX_LPS_ENABLE = 0x1, +}; + +enum coex_notify_type_scan { + COEX_SCAN_FINISH, + COEX_SCAN_START, + COEX_SCAN_START_2G, + COEX_SCAN_START_5G, +}; + +enum coex_notify_type_switchband { + COEX_NOT_SWITCH, + COEX_SWITCH_TO_24G, + COEX_SWITCH_TO_5G, + COEX_SWITCH_TO_24G_NOFORSCAN, +}; + +enum coex_notify_type_associate { + COEX_ASSOCIATE_FINISH, + COEX_ASSOCIATE_START, + COEX_ASSOCIATE_5G_FINISH, + COEX_ASSOCIATE_5G_START, +}; + +enum coex_notify_type_media_status { + COEX_MEDIA_DISCONNECT, + COEX_MEDIA_CONNECT, + COEX_MEDIA_CONNECT_5G, +}; + +enum coex_bt_status { + COEX_BTSTATUS_NCON_IDLE = 0, + COEX_BTSTATUS_CON_IDLE = 1, + COEX_BTSTATUS_INQ_PAGE = 2, + COEX_BTSTATUS_ACL_BUSY = 3, + COEX_BTSTATUS_SCO_BUSY = 4, + COEX_BTSTATUS_ACL_SCO_BUSY = 5, + + COEX_BTSTATUS_MAX +}; + +enum coex_wl_tput_dir { + COEX_WL_TPUT_TX = 0x0, + COEX_WL_TPUT_RX = 0x1, + COEX_WL_TPUT_MAX +}; + +enum coex_wl_priority_mask { + COEX_WLPRI_RX_RSP = 2, + COEX_WLPRI_TX_RSP = 3, + COEX_WLPRI_TX_BEACON = 4, + COEX_WLPRI_TX_OFDM = 11, + COEX_WLPRI_TX_CCK = 12, + COEX_WLPRI_TX_BEACONQ = 27, + COEX_WLPRI_RX_CCK = 28, + COEX_WLPRI_RX_OFDM = 29, + COEX_WLPRI_MAX +}; + +enum coex_commom_chip_setup { + COEX_CSETUP_INIT_HW = 0x0, + COEX_CSETUP_ANT_SWITCH = 0x1, + COEX_CSETUP_GNT_FIX = 0x2, + COEX_CSETUP_GNT_DEBUG = 0x3, + COEX_CSETUP_RFE_TYPE = 0x4, + COEX_CSETUP_COEXINFO_HW = 0x5, + COEX_CSETUP_WL_TX_POWER = 0x6, + COEX_CSETUP_WL_RX_GAIN = 0x7, + COEX_CSETUP_WLAN_ACT_IPS = 0x8, + COEX_CSETUP_MAX +}; + +enum coex_indirect_reg_type { + COEX_INDIRECT_1700 = 0x0, + COEX_INDIRECT_7C0 = 0x1, + COEX_INDIRECT_MAX +}; + +enum coex_pstdma_type { + COEX_PSTDMA_FORCE_LPSOFF = 0x0, + COEX_PSTDMA_FORCE_LPSON = 0x1, + COEX_PSTDMA_MAX +}; + +enum coex_btrssi_type { + COEX_BTRSSI_RATIO = 0x0, + COEX_BTRSSI_DBM = 0x1, + COEX_BTRSSI_MAX +}; + +struct coex_table_para { + u32 bt; + u32 wl; +}; + +struct coex_tdma_para { + u8 para[5]; +}; + +struct coex_5g_afh_map { + u32 wl_5g_ch; + u8 bt_skip_ch; + u8 bt_skip_span; +}; + +struct coex_rf_para { + u8 wl_pwr_dec_lvl; + u8 bt_pwr_dec_lvl; + bool wl_low_gain_en; + u8 bt_lna_lvl; +}; + +static inline void rtw_coex_set_init(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + chip->ops->coex_set_init(rtwdev); +} + +static inline +void rtw_coex_set_ant_switch(struct rtw_dev *rtwdev, u8 ctrl_type, u8 pos_type) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + if (!chip->ops->coex_set_ant_switch) + return; + + chip->ops->coex_set_ant_switch(rtwdev, ctrl_type, pos_type); +} + +static inline void rtw_coex_set_gnt_fix(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + chip->ops->coex_set_gnt_fix(rtwdev); +} + +static inline void rtw_coex_set_gnt_debug(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + chip->ops->coex_set_gnt_debug(rtwdev); +} + +static inline void rtw_coex_set_rfe_type(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + chip->ops->coex_set_rfe_type(rtwdev); +} + +static inline void rtw_coex_set_wl_tx_power(struct rtw_dev *rtwdev, u8 wl_pwr) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + chip->ops->coex_set_wl_tx_power(rtwdev, wl_pwr); +} + +static inline +void rtw_coex_set_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + chip->ops->coex_set_wl_rx_gain(rtwdev, low_gain); +} + +void rtw_coex_info_response(struct rtw_dev *rtwdev, struct sk_buff *skb); +u32 rtw_coex_read_indirect_reg(struct rtw_dev *rtwdev, u16 addr); +void rtw_coex_write_indirect_reg(struct rtw_dev *rtwdev, u16 addr, + u32 mask, u32 val); +void rtw_coex_write_scbd(struct rtw_dev *rtwdev, u16 bitpos, bool set); + +void rtw_coex_bt_relink_work(struct work_struct *work); +void rtw_coex_bt_reenable_work(struct work_struct *work); +void rtw_coex_defreeze_work(struct work_struct *work); +void rtw_coex_wl_remain_work(struct work_struct *work); +void rtw_coex_bt_remain_work(struct work_struct *work); +void rtw_coex_wl_connecting_work(struct work_struct *work); +void rtw_coex_bt_multi_link_remain_work(struct work_struct *work); +void rtw_coex_wl_ccklock_work(struct work_struct *work); + +void rtw_coex_power_on_setting(struct rtw_dev *rtwdev); +void rtw_coex_power_off_setting(struct rtw_dev *rtwdev); +void rtw_coex_init_hw_config(struct rtw_dev *rtwdev, bool wifi_only); +void rtw_coex_ips_notify(struct rtw_dev *rtwdev, u8 type); +void rtw_coex_lps_notify(struct rtw_dev *rtwdev, u8 type); +void rtw_coex_scan_notify(struct rtw_dev *rtwdev, u8 type); +void rtw_coex_connect_notify(struct rtw_dev *rtwdev, u8 type); +void rtw_coex_media_status_notify(struct rtw_dev *rtwdev, u8 type); +void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length); +void rtw_coex_bt_hid_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length); +void rtw_coex_wl_fwdbginfo_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length); +void rtw_coex_switchband_notify(struct rtw_dev *rtwdev, u8 type); +void rtw_coex_wl_status_change_notify(struct rtw_dev *rtwdev, u32 type); +void rtw_coex_wl_status_check(struct rtw_dev *rtwdev); +void rtw_coex_query_bt_hid_list(struct rtw_dev *rtwdev); +void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m); + +static inline bool rtw_coex_disabled(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + + return coex_stat->bt_disabled; +} + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/compiler.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/compiler.h new file mode 100644 index 0000000000000000000000000000000000000000..adcd51c87e4d29281cdb2cf8886245bc3ed6a094 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/compiler.h @@ -0,0 +1,552 @@ +#ifndef __LINUX_COMPILER_H +#define __LINUX_COMPILER_H + +#ifndef __ASSEMBLY__ + +#ifdef __CHECKER__ +# define __user __attribute__((noderef, address_space(1))) +# define __kernel __attribute__((address_space(0))) +# define __safe __attribute__((safe)) +# define __force __attribute__((force)) +# define __nocast __attribute__((nocast)) +# define __iomem __attribute__((noderef, address_space(2))) +# define __must_hold(x) __attribute__((context(x,1,1))) +# define __acquires(x) __attribute__((context(x,0,1))) +# define __releases(x) __attribute__((context(x,1,0))) +# define __acquire(x) __context__(x,1) +# define __release(x) __context__(x,-1) +# define __cond_lock(x,c) ((c) ? ({ __acquire(x); 1; }) : 0) +# define __percpu __attribute__((noderef, address_space(3))) +#ifdef CONFIG_SPARSE_RCU_POINTER +# define __rcu __attribute__((noderef, address_space(4))) +#else /* CONFIG_SPARSE_RCU_POINTER */ +# define __rcu +#endif /* CONFIG_SPARSE_RCU_POINTER */ +# define __private __attribute__((noderef)) +extern void __chk_user_ptr(const volatile void __user *); +extern void __chk_io_ptr(const volatile void __iomem *); +# define ACCESS_PRIVATE(p, member) (*((typeof((p)->member) __force *) &(p)->member)) +#else /* __CHECKER__ */ +# define __user +# define __kernel +# define __safe +# define __force +# define __nocast +# define __iomem +# define __chk_user_ptr(x) (void)0 +# define __chk_io_ptr(x) (void)0 +# define __builtin_warning(x, y...) (1) +# define __must_hold(x) +# define __acquires(x) +# define __releases(x) +# define __acquire(x) (void)0 +# define __release(x) (void)0 +# define __cond_lock(x,c) (c) +# define __percpu +# define __rcu +# define __private +# define ACCESS_PRIVATE(p, member) ((p)->member) +#endif /* __CHECKER__ */ + +/* Indirect macros required for expanded argument pasting, eg. __LINE__. */ +#define ___PASTE(a,b) a##b +#define __PASTE(a,b) ___PASTE(a,b) + +#ifdef __KERNEL__ + +#ifdef __GNUC__ +#include +#endif + +#if defined(CC_USING_HOTPATCH) && !defined(__CHECKER__) +#define notrace __attribute__((hotpatch(0,0))) +#else +#define notrace __attribute__((no_instrument_function)) +#endif + +/* Intel compiler defines __GNUC__. So we will overwrite implementations + * coming from above header files here + */ +#ifdef __INTEL_COMPILER +# include +#endif + +/* Clang compiler defines __GNUC__. So we will overwrite implementations + * coming from above header files here + */ +#ifdef __clang__ +#include +#endif + +/* + * Generic compiler-dependent macros required for kernel + * build go below this comment. Actual compiler/compiler version + * specific implementations come from the above header files + */ + +struct ftrace_branch_data { + const char *func; + const char *file; + unsigned line; + union { + struct { + unsigned long correct; + unsigned long incorrect; + }; + struct { + unsigned long miss; + unsigned long hit; + }; + unsigned long miss_hit[2]; + }; +}; + +/* + * Note: DISABLE_BRANCH_PROFILING can be used by special lowlevel code + * to disable branch tracing on a per file basis. + */ +#if defined(CONFIG_TRACE_BRANCH_PROFILING) \ + && !defined(DISABLE_BRANCH_PROFILING) && !defined(__CHECKER__) +void ftrace_likely_update(struct ftrace_branch_data *f, int val, int expect); + +#define likely_notrace(x) __builtin_expect(!!(x), 1) +#define unlikely_notrace(x) __builtin_expect(!!(x), 0) + +#define __branch_check__(x, expect) ({ \ + int ______r; \ + static struct ftrace_branch_data \ + __attribute__((__aligned__(4))) \ + __attribute__((section("_ftrace_annotated_branch"))) \ + ______f = { \ + .func = __func__, \ + .file = __FILE__, \ + .line = __LINE__, \ + }; \ + ______r = likely_notrace(x); \ + ftrace_likely_update(&______f, ______r, expect); \ + ______r; \ + }) + +/* + * Using __builtin_constant_p(x) to ignore cases where the return + * value is always the same. This idea is taken from a similar patch + * written by Daniel Walker. + */ +# ifndef likely +# define likely(x) (__builtin_constant_p(x) ? !!(x) : __branch_check__(x, 1)) +# endif +# ifndef unlikely +# define unlikely(x) (__builtin_constant_p(x) ? !!(x) : __branch_check__(x, 0)) +# endif + +#ifdef CONFIG_PROFILE_ALL_BRANCHES +/* + * "Define 'is'", Bill Clinton + * "Define 'if'", Steven Rostedt + */ +#define if(cond, ...) __trace_if( (cond , ## __VA_ARGS__) ) +#define __trace_if(cond) \ + if (__builtin_constant_p(!!(cond)) ? !!(cond) : \ + ({ \ + int ______r; \ + static struct ftrace_branch_data \ + __attribute__((__aligned__(4))) \ + __attribute__((section("_ftrace_branch"))) \ + ______f = { \ + .func = __func__, \ + .file = __FILE__, \ + .line = __LINE__, \ + }; \ + ______r = !!(cond); \ + ______f.miss_hit[______r]++; \ + ______r; \ + })) +#endif /* CONFIG_PROFILE_ALL_BRANCHES */ + +#else +# define likely(x) __builtin_expect(!!(x), 1) +# define unlikely(x) __builtin_expect(!!(x), 0) +#endif + +/* Optimization barrier */ +#ifndef barrier +# define barrier() __memory_barrier() +#endif + +#ifndef barrier_data +# define barrier_data(ptr) barrier() +#endif + +/* Unreachable code */ +#ifndef unreachable +# define unreachable() do { } while (1) +#endif + +/* + * KENTRY - kernel entry point + * This can be used to annotate symbols (functions or data) that are used + * without their linker symbol being referenced explicitly. For example, + * interrupt vector handlers, or functions in the kernel image that are found + * programatically. + * + * Not required for symbols exported with EXPORT_SYMBOL, or initcalls. Those + * are handled in their own way (with KEEP() in linker scripts). + * + * KENTRY can be avoided if the symbols in question are marked as KEEP() in the + * linker script. For example an architecture could KEEP() its entire + * boot/exception vector code rather than annotate each function and data. + */ +#ifndef KENTRY +# define KENTRY(sym) \ + extern typeof(sym) sym; \ + static const unsigned long __kentry_##sym \ + __used \ + __attribute__((section("___kentry" "+" #sym ), used)) \ + = (unsigned long)&sym; +#endif + +#ifndef RELOC_HIDE +# define RELOC_HIDE(ptr, off) \ + ({ unsigned long __ptr; \ + __ptr = (unsigned long) (ptr); \ + (typeof(ptr)) (__ptr + (off)); }) +#endif + +#ifndef OPTIMIZER_HIDE_VAR +#define OPTIMIZER_HIDE_VAR(var) barrier() +#endif + +/* Not-quite-unique ID. */ +#ifndef __UNIQUE_ID +# define __UNIQUE_ID(prefix) __PASTE(__PASTE(__UNIQUE_ID_, prefix), __LINE__) +#endif + +#include + +#define __READ_ONCE_SIZE \ +({ \ + switch (size) { \ + case 1: *(__u8 *)res = *(volatile __u8 *)p; break; \ + case 2: *(__u16 *)res = *(volatile __u16 *)p; break; \ + case 4: *(__u32 *)res = *(volatile __u32 *)p; break; \ + case 8: *(__u64 *)res = *(volatile __u64 *)p; break; \ + default: \ + barrier(); \ + __builtin_memcpy((void *)res, (const void *)p, size); \ + barrier(); \ + } \ +}) + +static __always_inline +void __read_once_size(const volatile void *p, void *res, int size) +{ + __READ_ONCE_SIZE; +} + +#ifdef CONFIG_KASAN +/* + * This function is not 'inline' because __no_sanitize_address confilcts + * with inlining. Attempt to inline it may cause a build failure. + * https://gcc.gnu.org/bugzilla/show_bug.cgi?id=67368 + * '__maybe_unused' allows us to avoid defined-but-not-used warnings. + */ +static __no_sanitize_address __maybe_unused +void __read_once_size_nocheck(const volatile void *p, void *res, int size) +{ + __READ_ONCE_SIZE; +} +#else +static __always_inline +void __read_once_size_nocheck(const volatile void *p, void *res, int size) +{ + __READ_ONCE_SIZE; +} +#endif + +static __always_inline void __write_once_size(volatile void *p, void *res, int size) +{ + switch (size) { + case 1: *(volatile __u8 *)p = *(__u8 *)res; break; + case 2: *(volatile __u16 *)p = *(__u16 *)res; break; + case 4: *(volatile __u32 *)p = *(__u32 *)res; break; + case 8: *(volatile __u64 *)p = *(__u64 *)res; break; + default: + barrier(); + __builtin_memcpy((void *)p, (const void *)res, size); + barrier(); + } +} + +/* + * Prevent the compiler from merging or refetching reads or writes. The + * compiler is also forbidden from reordering successive instances of + * READ_ONCE, WRITE_ONCE and ACCESS_ONCE (see below), but only when the + * compiler is aware of some particular ordering. One way to make the + * compiler aware of ordering is to put the two invocations of READ_ONCE, + * WRITE_ONCE or ACCESS_ONCE() in different C statements. + * + * In contrast to ACCESS_ONCE these two macros will also work on aggregate + * data types like structs or unions. If the size of the accessed data + * type exceeds the word size of the machine (e.g., 32 bits or 64 bits) + * READ_ONCE() and WRITE_ONCE() will fall back to memcpy(). There's at + * least two memcpy()s: one for the __builtin_memcpy() and then one for + * the macro doing the copy of variable - '__u' allocated on the stack. + * + * Their two major use cases are: (1) Mediating communication between + * process-level code and irq/NMI handlers, all running on the same CPU, + * and (2) Ensuring that the compiler does not fold, spindle, or otherwise + * mutilate accesses that either do not require ordering or that interact + * with an explicit memory barrier or atomic instruction that provides the + * required ordering. + */ + +#define __READ_ONCE(x, check) \ +({ \ + union { typeof(x) __val; char __c[1]; } __u; \ + if (check) \ + __read_once_size(&(x), __u.__c, sizeof(x)); \ + else \ + __read_once_size_nocheck(&(x), __u.__c, sizeof(x)); \ + __u.__val; \ +}) +#define READ_ONCE(x) __READ_ONCE(x, 1) + +/* + * Use READ_ONCE_NOCHECK() instead of READ_ONCE() if you need + * to hide memory access from KASAN. + */ +#define READ_ONCE_NOCHECK(x) __READ_ONCE(x, 0) + +#define WRITE_ONCE(x, val) \ +({ \ + union { typeof(x) __val; char __c[1]; } __u = \ + { .__val = (__force typeof(x)) (val) }; \ + __write_once_size(&(x), __u.__c, sizeof(x)); \ + __u.__val; \ +}) + +#endif /* __KERNEL__ */ + +#endif /* __ASSEMBLY__ */ + +#ifdef __KERNEL__ +/* + * Allow us to mark functions as 'deprecated' and have gcc emit a nice + * warning for each use, in hopes of speeding the functions removal. + * Usage is: + * int __deprecated foo(void) + */ +#ifndef __deprecated +# define __deprecated /* unimplemented */ +#endif + +#ifdef MODULE +#define __deprecated_for_modules __deprecated +#else +#define __deprecated_for_modules +#endif + +#ifndef __must_check +#define __must_check +#endif + +#ifndef CONFIG_ENABLE_MUST_CHECK +#undef __must_check +#define __must_check +#endif +#ifndef CONFIG_ENABLE_WARN_DEPRECATED +#undef __deprecated +#undef __deprecated_for_modules +#define __deprecated +#define __deprecated_for_modules +#endif + +#ifndef __malloc +#define __malloc +#endif + +/* + * Allow us to avoid 'defined but not used' warnings on functions and data, + * as well as force them to be emitted to the assembly file. + * + * As of gcc 3.4, static functions that are not marked with attribute((used)) + * may be elided from the assembly file. As of gcc 3.4, static data not so + * marked will not be elided, but this may change in a future gcc version. + * + * NOTE: Because distributions shipped with a backported unit-at-a-time + * compiler in gcc 3.3, we must define __used to be __attribute__((used)) + * for gcc >=3.3 instead of 3.4. + * + * In prior versions of gcc, such functions and data would be emitted, but + * would be warned about except with attribute((unused)). + * + * Mark functions that are referenced only in inline assembly as __used so + * the code is emitted even though it appears to be unreferenced. + */ +#ifndef __used +# define __used /* unimplemented */ +#endif + +#ifndef __maybe_unused +# define __maybe_unused /* unimplemented */ +#endif + +#ifndef __always_unused +# define __always_unused /* unimplemented */ +#endif + +#ifndef noinline +#define noinline +#endif + +/* + * Rather then using noinline to prevent stack consumption, use + * noinline_for_stack instead. For documentation reasons. + */ +#define noinline_for_stack noinline + +#ifndef __always_inline +#define __always_inline inline +#endif + +#endif /* __KERNEL__ */ + +/* + * From the GCC manual: + * + * Many functions do not examine any values except their arguments, + * and have no effects except the return value. Basically this is + * just slightly more strict class than the `pure' attribute above, + * since function is not allowed to read global memory. + * + * Note that a function that has pointer arguments and examines the + * data pointed to must _not_ be declared `const'. Likewise, a + * function that calls a non-`const' function usually must not be + * `const'. It does not make sense for a `const' function to return + * `void'. + */ +#ifndef __attribute_const__ +# define __attribute_const__ /* unimplemented */ +#endif + +#ifndef __latent_entropy +# define __latent_entropy +#endif + +/* + * Tell gcc if a function is cold. The compiler will assume any path + * directly leading to the call is unlikely. + */ + +#ifndef __cold +#define __cold +#endif + +/* Simple shorthand for a section definition */ +#ifndef __section +# define __section(S) __attribute__ ((__section__(#S))) +#endif + +#ifndef __visible +#define __visible +#endif + +/* + * Assume alignment of return value. + */ +#ifndef __assume_aligned +#define __assume_aligned(a, ...) +#endif + + +/* Are two types/vars the same type (ignoring qualifiers)? */ +#ifndef __same_type +# define __same_type(a, b) __builtin_types_compatible_p(typeof(a), typeof(b)) +#endif + +/* Is this type a native word size -- useful for atomic operations */ +#ifndef __native_word +# define __native_word(t) (sizeof(t) == sizeof(char) || sizeof(t) == sizeof(short) || sizeof(t) == sizeof(int) || sizeof(t) == sizeof(long)) +#endif + +/* Compile time object size, -1 for unknown */ +#ifndef __compiletime_object_size +# define __compiletime_object_size(obj) -1 +#endif +#ifndef __compiletime_warning +# define __compiletime_warning(message) +#endif +#ifndef __compiletime_error +# define __compiletime_error(message) +# ifndef __CHECKER__ +# define __compiletime_error_fallback(condition) \ + do { ((void)sizeof(char[1 - 2 * condition])); } while (0) +# endif +#endif +#ifndef __compiletime_error_fallback +# define __compiletime_error_fallback(condition) do { } while (0) +#endif + +/* + * Prevent the compiler from merging or refetching accesses. The compiler + * is also forbidden from reordering successive instances of ACCESS_ONCE(), + * but only when the compiler is aware of some particular ordering. One way + * to make the compiler aware of ordering is to put the two invocations of + * ACCESS_ONCE() in different C statements. + * + * ACCESS_ONCE will only work on scalar types. For union types, ACCESS_ONCE + * on a union member will work as long as the size of the member matches the + * size of the union and the size is smaller than word size. + * + * The major use cases of ACCESS_ONCE used to be (1) Mediating communication + * between process-level code and irq/NMI handlers, all running on the same CPU, + * and (2) Ensuring that the compiler does not fold, spindle, or otherwise + * mutilate accesses that either do not require ordering or that interact + * with an explicit memory barrier or atomic instruction that provides the + * required ordering. + * + * If possible use READ_ONCE()/WRITE_ONCE() instead. + */ +#define __ACCESS_ONCE(x) ({ \ + __maybe_unused typeof(x) __var = (__force typeof(x)) 0; \ + (volatile typeof(x) *)&(x); }) +#define ACCESS_ONCE(x) (*__ACCESS_ONCE(x)) + +/** + * lockless_dereference() - safely load a pointer for later dereference + * @p: The pointer to load + * + * Similar to rcu_dereference(), but for situations where the pointed-to + * object's lifetime is managed by something other than RCU. That + * "something other" might be reference counting or simple immortality. + * + * The seemingly unused variable ___typecheck_p validates that @p is + * indeed a pointer type by using a pointer to typeof(*p) as the type. + * Taking a pointer to typeof(*p) again is needed in case p is void *. + */ +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0) +#define lockless_dereference(p) \ +({ \ + typeof(p) _________p1 = READ_ONCE(p); \ + typeof(*(p)) *___typecheck_p __maybe_unused; \ + smp_read_barrier_depends(); /* Dependency order vs. p above. */ \ + (_________p1); \ +}) +#else +#define lockless_dereference(p) \ +({ \ + typeof(p) _________p1 = READ_ONCE(p); \ + smp_read_barrier_depends(); /* Dependency order vs. p above. */ \ + (_________p1); \ +}) +#endif + +/* Ignore/forbid kprobes attach on very low level functions marked by this attribute: */ +#ifdef CONFIG_KPROBES +# define __kprobes __attribute__((__section__(".kprobes.text"))) +# define nokprobe_inline __always_inline +#else +# define __kprobes +# define nokprobe_inline inline +#endif +#endif /* __LINUX_COMPILER_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/debug.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/debug.c new file mode 100644 index 0000000000000000000000000000000000000000..8fa8ddb997c71ff58ac23389fe7d4ae9ee721bdb --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/debug.c @@ -0,0 +1,1335 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include "main.h" +#include "coex.h" +#include "sec.h" +#include "fw.h" +#include "debug.h" +#include "phy.h" +#include "reg.h" +#include "ps.h" +#include "regd.h" + +#ifdef CONFIG_RTW88_DEBUGFS + +struct rtw_debugfs_priv { + struct rtw_dev *rtwdev; + int (*cb_read)(struct seq_file *m, void *v); + ssize_t (*cb_write)(struct file *filp, const char __user *buffer, + size_t count, loff_t *loff); + union { + u32 cb_data; + u8 *buf; + struct { + u32 page_offset; + u32 page_num; + } rsvd_page; + struct { + u8 rf_path; + u32 rf_addr; + u32 rf_mask; + }; + struct { + u32 addr; + u32 len; + } read_reg; + struct { + u8 bit; + } dm_cap; + }; +}; + +static const char * const rtw_dm_cap_strs[] = { + [RTW_DM_CAP_NA] = "NA", + [RTW_DM_CAP_TXGAPK] = "TXGAPK", +}; + +static int rtw_debugfs_single_show(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + + return debugfs_priv->cb_read(m, v); +} + +static ssize_t rtw_debugfs_common_write(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct rtw_debugfs_priv *debugfs_priv = filp->private_data; + + return debugfs_priv->cb_write(filp, buffer, count, loff); +} + +static ssize_t rtw_debugfs_single_write(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + + return debugfs_priv->cb_write(filp, buffer, count, loff); +} + +static int rtw_debugfs_single_open_rw(struct inode *inode, struct file *filp) +{ + return single_open(filp, rtw_debugfs_single_show, inode->i_private); +} + +static int rtw_debugfs_close(struct inode *inode, struct file *filp) +{ + return 0; +} + +static const struct file_operations file_ops_single_r = { + .owner = THIS_MODULE, + .open = rtw_debugfs_single_open_rw, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static const struct file_operations file_ops_single_rw = { + .owner = THIS_MODULE, + .open = rtw_debugfs_single_open_rw, + .release = single_release, + .read = seq_read, + .llseek = seq_lseek, + .write = rtw_debugfs_single_write, +}; + +static const struct file_operations file_ops_common_write = { + .owner = THIS_MODULE, + .write = rtw_debugfs_common_write, + .open = simple_open, + .release = rtw_debugfs_close, +}; + +static int rtw_debugfs_get_read_reg(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + u32 val, len, addr; + + len = debugfs_priv->read_reg.len; + addr = debugfs_priv->read_reg.addr; + switch (len) { + case 1: + val = rtw_read8(rtwdev, addr); + seq_printf(m, "reg 0x%03x: 0x%02x\n", addr, val); + break; + case 2: + val = rtw_read16(rtwdev, addr); + seq_printf(m, "reg 0x%03x: 0x%04x\n", addr, val); + break; + case 4: + val = rtw_read32(rtwdev, addr); + seq_printf(m, "reg 0x%03x: 0x%08x\n", addr, val); + break; + } + return 0; +} + +static int rtw_debugfs_get_rf_read(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + u32 val, addr, mask; + u8 path; + + path = debugfs_priv->rf_path; + addr = debugfs_priv->rf_addr; + mask = debugfs_priv->rf_mask; + + mutex_lock(&rtwdev->mutex); + val = rtw_read_rf(rtwdev, path, addr, mask); + mutex_unlock(&rtwdev->mutex); + + seq_printf(m, "rf_read path:%d addr:0x%08x mask:0x%08x val=0x%08x\n", + path, addr, mask, val); + + return 0; +} + +static int rtw_debugfs_get_fix_rate(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 fix_rate = dm_info->fix_rate; + + if (fix_rate >= DESC_RATE_MAX) { + seq_printf(m, "Fix rate disabled, fix_rate = %u\n", fix_rate); + return 0; + } + + seq_printf(m, "Data frames fixed at desc rate %u\n", fix_rate); + return 0; +} + +static int rtw_debugfs_copy_from_user(char tmp[], int size, + const char __user *buffer, size_t count, + int num) +{ + int tmp_len; + + memset(tmp, 0, size); + + if (count < num) + return -EFAULT; + + tmp_len = (count > size - 1 ? size - 1 : count); + + if (copy_from_user(tmp, buffer, tmp_len)) + return -EFAULT; + + tmp[tmp_len] = '\0'; + + return 0; +} + +static ssize_t rtw_debugfs_set_read_reg(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + char tmp[32 + 1]; + u32 addr, len; + int num; + int ret; + + ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 2); + if (ret) + return ret; + + num = sscanf(tmp, "%x %x", &addr, &len); + + if (num != 2) + return -EINVAL; + + if (len != 1 && len != 2 && len != 4) { + rtw_warn(rtwdev, "read reg setting wrong len\n"); + return -EINVAL; + } + debugfs_priv->read_reg.addr = addr; + debugfs_priv->read_reg.len = len; + + return count; +} + +static int rtw_debugfs_get_dump_cam(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + u32 val, command; + u32 hw_key_idx = debugfs_priv->cb_data << RTW_SEC_CAM_ENTRY_SHIFT; + u32 read_cmd = RTW_SEC_CMD_POLLING; + int i; + + seq_printf(m, "cam entry%d\n", debugfs_priv->cb_data); + seq_puts(m, "0x0 0x1 0x2 0x3 "); + seq_puts(m, "0x4 0x5\n"); + mutex_lock(&rtwdev->mutex); + for (i = 0; i <= 5; i++) { + command = read_cmd | (hw_key_idx + i); + rtw_write32(rtwdev, RTW_SEC_CMD_REG, command); + val = rtw_read32(rtwdev, RTW_SEC_READ_REG); + seq_printf(m, "%8.8x", val); + if (i < 2) + seq_puts(m, " "); + } + seq_puts(m, "\n"); + mutex_unlock(&rtwdev->mutex); + return 0; +} + +static int rtw_debugfs_get_rsvd_page(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + u8 page_size = rtwdev->chip->page_size; + u32 buf_size = debugfs_priv->rsvd_page.page_num * page_size; + u32 offset = debugfs_priv->rsvd_page.page_offset * page_size; + u8 *buf; + int i; + int ret; + + buf = vzalloc(buf_size); + if (!buf) + return -ENOMEM; + + ret = rtw_fw_dump_fifo(rtwdev, RTW_FW_FIFO_SEL_RSVD_PAGE, offset, + buf_size, (u32 *)buf); + if (ret) { + rtw_err(rtwdev, "failed to dump rsvd page\n"); + vfree(buf); + return ret; + } + + for (i = 0 ; i < buf_size ; i += 8) { + if (i % page_size == 0) + seq_printf(m, "PAGE %d\n", (i + offset) / page_size); + seq_printf(m, "%8ph\n", buf + i); + } + vfree(buf); + + return 0; +} + +static ssize_t rtw_debugfs_set_rsvd_page(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + char tmp[32 + 1]; + u32 offset, page_num; + int num; + int ret; + + ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 2); + if (ret) + return ret; + + num = sscanf(tmp, "%d %d", &offset, &page_num); + + if (num != 2) { + rtw_warn(rtwdev, "invalid arguments\n"); + return -EINVAL; + } + + debugfs_priv->rsvd_page.page_offset = offset; + debugfs_priv->rsvd_page.page_num = page_num; + + return count; +} + +static ssize_t rtw_debugfs_set_single_input(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + char tmp[32 + 1]; + u32 input; + int num; + int ret; + + ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 1); + if (ret) + return ret; + + num = kstrtoint(tmp, 0, &input); + + if (num) { + rtw_warn(rtwdev, "kstrtoint failed\n"); + return num; + } + + debugfs_priv->cb_data = input; + + return count; +} + +static ssize_t rtw_debugfs_set_write_reg(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct rtw_debugfs_priv *debugfs_priv = filp->private_data; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + char tmp[32 + 1]; + u32 addr, val, len; + int num; + int ret; + + ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 3); + if (ret) + return ret; + + /* write BB/MAC register */ + num = sscanf(tmp, "%x %x %x", &addr, &val, &len); + + if (num != 3) + return -EINVAL; + + switch (len) { + case 1: + rtw_dbg(rtwdev, RTW_DBG_DEBUGFS, + "reg write8 0x%03x: 0x%08x\n", addr, val); + rtw_write8(rtwdev, addr, (u8)val); + break; + case 2: + rtw_dbg(rtwdev, RTW_DBG_DEBUGFS, + "reg write16 0x%03x: 0x%08x\n", addr, val); + rtw_write16(rtwdev, addr, (u16)val); + break; + case 4: + rtw_dbg(rtwdev, RTW_DBG_DEBUGFS, + "reg write32 0x%03x: 0x%08x\n", addr, val); + rtw_write32(rtwdev, addr, (u32)val); + break; + default: + rtw_dbg(rtwdev, RTW_DBG_DEBUGFS, + "error write length = %d\n", len); + break; + } + + return count; +} + +static ssize_t rtw_debugfs_set_h2c(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct rtw_debugfs_priv *debugfs_priv = filp->private_data; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + char tmp[32 + 1]; + u8 param[8]; + int num; + int ret; + + ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 3); + if (ret) + return ret; + + num = sscanf(tmp, "%hhx,%hhx,%hhx,%hhx,%hhx,%hhx,%hhx,%hhx", + ¶m[0], ¶m[1], ¶m[2], ¶m[3], + ¶m[4], ¶m[5], ¶m[6], ¶m[7]); + if (num != 8) { + rtw_warn(rtwdev, "invalid H2C command format for debug\n"); + return -EINVAL; + } + + mutex_lock(&rtwdev->mutex); + rtw_fw_h2c_cmd_dbg(rtwdev, param); + mutex_unlock(&rtwdev->mutex); + + return count; +} + +static ssize_t rtw_debugfs_set_rf_write(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct rtw_debugfs_priv *debugfs_priv = filp->private_data; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + char tmp[32 + 1]; + u32 path, addr, mask, val; + int num; + int ret; + + ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 4); + if (ret) + return ret; + + num = sscanf(tmp, "%x %x %x %x", &path, &addr, &mask, &val); + + if (num != 4) { + rtw_warn(rtwdev, "invalid args, [path] [addr] [mask] [val]\n"); + return -EINVAL; + } + + mutex_lock(&rtwdev->mutex); + rtw_write_rf(rtwdev, path, addr, mask, val); + mutex_unlock(&rtwdev->mutex); + rtw_dbg(rtwdev, RTW_DBG_DEBUGFS, + "write_rf path:%d addr:0x%08x mask:0x%08x, val:0x%08x\n", + path, addr, mask, val); + + return count; +} + +static ssize_t rtw_debugfs_set_rf_read(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + char tmp[32 + 1]; + u32 path, addr, mask; + int num; + int ret; + + ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 3); + if (ret) + return ret; + + num = sscanf(tmp, "%x %x %x", &path, &addr, &mask); + + if (num != 3) { + rtw_warn(rtwdev, "invalid args, [path] [addr] [mask] [val]\n"); + return -EINVAL; + } + + debugfs_priv->rf_path = path; + debugfs_priv->rf_addr = addr; + debugfs_priv->rf_mask = mask; + + return count; +} + +static ssize_t rtw_debugfs_set_fix_rate(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 fix_rate; + char tmp[32 + 1]; + int ret; + + ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 1); + if (ret) + return ret; + + ret = kstrtou8(tmp, 0, &fix_rate); + if (ret) { + rtw_warn(rtwdev, "invalid args, [rate]\n"); + return ret; + } + + dm_info->fix_rate = fix_rate; + + return count; +} + +static int rtw_debug_get_mac_page(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + u32 page = debugfs_priv->cb_data; + int i, n; + int max = 0xff; + + rtw_read32(rtwdev, debugfs_priv->cb_data); + for (n = 0; n <= max; ) { + seq_printf(m, "\n%8.8x ", n + page); + for (i = 0; i < 4 && n <= max; i++, n += 4) + seq_printf(m, "%8.8x ", + rtw_read32(rtwdev, (page | n))); + } + seq_puts(m, "\n"); + return 0; +} + +static int rtw_debug_get_bb_page(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + u32 page = debugfs_priv->cb_data; + int i, n; + int max = 0xff; + + rtw_read32(rtwdev, debugfs_priv->cb_data); + for (n = 0; n <= max; ) { + seq_printf(m, "\n%8.8x ", n + page); + for (i = 0; i < 4 && n <= max; i++, n += 4) + seq_printf(m, "%8.8x ", + rtw_read32(rtwdev, (page | n))); + } + seq_puts(m, "\n"); + return 0; +} + +static int rtw_debug_get_rf_dump(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + u32 addr, offset, data; + u8 path; + + mutex_lock(&rtwdev->mutex); + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + seq_printf(m, "RF path:%d\n", path); + for (addr = 0; addr < 0x100; addr += 4) { + seq_printf(m, "%8.8x ", addr); + for (offset = 0; offset < 4; offset++) { + data = rtw_read_rf(rtwdev, path, addr + offset, + 0xffffffff); + seq_printf(m, "%8.8x ", data); + } + seq_puts(m, "\n"); + } + seq_puts(m, "\n"); + } + + mutex_unlock(&rtwdev->mutex); + + return 0; +} + +static void rtw_print_cck_rate_txt(struct seq_file *m, u8 rate) +{ + static const char * const + cck_rate[] = {"1M", "2M", "5.5M", "11M"}; + u8 idx = rate - DESC_RATE1M; + + seq_printf(m, " CCK_%-5s", cck_rate[idx]); +} + +static void rtw_print_ofdm_rate_txt(struct seq_file *m, u8 rate) +{ + static const char * const + ofdm_rate[] = {"6M", "9M", "12M", "18M", "24M", "36M", "48M", "54M"}; + u8 idx = rate - DESC_RATE6M; + + seq_printf(m, " OFDM_%-4s", ofdm_rate[idx]); +} + +static void rtw_print_ht_rate_txt(struct seq_file *m, u8 rate) +{ + u8 mcs_n = rate - DESC_RATEMCS0; + + seq_printf(m, " MCS%-6u", mcs_n); +} + +static void rtw_print_vht_rate_txt(struct seq_file *m, u8 rate) +{ + u8 idx = rate - DESC_RATEVHT1SS_MCS0; + u8 n_ss, mcs_n; + + /* n spatial stream */ + n_ss = 1 + idx / 10; + /* MCS n */ + mcs_n = idx % 10; + seq_printf(m, " VHT%uSMCS%u", n_ss, mcs_n); +} + +static void rtw_print_rate(struct seq_file *m, u8 rate) +{ + switch (rate) { + case DESC_RATE1M...DESC_RATE11M: + rtw_print_cck_rate_txt(m, rate); + break; + case DESC_RATE6M...DESC_RATE54M: + rtw_print_ofdm_rate_txt(m, rate); + break; + case DESC_RATEMCS0...DESC_RATEMCS15: + rtw_print_ht_rate_txt(m, rate); + break; + case DESC_RATEVHT1SS_MCS0...DESC_RATEVHT2SS_MCS9: + rtw_print_vht_rate_txt(m, rate); + break; + default: + seq_printf(m, " Unknown rate=0x%x\n", rate); + break; + } +} + +#define case_REGD(src) \ + case RTW_REGD_##src: return #src + +static const char *rtw_get_regd_string(u8 regd) +{ + switch (regd) { + case_REGD(FCC); + case_REGD(MKK); + case_REGD(ETSI); + case_REGD(IC); + case_REGD(KCC); + case_REGD(ACMA); + case_REGD(CHILE); + case_REGD(UKRAINE); + case_REGD(MEXICO); + case_REGD(CN); + case_REGD(WW); + default: + return "Unknown"; + } +} + +static int rtw_debugfs_get_tx_pwr_tbl(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + struct rtw_hal *hal = &rtwdev->hal; + u8 path, rate, bw, ch, regd; + struct rtw_power_params pwr_param = {0}; + + mutex_lock(&rtwdev->mutex); + bw = hal->current_band_width; + ch = hal->current_channel; + regd = rtw_regd_get(rtwdev); + + seq_printf(m, "channel: %u\n", ch); + seq_printf(m, "bandwidth: %u\n", bw); + seq_printf(m, "regulatory: %s\n", rtw_get_regd_string(regd)); + seq_printf(m, "%-4s %-10s %-9s %-9s (%-4s %-4s %-4s) %-4s\n", + "path", "rate", "pwr", "base", "byr", "lmt", "sar", "rem"); + + mutex_lock(&hal->tx_power_mutex); + for (path = RF_PATH_A; path <= RF_PATH_B; path++) { + /* there is no CCK rates used in 5G */ + if (hal->current_band_type == RTW_BAND_5G) + rate = DESC_RATE6M; + else + rate = DESC_RATE1M; + + /* now, not support vht 3ss and vht 4ss*/ + for (; rate <= DESC_RATEVHT2SS_MCS9; rate++) { + /* now, not support ht 3ss and ht 4ss*/ + if (rate > DESC_RATEMCS15 && + rate < DESC_RATEVHT1SS_MCS0) + continue; + + rtw_get_tx_power_params(rtwdev, path, rate, bw, + ch, regd, &pwr_param); + + seq_printf(m, "%4c ", path + 'A'); + rtw_print_rate(m, rate); + seq_printf(m, " %3u(0x%02x) %4u %4d (%4d %4d %4d) %4d\n", + hal->tx_pwr_tbl[path][rate], + hal->tx_pwr_tbl[path][rate], + pwr_param.pwr_base, + min3(pwr_param.pwr_offset, + pwr_param.pwr_limit, + pwr_param.pwr_sar), + pwr_param.pwr_offset, pwr_param.pwr_limit, + pwr_param.pwr_sar, + pwr_param.pwr_remnant); + } + } + + mutex_unlock(&hal->tx_power_mutex); + mutex_unlock(&rtwdev->mutex); + + return 0; +} + +void rtw_debugfs_get_simple_phy_info(struct seq_file *m) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_traffic_stats *stats = &rtwdev->stats; + + seq_printf(m, "%-40s = %ddBm/ %d\n", "RSSI/ STA Channel", + dm_info->rssi[RF_PATH_A] - 100, hal->current_channel); + + seq_printf(m, "TP {Tx, Rx} = {%u, %u}Mbps\n", + stats->tx_throughput, stats->rx_throughput); + + seq_puts(m, "[Tx Rate] = "); + rtw_print_rate(m, dm_info->tx_rate); + seq_printf(m, "(0x%x)\n", dm_info->tx_rate); + + seq_puts(m, "[Rx Rate] = "); + rtw_print_rate(m, dm_info->curr_rx_rate); + seq_printf(m, "(0x%x)\n", dm_info->curr_rx_rate); +} + +static int rtw_debugfs_get_phy_info(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_traffic_stats *stats = &rtwdev->stats; + struct rtw_pkt_count *last_cnt = &dm_info->last_pkt_count; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct ewma_evm *ewma_evm = dm_info->ewma_evm; + struct ewma_snr *ewma_snr = dm_info->ewma_snr; + u8 ss, rate_id; + + seq_puts(m, "==========[Common Info]========\n"); + seq_printf(m, "Is link = %c\n", rtw_is_assoc(rtwdev) ? 'Y' : 'N'); + seq_printf(m, "Current CH(fc) = %u\n", rtwdev->hal.current_channel); + seq_printf(m, "Current BW = %u\n", rtwdev->hal.current_band_width); + seq_printf(m, "Current IGI = 0x%x\n", dm_info->igi_history[0]); + seq_printf(m, "TP {Tx, Rx} = {%u, %u}Mbps\n", + stats->tx_throughput, stats->rx_throughput); + seq_printf(m, "1SS for TX and RX = %c\n\n", rtwdev->hal.txrx_1ss ? + 'Y' : 'N'); + + seq_puts(m, "==========[Tx Phy Info]========\n"); + seq_puts(m, "[Tx Rate] = "); + rtw_print_rate(m, dm_info->tx_rate); + seq_printf(m, "(0x%x)\n\n", dm_info->tx_rate); + + seq_puts(m, "==========[Rx Phy Info]========\n"); + seq_printf(m, "[Rx Beacon Count] = %u\n", last_cnt->num_bcn_pkt); + seq_puts(m, "[Rx Rate] = "); + rtw_print_rate(m, dm_info->curr_rx_rate); + seq_printf(m, "(0x%x)\n", dm_info->curr_rx_rate); + + seq_puts(m, "[Rx Rate Count]:\n"); + seq_printf(m, " * CCK = {%u, %u, %u, %u}\n", + last_cnt->num_qry_pkt[DESC_RATE1M], + last_cnt->num_qry_pkt[DESC_RATE2M], + last_cnt->num_qry_pkt[DESC_RATE5_5M], + last_cnt->num_qry_pkt[DESC_RATE11M]); + + seq_printf(m, " * OFDM = {%u, %u, %u, %u, %u, %u, %u, %u}\n", + last_cnt->num_qry_pkt[DESC_RATE6M], + last_cnt->num_qry_pkt[DESC_RATE9M], + last_cnt->num_qry_pkt[DESC_RATE12M], + last_cnt->num_qry_pkt[DESC_RATE18M], + last_cnt->num_qry_pkt[DESC_RATE24M], + last_cnt->num_qry_pkt[DESC_RATE36M], + last_cnt->num_qry_pkt[DESC_RATE48M], + last_cnt->num_qry_pkt[DESC_RATE54M]); + + for (ss = 0; ss < efuse->hw_cap.nss; ss++) { + rate_id = DESC_RATEMCS0 + ss * 8; + seq_printf(m, " * HT_MCS[%u:%u] = {%u, %u, %u, %u, %u, %u, %u, %u}\n", + ss * 8, ss * 8 + 7, + last_cnt->num_qry_pkt[rate_id], + last_cnt->num_qry_pkt[rate_id + 1], + last_cnt->num_qry_pkt[rate_id + 2], + last_cnt->num_qry_pkt[rate_id + 3], + last_cnt->num_qry_pkt[rate_id + 4], + last_cnt->num_qry_pkt[rate_id + 5], + last_cnt->num_qry_pkt[rate_id + 6], + last_cnt->num_qry_pkt[rate_id + 7]); + } + + for (ss = 0; ss < efuse->hw_cap.nss; ss++) { + rate_id = DESC_RATEVHT1SS_MCS0 + ss * 10; + seq_printf(m, " * VHT_MCS-%uss MCS[0:9] = {%u, %u, %u, %u, %u, %u, %u, %u, %u, %u}\n", + ss + 1, + last_cnt->num_qry_pkt[rate_id], + last_cnt->num_qry_pkt[rate_id + 1], + last_cnt->num_qry_pkt[rate_id + 2], + last_cnt->num_qry_pkt[rate_id + 3], + last_cnt->num_qry_pkt[rate_id + 4], + last_cnt->num_qry_pkt[rate_id + 5], + last_cnt->num_qry_pkt[rate_id + 6], + last_cnt->num_qry_pkt[rate_id + 7], + last_cnt->num_qry_pkt[rate_id + 8], + last_cnt->num_qry_pkt[rate_id + 9]); + } + + seq_printf(m, "[RSSI(dBm)] = {%d, %d}\n", + dm_info->rssi[RF_PATH_A] - 100, + dm_info->rssi[RF_PATH_B] - 100); + seq_printf(m, "[Rx EVM(dB)] = {-%d, -%d}\n", + dm_info->rx_evm_dbm[RF_PATH_A], + dm_info->rx_evm_dbm[RF_PATH_B]); + seq_printf(m, "[Rx SNR] = {%d, %d}\n", + dm_info->rx_snr[RF_PATH_A], + dm_info->rx_snr[RF_PATH_B]); + seq_printf(m, "[CFO_tail(KHz)] = {%d, %d}\n", + dm_info->cfo_tail[RF_PATH_A], + dm_info->cfo_tail[RF_PATH_B]); + + if (dm_info->curr_rx_rate >= DESC_RATE11M) { + seq_puts(m, "[Rx Average Status]:\n"); + seq_printf(m, " * OFDM, EVM: {-%d}, SNR: {%d}\n", + (u8)ewma_evm_read(&ewma_evm[RTW_EVM_OFDM]), + (u8)ewma_snr_read(&ewma_snr[RTW_SNR_OFDM_A])); + seq_printf(m, " * 1SS, EVM: {-%d}, SNR: {%d}\n", + (u8)ewma_evm_read(&ewma_evm[RTW_EVM_1SS]), + (u8)ewma_snr_read(&ewma_snr[RTW_SNR_1SS_A])); + seq_printf(m, " * 2SS, EVM: {-%d, -%d}, SNR: {%d, %d}\n", + (u8)ewma_evm_read(&ewma_evm[RTW_EVM_2SS_A]), + (u8)ewma_evm_read(&ewma_evm[RTW_EVM_2SS_B]), + (u8)ewma_snr_read(&ewma_snr[RTW_SNR_2SS_A]), + (u8)ewma_snr_read(&ewma_snr[RTW_SNR_2SS_B])); + } + + seq_puts(m, "[Rx Counter]:\n"); + seq_printf(m, " * CCA (CCK, OFDM, Total) = (%u, %u, %u)\n", + dm_info->cck_cca_cnt, + dm_info->ofdm_cca_cnt, + dm_info->total_cca_cnt); + seq_printf(m, " * False Alarm (CCK, OFDM, Total) = (%u, %u, %u)\n", + dm_info->cck_fa_cnt, + dm_info->ofdm_fa_cnt, + dm_info->total_fa_cnt); + seq_printf(m, " * CCK cnt (ok, err) = (%u, %u)\n", + dm_info->cck_ok_cnt, dm_info->cck_err_cnt); + seq_printf(m, " * OFDM cnt (ok, err) = (%u, %u)\n", + dm_info->ofdm_ok_cnt, dm_info->ofdm_err_cnt); + seq_printf(m, " * HT cnt (ok, err) = (%u, %u)\n", + dm_info->ht_ok_cnt, dm_info->ht_err_cnt); + seq_printf(m, " * VHT cnt (ok, err) = (%u, %u)\n", + dm_info->vht_ok_cnt, dm_info->vht_err_cnt); + + return 0; +} + +static int rtw_debugfs_get_coex_info(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + + mutex_lock(&rtwdev->mutex); + rtw_coex_display_coex_info(rtwdev, m); + mutex_unlock(&rtwdev->mutex); + + return 0; +} + +static ssize_t rtw_debugfs_set_coex_enable(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + struct rtw_coex *coex = &rtwdev->coex; + char tmp[32 + 1]; + bool enable; + int ret; + + ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 1); + if (ret) + return ret; + + ret = kstrtobool(tmp, &enable); + if (ret) { + rtw_warn(rtwdev, "invalid arguments\n"); + return ret; + } + + mutex_lock(&rtwdev->mutex); + coex->manual_control = !enable; + mutex_unlock(&rtwdev->mutex); + + return count; +} + +static int rtw_debugfs_get_coex_enable(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + struct rtw_coex *coex = &rtwdev->coex; + + seq_printf(m, "coex mechanism %s\n", + coex->manual_control ? "disabled" : "enabled"); + + return 0; +} + +static ssize_t rtw_debugfs_set_edcca_enable(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + bool input; + int err; + + err = kstrtobool_from_user(buffer, count, &input); + if (err) + return err; + + rtw_edcca_enabled = input; + rtw_phy_adaptivity_set_mode(rtwdev); + + return count; +} + +static int rtw_debugfs_get_edcca_enable(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + seq_printf(m, "EDCCA %s: EDCCA mode %d\n", + rtw_edcca_enabled ? "enabled" : "disabled", + dm_info->edcca_mode); + return 0; +} + +static ssize_t rtw_debugfs_set_fw_crash(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + char tmp[32 + 1]; + bool input; + int ret; + + ret = rtw_debugfs_copy_from_user(tmp, sizeof(tmp), buffer, count, 1); + if (ret) + return ret; + + ret = kstrtobool(tmp, &input); + if (ret) + return -EINVAL; + + if (!input) + return -EINVAL; + + if (test_bit(RTW_FLAG_RESTARTING, rtwdev->flags)) + return -EINPROGRESS; + + mutex_lock(&rtwdev->mutex); + rtw_leave_lps_deep(rtwdev); + set_bit(RTW_FLAG_RESTART_TRIGGERING, rtwdev->flags); + rtw_write8(rtwdev, REG_HRCV_MSG, 1); + mutex_unlock(&rtwdev->mutex); + + return count; +} + +static int rtw_debugfs_get_fw_crash(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + + seq_printf(m, "%d\n", + test_bit(RTW_FLAG_RESTART_TRIGGERING, rtwdev->flags) || + test_bit(RTW_FLAG_RESTARTING, rtwdev->flags)); + return 0; +} + +static ssize_t rtw_debugfs_set_force_lowest_basic_rate(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + bool input; + int err; + + err = kstrtobool_from_user(buffer, count, &input); + if (err) + return err; + + if (input) + set_bit(RTW_FLAG_FORCE_LOWEST_RATE, rtwdev->flags); + else + clear_bit(RTW_FLAG_FORCE_LOWEST_RATE, rtwdev->flags); + + return count; +} + +static int rtw_debugfs_get_force_lowest_basic_rate(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + + seq_printf(m, "force lowest basic rate: %d\n", + test_bit(RTW_FLAG_FORCE_LOWEST_RATE, rtwdev->flags)); + + return 0; +} + +static ssize_t rtw_debugfs_set_dm_cap(struct file *filp, + const char __user *buffer, + size_t count, loff_t *loff) +{ + struct seq_file *seqpriv = (struct seq_file *)filp->private_data; + struct rtw_debugfs_priv *debugfs_priv = seqpriv->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + int bit; + bool en; + + if (kstrtoint_from_user(buffer, count, 10, &bit)) + return -EINVAL; + + en = bit > 0; + bit = abs(bit); + + if (bit >= RTW_DM_CAP_NUM) { + rtw_warn(rtwdev, "unknown DM CAP %d\n", bit); + return -EINVAL; + } + + if (en) + dm_info->dm_flags &= ~BIT(bit); + else + dm_info->dm_flags |= BIT(bit); + + debugfs_priv->dm_cap.bit = bit; + + return count; +} + +static void dump_gapk_status(struct rtw_dev *rtwdev, struct seq_file *m) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; + int i, path; + u32 val; + + seq_printf(m, "\n(%2d) %c%s\n\n", RTW_DM_CAP_TXGAPK, + dm_info->dm_flags & BIT(RTW_DM_CAP_TXGAPK) ? '-' : '+', + rtw_dm_cap_strs[RTW_DM_CAP_TXGAPK]); + + mutex_lock(&rtwdev->mutex); + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + val = rtw_read_rf(rtwdev, path, RF_GAINTX, RFREG_MASK); + seq_printf(m, "path %d:\n0x%x = 0x%x\n", path, RF_GAINTX, val); + + for (i = 0; i < RF_HW_OFFSET_NUM; i++) + seq_printf(m, "[TXGAPK] offset %d %d\n", + txgapk->rf3f_fs[path][i], i); + seq_puts(m, "\n"); + } + mutex_unlock(&rtwdev->mutex); +} + +static int rtw_debugfs_get_dm_cap(struct seq_file *m, void *v) +{ + struct rtw_debugfs_priv *debugfs_priv = m->private; + struct rtw_dev *rtwdev = debugfs_priv->rtwdev; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + int i; + + switch (debugfs_priv->dm_cap.bit) { + case RTW_DM_CAP_TXGAPK: + dump_gapk_status(rtwdev, m); + break; + default: + for (i = 1; i < RTW_DM_CAP_NUM; i++) { + seq_printf(m, "(%2d) %c%s\n", i, + dm_info->dm_flags & BIT(i) ? '-' : '+', + rtw_dm_cap_strs[i]); + } + break; + } + debugfs_priv->dm_cap.bit = RTW_DM_CAP_NA; + return 0; +} + +#define rtw_debug_impl_mac(page, addr) \ +static struct rtw_debugfs_priv rtw_debug_priv_mac_ ##page = { \ + .cb_read = rtw_debug_get_mac_page, \ + .cb_data = addr, \ +} + +rtw_debug_impl_mac(0, 0x0000); +rtw_debug_impl_mac(1, 0x0100); +rtw_debug_impl_mac(2, 0x0200); +rtw_debug_impl_mac(3, 0x0300); +rtw_debug_impl_mac(4, 0x0400); +rtw_debug_impl_mac(5, 0x0500); +rtw_debug_impl_mac(6, 0x0600); +rtw_debug_impl_mac(7, 0x0700); +rtw_debug_impl_mac(10, 0x1000); +rtw_debug_impl_mac(11, 0x1100); +rtw_debug_impl_mac(12, 0x1200); +rtw_debug_impl_mac(13, 0x1300); +rtw_debug_impl_mac(14, 0x1400); +rtw_debug_impl_mac(15, 0x1500); +rtw_debug_impl_mac(16, 0x1600); +rtw_debug_impl_mac(17, 0x1700); + +#define rtw_debug_impl_bb(page, addr) \ +static struct rtw_debugfs_priv rtw_debug_priv_bb_ ##page = { \ + .cb_read = rtw_debug_get_bb_page, \ + .cb_data = addr, \ +} + +rtw_debug_impl_bb(8, 0x0800); +rtw_debug_impl_bb(9, 0x0900); +rtw_debug_impl_bb(a, 0x0a00); +rtw_debug_impl_bb(b, 0x0b00); +rtw_debug_impl_bb(c, 0x0c00); +rtw_debug_impl_bb(d, 0x0d00); +rtw_debug_impl_bb(e, 0x0e00); +rtw_debug_impl_bb(f, 0x0f00); +rtw_debug_impl_bb(18, 0x1800); +rtw_debug_impl_bb(19, 0x1900); +rtw_debug_impl_bb(1a, 0x1a00); +rtw_debug_impl_bb(1b, 0x1b00); +rtw_debug_impl_bb(1c, 0x1c00); +rtw_debug_impl_bb(1d, 0x1d00); +rtw_debug_impl_bb(1e, 0x1e00); +rtw_debug_impl_bb(1f, 0x1f00); +rtw_debug_impl_bb(2c, 0x2c00); +rtw_debug_impl_bb(2d, 0x2d00); +rtw_debug_impl_bb(40, 0x4000); +rtw_debug_impl_bb(41, 0x4100); + +static struct rtw_debugfs_priv rtw_debug_priv_rf_dump = { + .cb_read = rtw_debug_get_rf_dump, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_tx_pwr_tbl = { + .cb_read = rtw_debugfs_get_tx_pwr_tbl, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_write_reg = { + .cb_write = rtw_debugfs_set_write_reg, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_h2c = { + .cb_write = rtw_debugfs_set_h2c, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_rf_write = { + .cb_write = rtw_debugfs_set_rf_write, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_rf_read = { + .cb_write = rtw_debugfs_set_rf_read, + .cb_read = rtw_debugfs_get_rf_read, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_read_reg = { + .cb_write = rtw_debugfs_set_read_reg, + .cb_read = rtw_debugfs_get_read_reg, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_fix_rate = { + .cb_write = rtw_debugfs_set_fix_rate, + .cb_read = rtw_debugfs_get_fix_rate, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_dump_cam = { + .cb_write = rtw_debugfs_set_single_input, + .cb_read = rtw_debugfs_get_dump_cam, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_rsvd_page = { + .cb_write = rtw_debugfs_set_rsvd_page, + .cb_read = rtw_debugfs_get_rsvd_page, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_phy_info = { + .cb_read = rtw_debugfs_get_phy_info, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_coex_enable = { + .cb_write = rtw_debugfs_set_coex_enable, + .cb_read = rtw_debugfs_get_coex_enable, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_coex_info = { + .cb_read = rtw_debugfs_get_coex_info, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_edcca_enable = { + .cb_write = rtw_debugfs_set_edcca_enable, + .cb_read = rtw_debugfs_get_edcca_enable, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_fw_crash = { + .cb_write = rtw_debugfs_set_fw_crash, + .cb_read = rtw_debugfs_get_fw_crash, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_force_lowest_basic_rate = { + .cb_write = rtw_debugfs_set_force_lowest_basic_rate, + .cb_read = rtw_debugfs_get_force_lowest_basic_rate, +}; + +static struct rtw_debugfs_priv rtw_debug_priv_dm_cap = { + .cb_write = rtw_debugfs_set_dm_cap, + .cb_read = rtw_debugfs_get_dm_cap, +}; + +#define rtw_debugfs_add_core(name, mode, fopname, parent) \ + do { \ + rtw_debug_priv_ ##name.rtwdev = rtwdev; \ + if (IS_ERR(debugfs_create_file(#name, mode, \ + parent, &rtw_debug_priv_ ##name,\ + &file_ops_ ##fopname))) \ + pr_debug("Unable to initialize debugfs:%s\n", \ + #name); \ + } while (0) + +#define rtw_debugfs_add_w(name) \ + rtw_debugfs_add_core(name, S_IFREG | 0222, common_write, debugfs_topdir) +#define rtw_debugfs_add_rw(name) \ + rtw_debugfs_add_core(name, S_IFREG | 0666, single_rw, debugfs_topdir) +#define rtw_debugfs_add_r(name) \ + rtw_debugfs_add_core(name, S_IFREG | 0444, single_r, debugfs_topdir) + +void rtw_debugfs_init(struct rtw_dev *rtwdev) +{ + struct dentry *debugfs_topdir; + + debugfs_topdir = debugfs_create_dir("rtw88", + rtwdev->hw->wiphy->debugfsdir); + rtw_debugfs_add_w(write_reg); + rtw_debugfs_add_rw(read_reg); + rtw_debugfs_add_w(rf_write); + rtw_debugfs_add_rw(rf_read); + rtw_debugfs_add_rw(fix_rate); + rtw_debugfs_add_rw(dump_cam); + rtw_debugfs_add_rw(rsvd_page); + rtw_debugfs_add_r(phy_info); + rtw_debugfs_add_r(coex_info); + rtw_debugfs_add_rw(coex_enable); + rtw_debugfs_add_w(h2c); + rtw_debugfs_add_r(mac_0); + rtw_debugfs_add_r(mac_1); + rtw_debugfs_add_r(mac_2); + rtw_debugfs_add_r(mac_3); + rtw_debugfs_add_r(mac_4); + rtw_debugfs_add_r(mac_5); + rtw_debugfs_add_r(mac_6); + rtw_debugfs_add_r(mac_7); + rtw_debugfs_add_r(bb_8); + rtw_debugfs_add_r(bb_9); + rtw_debugfs_add_r(bb_a); + rtw_debugfs_add_r(bb_b); + rtw_debugfs_add_r(bb_c); + rtw_debugfs_add_r(bb_d); + rtw_debugfs_add_r(bb_e); + rtw_debugfs_add_r(bb_f); + rtw_debugfs_add_r(mac_10); + rtw_debugfs_add_r(mac_11); + rtw_debugfs_add_r(mac_12); + rtw_debugfs_add_r(mac_13); + rtw_debugfs_add_r(mac_14); + rtw_debugfs_add_r(mac_15); + rtw_debugfs_add_r(mac_16); + rtw_debugfs_add_r(mac_17); + rtw_debugfs_add_r(bb_18); + rtw_debugfs_add_r(bb_19); + rtw_debugfs_add_r(bb_1a); + rtw_debugfs_add_r(bb_1b); + rtw_debugfs_add_r(bb_1c); + rtw_debugfs_add_r(bb_1d); + rtw_debugfs_add_r(bb_1e); + rtw_debugfs_add_r(bb_1f); + if (rtwdev->chip->id == RTW_CHIP_TYPE_8822C) { + rtw_debugfs_add_r(bb_2c); + rtw_debugfs_add_r(bb_2d); + rtw_debugfs_add_r(bb_40); + rtw_debugfs_add_r(bb_41); + } + rtw_debugfs_add_r(rf_dump); + rtw_debugfs_add_r(tx_pwr_tbl); + rtw_debugfs_add_rw(edcca_enable); + rtw_debugfs_add_rw(fw_crash); + rtw_debugfs_add_rw(force_lowest_basic_rate); + rtw_debugfs_add_rw(dm_cap); +} + +#endif /* CONFIG_RTW88_DEBUGFS */ + +#ifdef CONFIG_RTW88_DEBUG + +void __rtw_dbg(struct rtw_dev *rtwdev, enum rtw_debug_mask mask, + const char *fmt, ...) +{ + struct va_format vaf = { + .fmt = fmt, + }; + va_list args; + + va_start(args, fmt); + vaf.va = &args; + + if (rtw_debug_mask & mask) + dev_printk(KERN_DEBUG, rtwdev->dev, "%pV", &vaf); + + va_end(args); +} +EXPORT_SYMBOL(__rtw_dbg); + +#endif /* CONFIG_RTW88_DEBUG */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/debug.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/debug.h new file mode 100644 index 0000000000000000000000000000000000000000..a9149c6c2b48c5cd452c5711cfa776ea79464bfd --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/debug.h @@ -0,0 +1,62 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_DEBUG_H +#define __RTW_DEBUG_H + +enum rtw_debug_mask { + RTW_DBG_PCI = 0x00000001, + RTW_DBG_TX = 0x00000002, + RTW_DBG_RX = 0x00000004, + RTW_DBG_PHY = 0x00000008, + RTW_DBG_FW = 0x00000010, + RTW_DBG_EFUSE = 0x00000020, + RTW_DBG_COEX = 0x00000040, + RTW_DBG_RFK = 0x00000080, + RTW_DBG_REGD = 0x00000100, + RTW_DBG_DEBUGFS = 0x00000200, + RTW_DBG_PS = 0x00000400, + RTW_DBG_BF = 0x00000800, + RTW_DBG_WOW = 0x00001000, + RTW_DBG_CFO = 0x00002000, + RTW_DBG_PATH_DIV = 0x00004000, + RTW_DBG_ADAPTIVITY = 0x00008000, + RTW_DBG_HW_SCAN = 0x00010000, + RTW_DBG_STATE = 0x00020000, + RTW_DBG_SDIO = 0x00040000, + + RTW_DBG_ALL = 0xffffffff +}; + +#ifdef CONFIG_RTW88_DEBUGFS + +void rtw_debugfs_init(struct rtw_dev *rtwdev); +void rtw_debugfs_get_simple_phy_info(struct seq_file *m); + +#else + +static inline void rtw_debugfs_init(struct rtw_dev *rtwdev) {} + +#endif /* CONFIG_RTW88_DEBUGFS */ + +#ifdef CONFIG_RTW88_DEBUG + +__printf(3, 4) +void __rtw_dbg(struct rtw_dev *rtwdev, enum rtw_debug_mask mask, + const char *fmt, ...); + +#define rtw_dbg(rtwdev, a...) __rtw_dbg(rtwdev, ##a) + +#else + +static inline void rtw_dbg(struct rtw_dev *rtwdev, enum rtw_debug_mask mask, + const char *fmt, ...) {} + +#endif /* CONFIG_RTW88_DEBUG */ + +#define rtw_info(rtwdev, a...) dev_info(rtwdev->dev, ##a) +#define rtw_warn(rtwdev, a...) dev_warn(rtwdev->dev, ##a) +#define rtw_err(rtwdev, a...) dev_err(rtwdev->dev, ##a) + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/efuse.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/efuse.c new file mode 100644 index 0000000000000000000000000000000000000000..b85075cd68d0a433563be736b5c3f7f26ee5f958 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/efuse.c @@ -0,0 +1,187 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include + +#include "main.h" +#include "efuse.h" +#include "reg.h" +#include "debug.h" + +#define RTW_EFUSE_BANK_WIFI 0x0 + +static void switch_efuse_bank(struct rtw_dev *rtwdev) +{ + rtw_write32_mask(rtwdev, REG_LDO_EFUSE_CTRL, BIT_MASK_EFUSE_BANK_SEL, + RTW_EFUSE_BANK_WIFI); +} + +#define invalid_efuse_header(hdr1, hdr2) \ + ((hdr1) == 0xff || (((hdr1) & 0x1f) == 0xf && (hdr2) == 0xff)) +#define invalid_efuse_content(word_en, i) \ + (((word_en) & BIT(i)) != 0x0) +#define get_efuse_blk_idx_2_byte(hdr1, hdr2) \ + ((((hdr2) & 0xf0) >> 1) | (((hdr1) >> 5) & 0x07)) +#define get_efuse_blk_idx_1_byte(hdr1) \ + (((hdr1) & 0xf0) >> 4) +#define block_idx_to_logical_idx(blk_idx, i) \ + (((blk_idx) << 3) + ((i) << 1)) + +/* efuse header format + * + * | 7 5 4 0 | 7 4 3 0 | 15 8 7 0 | + * block[2:0] 0 1111 block[6:3] word_en[3:0] byte0 byte1 + * | header 1 (optional) | header 2 | word N | + * + * word_en: 4 bits each word. 0 -> write; 1 -> not write + * N: 1~4, depends on word_en + */ +static int rtw_dump_logical_efuse_map(struct rtw_dev *rtwdev, u8 *phy_map, + u8 *log_map) +{ + u32 physical_size = rtwdev->efuse.physical_size; + u32 protect_size = rtwdev->efuse.protect_size; + u32 logical_size = rtwdev->efuse.logical_size; + u32 phy_idx, log_idx; + u8 hdr1, hdr2; + u8 blk_idx; + u8 word_en; + int i; + + for (phy_idx = 0; phy_idx < physical_size - protect_size;) { + hdr1 = phy_map[phy_idx]; + hdr2 = phy_map[phy_idx + 1]; + if (invalid_efuse_header(hdr1, hdr2)) + break; + + if ((hdr1 & 0x1f) == 0xf) { + /* 2-byte header format */ + blk_idx = get_efuse_blk_idx_2_byte(hdr1, hdr2); + word_en = hdr2 & 0xf; + phy_idx += 2; + } else { + /* 1-byte header format */ + blk_idx = get_efuse_blk_idx_1_byte(hdr1); + word_en = hdr1 & 0xf; + phy_idx += 1; + } + + for (i = 0; i < 4; i++) { + if (invalid_efuse_content(word_en, i)) + continue; + + log_idx = block_idx_to_logical_idx(blk_idx, i); + if (phy_idx + 1 > physical_size - protect_size || + log_idx + 1 > logical_size) + return -EINVAL; + + log_map[log_idx] = phy_map[phy_idx]; + log_map[log_idx + 1] = phy_map[phy_idx + 1]; + phy_idx += 2; + } + } + return 0; +} + +static int rtw_dump_physical_efuse_map(struct rtw_dev *rtwdev, u8 *map) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + u32 size = rtwdev->efuse.physical_size; + u32 efuse_ctl; + u32 addr; + u32 cnt; + + rtw_chip_efuse_grant_on(rtwdev); + + switch_efuse_bank(rtwdev); + + /* disable 2.5V LDO */ + chip->ops->cfg_ldo25(rtwdev, false); + + efuse_ctl = rtw_read32(rtwdev, REG_EFUSE_CTRL); + + for (addr = 0; addr < size; addr++) { + efuse_ctl &= ~(BIT_MASK_EF_DATA | BITS_EF_ADDR); + efuse_ctl |= (addr & BIT_MASK_EF_ADDR) << BIT_SHIFT_EF_ADDR; + rtw_write32(rtwdev, REG_EFUSE_CTRL, efuse_ctl & (~BIT_EF_FLAG)); + + cnt = 1000000; + do { + udelay(1); + efuse_ctl = rtw_read32(rtwdev, REG_EFUSE_CTRL); + if (--cnt == 0) + return -EBUSY; + } while (!(efuse_ctl & BIT_EF_FLAG)); + + *(map + addr) = (u8)(efuse_ctl & BIT_MASK_EF_DATA); + } + + rtw_chip_efuse_grant_off(rtwdev); + + return 0; +} + +int rtw_read8_physical_efuse(struct rtw_dev *rtwdev, u16 addr, u8 *data) +{ + u32 efuse_ctl; + int ret; + + rtw_write32_mask(rtwdev, REG_EFUSE_CTRL, 0x3ff00, addr); + rtw_write32_clr(rtwdev, REG_EFUSE_CTRL, BIT_EF_FLAG); + + ret = read_poll_timeout(rtw_read32, efuse_ctl, efuse_ctl & BIT_EF_FLAG, + 1000, 100000, false, rtwdev, REG_EFUSE_CTRL); + if (ret) { + *data = EFUSE_READ_FAIL; + return ret; + } + + *data = rtw_read8(rtwdev, REG_EFUSE_CTRL); + + return 0; +} +EXPORT_SYMBOL(rtw_read8_physical_efuse); + +int rtw_parse_efuse_map(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + u32 phy_size = efuse->physical_size; + u32 log_size = efuse->logical_size; + u8 *phy_map = NULL; + u8 *log_map = NULL; + int ret = 0; + + phy_map = kmalloc(phy_size, GFP_KERNEL); + log_map = kmalloc(log_size, GFP_KERNEL); + if (!phy_map || !log_map) { + ret = -ENOMEM; + goto out_free; + } + + ret = rtw_dump_physical_efuse_map(rtwdev, phy_map); + if (ret) { + rtw_err(rtwdev, "failed to dump efuse physical map\n"); + goto out_free; + } + + memset(log_map, 0xff, log_size); + ret = rtw_dump_logical_efuse_map(rtwdev, phy_map, log_map); + if (ret) { + rtw_err(rtwdev, "failed to dump efuse logical map\n"); + goto out_free; + } + + ret = chip->ops->read_efuse(rtwdev, log_map); + if (ret) { + rtw_err(rtwdev, "failed to read efuse map\n"); + goto out_free; + } + +out_free: + kfree(log_map); + kfree(phy_map); + + return ret; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/efuse.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/efuse.h new file mode 100644 index 0000000000000000000000000000000000000000..97a51f0b0e466a57e29bb28e3000133d77a7ab3b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/efuse.h @@ -0,0 +1,29 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_EFUSE_H__ +#define __RTW_EFUSE_H__ + +#define EFUSE_HW_CAP_IGNORE 0 +#define EFUSE_HW_CAP_PTCL_VHT 3 +#define EFUSE_HW_CAP_SUPP_BW80 7 +#define EFUSE_HW_CAP_SUPP_BW40 6 + +#define EFUSE_READ_FAIL 0xff + +#define GET_EFUSE_HW_CAP_HCI(hw_cap) \ + le32_get_bits(*((__le32 *)(hw_cap) + 0x01), GENMASK(3, 0)) +#define GET_EFUSE_HW_CAP_BW(hw_cap) \ + le32_get_bits(*((__le32 *)(hw_cap) + 0x01), GENMASK(18, 16)) +#define GET_EFUSE_HW_CAP_NSS(hw_cap) \ + le32_get_bits(*((__le32 *)(hw_cap) + 0x01), GENMASK(20, 19)) +#define GET_EFUSE_HW_CAP_ANT_NUM(hw_cap) \ + le32_get_bits(*((__le32 *)(hw_cap) + 0x01), GENMASK(23, 21)) +#define GET_EFUSE_HW_CAP_PTCL(hw_cap) \ + le32_get_bits(*((__le32 *)(hw_cap) + 0x01), GENMASK(27, 26)) + +int rtw_parse_efuse_map(struct rtw_dev *rtwdev); +int rtw_read8_physical_efuse(struct rtw_dev *rtwdev, u16 addr, u8 *data); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/fw.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/fw.c new file mode 100644 index 0000000000000000000000000000000000000000..071e8ec2f8791b53261bd2104fa9372bb6ca9bed --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/fw.c @@ -0,0 +1,2386 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include + +#include "main.h" +#include "coex.h" +#include "fw.h" +#include "tx.h" +#include "reg.h" +#include "sec.h" +#include "debug.h" +#include "util.h" +#include "wow.h" +#include "ps.h" +#include "phy.h" +#include "mac.h" + +static void rtw_fw_c2h_cmd_handle_ext(struct rtw_dev *rtwdev, + struct sk_buff *skb) +{ + struct rtw_c2h_cmd *c2h; + u8 sub_cmd_id; + + c2h = get_c2h_from_skb(skb); + sub_cmd_id = c2h->payload[0]; + + switch (sub_cmd_id) { + case C2H_CCX_RPT: + rtw_tx_report_handle(rtwdev, skb, C2H_CCX_RPT); + break; + case C2H_SCAN_STATUS_RPT: + rtw_hw_scan_status_report(rtwdev, skb); + break; + case C2H_CHAN_SWITCH: + rtw_hw_scan_chan_switch(rtwdev, skb); + break; + default: + break; + } +} + +static u16 get_max_amsdu_len(u32 bit_rate) +{ + /* lower than ofdm, do not aggregate */ + if (bit_rate < 550) + return 1; + + /* lower than 20M 2ss mcs8, make it small */ + if (bit_rate < 1800) + return 1200; + + /* lower than 40M 2ss mcs9, make it medium */ + if (bit_rate < 4000) + return 2600; + + /* not yet 80M 2ss mcs8/9, make it twice regular packet size */ + if (bit_rate < 7000) + return 3500; + + /* unlimited */ + return 0; +} + +struct rtw_fw_iter_ra_data { + struct rtw_dev *rtwdev; + u8 *payload; +}; + +static void rtw_fw_ra_report_iter(void *data, struct ieee80211_sta *sta) +{ + struct rtw_fw_iter_ra_data *ra_data = data; + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + u8 mac_id, rate, sgi, bw; + u8 mcs, nss; + u32 bit_rate; + + mac_id = GET_RA_REPORT_MACID(ra_data->payload); + if (si->mac_id != mac_id) + return; + + si->ra_report.txrate.flags = 0; + + rate = GET_RA_REPORT_RATE(ra_data->payload); + sgi = GET_RA_REPORT_SGI(ra_data->payload); + bw = GET_RA_REPORT_BW(ra_data->payload); + + if (rate < DESC_RATEMCS0) { + si->ra_report.txrate.legacy = rtw_desc_to_bitrate(rate); + goto legacy; + } + + rtw_desc_to_mcsrate(rate, &mcs, &nss); + if (rate >= DESC_RATEVHT1SS_MCS0) + si->ra_report.txrate.flags |= RATE_INFO_FLAGS_VHT_MCS; + else if (rate >= DESC_RATEMCS0) + si->ra_report.txrate.flags |= RATE_INFO_FLAGS_MCS; + + if (rate >= DESC_RATEMCS0) { + si->ra_report.txrate.mcs = mcs; + si->ra_report.txrate.nss = nss; + } + + if (sgi) + si->ra_report.txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; + + if (bw == RTW_CHANNEL_WIDTH_80) + si->ra_report.txrate.bw = RATE_INFO_BW_80; + else if (bw == RTW_CHANNEL_WIDTH_40) + si->ra_report.txrate.bw = RATE_INFO_BW_40; + else + si->ra_report.txrate.bw = RATE_INFO_BW_20; + +legacy: + bit_rate = cfg80211_calculate_bitrate(&si->ra_report.txrate); + + si->ra_report.desc_rate = rate; + si->ra_report.bit_rate = bit_rate; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 1, 0) + sta->deflink.agg.max_rc_amsdu_len = get_max_amsdu_len(bit_rate); +#else + sta->max_rc_amsdu_len = get_max_amsdu_len(bit_rate); +#endif +} + +static void rtw_fw_ra_report_handle(struct rtw_dev *rtwdev, u8 *payload, + u8 length) +{ + struct rtw_fw_iter_ra_data ra_data; + + if (WARN(length < 7, "invalid ra report c2h length\n")) + return; + + rtwdev->dm_info.tx_rate = GET_RA_REPORT_RATE(payload); + ra_data.rtwdev = rtwdev; + ra_data.payload = payload; + rtw_iterate_stas_atomic(rtwdev, rtw_fw_ra_report_iter, &ra_data); +} + +struct rtw_beacon_filter_iter_data { + struct rtw_dev *rtwdev; + u8 *payload; +}; + +static void rtw_fw_bcn_filter_notify_vif_iter(void *data, + struct ieee80211_vif *vif) +{ + struct rtw_beacon_filter_iter_data *iter_data = data; + struct rtw_dev *rtwdev = iter_data->rtwdev; + u8 *payload = iter_data->payload; + u8 type = GET_BCN_FILTER_NOTIFY_TYPE(payload); + u8 event = GET_BCN_FILTER_NOTIFY_EVENT(payload); + s8 sig = (s8)GET_BCN_FILTER_NOTIFY_RSSI(payload); + + switch (type) { + case BCN_FILTER_NOTIFY_SIGNAL_CHANGE: + event = event ? NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH : + NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW; + ieee80211_cqm_rssi_notify(vif, event, sig, GFP_KERNEL); + break; + case BCN_FILTER_CONNECTION_LOSS: + ieee80211_connection_loss(vif); + break; + case BCN_FILTER_CONNECTED: + rtwdev->beacon_loss = false; + break; + case BCN_FILTER_NOTIFY_BEACON_LOSS: + rtwdev->beacon_loss = true; + rtw_leave_lps(rtwdev); + break; + } +} + +static void rtw_fw_bcn_filter_notify(struct rtw_dev *rtwdev, u8 *payload, + u8 length) +{ + struct rtw_beacon_filter_iter_data dev_iter_data; + + dev_iter_data.rtwdev = rtwdev; + dev_iter_data.payload = payload; + rtw_iterate_vifs(rtwdev, rtw_fw_bcn_filter_notify_vif_iter, + &dev_iter_data); +} + +static void rtw_fw_scan_result(struct rtw_dev *rtwdev, u8 *payload, + u8 length) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + dm_info->scan_density = payload[0]; + + rtw_dbg(rtwdev, RTW_DBG_FW, "scan.density = %x\n", + dm_info->scan_density); +} + +static void rtw_fw_adaptivity_result(struct rtw_dev *rtwdev, u8 *payload, + u8 length) +{ + struct rtw_hw_reg_offset *edcca_th = rtwdev->chip->edcca_th; + struct rtw_c2h_adaptivity *result = (struct rtw_c2h_adaptivity *)payload; + + rtw_dbg(rtwdev, RTW_DBG_ADAPTIVITY, + "Adaptivity: density %x igi %x l2h_th_init %x l2h %x h2l %x option %x\n", + result->density, result->igi, result->l2h_th_init, result->l2h, + result->h2l, result->option); + + rtw_dbg(rtwdev, RTW_DBG_ADAPTIVITY, "Reg Setting: L2H %x H2L %x\n", + rtw_read32_mask(rtwdev, edcca_th[EDCCA_TH_L2H_IDX].hw_reg.addr, + edcca_th[EDCCA_TH_L2H_IDX].hw_reg.mask), + rtw_read32_mask(rtwdev, edcca_th[EDCCA_TH_H2L_IDX].hw_reg.addr, + edcca_th[EDCCA_TH_H2L_IDX].hw_reg.mask)); + + rtw_dbg(rtwdev, RTW_DBG_ADAPTIVITY, "EDCCA Flag %s\n", + rtw_read32_mask(rtwdev, REG_EDCCA_REPORT, BIT_EDCCA_FLAG) ? + "Set" : "Unset"); +} + +void rtw_fw_c2h_cmd_handle(struct rtw_dev *rtwdev, struct sk_buff *skb) +{ + struct rtw_c2h_cmd *c2h; + u32 pkt_offset; + u8 len; + + pkt_offset = *((u32 *)skb->cb); + c2h = (struct rtw_c2h_cmd *)(skb->data + pkt_offset); + len = skb->len - pkt_offset - 2; + + mutex_lock(&rtwdev->mutex); + + if (!test_bit(RTW_FLAG_RUNNING, rtwdev->flags)) + goto unlock; + + switch (c2h->id) { + case C2H_CCX_TX_RPT: + rtw_tx_report_handle(rtwdev, skb, C2H_CCX_TX_RPT); + break; + case C2H_BT_INFO: + rtw_coex_bt_info_notify(rtwdev, c2h->payload, len); + break; + case C2H_BT_HID_INFO: + rtw_coex_bt_hid_info_notify(rtwdev, c2h->payload, len); + break; + case C2H_WLAN_INFO: + rtw_coex_wl_fwdbginfo_notify(rtwdev, c2h->payload, len); + break; + case C2H_BCN_FILTER_NOTIFY: + rtw_fw_bcn_filter_notify(rtwdev, c2h->payload, len); + break; + case C2H_HALMAC: + rtw_fw_c2h_cmd_handle_ext(rtwdev, skb); + break; + case C2H_RA_RPT: + rtw_fw_ra_report_handle(rtwdev, c2h->payload, len); + break; + default: + rtw_dbg(rtwdev, RTW_DBG_FW, "C2H 0x%x isn't handled\n", c2h->id); + break; + } + +unlock: + mutex_unlock(&rtwdev->mutex); +} + +void rtw_fw_c2h_cmd_rx_irqsafe(struct rtw_dev *rtwdev, u32 pkt_offset, + struct sk_buff *skb) +{ + struct rtw_c2h_cmd *c2h; + u8 len; + + c2h = (struct rtw_c2h_cmd *)(skb->data + pkt_offset); + len = skb->len - pkt_offset - 2; + *((u32 *)skb->cb) = pkt_offset; + + rtw_dbg(rtwdev, RTW_DBG_FW, "recv C2H, id=0x%02x, seq=0x%02x, len=%d\n", + c2h->id, c2h->seq, len); + + switch (c2h->id) { + case C2H_BT_MP_INFO: + rtw_coex_info_response(rtwdev, skb); + break; + case C2H_WLAN_RFON: + complete(&rtwdev->lps_leave_check); + dev_kfree_skb_any(skb); + break; + case C2H_SCAN_RESULT: + complete(&rtwdev->fw_scan_density); + rtw_fw_scan_result(rtwdev, c2h->payload, len); + dev_kfree_skb_any(skb); + break; + case C2H_ADAPTIVITY: + rtw_fw_adaptivity_result(rtwdev, c2h->payload, len); + dev_kfree_skb_any(skb); + break; + default: + /* pass offset for further operation */ + *((u32 *)skb->cb) = pkt_offset; + skb_queue_tail(&rtwdev->c2h_queue, skb); + ieee80211_queue_work(rtwdev->hw, &rtwdev->c2h_work); + break; + } +} +EXPORT_SYMBOL(rtw_fw_c2h_cmd_rx_irqsafe); + +void rtw_fw_c2h_cmd_isr(struct rtw_dev *rtwdev) +{ + if (rtw_read8(rtwdev, REG_MCU_TST_CFG) == VAL_FW_TRIGGER) + rtw_fw_recovery(rtwdev); + else + rtw_warn(rtwdev, "unhandled firmware c2h interrupt\n"); +} +EXPORT_SYMBOL(rtw_fw_c2h_cmd_isr); + +static void rtw_fw_send_h2c_command_register(struct rtw_dev *rtwdev, + struct rtw_h2c_register *h2c) +{ + u32 box_reg, box_ex_reg; + u8 box_state, box; + int ret; + + rtw_dbg(rtwdev, RTW_DBG_FW, "send H2C content %08x %08x\n", h2c->w0, + h2c->w1); + + lockdep_assert_held(&rtwdev->mutex); + + box = rtwdev->h2c.last_box_num; + switch (box) { + case 0: + box_reg = REG_HMEBOX0; + box_ex_reg = REG_HMEBOX0_EX; + break; + case 1: + box_reg = REG_HMEBOX1; + box_ex_reg = REG_HMEBOX1_EX; + break; + case 2: + box_reg = REG_HMEBOX2; + box_ex_reg = REG_HMEBOX2_EX; + break; + case 3: + box_reg = REG_HMEBOX3; + box_ex_reg = REG_HMEBOX3_EX; + break; + default: + WARN(1, "invalid h2c mail box number\n"); + return; + } + + ret = read_poll_timeout_atomic(rtw_read8, box_state, + !((box_state >> box) & 0x1), 100, 3000, + false, rtwdev, REG_HMETFR); + + if (ret) { + rtw_err(rtwdev, "failed to send h2c command\n"); + return; + } + + rtw_write32(rtwdev, box_ex_reg, h2c->w1); + rtw_write32(rtwdev, box_reg, h2c->w0); + + if (++rtwdev->h2c.last_box_num >= 4) + rtwdev->h2c.last_box_num = 0; +} + +static void rtw_fw_send_h2c_command(struct rtw_dev *rtwdev, + u8 *h2c) +{ + struct rtw_h2c_cmd *h2c_cmd = (struct rtw_h2c_cmd *)h2c; + u8 box; + u8 box_state; + u32 box_reg, box_ex_reg; + int ret; + + rtw_dbg(rtwdev, RTW_DBG_FW, + "send H2C content %02x%02x%02x%02x %02x%02x%02x%02x\n", + h2c[3], h2c[2], h2c[1], h2c[0], + h2c[7], h2c[6], h2c[5], h2c[4]); + + lockdep_assert_held(&rtwdev->mutex); + + box = rtwdev->h2c.last_box_num; + switch (box) { + case 0: + box_reg = REG_HMEBOX0; + box_ex_reg = REG_HMEBOX0_EX; + break; + case 1: + box_reg = REG_HMEBOX1; + box_ex_reg = REG_HMEBOX1_EX; + break; + case 2: + box_reg = REG_HMEBOX2; + box_ex_reg = REG_HMEBOX2_EX; + break; + case 3: + box_reg = REG_HMEBOX3; + box_ex_reg = REG_HMEBOX3_EX; + break; + default: + WARN(1, "invalid h2c mail box number\n"); + return; + } + + ret = read_poll_timeout_atomic(rtw_read8, box_state, + !((box_state >> box) & 0x1), 100, 3000, + false, rtwdev, REG_HMETFR); + + if (ret) { + rtw_err(rtwdev, "failed to send h2c command\n"); + return; + } + + rtw_write32(rtwdev, box_ex_reg, le32_to_cpu(h2c_cmd->msg_ext)); + rtw_write32(rtwdev, box_reg, le32_to_cpu(h2c_cmd->msg)); + + if (++rtwdev->h2c.last_box_num >= 4) + rtwdev->h2c.last_box_num = 0; +} + +void rtw_fw_h2c_cmd_dbg(struct rtw_dev *rtwdev, u8 *h2c) +{ + rtw_fw_send_h2c_command(rtwdev, h2c); +} + +static void rtw_fw_send_h2c_packet(struct rtw_dev *rtwdev, u8 *h2c_pkt) +{ + int ret; + + lockdep_assert_held(&rtwdev->mutex); + + FW_OFFLOAD_H2C_SET_SEQ_NUM(h2c_pkt, rtwdev->h2c.seq); + ret = rtw_hci_write_data_h2c(rtwdev, h2c_pkt, H2C_PKT_SIZE); + if (ret) + rtw_err(rtwdev, "failed to send h2c packet\n"); + rtwdev->h2c.seq++; +} + +void +rtw_fw_send_general_info(struct rtw_dev *rtwdev) +{ + struct rtw_fifo_conf *fifo = &rtwdev->fifo; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + u16 total_size = H2C_PKT_HDR_SIZE + 4; + + if (rtw_chip_wcpu_11n(rtwdev)) + return; + + rtw_h2c_pkt_set_header(h2c_pkt, H2C_PKT_GENERAL_INFO); + + SET_PKT_H2C_TOTAL_LEN(h2c_pkt, total_size); + + GENERAL_INFO_SET_FW_TX_BOUNDARY(h2c_pkt, + fifo->rsvd_fw_txbuf_addr - + fifo->rsvd_boundary); + + rtw_fw_send_h2c_packet(rtwdev, h2c_pkt); +} + +void +rtw_fw_send_phydm_info(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + u16 total_size = H2C_PKT_HDR_SIZE + 8; + u8 fw_rf_type = 0; + + if (rtw_chip_wcpu_11n(rtwdev)) + return; + + if (hal->rf_type == RF_1T1R) + fw_rf_type = FW_RF_1T1R; + else if (hal->rf_type == RF_2T2R) + fw_rf_type = FW_RF_2T2R; + + rtw_h2c_pkt_set_header(h2c_pkt, H2C_PKT_PHYDM_INFO); + + SET_PKT_H2C_TOTAL_LEN(h2c_pkt, total_size); + PHYDM_INFO_SET_REF_TYPE(h2c_pkt, efuse->rfe_option); + PHYDM_INFO_SET_RF_TYPE(h2c_pkt, fw_rf_type); + PHYDM_INFO_SET_CUT_VER(h2c_pkt, hal->cut_version); + PHYDM_INFO_SET_RX_ANT_STATUS(h2c_pkt, hal->antenna_tx); + PHYDM_INFO_SET_TX_ANT_STATUS(h2c_pkt, hal->antenna_rx); + + rtw_fw_send_h2c_packet(rtwdev, h2c_pkt); +} + +void rtw_fw_do_iqk(struct rtw_dev *rtwdev, struct rtw_iqk_para *para) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + u16 total_size = H2C_PKT_HDR_SIZE + 1; + + rtw_h2c_pkt_set_header(h2c_pkt, H2C_PKT_IQK); + SET_PKT_H2C_TOTAL_LEN(h2c_pkt, total_size); + IQK_SET_CLEAR(h2c_pkt, para->clear); + IQK_SET_SEGMENT_IQK(h2c_pkt, para->segment_iqk); + + rtw_fw_send_h2c_packet(rtwdev, h2c_pkt); +} +EXPORT_SYMBOL(rtw_fw_do_iqk); + +void rtw_fw_inform_rfk_status(struct rtw_dev *rtwdev, bool start) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_WIFI_CALIBRATION); + + RFK_SET_INFORM_START(h2c_pkt, start); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} +EXPORT_SYMBOL(rtw_fw_inform_rfk_status); + +void rtw_fw_query_bt_info(struct rtw_dev *rtwdev) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_QUERY_BT_INFO); + + SET_QUERY_BT_INFO(h2c_pkt, true); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_default_port(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif) +{ + struct rtw_h2c_register h2c = {}; + + if (rtwvif->net_type != RTW_NET_MGD_LINKED) + return; + + /* Leave LPS before default port H2C so FW timer is correct */ + rtw_leave_lps(rtwdev); + + h2c.w0 = u32_encode_bits(H2C_CMD_DEFAULT_PORT, RTW_H2C_W0_CMDID) | + u32_encode_bits(rtwvif->port, RTW_H2C_DEFAULT_PORT_W0_PORTID) | + u32_encode_bits(rtwvif->mac_id, RTW_H2C_DEFAULT_PORT_W0_MACID); + + rtw_fw_send_h2c_command_register(rtwdev, &h2c); +} + +void rtw_fw_wl_ch_info(struct rtw_dev *rtwdev, u8 link, u8 ch, u8 bw) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_WL_CH_INFO); + + SET_WL_CH_INFO_LINK(h2c_pkt, link); + SET_WL_CH_INFO_CHNL(h2c_pkt, ch); + SET_WL_CH_INFO_BW(h2c_pkt, bw); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_query_bt_mp_info(struct rtw_dev *rtwdev, + struct rtw_coex_info_req *req) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_QUERY_BT_MP_INFO); + + SET_BT_MP_INFO_SEQ(h2c_pkt, req->seq); + SET_BT_MP_INFO_OP_CODE(h2c_pkt, req->op_code); + SET_BT_MP_INFO_PARA1(h2c_pkt, req->para1); + SET_BT_MP_INFO_PARA2(h2c_pkt, req->para2); + SET_BT_MP_INFO_PARA3(h2c_pkt, req->para3); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_force_bt_tx_power(struct rtw_dev *rtwdev, u8 bt_pwr_dec_lvl) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + u8 index = 0 - bt_pwr_dec_lvl; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_FORCE_BT_TX_POWER); + + SET_BT_TX_POWER_INDEX(h2c_pkt, index); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_bt_ignore_wlan_action(struct rtw_dev *rtwdev, bool enable) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_IGNORE_WLAN_ACTION); + + SET_IGNORE_WLAN_ACTION_EN(h2c_pkt, enable); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_coex_tdma_type(struct rtw_dev *rtwdev, + u8 para1, u8 para2, u8 para3, u8 para4, u8 para5) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_COEX_TDMA_TYPE); + + SET_COEX_TDMA_TYPE_PARA1(h2c_pkt, para1); + SET_COEX_TDMA_TYPE_PARA2(h2c_pkt, para2); + SET_COEX_TDMA_TYPE_PARA3(h2c_pkt, para3); + SET_COEX_TDMA_TYPE_PARA4(h2c_pkt, para4); + SET_COEX_TDMA_TYPE_PARA5(h2c_pkt, para5); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_coex_query_hid_info(struct rtw_dev *rtwdev, u8 sub_id, u8 data) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_QUERY_BT_HID_INFO); + + SET_COEX_QUERY_HID_INFO_SUBID(h2c_pkt, sub_id); + SET_COEX_QUERY_HID_INFO_DATA1(h2c_pkt, data); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_bt_wifi_control(struct rtw_dev *rtwdev, u8 op_code, u8 *data) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_BT_WIFI_CONTROL); + + SET_BT_WIFI_CONTROL_OP_CODE(h2c_pkt, op_code); + + SET_BT_WIFI_CONTROL_DATA1(h2c_pkt, *data); + SET_BT_WIFI_CONTROL_DATA2(h2c_pkt, *(data + 1)); + SET_BT_WIFI_CONTROL_DATA3(h2c_pkt, *(data + 2)); + SET_BT_WIFI_CONTROL_DATA4(h2c_pkt, *(data + 3)); + SET_BT_WIFI_CONTROL_DATA5(h2c_pkt, *(data + 4)); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_send_rssi_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + u8 rssi = ewma_rssi_read(&si->avg_rssi); + bool stbc_en = si->stbc_en ? true : false; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_RSSI_MONITOR); + + SET_RSSI_INFO_MACID(h2c_pkt, si->mac_id); + SET_RSSI_INFO_RSSI(h2c_pkt, rssi); + SET_RSSI_INFO_STBC(h2c_pkt, stbc_en); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 18, 0) +void rtw_fw_send_ra_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si, + bool reset_ra_mask) +#else +void rtw_fw_send_ra_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si) +#endif +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + bool disable_pt = true; +#if LINUX_VERSION_CODE < KERNEL_VERSION(5, 18, 0) + bool reset_ra_mask = true; +#endif + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_RA_INFO); + + SET_RA_INFO_MACID(h2c_pkt, si->mac_id); + SET_RA_INFO_RATE_ID(h2c_pkt, si->rate_id); + SET_RA_INFO_INIT_RA_LVL(h2c_pkt, si->init_ra_lv); + SET_RA_INFO_SGI_EN(h2c_pkt, si->sgi_enable); + SET_RA_INFO_BW_MODE(h2c_pkt, si->bw_mode); + SET_RA_INFO_LDPC(h2c_pkt, !!si->ldpc_en); + SET_RA_INFO_NO_UPDATE(h2c_pkt, !reset_ra_mask); + SET_RA_INFO_VHT_EN(h2c_pkt, si->vht_enable); + SET_RA_INFO_DIS_PT(h2c_pkt, disable_pt); + SET_RA_INFO_RA_MASK0(h2c_pkt, (si->ra_mask & 0xff)); + SET_RA_INFO_RA_MASK1(h2c_pkt, (si->ra_mask & 0xff00) >> 8); + SET_RA_INFO_RA_MASK2(h2c_pkt, (si->ra_mask & 0xff0000) >> 16); + SET_RA_INFO_RA_MASK3(h2c_pkt, (si->ra_mask & 0xff000000) >> 24); + + si->init_ra_lv = 0; + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_media_status_report(struct rtw_dev *rtwdev, u8 mac_id, bool connect) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_MEDIA_STATUS_RPT); + MEDIA_STATUS_RPT_SET_OP_MODE(h2c_pkt, connect); + MEDIA_STATUS_RPT_SET_MACID(h2c_pkt, mac_id); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_update_wl_phy_info(struct rtw_dev *rtwdev) +{ + struct rtw_traffic_stats *stats = &rtwdev->stats; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_WL_PHY_INFO); + SET_WL_PHY_INFO_TX_TP(h2c_pkt, stats->tx_throughput); + SET_WL_PHY_INFO_RX_TP(h2c_pkt, stats->rx_throughput); + SET_WL_PHY_INFO_TX_RATE_DESC(h2c_pkt, dm_info->tx_rate); + SET_WL_PHY_INFO_RX_RATE_DESC(h2c_pkt, dm_info->curr_rx_rate); + SET_WL_PHY_INFO_RX_EVM(h2c_pkt, dm_info->rx_evm_dbm[RF_PATH_A]); + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_beacon_filter_config(struct rtw_dev *rtwdev, bool connect, + struct ieee80211_vif *vif) +{ + struct ieee80211_bss_conf *bss_conf = &vif->bss_conf; + struct ieee80211_sta *sta = ieee80211_find_sta(vif, bss_conf->bssid); + static const u8 rssi_min = 0, rssi_max = 100, rssi_offset = 100; + struct rtw_sta_info *si = + sta ? (struct rtw_sta_info *)sta->drv_priv : NULL; + s32 threshold = bss_conf->cqm_rssi_thold + rssi_offset; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_BCN_FILTER)) + return; + + if (!connect) { + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_BCN_FILTER_OFFLOAD_P1); + SET_BCN_FILTER_OFFLOAD_P1_ENABLE(h2c_pkt, connect); + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); + + return; + } + + if (!si) + return; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_BCN_FILTER_OFFLOAD_P0); + ether_addr_copy(&h2c_pkt[1], bss_conf->bssid); + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); + + memset(h2c_pkt, 0, sizeof(h2c_pkt)); + threshold = clamp_t(s32, threshold, rssi_min, rssi_max); + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_BCN_FILTER_OFFLOAD_P1); + SET_BCN_FILTER_OFFLOAD_P1_ENABLE(h2c_pkt, connect); + SET_BCN_FILTER_OFFLOAD_P1_OFFLOAD_MODE(h2c_pkt, + BCN_FILTER_OFFLOAD_MODE_DEFAULT); + SET_BCN_FILTER_OFFLOAD_P1_THRESHOLD(h2c_pkt, (u8)threshold); + SET_BCN_FILTER_OFFLOAD_P1_BCN_LOSS_CNT(h2c_pkt, BCN_LOSS_CNT); + SET_BCN_FILTER_OFFLOAD_P1_MACID(h2c_pkt, si->mac_id); + SET_BCN_FILTER_OFFLOAD_P1_HYST(h2c_pkt, bss_conf->cqm_rssi_hyst); + SET_BCN_FILTER_OFFLOAD_P1_BCN_INTERVAL(h2c_pkt, bss_conf->beacon_int); + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_set_pwr_mode(struct rtw_dev *rtwdev) +{ + struct rtw_lps_conf *conf = &rtwdev->lps_conf; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_SET_PWR_MODE); + + SET_PWR_MODE_SET_MODE(h2c_pkt, conf->mode); + SET_PWR_MODE_SET_RLBM(h2c_pkt, conf->rlbm); + SET_PWR_MODE_SET_SMART_PS(h2c_pkt, conf->smart_ps); + SET_PWR_MODE_SET_AWAKE_INTERVAL(h2c_pkt, conf->awake_interval); + SET_PWR_MODE_SET_PORT_ID(h2c_pkt, conf->port_id); + SET_PWR_MODE_SET_PWR_STATE(h2c_pkt, conf->state); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_set_keep_alive_cmd(struct rtw_dev *rtwdev, bool enable) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + struct rtw_fw_wow_keep_alive_para mode = { + .adopt = true, + .pkt_type = KEEP_ALIVE_NULL_PKT, + .period = 5, + }; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_KEEP_ALIVE); + SET_KEEP_ALIVE_ENABLE(h2c_pkt, enable); + SET_KEEP_ALIVE_ADOPT(h2c_pkt, mode.adopt); + SET_KEEP_ALIVE_PKT_TYPE(h2c_pkt, mode.pkt_type); + SET_KEEP_ALIVE_CHECK_PERIOD(h2c_pkt, mode.period); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_set_disconnect_decision_cmd(struct rtw_dev *rtwdev, bool enable) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + struct rtw_fw_wow_disconnect_para mode = { + .adopt = true, + .period = 30, + .retry_count = 5, + }; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_DISCONNECT_DECISION); + + if (test_bit(RTW_WOW_FLAG_EN_DISCONNECT, rtw_wow->flags)) { + SET_DISCONNECT_DECISION_ENABLE(h2c_pkt, enable); + SET_DISCONNECT_DECISION_ADOPT(h2c_pkt, mode.adopt); + SET_DISCONNECT_DECISION_CHECK_PERIOD(h2c_pkt, mode.period); + SET_DISCONNECT_DECISION_TRY_PKT_NUM(h2c_pkt, mode.retry_count); + } + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_set_wowlan_ctrl_cmd(struct rtw_dev *rtwdev, bool enable) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_WOWLAN); + + SET_WOWLAN_FUNC_ENABLE(h2c_pkt, enable); + if (rtw_wow_mgd_linked(rtwdev)) { + if (test_bit(RTW_WOW_FLAG_EN_MAGIC_PKT, rtw_wow->flags)) + SET_WOWLAN_MAGIC_PKT_ENABLE(h2c_pkt, enable); + if (test_bit(RTW_WOW_FLAG_EN_DISCONNECT, rtw_wow->flags)) + SET_WOWLAN_DEAUTH_WAKEUP_ENABLE(h2c_pkt, enable); + if (test_bit(RTW_WOW_FLAG_EN_REKEY_PKT, rtw_wow->flags)) + SET_WOWLAN_REKEY_WAKEUP_ENABLE(h2c_pkt, enable); + if (rtw_wow->pattern_cnt) + SET_WOWLAN_PATTERN_MATCH_ENABLE(h2c_pkt, enable); + } + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_set_aoac_global_info_cmd(struct rtw_dev *rtwdev, + u8 pairwise_key_enc, + u8 group_key_enc) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_AOAC_GLOBAL_INFO); + + SET_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(h2c_pkt, pairwise_key_enc); + SET_AOAC_GLOBAL_INFO_GROUP_ENC_ALG(h2c_pkt, group_key_enc); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_set_remote_wake_ctrl_cmd(struct rtw_dev *rtwdev, bool enable) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_REMOTE_WAKE_CTRL); + + SET_REMOTE_WAKECTRL_ENABLE(h2c_pkt, enable); + + if (rtw_wow_no_link(rtwdev)) + SET_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN(h2c_pkt, enable); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +static u8 rtw_get_rsvd_page_location(struct rtw_dev *rtwdev, + enum rtw_rsvd_packet_type type) +{ + struct rtw_rsvd_page *rsvd_pkt; + u8 location = 0; + + list_for_each_entry(rsvd_pkt, &rtwdev->rsvd_page_list, build_list) { + if (type == rsvd_pkt->type) + location = rsvd_pkt->page; + } + + return location; +} + +void rtw_fw_set_nlo_info(struct rtw_dev *rtwdev, bool enable) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + u8 loc_nlo; + + loc_nlo = rtw_get_rsvd_page_location(rtwdev, RSVD_NLO_INFO); + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_NLO_INFO); + + SET_NLO_FUN_EN(h2c_pkt, enable); + if (enable) { + if (rtw_get_lps_deep_mode(rtwdev) != LPS_DEEP_MODE_NONE) + SET_NLO_PS_32K(h2c_pkt, enable); + SET_NLO_IGNORE_SECURITY(h2c_pkt, enable); + SET_NLO_LOC_NLO_INFO(h2c_pkt, loc_nlo); + } + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_set_recover_bt_device(struct rtw_dev *rtwdev) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_RECOVER_BT_DEV); + SET_RECOVER_BT_DEV_EN(h2c_pkt, 1); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_set_pg_info(struct rtw_dev *rtwdev) +{ + struct rtw_lps_conf *conf = &rtwdev->lps_conf; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + u8 loc_pg, loc_dpk; + + loc_pg = rtw_get_rsvd_page_location(rtwdev, RSVD_LPS_PG_INFO); + loc_dpk = rtw_get_rsvd_page_location(rtwdev, RSVD_LPS_PG_DPK); + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_LPS_PG_INFO); + + LPS_PG_INFO_LOC(h2c_pkt, loc_pg); + LPS_PG_DPK_LOC(h2c_pkt, loc_dpk); + LPS_PG_SEC_CAM_EN(h2c_pkt, conf->sec_cam_backup); + LPS_PG_PATTERN_CAM_EN(h2c_pkt, conf->pattern_cam_backup); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +static u8 rtw_get_rsvd_page_probe_req_location(struct rtw_dev *rtwdev, + struct cfg80211_ssid *ssid) +{ + struct rtw_rsvd_page *rsvd_pkt; + u8 location = 0; + + list_for_each_entry(rsvd_pkt, &rtwdev->rsvd_page_list, build_list) { + if (rsvd_pkt->type != RSVD_PROBE_REQ) + continue; + if ((!ssid && !rsvd_pkt->ssid) || + rtw_ssid_equal(rsvd_pkt->ssid, ssid)) + location = rsvd_pkt->page; + } + + return location; +} + +static u16 rtw_get_rsvd_page_probe_req_size(struct rtw_dev *rtwdev, + struct cfg80211_ssid *ssid) +{ + struct rtw_rsvd_page *rsvd_pkt; + u16 size = 0; + + list_for_each_entry(rsvd_pkt, &rtwdev->rsvd_page_list, build_list) { + if (rsvd_pkt->type != RSVD_PROBE_REQ) + continue; + if ((!ssid && !rsvd_pkt->ssid) || + rtw_ssid_equal(rsvd_pkt->ssid, ssid)) + size = rsvd_pkt->probe_req_size; + } + + return size; +} + +void rtw_send_rsvd_page_h2c(struct rtw_dev *rtwdev) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + u8 location = 0; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_RSVD_PAGE); + + location = rtw_get_rsvd_page_location(rtwdev, RSVD_PROBE_RESP); + *(h2c_pkt + 1) = location; + rtw_dbg(rtwdev, RTW_DBG_FW, "RSVD_PROBE_RESP loc: %d\n", location); + + location = rtw_get_rsvd_page_location(rtwdev, RSVD_PS_POLL); + *(h2c_pkt + 2) = location; + rtw_dbg(rtwdev, RTW_DBG_FW, "RSVD_PS_POLL loc: %d\n", location); + + location = rtw_get_rsvd_page_location(rtwdev, RSVD_NULL); + *(h2c_pkt + 3) = location; + rtw_dbg(rtwdev, RTW_DBG_FW, "RSVD_NULL loc: %d\n", location); + + location = rtw_get_rsvd_page_location(rtwdev, RSVD_QOS_NULL); + *(h2c_pkt + 4) = location; + rtw_dbg(rtwdev, RTW_DBG_FW, "RSVD_QOS_NULL loc: %d\n", location); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +static struct sk_buff *rtw_nlo_info_get(struct ieee80211_hw *hw) +{ + struct rtw_dev *rtwdev = hw->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_pno_request *pno_req = &rtwdev->wow.pno_req; + struct rtw_nlo_info_hdr *nlo_hdr; + struct cfg80211_ssid *ssid; + struct sk_buff *skb; + u8 *pos, loc; + u32 size; + int i; + + if (!pno_req->inited || !pno_req->match_set_cnt) + return NULL; + + size = sizeof(struct rtw_nlo_info_hdr) + pno_req->match_set_cnt * + IEEE80211_MAX_SSID_LEN + chip->tx_pkt_desc_sz; + + skb = alloc_skb(size, GFP_KERNEL); + if (!skb) + return NULL; + + skb_reserve(skb, chip->tx_pkt_desc_sz); + + nlo_hdr = skb_put_zero(skb, sizeof(struct rtw_nlo_info_hdr)); + + nlo_hdr->nlo_count = pno_req->match_set_cnt; + nlo_hdr->hidden_ap_count = pno_req->match_set_cnt; + + /* pattern check for firmware */ + memset(nlo_hdr->pattern_check, 0xA5, FW_NLO_INFO_CHECK_SIZE); + + for (i = 0; i < pno_req->match_set_cnt; i++) + nlo_hdr->ssid_len[i] = pno_req->match_sets[i].ssid.ssid_len; + + for (i = 0; i < pno_req->match_set_cnt; i++) { + ssid = &pno_req->match_sets[i].ssid; + loc = rtw_get_rsvd_page_probe_req_location(rtwdev, ssid); + if (!loc) { + rtw_err(rtwdev, "failed to get probe req rsvd loc\n"); + kfree_skb(skb); + return NULL; + } + nlo_hdr->location[i] = loc; + } + + for (i = 0; i < pno_req->match_set_cnt; i++) { + pos = skb_put_zero(skb, IEEE80211_MAX_SSID_LEN); + memcpy(pos, pno_req->match_sets[i].ssid.ssid, + pno_req->match_sets[i].ssid.ssid_len); + } + + return skb; +} + +static struct sk_buff *rtw_cs_channel_info_get(struct ieee80211_hw *hw) +{ + struct rtw_dev *rtwdev = hw->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_pno_request *pno_req = &rtwdev->wow.pno_req; + struct ieee80211_channel *channels = pno_req->channels; + struct sk_buff *skb; + int count = pno_req->channel_cnt; + u8 *pos; + int i = 0; + + skb = alloc_skb(4 * count + chip->tx_pkt_desc_sz, GFP_KERNEL); + if (!skb) + return NULL; + + skb_reserve(skb, chip->tx_pkt_desc_sz); + + for (i = 0; i < count; i++) { + pos = skb_put_zero(skb, 4); + + CHSW_INFO_SET_CH(pos, channels[i].hw_value); + + if (channels[i].flags & IEEE80211_CHAN_RADAR) + CHSW_INFO_SET_ACTION_ID(pos, 0); + else + CHSW_INFO_SET_ACTION_ID(pos, 1); + CHSW_INFO_SET_TIMEOUT(pos, 1); + CHSW_INFO_SET_PRI_CH_IDX(pos, 1); + CHSW_INFO_SET_BW(pos, 0); + } + + return skb; +} + +static struct sk_buff *rtw_lps_pg_dpk_get(struct ieee80211_hw *hw) +{ + struct rtw_dev *rtwdev = hw->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + struct rtw_lps_pg_dpk_hdr *dpk_hdr; + struct sk_buff *skb; + u32 size; + + size = chip->tx_pkt_desc_sz + sizeof(*dpk_hdr); + skb = alloc_skb(size, GFP_KERNEL); + if (!skb) + return NULL; + + skb_reserve(skb, chip->tx_pkt_desc_sz); + dpk_hdr = skb_put_zero(skb, sizeof(*dpk_hdr)); + dpk_hdr->dpk_ch = dpk_info->dpk_ch; + dpk_hdr->dpk_path_ok = dpk_info->dpk_path_ok[0]; + memcpy(dpk_hdr->dpk_txagc, dpk_info->dpk_txagc, 2); + memcpy(dpk_hdr->dpk_gs, dpk_info->dpk_gs, 4); + memcpy(dpk_hdr->coef, dpk_info->coef, 160); + + return skb; +} + +static struct sk_buff *rtw_lps_pg_info_get(struct ieee80211_hw *hw) +{ + struct rtw_dev *rtwdev = hw->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_lps_conf *conf = &rtwdev->lps_conf; + struct rtw_lps_pg_info_hdr *pg_info_hdr; + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + struct sk_buff *skb; + u32 size; + + size = chip->tx_pkt_desc_sz + sizeof(*pg_info_hdr); + skb = alloc_skb(size, GFP_KERNEL); + if (!skb) + return NULL; + + skb_reserve(skb, chip->tx_pkt_desc_sz); + pg_info_hdr = skb_put_zero(skb, sizeof(*pg_info_hdr)); + pg_info_hdr->tx_bu_page_count = rtwdev->fifo.rsvd_drv_pg_num; + pg_info_hdr->macid = find_first_bit(rtwdev->mac_id_map, RTW_MAX_MAC_ID_NUM); + pg_info_hdr->sec_cam_count = + rtw_sec_cam_pg_backup(rtwdev, pg_info_hdr->sec_cam); + pg_info_hdr->pattern_count = rtw_wow->pattern_cnt; + + conf->sec_cam_backup = pg_info_hdr->sec_cam_count != 0; + conf->pattern_cam_backup = rtw_wow->pattern_cnt != 0; + + return skb; +} + +static struct sk_buff *rtw_get_rsvd_page_skb(struct ieee80211_hw *hw, + struct rtw_rsvd_page *rsvd_pkt) +{ + struct ieee80211_vif *vif; + struct rtw_vif *rtwvif; + struct sk_buff *skb_new; + struct cfg80211_ssid *ssid; + u16 tim_offset = 0; + + if (rsvd_pkt->type == RSVD_DUMMY) { + skb_new = alloc_skb(1, GFP_KERNEL); + if (!skb_new) + return NULL; + + skb_put(skb_new, 1); + return skb_new; + } + + rtwvif = rsvd_pkt->rtwvif; + if (!rtwvif) + return NULL; + + vif = rtwvif_to_vif(rtwvif); + + switch (rsvd_pkt->type) { + case RSVD_BEACON: +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) + skb_new = ieee80211_beacon_get_tim(hw, vif, &tim_offset, NULL, 0); +#else + skb_new = ieee80211_beacon_get_tim(hw, vif, &tim_offset, NULL); +#endif + rsvd_pkt->tim_offset = tim_offset; + break; + case RSVD_PS_POLL: + skb_new = ieee80211_pspoll_get(hw, vif); + break; + case RSVD_PROBE_RESP: + skb_new = ieee80211_proberesp_get(hw, vif); + break; + case RSVD_NULL: +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 17) +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 1, 0) + skb_new = ieee80211_nullfunc_get(hw, vif, -1, false); +#else + skb_new = ieee80211_nullfunc_get(hw, vif, false); +#endif +#else + skb_new = ieee80211_nullfunc_get(hw, vif); +#endif + break; + case RSVD_QOS_NULL: +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 17) +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 1, 0) + skb_new = ieee80211_nullfunc_get(hw, vif, -1, true); +#else + skb_new = ieee80211_nullfunc_get(hw, vif, true); +#endif +#else + skb_new = ieee80211_nullfunc_get(hw, vif); +#endif + break; + case RSVD_LPS_PG_DPK: + skb_new = rtw_lps_pg_dpk_get(hw); + break; + case RSVD_LPS_PG_INFO: + skb_new = rtw_lps_pg_info_get(hw); + break; + case RSVD_PROBE_REQ: + ssid = (struct cfg80211_ssid *)rsvd_pkt->ssid; + if (ssid) + skb_new = ieee80211_probereq_get(hw, vif->addr, + ssid->ssid, + ssid->ssid_len, 0); + else + skb_new = ieee80211_probereq_get(hw, vif->addr, NULL, 0, 0); + if (skb_new) + rsvd_pkt->probe_req_size = (u16)skb_new->len; + break; + case RSVD_NLO_INFO: + skb_new = rtw_nlo_info_get(hw); + break; + case RSVD_CH_INFO: + skb_new = rtw_cs_channel_info_get(hw); + break; + default: + return NULL; + } + + if (!skb_new) + return NULL; + + return skb_new; +} + +static void rtw_fill_rsvd_page_desc(struct rtw_dev *rtwdev, struct sk_buff *skb, + enum rtw_rsvd_packet_type type) +{ + struct rtw_tx_pkt_info pkt_info = {0}; + const struct rtw_chip_info *chip = rtwdev->chip; + u8 *pkt_desc; + + rtw_tx_rsvd_page_pkt_info_update(rtwdev, &pkt_info, skb, type); + pkt_desc = skb_push(skb, chip->tx_pkt_desc_sz); + memset(pkt_desc, 0, chip->tx_pkt_desc_sz); + rtw_tx_fill_tx_desc(&pkt_info, skb); +} + +static inline u8 rtw_len_to_page(unsigned int len, u8 page_size) +{ + return DIV_ROUND_UP(len, page_size); +} + +static void rtw_rsvd_page_list_to_buf(struct rtw_dev *rtwdev, u8 page_size, + u8 page_margin, u32 page, u8 *buf, + struct rtw_rsvd_page *rsvd_pkt) +{ + struct sk_buff *skb = rsvd_pkt->skb; + + if (page >= 1) + memcpy(buf + page_margin + page_size * (page - 1), + skb->data, skb->len); + else + memcpy(buf, skb->data, skb->len); +} + +static struct rtw_rsvd_page *rtw_alloc_rsvd_page(struct rtw_dev *rtwdev, + enum rtw_rsvd_packet_type type, + bool txdesc) +{ + struct rtw_rsvd_page *rsvd_pkt = NULL; + + rsvd_pkt = kzalloc(sizeof(*rsvd_pkt), GFP_KERNEL); + + if (!rsvd_pkt) + return NULL; + + INIT_LIST_HEAD(&rsvd_pkt->vif_list); + INIT_LIST_HEAD(&rsvd_pkt->build_list); + rsvd_pkt->type = type; + rsvd_pkt->add_txdesc = txdesc; + + return rsvd_pkt; +} + +static void rtw_insert_rsvd_page(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif, + struct rtw_rsvd_page *rsvd_pkt) +{ + lockdep_assert_held(&rtwdev->mutex); + + list_add_tail(&rsvd_pkt->vif_list, &rtwvif->rsvd_page_list); +} + +static void rtw_add_rsvd_page(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif, + enum rtw_rsvd_packet_type type, + bool txdesc) +{ + struct rtw_rsvd_page *rsvd_pkt; + + rsvd_pkt = rtw_alloc_rsvd_page(rtwdev, type, txdesc); + if (!rsvd_pkt) { + rtw_err(rtwdev, "failed to alloc rsvd page %d\n", type); + return; + } + + rsvd_pkt->rtwvif = rtwvif; + rtw_insert_rsvd_page(rtwdev, rtwvif, rsvd_pkt); +} + +static void rtw_add_rsvd_page_probe_req(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif, + struct cfg80211_ssid *ssid) +{ + struct rtw_rsvd_page *rsvd_pkt; + + rsvd_pkt = rtw_alloc_rsvd_page(rtwdev, RSVD_PROBE_REQ, true); + if (!rsvd_pkt) { + rtw_err(rtwdev, "failed to alloc probe req rsvd page\n"); + return; + } + + rsvd_pkt->rtwvif = rtwvif; + rsvd_pkt->ssid = ssid; + rtw_insert_rsvd_page(rtwdev, rtwvif, rsvd_pkt); +} + +void rtw_remove_rsvd_page(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif) +{ + struct rtw_rsvd_page *rsvd_pkt, *tmp; + + lockdep_assert_held(&rtwdev->mutex); + + /* remove all of the rsvd pages for vif */ + list_for_each_entry_safe(rsvd_pkt, tmp, &rtwvif->rsvd_page_list, + vif_list) { + list_del(&rsvd_pkt->vif_list); + if (!list_empty(&rsvd_pkt->build_list)) + list_del(&rsvd_pkt->build_list); + kfree(rsvd_pkt); + } +} + +void rtw_add_rsvd_page_bcn(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif) +{ + struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif); + + if (vif->type != NL80211_IFTYPE_AP && + vif->type != NL80211_IFTYPE_ADHOC && + vif->type != NL80211_IFTYPE_MESH_POINT) { + rtw_warn(rtwdev, "Cannot add beacon rsvd page for %d\n", + vif->type); + return; + } + + rtw_add_rsvd_page(rtwdev, rtwvif, RSVD_BEACON, false); +} + +void rtw_add_rsvd_page_pno(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif) +{ + struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif); + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + struct rtw_pno_request *rtw_pno_req = &rtw_wow->pno_req; + struct cfg80211_ssid *ssid; + int i; + + if (vif->type != NL80211_IFTYPE_STATION) { + rtw_warn(rtwdev, "Cannot add PNO rsvd page for %d\n", + vif->type); + return; + } + + for (i = 0 ; i < rtw_pno_req->match_set_cnt; i++) { + ssid = &rtw_pno_req->match_sets[i].ssid; + rtw_add_rsvd_page_probe_req(rtwdev, rtwvif, ssid); + } + + rtw_add_rsvd_page_probe_req(rtwdev, rtwvif, NULL); + rtw_add_rsvd_page(rtwdev, rtwvif, RSVD_NLO_INFO, false); + rtw_add_rsvd_page(rtwdev, rtwvif, RSVD_CH_INFO, true); +} + +void rtw_add_rsvd_page_sta(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif) +{ + struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif); + + if (vif->type != NL80211_IFTYPE_STATION) { + rtw_warn(rtwdev, "Cannot add sta rsvd page for %d\n", + vif->type); + return; + } + + rtw_add_rsvd_page(rtwdev, rtwvif, RSVD_PS_POLL, true); + rtw_add_rsvd_page(rtwdev, rtwvif, RSVD_QOS_NULL, true); + rtw_add_rsvd_page(rtwdev, rtwvif, RSVD_NULL, true); + rtw_add_rsvd_page(rtwdev, rtwvif, RSVD_LPS_PG_DPK, true); + rtw_add_rsvd_page(rtwdev, rtwvif, RSVD_LPS_PG_INFO, true); +} + +int rtw_fw_write_data_rsvd_page(struct rtw_dev *rtwdev, u16 pg_addr, + u8 *buf, u32 size) +{ + u8 bckp[2]; + u8 val; + u16 rsvd_pg_head; + u32 bcn_valid_addr; + u32 bcn_valid_mask; + int ret; + + lockdep_assert_held(&rtwdev->mutex); + + if (!size) + return -EINVAL; + + if (rtw_chip_wcpu_11n(rtwdev)) { + rtw_write32_set(rtwdev, REG_DWBCN0_CTRL, BIT_BCN_VALID); + } else { + pg_addr &= BIT_MASK_BCN_HEAD_1_V1; + pg_addr |= BIT_BCN_VALID_V1; + rtw_write16(rtwdev, REG_FIFOPAGE_CTRL_2, pg_addr); + } + + val = rtw_read8(rtwdev, REG_CR + 1); + bckp[0] = val; + val |= BIT_ENSWBCN >> 8; + rtw_write8(rtwdev, REG_CR + 1, val); + + val = rtw_read8(rtwdev, REG_FWHW_TXQ_CTRL + 2); + bckp[1] = val; + val &= ~(BIT_EN_BCNQ_DL >> 16); + rtw_write8(rtwdev, REG_FWHW_TXQ_CTRL + 2, val); + + ret = rtw_hci_write_data_rsvd_page(rtwdev, buf, size); + if (ret) { + rtw_err(rtwdev, "failed to write data to rsvd page\n"); + goto restore; + } + + if (rtw_chip_wcpu_11n(rtwdev)) { + bcn_valid_addr = REG_DWBCN0_CTRL; + bcn_valid_mask = BIT_BCN_VALID; + } else { + bcn_valid_addr = REG_FIFOPAGE_CTRL_2; + bcn_valid_mask = BIT_BCN_VALID_V1; + } + + if (!check_hw_ready(rtwdev, bcn_valid_addr, bcn_valid_mask, 1)) { + rtw_err(rtwdev, "error beacon valid\n"); + ret = -EBUSY; + } + +restore: + rsvd_pg_head = rtwdev->fifo.rsvd_boundary; + rtw_write16(rtwdev, REG_FIFOPAGE_CTRL_2, + rsvd_pg_head | BIT_BCN_VALID_V1); + rtw_write8(rtwdev, REG_FWHW_TXQ_CTRL + 2, bckp[1]); + rtw_write8(rtwdev, REG_CR + 1, bckp[0]); + + return ret; +} + +static int rtw_download_drv_rsvd_page(struct rtw_dev *rtwdev, u8 *buf, u32 size) +{ + u32 pg_size; + u32 pg_num = 0; + u16 pg_addr = 0; + + pg_size = rtwdev->chip->page_size; + pg_num = size / pg_size + ((size & (pg_size - 1)) ? 1 : 0); + if (pg_num > rtwdev->fifo.rsvd_drv_pg_num) + return -ENOMEM; + + pg_addr = rtwdev->fifo.rsvd_drv_addr; + + return rtw_fw_write_data_rsvd_page(rtwdev, pg_addr, buf, size); +} + +static void __rtw_build_rsvd_page_reset(struct rtw_dev *rtwdev) +{ + struct rtw_rsvd_page *rsvd_pkt, *tmp; + + list_for_each_entry_safe(rsvd_pkt, tmp, &rtwdev->rsvd_page_list, + build_list) { + list_del_init(&rsvd_pkt->build_list); + + /* Don't free except for the dummy rsvd page, + * others will be freed when removing vif + */ + if (rsvd_pkt->type == RSVD_DUMMY) + kfree(rsvd_pkt); + } +} + +static void rtw_build_rsvd_page_iter(void *data, u8 *mac, + struct ieee80211_vif *vif) +{ + struct rtw_dev *rtwdev = data; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + struct rtw_rsvd_page *rsvd_pkt; + + /* AP not yet started, don't gather its rsvd pages */ + if (vif->type == NL80211_IFTYPE_AP && !rtwdev->ap_active) + return; + + list_for_each_entry(rsvd_pkt, &rtwvif->rsvd_page_list, vif_list) { + if (rsvd_pkt->type == RSVD_BEACON) + list_add(&rsvd_pkt->build_list, + &rtwdev->rsvd_page_list); + else + list_add_tail(&rsvd_pkt->build_list, + &rtwdev->rsvd_page_list); + } +} + +static int __rtw_build_rsvd_page_from_vifs(struct rtw_dev *rtwdev) +{ + struct rtw_rsvd_page *rsvd_pkt; + + __rtw_build_rsvd_page_reset(rtwdev); + + /* gather rsvd page from vifs */ + rtw_iterate_vifs_atomic(rtwdev, rtw_build_rsvd_page_iter, rtwdev); + + rsvd_pkt = list_first_entry_or_null(&rtwdev->rsvd_page_list, + struct rtw_rsvd_page, build_list); + if (!rsvd_pkt) { + WARN(1, "Should not have an empty reserved page\n"); + return -EINVAL; + } + + /* the first rsvd should be beacon, otherwise add a dummy one */ + if (rsvd_pkt->type != RSVD_BEACON) { + struct rtw_rsvd_page *dummy_pkt; + + dummy_pkt = rtw_alloc_rsvd_page(rtwdev, RSVD_DUMMY, false); + if (!dummy_pkt) { + rtw_err(rtwdev, "failed to alloc dummy rsvd page\n"); + return -ENOMEM; + } + + list_add(&dummy_pkt->build_list, &rtwdev->rsvd_page_list); + } + + return 0; +} + +static u8 *rtw_build_rsvd_page(struct rtw_dev *rtwdev, u32 *size) +{ + struct ieee80211_hw *hw = rtwdev->hw; + const struct rtw_chip_info *chip = rtwdev->chip; + struct sk_buff *iter; + struct rtw_rsvd_page *rsvd_pkt; + u32 page = 0; + u8 total_page = 0; + u8 page_size, page_margin, tx_desc_sz; + u8 *buf; + int ret; + + page_size = chip->page_size; + tx_desc_sz = chip->tx_pkt_desc_sz; + page_margin = page_size - tx_desc_sz; + + ret = __rtw_build_rsvd_page_from_vifs(rtwdev); + if (ret) { + rtw_err(rtwdev, + "failed to build rsvd page from vifs, ret %d\n", ret); + return NULL; + } + + list_for_each_entry(rsvd_pkt, &rtwdev->rsvd_page_list, build_list) { + iter = rtw_get_rsvd_page_skb(hw, rsvd_pkt); + if (!iter) { + rtw_err(rtwdev, "failed to build rsvd packet\n"); + goto release_skb; + } + + /* Fill the tx_desc for the rsvd pkt that requires one. + * And iter->len will be added with size of tx_desc_sz. + */ + if (rsvd_pkt->add_txdesc) + rtw_fill_rsvd_page_desc(rtwdev, iter, rsvd_pkt->type); + + rsvd_pkt->skb = iter; + rsvd_pkt->page = total_page; + + /* Reserved page is downloaded via TX path, and TX path will + * generate a tx_desc at the header to describe length of + * the buffer. If we are not counting page numbers with the + * size of tx_desc added at the first rsvd_pkt (usually a + * beacon, firmware default refer to the first page as the + * content of beacon), we could generate a buffer which size + * is smaller than the actual size of the whole rsvd_page + */ + if (total_page == 0) { + if (rsvd_pkt->type != RSVD_BEACON && + rsvd_pkt->type != RSVD_DUMMY) { + rtw_err(rtwdev, "first page should be a beacon\n"); + goto release_skb; + } + total_page += rtw_len_to_page(iter->len + tx_desc_sz, + page_size); + } else { + total_page += rtw_len_to_page(iter->len, page_size); + } + } + + if (total_page > rtwdev->fifo.rsvd_drv_pg_num) { + rtw_err(rtwdev, "rsvd page over size: %d\n", total_page); + goto release_skb; + } + + *size = (total_page - 1) * page_size + page_margin; + buf = kzalloc(*size, GFP_KERNEL); + if (!buf) + goto release_skb; + + /* Copy the content of each rsvd_pkt to the buf, and they should + * be aligned to the pages. + * + * Note that the first rsvd_pkt is a beacon no matter what vif->type. + * And that rsvd_pkt does not require tx_desc because when it goes + * through TX path, the TX path will generate one for it. + */ + list_for_each_entry(rsvd_pkt, &rtwdev->rsvd_page_list, build_list) { + rtw_rsvd_page_list_to_buf(rtwdev, page_size, page_margin, + page, buf, rsvd_pkt); + if (page == 0) + page += rtw_len_to_page(rsvd_pkt->skb->len + + tx_desc_sz, page_size); + else + page += rtw_len_to_page(rsvd_pkt->skb->len, page_size); + + kfree_skb(rsvd_pkt->skb); + rsvd_pkt->skb = NULL; + } + + return buf; + +release_skb: + list_for_each_entry(rsvd_pkt, &rtwdev->rsvd_page_list, build_list) { + kfree_skb(rsvd_pkt->skb); + rsvd_pkt->skb = NULL; + } + + return NULL; +} + +static int rtw_download_beacon(struct rtw_dev *rtwdev) +{ + struct ieee80211_hw *hw = rtwdev->hw; + struct rtw_rsvd_page *rsvd_pkt; + struct sk_buff *skb; + int ret = 0; + + rsvd_pkt = list_first_entry_or_null(&rtwdev->rsvd_page_list, + struct rtw_rsvd_page, build_list); + if (!rsvd_pkt) { + rtw_err(rtwdev, "failed to get rsvd page from build list\n"); + return -ENOENT; + } + + if (rsvd_pkt->type != RSVD_BEACON && + rsvd_pkt->type != RSVD_DUMMY) { + rtw_err(rtwdev, "invalid rsvd page type %d, should be beacon or dummy\n", + rsvd_pkt->type); + return -EINVAL; + } + + skb = rtw_get_rsvd_page_skb(hw, rsvd_pkt); + if (!skb) { + rtw_err(rtwdev, "failed to get beacon skb\n"); + return -ENOMEM; + } + + ret = rtw_download_drv_rsvd_page(rtwdev, skb->data, skb->len); + if (ret) + rtw_err(rtwdev, "failed to download drv rsvd page\n"); + + dev_kfree_skb(skb); + + return ret; +} + +int rtw_fw_download_rsvd_page(struct rtw_dev *rtwdev) +{ + u8 *buf; + u32 size; + int ret; + + buf = rtw_build_rsvd_page(rtwdev, &size); + if (!buf) { + rtw_err(rtwdev, "failed to build rsvd page pkt\n"); + return -ENOMEM; + } + + ret = rtw_download_drv_rsvd_page(rtwdev, buf, size); + if (ret) { + rtw_err(rtwdev, "failed to download drv rsvd page\n"); + goto free; + } + + /* The last thing is to download the *ONLY* beacon again, because + * the previous tx_desc is to describe the total rsvd page. Download + * the beacon again to replace the TX desc header, and we will get + * a correct tx_desc for the beacon in the rsvd page. + */ + ret = rtw_download_beacon(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to download beacon\n"); + goto free; + } + +free: + kfree(buf); + + return ret; +} + +void rtw_fw_update_beacon_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + update_beacon_work); + + mutex_lock(&rtwdev->mutex); + rtw_fw_download_rsvd_page(rtwdev); + rtw_send_rsvd_page_h2c(rtwdev); + mutex_unlock(&rtwdev->mutex); +} + +static void rtw_fw_read_fifo_page(struct rtw_dev *rtwdev, u32 offset, u32 size, + u32 *buf, u32 residue, u16 start_pg) +{ + u32 i; + u16 idx = 0; + u16 ctl; + + ctl = rtw_read16(rtwdev, REG_PKTBUF_DBG_CTRL) & 0xf000; + /* disable rx clock gate */ + rtw_write32_set(rtwdev, REG_RCR, BIT_DISGCLK); + + do { + rtw_write16(rtwdev, REG_PKTBUF_DBG_CTRL, start_pg | ctl); + + for (i = FIFO_DUMP_ADDR + residue; + i < FIFO_DUMP_ADDR + FIFO_PAGE_SIZE; i += 4) { + buf[idx++] = rtw_read32(rtwdev, i); + size -= 4; + if (size == 0) + goto out; + } + + residue = 0; + start_pg++; + } while (size); + +out: + rtw_write16(rtwdev, REG_PKTBUF_DBG_CTRL, ctl); + /* restore rx clock gate */ + rtw_write32_clr(rtwdev, REG_RCR, BIT_DISGCLK); +} + +static void rtw_fw_read_fifo(struct rtw_dev *rtwdev, enum rtw_fw_fifo_sel sel, + u32 offset, u32 size, u32 *buf) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + u32 start_pg, residue; + + if (sel >= RTW_FW_FIFO_MAX) { + rtw_dbg(rtwdev, RTW_DBG_FW, "wrong fw fifo sel\n"); + return; + } + if (sel == RTW_FW_FIFO_SEL_RSVD_PAGE) + offset += rtwdev->fifo.rsvd_boundary << TX_PAGE_SIZE_SHIFT; + residue = offset & (FIFO_PAGE_SIZE - 1); + start_pg = (offset >> FIFO_PAGE_SIZE_SHIFT) + chip->fw_fifo_addr[sel]; + + rtw_fw_read_fifo_page(rtwdev, offset, size, buf, residue, start_pg); +} + +static bool rtw_fw_dump_check_size(struct rtw_dev *rtwdev, + enum rtw_fw_fifo_sel sel, + u32 start_addr, u32 size) +{ + switch (sel) { + case RTW_FW_FIFO_SEL_TX: + case RTW_FW_FIFO_SEL_RX: + if ((start_addr + size) > rtwdev->chip->fw_fifo_addr[sel]) + return false; + fallthrough; + default: + return true; + } +} + +int rtw_fw_dump_fifo(struct rtw_dev *rtwdev, u8 fifo_sel, u32 addr, u32 size, + u32 *buffer) +{ + if (!rtwdev->chip->fw_fifo_addr[0]) { + rtw_dbg(rtwdev, RTW_DBG_FW, "chip not support dump fw fifo\n"); + return -ENOTSUPP; + } + + if (size == 0 || !buffer) + return -EINVAL; + + if (size & 0x3) { + rtw_dbg(rtwdev, RTW_DBG_FW, "not 4byte alignment\n"); + return -EINVAL; + } + + if (!rtw_fw_dump_check_size(rtwdev, fifo_sel, addr, size)) { + rtw_dbg(rtwdev, RTW_DBG_FW, "fw fifo dump size overflow\n"); + return -EINVAL; + } + + rtw_fw_read_fifo(rtwdev, fifo_sel, addr, size, buffer); + + return 0; +} + +static void __rtw_fw_update_pkt(struct rtw_dev *rtwdev, u8 pkt_id, u16 size, + u8 location) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + u16 total_size = H2C_PKT_HDR_SIZE + H2C_PKT_UPDATE_PKT_LEN; + + rtw_h2c_pkt_set_header(h2c_pkt, H2C_PKT_UPDATE_PKT); + + SET_PKT_H2C_TOTAL_LEN(h2c_pkt, total_size); + UPDATE_PKT_SET_PKT_ID(h2c_pkt, pkt_id); + UPDATE_PKT_SET_LOCATION(h2c_pkt, location); + + /* include txdesc size */ + size += chip->tx_pkt_desc_sz; + UPDATE_PKT_SET_SIZE(h2c_pkt, size); + + rtw_fw_send_h2c_packet(rtwdev, h2c_pkt); +} + +void rtw_fw_update_pkt_probe_req(struct rtw_dev *rtwdev, + struct cfg80211_ssid *ssid) +{ + u8 loc; + u16 size; + + loc = rtw_get_rsvd_page_probe_req_location(rtwdev, ssid); + if (!loc) { + rtw_err(rtwdev, "failed to get probe_req rsvd loc\n"); + return; + } + + size = rtw_get_rsvd_page_probe_req_size(rtwdev, ssid); + if (!size) { + rtw_err(rtwdev, "failed to get probe_req rsvd size\n"); + return; + } + + __rtw_fw_update_pkt(rtwdev, RTW_PACKET_PROBE_REQ, size, loc); +} + +void rtw_fw_channel_switch(struct rtw_dev *rtwdev, bool enable) +{ + struct rtw_pno_request *rtw_pno_req = &rtwdev->wow.pno_req; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + u16 total_size = H2C_PKT_HDR_SIZE + H2C_PKT_CH_SWITCH_LEN; + u8 loc_ch_info; + const struct rtw_ch_switch_option cs_option = { + .dest_ch_en = 1, + .dest_ch = 1, + .periodic_option = 2, + .normal_period = 5, + .normal_period_sel = 0, + .normal_cycle = 10, + .slow_period = 1, + .slow_period_sel = 1, + }; + + rtw_h2c_pkt_set_header(h2c_pkt, H2C_PKT_CH_SWITCH); + SET_PKT_H2C_TOTAL_LEN(h2c_pkt, total_size); + + CH_SWITCH_SET_START(h2c_pkt, enable); + CH_SWITCH_SET_DEST_CH_EN(h2c_pkt, cs_option.dest_ch_en); + CH_SWITCH_SET_DEST_CH(h2c_pkt, cs_option.dest_ch); + CH_SWITCH_SET_NORMAL_PERIOD(h2c_pkt, cs_option.normal_period); + CH_SWITCH_SET_NORMAL_PERIOD_SEL(h2c_pkt, cs_option.normal_period_sel); + CH_SWITCH_SET_SLOW_PERIOD(h2c_pkt, cs_option.slow_period); + CH_SWITCH_SET_SLOW_PERIOD_SEL(h2c_pkt, cs_option.slow_period_sel); + CH_SWITCH_SET_NORMAL_CYCLE(h2c_pkt, cs_option.normal_cycle); + CH_SWITCH_SET_PERIODIC_OPT(h2c_pkt, cs_option.periodic_option); + + CH_SWITCH_SET_CH_NUM(h2c_pkt, rtw_pno_req->channel_cnt); + CH_SWITCH_SET_INFO_SIZE(h2c_pkt, rtw_pno_req->channel_cnt * 4); + + loc_ch_info = rtw_get_rsvd_page_location(rtwdev, RSVD_CH_INFO); + CH_SWITCH_SET_INFO_LOC(h2c_pkt, loc_ch_info); + + rtw_fw_send_h2c_packet(rtwdev, h2c_pkt); +} + +void rtw_fw_adaptivity(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + if (!rtw_edcca_enabled) { + dm_info->edcca_mode = RTW_EDCCA_NORMAL; + rtw_dbg(rtwdev, RTW_DBG_ADAPTIVITY, + "EDCCA disabled by debugfs\n"); + } + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_ADAPTIVITY); + SET_ADAPTIVITY_MODE(h2c_pkt, dm_info->edcca_mode); + SET_ADAPTIVITY_OPTION(h2c_pkt, 1); + SET_ADAPTIVITY_IGI(h2c_pkt, dm_info->igi_history[0]); + SET_ADAPTIVITY_L2H(h2c_pkt, dm_info->l2h_th_ini); + SET_ADAPTIVITY_DENSITY(h2c_pkt, dm_info->scan_density); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +void rtw_fw_scan_notify(struct rtw_dev *rtwdev, bool start) +{ + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + SET_H2C_CMD_ID_CLASS(h2c_pkt, H2C_CMD_SCAN); + SET_SCAN_START(h2c_pkt, start); + + rtw_fw_send_h2c_command(rtwdev, h2c_pkt); +} + +static int rtw_append_probe_req_ie(struct rtw_dev *rtwdev, struct sk_buff *skb, + struct sk_buff_head *list, u8 *bands, + struct rtw_vif *rtwvif) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct ieee80211_scan_ies *ies = rtwvif->scan_ies; + struct sk_buff *new; + u8 idx; + + for (idx = NL80211_BAND_2GHZ; idx < NUM_NL80211_BANDS; idx++) { + if (!(BIT(idx) & chip->band)) + continue; + new = skb_copy(skb, GFP_KERNEL); + if (!new) + return -ENOMEM; + skb_put_data(new, ies->ies[idx], ies->len[idx]); + skb_put_data(new, ies->common_ies, ies->common_ie_len); + skb_queue_tail(list, new); + (*bands)++; + } + + return 0; +} + +static int _rtw_hw_scan_update_probe_req(struct rtw_dev *rtwdev, u8 num_probes, + struct sk_buff_head *probe_req_list) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct sk_buff *skb, *tmp; + u8 page_offset = 1, *buf, page_size = chip->page_size; + u16 pg_addr = rtwdev->fifo.rsvd_h2c_info_addr, loc; + u16 buf_offset = page_size * page_offset; + u8 tx_desc_sz = chip->tx_pkt_desc_sz; + u8 page_cnt, pages; + unsigned int pkt_len; + int ret; + + if (rtw_fw_feature_ext_check(&rtwdev->fw, FW_FEATURE_EXT_OLD_PAGE_NUM)) + page_cnt = RTW_OLD_PROBE_PG_CNT; + else + page_cnt = RTW_PROBE_PG_CNT; + + pages = page_offset + num_probes * page_cnt; + + buf = kzalloc(page_size * pages, GFP_KERNEL); + if (!buf) + return -ENOMEM; + + buf_offset -= tx_desc_sz; + skb_queue_walk_safe(probe_req_list, skb, tmp) { + skb_unlink(skb, probe_req_list); + rtw_fill_rsvd_page_desc(rtwdev, skb, RSVD_PROBE_REQ); + if (skb->len > page_size * page_cnt) { + ret = -EINVAL; + goto out; + } + + memcpy(buf + buf_offset, skb->data, skb->len); + pkt_len = skb->len - tx_desc_sz; + loc = pg_addr - rtwdev->fifo.rsvd_boundary + page_offset; + __rtw_fw_update_pkt(rtwdev, RTW_PACKET_PROBE_REQ, pkt_len, loc); + + buf_offset += page_cnt * page_size; + page_offset += page_cnt; + kfree_skb(skb); + } + + ret = rtw_fw_write_data_rsvd_page(rtwdev, pg_addr, buf, buf_offset); + if (ret) { + rtw_err(rtwdev, "Download probe request to firmware failed\n"); + goto out; + } + + rtwdev->scan_info.probe_pg_size = page_offset; +out: + kfree(buf); + skb_queue_walk_safe(probe_req_list, skb, tmp) + kfree_skb(skb); + + return ret; +} + +static int rtw_hw_scan_update_probe_req(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif) +{ + struct cfg80211_scan_request *req = rtwvif->scan_req; + struct sk_buff_head list; + struct sk_buff *skb, *tmp; + u8 num = req->n_ssids, i, bands = 0; + int ret; + + skb_queue_head_init(&list); + for (i = 0; i < num; i++) { + skb = ieee80211_probereq_get(rtwdev->hw, rtwvif->mac_addr, + req->ssids[i].ssid, + req->ssids[i].ssid_len, + req->ie_len); + if (!skb) { + ret = -ENOMEM; + goto out; + } + ret = rtw_append_probe_req_ie(rtwdev, skb, &list, &bands, + rtwvif); + if (ret) + goto out; + + kfree_skb(skb); + } + + return _rtw_hw_scan_update_probe_req(rtwdev, num * bands, &list); + +out: + skb_queue_walk_safe(&list, skb, tmp) + kfree_skb(skb); + + return ret; +} + +static int rtw_add_chan_info(struct rtw_dev *rtwdev, struct rtw_chan_info *info, + struct rtw_chan_list *list, u8 *buf) +{ + u8 *chan = &buf[list->size]; + u8 info_size = RTW_CH_INFO_SIZE; + + if (list->size > list->buf_size) + return -ENOMEM; + + CH_INFO_SET_CH(chan, info->channel); + CH_INFO_SET_PRI_CH_IDX(chan, info->pri_ch_idx); + CH_INFO_SET_BW(chan, info->bw); + CH_INFO_SET_TIMEOUT(chan, info->timeout); + CH_INFO_SET_ACTION_ID(chan, info->action_id); + CH_INFO_SET_EXTRA_INFO(chan, info->extra_info); + if (info->extra_info) { + EXTRA_CH_INFO_SET_ID(chan, RTW_SCAN_EXTRA_ID_DFS); + EXTRA_CH_INFO_SET_INFO(chan, RTW_SCAN_EXTRA_ACTION_SCAN); + EXTRA_CH_INFO_SET_SIZE(chan, RTW_EX_CH_INFO_SIZE - + RTW_EX_CH_INFO_HDR_SIZE); + EXTRA_CH_INFO_SET_DFS_EXT_TIME(chan, RTW_DFS_CHAN_TIME); + info_size += RTW_EX_CH_INFO_SIZE; + } + list->size += info_size; + list->ch_num++; + + return 0; +} + +static int rtw_add_chan_list(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif, + struct rtw_chan_list *list, u8 *buf) +{ + struct cfg80211_scan_request *req = rtwvif->scan_req; + struct rtw_fifo_conf *fifo = &rtwdev->fifo; + struct ieee80211_channel *channel; + int i, ret = 0; + + for (i = 0; i < req->n_channels; i++) { + struct rtw_chan_info ch_info = {0}; + + channel = req->channels[i]; + ch_info.channel = channel->hw_value; + ch_info.bw = RTW_SCAN_WIDTH; + ch_info.pri_ch_idx = RTW_PRI_CH_IDX; + ch_info.timeout = req->duration_mandatory ? + req->duration : RTW_CHANNEL_TIME; + + if (channel->flags & (IEEE80211_CHAN_RADAR | IEEE80211_CHAN_NO_IR)) { + ch_info.action_id = RTW_CHANNEL_RADAR; + ch_info.extra_info = 1; + /* Overwrite duration for passive scans if necessary */ + ch_info.timeout = ch_info.timeout > RTW_PASS_CHAN_TIME ? + ch_info.timeout : RTW_PASS_CHAN_TIME; + } else { + ch_info.action_id = RTW_CHANNEL_ACTIVE; + } + + ret = rtw_add_chan_info(rtwdev, &ch_info, list, buf); + if (ret) + return ret; + } + + if (list->size > fifo->rsvd_pg_num << TX_PAGE_SIZE_SHIFT) { + rtw_err(rtwdev, "List exceeds rsvd page total size\n"); + return -EINVAL; + } + + list->addr = fifo->rsvd_h2c_info_addr + rtwdev->scan_info.probe_pg_size; + ret = rtw_fw_write_data_rsvd_page(rtwdev, list->addr, buf, list->size); + if (ret) + rtw_err(rtwdev, "Download channel list failed\n"); + + return ret; +} + +static void rtw_fw_set_scan_offload(struct rtw_dev *rtwdev, + struct rtw_ch_switch_option *opt, + struct rtw_vif *rtwvif, + struct rtw_chan_list *list) +{ + struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; + struct cfg80211_scan_request *req = rtwvif->scan_req; + struct rtw_fifo_conf *fifo = &rtwdev->fifo; + /* reserve one dummy page at the beginning for tx descriptor */ + u8 pkt_loc = fifo->rsvd_h2c_info_addr - fifo->rsvd_boundary + 1; + bool random_seq = req->flags & NL80211_SCAN_FLAG_RANDOM_SN; + u8 h2c_pkt[H2C_PKT_SIZE] = {0}; + + rtw_h2c_pkt_set_header(h2c_pkt, H2C_PKT_SCAN_OFFLOAD); + SET_PKT_H2C_TOTAL_LEN(h2c_pkt, H2C_PKT_CH_SWITCH_LEN); + + SCAN_OFFLOAD_SET_START(h2c_pkt, opt->switch_en); + SCAN_OFFLOAD_SET_BACK_OP_EN(h2c_pkt, opt->back_op_en); + SCAN_OFFLOAD_SET_RANDOM_SEQ_EN(h2c_pkt, random_seq); + SCAN_OFFLOAD_SET_NO_CCK_EN(h2c_pkt, req->no_cck); + SCAN_OFFLOAD_SET_CH_NUM(h2c_pkt, list->ch_num); + SCAN_OFFLOAD_SET_CH_INFO_SIZE(h2c_pkt, list->size); + SCAN_OFFLOAD_SET_CH_INFO_LOC(h2c_pkt, list->addr - fifo->rsvd_boundary); + SCAN_OFFLOAD_SET_OP_CH(h2c_pkt, scan_info->op_chan); + SCAN_OFFLOAD_SET_OP_PRI_CH_IDX(h2c_pkt, scan_info->op_pri_ch_idx); + SCAN_OFFLOAD_SET_OP_BW(h2c_pkt, scan_info->op_bw); + SCAN_OFFLOAD_SET_OP_PORT_ID(h2c_pkt, rtwvif->port); + SCAN_OFFLOAD_SET_OP_DWELL_TIME(h2c_pkt, req->duration_mandatory ? + req->duration : RTW_CHANNEL_TIME); + SCAN_OFFLOAD_SET_OP_GAP_TIME(h2c_pkt, RTW_OFF_CHAN_TIME); + SCAN_OFFLOAD_SET_SSID_NUM(h2c_pkt, req->n_ssids); + SCAN_OFFLOAD_SET_PKT_LOC(h2c_pkt, pkt_loc); + + rtw_fw_send_h2c_packet(rtwdev, h2c_pkt); +} + +void rtw_hw_scan_start(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct ieee80211_scan_request *scan_req) +{ + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + struct cfg80211_scan_request *req = &scan_req->req; + u8 mac_addr[ETH_ALEN]; + + rtwdev->scan_info.scanning_vif = vif; + rtwvif->scan_ies = &scan_req->ies; + rtwvif->scan_req = req; + + ieee80211_stop_queues(rtwdev->hw); + rtw_leave_lps_deep(rtwdev); + rtw_hci_flush_all_queues(rtwdev, false); + rtw_mac_flush_all_queues(rtwdev, false); + if (req->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) + get_random_mask_addr(mac_addr, req->mac_addr, + req->mac_addr_mask); + else + ether_addr_copy(mac_addr, vif->addr); + + rtw_core_scan_start(rtwdev, rtwvif, mac_addr, true); + + rtwdev->hal.rcr &= ~BIT_CBSSID_BCN; + rtw_write32(rtwdev, REG_RCR, rtwdev->hal.rcr); +} + +void rtw_hw_scan_complete(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + bool aborted) +{ + struct cfg80211_scan_info info = { + .aborted = aborted, + }; + struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_vif *rtwvif; + u8 chan = scan_info->op_chan; + + if (!vif) + return; + + rtwdev->hal.rcr |= BIT_CBSSID_BCN; + rtw_write32(rtwdev, REG_RCR, rtwdev->hal.rcr); + + rtw_core_scan_complete(rtwdev, vif, true); + + rtwvif = (struct rtw_vif *)vif->drv_priv; + if (chan) + rtw_store_op_chan(rtwdev, false); + rtw_phy_set_tx_power_level(rtwdev, hal->current_channel); + ieee80211_wake_queues(rtwdev->hw); + ieee80211_scan_completed(rtwdev->hw, &info); + + rtwvif->scan_req = NULL; + rtwvif->scan_ies = NULL; + rtwdev->scan_info.scanning_vif = NULL; +} + +static int rtw_hw_scan_prehandle(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif, + struct rtw_chan_list *list) +{ + struct cfg80211_scan_request *req = rtwvif->scan_req; + int size = req->n_channels * (RTW_CH_INFO_SIZE + RTW_EX_CH_INFO_SIZE); + u8 *buf; + int ret; + + buf = kmalloc(size, GFP_KERNEL); + if (!buf) + return -ENOMEM; + + ret = rtw_hw_scan_update_probe_req(rtwdev, rtwvif); + if (ret) { + rtw_err(rtwdev, "Update probe request failed\n"); + goto out; + } + + list->buf_size = size; + list->size = 0; + list->ch_num = 0; + ret = rtw_add_chan_list(rtwdev, rtwvif, list, buf); +out: + kfree(buf); + + return ret; +} + +int rtw_hw_scan_offload(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + bool enable) +{ + struct rtw_vif *rtwvif = vif ? (struct rtw_vif *)vif->drv_priv : NULL; + struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; + struct rtw_ch_switch_option cs_option = {0}; + struct rtw_chan_list chan_list = {0}; + int ret = 0; + + if (!rtwvif) + return -EINVAL; + + cs_option.switch_en = enable; + cs_option.back_op_en = scan_info->op_chan != 0; + if (enable) { + ret = rtw_hw_scan_prehandle(rtwdev, rtwvif, &chan_list); + if (ret) + goto out; + } + rtw_fw_set_scan_offload(rtwdev, &cs_option, rtwvif, &chan_list); +out: + if (rtwdev->ap_active) { + ret = rtw_download_beacon(rtwdev); + if (ret) + rtw_err(rtwdev, "HW scan download beacon failed\n"); + } + + return ret; +} + +void rtw_hw_scan_abort(struct rtw_dev *rtwdev) +{ + struct ieee80211_vif *vif = rtwdev->scan_info.scanning_vif; + + if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD)) + return; + + rtw_hw_scan_offload(rtwdev, vif, false); + rtw_hw_scan_complete(rtwdev, vif, true); +} + +void rtw_hw_scan_status_report(struct rtw_dev *rtwdev, struct sk_buff *skb) +{ + struct ieee80211_vif *vif = rtwdev->scan_info.scanning_vif; + struct rtw_c2h_cmd *c2h; + bool aborted; + u8 rc; + + if (!test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + return; + + c2h = get_c2h_from_skb(skb); + rc = GET_SCAN_REPORT_RETURN_CODE(c2h->payload); + aborted = rc != RTW_SCAN_REPORT_SUCCESS; + rtw_hw_scan_complete(rtwdev, vif, aborted); + + if (aborted) + rtw_dbg(rtwdev, RTW_DBG_HW_SCAN, "HW scan aborted with code: %d\n", rc); +} + +void rtw_store_op_chan(struct rtw_dev *rtwdev, bool backup) +{ + struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; + struct rtw_hal *hal = &rtwdev->hal; + u8 band; + + if (backup) { + scan_info->op_chan = hal->current_channel; + scan_info->op_bw = hal->current_band_width; + scan_info->op_pri_ch_idx = hal->current_primary_channel_index; + scan_info->op_pri_ch = hal->primary_channel; + } else { + band = scan_info->op_chan > 14 ? RTW_BAND_5G : RTW_BAND_2G; + rtw_update_channel(rtwdev, scan_info->op_chan, + scan_info->op_pri_ch, + band, scan_info->op_bw); + } +} + +void rtw_clear_op_chan(struct rtw_dev *rtwdev) +{ + struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; + + scan_info->op_chan = 0; + scan_info->op_bw = 0; + scan_info->op_pri_ch_idx = 0; + scan_info->op_pri_ch = 0; +} + +static bool rtw_is_op_chan(struct rtw_dev *rtwdev, u8 channel) +{ + struct rtw_hw_scan_info *scan_info = &rtwdev->scan_info; + + return channel == scan_info->op_chan; +} + +void rtw_hw_scan_chan_switch(struct rtw_dev *rtwdev, struct sk_buff *skb) +{ + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_c2h_cmd *c2h; + enum rtw_scan_notify_id id; + u8 chan, band, status; + + if (!test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + return; + + c2h = get_c2h_from_skb(skb); + chan = GET_CHAN_SWITCH_CENTRAL_CH(c2h->payload); + id = GET_CHAN_SWITCH_ID(c2h->payload); + status = GET_CHAN_SWITCH_STATUS(c2h->payload); + + if (id == RTW_SCAN_NOTIFY_ID_POSTSWITCH) { + band = chan > 14 ? RTW_BAND_5G : RTW_BAND_2G; + rtw_update_channel(rtwdev, chan, chan, band, + RTW_CHANNEL_WIDTH_20); + if (rtw_is_op_chan(rtwdev, chan)) { + rtw_store_op_chan(rtwdev, false); + ieee80211_wake_queues(rtwdev->hw); + rtw_core_enable_beacon(rtwdev, true); + } + } else if (id == RTW_SCAN_NOTIFY_ID_PRESWITCH) { + if (IS_CH_5G_BAND(chan)) { + rtw_coex_switchband_notify(rtwdev, COEX_SWITCH_TO_5G); + } else if (IS_CH_2G_BAND(chan)) { + u8 chan_type; + + if (test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + chan_type = COEX_SWITCH_TO_24G; + else + chan_type = COEX_SWITCH_TO_24G_NOFORSCAN; + rtw_coex_switchband_notify(rtwdev, chan_type); + } + /* The channel of C2H RTW_SCAN_NOTIFY_ID_PRESWITCH is next + * channel that hardware will switch. We need to stop queue + * if next channel is non-op channel. + */ + if (!rtw_is_op_chan(rtwdev, chan) && + rtw_is_op_chan(rtwdev, hal->current_channel)) { + rtw_core_enable_beacon(rtwdev, false); + ieee80211_stop_queues(rtwdev->hw); + } + } + + rtw_dbg(rtwdev, RTW_DBG_HW_SCAN, + "Chan switch: %x, id: %x, status: %x\n", chan, id, status); +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/fw.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/fw.h new file mode 100644 index 0000000000000000000000000000000000000000..1500723d1aa0c7853b74995ad34b9436b1abc0fd --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/fw.h @@ -0,0 +1,889 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_FW_H_ +#define __RTW_FW_H_ + +#define H2C_PKT_SIZE 32 +#define H2C_PKT_HDR_SIZE 8 + +/* FW bin information */ +#define FW_HDR_SIZE 64 +#define FW_HDR_CHKSUM_SIZE 8 + +#define FW_NLO_INFO_CHECK_SIZE 4 + +#define FIFO_PAGE_SIZE_SHIFT 12 +#define FIFO_PAGE_SIZE 4096 +#define FIFO_DUMP_ADDR 0x8000 + +#define DLFW_PAGE_SIZE_SHIFT_LEGACY 12 +#define DLFW_PAGE_SIZE_LEGACY 0x1000 +#define DLFW_BLK_SIZE_SHIFT_LEGACY 2 +#define DLFW_BLK_SIZE_LEGACY 4 +#define FW_START_ADDR_LEGACY 0x1000 + +#define BCN_LOSS_CNT 10 +#define BCN_FILTER_NOTIFY_SIGNAL_CHANGE 0 +#define BCN_FILTER_CONNECTION_LOSS 1 +#define BCN_FILTER_CONNECTED 2 +#define BCN_FILTER_NOTIFY_BEACON_LOSS 3 + +#define SCAN_NOTIFY_TIMEOUT msecs_to_jiffies(10) + +#define RTW_CHANNEL_TIME 45 +#define RTW_OFF_CHAN_TIME 100 +#define RTW_PASS_CHAN_TIME 105 +#define RTW_DFS_CHAN_TIME 20 +#define RTW_CH_INFO_SIZE 4 +#define RTW_EX_CH_INFO_SIZE 3 +#define RTW_EX_CH_INFO_HDR_SIZE 2 +#define RTW_SCAN_WIDTH 0 +#define RTW_PRI_CH_IDX 1 +#define RTW_OLD_PROBE_PG_CNT 2 +#define RTW_PROBE_PG_CNT 4 + +enum rtw_c2h_cmd_id { + C2H_CCX_TX_RPT = 0x03, + C2H_BT_INFO = 0x09, + C2H_BT_MP_INFO = 0x0b, + C2H_BT_HID_INFO = 0x45, + C2H_RA_RPT = 0x0c, + C2H_HW_FEATURE_REPORT = 0x19, + C2H_WLAN_INFO = 0x27, + C2H_WLAN_RFON = 0x32, + C2H_BCN_FILTER_NOTIFY = 0x36, + C2H_ADAPTIVITY = 0x37, + C2H_SCAN_RESULT = 0x38, + C2H_HW_FEATURE_DUMP = 0xfd, + C2H_HALMAC = 0xff, +}; + +enum rtw_c2h_cmd_id_ext { + C2H_SCAN_STATUS_RPT = 0x3, + C2H_CCX_RPT = 0x0f, + C2H_CHAN_SWITCH = 0x22, +}; + +struct rtw_c2h_cmd { + u8 id; + u8 seq; + u8 payload[]; +} __packed; + +struct rtw_c2h_adaptivity { + u8 density; + u8 igi; + u8 l2h_th_init; + u8 l2h; + u8 h2l; + u8 option; +} __packed; + +struct rtw_h2c_register { + u32 w0; + u32 w1; +} __packed; + +#define RTW_H2C_W0_CMDID GENMASK(7, 0) + +/* H2C_CMD_DEFAULT_PORT command */ +#define RTW_H2C_DEFAULT_PORT_W0_PORTID GENMASK(15, 8) +#define RTW_H2C_DEFAULT_PORT_W0_MACID GENMASK(23, 16) + +struct rtw_h2c_cmd { + __le32 msg; + __le32 msg_ext; +} __packed; + +enum rtw_rsvd_packet_type { + RSVD_BEACON, + RSVD_DUMMY, + RSVD_PS_POLL, + RSVD_PROBE_RESP, + RSVD_NULL, + RSVD_QOS_NULL, + RSVD_LPS_PG_DPK, + RSVD_LPS_PG_INFO, + RSVD_PROBE_REQ, + RSVD_NLO_INFO, + RSVD_CH_INFO, +}; + +enum rtw_fw_rf_type { + FW_RF_1T2R = 0, + FW_RF_2T4R = 1, + FW_RF_2T2R = 2, + FW_RF_2T3R = 3, + FW_RF_1T1R = 4, + FW_RF_2T2R_GREEN = 5, + FW_RF_3T3R = 6, + FW_RF_3T4R = 7, + FW_RF_4T4R = 8, + FW_RF_MAX_TYPE = 0xF, +}; + +enum rtw_fw_feature { + FW_FEATURE_SIG = BIT(0), + FW_FEATURE_LPS_C2H = BIT(1), + FW_FEATURE_LCLK = BIT(2), + FW_FEATURE_PG = BIT(3), + FW_FEATURE_TX_WAKE = BIT(4), + FW_FEATURE_BCN_FILTER = BIT(5), + FW_FEATURE_NOTIFY_SCAN = BIT(6), + FW_FEATURE_ADAPTIVITY = BIT(7), + FW_FEATURE_SCAN_OFFLOAD = BIT(8), + FW_FEATURE_MAX = BIT(31), +}; + +enum rtw_fw_feature_ext { + FW_FEATURE_EXT_OLD_PAGE_NUM = BIT(0), +}; + +enum rtw_beacon_filter_offload_mode { + BCN_FILTER_OFFLOAD_MODE_0 = 0, + BCN_FILTER_OFFLOAD_MODE_1, + BCN_FILTER_OFFLOAD_MODE_2, + BCN_FILTER_OFFLOAD_MODE_3, + + BCN_FILTER_OFFLOAD_MODE_DEFAULT = BCN_FILTER_OFFLOAD_MODE_0, +}; + +struct rtw_coex_info_req { + u8 seq; + u8 op_code; + u8 para1; + u8 para2; + u8 para3; +}; + +struct rtw_iqk_para { + u8 clear; + u8 segment_iqk; +}; + +struct rtw_lps_pg_dpk_hdr { + u16 dpk_path_ok; + u8 dpk_txagc[2]; + u16 dpk_gs[2]; + u32 coef[2][20]; + u8 dpk_ch; +} __packed; + +struct rtw_lps_pg_info_hdr { + u8 macid; + u8 mbssid; + u8 pattern_count; + u8 mu_tab_group_id; + u8 sec_cam_count; + u8 tx_bu_page_count; + u16 rsvd; + u8 sec_cam[MAX_PG_CAM_BACKUP_NUM]; +} __packed; + +struct rtw_rsvd_page { + /* associated with each vif */ + struct list_head vif_list; + struct rtw_vif *rtwvif; + + /* associated when build rsvd page */ + struct list_head build_list; + + struct sk_buff *skb; + enum rtw_rsvd_packet_type type; + u8 page; + u16 tim_offset; + bool add_txdesc; + struct cfg80211_ssid *ssid; + u16 probe_req_size; +}; + +enum rtw_keep_alive_pkt_type { + KEEP_ALIVE_NULL_PKT = 0, + KEEP_ALIVE_ARP_RSP = 1, +}; + +struct rtw_nlo_info_hdr { + u8 nlo_count; + u8 hidden_ap_count; + u8 rsvd1[2]; + u8 pattern_check[FW_NLO_INFO_CHECK_SIZE]; + u8 rsvd2[8]; + u8 ssid_len[16]; + u8 chiper[16]; + u8 rsvd3[16]; + u8 location[8]; +} __packed; + +enum rtw_packet_type { + RTW_PACKET_PROBE_REQ = 0x00, + + RTW_PACKET_UNDEFINE = 0x7FFFFFFF, +}; + +struct rtw_fw_wow_keep_alive_para { + bool adopt; + u8 pkt_type; + u8 period; /* unit: sec */ +}; + +struct rtw_fw_wow_disconnect_para { + bool adopt; + u8 period; /* unit: sec */ + u8 retry_count; +}; + +enum rtw_channel_type { + RTW_CHANNEL_PASSIVE, + RTW_CHANNEL_ACTIVE, + RTW_CHANNEL_RADAR, +}; + +enum rtw_scan_extra_id { + RTW_SCAN_EXTRA_ID_DFS, +}; + +enum rtw_scan_extra_info { + RTW_SCAN_EXTRA_ACTION_SCAN, +}; + +enum rtw_scan_report_code { + RTW_SCAN_REPORT_SUCCESS = 0x00, + RTW_SCAN_REPORT_ERR_PHYDM = 0x01, + RTW_SCAN_REPORT_ERR_ID = 0x02, + RTW_SCAN_REPORT_ERR_TX = 0x03, + RTW_SCAN_REPORT_CANCELED = 0x10, + RTW_SCAN_REPORT_CANCELED_EXT = 0x11, + RTW_SCAN_REPORT_FW_DISABLED = 0xF0, +}; + +enum rtw_scan_notify_id { + RTW_SCAN_NOTIFY_ID_PRESWITCH = 0x00, + RTW_SCAN_NOTIFY_ID_POSTSWITCH = 0x01, + RTW_SCAN_NOTIFY_ID_PROBE_PRETX = 0x02, + RTW_SCAN_NOTIFY_ID_PROBE_ISSUETX = 0x03, + RTW_SCAN_NOTIFY_ID_NULL0_PRETX = 0x04, + RTW_SCAN_NOTIFY_ID_NULL0_ISSUETX = 0x05, + RTW_SCAN_NOTIFY_ID_NULL0_POSTTX = 0x06, + RTW_SCAN_NOTIFY_ID_NULL1_PRETX = 0x07, + RTW_SCAN_NOTIFY_ID_NULL1_ISSUETX = 0x08, + RTW_SCAN_NOTIFY_ID_NULL1_POSTTX = 0x09, + RTW_SCAN_NOTIFY_ID_DWELLEXT = 0x0A, +}; + +enum rtw_scan_notify_status { + RTW_SCAN_NOTIFY_STATUS_SUCCESS = 0x00, + RTW_SCAN_NOTIFY_STATUS_FAILURE = 0x01, + RTW_SCAN_NOTIFY_STATUS_RESOURCE = 0x02, + RTW_SCAN_NOTIFY_STATUS_TIMEOUT = 0x03, +}; + +struct rtw_ch_switch_option { + u8 periodic_option; + u32 tsf_high; + u32 tsf_low; + u8 dest_ch_en; + u8 absolute_time_en; + u8 dest_ch; + u8 normal_period; + u8 normal_period_sel; + u8 normal_cycle; + u8 slow_period; + u8 slow_period_sel; + u8 nlo_en; + bool switch_en; + bool back_op_en; +}; + +struct rtw_fw_hdr { + __le16 signature; + u8 category; + u8 function; + __le16 version; /* 0x04 */ + u8 subversion; + u8 subindex; + __le32 rsvd; /* 0x08 */ + __le32 feature; /* 0x0C */ + u8 month; /* 0x10 */ + u8 day; + u8 hour; + u8 min; + __le16 year; /* 0x14 */ + __le16 rsvd3; + u8 mem_usage; /* 0x18 */ + u8 rsvd4[3]; + __le16 h2c_fmt_ver; /* 0x1C */ + __le16 rsvd5; + __le32 dmem_addr; /* 0x20 */ + __le32 dmem_size; + __le32 rsvd6; + __le32 rsvd7; + __le32 imem_size; /* 0x30 */ + __le32 emem_size; + __le32 emem_addr; + __le32 imem_addr; +} __packed; + +struct rtw_fw_hdr_legacy { + __le16 signature; + u8 category; + u8 function; + __le16 version; /* 0x04 */ + u8 subversion1; + u8 subversion2; + u8 month; /* 0x08 */ + u8 day; + u8 hour; + u8 minute; + __le16 size; + __le16 rsvd2; + __le32 idx; /* 0x10 */ + __le32 rsvd3; + __le32 rsvd4; /* 0x18 */ + __le32 rsvd5; +} __packed; + +#define RTW_FW_VER_CODE(ver, sub_ver, idx) \ + (((ver) << 16) | ((sub_ver) << 8) | (idx)) +#define RTW_FW_SUIT_VER_CODE(s) \ + RTW_FW_VER_CODE((s).version, (s).sub_version, (s).sub_index) + +/* C2H */ +#define GET_CCX_REPORT_SEQNUM_V0(c2h_payload) (c2h_payload[6] & 0xfc) +#define GET_CCX_REPORT_STATUS_V0(c2h_payload) (c2h_payload[0] & 0xc0) +#define GET_CCX_REPORT_SEQNUM_V1(c2h_payload) (c2h_payload[8] & 0xfc) +#define GET_CCX_REPORT_STATUS_V1(c2h_payload) (c2h_payload[9] & 0xc0) + +#define GET_SCAN_REPORT_RETURN_CODE(c2h_payload) (c2h_payload[2] & 0xff) + +#define GET_CHAN_SWITCH_CENTRAL_CH(c2h_payload) (c2h_payload[2]) +#define GET_CHAN_SWITCH_ID(c2h_payload) (c2h_payload[3]) +#define GET_CHAN_SWITCH_STATUS(c2h_payload) (c2h_payload[4]) +#define GET_RA_REPORT_RATE(c2h_payload) (c2h_payload[0] & 0x7f) +#define GET_RA_REPORT_SGI(c2h_payload) ((c2h_payload[0] & 0x80) >> 7) +#define GET_RA_REPORT_BW(c2h_payload) (c2h_payload[6]) +#define GET_RA_REPORT_MACID(c2h_payload) (c2h_payload[1]) + +#define GET_BCN_FILTER_NOTIFY_TYPE(c2h_payload) (c2h_payload[1] & 0xf) +#define GET_BCN_FILTER_NOTIFY_EVENT(c2h_payload) (c2h_payload[1] & 0x10) +#define GET_BCN_FILTER_NOTIFY_RSSI(c2h_payload) (c2h_payload[2] - 100) + +/* PKT H2C */ +#define H2C_PKT_CMD_ID 0xFF +#define H2C_PKT_CATEGORY 0x01 + +#define H2C_PKT_GENERAL_INFO 0x0D +#define H2C_PKT_PHYDM_INFO 0x11 +#define H2C_PKT_IQK 0x0E + +#define H2C_PKT_CH_SWITCH 0x02 +#define H2C_PKT_UPDATE_PKT 0x0C +#define H2C_PKT_SCAN_OFFLOAD 0x19 + +#define H2C_PKT_CH_SWITCH_LEN 0x20 +#define H2C_PKT_UPDATE_PKT_LEN 0x4 + +#define SET_PKT_H2C_CATEGORY(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(6, 0)) +#define SET_PKT_H2C_CMD_ID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) +#define SET_PKT_H2C_SUB_CMD_ID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 16)) +#define SET_PKT_H2C_TOTAL_LEN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(15, 0)) + +static inline void rtw_h2c_pkt_set_header(u8 *h2c_pkt, u8 sub_id) +{ + SET_PKT_H2C_CATEGORY(h2c_pkt, H2C_PKT_CATEGORY); + SET_PKT_H2C_CMD_ID(h2c_pkt, H2C_PKT_CMD_ID); + SET_PKT_H2C_SUB_CMD_ID(h2c_pkt, sub_id); +} + +#define FW_OFFLOAD_H2C_SET_SEQ_NUM(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(31, 16)) +#define GENERAL_INFO_SET_FW_TX_BOUNDARY(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(23, 16)) + +#define PHYDM_INFO_SET_REF_TYPE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(7, 0)) +#define PHYDM_INFO_SET_RF_TYPE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(15, 8)) +#define PHYDM_INFO_SET_CUT_VER(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(23, 16)) +#define PHYDM_INFO_SET_RX_ANT_STATUS(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(27, 24)) +#define PHYDM_INFO_SET_TX_ANT_STATUS(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(31, 28)) +#define IQK_SET_CLEAR(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(0)) +#define IQK_SET_SEGMENT_IQK(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(1)) + +#define CHSW_INFO_SET_CH(pkt, value) \ + le32p_replace_bits((__le32 *)(pkt) + 0x00, value, GENMASK(7, 0)) +#define CHSW_INFO_SET_PRI_CH_IDX(pkt, value) \ + le32p_replace_bits((__le32 *)(pkt) + 0x00, value, GENMASK(11, 8)) +#define CHSW_INFO_SET_BW(pkt, value) \ + le32p_replace_bits((__le32 *)(pkt) + 0x00, value, GENMASK(15, 12)) +#define CHSW_INFO_SET_TIMEOUT(pkt, value) \ + le32p_replace_bits((__le32 *)(pkt) + 0x00, value, GENMASK(23, 16)) +#define CHSW_INFO_SET_ACTION_ID(pkt, value) \ + le32p_replace_bits((__le32 *)(pkt) + 0x00, value, GENMASK(30, 24)) +#define CHSW_INFO_SET_EXTRA_INFO(pkt, value) \ + le32p_replace_bits((__le32 *)(pkt) + 0x00, value, BIT(31)) + +#define CH_INFO_SET_CH(pkt, value) \ + u8p_replace_bits((u8 *)(pkt) + 0x00, value, GENMASK(7, 0)) +#define CH_INFO_SET_PRI_CH_IDX(pkt, value) \ + u8p_replace_bits((u8 *)(pkt) + 0x01, value, GENMASK(3, 0)) +#define CH_INFO_SET_BW(pkt, value) \ + u8p_replace_bits((u8 *)(pkt) + 0x01, value, GENMASK(7, 4)) +#define CH_INFO_SET_TIMEOUT(pkt, value) \ + u8p_replace_bits((u8 *)(pkt) + 0x02, value, GENMASK(7, 0)) +#define CH_INFO_SET_ACTION_ID(pkt, value) \ + u8p_replace_bits((u8 *)(pkt) + 0x03, value, GENMASK(6, 0)) +#define CH_INFO_SET_EXTRA_INFO(pkt, value) \ + u8p_replace_bits((u8 *)(pkt) + 0x03, value, BIT(7)) + +#define EXTRA_CH_INFO_SET_ID(pkt, value) \ + u8p_replace_bits((u8 *)(pkt) + 0x04, value, GENMASK(6, 0)) +#define EXTRA_CH_INFO_SET_INFO(pkt, value) \ + u8p_replace_bits((u8 *)(pkt) + 0x04, value, BIT(7)) +#define EXTRA_CH_INFO_SET_SIZE(pkt, value) \ + u8p_replace_bits((u8 *)(pkt) + 0x05, value, GENMASK(7, 0)) +#define EXTRA_CH_INFO_SET_DFS_EXT_TIME(pkt, value) \ + u8p_replace_bits((u8 *)(pkt) + 0x06, value, GENMASK(7, 0)) + +#define UPDATE_PKT_SET_SIZE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(15, 0)) +#define UPDATE_PKT_SET_PKT_ID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(23, 16)) +#define UPDATE_PKT_SET_LOCATION(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(31, 24)) + +#define CH_SWITCH_SET_START(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(0)) +#define CH_SWITCH_SET_DEST_CH_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(1)) +#define CH_SWITCH_SET_ABSOLUTE_TIME(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(2)) +#define CH_SWITCH_SET_PERIODIC_OPT(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(4, 3)) +#define CH_SWITCH_SET_SCAN_MODE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(5)) +#define CH_SWITCH_SET_BACK_OP_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(6)) +#define CH_SWITCH_SET_INFO_LOC(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(15, 8)) +#define CH_SWITCH_SET_CH_NUM(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(23, 16)) +#define CH_SWITCH_SET_PRI_CH_IDX(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(27, 24)) +#define CH_SWITCH_SET_DEST_BW(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(31, 28)) +#define CH_SWITCH_SET_DEST_CH(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(7, 0)) +#define CH_SWITCH_SET_NORMAL_PERIOD(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(13, 8)) +#define CH_SWITCH_SET_NORMAL_PERIOD_SEL(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(15, 14)) +#define CH_SWITCH_SET_SLOW_PERIOD(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(21, 16)) +#define CH_SWITCH_SET_SLOW_PERIOD_SEL(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(23, 22)) +#define CH_SWITCH_SET_NORMAL_CYCLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(31, 24)) +#define CH_SWITCH_SET_TSF_HIGH(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x04, value, GENMASK(31, 0)) +#define CH_SWITCH_SET_TSF_LOW(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x05, value, GENMASK(31, 0)) +#define CH_SWITCH_SET_INFO_SIZE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x06, value, GENMASK(15, 0)) + +#define SCAN_OFFLOAD_SET_START(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(0)) +#define SCAN_OFFLOAD_SET_BACK_OP_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(1)) +#define SCAN_OFFLOAD_SET_RANDOM_SEQ_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(2)) +#define SCAN_OFFLOAD_SET_NO_CCK_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(3)) +#define SCAN_OFFLOAD_SET_VERBOSE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, BIT(4)) +#define SCAN_OFFLOAD_SET_CH_NUM(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(15, 8)) +#define SCAN_OFFLOAD_SET_CH_INFO_SIZE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x02, value, GENMASK(31, 16)) +#define SCAN_OFFLOAD_SET_CH_INFO_LOC(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(7, 0)) +#define SCAN_OFFLOAD_SET_OP_CH(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(15, 8)) +#define SCAN_OFFLOAD_SET_OP_PRI_CH_IDX(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(19, 16)) +#define SCAN_OFFLOAD_SET_OP_BW(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(23, 20)) +#define SCAN_OFFLOAD_SET_OP_PORT_ID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x03, value, GENMASK(26, 24)) +#define SCAN_OFFLOAD_SET_OP_DWELL_TIME(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x04, value, GENMASK(15, 0)) +#define SCAN_OFFLOAD_SET_OP_GAP_TIME(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x04, value, GENMASK(31, 16)) +#define SCAN_OFFLOAD_SET_MODE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x05, value, GENMASK(3, 0)) +#define SCAN_OFFLOAD_SET_SSID_NUM(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x05, value, GENMASK(7, 4)) +#define SCAN_OFFLOAD_SET_PKT_LOC(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x05, value, GENMASK(15, 8)) + +/* Command H2C */ +#define H2C_CMD_RSVD_PAGE 0x0 +#define H2C_CMD_MEDIA_STATUS_RPT 0x01 +#define H2C_CMD_SET_PWR_MODE 0x20 +#define H2C_CMD_LPS_PG_INFO 0x2b +#define H2C_CMD_DEFAULT_PORT 0x2c +#define H2C_CMD_RA_INFO 0x40 +#define H2C_CMD_RSSI_MONITOR 0x42 +#define H2C_CMD_BCN_FILTER_OFFLOAD_P0 0x56 +#define H2C_CMD_BCN_FILTER_OFFLOAD_P1 0x57 +#define H2C_CMD_WL_PHY_INFO 0x58 +#define H2C_CMD_SCAN 0x59 +#define H2C_CMD_ADAPTIVITY 0x5A + +#define H2C_CMD_COEX_TDMA_TYPE 0x60 +#define H2C_CMD_QUERY_BT_INFO 0x61 +#define H2C_CMD_FORCE_BT_TX_POWER 0x62 +#define H2C_CMD_IGNORE_WLAN_ACTION 0x63 +#define H2C_CMD_WL_CH_INFO 0x66 +#define H2C_CMD_QUERY_BT_MP_INFO 0x67 +#define H2C_CMD_BT_WIFI_CONTROL 0x69 +#define H2C_CMD_WIFI_CALIBRATION 0x6d +#define H2C_CMD_QUERY_BT_HID_INFO 0x73 + +#define H2C_CMD_KEEP_ALIVE 0x03 +#define H2C_CMD_DISCONNECT_DECISION 0x04 +#define H2C_CMD_WOWLAN 0x80 +#define H2C_CMD_REMOTE_WAKE_CTRL 0x81 +#define H2C_CMD_AOAC_GLOBAL_INFO 0x82 +#define H2C_CMD_NLO_INFO 0x8C + +#define H2C_CMD_RECOVER_BT_DEV 0xD1 + +#define SET_H2C_CMD_ID_CLASS(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(7, 0)) + +#define MEDIA_STATUS_RPT_SET_OP_MODE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) +#define MEDIA_STATUS_RPT_SET_MACID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) + +#define SET_WL_PHY_INFO_TX_TP(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(17, 8)) +#define SET_WL_PHY_INFO_RX_TP(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(27, 18)) +#define SET_WL_PHY_INFO_TX_RATE_DESC(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(7, 0)) +#define SET_WL_PHY_INFO_RX_RATE_DESC(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(15, 8)) +#define SET_WL_PHY_INFO_RX_EVM(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(23, 16)) +#define SET_BCN_FILTER_OFFLOAD_P1_MACID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) +#define SET_BCN_FILTER_OFFLOAD_P1_ENABLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(16)) +#define SET_BCN_FILTER_OFFLOAD_P1_HYST(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(20, 17)) +#define SET_BCN_FILTER_OFFLOAD_P1_OFFLOAD_MODE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 21)) +#define SET_BCN_FILTER_OFFLOAD_P1_THRESHOLD(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) +#define SET_BCN_FILTER_OFFLOAD_P1_BCN_LOSS_CNT(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(3, 0)) +#define SET_BCN_FILTER_OFFLOAD_P1_BCN_INTERVAL(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(13, 4)) + +#define SET_SCAN_START(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) + +#define SET_ADAPTIVITY_MODE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(11, 8)) +#define SET_ADAPTIVITY_OPTION(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 12)) +#define SET_ADAPTIVITY_IGI(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) +#define SET_ADAPTIVITY_L2H(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) +#define SET_ADAPTIVITY_DENSITY(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(7, 0)) + +#define SET_PWR_MODE_SET_MODE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(14, 8)) +#define SET_PWR_MODE_SET_RLBM(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(19, 16)) +#define SET_PWR_MODE_SET_SMART_PS(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 20)) +#define SET_PWR_MODE_SET_AWAKE_INTERVAL(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) +#define SET_PWR_MODE_SET_PORT_ID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(7, 5)) +#define SET_PWR_MODE_SET_PWR_STATE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(15, 8)) +#define LPS_PG_INFO_LOC(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) +#define LPS_PG_DPK_LOC(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) +#define LPS_PG_SEC_CAM_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) +#define LPS_PG_PATTERN_CAM_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(10)) +#define SET_RSSI_INFO_MACID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) +#define SET_RSSI_INFO_RSSI(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) +#define SET_RSSI_INFO_STBC(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, BIT(1)) +#define SET_RA_INFO_MACID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) +#define SET_RA_INFO_RATE_ID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(20, 16)) +#define SET_RA_INFO_INIT_RA_LVL(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(22, 21)) +#define SET_RA_INFO_SGI_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(23)) +#define SET_RA_INFO_BW_MODE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(25, 24)) +#define SET_RA_INFO_LDPC(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(26)) +#define SET_RA_INFO_NO_UPDATE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(27)) +#define SET_RA_INFO_VHT_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(29, 28)) +#define SET_RA_INFO_DIS_PT(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(30)) +#define SET_RA_INFO_RA_MASK0(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(7, 0)) +#define SET_RA_INFO_RA_MASK1(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(15, 8)) +#define SET_RA_INFO_RA_MASK2(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(23, 16)) +#define SET_RA_INFO_RA_MASK3(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(31, 24)) +#define SET_QUERY_BT_INFO(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) +#define SET_WL_CH_INFO_LINK(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) +#define SET_WL_CH_INFO_CHNL(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) +#define SET_WL_CH_INFO_BW(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) +#define SET_BT_MP_INFO_SEQ(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 12)) +#define SET_BT_MP_INFO_OP_CODE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) +#define SET_BT_MP_INFO_PARA1(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) +#define SET_BT_MP_INFO_PARA2(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(7, 0)) +#define SET_BT_MP_INFO_PARA3(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(15, 8)) +#define SET_BT_TX_POWER_INDEX(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) +#define SET_IGNORE_WLAN_ACTION_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) +#define SET_COEX_TDMA_TYPE_PARA1(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) +#define SET_COEX_TDMA_TYPE_PARA2(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) +#define SET_COEX_TDMA_TYPE_PARA3(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) +#define SET_COEX_TDMA_TYPE_PARA4(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(7, 0)) +#define SET_COEX_TDMA_TYPE_PARA5(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(15, 8)) +#define SET_BT_WIFI_CONTROL_OP_CODE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) +#define SET_BT_WIFI_CONTROL_DATA1(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) +#define SET_BT_WIFI_CONTROL_DATA2(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) +#define SET_BT_WIFI_CONTROL_DATA3(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(7, 0)) +#define SET_BT_WIFI_CONTROL_DATA4(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(15, 8)) +#define SET_BT_WIFI_CONTROL_DATA5(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x01, value, GENMASK(23, 16)) + +#define SET_COEX_QUERY_HID_INFO_SUBID(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) +#define SET_COEX_QUERY_HID_INFO_DATA1(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) + +#define SET_KEEP_ALIVE_ENABLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) +#define SET_KEEP_ALIVE_ADOPT(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(9)) +#define SET_KEEP_ALIVE_PKT_TYPE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(10)) +#define SET_KEEP_ALIVE_CHECK_PERIOD(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) + +#define SET_DISCONNECT_DECISION_ENABLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) +#define SET_DISCONNECT_DECISION_ADOPT(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(9)) +#define SET_DISCONNECT_DECISION_CHECK_PERIOD(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) +#define SET_DISCONNECT_DECISION_TRY_PKT_NUM(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(31, 24)) + +#define SET_WOWLAN_FUNC_ENABLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) +#define SET_WOWLAN_PATTERN_MATCH_ENABLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(9)) +#define SET_WOWLAN_MAGIC_PKT_ENABLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(10)) +#define SET_WOWLAN_UNICAST_PKT_ENABLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(11)) +#define SET_WOWLAN_REKEY_WAKEUP_ENABLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(14)) +#define SET_WOWLAN_DEAUTH_WAKEUP_ENABLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(15)) + +#define SET_REMOTE_WAKECTRL_ENABLE(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) +#define SET_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(12)) + +#define SET_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(15, 8)) +#define SET_AOAC_GLOBAL_INFO_GROUP_ENC_ALG(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) + +#define SET_NLO_FUN_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) +#define SET_NLO_PS_32K(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(9)) +#define SET_NLO_IGNORE_SECURITY(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(10)) +#define SET_NLO_LOC_NLO_INFO(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, GENMASK(23, 16)) + +#define SET_RECOVER_BT_DEV_EN(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) + +#define GET_FW_DUMP_LEN(_header) \ + le32_get_bits(*((__le32 *)(_header) + 0x00), GENMASK(15, 0)) +#define GET_FW_DUMP_SEQ(_header) \ + le32_get_bits(*((__le32 *)(_header) + 0x00), GENMASK(22, 16)) +#define GET_FW_DUMP_MORE(_header) \ + le32_get_bits(*((__le32 *)(_header) + 0x00), BIT(23)) +#define GET_FW_DUMP_VERSION(_header) \ + le32_get_bits(*((__le32 *)(_header) + 0x00), GENMASK(31, 24)) +#define GET_FW_DUMP_TLV_TYPE(_header) \ + le32_get_bits(*((__le32 *)(_header) + 0x01), GENMASK(15, 0)) +#define GET_FW_DUMP_TLV_LEN(_header) \ + le32_get_bits(*((__le32 *)(_header) + 0x01), GENMASK(31, 16)) +#define GET_FW_DUMP_TLV_VAL(_header) \ + le32_get_bits(*((__le32 *)(_header) + 0x02), GENMASK(31, 0)) + +#define RFK_SET_INFORM_START(h2c_pkt, value) \ + le32p_replace_bits((__le32 *)(h2c_pkt) + 0x00, value, BIT(8)) +static inline struct rtw_c2h_cmd *get_c2h_from_skb(struct sk_buff *skb) +{ + u32 pkt_offset; + + pkt_offset = *((u32 *)skb->cb); + return (struct rtw_c2h_cmd *)(skb->data + pkt_offset); +} + +static inline bool rtw_fw_feature_check(struct rtw_fw_state *fw, + enum rtw_fw_feature feature) +{ + return !!(fw->feature & feature); +} + +static inline bool rtw_fw_feature_ext_check(struct rtw_fw_state *fw, + enum rtw_fw_feature_ext feature) +{ + return !!(fw->feature_ext & feature); +} + +void rtw_fw_c2h_cmd_rx_irqsafe(struct rtw_dev *rtwdev, u32 pkt_offset, + struct sk_buff *skb); +void rtw_fw_c2h_cmd_handle(struct rtw_dev *rtwdev, struct sk_buff *skb); +void rtw_fw_send_general_info(struct rtw_dev *rtwdev); +void rtw_fw_send_phydm_info(struct rtw_dev *rtwdev); +void rtw_fw_default_port(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif); + +void rtw_fw_do_iqk(struct rtw_dev *rtwdev, struct rtw_iqk_para *para); +void rtw_fw_inform_rfk_status(struct rtw_dev *rtwdev, bool start); +void rtw_fw_set_pwr_mode(struct rtw_dev *rtwdev); +void rtw_fw_set_pg_info(struct rtw_dev *rtwdev); +void rtw_fw_query_bt_info(struct rtw_dev *rtwdev); +void rtw_fw_wl_ch_info(struct rtw_dev *rtwdev, u8 link, u8 ch, u8 bw); +void rtw_fw_query_bt_mp_info(struct rtw_dev *rtwdev, + struct rtw_coex_info_req *req); +void rtw_fw_force_bt_tx_power(struct rtw_dev *rtwdev, u8 bt_pwr_dec_lvl); +void rtw_fw_bt_ignore_wlan_action(struct rtw_dev *rtwdev, bool enable); +void rtw_fw_coex_tdma_type(struct rtw_dev *rtwdev, + u8 para1, u8 para2, u8 para3, u8 para4, u8 para5); +void rtw_fw_coex_query_hid_info(struct rtw_dev *rtwdev, u8 sub_id, u8 data); + +void rtw_fw_bt_wifi_control(struct rtw_dev *rtwdev, u8 op_code, u8 *data); +void rtw_fw_send_rssi_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si); +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 18, 0) +void rtw_fw_send_ra_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si, + bool reset_ra_mask); +#else +void rtw_fw_send_ra_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si); +#endif +void rtw_fw_media_status_report(struct rtw_dev *rtwdev, u8 mac_id, bool conn); +void rtw_fw_update_wl_phy_info(struct rtw_dev *rtwdev); +void rtw_fw_beacon_filter_config(struct rtw_dev *rtwdev, bool connect, + struct ieee80211_vif *vif); +int rtw_fw_write_data_rsvd_page(struct rtw_dev *rtwdev, u16 pg_addr, + u8 *buf, u32 size); +void rtw_remove_rsvd_page(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif); +void rtw_add_rsvd_page_bcn(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif); +void rtw_add_rsvd_page_pno(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif); +void rtw_add_rsvd_page_sta(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif); +int rtw_fw_download_rsvd_page(struct rtw_dev *rtwdev); +void rtw_fw_update_beacon_work(struct work_struct *work); +void rtw_send_rsvd_page_h2c(struct rtw_dev *rtwdev); +int rtw_dump_drv_rsvd_page(struct rtw_dev *rtwdev, + u32 offset, u32 size, u32 *buf); +void rtw_fw_set_remote_wake_ctrl_cmd(struct rtw_dev *rtwdev, bool enable); +void rtw_fw_set_wowlan_ctrl_cmd(struct rtw_dev *rtwdev, bool enable); +void rtw_fw_set_keep_alive_cmd(struct rtw_dev *rtwdev, bool enable); +void rtw_fw_set_disconnect_decision_cmd(struct rtw_dev *rtwdev, bool enable); +void rtw_fw_set_aoac_global_info_cmd(struct rtw_dev *rtwdev, + u8 pairwise_key_enc, + u8 group_key_enc); + +void rtw_fw_set_nlo_info(struct rtw_dev *rtwdev, bool enable); +void rtw_fw_set_recover_bt_device(struct rtw_dev *rtwdev); +void rtw_fw_update_pkt_probe_req(struct rtw_dev *rtwdev, + struct cfg80211_ssid *ssid); +void rtw_fw_channel_switch(struct rtw_dev *rtwdev, bool enable); +void rtw_fw_h2c_cmd_dbg(struct rtw_dev *rtwdev, u8 *h2c); +void rtw_fw_c2h_cmd_isr(struct rtw_dev *rtwdev); +int rtw_fw_dump_fifo(struct rtw_dev *rtwdev, u8 fifo_sel, u32 addr, u32 size, + u32 *buffer); +void rtw_fw_scan_notify(struct rtw_dev *rtwdev, bool start); +void rtw_fw_adaptivity(struct rtw_dev *rtwdev); +void rtw_store_op_chan(struct rtw_dev *rtwdev, bool backup); +void rtw_clear_op_chan(struct rtw_dev *rtwdev); +void rtw_hw_scan_start(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct ieee80211_scan_request *req); +void rtw_hw_scan_complete(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + bool aborted); +int rtw_hw_scan_offload(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + bool enable); +void rtw_hw_scan_status_report(struct rtw_dev *rtwdev, struct sk_buff *skb); +void rtw_hw_scan_chan_switch(struct rtw_dev *rtwdev, struct sk_buff *skb); +void rtw_hw_scan_abort(struct rtw_dev *rtwdev); +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/hci.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/hci.h new file mode 100644 index 0000000000000000000000000000000000000000..830d7532f2a35a8c973f61087fe3860034770cc0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/hci.h @@ -0,0 +1,274 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_HCI_H__ +#define __RTW_HCI_H__ + +/* ops for PCI, USB and SDIO */ +struct rtw_hci_ops { + int (*tx_write)(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb); + void (*tx_kick_off)(struct rtw_dev *rtwdev); + void (*flush_queues)(struct rtw_dev *rtwdev, u32 queues, bool drop); + int (*setup)(struct rtw_dev *rtwdev); + int (*start)(struct rtw_dev *rtwdev); + void (*stop)(struct rtw_dev *rtwdev); + void (*deep_ps)(struct rtw_dev *rtwdev, bool enter); + void (*link_ps)(struct rtw_dev *rtwdev, bool enter); + void (*interface_cfg)(struct rtw_dev *rtwdev); + + int (*write_data_rsvd_page)(struct rtw_dev *rtwdev, u8 *buf, u32 size); + int (*write_data_h2c)(struct rtw_dev *rtwdev, u8 *buf, u32 size); + + u8 (*read8)(struct rtw_dev *rtwdev, u32 addr); + u16 (*read16)(struct rtw_dev *rtwdev, u32 addr); + u32 (*read32)(struct rtw_dev *rtwdev, u32 addr); + void (*write8)(struct rtw_dev *rtwdev, u32 addr, u8 val); + void (*write16)(struct rtw_dev *rtwdev, u32 addr, u16 val); + void (*write32)(struct rtw_dev *rtwdev, u32 addr, u32 val); +}; + +static inline int rtw_hci_tx_write(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb) +{ + return rtwdev->hci.ops->tx_write(rtwdev, pkt_info, skb); +} + +static inline void rtw_hci_tx_kick_off(struct rtw_dev *rtwdev) +{ + return rtwdev->hci.ops->tx_kick_off(rtwdev); +} + +static inline int rtw_hci_setup(struct rtw_dev *rtwdev) +{ + return rtwdev->hci.ops->setup(rtwdev); +} + +static inline int rtw_hci_start(struct rtw_dev *rtwdev) +{ + return rtwdev->hci.ops->start(rtwdev); +} + +static inline void rtw_hci_stop(struct rtw_dev *rtwdev) +{ + rtwdev->hci.ops->stop(rtwdev); +} + +static inline void rtw_hci_deep_ps(struct rtw_dev *rtwdev, bool enter) +{ + rtwdev->hci.ops->deep_ps(rtwdev, enter); +} + +static inline void rtw_hci_link_ps(struct rtw_dev *rtwdev, bool enter) +{ + rtwdev->hci.ops->link_ps(rtwdev, enter); +} + +static inline void rtw_hci_interface_cfg(struct rtw_dev *rtwdev) +{ + rtwdev->hci.ops->interface_cfg(rtwdev); +} + +static inline int +rtw_hci_write_data_rsvd_page(struct rtw_dev *rtwdev, u8 *buf, u32 size) +{ + return rtwdev->hci.ops->write_data_rsvd_page(rtwdev, buf, size); +} + +static inline int +rtw_hci_write_data_h2c(struct rtw_dev *rtwdev, u8 *buf, u32 size) +{ + return rtwdev->hci.ops->write_data_h2c(rtwdev, buf, size); +} + +static inline u8 rtw_read8(struct rtw_dev *rtwdev, u32 addr) +{ + return rtwdev->hci.ops->read8(rtwdev, addr); +} + +static inline u16 rtw_read16(struct rtw_dev *rtwdev, u32 addr) +{ + return rtwdev->hci.ops->read16(rtwdev, addr); +} + +static inline u32 rtw_read32(struct rtw_dev *rtwdev, u32 addr) +{ + return rtwdev->hci.ops->read32(rtwdev, addr); +} + +static inline void rtw_write8(struct rtw_dev *rtwdev, u32 addr, u8 val) +{ + rtwdev->hci.ops->write8(rtwdev, addr, val); +} + +static inline void rtw_write16(struct rtw_dev *rtwdev, u32 addr, u16 val) +{ + rtwdev->hci.ops->write16(rtwdev, addr, val); +} + +static inline void rtw_write32(struct rtw_dev *rtwdev, u32 addr, u32 val) +{ + rtwdev->hci.ops->write32(rtwdev, addr, val); +} + +static inline void rtw_write8_set(struct rtw_dev *rtwdev, u32 addr, u8 bit) +{ + u8 val; + + val = rtw_read8(rtwdev, addr); + rtw_write8(rtwdev, addr, val | bit); +} + +static inline void rtw_write16_set(struct rtw_dev *rtwdev, u32 addr, u16 bit) +{ + u16 val; + + val = rtw_read16(rtwdev, addr); + rtw_write16(rtwdev, addr, val | bit); +} + +static inline void rtw_write32_set(struct rtw_dev *rtwdev, u32 addr, u32 bit) +{ + u32 val; + + val = rtw_read32(rtwdev, addr); + rtw_write32(rtwdev, addr, val | bit); +} + +static inline void rtw_write8_clr(struct rtw_dev *rtwdev, u32 addr, u8 bit) +{ + u8 val; + + val = rtw_read8(rtwdev, addr); + rtw_write8(rtwdev, addr, val & ~bit); +} + +static inline void rtw_write16_clr(struct rtw_dev *rtwdev, u32 addr, u16 bit) +{ + u16 val; + + val = rtw_read16(rtwdev, addr); + rtw_write16(rtwdev, addr, val & ~bit); +} + +static inline void rtw_write32_clr(struct rtw_dev *rtwdev, u32 addr, u32 bit) +{ + u32 val; + + val = rtw_read32(rtwdev, addr); + rtw_write32(rtwdev, addr, val & ~bit); +} + +static inline u32 +rtw_read_rf(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask) +{ + u32 val; + + lockdep_assert_held(&rtwdev->mutex); + + val = rtwdev->chip->ops->read_rf(rtwdev, rf_path, addr, mask); + + return val; +} + +static inline void +rtw_write_rf(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask, u32 data) +{ + lockdep_assert_held(&rtwdev->mutex); + + rtwdev->chip->ops->write_rf(rtwdev, rf_path, addr, mask, data); +} + +static inline u32 +rtw_read32_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask) +{ + u32 shift = __ffs(mask); + u32 orig; + u32 ret; + + orig = rtw_read32(rtwdev, addr); + ret = (orig & mask) >> shift; + + return ret; +} + +static inline u16 +rtw_read16_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask) +{ + u32 shift = __ffs(mask); + u32 orig; + u32 ret; + + orig = rtw_read16(rtwdev, addr); + ret = (orig & mask) >> shift; + + return ret; +} + +static inline u8 +rtw_read8_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask) +{ + u32 shift = __ffs(mask); + u32 orig; + u32 ret; + + orig = rtw_read8(rtwdev, addr); + ret = (orig & mask) >> shift; + + return ret; +} + +static inline void +rtw_write32_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) +{ + u32 shift = __ffs(mask); + u32 orig; + u32 set; + + WARN(addr & 0x3, "should be 4-byte aligned, addr = 0x%08x\n", addr); + + orig = rtw_read32(rtwdev, addr); + set = (orig & ~mask) | ((data << shift) & mask); + rtw_write32(rtwdev, addr, set); +} + +static inline void +rtw_write8_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u8 data) +{ + u32 shift; + u8 orig, set; + + mask &= 0xff; + shift = __ffs(mask); + + orig = rtw_read8(rtwdev, addr); + set = (orig & ~mask) | ((data << shift) & mask); + rtw_write8(rtwdev, addr, set); +} + +static inline enum rtw_hci_type rtw_hci_type(struct rtw_dev *rtwdev) +{ + return rtwdev->hci.type; +} + +static inline void rtw_hci_flush_queues(struct rtw_dev *rtwdev, u32 queues, + bool drop) +{ + if (rtwdev->hci.ops->flush_queues) + rtwdev->hci.ops->flush_queues(rtwdev, queues, drop); +} + +static inline void rtw_hci_flush_all_queues(struct rtw_dev *rtwdev, bool drop) +{ + if (rtwdev->hci.ops->flush_queues) + rtwdev->hci.ops->flush_queues(rtwdev, + BIT(rtwdev->hw->queues) - 1, + drop); +} + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/mac.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/mac.c new file mode 100644 index 0000000000000000000000000000000000000000..298663b03580853ce4d3fc171eadc332944d7cbb --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/mac.c @@ -0,0 +1,1379 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "mac.h" +#include "reg.h" +#include "fw.h" +#include "debug.h" +#include "sdio.h" + +void rtw_set_channel_mac(struct rtw_dev *rtwdev, u8 channel, u8 bw, + u8 primary_ch_idx) +{ + u8 txsc40 = 0, txsc20 = 0; + u32 value32; + u8 value8; + + txsc20 = primary_ch_idx; + if (bw == RTW_CHANNEL_WIDTH_80) { + if (txsc20 == RTW_SC_20_UPPER || txsc20 == RTW_SC_20_UPMOST) + txsc40 = RTW_SC_40_UPPER; + else + txsc40 = RTW_SC_40_LOWER; + } + rtw_write8(rtwdev, REG_DATA_SC, + BIT_TXSC_20M(txsc20) | BIT_TXSC_40M(txsc40)); + + value32 = rtw_read32(rtwdev, REG_WMAC_TRXPTCL_CTL); + value32 &= ~BIT_RFMOD; + switch (bw) { + case RTW_CHANNEL_WIDTH_80: + value32 |= BIT_RFMOD_80M; + break; + case RTW_CHANNEL_WIDTH_40: + value32 |= BIT_RFMOD_40M; + break; + case RTW_CHANNEL_WIDTH_20: + default: + break; + } + rtw_write32(rtwdev, REG_WMAC_TRXPTCL_CTL, value32); + + if (rtw_chip_wcpu_11n(rtwdev)) + return; + + value32 = rtw_read32(rtwdev, REG_AFE_CTRL1) & ~(BIT_MAC_CLK_SEL); + value32 |= (MAC_CLK_HW_DEF_80M << BIT_SHIFT_MAC_CLK_SEL); + rtw_write32(rtwdev, REG_AFE_CTRL1, value32); + + rtw_write8(rtwdev, REG_USTIME_TSF, MAC_CLK_SPEED); + rtw_write8(rtwdev, REG_USTIME_EDCA, MAC_CLK_SPEED); + + value8 = rtw_read8(rtwdev, REG_CCK_CHECK); + value8 = value8 & ~BIT_CHECK_CCK_EN; + if (IS_CH_5G_BAND(channel)) + value8 |= BIT_CHECK_CCK_EN; + rtw_write8(rtwdev, REG_CCK_CHECK, value8); +} +EXPORT_SYMBOL(rtw_set_channel_mac); + +static int rtw_mac_pre_system_cfg(struct rtw_dev *rtwdev) +{ + unsigned int retry; + u32 value32; + u8 value8; + + rtw_write8(rtwdev, REG_RSV_CTRL, 0); + + if (rtw_chip_wcpu_11n(rtwdev)) { + if (rtw_read32(rtwdev, REG_SYS_CFG1) & BIT_LDO) + rtw_write8(rtwdev, REG_LDO_SWR_CTRL, LDO_SEL); + else + rtw_write8(rtwdev, REG_LDO_SWR_CTRL, SPS_SEL); + return 0; + } + + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_PCIE: + rtw_write32_set(rtwdev, REG_HCI_OPT_CTRL, BIT_USB_SUS_DIS); + break; + case RTW_HCI_TYPE_SDIO: + rtw_write8_clr(rtwdev, REG_SDIO_HSUS_CTRL, BIT_HCI_SUS_REQ); + + for (retry = 0; retry < RTW_PWR_POLLING_CNT; retry++) { + if (rtw_read8(rtwdev, REG_SDIO_HSUS_CTRL) & BIT_HCI_RESUME_RDY) + break; + + usleep_range(10, 50); + } + + if (retry == RTW_PWR_POLLING_CNT) { + rtw_err(rtwdev, "failed to poll REG_SDIO_HSUS_CTRL[1]"); + return -ETIMEDOUT; + } + + if (rtw_sdio_is_sdio30_supported(rtwdev)) + rtw_write8_set(rtwdev, REG_HCI_OPT_CTRL + 2, + BIT_SDIO_PAD_E5 >> 16); + else + rtw_write8_clr(rtwdev, REG_HCI_OPT_CTRL + 2, + BIT_SDIO_PAD_E5 >> 16); + break; + case RTW_HCI_TYPE_USB: + break; + default: + return -EINVAL; + } + + /* config PIN Mux */ + value32 = rtw_read32(rtwdev, REG_PAD_CTRL1); + value32 |= BIT_PAPE_WLBT_SEL | BIT_LNAON_WLBT_SEL; + rtw_write32(rtwdev, REG_PAD_CTRL1, value32); + + value32 = rtw_read32(rtwdev, REG_LED_CFG); + value32 &= ~(BIT_PAPE_SEL_EN | BIT_LNAON_SEL_EN); + rtw_write32(rtwdev, REG_LED_CFG, value32); + + value32 = rtw_read32(rtwdev, REG_GPIO_MUXCFG); + value32 |= BIT_WLRFE_4_5_EN; + rtw_write32(rtwdev, REG_GPIO_MUXCFG, value32); + + /* disable BB/RF */ + value8 = rtw_read8(rtwdev, REG_SYS_FUNC_EN); + value8 &= ~(BIT_FEN_BB_RSTB | BIT_FEN_BB_GLB_RST); + rtw_write8(rtwdev, REG_SYS_FUNC_EN, value8); + + value8 = rtw_read8(rtwdev, REG_RF_CTRL); + value8 &= ~(BIT_RF_SDM_RSTB | BIT_RF_RSTB | BIT_RF_EN); + rtw_write8(rtwdev, REG_RF_CTRL, value8); + + value32 = rtw_read32(rtwdev, REG_WLRF1); + value32 &= ~BIT_WLRF1_BBRF_EN; + rtw_write32(rtwdev, REG_WLRF1, value32); + + return 0; +} + +static bool do_pwr_poll_cmd(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 target) +{ + u32 val; + + target &= mask; + + return read_poll_timeout_atomic(rtw_read8, val, (val & mask) == target, + 50, 50 * RTW_PWR_POLLING_CNT, false, + rtwdev, addr) == 0; +} + +static int rtw_pwr_cmd_polling(struct rtw_dev *rtwdev, + const struct rtw_pwr_seq_cmd *cmd) +{ + u8 value; + u32 offset; + + if (cmd->base == RTW_PWR_ADDR_SDIO) + offset = cmd->offset | SDIO_LOCAL_OFFSET; + else + offset = cmd->offset; + + if (do_pwr_poll_cmd(rtwdev, offset, cmd->mask, cmd->value)) + return 0; + + if (rtw_hci_type(rtwdev) != RTW_HCI_TYPE_PCIE) + goto err; + + /* if PCIE, toggle BIT_PFM_WOWL and try again */ + value = rtw_read8(rtwdev, REG_SYS_PW_CTRL); + if (rtwdev->chip->id == RTW_CHIP_TYPE_8723D) + rtw_write8(rtwdev, REG_SYS_PW_CTRL, value & ~BIT_PFM_WOWL); + rtw_write8(rtwdev, REG_SYS_PW_CTRL, value | BIT_PFM_WOWL); + rtw_write8(rtwdev, REG_SYS_PW_CTRL, value & ~BIT_PFM_WOWL); + if (rtwdev->chip->id == RTW_CHIP_TYPE_8723D) + rtw_write8(rtwdev, REG_SYS_PW_CTRL, value | BIT_PFM_WOWL); + + if (do_pwr_poll_cmd(rtwdev, offset, cmd->mask, cmd->value)) + return 0; + +err: + rtw_err(rtwdev, "failed to poll offset=0x%x mask=0x%x value=0x%x\n", + offset, cmd->mask, cmd->value); + return -EBUSY; +} + +static int rtw_sub_pwr_seq_parser(struct rtw_dev *rtwdev, u8 intf_mask, + u8 cut_mask, + const struct rtw_pwr_seq_cmd *cmd) +{ + const struct rtw_pwr_seq_cmd *cur_cmd; + u32 offset; + u8 value; + + for (cur_cmd = cmd; cur_cmd->cmd != RTW_PWR_CMD_END; cur_cmd++) { + if (!(cur_cmd->intf_mask & intf_mask) || + !(cur_cmd->cut_mask & cut_mask)) + continue; + + switch (cur_cmd->cmd) { + case RTW_PWR_CMD_WRITE: + offset = cur_cmd->offset; + + if (cur_cmd->base == RTW_PWR_ADDR_SDIO) + offset |= SDIO_LOCAL_OFFSET; + + value = rtw_read8(rtwdev, offset); + value &= ~cur_cmd->mask; + value |= (cur_cmd->value & cur_cmd->mask); + rtw_write8(rtwdev, offset, value); + break; + case RTW_PWR_CMD_POLLING: + if (rtw_pwr_cmd_polling(rtwdev, cur_cmd)) + return -EBUSY; + break; + case RTW_PWR_CMD_DELAY: + if (cur_cmd->value == RTW_PWR_DELAY_US) + udelay(cur_cmd->offset); + else + mdelay(cur_cmd->offset); + break; + case RTW_PWR_CMD_READ: + break; + default: + return -EINVAL; + } + } + + return 0; +} + +static int rtw_pwr_seq_parser(struct rtw_dev *rtwdev, + const struct rtw_pwr_seq_cmd **cmd_seq) +{ + u8 cut_mask; + u8 intf_mask; + u8 cut; + u32 idx = 0; + const struct rtw_pwr_seq_cmd *cmd; + int ret; + + cut = rtwdev->hal.cut_version; + cut_mask = cut_version_to_mask(cut); + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_PCIE: + intf_mask = RTW_PWR_INTF_PCI_MSK; + break; + case RTW_HCI_TYPE_USB: + intf_mask = RTW_PWR_INTF_USB_MSK; + break; + case RTW_HCI_TYPE_SDIO: + intf_mask = RTW_PWR_INTF_SDIO_MSK; + break; + default: + return -EINVAL; + } + + do { + cmd = cmd_seq[idx]; + if (!cmd) + break; + + ret = rtw_sub_pwr_seq_parser(rtwdev, intf_mask, cut_mask, cmd); + if (ret) + return ret; + + idx++; + } while (1); + + return 0; +} + +static int rtw_mac_power_switch(struct rtw_dev *rtwdev, bool pwr_on) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + const struct rtw_pwr_seq_cmd **pwr_seq; + u32 imr = 0; + u8 rpwm; + bool cur_pwr; + int ret; + + if (rtw_chip_wcpu_11ac(rtwdev)) { + rpwm = rtw_read8(rtwdev, rtwdev->hci.rpwm_addr); + + /* Check FW still exist or not */ + if (rtw_read16(rtwdev, REG_MCUFW_CTRL) == 0xC078) { + rpwm = (rpwm ^ BIT_RPWM_TOGGLE) & BIT_RPWM_TOGGLE; + rtw_write8(rtwdev, rtwdev->hci.rpwm_addr, rpwm); + } + } + + if (rtw_read8(rtwdev, REG_CR) == 0xea) + cur_pwr = false; + else if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_USB && + (rtw_read8(rtwdev, REG_SYS_STATUS1 + 1) & BIT(0))) + cur_pwr = false; + else + cur_pwr = true; + + if (pwr_on == cur_pwr) + return -EALREADY; + + if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) { + imr = rtw_read32(rtwdev, REG_SDIO_HIMR); + rtw_write32(rtwdev, REG_SDIO_HIMR, 0); + } + + if (!pwr_on) + clear_bit(RTW_FLAG_POWERON, rtwdev->flags); + + pwr_seq = pwr_on ? chip->pwr_on_seq : chip->pwr_off_seq; + ret = rtw_pwr_seq_parser(rtwdev, pwr_seq); + + if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) + rtw_write32(rtwdev, REG_SDIO_HIMR, imr); + + if (!ret && pwr_on) + set_bit(RTW_FLAG_POWERON, rtwdev->flags); + + return ret; +} + +static int __rtw_mac_init_system_cfg(struct rtw_dev *rtwdev) +{ + u8 sys_func_en = rtwdev->chip->sys_func_en; + u8 value8; + u32 value, tmp; + + value = rtw_read32(rtwdev, REG_CPU_DMEM_CON); + value |= BIT_WL_PLATFORM_RST | BIT_DDMA_EN; + rtw_write32(rtwdev, REG_CPU_DMEM_CON, value); + + rtw_write8_set(rtwdev, REG_SYS_FUNC_EN + 1, sys_func_en); + value8 = (rtw_read8(rtwdev, REG_CR_EXT + 3) & 0xF0) | 0x0C; + rtw_write8(rtwdev, REG_CR_EXT + 3, value8); + + /* disable boot-from-flash for driver's DL FW */ + tmp = rtw_read32(rtwdev, REG_MCUFW_CTRL); + if (tmp & BIT_BOOT_FSPI_EN) { + rtw_write32(rtwdev, REG_MCUFW_CTRL, tmp & (~BIT_BOOT_FSPI_EN)); + value = rtw_read32(rtwdev, REG_GPIO_MUXCFG) & (~BIT_FSPI_EN); + rtw_write32(rtwdev, REG_GPIO_MUXCFG, value); + } + + return 0; +} + +static int __rtw_mac_init_system_cfg_legacy(struct rtw_dev *rtwdev) +{ + rtw_write8(rtwdev, REG_CR, 0xff); + mdelay(2); + rtw_write8(rtwdev, REG_HWSEQ_CTRL, 0x7f); + mdelay(2); + + rtw_write8_set(rtwdev, REG_SYS_CLKR, BIT_WAKEPAD_EN); + rtw_write16_clr(rtwdev, REG_GPIO_MUXCFG, BIT_EN_SIC); + + rtw_write16(rtwdev, REG_CR, 0x2ff); + + return 0; +} + +static int rtw_mac_init_system_cfg(struct rtw_dev *rtwdev) +{ + if (rtw_chip_wcpu_11n(rtwdev)) + return __rtw_mac_init_system_cfg_legacy(rtwdev); + + return __rtw_mac_init_system_cfg(rtwdev); +} + +int rtw_mac_power_on(struct rtw_dev *rtwdev) +{ + int ret = 0; + + ret = rtw_mac_pre_system_cfg(rtwdev); + if (ret) + goto err; + + ret = rtw_mac_power_switch(rtwdev, true); + if (ret == -EALREADY) { + rtw_mac_power_switch(rtwdev, false); + + ret = rtw_mac_pre_system_cfg(rtwdev); + if (ret) + goto err; + + ret = rtw_mac_power_switch(rtwdev, true); + if (ret) + goto err; + } else if (ret) { + goto err; + } + + ret = rtw_mac_init_system_cfg(rtwdev); + if (ret) + goto err; + + return 0; + +err: + rtw_err(rtwdev, "mac power on failed"); + return ret; +} + +void rtw_mac_power_off(struct rtw_dev *rtwdev) +{ + rtw_mac_power_switch(rtwdev, false); +} + +static bool check_firmware_size(const u8 *data, u32 size) +{ + const struct rtw_fw_hdr *fw_hdr = (const struct rtw_fw_hdr *)data; + u32 dmem_size; + u32 imem_size; + u32 emem_size; + u32 real_size; + + dmem_size = le32_to_cpu(fw_hdr->dmem_size); + imem_size = le32_to_cpu(fw_hdr->imem_size); + emem_size = (fw_hdr->mem_usage & BIT(4)) ? + le32_to_cpu(fw_hdr->emem_size) : 0; + + dmem_size += FW_HDR_CHKSUM_SIZE; + imem_size += FW_HDR_CHKSUM_SIZE; + emem_size += emem_size ? FW_HDR_CHKSUM_SIZE : 0; + real_size = FW_HDR_SIZE + dmem_size + imem_size + emem_size; + if (real_size != size) + return false; + + return true; +} + +static void wlan_cpu_enable(struct rtw_dev *rtwdev, bool enable) +{ + if (enable) { + /* cpu io interface enable */ + rtw_write8_set(rtwdev, REG_RSV_CTRL + 1, BIT_WLMCU_IOIF); + + /* cpu enable */ + rtw_write8_set(rtwdev, REG_SYS_FUNC_EN + 1, BIT_FEN_CPUEN); + } else { + /* cpu io interface disable */ + rtw_write8_clr(rtwdev, REG_SYS_FUNC_EN + 1, BIT_FEN_CPUEN); + + /* cpu disable */ + rtw_write8_clr(rtwdev, REG_RSV_CTRL + 1, BIT_WLMCU_IOIF); + } +} + +#define DLFW_RESTORE_REG_NUM 6 + +static void download_firmware_reg_backup(struct rtw_dev *rtwdev, + struct rtw_backup_info *bckp) +{ + u8 tmp; + u8 bckp_idx = 0; + + /* set HIQ to hi priority */ + bckp[bckp_idx].len = 1; + bckp[bckp_idx].reg = REG_TXDMA_PQ_MAP + 1; + bckp[bckp_idx].val = rtw_read8(rtwdev, REG_TXDMA_PQ_MAP + 1); + bckp_idx++; + tmp = RTW_DMA_MAPPING_HIGH << 6; + rtw_write8(rtwdev, REG_TXDMA_PQ_MAP + 1, tmp); + + /* DLFW only use HIQ, map HIQ to hi priority */ + bckp[bckp_idx].len = 1; + bckp[bckp_idx].reg = REG_CR; + bckp[bckp_idx].val = rtw_read8(rtwdev, REG_CR); + bckp_idx++; + bckp[bckp_idx].len = 4; + bckp[bckp_idx].reg = REG_H2CQ_CSR; + bckp[bckp_idx].val = BIT_H2CQ_FULL; + bckp_idx++; + tmp = BIT_HCI_TXDMA_EN | BIT_TXDMA_EN; + rtw_write8(rtwdev, REG_CR, tmp); + rtw_write32(rtwdev, REG_H2CQ_CSR, BIT_H2CQ_FULL); + + /* Config hi priority queue and public priority queue page number */ + bckp[bckp_idx].len = 2; + bckp[bckp_idx].reg = REG_FIFOPAGE_INFO_1; + bckp[bckp_idx].val = rtw_read16(rtwdev, REG_FIFOPAGE_INFO_1); + bckp_idx++; + bckp[bckp_idx].len = 4; + bckp[bckp_idx].reg = REG_RQPN_CTRL_2; + bckp[bckp_idx].val = rtw_read32(rtwdev, REG_RQPN_CTRL_2) | BIT_LD_RQPN; + bckp_idx++; + rtw_write16(rtwdev, REG_FIFOPAGE_INFO_1, 0x200); + rtw_write32(rtwdev, REG_RQPN_CTRL_2, bckp[bckp_idx - 1].val); + + if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) + rtw_read32(rtwdev, REG_SDIO_FREE_TXPG); + + /* Disable beacon related functions */ + tmp = rtw_read8(rtwdev, REG_BCN_CTRL); + bckp[bckp_idx].len = 1; + bckp[bckp_idx].reg = REG_BCN_CTRL; + bckp[bckp_idx].val = tmp; + bckp_idx++; + tmp = (u8)((tmp & (~BIT_EN_BCN_FUNCTION)) | BIT_DIS_TSF_UDT); + rtw_write8(rtwdev, REG_BCN_CTRL, tmp); + + WARN(bckp_idx != DLFW_RESTORE_REG_NUM, "wrong backup number\n"); +} + +static void download_firmware_reset_platform(struct rtw_dev *rtwdev) +{ + rtw_write8_clr(rtwdev, REG_CPU_DMEM_CON + 2, BIT_WL_PLATFORM_RST >> 16); + rtw_write8_clr(rtwdev, REG_SYS_CLK_CTRL + 1, BIT_CPU_CLK_EN >> 8); + rtw_write8_set(rtwdev, REG_CPU_DMEM_CON + 2, BIT_WL_PLATFORM_RST >> 16); + rtw_write8_set(rtwdev, REG_SYS_CLK_CTRL + 1, BIT_CPU_CLK_EN >> 8); +} + +static void download_firmware_reg_restore(struct rtw_dev *rtwdev, + struct rtw_backup_info *bckp, + u8 bckp_num) +{ + rtw_restore_reg(rtwdev, bckp, bckp_num); +} + +#define TX_DESC_SIZE 48 + +static int send_firmware_pkt_rsvd_page(struct rtw_dev *rtwdev, u16 pg_addr, + const u8 *data, u32 size) +{ + u8 *buf; + int ret; + + buf = kmemdup(data, size, GFP_KERNEL); + if (!buf) + return -ENOMEM; + + ret = rtw_fw_write_data_rsvd_page(rtwdev, pg_addr, buf, size); + kfree(buf); + return ret; +} + +static int +send_firmware_pkt(struct rtw_dev *rtwdev, u16 pg_addr, const u8 *data, u32 size) +{ + int ret; + + if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_USB && + !((size + TX_DESC_SIZE) & (512 - 1))) + size += 1; + + ret = send_firmware_pkt_rsvd_page(rtwdev, pg_addr, data, size); + if (ret) + rtw_err(rtwdev, "failed to download rsvd page\n"); + + return ret; +} + +static int +iddma_enable(struct rtw_dev *rtwdev, u32 src, u32 dst, u32 ctrl) +{ + rtw_write32(rtwdev, REG_DDMA_CH0SA, src); + rtw_write32(rtwdev, REG_DDMA_CH0DA, dst); + rtw_write32(rtwdev, REG_DDMA_CH0CTRL, ctrl); + + if (!check_hw_ready(rtwdev, REG_DDMA_CH0CTRL, BIT_DDMACH0_OWN, 0)) + return -EBUSY; + + return 0; +} + +static int iddma_download_firmware(struct rtw_dev *rtwdev, u32 src, u32 dst, + u32 len, u8 first) +{ + u32 ch0_ctrl = BIT_DDMACH0_CHKSUM_EN | BIT_DDMACH0_OWN; + + if (!check_hw_ready(rtwdev, REG_DDMA_CH0CTRL, BIT_DDMACH0_OWN, 0)) + return -EBUSY; + + ch0_ctrl |= len & BIT_MASK_DDMACH0_DLEN; + if (!first) + ch0_ctrl |= BIT_DDMACH0_CHKSUM_CONT; + + if (iddma_enable(rtwdev, src, dst, ch0_ctrl)) + return -EBUSY; + + return 0; +} + +int rtw_ddma_to_fw_fifo(struct rtw_dev *rtwdev, u32 ocp_src, u32 size) +{ + u32 ch0_ctrl = BIT_DDMACH0_OWN | BIT_DDMACH0_DDMA_MODE; + + if (!check_hw_ready(rtwdev, REG_DDMA_CH0CTRL, BIT_DDMACH0_OWN, 0)) { + rtw_dbg(rtwdev, RTW_DBG_FW, "busy to start ddma\n"); + return -EBUSY; + } + + ch0_ctrl |= size & BIT_MASK_DDMACH0_DLEN; + + if (iddma_enable(rtwdev, ocp_src, OCPBASE_RXBUF_FW_88XX, ch0_ctrl)) { + rtw_dbg(rtwdev, RTW_DBG_FW, "busy to complete ddma\n"); + return -EBUSY; + } + + return 0; +} + +static bool +check_fw_checksum(struct rtw_dev *rtwdev, u32 addr) +{ + u8 fw_ctrl; + + fw_ctrl = rtw_read8(rtwdev, REG_MCUFW_CTRL); + + if (rtw_read32(rtwdev, REG_DDMA_CH0CTRL) & BIT_DDMACH0_CHKSUM_STS) { + if (addr < OCPBASE_DMEM_88XX) { + fw_ctrl |= BIT_IMEM_DW_OK; + fw_ctrl &= ~BIT_IMEM_CHKSUM_OK; + rtw_write8(rtwdev, REG_MCUFW_CTRL, fw_ctrl); + } else { + fw_ctrl |= BIT_DMEM_DW_OK; + fw_ctrl &= ~BIT_DMEM_CHKSUM_OK; + rtw_write8(rtwdev, REG_MCUFW_CTRL, fw_ctrl); + } + + rtw_err(rtwdev, "invalid fw checksum\n"); + + return false; + } + + if (addr < OCPBASE_DMEM_88XX) { + fw_ctrl |= (BIT_IMEM_DW_OK | BIT_IMEM_CHKSUM_OK); + rtw_write8(rtwdev, REG_MCUFW_CTRL, fw_ctrl); + } else { + fw_ctrl |= (BIT_DMEM_DW_OK | BIT_DMEM_CHKSUM_OK); + rtw_write8(rtwdev, REG_MCUFW_CTRL, fw_ctrl); + } + + return true; +} + +static int +download_firmware_to_mem(struct rtw_dev *rtwdev, const u8 *data, + u32 src, u32 dst, u32 size) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + u32 desc_size = chip->tx_pkt_desc_sz; + u8 first_part; + u32 mem_offset; + u32 residue_size; + u32 pkt_size; + u32 max_size = 0x1000; + u32 val; + int ret; + + mem_offset = 0; + first_part = 1; + residue_size = size; + + val = rtw_read32(rtwdev, REG_DDMA_CH0CTRL); + val |= BIT_DDMACH0_RESET_CHKSUM_STS; + rtw_write32(rtwdev, REG_DDMA_CH0CTRL, val); + + while (residue_size) { + if (residue_size >= max_size) + pkt_size = max_size; + else + pkt_size = residue_size; + + ret = send_firmware_pkt(rtwdev, (u16)(src >> 7), + data + mem_offset, pkt_size); + if (ret) + return ret; + + ret = iddma_download_firmware(rtwdev, OCPBASE_TXBUF_88XX + + src + desc_size, + dst + mem_offset, pkt_size, + first_part); + if (ret) + return ret; + + first_part = 0; + mem_offset += pkt_size; + residue_size -= pkt_size; + } + + if (!check_fw_checksum(rtwdev, dst)) + return -EINVAL; + + return 0; +} + +static int +start_download_firmware(struct rtw_dev *rtwdev, const u8 *data, u32 size) +{ + const struct rtw_fw_hdr *fw_hdr = (const struct rtw_fw_hdr *)data; + const u8 *cur_fw; + u16 val; + u32 imem_size; + u32 dmem_size; + u32 emem_size; + u32 addr; + int ret; + + dmem_size = le32_to_cpu(fw_hdr->dmem_size); + imem_size = le32_to_cpu(fw_hdr->imem_size); + emem_size = (fw_hdr->mem_usage & BIT(4)) ? + le32_to_cpu(fw_hdr->emem_size) : 0; + dmem_size += FW_HDR_CHKSUM_SIZE; + imem_size += FW_HDR_CHKSUM_SIZE; + emem_size += emem_size ? FW_HDR_CHKSUM_SIZE : 0; + + val = (u16)(rtw_read16(rtwdev, REG_MCUFW_CTRL) & 0x3800); + val |= BIT_MCUFWDL_EN; + rtw_write16(rtwdev, REG_MCUFW_CTRL, val); + + cur_fw = data + FW_HDR_SIZE; + addr = le32_to_cpu(fw_hdr->dmem_addr); + addr &= ~BIT(31); + ret = download_firmware_to_mem(rtwdev, cur_fw, 0, addr, dmem_size); + if (ret) + return ret; + + cur_fw = data + FW_HDR_SIZE + dmem_size; + addr = le32_to_cpu(fw_hdr->imem_addr); + addr &= ~BIT(31); + ret = download_firmware_to_mem(rtwdev, cur_fw, 0, addr, imem_size); + if (ret) + return ret; + + if (emem_size) { + cur_fw = data + FW_HDR_SIZE + dmem_size + imem_size; + addr = le32_to_cpu(fw_hdr->emem_addr); + addr &= ~BIT(31); + ret = download_firmware_to_mem(rtwdev, cur_fw, 0, addr, + emem_size); + if (ret) + return ret; + } + + return 0; +} + +static int download_firmware_validate(struct rtw_dev *rtwdev) +{ + u32 fw_key; + + if (!check_hw_ready(rtwdev, REG_MCUFW_CTRL, FW_READY_MASK, FW_READY)) { + fw_key = rtw_read32(rtwdev, REG_FW_DBG7) & FW_KEY_MASK; + if (fw_key == ILLEGAL_KEY_GROUP) + rtw_err(rtwdev, "invalid fw key\n"); + return -EINVAL; + } + + return 0; +} + +static void download_firmware_end_flow(struct rtw_dev *rtwdev) +{ + u16 fw_ctrl; + + rtw_write32(rtwdev, REG_TXDMA_STATUS, BTI_PAGE_OVF); + + /* Check IMEM & DMEM checksum is OK or not */ + fw_ctrl = rtw_read16(rtwdev, REG_MCUFW_CTRL); + if ((fw_ctrl & BIT_CHECK_SUM_OK) != BIT_CHECK_SUM_OK) + return; + + fw_ctrl = (fw_ctrl | BIT_FW_DW_RDY) & ~BIT_MCUFWDL_EN; + rtw_write16(rtwdev, REG_MCUFW_CTRL, fw_ctrl); +} + +static int __rtw_download_firmware(struct rtw_dev *rtwdev, + struct rtw_fw_state *fw) +{ + struct rtw_backup_info bckp[DLFW_RESTORE_REG_NUM]; + const u8 *data = fw->firmware->data; + u32 size = fw->firmware->size; + u32 ltecoex_bckp; + int ret; + + if (!check_firmware_size(data, size)) + return -EINVAL; + + if (!ltecoex_read_reg(rtwdev, 0x38, <ecoex_bckp)) + return -EBUSY; + + wlan_cpu_enable(rtwdev, false); + + download_firmware_reg_backup(rtwdev, bckp); + download_firmware_reset_platform(rtwdev); + + ret = start_download_firmware(rtwdev, data, size); + if (ret) + goto dlfw_fail; + + download_firmware_reg_restore(rtwdev, bckp, DLFW_RESTORE_REG_NUM); + + download_firmware_end_flow(rtwdev); + + wlan_cpu_enable(rtwdev, true); + + if (!ltecoex_reg_write(rtwdev, 0x38, ltecoex_bckp)) { + ret = -EBUSY; + goto dlfw_fail; + } + + ret = download_firmware_validate(rtwdev); + if (ret) + goto dlfw_fail; + + /* reset desc and index */ + rtw_hci_setup(rtwdev); + + rtwdev->h2c.last_box_num = 0; + rtwdev->h2c.seq = 0; + + set_bit(RTW_FLAG_FW_RUNNING, rtwdev->flags); + + return 0; + +dlfw_fail: + /* Disable FWDL_EN */ + rtw_write8_clr(rtwdev, REG_MCUFW_CTRL, BIT_MCUFWDL_EN); + rtw_write8_set(rtwdev, REG_SYS_FUNC_EN + 1, BIT_FEN_CPUEN); + + return ret; +} + +static void en_download_firmware_legacy(struct rtw_dev *rtwdev, bool en) +{ + int try; + + if (en) { + wlan_cpu_enable(rtwdev, false); + wlan_cpu_enable(rtwdev, true); + + rtw_write8_set(rtwdev, REG_MCUFW_CTRL, BIT_MCUFWDL_EN); + + for (try = 0; try < 10; try++) { + if (rtw_read8(rtwdev, REG_MCUFW_CTRL) & BIT_MCUFWDL_EN) + goto fwdl_ready; + rtw_write8_set(rtwdev, REG_MCUFW_CTRL, BIT_MCUFWDL_EN); + msleep(20); + } + rtw_err(rtwdev, "failed to check fw download ready\n"); +fwdl_ready: + rtw_write32_clr(rtwdev, REG_MCUFW_CTRL, BIT_ROM_DLEN); + } else { + rtw_write8_clr(rtwdev, REG_MCUFW_CTRL, BIT_MCUFWDL_EN); + } +} + +static void +write_firmware_page(struct rtw_dev *rtwdev, u32 page, const u8 *data, u32 size) +{ + u32 val32; + u32 block_nr; + u32 remain_size; + u32 write_addr = FW_START_ADDR_LEGACY; + const __le32 *ptr = (const __le32 *)data; + u32 block; + __le32 remain_data = 0; + + block_nr = size >> DLFW_BLK_SIZE_SHIFT_LEGACY; + remain_size = size & (DLFW_BLK_SIZE_LEGACY - 1); + + val32 = rtw_read32(rtwdev, REG_MCUFW_CTRL); + val32 &= ~BIT_ROM_PGE; + val32 |= (page << BIT_SHIFT_ROM_PGE) & BIT_ROM_PGE; + rtw_write32(rtwdev, REG_MCUFW_CTRL, val32); + + for (block = 0; block < block_nr; block++) { + rtw_write32(rtwdev, write_addr, le32_to_cpu(*ptr)); + + write_addr += DLFW_BLK_SIZE_LEGACY; + ptr++; + } + + if (remain_size) { + memcpy(&remain_data, ptr, remain_size); + rtw_write32(rtwdev, write_addr, le32_to_cpu(remain_data)); + } +} + +static int +download_firmware_legacy(struct rtw_dev *rtwdev, const u8 *data, u32 size) +{ + u32 page; + u32 total_page; + u32 last_page_size; + + data += sizeof(struct rtw_fw_hdr_legacy); + size -= sizeof(struct rtw_fw_hdr_legacy); + + total_page = size >> DLFW_PAGE_SIZE_SHIFT_LEGACY; + last_page_size = size & (DLFW_PAGE_SIZE_LEGACY - 1); + + rtw_write8_set(rtwdev, REG_MCUFW_CTRL, BIT_FWDL_CHK_RPT); + + for (page = 0; page < total_page; page++) { + write_firmware_page(rtwdev, page, data, DLFW_PAGE_SIZE_LEGACY); + data += DLFW_PAGE_SIZE_LEGACY; + } + if (last_page_size) + write_firmware_page(rtwdev, page, data, last_page_size); + + if (!check_hw_ready(rtwdev, REG_MCUFW_CTRL, BIT_FWDL_CHK_RPT, 1)) { + rtw_err(rtwdev, "failed to check download firmware report\n"); + return -EINVAL; + } + + return 0; +} + +static int download_firmware_validate_legacy(struct rtw_dev *rtwdev) +{ + u32 val32; + int try; + + val32 = rtw_read32(rtwdev, REG_MCUFW_CTRL); + val32 |= BIT_MCUFWDL_RDY; + val32 &= ~BIT_WINTINI_RDY; + rtw_write32(rtwdev, REG_MCUFW_CTRL, val32); + + wlan_cpu_enable(rtwdev, false); + wlan_cpu_enable(rtwdev, true); + + for (try = 0; try < 10; try++) { + val32 = rtw_read32(rtwdev, REG_MCUFW_CTRL); + if ((val32 & FW_READY_LEGACY) == FW_READY_LEGACY) + return 0; + msleep(20); + } + + rtw_err(rtwdev, "failed to validate firmware\n"); + return -EINVAL; +} + +static int __rtw_download_firmware_legacy(struct rtw_dev *rtwdev, + struct rtw_fw_state *fw) +{ + int ret = 0; + + en_download_firmware_legacy(rtwdev, true); + ret = download_firmware_legacy(rtwdev, fw->firmware->data, fw->firmware->size); + en_download_firmware_legacy(rtwdev, false); + if (ret) + goto out; + + ret = download_firmware_validate_legacy(rtwdev); + if (ret) + goto out; + + /* reset desc and index */ + rtw_hci_setup(rtwdev); + + rtwdev->h2c.last_box_num = 0; + rtwdev->h2c.seq = 0; + + set_bit(RTW_FLAG_FW_RUNNING, rtwdev->flags); + +out: + return ret; +} + +static +int _rtw_download_firmware(struct rtw_dev *rtwdev, struct rtw_fw_state *fw) +{ + if (rtw_chip_wcpu_11n(rtwdev)) + return __rtw_download_firmware_legacy(rtwdev, fw); + + return __rtw_download_firmware(rtwdev, fw); +} + +int rtw_download_firmware(struct rtw_dev *rtwdev, struct rtw_fw_state *fw) +{ + int ret; + + ret = _rtw_download_firmware(rtwdev, fw); + if (ret) + return ret; + + if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_PCIE && + rtwdev->chip->id == RTW_CHIP_TYPE_8821C) + rtw_fw_set_recover_bt_device(rtwdev); + + return 0; +} + +static u32 get_priority_queues(struct rtw_dev *rtwdev, u32 queues) +{ + const struct rtw_rqpn *rqpn = rtwdev->fifo.rqpn; + u32 prio_queues = 0; + + if (queues & BIT(IEEE80211_AC_VO)) + prio_queues |= BIT(rqpn->dma_map_vo); + if (queues & BIT(IEEE80211_AC_VI)) + prio_queues |= BIT(rqpn->dma_map_vi); + if (queues & BIT(IEEE80211_AC_BE)) + prio_queues |= BIT(rqpn->dma_map_be); + if (queues & BIT(IEEE80211_AC_BK)) + prio_queues |= BIT(rqpn->dma_map_bk); + + return prio_queues; +} + +static void __rtw_mac_flush_prio_queue(struct rtw_dev *rtwdev, + u32 prio_queue, bool drop) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + const struct rtw_prioq_addr *addr; + bool wsize; + u16 avail_page, rsvd_page; + int i; + + if (prio_queue >= RTW_DMA_MAPPING_MAX) + return; + + addr = &chip->prioq_addrs->prio[prio_queue]; + wsize = chip->prioq_addrs->wsize; + + /* check if all of the reserved pages are available for 100 msecs */ + for (i = 0; i < 5; i++) { + rsvd_page = wsize ? rtw_read16(rtwdev, addr->rsvd) : + rtw_read8(rtwdev, addr->rsvd); + avail_page = wsize ? rtw_read16(rtwdev, addr->avail) : + rtw_read8(rtwdev, addr->avail); + if (rsvd_page == avail_page) + return; + + msleep(20); + } + + /* priority queue is still not empty, throw a warning, + * + * Note that if we want to flush the tx queue when having a lot of + * traffic (ex, 100Mbps up), some of the packets could be dropped. + * And it requires like ~2secs to flush the full priority queue. + */ + if (!drop) + rtw_warn(rtwdev, "timed out to flush queue %d\n", prio_queue); +} + +static void rtw_mac_flush_prio_queues(struct rtw_dev *rtwdev, + u32 prio_queues, bool drop) +{ + u32 q; + + for (q = 0; q < RTW_DMA_MAPPING_MAX; q++) + if (prio_queues & BIT(q)) + __rtw_mac_flush_prio_queue(rtwdev, q, drop); +} + +void rtw_mac_flush_queues(struct rtw_dev *rtwdev, u32 queues, bool drop) +{ + u32 prio_queues = 0; + + /* If all of the hardware queues are requested to flush, + * or the priority queues are not mapped yet, + * flush all of the priority queues + */ + if (queues == BIT(rtwdev->hw->queues) - 1 || !rtwdev->fifo.rqpn) + prio_queues = BIT(RTW_DMA_MAPPING_MAX) - 1; + else + prio_queues = get_priority_queues(rtwdev, queues); + + rtw_mac_flush_prio_queues(rtwdev, prio_queues, drop); +} + +static int txdma_queue_mapping(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + const struct rtw_rqpn *rqpn = NULL; + u16 txdma_pq_map = 0; + + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_PCIE: + rqpn = &chip->rqpn_table[1]; + break; + case RTW_HCI_TYPE_USB: + if (rtwdev->hci.bulkout_num == 2) + rqpn = &chip->rqpn_table[2]; + else if (rtwdev->hci.bulkout_num == 3) + rqpn = &chip->rqpn_table[3]; + else if (rtwdev->hci.bulkout_num == 4) + rqpn = &chip->rqpn_table[4]; + else + return -EINVAL; + break; + case RTW_HCI_TYPE_SDIO: + rqpn = &chip->rqpn_table[0]; + break; + default: + return -EINVAL; + } + + rtwdev->fifo.rqpn = rqpn; + txdma_pq_map |= BIT_TXDMA_HIQ_MAP(rqpn->dma_map_hi); + txdma_pq_map |= BIT_TXDMA_MGQ_MAP(rqpn->dma_map_mg); + txdma_pq_map |= BIT_TXDMA_BKQ_MAP(rqpn->dma_map_bk); + txdma_pq_map |= BIT_TXDMA_BEQ_MAP(rqpn->dma_map_be); + txdma_pq_map |= BIT_TXDMA_VIQ_MAP(rqpn->dma_map_vi); + txdma_pq_map |= BIT_TXDMA_VOQ_MAP(rqpn->dma_map_vo); + rtw_write16(rtwdev, REG_TXDMA_PQ_MAP, txdma_pq_map); + + rtw_write8(rtwdev, REG_CR, 0); + rtw_write8(rtwdev, REG_CR, MAC_TRX_ENABLE); + if (rtw_chip_wcpu_11ac(rtwdev)) + rtw_write32(rtwdev, REG_H2CQ_CSR, BIT_H2CQ_FULL); + + if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) { + rtw_read32(rtwdev, REG_SDIO_FREE_TXPG); + rtw_write32(rtwdev, REG_SDIO_TX_CTRL, 0); + } else if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_USB) { + rtw_write8_set(rtwdev, REG_TXDMA_PQ_MAP, BIT_RXDMA_ARBBW_EN); + } + + return 0; +} + +static int set_trx_fifo_info(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_fifo_conf *fifo = &rtwdev->fifo; + u16 cur_pg_addr; + u8 csi_buf_pg_num = chip->csi_buf_pg_num; + + /* config rsvd page num */ + fifo->rsvd_drv_pg_num = chip->rsvd_drv_pg_num; + fifo->txff_pg_num = chip->txff_size >> 7; + if (rtw_chip_wcpu_11n(rtwdev)) + fifo->rsvd_pg_num = fifo->rsvd_drv_pg_num; + else + fifo->rsvd_pg_num = fifo->rsvd_drv_pg_num + + RSVD_PG_H2C_EXTRAINFO_NUM + + RSVD_PG_H2C_STATICINFO_NUM + + RSVD_PG_H2CQ_NUM + + RSVD_PG_CPU_INSTRUCTION_NUM + + RSVD_PG_FW_TXBUF_NUM + + csi_buf_pg_num; + + if (fifo->rsvd_pg_num > fifo->txff_pg_num) + return -ENOMEM; + + fifo->acq_pg_num = fifo->txff_pg_num - fifo->rsvd_pg_num; + fifo->rsvd_boundary = fifo->txff_pg_num - fifo->rsvd_pg_num; + + cur_pg_addr = fifo->txff_pg_num; + if (rtw_chip_wcpu_11ac(rtwdev)) { + cur_pg_addr -= csi_buf_pg_num; + fifo->rsvd_csibuf_addr = cur_pg_addr; + cur_pg_addr -= RSVD_PG_FW_TXBUF_NUM; + fifo->rsvd_fw_txbuf_addr = cur_pg_addr; + cur_pg_addr -= RSVD_PG_CPU_INSTRUCTION_NUM; + fifo->rsvd_cpu_instr_addr = cur_pg_addr; + cur_pg_addr -= RSVD_PG_H2CQ_NUM; + fifo->rsvd_h2cq_addr = cur_pg_addr; + cur_pg_addr -= RSVD_PG_H2C_STATICINFO_NUM; + fifo->rsvd_h2c_sta_info_addr = cur_pg_addr; + cur_pg_addr -= RSVD_PG_H2C_EXTRAINFO_NUM; + fifo->rsvd_h2c_info_addr = cur_pg_addr; + } + cur_pg_addr -= fifo->rsvd_drv_pg_num; + fifo->rsvd_drv_addr = cur_pg_addr; + + if (fifo->rsvd_boundary != fifo->rsvd_drv_addr) { + rtw_err(rtwdev, "wrong rsvd driver address\n"); + return -EINVAL; + } + + return 0; +} + +static int __priority_queue_cfg(struct rtw_dev *rtwdev, + const struct rtw_page_table *pg_tbl, + u16 pubq_num) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_fifo_conf *fifo = &rtwdev->fifo; + + rtw_write16(rtwdev, REG_FIFOPAGE_INFO_1, pg_tbl->hq_num); + rtw_write16(rtwdev, REG_FIFOPAGE_INFO_2, pg_tbl->lq_num); + rtw_write16(rtwdev, REG_FIFOPAGE_INFO_3, pg_tbl->nq_num); + rtw_write16(rtwdev, REG_FIFOPAGE_INFO_4, pg_tbl->exq_num); + rtw_write16(rtwdev, REG_FIFOPAGE_INFO_5, pubq_num); + rtw_write32_set(rtwdev, REG_RQPN_CTRL_2, BIT_LD_RQPN); + + rtw_write16(rtwdev, REG_FIFOPAGE_CTRL_2, fifo->rsvd_boundary); + rtw_write8_set(rtwdev, REG_FWHW_TXQ_CTRL + 2, BIT_EN_WR_FREE_TAIL >> 16); + + rtw_write16(rtwdev, REG_BCNQ_BDNY_V1, fifo->rsvd_boundary); + rtw_write16(rtwdev, REG_FIFOPAGE_CTRL_2 + 2, fifo->rsvd_boundary); + rtw_write16(rtwdev, REG_BCNQ1_BDNY_V1, fifo->rsvd_boundary); + rtw_write32(rtwdev, REG_RXFF_BNDY, chip->rxff_size - C2H_PKT_BUF - 1); + rtw_write8_set(rtwdev, REG_AUTO_LLT_V1, BIT_AUTO_INIT_LLT_V1); + + if (!check_hw_ready(rtwdev, REG_AUTO_LLT_V1, BIT_AUTO_INIT_LLT_V1, 0)) + return -EBUSY; + + rtw_write8(rtwdev, REG_CR + 3, 0); + + return 0; +} + +static int __priority_queue_cfg_legacy(struct rtw_dev *rtwdev, + const struct rtw_page_table *pg_tbl, + u16 pubq_num) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_fifo_conf *fifo = &rtwdev->fifo; + u32 val32; + + val32 = BIT_RQPN_NE(pg_tbl->nq_num, pg_tbl->exq_num); + rtw_write32(rtwdev, REG_RQPN_NPQ, val32); + val32 = BIT_RQPN_HLP(pg_tbl->hq_num, pg_tbl->lq_num, pubq_num); + rtw_write32(rtwdev, REG_RQPN, val32); + + rtw_write8(rtwdev, REG_TRXFF_BNDY, fifo->rsvd_boundary); + rtw_write16(rtwdev, REG_TRXFF_BNDY + 2, chip->rxff_size - REPORT_BUF - 1); + rtw_write8(rtwdev, REG_DWBCN0_CTRL + 1, fifo->rsvd_boundary); + rtw_write8(rtwdev, REG_BCNQ_BDNY, fifo->rsvd_boundary); + rtw_write8(rtwdev, REG_MGQ_BDNY, fifo->rsvd_boundary); + rtw_write8(rtwdev, REG_WMAC_LBK_BF_HD, fifo->rsvd_boundary); + + rtw_write32_set(rtwdev, REG_AUTO_LLT, BIT_AUTO_INIT_LLT); + + if (!check_hw_ready(rtwdev, REG_AUTO_LLT, BIT_AUTO_INIT_LLT, 0)) + return -EBUSY; + + return 0; +} + +static int priority_queue_cfg(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_fifo_conf *fifo = &rtwdev->fifo; + const struct rtw_page_table *pg_tbl = NULL; + u16 pubq_num; + int ret; + + ret = set_trx_fifo_info(rtwdev); + if (ret) + return ret; + + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_PCIE: + pg_tbl = &chip->page_table[1]; + break; + case RTW_HCI_TYPE_USB: + if (rtwdev->hci.bulkout_num == 2) + pg_tbl = &chip->page_table[2]; + else if (rtwdev->hci.bulkout_num == 3) + pg_tbl = &chip->page_table[3]; + else if (rtwdev->hci.bulkout_num == 4) + pg_tbl = &chip->page_table[4]; + else + return -EINVAL; + break; + case RTW_HCI_TYPE_SDIO: + pg_tbl = &chip->page_table[0]; + break; + default: + return -EINVAL; + } + + pubq_num = fifo->acq_pg_num - pg_tbl->hq_num - pg_tbl->lq_num - + pg_tbl->nq_num - pg_tbl->exq_num - pg_tbl->gapq_num; + if (rtw_chip_wcpu_11n(rtwdev)) + return __priority_queue_cfg_legacy(rtwdev, pg_tbl, pubq_num); + else + return __priority_queue_cfg(rtwdev, pg_tbl, pubq_num); +} + +static int init_h2c(struct rtw_dev *rtwdev) +{ + struct rtw_fifo_conf *fifo = &rtwdev->fifo; + u8 value8; + u32 value32; + u32 h2cq_addr; + u32 h2cq_size; + u32 h2cq_free; + u32 wp, rp; + + if (rtw_chip_wcpu_11n(rtwdev)) + return 0; + + h2cq_addr = fifo->rsvd_h2cq_addr << TX_PAGE_SIZE_SHIFT; + h2cq_size = RSVD_PG_H2CQ_NUM << TX_PAGE_SIZE_SHIFT; + + value32 = rtw_read32(rtwdev, REG_H2C_HEAD); + value32 = (value32 & 0xFFFC0000) | h2cq_addr; + rtw_write32(rtwdev, REG_H2C_HEAD, value32); + + value32 = rtw_read32(rtwdev, REG_H2C_READ_ADDR); + value32 = (value32 & 0xFFFC0000) | h2cq_addr; + rtw_write32(rtwdev, REG_H2C_READ_ADDR, value32); + + value32 = rtw_read32(rtwdev, REG_H2C_TAIL); + value32 &= 0xFFFC0000; + value32 |= (h2cq_addr + h2cq_size); + rtw_write32(rtwdev, REG_H2C_TAIL, value32); + + value8 = rtw_read8(rtwdev, REG_H2C_INFO); + value8 = (u8)((value8 & 0xFC) | 0x01); + rtw_write8(rtwdev, REG_H2C_INFO, value8); + + value8 = rtw_read8(rtwdev, REG_H2C_INFO); + value8 = (u8)((value8 & 0xFB) | 0x04); + rtw_write8(rtwdev, REG_H2C_INFO, value8); + + value8 = rtw_read8(rtwdev, REG_TXDMA_OFFSET_CHK + 1); + value8 = (u8)((value8 & 0x7f) | 0x80); + rtw_write8(rtwdev, REG_TXDMA_OFFSET_CHK + 1, value8); + + wp = rtw_read32(rtwdev, REG_H2C_PKT_WRITEADDR) & 0x3FFFF; + rp = rtw_read32(rtwdev, REG_H2C_PKT_READADDR) & 0x3FFFF; + h2cq_free = wp >= rp ? h2cq_size - (wp - rp) : rp - wp; + + if (h2cq_size != h2cq_free) { + rtw_err(rtwdev, "H2C queue mismatch\n"); + return -EINVAL; + } + + return 0; +} + +static int rtw_init_trx_cfg(struct rtw_dev *rtwdev) +{ + int ret; + + ret = txdma_queue_mapping(rtwdev); + if (ret) + return ret; + + ret = priority_queue_cfg(rtwdev); + if (ret) + return ret; + + ret = init_h2c(rtwdev); + if (ret) + return ret; + + return 0; +} + +static int rtw_drv_info_cfg(struct rtw_dev *rtwdev) +{ + u8 value8; + + rtw_write8(rtwdev, REG_RX_DRVINFO_SZ, PHY_STATUS_SIZE); + if (rtw_chip_wcpu_11ac(rtwdev)) { + value8 = rtw_read8(rtwdev, REG_TRXFF_BNDY + 1); + value8 &= 0xF0; + /* For rxdesc len = 0 issue */ + value8 |= 0xF; + rtw_write8(rtwdev, REG_TRXFF_BNDY + 1, value8); + } + rtw_write32_set(rtwdev, REG_RCR, BIT_APP_PHYSTS); + rtw_write32_clr(rtwdev, REG_WMAC_OPTION_FUNCTION + 4, BIT(8) | BIT(9)); + + return 0; +} + +int rtw_mac_init(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + int ret; + + ret = rtw_init_trx_cfg(rtwdev); + if (ret) + return ret; + + ret = chip->ops->mac_init(rtwdev); + if (ret) + return ret; + + ret = rtw_drv_info_cfg(rtwdev); + if (ret) + return ret; + + rtw_hci_interface_cfg(rtwdev); + + return 0; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/mac.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/mac.h new file mode 100644 index 0000000000000000000000000000000000000000..58c3dccc14bb512cd9a4f86b0fe9f83c2302ff6d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/mac.h @@ -0,0 +1,45 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_MAC_H__ +#define __RTW_MAC_H__ + +#define RTW_HW_PORT_NUM 5 +#define cut_version_to_mask(cut) (0x1 << ((cut) + 1)) +#define DDMA_POLLING_COUNT 1000 +#define C2H_PKT_BUF 256 +#define REPORT_BUF 128 +#define PHY_STATUS_SIZE 4 +#define ILLEGAL_KEY_GROUP 0xFAAAAA00 + +/* HW memory address */ +#define OCPBASE_RXBUF_FW_88XX 0x18680000 +#define OCPBASE_TXBUF_88XX 0x18780000 +#define OCPBASE_ROM_88XX 0x00000000 +#define OCPBASE_IMEM_88XX 0x00030000 +#define OCPBASE_DMEM_88XX 0x00200000 +#define OCPBASE_EMEM_88XX 0x00100000 + +#define RSVD_PG_DRV_NUM 16 +#define RSVD_PG_H2C_EXTRAINFO_NUM 24 +#define RSVD_PG_H2C_STATICINFO_NUM 8 +#define RSVD_PG_H2CQ_NUM 8 +#define RSVD_PG_CPU_INSTRUCTION_NUM 0 +#define RSVD_PG_FW_TXBUF_NUM 4 + +void rtw_set_channel_mac(struct rtw_dev *rtwdev, u8 channel, u8 bw, + u8 primary_ch_idx); +int rtw_mac_power_on(struct rtw_dev *rtwdev); +void rtw_mac_power_off(struct rtw_dev *rtwdev); +int rtw_download_firmware(struct rtw_dev *rtwdev, struct rtw_fw_state *fw); +int rtw_mac_init(struct rtw_dev *rtwdev); +void rtw_mac_flush_queues(struct rtw_dev *rtwdev, u32 queues, bool drop); +int rtw_ddma_to_fw_fifo(struct rtw_dev *rtwdev, u32 ocp_src, u32 size); + +static inline void rtw_mac_flush_all_queues(struct rtw_dev *rtwdev, bool drop) +{ + rtw_mac_flush_queues(rtwdev, BIT(rtwdev->hw->queues) - 1, drop); +} + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/mac80211.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/mac80211.c new file mode 100644 index 0000000000000000000000000000000000000000..78bdbe2cf07b00decd5d1629c16df431bec94d01 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/mac80211.c @@ -0,0 +1,1030 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "sec.h" +#include "tx.h" +#include "fw.h" +#include "mac.h" +#include "coex.h" +#include "ps.h" +#include "reg.h" +#include "bf.h" +#include "debug.h" +#include "wow.h" +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) +#include "sar.h" +#endif + +static void rtw_ops_tx(struct ieee80211_hw *hw, + struct ieee80211_tx_control *control, + struct sk_buff *skb) +{ + struct rtw_dev *rtwdev = hw->priv; + + if (!test_bit(RTW_FLAG_RUNNING, rtwdev->flags)) { + ieee80211_free_txskb(hw, skb); + return; + } + + rtw_tx(rtwdev, control, skb); +} + +static void rtw_ops_wake_tx_queue(struct ieee80211_hw *hw, + struct ieee80211_txq *txq) +{ + struct rtw_dev *rtwdev = hw->priv; + struct rtw_txq *rtwtxq = (struct rtw_txq *)txq->drv_priv; + + if (!test_bit(RTW_FLAG_RUNNING, rtwdev->flags)) + return; + + spin_lock_bh(&rtwdev->txq_lock); + if (list_empty(&rtwtxq->list)) + list_add_tail(&rtwtxq->list, &rtwdev->txqs); + spin_unlock_bh(&rtwdev->txq_lock); + + /* ensure to dequeue EAPOL (4/4) at the right time */ + if (txq->ac == IEEE80211_AC_VO) + __rtw_tx_work(rtwdev); + else + queue_work(rtwdev->tx_wq, &rtwdev->tx_work); +} + +static int rtw_ops_start(struct ieee80211_hw *hw) +{ + struct rtw_dev *rtwdev = hw->priv; + int ret; + + mutex_lock(&rtwdev->mutex); + ret = rtw_core_start(rtwdev); + mutex_unlock(&rtwdev->mutex); + + return ret; +} + +static void rtw_ops_stop(struct ieee80211_hw *hw) +{ + struct rtw_dev *rtwdev = hw->priv; + + mutex_lock(&rtwdev->mutex); + rtw_core_stop(rtwdev); + mutex_unlock(&rtwdev->mutex); +} + +static int rtw_ops_config(struct ieee80211_hw *hw, u32 changed) +{ + struct rtw_dev *rtwdev = hw->priv; + int ret = 0; + + /* let previous ips work finish to ensure we don't leave ips twice */ + cancel_work_sync(&rtwdev->ips_work); + + mutex_lock(&rtwdev->mutex); + + rtw_leave_lps_deep(rtwdev); + + if ((changed & IEEE80211_CONF_CHANGE_IDLE) && + !(hw->conf.flags & IEEE80211_CONF_IDLE)) { + ret = rtw_leave_ips(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to leave idle state\n"); + goto out; + } + } + + if (changed & IEEE80211_CONF_CHANGE_CHANNEL) + rtw_set_channel(rtwdev); + + if ((changed & IEEE80211_CONF_CHANGE_IDLE) && + (hw->conf.flags & IEEE80211_CONF_IDLE) && + !test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + rtw_enter_ips(rtwdev); + +out: + mutex_unlock(&rtwdev->mutex); + return ret; +} + +static const struct rtw_vif_port rtw_vif_port[] = { + [0] = { + .mac_addr = {.addr = 0x0610}, + .bssid = {.addr = 0x0618}, + .net_type = {.addr = 0x0100, .mask = 0x30000}, + .aid = {.addr = 0x06a8, .mask = 0x7ff}, + .bcn_ctrl = {.addr = 0x0550, .mask = 0xff}, + }, + [1] = { + .mac_addr = {.addr = 0x0700}, + .bssid = {.addr = 0x0708}, + .net_type = {.addr = 0x0100, .mask = 0xc0000}, + .aid = {.addr = 0x0710, .mask = 0x7ff}, + .bcn_ctrl = {.addr = 0x0551, .mask = 0xff}, + }, + [2] = { + .mac_addr = {.addr = 0x1620}, + .bssid = {.addr = 0x1628}, + .net_type = {.addr = 0x1100, .mask = 0x3}, + .aid = {.addr = 0x1600, .mask = 0x7ff}, + .bcn_ctrl = {.addr = 0x0578, .mask = 0xff}, + }, + [3] = { + .mac_addr = {.addr = 0x1630}, + .bssid = {.addr = 0x1638}, + .net_type = {.addr = 0x1100, .mask = 0xc}, + .aid = {.addr = 0x1604, .mask = 0x7ff}, + .bcn_ctrl = {.addr = 0x0579, .mask = 0xff}, + }, + [4] = { + .mac_addr = {.addr = 0x1640}, + .bssid = {.addr = 0x1648}, + .net_type = {.addr = 0x1100, .mask = 0x30}, + .aid = {.addr = 0x1608, .mask = 0x7ff}, + .bcn_ctrl = {.addr = 0x057a, .mask = 0xff}, + }, +}; + +static int rtw_ops_add_interface(struct ieee80211_hw *hw, + struct ieee80211_vif *vif) +{ + struct rtw_dev *rtwdev = hw->priv; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + enum rtw_net_type net_type; + u32 config = 0; + u8 port; + u8 bcn_ctrl = 0; + + if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_BCN_FILTER)) + vif->driver_flags |= IEEE80211_VIF_BEACON_FILTER | + IEEE80211_VIF_SUPPORTS_CQM_RSSI; + rtwvif->stats.tx_unicast = 0; + rtwvif->stats.rx_unicast = 0; + rtwvif->stats.tx_cnt = 0; + rtwvif->stats.rx_cnt = 0; + rtwvif->scan_req = NULL; + memset(&rtwvif->bfee, 0, sizeof(struct rtw_bfee)); + rtw_txq_init(rtwdev, vif->txq); + INIT_LIST_HEAD(&rtwvif->rsvd_page_list); + + mutex_lock(&rtwdev->mutex); + + port = find_first_zero_bit(rtwdev->hw_port, RTW_PORT_NUM); + if (port >= RTW_PORT_NUM) { + mutex_unlock(&rtwdev->mutex); + return -EINVAL; + } + set_bit(port, rtwdev->hw_port); + + rtwvif->port = port; + rtwvif->conf = &rtw_vif_port[port]; + rtw_leave_lps_deep(rtwdev); + + switch (vif->type) { + case NL80211_IFTYPE_AP: + case NL80211_IFTYPE_MESH_POINT: + rtw_add_rsvd_page_bcn(rtwdev, rtwvif); + net_type = RTW_NET_AP_MODE; + bcn_ctrl = BIT_EN_BCN_FUNCTION | BIT_DIS_TSF_UDT; + break; + case NL80211_IFTYPE_ADHOC: + rtw_add_rsvd_page_bcn(rtwdev, rtwvif); + net_type = RTW_NET_AD_HOC; + bcn_ctrl = BIT_EN_BCN_FUNCTION | BIT_DIS_TSF_UDT; + break; + case NL80211_IFTYPE_STATION: + rtw_add_rsvd_page_sta(rtwdev, rtwvif); + net_type = RTW_NET_NO_LINK; + bcn_ctrl = BIT_EN_BCN_FUNCTION; + break; + default: + WARN_ON(1); + clear_bit(rtwvif->port, rtwdev->hw_port); + mutex_unlock(&rtwdev->mutex); + return -EINVAL; + } + + ether_addr_copy(rtwvif->mac_addr, vif->addr); + config |= PORT_SET_MAC_ADDR; + rtwvif->net_type = net_type; + config |= PORT_SET_NET_TYPE; + rtwvif->bcn_ctrl = bcn_ctrl; + config |= PORT_SET_BCN_CTRL; + rtw_vif_port_config(rtwdev, rtwvif, config); + rtw_core_port_switch(rtwdev, vif); + rtw_recalc_lps(rtwdev, vif); + + mutex_unlock(&rtwdev->mutex); + + rtw_dbg(rtwdev, RTW_DBG_STATE, "start vif %pM on port %d\n", vif->addr, rtwvif->port); + return 0; +} + +static void rtw_ops_remove_interface(struct ieee80211_hw *hw, + struct ieee80211_vif *vif) +{ + struct rtw_dev *rtwdev = hw->priv; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + u32 config = 0; + + rtw_dbg(rtwdev, RTW_DBG_STATE, "stop vif %pM on port %d\n", vif->addr, rtwvif->port); + + mutex_lock(&rtwdev->mutex); + + rtw_leave_lps_deep(rtwdev); + + rtw_txq_cleanup(rtwdev, vif->txq); + rtw_remove_rsvd_page(rtwdev, rtwvif); + + eth_zero_addr(rtwvif->mac_addr); + config |= PORT_SET_MAC_ADDR; + rtwvif->net_type = RTW_NET_NO_LINK; + config |= PORT_SET_NET_TYPE; + rtwvif->bcn_ctrl = 0; + config |= PORT_SET_BCN_CTRL; + rtw_vif_port_config(rtwdev, rtwvif, config); + clear_bit(rtwvif->port, rtwdev->hw_port); + rtw_recalc_lps(rtwdev, NULL); + + mutex_unlock(&rtwdev->mutex); +} + +static int rtw_ops_change_interface(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + enum nl80211_iftype type, bool p2p) +{ + struct rtw_dev *rtwdev = hw->priv; + + rtw_dbg(rtwdev, RTW_DBG_STATE, "change vif %pM (%d)->(%d), p2p (%d)->(%d)\n", + vif->addr, vif->type, type, vif->p2p, p2p); + + rtw_ops_remove_interface(hw, vif); + + vif->type = type; + vif->p2p = p2p; + + return rtw_ops_add_interface(hw, vif); +} + +static void rtw_ops_configure_filter(struct ieee80211_hw *hw, + unsigned int changed_flags, + unsigned int *new_flags, + u64 multicast) +{ + struct rtw_dev *rtwdev = hw->priv; + + *new_flags &= FIF_ALLMULTI | FIF_OTHER_BSS | FIF_FCSFAIL | + FIF_BCN_PRBRESP_PROMISC; + + mutex_lock(&rtwdev->mutex); + + rtw_leave_lps_deep(rtwdev); + + if (changed_flags & FIF_ALLMULTI) { + if (*new_flags & FIF_ALLMULTI) + rtwdev->hal.rcr |= BIT_AM; + else + rtwdev->hal.rcr &= ~(BIT_AM); + } + if (changed_flags & FIF_FCSFAIL) { + if (*new_flags & FIF_FCSFAIL) + rtwdev->hal.rcr |= BIT_ACRC32; + else + rtwdev->hal.rcr &= ~(BIT_ACRC32); + } + if (changed_flags & FIF_OTHER_BSS) { + if (*new_flags & FIF_OTHER_BSS) + rtwdev->hal.rcr |= BIT_AAP; + else + rtwdev->hal.rcr &= ~(BIT_AAP); + } + if (changed_flags & FIF_BCN_PRBRESP_PROMISC) { + if (*new_flags & FIF_BCN_PRBRESP_PROMISC) + rtwdev->hal.rcr &= ~(BIT_CBSSID_BCN | BIT_CBSSID_DATA); + else + rtwdev->hal.rcr |= BIT_CBSSID_BCN; + } + + rtw_dbg(rtwdev, RTW_DBG_RX, + "config rx filter, changed=0x%08x, new=0x%08x, rcr=0x%08x\n", + changed_flags, *new_flags, rtwdev->hal.rcr); + + rtw_write32(rtwdev, REG_RCR, rtwdev->hal.rcr); + + mutex_unlock(&rtwdev->mutex); +} + +/* Only have one group of EDCA parameters now */ +static const u32 ac_to_edca_param[IEEE80211_NUM_ACS] = { + [IEEE80211_AC_VO] = REG_EDCA_VO_PARAM, + [IEEE80211_AC_VI] = REG_EDCA_VI_PARAM, + [IEEE80211_AC_BE] = REG_EDCA_BE_PARAM, + [IEEE80211_AC_BK] = REG_EDCA_BK_PARAM, +}; + +static u8 rtw_aifsn_to_aifs(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif, u8 aifsn) +{ + struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif); + u8 slot_time; + u8 sifs; + + slot_time = vif->bss_conf.use_short_slot ? 9 : 20; + sifs = rtwdev->hal.current_band_type == RTW_BAND_5G ? 16 : 10; + + return aifsn * slot_time + sifs; +} + +static void __rtw_conf_tx(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif, u16 ac) +{ + struct ieee80211_tx_queue_params *params = &rtwvif->tx_params[ac]; + u32 edca_param = ac_to_edca_param[ac]; + u8 ecw_max, ecw_min; + u8 aifs; + + /* 2^ecw - 1 = cw; ecw = log2(cw + 1) */ + ecw_max = ilog2(params->cw_max + 1); + ecw_min = ilog2(params->cw_min + 1); + aifs = rtw_aifsn_to_aifs(rtwdev, rtwvif, params->aifs); + rtw_write32_mask(rtwdev, edca_param, BIT_MASK_TXOP_LMT, params->txop); + rtw_write32_mask(rtwdev, edca_param, BIT_MASK_CWMAX, ecw_max); + rtw_write32_mask(rtwdev, edca_param, BIT_MASK_CWMIN, ecw_min); + rtw_write32_mask(rtwdev, edca_param, BIT_MASK_AIFS, aifs); +} + +static void rtw_conf_tx(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif) +{ + u16 ac; + + for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) + __rtw_conf_tx(rtwdev, rtwvif, ac); +} + +static void rtw_ops_bss_info_changed(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + struct ieee80211_bss_conf *conf, +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) + u64 changed) +#else + u32 changed) +#endif +{ + struct rtw_dev *rtwdev = hw->priv; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + u32 config = 0; + + mutex_lock(&rtwdev->mutex); + + rtw_leave_lps_deep(rtwdev); + + if (changed & BSS_CHANGED_ASSOC) { + rtw_vif_assoc_changed(rtwvif, conf); +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) + if (vif->cfg.assoc) { +#else + if (conf->assoc) { +#endif + rtw_coex_connect_notify(rtwdev, COEX_ASSOCIATE_FINISH); + + rtw_fw_download_rsvd_page(rtwdev); + rtw_send_rsvd_page_h2c(rtwdev); + rtw_fw_default_port(rtwdev, rtwvif); +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) + rtw_coex_media_status_notify(rtwdev, vif->cfg.assoc); +#else + rtw_coex_media_status_notify(rtwdev, conf->assoc); +#endif + if (rtw_bf_support) + rtw_bf_assoc(rtwdev, vif, conf); + } else { + rtw_leave_lps(rtwdev); + rtw_bf_disassoc(rtwdev, vif, conf); + /* Abort ongoing scan if cancel_scan isn't issued + * when disconnected by peer + */ + if (test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + rtw_hw_scan_abort(rtwdev); + + } + + config |= PORT_SET_NET_TYPE; + config |= PORT_SET_AID; + } + + if (changed & BSS_CHANGED_BSSID) { + ether_addr_copy(rtwvif->bssid, conf->bssid); + config |= PORT_SET_BSSID; + if (!rtw_core_check_sta_active(rtwdev)) + rtw_clear_op_chan(rtwdev); + else + rtw_store_op_chan(rtwdev, true); + } + + if (changed & BSS_CHANGED_BEACON_INT) { + if (ieee80211_vif_type_p2p(vif) == NL80211_IFTYPE_STATION) + coex_stat->wl_beacon_interval = conf->beacon_int; + } + + if (changed & BSS_CHANGED_BEACON) { + rtw_set_dtim_period(rtwdev, conf->dtim_period); + rtw_fw_download_rsvd_page(rtwdev); + rtw_send_rsvd_page_h2c(rtwdev); + } + + if (changed & BSS_CHANGED_BEACON_ENABLED) { + if (conf->enable_beacon) + rtw_write32_set(rtwdev, REG_FWHW_TXQ_CTRL, + BIT_EN_BCNQ_DL); + else + rtw_write32_clr(rtwdev, REG_FWHW_TXQ_CTRL, + BIT_EN_BCNQ_DL); + } + if (changed & BSS_CHANGED_CQM) + rtw_fw_beacon_filter_config(rtwdev, true, vif); + + if (changed & BSS_CHANGED_MU_GROUPS) + rtw_chip_set_gid_table(rtwdev, vif, conf); + + if (changed & BSS_CHANGED_ERP_SLOT) + rtw_conf_tx(rtwdev, rtwvif); + + if (changed & BSS_CHANGED_PS) + rtw_recalc_lps(rtwdev, NULL); + + rtw_vif_port_config(rtwdev, rtwvif, config); + + mutex_unlock(&rtwdev->mutex); +} + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) +static int rtw_ops_start_ap(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + struct ieee80211_bss_conf *link_conf) +#else +static int rtw_ops_start_ap(struct ieee80211_hw *hw, struct ieee80211_vif *vif) +#endif +{ + struct rtw_dev *rtwdev = hw->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + + mutex_lock(&rtwdev->mutex); + rtw_write32_set(rtwdev, REG_TCR, BIT_TCR_UPDATE_HGQMD); + rtwdev->ap_active = true; + rtw_store_op_chan(rtwdev, true); + chip->ops->phy_calibration(rtwdev); + mutex_unlock(&rtwdev->mutex); + + return 0; +} + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) +static void rtw_ops_stop_ap(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + struct ieee80211_bss_conf *link_conf) +#else +static void rtw_ops_stop_ap(struct ieee80211_hw *hw, + struct ieee80211_vif *vif) +#endif +{ + struct rtw_dev *rtwdev = hw->priv; + + mutex_lock(&rtwdev->mutex); + rtw_write32_clr(rtwdev, REG_TCR, BIT_TCR_UPDATE_HGQMD); + rtwdev->ap_active = false; + if (!rtw_core_check_sta_active(rtwdev)) + rtw_clear_op_chan(rtwdev); + mutex_unlock(&rtwdev->mutex); +} + +static int rtw_ops_conf_tx(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) + unsigned int link_id, u16 ac, +#else + u16 ac, +#endif + const struct ieee80211_tx_queue_params *params) +{ + struct rtw_dev *rtwdev = hw->priv; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + + mutex_lock(&rtwdev->mutex); + + rtw_leave_lps_deep(rtwdev); + + rtwvif->tx_params[ac] = *params; + __rtw_conf_tx(rtwdev, rtwvif, ac); + + mutex_unlock(&rtwdev->mutex); + + return 0; +} + +static int rtw_ops_sta_add(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + struct ieee80211_sta *sta) +{ + struct rtw_dev *rtwdev = hw->priv; + int ret = 0; + + mutex_lock(&rtwdev->mutex); + ret = rtw_sta_add(rtwdev, sta, vif); + mutex_unlock(&rtwdev->mutex); + + return ret; +} + +static int rtw_ops_sta_remove(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + struct ieee80211_sta *sta) +{ + struct rtw_dev *rtwdev = hw->priv; + + mutex_lock(&rtwdev->mutex); + rtw_fw_beacon_filter_config(rtwdev, false, vif); + rtw_sta_remove(rtwdev, sta, true); + mutex_unlock(&rtwdev->mutex); + + return 0; +} + +static int rtw_ops_set_tim(struct ieee80211_hw *hw, struct ieee80211_sta *sta, + bool set) +{ + struct rtw_dev *rtwdev = hw->priv; + + ieee80211_queue_work(hw, &rtwdev->update_beacon_work); + + return 0; +} + +static int rtw_ops_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, + struct ieee80211_vif *vif, struct ieee80211_sta *sta, + struct ieee80211_key_conf *key) +{ + struct rtw_dev *rtwdev = hw->priv; + struct rtw_sec_desc *sec = &rtwdev->sec; + u8 hw_key_type; + u8 hw_key_idx; + int ret = 0; + + switch (key->cipher) { + case WLAN_CIPHER_SUITE_WEP40: + hw_key_type = RTW_CAM_WEP40; + break; + case WLAN_CIPHER_SUITE_WEP104: + hw_key_type = RTW_CAM_WEP104; + break; + case WLAN_CIPHER_SUITE_TKIP: + hw_key_type = RTW_CAM_TKIP; + key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC; + break; + case WLAN_CIPHER_SUITE_CCMP: + hw_key_type = RTW_CAM_AES; + key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; + break; + case WLAN_CIPHER_SUITE_AES_CMAC: + case WLAN_CIPHER_SUITE_BIP_CMAC_256: + case WLAN_CIPHER_SUITE_BIP_GMAC_128: + case WLAN_CIPHER_SUITE_BIP_GMAC_256: + case WLAN_CIPHER_SUITE_CCMP_256: + case WLAN_CIPHER_SUITE_GCMP: + case WLAN_CIPHER_SUITE_GCMP_256: + /* suppress error messages */ + return -EOPNOTSUPP; + default: + return -ENOTSUPP; + } + + mutex_lock(&rtwdev->mutex); + + rtw_leave_lps_deep(rtwdev); + + if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) { + hw_key_idx = rtw_sec_get_free_cam(sec); + } else { + /* multiple interfaces? */ + hw_key_idx = key->keyidx; + } + + if (hw_key_idx > sec->total_cam_num) { + ret = -ENOSPC; + goto out; + } + + switch (cmd) { + case SET_KEY: + /* need sw generated IV */ + key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV; + key->hw_key_idx = hw_key_idx; + rtw_sec_write_cam(rtwdev, sec, sta, key, + hw_key_type, hw_key_idx); + break; + case DISABLE_KEY: + rtw_hci_flush_all_queues(rtwdev, false); + rtw_mac_flush_all_queues(rtwdev, false); + rtw_sec_clear_cam(rtwdev, sec, key->hw_key_idx); + break; + } + + /* download new cam settings for PG to backup */ + if (rtw_get_lps_deep_mode(rtwdev) == LPS_DEEP_MODE_PG) + rtw_fw_download_rsvd_page(rtwdev); + +out: + mutex_unlock(&rtwdev->mutex); + + return ret; +} + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 6, 0) +static int rtw_ops_ampdu_action(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + struct ieee80211_ampdu_params *params) +#else +static int rtw_ops_ampdu_action(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + enum ieee80211_ampdu_mlme_action action, + struct ieee80211_sta *sta, u16 tid, u16 *ssn, + u8 buf_size, bool amsdu) +#endif +{ +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 6, 0) + struct ieee80211_sta *sta = params->sta; + u16 tid = params->tid; + struct ieee80211_txq *txq = sta->txq[tid]; + struct rtw_txq *rtwtxq = (struct rtw_txq *)txq->drv_priv; + + switch (params->action) { +#else + switch (action) { +#endif + case IEEE80211_AMPDU_TX_START: +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 5, 0) + return IEEE80211_AMPDU_TX_START_IMMEDIATE; +#else + ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid); + break; +#endif + case IEEE80211_AMPDU_TX_STOP_CONT: + case IEEE80211_AMPDU_TX_STOP_FLUSH: + case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT: + clear_bit(RTW_TXQ_AMPDU, &rtwtxq->flags); + ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid); + break; + case IEEE80211_AMPDU_TX_OPERATIONAL: + set_bit(RTW_TXQ_AMPDU, &rtwtxq->flags); + break; + case IEEE80211_AMPDU_RX_START: + case IEEE80211_AMPDU_RX_STOP: + break; + default: + WARN_ON(1); + return -ENOTSUPP; + } + + return 0; +} + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 20, 0) +static bool rtw_ops_can_aggregate_in_amsdu(struct ieee80211_hw *hw, + struct sk_buff *head, + struct sk_buff *skb) +{ + struct rtw_dev *rtwdev = hw->priv; + struct rtw_hal *hal = &rtwdev->hal; + + /* we don't want to enable TX AMSDU on 2.4G */ + if (hal->current_band_type == RTW_BAND_2G) + return false; + + return true; +} +#endif + +static void rtw_ops_sw_scan_start(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + const u8 *mac_addr) +{ + struct rtw_dev *rtwdev = hw->priv; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + + mutex_lock(&rtwdev->mutex); + rtw_core_scan_start(rtwdev, rtwvif, mac_addr, false); + mutex_unlock(&rtwdev->mutex); +} + +static void rtw_ops_sw_scan_complete(struct ieee80211_hw *hw, + struct ieee80211_vif *vif) +{ + struct rtw_dev *rtwdev = hw->priv; + + mutex_lock(&rtwdev->mutex); + rtw_core_scan_complete(rtwdev, vif, false); + mutex_unlock(&rtwdev->mutex); +} + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 18, 0) +static void rtw_ops_mgd_prepare_tx(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5,14,0)) + struct ieee80211_prep_tx_info *info) + #else + u16 duration) + #endif +#else +static void rtw_ops_mgd_prepare_tx(struct ieee80211_hw *hw, + struct ieee80211_vif *vif) +#endif +{ + struct rtw_dev *rtwdev = hw->priv; + + mutex_lock(&rtwdev->mutex); + rtw_leave_lps_deep(rtwdev); + rtw_coex_connect_notify(rtwdev, COEX_ASSOCIATE_START); + rtw_chip_prepare_tx(rtwdev); + mutex_unlock(&rtwdev->mutex); +} + +static int rtw_ops_set_rts_threshold(struct ieee80211_hw *hw, u32 value) +{ + struct rtw_dev *rtwdev = hw->priv; + + mutex_lock(&rtwdev->mutex); + rtwdev->rts_threshold = value; + mutex_unlock(&rtwdev->mutex); + + return 0; +} + +static void rtw_ops_sta_statistics(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + struct ieee80211_sta *sta, + struct station_info *sinfo) +{ + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + + sinfo->txrate = si->ra_report.txrate; + sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BITRATE); +} + +static void rtw_ops_flush(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + u32 queues, bool drop) +{ + struct rtw_dev *rtwdev = hw->priv; + + mutex_lock(&rtwdev->mutex); + rtw_leave_lps_deep(rtwdev); + + rtw_hci_flush_queues(rtwdev, queues, drop); + rtw_mac_flush_queues(rtwdev, queues, drop); + mutex_unlock(&rtwdev->mutex); +} + +struct rtw_iter_bitrate_mask_data { + struct rtw_dev *rtwdev; + struct ieee80211_vif *vif; + const struct cfg80211_bitrate_mask *mask; +}; + +static void rtw_ra_mask_info_update_iter(void *data, struct ieee80211_sta *sta) +{ + struct rtw_iter_bitrate_mask_data *br_data = data; + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + + if (si->vif != br_data->vif) + return; + + /* free previous mask setting */ + kfree(si->mask); + si->mask = kmemdup(br_data->mask, sizeof(struct cfg80211_bitrate_mask), + GFP_ATOMIC); + if (!si->mask) { + si->use_cfg_mask = false; + return; + } + + si->use_cfg_mask = true; + rtw_update_sta_info(br_data->rtwdev, si, true); +} + +static void rtw_ra_mask_info_update(struct rtw_dev *rtwdev, + struct ieee80211_vif *vif, + const struct cfg80211_bitrate_mask *mask) +{ + struct rtw_iter_bitrate_mask_data br_data; + + br_data.rtwdev = rtwdev; + br_data.vif = vif; + br_data.mask = mask; + rtw_iterate_stas(rtwdev, rtw_ra_mask_info_update_iter, &br_data); +} + +static int rtw_ops_set_bitrate_mask(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + const struct cfg80211_bitrate_mask *mask) +{ + struct rtw_dev *rtwdev = hw->priv; + + mutex_lock(&rtwdev->mutex); + rtw_ra_mask_info_update(rtwdev, vif, mask); + mutex_unlock(&rtwdev->mutex); + + return 0; +} + +static int rtw_ops_set_antenna(struct ieee80211_hw *hw, + u32 tx_antenna, + u32 rx_antenna) +{ + struct rtw_dev *rtwdev = hw->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + int ret; + + if (!chip->ops->set_antenna) + return -EOPNOTSUPP; + + mutex_lock(&rtwdev->mutex); + ret = chip->ops->set_antenna(rtwdev, tx_antenna, rx_antenna); + mutex_unlock(&rtwdev->mutex); + + return ret; +} + +static int rtw_ops_get_antenna(struct ieee80211_hw *hw, + u32 *tx_antenna, + u32 *rx_antenna) +{ + struct rtw_dev *rtwdev = hw->priv; + struct rtw_hal *hal = &rtwdev->hal; + + *tx_antenna = hal->antenna_tx; + *rx_antenna = hal->antenna_rx; + + return 0; +} + +#ifdef CONFIG_PM +static int rtw_ops_suspend(struct ieee80211_hw *hw, + struct cfg80211_wowlan *wowlan) +{ + struct rtw_dev *rtwdev = hw->priv; + int ret; + + mutex_lock(&rtwdev->mutex); + ret = rtw_wow_suspend(rtwdev, wowlan); + if (ret) + rtw_err(rtwdev, "failed to suspend for wow %d\n", ret); + mutex_unlock(&rtwdev->mutex); + + return ret ? 1 : 0; +} + +static int rtw_ops_resume(struct ieee80211_hw *hw) +{ + struct rtw_dev *rtwdev = hw->priv; + int ret; + + mutex_lock(&rtwdev->mutex); + ret = rtw_wow_resume(rtwdev); + if (ret) + rtw_err(rtwdev, "failed to resume for wow %d\n", ret); + mutex_unlock(&rtwdev->mutex); + + return ret ? 1 : 0; +} + +static void rtw_ops_set_wakeup(struct ieee80211_hw *hw, bool enabled) +{ + struct rtw_dev *rtwdev = hw->priv; + + device_set_wakeup_enable(rtwdev->dev, enabled); +} +#endif + +static void rtw_reconfig_complete(struct ieee80211_hw *hw, + enum ieee80211_reconfig_type reconfig_type) +{ + struct rtw_dev *rtwdev = hw->priv; + + mutex_lock(&rtwdev->mutex); + if (reconfig_type == IEEE80211_RECONFIG_TYPE_RESTART) + clear_bit(RTW_FLAG_RESTARTING, rtwdev->flags); + mutex_unlock(&rtwdev->mutex); +} + +static int rtw_ops_hw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif, + struct ieee80211_scan_request *req) +{ + struct rtw_dev *rtwdev = hw->priv; + int ret; + + if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD)) + return 1; + + if (test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + return -EBUSY; + + mutex_lock(&rtwdev->mutex); + rtw_hw_scan_start(rtwdev, vif, req); + ret = rtw_hw_scan_offload(rtwdev, vif, true); + if (ret) { + rtw_hw_scan_abort(rtwdev); + rtw_err(rtwdev, "HW scan failed with status: %d\n", ret); + } + mutex_unlock(&rtwdev->mutex); + + return ret; +} + +static void rtw_ops_cancel_hw_scan(struct ieee80211_hw *hw, + struct ieee80211_vif *vif) +{ + struct rtw_dev *rtwdev = hw->priv; + + if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD)) + return; + + if (!test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + return; + + mutex_lock(&rtwdev->mutex); + rtw_hw_scan_abort(rtwdev); + mutex_unlock(&rtwdev->mutex); +} + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) +static int rtw_ops_set_sar_specs(struct ieee80211_hw *hw, + const struct cfg80211_sar_specs *sar) +{ + struct rtw_dev *rtwdev = hw->priv; + + mutex_lock(&rtwdev->mutex); + rtw_set_sar_specs(rtwdev, sar); + mutex_unlock(&rtwdev->mutex); + + return 0; +} +#endif + +static void rtw_ops_sta_rc_update(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + struct ieee80211_sta *sta, u32 changed) +{ + struct rtw_dev *rtwdev = hw->priv; + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + + if (changed & IEEE80211_RC_BW_CHANGED) + ieee80211_queue_work(rtwdev->hw, &si->rc_work); +} + +const struct ieee80211_ops rtw_ops = { + .tx = rtw_ops_tx, + .wake_tx_queue = rtw_ops_wake_tx_queue, + .start = rtw_ops_start, + .stop = rtw_ops_stop, + .config = rtw_ops_config, + .add_interface = rtw_ops_add_interface, + .remove_interface = rtw_ops_remove_interface, + .change_interface = rtw_ops_change_interface, + .configure_filter = rtw_ops_configure_filter, + .bss_info_changed = rtw_ops_bss_info_changed, + .start_ap = rtw_ops_start_ap, + .stop_ap = rtw_ops_stop_ap, + .conf_tx = rtw_ops_conf_tx, + .sta_add = rtw_ops_sta_add, + .sta_remove = rtw_ops_sta_remove, + .set_tim = rtw_ops_set_tim, + .set_key = rtw_ops_set_key, + .ampdu_action = rtw_ops_ampdu_action, +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 20, 0) + .can_aggregate_in_amsdu = rtw_ops_can_aggregate_in_amsdu, +#endif + .sw_scan_start = rtw_ops_sw_scan_start, + .sw_scan_complete = rtw_ops_sw_scan_complete, + .mgd_prepare_tx = rtw_ops_mgd_prepare_tx, + .set_rts_threshold = rtw_ops_set_rts_threshold, + .sta_statistics = rtw_ops_sta_statistics, + .flush = rtw_ops_flush, + .set_bitrate_mask = rtw_ops_set_bitrate_mask, + .set_antenna = rtw_ops_set_antenna, + .get_antenna = rtw_ops_get_antenna, + .reconfig_complete = rtw_reconfig_complete, + .hw_scan = rtw_ops_hw_scan, + .cancel_hw_scan = rtw_ops_cancel_hw_scan, + .sta_rc_update = rtw_ops_sta_rc_update, +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) + .set_sar_specs = rtw_ops_set_sar_specs, +#endif +#ifdef CONFIG_PM + .suspend = rtw_ops_suspend, + .resume = rtw_ops_resume, + .set_wakeup = rtw_ops_set_wakeup, +#endif +}; +EXPORT_SYMBOL(rtw_ops); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/main.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/main.c new file mode 100644 index 0000000000000000000000000000000000000000..f58902994a35f2e9d40e9d62ec746fd5582673f8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/main.c @@ -0,0 +1,2550 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include + +#include "main.h" +#include "regd.h" +#include "fw.h" +#include "ps.h" +#include "sec.h" +#include "mac.h" +#include "coex.h" +#include "phy.h" +#include "reg.h" +#include "efuse.h" +#include "tx.h" +#include "debug.h" +#include "bf.h" +#include "sar.h" +#include "sdio.h" + +bool rtw_disable_lps_deep_mode; +EXPORT_SYMBOL(rtw_disable_lps_deep_mode); +bool rtw_bf_support = true; +unsigned int rtw_debug_mask; +EXPORT_SYMBOL(rtw_debug_mask); +/* EDCCA is enabled during normal behavior. For debugging purpose in + * a noisy environment, it can be disabled via edcca debugfs. Because + * all rtw88 devices will probably be affected if environment is noisy, + * rtw_edcca_enabled is just declared by driver instead of by device. + * So, turning it off will take effect for all rtw88 devices before + * there is a tough reason to maintain rtw_edcca_enabled by device. + */ +bool rtw_edcca_enabled = true; + +module_param_named(disable_lps_deep, rtw_disable_lps_deep_mode, bool, 0644); +module_param_named(support_bf, rtw_bf_support, bool, 0644); +module_param_named(debug_mask, rtw_debug_mask, uint, 0644); + +MODULE_PARM_DESC(disable_lps_deep, "Set Y to disable Deep PS"); +MODULE_PARM_DESC(support_bf, "Set Y to enable beamformee support"); +MODULE_PARM_DESC(debug_mask, "Debugging mask"); + +static struct ieee80211_channel rtw_channeltable_2g[] = { + {.center_freq = 2412, .hw_value = 1,}, + {.center_freq = 2417, .hw_value = 2,}, + {.center_freq = 2422, .hw_value = 3,}, + {.center_freq = 2427, .hw_value = 4,}, + {.center_freq = 2432, .hw_value = 5,}, + {.center_freq = 2437, .hw_value = 6,}, + {.center_freq = 2442, .hw_value = 7,}, + {.center_freq = 2447, .hw_value = 8,}, + {.center_freq = 2452, .hw_value = 9,}, + {.center_freq = 2457, .hw_value = 10,}, + {.center_freq = 2462, .hw_value = 11,}, + {.center_freq = 2467, .hw_value = 12,}, + {.center_freq = 2472, .hw_value = 13,}, + {.center_freq = 2484, .hw_value = 14,}, +}; + +static struct ieee80211_channel rtw_channeltable_5g[] = { + {.center_freq = 5180, .hw_value = 36,}, + {.center_freq = 5200, .hw_value = 40,}, + {.center_freq = 5220, .hw_value = 44,}, + {.center_freq = 5240, .hw_value = 48,}, + {.center_freq = 5260, .hw_value = 52,}, + {.center_freq = 5280, .hw_value = 56,}, + {.center_freq = 5300, .hw_value = 60,}, + {.center_freq = 5320, .hw_value = 64,}, + {.center_freq = 5500, .hw_value = 100,}, + {.center_freq = 5520, .hw_value = 104,}, + {.center_freq = 5540, .hw_value = 108,}, + {.center_freq = 5560, .hw_value = 112,}, + {.center_freq = 5580, .hw_value = 116,}, + {.center_freq = 5600, .hw_value = 120,}, + {.center_freq = 5620, .hw_value = 124,}, + {.center_freq = 5640, .hw_value = 128,}, + {.center_freq = 5660, .hw_value = 132,}, + {.center_freq = 5680, .hw_value = 136,}, + {.center_freq = 5700, .hw_value = 140,}, + {.center_freq = 5720, .hw_value = 144,}, + {.center_freq = 5745, .hw_value = 149,}, + {.center_freq = 5765, .hw_value = 153,}, + {.center_freq = 5785, .hw_value = 157,}, + {.center_freq = 5805, .hw_value = 161,}, + {.center_freq = 5825, .hw_value = 165, + .flags = IEEE80211_CHAN_NO_HT40MINUS}, +}; + +static struct ieee80211_rate rtw_ratetable[] = { + {.bitrate = 10, .hw_value = 0x00,}, + {.bitrate = 20, .hw_value = 0x01,}, + {.bitrate = 55, .hw_value = 0x02,}, + {.bitrate = 110, .hw_value = 0x03,}, + {.bitrate = 60, .hw_value = 0x04,}, + {.bitrate = 90, .hw_value = 0x05,}, + {.bitrate = 120, .hw_value = 0x06,}, + {.bitrate = 180, .hw_value = 0x07,}, + {.bitrate = 240, .hw_value = 0x08,}, + {.bitrate = 360, .hw_value = 0x09,}, + {.bitrate = 480, .hw_value = 0x0a,}, + {.bitrate = 540, .hw_value = 0x0b,}, +}; + +static const struct ieee80211_iface_limit rtw_iface_limits[] = { + { + .max = 1, + .types = BIT(NL80211_IFTYPE_STATION), + }, + { + .max = 1, + .types = BIT(NL80211_IFTYPE_AP), + } +}; + +static const struct ieee80211_iface_combination rtw_iface_combs[] = { + { + .limits = rtw_iface_limits, + .n_limits = ARRAY_SIZE(rtw_iface_limits), + .max_interfaces = 2, + .num_different_channels = 1, + } +}; + +u16 rtw_desc_to_bitrate(u8 desc_rate) +{ + struct ieee80211_rate rate; + + if (WARN(desc_rate >= ARRAY_SIZE(rtw_ratetable), "invalid desc rate\n")) + return 0; + + rate = rtw_ratetable[desc_rate]; + + return rate.bitrate; +} + +static struct ieee80211_supported_band rtw_band_2ghz = { + .band = NL80211_BAND_2GHZ, + + .channels = rtw_channeltable_2g, + .n_channels = ARRAY_SIZE(rtw_channeltable_2g), + + .bitrates = rtw_ratetable, + .n_bitrates = ARRAY_SIZE(rtw_ratetable), + + .ht_cap = {0}, + .vht_cap = {0}, +}; + +static struct ieee80211_supported_band rtw_band_5ghz = { + .band = NL80211_BAND_5GHZ, + + .channels = rtw_channeltable_5g, + .n_channels = ARRAY_SIZE(rtw_channeltable_5g), + + /* 5G has no CCK rates */ + .bitrates = rtw_ratetable + 4, + .n_bitrates = ARRAY_SIZE(rtw_ratetable) - 4, + + .ht_cap = {0}, + .vht_cap = {0}, +}; + +struct rtw_watch_dog_iter_data { + struct rtw_dev *rtwdev; + struct rtw_vif *rtwvif; +}; + +static void rtw_dynamic_csi_rate(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif) +{ + struct rtw_bf_info *bf_info = &rtwdev->bf_info; + u8 fix_rate_enable = 0; + u8 new_csi_rate_idx; + + if (rtwvif->bfee.role != RTW_BFEE_SU && + rtwvif->bfee.role != RTW_BFEE_MU) + return; + + rtw_chip_cfg_csi_rate(rtwdev, rtwdev->dm_info.min_rssi, + bf_info->cur_csi_rpt_rate, + fix_rate_enable, &new_csi_rate_idx); + + if (new_csi_rate_idx != bf_info->cur_csi_rpt_rate) + bf_info->cur_csi_rpt_rate = new_csi_rate_idx; +} + +static void rtw_vif_watch_dog_iter(void *data, struct ieee80211_vif *vif) +{ + struct rtw_watch_dog_iter_data *iter_data = data; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + + if (vif->type == NL80211_IFTYPE_STATION) +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) + if (vif->cfg.assoc) +#else + if (vif->bss_conf.assoc) +#endif + iter_data->rtwvif = rtwvif; + + rtw_dynamic_csi_rate(iter_data->rtwdev, rtwvif); + + rtwvif->stats.tx_unicast = 0; + rtwvif->stats.rx_unicast = 0; + rtwvif->stats.tx_cnt = 0; + rtwvif->stats.rx_cnt = 0; +} + +/* process TX/RX statistics periodically for hardware, + * the information helps hardware to enhance performance + */ +static void rtw_watch_dog_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + watch_dog_work.work); + struct rtw_traffic_stats *stats = &rtwdev->stats; + struct rtw_watch_dog_iter_data data = {}; + bool busy_traffic = test_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags); + bool ps_active; + + mutex_lock(&rtwdev->mutex); + + if (!test_bit(RTW_FLAG_RUNNING, rtwdev->flags)) + goto unlock; + + ieee80211_queue_delayed_work(rtwdev->hw, &rtwdev->watch_dog_work, + RTW_WATCH_DOG_DELAY_TIME); + + if (rtwdev->stats.tx_cnt > 100 || rtwdev->stats.rx_cnt > 100) + set_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags); + else + clear_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags); + + rtw_coex_wl_status_check(rtwdev); + rtw_coex_query_bt_hid_list(rtwdev); + + if (busy_traffic != test_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags)) + rtw_coex_wl_status_change_notify(rtwdev, 0); + + if (stats->tx_cnt > RTW_LPS_THRESHOLD || + stats->rx_cnt > RTW_LPS_THRESHOLD) + ps_active = true; + else + ps_active = false; + + ewma_tp_add(&stats->tx_ewma_tp, + (u32)(stats->tx_unicast >> RTW_TP_SHIFT)); + ewma_tp_add(&stats->rx_ewma_tp, + (u32)(stats->rx_unicast >> RTW_TP_SHIFT)); + stats->tx_throughput = ewma_tp_read(&stats->tx_ewma_tp); + stats->rx_throughput = ewma_tp_read(&stats->rx_ewma_tp); + + /* reset tx/rx statictics */ + stats->tx_unicast = 0; + stats->rx_unicast = 0; + stats->tx_cnt = 0; + stats->rx_cnt = 0; + + if (test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + goto unlock; + + /* make sure BB/RF is working for dynamic mech */ + rtw_leave_lps(rtwdev); + + rtw_phy_dynamic_mechanism(rtwdev); + + data.rtwdev = rtwdev; + /* rtw_iterate_vifs internally uses an atomic iterator which is needed + * to avoid taking local->iflist_mtx mutex + */ + rtw_iterate_vifs(rtwdev, rtw_vif_watch_dog_iter, &data); + + /* fw supports only one station associated to enter lps, if there are + * more than two stations associated to the AP, then we can not enter + * lps, because fw does not handle the overlapped beacon interval + * + * rtw_recalc_lps() iterate vifs and determine if driver can enter + * ps by vif->type and vif->cfg.ps, all we need to do here is to + * get that vif and check if device is having traffic more than the + * threshold. + */ + if (rtwdev->ps_enabled && data.rtwvif && !ps_active && + !rtwdev->beacon_loss && !rtwdev->ap_active) + rtw_enter_lps(rtwdev, data.rtwvif->port); + + rtwdev->watch_dog_cnt++; + +unlock: + mutex_unlock(&rtwdev->mutex); +} + +static void rtw_c2h_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, c2h_work); + struct sk_buff *skb, *tmp; + + skb_queue_walk_safe(&rtwdev->c2h_queue, skb, tmp) { + skb_unlink(skb, &rtwdev->c2h_queue); + rtw_fw_c2h_cmd_handle(rtwdev, skb); + dev_kfree_skb_any(skb); + } +} + +static void rtw_ips_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, ips_work); + + mutex_lock(&rtwdev->mutex); + if (rtwdev->hw->conf.flags & IEEE80211_CONF_IDLE) + rtw_enter_ips(rtwdev); + mutex_unlock(&rtwdev->mutex); +} + +static u8 rtw_acquire_macid(struct rtw_dev *rtwdev) +{ + unsigned long mac_id; + + mac_id = find_first_zero_bit(rtwdev->mac_id_map, RTW_MAX_MAC_ID_NUM); + if (mac_id < RTW_MAX_MAC_ID_NUM) + set_bit(mac_id, rtwdev->mac_id_map); + + return mac_id; +} + +static void rtw_sta_rc_work(struct work_struct *work) +{ + struct rtw_sta_info *si = container_of(work, struct rtw_sta_info, + rc_work); + struct rtw_dev *rtwdev = si->rtwdev; + + mutex_lock(&rtwdev->mutex); + rtw_update_sta_info(rtwdev, si, true); + mutex_unlock(&rtwdev->mutex); +} + +int rtw_sta_add(struct rtw_dev *rtwdev, struct ieee80211_sta *sta, + struct ieee80211_vif *vif) +{ + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + int i; + + si->mac_id = rtw_acquire_macid(rtwdev); + if (si->mac_id >= RTW_MAX_MAC_ID_NUM) + return -ENOSPC; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) + if (vif->type == NL80211_IFTYPE_STATION && vif->cfg.assoc == 0) +#else + if (vif->type == NL80211_IFTYPE_STATION && vif->bss_conf.assoc == 0) +#endif + rtwvif->mac_id = si->mac_id; + si->rtwdev = rtwdev; + si->sta = sta; + si->vif = vif; + si->init_ra_lv = 1; + ewma_rssi_init(&si->avg_rssi); + for (i = 0; i < ARRAY_SIZE(sta->txq); i++) + rtw_txq_init(rtwdev, sta->txq[i]); + INIT_WORK(&si->rc_work, rtw_sta_rc_work); + + rtw_update_sta_info(rtwdev, si, true); + rtw_fw_media_status_report(rtwdev, si->mac_id, true); + + rtwdev->sta_cnt++; + rtwdev->beacon_loss = false; + rtw_dbg(rtwdev, RTW_DBG_STATE, "sta %pM joined with macid %d\n", + sta->addr, si->mac_id); + + return 0; +} + +void rtw_sta_remove(struct rtw_dev *rtwdev, struct ieee80211_sta *sta, + bool fw_exist) +{ + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + int i; + + cancel_work_sync(&si->rc_work); + + rtw_release_macid(rtwdev, si->mac_id); + if (fw_exist) + rtw_fw_media_status_report(rtwdev, si->mac_id, false); + + for (i = 0; i < ARRAY_SIZE(sta->txq); i++) + rtw_txq_cleanup(rtwdev, sta->txq[i]); + + kfree(si->mask); + + rtwdev->sta_cnt--; + rtw_dbg(rtwdev, RTW_DBG_STATE, "sta %pM with macid %d left\n", + sta->addr, si->mac_id); +} + +struct rtw_fwcd_hdr { + u32 item; + u32 size; + u32 padding1; + u32 padding2; +} __packed; + +static int rtw_fwcd_prep(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_fwcd_desc *desc = &rtwdev->fw.fwcd_desc; + const struct rtw_fwcd_segs *segs = chip->fwcd_segs; + u32 prep_size = chip->fw_rxff_size + sizeof(struct rtw_fwcd_hdr); + u8 i; + + if (segs) { + prep_size += segs->num * sizeof(struct rtw_fwcd_hdr); + + for (i = 0; i < segs->num; i++) + prep_size += segs->segs[i]; + } + + desc->data = vmalloc(prep_size); + if (!desc->data) + return -ENOMEM; + + desc->size = prep_size; + desc->next = desc->data; + + return 0; +} + +static u8 *rtw_fwcd_next(struct rtw_dev *rtwdev, u32 item, u32 size) +{ + struct rtw_fwcd_desc *desc = &rtwdev->fw.fwcd_desc; + struct rtw_fwcd_hdr *hdr; + u8 *next; + + if (!desc->data) { + rtw_dbg(rtwdev, RTW_DBG_FW, "fwcd isn't prepared successfully\n"); + return NULL; + } + + next = desc->next + sizeof(struct rtw_fwcd_hdr); + if (next - desc->data + size > desc->size) { + rtw_dbg(rtwdev, RTW_DBG_FW, "fwcd isn't prepared enough\n"); + return NULL; + } + + hdr = (struct rtw_fwcd_hdr *)(desc->next); + hdr->item = item; + hdr->size = size; + hdr->padding1 = 0x01234567; + hdr->padding2 = 0x89abcdef; + desc->next = next + size; + + return next; +} + +static void rtw_fwcd_dump(struct rtw_dev *rtwdev) +{ + struct rtw_fwcd_desc *desc = &rtwdev->fw.fwcd_desc; + + rtw_dbg(rtwdev, RTW_DBG_FW, "dump fwcd\n"); + + /* Data will be freed after lifetime of device coredump. After calling + * dev_coredump, data is supposed to be handled by the device coredump + * framework. Note that a new dump will be discarded if a previous one + * hasn't been released yet. + */ + dev_coredumpv(rtwdev->dev, desc->data, desc->size, GFP_KERNEL); +} + +static void rtw_fwcd_free(struct rtw_dev *rtwdev, bool free_self) +{ + struct rtw_fwcd_desc *desc = &rtwdev->fw.fwcd_desc; + + if (free_self) { + rtw_dbg(rtwdev, RTW_DBG_FW, "free fwcd by self\n"); + vfree(desc->data); + } + + desc->data = NULL; + desc->next = NULL; +} + +static int rtw_fw_dump_crash_log(struct rtw_dev *rtwdev) +{ + u32 size = rtwdev->chip->fw_rxff_size; + u32 *buf; + u8 seq; + + buf = (u32 *)rtw_fwcd_next(rtwdev, RTW_FWCD_TLV, size); + if (!buf) + return -ENOMEM; + + if (rtw_fw_dump_fifo(rtwdev, RTW_FW_FIFO_SEL_RXBUF_FW, 0, size, buf)) { + rtw_dbg(rtwdev, RTW_DBG_FW, "dump fw fifo fail\n"); + return -EINVAL; + } + + if (GET_FW_DUMP_LEN(buf) == 0) { + rtw_dbg(rtwdev, RTW_DBG_FW, "fw crash dump's length is 0\n"); + return -EINVAL; + } + + seq = GET_FW_DUMP_SEQ(buf); + if (seq > 0) { + rtw_dbg(rtwdev, RTW_DBG_FW, + "fw crash dump's seq is wrong: %d\n", seq); + return -EINVAL; + } + + return 0; +} + +int rtw_dump_fw(struct rtw_dev *rtwdev, const u32 ocp_src, u32 size, + u32 fwcd_item) +{ + u32 rxff = rtwdev->chip->fw_rxff_size; + u32 dump_size, done_size = 0; + u8 *buf; + int ret; + + buf = rtw_fwcd_next(rtwdev, fwcd_item, size); + if (!buf) + return -ENOMEM; + + while (size) { + dump_size = size > rxff ? rxff : size; + + ret = rtw_ddma_to_fw_fifo(rtwdev, ocp_src + done_size, + dump_size); + if (ret) { + rtw_err(rtwdev, + "ddma fw 0x%x [+0x%x] to fw fifo fail\n", + ocp_src, done_size); + return ret; + } + + ret = rtw_fw_dump_fifo(rtwdev, RTW_FW_FIFO_SEL_RXBUF_FW, 0, + dump_size, (u32 *)(buf + done_size)); + if (ret) { + rtw_err(rtwdev, + "dump fw 0x%x [+0x%x] from fw fifo fail\n", + ocp_src, done_size); + return ret; + } + + size -= dump_size; + done_size += dump_size; + } + + return 0; +} +EXPORT_SYMBOL(rtw_dump_fw); + +int rtw_dump_reg(struct rtw_dev *rtwdev, const u32 addr, const u32 size) +{ + u8 *buf; + u32 i; + + if (addr & 0x3) { + WARN(1, "should be 4-byte aligned, addr = 0x%08x\n", addr); + return -EINVAL; + } + + buf = rtw_fwcd_next(rtwdev, RTW_FWCD_REG, size); + if (!buf) + return -ENOMEM; + + for (i = 0; i < size; i += 4) + *(u32 *)(buf + i) = rtw_read32(rtwdev, addr + i); + + return 0; +} +EXPORT_SYMBOL(rtw_dump_reg); + +void rtw_vif_assoc_changed(struct rtw_vif *rtwvif, + struct ieee80211_bss_conf *conf) +{ +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) + struct ieee80211_vif *vif = NULL; + + if (conf) + vif = container_of(conf, struct ieee80211_vif, bss_conf); + + if (conf && vif->cfg.assoc) { + rtwvif->aid = vif->cfg.aid; +#else + if (conf && conf->assoc) { + rtwvif->aid = conf->aid; +#endif + rtwvif->net_type = RTW_NET_MGD_LINKED; + } else { + rtwvif->aid = 0; + rtwvif->net_type = RTW_NET_NO_LINK; + } +} + +static void rtw_reset_key_iter(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + struct ieee80211_sta *sta, + struct ieee80211_key_conf *key, + void *data) +{ + struct rtw_dev *rtwdev = (struct rtw_dev *)data; + struct rtw_sec_desc *sec = &rtwdev->sec; + + rtw_sec_clear_cam(rtwdev, sec, key->hw_key_idx); +} + +static void rtw_reset_sta_iter(void *data, struct ieee80211_sta *sta) +{ + struct rtw_dev *rtwdev = (struct rtw_dev *)data; + + if (rtwdev->sta_cnt == 0) { + rtw_warn(rtwdev, "sta count before reset should not be 0\n"); + return; + } + rtw_sta_remove(rtwdev, sta, false); +} + +static void rtw_reset_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif) +{ + struct rtw_dev *rtwdev = (struct rtw_dev *)data; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + + rtw_bf_disassoc(rtwdev, vif, NULL); + rtw_vif_assoc_changed(rtwvif, NULL); + rtw_txq_cleanup(rtwdev, vif->txq); +} + +void rtw_fw_recovery(struct rtw_dev *rtwdev) +{ + if (!test_bit(RTW_FLAG_RESTARTING, rtwdev->flags)) + ieee80211_queue_work(rtwdev->hw, &rtwdev->fw_recovery_work); +} + +static void __fw_recovery_work(struct rtw_dev *rtwdev) +{ + int ret = 0; + + set_bit(RTW_FLAG_RESTARTING, rtwdev->flags); + clear_bit(RTW_FLAG_RESTART_TRIGGERING, rtwdev->flags); + + ret = rtw_fwcd_prep(rtwdev); + if (ret) + goto free; + ret = rtw_fw_dump_crash_log(rtwdev); + if (ret) + goto free; + ret = rtw_chip_dump_fw_crash(rtwdev); + if (ret) + goto free; + + rtw_fwcd_dump(rtwdev); +free: + rtw_fwcd_free(rtwdev, !!ret); + rtw_write8(rtwdev, REG_MCU_TST_CFG, 0); + + WARN(1, "firmware crash, start reset and recover\n"); + + rcu_read_lock(); + rtw_iterate_keys_rcu(rtwdev, NULL, rtw_reset_key_iter, rtwdev); + rcu_read_unlock(); + rtw_iterate_stas_atomic(rtwdev, rtw_reset_sta_iter, rtwdev); + rtw_iterate_vifs_atomic(rtwdev, rtw_reset_vif_iter, rtwdev); + bitmap_zero(rtwdev->hw_port, RTW_PORT_NUM); + rtw_enter_ips(rtwdev); +} + +static void rtw_fw_recovery_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, + fw_recovery_work); + + mutex_lock(&rtwdev->mutex); + __fw_recovery_work(rtwdev); + mutex_unlock(&rtwdev->mutex); + + ieee80211_restart_hw(rtwdev->hw); +} + +struct rtw_txq_ba_iter_data { +}; + +static void rtw_txq_ba_iter(void *data, struct ieee80211_sta *sta) +{ + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + int ret; + u8 tid; + + tid = find_first_bit(si->tid_ba, IEEE80211_NUM_TIDS); + while (tid != IEEE80211_NUM_TIDS) { + clear_bit(tid, si->tid_ba); + ret = ieee80211_start_tx_ba_session(sta, tid, 0); + if (ret == -EINVAL) { + struct ieee80211_txq *txq; + struct rtw_txq *rtwtxq; + + txq = sta->txq[tid]; + rtwtxq = (struct rtw_txq *)txq->drv_priv; + set_bit(RTW_TXQ_BLOCK_BA, &rtwtxq->flags); + } + + tid = find_first_bit(si->tid_ba, IEEE80211_NUM_TIDS); + } +} + +static void rtw_txq_ba_work(struct work_struct *work) +{ + struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, ba_work); + struct rtw_txq_ba_iter_data data; + + rtw_iterate_stas_atomic(rtwdev, rtw_txq_ba_iter, &data); +} + +void rtw_set_rx_freq_band(struct rtw_rx_pkt_stat *pkt_stat, u8 channel) +{ + if (IS_CH_2G_BAND(channel)) + pkt_stat->band = NL80211_BAND_2GHZ; + else if (IS_CH_5G_BAND(channel)) + pkt_stat->band = NL80211_BAND_5GHZ; + else + return; + + pkt_stat->freq = ieee80211_channel_to_frequency(channel, pkt_stat->band); +} +EXPORT_SYMBOL(rtw_set_rx_freq_band); + +void rtw_set_dtim_period(struct rtw_dev *rtwdev, int dtim_period) +{ + rtw_write32_set(rtwdev, REG_TCR, BIT_TCR_UPDATE_TIMIE); + rtw_write8(rtwdev, REG_DTIM_COUNTER_ROOT, dtim_period - 1); +} + +void rtw_update_channel(struct rtw_dev *rtwdev, u8 center_channel, + u8 primary_channel, enum rtw_supported_band band, + enum rtw_bandwidth bandwidth) +{ + enum nl80211_band nl_band = rtw_hw_to_nl80211_band(band); + struct rtw_hal *hal = &rtwdev->hal; + u8 *cch_by_bw = hal->cch_by_bw; + u32 center_freq, primary_freq; + enum rtw_sar_bands sar_band; + u8 primary_channel_idx; + + center_freq = ieee80211_channel_to_frequency(center_channel, nl_band); + primary_freq = ieee80211_channel_to_frequency(primary_channel, nl_band); + + /* assign the center channel used while 20M bw is selected */ + cch_by_bw[RTW_CHANNEL_WIDTH_20] = primary_channel; + + /* assign the center channel used while current bw is selected */ + cch_by_bw[bandwidth] = center_channel; + + switch (bandwidth) { + case RTW_CHANNEL_WIDTH_20: + default: + primary_channel_idx = RTW_SC_DONT_CARE; + break; + case RTW_CHANNEL_WIDTH_40: + if (primary_freq > center_freq) + primary_channel_idx = RTW_SC_20_UPPER; + else + primary_channel_idx = RTW_SC_20_LOWER; + break; + case RTW_CHANNEL_WIDTH_80: + if (primary_freq > center_freq) { + if (primary_freq - center_freq == 10) + primary_channel_idx = RTW_SC_20_UPPER; + else + primary_channel_idx = RTW_SC_20_UPMOST; + + /* assign the center channel used + * while 40M bw is selected + */ + cch_by_bw[RTW_CHANNEL_WIDTH_40] = center_channel + 4; + } else { + if (center_freq - primary_freq == 10) + primary_channel_idx = RTW_SC_20_LOWER; + else + primary_channel_idx = RTW_SC_20_LOWEST; + + /* assign the center channel used + * while 40M bw is selected + */ + cch_by_bw[RTW_CHANNEL_WIDTH_40] = center_channel - 4; + } + break; + } + + switch (center_channel) { + case 1 ... 14: + sar_band = RTW_SAR_BAND_0; + break; + case 36 ... 64: + sar_band = RTW_SAR_BAND_1; + break; + case 100 ... 144: + sar_band = RTW_SAR_BAND_3; + break; + case 149 ... 177: + sar_band = RTW_SAR_BAND_4; + break; + default: + WARN(1, "unknown ch(%u) to SAR band\n", center_channel); + sar_band = RTW_SAR_BAND_0; + break; + } + + hal->current_primary_channel_index = primary_channel_idx; + hal->current_band_width = bandwidth; + hal->primary_channel = primary_channel; + hal->current_channel = center_channel; + hal->current_band_type = band; + hal->sar_band = sar_band; +} + +void rtw_get_channel_params(struct cfg80211_chan_def *chandef, + struct rtw_channel_params *chan_params) +{ + struct ieee80211_channel *channel = chandef->chan; + enum nl80211_chan_width width = chandef->width; + u32 primary_freq, center_freq; + u8 center_chan; + u8 bandwidth = RTW_CHANNEL_WIDTH_20; + + center_chan = channel->hw_value; + primary_freq = channel->center_freq; + center_freq = chandef->center_freq1; + + switch (width) { + case NL80211_CHAN_WIDTH_20_NOHT: + case NL80211_CHAN_WIDTH_20: + bandwidth = RTW_CHANNEL_WIDTH_20; + break; + case NL80211_CHAN_WIDTH_40: + bandwidth = RTW_CHANNEL_WIDTH_40; + if (primary_freq > center_freq) + center_chan -= 2; + else + center_chan += 2; + break; + case NL80211_CHAN_WIDTH_80: + bandwidth = RTW_CHANNEL_WIDTH_80; + if (primary_freq > center_freq) { + if (primary_freq - center_freq == 10) + center_chan -= 2; + else + center_chan -= 6; + } else { + if (center_freq - primary_freq == 10) + center_chan += 2; + else + center_chan += 6; + } + break; + default: + center_chan = 0; + break; + } + + chan_params->center_chan = center_chan; + chan_params->bandwidth = bandwidth; + chan_params->primary_chan = channel->hw_value; +} + +void rtw_set_channel(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct ieee80211_hw *hw = rtwdev->hw; + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_channel_params ch_param; + u8 center_chan, primary_chan, bandwidth, band; + + rtw_get_channel_params(&hw->conf.chandef, &ch_param); + if (WARN(ch_param.center_chan == 0, "Invalid channel\n")) + return; + + center_chan = ch_param.center_chan; + primary_chan = ch_param.primary_chan; + bandwidth = ch_param.bandwidth; + band = ch_param.center_chan > 14 ? RTW_BAND_5G : RTW_BAND_2G; + + rtw_update_channel(rtwdev, center_chan, primary_chan, band, bandwidth); + + if (rtwdev->scan_info.op_chan) + rtw_store_op_chan(rtwdev, true); + + chip->ops->set_channel(rtwdev, center_chan, bandwidth, + hal->current_primary_channel_index); + + if (hal->current_band_type == RTW_BAND_5G) { + rtw_coex_switchband_notify(rtwdev, COEX_SWITCH_TO_5G); + } else { + if (test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + rtw_coex_switchband_notify(rtwdev, COEX_SWITCH_TO_24G); + else + rtw_coex_switchband_notify(rtwdev, COEX_SWITCH_TO_24G_NOFORSCAN); + } + + rtw_phy_set_tx_power_level(rtwdev, center_chan); + + /* if the channel isn't set for scanning, we will do RF calibration + * in ieee80211_ops::mgd_prepare_tx(). Performing the calibration + * during scanning on each channel takes too long. + */ + if (!test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + rtwdev->need_rfk = true; +} + +void rtw_chip_prepare_tx(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + if (rtwdev->need_rfk) { + rtwdev->need_rfk = false; + chip->ops->phy_calibration(rtwdev); + } +} + +static void rtw_vif_write_addr(struct rtw_dev *rtwdev, u32 start, u8 *addr) +{ + int i; + + for (i = 0; i < ETH_ALEN; i++) + rtw_write8(rtwdev, start + i, addr[i]); +} + +void rtw_vif_port_config(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif, + u32 config) +{ + u32 addr, mask; + + if (config & PORT_SET_MAC_ADDR) { + addr = rtwvif->conf->mac_addr.addr; + rtw_vif_write_addr(rtwdev, addr, rtwvif->mac_addr); + } + if (config & PORT_SET_BSSID) { + addr = rtwvif->conf->bssid.addr; + rtw_vif_write_addr(rtwdev, addr, rtwvif->bssid); + } + if (config & PORT_SET_NET_TYPE) { + addr = rtwvif->conf->net_type.addr; + mask = rtwvif->conf->net_type.mask; + rtw_write32_mask(rtwdev, addr, mask, rtwvif->net_type); + } + if (config & PORT_SET_AID) { + addr = rtwvif->conf->aid.addr; + mask = rtwvif->conf->aid.mask; + rtw_write32_mask(rtwdev, addr, mask, rtwvif->aid); + } + if (config & PORT_SET_BCN_CTRL) { + addr = rtwvif->conf->bcn_ctrl.addr; + mask = rtwvif->conf->bcn_ctrl.mask; + rtw_write8_mask(rtwdev, addr, mask, rtwvif->bcn_ctrl); + } +} + +static u8 hw_bw_cap_to_bitamp(u8 bw_cap) +{ + u8 bw = 0; + + switch (bw_cap) { + case EFUSE_HW_CAP_IGNORE: + case EFUSE_HW_CAP_SUPP_BW80: + bw |= BIT(RTW_CHANNEL_WIDTH_80); + fallthrough; + case EFUSE_HW_CAP_SUPP_BW40: + bw |= BIT(RTW_CHANNEL_WIDTH_40); + fallthrough; + default: + bw |= BIT(RTW_CHANNEL_WIDTH_20); + break; + } + + return bw; +} + +static void rtw_hw_config_rf_ant_num(struct rtw_dev *rtwdev, u8 hw_ant_num) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_hal *hal = &rtwdev->hal; + + if (hw_ant_num == EFUSE_HW_CAP_IGNORE || + hw_ant_num >= hal->rf_path_num) + return; + + switch (hw_ant_num) { + case 1: + hal->rf_type = RF_1T1R; + hal->rf_path_num = 1; + if (!chip->fix_rf_phy_num) + hal->rf_phy_num = hal->rf_path_num; + hal->antenna_tx = BB_PATH_A; + hal->antenna_rx = BB_PATH_A; + break; + default: + WARN(1, "invalid hw configuration from efuse\n"); + break; + } +} + +static u64 get_vht_ra_mask(struct ieee80211_sta *sta) +{ + u64 ra_mask = 0; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + u16 mcs_map = le16_to_cpu(sta->deflink.vht_cap.vht_mcs.rx_mcs_map); +#else + u16 mcs_map = le16_to_cpu(sta->vht_cap.vht_mcs.rx_mcs_map); +#endif + u8 vht_mcs_cap; + int i, nss; + + /* 4SS, every two bits for MCS7/8/9 */ + for (i = 0, nss = 12; i < 4; i++, mcs_map >>= 2, nss += 10) { + vht_mcs_cap = mcs_map & 0x3; + switch (vht_mcs_cap) { + case 2: /* MCS9 */ + ra_mask |= 0x3ffULL << nss; + break; + case 1: /* MCS8 */ + ra_mask |= 0x1ffULL << nss; + break; + case 0: /* MCS7 */ + ra_mask |= 0x0ffULL << nss; + break; + default: + break; + } + } + + return ra_mask; +} + +static u8 get_rate_id(u8 wireless_set, enum rtw_bandwidth bw_mode, u8 tx_num) +{ + u8 rate_id = 0; + + switch (wireless_set) { + case WIRELESS_CCK: + rate_id = RTW_RATEID_B_20M; + break; + case WIRELESS_OFDM: + rate_id = RTW_RATEID_G; + break; + case WIRELESS_CCK | WIRELESS_OFDM: + rate_id = RTW_RATEID_BG; + break; + case WIRELESS_OFDM | WIRELESS_HT: + if (tx_num == 1) + rate_id = RTW_RATEID_GN_N1SS; + else if (tx_num == 2) + rate_id = RTW_RATEID_GN_N2SS; + else if (tx_num == 3) + rate_id = RTW_RATEID_ARFR5_N_3SS; + break; + case WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_HT: + if (bw_mode == RTW_CHANNEL_WIDTH_40) { + if (tx_num == 1) + rate_id = RTW_RATEID_BGN_40M_1SS; + else if (tx_num == 2) + rate_id = RTW_RATEID_BGN_40M_2SS; + else if (tx_num == 3) + rate_id = RTW_RATEID_ARFR5_N_3SS; + else if (tx_num == 4) + rate_id = RTW_RATEID_ARFR7_N_4SS; + } else { + if (tx_num == 1) + rate_id = RTW_RATEID_BGN_20M_1SS; + else if (tx_num == 2) + rate_id = RTW_RATEID_BGN_20M_2SS; + else if (tx_num == 3) + rate_id = RTW_RATEID_ARFR5_N_3SS; + else if (tx_num == 4) + rate_id = RTW_RATEID_ARFR7_N_4SS; + } + break; + case WIRELESS_OFDM | WIRELESS_VHT: + if (tx_num == 1) + rate_id = RTW_RATEID_ARFR1_AC_1SS; + else if (tx_num == 2) + rate_id = RTW_RATEID_ARFR0_AC_2SS; + else if (tx_num == 3) + rate_id = RTW_RATEID_ARFR4_AC_3SS; + else if (tx_num == 4) + rate_id = RTW_RATEID_ARFR6_AC_4SS; + break; + case WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_VHT: + if (bw_mode >= RTW_CHANNEL_WIDTH_80) { + if (tx_num == 1) + rate_id = RTW_RATEID_ARFR1_AC_1SS; + else if (tx_num == 2) + rate_id = RTW_RATEID_ARFR0_AC_2SS; + else if (tx_num == 3) + rate_id = RTW_RATEID_ARFR4_AC_3SS; + else if (tx_num == 4) + rate_id = RTW_RATEID_ARFR6_AC_4SS; + } else { + if (tx_num == 1) + rate_id = RTW_RATEID_ARFR2_AC_2G_1SS; + else if (tx_num == 2) + rate_id = RTW_RATEID_ARFR3_AC_2G_2SS; + else if (tx_num == 3) + rate_id = RTW_RATEID_ARFR4_AC_3SS; + else if (tx_num == 4) + rate_id = RTW_RATEID_ARFR6_AC_4SS; + } + break; + default: + break; + } + + return rate_id; +} + +#define RA_MASK_CCK_RATES 0x0000f +#define RA_MASK_OFDM_RATES 0x00ff0 +#define RA_MASK_HT_RATES_1SS (0xff000ULL << 0) +#define RA_MASK_HT_RATES_2SS (0xff000ULL << 8) +#define RA_MASK_HT_RATES_3SS (0xff000ULL << 16) +#define RA_MASK_HT_RATES (RA_MASK_HT_RATES_1SS | \ + RA_MASK_HT_RATES_2SS | \ + RA_MASK_HT_RATES_3SS) +#define RA_MASK_VHT_RATES_1SS (0x3ff000ULL << 0) +#define RA_MASK_VHT_RATES_2SS (0x3ff000ULL << 10) +#define RA_MASK_VHT_RATES_3SS (0x3ff000ULL << 20) +#define RA_MASK_VHT_RATES (RA_MASK_VHT_RATES_1SS | \ + RA_MASK_VHT_RATES_2SS | \ + RA_MASK_VHT_RATES_3SS) +#define RA_MASK_CCK_IN_BG 0x00005 +#define RA_MASK_CCK_IN_HT 0x00005 +#define RA_MASK_CCK_IN_VHT 0x00005 +#define RA_MASK_OFDM_IN_VHT 0x00010 +#define RA_MASK_OFDM_IN_HT_2G 0x00010 +#define RA_MASK_OFDM_IN_HT_5G 0x00030 + +static u64 rtw_rate_mask_rssi(struct rtw_sta_info *si, u8 wireless_set) +{ + u8 rssi_level = si->rssi_level; + + if (wireless_set == WIRELESS_CCK) + return 0xffffffffffffffffULL; + + if (rssi_level == 0) + return 0xffffffffffffffffULL; + else if (rssi_level == 1) + return 0xfffffffffffffff0ULL; + else if (rssi_level == 2) + return 0xffffffffffffefe0ULL; + else if (rssi_level == 3) + return 0xffffffffffffcfc0ULL; + else if (rssi_level == 4) + return 0xffffffffffff8f80ULL; + else + return 0xffffffffffff0f00ULL; +} + +static u64 rtw_rate_mask_recover(u64 ra_mask, u64 ra_mask_bak) +{ + if ((ra_mask & ~(RA_MASK_CCK_RATES | RA_MASK_OFDM_RATES)) == 0) + ra_mask |= (ra_mask_bak & ~(RA_MASK_CCK_RATES | RA_MASK_OFDM_RATES)); + + if (ra_mask == 0) + ra_mask |= (ra_mask_bak & (RA_MASK_CCK_RATES | RA_MASK_OFDM_RATES)); + + return ra_mask; +} + +static u64 rtw_rate_mask_cfg(struct rtw_dev *rtwdev, struct rtw_sta_info *si, + u64 ra_mask, bool is_vht_enable) +{ + struct rtw_hal *hal = &rtwdev->hal; + const struct cfg80211_bitrate_mask *mask = si->mask; + u64 cfg_mask = GENMASK_ULL(63, 0); + u8 band; + + if (!si->use_cfg_mask) + return ra_mask; + + band = hal->current_band_type; + if (band == RTW_BAND_2G) { + band = NL80211_BAND_2GHZ; + cfg_mask = mask->control[band].legacy; + } else if (band == RTW_BAND_5G) { + band = NL80211_BAND_5GHZ; + cfg_mask = u64_encode_bits(mask->control[band].legacy, + RA_MASK_OFDM_RATES); + } + + if (!is_vht_enable) { + if (ra_mask & RA_MASK_HT_RATES_1SS) + cfg_mask |= u64_encode_bits(mask->control[band].ht_mcs[0], + RA_MASK_HT_RATES_1SS); + if (ra_mask & RA_MASK_HT_RATES_2SS) + cfg_mask |= u64_encode_bits(mask->control[band].ht_mcs[1], + RA_MASK_HT_RATES_2SS); + } else { + if (ra_mask & RA_MASK_VHT_RATES_1SS) + cfg_mask |= u64_encode_bits(mask->control[band].vht_mcs[0], + RA_MASK_VHT_RATES_1SS); + if (ra_mask & RA_MASK_VHT_RATES_2SS) + cfg_mask |= u64_encode_bits(mask->control[band].vht_mcs[1], + RA_MASK_VHT_RATES_2SS); + } + + ra_mask &= cfg_mask; + + return ra_mask; +} + +void rtw_update_sta_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si, + bool reset_ra_mask) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct ieee80211_sta *sta = si->sta; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_hal *hal = &rtwdev->hal; + u8 wireless_set; + u8 bw_mode; + u8 rate_id; + u8 rf_type = RF_1T1R; + u8 stbc_en = 0; + u8 ldpc_en = 0; + u8 tx_num = 1; + u64 ra_mask = 0; + u64 ra_mask_bak = 0; + bool is_vht_enable = false; + bool is_support_sgi = false; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + if (sta->deflink.vht_cap.vht_supported) { +#else + if (sta->vht_cap.vht_supported) { +#endif + is_vht_enable = true; + ra_mask |= get_vht_ra_mask(sta); +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + if (sta->deflink.vht_cap.cap & IEEE80211_VHT_CAP_RXSTBC_MASK) +#else + if (sta->vht_cap.cap & IEEE80211_VHT_CAP_RXSTBC_MASK) +#endif + stbc_en = VHT_STBC_EN; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + if (sta->deflink.vht_cap.cap & IEEE80211_VHT_CAP_RXLDPC) +#else + if (sta->vht_cap.cap & IEEE80211_VHT_CAP_RXLDPC) +#endif + ldpc_en = VHT_LDPC_EN; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + } else if (sta->deflink.ht_cap.ht_supported) { + ra_mask |= (sta->deflink.ht_cap.mcs.rx_mask[1] << 20) | + (sta->deflink.ht_cap.mcs.rx_mask[0] << 12); + if (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_RX_STBC) + stbc_en = HT_STBC_EN; + if (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_LDPC_CODING) + ldpc_en = HT_LDPC_EN; +#else + } else if (sta->ht_cap.ht_supported) { + ra_mask |= (sta->ht_cap.mcs.rx_mask[1] << 20) | + (sta->ht_cap.mcs.rx_mask[0] << 12); + if (sta->ht_cap.cap & IEEE80211_HT_CAP_RX_STBC) + stbc_en = HT_STBC_EN; + if (sta->ht_cap.cap & IEEE80211_HT_CAP_LDPC_CODING) + ldpc_en = HT_LDPC_EN; +#endif + } + + if (efuse->hw_cap.nss == 1 || rtwdev->hal.txrx_1ss) + ra_mask &= RA_MASK_VHT_RATES_1SS | RA_MASK_HT_RATES_1SS; + + if (hal->current_band_type == RTW_BAND_5G) { +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + ra_mask |= (u64)sta->deflink.supp_rates[NL80211_BAND_5GHZ] << 4; +#else + ra_mask |= (u64)sta->supp_rates[NL80211_BAND_5GHZ] << 4; +#endif + ra_mask_bak = ra_mask; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + if (sta->deflink.vht_cap.vht_supported) { +#else + if (sta->vht_cap.vht_supported) { +#endif + ra_mask &= RA_MASK_VHT_RATES | RA_MASK_OFDM_IN_VHT; + wireless_set = WIRELESS_OFDM | WIRELESS_VHT; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + } else if (sta->deflink.ht_cap.ht_supported) { +#else + } else if (sta->ht_cap.ht_supported) { +#endif + ra_mask &= RA_MASK_HT_RATES | RA_MASK_OFDM_IN_HT_5G; + wireless_set = WIRELESS_OFDM | WIRELESS_HT; + } else { + wireless_set = WIRELESS_OFDM; + } + dm_info->rrsr_val_init = RRSR_INIT_5G; + } else if (hal->current_band_type == RTW_BAND_2G) { +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + ra_mask |= sta->deflink.supp_rates[NL80211_BAND_2GHZ]; +#else + ra_mask |= sta->supp_rates[NL80211_BAND_2GHZ]; +#endif + ra_mask_bak = ra_mask; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + if (sta->deflink.vht_cap.vht_supported) { +#else + if (sta->vht_cap.vht_supported) { +#endif + ra_mask &= RA_MASK_VHT_RATES | RA_MASK_CCK_IN_VHT | + RA_MASK_OFDM_IN_VHT; + wireless_set = WIRELESS_CCK | WIRELESS_OFDM | + WIRELESS_HT | WIRELESS_VHT; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + } else if (sta->deflink.ht_cap.ht_supported) { +#else + } else if (sta->ht_cap.ht_supported) { +#endif + ra_mask &= RA_MASK_HT_RATES | RA_MASK_CCK_IN_HT | + RA_MASK_OFDM_IN_HT_2G; + wireless_set = WIRELESS_CCK | WIRELESS_OFDM | + WIRELESS_HT; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + } else if (sta->deflink.supp_rates[0] <= 0xf) { +#else + } else if (sta->supp_rates[0] <= 0xf) { +#endif + wireless_set = WIRELESS_CCK; + } else { + ra_mask &= RA_MASK_OFDM_RATES | RA_MASK_CCK_IN_BG; + wireless_set = WIRELESS_CCK | WIRELESS_OFDM; + } + dm_info->rrsr_val_init = RRSR_INIT_2G; + } else { + rtw_err(rtwdev, "Unknown band type\n"); + ra_mask_bak = ra_mask; + wireless_set = 0; + } + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + switch (sta->deflink.bandwidth) { +#else + switch (sta->bandwidth) { +#endif + case IEEE80211_STA_RX_BW_80: + bw_mode = RTW_CHANNEL_WIDTH_80; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + is_support_sgi = sta->deflink.vht_cap.vht_supported && + (sta->deflink.vht_cap.cap & IEEE80211_VHT_CAP_SHORT_GI_80); +#else + is_support_sgi = sta->vht_cap.vht_supported && + (sta->vht_cap.cap & IEEE80211_VHT_CAP_SHORT_GI_80); +#endif + break; + case IEEE80211_STA_RX_BW_40: + bw_mode = RTW_CHANNEL_WIDTH_40; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + is_support_sgi = sta->deflink.ht_cap.ht_supported && + (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_SGI_40); +#else + is_support_sgi = sta->ht_cap.ht_supported && + (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40); +#endif + break; + default: + bw_mode = RTW_CHANNEL_WIDTH_20; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + is_support_sgi = sta->deflink.ht_cap.ht_supported && + (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_SGI_20); +#else + is_support_sgi = sta->ht_cap.ht_supported && + (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20); +#endif + break; + } + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + if (sta->deflink.vht_cap.vht_supported && ra_mask & 0xffc00000) { +#else + if (sta->vht_cap.vht_supported && ra_mask & 0xffc00000) { +#endif + tx_num = 2; + rf_type = RF_2T2R; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + } else if (sta->deflink.ht_cap.ht_supported && ra_mask & 0xfff00000) { +#else + } else if (sta->ht_cap.ht_supported && ra_mask & 0xfff00000) { +#endif + tx_num = 2; + rf_type = RF_2T2R; + } + + rate_id = get_rate_id(wireless_set, bw_mode, tx_num); + + ra_mask &= rtw_rate_mask_rssi(si, wireless_set); + ra_mask = rtw_rate_mask_recover(ra_mask, ra_mask_bak); + ra_mask = rtw_rate_mask_cfg(rtwdev, si, ra_mask, is_vht_enable); + + si->bw_mode = bw_mode; + si->stbc_en = stbc_en; + si->ldpc_en = ldpc_en; + si->rf_type = rf_type; + si->sgi_enable = is_support_sgi; + si->vht_enable = is_vht_enable; + si->ra_mask = ra_mask; + si->rate_id = rate_id; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 18, 0) + rtw_fw_send_ra_info(rtwdev, si, reset_ra_mask); +#else + rtw_fw_send_ra_info(rtwdev, si); +#endif +} + +static int rtw_wait_firmware_completion(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_fw_state *fw; + + fw = &rtwdev->fw; + wait_for_completion(&fw->completion); + if (!fw->firmware) + return -EINVAL; + + if (chip->wow_fw_name) { + fw = &rtwdev->wow_fw; + wait_for_completion(&fw->completion); + if (!fw->firmware) + return -EINVAL; + } + + return 0; +} + +static enum rtw_lps_deep_mode rtw_update_lps_deep_mode(struct rtw_dev *rtwdev, + struct rtw_fw_state *fw) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + if (rtw_disable_lps_deep_mode || !chip->lps_deep_mode_supported || + !fw->feature) + return LPS_DEEP_MODE_NONE; + + if ((chip->lps_deep_mode_supported & BIT(LPS_DEEP_MODE_PG)) && + rtw_fw_feature_check(fw, FW_FEATURE_PG)) + return LPS_DEEP_MODE_PG; + + if ((chip->lps_deep_mode_supported & BIT(LPS_DEEP_MODE_LCLK)) && + rtw_fw_feature_check(fw, FW_FEATURE_LCLK)) + return LPS_DEEP_MODE_LCLK; + + return LPS_DEEP_MODE_NONE; +} + +static int rtw_power_on(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_fw_state *fw = &rtwdev->fw; + bool wifi_only; + int ret; + + ret = rtw_hci_setup(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to setup hci\n"); + goto err; + } + + /* power on MAC before firmware downloaded */ + ret = rtw_mac_power_on(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to power on mac\n"); + goto err; + } + + ret = rtw_wait_firmware_completion(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to wait firmware completion\n"); + goto err_off; + } + + ret = rtw_download_firmware(rtwdev, fw); + if (ret) { + rtw_err(rtwdev, "failed to download firmware\n"); + goto err_off; + } + + /* config mac after firmware downloaded */ + ret = rtw_mac_init(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to configure mac\n"); + goto err_off; + } + + chip->ops->phy_set_param(rtwdev); + + ret = rtw_hci_start(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to start hci\n"); + goto err_off; + } + + /* send H2C after HCI has started */ + rtw_fw_send_general_info(rtwdev); + rtw_fw_send_phydm_info(rtwdev); + + wifi_only = !rtwdev->efuse.btcoex; + rtw_coex_power_on_setting(rtwdev); + rtw_coex_init_hw_config(rtwdev, wifi_only); + + return 0; + +err_off: + rtw_mac_power_off(rtwdev); + +err: + return ret; +} + +void rtw_core_fw_scan_notify(struct rtw_dev *rtwdev, bool start) +{ + if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_NOTIFY_SCAN)) + return; + + if (start) { + rtw_fw_scan_notify(rtwdev, true); + } else { + reinit_completion(&rtwdev->fw_scan_density); + rtw_fw_scan_notify(rtwdev, false); + if (!wait_for_completion_timeout(&rtwdev->fw_scan_density, + SCAN_NOTIFY_TIMEOUT)) + rtw_warn(rtwdev, "firmware failed to report density after scan\n"); + } +} + +void rtw_core_scan_start(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif, + const u8 *mac_addr, bool hw_scan) +{ + u32 config = 0; + int ret = 0; + + rtw_leave_lps(rtwdev); + + if (hw_scan && (rtwdev->hw->conf.flags & IEEE80211_CONF_IDLE)) { + ret = rtw_leave_ips(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to leave idle state\n"); + return; + } + } + + ether_addr_copy(rtwvif->mac_addr, mac_addr); + config |= PORT_SET_MAC_ADDR; + rtw_vif_port_config(rtwdev, rtwvif, config); + + rtw_coex_scan_notify(rtwdev, COEX_SCAN_START); + rtw_core_fw_scan_notify(rtwdev, true); + + set_bit(RTW_FLAG_DIG_DISABLE, rtwdev->flags); + set_bit(RTW_FLAG_SCANNING, rtwdev->flags); +} + +void rtw_core_scan_complete(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + bool hw_scan) +{ + struct rtw_vif *rtwvif = vif ? (struct rtw_vif *)vif->drv_priv : NULL; + u32 config = 0; + + if (!rtwvif) + return; + + clear_bit(RTW_FLAG_SCANNING, rtwdev->flags); + clear_bit(RTW_FLAG_DIG_DISABLE, rtwdev->flags); + + rtw_core_fw_scan_notify(rtwdev, false); + + ether_addr_copy(rtwvif->mac_addr, vif->addr); + config |= PORT_SET_MAC_ADDR; + rtw_vif_port_config(rtwdev, rtwvif, config); + + rtw_coex_scan_notify(rtwdev, COEX_SCAN_FINISH); + + if (hw_scan && (rtwdev->hw->conf.flags & IEEE80211_CONF_IDLE)) + ieee80211_queue_work(rtwdev->hw, &rtwdev->ips_work); +} + +int rtw_core_start(struct rtw_dev *rtwdev) +{ + int ret; + + ret = rtw_power_on(rtwdev); + if (ret) + return ret; + + rtw_sec_enable_sec_engine(rtwdev); + + rtwdev->lps_conf.deep_mode = rtw_update_lps_deep_mode(rtwdev, &rtwdev->fw); + rtwdev->lps_conf.wow_deep_mode = rtw_update_lps_deep_mode(rtwdev, &rtwdev->wow_fw); + + /* rcr reset after powered on */ + rtw_write32(rtwdev, REG_RCR, rtwdev->hal.rcr); + + ieee80211_queue_delayed_work(rtwdev->hw, &rtwdev->watch_dog_work, + RTW_WATCH_DOG_DELAY_TIME); + + set_bit(RTW_FLAG_RUNNING, rtwdev->flags); + + return 0; +} + +static void rtw_power_off(struct rtw_dev *rtwdev) +{ + rtw_hci_stop(rtwdev); + rtw_coex_power_off_setting(rtwdev); + rtw_mac_power_off(rtwdev); +} + +void rtw_core_stop(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + + clear_bit(RTW_FLAG_RUNNING, rtwdev->flags); + clear_bit(RTW_FLAG_FW_RUNNING, rtwdev->flags); + + mutex_unlock(&rtwdev->mutex); + + cancel_work_sync(&rtwdev->c2h_work); + cancel_work_sync(&rtwdev->update_beacon_work); + cancel_delayed_work_sync(&rtwdev->watch_dog_work); + cancel_delayed_work_sync(&coex->bt_relink_work); + cancel_delayed_work_sync(&coex->bt_reenable_work); + cancel_delayed_work_sync(&coex->defreeze_work); + cancel_delayed_work_sync(&coex->wl_remain_work); + cancel_delayed_work_sync(&coex->bt_remain_work); + cancel_delayed_work_sync(&coex->wl_connecting_work); + cancel_delayed_work_sync(&coex->bt_multi_link_remain_work); + cancel_delayed_work_sync(&coex->wl_ccklock_work); + + mutex_lock(&rtwdev->mutex); + + rtw_power_off(rtwdev); +} + +static void rtw_init_ht_cap(struct rtw_dev *rtwdev, + struct ieee80211_sta_ht_cap *ht_cap) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + + ht_cap->ht_supported = true; + ht_cap->cap = 0; + ht_cap->cap |= IEEE80211_HT_CAP_SGI_20 | + IEEE80211_HT_CAP_MAX_AMSDU | + (1 << IEEE80211_HT_CAP_RX_STBC_SHIFT); + + if (rtw_chip_has_rx_ldpc(rtwdev)) + ht_cap->cap |= IEEE80211_HT_CAP_LDPC_CODING; + if (rtw_chip_has_tx_stbc(rtwdev)) + ht_cap->cap |= IEEE80211_HT_CAP_TX_STBC; + + if (efuse->hw_cap.bw & BIT(RTW_CHANNEL_WIDTH_40)) + ht_cap->cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40 | + IEEE80211_HT_CAP_DSSSCCK40 | + IEEE80211_HT_CAP_SGI_40; + ht_cap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K; + ht_cap->ampdu_density = chip->ampdu_density; + ht_cap->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED; + if (efuse->hw_cap.nss > 1) { + 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(300); + } else { + 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(150); + } +} + +static void rtw_init_vht_cap(struct rtw_dev *rtwdev, + struct ieee80211_sta_vht_cap *vht_cap) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + u16 mcs_map; + __le16 highest; + + if (efuse->hw_cap.ptcl != EFUSE_HW_CAP_IGNORE && + efuse->hw_cap.ptcl != EFUSE_HW_CAP_PTCL_VHT) + return; + + vht_cap->vht_supported = true; + vht_cap->cap = IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454 | + IEEE80211_VHT_CAP_SHORT_GI_80 | + IEEE80211_VHT_CAP_RXSTBC_1 | + IEEE80211_VHT_CAP_HTC_VHT | + IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK | + 0; + if (rtwdev->hal.rf_path_num > 1) + vht_cap->cap |= IEEE80211_VHT_CAP_TXSTBC; + vht_cap->cap |= IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE | + IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE; + vht_cap->cap |= (rtwdev->hal.bfee_sts_cap << + IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT); + + if (rtw_chip_has_rx_ldpc(rtwdev)) + vht_cap->cap |= IEEE80211_VHT_CAP_RXLDPC; + + mcs_map = IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 | + IEEE80211_VHT_MCS_NOT_SUPPORTED << 4 | + IEEE80211_VHT_MCS_NOT_SUPPORTED << 6 | + IEEE80211_VHT_MCS_NOT_SUPPORTED << 8 | + IEEE80211_VHT_MCS_NOT_SUPPORTED << 10 | + IEEE80211_VHT_MCS_NOT_SUPPORTED << 12 | + IEEE80211_VHT_MCS_NOT_SUPPORTED << 14; + if (efuse->hw_cap.nss > 1) { + highest = cpu_to_le16(780); + mcs_map |= IEEE80211_VHT_MCS_SUPPORT_0_9 << 2; + } else { + highest = cpu_to_le16(390); + mcs_map |= IEEE80211_VHT_MCS_NOT_SUPPORTED << 2; + } + + vht_cap->vht_mcs.rx_mcs_map = cpu_to_le16(mcs_map); + vht_cap->vht_mcs.tx_mcs_map = cpu_to_le16(mcs_map); + vht_cap->vht_mcs.rx_highest = highest; + vht_cap->vht_mcs.tx_highest = highest; +} + +static u16 rtw_get_max_scan_ie_len(struct rtw_dev *rtwdev) +{ + u16 len; + + len = rtwdev->chip->max_scan_ie_len; + + if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD) && + rtwdev->chip->id == RTW_CHIP_TYPE_8822C) + len = IEEE80211_MAX_DATA_LEN; + else if (rtw_fw_feature_ext_check(&rtwdev->fw, FW_FEATURE_EXT_OLD_PAGE_NUM)) + len -= RTW_OLD_PROBE_PG_CNT * TX_PAGE_SIZE; + + return len; +} + +static void rtw_set_supported_band(struct ieee80211_hw *hw, + const struct rtw_chip_info *chip) +{ + struct rtw_dev *rtwdev = hw->priv; + struct ieee80211_supported_band *sband; + + if (chip->band & RTW_BAND_2G) { + sband = kmemdup(&rtw_band_2ghz, sizeof(*sband), GFP_KERNEL); + if (!sband) + goto err_out; + if (chip->ht_supported) + rtw_init_ht_cap(rtwdev, &sband->ht_cap); + hw->wiphy->bands[NL80211_BAND_2GHZ] = sband; + } + + if (chip->band & RTW_BAND_5G) { + sband = kmemdup(&rtw_band_5ghz, sizeof(*sband), GFP_KERNEL); + if (!sband) + goto err_out; + if (chip->ht_supported) + rtw_init_ht_cap(rtwdev, &sband->ht_cap); + if (chip->vht_supported) + rtw_init_vht_cap(rtwdev, &sband->vht_cap); + hw->wiphy->bands[NL80211_BAND_5GHZ] = sband; + } + + return; + +err_out: + rtw_err(rtwdev, "failed to set supported band\n"); +} + +static void rtw_unset_supported_band(struct ieee80211_hw *hw, + const struct rtw_chip_info *chip) +{ + kfree(hw->wiphy->bands[NL80211_BAND_2GHZ]); + kfree(hw->wiphy->bands[NL80211_BAND_5GHZ]); +} + +static void rtw_vif_smps_iter(void *data, u8 *mac, + struct ieee80211_vif *vif) +{ + struct rtw_dev *rtwdev = (struct rtw_dev *)data; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) + if (vif->type != NL80211_IFTYPE_STATION || !vif->cfg.assoc) +#else + if (vif->type != NL80211_IFTYPE_STATION || !vif->bss_conf.assoc) +#endif + return; + + if (rtwdev->hal.txrx_1ss) +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) + ieee80211_request_smps(vif, 0, IEEE80211_SMPS_STATIC); +#else + ieee80211_request_smps(vif, IEEE80211_SMPS_STATIC); +#endif + else +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) + ieee80211_request_smps(vif, 0, IEEE80211_SMPS_OFF); +#else + ieee80211_request_smps(vif, IEEE80211_SMPS_OFF); +#endif +} + +void rtw_set_txrx_1ss(struct rtw_dev *rtwdev, bool txrx_1ss) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_hal *hal = &rtwdev->hal; + + if (!chip->ops->config_txrx_mode || rtwdev->hal.txrx_1ss == txrx_1ss) + return; + + rtwdev->hal.txrx_1ss = txrx_1ss; + if (txrx_1ss) + chip->ops->config_txrx_mode(rtwdev, BB_PATH_A, BB_PATH_A, false); + else + chip->ops->config_txrx_mode(rtwdev, hal->antenna_tx, + hal->antenna_rx, false); + rtw_iterate_vifs_atomic(rtwdev, rtw_vif_smps_iter, rtwdev); +} + +static void __update_firmware_feature(struct rtw_dev *rtwdev, + struct rtw_fw_state *fw) +{ + u32 feature; + const struct rtw_fw_hdr *fw_hdr = + (const struct rtw_fw_hdr *)fw->firmware->data; + + feature = le32_to_cpu(fw_hdr->feature); + fw->feature = feature & FW_FEATURE_SIG ? feature : 0; + + if (rtwdev->chip->id == RTW_CHIP_TYPE_8822C && + RTW_FW_SUIT_VER_CODE(rtwdev->fw) < RTW_FW_VER_CODE(9, 9, 13)) + fw->feature_ext |= FW_FEATURE_EXT_OLD_PAGE_NUM; +} + +static void __update_firmware_info(struct rtw_dev *rtwdev, + struct rtw_fw_state *fw) +{ + const struct rtw_fw_hdr *fw_hdr = + (const struct rtw_fw_hdr *)fw->firmware->data; + + fw->h2c_version = le16_to_cpu(fw_hdr->h2c_fmt_ver); + fw->version = le16_to_cpu(fw_hdr->version); + fw->sub_version = fw_hdr->subversion; + fw->sub_index = fw_hdr->subindex; + + __update_firmware_feature(rtwdev, fw); +} + +static void __update_firmware_info_legacy(struct rtw_dev *rtwdev, + struct rtw_fw_state *fw) +{ + struct rtw_fw_hdr_legacy *legacy = + (struct rtw_fw_hdr_legacy *)fw->firmware->data; + + fw->h2c_version = 0; + fw->version = le16_to_cpu(legacy->version); + fw->sub_version = legacy->subversion1; + fw->sub_index = legacy->subversion2; +} + +static void update_firmware_info(struct rtw_dev *rtwdev, + struct rtw_fw_state *fw) +{ + if (rtw_chip_wcpu_11n(rtwdev)) + __update_firmware_info_legacy(rtwdev, fw); + else + __update_firmware_info(rtwdev, fw); +} + +static void rtw_load_firmware_cb(const struct firmware *firmware, void *context) +{ + struct rtw_fw_state *fw = context; + struct rtw_dev *rtwdev = fw->rtwdev; + + if (!firmware || !firmware->data) { + rtw_err(rtwdev, "failed to request firmware\n"); + complete_all(&fw->completion); + return; + } + + fw->firmware = firmware; + update_firmware_info(rtwdev, fw); + complete_all(&fw->completion); + + rtw_info(rtwdev, "%sFirmware version %u.%u.%u, H2C version %u\n", + fw->type == RTW_WOWLAN_FW ? "WOW " : "", + fw->version, fw->sub_version, fw->sub_index, fw->h2c_version); +} + +static int rtw_load_firmware(struct rtw_dev *rtwdev, enum rtw_fw_type type) +{ + const char *fw_name; + struct rtw_fw_state *fw; + int ret; + + switch (type) { + case RTW_WOWLAN_FW: + fw = &rtwdev->wow_fw; + fw_name = rtwdev->chip->wow_fw_name; + break; + + case RTW_NORMAL_FW: + fw = &rtwdev->fw; + fw_name = rtwdev->chip->fw_name; + break; + + default: + rtw_warn(rtwdev, "unsupported firmware type\n"); + return -ENOENT; + } + + fw->type = type; + fw->rtwdev = rtwdev; + init_completion(&fw->completion); + + ret = request_firmware_nowait(THIS_MODULE, true, fw_name, rtwdev->dev, + GFP_KERNEL, fw, rtw_load_firmware_cb); + if (ret) { + rtw_err(rtwdev, "failed to async firmware request\n"); + return ret; + } + + return 0; +} + +static int rtw_chip_parameter_setup(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_efuse *efuse = &rtwdev->efuse; + + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_PCIE: + rtwdev->hci.rpwm_addr = 0x03d9; + rtwdev->hci.cpwm_addr = 0x03da; + break; + case RTW_HCI_TYPE_SDIO: + rtwdev->hci.rpwm_addr = REG_SDIO_HRPWM1; + rtwdev->hci.cpwm_addr = REG_SDIO_HCPWM1_V2; + break; + case RTW_HCI_TYPE_USB: + rtwdev->hci.rpwm_addr = 0xfe58; + rtwdev->hci.cpwm_addr = 0xfe57; + break; + default: + rtw_err(rtwdev, "unsupported hci type\n"); + return -EINVAL; + } + + hal->chip_version = rtw_read32(rtwdev, REG_SYS_CFG1); + hal->cut_version = BIT_GET_CHIP_VER(hal->chip_version); + hal->mp_chip = (hal->chip_version & BIT_RTL_ID) ? 0 : 1; + if (hal->chip_version & BIT_RF_TYPE_ID) { + hal->rf_type = RF_2T2R; + hal->rf_path_num = 2; + hal->antenna_tx = BB_PATH_AB; + hal->antenna_rx = BB_PATH_AB; + } else { + hal->rf_type = RF_1T1R; + hal->rf_path_num = 1; + hal->antenna_tx = BB_PATH_A; + hal->antenna_rx = BB_PATH_A; + } + hal->rf_phy_num = chip->fix_rf_phy_num ? chip->fix_rf_phy_num : + hal->rf_path_num; + + efuse->physical_size = chip->phy_efuse_size; + efuse->logical_size = chip->log_efuse_size; + efuse->protect_size = chip->ptct_efuse_size; + + /* default use ack */ + rtwdev->hal.rcr |= BIT_VHT_DACK; + + hal->bfee_sts_cap = 3; + + return 0; +} + +static int rtw_chip_efuse_enable(struct rtw_dev *rtwdev) +{ + struct rtw_fw_state *fw = &rtwdev->fw; + int ret; + + ret = rtw_hci_setup(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to setup hci\n"); + goto err; + } + + ret = rtw_mac_power_on(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to power on mac\n"); + goto err; + } + + rtw_write8(rtwdev, REG_C2HEVT, C2H_HW_FEATURE_DUMP); + + wait_for_completion(&fw->completion); + if (!fw->firmware) { + ret = -EINVAL; + rtw_err(rtwdev, "failed to load firmware\n"); + goto err; + } + + ret = rtw_download_firmware(rtwdev, fw); + if (ret) { + rtw_err(rtwdev, "failed to download firmware\n"); + goto err_off; + } + + return 0; + +err_off: + rtw_mac_power_off(rtwdev); + +err: + return ret; +} + +static int rtw_dump_hw_feature(struct rtw_dev *rtwdev) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 hw_feature[HW_FEATURE_LEN]; + u8 id; + u8 bw; + int i; + + id = rtw_read8(rtwdev, REG_C2HEVT); + if (id != C2H_HW_FEATURE_REPORT) { + rtw_err(rtwdev, "failed to read hw feature report\n"); + return -EBUSY; + } + + for (i = 0; i < HW_FEATURE_LEN; i++) + hw_feature[i] = rtw_read8(rtwdev, REG_C2HEVT + 2 + i); + + rtw_write8(rtwdev, REG_C2HEVT, 0); + + bw = GET_EFUSE_HW_CAP_BW(hw_feature); + efuse->hw_cap.bw = hw_bw_cap_to_bitamp(bw); + efuse->hw_cap.hci = GET_EFUSE_HW_CAP_HCI(hw_feature); + efuse->hw_cap.nss = GET_EFUSE_HW_CAP_NSS(hw_feature); + efuse->hw_cap.ptcl = GET_EFUSE_HW_CAP_PTCL(hw_feature); + efuse->hw_cap.ant_num = GET_EFUSE_HW_CAP_ANT_NUM(hw_feature); + + rtw_hw_config_rf_ant_num(rtwdev, efuse->hw_cap.ant_num); + + if (efuse->hw_cap.nss == EFUSE_HW_CAP_IGNORE || + efuse->hw_cap.nss > rtwdev->hal.rf_path_num) + efuse->hw_cap.nss = rtwdev->hal.rf_path_num; + + rtw_dbg(rtwdev, RTW_DBG_EFUSE, + "hw cap: hci=0x%02x, bw=0x%02x, ptcl=0x%02x, ant_num=%d, nss=%d\n", + efuse->hw_cap.hci, efuse->hw_cap.bw, efuse->hw_cap.ptcl, + efuse->hw_cap.ant_num, efuse->hw_cap.nss); + + return 0; +} + +static void rtw_chip_efuse_disable(struct rtw_dev *rtwdev) +{ + rtw_hci_stop(rtwdev); + rtw_mac_power_off(rtwdev); +} + +static int rtw_chip_efuse_info_setup(struct rtw_dev *rtwdev) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + int ret; + + mutex_lock(&rtwdev->mutex); + + /* power on mac to read efuse */ + ret = rtw_chip_efuse_enable(rtwdev); + if (ret) + goto out_unlock; + + ret = rtw_parse_efuse_map(rtwdev); + if (ret) + goto out_disable; + + ret = rtw_dump_hw_feature(rtwdev); + if (ret) + goto out_disable; + + ret = rtw_check_supported_rfe(rtwdev); + if (ret) + goto out_disable; + + if (efuse->crystal_cap == 0xff) + efuse->crystal_cap = 0; + if (efuse->pa_type_2g == 0xff) + efuse->pa_type_2g = 0; + if (efuse->pa_type_5g == 0xff) + efuse->pa_type_5g = 0; + if (efuse->lna_type_2g == 0xff) + efuse->lna_type_2g = 0; + if (efuse->lna_type_5g == 0xff) + efuse->lna_type_5g = 0; + if (efuse->channel_plan == 0xff) + efuse->channel_plan = 0x7f; + if (efuse->rf_board_option == 0xff) + efuse->rf_board_option = 0; + if (efuse->bt_setting & BIT(0)) + efuse->share_ant = true; + if (efuse->regd == 0xff) + efuse->regd = 0; + if (efuse->tx_bb_swing_setting_2g == 0xff) + efuse->tx_bb_swing_setting_2g = 0; + if (efuse->tx_bb_swing_setting_5g == 0xff) + efuse->tx_bb_swing_setting_5g = 0; + + efuse->btcoex = (efuse->rf_board_option & 0xe0) == 0x20; + efuse->ext_pa_2g = efuse->pa_type_2g & BIT(4) ? 1 : 0; + efuse->ext_lna_2g = efuse->lna_type_2g & BIT(3) ? 1 : 0; + efuse->ext_pa_5g = efuse->pa_type_5g & BIT(0) ? 1 : 0; + efuse->ext_lna_2g = efuse->lna_type_5g & BIT(3) ? 1 : 0; + +out_disable: + rtw_chip_efuse_disable(rtwdev); + +out_unlock: + mutex_unlock(&rtwdev->mutex); + return ret; +} + +static int rtw_chip_board_info_setup(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + const struct rtw_rfe_def *rfe_def = rtw_get_rfe_def(rtwdev); + + if (!rfe_def) + return -ENODEV; + + rtw_phy_setup_phy_cond(rtwdev, hal->pkg_type); + + rtw_phy_init_tx_power(rtwdev); + if (rfe_def->agc_btg_tbl) + rtw_load_table(rtwdev, rfe_def->agc_btg_tbl); + rtw_load_table(rtwdev, rfe_def->phy_pg_tbl); + rtw_load_table(rtwdev, rfe_def->txpwr_lmt_tbl); + rtw_phy_tx_power_by_rate_config(hal); + rtw_phy_tx_power_limit_config(hal); + + return 0; +} + +int rtw_chip_info_setup(struct rtw_dev *rtwdev) +{ + int ret; + + ret = rtw_chip_parameter_setup(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to setup chip parameters\n"); + goto err_out; + } + + ret = rtw_chip_efuse_info_setup(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to setup chip efuse info\n"); + goto err_out; + } + + ret = rtw_chip_board_info_setup(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to setup chip board info\n"); + goto err_out; + } + + return 0; + +err_out: + return ret; +} +EXPORT_SYMBOL(rtw_chip_info_setup); + +static void rtw_stats_init(struct rtw_dev *rtwdev) +{ + struct rtw_traffic_stats *stats = &rtwdev->stats; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + int i; + + ewma_tp_init(&stats->tx_ewma_tp); + ewma_tp_init(&stats->rx_ewma_tp); + + for (i = 0; i < RTW_EVM_NUM; i++) + ewma_evm_init(&dm_info->ewma_evm[i]); + for (i = 0; i < RTW_SNR_NUM; i++) + ewma_snr_init(&dm_info->ewma_snr[i]); +} + +int rtw_core_init(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_coex *coex = &rtwdev->coex; + int ret; + + INIT_LIST_HEAD(&rtwdev->rsvd_page_list); + INIT_LIST_HEAD(&rtwdev->txqs); + +#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 14, 0) + setup_timer(&rtwdev->tx_report.purge_timer, + (void *)(long unsigned int)rtw_tx_report_purge_timer, + (long unsigned int)rtwdev); +#else + timer_setup(&rtwdev->tx_report.purge_timer, + rtw_tx_report_purge_timer, 0); +#endif + rtwdev->tx_wq = alloc_workqueue("rtw_tx_wq", WQ_UNBOUND | WQ_HIGHPRI, 0); + if (!rtwdev->tx_wq) { + rtw_warn(rtwdev, "alloc_workqueue rtw_tx_wq failed\n"); + return -ENOMEM; + } + + INIT_DELAYED_WORK(&rtwdev->watch_dog_work, rtw_watch_dog_work); + INIT_DELAYED_WORK(&coex->bt_relink_work, rtw_coex_bt_relink_work); + INIT_DELAYED_WORK(&coex->bt_reenable_work, rtw_coex_bt_reenable_work); + INIT_DELAYED_WORK(&coex->defreeze_work, rtw_coex_defreeze_work); + INIT_DELAYED_WORK(&coex->wl_remain_work, rtw_coex_wl_remain_work); + INIT_DELAYED_WORK(&coex->bt_remain_work, rtw_coex_bt_remain_work); + INIT_DELAYED_WORK(&coex->wl_connecting_work, rtw_coex_wl_connecting_work); + INIT_DELAYED_WORK(&coex->bt_multi_link_remain_work, + rtw_coex_bt_multi_link_remain_work); + INIT_DELAYED_WORK(&coex->wl_ccklock_work, rtw_coex_wl_ccklock_work); + INIT_WORK(&rtwdev->tx_work, rtw_tx_work); + INIT_WORK(&rtwdev->c2h_work, rtw_c2h_work); + INIT_WORK(&rtwdev->ips_work, rtw_ips_work); + INIT_WORK(&rtwdev->fw_recovery_work, rtw_fw_recovery_work); + INIT_WORK(&rtwdev->update_beacon_work, rtw_fw_update_beacon_work); + INIT_WORK(&rtwdev->ba_work, rtw_txq_ba_work); + skb_queue_head_init(&rtwdev->c2h_queue); + skb_queue_head_init(&rtwdev->coex.queue); + skb_queue_head_init(&rtwdev->tx_report.queue); + + spin_lock_init(&rtwdev->txq_lock); + spin_lock_init(&rtwdev->tx_report.q_lock); + + mutex_init(&rtwdev->mutex); + mutex_init(&rtwdev->hal.tx_power_mutex); + + init_waitqueue_head(&rtwdev->coex.wait); + init_completion(&rtwdev->lps_leave_check); + init_completion(&rtwdev->fw_scan_density); + + rtwdev->sec.total_cam_num = 32; + rtwdev->hal.current_channel = 1; + rtwdev->dm_info.fix_rate = U8_MAX; + set_bit(RTW_BC_MC_MACID, rtwdev->mac_id_map); + + rtw_stats_init(rtwdev); + + /* default rx filter setting */ + rtwdev->hal.rcr = BIT_APP_FCS | BIT_APP_MIC | BIT_APP_ICV | + BIT_PKTCTL_DLEN | BIT_HTC_LOC_CTRL | BIT_APP_PHYSTS | + BIT_AB | BIT_AM | BIT_APM; + + ret = rtw_load_firmware(rtwdev, RTW_NORMAL_FW); + if (ret) { + rtw_warn(rtwdev, "no firmware loaded\n"); + goto out; + } + + if (chip->wow_fw_name) { + ret = rtw_load_firmware(rtwdev, RTW_WOWLAN_FW); + if (ret) { + rtw_warn(rtwdev, "no wow firmware loaded\n"); + wait_for_completion(&rtwdev->fw.completion); + if (rtwdev->fw.firmware) + release_firmware(rtwdev->fw.firmware); + goto out; + } + } + + return 0; + +out: + destroy_workqueue(rtwdev->tx_wq); + return ret; +} +EXPORT_SYMBOL(rtw_core_init); + +void rtw_core_deinit(struct rtw_dev *rtwdev) +{ + struct rtw_fw_state *fw = &rtwdev->fw; + struct rtw_fw_state *wow_fw = &rtwdev->wow_fw; + struct rtw_rsvd_page *rsvd_pkt, *tmp; + unsigned long flags; + + rtw_wait_firmware_completion(rtwdev); + + if (fw->firmware) + release_firmware(fw->firmware); + + if (wow_fw->firmware) + release_firmware(wow_fw->firmware); + + destroy_workqueue(rtwdev->tx_wq); +# if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 2, 0) + timer_delete_sync(&rtwdev->tx_report.purge_timer); +# else + del_timer_sync(&rtwdev->tx_report.purge_timer); +# endif + spin_lock_irqsave(&rtwdev->tx_report.q_lock, flags); + skb_queue_purge(&rtwdev->tx_report.queue); + skb_queue_purge(&rtwdev->coex.queue); + skb_queue_purge(&rtwdev->c2h_queue); + spin_unlock_irqrestore(&rtwdev->tx_report.q_lock, flags); + + list_for_each_entry_safe(rsvd_pkt, tmp, &rtwdev->rsvd_page_list, + build_list) { + list_del(&rsvd_pkt->build_list); + kfree(rsvd_pkt); + } + + mutex_destroy(&rtwdev->mutex); + mutex_destroy(&rtwdev->hal.tx_power_mutex); +} +EXPORT_SYMBOL(rtw_core_deinit); + +int rtw_register_hw(struct rtw_dev *rtwdev, struct ieee80211_hw *hw) +{ + struct rtw_hal *hal = &rtwdev->hal; + int max_tx_headroom = 0; + int ret; + + max_tx_headroom = rtwdev->chip->tx_pkt_desc_sz; + + if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) + max_tx_headroom += RTW_SDIO_DATA_PTR_ALIGN; + + hw->extra_tx_headroom = max_tx_headroom; + hw->queues = IEEE80211_NUM_ACS; + hw->txq_data_size = sizeof(struct rtw_txq); + hw->sta_data_size = sizeof(struct rtw_sta_info); + hw->vif_data_size = sizeof(struct rtw_vif); + + ieee80211_hw_set(hw, SIGNAL_DBM); + ieee80211_hw_set(hw, RX_INCLUDES_FCS); + ieee80211_hw_set(hw, AMPDU_AGGREGATION); + ieee80211_hw_set(hw, MFP_CAPABLE); + ieee80211_hw_set(hw, REPORTS_TX_ACK_STATUS); + ieee80211_hw_set(hw, SUPPORTS_PS); + ieee80211_hw_set(hw, SUPPORTS_DYNAMIC_PS); + ieee80211_hw_set(hw, SUPPORT_FAST_XMIT); + ieee80211_hw_set(hw, SUPPORTS_AMSDU_IN_AMPDU); + ieee80211_hw_set(hw, HAS_RATE_CONTROL); + ieee80211_hw_set(hw, TX_AMSDU); + ieee80211_hw_set(hw, SINGLE_SCAN_ON_ALL_BANDS); + + hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | + BIT(NL80211_IFTYPE_AP) | + BIT(NL80211_IFTYPE_ADHOC) | + BIT(NL80211_IFTYPE_MESH_POINT); + hw->wiphy->available_antennas_tx = hal->antenna_tx; + hw->wiphy->available_antennas_rx = hal->antenna_rx; + + hw->wiphy->flags |= WIPHY_FLAG_SUPPORTS_TDLS | + WIPHY_FLAG_TDLS_EXTERNAL_SETUP; + + hw->wiphy->features |= NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR; + hw->wiphy->max_scan_ssids = RTW_SCAN_MAX_SSIDS; + hw->wiphy->max_scan_ie_len = rtw_get_max_scan_ie_len(rtwdev); + + if (rtwdev->chip->id == RTW_CHIP_TYPE_8822C) { + hw->wiphy->iface_combinations = rtw_iface_combs; + hw->wiphy->n_iface_combinations = ARRAY_SIZE(rtw_iface_combs); + } + + wiphy_ext_feature_set(hw->wiphy, NL80211_EXT_FEATURE_CAN_REPLACE_PTK0); + wiphy_ext_feature_set(hw->wiphy, NL80211_EXT_FEATURE_SCAN_RANDOM_SN); + wiphy_ext_feature_set(hw->wiphy, NL80211_EXT_FEATURE_SET_SCAN_DWELL); + +#ifdef CONFIG_PM + hw->wiphy->wowlan = rtwdev->chip->wowlan_stub; + hw->wiphy->max_sched_scan_ssids = rtwdev->chip->max_sched_scan_ssids; +#endif + rtw_set_supported_band(hw, rtwdev->chip); + SET_IEEE80211_PERM_ADDR(hw, rtwdev->efuse.addr); + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) + hw->wiphy->sar_capa = &rtw_sar_capa; +#endif + + ret = rtw_regd_init(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to init regd\n"); + return ret; + } + + ret = ieee80211_register_hw(hw); + if (ret) { + rtw_err(rtwdev, "failed to register hw\n"); + return ret; + } + + ret = rtw_regd_hint(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to hint regd\n"); + return ret; + } + + rtw_debugfs_init(rtwdev); + + rtwdev->bf_info.bfer_mu_cnt = 0; + rtwdev->bf_info.bfer_su_cnt = 0; + + return 0; +} +EXPORT_SYMBOL(rtw_register_hw); + +void rtw_unregister_hw(struct rtw_dev *rtwdev, struct ieee80211_hw *hw) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + ieee80211_unregister_hw(hw); + rtw_unset_supported_band(hw, chip); +} +EXPORT_SYMBOL(rtw_unregister_hw); + +static +void rtw_swap_reg_nbytes(struct rtw_dev *rtwdev, const struct rtw_hw_reg *reg1, + const struct rtw_hw_reg *reg2, u8 nbytes) +{ + u8 i; + + for (i = 0; i < nbytes; i++) { + u8 v1 = rtw_read8(rtwdev, reg1->addr + i); + u8 v2 = rtw_read8(rtwdev, reg2->addr + i); + + rtw_write8(rtwdev, reg1->addr + i, v2); + rtw_write8(rtwdev, reg2->addr + i, v1); + } +} + +static +void rtw_swap_reg_mask(struct rtw_dev *rtwdev, const struct rtw_hw_reg *reg1, + const struct rtw_hw_reg *reg2) +{ + u32 v1, v2; + + v1 = rtw_read32_mask(rtwdev, reg1->addr, reg1->mask); + v2 = rtw_read32_mask(rtwdev, reg2->addr, reg2->mask); + rtw_write32_mask(rtwdev, reg2->addr, reg2->mask, v1); + rtw_write32_mask(rtwdev, reg1->addr, reg1->mask, v2); +} + +struct rtw_iter_port_switch_data { + struct rtw_dev *rtwdev; + struct rtw_vif *rtwvif_ap; +}; + +static void rtw_port_switch_iter(void *data, struct ieee80211_vif *vif) +{ + struct rtw_iter_port_switch_data *iter_data = data; + struct rtw_dev *rtwdev = iter_data->rtwdev; + struct rtw_vif *rtwvif_target = (struct rtw_vif *)vif->drv_priv; + struct rtw_vif *rtwvif_ap = iter_data->rtwvif_ap; + const struct rtw_hw_reg *reg1, *reg2; + + if (rtwvif_target->port != RTW_PORT_0) + return; + + rtw_dbg(rtwdev, RTW_DBG_STATE, "AP port switch from %d -> %d\n", + rtwvif_ap->port, rtwvif_target->port); + + /* Leave LPS so the value swapped are not in PS mode */ + rtw_leave_lps(rtwdev); + + reg1 = &rtwvif_ap->conf->net_type; + reg2 = &rtwvif_target->conf->net_type; + rtw_swap_reg_mask(rtwdev, reg1, reg2); + + reg1 = &rtwvif_ap->conf->mac_addr; + reg2 = &rtwvif_target->conf->mac_addr; + rtw_swap_reg_nbytes(rtwdev, reg1, reg2, ETH_ALEN); + + reg1 = &rtwvif_ap->conf->bssid; + reg2 = &rtwvif_target->conf->bssid; + rtw_swap_reg_nbytes(rtwdev, reg1, reg2, ETH_ALEN); + + reg1 = &rtwvif_ap->conf->bcn_ctrl; + reg2 = &rtwvif_target->conf->bcn_ctrl; + rtw_swap_reg_nbytes(rtwdev, reg1, reg2, 1); + + swap(rtwvif_target->port, rtwvif_ap->port); + swap(rtwvif_target->conf, rtwvif_ap->conf); + + rtw_fw_default_port(rtwdev, rtwvif_target); +} + +void rtw_core_port_switch(struct rtw_dev *rtwdev, struct ieee80211_vif *vif) +{ + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + struct rtw_iter_port_switch_data iter_data; + + if (vif->type != NL80211_IFTYPE_AP || rtwvif->port == RTW_PORT_0) + return; + + iter_data.rtwdev = rtwdev; + iter_data.rtwvif_ap = rtwvif; + rtw_iterate_vifs(rtwdev, rtw_port_switch_iter, &iter_data); +} + +static void rtw_check_sta_active_iter(void *data, struct ieee80211_vif *vif) +{ + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + bool *active = data; + + if (*active) + return; + + if (vif->type != NL80211_IFTYPE_STATION) + return; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0) + if (vif->cfg.assoc || !is_zero_ether_addr(rtwvif->bssid)) +#else + if (vif->bss_conf.assoc || !is_zero_ether_addr(rtwvif->bssid)) +#endif + *active = true; +} + +bool rtw_core_check_sta_active(struct rtw_dev *rtwdev) +{ + bool sta_active = false; + + rtw_iterate_vifs(rtwdev, rtw_check_sta_active_iter, &sta_active); + + return rtwdev->ap_active || sta_active; +} + +void rtw_core_enable_beacon(struct rtw_dev *rtwdev, bool enable) +{ + if (!rtwdev->ap_active) + return; + + if (enable) { + rtw_write32_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); + rtw_write32_clr(rtwdev, REG_TXPAUSE, BIT_HIGH_QUEUE); + } else { + rtw_write32_clr(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); + rtw_write32_set(rtwdev, REG_TXPAUSE, BIT_HIGH_QUEUE); + } +} + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless core module"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/main.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/main.h new file mode 100644 index 0000000000000000000000000000000000000000..d4714c5a5abc4cfe240a9664768f7db8951199af --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/main.h @@ -0,0 +1,2299 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTK_MAIN_H_ +#define __RTK_MAIN_H_ + +#include +#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 11, 0) +#include "compiler.h" +#endif +#include +#include +#include +#include +#include +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 19, 0) +#include +#else +#include "bitfield.h" +#endif +#include +#include +#include + +#include "util.h" +#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 8, 0) +#include +#endif + +#if !defined(RHEL_RELEASE_CODE) +#define RHEL_RELEASE_CODE 0 +#define RHEL_RELEASE_VERSION(a, b) a<<8 & b +#endif + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 8, 0)) || defined(RHEL_RELEASE) && (RHEL_RELEASE_CODE < RHEL_RELEASE_VERSION(8,0)) +/* see Documentation/timers/timers-howto.rst for the thresholds */ +static inline void fsleep(unsigned long usecs) +{ + if (usecs <= 10) + udelay(usecs); + else if (usecs <= 20000) + usleep_range(usecs, 2 * usecs); + else + msleep(DIV_ROUND_UP(usecs, 1000)); +} +#endif + +#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 7, 0) +#define NUM_NL80211_BANDS IEEE80211_NUM_BANDS +#endif + +#define RTW_MAX_MAC_ID_NUM 32 +#define RTW_MAX_SEC_CAM_NUM 32 +#define MAX_PG_CAM_BACKUP_NUM 8 + +#define RTW_SCAN_MAX_SSIDS 4 + +#define RTW_MAX_PATTERN_NUM 12 +#define RTW_MAX_PATTERN_MASK_SIZE 16 +#define RTW_MAX_PATTERN_SIZE 128 + +#define RTW_WATCH_DOG_DELAY_TIME round_jiffies_relative(HZ * 2) + +#define RFREG_MASK 0xfffff +#define INV_RF_DATA 0xffffffff +#define TX_PAGE_SIZE_SHIFT 7 +#define TX_PAGE_SIZE (1 << TX_PAGE_SIZE_SHIFT) + +#define RTW_CHANNEL_WIDTH_MAX 3 +#define RTW_RF_PATH_MAX 4 +#define HW_FEATURE_LEN 13 + +#define RTW_TP_SHIFT 18 /* bytes/2s --> Mbps */ + +#ifndef read_poll_timeout +#define read_poll_timeout(op, val, cond, sleep_us, timeout_us, \ + sleep_before_read, args...) \ +({ \ + u64 __timeout_us = (timeout_us); \ + unsigned long __sleep_us = (sleep_us); \ + ktime_t __timeout = ktime_add_us(ktime_get(), __timeout_us); \ + might_sleep_if((__sleep_us) != 0); \ + if (sleep_before_read && __sleep_us) \ + usleep_range((__sleep_us >> 2) + 1, __sleep_us); \ + for (;;) { \ + (val) = op(args); \ + if (cond) \ + break; \ + if (__timeout_us && \ + ktime_compare(ktime_get(), __timeout) > 0) { \ + (val) = op(args); \ + break; \ + } \ + if (__sleep_us) \ + usleep_range((__sleep_us >> 2) + 1, __sleep_us); \ + } \ + (cond) ? 0 : -ETIMEDOUT; \ +}) +#endif + +#if !defined(IEEE80211_AMPDU_TX_START_IMMEDIATE) +#define IEEE80211_AMPDU_TX_START_IMMEDIATE 1 +#endif + +#if !defined(fallthrough) +#define fallthrough do {} while (0) +#endif + +#ifndef read_poll_timeout_atomic +#define read_poll_timeout_atomic(op, val, cond, delay_us, timeout_us, \ + delay_before_read, args...) \ +({ \ + u64 __timeout_us = (timeout_us); \ + unsigned long __delay_us = (delay_us); \ + ktime_t __timeout = ktime_add_us(ktime_get(), __timeout_us); \ + if (delay_before_read && __delay_us) \ + udelay(__delay_us); \ + for (;;) { \ + (val) = op(args); \ + if (cond) \ + break; \ + if (__timeout_us && \ + ktime_compare(ktime_get(), __timeout) > 0) { \ + (val) = op(args); \ + break; \ + } \ + if (__delay_us) \ + udelay(__delay_us); \ + } \ + (cond) ? 0 : -ETIMEDOUT; \ +}) +#endif + +extern bool rtw_bf_support; +extern bool rtw_disable_lps_deep_mode; +extern unsigned int rtw_debug_mask; +extern bool rtw_edcca_enabled; +extern const struct ieee80211_ops rtw_ops; + +#define RTW_MAX_CHANNEL_NUM_2G 14 +#define RTW_MAX_CHANNEL_NUM_5G 49 + +struct rtw_dev; + +enum rtw_hci_type { + RTW_HCI_TYPE_PCIE, + RTW_HCI_TYPE_USB, + RTW_HCI_TYPE_SDIO, + + RTW_HCI_TYPE_UNDEFINE, +}; + +struct rtw_hci { + struct rtw_hci_ops *ops; + enum rtw_hci_type type; + + u32 rpwm_addr; + u32 cpwm_addr; + + u8 bulkout_num; +}; + +#define IS_CH_5G_BAND_1(channel) ((channel) >= 36 && (channel <= 48)) +#define IS_CH_5G_BAND_2(channel) ((channel) >= 52 && (channel <= 64)) +#define IS_CH_5G_BAND_3(channel) ((channel) >= 100 && (channel <= 144)) +#define IS_CH_5G_BAND_4(channel) ((channel) >= 149 && (channel <= 177)) + +#define IS_CH_5G_BAND_MID(channel) \ + (IS_CH_5G_BAND_2(channel) || IS_CH_5G_BAND_3(channel)) + +#define IS_CH_2G_BAND(channel) ((channel) <= 14) +#define IS_CH_5G_BAND(channel) \ + (IS_CH_5G_BAND_1(channel) || IS_CH_5G_BAND_2(channel) || \ + IS_CH_5G_BAND_3(channel) || IS_CH_5G_BAND_4(channel)) + +enum rtw_supported_band { + RTW_BAND_2G = BIT(NL80211_BAND_2GHZ), + RTW_BAND_5G = BIT(NL80211_BAND_5GHZ), + RTW_BAND_60G = BIT(NL80211_BAND_60GHZ), +}; + +/* now, support up to 80M bw */ +#define RTW_MAX_CHANNEL_WIDTH RTW_CHANNEL_WIDTH_80 + +enum rtw_bandwidth { + RTW_CHANNEL_WIDTH_20 = 0, + RTW_CHANNEL_WIDTH_40 = 1, + RTW_CHANNEL_WIDTH_80 = 2, + RTW_CHANNEL_WIDTH_160 = 3, + RTW_CHANNEL_WIDTH_80_80 = 4, + RTW_CHANNEL_WIDTH_5 = 5, + RTW_CHANNEL_WIDTH_10 = 6, +}; + +enum rtw_sc_offset { + RTW_SC_DONT_CARE = 0, + RTW_SC_20_UPPER = 1, + RTW_SC_20_LOWER = 2, + RTW_SC_20_UPMOST = 3, + RTW_SC_20_LOWEST = 4, + RTW_SC_40_UPPER = 9, + RTW_SC_40_LOWER = 10, +}; + +enum rtw_net_type { + RTW_NET_NO_LINK = 0, + RTW_NET_AD_HOC = 1, + RTW_NET_MGD_LINKED = 2, + RTW_NET_AP_MODE = 3, +}; + +enum rtw_rf_type { + RF_1T1R = 0, + RF_1T2R = 1, + RF_2T2R = 2, + RF_2T3R = 3, + RF_2T4R = 4, + RF_3T3R = 5, + RF_3T4R = 6, + RF_4T4R = 7, + RF_TYPE_MAX, +}; + +enum rtw_rf_path { + RF_PATH_A = 0, + RF_PATH_B = 1, + RF_PATH_C = 2, + RF_PATH_D = 3, +}; + +enum rtw_bb_path { + BB_PATH_A = BIT(0), + BB_PATH_B = BIT(1), + BB_PATH_C = BIT(2), + BB_PATH_D = BIT(3), + + BB_PATH_AB = (BB_PATH_A | BB_PATH_B), + BB_PATH_AC = (BB_PATH_A | BB_PATH_C), + BB_PATH_AD = (BB_PATH_A | BB_PATH_D), + BB_PATH_BC = (BB_PATH_B | BB_PATH_C), + BB_PATH_BD = (BB_PATH_B | BB_PATH_D), + BB_PATH_CD = (BB_PATH_C | BB_PATH_D), + + BB_PATH_ABC = (BB_PATH_A | BB_PATH_B | BB_PATH_C), + BB_PATH_ABD = (BB_PATH_A | BB_PATH_B | BB_PATH_D), + BB_PATH_ACD = (BB_PATH_A | BB_PATH_C | BB_PATH_D), + BB_PATH_BCD = (BB_PATH_B | BB_PATH_C | BB_PATH_D), + + BB_PATH_ABCD = (BB_PATH_A | BB_PATH_B | BB_PATH_C | BB_PATH_D), +}; + +enum rtw_rate_section { + RTW_RATE_SECTION_CCK = 0, + RTW_RATE_SECTION_OFDM, + RTW_RATE_SECTION_HT_1S, + RTW_RATE_SECTION_HT_2S, + RTW_RATE_SECTION_VHT_1S, + RTW_RATE_SECTION_VHT_2S, + + /* keep last */ + RTW_RATE_SECTION_MAX, +}; + +enum rtw_wireless_set { + WIRELESS_CCK = 0x00000001, + WIRELESS_OFDM = 0x00000002, + WIRELESS_HT = 0x00000004, + WIRELESS_VHT = 0x00000008, +}; + +#define HT_STBC_EN BIT(0) +#define VHT_STBC_EN BIT(1) +#define HT_LDPC_EN BIT(0) +#define VHT_LDPC_EN BIT(1) + +enum rtw_chip_type { + RTW_CHIP_TYPE_8822B, + RTW_CHIP_TYPE_8822C, + RTW_CHIP_TYPE_8723D, + RTW_CHIP_TYPE_8821C, +}; + +enum rtw_tx_queue_type { + /* the order of AC queues matters */ + RTW_TX_QUEUE_BK = 0x0, + RTW_TX_QUEUE_BE = 0x1, + RTW_TX_QUEUE_VI = 0x2, + RTW_TX_QUEUE_VO = 0x3, + + RTW_TX_QUEUE_BCN = 0x4, + RTW_TX_QUEUE_MGMT = 0x5, + RTW_TX_QUEUE_HI0 = 0x6, + RTW_TX_QUEUE_H2C = 0x7, + /* keep it last */ + RTK_MAX_TX_QUEUE_NUM +}; + +enum rtw_rx_queue_type { + RTW_RX_QUEUE_MPDU = 0x0, + RTW_RX_QUEUE_C2H = 0x1, + /* keep it last */ + RTK_MAX_RX_QUEUE_NUM +}; + +enum rtw_fw_type { + RTW_NORMAL_FW = 0x0, + RTW_WOWLAN_FW = 0x1, +}; + +enum rtw_rate_index { + RTW_RATEID_BGN_40M_2SS = 0, + RTW_RATEID_BGN_40M_1SS = 1, + RTW_RATEID_BGN_20M_2SS = 2, + RTW_RATEID_BGN_20M_1SS = 3, + RTW_RATEID_GN_N2SS = 4, + RTW_RATEID_GN_N1SS = 5, + RTW_RATEID_BG = 6, + RTW_RATEID_G = 7, + RTW_RATEID_B_20M = 8, + RTW_RATEID_ARFR0_AC_2SS = 9, + RTW_RATEID_ARFR1_AC_1SS = 10, + RTW_RATEID_ARFR2_AC_2G_1SS = 11, + RTW_RATEID_ARFR3_AC_2G_2SS = 12, + RTW_RATEID_ARFR4_AC_3SS = 13, + RTW_RATEID_ARFR5_N_3SS = 14, + RTW_RATEID_ARFR7_N_4SS = 15, + RTW_RATEID_ARFR6_AC_4SS = 16 +}; + +enum rtw_trx_desc_rate { + DESC_RATE1M = 0x00, + DESC_RATE2M = 0x01, + DESC_RATE5_5M = 0x02, + DESC_RATE11M = 0x03, + + DESC_RATE6M = 0x04, + DESC_RATE9M = 0x05, + DESC_RATE12M = 0x06, + DESC_RATE18M = 0x07, + DESC_RATE24M = 0x08, + DESC_RATE36M = 0x09, + DESC_RATE48M = 0x0a, + DESC_RATE54M = 0x0b, + + DESC_RATEMCS0 = 0x0c, + DESC_RATEMCS1 = 0x0d, + DESC_RATEMCS2 = 0x0e, + DESC_RATEMCS3 = 0x0f, + DESC_RATEMCS4 = 0x10, + DESC_RATEMCS5 = 0x11, + DESC_RATEMCS6 = 0x12, + DESC_RATEMCS7 = 0x13, + DESC_RATEMCS8 = 0x14, + DESC_RATEMCS9 = 0x15, + DESC_RATEMCS10 = 0x16, + DESC_RATEMCS11 = 0x17, + DESC_RATEMCS12 = 0x18, + DESC_RATEMCS13 = 0x19, + DESC_RATEMCS14 = 0x1a, + DESC_RATEMCS15 = 0x1b, + DESC_RATEMCS16 = 0x1c, + DESC_RATEMCS17 = 0x1d, + DESC_RATEMCS18 = 0x1e, + DESC_RATEMCS19 = 0x1f, + DESC_RATEMCS20 = 0x20, + DESC_RATEMCS21 = 0x21, + DESC_RATEMCS22 = 0x22, + DESC_RATEMCS23 = 0x23, + DESC_RATEMCS24 = 0x24, + DESC_RATEMCS25 = 0x25, + DESC_RATEMCS26 = 0x26, + DESC_RATEMCS27 = 0x27, + DESC_RATEMCS28 = 0x28, + DESC_RATEMCS29 = 0x29, + DESC_RATEMCS30 = 0x2a, + DESC_RATEMCS31 = 0x2b, + + DESC_RATEVHT1SS_MCS0 = 0x2c, + DESC_RATEVHT1SS_MCS1 = 0x2d, + DESC_RATEVHT1SS_MCS2 = 0x2e, + DESC_RATEVHT1SS_MCS3 = 0x2f, + DESC_RATEVHT1SS_MCS4 = 0x30, + DESC_RATEVHT1SS_MCS5 = 0x31, + DESC_RATEVHT1SS_MCS6 = 0x32, + DESC_RATEVHT1SS_MCS7 = 0x33, + DESC_RATEVHT1SS_MCS8 = 0x34, + DESC_RATEVHT1SS_MCS9 = 0x35, + + DESC_RATEVHT2SS_MCS0 = 0x36, + DESC_RATEVHT2SS_MCS1 = 0x37, + DESC_RATEVHT2SS_MCS2 = 0x38, + DESC_RATEVHT2SS_MCS3 = 0x39, + DESC_RATEVHT2SS_MCS4 = 0x3a, + DESC_RATEVHT2SS_MCS5 = 0x3b, + DESC_RATEVHT2SS_MCS6 = 0x3c, + DESC_RATEVHT2SS_MCS7 = 0x3d, + DESC_RATEVHT2SS_MCS8 = 0x3e, + DESC_RATEVHT2SS_MCS9 = 0x3f, + + DESC_RATEVHT3SS_MCS0 = 0x40, + DESC_RATEVHT3SS_MCS1 = 0x41, + DESC_RATEVHT3SS_MCS2 = 0x42, + DESC_RATEVHT3SS_MCS3 = 0x43, + DESC_RATEVHT3SS_MCS4 = 0x44, + DESC_RATEVHT3SS_MCS5 = 0x45, + DESC_RATEVHT3SS_MCS6 = 0x46, + DESC_RATEVHT3SS_MCS7 = 0x47, + DESC_RATEVHT3SS_MCS8 = 0x48, + DESC_RATEVHT3SS_MCS9 = 0x49, + + DESC_RATEVHT4SS_MCS0 = 0x4a, + DESC_RATEVHT4SS_MCS1 = 0x4b, + DESC_RATEVHT4SS_MCS2 = 0x4c, + DESC_RATEVHT4SS_MCS3 = 0x4d, + DESC_RATEVHT4SS_MCS4 = 0x4e, + DESC_RATEVHT4SS_MCS5 = 0x4f, + DESC_RATEVHT4SS_MCS6 = 0x50, + DESC_RATEVHT4SS_MCS7 = 0x51, + DESC_RATEVHT4SS_MCS8 = 0x52, + DESC_RATEVHT4SS_MCS9 = 0x53, + + DESC_RATE_MAX, +}; + +enum rtw_regulatory_domains { + RTW_REGD_FCC = 0, + RTW_REGD_MKK = 1, + RTW_REGD_ETSI = 2, + RTW_REGD_IC = 3, + RTW_REGD_KCC = 4, + RTW_REGD_ACMA = 5, + RTW_REGD_CHILE = 6, + RTW_REGD_UKRAINE = 7, + RTW_REGD_MEXICO = 8, + RTW_REGD_CN = 9, + RTW_REGD_WW, + + RTW_REGD_MAX +}; + +enum rtw_txq_flags { + RTW_TXQ_AMPDU, + RTW_TXQ_BLOCK_BA, +}; + +enum rtw_flags { + RTW_FLAG_RUNNING, + RTW_FLAG_FW_RUNNING, + RTW_FLAG_SCANNING, + RTW_FLAG_POWERON, + RTW_FLAG_LEISURE_PS, + RTW_FLAG_LEISURE_PS_DEEP, + RTW_FLAG_DIG_DISABLE, + RTW_FLAG_BUSY_TRAFFIC, + RTW_FLAG_WOWLAN, + RTW_FLAG_RESTARTING, + RTW_FLAG_RESTART_TRIGGERING, + RTW_FLAG_FORCE_LOWEST_RATE, + + NUM_OF_RTW_FLAGS, +}; + +enum rtw_evm { + RTW_EVM_OFDM = 0, + RTW_EVM_1SS, + RTW_EVM_2SS_A, + RTW_EVM_2SS_B, + /* keep it last */ + RTW_EVM_NUM +}; + +enum rtw_snr { + RTW_SNR_OFDM_A = 0, + RTW_SNR_OFDM_B, + RTW_SNR_OFDM_C, + RTW_SNR_OFDM_D, + RTW_SNR_1SS_A, + RTW_SNR_1SS_B, + RTW_SNR_1SS_C, + RTW_SNR_1SS_D, + RTW_SNR_2SS_A, + RTW_SNR_2SS_B, + RTW_SNR_2SS_C, + RTW_SNR_2SS_D, + /* keep it last */ + RTW_SNR_NUM +}; + +enum rtw_port { + RTW_PORT_0 = 0, + RTW_PORT_1 = 1, + RTW_PORT_2 = 2, + RTW_PORT_3 = 3, + RTW_PORT_4 = 4, + RTW_PORT_NUM +}; + +enum rtw_wow_flags { + RTW_WOW_FLAG_EN_MAGIC_PKT, + RTW_WOW_FLAG_EN_REKEY_PKT, + RTW_WOW_FLAG_EN_DISCONNECT, + + /* keep it last */ + RTW_WOW_FLAG_MAX, +}; + +/* the power index is represented by differences, which cck-1s & ht40-1s are + * the base values, so for 1s's differences, there are only ht20 & ofdm + */ +struct rtw_2g_1s_pwr_idx_diff { +#ifdef __LITTLE_ENDIAN + s8 ofdm:4; + s8 bw20:4; +#else + s8 bw20:4; + s8 ofdm:4; +#endif +} __packed; + +struct rtw_2g_ns_pwr_idx_diff { +#ifdef __LITTLE_ENDIAN + s8 bw20:4; + s8 bw40:4; + s8 cck:4; + s8 ofdm:4; +#else + s8 ofdm:4; + s8 cck:4; + s8 bw40:4; + s8 bw20:4; +#endif +} __packed; + +struct rtw_2g_txpwr_idx { + u8 cck_base[6]; + u8 bw40_base[5]; + struct rtw_2g_1s_pwr_idx_diff ht_1s_diff; + struct rtw_2g_ns_pwr_idx_diff ht_2s_diff; + struct rtw_2g_ns_pwr_idx_diff ht_3s_diff; + struct rtw_2g_ns_pwr_idx_diff ht_4s_diff; +}; + +struct rtw_5g_ht_1s_pwr_idx_diff { +#ifdef __LITTLE_ENDIAN + s8 ofdm:4; + s8 bw20:4; +#else + s8 bw20:4; + s8 ofdm:4; +#endif +} __packed; + +struct rtw_5g_ht_ns_pwr_idx_diff { +#ifdef __LITTLE_ENDIAN + s8 bw20:4; + s8 bw40:4; +#else + s8 bw40:4; + s8 bw20:4; +#endif +} __packed; + +struct rtw_5g_ofdm_ns_pwr_idx_diff { +#ifdef __LITTLE_ENDIAN + s8 ofdm_3s:4; + s8 ofdm_2s:4; + s8 ofdm_4s:4; + s8 res:4; +#else + s8 res:4; + s8 ofdm_4s:4; + s8 ofdm_2s:4; + s8 ofdm_3s:4; +#endif +} __packed; + +struct rtw_5g_vht_ns_pwr_idx_diff { +#ifdef __LITTLE_ENDIAN + s8 bw160:4; + s8 bw80:4; +#else + s8 bw80:4; + s8 bw160:4; +#endif +} __packed; + +struct rtw_5g_txpwr_idx { + u8 bw40_base[14]; + struct rtw_5g_ht_1s_pwr_idx_diff ht_1s_diff; + struct rtw_5g_ht_ns_pwr_idx_diff ht_2s_diff; + struct rtw_5g_ht_ns_pwr_idx_diff ht_3s_diff; + struct rtw_5g_ht_ns_pwr_idx_diff ht_4s_diff; + struct rtw_5g_ofdm_ns_pwr_idx_diff ofdm_diff; + struct rtw_5g_vht_ns_pwr_idx_diff vht_1s_diff; + struct rtw_5g_vht_ns_pwr_idx_diff vht_2s_diff; + struct rtw_5g_vht_ns_pwr_idx_diff vht_3s_diff; + struct rtw_5g_vht_ns_pwr_idx_diff vht_4s_diff; +}; + +struct rtw_txpwr_idx { + struct rtw_2g_txpwr_idx pwr_idx_2g; + struct rtw_5g_txpwr_idx pwr_idx_5g; +}; + +struct rtw_channel_params { + u8 center_chan; + u8 primary_chan; + u8 bandwidth; +}; + +struct rtw_hw_reg { + u32 addr; + u32 mask; +}; + +struct rtw_ltecoex_addr { + u32 ctrl; + u32 wdata; + u32 rdata; +}; + +struct rtw_reg_domain { + u32 addr; + u32 mask; +#define RTW_REG_DOMAIN_MAC32 0 +#define RTW_REG_DOMAIN_MAC16 1 +#define RTW_REG_DOMAIN_MAC8 2 +#define RTW_REG_DOMAIN_RF_A 3 +#define RTW_REG_DOMAIN_RF_B 4 +#define RTW_REG_DOMAIN_NL 0xFF + u8 domain; +}; + +struct rtw_rf_sipi_addr { + u32 hssi_1; + u32 hssi_2; + u32 lssi_read; + u32 lssi_read_pi; +}; + +struct rtw_hw_reg_offset { + struct rtw_hw_reg hw_reg; + u8 offset; +}; + +struct rtw_backup_info { + u8 len; + u32 reg; + u32 val; +}; + +enum rtw_vif_port_set { + PORT_SET_MAC_ADDR = BIT(0), + PORT_SET_BSSID = BIT(1), + PORT_SET_NET_TYPE = BIT(2), + PORT_SET_AID = BIT(3), + PORT_SET_BCN_CTRL = BIT(4), +}; + +struct rtw_vif_port { + struct rtw_hw_reg mac_addr; + struct rtw_hw_reg bssid; + struct rtw_hw_reg net_type; + struct rtw_hw_reg aid; + struct rtw_hw_reg bcn_ctrl; +}; + +struct rtw_tx_pkt_info { + u32 tx_pkt_size; + u8 offset; + u8 pkt_offset; + u8 tim_offset; + u8 mac_id; + u8 rate_id; + u8 rate; + u8 qsel; + u8 bw; + u8 sec_type; + u8 sn; + bool ampdu_en; + u8 ampdu_factor; + u8 ampdu_density; + u16 seq; + bool stbc; + bool ldpc; + bool dis_rate_fallback; + bool bmc; + bool use_rate; + bool ls; + bool fs; + bool short_gi; + bool report; + bool rts; + bool dis_qselseq; + bool en_hwseq; + u8 hw_ssn_sel; + bool nav_use_hdr; + bool bt_null; +}; + +struct rtw_rx_pkt_stat { + bool phy_status; + bool icv_err; + bool crc_err; + bool decrypted; + bool is_c2h; + + s32 signal_power; + u16 pkt_len; + u8 bw; + u8 drv_info_sz; + u8 shift; + u8 rate; + u8 mac_id; + u8 cam_id; + u8 ppdu_cnt; + u32 tsf_low; + s8 rx_power[RTW_RF_PATH_MAX]; + u8 rssi; + u8 rxsc; + s8 rx_snr[RTW_RF_PATH_MAX]; + u8 rx_evm[RTW_RF_PATH_MAX]; + s8 cfo_tail[RTW_RF_PATH_MAX]; + u16 freq; + u8 band; + + struct rtw_sta_info *si; + struct ieee80211_vif *vif; + struct ieee80211_hdr *hdr; +}; + +DECLARE_EWMA(tp, 10, 2); + +struct rtw_traffic_stats { + /* units in bytes */ + u64 tx_unicast; + u64 rx_unicast; + + /* count for packets */ + u64 tx_cnt; + u64 rx_cnt; + + /* units in Mbps */ + u32 tx_throughput; + u32 rx_throughput; + struct ewma_tp tx_ewma_tp; + struct ewma_tp rx_ewma_tp; +}; + +enum rtw_lps_mode { + RTW_MODE_ACTIVE = 0, + RTW_MODE_LPS = 1, + RTW_MODE_WMM_PS = 2, +}; + +enum rtw_lps_deep_mode { + LPS_DEEP_MODE_NONE = 0, + LPS_DEEP_MODE_LCLK = 1, + LPS_DEEP_MODE_PG = 2, +}; + +enum rtw_pwr_state { + RTW_RF_OFF = 0x0, + RTW_RF_ON = 0x4, + RTW_ALL_ON = 0xc, +}; + +struct rtw_lps_conf { + enum rtw_lps_mode mode; + enum rtw_lps_deep_mode deep_mode; + enum rtw_lps_deep_mode wow_deep_mode; + enum rtw_pwr_state state; + u8 awake_interval; + u8 rlbm; + u8 smart_ps; + u8 port_id; + bool sec_cam_backup; + bool pattern_cam_backup; +}; + +enum rtw_hw_key_type { + RTW_CAM_NONE = 0, + RTW_CAM_WEP40 = 1, + RTW_CAM_TKIP = 2, + RTW_CAM_AES = 4, + RTW_CAM_WEP104 = 5, +}; + +struct rtw_cam_entry { + bool valid; + bool group; + u8 addr[ETH_ALEN]; + u8 hw_key_type; + struct ieee80211_key_conf *key; +}; + +struct rtw_sec_desc { + /* search strategy */ + bool default_key_search; + + u32 total_cam_num; + struct rtw_cam_entry cam_table[RTW_MAX_SEC_CAM_NUM]; + DECLARE_BITMAP(cam_map, RTW_MAX_SEC_CAM_NUM); +}; + +struct rtw_tx_report { + /* protect the tx report queue */ + spinlock_t q_lock; + struct sk_buff_head queue; + atomic_t sn; + struct timer_list purge_timer; +}; + +struct rtw_ra_report { + struct rate_info txrate; + u32 bit_rate; + u8 desc_rate; +}; + +struct rtw_txq { + struct list_head list; + unsigned long flags; +}; + +#define RTW_BC_MC_MACID 1 +DECLARE_EWMA(rssi, 10, 16); + +struct rtw_sta_info { + struct rtw_dev *rtwdev; + struct ieee80211_sta *sta; + struct ieee80211_vif *vif; + + struct ewma_rssi avg_rssi; + u8 rssi_level; + + u8 mac_id; + u8 rate_id; + enum rtw_bandwidth bw_mode; + enum rtw_rf_type rf_type; + u8 stbc_en:2; + u8 ldpc_en:2; + bool sgi_enable; + bool vht_enable; + u8 init_ra_lv; + u64 ra_mask; + + DECLARE_BITMAP(tid_ba, IEEE80211_NUM_TIDS); + + struct rtw_ra_report ra_report; + + bool use_cfg_mask; + struct cfg80211_bitrate_mask *mask; + + struct work_struct rc_work; +}; + +enum rtw_bfee_role { + RTW_BFEE_NONE, + RTW_BFEE_SU, + RTW_BFEE_MU +}; + +struct rtw_bfee { + enum rtw_bfee_role role; + + u16 p_aid; + u8 g_id; + u8 mac_addr[ETH_ALEN]; + u8 sound_dim; + + /* SU-MIMO */ + u8 su_reg_index; + + /* MU-MIMO */ + u16 aid; +}; + +struct rtw_bf_info { + u8 bfer_mu_cnt; + u8 bfer_su_cnt; + DECLARE_BITMAP(bfer_su_reg_maping, 2); + u8 cur_csi_rpt_rate; +}; + +struct rtw_vif { + enum rtw_net_type net_type; + u16 aid; + u8 mac_id; /* for STA mode only */ + u8 mac_addr[ETH_ALEN]; + u8 bssid[ETH_ALEN]; + u8 port; + u8 bcn_ctrl; + struct list_head rsvd_page_list; + struct ieee80211_tx_queue_params tx_params[IEEE80211_NUM_ACS]; + const struct rtw_vif_port *conf; + struct cfg80211_scan_request *scan_req; + struct ieee80211_scan_ies *scan_ies; + + struct rtw_traffic_stats stats; + + struct rtw_bfee bfee; +}; + +struct rtw_regulatory { + char alpha2[2]; + u8 txpwr_regd_2g; + u8 txpwr_regd_5g; +}; + +enum rtw_regd_state { + RTW_REGD_STATE_WORLDWIDE, + RTW_REGD_STATE_PROGRAMMED, + RTW_REGD_STATE_SETTING, + + RTW_REGD_STATE_NR, +}; + +struct rtw_regd { + enum rtw_regd_state state; + const struct rtw_regulatory *regulatory; + enum nl80211_dfs_regions dfs_region; +}; + +struct rtw_chip_ops { + int (*mac_init)(struct rtw_dev *rtwdev); + int (*dump_fw_crash)(struct rtw_dev *rtwdev); + void (*shutdown)(struct rtw_dev *rtwdev); + int (*read_efuse)(struct rtw_dev *rtwdev, u8 *map); + void (*phy_set_param)(struct rtw_dev *rtwdev); + void (*set_channel)(struct rtw_dev *rtwdev, u8 channel, + u8 bandwidth, u8 primary_chan_idx); + void (*query_rx_desc)(struct rtw_dev *rtwdev, u8 *rx_desc, + struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_rx_status *rx_status); + u32 (*read_rf)(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask); + bool (*write_rf)(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask, u32 data); + void (*set_tx_power_index)(struct rtw_dev *rtwdev); + int (*rsvd_page_dump)(struct rtw_dev *rtwdev, u8 *buf, u32 offset, + u32 size); + int (*set_antenna)(struct rtw_dev *rtwdev, + u32 antenna_tx, + u32 antenna_rx); + void (*cfg_ldo25)(struct rtw_dev *rtwdev, bool enable); + void (*efuse_grant)(struct rtw_dev *rtwdev, bool enable); + void (*false_alarm_statistics)(struct rtw_dev *rtwdev); + void (*phy_calibration)(struct rtw_dev *rtwdev); + void (*dpk_track)(struct rtw_dev *rtwdev); + void (*cck_pd_set)(struct rtw_dev *rtwdev, u8 level); + void (*pwr_track)(struct rtw_dev *rtwdev); + void (*config_bfee)(struct rtw_dev *rtwdev, struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable); + void (*set_gid_table)(struct rtw_dev *rtwdev, + struct ieee80211_vif *vif, + struct ieee80211_bss_conf *conf); + void (*cfg_csi_rate)(struct rtw_dev *rtwdev, u8 rssi, u8 cur_rate, + u8 fixrate_en, u8 *new_rate); + void (*adaptivity_init)(struct rtw_dev *rtwdev); + void (*adaptivity)(struct rtw_dev *rtwdev); + void (*cfo_init)(struct rtw_dev *rtwdev); + void (*cfo_track)(struct rtw_dev *rtwdev); + void (*config_tx_path)(struct rtw_dev *rtwdev, u8 tx_path, + enum rtw_bb_path tx_path_1ss, + enum rtw_bb_path tx_path_cck, + bool is_tx2_path); + void (*config_txrx_mode)(struct rtw_dev *rtwdev, u8 tx_path, + u8 rx_path, bool is_tx2_path); + /* for USB/SDIO only */ + void (*fill_txdesc_checksum)(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *txdesc); + + /* for coex */ + void (*coex_set_init)(struct rtw_dev *rtwdev); + void (*coex_set_ant_switch)(struct rtw_dev *rtwdev, + u8 ctrl_type, u8 pos_type); + void (*coex_set_gnt_fix)(struct rtw_dev *rtwdev); + void (*coex_set_gnt_debug)(struct rtw_dev *rtwdev); + void (*coex_set_rfe_type)(struct rtw_dev *rtwdev); + void (*coex_set_wl_tx_power)(struct rtw_dev *rtwdev, u8 wl_pwr); + void (*coex_set_wl_rx_gain)(struct rtw_dev *rtwdev, bool low_gain); +}; + +#define RTW_PWR_POLLING_CNT 20000 + +#define RTW_PWR_CMD_READ 0x00 +#define RTW_PWR_CMD_WRITE 0x01 +#define RTW_PWR_CMD_POLLING 0x02 +#define RTW_PWR_CMD_DELAY 0x03 +#define RTW_PWR_CMD_END 0x04 + +/* define the base address of each block */ +#define RTW_PWR_ADDR_MAC 0x00 +#define RTW_PWR_ADDR_USB 0x01 +#define RTW_PWR_ADDR_PCIE 0x02 +#define RTW_PWR_ADDR_SDIO 0x03 + +#define RTW_PWR_INTF_SDIO_MSK BIT(0) +#define RTW_PWR_INTF_USB_MSK BIT(1) +#define RTW_PWR_INTF_PCI_MSK BIT(2) +#define RTW_PWR_INTF_ALL_MSK (BIT(0) | BIT(1) | BIT(2) | BIT(3)) + +#define RTW_PWR_CUT_TEST_MSK BIT(0) +#define RTW_PWR_CUT_A_MSK BIT(1) +#define RTW_PWR_CUT_B_MSK BIT(2) +#define RTW_PWR_CUT_C_MSK BIT(3) +#define RTW_PWR_CUT_D_MSK BIT(4) +#define RTW_PWR_CUT_E_MSK BIT(5) +#define RTW_PWR_CUT_F_MSK BIT(6) +#define RTW_PWR_CUT_G_MSK BIT(7) +#define RTW_PWR_CUT_ALL_MSK 0xFF + +enum rtw_pwr_seq_cmd_delay_unit { + RTW_PWR_DELAY_US, + RTW_PWR_DELAY_MS, +}; + +struct rtw_pwr_seq_cmd { + u16 offset; + u8 cut_mask; + u8 intf_mask; + u8 base:4; + u8 cmd:4; + u8 mask; + u8 value; +}; + +enum rtw_chip_ver { + RTW_CHIP_VER_CUT_A = 0x00, + RTW_CHIP_VER_CUT_B = 0x01, + RTW_CHIP_VER_CUT_C = 0x02, + RTW_CHIP_VER_CUT_D = 0x03, + RTW_CHIP_VER_CUT_E = 0x04, + RTW_CHIP_VER_CUT_F = 0x05, + RTW_CHIP_VER_CUT_G = 0x06, +}; + +#define RTW_INTF_PHY_PLATFORM_ALL 0 + +enum rtw_intf_phy_cut { + RTW_INTF_PHY_CUT_A = BIT(0), + RTW_INTF_PHY_CUT_B = BIT(1), + RTW_INTF_PHY_CUT_C = BIT(2), + RTW_INTF_PHY_CUT_D = BIT(3), + RTW_INTF_PHY_CUT_E = BIT(4), + RTW_INTF_PHY_CUT_F = BIT(5), + RTW_INTF_PHY_CUT_G = BIT(6), + RTW_INTF_PHY_CUT_ALL = 0xFFFF, +}; + +enum rtw_ip_sel { + RTW_IP_SEL_PHY = 0, + RTW_IP_SEL_MAC = 1, + RTW_IP_SEL_DBI = 2, + + RTW_IP_SEL_UNDEF = 0xFFFF +}; + +enum rtw_pq_map_id { + RTW_PQ_MAP_VO = 0x0, + RTW_PQ_MAP_VI = 0x1, + RTW_PQ_MAP_BE = 0x2, + RTW_PQ_MAP_BK = 0x3, + RTW_PQ_MAP_MG = 0x4, + RTW_PQ_MAP_HI = 0x5, + RTW_PQ_MAP_NUM = 0x6, + + RTW_PQ_MAP_UNDEF, +}; + +enum rtw_dma_mapping { + RTW_DMA_MAPPING_EXTRA = 0, + RTW_DMA_MAPPING_LOW = 1, + RTW_DMA_MAPPING_NORMAL = 2, + RTW_DMA_MAPPING_HIGH = 3, + + RTW_DMA_MAPPING_MAX, + RTW_DMA_MAPPING_UNDEF, +}; + +struct rtw_rqpn { + enum rtw_dma_mapping dma_map_vo; + enum rtw_dma_mapping dma_map_vi; + enum rtw_dma_mapping dma_map_be; + enum rtw_dma_mapping dma_map_bk; + enum rtw_dma_mapping dma_map_mg; + enum rtw_dma_mapping dma_map_hi; +}; + +struct rtw_prioq_addr { + u32 rsvd; + u32 avail; +}; + +struct rtw_prioq_addrs { + struct rtw_prioq_addr prio[RTW_DMA_MAPPING_MAX]; + bool wsize; +}; + +struct rtw_page_table { + u16 hq_num; + u16 nq_num; + u16 lq_num; + u16 exq_num; + u16 gapq_num; +}; + +struct rtw_intf_phy_para { + u16 offset; + u16 value; + u16 ip_sel; + u16 cut_mask; + u16 platform; +}; + +struct rtw_wow_pattern { + u16 crc; + u8 type; + u8 valid; + u8 mask[RTW_MAX_PATTERN_MASK_SIZE]; +}; + +struct rtw_pno_request { + bool inited; + u32 match_set_cnt; + struct cfg80211_match_set *match_sets; + u8 channel_cnt; + struct ieee80211_channel *channels; + struct cfg80211_sched_scan_plan scan_plan; +}; + +struct rtw_wow_param { + struct ieee80211_vif *wow_vif; + DECLARE_BITMAP(flags, RTW_WOW_FLAG_MAX); + u8 txpause; + u8 pattern_cnt; + struct rtw_wow_pattern patterns[RTW_MAX_PATTERN_NUM]; + + bool ips_enabled; + struct rtw_pno_request pno_req; +}; + +struct rtw_intf_phy_para_table { + const struct rtw_intf_phy_para *usb2_para; + const struct rtw_intf_phy_para *usb3_para; + const struct rtw_intf_phy_para *gen1_para; + const struct rtw_intf_phy_para *gen2_para; + u8 n_usb2_para; + u8 n_usb3_para; + u8 n_gen1_para; + u8 n_gen2_para; +}; + +struct rtw_table { + const void *data; + const u32 size; + void (*parse)(struct rtw_dev *rtwdev, const struct rtw_table *tbl); + void (*do_cfg)(struct rtw_dev *rtwdev, const struct rtw_table *tbl, + u32 addr, u32 data); + enum rtw_rf_path rf_path; +}; + +static inline void rtw_load_table(struct rtw_dev *rtwdev, + const struct rtw_table *tbl) +{ + (*tbl->parse)(rtwdev, tbl); +} + +enum rtw_rfe_fem { + RTW_RFE_IFEM, + RTW_RFE_EFEM, + RTW_RFE_IFEM2G_EFEM5G, + RTW_RFE_NUM, +}; + +struct rtw_rfe_def { + const struct rtw_table *phy_pg_tbl; + const struct rtw_table *txpwr_lmt_tbl; + const struct rtw_table *agc_btg_tbl; +}; + +#define RTW_DEF_RFE(chip, bb_pg, pwrlmt) { \ + .phy_pg_tbl = &rtw ## chip ## _bb_pg_type ## bb_pg ## _tbl, \ + .txpwr_lmt_tbl = &rtw ## chip ## _txpwr_lmt_type ## pwrlmt ## _tbl, \ + } + +#define RTW_DEF_RFE_EXT(chip, bb_pg, pwrlmt, btg) { \ + .phy_pg_tbl = &rtw ## chip ## _bb_pg_type ## bb_pg ## _tbl, \ + .txpwr_lmt_tbl = &rtw ## chip ## _txpwr_lmt_type ## pwrlmt ## _tbl, \ + .agc_btg_tbl = &rtw ## chip ## _agc_btg_type ## btg ## _tbl, \ + } + +#define RTW_PWR_TRK_5G_1 0 +#define RTW_PWR_TRK_5G_2 1 +#define RTW_PWR_TRK_5G_3 2 +#define RTW_PWR_TRK_5G_NUM 3 + +#define RTW_PWR_TRK_TBL_SZ 30 + +/* This table stores the values of TX power that will be adjusted by power + * tracking. + * + * For 5G bands, there are 3 different settings. + * For 2G there are cck rate and ofdm rate with different settings. + */ +struct rtw_pwr_track_tbl { + const u8 *pwrtrk_5gb_n[RTW_PWR_TRK_5G_NUM]; + const u8 *pwrtrk_5gb_p[RTW_PWR_TRK_5G_NUM]; + const u8 *pwrtrk_5ga_n[RTW_PWR_TRK_5G_NUM]; + const u8 *pwrtrk_5ga_p[RTW_PWR_TRK_5G_NUM]; + const u8 *pwrtrk_2gb_n; + const u8 *pwrtrk_2gb_p; + const u8 *pwrtrk_2ga_n; + const u8 *pwrtrk_2ga_p; + const u8 *pwrtrk_2g_cckb_n; + const u8 *pwrtrk_2g_cckb_p; + const u8 *pwrtrk_2g_ccka_n; + const u8 *pwrtrk_2g_ccka_p; + const s8 *pwrtrk_xtal_n; + const s8 *pwrtrk_xtal_p; +}; + +enum rtw_wlan_cpu { + RTW_WCPU_11AC, + RTW_WCPU_11N, +}; + +enum rtw_fw_fifo_sel { + RTW_FW_FIFO_SEL_TX, + RTW_FW_FIFO_SEL_RX, + RTW_FW_FIFO_SEL_RSVD_PAGE, + RTW_FW_FIFO_SEL_REPORT, + RTW_FW_FIFO_SEL_LLT, + RTW_FW_FIFO_SEL_RXBUF_FW, + + RTW_FW_FIFO_MAX, +}; + +enum rtw_fwcd_item { + RTW_FWCD_TLV, + RTW_FWCD_REG, + RTW_FWCD_ROM, + RTW_FWCD_IMEM, + RTW_FWCD_DMEM, + RTW_FWCD_EMEM, +}; + +/* hardware configuration for each IC */ +struct rtw_chip_info { + struct rtw_chip_ops *ops; + u8 id; + + const char *fw_name; + enum rtw_wlan_cpu wlan_cpu; + u8 tx_pkt_desc_sz; + u8 tx_buf_desc_sz; + u8 rx_pkt_desc_sz; + u8 rx_buf_desc_sz; + u32 phy_efuse_size; + u32 log_efuse_size; + u32 ptct_efuse_size; + u32 txff_size; + u32 rxff_size; + u32 fw_rxff_size; + u16 rsvd_drv_pg_num; + u8 band; + u8 page_size; + u8 csi_buf_pg_num; + u8 dig_max; + u8 dig_min; + u8 txgi_factor; + bool is_pwr_by_rate_dec; + bool rx_ldpc; + bool tx_stbc; + u8 max_power_index; + u8 ampdu_density; + + u16 fw_fifo_addr[RTW_FW_FIFO_MAX]; + const struct rtw_fwcd_segs *fwcd_segs; + + u8 default_1ss_tx_path; + + bool path_div_supported; + bool ht_supported; + bool vht_supported; + u8 lps_deep_mode_supported; + + /* init values */ + u8 sys_func_en; + const struct rtw_pwr_seq_cmd **pwr_on_seq; + const struct rtw_pwr_seq_cmd **pwr_off_seq; + const struct rtw_rqpn *rqpn_table; + const struct rtw_prioq_addrs *prioq_addrs; + const struct rtw_page_table *page_table; + const struct rtw_intf_phy_para_table *intf_table; + + const struct rtw_hw_reg *dig; + const struct rtw_hw_reg *dig_cck; + u32 rf_base_addr[2]; + u32 rf_sipi_addr[2]; + const struct rtw_rf_sipi_addr *rf_sipi_read_addr; + u8 fix_rf_phy_num; + const struct rtw_ltecoex_addr *ltecoex_addr; + + const struct rtw_table *mac_tbl; + const struct rtw_table *agc_tbl; + const struct rtw_table *bb_tbl; + const struct rtw_table *rf_tbl[RTW_RF_PATH_MAX]; + const struct rtw_table *rfk_init_tbl; + + const struct rtw_rfe_def *rfe_defs; + u32 rfe_defs_size; + + bool en_dis_dpd; + u16 dpd_ratemask; + u8 iqk_threshold; + u8 lck_threshold; + const struct rtw_pwr_track_tbl *pwr_track_tbl; + + u8 bfer_su_max_num; + u8 bfer_mu_max_num; + + struct rtw_hw_reg_offset *edcca_th; + s8 l2h_th_ini_cs; + s8 l2h_th_ini_ad; + + const char *wow_fw_name; + const struct wiphy_wowlan_support *wowlan_stub; + const u8 max_sched_scan_ssids; + const u16 max_scan_ie_len; + + /* coex paras */ + u32 coex_para_ver; + u8 bt_desired_ver; + bool scbd_support; + bool new_scbd10_def; /* true: fix 2M(8822c) */ + bool ble_hid_profile_support; + bool wl_mimo_ps_support; + u8 pstdma_type; /* 0: LPSoff, 1:LPSon */ + u8 bt_rssi_type; + u8 ant_isolation; + u8 rssi_tolerance; + u8 table_sant_num; + u8 table_nsant_num; + u8 tdma_sant_num; + u8 tdma_nsant_num; + u8 bt_afh_span_bw20; + u8 bt_afh_span_bw40; + u8 afh_5g_num; + u8 wl_rf_para_num; + u8 coex_info_hw_regs_num; + const u8 *bt_rssi_step; + const u8 *wl_rssi_step; + const struct coex_table_para *table_nsant; + const struct coex_table_para *table_sant; + const struct coex_tdma_para *tdma_sant; + const struct coex_tdma_para *tdma_nsant; + const struct coex_rf_para *wl_rf_para_tx; + const struct coex_rf_para *wl_rf_para_rx; + const struct coex_5g_afh_map *afh_5g; + const struct rtw_hw_reg *btg_reg; + const struct rtw_reg_domain *coex_info_hw_regs; + u32 wl_fw_desired_ver; +}; + +enum rtw_coex_bt_state_cnt { + COEX_CNT_BT_RETRY, + COEX_CNT_BT_REINIT, + COEX_CNT_BT_REENABLE, + COEX_CNT_BT_POPEVENT, + COEX_CNT_BT_SETUPLINK, + COEX_CNT_BT_IGNWLANACT, + COEX_CNT_BT_INQ, + COEX_CNT_BT_PAGE, + COEX_CNT_BT_ROLESWITCH, + COEX_CNT_BT_AFHUPDATE, + COEX_CNT_BT_INFOUPDATE, + COEX_CNT_BT_IQK, + COEX_CNT_BT_IQKFAIL, + + COEX_CNT_BT_MAX +}; + +enum rtw_coex_wl_state_cnt { + COEX_CNT_WL_SCANAP, + COEX_CNT_WL_CONNPKT, + COEX_CNT_WL_COEXRUN, + COEX_CNT_WL_NOISY0, + COEX_CNT_WL_NOISY1, + COEX_CNT_WL_NOISY2, + COEX_CNT_WL_5MS_NOEXTEND, + COEX_CNT_WL_FW_NOTIFY, + + COEX_CNT_WL_MAX +}; + +struct rtw_coex_rfe { + bool ant_switch_exist; + bool ant_switch_diversity; + bool ant_switch_with_bt; + u8 rfe_module_type; + u8 ant_switch_polarity; + + /* true if WLG at BTG, else at WLAG */ + bool wlg_at_btg; +}; + +#define COEX_WL_TDMA_PARA_LENGTH 5 + +struct rtw_coex_dm { + bool cur_ps_tdma_on; + bool cur_wl_rx_low_gain_en; + bool ignore_wl_act; + + u8 reason; + u8 bt_rssi_state[4]; + u8 wl_rssi_state[4]; + u8 wl_ch_info[3]; + u8 cur_ps_tdma; + u8 cur_table; + u8 ps_tdma_para[5]; + u8 cur_bt_pwr_lvl; + u8 cur_bt_lna_lvl; + u8 cur_wl_pwr_lvl; + u8 bt_status; + u32 cur_ant_pos_type; + u32 cur_switch_status; + u32 setting_tdma; + u8 fw_tdma_para[COEX_WL_TDMA_PARA_LENGTH]; +}; + +#define COEX_BTINFO_SRC_WL_FW 0x0 +#define COEX_BTINFO_SRC_BT_RSP 0x1 +#define COEX_BTINFO_SRC_BT_ACT 0x2 +#define COEX_BTINFO_SRC_BT_IQK 0x3 +#define COEX_BTINFO_SRC_BT_SCBD 0x4 +#define COEX_BTINFO_SRC_H2C60 0x5 +#define COEX_BTINFO_SRC_MAX 0x6 + +#define COEX_INFO_FTP BIT(7) +#define COEX_INFO_A2DP BIT(6) +#define COEX_INFO_HID BIT(5) +#define COEX_INFO_SCO_BUSY BIT(4) +#define COEX_INFO_ACL_BUSY BIT(3) +#define COEX_INFO_INQ_PAGE BIT(2) +#define COEX_INFO_SCO_ESCO BIT(1) +#define COEX_INFO_CONNECTION BIT(0) +#define COEX_BTINFO_LENGTH_MAX 10 +#define COEX_BTINFO_LENGTH 7 + +#define COEX_BT_HIDINFO_LIST 0x0 +#define COEX_BT_HIDINFO_A 0x1 +#define COEX_BT_HIDINFO_NAME 3 + +#define COEX_BT_HIDINFO_LENGTH 6 +#define COEX_BT_HIDINFO_HANDLE_NUM 4 +#define COEX_BT_HIDINFO_C2H_HANDLE 0 +#define COEX_BT_HIDINFO_C2H_VENDOR 1 +#define COEX_BT_BLE_HANDLE_THRS 0x10 +#define COEX_BT_HIDINFO_NOTCON 0xff + +struct rtw_coex_hid { + u8 hid_handle; + u8 hid_vendor; + u8 hid_name[COEX_BT_HIDINFO_NAME]; + bool hid_info_completed; + bool is_game_hid; +}; + +struct rtw_coex_hid_handle_list { + u8 cmd_id; + u8 len; + u8 subid; + u8 handle_cnt; + u8 handle[COEX_BT_HIDINFO_HANDLE_NUM]; +} __packed; + +struct rtw_coex_hid_info_a { + u8 cmd_id; + u8 len; + u8 subid; + u8 handle; + u8 vendor; + u8 name[COEX_BT_HIDINFO_NAME]; +} __packed; + +struct rtw_coex_stat { + bool bt_disabled; + bool bt_disabled_pre; + bool bt_link_exist; + bool bt_whck_test; + bool bt_inq_page; + bool bt_inq_remain; + bool bt_inq; + bool bt_page; + bool bt_ble_voice; + bool bt_ble_exist; + bool bt_hfp_exist; + bool bt_a2dp_exist; + bool bt_hid_exist; + bool bt_pan_exist; /* PAN or OPP */ + bool bt_opp_exist; /* OPP only */ + bool bt_acl_busy; + bool bt_fix_2M; + bool bt_setup_link; + bool bt_multi_link; + bool bt_multi_link_pre; + bool bt_multi_link_remain; + bool bt_a2dp_sink; + bool bt_a2dp_active; + bool bt_reenable; + bool bt_ble_scan_en; + bool bt_init_scan; + bool bt_slave; + bool bt_418_hid_exist; + bool bt_ble_hid_exist; + bool bt_game_hid_exist; + bool bt_hid_handle_cnt; + bool bt_mailbox_reply; + + bool wl_under_lps; + bool wl_under_ips; + bool wl_hi_pri_task1; + bool wl_hi_pri_task2; + bool wl_force_lps_ctrl; + bool wl_gl_busy; + bool wl_linkscan_proc; + bool wl_ps_state_fail; + bool wl_tx_limit_en; + bool wl_ampdu_limit_en; + bool wl_connected; + bool wl_slot_extend; + bool wl_cck_lock; + bool wl_cck_lock_pre; + bool wl_cck_lock_ever; + bool wl_connecting; + bool wl_slot_toggle; + bool wl_slot_toggle_change; /* if toggle to no-toggle */ + bool wl_mimo_ps; + + u32 bt_supported_version; + u32 bt_supported_feature; + u32 hi_pri_tx; + u32 hi_pri_rx; + u32 lo_pri_tx; + u32 lo_pri_rx; + u32 patch_ver; + u16 bt_reg_vendor_ae; + u16 bt_reg_vendor_ac; + s8 bt_rssi; + u8 kt_ver; + u8 gnt_workaround_state; + u8 tdma_timer_base; + u8 bt_profile_num; + u8 bt_info_c2h[COEX_BTINFO_SRC_MAX][COEX_BTINFO_LENGTH_MAX]; + u8 bt_info_lb2; + u8 bt_info_lb3; + u8 bt_info_hb0; + u8 bt_info_hb1; + u8 bt_info_hb2; + u8 bt_info_hb3; + u8 bt_ble_scan_type; + u8 bt_hid_pair_num; + u8 bt_hid_slot; + u8 bt_a2dp_bitpool; + u8 bt_iqk_state; + + u16 wl_beacon_interval; + u8 wl_noisy_level; + u8 wl_fw_dbg_info[10]; + u8 wl_fw_dbg_info_pre[10]; + u8 wl_rx_rate; + u8 wl_tx_rate; + u8 wl_rts_rx_rate; + u8 wl_coex_mode; + u8 wl_iot_peer; + u8 ampdu_max_time; + u8 wl_tput_dir; + + u8 wl_toggle_para[6]; + u8 wl_toggle_interval; + + u16 score_board; + u16 retry_limit; + + /* counters to record bt states */ + u32 cnt_bt[COEX_CNT_BT_MAX]; + + /* counters to record wifi states */ + u32 cnt_wl[COEX_CNT_WL_MAX]; + + /* counters to record bt c2h data */ + u32 cnt_bt_info_c2h[COEX_BTINFO_SRC_MAX]; + + u32 darfrc; + u32 darfrch; + + struct rtw_coex_hid hid_info[COEX_BT_HIDINFO_HANDLE_NUM]; + struct rtw_coex_hid_handle_list hid_handle_list; +}; + +struct rtw_coex { + struct sk_buff_head queue; + wait_queue_head_t wait; + + bool under_5g; + bool stop_dm; + bool freeze; + bool freerun; + bool wl_rf_off; + bool manual_control; + + struct rtw_coex_stat stat; + struct rtw_coex_dm dm; + struct rtw_coex_rfe rfe; + + struct delayed_work bt_relink_work; + struct delayed_work bt_reenable_work; + struct delayed_work defreeze_work; + struct delayed_work wl_remain_work; + struct delayed_work bt_remain_work; + struct delayed_work wl_connecting_work; + struct delayed_work bt_multi_link_remain_work; + struct delayed_work wl_ccklock_work; + +}; + +#define DPK_RF_REG_NUM 7 +#define DPK_RF_PATH_NUM 2 +#define DPK_BB_REG_NUM 18 +#define DPK_CHANNEL_WIDTH_80 1 + +DECLARE_EWMA(thermal, 10, 4); + +struct rtw_dpk_info { + bool is_dpk_pwr_on; + bool is_reload; + + DECLARE_BITMAP(dpk_path_ok, DPK_RF_PATH_NUM); + + u8 thermal_dpk[DPK_RF_PATH_NUM]; + struct ewma_thermal avg_thermal[DPK_RF_PATH_NUM]; + + u32 gnt_control; + u32 gnt_value; + + u8 result[RTW_RF_PATH_MAX]; + u8 dpk_txagc[RTW_RF_PATH_MAX]; + u32 coef[RTW_RF_PATH_MAX][20]; + u16 dpk_gs[RTW_RF_PATH_MAX]; + u8 thermal_dpk_delta[RTW_RF_PATH_MAX]; + u8 pre_pwsf[RTW_RF_PATH_MAX]; + + u8 dpk_band; + u8 dpk_ch; + u8 dpk_bw; +}; + +struct rtw_phy_cck_pd_reg { + u32 reg_pd; + u32 mask_pd; + u32 reg_cs; + u32 mask_cs; +}; + +#define DACK_MSBK_BACKUP_NUM 0xf +#define DACK_DCK_BACKUP_NUM 0x2 + +struct rtw_swing_table { + const u8 *p[RTW_RF_PATH_MAX]; + const u8 *n[RTW_RF_PATH_MAX]; +}; + +struct rtw_pkt_count { + u16 num_bcn_pkt; + u16 num_qry_pkt[DESC_RATE_MAX]; +}; + +DECLARE_EWMA(evm, 10, 4); +DECLARE_EWMA(snr, 10, 4); + +struct rtw_iqk_info { + bool done; + struct { + u32 s1_x; + u32 s1_y; + u32 s0_x; + u32 s0_y; + } result; +}; + +enum rtw_rf_band { + RF_BAND_2G_CCK, + RF_BAND_2G_OFDM, + RF_BAND_5G_L, + RF_BAND_5G_M, + RF_BAND_5G_H, + RF_BAND_MAX +}; + +#define RF_GAIN_NUM 11 +#define RF_HW_OFFSET_NUM 10 + +struct rtw_gapk_info { + u32 rf3f_bp[RF_BAND_MAX][RF_GAIN_NUM][RTW_RF_PATH_MAX]; + u32 rf3f_fs[RTW_RF_PATH_MAX][RF_GAIN_NUM]; + bool txgapk_bp_done; + s8 offset[RF_GAIN_NUM][RTW_RF_PATH_MAX]; + s8 fianl_offset[RF_GAIN_NUM][RTW_RF_PATH_MAX]; + u8 read_txgain; + u8 channel; +}; + +#define EDCCA_TH_L2H_IDX 0 +#define EDCCA_TH_H2L_IDX 1 +#define EDCCA_TH_L2H_LB 48 +#define EDCCA_ADC_BACKOFF 12 +#define EDCCA_IGI_BASE 50 +#define EDCCA_IGI_L2H_DIFF 8 +#define EDCCA_L2H_H2L_DIFF 7 +#define EDCCA_L2H_H2L_DIFF_NORMAL 8 + +enum rtw_edcca_mode { + RTW_EDCCA_NORMAL = 0, + RTW_EDCCA_ADAPTIVITY = 1, +}; + +struct rtw_cfo_track { + bool is_adjust; + u8 crystal_cap; + s32 cfo_tail[RTW_RF_PATH_MAX]; + s32 cfo_cnt[RTW_RF_PATH_MAX]; + u32 packet_count; + u32 packet_count_pre; +}; + +#define RRSR_INIT_2G 0x15f +#define RRSR_INIT_5G 0x150 + +enum rtw_dm_cap { + RTW_DM_CAP_NA, + RTW_DM_CAP_TXGAPK, + RTW_DM_CAP_NUM +}; + +struct rtw_dm_info { + u32 cck_fa_cnt; + u32 ofdm_fa_cnt; + u32 total_fa_cnt; + u32 cck_cca_cnt; + u32 ofdm_cca_cnt; + u32 total_cca_cnt; + + u32 cck_ok_cnt; + u32 cck_err_cnt; + u32 ofdm_ok_cnt; + u32 ofdm_err_cnt; + u32 ht_ok_cnt; + u32 ht_err_cnt; + u32 vht_ok_cnt; + u32 vht_err_cnt; + + u8 min_rssi; + u8 pre_min_rssi; + u16 fa_history[4]; + u8 igi_history[4]; + u8 igi_bitmap; + bool damping; + u8 damping_cnt; + u8 damping_rssi; + + u8 cck_gi_u_bnd; + u8 cck_gi_l_bnd; + + u8 fix_rate; + u8 tx_rate; + u32 rrsr_val_init; + u32 rrsr_mask_min; + u8 thermal_avg[RTW_RF_PATH_MAX]; + u8 thermal_meter_k; + u8 thermal_meter_lck; + s8 delta_power_index[RTW_RF_PATH_MAX]; + s8 delta_power_index_last[RTW_RF_PATH_MAX]; + u8 default_ofdm_index; + bool pwr_trk_triggered; + bool pwr_trk_init_trigger; + struct ewma_thermal avg_thermal[RTW_RF_PATH_MAX]; + s8 txagc_remnant_cck; + s8 txagc_remnant_ofdm; + + /* backup dack results for each path and I/Q */ + u32 dack_adck[RTW_RF_PATH_MAX]; + u16 dack_msbk[RTW_RF_PATH_MAX][2][DACK_MSBK_BACKUP_NUM]; + u8 dack_dck[RTW_RF_PATH_MAX][2][DACK_DCK_BACKUP_NUM]; + + struct rtw_dpk_info dpk_info; + struct rtw_cfo_track cfo_track; + + /* [bandwidth 0:20M/1:40M][number of path] */ + u8 cck_pd_lv[2][RTW_RF_PATH_MAX]; + u32 cck_fa_avg; + u8 cck_pd_default; + + /* save the last rx phy status for debug */ + s8 rx_snr[RTW_RF_PATH_MAX]; + u8 rx_evm_dbm[RTW_RF_PATH_MAX]; + s16 cfo_tail[RTW_RF_PATH_MAX]; + u8 rssi[RTW_RF_PATH_MAX]; + u8 curr_rx_rate; + struct rtw_pkt_count cur_pkt_count; + struct rtw_pkt_count last_pkt_count; + struct ewma_evm ewma_evm[RTW_EVM_NUM]; + struct ewma_snr ewma_snr[RTW_SNR_NUM]; + + u32 dm_flags; /* enum rtw_dm_cap */ + struct rtw_iqk_info iqk; + struct rtw_gapk_info gapk; + bool is_bt_iqk_timeout; + + s8 l2h_th_ini; + enum rtw_edcca_mode edcca_mode; + u8 scan_density; +}; + +struct rtw_efuse { + u32 size; + u32 physical_size; + u32 logical_size; + u32 protect_size; + + u8 addr[ETH_ALEN]; + u8 channel_plan; + u8 country_code[2]; + u8 rf_board_option; + u8 rfe_option; + u8 power_track_type; + u8 thermal_meter[RTW_RF_PATH_MAX]; + u8 thermal_meter_k; + u8 crystal_cap; + u8 ant_div_cfg; + u8 ant_div_type; + u8 regd; + u8 afe; + + u8 lna_type_2g; + u8 lna_type_5g; + u8 glna_type; + u8 alna_type; + bool ext_lna_2g; + bool ext_lna_5g; + u8 pa_type_2g; + u8 pa_type_5g; + u8 gpa_type; + u8 apa_type; + bool ext_pa_2g; + bool ext_pa_5g; + u8 tx_bb_swing_setting_2g; + u8 tx_bb_swing_setting_5g; + + bool btcoex; + /* bt share antenna with wifi */ + bool share_ant; + u8 bt_setting; + + struct { + u8 hci; + u8 bw; + u8 ptcl; + u8 nss; + u8 ant_num; + } hw_cap; + + struct rtw_txpwr_idx txpwr_idx_table[4]; +}; + +struct rtw_phy_cond { +#ifdef __LITTLE_ENDIAN + u32 rfe:8; + u32 intf:4; + u32 pkg:4; + u32 plat:4; + u32 intf_rsvd:4; + u32 cut:4; + u32 branch:2; + u32 neg:1; + u32 pos:1; +#else + u32 pos:1; + u32 neg:1; + u32 branch:2; + u32 cut:4; + u32 intf_rsvd:4; + u32 plat:4; + u32 pkg:4; + u32 intf:4; + u32 rfe:8; +#endif + /* for intf:4 */ + #define INTF_PCIE BIT(0) + #define INTF_USB BIT(1) + #define INTF_SDIO BIT(2) + /* for branch:2 */ + #define BRANCH_IF 0 + #define BRANCH_ELIF 1 + #define BRANCH_ELSE 2 + #define BRANCH_ENDIF 3 +}; + +struct rtw_fifo_conf { + /* tx fifo information */ + u16 rsvd_boundary; + u16 rsvd_pg_num; + u16 rsvd_drv_pg_num; + u16 txff_pg_num; + u16 acq_pg_num; + u16 rsvd_drv_addr; + u16 rsvd_h2c_info_addr; + u16 rsvd_h2c_sta_info_addr; + u16 rsvd_h2cq_addr; + u16 rsvd_cpu_instr_addr; + u16 rsvd_fw_txbuf_addr; + u16 rsvd_csibuf_addr; + const struct rtw_rqpn *rqpn; +}; + +struct rtw_fwcd_desc { + u32 size; + u8 *next; + u8 *data; +}; + +struct rtw_fwcd_segs { + const u32 *segs; + u8 num; +}; + +#define FW_CD_TYPE 0xffff +#define FW_CD_LEN 4 +#define FW_CD_VAL 0xaabbccdd +struct rtw_fw_state { + const struct firmware *firmware; + struct rtw_dev *rtwdev; + struct completion completion; + struct rtw_fwcd_desc fwcd_desc; + u16 version; + u8 sub_version; + u8 sub_index; + u16 h2c_version; + u32 feature; + u32 feature_ext; + enum rtw_fw_type type; +}; + +enum rtw_sar_sources { + RTW_SAR_SOURCE_NONE, + RTW_SAR_SOURCE_COMMON, +}; + +enum rtw_sar_bands { + RTW_SAR_BAND_0, + RTW_SAR_BAND_1, + /* RTW_SAR_BAND_2, not used now */ + RTW_SAR_BAND_3, + RTW_SAR_BAND_4, + + RTW_SAR_BAND_NR, +}; + +/* the union is reserved for other kinds of SAR sources + * which might not re-use same format with array common. + */ +union rtw_sar_cfg { + s8 common[RTW_SAR_BAND_NR]; +}; + +struct rtw_sar { + enum rtw_sar_sources src; + union rtw_sar_cfg cfg[RTW_RF_PATH_MAX][RTW_RATE_SECTION_MAX]; +}; + +struct rtw_hal { + u32 rcr; + + u32 chip_version; + u8 cut_version; + u8 mp_chip; + u8 oem_id; + u8 pkg_type; + struct rtw_phy_cond phy_cond; + bool rfe_btg; + + u8 ps_mode; + u8 current_channel; + u8 current_primary_channel_index; + u8 current_band_width; + u8 current_band_type; + u8 primary_channel; + + /* center channel for different available bandwidth, + * val of (bw > current_band_width) is invalid + */ + u8 cch_by_bw[RTW_MAX_CHANNEL_WIDTH + 1]; + + u8 sec_ch_offset; + u8 rf_type; + u8 rf_path_num; + u8 rf_phy_num; + u32 antenna_tx; + u32 antenna_rx; + u8 bfee_sts_cap; + bool txrx_1ss; + + /* protect tx power section */ + struct mutex tx_power_mutex; + s8 tx_pwr_by_rate_offset_2g[RTW_RF_PATH_MAX] + [DESC_RATE_MAX]; + s8 tx_pwr_by_rate_offset_5g[RTW_RF_PATH_MAX] + [DESC_RATE_MAX]; + s8 tx_pwr_by_rate_base_2g[RTW_RF_PATH_MAX] + [RTW_RATE_SECTION_MAX]; + s8 tx_pwr_by_rate_base_5g[RTW_RF_PATH_MAX] + [RTW_RATE_SECTION_MAX]; + s8 tx_pwr_limit_2g[RTW_REGD_MAX] + [RTW_CHANNEL_WIDTH_MAX] + [RTW_RATE_SECTION_MAX] + [RTW_MAX_CHANNEL_NUM_2G]; + s8 tx_pwr_limit_5g[RTW_REGD_MAX] + [RTW_CHANNEL_WIDTH_MAX] + [RTW_RATE_SECTION_MAX] + [RTW_MAX_CHANNEL_NUM_5G]; + s8 tx_pwr_tbl[RTW_RF_PATH_MAX] + [DESC_RATE_MAX]; + + enum rtw_sar_bands sar_band; + struct rtw_sar sar; + + /* for 8821c set channel */ + u32 ch_param[3]; +}; + +struct rtw_path_div { + enum rtw_bb_path current_tx_path; + u32 path_a_sum; + u32 path_b_sum; + u16 path_a_cnt; + u16 path_b_cnt; +}; + +struct rtw_chan_info { + int pri_ch_idx; + int action_id; + int bw; + u8 extra_info; + u8 channel; + u16 timeout; +}; + +struct rtw_chan_list { + u32 buf_size; + u32 ch_num; + u32 size; + u16 addr; +}; + +struct rtw_hw_scan_info { + struct ieee80211_vif *scanning_vif; + u8 probe_pg_size; + u8 op_pri_ch_idx; + u8 op_pri_ch; + u8 op_chan; + u8 op_bw; +}; + +struct rtw_dev { + struct ieee80211_hw *hw; + struct device *dev; + + struct rtw_hci hci; + + struct rtw_hw_scan_info scan_info; + const struct rtw_chip_info *chip; + struct rtw_hal hal; + struct rtw_fifo_conf fifo; + struct rtw_fw_state fw; + struct rtw_efuse efuse; + struct rtw_sec_desc sec; + struct rtw_traffic_stats stats; + struct rtw_regd regd; + struct rtw_bf_info bf_info; + + struct rtw_dm_info dm_info; + struct rtw_coex coex; + + /* ensures exclusive access from mac80211 callbacks */ + struct mutex mutex; + + /* watch dog every 2 sec */ + struct delayed_work watch_dog_work; + u32 watch_dog_cnt; + + struct list_head rsvd_page_list; + + /* c2h cmd queue & handler work */ + struct sk_buff_head c2h_queue; + struct work_struct c2h_work; + struct work_struct ips_work; + struct work_struct fw_recovery_work; + struct work_struct update_beacon_work; + + /* used to protect txqs list */ + spinlock_t txq_lock; + struct list_head txqs; + struct workqueue_struct *tx_wq; + struct work_struct tx_work; + struct work_struct ba_work; + + struct rtw_tx_report tx_report; + + struct { + /* indicate the mail box to use with fw */ + u8 last_box_num; + u32 seq; + } h2c; + + /* lps power state & handler work */ + struct rtw_lps_conf lps_conf; + bool ps_enabled; + bool beacon_loss; + struct completion lps_leave_check; + + struct dentry *debugfs; + + u8 sta_cnt; + u32 rts_threshold; + + DECLARE_BITMAP(hw_port, RTW_PORT_NUM); + DECLARE_BITMAP(mac_id_map, RTW_MAX_MAC_ID_NUM); + DECLARE_BITMAP(flags, NUM_OF_RTW_FLAGS); + + u8 mp_mode; + struct rtw_path_div dm_path_div; + + struct rtw_fw_state wow_fw; + struct rtw_wow_param wow; + + bool need_rfk; + struct completion fw_scan_density; + bool ap_active; + + /* hci related data, must be last */ + u8 priv[] __aligned(sizeof(void *)); +}; + +#include "hci.h" + +static inline bool rtw_is_assoc(struct rtw_dev *rtwdev) +{ + return !!rtwdev->sta_cnt; +} + +static inline struct ieee80211_txq *rtwtxq_to_txq(struct rtw_txq *rtwtxq) +{ + void *p = rtwtxq; + + return container_of(p, struct ieee80211_txq, drv_priv); +} + +static inline struct ieee80211_vif *rtwvif_to_vif(struct rtw_vif *rtwvif) +{ + void *p = rtwvif; + + return container_of(p, struct ieee80211_vif, drv_priv); +} + +static inline bool rtw_ssid_equal(struct cfg80211_ssid *a, + struct cfg80211_ssid *b) +{ + if (!a || !b || a->ssid_len != b->ssid_len) + return false; + + if (memcmp(a->ssid, b->ssid, a->ssid_len)) + return false; + + return true; +} + +static inline void rtw_chip_efuse_grant_on(struct rtw_dev *rtwdev) +{ + if (rtwdev->chip->ops->efuse_grant) + rtwdev->chip->ops->efuse_grant(rtwdev, true); +} + +static inline void rtw_chip_efuse_grant_off(struct rtw_dev *rtwdev) +{ + if (rtwdev->chip->ops->efuse_grant) + rtwdev->chip->ops->efuse_grant(rtwdev, false); +} + +static inline bool rtw_chip_wcpu_11n(struct rtw_dev *rtwdev) +{ + return rtwdev->chip->wlan_cpu == RTW_WCPU_11N; +} + +static inline bool rtw_chip_wcpu_11ac(struct rtw_dev *rtwdev) +{ + return rtwdev->chip->wlan_cpu == RTW_WCPU_11AC; +} + +static inline bool rtw_chip_has_rx_ldpc(struct rtw_dev *rtwdev) +{ + return rtwdev->chip->rx_ldpc; +} + +static inline bool rtw_chip_has_tx_stbc(struct rtw_dev *rtwdev) +{ + return rtwdev->chip->tx_stbc; +} + +static inline void rtw_release_macid(struct rtw_dev *rtwdev, u8 mac_id) +{ + clear_bit(mac_id, rtwdev->mac_id_map); +} + +static inline int rtw_chip_dump_fw_crash(struct rtw_dev *rtwdev) +{ + if (rtwdev->chip->ops->dump_fw_crash) + return rtwdev->chip->ops->dump_fw_crash(rtwdev); + + return 0; +} + +static inline +enum nl80211_band rtw_hw_to_nl80211_band(enum rtw_supported_band hw_band) +{ + switch (hw_band) { + default: + case RTW_BAND_2G: + return NL80211_BAND_2GHZ; + case RTW_BAND_5G: + return NL80211_BAND_5GHZ; + case RTW_BAND_60G: + return NL80211_BAND_60GHZ; + } +} + +void rtw_set_rx_freq_band(struct rtw_rx_pkt_stat *pkt_stat, u8 channel); +void rtw_set_dtim_period(struct rtw_dev *rtwdev, int dtim_period); +void rtw_get_channel_params(struct cfg80211_chan_def *chandef, + struct rtw_channel_params *ch_param); +bool check_hw_ready(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 target); +bool ltecoex_read_reg(struct rtw_dev *rtwdev, u16 offset, u32 *val); +bool ltecoex_reg_write(struct rtw_dev *rtwdev, u16 offset, u32 value); +void rtw_restore_reg(struct rtw_dev *rtwdev, + struct rtw_backup_info *bckp, u32 num); +void rtw_desc_to_mcsrate(u16 rate, u8 *mcs, u8 *nss); +void rtw_set_channel(struct rtw_dev *rtwdev); +void rtw_chip_prepare_tx(struct rtw_dev *rtwdev); +void rtw_vif_port_config(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif, + u32 config); +#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 14, 0) +void rtw_tx_report_purge_timer(void *ctx); +#else +void rtw_tx_report_purge_timer(struct timer_list *t); +#endif +void rtw_update_sta_info(struct rtw_dev *rtwdev, struct rtw_sta_info *si, + bool reset_ra_mask); +void rtw_core_scan_start(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif, + const u8 *mac_addr, bool hw_scan); +void rtw_core_scan_complete(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + bool hw_scan); +int rtw_core_start(struct rtw_dev *rtwdev); +void rtw_core_stop(struct rtw_dev *rtwdev); +int rtw_chip_info_setup(struct rtw_dev *rtwdev); +int rtw_core_init(struct rtw_dev *rtwdev); +void rtw_core_deinit(struct rtw_dev *rtwdev); +int rtw_register_hw(struct rtw_dev *rtwdev, struct ieee80211_hw *hw); +void rtw_unregister_hw(struct rtw_dev *rtwdev, struct ieee80211_hw *hw); +u16 rtw_desc_to_bitrate(u8 desc_rate); +void rtw_vif_assoc_changed(struct rtw_vif *rtwvif, + struct ieee80211_bss_conf *conf); +int rtw_sta_add(struct rtw_dev *rtwdev, struct ieee80211_sta *sta, + struct ieee80211_vif *vif); +void rtw_sta_remove(struct rtw_dev *rtwdev, struct ieee80211_sta *sta, + bool fw_exist); +void rtw_fw_recovery(struct rtw_dev *rtwdev); +void rtw_core_fw_scan_notify(struct rtw_dev *rtwdev, bool start); +int rtw_dump_fw(struct rtw_dev *rtwdev, const u32 ocp_src, u32 size, + u32 fwcd_item); +int rtw_dump_reg(struct rtw_dev *rtwdev, const u32 addr, const u32 size); +void rtw_set_txrx_1ss(struct rtw_dev *rtwdev, bool config_1ss); +void rtw_update_channel(struct rtw_dev *rtwdev, u8 center_channel, + u8 primary_channel, enum rtw_supported_band band, + enum rtw_bandwidth bandwidth); +void rtw_core_port_switch(struct rtw_dev *rtwdev, struct ieee80211_vif *vif); +bool rtw_core_check_sta_active(struct rtw_dev *rtwdev); +void rtw_core_enable_beacon(struct rtw_dev *rtwdev, bool enable); +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/pci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/pci.c new file mode 100644 index 0000000000000000000000000000000000000000..494cf63293f4b14b3a7e36f8b7bd565ca6fc6c3d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/pci.c @@ -0,0 +1,1837 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include "main.h" +#include "pci.h" +#include "reg.h" +#include "tx.h" +#include "rx.h" +#include "fw.h" +#include "ps.h" +#include "debug.h" + +static bool rtw_disable_msi; +static bool rtw_pci_disable_aspm; +module_param_named(disable_msi, rtw_disable_msi, bool, 0644); +module_param_named(disable_aspm, rtw_pci_disable_aspm, bool, 0644); +MODULE_PARM_DESC(disable_msi, "Set Y to disable MSI interrupt support"); +MODULE_PARM_DESC(disable_aspm, "Set Y to disable PCI ASPM support"); + +static u32 rtw_pci_tx_queue_idx_addr[] = { + [RTW_TX_QUEUE_BK] = RTK_PCI_TXBD_IDX_BKQ, + [RTW_TX_QUEUE_BE] = RTK_PCI_TXBD_IDX_BEQ, + [RTW_TX_QUEUE_VI] = RTK_PCI_TXBD_IDX_VIQ, + [RTW_TX_QUEUE_VO] = RTK_PCI_TXBD_IDX_VOQ, + [RTW_TX_QUEUE_MGMT] = RTK_PCI_TXBD_IDX_MGMTQ, + [RTW_TX_QUEUE_HI0] = RTK_PCI_TXBD_IDX_HI0Q, + [RTW_TX_QUEUE_H2C] = RTK_PCI_TXBD_IDX_H2CQ, +}; + +static u8 rtw_pci_get_tx_qsel(struct sk_buff *skb, + enum rtw_tx_queue_type queue) +{ + switch (queue) { + case RTW_TX_QUEUE_BCN: + return TX_DESC_QSEL_BEACON; + case RTW_TX_QUEUE_H2C: + return TX_DESC_QSEL_H2C; + case RTW_TX_QUEUE_MGMT: + return TX_DESC_QSEL_MGMT; + case RTW_TX_QUEUE_HI0: + return TX_DESC_QSEL_HIGH; + default: + return skb->priority; + } +}; + +static u8 rtw_pci_read8(struct rtw_dev *rtwdev, u32 addr) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + return readb(rtwpci->mmap + addr); +} + +static u16 rtw_pci_read16(struct rtw_dev *rtwdev, u32 addr) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + return readw(rtwpci->mmap + addr); +} + +static u32 rtw_pci_read32(struct rtw_dev *rtwdev, u32 addr) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + return readl(rtwpci->mmap + addr); +} + +static void rtw_pci_write8(struct rtw_dev *rtwdev, u32 addr, u8 val) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + writeb(val, rtwpci->mmap + addr); +} + +static void rtw_pci_write16(struct rtw_dev *rtwdev, u32 addr, u16 val) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + writew(val, rtwpci->mmap + addr); +} + +static void rtw_pci_write32(struct rtw_dev *rtwdev, u32 addr, u32 val) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + writel(val, rtwpci->mmap + addr); +} + +static void rtw_pci_free_tx_ring_skbs(struct rtw_dev *rtwdev, + struct rtw_pci_tx_ring *tx_ring) +{ + struct pci_dev *pdev = to_pci_dev(rtwdev->dev); + struct rtw_pci_tx_data *tx_data; + struct sk_buff *skb, *tmp; + dma_addr_t dma; + + /* free every skb remained in tx list */ + skb_queue_walk_safe(&tx_ring->queue, skb, tmp) { + __skb_unlink(skb, &tx_ring->queue); + tx_data = rtw_pci_get_tx_data(skb); + dma = tx_data->dma; + + dma_unmap_single(&pdev->dev, dma, skb->len, DMA_TO_DEVICE); + dev_kfree_skb_any(skb); + } +} + +static void rtw_pci_free_tx_ring(struct rtw_dev *rtwdev, + struct rtw_pci_tx_ring *tx_ring) +{ + struct pci_dev *pdev = to_pci_dev(rtwdev->dev); + u8 *head = tx_ring->r.head; + u32 len = tx_ring->r.len; + int ring_sz = len * tx_ring->r.desc_size; + + rtw_pci_free_tx_ring_skbs(rtwdev, tx_ring); + + /* free the ring itself */ + dma_free_coherent(&pdev->dev, ring_sz, head, tx_ring->r.dma); + tx_ring->r.head = NULL; +} + +static void rtw_pci_free_rx_ring_skbs(struct rtw_dev *rtwdev, + struct rtw_pci_rx_ring *rx_ring) +{ + struct pci_dev *pdev = to_pci_dev(rtwdev->dev); + struct sk_buff *skb; + int buf_sz = RTK_PCI_RX_BUF_SIZE; + dma_addr_t dma; + int i; + + for (i = 0; i < rx_ring->r.len; i++) { + skb = rx_ring->buf[i]; + if (!skb) + continue; + + dma = *((dma_addr_t *)skb->cb); + dma_unmap_single(&pdev->dev, dma, buf_sz, DMA_FROM_DEVICE); + dev_kfree_skb(skb); + rx_ring->buf[i] = NULL; + } +} + +static void rtw_pci_free_rx_ring(struct rtw_dev *rtwdev, + struct rtw_pci_rx_ring *rx_ring) +{ + struct pci_dev *pdev = to_pci_dev(rtwdev->dev); + u8 *head = rx_ring->r.head; + int ring_sz = rx_ring->r.desc_size * rx_ring->r.len; + + rtw_pci_free_rx_ring_skbs(rtwdev, rx_ring); + + dma_free_coherent(&pdev->dev, ring_sz, head, rx_ring->r.dma); +} + +static void rtw_pci_free_trx_ring(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + struct rtw_pci_tx_ring *tx_ring; + struct rtw_pci_rx_ring *rx_ring; + int i; + + for (i = 0; i < RTK_MAX_TX_QUEUE_NUM; i++) { + tx_ring = &rtwpci->tx_rings[i]; + rtw_pci_free_tx_ring(rtwdev, tx_ring); + } + + for (i = 0; i < RTK_MAX_RX_QUEUE_NUM; i++) { + rx_ring = &rtwpci->rx_rings[i]; + rtw_pci_free_rx_ring(rtwdev, rx_ring); + } +} + +static int rtw_pci_init_tx_ring(struct rtw_dev *rtwdev, + struct rtw_pci_tx_ring *tx_ring, + u8 desc_size, u32 len) +{ + struct pci_dev *pdev = to_pci_dev(rtwdev->dev); + int ring_sz = desc_size * len; + dma_addr_t dma; + u8 *head; + + if (len > TRX_BD_IDX_MASK) { + rtw_err(rtwdev, "len %d exceeds maximum TX entries\n", len); + return -EINVAL; + } + + head = dma_alloc_coherent(&pdev->dev, ring_sz, &dma, GFP_KERNEL); + if (!head) { + rtw_err(rtwdev, "failed to allocate tx ring\n"); + return -ENOMEM; + } + + skb_queue_head_init(&tx_ring->queue); + tx_ring->r.head = head; + tx_ring->r.dma = dma; + tx_ring->r.len = len; + tx_ring->r.desc_size = desc_size; + tx_ring->r.wp = 0; + tx_ring->r.rp = 0; + + return 0; +} + +static int rtw_pci_reset_rx_desc(struct rtw_dev *rtwdev, struct sk_buff *skb, + struct rtw_pci_rx_ring *rx_ring, + u32 idx, u32 desc_sz) +{ + struct pci_dev *pdev = to_pci_dev(rtwdev->dev); + struct rtw_pci_rx_buffer_desc *buf_desc; + int buf_sz = RTK_PCI_RX_BUF_SIZE; + dma_addr_t dma; + + if (!skb) + return -EINVAL; + + dma = dma_map_single(&pdev->dev, skb->data, buf_sz, DMA_FROM_DEVICE); + if (dma_mapping_error(&pdev->dev, dma)) + return -EBUSY; + + *((dma_addr_t *)skb->cb) = dma; + buf_desc = (struct rtw_pci_rx_buffer_desc *)(rx_ring->r.head + + idx * desc_sz); + memset(buf_desc, 0, sizeof(*buf_desc)); + buf_desc->buf_size = cpu_to_le16(RTK_PCI_RX_BUF_SIZE); + buf_desc->dma = cpu_to_le32(dma); + + return 0; +} + +static void rtw_pci_sync_rx_desc_device(struct rtw_dev *rtwdev, dma_addr_t dma, + struct rtw_pci_rx_ring *rx_ring, + u32 idx, u32 desc_sz) +{ + struct device *dev = rtwdev->dev; + struct rtw_pci_rx_buffer_desc *buf_desc; + int buf_sz = RTK_PCI_RX_BUF_SIZE; + + dma_sync_single_for_device(dev, dma, buf_sz, DMA_FROM_DEVICE); + + buf_desc = (struct rtw_pci_rx_buffer_desc *)(rx_ring->r.head + + idx * desc_sz); + memset(buf_desc, 0, sizeof(*buf_desc)); + buf_desc->buf_size = cpu_to_le16(RTK_PCI_RX_BUF_SIZE); + buf_desc->dma = cpu_to_le32(dma); +} + +static int rtw_pci_init_rx_ring(struct rtw_dev *rtwdev, + struct rtw_pci_rx_ring *rx_ring, + u8 desc_size, u32 len) +{ + struct pci_dev *pdev = to_pci_dev(rtwdev->dev); + struct sk_buff *skb = NULL; + dma_addr_t dma; + u8 *head; + int ring_sz = desc_size * len; + int buf_sz = RTK_PCI_RX_BUF_SIZE; + int i, allocated; + int ret = 0; + + head = dma_alloc_coherent(&pdev->dev, ring_sz, &dma, GFP_KERNEL); + if (!head) { + rtw_err(rtwdev, "failed to allocate rx ring\n"); + return -ENOMEM; + } + rx_ring->r.head = head; + + for (i = 0; i < len; i++) { + skb = dev_alloc_skb(buf_sz); + if (!skb) { + allocated = i; + ret = -ENOMEM; + goto err_out; + } + + memset(skb->data, 0, buf_sz); + rx_ring->buf[i] = skb; + ret = rtw_pci_reset_rx_desc(rtwdev, skb, rx_ring, i, desc_size); + if (ret) { + allocated = i; + dev_kfree_skb_any(skb); + goto err_out; + } + } + + rx_ring->r.dma = dma; + rx_ring->r.len = len; + rx_ring->r.desc_size = desc_size; + rx_ring->r.wp = 0; + rx_ring->r.rp = 0; + + return 0; + +err_out: + for (i = 0; i < allocated; i++) { + skb = rx_ring->buf[i]; + if (!skb) + continue; + dma = *((dma_addr_t *)skb->cb); + dma_unmap_single(&pdev->dev, dma, buf_sz, DMA_FROM_DEVICE); + dev_kfree_skb_any(skb); + rx_ring->buf[i] = NULL; + } + dma_free_coherent(&pdev->dev, ring_sz, head, dma); + + rtw_err(rtwdev, "failed to init rx buffer\n"); + + return ret; +} + +static int rtw_pci_init_trx_ring(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + struct rtw_pci_tx_ring *tx_ring; + struct rtw_pci_rx_ring *rx_ring; + const struct rtw_chip_info *chip = rtwdev->chip; + int i = 0, j = 0, tx_alloced = 0, rx_alloced = 0; + int tx_desc_size, rx_desc_size; + u32 len; + int ret; + + tx_desc_size = chip->tx_buf_desc_sz; + + for (i = 0; i < RTK_MAX_TX_QUEUE_NUM; i++) { + tx_ring = &rtwpci->tx_rings[i]; + len = max_num_of_tx_queue(i); + ret = rtw_pci_init_tx_ring(rtwdev, tx_ring, tx_desc_size, len); + if (ret) + goto out; + } + + rx_desc_size = chip->rx_buf_desc_sz; + + for (j = 0; j < RTK_MAX_RX_QUEUE_NUM; j++) { + rx_ring = &rtwpci->rx_rings[j]; + ret = rtw_pci_init_rx_ring(rtwdev, rx_ring, rx_desc_size, + RTK_MAX_RX_DESC_NUM); + if (ret) + goto out; + } + + return 0; + +out: + tx_alloced = i; + for (i = 0; i < tx_alloced; i++) { + tx_ring = &rtwpci->tx_rings[i]; + rtw_pci_free_tx_ring(rtwdev, tx_ring); + } + + rx_alloced = j; + for (j = 0; j < rx_alloced; j++) { + rx_ring = &rtwpci->rx_rings[j]; + rtw_pci_free_rx_ring(rtwdev, rx_ring); + } + + return ret; +} + +static void rtw_pci_deinit(struct rtw_dev *rtwdev) +{ + rtw_pci_free_trx_ring(rtwdev); +} + +static int rtw_pci_init(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + int ret = 0; + + rtwpci->irq_mask[0] = IMR_HIGHDOK | + IMR_MGNTDOK | + IMR_BKDOK | + IMR_BEDOK | + IMR_VIDOK | + IMR_VODOK | + IMR_ROK | + IMR_BCNDMAINT_E | + IMR_C2HCMD | + 0; + rtwpci->irq_mask[1] = IMR_TXFOVW | + 0; + rtwpci->irq_mask[3] = IMR_H2CDOK | + 0; + spin_lock_init(&rtwpci->irq_lock); + spin_lock_init(&rtwpci->hwirq_lock); + ret = rtw_pci_init_trx_ring(rtwdev); + + return ret; +} + +static void rtw_pci_reset_buf_desc(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + u32 len; + u8 tmp; + dma_addr_t dma; + + tmp = rtw_read8(rtwdev, RTK_PCI_CTRL + 3); + rtw_write8(rtwdev, RTK_PCI_CTRL + 3, tmp | 0xf7); + + dma = rtwpci->tx_rings[RTW_TX_QUEUE_BCN].r.dma; + rtw_write32(rtwdev, RTK_PCI_TXBD_DESA_BCNQ, dma); + + if (!rtw_chip_wcpu_11n(rtwdev)) { + len = rtwpci->tx_rings[RTW_TX_QUEUE_H2C].r.len; + dma = rtwpci->tx_rings[RTW_TX_QUEUE_H2C].r.dma; + rtwpci->tx_rings[RTW_TX_QUEUE_H2C].r.rp = 0; + rtwpci->tx_rings[RTW_TX_QUEUE_H2C].r.wp = 0; + rtw_write16(rtwdev, RTK_PCI_TXBD_NUM_H2CQ, len & TRX_BD_IDX_MASK); + rtw_write32(rtwdev, RTK_PCI_TXBD_DESA_H2CQ, dma); + } + + len = rtwpci->tx_rings[RTW_TX_QUEUE_BK].r.len; + dma = rtwpci->tx_rings[RTW_TX_QUEUE_BK].r.dma; + rtwpci->tx_rings[RTW_TX_QUEUE_BK].r.rp = 0; + rtwpci->tx_rings[RTW_TX_QUEUE_BK].r.wp = 0; + rtw_write16(rtwdev, RTK_PCI_TXBD_NUM_BKQ, len & TRX_BD_IDX_MASK); + rtw_write32(rtwdev, RTK_PCI_TXBD_DESA_BKQ, dma); + + len = rtwpci->tx_rings[RTW_TX_QUEUE_BE].r.len; + dma = rtwpci->tx_rings[RTW_TX_QUEUE_BE].r.dma; + rtwpci->tx_rings[RTW_TX_QUEUE_BE].r.rp = 0; + rtwpci->tx_rings[RTW_TX_QUEUE_BE].r.wp = 0; + rtw_write16(rtwdev, RTK_PCI_TXBD_NUM_BEQ, len & TRX_BD_IDX_MASK); + rtw_write32(rtwdev, RTK_PCI_TXBD_DESA_BEQ, dma); + + len = rtwpci->tx_rings[RTW_TX_QUEUE_VO].r.len; + dma = rtwpci->tx_rings[RTW_TX_QUEUE_VO].r.dma; + rtwpci->tx_rings[RTW_TX_QUEUE_VO].r.rp = 0; + rtwpci->tx_rings[RTW_TX_QUEUE_VO].r.wp = 0; + rtw_write16(rtwdev, RTK_PCI_TXBD_NUM_VOQ, len & TRX_BD_IDX_MASK); + rtw_write32(rtwdev, RTK_PCI_TXBD_DESA_VOQ, dma); + + len = rtwpci->tx_rings[RTW_TX_QUEUE_VI].r.len; + dma = rtwpci->tx_rings[RTW_TX_QUEUE_VI].r.dma; + rtwpci->tx_rings[RTW_TX_QUEUE_VI].r.rp = 0; + rtwpci->tx_rings[RTW_TX_QUEUE_VI].r.wp = 0; + rtw_write16(rtwdev, RTK_PCI_TXBD_NUM_VIQ, len & TRX_BD_IDX_MASK); + rtw_write32(rtwdev, RTK_PCI_TXBD_DESA_VIQ, dma); + + len = rtwpci->tx_rings[RTW_TX_QUEUE_MGMT].r.len; + dma = rtwpci->tx_rings[RTW_TX_QUEUE_MGMT].r.dma; + rtwpci->tx_rings[RTW_TX_QUEUE_MGMT].r.rp = 0; + rtwpci->tx_rings[RTW_TX_QUEUE_MGMT].r.wp = 0; + rtw_write16(rtwdev, RTK_PCI_TXBD_NUM_MGMTQ, len & TRX_BD_IDX_MASK); + rtw_write32(rtwdev, RTK_PCI_TXBD_DESA_MGMTQ, dma); + + len = rtwpci->tx_rings[RTW_TX_QUEUE_HI0].r.len; + dma = rtwpci->tx_rings[RTW_TX_QUEUE_HI0].r.dma; + rtwpci->tx_rings[RTW_TX_QUEUE_HI0].r.rp = 0; + rtwpci->tx_rings[RTW_TX_QUEUE_HI0].r.wp = 0; + rtw_write16(rtwdev, RTK_PCI_TXBD_NUM_HI0Q, len & TRX_BD_IDX_MASK); + rtw_write32(rtwdev, RTK_PCI_TXBD_DESA_HI0Q, dma); + + len = rtwpci->rx_rings[RTW_RX_QUEUE_MPDU].r.len; + dma = rtwpci->rx_rings[RTW_RX_QUEUE_MPDU].r.dma; + rtwpci->rx_rings[RTW_RX_QUEUE_MPDU].r.rp = 0; + rtwpci->rx_rings[RTW_RX_QUEUE_MPDU].r.wp = 0; + rtw_write16(rtwdev, RTK_PCI_RXBD_NUM_MPDUQ, len & TRX_BD_IDX_MASK); + rtw_write32(rtwdev, RTK_PCI_RXBD_DESA_MPDUQ, dma); + + /* reset read/write point */ + rtw_write32(rtwdev, RTK_PCI_TXBD_RWPTR_CLR, 0xffffffff); + + /* reset H2C Queue index in a single write */ + if (rtw_chip_wcpu_11ac(rtwdev)) + rtw_write32_set(rtwdev, RTK_PCI_TXBD_H2CQ_CSR, + BIT_CLR_H2CQ_HOST_IDX | BIT_CLR_H2CQ_HW_IDX); +} + +static void rtw_pci_reset_trx_ring(struct rtw_dev *rtwdev) +{ + rtw_pci_reset_buf_desc(rtwdev); +} + +static void rtw_pci_enable_interrupt(struct rtw_dev *rtwdev, + struct rtw_pci *rtwpci, bool exclude_rx) +{ + unsigned long flags; + u32 imr0_unmask = exclude_rx ? IMR_ROK : 0; + + spin_lock_irqsave(&rtwpci->hwirq_lock, flags); + + rtw_write32(rtwdev, RTK_PCI_HIMR0, rtwpci->irq_mask[0] & ~imr0_unmask); + rtw_write32(rtwdev, RTK_PCI_HIMR1, rtwpci->irq_mask[1]); + if (rtw_chip_wcpu_11ac(rtwdev)) + rtw_write32(rtwdev, RTK_PCI_HIMR3, rtwpci->irq_mask[3]); + + rtwpci->irq_enabled = true; + + spin_unlock_irqrestore(&rtwpci->hwirq_lock, flags); +} + +static void rtw_pci_disable_interrupt(struct rtw_dev *rtwdev, + struct rtw_pci *rtwpci) +{ + unsigned long flags; + + spin_lock_irqsave(&rtwpci->hwirq_lock, flags); + + if (!rtwpci->irq_enabled) + goto out; + + rtw_write32(rtwdev, RTK_PCI_HIMR0, 0); + rtw_write32(rtwdev, RTK_PCI_HIMR1, 0); + if (rtw_chip_wcpu_11ac(rtwdev)) + rtw_write32(rtwdev, RTK_PCI_HIMR3, 0); + + rtwpci->irq_enabled = false; + +out: + spin_unlock_irqrestore(&rtwpci->hwirq_lock, flags); +} + +static void rtw_pci_dma_reset(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci) +{ + /* reset dma and rx tag */ + rtw_write32_set(rtwdev, RTK_PCI_CTRL, + BIT_RST_TRXDMA_INTF | BIT_RX_TAG_EN); + rtwpci->rx_tag = 0; +} + +static int rtw_pci_setup(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + rtw_pci_reset_trx_ring(rtwdev); + rtw_pci_dma_reset(rtwdev, rtwpci); + + return 0; +} + +static void rtw_pci_dma_release(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci) +{ + struct rtw_pci_tx_ring *tx_ring; + enum rtw_tx_queue_type queue; + + rtw_pci_reset_trx_ring(rtwdev); + for (queue = 0; queue < RTK_MAX_TX_QUEUE_NUM; queue++) { + tx_ring = &rtwpci->tx_rings[queue]; + rtw_pci_free_tx_ring_skbs(rtwdev, tx_ring); + } +} + +static void rtw_pci_napi_start(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + if (test_and_set_bit(RTW_PCI_FLAG_NAPI_RUNNING, rtwpci->flags)) + return; + + napi_enable(&rtwpci->napi); +} + +static void rtw_pci_napi_stop(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + if (!test_and_clear_bit(RTW_PCI_FLAG_NAPI_RUNNING, rtwpci->flags)) + return; + + napi_synchronize(&rtwpci->napi); + napi_disable(&rtwpci->napi); +} + +static int rtw_pci_start(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + rtw_pci_napi_start(rtwdev); + + spin_lock_bh(&rtwpci->irq_lock); + rtwpci->running = true; + rtw_pci_enable_interrupt(rtwdev, rtwpci, false); + spin_unlock_bh(&rtwpci->irq_lock); + + return 0; +} + +static void rtw_pci_stop(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + struct pci_dev *pdev = rtwpci->pdev; + + spin_lock_bh(&rtwpci->irq_lock); + rtwpci->running = false; + rtw_pci_disable_interrupt(rtwdev, rtwpci); + spin_unlock_bh(&rtwpci->irq_lock); + + synchronize_irq(pdev->irq); + rtw_pci_napi_stop(rtwdev); + + spin_lock_bh(&rtwpci->irq_lock); + rtw_pci_dma_release(rtwdev, rtwpci); + spin_unlock_bh(&rtwpci->irq_lock); +} + +static void rtw_pci_deep_ps_enter(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + struct rtw_pci_tx_ring *tx_ring; + enum rtw_tx_queue_type queue; + bool tx_empty = true; + + if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) + goto enter_deep_ps; + + lockdep_assert_held(&rtwpci->irq_lock); + + /* Deep PS state is not allowed to TX-DMA */ + for (queue = 0; queue < RTK_MAX_TX_QUEUE_NUM; queue++) { + /* BCN queue is rsvd page, does not have DMA interrupt + * H2C queue is managed by firmware + */ + if (queue == RTW_TX_QUEUE_BCN || + queue == RTW_TX_QUEUE_H2C) + continue; + + tx_ring = &rtwpci->tx_rings[queue]; + + /* check if there is any skb DMAing */ + if (skb_queue_len(&tx_ring->queue)) { + tx_empty = false; + break; + } + } + + if (!tx_empty) { + rtw_dbg(rtwdev, RTW_DBG_PS, + "TX path not empty, cannot enter deep power save state\n"); + return; + } +enter_deep_ps: + set_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags); + rtw_power_mode_change(rtwdev, true); +} + +static void rtw_pci_deep_ps_leave(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + lockdep_assert_held(&rtwpci->irq_lock); + + if (test_and_clear_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) + rtw_power_mode_change(rtwdev, false); +} + +static void rtw_pci_deep_ps(struct rtw_dev *rtwdev, bool enter) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + spin_lock_bh(&rtwpci->irq_lock); + + if (enter && !test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) + rtw_pci_deep_ps_enter(rtwdev); + + if (!enter && test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) + rtw_pci_deep_ps_leave(rtwdev); + + spin_unlock_bh(&rtwpci->irq_lock); +} + +static void rtw_pci_release_rsvd_page(struct rtw_pci *rtwpci, + struct rtw_pci_tx_ring *ring) +{ + struct sk_buff *prev = skb_dequeue(&ring->queue); + struct rtw_pci_tx_data *tx_data; + dma_addr_t dma; + + if (!prev) + return; + + tx_data = rtw_pci_get_tx_data(prev); + dma = tx_data->dma; + dma_unmap_single(&rtwpci->pdev->dev, dma, prev->len, DMA_TO_DEVICE); + dev_kfree_skb_any(prev); +} + +static void rtw_pci_dma_check(struct rtw_dev *rtwdev, + struct rtw_pci_rx_ring *rx_ring, + u32 idx) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_pci_rx_buffer_desc *buf_desc; + u32 desc_sz = chip->rx_buf_desc_sz; + u16 total_pkt_size; + + buf_desc = (struct rtw_pci_rx_buffer_desc *)(rx_ring->r.head + + idx * desc_sz); + total_pkt_size = le16_to_cpu(buf_desc->total_pkt_size); + + /* rx tag mismatch, throw a warning */ + if (total_pkt_size != rtwpci->rx_tag) + rtw_warn(rtwdev, "pci bus timeout, check dma status\n"); + + rtwpci->rx_tag = (rtwpci->rx_tag + 1) % RX_TAG_MAX; +} + +static u32 __pci_get_hw_tx_ring_rp(struct rtw_dev *rtwdev, u8 pci_q) +{ + u32 bd_idx_addr = rtw_pci_tx_queue_idx_addr[pci_q]; + u32 bd_idx = rtw_read16(rtwdev, bd_idx_addr + 2); + + return FIELD_GET(TRX_BD_IDX_MASK, bd_idx); +} + +static void __pci_flush_queue(struct rtw_dev *rtwdev, u8 pci_q, bool drop) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + struct rtw_pci_tx_ring *ring = &rtwpci->tx_rings[pci_q]; + u32 cur_rp; + u8 i; + + /* Because the time taked by the I/O in __pci_get_hw_tx_ring_rp is a + * bit dynamic, it's hard to define a reasonable fixed total timeout to + * use read_poll_timeout* helper. Instead, we can ensure a reasonable + * polling times, so we just use for loop with udelay here. + */ + for (i = 0; i < 30; i++) { + cur_rp = __pci_get_hw_tx_ring_rp(rtwdev, pci_q); + if (cur_rp == ring->r.wp) + return; + + udelay(1); + } + + if (!drop) + rtw_warn(rtwdev, "timed out to flush pci tx ring[%d]\n", pci_q); +} + +static void __rtw_pci_flush_queues(struct rtw_dev *rtwdev, u32 pci_queues, + bool drop) +{ + u8 q; + + for (q = 0; q < RTK_MAX_TX_QUEUE_NUM; q++) { + /* Unnecessary to flush BCN, H2C and HI tx queues. */ + if (q == RTW_TX_QUEUE_BCN || q == RTW_TX_QUEUE_H2C || + q == RTW_TX_QUEUE_HI0) + continue; + + if (pci_queues & BIT(q)) + __pci_flush_queue(rtwdev, q, drop); + } +} + +static void rtw_pci_flush_queues(struct rtw_dev *rtwdev, u32 queues, bool drop) +{ + u32 pci_queues = 0; + u8 i; + + /* If all of the hardware queues are requested to flush, + * flush all of the pci queues. + */ + if (queues == BIT(rtwdev->hw->queues) - 1) { + pci_queues = BIT(RTK_MAX_TX_QUEUE_NUM) - 1; + } else { + for (i = 0; i < rtwdev->hw->queues; i++) + if (queues & BIT(i)) + pci_queues |= BIT(rtw_tx_ac_to_hwq(i)); + } + + __rtw_pci_flush_queues(rtwdev, pci_queues, drop); +} + +static void rtw_pci_tx_kick_off_queue(struct rtw_dev *rtwdev, + enum rtw_tx_queue_type queue) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + struct rtw_pci_tx_ring *ring; + u32 bd_idx; + + ring = &rtwpci->tx_rings[queue]; + bd_idx = rtw_pci_tx_queue_idx_addr[queue]; + + spin_lock_bh(&rtwpci->irq_lock); + if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) + rtw_pci_deep_ps_leave(rtwdev); + rtw_write16(rtwdev, bd_idx, ring->r.wp & TRX_BD_IDX_MASK); + spin_unlock_bh(&rtwpci->irq_lock); +} + +static void rtw_pci_tx_kick_off(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + enum rtw_tx_queue_type queue; + + for (queue = 0; queue < RTK_MAX_TX_QUEUE_NUM; queue++) + if (test_and_clear_bit(queue, rtwpci->tx_queued)) + rtw_pci_tx_kick_off_queue(rtwdev, queue); +} + +static int rtw_pci_tx_write_data(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb, + enum rtw_tx_queue_type queue) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_pci_tx_ring *ring; + struct rtw_pci_tx_data *tx_data; + dma_addr_t dma; + u32 tx_pkt_desc_sz = chip->tx_pkt_desc_sz; + u32 tx_buf_desc_sz = chip->tx_buf_desc_sz; + u32 size; + u32 psb_len; + u8 *pkt_desc; + struct rtw_pci_tx_buffer_desc *buf_desc; + + ring = &rtwpci->tx_rings[queue]; + + size = skb->len; + + if (queue == RTW_TX_QUEUE_BCN) + rtw_pci_release_rsvd_page(rtwpci, ring); + else if (!avail_desc(ring->r.wp, ring->r.rp, ring->r.len)) + return -ENOSPC; + + pkt_desc = skb_push(skb, chip->tx_pkt_desc_sz); + memset(pkt_desc, 0, tx_pkt_desc_sz); + pkt_info->qsel = rtw_pci_get_tx_qsel(skb, queue); + rtw_tx_fill_tx_desc(pkt_info, skb); + dma = dma_map_single(&rtwpci->pdev->dev, skb->data, skb->len, + DMA_TO_DEVICE); + if (dma_mapping_error(&rtwpci->pdev->dev, dma)) + return -EBUSY; + + /* after this we got dma mapped, there is no way back */ + buf_desc = get_tx_buffer_desc(ring, tx_buf_desc_sz); + memset(buf_desc, 0, tx_buf_desc_sz); + psb_len = (skb->len - 1) / 128 + 1; + if (queue == RTW_TX_QUEUE_BCN) + psb_len |= 1 << RTK_PCI_TXBD_OWN_OFFSET; + + buf_desc[0].psb_len = cpu_to_le16(psb_len); + buf_desc[0].buf_size = cpu_to_le16(tx_pkt_desc_sz); + buf_desc[0].dma = cpu_to_le32(dma); + buf_desc[1].buf_size = cpu_to_le16(size); + buf_desc[1].dma = cpu_to_le32(dma + tx_pkt_desc_sz); + + tx_data = rtw_pci_get_tx_data(skb); + tx_data->dma = dma; + tx_data->sn = pkt_info->sn; + + spin_lock_bh(&rtwpci->irq_lock); + + skb_queue_tail(&ring->queue, skb); + + if (queue == RTW_TX_QUEUE_BCN) + goto out_unlock; + + /* update write-index, and kick it off later */ + set_bit(queue, rtwpci->tx_queued); + if (++ring->r.wp >= ring->r.len) + ring->r.wp = 0; + +out_unlock: + spin_unlock_bh(&rtwpci->irq_lock); + + return 0; +} + +static int rtw_pci_write_data_rsvd_page(struct rtw_dev *rtwdev, u8 *buf, + u32 size) +{ + struct sk_buff *skb; + struct rtw_tx_pkt_info pkt_info = {0}; + u8 reg_bcn_work; + int ret; + + skb = rtw_tx_write_data_rsvd_page_get(rtwdev, &pkt_info, buf, size); + if (!skb) + return -ENOMEM; + + ret = rtw_pci_tx_write_data(rtwdev, &pkt_info, skb, RTW_TX_QUEUE_BCN); + if (ret) { + rtw_err(rtwdev, "failed to write rsvd page data\n"); + return ret; + } + + /* reserved pages go through beacon queue */ + reg_bcn_work = rtw_read8(rtwdev, RTK_PCI_TXBD_BCN_WORK); + reg_bcn_work |= BIT_PCI_BCNQ_FLAG; + rtw_write8(rtwdev, RTK_PCI_TXBD_BCN_WORK, reg_bcn_work); + + return 0; +} + +static int rtw_pci_write_data_h2c(struct rtw_dev *rtwdev, u8 *buf, u32 size) +{ + struct sk_buff *skb; + struct rtw_tx_pkt_info pkt_info = {0}; + int ret; + + skb = rtw_tx_write_data_h2c_get(rtwdev, &pkt_info, buf, size); + if (!skb) + return -ENOMEM; + + ret = rtw_pci_tx_write_data(rtwdev, &pkt_info, skb, RTW_TX_QUEUE_H2C); + if (ret) { + rtw_err(rtwdev, "failed to write h2c data\n"); + return ret; + } + + rtw_pci_tx_kick_off_queue(rtwdev, RTW_TX_QUEUE_H2C); + + return 0; +} + +static int rtw_pci_tx_write(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb) +{ + enum rtw_tx_queue_type queue = rtw_tx_queue_mapping(skb); + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + struct rtw_pci_tx_ring *ring; + int ret; + + ret = rtw_pci_tx_write_data(rtwdev, pkt_info, skb, queue); + if (ret) + return ret; + + ring = &rtwpci->tx_rings[queue]; + spin_lock_bh(&rtwpci->irq_lock); + if (avail_desc(ring->r.wp, ring->r.rp, ring->r.len) < 2) { + ieee80211_stop_queue(rtwdev->hw, skb_get_queue_mapping(skb)); + ring->queue_stopped = true; + } + spin_unlock_bh(&rtwpci->irq_lock); + + return 0; +} + +static void rtw_pci_tx_isr(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, + u8 hw_queue) +{ + struct ieee80211_hw *hw = rtwdev->hw; + struct ieee80211_tx_info *info; + struct rtw_pci_tx_ring *ring; + struct rtw_pci_tx_data *tx_data; + struct sk_buff *skb; + u32 count; + u32 bd_idx_addr; + u32 bd_idx, cur_rp, rp_idx; + u16 q_map; + + ring = &rtwpci->tx_rings[hw_queue]; + + bd_idx_addr = rtw_pci_tx_queue_idx_addr[hw_queue]; + bd_idx = rtw_read32(rtwdev, bd_idx_addr); + cur_rp = bd_idx >> 16; + cur_rp &= TRX_BD_IDX_MASK; + rp_idx = ring->r.rp; + if (cur_rp >= ring->r.rp) + count = cur_rp - ring->r.rp; + else + count = ring->r.len - (ring->r.rp - cur_rp); + + while (count--) { + skb = skb_dequeue(&ring->queue); + if (!skb) { + rtw_err(rtwdev, "failed to dequeue %d skb TX queue %d, BD=0x%08x, rp %d -> %d\n", + count, hw_queue, bd_idx, ring->r.rp, cur_rp); + break; + } + tx_data = rtw_pci_get_tx_data(skb); + dma_unmap_single(&rtwpci->pdev->dev, tx_data->dma, skb->len, + DMA_TO_DEVICE); + + /* just free command packets from host to card */ + if (hw_queue == RTW_TX_QUEUE_H2C) { + dev_kfree_skb_irq(skb); + continue; + } + + if (ring->queue_stopped && + avail_desc(ring->r.wp, rp_idx, ring->r.len) > 4) { + q_map = skb_get_queue_mapping(skb); + ieee80211_wake_queue(hw, q_map); + ring->queue_stopped = false; + } + + if (++rp_idx >= ring->r.len) + rp_idx = 0; + + skb_pull(skb, rtwdev->chip->tx_pkt_desc_sz); + + info = IEEE80211_SKB_CB(skb); + + /* enqueue to wait for tx report */ + if (info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS) { + rtw_tx_report_enqueue(rtwdev, skb, tx_data->sn); + continue; + } + + /* always ACK for others, then they won't be marked as drop */ + if (info->flags & IEEE80211_TX_CTL_NO_ACK) + info->flags |= IEEE80211_TX_STAT_NOACK_TRANSMITTED; + else + info->flags |= IEEE80211_TX_STAT_ACK; + + ieee80211_tx_info_clear_status(info); + ieee80211_tx_status_irqsafe(hw, skb); + } + + ring->r.rp = cur_rp; +} + +static void rtw_pci_rx_isr(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + struct napi_struct *napi = &rtwpci->napi; + + napi_schedule(napi); +} + +static int rtw_pci_get_hw_rx_ring_nr(struct rtw_dev *rtwdev, + struct rtw_pci *rtwpci) +{ + struct rtw_pci_rx_ring *ring; + int count = 0; + u32 tmp, cur_wp; + + ring = &rtwpci->rx_rings[RTW_RX_QUEUE_MPDU]; + tmp = rtw_read32(rtwdev, RTK_PCI_RXBD_IDX_MPDUQ); + cur_wp = u32_get_bits(tmp, TRX_BD_HW_IDX_MASK); + if (cur_wp >= ring->r.wp) + count = cur_wp - ring->r.wp; + else + count = ring->r.len - (ring->r.wp - cur_wp); + + return count; +} + +static u32 rtw_pci_rx_napi(struct rtw_dev *rtwdev, struct rtw_pci *rtwpci, + u8 hw_queue, u32 limit) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct napi_struct *napi = &rtwpci->napi; + struct rtw_pci_rx_ring *ring = &rtwpci->rx_rings[RTW_RX_QUEUE_MPDU]; + struct rtw_rx_pkt_stat pkt_stat; + struct ieee80211_rx_status rx_status; + struct sk_buff *skb, *new; + u32 cur_rp = ring->r.rp; + u32 count, rx_done = 0; + u32 pkt_offset; + u32 pkt_desc_sz = chip->rx_pkt_desc_sz; + u32 buf_desc_sz = chip->rx_buf_desc_sz; + u32 new_len; + u8 *rx_desc; + dma_addr_t dma; + + count = rtw_pci_get_hw_rx_ring_nr(rtwdev, rtwpci); + count = min(count, limit); + + while (count--) { + rtw_pci_dma_check(rtwdev, ring, cur_rp); + skb = ring->buf[cur_rp]; + dma = *((dma_addr_t *)skb->cb); + dma_sync_single_for_cpu(rtwdev->dev, dma, RTK_PCI_RX_BUF_SIZE, + DMA_FROM_DEVICE); + rx_desc = skb->data; + chip->ops->query_rx_desc(rtwdev, rx_desc, &pkt_stat, &rx_status); + + /* offset from rx_desc to payload */ + pkt_offset = pkt_desc_sz + pkt_stat.drv_info_sz + + pkt_stat.shift; + + /* allocate a new skb for this frame, + * discard the frame if none available + */ + new_len = pkt_stat.pkt_len + pkt_offset; + new = dev_alloc_skb(new_len); + if (WARN_ONCE(!new, "rx routine starvation\n")) + goto next_rp; + + /* put the DMA data including rx_desc from phy to new skb */ + skb_put_data(new, skb->data, new_len); + + if (pkt_stat.is_c2h) { + rtw_fw_c2h_cmd_rx_irqsafe(rtwdev, pkt_offset, new); + } else { + /* remove rx_desc */ + skb_pull(new, pkt_offset); + + rtw_rx_stats(rtwdev, pkt_stat.vif, new); + memcpy(new->cb, &rx_status, sizeof(rx_status)); + ieee80211_rx_napi(rtwdev->hw, NULL, new, napi); + rx_done++; + } + +next_rp: + /* new skb delivered to mac80211, re-enable original skb DMA */ + rtw_pci_sync_rx_desc_device(rtwdev, dma, ring, cur_rp, + buf_desc_sz); + + /* host read next element in ring */ + if (++cur_rp >= ring->r.len) + cur_rp = 0; + } + + ring->r.rp = cur_rp; + /* 'rp', the last position we have read, is seen as previous posistion + * of 'wp' that is used to calculate 'count' next time. + */ + ring->r.wp = cur_rp; + rtw_write16(rtwdev, RTK_PCI_RXBD_IDX_MPDUQ, ring->r.rp); + + return rx_done; +} + +static void rtw_pci_irq_recognized(struct rtw_dev *rtwdev, + struct rtw_pci *rtwpci, u32 *irq_status) +{ + unsigned long flags; + + spin_lock_irqsave(&rtwpci->hwirq_lock, flags); + + irq_status[0] = rtw_read32(rtwdev, RTK_PCI_HISR0); + irq_status[1] = rtw_read32(rtwdev, RTK_PCI_HISR1); + if (rtw_chip_wcpu_11ac(rtwdev)) + irq_status[3] = rtw_read32(rtwdev, RTK_PCI_HISR3); + else + irq_status[3] = 0; + irq_status[0] &= rtwpci->irq_mask[0]; + irq_status[1] &= rtwpci->irq_mask[1]; + irq_status[3] &= rtwpci->irq_mask[3]; + rtw_write32(rtwdev, RTK_PCI_HISR0, irq_status[0]); + rtw_write32(rtwdev, RTK_PCI_HISR1, irq_status[1]); + if (rtw_chip_wcpu_11ac(rtwdev)) + rtw_write32(rtwdev, RTK_PCI_HISR3, irq_status[3]); + + spin_unlock_irqrestore(&rtwpci->hwirq_lock, flags); +} + +static irqreturn_t rtw_pci_interrupt_handler(int irq, void *dev) +{ + struct rtw_dev *rtwdev = dev; + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + /* disable RTW PCI interrupt to avoid more interrupts before the end of + * thread function + * + * disable HIMR here to also avoid new HISR flag being raised before + * the HISRs have been Write-1-cleared for MSI. If not all of the HISRs + * are cleared, the edge-triggered interrupt will not be generated when + * a new HISR flag is set. + */ + rtw_pci_disable_interrupt(rtwdev, rtwpci); + + return IRQ_WAKE_THREAD; +} + +static irqreturn_t rtw_pci_interrupt_threadfn(int irq, void *dev) +{ + struct rtw_dev *rtwdev = dev; + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + u32 irq_status[4]; + bool rx = false; + + spin_lock_bh(&rtwpci->irq_lock); + rtw_pci_irq_recognized(rtwdev, rtwpci, irq_status); + + if (irq_status[0] & IMR_MGNTDOK) + rtw_pci_tx_isr(rtwdev, rtwpci, RTW_TX_QUEUE_MGMT); + if (irq_status[0] & IMR_HIGHDOK) + rtw_pci_tx_isr(rtwdev, rtwpci, RTW_TX_QUEUE_HI0); + if (irq_status[0] & IMR_BEDOK) + rtw_pci_tx_isr(rtwdev, rtwpci, RTW_TX_QUEUE_BE); + if (irq_status[0] & IMR_BKDOK) + rtw_pci_tx_isr(rtwdev, rtwpci, RTW_TX_QUEUE_BK); + if (irq_status[0] & IMR_VODOK) + rtw_pci_tx_isr(rtwdev, rtwpci, RTW_TX_QUEUE_VO); + if (irq_status[0] & IMR_VIDOK) + rtw_pci_tx_isr(rtwdev, rtwpci, RTW_TX_QUEUE_VI); + if (irq_status[3] & IMR_H2CDOK) + rtw_pci_tx_isr(rtwdev, rtwpci, RTW_TX_QUEUE_H2C); + if (irq_status[0] & IMR_ROK) { + rtw_pci_rx_isr(rtwdev); + rx = true; + } + if (unlikely(irq_status[0] & IMR_C2HCMD)) + rtw_fw_c2h_cmd_isr(rtwdev); + + /* all of the jobs for this interrupt have been done */ + if (rtwpci->running) + rtw_pci_enable_interrupt(rtwdev, rtwpci, rx); + spin_unlock_bh(&rtwpci->irq_lock); + + return IRQ_HANDLED; +} + +static int rtw_pci_io_mapping(struct rtw_dev *rtwdev, + struct pci_dev *pdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + unsigned long len; + u8 bar_id = 2; + int ret; + + ret = pci_request_regions(pdev, KBUILD_MODNAME); + if (ret) { + rtw_err(rtwdev, "failed to request pci regions\n"); + return ret; + } + + len = pci_resource_len(pdev, bar_id); + rtwpci->mmap = pci_iomap(pdev, bar_id, len); + if (!rtwpci->mmap) { + pci_release_regions(pdev); + rtw_err(rtwdev, "failed to map pci memory\n"); + return -ENOMEM; + } + + return 0; +} + +static void rtw_pci_io_unmapping(struct rtw_dev *rtwdev, + struct pci_dev *pdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + if (rtwpci->mmap) { + pci_iounmap(pdev, rtwpci->mmap); + pci_release_regions(pdev); + } +} + +static void rtw_dbi_write8(struct rtw_dev *rtwdev, u16 addr, u8 data) +{ + u16 write_addr; + u16 remainder = addr & ~(BITS_DBI_WREN | BITS_DBI_ADDR_MASK); + u8 flag; + u8 cnt; + + write_addr = addr & BITS_DBI_ADDR_MASK; + write_addr |= u16_encode_bits(BIT(remainder), BITS_DBI_WREN); + rtw_write8(rtwdev, REG_DBI_WDATA_V1 + remainder, data); + rtw_write16(rtwdev, REG_DBI_FLAG_V1, write_addr); + rtw_write8(rtwdev, REG_DBI_FLAG_V1 + 2, BIT_DBI_WFLAG >> 16); + + for (cnt = 0; cnt < RTW_PCI_WR_RETRY_CNT; cnt++) { + flag = rtw_read8(rtwdev, REG_DBI_FLAG_V1 + 2); + if (flag == 0) + return; + + udelay(10); + } + + WARN(flag, "failed to write to DBI register, addr=0x%04x\n", addr); +} + +static int rtw_dbi_read8(struct rtw_dev *rtwdev, u16 addr, u8 *value) +{ + u16 read_addr = addr & BITS_DBI_ADDR_MASK; + u8 flag; + u8 cnt; + + rtw_write16(rtwdev, REG_DBI_FLAG_V1, read_addr); + rtw_write8(rtwdev, REG_DBI_FLAG_V1 + 2, BIT_DBI_RFLAG >> 16); + + for (cnt = 0; cnt < RTW_PCI_WR_RETRY_CNT; cnt++) { + flag = rtw_read8(rtwdev, REG_DBI_FLAG_V1 + 2); + if (flag == 0) { + read_addr = REG_DBI_RDATA_V1 + (addr & 3); + *value = rtw_read8(rtwdev, read_addr); + return 0; + } + + udelay(10); + } + + WARN(1, "failed to read DBI register, addr=0x%04x\n", addr); + return -EIO; +} + +static void rtw_mdio_write(struct rtw_dev *rtwdev, u8 addr, u16 data, bool g1) +{ + u8 page; + u8 wflag; + u8 cnt; + + rtw_write16(rtwdev, REG_MDIO_V1, data); + + page = addr < RTW_PCI_MDIO_PG_SZ ? 0 : 1; + page += g1 ? RTW_PCI_MDIO_PG_OFFS_G1 : RTW_PCI_MDIO_PG_OFFS_G2; + rtw_write8(rtwdev, REG_PCIE_MIX_CFG, addr & BITS_MDIO_ADDR_MASK); + rtw_write8(rtwdev, REG_PCIE_MIX_CFG + 3, page); + rtw_write32_mask(rtwdev, REG_PCIE_MIX_CFG, BIT_MDIO_WFLAG_V1, 1); + + for (cnt = 0; cnt < RTW_PCI_WR_RETRY_CNT; cnt++) { + wflag = rtw_read32_mask(rtwdev, REG_PCIE_MIX_CFG, + BIT_MDIO_WFLAG_V1); + if (wflag == 0) + return; + + udelay(10); + } + + WARN(wflag, "failed to write to MDIO register, addr=0x%02x\n", addr); +} + +static void rtw_pci_clkreq_set(struct rtw_dev *rtwdev, bool enable) +{ + u8 value; + int ret; + + if (rtw_pci_disable_aspm) + return; + + ret = rtw_dbi_read8(rtwdev, RTK_PCIE_LINK_CFG, &value); + if (ret) { + rtw_err(rtwdev, "failed to read CLKREQ_L1, ret=%d", ret); + return; + } + + if (enable) + value |= BIT_CLKREQ_SW_EN; + else + value &= ~BIT_CLKREQ_SW_EN; + + rtw_dbi_write8(rtwdev, RTK_PCIE_LINK_CFG, value); +} + +static void rtw_pci_clkreq_pad_low(struct rtw_dev *rtwdev, bool enable) +{ + u8 value; + int ret; + + ret = rtw_dbi_read8(rtwdev, RTK_PCIE_LINK_CFG, &value); + if (ret) { + rtw_err(rtwdev, "failed to read CLKREQ_L1, ret=%d", ret); + return; + } + + if (enable) + value &= ~BIT_CLKREQ_N_PAD; + else + value |= BIT_CLKREQ_N_PAD; + + rtw_dbi_write8(rtwdev, RTK_PCIE_LINK_CFG, value); +} + +static void rtw_pci_aspm_set(struct rtw_dev *rtwdev, bool enable) +{ + u8 value; + int ret; + + if (rtw_pci_disable_aspm) + return; + + ret = rtw_dbi_read8(rtwdev, RTK_PCIE_LINK_CFG, &value); + if (ret) { + rtw_err(rtwdev, "failed to read ASPM, ret=%d", ret); + return; + } + + if (enable) + value |= BIT_L1_SW_EN; + else + value &= ~BIT_L1_SW_EN; + + rtw_dbi_write8(rtwdev, RTK_PCIE_LINK_CFG, value); +} + +static void rtw_pci_link_ps(struct rtw_dev *rtwdev, bool enter) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + /* Like CLKREQ, ASPM is also implemented by two HW modules, and can + * only be enabled when host supports it. + * + * And ASPM mechanism should be enabled when driver/firmware enters + * power save mode, without having heavy traffic. Because we've + * experienced some inter-operability issues that the link tends + * to enter L1 state on the fly even when driver is having high + * throughput. This is probably because the ASPM behavior slightly + * varies from different SOC. + */ + if (!(rtwpci->link_ctrl & PCI_EXP_LNKCTL_ASPM_L1)) + return; + + if ((enter && atomic_dec_if_positive(&rtwpci->link_usage) == 0) || + (!enter && atomic_inc_return(&rtwpci->link_usage) == 1)) + rtw_pci_aspm_set(rtwdev, enter); +} + +static void rtw_pci_link_cfg(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + struct pci_dev *pdev = rtwpci->pdev; + u16 link_ctrl; + int ret; + + /* RTL8822CE has enabled REFCLK auto calibration, it does not need + * to add clock delay to cover the REFCLK timing gap. + */ + if (chip->id == RTW_CHIP_TYPE_8822C) + rtw_dbi_write8(rtwdev, RTK_PCIE_CLKDLY_CTRL, 0); + + /* Though there is standard PCIE configuration space to set the + * link control register, but by Realtek's design, driver should + * check if host supports CLKREQ/ASPM to enable the HW module. + * + * These functions are implemented by two HW modules associated, + * one is responsible to access PCIE configuration space to + * follow the host settings, and another is in charge of doing + * CLKREQ/ASPM mechanisms, it is default disabled. Because sometimes + * the host does not support it, and due to some reasons or wrong + * settings (ex. CLKREQ# not Bi-Direction), it could lead to device + * loss if HW misbehaves on the link. + * + * Hence it's designed that driver should first check the PCIE + * configuration space is sync'ed and enabled, then driver can turn + * on the other module that is actually working on the mechanism. + */ + ret = pcie_capability_read_word(pdev, PCI_EXP_LNKCTL, &link_ctrl); + if (ret) { + rtw_err(rtwdev, "failed to read PCI cap, ret=%d\n", ret); + return; + } + + if (link_ctrl & PCI_EXP_LNKCTL_CLKREQ_EN) + rtw_pci_clkreq_set(rtwdev, true); + + rtwpci->link_ctrl = link_ctrl; +} + +static void rtw_pci_interface_cfg(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + switch (chip->id) { + case RTW_CHIP_TYPE_8822C: + if (rtwdev->hal.cut_version >= RTW_CHIP_VER_CUT_D) + rtw_write32_mask(rtwdev, REG_HCI_MIX_CFG, + BIT_PCIE_EMAC_PDN_AUX_TO_FAST_CLK, 1); + break; + default: + break; + } +} + +static void rtw_pci_phy_cfg(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + struct pci_dev *pdev = rtwpci->pdev; + const struct rtw_intf_phy_para *para; + u16 cut; + u16 value; + u16 offset; + int i; + int ret; + + cut = BIT(0) << rtwdev->hal.cut_version; + + for (i = 0; i < chip->intf_table->n_gen1_para; i++) { + para = &chip->intf_table->gen1_para[i]; + if (!(para->cut_mask & cut)) + continue; + if (para->offset == 0xffff) + break; + offset = para->offset; + value = para->value; + if (para->ip_sel == RTW_IP_SEL_PHY) + rtw_mdio_write(rtwdev, offset, value, true); + else + rtw_dbi_write8(rtwdev, offset, value); + } + + for (i = 0; i < chip->intf_table->n_gen2_para; i++) { + para = &chip->intf_table->gen2_para[i]; + if (!(para->cut_mask & cut)) + continue; + if (para->offset == 0xffff) + break; + offset = para->offset; + value = para->value; + if (para->ip_sel == RTW_IP_SEL_PHY) + rtw_mdio_write(rtwdev, offset, value, false); + else + rtw_dbi_write8(rtwdev, offset, value); + } + + rtw_pci_link_cfg(rtwdev); + + /* Disable 8821ce completion timeout by default */ + if (chip->id == RTW_CHIP_TYPE_8821C) { + ret = pcie_capability_set_word(pdev, PCI_EXP_DEVCTL2, + PCI_EXP_DEVCTL2_COMP_TMOUT_DIS); + if (ret) + rtw_err(rtwdev, "failed to set PCI cap, ret = %d\n", + ret); + } +} + +static int __maybe_unused rtw_pci_suspend(struct device *dev) +{ + struct ieee80211_hw *hw = dev_get_drvdata(dev); + struct rtw_dev *rtwdev = hw->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + + if (chip->id == RTW_CHIP_TYPE_8822C && efuse->rfe_option == 6) + rtw_pci_clkreq_pad_low(rtwdev, true); + return 0; +} + +static int __maybe_unused rtw_pci_resume(struct device *dev) +{ + struct ieee80211_hw *hw = dev_get_drvdata(dev); + struct rtw_dev *rtwdev = hw->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + + if (chip->id == RTW_CHIP_TYPE_8822C && efuse->rfe_option == 6) + rtw_pci_clkreq_pad_low(rtwdev, false); + return 0; +} + +SIMPLE_DEV_PM_OPS(rtw_pm_ops, rtw_pci_suspend, rtw_pci_resume); +EXPORT_SYMBOL(rtw_pm_ops); + +static int rtw_pci_claim(struct rtw_dev *rtwdev, struct pci_dev *pdev) +{ + int ret; + + ret = pci_enable_device(pdev); + if (ret) { + rtw_err(rtwdev, "failed to enable pci device\n"); + return ret; + } + + pci_set_master(pdev); + pci_set_drvdata(pdev, rtwdev->hw); + SET_IEEE80211_DEV(rtwdev->hw, &pdev->dev); + + return 0; +} + +static void rtw_pci_declaim(struct rtw_dev *rtwdev, struct pci_dev *pdev) +{ + pci_disable_device(pdev); +} + +static int rtw_pci_setup_resource(struct rtw_dev *rtwdev, struct pci_dev *pdev) +{ + struct rtw_pci *rtwpci; + int ret; + + rtwpci = (struct rtw_pci *)rtwdev->priv; + rtwpci->pdev = pdev; + + /* after this driver can access to hw registers */ + ret = rtw_pci_io_mapping(rtwdev, pdev); + if (ret) { + rtw_err(rtwdev, "failed to request pci io region\n"); + goto err_out; + } + + ret = rtw_pci_init(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to allocate pci resources\n"); + goto err_io_unmap; + } + + return 0; + +err_io_unmap: + rtw_pci_io_unmapping(rtwdev, pdev); + +err_out: + return ret; +} + +static void rtw_pci_destroy(struct rtw_dev *rtwdev, struct pci_dev *pdev) +{ + rtw_pci_deinit(rtwdev); + rtw_pci_io_unmapping(rtwdev, pdev); +} + +static struct rtw_hci_ops rtw_pci_ops = { + .tx_write = rtw_pci_tx_write, + .tx_kick_off = rtw_pci_tx_kick_off, + .flush_queues = rtw_pci_flush_queues, + .setup = rtw_pci_setup, + .start = rtw_pci_start, + .stop = rtw_pci_stop, + .deep_ps = rtw_pci_deep_ps, + .link_ps = rtw_pci_link_ps, + .interface_cfg = rtw_pci_interface_cfg, + + .read8 = rtw_pci_read8, + .read16 = rtw_pci_read16, + .read32 = rtw_pci_read32, + .write8 = rtw_pci_write8, + .write16 = rtw_pci_write16, + .write32 = rtw_pci_write32, + .write_data_rsvd_page = rtw_pci_write_data_rsvd_page, + .write_data_h2c = rtw_pci_write_data_h2c, +}; + +static int rtw_pci_request_irq(struct rtw_dev *rtwdev, struct pci_dev *pdev) +{ + unsigned int flags = PCI_IRQ_LEGACY; + int ret; + + if (!rtw_disable_msi) + flags |= PCI_IRQ_MSI; + + ret = pci_alloc_irq_vectors(pdev, 1, 1, flags); + if (ret < 0) { + rtw_err(rtwdev, "failed to alloc PCI irq vectors\n"); + return ret; + } + + ret = devm_request_threaded_irq(rtwdev->dev, pdev->irq, + rtw_pci_interrupt_handler, + rtw_pci_interrupt_threadfn, + IRQF_SHARED, KBUILD_MODNAME, rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to request irq %d\n", ret); + pci_free_irq_vectors(pdev); + } + + return ret; +} + +static void rtw_pci_free_irq(struct rtw_dev *rtwdev, struct pci_dev *pdev) +{ + devm_free_irq(rtwdev->dev, pdev->irq, rtwdev); + pci_free_irq_vectors(pdev); +} + +static int rtw_pci_napi_poll(struct napi_struct *napi, int budget) +{ + struct rtw_pci *rtwpci = container_of(napi, struct rtw_pci, napi); + struct rtw_dev *rtwdev = container_of((void *)rtwpci, struct rtw_dev, + priv); + int work_done = 0; + + if (rtwpci->rx_no_aspm) + rtw_pci_link_ps(rtwdev, false); + + while (work_done < budget) { + u32 work_done_once; + + work_done_once = rtw_pci_rx_napi(rtwdev, rtwpci, RTW_RX_QUEUE_MPDU, + budget - work_done); + if (work_done_once == 0) + break; + work_done += work_done_once; + } + if (work_done < budget) { + napi_complete_done(napi, work_done); + spin_lock_bh(&rtwpci->irq_lock); + if (rtwpci->running) + rtw_pci_enable_interrupt(rtwdev, rtwpci, false); + spin_unlock_bh(&rtwpci->irq_lock); + /* When ISR happens during polling and before napi_complete + * while no further data is received. Data on the dma_ring will + * not be processed immediately. Check whether dma ring is + * empty and perform napi_schedule accordingly. + */ + if (rtw_pci_get_hw_rx_ring_nr(rtwdev, rtwpci)) + napi_schedule(napi); + } + if (rtwpci->rx_no_aspm) + rtw_pci_link_ps(rtwdev, true); + + return work_done; +} + +static void rtw_pci_napi_init(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + init_dummy_netdev(&rtwpci->netdev); +#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 1, 0) + netif_napi_add(&rtwpci->netdev, &rtwpci->napi, rtw_pci_napi_poll); +#else + netif_napi_add(&rtwpci->netdev, &rtwpci->napi, rtw_pci_napi_poll, + NAPI_POLL_WEIGHT); +#endif +} + +static void rtw_pci_napi_deinit(struct rtw_dev *rtwdev) +{ + struct rtw_pci *rtwpci = (struct rtw_pci *)rtwdev->priv; + + rtw_pci_napi_stop(rtwdev); + netif_napi_del(&rtwpci->napi); +} + +int rtw_pci_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct pci_dev *bridge = pci_upstream_bridge(pdev); + struct ieee80211_hw *hw; + struct rtw_dev *rtwdev; + struct rtw_pci *rtwpci; + int drv_data_size; + int ret; + + drv_data_size = sizeof(struct rtw_dev) + sizeof(struct rtw_pci); + hw = ieee80211_alloc_hw(drv_data_size, &rtw_ops); + if (!hw) { + dev_err(&pdev->dev, "failed to allocate hw\n"); + return -ENOMEM; + } + + rtwdev = hw->priv; + rtwdev->hw = hw; + rtwdev->dev = &pdev->dev; + rtwdev->chip = (struct rtw_chip_info *)id->driver_data; + rtwdev->hci.ops = &rtw_pci_ops; + rtwdev->hci.type = RTW_HCI_TYPE_PCIE; + + rtwpci = (struct rtw_pci *)rtwdev->priv; + atomic_set(&rtwpci->link_usage, 1); + + ret = rtw_core_init(rtwdev); + if (ret) + goto err_release_hw; + + rtw_dbg(rtwdev, RTW_DBG_PCI, + "rtw88 pci probe: vendor=0x%4.04X device=0x%4.04X rev=%d\n", + pdev->vendor, pdev->device, pdev->revision); + + ret = rtw_pci_claim(rtwdev, pdev); + if (ret) { + rtw_err(rtwdev, "failed to claim pci device\n"); + goto err_deinit_core; + } + + ret = rtw_pci_setup_resource(rtwdev, pdev); + if (ret) { + rtw_err(rtwdev, "failed to setup pci resources\n"); + goto err_pci_declaim; + } + + rtw_pci_napi_init(rtwdev); + + ret = rtw_chip_info_setup(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to setup chip information\n"); + goto err_destroy_pci; + } + + /* Disable PCIe ASPM L1 while doing NAPI poll for 8821CE */ + if (rtwdev->chip->id == RTW_CHIP_TYPE_8821C && bridge->vendor == PCI_VENDOR_ID_INTEL) + rtwpci->rx_no_aspm = true; + + rtw_pci_phy_cfg(rtwdev); + + ret = rtw_register_hw(rtwdev, hw); + if (ret) { + rtw_err(rtwdev, "failed to register hw\n"); + goto err_destroy_pci; + } + + ret = rtw_pci_request_irq(rtwdev, pdev); + if (ret) { + ieee80211_unregister_hw(hw); + goto err_destroy_pci; + } + + return 0; + +err_destroy_pci: + rtw_pci_napi_deinit(rtwdev); + rtw_pci_destroy(rtwdev, pdev); + +err_pci_declaim: + rtw_pci_declaim(rtwdev, pdev); + +err_deinit_core: + rtw_core_deinit(rtwdev); + +err_release_hw: + ieee80211_free_hw(hw); + + return ret; +} +EXPORT_SYMBOL(rtw_pci_probe); + +void rtw_pci_remove(struct pci_dev *pdev) +{ + struct ieee80211_hw *hw = pci_get_drvdata(pdev); + struct rtw_dev *rtwdev; + struct rtw_pci *rtwpci; + + if (!hw) + return; + + rtwdev = hw->priv; + rtwpci = (struct rtw_pci *)rtwdev->priv; + + rtw_unregister_hw(rtwdev, hw); + rtw_pci_disable_interrupt(rtwdev, rtwpci); + rtw_pci_napi_deinit(rtwdev); + rtw_pci_destroy(rtwdev, pdev); + rtw_pci_declaim(rtwdev, pdev); + rtw_pci_free_irq(rtwdev, pdev); + rtw_core_deinit(rtwdev); + ieee80211_free_hw(hw); +} +EXPORT_SYMBOL(rtw_pci_remove); + +void rtw_pci_shutdown(struct pci_dev *pdev) +{ + struct ieee80211_hw *hw = pci_get_drvdata(pdev); + struct rtw_dev *rtwdev; + const struct rtw_chip_info *chip; + + if (!hw) + return; + + rtwdev = hw->priv; + chip = rtwdev->chip; + + if (chip->ops->shutdown) + chip->ops->shutdown(rtwdev); + + pci_set_power_state(pdev, PCI_D3hot); +} +EXPORT_SYMBOL(rtw_pci_shutdown); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless PCI driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/pci.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/pci.h new file mode 100644 index 0000000000000000000000000000000000000000..0c37efd8c66fa776be6362250a28ec154f19de58 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/pci.h @@ -0,0 +1,279 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTK_PCI_H_ +#define __RTK_PCI_H_ + +#include "main.h" + +#define RTK_DEFAULT_TX_DESC_NUM 128 +#define RTK_BEQ_TX_DESC_NUM 256 + +#define RTK_MAX_RX_DESC_NUM 512 +/* 11K + rx desc size */ +#define RTK_PCI_RX_BUF_SIZE (11454 + 24) + +#define RTK_PCI_CTRL 0x300 +#define BIT_RST_TRXDMA_INTF BIT(20) +#define BIT_RX_TAG_EN BIT(15) +#define REG_DBI_WDATA_V1 0x03E8 +#define REG_DBI_RDATA_V1 0x03EC +#define REG_DBI_FLAG_V1 0x03F0 +#define BIT_DBI_RFLAG BIT(17) +#define BIT_DBI_WFLAG BIT(16) +#define BITS_DBI_WREN GENMASK(15, 12) +#define BITS_DBI_ADDR_MASK GENMASK(11, 2) + +#define REG_MDIO_V1 0x03F4 +#define REG_PCIE_MIX_CFG 0x03F8 +#define BITS_MDIO_ADDR_MASK GENMASK(4, 0) +#define BIT_MDIO_WFLAG_V1 BIT(5) +#define RTW_PCI_MDIO_PG_SZ BIT(5) +#define RTW_PCI_MDIO_PG_OFFS_G1 0 +#define RTW_PCI_MDIO_PG_OFFS_G2 2 +#define RTW_PCI_WR_RETRY_CNT 20 + +#define RTK_PCIE_LINK_CFG 0x0719 +#define BIT_CLKREQ_SW_EN BIT(4) +#define BIT_L1_SW_EN BIT(3) +#define BIT_CLKREQ_N_PAD BIT(0) +#define RTK_PCIE_CLKDLY_CTRL 0x0725 + +#define BIT_PCI_BCNQ_FLAG BIT(4) +#define RTK_PCI_TXBD_DESA_BCNQ 0x308 +#define RTK_PCI_TXBD_DESA_H2CQ 0x1320 +#define RTK_PCI_TXBD_DESA_MGMTQ 0x310 +#define RTK_PCI_TXBD_DESA_BKQ 0x330 +#define RTK_PCI_TXBD_DESA_BEQ 0x328 +#define RTK_PCI_TXBD_DESA_VIQ 0x320 +#define RTK_PCI_TXBD_DESA_VOQ 0x318 +#define RTK_PCI_TXBD_DESA_HI0Q 0x340 +#define RTK_PCI_RXBD_DESA_MPDUQ 0x338 + +#define TRX_BD_IDX_MASK GENMASK(11, 0) +#define TRX_BD_HW_IDX_MASK GENMASK(27, 16) + +/* BCNQ is specialized for rsvd page, does not need to specify a number */ +#define RTK_PCI_TXBD_NUM_H2CQ 0x1328 +#define RTK_PCI_TXBD_NUM_MGMTQ 0x380 +#define RTK_PCI_TXBD_NUM_BKQ 0x38A +#define RTK_PCI_TXBD_NUM_BEQ 0x388 +#define RTK_PCI_TXBD_NUM_VIQ 0x386 +#define RTK_PCI_TXBD_NUM_VOQ 0x384 +#define RTK_PCI_TXBD_NUM_HI0Q 0x38C +#define RTK_PCI_RXBD_NUM_MPDUQ 0x382 +#define RTK_PCI_TXBD_IDX_H2CQ 0x132C +#define RTK_PCI_TXBD_IDX_MGMTQ 0x3B0 +#define RTK_PCI_TXBD_IDX_BKQ 0x3AC +#define RTK_PCI_TXBD_IDX_BEQ 0x3A8 +#define RTK_PCI_TXBD_IDX_VIQ 0x3A4 +#define RTK_PCI_TXBD_IDX_VOQ 0x3A0 +#define RTK_PCI_TXBD_IDX_HI0Q 0x3B8 +#define RTK_PCI_RXBD_IDX_MPDUQ 0x3B4 + +#define RTK_PCI_TXBD_RWPTR_CLR 0x39C +#define RTK_PCI_TXBD_H2CQ_CSR 0x1330 + +#define BIT_CLR_H2CQ_HOST_IDX BIT(16) +#define BIT_CLR_H2CQ_HW_IDX BIT(8) + +#define RTK_PCI_HIMR0 0x0B0 +#define RTK_PCI_HISR0 0x0B4 +#define RTK_PCI_HIMR1 0x0B8 +#define RTK_PCI_HISR1 0x0BC +#define RTK_PCI_HIMR2 0x10B0 +#define RTK_PCI_HISR2 0x10B4 +#define RTK_PCI_HIMR3 0x10B8 +#define RTK_PCI_HISR3 0x10BC +/* IMR 0 */ +#define IMR_TIMER2 BIT(31) +#define IMR_TIMER1 BIT(30) +#define IMR_PSTIMEOUT BIT(29) +#define IMR_GTINT4 BIT(28) +#define IMR_GTINT3 BIT(27) +#define IMR_TBDER BIT(26) +#define IMR_TBDOK BIT(25) +#define IMR_TSF_BIT32_TOGGLE BIT(24) +#define IMR_BCNDMAINT0 BIT(20) +#define IMR_BCNDOK0 BIT(16) +#define IMR_HSISR_IND_ON_INT BIT(15) +#define IMR_BCNDMAINT_E BIT(14) +#define IMR_ATIMEND BIT(12) +#define IMR_HISR1_IND_INT BIT(11) +#define IMR_C2HCMD BIT(10) +#define IMR_CPWM2 BIT(9) +#define IMR_CPWM BIT(8) +#define IMR_HIGHDOK BIT(7) +#define IMR_MGNTDOK BIT(6) +#define IMR_BKDOK BIT(5) +#define IMR_BEDOK BIT(4) +#define IMR_VIDOK BIT(3) +#define IMR_VODOK BIT(2) +#define IMR_RDU BIT(1) +#define IMR_ROK BIT(0) +/* IMR 1 */ +#define IMR_TXFIFO_TH_INT BIT(30) +#define IMR_BTON_STS_UPDATE BIT(29) +#define IMR_MCUERR BIT(28) +#define IMR_BCNDMAINT7 BIT(27) +#define IMR_BCNDMAINT6 BIT(26) +#define IMR_BCNDMAINT5 BIT(25) +#define IMR_BCNDMAINT4 BIT(24) +#define IMR_BCNDMAINT3 BIT(23) +#define IMR_BCNDMAINT2 BIT(22) +#define IMR_BCNDMAINT1 BIT(21) +#define IMR_BCNDOK7 BIT(20) +#define IMR_BCNDOK6 BIT(19) +#define IMR_BCNDOK5 BIT(18) +#define IMR_BCNDOK4 BIT(17) +#define IMR_BCNDOK3 BIT(16) +#define IMR_BCNDOK2 BIT(15) +#define IMR_BCNDOK1 BIT(14) +#define IMR_ATIMEND_E BIT(13) +#define IMR_ATIMEND BIT(12) +#define IMR_TXERR BIT(11) +#define IMR_RXERR BIT(10) +#define IMR_TXFOVW BIT(9) +#define IMR_RXFOVW BIT(8) +#define IMR_CPU_MGQ_TXDONE BIT(5) +#define IMR_PS_TIMER_C BIT(4) +#define IMR_PS_TIMER_B BIT(3) +#define IMR_PS_TIMER_A BIT(2) +#define IMR_CPUMGQ_TX_TIMER BIT(1) +/* IMR 3 */ +#define IMR_H2CDOK BIT(16) + +enum rtw_pci_flags { + RTW_PCI_FLAG_NAPI_RUNNING, + + NUM_OF_RTW_PCI_FLAGS, +}; + +/* one element is reserved to know if the ring is closed */ +static inline int avail_desc(u32 wp, u32 rp, u32 len) +{ + if (rp > wp) + return rp - wp - 1; + else + return len - wp + rp - 1; +} + +#define RTK_PCI_TXBD_OWN_OFFSET 15 +#define RTK_PCI_TXBD_BCN_WORK 0x383 + +struct rtw_pci_tx_buffer_desc { + __le16 buf_size; + __le16 psb_len; + __le32 dma; +}; + +struct rtw_pci_tx_data { + dma_addr_t dma; + u8 sn; +}; + +struct rtw_pci_ring { + u8 *head; + dma_addr_t dma; + + u8 desc_size; + + u32 len; + u32 wp; + u32 rp; +}; + +struct rtw_pci_tx_ring { + struct rtw_pci_ring r; + struct sk_buff_head queue; + bool queue_stopped; +}; + +struct rtw_pci_rx_buffer_desc { + __le16 buf_size; + __le16 total_pkt_size; + __le32 dma; +}; + +struct rtw_pci_rx_ring { + struct rtw_pci_ring r; + struct sk_buff *buf[RTK_MAX_RX_DESC_NUM]; +}; + +#define RX_TAG_MAX 8192 + +struct rtw_pci { + struct pci_dev *pdev; + + /* Used for PCI interrupt. */ + spinlock_t hwirq_lock; + /* Used for PCI TX ring/queueing, and enable INT. */ + spinlock_t irq_lock; + u32 irq_mask[4]; + bool irq_enabled; + bool running; + + /* napi structure */ + struct net_device netdev; + struct napi_struct napi; + + u16 rx_tag; + DECLARE_BITMAP(tx_queued, RTK_MAX_TX_QUEUE_NUM); + struct rtw_pci_tx_ring tx_rings[RTK_MAX_TX_QUEUE_NUM]; + struct rtw_pci_rx_ring rx_rings[RTK_MAX_RX_QUEUE_NUM]; + u16 link_ctrl; + atomic_t link_usage; + bool rx_no_aspm; + DECLARE_BITMAP(flags, NUM_OF_RTW_PCI_FLAGS); + + void __iomem *mmap; +}; + +extern const struct dev_pm_ops rtw_pm_ops; + +int rtw_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id); +void rtw_pci_remove(struct pci_dev *pdev); +void rtw_pci_shutdown(struct pci_dev *pdev); + +static inline u32 max_num_of_tx_queue(u8 queue) +{ + u32 max_num; + + switch (queue) { + case RTW_TX_QUEUE_BE: + max_num = RTK_BEQ_TX_DESC_NUM; + break; + case RTW_TX_QUEUE_BCN: + max_num = 1; + break; + default: + max_num = RTK_DEFAULT_TX_DESC_NUM; + break; + } + + return max_num; +} + +static inline struct +rtw_pci_tx_data *rtw_pci_get_tx_data(struct sk_buff *skb) +{ + struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); + + BUILD_BUG_ON(sizeof(struct rtw_pci_tx_data) > + sizeof(info->status.status_driver_data)); + + return (struct rtw_pci_tx_data *)info->status.status_driver_data; +} + +static inline +struct rtw_pci_tx_buffer_desc *get_tx_buffer_desc(struct rtw_pci_tx_ring *ring, + u32 size) +{ + u8 *buf_desc; + + buf_desc = ring->r.head + ring->r.wp * size; + return (struct rtw_pci_tx_buffer_desc *)buf_desc; +} + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/phy.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/phy.c new file mode 100644 index 0000000000000000000000000000000000000000..57534625c850a242c7e4f9e3d1b91bba3f35a96f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/phy.c @@ -0,0 +1,2551 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include + +#include "main.h" +#include "reg.h" +#include "fw.h" +#include "phy.h" +#include "debug.h" +#include "regd.h" +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) +#include "sar.h" +#endif + +struct phy_cfg_pair { + u32 addr; + u32 data; +}; + +union phy_table_tile { + struct rtw_phy_cond cond; + struct phy_cfg_pair cfg; +}; + +static const u32 db_invert_table[12][8] = { + {10, 13, 16, 20, + 25, 32, 40, 50}, + {64, 80, 101, 128, + 160, 201, 256, 318}, + {401, 505, 635, 800, + 1007, 1268, 1596, 2010}, + {316, 398, 501, 631, + 794, 1000, 1259, 1585}, + {1995, 2512, 3162, 3981, + 5012, 6310, 7943, 10000}, + {12589, 15849, 19953, 25119, + 31623, 39811, 50119, 63098}, + {79433, 100000, 125893, 158489, + 199526, 251189, 316228, 398107}, + {501187, 630957, 794328, 1000000, + 1258925, 1584893, 1995262, 2511886}, + {3162278, 3981072, 5011872, 6309573, + 7943282, 1000000, 12589254, 15848932}, + {19952623, 25118864, 31622777, 39810717, + 50118723, 63095734, 79432823, 100000000}, + {125892541, 158489319, 199526232, 251188643, + 316227766, 398107171, 501187234, 630957345}, + {794328235, 1000000000, 1258925412, 1584893192, + 1995262315, 2511886432U, 3162277660U, 3981071706U} +}; + +u8 rtw_cck_rates[] = { DESC_RATE1M, DESC_RATE2M, DESC_RATE5_5M, DESC_RATE11M }; +u8 rtw_ofdm_rates[] = { + DESC_RATE6M, DESC_RATE9M, DESC_RATE12M, + DESC_RATE18M, DESC_RATE24M, DESC_RATE36M, + DESC_RATE48M, DESC_RATE54M +}; +u8 rtw_ht_1s_rates[] = { + DESC_RATEMCS0, DESC_RATEMCS1, DESC_RATEMCS2, + DESC_RATEMCS3, DESC_RATEMCS4, DESC_RATEMCS5, + DESC_RATEMCS6, DESC_RATEMCS7 +}; +u8 rtw_ht_2s_rates[] = { + DESC_RATEMCS8, DESC_RATEMCS9, DESC_RATEMCS10, + DESC_RATEMCS11, DESC_RATEMCS12, DESC_RATEMCS13, + DESC_RATEMCS14, DESC_RATEMCS15 +}; +u8 rtw_vht_1s_rates[] = { + DESC_RATEVHT1SS_MCS0, DESC_RATEVHT1SS_MCS1, + DESC_RATEVHT1SS_MCS2, DESC_RATEVHT1SS_MCS3, + DESC_RATEVHT1SS_MCS4, DESC_RATEVHT1SS_MCS5, + DESC_RATEVHT1SS_MCS6, DESC_RATEVHT1SS_MCS7, + DESC_RATEVHT1SS_MCS8, DESC_RATEVHT1SS_MCS9 +}; +u8 rtw_vht_2s_rates[] = { + DESC_RATEVHT2SS_MCS0, DESC_RATEVHT2SS_MCS1, + DESC_RATEVHT2SS_MCS2, DESC_RATEVHT2SS_MCS3, + DESC_RATEVHT2SS_MCS4, DESC_RATEVHT2SS_MCS5, + DESC_RATEVHT2SS_MCS6, DESC_RATEVHT2SS_MCS7, + DESC_RATEVHT2SS_MCS8, DESC_RATEVHT2SS_MCS9 +}; +u8 *rtw_rate_section[RTW_RATE_SECTION_MAX] = { + rtw_cck_rates, rtw_ofdm_rates, + rtw_ht_1s_rates, rtw_ht_2s_rates, + rtw_vht_1s_rates, rtw_vht_2s_rates +}; +EXPORT_SYMBOL(rtw_rate_section); + +u8 rtw_rate_size[RTW_RATE_SECTION_MAX] = { + ARRAY_SIZE(rtw_cck_rates), + ARRAY_SIZE(rtw_ofdm_rates), + ARRAY_SIZE(rtw_ht_1s_rates), + ARRAY_SIZE(rtw_ht_2s_rates), + ARRAY_SIZE(rtw_vht_1s_rates), + ARRAY_SIZE(rtw_vht_2s_rates) +}; +EXPORT_SYMBOL(rtw_rate_size); + +static const u8 rtw_cck_size = ARRAY_SIZE(rtw_cck_rates); +static const u8 rtw_ofdm_size = ARRAY_SIZE(rtw_ofdm_rates); +static const u8 rtw_ht_1s_size = ARRAY_SIZE(rtw_ht_1s_rates); +static const u8 rtw_ht_2s_size = ARRAY_SIZE(rtw_ht_2s_rates); +static const u8 rtw_vht_1s_size = ARRAY_SIZE(rtw_vht_1s_rates); +static const u8 rtw_vht_2s_size = ARRAY_SIZE(rtw_vht_2s_rates); + +enum rtw_phy_band_type { + PHY_BAND_2G = 0, + PHY_BAND_5G = 1, +}; + +static void rtw_phy_cck_pd_init(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 i, j; + + for (i = 0; i <= RTW_CHANNEL_WIDTH_40; i++) { + for (j = 0; j < RTW_RF_PATH_MAX; j++) + dm_info->cck_pd_lv[i][j] = CCK_PD_LV0; + } + + dm_info->cck_fa_avg = CCK_FA_AVG_RESET; +} + +void rtw_phy_set_edcca_th(struct rtw_dev *rtwdev, u8 l2h, u8 h2l) +{ + struct rtw_hw_reg_offset *edcca_th = rtwdev->chip->edcca_th; + + rtw_write32_mask(rtwdev, + edcca_th[EDCCA_TH_L2H_IDX].hw_reg.addr, + edcca_th[EDCCA_TH_L2H_IDX].hw_reg.mask, + l2h + edcca_th[EDCCA_TH_L2H_IDX].offset); + rtw_write32_mask(rtwdev, + edcca_th[EDCCA_TH_H2L_IDX].hw_reg.addr, + edcca_th[EDCCA_TH_H2L_IDX].hw_reg.mask, + h2l + edcca_th[EDCCA_TH_H2L_IDX].offset); +} +EXPORT_SYMBOL(rtw_phy_set_edcca_th); + +void rtw_phy_adaptivity_set_mode(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + /* turn off in debugfs for debug usage */ + if (!rtw_edcca_enabled) { + dm_info->edcca_mode = RTW_EDCCA_NORMAL; + rtw_dbg(rtwdev, RTW_DBG_PHY, "EDCCA disabled, cannot be set\n"); + return; + } + + switch (rtwdev->regd.dfs_region) { + case NL80211_DFS_ETSI: + dm_info->edcca_mode = RTW_EDCCA_ADAPTIVITY; + dm_info->l2h_th_ini = chip->l2h_th_ini_ad; + break; + case NL80211_DFS_JP: + dm_info->edcca_mode = RTW_EDCCA_ADAPTIVITY; + dm_info->l2h_th_ini = chip->l2h_th_ini_cs; + break; + default: + dm_info->edcca_mode = RTW_EDCCA_NORMAL; + break; + } +} + +static void rtw_phy_adaptivity_init(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + rtw_phy_adaptivity_set_mode(rtwdev); + if (chip->ops->adaptivity_init) + chip->ops->adaptivity_init(rtwdev); +} + +static void rtw_phy_adaptivity(struct rtw_dev *rtwdev) +{ + if (rtwdev->chip->ops->adaptivity) + rtwdev->chip->ops->adaptivity(rtwdev); +} + +static void rtw_phy_cfo_init(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + if (chip->ops->cfo_init) + chip->ops->cfo_init(rtwdev); +} + +static void rtw_phy_tx_path_div_init(struct rtw_dev *rtwdev) +{ + struct rtw_path_div *path_div = &rtwdev->dm_path_div; + + path_div->current_tx_path = rtwdev->chip->default_1ss_tx_path; + path_div->path_a_cnt = 0; + path_div->path_a_sum = 0; + path_div->path_b_cnt = 0; + path_div->path_b_sum = 0; +} + +void rtw_phy_init(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 addr, mask; + + dm_info->fa_history[3] = 0; + dm_info->fa_history[2] = 0; + dm_info->fa_history[1] = 0; + dm_info->fa_history[0] = 0; + dm_info->igi_bitmap = 0; + dm_info->igi_history[3] = 0; + dm_info->igi_history[2] = 0; + dm_info->igi_history[1] = 0; + + addr = chip->dig[0].addr; + mask = chip->dig[0].mask; + dm_info->igi_history[0] = rtw_read32_mask(rtwdev, addr, mask); + rtw_phy_cck_pd_init(rtwdev); + + dm_info->iqk.done = false; + rtw_phy_adaptivity_init(rtwdev); + rtw_phy_cfo_init(rtwdev); + rtw_phy_tx_path_div_init(rtwdev); +} +EXPORT_SYMBOL(rtw_phy_init); + +void rtw_phy_dig_write(struct rtw_dev *rtwdev, u8 igi) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_hal *hal = &rtwdev->hal; + u32 addr, mask; + u8 path; + + if (chip->dig_cck) { + const struct rtw_hw_reg *dig_cck = &chip->dig_cck[0]; + rtw_write32_mask(rtwdev, dig_cck->addr, dig_cck->mask, igi >> 1); + } + + for (path = 0; path < hal->rf_path_num; path++) { + addr = chip->dig[path].addr; + mask = chip->dig[path].mask; + rtw_write32_mask(rtwdev, addr, mask, igi); + } +} + +static void rtw_phy_stat_false_alarm(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + chip->ops->false_alarm_statistics(rtwdev); +} + +#define RA_FLOOR_TABLE_SIZE 7 +#define RA_FLOOR_UP_GAP 3 + +static u8 rtw_phy_get_rssi_level(u8 old_level, u8 rssi) +{ + u8 table[RA_FLOOR_TABLE_SIZE] = {20, 34, 38, 42, 46, 50, 100}; + u8 new_level = 0; + int i; + + for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) + if (i >= old_level) + table[i] += RA_FLOOR_UP_GAP; + + for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { + if (rssi < table[i]) { + new_level = i; + break; + } + } + + return new_level; +} + +struct rtw_phy_stat_iter_data { + struct rtw_dev *rtwdev; + u8 min_rssi; +}; + +static void rtw_phy_stat_rssi_iter(void *data, struct ieee80211_sta *sta) +{ + struct rtw_phy_stat_iter_data *iter_data = data; + struct rtw_dev *rtwdev = iter_data->rtwdev; + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + u8 rssi; + + rssi = ewma_rssi_read(&si->avg_rssi); + si->rssi_level = rtw_phy_get_rssi_level(si->rssi_level, rssi); + + rtw_fw_send_rssi_info(rtwdev, si); + + iter_data->min_rssi = min_t(u8, rssi, iter_data->min_rssi); +} + +static void rtw_phy_stat_rssi(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_phy_stat_iter_data data = {}; + + data.rtwdev = rtwdev; + data.min_rssi = U8_MAX; + rtw_iterate_stas(rtwdev, rtw_phy_stat_rssi_iter, &data); + + dm_info->pre_min_rssi = dm_info->min_rssi; + dm_info->min_rssi = data.min_rssi; +} + +static void rtw_phy_stat_rate_cnt(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + dm_info->last_pkt_count = dm_info->cur_pkt_count; + memset(&dm_info->cur_pkt_count, 0, sizeof(dm_info->cur_pkt_count)); +} + +static void rtw_phy_statistics(struct rtw_dev *rtwdev) +{ + rtw_phy_stat_rssi(rtwdev); + rtw_phy_stat_false_alarm(rtwdev); + rtw_phy_stat_rate_cnt(rtwdev); +} + +#define DIG_PERF_FA_TH_LOW 250 +#define DIG_PERF_FA_TH_HIGH 500 +#define DIG_PERF_FA_TH_EXTRA_HIGH 750 +#define DIG_PERF_MAX 0x5a +#define DIG_PERF_MID 0x40 +#define DIG_CVRG_FA_TH_LOW 2000 +#define DIG_CVRG_FA_TH_HIGH 4000 +#define DIG_CVRG_FA_TH_EXTRA_HIGH 5000 +#define DIG_CVRG_MAX 0x2a +#define DIG_CVRG_MID 0x26 +#define DIG_CVRG_MIN 0x1c +#define DIG_RSSI_GAIN_OFFSET 15 + +static bool +rtw_phy_dig_check_damping(struct rtw_dm_info *dm_info) +{ + u16 fa_lo = DIG_PERF_FA_TH_LOW; + u16 fa_hi = DIG_PERF_FA_TH_HIGH; + u16 *fa_history; + u8 *igi_history; + u8 damping_rssi; + u8 min_rssi; + u8 diff; + u8 igi_bitmap; + bool damping = false; + + min_rssi = dm_info->min_rssi; + if (dm_info->damping) { + damping_rssi = dm_info->damping_rssi; + diff = min_rssi > damping_rssi ? min_rssi - damping_rssi : + damping_rssi - min_rssi; + if (diff > 3 || dm_info->damping_cnt++ > 20) { + dm_info->damping = false; + return false; + } + + return true; + } + + igi_history = dm_info->igi_history; + fa_history = dm_info->fa_history; + igi_bitmap = dm_info->igi_bitmap & 0xf; + switch (igi_bitmap) { + case 5: + /* down -> up -> down -> up */ + if (igi_history[0] > igi_history[1] && + igi_history[2] > igi_history[3] && + igi_history[0] - igi_history[1] >= 2 && + igi_history[2] - igi_history[3] >= 2 && + fa_history[0] > fa_hi && fa_history[1] < fa_lo && + fa_history[2] > fa_hi && fa_history[3] < fa_lo) + damping = true; + break; + case 9: + /* up -> down -> down -> up */ + if (igi_history[0] > igi_history[1] && + igi_history[3] > igi_history[2] && + igi_history[0] - igi_history[1] >= 4 && + igi_history[3] - igi_history[2] >= 2 && + fa_history[0] > fa_hi && fa_history[1] < fa_lo && + fa_history[2] < fa_lo && fa_history[3] > fa_hi) + damping = true; + break; + default: + return false; + } + + if (damping) { + dm_info->damping = true; + dm_info->damping_cnt = 0; + dm_info->damping_rssi = min_rssi; + } + + return damping; +} + +static void rtw_phy_dig_get_boundary(struct rtw_dev *rtwdev, + struct rtw_dm_info *dm_info, + u8 *upper, u8 *lower, bool linked) +{ + u8 dig_max, dig_min, dig_mid; + u8 min_rssi; + + if (linked) { + dig_max = DIG_PERF_MAX; + dig_mid = DIG_PERF_MID; + dig_min = rtwdev->chip->dig_min; + min_rssi = max_t(u8, dm_info->min_rssi, dig_min); + } else { + dig_max = DIG_CVRG_MAX; + dig_mid = DIG_CVRG_MID; + dig_min = DIG_CVRG_MIN; + min_rssi = dig_min; + } + + /* DIG MAX should be bounded by minimum RSSI with offset +15 */ + dig_max = min_t(u8, dig_max, min_rssi + DIG_RSSI_GAIN_OFFSET); + + *lower = clamp_t(u8, min_rssi, dig_min, dig_mid); + *upper = clamp_t(u8, *lower + DIG_RSSI_GAIN_OFFSET, dig_min, dig_max); +} + +static void rtw_phy_dig_get_threshold(struct rtw_dm_info *dm_info, + u16 *fa_th, u8 *step, bool linked) +{ + u8 min_rssi, pre_min_rssi; + + min_rssi = dm_info->min_rssi; + pre_min_rssi = dm_info->pre_min_rssi; + step[0] = 4; + step[1] = 3; + step[2] = 2; + + if (linked) { + fa_th[0] = DIG_PERF_FA_TH_EXTRA_HIGH; + fa_th[1] = DIG_PERF_FA_TH_HIGH; + fa_th[2] = DIG_PERF_FA_TH_LOW; + if (pre_min_rssi > min_rssi) { + step[0] = 6; + step[1] = 4; + step[2] = 2; + } + } else { + fa_th[0] = DIG_CVRG_FA_TH_EXTRA_HIGH; + fa_th[1] = DIG_CVRG_FA_TH_HIGH; + fa_th[2] = DIG_CVRG_FA_TH_LOW; + } +} + +static void rtw_phy_dig_recorder(struct rtw_dm_info *dm_info, u8 igi, u16 fa) +{ + u8 *igi_history; + u16 *fa_history; + u8 igi_bitmap; + bool up; + + igi_bitmap = dm_info->igi_bitmap << 1 & 0xfe; + igi_history = dm_info->igi_history; + fa_history = dm_info->fa_history; + + up = igi > igi_history[0]; + igi_bitmap |= up; + + igi_history[3] = igi_history[2]; + igi_history[2] = igi_history[1]; + igi_history[1] = igi_history[0]; + igi_history[0] = igi; + + fa_history[3] = fa_history[2]; + fa_history[2] = fa_history[1]; + fa_history[1] = fa_history[0]; + fa_history[0] = fa; + + dm_info->igi_bitmap = igi_bitmap; +} + +static void rtw_phy_dig(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 upper_bound, lower_bound; + u8 pre_igi, cur_igi; + u16 fa_th[3], fa_cnt; + u8 level; + u8 step[3]; + bool linked; + + if (test_bit(RTW_FLAG_DIG_DISABLE, rtwdev->flags)) + return; + + if (rtw_phy_dig_check_damping(dm_info)) + return; + + linked = !!rtwdev->sta_cnt; + + fa_cnt = dm_info->total_fa_cnt; + pre_igi = dm_info->igi_history[0]; + + rtw_phy_dig_get_threshold(dm_info, fa_th, step, linked); + + /* test the false alarm count from the highest threshold level first, + * and increase it by corresponding step size + * + * note that the step size is offset by -2, compensate it afterall + */ + cur_igi = pre_igi; + for (level = 0; level < 3; level++) { + if (fa_cnt > fa_th[level]) { + cur_igi += step[level]; + break; + } + } + cur_igi -= 2; + + /* calculate the upper/lower bound by the minimum rssi we have among + * the peers connected with us, meanwhile make sure the igi value does + * not beyond the hardware limitation + */ + rtw_phy_dig_get_boundary(rtwdev, dm_info, &upper_bound, &lower_bound, + linked); + cur_igi = clamp_t(u8, cur_igi, lower_bound, upper_bound); + + /* record current igi value and false alarm statistics for further + * damping checks, and record the trend of igi values + */ + rtw_phy_dig_recorder(dm_info, cur_igi, fa_cnt); + + if (cur_igi != pre_igi) + rtw_phy_dig_write(rtwdev, cur_igi); +} + +static void rtw_phy_ra_info_update_iter(void *data, struct ieee80211_sta *sta) +{ + struct rtw_dev *rtwdev = data; + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + + rtw_update_sta_info(rtwdev, si, false); +} + +static void rtw_phy_ra_info_update(struct rtw_dev *rtwdev) +{ + if (rtwdev->watch_dog_cnt & 0x3) + return; + + rtw_iterate_stas(rtwdev, rtw_phy_ra_info_update_iter, rtwdev); +} + +static u32 rtw_phy_get_rrsr_mask(struct rtw_dev *rtwdev, u8 rate_idx) +{ + u8 rate_order; + + rate_order = rate_idx; + + if (rate_idx >= DESC_RATEVHT4SS_MCS0) + rate_order -= DESC_RATEVHT4SS_MCS0; + else if (rate_idx >= DESC_RATEVHT3SS_MCS0) + rate_order -= DESC_RATEVHT3SS_MCS0; + else if (rate_idx >= DESC_RATEVHT2SS_MCS0) + rate_order -= DESC_RATEVHT2SS_MCS0; + else if (rate_idx >= DESC_RATEVHT1SS_MCS0) + rate_order -= DESC_RATEVHT1SS_MCS0; + else if (rate_idx >= DESC_RATEMCS24) + rate_order -= DESC_RATEMCS24; + else if (rate_idx >= DESC_RATEMCS16) + rate_order -= DESC_RATEMCS16; + else if (rate_idx >= DESC_RATEMCS8) + rate_order -= DESC_RATEMCS8; + else if (rate_idx >= DESC_RATEMCS0) + rate_order -= DESC_RATEMCS0; + else if (rate_idx >= DESC_RATE6M) + rate_order -= DESC_RATE6M; + else + rate_order -= DESC_RATE1M; + + if (rate_idx >= DESC_RATEMCS0 || rate_order == 0) + rate_order++; + + return GENMASK(rate_order + RRSR_RATE_ORDER_CCK_LEN - 1, 0); +} + +static void rtw_phy_rrsr_mask_min_iter(void *data, struct ieee80211_sta *sta) +{ + struct rtw_dev *rtwdev = (struct rtw_dev *)data; + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 mask = 0; + + mask = rtw_phy_get_rrsr_mask(rtwdev, si->ra_report.desc_rate); + if (mask < dm_info->rrsr_mask_min) + dm_info->rrsr_mask_min = mask; +} + +static void rtw_phy_rrsr_update(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + dm_info->rrsr_mask_min = RRSR_RATE_ORDER_MAX; + rtw_iterate_stas(rtwdev, rtw_phy_rrsr_mask_min_iter, rtwdev); + rtw_write32(rtwdev, REG_RRSR, dm_info->rrsr_val_init & dm_info->rrsr_mask_min); +} + +static void rtw_phy_dpk_track(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + if (chip->ops->dpk_track) + chip->ops->dpk_track(rtwdev); +} + +struct rtw_rx_addr_match_data { + struct rtw_dev *rtwdev; + struct ieee80211_hdr *hdr; + struct rtw_rx_pkt_stat *pkt_stat; + u8 *bssid; +}; + +static void rtw_phy_parsing_cfo_iter(void *data, u8 *mac, + struct ieee80211_vif *vif) +{ + struct rtw_rx_addr_match_data *iter_data = data; + struct rtw_dev *rtwdev = iter_data->rtwdev; + struct rtw_rx_pkt_stat *pkt_stat = iter_data->pkt_stat; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_cfo_track *cfo = &dm_info->cfo_track; + u8 *bssid = iter_data->bssid; + u8 i; + + if (!ether_addr_equal(vif->bss_conf.bssid, bssid)) + return; + + for (i = 0; i < rtwdev->hal.rf_path_num; i++) { + cfo->cfo_tail[i] += pkt_stat->cfo_tail[i]; + cfo->cfo_cnt[i]++; + } + + cfo->packet_count++; +} + +void rtw_phy_parsing_cfo(struct rtw_dev *rtwdev, + struct rtw_rx_pkt_stat *pkt_stat) +{ + struct ieee80211_hdr *hdr = pkt_stat->hdr; + struct rtw_rx_addr_match_data data = {}; + + if (pkt_stat->crc_err || pkt_stat->icv_err || !pkt_stat->phy_status || + ieee80211_is_ctl(hdr->frame_control)) + return; + + data.rtwdev = rtwdev; + data.hdr = hdr; + data.pkt_stat = pkt_stat; + data.bssid = get_hdr_bssid(hdr); + + rtw_iterate_vifs_atomic(rtwdev, rtw_phy_parsing_cfo_iter, &data); +} +EXPORT_SYMBOL(rtw_phy_parsing_cfo); + +static void rtw_phy_cfo_track(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + if (chip->ops->cfo_track) + chip->ops->cfo_track(rtwdev); +} + +#define CCK_PD_FA_LV1_MIN 1000 +#define CCK_PD_FA_LV0_MAX 500 + +static u8 rtw_phy_cck_pd_lv_unlink(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 cck_fa_avg = dm_info->cck_fa_avg; + + if (cck_fa_avg > CCK_PD_FA_LV1_MIN) + return CCK_PD_LV1; + + if (cck_fa_avg < CCK_PD_FA_LV0_MAX) + return CCK_PD_LV0; + + return CCK_PD_LV_MAX; +} + +#define CCK_PD_IGI_LV4_VAL 0x38 +#define CCK_PD_IGI_LV3_VAL 0x2a +#define CCK_PD_IGI_LV2_VAL 0x24 +#define CCK_PD_RSSI_LV4_VAL 32 +#define CCK_PD_RSSI_LV3_VAL 32 +#define CCK_PD_RSSI_LV2_VAL 24 + +static u8 rtw_phy_cck_pd_lv_link(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 igi = dm_info->igi_history[0]; + u8 rssi = dm_info->min_rssi; + u32 cck_fa_avg = dm_info->cck_fa_avg; + + if (igi > CCK_PD_IGI_LV4_VAL && rssi > CCK_PD_RSSI_LV4_VAL) + return CCK_PD_LV4; + if (igi > CCK_PD_IGI_LV3_VAL && rssi > CCK_PD_RSSI_LV3_VAL) + return CCK_PD_LV3; + if (igi > CCK_PD_IGI_LV2_VAL || rssi > CCK_PD_RSSI_LV2_VAL) + return CCK_PD_LV2; + if (cck_fa_avg > CCK_PD_FA_LV1_MIN) + return CCK_PD_LV1; + if (cck_fa_avg < CCK_PD_FA_LV0_MAX) + return CCK_PD_LV0; + + return CCK_PD_LV_MAX; +} + +static u8 rtw_phy_cck_pd_lv(struct rtw_dev *rtwdev) +{ + if (!rtw_is_assoc(rtwdev)) + return rtw_phy_cck_pd_lv_unlink(rtwdev); + else + return rtw_phy_cck_pd_lv_link(rtwdev); +} + +static void rtw_phy_cck_pd(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 cck_fa = dm_info->cck_fa_cnt; + u8 level; + + if (rtwdev->hal.current_band_type != RTW_BAND_2G) + return; + + if (dm_info->cck_fa_avg == CCK_FA_AVG_RESET) + dm_info->cck_fa_avg = cck_fa; + else + dm_info->cck_fa_avg = (dm_info->cck_fa_avg * 3 + cck_fa) >> 2; + + rtw_dbg(rtwdev, RTW_DBG_PHY, "IGI=0x%x, rssi_min=%d, cck_fa=%d\n", + dm_info->igi_history[0], dm_info->min_rssi, + dm_info->fa_history[0]); + rtw_dbg(rtwdev, RTW_DBG_PHY, "cck_fa_avg=%d, cck_pd_default=%d\n", + dm_info->cck_fa_avg, dm_info->cck_pd_default); + + level = rtw_phy_cck_pd_lv(rtwdev); + + if (level >= CCK_PD_LV_MAX) + return; + + if (chip->ops->cck_pd_set) + chip->ops->cck_pd_set(rtwdev, level); +} + +static void rtw_phy_pwr_track(struct rtw_dev *rtwdev) +{ + rtwdev->chip->ops->pwr_track(rtwdev); +} + +static void rtw_phy_ra_track(struct rtw_dev *rtwdev) +{ + rtw_fw_update_wl_phy_info(rtwdev); + rtw_phy_ra_info_update(rtwdev); + rtw_phy_rrsr_update(rtwdev); +} + +void rtw_phy_dynamic_mechanism(struct rtw_dev *rtwdev) +{ + /* for further calculation */ + rtw_phy_statistics(rtwdev); + rtw_phy_dig(rtwdev); + rtw_phy_cck_pd(rtwdev); + rtw_phy_ra_track(rtwdev); + rtw_phy_tx_path_diversity(rtwdev); + rtw_phy_cfo_track(rtwdev); + rtw_phy_dpk_track(rtwdev); + rtw_phy_pwr_track(rtwdev); + + if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_ADAPTIVITY)) + rtw_fw_adaptivity(rtwdev); + else + rtw_phy_adaptivity(rtwdev); +} + +#define FRAC_BITS 3 + +static u8 rtw_phy_power_2_db(s8 power) +{ + if (power <= -100 || power >= 20) + return 0; + else if (power >= 0) + return 100; + else + return 100 + power; +} + +static u64 rtw_phy_db_2_linear(u8 power_db) +{ + u8 i, j; + u64 linear; + + if (power_db > 96) + power_db = 96; + else if (power_db < 1) + return 1; + + /* 1dB ~ 96dB */ + i = (power_db - 1) >> 3; + j = (power_db - 1) - (i << 3); + + linear = db_invert_table[i][j]; + linear = i > 2 ? linear << FRAC_BITS : linear; + + return linear; +} + +static u8 rtw_phy_linear_2_db(u64 linear) +{ + u8 i; + u8 j; + u32 dB; + + for (i = 0; i < 12; i++) { + for (j = 0; j < 8; j++) { + if (i <= 2 && (linear << FRAC_BITS) <= db_invert_table[i][j]) + goto cnt; + else if (i > 2 && linear <= db_invert_table[i][j]) + goto cnt; + } + } + + return 96; /* maximum 96 dB */ + +cnt: + if (j == 0 && i == 0) + goto end; + + if (j == 0) { + if (i != 3) { + if (db_invert_table[i][0] - linear > + linear - db_invert_table[i - 1][7]) { + i = i - 1; + j = 7; + } + } else { + if (db_invert_table[3][0] - linear > + linear - db_invert_table[2][7]) { + i = 2; + j = 7; + } + } + } else { + if (db_invert_table[i][j] - linear > + linear - db_invert_table[i][j - 1]) { + j = j - 1; + } + } +end: + dB = (i << 3) + j + 1; + + return dB; +} + +u8 rtw_phy_rf_power_2_rssi(s8 *rf_power, u8 path_num) +{ + s8 power; + u8 power_db; + u64 linear; + u64 sum = 0; + u8 path; + + for (path = 0; path < path_num; path++) { + power = rf_power[path]; + power_db = rtw_phy_power_2_db(power); + linear = rtw_phy_db_2_linear(power_db); + sum += linear; + } + + sum = (sum + (1 << (FRAC_BITS - 1))) >> FRAC_BITS; + switch (path_num) { + case 2: + sum >>= 1; + break; + case 3: + sum = ((sum) + ((sum) << 1) + ((sum) << 3)) >> 5; + break; + case 4: + sum >>= 2; + break; + default: + break; + } + + return rtw_phy_linear_2_db(sum); +} +EXPORT_SYMBOL(rtw_phy_rf_power_2_rssi); + +u32 rtw_phy_read_rf(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask) +{ + struct rtw_hal *hal = &rtwdev->hal; + const struct rtw_chip_info *chip = rtwdev->chip; + const u32 *base_addr = chip->rf_base_addr; + u32 val, direct_addr; + + if (rf_path >= hal->rf_phy_num) { + rtw_err(rtwdev, "unsupported rf path (%d)\n", rf_path); + return INV_RF_DATA; + } + + addr &= 0xff; + direct_addr = base_addr[rf_path] + (addr << 2); + mask &= RFREG_MASK; + + val = rtw_read32_mask(rtwdev, direct_addr, mask); + + return val; +} +EXPORT_SYMBOL(rtw_phy_read_rf); + +u32 rtw_phy_read_rf_sipi(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask) +{ + struct rtw_hal *hal = &rtwdev->hal; + const struct rtw_chip_info *chip = rtwdev->chip; + const struct rtw_rf_sipi_addr *rf_sipi_addr; + const struct rtw_rf_sipi_addr *rf_sipi_addr_a; + u32 val32; + u32 en_pi; + u32 r_addr; + u32 shift; + + if (rf_path >= hal->rf_phy_num) { + rtw_err(rtwdev, "unsupported rf path (%d)\n", rf_path); + return INV_RF_DATA; + } + + if (!chip->rf_sipi_read_addr) { + rtw_err(rtwdev, "rf_sipi_read_addr isn't defined\n"); + return INV_RF_DATA; + } + + rf_sipi_addr = &chip->rf_sipi_read_addr[rf_path]; + rf_sipi_addr_a = &chip->rf_sipi_read_addr[RF_PATH_A]; + + addr &= 0xff; + + val32 = rtw_read32(rtwdev, rf_sipi_addr->hssi_2); + val32 = (val32 & ~LSSI_READ_ADDR_MASK) | (addr << 23); + rtw_write32(rtwdev, rf_sipi_addr->hssi_2, val32); + + /* toggle read edge of path A */ + val32 = rtw_read32(rtwdev, rf_sipi_addr_a->hssi_2); + rtw_write32(rtwdev, rf_sipi_addr_a->hssi_2, val32 & ~LSSI_READ_EDGE_MASK); + rtw_write32(rtwdev, rf_sipi_addr_a->hssi_2, val32 | LSSI_READ_EDGE_MASK); + + udelay(120); + + en_pi = rtw_read32_mask(rtwdev, rf_sipi_addr->hssi_1, BIT(8)); + r_addr = en_pi ? rf_sipi_addr->lssi_read_pi : rf_sipi_addr->lssi_read; + + val32 = rtw_read32_mask(rtwdev, r_addr, LSSI_READ_DATA_MASK); + + shift = __ffs(mask); + + return (val32 & mask) >> shift; +} +EXPORT_SYMBOL(rtw_phy_read_rf_sipi); + +bool rtw_phy_write_rf_reg_sipi(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask, u32 data) +{ + struct rtw_hal *hal = &rtwdev->hal; + const struct rtw_chip_info *chip = rtwdev->chip; + const u32 *sipi_addr = chip->rf_sipi_addr; + u32 data_and_addr; + u32 old_data = 0; + u32 shift; + + if (rf_path >= hal->rf_phy_num) { + rtw_err(rtwdev, "unsupported rf path (%d)\n", rf_path); + return false; + } + + addr &= 0xff; + mask &= RFREG_MASK; + + if (mask != RFREG_MASK) { + old_data = chip->ops->read_rf(rtwdev, rf_path, addr, RFREG_MASK); + + if (old_data == INV_RF_DATA) { + rtw_err(rtwdev, "Write fail, rf is disabled\n"); + return false; + } + + shift = __ffs(mask); + data = ((old_data) & (~mask)) | (data << shift); + } + + data_and_addr = ((addr << 20) | (data & 0x000fffff)) & 0x0fffffff; + + rtw_write32(rtwdev, sipi_addr[rf_path], data_and_addr); + + udelay(13); + + return true; +} +EXPORT_SYMBOL(rtw_phy_write_rf_reg_sipi); + +bool rtw_phy_write_rf_reg(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask, u32 data) +{ + struct rtw_hal *hal = &rtwdev->hal; + const struct rtw_chip_info *chip = rtwdev->chip; + const u32 *base_addr = chip->rf_base_addr; + u32 direct_addr; + + if (rf_path >= hal->rf_phy_num) { + rtw_err(rtwdev, "unsupported rf path (%d)\n", rf_path); + return false; + } + + addr &= 0xff; + direct_addr = base_addr[rf_path] + (addr << 2); + mask &= RFREG_MASK; + + rtw_write32_mask(rtwdev, direct_addr, mask, data); + + udelay(1); + + return true; +} + +bool rtw_phy_write_rf_reg_mix(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask, u32 data) +{ + if (addr != 0x00) + return rtw_phy_write_rf_reg(rtwdev, rf_path, addr, mask, data); + + return rtw_phy_write_rf_reg_sipi(rtwdev, rf_path, addr, mask, data); +} +EXPORT_SYMBOL(rtw_phy_write_rf_reg_mix); + +void rtw_phy_setup_phy_cond(struct rtw_dev *rtwdev, u32 pkg) +{ + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_phy_cond cond = {0}; + + cond.cut = hal->cut_version ? hal->cut_version : 15; + cond.pkg = pkg ? pkg : 15; + cond.plat = 0x04; + cond.rfe = efuse->rfe_option; + + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_USB: + cond.intf = INTF_USB; + break; + case RTW_HCI_TYPE_SDIO: + cond.intf = INTF_SDIO; + break; + case RTW_HCI_TYPE_PCIE: + default: + cond.intf = INTF_PCIE; + break; + } + + hal->phy_cond = cond; + + rtw_dbg(rtwdev, RTW_DBG_PHY, "phy cond=0x%08x\n", *((u32 *)&hal->phy_cond)); +} + +static bool check_positive(struct rtw_dev *rtwdev, struct rtw_phy_cond cond) +{ + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_phy_cond drv_cond = hal->phy_cond; + + if (cond.cut && cond.cut != drv_cond.cut) + return false; + + if (cond.pkg && cond.pkg != drv_cond.pkg) + return false; + + if (cond.intf && cond.intf != drv_cond.intf) + return false; + + if (cond.rfe != drv_cond.rfe) + return false; + + return true; +} + +void rtw_parse_tbl_phy_cond(struct rtw_dev *rtwdev, const struct rtw_table *tbl) +{ + const union phy_table_tile *p = tbl->data; + const union phy_table_tile *end = p + tbl->size / 2; + struct rtw_phy_cond pos_cond = {0}; + bool is_matched = true, is_skipped = false; + + BUILD_BUG_ON(sizeof(union phy_table_tile) != sizeof(struct phy_cfg_pair)); + + for (; p < end; p++) { + if (p->cond.pos) { + switch (p->cond.branch) { + case BRANCH_ENDIF: + is_matched = true; + is_skipped = false; + break; + case BRANCH_ELSE: + is_matched = is_skipped ? false : true; + break; + case BRANCH_IF: + case BRANCH_ELIF: + default: + pos_cond = p->cond; + break; + } + } else if (p->cond.neg) { + if (!is_skipped) { + if (check_positive(rtwdev, pos_cond)) { + is_matched = true; + is_skipped = true; + } else { + is_matched = false; + is_skipped = false; + } + } else { + is_matched = false; + } + } else if (is_matched) { + (*tbl->do_cfg)(rtwdev, tbl, p->cfg.addr, p->cfg.data); + } + } +} +EXPORT_SYMBOL(rtw_parse_tbl_phy_cond); + +#define bcd_to_dec_pwr_by_rate(val, i) bcd2bin(val >> (i * 8)) + +static u8 tbl_to_dec_pwr_by_rate(struct rtw_dev *rtwdev, u32 hex, u8 i) +{ + if (rtwdev->chip->is_pwr_by_rate_dec) + return bcd_to_dec_pwr_by_rate(hex, i); + + return (hex >> (i * 8)) & 0xFF; +} + +static void +rtw_phy_get_rate_values_of_txpwr_by_rate(struct rtw_dev *rtwdev, + u32 addr, u32 mask, u32 val, u8 *rate, + u8 *pwr_by_rate, u8 *rate_num) +{ + int i; + + switch (addr) { + case 0xE00: + case 0x830: + rate[0] = DESC_RATE6M; + rate[1] = DESC_RATE9M; + rate[2] = DESC_RATE12M; + rate[3] = DESC_RATE18M; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xE04: + case 0x834: + rate[0] = DESC_RATE24M; + rate[1] = DESC_RATE36M; + rate[2] = DESC_RATE48M; + rate[3] = DESC_RATE54M; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xE08: + rate[0] = DESC_RATE1M; + pwr_by_rate[0] = bcd_to_dec_pwr_by_rate(val, 1); + *rate_num = 1; + break; + case 0x86C: + if (mask == 0xffffff00) { + rate[0] = DESC_RATE2M; + rate[1] = DESC_RATE5_5M; + rate[2] = DESC_RATE11M; + for (i = 1; i < 4; ++i) + pwr_by_rate[i - 1] = + tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 3; + } else if (mask == 0x000000ff) { + rate[0] = DESC_RATE11M; + pwr_by_rate[0] = bcd_to_dec_pwr_by_rate(val, 0); + *rate_num = 1; + } + break; + case 0xE10: + case 0x83C: + rate[0] = DESC_RATEMCS0; + rate[1] = DESC_RATEMCS1; + rate[2] = DESC_RATEMCS2; + rate[3] = DESC_RATEMCS3; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xE14: + case 0x848: + rate[0] = DESC_RATEMCS4; + rate[1] = DESC_RATEMCS5; + rate[2] = DESC_RATEMCS6; + rate[3] = DESC_RATEMCS7; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xE18: + case 0x84C: + rate[0] = DESC_RATEMCS8; + rate[1] = DESC_RATEMCS9; + rate[2] = DESC_RATEMCS10; + rate[3] = DESC_RATEMCS11; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xE1C: + case 0x868: + rate[0] = DESC_RATEMCS12; + rate[1] = DESC_RATEMCS13; + rate[2] = DESC_RATEMCS14; + rate[3] = DESC_RATEMCS15; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0x838: + rate[0] = DESC_RATE1M; + rate[1] = DESC_RATE2M; + rate[2] = DESC_RATE5_5M; + for (i = 1; i < 4; ++i) + pwr_by_rate[i - 1] = tbl_to_dec_pwr_by_rate(rtwdev, + val, i); + *rate_num = 3; + break; + case 0xC20: + case 0xE20: + case 0x1820: + case 0x1A20: + rate[0] = DESC_RATE1M; + rate[1] = DESC_RATE2M; + rate[2] = DESC_RATE5_5M; + rate[3] = DESC_RATE11M; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC24: + case 0xE24: + case 0x1824: + case 0x1A24: + rate[0] = DESC_RATE6M; + rate[1] = DESC_RATE9M; + rate[2] = DESC_RATE12M; + rate[3] = DESC_RATE18M; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC28: + case 0xE28: + case 0x1828: + case 0x1A28: + rate[0] = DESC_RATE24M; + rate[1] = DESC_RATE36M; + rate[2] = DESC_RATE48M; + rate[3] = DESC_RATE54M; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC2C: + case 0xE2C: + case 0x182C: + case 0x1A2C: + rate[0] = DESC_RATEMCS0; + rate[1] = DESC_RATEMCS1; + rate[2] = DESC_RATEMCS2; + rate[3] = DESC_RATEMCS3; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC30: + case 0xE30: + case 0x1830: + case 0x1A30: + rate[0] = DESC_RATEMCS4; + rate[1] = DESC_RATEMCS5; + rate[2] = DESC_RATEMCS6; + rate[3] = DESC_RATEMCS7; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC34: + case 0xE34: + case 0x1834: + case 0x1A34: + rate[0] = DESC_RATEMCS8; + rate[1] = DESC_RATEMCS9; + rate[2] = DESC_RATEMCS10; + rate[3] = DESC_RATEMCS11; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC38: + case 0xE38: + case 0x1838: + case 0x1A38: + rate[0] = DESC_RATEMCS12; + rate[1] = DESC_RATEMCS13; + rate[2] = DESC_RATEMCS14; + rate[3] = DESC_RATEMCS15; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC3C: + case 0xE3C: + case 0x183C: + case 0x1A3C: + rate[0] = DESC_RATEVHT1SS_MCS0; + rate[1] = DESC_RATEVHT1SS_MCS1; + rate[2] = DESC_RATEVHT1SS_MCS2; + rate[3] = DESC_RATEVHT1SS_MCS3; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC40: + case 0xE40: + case 0x1840: + case 0x1A40: + rate[0] = DESC_RATEVHT1SS_MCS4; + rate[1] = DESC_RATEVHT1SS_MCS5; + rate[2] = DESC_RATEVHT1SS_MCS6; + rate[3] = DESC_RATEVHT1SS_MCS7; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC44: + case 0xE44: + case 0x1844: + case 0x1A44: + rate[0] = DESC_RATEVHT1SS_MCS8; + rate[1] = DESC_RATEVHT1SS_MCS9; + rate[2] = DESC_RATEVHT2SS_MCS0; + rate[3] = DESC_RATEVHT2SS_MCS1; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC48: + case 0xE48: + case 0x1848: + case 0x1A48: + rate[0] = DESC_RATEVHT2SS_MCS2; + rate[1] = DESC_RATEVHT2SS_MCS3; + rate[2] = DESC_RATEVHT2SS_MCS4; + rate[3] = DESC_RATEVHT2SS_MCS5; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xC4C: + case 0xE4C: + case 0x184C: + case 0x1A4C: + rate[0] = DESC_RATEVHT2SS_MCS6; + rate[1] = DESC_RATEVHT2SS_MCS7; + rate[2] = DESC_RATEVHT2SS_MCS8; + rate[3] = DESC_RATEVHT2SS_MCS9; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xCD8: + case 0xED8: + case 0x18D8: + case 0x1AD8: + rate[0] = DESC_RATEMCS16; + rate[1] = DESC_RATEMCS17; + rate[2] = DESC_RATEMCS18; + rate[3] = DESC_RATEMCS19; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xCDC: + case 0xEDC: + case 0x18DC: + case 0x1ADC: + rate[0] = DESC_RATEMCS20; + rate[1] = DESC_RATEMCS21; + rate[2] = DESC_RATEMCS22; + rate[3] = DESC_RATEMCS23; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xCE0: + case 0xEE0: + case 0x18E0: + case 0x1AE0: + rate[0] = DESC_RATEVHT3SS_MCS0; + rate[1] = DESC_RATEVHT3SS_MCS1; + rate[2] = DESC_RATEVHT3SS_MCS2; + rate[3] = DESC_RATEVHT3SS_MCS3; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xCE4: + case 0xEE4: + case 0x18E4: + case 0x1AE4: + rate[0] = DESC_RATEVHT3SS_MCS4; + rate[1] = DESC_RATEVHT3SS_MCS5; + rate[2] = DESC_RATEVHT3SS_MCS6; + rate[3] = DESC_RATEVHT3SS_MCS7; + for (i = 0; i < 4; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 4; + break; + case 0xCE8: + case 0xEE8: + case 0x18E8: + case 0x1AE8: + rate[0] = DESC_RATEVHT3SS_MCS8; + rate[1] = DESC_RATEVHT3SS_MCS9; + for (i = 0; i < 2; ++i) + pwr_by_rate[i] = tbl_to_dec_pwr_by_rate(rtwdev, val, i); + *rate_num = 2; + break; + default: + rtw_warn(rtwdev, "invalid tx power index addr 0x%08x\n", addr); + break; + } +} + +static void rtw_phy_store_tx_power_by_rate(struct rtw_dev *rtwdev, + u32 band, u32 rfpath, u32 txnum, + u32 regaddr, u32 bitmask, u32 data) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 rate_num = 0; + u8 rate; + u8 rates[RTW_RF_PATH_MAX] = {0}; + s8 offset; + s8 pwr_by_rate[RTW_RF_PATH_MAX] = {0}; + int i; + + rtw_phy_get_rate_values_of_txpwr_by_rate(rtwdev, regaddr, bitmask, data, + rates, pwr_by_rate, &rate_num); + + if (WARN_ON(rfpath >= RTW_RF_PATH_MAX || + (band != PHY_BAND_2G && band != PHY_BAND_5G) || + rate_num > RTW_RF_PATH_MAX)) + return; + + for (i = 0; i < rate_num; i++) { + offset = pwr_by_rate[i]; + rate = rates[i]; + if (band == PHY_BAND_2G) + hal->tx_pwr_by_rate_offset_2g[rfpath][rate] = offset; + else if (band == PHY_BAND_5G) + hal->tx_pwr_by_rate_offset_5g[rfpath][rate] = offset; + else + continue; + } +} + +void rtw_parse_tbl_bb_pg(struct rtw_dev *rtwdev, const struct rtw_table *tbl) +{ + const struct rtw_phy_pg_cfg_pair *p = tbl->data; + const struct rtw_phy_pg_cfg_pair *end = p + tbl->size; + + for (; p < end; p++) { + if (p->addr == 0xfe || p->addr == 0xffe) { + msleep(50); + continue; + } + rtw_phy_store_tx_power_by_rate(rtwdev, p->band, p->rf_path, + p->tx_num, p->addr, p->bitmask, + p->data); + } +} +EXPORT_SYMBOL(rtw_parse_tbl_bb_pg); + +static const u8 rtw_channel_idx_5g[RTW_MAX_CHANNEL_NUM_5G] = { + 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 */ + +static int rtw_channel_to_idx(u8 band, u8 channel) +{ + int ch_idx; + u8 n_channel; + + if (band == PHY_BAND_2G) { + ch_idx = channel - 1; + n_channel = RTW_MAX_CHANNEL_NUM_2G; + } else if (band == PHY_BAND_5G) { + n_channel = RTW_MAX_CHANNEL_NUM_5G; + for (ch_idx = 0; ch_idx < n_channel; ch_idx++) + if (rtw_channel_idx_5g[ch_idx] == channel) + break; + } else { + return -1; + } + + if (ch_idx >= n_channel) + return -1; + + return ch_idx; +} + +static void rtw_phy_set_tx_power_limit(struct rtw_dev *rtwdev, u8 regd, u8 band, + u8 bw, u8 rs, u8 ch, s8 pwr_limit) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 max_power_index = rtwdev->chip->max_power_index; + s8 ww; + int ch_idx; + + pwr_limit = clamp_t(s8, pwr_limit, + -max_power_index, max_power_index); + ch_idx = rtw_channel_to_idx(band, ch); + + if (regd >= RTW_REGD_MAX || bw >= RTW_CHANNEL_WIDTH_MAX || + rs >= RTW_RATE_SECTION_MAX || ch_idx < 0) { + WARN(1, + "wrong txpwr_lmt regd=%u, band=%u bw=%u, rs=%u, ch_idx=%u, pwr_limit=%d\n", + regd, band, bw, rs, ch_idx, pwr_limit); + return; + } + + if (band == PHY_BAND_2G) { + hal->tx_pwr_limit_2g[regd][bw][rs][ch_idx] = pwr_limit; + ww = hal->tx_pwr_limit_2g[RTW_REGD_WW][bw][rs][ch_idx]; + ww = min_t(s8, ww, pwr_limit); + hal->tx_pwr_limit_2g[RTW_REGD_WW][bw][rs][ch_idx] = ww; + } else if (band == PHY_BAND_5G) { + hal->tx_pwr_limit_5g[regd][bw][rs][ch_idx] = pwr_limit; + ww = hal->tx_pwr_limit_5g[RTW_REGD_WW][bw][rs][ch_idx]; + ww = min_t(s8, ww, pwr_limit); + hal->tx_pwr_limit_5g[RTW_REGD_WW][bw][rs][ch_idx] = ww; + } +} + +/* cross-reference 5G power limits if values are not assigned */ +static void +rtw_xref_5g_txpwr_lmt(struct rtw_dev *rtwdev, u8 regd, + u8 bw, u8 ch_idx, u8 rs_ht, u8 rs_vht) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 max_power_index = rtwdev->chip->max_power_index; + s8 lmt_ht = hal->tx_pwr_limit_5g[regd][bw][rs_ht][ch_idx]; + s8 lmt_vht = hal->tx_pwr_limit_5g[regd][bw][rs_vht][ch_idx]; + + if (lmt_ht == lmt_vht) + return; + + if (lmt_ht == max_power_index) + hal->tx_pwr_limit_5g[regd][bw][rs_ht][ch_idx] = lmt_vht; + + else if (lmt_vht == max_power_index) + hal->tx_pwr_limit_5g[regd][bw][rs_vht][ch_idx] = lmt_ht; +} + +/* cross-reference power limits for ht and vht */ +static void +rtw_xref_txpwr_lmt_by_rs(struct rtw_dev *rtwdev, u8 regd, u8 bw, u8 ch_idx) +{ + u8 rs_idx, rs_ht, rs_vht; + u8 rs_cmp[2][2] = {{RTW_RATE_SECTION_HT_1S, RTW_RATE_SECTION_VHT_1S}, + {RTW_RATE_SECTION_HT_2S, RTW_RATE_SECTION_VHT_2S} }; + + for (rs_idx = 0; rs_idx < 2; rs_idx++) { + rs_ht = rs_cmp[rs_idx][0]; + rs_vht = rs_cmp[rs_idx][1]; + + rtw_xref_5g_txpwr_lmt(rtwdev, regd, bw, ch_idx, rs_ht, rs_vht); + } +} + +/* cross-reference power limits for 5G channels */ +static void +rtw_xref_5g_txpwr_lmt_by_ch(struct rtw_dev *rtwdev, u8 regd, u8 bw) +{ + u8 ch_idx; + + for (ch_idx = 0; ch_idx < RTW_MAX_CHANNEL_NUM_5G; ch_idx++) + rtw_xref_txpwr_lmt_by_rs(rtwdev, regd, bw, ch_idx); +} + +/* cross-reference power limits for 20/40M bandwidth */ +static void +rtw_xref_txpwr_lmt_by_bw(struct rtw_dev *rtwdev, u8 regd) +{ + u8 bw; + + for (bw = RTW_CHANNEL_WIDTH_20; bw <= RTW_CHANNEL_WIDTH_40; bw++) + rtw_xref_5g_txpwr_lmt_by_ch(rtwdev, regd, bw); +} + +/* cross-reference power limits */ +static void rtw_xref_txpwr_lmt(struct rtw_dev *rtwdev) +{ + u8 regd; + + for (regd = 0; regd < RTW_REGD_MAX; regd++) + rtw_xref_txpwr_lmt_by_bw(rtwdev, regd); +} + +static void +__cfg_txpwr_lmt_by_alt(struct rtw_hal *hal, u8 regd, u8 regd_alt, u8 bw, u8 rs) +{ + u8 ch; + + for (ch = 0; ch < RTW_MAX_CHANNEL_NUM_2G; ch++) + hal->tx_pwr_limit_2g[regd][bw][rs][ch] = + hal->tx_pwr_limit_2g[regd_alt][bw][rs][ch]; + + for (ch = 0; ch < RTW_MAX_CHANNEL_NUM_5G; ch++) + hal->tx_pwr_limit_5g[regd][bw][rs][ch] = + hal->tx_pwr_limit_5g[regd_alt][bw][rs][ch]; +} + +static void +rtw_cfg_txpwr_lmt_by_alt(struct rtw_dev *rtwdev, u8 regd, u8 regd_alt) +{ + u8 bw, rs; + + for (bw = 0; bw < RTW_CHANNEL_WIDTH_MAX; bw++) + for (rs = 0; rs < RTW_RATE_SECTION_MAX; rs++) + __cfg_txpwr_lmt_by_alt(&rtwdev->hal, regd, regd_alt, + bw, rs); +} + +void rtw_parse_tbl_txpwr_lmt(struct rtw_dev *rtwdev, + const struct rtw_table *tbl) +{ + const struct rtw_txpwr_lmt_cfg_pair *p = tbl->data; + const struct rtw_txpwr_lmt_cfg_pair *end = p + tbl->size; + u32 regd_cfg_flag = 0; + u8 regd_alt; + u8 i; + + for (; p < end; p++) { + regd_cfg_flag |= BIT(p->regd); + rtw_phy_set_tx_power_limit(rtwdev, p->regd, p->band, + p->bw, p->rs, p->ch, p->txpwr_lmt); + } + + for (i = 0; i < RTW_REGD_MAX; i++) { + if (i == RTW_REGD_WW) + continue; + + if (regd_cfg_flag & BIT(i)) + continue; + + rtw_dbg(rtwdev, RTW_DBG_REGD, + "txpwr regd %d does not be configured\n", i); + + if (rtw_regd_has_alt(i, ®d_alt) && + regd_cfg_flag & BIT(regd_alt)) { + rtw_dbg(rtwdev, RTW_DBG_REGD, + "cfg txpwr regd %d by regd %d as alternative\n", + i, regd_alt); + + rtw_cfg_txpwr_lmt_by_alt(rtwdev, i, regd_alt); + continue; + } + + rtw_dbg(rtwdev, RTW_DBG_REGD, "cfg txpwr regd %d by WW\n", i); + rtw_cfg_txpwr_lmt_by_alt(rtwdev, i, RTW_REGD_WW); + } + + rtw_xref_txpwr_lmt(rtwdev); +} +EXPORT_SYMBOL(rtw_parse_tbl_txpwr_lmt); + +void rtw_phy_cfg_mac(struct rtw_dev *rtwdev, const struct rtw_table *tbl, + u32 addr, u32 data) +{ + rtw_write8(rtwdev, addr, data); +} +EXPORT_SYMBOL(rtw_phy_cfg_mac); + +void rtw_phy_cfg_agc(struct rtw_dev *rtwdev, const struct rtw_table *tbl, + u32 addr, u32 data) +{ + rtw_write32(rtwdev, addr, data); +} +EXPORT_SYMBOL(rtw_phy_cfg_agc); + +void rtw_phy_cfg_bb(struct rtw_dev *rtwdev, const struct rtw_table *tbl, + u32 addr, u32 data) +{ + if (addr == 0xfe) + msleep(50); + else if (addr == 0xfd) + mdelay(5); + else if (addr == 0xfc) + mdelay(1); + else if (addr == 0xfb) + usleep_range(50, 60); + else if (addr == 0xfa) + udelay(5); + else if (addr == 0xf9) + udelay(1); + else + rtw_write32(rtwdev, addr, data); +} +EXPORT_SYMBOL(rtw_phy_cfg_bb); + +void rtw_phy_cfg_rf(struct rtw_dev *rtwdev, const struct rtw_table *tbl, + u32 addr, u32 data) +{ + if (addr == 0xffe) { + msleep(50); + } else if (addr == 0xfe) { + usleep_range(100, 110); + } else { + rtw_write_rf(rtwdev, tbl->rf_path, addr, RFREG_MASK, data); + udelay(1); + } +} +EXPORT_SYMBOL(rtw_phy_cfg_rf); + +static void rtw_load_rfk_table(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + + if (!chip->rfk_init_tbl) + return; + + rtw_write32_mask(rtwdev, 0x1e24, BIT(17), 0x1); + rtw_write32_mask(rtwdev, 0x1cd0, BIT(28), 0x1); + rtw_write32_mask(rtwdev, 0x1cd0, BIT(29), 0x1); + rtw_write32_mask(rtwdev, 0x1cd0, BIT(30), 0x1); + rtw_write32_mask(rtwdev, 0x1cd0, BIT(31), 0x0); + + rtw_load_table(rtwdev, chip->rfk_init_tbl); + + dpk_info->is_dpk_pwr_on = true; +} + +void rtw_phy_load_tables(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + u8 rf_path; + + rtw_load_table(rtwdev, chip->mac_tbl); + rtw_load_table(rtwdev, chip->bb_tbl); + rtw_load_table(rtwdev, chip->agc_tbl); + rtw_load_rfk_table(rtwdev); + + for (rf_path = 0; rf_path < rtwdev->hal.rf_path_num; rf_path++) { + const struct rtw_table *tbl; + + tbl = chip->rf_tbl[rf_path]; + rtw_load_table(rtwdev, tbl); + } +} +EXPORT_SYMBOL(rtw_phy_load_tables); + +static u8 rtw_get_channel_group(u8 channel, u8 rate) +{ + switch (channel) { + default: + WARN_ON(1); + fallthrough; + case 1: + case 2: + case 36: + case 38: + case 40: + case 42: + return 0; + case 3: + case 4: + case 5: + case 44: + case 46: + case 48: + case 50: + return 1; + case 6: + case 7: + case 8: + case 52: + case 54: + case 56: + case 58: + return 2; + case 9: + case 10: + case 11: + case 60: + case 62: + case 64: + return 3; + case 12: + case 13: + case 100: + case 102: + case 104: + case 106: + return 4; + case 14: + return rate <= DESC_RATE11M ? 5 : 4; + case 108: + case 110: + case 112: + case 114: + return 5; + case 116: + case 118: + case 120: + case 122: + return 6; + case 124: + case 126: + case 128: + case 130: + return 7; + case 132: + case 134: + case 136: + case 138: + return 8; + case 140: + case 142: + case 144: + return 9; + case 149: + case 151: + case 153: + case 155: + return 10; + case 157: + case 159: + case 161: + return 11; + case 165: + case 167: + case 169: + case 171: + return 12; + case 173: + case 175: + case 177: + return 13; + } +} + +static s8 rtw_phy_get_dis_dpd_by_rate_diff(struct rtw_dev *rtwdev, u16 rate) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + s8 dpd_diff = 0; + + if (!chip->en_dis_dpd) + return 0; + +#define RTW_DPD_RATE_CHECK(_rate) \ + case DESC_RATE ## _rate: \ + if (DIS_DPD_RATE ## _rate & chip->dpd_ratemask) \ + dpd_diff = -6 * chip->txgi_factor; \ + break + + switch (rate) { + RTW_DPD_RATE_CHECK(6M); + RTW_DPD_RATE_CHECK(9M); + RTW_DPD_RATE_CHECK(MCS0); + RTW_DPD_RATE_CHECK(MCS1); + RTW_DPD_RATE_CHECK(MCS8); + RTW_DPD_RATE_CHECK(MCS9); + RTW_DPD_RATE_CHECK(VHT1SS_MCS0); + RTW_DPD_RATE_CHECK(VHT1SS_MCS1); + RTW_DPD_RATE_CHECK(VHT2SS_MCS0); + RTW_DPD_RATE_CHECK(VHT2SS_MCS1); + } +#undef RTW_DPD_RATE_CHECK + + return dpd_diff; +} + +static u8 rtw_phy_get_2g_tx_power_index(struct rtw_dev *rtwdev, + struct rtw_2g_txpwr_idx *pwr_idx_2g, + enum rtw_bandwidth bandwidth, + u8 rate, u8 group) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + u8 tx_power; + bool mcs_rate; + bool above_2ss; + u8 factor = chip->txgi_factor; + + if (rate <= DESC_RATE11M) + tx_power = pwr_idx_2g->cck_base[group]; + else + tx_power = pwr_idx_2g->bw40_base[group]; + + if (rate >= DESC_RATE6M && rate <= DESC_RATE54M) + tx_power += pwr_idx_2g->ht_1s_diff.ofdm * factor; + + mcs_rate = (rate >= DESC_RATEMCS0 && rate <= DESC_RATEMCS15) || + (rate >= DESC_RATEVHT1SS_MCS0 && + rate <= DESC_RATEVHT2SS_MCS9); + above_2ss = (rate >= DESC_RATEMCS8 && rate <= DESC_RATEMCS15) || + (rate >= DESC_RATEVHT2SS_MCS0); + + if (!mcs_rate) + return tx_power; + + switch (bandwidth) { + default: + WARN_ON(1); + fallthrough; + case RTW_CHANNEL_WIDTH_20: + tx_power += pwr_idx_2g->ht_1s_diff.bw20 * factor; + if (above_2ss) + tx_power += pwr_idx_2g->ht_2s_diff.bw20 * factor; + break; + case RTW_CHANNEL_WIDTH_40: + /* bw40 is the base power */ + if (above_2ss) + tx_power += pwr_idx_2g->ht_2s_diff.bw40 * factor; + break; + } + + return tx_power; +} + +static u8 rtw_phy_get_5g_tx_power_index(struct rtw_dev *rtwdev, + struct rtw_5g_txpwr_idx *pwr_idx_5g, + enum rtw_bandwidth bandwidth, + u8 rate, u8 group) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + u8 tx_power; + u8 upper, lower; + bool mcs_rate; + bool above_2ss; + u8 factor = chip->txgi_factor; + + tx_power = pwr_idx_5g->bw40_base[group]; + + mcs_rate = (rate >= DESC_RATEMCS0 && rate <= DESC_RATEMCS15) || + (rate >= DESC_RATEVHT1SS_MCS0 && + rate <= DESC_RATEVHT2SS_MCS9); + above_2ss = (rate >= DESC_RATEMCS8 && rate <= DESC_RATEMCS15) || + (rate >= DESC_RATEVHT2SS_MCS0); + + if (!mcs_rate) { + tx_power += pwr_idx_5g->ht_1s_diff.ofdm * factor; + return tx_power; + } + + switch (bandwidth) { + default: + WARN_ON(1); + fallthrough; + case RTW_CHANNEL_WIDTH_20: + tx_power += pwr_idx_5g->ht_1s_diff.bw20 * factor; + if (above_2ss) + tx_power += pwr_idx_5g->ht_2s_diff.bw20 * factor; + break; + case RTW_CHANNEL_WIDTH_40: + /* bw40 is the base power */ + if (above_2ss) + tx_power += pwr_idx_5g->ht_2s_diff.bw40 * factor; + break; + case RTW_CHANNEL_WIDTH_80: + /* the base idx of bw80 is the average of bw40+/bw40- */ + lower = pwr_idx_5g->bw40_base[group]; + upper = pwr_idx_5g->bw40_base[group + 1]; + + tx_power = (lower + upper) / 2; + tx_power += pwr_idx_5g->vht_1s_diff.bw80 * factor; + if (above_2ss) + tx_power += pwr_idx_5g->vht_2s_diff.bw80 * factor; + break; + } + + return tx_power; +} + +/* return RTW_RATE_SECTION_MAX to indicate rate is invalid */ +static u8 rtw_phy_rate_to_rate_section(u8 rate) +{ + if (rate >= DESC_RATE1M && rate <= DESC_RATE11M) + return RTW_RATE_SECTION_CCK; + else if (rate >= DESC_RATE6M && rate <= DESC_RATE54M) + return RTW_RATE_SECTION_OFDM; + else if (rate >= DESC_RATEMCS0 && rate <= DESC_RATEMCS7) + return RTW_RATE_SECTION_HT_1S; + else if (rate >= DESC_RATEMCS8 && rate <= DESC_RATEMCS15) + return RTW_RATE_SECTION_HT_2S; + else if (rate >= DESC_RATEVHT1SS_MCS0 && rate <= DESC_RATEVHT1SS_MCS9) + return RTW_RATE_SECTION_VHT_1S; + else if (rate >= DESC_RATEVHT2SS_MCS0 && rate <= DESC_RATEVHT2SS_MCS9) + return RTW_RATE_SECTION_VHT_2S; + else + return RTW_RATE_SECTION_MAX; +} + +static s8 rtw_phy_get_tx_power_limit(struct rtw_dev *rtwdev, u8 band, + enum rtw_bandwidth bw, u8 rf_path, + u8 rate, u8 channel, u8 regd) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 *cch_by_bw = hal->cch_by_bw; + s8 power_limit = (s8)rtwdev->chip->max_power_index; + u8 rs = rtw_phy_rate_to_rate_section(rate); + int ch_idx; + u8 cur_bw, cur_ch; + s8 cur_lmt; + + if (regd > RTW_REGD_WW) + return power_limit; + + if (rs == RTW_RATE_SECTION_MAX) + goto err; + + /* only 20M BW with cck and ofdm */ + if (rs == RTW_RATE_SECTION_CCK || rs == RTW_RATE_SECTION_OFDM) + bw = RTW_CHANNEL_WIDTH_20; + + /* only 20/40M BW with ht */ + if (rs == RTW_RATE_SECTION_HT_1S || rs == RTW_RATE_SECTION_HT_2S) + bw = min_t(u8, bw, RTW_CHANNEL_WIDTH_40); + + /* select min power limit among [20M BW ~ current BW] */ + for (cur_bw = RTW_CHANNEL_WIDTH_20; cur_bw <= bw; cur_bw++) { + cur_ch = cch_by_bw[cur_bw]; + + ch_idx = rtw_channel_to_idx(band, cur_ch); + if (ch_idx < 0) + goto err; + + cur_lmt = cur_ch <= RTW_MAX_CHANNEL_NUM_2G ? + hal->tx_pwr_limit_2g[regd][cur_bw][rs][ch_idx] : + hal->tx_pwr_limit_5g[regd][cur_bw][rs][ch_idx]; + + power_limit = min_t(s8, cur_lmt, power_limit); + } + + return power_limit; + +err: + WARN(1, "invalid arguments, band=%d, bw=%d, path=%d, rate=%d, ch=%d\n", + band, bw, rf_path, rate, channel); + return (s8)rtwdev->chip->max_power_index; +} + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) +static s8 rtw_phy_get_tx_power_sar(struct rtw_dev *rtwdev, u8 sar_band, + u8 rf_path, u8 rate) +{ + u8 rs = rtw_phy_rate_to_rate_section(rate); + struct rtw_sar_arg arg = { + .sar_band = sar_band, + .path = rf_path, + .rs = rs, + }; + + if (rs == RTW_RATE_SECTION_MAX) + goto err; + + return rtw_query_sar(rtwdev, &arg); + +err: + WARN(1, "invalid arguments, sar_band=%d, path=%d, rate=%d\n", + sar_band, rf_path, rate); + return (s8)rtwdev->chip->max_power_index; +} +#endif + +void rtw_get_tx_power_params(struct rtw_dev *rtwdev, u8 path, u8 rate, u8 bw, + u8 ch, u8 regd, struct rtw_power_params *pwr_param) +{ + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_txpwr_idx *pwr_idx; + u8 group, band; + u8 *base = &pwr_param->pwr_base; + s8 *offset = &pwr_param->pwr_offset; + s8 *limit = &pwr_param->pwr_limit; + s8 *remnant = &pwr_param->pwr_remnant; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) + s8 *sar = &pwr_param->pwr_sar; +#endif + + pwr_idx = &rtwdev->efuse.txpwr_idx_table[path]; + group = rtw_get_channel_group(ch, rate); + + /* base power index for 2.4G/5G */ + if (IS_CH_2G_BAND(ch)) { + band = PHY_BAND_2G; + *base = rtw_phy_get_2g_tx_power_index(rtwdev, + &pwr_idx->pwr_idx_2g, + bw, rate, group); + *offset = hal->tx_pwr_by_rate_offset_2g[path][rate]; + } else { + band = PHY_BAND_5G; + *base = rtw_phy_get_5g_tx_power_index(rtwdev, + &pwr_idx->pwr_idx_5g, + bw, rate, group); + *offset = hal->tx_pwr_by_rate_offset_5g[path][rate]; + } + + *limit = rtw_phy_get_tx_power_limit(rtwdev, band, bw, path, + rate, ch, regd); + *remnant = (rate <= DESC_RATE11M ? dm_info->txagc_remnant_cck : + dm_info->txagc_remnant_ofdm); +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) + *sar = rtw_phy_get_tx_power_sar(rtwdev, hal->sar_band, path, rate); +#endif +} + +u8 +rtw_phy_get_tx_power_index(struct rtw_dev *rtwdev, u8 rf_path, u8 rate, + enum rtw_bandwidth bandwidth, u8 channel, u8 regd) +{ + struct rtw_power_params pwr_param = {0}; + u8 tx_power; + s8 offset; + + rtw_get_tx_power_params(rtwdev, rf_path, rate, bandwidth, + channel, regd, &pwr_param); + + tx_power = pwr_param.pwr_base; + offset = min3(pwr_param.pwr_offset, + pwr_param.pwr_limit, + pwr_param.pwr_sar); + + if (rtwdev->chip->en_dis_dpd) + offset += rtw_phy_get_dis_dpd_by_rate_diff(rtwdev, rate); + + tx_power += offset + pwr_param.pwr_remnant; + + if (tx_power > rtwdev->chip->max_power_index) + tx_power = rtwdev->chip->max_power_index; + + return tx_power; +} +EXPORT_SYMBOL(rtw_phy_get_tx_power_index); + +static void rtw_phy_set_tx_power_index_by_rs(struct rtw_dev *rtwdev, + u8 ch, u8 path, u8 rs) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 regd = rtw_regd_get(rtwdev); + u8 *rates; + u8 size; + u8 rate; + u8 pwr_idx; + u8 bw; + int i; + + if (rs >= RTW_RATE_SECTION_MAX) + return; + + rates = rtw_rate_section[rs]; + size = rtw_rate_size[rs]; + bw = hal->current_band_width; + for (i = 0; i < size; i++) { + rate = rates[i]; + pwr_idx = rtw_phy_get_tx_power_index(rtwdev, path, rate, + bw, ch, regd); + hal->tx_pwr_tbl[path][rate] = pwr_idx; + } +} + +/* set tx power level by path for each rates, note that the order of the rates + * are *very* important, bacause 8822B/8821C combines every four bytes of tx + * power index into a four-byte power index register, and calls set_tx_agc to + * write these values into hardware + */ +static void rtw_phy_set_tx_power_level_by_path(struct rtw_dev *rtwdev, + u8 ch, u8 path) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 rs; + + /* do not need cck rates if we are not in 2.4G */ + if (hal->current_band_type == RTW_BAND_2G) + rs = RTW_RATE_SECTION_CCK; + else + rs = RTW_RATE_SECTION_OFDM; + + for (; rs < RTW_RATE_SECTION_MAX; rs++) + rtw_phy_set_tx_power_index_by_rs(rtwdev, ch, path, rs); +} + +void rtw_phy_set_tx_power_level(struct rtw_dev *rtwdev, u8 channel) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_hal *hal = &rtwdev->hal; + u8 path; + + mutex_lock(&hal->tx_power_mutex); + + for (path = 0; path < hal->rf_path_num; path++) + rtw_phy_set_tx_power_level_by_path(rtwdev, channel, path); + + chip->ops->set_tx_power_index(rtwdev); + mutex_unlock(&hal->tx_power_mutex); +} +EXPORT_SYMBOL(rtw_phy_set_tx_power_level); + +static void +rtw_phy_tx_power_by_rate_config_by_path(struct rtw_hal *hal, u8 path, + u8 rs, u8 size, u8 *rates) +{ + u8 rate; + u8 base_idx, rate_idx; + s8 base_2g, base_5g; + + if (rs >= RTW_RATE_SECTION_VHT_1S) + base_idx = rates[size - 3]; + else + base_idx = rates[size - 1]; + base_2g = hal->tx_pwr_by_rate_offset_2g[path][base_idx]; + base_5g = hal->tx_pwr_by_rate_offset_5g[path][base_idx]; + hal->tx_pwr_by_rate_base_2g[path][rs] = base_2g; + hal->tx_pwr_by_rate_base_5g[path][rs] = base_5g; + for (rate = 0; rate < size; rate++) { + rate_idx = rates[rate]; + hal->tx_pwr_by_rate_offset_2g[path][rate_idx] -= base_2g; + hal->tx_pwr_by_rate_offset_5g[path][rate_idx] -= base_5g; + } +} + +void rtw_phy_tx_power_by_rate_config(struct rtw_hal *hal) +{ + u8 path; + + for (path = 0; path < RTW_RF_PATH_MAX; path++) { + rtw_phy_tx_power_by_rate_config_by_path(hal, path, + RTW_RATE_SECTION_CCK, + rtw_cck_size, rtw_cck_rates); + rtw_phy_tx_power_by_rate_config_by_path(hal, path, + RTW_RATE_SECTION_OFDM, + rtw_ofdm_size, rtw_ofdm_rates); + rtw_phy_tx_power_by_rate_config_by_path(hal, path, + RTW_RATE_SECTION_HT_1S, + rtw_ht_1s_size, rtw_ht_1s_rates); + rtw_phy_tx_power_by_rate_config_by_path(hal, path, + RTW_RATE_SECTION_HT_2S, + rtw_ht_2s_size, rtw_ht_2s_rates); + rtw_phy_tx_power_by_rate_config_by_path(hal, path, + RTW_RATE_SECTION_VHT_1S, + rtw_vht_1s_size, rtw_vht_1s_rates); + rtw_phy_tx_power_by_rate_config_by_path(hal, path, + RTW_RATE_SECTION_VHT_2S, + rtw_vht_2s_size, rtw_vht_2s_rates); + } +} + +static void +__rtw_phy_tx_power_limit_config(struct rtw_hal *hal, u8 regd, u8 bw, u8 rs) +{ + s8 base; + u8 ch; + + for (ch = 0; ch < RTW_MAX_CHANNEL_NUM_2G; ch++) { + base = hal->tx_pwr_by_rate_base_2g[0][rs]; + hal->tx_pwr_limit_2g[regd][bw][rs][ch] -= base; + } + + for (ch = 0; ch < RTW_MAX_CHANNEL_NUM_5G; ch++) { + base = hal->tx_pwr_by_rate_base_5g[0][rs]; + hal->tx_pwr_limit_5g[regd][bw][rs][ch] -= base; + } +} + +void rtw_phy_tx_power_limit_config(struct rtw_hal *hal) +{ + u8 regd, bw, rs; + + /* default at channel 1 */ + hal->cch_by_bw[RTW_CHANNEL_WIDTH_20] = 1; + + for (regd = 0; regd < RTW_REGD_MAX; regd++) + for (bw = 0; bw < RTW_CHANNEL_WIDTH_MAX; bw++) + for (rs = 0; rs < RTW_RATE_SECTION_MAX; rs++) + __rtw_phy_tx_power_limit_config(hal, regd, bw, rs); +} + +static void rtw_phy_init_tx_power_limit(struct rtw_dev *rtwdev, + u8 regd, u8 bw, u8 rs) +{ + struct rtw_hal *hal = &rtwdev->hal; + s8 max_power_index = (s8)rtwdev->chip->max_power_index; + u8 ch; + + /* 2.4G channels */ + for (ch = 0; ch < RTW_MAX_CHANNEL_NUM_2G; ch++) + hal->tx_pwr_limit_2g[regd][bw][rs][ch] = max_power_index; + + /* 5G channels */ + for (ch = 0; ch < RTW_MAX_CHANNEL_NUM_5G; ch++) + hal->tx_pwr_limit_5g[regd][bw][rs][ch] = max_power_index; +} + +void rtw_phy_init_tx_power(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 regd, path, rate, rs, bw; + + /* init tx power by rate offset */ + for (path = 0; path < RTW_RF_PATH_MAX; path++) { + for (rate = 0; rate < DESC_RATE_MAX; rate++) { + hal->tx_pwr_by_rate_offset_2g[path][rate] = 0; + hal->tx_pwr_by_rate_offset_5g[path][rate] = 0; + } + } + + /* init tx power limit */ + for (regd = 0; regd < RTW_REGD_MAX; regd++) + for (bw = 0; bw < RTW_CHANNEL_WIDTH_MAX; bw++) + for (rs = 0; rs < RTW_RATE_SECTION_MAX; rs++) + rtw_phy_init_tx_power_limit(rtwdev, regd, bw, + rs); +} + +void rtw_phy_config_swing_table(struct rtw_dev *rtwdev, + struct rtw_swing_table *swing_table) +{ + const struct rtw_pwr_track_tbl *tbl = rtwdev->chip->pwr_track_tbl; + u8 channel = rtwdev->hal.current_channel; + + if (IS_CH_2G_BAND(channel)) { + if (rtwdev->dm_info.tx_rate <= DESC_RATE11M) { + swing_table->p[RF_PATH_A] = tbl->pwrtrk_2g_ccka_p; + swing_table->n[RF_PATH_A] = tbl->pwrtrk_2g_ccka_n; + swing_table->p[RF_PATH_B] = tbl->pwrtrk_2g_cckb_p; + swing_table->n[RF_PATH_B] = tbl->pwrtrk_2g_cckb_n; + } else { + swing_table->p[RF_PATH_A] = tbl->pwrtrk_2ga_p; + swing_table->n[RF_PATH_A] = tbl->pwrtrk_2ga_n; + swing_table->p[RF_PATH_B] = tbl->pwrtrk_2gb_p; + swing_table->n[RF_PATH_B] = tbl->pwrtrk_2gb_n; + } + } else if (IS_CH_5G_BAND_1(channel) || IS_CH_5G_BAND_2(channel)) { + swing_table->p[RF_PATH_A] = tbl->pwrtrk_5ga_p[RTW_PWR_TRK_5G_1]; + swing_table->n[RF_PATH_A] = tbl->pwrtrk_5ga_n[RTW_PWR_TRK_5G_1]; + swing_table->p[RF_PATH_B] = tbl->pwrtrk_5gb_p[RTW_PWR_TRK_5G_1]; + swing_table->n[RF_PATH_B] = tbl->pwrtrk_5gb_n[RTW_PWR_TRK_5G_1]; + } else if (IS_CH_5G_BAND_3(channel)) { + swing_table->p[RF_PATH_A] = tbl->pwrtrk_5ga_p[RTW_PWR_TRK_5G_2]; + swing_table->n[RF_PATH_A] = tbl->pwrtrk_5ga_n[RTW_PWR_TRK_5G_2]; + swing_table->p[RF_PATH_B] = tbl->pwrtrk_5gb_p[RTW_PWR_TRK_5G_2]; + swing_table->n[RF_PATH_B] = tbl->pwrtrk_5gb_n[RTW_PWR_TRK_5G_2]; + } else if (IS_CH_5G_BAND_4(channel)) { + swing_table->p[RF_PATH_A] = tbl->pwrtrk_5ga_p[RTW_PWR_TRK_5G_3]; + swing_table->n[RF_PATH_A] = tbl->pwrtrk_5ga_n[RTW_PWR_TRK_5G_3]; + swing_table->p[RF_PATH_B] = tbl->pwrtrk_5gb_p[RTW_PWR_TRK_5G_3]; + swing_table->n[RF_PATH_B] = tbl->pwrtrk_5gb_n[RTW_PWR_TRK_5G_3]; + } else { + swing_table->p[RF_PATH_A] = tbl->pwrtrk_2ga_p; + swing_table->n[RF_PATH_A] = tbl->pwrtrk_2ga_n; + swing_table->p[RF_PATH_B] = tbl->pwrtrk_2gb_p; + swing_table->n[RF_PATH_B] = tbl->pwrtrk_2gb_n; + } +} +EXPORT_SYMBOL(rtw_phy_config_swing_table); + +void rtw_phy_pwrtrack_avg(struct rtw_dev *rtwdev, u8 thermal, u8 path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + ewma_thermal_add(&dm_info->avg_thermal[path], thermal); + dm_info->thermal_avg[path] = + ewma_thermal_read(&dm_info->avg_thermal[path]); +} +EXPORT_SYMBOL(rtw_phy_pwrtrack_avg); + +bool rtw_phy_pwrtrack_thermal_changed(struct rtw_dev *rtwdev, u8 thermal, + u8 path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 avg = ewma_thermal_read(&dm_info->avg_thermal[path]); + + if (avg == thermal) + return false; + + return true; +} +EXPORT_SYMBOL(rtw_phy_pwrtrack_thermal_changed); + +u8 rtw_phy_pwrtrack_get_delta(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 therm_avg, therm_efuse, therm_delta; + + therm_avg = dm_info->thermal_avg[path]; + therm_efuse = rtwdev->efuse.thermal_meter[path]; + therm_delta = abs(therm_avg - therm_efuse); + + return min_t(u8, therm_delta, RTW_PWR_TRK_TBL_SZ - 1); +} +EXPORT_SYMBOL(rtw_phy_pwrtrack_get_delta); + +s8 rtw_phy_pwrtrack_get_pwridx(struct rtw_dev *rtwdev, + struct rtw_swing_table *swing_table, + u8 tbl_path, u8 therm_path, u8 delta) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + const u8 *delta_swing_table_idx_pos; + const u8 *delta_swing_table_idx_neg; + + if (delta >= RTW_PWR_TRK_TBL_SZ) { + rtw_warn(rtwdev, "power track table overflow\n"); + return 0; + } + + if (!swing_table) { + rtw_warn(rtwdev, "swing table not configured\n"); + return 0; + } + + delta_swing_table_idx_pos = swing_table->p[tbl_path]; + delta_swing_table_idx_neg = swing_table->n[tbl_path]; + + if (!delta_swing_table_idx_pos || !delta_swing_table_idx_neg) { + rtw_warn(rtwdev, "invalid swing table index\n"); + return 0; + } + + if (dm_info->thermal_avg[therm_path] > + rtwdev->efuse.thermal_meter[therm_path]) + return delta_swing_table_idx_pos[delta]; + else + return -delta_swing_table_idx_neg[delta]; +} +EXPORT_SYMBOL(rtw_phy_pwrtrack_get_pwridx); + +bool rtw_phy_pwrtrack_need_lck(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 delta_lck; + + delta_lck = abs(dm_info->thermal_avg[0] - dm_info->thermal_meter_lck); + if (delta_lck >= rtwdev->chip->lck_threshold) { + dm_info->thermal_meter_lck = dm_info->thermal_avg[0]; + return true; + } + return false; +} +EXPORT_SYMBOL(rtw_phy_pwrtrack_need_lck); + +bool rtw_phy_pwrtrack_need_iqk(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 delta_iqk; + + delta_iqk = abs(dm_info->thermal_avg[0] - dm_info->thermal_meter_k); + if (delta_iqk >= rtwdev->chip->iqk_threshold) { + dm_info->thermal_meter_k = dm_info->thermal_avg[0]; + return true; + } + return false; +} +EXPORT_SYMBOL(rtw_phy_pwrtrack_need_iqk); + +static void rtw_phy_set_tx_path_by_reg(struct rtw_dev *rtwdev, + enum rtw_bb_path tx_path_sel_1ss) +{ + struct rtw_path_div *path_div = &rtwdev->dm_path_div; + enum rtw_bb_path tx_path_sel_cck = tx_path_sel_1ss; + const struct rtw_chip_info *chip = rtwdev->chip; + + if (tx_path_sel_1ss == path_div->current_tx_path) + return; + + path_div->current_tx_path = tx_path_sel_1ss; + rtw_dbg(rtwdev, RTW_DBG_PATH_DIV, "Switch TX path=%s\n", + tx_path_sel_1ss == BB_PATH_A ? "A" : "B"); + chip->ops->config_tx_path(rtwdev, rtwdev->hal.antenna_tx, + tx_path_sel_1ss, tx_path_sel_cck, false); +} + +static void rtw_phy_tx_path_div_select(struct rtw_dev *rtwdev) +{ + struct rtw_path_div *path_div = &rtwdev->dm_path_div; + enum rtw_bb_path path = path_div->current_tx_path; + s32 rssi_a = 0, rssi_b = 0; + + if (path_div->path_a_cnt) + rssi_a = path_div->path_a_sum / path_div->path_a_cnt; + else + rssi_a = 0; + if (path_div->path_b_cnt) + rssi_b = path_div->path_b_sum / path_div->path_b_cnt; + else + rssi_b = 0; + + if (rssi_a != rssi_b) + path = (rssi_a > rssi_b) ? BB_PATH_A : BB_PATH_B; + + path_div->path_a_cnt = 0; + path_div->path_a_sum = 0; + path_div->path_b_cnt = 0; + path_div->path_b_sum = 0; + rtw_phy_set_tx_path_by_reg(rtwdev, path); +} + +static void rtw_phy_tx_path_diversity_2ss(struct rtw_dev *rtwdev) +{ + if (rtwdev->hal.antenna_rx != BB_PATH_AB) { + rtw_dbg(rtwdev, RTW_DBG_PATH_DIV, + "[Return] tx_Path_en=%d, rx_Path_en=%d\n", + rtwdev->hal.antenna_tx, rtwdev->hal.antenna_rx); + return; + } + if (rtwdev->sta_cnt == 0) { + rtw_dbg(rtwdev, RTW_DBG_PATH_DIV, "No Link\n"); + return; + } + + rtw_phy_tx_path_div_select(rtwdev); +} + +void rtw_phy_tx_path_diversity(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + if (!chip->path_div_supported) + return; + + rtw_phy_tx_path_diversity_2ss(rtwdev); +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/phy.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/phy.h new file mode 100644 index 0000000000000000000000000000000000000000..ccfcbd3ced03aae0131d16c14d79c0f2d604087a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/phy.h @@ -0,0 +1,198 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_PHY_H_ +#define __RTW_PHY_H_ + +#include "debug.h" + +extern u8 rtw_cck_rates[]; +extern u8 rtw_ofdm_rates[]; +extern u8 rtw_ht_1s_rates[]; +extern u8 rtw_ht_2s_rates[]; +extern u8 rtw_vht_1s_rates[]; +extern u8 rtw_vht_2s_rates[]; +extern u8 *rtw_rate_section[]; +extern u8 rtw_rate_size[]; + +void rtw_phy_init(struct rtw_dev *rtwdev); +void rtw_phy_dynamic_mechanism(struct rtw_dev *rtwdev); +u8 rtw_phy_rf_power_2_rssi(s8 *rf_power, u8 path_num); +u32 rtw_phy_read_rf(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask); +u32 rtw_phy_read_rf_sipi(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask); +bool rtw_phy_write_rf_reg_sipi(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask, u32 data); +bool rtw_phy_write_rf_reg(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask, u32 data); +bool rtw_phy_write_rf_reg_mix(struct rtw_dev *rtwdev, enum rtw_rf_path rf_path, + u32 addr, u32 mask, u32 data); +void rtw_phy_setup_phy_cond(struct rtw_dev *rtwdev, u32 pkg); +void rtw_parse_tbl_phy_cond(struct rtw_dev *rtwdev, const struct rtw_table *tbl); +void rtw_parse_tbl_bb_pg(struct rtw_dev *rtwdev, const struct rtw_table *tbl); +void rtw_parse_tbl_txpwr_lmt(struct rtw_dev *rtwdev, const struct rtw_table *tbl); +void rtw_phy_cfg_mac(struct rtw_dev *rtwdev, const struct rtw_table *tbl, + u32 addr, u32 data); +void rtw_phy_cfg_agc(struct rtw_dev *rtwdev, const struct rtw_table *tbl, + u32 addr, u32 data); +void rtw_phy_cfg_bb(struct rtw_dev *rtwdev, const struct rtw_table *tbl, + u32 addr, u32 data); +void rtw_phy_cfg_rf(struct rtw_dev *rtwdev, const struct rtw_table *tbl, + u32 addr, u32 data); +void rtw_phy_init_tx_power(struct rtw_dev *rtwdev); +void rtw_phy_load_tables(struct rtw_dev *rtwdev); +u8 rtw_phy_get_tx_power_index(struct rtw_dev *rtwdev, u8 rf_path, u8 rate, + enum rtw_bandwidth bw, u8 channel, u8 regd); +void rtw_phy_set_tx_power_level(struct rtw_dev *rtwdev, u8 channel); +void rtw_phy_tx_power_by_rate_config(struct rtw_hal *hal); +void rtw_phy_tx_power_limit_config(struct rtw_hal *hal); +void rtw_phy_pwrtrack_avg(struct rtw_dev *rtwdev, u8 thermal, u8 path); +bool rtw_phy_pwrtrack_thermal_changed(struct rtw_dev *rtwdev, u8 thermal, + u8 path); +u8 rtw_phy_pwrtrack_get_delta(struct rtw_dev *rtwdev, u8 path); +s8 rtw_phy_pwrtrack_get_pwridx(struct rtw_dev *rtwdev, + struct rtw_swing_table *swing_table, + u8 tbl_path, u8 therm_path, u8 delta); +bool rtw_phy_pwrtrack_need_lck(struct rtw_dev *rtwdev); +bool rtw_phy_pwrtrack_need_iqk(struct rtw_dev *rtwdev); +void rtw_phy_config_swing_table(struct rtw_dev *rtwdev, + struct rtw_swing_table *swing_table); +void rtw_phy_set_edcca_th(struct rtw_dev *rtwdev, u8 l2h, u8 h2l); +void rtw_phy_adaptivity_set_mode(struct rtw_dev *rtwdev); +void rtw_phy_parsing_cfo(struct rtw_dev *rtwdev, + struct rtw_rx_pkt_stat *pkt_stat); +void rtw_phy_tx_path_diversity(struct rtw_dev *rtwdev); + +struct rtw_txpwr_lmt_cfg_pair { + u8 regd; + u8 band; + u8 bw; + u8 rs; + u8 ch; + s8 txpwr_lmt; +}; + +struct rtw_phy_pg_cfg_pair { + u32 band; + u32 rf_path; + u32 tx_num; + u32 addr; + u32 bitmask; + u32 data; +}; + +#define RTW_DECL_TABLE_PHY_COND_CORE(name, cfg, path) \ +const struct rtw_table name ## _tbl = { \ + .data = name, \ + .size = ARRAY_SIZE(name), \ + .parse = rtw_parse_tbl_phy_cond, \ + .do_cfg = cfg, \ + .rf_path = path, \ +} + +#define RTW_DECL_TABLE_PHY_COND(name, cfg) \ + RTW_DECL_TABLE_PHY_COND_CORE(name, cfg, 0) + +#define RTW_DECL_TABLE_RF_RADIO(name, path) \ + RTW_DECL_TABLE_PHY_COND_CORE(name, rtw_phy_cfg_rf, RF_PATH_ ## path) + +#define RTW_DECL_TABLE_BB_PG(name) \ +const struct rtw_table name ## _tbl = { \ + .data = name, \ + .size = ARRAY_SIZE(name), \ + .parse = rtw_parse_tbl_bb_pg, \ +} + +#define RTW_DECL_TABLE_TXPWR_LMT(name) \ +const struct rtw_table name ## _tbl = { \ + .data = name, \ + .size = ARRAY_SIZE(name), \ + .parse = rtw_parse_tbl_txpwr_lmt, \ +} + +static inline const struct rtw_rfe_def *rtw_get_rfe_def(struct rtw_dev *rtwdev) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_efuse *efuse = &rtwdev->efuse; + const struct rtw_rfe_def *rfe_def = NULL; + + if (chip->rfe_defs_size == 0) + return NULL; + + if (efuse->rfe_option < chip->rfe_defs_size) + rfe_def = &chip->rfe_defs[efuse->rfe_option]; + + rtw_dbg(rtwdev, RTW_DBG_PHY, "use rfe_def[%d]\n", efuse->rfe_option); + return rfe_def; +} + +static inline int rtw_check_supported_rfe(struct rtw_dev *rtwdev) +{ + const struct rtw_rfe_def *rfe_def = rtw_get_rfe_def(rtwdev); + + if (!rfe_def || !rfe_def->phy_pg_tbl || !rfe_def->txpwr_lmt_tbl) { + rtw_err(rtwdev, "rfe %d isn't supported\n", + rtwdev->efuse.rfe_option); + return -ENODEV; + } + + return 0; +} + +void rtw_phy_dig_write(struct rtw_dev *rtwdev, u8 igi); + +struct rtw_power_params { + u8 pwr_base; + s8 pwr_offset; + s8 pwr_limit; + s8 pwr_remnant; + s8 pwr_sar; +}; + +void +rtw_get_tx_power_params(struct rtw_dev *rtwdev, u8 path, + u8 rate, u8 bw, u8 ch, u8 regd, + struct rtw_power_params *pwr_param); + +enum rtw_phy_cck_pd_lv { + CCK_PD_LV0, + CCK_PD_LV1, + CCK_PD_LV2, + CCK_PD_LV3, + CCK_PD_LV4, + CCK_PD_LV_MAX, +}; + +#define MASKBYTE0 0xff +#define MASKBYTE1 0xff00 +#define MASKBYTE2 0xff0000 +#define MASKBYTE3 0xff000000 +#define MASKHWORD 0xffff0000 +#define MASKLWORD 0x0000ffff +#define MASKDWORD 0xffffffff +#define RFREG_MASK 0xfffff + +#define MASK7BITS 0x7f +#define MASK12BITS 0xfff +#define MASKH4BITS 0xf0000000 +#define MASK20BITS 0xfffff +#define MASK24BITS 0xffffff + +#define MASKH3BYTES 0xffffff00 +#define MASKL3BYTES 0x00ffffff +#define MASKBYTE2HIGHNIBBLE 0x00f00000 +#define MASKBYTE3LOWNIBBLE 0x0f000000 +#define MASKL3BYTES 0x00ffffff + +#define CCK_FA_AVG_RESET 0xffffffff + +#define LSSI_READ_ADDR_MASK 0x7f800000 +#define LSSI_READ_EDGE_MASK 0x80000000 +#define LSSI_READ_DATA_MASK 0xfffff + +#define RRSR_RATE_ORDER_MAX 0xfffff +#define RRSR_RATE_ORDER_CCK_LEN 4 + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/ps.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/ps.c new file mode 100644 index 0000000000000000000000000000000000000000..15454dd27fff8faf9e0ba56e46151a633e854300 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/ps.c @@ -0,0 +1,343 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "reg.h" +#include "fw.h" +#include "ps.h" +#include "mac.h" +#include "coex.h" +#include "debug.h" + +static int rtw_ips_pwr_up(struct rtw_dev *rtwdev) +{ + int ret; + + ret = rtw_core_start(rtwdev); + if (ret) + rtw_err(rtwdev, "leave idle state failed\n"); + + rtw_coex_ips_notify(rtwdev, COEX_IPS_LEAVE); + rtw_set_channel(rtwdev); + + return ret; +} + +int rtw_enter_ips(struct rtw_dev *rtwdev) +{ + if (!test_bit(RTW_FLAG_POWERON, rtwdev->flags)) + return 0; + + rtw_coex_ips_notify(rtwdev, COEX_IPS_ENTER); + + rtw_core_stop(rtwdev); + rtw_hci_link_ps(rtwdev, true); + + return 0; +} + +static void rtw_restore_port_cfg_iter(void *data, struct ieee80211_vif *vif) +{ + struct rtw_dev *rtwdev = data; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + u32 config = ~0; + + rtw_vif_port_config(rtwdev, rtwvif, config); +} + +int rtw_leave_ips(struct rtw_dev *rtwdev) +{ + int ret; + + if (test_bit(RTW_FLAG_POWERON, rtwdev->flags)) + return 0; + + rtw_hci_link_ps(rtwdev, false); + + ret = rtw_ips_pwr_up(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to leave ips state\n"); + return ret; + } + + rtw_iterate_vifs(rtwdev, rtw_restore_port_cfg_iter, rtwdev); + + return 0; +} + +void rtw_power_mode_change(struct rtw_dev *rtwdev, bool enter) +{ + u8 request, confirm, polling; + int ret; + + request = rtw_read8(rtwdev, rtwdev->hci.rpwm_addr); + confirm = rtw_read8(rtwdev, rtwdev->hci.cpwm_addr); + + /* toggle to request power mode, others remain 0 */ + request ^= request | BIT_RPWM_TOGGLE; + if (enter) { + request |= POWER_MODE_LCLK; + if (rtw_get_lps_deep_mode(rtwdev) == LPS_DEEP_MODE_PG) + request |= POWER_MODE_PG; + } + /* Each request require an ack from firmware */ + request |= POWER_MODE_ACK; + + if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) + request |= POWER_TX_WAKE; + + rtw_write8(rtwdev, rtwdev->hci.rpwm_addr, request); + + /* Check firmware get the power requset and ack via cpwm register */ + ret = read_poll_timeout_atomic(rtw_read8, polling, + (polling ^ confirm) & BIT_RPWM_TOGGLE, + 100, 15000, true, rtwdev, + rtwdev->hci.cpwm_addr); + if (ret) { + /* Hit here means that driver failed to get an ack from firmware. + * The reason could be that hardware is locked at Deep sleep, + * so most of the hardware circuits are not working, even + * register read/write; or firmware is locked in some state and + * cannot get the request. It should be treated as fatal error + * and requires an entire analysis about the firmware/hardware. + */ + WARN(1, "firmware failed to ack driver for %s Deep Power mode\n", + enter ? "entering" : "leaving"); + } +} +EXPORT_SYMBOL(rtw_power_mode_change); + +static void __rtw_leave_lps_deep(struct rtw_dev *rtwdev) +{ + rtw_hci_deep_ps(rtwdev, false); +} + +static int __rtw_fw_leave_lps_check_reg(struct rtw_dev *rtwdev) +{ + int i; + + /* Driver needs to wait for firmware to leave LPS state + * successfully. Firmware will send null packet to inform AP, + * and see if AP sends an ACK back, then firmware will restore + * the REG_TCR register. + * + * If driver does not wait for firmware, null packet with + * PS bit could be sent due to incorrect REG_TCR setting. + * + * In our test, 100ms should be enough for firmware to finish + * the flow. If REG_TCR Register is still incorrect after 100ms, + * just modify it directly, and throw a warn message. + */ + for (i = 0 ; i < LEAVE_LPS_TRY_CNT; i++) { + if (rtw_read32_mask(rtwdev, REG_TCR, BIT_PWRMGT_HWDATA_EN) == 0) + return 0; + msleep(20); + } + + return -EBUSY; +} + +static int __rtw_fw_leave_lps_check_c2h(struct rtw_dev *rtwdev) +{ + if (wait_for_completion_timeout(&rtwdev->lps_leave_check, + LEAVE_LPS_TIMEOUT)) + return 0; + return -EBUSY; +} + +static void rtw_fw_leave_lps_check(struct rtw_dev *rtwdev) +{ + bool ret = false; + struct rtw_fw_state *fw; + + if (test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) + fw = &rtwdev->wow_fw; + else + fw = &rtwdev->fw; + + if (rtw_fw_feature_check(fw, FW_FEATURE_LPS_C2H)) + ret = __rtw_fw_leave_lps_check_c2h(rtwdev); + else + ret = __rtw_fw_leave_lps_check_reg(rtwdev); + + if (ret) { + rtw_write32_clr(rtwdev, REG_TCR, BIT_PWRMGT_HWDATA_EN); + rtw_warn(rtwdev, "firmware failed to leave lps state\n"); + } +} + +static void rtw_fw_leave_lps_check_prepare(struct rtw_dev *rtwdev) +{ + struct rtw_fw_state *fw; + + if (test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) + fw = &rtwdev->wow_fw; + else + fw = &rtwdev->fw; + + if (rtw_fw_feature_check(fw, FW_FEATURE_LPS_C2H)) + reinit_completion(&rtwdev->lps_leave_check); +} + +static void rtw_leave_lps_core(struct rtw_dev *rtwdev) +{ + struct rtw_lps_conf *conf = &rtwdev->lps_conf; + + conf->state = RTW_ALL_ON; + conf->awake_interval = 1; + conf->rlbm = 0; + conf->smart_ps = 0; + + rtw_hci_link_ps(rtwdev, false); + rtw_fw_leave_lps_check_prepare(rtwdev); + rtw_fw_set_pwr_mode(rtwdev); + rtw_fw_leave_lps_check(rtwdev); + + clear_bit(RTW_FLAG_LEISURE_PS, rtwdev->flags); + + rtw_coex_lps_notify(rtwdev, COEX_LPS_DISABLE); +} + +enum rtw_lps_deep_mode rtw_get_lps_deep_mode(struct rtw_dev *rtwdev) +{ + if (test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) + return rtwdev->lps_conf.wow_deep_mode; + else + return rtwdev->lps_conf.deep_mode; +} + +static void __rtw_enter_lps_deep(struct rtw_dev *rtwdev) +{ + if (rtw_get_lps_deep_mode(rtwdev) == LPS_DEEP_MODE_NONE) + return; + + if (!test_bit(RTW_FLAG_LEISURE_PS, rtwdev->flags)) { + rtw_dbg(rtwdev, RTW_DBG_PS, + "Should enter LPS before entering deep PS\n"); + return; + } + + if (rtw_get_lps_deep_mode(rtwdev) == LPS_DEEP_MODE_PG) + rtw_fw_set_pg_info(rtwdev); + + rtw_hci_deep_ps(rtwdev, true); +} + +static void rtw_enter_lps_core(struct rtw_dev *rtwdev) +{ + struct rtw_lps_conf *conf = &rtwdev->lps_conf; + + conf->state = RTW_RF_OFF; + conf->awake_interval = 1; + conf->rlbm = 1; + conf->smart_ps = 2; + + rtw_coex_lps_notify(rtwdev, COEX_LPS_ENABLE); + + rtw_fw_set_pwr_mode(rtwdev); + rtw_hci_link_ps(rtwdev, true); + + set_bit(RTW_FLAG_LEISURE_PS, rtwdev->flags); +} + +static void __rtw_enter_lps(struct rtw_dev *rtwdev, u8 port_id) +{ + struct rtw_lps_conf *conf = &rtwdev->lps_conf; + + if (test_bit(RTW_FLAG_LEISURE_PS, rtwdev->flags)) + return; + + conf->mode = RTW_MODE_LPS; + conf->port_id = port_id; + + rtw_enter_lps_core(rtwdev); +} + +static void __rtw_leave_lps(struct rtw_dev *rtwdev) +{ + struct rtw_lps_conf *conf = &rtwdev->lps_conf; + + if (test_and_clear_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) { + rtw_dbg(rtwdev, RTW_DBG_PS, + "Should leave deep PS before leaving LPS\n"); + __rtw_leave_lps_deep(rtwdev); + } + + if (!test_bit(RTW_FLAG_LEISURE_PS, rtwdev->flags)) + return; + + conf->mode = RTW_MODE_ACTIVE; + + rtw_leave_lps_core(rtwdev); +} + +void rtw_enter_lps(struct rtw_dev *rtwdev, u8 port_id) +{ + lockdep_assert_held(&rtwdev->mutex); + + if (rtwdev->coex.stat.wl_force_lps_ctrl) + return; + + __rtw_enter_lps(rtwdev, port_id); + __rtw_enter_lps_deep(rtwdev); +} + +void rtw_leave_lps(struct rtw_dev *rtwdev) +{ + lockdep_assert_held(&rtwdev->mutex); + + __rtw_leave_lps_deep(rtwdev); + __rtw_leave_lps(rtwdev); +} + +void rtw_leave_lps_deep(struct rtw_dev *rtwdev) +{ + lockdep_assert_held(&rtwdev->mutex); + + __rtw_leave_lps_deep(rtwdev); +} + +struct rtw_vif_recalc_lps_iter_data { + struct rtw_dev *rtwdev; + struct ieee80211_vif *found_vif; + int count; +}; + +static void __rtw_vif_recalc_lps(struct rtw_vif_recalc_lps_iter_data *data, + struct ieee80211_vif *vif) +{ + if (data->count < 0) + return; + + if (vif->type != NL80211_IFTYPE_STATION) { + data->count = -1; + return; + } + + data->count++; + data->found_vif = vif; +} + +static void rtw_vif_recalc_lps_iter(void *data, struct ieee80211_vif *vif) +{ + __rtw_vif_recalc_lps(data, vif); +} + +void rtw_recalc_lps(struct rtw_dev *rtwdev, struct ieee80211_vif *new_vif) +{ + struct rtw_vif_recalc_lps_iter_data data = { .rtwdev = rtwdev }; + + if (new_vif) + __rtw_vif_recalc_lps(&data, new_vif); + rtw_iterate_vifs(rtwdev, rtw_vif_recalc_lps_iter, &data); + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(6, 0, 0)) + if (data.count == 1 && data.found_vif->cfg.ps) { + rtwdev->ps_enabled = true; + } else { + rtwdev->ps_enabled = false; + rtw_leave_lps(rtwdev); + } +#endif +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/ps.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/ps.h new file mode 100644 index 0000000000000000000000000000000000000000..5ae83d2526cfd2730daaeed07f1d0ca56527a068 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/ps.h @@ -0,0 +1,28 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_PS_H_ +#define __RTW_PS_H_ + +#define RTW_LPS_THRESHOLD 50 + +#define POWER_MODE_ACK BIT(6) +#define POWER_MODE_PG BIT(4) +#define POWER_TX_WAKE BIT(1) +#define POWER_MODE_LCLK BIT(0) + +#define LEAVE_LPS_TRY_CNT 5 +#define LEAVE_LPS_TIMEOUT msecs_to_jiffies(100) + +int rtw_enter_ips(struct rtw_dev *rtwdev); +int rtw_leave_ips(struct rtw_dev *rtwdev); + +void rtw_power_mode_change(struct rtw_dev *rtwdev, bool enter); +void rtw_enter_lps(struct rtw_dev *rtwdev, u8 port_id); +void rtw_leave_lps(struct rtw_dev *rtwdev); +void rtw_leave_lps_deep(struct rtw_dev *rtwdev); +enum rtw_lps_deep_mode rtw_get_lps_deep_mode(struct rtw_dev *rtwdev); +void rtw_recalc_lps(struct rtw_dev *rtwdev, struct ieee80211_vif *new_vif); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/reg.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/reg.h new file mode 100644 index 0000000000000000000000000000000000000000..7c6c11d50ff30f966b895bb5594e18cf08d03888 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/reg.h @@ -0,0 +1,705 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_REG_DEF_H__ +#define __RTW_REG_DEF_H__ + +#define REG_SYS_FUNC_EN 0x0002 +#define BIT_FEN_EN_25_1 BIT(13) +#define BIT_FEN_ELDR BIT(12) +#define BIT_FEN_CPUEN BIT(2) +#define BIT_FEN_BB_GLB_RST BIT(1) +#define BIT_FEN_BB_RSTB BIT(0) +#define BIT_R_DIS_PRST BIT(6) +#define BIT_WLOCK_1C_B6 BIT(5) +#define REG_SYS_PW_CTRL 0x0004 +#define BIT_PFM_WOWL BIT(3) +#define REG_SYS_CLK_CTRL 0x0008 +#define BIT_CPU_CLK_EN BIT(14) + +#define REG_SYS_CLKR 0x0008 +#define BIT_ANA8M BIT(1) +#define BIT_WAKEPAD_EN BIT(3) +#define BIT_LOADER_CLK_EN BIT(5) + +#define REG_RSV_CTRL 0x001C +#define DISABLE_PI 0x3 +#define ENABLE_PI 0x2 +#define BITS_RFC_DIRECT (BIT(31) | BIT(30)) +#define BIT_WLMCU_IOIF BIT(0) +#define REG_RF_CTRL 0x001F +#define BIT_RF_SDM_RSTB BIT(2) +#define BIT_RF_RSTB BIT(1) +#define BIT_RF_EN BIT(0) + +#define REG_AFE_CTRL1 0x0024 +#define BIT_MAC_CLK_SEL (BIT(20) | BIT(21)) +#define REG_EFUSE_CTRL 0x0030 +#define BIT_EF_FLAG BIT(31) +#define BIT_SHIFT_EF_ADDR 8 +#define BIT_MASK_EF_ADDR 0x3ff +#define BIT_MASK_EF_DATA 0xff +#define BITS_EF_ADDR (BIT_MASK_EF_ADDR << BIT_SHIFT_EF_ADDR) +#define BITS_PLL 0xf0 + +#define REG_AFE_XTAL_CTRL 0x24 +#define REG_AFE_PLL_CTRL 0x28 +#define REG_AFE_CTRL3 0x2c +#define BIT_MASK_XTAL 0x00FFF000 +#define BIT_XTAL_GMP_BIT4 BIT(28) + +#define REG_LDO_EFUSE_CTRL 0x0034 +#define BIT_MASK_EFUSE_BANK_SEL (BIT(8) | BIT(9)) + +#define BIT_LDO25_VOLTAGE_V25 0x03 +#define BIT_MASK_LDO25_VOLTAGE GENMASK(6, 4) +#define BIT_SHIFT_LDO25_VOLTAGE 4 +#define BIT_LDO25_EN BIT(7) + +#define REG_GPIO_MUXCFG 0x0040 +#define BIT_FSPI_EN BIT(19) +#define BIT_EN_SIC BIT(12) + +#define BIT_PO_BT_PTA_PINS BIT(9) +#define BIT_BT_PTA_EN BIT(5) +#define BIT_WLRFE_4_5_EN BIT(2) + +#define REG_LED_CFG 0x004C +#define BIT_LNAON_SEL_EN BIT(26) +#define BIT_PAPE_SEL_EN BIT(25) +#define BIT_DPDT_WL_SEL BIT(24) +#define BIT_DPDT_SEL_EN BIT(23) +#define REG_LEDCFG2 0x004E +#define REG_PAD_CTRL1 0x0064 +#define BIT_BT_BTG_SEL BIT(31) +#define BIT_PAPE_WLBT_SEL BIT(29) +#define BIT_LNAON_WLBT_SEL BIT(28) +#define BIT_BTGP_JTAG_EN BIT(24) +#define BIT_BTGP_SPI_EN BIT(20) +#define BIT_LED1DIS BIT(15) +#define BIT_SW_DPDT_SEL_DATA BIT(0) +#define REG_WL_BT_PWR_CTRL 0x0068 +#define BIT_BT_FUNC_EN BIT(18) +#define BIT_BT_DIG_CLK_EN BIT(8) +#define REG_SYS_SDIO_CTRL 0x0070 +#define BIT_DBG_GNT_WL_BT BIT(27) +#define BIT_LTE_MUX_CTRL_PATH BIT(26) +#define REG_HCI_OPT_CTRL 0x0074 +#define BIT_USB_SUS_DIS BIT(8) +#define BIT_SDIO_PAD_E5 BIT(18) + +#define REG_AFE_CTRL_4 0x0078 +#define BIT_CK320M_AFE_EN BIT(4) +#define BIT_EN_SYN BIT(15) + +#define REG_LDO_SWR_CTRL 0x007C +#define LDO_SEL 0xC3 +#define SPS_SEL 0x83 +#define BIT_XTA1 BIT(29) +#define BIT_XTA0 BIT(28) + +#define REG_MCUFW_CTRL 0x0080 +#define BIT_ANA_PORT_EN BIT(22) +#define BIT_MAC_PORT_EN BIT(21) +#define BIT_BOOT_FSPI_EN BIT(20) +#define BIT_ROM_DLEN BIT(19) +#define BIT_ROM_PGE GENMASK(18, 16) /* legacy only */ +#define BIT_SHIFT_ROM_PGE 16 +#define BIT_FW_INIT_RDY BIT(15) +#define BIT_FW_DW_RDY BIT(14) +#define BIT_RPWM_TOGGLE BIT(7) +#define BIT_RAM_DL_SEL BIT(7) /* legacy only */ +#define BIT_DMEM_CHKSUM_OK BIT(6) +#define BIT_WINTINI_RDY BIT(6) /* legacy only */ +#define BIT_DMEM_DW_OK BIT(5) +#define BIT_IMEM_CHKSUM_OK BIT(4) +#define BIT_IMEM_DW_OK BIT(3) +#define BIT_IMEM_BOOT_LOAD_CHECKSUM_OK BIT(2) +#define BIT_FWDL_CHK_RPT BIT(2) /* legacy only */ +#define BIT_MCUFWDL_RDY BIT(1) /* legacy only */ +#define BIT_MCUFWDL_EN BIT(0) +#define BIT_CHECK_SUM_OK (BIT(4) | BIT(6)) +#define FW_READY (BIT_FW_INIT_RDY | BIT_FW_DW_RDY | \ + BIT_IMEM_DW_OK | BIT_DMEM_DW_OK | \ + BIT_CHECK_SUM_OK) +#define FW_READY_LEGACY (BIT_MCUFWDL_RDY | BIT_FWDL_CHK_RPT | \ + BIT_WINTINI_RDY | BIT_RAM_DL_SEL) +#define FW_READY_MASK 0xffff + +#define REG_MCU_TST_CFG 0x84 +#define VAL_FW_TRIGGER 0x1 + +#define REG_PMC_DBG_CTRL1 0xa8 +#define BITS_PMC_BT_IQK_STS GENMASK(22, 21) + +#define REG_EFUSE_ACCESS 0x00CF +#define EFUSE_ACCESS_ON 0x69 +#define EFUSE_ACCESS_OFF 0x00 + +#define REG_WLRF1 0x00EC +#define REG_WIFI_BT_INFO 0x00AA +#define BIT_BT_INT_EN BIT(15) +#define REG_SYS_CFG1 0x00F0 +#define BIT_RTL_ID BIT(23) +#define BIT_LDO BIT(24) +#define BIT_RF_TYPE_ID BIT(27) +#define BIT_SHIFT_VENDOR_ID 16 +#define BIT_MASK_VENDOR_ID 0xf +#define BIT_VENDOR_ID(x) (((x) & BIT_MASK_VENDOR_ID) << BIT_SHIFT_VENDOR_ID) +#define BITS_VENDOR_ID (BIT_MASK_VENDOR_ID << BIT_SHIFT_VENDOR_ID) +#define BIT_CLEAR_VENDOR_ID(x) ((x) & (~BITS_VENDOR_ID)) +#define BIT_GET_VENDOR_ID(x) (((x) >> BIT_SHIFT_VENDOR_ID) & BIT_MASK_VENDOR_ID) +#define BIT_SHIFT_CHIP_VER 12 +#define BIT_MASK_CHIP_VER 0xf +#define BIT_CHIP_VER(x) (((x) & BIT_MASK_CHIP_VER) << BIT_SHIFT_CHIP_VER) +#define BITS_CHIP_VER (BIT_MASK_CHIP_VER << BIT_SHIFT_CHIP_VER) +#define BIT_CLEAR_CHIP_VER(x) ((x) & (~BITS_CHIP_VER)) +#define BIT_GET_CHIP_VER(x) (((x) >> BIT_SHIFT_CHIP_VER) & BIT_MASK_CHIP_VER) +#define REG_SYS_STATUS1 0x00F4 +#define REG_SYS_STATUS2 0x00F8 +#define REG_SYS_CFG2 0x00FC +#define REG_WLRF1 0x00EC +#define BIT_WLRF1_BBRF_EN (BIT(24) | BIT(25) | BIT(26)) +#define REG_CR 0x0100 +#define BIT_32K_CAL_TMR_EN BIT(10) +#define BIT_MAC_SEC_EN BIT(9) +#define BIT_ENSWBCN BIT(8) +#define BIT_MACRXEN BIT(7) +#define BIT_MACTXEN BIT(6) +#define BIT_SCHEDULE_EN BIT(5) +#define BIT_PROTOCOL_EN BIT(4) +#define BIT_RXDMA_EN BIT(3) +#define BIT_TXDMA_EN BIT(2) +#define BIT_HCI_RXDMA_EN BIT(1) +#define BIT_HCI_TXDMA_EN BIT(0) +#define MAC_TRX_ENABLE (BIT_HCI_TXDMA_EN | BIT_HCI_RXDMA_EN | BIT_TXDMA_EN | \ + BIT_RXDMA_EN | BIT_PROTOCOL_EN | BIT_SCHEDULE_EN | \ + BIT_MACTXEN | BIT_MACRXEN) +#define BIT_SHIFT_TXDMA_VOQ_MAP 4 +#define BIT_MASK_TXDMA_VOQ_MAP 0x3 +#define BIT_TXDMA_VOQ_MAP(x) \ + (((x) & BIT_MASK_TXDMA_VOQ_MAP) << BIT_SHIFT_TXDMA_VOQ_MAP) +#define BIT_SHIFT_TXDMA_VIQ_MAP 6 +#define BIT_MASK_TXDMA_VIQ_MAP 0x3 +#define BIT_TXDMA_VIQ_MAP(x) \ + (((x) & BIT_MASK_TXDMA_VIQ_MAP) << BIT_SHIFT_TXDMA_VIQ_MAP) +#define REG_TXDMA_PQ_MAP 0x010C +#define BIT_RXDMA_ARBBW_EN BIT(0) +#define BIT_RXSHFT_EN BIT(1) +#define BIT_RXDMA_AGG_EN BIT(2) +#define BIT_TXDMA_BW_EN BIT(3) +#define BIT_SHIFT_TXDMA_BEQ_MAP 8 +#define BIT_MASK_TXDMA_BEQ_MAP 0x3 +#define BIT_TXDMA_BEQ_MAP(x) \ + (((x) & BIT_MASK_TXDMA_BEQ_MAP) << BIT_SHIFT_TXDMA_BEQ_MAP) +#define BIT_SHIFT_TXDMA_BKQ_MAP 10 +#define BIT_MASK_TXDMA_BKQ_MAP 0x3 +#define BIT_TXDMA_BKQ_MAP(x) \ + (((x) & BIT_MASK_TXDMA_BKQ_MAP) << BIT_SHIFT_TXDMA_BKQ_MAP) +#define BIT_SHIFT_TXDMA_MGQ_MAP 12 +#define BIT_MASK_TXDMA_MGQ_MAP 0x3 +#define BIT_TXDMA_MGQ_MAP(x) \ + (((x) & BIT_MASK_TXDMA_MGQ_MAP) << BIT_SHIFT_TXDMA_MGQ_MAP) +#define BIT_SHIFT_TXDMA_HIQ_MAP 14 +#define BIT_MASK_TXDMA_HIQ_MAP 0x3 +#define BIT_TXDMA_HIQ_MAP(x) \ + (((x) & BIT_MASK_TXDMA_HIQ_MAP) << BIT_SHIFT_TXDMA_HIQ_MAP) +#define BIT_SHIFT_TXSC_40M 4 +#define BIT_MASK_TXSC_40M 0xf +#define BIT_TXSC_40M(x) \ + (((x) & BIT_MASK_TXSC_40M) << BIT_SHIFT_TXSC_40M) +#define BIT_SHIFT_TXSC_20M 0 +#define BIT_MASK_TXSC_20M 0xf +#define BIT_TXSC_20M(x) \ + (((x) & BIT_MASK_TXSC_20M) << BIT_SHIFT_TXSC_20M) +#define BIT_SHIFT_MAC_CLK_SEL 20 +#define MAC_CLK_HW_DEF_80M 0 +#define MAC_CLK_HW_DEF_40M 1 +#define MAC_CLK_HW_DEF_20M 2 +#define MAC_CLK_SPEED 80 + +#define REG_CR 0x0100 +#define REG_TRXFF_BNDY 0x0114 +#define REG_RXFF_BNDY 0x011C +#define REG_FE1IMR 0x0120 +#define BIT_FS_RXDONE BIT(16) +#define REG_PKTBUF_DBG_CTRL 0x0140 +#define REG_C2HEVT 0x01A0 +#define REG_MCUTST_1 0x01C0 +#define REG_MCUTST_II 0x01C4 +#define REG_WOWLAN_WAKE_REASON 0x01C7 +#define REG_HMETFR 0x01CC +#define REG_HMEBOX0 0x01D0 +#define REG_HMEBOX1 0x01D4 +#define REG_HMEBOX2 0x01D8 +#define REG_HMEBOX3 0x01DC +#define REG_HMEBOX0_EX 0x01F0 +#define REG_HMEBOX1_EX 0x01F4 +#define REG_HMEBOX2_EX 0x01F8 +#define REG_HMEBOX3_EX 0x01FC + +#define REG_RQPN 0x0200 +#define BIT_MASK_HPQ 0xff +#define BIT_SHIFT_HPQ 0 +#define BIT_RQPN_HPQ(x) (((x) & BIT_MASK_HPQ) << BIT_SHIFT_HPQ) +#define BIT_MASK_LPQ 0xff +#define BIT_SHIFT_LPQ 8 +#define BIT_RQPN_LPQ(x) (((x) & BIT_MASK_LPQ) << BIT_SHIFT_LPQ) +#define BIT_MASK_PUBQ 0xff +#define BIT_SHIFT_PUBQ 16 +#define BIT_RQPN_PUBQ(x) (((x) & BIT_MASK_PUBQ) << BIT_SHIFT_PUBQ) +#define BIT_RQPN_HLP(h, l, p) (BIT_LD_RQPN | BIT_RQPN_HPQ(h) | \ + BIT_RQPN_LPQ(l) | BIT_RQPN_PUBQ(p)) + +#define REG_FIFOPAGE_CTRL_2 0x0204 +#define BIT_BCN_VALID_V1 BIT(15) +#define BIT_MASK_BCN_HEAD_1_V1 0xfff +#define REG_AUTO_LLT_V1 0x0208 +#define BIT_AUTO_INIT_LLT_V1 BIT(0) +#define REG_DWBCN0_CTRL 0x0208 +#define BIT_BCN_VALID BIT(16) +#define REG_TXDMA_OFFSET_CHK 0x020C +#define BIT_DROP_DATA_EN BIT(9) +#define REG_TXDMA_STATUS 0x0210 +#define BTI_PAGE_OVF BIT(2) + +#define REG_RQPN_NPQ 0x0214 +#define BIT_MASK_NPQ 0xff +#define BIT_SHIFT_NPQ 0 +#define BIT_MASK_EPQ 0xff +#define BIT_SHIFT_EPQ 16 +#define BIT_RQPN_NPQ(x) (((x) & BIT_MASK_NPQ) << BIT_SHIFT_NPQ) +#define BIT_RQPN_EPQ(x) (((x) & BIT_MASK_EPQ) << BIT_SHIFT_EPQ) +#define BIT_RQPN_NE(n, e) (BIT_RQPN_NPQ(n) | BIT_RQPN_EPQ(e)) + +#define REG_AUTO_LLT 0x0224 +#define BIT_AUTO_INIT_LLT BIT(16) +#define REG_RQPN_CTRL_1 0x0228 +#define REG_RQPN_CTRL_2 0x022C +#define BIT_LD_RQPN BIT(31) +#define REG_FIFOPAGE_INFO_1 0x0230 +#define REG_FIFOPAGE_INFO_2 0x0234 +#define REG_FIFOPAGE_INFO_3 0x0238 +#define REG_FIFOPAGE_INFO_4 0x023C +#define REG_FIFOPAGE_INFO_5 0x0240 +#define REG_H2C_HEAD 0x0244 +#define REG_H2C_TAIL 0x0248 +#define REG_H2C_READ_ADDR 0x024C +#define REG_H2C_INFO 0x0254 +#define REG_RXDMA_AGG_PG_TH 0x0280 +#define BIT_RXDMA_AGG_PG_TH GENMASK(7, 0) +#define BIT_DMA_AGG_TO_V1 GENMASK(15, 8) +#define BIT_EN_PRE_CALC BIT(29) +#define REG_RXPKT_NUM 0x0284 +#define BIT_RXDMA_REQ BIT(19) +#define BIT_RW_RELEASE BIT(18) +#define BIT_RXDMA_IDLE BIT(17) +#define REG_RXDMA_STATUS 0x0288 +#define REG_RXDMA_DPR 0x028C +#define REG_RXDMA_MODE 0x0290 +#define BIT_DMA_MODE BIT(1) +#define REG_RXPKTNUM 0x02B0 + +#define REG_INT_MIG 0x0304 +#define REG_HCI_MIX_CFG 0x03FC +#define BIT_PCIE_EMAC_PDN_AUX_TO_FAST_CLK BIT(26) + +#define REG_BCNQ_INFO 0x0418 +#define BIT_MGQ_CPU_EMPTY BIT(24) +#define REG_FWHW_TXQ_CTRL 0x0420 +#define BIT_EN_BCNQ_DL BIT(22) +#define BIT_EN_WR_FREE_TAIL BIT(20) +#define REG_HWSEQ_CTRL 0x0423 + +#define REG_BCNQ_BDNY_V1 0x0424 +#define REG_BCNQ_BDNY 0x0424 +#define REG_MGQ_BDNY 0x0425 +#define REG_LIFETIME_EN 0x0426 +#define BIT_BA_PARSER_EN BIT(5) +#define REG_SPEC_SIFS 0x0428 +#define REG_RETRY_LIMIT 0x042a +#define REG_DARFRC 0x0430 +#define REG_DARFRCH 0x0434 +#define REG_RARFRCH 0x043C +#define REG_RRSR 0x0440 +#define BITS_RRSR_RSC GENMASK(22, 21) +#define REG_ARFR0 0x0444 +#define REG_ARFRH0 0x0448 +#define REG_ARFR1_V1 0x044C +#define REG_ARFRH1_V1 0x0450 +#define REG_CCK_CHECK 0x0454 +#define BIT_CHECK_CCK_EN BIT(7) +#define REG_AMPDU_MAX_TIME_V1 0x0455 +#define REG_BCNQ1_BDNY_V1 0x0456 +#define REG_AMPDU_MAX_TIME 0x0456 +#define REG_WMAC_LBK_BF_HD 0x045D +#define REG_TX_HANG_CTRL 0x045E +#define BIT_EN_GNT_BT_AWAKE BIT(3) +#define BIT_EN_EOF_V1 BIT(2) +#define REG_DATA_SC 0x0483 +#define REG_ARFR4 0x049C +#define BIT_WL_RFK BIT(0) +#define REG_ARFRH4 0x04A0 +#define REG_ARFR5 0x04A4 +#define REG_ARFRH5 0x04A8 +#define REG_SW_AMPDU_BURST_MODE_CTRL 0x04BC +#define BIT_PRE_TX_CMD BIT(6) +#define REG_QUEUE_CTRL 0x04C6 +#define BIT_PTA_WL_TX_EN BIT(4) +#define BIT_PTA_EDCCA_EN BIT(5) +#define REG_SINGLE_AMPDU_CTRL 0x04C7 +#define BIT_EN_SINGLE_APMDU BIT(7) +#define REG_PROT_MODE_CTRL 0x04C8 +#define REG_MAX_AGGR_NUM 0x04CA +#define REG_BAR_MODE_CTRL 0x04CC +#define REG_PRECNT_CTRL 0x04E5 +#define BIT_BTCCA_CTRL (BIT(0) | BIT(1)) +#define BIT_EN_PRECNT BIT(11) +#define REG_DUMMY_PAGE4_V1 0x04FC + +#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 BIT_MASK_TXOP_LMT GENMASK(26, 16) +#define BIT_MASK_CWMAX GENMASK(15, 12) +#define BIT_MASK_CWMIN GENMASK(11, 8) +#define BIT_MASK_AIFS GENMASK(7, 0) +#define REG_PIFS 0x0512 +#define REG_SIFS 0x0514 +#define BIT_SHIFT_SIFS_OFDM_CTX 8 +#define BIT_SHIFT_SIFS_CCK_TRX 16 +#define BIT_SHIFT_SIFS_OFDM_TRX 24 +#define REG_AGGR_BREAK_TIME 0x051A +#define REG_SLOT 0x051B +#define REG_TX_PTCL_CTRL 0x0520 +#define BIT_DIS_EDCCA BIT(15) +#define BIT_SIFS_BK_EN BIT(12) +#define REG_TXPAUSE 0x0522 +#define BIT_AC_QUEUE GENMASK(7, 0) +#define BIT_HIGH_QUEUE BIT(5) +#define REG_RD_CTRL 0x0524 +#define BIT_EDCCA_MSK_CNTDOWN_EN BIT(11) +#define BIT_DIS_TXOP_CFE BIT(10) +#define BIT_DIS_LSIG_CFE BIT(9) +#define BIT_DIS_STBC_CFE BIT(8) +#define REG_TBTT_PROHIBIT 0x0540 +#define BIT_SHIFT_TBTT_HOLD_TIME_AP 8 +#define REG_RD_NAV_NXT 0x0544 +#define REG_NAV_PROT_LEN 0x0546 +#define REG_BCN_CTRL 0x0550 +#define BIT_DIS_TSF_UDT BIT(4) +#define BIT_EN_BCN_FUNCTION BIT(3) +#define BIT_EN_TXBCN_RPT BIT(2) +#define REG_BCN_CTRL_CLINT0 0x0551 +#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_MISC_CTRL 0x0577 +#define BIT_EN_FREE_CNT BIT(3) +#define BIT_DIS_SECOND_CCA (BIT(0) | BIT(1)) +#define REG_HIQ_NO_LMT_EN 0x5A7 +#define REG_DTIM_COUNTER_ROOT 0x5A8 +#define BIT_HIQ_NO_LMT_EN_ROOT BIT(0) +#define REG_TIMER0_SRC_SEL 0x05B4 +#define BIT_TSFT_SEL_TIMER0 (BIT(4) | BIT(5) | BIT(6)) + +#define REG_TCR 0x0604 +#define BIT_PWRMGT_HWDATA_EN BIT(7) +#define BIT_TCR_UPDATE_TIMIE BIT(5) +#define BIT_TCR_UPDATE_HGQMD BIT(4) +#define REG_RCR 0x0608 +#define BIT_APP_FCS BIT(31) +#define BIT_APP_MIC BIT(30) +#define BIT_APP_ICV BIT(29) +#define BIT_APP_PHYSTS BIT(28) +#define BIT_APP_BASSN BIT(27) +#define BIT_VHT_DACK BIT(26) +#define BIT_TCPOFLD_EN BIT(25) +#define BIT_ENMBID BIT(24) +#define BIT_LSIGEN BIT(23) +#define BIT_MFBEN BIT(22) +#define BIT_DISCHKPPDLLEN BIT(21) +#define BIT_PKTCTL_DLEN BIT(20) +#define BIT_DISGCLK BIT(19) +#define BIT_TIM_PARSER_EN BIT(18) +#define BIT_BC_MD_EN BIT(17) +#define BIT_UC_MD_EN BIT(16) +#define BIT_RXSK_PERPKT BIT(15) +#define BIT_HTC_LOC_CTRL BIT(14) +#define BIT_RPFM_CAM_ENABLE BIT(12) +#define BIT_TA_BCN BIT(11) +#define BIT_RCR_ADF BIT(11) +#define BIT_DISDECMYPKT BIT(10) +#define BIT_AICV BIT(9) +#define BIT_ACRC32 BIT(8) +#define BIT_CBSSID_BCN BIT(7) +#define BIT_CBSSID_DATA BIT(6) +#define BIT_APWRMGT BIT(5) +#define BIT_ADD3 BIT(4) +#define BIT_AB BIT(3) +#define BIT_AM BIT(2) +#define BIT_APM BIT(1) +#define BIT_AAP BIT(0) +#define REG_RX_PKT_LIMIT 0x060C +#define REG_RX_DRVINFO_SZ 0x060F +#define BIT_APP_PHYSTS BIT(28) +#define REG_MAR 0x0620 +#define REG_USTIME_EDCA 0x0638 +#define REG_ACKTO_CCK 0x0639 +#define REG_MAC_SPEC_SIFS 0x063A +#define REG_RESP_SIFS_CCK 0x063C +#define REG_RESP_SIFS_OFDM 0x063E +#define REG_ACKTO 0x0640 +#define REG_EIFS 0x0642 +#define REG_NAV_CTRL 0x0650 +#define REG_WMAC_TRXPTCL_CTL 0x0668 +#define BIT_RFMOD (BIT(7) | BIT(8)) +#define BIT_RFMOD_80M BIT(8) +#define BIT_RFMOD_40M BIT(7) +#define REG_WMAC_TRXPTCL_CTL_H 0x066C +#define REG_WKFMCAM_CMD 0x0698 +#define BIT_WKFCAM_POLLING_V1 BIT(31) +#define BIT_WKFCAM_CLR_V1 BIT(30) +#define BIT_WKFCAM_WE BIT(16) +#define BIT_SHIFT_WKFCAM_ADDR_V2 8 +#define BIT_MASK_WKFCAM_ADDR_V2 0xff +#define BIT_WKFCAM_ADDR_V2(x) \ + (((x) & BIT_MASK_WKFCAM_ADDR_V2) << BIT_SHIFT_WKFCAM_ADDR_V2) +#define REG_WKFMCAM_RWD 0x069C +#define BIT_WKFMCAM_VALID BIT(31) +#define BIT_WKFMCAM_BC BIT(26) +#define BIT_WKFMCAM_MC BIT(25) +#define BIT_WKFMCAM_UC BIT(24) + +#define REG_RXFLTMAP0 0x06A0 +#define REG_RXFLTMAP1 0x06A2 +#define REG_RXFLTMAP2 0x06A4 +#define REG_RXFLTMAP4 0x068A +#define REG_BT_COEX_TABLE0 0x06C0 +#define REG_BT_COEX_TABLE1 0x06C4 +#define REG_BT_COEX_BRK_TABLE 0x06C8 +#define REG_BT_COEX_TABLE_H 0x06CC +#define REG_BT_COEX_TABLE_H1 0x06CD +#define REG_BT_COEX_TABLE_H2 0x06CE +#define REG_BT_COEX_TABLE_H3 0x06CF +#define REG_BBPSF_CTRL 0x06DC + +#define REG_BT_COEX_V2 0x0762 +#define BIT_GNT_BT_POLARITY BIT(12) +#define BIT_LTE_COEX_EN BIT(7) +#define REG_BT_COEX_ENH_INTR_CTRL 0x76E +#define BIT_R_GRANTALL_WLMASK BIT(3) +#define BIT_STATIS_BT_EN BIT(2) +#define REG_BT_ACT_STATISTICS 0x0770 +#define REG_BT_ACT_STATISTICS_1 0x0774 +#define REG_BT_STAT_CTRL 0x0778 +#define REG_BT_TDMA_TIME 0x0790 +#define BIT_MASK_SAMPLE_RATE GENMASK(5, 0) +#define REG_LTR_IDLE_LATENCY 0x0798 +#define REG_LTR_ACTIVE_LATENCY 0x079C +#define REG_LTR_CTRL_BASIC 0x07A4 +#define REG_WMAC_OPTION_FUNCTION 0x07D0 +#define REG_WMAC_OPTION_FUNCTION_1 0x07D4 + +#define REG_FPGA0_RFMOD 0x0800 +#define BIT_CCKEN BIT(24) +#define BIT_OFDMEN BIT(25) +#define REG_RX_GAIN_EN 0x081c + +#define REG_RFE_CTRL_E 0x0974 +#define REG_2ND_CCA_CTRL 0x0976 + +#define REG_CCK0_FAREPORT 0xa2c +#define BIT_CCK0_2RX BIT(18) +#define BIT_CCK0_MRC BIT(22) + +#define REG_DIS_DPD 0x0a70 +#define DIS_DPD_MASK GENMASK(9, 0) +#define DIS_DPD_RATE6M BIT(0) +#define DIS_DPD_RATE9M BIT(1) +#define DIS_DPD_RATEMCS0 BIT(2) +#define DIS_DPD_RATEMCS1 BIT(3) +#define DIS_DPD_RATEMCS8 BIT(4) +#define DIS_DPD_RATEMCS9 BIT(5) +#define DIS_DPD_RATEVHT1SS_MCS0 BIT(6) +#define DIS_DPD_RATEVHT1SS_MCS1 BIT(7) +#define DIS_DPD_RATEVHT2SS_MCS0 BIT(8) +#define DIS_DPD_RATEVHT2SS_MCS1 BIT(9) +#define DIS_DPD_RATEALL GENMASK(9, 0) + +#define REG_RFE_CTRL8 0x0cb4 +#define BIT_MASK_RFE_SEL89 GENMASK(7, 0) +#define REG_RFE_INV8 0x0cbd +#define BIT_MASK_RFE_INV89 GENMASK(1, 0) +#define REG_RFE_INV16 0x0cbe +#define BIT_RFE_BUF_EN BIT(3) + +#define REG_ANAPAR_XTAL_0 0x1040 +#define BIT_XCAP_0 GENMASK(23, 10) +#define REG_CPU_DMEM_CON 0x1080 +#define BIT_WL_PLATFORM_RST BIT(16) +#define BIT_WL_SECURITY_CLK BIT(15) +#define BIT_DDMA_EN BIT(8) + +#define REG_H2C_PKT_READADDR 0x10D0 +#define REG_H2C_PKT_WRITEADDR 0x10D4 +#define REG_FW_DBG7 0x10FC +#define FW_KEY_MASK 0xffffff00 + +#define REG_CR_EXT 0x1100 + +#define REG_DDMA_CH0SA 0x1200 +#define REG_DDMA_CH0DA 0x1204 +#define REG_DDMA_CH0CTRL 0x1208 +#define BIT_DDMACH0_OWN BIT(31) +#define BIT_DDMACH0_CHKSUM_EN BIT(29) +#define BIT_DDMACH0_CHKSUM_STS BIT(27) +#define BIT_DDMACH0_DDMA_MODE BIT(26) +#define BIT_DDMACH0_RESET_CHKSUM_STS BIT(25) +#define BIT_DDMACH0_CHKSUM_CONT BIT(24) +#define BIT_MASK_DDMACH0_DLEN 0x3ffff + +#define REG_H2CQ_CSR 0x1330 +#define BIT_H2CQ_FULL BIT(31) +#define REG_FAST_EDCA_VOVI_SETTING 0x1448 +#define REG_FAST_EDCA_BEBK_SETTING 0x144C + +#define REG_RXPSF_CTRL 0x1610 +#define BIT_RXGCK_FIFOTHR_EN BIT(28) + +#define BIT_SHIFT_RXGCK_VHT_FIFOTHR 26 +#define BIT_MASK_RXGCK_VHT_FIFOTHR 0x3 +#define BIT_RXGCK_VHT_FIFOTHR(x) \ + (((x) & BIT_MASK_RXGCK_VHT_FIFOTHR) << BIT_SHIFT_RXGCK_VHT_FIFOTHR) +#define BITS_RXGCK_VHT_FIFOTHR \ + (BIT_MASK_RXGCK_VHT_FIFOTHR << BIT_SHIFT_RXGCK_VHT_FIFOTHR) + +#define BIT_SHIFT_RXGCK_HT_FIFOTHR 24 +#define BIT_MASK_RXGCK_HT_FIFOTHR 0x3 +#define BIT_RXGCK_HT_FIFOTHR(x) \ + (((x) & BIT_MASK_RXGCK_HT_FIFOTHR) << BIT_SHIFT_RXGCK_HT_FIFOTHR) +#define BITS_RXGCK_HT_FIFOTHR \ + (BIT_MASK_RXGCK_HT_FIFOTHR << BIT_SHIFT_RXGCK_HT_FIFOTHR) + +#define BIT_SHIFT_RXGCK_OFDM_FIFOTHR 22 +#define BIT_MASK_RXGCK_OFDM_FIFOTHR 0x3 +#define BIT_RXGCK_OFDM_FIFOTHR(x) \ + (((x) & BIT_MASK_RXGCK_OFDM_FIFOTHR) << BIT_SHIFT_RXGCK_OFDM_FIFOTHR) +#define BITS_RXGCK_OFDM_FIFOTHR \ + (BIT_MASK_RXGCK_OFDM_FIFOTHR << BIT_SHIFT_RXGCK_OFDM_FIFOTHR) + +#define BIT_SHIFT_RXGCK_CCK_FIFOTHR 20 +#define BIT_MASK_RXGCK_CCK_FIFOTHR 0x3 +#define BIT_RXGCK_CCK_FIFOTHR(x) \ + (((x) & BIT_MASK_RXGCK_CCK_FIFOTHR) << BIT_SHIFT_RXGCK_CCK_FIFOTHR) +#define BITS_RXGCK_CCK_FIFOTHR \ + (BIT_MASK_RXGCK_CCK_FIFOTHR << BIT_SHIFT_RXGCK_CCK_FIFOTHR) + +#define BIT_RXGCK_OFDMCCA_EN BIT(16) + +#define BIT_SHIFT_RXPSF_PKTLENTHR 13 +#define BIT_MASK_RXPSF_PKTLENTHR 0x7 +#define BIT_RXPSF_PKTLENTHR(x) \ + (((x) & BIT_MASK_RXPSF_PKTLENTHR) << BIT_SHIFT_RXPSF_PKTLENTHR) +#define BITS_RXPSF_PKTLENTHR \ + (BIT_MASK_RXPSF_PKTLENTHR << BIT_SHIFT_RXPSF_PKTLENTHR) +#define BIT_CLEAR_RXPSF_PKTLENTHR(x) ((x) & (~BITS_RXPSF_PKTLENTHR)) +#define BIT_SET_RXPSF_PKTLENTHR(x, v) \ + (BIT_CLEAR_RXPSF_PKTLENTHR(x) | BIT_RXPSF_PKTLENTHR(v)) + +#define BIT_RXPSF_CTRLEN BIT(12) +#define BIT_RXPSF_VHTCHKEN BIT(11) +#define BIT_RXPSF_HTCHKEN BIT(10) +#define BIT_RXPSF_OFDMCHKEN BIT(9) +#define BIT_RXPSF_CCKCHKEN BIT(8) +#define BIT_RXPSF_OFDMRST BIT(7) +#define BIT_RXPSF_CCKRST BIT(6) +#define BIT_RXPSF_MHCHKEN BIT(5) +#define BIT_RXPSF_CONT_ERRCHKEN BIT(4) +#define BIT_RXPSF_ALL_ERRCHKEN BIT(3) + +#define BIT_SHIFT_RXPSF_ERRTHR 0 +#define BIT_MASK_RXPSF_ERRTHR 0x7 +#define BIT_RXPSF_ERRTHR(x) \ + (((x) & BIT_MASK_RXPSF_ERRTHR) << BIT_SHIFT_RXPSF_ERRTHR) +#define BITS_RXPSF_ERRTHR (BIT_MASK_RXPSF_ERRTHR << BIT_SHIFT_RXPSF_ERRTHR) +#define BIT_CLEAR_RXPSF_ERRTHR(x) ((x) & (~BITS_RXPSF_ERRTHR)) +#define BIT_GET_RXPSF_ERRTHR(x) \ + (((x) >> BIT_SHIFT_RXPSF_ERRTHR) & BIT_MASK_RXPSF_ERRTHR) +#define BIT_SET_RXPSF_ERRTHR(x, v) \ + (BIT_CLEAR_RXPSF_ERRTHR(x) | BIT_RXPSF_ERRTHR(v)) + +#define REG_RXPSF_TYPE_CTRL 0x1614 +#define REG_GENERAL_OPTION 0x1664 +#define BIT_DUMMY_FCS_READY_MASK_EN BIT(9) + +#define REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1 0x1700 +#define REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1 0x1704 +#define REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1 0x1708 +#define LTECOEX_READY BIT(29) +#define LTECOEX_ACCESS_CTRL REG_WL2LTECOEX_INDIRECT_ACCESS_CTRL_V1 +#define LTECOEX_WRITE_DATA REG_WL2LTECOEX_INDIRECT_ACCESS_WRITE_DATA_V1 +#define LTECOEX_READ_DATA REG_WL2LTECOEX_INDIRECT_ACCESS_READ_DATA_V1 + +#define REG_IGN_GNT_BT1 0x1860 + +#define REG_RFESEL_CTRL 0x1990 + +#define REG_NOMASK_TXBT 0x1ca7 +#define REG_ANAPAR 0x1c30 +#define BIT_ANAPAR_BTPS BIT(22) +#define REG_RSTB_SEL 0x1c38 +#define BIT_DAC_OFF_ENABLE BIT(4) +#define BIT_PI_IGNORE_GNT_BT BIT(3) +#define BIT_NOMASK_TXBT_ENABLE BIT(3) + +#define REG_HRCV_MSG 0x1cf + +#define REG_EDCCA_REPORT 0x2d38 +#define BIT_EDCCA_FLAG BIT(24) + +#define REG_IGN_GNTBT4 0x4160 + +#define RF_MODE 0x00 +#define RF_MODOPT 0x01 +#define RF_WLINT 0x01 +#define RF_WLSEL 0x02 +#define RF_DTXLOK 0x08 +#define RF_CFGCH 0x18 +#define BIT_BAND GENMASK(18, 16) +#define RF_RCK 0x1d +#define RF_LUTWA 0x33 +#define RF_LUTWD1 0x3e +#define RF_LUTWD0 0x3f +#define BIT_GAIN_EXT BIT(12) +#define BIT_DATA_L GENMASK(11, 0) +#define RF_T_METER 0x42 +#define RF_BSPAD 0x54 +#define RF_GAINTX 0x56 +#define RF_TXATANK 0x64 +#define RF_TRXIQ 0x66 +#define RF_RXIQGEN 0x8d +#define RF_SYN_PFD 0xb0 +#define RF_XTALX2 0xb8 +#define RF_SYN_CTRL 0xbb +#define RF_MALSEL 0xbe +#define RF_SYN_AAC 0xc9 +#define RF_AAC_CTRL 0xca +#define RF_FAST_LCK 0xcc +#define RF_RCKD 0xde +#define RF_TXADBG 0xde +#define RF_LUTDBG 0xdf +#define BIT_TXA_TANK BIT(4) +#define RF_LUTWE2 0xee +#define RF_LUTWE 0xef + +#define LTE_COEX_CTRL 0x38 +#define LTE_WL_TRX_CTRL 0xa0 +#define LTE_BT_TRX_CTRL 0xa4 + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/regd.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/regd.c new file mode 100644 index 0000000000000000000000000000000000000000..2f547cbcf6da5214f07d1c656ea7d1fae6755548 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/regd.c @@ -0,0 +1,531 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "regd.h" +#include "debug.h" +#include "phy.h" + +#define COUNTRY_REGD_ENT(_alpha2, _regd_2g, _regd_5g) \ + {.alpha2 = (_alpha2), \ + .txpwr_regd_2g = (_regd_2g), \ + .txpwr_regd_5g = (_regd_5g), \ + } + +#define rtw_dbg_regd_dump(_dev, _msg, _args...) \ +do { \ + struct rtw_dev *__d = (_dev); \ + const struct rtw_regd *__r = &__d->regd; \ + rtw_dbg(__d, RTW_DBG_REGD, _msg \ + "apply alpha2 %c%c, regd {%d, %d}, dfs_region %d\n",\ + ##_args, \ + __r->regulatory->alpha2[0], \ + __r->regulatory->alpha2[1], \ + __r->regulatory->txpwr_regd_2g, \ + __r->regulatory->txpwr_regd_5g, \ + __r->dfs_region); \ +} while (0) + +/* If country code is not correctly defined in efuse, + * use worldwide country code and txpwr regd. + */ +static const struct rtw_regulatory rtw_reg_ww = + COUNTRY_REGD_ENT("00", RTW_REGD_WW, RTW_REGD_WW); + +static const struct rtw_regulatory rtw_reg_map[] = { + COUNTRY_REGD_ENT("AD", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("AE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("AF", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("AG", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("AI", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("AL", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("AM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("AN", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("AO", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("AQ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("AR", RTW_REGD_MEXICO, RTW_REGD_MEXICO), + COUNTRY_REGD_ENT("AS", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("AT", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("AU", RTW_REGD_ACMA, RTW_REGD_ACMA), + COUNTRY_REGD_ENT("AW", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("AZ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BA", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BB", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("BD", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BF", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BH", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BI", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BJ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BM", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("BN", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BO", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("BR", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("BS", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("BT", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BV", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BW", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BY", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("BZ", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("CA", RTW_REGD_IC, RTW_REGD_IC), + COUNTRY_REGD_ENT("CC", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CD", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CF", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CH", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CI", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CK", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CL", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("CM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CN", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CO", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("CR", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("CV", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CX", RTW_REGD_ACMA, RTW_REGD_ACMA), + COUNTRY_REGD_ENT("CY", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("CZ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("DE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("DJ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("DK", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("DM", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("DO", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("DZ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("EC", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("EE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("EG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("EH", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("ER", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("ES", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("ET", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("FI", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("FJ", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("FK", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("FM", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("FO", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("FR", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GA", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GB", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GD", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("GE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GF", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GH", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GI", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GL", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GN", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GP", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GQ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GR", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GS", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GT", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("GU", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("GW", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("GY", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("HK", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("HM", RTW_REGD_ACMA, RTW_REGD_ACMA), + COUNTRY_REGD_ENT("HN", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("HR", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("HT", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("HU", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("ID", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("IE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("IL", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("IM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("IN", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("IO", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("IQ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("IR", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("IS", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("IT", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("JE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("JM", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("JO", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("JP", RTW_REGD_MKK, RTW_REGD_MKK), + COUNTRY_REGD_ENT("KE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("KG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("KH", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("KI", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("KM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("KN", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("KR", RTW_REGD_KCC, RTW_REGD_KCC), + COUNTRY_REGD_ENT("KW", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("KY", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("KZ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("LA", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("LB", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("LC", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("LI", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("LK", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("LR", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("LS", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("LT", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("LU", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("LV", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("LY", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MA", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MC", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MD", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("ME", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MF", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("MG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MH", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("MK", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("ML", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MN", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MO", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MP", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("MQ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MR", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MS", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MT", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MU", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MV", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MW", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MX", RTW_REGD_MEXICO, RTW_REGD_MEXICO), + COUNTRY_REGD_ENT("MY", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("MZ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("NA", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("NC", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("NE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("NF", RTW_REGD_ACMA, RTW_REGD_ACMA), + COUNTRY_REGD_ENT("NG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("NI", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("NL", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("NO", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("NP", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("NR", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("NU", RTW_REGD_ACMA, RTW_REGD_ACMA), + COUNTRY_REGD_ENT("NZ", RTW_REGD_ACMA, RTW_REGD_ACMA), + COUNTRY_REGD_ENT("OM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("PA", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("PE", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("PF", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("PG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("PH", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("PK", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("PL", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("PM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("PR", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("PS", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("PT", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("PW", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("PY", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("QA", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("RE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("RO", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("RS", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("RU", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("RW", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SA", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SB", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SC", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("SE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SH", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SI", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SJ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SK", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SL", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SN", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SO", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("SR", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("ST", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("SV", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("SX", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("SZ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TC", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TD", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TF", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TH", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TJ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TK", RTW_REGD_ACMA, RTW_REGD_ACMA), + COUNTRY_REGD_ENT("TM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TN", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TO", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TR", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("TT", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("TV", RTW_REGD_ETSI, RTW_REGD_WW), + COUNTRY_REGD_ENT("TW", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("TZ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("UA", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("UG", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("US", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("UY", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("UZ", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("VA", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("VC", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("VE", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("VG", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("VI", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("VN", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("VU", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("WF", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("WS", RTW_REGD_FCC, RTW_REGD_FCC), + COUNTRY_REGD_ENT("XK", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("YE", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("YT", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("ZA", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("ZM", RTW_REGD_ETSI, RTW_REGD_ETSI), + COUNTRY_REGD_ENT("ZW", RTW_REGD_ETSI, RTW_REGD_ETSI), +}; + +static void rtw_regd_apply_hw_cap_flags(struct wiphy *wiphy) +{ + struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy); + struct ieee80211_supported_band *sband; + struct ieee80211_channel *ch; + struct rtw_dev *rtwdev = hw->priv; + struct rtw_efuse *efuse = &rtwdev->efuse; + int i; + + if (efuse->hw_cap.bw & BIT(RTW_CHANNEL_WIDTH_80)) + return; + + sband = wiphy->bands[NL80211_BAND_2GHZ]; + if (!sband) + goto out_5g; + + for (i = 0; i < sband->n_channels; i++) { + ch = &sband->channels[i]; + ch->flags |= IEEE80211_CHAN_NO_80MHZ; + } + +out_5g: + sband = wiphy->bands[NL80211_BAND_5GHZ]; + if (!sband) + return; + + for (i = 0; i < sband->n_channels; i++) { + ch = &sband->channels[i]; + ch->flags |= IEEE80211_CHAN_NO_80MHZ; + } +} + +static bool rtw_reg_is_ww(const struct rtw_regulatory *reg) +{ + return reg == &rtw_reg_ww; +} + +static bool rtw_reg_match(const struct rtw_regulatory *reg, const char *alpha2) +{ + return memcmp(reg->alpha2, alpha2, 2) == 0; +} + +static const struct rtw_regulatory *rtw_reg_find_by_name(const char *alpha2) +{ + unsigned int i; + + for (i = 0; i < ARRAY_SIZE(rtw_reg_map); i++) { + if (rtw_reg_match(&rtw_reg_map[i], alpha2)) + return &rtw_reg_map[i]; + } + + return &rtw_reg_ww; +} + +static +void rtw_regd_notifier(struct wiphy *wiphy, struct regulatory_request *request); + +/* call this before ieee80211_register_hw() */ +int rtw_regd_init(struct rtw_dev *rtwdev) +{ + struct wiphy *wiphy = rtwdev->hw->wiphy; + const struct rtw_regulatory *chip_reg; + + if (!wiphy) + return -EINVAL; + + wiphy->reg_notifier = rtw_regd_notifier; + + chip_reg = rtw_reg_find_by_name(rtwdev->efuse.country_code); + if (!rtw_reg_is_ww(chip_reg)) { + rtwdev->regd.state = RTW_REGD_STATE_PROGRAMMED; + + /* Set REGULATORY_STRICT_REG before ieee80211_register_hw(), + * stack will wait for regulatory_hint() and consider it + * as the superset for our regulatory rule. + */ + wiphy->regulatory_flags |= REGULATORY_STRICT_REG; + wiphy->regulatory_flags |= REGULATORY_COUNTRY_IE_IGNORE; + } else { + rtwdev->regd.state = RTW_REGD_STATE_WORLDWIDE; + } + + rtwdev->regd.regulatory = &rtw_reg_ww; + rtwdev->regd.dfs_region = NL80211_DFS_UNSET; + rtw_dbg_regd_dump(rtwdev, "regd init state %d: ", rtwdev->regd.state); + + rtw_regd_apply_hw_cap_flags(wiphy); + return 0; +} + +/* call this after ieee80211_register_hw() */ +int rtw_regd_hint(struct rtw_dev *rtwdev) +{ + struct wiphy *wiphy = rtwdev->hw->wiphy; + int ret; + + if (!wiphy) + return -EINVAL; + + if (rtwdev->regd.state == RTW_REGD_STATE_PROGRAMMED) { + rtw_dbg(rtwdev, RTW_DBG_REGD, + "country domain %c%c is PGed on efuse", + rtwdev->efuse.country_code[0], + rtwdev->efuse.country_code[1]); + + ret = regulatory_hint(wiphy, rtwdev->efuse.country_code); + if (ret) { + rtw_warn(rtwdev, + "failed to hint regulatory: %d\n", ret); + return ret; + } + } + + return 0; +} + +static bool rtw_regd_mgmt_worldwide(struct rtw_dev *rtwdev, + struct rtw_regd *next_regd, + struct regulatory_request *request) +{ + struct wiphy *wiphy = rtwdev->hw->wiphy; + + next_regd->state = RTW_REGD_STATE_WORLDWIDE; + + if (request->initiator == NL80211_REGDOM_SET_BY_USER && + !rtw_reg_is_ww(next_regd->regulatory)) { + next_regd->state = RTW_REGD_STATE_SETTING; + wiphy->regulatory_flags |= REGULATORY_COUNTRY_IE_IGNORE; + } + + return true; +} + +static bool rtw_regd_mgmt_programmed(struct rtw_dev *rtwdev, + struct rtw_regd *next_regd, + struct regulatory_request *request) +{ + if (request->initiator == NL80211_REGDOM_SET_BY_DRIVER && + rtw_reg_match(next_regd->regulatory, rtwdev->efuse.country_code)) { + next_regd->state = RTW_REGD_STATE_PROGRAMMED; + return true; + } + + return false; +} + +static bool rtw_regd_mgmt_setting(struct rtw_dev *rtwdev, + struct rtw_regd *next_regd, + struct regulatory_request *request) +{ + struct wiphy *wiphy = rtwdev->hw->wiphy; + + if (request->initiator != NL80211_REGDOM_SET_BY_USER) + return false; + + next_regd->state = RTW_REGD_STATE_SETTING; + + if (rtw_reg_is_ww(next_regd->regulatory)) { + next_regd->state = RTW_REGD_STATE_WORLDWIDE; + wiphy->regulatory_flags &= ~REGULATORY_COUNTRY_IE_IGNORE; + } + + return true; +} + +static bool (*const rtw_regd_handler[RTW_REGD_STATE_NR]) + (struct rtw_dev *, struct rtw_regd *, struct regulatory_request *) = { + [RTW_REGD_STATE_WORLDWIDE] = rtw_regd_mgmt_worldwide, + [RTW_REGD_STATE_PROGRAMMED] = rtw_regd_mgmt_programmed, + [RTW_REGD_STATE_SETTING] = rtw_regd_mgmt_setting, +}; + +static bool rtw_regd_state_hdl(struct rtw_dev *rtwdev, + struct rtw_regd *next_regd, + struct regulatory_request *request) +{ + next_regd->regulatory = rtw_reg_find_by_name(request->alpha2); + next_regd->dfs_region = request->dfs_region; + return rtw_regd_handler[rtwdev->regd.state](rtwdev, next_regd, request); +} + +static +void rtw_regd_notifier(struct wiphy *wiphy, struct regulatory_request *request) +{ + struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy); + struct rtw_dev *rtwdev = hw->priv; + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_regd next_regd = {0}; + bool hdl; + + hdl = rtw_regd_state_hdl(rtwdev, &next_regd, request); + if (!hdl) { + rtw_dbg(rtwdev, RTW_DBG_REGD, + "regd state %d: ignore request %c%c of initiator %d\n", + rtwdev->regd.state, + request->alpha2[0], + request->alpha2[1], + request->initiator); + return; + } + + rtw_dbg(rtwdev, RTW_DBG_REGD, "regd state: %d -> %d\n", + rtwdev->regd.state, next_regd.state); + + mutex_lock(&rtwdev->mutex); + rtwdev->regd = next_regd; + rtw_dbg_regd_dump(rtwdev, "get alpha2 %c%c from initiator %d: ", + request->alpha2[0], + request->alpha2[1], + request->initiator); + + rtw_phy_adaptivity_set_mode(rtwdev); + rtw_phy_set_tx_power_level(rtwdev, hal->current_channel); + mutex_unlock(&rtwdev->mutex); +} + +u8 rtw_regd_get(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 band = hal->current_band_type; + + return band == RTW_BAND_2G ? + rtwdev->regd.regulatory->txpwr_regd_2g : + rtwdev->regd.regulatory->txpwr_regd_5g; +} +EXPORT_SYMBOL(rtw_regd_get); + +struct rtw_regd_alternative_t { + bool set; + u8 alt; +}; + +#define DECL_REGD_ALT(_regd, _regd_alt) \ + [(_regd)] = {.set = true, .alt = (_regd_alt)} + +static const struct rtw_regd_alternative_t +rtw_regd_alt[RTW_REGD_MAX] = { + DECL_REGD_ALT(RTW_REGD_IC, RTW_REGD_FCC), + DECL_REGD_ALT(RTW_REGD_KCC, RTW_REGD_ETSI), + DECL_REGD_ALT(RTW_REGD_ACMA, RTW_REGD_ETSI), + DECL_REGD_ALT(RTW_REGD_CHILE, RTW_REGD_FCC), + DECL_REGD_ALT(RTW_REGD_UKRAINE, RTW_REGD_ETSI), + DECL_REGD_ALT(RTW_REGD_MEXICO, RTW_REGD_FCC), + DECL_REGD_ALT(RTW_REGD_CN, RTW_REGD_ETSI), +}; + +bool rtw_regd_has_alt(u8 regd, u8 *regd_alt) +{ + if (!rtw_regd_alt[regd].set) + return false; + + *regd_alt = rtw_regd_alt[regd].alt; + return true; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/regd.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/regd.h new file mode 100644 index 0000000000000000000000000000000000000000..34cb13d0cd9ebce8f3ada4141729f16157241055 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/regd.h @@ -0,0 +1,71 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_REGD_H_ +#define __RTW_REGD_H_ + +#define IEEE80211_CHAN_NO_IBSS IEEE80211_CHAN_NO_IR +#define IEEE80211_CHAN_PASSIVE_SCAN IEEE80211_CHAN_NO_IR +enum rtw_chplan_id { + RTW_CHPLAN_ETSI1_NULL = 0x21, + RTW_CHPLAN_WORLD_ETSI1 = 0x26, + RTW_CHPLAN_MKK1_MKK1 = 0x27, + RTW_CHPLAN_IC1_IC2 = 0x2B, + RTW_CHPLAN_WORLD_CHILE1 = 0x2D, + RTW_CHPLAN_WORLD_FCC3 = 0x30, + RTW_CHPLAN_WORLD_FCC5 = 0x32, + RTW_CHPLAN_FCC1_FCC7 = 0x34, + RTW_CHPLAN_WORLD_ETSI2 = 0x35, + RTW_CHPLAN_WORLD_ETSI3 = 0x36, + RTW_CHPLAN_ETSI1_ETSI12 = 0x3D, + RTW_CHPLAN_KCC1_KCC2 = 0x3E, + RTW_CHPLAN_ETSI1_ETSI4 = 0x42, + RTW_CHPLAN_FCC1_NCC3 = 0x44, + RTW_CHPLAN_WORLD_ACMA1 = 0x45, + RTW_CHPLAN_WORLD_ETSI6 = 0x47, + RTW_CHPLAN_WORLD_ETSI7 = 0x48, + RTW_CHPLAN_WORLD_ETSI8 = 0x49, + RTW_CHPLAN_KCC1_KCC3 = 0x4B, + RTW_CHPLAN_WORLD_ETSI10 = 0x51, + RTW_CHPLAN_WORLD_ETSI14 = 0x59, + RTW_CHPLAN_FCC2_FCC7 = 0x61, + RTW_CHPLAN_FCC2_FCC1 = 0x62, + RTW_CHPLAN_WORLD_ETSI15 = 0x63, + RTW_CHPLAN_WORLD_FCC7 = 0x73, + RTW_CHPLAN_FCC2_FCC17 = 0x74, + RTW_CHPLAN_WORLD_ETSI20 = 0x75, + RTW_CHPLAN_FCC2_FCC11 = 0x76, + RTW_CHPLAN_REALTEK_DEFINE = 0x7f, +}; + +struct country_code_to_enum_rd { + u16 countrycode; + const char *iso_name; +}; + +enum country_code_type { + COUNTRY_CODE_FCC = 0, + COUNTRY_CODE_IC = 1, + COUNTRY_CODE_ETSI = 2, + COUNTRY_CODE_SPAIN = 3, + COUNTRY_CODE_FRANCE = 4, + COUNTRY_CODE_MKK = 5, + COUNTRY_CODE_MKK1 = 6, + COUNTRY_CODE_ISRAEL = 7, + COUNTRY_CODE_TELEC = 8, + COUNTRY_CODE_MIC = 9, + COUNTRY_CODE_GLOBAL_DOMAIN = 10, + COUNTRY_CODE_WORLD_WIDE_13 = 11, + COUNTRY_CODE_TELEC_NETGEAR = 12, + COUNTRY_CODE_WORLD_WIDE_13_5G_ALL = 13, + + /* new channel plan above this */ + COUNTRY_CODE_MAX +}; + +int rtw_regd_init(struct rtw_dev *rtwdev); +int rtw_regd_hint(struct rtw_dev *rtwdev); +u8 rtw_regd_get(struct rtw_dev *rtwdev); +bool rtw_regd_has_alt(u8 regd, u8 *regd_alt); +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d.c new file mode 100644 index 0000000000000000000000000000000000000000..c575476a002079ebf949645a9c39665b5c527055 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d.c @@ -0,0 +1,2831 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include "main.h" +#include "coex.h" +#include "fw.h" +#include "tx.h" +#include "rx.h" +#include "phy.h" +#include "rtw8723d.h" +#include "rtw8723d_table.h" +#include "mac.h" +#include "reg.h" +#include "debug.h" + +static const struct rtw_hw_reg rtw8723d_txagc[] = { + [DESC_RATE1M] = { .addr = 0xe08, .mask = 0x0000ff00 }, + [DESC_RATE2M] = { .addr = 0x86c, .mask = 0x0000ff00 }, + [DESC_RATE5_5M] = { .addr = 0x86c, .mask = 0x00ff0000 }, + [DESC_RATE11M] = { .addr = 0x86c, .mask = 0xff000000 }, + [DESC_RATE6M] = { .addr = 0xe00, .mask = 0x000000ff }, + [DESC_RATE9M] = { .addr = 0xe00, .mask = 0x0000ff00 }, + [DESC_RATE12M] = { .addr = 0xe00, .mask = 0x00ff0000 }, + [DESC_RATE18M] = { .addr = 0xe00, .mask = 0xff000000 }, + [DESC_RATE24M] = { .addr = 0xe04, .mask = 0x000000ff }, + [DESC_RATE36M] = { .addr = 0xe04, .mask = 0x0000ff00 }, + [DESC_RATE48M] = { .addr = 0xe04, .mask = 0x00ff0000 }, + [DESC_RATE54M] = { .addr = 0xe04, .mask = 0xff000000 }, + [DESC_RATEMCS0] = { .addr = 0xe10, .mask = 0x000000ff }, + [DESC_RATEMCS1] = { .addr = 0xe10, .mask = 0x0000ff00 }, + [DESC_RATEMCS2] = { .addr = 0xe10, .mask = 0x00ff0000 }, + [DESC_RATEMCS3] = { .addr = 0xe10, .mask = 0xff000000 }, + [DESC_RATEMCS4] = { .addr = 0xe14, .mask = 0x000000ff }, + [DESC_RATEMCS5] = { .addr = 0xe14, .mask = 0x0000ff00 }, + [DESC_RATEMCS6] = { .addr = 0xe14, .mask = 0x00ff0000 }, + [DESC_RATEMCS7] = { .addr = 0xe14, .mask = 0xff000000 }, +}; + +#define WLAN_TXQ_RPT_EN 0x1F +#define WLAN_SLOT_TIME 0x09 +#define WLAN_RL_VAL 0x3030 +#define WLAN_BAR_VAL 0x0201ffff +#define BIT_MASK_TBTT_HOLD 0x00000fff +#define BIT_SHIFT_TBTT_HOLD 8 +#define BIT_MASK_TBTT_SETUP 0x000000ff +#define BIT_SHIFT_TBTT_SETUP 0 +#define BIT_MASK_TBTT_MASK ((BIT_MASK_TBTT_HOLD << BIT_SHIFT_TBTT_HOLD) | \ + (BIT_MASK_TBTT_SETUP << BIT_SHIFT_TBTT_SETUP)) +#define TBTT_TIME(s, h)((((s) & BIT_MASK_TBTT_SETUP) << BIT_SHIFT_TBTT_SETUP) |\ + (((h) & BIT_MASK_TBTT_HOLD) << BIT_SHIFT_TBTT_HOLD)) +#define WLAN_TBTT_TIME_NORMAL TBTT_TIME(0x04, 0x80) +#define WLAN_TBTT_TIME_STOP_BCN TBTT_TIME(0x04, 0x64) +#define WLAN_PIFS_VAL 0 +#define WLAN_AGG_BRK_TIME 0x16 +#define WLAN_NAV_PROT_LEN 0x0040 +#define WLAN_SPEC_SIFS 0x100a +#define WLAN_RX_PKT_LIMIT 0x17 +#define WLAN_MAX_AGG_NR 0x0A +#define WLAN_AMPDU_MAX_TIME 0x1C +#define WLAN_ANT_SEL 0x82 +#define WLAN_LTR_IDLE_LAT 0x90039003 +#define WLAN_LTR_ACT_LAT 0x883c883c +#define WLAN_LTR_CTRL1 0xCB004010 +#define WLAN_LTR_CTRL2 0x01233425 + +static void rtw8723d_lck(struct rtw_dev *rtwdev) +{ + u32 lc_cal; + u8 val_ctx, rf_val; + int ret; + + val_ctx = rtw_read8(rtwdev, REG_CTX); + if ((val_ctx & BIT_MASK_CTX_TYPE) != 0) + rtw_write8(rtwdev, REG_CTX, val_ctx & ~BIT_MASK_CTX_TYPE); + else + rtw_write8(rtwdev, REG_TXPAUSE, 0xFF); + lc_cal = rtw_read_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK); + + rtw_write_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK, lc_cal | BIT_LCK); + + ret = read_poll_timeout(rtw_read_rf, rf_val, rf_val != 0x1, + 10000, 1000000, false, + rtwdev, RF_PATH_A, RF_CFGCH, BIT_LCK); + if (ret) + rtw_warn(rtwdev, "failed to poll LCK status bit\n"); + + rtw_write_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK, lc_cal); + if ((val_ctx & BIT_MASK_CTX_TYPE) != 0) + rtw_write8(rtwdev, REG_CTX, val_ctx); + else + rtw_write8(rtwdev, REG_TXPAUSE, 0x00); +} + +static const u32 rtw8723d_ofdm_swing_table[] = { + 0x0b40002d, 0x0c000030, 0x0cc00033, 0x0d800036, 0x0e400039, 0x0f00003c, + 0x10000040, 0x11000044, 0x12000048, 0x1300004c, 0x14400051, 0x15800056, + 0x16c0005b, 0x18000060, 0x19800066, 0x1b00006c, 0x1c800072, 0x1e400079, + 0x20000080, 0x22000088, 0x24000090, 0x26000098, 0x288000a2, 0x2ac000ab, + 0x2d4000b5, 0x300000c0, 0x32c000cb, 0x35c000d7, 0x390000e4, 0x3c8000f2, + 0x40000100, 0x43c0010f, 0x47c0011f, 0x4c000130, 0x50800142, 0x55400155, + 0x5a400169, 0x5fc0017f, 0x65400195, 0x6b8001ae, 0x71c001c7, 0x788001e2, + 0x7f8001fe, +}; + +static const u32 rtw8723d_cck_swing_table[] = { + 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, +}; + +#define RTW_OFDM_SWING_TABLE_SIZE ARRAY_SIZE(rtw8723d_ofdm_swing_table) +#define RTW_CCK_SWING_TABLE_SIZE ARRAY_SIZE(rtw8723d_cck_swing_table) + +static void rtw8723d_pwrtrack_init(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 path; + + dm_info->default_ofdm_index = RTW_DEF_OFDM_SWING_INDEX; + + for (path = RF_PATH_A; path < rtwdev->hal.rf_path_num; path++) { + ewma_thermal_init(&dm_info->avg_thermal[path]); + dm_info->delta_power_index[path] = 0; + } + dm_info->pwr_trk_triggered = false; + dm_info->pwr_trk_init_trigger = true; + dm_info->thermal_meter_k = rtwdev->efuse.thermal_meter_k; + dm_info->txagc_remnant_cck = 0; + dm_info->txagc_remnant_ofdm = 0; +} + +static void rtw8723d_phy_set_param(struct rtw_dev *rtwdev) +{ + u8 xtal_cap; + u32 val32; + + /* power on BB/RF domain */ + rtw_write16_set(rtwdev, REG_SYS_FUNC_EN, + BIT_FEN_EN_25_1 | BIT_FEN_BB_GLB_RST | BIT_FEN_BB_RSTB); + rtw_write8_set(rtwdev, REG_RF_CTRL, + BIT_RF_EN | BIT_RF_RSTB | BIT_RF_SDM_RSTB); + rtw_write8(rtwdev, REG_AFE_CTRL1 + 1, 0x80); + + rtw_phy_load_tables(rtwdev); + + /* post init after header files config */ + rtw_write32_clr(rtwdev, REG_RCR, BIT_RCR_ADF); + rtw_write8_set(rtwdev, REG_HIQ_NO_LMT_EN, BIT_HIQ_NO_LMT_EN_ROOT); + rtw_write16_set(rtwdev, REG_AFE_CTRL_4, BIT_CK320M_AFE_EN | BIT_EN_SYN); + + xtal_cap = rtwdev->efuse.crystal_cap & 0x3F; + rtw_write32_mask(rtwdev, REG_AFE_CTRL3, BIT_MASK_XTAL, + xtal_cap | (xtal_cap << 6)); + rtw_write32_set(rtwdev, REG_FPGA0_RFMOD, BIT_CCKEN | BIT_OFDMEN); + if ((rtwdev->efuse.afe >> 4) == 14) { + rtw_write32_set(rtwdev, REG_AFE_CTRL3, BIT_XTAL_GMP_BIT4); + rtw_write32_clr(rtwdev, REG_AFE_CTRL1, BITS_PLL); + rtw_write32_set(rtwdev, REG_LDO_SWR_CTRL, BIT_XTA1); + rtw_write32_clr(rtwdev, REG_LDO_SWR_CTRL, BIT_XTA0); + } + + rtw_write8(rtwdev, REG_SLOT, WLAN_SLOT_TIME); + rtw_write8(rtwdev, REG_FWHW_TXQ_CTRL + 1, WLAN_TXQ_RPT_EN); + rtw_write16(rtwdev, REG_RETRY_LIMIT, WLAN_RL_VAL); + rtw_write32(rtwdev, REG_BAR_MODE_CTRL, WLAN_BAR_VAL); + rtw_write8(rtwdev, REG_ATIMWND, 0x2); + rtw_write8(rtwdev, REG_BCN_CTRL, + BIT_DIS_TSF_UDT | BIT_EN_BCN_FUNCTION | BIT_EN_TXBCN_RPT); + val32 = rtw_read32(rtwdev, REG_TBTT_PROHIBIT); + val32 &= ~BIT_MASK_TBTT_MASK; + val32 |= WLAN_TBTT_TIME_STOP_BCN; + rtw_write8(rtwdev, REG_TBTT_PROHIBIT, val32); + rtw_write8(rtwdev, REG_PIFS, WLAN_PIFS_VAL); + rtw_write8(rtwdev, REG_AGGR_BREAK_TIME, WLAN_AGG_BRK_TIME); + rtw_write16(rtwdev, REG_NAV_PROT_LEN, WLAN_NAV_PROT_LEN); + rtw_write16(rtwdev, REG_MAC_SPEC_SIFS, WLAN_SPEC_SIFS); + rtw_write16(rtwdev, REG_SIFS, WLAN_SPEC_SIFS); + rtw_write16(rtwdev, REG_SIFS + 2, WLAN_SPEC_SIFS); + rtw_write8(rtwdev, REG_SINGLE_AMPDU_CTRL, BIT_EN_SINGLE_APMDU); + rtw_write8(rtwdev, REG_RX_PKT_LIMIT, WLAN_RX_PKT_LIMIT); + rtw_write8(rtwdev, REG_MAX_AGGR_NUM, WLAN_MAX_AGG_NR); + rtw_write8(rtwdev, REG_AMPDU_MAX_TIME, WLAN_AMPDU_MAX_TIME); + rtw_write8(rtwdev, REG_LEDCFG2, WLAN_ANT_SEL); + + rtw_write32(rtwdev, REG_LTR_IDLE_LATENCY, WLAN_LTR_IDLE_LAT); + rtw_write32(rtwdev, REG_LTR_ACTIVE_LATENCY, WLAN_LTR_ACT_LAT); + rtw_write32(rtwdev, REG_LTR_CTRL_BASIC, WLAN_LTR_CTRL1); + rtw_write32(rtwdev, REG_LTR_CTRL_BASIC + 4, WLAN_LTR_CTRL2); + + rtw_phy_init(rtwdev); + rtwdev->dm_info.cck_pd_default = rtw_read8(rtwdev, REG_CSRATIO) & 0x1f; + + rtw_write16_set(rtwdev, REG_TXDMA_OFFSET_CHK, BIT_DROP_DATA_EN); + + rtw8723d_lck(rtwdev); + + rtw_write32_mask(rtwdev, REG_OFDM0_XAAGC1, MASKBYTE0, 0x50); + rtw_write32_mask(rtwdev, REG_OFDM0_XAAGC1, MASKBYTE0, 0x20); + + rtw8723d_pwrtrack_init(rtwdev); +} + +static void rtw8723de_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8723d_efuse *map) +{ + ether_addr_copy(efuse->addr, map->e.mac_addr); +} + +static void rtw8723du_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8723d_efuse *map) +{ + ether_addr_copy(efuse->addr, map->u.mac_addr); +} + +static void rtw8723ds_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8723d_efuse *map) +{ + ether_addr_copy(efuse->addr, map->s.mac_addr); +} + +static int rtw8723d_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw8723d_efuse *map; + int i; + + map = (struct rtw8723d_efuse *)log_map; + + efuse->rfe_option = 0; + efuse->rf_board_option = map->rf_board_option; + efuse->crystal_cap = map->xtal_k; + efuse->pa_type_2g = map->pa_type; + efuse->lna_type_2g = map->lna_type_2g[0]; + efuse->channel_plan = map->channel_plan; + efuse->country_code[0] = map->country_code[0]; + efuse->country_code[1] = map->country_code[1]; + efuse->bt_setting = map->rf_bt_setting; + efuse->regd = map->rf_board_option & 0x7; + efuse->thermal_meter[0] = map->thermal_meter; + efuse->thermal_meter_k = map->thermal_meter; + efuse->afe = map->afe; + + for (i = 0; i < 4; i++) + efuse->txpwr_idx_table[i] = map->txpwr_idx_table[i]; + + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_PCIE: + rtw8723de_efuse_parsing(efuse, map); + break; + case RTW_HCI_TYPE_USB: + rtw8723du_efuse_parsing(efuse, map); + break; + case RTW_HCI_TYPE_SDIO: + rtw8723ds_efuse_parsing(efuse, map); + break; + default: + /* unsupported now */ + return -ENOTSUPP; + } + + return 0; +} + +static void query_phy_status_page0(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s8 min_rx_power = -120; + u8 pwdb = GET_PHY_STAT_P0_PWDB(phy_status); + + pkt_stat->rx_power[RF_PATH_A] = pwdb - 97; + pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1); + pkt_stat->bw = RTW_CHANNEL_WIDTH_20; + pkt_stat->signal_power = max(pkt_stat->rx_power[RF_PATH_A], + min_rx_power); + dm_info->rssi[RF_PATH_A] = pkt_stat->rssi; +} + +static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 rxsc, bw; + s8 min_rx_power = -120; + s8 rx_evm; + + if (pkt_stat->rate > DESC_RATE11M && pkt_stat->rate < DESC_RATEMCS0) + rxsc = GET_PHY_STAT_P1_L_RXSC(phy_status); + else + rxsc = GET_PHY_STAT_P1_HT_RXSC(phy_status); + + if (GET_PHY_STAT_P1_RF_MODE(phy_status) == 0) + bw = RTW_CHANNEL_WIDTH_20; + else if ((rxsc == 1) || (rxsc == 2)) + bw = RTW_CHANNEL_WIDTH_20; + else + bw = RTW_CHANNEL_WIDTH_40; + + pkt_stat->rx_power[RF_PATH_A] = GET_PHY_STAT_P1_PWDB_A(phy_status) - 110; + pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1); + pkt_stat->bw = bw; + pkt_stat->signal_power = max(pkt_stat->rx_power[RF_PATH_A], + min_rx_power); + pkt_stat->rx_evm[RF_PATH_A] = GET_PHY_STAT_P1_RXEVM_A(phy_status); + pkt_stat->rx_snr[RF_PATH_A] = GET_PHY_STAT_P1_RXSNR_A(phy_status); + pkt_stat->cfo_tail[RF_PATH_A] = GET_PHY_STAT_P1_CFO_TAIL_A(phy_status); + + dm_info->curr_rx_rate = pkt_stat->rate; + dm_info->rssi[RF_PATH_A] = pkt_stat->rssi; + dm_info->rx_snr[RF_PATH_A] = pkt_stat->rx_snr[RF_PATH_A] >> 1; + dm_info->cfo_tail[RF_PATH_A] = (pkt_stat->cfo_tail[RF_PATH_A] * 5) >> 1; + + rx_evm = clamp_t(s8, -pkt_stat->rx_evm[RF_PATH_A] >> 1, 0, 64); + rx_evm &= 0x3F; /* 64->0: second path of 1SS rate is 64 */ + dm_info->rx_evm_dbm[RF_PATH_A] = rx_evm; +} + +static void query_phy_status(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + u8 page; + + page = *phy_status & 0xf; + + switch (page) { + case 0: + query_phy_status_page0(rtwdev, phy_status, pkt_stat); + break; + case 1: + query_phy_status_page1(rtwdev, phy_status, pkt_stat); + break; + default: + rtw_warn(rtwdev, "unused phy status page (%d)\n", page); + return; + } +} + +static void rtw8723d_query_rx_desc(struct rtw_dev *rtwdev, u8 *rx_desc, + struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_rx_status *rx_status) +{ + struct ieee80211_hdr *hdr; + u32 desc_sz = rtwdev->chip->rx_pkt_desc_sz; + u8 *phy_status = NULL; + + memset(pkt_stat, 0, sizeof(*pkt_stat)); + + pkt_stat->phy_status = GET_RX_DESC_PHYST(rx_desc); + pkt_stat->icv_err = GET_RX_DESC_ICV_ERR(rx_desc); + pkt_stat->crc_err = GET_RX_DESC_CRC32(rx_desc); + pkt_stat->decrypted = !GET_RX_DESC_SWDEC(rx_desc) && + GET_RX_DESC_ENC_TYPE(rx_desc) != RX_DESC_ENC_NONE; + pkt_stat->is_c2h = GET_RX_DESC_C2H(rx_desc); + pkt_stat->pkt_len = GET_RX_DESC_PKT_LEN(rx_desc); + pkt_stat->drv_info_sz = GET_RX_DESC_DRV_INFO_SIZE(rx_desc); + pkt_stat->shift = GET_RX_DESC_SHIFT(rx_desc); + pkt_stat->rate = GET_RX_DESC_RX_RATE(rx_desc); + pkt_stat->cam_id = GET_RX_DESC_MACID(rx_desc); + pkt_stat->ppdu_cnt = 0; + pkt_stat->tsf_low = GET_RX_DESC_TSFL(rx_desc); + + /* drv_info_sz is in unit of 8-bytes */ + pkt_stat->drv_info_sz *= 8; + + /* c2h cmd pkt's rx/phy status is not interested */ + if (pkt_stat->is_c2h) + return; + + hdr = (struct ieee80211_hdr *)(rx_desc + desc_sz + pkt_stat->shift + + pkt_stat->drv_info_sz); + if (pkt_stat->phy_status) { + phy_status = rx_desc + desc_sz + pkt_stat->shift; + query_phy_status(rtwdev, phy_status, pkt_stat); + } + + rtw_rx_fill_rx_status(rtwdev, pkt_stat, hdr, rx_status, phy_status); +} + +static bool rtw8723d_check_spur_ov_thres(struct rtw_dev *rtwdev, + u8 channel, u32 thres) +{ + u32 freq; + bool ret = false; + + if (channel == 13) + freq = FREQ_CH13; + else if (channel == 14) + freq = FREQ_CH14; + else + return false; + + rtw_write32(rtwdev, REG_ANALOG_P4, DIS_3WIRE); + rtw_write32(rtwdev, REG_PSDFN, freq); + rtw_write32(rtwdev, REG_PSDFN, START_PSD | freq); + + msleep(30); + if (rtw_read32(rtwdev, REG_PSDRPT) >= thres) + ret = true; + + rtw_write32(rtwdev, REG_PSDFN, freq); + rtw_write32(rtwdev, REG_ANALOG_P4, EN_3WIRE); + + return ret; +} + +static void rtw8723d_cfg_notch(struct rtw_dev *rtwdev, u8 channel, bool notch) +{ + if (!notch) { + rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_MASK_RXDSP, 0x1f); + rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_EN_RXDSP, 0x0); + rtw_write32(rtwdev, REG_OFDM1_CSI1, 0x00000000); + rtw_write32(rtwdev, REG_OFDM1_CSI2, 0x00000000); + rtw_write32(rtwdev, REG_OFDM1_CSI3, 0x00000000); + rtw_write32(rtwdev, REG_OFDM1_CSI4, 0x00000000); + rtw_write32_mask(rtwdev, REG_OFDM1_CFOTRK, BIT_EN_CFOTRK, 0x0); + return; + } + + switch (channel) { + case 13: + rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_MASK_RXDSP, 0xb); + rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_EN_RXDSP, 0x1); + rtw_write32(rtwdev, REG_OFDM1_CSI1, 0x04000000); + rtw_write32(rtwdev, REG_OFDM1_CSI2, 0x00000000); + rtw_write32(rtwdev, REG_OFDM1_CSI3, 0x00000000); + rtw_write32(rtwdev, REG_OFDM1_CSI4, 0x00000000); + rtw_write32_mask(rtwdev, REG_OFDM1_CFOTRK, BIT_EN_CFOTRK, 0x1); + break; + case 14: + rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_MASK_RXDSP, 0x5); + rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_EN_RXDSP, 0x1); + rtw_write32(rtwdev, REG_OFDM1_CSI1, 0x00000000); + rtw_write32(rtwdev, REG_OFDM1_CSI2, 0x00000000); + rtw_write32(rtwdev, REG_OFDM1_CSI3, 0x00000000); + rtw_write32(rtwdev, REG_OFDM1_CSI4, 0x00080000); + rtw_write32_mask(rtwdev, REG_OFDM1_CFOTRK, BIT_EN_CFOTRK, 0x1); + break; + default: + rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_EN_RXDSP, 0x0); + rtw_write32_mask(rtwdev, REG_OFDM1_CFOTRK, BIT_EN_CFOTRK, 0x0); + break; + } +} + +static void rtw8723d_spur_cal(struct rtw_dev *rtwdev, u8 channel) +{ + bool notch; + + if (channel < 13) { + rtw8723d_cfg_notch(rtwdev, channel, false); + return; + } + + notch = rtw8723d_check_spur_ov_thres(rtwdev, channel, SPUR_THRES); + rtw8723d_cfg_notch(rtwdev, channel, notch); +} + +static void rtw8723d_set_channel_rf(struct rtw_dev *rtwdev, u8 channel, u8 bw) +{ + u32 rf_cfgch_a, rf_cfgch_b; + + rf_cfgch_a = rtw_read_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK); + rf_cfgch_b = rtw_read_rf(rtwdev, RF_PATH_B, RF_CFGCH, RFREG_MASK); + + rf_cfgch_a &= ~RFCFGCH_CHANNEL_MASK; + rf_cfgch_b &= ~RFCFGCH_CHANNEL_MASK; + rf_cfgch_a |= (channel & RFCFGCH_CHANNEL_MASK); + rf_cfgch_b |= (channel & RFCFGCH_CHANNEL_MASK); + + rf_cfgch_a &= ~RFCFGCH_BW_MASK; + switch (bw) { + case RTW_CHANNEL_WIDTH_20: + rf_cfgch_a |= RFCFGCH_BW_20M; + break; + case RTW_CHANNEL_WIDTH_40: + rf_cfgch_a |= RFCFGCH_BW_40M; + break; + default: + break; + } + + rtw_write_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK, rf_cfgch_a); + rtw_write_rf(rtwdev, RF_PATH_B, RF_CFGCH, RFREG_MASK, rf_cfgch_b); + + rtw8723d_spur_cal(rtwdev, channel); +} + +static const struct rtw_backup_info cck_dfir_cfg[][CCK_DFIR_NR] = { + [0] = { + { .len = 4, .reg = 0xA24, .val = 0x64B80C1C }, + { .len = 4, .reg = 0xA28, .val = 0x00008810 }, + { .len = 4, .reg = 0xAAC, .val = 0x01235667 }, + }, + [1] = { + { .len = 4, .reg = 0xA24, .val = 0x0000B81C }, + { .len = 4, .reg = 0xA28, .val = 0x00000000 }, + { .len = 4, .reg = 0xAAC, .val = 0x00003667 }, + }, +}; + +static void rtw8723d_set_channel_bb(struct rtw_dev *rtwdev, u8 channel, u8 bw, + u8 primary_ch_idx) +{ + const struct rtw_backup_info *cck_dfir; + int i; + + cck_dfir = channel <= 13 ? cck_dfir_cfg[0] : cck_dfir_cfg[1]; + + for (i = 0; i < CCK_DFIR_NR; i++, cck_dfir++) + rtw_write32(rtwdev, cck_dfir->reg, cck_dfir->val); + + switch (bw) { + case RTW_CHANNEL_WIDTH_20: + rtw_write32_mask(rtwdev, REG_FPGA0_RFMOD, BIT_MASK_RFMOD, 0x0); + rtw_write32_mask(rtwdev, REG_FPGA1_RFMOD, BIT_MASK_RFMOD, 0x0); + rtw_write32_mask(rtwdev, REG_BBRX_DFIR, BIT_RXBB_DFIR_EN, 1); + rtw_write32_mask(rtwdev, REG_BBRX_DFIR, BIT_MASK_RXBB_DFIR, 0xa); + break; + case RTW_CHANNEL_WIDTH_40: + rtw_write32_mask(rtwdev, REG_FPGA0_RFMOD, BIT_MASK_RFMOD, 0x1); + rtw_write32_mask(rtwdev, REG_FPGA1_RFMOD, BIT_MASK_RFMOD, 0x1); + rtw_write32_mask(rtwdev, REG_BBRX_DFIR, BIT_RXBB_DFIR_EN, 0); + rtw_write32_mask(rtwdev, REG_CCK0_SYS, BIT_CCK_SIDE_BAND, + (primary_ch_idx == RTW_SC_20_UPPER ? 1 : 0)); + break; + default: + break; + } +} + +static void rtw8723d_set_channel(struct rtw_dev *rtwdev, u8 channel, u8 bw, + u8 primary_chan_idx) +{ + rtw8723d_set_channel_rf(rtwdev, channel, bw); + rtw_set_channel_mac(rtwdev, channel, bw, primary_chan_idx); + rtw8723d_set_channel_bb(rtwdev, channel, bw, primary_chan_idx); +} + +#define BIT_CFENDFORM BIT(9) +#define BIT_WMAC_TCR_ERR0 BIT(12) +#define BIT_WMAC_TCR_ERR1 BIT(13) +#define BIT_TCR_CFG (BIT_CFENDFORM | BIT_WMAC_TCR_ERR0 | \ + BIT_WMAC_TCR_ERR1) +#define WLAN_RX_FILTER0 0xFFFF +#define WLAN_RX_FILTER1 0x400 +#define WLAN_RX_FILTER2 0xFFFF +#define WLAN_RCR_CFG 0x700060CE + +static int rtw8723d_mac_init(struct rtw_dev *rtwdev) +{ + rtw_write8(rtwdev, REG_FWHW_TXQ_CTRL + 1, WLAN_TXQ_RPT_EN); + rtw_write32(rtwdev, REG_TCR, BIT_TCR_CFG); + + rtw_write16(rtwdev, REG_RXFLTMAP0, WLAN_RX_FILTER0); + rtw_write16(rtwdev, REG_RXFLTMAP1, WLAN_RX_FILTER1); + rtw_write16(rtwdev, REG_RXFLTMAP2, WLAN_RX_FILTER2); + rtw_write32(rtwdev, REG_RCR, WLAN_RCR_CFG); + + rtw_write32(rtwdev, REG_INT_MIG, 0); + rtw_write32(rtwdev, REG_MCUTST_1, 0x0); + + rtw_write8(rtwdev, REG_MISC_CTRL, BIT_DIS_SECOND_CCA); + rtw_write8(rtwdev, REG_2ND_CCA_CTRL, 0); + + return 0; +} + +static void rtw8723d_shutdown(struct rtw_dev *rtwdev) +{ + rtw_write16_set(rtwdev, REG_HCI_OPT_CTRL, BIT_USB_SUS_DIS); +} + +static void rtw8723d_cfg_ldo25(struct rtw_dev *rtwdev, bool enable) +{ + u8 ldo_pwr; + + ldo_pwr = rtw_read8(rtwdev, REG_LDO_EFUSE_CTRL + 3); + if (enable) { + ldo_pwr &= ~BIT_MASK_LDO25_VOLTAGE; + ldo_pwr |= (BIT_LDO25_VOLTAGE_V25 << 4) | BIT_LDO25_EN; + } else { + ldo_pwr &= ~BIT_LDO25_EN; + } + rtw_write8(rtwdev, REG_LDO_EFUSE_CTRL + 3, ldo_pwr); +} + +static void +rtw8723d_set_tx_power_index_by_rate(struct rtw_dev *rtwdev, u8 path, u8 rs) +{ + struct rtw_hal *hal = &rtwdev->hal; + const struct rtw_hw_reg *txagc; + u8 rate, pwr_index; + int j; + + for (j = 0; j < rtw_rate_size[rs]; j++) { + rate = rtw_rate_section[rs][j]; + pwr_index = hal->tx_pwr_tbl[path][rate]; + + if (rate >= ARRAY_SIZE(rtw8723d_txagc)) { + rtw_warn(rtwdev, "rate 0x%x isn't supported\n", rate); + continue; + } + txagc = &rtw8723d_txagc[rate]; + if (!txagc->addr) { + rtw_warn(rtwdev, "rate 0x%x isn't defined\n", rate); + continue; + } + + rtw_write32_mask(rtwdev, txagc->addr, txagc->mask, pwr_index); + } +} + +static void rtw8723d_set_tx_power_index(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + int rs, path; + + for (path = 0; path < hal->rf_path_num; path++) { + for (rs = 0; rs <= RTW_RATE_SECTION_HT_1S; rs++) + rtw8723d_set_tx_power_index_by_rate(rtwdev, path, rs); + } +} + +static void rtw8723d_efuse_grant(struct rtw_dev *rtwdev, bool on) +{ + if (on) { + rtw_write8(rtwdev, REG_EFUSE_ACCESS, EFUSE_ACCESS_ON); + + rtw_write16_set(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_ELDR); + rtw_write16_set(rtwdev, REG_SYS_CLKR, BIT_LOADER_CLK_EN | BIT_ANA8M); + } else { + rtw_write8(rtwdev, REG_EFUSE_ACCESS, EFUSE_ACCESS_OFF); + } +} + +static void rtw8723d_false_alarm_statistics(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 cck_fa_cnt; + u32 ofdm_fa_cnt; + u32 crc32_cnt; + u32 val32; + + /* hold counter */ + rtw_write32_mask(rtwdev, REG_OFDM_FA_HOLDC_11N, BIT_MASK_OFDM_FA_KEEP, 1); + rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTD_11N, BIT_MASK_OFDM_FA_KEEP1, 1); + rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_CNT_KEEP, 1); + rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_FA_KEEP, 1); + + cck_fa_cnt = rtw_read32_mask(rtwdev, REG_CCK_FA_LSB_11N, MASKBYTE0); + cck_fa_cnt += rtw_read32_mask(rtwdev, REG_CCK_FA_MSB_11N, MASKBYTE3) << 8; + + val32 = rtw_read32(rtwdev, REG_OFDM_FA_TYPE1_11N); + ofdm_fa_cnt = u32_get_bits(val32, BIT_MASK_OFDM_FF_CNT); + ofdm_fa_cnt += u32_get_bits(val32, BIT_MASK_OFDM_SF_CNT); + val32 = rtw_read32(rtwdev, REG_OFDM_FA_TYPE2_11N); + dm_info->ofdm_cca_cnt = u32_get_bits(val32, BIT_MASK_OFDM_CCA_CNT); + ofdm_fa_cnt += u32_get_bits(val32, BIT_MASK_OFDM_PF_CNT); + val32 = rtw_read32(rtwdev, REG_OFDM_FA_TYPE3_11N); + ofdm_fa_cnt += u32_get_bits(val32, BIT_MASK_OFDM_RI_CNT); + ofdm_fa_cnt += u32_get_bits(val32, BIT_MASK_OFDM_CRC_CNT); + val32 = rtw_read32(rtwdev, REG_OFDM_FA_TYPE4_11N); + ofdm_fa_cnt += u32_get_bits(val32, BIT_MASK_OFDM_MNS_CNT); + + dm_info->cck_fa_cnt = cck_fa_cnt; + dm_info->ofdm_fa_cnt = ofdm_fa_cnt; + dm_info->total_fa_cnt = cck_fa_cnt + ofdm_fa_cnt; + + dm_info->cck_err_cnt = rtw_read32(rtwdev, REG_IGI_C_11N); + dm_info->cck_ok_cnt = rtw_read32(rtwdev, REG_IGI_D_11N); + crc32_cnt = rtw_read32(rtwdev, REG_OFDM_CRC32_CNT_11N); + dm_info->ofdm_err_cnt = u32_get_bits(crc32_cnt, BIT_MASK_OFDM_LCRC_ERR); + dm_info->ofdm_ok_cnt = u32_get_bits(crc32_cnt, BIT_MASK_OFDM_LCRC_OK); + crc32_cnt = rtw_read32(rtwdev, REG_HT_CRC32_CNT_11N); + dm_info->ht_err_cnt = u32_get_bits(crc32_cnt, BIT_MASK_HT_CRC_ERR); + dm_info->ht_ok_cnt = u32_get_bits(crc32_cnt, BIT_MASK_HT_CRC_OK); + dm_info->vht_err_cnt = 0; + dm_info->vht_ok_cnt = 0; + + val32 = rtw_read32(rtwdev, REG_CCK_CCA_CNT_11N); + dm_info->cck_cca_cnt = (u32_get_bits(val32, BIT_MASK_CCK_FA_MSB) << 8) | + u32_get_bits(val32, BIT_MASK_CCK_FA_LSB); + dm_info->total_cca_cnt = dm_info->cck_cca_cnt + dm_info->ofdm_cca_cnt; + + /* reset counter */ + rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTC_11N, BIT_MASK_OFDM_FA_RST, 1); + rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTC_11N, BIT_MASK_OFDM_FA_RST, 0); + rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTD_11N, BIT_MASK_OFDM_FA_RST1, 1); + rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTD_11N, BIT_MASK_OFDM_FA_RST1, 0); + rtw_write32_mask(rtwdev, REG_OFDM_FA_HOLDC_11N, BIT_MASK_OFDM_FA_KEEP, 0); + rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTD_11N, BIT_MASK_OFDM_FA_KEEP1, 0); + rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_CNT_KPEN, 0); + rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_CNT_KPEN, 2); + rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_FA_KPEN, 0); + rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_FA_KPEN, 2); + rtw_write32_mask(rtwdev, REG_PAGE_F_RST_11N, BIT_MASK_F_RST_ALL, 1); + rtw_write32_mask(rtwdev, REG_PAGE_F_RST_11N, BIT_MASK_F_RST_ALL, 0); +} + +static const u32 iqk_adda_regs[] = { + 0x85c, 0xe6c, 0xe70, 0xe74, 0xe78, 0xe7c, 0xe80, 0xe84, 0xe88, 0xe8c, + 0xed0, 0xed4, 0xed8, 0xedc, 0xee0, 0xeec +}; + +static const u32 iqk_mac8_regs[] = {0x522, 0x550, 0x551}; +static const u32 iqk_mac32_regs[] = {0x40}; + +static const u32 iqk_bb_regs[] = { + 0xc04, 0xc08, 0x874, 0xb68, 0xb6c, 0x870, 0x860, 0x864, 0xa04 +}; + +#define IQK_ADDA_REG_NUM ARRAY_SIZE(iqk_adda_regs) +#define IQK_MAC8_REG_NUM ARRAY_SIZE(iqk_mac8_regs) +#define IQK_MAC32_REG_NUM ARRAY_SIZE(iqk_mac32_regs) +#define IQK_BB_REG_NUM ARRAY_SIZE(iqk_bb_regs) + +struct iqk_backup_regs { + u32 adda[IQK_ADDA_REG_NUM]; + u8 mac8[IQK_MAC8_REG_NUM]; + u32 mac32[IQK_MAC32_REG_NUM]; + u32 bb[IQK_BB_REG_NUM]; + + u32 lte_path; + u32 lte_gnt; + + u32 bb_sel_btg; + u8 btg_sel; + + u8 igia; + u8 igib; +}; + +static void rtw8723d_iqk_backup_regs(struct rtw_dev *rtwdev, + struct iqk_backup_regs *backup) +{ + int i; + + for (i = 0; i < IQK_ADDA_REG_NUM; i++) + backup->adda[i] = rtw_read32(rtwdev, iqk_adda_regs[i]); + + for (i = 0; i < IQK_MAC8_REG_NUM; i++) + backup->mac8[i] = rtw_read8(rtwdev, iqk_mac8_regs[i]); + for (i = 0; i < IQK_MAC32_REG_NUM; i++) + backup->mac32[i] = rtw_read32(rtwdev, iqk_mac32_regs[i]); + + for (i = 0; i < IQK_BB_REG_NUM; i++) + backup->bb[i] = rtw_read32(rtwdev, iqk_bb_regs[i]); + + backup->igia = rtw_read32_mask(rtwdev, REG_OFDM0_XAAGC1, MASKBYTE0); + backup->igib = rtw_read32_mask(rtwdev, REG_OFDM0_XBAGC1, MASKBYTE0); + + backup->bb_sel_btg = rtw_read32(rtwdev, REG_BB_SEL_BTG); +} + +static void rtw8723d_iqk_restore_regs(struct rtw_dev *rtwdev, + const struct iqk_backup_regs *backup) +{ + int i; + + for (i = 0; i < IQK_ADDA_REG_NUM; i++) + rtw_write32(rtwdev, iqk_adda_regs[i], backup->adda[i]); + + for (i = 0; i < IQK_MAC8_REG_NUM; i++) + rtw_write8(rtwdev, iqk_mac8_regs[i], backup->mac8[i]); + for (i = 0; i < IQK_MAC32_REG_NUM; i++) + rtw_write32(rtwdev, iqk_mac32_regs[i], backup->mac32[i]); + + for (i = 0; i < IQK_BB_REG_NUM; i++) + rtw_write32(rtwdev, iqk_bb_regs[i], backup->bb[i]); + + rtw_write32_mask(rtwdev, REG_OFDM0_XAAGC1, MASKBYTE0, 0x50); + rtw_write32_mask(rtwdev, REG_OFDM0_XAAGC1, MASKBYTE0, backup->igia); + + rtw_write32_mask(rtwdev, REG_OFDM0_XBAGC1, MASKBYTE0, 0x50); + rtw_write32_mask(rtwdev, REG_OFDM0_XBAGC1, MASKBYTE0, backup->igib); + + rtw_write32(rtwdev, REG_TXIQK_TONE_A_11N, 0x01008c00); + rtw_write32(rtwdev, REG_RXIQK_TONE_A_11N, 0x01008c00); +} + +static void rtw8723d_iqk_backup_path_ctrl(struct rtw_dev *rtwdev, + struct iqk_backup_regs *backup) +{ + backup->btg_sel = rtw_read8(rtwdev, REG_BTG_SEL); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] original 0x67 = 0x%x\n", + backup->btg_sel); +} + +static void rtw8723d_iqk_config_path_ctrl(struct rtw_dev *rtwdev) +{ + rtw_write32_mask(rtwdev, REG_PAD_CTRL1, BIT_BT_BTG_SEL, 0x1); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] set 0x67 = 0x%x\n", + rtw_read32_mask(rtwdev, REG_PAD_CTRL1, MASKBYTE3)); +} + +static void rtw8723d_iqk_restore_path_ctrl(struct rtw_dev *rtwdev, + const struct iqk_backup_regs *backup) +{ + rtw_write8(rtwdev, REG_BTG_SEL, backup->btg_sel); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] restore 0x67 = 0x%x\n", + rtw_read32_mask(rtwdev, REG_PAD_CTRL1, MASKBYTE3)); +} + +static void rtw8723d_iqk_backup_lte_path_gnt(struct rtw_dev *rtwdev, + struct iqk_backup_regs *backup) +{ + backup->lte_path = rtw_read32(rtwdev, REG_LTECOEX_PATH_CONTROL); + rtw_write32(rtwdev, REG_LTECOEX_CTRL, 0x800f0038); + mdelay(1); + backup->lte_gnt = rtw_read32(rtwdev, REG_LTECOEX_READ_DATA); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] OriginalGNT = 0x%x\n", + backup->lte_gnt); +} + +static void rtw8723d_iqk_config_lte_path_gnt(struct rtw_dev *rtwdev) +{ + rtw_write32(rtwdev, REG_LTECOEX_WRITE_DATA, 0x0000ff00); + rtw_write32(rtwdev, REG_LTECOEX_CTRL, 0xc0020038); + rtw_write32_mask(rtwdev, REG_LTECOEX_PATH_CONTROL, BIT_LTE_MUX_CTRL_PATH, 0x1); +} + +static void rtw8723d_iqk_restore_lte_path_gnt(struct rtw_dev *rtwdev, + const struct iqk_backup_regs *bak) +{ + rtw_write32(rtwdev, REG_LTECOEX_WRITE_DATA, bak->lte_gnt); + rtw_write32(rtwdev, REG_LTECOEX_CTRL, 0xc00f0038); + rtw_write32(rtwdev, REG_LTECOEX_PATH_CONTROL, bak->lte_path); +} + +struct rtw_8723d_iqk_cfg { + const char *name; + u32 val_bb_sel_btg; + u32 reg_lutwe; + u32 val_txiqk_pi; + u32 reg_padlut; + u32 reg_gaintx; + u32 reg_bspad; + u32 val_wlint; + u32 val_wlsel; + u32 val_iqkpts; +}; + +static const struct rtw_8723d_iqk_cfg iqk_tx_cfg[PATH_NR] = { + [PATH_S1] = { + .name = "S1", + .val_bb_sel_btg = 0x99000000, + .reg_lutwe = RF_LUTWE, + .val_txiqk_pi = 0x8214019f, + .reg_padlut = RF_LUTDBG, + .reg_gaintx = RF_GAINTX, + .reg_bspad = RF_BSPAD, + .val_wlint = 0xe0d, + .val_wlsel = 0x60d, + .val_iqkpts = 0xfa000000, + }, + [PATH_S0] = { + .name = "S0", + .val_bb_sel_btg = 0x99000280, + .reg_lutwe = RF_LUTWE2, + .val_txiqk_pi = 0x8214018a, + .reg_padlut = RF_TXADBG, + .reg_gaintx = RF_TRXIQ, + .reg_bspad = RF_TXATANK, + .val_wlint = 0xe6d, + .val_wlsel = 0x66d, + .val_iqkpts = 0xf9000000, + }, +}; + +static u8 rtw8723d_iqk_check_tx_failed(struct rtw_dev *rtwdev, + const struct rtw_8723d_iqk_cfg *iqk_cfg) +{ + s32 tx_x, tx_y; + u32 tx_fail; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0xeac = 0x%x\n", + rtw_read32(rtwdev, REG_IQK_RES_RY)); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0xe94 = 0x%x, 0xe9c = 0x%x\n", + rtw_read32(rtwdev, REG_IQK_RES_TX), + rtw_read32(rtwdev, REG_IQK_RES_TY)); + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] 0xe90(before IQK)= 0x%x, 0xe98(afer IQK) = 0x%x\n", + rtw_read32(rtwdev, 0xe90), + rtw_read32(rtwdev, 0xe98)); + + tx_fail = rtw_read32_mask(rtwdev, REG_IQK_RES_RY, BIT_IQK_TX_FAIL); + tx_x = rtw_read32_mask(rtwdev, REG_IQK_RES_TX, BIT_MASK_RES_TX); + tx_y = rtw_read32_mask(rtwdev, REG_IQK_RES_TY, BIT_MASK_RES_TY); + + if (!tx_fail && tx_x != IQK_TX_X_ERR && tx_y != IQK_TX_Y_ERR) + return IQK_TX_OK; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] %s TXIQK is failed\n", + iqk_cfg->name); + + return 0; +} + +static u8 rtw8723d_iqk_check_rx_failed(struct rtw_dev *rtwdev, + const struct rtw_8723d_iqk_cfg *iqk_cfg) +{ + s32 rx_x, rx_y; + u32 rx_fail; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0xea4 = 0x%x, 0xeac = 0x%x\n", + rtw_read32(rtwdev, REG_IQK_RES_RX), + rtw_read32(rtwdev, REG_IQK_RES_RY)); + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] 0xea0(before IQK)= 0x%x, 0xea8(afer IQK) = 0x%x\n", + rtw_read32(rtwdev, 0xea0), + rtw_read32(rtwdev, 0xea8)); + + rx_fail = rtw_read32_mask(rtwdev, REG_IQK_RES_RY, BIT_IQK_RX_FAIL); + rx_x = rtw_read32_mask(rtwdev, REG_IQK_RES_RX, BIT_MASK_RES_RX); + rx_y = rtw_read32_mask(rtwdev, REG_IQK_RES_RY, BIT_MASK_RES_RY); + rx_y = abs(iqkxy_to_s32(rx_y)); + + if (!rx_fail && rx_x < IQK_RX_X_UPPER && rx_x > IQK_RX_X_LOWER && + rx_y < IQK_RX_Y_LMT) + return IQK_RX_OK; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] %s RXIQK STEP2 is failed\n", + iqk_cfg->name); + + return 0; +} + +static void rtw8723d_iqk_one_shot(struct rtw_dev *rtwdev, bool tx, + const struct rtw_8723d_iqk_cfg *iqk_cfg) +{ + u32 pts = (tx ? iqk_cfg->val_iqkpts : 0xf9000000); + + /* enter IQK mode */ + rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, EN_IQK); + rtw8723d_iqk_config_lte_path_gnt(rtwdev); + + rtw_write32(rtwdev, REG_LTECOEX_CTRL, 0x800f0054); + mdelay(1); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] GNT_BT @%s %sIQK1 = 0x%x\n", + iqk_cfg->name, tx ? "TX" : "RX", + rtw_read32(rtwdev, REG_LTECOEX_READ_DATA)); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0x948 @%s %sIQK1 = 0x%x\n", + iqk_cfg->name, tx ? "TX" : "RX", + rtw_read32(rtwdev, REG_BB_SEL_BTG)); + + /* One shot, LOK & IQK */ + rtw_write32(rtwdev, REG_IQK_AGC_PTS_11N, pts); + rtw_write32(rtwdev, REG_IQK_AGC_PTS_11N, 0xf8000000); + + if (!check_hw_ready(rtwdev, REG_IQK_RES_RY, BIT_IQK_DONE, 1)) + rtw_warn(rtwdev, "%s %s IQK isn't done\n", iqk_cfg->name, + tx ? "TX" : "RX"); +} + +static void rtw8723d_iqk_txrx_path_post(struct rtw_dev *rtwdev, + const struct rtw_8723d_iqk_cfg *iqk_cfg, + const struct iqk_backup_regs *backup) +{ + rtw8723d_iqk_restore_lte_path_gnt(rtwdev, backup); + rtw_write32(rtwdev, REG_BB_SEL_BTG, backup->bb_sel_btg); + + /* leave IQK mode */ + rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK); + mdelay(1); + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_padlut, 0x800, 0x0); + rtw_write_rf(rtwdev, RF_PATH_A, RF_WLINT, BIT(0), 0x0); + rtw_write_rf(rtwdev, RF_PATH_A, RF_WLSEL, BIT(0), 0x0); +} + +static u8 rtw8723d_iqk_tx_path(struct rtw_dev *rtwdev, + const struct rtw_8723d_iqk_cfg *iqk_cfg, + const struct iqk_backup_regs *backup) +{ + u8 status; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path %s TXIQK!!\n", iqk_cfg->name); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0x67 @%s TXIQK = 0x%x\n", + iqk_cfg->name, + rtw_read32_mask(rtwdev, REG_PAD_CTRL1, MASKBYTE3)); + + rtw_write32(rtwdev, REG_BB_SEL_BTG, iqk_cfg->val_bb_sel_btg); + rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK); + mdelay(1); + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, RFREG_MASK, 0x80000); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWA, RFREG_MASK, 0x00004); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD1, RFREG_MASK, 0x0005d); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD0, RFREG_MASK, 0xBFFE0); + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, RFREG_MASK, 0x00000); + + /* IQK setting */ + rtw_write32(rtwdev, REG_TXIQK_TONE_A_11N, 0x08008c0c); + rtw_write32(rtwdev, REG_RXIQK_TONE_A_11N, 0x38008c1c); + rtw_write32(rtwdev, REG_TXIQK_PI_A_11N, iqk_cfg->val_txiqk_pi); + rtw_write32(rtwdev, REG_RXIQK_PI_A_11N, 0x28160200); + rtw_write32(rtwdev, REG_TXIQK_11N, 0x01007c00); + rtw_write32(rtwdev, REG_RXIQK_11N, 0x01004800); + + /* LOK setting */ + rtw_write32(rtwdev, REG_IQK_AGC_RSP_11N, 0x00462911); + + /* PA, PAD setting */ + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_padlut, 0x800, 0x1); + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_gaintx, 0x600, 0x0); + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_gaintx, 0x1E0, 0x3); + rtw_write_rf(rtwdev, RF_PATH_A, RF_RXIQGEN, 0x1F, 0xf); + + /* LOK setting for 8723D */ + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, 0x10, 0x1); + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_bspad, 0x1, 0x1); + + rtw_write_rf(rtwdev, RF_PATH_A, RF_WLINT, RFREG_MASK, iqk_cfg->val_wlint); + rtw_write_rf(rtwdev, RF_PATH_A, RF_WLSEL, RFREG_MASK, iqk_cfg->val_wlsel); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x1 @%s TXIQK = 0x%x\n", + iqk_cfg->name, + rtw_read_rf(rtwdev, RF_PATH_A, RF_WLINT, RFREG_MASK)); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x2 @%s TXIQK = 0x%x\n", + iqk_cfg->name, + rtw_read_rf(rtwdev, RF_PATH_A, RF_WLSEL, RFREG_MASK)); + + rtw8723d_iqk_one_shot(rtwdev, true, iqk_cfg); + status = rtw8723d_iqk_check_tx_failed(rtwdev, iqk_cfg); + + rtw8723d_iqk_txrx_path_post(rtwdev, iqk_cfg, backup); + + return status; +} + +static u8 rtw8723d_iqk_rx_path(struct rtw_dev *rtwdev, + const struct rtw_8723d_iqk_cfg *iqk_cfg, + const struct iqk_backup_regs *backup) +{ + u32 tx_x, tx_y; + u8 status; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path %s RXIQK Step1!!\n", + iqk_cfg->name); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0x67 @%s RXIQK1 = 0x%x\n", + iqk_cfg->name, + rtw_read32_mask(rtwdev, REG_PAD_CTRL1, MASKBYTE3)); + rtw_write32(rtwdev, REG_BB_SEL_BTG, iqk_cfg->val_bb_sel_btg); + + rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK); + + /* IQK setting */ + rtw_write32(rtwdev, REG_TXIQK_11N, 0x01007c00); + rtw_write32(rtwdev, REG_RXIQK_11N, 0x01004800); + + /* path IQK setting */ + rtw_write32(rtwdev, REG_TXIQK_TONE_A_11N, 0x18008c1c); + rtw_write32(rtwdev, REG_RXIQK_TONE_A_11N, 0x38008c1c); + rtw_write32(rtwdev, REG_TX_IQK_TONE_B, 0x38008c1c); + rtw_write32(rtwdev, REG_RX_IQK_TONE_B, 0x38008c1c); + rtw_write32(rtwdev, REG_TXIQK_PI_A_11N, 0x82160000); + rtw_write32(rtwdev, REG_RXIQK_PI_A_11N, 0x28160000); + + /* LOK setting */ + rtw_write32(rtwdev, REG_IQK_AGC_RSP_11N, 0x0046a911); + + /* RXIQK mode */ + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, RFREG_MASK, 0x80000); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWA, RFREG_MASK, 0x00006); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD1, RFREG_MASK, 0x0005f); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD0, RFREG_MASK, 0xa7ffb); + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, RFREG_MASK, 0x00000); + + /* PA/PAD=0 */ + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_padlut, 0x800, 0x1); + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_gaintx, 0x600, 0x0); + rtw_write_rf(rtwdev, RF_PATH_A, RF_WLINT, RFREG_MASK, iqk_cfg->val_wlint); + rtw_write_rf(rtwdev, RF_PATH_A, RF_WLSEL, RFREG_MASK, iqk_cfg->val_wlsel); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x1@ path %s RXIQK1 = 0x%x\n", + iqk_cfg->name, + rtw_read_rf(rtwdev, RF_PATH_A, RF_WLINT, RFREG_MASK)); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x2@ path %s RXIQK1 = 0x%x\n", + iqk_cfg->name, + rtw_read_rf(rtwdev, RF_PATH_A, RF_WLSEL, RFREG_MASK)); + + rtw8723d_iqk_one_shot(rtwdev, false, iqk_cfg); + status = rtw8723d_iqk_check_tx_failed(rtwdev, iqk_cfg); + + if (!status) + goto restore; + + /* second round */ + tx_x = rtw_read32_mask(rtwdev, REG_IQK_RES_TX, BIT_MASK_RES_TX); + tx_y = rtw_read32_mask(rtwdev, REG_IQK_RES_TY, BIT_MASK_RES_TY); + + rtw_write32(rtwdev, REG_TXIQK_11N, BIT_SET_TXIQK_11N(tx_x, tx_y)); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0xe40 = 0x%x u4tmp = 0x%x\n", + rtw_read32(rtwdev, REG_TXIQK_11N), + BIT_SET_TXIQK_11N(tx_x, tx_y)); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path %s RXIQK STEP2!!\n", + iqk_cfg->name); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0x67 @%s RXIQK2 = 0x%x\n", + iqk_cfg->name, + rtw_read32_mask(rtwdev, REG_PAD_CTRL1, MASKBYTE3)); + + rtw_write32(rtwdev, REG_RXIQK_11N, 0x01004800); + rtw_write32(rtwdev, REG_TXIQK_TONE_A_11N, 0x38008c1c); + rtw_write32(rtwdev, REG_RXIQK_TONE_A_11N, 0x18008c1c); + rtw_write32(rtwdev, REG_TX_IQK_TONE_B, 0x38008c1c); + rtw_write32(rtwdev, REG_RX_IQK_TONE_B, 0x38008c1c); + rtw_write32(rtwdev, REG_TXIQK_PI_A_11N, 0x82170000); + rtw_write32(rtwdev, REG_RXIQK_PI_A_11N, 0x28171400); + + /* LOK setting */ + rtw_write32(rtwdev, REG_IQK_AGC_RSP_11N, 0x0046a8d1); + + /* RXIQK mode */ + rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK); + mdelay(1); + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, 0x80000, 0x1); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWA, RFREG_MASK, 0x00007); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD1, RFREG_MASK, 0x0005f); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD0, RFREG_MASK, 0xb3fdb); + rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, RFREG_MASK, 0x00000); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x1 @%s RXIQK2 = 0x%x\n", + iqk_cfg->name, + rtw_read_rf(rtwdev, RF_PATH_A, RF_WLINT, RFREG_MASK)); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x2 @%s RXIQK2 = 0x%x\n", + iqk_cfg->name, + rtw_read_rf(rtwdev, RF_PATH_A, RF_WLSEL, RFREG_MASK)); + + rtw8723d_iqk_one_shot(rtwdev, false, iqk_cfg); + status |= rtw8723d_iqk_check_rx_failed(rtwdev, iqk_cfg); + +restore: + rtw8723d_iqk_txrx_path_post(rtwdev, iqk_cfg, backup); + + return status; +} + +static +void rtw8723d_iqk_fill_s1_matrix(struct rtw_dev *rtwdev, const s32 result[]) +{ + s32 oldval_1; + s32 x, y; + s32 tx1_a, tx1_a_ext; + s32 tx1_c, tx1_c_ext; + + if (result[IQK_S1_TX_X] == 0) + return; + + oldval_1 = rtw_read32_mask(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE, + BIT_MASK_TXIQ_ELM_D); + + x = iqkxy_to_s32(result[IQK_S1_TX_X]); + tx1_a = iqk_mult(x, oldval_1, &tx1_a_ext); + rtw_write32_mask(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE, + BIT_MASK_TXIQ_ELM_A, tx1_a); + rtw_write32_mask(rtwdev, REG_OFDM_0_ECCA_THRESHOLD, + BIT_MASK_OFDM0_EXT_A, tx1_a_ext); + + y = iqkxy_to_s32(result[IQK_S1_TX_Y]); + tx1_c = iqk_mult(y, oldval_1, &tx1_c_ext); + rtw_write32_mask(rtwdev, REG_TXIQK_MATRIXA_LSB2_11N, MASKH4BITS, + BIT_SET_TXIQ_ELM_C1(tx1_c)); + rtw_write32_mask(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE, + BIT_MASK_TXIQ_ELM_C, BIT_SET_TXIQ_ELM_C2(tx1_c)); + rtw_write32_mask(rtwdev, REG_OFDM_0_ECCA_THRESHOLD, + BIT_MASK_OFDM0_EXT_C, tx1_c_ext); + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] X = 0x%x, TX1_A = 0x%x, oldval_1 0x%x\n", + x, tx1_a, oldval_1); + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] Y = 0x%x, TX1_C = 0x%x\n", y, tx1_c); + + if (result[IQK_S1_RX_X] == 0) + return; + + rtw_write32_mask(rtwdev, REG_A_RXIQI, BIT_MASK_RXIQ_S1_X, + result[IQK_S1_RX_X]); + rtw_write32_mask(rtwdev, REG_A_RXIQI, BIT_MASK_RXIQ_S1_Y1, + BIT_SET_RXIQ_S1_Y1(result[IQK_S1_RX_Y])); + rtw_write32_mask(rtwdev, REG_RXIQK_MATRIX_LSB_11N, BIT_MASK_RXIQ_S1_Y2, + BIT_SET_RXIQ_S1_Y2(result[IQK_S1_RX_Y])); +} + +static +void rtw8723d_iqk_fill_s0_matrix(struct rtw_dev *rtwdev, const s32 result[]) +{ + s32 oldval_0; + s32 x, y; + s32 tx0_a, tx0_a_ext; + s32 tx0_c, tx0_c_ext; + + if (result[IQK_S0_TX_X] == 0) + return; + + oldval_0 = rtw_read32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_D_S0); + + x = iqkxy_to_s32(result[IQK_S0_TX_X]); + tx0_a = iqk_mult(x, oldval_0, &tx0_a_ext); + + rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_S0, tx0_a); + rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_EXT_S0, tx0_a_ext); + + y = iqkxy_to_s32(result[IQK_S0_TX_Y]); + tx0_c = iqk_mult(y, oldval_0, &tx0_c_ext); + + rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_S0, tx0_c); + rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_EXT_S0, tx0_c_ext); + + if (result[IQK_S0_RX_X] == 0) + return; + + rtw_write32_mask(rtwdev, REG_RXIQ_AB_S0, BIT_MASK_RXIQ_X_S0, + result[IQK_S0_RX_X]); + rtw_write32_mask(rtwdev, REG_RXIQ_AB_S0, BIT_MASK_RXIQ_Y_S0, + result[IQK_S0_RX_Y]); +} + +static void rtw8723d_iqk_path_adda_on(struct rtw_dev *rtwdev) +{ + int i; + + for (i = 0; i < IQK_ADDA_REG_NUM; i++) + rtw_write32(rtwdev, iqk_adda_regs[i], 0x03c00016); +} + +static void rtw8723d_iqk_config_mac(struct rtw_dev *rtwdev) +{ + rtw_write8(rtwdev, REG_TXPAUSE, 0xff); +} + +static +void rtw8723d_iqk_rf_standby(struct rtw_dev *rtwdev, enum rtw_rf_path path) +{ + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path-%s standby mode!\n", + path == RF_PATH_A ? "S1" : "S0"); + + rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK); + mdelay(1); + rtw_write_rf(rtwdev, path, RF_MODE, RFREG_MASK, 0x10000); + rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, EN_IQK); +} + +static +bool rtw8723d_iqk_similarity_cmp(struct rtw_dev *rtwdev, s32 result[][IQK_NR], + u8 c1, u8 c2) +{ + u32 i, j, diff; + u32 bitmap = 0; + u8 candidate[PATH_NR] = {IQK_ROUND_INVALID, IQK_ROUND_INVALID}; + bool ret = true; + + s32 tmp1, tmp2; + + for (i = 0; i < IQK_NR; i++) { + tmp1 = iqkxy_to_s32(result[c1][i]); + tmp2 = iqkxy_to_s32(result[c2][i]); + + diff = abs(tmp1 - tmp2); + + if (diff <= MAX_TOLERANCE) + continue; + + if ((i == IQK_S1_RX_X || i == IQK_S0_RX_X) && !bitmap) { + if (result[c1][i] + result[c1][i + 1] == 0) + candidate[i / IQK_SX_NR] = c2; + else if (result[c2][i] + result[c2][i + 1] == 0) + candidate[i / IQK_SX_NR] = c1; + else + bitmap |= BIT(i); + } else { + bitmap |= BIT(i); + } + } + + if (bitmap != 0) + goto check_sim; + + for (i = 0; i < PATH_NR; i++) { + if (candidate[i] == IQK_ROUND_INVALID) + continue; + + for (j = i * IQK_SX_NR; j < i * IQK_SX_NR + 2; j++) + result[IQK_ROUND_HYBRID][j] = result[candidate[i]][j]; + ret = false; + } + + return ret; + +check_sim: + for (i = 0; i < IQK_NR; i++) { + j = i & ~1; /* 2 bits are a pair for IQ[X, Y] */ + if (bitmap & GENMASK(j + 1, j)) + continue; + + result[IQK_ROUND_HYBRID][i] = result[c1][i]; + } + + return false; +} + +static +void rtw8723d_iqk_precfg_path(struct rtw_dev *rtwdev, enum rtw8723d_path path) +{ + if (path == PATH_S0) { + rtw8723d_iqk_rf_standby(rtwdev, RF_PATH_A); + rtw8723d_iqk_path_adda_on(rtwdev); + } + + rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, EN_IQK); + rtw_write32(rtwdev, REG_TXIQK_11N, 0x01007c00); + rtw_write32(rtwdev, REG_RXIQK_11N, 0x01004800); + + if (path == PATH_S1) { + rtw8723d_iqk_rf_standby(rtwdev, RF_PATH_B); + rtw8723d_iqk_path_adda_on(rtwdev); + } +} + +static +void rtw8723d_iqk_one_round(struct rtw_dev *rtwdev, s32 result[][IQK_NR], u8 t, + const struct iqk_backup_regs *backup) +{ + u32 i; + u8 s1_ok, s0_ok; + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] IQ Calibration for 1T1R_S0/S1 for %d times\n", t); + + rtw8723d_iqk_path_adda_on(rtwdev); + rtw8723d_iqk_config_mac(rtwdev); + rtw_write32_mask(rtwdev, REG_CCK_ANT_SEL_11N, 0x0f000000, 0xf); + rtw_write32(rtwdev, REG_BB_RX_PATH_11N, 0x03a05611); + rtw_write32(rtwdev, REG_TRMUX_11N, 0x000800e4); + rtw_write32(rtwdev, REG_BB_PWR_SAV1_11N, 0x25204200); + rtw8723d_iqk_precfg_path(rtwdev, PATH_S1); + + for (i = 0; i < PATH_IQK_RETRY; i++) { + s1_ok = rtw8723d_iqk_tx_path(rtwdev, &iqk_tx_cfg[PATH_S1], backup); + if (s1_ok == IQK_TX_OK) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] path S1 Tx IQK Success!!\n"); + result[t][IQK_S1_TX_X] = + rtw_read32_mask(rtwdev, REG_IQK_RES_TX, BIT_MASK_RES_TX); + result[t][IQK_S1_TX_Y] = + rtw_read32_mask(rtwdev, REG_IQK_RES_TY, BIT_MASK_RES_TY); + break; + } + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S1 Tx IQK Fail!!\n"); + result[t][IQK_S1_TX_X] = 0x100; + result[t][IQK_S1_TX_Y] = 0x0; + } + + for (i = 0; i < PATH_IQK_RETRY; i++) { + s1_ok = rtw8723d_iqk_rx_path(rtwdev, &iqk_tx_cfg[PATH_S1], backup); + if (s1_ok == (IQK_TX_OK | IQK_RX_OK)) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] path S1 Rx IQK Success!!\n"); + result[t][IQK_S1_RX_X] = + rtw_read32_mask(rtwdev, REG_IQK_RES_RX, BIT_MASK_RES_RX); + result[t][IQK_S1_RX_Y] = + rtw_read32_mask(rtwdev, REG_IQK_RES_RY, BIT_MASK_RES_RY); + break; + } + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S1 Rx IQK Fail!!\n"); + result[t][IQK_S1_RX_X] = 0x100; + result[t][IQK_S1_RX_Y] = 0x0; + } + + if (s1_ok == 0x0) + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S1 IQK is failed!!\n"); + + rtw8723d_iqk_precfg_path(rtwdev, PATH_S0); + + for (i = 0; i < PATH_IQK_RETRY; i++) { + s0_ok = rtw8723d_iqk_tx_path(rtwdev, &iqk_tx_cfg[PATH_S0], backup); + if (s0_ok == IQK_TX_OK) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] path S0 Tx IQK Success!!\n"); + result[t][IQK_S0_TX_X] = + rtw_read32_mask(rtwdev, REG_IQK_RES_TX, BIT_MASK_RES_TX); + result[t][IQK_S0_TX_Y] = + rtw_read32_mask(rtwdev, REG_IQK_RES_TY, BIT_MASK_RES_TY); + break; + } + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S0 Tx IQK Fail!!\n"); + result[t][IQK_S0_TX_X] = 0x100; + result[t][IQK_S0_TX_Y] = 0x0; + } + + for (i = 0; i < PATH_IQK_RETRY; i++) { + s0_ok = rtw8723d_iqk_rx_path(rtwdev, &iqk_tx_cfg[PATH_S0], backup); + if (s0_ok == (IQK_TX_OK | IQK_RX_OK)) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] path S0 Rx IQK Success!!\n"); + + result[t][IQK_S0_RX_X] = + rtw_read32_mask(rtwdev, REG_IQK_RES_RX, BIT_MASK_RES_RX); + result[t][IQK_S0_RX_Y] = + rtw_read32_mask(rtwdev, REG_IQK_RES_RY, BIT_MASK_RES_RY); + break; + } + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S0 Rx IQK Fail!!\n"); + result[t][IQK_S0_RX_X] = 0x100; + result[t][IQK_S0_RX_Y] = 0x0; + } + + if (s0_ok == 0x0) + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S0 IQK is failed!!\n"); + + rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK); + mdelay(1); + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] back to BB mode, load original value!\n"); +} + +static void rtw8723d_phy_calibration(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s32 result[IQK_ROUND_SIZE][IQK_NR]; + struct iqk_backup_regs backup; + u8 i, j; + u8 final_candidate = IQK_ROUND_INVALID; + bool good; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] Start!!!\n"); + + memset(result, 0, sizeof(result)); + + rtw8723d_iqk_backup_path_ctrl(rtwdev, &backup); + rtw8723d_iqk_backup_lte_path_gnt(rtwdev, &backup); + rtw8723d_iqk_backup_regs(rtwdev, &backup); + + for (i = IQK_ROUND_0; i <= IQK_ROUND_2; i++) { + rtw8723d_iqk_config_path_ctrl(rtwdev); + rtw8723d_iqk_config_lte_path_gnt(rtwdev); + + rtw8723d_iqk_one_round(rtwdev, result, i, &backup); + + if (i > IQK_ROUND_0) + rtw8723d_iqk_restore_regs(rtwdev, &backup); + rtw8723d_iqk_restore_lte_path_gnt(rtwdev, &backup); + rtw8723d_iqk_restore_path_ctrl(rtwdev, &backup); + + for (j = IQK_ROUND_0; j < i; j++) { + good = rtw8723d_iqk_similarity_cmp(rtwdev, result, j, i); + + if (good) { + final_candidate = j; + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] cmp %d:%d final_candidate is %x\n", + j, i, final_candidate); + goto iqk_done; + } + } + } + + if (final_candidate == IQK_ROUND_INVALID) { + s32 reg_tmp = 0; + + for (i = 0; i < IQK_NR; i++) + reg_tmp += result[IQK_ROUND_HYBRID][i]; + + if (reg_tmp != 0) { + final_candidate = IQK_ROUND_HYBRID; + } else { + WARN(1, "IQK is failed\n"); + goto out; + } + } + +iqk_done: + rtw8723d_iqk_fill_s1_matrix(rtwdev, result[final_candidate]); + rtw8723d_iqk_fill_s0_matrix(rtwdev, result[final_candidate]); + + dm_info->iqk.result.s1_x = result[final_candidate][IQK_S1_TX_X]; + dm_info->iqk.result.s1_y = result[final_candidate][IQK_S1_TX_Y]; + dm_info->iqk.result.s0_x = result[final_candidate][IQK_S0_TX_X]; + dm_info->iqk.result.s0_y = result[final_candidate][IQK_S0_TX_Y]; + dm_info->iqk.done = true; + +out: + rtw_write32(rtwdev, REG_BB_SEL_BTG, backup.bb_sel_btg); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] final_candidate is %x\n", + final_candidate); + + for (i = IQK_ROUND_0; i < IQK_ROUND_SIZE; i++) + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK] Result %u: rege94_s1=%x rege9c_s1=%x regea4_s1=%x regeac_s1=%x rege94_s0=%x rege9c_s0=%x regea4_s0=%x regeac_s0=%x %s\n", + i, + result[i][0], result[i][1], result[i][2], result[i][3], + result[i][4], result[i][5], result[i][6], result[i][7], + final_candidate == i ? "(final candidate)" : ""); + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK]0xc80 = 0x%x 0xc94 = 0x%x 0xc14 = 0x%x 0xca0 = 0x%x\n", + rtw_read32(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE), + rtw_read32(rtwdev, REG_TXIQK_MATRIXA_LSB2_11N), + rtw_read32(rtwdev, REG_A_RXIQI), + rtw_read32(rtwdev, REG_RXIQK_MATRIX_LSB_11N)); + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[IQK]0xcd0 = 0x%x 0xcd4 = 0x%x 0xcd8 = 0x%x\n", + rtw_read32(rtwdev, REG_TXIQ_AB_S0), + rtw_read32(rtwdev, REG_TXIQ_CD_S0), + rtw_read32(rtwdev, REG_RXIQ_AB_S0)); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] finished\n"); +} + +static void rtw8723d_phy_cck_pd_set(struct rtw_dev *rtwdev, u8 new_lvl) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 pd[CCK_PD_LV_MAX] = {3, 7, 13, 13, 13}; + u8 cck_n_rx; + + rtw_dbg(rtwdev, RTW_DBG_PHY, "lv: (%d) -> (%d)\n", + dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A], new_lvl); + + if (dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A] == new_lvl) + return; + + cck_n_rx = (rtw_read8_mask(rtwdev, REG_CCK0_FAREPORT, BIT_CCK0_2RX) && + rtw_read8_mask(rtwdev, REG_CCK0_FAREPORT, BIT_CCK0_MRC)) ? 2 : 1; + rtw_dbg(rtwdev, RTW_DBG_PHY, + "is_linked=%d, lv=%d, n_rx=%d, cs_ratio=0x%x, pd_th=0x%x, cck_fa_avg=%d\n", + rtw_is_assoc(rtwdev), new_lvl, cck_n_rx, + dm_info->cck_pd_default + new_lvl * 2, + pd[new_lvl], dm_info->cck_fa_avg); + + dm_info->cck_fa_avg = CCK_FA_AVG_RESET; + + dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A] = new_lvl; + rtw_write32_mask(rtwdev, REG_PWRTH, 0x3f0000, pd[new_lvl]); + rtw_write32_mask(rtwdev, REG_PWRTH2, 0x1f0000, + dm_info->cck_pd_default + new_lvl * 2); +} + +/* for coex */ +static void rtw8723d_coex_cfg_init(struct rtw_dev *rtwdev) +{ + /* enable TBTT nterrupt */ + rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); + + /* BT report packet sample rate */ + /* 0x790[5:0]=0x5 */ + rtw_write8_mask(rtwdev, REG_BT_TDMA_TIME, BIT_MASK_SAMPLE_RATE, 0x5); + + /* enable BT counter statistics */ + rtw_write8(rtwdev, REG_BT_STAT_CTRL, 0x1); + + /* enable PTA (3-wire function form BT side) */ + rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_PTA_EN); + rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_PO_BT_PTA_PINS); + + /* enable PTA (tx/rx signal form WiFi side) */ + rtw_write8_set(rtwdev, REG_QUEUE_CTRL, BIT_PTA_WL_TX_EN); +} + +static void rtw8723d_coex_cfg_gnt_fix(struct rtw_dev *rtwdev) +{ +} + +static void rtw8723d_coex_cfg_gnt_debug(struct rtw_dev *rtwdev) +{ + rtw_write8_mask(rtwdev, REG_LEDCFG2, BIT(6), 0); + rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 3, BIT(0), 0); + rtw_write8_mask(rtwdev, REG_GPIO_INTM + 2, BIT(4), 0); + rtw_write8_mask(rtwdev, REG_GPIO_MUXCFG + 2, BIT(1), 0); + rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 3, BIT(1), 0); + rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 2, BIT(7), 0); + rtw_write8_mask(rtwdev, REG_SYS_CLKR + 1, BIT(1), 0); + rtw_write8_mask(rtwdev, REG_SYS_SDIO_CTRL + 3, BIT(3), 0); +} + +static void rtw8723d_coex_cfg_rfe_type(struct rtw_dev *rtwdev) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_rfe *coex_rfe = &coex->rfe; + bool aux = efuse->bt_setting & BIT(6); + + coex_rfe->rfe_module_type = rtwdev->efuse.rfe_option; + coex_rfe->ant_switch_polarity = 0; + coex_rfe->ant_switch_exist = false; + coex_rfe->ant_switch_with_bt = false; + coex_rfe->ant_switch_diversity = false; + coex_rfe->wlg_at_btg = true; + + /* decide antenna at main or aux */ + if (efuse->share_ant) { + if (aux) + rtw_write16(rtwdev, REG_BB_SEL_BTG, 0x80); + else + rtw_write16(rtwdev, REG_BB_SEL_BTG, 0x200); + } else { + if (aux) + rtw_write16(rtwdev, REG_BB_SEL_BTG, 0x280); + else + rtw_write16(rtwdev, REG_BB_SEL_BTG, 0x0); + } + + /* disable LTE coex in wifi side */ + rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, BIT_LTE_COEX_EN, 0x0); + rtw_coex_write_indirect_reg(rtwdev, LTE_WL_TRX_CTRL, MASKLWORD, 0xffff); + rtw_coex_write_indirect_reg(rtwdev, LTE_BT_TRX_CTRL, MASKLWORD, 0xffff); +} + +static void rtw8723d_coex_cfg_wl_tx_power(struct rtw_dev *rtwdev, u8 wl_pwr) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + static const u8 wl_tx_power[] = {0xb2, 0x90}; + u8 pwr; + + if (wl_pwr == coex_dm->cur_wl_pwr_lvl) + return; + + coex_dm->cur_wl_pwr_lvl = wl_pwr; + + if (coex_dm->cur_wl_pwr_lvl >= ARRAY_SIZE(wl_tx_power)) + coex_dm->cur_wl_pwr_lvl = ARRAY_SIZE(wl_tx_power) - 1; + + pwr = wl_tx_power[coex_dm->cur_wl_pwr_lvl]; + + rtw_write8(rtwdev, REG_ANA_PARAM1 + 3, pwr); +} + +static void rtw8723d_coex_cfg_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + /* WL Rx Low gain on */ + static const u32 wl_rx_low_gain_on[] = { + 0xec120101, 0xeb130101, 0xce140101, 0xcd150101, 0xcc160101, + 0xcb170101, 0xca180101, 0x8d190101, 0x8c1a0101, 0x8b1b0101, + 0x4f1c0101, 0x4e1d0101, 0x4d1e0101, 0x4c1f0101, 0x0e200101, + 0x0d210101, 0x0c220101, 0x0b230101, 0xcf240001, 0xce250001, + 0xcd260001, 0xcc270001, 0x8f280001 + }; + /* WL Rx Low gain off */ + static const u32 wl_rx_low_gain_off[] = { + 0xec120101, 0xeb130101, 0xea140101, 0xe9150101, 0xe8160101, + 0xe7170101, 0xe6180101, 0xe5190101, 0xe41a0101, 0xe31b0101, + 0xe21c0101, 0xe11d0101, 0xe01e0101, 0x861f0101, 0x85200101, + 0x84210101, 0x83220101, 0x82230101, 0x81240101, 0x80250101, + 0x44260101, 0x43270101, 0x42280101 + }; + u8 i; + + if (low_gain == coex_dm->cur_wl_rx_low_gain_en) + return; + + coex_dm->cur_wl_rx_low_gain_en = low_gain; + + if (coex_dm->cur_wl_rx_low_gain_en) { + for (i = 0; i < ARRAY_SIZE(wl_rx_low_gain_on); i++) + rtw_write32(rtwdev, REG_AGCRSSI, wl_rx_low_gain_on[i]); + } else { + for (i = 0; i < ARRAY_SIZE(wl_rx_low_gain_off); i++) + rtw_write32(rtwdev, REG_AGCRSSI, wl_rx_low_gain_off[i]); + } +} + +static u8 rtw8723d_pwrtrack_get_limit_ofdm(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 tx_rate = dm_info->tx_rate; + u8 limit_ofdm = 30; + + switch (tx_rate) { + case DESC_RATE1M...DESC_RATE5_5M: + case DESC_RATE11M: + break; + case DESC_RATE6M...DESC_RATE48M: + limit_ofdm = 36; + break; + case DESC_RATE54M: + limit_ofdm = 34; + break; + case DESC_RATEMCS0...DESC_RATEMCS2: + limit_ofdm = 38; + break; + case DESC_RATEMCS3...DESC_RATEMCS4: + limit_ofdm = 36; + break; + case DESC_RATEMCS5...DESC_RATEMCS7: + limit_ofdm = 34; + break; + default: + rtw_warn(rtwdev, "pwrtrack unhandled tx_rate 0x%x\n", tx_rate); + break; + } + + return limit_ofdm; +} + +static void rtw8723d_set_iqk_matrix_by_result(struct rtw_dev *rtwdev, + u32 ofdm_swing, u8 rf_path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s32 ele_A, ele_D, ele_C; + s32 ele_A_ext, ele_C_ext, ele_D_ext; + s32 iqk_result_x; + s32 iqk_result_y; + s32 value32; + + switch (rf_path) { + default: + case RF_PATH_A: + iqk_result_x = dm_info->iqk.result.s1_x; + iqk_result_y = dm_info->iqk.result.s1_y; + break; + case RF_PATH_B: + iqk_result_x = dm_info->iqk.result.s0_x; + iqk_result_y = dm_info->iqk.result.s0_y; + break; + } + + /* new element D */ + ele_D = OFDM_SWING_D(ofdm_swing); + iqk_mult(iqk_result_x, ele_D, &ele_D_ext); + /* new element A */ + iqk_result_x = iqkxy_to_s32(iqk_result_x); + ele_A = iqk_mult(iqk_result_x, ele_D, &ele_A_ext); + /* new element C */ + iqk_result_y = iqkxy_to_s32(iqk_result_y); + ele_C = iqk_mult(iqk_result_y, ele_D, &ele_C_ext); + + switch (rf_path) { + case RF_PATH_A: + default: + /* write new elements A, C, D, and element B is always 0 */ + value32 = BIT_SET_TXIQ_ELM_ACD(ele_A, ele_C, ele_D); + rtw_write32(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE, value32); + value32 = BIT_SET_TXIQ_ELM_C1(ele_C); + rtw_write32_mask(rtwdev, REG_TXIQK_MATRIXA_LSB2_11N, MASKH4BITS, + value32); + value32 = rtw_read32(rtwdev, REG_OFDM_0_ECCA_THRESHOLD); + value32 &= ~BIT_MASK_OFDM0_EXTS; + value32 |= BIT_SET_OFDM0_EXTS(ele_A_ext, ele_C_ext, ele_D_ext); + rtw_write32(rtwdev, REG_OFDM_0_ECCA_THRESHOLD, value32); + break; + + case RF_PATH_B: + /* write new elements A, C, D, and element B is always 0 */ + rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_D_S0, ele_D); + rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_S0, ele_C); + rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_S0, ele_A); + + rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_D_EXT_S0, + ele_D_ext); + rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_EXT_S0, + ele_A_ext); + rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_EXT_S0, + ele_C_ext); + break; + } +} + +static void rtw8723d_set_iqk_matrix(struct rtw_dev *rtwdev, s8 ofdm_index, + u8 rf_path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s32 value32; + u32 ofdm_swing; + + if (ofdm_index >= RTW_OFDM_SWING_TABLE_SIZE) + ofdm_index = RTW_OFDM_SWING_TABLE_SIZE - 1; + else if (ofdm_index < 0) + ofdm_index = 0; + + ofdm_swing = rtw8723d_ofdm_swing_table[ofdm_index]; + + if (dm_info->iqk.done) { + rtw8723d_set_iqk_matrix_by_result(rtwdev, ofdm_swing, rf_path); + return; + } + + switch (rf_path) { + case RF_PATH_A: + default: + rtw_write32(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE, ofdm_swing); + rtw_write32_mask(rtwdev, REG_TXIQK_MATRIXA_LSB2_11N, MASKH4BITS, + 0x00); + value32 = rtw_read32(rtwdev, REG_OFDM_0_ECCA_THRESHOLD); + value32 &= ~BIT_MASK_OFDM0_EXTS; + rtw_write32(rtwdev, REG_OFDM_0_ECCA_THRESHOLD, value32); + break; + + case RF_PATH_B: + /* image S1:c80 to S0:Cd0 and Cd4 */ + rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_S0, + OFDM_SWING_A(ofdm_swing)); + rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_B_S0, + OFDM_SWING_B(ofdm_swing)); + rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_S0, + OFDM_SWING_C(ofdm_swing)); + rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_D_S0, + OFDM_SWING_D(ofdm_swing)); + rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_D_EXT_S0, 0x0); + rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_EXT_S0, 0x0); + rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_EXT_S0, 0x0); + break; + } +} + +static void rtw8723d_pwrtrack_set_ofdm_pwr(struct rtw_dev *rtwdev, s8 swing_idx, + s8 txagc_idx) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + dm_info->txagc_remnant_ofdm = txagc_idx; + + rtw8723d_set_iqk_matrix(rtwdev, swing_idx, RF_PATH_A); + rtw8723d_set_iqk_matrix(rtwdev, swing_idx, RF_PATH_B); +} + +static void rtw8723d_pwrtrack_set_cck_pwr(struct rtw_dev *rtwdev, s8 swing_idx, + s8 txagc_idx) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + dm_info->txagc_remnant_cck = txagc_idx; + + rtw_write32_mask(rtwdev, 0xab4, 0x000007FF, + rtw8723d_cck_swing_table[swing_idx]); +} + +static void rtw8723d_pwrtrack_set(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_hal *hal = &rtwdev->hal; + u8 limit_ofdm; + u8 limit_cck = 40; + s8 final_ofdm_swing_index; + s8 final_cck_swing_index; + + limit_ofdm = rtw8723d_pwrtrack_get_limit_ofdm(rtwdev); + + final_ofdm_swing_index = RTW_DEF_OFDM_SWING_INDEX + + dm_info->delta_power_index[path]; + final_cck_swing_index = RTW_DEF_CCK_SWING_INDEX + + dm_info->delta_power_index[path]; + + if (final_ofdm_swing_index > limit_ofdm) + rtw8723d_pwrtrack_set_ofdm_pwr(rtwdev, limit_ofdm, + final_ofdm_swing_index - limit_ofdm); + else if (final_ofdm_swing_index < 0) + rtw8723d_pwrtrack_set_ofdm_pwr(rtwdev, 0, + final_ofdm_swing_index); + else + rtw8723d_pwrtrack_set_ofdm_pwr(rtwdev, final_ofdm_swing_index, 0); + + if (final_cck_swing_index > limit_cck) + rtw8723d_pwrtrack_set_cck_pwr(rtwdev, limit_cck, + final_cck_swing_index - limit_cck); + else if (final_cck_swing_index < 0) + rtw8723d_pwrtrack_set_cck_pwr(rtwdev, 0, + final_cck_swing_index); + else + rtw8723d_pwrtrack_set_cck_pwr(rtwdev, final_cck_swing_index, 0); + + rtw_phy_set_tx_power_level(rtwdev, hal->current_channel); +} + +static void rtw8723d_pwrtrack_set_xtal(struct rtw_dev *rtwdev, u8 therm_path, + u8 delta) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + const struct rtw_pwr_track_tbl *tbl = rtwdev->chip->pwr_track_tbl; + const s8 *pwrtrk_xtal; + s8 xtal_cap; + + if (dm_info->thermal_avg[therm_path] > + rtwdev->efuse.thermal_meter[therm_path]) + pwrtrk_xtal = tbl->pwrtrk_xtal_p; + else + pwrtrk_xtal = tbl->pwrtrk_xtal_n; + + xtal_cap = rtwdev->efuse.crystal_cap & 0x3F; + xtal_cap = clamp_t(s8, xtal_cap + pwrtrk_xtal[delta], 0, 0x3F); + rtw_write32_mask(rtwdev, REG_AFE_CTRL3, BIT_MASK_XTAL, + xtal_cap | (xtal_cap << 6)); +} + +static void rtw8723d_phy_pwrtrack(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_swing_table swing_table; + u8 thermal_value, delta, path; + bool do_iqk = false; + + rtw_phy_config_swing_table(rtwdev, &swing_table); + + if (rtwdev->efuse.thermal_meter[0] == 0xff) + return; + + thermal_value = rtw_read_rf(rtwdev, RF_PATH_A, RF_T_METER, 0xfc00); + + rtw_phy_pwrtrack_avg(rtwdev, thermal_value, RF_PATH_A); + + do_iqk = rtw_phy_pwrtrack_need_iqk(rtwdev); + + if (do_iqk) + rtw8723d_lck(rtwdev); + + if (dm_info->pwr_trk_init_trigger) + dm_info->pwr_trk_init_trigger = false; + else if (!rtw_phy_pwrtrack_thermal_changed(rtwdev, thermal_value, + RF_PATH_A)) + goto iqk; + + delta = rtw_phy_pwrtrack_get_delta(rtwdev, RF_PATH_A); + + delta = min_t(u8, delta, RTW_PWR_TRK_TBL_SZ - 1); + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + s8 delta_cur, delta_last; + + delta_last = dm_info->delta_power_index[path]; + delta_cur = rtw_phy_pwrtrack_get_pwridx(rtwdev, &swing_table, + path, RF_PATH_A, delta); + if (delta_last == delta_cur) + continue; + + dm_info->delta_power_index[path] = delta_cur; + rtw8723d_pwrtrack_set(rtwdev, path); + } + + rtw8723d_pwrtrack_set_xtal(rtwdev, RF_PATH_A, delta); + +iqk: + if (do_iqk) + rtw8723d_phy_calibration(rtwdev); +} + +static void rtw8723d_pwr_track(struct rtw_dev *rtwdev) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + if (efuse->power_track_type != 0) + return; + + if (!dm_info->pwr_trk_triggered) { + rtw_write_rf(rtwdev, RF_PATH_A, RF_T_METER, + GENMASK(17, 16), 0x03); + dm_info->pwr_trk_triggered = true; + return; + } + + rtw8723d_phy_pwrtrack(rtwdev); + dm_info->pwr_trk_triggered = false; +} + +static void rtw8723d_fill_txdesc_checksum(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *txdesc) +{ + size_t words = 32 / 2; /* calculate the first 32 bytes (16 words) */ + __le16 chksum = 0; + __le16 *data = (__le16 *)(txdesc); + struct rtw_tx_desc *tx_desc = (struct rtw_tx_desc *)txdesc; + + le32p_replace_bits(&tx_desc->w7, 0, RTW_TX_DESC_W7_TXDESC_CHECKSUM); + + while (words--) + chksum ^= *data++; + + chksum = ~chksum; + + le32p_replace_bits(&tx_desc->w7, __le16_to_cpu(chksum), + RTW_TX_DESC_W7_TXDESC_CHECKSUM); +} + +static struct rtw_chip_ops rtw8723d_ops = { + .phy_set_param = rtw8723d_phy_set_param, + .read_efuse = rtw8723d_read_efuse, + .query_rx_desc = rtw8723d_query_rx_desc, + .set_channel = rtw8723d_set_channel, + .mac_init = rtw8723d_mac_init, + .shutdown = rtw8723d_shutdown, + .read_rf = rtw_phy_read_rf_sipi, + .write_rf = rtw_phy_write_rf_reg_sipi, + .set_tx_power_index = rtw8723d_set_tx_power_index, + .set_antenna = NULL, + .cfg_ldo25 = rtw8723d_cfg_ldo25, + .efuse_grant = rtw8723d_efuse_grant, + .false_alarm_statistics = rtw8723d_false_alarm_statistics, + .phy_calibration = rtw8723d_phy_calibration, + .cck_pd_set = rtw8723d_phy_cck_pd_set, + .pwr_track = rtw8723d_pwr_track, + .config_bfee = NULL, + .set_gid_table = NULL, + .cfg_csi_rate = NULL, + .fill_txdesc_checksum = rtw8723d_fill_txdesc_checksum, + + .coex_set_init = rtw8723d_coex_cfg_init, + .coex_set_ant_switch = NULL, + .coex_set_gnt_fix = rtw8723d_coex_cfg_gnt_fix, + .coex_set_gnt_debug = rtw8723d_coex_cfg_gnt_debug, + .coex_set_rfe_type = rtw8723d_coex_cfg_rfe_type, + .coex_set_wl_tx_power = rtw8723d_coex_cfg_wl_tx_power, + .coex_set_wl_rx_gain = rtw8723d_coex_cfg_wl_rx_gain, +}; + +/* Shared-Antenna Coex Table */ +static const struct coex_table_para table_sant_8723d[] = { + {0xffffffff, 0xffffffff}, /* case-0 */ + {0x55555555, 0x55555555}, + {0x66555555, 0x66555555}, + {0xaaaaaaaa, 0xaaaaaaaa}, + {0x5a5a5a5a, 0x5a5a5a5a}, + {0xfafafafa, 0xfafafafa}, /* case-5 */ + {0x6a5a5555, 0xaaaaaaaa}, + {0x6a5a56aa, 0x6a5a56aa}, + {0x6a5a5a5a, 0x6a5a5a5a}, + {0x66555555, 0x5a5a5a5a}, + {0x66555555, 0x6a5a5a5a}, /* case-10 */ + {0x66555555, 0x6a5a5aaa}, + {0x66555555, 0x5a5a5aaa}, + {0x66555555, 0x6aaa5aaa}, + {0x66555555, 0xaaaa5aaa}, + {0x66555555, 0xaaaaaaaa}, /* case-15 */ + {0xffff55ff, 0xfafafafa}, + {0xffff55ff, 0x6afa5afa}, + {0xaaffffaa, 0xfafafafa}, + {0xaa5555aa, 0x5a5a5a5a}, + {0xaa5555aa, 0x6a5a5a5a}, /* case-20 */ + {0xaa5555aa, 0xaaaaaaaa}, + {0xffffffff, 0x5a5a5a5a}, + {0xffffffff, 0x5a5a5a5a}, + {0xffffffff, 0x55555555}, + {0xffffffff, 0x5a5a5aaa}, /* case-25 */ + {0x55555555, 0x5a5a5a5a}, + {0x55555555, 0xaaaaaaaa}, + {0x55555555, 0x6a5a6a5a}, + {0x66556655, 0x66556655}, + {0x66556aaa, 0x6a5a6aaa}, /* case-30 */ + {0xffffffff, 0x5aaa5aaa}, + {0x56555555, 0x5a5a5aaa}, +}; + +/* Non-Shared-Antenna Coex Table */ +static const struct coex_table_para table_nsant_8723d[] = { + {0xffffffff, 0xffffffff}, /* case-100 */ + {0x55555555, 0x55555555}, + {0x66555555, 0x66555555}, + {0xaaaaaaaa, 0xaaaaaaaa}, + {0x5a5a5a5a, 0x5a5a5a5a}, + {0xfafafafa, 0xfafafafa}, /* case-105 */ + {0x5afa5afa, 0x5afa5afa}, + {0x55555555, 0xfafafafa}, + {0x66555555, 0xfafafafa}, + {0x66555555, 0x5a5a5a5a}, + {0x66555555, 0x6a5a5a5a}, /* case-110 */ + {0x66555555, 0xaaaaaaaa}, + {0xffff55ff, 0xfafafafa}, + {0xffff55ff, 0x5afa5afa}, + {0xffff55ff, 0xaaaaaaaa}, + {0xffff55ff, 0xffff55ff}, /* case-115 */ + {0xaaffffaa, 0x5afa5afa}, + {0xaaffffaa, 0xaaaaaaaa}, + {0xffffffff, 0xfafafafa}, + {0xffffffff, 0x5afa5afa}, + {0xffffffff, 0xaaaaaaaa}, /* case-120 */ + {0x55ff55ff, 0x5afa5afa}, + {0x55ff55ff, 0xaaaaaaaa}, + {0x55ff55ff, 0x55ff55ff} +}; + +/* Shared-Antenna TDMA */ +static const struct coex_tdma_para tdma_sant_8723d[] = { + { {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-0 */ + { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-1 */ + { {0x61, 0x3a, 0x03, 0x11, 0x11} }, + { {0x61, 0x30, 0x03, 0x11, 0x11} }, + { {0x61, 0x20, 0x03, 0x11, 0x11} }, + { {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-5 */ + { {0x61, 0x45, 0x03, 0x11, 0x10} }, + { {0x61, 0x3a, 0x03, 0x11, 0x10} }, + { {0x61, 0x30, 0x03, 0x11, 0x10} }, + { {0x61, 0x20, 0x03, 0x11, 0x10} }, + { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-10 */ + { {0x61, 0x08, 0x03, 0x11, 0x14} }, + { {0x61, 0x08, 0x03, 0x10, 0x14} }, + { {0x51, 0x08, 0x03, 0x10, 0x54} }, + { {0x51, 0x08, 0x03, 0x10, 0x55} }, + { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-15 */ + { {0x51, 0x45, 0x03, 0x10, 0x50} }, + { {0x51, 0x3a, 0x03, 0x10, 0x50} }, + { {0x51, 0x30, 0x03, 0x10, 0x50} }, + { {0x51, 0x20, 0x03, 0x10, 0x50} }, + { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-20 */ + { {0x51, 0x4a, 0x03, 0x10, 0x50} }, + { {0x51, 0x0c, 0x03, 0x10, 0x54} }, + { {0x55, 0x08, 0x03, 0x10, 0x54} }, + { {0x65, 0x10, 0x03, 0x11, 0x10} }, + { {0x51, 0x10, 0x03, 0x10, 0x51} }, /* case-25 */ + { {0x51, 0x08, 0x03, 0x10, 0x50} }, + { {0x61, 0x08, 0x03, 0x11, 0x11} } +}; + +/* Non-Shared-Antenna TDMA */ +static const struct coex_tdma_para tdma_nsant_8723d[] = { + { {0x00, 0x00, 0x00, 0x00, 0x01} }, /* case-100 */ + { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-101 */ + { {0x61, 0x3a, 0x03, 0x11, 0x11} }, + { {0x61, 0x30, 0x03, 0x11, 0x11} }, + { {0x61, 0x20, 0x03, 0x11, 0x11} }, + { {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-105 */ + { {0x61, 0x45, 0x03, 0x11, 0x10} }, + { {0x61, 0x3a, 0x03, 0x11, 0x10} }, + { {0x61, 0x30, 0x03, 0x11, 0x10} }, + { {0x61, 0x20, 0x03, 0x11, 0x10} }, + { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-110 */ + { {0x61, 0x08, 0x03, 0x11, 0x14} }, + { {0x61, 0x08, 0x03, 0x10, 0x14} }, + { {0x51, 0x08, 0x03, 0x10, 0x54} }, + { {0x51, 0x08, 0x03, 0x10, 0x55} }, + { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-115 */ + { {0x51, 0x45, 0x03, 0x10, 0x50} }, + { {0x51, 0x3a, 0x03, 0x10, 0x50} }, + { {0x51, 0x30, 0x03, 0x10, 0x50} }, + { {0x51, 0x20, 0x03, 0x10, 0x50} }, + { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-120 */ + { {0x51, 0x08, 0x03, 0x10, 0x50} } +}; + +/* rssi in percentage % (dbm = % - 100) */ +static const u8 wl_rssi_step_8723d[] = {60, 50, 44, 30}; +static const u8 bt_rssi_step_8723d[] = {30, 30, 30, 30}; +static const struct coex_5g_afh_map afh_5g_8723d[] = { {0, 0, 0} }; + +static const struct rtw_hw_reg btg_reg_8723d = { + .addr = REG_BTG_SEL, .mask = BIT_MASK_BTG_WL, +}; + +/* wl_tx_dec_power, bt_tx_dec_power, wl_rx_gain, bt_rx_lna_constrain */ +static const struct coex_rf_para rf_para_tx_8723d[] = { + {0, 0, false, 7}, /* for normal */ + {0, 10, false, 7}, /* for WL-CPT */ + {1, 0, true, 4}, + {1, 2, true, 4}, + {1, 10, true, 4}, + {1, 15, true, 4} +}; + +static const struct coex_rf_para rf_para_rx_8723d[] = { + {0, 0, false, 7}, /* for normal */ + {0, 10, false, 7}, /* for WL-CPT */ + {1, 0, true, 5}, + {1, 2, true, 5}, + {1, 10, true, 5}, + {1, 15, true, 5} +}; + +static const struct rtw_pwr_seq_cmd trans_carddis_to_cardemu_8723d[] = { + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3) | BIT(7), 0}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_POLLING, BIT(1), BIT(1)}, + {0x004A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3) | BIT(4), 0}, + {0x0023, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(4), 0}, + {0x0301, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_cardemu_to_act_8723d[] = { + {0x0020, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0001, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_DELAY, 1, RTW_PWR_DELAY_MS}, + {0x0000, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3) | BIT(2)), 0}, + {0x0075, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(1), BIT(1)}, + {0x0075, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, (BIT(1) | BIT(0)), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3)), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(0), 0}, + {0x0010, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(6), BIT(6)}, + {0x0049, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), BIT(1)}, + {0x0063, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), BIT(1)}, + {0x0062, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0058, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x005A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), BIT(1)}, + {0x0068, + RTW_PWR_CUT_TEST_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3), BIT(3)}, + {0x0069, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(6), BIT(6)}, + {0x001f, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x00}, + {0x0077, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x00}, + {0x001f, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x07}, + {0x0077, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x07}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd *card_enable_flow_8723d[] = { + trans_carddis_to_cardemu_8723d, + trans_cardemu_to_act_8723d, + NULL +}; + +static const struct rtw_pwr_seq_cmd trans_act_to_lps_8723d[] = { + {0x0301, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0xFF}, + {0x0522, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0xFF}, + {0x05F8, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, 0xFF, 0}, + {0x05F9, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, 0xFF, 0}, + {0x05FA, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, 0xFF, 0}, + {0x05FB, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, 0xFF, 0}, + {0x0002, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0002, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_DELAY, 0, RTW_PWR_DELAY_US}, + {0x0002, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0100, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x03}, + {0x0101, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0093, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x00}, + {0x0553, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), BIT(5)}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_act_to_pre_carddis_8723d[] = { + {0x0003, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), 0}, + {0x0080, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_act_to_cardemu_8723d[] = { + {0x0002, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0049, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), BIT(1)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(1), 0}, + {0x0010, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(6), 0}, + {0x0000, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), BIT(5)}, + {0x0020, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_cardemu_to_carddis_8723d[] = { + {0x0007, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x20}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), BIT(2)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3) | BIT(4)}, + {0x004A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 1}, + {0x0023, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(4), BIT(4)}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_POLLING, BIT(1), 0}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_act_to_post_carddis_8723d[] = { + {0x001D, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x001D, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x001C, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x0E}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd *card_disable_flow_8723d[] = { + trans_act_to_lps_8723d, + trans_act_to_pre_carddis_8723d, + trans_act_to_cardemu_8723d, + trans_cardemu_to_carddis_8723d, + trans_act_to_post_carddis_8723d, + NULL +}; + +static const struct rtw_page_table page_table_8723d[] = { + {12, 2, 2, 0, 1}, + {12, 2, 2, 0, 1}, + {12, 2, 2, 0, 1}, + {12, 2, 2, 0, 1}, + {12, 2, 2, 0, 1}, +}; + +static const struct rtw_rqpn rqpn_table_8723d[] = { + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_HIGH, + RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, +}; + +static const struct rtw_prioq_addrs prioq_addrs_8723d = { + .prio[RTW_DMA_MAPPING_EXTRA] = { + .rsvd = REG_RQPN_NPQ + 2, .avail = REG_RQPN_NPQ + 3, + }, + .prio[RTW_DMA_MAPPING_LOW] = { + .rsvd = REG_RQPN + 1, .avail = REG_FIFOPAGE_CTRL_2 + 1, + }, + .prio[RTW_DMA_MAPPING_NORMAL] = { + .rsvd = REG_RQPN_NPQ, .avail = REG_RQPN_NPQ + 1, + }, + .prio[RTW_DMA_MAPPING_HIGH] = { + .rsvd = REG_RQPN, .avail = REG_FIFOPAGE_CTRL_2, + }, + .wsize = false, +}; + +static const struct rtw_intf_phy_para pcie_gen1_param_8723d[] = { + {0x0008, 0x4a22, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0009, 0x1000, + RTW_IP_SEL_PHY, + ~(RTW_INTF_PHY_CUT_A | RTW_INTF_PHY_CUT_B), + RTW_INTF_PHY_PLATFORM_ALL}, + {0xFFFF, 0x0000, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para_table phy_para_table_8723d = { + .gen1_para = pcie_gen1_param_8723d, + .n_gen1_para = ARRAY_SIZE(pcie_gen1_param_8723d), +}; + +static const struct rtw_hw_reg rtw8723d_dig[] = { + [0] = { .addr = 0xc50, .mask = 0x7f }, + [1] = { .addr = 0xc50, .mask = 0x7f }, +}; + +static const struct rtw_hw_reg rtw8723d_dig_cck[] = { + [0] = { .addr = 0xa0c, .mask = 0x3f00 }, +}; + +static const struct rtw_rf_sipi_addr rtw8723d_rf_sipi_addr[] = { + [RF_PATH_A] = { .hssi_1 = 0x820, .lssi_read = 0x8a0, + .hssi_2 = 0x824, .lssi_read_pi = 0x8b8}, + [RF_PATH_B] = { .hssi_1 = 0x828, .lssi_read = 0x8a4, + .hssi_2 = 0x82c, .lssi_read_pi = 0x8bc}, +}; + +static const struct rtw_ltecoex_addr rtw8723d_ltecoex_addr = { + .ctrl = REG_LTECOEX_CTRL, + .wdata = REG_LTECOEX_WRITE_DATA, + .rdata = REG_LTECOEX_READ_DATA, +}; + +static const struct rtw_rfe_def rtw8723d_rfe_defs[] = { + [0] = { .phy_pg_tbl = &rtw8723d_bb_pg_tbl, + .txpwr_lmt_tbl = &rtw8723d_txpwr_lmt_tbl,}, +}; + +static const u8 rtw8723d_pwrtrk_2gb_n[] = { + 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 +}; + +static const u8 rtw8723d_pwrtrk_2gb_p[] = { + 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 +}; + +static const u8 rtw8723d_pwrtrk_2ga_n[] = { + 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 +}; + +static const u8 rtw8723d_pwrtrk_2ga_p[] = { + 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 +}; + +static const u8 rtw8723d_pwrtrk_2g_cck_b_n[] = { + 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 +}; + +static const u8 rtw8723d_pwrtrk_2g_cck_b_p[] = { + 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 +}; + +static const u8 rtw8723d_pwrtrk_2g_cck_a_n[] = { + 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 +}; + +static const u8 rtw8723d_pwrtrk_2g_cck_a_p[] = { + 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 +}; + +static const s8 rtw8723d_pwrtrk_xtal_n[] = { + 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 +}; + +static const s8 rtw8723d_pwrtrk_xtal_p[] = { + 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 +}; + +static const struct rtw_pwr_track_tbl rtw8723d_rtw_pwr_track_tbl = { + .pwrtrk_2gb_n = rtw8723d_pwrtrk_2gb_n, + .pwrtrk_2gb_p = rtw8723d_pwrtrk_2gb_p, + .pwrtrk_2ga_n = rtw8723d_pwrtrk_2ga_n, + .pwrtrk_2ga_p = rtw8723d_pwrtrk_2ga_p, + .pwrtrk_2g_cckb_n = rtw8723d_pwrtrk_2g_cck_b_n, + .pwrtrk_2g_cckb_p = rtw8723d_pwrtrk_2g_cck_b_p, + .pwrtrk_2g_ccka_n = rtw8723d_pwrtrk_2g_cck_a_n, + .pwrtrk_2g_ccka_p = rtw8723d_pwrtrk_2g_cck_a_p, + .pwrtrk_xtal_p = rtw8723d_pwrtrk_xtal_p, + .pwrtrk_xtal_n = rtw8723d_pwrtrk_xtal_n, +}; + +static const struct rtw_reg_domain coex_info_hw_regs_8723d[] = { + {0x948, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x67, BIT(7), RTW_REG_DOMAIN_MAC8}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x964, BIT(1), RTW_REG_DOMAIN_MAC8}, + {0x864, BIT(0), RTW_REG_DOMAIN_MAC8}, + {0xab7, BIT(5), RTW_REG_DOMAIN_MAC8}, + {0xa01, BIT(7), RTW_REG_DOMAIN_MAC8}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x430, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x434, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x42a, MASKLWORD, RTW_REG_DOMAIN_MAC16}, + {0x426, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0x45e, BIT(3), RTW_REG_DOMAIN_MAC8}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x4c6, BIT(4), RTW_REG_DOMAIN_MAC8}, + {0x40, BIT(5), RTW_REG_DOMAIN_MAC8}, + {0x550, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x522, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0x953, BIT(1), RTW_REG_DOMAIN_MAC8}, +}; + +const struct rtw_chip_info rtw8723d_hw_spec = { + .ops = &rtw8723d_ops, + .id = RTW_CHIP_TYPE_8723D, + .fw_name = "rtw88/rtw8723d_fw.bin", + .wlan_cpu = RTW_WCPU_11N, + .tx_pkt_desc_sz = 40, + .tx_buf_desc_sz = 16, + .rx_pkt_desc_sz = 24, + .rx_buf_desc_sz = 8, + .phy_efuse_size = 512, + .log_efuse_size = 512, + .ptct_efuse_size = 96 + 1, + .txff_size = 32768, + .rxff_size = 16384, + .rsvd_drv_pg_num = 8, + .txgi_factor = 1, + .is_pwr_by_rate_dec = true, + .max_power_index = 0x3f, + .csi_buf_pg_num = 0, + .band = RTW_BAND_2G, + .page_size = TX_PAGE_SIZE, + .dig_min = 0x20, + .ht_supported = true, + .vht_supported = false, + .lps_deep_mode_supported = 0, + .sys_func_en = 0xFD, + .pwr_on_seq = card_enable_flow_8723d, + .pwr_off_seq = card_disable_flow_8723d, + .page_table = page_table_8723d, + .rqpn_table = rqpn_table_8723d, + .prioq_addrs = &prioq_addrs_8723d, + .intf_table = &phy_para_table_8723d, + .dig = rtw8723d_dig, + .dig_cck = rtw8723d_dig_cck, + .rf_sipi_addr = {0x840, 0x844}, + .rf_sipi_read_addr = rtw8723d_rf_sipi_addr, + .fix_rf_phy_num = 2, + .ltecoex_addr = &rtw8723d_ltecoex_addr, + .mac_tbl = &rtw8723d_mac_tbl, + .agc_tbl = &rtw8723d_agc_tbl, + .bb_tbl = &rtw8723d_bb_tbl, + .rf_tbl = {&rtw8723d_rf_a_tbl}, + .rfe_defs = rtw8723d_rfe_defs, + .rfe_defs_size = ARRAY_SIZE(rtw8723d_rfe_defs), + .rx_ldpc = false, + .pwr_track_tbl = &rtw8723d_rtw_pwr_track_tbl, + .iqk_threshold = 8, + .ampdu_density = IEEE80211_HT_MPDU_DENSITY_16, + .max_scan_ie_len = IEEE80211_MAX_DATA_LEN, + + .coex_para_ver = 0x2007022f, + .bt_desired_ver = 0x2f, + .scbd_support = true, + .new_scbd10_def = true, + .ble_hid_profile_support = false, + .wl_mimo_ps_support = false, + .pstdma_type = COEX_PSTDMA_FORCE_LPSOFF, + .bt_rssi_type = COEX_BTRSSI_RATIO, + .ant_isolation = 15, + .rssi_tolerance = 2, + .wl_rssi_step = wl_rssi_step_8723d, + .bt_rssi_step = bt_rssi_step_8723d, + .table_sant_num = ARRAY_SIZE(table_sant_8723d), + .table_sant = table_sant_8723d, + .table_nsant_num = ARRAY_SIZE(table_nsant_8723d), + .table_nsant = table_nsant_8723d, + .tdma_sant_num = ARRAY_SIZE(tdma_sant_8723d), + .tdma_sant = tdma_sant_8723d, + .tdma_nsant_num = ARRAY_SIZE(tdma_nsant_8723d), + .tdma_nsant = tdma_nsant_8723d, + .wl_rf_para_num = ARRAY_SIZE(rf_para_tx_8723d), + .wl_rf_para_tx = rf_para_tx_8723d, + .wl_rf_para_rx = rf_para_rx_8723d, + .bt_afh_span_bw20 = 0x20, + .bt_afh_span_bw40 = 0x30, + .afh_5g_num = ARRAY_SIZE(afh_5g_8723d), + .afh_5g = afh_5g_8723d, + .btg_reg = &btg_reg_8723d, + + .coex_info_hw_regs_num = ARRAY_SIZE(coex_info_hw_regs_8723d), + .coex_info_hw_regs = coex_info_hw_regs_8723d, +}; +EXPORT_SYMBOL(rtw8723d_hw_spec); + +MODULE_FIRMWARE("rtw88/rtw8723d_fw.bin"); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11n wireless 8723d driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d.h new file mode 100644 index 0000000000000000000000000000000000000000..3642a2c7f80c984dc2111880b7ac3729cdaaea5a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d.h @@ -0,0 +1,305 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW8723D_H__ +#define __RTW8723D_H__ + +enum rtw8723d_path { + PATH_S1, + PATH_S0, + PATH_NR, +}; + +enum rtw8723d_iqk_round { + IQK_ROUND_0, + IQK_ROUND_1, + IQK_ROUND_2, + IQK_ROUND_HYBRID, + IQK_ROUND_SIZE, + IQK_ROUND_INVALID = 0xff, +}; + +enum rtw8723d_iqk_result { + IQK_S1_TX_X, + IQK_S1_TX_Y, + IQK_S1_RX_X, + IQK_S1_RX_Y, + IQK_S0_TX_X, + IQK_S0_TX_Y, + IQK_S0_RX_X, + IQK_S0_RX_Y, + IQK_NR, + IQK_SX_NR = IQK_NR / PATH_NR, +}; + +struct rtw8723de_efuse { + u8 mac_addr[ETH_ALEN]; /* 0xd0 */ + u8 vender_id[2]; + u8 device_id[2]; + u8 sub_vender_id[2]; + u8 sub_device_id[2]; +}; + +struct rtw8723du_efuse { + u8 res4[48]; /* 0xd0 */ + u8 vender_id[2]; /* 0x100 */ + u8 product_id[2]; /* 0x102 */ + u8 usb_option; /* 0x104 */ + u8 mac_addr[ETH_ALEN]; /* 0x107 */ +}; + +struct rtw8723ds_efuse { + u8 res4[0x4a]; /* 0xd0 */ + u8 mac_addr[ETH_ALEN]; /* 0x11a */ +}; + +struct rtw8723d_efuse { + __le16 rtl_id; + u8 rsvd[2]; + u8 afe; + u8 rsvd1[11]; + + /* power index for four RF paths */ + struct rtw_txpwr_idx txpwr_idx_table[4]; + + u8 channel_plan; /* 0xb8 */ + u8 xtal_k; + u8 thermal_meter; + u8 iqk_lck; + u8 pa_type; /* 0xbc */ + u8 lna_type_2g[2]; /* 0xbd */ + u8 lna_type_5g[2]; + u8 rf_board_option; + u8 rf_feature_option; + u8 rf_bt_setting; + u8 eeprom_version; + u8 eeprom_customer_id; + u8 tx_bb_swing_setting_2g; + u8 res_c7; + u8 tx_pwr_calibrate_rate; + u8 rf_antenna_option; /* 0xc9 */ + u8 rfe_option; + u8 country_code[2]; + u8 res[3]; + union { + struct rtw8723de_efuse e; + struct rtw8723du_efuse u; + struct rtw8723ds_efuse s; + }; +}; + +extern const struct rtw_chip_info rtw8723d_hw_spec; + +/* phy status page0 */ +#define GET_PHY_STAT_P0_PWDB(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(15, 8)) + +/* phy status page1 */ +#define GET_PHY_STAT_P1_PWDB_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(15, 8)) +#define GET_PHY_STAT_P1_PWDB_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(23, 16)) +#define GET_PHY_STAT_P1_RF_MODE(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x03), GENMASK(29, 28)) +#define GET_PHY_STAT_P1_L_RXSC(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(11, 8)) +#define GET_PHY_STAT_P1_HT_RXSC(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(15, 12)) +#define GET_PHY_STAT_P1_RXEVM_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_CFO_TAIL_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x05), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_RXSNR_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x06), GENMASK(7, 0)) + +static inline s32 iqkxy_to_s32(s32 val) +{ + /* val is Q10.8 */ + return sign_extend32(val, 9); +} + +static inline s32 iqk_mult(s32 x, s32 y, s32 *ext) +{ + /* x, y and return value are Q10.8 */ + s32 t; + + t = x * y; + if (ext) + *ext = (t >> 7) & 0x1; /* Q.16 --> Q.9; get LSB of Q.9 */ + + return (t >> 8); /* Q.16 --> Q.8 */ +} + +#define OFDM_SWING_A(swing) FIELD_GET(GENMASK(9, 0), swing) +#define OFDM_SWING_B(swing) FIELD_GET(GENMASK(15, 10), swing) +#define OFDM_SWING_C(swing) FIELD_GET(GENMASK(21, 16), swing) +#define OFDM_SWING_D(swing) FIELD_GET(GENMASK(31, 22), swing) +#define RTW_DEF_OFDM_SWING_INDEX 28 +#define RTW_DEF_CCK_SWING_INDEX 28 + +#define MAX_TOLERANCE 5 +#define IQK_TX_X_ERR 0x142 +#define IQK_TX_Y_ERR 0x42 +#define IQK_RX_X_UPPER 0x11a +#define IQK_RX_X_LOWER 0xe6 +#define IQK_RX_Y_LMT 0x1a +#define IQK_TX_OK BIT(0) +#define IQK_RX_OK BIT(1) +#define PATH_IQK_RETRY 2 + +#define SPUR_THRES 0x16 +#define CCK_DFIR_NR 3 +#define DIS_3WIRE 0xccf000c0 +#define EN_3WIRE 0xccc000c0 +#define START_PSD 0x400000 +#define FREQ_CH13 0xfccd +#define FREQ_CH14 0xff9a +#define RFCFGCH_CHANNEL_MASK GENMASK(7, 0) +#define RFCFGCH_BW_MASK (BIT(11) | BIT(10)) +#define RFCFGCH_BW_20M (BIT(11) | BIT(10)) +#define RFCFGCH_BW_40M BIT(10) +#define BIT_MASK_RFMOD BIT(0) +#define BIT_LCK BIT(15) + +#define REG_GPIO_INTM 0x0048 +#define REG_BTG_SEL 0x0067 +#define BIT_MASK_BTG_WL BIT(7) +#define REG_LTECOEX_PATH_CONTROL 0x0070 +#define REG_LTECOEX_CTRL 0x07c0 +#define REG_LTECOEX_WRITE_DATA 0x07c4 +#define REG_LTECOEX_READ_DATA 0x07c8 +#define REG_PSDFN 0x0808 +#define REG_BB_PWR_SAV1_11N 0x0874 +#define REG_ANA_PARAM1 0x0880 +#define REG_ANALOG_P4 0x088c +#define REG_PSDRPT 0x08b4 +#define REG_FPGA1_RFMOD 0x0900 +#define REG_BB_SEL_BTG 0x0948 +#define REG_BBRX_DFIR 0x0954 +#define BIT_MASK_RXBB_DFIR GENMASK(27, 24) +#define BIT_RXBB_DFIR_EN BIT(19) +#define REG_CCK0_SYS 0x0a00 +#define BIT_CCK_SIDE_BAND BIT(4) +#define REG_CCK_ANT_SEL_11N 0x0a04 +#define REG_PWRTH 0x0a08 +#define REG_CCK_FA_RST_11N 0x0a2c +#define BIT_MASK_CCK_CNT_KEEP BIT(12) +#define BIT_MASK_CCK_CNT_EN BIT(13) +#define BIT_MASK_CCK_CNT_KPEN (BIT_MASK_CCK_CNT_KEEP | BIT_MASK_CCK_CNT_EN) +#define BIT_MASK_CCK_FA_KEEP BIT(14) +#define BIT_MASK_CCK_FA_EN BIT(15) +#define BIT_MASK_CCK_FA_KPEN (BIT_MASK_CCK_FA_KEEP | BIT_MASK_CCK_FA_EN) +#define REG_CCK_FA_LSB_11N 0x0a5c +#define REG_CCK_FA_MSB_11N 0x0a58 +#define REG_CCK_CCA_CNT_11N 0x0a60 +#define BIT_MASK_CCK_FA_MSB GENMASK(7, 0) +#define BIT_MASK_CCK_FA_LSB GENMASK(15, 8) +#define REG_PWRTH2 0x0aa8 +#define REG_CSRATIO 0x0aaa +#define REG_OFDM_FA_HOLDC_11N 0x0c00 +#define BIT_MASK_OFDM_FA_KEEP BIT(31) +#define REG_BB_RX_PATH_11N 0x0c04 +#define REG_TRMUX_11N 0x0c08 +#define REG_OFDM_FA_RSTC_11N 0x0c0c +#define BIT_MASK_OFDM_FA_RST BIT(31) +#define REG_A_RXIQI 0x0c14 +#define BIT_MASK_RXIQ_S1_X 0x000003FF +#define BIT_MASK_RXIQ_S1_Y1 0x0000FC00 +#define BIT_SET_RXIQ_S1_Y1(y) ((y) & 0x3F) +#define REG_OFDM0_RXDSP 0x0c40 +#define BIT_MASK_RXDSP GENMASK(28, 24) +#define BIT_EN_RXDSP BIT(9) +#define REG_OFDM_0_ECCA_THRESHOLD 0x0c4c +#define BIT_MASK_OFDM0_EXT_A BIT(31) +#define BIT_MASK_OFDM0_EXT_C BIT(29) +#define BIT_MASK_OFDM0_EXTS (BIT(31) | BIT(29) | BIT(28)) +#define BIT_SET_OFDM0_EXTS(a, c, d) (((a) << 31) | ((c) << 29) | ((d) << 28)) +#define REG_OFDM0_XAAGC1 0x0c50 +#define REG_OFDM0_XBAGC1 0x0c58 +#define REG_AGCRSSI 0x0c78 +#define REG_OFDM_0_XA_TX_IQ_IMBALANCE 0x0c80 +#define BIT_MASK_TXIQ_ELM_A 0x03ff +#define BIT_SET_TXIQ_ELM_ACD(a, c, d) (((d) << 22) | (((c) & 0x3F) << 16) | \ + ((a) & 0x03ff)) +#define BIT_MASK_TXIQ_ELM_C GENMASK(21, 16) +#define BIT_SET_TXIQ_ELM_C2(c) ((c) & 0x3F) +#define BIT_MASK_TXIQ_ELM_D GENMASK(31, 22) +#define REG_TXIQK_MATRIXA_LSB2_11N 0x0c94 +#define BIT_SET_TXIQ_ELM_C1(c) (((c) & 0x000003C0) >> 6) +#define REG_RXIQK_MATRIX_LSB_11N 0x0ca0 +#define BIT_MASK_RXIQ_S1_Y2 0xF0000000 +#define BIT_SET_RXIQ_S1_Y2(y) (((y) >> 6) & 0xF) +#define REG_TXIQ_AB_S0 0x0cd0 +#define BIT_MASK_TXIQ_A_S0 0x000007FE +#define BIT_MASK_TXIQ_A_EXT_S0 BIT(0) +#define BIT_MASK_TXIQ_B_S0 0x0007E000 +#define REG_TXIQ_CD_S0 0x0cd4 +#define BIT_MASK_TXIQ_C_S0 0x000007FE +#define BIT_MASK_TXIQ_C_EXT_S0 BIT(0) +#define BIT_MASK_TXIQ_D_S0 GENMASK(22, 13) +#define BIT_MASK_TXIQ_D_EXT_S0 BIT(12) +#define REG_RXIQ_AB_S0 0x0cd8 +#define BIT_MASK_RXIQ_X_S0 0x000003FF +#define BIT_MASK_RXIQ_Y_S0 0x003FF000 +#define REG_OFDM_FA_TYPE1_11N 0x0cf0 +#define BIT_MASK_OFDM_FF_CNT GENMASK(15, 0) +#define BIT_MASK_OFDM_SF_CNT GENMASK(31, 16) +#define REG_OFDM_FA_RSTD_11N 0x0d00 +#define BIT_MASK_OFDM_FA_RST1 BIT(27) +#define BIT_MASK_OFDM_FA_KEEP1 BIT(31) +#define REG_CTX 0x0d03 +#define BIT_MASK_CTX_TYPE GENMASK(6, 4) +#define REG_OFDM1_CFOTRK 0x0d2c +#define BIT_EN_CFOTRK BIT(28) +#define REG_OFDM1_CSI1 0x0d40 +#define REG_OFDM1_CSI2 0x0d44 +#define REG_OFDM1_CSI3 0x0d48 +#define REG_OFDM1_CSI4 0x0d4c +#define REG_OFDM_FA_TYPE2_11N 0x0da0 +#define BIT_MASK_OFDM_CCA_CNT GENMASK(15, 0) +#define BIT_MASK_OFDM_PF_CNT GENMASK(31, 16) +#define REG_OFDM_FA_TYPE3_11N 0x0da4 +#define BIT_MASK_OFDM_RI_CNT GENMASK(15, 0) +#define BIT_MASK_OFDM_CRC_CNT GENMASK(31, 16) +#define REG_OFDM_FA_TYPE4_11N 0x0da8 +#define BIT_MASK_OFDM_MNS_CNT GENMASK(15, 0) +#define REG_FPGA0_IQK_11N 0x0e28 +#define BIT_MASK_IQK_MOD 0xffffff00 +#define EN_IQK 0x808000 +#define RST_IQK 0x000000 +#define REG_TXIQK_TONE_A_11N 0x0e30 +#define REG_RXIQK_TONE_A_11N 0x0e34 +#define REG_TXIQK_PI_A_11N 0x0e38 +#define REG_RXIQK_PI_A_11N 0x0e3c +#define REG_TXIQK_11N 0x0e40 +#define BIT_SET_TXIQK_11N(x, y) (0x80007C00 | ((x) << 16) | (y)) +#define REG_RXIQK_11N 0x0e44 +#define REG_IQK_AGC_PTS_11N 0x0e48 +#define REG_IQK_AGC_RSP_11N 0x0e4c +#define REG_TX_IQK_TONE_B 0x0e50 +#define REG_RX_IQK_TONE_B 0x0e54 +#define REG_IQK_RES_TX 0x0e94 +#define BIT_MASK_RES_TX GENMASK(25, 16) +#define REG_IQK_RES_TY 0x0e9c +#define BIT_MASK_RES_TY GENMASK(25, 16) +#define REG_IQK_RES_RX 0x0ea4 +#define BIT_MASK_RES_RX GENMASK(25, 16) +#define REG_IQK_RES_RY 0x0eac +#define BIT_IQK_TX_FAIL BIT(28) +#define BIT_IQK_RX_FAIL BIT(27) +#define BIT_IQK_DONE BIT(26) +#define BIT_MASK_RES_RY GENMASK(25, 16) +#define REG_PAGE_F_RST_11N 0x0f14 +#define BIT_MASK_F_RST_ALL BIT(16) +#define REG_IGI_C_11N 0x0f84 +#define REG_IGI_D_11N 0x0f88 +#define REG_HT_CRC32_CNT_11N 0x0f90 +#define BIT_MASK_HT_CRC_OK GENMASK(15, 0) +#define BIT_MASK_HT_CRC_ERR GENMASK(31, 16) +#define REG_OFDM_CRC32_CNT_11N 0x0f94 +#define BIT_MASK_OFDM_LCRC_OK GENMASK(15, 0) +#define BIT_MASK_OFDM_LCRC_ERR GENMASK(31, 16) +#define REG_HT_CRC32_CNT_11N_AGG 0x0fb8 + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d_table.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d_table.c new file mode 100644 index 0000000000000000000000000000000000000000..27a22b392df005ae1ec0fd5d1f7c645ed60da041 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d_table.c @@ -0,0 +1,1196 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "phy.h" +#include "rtw8723d_table.h" + +static const u32 rtw8723d_mac[] = { + 0x020, 0x00000013, + 0x02F, 0x00000010, + 0x077, 0x00000007, + 0x421, 0x0000000F, + 0x428, 0x0000000A, + 0x429, 0x00000010, + 0x430, 0x00000000, + 0x431, 0x00000000, + 0x432, 0x00000000, + 0x433, 0x00000001, + 0x434, 0x00000002, + 0x435, 0x00000003, + 0x436, 0x00000005, + 0x437, 0x00000007, + 0x438, 0x00000000, + 0x439, 0x00000000, + 0x43A, 0x00000000, + 0x43B, 0x00000001, + 0x43C, 0x00000002, + 0x43D, 0x00000003, + 0x43E, 0x00000005, + 0x43F, 0x00000007, + 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, +}; + +RTW_DECL_TABLE_PHY_COND(rtw8723d_mac, rtw_phy_cfg_mac); + +static const u32 rtw8723d_agc[] = { + 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, +}; + +RTW_DECL_TABLE_PHY_COND(rtw8723d_agc, rtw_phy_cfg_agc); + +static const u32 rtw8723d_bb[] = { + 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, 0x00D046C8, + 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, 0x21F60000, + 0xC88, 0x40000100, + 0xC8C, 0x20200000, + 0xC90, 0x00091521, + 0xC94, 0x00000000, + 0xC98, 0x00121820, + 0xC9C, 0x00007F7F, + 0xCA0, 0x00012000, + 0xCA4, 0x800000A0, + 0xCA8, 0x84E6C606, + 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, 0x40608000, + 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, +}; + +RTW_DECL_TABLE_PHY_COND(rtw8723d_bb, rtw_phy_cfg_bb); + +static const struct rtw_phy_pg_cfg_pair rtw8723d_bb_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, }, +}; + +RTW_DECL_TABLE_BB_PG(rtw8723d_bb_pg); + +static const u32 rtw8723d_rf_a[] = { + 0x050, 0x0001C000, + 0x049, 0x0004AA00, + 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, 0x000018CA, + 0x030, 0x000028CA, + 0x030, 0x000038CA, + 0x0EF, 0x00000000, + 0x0EE, 0x00000400, + 0x030, 0x000008CA, + 0x030, 0x000018CA, + 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, + 0x83000100, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x0000E024, + 0xA0000000, 0x00000000, + 0x030, 0x0000E000, + 0xB0000000, 0x00000000, + 0x030, 0x0001C000, + 0x030, 0x0001E000, + 0x0EE, 0x00000000, + 0x0EE, 0x00020000, + 0x0EF, 0x00020000, + 0x030, 0x00000F75, + 0x030, 0x00002F55, + 0x030, 0x00003F75, + 0x0EE, 0x00000000, + 0x0EF, 0x00000000, + 0x018, 0x00008401, + 0xFFE, 0x00000000, +}; + +RTW_DECL_TABLE_RF_RADIO(rtw8723d_rf_a, A); + +static const struct rtw_txpwr_lmt_cfg_pair rtw8723d_txpwr_lmt[] = { + {0, 0, 0, 0, 1, 30, }, + {2, 0, 0, 0, 1, 30, }, + {1, 0, 0, 0, 1, 30, }, + {0, 0, 0, 0, 2, 30, }, + {2, 0, 0, 0, 2, 30, }, + {1, 0, 0, 0, 2, 30, }, + {0, 0, 0, 0, 3, 30, }, + {2, 0, 0, 0, 3, 30, }, + {1, 0, 0, 0, 3, 30, }, + {0, 0, 0, 0, 4, 30, }, + {2, 0, 0, 0, 4, 30, }, + {1, 0, 0, 0, 4, 30, }, + {0, 0, 0, 0, 5, 30, }, + {2, 0, 0, 0, 5, 30, }, + {1, 0, 0, 0, 5, 30, }, + {0, 0, 0, 0, 6, 30, }, + {2, 0, 0, 0, 6, 30, }, + {1, 0, 0, 0, 6, 30, }, + {0, 0, 0, 0, 7, 30, }, + {2, 0, 0, 0, 7, 30, }, + {1, 0, 0, 0, 7, 30, }, + {0, 0, 0, 0, 8, 30, }, + {2, 0, 0, 0, 8, 30, }, + {1, 0, 0, 0, 8, 30, }, + {0, 0, 0, 0, 9, 30, }, + {2, 0, 0, 0, 9, 30, }, + {1, 0, 0, 0, 9, 30, }, + {0, 0, 0, 0, 10, 30, }, + {2, 0, 0, 0, 10, 30, }, + {1, 0, 0, 0, 10, 30, }, + {0, 0, 0, 0, 11, 30, }, + {2, 0, 0, 0, 11, 30, }, + {1, 0, 0, 0, 11, 30, }, + {0, 0, 0, 0, 12, 30, }, + {2, 0, 0, 0, 12, 30, }, + {1, 0, 0, 0, 12, 30, }, + {0, 0, 0, 0, 13, 17, }, + {2, 0, 0, 0, 13, 30, }, + {1, 0, 0, 0, 13, 30, }, + {0, 0, 0, 0, 14, 63, }, + {2, 0, 0, 0, 14, 63, }, + {1, 0, 0, 0, 14, 30, }, + {0, 0, 0, 1, 1, 26, }, + {2, 0, 0, 1, 1, 31, }, + {1, 0, 0, 1, 1, 31, }, + {0, 0, 0, 1, 2, 28, }, + {2, 0, 0, 1, 2, 31, }, + {1, 0, 0, 1, 2, 31, }, + {0, 0, 0, 1, 3, 30, }, + {2, 0, 0, 1, 3, 31, }, + {1, 0, 0, 1, 3, 31, }, + {0, 0, 0, 1, 4, 30, }, + {2, 0, 0, 1, 4, 31, }, + {1, 0, 0, 1, 4, 31, }, + {0, 0, 0, 1, 5, 30, }, + {2, 0, 0, 1, 5, 31, }, + {1, 0, 0, 1, 5, 31, }, + {0, 0, 0, 1, 6, 30, }, + {2, 0, 0, 1, 6, 31, }, + {1, 0, 0, 1, 6, 31, }, + {0, 0, 0, 1, 7, 30, }, + {2, 0, 0, 1, 7, 31, }, + {1, 0, 0, 1, 7, 31, }, + {0, 0, 0, 1, 8, 30, }, + {2, 0, 0, 1, 8, 31, }, + {1, 0, 0, 1, 8, 31, }, + {0, 0, 0, 1, 9, 30, }, + {2, 0, 0, 1, 9, 31, }, + {1, 0, 0, 1, 9, 31, }, + {0, 0, 0, 1, 10, 28, }, + {2, 0, 0, 1, 10, 31, }, + {1, 0, 0, 1, 10, 31, }, + {0, 0, 0, 1, 11, 26, }, + {2, 0, 0, 1, 11, 31, }, + {1, 0, 0, 1, 11, 31, }, + {0, 0, 0, 1, 12, 24, }, + {2, 0, 0, 1, 12, 31, }, + {1, 0, 0, 1, 12, 31, }, + {0, 0, 0, 1, 13, 14, }, + {2, 0, 0, 1, 13, 31, }, + {1, 0, 0, 1, 13, 31, }, + {0, 0, 0, 1, 14, 63, }, + {2, 0, 0, 1, 14, 63, }, + {1, 0, 0, 1, 14, 63, }, + {0, 0, 0, 2, 1, 24, }, + {2, 0, 0, 2, 1, 31, }, + {1, 0, 0, 2, 1, 31, }, + {0, 0, 0, 2, 2, 26, }, + {2, 0, 0, 2, 2, 31, }, + {1, 0, 0, 2, 2, 31, }, + {0, 0, 0, 2, 3, 30, }, + {2, 0, 0, 2, 3, 31, }, + {1, 0, 0, 2, 3, 31, }, + {0, 0, 0, 2, 4, 30, }, + {2, 0, 0, 2, 4, 31, }, + {1, 0, 0, 2, 4, 31, }, + {0, 0, 0, 2, 5, 30, }, + {2, 0, 0, 2, 5, 31, }, + {1, 0, 0, 2, 5, 31, }, + {0, 0, 0, 2, 6, 30, }, + {2, 0, 0, 2, 6, 31, }, + {1, 0, 0, 2, 6, 31, }, + {0, 0, 0, 2, 7, 30, }, + {2, 0, 0, 2, 7, 31, }, + {1, 0, 0, 2, 7, 31, }, + {0, 0, 0, 2, 8, 30, }, + {2, 0, 0, 2, 8, 31, }, + {1, 0, 0, 2, 8, 31, }, + {0, 0, 0, 2, 9, 30, }, + {2, 0, 0, 2, 9, 31, }, + {1, 0, 0, 2, 9, 31, }, + {0, 0, 0, 2, 10, 26, }, + {2, 0, 0, 2, 10, 31, }, + {1, 0, 0, 2, 10, 31, }, + {0, 0, 0, 2, 11, 24, }, + {2, 0, 0, 2, 11, 31, }, + {1, 0, 0, 2, 11, 31, }, + {0, 0, 0, 2, 12, 23, }, + {2, 0, 0, 2, 12, 31, }, + {1, 0, 0, 2, 12, 31, }, + {0, 0, 0, 2, 13, 13, }, + {2, 0, 0, 2, 13, 31, }, + {1, 0, 0, 2, 13, 31, }, + {0, 0, 0, 2, 14, 63, }, + {2, 0, 0, 2, 14, 63, }, + {1, 0, 0, 2, 14, 63, }, + {0, 0, 0, 3, 1, 28, }, + {2, 0, 0, 3, 1, 30, }, + {1, 0, 0, 3, 1, 30, }, + {0, 0, 0, 3, 2, 28, }, + {2, 0, 0, 3, 2, 30, }, + {1, 0, 0, 3, 2, 30, }, + {0, 0, 0, 3, 3, 30, }, + {2, 0, 0, 3, 3, 30, }, + {1, 0, 0, 3, 3, 30, }, + {0, 0, 0, 3, 4, 30, }, + {2, 0, 0, 3, 4, 30, }, + {1, 0, 0, 3, 4, 30, }, + {0, 0, 0, 3, 5, 30, }, + {2, 0, 0, 3, 5, 30, }, + {1, 0, 0, 3, 5, 30, }, + {0, 0, 0, 3, 6, 30, }, + {2, 0, 0, 3, 6, 30, }, + {1, 0, 0, 3, 6, 30, }, + {0, 0, 0, 3, 7, 30, }, + {2, 0, 0, 3, 7, 30, }, + {1, 0, 0, 3, 7, 30, }, + {0, 0, 0, 3, 8, 30, }, + {2, 0, 0, 3, 8, 30, }, + {1, 0, 0, 3, 8, 30, }, + {0, 0, 0, 3, 9, 28, }, + {2, 0, 0, 3, 9, 30, }, + {1, 0, 0, 3, 9, 30, }, + {0, 0, 0, 3, 10, 28, }, + {2, 0, 0, 3, 10, 30, }, + {1, 0, 0, 3, 10, 30, }, + {0, 0, 0, 3, 11, 28, }, + {2, 0, 0, 3, 11, 30, }, + {1, 0, 0, 3, 11, 30, }, + {0, 0, 0, 3, 12, 63, }, + {2, 0, 0, 3, 12, 30, }, + {1, 0, 0, 3, 12, 30, }, + {0, 0, 0, 3, 13, 63, }, + {2, 0, 0, 3, 13, 30, }, + {1, 0, 0, 3, 13, 30, }, + {0, 0, 0, 3, 14, 63, }, + {2, 0, 0, 3, 14, 63, }, + {1, 0, 0, 3, 14, 63, }, + {0, 0, 1, 2, 1, 63, }, + {2, 0, 1, 2, 1, 63, }, + {1, 0, 1, 2, 1, 63, }, + {0, 0, 1, 2, 2, 63, }, + {2, 0, 1, 2, 2, 63, }, + {1, 0, 1, 2, 2, 63, }, + {0, 0, 1, 2, 3, 24, }, + {2, 0, 1, 2, 3, 30, }, + {1, 0, 1, 2, 3, 30, }, + {0, 0, 1, 2, 4, 24, }, + {2, 0, 1, 2, 4, 30, }, + {1, 0, 1, 2, 4, 30, }, + {0, 0, 1, 2, 5, 24, }, + {2, 0, 1, 2, 5, 30, }, + {1, 0, 1, 2, 5, 30, }, + {0, 0, 1, 2, 6, 24, }, + {2, 0, 1, 2, 6, 30, }, + {1, 0, 1, 2, 6, 30, }, + {0, 0, 1, 2, 7, 24, }, + {2, 0, 1, 2, 7, 30, }, + {1, 0, 1, 2, 7, 30, }, + {0, 0, 1, 2, 8, 24, }, + {2, 0, 1, 2, 8, 30, }, + {1, 0, 1, 2, 8, 30, }, + {0, 0, 1, 2, 9, 24, }, + {2, 0, 1, 2, 9, 30, }, + {1, 0, 1, 2, 9, 30, }, + {0, 0, 1, 2, 10, 22, }, + {2, 0, 1, 2, 10, 30, }, + {1, 0, 1, 2, 10, 30, }, + {0, 0, 1, 2, 11, 20, }, + {2, 0, 1, 2, 11, 30, }, + {1, 0, 1, 2, 11, 30, }, + {0, 0, 1, 2, 12, 63, }, + {2, 0, 1, 2, 12, 30, }, + {1, 0, 1, 2, 12, 30, }, + {0, 0, 1, 2, 13, 63, }, + {2, 0, 1, 2, 13, 30, }, + {1, 0, 1, 2, 13, 30, }, + {0, 0, 1, 2, 14, 63, }, + {2, 0, 1, 2, 14, 63, }, + {1, 0, 1, 2, 14, 63, }, + {0, 0, 1, 3, 1, 63, }, + {2, 0, 1, 3, 1, 63, }, + {1, 0, 1, 3, 1, 63, }, + {0, 0, 1, 3, 2, 63, }, + {2, 0, 1, 3, 2, 63, }, + {1, 0, 1, 3, 2, 63, }, + {0, 0, 1, 3, 3, 26, }, + {2, 0, 1, 3, 3, 26, }, + {1, 0, 1, 3, 3, 26, }, + {0, 0, 1, 3, 4, 26, }, + {2, 0, 1, 3, 4, 26, }, + {1, 0, 1, 3, 4, 26, }, + {0, 0, 1, 3, 5, 26, }, + {2, 0, 1, 3, 5, 26, }, + {1, 0, 1, 3, 5, 26, }, + {0, 0, 1, 3, 6, 26, }, + {2, 0, 1, 3, 6, 26, }, + {1, 0, 1, 3, 6, 26, }, + {0, 0, 1, 3, 7, 26, }, + {2, 0, 1, 3, 7, 26, }, + {1, 0, 1, 3, 7, 26, }, + {0, 0, 1, 3, 8, 26, }, + {2, 0, 1, 3, 8, 26, }, + {1, 0, 1, 3, 8, 26, }, + {0, 0, 1, 3, 9, 26, }, + {2, 0, 1, 3, 9, 26, }, + {1, 0, 1, 3, 9, 26, }, + {0, 0, 1, 3, 10, 26, }, + {2, 0, 1, 3, 10, 26, }, + {1, 0, 1, 3, 10, 26, }, + {0, 0, 1, 3, 11, 26, }, + {2, 0, 1, 3, 11, 26, }, + {1, 0, 1, 3, 11, 26, }, + {0, 0, 1, 3, 12, 63, }, + {2, 0, 1, 3, 12, 26, }, + {1, 0, 1, 3, 12, 26, }, + {0, 0, 1, 3, 13, 63, }, + {2, 0, 1, 3, 13, 26, }, + {1, 0, 1, 3, 13, 26, }, + {0, 0, 1, 3, 14, 63, }, + {2, 0, 1, 3, 14, 63, }, + {1, 0, 1, 3, 14, 63, }, +}; + +RTW_DECL_TABLE_TXPWR_LMT(rtw8723d_txpwr_lmt); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d_table.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d_table.h new file mode 100644 index 0000000000000000000000000000000000000000..4db996a1d982c8b03ea4f53a8a68a7c25c760bed --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723d_table.h @@ -0,0 +1,15 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW8723D_TABLE_H__ +#define __RTW8723D_TABLE_H__ + +extern const struct rtw_table rtw8723d_mac_tbl; +extern const struct rtw_table rtw8723d_agc_tbl; +extern const struct rtw_table rtw8723d_bb_tbl; +extern const struct rtw_table rtw8723d_bb_pg_tbl; +extern const struct rtw_table rtw8723d_rf_a_tbl; +extern const struct rtw_table rtw8723d_txpwr_lmt_tbl; + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723de.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723de.c new file mode 100644 index 0000000000000000000000000000000000000000..abbaafa32851332da1f1308cfbe8f03d5b39608e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723de.c @@ -0,0 +1,31 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include "pci.h" +#include "rtw8723d.h" + +static const struct pci_device_id rtw_8723de_id_table[] = { + { + PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0xD723), + .driver_data = (kernel_ulong_t)&rtw8723d_hw_spec + }, + {} +}; +MODULE_DEVICE_TABLE(pci, rtw_8723de_id_table); + +static struct pci_driver rtw_8723de_driver = { + .name = "rtw_8723de", + .id_table = rtw_8723de_id_table, + .probe = rtw_pci_probe, + .remove = rtw_pci_remove, + .driver.pm = &rtw_pm_ops, + .shutdown = rtw_pci_shutdown, +}; +module_pci_driver(rtw_8723de_driver); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11n wireless 8723de driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723de.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723de.h new file mode 100644 index 0000000000000000000000000000000000000000..ba3842360c20aa3d27f700aa78bcf8091cb4122c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723de.h @@ -0,0 +1,14 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_8723DE_H_ +#define __RTW_8723DE_H_ + +extern const struct dev_pm_ops rtw_pm_ops; +extern struct rtw_chip_info rtw8723d_hw_spec; +int rtw_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id); +void rtw_pci_remove(struct pci_dev *pdev); +void rtw_pci_shutdown(struct pci_dev *pdev); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723ds.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723ds.c new file mode 100644 index 0000000000000000000000000000000000000000..f1ffffe42c8e4358d4aa97f010b341cb8689f81f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723ds.c @@ -0,0 +1,41 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) Martin Blumenstingl + */ + +#include +#include "sdio_ids.h" +#include +#include "main.h" +#include "rtw8723d.h" +#include "sdio.h" + +static const struct sdio_device_id rtw_8723ds_id_table[] = { + { + SDIO_DEVICE(SDIO_VENDOR_ID_REALTEK, + SDIO_DEVICE_ID_REALTEK_RTW8723DS_1ANT), + .driver_data = (kernel_ulong_t)&rtw8723d_hw_spec, + }, + { + SDIO_DEVICE(SDIO_VENDOR_ID_REALTEK, + SDIO_DEVICE_ID_REALTEK_RTW8723DS_2ANT), + .driver_data = (kernel_ulong_t)&rtw8723d_hw_spec, + }, + {} +}; +MODULE_DEVICE_TABLE(sdio, rtw_8723ds_id_table); + +static struct sdio_driver rtw_8723ds_driver = { + .name = "rtw_8723ds", + .probe = rtw_sdio_probe, + .remove = rtw_sdio_remove, + .id_table = rtw_8723ds_id_table, + .drv = { + .pm = &rtw_sdio_pm_ops, + .shutdown = rtw_sdio_shutdown, + } +}; +module_sdio_driver(rtw_8723ds_driver); + +MODULE_AUTHOR("Martin Blumenstingl "); +MODULE_DESCRIPTION("Realtek 802.11n wireless 8723ds driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723du.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723du.c new file mode 100644 index 0000000000000000000000000000000000000000..322a805da76b08a436b404a1cf9cbbc900f9f1c3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8723du.c @@ -0,0 +1,36 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include "main.h" +#include "rtw8723d.h" +#include "usb.h" + +static const struct usb_device_id rtw_8723du_id_table[] = { + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xd723, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8723d_hw_spec) }, /* 8723DU 1*1 */ + { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xd611, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8723d_hw_spec) }, /* Edimax EW-7611ULB V2 */ + { }, +}; +MODULE_DEVICE_TABLE(usb, rtw_8723du_id_table); + +static int rtw8723du_probe(struct usb_interface *intf, + const struct usb_device_id *id) +{ + return rtw_usb_probe(intf, id); +} + +static struct usb_driver rtw_8723du_driver = { + .name = "rtw_8723du", + .id_table = rtw_8723du_id_table, + .probe = rtw8723du_probe, + .disconnect = rtw_usb_disconnect, +}; +module_usb_driver(rtw_8723du_driver); + +MODULE_AUTHOR("Hans Ulli Kroll "); +MODULE_DESCRIPTION("Realtek 802.11n wireless 8723du driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c.c new file mode 100644 index 0000000000000000000000000000000000000000..adf224618a2a6f3cae2d8dffc8bce5c7a98b407d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c.c @@ -0,0 +1,2009 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "coex.h" +#include "fw.h" +#include "tx.h" +#include "rx.h" +#include "phy.h" +#include "rtw8821c.h" +#include "rtw8821c_table.h" +#include "mac.h" +#include "reg.h" +#include "debug.h" +#include "bf.h" +#include "regd.h" + +static const s8 lna_gain_table_0[8] = {22, 8, -6, -22, -31, -40, -46, -52}; +static const s8 lna_gain_table_1[16] = {10, 6, 2, -2, -6, -10, -14, -17, + -20, -24, -28, -31, -34, -37, -40, -44}; + +static void rtw8821ce_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8821c_efuse *map) +{ + ether_addr_copy(efuse->addr, map->e.mac_addr); +} + +static void rtw8821cu_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8821c_efuse *map) +{ + ether_addr_copy(efuse->addr, map->u.mac_addr); +} + +static void rtw8821cs_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8821c_efuse *map) +{ + ether_addr_copy(efuse->addr, map->s.mac_addr); +} + +enum rtw8821ce_rf_set { + SWITCH_TO_BTG, + SWITCH_TO_WLG, + SWITCH_TO_WLA, + SWITCH_TO_BT, +}; + +static int rtw8821c_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) +{ + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw8821c_efuse *map; + int i; + + map = (struct rtw8821c_efuse *)log_map; + + efuse->rfe_option = map->rfe_option & 0x1f; + efuse->rf_board_option = map->rf_board_option; + efuse->crystal_cap = map->xtal_k; + efuse->pa_type_2g = map->pa_type; + efuse->pa_type_5g = map->pa_type; + efuse->lna_type_2g = map->lna_type_2g[0]; + efuse->lna_type_5g = map->lna_type_5g[0]; + efuse->channel_plan = map->channel_plan; + efuse->country_code[0] = map->country_code[0]; + efuse->country_code[1] = map->country_code[1]; + efuse->bt_setting = map->rf_bt_setting; + efuse->regd = map->rf_board_option & 0x7; + efuse->thermal_meter[0] = map->thermal_meter; + efuse->thermal_meter_k = map->thermal_meter; + efuse->tx_bb_swing_setting_2g = map->tx_bb_swing_setting_2g; + efuse->tx_bb_swing_setting_5g = map->tx_bb_swing_setting_5g; + + hal->pkg_type = map->rfe_option & BIT(5) ? 1 : 0; + + switch (efuse->rfe_option) { + case 0x2: + case 0x4: + case 0x7: + case 0xa: + case 0xc: + case 0xf: + hal->rfe_btg = true; + break; + } + + for (i = 0; i < 4; i++) + efuse->txpwr_idx_table[i] = map->txpwr_idx_table[i]; + + if (rtwdev->efuse.rfe_option == 2 || rtwdev->efuse.rfe_option == 4) + efuse->txpwr_idx_table[0].pwr_idx_2g = map->txpwr_idx_table[1].pwr_idx_2g; + + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_PCIE: + rtw8821ce_efuse_parsing(efuse, map); + break; + case RTW_HCI_TYPE_USB: + rtw8821cu_efuse_parsing(efuse, map); + break; + case RTW_HCI_TYPE_SDIO: + rtw8821cs_efuse_parsing(efuse, map); + break; + default: + /* unsupported now */ + return -ENOTSUPP; + } + + return 0; +} + +static const u32 rtw8821c_txscale_tbl[] = { + 0x081, 0x088, 0x090, 0x099, 0x0a2, 0x0ac, 0x0b6, 0x0c0, 0x0cc, 0x0d8, + 0x0e5, 0x0f2, 0x101, 0x110, 0x120, 0x131, 0x143, 0x156, 0x16a, 0x180, + 0x197, 0x1af, 0x1c8, 0x1e3, 0x200, 0x21e, 0x23e, 0x261, 0x285, 0x2ab, + 0x2d3, 0x2fe, 0x32b, 0x35c, 0x38e, 0x3c4, 0x3fe +}; + +static u8 rtw8821c_get_swing_index(struct rtw_dev *rtwdev) +{ + u8 i = 0; + u32 swing, table_value; + + swing = rtw_read32_mask(rtwdev, REG_TXSCALE_A, 0xffe00000); + for (i = 0; i < ARRAY_SIZE(rtw8821c_txscale_tbl); i++) { + table_value = rtw8821c_txscale_tbl[i]; + if (swing == table_value) + break; + } + + return i; +} + +static void rtw8821c_pwrtrack_init(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 swing_idx = rtw8821c_get_swing_index(rtwdev); + + if (swing_idx >= ARRAY_SIZE(rtw8821c_txscale_tbl)) + dm_info->default_ofdm_index = 24; + else + dm_info->default_ofdm_index = swing_idx; + + ewma_thermal_init(&dm_info->avg_thermal[RF_PATH_A]); + dm_info->delta_power_index[RF_PATH_A] = 0; + dm_info->delta_power_index_last[RF_PATH_A] = 0; + dm_info->pwr_trk_triggered = false; + dm_info->pwr_trk_init_trigger = true; + dm_info->thermal_meter_k = rtwdev->efuse.thermal_meter_k; +} + +static void rtw8821c_phy_bf_init(struct rtw_dev *rtwdev) +{ + rtw_bf_phy_init(rtwdev); + /* Grouping bitmap parameters */ + rtw_write32(rtwdev, 0x1C94, 0xAFFFAFFF); +} + +static void rtw8821c_phy_set_param(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 crystal_cap, val; + + /* power on BB/RF domain */ + val = rtw_read8(rtwdev, REG_SYS_FUNC_EN); + val |= BIT_FEN_PCIEA; + rtw_write8(rtwdev, REG_SYS_FUNC_EN, val); + + /* toggle BB reset */ + val |= BIT_FEN_BB_RSTB | BIT_FEN_BB_GLB_RST; + rtw_write8(rtwdev, REG_SYS_FUNC_EN, val); + val &= ~(BIT_FEN_BB_RSTB | BIT_FEN_BB_GLB_RST); + rtw_write8(rtwdev, REG_SYS_FUNC_EN, val); + val |= BIT_FEN_BB_RSTB | BIT_FEN_BB_GLB_RST; + rtw_write8(rtwdev, REG_SYS_FUNC_EN, val); + + rtw_write8(rtwdev, REG_RF_CTRL, + BIT_RF_EN | BIT_RF_RSTB | BIT_RF_SDM_RSTB); + usleep_range(10, 11); + rtw_write8(rtwdev, REG_WLRF1 + 3, + BIT_RF_EN | BIT_RF_RSTB | BIT_RF_SDM_RSTB); + usleep_range(10, 11); + + /* pre init before header files config */ + rtw_write32_clr(rtwdev, REG_RXPSEL, BIT_RX_PSEL_RST); + + rtw_phy_load_tables(rtwdev); + + crystal_cap = rtwdev->efuse.crystal_cap & 0x3F; + rtw_write32_mask(rtwdev, REG_AFE_XTAL_CTRL, 0x7e000000, crystal_cap); + rtw_write32_mask(rtwdev, REG_AFE_PLL_CTRL, 0x7e, crystal_cap); + rtw_write32_mask(rtwdev, REG_CCK0_FAREPORT, BIT(18) | BIT(22), 0); + + /* post init after header files config */ + rtw_write32_set(rtwdev, REG_RXPSEL, BIT_RX_PSEL_RST); + hal->ch_param[0] = rtw_read32_mask(rtwdev, REG_TXSF2, MASKDWORD); + hal->ch_param[1] = rtw_read32_mask(rtwdev, REG_TXSF6, MASKDWORD); + hal->ch_param[2] = rtw_read32_mask(rtwdev, REG_TXFILTER, MASKDWORD); + + rtw_phy_init(rtwdev); + rtwdev->dm_info.cck_pd_default = rtw_read8(rtwdev, REG_CSRATIO) & 0x1f; + + rtw8821c_pwrtrack_init(rtwdev); + + rtw8821c_phy_bf_init(rtwdev); +} + +static int rtw8821c_mac_init(struct rtw_dev *rtwdev) +{ + u32 value32; + u16 pre_txcnt; + + /* protocol configuration */ + rtw_write8(rtwdev, REG_AMPDU_MAX_TIME_V1, WLAN_AMPDU_MAX_TIME); + rtw_write8_set(rtwdev, REG_TX_HANG_CTRL, BIT_EN_EOF_V1); + pre_txcnt = WLAN_PRE_TXCNT_TIME_TH | BIT_EN_PRECNT; + rtw_write8(rtwdev, REG_PRECNT_CTRL, (u8)(pre_txcnt & 0xFF)); + rtw_write8(rtwdev, REG_PRECNT_CTRL + 1, (u8)(pre_txcnt >> 8)); + value32 = WLAN_RTS_LEN_TH | (WLAN_RTS_TX_TIME_TH << 8) | + (WLAN_MAX_AGG_PKT_LIMIT << 16) | + (WLAN_RTS_MAX_AGG_PKT_LIMIT << 24); + rtw_write32(rtwdev, REG_PROT_MODE_CTRL, value32); + rtw_write16(rtwdev, REG_BAR_MODE_CTRL + 2, + WLAN_BAR_RETRY_LIMIT | WLAN_RA_TRY_RATE_AGG_LIMIT << 8); + rtw_write8(rtwdev, REG_FAST_EDCA_VOVI_SETTING, FAST_EDCA_VO_TH); + rtw_write8(rtwdev, REG_FAST_EDCA_VOVI_SETTING + 2, FAST_EDCA_VI_TH); + rtw_write8(rtwdev, REG_FAST_EDCA_BEBK_SETTING, FAST_EDCA_BE_TH); + rtw_write8(rtwdev, REG_FAST_EDCA_BEBK_SETTING + 2, FAST_EDCA_BK_TH); + rtw_write8_set(rtwdev, REG_INIRTS_RATE_SEL, BIT(5)); + + /* EDCA configuration */ + rtw_write8_clr(rtwdev, REG_TIMER0_SRC_SEL, BIT_TSFT_SEL_TIMER0); + rtw_write16(rtwdev, REG_TXPAUSE, 0); + rtw_write8(rtwdev, REG_SLOT, WLAN_SLOT_TIME); + rtw_write8(rtwdev, REG_PIFS, WLAN_PIFS_TIME); + rtw_write32(rtwdev, REG_SIFS, WLAN_SIFS_CFG); + rtw_write16(rtwdev, REG_EDCA_VO_PARAM + 2, WLAN_VO_TXOP_LIMIT); + rtw_write16(rtwdev, REG_EDCA_VI_PARAM + 2, WLAN_VI_TXOP_LIMIT); + rtw_write32(rtwdev, REG_RD_NAV_NXT, WLAN_NAV_CFG); + rtw_write16(rtwdev, REG_RXTSF_OFFSET_CCK, WLAN_RX_TSF_CFG); + + /* Set beacon cotnrol - enable TSF and other related functions */ + rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); + + /* Set send beacon related registers */ + rtw_write32(rtwdev, REG_TBTT_PROHIBIT, WLAN_TBTT_TIME); + rtw_write8(rtwdev, REG_DRVERLYINT, WLAN_DRV_EARLY_INT); + rtw_write8(rtwdev, REG_BCNDMATIM, WLAN_BCN_DMA_TIME); + rtw_write8_clr(rtwdev, REG_TX_PTCL_CTRL + 1, BIT_SIFS_BK_EN >> 8); + + /* WMAC configuration */ + rtw_write32(rtwdev, REG_RXFLTMAP0, WLAN_RX_FILTER0); + rtw_write16(rtwdev, REG_RXFLTMAP2, WLAN_RX_FILTER2); + rtw_write32(rtwdev, REG_RCR, WLAN_RCR_CFG); + rtw_write8(rtwdev, REG_RX_PKT_LIMIT, WLAN_RXPKT_MAX_SZ_512); + rtw_write8(rtwdev, REG_TCR + 2, WLAN_TX_FUNC_CFG2); + rtw_write8(rtwdev, REG_TCR + 1, WLAN_TX_FUNC_CFG1); + rtw_write8(rtwdev, REG_ACKTO_CCK, 0x40); + rtw_write8_set(rtwdev, REG_WMAC_TRXPTCL_CTL_H, BIT(1)); + rtw_write8_set(rtwdev, REG_SND_PTCL_CTRL, + BIT_DIS_CHK_VHTSIGB_CRC); + rtw_write32(rtwdev, REG_WMAC_OPTION_FUNCTION + 8, WLAN_MAC_OPT_FUNC2); + rtw_write8(rtwdev, REG_WMAC_OPTION_FUNCTION + 4, WLAN_MAC_OPT_NORM_FUNC1); + + return 0; +} + +static void rtw8821c_cfg_ldo25(struct rtw_dev *rtwdev, bool enable) +{ + u8 ldo_pwr; + + ldo_pwr = rtw_read8(rtwdev, REG_LDO_EFUSE_CTRL + 3); + ldo_pwr = enable ? ldo_pwr | BIT(7) : ldo_pwr & ~BIT(7); + rtw_write8(rtwdev, REG_LDO_EFUSE_CTRL + 3, ldo_pwr); +} + +static void rtw8821c_switch_rf_set(struct rtw_dev *rtwdev, u8 rf_set) +{ + u32 reg; + + rtw_write32_set(rtwdev, REG_DMEM_CTRL, BIT_WL_RST); + rtw_write32_set(rtwdev, REG_SYS_CTRL, BIT_FEN_EN); + + reg = rtw_read32(rtwdev, REG_RFECTL); + switch (rf_set) { + case SWITCH_TO_BTG: + reg |= B_BTG_SWITCH; + reg &= ~(B_CTRL_SWITCH | B_WL_SWITCH | B_WLG_SWITCH | + B_WLA_SWITCH); + rtw_write32_mask(rtwdev, REG_ENRXCCA, MASKBYTE2, BTG_CCA); + rtw_write32_mask(rtwdev, REG_ENTXCCK, MASKLWORD, BTG_LNA); + break; + case SWITCH_TO_WLG: + reg |= B_WL_SWITCH | B_WLG_SWITCH; + reg &= ~(B_BTG_SWITCH | B_CTRL_SWITCH | B_WLA_SWITCH); + rtw_write32_mask(rtwdev, REG_ENRXCCA, MASKBYTE2, WLG_CCA); + rtw_write32_mask(rtwdev, REG_ENTXCCK, MASKLWORD, WLG_LNA); + break; + case SWITCH_TO_WLA: + reg |= B_WL_SWITCH | B_WLA_SWITCH; + reg &= ~(B_BTG_SWITCH | B_CTRL_SWITCH | B_WLG_SWITCH); + break; + case SWITCH_TO_BT: + default: + break; + } + + rtw_write32(rtwdev, REG_RFECTL, reg); +} + +static void rtw8821c_set_channel_rf(struct rtw_dev *rtwdev, u8 channel, u8 bw) +{ + struct rtw_hal *hal = &rtwdev->hal; + u32 rf_reg18; + + rf_reg18 = rtw_read_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK); + + rf_reg18 &= ~(RF18_BAND_MASK | RF18_CHANNEL_MASK | RF18_RFSI_MASK | + RF18_BW_MASK); + + rf_reg18 |= (channel <= 14 ? RF18_BAND_2G : RF18_BAND_5G); + rf_reg18 |= (channel & RF18_CHANNEL_MASK); + + if (channel >= 100 && channel <= 140) + rf_reg18 |= RF18_RFSI_GE; + else if (channel > 140) + rf_reg18 |= RF18_RFSI_GT; + + switch (bw) { + case RTW_CHANNEL_WIDTH_5: + case RTW_CHANNEL_WIDTH_10: + case RTW_CHANNEL_WIDTH_20: + default: + rf_reg18 |= RF18_BW_20M; + break; + case RTW_CHANNEL_WIDTH_40: + rf_reg18 |= RF18_BW_40M; + break; + case RTW_CHANNEL_WIDTH_80: + rf_reg18 |= RF18_BW_80M; + break; + } + + if (channel <= 14) { + if (hal->rfe_btg) + rtw8821c_switch_rf_set(rtwdev, SWITCH_TO_BTG); + else + rtw8821c_switch_rf_set(rtwdev, SWITCH_TO_WLG); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTDBG, BIT(6), 0x1); + rtw_write_rf(rtwdev, RF_PATH_A, 0x64, 0xf, 0xf); + } else { + rtw8821c_switch_rf_set(rtwdev, SWITCH_TO_WLA); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTDBG, BIT(6), 0x0); + } + + rtw_write_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK, rf_reg18); + + rtw_write_rf(rtwdev, RF_PATH_A, RF_XTALX2, BIT(19), 0); + rtw_write_rf(rtwdev, RF_PATH_A, RF_XTALX2, BIT(19), 1); +} + +static void rtw8821c_set_channel_rxdfir(struct rtw_dev *rtwdev, u8 bw) +{ + if (bw == RTW_CHANNEL_WIDTH_40) { + /* RX DFIR for BW40 */ + rtw_write32_mask(rtwdev, REG_ACBB0, BIT(29) | BIT(28), 0x2); + rtw_write32_mask(rtwdev, REG_ACBBRXFIR, BIT(29) | BIT(28), 0x2); + rtw_write32_mask(rtwdev, REG_TXDFIR, BIT(31), 0x0); + rtw_write32_mask(rtwdev, REG_CHFIR, BIT(31), 0x0); + } else if (bw == RTW_CHANNEL_WIDTH_80) { + /* RX DFIR for BW80 */ + rtw_write32_mask(rtwdev, REG_ACBB0, BIT(29) | BIT(28), 0x2); + rtw_write32_mask(rtwdev, REG_ACBBRXFIR, BIT(29) | BIT(28), 0x1); + rtw_write32_mask(rtwdev, REG_TXDFIR, BIT(31), 0x0); + rtw_write32_mask(rtwdev, REG_CHFIR, BIT(31), 0x1); + } else { + /* RX DFIR for BW20, BW10 and BW5 */ + rtw_write32_mask(rtwdev, REG_ACBB0, BIT(29) | BIT(28), 0x2); + rtw_write32_mask(rtwdev, REG_ACBBRXFIR, BIT(29) | BIT(28), 0x2); + rtw_write32_mask(rtwdev, REG_TXDFIR, BIT(31), 0x1); + rtw_write32_mask(rtwdev, REG_CHFIR, BIT(31), 0x0); + } +} + +static void rtw8821c_set_channel_bb(struct rtw_dev *rtwdev, u8 channel, u8 bw, + u8 primary_ch_idx) +{ + struct rtw_hal *hal = &rtwdev->hal; + u32 val32; + + if (channel <= 14) { + rtw_write32_mask(rtwdev, REG_RXPSEL, BIT(28), 0x1); + rtw_write32_mask(rtwdev, REG_CCK_CHECK, BIT(7), 0x0); + rtw_write32_mask(rtwdev, REG_ENTXCCK, BIT(18), 0x0); + rtw_write32_mask(rtwdev, REG_RXCCAMSK, 0x0000FC00, 15); + + rtw_write32_mask(rtwdev, REG_TXSCALE_A, 0xf00, 0x0); + rtw_write32_mask(rtwdev, REG_CLKTRK, 0x1ffe0000, 0x96a); + if (channel == 14) { + rtw_write32_mask(rtwdev, REG_TXSF2, MASKDWORD, 0x0000b81c); + rtw_write32_mask(rtwdev, REG_TXSF6, MASKLWORD, 0x0000); + rtw_write32_mask(rtwdev, REG_TXFILTER, MASKDWORD, 0x00003667); + } else { + rtw_write32_mask(rtwdev, REG_TXSF2, MASKDWORD, + hal->ch_param[0]); + rtw_write32_mask(rtwdev, REG_TXSF6, MASKLWORD, + hal->ch_param[1] & MASKLWORD); + rtw_write32_mask(rtwdev, REG_TXFILTER, MASKDWORD, + hal->ch_param[2]); + } + } else if (channel > 35) { + rtw_write32_mask(rtwdev, REG_ENTXCCK, BIT(18), 0x1); + rtw_write32_mask(rtwdev, REG_CCK_CHECK, BIT(7), 0x1); + rtw_write32_mask(rtwdev, REG_RXPSEL, BIT(28), 0x0); + rtw_write32_mask(rtwdev, REG_RXCCAMSK, 0x0000FC00, 15); + + if (channel >= 36 && channel <= 64) + rtw_write32_mask(rtwdev, REG_TXSCALE_A, 0xf00, 0x1); + else if (channel >= 100 && channel <= 144) + rtw_write32_mask(rtwdev, REG_TXSCALE_A, 0xf00, 0x2); + else if (channel >= 149) + rtw_write32_mask(rtwdev, REG_TXSCALE_A, 0xf00, 0x3); + + if (channel >= 36 && channel <= 48) + rtw_write32_mask(rtwdev, REG_CLKTRK, 0x1ffe0000, 0x494); + else if (channel >= 52 && channel <= 64) + rtw_write32_mask(rtwdev, REG_CLKTRK, 0x1ffe0000, 0x453); + else if (channel >= 100 && channel <= 116) + rtw_write32_mask(rtwdev, REG_CLKTRK, 0x1ffe0000, 0x452); + else if (channel >= 118 && channel <= 177) + rtw_write32_mask(rtwdev, REG_CLKTRK, 0x1ffe0000, 0x412); + } + + switch (bw) { + case RTW_CHANNEL_WIDTH_20: + default: + val32 = rtw_read32_mask(rtwdev, REG_ADCCLK, MASKDWORD); + val32 &= 0xffcffc00; + val32 |= 0x10010000; + rtw_write32_mask(rtwdev, REG_ADCCLK, MASKDWORD, val32); + + rtw_write32_mask(rtwdev, REG_ADC160, BIT(30), 0x1); + break; + case RTW_CHANNEL_WIDTH_40: + if (primary_ch_idx == 1) + rtw_write32_set(rtwdev, REG_RXSB, BIT(4)); + else + rtw_write32_clr(rtwdev, REG_RXSB, BIT(4)); + + val32 = rtw_read32_mask(rtwdev, REG_ADCCLK, MASKDWORD); + val32 &= 0xff3ff300; + val32 |= 0x20020000 | ((primary_ch_idx & 0xf) << 2) | + RTW_CHANNEL_WIDTH_40; + rtw_write32_mask(rtwdev, REG_ADCCLK, MASKDWORD, val32); + + rtw_write32_mask(rtwdev, REG_ADC160, BIT(30), 0x1); + break; + case RTW_CHANNEL_WIDTH_80: + val32 = rtw_read32_mask(rtwdev, REG_ADCCLK, MASKDWORD); + val32 &= 0xfcffcf00; + val32 |= 0x40040000 | ((primary_ch_idx & 0xf) << 2) | + RTW_CHANNEL_WIDTH_80; + rtw_write32_mask(rtwdev, REG_ADCCLK, MASKDWORD, val32); + + rtw_write32_mask(rtwdev, REG_ADC160, BIT(30), 0x1); + break; + case RTW_CHANNEL_WIDTH_5: + val32 = rtw_read32_mask(rtwdev, REG_ADCCLK, MASKDWORD); + val32 &= 0xefcefc00; + val32 |= 0x200240; + rtw_write32_mask(rtwdev, REG_ADCCLK, MASKDWORD, val32); + + rtw_write32_mask(rtwdev, REG_ADC160, BIT(30), 0x0); + rtw_write32_mask(rtwdev, REG_ADC40, BIT(31), 0x1); + break; + case RTW_CHANNEL_WIDTH_10: + val32 = rtw_read32_mask(rtwdev, REG_ADCCLK, MASKDWORD); + val32 &= 0xefcefc00; + val32 |= 0x300380; + rtw_write32_mask(rtwdev, REG_ADCCLK, MASKDWORD, val32); + + rtw_write32_mask(rtwdev, REG_ADC160, BIT(30), 0x0); + rtw_write32_mask(rtwdev, REG_ADC40, BIT(31), 0x1); + break; + } +} + +static u32 rtw8821c_get_bb_swing(struct rtw_dev *rtwdev, u8 channel) +{ + struct rtw_efuse efuse = rtwdev->efuse; + u8 tx_bb_swing; + u32 swing2setting[4] = {0x200, 0x16a, 0x101, 0x0b6}; + + tx_bb_swing = channel <= 14 ? efuse.tx_bb_swing_setting_2g : + efuse.tx_bb_swing_setting_5g; + if (tx_bb_swing > 9) + tx_bb_swing = 0; + + return swing2setting[(tx_bb_swing / 3)]; +} + +static void rtw8821c_set_channel_bb_swing(struct rtw_dev *rtwdev, u8 channel, + u8 bw, u8 primary_ch_idx) +{ + rtw_write32_mask(rtwdev, REG_TXSCALE_A, GENMASK(31, 21), + rtw8821c_get_bb_swing(rtwdev, channel)); + rtw8821c_pwrtrack_init(rtwdev); +} + +static void rtw8821c_set_channel(struct rtw_dev *rtwdev, u8 channel, u8 bw, + u8 primary_chan_idx) +{ + rtw8821c_set_channel_bb(rtwdev, channel, bw, primary_chan_idx); + rtw8821c_set_channel_bb_swing(rtwdev, channel, bw, primary_chan_idx); + rtw_set_channel_mac(rtwdev, channel, bw, primary_chan_idx); + rtw8821c_set_channel_rf(rtwdev, channel, bw); + rtw8821c_set_channel_rxdfir(rtwdev, bw); +} + +static s8 get_cck_rx_pwr(struct rtw_dev *rtwdev, u8 lna_idx, u8 vga_idx) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + const s8 *lna_gain_table; + int lna_gain_table_size; + s8 rx_pwr_all = 0; + s8 lna_gain = 0; + + if (efuse->rfe_option == 0) { + lna_gain_table = lna_gain_table_0; + lna_gain_table_size = ARRAY_SIZE(lna_gain_table_0); + } else { + lna_gain_table = lna_gain_table_1; + lna_gain_table_size = ARRAY_SIZE(lna_gain_table_1); + } + + if (lna_idx >= lna_gain_table_size) { + rtw_warn(rtwdev, "incorrect lna index (%d)\n", lna_idx); + return -120; + } + + lna_gain = lna_gain_table[lna_idx]; + rx_pwr_all = lna_gain - 2 * vga_idx; + + return rx_pwr_all; +} + +static void query_phy_status_page0(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s8 rx_power; + u8 lna_idx = 0; + u8 vga_idx = 0; + + vga_idx = GET_PHY_STAT_P0_VGA(phy_status); + lna_idx = FIELD_PREP(BIT_LNA_H_MASK, GET_PHY_STAT_P0_LNA_H(phy_status)) | + FIELD_PREP(BIT_LNA_L_MASK, GET_PHY_STAT_P0_LNA_L(phy_status)); + rx_power = get_cck_rx_pwr(rtwdev, lna_idx, vga_idx); + + pkt_stat->rx_power[RF_PATH_A] = rx_power; + pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1); + dm_info->rssi[RF_PATH_A] = pkt_stat->rssi; + pkt_stat->bw = RTW_CHANNEL_WIDTH_20; + pkt_stat->signal_power = rx_power; +} + +static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 rxsc, bw; + s8 min_rx_power = -120; + + if (pkt_stat->rate > DESC_RATE11M && pkt_stat->rate < DESC_RATEMCS0) + rxsc = GET_PHY_STAT_P1_L_RXSC(phy_status); + else + rxsc = GET_PHY_STAT_P1_HT_RXSC(phy_status); + + if (rxsc >= 1 && rxsc <= 8) + bw = RTW_CHANNEL_WIDTH_20; + else if (rxsc >= 9 && rxsc <= 12) + bw = RTW_CHANNEL_WIDTH_40; + else if (rxsc >= 13) + bw = RTW_CHANNEL_WIDTH_80; + else + bw = GET_PHY_STAT_P1_RF_MODE(phy_status); + + pkt_stat->rx_power[RF_PATH_A] = GET_PHY_STAT_P1_PWDB_A(phy_status) - 110; + pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1); + dm_info->rssi[RF_PATH_A] = pkt_stat->rssi; + pkt_stat->bw = bw; + pkt_stat->signal_power = max(pkt_stat->rx_power[RF_PATH_A], + min_rx_power); +} + +static void query_phy_status(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + u8 page; + + page = *phy_status & 0xf; + + switch (page) { + case 0: + query_phy_status_page0(rtwdev, phy_status, pkt_stat); + break; + case 1: + query_phy_status_page1(rtwdev, phy_status, pkt_stat); + break; + default: + rtw_warn(rtwdev, "unused phy status page (%d)\n", page); + return; + } +} + +static void rtw8821c_query_rx_desc(struct rtw_dev *rtwdev, u8 *rx_desc, + struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_rx_status *rx_status) +{ + struct ieee80211_hdr *hdr; + u32 desc_sz = rtwdev->chip->rx_pkt_desc_sz; + u8 *phy_status = NULL; + + memset(pkt_stat, 0, sizeof(*pkt_stat)); + + pkt_stat->phy_status = GET_RX_DESC_PHYST(rx_desc); + pkt_stat->icv_err = GET_RX_DESC_ICV_ERR(rx_desc); + pkt_stat->crc_err = GET_RX_DESC_CRC32(rx_desc); + pkt_stat->decrypted = !GET_RX_DESC_SWDEC(rx_desc) && + GET_RX_DESC_ENC_TYPE(rx_desc) != RX_DESC_ENC_NONE; + pkt_stat->is_c2h = GET_RX_DESC_C2H(rx_desc); + pkt_stat->pkt_len = GET_RX_DESC_PKT_LEN(rx_desc); + pkt_stat->drv_info_sz = GET_RX_DESC_DRV_INFO_SIZE(rx_desc); + pkt_stat->shift = GET_RX_DESC_SHIFT(rx_desc); + pkt_stat->rate = GET_RX_DESC_RX_RATE(rx_desc); + pkt_stat->cam_id = GET_RX_DESC_MACID(rx_desc); + pkt_stat->ppdu_cnt = GET_RX_DESC_PPDU_CNT(rx_desc); + pkt_stat->tsf_low = GET_RX_DESC_TSFL(rx_desc); + + /* drv_info_sz is in unit of 8-bytes */ + pkt_stat->drv_info_sz *= 8; + + /* c2h cmd pkt's rx/phy status is not interested */ + if (pkt_stat->is_c2h) + return; + + hdr = (struct ieee80211_hdr *)(rx_desc + desc_sz + pkt_stat->shift + + pkt_stat->drv_info_sz); + if (pkt_stat->phy_status) { + phy_status = rx_desc + desc_sz + pkt_stat->shift; + query_phy_status(rtwdev, phy_status, pkt_stat); + } + + rtw_rx_fill_rx_status(rtwdev, pkt_stat, hdr, rx_status, phy_status); +} + +static void +rtw8821c_set_tx_power_index_by_rate(struct rtw_dev *rtwdev, u8 path, u8 rs) +{ + struct rtw_hal *hal = &rtwdev->hal; + static const u32 offset_txagc[2] = {0x1d00, 0x1d80}; + static u32 phy_pwr_idx; + u8 rate, rate_idx, pwr_index, shift; + int j; + + for (j = 0; j < rtw_rate_size[rs]; j++) { + rate = rtw_rate_section[rs][j]; + pwr_index = hal->tx_pwr_tbl[path][rate]; + shift = rate & 0x3; + phy_pwr_idx |= ((u32)pwr_index << (shift * 8)); + if (shift == 0x3 || rate == DESC_RATEVHT1SS_MCS9) { + rate_idx = rate & 0xfc; + rtw_write32(rtwdev, offset_txagc[path] + rate_idx, + phy_pwr_idx); + phy_pwr_idx = 0; + } + } +} + +static void rtw8821c_set_tx_power_index(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + int rs, path; + + for (path = 0; path < hal->rf_path_num; path++) { + for (rs = 0; rs < RTW_RATE_SECTION_MAX; rs++) { + if (rs == RTW_RATE_SECTION_HT_2S || + rs == RTW_RATE_SECTION_VHT_2S) + continue; + rtw8821c_set_tx_power_index_by_rate(rtwdev, path, rs); + } + } +} + +static void rtw8821c_false_alarm_statistics(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 cck_enable; + u32 cck_fa_cnt; + u32 ofdm_fa_cnt; + u32 crc32_cnt; + u32 cca32_cnt; + + cck_enable = rtw_read32(rtwdev, REG_RXPSEL) & BIT(28); + cck_fa_cnt = rtw_read16(rtwdev, REG_FA_CCK); + ofdm_fa_cnt = rtw_read16(rtwdev, REG_FA_OFDM); + + dm_info->cck_fa_cnt = cck_fa_cnt; + dm_info->ofdm_fa_cnt = ofdm_fa_cnt; + if (cck_enable) + dm_info->total_fa_cnt += cck_fa_cnt; + dm_info->total_fa_cnt = ofdm_fa_cnt; + + crc32_cnt = rtw_read32(rtwdev, REG_CRC_CCK); + dm_info->cck_ok_cnt = FIELD_GET(GENMASK(15, 0), crc32_cnt); + dm_info->cck_err_cnt = FIELD_GET(GENMASK(31, 16), crc32_cnt); + + crc32_cnt = rtw_read32(rtwdev, REG_CRC_OFDM); + dm_info->ofdm_ok_cnt = FIELD_GET(GENMASK(15, 0), crc32_cnt); + dm_info->ofdm_err_cnt = FIELD_GET(GENMASK(31, 16), crc32_cnt); + + crc32_cnt = rtw_read32(rtwdev, REG_CRC_HT); + dm_info->ht_ok_cnt = FIELD_GET(GENMASK(15, 0), crc32_cnt); + dm_info->ht_err_cnt = FIELD_GET(GENMASK(31, 16), crc32_cnt); + + crc32_cnt = rtw_read32(rtwdev, REG_CRC_VHT); + dm_info->vht_ok_cnt = FIELD_GET(GENMASK(15, 0), crc32_cnt); + dm_info->vht_err_cnt = FIELD_GET(GENMASK(31, 16), crc32_cnt); + + cca32_cnt = rtw_read32(rtwdev, REG_CCA_OFDM); + dm_info->ofdm_cca_cnt = FIELD_GET(GENMASK(31, 16), cca32_cnt); + dm_info->total_cca_cnt = dm_info->ofdm_cca_cnt; + if (cck_enable) { + cca32_cnt = rtw_read32(rtwdev, REG_CCA_CCK); + dm_info->cck_cca_cnt = FIELD_GET(GENMASK(15, 0), cca32_cnt); + dm_info->total_cca_cnt += dm_info->cck_cca_cnt; + } + + rtw_write32_set(rtwdev, REG_FAS, BIT(17)); + rtw_write32_clr(rtwdev, REG_FAS, BIT(17)); + rtw_write32_clr(rtwdev, REG_RXDESC, BIT(15)); + rtw_write32_set(rtwdev, REG_RXDESC, BIT(15)); + rtw_write32_set(rtwdev, REG_CNTRST, BIT(0)); + rtw_write32_clr(rtwdev, REG_CNTRST, BIT(0)); +} + +static void rtw8821c_do_iqk(struct rtw_dev *rtwdev) +{ + static int do_iqk_cnt; + struct rtw_iqk_para para = {.clear = 0, .segment_iqk = 0}; + u32 rf_reg, iqk_fail_mask; + int counter; + bool reload; + + if (rtw_is_assoc(rtwdev)) + para.segment_iqk = 1; + + rtw_fw_do_iqk(rtwdev, ¶); + + for (counter = 0; counter < 300; counter++) { + rf_reg = rtw_read_rf(rtwdev, RF_PATH_A, RF_DTXLOK, RFREG_MASK); + if (rf_reg == 0xabcde) + break; + msleep(20); + } + rtw_write_rf(rtwdev, RF_PATH_A, RF_DTXLOK, RFREG_MASK, 0x0); + + reload = !!rtw_read32_mask(rtwdev, REG_IQKFAILMSK, BIT(16)); + iqk_fail_mask = rtw_read32_mask(rtwdev, REG_IQKFAILMSK, GENMASK(7, 0)); + rtw_dbg(rtwdev, RTW_DBG_PHY, + "iqk counter=%d reload=%d do_iqk_cnt=%d n_iqk_fail(mask)=0x%02x\n", + counter, reload, ++do_iqk_cnt, iqk_fail_mask); +} + +static void rtw8821c_phy_calibration(struct rtw_dev *rtwdev) +{ + rtw8821c_do_iqk(rtwdev); +} + +/* for coex */ +static void rtw8821c_coex_cfg_init(struct rtw_dev *rtwdev) +{ + /* enable TBTT nterrupt */ + rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); + + /* BT report packet sample rate */ + rtw_write8_mask(rtwdev, REG_BT_TDMA_TIME, BIT_MASK_SAMPLE_RATE, 0x5); + + /* enable BT counter statistics */ + rtw_write8(rtwdev, REG_BT_STAT_CTRL, BT_CNT_ENABLE); + + /* enable PTA (3-wire function form BT side) */ + rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_PTA_EN); + rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_PO_BT_PTA_PINS); + + /* enable PTA (tx/rx signal form WiFi side) */ + rtw_write8_set(rtwdev, REG_QUEUE_CTRL, BIT_PTA_WL_TX_EN); + /* wl tx signal to PTA not case EDCCA */ + rtw_write8_clr(rtwdev, REG_QUEUE_CTRL, BIT_PTA_EDCCA_EN); + /* GNT_BT=1 while select both */ + rtw_write16_set(rtwdev, REG_BT_COEX_V2, BIT_GNT_BT_POLARITY); + + /* beacon queue always hi-pri */ + rtw_write8_mask(rtwdev, REG_BT_COEX_TABLE_H + 3, BIT_BCN_QUEUE, + BCN_PRI_EN); +} + +static void rtw8821c_coex_cfg_ant_switch(struct rtw_dev *rtwdev, u8 ctrl_type, + u8 pos_type) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_coex_rfe *coex_rfe = &coex->rfe; + u32 switch_status = FIELD_PREP(CTRL_TYPE_MASK, ctrl_type) | pos_type; + bool polarity_inverse; + u8 regval = 0; + + if (switch_status == coex_dm->cur_switch_status) + return; + + if (coex_rfe->wlg_at_btg) { + ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; + + if (coex_rfe->ant_switch_polarity) + pos_type = COEX_SWITCH_TO_WLA; + else + pos_type = COEX_SWITCH_TO_WLG_BT; + } + + coex_dm->cur_switch_status = switch_status; + + if (coex_rfe->ant_switch_diversity && + ctrl_type == COEX_SWITCH_CTRL_BY_BBSW) + ctrl_type = COEX_SWITCH_CTRL_BY_ANTDIV; + + polarity_inverse = (coex_rfe->ant_switch_polarity == 1); + + switch (ctrl_type) { + default: + case COEX_SWITCH_CTRL_BY_BBSW: + rtw_write32_clr(rtwdev, REG_LED_CFG, BIT_DPDT_SEL_EN); + rtw_write32_set(rtwdev, REG_LED_CFG, BIT_DPDT_WL_SEL); + /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as ctrl pin */ + rtw_write8_mask(rtwdev, REG_RFE_CTRL8, BIT_MASK_RFE_SEL89, + DPDT_CTRL_PIN); + + if (pos_type == COEX_SWITCH_TO_WLG_BT) { + if (coex_rfe->rfe_module_type != 0x4 && + coex_rfe->rfe_module_type != 0x2) + regval = 0x3; + else + regval = (!polarity_inverse ? 0x2 : 0x1); + } else if (pos_type == COEX_SWITCH_TO_WLG) { + regval = (!polarity_inverse ? 0x2 : 0x1); + } else { + regval = (!polarity_inverse ? 0x1 : 0x2); + } + + rtw_write32_mask(rtwdev, REG_RFE_CTRL8, BIT_MASK_R_RFE_SEL_15, + regval); + break; + case COEX_SWITCH_CTRL_BY_PTA: + rtw_write32_clr(rtwdev, REG_LED_CFG, BIT_DPDT_SEL_EN); + rtw_write32_set(rtwdev, REG_LED_CFG, BIT_DPDT_WL_SEL); + /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as ctrl pin */ + rtw_write8_mask(rtwdev, REG_RFE_CTRL8, BIT_MASK_RFE_SEL89, + PTA_CTRL_PIN); + + regval = (!polarity_inverse ? 0x2 : 0x1); + rtw_write32_mask(rtwdev, REG_RFE_CTRL8, BIT_MASK_R_RFE_SEL_15, + regval); + break; + case COEX_SWITCH_CTRL_BY_ANTDIV: + rtw_write32_clr(rtwdev, REG_LED_CFG, BIT_DPDT_SEL_EN); + rtw_write32_set(rtwdev, REG_LED_CFG, BIT_DPDT_WL_SEL); + rtw_write8_mask(rtwdev, REG_RFE_CTRL8, BIT_MASK_RFE_SEL89, + ANTDIC_CTRL_PIN); + break; + case COEX_SWITCH_CTRL_BY_MAC: + rtw_write32_set(rtwdev, REG_LED_CFG, BIT_DPDT_SEL_EN); + + regval = (!polarity_inverse ? 0x0 : 0x1); + rtw_write8_mask(rtwdev, REG_PAD_CTRL1, BIT_SW_DPDT_SEL_DATA, + regval); + break; + case COEX_SWITCH_CTRL_BY_FW: + rtw_write32_clr(rtwdev, REG_LED_CFG, BIT_DPDT_SEL_EN); + rtw_write32_set(rtwdev, REG_LED_CFG, BIT_DPDT_WL_SEL); + break; + case COEX_SWITCH_CTRL_BY_BT: + rtw_write32_clr(rtwdev, REG_LED_CFG, BIT_DPDT_SEL_EN); + rtw_write32_clr(rtwdev, REG_LED_CFG, BIT_DPDT_WL_SEL); + break; + } + + if (ctrl_type == COEX_SWITCH_CTRL_BY_BT) { + rtw_write8_clr(rtwdev, REG_CTRL_TYPE, BIT_CTRL_TYPE1); + rtw_write8_clr(rtwdev, REG_CTRL_TYPE, BIT_CTRL_TYPE2); + } else { + rtw_write8_set(rtwdev, REG_CTRL_TYPE, BIT_CTRL_TYPE1); + rtw_write8_set(rtwdev, REG_CTRL_TYPE, BIT_CTRL_TYPE2); + } +} + +static void rtw8821c_coex_cfg_gnt_fix(struct rtw_dev *rtwdev) +{} + +static void rtw8821c_coex_cfg_gnt_debug(struct rtw_dev *rtwdev) +{ + rtw_write32_clr(rtwdev, REG_PAD_CTRL1, BIT_BTGP_SPI_EN); + rtw_write32_clr(rtwdev, REG_PAD_CTRL1, BIT_BTGP_JTAG_EN); + rtw_write32_clr(rtwdev, REG_GPIO_MUXCFG, BIT_FSPI_EN); + rtw_write32_clr(rtwdev, REG_PAD_CTRL1, BIT_LED1DIS); + rtw_write32_clr(rtwdev, REG_SYS_SDIO_CTRL, BIT_SDIO_INT); + rtw_write32_clr(rtwdev, REG_SYS_SDIO_CTRL, BIT_DBG_GNT_WL_BT); +} + +static void rtw8821c_coex_cfg_rfe_type(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_rfe *coex_rfe = &coex->rfe; + struct rtw_efuse *efuse = &rtwdev->efuse; + + coex_rfe->rfe_module_type = efuse->rfe_option; + coex_rfe->ant_switch_polarity = 0; + coex_rfe->ant_switch_exist = true; + coex_rfe->wlg_at_btg = false; + + switch (coex_rfe->rfe_module_type) { + case 0: + case 8: + case 1: + case 9: /* 1-Ant, Main, WLG */ + default: /* 2-Ant, DPDT, WLG */ + break; + case 2: + case 10: /* 1-Ant, Main, BTG */ + case 7: + case 15: /* 2-Ant, DPDT, BTG */ + coex_rfe->wlg_at_btg = true; + break; + case 3: + case 11: /* 1-Ant, Aux, WLG */ + coex_rfe->ant_switch_polarity = 1; + break; + case 4: + case 12: /* 1-Ant, Aux, BTG */ + coex_rfe->wlg_at_btg = true; + coex_rfe->ant_switch_polarity = 1; + break; + case 5: + case 13: /* 2-Ant, no switch, WLG */ + case 6: + case 14: /* 2-Ant, no antenna switch, WLG */ + coex_rfe->ant_switch_exist = false; + break; + } +} + +static void rtw8821c_coex_cfg_wl_tx_power(struct rtw_dev *rtwdev, u8 wl_pwr) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_efuse *efuse = &rtwdev->efuse; + bool share_ant = efuse->share_ant; + + if (share_ant) + return; + + if (wl_pwr == coex_dm->cur_wl_pwr_lvl) + return; + + coex_dm->cur_wl_pwr_lvl = wl_pwr; +} + +static void rtw8821c_coex_cfg_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain) +{} + +static void +rtw8821c_txagc_swing_offset(struct rtw_dev *rtwdev, u8 pwr_idx_offset, + s8 pwr_idx_offset_lower, + s8 *txagc_idx, u8 *swing_idx) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s8 delta_pwr_idx = dm_info->delta_power_index[RF_PATH_A]; + u8 swing_upper_bound = dm_info->default_ofdm_index + 10; + u8 swing_lower_bound = 0; + u8 max_pwr_idx_offset = 0xf; + s8 agc_index = 0; + u8 swing_index = dm_info->default_ofdm_index; + + pwr_idx_offset = min_t(u8, pwr_idx_offset, max_pwr_idx_offset); + pwr_idx_offset_lower = max_t(s8, pwr_idx_offset_lower, -15); + + if (delta_pwr_idx >= 0) { + if (delta_pwr_idx <= pwr_idx_offset) { + agc_index = delta_pwr_idx; + swing_index = dm_info->default_ofdm_index; + } else if (delta_pwr_idx > pwr_idx_offset) { + agc_index = pwr_idx_offset; + swing_index = dm_info->default_ofdm_index + + delta_pwr_idx - pwr_idx_offset; + swing_index = min_t(u8, swing_index, swing_upper_bound); + } + } else if (delta_pwr_idx < 0) { + if (delta_pwr_idx >= pwr_idx_offset_lower) { + agc_index = delta_pwr_idx; + swing_index = dm_info->default_ofdm_index; + } else if (delta_pwr_idx < pwr_idx_offset_lower) { + if (dm_info->default_ofdm_index > + (pwr_idx_offset_lower - delta_pwr_idx)) + swing_index = dm_info->default_ofdm_index + + delta_pwr_idx - pwr_idx_offset_lower; + else + swing_index = swing_lower_bound; + + agc_index = pwr_idx_offset_lower; + } + } + + if (swing_index >= ARRAY_SIZE(rtw8821c_txscale_tbl)) { + rtw_warn(rtwdev, "swing index overflow\n"); + swing_index = ARRAY_SIZE(rtw8821c_txscale_tbl) - 1; + } + + *txagc_idx = agc_index; + *swing_idx = swing_index; +} + +static void rtw8821c_pwrtrack_set_pwr(struct rtw_dev *rtwdev, u8 pwr_idx_offset, + s8 pwr_idx_offset_lower) +{ + s8 txagc_idx; + u8 swing_idx; + + rtw8821c_txagc_swing_offset(rtwdev, pwr_idx_offset, pwr_idx_offset_lower, + &txagc_idx, &swing_idx); + rtw_write32_mask(rtwdev, REG_TXAGCIDX, GENMASK(6, 1), txagc_idx); + rtw_write32_mask(rtwdev, REG_TXSCALE_A, GENMASK(31, 21), + rtw8821c_txscale_tbl[swing_idx]); +} + +static void rtw8821c_pwrtrack_set(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 pwr_idx_offset, tx_pwr_idx; + s8 pwr_idx_offset_lower; + u8 channel = rtwdev->hal.current_channel; + u8 band_width = rtwdev->hal.current_band_width; + u8 regd = rtw_regd_get(rtwdev); + u8 tx_rate = dm_info->tx_rate; + u8 max_pwr_idx = rtwdev->chip->max_power_index; + + tx_pwr_idx = rtw_phy_get_tx_power_index(rtwdev, RF_PATH_A, tx_rate, + band_width, channel, regd); + + tx_pwr_idx = min_t(u8, tx_pwr_idx, max_pwr_idx); + + pwr_idx_offset = max_pwr_idx - tx_pwr_idx; + pwr_idx_offset_lower = 0 - tx_pwr_idx; + + rtw8821c_pwrtrack_set_pwr(rtwdev, pwr_idx_offset, pwr_idx_offset_lower); +} + +static void rtw8821c_phy_pwrtrack(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_swing_table swing_table; + u8 thermal_value, delta; + + rtw_phy_config_swing_table(rtwdev, &swing_table); + + if (rtwdev->efuse.thermal_meter[0] == 0xff) + return; + + thermal_value = rtw_read_rf(rtwdev, RF_PATH_A, RF_T_METER, 0xfc00); + + rtw_phy_pwrtrack_avg(rtwdev, thermal_value, RF_PATH_A); + + if (dm_info->pwr_trk_init_trigger) + dm_info->pwr_trk_init_trigger = false; + else if (!rtw_phy_pwrtrack_thermal_changed(rtwdev, thermal_value, + RF_PATH_A)) + goto iqk; + + delta = rtw_phy_pwrtrack_get_delta(rtwdev, RF_PATH_A); + + delta = min_t(u8, delta, RTW_PWR_TRK_TBL_SZ - 1); + + dm_info->delta_power_index[RF_PATH_A] = + rtw_phy_pwrtrack_get_pwridx(rtwdev, &swing_table, RF_PATH_A, + RF_PATH_A, delta); + if (dm_info->delta_power_index[RF_PATH_A] == + dm_info->delta_power_index_last[RF_PATH_A]) + goto iqk; + else + dm_info->delta_power_index_last[RF_PATH_A] = + dm_info->delta_power_index[RF_PATH_A]; + rtw8821c_pwrtrack_set(rtwdev); + +iqk: + if (rtw_phy_pwrtrack_need_iqk(rtwdev)) + rtw8821c_do_iqk(rtwdev); +} + +static void rtw8821c_pwr_track(struct rtw_dev *rtwdev) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + if (efuse->power_track_type != 0) + return; + + if (!dm_info->pwr_trk_triggered) { + rtw_write_rf(rtwdev, RF_PATH_A, RF_T_METER, + GENMASK(17, 16), 0x03); + dm_info->pwr_trk_triggered = true; + return; + } + + rtw8821c_phy_pwrtrack(rtwdev); + dm_info->pwr_trk_triggered = false; +} + +static void rtw8821c_bf_config_bfee_su(struct rtw_dev *rtwdev, + struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable) +{ + if (enable) + rtw_bf_enable_bfee_su(rtwdev, vif, bfee); + else + rtw_bf_remove_bfee_su(rtwdev, bfee); +} + +static void rtw8821c_bf_config_bfee_mu(struct rtw_dev *rtwdev, + struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable) +{ + if (enable) + rtw_bf_enable_bfee_mu(rtwdev, vif, bfee); + else + rtw_bf_remove_bfee_mu(rtwdev, bfee); +} + +static void rtw8821c_bf_config_bfee(struct rtw_dev *rtwdev, struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable) +{ + if (bfee->role == RTW_BFEE_SU) + rtw8821c_bf_config_bfee_su(rtwdev, vif, bfee, enable); + else if (bfee->role == RTW_BFEE_MU) + rtw8821c_bf_config_bfee_mu(rtwdev, vif, bfee, enable); + else + rtw_warn(rtwdev, "wrong bfee role\n"); +} + +static void rtw8821c_phy_cck_pd_set(struct rtw_dev *rtwdev, u8 new_lvl) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 pd[CCK_PD_LV_MAX] = {3, 7, 13, 13, 13}; + u8 cck_n_rx; + + rtw_dbg(rtwdev, RTW_DBG_PHY, "lv: (%d) -> (%d)\n", + dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A], new_lvl); + + if (dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A] == new_lvl) + return; + + cck_n_rx = (rtw_read8_mask(rtwdev, REG_CCK0_FAREPORT, BIT_CCK0_2RX) && + rtw_read8_mask(rtwdev, REG_CCK0_FAREPORT, BIT_CCK0_MRC)) ? 2 : 1; + rtw_dbg(rtwdev, RTW_DBG_PHY, + "is_linked=%d, lv=%d, n_rx=%d, cs_ratio=0x%x, pd_th=0x%x, cck_fa_avg=%d\n", + rtw_is_assoc(rtwdev), new_lvl, cck_n_rx, + dm_info->cck_pd_default + new_lvl * 2, + pd[new_lvl], dm_info->cck_fa_avg); + + dm_info->cck_fa_avg = CCK_FA_AVG_RESET; + + dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A] = new_lvl; + rtw_write32_mask(rtwdev, REG_PWRTH, 0x3f0000, pd[new_lvl]); + rtw_write32_mask(rtwdev, REG_PWRTH2, 0x1f0000, + dm_info->cck_pd_default + new_lvl * 2); +} + +static void rtw8821c_fill_txdesc_checksum(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *txdesc) +{ + fill_txdesc_checksum_common(txdesc, 16); +} + +static struct rtw_pwr_seq_cmd trans_carddis_to_cardemu_8821c[] = { + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_POLLING, BIT(1), BIT(1)}, + {0x004A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3) | BIT(4) | BIT(7), 0}, + {0x0300, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x0301, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static struct rtw_pwr_seq_cmd trans_cardemu_to_act_8821c[] = { + {0x0020, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0001, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_DELAY, 1, RTW_PWR_DELAY_MS}, + {0x0000, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3) | BIT(2)), 0}, + {0x0075, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(1), BIT(1)}, + {0x0075, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3)), 0}, + {0x10C3, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(0), 0}, + {0x0020, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3), BIT(3)}, + {0x0074, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), BIT(5)}, + {0x0022, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0062, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(7) | BIT(6) | BIT(5)), + (BIT(7) | BIT(6) | BIT(5))}, + {0x0061, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(7) | BIT(6) | BIT(5)), 0}, + {0x007C, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static struct rtw_pwr_seq_cmd trans_act_to_cardemu_8821c[] = { + {0x0093, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3), 0}, + {0x001F, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x0049, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0002, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x10C3, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), BIT(1)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(1), 0}, + {0x0020, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3), 0}, + {0x0000, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), BIT(5)}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static struct rtw_pwr_seq_cmd trans_cardemu_to_carddis_8821c[] = { + {0x0007, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x20}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), BIT(2)}, + {0x004A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), 0}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(4), 0}, + {0x004F, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0046, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(6), BIT(6)}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), 0}, + {0x0046, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7), BIT(7)}, + {0x0062, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(4), BIT(4)}, + {0x0081, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7) | BIT(6), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3)}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_POLLING, BIT(1), 0}, + {0x0090, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0044, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x0040, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, 0xFF, 0x90}, + {0x0041, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, 0xFF, 0x00}, + {0x0042, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, 0xFF, 0x04}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd *card_enable_flow_8821c[] = { + trans_carddis_to_cardemu_8821c, + trans_cardemu_to_act_8821c, + NULL +}; + +static const struct rtw_pwr_seq_cmd *card_disable_flow_8821c[] = { + trans_act_to_cardemu_8821c, + trans_cardemu_to_carddis_8821c, + NULL +}; + +static const struct rtw_intf_phy_para usb2_param_8821c[] = { + {0xFFFF, 0x00, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para usb3_param_8821c[] = { + {0xFFFF, 0x0000, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para pcie_gen1_param_8821c[] = { + {0x0009, 0x6380, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, + {0xFFFF, 0x0000, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para pcie_gen2_param_8821c[] = { + {0xFFFF, 0x0000, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para_table phy_para_table_8821c = { + .usb2_para = usb2_param_8821c, + .usb3_para = usb3_param_8821c, + .gen1_para = pcie_gen1_param_8821c, + .gen2_para = pcie_gen2_param_8821c, + .n_usb2_para = ARRAY_SIZE(usb2_param_8821c), + .n_usb3_para = ARRAY_SIZE(usb2_param_8821c), + .n_gen1_para = ARRAY_SIZE(pcie_gen1_param_8821c), + .n_gen2_para = ARRAY_SIZE(pcie_gen2_param_8821c), +}; + +static const struct rtw_rfe_def rtw8821c_rfe_defs[] = { + [0] = RTW_DEF_RFE(8821c, 0, 0), + [2] = RTW_DEF_RFE_EXT(8821c, 0, 0, 2), + [4] = RTW_DEF_RFE_EXT(8821c, 0, 0, 2), + [6] = RTW_DEF_RFE(8821c, 0, 0), +}; + +static struct rtw_hw_reg rtw8821c_dig[] = { + [0] = { .addr = 0xc50, .mask = 0x7f }, +}; + +static const struct rtw_ltecoex_addr rtw8821c_ltecoex_addr = { + .ctrl = LTECOEX_ACCESS_CTRL, + .wdata = LTECOEX_WRITE_DATA, + .rdata = LTECOEX_READ_DATA, +}; + +static struct rtw_page_table page_table_8821c[] = { + /* not sure what [0] stands for */ + {16, 16, 16, 14, 1}, + {16, 16, 16, 14, 1}, + {16, 16, 0, 0, 1}, + {16, 16, 16, 0, 1}, + {16, 16, 16, 14, 1}, +}; + +static struct rtw_rqpn rqpn_table_8821c[] = { + /* not sure what [0] stands for */ + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_HIGH, + RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, +}; + +static struct rtw_prioq_addrs prioq_addrs_8821c = { + .prio[RTW_DMA_MAPPING_EXTRA] = { + .rsvd = REG_FIFOPAGE_INFO_4, .avail = REG_FIFOPAGE_INFO_4 + 2, + }, + .prio[RTW_DMA_MAPPING_LOW] = { + .rsvd = REG_FIFOPAGE_INFO_2, .avail = REG_FIFOPAGE_INFO_2 + 2, + }, + .prio[RTW_DMA_MAPPING_NORMAL] = { + .rsvd = REG_FIFOPAGE_INFO_3, .avail = REG_FIFOPAGE_INFO_3 + 2, + }, + .prio[RTW_DMA_MAPPING_HIGH] = { + .rsvd = REG_FIFOPAGE_INFO_1, .avail = REG_FIFOPAGE_INFO_1 + 2, + }, + .wsize = true, +}; + +static struct rtw_chip_ops rtw8821c_ops = { + .phy_set_param = rtw8821c_phy_set_param, + .read_efuse = rtw8821c_read_efuse, + .query_rx_desc = rtw8821c_query_rx_desc, + .set_channel = rtw8821c_set_channel, + .mac_init = rtw8821c_mac_init, + .read_rf = rtw_phy_read_rf, + .write_rf = rtw_phy_write_rf_reg_sipi, + .set_antenna = NULL, + .set_tx_power_index = rtw8821c_set_tx_power_index, + .cfg_ldo25 = rtw8821c_cfg_ldo25, + .false_alarm_statistics = rtw8821c_false_alarm_statistics, + .phy_calibration = rtw8821c_phy_calibration, + .cck_pd_set = rtw8821c_phy_cck_pd_set, + .pwr_track = rtw8821c_pwr_track, + .config_bfee = rtw8821c_bf_config_bfee, + .set_gid_table = rtw_bf_set_gid_table, + .cfg_csi_rate = rtw_bf_cfg_csi_rate, + .fill_txdesc_checksum = rtw8821c_fill_txdesc_checksum, + + .coex_set_init = rtw8821c_coex_cfg_init, + .coex_set_ant_switch = rtw8821c_coex_cfg_ant_switch, + .coex_set_gnt_fix = rtw8821c_coex_cfg_gnt_fix, + .coex_set_gnt_debug = rtw8821c_coex_cfg_gnt_debug, + .coex_set_rfe_type = rtw8821c_coex_cfg_rfe_type, + .coex_set_wl_tx_power = rtw8821c_coex_cfg_wl_tx_power, + .coex_set_wl_rx_gain = rtw8821c_coex_cfg_wl_rx_gain, +}; + +/* rssi in percentage % (dbm = % - 100) */ +static const u8 wl_rssi_step_8821c[] = {101, 45, 101, 40}; +static const u8 bt_rssi_step_8821c[] = {101, 101, 101, 101}; + +/* Shared-Antenna Coex Table */ +static const struct coex_table_para table_sant_8821c[] = { + {0x55555555, 0x55555555}, /* case-0 */ + {0x55555555, 0x55555555}, + {0x66555555, 0x66555555}, + {0xaaaaaaaa, 0xaaaaaaaa}, + {0x5a5a5a5a, 0x5a5a5a5a}, + {0xfafafafa, 0xfafafafa}, /* case-5 */ + {0x6a5a5555, 0xaaaaaaaa}, + {0x6a5a56aa, 0x6a5a56aa}, + {0x6a5a5a5a, 0x6a5a5a5a}, + {0x66555555, 0x5a5a5a5a}, + {0x66555555, 0x6a5a5a5a}, /* case-10 */ + {0x66555555, 0xaaaaaaaa}, + {0x66555555, 0x6a5a5aaa}, + {0x66555555, 0x6aaa6aaa}, + {0x66555555, 0x6a5a5aaa}, + {0x66555555, 0xaaaaaaaa}, /* case-15 */ + {0xffff55ff, 0xfafafafa}, + {0xffff55ff, 0x6afa5afa}, + {0xaaffffaa, 0xfafafafa}, + {0xaa5555aa, 0x5a5a5a5a}, + {0xaa5555aa, 0x6a5a5a5a}, /* case-20 */ + {0xaa5555aa, 0xaaaaaaaa}, + {0xffffffff, 0x55555555}, + {0xffffffff, 0x5a5a5a5a}, + {0xffffffff, 0x5a5a5a5a}, + {0xffffffff, 0x5a5a5aaa}, /* case-25 */ + {0x55555555, 0x5a5a5a5a}, + {0x55555555, 0xaaaaaaaa}, + {0x66555555, 0x6a5a6a5a}, + {0x66556655, 0x66556655}, + {0x66556aaa, 0x6a5a6aaa}, /* case-30 */ + {0xffffffff, 0x5aaa5aaa}, + {0x56555555, 0x5a5a5aaa} +}; + +/* Non-Shared-Antenna Coex Table */ +static const struct coex_table_para table_nsant_8821c[] = { + {0xffffffff, 0xffffffff}, /* case-100 */ + {0xffff55ff, 0xfafafafa}, + {0x66555555, 0x66555555}, + {0xaaaaaaaa, 0xaaaaaaaa}, + {0x5a5a5a5a, 0x5a5a5a5a}, + {0xffffffff, 0xffffffff}, /* case-105 */ + {0x5afa5afa, 0x5afa5afa}, + {0x55555555, 0xfafafafa}, + {0x66555555, 0xfafafafa}, + {0x66555555, 0x5a5a5a5a}, + {0x66555555, 0x6a5a5a5a}, /* case-110 */ + {0x66555555, 0xaaaaaaaa}, + {0xffff55ff, 0xfafafafa}, + {0xffff55ff, 0x5afa5afa}, + {0xffff55ff, 0xaaaaaaaa}, + {0xffff55ff, 0xffff55ff}, /* case-115 */ + {0xaaffffaa, 0x5afa5afa}, + {0xaaffffaa, 0xaaaaaaaa}, + {0xffffffff, 0xfafafafa}, + {0xffff55ff, 0xfafafafa}, + {0xffffffff, 0xaaaaaaaa}, /* case-120 */ + {0xffff55ff, 0x5afa5afa}, + {0xffff55ff, 0x5afa5afa}, + {0x55ff55ff, 0x55ff55ff} +}; + +/* Shared-Antenna TDMA */ +static const struct coex_tdma_para tdma_sant_8821c[] = { + { {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-0 */ + { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-1 */ + { {0x61, 0x3a, 0x03, 0x11, 0x11} }, + { {0x61, 0x35, 0x03, 0x11, 0x11} }, + { {0x61, 0x20, 0x03, 0x11, 0x11} }, + { {0x61, 0x3a, 0x03, 0x11, 0x11} }, /* case-5 */ + { {0x61, 0x45, 0x03, 0x11, 0x10} }, + { {0x61, 0x35, 0x03, 0x11, 0x10} }, + { {0x61, 0x30, 0x03, 0x11, 0x10} }, + { {0x61, 0x20, 0x03, 0x11, 0x10} }, + { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-10 */ + { {0x61, 0x08, 0x03, 0x11, 0x15} }, + { {0x61, 0x08, 0x03, 0x10, 0x14} }, + { {0x51, 0x08, 0x03, 0x10, 0x54} }, + { {0x51, 0x08, 0x03, 0x10, 0x55} }, + { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-15 */ + { {0x51, 0x45, 0x03, 0x10, 0x50} }, + { {0x51, 0x3a, 0x03, 0x11, 0x50} }, + { {0x51, 0x30, 0x03, 0x10, 0x50} }, + { {0x51, 0x21, 0x03, 0x10, 0x50} }, + { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-20 */ + { {0x51, 0x4a, 0x03, 0x10, 0x50} }, + { {0x51, 0x08, 0x03, 0x30, 0x54} }, + { {0x55, 0x08, 0x03, 0x10, 0x54} }, + { {0x65, 0x10, 0x03, 0x11, 0x10} }, + { {0x51, 0x10, 0x03, 0x10, 0x51} }, /* case-25 */ + { {0x51, 0x21, 0x03, 0x10, 0x50} }, + { {0x61, 0x08, 0x03, 0x11, 0x11} } +}; + +/* Non-Shared-Antenna TDMA */ +static const struct coex_tdma_para tdma_nsant_8821c[] = { + { {0x00, 0x00, 0x00, 0x40, 0x00} }, /* case-100 */ + { {0x61, 0x45, 0x03, 0x11, 0x11} }, + { {0x61, 0x25, 0x03, 0x11, 0x11} }, + { {0x61, 0x35, 0x03, 0x11, 0x11} }, + { {0x61, 0x20, 0x03, 0x11, 0x11} }, + { {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-105 */ + { {0x61, 0x45, 0x03, 0x11, 0x10} }, + { {0x61, 0x30, 0x03, 0x11, 0x10} }, + { {0x61, 0x30, 0x03, 0x11, 0x10} }, + { {0x61, 0x20, 0x03, 0x11, 0x10} }, + { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-110 */ + { {0x61, 0x10, 0x03, 0x11, 0x11} }, + { {0x61, 0x08, 0x03, 0x10, 0x14} }, + { {0x51, 0x08, 0x03, 0x10, 0x54} }, + { {0x51, 0x08, 0x03, 0x10, 0x55} }, + { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-115 */ + { {0x51, 0x45, 0x03, 0x10, 0x50} }, + { {0x51, 0x3a, 0x03, 0x10, 0x50} }, + { {0x51, 0x30, 0x03, 0x10, 0x50} }, + { {0x51, 0x21, 0x03, 0x10, 0x50} }, + { {0x51, 0x21, 0x03, 0x10, 0x50} }, /* case-120 */ + { {0x51, 0x10, 0x03, 0x10, 0x50} } +}; + +static const struct coex_5g_afh_map afh_5g_8821c[] = { {0, 0, 0} }; + +/* wl_tx_dec_power, bt_tx_dec_power, wl_rx_gain, bt_rx_lna_constrain */ +static const struct coex_rf_para rf_para_tx_8821c[] = { + {0, 0, false, 7}, /* for normal */ + {0, 20, false, 7}, /* for WL-CPT */ + {8, 17, true, 4}, + {7, 18, true, 4}, + {6, 19, true, 4}, + {5, 20, true, 4} +}; + +static const struct coex_rf_para rf_para_rx_8821c[] = { + {0, 0, false, 7}, /* for normal */ + {0, 20, false, 7}, /* for WL-CPT */ + {3, 24, true, 5}, + {2, 26, true, 5}, + {1, 27, true, 5}, + {0, 28, true, 5} +}; + +static_assert(ARRAY_SIZE(rf_para_tx_8821c) == ARRAY_SIZE(rf_para_rx_8821c)); + +static const u8 rtw8821c_pwrtrk_5gb_n[][RTW_PWR_TRK_TBL_SZ] = { + {0, 1, 1, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 8, 8, 8, 9, 9, 9, 10, 10, + 11, 11, 12, 12, 12, 12, 12}, + {0, 1, 1, 1, 2, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 8, 8, 9, 9, 10, 10, 11, + 11, 12, 12, 12, 12, 12, 12, 12}, + {0, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, + 11, 12, 12, 12, 12, 12, 12}, +}; + +static const u8 rtw8821c_pwrtrk_5gb_p[][RTW_PWR_TRK_TBL_SZ] = { + {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, + 12, 12, 12, 12, 12, 12, 12}, + {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 5, 6, 7, 7, 8, 8, 9, 10, 10, 11, 11, + 12, 12, 12, 12, 12, 12, 12, 12}, + {0, 1, 1, 1, 2, 3, 3, 3, 4, 4, 4, 5, 6, 6, 7, 7, 8, 8, 9, 10, 10, 11, + 11, 12, 12, 12, 12, 12, 12, 12}, +}; + +static const u8 rtw8821c_pwrtrk_5ga_n[][RTW_PWR_TRK_TBL_SZ] = { + {0, 1, 1, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 8, 8, 8, 9, 9, 9, 10, 10, + 11, 11, 12, 12, 12, 12, 12}, + {0, 1, 1, 1, 2, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 8, 8, 9, 9, 10, 10, 11, + 11, 12, 12, 12, 12, 12, 12, 12}, + {0, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, + 11, 12, 12, 12, 12, 12, 12}, +}; + +static const u8 rtw8821c_pwrtrk_5ga_p[][RTW_PWR_TRK_TBL_SZ] = { + {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, + 12, 12, 12, 12, 12, 12, 12}, + {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 5, 6, 7, 7, 8, 8, 9, 10, 10, 11, 11, + 12, 12, 12, 12, 12, 12, 12, 12}, + {0, 1, 1, 1, 2, 3, 3, 3, 4, 4, 4, 5, 6, 6, 7, 7, 8, 8, 9, 10, 10, 11, + 11, 12, 12, 12, 12, 12, 12, 12}, +}; + +static const u8 rtw8821c_pwrtrk_2gb_n[] = { + 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 3, 4, 4, + 4, 4, 5, 5, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9 +}; + +static const u8 rtw8821c_pwrtrk_2gb_p[] = { + 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 4, 4, 5, 5, + 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9 +}; + +static const u8 rtw8821c_pwrtrk_2ga_n[] = { + 0, 0, 0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 3, 4, 4, + 4, 4, 5, 5, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9 +}; + +static const u8 rtw8821c_pwrtrk_2ga_p[] = { + 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 3, 4, 4, 5, 5, + 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9 +}; + +static const u8 rtw8821c_pwrtrk_2g_cck_b_n[] = { + 0, 0, 1, 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3, 4, 4, + 4, 5, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 9 +}; + +static const u8 rtw8821c_pwrtrk_2g_cck_b_p[] = { + 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, + 5, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9, 9, 9 +}; + +static const u8 rtw8821c_pwrtrk_2g_cck_a_n[] = { + 0, 0, 1, 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3, 4, 4, + 4, 5, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 9 +}; + +static const u8 rtw8821c_pwrtrk_2g_cck_a_p[] = { + 0, 1, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, + 5, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 9, 9, 9 +}; + +static const struct rtw_pwr_track_tbl rtw8821c_rtw_pwr_track_tbl = { + .pwrtrk_5gb_n[0] = rtw8821c_pwrtrk_5gb_n[0], + .pwrtrk_5gb_n[1] = rtw8821c_pwrtrk_5gb_n[1], + .pwrtrk_5gb_n[2] = rtw8821c_pwrtrk_5gb_n[2], + .pwrtrk_5gb_p[0] = rtw8821c_pwrtrk_5gb_p[0], + .pwrtrk_5gb_p[1] = rtw8821c_pwrtrk_5gb_p[1], + .pwrtrk_5gb_p[2] = rtw8821c_pwrtrk_5gb_p[2], + .pwrtrk_5ga_n[0] = rtw8821c_pwrtrk_5ga_n[0], + .pwrtrk_5ga_n[1] = rtw8821c_pwrtrk_5ga_n[1], + .pwrtrk_5ga_n[2] = rtw8821c_pwrtrk_5ga_n[2], + .pwrtrk_5ga_p[0] = rtw8821c_pwrtrk_5ga_p[0], + .pwrtrk_5ga_p[1] = rtw8821c_pwrtrk_5ga_p[1], + .pwrtrk_5ga_p[2] = rtw8821c_pwrtrk_5ga_p[2], + .pwrtrk_2gb_n = rtw8821c_pwrtrk_2gb_n, + .pwrtrk_2gb_p = rtw8821c_pwrtrk_2gb_p, + .pwrtrk_2ga_n = rtw8821c_pwrtrk_2ga_n, + .pwrtrk_2ga_p = rtw8821c_pwrtrk_2ga_p, + .pwrtrk_2g_cckb_n = rtw8821c_pwrtrk_2g_cck_b_n, + .pwrtrk_2g_cckb_p = rtw8821c_pwrtrk_2g_cck_b_p, + .pwrtrk_2g_ccka_n = rtw8821c_pwrtrk_2g_cck_a_n, + .pwrtrk_2g_ccka_p = rtw8821c_pwrtrk_2g_cck_a_p, +}; + +static const struct rtw_reg_domain coex_info_hw_regs_8821c[] = { + {0xCB0, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0xCB4, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0xCBA, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x430, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x434, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x42a, MASKLWORD, RTW_REG_DOMAIN_MAC16}, + {0x426, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0x45e, BIT(3), RTW_REG_DOMAIN_MAC8}, + {0x454, MASKLWORD, RTW_REG_DOMAIN_MAC16}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x4c, BIT(24) | BIT(23), RTW_REG_DOMAIN_MAC32}, + {0x64, BIT(0), RTW_REG_DOMAIN_MAC8}, + {0x4c6, BIT(4), RTW_REG_DOMAIN_MAC8}, + {0x40, BIT(5), RTW_REG_DOMAIN_MAC8}, + {0x1, RFREG_MASK, RTW_REG_DOMAIN_RF_A}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x550, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x522, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0x953, BIT(1), RTW_REG_DOMAIN_MAC8}, + {0xc50, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0x60A, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, +}; + +const struct rtw_chip_info rtw8821c_hw_spec = { + .ops = &rtw8821c_ops, + .id = RTW_CHIP_TYPE_8821C, + .fw_name = "rtw88/rtw8821c_fw.bin", + .wlan_cpu = RTW_WCPU_11AC, + .tx_pkt_desc_sz = 48, + .tx_buf_desc_sz = 16, + .rx_pkt_desc_sz = 24, + .rx_buf_desc_sz = 8, + .phy_efuse_size = 512, + .log_efuse_size = 512, + .ptct_efuse_size = 96, + .txff_size = 65536, + .rxff_size = 16384, + .rsvd_drv_pg_num = 8, + .txgi_factor = 1, + .is_pwr_by_rate_dec = true, + .max_power_index = 0x3f, + .csi_buf_pg_num = 0, + .band = RTW_BAND_2G | RTW_BAND_5G, + .page_size = TX_PAGE_SIZE, + .dig_min = 0x1c, + .ht_supported = true, + .vht_supported = true, + .lps_deep_mode_supported = BIT(LPS_DEEP_MODE_LCLK), + .sys_func_en = 0xD8, + .pwr_on_seq = card_enable_flow_8821c, + .pwr_off_seq = card_disable_flow_8821c, + .page_table = page_table_8821c, + .rqpn_table = rqpn_table_8821c, + .prioq_addrs = &prioq_addrs_8821c, + .intf_table = &phy_para_table_8821c, + .dig = rtw8821c_dig, + .rf_base_addr = {0x2800, 0x2c00}, + .rf_sipi_addr = {0xc90, 0xe90}, + .ltecoex_addr = &rtw8821c_ltecoex_addr, + .mac_tbl = &rtw8821c_mac_tbl, + .agc_tbl = &rtw8821c_agc_tbl, + .bb_tbl = &rtw8821c_bb_tbl, + .rf_tbl = {&rtw8821c_rf_a_tbl}, + .rfe_defs = rtw8821c_rfe_defs, + .rfe_defs_size = ARRAY_SIZE(rtw8821c_rfe_defs), + .rx_ldpc = false, + .pwr_track_tbl = &rtw8821c_rtw_pwr_track_tbl, + .iqk_threshold = 8, + .bfer_su_max_num = 2, + .bfer_mu_max_num = 1, + .ampdu_density = IEEE80211_HT_MPDU_DENSITY_2, + .max_scan_ie_len = IEEE80211_MAX_DATA_LEN, + + .coex_para_ver = 0x19092746, + .bt_desired_ver = 0x46, + .scbd_support = true, + .new_scbd10_def = false, + .ble_hid_profile_support = false, + .wl_mimo_ps_support = false, + .pstdma_type = COEX_PSTDMA_FORCE_LPSOFF, + .bt_rssi_type = COEX_BTRSSI_RATIO, + .ant_isolation = 15, + .rssi_tolerance = 2, + .wl_rssi_step = wl_rssi_step_8821c, + .bt_rssi_step = bt_rssi_step_8821c, + .table_sant_num = ARRAY_SIZE(table_sant_8821c), + .table_sant = table_sant_8821c, + .table_nsant_num = ARRAY_SIZE(table_nsant_8821c), + .table_nsant = table_nsant_8821c, + .tdma_sant_num = ARRAY_SIZE(tdma_sant_8821c), + .tdma_sant = tdma_sant_8821c, + .tdma_nsant_num = ARRAY_SIZE(tdma_nsant_8821c), + .tdma_nsant = tdma_nsant_8821c, + .wl_rf_para_num = ARRAY_SIZE(rf_para_tx_8821c), + .wl_rf_para_tx = rf_para_tx_8821c, + .wl_rf_para_rx = rf_para_rx_8821c, + .bt_afh_span_bw20 = 0x24, + .bt_afh_span_bw40 = 0x36, + .afh_5g_num = ARRAY_SIZE(afh_5g_8821c), + .afh_5g = afh_5g_8821c, + + .coex_info_hw_regs_num = ARRAY_SIZE(coex_info_hw_regs_8821c), + .coex_info_hw_regs = coex_info_hw_regs_8821c, +}; +EXPORT_SYMBOL(rtw8821c_hw_spec); + +MODULE_FIRMWARE("rtw88/rtw8821c_fw.bin"); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8821c driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c.h new file mode 100644 index 0000000000000000000000000000000000000000..fcff31688c453a1da2930cd3b70f8554eeca5d84 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c.h @@ -0,0 +1,308 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW8821C_H__ +#define __RTW8821C_H__ + +#include + +#define RCR_VHT_ACK BIT(26) + +struct rtw8821cu_efuse { + u8 res4[4]; /* 0xd0 */ + u8 usb_optional_function; + u8 res5[0x1e]; + u8 res6[2]; + u8 serial[0x0b]; /* 0xf5 */ + u8 vid; /* 0x100 */ + u8 res7; + u8 pid; + u8 res8[4]; + u8 mac_addr[ETH_ALEN]; /* 0x107 */ + u8 res9[2]; + u8 vendor_name[0x07]; + u8 res10[2]; + u8 device_name[0x14]; + u8 res11[0xcf]; + u8 package_type; /* 0x1fb */ + u8 res12[0x4]; +}; + +struct rtw8821ce_efuse { + u8 mac_addr[ETH_ALEN]; /* 0xd0 */ + u8 vender_id[2]; + u8 device_id[2]; + u8 sub_vender_id[2]; + u8 sub_device_id[2]; + u8 pmc[2]; + u8 exp_device_cap[2]; + u8 msi_cap; + u8 ltr_cap; /* 0xe3 */ + u8 exp_link_control[2]; + u8 link_cap[4]; + u8 link_control[2]; + u8 serial_number[8]; + u8 res0:2; /* 0xf4 */ + u8 ltr_en:1; + u8 res1:2; + u8 obff:2; + u8 res2:3; + u8 obff_cap:2; + u8 res3:4; + u8 res4[3]; + u8 class_code[3]; + u8 pci_pm_L1_2_supp:1; + u8 pci_pm_L1_1_supp:1; + u8 aspm_pm_L1_2_supp:1; + u8 aspm_pm_L1_1_supp:1; + u8 L1_pm_substates_supp:1; + u8 res5:3; + u8 port_common_mode_restore_time; + u8 port_t_power_on_scale:2; + u8 res6:1; + u8 port_t_power_on_value:5; + u8 res7; +}; + +struct rtw8821cs_efuse { + u8 res4[0x4a]; /* 0xd0 */ + u8 mac_addr[ETH_ALEN]; /* 0x11a */ +} __packed; + +struct rtw8821c_efuse { + __le16 rtl_id; + u8 res0[0x0e]; + + /* power index for four RF paths */ + struct rtw_txpwr_idx txpwr_idx_table[4]; + + u8 channel_plan; /* 0xb8 */ + u8 xtal_k; + u8 thermal_meter; + u8 iqk_lck; + u8 pa_type; /* 0xbc */ + u8 lna_type_2g[2]; /* 0xbd */ + u8 lna_type_5g[2]; + u8 rf_board_option; + u8 rf_feature_option; + u8 rf_bt_setting; + u8 eeprom_version; + u8 eeprom_customer_id; + u8 tx_bb_swing_setting_2g; + u8 tx_bb_swing_setting_5g; + u8 tx_pwr_calibrate_rate; + u8 rf_antenna_option; /* 0xc9 */ + u8 rfe_option; + u8 country_code[2]; + u8 res[3]; + union { + struct rtw8821ce_efuse e; + struct rtw8821cu_efuse u; + struct rtw8821cs_efuse s; + }; +}; + +static inline void +_rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) +{ + /* 0xC00-0xCFF and 0xE00-0xEFF have the same layout */ + rtw_write32_mask(rtwdev, addr, mask, data); + rtw_write32_mask(rtwdev, addr + 0x200, mask, data); +} + +extern const struct rtw_chip_info rtw8821c_hw_spec; + +#define rtw_write32s_mask(rtwdev, addr, mask, data) \ + do { \ + BUILD_BUG_ON((addr) < 0xC00 || (addr) >= 0xD00); \ + \ + _rtw_write32s_mask(rtwdev, addr, mask, data); \ + } while (0) + +#define BIT_FEN_PCIEA BIT(6) +#define WLAN_SLOT_TIME 0x09 +#define WLAN_PIFS_TIME 0x19 +#define WLAN_SIFS_CCK_CONT_TX 0xA +#define WLAN_SIFS_OFDM_CONT_TX 0xE +#define WLAN_SIFS_CCK_TRX 0x10 +#define WLAN_SIFS_OFDM_TRX 0x10 +#define WLAN_VO_TXOP_LIMIT 0x186 +#define WLAN_VI_TXOP_LIMIT 0x3BC +#define WLAN_RDG_NAV 0x05 +#define WLAN_TXOP_NAV 0x1B +#define WLAN_CCK_RX_TSF 0x30 +#define WLAN_OFDM_RX_TSF 0x30 +#define WLAN_TBTT_PROHIBIT 0x04 +#define WLAN_TBTT_HOLD_TIME 0x064 +#define WLAN_DRV_EARLY_INT 0x04 +#define WLAN_BCN_DMA_TIME 0x02 + +#define WLAN_RX_FILTER0 0x0FFFFFFF +#define WLAN_RX_FILTER2 0xFFFF +#define WLAN_RCR_CFG 0xE400220E +#define WLAN_RXPKT_MAX_SZ 12288 +#define WLAN_RXPKT_MAX_SZ_512 (WLAN_RXPKT_MAX_SZ >> 9) + +#define WLAN_AMPDU_MAX_TIME 0x70 +#define WLAN_RTS_LEN_TH 0xFF +#define WLAN_RTS_TX_TIME_TH 0x08 +#define WLAN_MAX_AGG_PKT_LIMIT 0x20 +#define WLAN_RTS_MAX_AGG_PKT_LIMIT 0x20 +#define FAST_EDCA_VO_TH 0x06 +#define FAST_EDCA_VI_TH 0x06 +#define FAST_EDCA_BE_TH 0x06 +#define FAST_EDCA_BK_TH 0x06 +#define WLAN_BAR_RETRY_LIMIT 0x01 +#define WLAN_RA_TRY_RATE_AGG_LIMIT 0x08 + +#define WLAN_TX_FUNC_CFG1 0x30 +#define WLAN_TX_FUNC_CFG2 0x30 +#define WLAN_MAC_OPT_NORM_FUNC1 0x98 +#define WLAN_MAC_OPT_LB_FUNC1 0x80 +#define WLAN_MAC_OPT_FUNC2 0xb0810041 + +#define WLAN_SIFS_CFG (WLAN_SIFS_CCK_CONT_TX | \ + (WLAN_SIFS_OFDM_CONT_TX << BIT_SHIFT_SIFS_OFDM_CTX) | \ + (WLAN_SIFS_CCK_TRX << BIT_SHIFT_SIFS_CCK_TRX) | \ + (WLAN_SIFS_OFDM_TRX << BIT_SHIFT_SIFS_OFDM_TRX)) + +#define WLAN_TBTT_TIME (WLAN_TBTT_PROHIBIT |\ + (WLAN_TBTT_HOLD_TIME << BIT_SHIFT_TBTT_HOLD_TIME_AP)) + +#define WLAN_NAV_CFG (WLAN_RDG_NAV | (WLAN_TXOP_NAV << 16)) +#define WLAN_RX_TSF_CFG (WLAN_CCK_RX_TSF | (WLAN_OFDM_RX_TSF) << 8) +#define WLAN_PRE_TXCNT_TIME_TH 0x1E4 + +/* phy status page0 */ +#define GET_PHY_STAT_P0_PWDB(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(15, 8)) +#define GET_PHY_STAT_P0_VGA(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x03), GENMASK(12, 8)) +#define GET_PHY_STAT_P0_LNA_L(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x03), GENMASK(15, 13)) +#define GET_PHY_STAT_P0_LNA_H(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x03), BIT(23)) +#define BIT_LNA_H_MASK BIT(3) +#define BIT_LNA_L_MASK GENMASK(2, 0) + +/* phy status page1 */ +#define GET_PHY_STAT_P1_PWDB_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(15, 8)) +#define GET_PHY_STAT_P1_PWDB_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(23, 16)) +#define GET_PHY_STAT_P1_RF_MODE(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x03), GENMASK(29, 28)) +#define GET_PHY_STAT_P1_L_RXSC(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(11, 8)) +#define GET_PHY_STAT_P1_HT_RXSC(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(15, 12)) +#define GET_PHY_STAT_P1_RXEVM_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_RXEVM_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(15, 8)) +#define GET_PHY_STAT_P1_CFO_TAIL_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x05), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_CFO_TAIL_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x05), GENMASK(15, 8)) +#define GET_PHY_STAT_P1_RXSNR_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x06), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_RXSNR_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x06), GENMASK(15, 8)) + +#define REG_SYS_CTRL 0x000 +#define BIT_FEN_EN BIT(26) +#define REG_INIRTS_RATE_SEL 0x0480 +#define REG_HTSTFWT 0x800 +#define REG_RXPSEL 0x808 +#define BIT_RX_PSEL_RST (BIT(28) | BIT(29)) +#define REG_TXPSEL 0x80c +#define REG_RXCCAMSK 0x814 +#define REG_CCASEL 0x82c +#define REG_PDMFTH 0x830 +#define REG_CCA2ND 0x838 +#define REG_L1WT 0x83c +#define REG_L1PKWT 0x840 +#define REG_MRC 0x850 +#define REG_CLKTRK 0x860 +#define REG_ADCCLK 0x8ac +#define REG_ADC160 0x8c4 +#define REG_ADC40 0x8c8 +#define REG_CHFIR 0x8f0 +#define REG_CDDTXP 0x93c +#define REG_TXPSEL1 0x940 +#define REG_ACBB0 0x948 +#define REG_ACBBRXFIR 0x94c +#define REG_ACGG2TBL 0x958 +#define REG_FAS 0x9a4 +#define REG_RXSB 0xa00 +#define REG_ADCINI 0xa04 +#define REG_PWRTH 0xa08 +#define REG_TXSF2 0xa24 +#define REG_TXSF6 0xa28 +#define REG_FA_CCK 0xa5c +#define REG_RXDESC 0xa2c +#define REG_ENTXCCK 0xa80 +#define BTG_LNA 0xfc84 +#define WLG_LNA 0x7532 +#define REG_ENRXCCA 0xa84 +#define BTG_CCA 0x0e +#define WLG_CCA 0x12 +#define REG_PWRTH2 0xaa8 +#define REG_CSRATIO 0xaaa +#define REG_TXFILTER 0xaac +#define REG_CNTRST 0xb58 +#define REG_AGCTR_A 0xc08 +#define REG_TXSCALE_A 0xc1c +#define REG_TXDFIR 0xc20 +#define REG_RXIGI_A 0xc50 +#define REG_TXAGCIDX 0xc94 +#define REG_TRSW 0xca0 +#define REG_RFESEL0 0xcb0 +#define REG_RFESEL8 0xcb4 +#define REG_RFECTL 0xcb8 +#define B_BTG_SWITCH BIT(16) +#define B_CTRL_SWITCH BIT(18) +#define B_WL_SWITCH (BIT(20) | BIT(22)) +#define B_WLG_SWITCH BIT(21) +#define B_WLA_SWITCH BIT(23) +#define REG_RFEINV 0xcbc +#define REG_AGCTR_B 0xe08 +#define REG_RXIGI_B 0xe50 +#define REG_CRC_CCK 0xf04 +#define REG_CRC_OFDM 0xf14 +#define REG_CRC_HT 0xf10 +#define REG_CRC_VHT 0xf0c +#define REG_CCA_OFDM 0xf08 +#define REG_FA_OFDM 0xf48 +#define REG_CCA_CCK 0xfcc +#define REG_DMEM_CTRL 0x1080 +#define BIT_WL_RST BIT(16) +#define REG_ANTWT 0x1904 +#define REG_IQKFAILMSK 0x1bf0 +#define BIT_MASK_R_RFE_SEL_15 GENMASK(31, 28) +#define BIT_SDIO_INT BIT(18) +#define BT_CNT_ENABLE 0x1 +#define BIT_BCN_QUEUE BIT(3) +#define BCN_PRI_EN 0x1 +#define PTA_CTRL_PIN 0x66 +#define DPDT_CTRL_PIN 0x77 +#define ANTDIC_CTRL_PIN 0x88 +#define REG_CTRL_TYPE 0x67 +#define BIT_CTRL_TYPE1 BIT(5) +#define BIT_CTRL_TYPE2 BIT(4) +#define CTRL_TYPE_MASK GENMASK(15, 8) + +#define RF18_BAND_MASK (BIT(16) | BIT(9) | BIT(8)) +#define RF18_BAND_2G (0) +#define RF18_BAND_5G (BIT(16) | BIT(8)) +#define RF18_CHANNEL_MASK (MASKBYTE0) +#define RF18_RFSI_MASK (BIT(18) | BIT(17)) +#define RF18_RFSI_GE (BIT(17)) +#define RF18_RFSI_GT (BIT(18)) +#define RF18_BW_MASK (BIT(11) | BIT(10)) +#define RF18_BW_20M (BIT(11) | BIT(10)) +#define RF18_BW_40M (BIT(11)) +#define RF18_BW_80M (BIT(10)) + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c_table.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c_table.c new file mode 100644 index 0000000000000000000000000000000000000000..6c82c43834977e3e786302911937c390719ccfcc --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c_table.c @@ -0,0 +1,7008 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "phy.h" +#include "rtw8821c_table.h" + +static const u32 rtw8821c_mac[] = { + 0x010, 0x00000043, + 0x025, 0x0000001D, + 0x026, 0x000000CE, + 0x04F, 0x00000001, + 0x029, 0x000000F9, + 0x420, 0x00000080, + 0x421, 0x0000001F, + 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, 0x000000F0, + 0x446, 0x00000001, + 0x447, 0x000000FE, + 0x448, 0x00000000, + 0x449, 0x00000000, + 0x44A, 0x00000000, + 0x44B, 0x00000040, + 0x44C, 0x00000010, + 0x44D, 0x000000F0, + 0x44E, 0x0000003F, + 0x44F, 0x00000000, + 0x450, 0x00000000, + 0x451, 0x00000000, + 0x452, 0x00000000, + 0x453, 0x00000040, + 0x455, 0x00000070, + 0x45E, 0x00000004, + 0x49C, 0x00000010, + 0x49D, 0x000000F0, + 0x49E, 0x00000000, + 0x49F, 0x00000006, + 0x4A0, 0x000000E0, + 0x4A1, 0x00000003, + 0x4A2, 0x00000000, + 0x4A3, 0x00000040, + 0x4A4, 0x00000015, + 0x4A5, 0x000000F0, + 0x4A6, 0x00000000, + 0x4A7, 0x00000006, + 0x4A8, 0x000000E0, + 0x4A9, 0x00000000, + 0x4AA, 0x00000000, + 0x4AB, 0x00000000, + 0x7DA, 0x00000008, + 0x1448, 0x00000006, + 0x144A, 0x00000006, + 0x144C, 0x00000006, + 0x144E, 0x00000006, + 0x4C8, 0x000000FF, + 0x4C9, 0x00000008, + 0x4CC, 0x000000FF, + 0x4CD, 0x000000FF, + 0x4CE, 0x00000001, + 0x4CF, 0x00000008, + 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, + 0x521, 0x0000002F, + 0x525, 0x0000004F, + 0x551, 0x00000010, + 0x559, 0x00000002, + 0x55C, 0x00000050, + 0x55D, 0x000000FF, + 0x577, 0x0000000B, + 0x578, 0x00000014, + 0x579, 0x00000014, + 0x57A, 0x00000014, + 0x5BE, 0x00000064, + 0x605, 0x00000030, + 0x608, 0x0000000E, + 0x609, 0x00000022, + 0x60C, 0x00000018, + 0x6A0, 0x000000FF, + 0x6A1, 0x000000FF, + 0x6A2, 0x000000FF, + 0x6A3, 0x000000FF, + 0x6A4, 0x000000FF, + 0x6A5, 0x000000FF, + 0x6DE, 0x00000084, + 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, + 0x7D4, 0x00000098, + +}; + +RTW_DECL_TABLE_PHY_COND(rtw8821c_mac, rtw_phy_cfg_mac); + +static const u32 rtw8821c_agc[] = { + 0x80001004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000003, + 0x81C, 0xFA020003, + 0x81C, 0xF9040003, + 0x81C, 0xF8060003, + 0x81C, 0xF7080003, + 0x81C, 0xF60A0003, + 0x81C, 0xF50C0003, + 0x81C, 0xF40E0003, + 0x81C, 0xF3100003, + 0x81C, 0xF2120003, + 0x81C, 0xF1140003, + 0x81C, 0xF0160003, + 0x81C, 0xEF180003, + 0x81C, 0xEE1A0003, + 0x81C, 0xED1C0003, + 0x81C, 0xEC1E0003, + 0x81C, 0xEB200003, + 0x81C, 0xEA220003, + 0x81C, 0xE9240003, + 0x81C, 0xE8260003, + 0x81C, 0xE7280003, + 0x81C, 0xE62A0003, + 0x81C, 0xE52C0003, + 0x81C, 0xE42E0003, + 0x81C, 0xE3300003, + 0x81C, 0xE2320003, + 0x81C, 0xE1340003, + 0x81C, 0xC4360003, + 0x81C, 0xC3380003, + 0x81C, 0xC23A0003, + 0x81C, 0xC13C0003, + 0x81C, 0x883E0003, + 0x81C, 0x87400003, + 0x81C, 0x86420003, + 0x81C, 0x85440003, + 0x81C, 0x84460003, + 0x81C, 0x83480003, + 0x81C, 0x824A0003, + 0x81C, 0x814C0003, + 0x81C, 0x804E0003, + 0x81C, 0x64500003, + 0x81C, 0x63520003, + 0x81C, 0x62540003, + 0x81C, 0x61560003, + 0x81C, 0x60580003, + 0x81C, 0x475A0003, + 0x81C, 0x465C0003, + 0x81C, 0x455E0003, + 0x81C, 0x44600003, + 0x81C, 0x43620003, + 0x81C, 0x42640003, + 0x81C, 0x41660003, + 0x81C, 0x40680003, + 0x81C, 0x236A0003, + 0x81C, 0x226C0003, + 0x81C, 0x056E0003, + 0x81C, 0x04700003, + 0x81C, 0x03720003, + 0x81C, 0x02740003, + 0x81C, 0x01760003, + 0x81C, 0x01780003, + 0x81C, 0x017A0003, + 0x81C, 0x017C0003, + 0x81C, 0x017E0003, + 0x90001005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000003, + 0x81C, 0xFA020003, + 0x81C, 0xF9040003, + 0x81C, 0xF8060003, + 0x81C, 0xF7080003, + 0x81C, 0xF60A0003, + 0x81C, 0xF50C0003, + 0x81C, 0xF40E0003, + 0x81C, 0xF3100003, + 0x81C, 0xF2120003, + 0x81C, 0xF1140003, + 0x81C, 0xF0160003, + 0x81C, 0xEF180003, + 0x81C, 0xEE1A0003, + 0x81C, 0xED1C0003, + 0x81C, 0xEC1E0003, + 0x81C, 0xEB200003, + 0x81C, 0xEA220003, + 0x81C, 0xE9240003, + 0x81C, 0xE8260003, + 0x81C, 0xE7280003, + 0x81C, 0xE62A0003, + 0x81C, 0xE52C0003, + 0x81C, 0xE42E0003, + 0x81C, 0xE3300003, + 0x81C, 0xE2320003, + 0x81C, 0xE1340003, + 0x81C, 0xC4360003, + 0x81C, 0xC3380003, + 0x81C, 0xC23A0003, + 0x81C, 0xC13C0003, + 0x81C, 0x883E0003, + 0x81C, 0x87400003, + 0x81C, 0x86420003, + 0x81C, 0x85440003, + 0x81C, 0x84460003, + 0x81C, 0x83480003, + 0x81C, 0x824A0003, + 0x81C, 0x814C0003, + 0x81C, 0x804E0003, + 0x81C, 0x64500003, + 0x81C, 0x63520003, + 0x81C, 0x62540003, + 0x81C, 0x61560003, + 0x81C, 0x60580003, + 0x81C, 0x475A0003, + 0x81C, 0x465C0003, + 0x81C, 0x455E0003, + 0x81C, 0x44600003, + 0x81C, 0x43620003, + 0x81C, 0x42640003, + 0x81C, 0x41660003, + 0x81C, 0x40680003, + 0x81C, 0x236A0003, + 0x81C, 0x226C0003, + 0x81C, 0x056E0003, + 0x81C, 0x04700003, + 0x81C, 0x03720003, + 0x81C, 0x02740003, + 0x81C, 0x01760003, + 0x81C, 0x01780003, + 0x81C, 0x017A0003, + 0x81C, 0x017C0003, + 0x81C, 0x017E0003, + 0xA0000000, 0x00000000, + 0x81C, 0xFB000003, + 0x81C, 0xFA020003, + 0x81C, 0xF9040003, + 0x81C, 0xF8060003, + 0x81C, 0xF7080003, + 0x81C, 0xF60A0003, + 0x81C, 0xF50C0003, + 0x81C, 0xF40E0003, + 0x81C, 0xF3100003, + 0x81C, 0xF2120003, + 0x81C, 0xF1140003, + 0x81C, 0xF0160003, + 0x81C, 0xEF180003, + 0x81C, 0xEE1A0003, + 0x81C, 0xED1C0003, + 0x81C, 0xEC1E0003, + 0x81C, 0xEB200003, + 0x81C, 0xEA220003, + 0x81C, 0xE9240003, + 0x81C, 0xE8260003, + 0x81C, 0xE7280003, + 0x81C, 0xE62A0003, + 0x81C, 0xCA2C0003, + 0x81C, 0xC92E0003, + 0x81C, 0xC8300003, + 0x81C, 0xC7320003, + 0x81C, 0xC6340003, + 0x81C, 0xC5360003, + 0x81C, 0xC4380003, + 0x81C, 0xC33A0003, + 0x81C, 0xC23C0003, + 0x81C, 0xC13E0003, + 0x81C, 0x88400003, + 0x81C, 0x87420003, + 0x81C, 0x86440003, + 0x81C, 0x85460003, + 0x81C, 0x84480003, + 0x81C, 0x834A0003, + 0x81C, 0x674C0003, + 0x81C, 0x664E0003, + 0x81C, 0x65500003, + 0x81C, 0x64520003, + 0x81C, 0x63540003, + 0x81C, 0x62560003, + 0x81C, 0x61580003, + 0x81C, 0x455A0003, + 0x81C, 0x445C0003, + 0x81C, 0x435E0003, + 0x81C, 0x42600003, + 0x81C, 0x41620003, + 0x81C, 0x25640003, + 0x81C, 0x24660003, + 0x81C, 0x23680003, + 0x81C, 0x226A0003, + 0x81C, 0x216C0003, + 0x81C, 0x016E0003, + 0x81C, 0x01700003, + 0x81C, 0x01720003, + 0x81C, 0x01740003, + 0x81C, 0x01760003, + 0x81C, 0x01780003, + 0x81C, 0x017A0003, + 0x81C, 0x017C0003, + 0x81C, 0x017E0003, + 0xB0000000, 0x00000000, + 0x80001004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000103, + 0x81C, 0xFC020103, + 0x81C, 0xFB040103, + 0x81C, 0xFA060103, + 0x81C, 0xF9080103, + 0x81C, 0xF80A0103, + 0x81C, 0xF70C0103, + 0x81C, 0xF60E0103, + 0x81C, 0xF5100103, + 0x81C, 0xF4120103, + 0x81C, 0xF3140103, + 0x81C, 0xF2160103, + 0x81C, 0xF1180103, + 0x81C, 0xF01A0103, + 0x81C, 0xEF1C0103, + 0x81C, 0xEE1E0103, + 0x81C, 0xED200103, + 0x81C, 0xEC220103, + 0x81C, 0xEB240103, + 0x81C, 0xEA260103, + 0x81C, 0xE9280103, + 0x81C, 0xE82A0103, + 0x81C, 0xE72C0103, + 0x81C, 0xE62E0103, + 0x81C, 0xE5300103, + 0x81C, 0xE4320103, + 0x81C, 0xE3340103, + 0x81C, 0xE2360103, + 0x81C, 0xE1380103, + 0x81C, 0xE03A0103, + 0x81C, 0xC33C0103, + 0x81C, 0xC23E0103, + 0x81C, 0xC1400103, + 0x81C, 0xC0420103, + 0x81C, 0xA3440103, + 0x81C, 0xA2460103, + 0x81C, 0xA1480103, + 0x81C, 0xA04A0103, + 0x81C, 0x824C0103, + 0x81C, 0x814E0103, + 0x81C, 0x80500103, + 0x81C, 0x62520103, + 0x81C, 0x61540103, + 0x81C, 0x60560103, + 0x81C, 0x24580103, + 0x81C, 0x235A0103, + 0x81C, 0x225C0103, + 0x81C, 0x215E0103, + 0x81C, 0x20600103, + 0x81C, 0x03620103, + 0x81C, 0x02640103, + 0x81C, 0x01660103, + 0x81C, 0x01680103, + 0x81C, 0x016A0103, + 0x81C, 0x016C0103, + 0x81C, 0x016E0103, + 0x81C, 0x01700103, + 0x81C, 0x01720103, + 0x81C, 0x01740103, + 0x81C, 0x01760103, + 0x81C, 0x01780103, + 0x81C, 0x017A0103, + 0x81C, 0x017C0103, + 0x81C, 0x017E0103, + 0x90001005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF6000103, + 0x81C, 0xF5020103, + 0x81C, 0xF4040103, + 0x81C, 0xF3060103, + 0x81C, 0xF2080103, + 0x81C, 0xF10A0103, + 0x81C, 0xF00C0103, + 0x81C, 0xEF0E0103, + 0x81C, 0xEE100103, + 0x81C, 0xED120103, + 0x81C, 0xEC140103, + 0x81C, 0xCE160103, + 0x81C, 0xEA180103, + 0x81C, 0xE91A0103, + 0x81C, 0xE81C0103, + 0x81C, 0xE71E0103, + 0x81C, 0xE6200103, + 0x81C, 0xE5220103, + 0x81C, 0xE4240103, + 0x81C, 0xE3260103, + 0x81C, 0xE2280103, + 0x81C, 0xE12A0103, + 0x81C, 0xC32C0103, + 0x81C, 0xA62E0103, + 0x81C, 0xC1300103, + 0x81C, 0xA4320103, + 0x81C, 0xA3340103, + 0x81C, 0xA2360103, + 0x81C, 0xA1380103, + 0x81C, 0x833A0103, + 0x81C, 0x823C0103, + 0x81C, 0x813E0103, + 0x81C, 0x63400103, + 0x81C, 0x62420103, + 0x81C, 0x61440103, + 0x81C, 0x60460103, + 0x81C, 0x25480103, + 0x81C, 0x244A0103, + 0x81C, 0x234C0103, + 0x81C, 0x064E0103, + 0x81C, 0x21500103, + 0x81C, 0x04520103, + 0x81C, 0x03540103, + 0x81C, 0x02560103, + 0x81C, 0x01580103, + 0x81C, 0x005A0103, + 0x81C, 0x005C0103, + 0x81C, 0x005E0103, + 0x81C, 0x00600103, + 0x81C, 0x00620103, + 0x81C, 0x00640103, + 0x81C, 0x00660103, + 0x81C, 0x00680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0xA0000000, 0x00000000, + 0x81C, 0xFD000103, + 0x81C, 0xFC020103, + 0x81C, 0xFB040103, + 0x81C, 0xFA060103, + 0x81C, 0xF9080103, + 0x81C, 0xF80A0103, + 0x81C, 0xF70C0103, + 0x81C, 0xF60E0103, + 0x81C, 0xF5100103, + 0x81C, 0xF4120103, + 0x81C, 0xF3140103, + 0x81C, 0xF2160103, + 0x81C, 0xF1180103, + 0x81C, 0xF01A0103, + 0x81C, 0xEF1C0103, + 0x81C, 0xEE1E0103, + 0x81C, 0xED200103, + 0x81C, 0xEC220103, + 0x81C, 0xEB240103, + 0x81C, 0xEA260103, + 0x81C, 0xE9280103, + 0x81C, 0xE82A0103, + 0x81C, 0xE72C0103, + 0x81C, 0xE62E0103, + 0x81C, 0xE5300103, + 0x81C, 0xE4320103, + 0x81C, 0xE3340103, + 0x81C, 0xE2360103, + 0x81C, 0xE1380103, + 0x81C, 0xE03A0103, + 0x81C, 0xA83C0103, + 0x81C, 0xA73E0103, + 0x81C, 0xA6400103, + 0x81C, 0xA5420103, + 0x81C, 0xA4440103, + 0x81C, 0xA3460103, + 0x81C, 0xA2480103, + 0x81C, 0xA14A0103, + 0x81C, 0x834C0103, + 0x81C, 0x824E0103, + 0x81C, 0x81500103, + 0x81C, 0x63520103, + 0x81C, 0x62540103, + 0x81C, 0x61560103, + 0x81C, 0x25580103, + 0x81C, 0x245A0103, + 0x81C, 0x235C0103, + 0x81C, 0x225E0103, + 0x81C, 0x04600103, + 0x81C, 0x03620103, + 0x81C, 0x02640103, + 0x81C, 0x01660103, + 0x81C, 0x01680103, + 0x81C, 0x016A0103, + 0x81C, 0x016C0103, + 0x81C, 0x016E0103, + 0x81C, 0x01700103, + 0x81C, 0x01720103, + 0x81C, 0x01740103, + 0x81C, 0x01760103, + 0x81C, 0x01780103, + 0x81C, 0x017A0103, + 0x81C, 0x017C0103, + 0x81C, 0x017E0103, + 0xB0000000, 0x00000000, + 0x80001004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000203, + 0x81C, 0xFA020203, + 0x81C, 0xF9040203, + 0x81C, 0xF8060203, + 0x81C, 0xF7080203, + 0x81C, 0xF60A0203, + 0x81C, 0xF50C0203, + 0x81C, 0xF40E0203, + 0x81C, 0xF3100203, + 0x81C, 0xF2120203, + 0x81C, 0xF1140203, + 0x81C, 0xF0160203, + 0x81C, 0xEF180203, + 0x81C, 0xEE1A0203, + 0x81C, 0xED1C0203, + 0x81C, 0xEC1E0203, + 0x81C, 0xEB200203, + 0x81C, 0xEA220203, + 0x81C, 0xE9240203, + 0x81C, 0xE8260203, + 0x81C, 0xE7280203, + 0x81C, 0xE62A0203, + 0x81C, 0xE52C0203, + 0x81C, 0xE42E0203, + 0x81C, 0xE3300203, + 0x81C, 0xE2320203, + 0x81C, 0xE1340203, + 0x81C, 0xC5360203, + 0x81C, 0xC4380203, + 0x81C, 0xC33A0203, + 0x81C, 0xC23C0203, + 0x81C, 0xC13E0203, + 0x81C, 0xA4400203, + 0x81C, 0xA3420203, + 0x81C, 0xA2440203, + 0x81C, 0xA1460203, + 0x81C, 0xA0480203, + 0x81C, 0x834A0203, + 0x81C, 0x824C0203, + 0x81C, 0x814E0203, + 0x81C, 0x63500203, + 0x81C, 0x62520203, + 0x81C, 0x61540203, + 0x81C, 0x60560203, + 0x81C, 0x23580203, + 0x81C, 0x225A0203, + 0x81C, 0x215C0203, + 0x81C, 0x205E0203, + 0x81C, 0x04600203, + 0x81C, 0x03620203, + 0x81C, 0x02640203, + 0x81C, 0x01660203, + 0x81C, 0x01680203, + 0x81C, 0x016A0203, + 0x81C, 0x016C0203, + 0x81C, 0x016E0203, + 0x81C, 0x01700203, + 0x81C, 0x01720203, + 0x81C, 0x01740203, + 0x81C, 0x01760203, + 0x81C, 0x01780203, + 0x81C, 0x017A0203, + 0x81C, 0x017C0203, + 0x81C, 0x017E0203, + 0x90001005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF6000203, + 0x81C, 0xF5020203, + 0x81C, 0xF4040203, + 0x81C, 0xF3060203, + 0x81C, 0xF2080203, + 0x81C, 0xF10A0203, + 0x81C, 0xF00C0203, + 0x81C, 0xEF0E0203, + 0x81C, 0xEE100203, + 0x81C, 0xED120203, + 0x81C, 0xEC140203, + 0x81C, 0xEB160203, + 0x81C, 0xEA180203, + 0x81C, 0xE91A0203, + 0x81C, 0xE81C0203, + 0x81C, 0xE71E0203, + 0x81C, 0xE6200203, + 0x81C, 0xE5220203, + 0x81C, 0xE4240203, + 0x81C, 0xE3260203, + 0x81C, 0xE2280203, + 0x81C, 0xE12A0203, + 0x81C, 0xE02C0203, + 0x81C, 0xC22E0203, + 0x81C, 0xC1300203, + 0x81C, 0xC0320203, + 0x81C, 0xA3340203, + 0x81C, 0xA2360203, + 0x81C, 0xA1380203, + 0x81C, 0xA03A0203, + 0x81C, 0x833C0203, + 0x81C, 0x823E0203, + 0x81C, 0x81400203, + 0x81C, 0x80420203, + 0x81C, 0x62440203, + 0x81C, 0x61460203, + 0x81C, 0x42480203, + 0x81C, 0x414A0203, + 0x81C, 0x234C0203, + 0x81C, 0x224E0203, + 0x81C, 0x21500203, + 0x81C, 0x20520203, + 0x81C, 0x03540203, + 0x81C, 0x02560203, + 0x81C, 0x01580203, + 0x81C, 0x005A0203, + 0x81C, 0x005C0203, + 0x81C, 0x005E0203, + 0x81C, 0x00600203, + 0x81C, 0x00620203, + 0x81C, 0x00640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0xA0000000, 0x00000000, + 0x81C, 0xFC000203, + 0x81C, 0xFB020203, + 0x81C, 0xFA040203, + 0x81C, 0xF9060203, + 0x81C, 0xF8080203, + 0x81C, 0xF70A0203, + 0x81C, 0xF60C0203, + 0x81C, 0xF50E0203, + 0x81C, 0xF4100203, + 0x81C, 0xF3120203, + 0x81C, 0xF2140203, + 0x81C, 0xF1160203, + 0x81C, 0xF0180203, + 0x81C, 0xEF1A0203, + 0x81C, 0xEE1C0203, + 0x81C, 0xED1E0203, + 0x81C, 0xEC200203, + 0x81C, 0xEB220203, + 0x81C, 0xEA240203, + 0x81C, 0xE9260203, + 0x81C, 0xE8280203, + 0x81C, 0xE72A0203, + 0x81C, 0xE62C0203, + 0x81C, 0xE52E0203, + 0x81C, 0xE4300203, + 0x81C, 0xE3320203, + 0x81C, 0xE2340203, + 0x81C, 0xE1360203, + 0x81C, 0xC5380203, + 0x81C, 0xC43A0203, + 0x81C, 0xC33C0203, + 0x81C, 0xC23E0203, + 0x81C, 0xA6400203, + 0x81C, 0xA5420203, + 0x81C, 0xA4440203, + 0x81C, 0xA3460203, + 0x81C, 0xA2480203, + 0x81C, 0x844A0203, + 0x81C, 0x834C0203, + 0x81C, 0x824E0203, + 0x81C, 0x64500203, + 0x81C, 0x63520203, + 0x81C, 0x62540203, + 0x81C, 0x61560203, + 0x81C, 0x60580203, + 0x81C, 0x235A0203, + 0x81C, 0x225C0203, + 0x81C, 0x215E0203, + 0x81C, 0x04600203, + 0x81C, 0x03620203, + 0x81C, 0x02640203, + 0x81C, 0x01660203, + 0x81C, 0x01680203, + 0x81C, 0x016A0203, + 0x81C, 0x016C0203, + 0x81C, 0x016E0203, + 0x81C, 0x01700203, + 0x81C, 0x01720203, + 0x81C, 0x01740203, + 0x81C, 0x01760203, + 0x81C, 0x01780203, + 0x81C, 0x017A0203, + 0x81C, 0x017C0203, + 0x81C, 0x017E0203, + 0xB0000000, 0x00000000, + 0x80001004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000303, + 0x81C, 0xFA020303, + 0x81C, 0xF9040303, + 0x81C, 0xF8060303, + 0x81C, 0xF7080303, + 0x81C, 0xF60A0303, + 0x81C, 0xF50C0303, + 0x81C, 0xF40E0303, + 0x81C, 0xF3100303, + 0x81C, 0xF2120303, + 0x81C, 0xF1140303, + 0x81C, 0xF0160303, + 0x81C, 0xEF180303, + 0x81C, 0xEE1A0303, + 0x81C, 0xED1C0303, + 0x81C, 0xEC1E0303, + 0x81C, 0xEB200303, + 0x81C, 0xEA220303, + 0x81C, 0xE9240303, + 0x81C, 0xE8260303, + 0x81C, 0xE7280303, + 0x81C, 0xE62A0303, + 0x81C, 0xE52C0303, + 0x81C, 0xE42E0303, + 0x81C, 0xE3300303, + 0x81C, 0xE2320303, + 0x81C, 0xE1340303, + 0x81C, 0xC4360303, + 0x81C, 0xC3380303, + 0x81C, 0xC23A0303, + 0x81C, 0xC13C0303, + 0x81C, 0xA53E0303, + 0x81C, 0xA4400303, + 0x81C, 0xA3420303, + 0x81C, 0xA2440303, + 0x81C, 0xA1460303, + 0x81C, 0x83480303, + 0x81C, 0x824A0303, + 0x81C, 0x814C0303, + 0x81C, 0x644E0303, + 0x81C, 0x63500303, + 0x81C, 0x62520303, + 0x81C, 0x61540303, + 0x81C, 0x60560303, + 0x81C, 0x23580303, + 0x81C, 0x225A0303, + 0x81C, 0x215C0303, + 0x81C, 0x045E0303, + 0x81C, 0x03600303, + 0x81C, 0x02620303, + 0x81C, 0x01640303, + 0x81C, 0x01660303, + 0x81C, 0x01680303, + 0x81C, 0x016A0303, + 0x81C, 0x016C0303, + 0x81C, 0x016E0303, + 0x81C, 0x01700303, + 0x81C, 0x01720303, + 0x81C, 0x01740303, + 0x81C, 0x01760303, + 0x81C, 0x01780303, + 0x81C, 0x017A0303, + 0x81C, 0x017C0303, + 0x81C, 0x017E0303, + 0x90001005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF5000303, + 0x81C, 0xF4020303, + 0x81C, 0xF3040303, + 0x81C, 0xF2060303, + 0x81C, 0xF1080303, + 0x81C, 0xF00A0303, + 0x81C, 0xEF0C0303, + 0x81C, 0xEE0E0303, + 0x81C, 0xED100303, + 0x81C, 0xEC120303, + 0x81C, 0xEB140303, + 0x81C, 0xEA160303, + 0x81C, 0xE9180303, + 0x81C, 0xE81A0303, + 0x81C, 0xE71C0303, + 0x81C, 0xE61E0303, + 0x81C, 0xE5200303, + 0x81C, 0xE4220303, + 0x81C, 0xE3240303, + 0x81C, 0xE2260303, + 0x81C, 0xE1280303, + 0x81C, 0xE02A0303, + 0x81C, 0xA72C0303, + 0x81C, 0xA62E0303, + 0x81C, 0xA5300303, + 0x81C, 0xA4320303, + 0x81C, 0xA3340303, + 0x81C, 0xA2360303, + 0x81C, 0xA1380303, + 0x81C, 0xA03A0303, + 0x81C, 0x823C0303, + 0x81C, 0x643E0303, + 0x81C, 0x63400303, + 0x81C, 0x62420303, + 0x81C, 0x61440303, + 0x81C, 0x60460303, + 0x81C, 0x24480303, + 0x81C, 0x234A0303, + 0x81C, 0x224C0303, + 0x81C, 0x054E0303, + 0x81C, 0x04500303, + 0x81C, 0x03520303, + 0x81C, 0x02540303, + 0x81C, 0x01560303, + 0x81C, 0x00580303, + 0x81C, 0x005A0303, + 0x81C, 0x005C0303, + 0x81C, 0x005E0303, + 0x81C, 0x00600303, + 0x81C, 0x00620303, + 0x81C, 0x00640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0xA0000000, 0x00000000, + 0x81C, 0xFC000303, + 0x81C, 0xFB020303, + 0x81C, 0xFA040303, + 0x81C, 0xF9060303, + 0x81C, 0xF8080303, + 0x81C, 0xF70A0303, + 0x81C, 0xF60C0303, + 0x81C, 0xF50E0303, + 0x81C, 0xF4100303, + 0x81C, 0xF3120303, + 0x81C, 0xF2140303, + 0x81C, 0xF1160303, + 0x81C, 0xF0180303, + 0x81C, 0xEF1A0303, + 0x81C, 0xEE1C0303, + 0x81C, 0xED1E0303, + 0x81C, 0xEC200303, + 0x81C, 0xEB220303, + 0x81C, 0xEA240303, + 0x81C, 0xE9260303, + 0x81C, 0xE8280303, + 0x81C, 0xE72A0303, + 0x81C, 0xE62C0303, + 0x81C, 0xE52E0303, + 0x81C, 0xE4300303, + 0x81C, 0xE3320303, + 0x81C, 0xE2340303, + 0x81C, 0xE1360303, + 0x81C, 0xC4380303, + 0x81C, 0xC33A0303, + 0x81C, 0xC23C0303, + 0x81C, 0xC13E0303, + 0x81C, 0xA5400303, + 0x81C, 0xA4420303, + 0x81C, 0xA3440303, + 0x81C, 0xA2460303, + 0x81C, 0xA1480303, + 0x81C, 0x834A0303, + 0x81C, 0x824C0303, + 0x81C, 0x814E0303, + 0x81C, 0x64500303, + 0x81C, 0x63520303, + 0x81C, 0x62540303, + 0x81C, 0x61560303, + 0x81C, 0x24580303, + 0x81C, 0x235A0303, + 0x81C, 0x225C0303, + 0x81C, 0x215E0303, + 0x81C, 0x04600303, + 0x81C, 0x03620303, + 0x81C, 0x02640303, + 0x81C, 0x01660303, + 0x81C, 0x01680303, + 0x81C, 0x016A0303, + 0x81C, 0x016C0303, + 0x81C, 0x016E0303, + 0x81C, 0x01700303, + 0x81C, 0x01720303, + 0x81C, 0x01740303, + 0x81C, 0x01760303, + 0x81C, 0x01780303, + 0x81C, 0x017A0303, + 0x81C, 0x017C0303, + 0x81C, 0x017E0303, + 0xB0000000, 0x00000000, + 0x80001004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000803, + 0x81C, 0xFB020803, + 0x81C, 0xFA040803, + 0x81C, 0xF9060803, + 0x81C, 0xF8080803, + 0x81C, 0xF70A0803, + 0x81C, 0xF60C0803, + 0x81C, 0xF50E0803, + 0x81C, 0xF4100803, + 0x81C, 0xF3120803, + 0x81C, 0xF2140803, + 0x81C, 0xF1160803, + 0x81C, 0xF0180803, + 0x81C, 0xEF1A0803, + 0x81C, 0xEE1C0803, + 0x81C, 0xED1E0803, + 0x81C, 0xB5200803, + 0x81C, 0xB4220803, + 0x81C, 0xB3240803, + 0x81C, 0xB2260803, + 0x81C, 0xB1280803, + 0x81C, 0xB02A0803, + 0x81C, 0xAF2C0803, + 0x81C, 0xAE2E0803, + 0x81C, 0xAD300803, + 0x81C, 0xAC320803, + 0x81C, 0xAB340803, + 0x81C, 0xAA360803, + 0x81C, 0xA9380803, + 0x81C, 0xA83A0803, + 0x81C, 0xA73C0803, + 0x81C, 0xA63E0803, + 0x81C, 0x88400803, + 0x81C, 0x87420803, + 0x81C, 0x86440803, + 0x81C, 0x85460803, + 0x81C, 0x84480803, + 0x81C, 0x834A0803, + 0x81C, 0x674C0803, + 0x81C, 0x664E0803, + 0x81C, 0x65500803, + 0x81C, 0x64520803, + 0x81C, 0x63540803, + 0x81C, 0x62560803, + 0x81C, 0x61580803, + 0x81C, 0x455A0803, + 0x81C, 0x445C0803, + 0x81C, 0x435E0803, + 0x81C, 0x42600803, + 0x81C, 0x41620803, + 0x81C, 0x25640803, + 0x81C, 0x24660803, + 0x81C, 0x23680803, + 0x81C, 0x226A0803, + 0x81C, 0x216C0803, + 0x81C, 0x016E0803, + 0x81C, 0x01700803, + 0x81C, 0x01720803, + 0x81C, 0x01740803, + 0x81C, 0x01760803, + 0x81C, 0x01780803, + 0x81C, 0x017A0803, + 0x81C, 0x017C0803, + 0x81C, 0x017E0803, + 0x90001005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000803, + 0x81C, 0xFB020803, + 0x81C, 0xFA040803, + 0x81C, 0xF9060803, + 0x81C, 0xF8080803, + 0x81C, 0xF70A0803, + 0x81C, 0xF60C0803, + 0x81C, 0xF50E0803, + 0x81C, 0xF4100803, + 0x81C, 0xF3120803, + 0x81C, 0xF2140803, + 0x81C, 0xF1160803, + 0x81C, 0xF0180803, + 0x81C, 0xEF1A0803, + 0x81C, 0xEE1C0803, + 0x81C, 0xED1E0803, + 0x81C, 0xB5200803, + 0x81C, 0xB4220803, + 0x81C, 0xB3240803, + 0x81C, 0xB2260803, + 0x81C, 0xB1280803, + 0x81C, 0xB02A0803, + 0x81C, 0xAF2C0803, + 0x81C, 0xAE2E0803, + 0x81C, 0xAD300803, + 0x81C, 0xAC320803, + 0x81C, 0xAB340803, + 0x81C, 0xAA360803, + 0x81C, 0xA9380803, + 0x81C, 0xA83A0803, + 0x81C, 0xA73C0803, + 0x81C, 0xA63E0803, + 0x81C, 0x88400803, + 0x81C, 0x87420803, + 0x81C, 0x86440803, + 0x81C, 0x85460803, + 0x81C, 0x84480803, + 0x81C, 0x834A0803, + 0x81C, 0x674C0803, + 0x81C, 0x664E0803, + 0x81C, 0x65500803, + 0x81C, 0x64520803, + 0x81C, 0x63540803, + 0x81C, 0x62560803, + 0x81C, 0x61580803, + 0x81C, 0x455A0803, + 0x81C, 0x445C0803, + 0x81C, 0x435E0803, + 0x81C, 0x42600803, + 0x81C, 0x41620803, + 0x81C, 0x25640803, + 0x81C, 0x24660803, + 0x81C, 0x23680803, + 0x81C, 0x226A0803, + 0x81C, 0x216C0803, + 0x81C, 0x016E0803, + 0x81C, 0x01700803, + 0x81C, 0x01720803, + 0x81C, 0x01740803, + 0x81C, 0x01760803, + 0x81C, 0x01780803, + 0x81C, 0x017A0803, + 0x81C, 0x017C0803, + 0x81C, 0x017E0803, + 0xA0000000, 0x00000000, + 0x81C, 0xFC000803, + 0x81C, 0xFB020803, + 0x81C, 0xFA040803, + 0x81C, 0xF9060803, + 0x81C, 0xF8080803, + 0x81C, 0xF70A0803, + 0x81C, 0xF60C0803, + 0x81C, 0xF50E0803, + 0x81C, 0xF4100803, + 0x81C, 0xF3120803, + 0x81C, 0xF2140803, + 0x81C, 0xF1160803, + 0x81C, 0xF0180803, + 0x81C, 0xEF1A0803, + 0x81C, 0xEE1C0803, + 0x81C, 0xED1E0803, + 0x81C, 0xB5200803, + 0x81C, 0xB4220803, + 0x81C, 0xB3240803, + 0x81C, 0xB2260803, + 0x81C, 0xB1280803, + 0x81C, 0xB02A0803, + 0x81C, 0xAF2C0803, + 0x81C, 0xAE2E0803, + 0x81C, 0xAD300803, + 0x81C, 0xAC320803, + 0x81C, 0xAB340803, + 0x81C, 0xAA360803, + 0x81C, 0xA9380803, + 0x81C, 0xA83A0803, + 0x81C, 0xA73C0803, + 0x81C, 0xA63E0803, + 0x81C, 0x88400803, + 0x81C, 0x87420803, + 0x81C, 0x86440803, + 0x81C, 0x85460803, + 0x81C, 0x84480803, + 0x81C, 0x834A0803, + 0x81C, 0x674C0803, + 0x81C, 0x664E0803, + 0x81C, 0x65500803, + 0x81C, 0x64520803, + 0x81C, 0x63540803, + 0x81C, 0x62560803, + 0x81C, 0x61580803, + 0x81C, 0x455A0803, + 0x81C, 0x445C0803, + 0x81C, 0x435E0803, + 0x81C, 0x42600803, + 0x81C, 0x41620803, + 0x81C, 0x25640803, + 0x81C, 0x24660803, + 0x81C, 0x23680803, + 0x81C, 0x226A0803, + 0x81C, 0x216C0803, + 0x81C, 0x016E0803, + 0x81C, 0x01700803, + 0x81C, 0x01720803, + 0x81C, 0x01740803, + 0x81C, 0x01760803, + 0x81C, 0x01780803, + 0x81C, 0x017A0803, + 0x81C, 0x017C0803, + 0x81C, 0x017E0803, + 0xB0000000, 0x00000000, + 0x80001004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000913, + 0x81C, 0xFE020913, + 0x81C, 0xFD040913, + 0x81C, 0xFC060913, + 0x81C, 0xFB080913, + 0x81C, 0xFA0A0913, + 0x81C, 0xF90C0913, + 0x81C, 0xF80E0913, + 0x81C, 0xF7100913, + 0x81C, 0xF6120913, + 0x81C, 0xF5140913, + 0x81C, 0xF4160913, + 0x81C, 0xF3180913, + 0x81C, 0xF21A0913, + 0x81C, 0xF11C0913, + 0x81C, 0x941E0913, + 0x81C, 0x93200913, + 0x81C, 0x92220913, + 0x81C, 0x91240913, + 0x81C, 0x90260913, + 0x81C, 0x8F280913, + 0x81C, 0x8E2A0913, + 0x81C, 0x8D2C0913, + 0x81C, 0x8C2E0913, + 0x81C, 0x8B300913, + 0x81C, 0x8A320913, + 0x81C, 0x89340913, + 0x81C, 0x88360913, + 0x81C, 0x87380913, + 0x81C, 0x863A0913, + 0x81C, 0x853C0913, + 0x81C, 0x843E0913, + 0x81C, 0x83400913, + 0x81C, 0x82420913, + 0x81C, 0x81440913, + 0x81C, 0x07460913, + 0x81C, 0x06480913, + 0x81C, 0x054A0913, + 0x81C, 0x044C0913, + 0x81C, 0x034E0913, + 0x81C, 0x02500913, + 0x81C, 0x01520913, + 0x81C, 0x88540903, + 0x81C, 0x87560903, + 0x81C, 0x86580903, + 0x81C, 0x855A0903, + 0x81C, 0x845C0903, + 0x81C, 0x835E0903, + 0x81C, 0x82600903, + 0x81C, 0x81620903, + 0x81C, 0x07640903, + 0x81C, 0x06660903, + 0x81C, 0x05680903, + 0x81C, 0x046A0903, + 0x81C, 0x036C0903, + 0x81C, 0x026E0903, + 0x81C, 0x01700903, + 0x81C, 0x01720903, + 0x81C, 0x01740903, + 0x81C, 0x01760903, + 0x81C, 0x01780903, + 0x81C, 0x017A0903, + 0x81C, 0x017C0903, + 0x81C, 0x017E0903, + 0x90001005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000913, + 0x81C, 0xFE020913, + 0x81C, 0xFD040913, + 0x81C, 0xFC060913, + 0x81C, 0xFB080913, + 0x81C, 0xFA0A0913, + 0x81C, 0xF90C0913, + 0x81C, 0xF80E0913, + 0x81C, 0xF7100913, + 0x81C, 0xF6120913, + 0x81C, 0xF5140913, + 0x81C, 0xF4160913, + 0x81C, 0xF3180913, + 0x81C, 0xF21A0913, + 0x81C, 0xF11C0913, + 0x81C, 0x941E0913, + 0x81C, 0x93200913, + 0x81C, 0x92220913, + 0x81C, 0x91240913, + 0x81C, 0x90260913, + 0x81C, 0x8F280913, + 0x81C, 0x8E2A0913, + 0x81C, 0x8D2C0913, + 0x81C, 0x8C2E0913, + 0x81C, 0x8B300913, + 0x81C, 0x8A320913, + 0x81C, 0x89340913, + 0x81C, 0x88360913, + 0x81C, 0x87380913, + 0x81C, 0x863A0913, + 0x81C, 0x853C0913, + 0x81C, 0x843E0913, + 0x81C, 0x83400913, + 0x81C, 0x82420913, + 0x81C, 0x81440913, + 0x81C, 0x07460913, + 0x81C, 0x06480913, + 0x81C, 0x054A0913, + 0x81C, 0x044C0913, + 0x81C, 0x034E0913, + 0x81C, 0x02500913, + 0x81C, 0x01520913, + 0x81C, 0x88540903, + 0x81C, 0x87560903, + 0x81C, 0x86580903, + 0x81C, 0x855A0903, + 0x81C, 0x845C0903, + 0x81C, 0x835E0903, + 0x81C, 0x82600903, + 0x81C, 0x81620903, + 0x81C, 0x07640903, + 0x81C, 0x06660903, + 0x81C, 0x05680903, + 0x81C, 0x046A0903, + 0x81C, 0x036C0903, + 0x81C, 0x026E0903, + 0x81C, 0x01700903, + 0x81C, 0x01720903, + 0x81C, 0x01740903, + 0x81C, 0x01760903, + 0x81C, 0x01780903, + 0x81C, 0x017A0903, + 0x81C, 0x017C0903, + 0x81C, 0x017E0903, + 0xA0000000, 0x00000000, + 0x81C, 0xFF000913, + 0x81C, 0xFE020913, + 0x81C, 0xFD040913, + 0x81C, 0xFC060913, + 0x81C, 0xFB080913, + 0x81C, 0xFA0A0913, + 0x81C, 0xF90C0913, + 0x81C, 0xF80E0913, + 0x81C, 0xF7100913, + 0x81C, 0xF6120913, + 0x81C, 0xF5140913, + 0x81C, 0xF4160913, + 0x81C, 0xF3180913, + 0x81C, 0xF21A0913, + 0x81C, 0xF11C0913, + 0x81C, 0x941E0913, + 0x81C, 0x93200913, + 0x81C, 0x92220913, + 0x81C, 0x91240913, + 0x81C, 0x90260913, + 0x81C, 0x8F280913, + 0x81C, 0x8E2A0913, + 0x81C, 0x8D2C0913, + 0x81C, 0x8C2E0913, + 0x81C, 0x8B300913, + 0x81C, 0x8A320913, + 0x81C, 0x89340913, + 0x81C, 0x88360913, + 0x81C, 0x87380913, + 0x81C, 0x863A0913, + 0x81C, 0x853C0913, + 0x81C, 0x843E0913, + 0x81C, 0x83400913, + 0x81C, 0x82420913, + 0x81C, 0x81440913, + 0x81C, 0x07460913, + 0x81C, 0x06480913, + 0x81C, 0x054A0913, + 0x81C, 0x044C0913, + 0x81C, 0x034E0913, + 0x81C, 0x02500913, + 0x81C, 0x01520913, + 0x81C, 0x88540903, + 0x81C, 0x87560903, + 0x81C, 0x86580903, + 0x81C, 0x855A0903, + 0x81C, 0x845C0903, + 0x81C, 0x835E0903, + 0x81C, 0x82600903, + 0x81C, 0x81620903, + 0x81C, 0x07640903, + 0x81C, 0x06660903, + 0x81C, 0x05680903, + 0x81C, 0x046A0903, + 0x81C, 0x036C0903, + 0x81C, 0x026E0903, + 0x81C, 0x01700903, + 0x81C, 0x01720903, + 0x81C, 0x01740903, + 0x81C, 0x01760903, + 0x81C, 0x01780903, + 0x81C, 0x017A0903, + 0x81C, 0x017C0903, + 0x81C, 0x017E0903, + 0xB0000000, 0x00000000, + 0x80001004, 0x00000000, 0x40000000, 0x00000000, + 0xC50, 0x00000022, + 0xC50, 0x00000020, + 0x90001005, 0x00000000, 0x40000000, 0x00000000, + 0xC50, 0x00000022, + 0xC50, 0x00000022, + 0xA0000000, 0x00000000, + 0xC50, 0x00000022, + 0xC50, 0x00000020, + 0xB0000000, 0x00000000, + +}; + +RTW_DECL_TABLE_PHY_COND(rtw8821c_agc, rtw_phy_cfg_agc); + +static const u32 rtw8821c_agc_btg_type2[] = { + 0x80001004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000013, + 0x81C, 0xFE020013, + 0x81C, 0xFD040013, + 0x81C, 0xFC060013, + 0x81C, 0xFB080013, + 0x81C, 0xFA0A0013, + 0x81C, 0xF90C0013, + 0x81C, 0xF80E0013, + 0x81C, 0xF7100013, + 0x81C, 0xF6120013, + 0x81C, 0xF5140013, + 0x81C, 0xF4160013, + 0x81C, 0xF3180013, + 0x81C, 0xF21A0013, + 0x81C, 0xF11C0013, + 0x81C, 0xF01E0013, + 0x81C, 0xEF200013, + 0x81C, 0xEE220013, + 0x81C, 0xED240013, + 0x81C, 0xEC260013, + 0x81C, 0xEB280013, + 0x81C, 0xEA2A0013, + 0x81C, 0xE92C0013, + 0x81C, 0xE82E0013, + 0x81C, 0xE7300013, + 0x81C, 0x8B320013, + 0x81C, 0x8A340013, + 0x81C, 0x89360013, + 0x81C, 0x88380013, + 0x81C, 0x873A0013, + 0x81C, 0x863C0013, + 0x81C, 0x853E0013, + 0x81C, 0x84400013, + 0x81C, 0x83420013, + 0x81C, 0x82440013, + 0x81C, 0x81460013, + 0x81C, 0x08480013, + 0x81C, 0x074A0013, + 0x81C, 0x064C0013, + 0x81C, 0x054E0013, + 0x81C, 0x04500013, + 0x81C, 0x03520013, + 0x81C, 0x88540003, + 0x81C, 0x87560003, + 0x81C, 0x86580003, + 0x81C, 0x855A0003, + 0x81C, 0x845C0003, + 0x81C, 0x835E0003, + 0x81C, 0x82600003, + 0x81C, 0x81620003, + 0x81C, 0x07640003, + 0x81C, 0x06660003, + 0x81C, 0x05680003, + 0x81C, 0x046A0003, + 0x81C, 0x036C0003, + 0x81C, 0x026E0003, + 0x81C, 0x01700003, + 0x81C, 0x01720003, + 0x81C, 0x01740003, + 0x81C, 0x01760003, + 0x81C, 0x01780003, + 0x81C, 0x017A0003, + 0x81C, 0x017C0003, + 0x81C, 0x017E0003, + 0x81C, 0xFF000813, + 0x81C, 0xFE020813, + 0x81C, 0xFD040813, + 0x81C, 0xFC060813, + 0x81C, 0xFB080813, + 0x81C, 0xFA0A0813, + 0x81C, 0xF90C0813, + 0x81C, 0xF80E0813, + 0x81C, 0xF7100813, + 0x81C, 0xF6120813, + 0x81C, 0xF5140813, + 0x81C, 0xF4160813, + 0x81C, 0xF3180813, + 0x81C, 0xF21A0813, + 0x81C, 0xF11C0813, + 0x81C, 0x941E0813, + 0x81C, 0x93200813, + 0x81C, 0x92220813, + 0x81C, 0x91240813, + 0x81C, 0x90260813, + 0x81C, 0x8F280813, + 0x81C, 0x8E2A0813, + 0x81C, 0x8D2C0813, + 0x81C, 0x8C2E0813, + 0x81C, 0x8B300813, + 0x81C, 0x8A320813, + 0x81C, 0x89340813, + 0x81C, 0x88360813, + 0x81C, 0x87380813, + 0x81C, 0x863A0813, + 0x81C, 0x853C0813, + 0x81C, 0x843E0813, + 0x81C, 0x83400813, + 0x81C, 0x82420813, + 0x81C, 0x81440813, + 0x81C, 0x07460813, + 0x81C, 0x06480813, + 0x81C, 0x054A0813, + 0x81C, 0x044C0813, + 0x81C, 0x034E0813, + 0x81C, 0x02500813, + 0x81C, 0x01520813, + 0x81C, 0x88540803, + 0x81C, 0x87560803, + 0x81C, 0x86580803, + 0x81C, 0x855A0803, + 0x81C, 0x845C0803, + 0x81C, 0x835E0803, + 0x81C, 0x82600803, + 0x81C, 0x81620803, + 0x81C, 0x07640803, + 0x81C, 0x06660803, + 0x81C, 0x05680803, + 0x81C, 0x046A0803, + 0x81C, 0x036C0803, + 0x81C, 0x026E0803, + 0x81C, 0x01700803, + 0x81C, 0x01720803, + 0x81C, 0x01740803, + 0x81C, 0x01760803, + 0x81C, 0x01780803, + 0x81C, 0x017A0803, + 0x81C, 0x017C0803, + 0x81C, 0x017E0803, + 0x90001005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000013, + 0x81C, 0xFE020013, + 0x81C, 0xFD040013, + 0x81C, 0xFC060013, + 0x81C, 0xFB080013, + 0x81C, 0xFA0A0013, + 0x81C, 0xF90C0013, + 0x81C, 0xF80E0013, + 0x81C, 0xF7100013, + 0x81C, 0xF6120013, + 0x81C, 0xF5140013, + 0x81C, 0xF4160013, + 0x81C, 0xF3180013, + 0x81C, 0xF21A0013, + 0x81C, 0xF11C0013, + 0x81C, 0xF01E0013, + 0x81C, 0xEF200013, + 0x81C, 0xEE220013, + 0x81C, 0xED240013, + 0x81C, 0xEC260013, + 0x81C, 0xEB280013, + 0x81C, 0xEA2A0013, + 0x81C, 0xE92C0013, + 0x81C, 0xE82E0013, + 0x81C, 0xE7300013, + 0x81C, 0x8B320013, + 0x81C, 0x8A340013, + 0x81C, 0x89360013, + 0x81C, 0x88380013, + 0x81C, 0x873A0013, + 0x81C, 0x863C0013, + 0x81C, 0x853E0013, + 0x81C, 0x84400013, + 0x81C, 0x83420013, + 0x81C, 0x82440013, + 0x81C, 0x81460013, + 0x81C, 0x08480013, + 0x81C, 0x074A0013, + 0x81C, 0x064C0013, + 0x81C, 0x054E0013, + 0x81C, 0x04500013, + 0x81C, 0x03520013, + 0x81C, 0x88540003, + 0x81C, 0x87560003, + 0x81C, 0x86580003, + 0x81C, 0x855A0003, + 0x81C, 0x845C0003, + 0x81C, 0x835E0003, + 0x81C, 0x82600003, + 0x81C, 0x81620003, + 0x81C, 0x07640003, + 0x81C, 0x06660003, + 0x81C, 0x05680003, + 0x81C, 0x046A0003, + 0x81C, 0x036C0003, + 0x81C, 0x026E0003, + 0x81C, 0x01700003, + 0x81C, 0x01720003, + 0x81C, 0x01740003, + 0x81C, 0x01760003, + 0x81C, 0x01780003, + 0x81C, 0x017A0003, + 0x81C, 0x017C0003, + 0x81C, 0x017E0003, + 0x81C, 0xFF000813, + 0x81C, 0xFE020813, + 0x81C, 0xFD040813, + 0x81C, 0xFC060813, + 0x81C, 0xFB080813, + 0x81C, 0xFA0A0813, + 0x81C, 0xF90C0813, + 0x81C, 0xF80E0813, + 0x81C, 0xF7100813, + 0x81C, 0xF6120813, + 0x81C, 0xF5140813, + 0x81C, 0xF4160813, + 0x81C, 0xF3180813, + 0x81C, 0xF21A0813, + 0x81C, 0xF11C0813, + 0x81C, 0x941E0813, + 0x81C, 0x93200813, + 0x81C, 0x92220813, + 0x81C, 0x91240813, + 0x81C, 0x90260813, + 0x81C, 0x8F280813, + 0x81C, 0x8E2A0813, + 0x81C, 0x8D2C0813, + 0x81C, 0x8C2E0813, + 0x81C, 0x8B300813, + 0x81C, 0x8A320813, + 0x81C, 0x89340813, + 0x81C, 0x88360813, + 0x81C, 0x87380813, + 0x81C, 0x863A0813, + 0x81C, 0x853C0813, + 0x81C, 0x843E0813, + 0x81C, 0x83400813, + 0x81C, 0x82420813, + 0x81C, 0x81440813, + 0x81C, 0x07460813, + 0x81C, 0x06480813, + 0x81C, 0x054A0813, + 0x81C, 0x044C0813, + 0x81C, 0x034E0813, + 0x81C, 0x02500813, + 0x81C, 0x01520813, + 0x81C, 0x88540803, + 0x81C, 0x87560803, + 0x81C, 0x86580803, + 0x81C, 0x855A0803, + 0x81C, 0x845C0803, + 0x81C, 0x835E0803, + 0x81C, 0x82600803, + 0x81C, 0x81620803, + 0x81C, 0x07640803, + 0x81C, 0x06660803, + 0x81C, 0x05680803, + 0x81C, 0x046A0803, + 0x81C, 0x036C0803, + 0x81C, 0x026E0803, + 0x81C, 0x01700803, + 0x81C, 0x01720803, + 0x81C, 0x01740803, + 0x81C, 0x01760803, + 0x81C, 0x01780803, + 0x81C, 0x017A0803, + 0x81C, 0x017C0803, + 0x81C, 0x017E0803, + 0xA0000000, 0x00000000, + 0x81C, 0xFF000013, + 0x81C, 0xFE020013, + 0x81C, 0xFD040013, + 0x81C, 0xFC060013, + 0x81C, 0xFB080013, + 0x81C, 0xFA0A0013, + 0x81C, 0xF90C0013, + 0x81C, 0xF80E0013, + 0x81C, 0xF7100013, + 0x81C, 0xF6120013, + 0x81C, 0xF5140013, + 0x81C, 0xF4160013, + 0x81C, 0xF3180013, + 0x81C, 0xF21A0013, + 0x81C, 0xF11C0013, + 0x81C, 0xF01E0013, + 0x81C, 0xEF200013, + 0x81C, 0xEE220013, + 0x81C, 0xED240013, + 0x81C, 0xEC260013, + 0x81C, 0xEB280013, + 0x81C, 0xEA2A0013, + 0x81C, 0xE92C0013, + 0x81C, 0xE82E0013, + 0x81C, 0xE7300013, + 0x81C, 0x8A320013, + 0x81C, 0x89340013, + 0x81C, 0x88360013, + 0x81C, 0x87380013, + 0x81C, 0x863A0013, + 0x81C, 0x853C0013, + 0x81C, 0x843E0013, + 0x81C, 0x83400013, + 0x81C, 0x82420013, + 0x81C, 0x81440013, + 0x81C, 0x07460013, + 0x81C, 0x06480013, + 0x81C, 0x054A0013, + 0x81C, 0x044C0013, + 0x81C, 0x034E0013, + 0x81C, 0x02500013, + 0x81C, 0x01520013, + 0x81C, 0x88540003, + 0x81C, 0x87560003, + 0x81C, 0x86580003, + 0x81C, 0x855A0003, + 0x81C, 0x845C0003, + 0x81C, 0x835E0003, + 0x81C, 0x82600003, + 0x81C, 0x81620003, + 0x81C, 0x07640003, + 0x81C, 0x06660003, + 0x81C, 0x05680003, + 0x81C, 0x046A0003, + 0x81C, 0x036C0003, + 0x81C, 0x026E0003, + 0x81C, 0x01700003, + 0x81C, 0x01720003, + 0x81C, 0x01740003, + 0x81C, 0x01760003, + 0x81C, 0x01780003, + 0x81C, 0x017A0003, + 0x81C, 0x017C0003, + 0x81C, 0x017E0003, + 0x81C, 0xFF000813, + 0x81C, 0xFE020813, + 0x81C, 0xFD040813, + 0x81C, 0xFC060813, + 0x81C, 0xFB080813, + 0x81C, 0xFA0A0813, + 0x81C, 0xF90C0813, + 0x81C, 0xF80E0813, + 0x81C, 0xF7100813, + 0x81C, 0xF6120813, + 0x81C, 0xF5140813, + 0x81C, 0xF4160813, + 0x81C, 0xF3180813, + 0x81C, 0xF21A0813, + 0x81C, 0xF11C0813, + 0x81C, 0x961E0813, + 0x81C, 0x95200813, + 0x81C, 0x94220813, + 0x81C, 0x93240813, + 0x81C, 0x92260813, + 0x81C, 0x91280813, + 0x81C, 0x8F2A0813, + 0x81C, 0x8E2C0813, + 0x81C, 0x8D2E0813, + 0x81C, 0x8C300813, + 0x81C, 0x8B320813, + 0x81C, 0x8A340813, + 0x81C, 0x89360813, + 0x81C, 0x88380813, + 0x81C, 0x873A0813, + 0x81C, 0x863C0813, + 0x81C, 0x853E0813, + 0x81C, 0x84400813, + 0x81C, 0x83420813, + 0x81C, 0x82440813, + 0x81C, 0x08460813, + 0x81C, 0x07480813, + 0x81C, 0x064A0813, + 0x81C, 0x054C0813, + 0x81C, 0x044E0813, + 0x81C, 0x03500813, + 0x81C, 0x02520813, + 0x81C, 0x89540803, + 0x81C, 0x88560803, + 0x81C, 0x87580803, + 0x81C, 0x865A0803, + 0x81C, 0x855C0803, + 0x81C, 0x845E0803, + 0x81C, 0x83600803, + 0x81C, 0x82620803, + 0x81C, 0x07640803, + 0x81C, 0x06660803, + 0x81C, 0x05680803, + 0x81C, 0x046A0803, + 0x81C, 0x036C0803, + 0x81C, 0x026E0803, + 0x81C, 0x01700803, + 0x81C, 0x01720803, + 0x81C, 0x01740803, + 0x81C, 0x01760803, + 0x81C, 0x01780803, + 0x81C, 0x017A0803, + 0x81C, 0x017C0803, + 0x81C, 0x017E0803, + 0xB0000000, 0x00000000, +}; + +RTW_DECL_TABLE_PHY_COND(rtw8821c_agc_btg_type2, rtw_phy_cfg_agc); + +static const u32 rtw8821c_bb[] = { + 0x800, 0x9020D010, + 0x804, 0x80018180, + 0x808, 0x04028211, + 0x80C, 0x13D10011, + 0x810, 0x21104255, + 0x814, 0x020C3D10, + 0x818, 0x84A10385, + 0x81C, 0x1E1E081F, + 0x820, 0x0001AAAA, + 0x824, 0x00030FE0, + 0x828, 0x0000CCCC, + 0x82C, 0x75CB7010, + 0x830, 0x79A0EAAA, + 0x834, 0x072E698A, + 0x838, 0x87766461, + 0x83C, 0x9194B2B6, + 0x840, 0x171740E0, + 0x844, 0x4D3D7CDB, + 0x848, 0x4AD0408B, + 0x84C, 0x6AFBF7A5, + 0x850, 0x28A74706, + 0x854, 0x0001520C, + 0x858, 0x4060C000, + 0x85C, 0x74010160, + 0x860, 0x68A7C321, + 0x864, 0x79F27432, + 0x868, 0x8CA7A314, + 0x86C, 0x558C2878, + 0x870, 0x55555555, + 0x874, 0x27612C2E, + 0x878, 0xC0003152, + 0x87C, 0x5C8FC000, + 0x880, 0x00000000, + 0x884, 0x00000000, + 0x888, 0x00000000, + 0x88C, 0x00000000, + 0x890, 0x00000000, + 0x894, 0x00000000, + 0x898, 0x00000000, + 0x89C, 0x00000000, + 0x8A0, 0x00000013, + 0x8A4, 0x7F7F7F7F, + 0x8A8, 0x2202033E, + 0x8AC, 0xF00F000A, + 0x8B0, 0x00000600, + 0x8B4, 0x000FC080, + 0x8B8, 0xEC0057FF, + 0x8BC, 0x2CB520A3, + 0x8C0, 0xFFE04020, + 0x8C4, 0x47C00000, + 0x8C8, 0x00025165, + 0x82000400, 0x00000000, 0x40000000, 0x00000000, + 0x8CC, 0x08190492, + 0xA0000000, 0x00000000, + 0x8CC, 0x08188492, + 0xB0000000, 0x00000000, + 0x8D0, 0x0000B800, + 0x8D4, 0x860308A0, + 0x8D8, 0x290B5612, + 0x8DC, 0x00000000, + 0x8E0, 0x32D16777, + 0x8E4, 0x49092925, + 0x8E8, 0xFFFFC42C, + 0x8EC, 0x99999999, + 0x8F0, 0x00009999, + 0x8F4, 0x00D80FA1, + 0x8F8, 0x400000C0, + 0x8FC, 0x00000130, + 0x900, 0x00C00000, + 0x904, 0x0FFF0FFF, + 0x908, 0x00000000, + 0x90C, 0x13000000, + 0x910, 0x0000FC00, + 0x914, 0xC6380000, + 0x918, 0x1C1028C0, + 0x91C, 0x64B11A1C, + 0x920, 0xE0767233, + 0x924, 0x855A2500, + 0x928, 0x4AB0E4E4, + 0x92C, 0xFFFEB200, + 0x930, 0xFFFFFFFE, + 0x934, 0x001FFFFF, + 0x938, 0x00008480, + 0x93C, 0xE41C0642, + 0x940, 0x0E470430, + 0x944, 0x00000000, + 0x948, 0xAC000000, + 0x94C, 0x10000083, + 0x950, 0xB2010080, + 0x954, 0x86510080, + 0x958, 0x00000181, + 0x95C, 0x04248000, + 0x960, 0x00000000, + 0x964, 0x00000000, + 0x968, 0x00000000, + 0x96C, 0x00000000, + 0x970, 0x00001FFF, + 0x974, 0x04000FFF, + 0x978, 0x00000000, + 0x97C, 0x00000000, + 0x980, 0x00000000, + 0x984, 0x00000000, + 0x988, 0x00000000, + 0x98C, 0x23440000, + 0x990, 0x27100000, + 0x994, 0xFFFF0100, + 0x998, 0xFFFFFF5C, + 0x99C, 0xFFFFFFFF, + 0x9A0, 0x000000FF, + 0x9A4, 0x80000088, + 0x9A8, 0x0C2F0000, + 0x9AC, 0x01560000, + 0x9B0, 0x70000000, + 0x9B4, 0x00000000, + 0x9B8, 0x00000000, + 0x9BC, 0x00000000, + 0x9C0, 0x00000000, + 0x9C4, 0x00000000, + 0x9C8, 0x00000000, + 0x9CC, 0x00000000, + 0x9D0, 0x00000000, + 0x9D4, 0x00000000, + 0x9D8, 0x00000000, + 0x9DC, 0x00000000, + 0x9E0, 0x00000000, + 0x9E4, 0x02000402, + 0x9E8, 0x000022D4, + 0x9EC, 0x00000000, + 0x9F0, 0x00000000, + 0x9F4, 0x00000000, + 0x9F8, 0x00000000, + 0x9FC, 0xEFFFF7FF, + 0xA00, 0x00D040C8, + 0xA04, 0x80FF800C, + 0xA08, 0x9C838300, + 0xA0C, 0x297E000F, + 0xA10, 0x9500BB78, + 0xA14, 0x1114D028, + 0xA18, 0x00881117, + 0xA1C, 0x89140F00, + 0xA20, 0xE82C0000, + 0xA24, 0x64B80C1C, + 0xA28, 0x00008810, + 0xA2C, 0x00D20000, + 0xA70, 0x101FBF00, + 0xA74, 0x00000107, + 0xA78, 0x00008900, + 0xA7C, 0x225B0606, + 0xA80, 0x21807532, + 0xA84, 0x80120000, + 0xA88, 0x048C0000, + 0xA8C, 0x12345678, + 0xA90, 0xABCDEF00, + 0xA94, 0x001B1B89, + 0xA98, 0x00000000, + 0xA9C, 0x3F000000, + 0xAA0, 0x00000000, + 0xAA4, 0x00080000, + 0xAA8, 0xEACF0004, + 0xAAC, 0x01235667, + 0xAB0, 0x00000000, + 0xB00, 0xE1000440, + 0xB04, 0x00800000, + 0xB08, 0xFF02030B, + 0xB0C, 0x01EAA406, + 0xB10, 0x00030690, + 0xB14, 0x006000FA, + 0xB18, 0x00000002, + 0xB1C, 0x00000002, + 0xB20, 0x4B00001F, + 0xB24, 0x4E8E3E40, + 0xB28, 0x03020100, + 0xB2C, 0x07060504, + 0xB30, 0x0B0A0908, + 0xB34, 0x0F0E0D0C, + 0xB38, 0x13121110, + 0xB3C, 0x0000003A, + 0xB40, 0x00000000, + 0xB44, 0x80000000, + 0xB48, 0x3F0000FA, + 0xB4C, 0x88C80020, + 0xB50, 0x00000000, + 0xB54, 0x00004241, + 0xB58, 0xE0008208, + 0xB5C, 0x41EFFFF9, + 0xB60, 0x00000000, + 0xB64, 0x00200063, + 0xB68, 0x0000003A, + 0xB6C, 0x00000102, + 0xB70, 0x4E6D1870, + 0xB74, 0x03020100, + 0xB78, 0x07060504, + 0xB7C, 0x0B0A0908, + 0xB80, 0x0F0E0D0C, + 0xB84, 0x13121110, + 0xB88, 0x00000000, + 0xB8C, 0x00000000, + 0xC00, 0x00000007, + 0xC04, 0x03050020, + 0xC08, 0x60403231, + 0xC0C, 0x00012345, + 0xC10, 0x00000100, + 0xC14, 0x01000000, + 0xC18, 0x00000000, + 0xC1C, 0x40040053, + 0xC20, 0x400503A3, + 0xC24, 0x00000000, + 0xC28, 0x00000000, + 0xC2C, 0x00000000, + 0xC30, 0x00000000, + 0xC34, 0x00000000, + 0xC38, 0x00000000, + 0xC3C, 0x00000000, + 0xC40, 0x00000000, + 0xC44, 0x00000000, + 0xC48, 0x00000000, + 0xC4C, 0x00000000, + 0xC50, 0x00000020, + 0xC54, 0x00000000, + 0xC58, 0xD8020402, + 0xC5C, 0xDE000120, + 0xC68, 0x0000003F, + 0xC6C, 0x0000122A, + 0xC70, 0x00000000, + 0xC74, 0x00000000, + 0xC78, 0x00000000, + 0xC7C, 0x00000000, + 0xC80, 0x00000000, + 0xC84, 0x00000000, + 0xC88, 0x00000000, + 0xC8C, 0x07000000, + 0xC94, 0x01000100, + 0xC98, 0x201C8000, + 0xC9C, 0x00000000, + 0xCA0, 0x0000A555, + 0xCA4, 0x08040201, + 0xCA8, 0x80402010, + 0xCAC, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0xCB0, 0x77777717, + 0xCB4, 0x00000073, + 0xA0000000, 0x00000000, + 0xCB0, 0x77775747, + 0xCB4, 0x10000077, + 0xB0000000, 0x00000000, + 0xCB8, 0x00000000, + 0xCBC, 0x00000000, + 0xCC0, 0x00000000, + 0xCC4, 0x00000000, + 0xCC8, 0x00000000, + 0xCCC, 0x00000000, + 0xCD0, 0x00000000, + 0xCD4, 0x00000000, + 0xCD8, 0x00000000, + 0xCDC, 0x00000000, + 0xCE0, 0x00000000, + 0xCE4, 0x00000000, + 0xCE8, 0x00000000, + 0xCEC, 0x00000000, + 0xE00, 0x00000007, + 0xE04, 0x00000020, + 0xE08, 0x60403231, + 0xE0C, 0x00012345, + 0xE10, 0x00000100, + 0xE14, 0x01000000, + 0xE18, 0x00000000, + 0xE1C, 0x40040053, + 0xE20, 0x00020103, + 0xE24, 0x00000000, + 0xE28, 0x00000000, + 0xE2C, 0x00000000, + 0xE30, 0x00000000, + 0xE34, 0x00000000, + 0xE38, 0x00000000, + 0xE3C, 0x00000000, + 0xE40, 0x00000000, + 0xE44, 0x00000000, + 0xE48, 0x00000000, + 0xE4C, 0x00000000, + 0xE50, 0x00000020, + 0xE54, 0x00000000, + 0xE58, 0xD8020402, + 0xE5C, 0xDE000120, + 0xE68, 0x59799979, + 0xE6C, 0x0000122A, + 0xE70, 0x99795979, + 0xE74, 0x99795979, + 0xE78, 0x99799979, + 0xE7C, 0x99791979, + 0xE80, 0x19791979, + 0xE84, 0x19791979, + 0xE88, 0x00000000, + 0xE8C, 0x07000000, + 0xE94, 0x01000100, + 0xE98, 0x201C8000, + 0xE9C, 0x00000000, + 0xEA0, 0x0000A555, + 0xEA4, 0x08040201, + 0xEA8, 0x80402010, + 0xEAC, 0x00000000, + 0xEB0, 0x98543210, + 0xEB4, 0x000000BA, + 0xEB8, 0x00000000, + 0xEBC, 0x00000000, + 0xEC0, 0x00000000, + 0xEC4, 0x00000000, + 0xEC8, 0x00000000, + 0xECC, 0x00000000, + 0xED0, 0x00000000, + 0xED4, 0x00000000, + 0xED8, 0x00000000, + 0xEDC, 0x00000000, + 0xEE0, 0x00000000, + 0xEE4, 0x00000000, + 0xEE8, 0x00000000, + 0xEEC, 0x00000000, + 0x1900, 0x00000000, + 0x1904, 0x00238000, + 0x1908, 0x00000000, + 0x190C, 0x00000000, + 0x1910, 0x00001800, + 0x1914, 0x00000000, + 0x1918, 0x00000000, + 0x191C, 0x00000000, + 0x1920, 0x00000000, + 0x1924, 0x00000000, + 0x1928, 0x00000000, + 0x192C, 0x00000000, + 0x1930, 0x00000000, + 0x1934, 0x00000000, + 0x1938, 0x00000000, + 0x193C, 0x00000000, + 0x1940, 0x00000000, + 0x1944, 0x00000000, + 0x1948, 0x00000000, + 0x194C, 0x00000000, + 0x1950, 0x00000000, + 0x1954, 0x00000000, + 0x1958, 0x00000000, + 0x195C, 0x00000000, + 0x1960, 0x00000000, + 0x1964, 0x00000000, + 0x1968, 0x00000000, + 0x196C, 0x00000000, + 0x1970, 0x00000000, + 0x1974, 0x00000000, + 0x1978, 0x00000000, + 0x197C, 0x00000000, + 0x1980, 0x00000000, + 0x1984, 0x03000000, + 0x1988, 0x21401E88, + 0x198C, 0x00004000, + 0x1990, 0x00000000, + 0x1994, 0x00000000, + 0x1998, 0x00000053, + 0x199C, 0x00000000, + 0x19A0, 0x00000000, + 0x19A4, 0x00000000, + 0x19A8, 0x010A0000, + 0x19AC, 0x0E47E47F, + 0x19B0, 0x00008000, + 0x19B4, 0x0E47E47F, + 0x19B8, 0x00000000, + 0x19BC, 0x00000000, + 0x19C0, 0x00000000, + 0x19C4, 0x00000000, + 0x19C8, 0x00000000, + 0x19CC, 0x00000000, + 0x19D0, 0x00000000, + 0x19D4, 0x77777777, + 0x19D8, 0x00000777, + 0x19DC, 0x133E0F37, + 0x19E0, 0x00000000, + 0x19E4, 0x00000000, + 0x19E8, 0x00000000, + 0x19EC, 0x00000000, + 0x19F0, 0x00000000, + 0x19F4, 0x00000000, + 0x19F8, 0x01A00000, + 0x19FC, 0x00000000, + 0x1C00, 0x00000100, + 0x1C04, 0x01000000, + 0x1C08, 0x00000100, + 0x1C0C, 0x01000000, + 0x1C10, 0x00000100, + 0x1C14, 0x01000000, + 0x1C18, 0x00000100, + 0x1C1C, 0x01000000, + 0x1C20, 0x00000100, + 0x1C24, 0x01000000, + 0x1C28, 0x00000100, + 0x1C2C, 0x01000000, + 0x1C30, 0x00000100, + 0x1C34, 0x01000000, + 0x1C38, 0x00000000, + 0x1C3C, 0x00008000, + 0x1C40, 0x000C0100, + 0x1C44, 0x000000F3, + 0x1C48, 0x1A8249A8, + 0x1C4C, 0x1461C826, + 0x1C50, 0x0001469E, + 0x1C54, 0x58D158D1, + 0x1C58, 0x04490088, + 0x1C5C, 0x04004400, + 0x1C60, 0x00000000, + 0x1C64, 0x04004400, + 0x1C68, 0x0B7B7B75, + 0x1C6C, 0x01000000, + 0x1C70, 0x00A08145, + 0x1C74, 0x2080E0E0, + 0x1C78, 0x00000000, + 0x1C7C, 0x00000010, + 0x1C80, 0x00000100, + 0x1C84, 0x01000000, + 0x1C88, 0x00000100, + 0x1C8C, 0x01000000, + 0x1C90, 0x00000100, + 0x1C94, 0x01000000, + 0x1C98, 0x00000100, + 0x1C9C, 0x01000000, + 0x1CA0, 0x00000100, + 0x1CA4, 0x01000000, + 0x1CA8, 0x00000100, + 0x1CAC, 0x01000000, + 0x1CB0, 0x00000100, + 0x1CB4, 0x01000000, + 0x1CB8, 0x00000000, + 0x1CBC, 0x00000000, + 0x1CC0, 0x201B0100, + 0x1CC4, 0x00308000, + 0x1CC8, 0x5B74B6E9, + 0x1CCC, 0x01000000, + 0x1CD0, 0x00000400, + 0x1CD4, 0x01000000, + 0x1CD8, 0x01B8ADEB, + 0x1CDC, 0x01000000, + 0x1CE0, 0x00030003, + 0x1CE4, 0x4E4A0306, + 0x1CE8, 0x00000100, + 0x1CEC, 0x01000000, + 0x1CF0, 0x00000100, + 0x1CF4, 0x01000000, + 0x1CF8, 0x01B8ADEB, + 0x1CFC, 0x00000000, + 0xC60, 0x700B8040, + 0xC60, 0x700B8040, + 0xC60, 0x70146040, + 0xC60, 0x70246040, + 0xC60, 0x70346040, + 0xC60, 0x70446040, + 0xC60, 0x705B2040, + 0xC60, 0x70646040, + 0xC60, 0x707B8040, + 0xC60, 0x708B8040, + 0xC60, 0x709B8040, + 0xC60, 0x70AB8040, + 0xC60, 0x70BB6040, + 0xC60, 0x70C06040, + 0xC60, 0x70D06040, + 0xC60, 0x70EF6040, + 0xC60, 0x70F06040, + 0xE60, 0x700B8040, + 0xE60, 0x700B8040, + 0xE60, 0x70146040, + 0xE60, 0x70246040, + 0xE60, 0x70346040, + 0xE60, 0x70446040, + 0xE60, 0x705B2040, + 0xE60, 0x70646040, + 0xE60, 0x707B8040, + 0xE60, 0x708B8040, + 0xE60, 0x709B8040, + 0xE60, 0x70AB8040, + 0xE60, 0x70BB6040, + 0xE60, 0x70C06040, + 0xE60, 0x70D06040, + 0xE60, 0x70EF6040, + 0xE60, 0x70F06040, + 0xC64, 0x00800000, + 0xC64, 0x08800001, + 0xC64, 0x00800002, + 0xC64, 0x00800003, + 0xC64, 0x00800004, + 0xC64, 0x00800005, + 0xC64, 0x00800006, + 0xC64, 0x08800007, + 0xC64, 0x00004000, + 0xE64, 0x00800000, + 0xE64, 0x08800001, + 0xE64, 0x00800002, + 0xE64, 0x00800003, + 0xE64, 0x00800004, + 0xE64, 0x00800005, + 0xE64, 0x00800006, + 0xE64, 0x08800007, + 0xE64, 0x00004000, + 0x1B00, 0xF8000008, + 0x1B00, 0xF80A7008, + 0x1B00, 0xF8015008, + 0x1B00, 0xF8000008, + 0x1B04, 0xE24629D2, + 0x1B08, 0x00000080, + 0x1B0C, 0x00000000, + 0x1B10, 0x00011C00, + 0x1B14, 0x00000000, + 0x1B18, 0x00292903, + 0x1B1C, 0xA2193C32, + 0x1B20, 0x01840008, + 0x1B24, 0x01860008, + 0x1B28, 0x80060300, + 0x1B2C, 0x00000003, + 0x1B30, 0x20000000, + 0x1B34, 0x00000800, + 0x1B3C, 0x20000000, + 0x1BC0, 0x01000000, + 0x1BCC, 0x00000000, + 0x1B90, 0x0001E018, + 0x1B94, 0xF76D9F84, + 0x1BC8, 0x000C44AA, + 0x1BCC, 0x11978200, + 0x1B8C, 0x00002000, + 0x1B9C, 0x5B554F48, + 0x1BA0, 0x6F6B6661, + 0x1BA4, 0x817D7874, + 0x1BA8, 0x908C8884, + 0x1BAC, 0x9D9A9793, + 0x1BB0, 0xAAA7A4A1, + 0x1BB4, 0xB6B3B0AD, + 0x1B40, 0x02CE03E8, + 0x1B44, 0x01FD024C, + 0x1B48, 0x01A101C9, + 0x1B4C, 0x016A0183, + 0x1B50, 0x01430153, + 0x1B54, 0x01280134, + 0x1B58, 0x0112011C, + 0x1B5C, 0x01000107, + 0x1B60, 0x00F200F9, + 0x1B64, 0x00E500EB, + 0x1B68, 0x00DA00E0, + 0x1B6C, 0x00D200D6, + 0x1B70, 0x00C900CD, + 0x1B74, 0x00C200C5, + 0x1B78, 0x00BB00BE, + 0x1B7C, 0x00B500B8, + 0x1BDC, 0x40CAFFE1, + 0x1BDC, 0x4080A1E3, + 0x1BDC, 0x405165E5, + 0x1BDC, 0x403340E7, + 0x1BDC, 0x402028E9, + 0x1BDC, 0x401419EB, + 0x1BDC, 0x400D10ED, + 0x1BDC, 0x40080AEF, + 0x1BDC, 0x400506F1, + 0x1BDC, 0x400304F3, + 0x1BDC, 0x400203F5, + 0x1BDC, 0x400102F7, + 0x1BDC, 0x400101F9, + 0x1BDC, 0x400101FB, + 0x1BDC, 0x400101FD, + 0x1BDC, 0x400101FF, + 0x1BDC, 0x40CAFF81, + 0x1BDC, 0x4080A183, + 0x1BDC, 0x40516585, + 0x1BDC, 0x40334087, + 0x1BDC, 0x40202889, + 0x1BDC, 0x4014198B, + 0x1BDC, 0x400D108D, + 0x1BDC, 0x40080A8F, + 0x1BDC, 0x40050691, + 0x1BDC, 0x40030493, + 0x1BDC, 0x40020395, + 0x1BDC, 0x40010297, + 0x1BDC, 0x40010199, + 0x1BDC, 0x4001019B, + 0x1BDC, 0x4001019D, + 0x1BDC, 0x4001019F, + 0x1BDC, 0x00000000, + 0x1BDC, 0xD0000001, + 0x1BDC, 0xD0000003, + 0x1BDC, 0xD0000005, + 0x1BDC, 0xD0000007, + 0x1BDC, 0xD0000009, + 0x1BDC, 0xD000000B, + 0x1BDC, 0xD000000D, + 0x1BDC, 0xD000000F, + 0x1BDC, 0xD0000011, + 0x1BDC, 0xD0000013, + 0x1BDC, 0xD0000015, + 0x1BDC, 0xD0000017, + 0x1BDC, 0xD0000019, + 0x1BDC, 0xD000001B, + 0x1BDC, 0xD000001D, + 0x1BDC, 0xD000001F, + 0x1BDC, 0xD0000021, + 0x1BDC, 0xD0000023, + 0x1BDC, 0xD0000025, + 0x1BDC, 0xD0000027, + 0x1BDC, 0xD0000029, + 0x1BDC, 0xD000002B, + 0x1BDC, 0xD000002D, + 0x1BDC, 0xD000002F, + 0x1BDC, 0xD0000031, + 0x1BDC, 0xD0000033, + 0x1BDC, 0xD0000035, + 0x1BDC, 0xD0000037, + 0x1BDC, 0xD0000039, + 0x1BDC, 0xD000003B, + 0x1BDC, 0xD000003D, + 0x1BDC, 0xD000003F, + 0x1BDC, 0xD0000041, + 0x1BDC, 0xD0000043, + 0x1BDC, 0xD0000045, + 0x1BDC, 0xD0000047, + 0x1BDC, 0xD0000049, + 0x1BDC, 0xD000004B, + 0x1BDC, 0xD000004D, + 0x1BDC, 0xD000004F, + 0x1BDC, 0xD0000051, + 0x1BDC, 0xD0000053, + 0x1BDC, 0xD0000055, + 0x1BDC, 0xD0000057, + 0x1BDC, 0xD0000059, + 0x1BDC, 0xD000005B, + 0x1BDC, 0xD000005D, + 0x1BDC, 0xD000005F, + 0x1BDC, 0xD0000061, + 0x1BDC, 0xD0000063, + 0x1BDC, 0xD0000065, + 0x1BDC, 0xD0000067, + 0x1BDC, 0xD0000069, + 0x1BDC, 0xD000006B, + 0x1BDC, 0xD000006D, + 0x1BDC, 0xD000006F, + 0x1BDC, 0xD0000071, + 0x1BDC, 0xD0000073, + 0x1BDC, 0xD0000075, + 0x1BDC, 0xD0000077, + 0x1BDC, 0xD0000079, + 0x1BDC, 0xD000007B, + 0x1BDC, 0xD000007D, + 0x1BDC, 0xD000007F, + 0x1BDC, 0x90000081, + 0x1BDC, 0x90000083, + 0x1BDC, 0x90000085, + 0x1BDC, 0x90000087, + 0x1BDC, 0x90000089, + 0x1BDC, 0x9000008B, + 0x1BDC, 0x9000008D, + 0x1BDC, 0x9000008F, + 0x1BDC, 0x90000091, + 0x1BDC, 0x90000093, + 0x1BDC, 0x90000095, + 0x1BDC, 0x90000097, + 0x1BDC, 0x90000099, + 0x1BDC, 0x9000009B, + 0x1BDC, 0x9000009D, + 0x1BDC, 0x9000009F, + 0x1BDC, 0x900000A1, + 0x1BDC, 0x900000A3, + 0x1BDC, 0x900000A5, + 0x1BDC, 0x900000A7, + 0x1BDC, 0x900000A9, + 0x1BDC, 0x900000AB, + 0x1BDC, 0x900000AD, + 0x1BDC, 0x900000AF, + 0x1BDC, 0x900000B1, + 0x1BDC, 0x900000B3, + 0x1BDC, 0x900000B5, + 0x1BDC, 0x900000B7, + 0x1BDC, 0x900000B9, + 0x1BDC, 0x900000BB, + 0x1BDC, 0x900000BD, + 0x1BDC, 0x900000BF, + 0x1BDC, 0x900000C1, + 0x1BDC, 0x900000C3, + 0x1BDC, 0x900000C5, + 0x1BDC, 0x900000C7, + 0x1BDC, 0x900000C9, + 0x1BDC, 0x900000CB, + 0x1BDC, 0x900000CD, + 0x1BDC, 0x900000CF, + 0x1BDC, 0x900000D1, + 0x1BDC, 0x900000D3, + 0x1BDC, 0x900000D5, + 0x1BDC, 0x900000D7, + 0x1BDC, 0x900000D9, + 0x1BDC, 0x900000DB, + 0x1BDC, 0x900000DD, + 0x1BDC, 0x900000DF, + 0x1BDC, 0x900000E1, + 0x1BDC, 0x900000E3, + 0x1BDC, 0x900000E5, + 0x1BDC, 0x900000E7, + 0x1BDC, 0x900000E9, + 0x1BDC, 0x900000EB, + 0x1BDC, 0x900000ED, + 0x1BDC, 0x900000EF, + 0x1BDC, 0x900000F1, + 0x1BDC, 0x900000F3, + 0x1BDC, 0x900000F5, + 0x1BDC, 0x900000F7, + 0x1BDC, 0x900000F9, + 0x1BDC, 0x900000FB, + 0x1BDC, 0x900000FD, + 0x1BDC, 0x900000FF, + 0x1BDC, 0x00000000, + 0x1B00, 0xF8000000, + 0x1B80, 0x00000007, + 0x1B80, 0x090A0005, + 0x1B80, 0x090A0007, + 0x1B80, 0x0FFE0015, + 0x1B80, 0x0FFE0017, + 0x1B80, 0x00220025, + 0x1B80, 0x00220027, + 0x1B80, 0x00040035, + 0x1B80, 0x00040037, + 0x1B80, 0x05C00045, + 0x1B80, 0x05C00047, + 0x1B80, 0x00070055, + 0x1B80, 0x00070057, + 0x1B80, 0x64000065, + 0x1B80, 0x64000067, + 0x1B80, 0x00020075, + 0x1B80, 0x00020077, + 0x1B80, 0x00080085, + 0x1B80, 0x00080087, + 0x1B80, 0x80000095, + 0x1B80, 0x80000097, + 0x1B80, 0x090800A5, + 0x1B80, 0x090800A7, + 0x1B80, 0x0F0200B5, + 0x1B80, 0x0F0200B7, + 0x1B80, 0x002200C5, + 0x1B80, 0x002200C7, + 0x1B80, 0x000400D5, + 0x1B80, 0x000400D7, + 0x1B80, 0x05C000E5, + 0x1B80, 0x05C000E7, + 0x1B80, 0x000700F5, + 0x1B80, 0x000700F7, + 0x1B80, 0x64020105, + 0x1B80, 0x64020107, + 0x1B80, 0x00020115, + 0x1B80, 0x00020117, + 0x1B80, 0x00040125, + 0x1B80, 0x00040127, + 0x1B80, 0x4A000135, + 0x1B80, 0x4A000137, + 0x1B80, 0x4B040145, + 0x1B80, 0x4B040147, + 0x1B80, 0x85030155, + 0x1B80, 0x85030157, + 0x1B80, 0x40090165, + 0x1B80, 0x40090167, + 0x1B80, 0xE02A0175, + 0x1B80, 0xE02A0177, + 0x1B80, 0x4B050185, + 0x1B80, 0x4B050187, + 0x1B80, 0x86030195, + 0x1B80, 0x86030197, + 0x1B80, 0x400B01A5, + 0x1B80, 0x400B01A7, + 0x1B80, 0xE02A01B5, + 0x1B80, 0xE02A01B7, + 0x1B80, 0x4B0001C5, + 0x1B80, 0x4B0001C7, + 0x1B80, 0x000701D5, + 0x1B80, 0x000701D7, + 0x1B80, 0x4C0001E5, + 0x1B80, 0x4C0001E7, + 0x1B80, 0x000401F5, + 0x1B80, 0x000401F7, + 0x1B80, 0x4D040205, + 0x1B80, 0x4D040207, + 0x1B80, 0x2EE00215, + 0x1B80, 0x2EE00217, + 0x1B80, 0x00000225, + 0x1B80, 0x00000227, + 0x1B80, 0x2EF00235, + 0x1B80, 0x2EF00237, + 0x1B80, 0x00000245, + 0x1B80, 0x00000247, + 0x1B80, 0x20810255, + 0x1B80, 0x20810257, + 0x1B80, 0x23450265, + 0x1B80, 0x23450267, + 0x1B80, 0x4D000275, + 0x1B80, 0x4D000277, + 0x1B80, 0x00040285, + 0x1B80, 0x00040287, + 0x1B80, 0x30000295, + 0x1B80, 0x30000297, + 0x1B80, 0xE1D602A5, + 0x1B80, 0xE1D602A7, + 0x1B80, 0xF01102B5, + 0x1B80, 0xF01102B7, + 0x1B80, 0xF11102C5, + 0x1B80, 0xF11102C7, + 0x1B80, 0xF21102D5, + 0x1B80, 0xF21102D7, + 0x1B80, 0xF31102E5, + 0x1B80, 0xF31102E7, + 0x1B80, 0xF41102F5, + 0x1B80, 0xF41102F7, + 0x1B80, 0xF5110305, + 0x1B80, 0xF5110307, + 0x1B80, 0xF6110315, + 0x1B80, 0xF6110317, + 0x1B80, 0xF7110325, + 0x1B80, 0xF7110327, + 0x1B80, 0xF8110335, + 0x1B80, 0xF8110337, + 0x1B80, 0xF9110345, + 0x1B80, 0xF9110347, + 0x1B80, 0xFA110355, + 0x1B80, 0xFA110357, + 0x1B80, 0xFB110365, + 0x1B80, 0xFB110367, + 0x1B80, 0xFC110375, + 0x1B80, 0xFC110377, + 0x1B80, 0xFD110385, + 0x1B80, 0xFD110387, + 0x1B80, 0xFE110395, + 0x1B80, 0xFE110397, + 0x1B80, 0xFF1103A5, + 0x1B80, 0xFF1103A7, + 0x1B80, 0x000103B5, + 0x1B80, 0x000103B7, + 0x1B80, 0x305503C5, + 0x1B80, 0x305503C7, + 0x1B80, 0x306D03D5, + 0x1B80, 0x306D03D7, + 0x1B80, 0x30B803E5, + 0x1B80, 0x30B803E7, + 0x1B80, 0x30BB03F5, + 0x1B80, 0x30BB03F7, + 0x1B80, 0x306F0405, + 0x1B80, 0x306F0407, + 0x1B80, 0x307A0415, + 0x1B80, 0x307A0417, + 0x1B80, 0x30850425, + 0x1B80, 0x30850427, + 0x1B80, 0x30C50435, + 0x1B80, 0x30C50437, + 0x1B80, 0x30BF0445, + 0x1B80, 0x30BF0447, + 0x1B80, 0x30D30455, + 0x1B80, 0x30D30457, + 0x1B80, 0x30DE0465, + 0x1B80, 0x30DE0467, + 0x1B80, 0x30E90475, + 0x1B80, 0x30E90477, + 0x1B80, 0x304C0485, + 0x1B80, 0x304C0487, + 0x1B80, 0x31180495, + 0x1B80, 0x31180497, + 0x1B80, 0x312904A5, + 0x1B80, 0x312904A7, + 0x1B80, 0x313E04B5, + 0x1B80, 0x313E04B7, + 0x1B80, 0x4D0404C5, + 0x1B80, 0x4D0404C7, + 0x1B80, 0x2EE004D5, + 0x1B80, 0x2EE004D7, + 0x1B80, 0x000004E5, + 0x1B80, 0x000004E7, + 0x1B80, 0x2EF004F5, + 0x1B80, 0x2EF004F7, + 0x1B80, 0x00000505, + 0x1B80, 0x00000507, + 0x1B80, 0x20810515, + 0x1B80, 0x20810517, + 0x1B80, 0xA3B50525, + 0x1B80, 0xA3B50527, + 0x1B80, 0x4D000535, + 0x1B80, 0x4D000537, + 0x1B80, 0x30000545, + 0x1B80, 0x30000547, + 0x1B80, 0xE1690555, + 0x1B80, 0xE1690557, + 0x1B80, 0x4D040565, + 0x1B80, 0x4D040567, + 0x1B80, 0x20800575, + 0x1B80, 0x20800577, + 0x1B80, 0x00000585, + 0x1B80, 0x00000587, + 0x1B80, 0x4D000595, + 0x1B80, 0x4D000597, + 0x1B80, 0x550705A5, + 0x1B80, 0x550705A7, + 0x1B80, 0xE16105B5, + 0x1B80, 0xE16105B7, + 0x1B80, 0xE16105C5, + 0x1B80, 0xE16105C7, + 0x1B80, 0x4D0405D5, + 0x1B80, 0x4D0405D7, + 0x1B80, 0x208805E5, + 0x1B80, 0x208805E7, + 0x1B80, 0x020005F5, + 0x1B80, 0x020005F7, + 0x1B80, 0x4D000605, + 0x1B80, 0x4D000607, + 0x1B80, 0x550F0615, + 0x1B80, 0x550F0617, + 0x1B80, 0xE1610625, + 0x1B80, 0xE1610627, + 0x1B80, 0x4F020635, + 0x1B80, 0x4F020637, + 0x1B80, 0x4E000645, + 0x1B80, 0x4E000647, + 0x1B80, 0x53020655, + 0x1B80, 0x53020657, + 0x1B80, 0x52010665, + 0x1B80, 0x52010667, + 0x1B80, 0xE1650675, + 0x1B80, 0xE1650677, + 0x1B80, 0x4D080685, + 0x1B80, 0x4D080687, + 0x1B80, 0x57100695, + 0x1B80, 0x57100697, + 0x1B80, 0x570006A5, + 0x1B80, 0x570006A7, + 0x1B80, 0x4D0006B5, + 0x1B80, 0x4D0006B7, + 0x1B80, 0x000106C5, + 0x1B80, 0x000106C7, + 0x1B80, 0xE16906D5, + 0x1B80, 0xE16906D7, + 0x1B80, 0x000106E5, + 0x1B80, 0x000106E7, + 0x1B80, 0x308F06F5, + 0x1B80, 0x308F06F7, + 0x1B80, 0x00230705, + 0x1B80, 0x00230707, + 0x1B80, 0xE1C90715, + 0x1B80, 0xE1C90717, + 0x1B80, 0x00020725, + 0x1B80, 0x00020727, + 0x1B80, 0x54E90735, + 0x1B80, 0x54E90737, + 0x1B80, 0x0BA60745, + 0x1B80, 0x0BA60747, + 0x1B80, 0x00230755, + 0x1B80, 0x00230757, + 0x1B80, 0xE1C90765, + 0x1B80, 0xE1C90767, + 0x1B80, 0x00020775, + 0x1B80, 0x00020777, + 0x1B80, 0x4D300785, + 0x1B80, 0x4D300787, + 0x1B80, 0x30A80795, + 0x1B80, 0x30A80797, + 0x1B80, 0x308B07A5, + 0x1B80, 0x308B07A7, + 0x1B80, 0x002207B5, + 0x1B80, 0x002207B7, + 0x1B80, 0xE1C907C5, + 0x1B80, 0xE1C907C7, + 0x1B80, 0x000207D5, + 0x1B80, 0x000207D7, + 0x1B80, 0x54E807E5, + 0x1B80, 0x54E807E7, + 0x1B80, 0x0BA607F5, + 0x1B80, 0x0BA607F7, + 0x1B80, 0x00220805, + 0x1B80, 0x00220807, + 0x1B80, 0xE1C90815, + 0x1B80, 0xE1C90817, + 0x1B80, 0x00020825, + 0x1B80, 0x00020827, + 0x1B80, 0x4D300835, + 0x1B80, 0x4D300837, + 0x1B80, 0x30A80845, + 0x1B80, 0x30A80847, + 0x1B80, 0x63F10855, + 0x1B80, 0x63F10857, + 0x1B80, 0xE1690865, + 0x1B80, 0xE1690867, + 0x1B80, 0xE1C90875, + 0x1B80, 0xE1C90877, + 0x1B80, 0x63F40885, + 0x1B80, 0x63F40887, + 0x1B80, 0xE1690895, + 0x1B80, 0xE1690897, + 0x1B80, 0xE1C908A5, + 0x1B80, 0xE1C908A7, + 0x1B80, 0x0BA808B5, + 0x1B80, 0x0BA808B7, + 0x1B80, 0x63F808C5, + 0x1B80, 0x63F808C7, + 0x1B80, 0xE16908D5, + 0x1B80, 0xE16908D7, + 0x1B80, 0xE1C908E5, + 0x1B80, 0xE1C908E7, + 0x1B80, 0x0BA908F5, + 0x1B80, 0x0BA908F7, + 0x1B80, 0x63FC0905, + 0x1B80, 0x63FC0907, + 0x1B80, 0xE1690915, + 0x1B80, 0xE1690917, + 0x1B80, 0xE1C90925, + 0x1B80, 0xE1C90927, + 0x1B80, 0x63FF0935, + 0x1B80, 0x63FF0937, + 0x1B80, 0xE1690945, + 0x1B80, 0xE1690947, + 0x1B80, 0xE1C90955, + 0x1B80, 0xE1C90957, + 0x1B80, 0x63000965, + 0x1B80, 0x63000967, + 0x1B80, 0xE1690975, + 0x1B80, 0xE1690977, + 0x1B80, 0xE1C90985, + 0x1B80, 0xE1C90987, + 0x1B80, 0x63030995, + 0x1B80, 0x63030997, + 0x1B80, 0xE16909A5, + 0x1B80, 0xE16909A7, + 0x1B80, 0xE1C909B5, + 0x1B80, 0xE1C909B7, + 0x1B80, 0xF4D409C5, + 0x1B80, 0xF4D409C7, + 0x1B80, 0x630709D5, + 0x1B80, 0x630709D7, + 0x1B80, 0xE16909E5, + 0x1B80, 0xE16909E7, + 0x1B80, 0xE1C909F5, + 0x1B80, 0xE1C909F7, + 0x1B80, 0xF5DB0A05, + 0x1B80, 0xF5DB0A07, + 0x1B80, 0x630B0A15, + 0x1B80, 0x630B0A17, + 0x1B80, 0xE1690A25, + 0x1B80, 0xE1690A27, + 0x1B80, 0xE1C90A35, + 0x1B80, 0xE1C90A37, + 0x1B80, 0x630E0A45, + 0x1B80, 0x630E0A47, + 0x1B80, 0xE1690A55, + 0x1B80, 0xE1690A57, + 0x1B80, 0xE1C90A65, + 0x1B80, 0xE1C90A67, + 0x1B80, 0x4D300A75, + 0x1B80, 0x4D300A77, + 0x1B80, 0x55010A85, + 0x1B80, 0x55010A87, + 0x1B80, 0x57040A95, + 0x1B80, 0x57040A97, + 0x1B80, 0x57000AA5, + 0x1B80, 0x57000AA7, + 0x1B80, 0x96000AB5, + 0x1B80, 0x96000AB7, + 0x1B80, 0x57080AC5, + 0x1B80, 0x57080AC7, + 0x1B80, 0x57000AD5, + 0x1B80, 0x57000AD7, + 0x1B80, 0x95000AE5, + 0x1B80, 0x95000AE7, + 0x1B80, 0x4D000AF5, + 0x1B80, 0x4D000AF7, + 0x1B80, 0x6C070B05, + 0x1B80, 0x6C070B07, + 0x1B80, 0x7B200B15, + 0x1B80, 0x7B200B17, + 0x1B80, 0x7A000B25, + 0x1B80, 0x7A000B27, + 0x1B80, 0x79000B35, + 0x1B80, 0x79000B37, + 0x1B80, 0x7F200B45, + 0x1B80, 0x7F200B47, + 0x1B80, 0x7E000B55, + 0x1B80, 0x7E000B57, + 0x1B80, 0x7D000B65, + 0x1B80, 0x7D000B67, + 0x1B80, 0x00010B75, + 0x1B80, 0x00010B77, + 0x1B80, 0x62850B85, + 0x1B80, 0x62850B87, + 0x1B80, 0xE1690B95, + 0x1B80, 0xE1690B97, + 0x1B80, 0x00010BA5, + 0x1B80, 0x00010BA7, + 0x1B80, 0x5C320BB5, + 0x1B80, 0x5C320BB7, + 0x1B80, 0xE1C50BC5, + 0x1B80, 0xE1C50BC7, + 0x1B80, 0xE1950BD5, + 0x1B80, 0xE1950BD7, + 0x1B80, 0x00010BE5, + 0x1B80, 0x00010BE7, + 0x1B80, 0x5C320BF5, + 0x1B80, 0x5C320BF7, + 0x1B80, 0x63F40C05, + 0x1B80, 0x63F40C07, + 0x1B80, 0x62850C15, + 0x1B80, 0x62850C17, + 0x1B80, 0x0BB00C25, + 0x1B80, 0x0BB00C27, + 0x1B80, 0xE1690C35, + 0x1B80, 0xE1690C37, + 0x1B80, 0xE1C90C45, + 0x1B80, 0xE1C90C47, + 0x1B80, 0x5C320C55, + 0x1B80, 0x5C320C57, + 0x1B80, 0x63FC0C65, + 0x1B80, 0x63FC0C67, + 0x1B80, 0x62850C75, + 0x1B80, 0x62850C77, + 0x1B80, 0x0BB10C85, + 0x1B80, 0x0BB10C87, + 0x1B80, 0xE1690C95, + 0x1B80, 0xE1690C97, + 0x1B80, 0xE1C90CA5, + 0x1B80, 0xE1C90CA7, + 0x1B80, 0x63030CB5, + 0x1B80, 0x63030CB7, + 0x1B80, 0xE1690CC5, + 0x1B80, 0xE1690CC7, + 0x1B80, 0xE1C90CD5, + 0x1B80, 0xE1C90CD7, + 0x1B80, 0xF7040CE5, + 0x1B80, 0xF7040CE7, + 0x1B80, 0x630B0CF5, + 0x1B80, 0x630B0CF7, + 0x1B80, 0xE1690D05, + 0x1B80, 0xE1690D07, + 0x1B80, 0xE1C90D15, + 0x1B80, 0xE1C90D17, + 0x1B80, 0x00010D25, + 0x1B80, 0x00010D27, + 0x1B80, 0x30F70D35, + 0x1B80, 0x30F70D37, + 0x1B80, 0x00230D45, + 0x1B80, 0x00230D47, + 0x1B80, 0xE1CE0D55, + 0x1B80, 0xE1CE0D57, + 0x1B80, 0x00020D65, + 0x1B80, 0x00020D67, + 0x1B80, 0x54E90D75, + 0x1B80, 0x54E90D77, + 0x1B80, 0x0BA60D85, + 0x1B80, 0x0BA60D87, + 0x1B80, 0x00230D95, + 0x1B80, 0x00230D97, + 0x1B80, 0xE1CE0DA5, + 0x1B80, 0xE1CE0DA7, + 0x1B80, 0x00020DB5, + 0x1B80, 0x00020DB7, + 0x1B80, 0x4D100DC5, + 0x1B80, 0x4D100DC7, + 0x1B80, 0x30A80DD5, + 0x1B80, 0x30A80DD7, + 0x1B80, 0x30F10DE5, + 0x1B80, 0x30F10DE7, + 0x1B80, 0x00220DF5, + 0x1B80, 0x00220DF7, + 0x1B80, 0xE1CE0E05, + 0x1B80, 0xE1CE0E07, + 0x1B80, 0x00020E15, + 0x1B80, 0x00020E17, + 0x1B80, 0x54E80E25, + 0x1B80, 0x54E80E27, + 0x1B80, 0x0BA60E35, + 0x1B80, 0x0BA60E37, + 0x1B80, 0x00220E45, + 0x1B80, 0x00220E47, + 0x1B80, 0xE1CE0E55, + 0x1B80, 0xE1CE0E57, + 0x1B80, 0x00020E65, + 0x1B80, 0x00020E67, + 0x1B80, 0x4D100E75, + 0x1B80, 0x4D100E77, + 0x1B80, 0x30A80E85, + 0x1B80, 0x30A80E87, + 0x1B80, 0x5C320E95, + 0x1B80, 0x5C320E97, + 0x1B80, 0x54F00EA5, + 0x1B80, 0x54F00EA7, + 0x1B80, 0x67F10EB5, + 0x1B80, 0x67F10EB7, + 0x1B80, 0xE1950EC5, + 0x1B80, 0xE1950EC7, + 0x1B80, 0xE1CE0ED5, + 0x1B80, 0xE1CE0ED7, + 0x1B80, 0x67F40EE5, + 0x1B80, 0x67F40EE7, + 0x1B80, 0xE1950EF5, + 0x1B80, 0xE1950EF7, + 0x1B80, 0xE1CE0F05, + 0x1B80, 0xE1CE0F07, + 0x1B80, 0x5C320F15, + 0x1B80, 0x5C320F17, + 0x1B80, 0x54F10F25, + 0x1B80, 0x54F10F27, + 0x1B80, 0x0BA80F35, + 0x1B80, 0x0BA80F37, + 0x1B80, 0x67F80F45, + 0x1B80, 0x67F80F47, + 0x1B80, 0xE1950F55, + 0x1B80, 0xE1950F57, + 0x1B80, 0xE1CE0F65, + 0x1B80, 0xE1CE0F67, + 0x1B80, 0x5C320F75, + 0x1B80, 0x5C320F77, + 0x1B80, 0x54F10F85, + 0x1B80, 0x54F10F87, + 0x1B80, 0x0BA90F95, + 0x1B80, 0x0BA90F97, + 0x1B80, 0x67FC0FA5, + 0x1B80, 0x67FC0FA7, + 0x1B80, 0xE1950FB5, + 0x1B80, 0xE1950FB7, + 0x1B80, 0xE1CE0FC5, + 0x1B80, 0xE1CE0FC7, + 0x1B80, 0x67FF0FD5, + 0x1B80, 0x67FF0FD7, + 0x1B80, 0xE1950FE5, + 0x1B80, 0xE1950FE7, + 0x1B80, 0xE1CE0FF5, + 0x1B80, 0xE1CE0FF7, + 0x1B80, 0x5C321005, + 0x1B80, 0x5C321007, + 0x1B80, 0x54F21015, + 0x1B80, 0x54F21017, + 0x1B80, 0x67001025, + 0x1B80, 0x67001027, + 0x1B80, 0xE1951035, + 0x1B80, 0xE1951037, + 0x1B80, 0xE1CE1045, + 0x1B80, 0xE1CE1047, + 0x1B80, 0x67031055, + 0x1B80, 0x67031057, + 0x1B80, 0xE1951065, + 0x1B80, 0xE1951067, + 0x1B80, 0xE1CE1075, + 0x1B80, 0xE1CE1077, + 0x1B80, 0xF9CC1085, + 0x1B80, 0xF9CC1087, + 0x1B80, 0x67071095, + 0x1B80, 0x67071097, + 0x1B80, 0xE19510A5, + 0x1B80, 0xE19510A7, + 0x1B80, 0xE1CE10B5, + 0x1B80, 0xE1CE10B7, + 0x1B80, 0xFAD310C5, + 0x1B80, 0xFAD310C7, + 0x1B80, 0x5C3210D5, + 0x1B80, 0x5C3210D7, + 0x1B80, 0x54F310E5, + 0x1B80, 0x54F310E7, + 0x1B80, 0x670B10F5, + 0x1B80, 0x670B10F7, + 0x1B80, 0xE1951105, + 0x1B80, 0xE1951107, + 0x1B80, 0xE1CE1115, + 0x1B80, 0xE1CE1117, + 0x1B80, 0x670E1125, + 0x1B80, 0x670E1127, + 0x1B80, 0xE1951135, + 0x1B80, 0xE1951137, + 0x1B80, 0xE1CE1145, + 0x1B80, 0xE1CE1147, + 0x1B80, 0x4D101155, + 0x1B80, 0x4D101157, + 0x1B80, 0x30A81165, + 0x1B80, 0x30A81167, + 0x1B80, 0x00011175, + 0x1B80, 0x00011177, + 0x1B80, 0x6C001185, + 0x1B80, 0x6C001187, + 0x1B80, 0x00061195, + 0x1B80, 0x00061197, + 0x1B80, 0x530011A5, + 0x1B80, 0x530011A7, + 0x1B80, 0x57F711B5, + 0x1B80, 0x57F711B7, + 0x1B80, 0x582111C5, + 0x1B80, 0x582111C7, + 0x1B80, 0x592E11D5, + 0x1B80, 0x592E11D7, + 0x1B80, 0x5A3811E5, + 0x1B80, 0x5A3811E7, + 0x1B80, 0x5B4111F5, + 0x1B80, 0x5B4111F7, + 0x1B80, 0x00071205, + 0x1B80, 0x00071207, + 0x1B80, 0x5C001215, + 0x1B80, 0x5C001217, + 0x1B80, 0x4B001225, + 0x1B80, 0x4B001227, + 0x1B80, 0x4E8F1235, + 0x1B80, 0x4E8F1237, + 0x1B80, 0x4F151245, + 0x1B80, 0x4F151247, + 0x1B80, 0x00041255, + 0x1B80, 0x00041257, + 0x1B80, 0xE1B31265, + 0x1B80, 0xE1B31267, + 0x1B80, 0xAB001275, + 0x1B80, 0xAB001277, + 0x1B80, 0x00011285, + 0x1B80, 0x00011287, + 0x1B80, 0x6C001295, + 0x1B80, 0x6C001297, + 0x1B80, 0x000612A5, + 0x1B80, 0x000612A7, + 0x1B80, 0x530012B5, + 0x1B80, 0x530012B7, + 0x1B80, 0x57F712C5, + 0x1B80, 0x57F712C7, + 0x1B80, 0x582112D5, + 0x1B80, 0x582112D7, + 0x1B80, 0x592E12E5, + 0x1B80, 0x592E12E7, + 0x1B80, 0x5A3812F5, + 0x1B80, 0x5A3812F7, + 0x1B80, 0x5B411305, + 0x1B80, 0x5B411307, + 0x1B80, 0x00071315, + 0x1B80, 0x00071317, + 0x1B80, 0x5C001325, + 0x1B80, 0x5C001327, + 0x1B80, 0x4B401335, + 0x1B80, 0x4B401337, + 0x1B80, 0x4E971345, + 0x1B80, 0x4E971347, + 0x1B80, 0x4F111355, + 0x1B80, 0x4F111357, + 0x1B80, 0x00041365, + 0x1B80, 0x00041367, + 0x1B80, 0xE1B31375, + 0x1B80, 0xE1B31377, + 0x1B80, 0xAB001385, + 0x1B80, 0xAB001387, + 0x1B80, 0x8B001395, + 0x1B80, 0x8B001397, + 0x1B80, 0xAB0013A5, + 0x1B80, 0xAB0013A7, + 0x1B80, 0x8A1913B5, + 0x1B80, 0x8A1913B7, + 0x1B80, 0x301D13C5, + 0x1B80, 0x301D13C7, + 0x1B80, 0x000113D5, + 0x1B80, 0x000113D7, + 0x1B80, 0x6C0113E5, + 0x1B80, 0x6C0113E7, + 0x1B80, 0x000613F5, + 0x1B80, 0x000613F7, + 0x1B80, 0x53011405, + 0x1B80, 0x53011407, + 0x1B80, 0x57F71415, + 0x1B80, 0x57F71417, + 0x1B80, 0x58211425, + 0x1B80, 0x58211427, + 0x1B80, 0x592E1435, + 0x1B80, 0x592E1437, + 0x1B80, 0x5A381445, + 0x1B80, 0x5A381447, + 0x1B80, 0x5B411455, + 0x1B80, 0x5B411457, + 0x1B80, 0x00071465, + 0x1B80, 0x00071467, + 0x1B80, 0x5C001475, + 0x1B80, 0x5C001477, + 0x1B80, 0x4B001485, + 0x1B80, 0x4B001487, + 0x1B80, 0x4E871495, + 0x1B80, 0x4E871497, + 0x1B80, 0x4F1114A5, + 0x1B80, 0x4F1114A7, + 0x1B80, 0x000414B5, + 0x1B80, 0x000414B7, + 0x1B80, 0xE1B314C5, + 0x1B80, 0xE1B314C7, + 0x1B80, 0xAB0014D5, + 0x1B80, 0xAB0014D7, + 0x1B80, 0x000614E5, + 0x1B80, 0x000614E7, + 0x1B80, 0x577714F5, + 0x1B80, 0x577714F7, + 0x1B80, 0x00071505, + 0x1B80, 0x00071507, + 0x1B80, 0x4E861515, + 0x1B80, 0x4E861517, + 0x1B80, 0x00041525, + 0x1B80, 0x00041527, + 0x1B80, 0x00011535, + 0x1B80, 0x00011537, + 0x1B80, 0x00011545, + 0x1B80, 0x00011547, + 0x1B80, 0x7B241555, + 0x1B80, 0x7B241557, + 0x1B80, 0x7A401565, + 0x1B80, 0x7A401567, + 0x1B80, 0x79001575, + 0x1B80, 0x79001577, + 0x1B80, 0x55031585, + 0x1B80, 0x55031587, + 0x1B80, 0x31611595, + 0x1B80, 0x31611597, + 0x1B80, 0x7B1C15A5, + 0x1B80, 0x7B1C15A7, + 0x1B80, 0x7A4015B5, + 0x1B80, 0x7A4015B7, + 0x1B80, 0x550B15C5, + 0x1B80, 0x550B15C7, + 0x1B80, 0x316115D5, + 0x1B80, 0x316115D7, + 0x1B80, 0x7B2015E5, + 0x1B80, 0x7B2015E7, + 0x1B80, 0x7A0015F5, + 0x1B80, 0x7A0015F7, + 0x1B80, 0x55131605, + 0x1B80, 0x55131607, + 0x1B80, 0x74011615, + 0x1B80, 0x74011617, + 0x1B80, 0x74001625, + 0x1B80, 0x74001627, + 0x1B80, 0x8E001635, + 0x1B80, 0x8E001637, + 0x1B80, 0x00011645, + 0x1B80, 0x00011647, + 0x1B80, 0x57021655, + 0x1B80, 0x57021657, + 0x1B80, 0x57001665, + 0x1B80, 0x57001667, + 0x1B80, 0x97001675, + 0x1B80, 0x97001677, + 0x1B80, 0x00011685, + 0x1B80, 0x00011687, + 0x1B80, 0x4F781695, + 0x1B80, 0x4F781697, + 0x1B80, 0x538816A5, + 0x1B80, 0x538816A7, + 0x1B80, 0xE17516B5, + 0x1B80, 0xE17516B7, + 0x1B80, 0x548016C5, + 0x1B80, 0x548016C7, + 0x1B80, 0x540016D5, + 0x1B80, 0x540016D7, + 0x1B80, 0x548116E5, + 0x1B80, 0x548116E7, + 0x1B80, 0x540016F5, + 0x1B80, 0x540016F7, + 0x1B80, 0x54821705, + 0x1B80, 0x54821707, + 0x1B80, 0x54001715, + 0x1B80, 0x54001717, + 0x1B80, 0xE1801725, + 0x1B80, 0xE1801727, + 0x1B80, 0xBF1D1735, + 0x1B80, 0xBF1D1737, + 0x1B80, 0x301D1745, + 0x1B80, 0x301D1747, + 0x1B80, 0xE1551755, + 0x1B80, 0xE1551757, + 0x1B80, 0xE15A1765, + 0x1B80, 0xE15A1767, + 0x1B80, 0xE15E1775, + 0x1B80, 0xE15E1777, + 0x1B80, 0xE1651785, + 0x1B80, 0xE1651787, + 0x1B80, 0xE1C51795, + 0x1B80, 0xE1C51797, + 0x1B80, 0x551317A5, + 0x1B80, 0x551317A7, + 0x1B80, 0xE16117B5, + 0x1B80, 0xE16117B7, + 0x1B80, 0x551517C5, + 0x1B80, 0x551517C7, + 0x1B80, 0xE16517D5, + 0x1B80, 0xE16517D7, + 0x1B80, 0xE1C517E5, + 0x1B80, 0xE1C517E7, + 0x1B80, 0x000117F5, + 0x1B80, 0x000117F7, + 0x1B80, 0x54BF1805, + 0x1B80, 0x54BF1807, + 0x1B80, 0x54C01815, + 0x1B80, 0x54C01817, + 0x1B80, 0x54A31825, + 0x1B80, 0x54A31827, + 0x1B80, 0x54C11835, + 0x1B80, 0x54C11837, + 0x1B80, 0x54A41845, + 0x1B80, 0x54A41847, + 0x1B80, 0x4C181855, + 0x1B80, 0x4C181857, + 0x1B80, 0xBF071865, + 0x1B80, 0xBF071867, + 0x1B80, 0x54C21875, + 0x1B80, 0x54C21877, + 0x1B80, 0x54A41885, + 0x1B80, 0x54A41887, + 0x1B80, 0xBF041895, + 0x1B80, 0xBF041897, + 0x1B80, 0x54C118A5, + 0x1B80, 0x54C118A7, + 0x1B80, 0x54A318B5, + 0x1B80, 0x54A318B7, + 0x1B80, 0xBF0118C5, + 0x1B80, 0xBF0118C7, + 0x1B80, 0xE1D318D5, + 0x1B80, 0xE1D318D7, + 0x1B80, 0x54DF18E5, + 0x1B80, 0x54DF18E7, + 0x1B80, 0x000118F5, + 0x1B80, 0x000118F7, + 0x1B80, 0x54BF1905, + 0x1B80, 0x54BF1907, + 0x1B80, 0x54E51915, + 0x1B80, 0x54E51917, + 0x1B80, 0x050A1925, + 0x1B80, 0x050A1927, + 0x1B80, 0x54DF1935, + 0x1B80, 0x54DF1937, + 0x1B80, 0x00011945, + 0x1B80, 0x00011947, + 0x1B80, 0x7F201955, + 0x1B80, 0x7F201957, + 0x1B80, 0x7E001965, + 0x1B80, 0x7E001967, + 0x1B80, 0x7D001975, + 0x1B80, 0x7D001977, + 0x1B80, 0x55011985, + 0x1B80, 0x55011987, + 0x1B80, 0x5C311995, + 0x1B80, 0x5C311997, + 0x1B80, 0xE16119A5, + 0x1B80, 0xE16119A7, + 0x1B80, 0xE16519B5, + 0x1B80, 0xE16519B7, + 0x1B80, 0x548019C5, + 0x1B80, 0x548019C7, + 0x1B80, 0x540019D5, + 0x1B80, 0x540019D7, + 0x1B80, 0x548119E5, + 0x1B80, 0x548119E7, + 0x1B80, 0x540019F5, + 0x1B80, 0x540019F7, + 0x1B80, 0x54821A05, + 0x1B80, 0x54821A07, + 0x1B80, 0x54001A15, + 0x1B80, 0x54001A17, + 0x1B80, 0xE1801A25, + 0x1B80, 0xE1801A27, + 0x1B80, 0xBFED1A35, + 0x1B80, 0xBFED1A37, + 0x1B80, 0x301D1A45, + 0x1B80, 0x301D1A47, + 0x1B80, 0x00231A55, + 0x1B80, 0x00231A57, + 0x1B80, 0x7B201A65, + 0x1B80, 0x7B201A67, + 0x1B80, 0x7A001A75, + 0x1B80, 0x7A001A77, + 0x1B80, 0x79001A85, + 0x1B80, 0x79001A87, + 0x1B80, 0xE1C91A95, + 0x1B80, 0xE1C91A97, + 0x1B80, 0x00021AA5, + 0x1B80, 0x00021AA7, + 0x1B80, 0x00011AB5, + 0x1B80, 0x00011AB7, + 0x1B80, 0x00221AC5, + 0x1B80, 0x00221AC7, + 0x1B80, 0x7B201AD5, + 0x1B80, 0x7B201AD7, + 0x1B80, 0x7A001AE5, + 0x1B80, 0x7A001AE7, + 0x1B80, 0x79001AF5, + 0x1B80, 0x79001AF7, + 0x1B80, 0xE1C91B05, + 0x1B80, 0xE1C91B07, + 0x1B80, 0x00021B15, + 0x1B80, 0x00021B17, + 0x1B80, 0x00011B25, + 0x1B80, 0x00011B27, + 0x1B80, 0x74021B35, + 0x1B80, 0x74021B37, + 0x1B80, 0x003F1B45, + 0x1B80, 0x003F1B47, + 0x1B80, 0x74001B55, + 0x1B80, 0x74001B57, + 0x1B80, 0x00021B65, + 0x1B80, 0x00021B67, + 0x1B80, 0x00011B75, + 0x1B80, 0x00011B77, + 0x1B80, 0x4D041B85, + 0x1B80, 0x4D041B87, + 0x1B80, 0x2EF81B95, + 0x1B80, 0x2EF81B97, + 0x1B80, 0x00001BA5, + 0x1B80, 0x00001BA7, + 0x1B80, 0x23301BB5, + 0x1B80, 0x23301BB7, + 0x1B80, 0x00241BC5, + 0x1B80, 0x00241BC7, + 0x1B80, 0x23E01BD5, + 0x1B80, 0x23E01BD7, + 0x1B80, 0x003F1BE5, + 0x1B80, 0x003F1BE7, + 0x1B80, 0x23FC1BF5, + 0x1B80, 0x23FC1BF7, + 0x1B80, 0xBFCE1C05, + 0x1B80, 0xBFCE1C07, + 0x1B80, 0x2EF01C15, + 0x1B80, 0x2EF01C17, + 0x1B80, 0x00001C25, + 0x1B80, 0x00001C27, + 0x1B80, 0x4D001C35, + 0x1B80, 0x4D001C37, + 0x1B80, 0x00011C45, + 0x1B80, 0x00011C47, + 0x1B80, 0x549F1C55, + 0x1B80, 0x549F1C57, + 0x1B80, 0x54FF1C65, + 0x1B80, 0x54FF1C67, + 0x1B80, 0x54001C75, + 0x1B80, 0x54001C77, + 0x1B80, 0x00011C85, + 0x1B80, 0x00011C87, + 0x1B80, 0x5C311C95, + 0x1B80, 0x5C311C97, + 0x1B80, 0x07141CA5, + 0x1B80, 0x07141CA7, + 0x1B80, 0x54001CB5, + 0x1B80, 0x54001CB7, + 0x1B80, 0x5C321CC5, + 0x1B80, 0x5C321CC7, + 0x1B80, 0x00011CD5, + 0x1B80, 0x00011CD7, + 0x1B80, 0x5C321CE5, + 0x1B80, 0x5C321CE7, + 0x1B80, 0x07141CF5, + 0x1B80, 0x07141CF7, + 0x1B80, 0x54001D05, + 0x1B80, 0x54001D07, + 0x1B80, 0x5C311D15, + 0x1B80, 0x5C311D17, + 0x1B80, 0x00011D25, + 0x1B80, 0x00011D27, + 0x1B80, 0x4C981D35, + 0x1B80, 0x4C981D37, + 0x1B80, 0x4C181D45, + 0x1B80, 0x4C181D47, + 0x1B80, 0x00011D55, + 0x1B80, 0x00011D57, + 0x1B80, 0x5C321D65, + 0x1B80, 0x5C321D67, + 0x1B80, 0x62841D75, + 0x1B80, 0x62841D77, + 0x1B80, 0x66861D85, + 0x1B80, 0x66861D87, + 0x1B80, 0x6C031D95, + 0x1B80, 0x6C031D97, + 0x1B80, 0x7B201DA5, + 0x1B80, 0x7B201DA7, + 0x1B80, 0x7A001DB5, + 0x1B80, 0x7A001DB7, + 0x1B80, 0x79001DC5, + 0x1B80, 0x79001DC7, + 0x1B80, 0x7F201DD5, + 0x1B80, 0x7F201DD7, + 0x1B80, 0x7E001DE5, + 0x1B80, 0x7E001DE7, + 0x1B80, 0x7D001DF5, + 0x1B80, 0x7D001DF7, + 0x1B80, 0x09011E05, + 0x1B80, 0x09011E07, + 0x1B80, 0x0C011E15, + 0x1B80, 0x0C011E17, + 0x1B80, 0x0BA61E25, + 0x1B80, 0x0BA61E27, + 0x1B80, 0x00011E35, + 0x1B80, 0x00011E37, + 0x1B80, 0x00000006, + 0x1B80, 0x00000002, + +}; + +RTW_DECL_TABLE_PHY_COND(rtw8821c_bb, rtw_phy_cfg_bb); + +static const struct rtw_phy_pg_cfg_pair rtw8821c_bb_pg_type0[] = { + { 0, 0, 0, 0x00000c20, 0xffffffff, 0x32343638, }, + { 0, 0, 0, 0x00000c24, 0xffffffff, 0x36363636, }, + { 0, 0, 0, 0x00000c28, 0xffffffff, 0x28303234, }, + { 0, 0, 0, 0x00000c2c, 0xffffffff, 0x34363636, }, + { 0, 0, 0, 0x00000c30, 0xffffffff, 0x26283032, }, + { 0, 0, 0, 0x00000c3c, 0xffffffff, 0x34363636, }, + { 0, 0, 0, 0x00000c40, 0xffffffff, 0x26283032, }, + { 0, 0, 0, 0x00000c44, 0xffffffff, 0x22222224, }, + { 1, 0, 0, 0x00000c24, 0xffffffff, 0x34343434, }, + { 1, 0, 0, 0x00000c28, 0xffffffff, 0x26283032, }, + { 1, 0, 0, 0x00000c2c, 0xffffffff, 0x32343434, }, + { 1, 0, 0, 0x00000c30, 0xffffffff, 0x24262830, }, + { 1, 0, 0, 0x00000c3c, 0xffffffff, 0x32343434, }, + { 1, 0, 0, 0x00000c40, 0xffffffff, 0x24262830, }, + { 1, 0, 0, 0x00000c44, 0xffffffff, 0x20202022, }, +}; + +RTW_DECL_TABLE_BB_PG(rtw8821c_bb_pg_type0); + +static const u32 rtw8821c_rf_a[] = { + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x000, 0x00010000, + 0x018, 0x00010D24, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x000, 0x00010000, + 0x018, 0x00010D24, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x000, 0x00010000, + 0x018, 0x00010D24, + 0xA0000000, 0x00000000, + 0x000, 0x00010000, + 0x018, 0x00010D24, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000002, + 0x03E, 0x0000003F, + 0x03F, 0x000C0F4E, + 0x033, 0x00000001, + 0x03E, 0x00000034, + 0x03F, 0x0004080E, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000002, + 0x03E, 0x0000003F, + 0x03F, 0x000C0F4E, + 0x033, 0x00000001, + 0x03E, 0x00000034, + 0x03F, 0x0004080E, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000002, + 0x03E, 0x0000003F, + 0x03F, 0x000C0F4E, + 0x033, 0x00000001, + 0x03E, 0x00000034, + 0x03F, 0x0004080E, + 0xA0000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000002, + 0x03E, 0x0000003F, + 0x03F, 0x000C0F4E, + 0x033, 0x00000001, + 0x03E, 0x00000034, + 0x03F, 0x0004080E, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00002000, + 0x033, 0x00000000, + 0x03F, 0x000005DF, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00002000, + 0x033, 0x00000000, + 0x03F, 0x000005DF, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00002000, + 0x033, 0x00000000, + 0x03F, 0x000005DF, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00002000, + 0x033, 0x00000000, + 0x03F, 0x000005DF, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000400, + 0x033, 0x00000000, + 0x03F, 0x000005DF, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000400, + 0x033, 0x00000000, + 0x03F, 0x000005DF, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000400, + 0x033, 0x00000000, + 0x03F, 0x000005DF, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00000400, + 0x033, 0x00000000, + 0x03F, 0x000005DF, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x0B1, 0x0007DBE4, + 0x0B2, 0x000225D1, + 0x0B3, 0x000FC760, + 0x0B4, 0x00099DD0, + 0x0B5, 0x000400FC, + 0x0B6, 0x000187F0, + 0x0B7, 0x00030018, + 0x0B8, 0x00080800, + 0x0B9, 0x00000000, + 0x0BA, 0x00008000, + 0x0BB, 0x00000004, + 0x0BC, 0x00040000, + 0x0BD, 0x00000000, + 0x0BE, 0x00000000, + 0x0BF, 0x00000000, + 0x0C0, 0x00000000, + 0x0C1, 0x00000000, + 0x0C2, 0x00000000, + 0x0C3, 0x00000000, + 0x0C4, 0x00002402, + 0x0C5, 0x00000009, + 0x0C6, 0x00040299, + 0x0C7, 0x00055555, + 0x0C8, 0x0000C16C, + 0x0C9, 0x0001C140, + 0x0CA, 0x00000000, + 0x0CB, 0x00000000, + 0x0CC, 0x00000000, + 0x0CD, 0x00000000, + 0x0CE, 0x00090C00, + 0x0CF, 0x0006D200, + 0x0DF, 0x00000009, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x0B1, 0x0007DBE4, + 0x0B2, 0x000225D1, + 0x0B3, 0x000FC760, + 0x0B4, 0x00099DD0, + 0x0B5, 0x000400FC, + 0x0B6, 0x000187F0, + 0x0B7, 0x00030018, + 0x0B8, 0x00080800, + 0x0B9, 0x00000000, + 0x0BA, 0x00008000, + 0x0BB, 0x00000004, + 0x0BC, 0x00040000, + 0x0BD, 0x00000000, + 0x0BE, 0x00000000, + 0x0BF, 0x00000000, + 0x0C0, 0x00000000, + 0x0C1, 0x00000000, + 0x0C2, 0x00000000, + 0x0C3, 0x00000000, + 0x0C4, 0x00002402, + 0x0C5, 0x00000009, + 0x0C6, 0x00040299, + 0x0C7, 0x00055555, + 0x0C8, 0x0000C16C, + 0x0C9, 0x0001C140, + 0x0CA, 0x00000000, + 0x0CB, 0x00000000, + 0x0CC, 0x00000000, + 0x0CD, 0x00000000, + 0x0CE, 0x00090C00, + 0x0CF, 0x0006D200, + 0x0DF, 0x00000009, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x0B1, 0x0007DBE4, + 0x0B2, 0x000225D1, + 0x0B3, 0x000FC760, + 0x0B4, 0x00099DD0, + 0x0B5, 0x000400FC, + 0x0B6, 0x000187F0, + 0x0B7, 0x00030018, + 0x0B8, 0x00080800, + 0x0B9, 0x00000000, + 0x0BA, 0x00008000, + 0x0BB, 0x00000004, + 0x0BC, 0x00040000, + 0x0BD, 0x00000000, + 0x0BE, 0x00000000, + 0x0BF, 0x00000000, + 0x0C0, 0x00000000, + 0x0C1, 0x00000000, + 0x0C2, 0x00000000, + 0x0C3, 0x00000000, + 0x0C4, 0x00002402, + 0x0C5, 0x00000009, + 0x0C6, 0x00040299, + 0x0C7, 0x00055555, + 0x0C8, 0x0000C16C, + 0x0C9, 0x0001C140, + 0x0CA, 0x00000000, + 0x0CB, 0x00000000, + 0x0CC, 0x00000000, + 0x0CD, 0x00000000, + 0x0CE, 0x00090C00, + 0x0CF, 0x0006D200, + 0x0DF, 0x00000009, + 0xA0000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x0B1, 0x0007DBE4, + 0x0B2, 0x000225D1, + 0x0B3, 0x000FC760, + 0x0B4, 0x00099DD0, + 0x0B5, 0x000400FC, + 0x0B6, 0x000187F0, + 0x0B7, 0x00030018, + 0x0B8, 0x00080800, + 0x0B9, 0x00000000, + 0x0BA, 0x00008000, + 0x0BB, 0x00000004, + 0x0BC, 0x00040000, + 0x0BD, 0x00000000, + 0x0BE, 0x00000000, + 0x0BF, 0x00000000, + 0x0C0, 0x00000000, + 0x0C1, 0x00000000, + 0x0C2, 0x00000000, + 0x0C3, 0x00000000, + 0x0C4, 0x00002402, + 0x0C5, 0x00000009, + 0x0C6, 0x00040299, + 0x0C7, 0x00055555, + 0x0C8, 0x0000C16C, + 0x0C9, 0x0001C140, + 0x0CA, 0x00000000, + 0x0CB, 0x00000000, + 0x0CC, 0x00000000, + 0x0CD, 0x00000000, + 0x0CE, 0x00090C00, + 0x0CF, 0x0006D200, + 0x0DF, 0x00000009, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00010000, + 0x033, 0x00000058, + 0x03F, 0x0000001C, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00010000, + 0x033, 0x00000058, + 0x03F, 0x0000001C, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00010000, + 0x033, 0x00000058, + 0x03F, 0x0000001C, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00010000, + 0x033, 0x00000058, + 0x03F, 0x0000001C, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00010524, + 0x081, 0x0000FCC1, + 0x089, 0x00000004, + 0x08A, 0x0008A186, + 0x08B, 0x0006FFFC, + 0x08C, 0x000312C7, + 0x08D, 0x00020888, + 0x08E, 0x00064140, + 0x08F, 0x000A8010, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00010524, + 0x081, 0x0000FCC1, + 0x089, 0x00000004, + 0x08A, 0x0008A186, + 0x08B, 0x0006FFFC, + 0x08C, 0x000312C7, + 0x08D, 0x00020888, + 0x08E, 0x00064140, + 0x08F, 0x000A8010, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00010524, + 0x081, 0x0000FCC1, + 0x089, 0x00000004, + 0x08A, 0x0008A186, + 0x08B, 0x0007060C, + 0x08C, 0x000312C7, + 0x08D, 0x00020888, + 0x08E, 0x00064140, + 0x08F, 0x000A8010, + 0xA0000000, 0x00000000, + 0x018, 0x00010524, + 0x081, 0x0000FCC1, + 0x089, 0x00000004, + 0x08A, 0x0008A186, + 0x08B, 0x0007060C, + 0x08C, 0x000312C7, + 0x08D, 0x00020888, + 0x08E, 0x00064140, + 0x08F, 0x000A8010, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000020, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000020, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000020, + 0xA0000000, 0x00000000, + 0x0DD, 0x00000020, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00020000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000007, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x00000006, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x00000005, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x00000004, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x00000003, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x00000002, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000001, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000000, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000007, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x00000006, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x00000005, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x00000004, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x00000003, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x00000002, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000001, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000000, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000007, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x00000006, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x00000005, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x00000004, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x00000003, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x00000002, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000001, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000000, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0xA0000000, 0x00000000, + 0x033, 0x00000007, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x00000006, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x00000005, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x00000004, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x00000003, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x00000002, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000001, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000000, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000000F, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x0000000E, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x0000000D, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x0000000C, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x0000000B, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x0000000A, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000009, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000008, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000000F, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x0000000E, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x0000000D, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x0000000C, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x0000000B, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x0000000A, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000009, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000008, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000000F, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x0000000E, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x0000000D, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x0000000C, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x0000000B, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x0000000A, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000009, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000008, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0xA0000000, 0x00000000, + 0x033, 0x0000000F, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x0000000E, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x0000000D, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x0000000C, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x0000000B, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x0000000A, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000009, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000008, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000017, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x00000016, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x00000015, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x00000014, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x00000013, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x00000012, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000011, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000010, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000017, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x00000016, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x00000015, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x00000014, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x00000013, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x00000012, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000011, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000010, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000017, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x00000016, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x00000015, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x00000014, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x00000013, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x00000012, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000011, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000010, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x033, 0x00000017, + 0x03E, 0x00038000, + 0x03F, 0x000C3186, + 0x033, 0x00000016, + 0x03E, 0x00038080, + 0x03F, 0x000C3186, + 0x033, 0x00000015, + 0x03E, 0x000380C8, + 0x03F, 0x000C3186, + 0x033, 0x00000014, + 0x03E, 0x00038190, + 0x03F, 0x000C3186, + 0x033, 0x00000013, + 0x03E, 0x00038998, + 0x03F, 0x000C3186, + 0x033, 0x00000012, + 0x03E, 0x00039840, + 0x03F, 0x000C3186, + 0x033, 0x00000011, + 0x03E, 0x000398C4, + 0x03F, 0x000C3186, + 0x033, 0x00000010, + 0x03E, 0x00039930, + 0x03F, 0x000C3186, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x0000000F, + 0x033, 0x00000001, + 0x03F, 0x0000000A, + 0x033, 0x00000002, + 0x03F, 0x00000005, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x0000000F, + 0x033, 0x00000001, + 0x03F, 0x0000000A, + 0x033, 0x00000002, + 0x03F, 0x00000005, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x0000000F, + 0x033, 0x00000001, + 0x03F, 0x0000000A, + 0x033, 0x00000002, + 0x03F, 0x00000005, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x0000000F, + 0x033, 0x00000001, + 0x03F, 0x0000000A, + 0x033, 0x00000002, + 0x03F, 0x00000005, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00000401, + 0x084, 0x00001209, + 0x086, 0x000001A0, + 0x087, 0x000E8180, + 0x088, 0x00006020, + 0x0DF, 0x00008009, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00000401, + 0x084, 0x00001209, + 0x086, 0x000001A0, + 0x087, 0x000E8180, + 0x088, 0x00006020, + 0x0DF, 0x00008009, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00000401, + 0x084, 0x00001209, + 0x086, 0x000001A0, + 0x087, 0x000E8180, + 0x088, 0x00006020, + 0x0DF, 0x00008009, + 0xA0000000, 0x00000000, + 0x018, 0x00000401, + 0x084, 0x00001209, + 0x086, 0x000001A0, + 0x087, 0x000E8180, + 0x088, 0x00006020, + 0x0DF, 0x00008009, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00008000, + 0x033, 0x0000000F, + 0x03F, 0x0000003C, + 0x033, 0x0000000E, + 0x03F, 0x00000038, + 0x033, 0x0000000D, + 0x03F, 0x00000030, + 0x033, 0x0000000C, + 0x03F, 0x00000028, + 0x033, 0x0000000B, + 0x03F, 0x00000020, + 0x033, 0x0000000A, + 0x03F, 0x00000018, + 0x033, 0x00000009, + 0x03F, 0x00000010, + 0x033, 0x00000008, + 0x03F, 0x00000008, + 0x033, 0x00000007, + 0x03F, 0x0000003C, + 0x033, 0x00000006, + 0x03F, 0x00000038, + 0x033, 0x00000005, + 0x03F, 0x00000030, + 0x033, 0x00000004, + 0x03F, 0x00000028, + 0x033, 0x00000003, + 0x03F, 0x00000020, + 0x033, 0x00000002, + 0x03F, 0x00000018, + 0x033, 0x00000001, + 0x03F, 0x00000010, + 0x033, 0x00000000, + 0x03F, 0x00000008, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00008000, + 0x033, 0x0000000F, + 0x03F, 0x0000003C, + 0x033, 0x0000000E, + 0x03F, 0x00000038, + 0x033, 0x0000000D, + 0x03F, 0x00000030, + 0x033, 0x0000000C, + 0x03F, 0x00000028, + 0x033, 0x0000000B, + 0x03F, 0x00000020, + 0x033, 0x0000000A, + 0x03F, 0x00000018, + 0x033, 0x00000009, + 0x03F, 0x00000010, + 0x033, 0x00000008, + 0x03F, 0x00000008, + 0x033, 0x00000007, + 0x03F, 0x0000003C, + 0x033, 0x00000006, + 0x03F, 0x00000038, + 0x033, 0x00000005, + 0x03F, 0x00000030, + 0x033, 0x00000004, + 0x03F, 0x00000028, + 0x033, 0x00000003, + 0x03F, 0x00000020, + 0x033, 0x00000002, + 0x03F, 0x00000018, + 0x033, 0x00000001, + 0x03F, 0x00000010, + 0x033, 0x00000000, + 0x03F, 0x00000008, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00008000, + 0x033, 0x0000000F, + 0x03F, 0x0000003C, + 0x033, 0x0000000E, + 0x03F, 0x00000038, + 0x033, 0x0000000D, + 0x03F, 0x00000030, + 0x033, 0x0000000C, + 0x03F, 0x00000028, + 0x033, 0x0000000B, + 0x03F, 0x00000020, + 0x033, 0x0000000A, + 0x03F, 0x00000018, + 0x033, 0x00000009, + 0x03F, 0x00000010, + 0x033, 0x00000008, + 0x03F, 0x00000008, + 0x033, 0x00000007, + 0x03F, 0x0000003C, + 0x033, 0x00000006, + 0x03F, 0x00000038, + 0x033, 0x00000005, + 0x03F, 0x00000030, + 0x033, 0x00000004, + 0x03F, 0x00000028, + 0x033, 0x00000003, + 0x03F, 0x00000020, + 0x033, 0x00000002, + 0x03F, 0x00000018, + 0x033, 0x00000001, + 0x03F, 0x00000010, + 0x033, 0x00000000, + 0x03F, 0x00000008, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00008000, + 0x033, 0x0000000F, + 0x03F, 0x0000003C, + 0x033, 0x0000000E, + 0x03F, 0x00000038, + 0x033, 0x0000000D, + 0x03F, 0x00000030, + 0x033, 0x0000000C, + 0x03F, 0x00000028, + 0x033, 0x0000000B, + 0x03F, 0x00000020, + 0x033, 0x0000000A, + 0x03F, 0x00000018, + 0x033, 0x00000009, + 0x03F, 0x00000010, + 0x033, 0x00000008, + 0x03F, 0x00000008, + 0x033, 0x00000007, + 0x03F, 0x0000003C, + 0x033, 0x00000006, + 0x03F, 0x00000038, + 0x033, 0x00000005, + 0x03F, 0x00000030, + 0x033, 0x00000004, + 0x03F, 0x00000028, + 0x033, 0x00000003, + 0x03F, 0x00000020, + 0x033, 0x00000002, + 0x03F, 0x00000018, + 0x033, 0x00000001, + 0x03F, 0x00000010, + 0x033, 0x00000000, + 0x03F, 0x00000008, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000002, + 0x033, 0x0000001E, + 0x03F, 0x00000000, + 0x033, 0x0000001C, + 0x03F, 0x00000000, + 0x033, 0x0000000E, + 0x03F, 0x00000000, + 0x033, 0x0000000C, + 0x03F, 0x00000000, + 0x033, 0x0000000A, + 0x03F, 0x00000002, + 0x033, 0x00000008, + 0x03F, 0x00000000, + 0x033, 0x00000036, + 0x03F, 0x00000000, + 0x033, 0x00000037, + 0x03F, 0x00000000, + 0x033, 0x00000034, + 0x03F, 0x00000000, + 0x033, 0x00000026, + 0x03F, 0x00000006, + 0x033, 0x00000027, + 0x03F, 0x00000006, + 0x033, 0x00000024, + 0x03F, 0x00000006, + 0x033, 0x00000022, + 0x03F, 0x00000006, + 0x033, 0x00000020, + 0x03F, 0x00000006, + 0x033, 0x00000006, + 0x03F, 0x00000000, + 0x033, 0x00000007, + 0x03F, 0x00000006, + 0x033, 0x00000004, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000006, + 0x033, 0x00000000, + 0x03F, 0x00000006, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000002, + 0x033, 0x0000001E, + 0x03F, 0x00000000, + 0x033, 0x0000001C, + 0x03F, 0x00000000, + 0x033, 0x0000000E, + 0x03F, 0x00000000, + 0x033, 0x0000000C, + 0x03F, 0x00000000, + 0x033, 0x0000000A, + 0x03F, 0x00000002, + 0x033, 0x00000008, + 0x03F, 0x00000000, + 0x033, 0x00000036, + 0x03F, 0x00000000, + 0x033, 0x00000037, + 0x03F, 0x00000000, + 0x033, 0x00000034, + 0x03F, 0x00000000, + 0x033, 0x00000026, + 0x03F, 0x00000006, + 0x033, 0x00000027, + 0x03F, 0x00000006, + 0x033, 0x00000024, + 0x03F, 0x00000006, + 0x033, 0x00000022, + 0x03F, 0x00000006, + 0x033, 0x00000020, + 0x03F, 0x00000006, + 0x033, 0x00000006, + 0x03F, 0x00000000, + 0x033, 0x00000007, + 0x03F, 0x00000006, + 0x033, 0x00000004, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000006, + 0x033, 0x00000000, + 0x03F, 0x00000006, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000002, + 0x033, 0x0000001E, + 0x03F, 0x00000000, + 0x033, 0x0000001C, + 0x03F, 0x00000000, + 0x033, 0x0000000E, + 0x03F, 0x00000000, + 0x033, 0x0000000C, + 0x03F, 0x00000000, + 0x033, 0x0000000A, + 0x03F, 0x00000002, + 0x033, 0x00000008, + 0x03F, 0x00000000, + 0x033, 0x00000036, + 0x03F, 0x00000000, + 0x033, 0x00000037, + 0x03F, 0x00000000, + 0x033, 0x00000034, + 0x03F, 0x00000000, + 0x033, 0x00000026, + 0x03F, 0x00000006, + 0x033, 0x00000027, + 0x03F, 0x00000006, + 0x033, 0x00000024, + 0x03F, 0x00000006, + 0x033, 0x00000022, + 0x03F, 0x00000006, + 0x033, 0x00000020, + 0x03F, 0x00000006, + 0x033, 0x00000006, + 0x03F, 0x00000000, + 0x033, 0x00000007, + 0x03F, 0x00000006, + 0x033, 0x00000004, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000006, + 0x033, 0x00000000, + 0x03F, 0x00000006, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00000002, + 0x033, 0x0000001E, + 0x03F, 0x00000000, + 0x033, 0x0000001C, + 0x03F, 0x00000000, + 0x033, 0x0000000E, + 0x03F, 0x00000000, + 0x033, 0x0000000C, + 0x03F, 0x00000000, + 0x033, 0x0000000A, + 0x03F, 0x00000002, + 0x033, 0x00000008, + 0x03F, 0x00000000, + 0x033, 0x00000036, + 0x03F, 0x00000000, + 0x033, 0x00000037, + 0x03F, 0x00000000, + 0x033, 0x00000034, + 0x03F, 0x00000000, + 0x033, 0x00000026, + 0x03F, 0x00000006, + 0x033, 0x00000027, + 0x03F, 0x00000006, + 0x033, 0x00000024, + 0x03F, 0x00000006, + 0x033, 0x00000022, + 0x03F, 0x00000006, + 0x033, 0x00000020, + 0x03F, 0x00000006, + 0x033, 0x00000006, + 0x03F, 0x00000000, + 0x033, 0x00000007, + 0x03F, 0x00000006, + 0x033, 0x00000004, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000006, + 0x033, 0x00000000, + 0x03F, 0x00000006, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0A0, 0x000F0005, + 0x0A1, 0x0006C000, + 0x0A2, 0x0000161B, + 0x0A3, 0x000B9CBD, + 0x0AF, 0x00070000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0A0, 0x000F0005, + 0x0A1, 0x0006C000, + 0x0A2, 0x0000161B, + 0x0A3, 0x000B9CBD, + 0x0AF, 0x00070000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0A0, 0x000F0005, + 0x0A1, 0x0006C000, + 0x0A2, 0x0000161B, + 0x0A3, 0x000B9CBD, + 0x0AF, 0x00070000, + 0xA0000000, 0x00000000, + 0x0A0, 0x000F0005, + 0x0A1, 0x0006C000, + 0x0A2, 0x0000161B, + 0x0A3, 0x000B9CBD, + 0x0AF, 0x00070000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0DE, 0x00000200, + 0x0EE, 0x00000100, + 0x033, 0x00000007, + 0x03F, 0x00000043, + 0x033, 0x00000006, + 0x03F, 0x0000007A, + 0x033, 0x00000005, + 0x03F, 0x00000041, + 0x033, 0x00000004, + 0x03F, 0x00000079, + 0x033, 0x00000003, + 0x03F, 0x00000043, + 0x033, 0x00000002, + 0x03F, 0x0000007A, + 0x033, 0x00000001, + 0x03F, 0x00000041, + 0x033, 0x00000000, + 0x03F, 0x00000079, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0DE, 0x00000200, + 0x0EE, 0x00000100, + 0x033, 0x00000007, + 0x03F, 0x00000043, + 0x033, 0x00000006, + 0x03F, 0x0000007A, + 0x033, 0x00000005, + 0x03F, 0x00000041, + 0x033, 0x00000004, + 0x03F, 0x00000079, + 0x033, 0x00000003, + 0x03F, 0x00000043, + 0x033, 0x00000002, + 0x03F, 0x0000007A, + 0x033, 0x00000001, + 0x03F, 0x00000041, + 0x033, 0x00000000, + 0x03F, 0x00000079, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0DE, 0x00000200, + 0x0EE, 0x00000100, + 0x033, 0x00000007, + 0x03F, 0x00000043, + 0x033, 0x00000006, + 0x03F, 0x0000007A, + 0x033, 0x00000005, + 0x03F, 0x00000041, + 0x033, 0x00000004, + 0x03F, 0x00000079, + 0x033, 0x00000003, + 0x03F, 0x00000043, + 0x033, 0x00000002, + 0x03F, 0x0000007A, + 0x033, 0x00000001, + 0x03F, 0x00000041, + 0x033, 0x00000000, + 0x03F, 0x00000079, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0DE, 0x00000200, + 0x0EE, 0x00000100, + 0x033, 0x00000007, + 0x03F, 0x00000043, + 0x033, 0x00000006, + 0x03F, 0x0000007A, + 0x033, 0x00000005, + 0x03F, 0x00000041, + 0x033, 0x00000004, + 0x03F, 0x00000079, + 0x033, 0x00000003, + 0x03F, 0x00000043, + 0x033, 0x00000002, + 0x03F, 0x0000007A, + 0x033, 0x00000001, + 0x03F, 0x00000041, + 0x033, 0x00000000, + 0x03F, 0x00000079, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0B8, 0x00080A00, + 0x0B0, 0x000FF0FA, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0B8, 0x00080A00, + 0x0B0, 0x000FF0FA, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0B8, 0x00080A00, + 0x0B0, 0x000FF0FA, + 0xA0000000, 0x00000000, + 0x0B8, 0x00080A00, + 0x0B0, 0x000FF0FA, + 0xB0000000, 0x00000000, + 0xFFE, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0CA, 0x00080000, + 0x0C9, 0x0001C141, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0CA, 0x00080000, + 0x0C9, 0x0001C141, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0CA, 0x00080000, + 0x0C9, 0x0001C141, + 0xA0000000, 0x00000000, + 0x0CA, 0x00080000, + 0x0C9, 0x0001C141, + 0xB0000000, 0x00000000, + 0xFFE, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0xA0000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00018D24, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00018D24, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00018D24, + 0xA0000000, 0x00000000, + 0x018, 0x00018D24, + 0xB0000000, 0x00000000, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00010D24, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00010D24, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x018, 0x00010D24, + 0xA0000000, 0x00000000, + 0x018, 0x00010D24, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x01B, 0x00003A40, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x01B, 0x00003A40, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x01B, 0x00003A40, + 0xA0000000, 0x00000000, + 0x01B, 0x00003A40, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0004D3A3, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0004D3A3, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0004D3A1, + 0x062, 0x0000D3A3, + 0x063, 0x00000002, + 0xA0000000, 0x00000000, + 0x061, 0x0004D3A1, + 0x062, 0x0000D3A3, + 0x063, 0x00000002, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000000, + 0x03F, 0x00033303, + 0x030, 0x00001000, + 0x03F, 0x00033303, + 0x030, 0x00002000, + 0x03F, 0x00033303, + 0x030, 0x00003000, + 0x03F, 0x00033303, + 0x030, 0x00004000, + 0x03F, 0x00033303, + 0x030, 0x00005000, + 0x03F, 0x00033303, + 0x030, 0x00006000, + 0x03F, 0x00033303, + 0x030, 0x00007000, + 0x03F, 0x00033303, + 0x030, 0x00008000, + 0x03F, 0x00033303, + 0x030, 0x00009000, + 0x03F, 0x00033303, + 0x030, 0x0000A000, + 0x03F, 0x00033303, + 0x030, 0x0000B000, + 0x03F, 0x00033303, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000000, + 0x03F, 0x000333A3, + 0x030, 0x00001000, + 0x03F, 0x000333A3, + 0x030, 0x00002000, + 0x03F, 0x000333A3, + 0x030, 0x00003000, + 0x03F, 0x000333A3, + 0x030, 0x00004000, + 0x03F, 0x000313A3, + 0x030, 0x00005000, + 0x03F, 0x000313A3, + 0x030, 0x00006000, + 0x03F, 0x000313A3, + 0x030, 0x00007000, + 0x03F, 0x000313A3, + 0x030, 0x00008000, + 0x03F, 0x000333A3, + 0x030, 0x00009000, + 0x03F, 0x000333A3, + 0x030, 0x0000A000, + 0x03F, 0x000333A3, + 0x030, 0x0000B000, + 0x03F, 0x000333A3, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000000, + 0x03F, 0x000335A3, + 0x030, 0x00001000, + 0x03F, 0x000335A3, + 0x030, 0x00002000, + 0x03F, 0x000335A3, + 0x030, 0x00003000, + 0x03F, 0x000335A3, + 0x030, 0x00004000, + 0x03F, 0x000335A3, + 0x030, 0x00005000, + 0x03F, 0x000335A3, + 0x030, 0x00006000, + 0x03F, 0x000335A3, + 0x030, 0x00007000, + 0x03F, 0x000335A3, + 0x030, 0x00008000, + 0x03F, 0x000335A3, + 0x030, 0x00009000, + 0x03F, 0x000335A3, + 0x030, 0x0000A000, + 0x03F, 0x000335A3, + 0x030, 0x0000B000, + 0x03F, 0x000335A3, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000000, + 0x03F, 0x000335A3, + 0x030, 0x00001000, + 0x03F, 0x000335A3, + 0x030, 0x00002000, + 0x03F, 0x000335A3, + 0x030, 0x00003000, + 0x03F, 0x000335A3, + 0x030, 0x00004000, + 0x03F, 0x000335A3, + 0x030, 0x00005000, + 0x03F, 0x000335A3, + 0x030, 0x00006000, + 0x03F, 0x000335A3, + 0x030, 0x00007000, + 0x03F, 0x000335A3, + 0x030, 0x00008000, + 0x03F, 0x000335A3, + 0x030, 0x00009000, + 0x03F, 0x000335A3, + 0x030, 0x0000A000, + 0x03F, 0x000335A3, + 0x030, 0x0000B000, + 0x03F, 0x000335A3, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x033, 0x00000000, + 0x03F, 0x00033303, + 0x033, 0x00000001, + 0x03F, 0x00033303, + 0x033, 0x00000002, + 0x03F, 0x00033303, + 0x033, 0x00000003, + 0x03F, 0x00033303, + 0x033, 0x00000004, + 0x03F, 0x00033303, + 0x033, 0x00000005, + 0x03F, 0x00033303, + 0x033, 0x00000006, + 0x03F, 0x00033303, + 0x033, 0x00000007, + 0x03F, 0x00033303, + 0x033, 0x00000008, + 0x03F, 0x00033303, + 0x033, 0x00000009, + 0x03F, 0x00033303, + 0x033, 0x0000000A, + 0x03F, 0x00033303, + 0x033, 0x0000000B, + 0x03F, 0x00033303, + 0x033, 0x0000000C, + 0x03F, 0x00033303, + 0x033, 0x0000000D, + 0x03F, 0x00033303, + 0x033, 0x0000000E, + 0x03F, 0x00033303, + 0x033, 0x0000000F, + 0x03F, 0x00033303, + 0x033, 0x00000010, + 0x03F, 0x00033303, + 0x033, 0x00000011, + 0x03F, 0x00033303, + 0x033, 0x00000012, + 0x03F, 0x00033303, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x033, 0x00000000, + 0x03F, 0x000333A3, + 0x033, 0x00000001, + 0x03F, 0x000333A3, + 0x033, 0x00000002, + 0x03F, 0x000333A3, + 0x033, 0x00000003, + 0x03F, 0x000333A3, + 0x033, 0x00000004, + 0x03F, 0x000333A3, + 0x033, 0x00000005, + 0x03F, 0x000333A3, + 0x033, 0x00000006, + 0x03F, 0x000333A3, + 0x033, 0x00000007, + 0x03F, 0x000333A3, + 0x033, 0x00000008, + 0x03F, 0x000313A3, + 0x033, 0x00000009, + 0x03F, 0x000313A3, + 0x033, 0x0000000A, + 0x03F, 0x000313A3, + 0x033, 0x0000000B, + 0x03F, 0x000313A3, + 0x033, 0x0000000C, + 0x03F, 0x000313A3, + 0x033, 0x0000000D, + 0x03F, 0x000333A3, + 0x033, 0x0000000E, + 0x03F, 0x000333A3, + 0x033, 0x0000000F, + 0x03F, 0x000333A3, + 0x033, 0x00000010, + 0x03F, 0x000333A3, + 0x033, 0x00000011, + 0x03F, 0x000333A3, + 0x033, 0x00000012, + 0x03F, 0x000333A3, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x033, 0x00000000, + 0x03F, 0x000335A3, + 0x033, 0x00000001, + 0x03F, 0x000335A3, + 0x033, 0x00000002, + 0x03F, 0x000335A3, + 0x033, 0x00000003, + 0x03F, 0x000335A3, + 0x033, 0x00000004, + 0x03F, 0x000335A3, + 0x033, 0x00000005, + 0x03F, 0x000335A3, + 0x033, 0x00000006, + 0x03F, 0x000335A3, + 0x033, 0x00000007, + 0x03F, 0x000335A3, + 0x033, 0x00000008, + 0x03F, 0x000335A3, + 0x033, 0x00000009, + 0x03F, 0x000335A3, + 0x033, 0x0000000A, + 0x03F, 0x000335A3, + 0x033, 0x0000000B, + 0x03F, 0x000335A3, + 0x033, 0x0000000C, + 0x03F, 0x000335A3, + 0x033, 0x0000000D, + 0x03F, 0x000335A3, + 0x033, 0x0000000E, + 0x03F, 0x000335A3, + 0x033, 0x0000000F, + 0x03F, 0x000335A3, + 0x033, 0x00000010, + 0x03F, 0x000335A3, + 0x033, 0x00000011, + 0x03F, 0x000335A3, + 0x033, 0x00000012, + 0x03F, 0x000335A3, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000080, + 0x033, 0x00000000, + 0x03F, 0x000335A3, + 0x033, 0x00000001, + 0x03F, 0x000335A3, + 0x033, 0x00000002, + 0x03F, 0x000335A3, + 0x033, 0x00000003, + 0x03F, 0x000335A3, + 0x033, 0x00000004, + 0x03F, 0x000335A3, + 0x033, 0x00000005, + 0x03F, 0x000335A3, + 0x033, 0x00000006, + 0x03F, 0x000335A3, + 0x033, 0x00000007, + 0x03F, 0x000335A3, + 0x033, 0x00000008, + 0x03F, 0x000335A3, + 0x033, 0x00000009, + 0x03F, 0x000335A3, + 0x033, 0x0000000A, + 0x03F, 0x000335A3, + 0x033, 0x0000000B, + 0x03F, 0x000335A3, + 0x033, 0x0000000C, + 0x03F, 0x000335A3, + 0x033, 0x0000000D, + 0x03F, 0x000335A3, + 0x033, 0x0000000E, + 0x03F, 0x000335A3, + 0x033, 0x0000000F, + 0x03F, 0x000335A3, + 0x033, 0x00000010, + 0x03F, 0x000335A3, + 0x033, 0x00000011, + 0x03F, 0x000335A3, + 0x033, 0x00000012, + 0x03F, 0x000335A3, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000644, + 0x030, 0x00001135, + 0x030, 0x00002133, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000644, + 0x030, 0x00001412, + 0x030, 0x00002202, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000640, + 0x030, 0x00001512, + 0x030, 0x00002202, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000640, + 0x030, 0x00001512, + 0x030, 0x00002202, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000800, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000800, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000800, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000800, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000001, + 0x033, 0x00000021, + 0x03F, 0x00000004, + 0x033, 0x00000022, + 0x03F, 0x00000007, + 0x033, 0x00000023, + 0x03F, 0x00000024, + 0x033, 0x00000024, + 0x03F, 0x00000027, + 0x033, 0x00000025, + 0x03F, 0x0000002A, + 0x033, 0x00000026, + 0x03F, 0x0000002D, + 0x033, 0x00000027, + 0x03F, 0x00000030, + 0x033, 0x00000028, + 0x03F, 0x00000033, + 0x033, 0x00000029, + 0x03F, 0x00000036, + 0x033, 0x0000002A, + 0x03F, 0x00000039, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000E42, + 0x033, 0x00000021, + 0x03F, 0x00000E45, + 0x033, 0x00000022, + 0x03F, 0x00000E65, + 0x033, 0x00000023, + 0x03F, 0x00000E68, + 0x033, 0x00000024, + 0x03F, 0x00000EE4, + 0x033, 0x00000025, + 0x03F, 0x00000EE7, + 0x033, 0x00000026, + 0x03F, 0x00000EEA, + 0x033, 0x00000027, + 0x03F, 0x00000EED, + 0x033, 0x00000028, + 0x03F, 0x00000EF0, + 0x033, 0x00000029, + 0x03F, 0x00000EF3, + 0x033, 0x0000002A, + 0x03F, 0x00000EF6, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000E42, + 0x033, 0x00000021, + 0x03F, 0x00000E45, + 0x033, 0x00000022, + 0x03F, 0x00000E48, + 0x033, 0x00000023, + 0x03F, 0x00000E68, + 0x033, 0x00000024, + 0x03F, 0x00000E6B, + 0x033, 0x00000025, + 0x03F, 0x00000EAA, + 0x033, 0x00000026, + 0x03F, 0x00000EEA, + 0x033, 0x00000027, + 0x03F, 0x00000EED, + 0x033, 0x00000028, + 0x03F, 0x00000EF0, + 0x033, 0x00000029, + 0x03F, 0x00000EF3, + 0x033, 0x0000002A, + 0x03F, 0x00000EF6, + 0xA0000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000E42, + 0x033, 0x00000021, + 0x03F, 0x00000E45, + 0x033, 0x00000022, + 0x03F, 0x00000E65, + 0x033, 0x00000023, + 0x03F, 0x00000E68, + 0x033, 0x00000024, + 0x03F, 0x00000EE4, + 0x033, 0x00000025, + 0x03F, 0x00000EE7, + 0x033, 0x00000026, + 0x03F, 0x00000EEA, + 0x033, 0x00000027, + 0x03F, 0x00000EED, + 0x033, 0x00000028, + 0x03F, 0x00000EF0, + 0x033, 0x00000029, + 0x03F, 0x00000EF3, + 0x033, 0x0000002A, + 0x03F, 0x00000EF6, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000001, + 0x033, 0x00000061, + 0x03F, 0x00000004, + 0x033, 0x00000062, + 0x03F, 0x00000007, + 0x033, 0x00000063, + 0x03F, 0x00000024, + 0x033, 0x00000064, + 0x03F, 0x00000027, + 0x033, 0x00000065, + 0x03F, 0x0000002A, + 0x033, 0x00000066, + 0x03F, 0x0000002D, + 0x033, 0x00000067, + 0x03F, 0x00000030, + 0x033, 0x00000068, + 0x03F, 0x00000033, + 0x033, 0x00000069, + 0x03F, 0x00000036, + 0x033, 0x0000006A, + 0x03F, 0x00000039, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000E42, + 0x033, 0x00000061, + 0x03F, 0x00000E45, + 0x033, 0x00000062, + 0x03F, 0x00000E65, + 0x033, 0x00000063, + 0x03F, 0x00000E68, + 0x033, 0x00000064, + 0x03F, 0x00000EE5, + 0x033, 0x00000065, + 0x03F, 0x00000EE8, + 0x033, 0x00000066, + 0x03F, 0x00000EEB, + 0x033, 0x00000067, + 0x03F, 0x00000EEE, + 0x033, 0x00000068, + 0x03F, 0x00000EF1, + 0x033, 0x00000069, + 0x03F, 0x00000EF4, + 0x033, 0x0000006A, + 0x03F, 0x00000EF7, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000E09, + 0x033, 0x00000061, + 0x03F, 0x00000E43, + 0x033, 0x00000062, + 0x03F, 0x00000E46, + 0x033, 0x00000063, + 0x03F, 0x00000E49, + 0x033, 0x00000064, + 0x03F, 0x00000E88, + 0x033, 0x00000065, + 0x03F, 0x00000E8B, + 0x033, 0x00000066, + 0x03F, 0x00000ECB, + 0x033, 0x00000067, + 0x03F, 0x00000ECE, + 0x033, 0x00000068, + 0x03F, 0x00000EF0, + 0x033, 0x00000069, + 0x03F, 0x00000EF3, + 0x033, 0x0000006A, + 0x03F, 0x00000EF6, + 0xA0000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000E42, + 0x033, 0x00000061, + 0x03F, 0x00000E45, + 0x033, 0x00000062, + 0x03F, 0x00000E65, + 0x033, 0x00000063, + 0x03F, 0x00000E68, + 0x033, 0x00000064, + 0x03F, 0x00000EE5, + 0x033, 0x00000065, + 0x03F, 0x00000EE8, + 0x033, 0x00000066, + 0x03F, 0x00000EEB, + 0x033, 0x00000067, + 0x03F, 0x00000EEE, + 0x033, 0x00000068, + 0x03F, 0x00000EF1, + 0x033, 0x00000069, + 0x03F, 0x00000EF4, + 0x033, 0x0000006A, + 0x03F, 0x00000EF7, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000001, + 0x033, 0x000000A1, + 0x03F, 0x00000004, + 0x033, 0x000000A2, + 0x03F, 0x00000007, + 0x033, 0x000000A3, + 0x03F, 0x00000025, + 0x033, 0x000000A4, + 0x03F, 0x00000028, + 0x033, 0x000000A5, + 0x03F, 0x0000002B, + 0x033, 0x000000A6, + 0x03F, 0x0000002E, + 0x033, 0x000000A7, + 0x03F, 0x00000031, + 0x033, 0x000000A8, + 0x03F, 0x00000034, + 0x033, 0x000000A9, + 0x03F, 0x00000037, + 0x033, 0x000000AA, + 0x03F, 0x0000003A, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000E09, + 0x033, 0x000000A1, + 0x03F, 0x00000E43, + 0x033, 0x000000A2, + 0x03F, 0x00000E64, + 0x033, 0x000000A3, + 0x03F, 0x00000E67, + 0x033, 0x000000A4, + 0x03F, 0x00000EE4, + 0x033, 0x000000A5, + 0x03F, 0x00000EE7, + 0x033, 0x000000A6, + 0x03F, 0x00000EEA, + 0x033, 0x000000A7, + 0x03F, 0x00000EED, + 0x033, 0x000000A8, + 0x03F, 0x00000EF0, + 0x033, 0x000000A9, + 0x03F, 0x00000EF3, + 0x033, 0x000000AA, + 0x03F, 0x00000EF6, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000E08, + 0x033, 0x000000A1, + 0x03F, 0x00000E42, + 0x033, 0x000000A2, + 0x03F, 0x00000E45, + 0x033, 0x000000A3, + 0x03F, 0x00000E48, + 0x033, 0x000000A4, + 0x03F, 0x00000EA5, + 0x033, 0x000000A5, + 0x03F, 0x00000EA8, + 0x033, 0x000000A6, + 0x03F, 0x00000ECA, + 0x033, 0x000000A7, + 0x03F, 0x00000ECD, + 0x033, 0x000000A8, + 0x03F, 0x00000EEF, + 0x033, 0x000000A9, + 0x03F, 0x00000EF2, + 0x033, 0x000000AA, + 0x03F, 0x00000EF5, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000E09, + 0x033, 0x000000A1, + 0x03F, 0x00000E43, + 0x033, 0x000000A2, + 0x03F, 0x00000E64, + 0x033, 0x000000A3, + 0x03F, 0x00000E67, + 0x033, 0x000000A4, + 0x03F, 0x00000EE4, + 0x033, 0x000000A5, + 0x03F, 0x00000EE7, + 0x033, 0x000000A6, + 0x03F, 0x00000EEA, + 0x033, 0x000000A7, + 0x03F, 0x00000EED, + 0x033, 0x000000A8, + 0x03F, 0x00000EF0, + 0x033, 0x000000A9, + 0x03F, 0x00000EF3, + 0x033, 0x000000AA, + 0x03F, 0x00000EF6, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000400, + 0x033, 0x00000000, + 0x03F, 0x0006AC00, + 0x033, 0x00000001, + 0x03F, 0x00060C00, + 0x033, 0x00000002, + 0x03F, 0x0006AC00, + 0x033, 0x00000003, + 0x03F, 0x00086A00, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000400, + 0x033, 0x00000000, + 0x03F, 0x0006AC00, + 0x033, 0x00000001, + 0x03F, 0x00060C00, + 0x033, 0x00000002, + 0x03F, 0x0006AC00, + 0x033, 0x00000003, + 0x03F, 0x00086A00, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000400, + 0x033, 0x00000000, + 0x03F, 0x0006AC00, + 0x033, 0x00000001, + 0x03F, 0x00060C00, + 0x033, 0x00000002, + 0x03F, 0x0006AC00, + 0x033, 0x00000003, + 0x03F, 0x00086A00, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000400, + 0x033, 0x00000000, + 0x03F, 0x0006AC00, + 0x033, 0x00000001, + 0x03F, 0x00060C00, + 0x033, 0x00000002, + 0x03F, 0x0006AC00, + 0x033, 0x00000003, + 0x03F, 0x00086A00, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000100, + 0x033, 0x00000000, + 0x03F, 0x00000040, + 0x033, 0x00000001, + 0x03F, 0x00000040, + 0x033, 0x00000002, + 0x03F, 0x00000040, + 0x033, 0x00000003, + 0x03F, 0x00000040, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000100, + 0x033, 0x00000000, + 0x03F, 0x00000040, + 0x033, 0x00000001, + 0x03F, 0x00000040, + 0x033, 0x00000002, + 0x03F, 0x00000040, + 0x033, 0x00000003, + 0x03F, 0x00000040, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000100, + 0x033, 0x00000000, + 0x03F, 0x00000040, + 0x033, 0x00000001, + 0x03F, 0x00000040, + 0x033, 0x00000002, + 0x03F, 0x00000040, + 0x033, 0x00000003, + 0x03F, 0x00000040, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000100, + 0x033, 0x00000000, + 0x03F, 0x00000040, + 0x033, 0x00000001, + 0x03F, 0x00000040, + 0x033, 0x00000002, + 0x03F, 0x00000040, + 0x033, 0x00000003, + 0x03F, 0x00000040, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00040000, + 0x033, 0x00000000, + 0x03F, 0x00086A40, + 0x033, 0x00000001, + 0x03F, 0x00086A40, + 0x033, 0x00000002, + 0x03F, 0x00086A40, + 0x033, 0x00000003, + 0x03F, 0x00086A40, + 0x033, 0x00000004, + 0x03F, 0x00086A40, + 0x033, 0x00000005, + 0x03F, 0x00086A40, + 0x033, 0x00000006, + 0x03F, 0x00084A40, + 0x033, 0x00000007, + 0x03F, 0x00084A40, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00040000, + 0x033, 0x00000000, + 0x03F, 0x00086A40, + 0x033, 0x00000001, + 0x03F, 0x00086A40, + 0x033, 0x00000002, + 0x03F, 0x00086A40, + 0x033, 0x00000003, + 0x03F, 0x00086A40, + 0x033, 0x00000004, + 0x03F, 0x00086A40, + 0x033, 0x00000005, + 0x03F, 0x00086A40, + 0x033, 0x00000006, + 0x03F, 0x00084A40, + 0x033, 0x00000007, + 0x03F, 0x00084A40, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00040000, + 0x033, 0x00000000, + 0x03F, 0x00086A40, + 0x033, 0x00000001, + 0x03F, 0x00086A40, + 0x033, 0x00000002, + 0x03F, 0x00086A40, + 0x033, 0x00000003, + 0x03F, 0x00086A40, + 0x033, 0x00000004, + 0x03F, 0x00086A40, + 0x033, 0x00000005, + 0x03F, 0x00086A40, + 0x033, 0x00000006, + 0x03F, 0x00084A40, + 0x033, 0x00000007, + 0x03F, 0x00084A40, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00040000, + 0x033, 0x00000000, + 0x03F, 0x00086A40, + 0x033, 0x00000001, + 0x03F, 0x00086A40, + 0x033, 0x00000002, + 0x03F, 0x00086A40, + 0x033, 0x00000003, + 0x03F, 0x00086A40, + 0x033, 0x00000004, + 0x03F, 0x00086A40, + 0x033, 0x00000005, + 0x03F, 0x00086A40, + 0x033, 0x00000006, + 0x03F, 0x00084A40, + 0x033, 0x00000007, + 0x03F, 0x00084A40, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x051, 0x000801A8, + 0x052, 0x000972E3, + 0x053, 0x00008069, + 0x054, 0x00030032, + 0x055, 0x00082003, + 0x056, 0x00051CCB, + 0x057, 0x0000CFC2, + 0x058, 0x00000010, + 0x059, 0x00030000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x051, 0x000801A8, + 0x052, 0x000972E3, + 0x053, 0x00008069, + 0x054, 0x00030032, + 0x055, 0x00082003, + 0x056, 0x00051CCB, + 0x057, 0x0000CFC2, + 0x058, 0x00000010, + 0x059, 0x00030000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x051, 0x000801A8, + 0x052, 0x000972E3, + 0x053, 0x00008069, + 0x054, 0x00030032, + 0x055, 0x00082003, + 0x056, 0x00051CCB, + 0x057, 0x0000CFC2, + 0x058, 0x00000010, + 0x059, 0x00030000, + 0xA0000000, 0x00000000, + 0x051, 0x000801A8, + 0x052, 0x000972E3, + 0x053, 0x00008069, + 0x054, 0x00030032, + 0x055, 0x00082003, + 0x056, 0x00051CCB, + 0x057, 0x0000CFC2, + 0x058, 0x00000010, + 0x059, 0x00030000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000800, + 0x033, 0x00000000, + 0x03F, 0x00051429, + 0x033, 0x00000001, + 0x03F, 0x00051449, + 0x033, 0x00000002, + 0x03F, 0x0005144C, + 0x033, 0x00000003, + 0x03F, 0x00051C66, + 0x033, 0x00000004, + 0x03F, 0x00051C69, + 0x033, 0x00000005, + 0x03F, 0x00051C6C, + 0x033, 0x00000006, + 0x03F, 0x00051CE8, + 0x033, 0x00000007, + 0x03F, 0x00051CEB, + 0x033, 0x00000008, + 0x03F, 0x00051CEE, + 0x033, 0x00000009, + 0x03F, 0x00051CF1, + 0x033, 0x0000000A, + 0x03F, 0x00051CF4, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000800, + 0x033, 0x00000000, + 0x03F, 0x00051429, + 0x033, 0x00000001, + 0x03F, 0x00051449, + 0x033, 0x00000002, + 0x03F, 0x0005144C, + 0x033, 0x00000003, + 0x03F, 0x00051C66, + 0x033, 0x00000004, + 0x03F, 0x00051C69, + 0x033, 0x00000005, + 0x03F, 0x00051C6C, + 0x033, 0x00000006, + 0x03F, 0x00051CE8, + 0x033, 0x00000007, + 0x03F, 0x00051CEB, + 0x033, 0x00000008, + 0x03F, 0x00051CEE, + 0x033, 0x00000009, + 0x03F, 0x00051CF1, + 0x033, 0x0000000A, + 0x03F, 0x00051CF4, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000800, + 0x033, 0x00000000, + 0x03F, 0x00051427, + 0x033, 0x00000001, + 0x03F, 0x00051446, + 0x033, 0x00000002, + 0x03F, 0x00051449, + 0x033, 0x00000003, + 0x03F, 0x0005144C, + 0x033, 0x00000004, + 0x03F, 0x00051C67, + 0x033, 0x00000005, + 0x03F, 0x00051C6A, + 0x033, 0x00000006, + 0x03F, 0x00051C8B, + 0x033, 0x00000007, + 0x03F, 0x00051CE9, + 0x033, 0x00000008, + 0x03F, 0x00051CEC, + 0x033, 0x00000009, + 0x03F, 0x00051CEF, + 0x033, 0x0000000A, + 0x03F, 0x00051CF2, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000800, + 0x033, 0x00000000, + 0x03F, 0x00051427, + 0x033, 0x00000001, + 0x03F, 0x00051446, + 0x033, 0x00000002, + 0x03F, 0x00051449, + 0x033, 0x00000003, + 0x03F, 0x0005144C, + 0x033, 0x00000004, + 0x03F, 0x00051C67, + 0x033, 0x00000005, + 0x03F, 0x00051C6A, + 0x033, 0x00000006, + 0x03F, 0x00051C8B, + 0x033, 0x00000007, + 0x03F, 0x00051CE9, + 0x033, 0x00000008, + 0x03F, 0x00051CEC, + 0x033, 0x00000009, + 0x03F, 0x00051CEF, + 0x033, 0x0000000A, + 0x03F, 0x00051CF2, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x00048400, + 0x033, 0x00000001, + 0x03F, 0x00086E00, + 0x033, 0x00000002, + 0x03F, 0x00048400, + 0x033, 0x00000003, + 0x03F, 0x00048400, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x00048400, + 0x033, 0x00000001, + 0x03F, 0x00086E00, + 0x033, 0x00000002, + 0x03F, 0x00048400, + 0x033, 0x00000003, + 0x03F, 0x00048400, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x00048400, + 0x033, 0x00000001, + 0x03F, 0x00086E00, + 0x033, 0x00000002, + 0x03F, 0x00048400, + 0x033, 0x00000003, + 0x03F, 0x00048400, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x00048400, + 0x033, 0x00000001, + 0x03F, 0x00086E00, + 0x033, 0x00000002, + 0x03F, 0x00048400, + 0x033, 0x00000003, + 0x03F, 0x00048400, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00002000, + 0x033, 0x00000000, + 0x03F, 0x00000000, + 0x033, 0x00000001, + 0x03F, 0x00000000, + 0x033, 0x00000002, + 0x03F, 0x00000000, + 0x033, 0x00000003, + 0x03F, 0x00000000, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00002000, + 0x033, 0x00000000, + 0x03F, 0x00000000, + 0x033, 0x00000001, + 0x03F, 0x00000000, + 0x033, 0x00000002, + 0x03F, 0x00000000, + 0x033, 0x00000003, + 0x03F, 0x00000000, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00002000, + 0x033, 0x00000000, + 0x03F, 0x00000000, + 0x033, 0x00000001, + 0x03F, 0x00000000, + 0x033, 0x00000002, + 0x03F, 0x00000000, + 0x033, 0x00000003, + 0x03F, 0x00000000, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00002000, + 0x033, 0x00000000, + 0x03F, 0x00000000, + 0x033, 0x00000001, + 0x03F, 0x00000000, + 0x033, 0x00000002, + 0x03F, 0x00000000, + 0x033, 0x00000003, + 0x03F, 0x00000000, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00080000, + 0x033, 0x00000000, + 0x03F, 0x00048400, + 0x033, 0x00000001, + 0x03F, 0x00048400, + 0x033, 0x00000002, + 0x03F, 0x00048400, + 0x033, 0x00000003, + 0x03F, 0x00048400, + 0x033, 0x00000004, + 0x03F, 0x00048400, + 0x033, 0x00000005, + 0x03F, 0x00048400, + 0x033, 0x00000006, + 0x03F, 0x00048400, + 0x033, 0x00000007, + 0x03F, 0x00048400, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00080000, + 0x033, 0x00000000, + 0x03F, 0x00048400, + 0x033, 0x00000001, + 0x03F, 0x00048400, + 0x033, 0x00000002, + 0x03F, 0x00048400, + 0x033, 0x00000003, + 0x03F, 0x00048400, + 0x033, 0x00000004, + 0x03F, 0x00048400, + 0x033, 0x00000005, + 0x03F, 0x00048400, + 0x033, 0x00000006, + 0x03F, 0x00048400, + 0x033, 0x00000007, + 0x03F, 0x00048400, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00080000, + 0x033, 0x00000000, + 0x03F, 0x00048400, + 0x033, 0x00000001, + 0x03F, 0x00048400, + 0x033, 0x00000002, + 0x03F, 0x00048400, + 0x033, 0x00000003, + 0x03F, 0x00048400, + 0x033, 0x00000004, + 0x03F, 0x00048400, + 0x033, 0x00000005, + 0x03F, 0x00048400, + 0x033, 0x00000006, + 0x03F, 0x00048400, + 0x033, 0x00000007, + 0x03F, 0x00048400, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00080000, + 0x033, 0x00000000, + 0x03F, 0x00048400, + 0x033, 0x00000001, + 0x03F, 0x00048400, + 0x033, 0x00000002, + 0x03F, 0x00048400, + 0x033, 0x00000003, + 0x03F, 0x00048400, + 0x033, 0x00000004, + 0x03F, 0x00048400, + 0x033, 0x00000005, + 0x03F, 0x00048400, + 0x033, 0x00000006, + 0x03F, 0x00048400, + 0x033, 0x00000007, + 0x03F, 0x00048400, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x070, 0x00008000, + 0x075, 0x000027DA, + 0x076, 0x00006997, + 0x077, 0x00070418, + 0x078, 0x000BB000, + 0x07D, 0x00007600, + 0x07F, 0x00000000, + 0x06A, 0x000F4C00, + 0x065, 0x00082030, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x070, 0x00008000, + 0x075, 0x000027DA, + 0x076, 0x00006997, + 0x077, 0x00070418, + 0x078, 0x000BB000, + 0x07D, 0x00007600, + 0x07F, 0x00000000, + 0x06A, 0x000F4C00, + 0x065, 0x00082030, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x070, 0x00008000, + 0x075, 0x000027DA, + 0x076, 0x00006997, + 0x077, 0x00070418, + 0x078, 0x000BB000, + 0x07D, 0x00007600, + 0x07F, 0x00000000, + 0x06A, 0x000F4C00, + 0x065, 0x00082030, + 0xA0000000, 0x00000000, + 0x070, 0x00008000, + 0x075, 0x000027DA, + 0x076, 0x00006997, + 0x077, 0x00070418, + 0x078, 0x000BB000, + 0x07D, 0x00007600, + 0x07F, 0x00000000, + 0x06A, 0x000F4C00, + 0x065, 0x00082030, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00008000, + 0x033, 0x00000000, + 0x03F, 0x00051427, + 0x033, 0x00000001, + 0x03F, 0x00051446, + 0x033, 0x00000002, + 0x03F, 0x00051449, + 0x033, 0x00000003, + 0x03F, 0x0005144C, + 0x033, 0x00000004, + 0x03F, 0x00051C69, + 0x033, 0x00000005, + 0x03F, 0x00051C6C, + 0x033, 0x00000006, + 0x03F, 0x00051C8D, + 0x033, 0x00000007, + 0x03F, 0x00051CEB, + 0x033, 0x00000008, + 0x03F, 0x00051CEE, + 0x033, 0x00000009, + 0x03F, 0x00051CF1, + 0x033, 0x0000000A, + 0x03F, 0x00051CF4, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00008000, + 0x033, 0x00000000, + 0x03F, 0x00051427, + 0x033, 0x00000001, + 0x03F, 0x00051446, + 0x033, 0x00000002, + 0x03F, 0x00051449, + 0x033, 0x00000003, + 0x03F, 0x0005144C, + 0x033, 0x00000004, + 0x03F, 0x00051C69, + 0x033, 0x00000005, + 0x03F, 0x00051C6C, + 0x033, 0x00000006, + 0x03F, 0x00051C8D, + 0x033, 0x00000007, + 0x03F, 0x00051CEB, + 0x033, 0x00000008, + 0x03F, 0x00051CEE, + 0x033, 0x00000009, + 0x03F, 0x00051CF1, + 0x033, 0x0000000A, + 0x03F, 0x00051CF4, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00008000, + 0x033, 0x00000000, + 0x03F, 0x00051427, + 0x033, 0x00000001, + 0x03F, 0x00051446, + 0x033, 0x00000002, + 0x03F, 0x00051449, + 0x033, 0x00000003, + 0x03F, 0x0005144C, + 0x033, 0x00000004, + 0x03F, 0x00051C69, + 0x033, 0x00000005, + 0x03F, 0x00051C6C, + 0x033, 0x00000006, + 0x03F, 0x00051C8D, + 0x033, 0x00000007, + 0x03F, 0x00051CEB, + 0x033, 0x00000008, + 0x03F, 0x00051CEE, + 0x033, 0x00000009, + 0x03F, 0x00051CF1, + 0x033, 0x0000000A, + 0x03F, 0x00051CF4, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00008000, + 0x033, 0x00000000, + 0x03F, 0x00051427, + 0x033, 0x00000001, + 0x03F, 0x00051446, + 0x033, 0x00000002, + 0x03F, 0x00051449, + 0x033, 0x00000003, + 0x03F, 0x0005144C, + 0x033, 0x00000004, + 0x03F, 0x00051C69, + 0x033, 0x00000005, + 0x03F, 0x00051C6C, + 0x033, 0x00000006, + 0x03F, 0x00051C8D, + 0x033, 0x00000007, + 0x03F, 0x00051CEB, + 0x033, 0x00000008, + 0x03F, 0x00051CEE, + 0x033, 0x00000009, + 0x03F, 0x00051CF1, + 0x033, 0x0000000A, + 0x03F, 0x00051CF4, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000010, + 0x033, 0x00000000, + 0x008, 0x0009C060, + 0x033, 0x00000001, + 0x008, 0x0009C060, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000010, + 0x033, 0x00000000, + 0x008, 0x0009C060, + 0x033, 0x00000001, + 0x008, 0x0009C060, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000010, + 0x033, 0x00000000, + 0x008, 0x0009C060, + 0x033, 0x00000001, + 0x008, 0x0009C060, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000010, + 0x033, 0x00000000, + 0x008, 0x0009C060, + 0x033, 0x00000001, + 0x008, 0x0009C060, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000024, + 0x03E, 0x0000003F, + 0x03F, 0x00060FDE, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000024, + 0x03E, 0x0000003F, + 0x03F, 0x00060FDE, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000024, + 0x03E, 0x0000003F, + 0x03F, 0x00060FDE, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000024, + 0x03E, 0x0000003F, + 0x03F, 0x00060FDE, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000025, + 0x03E, 0x00000037, + 0x03F, 0x0007EFCE, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000025, + 0x03E, 0x00000037, + 0x03F, 0x0007EFCE, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000025, + 0x03E, 0x00000037, + 0x03F, 0x0007EFCE, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000025, + 0x03E, 0x00000037, + 0x03F, 0x0007EFCE, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000026, + 0x03E, 0x00000037, + 0x03F, 0x0005EFCE, + 0x0EF, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000026, + 0x03E, 0x00000037, + 0x03F, 0x0005EFCE, + 0x0EF, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000026, + 0x03E, 0x00000037, + 0x03F, 0x0005EFCE, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000026, + 0x03E, 0x00000037, + 0x03F, 0x0005EFCE, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000004, + 0x03F, 0x00001EC1, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000004, + 0x03F, 0x00001EC1, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000004, + 0x03F, 0x00001EC1, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000004, + 0x03F, 0x00001EC1, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000005, + 0x03F, 0x00001ECF, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000005, + 0x03F, 0x00001ECF, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000005, + 0x03F, 0x00001ECF, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000005, + 0x03F, 0x00001ECF, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x80001005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000006, + 0x03F, 0x00001F9D, + 0x0EE, 0x00000000, + 0x90001004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000006, + 0x03F, 0x00001F9D, + 0x0EE, 0x00000000, + 0x90000400, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000006, + 0x03F, 0x00001F9D, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00001000, + 0x033, 0x00000006, + 0x03F, 0x00001F9D, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + +}; + +RTW_DECL_TABLE_RF_RADIO(rtw8821c_rf_a, A); + +static const struct rtw_txpwr_lmt_cfg_pair rtw8821c_txpwr_lmt_type0[] = { + { 0, 0, 0, 0, 1, 30, }, + { 2, 0, 0, 0, 1, 30, }, + { 0, 0, 0, 0, 2, 32, }, + { 2, 0, 0, 0, 2, 30, }, + { 0, 0, 0, 0, 3, 32, }, + { 2, 0, 0, 0, 3, 30, }, + { 0, 0, 0, 0, 4, 32, }, + { 2, 0, 0, 0, 4, 30, }, + { 0, 0, 0, 0, 5, 32, }, + { 2, 0, 0, 0, 5, 30, }, + { 0, 0, 0, 0, 6, 32, }, + { 2, 0, 0, 0, 6, 30, }, + { 0, 0, 0, 0, 7, 32, }, + { 2, 0, 0, 0, 7, 30, }, + { 0, 0, 0, 0, 8, 32, }, + { 2, 0, 0, 0, 8, 30, }, + { 0, 0, 0, 0, 9, 32, }, + { 2, 0, 0, 0, 9, 30, }, + { 0, 0, 0, 0, 10, 32, }, + { 2, 0, 0, 0, 10, 30, }, + { 0, 0, 0, 0, 11, 32, }, + { 2, 0, 0, 0, 11, 30, }, + { 0, 0, 0, 0, 12, 24, }, + { 2, 0, 0, 0, 12, 30, }, + { 0, 0, 0, 0, 13, 16, }, + { 2, 0, 0, 0, 13, 30, }, + { 0, 0, 0, 0, 14, 63, }, + { 2, 0, 0, 0, 14, 63, }, + { 0, 0, 0, 1, 1, 30, }, + { 2, 0, 0, 1, 1, 30, }, + { 0, 0, 0, 1, 2, 32, }, + { 2, 0, 0, 1, 2, 30, }, + { 0, 0, 0, 1, 3, 34, }, + { 2, 0, 0, 1, 3, 30, }, + { 0, 0, 0, 1, 4, 34, }, + { 2, 0, 0, 1, 4, 30, }, + { 0, 0, 0, 1, 5, 34, }, + { 2, 0, 0, 1, 5, 30, }, + { 0, 0, 0, 1, 6, 34, }, + { 2, 0, 0, 1, 6, 30, }, + { 0, 0, 0, 1, 7, 34, }, + { 2, 0, 0, 1, 7, 30, }, + { 0, 0, 0, 1, 8, 34, }, + { 2, 0, 0, 1, 8, 30, }, + { 0, 0, 0, 1, 9, 34, }, + { 2, 0, 0, 1, 9, 30, }, + { 0, 0, 0, 1, 10, 32, }, + { 2, 0, 0, 1, 10, 30, }, + { 0, 0, 0, 1, 11, 30, }, + { 2, 0, 0, 1, 11, 30, }, + { 0, 0, 0, 1, 12, 28, }, + { 2, 0, 0, 1, 12, 30, }, + { 0, 0, 0, 1, 13, 16, }, + { 2, 0, 0, 1, 13, 30, }, + { 0, 0, 0, 1, 14, 63, }, + { 2, 0, 0, 1, 14, 63, }, + { 0, 0, 0, 2, 1, 26, }, + { 2, 0, 0, 2, 1, 30, }, + { 0, 0, 0, 2, 2, 30, }, + { 2, 0, 0, 2, 2, 30, }, + { 0, 0, 0, 2, 3, 32, }, + { 2, 0, 0, 2, 3, 30, }, + { 0, 0, 0, 2, 4, 34, }, + { 2, 0, 0, 2, 4, 30, }, + { 0, 0, 0, 2, 5, 34, }, + { 2, 0, 0, 2, 5, 30, }, + { 0, 0, 0, 2, 6, 34, }, + { 2, 0, 0, 2, 6, 30, }, + { 0, 0, 0, 2, 7, 34, }, + { 2, 0, 0, 2, 7, 30, }, + { 0, 0, 0, 2, 8, 34, }, + { 2, 0, 0, 2, 8, 30, }, + { 0, 0, 0, 2, 9, 32, }, + { 2, 0, 0, 2, 9, 30, }, + { 0, 0, 0, 2, 10, 30, }, + { 2, 0, 0, 2, 10, 30, }, + { 0, 0, 0, 2, 11, 28, }, + { 2, 0, 0, 2, 11, 30, }, + { 0, 0, 0, 2, 12, 26, }, + { 2, 0, 0, 2, 12, 30, }, + { 0, 0, 0, 2, 13, 12, }, + { 2, 0, 0, 2, 13, 30, }, + { 0, 0, 0, 2, 14, 63, }, + { 2, 0, 0, 2, 14, 63, }, + { 0, 0, 1, 2, 1, 63, }, + { 2, 0, 1, 2, 1, 63, }, + { 0, 0, 1, 2, 2, 63, }, + { 2, 0, 1, 2, 2, 63, }, + { 0, 0, 1, 2, 3, 26, }, + { 2, 0, 1, 2, 3, 30, }, + { 0, 0, 1, 2, 4, 26, }, + { 2, 0, 1, 2, 4, 30, }, + { 0, 0, 1, 2, 5, 30, }, + { 2, 0, 1, 2, 5, 30, }, + { 0, 0, 1, 2, 6, 30, }, + { 2, 0, 1, 2, 6, 30, }, + { 0, 0, 1, 2, 7, 30, }, + { 2, 0, 1, 2, 7, 30, }, + { 0, 0, 1, 2, 8, 26, }, + { 2, 0, 1, 2, 8, 30, }, + { 0, 0, 1, 2, 9, 26, }, + { 2, 0, 1, 2, 9, 30, }, + { 0, 0, 1, 2, 10, 28, }, + { 2, 0, 1, 2, 10, 30, }, + { 0, 0, 1, 2, 11, 20, }, + { 2, 0, 1, 2, 11, 30, }, + { 0, 0, 1, 2, 12, 63, }, + { 2, 0, 1, 2, 12, 63, }, + { 0, 0, 1, 2, 13, 63, }, + { 2, 0, 1, 2, 13, 63, }, + { 0, 0, 1, 2, 14, 63, }, + { 2, 0, 1, 2, 14, 63, }, + { 0, 1, 0, 1, 36, 31, }, + { 2, 1, 0, 1, 36, 32, }, + { 0, 1, 0, 1, 40, 33, }, + { 2, 1, 0, 1, 40, 32, }, + { 0, 1, 0, 1, 44, 33, }, + { 2, 1, 0, 1, 44, 32, }, + { 0, 1, 0, 1, 48, 31, }, + { 2, 1, 0, 1, 48, 32, }, + { 0, 1, 0, 1, 52, 33, }, + { 2, 1, 0, 1, 52, 32, }, + { 0, 1, 0, 1, 56, 33, }, + { 2, 1, 0, 1, 56, 32, }, + { 0, 1, 0, 1, 60, 33, }, + { 2, 1, 0, 1, 60, 32, }, + { 0, 1, 0, 1, 64, 30, }, + { 2, 1, 0, 1, 64, 32, }, + { 0, 1, 0, 1, 100, 30, }, + { 2, 1, 0, 1, 100, 32, }, + { 0, 1, 0, 1, 104, 33, }, + { 2, 1, 0, 1, 104, 32, }, + { 0, 1, 0, 1, 108, 33, }, + { 2, 1, 0, 1, 108, 32, }, + { 0, 1, 0, 1, 112, 33, }, + { 2, 1, 0, 1, 112, 32, }, + { 0, 1, 0, 1, 116, 33, }, + { 2, 1, 0, 1, 116, 32, }, + { 0, 1, 0, 1, 120, 33, }, + { 2, 1, 0, 1, 120, 32, }, + { 0, 1, 0, 1, 124, 33, }, + { 2, 1, 0, 1, 124, 32, }, + { 0, 1, 0, 1, 128, 33, }, + { 2, 1, 0, 1, 128, 32, }, + { 0, 1, 0, 1, 132, 33, }, + { 2, 1, 0, 1, 132, 32, }, + { 0, 1, 0, 1, 136, 33, }, + { 2, 1, 0, 1, 136, 32, }, + { 0, 1, 0, 1, 140, 31, }, + { 2, 1, 0, 1, 140, 32, }, + { 0, 1, 0, 1, 144, 30, }, + { 2, 1, 0, 1, 144, 63, }, + { 0, 1, 0, 1, 149, 33, }, + { 2, 1, 0, 1, 149, 63, }, + { 0, 1, 0, 1, 153, 33, }, + { 2, 1, 0, 1, 153, 63, }, + { 0, 1, 0, 1, 157, 33, }, + { 2, 1, 0, 1, 157, 63, }, + { 0, 1, 0, 1, 161, 33, }, + { 2, 1, 0, 1, 161, 63, }, + { 0, 1, 0, 1, 165, 33, }, + { 2, 1, 0, 1, 165, 63, }, + { 0, 1, 0, 2, 36, 30, }, + { 2, 1, 0, 2, 36, 32, }, + { 0, 1, 0, 2, 40, 33, }, + { 2, 1, 0, 2, 40, 32, }, + { 0, 1, 0, 2, 44, 33, }, + { 2, 1, 0, 2, 44, 32, }, + { 0, 1, 0, 2, 48, 33, }, + { 2, 1, 0, 2, 48, 32, }, + { 0, 1, 0, 2, 52, 33, }, + { 2, 1, 0, 2, 52, 32, }, + { 0, 1, 0, 2, 56, 33, }, + { 2, 1, 0, 2, 56, 32, }, + { 0, 1, 0, 2, 60, 33, }, + { 2, 1, 0, 2, 60, 32, }, + { 0, 1, 0, 2, 64, 30, }, + { 2, 1, 0, 2, 64, 32, }, + { 0, 1, 0, 2, 100, 30, }, + { 2, 1, 0, 2, 100, 32, }, + { 0, 1, 0, 2, 104, 33, }, + { 2, 1, 0, 2, 104, 32, }, + { 0, 1, 0, 2, 108, 33, }, + { 2, 1, 0, 2, 108, 32, }, + { 0, 1, 0, 2, 112, 33, }, + { 2, 1, 0, 2, 112, 32, }, + { 0, 1, 0, 2, 116, 33, }, + { 2, 1, 0, 2, 116, 32, }, + { 0, 1, 0, 2, 120, 33, }, + { 2, 1, 0, 2, 120, 32, }, + { 0, 1, 0, 2, 124, 33, }, + { 2, 1, 0, 2, 124, 32, }, + { 0, 1, 0, 2, 128, 33, }, + { 2, 1, 0, 2, 128, 32, }, + { 0, 1, 0, 2, 132, 33, }, + { 2, 1, 0, 2, 132, 32, }, + { 0, 1, 0, 2, 136, 33, }, + { 2, 1, 0, 2, 136, 32, }, + { 0, 1, 0, 2, 140, 29, }, + { 2, 1, 0, 2, 140, 32, }, + { 0, 1, 0, 2, 144, 27, }, + { 2, 1, 0, 2, 144, 63, }, + { 0, 1, 0, 2, 149, 33, }, + { 2, 1, 0, 2, 149, 63, }, + { 0, 1, 0, 2, 153, 33, }, + { 2, 1, 0, 2, 153, 63, }, + { 0, 1, 0, 2, 157, 33, }, + { 2, 1, 0, 2, 157, 63, }, + { 0, 1, 0, 2, 161, 33, }, + { 2, 1, 0, 2, 161, 63, }, + { 0, 1, 0, 2, 165, 33, }, + { 2, 1, 0, 2, 165, 63, }, + { 0, 1, 1, 2, 38, 22, }, + { 2, 1, 1, 2, 38, 32, }, + { 0, 1, 1, 2, 46, 32, }, + { 2, 1, 1, 2, 46, 32, }, + { 0, 1, 1, 2, 54, 32, }, + { 2, 1, 1, 2, 54, 32, }, + { 0, 1, 1, 2, 62, 23, }, + { 2, 1, 1, 2, 62, 32, }, + { 0, 1, 1, 2, 102, 21, }, + { 2, 1, 1, 2, 102, 32, }, + { 0, 1, 1, 2, 110, 32, }, + { 2, 1, 1, 2, 110, 32, }, + { 0, 1, 1, 2, 118, 32, }, + { 2, 1, 1, 2, 118, 32, }, + { 0, 1, 1, 2, 126, 32, }, + { 2, 1, 1, 2, 126, 32, }, + { 0, 1, 1, 2, 134, 32, }, + { 2, 1, 1, 2, 134, 32, }, + { 0, 1, 1, 2, 142, 29, }, + { 2, 1, 1, 2, 142, 63, }, + { 0, 1, 1, 2, 151, 32, }, + { 2, 1, 1, 2, 151, 63, }, + { 0, 1, 1, 2, 159, 32, }, + { 2, 1, 1, 2, 159, 63, }, + { 0, 1, 2, 4, 42, 19, }, + { 2, 1, 2, 4, 42, 32, }, + { 0, 1, 2, 4, 58, 22, }, + { 2, 1, 2, 4, 58, 32, }, + { 0, 1, 2, 4, 106, 18, }, + { 2, 1, 2, 4, 106, 32, }, + { 0, 1, 2, 4, 122, 32, }, + { 2, 1, 2, 4, 122, 32, }, + { 0, 1, 2, 4, 138, 28, }, + { 2, 1, 2, 4, 138, 63, }, + { 0, 1, 2, 4, 155, 32, }, + { 2, 1, 2, 4, 155, 63, }, + { 1, 0, 0, 0, 1, 34, }, + { 3, 0, 0, 0, 1, 30, }, + { 4, 0, 0, 0, 1, 34, }, + { 5, 0, 0, 0, 1, 30, }, + { 6, 0, 0, 0, 1, 30, }, + { 7, 0, 0, 0, 1, 30, }, + { 1, 0, 0, 0, 2, 34, }, + { 3, 0, 0, 0, 2, 32, }, + { 4, 0, 0, 0, 2, 34, }, + { 5, 0, 0, 0, 2, 30, }, + { 6, 0, 0, 0, 2, 32, }, + { 7, 0, 0, 0, 2, 30, }, + { 1, 0, 0, 0, 3, 34, }, + { 3, 0, 0, 0, 3, 32, }, + { 4, 0, 0, 0, 3, 34, }, + { 5, 0, 0, 0, 3, 30, }, + { 6, 0, 0, 0, 3, 32, }, + { 7, 0, 0, 0, 3, 30, }, + { 1, 0, 0, 0, 4, 34, }, + { 3, 0, 0, 0, 4, 32, }, + { 4, 0, 0, 0, 4, 34, }, + { 5, 0, 0, 0, 4, 30, }, + { 6, 0, 0, 0, 4, 32, }, + { 7, 0, 0, 0, 4, 30, }, + { 1, 0, 0, 0, 5, 34, }, + { 3, 0, 0, 0, 5, 32, }, + { 4, 0, 0, 0, 5, 34, }, + { 5, 0, 0, 0, 5, 30, }, + { 6, 0, 0, 0, 5, 32, }, + { 7, 0, 0, 0, 5, 30, }, + { 1, 0, 0, 0, 6, 34, }, + { 3, 0, 0, 0, 6, 32, }, + { 4, 0, 0, 0, 6, 34, }, + { 5, 0, 0, 0, 6, 30, }, + { 6, 0, 0, 0, 6, 32, }, + { 7, 0, 0, 0, 6, 30, }, + { 1, 0, 0, 0, 7, 34, }, + { 3, 0, 0, 0, 7, 32, }, + { 4, 0, 0, 0, 7, 34, }, + { 5, 0, 0, 0, 7, 30, }, + { 6, 0, 0, 0, 7, 32, }, + { 7, 0, 0, 0, 7, 30, }, + { 1, 0, 0, 0, 8, 34, }, + { 3, 0, 0, 0, 8, 32, }, + { 4, 0, 0, 0, 8, 34, }, + { 5, 0, 0, 0, 8, 30, }, + { 6, 0, 0, 0, 8, 32, }, + { 7, 0, 0, 0, 8, 30, }, + { 1, 0, 0, 0, 9, 34, }, + { 3, 0, 0, 0, 9, 32, }, + { 4, 0, 0, 0, 9, 34, }, + { 5, 0, 0, 0, 9, 30, }, + { 6, 0, 0, 0, 9, 32, }, + { 7, 0, 0, 0, 9, 30, }, + { 1, 0, 0, 0, 10, 34, }, + { 3, 0, 0, 0, 10, 32, }, + { 4, 0, 0, 0, 10, 34, }, + { 5, 0, 0, 0, 10, 30, }, + { 6, 0, 0, 0, 10, 32, }, + { 7, 0, 0, 0, 10, 30, }, + { 1, 0, 0, 0, 11, 34, }, + { 3, 0, 0, 0, 11, 32, }, + { 4, 0, 0, 0, 11, 34, }, + { 5, 0, 0, 0, 11, 30, }, + { 6, 0, 0, 0, 11, 32, }, + { 7, 0, 0, 0, 11, 30, }, + { 1, 0, 0, 0, 12, 34, }, + { 3, 0, 0, 0, 12, 24, }, + { 4, 0, 0, 0, 12, 34, }, + { 5, 0, 0, 0, 12, 30, }, + { 6, 0, 0, 0, 12, 24, }, + { 7, 0, 0, 0, 12, 30, }, + { 1, 0, 0, 0, 13, 34, }, + { 3, 0, 0, 0, 13, 16, }, + { 4, 0, 0, 0, 13, 34, }, + { 5, 0, 0, 0, 13, 30, }, + { 6, 0, 0, 0, 13, 16, }, + { 7, 0, 0, 0, 13, 30, }, + { 1, 0, 0, 0, 14, 34, }, + { 3, 0, 0, 0, 14, 63, }, + { 4, 0, 0, 0, 14, 63, }, + { 5, 0, 0, 0, 14, 63, }, + { 6, 0, 0, 0, 14, 63, }, + { 7, 0, 0, 0, 14, 63, }, + { 1, 0, 0, 1, 1, 34, }, + { 3, 0, 0, 1, 1, 30, }, + { 4, 0, 0, 1, 1, 32, }, + { 5, 0, 0, 1, 1, 30, }, + { 6, 0, 0, 1, 1, 30, }, + { 7, 0, 0, 1, 1, 30, }, + { 1, 0, 0, 1, 2, 34, }, + { 3, 0, 0, 1, 2, 32, }, + { 4, 0, 0, 1, 2, 34, }, + { 5, 0, 0, 1, 2, 30, }, + { 6, 0, 0, 1, 2, 32, }, + { 7, 0, 0, 1, 2, 30, }, + { 1, 0, 0, 1, 3, 34, }, + { 3, 0, 0, 1, 3, 34, }, + { 4, 0, 0, 1, 3, 34, }, + { 5, 0, 0, 1, 3, 30, }, + { 6, 0, 0, 1, 3, 34, }, + { 7, 0, 0, 1, 3, 30, }, + { 1, 0, 0, 1, 4, 34, }, + { 3, 0, 0, 1, 4, 34, }, + { 4, 0, 0, 1, 4, 34, }, + { 5, 0, 0, 1, 4, 30, }, + { 6, 0, 0, 1, 4, 34, }, + { 7, 0, 0, 1, 4, 30, }, + { 1, 0, 0, 1, 5, 34, }, + { 3, 0, 0, 1, 5, 34, }, + { 4, 0, 0, 1, 5, 34, }, + { 5, 0, 0, 1, 5, 30, }, + { 6, 0, 0, 1, 5, 34, }, + { 7, 0, 0, 1, 5, 30, }, + { 1, 0, 0, 1, 6, 34, }, + { 3, 0, 0, 1, 6, 34, }, + { 4, 0, 0, 1, 6, 34, }, + { 5, 0, 0, 1, 6, 30, }, + { 6, 0, 0, 1, 6, 34, }, + { 7, 0, 0, 1, 6, 30, }, + { 1, 0, 0, 1, 7, 34, }, + { 3, 0, 0, 1, 7, 34, }, + { 4, 0, 0, 1, 7, 34, }, + { 5, 0, 0, 1, 7, 30, }, + { 6, 0, 0, 1, 7, 34, }, + { 7, 0, 0, 1, 7, 30, }, + { 1, 0, 0, 1, 8, 34, }, + { 3, 0, 0, 1, 8, 34, }, + { 4, 0, 0, 1, 8, 34, }, + { 5, 0, 0, 1, 8, 30, }, + { 6, 0, 0, 1, 8, 34, }, + { 7, 0, 0, 1, 8, 30, }, + { 1, 0, 0, 1, 9, 34, }, + { 3, 0, 0, 1, 9, 34, }, + { 4, 0, 0, 1, 9, 34, }, + { 5, 0, 0, 1, 9, 30, }, + { 6, 0, 0, 1, 9, 34, }, + { 7, 0, 0, 1, 9, 30, }, + { 1, 0, 0, 1, 10, 34, }, + { 3, 0, 0, 1, 10, 32, }, + { 4, 0, 0, 1, 10, 34, }, + { 5, 0, 0, 1, 10, 30, }, + { 6, 0, 0, 1, 10, 32, }, + { 7, 0, 0, 1, 10, 30, }, + { 1, 0, 0, 1, 11, 34, }, + { 3, 0, 0, 1, 11, 30, }, + { 4, 0, 0, 1, 11, 34, }, + { 5, 0, 0, 1, 11, 30, }, + { 6, 0, 0, 1, 11, 30, }, + { 7, 0, 0, 1, 11, 30, }, + { 1, 0, 0, 1, 12, 34, }, + { 3, 0, 0, 1, 12, 28, }, + { 4, 0, 0, 1, 12, 34, }, + { 5, 0, 0, 1, 12, 30, }, + { 6, 0, 0, 1, 12, 28, }, + { 7, 0, 0, 1, 12, 30, }, + { 1, 0, 0, 1, 13, 34, }, + { 3, 0, 0, 1, 13, 16, }, + { 4, 0, 0, 1, 13, 32, }, + { 5, 0, 0, 1, 13, 30, }, + { 6, 0, 0, 1, 13, 16, }, + { 7, 0, 0, 1, 13, 30, }, + { 1, 0, 0, 1, 14, 63, }, + { 3, 0, 0, 1, 14, 63, }, + { 4, 0, 0, 1, 14, 63, }, + { 5, 0, 0, 1, 14, 63, }, + { 6, 0, 0, 1, 14, 63, }, + { 7, 0, 0, 1, 14, 63, }, + { 1, 0, 0, 2, 1, 34, }, + { 3, 0, 0, 2, 1, 26, }, + { 4, 0, 0, 2, 1, 32, }, + { 5, 0, 0, 2, 1, 30, }, + { 6, 0, 0, 2, 1, 26, }, + { 7, 0, 0, 2, 1, 30, }, + { 1, 0, 0, 2, 2, 34, }, + { 3, 0, 0, 2, 2, 30, }, + { 4, 0, 0, 2, 2, 34, }, + { 5, 0, 0, 2, 2, 30, }, + { 6, 0, 0, 2, 2, 30, }, + { 7, 0, 0, 2, 2, 30, }, + { 1, 0, 0, 2, 3, 34, }, + { 3, 0, 0, 2, 3, 32, }, + { 4, 0, 0, 2, 3, 34, }, + { 5, 0, 0, 2, 3, 30, }, + { 6, 0, 0, 2, 3, 32, }, + { 7, 0, 0, 2, 3, 30, }, + { 1, 0, 0, 2, 4, 34, }, + { 3, 0, 0, 2, 4, 34, }, + { 4, 0, 0, 2, 4, 34, }, + { 5, 0, 0, 2, 4, 30, }, + { 6, 0, 0, 2, 4, 34, }, + { 7, 0, 0, 2, 4, 30, }, + { 1, 0, 0, 2, 5, 34, }, + { 3, 0, 0, 2, 5, 34, }, + { 4, 0, 0, 2, 5, 34, }, + { 5, 0, 0, 2, 5, 30, }, + { 6, 0, 0, 2, 5, 34, }, + { 7, 0, 0, 2, 5, 30, }, + { 1, 0, 0, 2, 6, 34, }, + { 3, 0, 0, 2, 6, 34, }, + { 4, 0, 0, 2, 6, 34, }, + { 5, 0, 0, 2, 6, 30, }, + { 6, 0, 0, 2, 6, 34, }, + { 7, 0, 0, 2, 6, 30, }, + { 1, 0, 0, 2, 7, 34, }, + { 3, 0, 0, 2, 7, 34, }, + { 4, 0, 0, 2, 7, 34, }, + { 5, 0, 0, 2, 7, 30, }, + { 6, 0, 0, 2, 7, 34, }, + { 7, 0, 0, 2, 7, 30, }, + { 1, 0, 0, 2, 8, 34, }, + { 3, 0, 0, 2, 8, 34, }, + { 4, 0, 0, 2, 8, 34, }, + { 5, 0, 0, 2, 8, 30, }, + { 6, 0, 0, 2, 8, 34, }, + { 7, 0, 0, 2, 8, 30, }, + { 1, 0, 0, 2, 9, 34, }, + { 3, 0, 0, 2, 9, 32, }, + { 4, 0, 0, 2, 9, 34, }, + { 5, 0, 0, 2, 9, 30, }, + { 6, 0, 0, 2, 9, 32, }, + { 7, 0, 0, 2, 9, 30, }, + { 1, 0, 0, 2, 10, 34, }, + { 3, 0, 0, 2, 10, 30, }, + { 4, 0, 0, 2, 10, 34, }, + { 5, 0, 0, 2, 10, 30, }, + { 6, 0, 0, 2, 10, 30, }, + { 7, 0, 0, 2, 10, 30, }, + { 1, 0, 0, 2, 11, 34, }, + { 3, 0, 0, 2, 11, 28, }, + { 4, 0, 0, 2, 11, 34, }, + { 5, 0, 0, 2, 11, 30, }, + { 6, 0, 0, 2, 11, 28, }, + { 7, 0, 0, 2, 11, 30, }, + { 1, 0, 0, 2, 12, 34, }, + { 3, 0, 0, 2, 12, 26, }, + { 4, 0, 0, 2, 12, 34, }, + { 5, 0, 0, 2, 12, 30, }, + { 6, 0, 0, 2, 12, 26, }, + { 7, 0, 0, 2, 12, 30, }, + { 1, 0, 0, 2, 13, 34, }, + { 3, 0, 0, 2, 13, 12, }, + { 4, 0, 0, 2, 13, 32, }, + { 5, 0, 0, 2, 13, 30, }, + { 6, 0, 0, 2, 13, 12, }, + { 7, 0, 0, 2, 13, 30, }, + { 1, 0, 0, 2, 14, 63, }, + { 3, 0, 0, 2, 14, 63, }, + { 4, 0, 0, 2, 14, 63, }, + { 5, 0, 0, 2, 14, 63, }, + { 6, 0, 0, 2, 14, 63, }, + { 7, 0, 0, 2, 14, 63, }, + { 1, 0, 1, 2, 1, 63, }, + { 3, 0, 1, 2, 1, 63, }, + { 4, 0, 1, 2, 1, 63, }, + { 5, 0, 1, 2, 1, 63, }, + { 6, 0, 1, 2, 1, 63, }, + { 7, 0, 1, 2, 1, 63, }, + { 1, 0, 1, 2, 2, 63, }, + { 3, 0, 1, 2, 2, 63, }, + { 4, 0, 1, 2, 2, 63, }, + { 5, 0, 1, 2, 2, 63, }, + { 6, 0, 1, 2, 2, 63, }, + { 7, 0, 1, 2, 2, 63, }, + { 1, 0, 1, 2, 3, 30, }, + { 3, 0, 1, 2, 3, 26, }, + { 4, 0, 1, 2, 3, 30, }, + { 5, 0, 1, 2, 3, 30, }, + { 6, 0, 1, 2, 3, 26, }, + { 7, 0, 1, 2, 3, 30, }, + { 1, 0, 1, 2, 4, 30, }, + { 3, 0, 1, 2, 4, 26, }, + { 4, 0, 1, 2, 4, 30, }, + { 5, 0, 1, 2, 4, 30, }, + { 6, 0, 1, 2, 4, 26, }, + { 7, 0, 1, 2, 4, 30, }, + { 1, 0, 1, 2, 5, 30, }, + { 3, 0, 1, 2, 5, 30, }, + { 4, 0, 1, 2, 5, 30, }, + { 5, 0, 1, 2, 5, 30, }, + { 6, 0, 1, 2, 5, 30, }, + { 7, 0, 1, 2, 5, 30, }, + { 1, 0, 1, 2, 6, 30, }, + { 3, 0, 1, 2, 6, 30, }, + { 4, 0, 1, 2, 6, 30, }, + { 5, 0, 1, 2, 6, 30, }, + { 6, 0, 1, 2, 6, 30, }, + { 7, 0, 1, 2, 6, 30, }, + { 1, 0, 1, 2, 7, 30, }, + { 3, 0, 1, 2, 7, 30, }, + { 4, 0, 1, 2, 7, 30, }, + { 5, 0, 1, 2, 7, 30, }, + { 6, 0, 1, 2, 7, 30, }, + { 7, 0, 1, 2, 7, 30, }, + { 1, 0, 1, 2, 8, 30, }, + { 3, 0, 1, 2, 8, 26, }, + { 4, 0, 1, 2, 8, 30, }, + { 5, 0, 1, 2, 8, 30, }, + { 6, 0, 1, 2, 8, 26, }, + { 7, 0, 1, 2, 8, 30, }, + { 1, 0, 1, 2, 9, 30, }, + { 3, 0, 1, 2, 9, 26, }, + { 4, 0, 1, 2, 9, 30, }, + { 5, 0, 1, 2, 9, 30, }, + { 6, 0, 1, 2, 9, 26, }, + { 7, 0, 1, 2, 9, 30, }, + { 1, 0, 1, 2, 10, 30, }, + { 3, 0, 1, 2, 10, 28, }, + { 4, 0, 1, 2, 10, 30, }, + { 5, 0, 1, 2, 10, 30, }, + { 6, 0, 1, 2, 10, 28, }, + { 7, 0, 1, 2, 10, 30, }, + { 1, 0, 1, 2, 11, 30, }, + { 3, 0, 1, 2, 11, 20, }, + { 4, 0, 1, 2, 11, 30, }, + { 5, 0, 1, 2, 11, 30, }, + { 6, 0, 1, 2, 11, 20, }, + { 7, 0, 1, 2, 11, 30, }, + { 1, 0, 1, 2, 12, 63, }, + { 3, 0, 1, 2, 12, 63, }, + { 4, 0, 1, 2, 12, 63, }, + { 5, 0, 1, 2, 12, 63, }, + { 6, 0, 1, 2, 12, 63, }, + { 7, 0, 1, 2, 12, 63, }, + { 1, 0, 1, 2, 13, 63, }, + { 3, 0, 1, 2, 13, 63, }, + { 4, 0, 1, 2, 13, 63, }, + { 5, 0, 1, 2, 13, 63, }, + { 6, 0, 1, 2, 13, 63, }, + { 7, 0, 1, 2, 13, 63, }, + { 1, 0, 1, 2, 14, 63, }, + { 3, 0, 1, 2, 14, 63, }, + { 4, 0, 1, 2, 14, 63, }, + { 5, 0, 1, 2, 14, 63, }, + { 6, 0, 1, 2, 14, 63, }, + { 7, 0, 1, 2, 14, 63, }, + { 1, 1, 0, 1, 36, 33, }, + { 3, 1, 0, 1, 36, 31, }, + { 4, 1, 0, 1, 36, 29, }, + { 5, 1, 0, 1, 36, 32, }, + { 6, 1, 0, 1, 36, 29, }, + { 7, 1, 0, 1, 36, 27, }, + { 1, 1, 0, 1, 40, 33, }, + { 3, 1, 0, 1, 40, 31, }, + { 4, 1, 0, 1, 40, 28, }, + { 5, 1, 0, 1, 40, 32, }, + { 6, 1, 0, 1, 40, 29, }, + { 7, 1, 0, 1, 40, 27, }, + { 1, 1, 0, 1, 44, 33, }, + { 3, 1, 0, 1, 44, 31, }, + { 4, 1, 0, 1, 44, 28, }, + { 5, 1, 0, 1, 44, 32, }, + { 6, 1, 0, 1, 44, 30, }, + { 7, 1, 0, 1, 44, 27, }, + { 1, 1, 0, 1, 48, 33, }, + { 3, 1, 0, 1, 48, 31, }, + { 4, 1, 0, 1, 48, 27, }, + { 5, 1, 0, 1, 48, 32, }, + { 6, 1, 0, 1, 48, 30, }, + { 7, 1, 0, 1, 48, 27, }, + { 1, 1, 0, 1, 52, 33, }, + { 3, 1, 0, 1, 52, 32, }, + { 4, 1, 0, 1, 52, 16, }, + { 5, 1, 0, 1, 52, 32, }, + { 6, 1, 0, 1, 52, 30, }, + { 7, 1, 0, 1, 52, 27, }, + { 1, 1, 0, 1, 56, 33, }, + { 3, 1, 0, 1, 56, 32, }, + { 4, 1, 0, 1, 56, 33, }, + { 5, 1, 0, 1, 56, 32, }, + { 6, 1, 0, 1, 56, 30, }, + { 7, 1, 0, 1, 56, 27, }, + { 1, 1, 0, 1, 60, 33, }, + { 3, 1, 0, 1, 60, 32, }, + { 4, 1, 0, 1, 60, 33, }, + { 5, 1, 0, 1, 60, 32, }, + { 6, 1, 0, 1, 60, 30, }, + { 7, 1, 0, 1, 60, 27, }, + { 1, 1, 0, 1, 64, 33, }, + { 3, 1, 0, 1, 64, 30, }, + { 4, 1, 0, 1, 64, 33, }, + { 5, 1, 0, 1, 64, 32, }, + { 6, 1, 0, 1, 64, 29, }, + { 7, 1, 0, 1, 64, 27, }, + { 1, 1, 0, 1, 100, 33, }, + { 3, 1, 0, 1, 100, 30, }, + { 4, 1, 0, 1, 100, 33, }, + { 5, 1, 0, 1, 100, 32, }, + { 6, 1, 0, 1, 100, 30, }, + { 7, 1, 0, 1, 100, 27, }, + { 1, 1, 0, 1, 104, 33, }, + { 3, 1, 0, 1, 104, 33, }, + { 4, 1, 0, 1, 104, 33, }, + { 5, 1, 0, 1, 104, 32, }, + { 6, 1, 0, 1, 104, 30, }, + { 7, 1, 0, 1, 104, 27, }, + { 1, 1, 0, 1, 108, 33, }, + { 3, 1, 0, 1, 108, 33, }, + { 4, 1, 0, 1, 108, 33, }, + { 5, 1, 0, 1, 108, 32, }, + { 6, 1, 0, 1, 108, 30, }, + { 7, 1, 0, 1, 108, 27, }, + { 1, 1, 0, 1, 112, 33, }, + { 3, 1, 0, 1, 112, 33, }, + { 4, 1, 0, 1, 112, 33, }, + { 5, 1, 0, 1, 112, 32, }, + { 6, 1, 0, 1, 112, 30, }, + { 7, 1, 0, 1, 112, 27, }, + { 1, 1, 0, 1, 116, 33, }, + { 3, 1, 0, 1, 116, 33, }, + { 4, 1, 0, 1, 116, 33, }, + { 5, 1, 0, 1, 116, 32, }, + { 6, 1, 0, 1, 116, 30, }, + { 7, 1, 0, 1, 116, 27, }, + { 1, 1, 0, 1, 120, 33, }, + { 3, 1, 0, 1, 120, 63, }, + { 4, 1, 0, 1, 120, 33, }, + { 5, 1, 0, 1, 120, 63, }, + { 6, 1, 0, 1, 120, 30, }, + { 7, 1, 0, 1, 120, 27, }, + { 1, 1, 0, 1, 124, 33, }, + { 3, 1, 0, 1, 124, 63, }, + { 4, 1, 0, 1, 124, 33, }, + { 5, 1, 0, 1, 124, 63, }, + { 6, 1, 0, 1, 124, 30, }, + { 7, 1, 0, 1, 124, 27, }, + { 1, 1, 0, 1, 128, 33, }, + { 3, 1, 0, 1, 128, 63, }, + { 4, 1, 0, 1, 128, 63, }, + { 5, 1, 0, 1, 128, 63, }, + { 6, 1, 0, 1, 128, 30, }, + { 7, 1, 0, 1, 128, 27, }, + { 1, 1, 0, 1, 132, 33, }, + { 3, 1, 0, 1, 132, 33, }, + { 4, 1, 0, 1, 132, 63, }, + { 5, 1, 0, 1, 132, 32, }, + { 6, 1, 0, 1, 132, 30, }, + { 7, 1, 0, 1, 132, 27, }, + { 1, 1, 0, 1, 136, 33, }, + { 3, 1, 0, 1, 136, 33, }, + { 4, 1, 0, 1, 136, 63, }, + { 5, 1, 0, 1, 136, 32, }, + { 6, 1, 0, 1, 136, 30, }, + { 7, 1, 0, 1, 136, 63, }, + { 1, 1, 0, 1, 140, 33, }, + { 3, 1, 0, 1, 140, 31, }, + { 4, 1, 0, 1, 140, 63, }, + { 5, 1, 0, 1, 140, 32, }, + { 6, 1, 0, 1, 140, 30, }, + { 7, 1, 0, 1, 140, 63, }, + { 1, 1, 0, 1, 144, 63, }, + { 3, 1, 0, 1, 144, 30, }, + { 4, 1, 0, 1, 144, 63, }, + { 5, 1, 0, 1, 144, 63, }, + { 6, 1, 0, 1, 144, 30, }, + { 7, 1, 0, 1, 144, 63, }, + { 1, 1, 0, 1, 149, 63, }, + { 3, 1, 0, 1, 149, 30, }, + { 4, 1, 0, 1, 149, 33, }, + { 5, 1, 0, 1, 149, 33, }, + { 6, 1, 0, 1, 149, 30, }, + { 7, 1, 0, 1, 149, 27, }, + { 1, 1, 0, 1, 153, 63, }, + { 3, 1, 0, 1, 153, 33, }, + { 4, 1, 0, 1, 153, 33, }, + { 5, 1, 0, 1, 153, 33, }, + { 6, 1, 0, 1, 153, 30, }, + { 7, 1, 0, 1, 153, 27, }, + { 1, 1, 0, 1, 157, 63, }, + { 3, 1, 0, 1, 157, 33, }, + { 4, 1, 0, 1, 157, 33, }, + { 5, 1, 0, 1, 157, 33, }, + { 6, 1, 0, 1, 157, 30, }, + { 7, 1, 0, 1, 157, 27, }, + { 1, 1, 0, 1, 161, 63, }, + { 3, 1, 0, 1, 161, 33, }, + { 4, 1, 0, 1, 161, 31, }, + { 5, 1, 0, 1, 161, 33, }, + { 6, 1, 0, 1, 161, 30, }, + { 7, 1, 0, 1, 161, 27, }, + { 1, 1, 0, 1, 165, 63, }, + { 3, 1, 0, 1, 165, 33, }, + { 4, 1, 0, 1, 165, 63, }, + { 5, 1, 0, 1, 165, 33, }, + { 6, 1, 0, 1, 165, 30, }, + { 7, 1, 0, 1, 165, 27, }, + { 1, 1, 0, 2, 36, 33, }, + { 3, 1, 0, 2, 36, 30, }, + { 4, 1, 0, 2, 36, 27, }, + { 5, 1, 0, 2, 36, 32, }, + { 6, 1, 0, 2, 36, 30, }, + { 7, 1, 0, 2, 36, 27, }, + { 1, 1, 0, 2, 40, 33, }, + { 3, 1, 0, 2, 40, 31, }, + { 4, 1, 0, 2, 40, 29, }, + { 5, 1, 0, 2, 40, 32, }, + { 6, 1, 0, 2, 40, 30, }, + { 7, 1, 0, 2, 40, 27, }, + { 1, 1, 0, 2, 44, 33, }, + { 3, 1, 0, 2, 44, 31, }, + { 4, 1, 0, 2, 44, 29, }, + { 5, 1, 0, 2, 44, 32, }, + { 6, 1, 0, 2, 44, 30, }, + { 7, 1, 0, 2, 44, 27, }, + { 1, 1, 0, 2, 48, 33, }, + { 3, 1, 0, 2, 48, 31, }, + { 4, 1, 0, 2, 48, 26, }, + { 5, 1, 0, 2, 48, 32, }, + { 6, 1, 0, 2, 48, 30, }, + { 7, 1, 0, 2, 48, 27, }, + { 1, 1, 0, 2, 52, 33, }, + { 3, 1, 0, 2, 52, 32, }, + { 4, 1, 0, 2, 52, 7, }, + { 5, 1, 0, 2, 52, 32, }, + { 6, 1, 0, 2, 52, 30, }, + { 7, 1, 0, 2, 52, 27, }, + { 1, 1, 0, 2, 56, 33, }, + { 3, 1, 0, 2, 56, 32, }, + { 4, 1, 0, 2, 56, 33, }, + { 5, 1, 0, 2, 56, 32, }, + { 6, 1, 0, 2, 56, 30, }, + { 7, 1, 0, 2, 56, 27, }, + { 1, 1, 0, 2, 60, 33, }, + { 3, 1, 0, 2, 60, 32, }, + { 4, 1, 0, 2, 60, 33, }, + { 5, 1, 0, 2, 60, 32, }, + { 6, 1, 0, 2, 60, 30, }, + { 7, 1, 0, 2, 60, 27, }, + { 1, 1, 0, 2, 64, 33, }, + { 3, 1, 0, 2, 64, 30, }, + { 4, 1, 0, 2, 64, 33, }, + { 5, 1, 0, 2, 64, 32, }, + { 6, 1, 0, 2, 64, 30, }, + { 7, 1, 0, 2, 64, 27, }, + { 1, 1, 0, 2, 100, 33, }, + { 3, 1, 0, 2, 100, 30, }, + { 4, 1, 0, 2, 100, 33, }, + { 5, 1, 0, 2, 100, 32, }, + { 6, 1, 0, 2, 100, 30, }, + { 7, 1, 0, 2, 100, 27, }, + { 1, 1, 0, 2, 104, 33, }, + { 3, 1, 0, 2, 104, 33, }, + { 4, 1, 0, 2, 104, 33, }, + { 5, 1, 0, 2, 104, 32, }, + { 6, 1, 0, 2, 104, 30, }, + { 7, 1, 0, 2, 104, 27, }, + { 1, 1, 0, 2, 108, 33, }, + { 3, 1, 0, 2, 108, 33, }, + { 4, 1, 0, 2, 108, 33, }, + { 5, 1, 0, 2, 108, 32, }, + { 6, 1, 0, 2, 108, 30, }, + { 7, 1, 0, 2, 108, 27, }, + { 1, 1, 0, 2, 112, 33, }, + { 3, 1, 0, 2, 112, 33, }, + { 4, 1, 0, 2, 112, 33, }, + { 5, 1, 0, 2, 112, 32, }, + { 6, 1, 0, 2, 112, 30, }, + { 7, 1, 0, 2, 112, 27, }, + { 1, 1, 0, 2, 116, 33, }, + { 3, 1, 0, 2, 116, 33, }, + { 4, 1, 0, 2, 116, 33, }, + { 5, 1, 0, 2, 116, 32, }, + { 6, 1, 0, 2, 116, 30, }, + { 7, 1, 0, 2, 116, 27, }, + { 1, 1, 0, 2, 120, 33, }, + { 3, 1, 0, 2, 120, 63, }, + { 4, 1, 0, 2, 120, 33, }, + { 5, 1, 0, 2, 120, 63, }, + { 6, 1, 0, 2, 120, 30, }, + { 7, 1, 0, 2, 120, 27, }, + { 1, 1, 0, 2, 124, 33, }, + { 3, 1, 0, 2, 124, 63, }, + { 4, 1, 0, 2, 124, 33, }, + { 5, 1, 0, 2, 124, 63, }, + { 6, 1, 0, 2, 124, 30, }, + { 7, 1, 0, 2, 124, 27, }, + { 1, 1, 0, 2, 128, 33, }, + { 3, 1, 0, 2, 128, 63, }, + { 4, 1, 0, 2, 128, 63, }, + { 5, 1, 0, 2, 128, 63, }, + { 6, 1, 0, 2, 128, 30, }, + { 7, 1, 0, 2, 128, 27, }, + { 1, 1, 0, 2, 132, 33, }, + { 3, 1, 0, 2, 132, 33, }, + { 4, 1, 0, 2, 132, 63, }, + { 5, 1, 0, 2, 132, 32, }, + { 6, 1, 0, 2, 132, 30, }, + { 7, 1, 0, 2, 132, 27, }, + { 1, 1, 0, 2, 136, 33, }, + { 3, 1, 0, 2, 136, 33, }, + { 4, 1, 0, 2, 136, 63, }, + { 5, 1, 0, 2, 136, 32, }, + { 6, 1, 0, 2, 136, 30, }, + { 7, 1, 0, 2, 136, 63, }, + { 1, 1, 0, 2, 140, 33, }, + { 3, 1, 0, 2, 140, 29, }, + { 4, 1, 0, 2, 140, 63, }, + { 5, 1, 0, 2, 140, 32, }, + { 6, 1, 0, 2, 140, 30, }, + { 7, 1, 0, 2, 140, 63, }, + { 1, 1, 0, 2, 144, 63, }, + { 3, 1, 0, 2, 144, 27, }, + { 4, 1, 0, 2, 144, 63, }, + { 5, 1, 0, 2, 144, 63, }, + { 6, 1, 0, 2, 144, 30, }, + { 7, 1, 0, 2, 144, 63, }, + { 1, 1, 0, 2, 149, 63, }, + { 3, 1, 0, 2, 149, 33, }, + { 4, 1, 0, 2, 149, 33, }, + { 5, 1, 0, 2, 149, 33, }, + { 6, 1, 0, 2, 149, 30, }, + { 7, 1, 0, 2, 149, 27, }, + { 1, 1, 0, 2, 153, 63, }, + { 3, 1, 0, 2, 153, 33, }, + { 4, 1, 0, 2, 153, 33, }, + { 5, 1, 0, 2, 153, 33, }, + { 6, 1, 0, 2, 153, 30, }, + { 7, 1, 0, 2, 153, 27, }, + { 1, 1, 0, 2, 157, 63, }, + { 3, 1, 0, 2, 157, 33, }, + { 4, 1, 0, 2, 157, 33, }, + { 5, 1, 0, 2, 157, 33, }, + { 6, 1, 0, 2, 157, 30, }, + { 7, 1, 0, 2, 157, 27, }, + { 1, 1, 0, 2, 161, 63, }, + { 3, 1, 0, 2, 161, 33, }, + { 4, 1, 0, 2, 161, 31, }, + { 5, 1, 0, 2, 161, 33, }, + { 6, 1, 0, 2, 161, 30, }, + { 7, 1, 0, 2, 161, 27, }, + { 1, 1, 0, 2, 165, 63, }, + { 3, 1, 0, 2, 165, 33, }, + { 4, 1, 0, 2, 165, 63, }, + { 5, 1, 0, 2, 165, 33, }, + { 6, 1, 0, 2, 165, 30, }, + { 7, 1, 0, 2, 165, 27, }, + { 1, 1, 1, 2, 38, 32, }, + { 3, 1, 1, 2, 38, 22, }, + { 4, 1, 1, 2, 38, 26, }, + { 5, 1, 1, 2, 38, 32, }, + { 6, 1, 1, 2, 38, 22, }, + { 7, 1, 1, 2, 38, 27, }, + { 1, 1, 1, 2, 46, 32, }, + { 3, 1, 1, 2, 46, 32, }, + { 4, 1, 1, 2, 46, 28, }, + { 5, 1, 1, 2, 46, 32, }, + { 6, 1, 1, 2, 46, 30, }, + { 7, 1, 1, 2, 46, 27, }, + { 1, 1, 1, 2, 54, 32, }, + { 3, 1, 1, 2, 54, 32, }, + { 4, 1, 1, 2, 54, 22, }, + { 5, 1, 1, 2, 54, 32, }, + { 6, 1, 1, 2, 54, 30, }, + { 7, 1, 1, 2, 54, 27, }, + { 1, 1, 1, 2, 62, 32, }, + { 3, 1, 1, 2, 62, 23, }, + { 4, 1, 1, 2, 62, 31, }, + { 5, 1, 1, 2, 62, 32, }, + { 6, 1, 1, 2, 62, 23, }, + { 7, 1, 1, 2, 62, 27, }, + { 1, 1, 1, 2, 102, 32, }, + { 3, 1, 1, 2, 102, 21, }, + { 4, 1, 1, 2, 102, 31, }, + { 5, 1, 1, 2, 102, 32, }, + { 6, 1, 1, 2, 102, 30, }, + { 7, 1, 1, 2, 102, 27, }, + { 1, 1, 1, 2, 110, 32, }, + { 3, 1, 1, 2, 110, 32, }, + { 4, 1, 1, 2, 110, 32, }, + { 5, 1, 1, 2, 110, 32, }, + { 6, 1, 1, 2, 110, 30, }, + { 7, 1, 1, 2, 110, 27, }, + { 1, 1, 1, 2, 118, 32, }, + { 3, 1, 1, 2, 118, 63, }, + { 4, 1, 1, 2, 118, 32, }, + { 5, 1, 1, 2, 118, 63, }, + { 6, 1, 1, 2, 118, 30, }, + { 7, 1, 1, 2, 118, 27, }, + { 1, 1, 1, 2, 126, 32, }, + { 3, 1, 1, 2, 126, 63, }, + { 4, 1, 1, 2, 126, 63, }, + { 5, 1, 1, 2, 126, 63, }, + { 6, 1, 1, 2, 126, 30, }, + { 7, 1, 1, 2, 126, 27, }, + { 1, 1, 1, 2, 134, 32, }, + { 3, 1, 1, 2, 134, 32, }, + { 4, 1, 1, 2, 134, 63, }, + { 5, 1, 1, 2, 134, 32, }, + { 6, 1, 1, 2, 134, 30, }, + { 7, 1, 1, 2, 134, 63, }, + { 1, 1, 1, 2, 142, 63, }, + { 3, 1, 1, 2, 142, 29, }, + { 4, 1, 1, 2, 142, 63, }, + { 5, 1, 1, 2, 142, 63, }, + { 6, 1, 1, 2, 142, 30, }, + { 7, 1, 1, 2, 142, 63, }, + { 1, 1, 1, 2, 151, 63, }, + { 3, 1, 1, 2, 151, 32, }, + { 4, 1, 1, 2, 151, 27, }, + { 5, 1, 1, 2, 151, 32, }, + { 6, 1, 1, 2, 151, 30, }, + { 7, 1, 1, 2, 151, 27, }, + { 1, 1, 1, 2, 159, 63, }, + { 3, 1, 1, 2, 159, 32, }, + { 4, 1, 1, 2, 159, 26, }, + { 5, 1, 1, 2, 159, 32, }, + { 6, 1, 1, 2, 159, 30, }, + { 7, 1, 1, 2, 159, 27, }, + { 1, 1, 2, 4, 42, 28, }, + { 3, 1, 2, 4, 42, 19, }, + { 4, 1, 2, 4, 42, 25, }, + { 5, 1, 2, 4, 42, 32, }, + { 6, 1, 2, 4, 42, 19, }, + { 7, 1, 2, 4, 42, 27, }, + { 1, 1, 2, 4, 58, 28, }, + { 3, 1, 2, 4, 58, 22, }, + { 4, 1, 2, 4, 58, 28, }, + { 5, 1, 2, 4, 58, 32, }, + { 6, 1, 2, 4, 58, 22, }, + { 7, 1, 2, 4, 58, 27, }, + { 1, 1, 2, 4, 106, 32, }, + { 3, 1, 2, 4, 106, 18, }, + { 4, 1, 2, 4, 106, 30, }, + { 5, 1, 2, 4, 106, 32, }, + { 6, 1, 2, 4, 106, 30, }, + { 7, 1, 2, 4, 106, 27, }, + { 1, 1, 2, 4, 122, 32, }, + { 3, 1, 2, 4, 122, 63, }, + { 4, 1, 2, 4, 122, 26, }, + { 5, 1, 2, 4, 122, 63, }, + { 6, 1, 2, 4, 122, 30, }, + { 7, 1, 2, 4, 122, 27, }, + { 1, 1, 2, 4, 138, 63, }, + { 3, 1, 2, 4, 138, 28, }, + { 4, 1, 2, 4, 138, 63, }, + { 5, 1, 2, 4, 138, 63, }, + { 6, 1, 2, 4, 138, 30, }, + { 7, 1, 2, 4, 138, 63, }, + { 1, 1, 2, 4, 155, 63, }, + { 3, 1, 2, 4, 155, 32, }, + { 4, 1, 2, 4, 155, 27, }, + { 5, 1, 2, 4, 155, 32, }, + { 6, 1, 2, 4, 155, 30, }, + { 7, 1, 2, 4, 155, 27, }, +}; + +RTW_DECL_TABLE_TXPWR_LMT(rtw8821c_txpwr_lmt_type0); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c_table.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c_table.h new file mode 100644 index 0000000000000000000000000000000000000000..cda98f5c4a01e8c8df33592d80ecb1784fe0bace --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821c_table.h @@ -0,0 +1,16 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW8821C_TABLE_H__ +#define __RTW8821C_TABLE_H__ + +extern const struct rtw_table rtw8821c_mac_tbl; +extern const struct rtw_table rtw8821c_agc_tbl; +extern const struct rtw_table rtw8821c_agc_btg_type2_tbl; +extern const struct rtw_table rtw8821c_bb_tbl; +extern const struct rtw_table rtw8821c_bb_pg_type0_tbl; +extern const struct rtw_table rtw8821c_rf_a_tbl; +extern const struct rtw_table rtw8821c_txpwr_lmt_type0_tbl; + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821ce.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821ce.c new file mode 100644 index 0000000000000000000000000000000000000000..f3d971feda047377281d422fec7d969e97a1a1e7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821ce.c @@ -0,0 +1,35 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include "pci.h" +#include "rtw8821c.h" + +static const struct pci_device_id rtw_8821ce_id_table[] = { + { + PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0xB821), + .driver_data = (kernel_ulong_t)&rtw8821c_hw_spec + }, + { + PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0xC821), + .driver_data = (kernel_ulong_t)&rtw8821c_hw_spec + }, + {} +}; +MODULE_DEVICE_TABLE(pci, rtw_8821ce_id_table); + +static struct pci_driver rtw_8821ce_driver = { + .name = "rtw_8821ce", + .id_table = rtw_8821ce_id_table, + .probe = rtw_pci_probe, + .remove = rtw_pci_remove, + .driver.pm = &rtw_pm_ops, + .shutdown = rtw_pci_shutdown, +}; +module_pci_driver(rtw_8821ce_driver); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8821ce driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821ce.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821ce.h new file mode 100644 index 0000000000000000000000000000000000000000..8d3eb77a876be95111cdd0ed28377e97bb07d2f0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821ce.h @@ -0,0 +1,14 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_8821CE_H_ +#define __RTW_8821CE_H_ + +extern const struct dev_pm_ops rtw_pm_ops; +extern struct rtw_chip_info rtw8821c_hw_spec; +int rtw_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id); +void rtw_pci_remove(struct pci_dev *pdev); +void rtw_pci_shutdown(struct pci_dev *pdev); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821cs.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821cs.c new file mode 100644 index 0000000000000000000000000000000000000000..649f41baa06462f803451c8bbe4bc6b3ad232d68 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821cs.c @@ -0,0 +1,36 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) Martin Blumenstingl + */ + +#include +#include "sdio_ids.h" +#include +#include "main.h" +#include "rtw8821c.h" +#include "sdio.h" + +static const struct sdio_device_id rtw_8821cs_id_table[] = { + { + SDIO_DEVICE(SDIO_VENDOR_ID_REALTEK, + SDIO_DEVICE_ID_REALTEK_RTW8821CS), + .driver_data = (kernel_ulong_t)&rtw8821c_hw_spec, + }, + {} +}; +MODULE_DEVICE_TABLE(sdio, rtw_8821cs_id_table); + +static struct sdio_driver rtw_8821cs_driver = { + .name = "rtw_8821cs", + .probe = rtw_sdio_probe, + .remove = rtw_sdio_remove, + .id_table = rtw_8821cs_id_table, + .drv = { + .pm = &rtw_sdio_pm_ops, + .shutdown = rtw_sdio_shutdown, + } +}; +module_sdio_driver(rtw_8821cs_driver); + +MODULE_AUTHOR("Martin Blumenstingl "); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8821cs driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821cu.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821cu.c new file mode 100644 index 0000000000000000000000000000000000000000..7a5cbdc31ef7937f0204f7bf081b6e87577b90de --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8821cu.c @@ -0,0 +1,50 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include "main.h" +#include "rtw8821c.h" +#include "usb.h" + +static const struct usb_device_id rtw_8821cu_id_table[] = { + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb82b, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb820, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc821, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc820, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82a, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82b, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8821CU */ + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc811, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8811CU */ + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x8811, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* 8811CU */ + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x2006, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8821c_hw_spec) }, /* TOTOLINK A650UA v3 */ + {}, +}; +MODULE_DEVICE_TABLE(usb, rtw_8821cu_id_table); + +static int rtw_8821cu_probe(struct usb_interface *intf, + const struct usb_device_id *id) +{ + return rtw_usb_probe(intf, id); +} + +static struct usb_driver rtw_8821cu_driver = { + .name = "rtw_8821cu", + .id_table = rtw_8821cu_id_table, + .probe = rtw_8821cu_probe, + .disconnect = rtw_usb_disconnect, +}; +module_usb_driver(rtw_8821cu_driver); + +MODULE_AUTHOR("Hans Ulli Kroll "); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8821cu driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b.c new file mode 100644 index 0000000000000000000000000000000000000000..3017a9760da8dca8f982679336daafb081e0ef09 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b.c @@ -0,0 +1,2622 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include "main.h" +#include "coex.h" +#include "fw.h" +#include "tx.h" +#include "rx.h" +#include "phy.h" +#include "rtw8822b.h" +#include "rtw8822b_table.h" +#include "mac.h" +#include "reg.h" +#include "debug.h" +#include "bf.h" +#include "regd.h" + +static void rtw8822b_config_trx_mode(struct rtw_dev *rtwdev, u8 tx_path, + u8 rx_path, bool is_tx2_path); + +static void rtw8822be_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8822b_efuse *map) +{ + ether_addr_copy(efuse->addr, map->e.mac_addr); +} + +static void rtw8822bu_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8822b_efuse *map) +{ + ether_addr_copy(efuse->addr, map->u.mac_addr); +} + +static void rtw8822bs_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8822b_efuse *map) +{ + ether_addr_copy(efuse->addr, map->s.mac_addr); +} + +static int rtw8822b_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw8822b_efuse *map; + int i; + + map = (struct rtw8822b_efuse *)log_map; + + efuse->rfe_option = map->rfe_option; + efuse->rf_board_option = map->rf_board_option; + efuse->crystal_cap = map->xtal_k; + efuse->pa_type_2g = map->pa_type; + efuse->pa_type_5g = map->pa_type; + efuse->lna_type_2g = map->lna_type_2g[0]; + efuse->lna_type_5g = map->lna_type_5g[0]; + efuse->channel_plan = map->channel_plan; + efuse->country_code[0] = map->country_code[0]; + efuse->country_code[1] = map->country_code[1]; + efuse->bt_setting = map->rf_bt_setting; + efuse->regd = map->rf_board_option & 0x7; + efuse->thermal_meter[RF_PATH_A] = map->thermal_meter; + efuse->thermal_meter_k = map->thermal_meter; + + for (i = 0; i < 4; i++) + efuse->txpwr_idx_table[i] = map->txpwr_idx_table[i]; + + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_PCIE: + rtw8822be_efuse_parsing(efuse, map); + break; + case RTW_HCI_TYPE_USB: + rtw8822bu_efuse_parsing(efuse, map); + break; + case RTW_HCI_TYPE_SDIO: + rtw8822bs_efuse_parsing(efuse, map); + break; + default: + /* unsupported now */ + return -ENOTSUPP; + } + + return 0; +} + +static void rtw8822b_phy_rfe_init(struct rtw_dev *rtwdev) +{ + /* chip top mux */ + rtw_write32_mask(rtwdev, 0x64, BIT(29) | BIT(28), 0x3); + rtw_write32_mask(rtwdev, 0x4c, BIT(26) | BIT(25), 0x0); + rtw_write32_mask(rtwdev, 0x40, BIT(2), 0x1); + + /* from s0 or s1 */ + rtw_write32_mask(rtwdev, 0x1990, 0x3f, 0x30); + rtw_write32_mask(rtwdev, 0x1990, (BIT(11) | BIT(10)), 0x3); + + /* input or output */ + rtw_write32_mask(rtwdev, 0x974, 0x3f, 0x3f); + rtw_write32_mask(rtwdev, 0x974, (BIT(11) | BIT(10)), 0x3); +} + +#define RTW_TXSCALE_SIZE 37 +static const u32 rtw8822b_txscale_tbl[RTW_TXSCALE_SIZE] = { + 0x081, 0x088, 0x090, 0x099, 0x0a2, 0x0ac, 0x0b6, 0x0c0, 0x0cc, 0x0d8, + 0x0e5, 0x0f2, 0x101, 0x110, 0x120, 0x131, 0x143, 0x156, 0x16a, 0x180, + 0x197, 0x1af, 0x1c8, 0x1e3, 0x200, 0x21e, 0x23e, 0x261, 0x285, 0x2ab, + 0x2d3, 0x2fe, 0x32b, 0x35c, 0x38e, 0x3c4, 0x3fe +}; + +static u8 rtw8822b_get_swing_index(struct rtw_dev *rtwdev) +{ + u8 i = 0; + u32 swing, table_value; + + swing = rtw_read32_mask(rtwdev, 0xc1c, 0xffe00000); + for (i = 0; i < RTW_TXSCALE_SIZE; i++) { + table_value = rtw8822b_txscale_tbl[i]; + if (swing == table_value) + break; + } + + return i; +} + +static void rtw8822b_pwrtrack_init(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 swing_idx = rtw8822b_get_swing_index(rtwdev); + u8 path; + + if (swing_idx >= RTW_TXSCALE_SIZE) + dm_info->default_ofdm_index = 24; + else + dm_info->default_ofdm_index = swing_idx; + + for (path = RF_PATH_A; path < rtwdev->hal.rf_path_num; path++) { + ewma_thermal_init(&dm_info->avg_thermal[path]); + dm_info->delta_power_index[path] = 0; + } + dm_info->pwr_trk_triggered = false; + dm_info->pwr_trk_init_trigger = true; + dm_info->thermal_meter_k = rtwdev->efuse.thermal_meter_k; +} + +static void rtw8822b_phy_bf_init(struct rtw_dev *rtwdev) +{ + rtw_bf_phy_init(rtwdev); + /* Grouping bitmap parameters */ + rtw_write32(rtwdev, 0x1C94, 0xAFFFAFFF); +} + +static void rtw8822b_phy_set_param(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 crystal_cap; + bool is_tx2_path; + + /* power on BB/RF domain */ + rtw_write8_set(rtwdev, REG_SYS_FUNC_EN, + BIT_FEN_BB_RSTB | BIT_FEN_BB_GLB_RST); + rtw_write8_set(rtwdev, REG_RF_CTRL, + BIT_RF_EN | BIT_RF_RSTB | BIT_RF_SDM_RSTB); + rtw_write32_set(rtwdev, REG_WLRF1, BIT_WLRF1_BBRF_EN); + + /* pre init before header files config */ + rtw_write32_clr(rtwdev, REG_RXPSEL, BIT_RX_PSEL_RST); + + rtw_phy_load_tables(rtwdev); + + crystal_cap = rtwdev->efuse.crystal_cap & 0x3F; + rtw_write32_mask(rtwdev, 0x24, 0x7e000000, crystal_cap); + rtw_write32_mask(rtwdev, 0x28, 0x7e, crystal_cap); + + /* post init after header files config */ + rtw_write32_set(rtwdev, REG_RXPSEL, BIT_RX_PSEL_RST); + + is_tx2_path = false; + rtw8822b_config_trx_mode(rtwdev, hal->antenna_tx, hal->antenna_rx, + is_tx2_path); + rtw_phy_init(rtwdev); + + rtw8822b_phy_rfe_init(rtwdev); + rtw8822b_pwrtrack_init(rtwdev); + + rtw8822b_phy_bf_init(rtwdev); +} + +#define WLAN_SLOT_TIME 0x09 +#define WLAN_PIFS_TIME 0x19 +#define WLAN_SIFS_CCK_CONT_TX 0xA +#define WLAN_SIFS_OFDM_CONT_TX 0xE +#define WLAN_SIFS_CCK_TRX 0x10 +#define WLAN_SIFS_OFDM_TRX 0x10 +#define WLAN_VO_TXOP_LIMIT 0x186 /* unit : 32us */ +#define WLAN_VI_TXOP_LIMIT 0x3BC /* unit : 32us */ +#define WLAN_RDG_NAV 0x05 +#define WLAN_TXOP_NAV 0x1B +#define WLAN_CCK_RX_TSF 0x30 +#define WLAN_OFDM_RX_TSF 0x30 +#define WLAN_TBTT_PROHIBIT 0x04 /* unit : 32us */ +#define WLAN_TBTT_HOLD_TIME 0x064 /* unit : 32us */ +#define WLAN_DRV_EARLY_INT 0x04 +#define WLAN_BCN_DMA_TIME 0x02 + +#define WLAN_RX_FILTER0 0x0FFFFFFF +#define WLAN_RX_FILTER2 0xFFFF +#define WLAN_RCR_CFG 0xE400220E +#define WLAN_RXPKT_MAX_SZ 12288 +#define WLAN_RXPKT_MAX_SZ_512 (WLAN_RXPKT_MAX_SZ >> 9) + +#define WLAN_AMPDU_MAX_TIME 0x70 +#define WLAN_RTS_LEN_TH 0xFF +#define WLAN_RTS_TX_TIME_TH 0x08 +#define WLAN_MAX_AGG_PKT_LIMIT 0x20 +#define WLAN_RTS_MAX_AGG_PKT_LIMIT 0x20 +#define FAST_EDCA_VO_TH 0x06 +#define FAST_EDCA_VI_TH 0x06 +#define FAST_EDCA_BE_TH 0x06 +#define FAST_EDCA_BK_TH 0x06 +#define WLAN_BAR_RETRY_LIMIT 0x01 +#define WLAN_RA_TRY_RATE_AGG_LIMIT 0x08 + +#define WLAN_TX_FUNC_CFG1 0x30 +#define WLAN_TX_FUNC_CFG2 0x30 +#define WLAN_MAC_OPT_NORM_FUNC1 0x98 +#define WLAN_MAC_OPT_LB_FUNC1 0x80 +#define WLAN_MAC_OPT_FUNC2 0xb0810041 + +#define WLAN_SIFS_CFG (WLAN_SIFS_CCK_CONT_TX | \ + (WLAN_SIFS_OFDM_CONT_TX << BIT_SHIFT_SIFS_OFDM_CTX) | \ + (WLAN_SIFS_CCK_TRX << BIT_SHIFT_SIFS_CCK_TRX) | \ + (WLAN_SIFS_OFDM_TRX << BIT_SHIFT_SIFS_OFDM_TRX)) + +#define WLAN_TBTT_TIME (WLAN_TBTT_PROHIBIT |\ + (WLAN_TBTT_HOLD_TIME << BIT_SHIFT_TBTT_HOLD_TIME_AP)) + +#define WLAN_NAV_CFG (WLAN_RDG_NAV | (WLAN_TXOP_NAV << 16)) +#define WLAN_RX_TSF_CFG (WLAN_CCK_RX_TSF | (WLAN_OFDM_RX_TSF) << 8) + +static int rtw8822b_mac_init(struct rtw_dev *rtwdev) +{ + u32 value32; + + /* protocol configuration */ + rtw_write8_clr(rtwdev, REG_SW_AMPDU_BURST_MODE_CTRL, BIT_PRE_TX_CMD); + rtw_write8(rtwdev, REG_AMPDU_MAX_TIME_V1, WLAN_AMPDU_MAX_TIME); + rtw_write8_set(rtwdev, REG_TX_HANG_CTRL, BIT_EN_EOF_V1); + value32 = WLAN_RTS_LEN_TH | (WLAN_RTS_TX_TIME_TH << 8) | + (WLAN_MAX_AGG_PKT_LIMIT << 16) | + (WLAN_RTS_MAX_AGG_PKT_LIMIT << 24); + rtw_write32(rtwdev, REG_PROT_MODE_CTRL, value32); + rtw_write16(rtwdev, REG_BAR_MODE_CTRL + 2, + WLAN_BAR_RETRY_LIMIT | WLAN_RA_TRY_RATE_AGG_LIMIT << 8); + rtw_write8(rtwdev, REG_FAST_EDCA_VOVI_SETTING, FAST_EDCA_VO_TH); + rtw_write8(rtwdev, REG_FAST_EDCA_VOVI_SETTING + 2, FAST_EDCA_VI_TH); + rtw_write8(rtwdev, REG_FAST_EDCA_BEBK_SETTING, FAST_EDCA_BE_TH); + rtw_write8(rtwdev, REG_FAST_EDCA_BEBK_SETTING + 2, FAST_EDCA_BK_TH); + /* EDCA configuration */ + rtw_write8_clr(rtwdev, REG_TIMER0_SRC_SEL, BIT_TSFT_SEL_TIMER0); + rtw_write16(rtwdev, REG_TXPAUSE, 0x0000); + rtw_write8(rtwdev, REG_SLOT, WLAN_SLOT_TIME); + rtw_write8(rtwdev, REG_PIFS, WLAN_PIFS_TIME); + rtw_write32(rtwdev, REG_SIFS, WLAN_SIFS_CFG); + rtw_write16(rtwdev, REG_EDCA_VO_PARAM + 2, WLAN_VO_TXOP_LIMIT); + rtw_write16(rtwdev, REG_EDCA_VI_PARAM + 2, WLAN_VI_TXOP_LIMIT); + rtw_write32(rtwdev, REG_RD_NAV_NXT, WLAN_NAV_CFG); + rtw_write16(rtwdev, REG_RXTSF_OFFSET_CCK, WLAN_RX_TSF_CFG); + /* Set beacon cotnrol - enable TSF and other related functions */ + rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); + /* Set send beacon related registers */ + rtw_write32(rtwdev, REG_TBTT_PROHIBIT, WLAN_TBTT_TIME); + rtw_write8(rtwdev, REG_DRVERLYINT, WLAN_DRV_EARLY_INT); + rtw_write8(rtwdev, REG_BCNDMATIM, WLAN_BCN_DMA_TIME); + rtw_write8_clr(rtwdev, REG_TX_PTCL_CTRL + 1, BIT_SIFS_BK_EN >> 8); + /* WMAC configuration */ + rtw_write32(rtwdev, REG_RXFLTMAP0, WLAN_RX_FILTER0); + rtw_write16(rtwdev, REG_RXFLTMAP2, WLAN_RX_FILTER2); + rtw_write32(rtwdev, REG_RCR, WLAN_RCR_CFG); + rtw_write8(rtwdev, REG_RX_PKT_LIMIT, WLAN_RXPKT_MAX_SZ_512); + rtw_write8(rtwdev, REG_TCR + 2, WLAN_TX_FUNC_CFG2); + rtw_write8(rtwdev, REG_TCR + 1, WLAN_TX_FUNC_CFG1); + rtw_write32(rtwdev, REG_WMAC_OPTION_FUNCTION + 8, WLAN_MAC_OPT_FUNC2); + rtw_write8(rtwdev, REG_WMAC_OPTION_FUNCTION + 4, WLAN_MAC_OPT_NORM_FUNC1); + rtw_write8_set(rtwdev, REG_SND_PTCL_CTRL, + BIT_DIS_CHK_VHTSIGB_CRC); + + return 0; +} + +static void rtw8822b_set_channel_rfe_efem(struct rtw_dev *rtwdev, u8 channel) +{ + struct rtw_hal *hal = &rtwdev->hal; + + if (IS_CH_2G_BAND(channel)) { + rtw_write32s_mask(rtwdev, REG_RFESEL0, 0xffffff, 0x705770); + rtw_write32s_mask(rtwdev, REG_RFESEL8, MASKBYTE1, 0x57); + rtw_write32s_mask(rtwdev, REG_RFECTL, BIT(4), 0); + } else { + rtw_write32s_mask(rtwdev, REG_RFESEL0, 0xffffff, 0x177517); + rtw_write32s_mask(rtwdev, REG_RFESEL8, MASKBYTE1, 0x75); + rtw_write32s_mask(rtwdev, REG_RFECTL, BIT(5), 0); + } + + rtw_write32s_mask(rtwdev, REG_RFEINV, BIT(11) | BIT(10) | 0x3f, 0x0); + + if (hal->antenna_rx == BB_PATH_AB || + hal->antenna_tx == BB_PATH_AB) { + /* 2TX or 2RX */ + rtw_write32s_mask(rtwdev, REG_TRSW, MASKLWORD, 0xa501); + } else if (hal->antenna_rx == hal->antenna_tx) { + /* TXA+RXA or TXB+RXB */ + rtw_write32s_mask(rtwdev, REG_TRSW, MASKLWORD, 0xa500); + } else { + /* TXB+RXA or TXA+RXB */ + rtw_write32s_mask(rtwdev, REG_TRSW, MASKLWORD, 0xa005); + } +} + +static void rtw8822b_set_channel_rfe_ifem(struct rtw_dev *rtwdev, u8 channel) +{ + struct rtw_hal *hal = &rtwdev->hal; + + if (IS_CH_2G_BAND(channel)) { + /* signal source */ + rtw_write32s_mask(rtwdev, REG_RFESEL0, 0xffffff, 0x745774); + rtw_write32s_mask(rtwdev, REG_RFESEL8, MASKBYTE1, 0x57); + } else { + /* signal source */ + rtw_write32s_mask(rtwdev, REG_RFESEL0, 0xffffff, 0x477547); + rtw_write32s_mask(rtwdev, REG_RFESEL8, MASKBYTE1, 0x75); + } + + rtw_write32s_mask(rtwdev, REG_RFEINV, BIT(11) | BIT(10) | 0x3f, 0x0); + + if (IS_CH_2G_BAND(channel)) { + if (hal->antenna_rx == BB_PATH_AB || + hal->antenna_tx == BB_PATH_AB) { + /* 2TX or 2RX */ + rtw_write32s_mask(rtwdev, REG_TRSW, MASKLWORD, 0xa501); + } else if (hal->antenna_rx == hal->antenna_tx) { + /* TXA+RXA or TXB+RXB */ + rtw_write32s_mask(rtwdev, REG_TRSW, MASKLWORD, 0xa500); + } else { + /* TXB+RXA or TXA+RXB */ + rtw_write32s_mask(rtwdev, REG_TRSW, MASKLWORD, 0xa005); + } + } else { + rtw_write32s_mask(rtwdev, REG_TRSW, MASKLWORD, 0xa5a5); + } +} + +enum { + CCUT_IDX_1R_2G, + CCUT_IDX_2R_2G, + CCUT_IDX_1R_5G, + CCUT_IDX_2R_5G, + CCUT_IDX_NR, +}; + +struct cca_ccut { + u32 reg82c[CCUT_IDX_NR]; + u32 reg830[CCUT_IDX_NR]; + u32 reg838[CCUT_IDX_NR]; +}; + +static const struct cca_ccut cca_ifem_ccut = { + {0x75C97010, 0x75C97010, 0x75C97010, 0x75C97010}, /*Reg82C*/ + {0x79a0eaaa, 0x79A0EAAC, 0x79a0eaaa, 0x79a0eaaa}, /*Reg830*/ + {0x87765541, 0x87746341, 0x87765541, 0x87746341}, /*Reg838*/ +}; + +static const struct cca_ccut cca_efem_ccut = { + {0x75B86010, 0x75B76010, 0x75B86010, 0x75B76010}, /*Reg82C*/ + {0x79A0EAA8, 0x79A0EAAC, 0x79A0EAA8, 0x79a0eaaa}, /*Reg830*/ + {0x87766451, 0x87766431, 0x87766451, 0x87766431}, /*Reg838*/ +}; + +static const struct cca_ccut cca_ifem_ccut_ext = { + {0x75da8010, 0x75da8010, 0x75da8010, 0x75da8010}, /*Reg82C*/ + {0x79a0eaaa, 0x97A0EAAC, 0x79a0eaaa, 0x79a0eaaa}, /*Reg830*/ + {0x87765541, 0x86666341, 0x87765561, 0x86666361}, /*Reg838*/ +}; + +static void rtw8822b_get_cca_val(const struct cca_ccut *cca_ccut, u8 col, + u32 *reg82c, u32 *reg830, u32 *reg838) +{ + *reg82c = cca_ccut->reg82c[col]; + *reg830 = cca_ccut->reg830[col]; + *reg838 = cca_ccut->reg838[col]; +} + +struct rtw8822b_rfe_info { + const struct cca_ccut *cca_ccut_2g; + const struct cca_ccut *cca_ccut_5g; + enum rtw_rfe_fem fem; + bool ifem_ext; + void (*rtw_set_channel_rfe)(struct rtw_dev *rtwdev, u8 channel); +}; + +#define I2GE5G_CCUT(set_ch) { \ + .cca_ccut_2g = &cca_ifem_ccut, \ + .cca_ccut_5g = &cca_efem_ccut, \ + .fem = RTW_RFE_IFEM2G_EFEM5G, \ + .ifem_ext = false, \ + .rtw_set_channel_rfe = &rtw8822b_set_channel_rfe_ ## set_ch, \ + } +#define IFEM_EXT_CCUT(set_ch) { \ + .cca_ccut_2g = &cca_ifem_ccut_ext, \ + .cca_ccut_5g = &cca_ifem_ccut_ext, \ + .fem = RTW_RFE_IFEM, \ + .ifem_ext = true, \ + .rtw_set_channel_rfe = &rtw8822b_set_channel_rfe_ ## set_ch, \ + } + +static const struct rtw8822b_rfe_info rtw8822b_rfe_info[] = { + [2] = I2GE5G_CCUT(efem), + [3] = IFEM_EXT_CCUT(ifem), + [5] = IFEM_EXT_CCUT(ifem), +}; + +static void rtw8822b_set_channel_cca(struct rtw_dev *rtwdev, u8 channel, u8 bw, + const struct rtw8822b_rfe_info *rfe_info) +{ + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_efuse *efuse = &rtwdev->efuse; + const struct cca_ccut *cca_ccut; + u8 col; + u32 reg82c, reg830, reg838; + bool is_efem_cca = false, is_ifem_cca = false, is_rfe_type = false; + + if (IS_CH_2G_BAND(channel)) { + cca_ccut = rfe_info->cca_ccut_2g; + + if (hal->antenna_rx == BB_PATH_A || + hal->antenna_rx == BB_PATH_B) + col = CCUT_IDX_1R_2G; + else + col = CCUT_IDX_2R_2G; + } else { + cca_ccut = rfe_info->cca_ccut_5g; + + if (hal->antenna_rx == BB_PATH_A || + hal->antenna_rx == BB_PATH_B) + col = CCUT_IDX_1R_5G; + else + col = CCUT_IDX_2R_5G; + } + + rtw8822b_get_cca_val(cca_ccut, col, ®82c, ®830, ®838); + + switch (rfe_info->fem) { + case RTW_RFE_IFEM: + default: + is_ifem_cca = true; + if (rfe_info->ifem_ext) + is_rfe_type = true; + break; + case RTW_RFE_EFEM: + is_efem_cca = true; + break; + case RTW_RFE_IFEM2G_EFEM5G: + if (IS_CH_2G_BAND(channel)) + is_ifem_cca = true; + else + is_efem_cca = true; + break; + } + + if (is_ifem_cca) { + if ((hal->cut_version == RTW_CHIP_VER_CUT_B && + (col == CCUT_IDX_2R_2G || col == CCUT_IDX_2R_5G) && + bw == RTW_CHANNEL_WIDTH_40) || + (!is_rfe_type && col == CCUT_IDX_2R_5G && + bw == RTW_CHANNEL_WIDTH_40) || + (efuse->rfe_option == 5 && col == CCUT_IDX_2R_5G)) + reg830 = 0x79a0ea28; + } + + rtw_write32_mask(rtwdev, REG_CCASEL, MASKDWORD, reg82c); + rtw_write32_mask(rtwdev, REG_PDMFTH, MASKDWORD, reg830); + rtw_write32_mask(rtwdev, REG_CCA2ND, MASKDWORD, reg838); + + if (is_efem_cca && !(hal->cut_version == RTW_CHIP_VER_CUT_B)) + rtw_write32_mask(rtwdev, REG_L1WT, MASKDWORD, 0x9194b2b9); + + if (bw == RTW_CHANNEL_WIDTH_20 && IS_CH_5G_BAND_MID(channel)) + rtw_write32_mask(rtwdev, REG_CCA2ND, 0xf0, 0x4); +} + +static const u8 low_band[15] = {0x7, 0x6, 0x6, 0x5, 0x0, 0x0, 0x7, 0xff, 0x6, + 0x5, 0x0, 0x0, 0x7, 0x6, 0x6}; +static const u8 middle_band[23] = {0x6, 0x5, 0x0, 0x0, 0x7, 0x6, 0x6, 0xff, 0x0, + 0x0, 0x7, 0x6, 0x6, 0x5, 0x0, 0xff, 0x7, 0x6, + 0x6, 0x5, 0x0, 0x0, 0x7}; +static const u8 high_band[15] = {0x5, 0x5, 0x0, 0x7, 0x7, 0x6, 0x5, 0xff, 0x0, + 0x7, 0x7, 0x6, 0x5, 0x5, 0x0}; + +static void rtw8822b_set_channel_rf(struct rtw_dev *rtwdev, u8 channel, u8 bw) +{ +#define RF18_BAND_MASK (BIT(16) | BIT(9) | BIT(8)) +#define RF18_BAND_2G (0) +#define RF18_BAND_5G (BIT(16) | BIT(8)) +#define RF18_CHANNEL_MASK (MASKBYTE0) +#define RF18_RFSI_MASK (BIT(18) | BIT(17)) +#define RF18_RFSI_GE_CH80 (BIT(17)) +#define RF18_RFSI_GT_CH144 (BIT(18)) +#define RF18_BW_MASK (BIT(11) | BIT(10)) +#define RF18_BW_20M (BIT(11) | BIT(10)) +#define RF18_BW_40M (BIT(11)) +#define RF18_BW_80M (BIT(10)) +#define RFBE_MASK (BIT(17) | BIT(16) | BIT(15)) + + struct rtw_hal *hal = &rtwdev->hal; + u32 rf_reg18, rf_reg_be; + + rf_reg18 = rtw_read_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK); + + rf_reg18 &= ~(RF18_BAND_MASK | RF18_CHANNEL_MASK | RF18_RFSI_MASK | + RF18_BW_MASK); + + rf_reg18 |= (IS_CH_2G_BAND(channel) ? RF18_BAND_2G : RF18_BAND_5G); + rf_reg18 |= (channel & RF18_CHANNEL_MASK); + if (channel > 144) + rf_reg18 |= RF18_RFSI_GT_CH144; + else if (channel >= 80) + rf_reg18 |= RF18_RFSI_GE_CH80; + + switch (bw) { + case RTW_CHANNEL_WIDTH_5: + case RTW_CHANNEL_WIDTH_10: + case RTW_CHANNEL_WIDTH_20: + default: + rf_reg18 |= RF18_BW_20M; + break; + case RTW_CHANNEL_WIDTH_40: + rf_reg18 |= RF18_BW_40M; + break; + case RTW_CHANNEL_WIDTH_80: + rf_reg18 |= RF18_BW_80M; + break; + } + + if (IS_CH_2G_BAND(channel)) + rf_reg_be = 0x0; + else if (IS_CH_5G_BAND_1(channel) || IS_CH_5G_BAND_2(channel)) + rf_reg_be = low_band[(channel - 36) >> 1]; + else if (IS_CH_5G_BAND_3(channel)) + rf_reg_be = middle_band[(channel - 100) >> 1]; + else if (IS_CH_5G_BAND_4(channel)) + rf_reg_be = high_band[(channel - 149) >> 1]; + else + goto err; + + rtw_write_rf(rtwdev, RF_PATH_A, RF_MALSEL, RFBE_MASK, rf_reg_be); + + /* need to set 0xdf[18]=1 before writing RF18 when channel 144 */ + if (channel == 144) + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTDBG, BIT(18), 0x1); + else + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTDBG, BIT(18), 0x0); + + rtw_write_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK, rf_reg18); + if (hal->rf_type > RF_1T1R) + rtw_write_rf(rtwdev, RF_PATH_B, 0x18, RFREG_MASK, rf_reg18); + + rtw_write_rf(rtwdev, RF_PATH_A, RF_XTALX2, BIT(19), 0); + rtw_write_rf(rtwdev, RF_PATH_A, RF_XTALX2, BIT(19), 1); + + return; + +err: + WARN_ON(1); +} + +static void rtw8822b_toggle_igi(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + u32 igi; + + igi = rtw_read32_mask(rtwdev, REG_RXIGI_A, 0x7f); + rtw_write32_mask(rtwdev, REG_RXIGI_A, 0x7f, igi - 2); + rtw_write32_mask(rtwdev, REG_RXIGI_A, 0x7f, igi); + rtw_write32_mask(rtwdev, REG_RXIGI_B, 0x7f, igi - 2); + rtw_write32_mask(rtwdev, REG_RXIGI_B, 0x7f, igi); + + rtw_write32_mask(rtwdev, REG_RXPSEL, MASKBYTE0, 0x0); + rtw_write32_mask(rtwdev, REG_RXPSEL, MASKBYTE0, + hal->antenna_rx | (hal->antenna_rx << 4)); +} + +static void rtw8822b_set_channel_rxdfir(struct rtw_dev *rtwdev, u8 bw) +{ + if (bw == RTW_CHANNEL_WIDTH_40) { + /* RX DFIR for BW40 */ + rtw_write32_mask(rtwdev, REG_ACBB0, BIT(29) | BIT(28), 0x1); + rtw_write32_mask(rtwdev, REG_ACBBRXFIR, BIT(29) | BIT(28), 0x0); + rtw_write32s_mask(rtwdev, REG_TXDFIR, BIT(31), 0x0); + } else if (bw == RTW_CHANNEL_WIDTH_80) { + /* RX DFIR for BW80 */ + rtw_write32_mask(rtwdev, REG_ACBB0, BIT(29) | BIT(28), 0x2); + rtw_write32_mask(rtwdev, REG_ACBBRXFIR, BIT(29) | BIT(28), 0x1); + rtw_write32s_mask(rtwdev, REG_TXDFIR, BIT(31), 0x0); + } else { + /* RX DFIR for BW20, BW10 and BW5*/ + rtw_write32_mask(rtwdev, REG_ACBB0, BIT(29) | BIT(28), 0x2); + rtw_write32_mask(rtwdev, REG_ACBBRXFIR, BIT(29) | BIT(28), 0x2); + rtw_write32s_mask(rtwdev, REG_TXDFIR, BIT(31), 0x1); + } +} + +static void rtw8822b_set_channel_bb(struct rtw_dev *rtwdev, u8 channel, u8 bw, + u8 primary_ch_idx) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 rfe_option = efuse->rfe_option; + u32 val32; + + if (IS_CH_2G_BAND(channel)) { + rtw_write32_mask(rtwdev, REG_RXPSEL, BIT(28), 0x1); + rtw_write32_mask(rtwdev, REG_CCK_CHECK, BIT(7), 0x0); + rtw_write32_mask(rtwdev, REG_ENTXCCK, BIT(18), 0x0); + rtw_write32_mask(rtwdev, REG_RXCCAMSK, 0x0000FC00, 15); + + rtw_write32_mask(rtwdev, REG_ACGG2TBL, 0x1f, 0x0); + rtw_write32_mask(rtwdev, REG_CLKTRK, 0x1ffe0000, 0x96a); + if (channel == 14) { + rtw_write32_mask(rtwdev, REG_TXSF2, MASKDWORD, 0x00006577); + rtw_write32_mask(rtwdev, REG_TXSF6, MASKLWORD, 0x0000); + } else { + rtw_write32_mask(rtwdev, REG_TXSF2, MASKDWORD, 0x384f6577); + rtw_write32_mask(rtwdev, REG_TXSF6, MASKLWORD, 0x1525); + } + + rtw_write32_mask(rtwdev, REG_RFEINV, 0x300, 0x2); + } else if (IS_CH_5G_BAND(channel)) { + rtw_write32_mask(rtwdev, REG_ENTXCCK, BIT(18), 0x1); + rtw_write32_mask(rtwdev, REG_CCK_CHECK, BIT(7), 0x1); + rtw_write32_mask(rtwdev, REG_RXPSEL, BIT(28), 0x0); + rtw_write32_mask(rtwdev, REG_RXCCAMSK, 0x0000FC00, 34); + + if (IS_CH_5G_BAND_1(channel) || IS_CH_5G_BAND_2(channel)) + rtw_write32_mask(rtwdev, REG_ACGG2TBL, 0x1f, 0x1); + else if (IS_CH_5G_BAND_3(channel)) + rtw_write32_mask(rtwdev, REG_ACGG2TBL, 0x1f, 0x2); + else if (IS_CH_5G_BAND_4(channel)) + rtw_write32_mask(rtwdev, REG_ACGG2TBL, 0x1f, 0x3); + + if (IS_CH_5G_BAND_1(channel)) + rtw_write32_mask(rtwdev, REG_CLKTRK, 0x1ffe0000, 0x494); + else if (IS_CH_5G_BAND_2(channel)) + rtw_write32_mask(rtwdev, REG_CLKTRK, 0x1ffe0000, 0x453); + else if (channel >= 100 && channel <= 116) + rtw_write32_mask(rtwdev, REG_CLKTRK, 0x1ffe0000, 0x452); + else if (channel >= 118 && channel <= 177) + rtw_write32_mask(rtwdev, REG_CLKTRK, 0x1ffe0000, 0x412); + + rtw_write32_mask(rtwdev, 0xcbc, 0x300, 0x1); + } + + switch (bw) { + case RTW_CHANNEL_WIDTH_20: + default: + val32 = rtw_read32_mask(rtwdev, REG_ADCCLK, MASKDWORD); + val32 &= 0xFFCFFC00; + val32 |= (RTW_CHANNEL_WIDTH_20); + rtw_write32_mask(rtwdev, REG_ADCCLK, MASKDWORD, val32); + + rtw_write32_mask(rtwdev, REG_ADC160, BIT(30), 0x1); + break; + case RTW_CHANNEL_WIDTH_40: + if (primary_ch_idx == RTW_SC_20_UPPER) + rtw_write32_set(rtwdev, REG_RXSB, BIT(4)); + else + rtw_write32_clr(rtwdev, REG_RXSB, BIT(4)); + + val32 = rtw_read32_mask(rtwdev, REG_ADCCLK, MASKDWORD); + val32 &= 0xFF3FF300; + val32 |= (((primary_ch_idx & 0xf) << 2) | RTW_CHANNEL_WIDTH_40); + rtw_write32_mask(rtwdev, REG_ADCCLK, MASKDWORD, val32); + + rtw_write32_mask(rtwdev, REG_ADC160, BIT(30), 0x1); + break; + case RTW_CHANNEL_WIDTH_80: + val32 = rtw_read32_mask(rtwdev, REG_ADCCLK, MASKDWORD); + val32 &= 0xFCEFCF00; + val32 |= (((primary_ch_idx & 0xf) << 2) | RTW_CHANNEL_WIDTH_80); + rtw_write32_mask(rtwdev, REG_ADCCLK, MASKDWORD, val32); + + rtw_write32_mask(rtwdev, REG_ADC160, BIT(30), 0x1); + + if (rfe_option == 2 || rfe_option == 3) { + rtw_write32_mask(rtwdev, REG_L1PKWT, 0x0000f000, 0x6); + rtw_write32_mask(rtwdev, REG_ADC40, BIT(10), 0x1); + } + break; + case RTW_CHANNEL_WIDTH_5: + val32 = rtw_read32_mask(rtwdev, REG_ADCCLK, MASKDWORD); + val32 &= 0xEFEEFE00; + val32 |= ((BIT(6) | RTW_CHANNEL_WIDTH_20)); + rtw_write32_mask(rtwdev, REG_ADCCLK, MASKDWORD, val32); + + rtw_write32_mask(rtwdev, REG_ADC160, BIT(30), 0x0); + rtw_write32_mask(rtwdev, REG_ADC40, BIT(31), 0x1); + break; + case RTW_CHANNEL_WIDTH_10: + val32 = rtw_read32_mask(rtwdev, REG_ADCCLK, MASKDWORD); + val32 &= 0xEFFEFF00; + val32 |= ((BIT(7) | RTW_CHANNEL_WIDTH_20)); + rtw_write32_mask(rtwdev, REG_ADCCLK, MASKDWORD, val32); + + rtw_write32_mask(rtwdev, REG_ADC160, BIT(30), 0x0); + rtw_write32_mask(rtwdev, REG_ADC40, BIT(31), 0x1); + break; + } +} + +static void rtw8822b_set_channel(struct rtw_dev *rtwdev, u8 channel, u8 bw, + u8 primary_chan_idx) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + const struct rtw8822b_rfe_info *rfe_info; + + if (WARN(efuse->rfe_option >= ARRAY_SIZE(rtw8822b_rfe_info), + "rfe_option %d is out of boundary\n", efuse->rfe_option)) + return; + + rfe_info = &rtw8822b_rfe_info[efuse->rfe_option]; + + rtw8822b_set_channel_bb(rtwdev, channel, bw, primary_chan_idx); + rtw_set_channel_mac(rtwdev, channel, bw, primary_chan_idx); + rtw8822b_set_channel_rf(rtwdev, channel, bw); + rtw8822b_set_channel_rxdfir(rtwdev, bw); + rtw8822b_toggle_igi(rtwdev); + rtw8822b_set_channel_cca(rtwdev, channel, bw, rfe_info); + (*rfe_info->rtw_set_channel_rfe)(rtwdev, channel); +} + +static void rtw8822b_config_trx_mode(struct rtw_dev *rtwdev, u8 tx_path, + u8 rx_path, bool is_tx2_path) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + const struct rtw8822b_rfe_info *rfe_info; + u8 ch = rtwdev->hal.current_channel; + u8 tx_path_sel, rx_path_sel; + int counter; + + if (WARN(efuse->rfe_option >= ARRAY_SIZE(rtw8822b_rfe_info), + "rfe_option %d is out of boundary\n", efuse->rfe_option)) + return; + + rfe_info = &rtw8822b_rfe_info[efuse->rfe_option]; + + if ((tx_path | rx_path) & BB_PATH_A) + rtw_write32_mask(rtwdev, REG_AGCTR_A, MASKLWORD, 0x3231); + else + rtw_write32_mask(rtwdev, REG_AGCTR_A, MASKLWORD, 0x1111); + + if ((tx_path | rx_path) & BB_PATH_B) + rtw_write32_mask(rtwdev, REG_AGCTR_B, MASKLWORD, 0x3231); + else + rtw_write32_mask(rtwdev, REG_AGCTR_B, MASKLWORD, 0x1111); + + rtw_write32_mask(rtwdev, REG_CDDTXP, (BIT(19) | BIT(18)), 0x3); + rtw_write32_mask(rtwdev, REG_TXPSEL, (BIT(29) | BIT(28)), 0x1); + rtw_write32_mask(rtwdev, REG_TXPSEL, BIT(30), 0x1); + + if (tx_path & BB_PATH_A) { + rtw_write32_mask(rtwdev, REG_CDDTXP, 0xfff00000, 0x001); + rtw_write32_mask(rtwdev, REG_ADCINI, 0xf0000000, 0x8); + } else if (tx_path & BB_PATH_B) { + rtw_write32_mask(rtwdev, REG_CDDTXP, 0xfff00000, 0x002); + rtw_write32_mask(rtwdev, REG_ADCINI, 0xf0000000, 0x4); + } + + if (tx_path == BB_PATH_A || tx_path == BB_PATH_B) + rtw_write32_mask(rtwdev, REG_TXPSEL1, 0xfff0, 0x01); + else + rtw_write32_mask(rtwdev, REG_TXPSEL1, 0xfff0, 0x43); + + tx_path_sel = (tx_path << 4) | tx_path; + rtw_write32_mask(rtwdev, REG_TXPSEL, MASKBYTE0, tx_path_sel); + + if (tx_path != BB_PATH_A && tx_path != BB_PATH_B) { + if (is_tx2_path || rtwdev->mp_mode) { + rtw_write32_mask(rtwdev, REG_CDDTXP, 0xfff00000, 0x043); + rtw_write32_mask(rtwdev, REG_ADCINI, 0xf0000000, 0xc); + } + } + + rtw_write32_mask(rtwdev, REG_RXDESC, BIT(22), 0x0); + rtw_write32_mask(rtwdev, REG_RXDESC, BIT(18), 0x0); + + if (rx_path & BB_PATH_A) + rtw_write32_mask(rtwdev, REG_ADCINI, 0x0f000000, 0x0); + else if (rx_path & BB_PATH_B) + rtw_write32_mask(rtwdev, REG_ADCINI, 0x0f000000, 0x5); + + rx_path_sel = (rx_path << 4) | rx_path; + rtw_write32_mask(rtwdev, REG_RXPSEL, MASKBYTE0, rx_path_sel); + + if (rx_path == BB_PATH_A || rx_path == BB_PATH_B) { + rtw_write32_mask(rtwdev, REG_ANTWT, BIT(16), 0x0); + rtw_write32_mask(rtwdev, REG_HTSTFWT, BIT(28), 0x0); + rtw_write32_mask(rtwdev, REG_MRC, BIT(23), 0x0); + } else { + rtw_write32_mask(rtwdev, REG_ANTWT, BIT(16), 0x1); + rtw_write32_mask(rtwdev, REG_HTSTFWT, BIT(28), 0x1); + rtw_write32_mask(rtwdev, REG_MRC, BIT(23), 0x1); + } + + for (counter = 100; counter > 0; counter--) { + u32 rf_reg33; + + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWE, RFREG_MASK, 0x80000); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWA, RFREG_MASK, 0x00001); + + udelay(2); + rf_reg33 = rtw_read_rf(rtwdev, RF_PATH_A, 0x33, RFREG_MASK); + + if (rf_reg33 == 0x00001) + break; + } + + if (WARN(counter <= 0, "write RF mode table fail\n")) + return; + + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWE, RFREG_MASK, 0x80000); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWA, RFREG_MASK, 0x00001); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD1, RFREG_MASK, 0x00034); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD0, RFREG_MASK, 0x4080c); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWE, RFREG_MASK, 0x00000); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWE, RFREG_MASK, 0x00000); + + rtw8822b_toggle_igi(rtwdev); + rtw8822b_set_channel_cca(rtwdev, 1, RTW_CHANNEL_WIDTH_20, rfe_info); + (*rfe_info->rtw_set_channel_rfe)(rtwdev, ch); +} + +static void query_phy_status_page0(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s8 min_rx_power = -120; + u8 pwdb = GET_PHY_STAT_P0_PWDB(phy_status); + + /* 8822B uses only 1 antenna to RX CCK rates */ + pkt_stat->rx_power[RF_PATH_A] = pwdb - 110; + pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1); + pkt_stat->bw = RTW_CHANNEL_WIDTH_20; + pkt_stat->signal_power = max(pkt_stat->rx_power[RF_PATH_A], + min_rx_power); + dm_info->rssi[RF_PATH_A] = pkt_stat->rssi; +} + +static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 rxsc, bw; + s8 min_rx_power = -120; + s8 rx_evm; + u8 evm_dbm = 0; + u8 rssi; + int path; + + if (pkt_stat->rate > DESC_RATE11M && pkt_stat->rate < DESC_RATEMCS0) + rxsc = GET_PHY_STAT_P1_L_RXSC(phy_status); + else + rxsc = GET_PHY_STAT_P1_HT_RXSC(phy_status); + + if (rxsc >= 1 && rxsc <= 8) + bw = RTW_CHANNEL_WIDTH_20; + else if (rxsc >= 9 && rxsc <= 12) + bw = RTW_CHANNEL_WIDTH_40; + else if (rxsc >= 13) + bw = RTW_CHANNEL_WIDTH_80; + else + bw = GET_PHY_STAT_P1_RF_MODE(phy_status); + + pkt_stat->rx_power[RF_PATH_A] = GET_PHY_STAT_P1_PWDB_A(phy_status) - 110; + pkt_stat->rx_power[RF_PATH_B] = GET_PHY_STAT_P1_PWDB_B(phy_status) - 110; + pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 2); + pkt_stat->bw = bw; + pkt_stat->signal_power = max3(pkt_stat->rx_power[RF_PATH_A], + pkt_stat->rx_power[RF_PATH_B], + min_rx_power); + + dm_info->curr_rx_rate = pkt_stat->rate; + + pkt_stat->rx_evm[RF_PATH_A] = GET_PHY_STAT_P1_RXEVM_A(phy_status); + pkt_stat->rx_evm[RF_PATH_B] = GET_PHY_STAT_P1_RXEVM_B(phy_status); + + pkt_stat->rx_snr[RF_PATH_A] = GET_PHY_STAT_P1_RXSNR_A(phy_status); + pkt_stat->rx_snr[RF_PATH_B] = GET_PHY_STAT_P1_RXSNR_B(phy_status); + + pkt_stat->cfo_tail[RF_PATH_A] = GET_PHY_STAT_P1_CFO_TAIL_A(phy_status); + pkt_stat->cfo_tail[RF_PATH_B] = GET_PHY_STAT_P1_CFO_TAIL_B(phy_status); + + for (path = 0; path <= rtwdev->hal.rf_path_num; path++) { + rssi = rtw_phy_rf_power_2_rssi(&pkt_stat->rx_power[path], 1); + dm_info->rssi[path] = rssi; + dm_info->rx_snr[path] = pkt_stat->rx_snr[path] >> 1; + dm_info->cfo_tail[path] = (pkt_stat->cfo_tail[path] * 5) >> 1; + + rx_evm = pkt_stat->rx_evm[path]; + + if (rx_evm < 0) { + if (rx_evm == S8_MIN) + evm_dbm = 0; + else + evm_dbm = ((u8)-rx_evm >> 1); + } + dm_info->rx_evm_dbm[path] = evm_dbm; + } +} + +static void query_phy_status(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + u8 page; + + page = *phy_status & 0xf; + + switch (page) { + case 0: + query_phy_status_page0(rtwdev, phy_status, pkt_stat); + break; + case 1: + query_phy_status_page1(rtwdev, phy_status, pkt_stat); + break; + default: + rtw_warn(rtwdev, "unused phy status page (%d)\n", page); + return; + } +} + +static void rtw8822b_query_rx_desc(struct rtw_dev *rtwdev, u8 *rx_desc, + struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_rx_status *rx_status) +{ + struct ieee80211_hdr *hdr; + u32 desc_sz = rtwdev->chip->rx_pkt_desc_sz; + u8 *phy_status = NULL; + + memset(pkt_stat, 0, sizeof(*pkt_stat)); + + pkt_stat->phy_status = GET_RX_DESC_PHYST(rx_desc); + pkt_stat->icv_err = GET_RX_DESC_ICV_ERR(rx_desc); + pkt_stat->crc_err = GET_RX_DESC_CRC32(rx_desc); + pkt_stat->decrypted = !GET_RX_DESC_SWDEC(rx_desc) && + GET_RX_DESC_ENC_TYPE(rx_desc) != RX_DESC_ENC_NONE; + pkt_stat->is_c2h = GET_RX_DESC_C2H(rx_desc); + pkt_stat->pkt_len = GET_RX_DESC_PKT_LEN(rx_desc); + pkt_stat->drv_info_sz = GET_RX_DESC_DRV_INFO_SIZE(rx_desc); + pkt_stat->shift = GET_RX_DESC_SHIFT(rx_desc); + pkt_stat->rate = GET_RX_DESC_RX_RATE(rx_desc); + pkt_stat->cam_id = GET_RX_DESC_MACID(rx_desc); + pkt_stat->ppdu_cnt = GET_RX_DESC_PPDU_CNT(rx_desc); + pkt_stat->tsf_low = GET_RX_DESC_TSFL(rx_desc); + + /* drv_info_sz is in unit of 8-bytes */ + pkt_stat->drv_info_sz *= 8; + + /* c2h cmd pkt's rx/phy status is not interested */ + if (pkt_stat->is_c2h) + return; + + hdr = (struct ieee80211_hdr *)(rx_desc + desc_sz + pkt_stat->shift + + pkt_stat->drv_info_sz); + if (pkt_stat->phy_status) { + phy_status = rx_desc + desc_sz + pkt_stat->shift; + query_phy_status(rtwdev, phy_status, pkt_stat); + } + + rtw_rx_fill_rx_status(rtwdev, pkt_stat, hdr, rx_status, phy_status); +} + +static void +rtw8822b_set_tx_power_index_by_rate(struct rtw_dev *rtwdev, u8 path, u8 rs) +{ + struct rtw_hal *hal = &rtwdev->hal; + static const u32 offset_txagc[2] = {0x1d00, 0x1d80}; + static u32 phy_pwr_idx; + u8 rate, rate_idx, pwr_index, shift; + int j; + + for (j = 0; j < rtw_rate_size[rs]; j++) { + rate = rtw_rate_section[rs][j]; + pwr_index = hal->tx_pwr_tbl[path][rate]; + shift = rate & 0x3; + phy_pwr_idx |= ((u32)pwr_index << (shift * 8)); + if (shift == 0x3) { + rate_idx = rate & 0xfc; + rtw_write32(rtwdev, offset_txagc[path] + rate_idx, + phy_pwr_idx); + phy_pwr_idx = 0; + } + } +} + +static void rtw8822b_set_tx_power_index(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + int rs, path; + + for (path = 0; path < hal->rf_path_num; path++) { + for (rs = 0; rs < RTW_RATE_SECTION_MAX; rs++) + rtw8822b_set_tx_power_index_by_rate(rtwdev, path, rs); + } +} + +static bool rtw8822b_check_rf_path(u8 antenna) +{ + switch (antenna) { + case BB_PATH_A: + case BB_PATH_B: + case BB_PATH_AB: + return true; + default: + return false; + } +} + +static int rtw8822b_set_antenna(struct rtw_dev *rtwdev, + u32 antenna_tx, + u32 antenna_rx) +{ + struct rtw_hal *hal = &rtwdev->hal; + + rtw_dbg(rtwdev, RTW_DBG_PHY, "config RF path, tx=0x%x rx=0x%x\n", + antenna_tx, antenna_rx); + + if (!rtw8822b_check_rf_path(antenna_tx)) { + rtw_warn(rtwdev, "unsupported tx path 0x%x\n", antenna_tx); + return -EINVAL; + } + + if (!rtw8822b_check_rf_path(antenna_rx)) { + rtw_warn(rtwdev, "unsupported rx path 0x%x\n", antenna_rx); + return -EINVAL; + } + + hal->antenna_tx = antenna_tx; + hal->antenna_rx = antenna_rx; + + rtw8822b_config_trx_mode(rtwdev, antenna_tx, antenna_rx, false); + + return 0; +} + +static void rtw8822b_cfg_ldo25(struct rtw_dev *rtwdev, bool enable) +{ + u8 ldo_pwr; + + ldo_pwr = rtw_read8(rtwdev, REG_LDO_EFUSE_CTRL + 3); + ldo_pwr = enable ? ldo_pwr | BIT_LDO25_EN : ldo_pwr & ~BIT_LDO25_EN; + rtw_write8(rtwdev, REG_LDO_EFUSE_CTRL + 3, ldo_pwr); +} + +static void rtw8822b_false_alarm_statistics(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 cck_enable; + u32 cck_fa_cnt; + u32 ofdm_fa_cnt; + u32 crc32_cnt; + u32 cca32_cnt; + + cck_enable = rtw_read32(rtwdev, 0x808) & BIT(28); + cck_fa_cnt = rtw_read16(rtwdev, 0xa5c); + ofdm_fa_cnt = rtw_read16(rtwdev, 0xf48); + + dm_info->cck_fa_cnt = cck_fa_cnt; + dm_info->ofdm_fa_cnt = ofdm_fa_cnt; + dm_info->total_fa_cnt = ofdm_fa_cnt; + dm_info->total_fa_cnt += cck_enable ? cck_fa_cnt : 0; + + crc32_cnt = rtw_read32(rtwdev, 0xf04); + dm_info->cck_ok_cnt = crc32_cnt & 0xffff; + dm_info->cck_err_cnt = (crc32_cnt & 0xffff0000) >> 16; + crc32_cnt = rtw_read32(rtwdev, 0xf14); + dm_info->ofdm_ok_cnt = crc32_cnt & 0xffff; + dm_info->ofdm_err_cnt = (crc32_cnt & 0xffff0000) >> 16; + crc32_cnt = rtw_read32(rtwdev, 0xf10); + dm_info->ht_ok_cnt = crc32_cnt & 0xffff; + dm_info->ht_err_cnt = (crc32_cnt & 0xffff0000) >> 16; + crc32_cnt = rtw_read32(rtwdev, 0xf0c); + dm_info->vht_ok_cnt = crc32_cnt & 0xffff; + dm_info->vht_err_cnt = (crc32_cnt & 0xffff0000) >> 16; + + cca32_cnt = rtw_read32(rtwdev, 0xf08); + dm_info->ofdm_cca_cnt = ((cca32_cnt & 0xffff0000) >> 16); + dm_info->total_cca_cnt = dm_info->ofdm_cca_cnt; + if (cck_enable) { + cca32_cnt = rtw_read32(rtwdev, 0xfcc); + dm_info->cck_cca_cnt = cca32_cnt & 0xffff; + dm_info->total_cca_cnt += dm_info->cck_cca_cnt; + } + + rtw_write32_set(rtwdev, 0x9a4, BIT(17)); + rtw_write32_clr(rtwdev, 0x9a4, BIT(17)); + rtw_write32_clr(rtwdev, 0xa2c, BIT(15)); + rtw_write32_set(rtwdev, 0xa2c, BIT(15)); + rtw_write32_set(rtwdev, 0xb58, BIT(0)); + rtw_write32_clr(rtwdev, 0xb58, BIT(0)); +} + +static void rtw8822b_do_iqk(struct rtw_dev *rtwdev) +{ + static int do_iqk_cnt; + struct rtw_iqk_para para = {.clear = 0, .segment_iqk = 0}; + u32 rf_reg, iqk_fail_mask; + int counter; + bool reload; + + rtw_fw_do_iqk(rtwdev, ¶); + + for (counter = 0; counter < 300; counter++) { + rf_reg = rtw_read_rf(rtwdev, RF_PATH_A, RF_DTXLOK, RFREG_MASK); + if (rf_reg == 0xabcde) + break; + msleep(20); + } + rtw_write_rf(rtwdev, RF_PATH_A, RF_DTXLOK, RFREG_MASK, 0x0); + + reload = !!rtw_read32_mask(rtwdev, REG_IQKFAILMSK, BIT(16)); + iqk_fail_mask = rtw_read32_mask(rtwdev, REG_IQKFAILMSK, GENMASK(7, 0)); + rtw_dbg(rtwdev, RTW_DBG_PHY, + "iqk counter=%d reload=%d do_iqk_cnt=%d n_iqk_fail(mask)=0x%02x\n", + counter, reload, ++do_iqk_cnt, iqk_fail_mask); +} + +static void rtw8822b_phy_calibration(struct rtw_dev *rtwdev) +{ + rtw8822b_do_iqk(rtwdev); +} + +static void rtw8822b_coex_cfg_init(struct rtw_dev *rtwdev) +{ + /* enable TBTT nterrupt */ + rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); + + /* BT report packet sample rate */ + /* 0x790[5:0]=0x5 */ + rtw_write8_mask(rtwdev, REG_BT_TDMA_TIME, BIT_MASK_SAMPLE_RATE, 0x5); + + /* enable BT counter statistics */ + rtw_write8(rtwdev, REG_BT_STAT_CTRL, 0x1); + + /* enable PTA (3-wire function form BT side) */ + rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_PTA_EN); + rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_PO_BT_PTA_PINS); + + /* enable PTA (tx/rx signal form WiFi side) */ + rtw_write8_set(rtwdev, REG_QUEUE_CTRL, BIT_PTA_WL_TX_EN); + /* wl tx signal to PTA not case EDCCA */ + rtw_write8_clr(rtwdev, REG_QUEUE_CTRL, BIT_PTA_EDCCA_EN); + /* GNT_BT=1 while select both */ + rtw_write16_set(rtwdev, REG_BT_COEX_V2, BIT_GNT_BT_POLARITY); +} + +static void rtw8822b_coex_cfg_ant_switch(struct rtw_dev *rtwdev, + u8 ctrl_type, u8 pos_type) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + struct rtw_coex_rfe *coex_rfe = &coex->rfe; + bool polarity_inverse; + u8 regval = 0; + + if (((ctrl_type << 8) + pos_type) == coex_dm->cur_switch_status) + return; + + coex_dm->cur_switch_status = (ctrl_type << 8) + pos_type; + + if (coex_rfe->ant_switch_diversity && + ctrl_type == COEX_SWITCH_CTRL_BY_BBSW) + ctrl_type = COEX_SWITCH_CTRL_BY_ANTDIV; + + polarity_inverse = (coex_rfe->ant_switch_polarity == 1); + + switch (ctrl_type) { + default: + case COEX_SWITCH_CTRL_BY_BBSW: + /* 0x4c[23] = 0 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 2, BIT_DPDT_SEL_EN >> 16, 0x0); + /* 0x4c[24] = 1 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 3, BIT_DPDT_WL_SEL >> 24, 0x1); + /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as ctrl pin */ + rtw_write8_mask(rtwdev, REG_RFE_CTRL8, BIT_MASK_RFE_SEL89, 0x77); + + if (pos_type == COEX_SWITCH_TO_WLG_BT) { + if (coex_rfe->rfe_module_type != 0x4 && + coex_rfe->rfe_module_type != 0x2) + regval = 0x3; + else + regval = (!polarity_inverse ? 0x2 : 0x1); + } else if (pos_type == COEX_SWITCH_TO_WLG) { + regval = (!polarity_inverse ? 0x2 : 0x1); + } else { + regval = (!polarity_inverse ? 0x1 : 0x2); + } + + rtw_write8_mask(rtwdev, REG_RFE_INV8, BIT_MASK_RFE_INV89, regval); + break; + case COEX_SWITCH_CTRL_BY_PTA: + /* 0x4c[23] = 0 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 2, BIT_DPDT_SEL_EN >> 16, 0x0); + /* 0x4c[24] = 1 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 3, BIT_DPDT_WL_SEL >> 24, 0x1); + /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as ctrl pin */ + rtw_write8_mask(rtwdev, REG_RFE_CTRL8, BIT_MASK_RFE_SEL89, 0x66); + + regval = (!polarity_inverse ? 0x2 : 0x1); + rtw_write8_mask(rtwdev, REG_RFE_INV8, BIT_MASK_RFE_INV89, regval); + break; + case COEX_SWITCH_CTRL_BY_ANTDIV: + /* 0x4c[23] = 0 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 2, BIT_DPDT_SEL_EN >> 16, 0x0); + /* 0x4c[24] = 1 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 3, BIT_DPDT_WL_SEL >> 24, 0x1); + rtw_write8_mask(rtwdev, REG_RFE_CTRL8, BIT_MASK_RFE_SEL89, 0x88); + break; + case COEX_SWITCH_CTRL_BY_MAC: + /* 0x4c[23] = 1 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 2, BIT_DPDT_SEL_EN >> 16, 0x1); + + regval = (!polarity_inverse ? 0x0 : 0x1); + rtw_write8_mask(rtwdev, REG_PAD_CTRL1, BIT_SW_DPDT_SEL_DATA, regval); + break; + case COEX_SWITCH_CTRL_BY_FW: + /* 0x4c[23] = 0 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 2, BIT_DPDT_SEL_EN >> 16, 0x0); + /* 0x4c[24] = 1 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 3, BIT_DPDT_WL_SEL >> 24, 0x1); + break; + case COEX_SWITCH_CTRL_BY_BT: + /* 0x4c[23] = 0 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 2, BIT_DPDT_SEL_EN >> 16, 0x0); + /* 0x4c[24] = 0 */ + rtw_write8_mask(rtwdev, REG_LED_CFG + 3, BIT_DPDT_WL_SEL >> 24, 0x0); + break; + } +} + +static void rtw8822b_coex_cfg_gnt_fix(struct rtw_dev *rtwdev) +{ +} + +static void rtw8822b_coex_cfg_gnt_debug(struct rtw_dev *rtwdev) +{ + rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 2, BIT_BTGP_SPI_EN >> 16, 0); + rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 3, BIT_BTGP_JTAG_EN >> 24, 0); + rtw_write8_mask(rtwdev, REG_GPIO_MUXCFG + 2, BIT_FSPI_EN >> 16, 0); + rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 1, BIT_LED1DIS >> 8, 0); + rtw_write8_mask(rtwdev, REG_SYS_SDIO_CTRL + 3, BIT_DBG_GNT_WL_BT >> 24, 0); +} + +static void rtw8822b_coex_cfg_rfe_type(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_rfe *coex_rfe = &coex->rfe; + struct rtw_efuse *efuse = &rtwdev->efuse; + bool is_ext_fem = false; + + coex_rfe->rfe_module_type = rtwdev->efuse.rfe_option; + coex_rfe->ant_switch_polarity = 0; + coex_rfe->ant_switch_diversity = false; + if (coex_rfe->rfe_module_type == 0x12 || + coex_rfe->rfe_module_type == 0x15 || + coex_rfe->rfe_module_type == 0x16) + coex_rfe->ant_switch_exist = false; + else + coex_rfe->ant_switch_exist = true; + + if (coex_rfe->rfe_module_type == 2 || + coex_rfe->rfe_module_type == 4) { + rtw_coex_write_scbd(rtwdev, COEX_SCBD_EXTFEM, true); + is_ext_fem = true; + } else { + rtw_coex_write_scbd(rtwdev, COEX_SCBD_EXTFEM, false); + } + + coex_rfe->wlg_at_btg = false; + + if (efuse->share_ant && + coex_rfe->ant_switch_exist && !is_ext_fem) + coex_rfe->ant_switch_with_bt = true; + else + coex_rfe->ant_switch_with_bt = false; + + /* Ext switch buffer mux */ + rtw_write8(rtwdev, REG_RFE_CTRL_E, 0xff); + rtw_write8_mask(rtwdev, REG_RFESEL_CTRL + 1, 0x3, 0x0); + rtw_write8_mask(rtwdev, REG_RFE_INV16, BIT_RFE_BUF_EN, 0x0); + + /* Disable LTE Coex Function in WiFi side */ + rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, BIT_LTE_COEX_EN, 0); + + /* BTC_CTT_WL_VS_LTE */ + rtw_coex_write_indirect_reg(rtwdev, LTE_WL_TRX_CTRL, MASKLWORD, 0xffff); + + /* BTC_CTT_BT_VS_LTE */ + rtw_coex_write_indirect_reg(rtwdev, LTE_BT_TRX_CTRL, MASKLWORD, 0xffff); +} + +static void rtw8822b_coex_cfg_wl_tx_power(struct rtw_dev *rtwdev, u8 wl_pwr) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + static const u16 reg_addr[] = {0xc58, 0xe58}; + static const u8 wl_tx_power[] = {0xd8, 0xd4, 0xd0, 0xcc, 0xc8}; + u8 i, pwr; + + if (wl_pwr == coex_dm->cur_wl_pwr_lvl) + return; + + coex_dm->cur_wl_pwr_lvl = wl_pwr; + + if (coex_dm->cur_wl_pwr_lvl >= ARRAY_SIZE(wl_tx_power)) + coex_dm->cur_wl_pwr_lvl = ARRAY_SIZE(wl_tx_power) - 1; + + pwr = wl_tx_power[coex_dm->cur_wl_pwr_lvl]; + + for (i = 0; i < ARRAY_SIZE(reg_addr); i++) + rtw_write8_mask(rtwdev, reg_addr[i], 0xff, pwr); +} + +static void rtw8822b_coex_cfg_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + /* WL Rx Low gain on */ + static const u32 wl_rx_low_gain_on[] = { + 0xff000003, 0xbd120003, 0xbe100003, 0xbf080003, 0xbf060003, + 0xbf050003, 0xbc140003, 0xbb160003, 0xba180003, 0xb91a0003, + 0xb81c0003, 0xb71e0003, 0xb4200003, 0xb5220003, 0xb4240003, + 0xb3260003, 0xb2280003, 0xb12a0003, 0xb02c0003, 0xaf2e0003, + 0xae300003, 0xad320003, 0xac340003, 0xab360003, 0x8d380003, + 0x8c3a0003, 0x8b3c0003, 0x8a3e0003, 0x6e400003, 0x6d420003, + 0x6c440003, 0x6b460003, 0x6a480003, 0x694a0003, 0x684c0003, + 0x674e0003, 0x66500003, 0x65520003, 0x64540003, 0x64560003, + 0x007e0403 + }; + + /* WL Rx Low gain off */ + static const u32 wl_rx_low_gain_off[] = { + 0xff000003, 0xf4120003, 0xf5100003, 0xf60e0003, 0xf70c0003, + 0xf80a0003, 0xf3140003, 0xf2160003, 0xf1180003, 0xf01a0003, + 0xef1c0003, 0xee1e0003, 0xed200003, 0xec220003, 0xeb240003, + 0xea260003, 0xe9280003, 0xe82a0003, 0xe72c0003, 0xe62e0003, + 0xe5300003, 0xc8320003, 0xc7340003, 0xc6360003, 0xc5380003, + 0xc43a0003, 0xc33c0003, 0xc23e0003, 0xc1400003, 0xc0420003, + 0xa5440003, 0xa4460003, 0xa3480003, 0xa24a0003, 0xa14c0003, + 0x834e0003, 0x82500003, 0x81520003, 0x80540003, 0x65560003, + 0x007e0403 + }; + u8 i; + + if (low_gain == coex_dm->cur_wl_rx_low_gain_en) + return; + + coex_dm->cur_wl_rx_low_gain_en = low_gain; + + if (coex_dm->cur_wl_rx_low_gain_en) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], Hi-Li Table On!\n"); + for (i = 0; i < ARRAY_SIZE(wl_rx_low_gain_on); i++) + rtw_write32(rtwdev, REG_RX_GAIN_EN, wl_rx_low_gain_on[i]); + + /* set Rx filter corner RCK offset */ + rtw_write_rf(rtwdev, RF_PATH_A, RF_RCKD, 0x2, 0x1); + rtw_write_rf(rtwdev, RF_PATH_A, RF_RCK, 0x3f, 0x3f); + rtw_write_rf(rtwdev, RF_PATH_B, RF_RCKD, 0x2, 0x1); + rtw_write_rf(rtwdev, RF_PATH_B, RF_RCK, 0x3f, 0x3f); + } else { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], Hi-Li Table Off!\n"); + for (i = 0; i < ARRAY_SIZE(wl_rx_low_gain_off); i++) + rtw_write32(rtwdev, 0x81c, wl_rx_low_gain_off[i]); + + /* set Rx filter corner RCK offset */ + rtw_write_rf(rtwdev, RF_PATH_A, RF_RCK, 0x3f, 0x4); + rtw_write_rf(rtwdev, RF_PATH_A, RF_RCKD, 0x2, 0x0); + rtw_write_rf(rtwdev, RF_PATH_B, RF_RCK, 0x3f, 0x4); + rtw_write_rf(rtwdev, RF_PATH_B, RF_RCKD, 0x2, 0x0); + } +} + +static void rtw8822b_txagc_swing_offset(struct rtw_dev *rtwdev, u8 path, + u8 tx_pwr_idx_offset, + s8 *txagc_idx, u8 *swing_idx) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s8 delta_pwr_idx = dm_info->delta_power_index[path]; + u8 swing_upper_bound = dm_info->default_ofdm_index + 10; + u8 swing_lower_bound = 0; + u8 max_tx_pwr_idx_offset = 0xf; + s8 agc_index = 0; + u8 swing_index = dm_info->default_ofdm_index; + + tx_pwr_idx_offset = min_t(u8, tx_pwr_idx_offset, max_tx_pwr_idx_offset); + + if (delta_pwr_idx >= 0) { + if (delta_pwr_idx <= tx_pwr_idx_offset) { + agc_index = delta_pwr_idx; + swing_index = dm_info->default_ofdm_index; + } else if (delta_pwr_idx > tx_pwr_idx_offset) { + agc_index = tx_pwr_idx_offset; + swing_index = dm_info->default_ofdm_index + + delta_pwr_idx - tx_pwr_idx_offset; + swing_index = min_t(u8, swing_index, swing_upper_bound); + } + } else { + if (dm_info->default_ofdm_index > abs(delta_pwr_idx)) + swing_index = + dm_info->default_ofdm_index + delta_pwr_idx; + else + swing_index = swing_lower_bound; + swing_index = max_t(u8, swing_index, swing_lower_bound); + + agc_index = 0; + } + + if (swing_index >= RTW_TXSCALE_SIZE) { + rtw_warn(rtwdev, "swing index overflow\n"); + swing_index = RTW_TXSCALE_SIZE - 1; + } + *txagc_idx = agc_index; + *swing_idx = swing_index; +} + +static void rtw8822b_pwrtrack_set_pwr(struct rtw_dev *rtwdev, u8 path, + u8 pwr_idx_offset) +{ + s8 txagc_idx; + u8 swing_idx; + u32 reg1, reg2; + + if (path == RF_PATH_A) { + reg1 = 0xc94; + reg2 = 0xc1c; + } else if (path == RF_PATH_B) { + reg1 = 0xe94; + reg2 = 0xe1c; + } else { + return; + } + + rtw8822b_txagc_swing_offset(rtwdev, path, pwr_idx_offset, + &txagc_idx, &swing_idx); + rtw_write32_mask(rtwdev, reg1, GENMASK(29, 25), txagc_idx); + rtw_write32_mask(rtwdev, reg2, GENMASK(31, 21), + rtw8822b_txscale_tbl[swing_idx]); +} + +static void rtw8822b_pwrtrack_set(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 pwr_idx_offset, tx_pwr_idx; + u8 channel = rtwdev->hal.current_channel; + u8 band_width = rtwdev->hal.current_band_width; + u8 regd = rtw_regd_get(rtwdev); + u8 tx_rate = dm_info->tx_rate; + u8 max_pwr_idx = rtwdev->chip->max_power_index; + + tx_pwr_idx = rtw_phy_get_tx_power_index(rtwdev, path, tx_rate, + band_width, channel, regd); + + tx_pwr_idx = min_t(u8, tx_pwr_idx, max_pwr_idx); + + pwr_idx_offset = max_pwr_idx - tx_pwr_idx; + + rtw8822b_pwrtrack_set_pwr(rtwdev, path, pwr_idx_offset); +} + +static void rtw8822b_phy_pwrtrack_path(struct rtw_dev *rtwdev, + struct rtw_swing_table *swing_table, + u8 path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 power_idx_cur, power_idx_last; + u8 delta; + + /* 8822B only has one thermal meter at PATH A */ + delta = rtw_phy_pwrtrack_get_delta(rtwdev, RF_PATH_A); + + power_idx_last = dm_info->delta_power_index[path]; + power_idx_cur = rtw_phy_pwrtrack_get_pwridx(rtwdev, swing_table, + path, RF_PATH_A, delta); + + /* if delta of power indexes are the same, just skip */ + if (power_idx_cur == power_idx_last) + return; + + dm_info->delta_power_index[path] = power_idx_cur; + rtw8822b_pwrtrack_set(rtwdev, path); +} + +static void rtw8822b_phy_pwrtrack(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_swing_table swing_table; + u8 thermal_value, path; + + rtw_phy_config_swing_table(rtwdev, &swing_table); + + if (rtwdev->efuse.thermal_meter[RF_PATH_A] == 0xff) + return; + + thermal_value = rtw_read_rf(rtwdev, RF_PATH_A, RF_T_METER, 0xfc00); + + rtw_phy_pwrtrack_avg(rtwdev, thermal_value, RF_PATH_A); + + if (dm_info->pwr_trk_init_trigger) + dm_info->pwr_trk_init_trigger = false; + else if (!rtw_phy_pwrtrack_thermal_changed(rtwdev, thermal_value, + RF_PATH_A)) + goto iqk; + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) + rtw8822b_phy_pwrtrack_path(rtwdev, &swing_table, path); + +iqk: + if (rtw_phy_pwrtrack_need_iqk(rtwdev)) + rtw8822b_do_iqk(rtwdev); +} + +static void rtw8822b_pwr_track(struct rtw_dev *rtwdev) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + if (efuse->power_track_type != 0) + return; + + if (!dm_info->pwr_trk_triggered) { + rtw_write_rf(rtwdev, RF_PATH_A, RF_T_METER, + GENMASK(17, 16), 0x03); + dm_info->pwr_trk_triggered = true; + return; + } + + rtw8822b_phy_pwrtrack(rtwdev); + dm_info->pwr_trk_triggered = false; +} + +static void rtw8822b_bf_config_bfee_su(struct rtw_dev *rtwdev, + struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable) +{ + if (enable) + rtw_bf_enable_bfee_su(rtwdev, vif, bfee); + else + rtw_bf_remove_bfee_su(rtwdev, bfee); +} + +static void rtw8822b_bf_config_bfee_mu(struct rtw_dev *rtwdev, + struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable) +{ + if (enable) + rtw_bf_enable_bfee_mu(rtwdev, vif, bfee); + else + rtw_bf_remove_bfee_mu(rtwdev, bfee); +} + +static void rtw8822b_bf_config_bfee(struct rtw_dev *rtwdev, struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable) +{ + if (bfee->role == RTW_BFEE_SU) + rtw8822b_bf_config_bfee_su(rtwdev, vif, bfee, enable); + else if (bfee->role == RTW_BFEE_MU) + rtw8822b_bf_config_bfee_mu(rtwdev, vif, bfee, enable); + else + rtw_warn(rtwdev, "wrong bfee role\n"); +} + +static void rtw8822b_adaptivity_init(struct rtw_dev *rtwdev) +{ + rtw_phy_set_edcca_th(rtwdev, RTW8822B_EDCCA_MAX, RTW8822B_EDCCA_MAX); + + /* mac edcca state setting */ + rtw_write32_clr(rtwdev, REG_TX_PTCL_CTRL, BIT_DIS_EDCCA); + rtw_write32_set(rtwdev, REG_RD_CTRL, BIT_EDCCA_MSK_CNTDOWN_EN); + rtw_write32_mask(rtwdev, REG_EDCCA_SOURCE, BIT_SOURCE_OPTION, + RTW8822B_EDCCA_SRC_DEF); + rtw_write32_mask(rtwdev, REG_EDCCA_POW_MA, BIT_MA_LEVEL, 0); + + /* edcca decision opt */ + rtw_write32_set(rtwdev, REG_EDCCA_DECISION, BIT_EDCCA_OPTION); +} + +static void rtw8822b_adaptivity(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s8 l2h, h2l; + u8 igi; + + igi = dm_info->igi_history[0]; + if (dm_info->edcca_mode == RTW_EDCCA_NORMAL) { + l2h = max_t(s8, igi + EDCCA_IGI_L2H_DIFF, EDCCA_TH_L2H_LB); + h2l = l2h - EDCCA_L2H_H2L_DIFF_NORMAL; + } else { + l2h = min_t(s8, igi, dm_info->l2h_th_ini); + h2l = l2h - EDCCA_L2H_H2L_DIFF; + } + + rtw_phy_set_edcca_th(rtwdev, l2h, h2l); +} + +static void rtw8822b_fill_txdesc_checksum(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *txdesc) +{ + size_t words = 32 / 2; /* calculate the first 32 bytes (16 words) */ + + fill_txdesc_checksum_common(txdesc, words); +} + +static const struct rtw_pwr_seq_cmd trans_carddis_to_cardemu_8822b[] = { + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_POLLING, BIT(1), BIT(1)}, + {0x004A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3) | BIT(4) | BIT(7), 0}, + {0x0300, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x0301, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_cardemu_to_act_8822b[] = { + {0x0012, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0012, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0020, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0001, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_DELAY, 1, RTW_PWR_DELAY_MS}, + {0x0000, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3) | BIT(2)), 0}, + {0x0075, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(1), BIT(1)}, + {0x0075, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0xFF1A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3)), 0}, + {0x10C3, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(0), 0}, + {0x0020, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3), BIT(3)}, + {0x10A8, + RTW_PWR_CUT_C_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x10A9, + RTW_PWR_CUT_C_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0xef}, + {0x10AA, + RTW_PWR_CUT_C_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x0c}, + {0x0068, + RTW_PWR_CUT_C_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(4), BIT(4)}, + {0x0029, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0xF9}, + {0x0024, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), 0}, + {0x0074, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), BIT(5)}, + {0x00AF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), BIT(5)}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_act_to_cardemu_8822b[] = { + {0x0003, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), 0}, + {0x0093, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3), 0}, + {0x001F, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x00EF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0xFF1A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x30}, + {0x0049, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0002, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x10C3, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), BIT(1)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(1), 0}, + {0x0020, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3), 0}, + {0x0000, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), BIT(5)}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_cardemu_to_carddis_8822b[] = { + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7), BIT(7)}, + {0x0007, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x20}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), BIT(2)}, + {0x004A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), 0}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(4), 0}, + {0x004F, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0046, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(6), BIT(6)}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), 0}, + {0x0046, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7), BIT(7)}, + {0x0062, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(4), BIT(4)}, + {0x0081, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7) | BIT(6), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3)}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_POLLING, BIT(1), 0}, + {0x0090, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0044, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x0040, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, 0xFF, 0x90}, + {0x0041, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, 0xFF, 0x00}, + {0x0042, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, 0xFF, 0x04}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd *card_enable_flow_8822b[] = { + trans_carddis_to_cardemu_8822b, + trans_cardemu_to_act_8822b, + NULL +}; + +static const struct rtw_pwr_seq_cmd *card_disable_flow_8822b[] = { + trans_act_to_cardemu_8822b, + trans_cardemu_to_carddis_8822b, + NULL +}; + +static const struct rtw_intf_phy_para usb2_param_8822b[] = { + {0xFFFF, 0x00, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para usb3_param_8822b[] = { + {0x0001, 0xA841, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_D, + RTW_INTF_PHY_PLATFORM_ALL}, + {0xFFFF, 0x0000, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para pcie_gen1_param_8822b[] = { + {0x0001, 0xA841, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0002, 0x60C6, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0008, 0x3596, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0009, 0x321C, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x000A, 0x9623, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0020, 0x94FF, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0021, 0xFFCF, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0026, 0xC006, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0029, 0xFF0E, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x002A, 0x1840, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0xFFFF, 0x0000, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para pcie_gen2_param_8822b[] = { + {0x0001, 0xA841, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0002, 0x60C6, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0008, 0x3597, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0009, 0x321C, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x000A, 0x9623, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0020, 0x94FF, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0021, 0xFFCF, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0026, 0xC006, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x0029, 0xFF0E, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0x002A, 0x3040, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_C, + RTW_INTF_PHY_PLATFORM_ALL}, + {0xFFFF, 0x0000, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para_table phy_para_table_8822b = { + .usb2_para = usb2_param_8822b, + .usb3_para = usb3_param_8822b, + .gen1_para = pcie_gen1_param_8822b, + .gen2_para = pcie_gen2_param_8822b, + .n_usb2_para = ARRAY_SIZE(usb2_param_8822b), + .n_usb3_para = ARRAY_SIZE(usb2_param_8822b), + .n_gen1_para = ARRAY_SIZE(pcie_gen1_param_8822b), + .n_gen2_para = ARRAY_SIZE(pcie_gen2_param_8822b), +}; + +static const struct rtw_rfe_def rtw8822b_rfe_defs[] = { + [2] = RTW_DEF_RFE(8822b, 2, 2), + [3] = RTW_DEF_RFE(8822b, 3, 0), + [5] = RTW_DEF_RFE(8822b, 5, 5), +}; + +static const struct rtw_hw_reg rtw8822b_dig[] = { + [0] = { .addr = 0xc50, .mask = 0x7f }, + [1] = { .addr = 0xe50, .mask = 0x7f }, +}; + +static const struct rtw_ltecoex_addr rtw8822b_ltecoex_addr = { + .ctrl = LTECOEX_ACCESS_CTRL, + .wdata = LTECOEX_WRITE_DATA, + .rdata = LTECOEX_READ_DATA, +}; + +static const struct rtw_page_table page_table_8822b[] = { + {64, 64, 64, 64, 1}, + {64, 64, 64, 64, 1}, + {64, 64, 0, 0, 1}, + {64, 64, 64, 0, 1}, + {64, 64, 64, 64, 1}, +}; + +static const struct rtw_rqpn rqpn_table_8822b[] = { + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_HIGH, + RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, +}; + +static struct rtw_prioq_addrs prioq_addrs_8822b = { + .prio[RTW_DMA_MAPPING_EXTRA] = { + .rsvd = REG_FIFOPAGE_INFO_4, .avail = REG_FIFOPAGE_INFO_4 + 2, + }, + .prio[RTW_DMA_MAPPING_LOW] = { + .rsvd = REG_FIFOPAGE_INFO_2, .avail = REG_FIFOPAGE_INFO_2 + 2, + }, + .prio[RTW_DMA_MAPPING_NORMAL] = { + .rsvd = REG_FIFOPAGE_INFO_3, .avail = REG_FIFOPAGE_INFO_3 + 2, + }, + .prio[RTW_DMA_MAPPING_HIGH] = { + .rsvd = REG_FIFOPAGE_INFO_1, .avail = REG_FIFOPAGE_INFO_1 + 2, + }, + .wsize = true, +}; + +static struct rtw_chip_ops rtw8822b_ops = { + .phy_set_param = rtw8822b_phy_set_param, + .read_efuse = rtw8822b_read_efuse, + .query_rx_desc = rtw8822b_query_rx_desc, + .set_channel = rtw8822b_set_channel, + .mac_init = rtw8822b_mac_init, + .read_rf = rtw_phy_read_rf, + .write_rf = rtw_phy_write_rf_reg_sipi, + .set_tx_power_index = rtw8822b_set_tx_power_index, + .set_antenna = rtw8822b_set_antenna, + .cfg_ldo25 = rtw8822b_cfg_ldo25, + .false_alarm_statistics = rtw8822b_false_alarm_statistics, + .phy_calibration = rtw8822b_phy_calibration, + .pwr_track = rtw8822b_pwr_track, + .config_bfee = rtw8822b_bf_config_bfee, + .set_gid_table = rtw_bf_set_gid_table, + .cfg_csi_rate = rtw_bf_cfg_csi_rate, + .adaptivity_init = rtw8822b_adaptivity_init, + .adaptivity = rtw8822b_adaptivity, + .fill_txdesc_checksum = rtw8822b_fill_txdesc_checksum, + + .coex_set_init = rtw8822b_coex_cfg_init, + .coex_set_ant_switch = rtw8822b_coex_cfg_ant_switch, + .coex_set_gnt_fix = rtw8822b_coex_cfg_gnt_fix, + .coex_set_gnt_debug = rtw8822b_coex_cfg_gnt_debug, + .coex_set_rfe_type = rtw8822b_coex_cfg_rfe_type, + .coex_set_wl_tx_power = rtw8822b_coex_cfg_wl_tx_power, + .coex_set_wl_rx_gain = rtw8822b_coex_cfg_wl_rx_gain, +}; + +/* Shared-Antenna Coex Table */ +static const struct coex_table_para table_sant_8822b[] = { + {0xffffffff, 0xffffffff}, /* case-0 */ + {0x55555555, 0x55555555}, + {0x66555555, 0x66555555}, + {0xaaaaaaaa, 0xaaaaaaaa}, + {0x5a5a5a5a, 0x5a5a5a5a}, + {0xfafafafa, 0xfafafafa}, /* case-5 */ + {0x6a5a5555, 0xaaaaaaaa}, + {0x6a5a56aa, 0x6a5a56aa}, + {0x6a5a5a5a, 0x6a5a5a5a}, + {0x66555555, 0x5a5a5a5a}, + {0x66555555, 0x6a5a5a5a}, /* case-10 */ + {0x66555555, 0xfafafafa}, + {0x66555555, 0x5a5a5aaa}, + {0x66555555, 0x6aaa5aaa}, + {0x66555555, 0xaaaa5aaa}, + {0x66555555, 0xaaaaaaaa}, /* case-15 */ + {0xffff55ff, 0xfafafafa}, + {0xffff55ff, 0x6afa5afa}, + {0xaaffffaa, 0xfafafafa}, + {0xaa5555aa, 0x5a5a5a5a}, + {0xaa5555aa, 0x6a5a5a5a}, /* case-20 */ + {0xaa5555aa, 0xaaaaaaaa}, + {0xffffffff, 0x5a5a5a5a}, + {0xffffffff, 0x5a5a5a5a}, + {0xffffffff, 0x55555555}, + {0xffffffff, 0x6a5a5aaa}, /* case-25 */ + {0x55555555, 0x5a5a5a5a}, + {0x55555555, 0xaaaaaaaa}, + {0x55555555, 0x6a5a6a5a}, + {0x66556655, 0x66556655}, + {0x66556aaa, 0x6a5a6aaa}, /* case-30 */ + {0xffffffff, 0x5aaa5aaa}, + {0x56555555, 0x5a5a5aaa}, +}; + +/* Non-Shared-Antenna Coex Table */ +static const struct coex_table_para table_nsant_8822b[] = { + {0xffffffff, 0xffffffff}, /* case-100 */ + {0x55555555, 0x55555555}, + {0x66555555, 0x66555555}, + {0xaaaaaaaa, 0xaaaaaaaa}, + {0x5a5a5a5a, 0x5a5a5a5a}, + {0xfafafafa, 0xfafafafa}, /* case-105 */ + {0x5afa5afa, 0x5afa5afa}, + {0x55555555, 0xfafafafa}, + {0x66555555, 0xfafafafa}, + {0x66555555, 0x5a5a5a5a}, + {0x66555555, 0x6a5a5a5a}, /* case-110 */ + {0x66555555, 0xaaaaaaaa}, + {0xffff55ff, 0xfafafafa}, + {0xffff55ff, 0x5afa5afa}, + {0xffff55ff, 0xaaaaaaaa}, + {0xffff55ff, 0xffff55ff}, /* case-115 */ + {0xaaffffaa, 0x5afa5afa}, + {0xaaffffaa, 0xaaaaaaaa}, + {0xffffffff, 0xfafafafa}, + {0xffffffff, 0x5afa5afa}, + {0xffffffff, 0xaaaaaaaa}, /* case-120 */ + {0x55ff55ff, 0x5afa5afa}, + {0x55ff55ff, 0xaaaaaaaa}, + {0x55ff55ff, 0x55ff55ff} +}; + +/* Shared-Antenna TDMA */ +static const struct coex_tdma_para tdma_sant_8822b[] = { + { {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-0 */ + { {0x61, 0x45, 0x03, 0x11, 0x11} }, + { {0x61, 0x3a, 0x03, 0x11, 0x11} }, + { {0x61, 0x30, 0x03, 0x11, 0x11} }, + { {0x61, 0x20, 0x03, 0x11, 0x11} }, + { {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-5 */ + { {0x61, 0x45, 0x03, 0x11, 0x10} }, + { {0x61, 0x3a, 0x03, 0x11, 0x10} }, + { {0x61, 0x30, 0x03, 0x11, 0x10} }, + { {0x61, 0x20, 0x03, 0x11, 0x10} }, + { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-10 */ + { {0x61, 0x08, 0x03, 0x11, 0x14} }, + { {0x61, 0x08, 0x03, 0x10, 0x14} }, + { {0x51, 0x08, 0x03, 0x10, 0x54} }, + { {0x51, 0x08, 0x03, 0x10, 0x55} }, + { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-15 */ + { {0x51, 0x45, 0x03, 0x10, 0x50} }, + { {0x51, 0x3a, 0x03, 0x10, 0x50} }, + { {0x51, 0x30, 0x03, 0x10, 0x50} }, + { {0x51, 0x20, 0x03, 0x10, 0x50} }, + { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-20 */ + { {0x51, 0x4a, 0x03, 0x10, 0x50} }, + { {0x51, 0x0c, 0x03, 0x10, 0x54} }, + { {0x55, 0x08, 0x03, 0x10, 0x54} }, + { {0x65, 0x10, 0x03, 0x11, 0x10} }, + { {0x51, 0x10, 0x03, 0x10, 0x51} }, /* case-25 */ + { {0x51, 0x08, 0x03, 0x10, 0x50} }, + { {0x61, 0x08, 0x03, 0x11, 0x11} } +}; + +/* Non-Shared-Antenna TDMA */ +static const struct coex_tdma_para tdma_nsant_8822b[] = { + { {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-100 */ + { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-101 */ + { {0x61, 0x3a, 0x03, 0x11, 0x11} }, + { {0x61, 0x30, 0x03, 0x11, 0x11} }, + { {0x61, 0x20, 0x03, 0x11, 0x11} }, + { {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-105 */ + { {0x61, 0x45, 0x03, 0x11, 0x10} }, + { {0x61, 0x3a, 0x03, 0x11, 0x10} }, + { {0x61, 0x30, 0x03, 0x11, 0x10} }, + { {0x61, 0x20, 0x03, 0x11, 0x10} }, + { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-110 */ + { {0x61, 0x08, 0x03, 0x11, 0x14} }, + { {0x61, 0x08, 0x03, 0x10, 0x14} }, + { {0x51, 0x08, 0x03, 0x10, 0x54} }, + { {0x51, 0x08, 0x03, 0x10, 0x55} }, + { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-115 */ + { {0x51, 0x45, 0x03, 0x10, 0x50} }, + { {0x51, 0x3a, 0x03, 0x10, 0x50} }, + { {0x51, 0x30, 0x03, 0x10, 0x50} }, + { {0x51, 0x20, 0x03, 0x10, 0x50} }, + { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-120 */ + { {0x51, 0x08, 0x03, 0x10, 0x50} } +}; + +/* rssi in percentage % (dbm = % - 100) */ +static const u8 wl_rssi_step_8822b[] = {60, 50, 44, 30}; +static const u8 bt_rssi_step_8822b[] = {30, 30, 30, 30}; + +/* wl_tx_dec_power, bt_tx_dec_power, wl_rx_gain, bt_rx_lna_constrain */ +static const struct coex_rf_para rf_para_tx_8822b[] = { + {0, 0, false, 7}, /* for normal */ + {0, 16, false, 7}, /* for WL-CPT */ + {4, 0, true, 1}, + {3, 6, true, 1}, + {2, 9, true, 1}, + {1, 13, true, 1} +}; + +static const struct coex_rf_para rf_para_rx_8822b[] = { + {0, 0, false, 7}, /* for normal */ + {0, 16, false, 7}, /* for WL-CPT */ + {4, 0, true, 1}, + {3, 6, true, 1}, + {2, 9, true, 1}, + {1, 13, true, 1} +}; + +static const struct coex_5g_afh_map afh_5g_8822b[] = { + {120, 2, 4}, + {124, 8, 8}, + {128, 17, 8}, + {132, 26, 10}, + {136, 34, 8}, + {140, 42, 10}, + {144, 51, 8}, + {149, 62, 8}, + {153, 71, 10}, + {157, 77, 4}, + {118, 2, 4}, + {126, 12, 16}, + {134, 29, 16}, + {142, 46, 16}, + {151, 66, 16}, + {159, 76, 4}, + {122, 10, 20}, + {138, 37, 34}, + {155, 68, 20} +}; +static_assert(ARRAY_SIZE(rf_para_tx_8822b) == ARRAY_SIZE(rf_para_rx_8822b)); + +static const u8 +rtw8822b_pwrtrk_5gb_n[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = { + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, + 15, 16, 17, 17, 18, 19, 20, 20, 21, 22 }, + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, + 15, 16, 17, 17, 18, 19, 20, 20, 21, 22 }, + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, + 15, 16, 17, 17, 18, 19, 20, 20, 21, 22 }, +}; + +static const u8 +rtw8822b_pwrtrk_5gb_p[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = { + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 9, 9, 10, 11, 12, 13, 14, 14, 15, + 16, 17, 18, 19, 19, 20, 21, 22, 22, 23 }, + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 9, 9, 10, 11, 12, 13, 14, 14, 15, + 16, 17, 18, 19, 19, 20, 21, 22, 22, 23 }, + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 9, 9, 10, 11, 12, 13, 14, 14, 15, + 16, 17, 18, 19, 19, 20, 21, 22, 22, 23 }, +}; + +static const u8 +rtw8822b_pwrtrk_5ga_n[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = { + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, + 15, 16, 17, 17, 18, 19, 20, 20, 21, 22 }, + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, + 15, 16, 17, 17, 18, 19, 20, 20, 21, 22 }, + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, + 15, 16, 17, 17, 18, 19, 20, 20, 21, 22 }, +}; + +static const u8 +rtw8822b_pwrtrk_5ga_p[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = { + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 9, 9, 10, 11, 12, 13, 14, 14, 15, + 16, 17, 18, 19, 19, 20, 21, 22, 22, 23}, + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 9, 9, 10, 11, 12, 13, 14, 14, 15, + 16, 17, 18, 19, 19, 20, 21, 22, 22, 23}, + { 0, 1, 2, 2, 3, 4, 5, 5, 6, 7, + 8, 9, 9, 10, 11, 12, 13, 14, 14, 15, + 16, 17, 18, 19, 19, 20, 21, 22, 22, 23}, +}; + +static const u8 rtw8822b_pwrtrk_2gb_n[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 1, 1, 2, 2, 3, 3, 3, 4, + 4, 5, 5, 5, 6, 6, 7, 7, 7, 8, + 8, 9, 9, 9, 10, 10, 11, 11, 11, 12 +}; + +static const u8 rtw8822b_pwrtrk_2gb_p[RTW_PWR_TRK_TBL_SZ] = { + 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, + 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, + 9, 10, 10, 11, 11, 12, 12, 12, 13, 13 +}; + +static const u8 rtw8822b_pwrtrk_2ga_n[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 1, 1, 2, 2, 3, 3, 3, 4, + 4, 5, 5, 5, 6, 6, 7, 7, 7, 8, + 8, 9, 9, 9, 10, 10, 11, 11, 11, 12 +}; + +static const u8 rtw8822b_pwrtrk_2ga_p[RTW_PWR_TRK_TBL_SZ] = { + 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, 13, 13, 14, 14, 15 +}; + +static const u8 rtw8822b_pwrtrk_2g_cck_b_n[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 1, 1, 2, 2, 3, 3, 3, 4, + 4, 5, 5, 5, 6, 6, 7, 7, 7, 8, + 8, 9, 9, 9, 10, 10, 11, 11, 11, 12 +}; + +static const u8 rtw8822b_pwrtrk_2g_cck_b_p[RTW_PWR_TRK_TBL_SZ] = { + 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, + 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, + 9, 10, 10, 11, 11, 12, 12, 12, 13, 13 +}; + +static const u8 rtw8822b_pwrtrk_2g_cck_a_n[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 1, 1, 2, 2, 3, 3, 3, 4, + 4, 5, 5, 5, 6, 6, 7, 7, 7, 8, + 8, 9, 9, 9, 10, 10, 11, 11, 11, 12 +}; + +static const u8 rtw8822b_pwrtrk_2g_cck_a_p[RTW_PWR_TRK_TBL_SZ] = { + 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, 13, 13, 14, 14, 15 +}; + +static const struct rtw_pwr_track_tbl rtw8822b_rtw_pwr_track_tbl = { + .pwrtrk_5gb_n[RTW_PWR_TRK_5G_1] = rtw8822b_pwrtrk_5gb_n[RTW_PWR_TRK_5G_1], + .pwrtrk_5gb_n[RTW_PWR_TRK_5G_2] = rtw8822b_pwrtrk_5gb_n[RTW_PWR_TRK_5G_2], + .pwrtrk_5gb_n[RTW_PWR_TRK_5G_3] = rtw8822b_pwrtrk_5gb_n[RTW_PWR_TRK_5G_3], + .pwrtrk_5gb_p[RTW_PWR_TRK_5G_1] = rtw8822b_pwrtrk_5gb_p[RTW_PWR_TRK_5G_1], + .pwrtrk_5gb_p[RTW_PWR_TRK_5G_2] = rtw8822b_pwrtrk_5gb_p[RTW_PWR_TRK_5G_2], + .pwrtrk_5gb_p[RTW_PWR_TRK_5G_3] = rtw8822b_pwrtrk_5gb_p[RTW_PWR_TRK_5G_3], + .pwrtrk_5ga_n[RTW_PWR_TRK_5G_1] = rtw8822b_pwrtrk_5ga_n[RTW_PWR_TRK_5G_1], + .pwrtrk_5ga_n[RTW_PWR_TRK_5G_2] = rtw8822b_pwrtrk_5ga_n[RTW_PWR_TRK_5G_2], + .pwrtrk_5ga_n[RTW_PWR_TRK_5G_3] = rtw8822b_pwrtrk_5ga_n[RTW_PWR_TRK_5G_3], + .pwrtrk_5ga_p[RTW_PWR_TRK_5G_1] = rtw8822b_pwrtrk_5ga_p[RTW_PWR_TRK_5G_1], + .pwrtrk_5ga_p[RTW_PWR_TRK_5G_2] = rtw8822b_pwrtrk_5ga_p[RTW_PWR_TRK_5G_2], + .pwrtrk_5ga_p[RTW_PWR_TRK_5G_3] = rtw8822b_pwrtrk_5ga_p[RTW_PWR_TRK_5G_3], + .pwrtrk_2gb_n = rtw8822b_pwrtrk_2gb_n, + .pwrtrk_2gb_p = rtw8822b_pwrtrk_2gb_p, + .pwrtrk_2ga_n = rtw8822b_pwrtrk_2ga_n, + .pwrtrk_2ga_p = rtw8822b_pwrtrk_2ga_p, + .pwrtrk_2g_cckb_n = rtw8822b_pwrtrk_2g_cck_b_n, + .pwrtrk_2g_cckb_p = rtw8822b_pwrtrk_2g_cck_b_p, + .pwrtrk_2g_ccka_n = rtw8822b_pwrtrk_2g_cck_a_n, + .pwrtrk_2g_ccka_p = rtw8822b_pwrtrk_2g_cck_a_p, +}; + +static const struct rtw_reg_domain coex_info_hw_regs_8822b[] = { + {0xcb0, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0xcb4, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0xcba, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0xcbd, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0xc58, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0xcbd, BIT(0), RTW_REG_DOMAIN_MAC8}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x430, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x434, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x42a, MASKLWORD, RTW_REG_DOMAIN_MAC16}, + {0x426, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0x45e, BIT(3), RTW_REG_DOMAIN_MAC8}, + {0x454, MASKLWORD, RTW_REG_DOMAIN_MAC16}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x4c, BIT(24) | BIT(23), RTW_REG_DOMAIN_MAC32}, + {0x64, BIT(0), RTW_REG_DOMAIN_MAC8}, + {0x4c6, BIT(4), RTW_REG_DOMAIN_MAC8}, + {0x40, BIT(5), RTW_REG_DOMAIN_MAC8}, + {0x1, RFREG_MASK, RTW_REG_DOMAIN_RF_B}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x550, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x522, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0x953, BIT(1), RTW_REG_DOMAIN_MAC8}, + {0xc50, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, +}; + +static struct rtw_hw_reg_offset rtw8822b_edcca_th[] = { + [EDCCA_TH_L2H_IDX] = {{.addr = 0x8a4, .mask = MASKBYTE0}, .offset = 0}, + [EDCCA_TH_H2L_IDX] = {{.addr = 0x8a4, .mask = MASKBYTE1}, .offset = 0}, +}; + +const struct rtw_chip_info rtw8822b_hw_spec = { + .ops = &rtw8822b_ops, + .id = RTW_CHIP_TYPE_8822B, + .fw_name = "rtw88/rtw8822b_fw.bin", + .wlan_cpu = RTW_WCPU_11AC, + .tx_pkt_desc_sz = 48, + .tx_buf_desc_sz = 16, + .rx_pkt_desc_sz = 24, + .rx_buf_desc_sz = 8, + .phy_efuse_size = 1024, + .log_efuse_size = 768, + .ptct_efuse_size = 96, + .txff_size = 262144, + .rxff_size = 24576, + .fw_rxff_size = 12288, + .rsvd_drv_pg_num = 8, + .txgi_factor = 1, + .is_pwr_by_rate_dec = true, + .max_power_index = 0x3f, + .csi_buf_pg_num = 0, + .band = RTW_BAND_2G | RTW_BAND_5G, + .page_size = TX_PAGE_SIZE, + .dig_min = 0x1c, + .ht_supported = true, + .vht_supported = true, + .lps_deep_mode_supported = BIT(LPS_DEEP_MODE_LCLK), + .sys_func_en = 0xDC, + .pwr_on_seq = card_enable_flow_8822b, + .pwr_off_seq = card_disable_flow_8822b, + .page_table = page_table_8822b, + .rqpn_table = rqpn_table_8822b, + .prioq_addrs = &prioq_addrs_8822b, + .intf_table = &phy_para_table_8822b, + .dig = rtw8822b_dig, + .dig_cck = NULL, + .rf_base_addr = {0x2800, 0x2c00}, + .rf_sipi_addr = {0xc90, 0xe90}, + .ltecoex_addr = &rtw8822b_ltecoex_addr, + .mac_tbl = &rtw8822b_mac_tbl, + .agc_tbl = &rtw8822b_agc_tbl, + .bb_tbl = &rtw8822b_bb_tbl, + .rf_tbl = {&rtw8822b_rf_a_tbl, &rtw8822b_rf_b_tbl}, + .rfe_defs = rtw8822b_rfe_defs, + .rfe_defs_size = ARRAY_SIZE(rtw8822b_rfe_defs), + .pwr_track_tbl = &rtw8822b_rtw_pwr_track_tbl, + .iqk_threshold = 8, + .bfer_su_max_num = 2, + .bfer_mu_max_num = 1, + .rx_ldpc = true, + .edcca_th = rtw8822b_edcca_th, + .l2h_th_ini_cs = 10 + EDCCA_IGI_BASE, + .l2h_th_ini_ad = -14 + EDCCA_IGI_BASE, + .ampdu_density = IEEE80211_HT_MPDU_DENSITY_2, + .max_scan_ie_len = IEEE80211_MAX_DATA_LEN, + + .coex_para_ver = 0x20070206, + .bt_desired_ver = 0x6, + .scbd_support = true, + .new_scbd10_def = false, + .ble_hid_profile_support = false, + .wl_mimo_ps_support = false, + .pstdma_type = COEX_PSTDMA_FORCE_LPSOFF, + .bt_rssi_type = COEX_BTRSSI_RATIO, + .ant_isolation = 15, + .rssi_tolerance = 2, + .wl_rssi_step = wl_rssi_step_8822b, + .bt_rssi_step = bt_rssi_step_8822b, + .table_sant_num = ARRAY_SIZE(table_sant_8822b), + .table_sant = table_sant_8822b, + .table_nsant_num = ARRAY_SIZE(table_nsant_8822b), + .table_nsant = table_nsant_8822b, + .tdma_sant_num = ARRAY_SIZE(tdma_sant_8822b), + .tdma_sant = tdma_sant_8822b, + .tdma_nsant_num = ARRAY_SIZE(tdma_nsant_8822b), + .tdma_nsant = tdma_nsant_8822b, + .wl_rf_para_num = ARRAY_SIZE(rf_para_tx_8822b), + .wl_rf_para_tx = rf_para_tx_8822b, + .wl_rf_para_rx = rf_para_rx_8822b, + .bt_afh_span_bw20 = 0x24, + .bt_afh_span_bw40 = 0x36, + .afh_5g_num = ARRAY_SIZE(afh_5g_8822b), + .afh_5g = afh_5g_8822b, + + .coex_info_hw_regs_num = ARRAY_SIZE(coex_info_hw_regs_8822b), + .coex_info_hw_regs = coex_info_hw_regs_8822b, + + .fw_fifo_addr = {0x780, 0x700, 0x780, 0x660, 0x650, 0x680}, +}; +EXPORT_SYMBOL(rtw8822b_hw_spec); + +MODULE_FIRMWARE("rtw88/rtw8822b_fw.bin"); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822b driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b.h new file mode 100644 index 0000000000000000000000000000000000000000..2dc3a6660f06a5f3e3bfd45121f9d84b6100301b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b.h @@ -0,0 +1,198 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW8822B_H__ +#define __RTW8822B_H__ + +#include + +#define RCR_VHT_ACK BIT(26) + +struct rtw8822bu_efuse { + u8 res4[4]; /* 0xd0 */ + u8 usb_optional_function; + u8 res5[0x1e]; + u8 res6[2]; + u8 serial[0x0b]; /* 0xf5 */ + u8 vid; /* 0x100 */ + u8 res7; + u8 pid; + u8 res8[4]; + u8 mac_addr[ETH_ALEN]; /* 0x107 */ + u8 res9[2]; + u8 vendor_name[0x07]; + u8 res10[2]; + u8 device_name[0x14]; + u8 res11[0xcf]; + u8 package_type; /* 0x1fb */ + u8 res12[0x4]; +}; + +struct rtw8822be_efuse { + u8 mac_addr[ETH_ALEN]; /* 0xd0 */ + u8 vender_id[2]; + u8 device_id[2]; + u8 sub_vender_id[2]; + u8 sub_device_id[2]; + u8 pmc[2]; + u8 exp_device_cap[2]; + u8 msi_cap; + u8 ltr_cap; /* 0xe3 */ + u8 exp_link_control[2]; + u8 link_cap[4]; + u8 link_control[2]; + u8 serial_number[8]; + u8 res0:2; /* 0xf4 */ + u8 ltr_en:1; + u8 res1:2; + u8 obff:2; + u8 res2:3; + u8 obff_cap:2; + u8 res3:4; + u8 res4[3]; + u8 class_code[3]; + u8 pci_pm_L1_2_supp:1; + u8 pci_pm_L1_1_supp:1; + u8 aspm_pm_L1_2_supp:1; + u8 aspm_pm_L1_1_supp:1; + u8 L1_pm_substates_supp:1; + u8 res5:3; + u8 port_common_mode_restore_time; + u8 port_t_power_on_scale:2; + u8 res6:1; + u8 port_t_power_on_value:5; + u8 res7; +}; + +struct rtw8822bs_efuse { + u8 res4[0x4a]; /* 0xd0 */ + u8 mac_addr[ETH_ALEN]; /* 0x11a */ +} __packed; + +struct rtw8822b_efuse { + __le16 rtl_id; + u8 res0[0x0e]; + + /* power index for four RF paths */ + struct rtw_txpwr_idx txpwr_idx_table[4]; + + u8 channel_plan; /* 0xb8 */ + u8 xtal_k; + u8 thermal_meter; + u8 iqk_lck; + u8 pa_type; /* 0xbc */ + u8 lna_type_2g[2]; /* 0xbd */ + u8 lna_type_5g[2]; + u8 rf_board_option; + u8 rf_feature_option; + u8 rf_bt_setting; + u8 eeprom_version; + u8 eeprom_customer_id; + u8 tx_bb_swing_setting_2g; + u8 tx_bb_swing_setting_5g; + u8 tx_pwr_calibrate_rate; + u8 rf_antenna_option; /* 0xc9 */ + u8 rfe_option; + u8 country_code[2]; + u8 res[3]; + union { + struct rtw8822be_efuse e; + struct rtw8822bu_efuse u; + struct rtw8822bs_efuse s; + }; +}; + +static inline void +_rtw_write32s_mask(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 data) +{ + /* 0xC00-0xCFF and 0xE00-0xEFF have the same layout */ + rtw_write32_mask(rtwdev, addr, mask, data); + rtw_write32_mask(rtwdev, addr + 0x200, mask, data); +} + +#define rtw_write32s_mask(rtwdev, addr, mask, data) \ + do { \ + BUILD_BUG_ON((addr) < 0xC00 || (addr) >= 0xD00); \ + \ + _rtw_write32s_mask(rtwdev, addr, mask, data); \ + } while (0) + +/* phy status page0 */ +#define GET_PHY_STAT_P0_PWDB(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(15, 8)) + +/* phy status page1 */ +#define GET_PHY_STAT_P1_PWDB_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(15, 8)) +#define GET_PHY_STAT_P1_PWDB_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(23, 16)) +#define GET_PHY_STAT_P1_RF_MODE(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x03), GENMASK(29, 28)) +#define GET_PHY_STAT_P1_L_RXSC(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(11, 8)) +#define GET_PHY_STAT_P1_HT_RXSC(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(15, 12)) +#define GET_PHY_STAT_P1_RXEVM_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_RXEVM_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(15, 8)) +#define GET_PHY_STAT_P1_CFO_TAIL_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x05), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_CFO_TAIL_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x05), GENMASK(15, 8)) +#define GET_PHY_STAT_P1_RXSNR_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x06), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_RXSNR_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x06), GENMASK(15, 8)) + +#define RTW8822B_EDCCA_MAX 0x7f +#define RTW8822B_EDCCA_SRC_DEF 1 +#define REG_HTSTFWT 0x800 +#define REG_RXPSEL 0x808 +#define BIT_RX_PSEL_RST (BIT(28) | BIT(29)) +#define REG_TXPSEL 0x80c +#define REG_RXCCAMSK 0x814 +#define REG_CCASEL 0x82c +#define REG_PDMFTH 0x830 +#define REG_CCA2ND 0x838 +#define REG_L1WT 0x83c +#define REG_L1PKWT 0x840 +#define REG_MRC 0x850 +#define REG_CLKTRK 0x860 +#define REG_EDCCA_POW_MA 0x8a0 +#define BIT_MA_LEVEL GENMASK(1, 0) +#define REG_ADCCLK 0x8ac +#define REG_ADC160 0x8c4 +#define REG_ADC40 0x8c8 +#define REG_EDCCA_DECISION 0x8dc +#define BIT_EDCCA_OPTION BIT(5) +#define REG_CDDTXP 0x93c +#define REG_TXPSEL1 0x940 +#define REG_EDCCA_SOURCE 0x944 +#define BIT_SOURCE_OPTION GENMASK(29, 28) +#define REG_ACBB0 0x948 +#define REG_ACBBRXFIR 0x94c +#define REG_ACGG2TBL 0x958 +#define REG_RXSB 0xa00 +#define REG_ADCINI 0xa04 +#define REG_TXSF2 0xa24 +#define REG_TXSF6 0xa28 +#define REG_RXDESC 0xa2c +#define REG_ENTXCCK 0xa80 +#define REG_AGCTR_A 0xc08 +#define REG_TXDFIR 0xc20 +#define REG_RXIGI_A 0xc50 +#define REG_TRSW 0xca0 +#define REG_RFESEL0 0xcb0 +#define REG_RFESEL8 0xcb4 +#define REG_RFECTL 0xcb8 +#define REG_RFEINV 0xcbc +#define REG_AGCTR_B 0xe08 +#define REG_RXIGI_B 0xe50 +#define REG_ANTWT 0x1904 +#define REG_IQKFAILMSK 0x1bf0 + +extern const struct rtw_chip_info rtw8822b_hw_spec; + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b_table.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b_table.c new file mode 100644 index 0000000000000000000000000000000000000000..b9010b111a134f71b0ac35f1dd71fc7a890e5950 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b_table.c @@ -0,0 +1,22204 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "phy.h" +#include "rtw8822b_table.h" + +static const u32 rtw8822b_mac[] = { + 0x029, 0x000000F9, + 0x420, 0x00000080, + 0x421, 0x0000001F, + 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, 0x000000F0, + 0x446, 0x00000001, + 0x447, 0x000000FE, + 0x448, 0x00000000, + 0x449, 0x00000000, + 0x44A, 0x00000000, + 0x44B, 0x00000040, + 0x44C, 0x00000010, + 0x44D, 0x000000F0, + 0x44E, 0x0000003F, + 0x44F, 0x00000000, + 0x450, 0x00000000, + 0x451, 0x00000000, + 0x452, 0x00000000, + 0x453, 0x00000040, + 0x455, 0x00000070, + 0x45E, 0x00000004, + 0x49C, 0x00000010, + 0x49D, 0x000000F0, + 0x49E, 0x00000000, + 0x49F, 0x00000006, + 0x4A0, 0x000000E0, + 0x4A1, 0x00000003, + 0x4A2, 0x00000000, + 0x4A3, 0x00000040, + 0x4A4, 0x00000015, + 0x4A5, 0x000000F0, + 0x4A6, 0x00000000, + 0x4A7, 0x00000006, + 0x4A8, 0x000000E0, + 0x4A9, 0x00000000, + 0x4AA, 0x00000000, + 0x4AB, 0x00000000, + 0x7DA, 0x00000008, + 0x1448, 0x00000006, + 0x144A, 0x00000006, + 0x144C, 0x00000006, + 0x144E, 0x00000006, + 0x4C8, 0x000000FF, + 0x4C9, 0x00000008, + 0x4CA, 0x00000020, + 0x4CB, 0x00000020, + 0x4CC, 0x000000FF, + 0x4CD, 0x000000FF, + 0x4CE, 0x00000001, + 0x4CF, 0x00000008, + 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, + 0x521, 0x0000002F, + 0x525, 0x0000004F, + 0x551, 0x00000010, + 0x559, 0x00000002, + 0x55C, 0x00000050, + 0x55D, 0x000000FF, + 0x577, 0x0000000B, + 0x5BE, 0x00000064, + 0x605, 0x00000030, + 0x608, 0x0000000E, + 0x609, 0x00000022, + 0x60C, 0x00000018, + 0x6A0, 0x000000FF, + 0x6A1, 0x000000FF, + 0x6A2, 0x000000FF, + 0x6A3, 0x000000FF, + 0x6A4, 0x000000FF, + 0x6A5, 0x000000FF, + 0x6DE, 0x00000084, + 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, + 0x718, 0x00000040, + 0x7D4, 0x00000098, +}; + +RTW_DECL_TABLE_PHY_COND(rtw8822b_mac, rtw_phy_cfg_mac); + +static const u32 rtw8822b_agc[] = { + 0x80000000, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFE000003, + 0x81C, 0xFD020003, + 0x81C, 0xFC040003, + 0x81C, 0xFB060003, + 0x81C, 0xFA080003, + 0x81C, 0xF90A0003, + 0x81C, 0xF80C0003, + 0x81C, 0xF70E0003, + 0x81C, 0xF6100003, + 0x81C, 0xF5120003, + 0x81C, 0xF4140003, + 0x81C, 0xF3160003, + 0x81C, 0xF2180003, + 0x81C, 0xF11A0003, + 0x81C, 0xF01C0003, + 0x81C, 0xEF1E0003, + 0x81C, 0xEE200003, + 0x81C, 0xED220003, + 0x81C, 0xEC240003, + 0x81C, 0xEB260003, + 0x81C, 0xEA280003, + 0x81C, 0xE92A0003, + 0x81C, 0xE82C0003, + 0x81C, 0xE72E0003, + 0x81C, 0xE6300003, + 0x81C, 0xE5320003, + 0x81C, 0xC8340003, + 0x81C, 0xC7360003, + 0x81C, 0xC6380003, + 0x81C, 0xC53A0003, + 0x81C, 0xC43C0003, + 0x81C, 0xC33E0003, + 0x81C, 0xC2400003, + 0x81C, 0xC1420003, + 0x81C, 0xC0440003, + 0x81C, 0xA3460003, + 0x81C, 0xA2480003, + 0x81C, 0xA14A0003, + 0x81C, 0xA04C0003, + 0x81C, 0x824E0003, + 0x81C, 0x81500003, + 0x81C, 0x80520003, + 0x81C, 0x64540003, + 0x81C, 0x63560003, + 0x81C, 0x62580003, + 0x81C, 0x445A0003, + 0x81C, 0x435C0003, + 0x81C, 0x425E0003, + 0x81C, 0x41600003, + 0x81C, 0x40620003, + 0x81C, 0x05640003, + 0x81C, 0x04660003, + 0x81C, 0x03680003, + 0x81C, 0x026A0003, + 0x81C, 0x016C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xF5000003, + 0x81C, 0xF4020003, + 0x81C, 0xF3040003, + 0x81C, 0xF2060003, + 0x81C, 0xF1080003, + 0x81C, 0xF00A0003, + 0x81C, 0xEF0C0003, + 0x81C, 0xEE0E0003, + 0x81C, 0xED100003, + 0x81C, 0xEC120003, + 0x81C, 0xEB140003, + 0x81C, 0xEA160003, + 0x81C, 0xE9180003, + 0x81C, 0xE81A0003, + 0x81C, 0xE71C0003, + 0x81C, 0xE61E0003, + 0x81C, 0xE5200003, + 0x81C, 0xE4220003, + 0x81C, 0xE3240003, + 0x81C, 0xE2260003, + 0x81C, 0xE1280003, + 0x81C, 0xE02A0003, + 0x81C, 0xC32C0003, + 0x81C, 0xC22E0003, + 0x81C, 0xC1300003, + 0x81C, 0xC0320003, + 0x81C, 0xA4340003, + 0x81C, 0xA3360003, + 0x81C, 0xA2380003, + 0x81C, 0xA13A0003, + 0x81C, 0xA03C0003, + 0x81C, 0x823E0003, + 0x81C, 0x81400003, + 0x81C, 0x80420003, + 0x81C, 0x64440003, + 0x81C, 0x63460003, + 0x81C, 0x62480003, + 0x81C, 0x614A0003, + 0x81C, 0x604C0003, + 0x81C, 0x454E0003, + 0x81C, 0x44500003, + 0x81C, 0x43520003, + 0x81C, 0x42540003, + 0x81C, 0x41560003, + 0x81C, 0x40580003, + 0x81C, 0x055A0003, + 0x81C, 0x045C0003, + 0x81C, 0x035E0003, + 0x81C, 0x02600003, + 0x81C, 0x01620003, + 0x81C, 0x00640003, + 0x81C, 0x00660003, + 0x81C, 0x00680003, + 0x81C, 0x006A0003, + 0x81C, 0x006C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFD000003, + 0x81C, 0xFC020003, + 0x81C, 0xFB040003, + 0x81C, 0xFA060003, + 0x81C, 0xF9080003, + 0x81C, 0xF80A0003, + 0x81C, 0xF70C0003, + 0x81C, 0xF60E0003, + 0x81C, 0xF5100003, + 0x81C, 0xF4120003, + 0x81C, 0xF3140003, + 0x81C, 0xF2160003, + 0x81C, 0xF1180003, + 0x81C, 0xF01A0003, + 0x81C, 0xEF1C0003, + 0x81C, 0xEE1E0003, + 0x81C, 0xED200003, + 0x81C, 0xEC220003, + 0x81C, 0xEB240003, + 0x81C, 0xEA260003, + 0x81C, 0xE9280003, + 0x81C, 0xE82A0003, + 0x81C, 0xE72C0003, + 0x81C, 0xE62E0003, + 0x81C, 0xE5300003, + 0x81C, 0xC8320003, + 0x81C, 0xC7340003, + 0x81C, 0xC6360003, + 0x81C, 0xC5380003, + 0x81C, 0xC43A0003, + 0x81C, 0xC33C0003, + 0x81C, 0xC23E0003, + 0x81C, 0xC1400003, + 0x81C, 0xC0420003, + 0x81C, 0xA5440003, + 0x81C, 0xA4460003, + 0x81C, 0xA3480003, + 0x81C, 0xA24A0003, + 0x81C, 0xA14C0003, + 0x81C, 0x834E0003, + 0x81C, 0x82500003, + 0x81C, 0x81520003, + 0x81C, 0x80540003, + 0x81C, 0x65560003, + 0x81C, 0x64580003, + 0x81C, 0x635A0003, + 0x81C, 0x625C0003, + 0x81C, 0x435E0003, + 0x81C, 0x42600003, + 0x81C, 0x41620003, + 0x81C, 0x40640003, + 0x81C, 0x06660003, + 0x81C, 0x05680003, + 0x81C, 0x046A0003, + 0x81C, 0x036C0003, + 0x81C, 0x026E0003, + 0x81C, 0x01700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFD000003, + 0x81C, 0xFC020003, + 0x81C, 0xFB040003, + 0x81C, 0xFA060003, + 0x81C, 0xF9080003, + 0x81C, 0xF80A0003, + 0x81C, 0xF70C0003, + 0x81C, 0xF60E0003, + 0x81C, 0xF5100003, + 0x81C, 0xF4120003, + 0x81C, 0xF3140003, + 0x81C, 0xF2160003, + 0x81C, 0xF1180003, + 0x81C, 0xF01A0003, + 0x81C, 0xEF1C0003, + 0x81C, 0xEE1E0003, + 0x81C, 0xED200003, + 0x81C, 0xEC220003, + 0x81C, 0xEB240003, + 0x81C, 0xEA260003, + 0x81C, 0xE9280003, + 0x81C, 0xE82A0003, + 0x81C, 0xE72C0003, + 0x81C, 0xE62E0003, + 0x81C, 0xE5300003, + 0x81C, 0xC8320003, + 0x81C, 0xC7340003, + 0x81C, 0xC6360003, + 0x81C, 0xC5380003, + 0x81C, 0xC43A0003, + 0x81C, 0xC33C0003, + 0x81C, 0xC23E0003, + 0x81C, 0xC1400003, + 0x81C, 0xC0420003, + 0x81C, 0xA5440003, + 0x81C, 0xA4460003, + 0x81C, 0xA3480003, + 0x81C, 0xA24A0003, + 0x81C, 0xA14C0003, + 0x81C, 0x834E0003, + 0x81C, 0x82500003, + 0x81C, 0x81520003, + 0x81C, 0x80540003, + 0x81C, 0x65560003, + 0x81C, 0x64580003, + 0x81C, 0x635A0003, + 0x81C, 0x625C0003, + 0x81C, 0x435E0003, + 0x81C, 0x42600003, + 0x81C, 0x41620003, + 0x81C, 0x40640003, + 0x81C, 0x06660003, + 0x81C, 0x05680003, + 0x81C, 0x046A0003, + 0x81C, 0x036C0003, + 0x81C, 0x026E0003, + 0x81C, 0x01700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xDC000003, + 0x81C, 0xDB020003, + 0x81C, 0xDA040003, + 0x81C, 0xD9060003, + 0x81C, 0xD8080003, + 0x81C, 0xD70A0003, + 0x81C, 0xD60C0003, + 0x81C, 0xD50E0003, + 0x81C, 0xD4100003, + 0x81C, 0xD3120003, + 0x81C, 0xD2140003, + 0x81C, 0xD1160003, + 0x81C, 0xD0180003, + 0x81C, 0xB41A0003, + 0x81C, 0xB31C0003, + 0x81C, 0xB21E0003, + 0x81C, 0xB1200003, + 0x81C, 0xB0220003, + 0x81C, 0xAF240003, + 0x81C, 0xAE260003, + 0x81C, 0xAD280003, + 0x81C, 0xAC2A0003, + 0x81C, 0xAB2C0003, + 0x81C, 0x8C2E0003, + 0x81C, 0x8B300003, + 0x81C, 0x8A320003, + 0x81C, 0x89340003, + 0x81C, 0x88360003, + 0x81C, 0x87380003, + 0x81C, 0x863A0003, + 0x81C, 0x853C0003, + 0x81C, 0x693E0003, + 0x81C, 0x68400003, + 0x81C, 0x67420003, + 0x81C, 0x66440003, + 0x81C, 0x65460003, + 0x81C, 0x48480003, + 0x81C, 0x474A0003, + 0x81C, 0x464C0003, + 0x81C, 0x454E0003, + 0x81C, 0x44500003, + 0x81C, 0x43520003, + 0x81C, 0x27540003, + 0x81C, 0x26560003, + 0x81C, 0x25580003, + 0x81C, 0x245A0003, + 0x81C, 0x235C0003, + 0x81C, 0x045E0003, + 0x81C, 0x03600003, + 0x81C, 0x02620003, + 0x81C, 0x01640003, + 0x81C, 0x00660003, + 0x81C, 0x00680003, + 0x81C, 0x006A0003, + 0x81C, 0x006C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFD000003, + 0x81C, 0xFC020003, + 0x81C, 0xFB040003, + 0x81C, 0xFA060003, + 0x81C, 0xF9080003, + 0x81C, 0xF80A0003, + 0x81C, 0xF70C0003, + 0x81C, 0xF60E0003, + 0x81C, 0xF5100003, + 0x81C, 0xF4120003, + 0x81C, 0xF3140003, + 0x81C, 0xF2160003, + 0x81C, 0xF1180003, + 0x81C, 0xF01A0003, + 0x81C, 0xEF1C0003, + 0x81C, 0xEE1E0003, + 0x81C, 0xED200003, + 0x81C, 0xEC220003, + 0x81C, 0xEB240003, + 0x81C, 0xEA260003, + 0x81C, 0xE9280003, + 0x81C, 0xE82A0003, + 0x81C, 0xE72C0003, + 0x81C, 0xE62E0003, + 0x81C, 0xE5300003, + 0x81C, 0xC8320003, + 0x81C, 0xC7340003, + 0x81C, 0xC6360003, + 0x81C, 0xC5380003, + 0x81C, 0xC43A0003, + 0x81C, 0xC33C0003, + 0x81C, 0xC23E0003, + 0x81C, 0xC1400003, + 0x81C, 0xC0420003, + 0x81C, 0xA5440003, + 0x81C, 0xA4460003, + 0x81C, 0xA3480003, + 0x81C, 0xA24A0003, + 0x81C, 0xA14C0003, + 0x81C, 0x834E0003, + 0x81C, 0x82500003, + 0x81C, 0x81520003, + 0x81C, 0x80540003, + 0x81C, 0x65560003, + 0x81C, 0x64580003, + 0x81C, 0x635A0003, + 0x81C, 0x625C0003, + 0x81C, 0x435E0003, + 0x81C, 0x42600003, + 0x81C, 0x41620003, + 0x81C, 0x40640003, + 0x81C, 0x06660003, + 0x81C, 0x05680003, + 0x81C, 0x046A0003, + 0x81C, 0x036C0003, + 0x81C, 0x026E0003, + 0x81C, 0x01700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xF5000003, + 0x81C, 0xF4020003, + 0x81C, 0xF3040003, + 0x81C, 0xF2060003, + 0x81C, 0xF1080003, + 0x81C, 0xF00A0003, + 0x81C, 0xEF0C0003, + 0x81C, 0xEE0E0003, + 0x81C, 0xED100003, + 0x81C, 0xEC120003, + 0x81C, 0xEB140003, + 0x81C, 0xEA160003, + 0x81C, 0xE9180003, + 0x81C, 0xE81A0003, + 0x81C, 0xE71C0003, + 0x81C, 0xE61E0003, + 0x81C, 0xE5200003, + 0x81C, 0xE4220003, + 0x81C, 0xE3240003, + 0x81C, 0xE2260003, + 0x81C, 0xE1280003, + 0x81C, 0xE02A0003, + 0x81C, 0xC32C0003, + 0x81C, 0xC22E0003, + 0x81C, 0xC1300003, + 0x81C, 0xC0320003, + 0x81C, 0xA4340003, + 0x81C, 0xA3360003, + 0x81C, 0xA2380003, + 0x81C, 0xA13A0003, + 0x81C, 0xA03C0003, + 0x81C, 0x823E0003, + 0x81C, 0x81400003, + 0x81C, 0x80420003, + 0x81C, 0x64440003, + 0x81C, 0x63460003, + 0x81C, 0x62480003, + 0x81C, 0x614A0003, + 0x81C, 0x604C0003, + 0x81C, 0x454E0003, + 0x81C, 0x44500003, + 0x81C, 0x43520003, + 0x81C, 0x42540003, + 0x81C, 0x41560003, + 0x81C, 0x40580003, + 0x81C, 0x055A0003, + 0x81C, 0x045C0003, + 0x81C, 0x035E0003, + 0x81C, 0x02600003, + 0x81C, 0x01620003, + 0x81C, 0x00640003, + 0x81C, 0x00660003, + 0x81C, 0x00680003, + 0x81C, 0x006A0003, + 0x81C, 0x006C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xF5000003, + 0x81C, 0xF4020003, + 0x81C, 0xF3040003, + 0x81C, 0xF2060003, + 0x81C, 0xF1080003, + 0x81C, 0xF00A0003, + 0x81C, 0xEF0C0003, + 0x81C, 0xEE0E0003, + 0x81C, 0xED100003, + 0x81C, 0xEC120003, + 0x81C, 0xEB140003, + 0x81C, 0xEA160003, + 0x81C, 0xE9180003, + 0x81C, 0xE81A0003, + 0x81C, 0xE71C0003, + 0x81C, 0xE61E0003, + 0x81C, 0xE5200003, + 0x81C, 0xE4220003, + 0x81C, 0xE3240003, + 0x81C, 0xE2260003, + 0x81C, 0xE1280003, + 0x81C, 0xE02A0003, + 0x81C, 0xC32C0003, + 0x81C, 0xC22E0003, + 0x81C, 0xC1300003, + 0x81C, 0xC0320003, + 0x81C, 0xA4340003, + 0x81C, 0xA3360003, + 0x81C, 0xA2380003, + 0x81C, 0xA13A0003, + 0x81C, 0xA03C0003, + 0x81C, 0x823E0003, + 0x81C, 0x81400003, + 0x81C, 0x80420003, + 0x81C, 0x64440003, + 0x81C, 0x63460003, + 0x81C, 0x62480003, + 0x81C, 0x614A0003, + 0x81C, 0x604C0003, + 0x81C, 0x454E0003, + 0x81C, 0x44500003, + 0x81C, 0x43520003, + 0x81C, 0x42540003, + 0x81C, 0x41560003, + 0x81C, 0x40580003, + 0x81C, 0x055A0003, + 0x81C, 0x045C0003, + 0x81C, 0x035E0003, + 0x81C, 0x02600003, + 0x81C, 0x01620003, + 0x81C, 0x00640003, + 0x81C, 0x00660003, + 0x81C, 0x00680003, + 0x81C, 0x006A0003, + 0x81C, 0x006C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000008, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFE000003, + 0x81C, 0xFD020003, + 0x81C, 0xFC040003, + 0x81C, 0xFB060003, + 0x81C, 0xFA080003, + 0x81C, 0xF90A0003, + 0x81C, 0xF80C0003, + 0x81C, 0xF70E0003, + 0x81C, 0xF6100003, + 0x81C, 0xF5120003, + 0x81C, 0xF4140003, + 0x81C, 0xF3160003, + 0x81C, 0xF2180003, + 0x81C, 0xF11A0003, + 0x81C, 0xF01C0003, + 0x81C, 0xEF1E0003, + 0x81C, 0xEE200003, + 0x81C, 0xED220003, + 0x81C, 0xEC240003, + 0x81C, 0xEB260003, + 0x81C, 0xEA280003, + 0x81C, 0xE92A0003, + 0x81C, 0xE82C0003, + 0x81C, 0xE72E0003, + 0x81C, 0xE6300003, + 0x81C, 0xE5320003, + 0x81C, 0xC8340003, + 0x81C, 0xC7360003, + 0x81C, 0xC6380003, + 0x81C, 0xC53A0003, + 0x81C, 0xC43C0003, + 0x81C, 0xC33E0003, + 0x81C, 0xC2400003, + 0x81C, 0xC1420003, + 0x81C, 0xC0440003, + 0x81C, 0xA3460003, + 0x81C, 0xA2480003, + 0x81C, 0xA14A0003, + 0x81C, 0xA04C0003, + 0x81C, 0x824E0003, + 0x81C, 0x81500003, + 0x81C, 0x80520003, + 0x81C, 0x64540003, + 0x81C, 0x63560003, + 0x81C, 0x62580003, + 0x81C, 0x445A0003, + 0x81C, 0x435C0003, + 0x81C, 0x425E0003, + 0x81C, 0x41600003, + 0x81C, 0x40620003, + 0x81C, 0x05640003, + 0x81C, 0x04660003, + 0x81C, 0x03680003, + 0x81C, 0x026A0003, + 0x81C, 0x016C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000009, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xF5000003, + 0x81C, 0xF4020003, + 0x81C, 0xF3040003, + 0x81C, 0xF2060003, + 0x81C, 0xF1080003, + 0x81C, 0xF00A0003, + 0x81C, 0xEF0C0003, + 0x81C, 0xEE0E0003, + 0x81C, 0xED100003, + 0x81C, 0xEC120003, + 0x81C, 0xEB140003, + 0x81C, 0xEA160003, + 0x81C, 0xE9180003, + 0x81C, 0xE81A0003, + 0x81C, 0xE71C0003, + 0x81C, 0xE61E0003, + 0x81C, 0xE5200003, + 0x81C, 0xE4220003, + 0x81C, 0xE3240003, + 0x81C, 0xE2260003, + 0x81C, 0xE1280003, + 0x81C, 0xE02A0003, + 0x81C, 0xC32C0003, + 0x81C, 0xC22E0003, + 0x81C, 0xC1300003, + 0x81C, 0xC0320003, + 0x81C, 0xA4340003, + 0x81C, 0xA3360003, + 0x81C, 0xA2380003, + 0x81C, 0xA13A0003, + 0x81C, 0xA03C0003, + 0x81C, 0x823E0003, + 0x81C, 0x81400003, + 0x81C, 0x80420003, + 0x81C, 0x64440003, + 0x81C, 0x63460003, + 0x81C, 0x62480003, + 0x81C, 0x614A0003, + 0x81C, 0x604C0003, + 0x81C, 0x454E0003, + 0x81C, 0x44500003, + 0x81C, 0x43520003, + 0x81C, 0x42540003, + 0x81C, 0x41560003, + 0x81C, 0x40580003, + 0x81C, 0x055A0003, + 0x81C, 0x045C0003, + 0x81C, 0x035E0003, + 0x81C, 0x02600003, + 0x81C, 0x01620003, + 0x81C, 0x00640003, + 0x81C, 0x00660003, + 0x81C, 0x00680003, + 0x81C, 0x006A0003, + 0x81C, 0x006C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x9000000a, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFE000003, + 0x81C, 0xFD020003, + 0x81C, 0xFC040003, + 0x81C, 0xFB060003, + 0x81C, 0xFA080003, + 0x81C, 0xF90A0003, + 0x81C, 0xF80C0003, + 0x81C, 0xF70E0003, + 0x81C, 0xF6100003, + 0x81C, 0xF5120003, + 0x81C, 0xF4140003, + 0x81C, 0xF3160003, + 0x81C, 0xF2180003, + 0x81C, 0xF11A0003, + 0x81C, 0xF01C0003, + 0x81C, 0xEF1E0003, + 0x81C, 0xEE200003, + 0x81C, 0xED220003, + 0x81C, 0xEC240003, + 0x81C, 0xEB260003, + 0x81C, 0xEA280003, + 0x81C, 0xE92A0003, + 0x81C, 0xE82C0003, + 0x81C, 0xE72E0003, + 0x81C, 0xE6300003, + 0x81C, 0xE5320003, + 0x81C, 0xC8340003, + 0x81C, 0xC7360003, + 0x81C, 0xC6380003, + 0x81C, 0xC53A0003, + 0x81C, 0xC43C0003, + 0x81C, 0xC33E0003, + 0x81C, 0xC2400003, + 0x81C, 0xC1420003, + 0x81C, 0xC0440003, + 0x81C, 0xA3460003, + 0x81C, 0xA2480003, + 0x81C, 0xA14A0003, + 0x81C, 0xA04C0003, + 0x81C, 0x824E0003, + 0x81C, 0x81500003, + 0x81C, 0x80520003, + 0x81C, 0x64540003, + 0x81C, 0x63560003, + 0x81C, 0x62580003, + 0x81C, 0x445A0003, + 0x81C, 0x435C0003, + 0x81C, 0x425E0003, + 0x81C, 0x41600003, + 0x81C, 0x40620003, + 0x81C, 0x05640003, + 0x81C, 0x04660003, + 0x81C, 0x03680003, + 0x81C, 0x026A0003, + 0x81C, 0x016C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x9000000b, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xF5000003, + 0x81C, 0xF4020003, + 0x81C, 0xF3040003, + 0x81C, 0xF2060003, + 0x81C, 0xF1080003, + 0x81C, 0xF00A0003, + 0x81C, 0xEF0C0003, + 0x81C, 0xEE0E0003, + 0x81C, 0xED100003, + 0x81C, 0xEC120003, + 0x81C, 0xEB140003, + 0x81C, 0xEA160003, + 0x81C, 0xE9180003, + 0x81C, 0xE81A0003, + 0x81C, 0xE71C0003, + 0x81C, 0xE61E0003, + 0x81C, 0xE5200003, + 0x81C, 0xE4220003, + 0x81C, 0xE3240003, + 0x81C, 0xE2260003, + 0x81C, 0xE1280003, + 0x81C, 0xE02A0003, + 0x81C, 0xC32C0003, + 0x81C, 0xC22E0003, + 0x81C, 0xC1300003, + 0x81C, 0xC0320003, + 0x81C, 0xA4340003, + 0x81C, 0xA3360003, + 0x81C, 0xA2380003, + 0x81C, 0xA13A0003, + 0x81C, 0xA03C0003, + 0x81C, 0x823E0003, + 0x81C, 0x81400003, + 0x81C, 0x80420003, + 0x81C, 0x64440003, + 0x81C, 0x63460003, + 0x81C, 0x62480003, + 0x81C, 0x614A0003, + 0x81C, 0x604C0003, + 0x81C, 0x454E0003, + 0x81C, 0x44500003, + 0x81C, 0x43520003, + 0x81C, 0x42540003, + 0x81C, 0x41560003, + 0x81C, 0x40580003, + 0x81C, 0x055A0003, + 0x81C, 0x045C0003, + 0x81C, 0x035E0003, + 0x81C, 0x02600003, + 0x81C, 0x01620003, + 0x81C, 0x00640003, + 0x81C, 0x00660003, + 0x81C, 0x00680003, + 0x81C, 0x006A0003, + 0x81C, 0x006C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x9000000c, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFD000003, + 0x81C, 0xFC020003, + 0x81C, 0xFB040003, + 0x81C, 0xFA060003, + 0x81C, 0xF9080003, + 0x81C, 0xF80A0003, + 0x81C, 0xF70C0003, + 0x81C, 0xF60E0003, + 0x81C, 0xF5100003, + 0x81C, 0xF4120003, + 0x81C, 0xF3140003, + 0x81C, 0xF2160003, + 0x81C, 0xF1180003, + 0x81C, 0xF01A0003, + 0x81C, 0xEF1C0003, + 0x81C, 0xEE1E0003, + 0x81C, 0xED200003, + 0x81C, 0xEC220003, + 0x81C, 0xEB240003, + 0x81C, 0xEA260003, + 0x81C, 0xE9280003, + 0x81C, 0xE82A0003, + 0x81C, 0xE72C0003, + 0x81C, 0xE62E0003, + 0x81C, 0xE5300003, + 0x81C, 0xC8320003, + 0x81C, 0xC7340003, + 0x81C, 0xC6360003, + 0x81C, 0xC5380003, + 0x81C, 0xC43A0003, + 0x81C, 0xC33C0003, + 0x81C, 0xC23E0003, + 0x81C, 0xC1400003, + 0x81C, 0xC0420003, + 0x81C, 0xA5440003, + 0x81C, 0xA4460003, + 0x81C, 0xA3480003, + 0x81C, 0xA24A0003, + 0x81C, 0xA14C0003, + 0x81C, 0x834E0003, + 0x81C, 0x82500003, + 0x81C, 0x81520003, + 0x81C, 0x80540003, + 0x81C, 0x65560003, + 0x81C, 0x64580003, + 0x81C, 0x635A0003, + 0x81C, 0x625C0003, + 0x81C, 0x435E0003, + 0x81C, 0x42600003, + 0x81C, 0x41620003, + 0x81C, 0x40640003, + 0x81C, 0x06660003, + 0x81C, 0x05680003, + 0x81C, 0x046A0003, + 0x81C, 0x036C0003, + 0x81C, 0x026E0003, + 0x81C, 0x01700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x9000000d, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFE000003, + 0x81C, 0xFD020003, + 0x81C, 0xFC040003, + 0x81C, 0xFB060003, + 0x81C, 0xFA080003, + 0x81C, 0xF90A0003, + 0x81C, 0xF80C0003, + 0x81C, 0xF70E0003, + 0x81C, 0xF6100003, + 0x81C, 0xF5120003, + 0x81C, 0xF4140003, + 0x81C, 0xF3160003, + 0x81C, 0xF2180003, + 0x81C, 0xF11A0003, + 0x81C, 0xF01C0003, + 0x81C, 0xEF1E0003, + 0x81C, 0xEE200003, + 0x81C, 0xED220003, + 0x81C, 0xEC240003, + 0x81C, 0xEB260003, + 0x81C, 0xEA280003, + 0x81C, 0xE92A0003, + 0x81C, 0xE82C0003, + 0x81C, 0xE72E0003, + 0x81C, 0xE6300003, + 0x81C, 0xE5320003, + 0x81C, 0xC8340003, + 0x81C, 0xC7360003, + 0x81C, 0xC6380003, + 0x81C, 0xC53A0003, + 0x81C, 0xC43C0003, + 0x81C, 0xC33E0003, + 0x81C, 0xC2400003, + 0x81C, 0xC1420003, + 0x81C, 0xC0440003, + 0x81C, 0xA3460003, + 0x81C, 0xA2480003, + 0x81C, 0xA14A0003, + 0x81C, 0xA04C0003, + 0x81C, 0x824E0003, + 0x81C, 0x81500003, + 0x81C, 0x80520003, + 0x81C, 0x64540003, + 0x81C, 0x63560003, + 0x81C, 0x62580003, + 0x81C, 0x445A0003, + 0x81C, 0x435C0003, + 0x81C, 0x425E0003, + 0x81C, 0x41600003, + 0x81C, 0x40620003, + 0x81C, 0x05640003, + 0x81C, 0x04660003, + 0x81C, 0x03680003, + 0x81C, 0x026A0003, + 0x81C, 0x016C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x9000000e, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFE000003, + 0x81C, 0xFD020003, + 0x81C, 0xFC040003, + 0x81C, 0xFB060003, + 0x81C, 0xFA080003, + 0x81C, 0xF90A0003, + 0x81C, 0xF80C0003, + 0x81C, 0xF70E0003, + 0x81C, 0xF6100003, + 0x81C, 0xF5120003, + 0x81C, 0xF4140003, + 0x81C, 0xF3160003, + 0x81C, 0xF2180003, + 0x81C, 0xF11A0003, + 0x81C, 0xF01C0003, + 0x81C, 0xEF1E0003, + 0x81C, 0xEE200003, + 0x81C, 0xED220003, + 0x81C, 0xEC240003, + 0x81C, 0xEB260003, + 0x81C, 0xEA280003, + 0x81C, 0xE92A0003, + 0x81C, 0xE82C0003, + 0x81C, 0xE72E0003, + 0x81C, 0xE6300003, + 0x81C, 0xE5320003, + 0x81C, 0xC8340003, + 0x81C, 0xC7360003, + 0x81C, 0xC6380003, + 0x81C, 0xC53A0003, + 0x81C, 0xC43C0003, + 0x81C, 0xC33E0003, + 0x81C, 0xC2400003, + 0x81C, 0xC1420003, + 0x81C, 0xC0440003, + 0x81C, 0xA3460003, + 0x81C, 0xA2480003, + 0x81C, 0xA14A0003, + 0x81C, 0xA04C0003, + 0x81C, 0x824E0003, + 0x81C, 0x81500003, + 0x81C, 0x80520003, + 0x81C, 0x64540003, + 0x81C, 0x63560003, + 0x81C, 0x62580003, + 0x81C, 0x445A0003, + 0x81C, 0x435C0003, + 0x81C, 0x425E0003, + 0x81C, 0x41600003, + 0x81C, 0x40620003, + 0x81C, 0x05640003, + 0x81C, 0x04660003, + 0x81C, 0x03680003, + 0x81C, 0x026A0003, + 0x81C, 0x016C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x9000000f, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFC000003, + 0x81C, 0xFB020003, + 0x81C, 0xFA040003, + 0x81C, 0xF9060003, + 0x81C, 0xF8080003, + 0x81C, 0xF70A0003, + 0x81C, 0xF60C0003, + 0x81C, 0xF50E0003, + 0x81C, 0xF4100003, + 0x81C, 0xF3120003, + 0x81C, 0xF2140003, + 0x81C, 0xF1160003, + 0x81C, 0xF0180003, + 0x81C, 0xEF1A0003, + 0x81C, 0xEE1C0003, + 0x81C, 0xED1E0003, + 0x81C, 0xEC200003, + 0x81C, 0xEB220003, + 0x81C, 0xEA240003, + 0x81C, 0xE9260003, + 0x81C, 0xE8280003, + 0x81C, 0xE72A0003, + 0x81C, 0xE62C0003, + 0x81C, 0xE52E0003, + 0x81C, 0xC8300003, + 0x81C, 0xC7320003, + 0x81C, 0xC6340003, + 0x81C, 0xC5360003, + 0x81C, 0xC4380003, + 0x81C, 0xC33A0003, + 0x81C, 0xC23C0003, + 0x81C, 0xC13E0003, + 0x81C, 0xA4400003, + 0x81C, 0xA3420003, + 0x81C, 0xA2440003, + 0x81C, 0xA1460003, + 0x81C, 0xA0480003, + 0x81C, 0x684A0003, + 0x81C, 0x674C0003, + 0x81C, 0x664E0003, + 0x81C, 0x65500003, + 0x81C, 0x64520003, + 0x81C, 0x63540003, + 0x81C, 0x44560003, + 0x81C, 0x43580003, + 0x81C, 0x425A0003, + 0x81C, 0x415C0003, + 0x81C, 0x405E0003, + 0x81C, 0x23600003, + 0x81C, 0x22620003, + 0x81C, 0x21640003, + 0x81C, 0x03660003, + 0x81C, 0x02680003, + 0x81C, 0x016A0003, + 0x81C, 0x006C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000010, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFD000003, + 0x81C, 0xFC020003, + 0x81C, 0xFB040003, + 0x81C, 0xFA060003, + 0x81C, 0xF9080003, + 0x81C, 0xF80A0003, + 0x81C, 0xF70C0003, + 0x81C, 0xF60E0003, + 0x81C, 0xF5100003, + 0x81C, 0xF4120003, + 0x81C, 0xF3140003, + 0x81C, 0xF2160003, + 0x81C, 0xF1180003, + 0x81C, 0xF01A0003, + 0x81C, 0xEF1C0003, + 0x81C, 0xEE1E0003, + 0x81C, 0xED200003, + 0x81C, 0xEC220003, + 0x81C, 0xEB240003, + 0x81C, 0xEA260003, + 0x81C, 0xE9280003, + 0x81C, 0xE82A0003, + 0x81C, 0xE72C0003, + 0x81C, 0xE62E0003, + 0x81C, 0xE5300003, + 0x81C, 0xC8320003, + 0x81C, 0xC7340003, + 0x81C, 0xC6360003, + 0x81C, 0xC5380003, + 0x81C, 0xC43A0003, + 0x81C, 0xC33C0003, + 0x81C, 0xC23E0003, + 0x81C, 0xC1400003, + 0x81C, 0xC0420003, + 0x81C, 0xA5440003, + 0x81C, 0xA4460003, + 0x81C, 0xA3480003, + 0x81C, 0xA24A0003, + 0x81C, 0xA14C0003, + 0x81C, 0x834E0003, + 0x81C, 0x82500003, + 0x81C, 0x81520003, + 0x81C, 0x80540003, + 0x81C, 0x65560003, + 0x81C, 0x64580003, + 0x81C, 0x635A0003, + 0x81C, 0x625C0003, + 0x81C, 0x435E0003, + 0x81C, 0x42600003, + 0x81C, 0x41620003, + 0x81C, 0x40640003, + 0x81C, 0x06660003, + 0x81C, 0x05680003, + 0x81C, 0x046A0003, + 0x81C, 0x036C0003, + 0x81C, 0x026E0003, + 0x81C, 0x01700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0x90000012, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xDC000003, + 0x81C, 0xDB020003, + 0x81C, 0xDA040003, + 0x81C, 0xD9060003, + 0x81C, 0xD8080003, + 0x81C, 0xD70A0003, + 0x81C, 0xD60C0003, + 0x81C, 0xD50E0003, + 0x81C, 0xD4100003, + 0x81C, 0xD3120003, + 0x81C, 0xD2140003, + 0x81C, 0xD1160003, + 0x81C, 0xD0180003, + 0x81C, 0xB41A0003, + 0x81C, 0xB31C0003, + 0x81C, 0xB21E0003, + 0x81C, 0xB1200003, + 0x81C, 0xB0220003, + 0x81C, 0xAF240003, + 0x81C, 0xAE260003, + 0x81C, 0xAD280003, + 0x81C, 0xAC2A0003, + 0x81C, 0xAB2C0003, + 0x81C, 0x8C2E0003, + 0x81C, 0x8B300003, + 0x81C, 0x8A320003, + 0x81C, 0x89340003, + 0x81C, 0x88360003, + 0x81C, 0x87380003, + 0x81C, 0x863A0003, + 0x81C, 0x853C0003, + 0x81C, 0x693E0003, + 0x81C, 0x68400003, + 0x81C, 0x67420003, + 0x81C, 0x66440003, + 0x81C, 0x65460003, + 0x81C, 0x48480003, + 0x81C, 0x474A0003, + 0x81C, 0x464C0003, + 0x81C, 0x454E0003, + 0x81C, 0x44500003, + 0x81C, 0x43520003, + 0x81C, 0x27540003, + 0x81C, 0x26560003, + 0x81C, 0x25580003, + 0x81C, 0x245A0003, + 0x81C, 0x235C0003, + 0x81C, 0x045E0003, + 0x81C, 0x03600003, + 0x81C, 0x02620003, + 0x81C, 0x01640003, + 0x81C, 0x00660003, + 0x81C, 0x00680003, + 0x81C, 0x006A0003, + 0x81C, 0x006C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0xA0000000, 0x00000000, + 0x81C, 0xFF000003, + 0x81C, 0xFE000003, + 0x81C, 0xFD020003, + 0x81C, 0xFC040003, + 0x81C, 0xFB060003, + 0x81C, 0xFA080003, + 0x81C, 0xF90A0003, + 0x81C, 0xF80C0003, + 0x81C, 0xF70E0003, + 0x81C, 0xF6100003, + 0x81C, 0xF5120003, + 0x81C, 0xF4140003, + 0x81C, 0xF3160003, + 0x81C, 0xF2180003, + 0x81C, 0xF11A0003, + 0x81C, 0xF01C0003, + 0x81C, 0xEF1E0003, + 0x81C, 0xEE200003, + 0x81C, 0xED220003, + 0x81C, 0xEC240003, + 0x81C, 0xEB260003, + 0x81C, 0xEA280003, + 0x81C, 0xE92A0003, + 0x81C, 0xE82C0003, + 0x81C, 0xE72E0003, + 0x81C, 0xE6300003, + 0x81C, 0xE5320003, + 0x81C, 0xC8340003, + 0x81C, 0xC7360003, + 0x81C, 0xC6380003, + 0x81C, 0xC53A0003, + 0x81C, 0xC43C0003, + 0x81C, 0xC33E0003, + 0x81C, 0xC2400003, + 0x81C, 0xC1420003, + 0x81C, 0xC0440003, + 0x81C, 0xA3460003, + 0x81C, 0xA2480003, + 0x81C, 0xA14A0003, + 0x81C, 0xA04C0003, + 0x81C, 0x824E0003, + 0x81C, 0x81500003, + 0x81C, 0x80520003, + 0x81C, 0x64540003, + 0x81C, 0x63560003, + 0x81C, 0x62580003, + 0x81C, 0x445A0003, + 0x81C, 0x435C0003, + 0x81C, 0x425E0003, + 0x81C, 0x41600003, + 0x81C, 0x40620003, + 0x81C, 0x05640003, + 0x81C, 0x04660003, + 0x81C, 0x03680003, + 0x81C, 0x026A0003, + 0x81C, 0x016C0003, + 0x81C, 0x006E0003, + 0x81C, 0x00700003, + 0x81C, 0x00720003, + 0x81C, 0x00740003, + 0x81C, 0x00760003, + 0x81C, 0x00780003, + 0x81C, 0x007A0003, + 0x81C, 0x007C0003, + 0x81C, 0x007E0003, + 0xB0000000, 0x00000000, + 0x80000000, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000103, + 0x81C, 0xFC020103, + 0x81C, 0xFB040103, + 0x81C, 0xFA060103, + 0x81C, 0xF9080103, + 0x81C, 0xF80A0103, + 0x81C, 0xF70C0103, + 0x81C, 0xF60E0103, + 0x81C, 0xF5100103, + 0x81C, 0xF4120103, + 0x81C, 0xF3140103, + 0x81C, 0xF2160103, + 0x81C, 0xF1180103, + 0x81C, 0xF01A0103, + 0x81C, 0xEE1C0103, + 0x81C, 0xED1E0103, + 0x81C, 0xEC200103, + 0x81C, 0xEB220103, + 0x81C, 0xEA240103, + 0x81C, 0xE9260103, + 0x81C, 0xE8280103, + 0x81C, 0xE72A0103, + 0x81C, 0xE62C0103, + 0x81C, 0xE52E0103, + 0x81C, 0xE4300103, + 0x81C, 0xE3320103, + 0x81C, 0xE2340103, + 0x81C, 0xC5360103, + 0x81C, 0xC4380103, + 0x81C, 0xC33A0103, + 0x81C, 0xC23C0103, + 0x81C, 0xA53E0103, + 0x81C, 0xA4400103, + 0x81C, 0xA3420103, + 0x81C, 0xA2440103, + 0x81C, 0xA1460103, + 0x81C, 0x83480103, + 0x81C, 0x824A0103, + 0x81C, 0x814C0103, + 0x81C, 0x804E0103, + 0x81C, 0x63500103, + 0x81C, 0x62520103, + 0x81C, 0x61540103, + 0x81C, 0x43560103, + 0x81C, 0x42580103, + 0x81C, 0x415A0103, + 0x81C, 0x405C0103, + 0x81C, 0x225E0103, + 0x81C, 0x21600103, + 0x81C, 0x20620103, + 0x81C, 0x03640103, + 0x81C, 0x02660103, + 0x81C, 0x01680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000103, + 0x81C, 0xF7020103, + 0x81C, 0xF6040103, + 0x81C, 0xF5060103, + 0x81C, 0xF4080103, + 0x81C, 0xF30A0103, + 0x81C, 0xF20C0103, + 0x81C, 0xF10E0103, + 0x81C, 0xF0100103, + 0x81C, 0xEF120103, + 0x81C, 0xEE140103, + 0x81C, 0xED160103, + 0x81C, 0xEC180103, + 0x81C, 0xEB1A0103, + 0x81C, 0xEA1C0103, + 0x81C, 0xE91E0103, + 0x81C, 0xE8200103, + 0x81C, 0xE7220103, + 0x81C, 0xE6240103, + 0x81C, 0xE5260103, + 0x81C, 0xE4280103, + 0x81C, 0xE32A0103, + 0x81C, 0xC32C0103, + 0x81C, 0xC22E0103, + 0x81C, 0xC1300103, + 0x81C, 0xC0320103, + 0x81C, 0xA3340103, + 0x81C, 0xA2360103, + 0x81C, 0xA1380103, + 0x81C, 0xA03A0103, + 0x81C, 0x823C0103, + 0x81C, 0x813E0103, + 0x81C, 0x80400103, + 0x81C, 0x63420103, + 0x81C, 0x62440103, + 0x81C, 0x61460103, + 0x81C, 0x60480103, + 0x81C, 0x424A0103, + 0x81C, 0x414C0103, + 0x81C, 0x404E0103, + 0x81C, 0x06500103, + 0x81C, 0x05520103, + 0x81C, 0x04540103, + 0x81C, 0x03560103, + 0x81C, 0x02580103, + 0x81C, 0x015A0103, + 0x81C, 0x005C0103, + 0x81C, 0x005E0103, + 0x81C, 0x00600103, + 0x81C, 0x00620103, + 0x81C, 0x00640103, + 0x81C, 0x00660103, + 0x81C, 0x00680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000103, + 0x81C, 0xF7020103, + 0x81C, 0xF6040103, + 0x81C, 0xF5060103, + 0x81C, 0xF4080103, + 0x81C, 0xF30A0103, + 0x81C, 0xF20C0103, + 0x81C, 0xF10E0103, + 0x81C, 0xF0100103, + 0x81C, 0xEF120103, + 0x81C, 0xEE140103, + 0x81C, 0xED160103, + 0x81C, 0xEC180103, + 0x81C, 0xEB1A0103, + 0x81C, 0xEA1C0103, + 0x81C, 0xE91E0103, + 0x81C, 0xE8200103, + 0x81C, 0xE7220103, + 0x81C, 0xE6240103, + 0x81C, 0xE5260103, + 0x81C, 0xE4280103, + 0x81C, 0xE32A0103, + 0x81C, 0xC32C0103, + 0x81C, 0xC22E0103, + 0x81C, 0xC1300103, + 0x81C, 0xC0320103, + 0x81C, 0xA3340103, + 0x81C, 0xA2360103, + 0x81C, 0xA1380103, + 0x81C, 0xA03A0103, + 0x81C, 0x823C0103, + 0x81C, 0x813E0103, + 0x81C, 0x80400103, + 0x81C, 0x63420103, + 0x81C, 0x62440103, + 0x81C, 0x61460103, + 0x81C, 0x60480103, + 0x81C, 0x424A0103, + 0x81C, 0x414C0103, + 0x81C, 0x404E0103, + 0x81C, 0x22500103, + 0x81C, 0x21520103, + 0x81C, 0x20540103, + 0x81C, 0x03560103, + 0x81C, 0x02580103, + 0x81C, 0x015A0103, + 0x81C, 0x005C0103, + 0x81C, 0x005E0103, + 0x81C, 0x00600103, + 0x81C, 0x00620103, + 0x81C, 0x00640103, + 0x81C, 0x00660103, + 0x81C, 0x00680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFE000103, + 0x81C, 0xFD020103, + 0x81C, 0xFC040103, + 0x81C, 0xFB060103, + 0x81C, 0xFA080103, + 0x81C, 0xF90A0103, + 0x81C, 0xF80C0103, + 0x81C, 0xF70E0103, + 0x81C, 0xF6100103, + 0x81C, 0xF5120103, + 0x81C, 0xF4140103, + 0x81C, 0xF3160103, + 0x81C, 0xF2180103, + 0x81C, 0xF11A0103, + 0x81C, 0xF01C0103, + 0x81C, 0xEF1E0103, + 0x81C, 0xEE200103, + 0x81C, 0xED220103, + 0x81C, 0xEC240103, + 0x81C, 0xEB260103, + 0x81C, 0xEA280103, + 0x81C, 0xE92A0103, + 0x81C, 0xE82C0103, + 0x81C, 0xE72E0103, + 0x81C, 0xE6300103, + 0x81C, 0xE5320103, + 0x81C, 0xE4340103, + 0x81C, 0xE3360103, + 0x81C, 0xC6380103, + 0x81C, 0xC53A0103, + 0x81C, 0xC43C0103, + 0x81C, 0xC33E0103, + 0x81C, 0xA5400103, + 0x81C, 0xA4420103, + 0x81C, 0xA3440103, + 0x81C, 0xA2460103, + 0x81C, 0xA1480103, + 0x81C, 0xA04A0103, + 0x81C, 0x824C0103, + 0x81C, 0x814E0103, + 0x81C, 0x80500103, + 0x81C, 0x64520103, + 0x81C, 0x63540103, + 0x81C, 0x62560103, + 0x81C, 0x61580103, + 0x81C, 0x605A0103, + 0x81C, 0x235C0103, + 0x81C, 0x225E0103, + 0x81C, 0x21600103, + 0x81C, 0x20620103, + 0x81C, 0x03640103, + 0x81C, 0x02660103, + 0x81C, 0x01680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000103, + 0x81C, 0xF7020103, + 0x81C, 0xF6040103, + 0x81C, 0xF5060103, + 0x81C, 0xF4080103, + 0x81C, 0xF30A0103, + 0x81C, 0xF20C0103, + 0x81C, 0xF10E0103, + 0x81C, 0xF0100103, + 0x81C, 0xEF120103, + 0x81C, 0xEE140103, + 0x81C, 0xED160103, + 0x81C, 0xEC180103, + 0x81C, 0xEB1A0103, + 0x81C, 0xEA1C0103, + 0x81C, 0xE91E0103, + 0x81C, 0xE8200103, + 0x81C, 0xE7220103, + 0x81C, 0xE6240103, + 0x81C, 0xE5260103, + 0x81C, 0xE4280103, + 0x81C, 0xE32A0103, + 0x81C, 0xC32C0103, + 0x81C, 0xC22E0103, + 0x81C, 0xC1300103, + 0x81C, 0xC0320103, + 0x81C, 0xA3340103, + 0x81C, 0xA2360103, + 0x81C, 0xA1380103, + 0x81C, 0xA03A0103, + 0x81C, 0x823C0103, + 0x81C, 0x813E0103, + 0x81C, 0x80400103, + 0x81C, 0x63420103, + 0x81C, 0x62440103, + 0x81C, 0x61460103, + 0x81C, 0x60480103, + 0x81C, 0x424A0103, + 0x81C, 0x414C0103, + 0x81C, 0x404E0103, + 0x81C, 0x22500103, + 0x81C, 0x21520103, + 0x81C, 0x20540103, + 0x81C, 0x03560103, + 0x81C, 0x02580103, + 0x81C, 0x015A0103, + 0x81C, 0x005C0103, + 0x81C, 0x005E0103, + 0x81C, 0x00600103, + 0x81C, 0x00620103, + 0x81C, 0x00640103, + 0x81C, 0x00660103, + 0x81C, 0x00680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000103, + 0x81C, 0xFC020103, + 0x81C, 0xFB040103, + 0x81C, 0xFA060103, + 0x81C, 0xF9080103, + 0x81C, 0xF80A0103, + 0x81C, 0xF70C0103, + 0x81C, 0xF60E0103, + 0x81C, 0xF5100103, + 0x81C, 0xF4120103, + 0x81C, 0xF3140103, + 0x81C, 0xF2160103, + 0x81C, 0xF1180103, + 0x81C, 0xF01A0103, + 0x81C, 0xEF1C0103, + 0x81C, 0xEE1E0103, + 0x81C, 0xED200103, + 0x81C, 0xEC220103, + 0x81C, 0xEB240103, + 0x81C, 0xEA260103, + 0x81C, 0xE9280103, + 0x81C, 0xE82A0103, + 0x81C, 0xE72C0103, + 0x81C, 0xE62E0103, + 0x81C, 0xE5300103, + 0x81C, 0xE4320103, + 0x81C, 0xE3340103, + 0x81C, 0xE2360103, + 0x81C, 0xC5380103, + 0x81C, 0xC43A0103, + 0x81C, 0xC33C0103, + 0x81C, 0xC23E0103, + 0x81C, 0xA5400103, + 0x81C, 0xA4420103, + 0x81C, 0xA3440103, + 0x81C, 0xA2460103, + 0x81C, 0xA1480103, + 0x81C, 0x834A0103, + 0x81C, 0x824C0103, + 0x81C, 0x814E0103, + 0x81C, 0x64500103, + 0x81C, 0x63520103, + 0x81C, 0x62540103, + 0x81C, 0x61560103, + 0x81C, 0x42580103, + 0x81C, 0x415A0103, + 0x81C, 0x405C0103, + 0x81C, 0x065E0103, + 0x81C, 0x05600103, + 0x81C, 0x04620103, + 0x81C, 0x03640103, + 0x81C, 0x02660103, + 0x81C, 0x01680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFA000103, + 0x81C, 0xF9020103, + 0x81C, 0xF8040103, + 0x81C, 0xF7060103, + 0x81C, 0xF6080103, + 0x81C, 0xF50A0103, + 0x81C, 0xF40C0103, + 0x81C, 0xF30E0103, + 0x81C, 0xF2100103, + 0x81C, 0xF1120103, + 0x81C, 0xF0140103, + 0x81C, 0xEF160103, + 0x81C, 0xEE180103, + 0x81C, 0xED1A0103, + 0x81C, 0xEC1C0103, + 0x81C, 0xEB1E0103, + 0x81C, 0xEA200103, + 0x81C, 0xE9220103, + 0x81C, 0xE8240103, + 0x81C, 0xE7260103, + 0x81C, 0xE6280103, + 0x81C, 0xE52A0103, + 0x81C, 0xC42C0103, + 0x81C, 0xC32E0103, + 0x81C, 0xC2300103, + 0x81C, 0xC1320103, + 0x81C, 0xA4340103, + 0x81C, 0xA3360103, + 0x81C, 0xA2380103, + 0x81C, 0xA13A0103, + 0x81C, 0x833C0103, + 0x81C, 0x823E0103, + 0x81C, 0x81400103, + 0x81C, 0x63420103, + 0x81C, 0x62440103, + 0x81C, 0x61460103, + 0x81C, 0x60480103, + 0x81C, 0x424A0103, + 0x81C, 0x414C0103, + 0x81C, 0x404E0103, + 0x81C, 0x22500103, + 0x81C, 0x21520103, + 0x81C, 0x20540103, + 0x81C, 0x03560103, + 0x81C, 0x02580103, + 0x81C, 0x015A0103, + 0x81C, 0x005C0103, + 0x81C, 0x005E0103, + 0x81C, 0x00600103, + 0x81C, 0x00620103, + 0x81C, 0x00640103, + 0x81C, 0x00660103, + 0x81C, 0x00680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000103, + 0x81C, 0xF7020103, + 0x81C, 0xF6040103, + 0x81C, 0xF5060103, + 0x81C, 0xF4080103, + 0x81C, 0xF30A0103, + 0x81C, 0xF20C0103, + 0x81C, 0xF10E0103, + 0x81C, 0xF0100103, + 0x81C, 0xEF120103, + 0x81C, 0xEE140103, + 0x81C, 0xED160103, + 0x81C, 0xEC180103, + 0x81C, 0xEB1A0103, + 0x81C, 0xEA1C0103, + 0x81C, 0xE91E0103, + 0x81C, 0xE8200103, + 0x81C, 0xE7220103, + 0x81C, 0xE6240103, + 0x81C, 0xE5260103, + 0x81C, 0xE4280103, + 0x81C, 0xE32A0103, + 0x81C, 0xE22C0103, + 0x81C, 0xC32E0103, + 0x81C, 0xC2300103, + 0x81C, 0xC1320103, + 0x81C, 0xA3340103, + 0x81C, 0xA2360103, + 0x81C, 0xA1380103, + 0x81C, 0xA03A0103, + 0x81C, 0x823C0103, + 0x81C, 0x813E0103, + 0x81C, 0x80400103, + 0x81C, 0x64420103, + 0x81C, 0x63440103, + 0x81C, 0x62460103, + 0x81C, 0x61480103, + 0x81C, 0x434A0103, + 0x81C, 0x424C0103, + 0x81C, 0x414E0103, + 0x81C, 0x40500103, + 0x81C, 0x22520103, + 0x81C, 0x21540103, + 0x81C, 0x20560103, + 0x81C, 0x04580103, + 0x81C, 0x035A0103, + 0x81C, 0x025C0103, + 0x81C, 0x015E0103, + 0x81C, 0x00600103, + 0x81C, 0x00620103, + 0x81C, 0x00640103, + 0x81C, 0x00660103, + 0x81C, 0x00680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000008, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000103, + 0x81C, 0xFC020103, + 0x81C, 0xFB040103, + 0x81C, 0xFA060103, + 0x81C, 0xF9080103, + 0x81C, 0xF80A0103, + 0x81C, 0xF70C0103, + 0x81C, 0xF60E0103, + 0x81C, 0xF5100103, + 0x81C, 0xF4120103, + 0x81C, 0xF3140103, + 0x81C, 0xF2160103, + 0x81C, 0xF1180103, + 0x81C, 0xF01A0103, + 0x81C, 0xEF1C0103, + 0x81C, 0xEE1E0103, + 0x81C, 0xED200103, + 0x81C, 0xEC220103, + 0x81C, 0xEB240103, + 0x81C, 0xEA260103, + 0x81C, 0xE9280103, + 0x81C, 0xE82A0103, + 0x81C, 0xE72C0103, + 0x81C, 0xE62E0103, + 0x81C, 0xE5300103, + 0x81C, 0xE4320103, + 0x81C, 0xE3340103, + 0x81C, 0xC6360103, + 0x81C, 0xC5380103, + 0x81C, 0xC43A0103, + 0x81C, 0xC33C0103, + 0x81C, 0xC23E0103, + 0x81C, 0xA5400103, + 0x81C, 0xA4420103, + 0x81C, 0xA3440103, + 0x81C, 0xA2460103, + 0x81C, 0xA1480103, + 0x81C, 0x834A0103, + 0x81C, 0x824C0103, + 0x81C, 0x814E0103, + 0x81C, 0x63500103, + 0x81C, 0x62520103, + 0x81C, 0x61540103, + 0x81C, 0x43560103, + 0x81C, 0x42580103, + 0x81C, 0x245A0103, + 0x81C, 0x235C0103, + 0x81C, 0x225E0103, + 0x81C, 0x21600103, + 0x81C, 0x04620103, + 0x81C, 0x03640103, + 0x81C, 0x02660103, + 0x81C, 0x01680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000009, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000103, + 0x81C, 0xF7020103, + 0x81C, 0xF6040103, + 0x81C, 0xF5060103, + 0x81C, 0xF4080103, + 0x81C, 0xF30A0103, + 0x81C, 0xF20C0103, + 0x81C, 0xF10E0103, + 0x81C, 0xF0100103, + 0x81C, 0xEF120103, + 0x81C, 0xEE140103, + 0x81C, 0xED160103, + 0x81C, 0xEC180103, + 0x81C, 0xEB1A0103, + 0x81C, 0xEA1C0103, + 0x81C, 0xE91E0103, + 0x81C, 0xE8200103, + 0x81C, 0xE7220103, + 0x81C, 0xE6240103, + 0x81C, 0xE5260103, + 0x81C, 0xE4280103, + 0x81C, 0xE32A0103, + 0x81C, 0xE22C0103, + 0x81C, 0xC32E0103, + 0x81C, 0xC2300103, + 0x81C, 0xC1320103, + 0x81C, 0xA3340103, + 0x81C, 0xA2360103, + 0x81C, 0xA1380103, + 0x81C, 0xA03A0103, + 0x81C, 0x823C0103, + 0x81C, 0x813E0103, + 0x81C, 0x80400103, + 0x81C, 0x64420103, + 0x81C, 0x63440103, + 0x81C, 0x62460103, + 0x81C, 0x61480103, + 0x81C, 0x434A0103, + 0x81C, 0x424C0103, + 0x81C, 0x414E0103, + 0x81C, 0x40500103, + 0x81C, 0x22520103, + 0x81C, 0x21540103, + 0x81C, 0x20560103, + 0x81C, 0x04580103, + 0x81C, 0x035A0103, + 0x81C, 0x025C0103, + 0x81C, 0x015E0103, + 0x81C, 0x00600103, + 0x81C, 0x00620103, + 0x81C, 0x00640103, + 0x81C, 0x00660103, + 0x81C, 0x00680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x9000000a, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000103, + 0x81C, 0xFC020103, + 0x81C, 0xFB040103, + 0x81C, 0xFA060103, + 0x81C, 0xF9080103, + 0x81C, 0xF80A0103, + 0x81C, 0xF70C0103, + 0x81C, 0xF60E0103, + 0x81C, 0xF5100103, + 0x81C, 0xF4120103, + 0x81C, 0xF3140103, + 0x81C, 0xF2160103, + 0x81C, 0xF1180103, + 0x81C, 0xF01A0103, + 0x81C, 0xEE1C0103, + 0x81C, 0xED1E0103, + 0x81C, 0xEC200103, + 0x81C, 0xEB220103, + 0x81C, 0xEA240103, + 0x81C, 0xE9260103, + 0x81C, 0xE8280103, + 0x81C, 0xE72A0103, + 0x81C, 0xE62C0103, + 0x81C, 0xE52E0103, + 0x81C, 0xE4300103, + 0x81C, 0xE3320103, + 0x81C, 0xE2340103, + 0x81C, 0xC5360103, + 0x81C, 0xC4380103, + 0x81C, 0xC33A0103, + 0x81C, 0xC23C0103, + 0x81C, 0xA53E0103, + 0x81C, 0xA4400103, + 0x81C, 0xA3420103, + 0x81C, 0xA2440103, + 0x81C, 0xA1460103, + 0x81C, 0x83480103, + 0x81C, 0x824A0103, + 0x81C, 0x814C0103, + 0x81C, 0x804E0103, + 0x81C, 0x63500103, + 0x81C, 0x62520103, + 0x81C, 0x61540103, + 0x81C, 0x43560103, + 0x81C, 0x42580103, + 0x81C, 0x415A0103, + 0x81C, 0x405C0103, + 0x81C, 0x225E0103, + 0x81C, 0x21600103, + 0x81C, 0x20620103, + 0x81C, 0x03640103, + 0x81C, 0x02660103, + 0x81C, 0x01680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x9000000b, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF9000103, + 0x81C, 0xF8020103, + 0x81C, 0xF7040103, + 0x81C, 0xF6060103, + 0x81C, 0xF5080103, + 0x81C, 0xF40A0103, + 0x81C, 0xF30C0103, + 0x81C, 0xF20E0103, + 0x81C, 0xF1100103, + 0x81C, 0xF0120103, + 0x81C, 0xEF140103, + 0x81C, 0xEE160103, + 0x81C, 0xED180103, + 0x81C, 0xEC1A0103, + 0x81C, 0xEB1C0103, + 0x81C, 0xEA1E0103, + 0x81C, 0xE9200103, + 0x81C, 0xE8220103, + 0x81C, 0xE7240103, + 0x81C, 0xE6260103, + 0x81C, 0xE5280103, + 0x81C, 0xE42A0103, + 0x81C, 0xE32C0103, + 0x81C, 0xC32E0103, + 0x81C, 0xC2300103, + 0x81C, 0xC1320103, + 0x81C, 0xA4340103, + 0x81C, 0xA3360103, + 0x81C, 0xA2380103, + 0x81C, 0xA13A0103, + 0x81C, 0xA03C0103, + 0x81C, 0x823E0103, + 0x81C, 0x81400103, + 0x81C, 0x80420103, + 0x81C, 0x63440103, + 0x81C, 0x62460103, + 0x81C, 0x61480103, + 0x81C, 0x604A0103, + 0x81C, 0x244C0103, + 0x81C, 0x234E0103, + 0x81C, 0x22500103, + 0x81C, 0x21520103, + 0x81C, 0x20540103, + 0x81C, 0x05560103, + 0x81C, 0x04580103, + 0x81C, 0x035A0103, + 0x81C, 0x025C0103, + 0x81C, 0x015E0103, + 0x81C, 0x00600103, + 0x81C, 0x00620103, + 0x81C, 0x00640103, + 0x81C, 0x00660103, + 0x81C, 0x00680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x9000000c, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFE000103, + 0x81C, 0xFD020103, + 0x81C, 0xFC040103, + 0x81C, 0xFB060103, + 0x81C, 0xFA080103, + 0x81C, 0xF90A0103, + 0x81C, 0xF80C0103, + 0x81C, 0xF70E0103, + 0x81C, 0xF6100103, + 0x81C, 0xF5120103, + 0x81C, 0xF4140103, + 0x81C, 0xF3160103, + 0x81C, 0xF2180103, + 0x81C, 0xF11A0103, + 0x81C, 0xF01C0103, + 0x81C, 0xEF1E0103, + 0x81C, 0xEE200103, + 0x81C, 0xED220103, + 0x81C, 0xEC240103, + 0x81C, 0xEB260103, + 0x81C, 0xEA280103, + 0x81C, 0xE92A0103, + 0x81C, 0xE82C0103, + 0x81C, 0xE72E0103, + 0x81C, 0xE6300103, + 0x81C, 0xE5320103, + 0x81C, 0xE4340103, + 0x81C, 0xE3360103, + 0x81C, 0xC6380103, + 0x81C, 0xC53A0103, + 0x81C, 0xC43C0103, + 0x81C, 0xC33E0103, + 0x81C, 0xA5400103, + 0x81C, 0xA4420103, + 0x81C, 0xA3440103, + 0x81C, 0xA2460103, + 0x81C, 0xA1480103, + 0x81C, 0xA04A0103, + 0x81C, 0x824C0103, + 0x81C, 0x814E0103, + 0x81C, 0x80500103, + 0x81C, 0x64520103, + 0x81C, 0x63540103, + 0x81C, 0x62560103, + 0x81C, 0x61580103, + 0x81C, 0x605A0103, + 0x81C, 0x235C0103, + 0x81C, 0x225E0103, + 0x81C, 0x21600103, + 0x81C, 0x20620103, + 0x81C, 0x03640103, + 0x81C, 0x02660103, + 0x81C, 0x01680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x9000000d, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000103, + 0x81C, 0xFB020103, + 0x81C, 0xFA040103, + 0x81C, 0xF9060103, + 0x81C, 0xF8080103, + 0x81C, 0xF70A0103, + 0x81C, 0xF60C0103, + 0x81C, 0xF50E0103, + 0x81C, 0xF4100103, + 0x81C, 0xF3120103, + 0x81C, 0xF2140103, + 0x81C, 0xF1160103, + 0x81C, 0xF0180103, + 0x81C, 0xEE1A0103, + 0x81C, 0xED1C0103, + 0x81C, 0xEC1E0103, + 0x81C, 0xEB200103, + 0x81C, 0xEA220103, + 0x81C, 0xE9240103, + 0x81C, 0xE8260103, + 0x81C, 0xE7280103, + 0x81C, 0xE62A0103, + 0x81C, 0xE52C0103, + 0x81C, 0xE42E0103, + 0x81C, 0xE3300103, + 0x81C, 0xE2320103, + 0x81C, 0xE1340103, + 0x81C, 0xC5360103, + 0x81C, 0xC4380103, + 0x81C, 0xC33A0103, + 0x81C, 0xC23C0103, + 0x81C, 0xA53E0103, + 0x81C, 0xA4400103, + 0x81C, 0xA3420103, + 0x81C, 0xA2440103, + 0x81C, 0xA1460103, + 0x81C, 0x83480103, + 0x81C, 0x824A0103, + 0x81C, 0x814C0103, + 0x81C, 0x804E0103, + 0x81C, 0x63500103, + 0x81C, 0x62520103, + 0x81C, 0x61540103, + 0x81C, 0x43560103, + 0x81C, 0x42580103, + 0x81C, 0x415A0103, + 0x81C, 0x405C0103, + 0x81C, 0x225E0103, + 0x81C, 0x21600103, + 0x81C, 0x20620103, + 0x81C, 0x03640103, + 0x81C, 0x02660103, + 0x81C, 0x01680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x9000000e, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000103, + 0x81C, 0xFC020103, + 0x81C, 0xFB040103, + 0x81C, 0xFA060103, + 0x81C, 0xF9080103, + 0x81C, 0xF80A0103, + 0x81C, 0xF70C0103, + 0x81C, 0xF60E0103, + 0x81C, 0xF5100103, + 0x81C, 0xF4120103, + 0x81C, 0xF3140103, + 0x81C, 0xF2160103, + 0x81C, 0xF1180103, + 0x81C, 0xF01A0103, + 0x81C, 0xEE1C0103, + 0x81C, 0xED1E0103, + 0x81C, 0xEC200103, + 0x81C, 0xEB220103, + 0x81C, 0xEA240103, + 0x81C, 0xE9260103, + 0x81C, 0xE8280103, + 0x81C, 0xE72A0103, + 0x81C, 0xE62C0103, + 0x81C, 0xE52E0103, + 0x81C, 0xE4300103, + 0x81C, 0xE3320103, + 0x81C, 0xE2340103, + 0x81C, 0xC5360103, + 0x81C, 0xC4380103, + 0x81C, 0xC33A0103, + 0x81C, 0xC23C0103, + 0x81C, 0xA53E0103, + 0x81C, 0xA4400103, + 0x81C, 0xA3420103, + 0x81C, 0xA2440103, + 0x81C, 0xA1460103, + 0x81C, 0x83480103, + 0x81C, 0x824A0103, + 0x81C, 0x814C0103, + 0x81C, 0x804E0103, + 0x81C, 0x63500103, + 0x81C, 0x62520103, + 0x81C, 0x61540103, + 0x81C, 0x43560103, + 0x81C, 0x42580103, + 0x81C, 0x415A0103, + 0x81C, 0x405C0103, + 0x81C, 0x225E0103, + 0x81C, 0x21600103, + 0x81C, 0x20620103, + 0x81C, 0x03640103, + 0x81C, 0x02660103, + 0x81C, 0x01680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x9000000f, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000103, + 0x81C, 0xFB020103, + 0x81C, 0xFA040103, + 0x81C, 0xF9060103, + 0x81C, 0xF8080103, + 0x81C, 0xF70A0103, + 0x81C, 0xF60C0103, + 0x81C, 0xF50E0103, + 0x81C, 0xF4100103, + 0x81C, 0xF3120103, + 0x81C, 0xF2140103, + 0x81C, 0xF1160103, + 0x81C, 0xF0180103, + 0x81C, 0xEF1A0103, + 0x81C, 0xEE1C0103, + 0x81C, 0xED1E0103, + 0x81C, 0xEC200103, + 0x81C, 0xEB220103, + 0x81C, 0xEA240103, + 0x81C, 0xE9260103, + 0x81C, 0xE8280103, + 0x81C, 0xE72A0103, + 0x81C, 0xE62C0103, + 0x81C, 0xE52E0103, + 0x81C, 0xE4300103, + 0x81C, 0xE3320103, + 0x81C, 0xE2340103, + 0x81C, 0xE1360103, + 0x81C, 0xC3380103, + 0x81C, 0xC23A0103, + 0x81C, 0xC13C0103, + 0x81C, 0xC03E0103, + 0x81C, 0xA4400103, + 0x81C, 0xA3420103, + 0x81C, 0xA2440103, + 0x81C, 0xA1460103, + 0x81C, 0x82480103, + 0x81C, 0x814A0103, + 0x81C, 0x804C0103, + 0x81C, 0x634E0103, + 0x81C, 0x62500103, + 0x81C, 0x61520103, + 0x81C, 0x42540103, + 0x81C, 0x41560103, + 0x81C, 0x24580103, + 0x81C, 0x235A0103, + 0x81C, 0x225C0103, + 0x81C, 0x215E0103, + 0x81C, 0x20600103, + 0x81C, 0x03620103, + 0x81C, 0x02640103, + 0x81C, 0x01660103, + 0x81C, 0x00680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000010, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFE000103, + 0x81C, 0xFD020103, + 0x81C, 0xFC040103, + 0x81C, 0xFB060103, + 0x81C, 0xFA080103, + 0x81C, 0xF90A0103, + 0x81C, 0xF80C0103, + 0x81C, 0xF70E0103, + 0x81C, 0xF6100103, + 0x81C, 0xF5120103, + 0x81C, 0xF4140103, + 0x81C, 0xF3160103, + 0x81C, 0xF2180103, + 0x81C, 0xF11A0103, + 0x81C, 0xF01C0103, + 0x81C, 0xEF1E0103, + 0x81C, 0xEE200103, + 0x81C, 0xED220103, + 0x81C, 0xEC240103, + 0x81C, 0xEB260103, + 0x81C, 0xEA280103, + 0x81C, 0xE92A0103, + 0x81C, 0xE82C0103, + 0x81C, 0xE72E0103, + 0x81C, 0xE6300103, + 0x81C, 0xE5320103, + 0x81C, 0xE4340103, + 0x81C, 0xE3360103, + 0x81C, 0xC6380103, + 0x81C, 0xC53A0103, + 0x81C, 0xC43C0103, + 0x81C, 0xC33E0103, + 0x81C, 0xA5400103, + 0x81C, 0xA4420103, + 0x81C, 0xA3440103, + 0x81C, 0xA2460103, + 0x81C, 0xA1480103, + 0x81C, 0xA04A0103, + 0x81C, 0x824C0103, + 0x81C, 0x814E0103, + 0x81C, 0x80500103, + 0x81C, 0x64520103, + 0x81C, 0x63540103, + 0x81C, 0x62560103, + 0x81C, 0x61580103, + 0x81C, 0x605A0103, + 0x81C, 0x235C0103, + 0x81C, 0x225E0103, + 0x81C, 0x21600103, + 0x81C, 0x20620103, + 0x81C, 0x03640103, + 0x81C, 0x02660103, + 0x81C, 0x01680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0x90000012, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000103, + 0x81C, 0xF7020103, + 0x81C, 0xF6040103, + 0x81C, 0xF5060103, + 0x81C, 0xF4080103, + 0x81C, 0xF30A0103, + 0x81C, 0xF20C0103, + 0x81C, 0xF10E0103, + 0x81C, 0xF0100103, + 0x81C, 0xEF120103, + 0x81C, 0xEE140103, + 0x81C, 0xED160103, + 0x81C, 0xEC180103, + 0x81C, 0xEB1A0103, + 0x81C, 0xEA1C0103, + 0x81C, 0xE91E0103, + 0x81C, 0xE8200103, + 0x81C, 0xE7220103, + 0x81C, 0xE6240103, + 0x81C, 0xE5260103, + 0x81C, 0xE4280103, + 0x81C, 0xE32A0103, + 0x81C, 0xC32C0103, + 0x81C, 0xC22E0103, + 0x81C, 0xC1300103, + 0x81C, 0xC0320103, + 0x81C, 0xA3340103, + 0x81C, 0xA2360103, + 0x81C, 0xA1380103, + 0x81C, 0xA03A0103, + 0x81C, 0x823C0103, + 0x81C, 0x813E0103, + 0x81C, 0x80400103, + 0x81C, 0x63420103, + 0x81C, 0x62440103, + 0x81C, 0x61460103, + 0x81C, 0x60480103, + 0x81C, 0x424A0103, + 0x81C, 0x414C0103, + 0x81C, 0x404E0103, + 0x81C, 0x22500103, + 0x81C, 0x21520103, + 0x81C, 0x20540103, + 0x81C, 0x03560103, + 0x81C, 0x02580103, + 0x81C, 0x015A0103, + 0x81C, 0x005C0103, + 0x81C, 0x005E0103, + 0x81C, 0x00600103, + 0x81C, 0x00620103, + 0x81C, 0x00640103, + 0x81C, 0x00660103, + 0x81C, 0x00680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0xA0000000, 0x00000000, + 0x81C, 0xFE000103, + 0x81C, 0xFD020103, + 0x81C, 0xFC040103, + 0x81C, 0xFB060103, + 0x81C, 0xFA080103, + 0x81C, 0xF90A0103, + 0x81C, 0xF80C0103, + 0x81C, 0xF70E0103, + 0x81C, 0xF6100103, + 0x81C, 0xF5120103, + 0x81C, 0xF4140103, + 0x81C, 0xF3160103, + 0x81C, 0xF2180103, + 0x81C, 0xF11A0103, + 0x81C, 0xF01C0103, + 0x81C, 0xEF1E0103, + 0x81C, 0xEE200103, + 0x81C, 0xED220103, + 0x81C, 0xEC240103, + 0x81C, 0xEB260103, + 0x81C, 0xEA280103, + 0x81C, 0xE92A0103, + 0x81C, 0xE82C0103, + 0x81C, 0xE72E0103, + 0x81C, 0xE6300103, + 0x81C, 0xE5320103, + 0x81C, 0xE4340103, + 0x81C, 0xE3360103, + 0x81C, 0xC6380103, + 0x81C, 0xC53A0103, + 0x81C, 0xC43C0103, + 0x81C, 0xC33E0103, + 0x81C, 0xA5400103, + 0x81C, 0xA4420103, + 0x81C, 0xA3440103, + 0x81C, 0xA2460103, + 0x81C, 0xA1480103, + 0x81C, 0xA04A0103, + 0x81C, 0x824C0103, + 0x81C, 0x814E0103, + 0x81C, 0x80500103, + 0x81C, 0x64520103, + 0x81C, 0x63540103, + 0x81C, 0x62560103, + 0x81C, 0x61580103, + 0x81C, 0x605A0103, + 0x81C, 0x235C0103, + 0x81C, 0x225E0103, + 0x81C, 0x21600103, + 0x81C, 0x20620103, + 0x81C, 0x03640103, + 0x81C, 0x02660103, + 0x81C, 0x01680103, + 0x81C, 0x006A0103, + 0x81C, 0x006C0103, + 0x81C, 0x006E0103, + 0x81C, 0x00700103, + 0x81C, 0x00720103, + 0x81C, 0x00740103, + 0x81C, 0x00760103, + 0x81C, 0x00780103, + 0x81C, 0x007A0103, + 0x81C, 0x007C0103, + 0x81C, 0x007E0103, + 0xB0000000, 0x00000000, + 0x80000000, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000203, + 0x81C, 0xFB020203, + 0x81C, 0xFA040203, + 0x81C, 0xF9060203, + 0x81C, 0xF8080203, + 0x81C, 0xF70A0203, + 0x81C, 0xF60C0203, + 0x81C, 0xF50E0203, + 0x81C, 0xF4100203, + 0x81C, 0xF3120203, + 0x81C, 0xF2140203, + 0x81C, 0xF1160203, + 0x81C, 0xF0180203, + 0x81C, 0xEE1A0203, + 0x81C, 0xED1C0203, + 0x81C, 0xEC1E0203, + 0x81C, 0xEB200203, + 0x81C, 0xEA220203, + 0x81C, 0xE9240203, + 0x81C, 0xE8260203, + 0x81C, 0xE7280203, + 0x81C, 0xE62A0203, + 0x81C, 0xE52C0203, + 0x81C, 0xE42E0203, + 0x81C, 0xE3300203, + 0x81C, 0xE2320203, + 0x81C, 0xC6340203, + 0x81C, 0xC5360203, + 0x81C, 0xC4380203, + 0x81C, 0xC33A0203, + 0x81C, 0xA63C0203, + 0x81C, 0xA53E0203, + 0x81C, 0xA4400203, + 0x81C, 0xA3420203, + 0x81C, 0xA2440203, + 0x81C, 0xA1460203, + 0x81C, 0x83480203, + 0x81C, 0x824A0203, + 0x81C, 0x814C0203, + 0x81C, 0x804E0203, + 0x81C, 0x63500203, + 0x81C, 0x62520203, + 0x81C, 0x61540203, + 0x81C, 0x42560203, + 0x81C, 0x41580203, + 0x81C, 0x405A0203, + 0x81C, 0x225C0203, + 0x81C, 0x215E0203, + 0x81C, 0x20600203, + 0x81C, 0x04620203, + 0x81C, 0x03640203, + 0x81C, 0x02660203, + 0x81C, 0x01680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000203, + 0x81C, 0xF6020203, + 0x81C, 0xF5040203, + 0x81C, 0xF4060203, + 0x81C, 0xF3080203, + 0x81C, 0xF20A0203, + 0x81C, 0xF10C0203, + 0x81C, 0xF00E0203, + 0x81C, 0xEF100203, + 0x81C, 0xEE120203, + 0x81C, 0xED140203, + 0x81C, 0xEC160203, + 0x81C, 0xEB180203, + 0x81C, 0xEA1A0203, + 0x81C, 0xE91C0203, + 0x81C, 0xE81E0203, + 0x81C, 0xE7200203, + 0x81C, 0xE6220203, + 0x81C, 0xE5240203, + 0x81C, 0xE4260203, + 0x81C, 0xE3280203, + 0x81C, 0xC42A0203, + 0x81C, 0xC32C0203, + 0x81C, 0xC22E0203, + 0x81C, 0xC1300203, + 0x81C, 0xC0320203, + 0x81C, 0xA3340203, + 0x81C, 0xA2360203, + 0x81C, 0xA1380203, + 0x81C, 0xA03A0203, + 0x81C, 0x823C0203, + 0x81C, 0x813E0203, + 0x81C, 0x80400203, + 0x81C, 0x63420203, + 0x81C, 0x62440203, + 0x81C, 0x61460203, + 0x81C, 0x60480203, + 0x81C, 0x424A0203, + 0x81C, 0x414C0203, + 0x81C, 0x404E0203, + 0x81C, 0x06500203, + 0x81C, 0x05520203, + 0x81C, 0x04540203, + 0x81C, 0x03560203, + 0x81C, 0x02580203, + 0x81C, 0x015A0203, + 0x81C, 0x005C0203, + 0x81C, 0x005E0203, + 0x81C, 0x00600203, + 0x81C, 0x00620203, + 0x81C, 0x00640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000203, + 0x81C, 0xF6020203, + 0x81C, 0xF5040203, + 0x81C, 0xF4060203, + 0x81C, 0xF3080203, + 0x81C, 0xF20A0203, + 0x81C, 0xF10C0203, + 0x81C, 0xF00E0203, + 0x81C, 0xEF100203, + 0x81C, 0xEE120203, + 0x81C, 0xED140203, + 0x81C, 0xEC160203, + 0x81C, 0xEB180203, + 0x81C, 0xEA1A0203, + 0x81C, 0xE91C0203, + 0x81C, 0xE81E0203, + 0x81C, 0xE7200203, + 0x81C, 0xE6220203, + 0x81C, 0xE5240203, + 0x81C, 0xE4260203, + 0x81C, 0xE3280203, + 0x81C, 0xC42A0203, + 0x81C, 0xC32C0203, + 0x81C, 0xC22E0203, + 0x81C, 0xC1300203, + 0x81C, 0xC0320203, + 0x81C, 0xA3340203, + 0x81C, 0xA2360203, + 0x81C, 0xA1380203, + 0x81C, 0xA03A0203, + 0x81C, 0x823C0203, + 0x81C, 0x813E0203, + 0x81C, 0x80400203, + 0x81C, 0x64420203, + 0x81C, 0x63440203, + 0x81C, 0x62460203, + 0x81C, 0x61480203, + 0x81C, 0x604A0203, + 0x81C, 0x414C0203, + 0x81C, 0x404E0203, + 0x81C, 0x22500203, + 0x81C, 0x21520203, + 0x81C, 0x20540203, + 0x81C, 0x03560203, + 0x81C, 0x02580203, + 0x81C, 0x015A0203, + 0x81C, 0x005C0203, + 0x81C, 0x005E0203, + 0x81C, 0x00600203, + 0x81C, 0x00620203, + 0x81C, 0x00640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000203, + 0x81C, 0xFB020203, + 0x81C, 0xFA040203, + 0x81C, 0xF9060203, + 0x81C, 0xF8080203, + 0x81C, 0xF70A0203, + 0x81C, 0xF60C0203, + 0x81C, 0xF50E0203, + 0x81C, 0xF4100203, + 0x81C, 0xF3120203, + 0x81C, 0xF2140203, + 0x81C, 0xF1160203, + 0x81C, 0xF0180203, + 0x81C, 0xEF1A0203, + 0x81C, 0xEE1C0203, + 0x81C, 0xED1E0203, + 0x81C, 0xEC200203, + 0x81C, 0xEB220203, + 0x81C, 0xEA240203, + 0x81C, 0xE9260203, + 0x81C, 0xE8280203, + 0x81C, 0xE72A0203, + 0x81C, 0xE62C0203, + 0x81C, 0xE52E0203, + 0x81C, 0xE4300203, + 0x81C, 0xE3320203, + 0x81C, 0xE2340203, + 0x81C, 0xC6360203, + 0x81C, 0xC5380203, + 0x81C, 0xC43A0203, + 0x81C, 0xC33C0203, + 0x81C, 0xA63E0203, + 0x81C, 0xA5400203, + 0x81C, 0xA4420203, + 0x81C, 0xA3440203, + 0x81C, 0xA2460203, + 0x81C, 0xA1480203, + 0x81C, 0x834A0203, + 0x81C, 0x824C0203, + 0x81C, 0x814E0203, + 0x81C, 0x64500203, + 0x81C, 0x63520203, + 0x81C, 0x62540203, + 0x81C, 0x61560203, + 0x81C, 0x60580203, + 0x81C, 0x405A0203, + 0x81C, 0x215C0203, + 0x81C, 0x205E0203, + 0x81C, 0x03600203, + 0x81C, 0x02620203, + 0x81C, 0x01640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000203, + 0x81C, 0xF6020203, + 0x81C, 0xF5040203, + 0x81C, 0xF4060203, + 0x81C, 0xF3080203, + 0x81C, 0xF20A0203, + 0x81C, 0xF10C0203, + 0x81C, 0xF00E0203, + 0x81C, 0xEF100203, + 0x81C, 0xEE120203, + 0x81C, 0xED140203, + 0x81C, 0xEC160203, + 0x81C, 0xEB180203, + 0x81C, 0xEA1A0203, + 0x81C, 0xE91C0203, + 0x81C, 0xE81E0203, + 0x81C, 0xE7200203, + 0x81C, 0xE6220203, + 0x81C, 0xE5240203, + 0x81C, 0xE4260203, + 0x81C, 0xE3280203, + 0x81C, 0xC42A0203, + 0x81C, 0xC32C0203, + 0x81C, 0xC22E0203, + 0x81C, 0xC1300203, + 0x81C, 0xC0320203, + 0x81C, 0xA3340203, + 0x81C, 0xA2360203, + 0x81C, 0xA1380203, + 0x81C, 0xA03A0203, + 0x81C, 0x823C0203, + 0x81C, 0x813E0203, + 0x81C, 0x80400203, + 0x81C, 0x64420203, + 0x81C, 0x63440203, + 0x81C, 0x62460203, + 0x81C, 0x61480203, + 0x81C, 0x604A0203, + 0x81C, 0x414C0203, + 0x81C, 0x404E0203, + 0x81C, 0x22500203, + 0x81C, 0x21520203, + 0x81C, 0x20540203, + 0x81C, 0x03560203, + 0x81C, 0x02580203, + 0x81C, 0x015A0203, + 0x81C, 0x005C0203, + 0x81C, 0x005E0203, + 0x81C, 0x00600203, + 0x81C, 0x00620203, + 0x81C, 0x00640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000203, + 0x81C, 0xFB020203, + 0x81C, 0xFA040203, + 0x81C, 0xF9060203, + 0x81C, 0xF8080203, + 0x81C, 0xF70A0203, + 0x81C, 0xF60C0203, + 0x81C, 0xF50E0203, + 0x81C, 0xF4100203, + 0x81C, 0xF3120203, + 0x81C, 0xF2140203, + 0x81C, 0xF1160203, + 0x81C, 0xF0180203, + 0x81C, 0xEF1A0203, + 0x81C, 0xEE1C0203, + 0x81C, 0xED1E0203, + 0x81C, 0xEC200203, + 0x81C, 0xEB220203, + 0x81C, 0xEA240203, + 0x81C, 0xE9260203, + 0x81C, 0xE8280203, + 0x81C, 0xE72A0203, + 0x81C, 0xE62C0203, + 0x81C, 0xE52E0203, + 0x81C, 0xE4300203, + 0x81C, 0xE3320203, + 0x81C, 0xE2340203, + 0x81C, 0xE1360203, + 0x81C, 0xC5380203, + 0x81C, 0xC43A0203, + 0x81C, 0xC33C0203, + 0x81C, 0xC23E0203, + 0x81C, 0xC1400203, + 0x81C, 0xA3420203, + 0x81C, 0xA2440203, + 0x81C, 0xA1460203, + 0x81C, 0xA0480203, + 0x81C, 0x834A0203, + 0x81C, 0x824C0203, + 0x81C, 0x814E0203, + 0x81C, 0x64500203, + 0x81C, 0x63520203, + 0x81C, 0x62540203, + 0x81C, 0x61560203, + 0x81C, 0x25580203, + 0x81C, 0x245A0203, + 0x81C, 0x235C0203, + 0x81C, 0x225E0203, + 0x81C, 0x21600203, + 0x81C, 0x04620203, + 0x81C, 0x03640203, + 0x81C, 0x02660203, + 0x81C, 0x01680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF9000203, + 0x81C, 0xF8020203, + 0x81C, 0xF7040203, + 0x81C, 0xF6060203, + 0x81C, 0xF5080203, + 0x81C, 0xF40A0203, + 0x81C, 0xF30C0203, + 0x81C, 0xF20E0203, + 0x81C, 0xF1100203, + 0x81C, 0xF0120203, + 0x81C, 0xEF140203, + 0x81C, 0xEE160203, + 0x81C, 0xED180203, + 0x81C, 0xEC1A0203, + 0x81C, 0xEB1C0203, + 0x81C, 0xEA1E0203, + 0x81C, 0xE9200203, + 0x81C, 0xE8220203, + 0x81C, 0xE7240203, + 0x81C, 0xE6260203, + 0x81C, 0xE5280203, + 0x81C, 0xC42A0203, + 0x81C, 0xC32C0203, + 0x81C, 0xC22E0203, + 0x81C, 0xC1300203, + 0x81C, 0xC0320203, + 0x81C, 0xA3340203, + 0x81C, 0xA2360203, + 0x81C, 0xA1380203, + 0x81C, 0xA03A0203, + 0x81C, 0x823C0203, + 0x81C, 0x813E0203, + 0x81C, 0x80400203, + 0x81C, 0x64420203, + 0x81C, 0x63440203, + 0x81C, 0x62460203, + 0x81C, 0x61480203, + 0x81C, 0x604A0203, + 0x81C, 0x414C0203, + 0x81C, 0x404E0203, + 0x81C, 0x22500203, + 0x81C, 0x21520203, + 0x81C, 0x20540203, + 0x81C, 0x03560203, + 0x81C, 0x02580203, + 0x81C, 0x015A0203, + 0x81C, 0x005C0203, + 0x81C, 0x005E0203, + 0x81C, 0x00600203, + 0x81C, 0x00620203, + 0x81C, 0x00640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000203, + 0x81C, 0xF7020203, + 0x81C, 0xF6040203, + 0x81C, 0xF5060203, + 0x81C, 0xF4080203, + 0x81C, 0xF30A0203, + 0x81C, 0xF20C0203, + 0x81C, 0xF10E0203, + 0x81C, 0xF0100203, + 0x81C, 0xEF120203, + 0x81C, 0xEE140203, + 0x81C, 0xED160203, + 0x81C, 0xEC180203, + 0x81C, 0xEB1A0203, + 0x81C, 0xEA1C0203, + 0x81C, 0xE91E0203, + 0x81C, 0xE8200203, + 0x81C, 0xE7220203, + 0x81C, 0xE6240203, + 0x81C, 0xE5260203, + 0x81C, 0xE4280203, + 0x81C, 0xE32A0203, + 0x81C, 0xC42C0203, + 0x81C, 0xC32E0203, + 0x81C, 0xC2300203, + 0x81C, 0xC1320203, + 0x81C, 0xA3340203, + 0x81C, 0xA2360203, + 0x81C, 0xA1380203, + 0x81C, 0xA03A0203, + 0x81C, 0x823C0203, + 0x81C, 0x813E0203, + 0x81C, 0x80400203, + 0x81C, 0x65420203, + 0x81C, 0x64440203, + 0x81C, 0x63460203, + 0x81C, 0x62480203, + 0x81C, 0x614A0203, + 0x81C, 0x424C0203, + 0x81C, 0x414E0203, + 0x81C, 0x40500203, + 0x81C, 0x22520203, + 0x81C, 0x21540203, + 0x81C, 0x20560203, + 0x81C, 0x04580203, + 0x81C, 0x035A0203, + 0x81C, 0x025C0203, + 0x81C, 0x015E0203, + 0x81C, 0x00600203, + 0x81C, 0x00620203, + 0x81C, 0x00640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000008, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000203, + 0x81C, 0xFA020203, + 0x81C, 0xF9040203, + 0x81C, 0xF8060203, + 0x81C, 0xF7080203, + 0x81C, 0xF60A0203, + 0x81C, 0xF50C0203, + 0x81C, 0xF40E0203, + 0x81C, 0xF3100203, + 0x81C, 0xF2120203, + 0x81C, 0xF1140203, + 0x81C, 0xF0160203, + 0x81C, 0xEF180203, + 0x81C, 0xEE1A0203, + 0x81C, 0xED1C0203, + 0x81C, 0xEC1E0203, + 0x81C, 0xEB200203, + 0x81C, 0xEA220203, + 0x81C, 0xE9240203, + 0x81C, 0xE8260203, + 0x81C, 0xE7280203, + 0x81C, 0xE62A0203, + 0x81C, 0xE52C0203, + 0x81C, 0xE42E0203, + 0x81C, 0xE3300203, + 0x81C, 0xE2320203, + 0x81C, 0xC6340203, + 0x81C, 0xC5360203, + 0x81C, 0xC4380203, + 0x81C, 0xC33A0203, + 0x81C, 0xC23C0203, + 0x81C, 0xC13E0203, + 0x81C, 0xC0400203, + 0x81C, 0xA3420203, + 0x81C, 0xA2440203, + 0x81C, 0xA1460203, + 0x81C, 0xA0480203, + 0x81C, 0x824A0203, + 0x81C, 0x814C0203, + 0x81C, 0x804E0203, + 0x81C, 0x63500203, + 0x81C, 0x62520203, + 0x81C, 0x61540203, + 0x81C, 0x60560203, + 0x81C, 0x24580203, + 0x81C, 0x235A0203, + 0x81C, 0x225C0203, + 0x81C, 0x215E0203, + 0x81C, 0x20600203, + 0x81C, 0x03620203, + 0x81C, 0x02640203, + 0x81C, 0x01660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000009, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000203, + 0x81C, 0xF7020203, + 0x81C, 0xF6040203, + 0x81C, 0xF5060203, + 0x81C, 0xF4080203, + 0x81C, 0xF30A0203, + 0x81C, 0xF20C0203, + 0x81C, 0xF10E0203, + 0x81C, 0xF0100203, + 0x81C, 0xEF120203, + 0x81C, 0xEE140203, + 0x81C, 0xED160203, + 0x81C, 0xEC180203, + 0x81C, 0xEB1A0203, + 0x81C, 0xEA1C0203, + 0x81C, 0xE91E0203, + 0x81C, 0xE8200203, + 0x81C, 0xE7220203, + 0x81C, 0xE6240203, + 0x81C, 0xE5260203, + 0x81C, 0xE4280203, + 0x81C, 0xE32A0203, + 0x81C, 0xC42C0203, + 0x81C, 0xC32E0203, + 0x81C, 0xC2300203, + 0x81C, 0xC1320203, + 0x81C, 0xA3340203, + 0x81C, 0xA2360203, + 0x81C, 0xA1380203, + 0x81C, 0xA03A0203, + 0x81C, 0x823C0203, + 0x81C, 0x813E0203, + 0x81C, 0x80400203, + 0x81C, 0x65420203, + 0x81C, 0x64440203, + 0x81C, 0x63460203, + 0x81C, 0x62480203, + 0x81C, 0x614A0203, + 0x81C, 0x424C0203, + 0x81C, 0x414E0203, + 0x81C, 0x40500203, + 0x81C, 0x22520203, + 0x81C, 0x21540203, + 0x81C, 0x20560203, + 0x81C, 0x04580203, + 0x81C, 0x035A0203, + 0x81C, 0x025C0203, + 0x81C, 0x015E0203, + 0x81C, 0x00600203, + 0x81C, 0x00620203, + 0x81C, 0x00640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x9000000a, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000203, + 0x81C, 0xFB020203, + 0x81C, 0xFA040203, + 0x81C, 0xF9060203, + 0x81C, 0xF8080203, + 0x81C, 0xF70A0203, + 0x81C, 0xF60C0203, + 0x81C, 0xF50E0203, + 0x81C, 0xF4100203, + 0x81C, 0xF3120203, + 0x81C, 0xF2140203, + 0x81C, 0xF1160203, + 0x81C, 0xF0180203, + 0x81C, 0xEE1A0203, + 0x81C, 0xED1C0203, + 0x81C, 0xEC1E0203, + 0x81C, 0xEB200203, + 0x81C, 0xEA220203, + 0x81C, 0xE9240203, + 0x81C, 0xE8260203, + 0x81C, 0xE7280203, + 0x81C, 0xE62A0203, + 0x81C, 0xE52C0203, + 0x81C, 0xE42E0203, + 0x81C, 0xE3300203, + 0x81C, 0xE2320203, + 0x81C, 0xC6340203, + 0x81C, 0xC5360203, + 0x81C, 0xC4380203, + 0x81C, 0xC33A0203, + 0x81C, 0xA63C0203, + 0x81C, 0xA53E0203, + 0x81C, 0xA4400203, + 0x81C, 0xA3420203, + 0x81C, 0xA2440203, + 0x81C, 0xA1460203, + 0x81C, 0x83480203, + 0x81C, 0x824A0203, + 0x81C, 0x814C0203, + 0x81C, 0x804E0203, + 0x81C, 0x63500203, + 0x81C, 0x62520203, + 0x81C, 0x61540203, + 0x81C, 0x42560203, + 0x81C, 0x41580203, + 0x81C, 0x405A0203, + 0x81C, 0x225C0203, + 0x81C, 0x215E0203, + 0x81C, 0x20600203, + 0x81C, 0x04620203, + 0x81C, 0x03640203, + 0x81C, 0x02660203, + 0x81C, 0x01680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x9000000b, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF9000203, + 0x81C, 0xF8020203, + 0x81C, 0xF7040203, + 0x81C, 0xF6060203, + 0x81C, 0xF5080203, + 0x81C, 0xF40A0203, + 0x81C, 0xF30C0203, + 0x81C, 0xF20E0203, + 0x81C, 0xF1100203, + 0x81C, 0xF0120203, + 0x81C, 0xEF140203, + 0x81C, 0xEE160203, + 0x81C, 0xED180203, + 0x81C, 0xEC1A0203, + 0x81C, 0xEB1C0203, + 0x81C, 0xEA1E0203, + 0x81C, 0xE9200203, + 0x81C, 0xE8220203, + 0x81C, 0xE7240203, + 0x81C, 0xE6260203, + 0x81C, 0xE5280203, + 0x81C, 0xE42A0203, + 0x81C, 0xC42C0203, + 0x81C, 0xC32E0203, + 0x81C, 0xC2300203, + 0x81C, 0xC1320203, + 0x81C, 0xA3340203, + 0x81C, 0xA2360203, + 0x81C, 0xA1380203, + 0x81C, 0xA03A0203, + 0x81C, 0x823C0203, + 0x81C, 0x813E0203, + 0x81C, 0x80400203, + 0x81C, 0x64420203, + 0x81C, 0x63440203, + 0x81C, 0x62460203, + 0x81C, 0x61480203, + 0x81C, 0x604A0203, + 0x81C, 0x244C0203, + 0x81C, 0x234E0203, + 0x81C, 0x22500203, + 0x81C, 0x21520203, + 0x81C, 0x20540203, + 0x81C, 0x05560203, + 0x81C, 0x04580203, + 0x81C, 0x035A0203, + 0x81C, 0x025C0203, + 0x81C, 0x015E0203, + 0x81C, 0x00600203, + 0x81C, 0x00620203, + 0x81C, 0x00640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x9000000c, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000203, + 0x81C, 0xFB020203, + 0x81C, 0xFA040203, + 0x81C, 0xF9060203, + 0x81C, 0xF8080203, + 0x81C, 0xF70A0203, + 0x81C, 0xF60C0203, + 0x81C, 0xF50E0203, + 0x81C, 0xF4100203, + 0x81C, 0xF3120203, + 0x81C, 0xF2140203, + 0x81C, 0xF1160203, + 0x81C, 0xF0180203, + 0x81C, 0xEF1A0203, + 0x81C, 0xEE1C0203, + 0x81C, 0xED1E0203, + 0x81C, 0xEC200203, + 0x81C, 0xEB220203, + 0x81C, 0xEA240203, + 0x81C, 0xE9260203, + 0x81C, 0xE8280203, + 0x81C, 0xE72A0203, + 0x81C, 0xE62C0203, + 0x81C, 0xE52E0203, + 0x81C, 0xE4300203, + 0x81C, 0xE3320203, + 0x81C, 0xE2340203, + 0x81C, 0xC6360203, + 0x81C, 0xC5380203, + 0x81C, 0xC43A0203, + 0x81C, 0xC33C0203, + 0x81C, 0xA63E0203, + 0x81C, 0xA5400203, + 0x81C, 0xA4420203, + 0x81C, 0xA3440203, + 0x81C, 0xA2460203, + 0x81C, 0xA1480203, + 0x81C, 0x834A0203, + 0x81C, 0x824C0203, + 0x81C, 0x814E0203, + 0x81C, 0x64500203, + 0x81C, 0x63520203, + 0x81C, 0x62540203, + 0x81C, 0x61560203, + 0x81C, 0x60580203, + 0x81C, 0x405A0203, + 0x81C, 0x215C0203, + 0x81C, 0x205E0203, + 0x81C, 0x03600203, + 0x81C, 0x02620203, + 0x81C, 0x01640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x9000000d, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000203, + 0x81C, 0xFB020203, + 0x81C, 0xFA040203, + 0x81C, 0xF9060203, + 0x81C, 0xF8080203, + 0x81C, 0xF70A0203, + 0x81C, 0xF60C0203, + 0x81C, 0xF50E0203, + 0x81C, 0xF4100203, + 0x81C, 0xF3120203, + 0x81C, 0xF2140203, + 0x81C, 0xF1160203, + 0x81C, 0xF0180203, + 0x81C, 0xEE1A0203, + 0x81C, 0xED1C0203, + 0x81C, 0xEC1E0203, + 0x81C, 0xEB200203, + 0x81C, 0xEA220203, + 0x81C, 0xE9240203, + 0x81C, 0xE8260203, + 0x81C, 0xE7280203, + 0x81C, 0xE62A0203, + 0x81C, 0xE52C0203, + 0x81C, 0xE42E0203, + 0x81C, 0xE3300203, + 0x81C, 0xE2320203, + 0x81C, 0xC6340203, + 0x81C, 0xC5360203, + 0x81C, 0xC4380203, + 0x81C, 0xC33A0203, + 0x81C, 0xA63C0203, + 0x81C, 0xA53E0203, + 0x81C, 0xA4400203, + 0x81C, 0xA3420203, + 0x81C, 0xA2440203, + 0x81C, 0xA1460203, + 0x81C, 0x83480203, + 0x81C, 0x824A0203, + 0x81C, 0x814C0203, + 0x81C, 0x804E0203, + 0x81C, 0x63500203, + 0x81C, 0x62520203, + 0x81C, 0x61540203, + 0x81C, 0x42560203, + 0x81C, 0x41580203, + 0x81C, 0x405A0203, + 0x81C, 0x225C0203, + 0x81C, 0x215E0203, + 0x81C, 0x20600203, + 0x81C, 0x04620203, + 0x81C, 0x03640203, + 0x81C, 0x02660203, + 0x81C, 0x01680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x9000000e, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000203, + 0x81C, 0xFB020203, + 0x81C, 0xFA040203, + 0x81C, 0xF9060203, + 0x81C, 0xF8080203, + 0x81C, 0xF70A0203, + 0x81C, 0xF60C0203, + 0x81C, 0xF50E0203, + 0x81C, 0xF4100203, + 0x81C, 0xF3120203, + 0x81C, 0xF2140203, + 0x81C, 0xF1160203, + 0x81C, 0xF0180203, + 0x81C, 0xEE1A0203, + 0x81C, 0xED1C0203, + 0x81C, 0xEC1E0203, + 0x81C, 0xEB200203, + 0x81C, 0xEA220203, + 0x81C, 0xE9240203, + 0x81C, 0xE8260203, + 0x81C, 0xE7280203, + 0x81C, 0xE62A0203, + 0x81C, 0xE52C0203, + 0x81C, 0xE42E0203, + 0x81C, 0xE3300203, + 0x81C, 0xE2320203, + 0x81C, 0xC6340203, + 0x81C, 0xC5360203, + 0x81C, 0xC4380203, + 0x81C, 0xC33A0203, + 0x81C, 0xA63C0203, + 0x81C, 0xA53E0203, + 0x81C, 0xA4400203, + 0x81C, 0xA3420203, + 0x81C, 0xA2440203, + 0x81C, 0xA1460203, + 0x81C, 0x83480203, + 0x81C, 0x824A0203, + 0x81C, 0x814C0203, + 0x81C, 0x804E0203, + 0x81C, 0x63500203, + 0x81C, 0x62520203, + 0x81C, 0x61540203, + 0x81C, 0x42560203, + 0x81C, 0x41580203, + 0x81C, 0x405A0203, + 0x81C, 0x225C0203, + 0x81C, 0x215E0203, + 0x81C, 0x20600203, + 0x81C, 0x04620203, + 0x81C, 0x03640203, + 0x81C, 0x02660203, + 0x81C, 0x01680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x9000000f, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000203, + 0x81C, 0xFB020203, + 0x81C, 0xFA040203, + 0x81C, 0xF9060203, + 0x81C, 0xF8080203, + 0x81C, 0xF70A0203, + 0x81C, 0xF60C0203, + 0x81C, 0xF50E0203, + 0x81C, 0xF4100203, + 0x81C, 0xF3120203, + 0x81C, 0xF2140203, + 0x81C, 0xF1160203, + 0x81C, 0xF0180203, + 0x81C, 0xEF1A0203, + 0x81C, 0xEE1C0203, + 0x81C, 0xED1E0203, + 0x81C, 0xEC200203, + 0x81C, 0xEB220203, + 0x81C, 0xEA240203, + 0x81C, 0xE9260203, + 0x81C, 0xE8280203, + 0x81C, 0xE72A0203, + 0x81C, 0xE62C0203, + 0x81C, 0xE52E0203, + 0x81C, 0xE4300203, + 0x81C, 0xE3320203, + 0x81C, 0xE2340203, + 0x81C, 0xE1360203, + 0x81C, 0xE0380203, + 0x81C, 0xC33A0203, + 0x81C, 0xC23C0203, + 0x81C, 0xC13E0203, + 0x81C, 0xA3400203, + 0x81C, 0xA2420203, + 0x81C, 0xA1440203, + 0x81C, 0xA0460203, + 0x81C, 0x83480203, + 0x81C, 0x824A0203, + 0x81C, 0x814C0203, + 0x81C, 0x644E0203, + 0x81C, 0x63500203, + 0x81C, 0x62520203, + 0x81C, 0x61540203, + 0x81C, 0x42560203, + 0x81C, 0x41580203, + 0x81C, 0x235A0203, + 0x81C, 0x225C0203, + 0x81C, 0x215E0203, + 0x81C, 0x04600203, + 0x81C, 0x03620203, + 0x81C, 0x02640203, + 0x81C, 0x01660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000010, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000203, + 0x81C, 0xFB020203, + 0x81C, 0xFA040203, + 0x81C, 0xF9060203, + 0x81C, 0xF8080203, + 0x81C, 0xF70A0203, + 0x81C, 0xF60C0203, + 0x81C, 0xF50E0203, + 0x81C, 0xF4100203, + 0x81C, 0xF3120203, + 0x81C, 0xF2140203, + 0x81C, 0xF1160203, + 0x81C, 0xF0180203, + 0x81C, 0xEF1A0203, + 0x81C, 0xEE1C0203, + 0x81C, 0xED1E0203, + 0x81C, 0xEC200203, + 0x81C, 0xEB220203, + 0x81C, 0xEA240203, + 0x81C, 0xE9260203, + 0x81C, 0xE8280203, + 0x81C, 0xE72A0203, + 0x81C, 0xE62C0203, + 0x81C, 0xE52E0203, + 0x81C, 0xE4300203, + 0x81C, 0xE3320203, + 0x81C, 0xE2340203, + 0x81C, 0xC6360203, + 0x81C, 0xC5380203, + 0x81C, 0xC43A0203, + 0x81C, 0xC33C0203, + 0x81C, 0xA63E0203, + 0x81C, 0xA5400203, + 0x81C, 0xA4420203, + 0x81C, 0xA3440203, + 0x81C, 0xA2460203, + 0x81C, 0xA1480203, + 0x81C, 0x834A0203, + 0x81C, 0x824C0203, + 0x81C, 0x814E0203, + 0x81C, 0x64500203, + 0x81C, 0x63520203, + 0x81C, 0x62540203, + 0x81C, 0x61560203, + 0x81C, 0x60580203, + 0x81C, 0x405A0203, + 0x81C, 0x215C0203, + 0x81C, 0x205E0203, + 0x81C, 0x03600203, + 0x81C, 0x02620203, + 0x81C, 0x01640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0x90000012, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000203, + 0x81C, 0xF6020203, + 0x81C, 0xF5040203, + 0x81C, 0xF4060203, + 0x81C, 0xF3080203, + 0x81C, 0xF20A0203, + 0x81C, 0xF10C0203, + 0x81C, 0xF00E0203, + 0x81C, 0xEF100203, + 0x81C, 0xEE120203, + 0x81C, 0xED140203, + 0x81C, 0xEC160203, + 0x81C, 0xEB180203, + 0x81C, 0xEA1A0203, + 0x81C, 0xE91C0203, + 0x81C, 0xE81E0203, + 0x81C, 0xE7200203, + 0x81C, 0xE6220203, + 0x81C, 0xE5240203, + 0x81C, 0xE4260203, + 0x81C, 0xE3280203, + 0x81C, 0xC42A0203, + 0x81C, 0xC32C0203, + 0x81C, 0xC22E0203, + 0x81C, 0xC1300203, + 0x81C, 0xC0320203, + 0x81C, 0xA3340203, + 0x81C, 0xA2360203, + 0x81C, 0xA1380203, + 0x81C, 0xA03A0203, + 0x81C, 0x823C0203, + 0x81C, 0x813E0203, + 0x81C, 0x80400203, + 0x81C, 0x64420203, + 0x81C, 0x63440203, + 0x81C, 0x62460203, + 0x81C, 0x61480203, + 0x81C, 0x604A0203, + 0x81C, 0x414C0203, + 0x81C, 0x404E0203, + 0x81C, 0x22500203, + 0x81C, 0x21520203, + 0x81C, 0x20540203, + 0x81C, 0x03560203, + 0x81C, 0x02580203, + 0x81C, 0x015A0203, + 0x81C, 0x005C0203, + 0x81C, 0x005E0203, + 0x81C, 0x00600203, + 0x81C, 0x00620203, + 0x81C, 0x00640203, + 0x81C, 0x00660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0xA0000000, 0x00000000, + 0x81C, 0xFD000203, + 0x81C, 0xFC020203, + 0x81C, 0xFB040203, + 0x81C, 0xFA060203, + 0x81C, 0xF9080203, + 0x81C, 0xF80A0203, + 0x81C, 0xF70C0203, + 0x81C, 0xF60E0203, + 0x81C, 0xF5100203, + 0x81C, 0xF4120203, + 0x81C, 0xF3140203, + 0x81C, 0xF2160203, + 0x81C, 0xF1180203, + 0x81C, 0xF01A0203, + 0x81C, 0xEF1C0203, + 0x81C, 0xEE1E0203, + 0x81C, 0xED200203, + 0x81C, 0xEC220203, + 0x81C, 0xEB240203, + 0x81C, 0xEA260203, + 0x81C, 0xE9280203, + 0x81C, 0xE82A0203, + 0x81C, 0xE72C0203, + 0x81C, 0xE62E0203, + 0x81C, 0xE5300203, + 0x81C, 0xE4320203, + 0x81C, 0xE3340203, + 0x81C, 0xC6360203, + 0x81C, 0xC5380203, + 0x81C, 0xC43A0203, + 0x81C, 0xC33C0203, + 0x81C, 0xA63E0203, + 0x81C, 0xA5400203, + 0x81C, 0xA4420203, + 0x81C, 0xA3440203, + 0x81C, 0xA2460203, + 0x81C, 0xA1480203, + 0x81C, 0x834A0203, + 0x81C, 0x824C0203, + 0x81C, 0x814E0203, + 0x81C, 0x64500203, + 0x81C, 0x63520203, + 0x81C, 0x62540203, + 0x81C, 0x61560203, + 0x81C, 0x60580203, + 0x81C, 0x235A0203, + 0x81C, 0x225C0203, + 0x81C, 0x215E0203, + 0x81C, 0x20600203, + 0x81C, 0x03620203, + 0x81C, 0x02640203, + 0x81C, 0x01660203, + 0x81C, 0x00680203, + 0x81C, 0x006A0203, + 0x81C, 0x006C0203, + 0x81C, 0x006E0203, + 0x81C, 0x00700203, + 0x81C, 0x00720203, + 0x81C, 0x00740203, + 0x81C, 0x00760203, + 0x81C, 0x00780203, + 0x81C, 0x007A0203, + 0x81C, 0x007C0203, + 0x81C, 0x007E0203, + 0xB0000000, 0x00000000, + 0x80000000, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000303, + 0x81C, 0xFB020303, + 0x81C, 0xFA040303, + 0x81C, 0xF9060303, + 0x81C, 0xF8080303, + 0x81C, 0xF70A0303, + 0x81C, 0xF60C0303, + 0x81C, 0xF50E0303, + 0x81C, 0xF4100303, + 0x81C, 0xF3120303, + 0x81C, 0xF2140303, + 0x81C, 0xF1160303, + 0x81C, 0xEF180303, + 0x81C, 0xEE1A0303, + 0x81C, 0xED1C0303, + 0x81C, 0xEC1E0303, + 0x81C, 0xEB200303, + 0x81C, 0xEA220303, + 0x81C, 0xE9240303, + 0x81C, 0xE8260303, + 0x81C, 0xE7280303, + 0x81C, 0xE62A0303, + 0x81C, 0xE52C0303, + 0x81C, 0xE42E0303, + 0x81C, 0xE3300303, + 0x81C, 0xE2320303, + 0x81C, 0xC6340303, + 0x81C, 0xC5360303, + 0x81C, 0xC4380303, + 0x81C, 0xC33A0303, + 0x81C, 0xA63C0303, + 0x81C, 0xA53E0303, + 0x81C, 0xA4400303, + 0x81C, 0xA3420303, + 0x81C, 0xA2440303, + 0x81C, 0xA1460303, + 0x81C, 0x83480303, + 0x81C, 0x824A0303, + 0x81C, 0x814C0303, + 0x81C, 0x804E0303, + 0x81C, 0x63500303, + 0x81C, 0x62520303, + 0x81C, 0x61540303, + 0x81C, 0x42560303, + 0x81C, 0x41580303, + 0x81C, 0x405A0303, + 0x81C, 0x225C0303, + 0x81C, 0x215E0303, + 0x81C, 0x20600303, + 0x81C, 0x04620303, + 0x81C, 0x03640303, + 0x81C, 0x02660303, + 0x81C, 0x01680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000303, + 0x81C, 0xF6020303, + 0x81C, 0xF5040303, + 0x81C, 0xF4060303, + 0x81C, 0xF3080303, + 0x81C, 0xF20A0303, + 0x81C, 0xF10C0303, + 0x81C, 0xF00E0303, + 0x81C, 0xEF100303, + 0x81C, 0xEE120303, + 0x81C, 0xED140303, + 0x81C, 0xEC160303, + 0x81C, 0xEB180303, + 0x81C, 0xEA1A0303, + 0x81C, 0xE91C0303, + 0x81C, 0xCA1E0303, + 0x81C, 0xC9200303, + 0x81C, 0xC8220303, + 0x81C, 0xC7240303, + 0x81C, 0xC6260303, + 0x81C, 0xC5280303, + 0x81C, 0xC42A0303, + 0x81C, 0xC32C0303, + 0x81C, 0xC22E0303, + 0x81C, 0xC1300303, + 0x81C, 0xA4320303, + 0x81C, 0xA3340303, + 0x81C, 0xA2360303, + 0x81C, 0xA1380303, + 0x81C, 0xA03A0303, + 0x81C, 0x823C0303, + 0x81C, 0x813E0303, + 0x81C, 0x80400303, + 0x81C, 0x64420303, + 0x81C, 0x63440303, + 0x81C, 0x62460303, + 0x81C, 0x61480303, + 0x81C, 0x604A0303, + 0x81C, 0x414C0303, + 0x81C, 0x404E0303, + 0x81C, 0x06500303, + 0x81C, 0x05520303, + 0x81C, 0x04540303, + 0x81C, 0x03560303, + 0x81C, 0x02580303, + 0x81C, 0x015A0303, + 0x81C, 0x005C0303, + 0x81C, 0x005E0303, + 0x81C, 0x00600303, + 0x81C, 0x00620303, + 0x81C, 0x00640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000303, + 0x81C, 0xF6020303, + 0x81C, 0xF5040303, + 0x81C, 0xF4060303, + 0x81C, 0xF3080303, + 0x81C, 0xF20A0303, + 0x81C, 0xF10C0303, + 0x81C, 0xF00E0303, + 0x81C, 0xEF100303, + 0x81C, 0xEE120303, + 0x81C, 0xED140303, + 0x81C, 0xEC160303, + 0x81C, 0xEB180303, + 0x81C, 0xEA1A0303, + 0x81C, 0xE91C0303, + 0x81C, 0xCA1E0303, + 0x81C, 0xC9200303, + 0x81C, 0xC8220303, + 0x81C, 0xC7240303, + 0x81C, 0xC6260303, + 0x81C, 0xC5280303, + 0x81C, 0xC42A0303, + 0x81C, 0xC32C0303, + 0x81C, 0xC22E0303, + 0x81C, 0xC1300303, + 0x81C, 0xA4320303, + 0x81C, 0xA3340303, + 0x81C, 0xA2360303, + 0x81C, 0xA1380303, + 0x81C, 0xA03A0303, + 0x81C, 0x823C0303, + 0x81C, 0x813E0303, + 0x81C, 0x80400303, + 0x81C, 0x64420303, + 0x81C, 0x63440303, + 0x81C, 0x62460303, + 0x81C, 0x61480303, + 0x81C, 0x604A0303, + 0x81C, 0x414C0303, + 0x81C, 0x404E0303, + 0x81C, 0x22500303, + 0x81C, 0x21520303, + 0x81C, 0x20540303, + 0x81C, 0x03560303, + 0x81C, 0x02580303, + 0x81C, 0x015A0303, + 0x81C, 0x005C0303, + 0x81C, 0x005E0303, + 0x81C, 0x00600303, + 0x81C, 0x00620303, + 0x81C, 0x00640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000303, + 0x81C, 0xFB020303, + 0x81C, 0xFA040303, + 0x81C, 0xF9060303, + 0x81C, 0xF8080303, + 0x81C, 0xF70A0303, + 0x81C, 0xF60C0303, + 0x81C, 0xF50E0303, + 0x81C, 0xF4100303, + 0x81C, 0xF3120303, + 0x81C, 0xF2140303, + 0x81C, 0xF1160303, + 0x81C, 0xF0180303, + 0x81C, 0xEF1A0303, + 0x81C, 0xEE1C0303, + 0x81C, 0xED1E0303, + 0x81C, 0xEC200303, + 0x81C, 0xEB220303, + 0x81C, 0xEA240303, + 0x81C, 0xE9260303, + 0x81C, 0xE8280303, + 0x81C, 0xE72A0303, + 0x81C, 0xE62C0303, + 0x81C, 0xE52E0303, + 0x81C, 0xE4300303, + 0x81C, 0xE3320303, + 0x81C, 0xE2340303, + 0x81C, 0xC6360303, + 0x81C, 0xC5380303, + 0x81C, 0xC43A0303, + 0x81C, 0xC33C0303, + 0x81C, 0xA63E0303, + 0x81C, 0xA5400303, + 0x81C, 0xA4420303, + 0x81C, 0xA3440303, + 0x81C, 0xA2460303, + 0x81C, 0x84480303, + 0x81C, 0x834A0303, + 0x81C, 0x824C0303, + 0x81C, 0x814E0303, + 0x81C, 0x80500303, + 0x81C, 0x63520303, + 0x81C, 0x62540303, + 0x81C, 0x61560303, + 0x81C, 0x60580303, + 0x81C, 0x225A0303, + 0x81C, 0x055C0303, + 0x81C, 0x045E0303, + 0x81C, 0x03600303, + 0x81C, 0x02620303, + 0x81C, 0x01640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000303, + 0x81C, 0xF6020303, + 0x81C, 0xF5040303, + 0x81C, 0xF4060303, + 0x81C, 0xF3080303, + 0x81C, 0xF20A0303, + 0x81C, 0xF10C0303, + 0x81C, 0xF00E0303, + 0x81C, 0xEF100303, + 0x81C, 0xEE120303, + 0x81C, 0xED140303, + 0x81C, 0xEC160303, + 0x81C, 0xEB180303, + 0x81C, 0xEA1A0303, + 0x81C, 0xE91C0303, + 0x81C, 0xCA1E0303, + 0x81C, 0xC9200303, + 0x81C, 0xC8220303, + 0x81C, 0xC7240303, + 0x81C, 0xC6260303, + 0x81C, 0xC5280303, + 0x81C, 0xC42A0303, + 0x81C, 0xC32C0303, + 0x81C, 0xC22E0303, + 0x81C, 0xC1300303, + 0x81C, 0xA4320303, + 0x81C, 0xA3340303, + 0x81C, 0xA2360303, + 0x81C, 0xA1380303, + 0x81C, 0xA03A0303, + 0x81C, 0x823C0303, + 0x81C, 0x813E0303, + 0x81C, 0x80400303, + 0x81C, 0x64420303, + 0x81C, 0x63440303, + 0x81C, 0x62460303, + 0x81C, 0x61480303, + 0x81C, 0x604A0303, + 0x81C, 0x414C0303, + 0x81C, 0x404E0303, + 0x81C, 0x22500303, + 0x81C, 0x21520303, + 0x81C, 0x20540303, + 0x81C, 0x03560303, + 0x81C, 0x02580303, + 0x81C, 0x015A0303, + 0x81C, 0x005C0303, + 0x81C, 0x005E0303, + 0x81C, 0x00600303, + 0x81C, 0x00620303, + 0x81C, 0x00640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000303, + 0x81C, 0xFA020303, + 0x81C, 0xF9040303, + 0x81C, 0xF8060303, + 0x81C, 0xF7080303, + 0x81C, 0xF60A0303, + 0x81C, 0xF50C0303, + 0x81C, 0xF40E0303, + 0x81C, 0xF3100303, + 0x81C, 0xF2120303, + 0x81C, 0xF1140303, + 0x81C, 0xF0160303, + 0x81C, 0xEF180303, + 0x81C, 0xEE1A0303, + 0x81C, 0xED1C0303, + 0x81C, 0xEC1E0303, + 0x81C, 0xEB200303, + 0x81C, 0xEA220303, + 0x81C, 0xE9240303, + 0x81C, 0xE8260303, + 0x81C, 0xE7280303, + 0x81C, 0xE62A0303, + 0x81C, 0xE52C0303, + 0x81C, 0xE42E0303, + 0x81C, 0xE3300303, + 0x81C, 0xE2320303, + 0x81C, 0xE1340303, + 0x81C, 0xC5360303, + 0x81C, 0xC4380303, + 0x81C, 0xC33A0303, + 0x81C, 0xC23C0303, + 0x81C, 0xC13E0303, + 0x81C, 0xA4400303, + 0x81C, 0xA3420303, + 0x81C, 0xA2440303, + 0x81C, 0xA1460303, + 0x81C, 0x83480303, + 0x81C, 0x824A0303, + 0x81C, 0x814C0303, + 0x81C, 0x804E0303, + 0x81C, 0x64500303, + 0x81C, 0x63520303, + 0x81C, 0x62540303, + 0x81C, 0x61560303, + 0x81C, 0x60580303, + 0x81C, 0x235A0303, + 0x81C, 0x225C0303, + 0x81C, 0x215E0303, + 0x81C, 0x20600303, + 0x81C, 0x04620303, + 0x81C, 0x03640303, + 0x81C, 0x02660303, + 0x81C, 0x01680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF9000303, + 0x81C, 0xF8020303, + 0x81C, 0xF7040303, + 0x81C, 0xF6060303, + 0x81C, 0xF5080303, + 0x81C, 0xF40A0303, + 0x81C, 0xF30C0303, + 0x81C, 0xF20E0303, + 0x81C, 0xF1100303, + 0x81C, 0xF0120303, + 0x81C, 0xEF140303, + 0x81C, 0xEE160303, + 0x81C, 0xED180303, + 0x81C, 0xEC1A0303, + 0x81C, 0xEB1C0303, + 0x81C, 0xEA1E0303, + 0x81C, 0xC9200303, + 0x81C, 0xC8220303, + 0x81C, 0xC7240303, + 0x81C, 0xC6260303, + 0x81C, 0xC5280303, + 0x81C, 0xC42A0303, + 0x81C, 0xC32C0303, + 0x81C, 0xC22E0303, + 0x81C, 0xC1300303, + 0x81C, 0xC0320303, + 0x81C, 0xA3340303, + 0x81C, 0xA2360303, + 0x81C, 0xA1380303, + 0x81C, 0xA03A0303, + 0x81C, 0x823C0303, + 0x81C, 0x813E0303, + 0x81C, 0x80400303, + 0x81C, 0x64420303, + 0x81C, 0x63440303, + 0x81C, 0x62460303, + 0x81C, 0x61480303, + 0x81C, 0x604A0303, + 0x81C, 0x414C0303, + 0x81C, 0x404E0303, + 0x81C, 0x22500303, + 0x81C, 0x21520303, + 0x81C, 0x20540303, + 0x81C, 0x03560303, + 0x81C, 0x02580303, + 0x81C, 0x015A0303, + 0x81C, 0x005C0303, + 0x81C, 0x005E0303, + 0x81C, 0x00600303, + 0x81C, 0x00620303, + 0x81C, 0x00640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000303, + 0x81C, 0xF7020303, + 0x81C, 0xF6040303, + 0x81C, 0xF5060303, + 0x81C, 0xF4080303, + 0x81C, 0xF30A0303, + 0x81C, 0xF20C0303, + 0x81C, 0xF10E0303, + 0x81C, 0xF0100303, + 0x81C, 0xEF120303, + 0x81C, 0xEE140303, + 0x81C, 0xED160303, + 0x81C, 0xEC180303, + 0x81C, 0xEB1A0303, + 0x81C, 0xEA1C0303, + 0x81C, 0xE91E0303, + 0x81C, 0xCA200303, + 0x81C, 0xC9220303, + 0x81C, 0xC8240303, + 0x81C, 0xC7260303, + 0x81C, 0xC6280303, + 0x81C, 0xC52A0303, + 0x81C, 0xC42C0303, + 0x81C, 0xC32E0303, + 0x81C, 0xC2300303, + 0x81C, 0xC1320303, + 0x81C, 0xA3340303, + 0x81C, 0xA2360303, + 0x81C, 0xA1380303, + 0x81C, 0xA03A0303, + 0x81C, 0x823C0303, + 0x81C, 0x813E0303, + 0x81C, 0x80400303, + 0x81C, 0x65420303, + 0x81C, 0x64440303, + 0x81C, 0x63460303, + 0x81C, 0x62480303, + 0x81C, 0x614A0303, + 0x81C, 0x424C0303, + 0x81C, 0x414E0303, + 0x81C, 0x40500303, + 0x81C, 0x22520303, + 0x81C, 0x21540303, + 0x81C, 0x20560303, + 0x81C, 0x04580303, + 0x81C, 0x035A0303, + 0x81C, 0x025C0303, + 0x81C, 0x015E0303, + 0x81C, 0x00600303, + 0x81C, 0x00620303, + 0x81C, 0x00640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000008, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000303, + 0x81C, 0xFA020303, + 0x81C, 0xF9040303, + 0x81C, 0xF8060303, + 0x81C, 0xF7080303, + 0x81C, 0xF60A0303, + 0x81C, 0xF50C0303, + 0x81C, 0xF40E0303, + 0x81C, 0xF3100303, + 0x81C, 0xF2120303, + 0x81C, 0xF1140303, + 0x81C, 0xF0160303, + 0x81C, 0xEF180303, + 0x81C, 0xEE1A0303, + 0x81C, 0xED1C0303, + 0x81C, 0xEC1E0303, + 0x81C, 0xEB200303, + 0x81C, 0xEA220303, + 0x81C, 0xE9240303, + 0x81C, 0xE8260303, + 0x81C, 0xE7280303, + 0x81C, 0xE62A0303, + 0x81C, 0xE52C0303, + 0x81C, 0xE42E0303, + 0x81C, 0xE3300303, + 0x81C, 0xE2320303, + 0x81C, 0xC6340303, + 0x81C, 0xC5360303, + 0x81C, 0xC4380303, + 0x81C, 0xC33A0303, + 0x81C, 0xC23C0303, + 0x81C, 0xC13E0303, + 0x81C, 0xA4400303, + 0x81C, 0xA3420303, + 0x81C, 0xA2440303, + 0x81C, 0xA1460303, + 0x81C, 0x83480303, + 0x81C, 0x824A0303, + 0x81C, 0x814C0303, + 0x81C, 0x804E0303, + 0x81C, 0x63500303, + 0x81C, 0x62520303, + 0x81C, 0x43540303, + 0x81C, 0x42560303, + 0x81C, 0x41580303, + 0x81C, 0x235A0303, + 0x81C, 0x225C0303, + 0x81C, 0x215E0303, + 0x81C, 0x20600303, + 0x81C, 0x04620303, + 0x81C, 0x03640303, + 0x81C, 0x02660303, + 0x81C, 0x01680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000009, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000303, + 0x81C, 0xF7020303, + 0x81C, 0xF6040303, + 0x81C, 0xF5060303, + 0x81C, 0xF4080303, + 0x81C, 0xF30A0303, + 0x81C, 0xF20C0303, + 0x81C, 0xF10E0303, + 0x81C, 0xF0100303, + 0x81C, 0xEF120303, + 0x81C, 0xEE140303, + 0x81C, 0xED160303, + 0x81C, 0xEC180303, + 0x81C, 0xEB1A0303, + 0x81C, 0xEA1C0303, + 0x81C, 0xE91E0303, + 0x81C, 0xCA200303, + 0x81C, 0xC9220303, + 0x81C, 0xC8240303, + 0x81C, 0xC7260303, + 0x81C, 0xC6280303, + 0x81C, 0xC52A0303, + 0x81C, 0xC42C0303, + 0x81C, 0xC32E0303, + 0x81C, 0xC2300303, + 0x81C, 0xC1320303, + 0x81C, 0xA3340303, + 0x81C, 0xA2360303, + 0x81C, 0xA1380303, + 0x81C, 0xA03A0303, + 0x81C, 0x823C0303, + 0x81C, 0x813E0303, + 0x81C, 0x80400303, + 0x81C, 0x65420303, + 0x81C, 0x64440303, + 0x81C, 0x63460303, + 0x81C, 0x62480303, + 0x81C, 0x614A0303, + 0x81C, 0x424C0303, + 0x81C, 0x414E0303, + 0x81C, 0x40500303, + 0x81C, 0x22520303, + 0x81C, 0x21540303, + 0x81C, 0x20560303, + 0x81C, 0x04580303, + 0x81C, 0x035A0303, + 0x81C, 0x025C0303, + 0x81C, 0x015E0303, + 0x81C, 0x00600303, + 0x81C, 0x00620303, + 0x81C, 0x00640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x9000000a, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000303, + 0x81C, 0xFB020303, + 0x81C, 0xFA040303, + 0x81C, 0xF9060303, + 0x81C, 0xF8080303, + 0x81C, 0xF70A0303, + 0x81C, 0xF60C0303, + 0x81C, 0xF50E0303, + 0x81C, 0xF4100303, + 0x81C, 0xF3120303, + 0x81C, 0xF2140303, + 0x81C, 0xF1160303, + 0x81C, 0xEF180303, + 0x81C, 0xEE1A0303, + 0x81C, 0xED1C0303, + 0x81C, 0xEC1E0303, + 0x81C, 0xEB200303, + 0x81C, 0xEA220303, + 0x81C, 0xE9240303, + 0x81C, 0xE8260303, + 0x81C, 0xE7280303, + 0x81C, 0xE62A0303, + 0x81C, 0xE52C0303, + 0x81C, 0xE42E0303, + 0x81C, 0xE3300303, + 0x81C, 0xE2320303, + 0x81C, 0xC6340303, + 0x81C, 0xC5360303, + 0x81C, 0xC4380303, + 0x81C, 0xC33A0303, + 0x81C, 0xA63C0303, + 0x81C, 0xA53E0303, + 0x81C, 0xA4400303, + 0x81C, 0xA3420303, + 0x81C, 0xA2440303, + 0x81C, 0xA1460303, + 0x81C, 0x83480303, + 0x81C, 0x824A0303, + 0x81C, 0x814C0303, + 0x81C, 0x804E0303, + 0x81C, 0x63500303, + 0x81C, 0x62520303, + 0x81C, 0x61540303, + 0x81C, 0x42560303, + 0x81C, 0x41580303, + 0x81C, 0x405A0303, + 0x81C, 0x225C0303, + 0x81C, 0x215E0303, + 0x81C, 0x20600303, + 0x81C, 0x04620303, + 0x81C, 0x03640303, + 0x81C, 0x02660303, + 0x81C, 0x01680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x9000000b, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000303, + 0x81C, 0xF7020303, + 0x81C, 0xF6040303, + 0x81C, 0xF5060303, + 0x81C, 0xF4080303, + 0x81C, 0xF30A0303, + 0x81C, 0xF20C0303, + 0x81C, 0xF10E0303, + 0x81C, 0xF0100303, + 0x81C, 0xEF120303, + 0x81C, 0xEE140303, + 0x81C, 0xED160303, + 0x81C, 0xEC180303, + 0x81C, 0xEB1A0303, + 0x81C, 0xEA1C0303, + 0x81C, 0xE91E0303, + 0x81C, 0xCA200303, + 0x81C, 0xC9220303, + 0x81C, 0xC8240303, + 0x81C, 0xC7260303, + 0x81C, 0xC6280303, + 0x81C, 0xC52A0303, + 0x81C, 0xC42C0303, + 0x81C, 0xC32E0303, + 0x81C, 0xC2300303, + 0x81C, 0xC1320303, + 0x81C, 0xA3340303, + 0x81C, 0xA2360303, + 0x81C, 0xA1380303, + 0x81C, 0xA03A0303, + 0x81C, 0x823C0303, + 0x81C, 0x813E0303, + 0x81C, 0x80400303, + 0x81C, 0x64420303, + 0x81C, 0x63440303, + 0x81C, 0x62460303, + 0x81C, 0x61480303, + 0x81C, 0x604A0303, + 0x81C, 0x234C0303, + 0x81C, 0x224E0303, + 0x81C, 0x21500303, + 0x81C, 0x20520303, + 0x81C, 0x06540303, + 0x81C, 0x05560303, + 0x81C, 0x04580303, + 0x81C, 0x035A0303, + 0x81C, 0x025C0303, + 0x81C, 0x015E0303, + 0x81C, 0x00600303, + 0x81C, 0x00620303, + 0x81C, 0x00640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x9000000c, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000303, + 0x81C, 0xFB020303, + 0x81C, 0xFA040303, + 0x81C, 0xF9060303, + 0x81C, 0xF8080303, + 0x81C, 0xF70A0303, + 0x81C, 0xF60C0303, + 0x81C, 0xF50E0303, + 0x81C, 0xF4100303, + 0x81C, 0xF3120303, + 0x81C, 0xF2140303, + 0x81C, 0xF1160303, + 0x81C, 0xF0180303, + 0x81C, 0xEF1A0303, + 0x81C, 0xEE1C0303, + 0x81C, 0xED1E0303, + 0x81C, 0xEC200303, + 0x81C, 0xEB220303, + 0x81C, 0xEA240303, + 0x81C, 0xE9260303, + 0x81C, 0xE8280303, + 0x81C, 0xE72A0303, + 0x81C, 0xE62C0303, + 0x81C, 0xE52E0303, + 0x81C, 0xE4300303, + 0x81C, 0xE3320303, + 0x81C, 0xE2340303, + 0x81C, 0xC6360303, + 0x81C, 0xC5380303, + 0x81C, 0xC43A0303, + 0x81C, 0xC33C0303, + 0x81C, 0xA63E0303, + 0x81C, 0xA5400303, + 0x81C, 0xA4420303, + 0x81C, 0xA3440303, + 0x81C, 0xA2460303, + 0x81C, 0x84480303, + 0x81C, 0x834A0303, + 0x81C, 0x824C0303, + 0x81C, 0x814E0303, + 0x81C, 0x80500303, + 0x81C, 0x63520303, + 0x81C, 0x62540303, + 0x81C, 0x61560303, + 0x81C, 0x60580303, + 0x81C, 0x225A0303, + 0x81C, 0x055C0303, + 0x81C, 0x045E0303, + 0x81C, 0x03600303, + 0x81C, 0x02620303, + 0x81C, 0x01640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x9000000d, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000303, + 0x81C, 0xFA020303, + 0x81C, 0xF9040303, + 0x81C, 0xF8060303, + 0x81C, 0xF7080303, + 0x81C, 0xF60A0303, + 0x81C, 0xF50C0303, + 0x81C, 0xF40E0303, + 0x81C, 0xF3100303, + 0x81C, 0xF2120303, + 0x81C, 0xF1140303, + 0x81C, 0xEF160303, + 0x81C, 0xEE180303, + 0x81C, 0xED1A0303, + 0x81C, 0xEC1C0303, + 0x81C, 0xEB1E0303, + 0x81C, 0xEA200303, + 0x81C, 0xE9220303, + 0x81C, 0xE8240303, + 0x81C, 0xE7260303, + 0x81C, 0xE6280303, + 0x81C, 0xE52A0303, + 0x81C, 0xE42C0303, + 0x81C, 0xE32E0303, + 0x81C, 0xE2300303, + 0x81C, 0xE1320303, + 0x81C, 0xC6340303, + 0x81C, 0xC5360303, + 0x81C, 0xC4380303, + 0x81C, 0xC33A0303, + 0x81C, 0xA63C0303, + 0x81C, 0xA53E0303, + 0x81C, 0xA4400303, + 0x81C, 0xA3420303, + 0x81C, 0xA2440303, + 0x81C, 0xA1460303, + 0x81C, 0x83480303, + 0x81C, 0x824A0303, + 0x81C, 0x814C0303, + 0x81C, 0x804E0303, + 0x81C, 0x63500303, + 0x81C, 0x62520303, + 0x81C, 0x61540303, + 0x81C, 0x42560303, + 0x81C, 0x41580303, + 0x81C, 0x405A0303, + 0x81C, 0x225C0303, + 0x81C, 0x215E0303, + 0x81C, 0x20600303, + 0x81C, 0x04620303, + 0x81C, 0x03640303, + 0x81C, 0x02660303, + 0x81C, 0x01680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x9000000e, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000303, + 0x81C, 0xFA020303, + 0x81C, 0xF9040303, + 0x81C, 0xF8060303, + 0x81C, 0xF7080303, + 0x81C, 0xF60A0303, + 0x81C, 0xF50C0303, + 0x81C, 0xF40E0303, + 0x81C, 0xF3100303, + 0x81C, 0xF2120303, + 0x81C, 0xF1140303, + 0x81C, 0xEF160303, + 0x81C, 0xEE180303, + 0x81C, 0xED1A0303, + 0x81C, 0xEC1C0303, + 0x81C, 0xEB1E0303, + 0x81C, 0xEA200303, + 0x81C, 0xE9220303, + 0x81C, 0xE8240303, + 0x81C, 0xE7260303, + 0x81C, 0xE6280303, + 0x81C, 0xE52A0303, + 0x81C, 0xE42C0303, + 0x81C, 0xE32E0303, + 0x81C, 0xE2300303, + 0x81C, 0xE1320303, + 0x81C, 0xC6340303, + 0x81C, 0xC5360303, + 0x81C, 0xC4380303, + 0x81C, 0xC33A0303, + 0x81C, 0xA63C0303, + 0x81C, 0xA53E0303, + 0x81C, 0xA4400303, + 0x81C, 0xA3420303, + 0x81C, 0xA2440303, + 0x81C, 0xA1460303, + 0x81C, 0x83480303, + 0x81C, 0x824A0303, + 0x81C, 0x814C0303, + 0x81C, 0x804E0303, + 0x81C, 0x63500303, + 0x81C, 0x62520303, + 0x81C, 0x61540303, + 0x81C, 0x42560303, + 0x81C, 0x41580303, + 0x81C, 0x405A0303, + 0x81C, 0x225C0303, + 0x81C, 0x215E0303, + 0x81C, 0x20600303, + 0x81C, 0x04620303, + 0x81C, 0x03640303, + 0x81C, 0x02660303, + 0x81C, 0x01680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x9000000f, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000303, + 0x81C, 0xFA020303, + 0x81C, 0xF9040303, + 0x81C, 0xF8060303, + 0x81C, 0xF7080303, + 0x81C, 0xF60A0303, + 0x81C, 0xF50C0303, + 0x81C, 0xF40E0303, + 0x81C, 0xF3100303, + 0x81C, 0xF2120303, + 0x81C, 0xF1140303, + 0x81C, 0xF0160303, + 0x81C, 0xEF180303, + 0x81C, 0xEE1A0303, + 0x81C, 0xED1C0303, + 0x81C, 0xEC1E0303, + 0x81C, 0xEB200303, + 0x81C, 0xEA220303, + 0x81C, 0xE9240303, + 0x81C, 0xE8260303, + 0x81C, 0xE7280303, + 0x81C, 0xE62A0303, + 0x81C, 0xE52C0303, + 0x81C, 0xE42E0303, + 0x81C, 0xE3300303, + 0x81C, 0xE2320303, + 0x81C, 0xE1340303, + 0x81C, 0xE0360303, + 0x81C, 0xC3380303, + 0x81C, 0xC23A0303, + 0x81C, 0xC13C0303, + 0x81C, 0xC03E0303, + 0x81C, 0xA3400303, + 0x81C, 0xA2420303, + 0x81C, 0xA1440303, + 0x81C, 0xA0460303, + 0x81C, 0x83480303, + 0x81C, 0x824A0303, + 0x81C, 0x814C0303, + 0x81C, 0x644E0303, + 0x81C, 0x63500303, + 0x81C, 0x62520303, + 0x81C, 0x61540303, + 0x81C, 0x24560303, + 0x81C, 0x23580303, + 0x81C, 0x225A0303, + 0x81C, 0x215C0303, + 0x81C, 0x055E0303, + 0x81C, 0x04600303, + 0x81C, 0x03620303, + 0x81C, 0x02640303, + 0x81C, 0x01660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000010, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000303, + 0x81C, 0xFB020303, + 0x81C, 0xFA040303, + 0x81C, 0xF9060303, + 0x81C, 0xF8080303, + 0x81C, 0xF70A0303, + 0x81C, 0xF60C0303, + 0x81C, 0xF50E0303, + 0x81C, 0xF4100303, + 0x81C, 0xF3120303, + 0x81C, 0xF2140303, + 0x81C, 0xF1160303, + 0x81C, 0xF0180303, + 0x81C, 0xEF1A0303, + 0x81C, 0xEE1C0303, + 0x81C, 0xED1E0303, + 0x81C, 0xEC200303, + 0x81C, 0xEB220303, + 0x81C, 0xEA240303, + 0x81C, 0xE9260303, + 0x81C, 0xE8280303, + 0x81C, 0xE72A0303, + 0x81C, 0xE62C0303, + 0x81C, 0xE52E0303, + 0x81C, 0xE4300303, + 0x81C, 0xE3320303, + 0x81C, 0xE2340303, + 0x81C, 0xC6360303, + 0x81C, 0xC5380303, + 0x81C, 0xC43A0303, + 0x81C, 0xC33C0303, + 0x81C, 0xA63E0303, + 0x81C, 0xA5400303, + 0x81C, 0xA4420303, + 0x81C, 0xA3440303, + 0x81C, 0xA2460303, + 0x81C, 0x84480303, + 0x81C, 0x834A0303, + 0x81C, 0x824C0303, + 0x81C, 0x814E0303, + 0x81C, 0x80500303, + 0x81C, 0x63520303, + 0x81C, 0x62540303, + 0x81C, 0x61560303, + 0x81C, 0x60580303, + 0x81C, 0x225A0303, + 0x81C, 0x055C0303, + 0x81C, 0x045E0303, + 0x81C, 0x03600303, + 0x81C, 0x02620303, + 0x81C, 0x01640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0x90000012, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000303, + 0x81C, 0xF6020303, + 0x81C, 0xF5040303, + 0x81C, 0xF4060303, + 0x81C, 0xF3080303, + 0x81C, 0xF20A0303, + 0x81C, 0xF10C0303, + 0x81C, 0xF00E0303, + 0x81C, 0xEF100303, + 0x81C, 0xEE120303, + 0x81C, 0xED140303, + 0x81C, 0xEC160303, + 0x81C, 0xEB180303, + 0x81C, 0xEA1A0303, + 0x81C, 0xE91C0303, + 0x81C, 0xCA1E0303, + 0x81C, 0xC9200303, + 0x81C, 0xC8220303, + 0x81C, 0xC7240303, + 0x81C, 0xC6260303, + 0x81C, 0xC5280303, + 0x81C, 0xC42A0303, + 0x81C, 0xC32C0303, + 0x81C, 0xC22E0303, + 0x81C, 0xC1300303, + 0x81C, 0xA4320303, + 0x81C, 0xA3340303, + 0x81C, 0xA2360303, + 0x81C, 0xA1380303, + 0x81C, 0xA03A0303, + 0x81C, 0x823C0303, + 0x81C, 0x813E0303, + 0x81C, 0x80400303, + 0x81C, 0x64420303, + 0x81C, 0x63440303, + 0x81C, 0x62460303, + 0x81C, 0x61480303, + 0x81C, 0x604A0303, + 0x81C, 0x414C0303, + 0x81C, 0x404E0303, + 0x81C, 0x22500303, + 0x81C, 0x21520303, + 0x81C, 0x20540303, + 0x81C, 0x03560303, + 0x81C, 0x02580303, + 0x81C, 0x015A0303, + 0x81C, 0x005C0303, + 0x81C, 0x005E0303, + 0x81C, 0x00600303, + 0x81C, 0x00620303, + 0x81C, 0x00640303, + 0x81C, 0x00660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0xA0000000, 0x00000000, + 0x81C, 0xFC000303, + 0x81C, 0xFB020303, + 0x81C, 0xFA040303, + 0x81C, 0xF9060303, + 0x81C, 0xF8080303, + 0x81C, 0xF70A0303, + 0x81C, 0xF60C0303, + 0x81C, 0xF50E0303, + 0x81C, 0xF4100303, + 0x81C, 0xF3120303, + 0x81C, 0xF2140303, + 0x81C, 0xF1160303, + 0x81C, 0xF0180303, + 0x81C, 0xEF1A0303, + 0x81C, 0xEE1C0303, + 0x81C, 0xED1E0303, + 0x81C, 0xEC200303, + 0x81C, 0xEB220303, + 0x81C, 0xEA240303, + 0x81C, 0xE9260303, + 0x81C, 0xE8280303, + 0x81C, 0xE72A0303, + 0x81C, 0xE62C0303, + 0x81C, 0xE52E0303, + 0x81C, 0xE4300303, + 0x81C, 0xE3320303, + 0x81C, 0xE2340303, + 0x81C, 0xC6360303, + 0x81C, 0xC5380303, + 0x81C, 0xC43A0303, + 0x81C, 0xC33C0303, + 0x81C, 0xA63E0303, + 0x81C, 0xA5400303, + 0x81C, 0xA4420303, + 0x81C, 0xA3440303, + 0x81C, 0xA2460303, + 0x81C, 0x84480303, + 0x81C, 0x834A0303, + 0x81C, 0x824C0303, + 0x81C, 0x814E0303, + 0x81C, 0x80500303, + 0x81C, 0x63520303, + 0x81C, 0x62540303, + 0x81C, 0x61560303, + 0x81C, 0x60580303, + 0x81C, 0x235A0303, + 0x81C, 0x225C0303, + 0x81C, 0x215E0303, + 0x81C, 0x20600303, + 0x81C, 0x03620303, + 0x81C, 0x02640303, + 0x81C, 0x01660303, + 0x81C, 0x00680303, + 0x81C, 0x006A0303, + 0x81C, 0x006C0303, + 0x81C, 0x006E0303, + 0x81C, 0x00700303, + 0x81C, 0x00720303, + 0x81C, 0x00740303, + 0x81C, 0x00760303, + 0x81C, 0x00780303, + 0x81C, 0x007A0303, + 0x81C, 0x007C0303, + 0x81C, 0x007E0303, + 0xB0000000, 0x00000000, + 0x80000000, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xF5000403, + 0x81C, 0xF4020403, + 0x81C, 0xF3040403, + 0x81C, 0xF2060403, + 0x81C, 0xF1080403, + 0x81C, 0xF00A0403, + 0x81C, 0xEF0C0403, + 0x81C, 0xEE0E0403, + 0x81C, 0xED100403, + 0x81C, 0xEC120403, + 0x81C, 0xEB140403, + 0x81C, 0xEA160403, + 0x81C, 0xE9180403, + 0x81C, 0xE81A0403, + 0x81C, 0xE71C0403, + 0x81C, 0xE61E0403, + 0x81C, 0xE5200403, + 0x81C, 0xE4220403, + 0x81C, 0xE3240403, + 0x81C, 0xE2260403, + 0x81C, 0xE1280403, + 0x81C, 0xE02A0403, + 0x81C, 0xC32C0403, + 0x81C, 0xC22E0403, + 0x81C, 0xC1300403, + 0x81C, 0xC0320403, + 0x81C, 0xA4340403, + 0x81C, 0xA3360403, + 0x81C, 0xA2380403, + 0x81C, 0xA13A0403, + 0x81C, 0xA03C0403, + 0x81C, 0x823E0403, + 0x81C, 0x81400403, + 0x81C, 0x80420403, + 0x81C, 0x64440403, + 0x81C, 0x63460403, + 0x81C, 0x62480403, + 0x81C, 0x614A0403, + 0x81C, 0x604C0403, + 0x81C, 0x454E0403, + 0x81C, 0x44500403, + 0x81C, 0x43520403, + 0x81C, 0x42540403, + 0x81C, 0x41560403, + 0x81C, 0x40580403, + 0x81C, 0x055A0403, + 0x81C, 0x045C0403, + 0x81C, 0x035E0403, + 0x81C, 0x02600403, + 0x81C, 0x01620403, + 0x81C, 0x00640403, + 0x81C, 0x00660403, + 0x81C, 0x00680403, + 0x81C, 0x006A0403, + 0x81C, 0x006C0403, + 0x81C, 0x006E0403, + 0x81C, 0x00700403, + 0x81C, 0x00720403, + 0x81C, 0x00740403, + 0x81C, 0x00760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xF6000403, + 0x81C, 0xF5020403, + 0x81C, 0xF4040403, + 0x81C, 0xF3060403, + 0x81C, 0xF2080403, + 0x81C, 0xF10A0403, + 0x81C, 0xF00C0403, + 0x81C, 0xEF0E0403, + 0x81C, 0xD6100403, + 0x81C, 0xD5120403, + 0x81C, 0xD4140403, + 0x81C, 0xD3160403, + 0x81C, 0xD2180403, + 0x81C, 0xD11A0403, + 0x81C, 0xD01C0403, + 0x81C, 0xCF1E0403, + 0x81C, 0x95200403, + 0x81C, 0x94220403, + 0x81C, 0x93240403, + 0x81C, 0x92260403, + 0x81C, 0x91280403, + 0x81C, 0x902A0403, + 0x81C, 0x8F2C0403, + 0x81C, 0x8E2E0403, + 0x81C, 0x8D300403, + 0x81C, 0x8C320403, + 0x81C, 0x8B340403, + 0x81C, 0x8A360403, + 0x81C, 0x89380403, + 0x81C, 0x883A0403, + 0x81C, 0x873C0403, + 0x81C, 0x863E0403, + 0x81C, 0x68400403, + 0x81C, 0x67420403, + 0x81C, 0x66440403, + 0x81C, 0x65460403, + 0x81C, 0x64480403, + 0x81C, 0x634A0403, + 0x81C, 0x484C0403, + 0x81C, 0x474E0403, + 0x81C, 0x46500403, + 0x81C, 0x45520403, + 0x81C, 0x44540403, + 0x81C, 0x27560403, + 0x81C, 0x26580403, + 0x81C, 0x255A0403, + 0x81C, 0x245C0403, + 0x81C, 0x235E0403, + 0x81C, 0x04600403, + 0x81C, 0x03620403, + 0x81C, 0x02640403, + 0x81C, 0x01660403, + 0x81C, 0x00680403, + 0x81C, 0x006A0403, + 0x81C, 0x006C0403, + 0x81C, 0x006E0403, + 0x81C, 0x00700403, + 0x81C, 0x00720403, + 0x81C, 0x00740403, + 0x81C, 0x00760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xF5000403, + 0x81C, 0xF4020403, + 0x81C, 0xF3040403, + 0x81C, 0xF2060403, + 0x81C, 0xF1080403, + 0x81C, 0xF00A0403, + 0x81C, 0xEF0C0403, + 0x81C, 0xEE0E0403, + 0x81C, 0xED100403, + 0x81C, 0xEC120403, + 0x81C, 0xEB140403, + 0x81C, 0xEA160403, + 0x81C, 0xE9180403, + 0x81C, 0xE81A0403, + 0x81C, 0xE71C0403, + 0x81C, 0xE61E0403, + 0x81C, 0xE5200403, + 0x81C, 0xE4220403, + 0x81C, 0xE3240403, + 0x81C, 0xE2260403, + 0x81C, 0xE1280403, + 0x81C, 0xE02A0403, + 0x81C, 0xC32C0403, + 0x81C, 0xC22E0403, + 0x81C, 0xC1300403, + 0x81C, 0xC0320403, + 0x81C, 0xA4340403, + 0x81C, 0xA3360403, + 0x81C, 0xA2380403, + 0x81C, 0xA13A0403, + 0x81C, 0xA03C0403, + 0x81C, 0x823E0403, + 0x81C, 0x81400403, + 0x81C, 0x80420403, + 0x81C, 0x64440403, + 0x81C, 0x63460403, + 0x81C, 0x62480403, + 0x81C, 0x614A0403, + 0x81C, 0x604C0403, + 0x81C, 0x454E0403, + 0x81C, 0x44500403, + 0x81C, 0x43520403, + 0x81C, 0x42540403, + 0x81C, 0x41560403, + 0x81C, 0x40580403, + 0x81C, 0x055A0403, + 0x81C, 0x045C0403, + 0x81C, 0x035E0403, + 0x81C, 0x02600403, + 0x81C, 0x01620403, + 0x81C, 0x00640403, + 0x81C, 0x00660403, + 0x81C, 0x00680403, + 0x81C, 0x006A0403, + 0x81C, 0x006C0403, + 0x81C, 0x006E0403, + 0x81C, 0x00700403, + 0x81C, 0x00720403, + 0x81C, 0x00740403, + 0x81C, 0x00760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xF5000403, + 0x81C, 0xF4020403, + 0x81C, 0xF3040403, + 0x81C, 0xF2060403, + 0x81C, 0xF1080403, + 0x81C, 0xF00A0403, + 0x81C, 0xEF0C0403, + 0x81C, 0xEE0E0403, + 0x81C, 0xED100403, + 0x81C, 0xEC120403, + 0x81C, 0xEB140403, + 0x81C, 0xEA160403, + 0x81C, 0xE9180403, + 0x81C, 0xE81A0403, + 0x81C, 0xE71C0403, + 0x81C, 0xE61E0403, + 0x81C, 0xE5200403, + 0x81C, 0xE4220403, + 0x81C, 0xE3240403, + 0x81C, 0xE2260403, + 0x81C, 0xE1280403, + 0x81C, 0xE02A0403, + 0x81C, 0xC32C0403, + 0x81C, 0xC22E0403, + 0x81C, 0xC1300403, + 0x81C, 0xC0320403, + 0x81C, 0xA4340403, + 0x81C, 0xA3360403, + 0x81C, 0xA2380403, + 0x81C, 0xA13A0403, + 0x81C, 0xA03C0403, + 0x81C, 0x823E0403, + 0x81C, 0x81400403, + 0x81C, 0x80420403, + 0x81C, 0x64440403, + 0x81C, 0x63460403, + 0x81C, 0x62480403, + 0x81C, 0x614A0403, + 0x81C, 0x604C0403, + 0x81C, 0x454E0403, + 0x81C, 0x44500403, + 0x81C, 0x43520403, + 0x81C, 0x42540403, + 0x81C, 0x41560403, + 0x81C, 0x40580403, + 0x81C, 0x055A0403, + 0x81C, 0x045C0403, + 0x81C, 0x035E0403, + 0x81C, 0x02600403, + 0x81C, 0x01620403, + 0x81C, 0x00640403, + 0x81C, 0x00660403, + 0x81C, 0x00680403, + 0x81C, 0x006A0403, + 0x81C, 0x006C0403, + 0x81C, 0x006E0403, + 0x81C, 0x00700403, + 0x81C, 0x00720403, + 0x81C, 0x00740403, + 0x81C, 0x00760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000008, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000009, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xF5000403, + 0x81C, 0xF4020403, + 0x81C, 0xF3040403, + 0x81C, 0xF2060403, + 0x81C, 0xF1080403, + 0x81C, 0xF00A0403, + 0x81C, 0xEF0C0403, + 0x81C, 0xEE0E0403, + 0x81C, 0xED100403, + 0x81C, 0xEC120403, + 0x81C, 0xEB140403, + 0x81C, 0xEA160403, + 0x81C, 0xE9180403, + 0x81C, 0xE81A0403, + 0x81C, 0xE71C0403, + 0x81C, 0xE61E0403, + 0x81C, 0xE5200403, + 0x81C, 0xE4220403, + 0x81C, 0xE3240403, + 0x81C, 0xE2260403, + 0x81C, 0xE1280403, + 0x81C, 0xE02A0403, + 0x81C, 0xC32C0403, + 0x81C, 0xC22E0403, + 0x81C, 0xC1300403, + 0x81C, 0xC0320403, + 0x81C, 0xA4340403, + 0x81C, 0xA3360403, + 0x81C, 0xA2380403, + 0x81C, 0xA13A0403, + 0x81C, 0xA03C0403, + 0x81C, 0x823E0403, + 0x81C, 0x81400403, + 0x81C, 0x80420403, + 0x81C, 0x64440403, + 0x81C, 0x63460403, + 0x81C, 0x62480403, + 0x81C, 0x614A0403, + 0x81C, 0x604C0403, + 0x81C, 0x454E0403, + 0x81C, 0x44500403, + 0x81C, 0x43520403, + 0x81C, 0x42540403, + 0x81C, 0x41560403, + 0x81C, 0x40580403, + 0x81C, 0x055A0403, + 0x81C, 0x045C0403, + 0x81C, 0x035E0403, + 0x81C, 0x02600403, + 0x81C, 0x01620403, + 0x81C, 0x00640403, + 0x81C, 0x00660403, + 0x81C, 0x00680403, + 0x81C, 0x006A0403, + 0x81C, 0x006C0403, + 0x81C, 0x006E0403, + 0x81C, 0x00700403, + 0x81C, 0x00720403, + 0x81C, 0x00740403, + 0x81C, 0x00760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x9000000a, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x9000000b, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xF5000403, + 0x81C, 0xF4020403, + 0x81C, 0xF3040403, + 0x81C, 0xF2060403, + 0x81C, 0xF1080403, + 0x81C, 0xF00A0403, + 0x81C, 0xEF0C0403, + 0x81C, 0xEE0E0403, + 0x81C, 0xED100403, + 0x81C, 0xEC120403, + 0x81C, 0xEB140403, + 0x81C, 0xEA160403, + 0x81C, 0xE9180403, + 0x81C, 0xE81A0403, + 0x81C, 0xE71C0403, + 0x81C, 0xE61E0403, + 0x81C, 0xE5200403, + 0x81C, 0xE4220403, + 0x81C, 0xE3240403, + 0x81C, 0xE2260403, + 0x81C, 0xE1280403, + 0x81C, 0xE02A0403, + 0x81C, 0xC32C0403, + 0x81C, 0xC22E0403, + 0x81C, 0xC1300403, + 0x81C, 0xC0320403, + 0x81C, 0xA4340403, + 0x81C, 0xA3360403, + 0x81C, 0xA2380403, + 0x81C, 0xA13A0403, + 0x81C, 0xA03C0403, + 0x81C, 0x823E0403, + 0x81C, 0x81400403, + 0x81C, 0x80420403, + 0x81C, 0x64440403, + 0x81C, 0x63460403, + 0x81C, 0x62480403, + 0x81C, 0x614A0403, + 0x81C, 0x604C0403, + 0x81C, 0x454E0403, + 0x81C, 0x44500403, + 0x81C, 0x43520403, + 0x81C, 0x42540403, + 0x81C, 0x41560403, + 0x81C, 0x40580403, + 0x81C, 0x055A0403, + 0x81C, 0x045C0403, + 0x81C, 0x035E0403, + 0x81C, 0x02600403, + 0x81C, 0x01620403, + 0x81C, 0x00640403, + 0x81C, 0x00660403, + 0x81C, 0x00680403, + 0x81C, 0x006A0403, + 0x81C, 0x006C0403, + 0x81C, 0x006E0403, + 0x81C, 0x00700403, + 0x81C, 0x00720403, + 0x81C, 0x00740403, + 0x81C, 0x00760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x9000000c, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x9000000d, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x9000000e, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x9000000f, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000010, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0x90000012, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xF6000403, + 0x81C, 0xF5020403, + 0x81C, 0xF4040403, + 0x81C, 0xF3060403, + 0x81C, 0xF2080403, + 0x81C, 0xF10A0403, + 0x81C, 0xF00C0403, + 0x81C, 0xEF0E0403, + 0x81C, 0xD6100403, + 0x81C, 0xD5120403, + 0x81C, 0xD4140403, + 0x81C, 0xD3160403, + 0x81C, 0xD2180403, + 0x81C, 0xD11A0403, + 0x81C, 0xD01C0403, + 0x81C, 0xCF1E0403, + 0x81C, 0x95200403, + 0x81C, 0x94220403, + 0x81C, 0x93240403, + 0x81C, 0x92260403, + 0x81C, 0x91280403, + 0x81C, 0x902A0403, + 0x81C, 0x8F2C0403, + 0x81C, 0x8E2E0403, + 0x81C, 0x8D300403, + 0x81C, 0x8C320403, + 0x81C, 0x8B340403, + 0x81C, 0x8A360403, + 0x81C, 0x89380403, + 0x81C, 0x883A0403, + 0x81C, 0x873C0403, + 0x81C, 0x863E0403, + 0x81C, 0x68400403, + 0x81C, 0x67420403, + 0x81C, 0x66440403, + 0x81C, 0x65460403, + 0x81C, 0x64480403, + 0x81C, 0x634A0403, + 0x81C, 0x484C0403, + 0x81C, 0x474E0403, + 0x81C, 0x46500403, + 0x81C, 0x45520403, + 0x81C, 0x44540403, + 0x81C, 0x27560403, + 0x81C, 0x26580403, + 0x81C, 0x255A0403, + 0x81C, 0x245C0403, + 0x81C, 0x235E0403, + 0x81C, 0x04600403, + 0x81C, 0x03620403, + 0x81C, 0x02640403, + 0x81C, 0x01660403, + 0x81C, 0x00680403, + 0x81C, 0x006A0403, + 0x81C, 0x006C0403, + 0x81C, 0x006E0403, + 0x81C, 0x00700403, + 0x81C, 0x00720403, + 0x81C, 0x00740403, + 0x81C, 0x00760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0xA0000000, 0x00000000, + 0x81C, 0xFF000403, + 0x81C, 0xFF000403, + 0x81C, 0xFF020403, + 0x81C, 0xFE040403, + 0x81C, 0xFD060403, + 0x81C, 0xFC080403, + 0x81C, 0xFB0A0403, + 0x81C, 0xFA0C0403, + 0x81C, 0xF90E0403, + 0x81C, 0xF8100403, + 0x81C, 0xF7120403, + 0x81C, 0xF6140403, + 0x81C, 0xF5160403, + 0x81C, 0xF4180403, + 0x81C, 0xF31A0403, + 0x81C, 0xF21C0403, + 0x81C, 0xD51E0403, + 0x81C, 0xD4200403, + 0x81C, 0xD3220403, + 0x81C, 0xD2240403, + 0x81C, 0xB6260403, + 0x81C, 0xB5280403, + 0x81C, 0xB42A0403, + 0x81C, 0xB32C0403, + 0x81C, 0xB22E0403, + 0x81C, 0xB1300403, + 0x81C, 0xB0320403, + 0x81C, 0xAF340403, + 0x81C, 0xAE360403, + 0x81C, 0xAD380403, + 0x81C, 0xAC3A0403, + 0x81C, 0xAB3C0403, + 0x81C, 0xAA3E0403, + 0x81C, 0xA9400403, + 0x81C, 0xA8420403, + 0x81C, 0xA7440403, + 0x81C, 0xA6460403, + 0x81C, 0xA5480403, + 0x81C, 0xA44A0403, + 0x81C, 0xA34C0403, + 0x81C, 0x854E0403, + 0x81C, 0x84500403, + 0x81C, 0x83520403, + 0x81C, 0x82540403, + 0x81C, 0x81560403, + 0x81C, 0x80580403, + 0x81C, 0x485A0403, + 0x81C, 0x475C0403, + 0x81C, 0x465E0403, + 0x81C, 0x45600403, + 0x81C, 0x44620403, + 0x81C, 0x0A640403, + 0x81C, 0x09660403, + 0x81C, 0x08680403, + 0x81C, 0x076A0403, + 0x81C, 0x066C0403, + 0x81C, 0x056E0403, + 0x81C, 0x04700403, + 0x81C, 0x03720403, + 0x81C, 0x02740403, + 0x81C, 0x01760403, + 0x81C, 0x00780403, + 0x81C, 0x007A0403, + 0x81C, 0x007C0403, + 0x81C, 0x007E0403, + 0xB0000000, 0x00000000, + 0x80000000, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000503, + 0x81C, 0xFC020503, + 0x81C, 0xFB040503, + 0x81C, 0xFA060503, + 0x81C, 0xF9080503, + 0x81C, 0xF80A0503, + 0x81C, 0xF70C0503, + 0x81C, 0xF60E0503, + 0x81C, 0xF5100503, + 0x81C, 0xF4120503, + 0x81C, 0xF3140503, + 0x81C, 0xF2160503, + 0x81C, 0xF1180503, + 0x81C, 0xF01A0503, + 0x81C, 0xEE1C0503, + 0x81C, 0xED1E0503, + 0x81C, 0xEC200503, + 0x81C, 0xEB220503, + 0x81C, 0xEA240503, + 0x81C, 0xE9260503, + 0x81C, 0xE8280503, + 0x81C, 0xE72A0503, + 0x81C, 0xE62C0503, + 0x81C, 0xE52E0503, + 0x81C, 0xE4300503, + 0x81C, 0xE3320503, + 0x81C, 0xE2340503, + 0x81C, 0xC5360503, + 0x81C, 0xC4380503, + 0x81C, 0xC33A0503, + 0x81C, 0xC23C0503, + 0x81C, 0xA53E0503, + 0x81C, 0xA4400503, + 0x81C, 0xA3420503, + 0x81C, 0xA2440503, + 0x81C, 0xA1460503, + 0x81C, 0x83480503, + 0x81C, 0x824A0503, + 0x81C, 0x814C0503, + 0x81C, 0x804E0503, + 0x81C, 0x63500503, + 0x81C, 0x62520503, + 0x81C, 0x61540503, + 0x81C, 0x43560503, + 0x81C, 0x42580503, + 0x81C, 0x415A0503, + 0x81C, 0x405C0503, + 0x81C, 0x225E0503, + 0x81C, 0x21600503, + 0x81C, 0x20620503, + 0x81C, 0x03640503, + 0x81C, 0x02660503, + 0x81C, 0x01680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xBE000503, + 0x81C, 0xBD020503, + 0x81C, 0xBC040503, + 0x81C, 0xBB060503, + 0x81C, 0xBA080503, + 0x81C, 0xB90A0503, + 0x81C, 0xB80C0503, + 0x81C, 0xB70E0503, + 0x81C, 0xB6100503, + 0x81C, 0xB5120503, + 0x81C, 0xB4140503, + 0x81C, 0xB3160503, + 0x81C, 0xB2180503, + 0x81C, 0xB11A0503, + 0x81C, 0xB01C0503, + 0x81C, 0xAF1E0503, + 0x81C, 0xAE200503, + 0x81C, 0xAD220503, + 0x81C, 0xAC240503, + 0x81C, 0xAB260503, + 0x81C, 0x8D280503, + 0x81C, 0x8C2A0503, + 0x81C, 0x8B2C0503, + 0x81C, 0x8A2E0503, + 0x81C, 0x89300503, + 0x81C, 0x88320503, + 0x81C, 0x6A340503, + 0x81C, 0x69360503, + 0x81C, 0x68380503, + 0x81C, 0x673A0503, + 0x81C, 0x663C0503, + 0x81C, 0x653E0503, + 0x81C, 0x64400503, + 0x81C, 0x63420503, + 0x81C, 0x62440503, + 0x81C, 0x61460503, + 0x81C, 0x60480503, + 0x81C, 0x424A0503, + 0x81C, 0x414C0503, + 0x81C, 0x404E0503, + 0x81C, 0x06500503, + 0x81C, 0x05520503, + 0x81C, 0x04540503, + 0x81C, 0x03560503, + 0x81C, 0x02580503, + 0x81C, 0x015A0503, + 0x81C, 0x005C0503, + 0x81C, 0x005E0503, + 0x81C, 0x00600503, + 0x81C, 0x00620503, + 0x81C, 0x00640503, + 0x81C, 0x00660503, + 0x81C, 0x00680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007C0503, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000503, + 0x81C, 0xF7020503, + 0x81C, 0xF6040503, + 0x81C, 0xF5060503, + 0x81C, 0xF4080503, + 0x81C, 0xF30A0503, + 0x81C, 0xF20C0503, + 0x81C, 0xF10E0503, + 0x81C, 0xF0100503, + 0x81C, 0xEF120503, + 0x81C, 0xEE140503, + 0x81C, 0xED160503, + 0x81C, 0xEC180503, + 0x81C, 0xEB1A0503, + 0x81C, 0xEA1C0503, + 0x81C, 0xE91E0503, + 0x81C, 0xE8200503, + 0x81C, 0xE7220503, + 0x81C, 0xE6240503, + 0x81C, 0xE5260503, + 0x81C, 0xE4280503, + 0x81C, 0xE32A0503, + 0x81C, 0xC32C0503, + 0x81C, 0xC22E0503, + 0x81C, 0xC1300503, + 0x81C, 0xC0320503, + 0x81C, 0xA3340503, + 0x81C, 0xA2360503, + 0x81C, 0xA1380503, + 0x81C, 0xA03A0503, + 0x81C, 0x823C0503, + 0x81C, 0x813E0503, + 0x81C, 0x80400503, + 0x81C, 0x63420503, + 0x81C, 0x62440503, + 0x81C, 0x61460503, + 0x81C, 0x60480503, + 0x81C, 0x424A0503, + 0x81C, 0x414C0503, + 0x81C, 0x404E0503, + 0x81C, 0x22500503, + 0x81C, 0x21520503, + 0x81C, 0x20540503, + 0x81C, 0x03560503, + 0x81C, 0x02580503, + 0x81C, 0x015A0503, + 0x81C, 0x005C0503, + 0x81C, 0x005E0503, + 0x81C, 0x00600503, + 0x81C, 0x00620503, + 0x81C, 0x00640503, + 0x81C, 0x00660503, + 0x81C, 0x00680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFE000503, + 0x81C, 0xFD020503, + 0x81C, 0xFC040503, + 0x81C, 0xFB060503, + 0x81C, 0xFA080503, + 0x81C, 0xF90A0503, + 0x81C, 0xF80C0503, + 0x81C, 0xF70E0503, + 0x81C, 0xF6100503, + 0x81C, 0xF5120503, + 0x81C, 0xF4140503, + 0x81C, 0xF3160503, + 0x81C, 0xF2180503, + 0x81C, 0xF11A0503, + 0x81C, 0xF01C0503, + 0x81C, 0xEF1E0503, + 0x81C, 0xEE200503, + 0x81C, 0xED220503, + 0x81C, 0xEC240503, + 0x81C, 0xEB260503, + 0x81C, 0xEA280503, + 0x81C, 0xE92A0503, + 0x81C, 0xE82C0503, + 0x81C, 0xE72E0503, + 0x81C, 0xE6300503, + 0x81C, 0xE5320503, + 0x81C, 0xE4340503, + 0x81C, 0xE3360503, + 0x81C, 0xC6380503, + 0x81C, 0xC53A0503, + 0x81C, 0xC43C0503, + 0x81C, 0xC33E0503, + 0x81C, 0xA5400503, + 0x81C, 0xA4420503, + 0x81C, 0xA3440503, + 0x81C, 0xA2460503, + 0x81C, 0xA1480503, + 0x81C, 0xA04A0503, + 0x81C, 0x824C0503, + 0x81C, 0x814E0503, + 0x81C, 0x80500503, + 0x81C, 0x64520503, + 0x81C, 0x63540503, + 0x81C, 0x62560503, + 0x81C, 0x61580503, + 0x81C, 0x605A0503, + 0x81C, 0x235C0503, + 0x81C, 0x225E0503, + 0x81C, 0x21600503, + 0x81C, 0x20620503, + 0x81C, 0x03640503, + 0x81C, 0x02660503, + 0x81C, 0x01680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000503, + 0x81C, 0xF7020503, + 0x81C, 0xF6040503, + 0x81C, 0xF5060503, + 0x81C, 0xF4080503, + 0x81C, 0xF30A0503, + 0x81C, 0xF20C0503, + 0x81C, 0xF10E0503, + 0x81C, 0xF0100503, + 0x81C, 0xEF120503, + 0x81C, 0xEE140503, + 0x81C, 0xED160503, + 0x81C, 0xEC180503, + 0x81C, 0xEB1A0503, + 0x81C, 0xEA1C0503, + 0x81C, 0xE91E0503, + 0x81C, 0xE8200503, + 0x81C, 0xE7220503, + 0x81C, 0xE6240503, + 0x81C, 0xE5260503, + 0x81C, 0xE4280503, + 0x81C, 0xE32A0503, + 0x81C, 0xC32C0503, + 0x81C, 0xC22E0503, + 0x81C, 0xC1300503, + 0x81C, 0xC0320503, + 0x81C, 0xA3340503, + 0x81C, 0xA2360503, + 0x81C, 0xA1380503, + 0x81C, 0xA03A0503, + 0x81C, 0x823C0503, + 0x81C, 0x813E0503, + 0x81C, 0x80400503, + 0x81C, 0x63420503, + 0x81C, 0x62440503, + 0x81C, 0x61460503, + 0x81C, 0x60480503, + 0x81C, 0x424A0503, + 0x81C, 0x414C0503, + 0x81C, 0x404E0503, + 0x81C, 0x22500503, + 0x81C, 0x21520503, + 0x81C, 0x20540503, + 0x81C, 0x03560503, + 0x81C, 0x02580503, + 0x81C, 0x015A0503, + 0x81C, 0x005C0503, + 0x81C, 0x005E0503, + 0x81C, 0x00600503, + 0x81C, 0x00620503, + 0x81C, 0x00640503, + 0x81C, 0x00660503, + 0x81C, 0x00680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000503, + 0x81C, 0xFC020503, + 0x81C, 0xFB040503, + 0x81C, 0xFA060503, + 0x81C, 0xF9080503, + 0x81C, 0xF80A0503, + 0x81C, 0xF70C0503, + 0x81C, 0xF60E0503, + 0x81C, 0xF5100503, + 0x81C, 0xF4120503, + 0x81C, 0xF3140503, + 0x81C, 0xF2160503, + 0x81C, 0xF1180503, + 0x81C, 0xF01A0503, + 0x81C, 0xEF1C0503, + 0x81C, 0xEE1E0503, + 0x81C, 0xED200503, + 0x81C, 0xEC220503, + 0x81C, 0xEB240503, + 0x81C, 0xEA260503, + 0x81C, 0xE9280503, + 0x81C, 0xE82A0503, + 0x81C, 0xE72C0503, + 0x81C, 0xE62E0503, + 0x81C, 0xE5300503, + 0x81C, 0xE4320503, + 0x81C, 0xE3340503, + 0x81C, 0xE2360503, + 0x81C, 0xC5380503, + 0x81C, 0xC43A0503, + 0x81C, 0xC33C0503, + 0x81C, 0xC23E0503, + 0x81C, 0xA5400503, + 0x81C, 0xA4420503, + 0x81C, 0xA3440503, + 0x81C, 0xA2460503, + 0x81C, 0xA1480503, + 0x81C, 0x834A0503, + 0x81C, 0x824C0503, + 0x81C, 0x814E0503, + 0x81C, 0x64500503, + 0x81C, 0x63520503, + 0x81C, 0x62540503, + 0x81C, 0x61560503, + 0x81C, 0x42580503, + 0x81C, 0x415A0503, + 0x81C, 0x405C0503, + 0x81C, 0x065E0503, + 0x81C, 0x05600503, + 0x81C, 0x04620503, + 0x81C, 0x03640503, + 0x81C, 0x02660503, + 0x81C, 0x01680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFA000503, + 0x81C, 0xF9020503, + 0x81C, 0xF8040503, + 0x81C, 0xF7060503, + 0x81C, 0xF6080503, + 0x81C, 0xF50A0503, + 0x81C, 0xF40C0503, + 0x81C, 0xF30E0503, + 0x81C, 0xF2100503, + 0x81C, 0xF1120503, + 0x81C, 0xF0140503, + 0x81C, 0xEF160503, + 0x81C, 0xEE180503, + 0x81C, 0xED1A0503, + 0x81C, 0xEC1C0503, + 0x81C, 0xEB1E0503, + 0x81C, 0xEA200503, + 0x81C, 0xE9220503, + 0x81C, 0xE8240503, + 0x81C, 0xE7260503, + 0x81C, 0xE6280503, + 0x81C, 0xE52A0503, + 0x81C, 0xC42C0503, + 0x81C, 0xC32E0503, + 0x81C, 0xC2300503, + 0x81C, 0xC1320503, + 0x81C, 0xA4340503, + 0x81C, 0xA3360503, + 0x81C, 0xA2380503, + 0x81C, 0xA13A0503, + 0x81C, 0x833C0503, + 0x81C, 0x823E0503, + 0x81C, 0x81400503, + 0x81C, 0x63420503, + 0x81C, 0x62440503, + 0x81C, 0x61460503, + 0x81C, 0x60480503, + 0x81C, 0x424A0503, + 0x81C, 0x414C0503, + 0x81C, 0x404E0503, + 0x81C, 0x22500503, + 0x81C, 0x21520503, + 0x81C, 0x20540503, + 0x81C, 0x03560503, + 0x81C, 0x02580503, + 0x81C, 0x015A0503, + 0x81C, 0x005C0503, + 0x81C, 0x005E0503, + 0x81C, 0x00600503, + 0x81C, 0x00620503, + 0x81C, 0x00640503, + 0x81C, 0x00660503, + 0x81C, 0x00680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xBF000503, + 0x81C, 0xBE020503, + 0x81C, 0xBD040503, + 0x81C, 0xBC060503, + 0x81C, 0xBB080503, + 0x81C, 0xBA0A0503, + 0x81C, 0xB90C0503, + 0x81C, 0xB80E0503, + 0x81C, 0xB7100503, + 0x81C, 0xB6120503, + 0x81C, 0xB5140503, + 0x81C, 0xB4160503, + 0x81C, 0xB3180503, + 0x81C, 0xB21A0503, + 0x81C, 0xB11C0503, + 0x81C, 0x931E0503, + 0x81C, 0x92200503, + 0x81C, 0x91220503, + 0x81C, 0x90240503, + 0x81C, 0x8F260503, + 0x81C, 0x8E280503, + 0x81C, 0x8D2A0503, + 0x81C, 0x8C2C0503, + 0x81C, 0x8B2E0503, + 0x81C, 0x8A300503, + 0x81C, 0x89320503, + 0x81C, 0x88340503, + 0x81C, 0x6A360503, + 0x81C, 0x69380503, + 0x81C, 0x683A0503, + 0x81C, 0x673C0503, + 0x81C, 0x663E0503, + 0x81C, 0x65400503, + 0x81C, 0x64420503, + 0x81C, 0x63440503, + 0x81C, 0x62460503, + 0x81C, 0x61480503, + 0x81C, 0x604A0503, + 0x81C, 0x424C0503, + 0x81C, 0x414E0503, + 0x81C, 0x40500503, + 0x81C, 0x06520503, + 0x81C, 0x05540503, + 0x81C, 0x04560503, + 0x81C, 0x03580503, + 0x81C, 0x025A0503, + 0x81C, 0x015C0503, + 0x81C, 0x005E0503, + 0x81C, 0x00600503, + 0x81C, 0x00620503, + 0x81C, 0x00640503, + 0x81C, 0x00660503, + 0x81C, 0x00680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x90000008, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000503, + 0x81C, 0xFC020503, + 0x81C, 0xFB040503, + 0x81C, 0xFA060503, + 0x81C, 0xF9080503, + 0x81C, 0xF80A0503, + 0x81C, 0xF70C0503, + 0x81C, 0xF60E0503, + 0x81C, 0xF5100503, + 0x81C, 0xF4120503, + 0x81C, 0xF3140503, + 0x81C, 0xF2160503, + 0x81C, 0xF1180503, + 0x81C, 0xF01A0503, + 0x81C, 0xEF1C0503, + 0x81C, 0xEE1E0503, + 0x81C, 0xED200503, + 0x81C, 0xEC220503, + 0x81C, 0xEB240503, + 0x81C, 0xEA260503, + 0x81C, 0xE9280503, + 0x81C, 0xE82A0503, + 0x81C, 0xE72C0503, + 0x81C, 0xE62E0503, + 0x81C, 0xE5300503, + 0x81C, 0xE4320503, + 0x81C, 0xE3340503, + 0x81C, 0xC6360503, + 0x81C, 0xC5380503, + 0x81C, 0xC43A0503, + 0x81C, 0xC33C0503, + 0x81C, 0xC23E0503, + 0x81C, 0xA5400503, + 0x81C, 0xA4420503, + 0x81C, 0xA3440503, + 0x81C, 0xA2460503, + 0x81C, 0xA1480503, + 0x81C, 0x834A0503, + 0x81C, 0x824C0503, + 0x81C, 0x814E0503, + 0x81C, 0x63500503, + 0x81C, 0x62520503, + 0x81C, 0x61540503, + 0x81C, 0x43560503, + 0x81C, 0x42580503, + 0x81C, 0x245A0503, + 0x81C, 0x235C0503, + 0x81C, 0x225E0503, + 0x81C, 0x21600503, + 0x81C, 0x04620503, + 0x81C, 0x03640503, + 0x81C, 0x02660503, + 0x81C, 0x01680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x90000009, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000503, + 0x81C, 0xF7020503, + 0x81C, 0xF6040503, + 0x81C, 0xF5060503, + 0x81C, 0xF4080503, + 0x81C, 0xF30A0503, + 0x81C, 0xF20C0503, + 0x81C, 0xF10E0503, + 0x81C, 0xF0100503, + 0x81C, 0xEF120503, + 0x81C, 0xEE140503, + 0x81C, 0xED160503, + 0x81C, 0xEC180503, + 0x81C, 0xEB1A0503, + 0x81C, 0xEA1C0503, + 0x81C, 0xE91E0503, + 0x81C, 0xE8200503, + 0x81C, 0xE7220503, + 0x81C, 0xE6240503, + 0x81C, 0xE5260503, + 0x81C, 0xE4280503, + 0x81C, 0xE32A0503, + 0x81C, 0xE22C0503, + 0x81C, 0xC32E0503, + 0x81C, 0xC2300503, + 0x81C, 0xC1320503, + 0x81C, 0xA3340503, + 0x81C, 0xA2360503, + 0x81C, 0xA1380503, + 0x81C, 0xA03A0503, + 0x81C, 0x823C0503, + 0x81C, 0x813E0503, + 0x81C, 0x80400503, + 0x81C, 0x64420503, + 0x81C, 0x63440503, + 0x81C, 0x62460503, + 0x81C, 0x61480503, + 0x81C, 0x434A0503, + 0x81C, 0x424C0503, + 0x81C, 0x414E0503, + 0x81C, 0x40500503, + 0x81C, 0x22520503, + 0x81C, 0x21540503, + 0x81C, 0x20560503, + 0x81C, 0x04580503, + 0x81C, 0x035A0503, + 0x81C, 0x025C0503, + 0x81C, 0x015E0503, + 0x81C, 0x00600503, + 0x81C, 0x00620503, + 0x81C, 0x00640503, + 0x81C, 0x00660503, + 0x81C, 0x00680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x9000000a, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000503, + 0x81C, 0xFC020503, + 0x81C, 0xFB040503, + 0x81C, 0xFA060503, + 0x81C, 0xF9080503, + 0x81C, 0xF80A0503, + 0x81C, 0xF70C0503, + 0x81C, 0xF60E0503, + 0x81C, 0xF5100503, + 0x81C, 0xF4120503, + 0x81C, 0xF3140503, + 0x81C, 0xF2160503, + 0x81C, 0xF1180503, + 0x81C, 0xF01A0503, + 0x81C, 0xEE1C0503, + 0x81C, 0xED1E0503, + 0x81C, 0xEC200503, + 0x81C, 0xEB220503, + 0x81C, 0xEA240503, + 0x81C, 0xE9260503, + 0x81C, 0xE8280503, + 0x81C, 0xE72A0503, + 0x81C, 0xE62C0503, + 0x81C, 0xE52E0503, + 0x81C, 0xE4300503, + 0x81C, 0xE3320503, + 0x81C, 0xE2340503, + 0x81C, 0xC5360503, + 0x81C, 0xC4380503, + 0x81C, 0xC33A0503, + 0x81C, 0xC23C0503, + 0x81C, 0xA53E0503, + 0x81C, 0xA4400503, + 0x81C, 0xA3420503, + 0x81C, 0xA2440503, + 0x81C, 0xA1460503, + 0x81C, 0x83480503, + 0x81C, 0x824A0503, + 0x81C, 0x814C0503, + 0x81C, 0x804E0503, + 0x81C, 0x63500503, + 0x81C, 0x62520503, + 0x81C, 0x61540503, + 0x81C, 0x43560503, + 0x81C, 0x42580503, + 0x81C, 0x415A0503, + 0x81C, 0x405C0503, + 0x81C, 0x225E0503, + 0x81C, 0x21600503, + 0x81C, 0x20620503, + 0x81C, 0x03640503, + 0x81C, 0x02660503, + 0x81C, 0x01680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x9000000b, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF9000503, + 0x81C, 0xF8020503, + 0x81C, 0xF7040503, + 0x81C, 0xF6060503, + 0x81C, 0xF5080503, + 0x81C, 0xF40A0503, + 0x81C, 0xF30C0503, + 0x81C, 0xF20E0503, + 0x81C, 0xF1100503, + 0x81C, 0xF0120503, + 0x81C, 0xEF140503, + 0x81C, 0xEE160503, + 0x81C, 0xED180503, + 0x81C, 0xEC1A0503, + 0x81C, 0xEB1C0503, + 0x81C, 0xEA1E0503, + 0x81C, 0xE9200503, + 0x81C, 0xE8220503, + 0x81C, 0xE7240503, + 0x81C, 0xE6260503, + 0x81C, 0xE5280503, + 0x81C, 0xE42A0503, + 0x81C, 0xE32C0503, + 0x81C, 0xC32E0503, + 0x81C, 0xC2300503, + 0x81C, 0xC1320503, + 0x81C, 0xA4340503, + 0x81C, 0xA3360503, + 0x81C, 0xA2380503, + 0x81C, 0xA13A0503, + 0x81C, 0xA03C0503, + 0x81C, 0x823E0503, + 0x81C, 0x81400503, + 0x81C, 0x80420503, + 0x81C, 0x63440503, + 0x81C, 0x62460503, + 0x81C, 0x61480503, + 0x81C, 0x604A0503, + 0x81C, 0x244C0503, + 0x81C, 0x234E0503, + 0x81C, 0x22500503, + 0x81C, 0x21520503, + 0x81C, 0x20540503, + 0x81C, 0x05560503, + 0x81C, 0x04580503, + 0x81C, 0x035A0503, + 0x81C, 0x025C0503, + 0x81C, 0x015E0503, + 0x81C, 0x00600503, + 0x81C, 0x00620503, + 0x81C, 0x00640503, + 0x81C, 0x00660503, + 0x81C, 0x00680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x9000000c, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFE000503, + 0x81C, 0xFD020503, + 0x81C, 0xFC040503, + 0x81C, 0xFB060503, + 0x81C, 0xFA080503, + 0x81C, 0xF90A0503, + 0x81C, 0xF80C0503, + 0x81C, 0xF70E0503, + 0x81C, 0xF6100503, + 0x81C, 0xF5120503, + 0x81C, 0xF4140503, + 0x81C, 0xF3160503, + 0x81C, 0xF2180503, + 0x81C, 0xF11A0503, + 0x81C, 0xF01C0503, + 0x81C, 0xEF1E0503, + 0x81C, 0xEE200503, + 0x81C, 0xED220503, + 0x81C, 0xEC240503, + 0x81C, 0xEB260503, + 0x81C, 0xEA280503, + 0x81C, 0xE92A0503, + 0x81C, 0xE82C0503, + 0x81C, 0xE72E0503, + 0x81C, 0xE6300503, + 0x81C, 0xE5320503, + 0x81C, 0xE4340503, + 0x81C, 0xE3360503, + 0x81C, 0xC6380503, + 0x81C, 0xC53A0503, + 0x81C, 0xC43C0503, + 0x81C, 0xC33E0503, + 0x81C, 0xA5400503, + 0x81C, 0xA4420503, + 0x81C, 0xA3440503, + 0x81C, 0xA2460503, + 0x81C, 0xA1480503, + 0x81C, 0xA04A0503, + 0x81C, 0x824C0503, + 0x81C, 0x814E0503, + 0x81C, 0x80500503, + 0x81C, 0x64520503, + 0x81C, 0x63540503, + 0x81C, 0x62560503, + 0x81C, 0x61580503, + 0x81C, 0x605A0503, + 0x81C, 0x235C0503, + 0x81C, 0x225E0503, + 0x81C, 0x21600503, + 0x81C, 0x20620503, + 0x81C, 0x03640503, + 0x81C, 0x02660503, + 0x81C, 0x01680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x9000000d, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000503, + 0x81C, 0xFC020503, + 0x81C, 0xFB040503, + 0x81C, 0xFA060503, + 0x81C, 0xF9080503, + 0x81C, 0xF80A0503, + 0x81C, 0xF70C0503, + 0x81C, 0xF60E0503, + 0x81C, 0xF5100503, + 0x81C, 0xF4120503, + 0x81C, 0xF3140503, + 0x81C, 0xF2160503, + 0x81C, 0xF1180503, + 0x81C, 0xF01A0503, + 0x81C, 0xEE1C0503, + 0x81C, 0xED1E0503, + 0x81C, 0xEC200503, + 0x81C, 0xEB220503, + 0x81C, 0xEA240503, + 0x81C, 0xE9260503, + 0x81C, 0xE8280503, + 0x81C, 0xE72A0503, + 0x81C, 0xE62C0503, + 0x81C, 0xE52E0503, + 0x81C, 0xE4300503, + 0x81C, 0xE3320503, + 0x81C, 0xE2340503, + 0x81C, 0xC5360503, + 0x81C, 0xC4380503, + 0x81C, 0xC33A0503, + 0x81C, 0xC23C0503, + 0x81C, 0xA53E0503, + 0x81C, 0xA4400503, + 0x81C, 0xA3420503, + 0x81C, 0xA2440503, + 0x81C, 0xA1460503, + 0x81C, 0x83480503, + 0x81C, 0x824A0503, + 0x81C, 0x814C0503, + 0x81C, 0x804E0503, + 0x81C, 0x63500503, + 0x81C, 0x62520503, + 0x81C, 0x61540503, + 0x81C, 0x43560503, + 0x81C, 0x42580503, + 0x81C, 0x415A0503, + 0x81C, 0x405C0503, + 0x81C, 0x225E0503, + 0x81C, 0x21600503, + 0x81C, 0x20620503, + 0x81C, 0x03640503, + 0x81C, 0x02660503, + 0x81C, 0x01680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x9000000e, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFD000503, + 0x81C, 0xFC020503, + 0x81C, 0xFB040503, + 0x81C, 0xFA060503, + 0x81C, 0xF9080503, + 0x81C, 0xF80A0503, + 0x81C, 0xF70C0503, + 0x81C, 0xF60E0503, + 0x81C, 0xF5100503, + 0x81C, 0xF4120503, + 0x81C, 0xF3140503, + 0x81C, 0xF2160503, + 0x81C, 0xF1180503, + 0x81C, 0xF01A0503, + 0x81C, 0xEE1C0503, + 0x81C, 0xED1E0503, + 0x81C, 0xEC200503, + 0x81C, 0xEB220503, + 0x81C, 0xEA240503, + 0x81C, 0xE9260503, + 0x81C, 0xE8280503, + 0x81C, 0xE72A0503, + 0x81C, 0xE62C0503, + 0x81C, 0xE52E0503, + 0x81C, 0xE4300503, + 0x81C, 0xE3320503, + 0x81C, 0xE2340503, + 0x81C, 0xC5360503, + 0x81C, 0xC4380503, + 0x81C, 0xC33A0503, + 0x81C, 0xC23C0503, + 0x81C, 0xA53E0503, + 0x81C, 0xA4400503, + 0x81C, 0xA3420503, + 0x81C, 0xA2440503, + 0x81C, 0xA1460503, + 0x81C, 0x83480503, + 0x81C, 0x824A0503, + 0x81C, 0x814C0503, + 0x81C, 0x804E0503, + 0x81C, 0x63500503, + 0x81C, 0x62520503, + 0x81C, 0x61540503, + 0x81C, 0x43560503, + 0x81C, 0x42580503, + 0x81C, 0x415A0503, + 0x81C, 0x405C0503, + 0x81C, 0x225E0503, + 0x81C, 0x21600503, + 0x81C, 0x20620503, + 0x81C, 0x03640503, + 0x81C, 0x02660503, + 0x81C, 0x01680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x9000000f, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xBF000503, + 0x81C, 0xBF020503, + 0x81C, 0xBF040503, + 0x81C, 0xBF060503, + 0x81C, 0xBF080503, + 0x81C, 0xBF0A0503, + 0x81C, 0xBE0C0503, + 0x81C, 0xBD0E0503, + 0x81C, 0xBC100503, + 0x81C, 0xBB120503, + 0x81C, 0xBA140503, + 0x81C, 0xB9160503, + 0x81C, 0xB8180503, + 0x81C, 0xB71A0503, + 0x81C, 0xB61C0503, + 0x81C, 0xB51E0503, + 0x81C, 0xB2200503, + 0x81C, 0xB3220503, + 0x81C, 0xB2240503, + 0x81C, 0xB1260503, + 0x81C, 0xB0280503, + 0x81C, 0xAF2A0503, + 0x81C, 0xAE2C0503, + 0x81C, 0xAD2E0503, + 0x81C, 0xAC300503, + 0x81C, 0xAB320503, + 0x81C, 0xAA340503, + 0x81C, 0xC6360503, + 0x81C, 0xC5380503, + 0x81C, 0xC43A0503, + 0x81C, 0xC33C0503, + 0x81C, 0x883E0503, + 0x81C, 0x87400503, + 0x81C, 0x86420503, + 0x81C, 0x85440503, + 0x81C, 0x84460503, + 0x81C, 0x83480503, + 0x81C, 0x674A0503, + 0x81C, 0x664C0503, + 0x81C, 0x654E0503, + 0x81C, 0x64500503, + 0x81C, 0x27520503, + 0x81C, 0x26540503, + 0x81C, 0x25560503, + 0x81C, 0x24580503, + 0x81C, 0x235A0503, + 0x81C, 0x225C0503, + 0x81C, 0x215E0503, + 0x81C, 0x20600503, + 0x81C, 0x03620503, + 0x81C, 0x02640503, + 0x81C, 0x01660503, + 0x81C, 0x00680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0x90000010, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFE000403, + 0x81C, 0xFD000503, + 0x81C, 0xFC020503, + 0x81C, 0xFB040503, + 0x81C, 0xFA060503, + 0x81C, 0xF9080503, + 0x81C, 0xF80A0503, + 0x81C, 0xF70C0503, + 0x81C, 0xF60E0503, + 0x81C, 0xF5100503, + 0x81C, 0xF4120503, + 0x81C, 0xF3140503, + 0x81C, 0xF2160503, + 0x81C, 0xF1180503, + 0x81C, 0xF01A0503, + 0x81C, 0xEF1C0503, + 0x81C, 0xEE1E0503, + 0x81C, 0xED200503, + 0x81C, 0xEC220503, + 0x81C, 0xEB240503, + 0x81C, 0xEA260503, + 0x81C, 0xE9280503, + 0x81C, 0xE82A0503, + 0x81C, 0xE72C0503, + 0x81C, 0xE62E0503, + 0x81C, 0xE5300503, + 0x81C, 0xE4320503, + 0x81C, 0xE3340503, + 0x81C, 0xC6360503, + 0x81C, 0xC5380503, + 0x81C, 0xC43A0503, + 0x81C, 0xC33C0503, + 0x81C, 0xA53E0503, + 0x81C, 0xA4400503, + 0x81C, 0xA3420503, + 0x81C, 0xA2440503, + 0x81C, 0xA1460503, + 0x81C, 0xA0480503, + 0x81C, 0x824A0503, + 0x81C, 0x814C0503, + 0x81C, 0x804E0503, + 0x81C, 0x64500503, + 0x81C, 0x63520503, + 0x81C, 0x62540503, + 0x81C, 0x61560503, + 0x81C, 0x60580503, + 0x81C, 0x235A0503, + 0x81C, 0x225C0503, + 0x81C, 0x215E0503, + 0x81C, 0x20600503, + 0x81C, 0x03620503, + 0x81C, 0x02640503, + 0x81C, 0x01660503, + 0x81C, 0x00680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x90000012, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000503, + 0x81C, 0xF7020503, + 0x81C, 0xF6040503, + 0x81C, 0xF5060503, + 0x81C, 0xF4080503, + 0x81C, 0xF30A0503, + 0x81C, 0xF20C0503, + 0x81C, 0xF10E0503, + 0x81C, 0xF0100503, + 0x81C, 0xEF120503, + 0x81C, 0xEE140503, + 0x81C, 0xED160503, + 0x81C, 0xEC180503, + 0x81C, 0xEB1A0503, + 0x81C, 0xEA1C0503, + 0x81C, 0xE91E0503, + 0x81C, 0xE8200503, + 0x81C, 0xE7220503, + 0x81C, 0xE6240503, + 0x81C, 0xE5260503, + 0x81C, 0xE4280503, + 0x81C, 0xE32A0503, + 0x81C, 0xC32C0503, + 0x81C, 0xC22E0503, + 0x81C, 0xC1300503, + 0x81C, 0xC0320503, + 0x81C, 0xA3340503, + 0x81C, 0xA2360503, + 0x81C, 0xA1380503, + 0x81C, 0xA03A0503, + 0x81C, 0x823C0503, + 0x81C, 0x813E0503, + 0x81C, 0x80400503, + 0x81C, 0x63420503, + 0x81C, 0x62440503, + 0x81C, 0x61460503, + 0x81C, 0x60480503, + 0x81C, 0x424A0503, + 0x81C, 0x414C0503, + 0x81C, 0x404E0503, + 0x81C, 0x22500503, + 0x81C, 0x21520503, + 0x81C, 0x20540503, + 0x81C, 0x03560503, + 0x81C, 0x02580503, + 0x81C, 0x015A0503, + 0x81C, 0x005C0503, + 0x81C, 0x005E0503, + 0x81C, 0x00600503, + 0x81C, 0x00620503, + 0x81C, 0x00640503, + 0x81C, 0x00660503, + 0x81C, 0x00680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0xA0000000, 0x00000000, + 0x81C, 0xFE000503, + 0x81C, 0xFD020503, + 0x81C, 0xFC040503, + 0x81C, 0xFB060503, + 0x81C, 0xFA080503, + 0x81C, 0xF90A0503, + 0x81C, 0xF80C0503, + 0x81C, 0xF70E0503, + 0x81C, 0xF6100503, + 0x81C, 0xF5120503, + 0x81C, 0xF4140503, + 0x81C, 0xF3160503, + 0x81C, 0xF2180503, + 0x81C, 0xF11A0503, + 0x81C, 0xF01C0503, + 0x81C, 0xEF1E0503, + 0x81C, 0xEE200503, + 0x81C, 0xED220503, + 0x81C, 0xEC240503, + 0x81C, 0xEB260503, + 0x81C, 0xEA280503, + 0x81C, 0xE92A0503, + 0x81C, 0xE82C0503, + 0x81C, 0xE72E0503, + 0x81C, 0xE6300503, + 0x81C, 0xE5320503, + 0x81C, 0xE4340503, + 0x81C, 0xE3360503, + 0x81C, 0xC6380503, + 0x81C, 0xC53A0503, + 0x81C, 0xC43C0503, + 0x81C, 0xC33E0503, + 0x81C, 0xA5400503, + 0x81C, 0xA4420503, + 0x81C, 0xA3440503, + 0x81C, 0xA2460503, + 0x81C, 0xA1480503, + 0x81C, 0xA04A0503, + 0x81C, 0x824C0503, + 0x81C, 0x814E0503, + 0x81C, 0x80500503, + 0x81C, 0x64520503, + 0x81C, 0x63540503, + 0x81C, 0x62560503, + 0x81C, 0x61580503, + 0x81C, 0x605A0503, + 0x81C, 0x235C0503, + 0x81C, 0x225E0503, + 0x81C, 0x21600503, + 0x81C, 0x20620503, + 0x81C, 0x03640503, + 0x81C, 0x02660503, + 0x81C, 0x01680503, + 0x81C, 0x006A0503, + 0x81C, 0x006C0503, + 0x81C, 0x006E0503, + 0x81C, 0x00700503, + 0x81C, 0x00720503, + 0x81C, 0x00740503, + 0x81C, 0x00760503, + 0x81C, 0x00780503, + 0x81C, 0x007A0503, + 0x81C, 0x007C0503, + 0x81C, 0x007E0503, + 0x81C, 0x007E0503, + 0xB0000000, 0x00000000, + 0x80000000, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000603, + 0x81C, 0xFB020603, + 0x81C, 0xFA040603, + 0x81C, 0xF9060603, + 0x81C, 0xF8080603, + 0x81C, 0xF70A0603, + 0x81C, 0xF60C0603, + 0x81C, 0xF50E0603, + 0x81C, 0xF4100603, + 0x81C, 0xF3120603, + 0x81C, 0xF2140603, + 0x81C, 0xF1160603, + 0x81C, 0xF0180603, + 0x81C, 0xEE1A0603, + 0x81C, 0xED1C0603, + 0x81C, 0xEC1E0603, + 0x81C, 0xEB200603, + 0x81C, 0xEA220603, + 0x81C, 0xE9240603, + 0x81C, 0xE8260603, + 0x81C, 0xE7280603, + 0x81C, 0xE62A0603, + 0x81C, 0xE52C0603, + 0x81C, 0xE42E0603, + 0x81C, 0xE3300603, + 0x81C, 0xE2320603, + 0x81C, 0xC6340603, + 0x81C, 0xC5360603, + 0x81C, 0xC4380603, + 0x81C, 0xC33A0603, + 0x81C, 0xA63C0603, + 0x81C, 0xA53E0603, + 0x81C, 0xA4400603, + 0x81C, 0xA3420603, + 0x81C, 0xA2440603, + 0x81C, 0xA1460603, + 0x81C, 0x83480603, + 0x81C, 0x824A0603, + 0x81C, 0x814C0603, + 0x81C, 0x804E0603, + 0x81C, 0x63500603, + 0x81C, 0x62520603, + 0x81C, 0x61540603, + 0x81C, 0x42560603, + 0x81C, 0x41580603, + 0x81C, 0x405A0603, + 0x81C, 0x225C0603, + 0x81C, 0x215E0603, + 0x81C, 0x20600603, + 0x81C, 0x04620603, + 0x81C, 0x03640603, + 0x81C, 0x02660603, + 0x81C, 0x01680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xBD000603, + 0x81C, 0xBC020603, + 0x81C, 0xBB040603, + 0x81C, 0xBA060603, + 0x81C, 0xB9080603, + 0x81C, 0xB80A0603, + 0x81C, 0xB70C0603, + 0x81C, 0xB60E0603, + 0x81C, 0xB5100603, + 0x81C, 0xB4120603, + 0x81C, 0xB3140603, + 0x81C, 0xB2160603, + 0x81C, 0xB1180603, + 0x81C, 0xB01A0603, + 0x81C, 0xAF1C0603, + 0x81C, 0xAE1E0603, + 0x81C, 0xAD200603, + 0x81C, 0x8F220603, + 0x81C, 0x8E240603, + 0x81C, 0x8D260603, + 0x81C, 0x8C280603, + 0x81C, 0x8B2A0603, + 0x81C, 0x8A2C0603, + 0x81C, 0x892E0603, + 0x81C, 0x88300603, + 0x81C, 0x6B320603, + 0x81C, 0x6A340603, + 0x81C, 0x69360603, + 0x81C, 0x68380603, + 0x81C, 0x673A0603, + 0x81C, 0x663C0603, + 0x81C, 0x653E0603, + 0x81C, 0x64400603, + 0x81C, 0x63420603, + 0x81C, 0x62440603, + 0x81C, 0x61460603, + 0x81C, 0x60480603, + 0x81C, 0x424A0603, + 0x81C, 0x414C0603, + 0x81C, 0x404E0603, + 0x81C, 0x06500603, + 0x81C, 0x05520603, + 0x81C, 0x04540603, + 0x81C, 0x03560603, + 0x81C, 0x02580603, + 0x81C, 0x015A0603, + 0x81C, 0x005C0603, + 0x81C, 0x005E0603, + 0x81C, 0x00600603, + 0x81C, 0x00620603, + 0x81C, 0x00640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007C0603, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000603, + 0x81C, 0xF6020603, + 0x81C, 0xF5040603, + 0x81C, 0xF4060603, + 0x81C, 0xF3080603, + 0x81C, 0xF20A0603, + 0x81C, 0xF10C0603, + 0x81C, 0xF00E0603, + 0x81C, 0xEF100603, + 0x81C, 0xEE120603, + 0x81C, 0xED140603, + 0x81C, 0xEC160603, + 0x81C, 0xEB180603, + 0x81C, 0xEA1A0603, + 0x81C, 0xE91C0603, + 0x81C, 0xE81E0603, + 0x81C, 0xE7200603, + 0x81C, 0xE6220603, + 0x81C, 0xE5240603, + 0x81C, 0xE4260603, + 0x81C, 0xE3280603, + 0x81C, 0xC42A0603, + 0x81C, 0xC32C0603, + 0x81C, 0xC22E0603, + 0x81C, 0xC1300603, + 0x81C, 0xC0320603, + 0x81C, 0xA3340603, + 0x81C, 0xA2360603, + 0x81C, 0xA1380603, + 0x81C, 0xA03A0603, + 0x81C, 0x823C0603, + 0x81C, 0x813E0603, + 0x81C, 0x80400603, + 0x81C, 0x64420603, + 0x81C, 0x63440603, + 0x81C, 0x62460603, + 0x81C, 0x61480603, + 0x81C, 0x604A0603, + 0x81C, 0x414C0603, + 0x81C, 0x404E0603, + 0x81C, 0x22500603, + 0x81C, 0x21520603, + 0x81C, 0x20540603, + 0x81C, 0x03560603, + 0x81C, 0x02580603, + 0x81C, 0x015A0603, + 0x81C, 0x005C0603, + 0x81C, 0x005E0603, + 0x81C, 0x00600603, + 0x81C, 0x00620603, + 0x81C, 0x00640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000603, + 0x81C, 0xFB020603, + 0x81C, 0xFA040603, + 0x81C, 0xF9060603, + 0x81C, 0xF8080603, + 0x81C, 0xF70A0603, + 0x81C, 0xF60C0603, + 0x81C, 0xF50E0603, + 0x81C, 0xF4100603, + 0x81C, 0xF3120603, + 0x81C, 0xF2140603, + 0x81C, 0xF1160603, + 0x81C, 0xF0180603, + 0x81C, 0xEF1A0603, + 0x81C, 0xEE1C0603, + 0x81C, 0xED1E0603, + 0x81C, 0xEC200603, + 0x81C, 0xEB220603, + 0x81C, 0xEA240603, + 0x81C, 0xE9260603, + 0x81C, 0xE8280603, + 0x81C, 0xE72A0603, + 0x81C, 0xE62C0603, + 0x81C, 0xE52E0603, + 0x81C, 0xE4300603, + 0x81C, 0xE3320603, + 0x81C, 0xE2340603, + 0x81C, 0xC6360603, + 0x81C, 0xC5380603, + 0x81C, 0xC43A0603, + 0x81C, 0xC33C0603, + 0x81C, 0xA63E0603, + 0x81C, 0xA5400603, + 0x81C, 0xA4420603, + 0x81C, 0xA3440603, + 0x81C, 0xA2460603, + 0x81C, 0xA1480603, + 0x81C, 0x834A0603, + 0x81C, 0x824C0603, + 0x81C, 0x814E0603, + 0x81C, 0x64500603, + 0x81C, 0x63520603, + 0x81C, 0x62540603, + 0x81C, 0x61560603, + 0x81C, 0x60580603, + 0x81C, 0x405A0603, + 0x81C, 0x215C0603, + 0x81C, 0x205E0603, + 0x81C, 0x03600603, + 0x81C, 0x02620603, + 0x81C, 0x01640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000603, + 0x81C, 0xF6020603, + 0x81C, 0xF5040603, + 0x81C, 0xF4060603, + 0x81C, 0xF3080603, + 0x81C, 0xF20A0603, + 0x81C, 0xF10C0603, + 0x81C, 0xF00E0603, + 0x81C, 0xEF100603, + 0x81C, 0xEE120603, + 0x81C, 0xED140603, + 0x81C, 0xEC160603, + 0x81C, 0xEB180603, + 0x81C, 0xEA1A0603, + 0x81C, 0xE91C0603, + 0x81C, 0xE81E0603, + 0x81C, 0xE7200603, + 0x81C, 0xE6220603, + 0x81C, 0xE5240603, + 0x81C, 0xE4260603, + 0x81C, 0xE3280603, + 0x81C, 0xC42A0603, + 0x81C, 0xC32C0603, + 0x81C, 0xC22E0603, + 0x81C, 0xC1300603, + 0x81C, 0xC0320603, + 0x81C, 0xA3340603, + 0x81C, 0xA2360603, + 0x81C, 0xA1380603, + 0x81C, 0xA03A0603, + 0x81C, 0x823C0603, + 0x81C, 0x813E0603, + 0x81C, 0x80400603, + 0x81C, 0x64420603, + 0x81C, 0x63440603, + 0x81C, 0x62460603, + 0x81C, 0x61480603, + 0x81C, 0x604A0603, + 0x81C, 0x414C0603, + 0x81C, 0x404E0603, + 0x81C, 0x22500603, + 0x81C, 0x21520603, + 0x81C, 0x20540603, + 0x81C, 0x03560603, + 0x81C, 0x02580603, + 0x81C, 0x015A0603, + 0x81C, 0x005C0603, + 0x81C, 0x005E0603, + 0x81C, 0x00600603, + 0x81C, 0x00620603, + 0x81C, 0x00640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000603, + 0x81C, 0xFB020603, + 0x81C, 0xFA040603, + 0x81C, 0xF9060603, + 0x81C, 0xF8080603, + 0x81C, 0xF70A0603, + 0x81C, 0xF60C0603, + 0x81C, 0xF50E0603, + 0x81C, 0xF4100603, + 0x81C, 0xF3120603, + 0x81C, 0xF2140603, + 0x81C, 0xF1160603, + 0x81C, 0xF0180603, + 0x81C, 0xEF1A0603, + 0x81C, 0xEE1C0603, + 0x81C, 0xED1E0603, + 0x81C, 0xEC200603, + 0x81C, 0xEB220603, + 0x81C, 0xEA240603, + 0x81C, 0xE9260603, + 0x81C, 0xE8280603, + 0x81C, 0xE72A0603, + 0x81C, 0xE62C0603, + 0x81C, 0xE52E0603, + 0x81C, 0xE4300603, + 0x81C, 0xE3320603, + 0x81C, 0xE2340603, + 0x81C, 0xE1360603, + 0x81C, 0xC5380603, + 0x81C, 0xC43A0603, + 0x81C, 0xC33C0603, + 0x81C, 0xC23E0603, + 0x81C, 0xC1400603, + 0x81C, 0xA3420603, + 0x81C, 0xA2440603, + 0x81C, 0xA1460603, + 0x81C, 0xA0480603, + 0x81C, 0x834A0603, + 0x81C, 0x824C0603, + 0x81C, 0x814E0603, + 0x81C, 0x64500603, + 0x81C, 0x63520603, + 0x81C, 0x62540603, + 0x81C, 0x61560603, + 0x81C, 0x25580603, + 0x81C, 0x245A0603, + 0x81C, 0x235C0603, + 0x81C, 0x225E0603, + 0x81C, 0x21600603, + 0x81C, 0x04620603, + 0x81C, 0x03640603, + 0x81C, 0x02660603, + 0x81C, 0x01680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF9000603, + 0x81C, 0xF8020603, + 0x81C, 0xF7040603, + 0x81C, 0xF6060603, + 0x81C, 0xF5080603, + 0x81C, 0xF40A0603, + 0x81C, 0xF30C0603, + 0x81C, 0xF20E0603, + 0x81C, 0xF1100603, + 0x81C, 0xF0120603, + 0x81C, 0xEF140603, + 0x81C, 0xEE160603, + 0x81C, 0xED180603, + 0x81C, 0xEC1A0603, + 0x81C, 0xEB1C0603, + 0x81C, 0xEA1E0603, + 0x81C, 0xE9200603, + 0x81C, 0xE8220603, + 0x81C, 0xE7240603, + 0x81C, 0xE6260603, + 0x81C, 0xE5280603, + 0x81C, 0xC42A0603, + 0x81C, 0xC32C0603, + 0x81C, 0xC22E0603, + 0x81C, 0xC1300603, + 0x81C, 0xC0320603, + 0x81C, 0xA3340603, + 0x81C, 0xA2360603, + 0x81C, 0xA1380603, + 0x81C, 0xA03A0603, + 0x81C, 0x823C0603, + 0x81C, 0x813E0603, + 0x81C, 0x80400603, + 0x81C, 0x64420603, + 0x81C, 0x63440603, + 0x81C, 0x62460603, + 0x81C, 0x61480603, + 0x81C, 0x604A0603, + 0x81C, 0x414C0603, + 0x81C, 0x404E0603, + 0x81C, 0x22500603, + 0x81C, 0x21520603, + 0x81C, 0x20540603, + 0x81C, 0x03560603, + 0x81C, 0x02580603, + 0x81C, 0x015A0603, + 0x81C, 0x005C0603, + 0x81C, 0x005E0603, + 0x81C, 0x00600603, + 0x81C, 0x00620603, + 0x81C, 0x00640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xBE000603, + 0x81C, 0xBD020603, + 0x81C, 0xBC040603, + 0x81C, 0xBB060603, + 0x81C, 0xBA080603, + 0x81C, 0xB90A0603, + 0x81C, 0xB80C0603, + 0x81C, 0xB70E0603, + 0x81C, 0xB6100603, + 0x81C, 0xB5120603, + 0x81C, 0xB4140603, + 0x81C, 0xB3160603, + 0x81C, 0xB2180603, + 0x81C, 0xB11A0603, + 0x81C, 0xB01C0603, + 0x81C, 0x921E0603, + 0x81C, 0x91200603, + 0x81C, 0x90220603, + 0x81C, 0x8F240603, + 0x81C, 0x8E260603, + 0x81C, 0x8D280603, + 0x81C, 0x8C2A0603, + 0x81C, 0x8B2C0603, + 0x81C, 0x8A2E0603, + 0x81C, 0x89300603, + 0x81C, 0x88320603, + 0x81C, 0x6B340603, + 0x81C, 0x6A360603, + 0x81C, 0x69380603, + 0x81C, 0x683A0603, + 0x81C, 0x673C0603, + 0x81C, 0x663E0603, + 0x81C, 0x65400603, + 0x81C, 0x64420603, + 0x81C, 0x63440603, + 0x81C, 0x62460603, + 0x81C, 0x61480603, + 0x81C, 0x604A0603, + 0x81C, 0x424C0603, + 0x81C, 0x414E0603, + 0x81C, 0x40500603, + 0x81C, 0x06520603, + 0x81C, 0x05540603, + 0x81C, 0x04560603, + 0x81C, 0x03580603, + 0x81C, 0x025A0603, + 0x81C, 0x015C0603, + 0x81C, 0x005E0603, + 0x81C, 0x00600603, + 0x81C, 0x00620603, + 0x81C, 0x00640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x90000008, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000603, + 0x81C, 0xFA020603, + 0x81C, 0xF9040603, + 0x81C, 0xF8060603, + 0x81C, 0xF7080603, + 0x81C, 0xF60A0603, + 0x81C, 0xF50C0603, + 0x81C, 0xF40E0603, + 0x81C, 0xF3100603, + 0x81C, 0xF2120603, + 0x81C, 0xF1140603, + 0x81C, 0xF0160603, + 0x81C, 0xEF180603, + 0x81C, 0xEE1A0603, + 0x81C, 0xED1C0603, + 0x81C, 0xEC1E0603, + 0x81C, 0xEB200603, + 0x81C, 0xEA220603, + 0x81C, 0xE9240603, + 0x81C, 0xE8260603, + 0x81C, 0xE7280603, + 0x81C, 0xE62A0603, + 0x81C, 0xE52C0603, + 0x81C, 0xE42E0603, + 0x81C, 0xE3300603, + 0x81C, 0xE2320603, + 0x81C, 0xC6340603, + 0x81C, 0xC5360603, + 0x81C, 0xC4380603, + 0x81C, 0xC33A0603, + 0x81C, 0xC23C0603, + 0x81C, 0xC13E0603, + 0x81C, 0xC0400603, + 0x81C, 0xA3420603, + 0x81C, 0xA2440603, + 0x81C, 0xA1460603, + 0x81C, 0xA0480603, + 0x81C, 0x824A0603, + 0x81C, 0x814C0603, + 0x81C, 0x804E0603, + 0x81C, 0x63500603, + 0x81C, 0x62520603, + 0x81C, 0x61540603, + 0x81C, 0x60560603, + 0x81C, 0x24580603, + 0x81C, 0x235A0603, + 0x81C, 0x225C0603, + 0x81C, 0x215E0603, + 0x81C, 0x20600603, + 0x81C, 0x03620603, + 0x81C, 0x02640603, + 0x81C, 0x01660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x90000009, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000603, + 0x81C, 0xF7020603, + 0x81C, 0xF6040603, + 0x81C, 0xF5060603, + 0x81C, 0xF4080603, + 0x81C, 0xF30A0603, + 0x81C, 0xF20C0603, + 0x81C, 0xF10E0603, + 0x81C, 0xF0100603, + 0x81C, 0xEF120603, + 0x81C, 0xEE140603, + 0x81C, 0xED160603, + 0x81C, 0xEC180603, + 0x81C, 0xEB1A0603, + 0x81C, 0xEA1C0603, + 0x81C, 0xE91E0603, + 0x81C, 0xE8200603, + 0x81C, 0xE7220603, + 0x81C, 0xE6240603, + 0x81C, 0xE5260603, + 0x81C, 0xE4280603, + 0x81C, 0xE32A0603, + 0x81C, 0xC42C0603, + 0x81C, 0xC32E0603, + 0x81C, 0xC2300603, + 0x81C, 0xC1320603, + 0x81C, 0xA3340603, + 0x81C, 0xA2360603, + 0x81C, 0xA1380603, + 0x81C, 0xA03A0603, + 0x81C, 0x823C0603, + 0x81C, 0x813E0603, + 0x81C, 0x80400603, + 0x81C, 0x65420603, + 0x81C, 0x64440603, + 0x81C, 0x63460603, + 0x81C, 0x62480603, + 0x81C, 0x614A0603, + 0x81C, 0x424C0603, + 0x81C, 0x414E0603, + 0x81C, 0x40500603, + 0x81C, 0x22520603, + 0x81C, 0x21540603, + 0x81C, 0x20560603, + 0x81C, 0x04580603, + 0x81C, 0x035A0603, + 0x81C, 0x025C0603, + 0x81C, 0x015E0603, + 0x81C, 0x00600603, + 0x81C, 0x00620603, + 0x81C, 0x00640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x9000000a, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000603, + 0x81C, 0xFB020603, + 0x81C, 0xFA040603, + 0x81C, 0xF9060603, + 0x81C, 0xF8080603, + 0x81C, 0xF70A0603, + 0x81C, 0xF60C0603, + 0x81C, 0xF50E0603, + 0x81C, 0xF4100603, + 0x81C, 0xF3120603, + 0x81C, 0xF2140603, + 0x81C, 0xF1160603, + 0x81C, 0xF0180603, + 0x81C, 0xEE1A0603, + 0x81C, 0xED1C0603, + 0x81C, 0xEC1E0603, + 0x81C, 0xEB200603, + 0x81C, 0xEA220603, + 0x81C, 0xE9240603, + 0x81C, 0xE8260603, + 0x81C, 0xE7280603, + 0x81C, 0xE62A0603, + 0x81C, 0xE52C0603, + 0x81C, 0xE42E0603, + 0x81C, 0xE3300603, + 0x81C, 0xE2320603, + 0x81C, 0xC6340603, + 0x81C, 0xC5360603, + 0x81C, 0xC4380603, + 0x81C, 0xC33A0603, + 0x81C, 0xA63C0603, + 0x81C, 0xA53E0603, + 0x81C, 0xA4400603, + 0x81C, 0xA3420603, + 0x81C, 0xA2440603, + 0x81C, 0xA1460603, + 0x81C, 0x83480603, + 0x81C, 0x824A0603, + 0x81C, 0x814C0603, + 0x81C, 0x804E0603, + 0x81C, 0x63500603, + 0x81C, 0x62520603, + 0x81C, 0x61540603, + 0x81C, 0x42560603, + 0x81C, 0x41580603, + 0x81C, 0x405A0603, + 0x81C, 0x225C0603, + 0x81C, 0x215E0603, + 0x81C, 0x20600603, + 0x81C, 0x04620603, + 0x81C, 0x03640603, + 0x81C, 0x02660603, + 0x81C, 0x01680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x9000000b, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF9000603, + 0x81C, 0xF8020603, + 0x81C, 0xF7040603, + 0x81C, 0xF6060603, + 0x81C, 0xF5080603, + 0x81C, 0xF40A0603, + 0x81C, 0xF30C0603, + 0x81C, 0xF20E0603, + 0x81C, 0xF1100603, + 0x81C, 0xF0120603, + 0x81C, 0xEF140603, + 0x81C, 0xEE160603, + 0x81C, 0xED180603, + 0x81C, 0xEC1A0603, + 0x81C, 0xEB1C0603, + 0x81C, 0xEA1E0603, + 0x81C, 0xE9200603, + 0x81C, 0xE8220603, + 0x81C, 0xE7240603, + 0x81C, 0xE6260603, + 0x81C, 0xE5280603, + 0x81C, 0xE42A0603, + 0x81C, 0xC42C0603, + 0x81C, 0xC32E0603, + 0x81C, 0xC2300603, + 0x81C, 0xC1320603, + 0x81C, 0xA3340603, + 0x81C, 0xA2360603, + 0x81C, 0xA1380603, + 0x81C, 0xA03A0603, + 0x81C, 0x823C0603, + 0x81C, 0x813E0603, + 0x81C, 0x80400603, + 0x81C, 0x64420603, + 0x81C, 0x63440603, + 0x81C, 0x62460603, + 0x81C, 0x61480603, + 0x81C, 0x604A0603, + 0x81C, 0x244C0603, + 0x81C, 0x234E0603, + 0x81C, 0x22500603, + 0x81C, 0x21520603, + 0x81C, 0x20540603, + 0x81C, 0x05560603, + 0x81C, 0x04580603, + 0x81C, 0x035A0603, + 0x81C, 0x025C0603, + 0x81C, 0x015E0603, + 0x81C, 0x00600603, + 0x81C, 0x00620603, + 0x81C, 0x00640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x9000000c, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000603, + 0x81C, 0xFB020603, + 0x81C, 0xFA040603, + 0x81C, 0xF9060603, + 0x81C, 0xF8080603, + 0x81C, 0xF70A0603, + 0x81C, 0xF60C0603, + 0x81C, 0xF50E0603, + 0x81C, 0xF4100603, + 0x81C, 0xF3120603, + 0x81C, 0xF2140603, + 0x81C, 0xF1160603, + 0x81C, 0xF0180603, + 0x81C, 0xEF1A0603, + 0x81C, 0xEE1C0603, + 0x81C, 0xED1E0603, + 0x81C, 0xEC200603, + 0x81C, 0xEB220603, + 0x81C, 0xEA240603, + 0x81C, 0xE9260603, + 0x81C, 0xE8280603, + 0x81C, 0xE72A0603, + 0x81C, 0xE62C0603, + 0x81C, 0xE52E0603, + 0x81C, 0xE4300603, + 0x81C, 0xE3320603, + 0x81C, 0xE2340603, + 0x81C, 0xC6360603, + 0x81C, 0xC5380603, + 0x81C, 0xC43A0603, + 0x81C, 0xC33C0603, + 0x81C, 0xA63E0603, + 0x81C, 0xA5400603, + 0x81C, 0xA4420603, + 0x81C, 0xA3440603, + 0x81C, 0xA2460603, + 0x81C, 0xA1480603, + 0x81C, 0x834A0603, + 0x81C, 0x824C0603, + 0x81C, 0x814E0603, + 0x81C, 0x64500603, + 0x81C, 0x63520603, + 0x81C, 0x62540603, + 0x81C, 0x61560603, + 0x81C, 0x60580603, + 0x81C, 0x405A0603, + 0x81C, 0x215C0603, + 0x81C, 0x205E0603, + 0x81C, 0x03600603, + 0x81C, 0x02620603, + 0x81C, 0x01640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x9000000d, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000603, + 0x81C, 0xFB020603, + 0x81C, 0xFA040603, + 0x81C, 0xF9060603, + 0x81C, 0xF8080603, + 0x81C, 0xF70A0603, + 0x81C, 0xF60C0603, + 0x81C, 0xF50E0603, + 0x81C, 0xF4100603, + 0x81C, 0xF3120603, + 0x81C, 0xF2140603, + 0x81C, 0xF1160603, + 0x81C, 0xF0180603, + 0x81C, 0xEE1A0603, + 0x81C, 0xED1C0603, + 0x81C, 0xEC1E0603, + 0x81C, 0xEB200603, + 0x81C, 0xEA220603, + 0x81C, 0xE9240603, + 0x81C, 0xE8260603, + 0x81C, 0xE7280603, + 0x81C, 0xE62A0603, + 0x81C, 0xE52C0603, + 0x81C, 0xE42E0603, + 0x81C, 0xE3300603, + 0x81C, 0xE2320603, + 0x81C, 0xC6340603, + 0x81C, 0xC5360603, + 0x81C, 0xC4380603, + 0x81C, 0xC33A0603, + 0x81C, 0xA63C0603, + 0x81C, 0xA53E0603, + 0x81C, 0xA4400603, + 0x81C, 0xA3420603, + 0x81C, 0xA2440603, + 0x81C, 0xA1460603, + 0x81C, 0x83480603, + 0x81C, 0x824A0603, + 0x81C, 0x814C0603, + 0x81C, 0x804E0603, + 0x81C, 0x63500603, + 0x81C, 0x62520603, + 0x81C, 0x61540603, + 0x81C, 0x42560603, + 0x81C, 0x41580603, + 0x81C, 0x405A0603, + 0x81C, 0x225C0603, + 0x81C, 0x215E0603, + 0x81C, 0x20600603, + 0x81C, 0x04620603, + 0x81C, 0x03640603, + 0x81C, 0x02660603, + 0x81C, 0x01680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x9000000e, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000603, + 0x81C, 0xFB020603, + 0x81C, 0xFA040603, + 0x81C, 0xF9060603, + 0x81C, 0xF8080603, + 0x81C, 0xF70A0603, + 0x81C, 0xF60C0603, + 0x81C, 0xF50E0603, + 0x81C, 0xF4100603, + 0x81C, 0xF3120603, + 0x81C, 0xF2140603, + 0x81C, 0xF1160603, + 0x81C, 0xF0180603, + 0x81C, 0xEE1A0603, + 0x81C, 0xED1C0603, + 0x81C, 0xEC1E0603, + 0x81C, 0xEB200603, + 0x81C, 0xEA220603, + 0x81C, 0xE9240603, + 0x81C, 0xE8260603, + 0x81C, 0xE7280603, + 0x81C, 0xE62A0603, + 0x81C, 0xE52C0603, + 0x81C, 0xE42E0603, + 0x81C, 0xE3300603, + 0x81C, 0xE2320603, + 0x81C, 0xC6340603, + 0x81C, 0xC5360603, + 0x81C, 0xC4380603, + 0x81C, 0xC33A0603, + 0x81C, 0xA63C0603, + 0x81C, 0xA53E0603, + 0x81C, 0xA4400603, + 0x81C, 0xA3420603, + 0x81C, 0xA2440603, + 0x81C, 0xA1460603, + 0x81C, 0x83480603, + 0x81C, 0x824A0603, + 0x81C, 0x814C0603, + 0x81C, 0x804E0603, + 0x81C, 0x63500603, + 0x81C, 0x62520603, + 0x81C, 0x61540603, + 0x81C, 0x42560603, + 0x81C, 0x41580603, + 0x81C, 0x405A0603, + 0x81C, 0x225C0603, + 0x81C, 0x215E0603, + 0x81C, 0x20600603, + 0x81C, 0x04620603, + 0x81C, 0x03640603, + 0x81C, 0x02660603, + 0x81C, 0x01680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x9000000f, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xBF000603, + 0x81C, 0xBF020603, + 0x81C, 0xBF040603, + 0x81C, 0xBF060603, + 0x81C, 0xBF080603, + 0x81C, 0xBE0A0603, + 0x81C, 0xBD0C0603, + 0x81C, 0xBC0E0603, + 0x81C, 0xBB100603, + 0x81C, 0xBA120603, + 0x81C, 0xB9140603, + 0x81C, 0xB8160603, + 0x81C, 0xB7180603, + 0x81C, 0xB61A0603, + 0x81C, 0xB51C0603, + 0x81C, 0xB41E0603, + 0x81C, 0xB1200603, + 0x81C, 0xB2220603, + 0x81C, 0xB1240603, + 0x81C, 0xB0260603, + 0x81C, 0xAF280603, + 0x81C, 0xAE2A0603, + 0x81C, 0xAD2C0603, + 0x81C, 0xAC2E0603, + 0x81C, 0xAB300603, + 0x81C, 0xAA320603, + 0x81C, 0xC6340603, + 0x81C, 0xC5360603, + 0x81C, 0xC4380603, + 0x81C, 0xC33A0603, + 0x81C, 0x883C0603, + 0x81C, 0x873E0603, + 0x81C, 0x86400603, + 0x81C, 0x85420603, + 0x81C, 0x84440603, + 0x81C, 0x83460603, + 0x81C, 0x67480603, + 0x81C, 0x664A0603, + 0x81C, 0x654C0603, + 0x81C, 0x644E0603, + 0x81C, 0x27500603, + 0x81C, 0x26520603, + 0x81C, 0x25540603, + 0x81C, 0x24560603, + 0x81C, 0x23580603, + 0x81C, 0x225A0603, + 0x81C, 0x215C0603, + 0x81C, 0x205E0603, + 0x81C, 0x03600603, + 0x81C, 0x02620603, + 0x81C, 0x01640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0x90000010, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000403, + 0x81C, 0xFB000603, + 0x81C, 0xFA020603, + 0x81C, 0xF9040603, + 0x81C, 0xF8060603, + 0x81C, 0xF7080603, + 0x81C, 0xF60A0603, + 0x81C, 0xF50C0603, + 0x81C, 0xF40E0603, + 0x81C, 0xF3100603, + 0x81C, 0xF2120603, + 0x81C, 0xF1140603, + 0x81C, 0xF0160603, + 0x81C, 0xEF180603, + 0x81C, 0xEE1A0603, + 0x81C, 0xED1C0603, + 0x81C, 0xEC1E0603, + 0x81C, 0xEB200603, + 0x81C, 0xEA220603, + 0x81C, 0xE9240603, + 0x81C, 0xE8260603, + 0x81C, 0xE7280603, + 0x81C, 0xE62A0603, + 0x81C, 0xE52C0603, + 0x81C, 0xE42E0603, + 0x81C, 0xE3300603, + 0x81C, 0xE2320603, + 0x81C, 0xC6340603, + 0x81C, 0xC5360603, + 0x81C, 0xC4380603, + 0x81C, 0xC33A0603, + 0x81C, 0xA63C0603, + 0x81C, 0xA53E0603, + 0x81C, 0xA4400603, + 0x81C, 0xA3420603, + 0x81C, 0xA2440603, + 0x81C, 0xA1460603, + 0x81C, 0x83480603, + 0x81C, 0x824A0603, + 0x81C, 0x814C0603, + 0x81C, 0x644E0603, + 0x81C, 0x63500603, + 0x81C, 0x62520603, + 0x81C, 0x61540603, + 0x81C, 0x60560603, + 0x81C, 0x40580603, + 0x81C, 0x215A0603, + 0x81C, 0x205C0603, + 0x81C, 0x035E0603, + 0x81C, 0x02600603, + 0x81C, 0x01620603, + 0x81C, 0x00640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x90000012, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000603, + 0x81C, 0xF6020603, + 0x81C, 0xF5040603, + 0x81C, 0xF4060603, + 0x81C, 0xF3080603, + 0x81C, 0xF20A0603, + 0x81C, 0xF10C0603, + 0x81C, 0xF00E0603, + 0x81C, 0xEF100603, + 0x81C, 0xEE120603, + 0x81C, 0xED140603, + 0x81C, 0xEC160603, + 0x81C, 0xEB180603, + 0x81C, 0xEA1A0603, + 0x81C, 0xE91C0603, + 0x81C, 0xE81E0603, + 0x81C, 0xE7200603, + 0x81C, 0xE6220603, + 0x81C, 0xE5240603, + 0x81C, 0xE4260603, + 0x81C, 0xE3280603, + 0x81C, 0xC42A0603, + 0x81C, 0xC32C0603, + 0x81C, 0xC22E0603, + 0x81C, 0xC1300603, + 0x81C, 0xC0320603, + 0x81C, 0xA3340603, + 0x81C, 0xA2360603, + 0x81C, 0xA1380603, + 0x81C, 0xA03A0603, + 0x81C, 0x823C0603, + 0x81C, 0x813E0603, + 0x81C, 0x80400603, + 0x81C, 0x64420603, + 0x81C, 0x63440603, + 0x81C, 0x62460603, + 0x81C, 0x61480603, + 0x81C, 0x604A0603, + 0x81C, 0x414C0603, + 0x81C, 0x404E0603, + 0x81C, 0x22500603, + 0x81C, 0x21520603, + 0x81C, 0x20540603, + 0x81C, 0x03560603, + 0x81C, 0x02580603, + 0x81C, 0x015A0603, + 0x81C, 0x005C0603, + 0x81C, 0x005E0603, + 0x81C, 0x00600603, + 0x81C, 0x00620603, + 0x81C, 0x00640603, + 0x81C, 0x00660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0xA0000000, 0x00000000, + 0x81C, 0xFD000603, + 0x81C, 0xFC020603, + 0x81C, 0xFB040603, + 0x81C, 0xFA060603, + 0x81C, 0xF9080603, + 0x81C, 0xF80A0603, + 0x81C, 0xF70C0603, + 0x81C, 0xF60E0603, + 0x81C, 0xF5100603, + 0x81C, 0xF4120603, + 0x81C, 0xF3140603, + 0x81C, 0xF2160603, + 0x81C, 0xF1180603, + 0x81C, 0xF01A0603, + 0x81C, 0xEF1C0603, + 0x81C, 0xEE1E0603, + 0x81C, 0xED200603, + 0x81C, 0xEC220603, + 0x81C, 0xEB240603, + 0x81C, 0xEA260603, + 0x81C, 0xE9280603, + 0x81C, 0xE82A0603, + 0x81C, 0xE72C0603, + 0x81C, 0xE62E0603, + 0x81C, 0xE5300603, + 0x81C, 0xE4320603, + 0x81C, 0xE3340603, + 0x81C, 0xC6360603, + 0x81C, 0xC5380603, + 0x81C, 0xC43A0603, + 0x81C, 0xC33C0603, + 0x81C, 0xA63E0603, + 0x81C, 0xA5400603, + 0x81C, 0xA4420603, + 0x81C, 0xA3440603, + 0x81C, 0xA2460603, + 0x81C, 0xA1480603, + 0x81C, 0x834A0603, + 0x81C, 0x824C0603, + 0x81C, 0x814E0603, + 0x81C, 0x64500603, + 0x81C, 0x63520603, + 0x81C, 0x62540603, + 0x81C, 0x61560603, + 0x81C, 0x60580603, + 0x81C, 0x235A0603, + 0x81C, 0x225C0603, + 0x81C, 0x215E0603, + 0x81C, 0x20600603, + 0x81C, 0x03620603, + 0x81C, 0x02640603, + 0x81C, 0x01660603, + 0x81C, 0x00680603, + 0x81C, 0x006A0603, + 0x81C, 0x006C0603, + 0x81C, 0x006E0603, + 0x81C, 0x00700603, + 0x81C, 0x00720603, + 0x81C, 0x00740603, + 0x81C, 0x00760603, + 0x81C, 0x00780603, + 0x81C, 0x007A0603, + 0x81C, 0x007C0603, + 0x81C, 0x007E0603, + 0x81C, 0x007E0603, + 0xB0000000, 0x00000000, + 0x80000000, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000703, + 0x81C, 0xFB020703, + 0x81C, 0xFA040703, + 0x81C, 0xF9060703, + 0x81C, 0xF8080703, + 0x81C, 0xF70A0703, + 0x81C, 0xF60C0703, + 0x81C, 0xF50E0703, + 0x81C, 0xF4100703, + 0x81C, 0xF3120703, + 0x81C, 0xF2140703, + 0x81C, 0xF1160703, + 0x81C, 0xEF180703, + 0x81C, 0xEE1A0703, + 0x81C, 0xED1C0703, + 0x81C, 0xEC1E0703, + 0x81C, 0xEB200703, + 0x81C, 0xEA220703, + 0x81C, 0xE9240703, + 0x81C, 0xE8260703, + 0x81C, 0xE7280703, + 0x81C, 0xE62A0703, + 0x81C, 0xE52C0703, + 0x81C, 0xE42E0703, + 0x81C, 0xE3300703, + 0x81C, 0xE2320703, + 0x81C, 0xC6340703, + 0x81C, 0xC5360703, + 0x81C, 0xC4380703, + 0x81C, 0xC33A0703, + 0x81C, 0xA63C0703, + 0x81C, 0xA53E0703, + 0x81C, 0xA4400703, + 0x81C, 0xA3420703, + 0x81C, 0xA2440703, + 0x81C, 0xA1460703, + 0x81C, 0x83480703, + 0x81C, 0x824A0703, + 0x81C, 0x814C0703, + 0x81C, 0x804E0703, + 0x81C, 0x63500703, + 0x81C, 0x62520703, + 0x81C, 0x61540703, + 0x81C, 0x42560703, + 0x81C, 0x41580703, + 0x81C, 0x405A0703, + 0x81C, 0x225C0703, + 0x81C, 0x215E0703, + 0x81C, 0x20600703, + 0x81C, 0x04620703, + 0x81C, 0x03640703, + 0x81C, 0x02660703, + 0x81C, 0x01680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xBD000703, + 0x81C, 0xBC020703, + 0x81C, 0xBB040703, + 0x81C, 0xBA060703, + 0x81C, 0xB9080703, + 0x81C, 0xB80A0703, + 0x81C, 0xB70C0703, + 0x81C, 0xB60E0703, + 0x81C, 0xB5100703, + 0x81C, 0xB4120703, + 0x81C, 0xB3140703, + 0x81C, 0xB2160703, + 0x81C, 0xB1180703, + 0x81C, 0xB01A0703, + 0x81C, 0xAF1C0703, + 0x81C, 0xAE1E0703, + 0x81C, 0xAD200703, + 0x81C, 0xAC220703, + 0x81C, 0x8E240703, + 0x81C, 0x8D260703, + 0x81C, 0x8C280703, + 0x81C, 0x6F2A0703, + 0x81C, 0x6E2C0703, + 0x81C, 0x6D2E0703, + 0x81C, 0x6C300703, + 0x81C, 0x6B320703, + 0x81C, 0x6A340703, + 0x81C, 0x69360703, + 0x81C, 0x68380703, + 0x81C, 0x673A0703, + 0x81C, 0x663C0703, + 0x81C, 0x653E0703, + 0x81C, 0x64400703, + 0x81C, 0x63420703, + 0x81C, 0x62440703, + 0x81C, 0x61460703, + 0x81C, 0x60480703, + 0x81C, 0x424A0703, + 0x81C, 0x414C0703, + 0x81C, 0x404E0703, + 0x81C, 0x06500703, + 0x81C, 0x05520703, + 0x81C, 0x04540703, + 0x81C, 0x03560703, + 0x81C, 0x02580703, + 0x81C, 0x015A0703, + 0x81C, 0x005C0703, + 0x81C, 0x005E0703, + 0x81C, 0x00600703, + 0x81C, 0x00620703, + 0x81C, 0x00640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007C0703, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000703, + 0x81C, 0xF6020703, + 0x81C, 0xF5040703, + 0x81C, 0xF4060703, + 0x81C, 0xF3080703, + 0x81C, 0xF20A0703, + 0x81C, 0xF10C0703, + 0x81C, 0xF00E0703, + 0x81C, 0xEF100703, + 0x81C, 0xEE120703, + 0x81C, 0xED140703, + 0x81C, 0xEC160703, + 0x81C, 0xEB180703, + 0x81C, 0xEA1A0703, + 0x81C, 0xE91C0703, + 0x81C, 0xCA1E0703, + 0x81C, 0xC9200703, + 0x81C, 0xC8220703, + 0x81C, 0xC7240703, + 0x81C, 0xC6260703, + 0x81C, 0xC5280703, + 0x81C, 0xC42A0703, + 0x81C, 0xC32C0703, + 0x81C, 0xC22E0703, + 0x81C, 0xC1300703, + 0x81C, 0xA4320703, + 0x81C, 0xA3340703, + 0x81C, 0xA2360703, + 0x81C, 0xA1380703, + 0x81C, 0xA03A0703, + 0x81C, 0x823C0703, + 0x81C, 0x813E0703, + 0x81C, 0x80400703, + 0x81C, 0x64420703, + 0x81C, 0x63440703, + 0x81C, 0x62460703, + 0x81C, 0x61480703, + 0x81C, 0x604A0703, + 0x81C, 0x414C0703, + 0x81C, 0x404E0703, + 0x81C, 0x22500703, + 0x81C, 0x21520703, + 0x81C, 0x20540703, + 0x81C, 0x03560703, + 0x81C, 0x02580703, + 0x81C, 0x015A0703, + 0x81C, 0x005C0703, + 0x81C, 0x005E0703, + 0x81C, 0x00600703, + 0x81C, 0x00620703, + 0x81C, 0x00640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000703, + 0x81C, 0xFB020703, + 0x81C, 0xFA040703, + 0x81C, 0xF9060703, + 0x81C, 0xF8080703, + 0x81C, 0xF70A0703, + 0x81C, 0xF60C0703, + 0x81C, 0xF50E0703, + 0x81C, 0xF4100703, + 0x81C, 0xF3120703, + 0x81C, 0xF2140703, + 0x81C, 0xF1160703, + 0x81C, 0xF0180703, + 0x81C, 0xEF1A0703, + 0x81C, 0xEE1C0703, + 0x81C, 0xED1E0703, + 0x81C, 0xEC200703, + 0x81C, 0xEB220703, + 0x81C, 0xEA240703, + 0x81C, 0xE9260703, + 0x81C, 0xE8280703, + 0x81C, 0xE72A0703, + 0x81C, 0xE62C0703, + 0x81C, 0xE52E0703, + 0x81C, 0xE4300703, + 0x81C, 0xE3320703, + 0x81C, 0xE2340703, + 0x81C, 0xC6360703, + 0x81C, 0xC5380703, + 0x81C, 0xC43A0703, + 0x81C, 0xC33C0703, + 0x81C, 0xA63E0703, + 0x81C, 0xA5400703, + 0x81C, 0xA4420703, + 0x81C, 0xA3440703, + 0x81C, 0xA2460703, + 0x81C, 0x84480703, + 0x81C, 0x834A0703, + 0x81C, 0x824C0703, + 0x81C, 0x814E0703, + 0x81C, 0x80500703, + 0x81C, 0x63520703, + 0x81C, 0x62540703, + 0x81C, 0x61560703, + 0x81C, 0x60580703, + 0x81C, 0x225A0703, + 0x81C, 0x055C0703, + 0x81C, 0x045E0703, + 0x81C, 0x03600703, + 0x81C, 0x02620703, + 0x81C, 0x01640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000703, + 0x81C, 0xF6020703, + 0x81C, 0xF5040703, + 0x81C, 0xF4060703, + 0x81C, 0xF3080703, + 0x81C, 0xF20A0703, + 0x81C, 0xF10C0703, + 0x81C, 0xF00E0703, + 0x81C, 0xEF100703, + 0x81C, 0xEE120703, + 0x81C, 0xED140703, + 0x81C, 0xEC160703, + 0x81C, 0xEB180703, + 0x81C, 0xEA1A0703, + 0x81C, 0xE91C0703, + 0x81C, 0xCA1E0703, + 0x81C, 0xC9200703, + 0x81C, 0xC8220703, + 0x81C, 0xC7240703, + 0x81C, 0xC6260703, + 0x81C, 0xC5280703, + 0x81C, 0xC42A0703, + 0x81C, 0xC32C0703, + 0x81C, 0xC22E0703, + 0x81C, 0xC1300703, + 0x81C, 0xA4320703, + 0x81C, 0xA3340703, + 0x81C, 0xA2360703, + 0x81C, 0xA1380703, + 0x81C, 0xA03A0703, + 0x81C, 0x823C0703, + 0x81C, 0x813E0703, + 0x81C, 0x80400703, + 0x81C, 0x64420703, + 0x81C, 0x63440703, + 0x81C, 0x62460703, + 0x81C, 0x61480703, + 0x81C, 0x604A0703, + 0x81C, 0x414C0703, + 0x81C, 0x404E0703, + 0x81C, 0x22500703, + 0x81C, 0x21520703, + 0x81C, 0x20540703, + 0x81C, 0x03560703, + 0x81C, 0x02580703, + 0x81C, 0x015A0703, + 0x81C, 0x005C0703, + 0x81C, 0x005E0703, + 0x81C, 0x00600703, + 0x81C, 0x00620703, + 0x81C, 0x00640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000703, + 0x81C, 0xFA020703, + 0x81C, 0xF9040703, + 0x81C, 0xF8060703, + 0x81C, 0xF7080703, + 0x81C, 0xF60A0703, + 0x81C, 0xF50C0703, + 0x81C, 0xF40E0703, + 0x81C, 0xF3100703, + 0x81C, 0xF2120703, + 0x81C, 0xF1140703, + 0x81C, 0xF0160703, + 0x81C, 0xEF180703, + 0x81C, 0xEE1A0703, + 0x81C, 0xED1C0703, + 0x81C, 0xEC1E0703, + 0x81C, 0xEB200703, + 0x81C, 0xEA220703, + 0x81C, 0xE9240703, + 0x81C, 0xE8260703, + 0x81C, 0xE7280703, + 0x81C, 0xE62A0703, + 0x81C, 0xE52C0703, + 0x81C, 0xE42E0703, + 0x81C, 0xE3300703, + 0x81C, 0xE2320703, + 0x81C, 0xE1340703, + 0x81C, 0xC5360703, + 0x81C, 0xC4380703, + 0x81C, 0xC33A0703, + 0x81C, 0xC23C0703, + 0x81C, 0xC13E0703, + 0x81C, 0xA4400703, + 0x81C, 0xA3420703, + 0x81C, 0xA2440703, + 0x81C, 0xA1460703, + 0x81C, 0x83480703, + 0x81C, 0x824A0703, + 0x81C, 0x814C0703, + 0x81C, 0x804E0703, + 0x81C, 0x64500703, + 0x81C, 0x63520703, + 0x81C, 0x62540703, + 0x81C, 0x61560703, + 0x81C, 0x60580703, + 0x81C, 0x235A0703, + 0x81C, 0x225C0703, + 0x81C, 0x215E0703, + 0x81C, 0x20600703, + 0x81C, 0x04620703, + 0x81C, 0x03640703, + 0x81C, 0x02660703, + 0x81C, 0x01680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF9000703, + 0x81C, 0xF8020703, + 0x81C, 0xF7040703, + 0x81C, 0xF6060703, + 0x81C, 0xF5080703, + 0x81C, 0xF40A0703, + 0x81C, 0xF30C0703, + 0x81C, 0xF20E0703, + 0x81C, 0xF1100703, + 0x81C, 0xF0120703, + 0x81C, 0xEF140703, + 0x81C, 0xEE160703, + 0x81C, 0xED180703, + 0x81C, 0xEC1A0703, + 0x81C, 0xEB1C0703, + 0x81C, 0xEA1E0703, + 0x81C, 0xC9200703, + 0x81C, 0xC8220703, + 0x81C, 0xC7240703, + 0x81C, 0xC6260703, + 0x81C, 0xC5280703, + 0x81C, 0xC42A0703, + 0x81C, 0xC32C0703, + 0x81C, 0xC22E0703, + 0x81C, 0xC1300703, + 0x81C, 0xC0320703, + 0x81C, 0xA3340703, + 0x81C, 0xA2360703, + 0x81C, 0xA1380703, + 0x81C, 0xA03A0703, + 0x81C, 0x823C0703, + 0x81C, 0x813E0703, + 0x81C, 0x80400703, + 0x81C, 0x64420703, + 0x81C, 0x63440703, + 0x81C, 0x62460703, + 0x81C, 0x61480703, + 0x81C, 0x604A0703, + 0x81C, 0x414C0703, + 0x81C, 0x404E0703, + 0x81C, 0x22500703, + 0x81C, 0x21520703, + 0x81C, 0x20540703, + 0x81C, 0x03560703, + 0x81C, 0x02580703, + 0x81C, 0x015A0703, + 0x81C, 0x005C0703, + 0x81C, 0x005E0703, + 0x81C, 0x00600703, + 0x81C, 0x00620703, + 0x81C, 0x00640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xBE000703, + 0x81C, 0xBD020703, + 0x81C, 0xBC040703, + 0x81C, 0xBB060703, + 0x81C, 0xBA080703, + 0x81C, 0xB90A0703, + 0x81C, 0xB80C0703, + 0x81C, 0xB70E0703, + 0x81C, 0xB6100703, + 0x81C, 0xB5120703, + 0x81C, 0xB4140703, + 0x81C, 0xB3160703, + 0x81C, 0xB2180703, + 0x81C, 0xB11A0703, + 0x81C, 0xB01C0703, + 0x81C, 0x921E0703, + 0x81C, 0x91200703, + 0x81C, 0x90220703, + 0x81C, 0x8F240703, + 0x81C, 0x8E260703, + 0x81C, 0x8D280703, + 0x81C, 0x8C2A0703, + 0x81C, 0x6F2C0703, + 0x81C, 0x6E2E0703, + 0x81C, 0x6D300703, + 0x81C, 0x6C320703, + 0x81C, 0x6B340703, + 0x81C, 0x6A360703, + 0x81C, 0x69380703, + 0x81C, 0x683A0703, + 0x81C, 0x673C0703, + 0x81C, 0x663E0703, + 0x81C, 0x65400703, + 0x81C, 0x64420703, + 0x81C, 0x63440703, + 0x81C, 0x62460703, + 0x81C, 0x61480703, + 0x81C, 0x604A0703, + 0x81C, 0x424C0703, + 0x81C, 0x414E0703, + 0x81C, 0x40500703, + 0x81C, 0x06520703, + 0x81C, 0x05540703, + 0x81C, 0x04560703, + 0x81C, 0x03580703, + 0x81C, 0x025A0703, + 0x81C, 0x015C0703, + 0x81C, 0x005E0703, + 0x81C, 0x00600703, + 0x81C, 0x00620703, + 0x81C, 0x00640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x90000008, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000703, + 0x81C, 0xFA020703, + 0x81C, 0xF9040703, + 0x81C, 0xF8060703, + 0x81C, 0xF7080703, + 0x81C, 0xF60A0703, + 0x81C, 0xF50C0703, + 0x81C, 0xF40E0703, + 0x81C, 0xF3100703, + 0x81C, 0xF2120703, + 0x81C, 0xF1140703, + 0x81C, 0xF0160703, + 0x81C, 0xEF180703, + 0x81C, 0xEE1A0703, + 0x81C, 0xED1C0703, + 0x81C, 0xEC1E0703, + 0x81C, 0xEB200703, + 0x81C, 0xEA220703, + 0x81C, 0xE9240703, + 0x81C, 0xE8260703, + 0x81C, 0xE7280703, + 0x81C, 0xE62A0703, + 0x81C, 0xE52C0703, + 0x81C, 0xE42E0703, + 0x81C, 0xE3300703, + 0x81C, 0xE2320703, + 0x81C, 0xC6340703, + 0x81C, 0xC5360703, + 0x81C, 0xC4380703, + 0x81C, 0xC33A0703, + 0x81C, 0xC23C0703, + 0x81C, 0xC13E0703, + 0x81C, 0xA4400703, + 0x81C, 0xA3420703, + 0x81C, 0xA2440703, + 0x81C, 0xA1460703, + 0x81C, 0x83480703, + 0x81C, 0x824A0703, + 0x81C, 0x814C0703, + 0x81C, 0x804E0703, + 0x81C, 0x63500703, + 0x81C, 0x62520703, + 0x81C, 0x43540703, + 0x81C, 0x42560703, + 0x81C, 0x41580703, + 0x81C, 0x235A0703, + 0x81C, 0x225C0703, + 0x81C, 0x215E0703, + 0x81C, 0x20600703, + 0x81C, 0x04620703, + 0x81C, 0x03640703, + 0x81C, 0x02660703, + 0x81C, 0x01680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x90000009, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000703, + 0x81C, 0xF7020703, + 0x81C, 0xF6040703, + 0x81C, 0xF5060703, + 0x81C, 0xF4080703, + 0x81C, 0xF30A0703, + 0x81C, 0xF20C0703, + 0x81C, 0xF10E0703, + 0x81C, 0xF0100703, + 0x81C, 0xEF120703, + 0x81C, 0xEE140703, + 0x81C, 0xED160703, + 0x81C, 0xEC180703, + 0x81C, 0xEB1A0703, + 0x81C, 0xEA1C0703, + 0x81C, 0xE91E0703, + 0x81C, 0xCA200703, + 0x81C, 0xC9220703, + 0x81C, 0xC8240703, + 0x81C, 0xC7260703, + 0x81C, 0xC6280703, + 0x81C, 0xC52A0703, + 0x81C, 0xC42C0703, + 0x81C, 0xC32E0703, + 0x81C, 0xC2300703, + 0x81C, 0xC1320703, + 0x81C, 0xA3340703, + 0x81C, 0xA2360703, + 0x81C, 0xA1380703, + 0x81C, 0xA03A0703, + 0x81C, 0x823C0703, + 0x81C, 0x813E0703, + 0x81C, 0x80400703, + 0x81C, 0x65420703, + 0x81C, 0x64440703, + 0x81C, 0x63460703, + 0x81C, 0x62480703, + 0x81C, 0x614A0703, + 0x81C, 0x424C0703, + 0x81C, 0x414E0703, + 0x81C, 0x40500703, + 0x81C, 0x22520703, + 0x81C, 0x21540703, + 0x81C, 0x20560703, + 0x81C, 0x04580703, + 0x81C, 0x035A0703, + 0x81C, 0x025C0703, + 0x81C, 0x015E0703, + 0x81C, 0x00600703, + 0x81C, 0x00620703, + 0x81C, 0x00640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x9000000a, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000703, + 0x81C, 0xFB020703, + 0x81C, 0xFA040703, + 0x81C, 0xF9060703, + 0x81C, 0xF8080703, + 0x81C, 0xF70A0703, + 0x81C, 0xF60C0703, + 0x81C, 0xF50E0703, + 0x81C, 0xF4100703, + 0x81C, 0xF3120703, + 0x81C, 0xF2140703, + 0x81C, 0xF1160703, + 0x81C, 0xEF180703, + 0x81C, 0xEE1A0703, + 0x81C, 0xED1C0703, + 0x81C, 0xEC1E0703, + 0x81C, 0xEB200703, + 0x81C, 0xEA220703, + 0x81C, 0xE9240703, + 0x81C, 0xE8260703, + 0x81C, 0xE7280703, + 0x81C, 0xE62A0703, + 0x81C, 0xE52C0703, + 0x81C, 0xE42E0703, + 0x81C, 0xE3300703, + 0x81C, 0xE2320703, + 0x81C, 0xC6340703, + 0x81C, 0xC5360703, + 0x81C, 0xC4380703, + 0x81C, 0xC33A0703, + 0x81C, 0xA63C0703, + 0x81C, 0xA53E0703, + 0x81C, 0xA4400703, + 0x81C, 0xA3420703, + 0x81C, 0xA2440703, + 0x81C, 0xA1460703, + 0x81C, 0x83480703, + 0x81C, 0x824A0703, + 0x81C, 0x814C0703, + 0x81C, 0x804E0703, + 0x81C, 0x63500703, + 0x81C, 0x62520703, + 0x81C, 0x61540703, + 0x81C, 0x42560703, + 0x81C, 0x41580703, + 0x81C, 0x405A0703, + 0x81C, 0x225C0703, + 0x81C, 0x215E0703, + 0x81C, 0x20600703, + 0x81C, 0x04620703, + 0x81C, 0x03640703, + 0x81C, 0x02660703, + 0x81C, 0x01680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x9000000b, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF8000703, + 0x81C, 0xF7020703, + 0x81C, 0xF6040703, + 0x81C, 0xF5060703, + 0x81C, 0xF4080703, + 0x81C, 0xF30A0703, + 0x81C, 0xF20C0703, + 0x81C, 0xF10E0703, + 0x81C, 0xF0100703, + 0x81C, 0xEF120703, + 0x81C, 0xEE140703, + 0x81C, 0xED160703, + 0x81C, 0xEC180703, + 0x81C, 0xEB1A0703, + 0x81C, 0xEA1C0703, + 0x81C, 0xE91E0703, + 0x81C, 0xCA200703, + 0x81C, 0xC9220703, + 0x81C, 0xC8240703, + 0x81C, 0xC7260703, + 0x81C, 0xC6280703, + 0x81C, 0xC52A0703, + 0x81C, 0xC42C0703, + 0x81C, 0xC32E0703, + 0x81C, 0xC2300703, + 0x81C, 0xC1320703, + 0x81C, 0xA3340703, + 0x81C, 0xA2360703, + 0x81C, 0xA1380703, + 0x81C, 0xA03A0703, + 0x81C, 0x823C0703, + 0x81C, 0x813E0703, + 0x81C, 0x80400703, + 0x81C, 0x64420703, + 0x81C, 0x63440703, + 0x81C, 0x62460703, + 0x81C, 0x61480703, + 0x81C, 0x604A0703, + 0x81C, 0x234C0703, + 0x81C, 0x224E0703, + 0x81C, 0x21500703, + 0x81C, 0x20520703, + 0x81C, 0x06540703, + 0x81C, 0x05560703, + 0x81C, 0x04580703, + 0x81C, 0x035A0703, + 0x81C, 0x025C0703, + 0x81C, 0x015E0703, + 0x81C, 0x00600703, + 0x81C, 0x00620703, + 0x81C, 0x00640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x9000000c, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000703, + 0x81C, 0xFB020703, + 0x81C, 0xFA040703, + 0x81C, 0xF9060703, + 0x81C, 0xF8080703, + 0x81C, 0xF70A0703, + 0x81C, 0xF60C0703, + 0x81C, 0xF50E0703, + 0x81C, 0xF4100703, + 0x81C, 0xF3120703, + 0x81C, 0xF2140703, + 0x81C, 0xF1160703, + 0x81C, 0xF0180703, + 0x81C, 0xEF1A0703, + 0x81C, 0xEE1C0703, + 0x81C, 0xED1E0703, + 0x81C, 0xEC200703, + 0x81C, 0xEB220703, + 0x81C, 0xEA240703, + 0x81C, 0xE9260703, + 0x81C, 0xE8280703, + 0x81C, 0xE72A0703, + 0x81C, 0xE62C0703, + 0x81C, 0xE52E0703, + 0x81C, 0xE4300703, + 0x81C, 0xE3320703, + 0x81C, 0xE2340703, + 0x81C, 0xC6360703, + 0x81C, 0xC5380703, + 0x81C, 0xC43A0703, + 0x81C, 0xC33C0703, + 0x81C, 0xA63E0703, + 0x81C, 0xA5400703, + 0x81C, 0xA4420703, + 0x81C, 0xA3440703, + 0x81C, 0xA2460703, + 0x81C, 0x84480703, + 0x81C, 0x834A0703, + 0x81C, 0x824C0703, + 0x81C, 0x814E0703, + 0x81C, 0x80500703, + 0x81C, 0x63520703, + 0x81C, 0x62540703, + 0x81C, 0x61560703, + 0x81C, 0x60580703, + 0x81C, 0x225A0703, + 0x81C, 0x055C0703, + 0x81C, 0x045E0703, + 0x81C, 0x03600703, + 0x81C, 0x02620703, + 0x81C, 0x01640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x9000000d, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000703, + 0x81C, 0xFA020703, + 0x81C, 0xF9040703, + 0x81C, 0xF8060703, + 0x81C, 0xF7080703, + 0x81C, 0xF60A0703, + 0x81C, 0xF50C0703, + 0x81C, 0xF40E0703, + 0x81C, 0xF3100703, + 0x81C, 0xF2120703, + 0x81C, 0xF1140703, + 0x81C, 0xEF160703, + 0x81C, 0xEE180703, + 0x81C, 0xED1A0703, + 0x81C, 0xEC1C0703, + 0x81C, 0xEB1E0703, + 0x81C, 0xEA200703, + 0x81C, 0xE9220703, + 0x81C, 0xE8240703, + 0x81C, 0xE7260703, + 0x81C, 0xE6280703, + 0x81C, 0xE52A0703, + 0x81C, 0xE42C0703, + 0x81C, 0xE32E0703, + 0x81C, 0xE2300703, + 0x81C, 0xE1320703, + 0x81C, 0xC6340703, + 0x81C, 0xC5360703, + 0x81C, 0xC4380703, + 0x81C, 0xC33A0703, + 0x81C, 0xA63C0703, + 0x81C, 0xA53E0703, + 0x81C, 0xA4400703, + 0x81C, 0xA3420703, + 0x81C, 0xA2440703, + 0x81C, 0xA1460703, + 0x81C, 0x83480703, + 0x81C, 0x824A0703, + 0x81C, 0x814C0703, + 0x81C, 0x804E0703, + 0x81C, 0x63500703, + 0x81C, 0x62520703, + 0x81C, 0x61540703, + 0x81C, 0x42560703, + 0x81C, 0x41580703, + 0x81C, 0x405A0703, + 0x81C, 0x225C0703, + 0x81C, 0x215E0703, + 0x81C, 0x20600703, + 0x81C, 0x04620703, + 0x81C, 0x03640703, + 0x81C, 0x02660703, + 0x81C, 0x01680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x9000000e, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFB000703, + 0x81C, 0xFA020703, + 0x81C, 0xF9040703, + 0x81C, 0xF8060703, + 0x81C, 0xF7080703, + 0x81C, 0xF60A0703, + 0x81C, 0xF50C0703, + 0x81C, 0xF40E0703, + 0x81C, 0xF3100703, + 0x81C, 0xF2120703, + 0x81C, 0xF1140703, + 0x81C, 0xEF160703, + 0x81C, 0xEE180703, + 0x81C, 0xED1A0703, + 0x81C, 0xEC1C0703, + 0x81C, 0xEB1E0703, + 0x81C, 0xEA200703, + 0x81C, 0xE9220703, + 0x81C, 0xE8240703, + 0x81C, 0xE7260703, + 0x81C, 0xE6280703, + 0x81C, 0xE52A0703, + 0x81C, 0xE42C0703, + 0x81C, 0xE32E0703, + 0x81C, 0xE2300703, + 0x81C, 0xE1320703, + 0x81C, 0xC6340703, + 0x81C, 0xC5360703, + 0x81C, 0xC4380703, + 0x81C, 0xC33A0703, + 0x81C, 0xA63C0703, + 0x81C, 0xA53E0703, + 0x81C, 0xA4400703, + 0x81C, 0xA3420703, + 0x81C, 0xA2440703, + 0x81C, 0xA1460703, + 0x81C, 0x83480703, + 0x81C, 0x824A0703, + 0x81C, 0x814C0703, + 0x81C, 0x804E0703, + 0x81C, 0x63500703, + 0x81C, 0x62520703, + 0x81C, 0x61540703, + 0x81C, 0x42560703, + 0x81C, 0x41580703, + 0x81C, 0x405A0703, + 0x81C, 0x225C0703, + 0x81C, 0x215E0703, + 0x81C, 0x20600703, + 0x81C, 0x04620703, + 0x81C, 0x03640703, + 0x81C, 0x02660703, + 0x81C, 0x01680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x9000000f, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xBF000703, + 0x81C, 0xBF020703, + 0x81C, 0xBF040703, + 0x81C, 0xBF060703, + 0x81C, 0xBF080703, + 0x81C, 0xBE0A0703, + 0x81C, 0xBD0C0703, + 0x81C, 0xBC0E0703, + 0x81C, 0xBB100703, + 0x81C, 0xBA120703, + 0x81C, 0xB9140703, + 0x81C, 0xB8160703, + 0x81C, 0xB7180703, + 0x81C, 0xB61A0703, + 0x81C, 0xB51C0703, + 0x81C, 0xB41E0703, + 0x81C, 0xB1200703, + 0x81C, 0xB2220703, + 0x81C, 0xB1240703, + 0x81C, 0xB0260703, + 0x81C, 0xAF280703, + 0x81C, 0xAE2A0703, + 0x81C, 0xAD2C0703, + 0x81C, 0xAC2E0703, + 0x81C, 0xAB300703, + 0x81C, 0xAA320703, + 0x81C, 0xC6340703, + 0x81C, 0xC5360703, + 0x81C, 0xC4380703, + 0x81C, 0xC33A0703, + 0x81C, 0x883C0703, + 0x81C, 0x873E0703, + 0x81C, 0x86400703, + 0x81C, 0x85420703, + 0x81C, 0x84440703, + 0x81C, 0x83460703, + 0x81C, 0x67480703, + 0x81C, 0x664A0703, + 0x81C, 0x654C0703, + 0x81C, 0x644E0703, + 0x81C, 0x27500703, + 0x81C, 0x26520703, + 0x81C, 0x25540703, + 0x81C, 0x24560703, + 0x81C, 0x23580703, + 0x81C, 0x225A0703, + 0x81C, 0x215C0703, + 0x81C, 0x205E0703, + 0x81C, 0x03600703, + 0x81C, 0x02620703, + 0x81C, 0x01640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0x90000010, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xFC000403, + 0x81C, 0xFB000703, + 0x81C, 0xFA020703, + 0x81C, 0xF9040703, + 0x81C, 0xF8060703, + 0x81C, 0xF7080703, + 0x81C, 0xF60A0703, + 0x81C, 0xF50C0703, + 0x81C, 0xF40E0703, + 0x81C, 0xF3100703, + 0x81C, 0xF2120703, + 0x81C, 0xF1140703, + 0x81C, 0xF0160703, + 0x81C, 0xEF180703, + 0x81C, 0xEE1A0703, + 0x81C, 0xED1C0703, + 0x81C, 0xEC1E0703, + 0x81C, 0xEB200703, + 0x81C, 0xEA220703, + 0x81C, 0xE9240703, + 0x81C, 0xE8260703, + 0x81C, 0xE7280703, + 0x81C, 0xE62A0703, + 0x81C, 0xE52C0703, + 0x81C, 0xE42E0703, + 0x81C, 0xE3300703, + 0x81C, 0xE2320703, + 0x81C, 0xC6340703, + 0x81C, 0xC5360703, + 0x81C, 0xC4380703, + 0x81C, 0xC33A0703, + 0x81C, 0xA63C0703, + 0x81C, 0xA53E0703, + 0x81C, 0xA4400703, + 0x81C, 0xA3420703, + 0x81C, 0xA2440703, + 0x81C, 0x84460703, + 0x81C, 0x83480703, + 0x81C, 0x824A0703, + 0x81C, 0x814C0703, + 0x81C, 0x804E0703, + 0x81C, 0x63500703, + 0x81C, 0x62520703, + 0x81C, 0x61540703, + 0x81C, 0x60560703, + 0x81C, 0x22580703, + 0x81C, 0x055A0703, + 0x81C, 0x045C0703, + 0x81C, 0x035E0703, + 0x81C, 0x02600703, + 0x81C, 0x01620703, + 0x81C, 0x00640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x90000012, 0x00000000, 0x40000000, 0x00000000, + 0x81C, 0xF7000703, + 0x81C, 0xF6020703, + 0x81C, 0xF5040703, + 0x81C, 0xF4060703, + 0x81C, 0xF3080703, + 0x81C, 0xF20A0703, + 0x81C, 0xF10C0703, + 0x81C, 0xF00E0703, + 0x81C, 0xEF100703, + 0x81C, 0xEE120703, + 0x81C, 0xED140703, + 0x81C, 0xEC160703, + 0x81C, 0xEB180703, + 0x81C, 0xEA1A0703, + 0x81C, 0xE91C0703, + 0x81C, 0xCA1E0703, + 0x81C, 0xC9200703, + 0x81C, 0xC8220703, + 0x81C, 0xC7240703, + 0x81C, 0xC6260703, + 0x81C, 0xC5280703, + 0x81C, 0xC42A0703, + 0x81C, 0xC32C0703, + 0x81C, 0xC22E0703, + 0x81C, 0xC1300703, + 0x81C, 0xA4320703, + 0x81C, 0xA3340703, + 0x81C, 0xA2360703, + 0x81C, 0xA1380703, + 0x81C, 0xA03A0703, + 0x81C, 0x823C0703, + 0x81C, 0x813E0703, + 0x81C, 0x80400703, + 0x81C, 0x64420703, + 0x81C, 0x63440703, + 0x81C, 0x62460703, + 0x81C, 0x61480703, + 0x81C, 0x604A0703, + 0x81C, 0x414C0703, + 0x81C, 0x404E0703, + 0x81C, 0x22500703, + 0x81C, 0x21520703, + 0x81C, 0x20540703, + 0x81C, 0x03560703, + 0x81C, 0x02580703, + 0x81C, 0x015A0703, + 0x81C, 0x005C0703, + 0x81C, 0x005E0703, + 0x81C, 0x00600703, + 0x81C, 0x00620703, + 0x81C, 0x00640703, + 0x81C, 0x00660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0xA0000000, 0x00000000, + 0x81C, 0xFC000703, + 0x81C, 0xFB020703, + 0x81C, 0xFA040703, + 0x81C, 0xF9060703, + 0x81C, 0xF8080703, + 0x81C, 0xF70A0703, + 0x81C, 0xF60C0703, + 0x81C, 0xF50E0703, + 0x81C, 0xF4100703, + 0x81C, 0xF3120703, + 0x81C, 0xF2140703, + 0x81C, 0xF1160703, + 0x81C, 0xF0180703, + 0x81C, 0xEF1A0703, + 0x81C, 0xEE1C0703, + 0x81C, 0xED1E0703, + 0x81C, 0xEC200703, + 0x81C, 0xEB220703, + 0x81C, 0xEA240703, + 0x81C, 0xE9260703, + 0x81C, 0xE8280703, + 0x81C, 0xE72A0703, + 0x81C, 0xE62C0703, + 0x81C, 0xE52E0703, + 0x81C, 0xE4300703, + 0x81C, 0xE3320703, + 0x81C, 0xE2340703, + 0x81C, 0xC6360703, + 0x81C, 0xC5380703, + 0x81C, 0xC43A0703, + 0x81C, 0xC33C0703, + 0x81C, 0xA63E0703, + 0x81C, 0xA5400703, + 0x81C, 0xA4420703, + 0x81C, 0xA3440703, + 0x81C, 0xA2460703, + 0x81C, 0x84480703, + 0x81C, 0x834A0703, + 0x81C, 0x824C0703, + 0x81C, 0x814E0703, + 0x81C, 0x80500703, + 0x81C, 0x63520703, + 0x81C, 0x62540703, + 0x81C, 0x61560703, + 0x81C, 0x60580703, + 0x81C, 0x235A0703, + 0x81C, 0x225C0703, + 0x81C, 0x215E0703, + 0x81C, 0x20600703, + 0x81C, 0x03620703, + 0x81C, 0x02640703, + 0x81C, 0x01660703, + 0x81C, 0x00680703, + 0x81C, 0x006A0703, + 0x81C, 0x006C0703, + 0x81C, 0x006E0703, + 0x81C, 0x00700703, + 0x81C, 0x00720703, + 0x81C, 0x00740703, + 0x81C, 0x00760703, + 0x81C, 0x00780703, + 0x81C, 0x007A0703, + 0x81C, 0x007C0703, + 0x81C, 0x007E0703, + 0x81C, 0x007E0703, + 0xB0000000, 0x00000000, + 0x80000000, 0x00000000, 0x40000000, 0x00000000, + 0xC50, 0x00000022, + 0xC50, 0x00000020, + 0xE50, 0x00000022, + 0xE50, 0x00000020, + 0x9000000d, 0x00000000, 0x40000000, 0x00000000, + 0xC50, 0x00000022, + 0xC50, 0x00000020, + 0xE50, 0x00000022, + 0xE50, 0x00000020, + 0x9000000e, 0x00000000, 0x40000000, 0x00000000, + 0xC50, 0x00000022, + 0xC50, 0x00000020, + 0xE50, 0x00000022, + 0xE50, 0x00000020, + 0xA0000000, 0x00000000, + 0xC50, 0x00000022, + 0xC50, 0x00000020, + 0xE50, 0x00000022, + 0xE50, 0x00000020, + 0xB0000000, 0x00000000, + +}; + +RTW_DECL_TABLE_PHY_COND(rtw8822b_agc, rtw_phy_cfg_agc); + +static const u32 rtw8822b_bb[] = { + 0x800, 0x9020D010, + 0x804, 0x800181A0, + 0x808, 0x0E028233, + 0x80C, 0x10000013, + 0x810, 0x22101243, + 0x814, 0x020C3D11, + 0x818, 0x84A10385, + 0x81C, 0x1E1E081F, + 0x820, 0x0001AAAA, + 0x824, 0x00030FE0, + 0x828, 0x0000CCCC, + 0x82C, 0x75CB7010, + 0x830, 0x79A0EAAA, + 0x834, 0x072E6986, + 0x838, 0x87766441, + 0x83C, 0x9194B2B7, + 0x840, 0x171750E0, + 0x844, 0x4D3D7CDB, + 0x848, 0x4AD0408B, + 0x84C, 0x6AFBF7A5, + 0x850, 0x28A74706, + 0x854, 0x0001520C, + 0x858, 0x4060C000, + 0x85C, 0x74010160, + 0x860, 0x68A7C321, + 0x864, 0x79F27032, + 0x868, 0x8CA7A314, + 0x86C, 0x778C2878, + 0x870, 0x77777777, + 0x874, 0x27612C2E, + 0x878, 0xC0003152, + 0x87C, 0x5C8FC000, + 0x880, 0x00000000, + 0x884, 0x00000000, + 0x888, 0x00000000, + 0x88C, 0x00000000, + 0x890, 0x00000000, + 0x894, 0x00000000, + 0x898, 0x00000000, + 0x89C, 0x00000000, + 0x8A0, 0x00000013, + 0x8A4, 0x7F7F7F7F, + 0x8A8, 0x2202033E, + 0x8AC, 0xF00F000A, + 0x8B0, 0x00000600, + 0x8B4, 0x000FC080, + 0x8B8, 0xEC0057F7, + 0x8BC, 0xACB520A3, + 0x8C0, 0xFFE04020, + 0x8C4, 0x47C00000, + 0x8C8, 0x000251A5, + 0x8CC, 0x08108492, + 0x8D0, 0x0000B800, + 0x8D4, 0x860308A0, + 0x8D8, 0x29095612, + 0x8DC, 0x00000000, + 0x8E0, 0x32D16777, + 0x8E4, 0x4C098935, + 0x8E8, 0xFFFFC42C, + 0x8EC, 0x99999999, + 0x8F0, 0x00009999, + 0x8F4, 0x00D80FA1, + 0x8F8, 0x40000080, + 0x8FC, 0x00000130, + 0x900, 0x00800000, + 0x904, 0x00000000, + 0x908, 0x00000000, + 0x90C, 0xD3000000, + 0x910, 0x0000FC00, + 0x914, 0xC6380000, + 0x918, 0x1C1028C0, + 0x91C, 0x64B11A1C, + 0x920, 0xE0767233, + 0x924, 0x855A2500, + 0x928, 0x4AB0E4E4, + 0x92C, 0xFFFEB200, + 0x930, 0xFFFFFFFE, + 0x934, 0x001FFFFF, + 0x938, 0x00008480, + 0x93C, 0xE41C0642, + 0x940, 0x0E470430, + 0x944, 0x00000000, + 0x948, 0xAC000000, + 0x94C, 0x10000083, + 0x950, 0x32010080, + 0x954, 0x84510080, + 0x958, 0x00000001, + 0x95C, 0x04248000, + 0x960, 0x00000000, + 0x964, 0x00000000, + 0x968, 0x00000000, + 0x96C, 0x00000000, + 0x970, 0x00001FFF, + 0x974, 0x44000FFF, + 0x978, 0x00000000, + 0x97C, 0x00000000, + 0x980, 0x00000000, + 0x984, 0x00000000, + 0x988, 0x00000000, + 0x98C, 0x43440000, + 0x990, 0x27100000, + 0x994, 0xFFFF0100, + 0x998, 0xFFFFFF5C, + 0x99C, 0xFFFFFFFF, + 0x9A0, 0x000000FF, + 0x9A4, 0x80000088, + 0x9A8, 0x0C2F0000, + 0x9AC, 0x01560000, + 0x9B0, 0x70000000, + 0x9B4, 0x00000000, + 0x9B8, 0x00000000, + 0x9BC, 0x00000000, + 0x9C0, 0x00000000, + 0x9C4, 0x00000000, + 0x9C8, 0x00000000, + 0x9CC, 0x00000000, + 0x9D0, 0x00000000, + 0x9D4, 0x00000000, + 0x9D8, 0x00000000, + 0x9DC, 0x00000000, + 0x9E0, 0x00000000, + 0x9E4, 0x02000402, + 0x9E8, 0x000022D4, + 0x9EC, 0x00000000, + 0x9F0, 0x00010080, + 0x9F4, 0x00000000, + 0x9F8, 0x00000000, + 0x9FC, 0xEFFFF7F7, + 0xA00, 0x00D047C8, + 0xA04, 0x81FF800C, + 0xA08, 0x8C838300, + 0xA0C, 0x2E20100F, + 0xA10, 0x9500BB78, + 0xA14, 0x1114D028, + 0xA18, 0x00881117, + 0xA1C, 0x89140F00, + 0xA20, 0x84880000, + 0xA24, 0x384F6577, + 0xA28, 0x00001525, + 0xA2C, 0x00920000, + 0xA70, 0x101FFF00, + 0xA74, 0x00000148, + 0xA78, 0x00000900, + 0xA7C, 0x225B0606, + 0xA80, 0x218675B2, + 0xA84, 0x80208C00, + 0xA88, 0x040C0000, + 0xA8C, 0x12345678, + 0xA90, 0xABCDEF00, + 0xA94, 0x001B1B89, + 0xA98, 0x030A0000, + 0xA9C, 0x00060000, + 0xAA0, 0x00000000, + 0xAA4, 0x0004000F, + 0xAA8, 0x00000200, + 0xB00, 0xE1000440, + 0xB04, 0x00800000, + 0xB08, 0xFF02030B, + 0xB0C, 0x01EAA406, + 0xB10, 0x00030690, + 0xB14, 0x006000FA, + 0xB18, 0x00000002, + 0xB1C, 0x00000002, + 0xB20, 0x4B00001F, + 0xB24, 0x4E8E3E40, + 0xB28, 0x03020100, + 0xB2C, 0x07060504, + 0xB30, 0x0B0A0908, + 0xB34, 0x0F0E0D0C, + 0xB38, 0x13121110, + 0xB3C, 0x0000003A, + 0xB40, 0x00000000, + 0xB44, 0x80000000, + 0xB48, 0x3F0000FA, + 0xB4C, 0x88C80020, + 0xB50, 0x00000000, + 0xB54, 0x00004241, + 0xB58, 0xE0008208, + 0xB5C, 0x41EFFFF9, + 0xB60, 0x00000000, + 0xB64, 0x00200063, + 0xB68, 0x0000003A, + 0xB6C, 0x00000102, + 0xB70, 0x4E6D1870, + 0xB74, 0x03020100, + 0xB78, 0x07060504, + 0xB7C, 0x0B0A0908, + 0xB80, 0x0F0E0D0C, + 0xB84, 0x13121110, + 0xB88, 0x00000000, + 0xB8C, 0x00000000, + 0xC00, 0x00000007, + 0xC04, 0x00000020, + 0xC08, 0x60403231, + 0xC0C, 0x00012345, + 0xC10, 0x00000100, + 0xC14, 0x01000000, + 0xC18, 0x00000000, + 0xC1C, 0x40040053, + 0xC20, 0x40020103, + 0xC24, 0x00000000, + 0xC28, 0x00000000, + 0xC2C, 0x00000000, + 0xC30, 0x00000000, + 0xC34, 0x00000000, + 0xC38, 0x00000000, + 0xC3C, 0x00000000, + 0xC40, 0x00000000, + 0xC44, 0x00000000, + 0xC48, 0x00000000, + 0xC4C, 0x00000000, + 0xC50, 0x00000020, + 0xC54, 0x00000000, + 0xC58, 0xD8020402, + 0xC5C, 0xDE000120, + 0xC68, 0x5979993F, + 0xC6C, 0x0000122A, + 0xC70, 0x99795979, + 0xC74, 0x99795979, + 0xC78, 0x99799979, + 0xC7C, 0x99791979, + 0xC80, 0x19791979, + 0xC84, 0x19791979, + 0xC88, 0x00000000, + 0xC8C, 0x07000000, + 0xC94, 0x01000100, + 0xC98, 0x201C8000, + 0xC9C, 0x00000000, + 0xCA0, 0x0000A555, + 0xCA4, 0x08040201, + 0xCA8, 0x80402010, + 0xCAC, 0x00000000, + 0xCB0, 0x77777777, + 0xCB4, 0x00007777, + 0xCB8, 0x00000000, + 0xCBC, 0x00000000, + 0xCC0, 0x00000000, + 0xCC4, 0x00000000, + 0xCC8, 0x00000000, + 0xCCC, 0x00000000, + 0xCD0, 0x00000000, + 0xCD4, 0x00000000, + 0xCD8, 0x00000000, + 0xCDC, 0x00000000, + 0xCE0, 0x00000000, + 0xCE4, 0x00000000, + 0xCE8, 0x00000000, + 0xCEC, 0x00000000, + 0xE00, 0x00000007, + 0xE04, 0x00000020, + 0xE08, 0x60403231, + 0xE0C, 0x00012345, + 0xE10, 0x00000100, + 0xE14, 0x01000000, + 0xE18, 0x00000000, + 0xE1C, 0x40040053, + 0xE20, 0x40020103, + 0xE24, 0x00000000, + 0xE28, 0x00000000, + 0xE2C, 0x00000000, + 0xE30, 0x00000000, + 0xE34, 0x00000000, + 0xE38, 0x00000000, + 0xE3C, 0x00000000, + 0xE40, 0x00000000, + 0xE44, 0x00000000, + 0xE48, 0x00000000, + 0xE4C, 0x00000000, + 0xE50, 0x00000020, + 0xE54, 0x00000000, + 0xE58, 0xD8120402, + 0xE5C, 0xDE000120, + 0xE68, 0x5979993F, + 0xE6C, 0x0000122A, + 0xE70, 0x99795979, + 0xE74, 0x99795979, + 0xE78, 0x99799979, + 0xE7C, 0x99791979, + 0xE80, 0x19791979, + 0xE84, 0x19791979, + 0xE88, 0x00000000, + 0xE8C, 0x07000000, + 0xE94, 0x01000100, + 0xE98, 0x201C8000, + 0xE9C, 0x00000000, + 0xEA0, 0x0000A555, + 0xEA4, 0x08040201, + 0xEA8, 0x80402010, + 0xEAC, 0x00000000, + 0xEB0, 0x77777777, + 0xEB4, 0x00007777, + 0xEB8, 0x00000000, + 0xEBC, 0x00000000, + 0xEC0, 0x00000000, + 0xEC4, 0x00000000, + 0xEC8, 0x00000000, + 0xECC, 0x00000000, + 0xED0, 0x00000000, + 0xED4, 0x00000000, + 0xED8, 0x00000000, + 0xEDC, 0x00000000, + 0xEE0, 0x00000000, + 0xEE4, 0x00000000, + 0xEE8, 0x00000000, + 0xEEC, 0x00000000, + 0x1900, 0x00000000, + 0x1904, 0x00238000, + 0x1908, 0x00000000, + 0x190C, 0x00000000, + 0x1910, 0x00000000, + 0x1914, 0x00000000, + 0x1918, 0x00000000, + 0x191C, 0x00000000, + 0x1920, 0x00000000, + 0x1924, 0x00000000, + 0x1928, 0x00000000, + 0x192C, 0x00000000, + 0x1930, 0x00000000, + 0x1934, 0x00000000, + 0x1938, 0x00000000, + 0x193C, 0x00000000, + 0x1940, 0x00000000, + 0x1944, 0x00000000, + 0x1948, 0x00000000, + 0x194C, 0x00000000, + 0x1950, 0x00000000, + 0x1954, 0x00000000, + 0x1958, 0x00000000, + 0x195C, 0x00000000, + 0x1960, 0x00000000, + 0x1964, 0x00000000, + 0x1968, 0x00000000, + 0x196C, 0x00000000, + 0x1970, 0x00000000, + 0x1974, 0x00000000, + 0x1978, 0x00000000, + 0x197C, 0x00000000, + 0x1980, 0x00000000, + 0x1984, 0x03000000, + 0x1988, 0x21401E88, + 0x198C, 0x00004000, + 0x1990, 0x00000000, + 0x1994, 0x00000000, + 0x1998, 0x00000053, + 0x199C, 0x00000000, + 0x19A0, 0x00000000, + 0x19A4, 0x00000000, + 0x19A8, 0x00000000, + 0x19AC, 0x0E47E47F, + 0x19B0, 0x00000000, + 0x19B4, 0x0E47E47F, + 0x19B8, 0x00000000, + 0x19BC, 0x00000000, + 0x19C0, 0x00000000, + 0x19C4, 0x00000000, + 0x19C8, 0x00000000, + 0x19CC, 0x00000000, + 0x19D0, 0x00000000, + 0x19D4, 0xAAAAAAAA, + 0x19D8, 0x00000AAA, + 0x19DC, 0x133E0F37, + 0x19E0, 0x00000000, + 0x19E4, 0x00000000, + 0x19E8, 0x00000000, + 0x19EC, 0x00000000, + 0x19F0, 0x00000000, + 0x19F4, 0x00000000, + 0x19F8, 0x01A00000, + 0x19FC, 0x00000000, + 0x1C00, 0x00000100, + 0x1C04, 0x01000000, + 0x1C08, 0x00000100, + 0x1C0C, 0x01000000, + 0x1C10, 0x00000100, + 0x1C14, 0x01000000, + 0x1C18, 0x00000100, + 0x1C1C, 0x01000000, + 0x1C20, 0x00000100, + 0x1C24, 0x01000000, + 0x1C28, 0x00000100, + 0x1C2C, 0x01000000, + 0x1C30, 0x00000100, + 0x1C34, 0x01000000, + 0x1C38, 0x00000000, + 0x1C3C, 0x00000000, + 0x1C40, 0x000C0100, + 0x1C44, 0x000000F3, + 0x1C48, 0x1A8249A8, + 0x1C4C, 0x1461C826, + 0x1C50, 0x0001469E, + 0x1C54, 0x58D158D1, + 0x1C58, 0x04490088, + 0x1C5C, 0x04004400, + 0x1C60, 0x00000000, + 0x1C64, 0x04004400, + 0x1C68, 0x00000100, + 0x1C6C, 0x01000000, + 0x1C70, 0x00000100, + 0x1C74, 0x01000000, + 0x1C78, 0x00000000, + 0x1C7C, 0x00000010, + 0x1C80, 0x5FFF5FFF, + 0x1C84, 0x5FFF5FFF, + 0x1C88, 0x5FFF5FFF, + 0x1C8C, 0x5FFF5FFF, + 0x1C90, 0x5FFF5FFF, + 0x1C94, 0x5FFF5FFF, + 0x1C98, 0x5FFF5FFF, + 0x1C9C, 0x5FFF5FFF, + 0x1CA0, 0x00000100, + 0x1CA4, 0x01000000, + 0x1CA8, 0x00000100, + 0x1CAC, 0x5FFF5FFF, + 0x1CB0, 0x00000100, + 0x1CB4, 0x01000000, + 0x1CB8, 0x00000000, + 0x1CBC, 0x00000000, + 0x1CC0, 0x00000100, + 0x1CC4, 0x01000000, + 0x1CC8, 0x00000100, + 0x1CCC, 0x01000000, + 0x1CD0, 0x00000100, + 0x1CD4, 0x01000000, + 0x1CD8, 0x00000100, + 0x1CDC, 0x01000000, + 0x1CE0, 0x00000100, + 0x1CE4, 0x01000000, + 0x1CE8, 0x00000100, + 0x1CEC, 0x01000000, + 0x1CF0, 0x00000100, + 0x1CF4, 0x01000000, + 0x1CF8, 0x00000000, + 0x1CFC, 0x00000000, + 0xC60, 0x70038040, + 0xC60, 0x70038040, + 0xC60, 0x70146040, + 0xC60, 0x70246040, + 0xC60, 0x70346040, + 0xC60, 0x70446040, + 0xC60, 0x70532040, + 0xC60, 0x70646040, + 0xC60, 0x70738040, + 0xC60, 0x70838040, + 0xC60, 0x70938040, + 0xC60, 0x70A38040, + 0xC60, 0x70B36040, + 0xC60, 0x70C06040, + 0xC60, 0x70D06040, + 0xC60, 0x70E76040, + 0xC60, 0x70F06040, + 0xE60, 0x70038040, + 0xE60, 0x70038040, + 0xE60, 0x70146040, + 0xE60, 0x70246040, + 0xE60, 0x70346040, + 0xE60, 0x70446040, + 0xE60, 0x70532040, + 0xE60, 0x70646040, + 0xE60, 0x70738040, + 0xE60, 0x70838040, + 0xE60, 0x70938040, + 0xE60, 0x70A38040, + 0xE60, 0x70B36040, + 0xE60, 0x70C06040, + 0xE60, 0x70D06040, + 0xE60, 0x70E76040, + 0xE60, 0x70F06040, + 0xC64, 0x00800000, + 0xC64, 0x08800001, + 0xC64, 0x00800002, + 0xC64, 0x00800003, + 0xC64, 0x00800004, + 0xC64, 0x00800005, + 0xC64, 0x00800006, + 0xC64, 0x08800007, + 0xC64, 0x00004000, + 0xE64, 0x00800000, + 0xE64, 0x08800001, + 0xE64, 0x00800002, + 0xE64, 0x00800003, + 0xE64, 0x00800004, + 0xE64, 0x00800005, + 0xE64, 0x00800006, + 0xE64, 0x08800007, + 0xE64, 0x00004000, + 0x1B00, 0xF8000008, + 0x1B00, 0xF80A7008, + 0x1B00, 0xF8015008, + 0x1B00, 0xF8000008, + 0x1B04, 0xE24629D2, + 0x1B08, 0x00000080, + 0x1B0C, 0x00000000, + 0x1B10, 0x00011C00, + 0x1B14, 0x00000000, + 0x1B18, 0x00292903, + 0x1B1C, 0xA2193C32, + 0x1B20, 0x01840008, + 0x1B24, 0x01860008, + 0x1B28, 0x80060300, + 0x1B2C, 0x00000003, + 0x1B30, 0x20000000, + 0x1B34, 0x00000800, + 0x1B3C, 0x20000000, + 0x1BC0, 0x01000000, + 0x1BCC, 0x00000000, + 0x1B00, 0xF800000A, + 0x1B1C, 0xA2193C32, + 0x1B20, 0x01840008, + 0x1B24, 0x01860008, + 0x1B28, 0x80060300, + 0x1B2C, 0x00000003, + 0x1B30, 0x20000000, + 0x1B34, 0x00000800, + 0x1B3C, 0x20000000, + 0x1BC0, 0x01000000, + 0x1BCC, 0x00000000, + 0x1B00, 0xF8000000, + 0x1B80, 0x00000007, + 0x1B80, 0x090A0005, + 0x1B80, 0x090A0007, + 0x1B80, 0x0FFE0015, + 0x1B80, 0x0FFE0017, + 0x1B80, 0x00220025, + 0x1B80, 0x00220027, + 0x1B80, 0x00040035, + 0x1B80, 0x00040037, + 0x1B80, 0x05C00045, + 0x1B80, 0x05C00047, + 0x1B80, 0x00070055, + 0x1B80, 0x00070057, + 0x1B80, 0x64000065, + 0x1B80, 0x64000067, + 0x1B80, 0x00020075, + 0x1B80, 0x00020077, + 0x1B80, 0x00080085, + 0x1B80, 0x00080087, + 0x1B80, 0x80000095, + 0x1B80, 0x80000097, + 0x1B80, 0x090800A5, + 0x1B80, 0x090800A7, + 0x1B80, 0x0F0200B5, + 0x1B80, 0x0F0200B7, + 0x1B80, 0x002200C5, + 0x1B80, 0x002200C7, + 0x1B80, 0x000400D5, + 0x1B80, 0x000400D7, + 0x1B80, 0x05C000E5, + 0x1B80, 0x05C000E7, + 0x1B80, 0x000700F5, + 0x1B80, 0x000700F7, + 0x1B80, 0x64020105, + 0x1B80, 0x64020107, + 0x1B80, 0x00020115, + 0x1B80, 0x00020117, + 0x1B80, 0x00040125, + 0x1B80, 0x00040127, + 0x1B80, 0x4A000135, + 0x1B80, 0x4A000137, + 0x1B80, 0x4B040145, + 0x1B80, 0x4B040147, + 0x1B80, 0x85030155, + 0x1B80, 0x85030157, + 0x1B80, 0x40090165, + 0x1B80, 0x40090167, + 0x1B80, 0xE0280175, + 0x1B80, 0xE0280177, + 0x1B80, 0x4B050185, + 0x1B80, 0x4B050187, + 0x1B80, 0x86030195, + 0x1B80, 0x86030197, + 0x1B80, 0x400B01A5, + 0x1B80, 0x400B01A7, + 0x1B80, 0xE02801B5, + 0x1B80, 0xE02801B7, + 0x1B80, 0x4B0001C5, + 0x1B80, 0x4B0001C7, + 0x1B80, 0x000701D5, + 0x1B80, 0x000701D7, + 0x1B80, 0x4C0001E5, + 0x1B80, 0x4C0001E7, + 0x1B80, 0x000401F5, + 0x1B80, 0x000401F7, + 0x1B80, 0x4D040205, + 0x1B80, 0x4D040207, + 0x1B80, 0x2EF00215, + 0x1B80, 0x2EF00217, + 0x1B80, 0x00000225, + 0x1B80, 0x00000227, + 0x1B80, 0x20810235, + 0x1B80, 0x20810237, + 0x1B80, 0x23450245, + 0x1B80, 0x23450247, + 0x1B80, 0x4D000255, + 0x1B80, 0x4D000257, + 0x1B80, 0x00040265, + 0x1B80, 0x00040267, + 0x1B80, 0x30000275, + 0x1B80, 0x30000277, + 0x1B80, 0xE1D80285, + 0x1B80, 0xE1D80287, + 0x1B80, 0xF0110295, + 0x1B80, 0xF0110297, + 0x1B80, 0xF11102A5, + 0x1B80, 0xF11102A7, + 0x1B80, 0xF21102B5, + 0x1B80, 0xF21102B7, + 0x1B80, 0xF31102C5, + 0x1B80, 0xF31102C7, + 0x1B80, 0xF41102D5, + 0x1B80, 0xF41102D7, + 0x1B80, 0xF51102E5, + 0x1B80, 0xF51102E7, + 0x1B80, 0xF61102F5, + 0x1B80, 0xF61102F7, + 0x1B80, 0xF7110305, + 0x1B80, 0xF7110307, + 0x1B80, 0xF8110315, + 0x1B80, 0xF8110317, + 0x1B80, 0xF9110325, + 0x1B80, 0xF9110327, + 0x1B80, 0xFA110335, + 0x1B80, 0xFA110337, + 0x1B80, 0xFB110345, + 0x1B80, 0xFB110347, + 0x1B80, 0xFC110355, + 0x1B80, 0xFC110357, + 0x1B80, 0xFD110365, + 0x1B80, 0xFD110367, + 0x1B80, 0xFE110375, + 0x1B80, 0xFE110377, + 0x1B80, 0xFF110385, + 0x1B80, 0xFF110387, + 0x1B80, 0x00010395, + 0x1B80, 0x00010397, + 0x1B80, 0x305103A5, + 0x1B80, 0x305103A7, + 0x1B80, 0x306903B5, + 0x1B80, 0x306903B7, + 0x1B80, 0x30B403C5, + 0x1B80, 0x30B403C7, + 0x1B80, 0x30B703D5, + 0x1B80, 0x30B703D7, + 0x1B80, 0x306B03E5, + 0x1B80, 0x306B03E7, + 0x1B80, 0x307603F5, + 0x1B80, 0x307603F7, + 0x1B80, 0x30810405, + 0x1B80, 0x30810407, + 0x1B80, 0x30C10415, + 0x1B80, 0x30C10417, + 0x1B80, 0x30BB0425, + 0x1B80, 0x30BB0427, + 0x1B80, 0x30CF0435, + 0x1B80, 0x30CF0437, + 0x1B80, 0x30DA0445, + 0x1B80, 0x30DA0447, + 0x1B80, 0x30E50455, + 0x1B80, 0x30E50457, + 0x1B80, 0x304A0465, + 0x1B80, 0x304A0467, + 0x1B80, 0x31140475, + 0x1B80, 0x31140477, + 0x1B80, 0x31250485, + 0x1B80, 0x31250487, + 0x1B80, 0x313A0495, + 0x1B80, 0x313A0497, + 0x1B80, 0x4D0404A5, + 0x1B80, 0x4D0404A7, + 0x1B80, 0x2EF004B5, + 0x1B80, 0x2EF004B7, + 0x1B80, 0x000004C5, + 0x1B80, 0x000004C7, + 0x1B80, 0x208104D5, + 0x1B80, 0x208104D7, + 0x1B80, 0xA3B504E5, + 0x1B80, 0xA3B504E7, + 0x1B80, 0x4D0004F5, + 0x1B80, 0x4D0004F7, + 0x1B80, 0x30000505, + 0x1B80, 0x30000507, + 0x1B80, 0xE1650515, + 0x1B80, 0xE1650517, + 0x1B80, 0x4D040525, + 0x1B80, 0x4D040527, + 0x1B80, 0x20800535, + 0x1B80, 0x20800537, + 0x1B80, 0x00000545, + 0x1B80, 0x00000547, + 0x1B80, 0x4D000555, + 0x1B80, 0x4D000557, + 0x1B80, 0x55070565, + 0x1B80, 0x55070567, + 0x1B80, 0xE15D0575, + 0x1B80, 0xE15D0577, + 0x1B80, 0xE15D0585, + 0x1B80, 0xE15D0587, + 0x1B80, 0x4D040595, + 0x1B80, 0x4D040597, + 0x1B80, 0x208805A5, + 0x1B80, 0x208805A7, + 0x1B80, 0x020005B5, + 0x1B80, 0x020005B7, + 0x1B80, 0x4D0005C5, + 0x1B80, 0x4D0005C7, + 0x1B80, 0x550F05D5, + 0x1B80, 0x550F05D7, + 0x1B80, 0xE15D05E5, + 0x1B80, 0xE15D05E7, + 0x1B80, 0x4F0205F5, + 0x1B80, 0x4F0205F7, + 0x1B80, 0x4E000605, + 0x1B80, 0x4E000607, + 0x1B80, 0x53020615, + 0x1B80, 0x53020617, + 0x1B80, 0x52010625, + 0x1B80, 0x52010627, + 0x1B80, 0xE1610635, + 0x1B80, 0xE1610637, + 0x1B80, 0x4D080645, + 0x1B80, 0x4D080647, + 0x1B80, 0x57100655, + 0x1B80, 0x57100657, + 0x1B80, 0x57000665, + 0x1B80, 0x57000667, + 0x1B80, 0x4D000675, + 0x1B80, 0x4D000677, + 0x1B80, 0x00010685, + 0x1B80, 0x00010687, + 0x1B80, 0xE1650695, + 0x1B80, 0xE1650697, + 0x1B80, 0x000106A5, + 0x1B80, 0x000106A7, + 0x1B80, 0x308B06B5, + 0x1B80, 0x308B06B7, + 0x1B80, 0x002306C5, + 0x1B80, 0x002306C7, + 0x1B80, 0xE1CB06D5, + 0x1B80, 0xE1CB06D7, + 0x1B80, 0x000206E5, + 0x1B80, 0x000206E7, + 0x1B80, 0x54E906F5, + 0x1B80, 0x54E906F7, + 0x1B80, 0x0BA60705, + 0x1B80, 0x0BA60707, + 0x1B80, 0x00230715, + 0x1B80, 0x00230717, + 0x1B80, 0xE1CB0725, + 0x1B80, 0xE1CB0727, + 0x1B80, 0x00020735, + 0x1B80, 0x00020737, + 0x1B80, 0x4D300745, + 0x1B80, 0x4D300747, + 0x1B80, 0x30A40755, + 0x1B80, 0x30A40757, + 0x1B80, 0x30870765, + 0x1B80, 0x30870767, + 0x1B80, 0x00220775, + 0x1B80, 0x00220777, + 0x1B80, 0xE1CB0785, + 0x1B80, 0xE1CB0787, + 0x1B80, 0x00020795, + 0x1B80, 0x00020797, + 0x1B80, 0x54E807A5, + 0x1B80, 0x54E807A7, + 0x1B80, 0x0BA607B5, + 0x1B80, 0x0BA607B7, + 0x1B80, 0x002207C5, + 0x1B80, 0x002207C7, + 0x1B80, 0xE1CB07D5, + 0x1B80, 0xE1CB07D7, + 0x1B80, 0x000207E5, + 0x1B80, 0x000207E7, + 0x1B80, 0x4D3007F5, + 0x1B80, 0x4D3007F7, + 0x1B80, 0x30A40805, + 0x1B80, 0x30A40807, + 0x1B80, 0x63F10815, + 0x1B80, 0x63F10817, + 0x1B80, 0xE1650825, + 0x1B80, 0xE1650827, + 0x1B80, 0xE1CB0835, + 0x1B80, 0xE1CB0837, + 0x1B80, 0x63F40845, + 0x1B80, 0x63F40847, + 0x1B80, 0xE1650855, + 0x1B80, 0xE1650857, + 0x1B80, 0xE1CB0865, + 0x1B80, 0xE1CB0867, + 0x1B80, 0x0BA80875, + 0x1B80, 0x0BA80877, + 0x1B80, 0x63F80885, + 0x1B80, 0x63F80887, + 0x1B80, 0xE1650895, + 0x1B80, 0xE1650897, + 0x1B80, 0xE1CB08A5, + 0x1B80, 0xE1CB08A7, + 0x1B80, 0x0BA908B5, + 0x1B80, 0x0BA908B7, + 0x1B80, 0x63FC08C5, + 0x1B80, 0x63FC08C7, + 0x1B80, 0xE16508D5, + 0x1B80, 0xE16508D7, + 0x1B80, 0xE1CB08E5, + 0x1B80, 0xE1CB08E7, + 0x1B80, 0x63FF08F5, + 0x1B80, 0x63FF08F7, + 0x1B80, 0xE1650905, + 0x1B80, 0xE1650907, + 0x1B80, 0xE1CB0915, + 0x1B80, 0xE1CB0917, + 0x1B80, 0x63000925, + 0x1B80, 0x63000927, + 0x1B80, 0xE1650935, + 0x1B80, 0xE1650937, + 0x1B80, 0xE1CB0945, + 0x1B80, 0xE1CB0947, + 0x1B80, 0x63030955, + 0x1B80, 0x63030957, + 0x1B80, 0xE1650965, + 0x1B80, 0xE1650967, + 0x1B80, 0xE1CB0975, + 0x1B80, 0xE1CB0977, + 0x1B80, 0xF4D40985, + 0x1B80, 0xF4D40987, + 0x1B80, 0x63070995, + 0x1B80, 0x63070997, + 0x1B80, 0xE16509A5, + 0x1B80, 0xE16509A7, + 0x1B80, 0xE1CB09B5, + 0x1B80, 0xE1CB09B7, + 0x1B80, 0xF5DB09C5, + 0x1B80, 0xF5DB09C7, + 0x1B80, 0x630B09D5, + 0x1B80, 0x630B09D7, + 0x1B80, 0xE16509E5, + 0x1B80, 0xE16509E7, + 0x1B80, 0xE1CB09F5, + 0x1B80, 0xE1CB09F7, + 0x1B80, 0x630E0A05, + 0x1B80, 0x630E0A07, + 0x1B80, 0xE1650A15, + 0x1B80, 0xE1650A17, + 0x1B80, 0xE1CB0A25, + 0x1B80, 0xE1CB0A27, + 0x1B80, 0x4D300A35, + 0x1B80, 0x4D300A37, + 0x1B80, 0x55010A45, + 0x1B80, 0x55010A47, + 0x1B80, 0x57040A55, + 0x1B80, 0x57040A57, + 0x1B80, 0x57000A65, + 0x1B80, 0x57000A67, + 0x1B80, 0x96000A75, + 0x1B80, 0x96000A77, + 0x1B80, 0x57080A85, + 0x1B80, 0x57080A87, + 0x1B80, 0x57000A95, + 0x1B80, 0x57000A97, + 0x1B80, 0x95000AA5, + 0x1B80, 0x95000AA7, + 0x1B80, 0x4D000AB5, + 0x1B80, 0x4D000AB7, + 0x1B80, 0x6C070AC5, + 0x1B80, 0x6C070AC7, + 0x1B80, 0x7B200AD5, + 0x1B80, 0x7B200AD7, + 0x1B80, 0x7A000AE5, + 0x1B80, 0x7A000AE7, + 0x1B80, 0x79000AF5, + 0x1B80, 0x79000AF7, + 0x1B80, 0x7F200B05, + 0x1B80, 0x7F200B07, + 0x1B80, 0x7E000B15, + 0x1B80, 0x7E000B17, + 0x1B80, 0x7D000B25, + 0x1B80, 0x7D000B27, + 0x1B80, 0x00010B35, + 0x1B80, 0x00010B37, + 0x1B80, 0x62850B45, + 0x1B80, 0x62850B47, + 0x1B80, 0xE1650B55, + 0x1B80, 0xE1650B57, + 0x1B80, 0x00010B65, + 0x1B80, 0x00010B67, + 0x1B80, 0x5C320B75, + 0x1B80, 0x5C320B77, + 0x1B80, 0xE1C70B85, + 0x1B80, 0xE1C70B87, + 0x1B80, 0xE1930B95, + 0x1B80, 0xE1930B97, + 0x1B80, 0x00010BA5, + 0x1B80, 0x00010BA7, + 0x1B80, 0x5C320BB5, + 0x1B80, 0x5C320BB7, + 0x1B80, 0x63F40BC5, + 0x1B80, 0x63F40BC7, + 0x1B80, 0x62850BD5, + 0x1B80, 0x62850BD7, + 0x1B80, 0x0BB00BE5, + 0x1B80, 0x0BB00BE7, + 0x1B80, 0xE1650BF5, + 0x1B80, 0xE1650BF7, + 0x1B80, 0xE1CB0C05, + 0x1B80, 0xE1CB0C07, + 0x1B80, 0x5C320C15, + 0x1B80, 0x5C320C17, + 0x1B80, 0x63FC0C25, + 0x1B80, 0x63FC0C27, + 0x1B80, 0x62850C35, + 0x1B80, 0x62850C37, + 0x1B80, 0x0BB10C45, + 0x1B80, 0x0BB10C47, + 0x1B80, 0xE1650C55, + 0x1B80, 0xE1650C57, + 0x1B80, 0xE1CB0C65, + 0x1B80, 0xE1CB0C67, + 0x1B80, 0x63030C75, + 0x1B80, 0x63030C77, + 0x1B80, 0xE1650C85, + 0x1B80, 0xE1650C87, + 0x1B80, 0xE1CB0C95, + 0x1B80, 0xE1CB0C97, + 0x1B80, 0xF7040CA5, + 0x1B80, 0xF7040CA7, + 0x1B80, 0x630B0CB5, + 0x1B80, 0x630B0CB7, + 0x1B80, 0xE1650CC5, + 0x1B80, 0xE1650CC7, + 0x1B80, 0xE1CB0CD5, + 0x1B80, 0xE1CB0CD7, + 0x1B80, 0x00010CE5, + 0x1B80, 0x00010CE7, + 0x1B80, 0x30F30CF5, + 0x1B80, 0x30F30CF7, + 0x1B80, 0x00230D05, + 0x1B80, 0x00230D07, + 0x1B80, 0xE1D00D15, + 0x1B80, 0xE1D00D17, + 0x1B80, 0x00020D25, + 0x1B80, 0x00020D27, + 0x1B80, 0x54E90D35, + 0x1B80, 0x54E90D37, + 0x1B80, 0x0BA60D45, + 0x1B80, 0x0BA60D47, + 0x1B80, 0x00230D55, + 0x1B80, 0x00230D57, + 0x1B80, 0xE1D00D65, + 0x1B80, 0xE1D00D67, + 0x1B80, 0x00020D75, + 0x1B80, 0x00020D77, + 0x1B80, 0x4D100D85, + 0x1B80, 0x4D100D87, + 0x1B80, 0x30A40D95, + 0x1B80, 0x30A40D97, + 0x1B80, 0x30ED0DA5, + 0x1B80, 0x30ED0DA7, + 0x1B80, 0x00220DB5, + 0x1B80, 0x00220DB7, + 0x1B80, 0xE1D00DC5, + 0x1B80, 0xE1D00DC7, + 0x1B80, 0x00020DD5, + 0x1B80, 0x00020DD7, + 0x1B80, 0x54E80DE5, + 0x1B80, 0x54E80DE7, + 0x1B80, 0x0BA60DF5, + 0x1B80, 0x0BA60DF7, + 0x1B80, 0x00220E05, + 0x1B80, 0x00220E07, + 0x1B80, 0xE1D00E15, + 0x1B80, 0xE1D00E17, + 0x1B80, 0x00020E25, + 0x1B80, 0x00020E27, + 0x1B80, 0x4D100E35, + 0x1B80, 0x4D100E37, + 0x1B80, 0x30A40E45, + 0x1B80, 0x30A40E47, + 0x1B80, 0x5C320E55, + 0x1B80, 0x5C320E57, + 0x1B80, 0x54F00E65, + 0x1B80, 0x54F00E67, + 0x1B80, 0x67F10E75, + 0x1B80, 0x67F10E77, + 0x1B80, 0xE1930E85, + 0x1B80, 0xE1930E87, + 0x1B80, 0xE1D00E95, + 0x1B80, 0xE1D00E97, + 0x1B80, 0x67F40EA5, + 0x1B80, 0x67F40EA7, + 0x1B80, 0xE1930EB5, + 0x1B80, 0xE1930EB7, + 0x1B80, 0xE1D00EC5, + 0x1B80, 0xE1D00EC7, + 0x1B80, 0x5C320ED5, + 0x1B80, 0x5C320ED7, + 0x1B80, 0x54F10EE5, + 0x1B80, 0x54F10EE7, + 0x1B80, 0x0BA80EF5, + 0x1B80, 0x0BA80EF7, + 0x1B80, 0x67F80F05, + 0x1B80, 0x67F80F07, + 0x1B80, 0xE1930F15, + 0x1B80, 0xE1930F17, + 0x1B80, 0xE1D00F25, + 0x1B80, 0xE1D00F27, + 0x1B80, 0x5C320F35, + 0x1B80, 0x5C320F37, + 0x1B80, 0x54F10F45, + 0x1B80, 0x54F10F47, + 0x1B80, 0x0BA90F55, + 0x1B80, 0x0BA90F57, + 0x1B80, 0x67FC0F65, + 0x1B80, 0x67FC0F67, + 0x1B80, 0xE1930F75, + 0x1B80, 0xE1930F77, + 0x1B80, 0xE1D00F85, + 0x1B80, 0xE1D00F87, + 0x1B80, 0x67FF0F95, + 0x1B80, 0x67FF0F97, + 0x1B80, 0xE1930FA5, + 0x1B80, 0xE1930FA7, + 0x1B80, 0xE1D00FB5, + 0x1B80, 0xE1D00FB7, + 0x1B80, 0x5C320FC5, + 0x1B80, 0x5C320FC7, + 0x1B80, 0x54F20FD5, + 0x1B80, 0x54F20FD7, + 0x1B80, 0x67000FE5, + 0x1B80, 0x67000FE7, + 0x1B80, 0xE1930FF5, + 0x1B80, 0xE1930FF7, + 0x1B80, 0xE1D01005, + 0x1B80, 0xE1D01007, + 0x1B80, 0x67031015, + 0x1B80, 0x67031017, + 0x1B80, 0xE1931025, + 0x1B80, 0xE1931027, + 0x1B80, 0xE1D01035, + 0x1B80, 0xE1D01037, + 0x1B80, 0xF9CC1045, + 0x1B80, 0xF9CC1047, + 0x1B80, 0x67071055, + 0x1B80, 0x67071057, + 0x1B80, 0xE1931065, + 0x1B80, 0xE1931067, + 0x1B80, 0xE1D01075, + 0x1B80, 0xE1D01077, + 0x1B80, 0xFAD31085, + 0x1B80, 0xFAD31087, + 0x1B80, 0x5C321095, + 0x1B80, 0x5C321097, + 0x1B80, 0x54F310A5, + 0x1B80, 0x54F310A7, + 0x1B80, 0x670B10B5, + 0x1B80, 0x670B10B7, + 0x1B80, 0xE19310C5, + 0x1B80, 0xE19310C7, + 0x1B80, 0xE1D010D5, + 0x1B80, 0xE1D010D7, + 0x1B80, 0x670E10E5, + 0x1B80, 0x670E10E7, + 0x1B80, 0xE19310F5, + 0x1B80, 0xE19310F7, + 0x1B80, 0xE1D01105, + 0x1B80, 0xE1D01107, + 0x1B80, 0x4D101115, + 0x1B80, 0x4D101117, + 0x1B80, 0x30A41125, + 0x1B80, 0x30A41127, + 0x1B80, 0x00011135, + 0x1B80, 0x00011137, + 0x1B80, 0x6C001145, + 0x1B80, 0x6C001147, + 0x1B80, 0x00061155, + 0x1B80, 0x00061157, + 0x1B80, 0x53001165, + 0x1B80, 0x53001167, + 0x1B80, 0x57F71175, + 0x1B80, 0x57F71177, + 0x1B80, 0x58211185, + 0x1B80, 0x58211187, + 0x1B80, 0x592E1195, + 0x1B80, 0x592E1197, + 0x1B80, 0x5A3811A5, + 0x1B80, 0x5A3811A7, + 0x1B80, 0x5B4111B5, + 0x1B80, 0x5B4111B7, + 0x1B80, 0x000711C5, + 0x1B80, 0x000711C7, + 0x1B80, 0x5C0011D5, + 0x1B80, 0x5C0011D7, + 0x1B80, 0x4B0011E5, + 0x1B80, 0x4B0011E7, + 0x1B80, 0x4E8F11F5, + 0x1B80, 0x4E8F11F7, + 0x1B80, 0x4F151205, + 0x1B80, 0x4F151207, + 0x1B80, 0x00041215, + 0x1B80, 0x00041217, + 0x1B80, 0xE1B51225, + 0x1B80, 0xE1B51227, + 0x1B80, 0xAB001235, + 0x1B80, 0xAB001237, + 0x1B80, 0x00011245, + 0x1B80, 0x00011247, + 0x1B80, 0x6C001255, + 0x1B80, 0x6C001257, + 0x1B80, 0x00061265, + 0x1B80, 0x00061267, + 0x1B80, 0x53001275, + 0x1B80, 0x53001277, + 0x1B80, 0x57F71285, + 0x1B80, 0x57F71287, + 0x1B80, 0x58211295, + 0x1B80, 0x58211297, + 0x1B80, 0x592E12A5, + 0x1B80, 0x592E12A7, + 0x1B80, 0x5A3812B5, + 0x1B80, 0x5A3812B7, + 0x1B80, 0x5B4112C5, + 0x1B80, 0x5B4112C7, + 0x1B80, 0x000712D5, + 0x1B80, 0x000712D7, + 0x1B80, 0x5C0012E5, + 0x1B80, 0x5C0012E7, + 0x1B80, 0x4B4012F5, + 0x1B80, 0x4B4012F7, + 0x1B80, 0x4E971305, + 0x1B80, 0x4E971307, + 0x1B80, 0x4F111315, + 0x1B80, 0x4F111317, + 0x1B80, 0x00041325, + 0x1B80, 0x00041327, + 0x1B80, 0xE1B51335, + 0x1B80, 0xE1B51337, + 0x1B80, 0xAB001345, + 0x1B80, 0xAB001347, + 0x1B80, 0x8B001355, + 0x1B80, 0x8B001357, + 0x1B80, 0xAB001365, + 0x1B80, 0xAB001367, + 0x1B80, 0x8A191375, + 0x1B80, 0x8A191377, + 0x1B80, 0x301D1385, + 0x1B80, 0x301D1387, + 0x1B80, 0x00011395, + 0x1B80, 0x00011397, + 0x1B80, 0x6C0113A5, + 0x1B80, 0x6C0113A7, + 0x1B80, 0x000613B5, + 0x1B80, 0x000613B7, + 0x1B80, 0x530113C5, + 0x1B80, 0x530113C7, + 0x1B80, 0x57F713D5, + 0x1B80, 0x57F713D7, + 0x1B80, 0x582113E5, + 0x1B80, 0x582113E7, + 0x1B80, 0x592E13F5, + 0x1B80, 0x592E13F7, + 0x1B80, 0x5A381405, + 0x1B80, 0x5A381407, + 0x1B80, 0x5B411415, + 0x1B80, 0x5B411417, + 0x1B80, 0x00071425, + 0x1B80, 0x00071427, + 0x1B80, 0x5C001435, + 0x1B80, 0x5C001437, + 0x1B80, 0x4B001445, + 0x1B80, 0x4B001447, + 0x1B80, 0x4E871455, + 0x1B80, 0x4E871457, + 0x1B80, 0x4F111465, + 0x1B80, 0x4F111467, + 0x1B80, 0x00041475, + 0x1B80, 0x00041477, + 0x1B80, 0xE1B51485, + 0x1B80, 0xE1B51487, + 0x1B80, 0xAB001495, + 0x1B80, 0xAB001497, + 0x1B80, 0x000614A5, + 0x1B80, 0x000614A7, + 0x1B80, 0x577714B5, + 0x1B80, 0x577714B7, + 0x1B80, 0x000714C5, + 0x1B80, 0x000714C7, + 0x1B80, 0x4E8614D5, + 0x1B80, 0x4E8614D7, + 0x1B80, 0x000414E5, + 0x1B80, 0x000414E7, + 0x1B80, 0x000114F5, + 0x1B80, 0x000114F7, + 0x1B80, 0x00011505, + 0x1B80, 0x00011507, + 0x1B80, 0x7B241515, + 0x1B80, 0x7B241517, + 0x1B80, 0x7A401525, + 0x1B80, 0x7A401527, + 0x1B80, 0x79001535, + 0x1B80, 0x79001537, + 0x1B80, 0x55031545, + 0x1B80, 0x55031547, + 0x1B80, 0x315D1555, + 0x1B80, 0x315D1557, + 0x1B80, 0x7B1C1565, + 0x1B80, 0x7B1C1567, + 0x1B80, 0x7A401575, + 0x1B80, 0x7A401577, + 0x1B80, 0x550B1585, + 0x1B80, 0x550B1587, + 0x1B80, 0x315D1595, + 0x1B80, 0x315D1597, + 0x1B80, 0x7B2015A5, + 0x1B80, 0x7B2015A7, + 0x1B80, 0x7A0015B5, + 0x1B80, 0x7A0015B7, + 0x1B80, 0x551315C5, + 0x1B80, 0x551315C7, + 0x1B80, 0x740115D5, + 0x1B80, 0x740115D7, + 0x1B80, 0x740015E5, + 0x1B80, 0x740015E7, + 0x1B80, 0x8E0015F5, + 0x1B80, 0x8E0015F7, + 0x1B80, 0x00011605, + 0x1B80, 0x00011607, + 0x1B80, 0x57021615, + 0x1B80, 0x57021617, + 0x1B80, 0x57001625, + 0x1B80, 0x57001627, + 0x1B80, 0x97001635, + 0x1B80, 0x97001637, + 0x1B80, 0x00011645, + 0x1B80, 0x00011647, + 0x1B80, 0x4F781655, + 0x1B80, 0x4F781657, + 0x1B80, 0x53881665, + 0x1B80, 0x53881667, + 0x1B80, 0xE1731675, + 0x1B80, 0xE1731677, + 0x1B80, 0x54801685, + 0x1B80, 0x54801687, + 0x1B80, 0x54001695, + 0x1B80, 0x54001697, + 0x1B80, 0xE17316A5, + 0x1B80, 0xE17316A7, + 0x1B80, 0x548116B5, + 0x1B80, 0x548116B7, + 0x1B80, 0x540016C5, + 0x1B80, 0x540016C7, + 0x1B80, 0xE17316D5, + 0x1B80, 0xE17316D7, + 0x1B80, 0x548216E5, + 0x1B80, 0x548216E7, + 0x1B80, 0x540016F5, + 0x1B80, 0x540016F7, + 0x1B80, 0xE17E1705, + 0x1B80, 0xE17E1707, + 0x1B80, 0xBF1D1715, + 0x1B80, 0xBF1D1717, + 0x1B80, 0x301D1725, + 0x1B80, 0x301D1727, + 0x1B80, 0xE1511735, + 0x1B80, 0xE1511737, + 0x1B80, 0xE1561745, + 0x1B80, 0xE1561747, + 0x1B80, 0xE15A1755, + 0x1B80, 0xE15A1757, + 0x1B80, 0xE1611765, + 0x1B80, 0xE1611767, + 0x1B80, 0xE1C71775, + 0x1B80, 0xE1C71777, + 0x1B80, 0x55131785, + 0x1B80, 0x55131787, + 0x1B80, 0xE15D1795, + 0x1B80, 0xE15D1797, + 0x1B80, 0x551517A5, + 0x1B80, 0x551517A7, + 0x1B80, 0xE16117B5, + 0x1B80, 0xE16117B7, + 0x1B80, 0xE1C717C5, + 0x1B80, 0xE1C717C7, + 0x1B80, 0x000117D5, + 0x1B80, 0x000117D7, + 0x1B80, 0x54BF17E5, + 0x1B80, 0x54BF17E7, + 0x1B80, 0x54C017F5, + 0x1B80, 0x54C017F7, + 0x1B80, 0x54A31805, + 0x1B80, 0x54A31807, + 0x1B80, 0x54C11815, + 0x1B80, 0x54C11817, + 0x1B80, 0x54A41825, + 0x1B80, 0x54A41827, + 0x1B80, 0x4C181835, + 0x1B80, 0x4C181837, + 0x1B80, 0xBF071845, + 0x1B80, 0xBF071847, + 0x1B80, 0x54C21855, + 0x1B80, 0x54C21857, + 0x1B80, 0x54A41865, + 0x1B80, 0x54A41867, + 0x1B80, 0xBF041875, + 0x1B80, 0xBF041877, + 0x1B80, 0x54C11885, + 0x1B80, 0x54C11887, + 0x1B80, 0x54A31895, + 0x1B80, 0x54A31897, + 0x1B80, 0xBF0118A5, + 0x1B80, 0xBF0118A7, + 0x1B80, 0xE1D518B5, + 0x1B80, 0xE1D518B7, + 0x1B80, 0x54DF18C5, + 0x1B80, 0x54DF18C7, + 0x1B80, 0x000118D5, + 0x1B80, 0x000118D7, + 0x1B80, 0x54BF18E5, + 0x1B80, 0x54BF18E7, + 0x1B80, 0x54E518F5, + 0x1B80, 0x54E518F7, + 0x1B80, 0x050A1905, + 0x1B80, 0x050A1907, + 0x1B80, 0x54DF1915, + 0x1B80, 0x54DF1917, + 0x1B80, 0x00011925, + 0x1B80, 0x00011927, + 0x1B80, 0x7F201935, + 0x1B80, 0x7F201937, + 0x1B80, 0x7E001945, + 0x1B80, 0x7E001947, + 0x1B80, 0x7D001955, + 0x1B80, 0x7D001957, + 0x1B80, 0x55011965, + 0x1B80, 0x55011967, + 0x1B80, 0x5C311975, + 0x1B80, 0x5C311977, + 0x1B80, 0xE15D1985, + 0x1B80, 0xE15D1987, + 0x1B80, 0xE1611995, + 0x1B80, 0xE1611997, + 0x1B80, 0x548019A5, + 0x1B80, 0x548019A7, + 0x1B80, 0x540019B5, + 0x1B80, 0x540019B7, + 0x1B80, 0xE15D19C5, + 0x1B80, 0xE15D19C7, + 0x1B80, 0xE16119D5, + 0x1B80, 0xE16119D7, + 0x1B80, 0x548119E5, + 0x1B80, 0x548119E7, + 0x1B80, 0x540019F5, + 0x1B80, 0x540019F7, + 0x1B80, 0xE15D1A05, + 0x1B80, 0xE15D1A07, + 0x1B80, 0xE1611A15, + 0x1B80, 0xE1611A17, + 0x1B80, 0x54821A25, + 0x1B80, 0x54821A27, + 0x1B80, 0x54001A35, + 0x1B80, 0x54001A37, + 0x1B80, 0xE17E1A45, + 0x1B80, 0xE17E1A47, + 0x1B80, 0xBFE91A55, + 0x1B80, 0xBFE91A57, + 0x1B80, 0x301D1A65, + 0x1B80, 0x301D1A67, + 0x1B80, 0x00231A75, + 0x1B80, 0x00231A77, + 0x1B80, 0x7B201A85, + 0x1B80, 0x7B201A87, + 0x1B80, 0x7A001A95, + 0x1B80, 0x7A001A97, + 0x1B80, 0x79001AA5, + 0x1B80, 0x79001AA7, + 0x1B80, 0xE1CB1AB5, + 0x1B80, 0xE1CB1AB7, + 0x1B80, 0x00021AC5, + 0x1B80, 0x00021AC7, + 0x1B80, 0x00011AD5, + 0x1B80, 0x00011AD7, + 0x1B80, 0x00221AE5, + 0x1B80, 0x00221AE7, + 0x1B80, 0x7B201AF5, + 0x1B80, 0x7B201AF7, + 0x1B80, 0x7A001B05, + 0x1B80, 0x7A001B07, + 0x1B80, 0x79001B15, + 0x1B80, 0x79001B17, + 0x1B80, 0xE1CB1B25, + 0x1B80, 0xE1CB1B27, + 0x1B80, 0x00021B35, + 0x1B80, 0x00021B37, + 0x1B80, 0x00011B45, + 0x1B80, 0x00011B47, + 0x1B80, 0x74021B55, + 0x1B80, 0x74021B57, + 0x1B80, 0x003F1B65, + 0x1B80, 0x003F1B67, + 0x1B80, 0x74001B75, + 0x1B80, 0x74001B77, + 0x1B80, 0x00021B85, + 0x1B80, 0x00021B87, + 0x1B80, 0x00011B95, + 0x1B80, 0x00011B97, + 0x1B80, 0x4D041BA5, + 0x1B80, 0x4D041BA7, + 0x1B80, 0x2EF81BB5, + 0x1B80, 0x2EF81BB7, + 0x1B80, 0x00001BC5, + 0x1B80, 0x00001BC7, + 0x1B80, 0x23301BD5, + 0x1B80, 0x23301BD7, + 0x1B80, 0x00241BE5, + 0x1B80, 0x00241BE7, + 0x1B80, 0x23E01BF5, + 0x1B80, 0x23E01BF7, + 0x1B80, 0x003F1C05, + 0x1B80, 0x003F1C07, + 0x1B80, 0x23FC1C15, + 0x1B80, 0x23FC1C17, + 0x1B80, 0xBFCE1C25, + 0x1B80, 0xBFCE1C27, + 0x1B80, 0x2EF01C35, + 0x1B80, 0x2EF01C37, + 0x1B80, 0x00001C45, + 0x1B80, 0x00001C47, + 0x1B80, 0x4D001C55, + 0x1B80, 0x4D001C57, + 0x1B80, 0x00011C65, + 0x1B80, 0x00011C67, + 0x1B80, 0x549F1C75, + 0x1B80, 0x549F1C77, + 0x1B80, 0x54FF1C85, + 0x1B80, 0x54FF1C87, + 0x1B80, 0x54001C95, + 0x1B80, 0x54001C97, + 0x1B80, 0x00011CA5, + 0x1B80, 0x00011CA7, + 0x1B80, 0x5C311CB5, + 0x1B80, 0x5C311CB7, + 0x1B80, 0x07141CC5, + 0x1B80, 0x07141CC7, + 0x1B80, 0x54001CD5, + 0x1B80, 0x54001CD7, + 0x1B80, 0x5C321CE5, + 0x1B80, 0x5C321CE7, + 0x1B80, 0x00011CF5, + 0x1B80, 0x00011CF7, + 0x1B80, 0x5C321D05, + 0x1B80, 0x5C321D07, + 0x1B80, 0x07141D15, + 0x1B80, 0x07141D17, + 0x1B80, 0x54001D25, + 0x1B80, 0x54001D27, + 0x1B80, 0x5C311D35, + 0x1B80, 0x5C311D37, + 0x1B80, 0x00011D45, + 0x1B80, 0x00011D47, + 0x1B80, 0x4C981D55, + 0x1B80, 0x4C981D57, + 0x1B80, 0x4C181D65, + 0x1B80, 0x4C181D67, + 0x1B80, 0x00011D75, + 0x1B80, 0x00011D77, + 0x1B80, 0x5C321D85, + 0x1B80, 0x5C321D87, + 0x1B80, 0x62841D95, + 0x1B80, 0x62841D97, + 0x1B80, 0x66861DA5, + 0x1B80, 0x66861DA7, + 0x1B80, 0x6C031DB5, + 0x1B80, 0x6C031DB7, + 0x1B80, 0x7B201DC5, + 0x1B80, 0x7B201DC7, + 0x1B80, 0x7A001DD5, + 0x1B80, 0x7A001DD7, + 0x1B80, 0x79001DE5, + 0x1B80, 0x79001DE7, + 0x1B80, 0x7F201DF5, + 0x1B80, 0x7F201DF7, + 0x1B80, 0x7E001E05, + 0x1B80, 0x7E001E07, + 0x1B80, 0x7D001E15, + 0x1B80, 0x7D001E17, + 0x1B80, 0x09011E25, + 0x1B80, 0x09011E27, + 0x1B80, 0x0C011E35, + 0x1B80, 0x0C011E37, + 0x1B80, 0x0BA61E45, + 0x1B80, 0x0BA61E47, + 0x1B80, 0x00011E55, + 0x1B80, 0x00011E57, + 0x1B80, 0x00000006, + 0x1B80, 0x00000002, +}; + +RTW_DECL_TABLE_PHY_COND(rtw8822b_bb, rtw_phy_cfg_bb); + +static const struct rtw_phy_pg_cfg_pair rtw8822b_bb_pg_type2[] = { + { 0, 0, 0, 0x00000c20, 0xffffffff, 0x32343638, }, + { 0, 0, 0, 0x00000c24, 0xffffffff, 0x36384042, }, + { 0, 0, 0, 0x00000c28, 0xffffffff, 0x28303234, }, + { 0, 0, 0, 0x00000c2c, 0xffffffff, 0x34363840, }, + { 0, 0, 0, 0x00000c30, 0xffffffff, 0x26283032, }, + { 0, 0, 1, 0x00000c34, 0xffffffff, 0x34363840, }, + { 0, 0, 1, 0x00000c38, 0xffffffff, 0x26283032, }, + { 0, 0, 0, 0x00000c3c, 0xffffffff, 0x34363840, }, + { 0, 0, 0, 0x00000c40, 0xffffffff, 0x26283032, }, + { 0, 0, 0, 0x00000c44, 0xffffffff, 0x38402224, }, + { 0, 0, 1, 0x00000c48, 0xffffffff, 0x30323436, }, + { 0, 0, 1, 0x00000c4c, 0xffffffff, 0x22242628, }, + { 0, 1, 0, 0x00000e20, 0xffffffff, 0x32343638, }, + { 0, 1, 0, 0x00000e24, 0xffffffff, 0x36384042, }, + { 0, 1, 0, 0x00000e28, 0xffffffff, 0x28303234, }, + { 0, 1, 0, 0x00000e2c, 0xffffffff, 0x34363840, }, + { 0, 1, 0, 0x00000e30, 0xffffffff, 0x26283032, }, + { 0, 1, 1, 0x00000e34, 0xffffffff, 0x34363840, }, + { 0, 1, 1, 0x00000e38, 0xffffffff, 0x26283032, }, + { 0, 1, 0, 0x00000e3c, 0xffffffff, 0x34363840, }, + { 0, 1, 0, 0x00000e40, 0xffffffff, 0x26283032, }, + { 0, 1, 0, 0x00000e44, 0xffffffff, 0x38402224, }, + { 0, 1, 1, 0x00000e48, 0xffffffff, 0x30323436, }, + { 0, 1, 1, 0x00000e4c, 0xffffffff, 0x22242628, }, + { 1, 0, 0, 0x00000c24, 0xffffffff, 0x40424446, }, + { 1, 0, 0, 0x00000c28, 0xffffffff, 0x32343638, }, + { 1, 0, 0, 0x00000c2c, 0xffffffff, 0x38404244, }, + { 1, 0, 0, 0x00000c30, 0xffffffff, 0x30323436, }, + { 1, 0, 1, 0x00000c34, 0xffffffff, 0x38404244, }, + { 1, 0, 1, 0x00000c38, 0xffffffff, 0x30323436, }, + { 1, 0, 0, 0x00000c3c, 0xffffffff, 0x38404244, }, + { 1, 0, 0, 0x00000c40, 0xffffffff, 0x30323436, }, + { 1, 0, 0, 0x00000c44, 0xffffffff, 0x42442628, }, + { 1, 0, 1, 0x00000c48, 0xffffffff, 0x34363840, }, + { 1, 0, 1, 0x00000c4c, 0xffffffff, 0x26283032, }, + { 1, 1, 0, 0x00000e24, 0xffffffff, 0x40424446, }, + { 1, 1, 0, 0x00000e28, 0xffffffff, 0x32343638, }, + { 1, 1, 0, 0x00000e2c, 0xffffffff, 0x38404244, }, + { 1, 1, 0, 0x00000e30, 0xffffffff, 0x30323436, }, + { 1, 1, 1, 0x00000e34, 0xffffffff, 0x38404244, }, + { 1, 1, 1, 0x00000e38, 0xffffffff, 0x30323436, }, + { 1, 1, 0, 0x00000e3c, 0xffffffff, 0x38404244, }, + { 1, 1, 0, 0x00000e40, 0xffffffff, 0x30323436, }, + { 1, 1, 0, 0x00000e44, 0xffffffff, 0x42442628, }, + { 1, 1, 1, 0x00000e48, 0xffffffff, 0x34363840, }, + { 1, 1, 1, 0x00000e4c, 0xffffffff, 0x26283032, }, +}; + +RTW_DECL_TABLE_BB_PG(rtw8822b_bb_pg_type2); + +static const struct rtw_phy_pg_cfg_pair rtw8822b_bb_pg_type3[] = { + { 0, 0, 0, 0x00000c20, 0xffffffff, 0x32343638, }, + { 0, 0, 0, 0x00000c24, 0xffffffff, 0x36384042, }, + { 0, 0, 0, 0x00000c28, 0xffffffff, 0x28303234, }, + { 0, 0, 0, 0x00000c2c, 0xffffffff, 0x34363840, }, + { 0, 0, 0, 0x00000c30, 0xffffffff, 0x26283032, }, + { 0, 0, 1, 0x00000c34, 0xffffffff, 0x34363840, }, + { 0, 0, 1, 0x00000c38, 0xffffffff, 0x26283032, }, + { 0, 0, 0, 0x00000c3c, 0xffffffff, 0x34363840, }, + { 0, 0, 0, 0x00000c40, 0xffffffff, 0x26283032, }, + { 0, 0, 0, 0x00000c44, 0xffffffff, 0x38402224, }, + { 0, 0, 1, 0x00000c48, 0xffffffff, 0x30323436, }, + { 0, 0, 1, 0x00000c4c, 0xffffffff, 0x22242628, }, + { 0, 1, 0, 0x00000e20, 0xffffffff, 0x32343638, }, + { 0, 1, 0, 0x00000e24, 0xffffffff, 0x36384042, }, + { 0, 1, 0, 0x00000e28, 0xffffffff, 0x28303234, }, + { 0, 1, 0, 0x00000e2c, 0xffffffff, 0x34363840, }, + { 0, 1, 0, 0x00000e30, 0xffffffff, 0x26283032, }, + { 0, 1, 1, 0x00000e34, 0xffffffff, 0x34363840, }, + { 0, 1, 1, 0x00000e38, 0xffffffff, 0x26283032, }, + { 0, 1, 0, 0x00000e3c, 0xffffffff, 0x34363840, }, + { 0, 1, 0, 0x00000e40, 0xffffffff, 0x26283032, }, + { 0, 1, 0, 0x00000e44, 0xffffffff, 0x38402224, }, + { 0, 1, 1, 0x00000e48, 0xffffffff, 0x30323436, }, + { 0, 1, 1, 0x00000e4c, 0xffffffff, 0x22242628, }, + { 1, 0, 0, 0x00000c24, 0xffffffff, 0x34363840, }, + { 1, 0, 0, 0x00000c28, 0xffffffff, 0x26283032, }, + { 1, 0, 0, 0x00000c2c, 0xffffffff, 0x32343638, }, + { 1, 0, 0, 0x00000c30, 0xffffffff, 0x24262830, }, + { 1, 0, 1, 0x00000c34, 0xffffffff, 0x32343638, }, + { 1, 0, 1, 0x00000c38, 0xffffffff, 0x24262830, }, + { 1, 0, 0, 0x00000c3c, 0xffffffff, 0x32343638, }, + { 1, 0, 0, 0x00000c40, 0xffffffff, 0x24262830, }, + { 1, 0, 0, 0x00000c44, 0xffffffff, 0x36382022, }, + { 1, 0, 1, 0x00000c48, 0xffffffff, 0x28303234, }, + { 1, 0, 1, 0x00000c4c, 0xffffffff, 0x20222426, }, + { 1, 1, 0, 0x00000e24, 0xffffffff, 0x34363840, }, + { 1, 1, 0, 0x00000e28, 0xffffffff, 0x26283032, }, + { 1, 1, 0, 0x00000e2c, 0xffffffff, 0x32343638, }, + { 1, 1, 0, 0x00000e30, 0xffffffff, 0x24262830, }, + { 1, 1, 1, 0x00000e34, 0xffffffff, 0x32343638, }, + { 1, 1, 1, 0x00000e38, 0xffffffff, 0x24262830, }, + { 1, 1, 0, 0x00000e3c, 0xffffffff, 0x32343638, }, + { 1, 1, 0, 0x00000e40, 0xffffffff, 0x24262830, }, + { 1, 1, 0, 0x00000e44, 0xffffffff, 0x36382022, }, + { 1, 1, 1, 0x00000e48, 0xffffffff, 0x28303234, }, + { 1, 1, 1, 0x00000e4c, 0xffffffff, 0x20222426, }, +}; + +RTW_DECL_TABLE_BB_PG(rtw8822b_bb_pg_type3); + +static const struct rtw_phy_pg_cfg_pair rtw8822b_bb_pg_type5[] = { + { 0, 0, 0, 0x00000c20, 0xffffffff, 0x32343638, }, + { 0, 0, 0, 0x00000c24, 0xffffffff, 0x36384042, }, + { 0, 0, 0, 0x00000c28, 0xffffffff, 0x28303234, }, + { 0, 0, 0, 0x00000c2c, 0xffffffff, 0x34363840, }, + { 0, 0, 0, 0x00000c30, 0xffffffff, 0x26283032, }, + { 0, 0, 1, 0x00000c34, 0xffffffff, 0x34363840, }, + { 0, 0, 1, 0x00000c38, 0xffffffff, 0x26283032, }, + { 0, 0, 0, 0x00000c3c, 0xffffffff, 0x34363840, }, + { 0, 0, 0, 0x00000c40, 0xffffffff, 0x26283032, }, + { 0, 0, 0, 0x00000c44, 0xffffffff, 0x38402224, }, + { 0, 0, 1, 0x00000c48, 0xffffffff, 0x30323436, }, + { 0, 0, 1, 0x00000c4c, 0xffffffff, 0x22242628, }, + { 0, 1, 0, 0x00000e20, 0xffffffff, 0x32343638, }, + { 0, 1, 0, 0x00000e24, 0xffffffff, 0x36384042, }, + { 0, 1, 0, 0x00000e28, 0xffffffff, 0x28303234, }, + { 0, 1, 0, 0x00000e2c, 0xffffffff, 0x34363840, }, + { 0, 1, 0, 0x00000e30, 0xffffffff, 0x26283032, }, + { 0, 1, 1, 0x00000e34, 0xffffffff, 0x34363840, }, + { 0, 1, 1, 0x00000e38, 0xffffffff, 0x26283032, }, + { 0, 1, 0, 0x00000e3c, 0xffffffff, 0x34363840, }, + { 0, 1, 0, 0x00000e40, 0xffffffff, 0x26283032, }, + { 0, 1, 0, 0x00000e44, 0xffffffff, 0x38402224, }, + { 0, 1, 1, 0x00000e48, 0xffffffff, 0x30323436, }, + { 0, 1, 1, 0x00000e4c, 0xffffffff, 0x22242628, }, + { 1, 0, 0, 0x00000c24, 0xffffffff, 0x34363840, }, + { 1, 0, 0, 0x00000c28, 0xffffffff, 0x26283032, }, + { 1, 0, 0, 0x00000c2c, 0xffffffff, 0x32343638, }, + { 1, 0, 0, 0x00000c30, 0xffffffff, 0x24262830, }, + { 1, 0, 1, 0x00000c34, 0xffffffff, 0x32343638, }, + { 1, 0, 1, 0x00000c38, 0xffffffff, 0x24262830, }, + { 1, 0, 0, 0x00000c3c, 0xffffffff, 0x32343638, }, + { 1, 0, 0, 0x00000c40, 0xffffffff, 0x24262830, }, + { 1, 0, 0, 0x00000c44, 0xffffffff, 0x36382022, }, + { 1, 0, 1, 0x00000c48, 0xffffffff, 0x28303234, }, + { 1, 0, 1, 0x00000c4c, 0xffffffff, 0x20222426, }, + { 1, 1, 0, 0x00000e24, 0xffffffff, 0x34363840, }, + { 1, 1, 0, 0x00000e28, 0xffffffff, 0x26283032, }, + { 1, 1, 0, 0x00000e2c, 0xffffffff, 0x32343638, }, + { 1, 1, 0, 0x00000e30, 0xffffffff, 0x24262830, }, + { 1, 1, 1, 0x00000e34, 0xffffffff, 0x32343638, }, + { 1, 1, 1, 0x00000e38, 0xffffffff, 0x24262830, }, + { 1, 1, 0, 0x00000e3c, 0xffffffff, 0x32343638, }, + { 1, 1, 0, 0x00000e40, 0xffffffff, 0x24262830, }, + { 1, 1, 0, 0x00000e44, 0xffffffff, 0x36382022, }, + { 1, 1, 1, 0x00000e48, 0xffffffff, 0x28303234, }, + { 1, 1, 1, 0x00000e4c, 0xffffffff, 0x20222426, }, +}; + +RTW_DECL_TABLE_BB_PG(rtw8822b_bb_pg_type5); + +static const u32 rtw8822b_rf_a[] = { + 0x000, 0x00030000, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0xA0000000, 0x00000000, + 0x001, 0x00040029, + 0xB0000000, 0x00000000, + 0x018, 0x00010D24, + 0x0EF, 0x00080000, + 0x033, 0x00000002, + 0x03E, 0x0000003F, + 0x8300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000D0F4E, + 0xA0000000, 0x00000000, + 0x03F, 0x000C0F4E, + 0xB0000000, 0x00000000, + 0x033, 0x00000001, + 0x03E, 0x00000034, + 0x03F, 0x0004080E, + 0x0EF, 0x00080000, + 0x0DF, 0x00002449, + 0x033, 0x00000024, + 0x03E, 0x0000003F, + 0x03F, 0x00060FDE, + 0x0EF, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000025, + 0x03E, 0x00000037, + 0x03F, 0x0007EFCE, + 0x0EF, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000026, + 0x03E, 0x00000037, + 0x03F, 0x000DEFCE, + 0x0EF, 0x00000000, + 0x07F, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FB0F8, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0xA0000000, 0x00000000, + 0x0B0, 0x000FF0F8, + 0xB0000000, 0x00000000, + 0x0B1, 0x0007DBE4, + 0x0B2, 0x000225D1, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C330, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0003C360, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0xA0000000, 0x00000000, + 0x0B3, 0x000FC760, + 0xB0000000, 0x00000000, + 0x0B4, 0x00099DD0, + 0x0B5, 0x000400FC, + 0x0B6, 0x000187F0, + 0x0B7, 0x00030018, + 0x0B8, 0x00080800, + 0x0B9, 0x00000000, + 0x0BA, 0x00008000, + 0x0BB, 0x00000000, + 0x0BC, 0x00040030, + 0x0BD, 0x00000000, + 0x0BE, 0x00000000, + 0x0BF, 0x00000000, + 0x0C0, 0x00000000, + 0x0C1, 0x00000000, + 0x0C2, 0x00000000, + 0x0C3, 0x00000000, + 0x0C4, 0x00002402, + 0x0C5, 0x00000009, + 0x0C6, 0x00040299, + 0x0C7, 0x00055555, + 0x0C8, 0x0000C16C, + 0x0C9, 0x0001C146, + 0x0CA, 0x00000000, + 0x0CB, 0x00000000, + 0x0CC, 0x00000000, + 0x0CD, 0x00000000, + 0x0CE, 0x00090C00, + 0x0CF, 0x0006D200, + 0x0DF, 0x00000009, + 0x018, 0x00010524, + 0x089, 0x00000207, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FE186, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FE186, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FE186, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0xA0000000, 0x00000000, + 0x08A, 0x000FF186, + 0xB0000000, 0x00000000, + 0x08B, 0x00061E3C, + 0x08C, 0x000112C7, + 0x08D, 0x000F4988, + 0x08E, 0x00064D40, + 0x0EF, 0x00020000, + 0x033, 0x00000007, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0xA0000000, 0x00000000, + 0x03E, 0x00004000, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000DFF86, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000DFF86, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0xA0000000, 0x00000000, + 0x03F, 0x000C3186, + 0xB0000000, 0x00000000, + 0x033, 0x00000006, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0xA0000000, 0x00000000, + 0x03E, 0x00004080, + 0xB0000000, 0x00000000, + 0x03F, 0x000C3186, + 0x033, 0x00000005, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000040C8, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000040C8, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000040C8, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000040C8, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000040C8, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000040C8, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004084, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000040C8, + 0xA0000000, 0x00000000, + 0x03E, 0x000040C8, + 0xB0000000, 0x00000000, + 0x03F, 0x000C3186, + 0x033, 0x00000004, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004190, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004190, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004190, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004190, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004190, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004190, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004108, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004190, + 0xA0000000, 0x00000000, + 0x03E, 0x00004190, + 0xB0000000, 0x00000000, + 0x03F, 0x000C3186, + 0x033, 0x00000003, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004998, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004998, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004998, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004998, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004998, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004998, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x0000490C, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004998, + 0xA0000000, 0x00000000, + 0x03E, 0x00004998, + 0xB0000000, 0x00000000, + 0x03F, 0x000C3186, + 0x033, 0x00000002, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005840, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005840, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005840, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005840, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005840, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005840, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005E00, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005840, + 0xA0000000, 0x00000000, + 0x03E, 0x00005840, + 0xB0000000, 0x00000000, + 0x03F, 0x000C3186, + 0x033, 0x00000001, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000058C2, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000058C2, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000058C2, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000058C2, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000058C2, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000058C2, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005862, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000058C2, + 0xA0000000, 0x00000000, + 0x03E, 0x000058C2, + 0xB0000000, 0x00000000, + 0x03F, 0x000C3186, + 0x033, 0x00000000, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005930, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005930, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005930, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005930, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005930, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005930, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005948, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00005930, + 0xA0000000, 0x00000000, + 0x03E, 0x00005930, + 0xB0000000, 0x00000000, + 0x03F, 0x000C3186, + 0x033, 0x0000000F, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0xA0000000, 0x00000000, + 0x03E, 0x00004000, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000DFF86, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000DFF86, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0xA0000000, 0x00000000, + 0x03F, 0x000C3186, + 0xB0000000, 0x00000000, + 0x033, 0x0000000E, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x033, 0x0000000D, + 0x03E, 0x000040C8, + 0x03F, 0x000C3186, + 0x033, 0x0000000C, + 0x03E, 0x00004190, + 0x03F, 0x000C3186, + 0x033, 0x0000000B, + 0x03E, 0x00004998, + 0x03F, 0x000C3186, + 0x033, 0x0000000A, + 0x03E, 0x00005840, + 0x03F, 0x000C3186, + 0x033, 0x00000009, + 0x03E, 0x000058C2, + 0x03F, 0x000C3186, + 0x033, 0x00000008, + 0x03E, 0x00005930, + 0x03F, 0x000C3186, + 0x033, 0x00000017, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0xA0000000, 0x00000000, + 0x03E, 0x00004000, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000DFF86, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0006, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C3186, + 0xA0000000, 0x00000000, + 0x03F, 0x000C3186, + 0xB0000000, 0x00000000, + 0x033, 0x00000016, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x033, 0x00000015, + 0x03E, 0x000040C8, + 0x03F, 0x000C3186, + 0x033, 0x00000014, + 0x03E, 0x00004190, + 0x03F, 0x000C3186, + 0x033, 0x00000013, + 0x03E, 0x00004998, + 0x03F, 0x000C3186, + 0x033, 0x00000012, + 0x03E, 0x00005840, + 0x03F, 0x000C3186, + 0x033, 0x00000011, + 0x03E, 0x000058C2, + 0x03F, 0x000C3186, + 0x033, 0x00000010, + 0x03E, 0x00005930, + 0x03F, 0x000C3186, + 0x0EF, 0x00000000, + 0x0EF, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x0000000A, + 0x033, 0x00000001, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000005, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000006, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000005, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000005, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000005, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000005, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0xA0000000, 0x00000000, + 0x03F, 0x00000005, + 0xB0000000, 0x00000000, + 0x033, 0x00000002, + 0x03F, 0x00000000, + 0x0EF, 0x00000000, + 0x018, 0x00000401, + 0x084, 0x00001209, + 0x086, 0x000001A0, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0xA0000000, 0x00000000, + 0x087, 0x000E8180, + 0xB0000000, 0x00000000, + 0x088, 0x00070020, + 0x0DE, 0x00000010, + 0x0EF, 0x00008000, + 0x033, 0x0000000F, + 0x03F, 0x0000003C, + 0x033, 0x0000000E, + 0x03F, 0x00000038, + 0x033, 0x0000000D, + 0x03F, 0x00000030, + 0x033, 0x0000000C, + 0x03F, 0x00000028, + 0x033, 0x0000000B, + 0x03F, 0x00000020, + 0x033, 0x0000000A, + 0x03F, 0x00000018, + 0x033, 0x00000009, + 0x03F, 0x00000010, + 0x033, 0x00000008, + 0x03F, 0x00000008, + 0x033, 0x00000007, + 0x03F, 0x0000003C, + 0x033, 0x00000006, + 0x03F, 0x00000038, + 0x033, 0x00000005, + 0x03F, 0x00000030, + 0x033, 0x00000004, + 0x03F, 0x00000028, + 0x033, 0x00000003, + 0x03F, 0x00000020, + 0x033, 0x00000002, + 0x03F, 0x00000018, + 0x033, 0x00000001, + 0x03F, 0x00000010, + 0x033, 0x00000000, + 0x03F, 0x00000008, + 0x0EF, 0x00000000, + 0x0B8, 0x00080A00, + 0x0FE, 0x00000000, + 0x0B0, 0x000FF0FA, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x0CA, 0x00080000, + 0x0FE, 0x00000000, + 0x0C9, 0x0001C141, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x0B0, 0x000FF0F8, + 0x018, 0x00018D24, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0x018, 0x00010D24, + 0x01B, 0x00075A40, + 0x0EE, 0x00000002, + 0x033, 0x00000000, + 0x03F, 0x00000004, + 0x033, 0x00000001, + 0x03F, 0x00000004, + 0x033, 0x00000002, + 0x03F, 0x00000004, + 0x033, 0x00000003, + 0x03F, 0x00000004, + 0x033, 0x00000004, + 0x03F, 0x00000004, + 0x033, 0x00000005, + 0x03F, 0x00000006, + 0x033, 0x00000006, + 0x03F, 0x00000004, + 0x033, 0x00000007, + 0x03F, 0x00000000, + 0x0EE, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D3D1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000062, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D301, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000062, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D301, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D301, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D3D1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D3D1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D301, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D3D1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D3D1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D301, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D301, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D301, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000062, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000062, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D301, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000062, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D301, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0xA0000000, 0x00000000, + 0x061, 0x0005D3D0, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A3, + 0x030, 0x000093A3, + 0x030, 0x0000A3A3, + 0x030, 0x0000B3A3, + 0x0EF, 0x00000000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000004A3, + 0x030, 0x000014A3, + 0x030, 0x000024A3, + 0x030, 0x000034A3, + 0x030, 0x000044A3, + 0x030, 0x000054A3, + 0x030, 0x000064A3, + 0x030, 0x000074A3, + 0x030, 0x000084A3, + 0x030, 0x000094A3, + 0x030, 0x0000A4A3, + 0x030, 0x0000B4A3, + 0x0EF, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000002A6, + 0x030, 0x000012A6, + 0x030, 0x000022A6, + 0x030, 0x000032A6, + 0x030, 0x000042A6, + 0x030, 0x000052A6, + 0x030, 0x000062A6, + 0x030, 0x000072A6, + 0x030, 0x000082A6, + 0x030, 0x000092A6, + 0x030, 0x0000A2A6, + 0x030, 0x0000B2A6, + 0x0EF, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000303, + 0x030, 0x00001303, + 0x030, 0x00002303, + 0x030, 0x00003303, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x00008365, + 0x030, 0x00009365, + 0x030, 0x0000A365, + 0x030, 0x0000B365, + 0x0EF, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000002A6, + 0x030, 0x000012A6, + 0x030, 0x000022A6, + 0x030, 0x000032A6, + 0x030, 0x000042A6, + 0x030, 0x000052A6, + 0x030, 0x000062A6, + 0x030, 0x000072A6, + 0x030, 0x000082A6, + 0x030, 0x000092A6, + 0x030, 0x0000A2A6, + 0x030, 0x0000B2A6, + 0x0EF, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000003A3, + 0x030, 0x000013A3, + 0x030, 0x000023A3, + 0x030, 0x000033A3, + 0x030, 0x00004355, + 0x030, 0x00005355, + 0x030, 0x00006355, + 0x030, 0x00007355, + 0x030, 0x00008315, + 0x030, 0x00009315, + 0x030, 0x0000A315, + 0x030, 0x0000B315, + 0x0EF, 0x00000000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000004A3, + 0x030, 0x000014A3, + 0x030, 0x000024A3, + 0x030, 0x000034A3, + 0x030, 0x000044A3, + 0x030, 0x000054A3, + 0x030, 0x000064A3, + 0x030, 0x000074A3, + 0x030, 0x000084A3, + 0x030, 0x000094A3, + 0x030, 0x0000A4A3, + 0x030, 0x0000B4A3, + 0x0EF, 0x00000000, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000004A3, + 0x030, 0x000014A3, + 0x030, 0x000024A3, + 0x030, 0x000034A3, + 0x030, 0x000044A3, + 0x030, 0x000054A3, + 0x030, 0x000064A3, + 0x030, 0x000074A3, + 0x030, 0x000084A3, + 0x030, 0x000094A3, + 0x030, 0x0000A4A3, + 0x030, 0x0000B4A3, + 0x0EF, 0x00000000, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000384, + 0x030, 0x00001384, + 0x030, 0x00002384, + 0x030, 0x00003384, + 0x030, 0x00004425, + 0x030, 0x00005425, + 0x030, 0x00006425, + 0x030, 0x00007425, + 0x030, 0x000084A6, + 0x030, 0x000094A6, + 0x030, 0x0000A4A6, + 0x030, 0x0000B4A6, + 0x0EF, 0x00000000, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000463, + 0x030, 0x00001463, + 0x030, 0x00002463, + 0x030, 0x00003463, + 0x030, 0x00004545, + 0x030, 0x00005545, + 0x030, 0x00006545, + 0x030, 0x00007545, + 0x030, 0x00008565, + 0x030, 0x00009565, + 0x030, 0x0000A565, + 0x030, 0x0000B565, + 0x0EF, 0x00000000, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A3, + 0x030, 0x000093A3, + 0x030, 0x0000A3A3, + 0x030, 0x0000B3A3, + 0x0EF, 0x00000000, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000004A3, + 0x030, 0x000014A3, + 0x030, 0x000024A3, + 0x030, 0x000034A3, + 0x030, 0x000044A3, + 0x030, 0x000054A3, + 0x030, 0x000064A3, + 0x030, 0x000074A3, + 0x030, 0x000084A3, + 0x030, 0x000094A3, + 0x030, 0x0000A4A3, + 0x030, 0x0000B4A3, + 0x0EF, 0x00000000, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000443, + 0x030, 0x00001443, + 0x030, 0x00002443, + 0x030, 0x00003443, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x00008365, + 0x030, 0x00009365, + 0x030, 0x0000A365, + 0x030, 0x0000B365, + 0x0EF, 0x00000000, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000443, + 0x030, 0x00001443, + 0x030, 0x00002443, + 0x030, 0x00003443, + 0x030, 0x00004483, + 0x030, 0x00005483, + 0x030, 0x00006483, + 0x030, 0x00007483, + 0x030, 0x000084A4, + 0x030, 0x000094A4, + 0x030, 0x0000A4A4, + 0x030, 0x0000B4A4, + 0x0EF, 0x00000000, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000361, + 0x030, 0x00001361, + 0x030, 0x00002361, + 0x030, 0x00003361, + 0x030, 0x00004443, + 0x030, 0x00005443, + 0x030, 0x00006443, + 0x030, 0x00007443, + 0x030, 0x00008424, + 0x030, 0x00009424, + 0x030, 0x0000A424, + 0x030, 0x0000B424, + 0x0EF, 0x00000000, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x00008365, + 0x030, 0x00009365, + 0x030, 0x0000A365, + 0x030, 0x0000B365, + 0x0EF, 0x00000000, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x00000403, + 0x030, 0x00001403, + 0x030, 0x00002403, + 0x030, 0x00003403, + 0x030, 0x000044A2, + 0x030, 0x000054A2, + 0x030, 0x000064A2, + 0x030, 0x000074A2, + 0x030, 0x000083A3, + 0x030, 0x000093A3, + 0x030, 0x0000A3A3, + 0x030, 0x0000B3A3, + 0x0EF, 0x00000000, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000003A3, + 0x030, 0x000013A3, + 0x030, 0x000023A3, + 0x030, 0x000033A3, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x00008365, + 0x030, 0x00009365, + 0x030, 0x0000A365, + 0x030, 0x0000B365, + 0x0EF, 0x00000000, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000002A6, + 0x030, 0x000012A6, + 0x030, 0x000022A6, + 0x030, 0x000032A6, + 0x030, 0x000042A6, + 0x030, 0x000052A6, + 0x030, 0x000062A6, + 0x030, 0x000072A6, + 0x030, 0x000082A6, + 0x030, 0x000092A6, + 0x030, 0x0000A2A6, + 0x030, 0x0000B2A6, + 0x0EF, 0x00000000, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000004A0, + 0x030, 0x000014A0, + 0x030, 0x000024A0, + 0x030, 0x000034A0, + 0x030, 0x000044A0, + 0x030, 0x000054A0, + 0x030, 0x000064A0, + 0x030, 0x000074A0, + 0x030, 0x000084A0, + 0x030, 0x000094A0, + 0x030, 0x0000A4A0, + 0x030, 0x0000B4A0, + 0x0EF, 0x00000000, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000002A1, + 0x030, 0x000012A1, + 0x030, 0x000022A1, + 0x030, 0x000032A1, + 0x030, 0x000042A1, + 0x030, 0x000052A1, + 0x030, 0x000062A1, + 0x030, 0x000072A1, + 0x030, 0x000082A1, + 0x030, 0x000092A1, + 0x030, 0x0000A2A1, + 0x030, 0x0000B2A1, + 0x0EF, 0x00000000, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000003A0, + 0x030, 0x000013A0, + 0x030, 0x000023A0, + 0x030, 0x000033A0, + 0x030, 0x000043A1, + 0x030, 0x000053A1, + 0x030, 0x000063A1, + 0x030, 0x000073A1, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x0EF, 0x00000000, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000002A1, + 0x030, 0x000012A1, + 0x030, 0x000022A1, + 0x030, 0x000032A1, + 0x030, 0x000042A1, + 0x030, 0x000052A1, + 0x030, 0x000062A1, + 0x030, 0x000072A1, + 0x030, 0x000082A1, + 0x030, 0x000092A1, + 0x030, 0x0000A2A1, + 0x030, 0x0000B2A1, + 0x0EF, 0x00000000, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000003A0, + 0x030, 0x000013A0, + 0x030, 0x000023A0, + 0x030, 0x000033A0, + 0x030, 0x00004430, + 0x030, 0x00005430, + 0x030, 0x00006430, + 0x030, 0x00007430, + 0x030, 0x00008372, + 0x030, 0x00009372, + 0x030, 0x0000A372, + 0x030, 0x0000B372, + 0x0EF, 0x00000000, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000004A0, + 0x030, 0x000014A0, + 0x030, 0x000024A0, + 0x030, 0x000034A0, + 0x030, 0x000044A0, + 0x030, 0x000054A0, + 0x030, 0x000064A0, + 0x030, 0x000074A0, + 0x030, 0x000084A0, + 0x030, 0x000094A0, + 0x030, 0x0000A4A0, + 0x030, 0x0000B4A0, + 0x0EF, 0x00000000, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000004A0, + 0x030, 0x000014A0, + 0x030, 0x000024A0, + 0x030, 0x000034A0, + 0x030, 0x000044A0, + 0x030, 0x000054A0, + 0x030, 0x000064A0, + 0x030, 0x000074A0, + 0x030, 0x000084A0, + 0x030, 0x000094A0, + 0x030, 0x0000A4A0, + 0x030, 0x0000B4A0, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000200, + 0x030, 0x000003D0, + 0x030, 0x000013D0, + 0x030, 0x000023D0, + 0x030, 0x000033D0, + 0x030, 0x000043D0, + 0x030, 0x000053D0, + 0x030, 0x000063D0, + 0x030, 0x000073D0, + 0x030, 0x000083D0, + 0x030, 0x000093D0, + 0x030, 0x0000A3D0, + 0x030, 0x0000B3D0, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A3, + 0x030, 0x000013A3, + 0x030, 0x000023A3, + 0x030, 0x000033A3, + 0x030, 0x000043A3, + 0x030, 0x000053A3, + 0x030, 0x000063A3, + 0x030, 0x000073A3, + 0x030, 0x000083A3, + 0x030, 0x000093A3, + 0x030, 0x0000A3A3, + 0x030, 0x0000B3A3, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000080, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000764, + 0x030, 0x00001632, + 0x030, 0x00002421, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000777, + 0x030, 0x00001442, + 0x030, 0x00002222, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000776, + 0x030, 0x00001455, + 0x030, 0x00002335, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000660, + 0x030, 0x00001443, + 0x030, 0x00002221, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000764, + 0x030, 0x00001632, + 0x030, 0x00002421, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000764, + 0x030, 0x00001632, + 0x030, 0x00002421, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000767, + 0x030, 0x00001442, + 0x030, 0x00002222, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000765, + 0x030, 0x00001632, + 0x030, 0x00002451, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000764, + 0x030, 0x00001632, + 0x030, 0x00002421, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000777, + 0x030, 0x00001454, + 0x030, 0x00002224, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000777, + 0x030, 0x00001442, + 0x030, 0x00002222, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000777, + 0x030, 0x00001442, + 0x030, 0x00002222, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000775, + 0x030, 0x00001422, + 0x030, 0x00002210, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000775, + 0x030, 0x00001343, + 0x030, 0x00002210, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000764, + 0x030, 0x00001632, + 0x030, 0x00002421, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000800, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C09, + 0x033, 0x00000021, + 0x03F, 0x00000C0C, + 0x033, 0x00000022, + 0x03F, 0x00000C0F, + 0x033, 0x00000023, + 0x03F, 0x00000C2C, + 0x033, 0x00000024, + 0x03F, 0x00000C2F, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000C90, + 0x033, 0x00000028, + 0x03F, 0x00000CD0, + 0x033, 0x00000029, + 0x03F, 0x00000CF2, + 0x033, 0x0000002A, + 0x03F, 0x00000CF5, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000005, + 0x033, 0x00000021, + 0x03F, 0x00000008, + 0x033, 0x00000022, + 0x03F, 0x0000000B, + 0x033, 0x00000023, + 0x03F, 0x0000000E, + 0x033, 0x00000024, + 0x03F, 0x0000002B, + 0x033, 0x00000025, + 0x03F, 0x0000002E, + 0x033, 0x00000026, + 0x03F, 0x0000006B, + 0x033, 0x00000027, + 0x03F, 0x0000006E, + 0x033, 0x00000028, + 0x03F, 0x00000071, + 0x033, 0x00000029, + 0x03F, 0x00000074, + 0x033, 0x0000002A, + 0x03F, 0x00000077, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000429, + 0x033, 0x00000021, + 0x03F, 0x00000828, + 0x033, 0x00000022, + 0x03F, 0x00000847, + 0x033, 0x00000023, + 0x03F, 0x0000084A, + 0x033, 0x00000024, + 0x03F, 0x00000C4B, + 0x033, 0x00000025, + 0x03F, 0x00000C6C, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000CAF, + 0x033, 0x00000028, + 0x03F, 0x00000CD1, + 0x033, 0x00000029, + 0x03F, 0x00000CF3, + 0x033, 0x0000002A, + 0x03F, 0x00000CF6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000005, + 0x033, 0x00000021, + 0x03F, 0x00000008, + 0x033, 0x00000022, + 0x03F, 0x0000000B, + 0x033, 0x00000023, + 0x03F, 0x0000000E, + 0x033, 0x00000024, + 0x03F, 0x0000002B, + 0x033, 0x00000025, + 0x03F, 0x0000002E, + 0x033, 0x00000026, + 0x03F, 0x0000006B, + 0x033, 0x00000027, + 0x03F, 0x0000006E, + 0x033, 0x00000028, + 0x03F, 0x00000071, + 0x033, 0x00000029, + 0x03F, 0x00000074, + 0x033, 0x0000002A, + 0x03F, 0x00000077, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x0000042B, + 0x033, 0x00000021, + 0x03F, 0x0000082A, + 0x033, 0x00000022, + 0x03F, 0x00000849, + 0x033, 0x00000023, + 0x03F, 0x0000084C, + 0x033, 0x00000024, + 0x03F, 0x00000C4C, + 0x033, 0x00000025, + 0x03F, 0x00000C6C, + 0x033, 0x00000026, + 0x03F, 0x00000CAC, + 0x033, 0x00000027, + 0x03F, 0x00000CED, + 0x033, 0x00000028, + 0x03F, 0x00000CF0, + 0x033, 0x00000029, + 0x03F, 0x00000CF3, + 0x033, 0x0000002A, + 0x03F, 0x00000CF6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C0C, + 0x033, 0x00000021, + 0x03F, 0x00000C29, + 0x033, 0x00000022, + 0x03F, 0x00000C2C, + 0x033, 0x00000023, + 0x03F, 0x00000C69, + 0x033, 0x00000024, + 0x03F, 0x00000CA8, + 0x033, 0x00000025, + 0x03F, 0x00000CE8, + 0x033, 0x00000026, + 0x03F, 0x00000CEB, + 0x033, 0x00000027, + 0x03F, 0x00000CEE, + 0x033, 0x00000028, + 0x03F, 0x00000CF1, + 0x033, 0x00000029, + 0x03F, 0x00000CF4, + 0x033, 0x0000002A, + 0x03F, 0x00000CF7, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C09, + 0x033, 0x00000021, + 0x03F, 0x00000C0C, + 0x033, 0x00000022, + 0x03F, 0x00000C0F, + 0x033, 0x00000023, + 0x03F, 0x00000C2C, + 0x033, 0x00000024, + 0x03F, 0x00000C2F, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000C90, + 0x033, 0x00000028, + 0x03F, 0x00000CD0, + 0x033, 0x00000029, + 0x03F, 0x00000CF2, + 0x033, 0x0000002A, + 0x03F, 0x00000CF5, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C09, + 0x033, 0x00000021, + 0x03F, 0x00000C0C, + 0x033, 0x00000022, + 0x03F, 0x00000C0F, + 0x033, 0x00000023, + 0x03F, 0x00000C2C, + 0x033, 0x00000024, + 0x03F, 0x00000C2F, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000C90, + 0x033, 0x00000028, + 0x03F, 0x00000CD0, + 0x033, 0x00000029, + 0x03F, 0x00000CF2, + 0x033, 0x0000002A, + 0x03F, 0x00000CF5, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000429, + 0x033, 0x00000021, + 0x03F, 0x00000828, + 0x033, 0x00000022, + 0x03F, 0x00000847, + 0x033, 0x00000023, + 0x03F, 0x0000084A, + 0x033, 0x00000024, + 0x03F, 0x00000C4B, + 0x033, 0x00000025, + 0x03F, 0x00000CE5, + 0x033, 0x00000026, + 0x03F, 0x00000CE8, + 0x033, 0x00000027, + 0x03F, 0x00000CEB, + 0x033, 0x00000028, + 0x03F, 0x00000CEE, + 0x033, 0x00000029, + 0x03F, 0x00000CF1, + 0x033, 0x0000002A, + 0x03F, 0x00000CF4, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C0B, + 0x033, 0x00000021, + 0x03F, 0x00000C0E, + 0x033, 0x00000022, + 0x03F, 0x00000C2B, + 0x033, 0x00000023, + 0x03F, 0x00000C2E, + 0x033, 0x00000024, + 0x03F, 0x00000C89, + 0x033, 0x00000025, + 0x03F, 0x00000CE8, + 0x033, 0x00000026, + 0x03F, 0x00000CEB, + 0x033, 0x00000027, + 0x03F, 0x00000CEE, + 0x033, 0x00000028, + 0x03F, 0x00000CF1, + 0x033, 0x00000029, + 0x03F, 0x00000CF4, + 0x033, 0x0000002A, + 0x03F, 0x00000CF7, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C09, + 0x033, 0x00000021, + 0x03F, 0x00000C0C, + 0x033, 0x00000022, + 0x03F, 0x00000C0F, + 0x033, 0x00000023, + 0x03F, 0x00000C2C, + 0x033, 0x00000024, + 0x03F, 0x00000C2F, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000C90, + 0x033, 0x00000028, + 0x03F, 0x00000CD0, + 0x033, 0x00000029, + 0x03F, 0x00000CF2, + 0x033, 0x0000002A, + 0x03F, 0x00000CF5, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000429, + 0x033, 0x00000021, + 0x03F, 0x00000828, + 0x033, 0x00000022, + 0x03F, 0x00000847, + 0x033, 0x00000023, + 0x03F, 0x0000084A, + 0x033, 0x00000024, + 0x03F, 0x0000086A, + 0x033, 0x00000025, + 0x03F, 0x0000086D, + 0x033, 0x00000026, + 0x03F, 0x00000870, + 0x033, 0x00000027, + 0x03F, 0x00000891, + 0x033, 0x00000028, + 0x03F, 0x00000894, + 0x033, 0x00000029, + 0x03F, 0x000008B5, + 0x033, 0x0000002A, + 0x03F, 0x000008F5, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000429, + 0x033, 0x00000021, + 0x03F, 0x00000828, + 0x033, 0x00000022, + 0x03F, 0x00000847, + 0x033, 0x00000023, + 0x03F, 0x0000084A, + 0x033, 0x00000024, + 0x03F, 0x00000C4B, + 0x033, 0x00000025, + 0x03F, 0x00000C6C, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000CAF, + 0x033, 0x00000028, + 0x03F, 0x00000CD1, + 0x033, 0x00000029, + 0x03F, 0x00000CF3, + 0x033, 0x0000002A, + 0x03F, 0x00000CF6, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000429, + 0x033, 0x00000021, + 0x03F, 0x00000828, + 0x033, 0x00000022, + 0x03F, 0x00000847, + 0x033, 0x00000023, + 0x03F, 0x0000084A, + 0x033, 0x00000024, + 0x03F, 0x00000C4B, + 0x033, 0x00000025, + 0x03F, 0x00000C6C, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000CAF, + 0x033, 0x00000028, + 0x03F, 0x00000CD1, + 0x033, 0x00000029, + 0x03F, 0x00000CF3, + 0x033, 0x0000002A, + 0x03F, 0x00000CF6, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000005, + 0x033, 0x00000021, + 0x03F, 0x00000008, + 0x033, 0x00000022, + 0x03F, 0x0000000B, + 0x033, 0x00000023, + 0x03F, 0x0000000E, + 0x033, 0x00000024, + 0x03F, 0x0000002B, + 0x033, 0x00000025, + 0x03F, 0x0000002E, + 0x033, 0x00000026, + 0x03F, 0x0000006B, + 0x033, 0x00000027, + 0x03F, 0x0000006E, + 0x033, 0x00000028, + 0x03F, 0x00000071, + 0x033, 0x00000029, + 0x03F, 0x00000074, + 0x033, 0x0000002A, + 0x03F, 0x00000077, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000005, + 0x033, 0x00000021, + 0x03F, 0x00000008, + 0x033, 0x00000022, + 0x03F, 0x0000000B, + 0x033, 0x00000023, + 0x03F, 0x0000000E, + 0x033, 0x00000024, + 0x03F, 0x0000002B, + 0x033, 0x00000025, + 0x03F, 0x00000068, + 0x033, 0x00000026, + 0x03F, 0x0000006B, + 0x033, 0x00000027, + 0x03F, 0x0000006E, + 0x033, 0x00000028, + 0x03F, 0x00000071, + 0x033, 0x00000029, + 0x03F, 0x00000074, + 0x033, 0x0000002A, + 0x03F, 0x00000077, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x0000042B, + 0x033, 0x00000021, + 0x03F, 0x0000082A, + 0x033, 0x00000022, + 0x03F, 0x00000849, + 0x033, 0x00000023, + 0x03F, 0x0000084C, + 0x033, 0x00000024, + 0x03F, 0x00000C4C, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000CEB, + 0x033, 0x00000028, + 0x03F, 0x00000CEE, + 0x033, 0x00000029, + 0x03F, 0x00000CF1, + 0x033, 0x0000002A, + 0x03F, 0x00000CF4, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000005, + 0x033, 0x00000021, + 0x03F, 0x00000008, + 0x033, 0x00000022, + 0x03F, 0x0000000B, + 0x033, 0x00000023, + 0x03F, 0x0000000E, + 0x033, 0x00000024, + 0x03F, 0x0000002B, + 0x033, 0x00000025, + 0x03F, 0x00000068, + 0x033, 0x00000026, + 0x03F, 0x0000006B, + 0x033, 0x00000027, + 0x03F, 0x0000006E, + 0x033, 0x00000028, + 0x03F, 0x00000071, + 0x033, 0x00000029, + 0x03F, 0x00000074, + 0x033, 0x0000002A, + 0x03F, 0x00000077, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x0000042B, + 0x033, 0x00000021, + 0x03F, 0x0000082A, + 0x033, 0x00000022, + 0x03F, 0x00000849, + 0x033, 0x00000023, + 0x03F, 0x0000084C, + 0x033, 0x00000024, + 0x03F, 0x00000C4C, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000CEB, + 0x033, 0x00000028, + 0x03F, 0x00000CEE, + 0x033, 0x00000029, + 0x03F, 0x00000CF1, + 0x033, 0x0000002A, + 0x03F, 0x00000CF4, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0xA0000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C09, + 0x033, 0x00000021, + 0x03F, 0x00000C0C, + 0x033, 0x00000022, + 0x03F, 0x00000C0F, + 0x033, 0x00000023, + 0x03F, 0x00000C2C, + 0x033, 0x00000024, + 0x03F, 0x00000C2F, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000C90, + 0x033, 0x00000028, + 0x03F, 0x00000CD0, + 0x033, 0x00000029, + 0x03F, 0x00000CF2, + 0x033, 0x0000002A, + 0x03F, 0x00000CF5, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C2A, + 0x033, 0x00000063, + 0x03F, 0x00000C2D, + 0x033, 0x00000064, + 0x03F, 0x00000C6A, + 0x033, 0x00000065, + 0x03F, 0x00000CAA, + 0x033, 0x00000066, + 0x03F, 0x00000CAD, + 0x033, 0x00000067, + 0x03F, 0x00000CB0, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x0000002E, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000429, + 0x033, 0x00000061, + 0x03F, 0x00000828, + 0x033, 0x00000062, + 0x03F, 0x00000847, + 0x033, 0x00000063, + 0x03F, 0x0000084A, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000C6C, + 0x033, 0x00000066, + 0x03F, 0x00000C8D, + 0x033, 0x00000067, + 0x03F, 0x00000CAF, + 0x033, 0x00000068, + 0x03F, 0x00000CD1, + 0x033, 0x00000069, + 0x03F, 0x00000CF3, + 0x033, 0x0000006A, + 0x03F, 0x00000CF6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x0000002E, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x0000042A, + 0x033, 0x00000061, + 0x03F, 0x00000829, + 0x033, 0x00000062, + 0x03F, 0x00000848, + 0x033, 0x00000063, + 0x03F, 0x0000084B, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000C6C, + 0x033, 0x00000066, + 0x03F, 0x00000CAC, + 0x033, 0x00000067, + 0x03F, 0x00000CED, + 0x033, 0x00000068, + 0x03F, 0x00000CF0, + 0x033, 0x00000069, + 0x03F, 0x00000CF3, + 0x033, 0x0000006A, + 0x03F, 0x00000CF6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x0000080B, + 0x033, 0x00000061, + 0x03F, 0x0000080E, + 0x033, 0x00000062, + 0x03F, 0x00000848, + 0x033, 0x00000063, + 0x03F, 0x00000869, + 0x033, 0x00000064, + 0x03F, 0x000008A9, + 0x033, 0x00000065, + 0x03F, 0x00000CE8, + 0x033, 0x00000066, + 0x03F, 0x00000CEB, + 0x033, 0x00000067, + 0x03F, 0x00000CEE, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C2A, + 0x033, 0x00000063, + 0x03F, 0x00000C2D, + 0x033, 0x00000064, + 0x03F, 0x00000C6A, + 0x033, 0x00000065, + 0x03F, 0x00000CAA, + 0x033, 0x00000066, + 0x03F, 0x00000CAD, + 0x033, 0x00000067, + 0x03F, 0x00000CB0, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C2A, + 0x033, 0x00000063, + 0x03F, 0x00000C2D, + 0x033, 0x00000064, + 0x03F, 0x00000C6A, + 0x033, 0x00000065, + 0x03F, 0x00000CAA, + 0x033, 0x00000066, + 0x03F, 0x00000CAD, + 0x033, 0x00000067, + 0x03F, 0x00000CB0, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x00000068, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000429, + 0x033, 0x00000061, + 0x03F, 0x00000828, + 0x033, 0x00000062, + 0x03F, 0x00000847, + 0x033, 0x00000063, + 0x03F, 0x0000084A, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000CE5, + 0x033, 0x00000066, + 0x03F, 0x00000CE8, + 0x033, 0x00000067, + 0x03F, 0x00000CEB, + 0x033, 0x00000068, + 0x03F, 0x00000CEE, + 0x033, 0x00000069, + 0x03F, 0x00000CF1, + 0x033, 0x0000006A, + 0x03F, 0x00000CF4, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C10, + 0x033, 0x00000063, + 0x03F, 0x00000C4A, + 0x033, 0x00000064, + 0x03F, 0x00000C4D, + 0x033, 0x00000065, + 0x03F, 0x00000CC9, + 0x033, 0x00000066, + 0x03F, 0x00000CEB, + 0x033, 0x00000067, + 0x03F, 0x00000CEE, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C2A, + 0x033, 0x00000063, + 0x03F, 0x00000C2D, + 0x033, 0x00000064, + 0x03F, 0x00000C6A, + 0x033, 0x00000065, + 0x03F, 0x00000CAA, + 0x033, 0x00000066, + 0x03F, 0x00000CAD, + 0x033, 0x00000067, + 0x03F, 0x00000CB0, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000429, + 0x033, 0x00000061, + 0x03F, 0x00000828, + 0x033, 0x00000062, + 0x03F, 0x00000847, + 0x033, 0x00000063, + 0x03F, 0x0000084A, + 0x033, 0x00000064, + 0x03F, 0x0000086A, + 0x033, 0x00000065, + 0x03F, 0x0000086D, + 0x033, 0x00000066, + 0x03F, 0x00000870, + 0x033, 0x00000067, + 0x03F, 0x00000891, + 0x033, 0x00000068, + 0x03F, 0x00000894, + 0x033, 0x00000069, + 0x03F, 0x000008B5, + 0x033, 0x0000006A, + 0x03F, 0x000008F5, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000429, + 0x033, 0x00000061, + 0x03F, 0x00000828, + 0x033, 0x00000062, + 0x03F, 0x00000847, + 0x033, 0x00000063, + 0x03F, 0x0000084A, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000C6C, + 0x033, 0x00000066, + 0x03F, 0x00000C8D, + 0x033, 0x00000067, + 0x03F, 0x00000CAF, + 0x033, 0x00000068, + 0x03F, 0x00000CD1, + 0x033, 0x00000069, + 0x03F, 0x00000CF3, + 0x033, 0x0000006A, + 0x03F, 0x00000CF6, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000429, + 0x033, 0x00000061, + 0x03F, 0x00000828, + 0x033, 0x00000062, + 0x03F, 0x00000847, + 0x033, 0x00000063, + 0x03F, 0x0000084A, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000C6C, + 0x033, 0x00000066, + 0x03F, 0x00000C8D, + 0x033, 0x00000067, + 0x03F, 0x00000CAF, + 0x033, 0x00000068, + 0x03F, 0x00000CD1, + 0x033, 0x00000069, + 0x03F, 0x00000CF3, + 0x033, 0x0000006A, + 0x03F, 0x00000CF6, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x0000002E, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x00000068, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x0000042C, + 0x033, 0x00000061, + 0x03F, 0x0000082B, + 0x033, 0x00000062, + 0x03F, 0x0000084A, + 0x033, 0x00000063, + 0x03F, 0x0000084D, + 0x033, 0x00000064, + 0x03F, 0x00000C4D, + 0x033, 0x00000065, + 0x03F, 0x00000C8B, + 0x033, 0x00000066, + 0x03F, 0x00000C8E, + 0x033, 0x00000067, + 0x03F, 0x00000CEC, + 0x033, 0x00000068, + 0x03F, 0x00000CEF, + 0x033, 0x00000069, + 0x03F, 0x00000CF2, + 0x033, 0x0000006A, + 0x03F, 0x00000CF5, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x00000068, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x0000042C, + 0x033, 0x00000061, + 0x03F, 0x0000082B, + 0x033, 0x00000062, + 0x03F, 0x0000084A, + 0x033, 0x00000063, + 0x03F, 0x0000084D, + 0x033, 0x00000064, + 0x03F, 0x00000C4D, + 0x033, 0x00000065, + 0x03F, 0x00000C8B, + 0x033, 0x00000066, + 0x03F, 0x00000C8E, + 0x033, 0x00000067, + 0x03F, 0x00000CEC, + 0x033, 0x00000068, + 0x03F, 0x00000CEF, + 0x033, 0x00000069, + 0x03F, 0x00000CF2, + 0x033, 0x0000006A, + 0x03F, 0x00000CF5, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0xA0000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C2A, + 0x033, 0x00000063, + 0x03F, 0x00000C2D, + 0x033, 0x00000064, + 0x03F, 0x00000C6A, + 0x033, 0x00000065, + 0x03F, 0x00000CAA, + 0x033, 0x00000066, + 0x03F, 0x00000CAD, + 0x033, 0x00000067, + 0x03F, 0x00000CB0, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C09, + 0x033, 0x000000A1, + 0x03F, 0x00000C0C, + 0x033, 0x000000A2, + 0x03F, 0x00000C0F, + 0x033, 0x000000A3, + 0x03F, 0x00000C2C, + 0x033, 0x000000A4, + 0x03F, 0x00000C2F, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000C90, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000005, + 0x033, 0x000000A1, + 0x03F, 0x00000008, + 0x033, 0x000000A2, + 0x03F, 0x0000000B, + 0x033, 0x000000A3, + 0x03F, 0x0000000E, + 0x033, 0x000000A4, + 0x03F, 0x0000002B, + 0x033, 0x000000A5, + 0x03F, 0x0000002E, + 0x033, 0x000000A6, + 0x03F, 0x00000031, + 0x033, 0x000000A7, + 0x03F, 0x00000034, + 0x033, 0x000000A8, + 0x03F, 0x00000053, + 0x033, 0x000000A9, + 0x03F, 0x00000056, + 0x033, 0x000000AA, + 0x03F, 0x000000D1, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x00000C4B, + 0x033, 0x000000A5, + 0x03F, 0x00000C6C, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000CAF, + 0x033, 0x000000A8, + 0x03F, 0x00000CD1, + 0x033, 0x000000A9, + 0x03F, 0x00000CF3, + 0x033, 0x000000AA, + 0x03F, 0x00000CF6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000005, + 0x033, 0x000000A1, + 0x03F, 0x00000008, + 0x033, 0x000000A2, + 0x03F, 0x0000000B, + 0x033, 0x000000A3, + 0x03F, 0x0000000E, + 0x033, 0x000000A4, + 0x03F, 0x0000002B, + 0x033, 0x000000A5, + 0x03F, 0x0000002E, + 0x033, 0x000000A6, + 0x03F, 0x00000031, + 0x033, 0x000000A7, + 0x03F, 0x00000034, + 0x033, 0x000000A8, + 0x03F, 0x00000053, + 0x033, 0x000000A9, + 0x03F, 0x00000056, + 0x033, 0x000000AA, + 0x03F, 0x000000D1, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x00000C4B, + 0x033, 0x000000A5, + 0x03F, 0x00000C6C, + 0x033, 0x000000A6, + 0x03F, 0x00000CAC, + 0x033, 0x000000A7, + 0x03F, 0x00000CED, + 0x033, 0x000000A8, + 0x03F, 0x00000CF0, + 0x033, 0x000000A9, + 0x03F, 0x00000CF3, + 0x033, 0x000000AA, + 0x03F, 0x00000CF6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C0A, + 0x033, 0x000000A1, + 0x03F, 0x00000C0D, + 0x033, 0x000000A2, + 0x03F, 0x00000C2A, + 0x033, 0x000000A3, + 0x03F, 0x00000C2D, + 0x033, 0x000000A4, + 0x03F, 0x00000C6A, + 0x033, 0x000000A5, + 0x03F, 0x00000CE8, + 0x033, 0x000000A6, + 0x03F, 0x00000CEB, + 0x033, 0x000000A7, + 0x03F, 0x00000CEE, + 0x033, 0x000000A8, + 0x03F, 0x00000CF1, + 0x033, 0x000000A9, + 0x03F, 0x00000CF4, + 0x033, 0x000000AA, + 0x03F, 0x00000CF7, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C09, + 0x033, 0x000000A1, + 0x03F, 0x00000C0C, + 0x033, 0x000000A2, + 0x03F, 0x00000C0F, + 0x033, 0x000000A3, + 0x03F, 0x00000C2C, + 0x033, 0x000000A4, + 0x03F, 0x00000C2F, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000C90, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C09, + 0x033, 0x000000A1, + 0x03F, 0x00000C0C, + 0x033, 0x000000A2, + 0x03F, 0x00000C0F, + 0x033, 0x000000A3, + 0x03F, 0x00000C2C, + 0x033, 0x000000A4, + 0x03F, 0x00000C2F, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000C90, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x00000C4B, + 0x033, 0x000000A5, + 0x03F, 0x00000CE5, + 0x033, 0x000000A6, + 0x03F, 0x00000CE8, + 0x033, 0x000000A7, + 0x03F, 0x00000CEB, + 0x033, 0x000000A8, + 0x03F, 0x00000CEE, + 0x033, 0x000000A9, + 0x03F, 0x00000CF1, + 0x033, 0x000000AA, + 0x03F, 0x00000CF4, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000824, + 0x033, 0x000000A1, + 0x03F, 0x00000827, + 0x033, 0x000000A2, + 0x03F, 0x0000082A, + 0x033, 0x000000A3, + 0x03F, 0x0000082D, + 0x033, 0x000000A4, + 0x03F, 0x00000C68, + 0x033, 0x000000A5, + 0x03F, 0x00000C6B, + 0x033, 0x000000A6, + 0x03F, 0x00000CCA, + 0x033, 0x000000A7, + 0x03F, 0x00000CCD, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C08, + 0x033, 0x000000A1, + 0x03F, 0x00000C0B, + 0x033, 0x000000A2, + 0x03F, 0x00000C0E, + 0x033, 0x000000A3, + 0x03F, 0x00000C2B, + 0x033, 0x000000A4, + 0x03F, 0x00000C2E, + 0x033, 0x000000A5, + 0x03F, 0x00000C31, + 0x033, 0x000000A6, + 0x03F, 0x00000CCA, + 0x033, 0x000000A7, + 0x03F, 0x00000CCD, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x0000086A, + 0x033, 0x000000A5, + 0x03F, 0x0000086D, + 0x033, 0x000000A6, + 0x03F, 0x00000870, + 0x033, 0x000000A7, + 0x03F, 0x00000891, + 0x033, 0x000000A8, + 0x03F, 0x00000894, + 0x033, 0x000000A9, + 0x03F, 0x000008B5, + 0x033, 0x000000AA, + 0x03F, 0x000008F5, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x00000C4B, + 0x033, 0x000000A5, + 0x03F, 0x00000C6C, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000CAF, + 0x033, 0x000000A8, + 0x03F, 0x00000CD1, + 0x033, 0x000000A9, + 0x03F, 0x00000CF3, + 0x033, 0x000000AA, + 0x03F, 0x00000CF6, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x00000C4B, + 0x033, 0x000000A5, + 0x03F, 0x00000C6C, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000CAF, + 0x033, 0x000000A8, + 0x03F, 0x00000CD1, + 0x033, 0x000000A9, + 0x03F, 0x00000CF3, + 0x033, 0x000000AA, + 0x03F, 0x00000CF6, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000005, + 0x033, 0x000000A1, + 0x03F, 0x00000008, + 0x033, 0x000000A2, + 0x03F, 0x0000000B, + 0x033, 0x000000A3, + 0x03F, 0x0000000E, + 0x033, 0x000000A4, + 0x03F, 0x0000002B, + 0x033, 0x000000A5, + 0x03F, 0x0000002E, + 0x033, 0x000000A6, + 0x03F, 0x00000031, + 0x033, 0x000000A7, + 0x03F, 0x00000034, + 0x033, 0x000000A8, + 0x03F, 0x00000053, + 0x033, 0x000000A9, + 0x03F, 0x00000056, + 0x033, 0x000000AA, + 0x03F, 0x000000D1, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000005, + 0x033, 0x000000A1, + 0x03F, 0x00000008, + 0x033, 0x000000A2, + 0x03F, 0x0000000B, + 0x033, 0x000000A3, + 0x03F, 0x0000000E, + 0x033, 0x000000A4, + 0x03F, 0x00000047, + 0x033, 0x000000A5, + 0x03F, 0x0000004A, + 0x033, 0x000000A6, + 0x03F, 0x0000004D, + 0x033, 0x000000A7, + 0x03F, 0x00000050, + 0x033, 0x000000A8, + 0x03F, 0x00000053, + 0x033, 0x000000A9, + 0x03F, 0x00000056, + 0x033, 0x000000AA, + 0x03F, 0x00000094, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x0000042A, + 0x033, 0x000000A1, + 0x03F, 0x00000829, + 0x033, 0x000000A2, + 0x03F, 0x00000848, + 0x033, 0x000000A3, + 0x03F, 0x0000084B, + 0x033, 0x000000A4, + 0x03F, 0x00000C4C, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000CEB, + 0x033, 0x000000A8, + 0x03F, 0x00000CEE, + 0x033, 0x000000A9, + 0x03F, 0x00000CF1, + 0x033, 0x000000AA, + 0x03F, 0x00000CF4, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000005, + 0x033, 0x000000A1, + 0x03F, 0x00000008, + 0x033, 0x000000A2, + 0x03F, 0x0000000B, + 0x033, 0x000000A3, + 0x03F, 0x0000000E, + 0x033, 0x000000A4, + 0x03F, 0x00000047, + 0x033, 0x000000A5, + 0x03F, 0x0000004A, + 0x033, 0x000000A6, + 0x03F, 0x0000004D, + 0x033, 0x000000A7, + 0x03F, 0x00000050, + 0x033, 0x000000A8, + 0x03F, 0x00000053, + 0x033, 0x000000A9, + 0x03F, 0x00000056, + 0x033, 0x000000AA, + 0x03F, 0x00000094, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x0000042A, + 0x033, 0x000000A1, + 0x03F, 0x00000829, + 0x033, 0x000000A2, + 0x03F, 0x00000848, + 0x033, 0x000000A3, + 0x03F, 0x0000084B, + 0x033, 0x000000A4, + 0x03F, 0x00000C4C, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000CEB, + 0x033, 0x000000A8, + 0x03F, 0x00000CEE, + 0x033, 0x000000A9, + 0x03F, 0x00000CF1, + 0x033, 0x000000AA, + 0x03F, 0x00000CF4, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0xA0000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C09, + 0x033, 0x000000A1, + 0x03F, 0x00000C0C, + 0x033, 0x000000A2, + 0x03F, 0x00000C0F, + 0x033, 0x000000A3, + 0x03F, 0x00000C2C, + 0x033, 0x000000A4, + 0x03F, 0x00000C2F, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000C90, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000400, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000047C, + 0x033, 0x00000001, + 0x03F, 0x0000047C, + 0x033, 0x00000002, + 0x03F, 0x0000047C, + 0x033, 0x00000003, + 0x03F, 0x0000047C, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000047C, + 0x033, 0x00000001, + 0x03F, 0x0000047C, + 0x033, 0x00000002, + 0x03F, 0x0000047C, + 0x033, 0x00000003, + 0x03F, 0x0000047C, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000047C, + 0x033, 0x00000001, + 0x03F, 0x0000047C, + 0x033, 0x00000002, + 0x03F, 0x0000047C, + 0x033, 0x00000003, + 0x03F, 0x0000047C, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000047C, + 0x033, 0x00000001, + 0x03F, 0x0000047C, + 0x033, 0x00000002, + 0x03F, 0x0000047C, + 0x033, 0x00000003, + 0x03F, 0x0000047C, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000047C, + 0x033, 0x00000001, + 0x03F, 0x0000047C, + 0x033, 0x00000002, + 0x03F, 0x0000047C, + 0x033, 0x00000003, + 0x03F, 0x0000047C, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x000008BB, + 0x033, 0x00000001, + 0x03F, 0x000008BB, + 0x033, 0x00000002, + 0x03F, 0x000008BB, + 0x033, 0x00000003, + 0x03F, 0x000008BB, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000047C, + 0x033, 0x00000001, + 0x03F, 0x0000047C, + 0x033, 0x00000002, + 0x03F, 0x0000047C, + 0x033, 0x00000003, + 0x03F, 0x0000047C, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000047C, + 0x033, 0x00000001, + 0x03F, 0x0000047C, + 0x033, 0x00000002, + 0x03F, 0x0000047C, + 0x033, 0x00000003, + 0x03F, 0x0000047C, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000047C, + 0x033, 0x00000001, + 0x03F, 0x0000047C, + 0x033, 0x00000002, + 0x03F, 0x0000047C, + 0x033, 0x00000003, + 0x03F, 0x0000047C, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000047C, + 0x033, 0x00000001, + 0x03F, 0x0000047C, + 0x033, 0x00000002, + 0x03F, 0x0000047C, + 0x033, 0x00000003, + 0x03F, 0x0000047C, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000047C, + 0x033, 0x00000001, + 0x03F, 0x0000047C, + 0x033, 0x00000002, + 0x03F, 0x0000047C, + 0x033, 0x00000003, + 0x03F, 0x0000047C, + 0xA0000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x000004BB, + 0x033, 0x00000001, + 0x03F, 0x000004BB, + 0x033, 0x00000002, + 0x03F, 0x000004BB, + 0x033, 0x00000003, + 0x03F, 0x000004BB, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000100, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00001726, + 0x033, 0x00000001, + 0x03F, 0x00001726, + 0x033, 0x00000002, + 0x03F, 0x00001726, + 0x033, 0x00000003, + 0x03F, 0x00001726, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00001726, + 0x033, 0x00000001, + 0x03F, 0x00001726, + 0x033, 0x00000002, + 0x03F, 0x00001726, + 0x033, 0x00000003, + 0x03F, 0x00001726, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00001726, + 0x033, 0x00000001, + 0x03F, 0x00001726, + 0x033, 0x00000002, + 0x03F, 0x00001726, + 0x033, 0x00000003, + 0x03F, 0x00001726, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00001726, + 0x033, 0x00000001, + 0x03F, 0x00001726, + 0x033, 0x00000002, + 0x03F, 0x00001726, + 0x033, 0x00000003, + 0x03F, 0x00001726, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00001726, + 0x033, 0x00000001, + 0x03F, 0x00001726, + 0x033, 0x00000002, + 0x03F, 0x00001726, + 0x033, 0x00000003, + 0x03F, 0x00001726, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00001726, + 0x033, 0x00000001, + 0x03F, 0x00001726, + 0x033, 0x00000002, + 0x03F, 0x00001726, + 0x033, 0x00000003, + 0x03F, 0x00001726, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00001726, + 0x033, 0x00000001, + 0x03F, 0x00001726, + 0x033, 0x00000002, + 0x03F, 0x00001726, + 0x033, 0x00000003, + 0x03F, 0x00001726, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00001726, + 0x033, 0x00000001, + 0x03F, 0x00001726, + 0x033, 0x00000002, + 0x03F, 0x00001726, + 0x033, 0x00000003, + 0x03F, 0x00001726, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00001726, + 0x033, 0x00000001, + 0x03F, 0x00001726, + 0x033, 0x00000002, + 0x03F, 0x00001726, + 0x033, 0x00000003, + 0x03F, 0x00001726, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00001726, + 0x033, 0x00000001, + 0x03F, 0x00001726, + 0x033, 0x00000002, + 0x03F, 0x00001726, + 0x033, 0x00000003, + 0x03F, 0x00001726, + 0xA0000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000F34, + 0x033, 0x00000001, + 0x03F, 0x00000F34, + 0x033, 0x00000002, + 0x03F, 0x00000F34, + 0x033, 0x00000003, + 0x03F, 0x00000F34, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0xA0000000, 0x00000000, + 0x081, 0x0000F000, + 0x087, 0x00016040, + 0x051, 0x00000C00, + 0x052, 0x0007C241, + 0x053, 0x0001C069, + 0x054, 0x00078032, + 0x057, 0x0000CE0A, + 0x058, 0x00058750, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000800, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000002, + 0x033, 0x00000001, + 0x03F, 0x00000005, + 0x033, 0x00000002, + 0x03F, 0x00000008, + 0x033, 0x00000003, + 0x03F, 0x0000000B, + 0x033, 0x00000004, + 0x03F, 0x0000000E, + 0x033, 0x00000005, + 0x03F, 0x0000002B, + 0x033, 0x00000006, + 0x03F, 0x0000002E, + 0x033, 0x00000007, + 0x03F, 0x00000031, + 0x033, 0x00000008, + 0x03F, 0x0000006E, + 0x033, 0x00000009, + 0x03F, 0x00000071, + 0x033, 0x0000000A, + 0x03F, 0x00000074, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000002, + 0x033, 0x00000001, + 0x03F, 0x00000005, + 0x033, 0x00000002, + 0x03F, 0x00000008, + 0x033, 0x00000003, + 0x03F, 0x0000000B, + 0x033, 0x00000004, + 0x03F, 0x0000000E, + 0x033, 0x00000005, + 0x03F, 0x0000002B, + 0x033, 0x00000006, + 0x03F, 0x0000002E, + 0x033, 0x00000007, + 0x03F, 0x00000031, + 0x033, 0x00000008, + 0x03F, 0x0000006E, + 0x033, 0x00000009, + 0x03F, 0x00000071, + 0x033, 0x0000000A, + 0x03F, 0x00000074, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0xA0000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0005142C, + 0x033, 0x00000001, + 0x03F, 0x0005144B, + 0x033, 0x00000002, + 0x03F, 0x0005144E, + 0x033, 0x00000003, + 0x03F, 0x00051C69, + 0x033, 0x00000004, + 0x03F, 0x00051C6C, + 0x033, 0x00000005, + 0x03F, 0x00051C6F, + 0x033, 0x00000006, + 0x03F, 0x00051CEB, + 0x033, 0x00000007, + 0x03F, 0x00051CEE, + 0x033, 0x00000008, + 0x03F, 0x00051CF1, + 0x033, 0x00000009, + 0x03F, 0x00051CF4, + 0x033, 0x0000000A, + 0x03F, 0x00051CF7, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000010, + 0x033, 0x00000000, + 0x008, 0x0009C060, + 0x033, 0x00000001, + 0x008, 0x0009C060, + 0x0EF, 0x00000000, + 0x033, 0x000000A2, + 0x0EF, 0x00080000, + 0x03E, 0x0000593F, + 0x8300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000D0F4F, + 0xA0000000, 0x00000000, + 0x03F, 0x000C0F4F, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x033, 0x000000A3, + 0x0EF, 0x00080000, + 0x03E, 0x00005934, + 0x03F, 0x0005AFCF, + 0x0EF, 0x00000000, + 0x83000002, 0x00000000, 0x40000000, 0x00000000, + 0x0CE, 0x00094400, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0CE, 0x00094400, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0CE, 0x00094400, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0CE, 0x00094400, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x0CE, 0x00094400, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x0CE, 0x00094400, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x0CE, 0x00094400, + 0xA0000000, 0x00000000, + 0x0CE, 0x00094C00, + 0xB0000000, 0x00000000, + 0x83000002, 0x00000000, 0x40000000, 0x00000000, + 0x0CF, 0x00072F00, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0CF, 0x00072F00, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0CF, 0x00072F00, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0CF, 0x00072F00, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x0CF, 0x00064700, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x0CF, 0x00072F00, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x0CF, 0x00072F00, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x0CF, 0x00072F00, + 0xA0000000, 0x00000000, + 0x0CF, 0x00064700, + 0xB0000000, 0x00000000, + 0x83000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000004, + 0x033, 0x00000000, + 0x03F, 0x00000056, + 0x033, 0x00000001, + 0x03F, 0x000000D6, + 0x0EF, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000004, + 0x033, 0x00000000, + 0x03F, 0x00000056, + 0x033, 0x00000001, + 0x03F, 0x000000D6, + 0x0EF, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000004, + 0x033, 0x00000000, + 0x03F, 0x00000056, + 0x033, 0x00000001, + 0x03F, 0x000000D6, + 0x0EF, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000004, + 0x033, 0x00000000, + 0x03F, 0x00000056, + 0x033, 0x00000001, + 0x03F, 0x000000D6, + 0x0EF, 0x00000000, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000004, + 0x033, 0x00000000, + 0x03F, 0x00000096, + 0x033, 0x00000001, + 0x03F, 0x000000D6, + 0x0EF, 0x00000000, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000004, + 0x033, 0x00000000, + 0x03F, 0x00000056, + 0x033, 0x00000001, + 0x03F, 0x00000056, + 0x0EF, 0x00000000, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000004, + 0x033, 0x00000000, + 0x03F, 0x00000056, + 0x033, 0x00000001, + 0x03F, 0x000000D6, + 0x0EF, 0x00000000, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000004, + 0x033, 0x00000000, + 0x03F, 0x00000056, + 0x033, 0x00000001, + 0x03F, 0x000000D6, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000096, + 0x033, 0x00000001, + 0x03F, 0x000000D6, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x0B0, 0x000FF0FC, + 0x0C4, 0x00081402, + 0x0CC, 0x00082000, +}; + +RTW_DECL_TABLE_RF_RADIO(rtw8822b_rf_a, A); + +static const u32 rtw8822b_rf_b[] = { + 0x000, 0x00030000, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x00040029, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x001, 0x0004002D, + 0xA0000000, 0x00000000, + 0x001, 0x00040029, + 0xB0000000, 0x00000000, + 0x018, 0x00010D24, + 0x0EF, 0x00080000, + 0x033, 0x00000002, + 0x03E, 0x0000003F, + 0x8300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000D0F4E, + 0xA0000000, 0x00000000, + 0x03F, 0x000C0F4E, + 0xB0000000, 0x00000000, + 0x033, 0x00000001, + 0x03E, 0x00000034, + 0x03F, 0x0004080E, + 0x0EF, 0x00080000, + 0x0DF, 0x00002449, + 0x033, 0x00000024, + 0x03E, 0x0000003F, + 0x03F, 0x00060FDE, + 0x0EF, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000025, + 0x03E, 0x00000037, + 0x03F, 0x0007EFCE, + 0x0EF, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000026, + 0x03E, 0x00000037, + 0x03F, 0x000DEFCE, + 0x0EF, 0x00000000, + 0x0DF, 0x00000009, + 0x018, 0x00010524, + 0x089, 0x00000207, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FE186, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FE186, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x08A, 0x000FF186, + 0xA0000000, 0x00000000, + 0x08A, 0x000FF186, + 0xB0000000, 0x00000000, + 0x08B, 0x00061E3C, + 0x08C, 0x000112C7, + 0x08D, 0x000F4988, + 0x08E, 0x00064D40, + 0x0EF, 0x00020000, + 0x033, 0x00000007, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0xA0000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0xB0000000, 0x00000000, + 0x033, 0x00000006, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x033, 0x00000005, + 0x03E, 0x000040C8, + 0x03F, 0x000C3186, + 0x033, 0x00000004, + 0x03E, 0x00004190, + 0x03F, 0x000C3186, + 0x033, 0x00000003, + 0x03E, 0x00004998, + 0x03F, 0x000C3186, + 0x033, 0x00000002, + 0x03E, 0x00005840, + 0x03F, 0x000C3186, + 0x033, 0x00000001, + 0x03E, 0x000058C2, + 0x03F, 0x000C3186, + 0x033, 0x00000000, + 0x03E, 0x00005930, + 0x03F, 0x000C3186, + 0x033, 0x0000000F, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0xA0000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0xB0000000, 0x00000000, + 0x033, 0x0000000E, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x033, 0x0000000D, + 0x8300000f, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000040D0, + 0xA0000000, 0x00000000, + 0x03E, 0x000040C8, + 0xB0000000, 0x00000000, + 0x03F, 0x000C3186, + 0x033, 0x0000000C, + 0x03E, 0x00004190, + 0x03F, 0x000C3186, + 0x033, 0x0000000B, + 0x03E, 0x00004998, + 0x03F, 0x000C3186, + 0x033, 0x0000000A, + 0x03E, 0x00005840, + 0x03F, 0x000C3186, + 0x033, 0x00000009, + 0x03E, 0x000058C2, + 0x03F, 0x000C3186, + 0x033, 0x00000008, + 0x03E, 0x00005930, + 0x03F, 0x000C3186, + 0x033, 0x00000017, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000DFF86, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000DFF86, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C0006, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00004040, + 0x03F, 0x000C3186, + 0xA0000000, 0x00000000, + 0x03E, 0x00004000, + 0x03F, 0x000C3186, + 0xB0000000, 0x00000000, + 0x033, 0x00000016, + 0x03E, 0x00004080, + 0x03F, 0x000C3186, + 0x033, 0x00000015, + 0x8300000f, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x000040D0, + 0xA0000000, 0x00000000, + 0x03E, 0x000040C8, + 0xB0000000, 0x00000000, + 0x03F, 0x000C3186, + 0x033, 0x00000014, + 0x03E, 0x00004190, + 0x03F, 0x000C3186, + 0x033, 0x00000013, + 0x03E, 0x00004998, + 0x03F, 0x000C3186, + 0x033, 0x00000012, + 0x03E, 0x00005840, + 0x03F, 0x000C3186, + 0x033, 0x00000011, + 0x03E, 0x000058C2, + 0x03F, 0x000C3186, + 0x033, 0x00000010, + 0x03E, 0x00005930, + 0x03F, 0x000C3186, + 0x0EF, 0x00000000, + 0x0EF, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x0000000A, + 0x033, 0x00000001, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000005, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000002, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000005, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000005, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000005, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00000000, + 0xA0000000, 0x00000000, + 0x03F, 0x00000005, + 0xB0000000, 0x00000000, + 0x033, 0x00000002, + 0x03F, 0x00000000, + 0x0EF, 0x00000000, + 0x018, 0x00000401, + 0x084, 0x00001209, + 0x086, 0x000001A0, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x087, 0x00068080, + 0xA0000000, 0x00000000, + 0x087, 0x000E8180, + 0xB0000000, 0x00000000, + 0x088, 0x00070020, + 0x0DE, 0x00000010, + 0x0EF, 0x00008000, + 0x033, 0x0000000F, + 0x03F, 0x0000003C, + 0x033, 0x0000000E, + 0x03F, 0x00000038, + 0x033, 0x0000000D, + 0x03F, 0x00000030, + 0x033, 0x0000000C, + 0x03F, 0x00000028, + 0x033, 0x0000000B, + 0x03F, 0x00000020, + 0x033, 0x0000000A, + 0x03F, 0x00000018, + 0x033, 0x00000009, + 0x03F, 0x00000010, + 0x033, 0x00000008, + 0x03F, 0x00000008, + 0x033, 0x00000007, + 0x03F, 0x0000003C, + 0x033, 0x00000006, + 0x03F, 0x00000038, + 0x033, 0x00000005, + 0x03F, 0x00000030, + 0x033, 0x00000004, + 0x03F, 0x00000028, + 0x033, 0x00000003, + 0x03F, 0x00000020, + 0x033, 0x00000002, + 0x03F, 0x00000018, + 0x033, 0x00000001, + 0x03F, 0x00000010, + 0x033, 0x00000000, + 0x03F, 0x00000008, + 0x0EF, 0x00000000, + 0x018, 0x00018D24, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0x018, 0x00010D24, + 0x01B, 0x00075A40, + 0x0EE, 0x00000002, + 0x033, 0x00000000, + 0x03F, 0x00000004, + 0x033, 0x00000001, + 0x03F, 0x00000004, + 0x033, 0x00000002, + 0x03F, 0x00000004, + 0x033, 0x00000003, + 0x03F, 0x00000004, + 0x033, 0x00000004, + 0x03F, 0x00000004, + 0x033, 0x00000005, + 0x03F, 0x00000006, + 0x033, 0x00000006, + 0x03F, 0x00000004, + 0x033, 0x00000007, + 0x03F, 0x00000000, + 0x0EE, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D3D1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000062, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000062, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D3D1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D3D1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D3D1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D3D1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000062, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000062, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000062, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D2A1, + 0x062, 0x0000D3A2, + 0x063, 0x00000002, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x061, 0x0005D4A0, + 0x062, 0x0000D203, + 0x063, 0x00000062, + 0xA0000000, 0x00000000, + 0x061, 0x0005D3D0, + 0x062, 0x0000D303, + 0x063, 0x00000002, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000200, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A3, + 0x030, 0x000053A3, + 0x030, 0x000063A3, + 0x030, 0x000073A3, + 0x030, 0x000083A3, + 0x030, 0x000093A3, + 0x030, 0x0000A3A3, + 0x030, 0x0000B3A3, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000004A3, + 0x030, 0x000014A3, + 0x030, 0x000024A3, + 0x030, 0x000034A3, + 0x030, 0x000044A3, + 0x030, 0x000054A3, + 0x030, 0x000064A3, + 0x030, 0x000074A3, + 0x030, 0x000084A3, + 0x030, 0x000094A3, + 0x030, 0x0000A4A3, + 0x030, 0x0000B4A3, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000002A6, + 0x030, 0x000012A6, + 0x030, 0x000022A6, + 0x030, 0x000032A6, + 0x030, 0x000042A6, + 0x030, 0x000052A6, + 0x030, 0x000062A6, + 0x030, 0x000072A6, + 0x030, 0x000082A6, + 0x030, 0x000092A6, + 0x030, 0x0000A2A6, + 0x030, 0x0000B2A6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000303, + 0x030, 0x00001303, + 0x030, 0x00002303, + 0x030, 0x00003303, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x00008365, + 0x030, 0x00009365, + 0x030, 0x0000A365, + 0x030, 0x0000B365, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000002A6, + 0x030, 0x000012A6, + 0x030, 0x000022A6, + 0x030, 0x000032A6, + 0x030, 0x000042A6, + 0x030, 0x000052A6, + 0x030, 0x000062A6, + 0x030, 0x000072A6, + 0x030, 0x000082A6, + 0x030, 0x000092A6, + 0x030, 0x0000A2A6, + 0x030, 0x0000B2A6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000004A4, + 0x030, 0x000014A4, + 0x030, 0x000024A4, + 0x030, 0x000034A4, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x000083A5, + 0x030, 0x000093A5, + 0x030, 0x0000A3A5, + 0x030, 0x0000B3A5, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000004A3, + 0x030, 0x000014A3, + 0x030, 0x000024A3, + 0x030, 0x000034A3, + 0x030, 0x000044A3, + 0x030, 0x000054A3, + 0x030, 0x000064A3, + 0x030, 0x000074A3, + 0x030, 0x000084A3, + 0x030, 0x000094A3, + 0x030, 0x0000A4A3, + 0x030, 0x0000B4A3, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000004A3, + 0x030, 0x000014A3, + 0x030, 0x000024A3, + 0x030, 0x000034A3, + 0x030, 0x000044A3, + 0x030, 0x000054A3, + 0x030, 0x000064A3, + 0x030, 0x000074A3, + 0x030, 0x000084A3, + 0x030, 0x000094A3, + 0x030, 0x0000A4A3, + 0x030, 0x0000B4A3, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000002F4, + 0x030, 0x000012F4, + 0x030, 0x000022F4, + 0x030, 0x000032F4, + 0x030, 0x00004365, + 0x030, 0x00005365, + 0x030, 0x00006365, + 0x030, 0x00007365, + 0x030, 0x000082A4, + 0x030, 0x000092A4, + 0x030, 0x0000A2A4, + 0x030, 0x0000B2A4, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000382, + 0x030, 0x00001382, + 0x030, 0x00002382, + 0x030, 0x00003382, + 0x030, 0x00004445, + 0x030, 0x00005445, + 0x030, 0x00006445, + 0x030, 0x00007445, + 0x030, 0x00008425, + 0x030, 0x00009425, + 0x030, 0x0000A425, + 0x030, 0x0000B425, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A3, + 0x030, 0x000053A3, + 0x030, 0x000063A3, + 0x030, 0x000073A3, + 0x030, 0x000083A3, + 0x030, 0x000093A3, + 0x030, 0x0000A3A3, + 0x030, 0x0000B3A3, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000004A3, + 0x030, 0x000014A3, + 0x030, 0x000024A3, + 0x030, 0x000034A3, + 0x030, 0x000044A3, + 0x030, 0x000054A3, + 0x030, 0x000064A3, + 0x030, 0x000074A3, + 0x030, 0x000084A3, + 0x030, 0x000094A3, + 0x030, 0x0000A4A3, + 0x030, 0x0000B4A3, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000443, + 0x030, 0x00001443, + 0x030, 0x00002443, + 0x030, 0x00003443, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x00008365, + 0x030, 0x00009365, + 0x030, 0x0000A365, + 0x030, 0x0000B365, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000343, + 0x030, 0x00001343, + 0x030, 0x00002343, + 0x030, 0x00003343, + 0x030, 0x00004483, + 0x030, 0x00005483, + 0x030, 0x00006483, + 0x030, 0x00007483, + 0x030, 0x000083A4, + 0x030, 0x000093A4, + 0x030, 0x0000A3A4, + 0x030, 0x0000B3A4, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x00004423, + 0x030, 0x00005423, + 0x030, 0x00006423, + 0x030, 0x00007423, + 0x030, 0x00008324, + 0x030, 0x00009324, + 0x030, 0x0000A324, + 0x030, 0x0000B324, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000303, + 0x030, 0x00001303, + 0x030, 0x00002303, + 0x030, 0x00003303, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x00008365, + 0x030, 0x00009365, + 0x030, 0x0000A365, + 0x030, 0x0000B365, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000403, + 0x030, 0x00001403, + 0x030, 0x00002403, + 0x030, 0x00003403, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x000083A3, + 0x030, 0x000093A3, + 0x030, 0x0000A3A3, + 0x030, 0x0000B3A3, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A3, + 0x030, 0x000013A3, + 0x030, 0x000023A3, + 0x030, 0x000033A3, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x00008365, + 0x030, 0x00009365, + 0x030, 0x0000A365, + 0x030, 0x0000B365, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000002A6, + 0x030, 0x000012A6, + 0x030, 0x000022A6, + 0x030, 0x000032A6, + 0x030, 0x000042A6, + 0x030, 0x000052A6, + 0x030, 0x000062A6, + 0x030, 0x000072A6, + 0x030, 0x000082A6, + 0x030, 0x000092A6, + 0x030, 0x0000A2A6, + 0x030, 0x0000B2A6, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000004A0, + 0x030, 0x000014A0, + 0x030, 0x000024A0, + 0x030, 0x000034A0, + 0x030, 0x000044A0, + 0x030, 0x000054A0, + 0x030, 0x000064A0, + 0x030, 0x000074A0, + 0x030, 0x000084A0, + 0x030, 0x000094A0, + 0x030, 0x0000A4A0, + 0x030, 0x0000B4A0, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000002A1, + 0x030, 0x000012A1, + 0x030, 0x000022A1, + 0x030, 0x000032A1, + 0x030, 0x000042A1, + 0x030, 0x000052A1, + 0x030, 0x000062A1, + 0x030, 0x000072A1, + 0x030, 0x000082A1, + 0x030, 0x000092A1, + 0x030, 0x0000A2A1, + 0x030, 0x0000B2A1, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000004A0, + 0x030, 0x000014A0, + 0x030, 0x000024A0, + 0x030, 0x000034A0, + 0x030, 0x000043A1, + 0x030, 0x000053A1, + 0x030, 0x000063A1, + 0x030, 0x000073A1, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000002A1, + 0x030, 0x000012A1, + 0x030, 0x000022A1, + 0x030, 0x000032A1, + 0x030, 0x000042A1, + 0x030, 0x000052A1, + 0x030, 0x000062A1, + 0x030, 0x000072A1, + 0x030, 0x000082A1, + 0x030, 0x000092A1, + 0x030, 0x0000A2A1, + 0x030, 0x0000B2A1, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000004A1, + 0x030, 0x000014A1, + 0x030, 0x000024A1, + 0x030, 0x000034A1, + 0x030, 0x000043A1, + 0x030, 0x000053A1, + 0x030, 0x000063A1, + 0x030, 0x000073A1, + 0x030, 0x000083A1, + 0x030, 0x000093A1, + 0x030, 0x0000A3A1, + 0x030, 0x0000B3A1, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000004A0, + 0x030, 0x000014A0, + 0x030, 0x000024A0, + 0x030, 0x000034A0, + 0x030, 0x000044A0, + 0x030, 0x000054A0, + 0x030, 0x000064A0, + 0x030, 0x000074A0, + 0x030, 0x000084A0, + 0x030, 0x000094A0, + 0x030, 0x0000A4A0, + 0x030, 0x0000B4A0, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000004A0, + 0x030, 0x000014A0, + 0x030, 0x000024A0, + 0x030, 0x000034A0, + 0x030, 0x000044A0, + 0x030, 0x000054A0, + 0x030, 0x000064A0, + 0x030, 0x000074A0, + 0x030, 0x000084A0, + 0x030, 0x000094A0, + 0x030, 0x0000A4A0, + 0x030, 0x0000B4A0, + 0xA0000000, 0x00000000, + 0x030, 0x000002D0, + 0x030, 0x000012D0, + 0x030, 0x000022D0, + 0x030, 0x000032D0, + 0x030, 0x000042D0, + 0x030, 0x000052D0, + 0x030, 0x000062D0, + 0x030, 0x000072D0, + 0x030, 0x000082D0, + 0x030, 0x000092D0, + 0x030, 0x0000A2D0, + 0x030, 0x0000B2D0, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000080, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A3, + 0x030, 0x000013A3, + 0x030, 0x000023A3, + 0x030, 0x000033A3, + 0x030, 0x000043A4, + 0x030, 0x000053A4, + 0x030, 0x000063A4, + 0x030, 0x000073A4, + 0x030, 0x000083A3, + 0x030, 0x000093A3, + 0x030, 0x0000A3A3, + 0x030, 0x0000B3A3, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000203, + 0x030, 0x00001203, + 0x030, 0x00002203, + 0x030, 0x00003203, + 0x030, 0x00004203, + 0x030, 0x00005203, + 0x030, 0x00006203, + 0x030, 0x00007203, + 0x030, 0x00008203, + 0x030, 0x00009203, + 0x030, 0x0000A203, + 0x030, 0x0000B203, + 0xA0000000, 0x00000000, + 0x030, 0x000003A2, + 0x030, 0x000013A2, + 0x030, 0x000023A2, + 0x030, 0x000033A2, + 0x030, 0x000043A2, + 0x030, 0x000053A2, + 0x030, 0x000063A2, + 0x030, 0x000073A2, + 0x030, 0x000083A2, + 0x030, 0x000093A2, + 0x030, 0x0000A3A2, + 0x030, 0x0000B3A2, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000040, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000764, + 0x030, 0x00001632, + 0x030, 0x00002421, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000777, + 0x030, 0x00001442, + 0x030, 0x00002222, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000764, + 0x030, 0x00001452, + 0x030, 0x00002220, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000660, + 0x030, 0x00001341, + 0x030, 0x00002220, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000764, + 0x030, 0x00001632, + 0x030, 0x00002421, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000764, + 0x030, 0x00001632, + 0x030, 0x00002421, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000767, + 0x030, 0x00001442, + 0x030, 0x00002222, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000765, + 0x030, 0x00001632, + 0x030, 0x00002451, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000764, + 0x030, 0x00001632, + 0x030, 0x00002421, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000777, + 0x030, 0x00001442, + 0x030, 0x00002222, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000776, + 0x030, 0x00001442, + 0x030, 0x00002222, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000777, + 0x030, 0x00001442, + 0x030, 0x00002222, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004777, + 0x030, 0x00005777, + 0x030, 0x00006777, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000775, + 0x030, 0x00001422, + 0x030, 0x00002210, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000775, + 0x030, 0x00001222, + 0x030, 0x00002210, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000645, + 0x030, 0x00001333, + 0x030, 0x00002011, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0xA0000000, 0x00000000, + 0x030, 0x00000764, + 0x030, 0x00001632, + 0x030, 0x00002421, + 0x030, 0x00004000, + 0x030, 0x00005000, + 0x030, 0x00006000, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000800, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C09, + 0x033, 0x00000021, + 0x03F, 0x00000C0C, + 0x033, 0x00000022, + 0x03F, 0x00000C0F, + 0x033, 0x00000023, + 0x03F, 0x00000C2C, + 0x033, 0x00000024, + 0x03F, 0x00000C2F, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000C90, + 0x033, 0x00000028, + 0x03F, 0x00000CD0, + 0x033, 0x00000029, + 0x03F, 0x00000CF2, + 0x033, 0x0000002A, + 0x03F, 0x00000CF5, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000005, + 0x033, 0x00000021, + 0x03F, 0x00000008, + 0x033, 0x00000022, + 0x03F, 0x0000000B, + 0x033, 0x00000023, + 0x03F, 0x0000000E, + 0x033, 0x00000024, + 0x03F, 0x0000002B, + 0x033, 0x00000025, + 0x03F, 0x0000002E, + 0x033, 0x00000026, + 0x03F, 0x0000006B, + 0x033, 0x00000027, + 0x03F, 0x0000006E, + 0x033, 0x00000028, + 0x03F, 0x00000071, + 0x033, 0x00000029, + 0x03F, 0x00000074, + 0x033, 0x0000002A, + 0x03F, 0x00000077, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000429, + 0x033, 0x00000021, + 0x03F, 0x00000828, + 0x033, 0x00000022, + 0x03F, 0x00000847, + 0x033, 0x00000023, + 0x03F, 0x0000084A, + 0x033, 0x00000024, + 0x03F, 0x00000C4B, + 0x033, 0x00000025, + 0x03F, 0x00000C6C, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000CAF, + 0x033, 0x00000028, + 0x03F, 0x00000CD1, + 0x033, 0x00000029, + 0x03F, 0x00000CF3, + 0x033, 0x0000002A, + 0x03F, 0x00000CF6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000005, + 0x033, 0x00000021, + 0x03F, 0x00000008, + 0x033, 0x00000022, + 0x03F, 0x0000000B, + 0x033, 0x00000023, + 0x03F, 0x0000000E, + 0x033, 0x00000024, + 0x03F, 0x0000002B, + 0x033, 0x00000025, + 0x03F, 0x0000002E, + 0x033, 0x00000026, + 0x03F, 0x0000006B, + 0x033, 0x00000027, + 0x03F, 0x0000006E, + 0x033, 0x00000028, + 0x03F, 0x00000071, + 0x033, 0x00000029, + 0x03F, 0x00000074, + 0x033, 0x0000002A, + 0x03F, 0x00000077, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x0000042C, + 0x033, 0x00000021, + 0x03F, 0x0000082B, + 0x033, 0x00000022, + 0x03F, 0x0000084A, + 0x033, 0x00000023, + 0x03F, 0x0000084D, + 0x033, 0x00000024, + 0x03F, 0x00000C4E, + 0x033, 0x00000025, + 0x03F, 0x00000C6E, + 0x033, 0x00000026, + 0x03F, 0x00000CAD, + 0x033, 0x00000027, + 0x03F, 0x00000CED, + 0x033, 0x00000028, + 0x03F, 0x00000CF0, + 0x033, 0x00000029, + 0x03F, 0x00000CF3, + 0x033, 0x0000002A, + 0x03F, 0x00000CF6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000828, + 0x033, 0x00000021, + 0x03F, 0x0000082B, + 0x033, 0x00000022, + 0x03F, 0x00000868, + 0x033, 0x00000023, + 0x03F, 0x00000889, + 0x033, 0x00000024, + 0x03F, 0x000008AA, + 0x033, 0x00000025, + 0x03F, 0x00000CE8, + 0x033, 0x00000026, + 0x03F, 0x00000CEB, + 0x033, 0x00000027, + 0x03F, 0x00000CEE, + 0x033, 0x00000028, + 0x03F, 0x00000CF1, + 0x033, 0x00000029, + 0x03F, 0x00000CF4, + 0x033, 0x0000002A, + 0x03F, 0x00000CF7, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C09, + 0x033, 0x00000021, + 0x03F, 0x00000C0C, + 0x033, 0x00000022, + 0x03F, 0x00000C0F, + 0x033, 0x00000023, + 0x03F, 0x00000C2C, + 0x033, 0x00000024, + 0x03F, 0x00000C2F, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000C90, + 0x033, 0x00000028, + 0x03F, 0x00000CD0, + 0x033, 0x00000029, + 0x03F, 0x00000CF2, + 0x033, 0x0000002A, + 0x03F, 0x00000CF5, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C09, + 0x033, 0x00000021, + 0x03F, 0x00000C0C, + 0x033, 0x00000022, + 0x03F, 0x00000C0F, + 0x033, 0x00000023, + 0x03F, 0x00000C2C, + 0x033, 0x00000024, + 0x03F, 0x00000C2F, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000C90, + 0x033, 0x00000028, + 0x03F, 0x00000CD0, + 0x033, 0x00000029, + 0x03F, 0x00000CF2, + 0x033, 0x0000002A, + 0x03F, 0x00000CF5, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000429, + 0x033, 0x00000021, + 0x03F, 0x00000828, + 0x033, 0x00000022, + 0x03F, 0x00000847, + 0x033, 0x00000023, + 0x03F, 0x0000084A, + 0x033, 0x00000024, + 0x03F, 0x00000C4B, + 0x033, 0x00000025, + 0x03F, 0x00000CE5, + 0x033, 0x00000026, + 0x03F, 0x00000CE8, + 0x033, 0x00000027, + 0x03F, 0x00000CEB, + 0x033, 0x00000028, + 0x03F, 0x00000CEE, + 0x033, 0x00000029, + 0x03F, 0x00000CF1, + 0x033, 0x0000002A, + 0x03F, 0x00000CF4, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C25, + 0x033, 0x00000021, + 0x03F, 0x00000C28, + 0x033, 0x00000022, + 0x03F, 0x00000C2B, + 0x033, 0x00000023, + 0x03F, 0x00000C68, + 0x033, 0x00000024, + 0x03F, 0x00000C6B, + 0x033, 0x00000025, + 0x03F, 0x00000C6E, + 0x033, 0x00000026, + 0x03F, 0x00000CEB, + 0x033, 0x00000027, + 0x03F, 0x00000CEE, + 0x033, 0x00000028, + 0x03F, 0x00000CF1, + 0x033, 0x00000029, + 0x03F, 0x00000CF4, + 0x033, 0x0000002A, + 0x03F, 0x00000CF7, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C09, + 0x033, 0x00000021, + 0x03F, 0x00000C0C, + 0x033, 0x00000022, + 0x03F, 0x00000C0F, + 0x033, 0x00000023, + 0x03F, 0x00000C2C, + 0x033, 0x00000024, + 0x03F, 0x00000C2F, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000C90, + 0x033, 0x00000028, + 0x03F, 0x00000CD0, + 0x033, 0x00000029, + 0x03F, 0x00000CF2, + 0x033, 0x0000002A, + 0x03F, 0x00000CF5, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000429, + 0x033, 0x00000021, + 0x03F, 0x00000828, + 0x033, 0x00000022, + 0x03F, 0x00000847, + 0x033, 0x00000023, + 0x03F, 0x0000084A, + 0x033, 0x00000024, + 0x03F, 0x00000C4B, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000CEA, + 0x033, 0x00000027, + 0x03F, 0x00000CED, + 0x033, 0x00000028, + 0x03F, 0x00000CF0, + 0x033, 0x00000029, + 0x03F, 0x00000CF3, + 0x033, 0x0000002A, + 0x03F, 0x00000CF6, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000429, + 0x033, 0x00000021, + 0x03F, 0x00000828, + 0x033, 0x00000022, + 0x03F, 0x00000847, + 0x033, 0x00000023, + 0x03F, 0x0000084A, + 0x033, 0x00000024, + 0x03F, 0x00000C4B, + 0x033, 0x00000025, + 0x03F, 0x00000C6C, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000CAF, + 0x033, 0x00000028, + 0x03F, 0x00000CD1, + 0x033, 0x00000029, + 0x03F, 0x00000CF3, + 0x033, 0x0000002A, + 0x03F, 0x00000CF6, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000429, + 0x033, 0x00000021, + 0x03F, 0x00000828, + 0x033, 0x00000022, + 0x03F, 0x00000847, + 0x033, 0x00000023, + 0x03F, 0x0000084A, + 0x033, 0x00000024, + 0x03F, 0x00000C4B, + 0x033, 0x00000025, + 0x03F, 0x00000C6C, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000CAF, + 0x033, 0x00000028, + 0x03F, 0x00000CD1, + 0x033, 0x00000029, + 0x03F, 0x00000CF3, + 0x033, 0x0000002A, + 0x03F, 0x00000CF6, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000005, + 0x033, 0x00000021, + 0x03F, 0x00000008, + 0x033, 0x00000022, + 0x03F, 0x0000000B, + 0x033, 0x00000023, + 0x03F, 0x0000000E, + 0x033, 0x00000024, + 0x03F, 0x0000002B, + 0x033, 0x00000025, + 0x03F, 0x0000002E, + 0x033, 0x00000026, + 0x03F, 0x0000006B, + 0x033, 0x00000027, + 0x03F, 0x0000006E, + 0x033, 0x00000028, + 0x03F, 0x00000071, + 0x033, 0x00000029, + 0x03F, 0x00000074, + 0x033, 0x0000002A, + 0x03F, 0x00000077, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000005, + 0x033, 0x00000021, + 0x03F, 0x00000008, + 0x033, 0x00000022, + 0x03F, 0x0000000B, + 0x033, 0x00000023, + 0x03F, 0x0000000E, + 0x033, 0x00000024, + 0x03F, 0x0000002B, + 0x033, 0x00000025, + 0x03F, 0x00000068, + 0x033, 0x00000026, + 0x03F, 0x0000006B, + 0x033, 0x00000027, + 0x03F, 0x0000006E, + 0x033, 0x00000028, + 0x03F, 0x00000071, + 0x033, 0x00000029, + 0x03F, 0x00000074, + 0x033, 0x0000002A, + 0x03F, 0x00000077, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x0000042B, + 0x033, 0x00000021, + 0x03F, 0x0000082A, + 0x033, 0x00000022, + 0x03F, 0x00000849, + 0x033, 0x00000023, + 0x03F, 0x0000084C, + 0x033, 0x00000024, + 0x03F, 0x00000C4C, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000CEB, + 0x033, 0x00000028, + 0x03F, 0x00000CEE, + 0x033, 0x00000029, + 0x03F, 0x00000CF1, + 0x033, 0x0000002A, + 0x03F, 0x00000CF4, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000005, + 0x033, 0x00000021, + 0x03F, 0x00000008, + 0x033, 0x00000022, + 0x03F, 0x0000000B, + 0x033, 0x00000023, + 0x03F, 0x0000000E, + 0x033, 0x00000024, + 0x03F, 0x0000002B, + 0x033, 0x00000025, + 0x03F, 0x00000068, + 0x033, 0x00000026, + 0x03F, 0x0000006B, + 0x033, 0x00000027, + 0x03F, 0x0000006E, + 0x033, 0x00000028, + 0x03F, 0x00000071, + 0x033, 0x00000029, + 0x03F, 0x00000074, + 0x033, 0x0000002A, + 0x03F, 0x00000077, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x0000042B, + 0x033, 0x00000021, + 0x03F, 0x0000082A, + 0x033, 0x00000022, + 0x03F, 0x00000849, + 0x033, 0x00000023, + 0x03F, 0x0000084C, + 0x033, 0x00000024, + 0x03F, 0x00000C4C, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000CEB, + 0x033, 0x00000028, + 0x03F, 0x00000CEE, + 0x033, 0x00000029, + 0x03F, 0x00000CF1, + 0x033, 0x0000002A, + 0x03F, 0x00000CF4, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000007, + 0x033, 0x00000021, + 0x03F, 0x0000000A, + 0x033, 0x00000022, + 0x03F, 0x0000000D, + 0x033, 0x00000023, + 0x03F, 0x0000002A, + 0x033, 0x00000024, + 0x03F, 0x0000002D, + 0x033, 0x00000025, + 0x03F, 0x00000030, + 0x033, 0x00000026, + 0x03F, 0x0000006D, + 0x033, 0x00000027, + 0x03F, 0x00000070, + 0x033, 0x00000028, + 0x03F, 0x000000ED, + 0x033, 0x00000029, + 0x03F, 0x000000F0, + 0x033, 0x0000002A, + 0x03F, 0x000000F3, + 0xA0000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000C09, + 0x033, 0x00000021, + 0x03F, 0x00000C0C, + 0x033, 0x00000022, + 0x03F, 0x00000C0F, + 0x033, 0x00000023, + 0x03F, 0x00000C2C, + 0x033, 0x00000024, + 0x03F, 0x00000C2F, + 0x033, 0x00000025, + 0x03F, 0x00000C8A, + 0x033, 0x00000026, + 0x03F, 0x00000C8D, + 0x033, 0x00000027, + 0x03F, 0x00000C90, + 0x033, 0x00000028, + 0x03F, 0x00000CD0, + 0x033, 0x00000029, + 0x03F, 0x00000CF2, + 0x033, 0x0000002A, + 0x03F, 0x00000CF5, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C2A, + 0x033, 0x00000063, + 0x03F, 0x00000C2D, + 0x033, 0x00000064, + 0x03F, 0x00000C6A, + 0x033, 0x00000065, + 0x03F, 0x00000CAA, + 0x033, 0x00000066, + 0x03F, 0x00000CAD, + 0x033, 0x00000067, + 0x03F, 0x00000CB0, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x0000002E, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000429, + 0x033, 0x00000061, + 0x03F, 0x00000828, + 0x033, 0x00000062, + 0x03F, 0x00000847, + 0x033, 0x00000063, + 0x03F, 0x0000084A, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000C6C, + 0x033, 0x00000066, + 0x03F, 0x00000C8D, + 0x033, 0x00000067, + 0x03F, 0x00000CAF, + 0x033, 0x00000068, + 0x03F, 0x00000CD1, + 0x033, 0x00000069, + 0x03F, 0x00000CF3, + 0x033, 0x0000006A, + 0x03F, 0x00000CF6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x0000002E, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x0000042A, + 0x033, 0x00000061, + 0x03F, 0x00000829, + 0x033, 0x00000062, + 0x03F, 0x00000848, + 0x033, 0x00000063, + 0x03F, 0x0000084B, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000C6C, + 0x033, 0x00000066, + 0x03F, 0x00000CAC, + 0x033, 0x00000067, + 0x03F, 0x00000CED, + 0x033, 0x00000068, + 0x03F, 0x00000CF0, + 0x033, 0x00000069, + 0x03F, 0x00000CF3, + 0x033, 0x0000006A, + 0x03F, 0x00000CF6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000842, + 0x033, 0x00000061, + 0x03F, 0x00000845, + 0x033, 0x00000062, + 0x03F, 0x00000866, + 0x033, 0x00000063, + 0x03F, 0x000008A6, + 0x033, 0x00000064, + 0x03F, 0x000008C8, + 0x033, 0x00000065, + 0x03F, 0x00000CE8, + 0x033, 0x00000066, + 0x03F, 0x00000CEB, + 0x033, 0x00000067, + 0x03F, 0x00000CEE, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C2A, + 0x033, 0x00000063, + 0x03F, 0x00000C2D, + 0x033, 0x00000064, + 0x03F, 0x00000C6A, + 0x033, 0x00000065, + 0x03F, 0x00000CAA, + 0x033, 0x00000066, + 0x03F, 0x00000CAD, + 0x033, 0x00000067, + 0x03F, 0x00000CB0, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C2A, + 0x033, 0x00000063, + 0x03F, 0x00000C2D, + 0x033, 0x00000064, + 0x03F, 0x00000C6A, + 0x033, 0x00000065, + 0x03F, 0x00000CAA, + 0x033, 0x00000066, + 0x03F, 0x00000CAD, + 0x033, 0x00000067, + 0x03F, 0x00000CB0, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x00000068, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000429, + 0x033, 0x00000061, + 0x03F, 0x00000828, + 0x033, 0x00000062, + 0x03F, 0x00000847, + 0x033, 0x00000063, + 0x03F, 0x0000084A, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000CE5, + 0x033, 0x00000066, + 0x03F, 0x00000CE8, + 0x033, 0x00000067, + 0x03F, 0x00000CEB, + 0x033, 0x00000068, + 0x03F, 0x00000CEE, + 0x033, 0x00000069, + 0x03F, 0x00000CF1, + 0x033, 0x0000006A, + 0x03F, 0x00000CF4, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C10, + 0x033, 0x00000063, + 0x03F, 0x00000C4A, + 0x033, 0x00000064, + 0x03F, 0x00000C4D, + 0x033, 0x00000065, + 0x03F, 0x00000CC9, + 0x033, 0x00000066, + 0x03F, 0x00000CEB, + 0x033, 0x00000067, + 0x03F, 0x00000CEE, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C2A, + 0x033, 0x00000063, + 0x03F, 0x00000C2D, + 0x033, 0x00000064, + 0x03F, 0x00000C6A, + 0x033, 0x00000065, + 0x03F, 0x00000CAA, + 0x033, 0x00000066, + 0x03F, 0x00000CAD, + 0x033, 0x00000067, + 0x03F, 0x00000CB0, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000429, + 0x033, 0x00000061, + 0x03F, 0x00000828, + 0x033, 0x00000062, + 0x03F, 0x00000847, + 0x033, 0x00000063, + 0x03F, 0x0000084A, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000C8A, + 0x033, 0x00000066, + 0x03F, 0x00000CEA, + 0x033, 0x00000067, + 0x03F, 0x00000CED, + 0x033, 0x00000068, + 0x03F, 0x00000CF0, + 0x033, 0x00000069, + 0x03F, 0x00000CF3, + 0x033, 0x0000006A, + 0x03F, 0x00000CF6, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000429, + 0x033, 0x00000061, + 0x03F, 0x00000828, + 0x033, 0x00000062, + 0x03F, 0x00000847, + 0x033, 0x00000063, + 0x03F, 0x0000084A, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000C6C, + 0x033, 0x00000066, + 0x03F, 0x00000C8D, + 0x033, 0x00000067, + 0x03F, 0x00000CAF, + 0x033, 0x00000068, + 0x03F, 0x00000CD1, + 0x033, 0x00000069, + 0x03F, 0x00000CF3, + 0x033, 0x0000006A, + 0x03F, 0x00000CF6, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000429, + 0x033, 0x00000061, + 0x03F, 0x00000828, + 0x033, 0x00000062, + 0x03F, 0x00000847, + 0x033, 0x00000063, + 0x03F, 0x0000084A, + 0x033, 0x00000064, + 0x03F, 0x00000C4B, + 0x033, 0x00000065, + 0x03F, 0x00000C6C, + 0x033, 0x00000066, + 0x03F, 0x00000C8D, + 0x033, 0x00000067, + 0x03F, 0x00000CAF, + 0x033, 0x00000068, + 0x03F, 0x00000CD1, + 0x033, 0x00000069, + 0x03F, 0x00000CF3, + 0x033, 0x0000006A, + 0x03F, 0x00000CF6, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x0000002E, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x00000068, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x0000042C, + 0x033, 0x00000061, + 0x03F, 0x0000082B, + 0x033, 0x00000062, + 0x03F, 0x0000084A, + 0x033, 0x00000063, + 0x03F, 0x0000084D, + 0x033, 0x00000064, + 0x03F, 0x00000C4E, + 0x033, 0x00000065, + 0x03F, 0x00000C8C, + 0x033, 0x00000066, + 0x03F, 0x00000C8F, + 0x033, 0x00000067, + 0x03F, 0x00000CEC, + 0x033, 0x00000068, + 0x03F, 0x00000CEF, + 0x033, 0x00000069, + 0x03F, 0x00000CF2, + 0x033, 0x0000006A, + 0x03F, 0x00000CF5, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000005, + 0x033, 0x00000061, + 0x03F, 0x00000008, + 0x033, 0x00000062, + 0x03F, 0x0000000B, + 0x033, 0x00000063, + 0x03F, 0x0000000E, + 0x033, 0x00000064, + 0x03F, 0x0000002B, + 0x033, 0x00000065, + 0x03F, 0x00000068, + 0x033, 0x00000066, + 0x03F, 0x0000006B, + 0x033, 0x00000067, + 0x03F, 0x0000006E, + 0x033, 0x00000068, + 0x03F, 0x00000071, + 0x033, 0x00000069, + 0x03F, 0x00000074, + 0x033, 0x0000006A, + 0x03F, 0x00000077, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x0000042C, + 0x033, 0x00000061, + 0x03F, 0x0000082B, + 0x033, 0x00000062, + 0x03F, 0x0000084A, + 0x033, 0x00000063, + 0x03F, 0x0000084D, + 0x033, 0x00000064, + 0x03F, 0x00000C4E, + 0x033, 0x00000065, + 0x03F, 0x00000C8C, + 0x033, 0x00000066, + 0x03F, 0x00000C8F, + 0x033, 0x00000067, + 0x03F, 0x00000CEC, + 0x033, 0x00000068, + 0x03F, 0x00000CEF, + 0x033, 0x00000069, + 0x03F, 0x00000CF2, + 0x033, 0x0000006A, + 0x03F, 0x00000CF5, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000007, + 0x033, 0x00000061, + 0x03F, 0x0000000A, + 0x033, 0x00000062, + 0x03F, 0x0000000D, + 0x033, 0x00000063, + 0x03F, 0x0000002A, + 0x033, 0x00000064, + 0x03F, 0x0000002D, + 0x033, 0x00000065, + 0x03F, 0x00000030, + 0x033, 0x00000066, + 0x03F, 0x0000006D, + 0x033, 0x00000067, + 0x03F, 0x00000070, + 0x033, 0x00000068, + 0x03F, 0x000000ED, + 0x033, 0x00000069, + 0x03F, 0x000000F0, + 0x033, 0x0000006A, + 0x03F, 0x000000F3, + 0xA0000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000C0A, + 0x033, 0x00000061, + 0x03F, 0x00000C0D, + 0x033, 0x00000062, + 0x03F, 0x00000C2A, + 0x033, 0x00000063, + 0x03F, 0x00000C2D, + 0x033, 0x00000064, + 0x03F, 0x00000C6A, + 0x033, 0x00000065, + 0x03F, 0x00000CAA, + 0x033, 0x00000066, + 0x03F, 0x00000CAD, + 0x033, 0x00000067, + 0x03F, 0x00000CB0, + 0x033, 0x00000068, + 0x03F, 0x00000CF1, + 0x033, 0x00000069, + 0x03F, 0x00000CF4, + 0x033, 0x0000006A, + 0x03F, 0x00000CF7, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C09, + 0x033, 0x000000A1, + 0x03F, 0x00000C0C, + 0x033, 0x000000A2, + 0x03F, 0x00000C0F, + 0x033, 0x000000A3, + 0x03F, 0x00000C2C, + 0x033, 0x000000A4, + 0x03F, 0x00000C2F, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000C90, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000005, + 0x033, 0x000000A1, + 0x03F, 0x00000008, + 0x033, 0x000000A2, + 0x03F, 0x0000000B, + 0x033, 0x000000A3, + 0x03F, 0x0000000E, + 0x033, 0x000000A4, + 0x03F, 0x0000002B, + 0x033, 0x000000A5, + 0x03F, 0x0000002E, + 0x033, 0x000000A6, + 0x03F, 0x00000031, + 0x033, 0x000000A7, + 0x03F, 0x00000034, + 0x033, 0x000000A8, + 0x03F, 0x00000053, + 0x033, 0x000000A9, + 0x03F, 0x00000056, + 0x033, 0x000000AA, + 0x03F, 0x000000D1, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x00000C4B, + 0x033, 0x000000A5, + 0x03F, 0x00000C6C, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000CAF, + 0x033, 0x000000A8, + 0x03F, 0x00000CD1, + 0x033, 0x000000A9, + 0x03F, 0x00000CF3, + 0x033, 0x000000AA, + 0x03F, 0x00000CF6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000005, + 0x033, 0x000000A1, + 0x03F, 0x00000008, + 0x033, 0x000000A2, + 0x03F, 0x0000000B, + 0x033, 0x000000A3, + 0x03F, 0x0000000E, + 0x033, 0x000000A4, + 0x03F, 0x0000002B, + 0x033, 0x000000A5, + 0x03F, 0x0000002E, + 0x033, 0x000000A6, + 0x03F, 0x00000031, + 0x033, 0x000000A7, + 0x03F, 0x00000034, + 0x033, 0x000000A8, + 0x03F, 0x00000053, + 0x033, 0x000000A9, + 0x03F, 0x00000056, + 0x033, 0x000000AA, + 0x03F, 0x000000D1, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x0000042A, + 0x033, 0x000000A1, + 0x03F, 0x00000829, + 0x033, 0x000000A2, + 0x03F, 0x00000848, + 0x033, 0x000000A3, + 0x03F, 0x0000084B, + 0x033, 0x000000A4, + 0x03F, 0x00000C4C, + 0x033, 0x000000A5, + 0x03F, 0x00000C6C, + 0x033, 0x000000A6, + 0x03F, 0x00000CAC, + 0x033, 0x000000A7, + 0x03F, 0x00000CED, + 0x033, 0x000000A8, + 0x03F, 0x00000CF0, + 0x033, 0x000000A9, + 0x03F, 0x00000CF3, + 0x033, 0x000000AA, + 0x03F, 0x00000CF6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x93000008, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000826, + 0x033, 0x000000A1, + 0x03F, 0x00000829, + 0x033, 0x000000A2, + 0x03F, 0x0000082C, + 0x033, 0x000000A3, + 0x03F, 0x0000082F, + 0x033, 0x000000A4, + 0x03F, 0x0000086C, + 0x033, 0x000000A5, + 0x03F, 0x00000CE8, + 0x033, 0x000000A6, + 0x03F, 0x00000CEB, + 0x033, 0x000000A7, + 0x03F, 0x00000CEE, + 0x033, 0x000000A8, + 0x03F, 0x00000CF1, + 0x033, 0x000000A9, + 0x03F, 0x00000CF4, + 0x033, 0x000000AA, + 0x03F, 0x00000CF7, + 0x93000009, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C09, + 0x033, 0x000000A1, + 0x03F, 0x00000C0C, + 0x033, 0x000000A2, + 0x03F, 0x00000C0F, + 0x033, 0x000000A3, + 0x03F, 0x00000C2C, + 0x033, 0x000000A4, + 0x03F, 0x00000C2F, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000C90, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x9300000a, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C09, + 0x033, 0x000000A1, + 0x03F, 0x00000C0C, + 0x033, 0x000000A2, + 0x03F, 0x00000C0F, + 0x033, 0x000000A3, + 0x03F, 0x00000C2C, + 0x033, 0x000000A4, + 0x03F, 0x00000C2F, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000C90, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x00000C4B, + 0x033, 0x000000A5, + 0x03F, 0x00000CE5, + 0x033, 0x000000A6, + 0x03F, 0x00000CE8, + 0x033, 0x000000A7, + 0x03F, 0x00000CEB, + 0x033, 0x000000A8, + 0x03F, 0x00000CEE, + 0x033, 0x000000A9, + 0x03F, 0x00000CF1, + 0x033, 0x000000AA, + 0x03F, 0x00000CF4, + 0x9300000d, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x0000080A, + 0x033, 0x000000A1, + 0x03F, 0x0000080D, + 0x033, 0x000000A2, + 0x03F, 0x00000810, + 0x033, 0x000000A3, + 0x03F, 0x00000868, + 0x033, 0x000000A4, + 0x03F, 0x00000C68, + 0x033, 0x000000A5, + 0x03F, 0x00000C6B, + 0x033, 0x000000A6, + 0x03F, 0x00000CAB, + 0x033, 0x000000A7, + 0x03F, 0x00000CAE, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x9300000e, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C08, + 0x033, 0x000000A1, + 0x03F, 0x00000C0B, + 0x033, 0x000000A2, + 0x03F, 0x00000C0E, + 0x033, 0x000000A3, + 0x03F, 0x00000C2B, + 0x033, 0x000000A4, + 0x03F, 0x00000C2E, + 0x033, 0x000000A5, + 0x03F, 0x00000C31, + 0x033, 0x000000A6, + 0x03F, 0x00000CAB, + 0x033, 0x000000A7, + 0x03F, 0x00000CAE, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x00000C4B, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000CEA, + 0x033, 0x000000A7, + 0x03F, 0x00000CED, + 0x033, 0x000000A8, + 0x03F, 0x00000CF0, + 0x033, 0x000000A9, + 0x03F, 0x00000CF3, + 0x033, 0x000000AA, + 0x03F, 0x00000CF6, + 0x93000010, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x00000C4B, + 0x033, 0x000000A5, + 0x03F, 0x00000C6C, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000CAF, + 0x033, 0x000000A8, + 0x03F, 0x00000CD1, + 0x033, 0x000000A9, + 0x03F, 0x00000CF3, + 0x033, 0x000000AA, + 0x03F, 0x00000CF6, + 0x93000011, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000429, + 0x033, 0x000000A1, + 0x03F, 0x00000828, + 0x033, 0x000000A2, + 0x03F, 0x00000847, + 0x033, 0x000000A3, + 0x03F, 0x0000084A, + 0x033, 0x000000A4, + 0x03F, 0x00000C4B, + 0x033, 0x000000A5, + 0x03F, 0x00000C6C, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000CAF, + 0x033, 0x000000A8, + 0x03F, 0x00000CD1, + 0x033, 0x000000A9, + 0x03F, 0x00000CF3, + 0x033, 0x000000AA, + 0x03F, 0x00000CF6, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000005, + 0x033, 0x000000A1, + 0x03F, 0x00000008, + 0x033, 0x000000A2, + 0x03F, 0x0000000B, + 0x033, 0x000000A3, + 0x03F, 0x0000000E, + 0x033, 0x000000A4, + 0x03F, 0x0000002B, + 0x033, 0x000000A5, + 0x03F, 0x0000002E, + 0x033, 0x000000A6, + 0x03F, 0x00000031, + 0x033, 0x000000A7, + 0x03F, 0x00000034, + 0x033, 0x000000A8, + 0x03F, 0x00000053, + 0x033, 0x000000A9, + 0x03F, 0x00000056, + 0x033, 0x000000AA, + 0x03F, 0x000000D1, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x90000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000005, + 0x033, 0x000000A1, + 0x03F, 0x00000008, + 0x033, 0x000000A2, + 0x03F, 0x0000000B, + 0x033, 0x000000A3, + 0x03F, 0x0000000E, + 0x033, 0x000000A4, + 0x03F, 0x00000047, + 0x033, 0x000000A5, + 0x03F, 0x0000004A, + 0x033, 0x000000A6, + 0x03F, 0x0000004D, + 0x033, 0x000000A7, + 0x03F, 0x00000050, + 0x033, 0x000000A8, + 0x03F, 0x00000053, + 0x033, 0x000000A9, + 0x03F, 0x00000056, + 0x033, 0x000000AA, + 0x03F, 0x00000094, + 0x90000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x0000042A, + 0x033, 0x000000A1, + 0x03F, 0x00000829, + 0x033, 0x000000A2, + 0x03F, 0x00000848, + 0x033, 0x000000A3, + 0x03F, 0x0000084B, + 0x033, 0x000000A4, + 0x03F, 0x00000C4C, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000CEC, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000005, + 0x033, 0x000000A1, + 0x03F, 0x00000008, + 0x033, 0x000000A2, + 0x03F, 0x0000000B, + 0x033, 0x000000A3, + 0x03F, 0x0000000E, + 0x033, 0x000000A4, + 0x03F, 0x00000047, + 0x033, 0x000000A5, + 0x03F, 0x0000004A, + 0x033, 0x000000A6, + 0x03F, 0x0000004D, + 0x033, 0x000000A7, + 0x03F, 0x00000050, + 0x033, 0x000000A8, + 0x03F, 0x00000053, + 0x033, 0x000000A9, + 0x03F, 0x00000056, + 0x033, 0x000000AA, + 0x03F, 0x00000094, + 0x90000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x0000042A, + 0x033, 0x000000A1, + 0x03F, 0x00000829, + 0x033, 0x000000A2, + 0x03F, 0x00000848, + 0x033, 0x000000A3, + 0x03F, 0x0000084B, + 0x033, 0x000000A4, + 0x03F, 0x00000C4C, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000CEC, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000007, + 0x033, 0x000000A1, + 0x03F, 0x0000000A, + 0x033, 0x000000A2, + 0x03F, 0x0000000D, + 0x033, 0x000000A3, + 0x03F, 0x0000002A, + 0x033, 0x000000A4, + 0x03F, 0x0000002D, + 0x033, 0x000000A5, + 0x03F, 0x00000030, + 0x033, 0x000000A6, + 0x03F, 0x0000006D, + 0x033, 0x000000A7, + 0x03F, 0x00000070, + 0x033, 0x000000A8, + 0x03F, 0x000000ED, + 0x033, 0x000000A9, + 0x03F, 0x000000F0, + 0x033, 0x000000AA, + 0x03F, 0x000000F3, + 0xA0000000, 0x00000000, + 0x033, 0x000000A0, + 0x03F, 0x00000C09, + 0x033, 0x000000A1, + 0x03F, 0x00000C0C, + 0x033, 0x000000A2, + 0x03F, 0x00000C0F, + 0x033, 0x000000A3, + 0x03F, 0x00000C2C, + 0x033, 0x000000A4, + 0x03F, 0x00000C2F, + 0x033, 0x000000A5, + 0x03F, 0x00000C8A, + 0x033, 0x000000A6, + 0x03F, 0x00000C8D, + 0x033, 0x000000A7, + 0x03F, 0x00000C90, + 0x033, 0x000000A8, + 0x03F, 0x00000CEF, + 0x033, 0x000000A9, + 0x03F, 0x00000CF2, + 0x033, 0x000000AA, + 0x03F, 0x00000CF5, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000400, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000265A, + 0x033, 0x00000001, + 0x03F, 0x0000265A, + 0x033, 0x00000002, + 0x03F, 0x0000265A, + 0x033, 0x00000003, + 0x03F, 0x0000265A, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000265A, + 0x033, 0x00000001, + 0x03F, 0x0000265A, + 0x033, 0x00000002, + 0x03F, 0x0000265A, + 0x033, 0x00000003, + 0x03F, 0x0000265A, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000265A, + 0x033, 0x00000001, + 0x03F, 0x0000265A, + 0x033, 0x00000002, + 0x03F, 0x0000265A, + 0x033, 0x00000003, + 0x03F, 0x0000265A, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000265A, + 0x033, 0x00000001, + 0x03F, 0x0000265A, + 0x033, 0x00000002, + 0x03F, 0x0000265A, + 0x033, 0x00000003, + 0x03F, 0x0000265A, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000265A, + 0x033, 0x00000001, + 0x03F, 0x0000265A, + 0x033, 0x00000002, + 0x03F, 0x0000265A, + 0x033, 0x00000003, + 0x03F, 0x0000265A, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x000004FB, + 0x033, 0x00000001, + 0x03F, 0x000004FB, + 0x033, 0x00000002, + 0x03F, 0x000004FB, + 0x033, 0x00000003, + 0x03F, 0x000004FB, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000265A, + 0x033, 0x00000001, + 0x03F, 0x0000265A, + 0x033, 0x00000002, + 0x03F, 0x0000265A, + 0x033, 0x00000003, + 0x03F, 0x0000265A, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000265A, + 0x033, 0x00000001, + 0x03F, 0x0000265A, + 0x033, 0x00000002, + 0x03F, 0x0000265A, + 0x033, 0x00000003, + 0x03F, 0x0000265A, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000265A, + 0x033, 0x00000001, + 0x03F, 0x0000265A, + 0x033, 0x00000002, + 0x03F, 0x0000265A, + 0x033, 0x00000003, + 0x03F, 0x0000265A, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000265A, + 0x033, 0x00000001, + 0x03F, 0x0000265A, + 0x033, 0x00000002, + 0x03F, 0x0000265A, + 0x033, 0x00000003, + 0x03F, 0x0000265A, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0000265A, + 0x033, 0x00000001, + 0x03F, 0x0000265A, + 0x033, 0x00000002, + 0x03F, 0x0000265A, + 0x033, 0x00000003, + 0x03F, 0x0000265A, + 0xA0000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x000004BB, + 0x033, 0x00000001, + 0x03F, 0x000004BB, + 0x033, 0x00000002, + 0x03F, 0x000004BB, + 0x033, 0x00000003, + 0x03F, 0x000004BB, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000100, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000745, + 0x033, 0x00000001, + 0x03F, 0x00000745, + 0x033, 0x00000002, + 0x03F, 0x00000745, + 0x033, 0x00000003, + 0x03F, 0x00000745, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000745, + 0x033, 0x00000001, + 0x03F, 0x00000745, + 0x033, 0x00000002, + 0x03F, 0x00000745, + 0x033, 0x00000003, + 0x03F, 0x00000745, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000745, + 0x033, 0x00000001, + 0x03F, 0x00000745, + 0x033, 0x00000002, + 0x03F, 0x00000745, + 0x033, 0x00000003, + 0x03F, 0x00000745, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000745, + 0x033, 0x00000001, + 0x03F, 0x00000745, + 0x033, 0x00000002, + 0x03F, 0x00000745, + 0x033, 0x00000003, + 0x03F, 0x00000745, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000745, + 0x033, 0x00000001, + 0x03F, 0x00000745, + 0x033, 0x00000002, + 0x03F, 0x00000745, + 0x033, 0x00000003, + 0x03F, 0x00000745, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000745, + 0x033, 0x00000001, + 0x03F, 0x00000745, + 0x033, 0x00000002, + 0x03F, 0x00000745, + 0x033, 0x00000003, + 0x03F, 0x00000745, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000745, + 0x033, 0x00000001, + 0x03F, 0x00000745, + 0x033, 0x00000002, + 0x03F, 0x00000745, + 0x033, 0x00000003, + 0x03F, 0x00000745, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000745, + 0x033, 0x00000001, + 0x03F, 0x00000745, + 0x033, 0x00000002, + 0x03F, 0x00000745, + 0x033, 0x00000003, + 0x03F, 0x00000745, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000745, + 0x033, 0x00000001, + 0x03F, 0x00000745, + 0x033, 0x00000002, + 0x03F, 0x00000745, + 0x033, 0x00000003, + 0x03F, 0x00000745, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000745, + 0x033, 0x00000001, + 0x03F, 0x00000745, + 0x033, 0x00000002, + 0x03F, 0x00000745, + 0x033, 0x00000003, + 0x03F, 0x00000745, + 0xA0000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000F34, + 0x033, 0x00000001, + 0x03F, 0x00000F34, + 0x033, 0x00000002, + 0x03F, 0x00000F34, + 0x033, 0x00000003, + 0x03F, 0x00000F34, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x081, 0x0000F400, + 0x087, 0x00016040, + 0x051, 0x00000808, + 0x052, 0x00098002, + 0x053, 0x0000FA47, + 0x054, 0x00058032, + 0x056, 0x00051000, + 0x057, 0x0000CE0A, + 0x058, 0x00082030, + 0xA0000000, 0x00000000, + 0x081, 0x0000F000, + 0x087, 0x00016040, + 0x051, 0x00000C00, + 0x052, 0x0007C241, + 0x053, 0x0001C069, + 0x054, 0x00078032, + 0x057, 0x0000CE0A, + 0x058, 0x00058750, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000800, + 0x83000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000002, + 0x033, 0x00000001, + 0x03F, 0x00000005, + 0x033, 0x00000002, + 0x03F, 0x00000008, + 0x033, 0x00000003, + 0x03F, 0x0000000B, + 0x033, 0x00000004, + 0x03F, 0x0000000E, + 0x033, 0x00000005, + 0x03F, 0x0000002B, + 0x033, 0x00000006, + 0x03F, 0x0000002E, + 0x033, 0x00000007, + 0x03F, 0x00000031, + 0x033, 0x00000008, + 0x03F, 0x0000006E, + 0x033, 0x00000009, + 0x03F, 0x00000071, + 0x033, 0x0000000A, + 0x03F, 0x00000074, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x93000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x9300000b, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x9300000c, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0005142C, + 0x033, 0x00000001, + 0x03F, 0x0005142F, + 0x033, 0x00000002, + 0x03F, 0x00051432, + 0x033, 0x00000003, + 0x03F, 0x00051CA5, + 0x033, 0x00000004, + 0x03F, 0x00051CA8, + 0x033, 0x00000005, + 0x03F, 0x00051CAB, + 0x033, 0x00000006, + 0x03F, 0x00051CEB, + 0x033, 0x00000007, + 0x03F, 0x00051CEE, + 0x033, 0x00000008, + 0x03F, 0x00051CF1, + 0x033, 0x00000009, + 0x03F, 0x00051CF4, + 0x033, 0x0000000A, + 0x03F, 0x00051CF7, + 0x9300000f, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0005142C, + 0x033, 0x00000001, + 0x03F, 0x0005144B, + 0x033, 0x00000002, + 0x03F, 0x00051868, + 0x033, 0x00000003, + 0x03F, 0x0005186B, + 0x033, 0x00000004, + 0x03F, 0x0005186E, + 0x033, 0x00000005, + 0x03F, 0x00051871, + 0x033, 0x00000006, + 0x03F, 0x00051874, + 0x033, 0x00000007, + 0x03F, 0x00051895, + 0x033, 0x00000008, + 0x03F, 0x000518B6, + 0x033, 0x00000009, + 0x03F, 0x000518F6, + 0x033, 0x0000000A, + 0x03F, 0x00051CF7, + 0x93000012, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000002, + 0x033, 0x00000001, + 0x03F, 0x00000005, + 0x033, 0x00000002, + 0x03F, 0x00000008, + 0x033, 0x00000003, + 0x03F, 0x0000000B, + 0x033, 0x00000004, + 0x03F, 0x0000000E, + 0x033, 0x00000005, + 0x03F, 0x0000002B, + 0x033, 0x00000006, + 0x03F, 0x0000002E, + 0x033, 0x00000007, + 0x03F, 0x00000031, + 0x033, 0x00000008, + 0x03F, 0x0000006E, + 0x033, 0x00000009, + 0x03F, 0x00000071, + 0x033, 0x0000000A, + 0x03F, 0x00000074, + 0x90000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x90000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x90000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0x90000007, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x00000003, + 0x033, 0x00000001, + 0x03F, 0x00000006, + 0x033, 0x00000002, + 0x03F, 0x00000009, + 0x033, 0x00000003, + 0x03F, 0x00000026, + 0x033, 0x00000004, + 0x03F, 0x00000029, + 0x033, 0x00000005, + 0x03F, 0x0000002C, + 0x033, 0x00000006, + 0x03F, 0x0000002F, + 0x033, 0x00000007, + 0x03F, 0x00000033, + 0x033, 0x00000008, + 0x03F, 0x00000036, + 0x033, 0x00000009, + 0x03F, 0x00000039, + 0x033, 0x0000000A, + 0x03F, 0x0000003C, + 0xA0000000, 0x00000000, + 0x033, 0x00000000, + 0x03F, 0x0005142C, + 0x033, 0x00000001, + 0x03F, 0x0005142F, + 0x033, 0x00000002, + 0x03F, 0x00051432, + 0x033, 0x00000003, + 0x03F, 0x00051C87, + 0x033, 0x00000004, + 0x03F, 0x00051C8A, + 0x033, 0x00000005, + 0x03F, 0x00051C8D, + 0x033, 0x00000006, + 0x03F, 0x00051CEB, + 0x033, 0x00000007, + 0x03F, 0x00051CEE, + 0x033, 0x00000008, + 0x03F, 0x00051CF1, + 0x033, 0x00000009, + 0x03F, 0x00051CF4, + 0x033, 0x0000000A, + 0x03F, 0x00051CF7, + 0xB0000000, 0x00000000, + 0x8300000c, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000010, + 0x033, 0x00000000, + 0x008, 0x0009C060, + 0x033, 0x00000001, + 0x008, 0x0009C060, + 0x0EF, 0x00000000, + 0x033, 0x000000A2, + 0x0EF, 0x00080000, + 0x03E, 0x0000593F, + 0x8300000c, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000D0F4F, + 0xA0000000, 0x00000000, + 0x03F, 0x000C0F4F, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x033, 0x000000A3, + 0x0EF, 0x00080000, + 0x03E, 0x00005934, + 0x03F, 0x0005AFCF, + 0x0EF, 0x00000000, +}; + +RTW_DECL_TABLE_RF_RADIO(rtw8822b_rf_b, B); + +static const struct rtw_txpwr_lmt_cfg_pair rtw8822b_txpwr_lmt_type0[] = { + { 0, 0, 0, 0, 1, 32, }, + { 2, 0, 0, 0, 1, 28, }, + { 1, 0, 0, 0, 1, 30, }, + { 0, 0, 0, 0, 2, 32, }, + { 2, 0, 0, 0, 2, 28, }, + { 1, 0, 0, 0, 2, 30, }, + { 0, 0, 0, 0, 3, 32, }, + { 2, 0, 0, 0, 3, 28, }, + { 1, 0, 0, 0, 3, 30, }, + { 0, 0, 0, 0, 4, 32, }, + { 2, 0, 0, 0, 4, 28, }, + { 1, 0, 0, 0, 4, 30, }, + { 0, 0, 0, 0, 5, 32, }, + { 2, 0, 0, 0, 5, 28, }, + { 1, 0, 0, 0, 5, 30, }, + { 0, 0, 0, 0, 6, 32, }, + { 2, 0, 0, 0, 6, 28, }, + { 1, 0, 0, 0, 6, 30, }, + { 0, 0, 0, 0, 7, 32, }, + { 2, 0, 0, 0, 7, 28, }, + { 1, 0, 0, 0, 7, 30, }, + { 0, 0, 0, 0, 8, 32, }, + { 2, 0, 0, 0, 8, 28, }, + { 1, 0, 0, 0, 8, 30, }, + { 0, 0, 0, 0, 9, 32, }, + { 2, 0, 0, 0, 9, 28, }, + { 1, 0, 0, 0, 9, 30, }, + { 0, 0, 0, 0, 10, 32, }, + { 2, 0, 0, 0, 10, 28, }, + { 1, 0, 0, 0, 10, 30, }, + { 0, 0, 0, 0, 11, 32, }, + { 2, 0, 0, 0, 11, 28, }, + { 1, 0, 0, 0, 11, 30, }, + { 0, 0, 0, 0, 12, 26, }, + { 2, 0, 0, 0, 12, 28, }, + { 1, 0, 0, 0, 12, 30, }, + { 0, 0, 0, 0, 13, 20, }, + { 2, 0, 0, 0, 13, 28, }, + { 1, 0, 0, 0, 13, 28, }, + { 0, 0, 0, 0, 14, 63, }, + { 2, 0, 0, 0, 14, 63, }, + { 1, 0, 0, 0, 14, 32, }, + { 0, 0, 0, 1, 1, 26, }, + { 2, 0, 0, 1, 1, 30, }, + { 1, 0, 0, 1, 1, 34, }, + { 0, 0, 0, 1, 2, 30, }, + { 2, 0, 0, 1, 2, 30, }, + { 1, 0, 0, 1, 2, 34, }, + { 0, 0, 0, 1, 3, 32, }, + { 2, 0, 0, 1, 3, 30, }, + { 1, 0, 0, 1, 3, 34, }, + { 0, 0, 0, 1, 4, 34, }, + { 2, 0, 0, 1, 4, 30, }, + { 1, 0, 0, 1, 4, 34, }, + { 0, 0, 0, 1, 5, 34, }, + { 2, 0, 0, 1, 5, 30, }, + { 1, 0, 0, 1, 5, 34, }, + { 0, 0, 0, 1, 6, 34, }, + { 2, 0, 0, 1, 6, 30, }, + { 1, 0, 0, 1, 6, 34, }, + { 0, 0, 0, 1, 7, 34, }, + { 2, 0, 0, 1, 7, 30, }, + { 1, 0, 0, 1, 7, 34, }, + { 0, 0, 0, 1, 8, 34, }, + { 2, 0, 0, 1, 8, 30, }, + { 1, 0, 0, 1, 8, 34, }, + { 0, 0, 0, 1, 9, 32, }, + { 2, 0, 0, 1, 9, 30, }, + { 1, 0, 0, 1, 9, 34, }, + { 0, 0, 0, 1, 10, 30, }, + { 2, 0, 0, 1, 10, 30, }, + { 1, 0, 0, 1, 10, 34, }, + { 0, 0, 0, 1, 11, 28, }, + { 2, 0, 0, 1, 11, 30, }, + { 1, 0, 0, 1, 11, 34, }, + { 0, 0, 0, 1, 12, 22, }, + { 2, 0, 0, 1, 12, 30, }, + { 1, 0, 0, 1, 12, 34, }, + { 0, 0, 0, 1, 13, 14, }, + { 2, 0, 0, 1, 13, 30, }, + { 1, 0, 0, 1, 13, 34, }, + { 0, 0, 0, 1, 14, 63, }, + { 2, 0, 0, 1, 14, 63, }, + { 1, 0, 0, 1, 14, 63, }, + { 0, 0, 0, 2, 1, 26, }, + { 2, 0, 0, 2, 1, 30, }, + { 1, 0, 0, 2, 1, 34, }, + { 0, 0, 0, 2, 2, 30, }, + { 2, 0, 0, 2, 2, 30, }, + { 1, 0, 0, 2, 2, 34, }, + { 0, 0, 0, 2, 3, 32, }, + { 2, 0, 0, 2, 3, 30, }, + { 1, 0, 0, 2, 3, 34, }, + { 0, 0, 0, 2, 4, 34, }, + { 2, 0, 0, 2, 4, 30, }, + { 1, 0, 0, 2, 4, 34, }, + { 0, 0, 0, 2, 5, 34, }, + { 2, 0, 0, 2, 5, 30, }, + { 1, 0, 0, 2, 5, 34, }, + { 0, 0, 0, 2, 6, 34, }, + { 2, 0, 0, 2, 6, 30, }, + { 1, 0, 0, 2, 6, 34, }, + { 0, 0, 0, 2, 7, 34, }, + { 2, 0, 0, 2, 7, 30, }, + { 1, 0, 0, 2, 7, 34, }, + { 0, 0, 0, 2, 8, 34, }, + { 2, 0, 0, 2, 8, 30, }, + { 1, 0, 0, 2, 8, 34, }, + { 0, 0, 0, 2, 9, 32, }, + { 2, 0, 0, 2, 9, 30, }, + { 1, 0, 0, 2, 9, 34, }, + { 0, 0, 0, 2, 10, 30, }, + { 2, 0, 0, 2, 10, 30, }, + { 1, 0, 0, 2, 10, 34, }, + { 0, 0, 0, 2, 11, 26, }, + { 2, 0, 0, 2, 11, 30, }, + { 1, 0, 0, 2, 11, 34, }, + { 0, 0, 0, 2, 12, 20, }, + { 2, 0, 0, 2, 12, 30, }, + { 1, 0, 0, 2, 12, 34, }, + { 0, 0, 0, 2, 13, 14, }, + { 2, 0, 0, 2, 13, 30, }, + { 1, 0, 0, 2, 13, 34, }, + { 0, 0, 0, 2, 14, 63, }, + { 2, 0, 0, 2, 14, 63, }, + { 1, 0, 0, 2, 14, 63, }, + { 0, 0, 0, 3, 1, 26, }, + { 2, 0, 0, 3, 1, 18, }, + { 1, 0, 0, 3, 1, 30, }, + { 0, 0, 0, 3, 2, 28, }, + { 2, 0, 0, 3, 2, 18, }, + { 1, 0, 0, 3, 2, 30, }, + { 0, 0, 0, 3, 3, 30, }, + { 2, 0, 0, 3, 3, 18, }, + { 1, 0, 0, 3, 3, 30, }, + { 0, 0, 0, 3, 4, 30, }, + { 2, 0, 0, 3, 4, 18, }, + { 1, 0, 0, 3, 4, 30, }, + { 0, 0, 0, 3, 5, 32, }, + { 2, 0, 0, 3, 5, 18, }, + { 1, 0, 0, 3, 5, 30, }, + { 0, 0, 0, 3, 6, 32, }, + { 2, 0, 0, 3, 6, 18, }, + { 1, 0, 0, 3, 6, 30, }, + { 0, 0, 0, 3, 7, 32, }, + { 2, 0, 0, 3, 7, 18, }, + { 1, 0, 0, 3, 7, 30, }, + { 0, 0, 0, 3, 8, 30, }, + { 2, 0, 0, 3, 8, 18, }, + { 1, 0, 0, 3, 8, 30, }, + { 0, 0, 0, 3, 9, 30, }, + { 2, 0, 0, 3, 9, 18, }, + { 1, 0, 0, 3, 9, 30, }, + { 0, 0, 0, 3, 10, 28, }, + { 2, 0, 0, 3, 10, 18, }, + { 1, 0, 0, 3, 10, 30, }, + { 0, 0, 0, 3, 11, 26, }, + { 2, 0, 0, 3, 11, 18, }, + { 1, 0, 0, 3, 11, 30, }, + { 0, 0, 0, 3, 12, 20, }, + { 2, 0, 0, 3, 12, 18, }, + { 1, 0, 0, 3, 12, 30, }, + { 0, 0, 0, 3, 13, 14, }, + { 2, 0, 0, 3, 13, 18, }, + { 1, 0, 0, 3, 13, 30, }, + { 0, 0, 0, 3, 14, 63, }, + { 2, 0, 0, 3, 14, 63, }, + { 1, 0, 0, 3, 14, 63, }, + { 0, 0, 1, 2, 1, 63, }, + { 2, 0, 1, 2, 1, 63, }, + { 1, 0, 1, 2, 1, 63, }, + { 0, 0, 1, 2, 2, 63, }, + { 2, 0, 1, 2, 2, 63, }, + { 1, 0, 1, 2, 2, 63, }, + { 0, 0, 1, 2, 3, 26, }, + { 2, 0, 1, 2, 3, 30, }, + { 1, 0, 1, 2, 3, 34, }, + { 0, 0, 1, 2, 4, 26, }, + { 2, 0, 1, 2, 4, 30, }, + { 1, 0, 1, 2, 4, 34, }, + { 0, 0, 1, 2, 5, 30, }, + { 2, 0, 1, 2, 5, 30, }, + { 1, 0, 1, 2, 5, 34, }, + { 0, 0, 1, 2, 6, 32, }, + { 2, 0, 1, 2, 6, 30, }, + { 1, 0, 1, 2, 6, 34, }, + { 0, 0, 1, 2, 7, 30, }, + { 2, 0, 1, 2, 7, 30, }, + { 1, 0, 1, 2, 7, 34, }, + { 0, 0, 1, 2, 8, 26, }, + { 2, 0, 1, 2, 8, 30, }, + { 1, 0, 1, 2, 8, 34, }, + { 0, 0, 1, 2, 9, 26, }, + { 2, 0, 1, 2, 9, 30, }, + { 1, 0, 1, 2, 9, 34, }, + { 0, 0, 1, 2, 10, 20, }, + { 2, 0, 1, 2, 10, 30, }, + { 1, 0, 1, 2, 10, 34, }, + { 0, 0, 1, 2, 11, 14, }, + { 2, 0, 1, 2, 11, 30, }, + { 1, 0, 1, 2, 11, 34, }, + { 0, 0, 1, 2, 12, 63, }, + { 2, 0, 1, 2, 12, 63, }, + { 1, 0, 1, 2, 12, 63, }, + { 0, 0, 1, 2, 13, 63, }, + { 2, 0, 1, 2, 13, 63, }, + { 1, 0, 1, 2, 13, 63, }, + { 0, 0, 1, 2, 14, 63, }, + { 2, 0, 1, 2, 14, 63, }, + { 1, 0, 1, 2, 14, 63, }, + { 0, 0, 1, 3, 1, 63, }, + { 2, 0, 1, 3, 1, 63, }, + { 1, 0, 1, 3, 1, 63, }, + { 0, 0, 1, 3, 2, 63, }, + { 2, 0, 1, 3, 2, 63, }, + { 1, 0, 1, 3, 2, 63, }, + { 0, 0, 1, 3, 3, 24, }, + { 2, 0, 1, 3, 3, 18, }, + { 1, 0, 1, 3, 3, 30, }, + { 0, 0, 1, 3, 4, 24, }, + { 2, 0, 1, 3, 4, 18, }, + { 1, 0, 1, 3, 4, 30, }, + { 0, 0, 1, 3, 5, 26, }, + { 2, 0, 1, 3, 5, 18, }, + { 1, 0, 1, 3, 5, 30, }, + { 0, 0, 1, 3, 6, 28, }, + { 2, 0, 1, 3, 6, 18, }, + { 1, 0, 1, 3, 6, 30, }, + { 0, 0, 1, 3, 7, 26, }, + { 2, 0, 1, 3, 7, 18, }, + { 1, 0, 1, 3, 7, 30, }, + { 0, 0, 1, 3, 8, 26, }, + { 2, 0, 1, 3, 8, 18, }, + { 1, 0, 1, 3, 8, 30, }, + { 0, 0, 1, 3, 9, 26, }, + { 2, 0, 1, 3, 9, 18, }, + { 1, 0, 1, 3, 9, 30, }, + { 0, 0, 1, 3, 10, 20, }, + { 2, 0, 1, 3, 10, 18, }, + { 1, 0, 1, 3, 10, 30, }, + { 0, 0, 1, 3, 11, 14, }, + { 2, 0, 1, 3, 11, 18, }, + { 1, 0, 1, 3, 11, 30, }, + { 0, 0, 1, 3, 12, 63, }, + { 2, 0, 1, 3, 12, 63, }, + { 1, 0, 1, 3, 12, 63, }, + { 0, 0, 1, 3, 13, 63, }, + { 2, 0, 1, 3, 13, 63, }, + { 1, 0, 1, 3, 13, 63, }, + { 0, 0, 1, 3, 14, 63, }, + { 2, 0, 1, 3, 14, 63, }, + { 1, 0, 1, 3, 14, 63, }, + { 0, 1, 0, 1, 36, 30, }, + { 2, 1, 0, 1, 36, 32, }, + { 1, 1, 0, 1, 36, 30, }, + { 0, 1, 0, 1, 40, 32, }, + { 2, 1, 0, 1, 40, 32, }, + { 1, 1, 0, 1, 40, 30, }, + { 0, 1, 0, 1, 44, 32, }, + { 2, 1, 0, 1, 44, 32, }, + { 1, 1, 0, 1, 44, 30, }, + { 0, 1, 0, 1, 48, 32, }, + { 2, 1, 0, 1, 48, 32, }, + { 1, 1, 0, 1, 48, 30, }, + { 0, 1, 0, 1, 52, 32, }, + { 2, 1, 0, 1, 52, 32, }, + { 1, 1, 0, 1, 52, 28, }, + { 0, 1, 0, 1, 56, 32, }, + { 2, 1, 0, 1, 56, 32, }, + { 1, 1, 0, 1, 56, 28, }, + { 0, 1, 0, 1, 60, 32, }, + { 2, 1, 0, 1, 60, 32, }, + { 1, 1, 0, 1, 60, 28, }, + { 0, 1, 0, 1, 64, 28, }, + { 2, 1, 0, 1, 64, 32, }, + { 1, 1, 0, 1, 64, 28, }, + { 0, 1, 0, 1, 100, 26, }, + { 2, 1, 0, 1, 100, 32, }, + { 1, 1, 0, 1, 100, 32, }, + { 0, 1, 0, 1, 104, 32, }, + { 2, 1, 0, 1, 104, 32, }, + { 1, 1, 0, 1, 104, 32, }, + { 0, 1, 0, 1, 108, 32, }, + { 2, 1, 0, 1, 108, 32, }, + { 1, 1, 0, 1, 108, 32, }, + { 0, 1, 0, 1, 112, 32, }, + { 2, 1, 0, 1, 112, 32, }, + { 1, 1, 0, 1, 112, 32, }, + { 0, 1, 0, 1, 116, 32, }, + { 2, 1, 0, 1, 116, 32, }, + { 1, 1, 0, 1, 116, 32, }, + { 0, 1, 0, 1, 120, 32, }, + { 2, 1, 0, 1, 120, 32, }, + { 1, 1, 0, 1, 120, 32, }, + { 0, 1, 0, 1, 124, 32, }, + { 2, 1, 0, 1, 124, 32, }, + { 1, 1, 0, 1, 124, 32, }, + { 0, 1, 0, 1, 128, 32, }, + { 2, 1, 0, 1, 128, 32, }, + { 1, 1, 0, 1, 128, 32, }, + { 0, 1, 0, 1, 132, 32, }, + { 2, 1, 0, 1, 132, 32, }, + { 1, 1, 0, 1, 132, 32, }, + { 0, 1, 0, 1, 136, 32, }, + { 2, 1, 0, 1, 136, 32, }, + { 1, 1, 0, 1, 136, 32, }, + { 0, 1, 0, 1, 140, 28, }, + { 2, 1, 0, 1, 140, 32, }, + { 1, 1, 0, 1, 140, 32, }, + { 0, 1, 0, 1, 144, 28, }, + { 2, 1, 0, 1, 144, 32, }, + { 1, 1, 0, 1, 144, 63, }, + { 0, 1, 0, 1, 149, 32, }, + { 2, 1, 0, 1, 149, 63, }, + { 1, 1, 0, 1, 149, 63, }, + { 0, 1, 0, 1, 153, 32, }, + { 2, 1, 0, 1, 153, 63, }, + { 1, 1, 0, 1, 153, 63, }, + { 0, 1, 0, 1, 157, 32, }, + { 2, 1, 0, 1, 157, 63, }, + { 1, 1, 0, 1, 157, 63, }, + { 0, 1, 0, 1, 161, 32, }, + { 2, 1, 0, 1, 161, 63, }, + { 1, 1, 0, 1, 161, 63, }, + { 0, 1, 0, 1, 165, 32, }, + { 2, 1, 0, 1, 165, 63, }, + { 1, 1, 0, 1, 165, 63, }, + { 0, 1, 0, 2, 36, 30, }, + { 2, 1, 0, 2, 36, 32, }, + { 1, 1, 0, 2, 36, 28, }, + { 0, 1, 0, 2, 40, 32, }, + { 2, 1, 0, 2, 40, 32, }, + { 1, 1, 0, 2, 40, 28, }, + { 0, 1, 0, 2, 44, 32, }, + { 2, 1, 0, 2, 44, 32, }, + { 1, 1, 0, 2, 44, 28, }, + { 0, 1, 0, 2, 48, 32, }, + { 2, 1, 0, 2, 48, 32, }, + { 1, 1, 0, 2, 48, 28, }, + { 0, 1, 0, 2, 52, 32, }, + { 2, 1, 0, 2, 52, 32, }, + { 1, 1, 0, 2, 52, 28, }, + { 0, 1, 0, 2, 56, 32, }, + { 2, 1, 0, 2, 56, 32, }, + { 1, 1, 0, 2, 56, 28, }, + { 0, 1, 0, 2, 60, 32, }, + { 2, 1, 0, 2, 60, 32, }, + { 1, 1, 0, 2, 60, 28, }, + { 0, 1, 0, 2, 64, 28, }, + { 2, 1, 0, 2, 64, 32, }, + { 1, 1, 0, 2, 64, 28, }, + { 0, 1, 0, 2, 100, 26, }, + { 2, 1, 0, 2, 100, 32, }, + { 1, 1, 0, 2, 100, 32, }, + { 0, 1, 0, 2, 104, 32, }, + { 2, 1, 0, 2, 104, 32, }, + { 1, 1, 0, 2, 104, 32, }, + { 0, 1, 0, 2, 108, 32, }, + { 2, 1, 0, 2, 108, 32, }, + { 1, 1, 0, 2, 108, 32, }, + { 0, 1, 0, 2, 112, 32, }, + { 2, 1, 0, 2, 112, 32, }, + { 1, 1, 0, 2, 112, 32, }, + { 0, 1, 0, 2, 116, 32, }, + { 2, 1, 0, 2, 116, 32, }, + { 1, 1, 0, 2, 116, 32, }, + { 0, 1, 0, 2, 120, 32, }, + { 2, 1, 0, 2, 120, 32, }, + { 1, 1, 0, 2, 120, 32, }, + { 0, 1, 0, 2, 124, 32, }, + { 2, 1, 0, 2, 124, 32, }, + { 1, 1, 0, 2, 124, 32, }, + { 0, 1, 0, 2, 128, 32, }, + { 2, 1, 0, 2, 128, 32, }, + { 1, 1, 0, 2, 128, 32, }, + { 0, 1, 0, 2, 132, 32, }, + { 2, 1, 0, 2, 132, 32, }, + { 1, 1, 0, 2, 132, 32, }, + { 0, 1, 0, 2, 136, 32, }, + { 2, 1, 0, 2, 136, 32, }, + { 1, 1, 0, 2, 136, 32, }, + { 0, 1, 0, 2, 140, 26, }, + { 2, 1, 0, 2, 140, 32, }, + { 1, 1, 0, 2, 140, 32, }, + { 0, 1, 0, 2, 144, 26, }, + { 2, 1, 0, 2, 144, 63, }, + { 1, 1, 0, 2, 144, 63, }, + { 0, 1, 0, 2, 149, 32, }, + { 2, 1, 0, 2, 149, 63, }, + { 1, 1, 0, 2, 149, 63, }, + { 0, 1, 0, 2, 153, 32, }, + { 2, 1, 0, 2, 153, 63, }, + { 1, 1, 0, 2, 153, 63, }, + { 0, 1, 0, 2, 157, 32, }, + { 2, 1, 0, 2, 157, 63, }, + { 1, 1, 0, 2, 157, 63, }, + { 0, 1, 0, 2, 161, 32, }, + { 2, 1, 0, 2, 161, 63, }, + { 1, 1, 0, 2, 161, 63, }, + { 0, 1, 0, 2, 165, 32, }, + { 2, 1, 0, 2, 165, 63, }, + { 1, 1, 0, 2, 165, 63, }, + { 0, 1, 0, 3, 36, 28, }, + { 2, 1, 0, 3, 36, 20, }, + { 1, 1, 0, 3, 36, 22, }, + { 0, 1, 0, 3, 40, 30, }, + { 2, 1, 0, 3, 40, 20, }, + { 1, 1, 0, 3, 40, 22, }, + { 0, 1, 0, 3, 44, 30, }, + { 2, 1, 0, 3, 44, 20, }, + { 1, 1, 0, 3, 44, 22, }, + { 0, 1, 0, 3, 48, 30, }, + { 2, 1, 0, 3, 48, 20, }, + { 1, 1, 0, 3, 48, 22, }, + { 0, 1, 0, 3, 52, 30, }, + { 2, 1, 0, 3, 52, 20, }, + { 1, 1, 0, 3, 52, 22, }, + { 0, 1, 0, 3, 56, 30, }, + { 2, 1, 0, 3, 56, 20, }, + { 1, 1, 0, 3, 56, 22, }, + { 0, 1, 0, 3, 60, 30, }, + { 2, 1, 0, 3, 60, 20, }, + { 1, 1, 0, 3, 60, 22, }, + { 0, 1, 0, 3, 64, 28, }, + { 2, 1, 0, 3, 64, 20, }, + { 1, 1, 0, 3, 64, 22, }, + { 0, 1, 0, 3, 100, 26, }, + { 2, 1, 0, 3, 100, 20, }, + { 1, 1, 0, 3, 100, 30, }, + { 0, 1, 0, 3, 104, 30, }, + { 2, 1, 0, 3, 104, 20, }, + { 1, 1, 0, 3, 104, 30, }, + { 0, 1, 0, 3, 108, 32, }, + { 2, 1, 0, 3, 108, 20, }, + { 1, 1, 0, 3, 108, 30, }, + { 0, 1, 0, 3, 112, 32, }, + { 2, 1, 0, 3, 112, 20, }, + { 1, 1, 0, 3, 112, 30, }, + { 0, 1, 0, 3, 116, 32, }, + { 2, 1, 0, 3, 116, 20, }, + { 1, 1, 0, 3, 116, 30, }, + { 0, 1, 0, 3, 120, 32, }, + { 2, 1, 0, 3, 120, 20, }, + { 1, 1, 0, 3, 120, 30, }, + { 0, 1, 0, 3, 124, 32, }, + { 2, 1, 0, 3, 124, 20, }, + { 1, 1, 0, 3, 124, 30, }, + { 0, 1, 0, 3, 128, 32, }, + { 2, 1, 0, 3, 128, 20, }, + { 1, 1, 0, 3, 128, 30, }, + { 0, 1, 0, 3, 132, 32, }, + { 2, 1, 0, 3, 132, 20, }, + { 1, 1, 0, 3, 132, 30, }, + { 0, 1, 0, 3, 136, 30, }, + { 2, 1, 0, 3, 136, 20, }, + { 1, 1, 0, 3, 136, 30, }, + { 0, 1, 0, 3, 140, 26, }, + { 2, 1, 0, 3, 140, 20, }, + { 1, 1, 0, 3, 140, 30, }, + { 0, 1, 0, 3, 144, 26, }, + { 2, 1, 0, 3, 144, 63, }, + { 1, 1, 0, 3, 144, 63, }, + { 0, 1, 0, 3, 149, 32, }, + { 2, 1, 0, 3, 149, 63, }, + { 1, 1, 0, 3, 149, 63, }, + { 0, 1, 0, 3, 153, 32, }, + { 2, 1, 0, 3, 153, 63, }, + { 1, 1, 0, 3, 153, 63, }, + { 0, 1, 0, 3, 157, 32, }, + { 2, 1, 0, 3, 157, 63, }, + { 1, 1, 0, 3, 157, 63, }, + { 0, 1, 0, 3, 161, 32, }, + { 2, 1, 0, 3, 161, 63, }, + { 1, 1, 0, 3, 161, 63, }, + { 0, 1, 0, 3, 165, 32, }, + { 2, 1, 0, 3, 165, 63, }, + { 1, 1, 0, 3, 165, 63, }, + { 0, 1, 1, 2, 38, 22, }, + { 2, 1, 1, 2, 38, 30, }, + { 1, 1, 1, 2, 38, 30, }, + { 0, 1, 1, 2, 46, 30, }, + { 2, 1, 1, 2, 46, 30, }, + { 1, 1, 1, 2, 46, 30, }, + { 0, 1, 1, 2, 54, 30, }, + { 2, 1, 1, 2, 54, 30, }, + { 1, 1, 1, 2, 54, 30, }, + { 0, 1, 1, 2, 62, 24, }, + { 2, 1, 1, 2, 62, 30, }, + { 1, 1, 1, 2, 62, 30, }, + { 0, 1, 1, 2, 102, 24, }, + { 2, 1, 1, 2, 102, 30, }, + { 1, 1, 1, 2, 102, 30, }, + { 0, 1, 1, 2, 110, 30, }, + { 2, 1, 1, 2, 110, 30, }, + { 1, 1, 1, 2, 110, 30, }, + { 0, 1, 1, 2, 118, 30, }, + { 2, 1, 1, 2, 118, 30, }, + { 1, 1, 1, 2, 118, 30, }, + { 0, 1, 1, 2, 126, 30, }, + { 2, 1, 1, 2, 126, 30, }, + { 1, 1, 1, 2, 126, 30, }, + { 0, 1, 1, 2, 134, 30, }, + { 2, 1, 1, 2, 134, 30, }, + { 1, 1, 1, 2, 134, 30, }, + { 0, 1, 1, 2, 142, 30, }, + { 2, 1, 1, 2, 142, 63, }, + { 1, 1, 1, 2, 142, 63, }, + { 0, 1, 1, 2, 151, 30, }, + { 2, 1, 1, 2, 151, 63, }, + { 1, 1, 1, 2, 151, 63, }, + { 0, 1, 1, 2, 159, 30, }, + { 2, 1, 1, 2, 159, 63, }, + { 1, 1, 1, 2, 159, 63, }, + { 0, 1, 1, 3, 38, 20, }, + { 2, 1, 1, 3, 38, 20, }, + { 1, 1, 1, 3, 38, 22, }, + { 0, 1, 1, 3, 46, 30, }, + { 2, 1, 1, 3, 46, 20, }, + { 1, 1, 1, 3, 46, 22, }, + { 0, 1, 1, 3, 54, 30, }, + { 2, 1, 1, 3, 54, 20, }, + { 1, 1, 1, 3, 54, 22, }, + { 0, 1, 1, 3, 62, 22, }, + { 2, 1, 1, 3, 62, 20, }, + { 1, 1, 1, 3, 62, 22, }, + { 0, 1, 1, 3, 102, 22, }, + { 2, 1, 1, 3, 102, 20, }, + { 1, 1, 1, 3, 102, 30, }, + { 0, 1, 1, 3, 110, 30, }, + { 2, 1, 1, 3, 110, 20, }, + { 1, 1, 1, 3, 110, 30, }, + { 0, 1, 1, 3, 118, 30, }, + { 2, 1, 1, 3, 118, 20, }, + { 1, 1, 1, 3, 118, 30, }, + { 0, 1, 1, 3, 126, 30, }, + { 2, 1, 1, 3, 126, 20, }, + { 1, 1, 1, 3, 126, 30, }, + { 0, 1, 1, 3, 134, 30, }, + { 2, 1, 1, 3, 134, 20, }, + { 1, 1, 1, 3, 134, 30, }, + { 0, 1, 1, 3, 142, 30, }, + { 2, 1, 1, 3, 142, 63, }, + { 1, 1, 1, 3, 142, 63, }, + { 0, 1, 1, 3, 151, 30, }, + { 2, 1, 1, 3, 151, 63, }, + { 1, 1, 1, 3, 151, 63, }, + { 0, 1, 1, 3, 159, 30, }, + { 2, 1, 1, 3, 159, 63, }, + { 1, 1, 1, 3, 159, 63, }, + { 0, 1, 2, 4, 42, 20, }, + { 2, 1, 2, 4, 42, 30, }, + { 1, 1, 2, 4, 42, 28, }, + { 0, 1, 2, 4, 58, 20, }, + { 2, 1, 2, 4, 58, 30, }, + { 1, 1, 2, 4, 58, 28, }, + { 0, 1, 2, 4, 106, 20, }, + { 2, 1, 2, 4, 106, 30, }, + { 1, 1, 2, 4, 106, 30, }, + { 0, 1, 2, 4, 122, 30, }, + { 2, 1, 2, 4, 122, 30, }, + { 1, 1, 2, 4, 122, 30, }, + { 0, 1, 2, 4, 138, 30, }, + { 2, 1, 2, 4, 138, 63, }, + { 1, 1, 2, 4, 138, 63, }, + { 0, 1, 2, 4, 155, 30, }, + { 2, 1, 2, 4, 155, 63, }, + { 1, 1, 2, 4, 155, 63, }, + { 0, 1, 2, 5, 42, 18, }, + { 2, 1, 2, 5, 42, 20, }, + { 1, 1, 2, 5, 42, 22, }, + { 0, 1, 2, 5, 58, 18, }, + { 2, 1, 2, 5, 58, 20, }, + { 1, 1, 2, 5, 58, 22, }, + { 0, 1, 2, 5, 106, 20, }, + { 2, 1, 2, 5, 106, 20, }, + { 1, 1, 2, 5, 106, 30, }, + { 0, 1, 2, 5, 122, 30, }, + { 2, 1, 2, 5, 122, 20, }, + { 1, 1, 2, 5, 122, 30, }, + { 0, 1, 2, 5, 138, 30, }, + { 2, 1, 2, 5, 138, 63, }, + { 1, 1, 2, 5, 138, 63, }, + { 0, 1, 2, 5, 155, 30, }, + { 2, 1, 2, 5, 155, 63, }, + { 1, 1, 2, 5, 155, 63, }, +}; + +RTW_DECL_TABLE_TXPWR_LMT(rtw8822b_txpwr_lmt_type0); + +static const struct rtw_txpwr_lmt_cfg_pair rtw8822b_txpwr_lmt_type2[] = { + { 0, 0, 0, 0, 1, 32, }, + { 2, 0, 0, 0, 1, 28, }, + { 1, 0, 0, 0, 1, 30, }, + { 0, 0, 0, 0, 2, 32, }, + { 2, 0, 0, 0, 2, 28, }, + { 1, 0, 0, 0, 2, 30, }, + { 0, 0, 0, 0, 3, 32, }, + { 2, 0, 0, 0, 3, 28, }, + { 1, 0, 0, 0, 3, 30, }, + { 0, 0, 0, 0, 4, 32, }, + { 2, 0, 0, 0, 4, 28, }, + { 1, 0, 0, 0, 4, 30, }, + { 0, 0, 0, 0, 5, 32, }, + { 2, 0, 0, 0, 5, 28, }, + { 1, 0, 0, 0, 5, 30, }, + { 0, 0, 0, 0, 6, 32, }, + { 2, 0, 0, 0, 6, 28, }, + { 1, 0, 0, 0, 6, 30, }, + { 0, 0, 0, 0, 7, 32, }, + { 2, 0, 0, 0, 7, 28, }, + { 1, 0, 0, 0, 7, 30, }, + { 0, 0, 0, 0, 8, 32, }, + { 2, 0, 0, 0, 8, 28, }, + { 1, 0, 0, 0, 8, 30, }, + { 0, 0, 0, 0, 9, 32, }, + { 2, 0, 0, 0, 9, 28, }, + { 1, 0, 0, 0, 9, 30, }, + { 0, 0, 0, 0, 10, 32, }, + { 2, 0, 0, 0, 10, 28, }, + { 1, 0, 0, 0, 10, 30, }, + { 0, 0, 0, 0, 11, 32, }, + { 2, 0, 0, 0, 11, 28, }, + { 1, 0, 0, 0, 11, 30, }, + { 0, 0, 0, 0, 12, 26, }, + { 2, 0, 0, 0, 12, 28, }, + { 1, 0, 0, 0, 12, 30, }, + { 0, 0, 0, 0, 13, 20, }, + { 2, 0, 0, 0, 13, 28, }, + { 1, 0, 0, 0, 13, 28, }, + { 0, 0, 0, 0, 14, 63, }, + { 2, 0, 0, 0, 14, 63, }, + { 1, 0, 0, 0, 14, 32, }, + { 0, 0, 0, 1, 1, 26, }, + { 2, 0, 0, 1, 1, 30, }, + { 1, 0, 0, 1, 1, 34, }, + { 0, 0, 0, 1, 2, 30, }, + { 2, 0, 0, 1, 2, 30, }, + { 1, 0, 0, 1, 2, 34, }, + { 0, 0, 0, 1, 3, 32, }, + { 2, 0, 0, 1, 3, 30, }, + { 1, 0, 0, 1, 3, 34, }, + { 0, 0, 0, 1, 4, 34, }, + { 2, 0, 0, 1, 4, 30, }, + { 1, 0, 0, 1, 4, 34, }, + { 0, 0, 0, 1, 5, 34, }, + { 2, 0, 0, 1, 5, 30, }, + { 1, 0, 0, 1, 5, 34, }, + { 0, 0, 0, 1, 6, 34, }, + { 2, 0, 0, 1, 6, 30, }, + { 1, 0, 0, 1, 6, 34, }, + { 0, 0, 0, 1, 7, 34, }, + { 2, 0, 0, 1, 7, 30, }, + { 1, 0, 0, 1, 7, 34, }, + { 0, 0, 0, 1, 8, 34, }, + { 2, 0, 0, 1, 8, 30, }, + { 1, 0, 0, 1, 8, 34, }, + { 0, 0, 0, 1, 9, 32, }, + { 2, 0, 0, 1, 9, 30, }, + { 1, 0, 0, 1, 9, 34, }, + { 0, 0, 0, 1, 10, 30, }, + { 2, 0, 0, 1, 10, 30, }, + { 1, 0, 0, 1, 10, 34, }, + { 0, 0, 0, 1, 11, 28, }, + { 2, 0, 0, 1, 11, 30, }, + { 1, 0, 0, 1, 11, 34, }, + { 0, 0, 0, 1, 12, 22, }, + { 2, 0, 0, 1, 12, 30, }, + { 1, 0, 0, 1, 12, 34, }, + { 0, 0, 0, 1, 13, 14, }, + { 2, 0, 0, 1, 13, 30, }, + { 1, 0, 0, 1, 13, 34, }, + { 0, 0, 0, 1, 14, 63, }, + { 2, 0, 0, 1, 14, 63, }, + { 1, 0, 0, 1, 14, 63, }, + { 0, 0, 0, 2, 1, 26, }, + { 2, 0, 0, 2, 1, 30, }, + { 1, 0, 0, 2, 1, 34, }, + { 0, 0, 0, 2, 2, 30, }, + { 2, 0, 0, 2, 2, 30, }, + { 1, 0, 0, 2, 2, 34, }, + { 0, 0, 0, 2, 3, 32, }, + { 2, 0, 0, 2, 3, 30, }, + { 1, 0, 0, 2, 3, 34, }, + { 0, 0, 0, 2, 4, 34, }, + { 2, 0, 0, 2, 4, 30, }, + { 1, 0, 0, 2, 4, 34, }, + { 0, 0, 0, 2, 5, 34, }, + { 2, 0, 0, 2, 5, 30, }, + { 1, 0, 0, 2, 5, 34, }, + { 0, 0, 0, 2, 6, 34, }, + { 2, 0, 0, 2, 6, 30, }, + { 1, 0, 0, 2, 6, 34, }, + { 0, 0, 0, 2, 7, 34, }, + { 2, 0, 0, 2, 7, 30, }, + { 1, 0, 0, 2, 7, 34, }, + { 0, 0, 0, 2, 8, 34, }, + { 2, 0, 0, 2, 8, 30, }, + { 1, 0, 0, 2, 8, 34, }, + { 0, 0, 0, 2, 9, 32, }, + { 2, 0, 0, 2, 9, 30, }, + { 1, 0, 0, 2, 9, 34, }, + { 0, 0, 0, 2, 10, 30, }, + { 2, 0, 0, 2, 10, 30, }, + { 1, 0, 0, 2, 10, 34, }, + { 0, 0, 0, 2, 11, 26, }, + { 2, 0, 0, 2, 11, 30, }, + { 1, 0, 0, 2, 11, 34, }, + { 0, 0, 0, 2, 12, 20, }, + { 2, 0, 0, 2, 12, 30, }, + { 1, 0, 0, 2, 12, 34, }, + { 0, 0, 0, 2, 13, 14, }, + { 2, 0, 0, 2, 13, 30, }, + { 1, 0, 0, 2, 13, 34, }, + { 0, 0, 0, 2, 14, 63, }, + { 2, 0, 0, 2, 14, 63, }, + { 1, 0, 0, 2, 14, 63, }, + { 0, 0, 0, 3, 1, 26, }, + { 2, 0, 0, 3, 1, 18, }, + { 1, 0, 0, 3, 1, 30, }, + { 0, 0, 0, 3, 2, 28, }, + { 2, 0, 0, 3, 2, 18, }, + { 1, 0, 0, 3, 2, 30, }, + { 0, 0, 0, 3, 3, 30, }, + { 2, 0, 0, 3, 3, 18, }, + { 1, 0, 0, 3, 3, 30, }, + { 0, 0, 0, 3, 4, 30, }, + { 2, 0, 0, 3, 4, 18, }, + { 1, 0, 0, 3, 4, 30, }, + { 0, 0, 0, 3, 5, 32, }, + { 2, 0, 0, 3, 5, 18, }, + { 1, 0, 0, 3, 5, 30, }, + { 0, 0, 0, 3, 6, 32, }, + { 2, 0, 0, 3, 6, 18, }, + { 1, 0, 0, 3, 6, 30, }, + { 0, 0, 0, 3, 7, 32, }, + { 2, 0, 0, 3, 7, 18, }, + { 1, 0, 0, 3, 7, 30, }, + { 0, 0, 0, 3, 8, 30, }, + { 2, 0, 0, 3, 8, 18, }, + { 1, 0, 0, 3, 8, 30, }, + { 0, 0, 0, 3, 9, 30, }, + { 2, 0, 0, 3, 9, 18, }, + { 1, 0, 0, 3, 9, 30, }, + { 0, 0, 0, 3, 10, 28, }, + { 2, 0, 0, 3, 10, 18, }, + { 1, 0, 0, 3, 10, 30, }, + { 0, 0, 0, 3, 11, 26, }, + { 2, 0, 0, 3, 11, 18, }, + { 1, 0, 0, 3, 11, 30, }, + { 0, 0, 0, 3, 12, 20, }, + { 2, 0, 0, 3, 12, 18, }, + { 1, 0, 0, 3, 12, 30, }, + { 0, 0, 0, 3, 13, 14, }, + { 2, 0, 0, 3, 13, 18, }, + { 1, 0, 0, 3, 13, 30, }, + { 0, 0, 0, 3, 14, 63, }, + { 2, 0, 0, 3, 14, 63, }, + { 1, 0, 0, 3, 14, 63, }, + { 0, 0, 1, 2, 1, 63, }, + { 2, 0, 1, 2, 1, 63, }, + { 1, 0, 1, 2, 1, 63, }, + { 0, 0, 1, 2, 2, 63, }, + { 2, 0, 1, 2, 2, 63, }, + { 1, 0, 1, 2, 2, 63, }, + { 0, 0, 1, 2, 3, 26, }, + { 2, 0, 1, 2, 3, 30, }, + { 1, 0, 1, 2, 3, 34, }, + { 0, 0, 1, 2, 4, 26, }, + { 2, 0, 1, 2, 4, 30, }, + { 1, 0, 1, 2, 4, 34, }, + { 0, 0, 1, 2, 5, 30, }, + { 2, 0, 1, 2, 5, 30, }, + { 1, 0, 1, 2, 5, 34, }, + { 0, 0, 1, 2, 6, 32, }, + { 2, 0, 1, 2, 6, 30, }, + { 1, 0, 1, 2, 6, 34, }, + { 0, 0, 1, 2, 7, 30, }, + { 2, 0, 1, 2, 7, 30, }, + { 1, 0, 1, 2, 7, 34, }, + { 0, 0, 1, 2, 8, 26, }, + { 2, 0, 1, 2, 8, 30, }, + { 1, 0, 1, 2, 8, 34, }, + { 0, 0, 1, 2, 9, 26, }, + { 2, 0, 1, 2, 9, 30, }, + { 1, 0, 1, 2, 9, 34, }, + { 0, 0, 1, 2, 10, 20, }, + { 2, 0, 1, 2, 10, 30, }, + { 1, 0, 1, 2, 10, 34, }, + { 0, 0, 1, 2, 11, 14, }, + { 2, 0, 1, 2, 11, 30, }, + { 1, 0, 1, 2, 11, 34, }, + { 0, 0, 1, 2, 12, 63, }, + { 2, 0, 1, 2, 12, 63, }, + { 1, 0, 1, 2, 12, 63, }, + { 0, 0, 1, 2, 13, 63, }, + { 2, 0, 1, 2, 13, 63, }, + { 1, 0, 1, 2, 13, 63, }, + { 0, 0, 1, 2, 14, 63, }, + { 2, 0, 1, 2, 14, 63, }, + { 1, 0, 1, 2, 14, 63, }, + { 0, 0, 1, 3, 1, 63, }, + { 2, 0, 1, 3, 1, 63, }, + { 1, 0, 1, 3, 1, 63, }, + { 0, 0, 1, 3, 2, 63, }, + { 2, 0, 1, 3, 2, 63, }, + { 1, 0, 1, 3, 2, 63, }, + { 0, 0, 1, 3, 3, 24, }, + { 2, 0, 1, 3, 3, 18, }, + { 1, 0, 1, 3, 3, 30, }, + { 0, 0, 1, 3, 4, 24, }, + { 2, 0, 1, 3, 4, 18, }, + { 1, 0, 1, 3, 4, 30, }, + { 0, 0, 1, 3, 5, 26, }, + { 2, 0, 1, 3, 5, 18, }, + { 1, 0, 1, 3, 5, 30, }, + { 0, 0, 1, 3, 6, 28, }, + { 2, 0, 1, 3, 6, 18, }, + { 1, 0, 1, 3, 6, 30, }, + { 0, 0, 1, 3, 7, 26, }, + { 2, 0, 1, 3, 7, 18, }, + { 1, 0, 1, 3, 7, 30, }, + { 0, 0, 1, 3, 8, 26, }, + { 2, 0, 1, 3, 8, 18, }, + { 1, 0, 1, 3, 8, 30, }, + { 0, 0, 1, 3, 9, 26, }, + { 2, 0, 1, 3, 9, 18, }, + { 1, 0, 1, 3, 9, 30, }, + { 0, 0, 1, 3, 10, 20, }, + { 2, 0, 1, 3, 10, 18, }, + { 1, 0, 1, 3, 10, 30, }, + { 0, 0, 1, 3, 11, 14, }, + { 2, 0, 1, 3, 11, 18, }, + { 1, 0, 1, 3, 11, 30, }, + { 0, 0, 1, 3, 12, 63, }, + { 2, 0, 1, 3, 12, 63, }, + { 1, 0, 1, 3, 12, 63, }, + { 0, 0, 1, 3, 13, 63, }, + { 2, 0, 1, 3, 13, 63, }, + { 1, 0, 1, 3, 13, 63, }, + { 0, 0, 1, 3, 14, 63, }, + { 2, 0, 1, 3, 14, 63, }, + { 1, 0, 1, 3, 14, 63, }, + { 0, 1, 0, 1, 36, 36, }, + { 2, 1, 0, 1, 36, 32, }, + { 1, 1, 0, 1, 36, 30, }, + { 0, 1, 0, 1, 40, 38, }, + { 2, 1, 0, 1, 40, 32, }, + { 1, 1, 0, 1, 40, 30, }, + { 0, 1, 0, 1, 44, 38, }, + { 2, 1, 0, 1, 44, 32, }, + { 1, 1, 0, 1, 44, 30, }, + { 0, 1, 0, 1, 48, 38, }, + { 2, 1, 0, 1, 48, 32, }, + { 1, 1, 0, 1, 48, 30, }, + { 0, 1, 0, 1, 52, 38, }, + { 2, 1, 0, 1, 52, 32, }, + { 1, 1, 0, 1, 52, 28, }, + { 0, 1, 0, 1, 56, 38, }, + { 2, 1, 0, 1, 56, 32, }, + { 1, 1, 0, 1, 56, 28, }, + { 0, 1, 0, 1, 60, 38, }, + { 2, 1, 0, 1, 60, 32, }, + { 1, 1, 0, 1, 60, 28, }, + { 0, 1, 0, 1, 64, 34, }, + { 2, 1, 0, 1, 64, 32, }, + { 1, 1, 0, 1, 64, 28, }, + { 0, 1, 0, 1, 100, 32, }, + { 2, 1, 0, 1, 100, 32, }, + { 1, 1, 0, 1, 100, 32, }, + { 0, 1, 0, 1, 104, 38, }, + { 2, 1, 0, 1, 104, 32, }, + { 1, 1, 0, 1, 104, 32, }, + { 0, 1, 0, 1, 108, 38, }, + { 2, 1, 0, 1, 108, 32, }, + { 1, 1, 0, 1, 108, 32, }, + { 0, 1, 0, 1, 112, 38, }, + { 2, 1, 0, 1, 112, 32, }, + { 1, 1, 0, 1, 112, 32, }, + { 0, 1, 0, 1, 116, 38, }, + { 2, 1, 0, 1, 116, 32, }, + { 1, 1, 0, 1, 116, 32, }, + { 0, 1, 0, 1, 120, 38, }, + { 2, 1, 0, 1, 120, 32, }, + { 1, 1, 0, 1, 120, 32, }, + { 0, 1, 0, 1, 124, 38, }, + { 2, 1, 0, 1, 124, 32, }, + { 1, 1, 0, 1, 124, 32, }, + { 0, 1, 0, 1, 128, 38, }, + { 2, 1, 0, 1, 128, 32, }, + { 1, 1, 0, 1, 128, 32, }, + { 0, 1, 0, 1, 132, 38, }, + { 2, 1, 0, 1, 132, 32, }, + { 1, 1, 0, 1, 132, 32, }, + { 0, 1, 0, 1, 136, 38, }, + { 2, 1, 0, 1, 136, 32, }, + { 1, 1, 0, 1, 136, 32, }, + { 0, 1, 0, 1, 140, 34, }, + { 2, 1, 0, 1, 140, 32, }, + { 1, 1, 0, 1, 140, 32, }, + { 0, 1, 0, 1, 144, 34, }, + { 2, 1, 0, 1, 144, 32, }, + { 1, 1, 0, 1, 144, 63, }, + { 0, 1, 0, 1, 149, 38, }, + { 2, 1, 0, 1, 149, 63, }, + { 1, 1, 0, 1, 149, 63, }, + { 0, 1, 0, 1, 153, 38, }, + { 2, 1, 0, 1, 153, 63, }, + { 1, 1, 0, 1, 153, 63, }, + { 0, 1, 0, 1, 157, 38, }, + { 2, 1, 0, 1, 157, 63, }, + { 1, 1, 0, 1, 157, 63, }, + { 0, 1, 0, 1, 161, 38, }, + { 2, 1, 0, 1, 161, 63, }, + { 1, 1, 0, 1, 161, 63, }, + { 0, 1, 0, 1, 165, 38, }, + { 2, 1, 0, 1, 165, 63, }, + { 1, 1, 0, 1, 165, 63, }, + { 0, 1, 0, 2, 36, 36, }, + { 2, 1, 0, 2, 36, 32, }, + { 1, 1, 0, 2, 36, 28, }, + { 0, 1, 0, 2, 40, 38, }, + { 2, 1, 0, 2, 40, 32, }, + { 1, 1, 0, 2, 40, 28, }, + { 0, 1, 0, 2, 44, 38, }, + { 2, 1, 0, 2, 44, 32, }, + { 1, 1, 0, 2, 44, 28, }, + { 0, 1, 0, 2, 48, 38, }, + { 2, 1, 0, 2, 48, 32, }, + { 1, 1, 0, 2, 48, 28, }, + { 0, 1, 0, 2, 52, 38, }, + { 2, 1, 0, 2, 52, 32, }, + { 1, 1, 0, 2, 52, 28, }, + { 0, 1, 0, 2, 56, 38, }, + { 2, 1, 0, 2, 56, 32, }, + { 1, 1, 0, 2, 56, 28, }, + { 0, 1, 0, 2, 60, 38, }, + { 2, 1, 0, 2, 60, 32, }, + { 1, 1, 0, 2, 60, 28, }, + { 0, 1, 0, 2, 64, 34, }, + { 2, 1, 0, 2, 64, 32, }, + { 1, 1, 0, 2, 64, 28, }, + { 0, 1, 0, 2, 100, 32, }, + { 2, 1, 0, 2, 100, 32, }, + { 1, 1, 0, 2, 100, 32, }, + { 0, 1, 0, 2, 104, 38, }, + { 2, 1, 0, 2, 104, 32, }, + { 1, 1, 0, 2, 104, 32, }, + { 0, 1, 0, 2, 108, 38, }, + { 2, 1, 0, 2, 108, 32, }, + { 1, 1, 0, 2, 108, 32, }, + { 0, 1, 0, 2, 112, 38, }, + { 2, 1, 0, 2, 112, 32, }, + { 1, 1, 0, 2, 112, 32, }, + { 0, 1, 0, 2, 116, 38, }, + { 2, 1, 0, 2, 116, 32, }, + { 1, 1, 0, 2, 116, 32, }, + { 0, 1, 0, 2, 120, 38, }, + { 2, 1, 0, 2, 120, 32, }, + { 1, 1, 0, 2, 120, 32, }, + { 0, 1, 0, 2, 124, 38, }, + { 2, 1, 0, 2, 124, 32, }, + { 1, 1, 0, 2, 124, 32, }, + { 0, 1, 0, 2, 128, 38, }, + { 2, 1, 0, 2, 128, 32, }, + { 1, 1, 0, 2, 128, 32, }, + { 0, 1, 0, 2, 132, 38, }, + { 2, 1, 0, 2, 132, 32, }, + { 1, 1, 0, 2, 132, 32, }, + { 0, 1, 0, 2, 136, 38, }, + { 2, 1, 0, 2, 136, 32, }, + { 1, 1, 0, 2, 136, 32, }, + { 0, 1, 0, 2, 140, 32, }, + { 2, 1, 0, 2, 140, 32, }, + { 1, 1, 0, 2, 140, 32, }, + { 0, 1, 0, 2, 144, 26, }, + { 2, 1, 0, 2, 144, 63, }, + { 1, 1, 0, 2, 144, 63, }, + { 0, 1, 0, 2, 149, 38, }, + { 2, 1, 0, 2, 149, 63, }, + { 1, 1, 0, 2, 149, 63, }, + { 0, 1, 0, 2, 153, 38, }, + { 2, 1, 0, 2, 153, 63, }, + { 1, 1, 0, 2, 153, 63, }, + { 0, 1, 0, 2, 157, 38, }, + { 2, 1, 0, 2, 157, 63, }, + { 1, 1, 0, 2, 157, 63, }, + { 0, 1, 0, 2, 161, 38, }, + { 2, 1, 0, 2, 161, 63, }, + { 1, 1, 0, 2, 161, 63, }, + { 0, 1, 0, 2, 165, 38, }, + { 2, 1, 0, 2, 165, 63, }, + { 1, 1, 0, 2, 165, 63, }, + { 0, 1, 0, 3, 36, 34, }, + { 2, 1, 0, 3, 36, 20, }, + { 1, 1, 0, 3, 36, 22, }, + { 0, 1, 0, 3, 40, 36, }, + { 2, 1, 0, 3, 40, 20, }, + { 1, 1, 0, 3, 40, 22, }, + { 0, 1, 0, 3, 44, 36, }, + { 2, 1, 0, 3, 44, 20, }, + { 1, 1, 0, 3, 44, 22, }, + { 0, 1, 0, 3, 48, 36, }, + { 2, 1, 0, 3, 48, 20, }, + { 1, 1, 0, 3, 48, 22, }, + { 0, 1, 0, 3, 52, 36, }, + { 2, 1, 0, 3, 52, 20, }, + { 1, 1, 0, 3, 52, 22, }, + { 0, 1, 0, 3, 56, 36, }, + { 2, 1, 0, 3, 56, 20, }, + { 1, 1, 0, 3, 56, 22, }, + { 0, 1, 0, 3, 60, 36, }, + { 2, 1, 0, 3, 60, 20, }, + { 1, 1, 0, 3, 60, 22, }, + { 0, 1, 0, 3, 64, 34, }, + { 2, 1, 0, 3, 64, 20, }, + { 1, 1, 0, 3, 64, 22, }, + { 0, 1, 0, 3, 100, 32, }, + { 2, 1, 0, 3, 100, 20, }, + { 1, 1, 0, 3, 100, 30, }, + { 0, 1, 0, 3, 104, 36, }, + { 2, 1, 0, 3, 104, 20, }, + { 1, 1, 0, 3, 104, 30, }, + { 0, 1, 0, 3, 108, 38, }, + { 2, 1, 0, 3, 108, 20, }, + { 1, 1, 0, 3, 108, 30, }, + { 0, 1, 0, 3, 112, 38, }, + { 2, 1, 0, 3, 112, 20, }, + { 1, 1, 0, 3, 112, 30, }, + { 0, 1, 0, 3, 116, 38, }, + { 2, 1, 0, 3, 116, 20, }, + { 1, 1, 0, 3, 116, 30, }, + { 0, 1, 0, 3, 120, 38, }, + { 2, 1, 0, 3, 120, 20, }, + { 1, 1, 0, 3, 120, 30, }, + { 0, 1, 0, 3, 124, 38, }, + { 2, 1, 0, 3, 124, 20, }, + { 1, 1, 0, 3, 124, 30, }, + { 0, 1, 0, 3, 128, 38, }, + { 2, 1, 0, 3, 128, 20, }, + { 1, 1, 0, 3, 128, 30, }, + { 0, 1, 0, 3, 132, 38, }, + { 2, 1, 0, 3, 132, 20, }, + { 1, 1, 0, 3, 132, 30, }, + { 0, 1, 0, 3, 136, 36, }, + { 2, 1, 0, 3, 136, 20, }, + { 1, 1, 0, 3, 136, 30, }, + { 0, 1, 0, 3, 140, 32, }, + { 2, 1, 0, 3, 140, 20, }, + { 1, 1, 0, 3, 140, 30, }, + { 0, 1, 0, 3, 144, 26, }, + { 2, 1, 0, 3, 144, 63, }, + { 1, 1, 0, 3, 144, 63, }, + { 0, 1, 0, 3, 149, 38, }, + { 2, 1, 0, 3, 149, 63, }, + { 1, 1, 0, 3, 149, 63, }, + { 0, 1, 0, 3, 153, 38, }, + { 2, 1, 0, 3, 153, 63, }, + { 1, 1, 0, 3, 153, 63, }, + { 0, 1, 0, 3, 157, 38, }, + { 2, 1, 0, 3, 157, 63, }, + { 1, 1, 0, 3, 157, 63, }, + { 0, 1, 0, 3, 161, 38, }, + { 2, 1, 0, 3, 161, 63, }, + { 1, 1, 0, 3, 161, 63, }, + { 0, 1, 0, 3, 165, 38, }, + { 2, 1, 0, 3, 165, 63, }, + { 1, 1, 0, 3, 165, 63, }, + { 0, 1, 1, 2, 38, 28, }, + { 2, 1, 1, 2, 38, 30, }, + { 1, 1, 1, 2, 38, 30, }, + { 0, 1, 1, 2, 46, 36, }, + { 2, 1, 1, 2, 46, 30, }, + { 1, 1, 1, 2, 46, 30, }, + { 0, 1, 1, 2, 54, 36, }, + { 2, 1, 1, 2, 54, 30, }, + { 1, 1, 1, 2, 54, 30, }, + { 0, 1, 1, 2, 62, 30, }, + { 2, 1, 1, 2, 62, 30, }, + { 1, 1, 1, 2, 62, 30, }, + { 0, 1, 1, 2, 102, 30, }, + { 2, 1, 1, 2, 102, 30, }, + { 1, 1, 1, 2, 102, 30, }, + { 0, 1, 1, 2, 110, 36, }, + { 2, 1, 1, 2, 110, 30, }, + { 1, 1, 1, 2, 110, 30, }, + { 0, 1, 1, 2, 118, 36, }, + { 2, 1, 1, 2, 118, 30, }, + { 1, 1, 1, 2, 118, 30, }, + { 0, 1, 1, 2, 126, 36, }, + { 2, 1, 1, 2, 126, 30, }, + { 1, 1, 1, 2, 126, 30, }, + { 0, 1, 1, 2, 134, 36, }, + { 2, 1, 1, 2, 134, 30, }, + { 1, 1, 1, 2, 134, 30, }, + { 0, 1, 1, 2, 142, 30, }, + { 2, 1, 1, 2, 142, 63, }, + { 1, 1, 1, 2, 142, 63, }, + { 0, 1, 1, 2, 151, 36, }, + { 2, 1, 1, 2, 151, 63, }, + { 1, 1, 1, 2, 151, 63, }, + { 0, 1, 1, 2, 159, 36, }, + { 2, 1, 1, 2, 159, 63, }, + { 1, 1, 1, 2, 159, 63, }, + { 0, 1, 1, 3, 38, 26, }, + { 2, 1, 1, 3, 38, 20, }, + { 1, 1, 1, 3, 38, 22, }, + { 0, 1, 1, 3, 46, 36, }, + { 2, 1, 1, 3, 46, 20, }, + { 1, 1, 1, 3, 46, 22, }, + { 0, 1, 1, 3, 54, 36, }, + { 2, 1, 1, 3, 54, 20, }, + { 1, 1, 1, 3, 54, 22, }, + { 0, 1, 1, 3, 62, 28, }, + { 2, 1, 1, 3, 62, 20, }, + { 1, 1, 1, 3, 62, 22, }, + { 0, 1, 1, 3, 102, 28, }, + { 2, 1, 1, 3, 102, 20, }, + { 1, 1, 1, 3, 102, 30, }, + { 0, 1, 1, 3, 110, 36, }, + { 2, 1, 1, 3, 110, 20, }, + { 1, 1, 1, 3, 110, 30, }, + { 0, 1, 1, 3, 118, 36, }, + { 2, 1, 1, 3, 118, 20, }, + { 1, 1, 1, 3, 118, 30, }, + { 0, 1, 1, 3, 126, 36, }, + { 2, 1, 1, 3, 126, 20, }, + { 1, 1, 1, 3, 126, 30, }, + { 0, 1, 1, 3, 134, 36, }, + { 2, 1, 1, 3, 134, 20, }, + { 1, 1, 1, 3, 134, 30, }, + { 0, 1, 1, 3, 142, 30, }, + { 2, 1, 1, 3, 142, 63, }, + { 1, 1, 1, 3, 142, 63, }, + { 0, 1, 1, 3, 151, 36, }, + { 2, 1, 1, 3, 151, 63, }, + { 1, 1, 1, 3, 151, 63, }, + { 0, 1, 1, 3, 159, 36, }, + { 2, 1, 1, 3, 159, 63, }, + { 1, 1, 1, 3, 159, 63, }, + { 0, 1, 2, 4, 42, 26, }, + { 2, 1, 2, 4, 42, 30, }, + { 1, 1, 2, 4, 42, 28, }, + { 0, 1, 2, 4, 58, 26, }, + { 2, 1, 2, 4, 58, 30, }, + { 1, 1, 2, 4, 58, 28, }, + { 0, 1, 2, 4, 106, 26, }, + { 2, 1, 2, 4, 106, 30, }, + { 1, 1, 2, 4, 106, 30, }, + { 0, 1, 2, 4, 122, 36, }, + { 2, 1, 2, 4, 122, 30, }, + { 1, 1, 2, 4, 122, 30, }, + { 0, 1, 2, 4, 138, 36, }, + { 2, 1, 2, 4, 138, 63, }, + { 1, 1, 2, 4, 138, 63, }, + { 0, 1, 2, 4, 155, 36, }, + { 2, 1, 2, 4, 155, 63, }, + { 1, 1, 2, 4, 155, 63, }, + { 0, 1, 2, 5, 42, 24, }, + { 2, 1, 2, 5, 42, 20, }, + { 1, 1, 2, 5, 42, 22, }, + { 0, 1, 2, 5, 58, 24, }, + { 2, 1, 2, 5, 58, 20, }, + { 1, 1, 2, 5, 58, 22, }, + { 0, 1, 2, 5, 106, 26, }, + { 2, 1, 2, 5, 106, 20, }, + { 1, 1, 2, 5, 106, 30, }, + { 0, 1, 2, 5, 122, 36, }, + { 2, 1, 2, 5, 122, 20, }, + { 1, 1, 2, 5, 122, 30, }, + { 0, 1, 2, 5, 138, 36, }, + { 2, 1, 2, 5, 138, 63, }, + { 1, 1, 2, 5, 138, 63, }, + { 0, 1, 2, 5, 155, 36, }, + { 2, 1, 2, 5, 155, 63, }, + { 1, 1, 2, 5, 155, 63 }, +}; + +RTW_DECL_TABLE_TXPWR_LMT(rtw8822b_txpwr_lmt_type2); + +static const struct rtw_txpwr_lmt_cfg_pair rtw8822b_txpwr_lmt_type5[] = { + { 0, 0, 0, 0, 1, 32, }, + { 2, 0, 0, 0, 1, 28, }, + { 1, 0, 0, 0, 1, 30, }, + { 0, 0, 0, 0, 2, 32, }, + { 2, 0, 0, 0, 2, 28, }, + { 1, 0, 0, 0, 2, 30, }, + { 0, 0, 0, 0, 3, 32, }, + { 2, 0, 0, 0, 3, 28, }, + { 1, 0, 0, 0, 3, 30, }, + { 0, 0, 0, 0, 4, 32, }, + { 2, 0, 0, 0, 4, 28, }, + { 1, 0, 0, 0, 4, 30, }, + { 0, 0, 0, 0, 5, 32, }, + { 2, 0, 0, 0, 5, 28, }, + { 1, 0, 0, 0, 5, 30, }, + { 0, 0, 0, 0, 6, 32, }, + { 2, 0, 0, 0, 6, 28, }, + { 1, 0, 0, 0, 6, 30, }, + { 0, 0, 0, 0, 7, 32, }, + { 2, 0, 0, 0, 7, 28, }, + { 1, 0, 0, 0, 7, 30, }, + { 0, 0, 0, 0, 8, 32, }, + { 2, 0, 0, 0, 8, 28, }, + { 1, 0, 0, 0, 8, 30, }, + { 0, 0, 0, 0, 9, 32, }, + { 2, 0, 0, 0, 9, 28, }, + { 1, 0, 0, 0, 9, 30, }, + { 0, 0, 0, 0, 10, 32, }, + { 2, 0, 0, 0, 10, 28, }, + { 1, 0, 0, 0, 10, 30, }, + { 0, 0, 0, 0, 11, 32, }, + { 2, 0, 0, 0, 11, 28, }, + { 1, 0, 0, 0, 11, 30, }, + { 0, 0, 0, 0, 12, 26, }, + { 2, 0, 0, 0, 12, 28, }, + { 1, 0, 0, 0, 12, 30, }, + { 0, 0, 0, 0, 13, 20, }, + { 2, 0, 0, 0, 13, 28, }, + { 1, 0, 0, 0, 13, 28, }, + { 0, 0, 0, 0, 14, 63, }, + { 2, 0, 0, 0, 14, 63, }, + { 1, 0, 0, 0, 14, 32, }, + { 0, 0, 0, 1, 1, 26, }, + { 2, 0, 0, 1, 1, 30, }, + { 1, 0, 0, 1, 1, 34, }, + { 0, 0, 0, 1, 2, 30, }, + { 2, 0, 0, 1, 2, 30, }, + { 1, 0, 0, 1, 2, 34, }, + { 0, 0, 0, 1, 3, 32, }, + { 2, 0, 0, 1, 3, 30, }, + { 1, 0, 0, 1, 3, 34, }, + { 0, 0, 0, 1, 4, 34, }, + { 2, 0, 0, 1, 4, 30, }, + { 1, 0, 0, 1, 4, 34, }, + { 0, 0, 0, 1, 5, 34, }, + { 2, 0, 0, 1, 5, 30, }, + { 1, 0, 0, 1, 5, 34, }, + { 0, 0, 0, 1, 6, 34, }, + { 2, 0, 0, 1, 6, 30, }, + { 1, 0, 0, 1, 6, 34, }, + { 0, 0, 0, 1, 7, 34, }, + { 2, 0, 0, 1, 7, 30, }, + { 1, 0, 0, 1, 7, 34, }, + { 0, 0, 0, 1, 8, 34, }, + { 2, 0, 0, 1, 8, 30, }, + { 1, 0, 0, 1, 8, 34, }, + { 0, 0, 0, 1, 9, 32, }, + { 2, 0, 0, 1, 9, 30, }, + { 1, 0, 0, 1, 9, 34, }, + { 0, 0, 0, 1, 10, 30, }, + { 2, 0, 0, 1, 10, 30, }, + { 1, 0, 0, 1, 10, 34, }, + { 0, 0, 0, 1, 11, 28, }, + { 2, 0, 0, 1, 11, 30, }, + { 1, 0, 0, 1, 11, 34, }, + { 0, 0, 0, 1, 12, 22, }, + { 2, 0, 0, 1, 12, 30, }, + { 1, 0, 0, 1, 12, 34, }, + { 0, 0, 0, 1, 13, 14, }, + { 2, 0, 0, 1, 13, 30, }, + { 1, 0, 0, 1, 13, 34, }, + { 0, 0, 0, 1, 14, 63, }, + { 2, 0, 0, 1, 14, 63, }, + { 1, 0, 0, 1, 14, 63, }, + { 0, 0, 0, 2, 1, 26, }, + { 2, 0, 0, 2, 1, 30, }, + { 1, 0, 0, 2, 1, 34, }, + { 0, 0, 0, 2, 2, 30, }, + { 2, 0, 0, 2, 2, 30, }, + { 1, 0, 0, 2, 2, 34, }, + { 0, 0, 0, 2, 3, 32, }, + { 2, 0, 0, 2, 3, 30, }, + { 1, 0, 0, 2, 3, 34, }, + { 0, 0, 0, 2, 4, 34, }, + { 2, 0, 0, 2, 4, 30, }, + { 1, 0, 0, 2, 4, 34, }, + { 0, 0, 0, 2, 5, 34, }, + { 2, 0, 0, 2, 5, 30, }, + { 1, 0, 0, 2, 5, 34, }, + { 0, 0, 0, 2, 6, 34, }, + { 2, 0, 0, 2, 6, 30, }, + { 1, 0, 0, 2, 6, 34, }, + { 0, 0, 0, 2, 7, 34, }, + { 2, 0, 0, 2, 7, 30, }, + { 1, 0, 0, 2, 7, 34, }, + { 0, 0, 0, 2, 8, 34, }, + { 2, 0, 0, 2, 8, 30, }, + { 1, 0, 0, 2, 8, 34, }, + { 0, 0, 0, 2, 9, 32, }, + { 2, 0, 0, 2, 9, 30, }, + { 1, 0, 0, 2, 9, 34, }, + { 0, 0, 0, 2, 10, 30, }, + { 2, 0, 0, 2, 10, 30, }, + { 1, 0, 0, 2, 10, 34, }, + { 0, 0, 0, 2, 11, 26, }, + { 2, 0, 0, 2, 11, 30, }, + { 1, 0, 0, 2, 11, 34, }, + { 0, 0, 0, 2, 12, 20, }, + { 2, 0, 0, 2, 12, 30, }, + { 1, 0, 0, 2, 12, 34, }, + { 0, 0, 0, 2, 13, 14, }, + { 2, 0, 0, 2, 13, 30, }, + { 1, 0, 0, 2, 13, 34, }, + { 0, 0, 0, 2, 14, 63, }, + { 2, 0, 0, 2, 14, 63, }, + { 1, 0, 0, 2, 14, 63, }, + { 0, 0, 0, 3, 1, 26, }, + { 2, 0, 0, 3, 1, 18, }, + { 1, 0, 0, 3, 1, 30, }, + { 0, 0, 0, 3, 2, 28, }, + { 2, 0, 0, 3, 2, 18, }, + { 1, 0, 0, 3, 2, 30, }, + { 0, 0, 0, 3, 3, 30, }, + { 2, 0, 0, 3, 3, 18, }, + { 1, 0, 0, 3, 3, 30, }, + { 0, 0, 0, 3, 4, 30, }, + { 2, 0, 0, 3, 4, 18, }, + { 1, 0, 0, 3, 4, 30, }, + { 0, 0, 0, 3, 5, 32, }, + { 2, 0, 0, 3, 5, 18, }, + { 1, 0, 0, 3, 5, 30, }, + { 0, 0, 0, 3, 6, 32, }, + { 2, 0, 0, 3, 6, 18, }, + { 1, 0, 0, 3, 6, 30, }, + { 0, 0, 0, 3, 7, 32, }, + { 2, 0, 0, 3, 7, 18, }, + { 1, 0, 0, 3, 7, 30, }, + { 0, 0, 0, 3, 8, 30, }, + { 2, 0, 0, 3, 8, 18, }, + { 1, 0, 0, 3, 8, 30, }, + { 0, 0, 0, 3, 9, 30, }, + { 2, 0, 0, 3, 9, 18, }, + { 1, 0, 0, 3, 9, 30, }, + { 0, 0, 0, 3, 10, 28, }, + { 2, 0, 0, 3, 10, 18, }, + { 1, 0, 0, 3, 10, 30, }, + { 0, 0, 0, 3, 11, 26, }, + { 2, 0, 0, 3, 11, 18, }, + { 1, 0, 0, 3, 11, 30, }, + { 0, 0, 0, 3, 12, 20, }, + { 2, 0, 0, 3, 12, 18, }, + { 1, 0, 0, 3, 12, 30, }, + { 0, 0, 0, 3, 13, 14, }, + { 2, 0, 0, 3, 13, 18, }, + { 1, 0, 0, 3, 13, 30, }, + { 0, 0, 0, 3, 14, 63, }, + { 2, 0, 0, 3, 14, 63, }, + { 1, 0, 0, 3, 14, 63, }, + { 0, 0, 1, 2, 1, 63, }, + { 2, 0, 1, 2, 1, 63, }, + { 1, 0, 1, 2, 1, 63, }, + { 0, 0, 1, 2, 2, 63, }, + { 2, 0, 1, 2, 2, 63, }, + { 1, 0, 1, 2, 2, 63, }, + { 0, 0, 1, 2, 3, 26, }, + { 2, 0, 1, 2, 3, 30, }, + { 1, 0, 1, 2, 3, 34, }, + { 0, 0, 1, 2, 4, 26, }, + { 2, 0, 1, 2, 4, 30, }, + { 1, 0, 1, 2, 4, 34, }, + { 0, 0, 1, 2, 5, 30, }, + { 2, 0, 1, 2, 5, 30, }, + { 1, 0, 1, 2, 5, 34, }, + { 0, 0, 1, 2, 6, 32, }, + { 2, 0, 1, 2, 6, 30, }, + { 1, 0, 1, 2, 6, 34, }, + { 0, 0, 1, 2, 7, 30, }, + { 2, 0, 1, 2, 7, 30, }, + { 1, 0, 1, 2, 7, 34, }, + { 0, 0, 1, 2, 8, 26, }, + { 2, 0, 1, 2, 8, 30, }, + { 1, 0, 1, 2, 8, 34, }, + { 0, 0, 1, 2, 9, 26, }, + { 2, 0, 1, 2, 9, 30, }, + { 1, 0, 1, 2, 9, 34, }, + { 0, 0, 1, 2, 10, 20, }, + { 2, 0, 1, 2, 10, 30, }, + { 1, 0, 1, 2, 10, 34, }, + { 0, 0, 1, 2, 11, 14, }, + { 2, 0, 1, 2, 11, 30, }, + { 1, 0, 1, 2, 11, 34, }, + { 0, 0, 1, 2, 12, 63, }, + { 2, 0, 1, 2, 12, 63, }, + { 1, 0, 1, 2, 12, 63, }, + { 0, 0, 1, 2, 13, 63, }, + { 2, 0, 1, 2, 13, 63, }, + { 1, 0, 1, 2, 13, 63, }, + { 0, 0, 1, 2, 14, 63, }, + { 2, 0, 1, 2, 14, 63, }, + { 1, 0, 1, 2, 14, 63, }, + { 0, 0, 1, 3, 1, 63, }, + { 2, 0, 1, 3, 1, 63, }, + { 1, 0, 1, 3, 1, 63, }, + { 0, 0, 1, 3, 2, 63, }, + { 2, 0, 1, 3, 2, 63, }, + { 1, 0, 1, 3, 2, 63, }, + { 0, 0, 1, 3, 3, 24, }, + { 2, 0, 1, 3, 3, 18, }, + { 1, 0, 1, 3, 3, 30, }, + { 0, 0, 1, 3, 4, 24, }, + { 2, 0, 1, 3, 4, 18, }, + { 1, 0, 1, 3, 4, 30, }, + { 0, 0, 1, 3, 5, 26, }, + { 2, 0, 1, 3, 5, 18, }, + { 1, 0, 1, 3, 5, 30, }, + { 0, 0, 1, 3, 6, 28, }, + { 2, 0, 1, 3, 6, 18, }, + { 1, 0, 1, 3, 6, 30, }, + { 0, 0, 1, 3, 7, 26, }, + { 2, 0, 1, 3, 7, 18, }, + { 1, 0, 1, 3, 7, 30, }, + { 0, 0, 1, 3, 8, 26, }, + { 2, 0, 1, 3, 8, 18, }, + { 1, 0, 1, 3, 8, 30, }, + { 0, 0, 1, 3, 9, 26, }, + { 2, 0, 1, 3, 9, 18, }, + { 1, 0, 1, 3, 9, 30, }, + { 0, 0, 1, 3, 10, 20, }, + { 2, 0, 1, 3, 10, 18, }, + { 1, 0, 1, 3, 10, 30, }, + { 0, 0, 1, 3, 11, 14, }, + { 2, 0, 1, 3, 11, 18, }, + { 1, 0, 1, 3, 11, 30, }, + { 0, 0, 1, 3, 12, 63, }, + { 2, 0, 1, 3, 12, 63, }, + { 1, 0, 1, 3, 12, 63, }, + { 0, 0, 1, 3, 13, 63, }, + { 2, 0, 1, 3, 13, 63, }, + { 1, 0, 1, 3, 13, 63, }, + { 0, 0, 1, 3, 14, 63, }, + { 2, 0, 1, 3, 14, 63, }, + { 1, 0, 1, 3, 14, 63, }, + { 0, 1, 0, 1, 36, 30, }, + { 2, 1, 0, 1, 36, 32, }, + { 1, 1, 0, 1, 36, 30, }, + { 0, 1, 0, 1, 40, 32, }, + { 2, 1, 0, 1, 40, 32, }, + { 1, 1, 0, 1, 40, 30, }, + { 0, 1, 0, 1, 44, 32, }, + { 2, 1, 0, 1, 44, 32, }, + { 1, 1, 0, 1, 44, 30, }, + { 0, 1, 0, 1, 48, 32, }, + { 2, 1, 0, 1, 48, 32, }, + { 1, 1, 0, 1, 48, 30, }, + { 0, 1, 0, 1, 52, 32, }, + { 2, 1, 0, 1, 52, 32, }, + { 1, 1, 0, 1, 52, 28, }, + { 0, 1, 0, 1, 56, 32, }, + { 2, 1, 0, 1, 56, 32, }, + { 1, 1, 0, 1, 56, 28, }, + { 0, 1, 0, 1, 60, 32, }, + { 2, 1, 0, 1, 60, 32, }, + { 1, 1, 0, 1, 60, 28, }, + { 0, 1, 0, 1, 64, 28, }, + { 2, 1, 0, 1, 64, 32, }, + { 1, 1, 0, 1, 64, 28, }, + { 0, 1, 0, 1, 100, 26, }, + { 2, 1, 0, 1, 100, 32, }, + { 1, 1, 0, 1, 100, 32, }, + { 0, 1, 0, 1, 104, 32, }, + { 2, 1, 0, 1, 104, 32, }, + { 1, 1, 0, 1, 104, 32, }, + { 0, 1, 0, 1, 108, 32, }, + { 2, 1, 0, 1, 108, 32, }, + { 1, 1, 0, 1, 108, 32, }, + { 0, 1, 0, 1, 112, 32, }, + { 2, 1, 0, 1, 112, 32, }, + { 1, 1, 0, 1, 112, 32, }, + { 0, 1, 0, 1, 116, 32, }, + { 2, 1, 0, 1, 116, 32, }, + { 1, 1, 0, 1, 116, 32, }, + { 0, 1, 0, 1, 120, 32, }, + { 2, 1, 0, 1, 120, 32, }, + { 1, 1, 0, 1, 120, 32, }, + { 0, 1, 0, 1, 124, 32, }, + { 2, 1, 0, 1, 124, 32, }, + { 1, 1, 0, 1, 124, 32, }, + { 0, 1, 0, 1, 128, 32, }, + { 2, 1, 0, 1, 128, 32, }, + { 1, 1, 0, 1, 128, 32, }, + { 0, 1, 0, 1, 132, 32, }, + { 2, 1, 0, 1, 132, 32, }, + { 1, 1, 0, 1, 132, 32, }, + { 0, 1, 0, 1, 136, 32, }, + { 2, 1, 0, 1, 136, 32, }, + { 1, 1, 0, 1, 136, 32, }, + { 0, 1, 0, 1, 140, 28, }, + { 2, 1, 0, 1, 140, 32, }, + { 1, 1, 0, 1, 140, 32, }, + { 0, 1, 0, 1, 144, 28, }, + { 2, 1, 0, 1, 144, 63, }, + { 1, 1, 0, 1, 144, 63, }, + { 0, 1, 0, 1, 149, 32, }, + { 2, 1, 0, 1, 149, 63, }, + { 1, 1, 0, 1, 149, 63, }, + { 0, 1, 0, 1, 153, 32, }, + { 2, 1, 0, 1, 153, 63, }, + { 1, 1, 0, 1, 153, 63, }, + { 0, 1, 0, 1, 157, 32, }, + { 2, 1, 0, 1, 157, 63, }, + { 1, 1, 0, 1, 157, 63, }, + { 0, 1, 0, 1, 161, 32, }, + { 2, 1, 0, 1, 161, 63, }, + { 1, 1, 0, 1, 161, 63, }, + { 0, 1, 0, 1, 165, 32, }, + { 2, 1, 0, 1, 165, 63, }, + { 1, 1, 0, 1, 165, 63, }, + { 0, 1, 0, 2, 36, 30, }, + { 2, 1, 0, 2, 36, 32, }, + { 1, 1, 0, 2, 36, 28, }, + { 0, 1, 0, 2, 40, 32, }, + { 2, 1, 0, 2, 40, 32, }, + { 1, 1, 0, 2, 40, 28, }, + { 0, 1, 0, 2, 44, 32, }, + { 2, 1, 0, 2, 44, 32, }, + { 1, 1, 0, 2, 44, 28, }, + { 0, 1, 0, 2, 48, 32, }, + { 2, 1, 0, 2, 48, 32, }, + { 1, 1, 0, 2, 48, 28, }, + { 0, 1, 0, 2, 52, 32, }, + { 2, 1, 0, 2, 52, 32, }, + { 1, 1, 0, 2, 52, 28, }, + { 0, 1, 0, 2, 56, 32, }, + { 2, 1, 0, 2, 56, 32, }, + { 1, 1, 0, 2, 56, 28, }, + { 0, 1, 0, 2, 60, 32, }, + { 2, 1, 0, 2, 60, 32, }, + { 1, 1, 0, 2, 60, 28, }, + { 0, 1, 0, 2, 64, 28, }, + { 2, 1, 0, 2, 64, 32, }, + { 1, 1, 0, 2, 64, 28, }, + { 0, 1, 0, 2, 100, 26, }, + { 2, 1, 0, 2, 100, 32, }, + { 1, 1, 0, 2, 100, 32, }, + { 0, 1, 0, 2, 104, 32, }, + { 2, 1, 0, 2, 104, 32, }, + { 1, 1, 0, 2, 104, 32, }, + { 0, 1, 0, 2, 108, 32, }, + { 2, 1, 0, 2, 108, 32, }, + { 1, 1, 0, 2, 108, 32, }, + { 0, 1, 0, 2, 112, 32, }, + { 2, 1, 0, 2, 112, 32, }, + { 1, 1, 0, 2, 112, 32, }, + { 0, 1, 0, 2, 116, 32, }, + { 2, 1, 0, 2, 116, 32, }, + { 1, 1, 0, 2, 116, 32, }, + { 0, 1, 0, 2, 120, 32, }, + { 2, 1, 0, 2, 120, 32, }, + { 1, 1, 0, 2, 120, 32, }, + { 0, 1, 0, 2, 124, 32, }, + { 2, 1, 0, 2, 124, 32, }, + { 1, 1, 0, 2, 124, 32, }, + { 0, 1, 0, 2, 128, 32, }, + { 2, 1, 0, 2, 128, 32, }, + { 1, 1, 0, 2, 128, 32, }, + { 0, 1, 0, 2, 132, 32, }, + { 2, 1, 0, 2, 132, 32, }, + { 1, 1, 0, 2, 132, 32, }, + { 0, 1, 0, 2, 136, 32, }, + { 2, 1, 0, 2, 136, 32, }, + { 1, 1, 0, 2, 136, 32, }, + { 0, 1, 0, 2, 140, 26, }, + { 2, 1, 0, 2, 140, 32, }, + { 1, 1, 0, 2, 140, 32, }, + { 0, 1, 0, 2, 144, 26, }, + { 2, 1, 0, 2, 144, 63, }, + { 1, 1, 0, 2, 144, 63, }, + { 0, 1, 0, 2, 149, 32, }, + { 2, 1, 0, 2, 149, 63, }, + { 1, 1, 0, 2, 149, 63, }, + { 0, 1, 0, 2, 153, 32, }, + { 2, 1, 0, 2, 153, 63, }, + { 1, 1, 0, 2, 153, 63, }, + { 0, 1, 0, 2, 157, 32, }, + { 2, 1, 0, 2, 157, 63, }, + { 1, 1, 0, 2, 157, 63, }, + { 0, 1, 0, 2, 161, 32, }, + { 2, 1, 0, 2, 161, 63, }, + { 1, 1, 0, 2, 161, 63, }, + { 0, 1, 0, 2, 165, 32, }, + { 2, 1, 0, 2, 165, 63, }, + { 1, 1, 0, 2, 165, 63, }, + { 0, 1, 0, 3, 36, 28, }, + { 2, 1, 0, 3, 36, 20, }, + { 1, 1, 0, 3, 36, 22, }, + { 0, 1, 0, 3, 40, 30, }, + { 2, 1, 0, 3, 40, 20, }, + { 1, 1, 0, 3, 40, 22, }, + { 0, 1, 0, 3, 44, 30, }, + { 2, 1, 0, 3, 44, 20, }, + { 1, 1, 0, 3, 44, 22, }, + { 0, 1, 0, 3, 48, 30, }, + { 2, 1, 0, 3, 48, 20, }, + { 1, 1, 0, 3, 48, 22, }, + { 0, 1, 0, 3, 52, 30, }, + { 2, 1, 0, 3, 52, 20, }, + { 1, 1, 0, 3, 52, 22, }, + { 0, 1, 0, 3, 56, 30, }, + { 2, 1, 0, 3, 56, 20, }, + { 1, 1, 0, 3, 56, 22, }, + { 0, 1, 0, 3, 60, 30, }, + { 2, 1, 0, 3, 60, 20, }, + { 1, 1, 0, 3, 60, 22, }, + { 0, 1, 0, 3, 64, 28, }, + { 2, 1, 0, 3, 64, 20, }, + { 1, 1, 0, 3, 64, 22, }, + { 0, 1, 0, 3, 100, 26, }, + { 2, 1, 0, 3, 100, 20, }, + { 1, 1, 0, 3, 100, 30, }, + { 0, 1, 0, 3, 104, 30, }, + { 2, 1, 0, 3, 104, 20, }, + { 1, 1, 0, 3, 104, 30, }, + { 0, 1, 0, 3, 108, 32, }, + { 2, 1, 0, 3, 108, 20, }, + { 1, 1, 0, 3, 108, 30, }, + { 0, 1, 0, 3, 112, 32, }, + { 2, 1, 0, 3, 112, 20, }, + { 1, 1, 0, 3, 112, 30, }, + { 0, 1, 0, 3, 116, 32, }, + { 2, 1, 0, 3, 116, 20, }, + { 1, 1, 0, 3, 116, 30, }, + { 0, 1, 0, 3, 120, 32, }, + { 2, 1, 0, 3, 120, 20, }, + { 1, 1, 0, 3, 120, 30, }, + { 0, 1, 0, 3, 124, 32, }, + { 2, 1, 0, 3, 124, 20, }, + { 1, 1, 0, 3, 124, 30, }, + { 0, 1, 0, 3, 128, 32, }, + { 2, 1, 0, 3, 128, 20, }, + { 1, 1, 0, 3, 128, 30, }, + { 0, 1, 0, 3, 132, 32, }, + { 2, 1, 0, 3, 132, 20, }, + { 1, 1, 0, 3, 132, 30, }, + { 0, 1, 0, 3, 136, 30, }, + { 2, 1, 0, 3, 136, 20, }, + { 1, 1, 0, 3, 136, 30, }, + { 0, 1, 0, 3, 140, 26, }, + { 2, 1, 0, 3, 140, 20, }, + { 1, 1, 0, 3, 140, 30, }, + { 0, 1, 0, 3, 144, 26, }, + { 2, 1, 0, 3, 144, 63, }, + { 1, 1, 0, 3, 144, 63, }, + { 0, 1, 0, 3, 149, 32, }, + { 2, 1, 0, 3, 149, 63, }, + { 1, 1, 0, 3, 149, 63, }, + { 0, 1, 0, 3, 153, 32, }, + { 2, 1, 0, 3, 153, 63, }, + { 1, 1, 0, 3, 153, 63, }, + { 0, 1, 0, 3, 157, 32, }, + { 2, 1, 0, 3, 157, 63, }, + { 1, 1, 0, 3, 157, 63, }, + { 0, 1, 0, 3, 161, 32, }, + { 2, 1, 0, 3, 161, 63, }, + { 1, 1, 0, 3, 161, 63, }, + { 0, 1, 0, 3, 165, 32, }, + { 2, 1, 0, 3, 165, 63, }, + { 1, 1, 0, 3, 165, 63, }, + { 0, 1, 1, 2, 38, 22, }, + { 2, 1, 1, 2, 38, 30, }, + { 1, 1, 1, 2, 38, 30, }, + { 0, 1, 1, 2, 46, 30, }, + { 2, 1, 1, 2, 46, 30, }, + { 1, 1, 1, 2, 46, 30, }, + { 0, 1, 1, 2, 54, 30, }, + { 2, 1, 1, 2, 54, 30, }, + { 1, 1, 1, 2, 54, 30, }, + { 0, 1, 1, 2, 62, 24, }, + { 2, 1, 1, 2, 62, 30, }, + { 1, 1, 1, 2, 62, 30, }, + { 0, 1, 1, 2, 102, 24, }, + { 2, 1, 1, 2, 102, 30, }, + { 1, 1, 1, 2, 102, 30, }, + { 0, 1, 1, 2, 110, 30, }, + { 2, 1, 1, 2, 110, 30, }, + { 1, 1, 1, 2, 110, 30, }, + { 0, 1, 1, 2, 118, 30, }, + { 2, 1, 1, 2, 118, 30, }, + { 1, 1, 1, 2, 118, 30, }, + { 0, 1, 1, 2, 126, 30, }, + { 2, 1, 1, 2, 126, 30, }, + { 1, 1, 1, 2, 126, 30, }, + { 0, 1, 1, 2, 134, 30, }, + { 2, 1, 1, 2, 134, 30, }, + { 1, 1, 1, 2, 134, 30, }, + { 0, 1, 1, 2, 142, 30, }, + { 2, 1, 1, 2, 142, 63, }, + { 1, 1, 1, 2, 142, 63, }, + { 0, 1, 1, 2, 151, 30, }, + { 2, 1, 1, 2, 151, 63, }, + { 1, 1, 1, 2, 151, 63, }, + { 0, 1, 1, 2, 159, 30, }, + { 2, 1, 1, 2, 159, 63, }, + { 1, 1, 1, 2, 159, 63, }, + { 0, 1, 1, 3, 38, 20, }, + { 2, 1, 1, 3, 38, 20, }, + { 1, 1, 1, 3, 38, 22, }, + { 0, 1, 1, 3, 46, 30, }, + { 2, 1, 1, 3, 46, 20, }, + { 1, 1, 1, 3, 46, 22, }, + { 0, 1, 1, 3, 54, 30, }, + { 2, 1, 1, 3, 54, 20, }, + { 1, 1, 1, 3, 54, 22, }, + { 0, 1, 1, 3, 62, 22, }, + { 2, 1, 1, 3, 62, 20, }, + { 1, 1, 1, 3, 62, 22, }, + { 0, 1, 1, 3, 102, 22, }, + { 2, 1, 1, 3, 102, 20, }, + { 1, 1, 1, 3, 102, 30, }, + { 0, 1, 1, 3, 110, 30, }, + { 2, 1, 1, 3, 110, 20, }, + { 1, 1, 1, 3, 110, 30, }, + { 0, 1, 1, 3, 118, 30, }, + { 2, 1, 1, 3, 118, 20, }, + { 1, 1, 1, 3, 118, 30, }, + { 0, 1, 1, 3, 126, 30, }, + { 2, 1, 1, 3, 126, 20, }, + { 1, 1, 1, 3, 126, 30, }, + { 0, 1, 1, 3, 134, 30, }, + { 2, 1, 1, 3, 134, 20, }, + { 1, 1, 1, 3, 134, 30, }, + { 0, 1, 1, 3, 142, 30, }, + { 2, 1, 1, 3, 142, 63, }, + { 1, 1, 1, 3, 142, 63, }, + { 0, 1, 1, 3, 151, 30, }, + { 2, 1, 1, 3, 151, 63, }, + { 1, 1, 1, 3, 151, 63, }, + { 0, 1, 1, 3, 159, 30, }, + { 2, 1, 1, 3, 159, 63, }, + { 1, 1, 1, 3, 159, 63, }, + { 0, 1, 2, 4, 42, 20, }, + { 2, 1, 2, 4, 42, 30, }, + { 1, 1, 2, 4, 42, 28, }, + { 0, 1, 2, 4, 58, 20, }, + { 2, 1, 2, 4, 58, 30, }, + { 1, 1, 2, 4, 58, 28, }, + { 0, 1, 2, 4, 106, 20, }, + { 2, 1, 2, 4, 106, 30, }, + { 1, 1, 2, 4, 106, 30, }, + { 0, 1, 2, 4, 122, 30, }, + { 2, 1, 2, 4, 122, 30, }, + { 1, 1, 2, 4, 122, 30, }, + { 0, 1, 2, 4, 138, 30, }, + { 2, 1, 2, 4, 138, 63, }, + { 1, 1, 2, 4, 138, 63, }, + { 0, 1, 2, 4, 155, 30, }, + { 2, 1, 2, 4, 155, 63, }, + { 1, 1, 2, 4, 155, 63, }, + { 0, 1, 2, 5, 42, 18, }, + { 2, 1, 2, 5, 42, 20, }, + { 1, 1, 2, 5, 42, 22, }, + { 0, 1, 2, 5, 58, 18, }, + { 2, 1, 2, 5, 58, 20, }, + { 1, 1, 2, 5, 58, 22, }, + { 0, 1, 2, 5, 106, 20, }, + { 2, 1, 2, 5, 106, 20, }, + { 1, 1, 2, 5, 106, 30, }, + { 0, 1, 2, 5, 122, 30, }, + { 2, 1, 2, 5, 122, 20, }, + { 1, 1, 2, 5, 122, 30, }, + { 0, 1, 2, 5, 138, 30, }, + { 2, 1, 2, 5, 138, 63, }, + { 1, 1, 2, 5, 138, 63, }, + { 0, 1, 2, 5, 155, 30, }, + { 2, 1, 2, 5, 155, 63, }, + { 1, 1, 2, 5, 155, 63, }, +}; + +RTW_DECL_TABLE_TXPWR_LMT(rtw8822b_txpwr_lmt_type5); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b_table.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b_table.h new file mode 100644 index 0000000000000000000000000000000000000000..4140e1ccb7b1b95e2759dfddd8dde30af4b6de8a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822b_table.h @@ -0,0 +1,20 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW8822B_TABLE_H__ +#define __RTW8822B_TABLE_H__ + +extern const struct rtw_table rtw8822b_mac_tbl; +extern const struct rtw_table rtw8822b_agc_tbl; +extern const struct rtw_table rtw8822b_bb_tbl; +extern const struct rtw_table rtw8822b_bb_pg_type2_tbl; +extern const struct rtw_table rtw8822b_bb_pg_type3_tbl; +extern const struct rtw_table rtw8822b_bb_pg_type5_tbl; +extern const struct rtw_table rtw8822b_rf_a_tbl; +extern const struct rtw_table rtw8822b_rf_b_tbl; +extern const struct rtw_table rtw8822b_txpwr_lmt_type0_tbl; +extern const struct rtw_table rtw8822b_txpwr_lmt_type2_tbl; +extern const struct rtw_table rtw8822b_txpwr_lmt_type5_tbl; + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822be.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822be.c new file mode 100644 index 0000000000000000000000000000000000000000..4994950776cd9075460deac67e1696af2638a7b3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822be.c @@ -0,0 +1,31 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include "pci.h" +#include "rtw8822b.h" + +static const struct pci_device_id rtw_8822be_id_table[] = { + { + PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0xB822), + .driver_data = (kernel_ulong_t)&rtw8822b_hw_spec + }, + {} +}; +MODULE_DEVICE_TABLE(pci, rtw_8822be_id_table); + +static struct pci_driver rtw_8822be_driver = { + .name = "rtw_8822be", + .id_table = rtw_8822be_id_table, + .probe = rtw_pci_probe, + .remove = rtw_pci_remove, + .driver.pm = &rtw_pm_ops, + .shutdown = rtw_pci_shutdown, +}; +module_pci_driver(rtw_8822be_driver); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822be driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822be.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822be.h new file mode 100644 index 0000000000000000000000000000000000000000..d823ca059f5c964425ef22ab3a9d4720e95f40af --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822be.h @@ -0,0 +1,14 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_8822BE_H_ +#define __RTW_8822BE_H_ + +extern const struct dev_pm_ops rtw_pm_ops; +extern struct rtw_chip_info rtw8822b_hw_spec; +int rtw_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id); +void rtw_pci_remove(struct pci_dev *pdev); +void rtw_pci_shutdown(struct pci_dev *pdev); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822bs.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822bs.c new file mode 100644 index 0000000000000000000000000000000000000000..1ddef81dae0e814da765e52435f4f3b48e414913 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822bs.c @@ -0,0 +1,36 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) Jernej Skrabec + */ + +#include +#include "sdio_ids.h" +#include +#include "main.h" +#include "rtw8822b.h" +#include "sdio.h" + +static const struct sdio_device_id rtw_8822bs_id_table[] = { + { + SDIO_DEVICE(SDIO_VENDOR_ID_REALTEK, + SDIO_DEVICE_ID_REALTEK_RTW8822BS), + .driver_data = (kernel_ulong_t)&rtw8822b_hw_spec, + }, + {} +}; +MODULE_DEVICE_TABLE(sdio, rtw_8822bs_id_table); + +static struct sdio_driver rtw_8822bs_driver = { + .name = "rtw_8822bs", + .probe = rtw_sdio_probe, + .remove = rtw_sdio_remove, + .id_table = rtw_8822bs_id_table, + .drv = { + .pm = &rtw_sdio_pm_ops, + .shutdown = rtw_sdio_shutdown, + } +}; +module_sdio_driver(rtw_8822bs_driver); + +MODULE_AUTHOR("Jernej Skrabec "); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822bs driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822bu.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822bu.c new file mode 100644 index 0000000000000000000000000000000000000000..ab620a0b1dfc6a93abefd92fbc6cf3db19d5a2cf --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822bu.c @@ -0,0 +1,90 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include "main.h" +#include "rtw8822b.h" +#include "usb.h" + +static const struct usb_device_id rtw_8822bu_id_table[] = { + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb812, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb82c, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0x2102, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* CCNC */ + { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xb822, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Edimax EW-7822ULC */ + { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xc822, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Edimax EW-7822UTC */ + { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xd822, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Edimax */ + { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xe822, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Edimax */ + { USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0xf822, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Edimax EW-7822UAD */ + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xb81a, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Default ID */ + { USB_DEVICE_AND_INTERFACE_INFO(0x0b05, 0x1841, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* ASUS AC1300 USB-AC55 B1 */ + { USB_DEVICE_AND_INTERFACE_INFO(0x0b05, 0x184c, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* ASUS U2 */ + { USB_DEVICE_AND_INTERFACE_INFO(0x0B05, 0x19aa, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* ASUS - USB-AC58 rev A1 */ + { USB_DEVICE_AND_INTERFACE_INFO(0x0B05, 0x1870, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* ASUS */ + { USB_DEVICE_AND_INTERFACE_INFO(0x0B05, 0x1874, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* ASUS */ + { USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x331e, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Dlink - DWA-181 */ + { USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x331c, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Dlink - DWA-182 - D1 */ + {USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x331f, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec)}, /* Dlink - DWA-183 D Ver */ + { USB_DEVICE_AND_INTERFACE_INFO(0x13b1, 0x0043, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Linksys WUSB6400M */ + { USB_DEVICE_AND_INTERFACE_INFO(0x13b1, 0x0045, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Linksys WUSB3600 v2 */ + { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x012d, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-Link Archer T3U v1 */ + { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0138, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-Link Archer T3U Plus v1 */ + { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0115, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-Link Archer T4U V3 */ + { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x012e, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-LINK */ + { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0116, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-LINK */ + { USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0117, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TP-LINK */ + { USB_DEVICE_AND_INTERFACE_INFO(0x0846, 0x9055, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Netgear A6150 */ + { USB_DEVICE_AND_INTERFACE_INFO(0x0e66, 0x0025, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* Hawking HW12ACU */ + { USB_DEVICE_AND_INTERFACE_INFO(0x04ca, 0x8602, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* LiteOn */ + { USB_DEVICE_AND_INTERFACE_INFO(0x20f4, 0x808a, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822b_hw_spec) }, /* TRENDnet TEW-808UBM */ + {}, +}; +MODULE_DEVICE_TABLE(usb, rtw_8822bu_id_table); + +static int rtw8822bu_probe(struct usb_interface *intf, + const struct usb_device_id *id) +{ + return rtw_usb_probe(intf, id); +} + +static struct usb_driver rtw_8822bu_driver = { + .name = "rtw_8822bu", + .id_table = rtw_8822bu_id_table, + .probe = rtw8822bu_probe, + .disconnect = rtw_usb_disconnect, +}; +module_usb_driver(rtw_8822bu_driver); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822bu driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c.c new file mode 100644 index 0000000000000000000000000000000000000000..8078127a5e53b6da4377d844be48e694c65791bd --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c.c @@ -0,0 +1,5452 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include "main.h" +#include "coex.h" +#include "fw.h" +#include "tx.h" +#include "rx.h" +#include "phy.h" +#include "rtw8822c.h" +#include "rtw8822c_table.h" +#include "mac.h" +#include "reg.h" +#include "debug.h" +#include "util.h" +#include "bf.h" +#include "efuse.h" + +#define IQK_DONE_8822C 0xaa + +static void rtw8822c_config_trx_mode(struct rtw_dev *rtwdev, u8 tx_path, + u8 rx_path, bool is_tx2_path); + +static void rtw8822ce_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8822c_efuse *map) +{ + ether_addr_copy(efuse->addr, map->e.mac_addr); +} + +static void rtw8822cu_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8822c_efuse *map) +{ + ether_addr_copy(efuse->addr, map->u.mac_addr); +} + +static void rtw8822cs_efuse_parsing(struct rtw_efuse *efuse, + struct rtw8822c_efuse *map) +{ + ether_addr_copy(efuse->addr, map->s.mac_addr); +} + +static int rtw8822c_read_efuse(struct rtw_dev *rtwdev, u8 *log_map) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw8822c_efuse *map; + int i; + + map = (struct rtw8822c_efuse *)log_map; + + efuse->rfe_option = map->rfe_option; + efuse->rf_board_option = map->rf_board_option; + efuse->crystal_cap = map->xtal_k & XCAP_MASK; + efuse->channel_plan = map->channel_plan; + efuse->country_code[0] = map->country_code[0]; + efuse->country_code[1] = map->country_code[1]; + efuse->bt_setting = map->rf_bt_setting; + efuse->regd = map->rf_board_option & 0x7; + efuse->thermal_meter[RF_PATH_A] = map->path_a_thermal; + efuse->thermal_meter[RF_PATH_B] = map->path_b_thermal; + efuse->thermal_meter_k = + (map->path_a_thermal + map->path_b_thermal) >> 1; + efuse->power_track_type = (map->tx_pwr_calibrate_rate >> 4) & 0xf; + + for (i = 0; i < 4; i++) + efuse->txpwr_idx_table[i] = map->txpwr_idx_table[i]; + + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_PCIE: + rtw8822ce_efuse_parsing(efuse, map); + break; + case RTW_HCI_TYPE_USB: + rtw8822cu_efuse_parsing(efuse, map); + break; + case RTW_HCI_TYPE_SDIO: + rtw8822cs_efuse_parsing(efuse, map); + break; + default: + /* unsupported now */ + return -ENOTSUPP; + } + + return 0; +} + +static void rtw8822c_header_file_init(struct rtw_dev *rtwdev, bool pre) +{ + rtw_write32_set(rtwdev, REG_3WIRE, BIT_3WIRE_TX_EN | BIT_3WIRE_RX_EN); + rtw_write32_set(rtwdev, REG_3WIRE, BIT_3WIRE_PI_ON); + rtw_write32_set(rtwdev, REG_3WIRE2, BIT_3WIRE_TX_EN | BIT_3WIRE_RX_EN); + rtw_write32_set(rtwdev, REG_3WIRE2, BIT_3WIRE_PI_ON); + + if (pre) + rtw_write32_clr(rtwdev, REG_ENCCK, BIT_CCK_OFDM_BLK_EN); + else + rtw_write32_set(rtwdev, REG_ENCCK, BIT_CCK_OFDM_BLK_EN); +} + +static void rtw8822c_bb_reset(struct rtw_dev *rtwdev) +{ + rtw_write16_set(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_BB_RSTB); + rtw_write16_clr(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_BB_RSTB); + rtw_write16_set(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_BB_RSTB); +} + +static void rtw8822c_dac_backup_reg(struct rtw_dev *rtwdev, + struct rtw_backup_info *backup, + struct rtw_backup_info *backup_rf) +{ + u32 path, i; + u32 val; + u32 reg; + u32 rf_addr[DACK_RF_8822C] = {0x8f}; + u32 addrs[DACK_REG_8822C] = {0x180c, 0x1810, 0x410c, 0x4110, + 0x1c3c, 0x1c24, 0x1d70, 0x9b4, + 0x1a00, 0x1a14, 0x1d58, 0x1c38, + 0x1e24, 0x1e28, 0x1860, 0x4160}; + + for (i = 0; i < DACK_REG_8822C; i++) { + backup[i].len = 4; + backup[i].reg = addrs[i]; + backup[i].val = rtw_read32(rtwdev, addrs[i]); + } + + for (path = 0; path < DACK_PATH_8822C; path++) { + for (i = 0; i < DACK_RF_8822C; i++) { + reg = rf_addr[i]; + val = rtw_read_rf(rtwdev, path, reg, RFREG_MASK); + backup_rf[path * i + i].reg = reg; + backup_rf[path * i + i].val = val; + } + } +} + +static void rtw8822c_dac_restore_reg(struct rtw_dev *rtwdev, + struct rtw_backup_info *backup, + struct rtw_backup_info *backup_rf) +{ + u32 path, i; + u32 val; + u32 reg; + + rtw_restore_reg(rtwdev, backup, DACK_REG_8822C); + + for (path = 0; path < DACK_PATH_8822C; path++) { + for (i = 0; i < DACK_RF_8822C; i++) { + val = backup_rf[path * i + i].val; + reg = backup_rf[path * i + i].reg; + rtw_write_rf(rtwdev, path, reg, RFREG_MASK, val); + } + } +} + +static void rtw8822c_rf_minmax_cmp(struct rtw_dev *rtwdev, u32 value, + u32 *min, u32 *max) +{ + if (value >= 0x200) { + if (*min >= 0x200) { + if (*min > value) + *min = value; + } else { + *min = value; + } + if (*max >= 0x200) { + if (*max < value) + *max = value; + } + } else { + if (*min < 0x200) { + if (*min > value) + *min = value; + } + + if (*max >= 0x200) { + *max = value; + } else { + if (*max < value) + *max = value; + } + } +} + +static void __rtw8822c_dac_iq_sort(struct rtw_dev *rtwdev, u32 *v1, u32 *v2) +{ + if (*v1 >= 0x200 && *v2 >= 0x200) { + if (*v1 > *v2) + swap(*v1, *v2); + } else if (*v1 < 0x200 && *v2 < 0x200) { + if (*v1 > *v2) + swap(*v1, *v2); + } else if (*v1 < 0x200 && *v2 >= 0x200) { + swap(*v1, *v2); + } +} + +static void rtw8822c_dac_iq_sort(struct rtw_dev *rtwdev, u32 *iv, u32 *qv) +{ + u32 i, j; + + for (i = 0; i < DACK_SN_8822C - 1; i++) { + for (j = 0; j < (DACK_SN_8822C - 1 - i) ; j++) { + __rtw8822c_dac_iq_sort(rtwdev, &iv[j], &iv[j + 1]); + __rtw8822c_dac_iq_sort(rtwdev, &qv[j], &qv[j + 1]); + } + } +} + +static void rtw8822c_dac_iq_offset(struct rtw_dev *rtwdev, u32 *vec, u32 *val) +{ + u32 p, m, t, i; + + m = 0; + p = 0; + for (i = 10; i < DACK_SN_8822C - 10; i++) { + if (vec[i] > 0x200) + m = (0x400 - vec[i]) + m; + else + p = vec[i] + p; + } + + if (p > m) { + t = p - m; + t = t / (DACK_SN_8822C - 20); + } else { + t = m - p; + t = t / (DACK_SN_8822C - 20); + if (t != 0x0) + t = 0x400 - t; + } + + *val = t; +} + +static u32 rtw8822c_get_path_write_addr(u8 path) +{ + u32 base_addr; + + switch (path) { + case RF_PATH_A: + base_addr = 0x1800; + break; + case RF_PATH_B: + base_addr = 0x4100; + break; + default: + WARN_ON(1); + return -1; + } + + return base_addr; +} + +static u32 rtw8822c_get_path_read_addr(u8 path) +{ + u32 base_addr; + + switch (path) { + case RF_PATH_A: + base_addr = 0x2800; + break; + case RF_PATH_B: + base_addr = 0x4500; + break; + default: + WARN_ON(1); + return -1; + } + + return base_addr; +} + +static bool rtw8822c_dac_iq_check(struct rtw_dev *rtwdev, u32 value) +{ + bool ret = true; + + if ((value >= 0x200 && (0x400 - value) > 0x64) || + (value < 0x200 && value > 0x64)) { + ret = false; + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] Error overflow\n"); + } + + return ret; +} + +static void rtw8822c_dac_cal_iq_sample(struct rtw_dev *rtwdev, u32 *iv, u32 *qv) +{ + u32 temp; + int i = 0, cnt = 0; + + while (i < DACK_SN_8822C && cnt < 10000) { + cnt++; + temp = rtw_read32_mask(rtwdev, 0x2dbc, 0x3fffff); + iv[i] = (temp & 0x3ff000) >> 12; + qv[i] = temp & 0x3ff; + + if (rtw8822c_dac_iq_check(rtwdev, iv[i]) && + rtw8822c_dac_iq_check(rtwdev, qv[i])) + i++; + } +} + +static void rtw8822c_dac_cal_iq_search(struct rtw_dev *rtwdev, + u32 *iv, u32 *qv, + u32 *i_value, u32 *q_value) +{ + u32 i_max = 0, q_max = 0, i_min = 0, q_min = 0; + u32 i_delta, q_delta; + u32 temp; + int i, cnt = 0; + + do { + i_min = iv[0]; + i_max = iv[0]; + q_min = qv[0]; + q_max = qv[0]; + for (i = 0; i < DACK_SN_8822C; i++) { + rtw8822c_rf_minmax_cmp(rtwdev, iv[i], &i_min, &i_max); + rtw8822c_rf_minmax_cmp(rtwdev, qv[i], &q_min, &q_max); + } + + if (i_max < 0x200 && i_min < 0x200) + i_delta = i_max - i_min; + else if (i_max >= 0x200 && i_min >= 0x200) + i_delta = i_max - i_min; + else + i_delta = i_max + (0x400 - i_min); + + if (q_max < 0x200 && q_min < 0x200) + q_delta = q_max - q_min; + else if (q_max >= 0x200 && q_min >= 0x200) + q_delta = q_max - q_min; + else + q_delta = q_max + (0x400 - q_min); + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[DACK] i: min=0x%08x, max=0x%08x, delta=0x%08x\n", + i_min, i_max, i_delta); + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[DACK] q: min=0x%08x, max=0x%08x, delta=0x%08x\n", + q_min, q_max, q_delta); + + rtw8822c_dac_iq_sort(rtwdev, iv, qv); + + if (i_delta > 5 || q_delta > 5) { + temp = rtw_read32_mask(rtwdev, 0x2dbc, 0x3fffff); + iv[0] = (temp & 0x3ff000) >> 12; + qv[0] = temp & 0x3ff; + temp = rtw_read32_mask(rtwdev, 0x2dbc, 0x3fffff); + iv[DACK_SN_8822C - 1] = (temp & 0x3ff000) >> 12; + qv[DACK_SN_8822C - 1] = temp & 0x3ff; + } else { + break; + } + } while (cnt++ < 100); + + rtw8822c_dac_iq_offset(rtwdev, iv, i_value); + rtw8822c_dac_iq_offset(rtwdev, qv, q_value); +} + +static void rtw8822c_dac_cal_rf_mode(struct rtw_dev *rtwdev, + u32 *i_value, u32 *q_value) +{ + u32 iv[DACK_SN_8822C], qv[DACK_SN_8822C]; + u32 rf_a, rf_b; + + rf_a = rtw_read_rf(rtwdev, RF_PATH_A, 0x0, RFREG_MASK); + rf_b = rtw_read_rf(rtwdev, RF_PATH_B, 0x0, RFREG_MASK); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] RF path-A=0x%05x\n", rf_a); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] RF path-B=0x%05x\n", rf_b); + + rtw8822c_dac_cal_iq_sample(rtwdev, iv, qv); + rtw8822c_dac_cal_iq_search(rtwdev, iv, qv, i_value, q_value); +} + +static void rtw8822c_dac_bb_setting(struct rtw_dev *rtwdev) +{ + rtw_write32_mask(rtwdev, 0x1d58, 0xff8, 0x1ff); + rtw_write32_mask(rtwdev, 0x1a00, 0x3, 0x2); + rtw_write32_mask(rtwdev, 0x1a14, 0x300, 0x3); + rtw_write32(rtwdev, 0x1d70, 0x7e7e7e7e); + rtw_write32_mask(rtwdev, 0x180c, 0x3, 0x0); + rtw_write32_mask(rtwdev, 0x410c, 0x3, 0x0); + rtw_write32(rtwdev, 0x1b00, 0x00000008); + rtw_write8(rtwdev, 0x1bcc, 0x3f); + rtw_write32(rtwdev, 0x1b00, 0x0000000a); + rtw_write8(rtwdev, 0x1bcc, 0x3f); + rtw_write32_mask(rtwdev, 0x1e24, BIT(31), 0x0); + rtw_write32_mask(rtwdev, 0x1e28, 0xf, 0x3); +} + +static void rtw8822c_dac_cal_adc(struct rtw_dev *rtwdev, + u8 path, u32 *adc_ic, u32 *adc_qc) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 ic = 0, qc = 0, temp = 0; + u32 base_addr; + u32 path_sel; + int i; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] ADCK path(%d)\n", path); + + base_addr = rtw8822c_get_path_write_addr(path); + switch (path) { + case RF_PATH_A: + path_sel = 0xa0000; + break; + case RF_PATH_B: + path_sel = 0x80000; + break; + default: + WARN_ON(1); + return; + } + + /* ADCK step1 */ + rtw_write32_mask(rtwdev, base_addr + 0x30, BIT(30), 0x0); + if (path == RF_PATH_B) + rtw_write32(rtwdev, base_addr + 0x30, 0x30db8041); + rtw_write32(rtwdev, base_addr + 0x60, 0xf0040ff0); + rtw_write32(rtwdev, base_addr + 0x0c, 0xdff00220); + rtw_write32(rtwdev, base_addr + 0x10, 0x02dd08c4); + rtw_write32(rtwdev, base_addr + 0x0c, 0x10000260); + rtw_write_rf(rtwdev, RF_PATH_A, 0x0, RFREG_MASK, 0x10000); + rtw_write_rf(rtwdev, RF_PATH_B, 0x0, RFREG_MASK, 0x10000); + for (i = 0; i < 10; i++) { + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] ADCK count=%d\n", i); + rtw_write32(rtwdev, 0x1c3c, path_sel + 0x8003); + rtw_write32(rtwdev, 0x1c24, 0x00010002); + rtw8822c_dac_cal_rf_mode(rtwdev, &ic, &qc); + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[DACK] before: i=0x%x, q=0x%x\n", ic, qc); + + /* compensation value */ + if (ic != 0x0) { + ic = 0x400 - ic; + *adc_ic = ic; + } + if (qc != 0x0) { + qc = 0x400 - qc; + *adc_qc = qc; + } + temp = (ic & 0x3ff) | ((qc & 0x3ff) << 10); + rtw_write32(rtwdev, base_addr + 0x68, temp); + dm_info->dack_adck[path] = temp; + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] ADCK 0x%08x=0x08%x\n", + base_addr + 0x68, temp); + /* check ADC DC offset */ + rtw_write32(rtwdev, 0x1c3c, path_sel + 0x8103); + rtw8822c_dac_cal_rf_mode(rtwdev, &ic, &qc); + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[DACK] after: i=0x%08x, q=0x%08x\n", ic, qc); + if (ic >= 0x200) + ic = 0x400 - ic; + if (qc >= 0x200) + qc = 0x400 - qc; + if (ic < 5 && qc < 5) + break; + } + + /* ADCK step2 */ + rtw_write32(rtwdev, 0x1c3c, 0x00000003); + rtw_write32(rtwdev, base_addr + 0x0c, 0x10000260); + rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c4); + + /* release pull low switch on IQ path */ + rtw_write_rf(rtwdev, path, 0x8f, BIT(13), 0x1); +} + +static void rtw8822c_dac_cal_step1(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 base_addr; + u32 read_addr; + + base_addr = rtw8822c_get_path_write_addr(path); + read_addr = rtw8822c_get_path_read_addr(path); + + rtw_write32(rtwdev, base_addr + 0x68, dm_info->dack_adck[path]); + rtw_write32(rtwdev, base_addr + 0x0c, 0xdff00220); + if (path == RF_PATH_A) { + rtw_write32(rtwdev, base_addr + 0x60, 0xf0040ff0); + rtw_write32(rtwdev, 0x1c38, 0xffffffff); + } + rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c5); + rtw_write32(rtwdev, 0x9b4, 0xdb66db00); + rtw_write32(rtwdev, base_addr + 0xb0, 0x0a11fb88); + rtw_write32(rtwdev, base_addr + 0xbc, 0x0008ff81); + rtw_write32(rtwdev, base_addr + 0xc0, 0x0003d208); + rtw_write32(rtwdev, base_addr + 0xcc, 0x0a11fb88); + rtw_write32(rtwdev, base_addr + 0xd8, 0x0008ff81); + rtw_write32(rtwdev, base_addr + 0xdc, 0x0003d208); + rtw_write32(rtwdev, base_addr + 0xb8, 0x60000000); + mdelay(2); + rtw_write32(rtwdev, base_addr + 0xbc, 0x000aff8d); + mdelay(2); + rtw_write32(rtwdev, base_addr + 0xb0, 0x0a11fb89); + rtw_write32(rtwdev, base_addr + 0xcc, 0x0a11fb89); + mdelay(1); + rtw_write32(rtwdev, base_addr + 0xb8, 0x62000000); + rtw_write32(rtwdev, base_addr + 0xd4, 0x62000000); + mdelay(20); + if (!check_hw_ready(rtwdev, read_addr + 0x08, 0x7fff80, 0xffff) || + !check_hw_ready(rtwdev, read_addr + 0x34, 0x7fff80, 0xffff)) + rtw_err(rtwdev, "failed to wait for dack ready\n"); + rtw_write32(rtwdev, base_addr + 0xb8, 0x02000000); + mdelay(1); + rtw_write32(rtwdev, base_addr + 0xbc, 0x0008ff87); + rtw_write32(rtwdev, 0x9b4, 0xdb6db600); + rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c5); + rtw_write32(rtwdev, base_addr + 0xbc, 0x0008ff87); + rtw_write32(rtwdev, base_addr + 0x60, 0xf0000000); +} + +static void rtw8822c_dac_cal_step2(struct rtw_dev *rtwdev, + u8 path, u32 *ic_out, u32 *qc_out) +{ + u32 base_addr; + u32 ic, qc, ic_in, qc_in; + + base_addr = rtw8822c_get_path_write_addr(path); + rtw_write32_mask(rtwdev, base_addr + 0xbc, 0xf0000000, 0x0); + rtw_write32_mask(rtwdev, base_addr + 0xc0, 0xf, 0x8); + rtw_write32_mask(rtwdev, base_addr + 0xd8, 0xf0000000, 0x0); + rtw_write32_mask(rtwdev, base_addr + 0xdc, 0xf, 0x8); + + rtw_write32(rtwdev, 0x1b00, 0x00000008); + rtw_write8(rtwdev, 0x1bcc, 0x03f); + rtw_write32(rtwdev, base_addr + 0x0c, 0xdff00220); + rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c5); + rtw_write32(rtwdev, 0x1c3c, 0x00088103); + + rtw8822c_dac_cal_rf_mode(rtwdev, &ic_in, &qc_in); + ic = ic_in; + qc = qc_in; + + /* compensation value */ + if (ic != 0x0) + ic = 0x400 - ic; + if (qc != 0x0) + qc = 0x400 - qc; + if (ic < 0x300) { + ic = ic * 2 * 6 / 5; + ic = ic + 0x80; + } else { + ic = (0x400 - ic) * 2 * 6 / 5; + ic = 0x7f - ic; + } + if (qc < 0x300) { + qc = qc * 2 * 6 / 5; + qc = qc + 0x80; + } else { + qc = (0x400 - qc) * 2 * 6 / 5; + qc = 0x7f - qc; + } + + *ic_out = ic; + *qc_out = qc; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] before i=0x%x, q=0x%x\n", ic_in, qc_in); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] after i=0x%x, q=0x%x\n", ic, qc); +} + +static void rtw8822c_dac_cal_step3(struct rtw_dev *rtwdev, u8 path, + u32 adc_ic, u32 adc_qc, + u32 *ic_in, u32 *qc_in, + u32 *i_out, u32 *q_out) +{ + u32 base_addr; + u32 read_addr; + u32 ic, qc; + u32 temp; + + base_addr = rtw8822c_get_path_write_addr(path); + read_addr = rtw8822c_get_path_read_addr(path); + ic = *ic_in; + qc = *qc_in; + + rtw_write32(rtwdev, base_addr + 0x0c, 0xdff00220); + rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c5); + rtw_write32(rtwdev, 0x9b4, 0xdb66db00); + rtw_write32(rtwdev, base_addr + 0xb0, 0x0a11fb88); + rtw_write32(rtwdev, base_addr + 0xbc, 0xc008ff81); + rtw_write32(rtwdev, base_addr + 0xc0, 0x0003d208); + rtw_write32_mask(rtwdev, base_addr + 0xbc, 0xf0000000, ic & 0xf); + rtw_write32_mask(rtwdev, base_addr + 0xc0, 0xf, (ic & 0xf0) >> 4); + rtw_write32(rtwdev, base_addr + 0xcc, 0x0a11fb88); + rtw_write32(rtwdev, base_addr + 0xd8, 0xe008ff81); + rtw_write32(rtwdev, base_addr + 0xdc, 0x0003d208); + rtw_write32_mask(rtwdev, base_addr + 0xd8, 0xf0000000, qc & 0xf); + rtw_write32_mask(rtwdev, base_addr + 0xdc, 0xf, (qc & 0xf0) >> 4); + rtw_write32(rtwdev, base_addr + 0xb8, 0x60000000); + mdelay(2); + rtw_write32_mask(rtwdev, base_addr + 0xbc, 0xe, 0x6); + mdelay(2); + rtw_write32(rtwdev, base_addr + 0xb0, 0x0a11fb89); + rtw_write32(rtwdev, base_addr + 0xcc, 0x0a11fb89); + mdelay(1); + rtw_write32(rtwdev, base_addr + 0xb8, 0x62000000); + rtw_write32(rtwdev, base_addr + 0xd4, 0x62000000); + mdelay(20); + if (!check_hw_ready(rtwdev, read_addr + 0x24, 0x07f80000, ic) || + !check_hw_ready(rtwdev, read_addr + 0x50, 0x07f80000, qc)) + rtw_err(rtwdev, "failed to write IQ vector to hardware\n"); + rtw_write32(rtwdev, base_addr + 0xb8, 0x02000000); + mdelay(1); + rtw_write32_mask(rtwdev, base_addr + 0xbc, 0xe, 0x3); + rtw_write32(rtwdev, 0x9b4, 0xdb6db600); + + /* check DAC DC offset */ + temp = ((adc_ic + 0x10) & 0x3ff) | (((adc_qc + 0x10) & 0x3ff) << 10); + rtw_write32(rtwdev, base_addr + 0x68, temp); + rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c5); + rtw_write32(rtwdev, base_addr + 0x60, 0xf0000000); + rtw8822c_dac_cal_rf_mode(rtwdev, &ic, &qc); + if (ic >= 0x10) + ic = ic - 0x10; + else + ic = 0x400 - (0x10 - ic); + + if (qc >= 0x10) + qc = qc - 0x10; + else + qc = 0x400 - (0x10 - qc); + + *i_out = ic; + *q_out = qc; + + if (ic >= 0x200) + ic = 0x400 - ic; + if (qc >= 0x200) + qc = 0x400 - qc; + + *ic_in = ic; + *qc_in = qc; + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[DACK] after DACK i=0x%x, q=0x%x\n", *i_out, *q_out); +} + +static void rtw8822c_dac_cal_step4(struct rtw_dev *rtwdev, u8 path) +{ + u32 base_addr = rtw8822c_get_path_write_addr(path); + + rtw_write32(rtwdev, base_addr + 0x68, 0x0); + rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c4); + rtw_write32_mask(rtwdev, base_addr + 0xbc, 0x1, 0x0); + rtw_write32_mask(rtwdev, base_addr + 0x30, BIT(30), 0x1); +} + +static void rtw8822c_dac_cal_backup_vec(struct rtw_dev *rtwdev, + u8 path, u8 vec, u32 w_addr, u32 r_addr) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u16 val; + u32 i; + + if (WARN_ON(vec >= 2)) + return; + + for (i = 0; i < DACK_MSBK_BACKUP_NUM; i++) { + rtw_write32_mask(rtwdev, w_addr, 0xf0000000, i); + val = (u16)rtw_read32_mask(rtwdev, r_addr, 0x7fc0000); + dm_info->dack_msbk[path][vec][i] = val; + } +} + +static void rtw8822c_dac_cal_backup_path(struct rtw_dev *rtwdev, u8 path) +{ + u32 w_off = 0x1c; + u32 r_off = 0x2c; + u32 w_addr, r_addr; + + if (WARN_ON(path >= 2)) + return; + + /* backup I vector */ + w_addr = rtw8822c_get_path_write_addr(path) + 0xb0; + r_addr = rtw8822c_get_path_read_addr(path) + 0x10; + rtw8822c_dac_cal_backup_vec(rtwdev, path, 0, w_addr, r_addr); + + /* backup Q vector */ + w_addr = rtw8822c_get_path_write_addr(path) + 0xb0 + w_off; + r_addr = rtw8822c_get_path_read_addr(path) + 0x10 + r_off; + rtw8822c_dac_cal_backup_vec(rtwdev, path, 1, w_addr, r_addr); +} + +static void rtw8822c_dac_cal_backup_dck(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 val; + + val = (u8)rtw_read32_mask(rtwdev, REG_DCKA_I_0, 0xf0000000); + dm_info->dack_dck[RF_PATH_A][0][0] = val; + val = (u8)rtw_read32_mask(rtwdev, REG_DCKA_I_1, 0xf); + dm_info->dack_dck[RF_PATH_A][0][1] = val; + val = (u8)rtw_read32_mask(rtwdev, REG_DCKA_Q_0, 0xf0000000); + dm_info->dack_dck[RF_PATH_A][1][0] = val; + val = (u8)rtw_read32_mask(rtwdev, REG_DCKA_Q_1, 0xf); + dm_info->dack_dck[RF_PATH_A][1][1] = val; + + val = (u8)rtw_read32_mask(rtwdev, REG_DCKB_I_0, 0xf0000000); + dm_info->dack_dck[RF_PATH_B][0][0] = val; + val = (u8)rtw_read32_mask(rtwdev, REG_DCKB_I_1, 0xf); + dm_info->dack_dck[RF_PATH_B][1][0] = val; + val = (u8)rtw_read32_mask(rtwdev, REG_DCKB_Q_0, 0xf0000000); + dm_info->dack_dck[RF_PATH_B][0][1] = val; + val = (u8)rtw_read32_mask(rtwdev, REG_DCKB_Q_1, 0xf); + dm_info->dack_dck[RF_PATH_B][1][1] = val; +} + +static void rtw8822c_dac_cal_backup(struct rtw_dev *rtwdev) +{ + u32 temp[3]; + + temp[0] = rtw_read32(rtwdev, 0x1860); + temp[1] = rtw_read32(rtwdev, 0x4160); + temp[2] = rtw_read32(rtwdev, 0x9b4); + + /* set clock */ + rtw_write32(rtwdev, 0x9b4, 0xdb66db00); + + /* backup path-A I/Q */ + rtw_write32_clr(rtwdev, 0x1830, BIT(30)); + rtw_write32_mask(rtwdev, 0x1860, 0xfc000000, 0x3c); + rtw8822c_dac_cal_backup_path(rtwdev, RF_PATH_A); + + /* backup path-B I/Q */ + rtw_write32_clr(rtwdev, 0x4130, BIT(30)); + rtw_write32_mask(rtwdev, 0x4160, 0xfc000000, 0x3c); + rtw8822c_dac_cal_backup_path(rtwdev, RF_PATH_B); + + rtw8822c_dac_cal_backup_dck(rtwdev); + rtw_write32_set(rtwdev, 0x1830, BIT(30)); + rtw_write32_set(rtwdev, 0x4130, BIT(30)); + + rtw_write32(rtwdev, 0x1860, temp[0]); + rtw_write32(rtwdev, 0x4160, temp[1]); + rtw_write32(rtwdev, 0x9b4, temp[2]); +} + +static void rtw8822c_dac_cal_restore_dck(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 val; + + rtw_write32_set(rtwdev, REG_DCKA_I_0, BIT(19)); + val = dm_info->dack_dck[RF_PATH_A][0][0]; + rtw_write32_mask(rtwdev, REG_DCKA_I_0, 0xf0000000, val); + val = dm_info->dack_dck[RF_PATH_A][0][1]; + rtw_write32_mask(rtwdev, REG_DCKA_I_1, 0xf, val); + + rtw_write32_set(rtwdev, REG_DCKA_Q_0, BIT(19)); + val = dm_info->dack_dck[RF_PATH_A][1][0]; + rtw_write32_mask(rtwdev, REG_DCKA_Q_0, 0xf0000000, val); + val = dm_info->dack_dck[RF_PATH_A][1][1]; + rtw_write32_mask(rtwdev, REG_DCKA_Q_1, 0xf, val); + + rtw_write32_set(rtwdev, REG_DCKB_I_0, BIT(19)); + val = dm_info->dack_dck[RF_PATH_B][0][0]; + rtw_write32_mask(rtwdev, REG_DCKB_I_0, 0xf0000000, val); + val = dm_info->dack_dck[RF_PATH_B][0][1]; + rtw_write32_mask(rtwdev, REG_DCKB_I_1, 0xf, val); + + rtw_write32_set(rtwdev, REG_DCKB_Q_0, BIT(19)); + val = dm_info->dack_dck[RF_PATH_B][1][0]; + rtw_write32_mask(rtwdev, REG_DCKB_Q_0, 0xf0000000, val); + val = dm_info->dack_dck[RF_PATH_B][1][1]; + rtw_write32_mask(rtwdev, REG_DCKB_Q_1, 0xf, val); +} + +static void rtw8822c_dac_cal_restore_prepare(struct rtw_dev *rtwdev) +{ + rtw_write32(rtwdev, 0x9b4, 0xdb66db00); + + rtw_write32_mask(rtwdev, 0x18b0, BIT(27), 0x0); + rtw_write32_mask(rtwdev, 0x18cc, BIT(27), 0x0); + rtw_write32_mask(rtwdev, 0x41b0, BIT(27), 0x0); + rtw_write32_mask(rtwdev, 0x41cc, BIT(27), 0x0); + + rtw_write32_mask(rtwdev, 0x1830, BIT(30), 0x0); + rtw_write32_mask(rtwdev, 0x1860, 0xfc000000, 0x3c); + rtw_write32_mask(rtwdev, 0x18b4, BIT(0), 0x1); + rtw_write32_mask(rtwdev, 0x18d0, BIT(0), 0x1); + + rtw_write32_mask(rtwdev, 0x4130, BIT(30), 0x0); + rtw_write32_mask(rtwdev, 0x4160, 0xfc000000, 0x3c); + rtw_write32_mask(rtwdev, 0x41b4, BIT(0), 0x1); + rtw_write32_mask(rtwdev, 0x41d0, BIT(0), 0x1); + + rtw_write32_mask(rtwdev, 0x18b0, 0xf00, 0x0); + rtw_write32_mask(rtwdev, 0x18c0, BIT(14), 0x0); + rtw_write32_mask(rtwdev, 0x18cc, 0xf00, 0x0); + rtw_write32_mask(rtwdev, 0x18dc, BIT(14), 0x0); + + rtw_write32_mask(rtwdev, 0x18b0, BIT(0), 0x0); + rtw_write32_mask(rtwdev, 0x18cc, BIT(0), 0x0); + rtw_write32_mask(rtwdev, 0x18b0, BIT(0), 0x1); + rtw_write32_mask(rtwdev, 0x18cc, BIT(0), 0x1); + + rtw8822c_dac_cal_restore_dck(rtwdev); + + rtw_write32_mask(rtwdev, 0x18c0, 0x38000, 0x7); + rtw_write32_mask(rtwdev, 0x18dc, 0x38000, 0x7); + rtw_write32_mask(rtwdev, 0x41c0, 0x38000, 0x7); + rtw_write32_mask(rtwdev, 0x41dc, 0x38000, 0x7); + + rtw_write32_mask(rtwdev, 0x18b8, BIT(26) | BIT(25), 0x1); + rtw_write32_mask(rtwdev, 0x18d4, BIT(26) | BIT(25), 0x1); + + rtw_write32_mask(rtwdev, 0x41b0, 0xf00, 0x0); + rtw_write32_mask(rtwdev, 0x41c0, BIT(14), 0x0); + rtw_write32_mask(rtwdev, 0x41cc, 0xf00, 0x0); + rtw_write32_mask(rtwdev, 0x41dc, BIT(14), 0x0); + + rtw_write32_mask(rtwdev, 0x41b0, BIT(0), 0x0); + rtw_write32_mask(rtwdev, 0x41cc, BIT(0), 0x0); + rtw_write32_mask(rtwdev, 0x41b0, BIT(0), 0x1); + rtw_write32_mask(rtwdev, 0x41cc, BIT(0), 0x1); + + rtw_write32_mask(rtwdev, 0x41b8, BIT(26) | BIT(25), 0x1); + rtw_write32_mask(rtwdev, 0x41d4, BIT(26) | BIT(25), 0x1); +} + +static bool rtw8822c_dac_cal_restore_wait(struct rtw_dev *rtwdev, + u32 target_addr, u32 toggle_addr) +{ + u32 cnt = 0; + + do { + rtw_write32_mask(rtwdev, toggle_addr, BIT(26) | BIT(25), 0x0); + rtw_write32_mask(rtwdev, toggle_addr, BIT(26) | BIT(25), 0x2); + + if (rtw_read32_mask(rtwdev, target_addr, 0xf) == 0x6) + return true; + + } while (cnt++ < 100); + + return false; +} + +static bool rtw8822c_dac_cal_restore_path(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 w_off = 0x1c; + u32 r_off = 0x2c; + u32 w_i, r_i, w_q, r_q; + u32 value; + u32 i; + + w_i = rtw8822c_get_path_write_addr(path) + 0xb0; + r_i = rtw8822c_get_path_read_addr(path) + 0x08; + w_q = rtw8822c_get_path_write_addr(path) + 0xb0 + w_off; + r_q = rtw8822c_get_path_read_addr(path) + 0x08 + r_off; + + if (!rtw8822c_dac_cal_restore_wait(rtwdev, r_i, w_i + 0x8)) + return false; + + for (i = 0; i < DACK_MSBK_BACKUP_NUM; i++) { + rtw_write32_mask(rtwdev, w_i + 0x4, BIT(2), 0x0); + value = dm_info->dack_msbk[path][0][i]; + rtw_write32_mask(rtwdev, w_i + 0x4, 0xff8, value); + rtw_write32_mask(rtwdev, w_i, 0xf0000000, i); + rtw_write32_mask(rtwdev, w_i + 0x4, BIT(2), 0x1); + } + + rtw_write32_mask(rtwdev, w_i + 0x4, BIT(2), 0x0); + + if (!rtw8822c_dac_cal_restore_wait(rtwdev, r_q, w_q + 0x8)) + return false; + + for (i = 0; i < DACK_MSBK_BACKUP_NUM; i++) { + rtw_write32_mask(rtwdev, w_q + 0x4, BIT(2), 0x0); + value = dm_info->dack_msbk[path][1][i]; + rtw_write32_mask(rtwdev, w_q + 0x4, 0xff8, value); + rtw_write32_mask(rtwdev, w_q, 0xf0000000, i); + rtw_write32_mask(rtwdev, w_q + 0x4, BIT(2), 0x1); + } + rtw_write32_mask(rtwdev, w_q + 0x4, BIT(2), 0x0); + + rtw_write32_mask(rtwdev, w_i + 0x8, BIT(26) | BIT(25), 0x0); + rtw_write32_mask(rtwdev, w_q + 0x8, BIT(26) | BIT(25), 0x0); + rtw_write32_mask(rtwdev, w_i + 0x4, BIT(0), 0x0); + rtw_write32_mask(rtwdev, w_q + 0x4, BIT(0), 0x0); + + return true; +} + +static bool __rtw8822c_dac_cal_restore(struct rtw_dev *rtwdev) +{ + if (!rtw8822c_dac_cal_restore_path(rtwdev, RF_PATH_A)) + return false; + + if (!rtw8822c_dac_cal_restore_path(rtwdev, RF_PATH_B)) + return false; + + return true; +} + +static bool rtw8822c_dac_cal_restore(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 temp[3]; + + /* sample the first element for both path's IQ vector */ + if (dm_info->dack_msbk[RF_PATH_A][0][0] == 0 && + dm_info->dack_msbk[RF_PATH_A][1][0] == 0 && + dm_info->dack_msbk[RF_PATH_B][0][0] == 0 && + dm_info->dack_msbk[RF_PATH_B][1][0] == 0) + return false; + + temp[0] = rtw_read32(rtwdev, 0x1860); + temp[1] = rtw_read32(rtwdev, 0x4160); + temp[2] = rtw_read32(rtwdev, 0x9b4); + + rtw8822c_dac_cal_restore_prepare(rtwdev); + if (!check_hw_ready(rtwdev, 0x2808, 0x7fff80, 0xffff) || + !check_hw_ready(rtwdev, 0x2834, 0x7fff80, 0xffff) || + !check_hw_ready(rtwdev, 0x4508, 0x7fff80, 0xffff) || + !check_hw_ready(rtwdev, 0x4534, 0x7fff80, 0xffff)) + return false; + + if (!__rtw8822c_dac_cal_restore(rtwdev)) { + rtw_err(rtwdev, "failed to restore dack vectors\n"); + return false; + } + + rtw_write32_mask(rtwdev, 0x1830, BIT(30), 0x1); + rtw_write32_mask(rtwdev, 0x4130, BIT(30), 0x1); + rtw_write32(rtwdev, 0x1860, temp[0]); + rtw_write32(rtwdev, 0x4160, temp[1]); + rtw_write32_mask(rtwdev, 0x18b0, BIT(27), 0x1); + rtw_write32_mask(rtwdev, 0x18cc, BIT(27), 0x1); + rtw_write32_mask(rtwdev, 0x41b0, BIT(27), 0x1); + rtw_write32_mask(rtwdev, 0x41cc, BIT(27), 0x1); + rtw_write32(rtwdev, 0x9b4, temp[2]); + + return true; +} + +static void rtw8822c_rf_dac_cal(struct rtw_dev *rtwdev) +{ + struct rtw_backup_info backup_rf[DACK_RF_8822C * DACK_PATH_8822C]; + struct rtw_backup_info backup[DACK_REG_8822C]; + u32 ic = 0, qc = 0, i; + u32 i_a = 0x0, q_a = 0x0, i_b = 0x0, q_b = 0x0; + u32 ic_a = 0x0, qc_a = 0x0, ic_b = 0x0, qc_b = 0x0; + u32 adc_ic_a = 0x0, adc_qc_a = 0x0, adc_ic_b = 0x0, adc_qc_b = 0x0; + + if (rtw8822c_dac_cal_restore(rtwdev)) + return; + + /* not able to restore, do it */ + + rtw8822c_dac_backup_reg(rtwdev, backup, backup_rf); + + rtw8822c_dac_bb_setting(rtwdev); + + /* path-A */ + rtw8822c_dac_cal_adc(rtwdev, RF_PATH_A, &adc_ic_a, &adc_qc_a); + for (i = 0; i < 10; i++) { + rtw8822c_dac_cal_step1(rtwdev, RF_PATH_A); + rtw8822c_dac_cal_step2(rtwdev, RF_PATH_A, &ic, &qc); + ic_a = ic; + qc_a = qc; + + rtw8822c_dac_cal_step3(rtwdev, RF_PATH_A, adc_ic_a, adc_qc_a, + &ic, &qc, &i_a, &q_a); + + if (ic < 5 && qc < 5) + break; + } + rtw8822c_dac_cal_step4(rtwdev, RF_PATH_A); + + /* path-B */ + rtw8822c_dac_cal_adc(rtwdev, RF_PATH_B, &adc_ic_b, &adc_qc_b); + for (i = 0; i < 10; i++) { + rtw8822c_dac_cal_step1(rtwdev, RF_PATH_B); + rtw8822c_dac_cal_step2(rtwdev, RF_PATH_B, &ic, &qc); + ic_b = ic; + qc_b = qc; + + rtw8822c_dac_cal_step3(rtwdev, RF_PATH_B, adc_ic_b, adc_qc_b, + &ic, &qc, &i_b, &q_b); + + if (ic < 5 && qc < 5) + break; + } + rtw8822c_dac_cal_step4(rtwdev, RF_PATH_B); + + rtw_write32(rtwdev, 0x1b00, 0x00000008); + rtw_write32_mask(rtwdev, 0x4130, BIT(30), 0x1); + rtw_write8(rtwdev, 0x1bcc, 0x0); + rtw_write32(rtwdev, 0x1b00, 0x0000000a); + rtw_write8(rtwdev, 0x1bcc, 0x0); + + rtw8822c_dac_restore_reg(rtwdev, backup, backup_rf); + + /* backup results to restore, saving a lot of time */ + rtw8822c_dac_cal_backup(rtwdev); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] path A: ic=0x%x, qc=0x%x\n", ic_a, qc_a); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] path B: ic=0x%x, qc=0x%x\n", ic_b, qc_b); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] path A: i=0x%x, q=0x%x\n", i_a, q_a); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] path B: i=0x%x, q=0x%x\n", i_b, q_b); +} + +static void rtw8822c_rf_x2_check(struct rtw_dev *rtwdev) +{ + u8 x2k_busy; + + mdelay(1); + x2k_busy = rtw_read_rf(rtwdev, RF_PATH_A, 0xb8, BIT(15)); + if (x2k_busy == 1) { + rtw_write_rf(rtwdev, RF_PATH_A, 0xb8, RFREG_MASK, 0xC4440); + rtw_write_rf(rtwdev, RF_PATH_A, 0xba, RFREG_MASK, 0x6840D); + rtw_write_rf(rtwdev, RF_PATH_A, 0xb8, RFREG_MASK, 0x80440); + mdelay(1); + } +} + +static void rtw8822c_set_power_trim(struct rtw_dev *rtwdev, s8 bb_gain[2][8]) +{ +#define RF_SET_POWER_TRIM(_path, _seq, _idx) \ + do { \ + rtw_write_rf(rtwdev, _path, 0x33, RFREG_MASK, _seq); \ + rtw_write_rf(rtwdev, _path, 0x3f, RFREG_MASK, \ + bb_gain[_path][_idx]); \ + } while (0) + u8 path; + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + rtw_write_rf(rtwdev, path, 0xee, BIT(19), 1); + RF_SET_POWER_TRIM(path, 0x0, 0); + RF_SET_POWER_TRIM(path, 0x1, 1); + RF_SET_POWER_TRIM(path, 0x2, 2); + RF_SET_POWER_TRIM(path, 0x3, 2); + RF_SET_POWER_TRIM(path, 0x4, 3); + RF_SET_POWER_TRIM(path, 0x5, 4); + RF_SET_POWER_TRIM(path, 0x6, 5); + RF_SET_POWER_TRIM(path, 0x7, 6); + RF_SET_POWER_TRIM(path, 0x8, 7); + RF_SET_POWER_TRIM(path, 0x9, 3); + RF_SET_POWER_TRIM(path, 0xa, 4); + RF_SET_POWER_TRIM(path, 0xb, 5); + RF_SET_POWER_TRIM(path, 0xc, 6); + RF_SET_POWER_TRIM(path, 0xd, 7); + RF_SET_POWER_TRIM(path, 0xe, 7); + rtw_write_rf(rtwdev, path, 0xee, BIT(19), 0); + } +#undef RF_SET_POWER_TRIM +} + +static void rtw8822c_power_trim(struct rtw_dev *rtwdev) +{ + u8 pg_pwr = 0xff, i, path, idx; + s8 bb_gain[2][8] = {}; + u16 rf_efuse_2g[3] = {PPG_2GL_TXAB, PPG_2GM_TXAB, PPG_2GH_TXAB}; + u16 rf_efuse_5g[2][5] = {{PPG_5GL1_TXA, PPG_5GL2_TXA, PPG_5GM1_TXA, + PPG_5GM2_TXA, PPG_5GH1_TXA}, + {PPG_5GL1_TXB, PPG_5GL2_TXB, PPG_5GM1_TXB, + PPG_5GM2_TXB, PPG_5GH1_TXB} }; + bool set = false; + + for (i = 0; i < ARRAY_SIZE(rf_efuse_2g); i++) { + rtw_read8_physical_efuse(rtwdev, rf_efuse_2g[i], &pg_pwr); + if (pg_pwr == EFUSE_READ_FAIL) + continue; + set = true; + bb_gain[RF_PATH_A][i] = FIELD_GET(PPG_2G_A_MASK, pg_pwr); + bb_gain[RF_PATH_B][i] = FIELD_GET(PPG_2G_B_MASK, pg_pwr); + } + + for (i = 0; i < ARRAY_SIZE(rf_efuse_5g[0]); i++) { + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + rtw_read8_physical_efuse(rtwdev, rf_efuse_5g[path][i], + &pg_pwr); + if (pg_pwr == EFUSE_READ_FAIL) + continue; + set = true; + idx = i + ARRAY_SIZE(rf_efuse_2g); + bb_gain[path][idx] = FIELD_GET(PPG_5G_MASK, pg_pwr); + } + } + if (set) + rtw8822c_set_power_trim(rtwdev, bb_gain); + + rtw_write32_mask(rtwdev, REG_DIS_DPD, DIS_DPD_MASK, DIS_DPD_RATEALL); +} + +static void rtw8822c_thermal_trim(struct rtw_dev *rtwdev) +{ + u16 rf_efuse[2] = {PPG_THERMAL_A, PPG_THERMAL_B}; + u8 pg_therm = 0xff, thermal[2] = {0}, path; + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + rtw_read8_physical_efuse(rtwdev, rf_efuse[path], &pg_therm); + if (pg_therm == EFUSE_READ_FAIL) + return; + /* Efuse value of BIT(0) shall be move to BIT(3), and the value + * of BIT(1) to BIT(3) should be right shifted 1 bit. + */ + thermal[path] = FIELD_GET(GENMASK(3, 1), pg_therm); + thermal[path] |= FIELD_PREP(BIT(3), pg_therm & BIT(0)); + rtw_write_rf(rtwdev, path, 0x43, RF_THEMAL_MASK, thermal[path]); + } +} + +static void rtw8822c_pa_bias(struct rtw_dev *rtwdev) +{ + u16 rf_efuse_2g[2] = {PPG_PABIAS_2GA, PPG_PABIAS_2GB}; + u16 rf_efuse_5g[2] = {PPG_PABIAS_5GA, PPG_PABIAS_5GB}; + u8 pg_pa_bias = 0xff, path; + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + rtw_read8_physical_efuse(rtwdev, rf_efuse_2g[path], + &pg_pa_bias); + if (pg_pa_bias == EFUSE_READ_FAIL) + return; + pg_pa_bias = FIELD_GET(PPG_PABIAS_MASK, pg_pa_bias); + rtw_write_rf(rtwdev, path, RF_PA, RF_PABIAS_2G_MASK, pg_pa_bias); + } + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + rtw_read8_physical_efuse(rtwdev, rf_efuse_5g[path], + &pg_pa_bias); + pg_pa_bias = FIELD_GET(PPG_PABIAS_MASK, pg_pa_bias); + rtw_write_rf(rtwdev, path, RF_PA, RF_PABIAS_5G_MASK, pg_pa_bias); + } +} + +static void rtw8822c_rfk_handshake(struct rtw_dev *rtwdev, bool is_before_k) +{ + struct rtw_dm_info *dm = &rtwdev->dm_info; + u8 u1b_tmp; + u8 u4b_tmp; + int ret; + + if (is_before_k) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[RFK] WiFi / BT RFK handshake start!!\n"); + + if (!dm->is_bt_iqk_timeout) { + ret = read_poll_timeout(rtw_read32_mask, u4b_tmp, + u4b_tmp == 0, 20, 600000, false, + rtwdev, REG_PMC_DBG_CTRL1, + BITS_PMC_BT_IQK_STS); + if (ret) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[RFK] Wait BT IQK finish timeout!!\n"); + dm->is_bt_iqk_timeout = true; + } + } + + rtw_fw_inform_rfk_status(rtwdev, true); + + ret = read_poll_timeout(rtw_read8_mask, u1b_tmp, + u1b_tmp == 1, 20, 100000, false, + rtwdev, REG_ARFR4, BIT_WL_RFK); + if (ret) + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[RFK] Send WiFi RFK start H2C cmd FAIL!!\n"); + } else { + rtw_fw_inform_rfk_status(rtwdev, false); + ret = read_poll_timeout(rtw_read8_mask, u1b_tmp, + u1b_tmp == 1, 20, 100000, false, + rtwdev, REG_ARFR4, + BIT_WL_RFK); + if (ret) + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[RFK] Send WiFi RFK finish H2C cmd FAIL!!\n"); + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[RFK] WiFi / BT RFK handshake finish!!\n"); + } +} + +static void rtw8822c_rfk_power_save(struct rtw_dev *rtwdev, + bool is_power_save) +{ + u8 path; + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); + rtw_write32_mask(rtwdev, REG_DPD_CTL1_S0, BIT_PS_EN, + is_power_save ? 0 : 1); + } +} + +static void rtw8822c_txgapk_backup_bb_reg(struct rtw_dev *rtwdev, const u32 reg[], + u32 reg_backup[], u32 reg_num) +{ + u32 i; + + for (i = 0; i < reg_num; i++) { + reg_backup[i] = rtw_read32(rtwdev, reg[i]); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] Backup BB 0x%x = 0x%x\n", + reg[i], reg_backup[i]); + } +} + +static void rtw8822c_txgapk_reload_bb_reg(struct rtw_dev *rtwdev, + const u32 reg[], u32 reg_backup[], + u32 reg_num) +{ + u32 i; + + for (i = 0; i < reg_num; i++) { + rtw_write32(rtwdev, reg[i], reg_backup[i]); + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] Reload BB 0x%x = 0x%x\n", + reg[i], reg_backup[i]); + } +} + +static bool check_rf_status(struct rtw_dev *rtwdev, u8 status) +{ + u8 reg_rf0_a, reg_rf0_b; + + reg_rf0_a = (u8)rtw_read_rf(rtwdev, RF_PATH_A, + RF_MODE_TRXAGC, BIT_RF_MODE); + reg_rf0_b = (u8)rtw_read_rf(rtwdev, RF_PATH_B, + RF_MODE_TRXAGC, BIT_RF_MODE); + + if (reg_rf0_a == status || reg_rf0_b == status) + return false; + + return true; +} + +static void rtw8822c_txgapk_tx_pause(struct rtw_dev *rtwdev) +{ + bool status; + int ret; + + rtw_write8(rtwdev, REG_TXPAUSE, BIT_AC_QUEUE); + rtw_write32_mask(rtwdev, REG_TX_FIFO, BIT_STOP_TX, 0x2); + + ret = read_poll_timeout_atomic(check_rf_status, status, status, + 2, 5000, false, rtwdev, 2); + if (ret) + rtw_warn(rtwdev, "failed to pause TX\n"); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] Tx pause!!\n"); +} + +static void rtw8822c_txgapk_bb_dpk(struct rtw_dev *rtwdev, u8 path) +{ + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); + + rtw_write32_mask(rtwdev, REG_ENFN, BIT_IQK_DPK_EN, 0x1); + rtw_write32_mask(rtwdev, REG_CH_DELAY_EXTR2, + BIT_IQK_DPK_CLOCK_SRC, 0x1); + rtw_write32_mask(rtwdev, REG_CH_DELAY_EXTR2, + BIT_IQK_DPK_RESET_SRC, 0x1); + rtw_write32_mask(rtwdev, REG_CH_DELAY_EXTR2, BIT_EN_IOQ_IQK_DPK, 0x1); + rtw_write32_mask(rtwdev, REG_CH_DELAY_EXTR2, BIT_TST_IQK2SET_SRC, 0x0); + rtw_write32_mask(rtwdev, REG_CCA_OFF, BIT_CCA_ON_BY_PW, 0x1ff); + + if (path == RF_PATH_A) { + rtw_write32_mask(rtwdev, REG_RFTXEN_GCK_A, + BIT_RFTXEN_GCK_FORCE_ON, 0x1); + rtw_write32_mask(rtwdev, REG_3WIRE, BIT_DIS_SHARERX_TXGAT, 0x1); + rtw_write32_mask(rtwdev, REG_DIS_SHARE_RX_A, + BIT_TX_SCALE_0DB, 0x1); + rtw_write32_mask(rtwdev, REG_3WIRE, BIT_3WIRE_EN, 0x0); + } else if (path == RF_PATH_B) { + rtw_write32_mask(rtwdev, REG_RFTXEN_GCK_B, + BIT_RFTXEN_GCK_FORCE_ON, 0x1); + rtw_write32_mask(rtwdev, REG_3WIRE2, + BIT_DIS_SHARERX_TXGAT, 0x1); + rtw_write32_mask(rtwdev, REG_DIS_SHARE_RX_B, + BIT_TX_SCALE_0DB, 0x1); + rtw_write32_mask(rtwdev, REG_3WIRE2, BIT_3WIRE_EN, 0x0); + } + rtw_write32_mask(rtwdev, REG_CCKSB, BIT_BBMODE, 0x2); +} + +static void rtw8822c_txgapk_afe_dpk(struct rtw_dev *rtwdev, u8 path) +{ + u32 reg; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); + + if (path == RF_PATH_A) { + reg = REG_ANAPAR_A; + } else if (path == RF_PATH_B) { + reg = REG_ANAPAR_B; + } else { + rtw_err(rtwdev, "[TXGAPK] unknown path %d!!\n", path); + return; + } + + rtw_write32_mask(rtwdev, REG_IQK_CTRL, MASKDWORD, MASKDWORD); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x700f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x700f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x701f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x702f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x703f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x704f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x705f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x706f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x707f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x708f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x709f0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70af0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70bf0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70cf0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70df0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70ef0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70ff0001); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70ff0001); +} + +static void rtw8822c_txgapk_afe_dpk_restore(struct rtw_dev *rtwdev, u8 path) +{ + u32 reg; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); + + if (path == RF_PATH_A) { + reg = REG_ANAPAR_A; + } else if (path == RF_PATH_B) { + reg = REG_ANAPAR_B; + } else { + rtw_err(rtwdev, "[TXGAPK] unknown path %d!!\n", path); + return; + } + rtw_write32_mask(rtwdev, REG_IQK_CTRL, MASKDWORD, 0xffa1005e); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x700b8041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70144041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70244041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70344041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70444041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x705b8041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70644041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x707b8041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x708b8041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x709b8041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70ab8041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70bb8041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70cb8041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70db8041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70eb8041); + rtw_write32_mask(rtwdev, reg, MASKDWORD, 0x70fb8041); +} + +static void rtw8822c_txgapk_bb_dpk_restore(struct rtw_dev *rtwdev, u8 path) +{ + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); + + rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TX_GAIN, 0x0); + rtw_write_rf(rtwdev, path, RF_DIS_BYPASS_TXBB, BIT_TIA_BYPASS, 0x0); + rtw_write_rf(rtwdev, path, RF_DIS_BYPASS_TXBB, BIT_TXBB, 0x0); + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, 0x0); + rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0); + rtw_write32_mask(rtwdev, REG_SINGLE_TONE_SW, BIT_IRQ_TEST_MODE, 0x0); + rtw_write32_mask(rtwdev, REG_R_CONFIG, MASKBYTE0, 0x00); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, 0x1); + rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0); + rtw_write32_mask(rtwdev, REG_SINGLE_TONE_SW, BIT_IRQ_TEST_MODE, 0x0); + rtw_write32_mask(rtwdev, REG_R_CONFIG, MASKBYTE0, 0x00); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, 0x0); + rtw_write32_mask(rtwdev, REG_CCA_OFF, BIT_CCA_ON_BY_PW, 0x0); + + if (path == RF_PATH_A) { + rtw_write32_mask(rtwdev, REG_RFTXEN_GCK_A, + BIT_RFTXEN_GCK_FORCE_ON, 0x0); + rtw_write32_mask(rtwdev, REG_3WIRE, BIT_DIS_SHARERX_TXGAT, 0x0); + rtw_write32_mask(rtwdev, REG_DIS_SHARE_RX_A, + BIT_TX_SCALE_0DB, 0x0); + rtw_write32_mask(rtwdev, REG_3WIRE, BIT_3WIRE_EN, 0x3); + } else if (path == RF_PATH_B) { + rtw_write32_mask(rtwdev, REG_RFTXEN_GCK_B, + BIT_RFTXEN_GCK_FORCE_ON, 0x0); + rtw_write32_mask(rtwdev, REG_3WIRE2, + BIT_DIS_SHARERX_TXGAT, 0x0); + rtw_write32_mask(rtwdev, REG_DIS_SHARE_RX_B, + BIT_TX_SCALE_0DB, 0x0); + rtw_write32_mask(rtwdev, REG_3WIRE2, BIT_3WIRE_EN, 0x3); + } + + rtw_write32_mask(rtwdev, REG_CCKSB, BIT_BBMODE, 0x0); + rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_CFIR_EN, 0x5); +} + +static bool _rtw8822c_txgapk_gain_valid(struct rtw_dev *rtwdev, u32 gain) +{ + if ((FIELD_GET(BIT_GAIN_TX_PAD_H, gain) >= 0xc) && + (FIELD_GET(BIT_GAIN_TX_PAD_L, gain) >= 0xe)) + return true; + + return false; +} + +static void _rtw8822c_txgapk_write_gain_bb_table(struct rtw_dev *rtwdev, + u8 band, u8 path) +{ + struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; + u32 v, tmp_3f = 0; + u8 gain, check_txgain; + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); + + switch (band) { + case RF_BAND_2G_OFDM: + rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x0); + break; + case RF_BAND_5G_L: + rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x2); + break; + case RF_BAND_5G_M: + rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x3); + break; + case RF_BAND_5G_H: + rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x4); + break; + default: + break; + } + + rtw_write32_mask(rtwdev, REG_TX_GAIN_SET, MASKBYTE0, 0x88); + + check_txgain = 0; + for (gain = 0; gain < RF_GAIN_NUM; gain++) { + v = txgapk->rf3f_bp[band][gain][path]; + if (_rtw8822c_txgapk_gain_valid(rtwdev, v)) { + if (!check_txgain) { + tmp_3f = txgapk->rf3f_bp[band][gain][path]; + check_txgain = 1; + } + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] tx_gain=0x%03X >= 0xCEX\n", + txgapk->rf3f_bp[band][gain][path]); + } else { + tmp_3f = txgapk->rf3f_bp[band][gain][path]; + } + + rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN, tmp_3f); + rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_I_GAIN, gain); + rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_GAIN_RST, 0x1); + rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_GAIN_RST, 0x0); + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] Band=%d 0x1b98[11:0]=0x%03X path=%d\n", + band, tmp_3f, path); + } +} + +static void rtw8822c_txgapk_write_gain_bb_table(struct rtw_dev *rtwdev) +{ + u8 path, band; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s channel=%d\n", + __func__, rtwdev->dm_info.gapk.channel); + + for (band = 0; band < RF_BAND_MAX; band++) { + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + _rtw8822c_txgapk_write_gain_bb_table(rtwdev, + band, path); + } + } +} + +static void rtw8822c_txgapk_read_offset(struct rtw_dev *rtwdev, u8 path) +{ + static const u32 cfg1_1b00[2] = {0x00000d18, 0x00000d2a}; + static const u32 cfg2_1b00[2] = {0x00000d19, 0x00000d2b}; + static const u32 set_pi[2] = {REG_RSV_CTRL, REG_WLRF1}; + static const u32 path_setting[2] = {REG_ORITXCODE, REG_ORITXCODE2}; + struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; + u8 channel = txgapk->channel; + u32 val; + int i; + + if (path >= ARRAY_SIZE(cfg1_1b00) || + path >= ARRAY_SIZE(cfg2_1b00) || + path >= ARRAY_SIZE(set_pi) || + path >= ARRAY_SIZE(path_setting)) { + rtw_warn(rtwdev, "[TXGAPK] wrong path %d\n", path); + return; + } + + rtw_write32_mask(rtwdev, REG_ANTMAP0, BIT_ANT_PATH, path + 1); + rtw_write32_mask(rtwdev, REG_TXLGMAP, MASKDWORD, 0xe4e40000); + rtw_write32_mask(rtwdev, REG_TXANTSEG, BIT_ANTSEG, 0x3); + rtw_write32_mask(rtwdev, path_setting[path], MASK20BITS, 0x33312); + rtw_write32_mask(rtwdev, path_setting[path], BIT_PATH_EN, 0x1); + rtw_write32_mask(rtwdev, set_pi[path], BITS_RFC_DIRECT, 0x0); + rtw_write_rf(rtwdev, path, RF_LUTDBG, BIT_TXA_TANK, 0x1); + rtw_write_rf(rtwdev, path, RF_IDAC, BIT_TX_MODE, 0x820); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); + rtw_write32_mask(rtwdev, REG_IQKSTAT, MASKBYTE0, 0x0); + + rtw_write32_mask(rtwdev, REG_TX_TONE_IDX, MASKBYTE0, 0x018); + fsleep(1000); + if (channel >= 1 && channel <= 14) + rtw_write32_mask(rtwdev, REG_R_CONFIG, MASKBYTE0, BIT_2G_SWING); + else + rtw_write32_mask(rtwdev, REG_R_CONFIG, MASKBYTE0, BIT_5G_SWING); + fsleep(1000); + + rtw_write32_mask(rtwdev, REG_NCTL0, MASKDWORD, cfg1_1b00[path]); + rtw_write32_mask(rtwdev, REG_NCTL0, MASKDWORD, cfg2_1b00[path]); + + read_poll_timeout(rtw_read32_mask, val, + val == 0x55, 1000, 100000, false, + rtwdev, REG_RPT_CIP, BIT_RPT_CIP_STATUS); + + rtw_write32_mask(rtwdev, set_pi[path], BITS_RFC_DIRECT, 0x2); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); + rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_RPT_EN, 0x1); + rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_RPT_SEL, 0x12); + rtw_write32_mask(rtwdev, REG_TX_GAIN_SET, BIT_GAPK_RPT_IDX, 0x3); + val = rtw_read32(rtwdev, REG_STAT_RPT); + + txgapk->offset[0][path] = (s8)FIELD_GET(BIT_GAPK_RPT0, val); + txgapk->offset[1][path] = (s8)FIELD_GET(BIT_GAPK_RPT1, val); + txgapk->offset[2][path] = (s8)FIELD_GET(BIT_GAPK_RPT2, val); + txgapk->offset[3][path] = (s8)FIELD_GET(BIT_GAPK_RPT3, val); + txgapk->offset[4][path] = (s8)FIELD_GET(BIT_GAPK_RPT4, val); + txgapk->offset[5][path] = (s8)FIELD_GET(BIT_GAPK_RPT5, val); + txgapk->offset[6][path] = (s8)FIELD_GET(BIT_GAPK_RPT6, val); + txgapk->offset[7][path] = (s8)FIELD_GET(BIT_GAPK_RPT7, val); + + rtw_write32_mask(rtwdev, REG_TX_GAIN_SET, BIT_GAPK_RPT_IDX, 0x4); + val = rtw_read32(rtwdev, REG_STAT_RPT); + + txgapk->offset[8][path] = (s8)FIELD_GET(BIT_GAPK_RPT0, val); + txgapk->offset[9][path] = (s8)FIELD_GET(BIT_GAPK_RPT1, val); + + for (i = 0; i < RF_HW_OFFSET_NUM; i++) + if (txgapk->offset[i][path] & BIT(3)) + txgapk->offset[i][path] = txgapk->offset[i][path] | + 0xf0; + for (i = 0; i < RF_HW_OFFSET_NUM; i++) + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] offset %d %d path=%d\n", + txgapk->offset[i][path], i, path); +} + +static void rtw8822c_txgapk_calculate_offset(struct rtw_dev *rtwdev, u8 path) +{ + static const u32 bb_reg[] = {REG_ANTMAP0, REG_TXLGMAP, REG_TXANTSEG, + REG_ORITXCODE, REG_ORITXCODE2}; + struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; + u8 channel = txgapk->channel; + u32 reg_backup[ARRAY_SIZE(bb_reg)] = {0}; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s channel=%d\n", + __func__, channel); + + rtw8822c_txgapk_backup_bb_reg(rtwdev, bb_reg, + reg_backup, ARRAY_SIZE(bb_reg)); + + if (channel >= 1 && channel <= 14) { + rtw_write32_mask(rtwdev, + REG_SINGLE_TONE_SW, BIT_IRQ_TEST_MODE, 0x0); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); + rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x3f); + rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0); + rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TX_GAIN, 0x1); + rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, RFREG_MASK, 0x5000f); + rtw_write_rf(rtwdev, path, RF_TX_GAIN_OFFSET, BIT_RF_GAIN, 0x0); + rtw_write_rf(rtwdev, path, RF_RXG_GAIN, BIT_RXG_GAIN, 0x1); + rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_RXAGC, 0x0f); + rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TRXBW, 0x1); + rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_TXBB, 0x1); + rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_RXBB, 0x0); + rtw_write_rf(rtwdev, path, RF_EXT_TIA_BW, BIT_PW_EXT_TIA, 0x1); + + rtw_write32_mask(rtwdev, REG_IQKSTAT, MASKBYTE0, 0x00); + rtw_write32_mask(rtwdev, REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x0); + + rtw8822c_txgapk_read_offset(rtwdev, path); + rtw_dbg(rtwdev, RTW_DBG_RFK, "=============================\n"); + + } else { + rtw_write32_mask(rtwdev, + REG_SINGLE_TONE_SW, BIT_IRQ_TEST_MODE, 0x0); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SEL_PATH, path); + rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x3f); + rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0); + rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TX_GAIN, 0x1); + rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, RFREG_MASK, 0x50011); + rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_TXA_LB_ATT, 0x3); + rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_LB_ATT, 0x3); + rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_LB_SW, 0x1); + rtw_write_rf(rtwdev, path, + RF_RXA_MIX_GAIN, BIT_RXA_MIX_GAIN, 0x2); + rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_RXAGC, 0x12); + rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TRXBW, 0x1); + rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_RXBB, 0x0); + rtw_write_rf(rtwdev, path, RF_EXT_TIA_BW, BIT_PW_EXT_TIA, 0x1); + rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_RF_MODE, 0x5); + + rtw_write32_mask(rtwdev, REG_IQKSTAT, MASKBYTE0, 0x0); + + if (channel >= 36 && channel <= 64) + rtw_write32_mask(rtwdev, + REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x2); + else if (channel >= 100 && channel <= 144) + rtw_write32_mask(rtwdev, + REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x3); + else if (channel >= 149 && channel <= 177) + rtw_write32_mask(rtwdev, + REG_TABLE_SEL, BIT_Q_GAIN_SEL, 0x4); + + rtw8822c_txgapk_read_offset(rtwdev, path); + rtw_dbg(rtwdev, RTW_DBG_RFK, "=============================\n"); + } + rtw8822c_txgapk_reload_bb_reg(rtwdev, bb_reg, + reg_backup, ARRAY_SIZE(bb_reg)); +} + +static void rtw8822c_txgapk_rf_restore(struct rtw_dev *rtwdev, u8 path) +{ + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); + + if (path >= rtwdev->hal.rf_path_num) + return; + + rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_RF_MODE, 0x3); + rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TRXBW, 0x0); + rtw_write_rf(rtwdev, path, RF_EXT_TIA_BW, BIT_PW_EXT_TIA, 0x0); +} + +static u32 rtw8822c_txgapk_cal_gain(struct rtw_dev *rtwdev, u32 gain, s8 offset) +{ + u32 gain_x2, new_gain; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); + + if (_rtw8822c_txgapk_gain_valid(rtwdev, gain)) { + new_gain = gain; + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] gain=0x%03X(>=0xCEX) offset=%d new_gain=0x%03X\n", + gain, offset, new_gain); + return new_gain; + } + + gain_x2 = (gain << 1) + offset; + new_gain = (gain_x2 >> 1) | (gain_x2 & BIT(0) ? BIT_GAIN_EXT : 0); + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] gain=0x%X offset=%d new_gain=0x%X\n", + gain, offset, new_gain); + + return new_gain; +} + +static void rtw8822c_txgapk_write_tx_gain(struct rtw_dev *rtwdev) +{ + struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; + u32 i, j, tmp = 0x20, tmp_3f, v; + s8 offset_tmp[RF_GAIN_NUM] = {0}; + u8 path, band = RF_BAND_2G_OFDM, channel = txgapk->channel; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); + + if (channel >= 1 && channel <= 14) { + tmp = 0x20; + band = RF_BAND_2G_OFDM; + } else if (channel >= 36 && channel <= 64) { + tmp = 0x200; + band = RF_BAND_5G_L; + } else if (channel >= 100 && channel <= 144) { + tmp = 0x280; + band = RF_BAND_5G_M; + } else if (channel >= 149 && channel <= 177) { + tmp = 0x300; + band = RF_BAND_5G_H; + } else { + rtw_err(rtwdev, "[TXGAPK] unknown channel %d!!\n", channel); + return; + } + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + for (i = 0; i < RF_GAIN_NUM; i++) { + offset_tmp[i] = 0; + for (j = i; j < RF_GAIN_NUM; j++) { + v = txgapk->rf3f_bp[band][j][path]; + if (_rtw8822c_txgapk_gain_valid(rtwdev, v)) + continue; + + offset_tmp[i] += txgapk->offset[j][path]; + txgapk->fianl_offset[i][path] = offset_tmp[i]; + } + + v = txgapk->rf3f_bp[band][i][path]; + if (_rtw8822c_txgapk_gain_valid(rtwdev, v)) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] tx_gain=0x%03X >= 0xCEX\n", + txgapk->rf3f_bp[band][i][path]); + } else { + txgapk->rf3f_fs[path][i] = offset_tmp[i]; + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] offset %d %d\n", + offset_tmp[i], i); + } + } + + rtw_write_rf(rtwdev, path, RF_LUTWE2, RFREG_MASK, 0x10000); + for (i = 0; i < RF_GAIN_NUM; i++) { + rtw_write_rf(rtwdev, path, + RF_LUTWA, RFREG_MASK, tmp + i); + + tmp_3f = rtw8822c_txgapk_cal_gain(rtwdev, + txgapk->rf3f_bp[band][i][path], + offset_tmp[i]); + rtw_write_rf(rtwdev, path, RF_LUTWD0, + BIT_GAIN_EXT | BIT_DATA_L, tmp_3f); + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] 0x33=0x%05X 0x3f=0x%04X\n", + tmp + i, tmp_3f); + } + rtw_write_rf(rtwdev, path, RF_LUTWE2, RFREG_MASK, 0x0); + } +} + +static void rtw8822c_txgapk_save_all_tx_gain_table(struct rtw_dev *rtwdev) +{ + struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; + static const u32 three_wire[2] = {REG_3WIRE, REG_3WIRE2}; + static const u8 ch_num[RF_BAND_MAX] = {1, 1, 36, 100, 149}; + static const u8 band_num[RF_BAND_MAX] = {0x0, 0x0, 0x1, 0x3, 0x5}; + static const u8 cck[RF_BAND_MAX] = {0x1, 0x0, 0x0, 0x0, 0x0}; + u8 path, band, gain, rf0_idx; + u32 rf18, v; + + if (rtwdev->dm_info.dm_flags & BIT(RTW_DM_CAP_TXGAPK)) + return; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); + + if (txgapk->read_txgain == 1) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] Already Read txgapk->read_txgain return!!!\n"); + rtw8822c_txgapk_write_gain_bb_table(rtwdev); + return; + } + + for (band = 0; band < RF_BAND_MAX; band++) { + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + rf18 = rtw_read_rf(rtwdev, path, RF_CFGCH, RFREG_MASK); + + rtw_write32_mask(rtwdev, + three_wire[path], BIT_3WIRE_EN, 0x0); + rtw_write_rf(rtwdev, path, + RF_CFGCH, MASKBYTE0, ch_num[band]); + rtw_write_rf(rtwdev, path, + RF_CFGCH, BIT_BAND, band_num[band]); + rtw_write_rf(rtwdev, path, + RF_BW_TRXBB, BIT_DBG_CCK_CCA, cck[band]); + rtw_write_rf(rtwdev, path, + RF_BW_TRXBB, BIT_TX_CCK_IND, cck[band]); + gain = 0; + for (rf0_idx = 1; rf0_idx < 32; rf0_idx += 3) { + rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, + MASKBYTE0, rf0_idx); + v = rtw_read_rf(rtwdev, path, + RF_TX_RESULT, RFREG_MASK); + txgapk->rf3f_bp[band][gain][path] = v & BIT_DATA_L; + + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] 0x5f=0x%03X band=%d path=%d\n", + txgapk->rf3f_bp[band][gain][path], + band, path); + gain++; + } + rtw_write_rf(rtwdev, path, RF_CFGCH, RFREG_MASK, rf18); + rtw_write32_mask(rtwdev, + three_wire[path], BIT_3WIRE_EN, 0x3); + } + } + rtw8822c_txgapk_write_gain_bb_table(rtwdev); + txgapk->read_txgain = 1; +} + +static void rtw8822c_txgapk(struct rtw_dev *rtwdev) +{ + static const u32 bb_reg[2] = {REG_TX_PTCL_CTRL, REG_TX_FIFO}; + struct rtw_gapk_info *txgapk = &rtwdev->dm_info.gapk; + u32 bb_reg_backup[2]; + u8 path; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] ======>%s\n", __func__); + + rtw8822c_txgapk_save_all_tx_gain_table(rtwdev); + + if (txgapk->read_txgain == 0) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] txgapk->read_txgain == 0 return!!!\n"); + return; + } + + if (rtwdev->efuse.power_track_type >= 4 && + rtwdev->efuse.power_track_type <= 7) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[TXGAPK] Normal Mode in TSSI mode. return!!!\n"); + return; + } + + rtw8822c_txgapk_backup_bb_reg(rtwdev, bb_reg, + bb_reg_backup, ARRAY_SIZE(bb_reg)); + rtw8822c_txgapk_tx_pause(rtwdev); + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + txgapk->channel = rtw_read_rf(rtwdev, path, + RF_CFGCH, RFREG_MASK) & MASKBYTE0; + rtw8822c_txgapk_bb_dpk(rtwdev, path); + rtw8822c_txgapk_afe_dpk(rtwdev, path); + rtw8822c_txgapk_calculate_offset(rtwdev, path); + rtw8822c_txgapk_rf_restore(rtwdev, path); + rtw8822c_txgapk_afe_dpk_restore(rtwdev, path); + rtw8822c_txgapk_bb_dpk_restore(rtwdev, path); + } + rtw8822c_txgapk_write_tx_gain(rtwdev); + rtw8822c_txgapk_reload_bb_reg(rtwdev, bb_reg, + bb_reg_backup, ARRAY_SIZE(bb_reg)); +} + +static void rtw8822c_do_gapk(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm = &rtwdev->dm_info; + + if (dm->dm_flags & BIT(RTW_DM_CAP_TXGAPK)) { + rtw_dbg(rtwdev, RTW_DBG_RFK, "[TXGAPK] feature disable!!!\n"); + return; + } + rtw8822c_rfk_handshake(rtwdev, true); + rtw8822c_txgapk(rtwdev); + rtw8822c_rfk_handshake(rtwdev, false); +} + +static void rtw8822c_rf_init(struct rtw_dev *rtwdev) +{ + rtw8822c_rf_dac_cal(rtwdev); + rtw8822c_rf_x2_check(rtwdev); + rtw8822c_thermal_trim(rtwdev); + rtw8822c_power_trim(rtwdev); + rtw8822c_pa_bias(rtwdev); +} + +static void rtw8822c_pwrtrack_init(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 path; + + for (path = RF_PATH_A; path < RTW_RF_PATH_MAX; path++) { + dm_info->delta_power_index[path] = 0; + ewma_thermal_init(&dm_info->avg_thermal[path]); + dm_info->thermal_avg[path] = 0xff; + } + + dm_info->pwr_trk_triggered = false; + dm_info->thermal_meter_k = rtwdev->efuse.thermal_meter_k; + dm_info->thermal_meter_lck = rtwdev->efuse.thermal_meter_k; +} + +static void rtw8822c_phy_set_param(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_hal *hal = &rtwdev->hal; + u8 crystal_cap; + u8 cck_gi_u_bnd_msb = 0; + u8 cck_gi_u_bnd_lsb = 0; + u8 cck_gi_l_bnd_msb = 0; + u8 cck_gi_l_bnd_lsb = 0; + bool is_tx2_path; + + /* power on BB/RF domain */ + rtw_write8_set(rtwdev, REG_SYS_FUNC_EN, + BIT_FEN_BB_GLB_RST | BIT_FEN_BB_RSTB); + rtw_write8_set(rtwdev, REG_RF_CTRL, + BIT_RF_EN | BIT_RF_RSTB | BIT_RF_SDM_RSTB); + rtw_write32_set(rtwdev, REG_WLRF1, BIT_WLRF1_BBRF_EN); + + /* disable low rate DPD */ + rtw_write32_mask(rtwdev, REG_DIS_DPD, DIS_DPD_MASK, DIS_DPD_RATEALL); + + /* pre init before header files config */ + rtw8822c_header_file_init(rtwdev, true); + + rtw_phy_load_tables(rtwdev); + + crystal_cap = rtwdev->efuse.crystal_cap & 0x7f; + rtw_write32_mask(rtwdev, REG_ANAPAR_XTAL_0, 0xfffc00, + crystal_cap | (crystal_cap << 7)); + + /* post init after header files config */ + rtw8822c_header_file_init(rtwdev, false); + + is_tx2_path = false; + rtw8822c_config_trx_mode(rtwdev, hal->antenna_tx, hal->antenna_rx, + is_tx2_path); + rtw_phy_init(rtwdev); + + cck_gi_u_bnd_msb = (u8)rtw_read32_mask(rtwdev, 0x1a98, 0xc000); + cck_gi_u_bnd_lsb = (u8)rtw_read32_mask(rtwdev, 0x1aa8, 0xf0000); + cck_gi_l_bnd_msb = (u8)rtw_read32_mask(rtwdev, 0x1a98, 0xc0); + cck_gi_l_bnd_lsb = (u8)rtw_read32_mask(rtwdev, 0x1a70, 0x0f000000); + + dm_info->cck_gi_u_bnd = ((cck_gi_u_bnd_msb << 4) | (cck_gi_u_bnd_lsb)); + dm_info->cck_gi_l_bnd = ((cck_gi_l_bnd_msb << 4) | (cck_gi_l_bnd_lsb)); + + rtw8822c_rf_init(rtwdev); + rtw8822c_pwrtrack_init(rtwdev); + + rtw_bf_phy_init(rtwdev); +} + +#define WLAN_TXQ_RPT_EN 0x1F +#define WLAN_SLOT_TIME 0x09 +#define WLAN_PIFS_TIME 0x1C +#define WLAN_SIFS_CCK_CONT_TX 0x0A +#define WLAN_SIFS_OFDM_CONT_TX 0x0E +#define WLAN_SIFS_CCK_TRX 0x0A +#define WLAN_SIFS_OFDM_TRX 0x10 +#define WLAN_NAV_MAX 0xC8 +#define WLAN_RDG_NAV 0x05 +#define WLAN_TXOP_NAV 0x1B +#define WLAN_CCK_RX_TSF 0x30 +#define WLAN_OFDM_RX_TSF 0x30 +#define WLAN_TBTT_PROHIBIT 0x04 /* unit : 32us */ +#define WLAN_TBTT_HOLD_TIME 0x064 /* unit : 32us */ +#define WLAN_DRV_EARLY_INT 0x04 +#define WLAN_BCN_CTRL_CLT0 0x10 +#define WLAN_BCN_DMA_TIME 0x02 +#define WLAN_BCN_MAX_ERR 0xFF +#define WLAN_SIFS_CCK_DUR_TUNE 0x0A +#define WLAN_SIFS_OFDM_DUR_TUNE 0x10 +#define WLAN_SIFS_CCK_CTX 0x0A +#define WLAN_SIFS_CCK_IRX 0x0A +#define WLAN_SIFS_OFDM_CTX 0x0E +#define WLAN_SIFS_OFDM_IRX 0x0E +#define WLAN_EIFS_DUR_TUNE 0x40 +#define WLAN_EDCA_VO_PARAM 0x002FA226 +#define WLAN_EDCA_VI_PARAM 0x005EA328 +#define WLAN_EDCA_BE_PARAM 0x005EA42B +#define WLAN_EDCA_BK_PARAM 0x0000A44F + +#define WLAN_RX_FILTER0 0xFFFFFFFF +#define WLAN_RX_FILTER2 0xFFFF +#define WLAN_RCR_CFG 0xE400220E +#define WLAN_RXPKT_MAX_SZ 12288 +#define WLAN_RXPKT_MAX_SZ_512 (WLAN_RXPKT_MAX_SZ >> 9) + +#define WLAN_AMPDU_MAX_TIME 0x70 +#define WLAN_RTS_LEN_TH 0xFF +#define WLAN_RTS_TX_TIME_TH 0x08 +#define WLAN_MAX_AGG_PKT_LIMIT 0x3f +#define WLAN_RTS_MAX_AGG_PKT_LIMIT 0x3f +#define WLAN_PRE_TXCNT_TIME_TH 0x1E0 +#define FAST_EDCA_VO_TH 0x06 +#define FAST_EDCA_VI_TH 0x06 +#define FAST_EDCA_BE_TH 0x06 +#define FAST_EDCA_BK_TH 0x06 +#define WLAN_BAR_RETRY_LIMIT 0x01 +#define WLAN_BAR_ACK_TYPE 0x05 +#define WLAN_RA_TRY_RATE_AGG_LIMIT 0x08 +#define WLAN_RESP_TXRATE 0x84 +#define WLAN_ACK_TO 0x21 +#define WLAN_ACK_TO_CCK 0x6A +#define WLAN_DATA_RATE_FB_CNT_1_4 0x01000000 +#define WLAN_DATA_RATE_FB_CNT_5_8 0x08070504 +#define WLAN_RTS_RATE_FB_CNT_5_8 0x08070504 +#define WLAN_DATA_RATE_FB_RATE0 0xFE01F010 +#define WLAN_DATA_RATE_FB_RATE0_H 0x40000000 +#define WLAN_RTS_RATE_FB_RATE1 0x003FF010 +#define WLAN_RTS_RATE_FB_RATE1_H 0x40000000 +#define WLAN_RTS_RATE_FB_RATE4 0x0600F010 +#define WLAN_RTS_RATE_FB_RATE4_H 0x400003E0 +#define WLAN_RTS_RATE_FB_RATE5 0x0600F015 +#define WLAN_RTS_RATE_FB_RATE5_H 0x000000E0 +#define WLAN_MULTI_ADDR 0xFFFFFFFF + +#define WLAN_TX_FUNC_CFG1 0x30 +#define WLAN_TX_FUNC_CFG2 0x30 +#define WLAN_MAC_OPT_NORM_FUNC1 0x98 +#define WLAN_MAC_OPT_LB_FUNC1 0x80 +#define WLAN_MAC_OPT_FUNC2 0xb0810041 +#define WLAN_MAC_INT_MIG_CFG 0x33330000 + +#define WLAN_SIFS_CFG (WLAN_SIFS_CCK_CONT_TX | \ + (WLAN_SIFS_OFDM_CONT_TX << BIT_SHIFT_SIFS_OFDM_CTX) | \ + (WLAN_SIFS_CCK_TRX << BIT_SHIFT_SIFS_CCK_TRX) | \ + (WLAN_SIFS_OFDM_TRX << BIT_SHIFT_SIFS_OFDM_TRX)) + +#define WLAN_SIFS_DUR_TUNE (WLAN_SIFS_CCK_DUR_TUNE | \ + (WLAN_SIFS_OFDM_DUR_TUNE << 8)) + +#define WLAN_TBTT_TIME (WLAN_TBTT_PROHIBIT |\ + (WLAN_TBTT_HOLD_TIME << BIT_SHIFT_TBTT_HOLD_TIME_AP)) + +#define WLAN_NAV_CFG (WLAN_RDG_NAV | (WLAN_TXOP_NAV << 16)) +#define WLAN_RX_TSF_CFG (WLAN_CCK_RX_TSF | (WLAN_OFDM_RX_TSF) << 8) + +#define MAC_CLK_SPEED 80 /* 80M */ +#define EFUSE_PCB_INFO_OFFSET 0xCA + +static int rtw8822c_mac_init(struct rtw_dev *rtwdev) +{ + u8 value8; + u16 value16; + u32 value32; + u16 pre_txcnt; + + /* txq control */ + value8 = rtw_read8(rtwdev, REG_FWHW_TXQ_CTRL); + value8 |= (BIT(7) & ~BIT(1) & ~BIT(2)); + rtw_write8(rtwdev, REG_FWHW_TXQ_CTRL, value8); + rtw_write8(rtwdev, REG_FWHW_TXQ_CTRL + 1, WLAN_TXQ_RPT_EN); + /* sifs control */ + rtw_write16(rtwdev, REG_SPEC_SIFS, WLAN_SIFS_DUR_TUNE); + rtw_write32(rtwdev, REG_SIFS, WLAN_SIFS_CFG); + rtw_write16(rtwdev, REG_RESP_SIFS_CCK, + WLAN_SIFS_CCK_CTX | WLAN_SIFS_CCK_IRX << 8); + rtw_write16(rtwdev, REG_RESP_SIFS_OFDM, + WLAN_SIFS_OFDM_CTX | WLAN_SIFS_OFDM_IRX << 8); + /* rate fallback control */ + rtw_write32(rtwdev, REG_DARFRC, WLAN_DATA_RATE_FB_CNT_1_4); + rtw_write32(rtwdev, REG_DARFRCH, WLAN_DATA_RATE_FB_CNT_5_8); + rtw_write32(rtwdev, REG_RARFRCH, WLAN_RTS_RATE_FB_CNT_5_8); + rtw_write32(rtwdev, REG_ARFR0, WLAN_DATA_RATE_FB_RATE0); + rtw_write32(rtwdev, REG_ARFRH0, WLAN_DATA_RATE_FB_RATE0_H); + rtw_write32(rtwdev, REG_ARFR1_V1, WLAN_RTS_RATE_FB_RATE1); + rtw_write32(rtwdev, REG_ARFRH1_V1, WLAN_RTS_RATE_FB_RATE1_H); + rtw_write32(rtwdev, REG_ARFR4, WLAN_RTS_RATE_FB_RATE4); + rtw_write32(rtwdev, REG_ARFRH4, WLAN_RTS_RATE_FB_RATE4_H); + rtw_write32(rtwdev, REG_ARFR5, WLAN_RTS_RATE_FB_RATE5); + rtw_write32(rtwdev, REG_ARFRH5, WLAN_RTS_RATE_FB_RATE5_H); + /* protocol configuration */ + rtw_write8(rtwdev, REG_AMPDU_MAX_TIME_V1, WLAN_AMPDU_MAX_TIME); + rtw_write8_set(rtwdev, REG_TX_HANG_CTRL, BIT_EN_EOF_V1); + pre_txcnt = WLAN_PRE_TXCNT_TIME_TH | BIT_EN_PRECNT; + rtw_write8(rtwdev, REG_PRECNT_CTRL, (u8)(pre_txcnt & 0xFF)); + rtw_write8(rtwdev, REG_PRECNT_CTRL + 1, (u8)(pre_txcnt >> 8)); + value32 = WLAN_RTS_LEN_TH | (WLAN_RTS_TX_TIME_TH << 8) | + (WLAN_MAX_AGG_PKT_LIMIT << 16) | + (WLAN_RTS_MAX_AGG_PKT_LIMIT << 24); + rtw_write32(rtwdev, REG_PROT_MODE_CTRL, value32); + rtw_write16(rtwdev, REG_BAR_MODE_CTRL + 2, + WLAN_BAR_RETRY_LIMIT | WLAN_RA_TRY_RATE_AGG_LIMIT << 8); + rtw_write8(rtwdev, REG_FAST_EDCA_VOVI_SETTING, FAST_EDCA_VO_TH); + rtw_write8(rtwdev, REG_FAST_EDCA_VOVI_SETTING + 2, FAST_EDCA_VI_TH); + rtw_write8(rtwdev, REG_FAST_EDCA_BEBK_SETTING, FAST_EDCA_BE_TH); + rtw_write8(rtwdev, REG_FAST_EDCA_BEBK_SETTING + 2, FAST_EDCA_BK_TH); + /* close BA parser */ + rtw_write8_clr(rtwdev, REG_LIFETIME_EN, BIT_BA_PARSER_EN); + rtw_write32_clr(rtwdev, REG_RRSR, BITS_RRSR_RSC); + + /* EDCA configuration */ + rtw_write32(rtwdev, REG_EDCA_VO_PARAM, WLAN_EDCA_VO_PARAM); + rtw_write32(rtwdev, REG_EDCA_VI_PARAM, WLAN_EDCA_VI_PARAM); + rtw_write32(rtwdev, REG_EDCA_BE_PARAM, WLAN_EDCA_BE_PARAM); + rtw_write32(rtwdev, REG_EDCA_BK_PARAM, WLAN_EDCA_BK_PARAM); + rtw_write8(rtwdev, REG_PIFS, WLAN_PIFS_TIME); + rtw_write8_clr(rtwdev, REG_TX_PTCL_CTRL + 1, BIT_SIFS_BK_EN >> 8); + rtw_write8_set(rtwdev, REG_RD_CTRL + 1, + (BIT_DIS_TXOP_CFE | BIT_DIS_LSIG_CFE | + BIT_DIS_STBC_CFE) >> 8); + + /* MAC clock configuration */ + rtw_write32_clr(rtwdev, REG_AFE_CTRL1, BIT_MAC_CLK_SEL); + rtw_write8(rtwdev, REG_USTIME_TSF, MAC_CLK_SPEED); + rtw_write8(rtwdev, REG_USTIME_EDCA, MAC_CLK_SPEED); + + rtw_write8_set(rtwdev, REG_MISC_CTRL, + BIT_EN_FREE_CNT | BIT_DIS_SECOND_CCA); + rtw_write8_clr(rtwdev, REG_TIMER0_SRC_SEL, BIT_TSFT_SEL_TIMER0); + rtw_write16(rtwdev, REG_TXPAUSE, 0x0000); + rtw_write8(rtwdev, REG_SLOT, WLAN_SLOT_TIME); + rtw_write32(rtwdev, REG_RD_NAV_NXT, WLAN_NAV_CFG); + rtw_write16(rtwdev, REG_RXTSF_OFFSET_CCK, WLAN_RX_TSF_CFG); + /* Set beacon cotnrol - enable TSF and other related functions */ + rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); + /* Set send beacon related registers */ + rtw_write32(rtwdev, REG_TBTT_PROHIBIT, WLAN_TBTT_TIME); + rtw_write8(rtwdev, REG_DRVERLYINT, WLAN_DRV_EARLY_INT); + rtw_write8(rtwdev, REG_BCN_CTRL_CLINT0, WLAN_BCN_CTRL_CLT0); + rtw_write8(rtwdev, REG_BCNDMATIM, WLAN_BCN_DMA_TIME); + rtw_write8(rtwdev, REG_BCN_MAX_ERR, WLAN_BCN_MAX_ERR); + + /* WMAC configuration */ + rtw_write32(rtwdev, REG_MAR, WLAN_MULTI_ADDR); + rtw_write32(rtwdev, REG_MAR + 4, WLAN_MULTI_ADDR); + rtw_write8(rtwdev, REG_BBPSF_CTRL + 2, WLAN_RESP_TXRATE); + rtw_write8(rtwdev, REG_ACKTO, WLAN_ACK_TO); + rtw_write8(rtwdev, REG_ACKTO_CCK, WLAN_ACK_TO_CCK); + rtw_write16(rtwdev, REG_EIFS, WLAN_EIFS_DUR_TUNE); + rtw_write8(rtwdev, REG_NAV_CTRL + 2, WLAN_NAV_MAX); + rtw_write8(rtwdev, REG_WMAC_TRXPTCL_CTL_H + 2, WLAN_BAR_ACK_TYPE); + rtw_write32(rtwdev, REG_RXFLTMAP0, WLAN_RX_FILTER0); + rtw_write16(rtwdev, REG_RXFLTMAP2, WLAN_RX_FILTER2); + rtw_write32(rtwdev, REG_RCR, WLAN_RCR_CFG); + rtw_write8(rtwdev, REG_RX_PKT_LIMIT, WLAN_RXPKT_MAX_SZ_512); + rtw_write8(rtwdev, REG_TCR + 2, WLAN_TX_FUNC_CFG2); + rtw_write8(rtwdev, REG_TCR + 1, WLAN_TX_FUNC_CFG1); + rtw_write32_set(rtwdev, REG_GENERAL_OPTION, BIT_DUMMY_FCS_READY_MASK_EN); + rtw_write32(rtwdev, REG_WMAC_OPTION_FUNCTION + 8, WLAN_MAC_OPT_FUNC2); + rtw_write8(rtwdev, REG_WMAC_OPTION_FUNCTION_1, WLAN_MAC_OPT_NORM_FUNC1); + + /* init low power */ + value16 = rtw_read16(rtwdev, REG_RXPSF_CTRL + 2) & 0xF00F; + value16 |= (BIT_RXGCK_VHT_FIFOTHR(1) | BIT_RXGCK_HT_FIFOTHR(1) | + BIT_RXGCK_OFDM_FIFOTHR(1) | BIT_RXGCK_CCK_FIFOTHR(1)) >> 16; + rtw_write16(rtwdev, REG_RXPSF_CTRL + 2, value16); + value16 = 0; + value16 = BIT_SET_RXPSF_PKTLENTHR(value16, 1); + value16 |= BIT_RXPSF_CTRLEN | BIT_RXPSF_VHTCHKEN | BIT_RXPSF_HTCHKEN + | BIT_RXPSF_OFDMCHKEN | BIT_RXPSF_CCKCHKEN + | BIT_RXPSF_OFDMRST; + rtw_write16(rtwdev, REG_RXPSF_CTRL, value16); + rtw_write32(rtwdev, REG_RXPSF_TYPE_CTRL, 0xFFFFFFFF); + /* rx ignore configuration */ + value16 = rtw_read16(rtwdev, REG_RXPSF_CTRL); + value16 &= ~(BIT_RXPSF_MHCHKEN | BIT_RXPSF_CCKRST | + BIT_RXPSF_CONT_ERRCHKEN); + value16 = BIT_SET_RXPSF_ERRTHR(value16, 0x07); + rtw_write16(rtwdev, REG_RXPSF_CTRL, value16); + rtw_write8_set(rtwdev, REG_SND_PTCL_CTRL, + BIT_DIS_CHK_VHTSIGB_CRC); + + /* Interrupt migration configuration */ + rtw_write32(rtwdev, REG_INT_MIG, WLAN_MAC_INT_MIG_CFG); + + return 0; +} + +#define FWCD_SIZE_REG_8822C 0x2000 +#define FWCD_SIZE_DMEM_8822C 0x10000 +#define FWCD_SIZE_IMEM_8822C 0x10000 +#define FWCD_SIZE_EMEM_8822C 0x20000 +#define FWCD_SIZE_ROM_8822C 0x10000 + +static const u32 __fwcd_segs_8822c[] = { + FWCD_SIZE_REG_8822C, + FWCD_SIZE_DMEM_8822C, + FWCD_SIZE_IMEM_8822C, + FWCD_SIZE_EMEM_8822C, + FWCD_SIZE_ROM_8822C, +}; + +static const struct rtw_fwcd_segs rtw8822c_fwcd_segs = { + .segs = __fwcd_segs_8822c, + .num = ARRAY_SIZE(__fwcd_segs_8822c), +}; + +static int rtw8822c_dump_fw_crash(struct rtw_dev *rtwdev) +{ +#define __dump_fw_8822c(_dev, _mem) \ + rtw_dump_fw(_dev, OCPBASE_ ## _mem ## _88XX, \ + FWCD_SIZE_ ## _mem ## _8822C, RTW_FWCD_ ## _mem) + int ret; + + ret = rtw_dump_reg(rtwdev, 0x0, FWCD_SIZE_REG_8822C); + if (ret) + return ret; + ret = __dump_fw_8822c(rtwdev, DMEM); + if (ret) + return ret; + ret = __dump_fw_8822c(rtwdev, IMEM); + if (ret) + return ret; + ret = __dump_fw_8822c(rtwdev, EMEM); + if (ret) + return ret; + ret = __dump_fw_8822c(rtwdev, ROM); + if (ret) + return ret; + + return 0; + +#undef __dump_fw_8822c +} + +static void rtw8822c_rstb_3wire(struct rtw_dev *rtwdev, bool enable) +{ + if (enable) { + rtw_write32_mask(rtwdev, REG_RSTB, BIT_RSTB_3WIRE, 0x1); + rtw_write32_mask(rtwdev, REG_ANAPAR_A, BIT_ANAPAR_UPDATE, 0x1); + rtw_write32_mask(rtwdev, REG_ANAPAR_B, BIT_ANAPAR_UPDATE, 0x1); + } else { + rtw_write32_mask(rtwdev, REG_RSTB, BIT_RSTB_3WIRE, 0x0); + } +} + +static void rtw8822c_set_channel_rf(struct rtw_dev *rtwdev, u8 channel, u8 bw) +{ +#define RF18_BAND_MASK (BIT(16) | BIT(9) | BIT(8)) +#define RF18_BAND_2G (0) +#define RF18_BAND_5G (BIT(16) | BIT(8)) +#define RF18_CHANNEL_MASK (MASKBYTE0) +#define RF18_RFSI_MASK (BIT(18) | BIT(17)) +#define RF18_RFSI_GE_CH80 (BIT(17)) +#define RF18_RFSI_GT_CH140 (BIT(18)) +#define RF18_BW_MASK (BIT(13) | BIT(12)) +#define RF18_BW_20M (BIT(13) | BIT(12)) +#define RF18_BW_40M (BIT(13)) +#define RF18_BW_80M (BIT(12)) + + u32 rf_reg18 = 0; + u32 rf_rxbb = 0; + + rf_reg18 = rtw_read_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK); + + rf_reg18 &= ~(RF18_BAND_MASK | RF18_CHANNEL_MASK | RF18_RFSI_MASK | + RF18_BW_MASK); + + rf_reg18 |= (IS_CH_2G_BAND(channel) ? RF18_BAND_2G : RF18_BAND_5G); + rf_reg18 |= (channel & RF18_CHANNEL_MASK); + if (IS_CH_5G_BAND_4(channel)) + rf_reg18 |= RF18_RFSI_GT_CH140; + else if (IS_CH_5G_BAND_3(channel)) + rf_reg18 |= RF18_RFSI_GE_CH80; + + switch (bw) { + case RTW_CHANNEL_WIDTH_5: + case RTW_CHANNEL_WIDTH_10: + case RTW_CHANNEL_WIDTH_20: + default: + rf_reg18 |= RF18_BW_20M; + rf_rxbb = 0x18; + break; + case RTW_CHANNEL_WIDTH_40: + /* RF bandwidth */ + rf_reg18 |= RF18_BW_40M; + rf_rxbb = 0x10; + break; + case RTW_CHANNEL_WIDTH_80: + rf_reg18 |= RF18_BW_80M; + rf_rxbb = 0x8; + break; + } + + rtw8822c_rstb_3wire(rtwdev, false); + + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWE2, 0x04, 0x01); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWA, 0x1f, 0x12); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD0, 0xfffff, rf_rxbb); + rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWE2, 0x04, 0x00); + + rtw_write_rf(rtwdev, RF_PATH_B, RF_LUTWE2, 0x04, 0x01); + rtw_write_rf(rtwdev, RF_PATH_B, RF_LUTWA, 0x1f, 0x12); + rtw_write_rf(rtwdev, RF_PATH_B, RF_LUTWD0, 0xfffff, rf_rxbb); + rtw_write_rf(rtwdev, RF_PATH_B, RF_LUTWE2, 0x04, 0x00); + + rtw_write_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK, rf_reg18); + rtw_write_rf(rtwdev, RF_PATH_B, RF_CFGCH, RFREG_MASK, rf_reg18); + + rtw8822c_rstb_3wire(rtwdev, true); +} + +static void rtw8822c_toggle_igi(struct rtw_dev *rtwdev) +{ + u32 igi; + + igi = rtw_read32_mask(rtwdev, REG_RXIGI, 0x7f); + rtw_write32_mask(rtwdev, REG_RXIGI, 0x7f, igi - 2); + rtw_write32_mask(rtwdev, REG_RXIGI, 0x7f00, igi - 2); + rtw_write32_mask(rtwdev, REG_RXIGI, 0x7f, igi); + rtw_write32_mask(rtwdev, REG_RXIGI, 0x7f00, igi); +} + +static void rtw8822c_set_channel_bb(struct rtw_dev *rtwdev, u8 channel, u8 bw, + u8 primary_ch_idx) +{ + if (IS_CH_2G_BAND(channel)) { + rtw_write32_clr(rtwdev, REG_BGCTRL, BITS_RX_IQ_WEIGHT); + rtw_write32_set(rtwdev, REG_TXF4, BIT(20)); + rtw_write32_clr(rtwdev, REG_CCK_CHECK, BIT_CHECK_CCK_EN); + rtw_write32_clr(rtwdev, REG_CCKTXONLY, BIT_BB_CCK_CHECK_EN); + rtw_write32_mask(rtwdev, REG_CCAMSK, 0x3F000000, 0xF); + + switch (bw) { + case RTW_CHANNEL_WIDTH_20: + rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_CCK, + 0x5); + rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_CCK, + 0x5); + rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_OFDM, + 0x6); + rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_OFDM, + 0x6); + break; + case RTW_CHANNEL_WIDTH_40: + rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_CCK, + 0x4); + rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_CCK, + 0x4); + rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_OFDM, + 0x0); + rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_OFDM, + 0x0); + break; + } + if (channel == 13 || channel == 14) + rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x969); + else if (channel == 11 || channel == 12) + rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x96a); + else + rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x9aa); + if (channel == 14) { + rtw_write32_mask(rtwdev, REG_TXF0, MASKHWORD, 0x3da0); + rtw_write32_mask(rtwdev, REG_TXF1, MASKDWORD, + 0x4962c931); + rtw_write32_mask(rtwdev, REG_TXF2, MASKLWORD, 0x6aa3); + rtw_write32_mask(rtwdev, REG_TXF3, MASKHWORD, 0xaa7b); + rtw_write32_mask(rtwdev, REG_TXF4, MASKLWORD, 0xf3d7); + rtw_write32_mask(rtwdev, REG_TXF5, MASKDWORD, 0x0); + rtw_write32_mask(rtwdev, REG_TXF6, MASKDWORD, + 0xff012455); + rtw_write32_mask(rtwdev, REG_TXF7, MASKDWORD, 0xffff); + } else { + rtw_write32_mask(rtwdev, REG_TXF0, MASKHWORD, 0x5284); + rtw_write32_mask(rtwdev, REG_TXF1, MASKDWORD, + 0x3e18fec8); + rtw_write32_mask(rtwdev, REG_TXF2, MASKLWORD, 0x0a88); + rtw_write32_mask(rtwdev, REG_TXF3, MASKHWORD, 0xacc4); + rtw_write32_mask(rtwdev, REG_TXF4, MASKLWORD, 0xc8b2); + rtw_write32_mask(rtwdev, REG_TXF5, MASKDWORD, + 0x00faf0de); + rtw_write32_mask(rtwdev, REG_TXF6, MASKDWORD, + 0x00122344); + rtw_write32_mask(rtwdev, REG_TXF7, MASKDWORD, + 0x0fffffff); + } + if (channel == 13) + rtw_write32_mask(rtwdev, REG_TXDFIR0, 0x70, 0x3); + else + rtw_write32_mask(rtwdev, REG_TXDFIR0, 0x70, 0x1); + } else if (IS_CH_5G_BAND(channel)) { + rtw_write32_set(rtwdev, REG_CCKTXONLY, BIT_BB_CCK_CHECK_EN); + rtw_write32_set(rtwdev, REG_CCK_CHECK, BIT_CHECK_CCK_EN); + rtw_write32_set(rtwdev, REG_BGCTRL, BITS_RX_IQ_WEIGHT); + rtw_write32_clr(rtwdev, REG_TXF4, BIT(20)); + rtw_write32_mask(rtwdev, REG_CCAMSK, 0x3F000000, 0x22); + rtw_write32_mask(rtwdev, REG_TXDFIR0, 0x70, 0x3); + if (IS_CH_5G_BAND_1(channel) || IS_CH_5G_BAND_2(channel)) { + rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_OFDM, + 0x1); + rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_OFDM, + 0x1); + } else if (IS_CH_5G_BAND_3(channel)) { + rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_OFDM, + 0x2); + rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_OFDM, + 0x2); + } else if (IS_CH_5G_BAND_4(channel)) { + rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_OFDM, + 0x3); + rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_OFDM, + 0x3); + } + + if (channel >= 36 && channel <= 51) + rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x494); + else if (channel >= 52 && channel <= 55) + rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x493); + else if (channel >= 56 && channel <= 111) + rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x453); + else if (channel >= 112 && channel <= 119) + rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x452); + else if (channel >= 120 && channel <= 172) + rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x412); + else if (channel >= 173 && channel <= 177) + rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x411); + } + + switch (bw) { + case RTW_CHANNEL_WIDTH_20: + rtw_write32_mask(rtwdev, REG_DFIRBW, 0x3FF0, 0x19B); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xf, 0x0); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xffc0, 0x0); + rtw_write32_mask(rtwdev, REG_TXCLK, 0x700, 0x7); + rtw_write32_mask(rtwdev, REG_TXCLK, 0x700000, 0x6); + rtw_write32_mask(rtwdev, REG_CCK_SOURCE, BIT_NBI_EN, 0x0); + rtw_write32_mask(rtwdev, REG_SBD, BITS_SUBTUNE, 0x1); + rtw_write32_mask(rtwdev, REG_PT_CHSMO, BIT_PT_OPT, 0x0); + break; + case RTW_CHANNEL_WIDTH_40: + rtw_write32_mask(rtwdev, REG_CCKSB, BIT(4), + (primary_ch_idx == RTW_SC_20_UPPER ? 1 : 0)); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xf, 0x5); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xc0, 0x0); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xff00, + (primary_ch_idx | (primary_ch_idx << 4))); + rtw_write32_mask(rtwdev, REG_CCK_SOURCE, BIT_NBI_EN, 0x1); + rtw_write32_mask(rtwdev, REG_SBD, BITS_SUBTUNE, 0x1); + rtw_write32_mask(rtwdev, REG_PT_CHSMO, BIT_PT_OPT, 0x1); + break; + case RTW_CHANNEL_WIDTH_80: + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xf, 0xa); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xc0, 0x0); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xff00, + (primary_ch_idx | (primary_ch_idx << 4))); + rtw_write32_mask(rtwdev, REG_SBD, BITS_SUBTUNE, 0x6); + rtw_write32_mask(rtwdev, REG_PT_CHSMO, BIT_PT_OPT, 0x1); + break; + case RTW_CHANNEL_WIDTH_5: + rtw_write32_mask(rtwdev, REG_DFIRBW, 0x3FF0, 0x2AB); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xf, 0x0); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xffc0, 0x1); + rtw_write32_mask(rtwdev, REG_TXCLK, 0x700, 0x4); + rtw_write32_mask(rtwdev, REG_TXCLK, 0x700000, 0x4); + rtw_write32_mask(rtwdev, REG_CCK_SOURCE, BIT_NBI_EN, 0x0); + rtw_write32_mask(rtwdev, REG_SBD, BITS_SUBTUNE, 0x1); + rtw_write32_mask(rtwdev, REG_PT_CHSMO, BIT_PT_OPT, 0x0); + break; + case RTW_CHANNEL_WIDTH_10: + rtw_write32_mask(rtwdev, REG_DFIRBW, 0x3FF0, 0x2AB); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xf, 0x0); + rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xffc0, 0x2); + rtw_write32_mask(rtwdev, REG_TXCLK, 0x700, 0x6); + rtw_write32_mask(rtwdev, REG_TXCLK, 0x700000, 0x5); + rtw_write32_mask(rtwdev, REG_CCK_SOURCE, BIT_NBI_EN, 0x0); + rtw_write32_mask(rtwdev, REG_SBD, BITS_SUBTUNE, 0x1); + rtw_write32_mask(rtwdev, REG_PT_CHSMO, BIT_PT_OPT, 0x0); + break; + } +} + +static void rtw8822c_set_channel(struct rtw_dev *rtwdev, u8 channel, u8 bw, + u8 primary_chan_idx) +{ + rtw8822c_set_channel_bb(rtwdev, channel, bw, primary_chan_idx); + rtw_set_channel_mac(rtwdev, channel, bw, primary_chan_idx); + rtw8822c_set_channel_rf(rtwdev, channel, bw); + rtw8822c_toggle_igi(rtwdev); +} + +static void rtw8822c_config_cck_rx_path(struct rtw_dev *rtwdev, u8 rx_path) +{ + if (rx_path == BB_PATH_A || rx_path == BB_PATH_B) { + rtw_write32_mask(rtwdev, REG_CCANRX, 0x00060000, 0x0); + rtw_write32_mask(rtwdev, REG_CCANRX, 0x00600000, 0x0); + } else if (rx_path == BB_PATH_AB) { + rtw_write32_mask(rtwdev, REG_CCANRX, 0x00600000, 0x1); + rtw_write32_mask(rtwdev, REG_CCANRX, 0x00060000, 0x1); + } + + if (rx_path == BB_PATH_A) + rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0x0f000000, 0x0); + else if (rx_path == BB_PATH_B) + rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0x0f000000, 0x5); + else if (rx_path == BB_PATH_AB) + rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0x0f000000, 0x1); +} + +static void rtw8822c_config_ofdm_rx_path(struct rtw_dev *rtwdev, u8 rx_path) +{ + if (rx_path == BB_PATH_A || rx_path == BB_PATH_B) { + rtw_write32_mask(rtwdev, REG_RXFNCTL, 0x300, 0x0); + rtw_write32_mask(rtwdev, REG_RXFNCTL, 0x600000, 0x0); + rtw_write32_mask(rtwdev, REG_AGCSWSH, BIT(17), 0x0); + rtw_write32_mask(rtwdev, REG_ANTWTPD, BIT(20), 0x0); + rtw_write32_mask(rtwdev, REG_MRCM, BIT(24), 0x0); + } else if (rx_path == BB_PATH_AB) { + rtw_write32_mask(rtwdev, REG_RXFNCTL, 0x300, 0x1); + rtw_write32_mask(rtwdev, REG_RXFNCTL, 0x600000, 0x1); + rtw_write32_mask(rtwdev, REG_AGCSWSH, BIT(17), 0x1); + rtw_write32_mask(rtwdev, REG_ANTWTPD, BIT(20), 0x1); + rtw_write32_mask(rtwdev, REG_MRCM, BIT(24), 0x1); + } + + rtw_write32_mask(rtwdev, 0x824, 0x0f000000, rx_path); + rtw_write32_mask(rtwdev, 0x824, 0x000f0000, rx_path); +} + +static void rtw8822c_config_rx_path(struct rtw_dev *rtwdev, u8 rx_path) +{ + rtw8822c_config_cck_rx_path(rtwdev, rx_path); + rtw8822c_config_ofdm_rx_path(rtwdev, rx_path); +} + +static void rtw8822c_config_cck_tx_path(struct rtw_dev *rtwdev, u8 tx_path, + bool is_tx2_path) +{ + if (tx_path == BB_PATH_A) { + rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0xf0000000, 0x8); + } else if (tx_path == BB_PATH_B) { + rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0xf0000000, 0x4); + } else { + if (is_tx2_path) + rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0xf0000000, 0xc); + else + rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0xf0000000, 0x8); + } + rtw8822c_bb_reset(rtwdev); +} + +static void rtw8822c_config_ofdm_tx_path(struct rtw_dev *rtwdev, u8 tx_path, + enum rtw_bb_path tx_path_sel_1ss) +{ + if (tx_path == BB_PATH_A) { + rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x11); + rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xff, 0x0); + } else if (tx_path == BB_PATH_B) { + rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x12); + rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xff, 0x0); + } else { + if (tx_path_sel_1ss == BB_PATH_AB) { + rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x33); + rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xffff, 0x0404); + } else if (tx_path_sel_1ss == BB_PATH_B) { + rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x32); + rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xffff, 0x0400); + } else if (tx_path_sel_1ss == BB_PATH_A) { + rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x31); + rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xffff, 0x0400); + } + } + rtw8822c_bb_reset(rtwdev); +} + +static void rtw8822c_config_tx_path(struct rtw_dev *rtwdev, u8 tx_path, + enum rtw_bb_path tx_path_sel_1ss, + enum rtw_bb_path tx_path_cck, + bool is_tx2_path) +{ + rtw8822c_config_cck_tx_path(rtwdev, tx_path_cck, is_tx2_path); + rtw8822c_config_ofdm_tx_path(rtwdev, tx_path, tx_path_sel_1ss); + rtw8822c_bb_reset(rtwdev); +} + +static void rtw8822c_config_trx_mode(struct rtw_dev *rtwdev, u8 tx_path, + u8 rx_path, bool is_tx2_path) +{ + if ((tx_path | rx_path) & BB_PATH_A) + rtw_write32_mask(rtwdev, REG_ORITXCODE, MASK20BITS, 0x33312); + else + rtw_write32_mask(rtwdev, REG_ORITXCODE, MASK20BITS, 0x11111); + if ((tx_path | rx_path) & BB_PATH_B) + rtw_write32_mask(rtwdev, REG_ORITXCODE2, MASK20BITS, 0x33312); + else + rtw_write32_mask(rtwdev, REG_ORITXCODE2, MASK20BITS, 0x11111); + + rtw8822c_config_rx_path(rtwdev, rx_path); + rtw8822c_config_tx_path(rtwdev, tx_path, BB_PATH_A, BB_PATH_A, + is_tx2_path); + + rtw8822c_toggle_igi(rtwdev); +} + +static void query_phy_status_page0(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 l_bnd, u_bnd; + u8 gain_a, gain_b; + s8 rx_power[RTW_RF_PATH_MAX]; + s8 min_rx_power = -120; + u8 rssi; + u8 channel; + int path; + + rx_power[RF_PATH_A] = GET_PHY_STAT_P0_PWDB_A(phy_status); + rx_power[RF_PATH_B] = GET_PHY_STAT_P0_PWDB_B(phy_status); + l_bnd = dm_info->cck_gi_l_bnd; + u_bnd = dm_info->cck_gi_u_bnd; + gain_a = GET_PHY_STAT_P0_GAIN_A(phy_status); + gain_b = GET_PHY_STAT_P0_GAIN_B(phy_status); + if (gain_a < l_bnd) + rx_power[RF_PATH_A] += (l_bnd - gain_a) << 1; + else if (gain_a > u_bnd) + rx_power[RF_PATH_A] -= (gain_a - u_bnd) << 1; + if (gain_b < l_bnd) + rx_power[RF_PATH_B] += (l_bnd - gain_b) << 1; + else if (gain_b > u_bnd) + rx_power[RF_PATH_B] -= (gain_b - u_bnd) << 1; + + rx_power[RF_PATH_A] -= 110; + rx_power[RF_PATH_B] -= 110; + + channel = GET_PHY_STAT_P0_CHANNEL(phy_status); + if (channel == 0) + channel = rtwdev->hal.current_channel; + rtw_set_rx_freq_band(pkt_stat, channel); + + pkt_stat->rx_power[RF_PATH_A] = rx_power[RF_PATH_A]; + pkt_stat->rx_power[RF_PATH_B] = rx_power[RF_PATH_B]; + + for (path = 0; path <= rtwdev->hal.rf_path_num; path++) { + rssi = rtw_phy_rf_power_2_rssi(&pkt_stat->rx_power[path], 1); + dm_info->rssi[path] = rssi; + } + + pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1); + pkt_stat->bw = RTW_CHANNEL_WIDTH_20; + pkt_stat->signal_power = max(pkt_stat->rx_power[RF_PATH_A], + min_rx_power); +} + +static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + struct rtw_path_div *p_div = &rtwdev->dm_path_div; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 rxsc, bw; + s8 min_rx_power = -120; + s8 rx_evm; + u8 evm_dbm = 0; + u8 rssi; + int path; + u8 channel; + + if (pkt_stat->rate > DESC_RATE11M && pkt_stat->rate < DESC_RATEMCS0) + rxsc = GET_PHY_STAT_P1_L_RXSC(phy_status); + else + rxsc = GET_PHY_STAT_P1_HT_RXSC(phy_status); + + if (rxsc >= 9 && rxsc <= 12) + bw = RTW_CHANNEL_WIDTH_40; + else if (rxsc >= 13) + bw = RTW_CHANNEL_WIDTH_80; + else + bw = RTW_CHANNEL_WIDTH_20; + + channel = GET_PHY_STAT_P1_CHANNEL(phy_status); + rtw_set_rx_freq_band(pkt_stat, channel); + + pkt_stat->rx_power[RF_PATH_A] = GET_PHY_STAT_P1_PWDB_A(phy_status) - 110; + pkt_stat->rx_power[RF_PATH_B] = GET_PHY_STAT_P1_PWDB_B(phy_status) - 110; + pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 2); + pkt_stat->bw = bw; + pkt_stat->signal_power = max3(pkt_stat->rx_power[RF_PATH_A], + pkt_stat->rx_power[RF_PATH_B], + min_rx_power); + + dm_info->curr_rx_rate = pkt_stat->rate; + + pkt_stat->rx_evm[RF_PATH_A] = GET_PHY_STAT_P1_RXEVM_A(phy_status); + pkt_stat->rx_evm[RF_PATH_B] = GET_PHY_STAT_P1_RXEVM_B(phy_status); + + pkt_stat->rx_snr[RF_PATH_A] = GET_PHY_STAT_P1_RXSNR_A(phy_status); + pkt_stat->rx_snr[RF_PATH_B] = GET_PHY_STAT_P1_RXSNR_B(phy_status); + + pkt_stat->cfo_tail[RF_PATH_A] = GET_PHY_STAT_P1_CFO_TAIL_A(phy_status); + pkt_stat->cfo_tail[RF_PATH_B] = GET_PHY_STAT_P1_CFO_TAIL_B(phy_status); + + for (path = 0; path <= rtwdev->hal.rf_path_num; path++) { + rssi = rtw_phy_rf_power_2_rssi(&pkt_stat->rx_power[path], 1); + dm_info->rssi[path] = rssi; + if (path == RF_PATH_A) { + p_div->path_a_sum += rssi; + p_div->path_a_cnt++; + } else if (path == RF_PATH_B) { + p_div->path_b_sum += rssi; + p_div->path_b_cnt++; + } + dm_info->rx_snr[path] = pkt_stat->rx_snr[path] >> 1; + dm_info->cfo_tail[path] = (pkt_stat->cfo_tail[path] * 5) >> 1; + + rx_evm = pkt_stat->rx_evm[path]; + + if (rx_evm < 0) { + if (rx_evm == S8_MIN) + evm_dbm = 0; + else + evm_dbm = ((u8)-rx_evm >> 1); + } + dm_info->rx_evm_dbm[path] = evm_dbm; + } + rtw_phy_parsing_cfo(rtwdev, pkt_stat); +} + +static void query_phy_status(struct rtw_dev *rtwdev, u8 *phy_status, + struct rtw_rx_pkt_stat *pkt_stat) +{ + u8 page; + + page = *phy_status & 0xf; + + switch (page) { + case 0: + query_phy_status_page0(rtwdev, phy_status, pkt_stat); + break; + case 1: + query_phy_status_page1(rtwdev, phy_status, pkt_stat); + break; + default: + rtw_warn(rtwdev, "unused phy status page (%d)\n", page); + return; + } +} + +static void rtw8822c_query_rx_desc(struct rtw_dev *rtwdev, u8 *rx_desc, + struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_rx_status *rx_status) +{ + struct ieee80211_hdr *hdr; + u32 desc_sz = rtwdev->chip->rx_pkt_desc_sz; + u8 *phy_status = NULL; + + memset(pkt_stat, 0, sizeof(*pkt_stat)); + + pkt_stat->phy_status = GET_RX_DESC_PHYST(rx_desc); + pkt_stat->icv_err = GET_RX_DESC_ICV_ERR(rx_desc); + pkt_stat->crc_err = GET_RX_DESC_CRC32(rx_desc); + pkt_stat->decrypted = !GET_RX_DESC_SWDEC(rx_desc) && + GET_RX_DESC_ENC_TYPE(rx_desc) != RX_DESC_ENC_NONE; + pkt_stat->is_c2h = GET_RX_DESC_C2H(rx_desc); + pkt_stat->pkt_len = GET_RX_DESC_PKT_LEN(rx_desc); + pkt_stat->drv_info_sz = GET_RX_DESC_DRV_INFO_SIZE(rx_desc); + pkt_stat->shift = GET_RX_DESC_SHIFT(rx_desc); + pkt_stat->rate = GET_RX_DESC_RX_RATE(rx_desc); + pkt_stat->cam_id = GET_RX_DESC_MACID(rx_desc); + pkt_stat->ppdu_cnt = GET_RX_DESC_PPDU_CNT(rx_desc); + pkt_stat->tsf_low = GET_RX_DESC_TSFL(rx_desc); + + /* drv_info_sz is in unit of 8-bytes */ + pkt_stat->drv_info_sz *= 8; + + /* c2h cmd pkt's rx/phy status is not interested */ + if (pkt_stat->is_c2h) + return; + + hdr = (struct ieee80211_hdr *)(rx_desc + desc_sz + pkt_stat->shift + + pkt_stat->drv_info_sz); + pkt_stat->hdr = hdr; + if (pkt_stat->phy_status) { + phy_status = rx_desc + desc_sz + pkt_stat->shift; + query_phy_status(rtwdev, phy_status, pkt_stat); + } + + rtw_rx_fill_rx_status(rtwdev, pkt_stat, hdr, rx_status, phy_status); +} + +static void +rtw8822c_set_write_tx_power_ref(struct rtw_dev *rtwdev, u8 *tx_pwr_ref_cck, + u8 *tx_pwr_ref_ofdm) +{ + struct rtw_hal *hal = &rtwdev->hal; + u32 txref_cck[2] = {0x18a0, 0x41a0}; + u32 txref_ofdm[2] = {0x18e8, 0x41e8}; + u8 path; + + for (path = 0; path < hal->rf_path_num; path++) { + rtw_write32_mask(rtwdev, 0x1c90, BIT(15), 0); + rtw_write32_mask(rtwdev, txref_cck[path], 0x7f0000, + tx_pwr_ref_cck[path]); + } + for (path = 0; path < hal->rf_path_num; path++) { + rtw_write32_mask(rtwdev, 0x1c90, BIT(15), 0); + rtw_write32_mask(rtwdev, txref_ofdm[path], 0x1fc00, + tx_pwr_ref_ofdm[path]); + } +} + +static void rtw8822c_set_tx_power_diff(struct rtw_dev *rtwdev, u8 rate, + s8 *diff_idx) +{ + u32 offset_txagc = 0x3a00; + u8 rate_idx = rate & 0xfc; + u8 pwr_idx[4]; + u32 phy_pwr_idx; + int i; + + for (i = 0; i < 4; i++) + pwr_idx[i] = diff_idx[i] & 0x7f; + + phy_pwr_idx = pwr_idx[0] | + (pwr_idx[1] << 8) | + (pwr_idx[2] << 16) | + (pwr_idx[3] << 24); + + rtw_write32_mask(rtwdev, 0x1c90, BIT(15), 0x0); + rtw_write32_mask(rtwdev, offset_txagc + rate_idx, MASKDWORD, + phy_pwr_idx); +} + +static void rtw8822c_set_tx_power_index(struct rtw_dev *rtwdev) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 rs, rate, j; + u8 pwr_ref_cck[2] = {hal->tx_pwr_tbl[RF_PATH_A][DESC_RATE11M], + hal->tx_pwr_tbl[RF_PATH_B][DESC_RATE11M]}; + u8 pwr_ref_ofdm[2] = {hal->tx_pwr_tbl[RF_PATH_A][DESC_RATEMCS7], + hal->tx_pwr_tbl[RF_PATH_B][DESC_RATEMCS7]}; + s8 diff_a, diff_b; + u8 pwr_a, pwr_b; + s8 diff_idx[4]; + + rtw8822c_set_write_tx_power_ref(rtwdev, pwr_ref_cck, pwr_ref_ofdm); + for (rs = 0; rs < RTW_RATE_SECTION_MAX; rs++) { + for (j = 0; j < rtw_rate_size[rs]; j++) { + rate = rtw_rate_section[rs][j]; + pwr_a = hal->tx_pwr_tbl[RF_PATH_A][rate]; + pwr_b = hal->tx_pwr_tbl[RF_PATH_B][rate]; + if (rs == 0) { + diff_a = (s8)pwr_a - (s8)pwr_ref_cck[0]; + diff_b = (s8)pwr_b - (s8)pwr_ref_cck[1]; + } else { + diff_a = (s8)pwr_a - (s8)pwr_ref_ofdm[0]; + diff_b = (s8)pwr_b - (s8)pwr_ref_ofdm[1]; + } + diff_idx[rate % 4] = min(diff_a, diff_b); + if (rate % 4 == 3) + rtw8822c_set_tx_power_diff(rtwdev, rate - 3, + diff_idx); + } + } +} + +static int rtw8822c_set_antenna(struct rtw_dev *rtwdev, + u32 antenna_tx, + u32 antenna_rx) +{ + struct rtw_hal *hal = &rtwdev->hal; + + switch (antenna_tx) { + case BB_PATH_A: + case BB_PATH_B: + case BB_PATH_AB: + break; + default: + rtw_warn(rtwdev, "unsupported tx path 0x%x\n", antenna_tx); + return -EINVAL; + } + + /* path B only is not available for RX */ + switch (antenna_rx) { + case BB_PATH_A: + case BB_PATH_AB: + break; + default: + rtw_warn(rtwdev, "unsupported rx path 0x%x\n", antenna_rx); + return -EINVAL; + } + + hal->antenna_tx = antenna_tx; + hal->antenna_rx = antenna_rx; + + rtw8822c_config_trx_mode(rtwdev, antenna_tx, antenna_rx, false); + + return 0; +} + +static void rtw8822c_cfg_ldo25(struct rtw_dev *rtwdev, bool enable) +{ + u8 ldo_pwr; + + ldo_pwr = rtw_read8(rtwdev, REG_ANAPARLDO_POW_MAC); + ldo_pwr = enable ? ldo_pwr | BIT_LDOE25_PON : ldo_pwr & ~BIT_LDOE25_PON; + rtw_write8(rtwdev, REG_ANAPARLDO_POW_MAC, ldo_pwr); +} + +static void rtw8822c_false_alarm_statistics(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u32 cck_enable; + u32 cck_fa_cnt; + u32 crc32_cnt; + u32 cca32_cnt; + u32 ofdm_fa_cnt; + u32 ofdm_fa_cnt1, ofdm_fa_cnt2, ofdm_fa_cnt3, ofdm_fa_cnt4, ofdm_fa_cnt5; + u16 parity_fail, rate_illegal, crc8_fail, mcs_fail, sb_search_fail, + fast_fsync, crc8_fail_vhta, mcs_fail_vht; + + cck_enable = rtw_read32(rtwdev, REG_ENCCK) & BIT_CCK_BLK_EN; + cck_fa_cnt = rtw_read16(rtwdev, REG_CCK_FACNT); + + ofdm_fa_cnt1 = rtw_read32(rtwdev, REG_OFDM_FACNT1); + ofdm_fa_cnt2 = rtw_read32(rtwdev, REG_OFDM_FACNT2); + ofdm_fa_cnt3 = rtw_read32(rtwdev, REG_OFDM_FACNT3); + ofdm_fa_cnt4 = rtw_read32(rtwdev, REG_OFDM_FACNT4); + ofdm_fa_cnt5 = rtw_read32(rtwdev, REG_OFDM_FACNT5); + + parity_fail = FIELD_GET(GENMASK(31, 16), ofdm_fa_cnt1); + rate_illegal = FIELD_GET(GENMASK(15, 0), ofdm_fa_cnt2); + crc8_fail = FIELD_GET(GENMASK(31, 16), ofdm_fa_cnt2); + crc8_fail_vhta = FIELD_GET(GENMASK(15, 0), ofdm_fa_cnt3); + mcs_fail = FIELD_GET(GENMASK(15, 0), ofdm_fa_cnt4); + mcs_fail_vht = FIELD_GET(GENMASK(31, 16), ofdm_fa_cnt4); + fast_fsync = FIELD_GET(GENMASK(15, 0), ofdm_fa_cnt5); + sb_search_fail = FIELD_GET(GENMASK(31, 16), ofdm_fa_cnt5); + + ofdm_fa_cnt = parity_fail + rate_illegal + crc8_fail + crc8_fail_vhta + + mcs_fail + mcs_fail_vht + fast_fsync + sb_search_fail; + + dm_info->cck_fa_cnt = cck_fa_cnt; + dm_info->ofdm_fa_cnt = ofdm_fa_cnt; + dm_info->total_fa_cnt = ofdm_fa_cnt; + dm_info->total_fa_cnt += cck_enable ? cck_fa_cnt : 0; + + crc32_cnt = rtw_read32(rtwdev, 0x2c04); + dm_info->cck_ok_cnt = crc32_cnt & 0xffff; + dm_info->cck_err_cnt = (crc32_cnt & 0xffff0000) >> 16; + crc32_cnt = rtw_read32(rtwdev, 0x2c14); + dm_info->ofdm_ok_cnt = crc32_cnt & 0xffff; + dm_info->ofdm_err_cnt = (crc32_cnt & 0xffff0000) >> 16; + crc32_cnt = rtw_read32(rtwdev, 0x2c10); + dm_info->ht_ok_cnt = crc32_cnt & 0xffff; + dm_info->ht_err_cnt = (crc32_cnt & 0xffff0000) >> 16; + crc32_cnt = rtw_read32(rtwdev, 0x2c0c); + dm_info->vht_ok_cnt = crc32_cnt & 0xffff; + dm_info->vht_err_cnt = (crc32_cnt & 0xffff0000) >> 16; + + cca32_cnt = rtw_read32(rtwdev, 0x2c08); + dm_info->ofdm_cca_cnt = ((cca32_cnt & 0xffff0000) >> 16); + dm_info->cck_cca_cnt = cca32_cnt & 0xffff; + dm_info->total_cca_cnt = dm_info->ofdm_cca_cnt; + if (cck_enable) + dm_info->total_cca_cnt += dm_info->cck_cca_cnt; + + rtw_write32_mask(rtwdev, REG_CCANRX, BIT_CCK_FA_RST, 0); + rtw_write32_mask(rtwdev, REG_CCANRX, BIT_CCK_FA_RST, 2); + rtw_write32_mask(rtwdev, REG_CCANRX, BIT_OFDM_FA_RST, 0); + rtw_write32_mask(rtwdev, REG_CCANRX, BIT_OFDM_FA_RST, 2); + + /* disable rx clk gating to reset counters */ + rtw_write32_clr(rtwdev, REG_RX_BREAK, BIT_COM_RX_GCK_EN); + rtw_write32_set(rtwdev, REG_CNT_CTRL, BIT_ALL_CNT_RST); + rtw_write32_clr(rtwdev, REG_CNT_CTRL, BIT_ALL_CNT_RST); + rtw_write32_set(rtwdev, REG_RX_BREAK, BIT_COM_RX_GCK_EN); +} + +static void rtw8822c_do_lck(struct rtw_dev *rtwdev) +{ + u32 val; + + rtw_write_rf(rtwdev, RF_PATH_A, RF_SYN_CTRL, RFREG_MASK, 0x80010); + rtw_write_rf(rtwdev, RF_PATH_A, RF_SYN_PFD, RFREG_MASK, 0x1F0FA); + fsleep(1); + rtw_write_rf(rtwdev, RF_PATH_A, RF_AAC_CTRL, RFREG_MASK, 0x80000); + rtw_write_rf(rtwdev, RF_PATH_A, RF_SYN_AAC, RFREG_MASK, 0x80001); + read_poll_timeout(rtw_read_rf, val, val != 0x1, 1000, 100000, + true, rtwdev, RF_PATH_A, RF_AAC_CTRL, 0x1000); + rtw_write_rf(rtwdev, RF_PATH_A, RF_SYN_PFD, RFREG_MASK, 0x1F0F8); + rtw_write_rf(rtwdev, RF_PATH_B, RF_SYN_CTRL, RFREG_MASK, 0x80010); + + rtw_write_rf(rtwdev, RF_PATH_A, RF_FAST_LCK, RFREG_MASK, 0x0f000); + rtw_write_rf(rtwdev, RF_PATH_A, RF_FAST_LCK, RFREG_MASK, 0x4f000); + fsleep(1); + rtw_write_rf(rtwdev, RF_PATH_A, RF_FAST_LCK, RFREG_MASK, 0x0f000); +} + +static void rtw8822c_do_iqk(struct rtw_dev *rtwdev) +{ + struct rtw_iqk_para para = {0}; + u8 iqk_chk; + int ret; + + para.clear = 1; + rtw_fw_do_iqk(rtwdev, ¶); + + ret = read_poll_timeout(rtw_read8, iqk_chk, iqk_chk == IQK_DONE_8822C, + 20000, 300000, false, rtwdev, REG_RPT_CIP); + if (ret) + rtw_warn(rtwdev, "failed to poll iqk status bit\n"); + + rtw_write8(rtwdev, REG_IQKSTAT, 0x0); +} + +/* for coex */ +static void rtw8822c_coex_cfg_init(struct rtw_dev *rtwdev) +{ + /* enable TBTT nterrupt */ + rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); + + /* BT report packet sample rate */ + /* 0x790[5:0]=0x5 */ + rtw_write8_mask(rtwdev, REG_BT_TDMA_TIME, BIT_MASK_SAMPLE_RATE, 0x5); + + /* enable BT counter statistics */ + rtw_write8(rtwdev, REG_BT_STAT_CTRL, 0x1); + + /* enable PTA (3-wire function form BT side) */ + rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_PTA_EN); + rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_PO_BT_PTA_PINS); + + /* enable PTA (tx/rx signal form WiFi side) */ + rtw_write8_set(rtwdev, REG_QUEUE_CTRL, BIT_PTA_WL_TX_EN); + /* wl tx signal to PTA not case EDCCA */ + rtw_write8_clr(rtwdev, REG_QUEUE_CTRL, BIT_PTA_EDCCA_EN); + /* GNT_BT=1 while select both */ + rtw_write16_set(rtwdev, REG_BT_COEX_V2, BIT_GNT_BT_POLARITY); + /* BT_CCA = ~GNT_WL_BB, not or GNT_BT_BB, LTE_Rx */ + rtw_write8_clr(rtwdev, REG_DUMMY_PAGE4_V1, BIT_BTCCA_CTRL); + + /* to avoid RF parameter error */ + rtw_write_rf(rtwdev, RF_PATH_B, RF_MODOPT, 0xfffff, 0x40000); +} + +static void rtw8822c_coex_cfg_gnt_fix(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_stat *coex_stat = &coex->stat; + struct rtw_efuse *efuse = &rtwdev->efuse; + u32 rf_0x1; + + if (coex_stat->gnt_workaround_state == coex_stat->wl_coex_mode) + return; + + coex_stat->gnt_workaround_state = coex_stat->wl_coex_mode; + + if ((coex_stat->kt_ver == 0 && coex->under_5g) || coex->freerun) + rf_0x1 = 0x40021; + else + rf_0x1 = 0x40000; + + /* BT at S1 for Shared-Ant */ + if (efuse->share_ant) + rf_0x1 |= BIT(13); + + rtw_write_rf(rtwdev, RF_PATH_B, 0x1, 0xfffff, rf_0x1); + + /* WL-S0 2G RF TRX cannot be masked by GNT_BT + * enable "WLS0 BB chage RF mode if GNT_BT = 1" for shared-antenna type + * disable:0x1860[3] = 1, enable:0x1860[3] = 0 + * + * enable "DAC off if GNT_WL = 0" for non-shared-antenna + * disable 0x1c30[22] = 0, + * enable: 0x1c30[22] = 1, 0x1c38[12] = 0, 0x1c38[28] = 1 + */ + if (coex_stat->wl_coex_mode == COEX_WLINK_2GFREE) { + rtw_write8_mask(rtwdev, REG_ANAPAR + 2, + BIT_ANAPAR_BTPS >> 16, 0); + } else { + rtw_write8_mask(rtwdev, REG_ANAPAR + 2, + BIT_ANAPAR_BTPS >> 16, 1); + rtw_write8_mask(rtwdev, REG_RSTB_SEL + 1, + BIT_DAC_OFF_ENABLE, 0); + rtw_write8_mask(rtwdev, REG_RSTB_SEL + 3, + BIT_DAC_OFF_ENABLE, 1); + } + + /* disable WL-S1 BB chage RF mode if GNT_BT + * since RF TRx mask can do it + */ + rtw_write8_mask(rtwdev, REG_IGN_GNTBT4, + BIT_PI_IGNORE_GNT_BT, 1); + + /* disable WL-S0 BB chage RF mode if wifi is at 5G, + * or antenna path is separated + */ + if (coex_stat->wl_coex_mode == COEX_WLINK_2GFREE) { + rtw_write8_mask(rtwdev, REG_IGN_GNT_BT1, + BIT_PI_IGNORE_GNT_BT, 1); + rtw_write8_mask(rtwdev, REG_NOMASK_TXBT, + BIT_NOMASK_TXBT_ENABLE, 1); + } else if (coex_stat->wl_coex_mode == COEX_WLINK_5G || + coex->under_5g || !efuse->share_ant) { + if (coex_stat->kt_ver >= 3) { + rtw_write8_mask(rtwdev, REG_IGN_GNT_BT1, + BIT_PI_IGNORE_GNT_BT, 0); + rtw_write8_mask(rtwdev, REG_NOMASK_TXBT, + BIT_NOMASK_TXBT_ENABLE, 1); + } else { + rtw_write8_mask(rtwdev, REG_IGN_GNT_BT1, + BIT_PI_IGNORE_GNT_BT, 1); + } + } else { + /* shared-antenna */ + rtw_write8_mask(rtwdev, REG_IGN_GNT_BT1, + BIT_PI_IGNORE_GNT_BT, 0); + if (coex_stat->kt_ver >= 3) { + rtw_write8_mask(rtwdev, REG_NOMASK_TXBT, + BIT_NOMASK_TXBT_ENABLE, 0); + } + } +} + +static void rtw8822c_coex_cfg_gnt_debug(struct rtw_dev *rtwdev) +{ + rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 2, BIT_BTGP_SPI_EN >> 16, 0); + rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 3, BIT_BTGP_JTAG_EN >> 24, 0); + rtw_write8_mask(rtwdev, REG_GPIO_MUXCFG + 2, BIT_FSPI_EN >> 16, 0); + rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 1, BIT_LED1DIS >> 8, 0); + rtw_write8_mask(rtwdev, REG_SYS_SDIO_CTRL + 3, BIT_DBG_GNT_WL_BT >> 24, 0); +} + +static void rtw8822c_coex_cfg_rfe_type(struct rtw_dev *rtwdev) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_rfe *coex_rfe = &coex->rfe; + struct rtw_efuse *efuse = &rtwdev->efuse; + + coex_rfe->rfe_module_type = rtwdev->efuse.rfe_option; + coex_rfe->ant_switch_polarity = 0; + coex_rfe->ant_switch_exist = false; + coex_rfe->ant_switch_with_bt = false; + coex_rfe->ant_switch_diversity = false; + + if (efuse->share_ant) + coex_rfe->wlg_at_btg = true; + else + coex_rfe->wlg_at_btg = false; + + /* disable LTE coex in wifi side */ + rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, BIT_LTE_COEX_EN, 0x0); + rtw_coex_write_indirect_reg(rtwdev, LTE_WL_TRX_CTRL, MASKLWORD, 0xffff); + rtw_coex_write_indirect_reg(rtwdev, LTE_BT_TRX_CTRL, MASKLWORD, 0xffff); +} + +static void rtw8822c_coex_cfg_wl_tx_power(struct rtw_dev *rtwdev, u8 wl_pwr) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + + if (wl_pwr == coex_dm->cur_wl_pwr_lvl) + return; + + coex_dm->cur_wl_pwr_lvl = wl_pwr; +} + +static void rtw8822c_coex_cfg_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain) +{ + struct rtw_coex *coex = &rtwdev->coex; + struct rtw_coex_dm *coex_dm = &coex->dm; + + if (low_gain == coex_dm->cur_wl_rx_low_gain_en) + return; + + coex_dm->cur_wl_rx_low_gain_en = low_gain; + + if (coex_dm->cur_wl_rx_low_gain_en) { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], Hi-Li Table On!\n"); + + /* set Rx filter corner RCK offset */ + rtw_write_rf(rtwdev, RF_PATH_A, RF_RCKD, RFREG_MASK, 0x22); + rtw_write_rf(rtwdev, RF_PATH_A, RF_RCK, RFREG_MASK, 0x36); + rtw_write_rf(rtwdev, RF_PATH_B, RF_RCKD, RFREG_MASK, 0x22); + rtw_write_rf(rtwdev, RF_PATH_B, RF_RCK, RFREG_MASK, 0x36); + + } else { + rtw_dbg(rtwdev, RTW_DBG_COEX, "[BTCoex], Hi-Li Table Off!\n"); + + /* set Rx filter corner RCK offset */ + rtw_write_rf(rtwdev, RF_PATH_A, RF_RCKD, RFREG_MASK, 0x20); + rtw_write_rf(rtwdev, RF_PATH_A, RF_RCK, RFREG_MASK, 0x0); + rtw_write_rf(rtwdev, RF_PATH_B, RF_RCKD, RFREG_MASK, 0x20); + rtw_write_rf(rtwdev, RF_PATH_B, RF_RCK, RFREG_MASK, 0x0); + } +} + +static void rtw8822c_bf_enable_bfee_su(struct rtw_dev *rtwdev, + struct rtw_vif *vif, + struct rtw_bfee *bfee) +{ + u8 csi_rsc = 0; + u32 tmp6dc; + + rtw_bf_enable_bfee_su(rtwdev, vif, bfee); + + tmp6dc = rtw_read32(rtwdev, REG_BBPSF_CTRL) | + BIT_WMAC_USE_NDPARATE | + (csi_rsc << 13); + if (vif->net_type == RTW_NET_AP_MODE) + rtw_write32(rtwdev, REG_BBPSF_CTRL, tmp6dc | BIT(12)); + else + rtw_write32(rtwdev, REG_BBPSF_CTRL, tmp6dc & ~BIT(12)); + + rtw_write32(rtwdev, REG_CSI_RRSR, 0x550); +} + +static void rtw8822c_bf_config_bfee_su(struct rtw_dev *rtwdev, + struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable) +{ + if (enable) + rtw8822c_bf_enable_bfee_su(rtwdev, vif, bfee); + else + rtw_bf_remove_bfee_su(rtwdev, bfee); +} + +static void rtw8822c_bf_config_bfee_mu(struct rtw_dev *rtwdev, + struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable) +{ + if (enable) + rtw_bf_enable_bfee_mu(rtwdev, vif, bfee); + else + rtw_bf_remove_bfee_mu(rtwdev, bfee); +} + +static void rtw8822c_bf_config_bfee(struct rtw_dev *rtwdev, struct rtw_vif *vif, + struct rtw_bfee *bfee, bool enable) +{ + if (bfee->role == RTW_BFEE_SU) + rtw8822c_bf_config_bfee_su(rtwdev, vif, bfee, enable); + else if (bfee->role == RTW_BFEE_MU) + rtw8822c_bf_config_bfee_mu(rtwdev, vif, bfee, enable); + else + rtw_warn(rtwdev, "wrong bfee role\n"); +} + +struct dpk_cfg_pair { + u32 addr; + u32 bitmask; + u32 data; +}; + +void rtw8822c_parse_tbl_dpk(struct rtw_dev *rtwdev, + const struct rtw_table *tbl) +{ + const struct dpk_cfg_pair *p = tbl->data; + const struct dpk_cfg_pair *end = p + tbl->size / 3; + + BUILD_BUG_ON(sizeof(struct dpk_cfg_pair) != sizeof(u32) * 3); + + for (; p < end; p++) + rtw_write32_mask(rtwdev, p->addr, p->bitmask, p->data); +} + +static void rtw8822c_dpk_set_gnt_wl(struct rtw_dev *rtwdev, bool is_before_k) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + + if (is_before_k) { + dpk_info->gnt_control = rtw_read32(rtwdev, 0x70); + dpk_info->gnt_value = rtw_coex_read_indirect_reg(rtwdev, 0x38); + rtw_write32_mask(rtwdev, 0x70, BIT(26), 0x1); + rtw_coex_write_indirect_reg(rtwdev, 0x38, MASKBYTE1, 0x77); + } else { + rtw_coex_write_indirect_reg(rtwdev, 0x38, MASKDWORD, + dpk_info->gnt_value); + rtw_write32(rtwdev, 0x70, dpk_info->gnt_control); + } +} + +static void +rtw8822c_dpk_restore_registers(struct rtw_dev *rtwdev, u32 reg_num, + struct rtw_backup_info *bckp) +{ + rtw_restore_reg(rtwdev, bckp, reg_num); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc); + rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_DPD_CLK, 0x4); +} + +static void +rtw8822c_dpk_backup_registers(struct rtw_dev *rtwdev, u32 *reg, + u32 reg_num, struct rtw_backup_info *bckp) +{ + u32 i; + + for (i = 0; i < reg_num; i++) { + bckp[i].len = 4; + bckp[i].reg = reg[i]; + bckp[i].val = rtw_read32(rtwdev, reg[i]); + } +} + +static void rtw8822c_dpk_backup_rf_registers(struct rtw_dev *rtwdev, + u32 *rf_reg, + u32 rf_reg_bak[][2]) +{ + u32 i; + + for (i = 0; i < DPK_RF_REG_NUM; i++) { + rf_reg_bak[i][RF_PATH_A] = rtw_read_rf(rtwdev, RF_PATH_A, + rf_reg[i], RFREG_MASK); + rf_reg_bak[i][RF_PATH_B] = rtw_read_rf(rtwdev, RF_PATH_B, + rf_reg[i], RFREG_MASK); + } +} + +static void rtw8822c_dpk_reload_rf_registers(struct rtw_dev *rtwdev, + u32 *rf_reg, + u32 rf_reg_bak[][2]) +{ + u32 i; + + for (i = 0; i < DPK_RF_REG_NUM; i++) { + rtw_write_rf(rtwdev, RF_PATH_A, rf_reg[i], RFREG_MASK, + rf_reg_bak[i][RF_PATH_A]); + rtw_write_rf(rtwdev, RF_PATH_B, rf_reg[i], RFREG_MASK, + rf_reg_bak[i][RF_PATH_B]); + } +} + +static void rtw8822c_dpk_information(struct rtw_dev *rtwdev) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u32 reg; + u8 band_shift; + + reg = rtw_read_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK); + + band_shift = FIELD_GET(BIT(16), reg); + dpk_info->dpk_band = 1 << band_shift; + dpk_info->dpk_ch = FIELD_GET(0xff, reg); + dpk_info->dpk_bw = FIELD_GET(0x3000, reg); +} + +static void rtw8822c_dpk_rxbb_dc_cal(struct rtw_dev *rtwdev, u8 path) +{ + rtw_write_rf(rtwdev, path, 0x92, RFREG_MASK, 0x84800); + udelay(5); + rtw_write_rf(rtwdev, path, 0x92, RFREG_MASK, 0x84801); + usleep_range(600, 610); + rtw_write_rf(rtwdev, path, 0x92, RFREG_MASK, 0x84800); +} + +static u8 rtw8822c_dpk_dc_corr_check(struct rtw_dev *rtwdev, u8 path) +{ + u16 dc_i, dc_q; + u8 corr_idx; + + rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x000900f0); + dc_i = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(27, 16)); + dc_q = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(11, 0)); + + if (dc_i & BIT(11)) + dc_i = 0x1000 - dc_i; + if (dc_q & BIT(11)) + dc_q = 0x1000 - dc_q; + + rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x000000f0); + corr_idx = (u8)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(7, 0)); + rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(15, 8)); + + if (dc_i > 200 || dc_q > 200 || corr_idx < 40 || corr_idx > 65) + return 1; + else + return 0; + +} + +static void rtw8822c_dpk_tx_pause(struct rtw_dev *rtwdev) +{ + u8 reg_a, reg_b; + u16 count = 0; + + rtw_write8(rtwdev, 0x522, 0xff); + rtw_write32_mask(rtwdev, 0x1e70, 0xf, 0x2); + + do { + reg_a = (u8)rtw_read_rf(rtwdev, RF_PATH_A, 0x00, 0xf0000); + reg_b = (u8)rtw_read_rf(rtwdev, RF_PATH_B, 0x00, 0xf0000); + udelay(2); + count++; + } while ((reg_a == 2 || reg_b == 2) && count < 2500); +} + +static void rtw8822c_dpk_mac_bb_setting(struct rtw_dev *rtwdev) +{ + rtw8822c_dpk_tx_pause(rtwdev); + rtw_load_table(rtwdev, &rtw8822c_dpk_mac_bb_tbl); +} + +static void rtw8822c_dpk_afe_setting(struct rtw_dev *rtwdev, bool is_do_dpk) +{ + if (is_do_dpk) + rtw_load_table(rtwdev, &rtw8822c_dpk_afe_is_dpk_tbl); + else + rtw_load_table(rtwdev, &rtw8822c_dpk_afe_no_dpk_tbl); +} + +static void rtw8822c_dpk_pre_setting(struct rtw_dev *rtwdev) +{ + u8 path; + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + rtw_write_rf(rtwdev, path, RF_RXAGC_OFFSET, RFREG_MASK, 0x0); + rtw_write32(rtwdev, REG_NCTL0, 0x8 | (path << 1)); + if (rtwdev->dm_info.dpk_info.dpk_band == RTW_BAND_2G) + rtw_write32(rtwdev, REG_DPD_CTL1_S1, 0x1f100000); + else + rtw_write32(rtwdev, REG_DPD_CTL1_S1, 0x1f0d0000); + rtw_write32_mask(rtwdev, REG_DPD_LUT0, BIT_GLOSS_DB, 0x4); + rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x3); + } + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc); + rtw_write32(rtwdev, REG_DPD_CTL11, 0x3b23170b); + rtw_write32(rtwdev, REG_DPD_CTL12, 0x775f5347); +} + +static u32 rtw8822c_dpk_rf_setting(struct rtw_dev *rtwdev, u8 path) +{ + u32 ori_txbb; + + rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, RFREG_MASK, 0x50017); + ori_txbb = rtw_read_rf(rtwdev, path, RF_TX_GAIN, RFREG_MASK); + + rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TX_GAIN, 0x1); + rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_PWR_TRIM, 0x1); + rtw_write_rf(rtwdev, path, RF_TX_GAIN_OFFSET, BIT_BB_GAIN, 0x0); + rtw_write_rf(rtwdev, path, RF_TX_GAIN, RFREG_MASK, ori_txbb); + + if (rtwdev->dm_info.dpk_info.dpk_band == RTW_BAND_2G) { + rtw_write_rf(rtwdev, path, RF_TX_GAIN_OFFSET, BIT_RF_GAIN, 0x1); + rtw_write_rf(rtwdev, path, RF_RXG_GAIN, BIT_RXG_GAIN, 0x0); + } else { + rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_TXA_LB_ATT, 0x0); + rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_LB_ATT, 0x6); + rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_LB_SW, 0x1); + rtw_write_rf(rtwdev, path, RF_RXA_MIX_GAIN, BIT_RXA_MIX_GAIN, 0); + } + + rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_RXAGC, 0xf); + rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TRXBW, 0x1); + rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_RXBB, 0x0); + + if (rtwdev->dm_info.dpk_info.dpk_bw == DPK_CHANNEL_WIDTH_80) + rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_TXBB, 0x2); + else + rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_TXBB, 0x1); + + rtw_write_rf(rtwdev, path, RF_EXT_TIA_BW, BIT(1), 0x1); + + usleep_range(100, 110); + + return ori_txbb & 0x1f; +} + +static u16 rtw8822c_dpk_get_cmd(struct rtw_dev *rtwdev, u8 action, u8 path) +{ + u16 cmd; + u8 bw = rtwdev->dm_info.dpk_info.dpk_bw == DPK_CHANNEL_WIDTH_80 ? 2 : 0; + + switch (action) { + case RTW_DPK_GAIN_LOSS: + cmd = 0x14 + path; + break; + case RTW_DPK_DO_DPK: + cmd = 0x16 + path + bw; + break; + case RTW_DPK_DPK_ON: + cmd = 0x1a + path; + break; + case RTW_DPK_DAGC: + cmd = 0x1c + path + bw; + break; + default: + return 0; + } + + return (cmd << 8) | 0x48; +} + +static u8 rtw8822c_dpk_one_shot(struct rtw_dev *rtwdev, u8 path, u8 action) +{ + u16 dpk_cmd; + u8 result = 0; + + rtw8822c_dpk_set_gnt_wl(rtwdev, true); + + if (action == RTW_DPK_CAL_PWR) { + rtw_write32_mask(rtwdev, REG_DPD_CTL0, BIT(12), 0x1); + rtw_write32_mask(rtwdev, REG_DPD_CTL0, BIT(12), 0x0); + rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_RPT_SEL, 0x0); + msleep(10); + if (!check_hw_ready(rtwdev, REG_STAT_RPT, BIT(31), 0x1)) { + result = 1; + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DPK] one-shot over 20ms\n"); + } + } else { + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, + 0x8 | (path << 1)); + rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x9); + + dpk_cmd = rtw8822c_dpk_get_cmd(rtwdev, action, path); + rtw_write32(rtwdev, REG_NCTL0, dpk_cmd); + rtw_write32(rtwdev, REG_NCTL0, dpk_cmd + 1); + msleep(10); + if (!check_hw_ready(rtwdev, 0x2d9c, 0xff, 0x55)) { + result = 1; + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DPK] one-shot over 20ms\n"); + } + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, + 0x8 | (path << 1)); + rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x0); + } + + rtw8822c_dpk_set_gnt_wl(rtwdev, false); + + rtw_write8(rtwdev, 0x1b10, 0x0); + + return result; +} + +static u16 rtw8822c_dpk_dgain_read(struct rtw_dev *rtwdev, u8 path) +{ + u16 dgain; + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc); + rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, 0x00ff0000, 0x0); + + dgain = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(27, 16)); + + return dgain; +} + +static u8 rtw8822c_dpk_thermal_read(struct rtw_dev *rtwdev, u8 path) +{ + rtw_write_rf(rtwdev, path, RF_T_METER, BIT(19), 0x1); + rtw_write_rf(rtwdev, path, RF_T_METER, BIT(19), 0x0); + rtw_write_rf(rtwdev, path, RF_T_METER, BIT(19), 0x1); + udelay(15); + + return (u8)rtw_read_rf(rtwdev, path, RF_T_METER, 0x0007e); +} + +static u32 rtw8822c_dpk_pas_read(struct rtw_dev *rtwdev, u8 path) +{ + u32 i_val, q_val; + + rtw_write32(rtwdev, REG_NCTL0, 0x8 | (path << 1)); + rtw_write32_mask(rtwdev, 0x1b48, BIT(14), 0x0); + rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x00060001); + rtw_write32(rtwdev, 0x1b4c, 0x00000000); + rtw_write32(rtwdev, 0x1b4c, 0x00080000); + + q_val = rtw_read32_mask(rtwdev, REG_STAT_RPT, MASKHWORD); + i_val = rtw_read32_mask(rtwdev, REG_STAT_RPT, MASKLWORD); + + if (i_val & BIT(15)) + i_val = 0x10000 - i_val; + if (q_val & BIT(15)) + q_val = 0x10000 - q_val; + + rtw_write32(rtwdev, 0x1b4c, 0x00000000); + + return i_val * i_val + q_val * q_val; +} + +static u32 rtw8822c_psd_log2base(u32 val) +{ + u32 tmp, val_integerd_b, tindex; + u32 result, val_fractiond_b; + u32 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; + + val_integerd_b = __fls(val) + 1; + + tmp = (val * 100) / (1 << val_integerd_b); + tindex = tmp / 5; + + if (tindex >= ARRAY_SIZE(table_fraction)) + tindex = ARRAY_SIZE(table_fraction) - 1; + + val_fractiond_b = table_fraction[tindex]; + + result = val_integerd_b * 100 - val_fractiond_b; + + return result; +} + +static u8 rtw8822c_dpk_gainloss_result(struct rtw_dev *rtwdev, u8 path) +{ + u8 result; + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1)); + rtw_write32_mask(rtwdev, 0x1b48, BIT(14), 0x1); + rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x00060000); + + result = (u8)rtw_read32_mask(rtwdev, REG_STAT_RPT, 0x000000f0); + + rtw_write32_mask(rtwdev, 0x1b48, BIT(14), 0x0); + + return result; +} + +static u8 rtw8822c_dpk_agc_gain_chk(struct rtw_dev *rtwdev, u8 path, + u8 limited_pga) +{ + u8 result = 0; + u16 dgain; + + rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DAGC); + dgain = rtw8822c_dpk_dgain_read(rtwdev, path); + + if (dgain > 1535 && !limited_pga) + return RTW_DPK_GAIN_LESS; + else if (dgain < 768 && !limited_pga) + return RTW_DPK_GAIN_LARGE; + else + return result; +} + +static u8 rtw8822c_dpk_agc_loss_chk(struct rtw_dev *rtwdev, u8 path) +{ + u32 loss, loss_db; + + loss = rtw8822c_dpk_pas_read(rtwdev, path); + if (loss < 0x4000000) + return RTW_DPK_GL_LESS; + loss_db = 3 * rtw8822c_psd_log2base(loss >> 13) - 3870; + + if (loss_db > 1000) + return RTW_DPK_GL_LARGE; + else if (loss_db < 250) + return RTW_DPK_GL_LESS; + else + return RTW_DPK_AGC_OUT; +} + +struct rtw8822c_dpk_data { + u8 txbb; + u8 pga; + u8 limited_pga; + u8 agc_cnt; + bool loss_only; + bool gain_only; + u8 path; +}; + +static u8 rtw8822c_gain_check_state(struct rtw_dev *rtwdev, + struct rtw8822c_dpk_data *data) +{ + u8 state; + + data->txbb = (u8)rtw_read_rf(rtwdev, data->path, RF_TX_GAIN, + BIT_GAIN_TXBB); + data->pga = (u8)rtw_read_rf(rtwdev, data->path, RF_MODE_TRXAGC, + BIT_RXAGC); + + if (data->loss_only) { + state = RTW_DPK_LOSS_CHECK; + goto check_end; + } + + state = rtw8822c_dpk_agc_gain_chk(rtwdev, data->path, + data->limited_pga); + if (state == RTW_DPK_GAIN_CHECK && data->gain_only) + state = RTW_DPK_AGC_OUT; + else if (state == RTW_DPK_GAIN_CHECK) + state = RTW_DPK_LOSS_CHECK; + +check_end: + data->agc_cnt++; + if (data->agc_cnt >= 6) + state = RTW_DPK_AGC_OUT; + + return state; +} + +static u8 rtw8822c_gain_large_state(struct rtw_dev *rtwdev, + struct rtw8822c_dpk_data *data) +{ + u8 pga = data->pga; + + if (pga > 0xe) + rtw_write_rf(rtwdev, data->path, RF_MODE_TRXAGC, BIT_RXAGC, 0xc); + else if (pga > 0xb && pga < 0xf) + rtw_write_rf(rtwdev, data->path, RF_MODE_TRXAGC, BIT_RXAGC, 0x0); + else if (pga < 0xc) + data->limited_pga = 1; + + return RTW_DPK_GAIN_CHECK; +} + +static u8 rtw8822c_gain_less_state(struct rtw_dev *rtwdev, + struct rtw8822c_dpk_data *data) +{ + u8 pga = data->pga; + + if (pga < 0xc) + rtw_write_rf(rtwdev, data->path, RF_MODE_TRXAGC, BIT_RXAGC, 0xc); + else if (pga > 0xb && pga < 0xf) + rtw_write_rf(rtwdev, data->path, RF_MODE_TRXAGC, BIT_RXAGC, 0xf); + else if (pga > 0xe) + data->limited_pga = 1; + + return RTW_DPK_GAIN_CHECK; +} + +static u8 rtw8822c_gl_state(struct rtw_dev *rtwdev, + struct rtw8822c_dpk_data *data, u8 is_large) +{ + u8 txbb_bound[] = {0x1f, 0}; + + if (data->txbb == txbb_bound[is_large]) + return RTW_DPK_AGC_OUT; + + if (is_large == 1) + data->txbb -= 2; + else + data->txbb += 3; + + rtw_write_rf(rtwdev, data->path, RF_TX_GAIN, BIT_GAIN_TXBB, data->txbb); + data->limited_pga = 0; + + return RTW_DPK_GAIN_CHECK; +} + +static u8 rtw8822c_gl_large_state(struct rtw_dev *rtwdev, + struct rtw8822c_dpk_data *data) +{ + return rtw8822c_gl_state(rtwdev, data, 1); +} + +static u8 rtw8822c_gl_less_state(struct rtw_dev *rtwdev, + struct rtw8822c_dpk_data *data) +{ + return rtw8822c_gl_state(rtwdev, data, 0); +} + +static u8 rtw8822c_loss_check_state(struct rtw_dev *rtwdev, + struct rtw8822c_dpk_data *data) +{ + u8 path = data->path; + u8 state; + + rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_GAIN_LOSS); + state = rtw8822c_dpk_agc_loss_chk(rtwdev, path); + + return state; +} + +static u8 (*dpk_state[])(struct rtw_dev *rtwdev, + struct rtw8822c_dpk_data *data) = { + rtw8822c_gain_check_state, rtw8822c_gain_large_state, + rtw8822c_gain_less_state, rtw8822c_gl_large_state, + rtw8822c_gl_less_state, rtw8822c_loss_check_state }; + +static u8 rtw8822c_dpk_pas_agc(struct rtw_dev *rtwdev, u8 path, + bool gain_only, bool loss_only) +{ + struct rtw8822c_dpk_data data = {0}; + u8 (*func)(struct rtw_dev *rtwdev, struct rtw8822c_dpk_data *data); + u8 state = RTW_DPK_GAIN_CHECK; + + data.loss_only = loss_only; + data.gain_only = gain_only; + data.path = path; + + for (;;) { + func = dpk_state[state]; + state = func(rtwdev, &data); + if (state == RTW_DPK_AGC_OUT) + break; + } + + return data.txbb; +} + +static bool rtw8822c_dpk_coef_iq_check(struct rtw_dev *rtwdev, + u16 coef_i, u16 coef_q) +{ + if (coef_i == 0x1000 || coef_i == 0x0fff || + coef_q == 0x1000 || coef_q == 0x0fff) + return true; + + return false; +} + +static u32 rtw8822c_dpk_coef_transfer(struct rtw_dev *rtwdev) +{ + u32 reg = 0; + u16 coef_i = 0, coef_q = 0; + + reg = rtw_read32(rtwdev, REG_STAT_RPT); + + coef_i = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, MASKHWORD) & 0x1fff; + coef_q = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, MASKLWORD) & 0x1fff; + + coef_q = ((0x2000 - coef_q) & 0x1fff) - 1; + + reg = (coef_i << 16) | coef_q; + + return reg; +} + +static const u32 rtw8822c_dpk_get_coef_tbl[] = { + 0x000400f0, 0x040400f0, 0x080400f0, 0x010400f0, 0x050400f0, + 0x090400f0, 0x020400f0, 0x060400f0, 0x0a0400f0, 0x030400f0, + 0x070400f0, 0x0b0400f0, 0x0c0400f0, 0x100400f0, 0x0d0400f0, + 0x110400f0, 0x0e0400f0, 0x120400f0, 0x0f0400f0, 0x130400f0, +}; + +static void rtw8822c_dpk_coef_tbl_apply(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + int i; + + for (i = 0; i < 20; i++) { + rtw_write32(rtwdev, REG_RXSRAM_CTL, + rtw8822c_dpk_get_coef_tbl[i]); + dpk_info->coef[path][i] = rtw8822c_dpk_coef_transfer(rtwdev); + } +} + +static void rtw8822c_dpk_get_coef(struct rtw_dev *rtwdev, u8 path) +{ + rtw_write32(rtwdev, REG_NCTL0, 0x0000000c); + + if (path == RF_PATH_A) { + rtw_write32_mask(rtwdev, REG_DPD_CTL0, BIT(24), 0x0); + rtw_write32(rtwdev, REG_DPD_CTL0_S0, 0x30000080); + } else if (path == RF_PATH_B) { + rtw_write32_mask(rtwdev, REG_DPD_CTL0, BIT(24), 0x1); + rtw_write32(rtwdev, REG_DPD_CTL0_S1, 0x30000080); + } + + rtw8822c_dpk_coef_tbl_apply(rtwdev, path); +} + +static u8 rtw8822c_dpk_coef_read(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u8 addr, result = 1; + u16 coef_i, coef_q; + + for (addr = 0; addr < 20; addr++) { + coef_i = FIELD_GET(0x1fff0000, dpk_info->coef[path][addr]); + coef_q = FIELD_GET(0x1fff, dpk_info->coef[path][addr]); + + if (rtw8822c_dpk_coef_iq_check(rtwdev, coef_i, coef_q)) { + result = 0; + break; + } + } + return result; +} + +static void rtw8822c_dpk_coef_write(struct rtw_dev *rtwdev, u8 path, u8 result) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u16 reg[DPK_RF_PATH_NUM] = {0x1b0c, 0x1b64}; + u32 coef; + u8 addr; + + rtw_write32(rtwdev, REG_NCTL0, 0x0000000c); + rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x000000f0); + + for (addr = 0; addr < 20; addr++) { + if (result == 0) { + if (addr == 3) + coef = 0x04001fff; + else + coef = 0x00001fff; + } else { + coef = dpk_info->coef[path][addr]; + } + rtw_write32(rtwdev, reg[path] + addr * 4, coef); + } +} + +static void rtw8822c_dpk_fill_result(struct rtw_dev *rtwdev, u32 dpk_txagc, + u8 path, u8 result) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1)); + + if (result) + rtw_write8(rtwdev, REG_DPD_AGC, (u8)(dpk_txagc - 6)); + else + rtw_write8(rtwdev, REG_DPD_AGC, 0x00); + + dpk_info->result[path] = result; + dpk_info->dpk_txagc[path] = rtw_read8(rtwdev, REG_DPD_AGC); + + rtw8822c_dpk_coef_write(rtwdev, path, result); +} + +static u32 rtw8822c_dpk_gainloss(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u8 tx_agc, tx_bb, ori_txbb, ori_txagc, tx_agc_search, t1, t2; + + ori_txbb = rtw8822c_dpk_rf_setting(rtwdev, path); + ori_txagc = (u8)rtw_read_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_TXAGC); + + rtw8822c_dpk_rxbb_dc_cal(rtwdev, path); + rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DAGC); + rtw8822c_dpk_dgain_read(rtwdev, path); + + if (rtw8822c_dpk_dc_corr_check(rtwdev, path)) { + rtw8822c_dpk_rxbb_dc_cal(rtwdev, path); + rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DAGC); + rtw8822c_dpk_dc_corr_check(rtwdev, path); + } + + t1 = rtw8822c_dpk_thermal_read(rtwdev, path); + tx_bb = rtw8822c_dpk_pas_agc(rtwdev, path, false, true); + tx_agc_search = rtw8822c_dpk_gainloss_result(rtwdev, path); + + if (tx_bb < tx_agc_search) + tx_bb = 0; + else + tx_bb = tx_bb - tx_agc_search; + + rtw_write_rf(rtwdev, path, RF_TX_GAIN, BIT_GAIN_TXBB, tx_bb); + + tx_agc = ori_txagc - (ori_txbb - tx_bb); + + t2 = rtw8822c_dpk_thermal_read(rtwdev, path); + + dpk_info->thermal_dpk_delta[path] = abs(t2 - t1); + + return tx_agc; +} + +static u8 rtw8822c_dpk_by_path(struct rtw_dev *rtwdev, u32 tx_agc, u8 path) +{ + u8 result; + + result = rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DO_DPK); + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1)); + + result = result | (u8)rtw_read32_mask(rtwdev, REG_DPD_CTL1_S0, BIT(26)); + + rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, RFREG_MASK, 0x33e14); + + rtw8822c_dpk_get_coef(rtwdev, path); + + return result; +} + +static void rtw8822c_dpk_cal_gs(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u32 tmp_gs = 0; + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1)); + rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_BYPASS_DPD, 0x0); + rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0); + rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x9); + rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_INNER_LB, 0x1); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc); + rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_DPD_CLK, 0xf); + + if (path == RF_PATH_A) { + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0, BIT_GS_PWSF, + 0x1066680); + rtw_write32_mask(rtwdev, REG_DPD_CTL1_S0, BIT_DPD_EN, 0x1); + } else { + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S1, BIT_GS_PWSF, + 0x1066680); + rtw_write32_mask(rtwdev, REG_DPD_CTL1_S1, BIT_DPD_EN, 0x1); + } + + if (dpk_info->dpk_bw == DPK_CHANNEL_WIDTH_80) { + rtw_write32(rtwdev, REG_DPD_CTL16, 0x80001310); + rtw_write32(rtwdev, REG_DPD_CTL16, 0x00001310); + rtw_write32(rtwdev, REG_DPD_CTL16, 0x810000db); + rtw_write32(rtwdev, REG_DPD_CTL16, 0x010000db); + rtw_write32(rtwdev, REG_DPD_CTL16, 0x0000b428); + rtw_write32(rtwdev, REG_DPD_CTL15, + 0x05020000 | (BIT(path) << 28)); + } else { + rtw_write32(rtwdev, REG_DPD_CTL16, 0x8200190c); + rtw_write32(rtwdev, REG_DPD_CTL16, 0x0200190c); + rtw_write32(rtwdev, REG_DPD_CTL16, 0x8301ee14); + rtw_write32(rtwdev, REG_DPD_CTL16, 0x0301ee14); + rtw_write32(rtwdev, REG_DPD_CTL16, 0x0000b428); + rtw_write32(rtwdev, REG_DPD_CTL15, + 0x05020008 | (BIT(path) << 28)); + } + + rtw_write32_mask(rtwdev, REG_DPD_CTL0, MASKBYTE3, 0x8 | path); + + rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_CAL_PWR); + + rtw_write32_mask(rtwdev, REG_DPD_CTL15, MASKBYTE3, 0x0); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1)); + rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x0); + rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_INNER_LB, 0x0); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc); + + if (path == RF_PATH_A) + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0, BIT_GS_PWSF, 0x5b); + else + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S1, BIT_GS_PWSF, 0x5b); + + rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_RPT_SEL, 0x0); + + tmp_gs = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, BIT_RPT_DGAIN); + tmp_gs = (tmp_gs * 910) >> 10; + tmp_gs = DIV_ROUND_CLOSEST(tmp_gs, 10); + + if (path == RF_PATH_A) + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0, BIT_GS_PWSF, tmp_gs); + else + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S1, BIT_GS_PWSF, tmp_gs); + + dpk_info->dpk_gs[path] = tmp_gs; +} + +static void rtw8822c_dpk_cal_coef1(struct rtw_dev *rtwdev) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u32 offset[DPK_RF_PATH_NUM] = {0, 0x58}; + u32 i_scaling; + u8 path; + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x0000000c); + rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x000000f0); + rtw_write32(rtwdev, REG_NCTL0, 0x00001148); + rtw_write32(rtwdev, REG_NCTL0, 0x00001149); + + check_hw_ready(rtwdev, 0x2d9c, MASKBYTE0, 0x55); + + rtw_write8(rtwdev, 0x1b10, 0x0); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x0000000c); + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + i_scaling = 0x16c00 / dpk_info->dpk_gs[path]; + + rtw_write32_mask(rtwdev, 0x1b18 + offset[path], MASKHWORD, + i_scaling); + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0 + offset[path], + GENMASK(31, 28), 0x9); + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0 + offset[path], + GENMASK(31, 28), 0x1); + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0 + offset[path], + GENMASK(31, 28), 0x0); + rtw_write32_mask(rtwdev, REG_DPD_CTL1_S0 + offset[path], + BIT(14), 0x0); + } +} + +static void rtw8822c_dpk_on(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + + rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DPK_ON); + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1)); + rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0); + + if (test_bit(path, dpk_info->dpk_path_ok)) + rtw8822c_dpk_cal_gs(rtwdev, path); +} + +static bool rtw8822c_dpk_check_pass(struct rtw_dev *rtwdev, bool is_fail, + u32 dpk_txagc, u8 path) +{ + bool result; + + if (!is_fail) { + if (rtw8822c_dpk_coef_read(rtwdev, path)) + result = true; + else + result = false; + } else { + result = false; + } + + rtw8822c_dpk_fill_result(rtwdev, dpk_txagc, path, result); + + return result; +} + +static void rtw8822c_dpk_result_reset(struct rtw_dev *rtwdev) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u8 path; + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + clear_bit(path, dpk_info->dpk_path_ok); + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, + 0x8 | (path << 1)); + rtw_write32_mask(rtwdev, 0x1b58, 0x0000007f, 0x0); + + dpk_info->dpk_txagc[path] = 0; + dpk_info->result[path] = 0; + dpk_info->dpk_gs[path] = 0x5b; + dpk_info->pre_pwsf[path] = 0; + dpk_info->thermal_dpk[path] = rtw8822c_dpk_thermal_read(rtwdev, + path); + } +} + +static void rtw8822c_dpk_calibrate(struct rtw_dev *rtwdev, u8 path) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u32 dpk_txagc; + u8 dpk_fail; + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DPK] s%d dpk start\n", path); + + dpk_txagc = rtw8822c_dpk_gainloss(rtwdev, path); + + dpk_fail = rtw8822c_dpk_by_path(rtwdev, dpk_txagc, path); + + if (!rtw8822c_dpk_check_pass(rtwdev, dpk_fail, dpk_txagc, path)) + rtw_err(rtwdev, "failed to do dpk calibration\n"); + + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DPK] s%d dpk finish\n", path); + + if (dpk_info->result[path]) + set_bit(path, dpk_info->dpk_path_ok); +} + +static void rtw8822c_dpk_path_select(struct rtw_dev *rtwdev) +{ + rtw8822c_dpk_calibrate(rtwdev, RF_PATH_A); + rtw8822c_dpk_calibrate(rtwdev, RF_PATH_B); + rtw8822c_dpk_on(rtwdev, RF_PATH_A); + rtw8822c_dpk_on(rtwdev, RF_PATH_B); + rtw8822c_dpk_cal_coef1(rtwdev); +} + +static void rtw8822c_dpk_enable_disable(struct rtw_dev *rtwdev) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u32 mask = BIT(15) | BIT(14); + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc); + + rtw_write32_mask(rtwdev, REG_DPD_CTL1_S0, BIT_DPD_EN, + dpk_info->is_dpk_pwr_on); + rtw_write32_mask(rtwdev, REG_DPD_CTL1_S1, BIT_DPD_EN, + dpk_info->is_dpk_pwr_on); + + if (test_bit(RF_PATH_A, dpk_info->dpk_path_ok)) { + rtw_write32_mask(rtwdev, REG_DPD_CTL1_S0, mask, 0x0); + rtw_write8(rtwdev, REG_DPD_CTL0_S0, dpk_info->dpk_gs[RF_PATH_A]); + } + if (test_bit(RF_PATH_B, dpk_info->dpk_path_ok)) { + rtw_write32_mask(rtwdev, REG_DPD_CTL1_S1, mask, 0x0); + rtw_write8(rtwdev, REG_DPD_CTL0_S1, dpk_info->dpk_gs[RF_PATH_B]); + } +} + +static void rtw8822c_dpk_reload_data(struct rtw_dev *rtwdev) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u8 path; + + if (!test_bit(RF_PATH_A, dpk_info->dpk_path_ok) && + !test_bit(RF_PATH_B, dpk_info->dpk_path_ok) && + dpk_info->dpk_ch == 0) + return; + + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, + 0x8 | (path << 1)); + if (dpk_info->dpk_band == RTW_BAND_2G) + rtw_write32(rtwdev, REG_DPD_CTL1_S1, 0x1f100000); + else + rtw_write32(rtwdev, REG_DPD_CTL1_S1, 0x1f0d0000); + + rtw_write8(rtwdev, REG_DPD_AGC, dpk_info->dpk_txagc[path]); + + rtw8822c_dpk_coef_write(rtwdev, path, + test_bit(path, dpk_info->dpk_path_ok)); + + rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DPK_ON); + + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc); + + if (path == RF_PATH_A) + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0, BIT_GS_PWSF, + dpk_info->dpk_gs[path]); + else + rtw_write32_mask(rtwdev, REG_DPD_CTL0_S1, BIT_GS_PWSF, + dpk_info->dpk_gs[path]); + } + rtw8822c_dpk_cal_coef1(rtwdev); +} + +static bool rtw8822c_dpk_reload(struct rtw_dev *rtwdev) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u8 channel; + + dpk_info->is_reload = false; + + channel = (u8)(rtw_read_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK) & 0xff); + + if (channel == dpk_info->dpk_ch) { + rtw_dbg(rtwdev, RTW_DBG_RFK, + "[DPK] DPK reload for CH%d!!\n", dpk_info->dpk_ch); + rtw8822c_dpk_reload_data(rtwdev); + dpk_info->is_reload = true; + } + + return dpk_info->is_reload; +} + +static void rtw8822c_do_dpk(struct rtw_dev *rtwdev) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + struct rtw_backup_info bckp[DPK_BB_REG_NUM]; + u32 rf_reg_backup[DPK_RF_REG_NUM][DPK_RF_PATH_NUM]; + u32 bb_reg[DPK_BB_REG_NUM] = { + 0x520, 0x820, 0x824, 0x1c3c, 0x1d58, 0x1864, + 0x4164, 0x180c, 0x410c, 0x186c, 0x416c, + 0x1a14, 0x1e70, 0x80c, 0x1d70, 0x1e7c, 0x18a4, 0x41a4}; + u32 rf_reg[DPK_RF_REG_NUM] = { + 0x0, 0x1a, 0x55, 0x63, 0x87, 0x8f, 0xde}; + u8 path; + + if (!dpk_info->is_dpk_pwr_on) { + rtw_dbg(rtwdev, RTW_DBG_RFK, "[DPK] Skip DPK due to DPD PWR off\n"); + return; + } else if (rtw8822c_dpk_reload(rtwdev)) { + return; + } + + for (path = RF_PATH_A; path < DPK_RF_PATH_NUM; path++) + ewma_thermal_init(&dpk_info->avg_thermal[path]); + + rtw8822c_dpk_information(rtwdev); + + rtw8822c_dpk_backup_registers(rtwdev, bb_reg, DPK_BB_REG_NUM, bckp); + rtw8822c_dpk_backup_rf_registers(rtwdev, rf_reg, rf_reg_backup); + + rtw8822c_dpk_mac_bb_setting(rtwdev); + rtw8822c_dpk_afe_setting(rtwdev, true); + rtw8822c_dpk_pre_setting(rtwdev); + rtw8822c_dpk_result_reset(rtwdev); + rtw8822c_dpk_path_select(rtwdev); + rtw8822c_dpk_afe_setting(rtwdev, false); + rtw8822c_dpk_enable_disable(rtwdev); + + rtw8822c_dpk_reload_rf_registers(rtwdev, rf_reg, rf_reg_backup); + for (path = 0; path < rtwdev->hal.rf_path_num; path++) + rtw8822c_dpk_rxbb_dc_cal(rtwdev, path); + rtw8822c_dpk_restore_registers(rtwdev, DPK_BB_REG_NUM, bckp); +} + +static void rtw8822c_phy_calibration(struct rtw_dev *rtwdev) +{ + rtw8822c_rfk_power_save(rtwdev, false); + rtw8822c_do_gapk(rtwdev); + rtw8822c_do_iqk(rtwdev); + rtw8822c_do_dpk(rtwdev); + rtw8822c_rfk_power_save(rtwdev, true); +} + +static void rtw8822c_dpk_track(struct rtw_dev *rtwdev) +{ + struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info; + u8 path; + u8 thermal_value[DPK_RF_PATH_NUM] = {0}; + s8 offset[DPK_RF_PATH_NUM], delta_dpk[DPK_RF_PATH_NUM]; + + if (dpk_info->thermal_dpk[0] == 0 && dpk_info->thermal_dpk[1] == 0) + return; + + for (path = 0; path < DPK_RF_PATH_NUM; path++) { + thermal_value[path] = rtw8822c_dpk_thermal_read(rtwdev, path); + ewma_thermal_add(&dpk_info->avg_thermal[path], + thermal_value[path]); + thermal_value[path] = + ewma_thermal_read(&dpk_info->avg_thermal[path]); + delta_dpk[path] = dpk_info->thermal_dpk[path] - + thermal_value[path]; + offset[path] = delta_dpk[path] - + dpk_info->thermal_dpk_delta[path]; + offset[path] &= 0x7f; + + if (offset[path] != dpk_info->pre_pwsf[path]) { + rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, + 0x8 | (path << 1)); + rtw_write32_mask(rtwdev, 0x1b58, GENMASK(6, 0), + offset[path]); + dpk_info->pre_pwsf[path] = offset[path]; + } + } +} + +#define XCAP_EXTEND(val) ({typeof(val) _v = (val); _v | _v << 7; }) +static void rtw8822c_set_crystal_cap_reg(struct rtw_dev *rtwdev, u8 crystal_cap) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_cfo_track *cfo = &dm_info->cfo_track; + u32 val = 0; + + val = XCAP_EXTEND(crystal_cap); + cfo->crystal_cap = crystal_cap; + rtw_write32_mask(rtwdev, REG_ANAPAR_XTAL_0, BIT_XCAP_0, val); +} + +static void rtw8822c_set_crystal_cap(struct rtw_dev *rtwdev, u8 crystal_cap) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_cfo_track *cfo = &dm_info->cfo_track; + + if (cfo->crystal_cap == crystal_cap) + return; + + rtw8822c_set_crystal_cap_reg(rtwdev, crystal_cap); +} + +static void rtw8822c_cfo_tracking_reset(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_cfo_track *cfo = &dm_info->cfo_track; + + cfo->is_adjust = true; + + if (cfo->crystal_cap > rtwdev->efuse.crystal_cap) + rtw8822c_set_crystal_cap(rtwdev, cfo->crystal_cap - 1); + else if (cfo->crystal_cap < rtwdev->efuse.crystal_cap) + rtw8822c_set_crystal_cap(rtwdev, cfo->crystal_cap + 1); +} + +static void rtw8822c_cfo_init(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_cfo_track *cfo = &dm_info->cfo_track; + + cfo->crystal_cap = rtwdev->efuse.crystal_cap; + cfo->is_adjust = true; +} + +#define REPORT_TO_KHZ(val) ({typeof(val) _v = (val); (_v << 1) + (_v >> 1); }) +static s32 rtw8822c_cfo_calc_avg(struct rtw_dev *rtwdev, u8 path_num) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_cfo_track *cfo = &dm_info->cfo_track; + s32 cfo_avg, cfo_path_sum = 0, cfo_rpt_sum; + u8 i; + + for (i = 0; i < path_num; i++) { + cfo_rpt_sum = REPORT_TO_KHZ(cfo->cfo_tail[i]); + + if (cfo->cfo_cnt[i]) + cfo_avg = cfo_rpt_sum / cfo->cfo_cnt[i]; + else + cfo_avg = 0; + + cfo_path_sum += cfo_avg; + } + + for (i = 0; i < path_num; i++) { + cfo->cfo_tail[i] = 0; + cfo->cfo_cnt[i] = 0; + } + + return cfo_path_sum / path_num; +} + +static void rtw8822c_cfo_need_adjust(struct rtw_dev *rtwdev, s32 cfo_avg) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_cfo_track *cfo = &dm_info->cfo_track; + + if (!cfo->is_adjust) { + if (abs(cfo_avg) > CFO_TRK_ENABLE_TH) + cfo->is_adjust = true; + } else { + if (abs(cfo_avg) <= CFO_TRK_STOP_TH) + cfo->is_adjust = false; + } + + if (!rtw_coex_disabled(rtwdev)) { + cfo->is_adjust = false; + rtw8822c_set_crystal_cap(rtwdev, rtwdev->efuse.crystal_cap); + } +} + +static void rtw8822c_cfo_track(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_cfo_track *cfo = &dm_info->cfo_track; + u8 path_num = rtwdev->hal.rf_path_num; + s8 crystal_cap = cfo->crystal_cap; + s32 cfo_avg = 0; + + if (rtwdev->sta_cnt != 1) { + rtw8822c_cfo_tracking_reset(rtwdev); + return; + } + + if (cfo->packet_count == cfo->packet_count_pre) + return; + + cfo->packet_count_pre = cfo->packet_count; + cfo_avg = rtw8822c_cfo_calc_avg(rtwdev, path_num); + rtw8822c_cfo_need_adjust(rtwdev, cfo_avg); + + if (cfo->is_adjust) { + if (cfo_avg > CFO_TRK_ADJ_TH) + crystal_cap++; + else if (cfo_avg < -CFO_TRK_ADJ_TH) + crystal_cap--; + + crystal_cap = clamp_t(s8, crystal_cap, 0, XCAP_MASK); + rtw8822c_set_crystal_cap(rtwdev, (u8)crystal_cap); + } +} + +static const struct rtw_phy_cck_pd_reg +rtw8822c_cck_pd_reg[RTW_CHANNEL_WIDTH_40 + 1][RTW_RF_PATH_MAX] = { + { + {0x1ac8, 0x00ff, 0x1ad0, 0x01f}, + {0x1ac8, 0xff00, 0x1ad0, 0x3e0} + }, + { + {0x1acc, 0x00ff, 0x1ad0, 0x01F00000}, + {0x1acc, 0xff00, 0x1ad0, 0x3E000000} + }, +}; + +#define RTW_CCK_PD_MAX 255 +#define RTW_CCK_CS_MAX 31 +#define RTW_CCK_CS_ERR1 27 +#define RTW_CCK_CS_ERR2 29 +static void +rtw8822c_phy_cck_pd_set_reg(struct rtw_dev *rtwdev, + s8 pd_diff, s8 cs_diff, u8 bw, u8 nrx) +{ + u32 pd, cs; + + if (WARN_ON(bw > RTW_CHANNEL_WIDTH_40 || nrx >= RTW_RF_PATH_MAX)) + return; + + pd = rtw_read32_mask(rtwdev, + rtw8822c_cck_pd_reg[bw][nrx].reg_pd, + rtw8822c_cck_pd_reg[bw][nrx].mask_pd); + cs = rtw_read32_mask(rtwdev, + rtw8822c_cck_pd_reg[bw][nrx].reg_cs, + rtw8822c_cck_pd_reg[bw][nrx].mask_cs); + pd += pd_diff; + cs += cs_diff; + if (pd > RTW_CCK_PD_MAX) + pd = RTW_CCK_PD_MAX; + if (cs == RTW_CCK_CS_ERR1 || cs == RTW_CCK_CS_ERR2) + cs++; + else if (cs > RTW_CCK_CS_MAX) + cs = RTW_CCK_CS_MAX; + rtw_write32_mask(rtwdev, + rtw8822c_cck_pd_reg[bw][nrx].reg_pd, + rtw8822c_cck_pd_reg[bw][nrx].mask_pd, + pd); + rtw_write32_mask(rtwdev, + rtw8822c_cck_pd_reg[bw][nrx].reg_cs, + rtw8822c_cck_pd_reg[bw][nrx].mask_cs, + cs); + + rtw_dbg(rtwdev, RTW_DBG_PHY, + "is_linked=%d, bw=%d, nrx=%d, cs_ratio=0x%x, pd_th=0x%x\n", + rtw_is_assoc(rtwdev), bw, nrx, cs, pd); +} + +static void rtw8822c_phy_cck_pd_set(struct rtw_dev *rtwdev, u8 new_lvl) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s8 pd_lvl[CCK_PD_LV_MAX] = {0, 2, 4, 6, 8}; + s8 cs_lvl[CCK_PD_LV_MAX] = {0, 2, 2, 2, 4}; + u8 cur_lvl; + u8 nrx, bw; + + nrx = (u8)rtw_read32_mask(rtwdev, 0x1a2c, 0x60000); + bw = (u8)rtw_read32_mask(rtwdev, 0x9b0, 0xc); + + rtw_dbg(rtwdev, RTW_DBG_PHY, "lv: (%d) -> (%d) bw=%d nr=%d cck_fa_avg=%d\n", + dm_info->cck_pd_lv[bw][nrx], new_lvl, bw, nrx, + dm_info->cck_fa_avg); + + if (dm_info->cck_pd_lv[bw][nrx] == new_lvl) + return; + + cur_lvl = dm_info->cck_pd_lv[bw][nrx]; + + /* update cck pd info */ + dm_info->cck_fa_avg = CCK_FA_AVG_RESET; + + rtw8822c_phy_cck_pd_set_reg(rtwdev, + pd_lvl[new_lvl] - pd_lvl[cur_lvl], + cs_lvl[new_lvl] - cs_lvl[cur_lvl], + bw, nrx); + dm_info->cck_pd_lv[bw][nrx] = new_lvl; +} + +#define PWR_TRACK_MASK 0x7f +static void rtw8822c_pwrtrack_set(struct rtw_dev *rtwdev, u8 rf_path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + switch (rf_path) { + case RF_PATH_A: + rtw_write32_mask(rtwdev, 0x18a0, PWR_TRACK_MASK, + dm_info->delta_power_index[rf_path]); + break; + case RF_PATH_B: + rtw_write32_mask(rtwdev, 0x41a0, PWR_TRACK_MASK, + dm_info->delta_power_index[rf_path]); + break; + default: + break; + } +} + +static void rtw8822c_pwr_track_stats(struct rtw_dev *rtwdev, u8 path) +{ + u8 thermal_value; + + if (rtwdev->efuse.thermal_meter[path] == 0xff) + return; + + thermal_value = rtw_read_rf(rtwdev, path, RF_T_METER, 0x7e); + rtw_phy_pwrtrack_avg(rtwdev, thermal_value, path); +} + +static void rtw8822c_pwr_track_path(struct rtw_dev *rtwdev, + struct rtw_swing_table *swing_table, + u8 path) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + u8 delta; + + delta = rtw_phy_pwrtrack_get_delta(rtwdev, path); + dm_info->delta_power_index[path] = + rtw_phy_pwrtrack_get_pwridx(rtwdev, swing_table, path, path, + delta); + rtw8822c_pwrtrack_set(rtwdev, path); +} + +static void __rtw8822c_pwr_track(struct rtw_dev *rtwdev) +{ + struct rtw_swing_table swing_table; + u8 i; + + rtw_phy_config_swing_table(rtwdev, &swing_table); + + for (i = 0; i < rtwdev->hal.rf_path_num; i++) + rtw8822c_pwr_track_stats(rtwdev, i); + if (rtw_phy_pwrtrack_need_lck(rtwdev)) + rtw8822c_do_lck(rtwdev); + for (i = 0; i < rtwdev->hal.rf_path_num; i++) + rtw8822c_pwr_track_path(rtwdev, &swing_table, i); +} + +static void rtw8822c_pwr_track(struct rtw_dev *rtwdev) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + + if (efuse->power_track_type != 0) + return; + + if (!dm_info->pwr_trk_triggered) { + rtw_write_rf(rtwdev, RF_PATH_A, RF_T_METER, BIT(19), 0x01); + rtw_write_rf(rtwdev, RF_PATH_A, RF_T_METER, BIT(19), 0x00); + rtw_write_rf(rtwdev, RF_PATH_A, RF_T_METER, BIT(19), 0x01); + + rtw_write_rf(rtwdev, RF_PATH_B, RF_T_METER, BIT(19), 0x01); + rtw_write_rf(rtwdev, RF_PATH_B, RF_T_METER, BIT(19), 0x00); + rtw_write_rf(rtwdev, RF_PATH_B, RF_T_METER, BIT(19), 0x01); + + dm_info->pwr_trk_triggered = true; + return; + } + + __rtw8822c_pwr_track(rtwdev); + dm_info->pwr_trk_triggered = false; +} + +static void rtw8822c_adaptivity_init(struct rtw_dev *rtwdev) +{ + rtw_phy_set_edcca_th(rtwdev, RTW8822C_EDCCA_MAX, RTW8822C_EDCCA_MAX); + + /* mac edcca state setting */ + rtw_write32_clr(rtwdev, REG_TX_PTCL_CTRL, BIT_DIS_EDCCA); + rtw_write32_set(rtwdev, REG_RD_CTRL, BIT_EDCCA_MSK_CNTDOWN_EN); + + /* edcca decistion opt */ + rtw_write32_clr(rtwdev, REG_EDCCA_DECISION, BIT_EDCCA_OPTION); +} + +static void rtw8822c_adaptivity(struct rtw_dev *rtwdev) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + s8 l2h, h2l; + u8 igi; + + igi = dm_info->igi_history[0]; + if (dm_info->edcca_mode == RTW_EDCCA_NORMAL) { + l2h = max_t(s8, igi + EDCCA_IGI_L2H_DIFF, EDCCA_TH_L2H_LB); + h2l = l2h - EDCCA_L2H_H2L_DIFF_NORMAL; + } else { + if (igi < dm_info->l2h_th_ini - EDCCA_ADC_BACKOFF) + l2h = igi + EDCCA_ADC_BACKOFF; + else + l2h = dm_info->l2h_th_ini; + h2l = l2h - EDCCA_L2H_H2L_DIFF; + } + + rtw_phy_set_edcca_th(rtwdev, l2h, h2l); +} + +static void rtw8822c_fill_txdesc_checksum(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *txdesc) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + size_t words; + + words = (pkt_info->pkt_offset * 8 + chip->tx_pkt_desc_sz) / 2; + + fill_txdesc_checksum_common(txdesc, words); +} + +static const struct rtw_pwr_seq_cmd trans_carddis_to_cardemu_8822c[] = { + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_POLLING, BIT(1), BIT(1)}, + {0x002E, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), BIT(2)}, + {0x002D, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x007F, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7), 0}, + {0x004A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3) | BIT(4) | BIT(7), 0}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_cardemu_to_act_8822c[] = { + {0x0000, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3) | BIT(2)), 0}, + {0x0075, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(1), BIT(1)}, + {0x0075, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0xFF1A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x002E, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3), 0}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3)), 0}, + {0x1018, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), BIT(2)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(0), 0}, + {0x0074, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), BIT(5)}, + {0x0071, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(4), 0}, + {0x0062, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(7) | BIT(6) | BIT(5)), + (BIT(7) | BIT(6) | BIT(5))}, + {0x0061, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(7) | BIT(6) | BIT(5)), 0}, + {0x001F, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(7) | BIT(6)), BIT(7)}, + {0x00EF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, (BIT(7) | BIT(6)), BIT(7)}, + {0x1045, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(4), BIT(4)}, + {0x0010, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), BIT(2)}, + {0x1064, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), BIT(1)}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_act_to_cardemu_8822c[] = { + {0x0093, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3), 0}, + {0x001F, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x00EF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0}, + {0x1045, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(4), 0}, + {0xFF1A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x30}, + {0x0049, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0006, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0x0002, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), BIT(1)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_POLLING, BIT(1), 0}, + {0x0000, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), BIT(5)}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd trans_cardemu_to_carddis_8822c[] = { + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7), BIT(7)}, + {0x0007, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x00}, + {0x0067, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(5), 0}, + {0x004A, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(0), 0}, + {0x0081, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(7) | BIT(6), 0}, + {0x0090, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(1), 0}, + {0x0092, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x20}, + {0x0093, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, 0xFF, 0x04}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3)}, + {0x0005, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_PCI_MSK, + RTW_PWR_ADDR_MAC, + RTW_PWR_CMD_WRITE, BIT(2), BIT(2)}, + {0x0086, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_SDIO_MSK, + RTW_PWR_ADDR_SDIO, + RTW_PWR_CMD_WRITE, BIT(0), BIT(0)}, + {0xFFFF, + RTW_PWR_CUT_ALL_MSK, + RTW_PWR_INTF_ALL_MSK, + 0, + RTW_PWR_CMD_END, 0, 0}, +}; + +static const struct rtw_pwr_seq_cmd *card_enable_flow_8822c[] = { + trans_carddis_to_cardemu_8822c, + trans_cardemu_to_act_8822c, + NULL +}; + +static const struct rtw_pwr_seq_cmd *card_disable_flow_8822c[] = { + trans_act_to_cardemu_8822c, + trans_cardemu_to_carddis_8822c, + NULL +}; + +static const struct rtw_intf_phy_para usb2_param_8822c[] = { + {0xFFFF, 0x00, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para usb3_param_8822c[] = { + {0xFFFF, 0x0000, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para pcie_gen1_param_8822c[] = { + {0xFFFF, 0x0000, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para pcie_gen2_param_8822c[] = { + {0xFFFF, 0x0000, + RTW_IP_SEL_PHY, + RTW_INTF_PHY_CUT_ALL, + RTW_INTF_PHY_PLATFORM_ALL}, +}; + +static const struct rtw_intf_phy_para_table phy_para_table_8822c = { + .usb2_para = usb2_param_8822c, + .usb3_para = usb3_param_8822c, + .gen1_para = pcie_gen1_param_8822c, + .gen2_para = pcie_gen2_param_8822c, + .n_usb2_para = ARRAY_SIZE(usb2_param_8822c), + .n_usb3_para = ARRAY_SIZE(usb2_param_8822c), + .n_gen1_para = ARRAY_SIZE(pcie_gen1_param_8822c), + .n_gen2_para = ARRAY_SIZE(pcie_gen2_param_8822c), +}; + +static const struct rtw_rfe_def rtw8822c_rfe_defs[] = { + [0] = RTW_DEF_RFE(8822c, 0, 0), + [1] = RTW_DEF_RFE(8822c, 0, 0), + [2] = RTW_DEF_RFE(8822c, 0, 0), + [3] = RTW_DEF_RFE(8822c, 0, 0), + [4] = RTW_DEF_RFE(8822c, 0, 0), + [5] = RTW_DEF_RFE(8822c, 0, 5), + [6] = RTW_DEF_RFE(8822c, 0, 0), +}; + +static const struct rtw_hw_reg rtw8822c_dig[] = { + [0] = { .addr = 0x1d70, .mask = 0x7f }, + [1] = { .addr = 0x1d70, .mask = 0x7f00 }, +}; + +static const struct rtw_ltecoex_addr rtw8822c_ltecoex_addr = { + .ctrl = LTECOEX_ACCESS_CTRL, + .wdata = LTECOEX_WRITE_DATA, + .rdata = LTECOEX_READ_DATA, +}; + +static const struct rtw_page_table page_table_8822c[] = { + {64, 64, 64, 64, 1}, + {64, 64, 64, 64, 1}, + {64, 64, 0, 0, 1}, + {64, 64, 64, 0, 1}, + {64, 64, 64, 64, 1}, +}; + +static const struct rtw_rqpn rqpn_table_8822c[] = { + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_HIGH, + RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH}, + {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL, + RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW, + RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH}, +}; + +static struct rtw_prioq_addrs prioq_addrs_8822c = { + .prio[RTW_DMA_MAPPING_EXTRA] = { + .rsvd = REG_FIFOPAGE_INFO_4, .avail = REG_FIFOPAGE_INFO_4 + 2, + }, + .prio[RTW_DMA_MAPPING_LOW] = { + .rsvd = REG_FIFOPAGE_INFO_2, .avail = REG_FIFOPAGE_INFO_2 + 2, + }, + .prio[RTW_DMA_MAPPING_NORMAL] = { + .rsvd = REG_FIFOPAGE_INFO_3, .avail = REG_FIFOPAGE_INFO_3 + 2, + }, + .prio[RTW_DMA_MAPPING_HIGH] = { + .rsvd = REG_FIFOPAGE_INFO_1, .avail = REG_FIFOPAGE_INFO_1 + 2, + }, + .wsize = true, +}; + +static struct rtw_chip_ops rtw8822c_ops = { + .phy_set_param = rtw8822c_phy_set_param, + .read_efuse = rtw8822c_read_efuse, + .query_rx_desc = rtw8822c_query_rx_desc, + .set_channel = rtw8822c_set_channel, + .mac_init = rtw8822c_mac_init, + .dump_fw_crash = rtw8822c_dump_fw_crash, + .read_rf = rtw_phy_read_rf, + .write_rf = rtw_phy_write_rf_reg_mix, + .set_tx_power_index = rtw8822c_set_tx_power_index, + .set_antenna = rtw8822c_set_antenna, + .cfg_ldo25 = rtw8822c_cfg_ldo25, + .false_alarm_statistics = rtw8822c_false_alarm_statistics, + .dpk_track = rtw8822c_dpk_track, + .phy_calibration = rtw8822c_phy_calibration, + .cck_pd_set = rtw8822c_phy_cck_pd_set, + .pwr_track = rtw8822c_pwr_track, + .config_bfee = rtw8822c_bf_config_bfee, + .set_gid_table = rtw_bf_set_gid_table, + .cfg_csi_rate = rtw_bf_cfg_csi_rate, + .adaptivity_init = rtw8822c_adaptivity_init, + .adaptivity = rtw8822c_adaptivity, + .cfo_init = rtw8822c_cfo_init, + .cfo_track = rtw8822c_cfo_track, + .config_tx_path = rtw8822c_config_tx_path, + .config_txrx_mode = rtw8822c_config_trx_mode, + .fill_txdesc_checksum = rtw8822c_fill_txdesc_checksum, + + .coex_set_init = rtw8822c_coex_cfg_init, + .coex_set_ant_switch = NULL, + .coex_set_gnt_fix = rtw8822c_coex_cfg_gnt_fix, + .coex_set_gnt_debug = rtw8822c_coex_cfg_gnt_debug, + .coex_set_rfe_type = rtw8822c_coex_cfg_rfe_type, + .coex_set_wl_tx_power = rtw8822c_coex_cfg_wl_tx_power, + .coex_set_wl_rx_gain = rtw8822c_coex_cfg_wl_rx_gain, +}; + +/* Shared-Antenna Coex Table */ +static const struct coex_table_para table_sant_8822c[] = { + {0xffffffff, 0xffffffff}, /* case-0 */ + {0x55555555, 0x55555555}, + {0x66555555, 0x66555555}, + {0xaaaaaaaa, 0xaaaaaaaa}, + {0x5a5a5a5a, 0x5a5a5a5a}, + {0xfafafafa, 0xfafafafa}, /* case-5 */ + {0x6a5a5555, 0xaaaaaaaa}, + {0x6a5a56aa, 0x6a5a56aa}, + {0x6a5a5a5a, 0x6a5a5a5a}, + {0x66555555, 0x5a5a5a5a}, + {0x66555555, 0x6a5a5a5a}, /* case-10 */ + {0x66555555, 0x6a5a5aaa}, + {0x66555555, 0x5a5a5aaa}, + {0x66555555, 0x6aaa5aaa}, + {0x66555555, 0xaaaa5aaa}, + {0x66555555, 0xaaaaaaaa}, /* case-15 */ + {0xffff55ff, 0xfafafafa}, + {0xffff55ff, 0x6afa5afa}, + {0xaaffffaa, 0xfafafafa}, + {0xaa5555aa, 0x5a5a5a5a}, + {0xaa5555aa, 0x6a5a5a5a}, /* case-20 */ + {0xaa5555aa, 0xaaaaaaaa}, + {0xffffffff, 0x5a5a5a5a}, + {0xffffffff, 0x5a5a5a5a}, + {0xffffffff, 0x55555555}, + {0xffffffff, 0x5a5a5aaa}, /* case-25 */ + {0x55555555, 0x5a5a5a5a}, + {0x55555555, 0xaaaaaaaa}, + {0x55555555, 0x6a5a6a5a}, + {0x66556655, 0x66556655}, + {0x66556aaa, 0x6a5a6aaa}, /*case-30*/ + {0xffffffff, 0x5aaa5aaa}, + {0x56555555, 0x5a5a5aaa}, + {0xdaffdaff, 0xdaffdaff}, + {0xddffddff, 0xddffddff}, +}; + +/* Non-Shared-Antenna Coex Table */ +static const struct coex_table_para table_nsant_8822c[] = { + {0xffffffff, 0xffffffff}, /* case-100 */ + {0x55555555, 0x55555555}, + {0x66555555, 0x66555555}, + {0xaaaaaaaa, 0xaaaaaaaa}, + {0x5a5a5a5a, 0x5a5a5a5a}, + {0xfafafafa, 0xfafafafa}, /* case-105 */ + {0x5afa5afa, 0x5afa5afa}, + {0x55555555, 0xfafafafa}, + {0x66555555, 0xfafafafa}, + {0x66555555, 0x5a5a5a5a}, + {0x66555555, 0x6a5a5a5a}, /* case-110 */ + {0x66555555, 0xaaaaaaaa}, + {0xffff55ff, 0xfafafafa}, + {0xffff55ff, 0x5afa5afa}, + {0xffff55ff, 0xaaaaaaaa}, + {0xffff55ff, 0xffff55ff}, /* case-115 */ + {0xaaffffaa, 0x5afa5afa}, + {0xaaffffaa, 0xaaaaaaaa}, + {0xffffffff, 0xfafafafa}, + {0xffffffff, 0x5afa5afa}, + {0xffffffff, 0xaaaaaaaa}, /* case-120 */ + {0x55ff55ff, 0x5afa5afa}, + {0x55ff55ff, 0xaaaaaaaa}, + {0x55ff55ff, 0x55ff55ff} +}; + +/* Shared-Antenna TDMA */ +static const struct coex_tdma_para tdma_sant_8822c[] = { + { {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-0 */ + { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-1 */ + { {0x61, 0x3a, 0x03, 0x11, 0x11} }, + { {0x61, 0x30, 0x03, 0x11, 0x11} }, + { {0x61, 0x20, 0x03, 0x11, 0x11} }, + { {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-5 */ + { {0x61, 0x45, 0x03, 0x11, 0x10} }, + { {0x61, 0x3a, 0x03, 0x11, 0x10} }, + { {0x61, 0x30, 0x03, 0x11, 0x10} }, + { {0x61, 0x20, 0x03, 0x11, 0x10} }, + { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-10 */ + { {0x61, 0x08, 0x03, 0x11, 0x14} }, + { {0x61, 0x08, 0x03, 0x10, 0x14} }, + { {0x51, 0x08, 0x03, 0x10, 0x54} }, + { {0x51, 0x08, 0x03, 0x10, 0x55} }, + { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-15 */ + { {0x51, 0x45, 0x03, 0x10, 0x50} }, + { {0x51, 0x3a, 0x03, 0x10, 0x50} }, + { {0x51, 0x30, 0x03, 0x10, 0x50} }, + { {0x51, 0x20, 0x03, 0x10, 0x50} }, + { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-20 */ + { {0x51, 0x4a, 0x03, 0x10, 0x50} }, + { {0x51, 0x0c, 0x03, 0x10, 0x54} }, + { {0x55, 0x08, 0x03, 0x10, 0x54} }, + { {0x65, 0x10, 0x03, 0x11, 0x10} }, + { {0x51, 0x10, 0x03, 0x10, 0x51} }, /* case-25 */ + { {0x51, 0x08, 0x03, 0x10, 0x50} }, + { {0x61, 0x08, 0x03, 0x11, 0x11} } +}; + +/* Non-Shared-Antenna TDMA */ +static const struct coex_tdma_para tdma_nsant_8822c[] = { + { {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-100 */ + { {0x61, 0x45, 0x03, 0x11, 0x11} }, + { {0x61, 0x3a, 0x03, 0x11, 0x11} }, + { {0x61, 0x30, 0x03, 0x11, 0x11} }, + { {0x61, 0x20, 0x03, 0x11, 0x11} }, + { {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-105 */ + { {0x61, 0x45, 0x03, 0x11, 0x10} }, + { {0x61, 0x3a, 0x03, 0x11, 0x10} }, + { {0x61, 0x30, 0x03, 0x11, 0x10} }, + { {0x61, 0x20, 0x03, 0x11, 0x10} }, + { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-110 */ + { {0x61, 0x08, 0x03, 0x11, 0x14} }, + { {0x61, 0x08, 0x03, 0x10, 0x14} }, + { {0x51, 0x08, 0x03, 0x10, 0x54} }, + { {0x51, 0x08, 0x03, 0x10, 0x55} }, + { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-115 */ + { {0x51, 0x45, 0x03, 0x10, 0x50} }, + { {0x51, 0x3a, 0x03, 0x10, 0x50} }, + { {0x51, 0x30, 0x03, 0x10, 0x50} }, + { {0x51, 0x20, 0x03, 0x10, 0x50} }, + { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-120 */ + { {0x51, 0x08, 0x03, 0x10, 0x50} } +}; + +/* rssi in percentage % (dbm = % - 100) */ +static const u8 wl_rssi_step_8822c[] = {60, 50, 44, 30}; +static const u8 bt_rssi_step_8822c[] = {8, 15, 20, 25}; +static const struct coex_5g_afh_map afh_5g_8822c[] = { {0, 0, 0} }; + +/* wl_tx_dec_power, bt_tx_dec_power, wl_rx_gain, bt_rx_lna_constrain */ +static const struct coex_rf_para rf_para_tx_8822c[] = { + {0, 0, false, 7}, /* for normal */ + {0, 16, false, 7}, /* for WL-CPT */ + {8, 17, true, 4}, + {7, 18, true, 4}, + {6, 19, true, 4}, + {5, 20, true, 4}, + {0, 21, true, 4} /* for gamg hid */ +}; + +static const struct coex_rf_para rf_para_rx_8822c[] = { + {0, 0, false, 7}, /* for normal */ + {0, 16, false, 7}, /* for WL-CPT */ + {3, 24, true, 5}, + {2, 26, true, 5}, + {1, 27, true, 5}, + {0, 28, true, 5}, + {0, 28, true, 5} /* for gamg hid */ +}; + +static const u8 +rtw8822c_pwrtrk_5gb_n[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = { + { 0, 1, 2, 3, 5, 6, 7, 8, 9, 10, + 11, 12, 13, 14, 15, 16, 18, 19, 20, 21, + 22, 23, 24, 25, 26, 27, 28, 29, 30, 32 }, + { 0, 1, 2, 3, 5, 6, 7, 8, 9, 10, + 11, 12, 13, 14, 15, 16, 18, 19, 20, 21, + 22, 23, 24, 25, 26, 27, 28, 29, 30, 32 }, + { 0, 1, 2, 3, 5, 6, 7, 8, 9, 10, + 11, 12, 13, 14, 15, 16, 18, 19, 20, 21, + 22, 23, 24, 25, 26, 27, 28, 29, 30, 32 }, +}; + +static const u8 +rtw8822c_pwrtrk_5gb_p[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = { + { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 10, 10, 11, 12, 13, 14, 15, 16, 17, 18, + 19, 20, 21, 22, 22, 23, 24, 25, 26, 27 }, + { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 10, 10, 11, 12, 13, 14, 15, 16, 17, 18, + 19, 20, 21, 22, 22, 23, 24, 25, 26, 27 }, + { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 10, 10, 11, 12, 13, 14, 15, 16, 17, 18, + 19, 20, 21, 22, 22, 23, 24, 25, 26, 27 }, +}; + +static const u8 +rtw8822c_pwrtrk_5ga_n[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = { + { 0, 1, 2, 4, 5, 6, 7, 8, 9, 10, + 11, 13, 14, 15, 16, 17, 18, 19, 20, 21, + 23, 24, 25, 26, 27, 28, 29, 30, 31, 33 }, + { 0, 1, 2, 4, 5, 6, 7, 8, 9, 10, + 11, 13, 14, 15, 16, 17, 18, 19, 20, 21, + 23, 24, 25, 26, 27, 28, 29, 30, 31, 33 }, + { 0, 1, 2, 4, 5, 6, 7, 8, 9, 10, + 11, 13, 14, 15, 16, 17, 18, 19, 20, 21, + 23, 24, 25, 26, 27, 28, 29, 30, 31, 33 }, +}; + +static const u8 +rtw8822c_pwrtrk_5ga_p[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = { + { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 10, 11, 12, 13, 14, 15, 16, 17, 18, 20, + 21, 22, 23, 24, 25, 26, 27, 28, 29, 30 }, + { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 10, 11, 12, 13, 14, 15, 16, 17, 18, 20, + 21, 22, 23, 24, 25, 26, 27, 28, 29, 30 }, + { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 10, 11, 12, 13, 14, 15, 16, 17, 18, 20, + 21, 22, 23, 24, 25, 26, 27, 28, 29, 30 }, +}; + +static const u8 rtw8822c_pwrtrk_2gb_n[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 2, 3, 4, 4, 5, 6, 7, 8, + 9, 9, 10, 11, 12, 13, 14, 15, 15, 16, + 17, 18, 19, 20, 20, 21, 22, 23, 24, 25 +}; + +static const u8 rtw8822c_pwrtrk_2gb_p[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 10, 11, 12, 13, 14, 14, 15, 16, 17, 18, + 19, 20, 21, 22, 23, 24, 25, 26, 27, 28 +}; + +static const u8 rtw8822c_pwrtrk_2ga_n[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 2, 2, 3, 4, 4, 5, 6, 6, + 7, 8, 8, 9, 9, 10, 11, 11, 12, 13, + 13, 14, 15, 15, 16, 17, 17, 18, 19, 19 +}; + +static const u8 rtw8822c_pwrtrk_2ga_p[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 10, 11, 11, 12, 13, 14, 15, 16, 17, 18, + 19, 20, 21, 22, 23, 24, 25, 25, 26, 27 +}; + +static const u8 rtw8822c_pwrtrk_2g_cck_b_n[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 2, 3, 4, 5, 5, 6, 7, 8, + 9, 10, 11, 11, 12, 13, 14, 15, 16, 17, + 17, 18, 19, 20, 21, 22, 23, 23, 24, 25 +}; + +static const u8 rtw8822c_pwrtrk_2g_cck_b_p[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, + 20, 21, 22, 23, 24, 25, 26, 27, 28, 29 +}; + +static const u8 rtw8822c_pwrtrk_2g_cck_a_n[RTW_PWR_TRK_TBL_SZ] = { + 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, 22 +}; + +static const u8 rtw8822c_pwrtrk_2g_cck_a_p[RTW_PWR_TRK_TBL_SZ] = { + 0, 1, 2, 3, 4, 5, 5, 6, 7, 8, + 9, 10, 11, 11, 12, 13, 14, 15, 16, 17, + 18, 18, 19, 20, 21, 22, 23, 24, 24, 25 +}; + +static const struct rtw_pwr_track_tbl rtw8822c_rtw_pwr_track_tbl = { + .pwrtrk_5gb_n[RTW_PWR_TRK_5G_1] = rtw8822c_pwrtrk_5gb_n[RTW_PWR_TRK_5G_1], + .pwrtrk_5gb_n[RTW_PWR_TRK_5G_2] = rtw8822c_pwrtrk_5gb_n[RTW_PWR_TRK_5G_2], + .pwrtrk_5gb_n[RTW_PWR_TRK_5G_3] = rtw8822c_pwrtrk_5gb_n[RTW_PWR_TRK_5G_3], + .pwrtrk_5gb_p[RTW_PWR_TRK_5G_1] = rtw8822c_pwrtrk_5gb_p[RTW_PWR_TRK_5G_1], + .pwrtrk_5gb_p[RTW_PWR_TRK_5G_2] = rtw8822c_pwrtrk_5gb_p[RTW_PWR_TRK_5G_2], + .pwrtrk_5gb_p[RTW_PWR_TRK_5G_3] = rtw8822c_pwrtrk_5gb_p[RTW_PWR_TRK_5G_3], + .pwrtrk_5ga_n[RTW_PWR_TRK_5G_1] = rtw8822c_pwrtrk_5ga_n[RTW_PWR_TRK_5G_1], + .pwrtrk_5ga_n[RTW_PWR_TRK_5G_2] = rtw8822c_pwrtrk_5ga_n[RTW_PWR_TRK_5G_2], + .pwrtrk_5ga_n[RTW_PWR_TRK_5G_3] = rtw8822c_pwrtrk_5ga_n[RTW_PWR_TRK_5G_3], + .pwrtrk_5ga_p[RTW_PWR_TRK_5G_1] = rtw8822c_pwrtrk_5ga_p[RTW_PWR_TRK_5G_1], + .pwrtrk_5ga_p[RTW_PWR_TRK_5G_2] = rtw8822c_pwrtrk_5ga_p[RTW_PWR_TRK_5G_2], + .pwrtrk_5ga_p[RTW_PWR_TRK_5G_3] = rtw8822c_pwrtrk_5ga_p[RTW_PWR_TRK_5G_3], + .pwrtrk_2gb_n = rtw8822c_pwrtrk_2gb_n, + .pwrtrk_2gb_p = rtw8822c_pwrtrk_2gb_p, + .pwrtrk_2ga_n = rtw8822c_pwrtrk_2ga_n, + .pwrtrk_2ga_p = rtw8822c_pwrtrk_2ga_p, + .pwrtrk_2g_cckb_n = rtw8822c_pwrtrk_2g_cck_b_n, + .pwrtrk_2g_cckb_p = rtw8822c_pwrtrk_2g_cck_b_p, + .pwrtrk_2g_ccka_n = rtw8822c_pwrtrk_2g_cck_a_n, + .pwrtrk_2g_ccka_p = rtw8822c_pwrtrk_2g_cck_a_p, +}; + +static struct rtw_hw_reg_offset rtw8822c_edcca_th[] = { + [EDCCA_TH_L2H_IDX] = { + {.addr = 0x84c, .mask = MASKBYTE2}, .offset = 0x80 + }, + [EDCCA_TH_H2L_IDX] = { + {.addr = 0x84c, .mask = MASKBYTE3}, .offset = 0x80 + }, +}; + +#ifdef CONFIG_PM +static const struct wiphy_wowlan_support rtw_wowlan_stub_8822c = { + .flags = WIPHY_WOWLAN_MAGIC_PKT | WIPHY_WOWLAN_GTK_REKEY_FAILURE | + WIPHY_WOWLAN_DISCONNECT | WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | + WIPHY_WOWLAN_NET_DETECT, + .n_patterns = RTW_MAX_PATTERN_NUM, + .pattern_max_len = RTW_MAX_PATTERN_SIZE, + .pattern_min_len = 1, + .max_nd_match_sets = 4, +}; +#endif + +static const struct rtw_reg_domain coex_info_hw_regs_8822c[] = { + {0x1860, BIT(3), RTW_REG_DOMAIN_MAC8}, + {0x4160, BIT(3), RTW_REG_DOMAIN_MAC8}, + {0x1c32, BIT(6), RTW_REG_DOMAIN_MAC8}, + {0x1c38, BIT(28), RTW_REG_DOMAIN_MAC32}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x430, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x434, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x42a, MASKLWORD, RTW_REG_DOMAIN_MAC16}, + {0x426, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0x45e, BIT(3), RTW_REG_DOMAIN_MAC8}, + {0x454, MASKLWORD, RTW_REG_DOMAIN_MAC16}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x4c, BIT(24) | BIT(23), RTW_REG_DOMAIN_MAC32}, + {0x64, BIT(0), RTW_REG_DOMAIN_MAC8}, + {0x4c6, BIT(4), RTW_REG_DOMAIN_MAC8}, + {0x40, BIT(5), RTW_REG_DOMAIN_MAC8}, + {0x1, RFREG_MASK, RTW_REG_DOMAIN_RF_B}, + {0, 0, RTW_REG_DOMAIN_NL}, + {0x550, MASKDWORD, RTW_REG_DOMAIN_MAC32}, + {0x522, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, + {0x953, BIT(1), RTW_REG_DOMAIN_MAC8}, + {0xc50, MASKBYTE0, RTW_REG_DOMAIN_MAC8}, +}; + +const struct rtw_chip_info rtw8822c_hw_spec = { + .ops = &rtw8822c_ops, + .id = RTW_CHIP_TYPE_8822C, + .fw_name = "rtw88/rtw8822c_fw.bin", + .wlan_cpu = RTW_WCPU_11AC, + .tx_pkt_desc_sz = 48, + .tx_buf_desc_sz = 16, + .rx_pkt_desc_sz = 24, + .rx_buf_desc_sz = 8, + .phy_efuse_size = 512, + .log_efuse_size = 768, + .ptct_efuse_size = 124, + .txff_size = 262144, + .rxff_size = 24576, + .fw_rxff_size = 12288, + .rsvd_drv_pg_num = 16, + .txgi_factor = 2, + .is_pwr_by_rate_dec = false, + .max_power_index = 0x7f, + .csi_buf_pg_num = 50, + .band = RTW_BAND_2G | RTW_BAND_5G, + .page_size = TX_PAGE_SIZE, + .dig_min = 0x20, + .default_1ss_tx_path = BB_PATH_A, + .path_div_supported = true, + .ht_supported = true, + .vht_supported = true, + .lps_deep_mode_supported = BIT(LPS_DEEP_MODE_LCLK) | BIT(LPS_DEEP_MODE_PG), + .sys_func_en = 0xD8, + .pwr_on_seq = card_enable_flow_8822c, + .pwr_off_seq = card_disable_flow_8822c, + .page_table = page_table_8822c, + .rqpn_table = rqpn_table_8822c, + .prioq_addrs = &prioq_addrs_8822c, + .intf_table = &phy_para_table_8822c, + .dig = rtw8822c_dig, + .dig_cck = NULL, + .rf_base_addr = {0x3c00, 0x4c00}, + .rf_sipi_addr = {0x1808, 0x4108}, + .ltecoex_addr = &rtw8822c_ltecoex_addr, + .mac_tbl = &rtw8822c_mac_tbl, + .agc_tbl = &rtw8822c_agc_tbl, + .bb_tbl = &rtw8822c_bb_tbl, + .rfk_init_tbl = &rtw8822c_array_mp_cal_init_tbl, + .rf_tbl = {&rtw8822c_rf_b_tbl, &rtw8822c_rf_a_tbl}, + .rfe_defs = rtw8822c_rfe_defs, + .rfe_defs_size = ARRAY_SIZE(rtw8822c_rfe_defs), + .en_dis_dpd = true, + .dpd_ratemask = DIS_DPD_RATEALL, + .pwr_track_tbl = &rtw8822c_rtw_pwr_track_tbl, + .iqk_threshold = 8, + .lck_threshold = 8, + .bfer_su_max_num = 2, + .bfer_mu_max_num = 1, + .rx_ldpc = true, + .tx_stbc = true, + .edcca_th = rtw8822c_edcca_th, + .l2h_th_ini_cs = 60, + .l2h_th_ini_ad = 45, + .ampdu_density = IEEE80211_HT_MPDU_DENSITY_2, + +#ifdef CONFIG_PM + .wow_fw_name = "rtw88/rtw8822c_wow_fw.bin", + .wowlan_stub = &rtw_wowlan_stub_8822c, + .max_sched_scan_ssids = 4, +#endif + .max_scan_ie_len = (RTW_PROBE_PG_CNT - 1) * TX_PAGE_SIZE, + .coex_para_ver = 0x22020720, + .bt_desired_ver = 0x20, + .scbd_support = true, + .new_scbd10_def = true, + .ble_hid_profile_support = true, + .wl_mimo_ps_support = true, + .pstdma_type = COEX_PSTDMA_FORCE_LPSOFF, + .bt_rssi_type = COEX_BTRSSI_DBM, + .ant_isolation = 15, + .rssi_tolerance = 2, + .wl_rssi_step = wl_rssi_step_8822c, + .bt_rssi_step = bt_rssi_step_8822c, + .table_sant_num = ARRAY_SIZE(table_sant_8822c), + .table_sant = table_sant_8822c, + .table_nsant_num = ARRAY_SIZE(table_nsant_8822c), + .table_nsant = table_nsant_8822c, + .tdma_sant_num = ARRAY_SIZE(tdma_sant_8822c), + .tdma_sant = tdma_sant_8822c, + .tdma_nsant_num = ARRAY_SIZE(tdma_nsant_8822c), + .tdma_nsant = tdma_nsant_8822c, + .wl_rf_para_num = ARRAY_SIZE(rf_para_tx_8822c), + .wl_rf_para_tx = rf_para_tx_8822c, + .wl_rf_para_rx = rf_para_rx_8822c, + .bt_afh_span_bw20 = 0x24, + .bt_afh_span_bw40 = 0x36, + .afh_5g_num = ARRAY_SIZE(afh_5g_8822c), + .afh_5g = afh_5g_8822c, + + .coex_info_hw_regs_num = ARRAY_SIZE(coex_info_hw_regs_8822c), + .coex_info_hw_regs = coex_info_hw_regs_8822c, + + .fw_fifo_addr = {0x780, 0x700, 0x780, 0x660, 0x650, 0x680}, + .fwcd_segs = &rtw8822c_fwcd_segs, +}; +EXPORT_SYMBOL(rtw8822c_hw_spec); + +MODULE_FIRMWARE("rtw88/rtw8822c_fw.bin"); +MODULE_FIRMWARE("rtw88/rtw8822c_wow_fw.bin"); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822c driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c.h new file mode 100644 index 0000000000000000000000000000000000000000..1bc0e7f5d6bb1f0367fe34ca3b3fb465ac6ccf86 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c.h @@ -0,0 +1,426 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW8822C_H__ +#define __RTW8822C_H__ + +#include + +struct rtw8822cu_efuse { + u8 res0[0x30]; /* 0x120 */ + u8 vid[2]; /* 0x150 */ + u8 pid[2]; + u8 res1[3]; + u8 mac_addr[ETH_ALEN]; /* 0x157 */ + u8 res2[0x3d]; +}; + +struct rtw8822cs_efuse { + u8 res0[0x4a]; /* 0x120 */ + u8 mac_addr[ETH_ALEN]; /* 0x16a */ +} __packed; + +struct rtw8822ce_efuse { + u8 mac_addr[ETH_ALEN]; /* 0x120 */ + u8 vender_id[2]; + u8 device_id[2]; + u8 sub_vender_id[2]; + u8 sub_device_id[2]; + u8 pmc[2]; + u8 exp_device_cap[2]; + u8 msi_cap; + u8 ltr_cap; /* 0x133 */ + u8 exp_link_control[2]; + u8 link_cap[4]; + u8 link_control[2]; + u8 serial_number[8]; + u8 res0:2; /* 0x144 */ + u8 ltr_en:1; + u8 res1:2; + u8 obff:2; + u8 res2:3; + u8 obff_cap:2; + u8 res3:4; + u8 class_code[3]; + u8 res4; + u8 pci_pm_L1_2_supp:1; + u8 pci_pm_L1_1_supp:1; + u8 aspm_pm_L1_2_supp:1; + u8 aspm_pm_L1_1_supp:1; + u8 L1_pm_substates_supp:1; + u8 res5:3; + u8 port_common_mode_restore_time; + u8 port_t_power_on_scale:2; + u8 res6:1; + u8 port_t_power_on_value:5; + u8 res7; +}; + +struct rtw8822c_efuse { + __le16 rtl_id; + u8 res0[0x0e]; + + /* power index for four RF paths */ + struct rtw_txpwr_idx txpwr_idx_table[4]; + + u8 channel_plan; /* 0xb8 */ + u8 xtal_k; + u8 res1; + u8 iqk_lck; + u8 res2[5]; /* 0xbc */ + u8 rf_board_option; + u8 rf_feature_option; + u8 rf_bt_setting; + u8 eeprom_version; + u8 eeprom_customer_id; + u8 tx_bb_swing_setting_2g; + u8 tx_bb_swing_setting_5g; + u8 tx_pwr_calibrate_rate; + u8 rf_antenna_option; /* 0xc9 */ + u8 rfe_option; + u8 country_code[2]; + u8 res3[3]; + u8 path_a_thermal; /* 0xd0 */ + u8 path_b_thermal; + u8 res4[2]; + u8 rx_gain_gap_2g_ofdm; + u8 res5; + u8 rx_gain_gap_2g_cck; + u8 res6; + u8 rx_gain_gap_5gl; + u8 res7; + u8 rx_gain_gap_5gm; + u8 res8; + u8 rx_gain_gap_5gh; + u8 res9; + u8 res10[0x42]; + union { + struct rtw8822ce_efuse e; + struct rtw8822cu_efuse u; + struct rtw8822cs_efuse s; + }; +}; + +enum rtw8822c_dpk_agc_phase { + RTW_DPK_GAIN_CHECK, + RTW_DPK_GAIN_LARGE, + RTW_DPK_GAIN_LESS, + RTW_DPK_GL_LARGE, + RTW_DPK_GL_LESS, + RTW_DPK_LOSS_CHECK, + RTW_DPK_AGC_OUT, +}; + +enum rtw8822c_dpk_one_shot_action { + RTW_DPK_CAL_PWR, + RTW_DPK_GAIN_LOSS, + RTW_DPK_DO_DPK, + RTW_DPK_DPK_ON, + RTW_DPK_DAGC, + RTW_DPK_ACTION_MAX +}; + +void rtw8822c_parse_tbl_dpk(struct rtw_dev *rtwdev, + const struct rtw_table *tbl); + +extern const struct rtw_chip_info rtw8822c_hw_spec; + +#define RTW_DECL_TABLE_DPK(name) \ +const struct rtw_table name ## _tbl = { \ + .data = name, \ + .size = ARRAY_SIZE(name), \ + .parse = rtw8822c_parse_tbl_dpk, \ +} + +#define DACK_PATH_8822C 2 +#define DACK_REG_8822C 16 +#define DACK_RF_8822C 1 +#define DACK_SN_8822C 100 + +/* phy status page0 */ +#define GET_PHY_STAT_P0_PWDB_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(15, 8)) +#define GET_PHY_STAT_P0_PWDB_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(7, 0)) +#define GET_PHY_STAT_P0_GAIN_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(21, 16)) +#define GET_PHY_STAT_P0_CHANNEL(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(23, 16)) +#define GET_PHY_STAT_P0_GAIN_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(29, 24)) + +/* phy status page1 */ +#define GET_PHY_STAT_P1_PWDB_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(15, 8)) +#define GET_PHY_STAT_P1_PWDB_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x00), GENMASK(23, 16)) +#define GET_PHY_STAT_P1_L_RXSC(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(11, 8)) +#define GET_PHY_STAT_P1_HT_RXSC(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(15, 12)) +#define GET_PHY_STAT_P1_CHANNEL(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x01), GENMASK(23, 16)) +#define GET_PHY_STAT_P1_RXEVM_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_RXEVM_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x04), GENMASK(15, 8)) +#define GET_PHY_STAT_P1_CFO_TAIL_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x05), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_CFO_TAIL_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x05), GENMASK(15, 8)) +#define GET_PHY_STAT_P1_RXSNR_A(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x06), GENMASK(7, 0)) +#define GET_PHY_STAT_P1_RXSNR_B(phy_stat) \ + le32_get_bits(*((__le32 *)(phy_stat) + 0x06), GENMASK(15, 8)) + +#define RTW8822C_EDCCA_MAX 0x7f +#define REG_ANAPARLDO_POW_MAC 0x0029 +#define BIT_LDOE25_PON BIT(0) +#define XCAP_MASK GENMASK(6, 0) +#define CFO_TRK_ENABLE_TH 20 +#define CFO_TRK_STOP_TH 10 +#define CFO_TRK_ADJ_TH 10 + +#define REG_TXDFIR0 0x808 +#define REG_DFIRBW 0x810 +#define REG_ANTMAP0 0x820 +#define BIT_ANT_PATH GENMASK(1, 0) +#define REG_ANTMAP 0x824 +#define REG_EDCCA_DECISION 0x844 +#define BIT_EDCCA_OPTION GENMASK(30, 29) +#define REG_DYMPRITH 0x86c +#define REG_DYMENTH0 0x870 +#define REG_DYMENTH 0x874 +#define REG_SBD 0x88c +#define BITS_SUBTUNE GENMASK(15, 12) +#define REG_DYMTHMIN 0x8a4 + +#define REG_TXBWCTL 0x9b0 +#define REG_TXCLK 0x9b4 + +#define REG_SCOTRK 0xc30 +#define REG_MRCM 0xc38 +#define REG_AGCSWSH 0xc44 +#define REG_ANTWTPD 0xc54 +#define REG_PT_CHSMO 0xcbc +#define BIT_PT_OPT BIT(21) + +#define REG_ORITXCODE 0x1800 +#define BIT_PATH_EN BIT(31) +#define REG_3WIRE 0x180c +#define BIT_DIS_SHARERX_TXGAT BIT(27) +#define BIT_3WIRE_TX_EN BIT(0) +#define BIT_3WIRE_RX_EN BIT(1) +#define BIT_3WIRE_EN GENMASK(1, 0) +#define BIT_3WIRE_PI_ON BIT(28) +#define REG_ANAPAR_A 0x1830 +#define BIT_ANAPAR_UPDATE BIT(29) +#define REG_RFTXEN_GCK_A 0x1864 +#define BIT_RFTXEN_GCK_FORCE_ON BIT(31) +#define REG_DIS_SHARE_RX_A 0x186c +#define BIT_TX_SCALE_0DB BIT(7) +#define REG_RXAGCCTL0 0x18ac +#define BITS_RXAGC_CCK GENMASK(15, 12) +#define BITS_RXAGC_OFDM GENMASK(8, 4) +#define REG_DCKA_I_0 0x18bc +#define REG_DCKA_I_1 0x18c0 +#define REG_DCKA_Q_0 0x18d8 +#define REG_DCKA_Q_1 0x18dc + +#define REG_CCKSB 0x1a00 +#define BIT_BBMODE GENMASK(2, 1) +#define REG_RXCCKSEL 0x1a04 +#define REG_BGCTRL 0x1a14 +#define BITS_RX_IQ_WEIGHT (BIT(8) | BIT(9)) +#define REG_TXF0 0x1a20 +#define REG_TXF1 0x1a24 +#define REG_TXF2 0x1a28 +#define REG_CCANRX 0x1a2c +#define BIT_CCK_FA_RST (BIT(14) | BIT(15)) +#define BIT_OFDM_FA_RST (BIT(12) | BIT(13)) +#define REG_CCK_FACNT 0x1a5c +#define REG_CCKTXONLY 0x1a80 +#define BIT_BB_CCK_CHECK_EN BIT(18) +#define REG_TXF3 0x1a98 +#define REG_TXF4 0x1a9c +#define REG_TXF5 0x1aa0 +#define REG_TXF6 0x1aac +#define REG_TXF7 0x1ab0 +#define REG_CCK_SOURCE 0x1abc +#define BIT_NBI_EN BIT(30) + +#define REG_NCTL0 0x1b00 +#define BIT_SEL_PATH GENMASK(2, 1) +#define BIT_SUBPAGE GENMASK(3, 0) +#define REG_DPD_CTL0_S0 0x1b04 +#define BIT_GS_PWSF GENMASK(27, 0) +#define REG_DPD_CTL1_S0 0x1b08 +#define BIT_DPD_EN BIT(31) +#define BIT_PS_EN BIT(7) +#define REG_IQKSTAT 0x1b10 +#define REG_IQK_CTL1 0x1b20 +#define BIT_TX_CFIR GENMASK(31, 30) +#define BIT_CFIR_EN GENMASK(26, 24) +#define BIT_BYPASS_DPD BIT(25) + +#define REG_TX_TONE_IDX 0x1b2c +#define REG_DPD_LUT0 0x1b44 +#define BIT_GLOSS_DB GENMASK(14, 12) +#define REG_DPD_CTL0_S1 0x1b5c +#define REG_DPD_CTL1_S1 0x1b60 +#define REG_DPD_AGC 0x1b67 +#define REG_TABLE_SEL 0x1b98 +#define BIT_I_GAIN GENMASK(19, 16) +#define BIT_GAIN_RST BIT(15) +#define BIT_Q_GAIN_SEL GENMASK(14, 12) +#define BIT_Q_GAIN GENMASK(11, 0) +#define REG_TX_GAIN_SET 0x1b9c +#define BIT_GAPK_RPT_IDX GENMASK(11, 8) +#define REG_DPD_CTL0 0x1bb4 +#define REG_SINGLE_TONE_SW 0x1bb8 +#define BIT_IRQ_TEST_MODE BIT(20) +#define REG_R_CONFIG 0x1bcc +#define BIT_INNER_LB BIT(21) +#define BIT_IQ_SWITCH GENMASK(5, 0) +#define BIT_2G_SWING 0x2d +#define BIT_5G_SWING 0x36 +#define REG_RXSRAM_CTL 0x1bd4 +#define BIT_RPT_EN BIT(21) +#define BIT_RPT_SEL GENMASK(20, 16) +#define BIT_DPD_CLK GENMASK(7, 4) +#define REG_DPD_CTL11 0x1be4 +#define REG_DPD_CTL12 0x1be8 +#define REG_DPD_CTL15 0x1bf4 +#define REG_DPD_CTL16 0x1bf8 +#define REG_STAT_RPT 0x1bfc +#define BIT_RPT_DGAIN GENMASK(27, 16) +#define BIT_GAPK_RPT0 GENMASK(3, 0) +#define BIT_GAPK_RPT1 GENMASK(7, 4) +#define BIT_GAPK_RPT2 GENMASK(11, 8) +#define BIT_GAPK_RPT3 GENMASK(15, 12) +#define BIT_GAPK_RPT4 GENMASK(19, 16) +#define BIT_GAPK_RPT5 GENMASK(23, 20) +#define BIT_GAPK_RPT6 GENMASK(27, 24) +#define BIT_GAPK_RPT7 GENMASK(31, 28) + +#define REG_TXANT 0x1c28 +#define REG_IQK_CTRL 0x1c38 +#define REG_ENCCK 0x1c3c +#define BIT_CCK_BLK_EN BIT(1) +#define BIT_CCK_OFDM_BLK_EN (BIT(0) | BIT(1)) +#define REG_CCAMSK 0x1c80 +#define REG_RSTB 0x1c90 +#define BIT_RSTB_3WIRE BIT(8) +#define REG_CH_DELAY_EXTR2 0x1cd0 +#define BIT_TST_IQK2SET_SRC BIT(31) +#define BIT_EN_IOQ_IQK_DPK BIT(30) +#define BIT_IQK_DPK_RESET_SRC BIT(29) +#define BIT_IQK_DPK_CLOCK_SRC BIT(28) + +#define REG_RX_BREAK 0x1d2c +#define BIT_COM_RX_GCK_EN BIT(31) +#define REG_RXFNCTL 0x1d30 +#define REG_CCA_OFF 0x1d58 +#define BIT_CCA_ON_BY_PW GENMASK(11, 3) +#define REG_RXIGI 0x1d70 + +#define REG_ENFN 0x1e24 +#define BIT_IQK_DPK_EN BIT(17) +#define REG_TXANTSEG 0x1e28 +#define BIT_ANTSEG GENMASK(3, 0) +#define REG_TXLGMAP 0x1e2c +#define REG_CCKPATH 0x1e5c +#define REG_TX_FIFO 0x1e70 +#define BIT_STOP_TX GENMASK(3, 0) +#define REG_CNT_CTRL 0x1eb4 +#define BIT_ALL_CNT_RST BIT(25) + +#define REG_OFDM_FACNT 0x2d00 +#define REG_OFDM_FACNT1 0x2d04 +#define REG_OFDM_FACNT2 0x2d08 +#define REG_OFDM_FACNT3 0x2d0c +#define REG_OFDM_FACNT4 0x2d10 +#define REG_OFDM_FACNT5 0x2d20 +#define REG_RPT_CIP 0x2d9c +#define BIT_RPT_CIP_STATUS GENMASK(7, 0) +#define REG_OFDM_TXCNT 0x2de0 + +#define REG_ORITXCODE2 0x4100 +#define REG_3WIRE2 0x410c +#define REG_ANAPAR_B 0x4130 +#define REG_RFTXEN_GCK_B 0x4164 +#define REG_DIS_SHARE_RX_B 0x416c +#define BIT_EXT_TIA_BW BIT(1) +#define REG_RXAGCCTL 0x41ac +#define REG_DCKB_I_0 0x41bc +#define REG_DCKB_I_1 0x41c0 +#define REG_DCKB_Q_0 0x41d8 +#define REG_DCKB_Q_1 0x41dc + +#define RF_MODE_TRXAGC 0x00 +#define BIT_RF_MODE GENMASK(19, 16) +#define BIT_RXAGC GENMASK(9, 5) +#define BIT_TXAGC GENMASK(4, 0) +#define RF_RXAGC_OFFSET 0x19 +#define RF_BW_TRXBB 0x1a +#define BIT_TX_CCK_IND BIT(16) +#define BIT_BW_TXBB GENMASK(14, 12) +#define BIT_BW_RXBB GENMASK(11, 10) +#define BIT_DBG_CCK_CCA BIT(1) +#define RF_TX_GAIN_OFFSET 0x55 +#define BIT_BB_GAIN GENMASK(18, 14) +#define BIT_RF_GAIN GENMASK(4, 2) +#define RF_TX_GAIN 0x56 +#define BIT_GAIN_TXBB GENMASK(4, 0) +#define RF_IDAC 0x58 +#define BIT_TX_MODE GENMASK(19, 8) +#define RF_TX_RESULT 0x5f +#define BIT_GAIN_TX_PAD_H GENMASK(11, 8) +#define BIT_GAIN_TX_PAD_L GENMASK(7, 4) +#define RF_PA 0x60 +#define RF_PABIAS_2G_MASK GENMASK(15, 12) +#define RF_PABIAS_5G_MASK GENMASK(19, 16) +#define RF_TXA_LB_SW 0x63 +#define BIT_TXA_LB_ATT GENMASK(15, 14) +#define BIT_LB_SW GENMASK(13, 12) +#define BIT_LB_ATT GENMASK(4, 2) +#define RF_RXG_GAIN 0x87 +#define BIT_RXG_GAIN BIT(18) +#define RF_RXA_MIX_GAIN 0x8a +#define BIT_RXA_MIX_GAIN GENMASK(4, 3) +#define RF_EXT_TIA_BW 0x8f +#define BIT_PW_EXT_TIA BIT(1) +#define RF_DIS_BYPASS_TXBB 0x9e +#define BIT_TXBB BIT(10) +#define BIT_TIA_BYPASS BIT(5) +#define RF_DEBUG 0xde +#define BIT_DE_PWR_TRIM BIT(19) +#define BIT_DE_TX_GAIN BIT(16) +#define BIT_DE_TRXBW BIT(2) + +#define PPG_THERMAL_B 0x1b0 +#define RF_THEMAL_MASK GENMASK(19, 16) +#define PPG_2GH_TXAB 0x1d2 +#define PPG_2G_A_MASK GENMASK(3, 0) +#define PPG_2G_B_MASK GENMASK(7, 4) +#define PPG_2GL_TXAB 0x1d4 +#define PPG_PABIAS_2GB 0x1d5 +#define PPG_PABIAS_2GA 0x1d6 +#define PPG_PABIAS_MASK GENMASK(3, 0) +#define PPG_PABIAS_5GB 0x1d7 +#define PPG_PABIAS_5GA 0x1d8 +#define PPG_5G_MASK GENMASK(4, 0) +#define PPG_5GH1_TXB 0x1db +#define PPG_5GH1_TXA 0x1dc +#define PPG_5GM2_TXB 0x1df +#define PPG_5GM2_TXA 0x1e0 +#define PPG_5GM1_TXB 0x1e3 +#define PPG_5GM1_TXA 0x1e4 +#define PPG_5GL2_TXB 0x1e7 +#define PPG_5GL2_TXA 0x1e8 +#define PPG_5GL1_TXB 0x1eb +#define PPG_5GL1_TXA 0x1ec +#define PPG_2GM_TXAB 0x1ee +#define PPG_THERMAL_A 0x1ef +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c_table.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c_table.c new file mode 100644 index 0000000000000000000000000000000000000000..f9e3d0779c597c2aeb29df4e8a62b7cb2ca0c04d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c_table.c @@ -0,0 +1,46300 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "phy.h" +#include "rtw8822c.h" +#include "rtw8822c_table.h" + +static const u32 rtw8822c_mac[] = { +}; + +RTW_DECL_TABLE_PHY_COND(rtw8822c_mac, rtw_phy_cfg_mac); + +static const u32 rtw8822c_agc[] = { + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x300001FF, + 0x1D90, 0x300101FE, + 0x1D90, 0x300201FD, + 0x1D90, 0x300301FC, + 0x1D90, 0x300401FB, + 0x1D90, 0x300501FA, + 0x1D90, 0x300601F9, + 0x1D90, 0x300701F8, + 0x1D90, 0x300801F7, + 0x1D90, 0x300901F6, + 0x1D90, 0x300A01F5, + 0x1D90, 0x300B01F4, + 0x1D90, 0x300C01F3, + 0x1D90, 0x300D01F2, + 0x1D90, 0x300E01F1, + 0x1D90, 0x300F01F0, + 0x1D90, 0x301001EF, + 0x1D90, 0x301101EE, + 0x1D90, 0x301201ED, + 0x1D90, 0x301301EC, + 0x1D90, 0x301401EB, + 0x1D90, 0x301501EA, + 0x1D90, 0x301601E9, + 0x1D90, 0x301701E8, + 0x1D90, 0x301801E7, + 0x1D90, 0x301901E5, + 0x1D90, 0x301A01E4, + 0x1D90, 0x301B01C5, + 0x1D90, 0x301C01C4, + 0x1D90, 0x301D01C3, + 0x1D90, 0x301E01C2, + 0x1D90, 0x301F0188, + 0x1D90, 0x30200187, + 0x1D90, 0x30210186, + 0x1D90, 0x30220184, + 0x1D90, 0x30230183, + 0x1D90, 0x30240182, + 0x1D90, 0x30250181, + 0x1D90, 0x30260148, + 0x1D90, 0x30270147, + 0x1D90, 0x30280146, + 0x1D90, 0x30290144, + 0x1D90, 0x302A0143, + 0x1D90, 0x302B0142, + 0x1D90, 0x302C0141, + 0x1D90, 0x302D00C8, + 0x1D90, 0x302E00C7, + 0x1D90, 0x302F00C6, + 0x1D90, 0x303000C5, + 0x1D90, 0x303100C4, + 0x1D90, 0x303200C3, + 0x1D90, 0x30330048, + 0x1D90, 0x30340047, + 0x1D90, 0x30350046, + 0x1D90, 0x30360045, + 0x1D90, 0x30370025, + 0x1D90, 0x30380024, + 0x1D90, 0x30390023, + 0x1D90, 0x303A0022, + 0x1D90, 0x303B0021, + 0x1D90, 0x303C0020, + 0x1D90, 0x303D0003, + 0x1D90, 0x303E0002, + 0x1D90, 0x303F0001, + 0x90000015, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x300001FF, + 0x1D90, 0x300101FE, + 0x1D90, 0x300201FD, + 0x1D90, 0x300301FC, + 0x1D90, 0x300401FB, + 0x1D90, 0x300501FA, + 0x1D90, 0x300601F9, + 0x1D90, 0x300701F8, + 0x1D90, 0x300801F7, + 0x1D90, 0x300901F6, + 0x1D90, 0x300A01F5, + 0x1D90, 0x300B01F4, + 0x1D90, 0x300C01F3, + 0x1D90, 0x300D01F2, + 0x1D90, 0x300E01F1, + 0x1D90, 0x300F01F0, + 0x1D90, 0x301001EF, + 0x1D90, 0x301101EE, + 0x1D90, 0x301201ED, + 0x1D90, 0x301301EC, + 0x1D90, 0x301401EB, + 0x1D90, 0x301501EA, + 0x1D90, 0x301601E9, + 0x1D90, 0x301701E8, + 0x1D90, 0x301801E7, + 0x1D90, 0x301901E5, + 0x1D90, 0x301A01E4, + 0x1D90, 0x301B01C5, + 0x1D90, 0x301C01C4, + 0x1D90, 0x301D01C3, + 0x1D90, 0x301E01C2, + 0x1D90, 0x301F0188, + 0x1D90, 0x30200187, + 0x1D90, 0x30210186, + 0x1D90, 0x30220184, + 0x1D90, 0x30230183, + 0x1D90, 0x30240182, + 0x1D90, 0x30250181, + 0x1D90, 0x30260148, + 0x1D90, 0x30270147, + 0x1D90, 0x30280146, + 0x1D90, 0x30290144, + 0x1D90, 0x302A0143, + 0x1D90, 0x302B0142, + 0x1D90, 0x302C0141, + 0x1D90, 0x302D00C8, + 0x1D90, 0x302E00C7, + 0x1D90, 0x302F00C6, + 0x1D90, 0x303000C5, + 0x1D90, 0x303100C4, + 0x1D90, 0x303200C3, + 0x1D90, 0x30330048, + 0x1D90, 0x30340047, + 0x1D90, 0x30350046, + 0x1D90, 0x30360045, + 0x1D90, 0x30370025, + 0x1D90, 0x30380024, + 0x1D90, 0x30390023, + 0x1D90, 0x303A0022, + 0x1D90, 0x303B0021, + 0x1D90, 0x303C0020, + 0x1D90, 0x303D0003, + 0x1D90, 0x303E0002, + 0x1D90, 0x303F0001, + 0x90000016, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x300001FF, + 0x1D90, 0x300101FE, + 0x1D90, 0x300201FD, + 0x1D90, 0x300301FC, + 0x1D90, 0x300401FB, + 0x1D90, 0x300501FA, + 0x1D90, 0x300601F9, + 0x1D90, 0x300701F8, + 0x1D90, 0x300801F7, + 0x1D90, 0x300901F6, + 0x1D90, 0x300A01F5, + 0x1D90, 0x300B01F4, + 0x1D90, 0x300C01F3, + 0x1D90, 0x300D01F2, + 0x1D90, 0x300E01F1, + 0x1D90, 0x300F01F0, + 0x1D90, 0x301001EF, + 0x1D90, 0x301101EE, + 0x1D90, 0x301201ED, + 0x1D90, 0x301301EC, + 0x1D90, 0x301401EB, + 0x1D90, 0x301501EA, + 0x1D90, 0x301601E9, + 0x1D90, 0x301701E8, + 0x1D90, 0x301801E7, + 0x1D90, 0x301901E5, + 0x1D90, 0x301A01E4, + 0x1D90, 0x301B01C5, + 0x1D90, 0x301C01C4, + 0x1D90, 0x301D01C3, + 0x1D90, 0x301E01C2, + 0x1D90, 0x301F0188, + 0x1D90, 0x30200187, + 0x1D90, 0x30210186, + 0x1D90, 0x30220184, + 0x1D90, 0x30230183, + 0x1D90, 0x30240182, + 0x1D90, 0x30250181, + 0x1D90, 0x30260148, + 0x1D90, 0x30270147, + 0x1D90, 0x30280146, + 0x1D90, 0x30290144, + 0x1D90, 0x302A0143, + 0x1D90, 0x302B0142, + 0x1D90, 0x302C0141, + 0x1D90, 0x302D00C8, + 0x1D90, 0x302E00C7, + 0x1D90, 0x302F00C6, + 0x1D90, 0x303000C5, + 0x1D90, 0x303100C4, + 0x1D90, 0x303200C3, + 0x1D90, 0x30330048, + 0x1D90, 0x30340047, + 0x1D90, 0x30350046, + 0x1D90, 0x30360045, + 0x1D90, 0x30370025, + 0x1D90, 0x30380024, + 0x1D90, 0x30390023, + 0x1D90, 0x303A0022, + 0x1D90, 0x303B0021, + 0x1D90, 0x303C0020, + 0x1D90, 0x303D0003, + 0x1D90, 0x303E0002, + 0x1D90, 0x303F0001, + 0xA0000000, 0x00000000, + 0x1D90, 0x300001FF, + 0x1D90, 0x300101FE, + 0x1D90, 0x300201FD, + 0x1D90, 0x300301FC, + 0x1D90, 0x300401FB, + 0x1D90, 0x300501FA, + 0x1D90, 0x300601F9, + 0x1D90, 0x300701F8, + 0x1D90, 0x300801F7, + 0x1D90, 0x300901F6, + 0x1D90, 0x300A01F5, + 0x1D90, 0x300B01F4, + 0x1D90, 0x300C01F3, + 0x1D90, 0x300D01F2, + 0x1D90, 0x300E01F1, + 0x1D90, 0x300F01F0, + 0x1D90, 0x301001EF, + 0x1D90, 0x301101EE, + 0x1D90, 0x301201ED, + 0x1D90, 0x301301EC, + 0x1D90, 0x301401EB, + 0x1D90, 0x301501EA, + 0x1D90, 0x301601E9, + 0x1D90, 0x301701E8, + 0x1D90, 0x301801E7, + 0x1D90, 0x301901E5, + 0x1D90, 0x301A01E4, + 0x1D90, 0x301B01C5, + 0x1D90, 0x301C01C4, + 0x1D90, 0x301D01C3, + 0x1D90, 0x301E01C2, + 0x1D90, 0x301F0188, + 0x1D90, 0x30200187, + 0x1D90, 0x30210186, + 0x1D90, 0x30220184, + 0x1D90, 0x30230183, + 0x1D90, 0x30240182, + 0x1D90, 0x30250181, + 0x1D90, 0x30260148, + 0x1D90, 0x30270147, + 0x1D90, 0x30280146, + 0x1D90, 0x30290144, + 0x1D90, 0x302A0143, + 0x1D90, 0x302B0142, + 0x1D90, 0x302C0141, + 0x1D90, 0x302D00C8, + 0x1D90, 0x302E00C7, + 0x1D90, 0x302F00C6, + 0x1D90, 0x303000C5, + 0x1D90, 0x303100C4, + 0x1D90, 0x303200C3, + 0x1D90, 0x30330048, + 0x1D90, 0x30340047, + 0x1D90, 0x30350046, + 0x1D90, 0x30360045, + 0x1D90, 0x30370025, + 0x1D90, 0x30380024, + 0x1D90, 0x30390023, + 0x1D90, 0x303A0022, + 0x1D90, 0x303B0021, + 0x1D90, 0x303C0020, + 0x1D90, 0x303D0003, + 0x1D90, 0x303E0002, + 0x1D90, 0x303F0001, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x3040011F, + 0x1D90, 0x3041011F, + 0x1D90, 0x3042011F, + 0x1D90, 0x3043011F, + 0x1D90, 0x3044011F, + 0x1D90, 0x3045011F, + 0x1D90, 0x3046011F, + 0x1D90, 0x3047011F, + 0x1D90, 0x3048011F, + 0x1D90, 0x3049011F, + 0x1D90, 0x304A011F, + 0x1D90, 0x304B011F, + 0x1D90, 0x304C011F, + 0x1D90, 0x304D011F, + 0x1D90, 0x304E011F, + 0x1D90, 0x304F00F4, + 0x1D90, 0x305000F3, + 0x1D90, 0x305100F2, + 0x1D90, 0x305200F1, + 0x1D90, 0x305300F0, + 0x1D90, 0x305400EF, + 0x1D90, 0x305500EE, + 0x1D90, 0x305600ED, + 0x1D90, 0x305700EC, + 0x1D90, 0x305800EB, + 0x1D90, 0x305900EA, + 0x1D90, 0x305A00E9, + 0x1D90, 0x305B00E8, + 0x1D90, 0x305C00E7, + 0x1D90, 0x305D00E6, + 0x1D90, 0x305E00E4, + 0x1D90, 0x305F00E3, + 0x1D90, 0x306000E2, + 0x1D90, 0x306100C4, + 0x1D90, 0x306200C3, + 0x1D90, 0x306300C2, + 0x1D90, 0x306400A4, + 0x1D90, 0x306500A3, + 0x1D90, 0x306600A2, + 0x1D90, 0x306700A1, + 0x1D90, 0x30680084, + 0x1D90, 0x30690083, + 0x1D90, 0x306A0082, + 0x1D90, 0x306B0081, + 0x1D90, 0x306C0080, + 0x1D90, 0x306D0067, + 0x1D90, 0x306E0066, + 0x1D90, 0x306F0065, + 0x1D90, 0x30700064, + 0x1D90, 0x30710063, + 0x1D90, 0x30720044, + 0x1D90, 0x30730043, + 0x1D90, 0x30740042, + 0x1D90, 0x30750041, + 0x1D90, 0x30760024, + 0x1D90, 0x30770023, + 0x1D90, 0x30780022, + 0x1D90, 0x30790021, + 0x1D90, 0x307A0020, + 0x1D90, 0x307B0004, + 0x1D90, 0x307C0003, + 0x1D90, 0x307D0002, + 0x1D90, 0x307E0001, + 0x1D90, 0x307F0000, + 0x90000015, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x304001FD, + 0x1D90, 0x304101FC, + 0x1D90, 0x304201FB, + 0x1D90, 0x304301FA, + 0x1D90, 0x304401F9, + 0x1D90, 0x304501F8, + 0x1D90, 0x304601F7, + 0x1D90, 0x304701F6, + 0x1D90, 0x304801F5, + 0x1D90, 0x304901F4, + 0x1D90, 0x304A01F3, + 0x1D90, 0x304B01F2, + 0x1D90, 0x304C01F1, + 0x1D90, 0x304D01F0, + 0x1D90, 0x304E01EF, + 0x1D90, 0x304F00EE, + 0x1D90, 0x305000ED, + 0x1D90, 0x305100EC, + 0x1D90, 0x305200EB, + 0x1D90, 0x305300EA, + 0x1D90, 0x305400E9, + 0x1D90, 0x305500E8, + 0x1D90, 0x305600E7, + 0x1D90, 0x305700E6, + 0x1D90, 0x305800E5, + 0x1D90, 0x305900E4, + 0x1D90, 0x305A00E3, + 0x1D90, 0x305B00C3, + 0x1D90, 0x305C00C2, + 0x1D90, 0x305D00A4, + 0x1D90, 0x305E00A3, + 0x1D90, 0x305F00A2, + 0x1D90, 0x306000A1, + 0x1D90, 0x30610085, + 0x1D90, 0x30620084, + 0x1D90, 0x30630083, + 0x1D90, 0x30640082, + 0x1D90, 0x30650069, + 0x1D90, 0x30660068, + 0x1D90, 0x30670067, + 0x1D90, 0x30680066, + 0x1D90, 0x30690065, + 0x1D90, 0x306A0064, + 0x1D90, 0x306B0063, + 0x1D90, 0x306C0043, + 0x1D90, 0x306D0042, + 0x1D90, 0x306E0041, + 0x1D90, 0x306F0025, + 0x1D90, 0x30700024, + 0x1D90, 0x30710023, + 0x1D90, 0x30720022, + 0x1D90, 0x30730021, + 0x1D90, 0x30740020, + 0x1D90, 0x30750004, + 0x1D90, 0x30760003, + 0x1D90, 0x30770002, + 0x1D90, 0x30780001, + 0x1D90, 0x30790000, + 0x1D90, 0x307A0000, + 0x1D90, 0x307B0000, + 0x1D90, 0x307C0000, + 0x1D90, 0x307D0000, + 0x1D90, 0x307E0000, + 0x1D90, 0x307F0000, + 0x90000016, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x304001FD, + 0x1D90, 0x304101FC, + 0x1D90, 0x304201FB, + 0x1D90, 0x304301FA, + 0x1D90, 0x304401F9, + 0x1D90, 0x304501F8, + 0x1D90, 0x304601F7, + 0x1D90, 0x304701F6, + 0x1D90, 0x304801F5, + 0x1D90, 0x304901F4, + 0x1D90, 0x304A01F3, + 0x1D90, 0x304B01F2, + 0x1D90, 0x304C01F1, + 0x1D90, 0x304D01F0, + 0x1D90, 0x304E01EF, + 0x1D90, 0x304F00EE, + 0x1D90, 0x305000ED, + 0x1D90, 0x305100EC, + 0x1D90, 0x305200EB, + 0x1D90, 0x305300EA, + 0x1D90, 0x305400E9, + 0x1D90, 0x305500E8, + 0x1D90, 0x305600E7, + 0x1D90, 0x305700E6, + 0x1D90, 0x305800E5, + 0x1D90, 0x305900E4, + 0x1D90, 0x305A00E3, + 0x1D90, 0x305B00C3, + 0x1D90, 0x305C00C2, + 0x1D90, 0x305D00A4, + 0x1D90, 0x305E00A3, + 0x1D90, 0x305F00A2, + 0x1D90, 0x306000A1, + 0x1D90, 0x30610085, + 0x1D90, 0x30620084, + 0x1D90, 0x30630083, + 0x1D90, 0x30640082, + 0x1D90, 0x30650069, + 0x1D90, 0x30660068, + 0x1D90, 0x30670067, + 0x1D90, 0x30680066, + 0x1D90, 0x30690065, + 0x1D90, 0x306A0064, + 0x1D90, 0x306B0063, + 0x1D90, 0x306C0043, + 0x1D90, 0x306D0042, + 0x1D90, 0x306E0041, + 0x1D90, 0x306F0025, + 0x1D90, 0x30700024, + 0x1D90, 0x30710023, + 0x1D90, 0x30720022, + 0x1D90, 0x30730021, + 0x1D90, 0x30740020, + 0x1D90, 0x30750004, + 0x1D90, 0x30760003, + 0x1D90, 0x30770002, + 0x1D90, 0x30780001, + 0x1D90, 0x30790000, + 0x1D90, 0x307A0000, + 0x1D90, 0x307B0000, + 0x1D90, 0x307C0000, + 0x1D90, 0x307D0000, + 0x1D90, 0x307E0000, + 0x1D90, 0x307F0000, + 0xA0000000, 0x00000000, + 0x1D90, 0x3040011F, + 0x1D90, 0x3041011F, + 0x1D90, 0x3042011F, + 0x1D90, 0x3043011F, + 0x1D90, 0x3044011F, + 0x1D90, 0x3045011F, + 0x1D90, 0x3046011F, + 0x1D90, 0x3047011F, + 0x1D90, 0x3048011F, + 0x1D90, 0x3049011F, + 0x1D90, 0x304A011F, + 0x1D90, 0x304B011F, + 0x1D90, 0x304C011F, + 0x1D90, 0x304D011F, + 0x1D90, 0x304E011F, + 0x1D90, 0x304F00F4, + 0x1D90, 0x305000F3, + 0x1D90, 0x305100F2, + 0x1D90, 0x305200F1, + 0x1D90, 0x305300F0, + 0x1D90, 0x305400EF, + 0x1D90, 0x305500EE, + 0x1D90, 0x305600ED, + 0x1D90, 0x305700EC, + 0x1D90, 0x305800EB, + 0x1D90, 0x305900EA, + 0x1D90, 0x305A00E9, + 0x1D90, 0x305B00E8, + 0x1D90, 0x305C00E7, + 0x1D90, 0x305D00E6, + 0x1D90, 0x305E00E4, + 0x1D90, 0x305F00E3, + 0x1D90, 0x306000E2, + 0x1D90, 0x306100C4, + 0x1D90, 0x306200C3, + 0x1D90, 0x306300C2, + 0x1D90, 0x306400A4, + 0x1D90, 0x306500A3, + 0x1D90, 0x306600A2, + 0x1D90, 0x306700A1, + 0x1D90, 0x30680084, + 0x1D90, 0x30690083, + 0x1D90, 0x306A0082, + 0x1D90, 0x306B0081, + 0x1D90, 0x306C0080, + 0x1D90, 0x306D0067, + 0x1D90, 0x306E0066, + 0x1D90, 0x306F0065, + 0x1D90, 0x30700064, + 0x1D90, 0x30710063, + 0x1D90, 0x30720044, + 0x1D90, 0x30730043, + 0x1D90, 0x30740042, + 0x1D90, 0x30750041, + 0x1D90, 0x30760024, + 0x1D90, 0x30770023, + 0x1D90, 0x30780022, + 0x1D90, 0x30790021, + 0x1D90, 0x307A0020, + 0x1D90, 0x307B0004, + 0x1D90, 0x307C0003, + 0x1D90, 0x307D0002, + 0x1D90, 0x307E0001, + 0x1D90, 0x307F0000, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x308000FF, + 0x1D90, 0x308100FF, + 0x1D90, 0x308200FF, + 0x1D90, 0x308300FF, + 0x1D90, 0x308400FF, + 0x1D90, 0x308500FF, + 0x1D90, 0x308600FE, + 0x1D90, 0x308700FD, + 0x1D90, 0x308800FC, + 0x1D90, 0x308900FB, + 0x1D90, 0x308A00FA, + 0x1D90, 0x308B00F9, + 0x1D90, 0x308C00F8, + 0x1D90, 0x308D00F7, + 0x1D90, 0x308E00F6, + 0x1D90, 0x308F00F5, + 0x1D90, 0x309000F4, + 0x1D90, 0x309100F3, + 0x1D90, 0x309200F2, + 0x1D90, 0x309300F1, + 0x1D90, 0x309400F0, + 0x1D90, 0x309500EF, + 0x1D90, 0x309600EE, + 0x1D90, 0x309700ED, + 0x1D90, 0x309800EC, + 0x1D90, 0x309900EB, + 0x1D90, 0x309A00EA, + 0x1D90, 0x309B00E8, + 0x1D90, 0x309C00E7, + 0x1D90, 0x309D00E6, + 0x1D90, 0x309E00E5, + 0x1D90, 0x309F00E4, + 0x1D90, 0x30A000C4, + 0x1D90, 0x30A100C3, + 0x1D90, 0x30A200C2, + 0x1D90, 0x30A300C1, + 0x1D90, 0x30A400A3, + 0x1D90, 0x30A500A2, + 0x1D90, 0x30A600A1, + 0x1D90, 0x30A70085, + 0x1D90, 0x30A80084, + 0x1D90, 0x30A90083, + 0x1D90, 0x30AA0082, + 0x1D90, 0x30AB0081, + 0x1D90, 0x30AC0067, + 0x1D90, 0x30AD0066, + 0x1D90, 0x30AE0065, + 0x1D90, 0x30AF0064, + 0x1D90, 0x30B00063, + 0x1D90, 0x30B10044, + 0x1D90, 0x30B20043, + 0x1D90, 0x30B30042, + 0x1D90, 0x30B40026, + 0x1D90, 0x30B50025, + 0x1D90, 0x30B60024, + 0x1D90, 0x30B70023, + 0x1D90, 0x30B80022, + 0x1D90, 0x30B90021, + 0x1D90, 0x30BA0005, + 0x1D90, 0x30BB0004, + 0x1D90, 0x30BC0003, + 0x1D90, 0x30BD0002, + 0x1D90, 0x30BE0001, + 0x1D90, 0x30BF0000, + 0x90000015, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x308000FA, + 0x1D90, 0x308100F9, + 0x1D90, 0x308200F8, + 0x1D90, 0x308300F7, + 0x1D90, 0x308400F6, + 0x1D90, 0x308500F5, + 0x1D90, 0x308600F4, + 0x1D90, 0x308700F3, + 0x1D90, 0x308800F2, + 0x1D90, 0x308900F1, + 0x1D90, 0x308A00F0, + 0x1D90, 0x308B00EF, + 0x1D90, 0x308C00EE, + 0x1D90, 0x308D00ED, + 0x1D90, 0x308E00EC, + 0x1D90, 0x308F00EB, + 0x1D90, 0x309000EA, + 0x1D90, 0x309100E8, + 0x1D90, 0x309200E7, + 0x1D90, 0x309300E6, + 0x1D90, 0x309400E5, + 0x1D90, 0x309500E4, + 0x1D90, 0x309600C4, + 0x1D90, 0x309700C3, + 0x1D90, 0x309800C2, + 0x1D90, 0x309900C1, + 0x1D90, 0x309A00A3, + 0x1D90, 0x309B00A2, + 0x1D90, 0x309C00A1, + 0x1D90, 0x309D0085, + 0x1D90, 0x309E0084, + 0x1D90, 0x309F0083, + 0x1D90, 0x30A00082, + 0x1D90, 0x30A10081, + 0x1D90, 0x30A20067, + 0x1D90, 0x30A30066, + 0x1D90, 0x30A40065, + 0x1D90, 0x30A50064, + 0x1D90, 0x30A60063, + 0x1D90, 0x30A70044, + 0x1D90, 0x30A80043, + 0x1D90, 0x30A90042, + 0x1D90, 0x30AA0026, + 0x1D90, 0x30AB0025, + 0x1D90, 0x30AC0024, + 0x1D90, 0x30AD0023, + 0x1D90, 0x30AE0022, + 0x1D90, 0x30AF0021, + 0x1D90, 0x30B00005, + 0x1D90, 0x30B10004, + 0x1D90, 0x30B20003, + 0x1D90, 0x30B30002, + 0x1D90, 0x30B40001, + 0x1D90, 0x30B50000, + 0x1D90, 0x30B60000, + 0x1D90, 0x30B70000, + 0x1D90, 0x30B80000, + 0x1D90, 0x30B90000, + 0x1D90, 0x30BA0000, + 0x1D90, 0x30BB0000, + 0x1D90, 0x30BC0000, + 0x1D90, 0x30BD0000, + 0x1D90, 0x30BE0000, + 0x1D90, 0x30BF0000, + 0x90000016, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x308000FA, + 0x1D90, 0x308100F9, + 0x1D90, 0x308200F8, + 0x1D90, 0x308300F7, + 0x1D90, 0x308400F6, + 0x1D90, 0x308500F5, + 0x1D90, 0x308600F4, + 0x1D90, 0x308700F3, + 0x1D90, 0x308800F2, + 0x1D90, 0x308900F1, + 0x1D90, 0x308A00F0, + 0x1D90, 0x308B00EF, + 0x1D90, 0x308C00EE, + 0x1D90, 0x308D00ED, + 0x1D90, 0x308E00EC, + 0x1D90, 0x308F00EB, + 0x1D90, 0x309000EA, + 0x1D90, 0x309100E8, + 0x1D90, 0x309200E7, + 0x1D90, 0x309300E6, + 0x1D90, 0x309400E5, + 0x1D90, 0x309500E4, + 0x1D90, 0x309600C4, + 0x1D90, 0x309700C3, + 0x1D90, 0x309800C2, + 0x1D90, 0x309900C1, + 0x1D90, 0x309A00A3, + 0x1D90, 0x309B00A2, + 0x1D90, 0x309C00A1, + 0x1D90, 0x309D0085, + 0x1D90, 0x309E0084, + 0x1D90, 0x309F0083, + 0x1D90, 0x30A00082, + 0x1D90, 0x30A10081, + 0x1D90, 0x30A20067, + 0x1D90, 0x30A30066, + 0x1D90, 0x30A40065, + 0x1D90, 0x30A50064, + 0x1D90, 0x30A60063, + 0x1D90, 0x30A70044, + 0x1D90, 0x30A80043, + 0x1D90, 0x30A90042, + 0x1D90, 0x30AA0026, + 0x1D90, 0x30AB0025, + 0x1D90, 0x30AC0024, + 0x1D90, 0x30AD0023, + 0x1D90, 0x30AE0022, + 0x1D90, 0x30AF0021, + 0x1D90, 0x30B00005, + 0x1D90, 0x30B10004, + 0x1D90, 0x30B20003, + 0x1D90, 0x30B30002, + 0x1D90, 0x30B40001, + 0x1D90, 0x30B50000, + 0x1D90, 0x30B60000, + 0x1D90, 0x30B70000, + 0x1D90, 0x30B80000, + 0x1D90, 0x30B90000, + 0x1D90, 0x30BA0000, + 0x1D90, 0x30BB0000, + 0x1D90, 0x30BC0000, + 0x1D90, 0x30BD0000, + 0x1D90, 0x30BE0000, + 0x1D90, 0x30BF0000, + 0xA0000000, 0x00000000, + 0x1D90, 0x308000FF, + 0x1D90, 0x308100FF, + 0x1D90, 0x308200FF, + 0x1D90, 0x308300FF, + 0x1D90, 0x308400FF, + 0x1D90, 0x308500FF, + 0x1D90, 0x308600FE, + 0x1D90, 0x308700FD, + 0x1D90, 0x308800FC, + 0x1D90, 0x308900FB, + 0x1D90, 0x308A00FA, + 0x1D90, 0x308B00F9, + 0x1D90, 0x308C00F8, + 0x1D90, 0x308D00F7, + 0x1D90, 0x308E00F6, + 0x1D90, 0x308F00F5, + 0x1D90, 0x309000F4, + 0x1D90, 0x309100F3, + 0x1D90, 0x309200F2, + 0x1D90, 0x309300F1, + 0x1D90, 0x309400F0, + 0x1D90, 0x309500EF, + 0x1D90, 0x309600EE, + 0x1D90, 0x309700ED, + 0x1D90, 0x309800EC, + 0x1D90, 0x309900EB, + 0x1D90, 0x309A00EA, + 0x1D90, 0x309B00E8, + 0x1D90, 0x309C00E7, + 0x1D90, 0x309D00E6, + 0x1D90, 0x309E00E5, + 0x1D90, 0x309F00E4, + 0x1D90, 0x30A000C4, + 0x1D90, 0x30A100C3, + 0x1D90, 0x30A200C2, + 0x1D90, 0x30A300C1, + 0x1D90, 0x30A400A3, + 0x1D90, 0x30A500A2, + 0x1D90, 0x30A600A1, + 0x1D90, 0x30A70085, + 0x1D90, 0x30A80084, + 0x1D90, 0x30A90083, + 0x1D90, 0x30AA0082, + 0x1D90, 0x30AB0081, + 0x1D90, 0x30AC0067, + 0x1D90, 0x30AD0066, + 0x1D90, 0x30AE0065, + 0x1D90, 0x30AF0064, + 0x1D90, 0x30B00063, + 0x1D90, 0x30B10044, + 0x1D90, 0x30B20043, + 0x1D90, 0x30B30042, + 0x1D90, 0x30B40026, + 0x1D90, 0x30B50025, + 0x1D90, 0x30B60024, + 0x1D90, 0x30B70023, + 0x1D90, 0x30B80022, + 0x1D90, 0x30B90021, + 0x1D90, 0x30BA0005, + 0x1D90, 0x30BB0004, + 0x1D90, 0x30BC0003, + 0x1D90, 0x30BD0002, + 0x1D90, 0x30BE0001, + 0x1D90, 0x30BF0000, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x30C000FF, + 0x1D90, 0x30C100FF, + 0x1D90, 0x30C200FF, + 0x1D90, 0x30C300FF, + 0x1D90, 0x30C400FF, + 0x1D90, 0x30C500FF, + 0x1D90, 0x30C600FE, + 0x1D90, 0x30C700FD, + 0x1D90, 0x30C800FC, + 0x1D90, 0x30C900FB, + 0x1D90, 0x30CA00FA, + 0x1D90, 0x30CB00F9, + 0x1D90, 0x30CC00F8, + 0x1D90, 0x30CD00F7, + 0x1D90, 0x30CE00F6, + 0x1D90, 0x30CF00F5, + 0x1D90, 0x30D000F4, + 0x1D90, 0x30D100F3, + 0x1D90, 0x30D200F2, + 0x1D90, 0x30D300F1, + 0x1D90, 0x30D400F0, + 0x1D90, 0x30D500EF, + 0x1D90, 0x30D600EE, + 0x1D90, 0x30D700ED, + 0x1D90, 0x30D800EC, + 0x1D90, 0x30D900EB, + 0x1D90, 0x30DA00EA, + 0x1D90, 0x30DB00E8, + 0x1D90, 0x30DC00E7, + 0x1D90, 0x30DD00E6, + 0x1D90, 0x30DE00E5, + 0x1D90, 0x30DF00E4, + 0x1D90, 0x30E000E3, + 0x1D90, 0x30E100E2, + 0x1D90, 0x30E200A6, + 0x1D90, 0x30E300A5, + 0x1D90, 0x30E400A4, + 0x1D90, 0x30E500A3, + 0x1D90, 0x30E600A2, + 0x1D90, 0x30E70086, + 0x1D90, 0x30E80085, + 0x1D90, 0x30E90084, + 0x1D90, 0x30EA0083, + 0x1D90, 0x30EB0082, + 0x1D90, 0x30EC0067, + 0x1D90, 0x30ED0066, + 0x1D90, 0x30EE0065, + 0x1D90, 0x30EF0064, + 0x1D90, 0x30F00063, + 0x1D90, 0x30F10045, + 0x1D90, 0x30F20044, + 0x1D90, 0x30F30043, + 0x1D90, 0x30F40042, + 0x1D90, 0x30F50025, + 0x1D90, 0x30F60024, + 0x1D90, 0x30F70023, + 0x1D90, 0x30F80022, + 0x1D90, 0x30F90021, + 0x1D90, 0x30FA0005, + 0x1D90, 0x30FB0004, + 0x1D90, 0x30FC0003, + 0x1D90, 0x30FD0002, + 0x1D90, 0x30FE0001, + 0x1D90, 0x30FF0000, + 0x90000015, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x30C000F8, + 0x1D90, 0x30C100F7, + 0x1D90, 0x30C200F6, + 0x1D90, 0x30C300F5, + 0x1D90, 0x30C400F4, + 0x1D90, 0x30C500F3, + 0x1D90, 0x30C600F2, + 0x1D90, 0x30C700F1, + 0x1D90, 0x30C800F0, + 0x1D90, 0x30C900EF, + 0x1D90, 0x30CA00EE, + 0x1D90, 0x30CB00ED, + 0x1D90, 0x30CC00EC, + 0x1D90, 0x30CD00EB, + 0x1D90, 0x30CE00EA, + 0x1D90, 0x30CF00E8, + 0x1D90, 0x30D000E7, + 0x1D90, 0x30D100E6, + 0x1D90, 0x30D200E5, + 0x1D90, 0x30D300E4, + 0x1D90, 0x30D400E3, + 0x1D90, 0x30D500E2, + 0x1D90, 0x30D600A6, + 0x1D90, 0x30D700A5, + 0x1D90, 0x30D800A4, + 0x1D90, 0x30D900A3, + 0x1D90, 0x30DA00A2, + 0x1D90, 0x30DB0086, + 0x1D90, 0x30DC0085, + 0x1D90, 0x30DD0084, + 0x1D90, 0x30DE0083, + 0x1D90, 0x30DF0081, + 0x1D90, 0x30E00068, + 0x1D90, 0x30E10067, + 0x1D90, 0x30E20066, + 0x1D90, 0x30E30065, + 0x1D90, 0x30E40064, + 0x1D90, 0x30E50045, + 0x1D90, 0x30E60044, + 0x1D90, 0x30E70043, + 0x1D90, 0x30E80042, + 0x1D90, 0x30E90025, + 0x1D90, 0x30EA0024, + 0x1D90, 0x30EB0023, + 0x1D90, 0x30EC0022, + 0x1D90, 0x30ED0021, + 0x1D90, 0x30EE0005, + 0x1D90, 0x30EF0004, + 0x1D90, 0x30F00003, + 0x1D90, 0x30F10002, + 0x1D90, 0x30F20001, + 0x1D90, 0x30F30000, + 0x1D90, 0x30F40000, + 0x1D90, 0x30F50000, + 0x1D90, 0x30F60000, + 0x1D90, 0x30F70000, + 0x1D90, 0x30F80000, + 0x1D90, 0x30F90000, + 0x1D90, 0x30FA0000, + 0x1D90, 0x30FB0000, + 0x1D90, 0x30FC0000, + 0x1D90, 0x30FD0000, + 0x1D90, 0x30FE0000, + 0x1D90, 0x30FF0000, + 0x90000016, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x30C000F8, + 0x1D90, 0x30C100F7, + 0x1D90, 0x30C200F6, + 0x1D90, 0x30C300F5, + 0x1D90, 0x30C400F4, + 0x1D90, 0x30C500F3, + 0x1D90, 0x30C600F2, + 0x1D90, 0x30C700F1, + 0x1D90, 0x30C800F0, + 0x1D90, 0x30C900EF, + 0x1D90, 0x30CA00EE, + 0x1D90, 0x30CB00ED, + 0x1D90, 0x30CC00EC, + 0x1D90, 0x30CD00EB, + 0x1D90, 0x30CE00EA, + 0x1D90, 0x30CF00E8, + 0x1D90, 0x30D000E7, + 0x1D90, 0x30D100E6, + 0x1D90, 0x30D200E5, + 0x1D90, 0x30D300E4, + 0x1D90, 0x30D400E3, + 0x1D90, 0x30D500E2, + 0x1D90, 0x30D600A6, + 0x1D90, 0x30D700A5, + 0x1D90, 0x30D800A4, + 0x1D90, 0x30D900A3, + 0x1D90, 0x30DA00A2, + 0x1D90, 0x30DB0086, + 0x1D90, 0x30DC0085, + 0x1D90, 0x30DD0084, + 0x1D90, 0x30DE0083, + 0x1D90, 0x30DF0081, + 0x1D90, 0x30E00068, + 0x1D90, 0x30E10067, + 0x1D90, 0x30E20066, + 0x1D90, 0x30E30065, + 0x1D90, 0x30E40064, + 0x1D90, 0x30E50045, + 0x1D90, 0x30E60044, + 0x1D90, 0x30E70043, + 0x1D90, 0x30E80042, + 0x1D90, 0x30E90025, + 0x1D90, 0x30EA0024, + 0x1D90, 0x30EB0023, + 0x1D90, 0x30EC0022, + 0x1D90, 0x30ED0021, + 0x1D90, 0x30EE0005, + 0x1D90, 0x30EF0004, + 0x1D90, 0x30F00003, + 0x1D90, 0x30F10002, + 0x1D90, 0x30F20001, + 0x1D90, 0x30F30000, + 0x1D90, 0x30F40000, + 0x1D90, 0x30F50000, + 0x1D90, 0x30F60000, + 0x1D90, 0x30F70000, + 0x1D90, 0x30F80000, + 0x1D90, 0x30F90000, + 0x1D90, 0x30FA0000, + 0x1D90, 0x30FB0000, + 0x1D90, 0x30FC0000, + 0x1D90, 0x30FD0000, + 0x1D90, 0x30FE0000, + 0x1D90, 0x30FF0000, + 0xA0000000, 0x00000000, + 0x1D90, 0x30C000FF, + 0x1D90, 0x30C100FF, + 0x1D90, 0x30C200FF, + 0x1D90, 0x30C300FF, + 0x1D90, 0x30C400FF, + 0x1D90, 0x30C500FF, + 0x1D90, 0x30C600FE, + 0x1D90, 0x30C700FD, + 0x1D90, 0x30C800FC, + 0x1D90, 0x30C900FB, + 0x1D90, 0x30CA00FA, + 0x1D90, 0x30CB00F9, + 0x1D90, 0x30CC00F8, + 0x1D90, 0x30CD00F7, + 0x1D90, 0x30CE00F6, + 0x1D90, 0x30CF00F5, + 0x1D90, 0x30D000F4, + 0x1D90, 0x30D100F3, + 0x1D90, 0x30D200F2, + 0x1D90, 0x30D300F1, + 0x1D90, 0x30D400F0, + 0x1D90, 0x30D500EF, + 0x1D90, 0x30D600EE, + 0x1D90, 0x30D700ED, + 0x1D90, 0x30D800EC, + 0x1D90, 0x30D900EB, + 0x1D90, 0x30DA00EA, + 0x1D90, 0x30DB00E8, + 0x1D90, 0x30DC00E7, + 0x1D90, 0x30DD00E6, + 0x1D90, 0x30DE00E5, + 0x1D90, 0x30DF00E4, + 0x1D90, 0x30E000E3, + 0x1D90, 0x30E100E2, + 0x1D90, 0x30E200A6, + 0x1D90, 0x30E300A5, + 0x1D90, 0x30E400A4, + 0x1D90, 0x30E500A3, + 0x1D90, 0x30E600A2, + 0x1D90, 0x30E70086, + 0x1D90, 0x30E80085, + 0x1D90, 0x30E90084, + 0x1D90, 0x30EA0083, + 0x1D90, 0x30EB0082, + 0x1D90, 0x30EC0067, + 0x1D90, 0x30ED0066, + 0x1D90, 0x30EE0065, + 0x1D90, 0x30EF0064, + 0x1D90, 0x30F00063, + 0x1D90, 0x30F10045, + 0x1D90, 0x30F20044, + 0x1D90, 0x30F30043, + 0x1D90, 0x30F40042, + 0x1D90, 0x30F50025, + 0x1D90, 0x30F60024, + 0x1D90, 0x30F70023, + 0x1D90, 0x30F80022, + 0x1D90, 0x30F90021, + 0x1D90, 0x30FA0005, + 0x1D90, 0x30FB0004, + 0x1D90, 0x30FC0003, + 0x1D90, 0x30FD0002, + 0x1D90, 0x30FE0001, + 0x1D90, 0x30FF0000, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x310001FF, + 0x1D90, 0x310101FF, + 0x1D90, 0x310201FF, + 0x1D90, 0x310301FF, + 0x1D90, 0x310401FE, + 0x1D90, 0x310501FD, + 0x1D90, 0x310601FC, + 0x1D90, 0x310701FB, + 0x1D90, 0x310801FA, + 0x1D90, 0x310901F9, + 0x1D90, 0x310A01F8, + 0x1D90, 0x310B01F7, + 0x1D90, 0x310C01F6, + 0x1D90, 0x310D01F5, + 0x1D90, 0x310E01F4, + 0x1D90, 0x310F01F3, + 0x1D90, 0x311001F2, + 0x1D90, 0x311101F1, + 0x1D90, 0x311201F0, + 0x1D90, 0x311301EF, + 0x1D90, 0x311401EE, + 0x1D90, 0x311501ED, + 0x1D90, 0x311601EC, + 0x1D90, 0x311701EB, + 0x1D90, 0x311801EA, + 0x1D90, 0x311901E9, + 0x1D90, 0x311A01E8, + 0x1D90, 0x311B01E7, + 0x1D90, 0x311C01E5, + 0x1D90, 0x311D01E4, + 0x1D90, 0x311E01C5, + 0x1D90, 0x311F01C4, + 0x1D90, 0x312001C3, + 0x1D90, 0x312101C2, + 0x1D90, 0x31220188, + 0x1D90, 0x31230187, + 0x1D90, 0x31240186, + 0x1D90, 0x31250184, + 0x1D90, 0x31260183, + 0x1D90, 0x31270182, + 0x1D90, 0x31280181, + 0x1D90, 0x31290148, + 0x1D90, 0x312A0147, + 0x1D90, 0x312B0146, + 0x1D90, 0x312C0144, + 0x1D90, 0x312D0143, + 0x1D90, 0x312E0142, + 0x1D90, 0x312F0141, + 0x1D90, 0x313000C8, + 0x1D90, 0x313100C7, + 0x1D90, 0x313200C6, + 0x1D90, 0x313300C5, + 0x1D90, 0x313400C4, + 0x1D90, 0x313500C3, + 0x1D90, 0x31360048, + 0x1D90, 0x31370047, + 0x1D90, 0x31380046, + 0x1D90, 0x31390045, + 0x1D90, 0x313A0025, + 0x1D90, 0x313B0024, + 0x1D90, 0x313C0023, + 0x1D90, 0x313D0022, + 0x1D90, 0x313E0021, + 0x1D90, 0x313F0020, + 0x90000015, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x310001FF, + 0x1D90, 0x310101FF, + 0x1D90, 0x310201FF, + 0x1D90, 0x310301FF, + 0x1D90, 0x310401FE, + 0x1D90, 0x310501FD, + 0x1D90, 0x310601FC, + 0x1D90, 0x310701FB, + 0x1D90, 0x310801FA, + 0x1D90, 0x310901F9, + 0x1D90, 0x310A01F8, + 0x1D90, 0x310B01F7, + 0x1D90, 0x310C01F6, + 0x1D90, 0x310D01F5, + 0x1D90, 0x310E01F4, + 0x1D90, 0x310F01F3, + 0x1D90, 0x311001F2, + 0x1D90, 0x311101F1, + 0x1D90, 0x311201F0, + 0x1D90, 0x311301EF, + 0x1D90, 0x311401EE, + 0x1D90, 0x311501ED, + 0x1D90, 0x311601EC, + 0x1D90, 0x311701EB, + 0x1D90, 0x311801EA, + 0x1D90, 0x311901E9, + 0x1D90, 0x311A01E8, + 0x1D90, 0x311B01E7, + 0x1D90, 0x311C01E5, + 0x1D90, 0x311D01E4, + 0x1D90, 0x311E01C5, + 0x1D90, 0x311F01C4, + 0x1D90, 0x312001C3, + 0x1D90, 0x312101C2, + 0x1D90, 0x31220188, + 0x1D90, 0x31230187, + 0x1D90, 0x31240186, + 0x1D90, 0x31250184, + 0x1D90, 0x31260183, + 0x1D90, 0x31270182, + 0x1D90, 0x31280181, + 0x1D90, 0x31290148, + 0x1D90, 0x312A0147, + 0x1D90, 0x312B0146, + 0x1D90, 0x312C0144, + 0x1D90, 0x312D0143, + 0x1D90, 0x312E0142, + 0x1D90, 0x312F0141, + 0x1D90, 0x313000C8, + 0x1D90, 0x313100C7, + 0x1D90, 0x313200C6, + 0x1D90, 0x313300C5, + 0x1D90, 0x313400C4, + 0x1D90, 0x313500C3, + 0x1D90, 0x31360048, + 0x1D90, 0x31370047, + 0x1D90, 0x31380046, + 0x1D90, 0x31390045, + 0x1D90, 0x313A0025, + 0x1D90, 0x313B0024, + 0x1D90, 0x313C0023, + 0x1D90, 0x313D0022, + 0x1D90, 0x313E0021, + 0x1D90, 0x313F0020, + 0x90000016, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x310001FF, + 0x1D90, 0x310101FF, + 0x1D90, 0x310201FF, + 0x1D90, 0x310301FF, + 0x1D90, 0x310401FE, + 0x1D90, 0x310501FD, + 0x1D90, 0x310601FC, + 0x1D90, 0x310701FB, + 0x1D90, 0x310801FA, + 0x1D90, 0x310901F9, + 0x1D90, 0x310A01F8, + 0x1D90, 0x310B01F7, + 0x1D90, 0x310C01F6, + 0x1D90, 0x310D01F5, + 0x1D90, 0x310E01F4, + 0x1D90, 0x310F01F3, + 0x1D90, 0x311001F2, + 0x1D90, 0x311101F1, + 0x1D90, 0x311201F0, + 0x1D90, 0x311301EF, + 0x1D90, 0x311401EE, + 0x1D90, 0x311501ED, + 0x1D90, 0x311601EC, + 0x1D90, 0x311701EB, + 0x1D90, 0x311801EA, + 0x1D90, 0x311901E9, + 0x1D90, 0x311A01E8, + 0x1D90, 0x311B01E7, + 0x1D90, 0x311C01E5, + 0x1D90, 0x311D01E4, + 0x1D90, 0x311E01C5, + 0x1D90, 0x311F01C4, + 0x1D90, 0x312001C3, + 0x1D90, 0x312101C2, + 0x1D90, 0x31220188, + 0x1D90, 0x31230187, + 0x1D90, 0x31240186, + 0x1D90, 0x31250184, + 0x1D90, 0x31260183, + 0x1D90, 0x31270182, + 0x1D90, 0x31280181, + 0x1D90, 0x31290148, + 0x1D90, 0x312A0147, + 0x1D90, 0x312B0146, + 0x1D90, 0x312C0144, + 0x1D90, 0x312D0143, + 0x1D90, 0x312E0142, + 0x1D90, 0x312F0141, + 0x1D90, 0x313000C8, + 0x1D90, 0x313100C7, + 0x1D90, 0x313200C6, + 0x1D90, 0x313300C5, + 0x1D90, 0x313400C4, + 0x1D90, 0x313500C3, + 0x1D90, 0x31360048, + 0x1D90, 0x31370047, + 0x1D90, 0x31380046, + 0x1D90, 0x31390045, + 0x1D90, 0x313A0025, + 0x1D90, 0x313B0024, + 0x1D90, 0x313C0023, + 0x1D90, 0x313D0022, + 0x1D90, 0x313E0021, + 0x1D90, 0x313F0020, + 0xA0000000, 0x00000000, + 0x1D90, 0x310001FF, + 0x1D90, 0x310101FF, + 0x1D90, 0x310201FF, + 0x1D90, 0x310301FF, + 0x1D90, 0x310401FE, + 0x1D90, 0x310501FD, + 0x1D90, 0x310601FC, + 0x1D90, 0x310701FB, + 0x1D90, 0x310801FA, + 0x1D90, 0x310901F9, + 0x1D90, 0x310A01F8, + 0x1D90, 0x310B01F7, + 0x1D90, 0x310C01F6, + 0x1D90, 0x310D01F5, + 0x1D90, 0x310E01F4, + 0x1D90, 0x310F01F3, + 0x1D90, 0x311001F2, + 0x1D90, 0x311101F1, + 0x1D90, 0x311201F0, + 0x1D90, 0x311301EF, + 0x1D90, 0x311401EE, + 0x1D90, 0x311501ED, + 0x1D90, 0x311601EC, + 0x1D90, 0x311701EB, + 0x1D90, 0x311801EA, + 0x1D90, 0x311901E9, + 0x1D90, 0x311A01E8, + 0x1D90, 0x311B01E7, + 0x1D90, 0x311C01E5, + 0x1D90, 0x311D01E4, + 0x1D90, 0x311E01C5, + 0x1D90, 0x311F01C4, + 0x1D90, 0x312001C3, + 0x1D90, 0x312101C2, + 0x1D90, 0x31220188, + 0x1D90, 0x31230187, + 0x1D90, 0x31240186, + 0x1D90, 0x31250184, + 0x1D90, 0x31260183, + 0x1D90, 0x31270182, + 0x1D90, 0x31280181, + 0x1D90, 0x31290148, + 0x1D90, 0x312A0147, + 0x1D90, 0x312B0146, + 0x1D90, 0x312C0144, + 0x1D90, 0x312D0143, + 0x1D90, 0x312E0142, + 0x1D90, 0x312F0141, + 0x1D90, 0x313000C8, + 0x1D90, 0x313100C7, + 0x1D90, 0x313200C6, + 0x1D90, 0x313300C5, + 0x1D90, 0x313400C4, + 0x1D90, 0x313500C3, + 0x1D90, 0x31360048, + 0x1D90, 0x31370047, + 0x1D90, 0x31380046, + 0x1D90, 0x31390045, + 0x1D90, 0x313A0025, + 0x1D90, 0x313B0024, + 0x1D90, 0x313C0023, + 0x1D90, 0x313D0022, + 0x1D90, 0x313E0021, + 0x1D90, 0x313F0020, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x314001FF, + 0x1D90, 0x314101FF, + 0x1D90, 0x314201FF, + 0x1D90, 0x314301FF, + 0x1D90, 0x314401FF, + 0x1D90, 0x314501FF, + 0x1D90, 0x314601FE, + 0x1D90, 0x314701FD, + 0x1D90, 0x314801FC, + 0x1D90, 0x314901FB, + 0x1D90, 0x314A01FA, + 0x1D90, 0x314B01F9, + 0x1D90, 0x314C01F8, + 0x1D90, 0x314D01F7, + 0x1D90, 0x314E01F6, + 0x1D90, 0x314F01F5, + 0x1D90, 0x315001F4, + 0x1D90, 0x315101F3, + 0x1D90, 0x315201F2, + 0x1D90, 0x315301F1, + 0x1D90, 0x315401F0, + 0x1D90, 0x315501EF, + 0x1D90, 0x315601EE, + 0x1D90, 0x315701ED, + 0x1D90, 0x315801EC, + 0x1D90, 0x315901EB, + 0x1D90, 0x315A01EA, + 0x1D90, 0x315B01E9, + 0x1D90, 0x315C01E7, + 0x1D90, 0x315D01E6, + 0x1D90, 0x315E01E5, + 0x1D90, 0x315F01E4, + 0x1D90, 0x316001A8, + 0x1D90, 0x316101A7, + 0x1D90, 0x316201A6, + 0x1D90, 0x316301A5, + 0x1D90, 0x31640185, + 0x1D90, 0x31650184, + 0x1D90, 0x31660183, + 0x1D90, 0x31670182, + 0x1D90, 0x31680149, + 0x1D90, 0x31690148, + 0x1D90, 0x316A0147, + 0x1D90, 0x316B0145, + 0x1D90, 0x316C0144, + 0x1D90, 0x316D0143, + 0x1D90, 0x316E0142, + 0x1D90, 0x316F00E6, + 0x1D90, 0x317000E5, + 0x1D90, 0x317100C9, + 0x1D90, 0x317200C8, + 0x1D90, 0x317300C7, + 0x1D90, 0x317400C6, + 0x1D90, 0x317500C5, + 0x1D90, 0x317600C4, + 0x1D90, 0x317700C3, + 0x1D90, 0x31780088, + 0x1D90, 0x31790087, + 0x1D90, 0x317A0086, + 0x1D90, 0x317B0085, + 0x1D90, 0x317C0026, + 0x1D90, 0x317D0025, + 0x1D90, 0x317E0024, + 0x1D90, 0x317F0023, + 0x90000015, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x314001FF, + 0x1D90, 0x314101FF, + 0x1D90, 0x314201FF, + 0x1D90, 0x314301FF, + 0x1D90, 0x314401FF, + 0x1D90, 0x314501FF, + 0x1D90, 0x314601FE, + 0x1D90, 0x314701FD, + 0x1D90, 0x314801FC, + 0x1D90, 0x314901FB, + 0x1D90, 0x314A01FA, + 0x1D90, 0x314B01F9, + 0x1D90, 0x314C01F8, + 0x1D90, 0x314D01F7, + 0x1D90, 0x314E01F6, + 0x1D90, 0x314F01F5, + 0x1D90, 0x315001F4, + 0x1D90, 0x315101F3, + 0x1D90, 0x315201F2, + 0x1D90, 0x315301F1, + 0x1D90, 0x315401F0, + 0x1D90, 0x315501EF, + 0x1D90, 0x315601EE, + 0x1D90, 0x315701ED, + 0x1D90, 0x315801EC, + 0x1D90, 0x315901EB, + 0x1D90, 0x315A01EA, + 0x1D90, 0x315B01E9, + 0x1D90, 0x315C01E7, + 0x1D90, 0x315D01E6, + 0x1D90, 0x315E01E5, + 0x1D90, 0x315F01E4, + 0x1D90, 0x316001A8, + 0x1D90, 0x316101A7, + 0x1D90, 0x316201A6, + 0x1D90, 0x316301A5, + 0x1D90, 0x31640185, + 0x1D90, 0x31650184, + 0x1D90, 0x31660183, + 0x1D90, 0x31670182, + 0x1D90, 0x31680149, + 0x1D90, 0x31690148, + 0x1D90, 0x316A0147, + 0x1D90, 0x316B0145, + 0x1D90, 0x316C0144, + 0x1D90, 0x316D0143, + 0x1D90, 0x316E0142, + 0x1D90, 0x316F00E6, + 0x1D90, 0x317000E5, + 0x1D90, 0x317100C9, + 0x1D90, 0x317200C8, + 0x1D90, 0x317300C7, + 0x1D90, 0x317400C6, + 0x1D90, 0x317500C5, + 0x1D90, 0x317600C4, + 0x1D90, 0x317700C3, + 0x1D90, 0x31780088, + 0x1D90, 0x31790087, + 0x1D90, 0x317A0086, + 0x1D90, 0x317B0085, + 0x1D90, 0x317C0026, + 0x1D90, 0x317D0025, + 0x1D90, 0x317E0024, + 0x1D90, 0x317F0023, + 0x90000016, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x314001FF, + 0x1D90, 0x314101FF, + 0x1D90, 0x314201FF, + 0x1D90, 0x314301FF, + 0x1D90, 0x314401FF, + 0x1D90, 0x314501FF, + 0x1D90, 0x314601FE, + 0x1D90, 0x314701FD, + 0x1D90, 0x314801FC, + 0x1D90, 0x314901FB, + 0x1D90, 0x314A01FA, + 0x1D90, 0x314B01F9, + 0x1D90, 0x314C01F8, + 0x1D90, 0x314D01F7, + 0x1D90, 0x314E01F6, + 0x1D90, 0x314F01F5, + 0x1D90, 0x315001F4, + 0x1D90, 0x315101F3, + 0x1D90, 0x315201F2, + 0x1D90, 0x315301F1, + 0x1D90, 0x315401F0, + 0x1D90, 0x315501EF, + 0x1D90, 0x315601EE, + 0x1D90, 0x315701ED, + 0x1D90, 0x315801EC, + 0x1D90, 0x315901EB, + 0x1D90, 0x315A01EA, + 0x1D90, 0x315B01E9, + 0x1D90, 0x315C01E7, + 0x1D90, 0x315D01E6, + 0x1D90, 0x315E01E5, + 0x1D90, 0x315F01E4, + 0x1D90, 0x316001A8, + 0x1D90, 0x316101A7, + 0x1D90, 0x316201A6, + 0x1D90, 0x316301A5, + 0x1D90, 0x31640185, + 0x1D90, 0x31650184, + 0x1D90, 0x31660183, + 0x1D90, 0x31670182, + 0x1D90, 0x31680149, + 0x1D90, 0x31690148, + 0x1D90, 0x316A0147, + 0x1D90, 0x316B0145, + 0x1D90, 0x316C0144, + 0x1D90, 0x316D0143, + 0x1D90, 0x316E0142, + 0x1D90, 0x316F00E6, + 0x1D90, 0x317000E5, + 0x1D90, 0x317100C9, + 0x1D90, 0x317200C8, + 0x1D90, 0x317300C7, + 0x1D90, 0x317400C6, + 0x1D90, 0x317500C5, + 0x1D90, 0x317600C4, + 0x1D90, 0x317700C3, + 0x1D90, 0x31780088, + 0x1D90, 0x31790087, + 0x1D90, 0x317A0086, + 0x1D90, 0x317B0085, + 0x1D90, 0x317C0026, + 0x1D90, 0x317D0025, + 0x1D90, 0x317E0024, + 0x1D90, 0x317F0023, + 0xA0000000, 0x00000000, + 0x1D90, 0x314001FF, + 0x1D90, 0x314101FF, + 0x1D90, 0x314201FF, + 0x1D90, 0x314301FF, + 0x1D90, 0x314401FF, + 0x1D90, 0x314501FF, + 0x1D90, 0x314601FE, + 0x1D90, 0x314701FD, + 0x1D90, 0x314801FC, + 0x1D90, 0x314901FB, + 0x1D90, 0x314A01FA, + 0x1D90, 0x314B01F9, + 0x1D90, 0x314C01F8, + 0x1D90, 0x314D01F7, + 0x1D90, 0x314E01F6, + 0x1D90, 0x314F01F5, + 0x1D90, 0x315001F4, + 0x1D90, 0x315101F3, + 0x1D90, 0x315201F2, + 0x1D90, 0x315301F1, + 0x1D90, 0x315401F0, + 0x1D90, 0x315501EF, + 0x1D90, 0x315601EE, + 0x1D90, 0x315701ED, + 0x1D90, 0x315801EC, + 0x1D90, 0x315901EB, + 0x1D90, 0x315A01EA, + 0x1D90, 0x315B01E9, + 0x1D90, 0x315C01E7, + 0x1D90, 0x315D01E6, + 0x1D90, 0x315E01E5, + 0x1D90, 0x315F01E4, + 0x1D90, 0x316001A8, + 0x1D90, 0x316101A7, + 0x1D90, 0x316201A6, + 0x1D90, 0x316301A5, + 0x1D90, 0x31640185, + 0x1D90, 0x31650184, + 0x1D90, 0x31660183, + 0x1D90, 0x31670182, + 0x1D90, 0x31680149, + 0x1D90, 0x31690148, + 0x1D90, 0x316A0147, + 0x1D90, 0x316B0145, + 0x1D90, 0x316C0144, + 0x1D90, 0x316D0143, + 0x1D90, 0x316E0142, + 0x1D90, 0x316F00E6, + 0x1D90, 0x317000E5, + 0x1D90, 0x317100C9, + 0x1D90, 0x317200C8, + 0x1D90, 0x317300C7, + 0x1D90, 0x317400C6, + 0x1D90, 0x317500C5, + 0x1D90, 0x317600C4, + 0x1D90, 0x317700C3, + 0x1D90, 0x31780088, + 0x1D90, 0x31790087, + 0x1D90, 0x317A0086, + 0x1D90, 0x317B0085, + 0x1D90, 0x317C0026, + 0x1D90, 0x317D0025, + 0x1D90, 0x317E0024, + 0x1D90, 0x317F0023, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x318001FE, + 0x1D90, 0x318101FD, + 0x1D90, 0x318201FC, + 0x1D90, 0x318301FB, + 0x1D90, 0x318401FA, + 0x1D90, 0x318501F9, + 0x1D90, 0x318601F8, + 0x1D90, 0x318701F7, + 0x1D90, 0x318801F6, + 0x1D90, 0x318901F5, + 0x1D90, 0x318A01F4, + 0x1D90, 0x318B01F3, + 0x1D90, 0x318C01F2, + 0x1D90, 0x318D01F1, + 0x1D90, 0x318E01F0, + 0x1D90, 0x318F01EF, + 0x1D90, 0x319001EE, + 0x1D90, 0x319101ED, + 0x1D90, 0x319201EC, + 0x1D90, 0x319301EB, + 0x1D90, 0x319401EA, + 0x1D90, 0x319501E9, + 0x1D90, 0x319601E7, + 0x1D90, 0x319701E6, + 0x1D90, 0x319801E5, + 0x1D90, 0x319901E4, + 0x1D90, 0x319A01A8, + 0x1D90, 0x319B01A7, + 0x1D90, 0x319C01A6, + 0x1D90, 0x319D01A5, + 0x1D90, 0x319E0185, + 0x1D90, 0x319F0184, + 0x1D90, 0x31A00183, + 0x1D90, 0x31A10182, + 0x1D90, 0x31A20149, + 0x1D90, 0x31A30148, + 0x1D90, 0x31A40147, + 0x1D90, 0x31A50145, + 0x1D90, 0x31A60144, + 0x1D90, 0x31A70143, + 0x1D90, 0x31A80142, + 0x1D90, 0x31A900E6, + 0x1D90, 0x31AA00E5, + 0x1D90, 0x31AB00C9, + 0x1D90, 0x31AC00C8, + 0x1D90, 0x31AD00C7, + 0x1D90, 0x31AE00C6, + 0x1D90, 0x31AF00C5, + 0x1D90, 0x31B000C4, + 0x1D90, 0x31B100C3, + 0x1D90, 0x31B20088, + 0x1D90, 0x31B30087, + 0x1D90, 0x31B40086, + 0x1D90, 0x31B50085, + 0x1D90, 0x31B60026, + 0x1D90, 0x31B70025, + 0x1D90, 0x31B80024, + 0x1D90, 0x31B90023, + 0x1D90, 0x31BA0022, + 0x1D90, 0x31BB0021, + 0x1D90, 0x31BC0020, + 0x1D90, 0x31BD0003, + 0x1D90, 0x31BE0002, + 0x1D90, 0x31BF0001, + 0x90000015, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x318001FE, + 0x1D90, 0x318101FD, + 0x1D90, 0x318201FC, + 0x1D90, 0x318301FB, + 0x1D90, 0x318401FA, + 0x1D90, 0x318501F9, + 0x1D90, 0x318601F8, + 0x1D90, 0x318701F7, + 0x1D90, 0x318801F6, + 0x1D90, 0x318901F5, + 0x1D90, 0x318A01F4, + 0x1D90, 0x318B01F3, + 0x1D90, 0x318C01F2, + 0x1D90, 0x318D01F1, + 0x1D90, 0x318E01F0, + 0x1D90, 0x318F01EF, + 0x1D90, 0x319001EE, + 0x1D90, 0x319101ED, + 0x1D90, 0x319201EC, + 0x1D90, 0x319301EB, + 0x1D90, 0x319401EA, + 0x1D90, 0x319501E9, + 0x1D90, 0x319601E7, + 0x1D90, 0x319701E6, + 0x1D90, 0x319801E5, + 0x1D90, 0x319901E4, + 0x1D90, 0x319A01A8, + 0x1D90, 0x319B01A7, + 0x1D90, 0x319C01A6, + 0x1D90, 0x319D01A5, + 0x1D90, 0x319E0185, + 0x1D90, 0x319F0184, + 0x1D90, 0x31A00183, + 0x1D90, 0x31A10182, + 0x1D90, 0x31A20149, + 0x1D90, 0x31A30148, + 0x1D90, 0x31A40147, + 0x1D90, 0x31A50145, + 0x1D90, 0x31A60144, + 0x1D90, 0x31A70143, + 0x1D90, 0x31A80142, + 0x1D90, 0x31A900E6, + 0x1D90, 0x31AA00E5, + 0x1D90, 0x31AB00C9, + 0x1D90, 0x31AC00C8, + 0x1D90, 0x31AD00C7, + 0x1D90, 0x31AE00C6, + 0x1D90, 0x31AF00C5, + 0x1D90, 0x31B000C4, + 0x1D90, 0x31B100C3, + 0x1D90, 0x31B20088, + 0x1D90, 0x31B30087, + 0x1D90, 0x31B40086, + 0x1D90, 0x31B50085, + 0x1D90, 0x31B60026, + 0x1D90, 0x31B70025, + 0x1D90, 0x31B80024, + 0x1D90, 0x31B90023, + 0x1D90, 0x31BA0022, + 0x1D90, 0x31BB0021, + 0x1D90, 0x31BC0020, + 0x1D90, 0x31BD0003, + 0x1D90, 0x31BE0002, + 0x1D90, 0x31BF0001, + 0x90000016, 0x00000000, 0x40000000, 0x00000000, + 0x1D90, 0x318001FE, + 0x1D90, 0x318101FD, + 0x1D90, 0x318201FC, + 0x1D90, 0x318301FB, + 0x1D90, 0x318401FA, + 0x1D90, 0x318501F9, + 0x1D90, 0x318601F8, + 0x1D90, 0x318701F7, + 0x1D90, 0x318801F6, + 0x1D90, 0x318901F5, + 0x1D90, 0x318A01F4, + 0x1D90, 0x318B01F3, + 0x1D90, 0x318C01F2, + 0x1D90, 0x318D01F1, + 0x1D90, 0x318E01F0, + 0x1D90, 0x318F01EF, + 0x1D90, 0x319001EE, + 0x1D90, 0x319101ED, + 0x1D90, 0x319201EC, + 0x1D90, 0x319301EB, + 0x1D90, 0x319401EA, + 0x1D90, 0x319501E9, + 0x1D90, 0x319601E7, + 0x1D90, 0x319701E6, + 0x1D90, 0x319801E5, + 0x1D90, 0x319901E4, + 0x1D90, 0x319A01A8, + 0x1D90, 0x319B01A7, + 0x1D90, 0x319C01A6, + 0x1D90, 0x319D01A5, + 0x1D90, 0x319E0185, + 0x1D90, 0x319F0184, + 0x1D90, 0x31A00183, + 0x1D90, 0x31A10182, + 0x1D90, 0x31A20149, + 0x1D90, 0x31A30148, + 0x1D90, 0x31A40147, + 0x1D90, 0x31A50145, + 0x1D90, 0x31A60144, + 0x1D90, 0x31A70143, + 0x1D90, 0x31A80142, + 0x1D90, 0x31A900E6, + 0x1D90, 0x31AA00E5, + 0x1D90, 0x31AB00C9, + 0x1D90, 0x31AC00C8, + 0x1D90, 0x31AD00C7, + 0x1D90, 0x31AE00C6, + 0x1D90, 0x31AF00C5, + 0x1D90, 0x31B000C4, + 0x1D90, 0x31B100C3, + 0x1D90, 0x31B20088, + 0x1D90, 0x31B30087, + 0x1D90, 0x31B40086, + 0x1D90, 0x31B50085, + 0x1D90, 0x31B60026, + 0x1D90, 0x31B70025, + 0x1D90, 0x31B80024, + 0x1D90, 0x31B90023, + 0x1D90, 0x31BA0022, + 0x1D90, 0x31BB0021, + 0x1D90, 0x31BC0020, + 0x1D90, 0x31BD0003, + 0x1D90, 0x31BE0002, + 0x1D90, 0x31BF0001, + 0xA0000000, 0x00000000, + 0x1D90, 0x318001FE, + 0x1D90, 0x318101FD, + 0x1D90, 0x318201FC, + 0x1D90, 0x318301FB, + 0x1D90, 0x318401FA, + 0x1D90, 0x318501F9, + 0x1D90, 0x318601F8, + 0x1D90, 0x318701F7, + 0x1D90, 0x318801F6, + 0x1D90, 0x318901F5, + 0x1D90, 0x318A01F4, + 0x1D90, 0x318B01F3, + 0x1D90, 0x318C01F2, + 0x1D90, 0x318D01F1, + 0x1D90, 0x318E01F0, + 0x1D90, 0x318F01EF, + 0x1D90, 0x319001EE, + 0x1D90, 0x319101ED, + 0x1D90, 0x319201EC, + 0x1D90, 0x319301EB, + 0x1D90, 0x319401EA, + 0x1D90, 0x319501E9, + 0x1D90, 0x319601E7, + 0x1D90, 0x319701E6, + 0x1D90, 0x319801E5, + 0x1D90, 0x319901E4, + 0x1D90, 0x319A01A8, + 0x1D90, 0x319B01A7, + 0x1D90, 0x319C01A6, + 0x1D90, 0x319D01A5, + 0x1D90, 0x319E0185, + 0x1D90, 0x319F0184, + 0x1D90, 0x31A00183, + 0x1D90, 0x31A10182, + 0x1D90, 0x31A20149, + 0x1D90, 0x31A30148, + 0x1D90, 0x31A40147, + 0x1D90, 0x31A50145, + 0x1D90, 0x31A60144, + 0x1D90, 0x31A70143, + 0x1D90, 0x31A80142, + 0x1D90, 0x31A900E6, + 0x1D90, 0x31AA00E5, + 0x1D90, 0x31AB00C9, + 0x1D90, 0x31AC00C8, + 0x1D90, 0x31AD00C7, + 0x1D90, 0x31AE00C6, + 0x1D90, 0x31AF00C5, + 0x1D90, 0x31B000C4, + 0x1D90, 0x31B100C3, + 0x1D90, 0x31B20088, + 0x1D90, 0x31B30087, + 0x1D90, 0x31B40086, + 0x1D90, 0x31B50085, + 0x1D90, 0x31B60026, + 0x1D90, 0x31B70025, + 0x1D90, 0x31B80024, + 0x1D90, 0x31B90023, + 0x1D90, 0x31BA0022, + 0x1D90, 0x31BB0021, + 0x1D90, 0x31BC0020, + 0x1D90, 0x31BD0003, + 0x1D90, 0x31BE0002, + 0x1D90, 0x31BF0001, + 0xB0000000, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1D70, 0x22222222, + 0x1D70, 0x20202020, + 0x90000015, 0x00000000, 0x40000000, 0x00000000, + 0x1D70, 0x22222222, + 0x1D70, 0x20202020, + 0x90000016, 0x00000000, 0x40000000, 0x00000000, + 0x1D70, 0x22222222, + 0x1D70, 0x20202020, + 0xA0000000, 0x00000000, + 0x1D70, 0x22222222, + 0x1D70, 0x20202020, + 0xB0000000, 0x00000000, +}; + +RTW_DECL_TABLE_PHY_COND(rtw8822c_agc, rtw_phy_cfg_agc); + +static const u32 rtw8822c_bb[] = { + 0x1D0C, 0x00410000, + 0x1C3C, 0x01038040, + 0x1C90, 0x00E49708, + 0x800, 0x00000000, + 0x804, 0xD6300000, + 0x808, 0x60956093, + 0x80C, 0x00000025, + 0x810, 0x11B019B0, + 0x814, 0x00904080, + 0x818, 0xC30056F1, + 0x81C, 0x00050000, + 0x820, 0x11111111, + 0x824, 0xC3C3CCC4, + 0x828, 0x30FB186C, + 0x82C, 0x185D6556, + 0x830, 0x1751145B, + 0x834, 0x776995D7, + 0x838, 0x74777A7D, + 0x83C, 0xF9AA9982, + 0x840, 0x89AA9ABB, + 0x844, 0x0DEEDDC1, + 0x848, 0xCDEEDEFF, + 0x84C, 0xFFFF5555, + 0x850, 0x6F7A727D, + 0x854, 0x6C776F7A, + 0x858, 0x6F7A6C77, + 0x85C, 0x69746974, + 0x860, 0x6F7A6C77, + 0x864, 0x6C776C77, + 0x868, 0x727D6F7A, + 0x86C, 0x69D7B196, + 0x870, 0x1A6D769B, + 0x874, 0x55823917, + 0x878, 0x00C025BD, + 0x87C, 0x4140557D, + 0x880, 0x9A1D9D47, + 0x884, 0x1DE7134F, + 0x888, 0x2857A857, + 0x88C, 0x520E8A24, + 0x890, 0x8F628C44, + 0x894, 0x72745F43, + 0x898, 0x03F02F0D, + 0x89C, 0x5DB6886F, + 0x8A0, 0x07DC309F, + 0x8A4, 0x09412495, + 0x8A8, 0x222222A9, + 0x8AC, 0x89628C44, + 0x8B0, 0x72745F43, + 0x8B4, 0x03F02F0D, + 0x8B8, 0x55B6886F, + 0x8BC, 0x07D0309F, + 0x8C0, 0x70404023, + 0x8C4, 0x00440001, + 0x8C8, 0x7A7A2E26, + 0x8CC, 0x25297777, + 0x8D0, 0x6CEB6DCE, + 0x8D4, 0x0005A632, + 0x8D8, 0x00000000, + 0x8DC, 0x00000000, + 0x8E0, 0x00000000, + 0x8E4, 0x00000000, + 0x8E8, 0x00000000, + 0x8EC, 0x00000000, + 0x8F0, 0x00000000, + 0x8F4, 0x00000000, + 0x8F8, 0x25239843, + 0x900, 0x00000000, + 0x904, 0x00000000, + 0x908, 0x000008CB, + 0x90C, 0x00000000, + 0x910, 0x00000000, + 0x914, 0x20000000, + 0x918, 0x20000000, + 0x91C, 0x20000000, + 0x920, 0x20000000, + 0x924, 0x00000000, + 0x928, 0x0000003A, + 0x92C, 0x0000003A, + 0x930, 0x0000003A, + 0x934, 0x0000003A, + 0x938, 0x0000000F, + 0x93C, 0x00000000, + 0x940, 0x4E1F3E81, + 0x944, 0x4E1F3E81, + 0x948, 0x4E1F3E81, + 0x94C, 0x4E1F3E81, + 0x950, 0x03020100, + 0x954, 0x07060504, + 0x958, 0x0B0A0908, + 0x95C, 0x0F0E0D0C, + 0x960, 0x13121110, + 0x964, 0x17161514, + 0x968, 0x03020100, + 0x96C, 0x07060504, + 0x970, 0x0B0A0908, + 0x974, 0x0F0E0D0C, + 0x978, 0x13121110, + 0x97C, 0x17161514, + 0x980, 0x03020100, + 0x984, 0x07060504, + 0x988, 0x0B0A0908, + 0x98C, 0x0F0E0D0C, + 0x990, 0x13121110, + 0x994, 0x17161514, + 0x998, 0x03020100, + 0x99C, 0x07060504, + 0x9A0, 0x0B0A0908, + 0x9A4, 0x0F0E0D0C, + 0x9A8, 0x13121110, + 0x9AC, 0x17161514, + 0x9B0, 0x00002200, + 0x9B4, 0xDB6FFF00, + 0x9B8, 0x00400064, + 0x9BC, 0x00000000, + 0x9C0, 0x01010101, + 0x9C4, 0x00640064, + 0x9C8, 0x00640064, + 0x9CC, 0x00007777, + 0x9D0, 0x00000000, + 0x9D4, 0x00000000, + 0x9D8, 0x00000000, + 0x9DC, 0x00000000, + 0x9E0, 0x00000000, + 0x9E4, 0x00000000, + 0x9E8, 0x00000000, + 0x9EC, 0x00000000, + 0x9F0, 0x100024E0, + 0x9F4, 0x00000000, + 0x9F8, 0x00000000, + 0xA00, 0x02001208, + 0xA04, 0x00000000, + 0xA08, 0x00000000, + 0xA0C, 0x00000000, + 0xA10, 0x00000000, + 0xA14, 0x00000000, + 0xA18, 0x00000000, + 0xA1C, 0x00000000, + 0xA20, 0xCB31B333, + 0xA24, 0x00275485, + 0xA28, 0x00166366, + 0xA2C, 0x00275485, + 0xA30, 0x00166366, + 0xA34, 0x00275485, + 0xA38, 0x00200400, + 0xA3C, 0x00200400, + 0xA40, 0xB35DC5BD, + 0xA44, 0x3033BEBD, + 0xA48, 0x2A521254, + 0xA4C, 0xA2733345, + 0xA50, 0x617BE003, + 0xA54, 0x50000968, + 0xA58, 0x00020000, + 0xA5C, 0x01000000, + 0xA60, 0x02000000, + 0xA64, 0x03000000, + 0xA68, 0x00020000, + 0xA6C, 0x00000000, + 0xA70, 0x00000000, + 0xA74, 0x00000000, + 0xA78, 0x00000000, + 0xA7C, 0x00000000, + 0xA80, 0x00000000, + 0xA84, 0x00000000, + 0xA88, 0x00000000, + 0xA8C, 0x00000000, + 0xA90, 0x00000000, + 0xA94, 0x00000000, + 0xA98, 0x00000000, + 0xA9C, 0x00000000, + 0xAA0, 0x00000000, + 0xAA4, 0x00000000, + 0xAA8, 0x00000000, + 0xAAC, 0x00000000, + 0xAB0, 0x00000000, + 0xAB4, 0x00000000, + 0xAB8, 0x00000000, + 0xABC, 0x00000000, + 0xAC0, 0x00000000, + 0xAC4, 0x00000000, + 0xAC8, 0x00000000, + 0xACC, 0x00000000, + 0xAD0, 0x00000000, + 0xAD4, 0x00000000, + 0xAD8, 0x00000000, + 0xADC, 0x00000000, + 0xAE0, 0x00000000, + 0xAE4, 0x00000000, + 0xAE8, 0x00000000, + 0xAEC, 0x00000000, + 0xAF0, 0x00000000, + 0xAF4, 0x00000000, + 0xAF8, 0x00000000, + 0xB00, 0x00000000, + 0xB04, 0x00000000, + 0xB08, 0x00000000, + 0xB0C, 0x00000000, + 0xB10, 0x00000000, + 0xB14, 0x00000000, + 0xB18, 0x00000000, + 0xB1C, 0x00000000, + 0xB20, 0x00000000, + 0xB24, 0x00000000, + 0xB28, 0x00000000, + 0xB2C, 0x00000000, + 0xB30, 0x00000000, + 0xB34, 0x00000000, + 0xB38, 0x00000000, + 0xB3C, 0x00000000, + 0xB40, 0x00000000, + 0xB44, 0x00000000, + 0xB48, 0x00000000, + 0xB4C, 0x00000000, + 0xB50, 0x00000000, + 0xB54, 0x00000000, + 0xB58, 0x00060100, + 0xB5C, 0x00000000, + 0xB60, 0x00000000, + 0xB64, 0x00000000, + 0xB68, 0x00000000, + 0xB6C, 0x00000000, + 0xB70, 0x00000000, + 0xB74, 0x00000000, + 0xB78, 0x00000000, + 0xB7C, 0x00000000, + 0xB80, 0x00000000, + 0xB84, 0x00000000, + 0xB88, 0x00000000, + 0xB8C, 0x00000000, + 0xB90, 0x00000000, + 0xB94, 0x00000000, + 0xB98, 0x00000000, + 0xB9C, 0x00000000, + 0xBA0, 0x00000000, + 0xBA4, 0x00000000, + 0xBA8, 0x00000000, + 0xBAC, 0x00000000, + 0xBB0, 0x00000000, + 0xBB4, 0x00000000, + 0xBB8, 0x00000000, + 0xBBC, 0x00000000, + 0xBC0, 0x00000000, + 0xBC4, 0x00000000, + 0xBC8, 0x00000000, + 0xBCC, 0x00000000, + 0xBD0, 0x00000000, + 0xBD4, 0x00000000, + 0xBD8, 0x00000000, + 0xBDC, 0x00000000, + 0xBE0, 0x00000000, + 0xBE4, 0x00000000, + 0xBE8, 0x00000000, + 0xBEC, 0x00000000, + 0xBF0, 0x00000000, + 0xBF4, 0x00000000, + 0xBF8, 0x00000000, + 0xC00, 0x0C8BA0D6, + 0xC04, 0x00000001, + 0xC08, 0x00000000, + 0xC0C, 0x02F1D8B7, + 0xC10, 0x000000B0, + 0xC14, 0x0000D891, + 0xC18, 0x00087672, + 0xC1C, 0x15260000, + 0xC20, 0x00000000, + 0xC24, 0x406000FF, + 0xC28, 0x06400F76, + 0xC2C, 0xE30020E1, + 0xC30, 0x140C9494, + 0xC34, 0x00A04946, + 0xC38, 0x011D4820, + 0xC3C, 0x168DB61B, + 0xC40, 0x009C50F8, + 0xC44, 0x2013BAD1, + 0xC48, 0xFFFFF7CC, + 0xC4C, 0xA000FFFF, + 0xC50, 0x20D0F800, + 0xC54, 0x941A0200, + 0xC58, 0x18380111, + 0xC5C, 0x006E01B8, + 0xC60, 0x2CA5555B, + 0xC64, 0x0210005F, + 0xC68, 0x039A5300, + 0xC6C, 0x0265C2BA, + 0xC70, 0x000CEB21, + 0xC74, 0x0E149CA1, + 0xC78, 0x1AB4956B, + 0xC7C, 0x00000ABF, + 0xC80, 0xC02A8799, + 0xC84, 0x06C636C6, + 0xC88, 0x08090202, + 0xC8C, 0x00204048, + 0xC90, 0x00F85F85, + 0xC94, 0x00000F85, + 0xC98, 0x58385858, + 0xC9C, 0x18382838, + 0xCA0, 0x00002838, + 0xCA4, 0x3A253A3A, + 0xCA8, 0x10251A25, + 0xCAC, 0x00001025, + 0xCB0, 0x3A133A3A, + 0xCB4, 0x08130D13, + 0xCB8, 0x00000813, + 0xCBC, 0x001F1066, + 0xCC0, 0x88A00400, + 0xCC4, 0x00200400, + 0xCC8, 0x0B200400, + 0xCCC, 0x00600400, + 0xCD0, 0x22220092, + 0xCD4, 0x22220707, + 0xCD8, 0x22222222, + 0xCDC, 0x22222222, + 0xCE0, 0x22222222, + 0xCE4, 0x22222222, + 0xCE8, 0x00002222, + 0xCEC, 0x00000000, + 0xCF0, 0x00000000, + 0xCF4, 0x00000000, + 0xCF8, 0x00000000, + 0xD00, 0x1083A10A, + 0xD04, 0x0EC42948, + 0xD08, 0x10852108, + 0xD0C, 0x0CC41D08, + 0xD10, 0x108620EC, + 0xD14, 0x0CA42108, + 0xD18, 0x107620E8, + 0xD1C, 0x0E742108, + 0xD20, 0x0E8618C8, + 0xD24, 0x00000108, + 0xD28, 0x288C224C, + 0xD2C, 0x11C6320C, + 0xD30, 0x30CEBD98, + 0xD34, 0x10C31908, + 0xD38, 0x310A318C, + 0xD3C, 0x18C41D08, + 0xD40, 0x28CC4190, + 0xD44, 0x19062108, + 0xD48, 0x294A5A17, + 0xD4C, 0x00000108, + 0xD50, 0x10A3A908, + 0xD54, 0x10842148, + 0xD58, 0x14C5314A, + 0xD5C, 0x1086258C, + 0xD60, 0x10A42948, + 0xD64, 0x10842108, + 0xD68, 0x08C42108, + 0xD6C, 0x10842148, + 0xD70, 0x08822084, + 0xD74, 0x10841D04, + 0xD78, 0x08421088, + 0xD7C, 0x1083A104, + 0xD80, 0x10842108, + 0xD84, 0x1085294A, + 0xD88, 0x08822104, + 0xD8C, 0x10852948, + 0xD90, 0x08421084, + 0xD94, 0x10852104, + 0xD98, 0x08421084, + 0xD9C, 0x10863184, + 0xDA0, 0x1083B10A, + 0xDA4, 0x10842148, + 0xDA8, 0x1984718C, + 0xDAC, 0x108C33AF, + 0xDB0, 0x00000000, + 0xDB4, 0x00000000, + 0xDB8, 0x00000000, + 0xDBC, 0x00000000, + 0xDC0, 0x00000000, + 0xDC4, 0x00000000, + 0xDC8, 0x00000000, + 0xDCC, 0x00000000, + 0xDD0, 0x00000000, + 0xDD4, 0x00000000, + 0xDD8, 0x00000000, + 0xDDC, 0x00000000, + 0xDE0, 0x00000000, + 0xDE4, 0x00000000, + 0xDE8, 0x00000000, + 0xDEC, 0x00000000, + 0xDF0, 0x00000000, + 0xDF4, 0x00000000, + 0xDF8, 0x00000000, + 0x1800, 0x00033312, + 0x1804, 0x00033312, + 0x180C, 0x17F40060, + 0x1810, 0x62F508C4, + 0x1814, 0x506AA5B4, + 0x1818, 0x000014FF, + 0x181C, 0x00000000, + 0x1820, 0x02D508CC, + 0x1824, 0x506AA5B4, + 0x1828, 0x000004FD, + 0x182C, 0x00000000, + 0x1834, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1838, 0x20000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x1838, 0x20100000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x1838, 0x20100000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x1838, 0x20100000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x1838, 0x20100000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x1838, 0x20100000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x1838, 0x20100000, + 0xA0000000, 0x00000000, + 0x1838, 0x20000000, + 0xB0000000, 0x00000000, + 0x183C, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1840, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x1840, 0x00002300, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x1840, 0x00002300, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x1840, 0x00002300, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x1840, 0x00002300, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x1840, 0x00002300, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x1840, 0x00002300, + 0xA0000000, 0x00000000, + 0x1840, 0x00000000, + 0xB0000000, 0x00000000, + 0x1844, 0x00000000, + 0x1848, 0x00000000, + 0x184C, 0x00000000, + 0x1850, 0x00000000, + 0x1854, 0x00000000, + 0x1858, 0x00000000, + 0x185C, 0x00000000, + 0x1860, 0xF0040FF8, + 0x1864, 0x7F000000, + 0x1868, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x186C, 0x0000FF00, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x186C, 0x0000FF02, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x186C, 0x0000FF02, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x186C, 0x0000FF02, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x186C, 0x0000FF02, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x186C, 0x0000FF02, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x186C, 0x0000FF02, + 0xA0000000, 0x00000000, + 0x186C, 0x0000FF00, + 0xB0000000, 0x00000000, + 0x1870, 0x00000000, + 0x1874, 0x00000000, + 0x1878, 0x00000000, + 0x187C, 0x00000000, + 0x1880, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1884, 0x02B00000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x1884, 0x03B00000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x1884, 0x03B00000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x1884, 0x03B00000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x1884, 0x03B00000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x1884, 0x03B00000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x1884, 0x03B00000, + 0xA0000000, 0x00000000, + 0x1884, 0x02B00000, + 0xB0000000, 0x00000000, + 0x1888, 0x00000000, + 0x188C, 0x00000000, + 0x1890, 0x00000000, + 0x1894, 0x00000000, + 0x1898, 0x00000000, + 0x18A0, 0x00510000, + 0x18A4, 0x183C1F7F, + 0x18A8, 0x0A02C99A, + 0x18AC, 0x00004200, + 0x18B0, 0x0809FB08, + 0x18B0, 0x0809FB09, + 0x18B4, 0x00000000, + 0x18B8, 0x00000000, + 0x18BC, 0x00C3FF80, + 0x18C0, 0x0002D100, + 0x18C4, 0x00000004, + 0x18C8, 0x001FFFE0, + 0x18CC, 0x0809FB08, + 0x18CC, 0x0809FB09, + 0x18D0, 0x00000000, + 0x18D4, 0x00000000, + 0x18D8, 0x00C3FF80, + 0x18DC, 0x0002D100, + 0x18E0, 0x00000004, + 0x18E4, 0x001FFFE0, + 0x18E8, 0x00800000, + 0x18EC, 0x1EC08000, + 0x18F0, 0x7F000064, + 0x18F4, 0x1F7DE75C, + 0x18F8, 0x7F7F7F7F, + 0x18FC, 0x7F7F7F7F, + 0x1900, 0xA7A7A7A7, + 0x1904, 0x95959595, + 0x1908, 0x00777788, + 0x190C, 0x77776666, + 0x1910, 0x00033333, + 0x1914, 0xAAAC875A, + 0x1918, 0x2AA2A8A2, + 0x191C, 0x2AAAA8A2, + 0x1920, 0x00878766, + 0x1924, 0x000C4924, + 0x1928, 0x5669B6C0, + 0x192C, 0x00409190, + 0x1930, 0xB85C0492, + 0x1934, 0x00B4A298, + 0x1938, 0x00030151, + 0x193C, 0x0058C618, + 0x1940, 0x41000000, + 0x1944, 0x00000BCB, + 0x1948, 0xAAAAAAAA, + 0x194C, 0x00B99999, + 0x1950, 0x88886665, + 0x1954, 0x08888888, + 0x1958, 0x00000618, + 0x195C, 0x00000000, + 0x1960, 0x00000000, + 0x1964, 0x00000000, + 0x1968, 0x00000000, + 0x196C, 0x00000000, + 0x1970, 0x00000000, + 0x1974, 0x00000000, + 0x1978, 0x00000000, + 0x197C, 0x00000000, + 0x1980, 0x00000000, + 0x1984, 0x00000000, + 0x1988, 0x00000000, + 0x198C, 0x00000000, + 0x1990, 0x00000000, + 0x1994, 0x00000000, + 0x1998, 0x00000000, + 0x199C, 0x00000000, + 0x19A0, 0x00000000, + 0x19A4, 0x00000000, + 0x19A8, 0x00000000, + 0x19AC, 0x00000000, + 0x19B0, 0x00000000, + 0x19B4, 0x00000000, + 0x19B8, 0x00000000, + 0x19BC, 0x00000000, + 0x19C0, 0x00000000, + 0x19C4, 0x00000000, + 0x19C8, 0x00000000, + 0x19CC, 0x00000000, + 0x19D0, 0x00000000, + 0x19D4, 0x00000000, + 0x19D8, 0x00000000, + 0x19DC, 0x00000000, + 0x19E0, 0x00000000, + 0x19E4, 0x00000000, + 0x19E8, 0x00000000, + 0x19EC, 0x00000000, + 0x19F0, 0x00000000, + 0x19F4, 0x00000000, + 0x19F8, 0x00000000, + 0x1C00, 0x00000000, + 0x1C04, 0x00000000, + 0x1C08, 0x00000000, + 0x1C0C, 0x00000000, + 0x1C10, 0x00000000, + 0x1C14, 0x00000000, + 0x1C18, 0x00000000, + 0x1C1C, 0x00000000, + 0x1C20, 0x03C23F00, + 0x1C24, 0xF101F002, + 0x1C28, 0x0FFE0010, + 0x1C2C, 0x453090FF, + 0x1C30, 0xFE0090FE, + 0x1C34, 0xE4E42000, + 0x1C38, 0xFFA1005E, + 0x1C40, 0x8F588837, + 0x1C44, 0x04400700, + 0x1C48, 0x00000000, + 0x1C4C, 0x00000200, + 0x1C50, 0x8E588837, + 0x1C54, 0x04400300, + 0x1C58, 0x00000000, + 0x1C5C, 0xFFFFFFFF, + 0x1C60, 0x0F030032, + 0x1C64, 0x360F0008, + 0x1C68, 0x007F0000, + 0x1C6C, 0x00010000, + 0x1C70, 0x00037FFE, + 0x1C74, 0x00000000, + 0x1C78, 0x00020000, + 0x1C7C, 0x00310000, + 0x1C80, 0x0E38E000, + 0x1C84, 0x245120D4, + 0x1C88, 0xC8400483, + 0x1C8C, 0x40005A20, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x1C94, 0x00000000, + 0x1C98, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x1C94, 0x00000B0E, + 0x1C98, 0x00450000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x1C94, 0x00000B0E, + 0x1C98, 0x00450000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x1C94, 0x00000B0E, + 0x1C98, 0x00450000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x1C94, 0x00000B0E, + 0x1C98, 0x00450000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x1C94, 0x00000B0E, + 0x1C98, 0x00450000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x1C94, 0x00000B0E, + 0x1C98, 0x00450000, + 0xA0000000, 0x00000000, + 0x1C94, 0x00000000, + 0x1C98, 0x00000000, + 0xB0000000, 0x00000000, + 0x1C9C, 0x00000000, + 0x1CA0, 0x00000000, + 0x1CA4, 0x20000000, + 0x1CA8, 0x0E000000, + 0x1CAC, 0xE424A2CC, + 0x1CB0, 0x00000000, + 0x1CB4, 0x00000000, + 0x1CB8, 0x24800000, + 0x1CBC, 0x60004800, + 0x1CC0, 0x24800000, + 0x1CC4, 0x60004800, + 0x1CC8, 0xF0444900, + 0x1CCC, 0x030300F1, + 0x1CD0, 0x0F000000, + 0x1CD4, 0x02024B00, + 0x1CD8, 0x04000000, + 0x1CDC, 0x10000000, + 0x1CE0, 0x60000000, + 0x1CE4, 0x00000000, + 0x1CE8, 0xC0000000, + 0x1CEC, 0x00000000, + 0x1CF0, 0x00000000, + 0x1CF4, 0xE4000000, + 0x1CF8, 0x00000000, + 0x1D00, 0x00000000, + 0x1D04, 0x08A3C000, + 0x1D08, 0xA0000000, + 0x1D10, 0x08B5BBBB, + 0x1D14, 0x77777777, + 0x1D18, 0x99999999, + 0x1D1C, 0x99999999, + 0x1D20, 0x000081E0, + 0x1D24, 0x00000000, + 0x1D28, 0x00000000, + 0x1D2C, 0xC0000000, + 0x1D30, 0x50009C00, + 0x1D34, 0x00000000, + 0x1D38, 0x00000000, + 0x1D3C, 0xF8000000, + 0x1D40, 0x00000000, + 0x1D44, 0x74740000, + 0x1D48, 0x14147474, + 0x1D4C, 0x00FFFF14, + 0x1D50, 0x00000000, + 0x1D54, 0x03A00000, + 0x1D58, 0x80800000, + 0x1D5C, 0x00000000, + 0x1D60, 0x00000000, + 0x1D64, 0x88000000, + 0x1D68, 0x00000000, + 0x1D6C, 0x666D8001, + 0x1D70, 0x20202020, + 0x1D74, 0x4E4E4E4E, + 0x1D78, 0x18189818, + 0x1D7C, 0x0005A000, + 0x1D80, 0x00080000, + 0x1D84, 0x00080000, + 0x1D88, 0x000000EF, + 0x1D8C, 0x0C0C0C0C, + 0x1D90, 0x103F003F, + 0x1D94, 0x00000000, + 0x1D98, 0x00000000, + 0x1D9C, 0x00000000, + 0x1DA0, 0x00000000, + 0x1DA4, 0x00000000, + 0x1DA8, 0x00000000, + 0x1DAC, 0x00000000, + 0x1DB0, 0x00000000, + 0x1DB4, 0x00000000, + 0x1DB8, 0x00000000, + 0x1DBC, 0x00000000, + 0x1DC0, 0x00000000, + 0x1DC4, 0x00000000, + 0x1DC8, 0x00000000, + 0x1DCC, 0x00000000, + 0x1DD0, 0x00000000, + 0x1DD4, 0x00000000, + 0x1DD8, 0x00000000, + 0x1DDC, 0x1FDF0000, + 0x1DE0, 0x01010000, + 0x1DE4, 0x05210123, + 0x1DE8, 0xFFFF4848, + 0x1DEC, 0x00000000, + 0x1DF0, 0x00000000, + 0x1DF4, 0x80000002, + 0x1DF8, 0x00000000, + 0x1E00, 0x00000000, + 0x1E04, 0x00000000, + 0x1E08, 0x00000000, + 0x1E0C, 0x00000000, + 0x1E10, 0x00000000, + 0x1E14, 0x00000000, + 0x1E18, 0x00000000, + 0x1E1C, 0x00000000, + 0x1E20, 0x00000000, + 0x1E24, 0x80003000, + 0x1E28, 0x000CC0C3, + 0x1E2C, 0xE4E40000, + 0x1E30, 0xE4E4E4E4, + 0x1E34, 0xF3001234, + 0x1E38, 0x00000000, + 0x1E3C, 0x00000000, + 0x1E40, 0x00000000, + 0x1E44, 0x00000000, + 0x1E48, 0x00000000, + 0x1E4C, 0x00000000, + 0x1E50, 0x00000000, + 0x1E54, 0x00000000, + 0x1E58, 0x00000000, + 0x1E5C, 0xC1000000, + 0x1E60, 0x00000000, + 0x1E64, 0xF3A00001, + 0x1E68, 0x0028846E, + 0x1E6C, 0x40274906, + 0x1E70, 0x00001000, + 0x1E74, 0x00000000, + 0x1E78, 0x00000000, + 0x1E7C, 0x00000000, + 0x1E80, 0x00000000, + 0x1E84, 0x00000000, + 0x1E84, 0x40000000, + 0x1E84, 0x41000000, + 0x1E84, 0x42000000, + 0x1E84, 0x43000000, + 0x1E84, 0x44000000, + 0x1E84, 0x45000000, + 0x1E84, 0x46000000, + 0x1E84, 0x47000000, + 0x1E84, 0x48000000, + 0x1E84, 0x49000000, + 0x1E84, 0x4A000000, + 0x1E84, 0x4B000000, + 0x1E84, 0x4C000000, + 0x1E84, 0x4D000000, + 0x1E84, 0x4E000000, + 0x1E84, 0x4F000000, + 0x1E84, 0x50000000, + 0x1E84, 0x51000000, + 0x1E84, 0x52000000, + 0x1E84, 0x53000000, + 0x1E84, 0x54000000, + 0x1E84, 0x55000000, + 0x1E84, 0x56000000, + 0x1E84, 0x57000000, + 0x1E84, 0x58000000, + 0x1E84, 0x59000000, + 0x1E84, 0x5A000000, + 0x1E84, 0x5B000000, + 0x1E84, 0x5C000000, + 0x1E84, 0x5D000000, + 0x1E84, 0x5E000000, + 0x1E84, 0x5F000000, + 0x1E84, 0x60000000, + 0x1E84, 0x61000000, + 0x1E84, 0x62000000, + 0x1E84, 0x63000000, + 0x1E84, 0x64000000, + 0x1E84, 0x65000000, + 0x1E84, 0x66000000, + 0x1E84, 0x67000000, + 0x1E84, 0x68000000, + 0x1E84, 0x69000000, + 0x1E84, 0x6A000000, + 0x1E84, 0x6B000000, + 0x1E84, 0x6C000000, + 0x1E84, 0x6D000000, + 0x1E84, 0x6E000000, + 0x1E84, 0x6F000000, + 0x1E84, 0x70000000, + 0x1E84, 0x71000000, + 0x1E84, 0x72000000, + 0x1E84, 0x73000000, + 0x1E84, 0x74000000, + 0x1E84, 0x75000000, + 0x1E84, 0x76000000, + 0x1E84, 0x77000000, + 0x1E84, 0x78000000, + 0x1E84, 0x79000000, + 0x1E84, 0x7A000000, + 0x1E84, 0x7B000000, + 0x1E84, 0x7C000000, + 0x1E84, 0x7D000000, + 0x1E84, 0x7E000000, + 0x1E84, 0x7F000000, + 0x1E84, 0x80000000, + 0x1E84, 0x00000000, + 0x1E88, 0x0200FC1C, + 0x1E8C, 0x00000000, + 0x1E90, 0x00000000, + 0x1E94, 0x04000000, + 0x1E98, 0x00000000, + 0x1E9C, 0x00000000, + 0x1EA0, 0x00000000, + 0x1EA4, 0x00000000, + 0x1EA8, 0xAA464646, + 0x1EAC, 0x01800030, + 0x1EB0, 0x00003002, + 0x1EB4, 0x31800002, + 0x1EB8, 0x00000000, + 0x1EBC, 0x00000000, + 0x1EC0, 0x00000000, + 0x1EC4, 0x00000000, + 0x1EC8, 0x00000000, + 0x1ECC, 0x00000000, + 0x1ED0, 0x00000000, + 0x1ED4, 0x8000000A, + 0x1ED8, 0x800B03E8, + 0x1EDC, 0x83E90FFF, + 0x1EE0, 0x8000FFFF, + 0x1EE4, 0x70000000, + 0x1EE8, 0x00000000, + 0x1EEC, 0x0280A933, + 0x1EF0, 0x00000A80, + 0x1EF4, 0x00001266, + 0x1EF8, 0x01000100, + 0x3A00, 0x0004080C, + 0x3A04, 0x1C202428, + 0x3A08, 0x0C101418, + 0x3A0C, 0x181C2024, + 0x3A10, 0x080C1014, + 0x3A14, 0x181C2024, + 0x3A18, 0x080C1014, + 0x3A1C, 0x00000000, + 0x3A20, 0x00000000, + 0x3A24, 0x00000000, + 0x3A28, 0x00000000, + 0x3A2C, 0x181C2024, + 0x3A30, 0x080C1014, + 0x3A34, 0x20240004, + 0x3A38, 0x1014181C, + 0x3A3C, 0x0004080C, + 0x3A40, 0x00000000, + 0x3A44, 0x00000000, + 0x3A48, 0x00000000, + 0x3A4C, 0x00000000, + 0x3A50, 0x00000000, + 0x3A54, 0x00000000, + 0x3A58, 0x00000000, + 0x3A5C, 0x00000000, + 0x3A60, 0x00000000, + 0x3A64, 0x00000000, + 0x3A68, 0x00000000, + 0x3A6C, 0x00000000, + 0x3A70, 0x00000000, + 0x3A74, 0x00000000, + 0x3A78, 0x00000000, + 0x3A7C, 0x00000000, + 0x3A80, 0x00000000, + 0x3A84, 0x00000000, + 0x3A88, 0x00000000, + 0x3A8C, 0x00000000, + 0x3A90, 0x00000000, + 0x3A94, 0x00000000, + 0x3A98, 0x00000000, + 0x3A9C, 0x00000000, + 0x3AA0, 0x00000000, + 0x3AA4, 0x00000000, + 0x4000, 0xA6A6A6A6, + 0x4004, 0x95959595, + 0x4008, 0x00777777, + 0x400C, 0x77776666, + 0x4010, 0x00033333, + 0x4014, 0xAAAC875A, + 0x4018, 0x2AA2A8A2, + 0x401C, 0x2AAAA8A2, + 0x4020, 0x00878766, + 0x4024, 0x000C4924, + 0x4028, 0x5669B6C0, + 0x402C, 0x00409190, + 0x4030, 0xB85C0492, + 0x4034, 0x00B4A298, + 0x4038, 0x00030151, + 0x403C, 0x0058C618, + 0x4040, 0x41000000, + 0x4044, 0x00000BCB, + 0x4048, 0xAAAAAAAA, + 0x404C, 0x00B98989, + 0x4050, 0x88886665, + 0x4054, 0x08888888, + 0x4058, 0x00000618, + 0x405C, 0x00000000, + 0x4060, 0x00000000, + 0x4064, 0x00000000, + 0x4068, 0x00000000, + 0x406C, 0x00000000, + 0x4070, 0x00000000, + 0x4074, 0x00000000, + 0x4078, 0x00000000, + 0x407C, 0x00000000, + 0x4080, 0x00000000, + 0x4084, 0x00000000, + 0x4088, 0x00000000, + 0x408C, 0x00000000, + 0x4090, 0x00000000, + 0x4094, 0x00000000, + 0x4098, 0x00000000, + 0x409C, 0x00000000, + 0x40A0, 0x00000000, + 0x40A4, 0x00000000, + 0x40A8, 0x00000000, + 0x40AC, 0x00000000, + 0x40B0, 0x00000000, + 0x40B4, 0x00000000, + 0x40B8, 0x00000000, + 0x40BC, 0x00000000, + 0x40C0, 0x00000000, + 0x40C4, 0x00000000, + 0x40C8, 0x00000000, + 0x40CC, 0x00000000, + 0x40D0, 0x00000000, + 0x40D4, 0x00000000, + 0x40D8, 0x00000000, + 0x40DC, 0x00000000, + 0x40E0, 0x00000000, + 0x40E4, 0x00000000, + 0x40E8, 0x00000000, + 0x40EC, 0x00000000, + 0x40F0, 0x00000000, + 0x40F4, 0x00000000, + 0x40F8, 0x00000000, + 0x4100, 0x00033312, + 0x4104, 0x00033312, + 0x410C, 0x17F40060, + 0x4110, 0x62D508C4, + 0x4114, 0x506AA5B4, + 0x4118, 0x000014FF, + 0x411C, 0x00000000, + 0x4120, 0x02D508CC, + 0x4124, 0x506AA5B4, + 0x4128, 0x000004FD, + 0x412C, 0x00000000, + 0x4134, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x4138, 0x20000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x4138, 0x20100000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x4138, 0x20100000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x4138, 0x20100000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x4138, 0x20100000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x4138, 0x20100000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x4138, 0x20100000, + 0xA0000000, 0x00000000, + 0x4138, 0x20000000, + 0xB0000000, 0x00000000, + 0x413C, 0x00000000, + 0x4140, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x4144, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x4144, 0x00002030, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x4144, 0x00002030, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x4144, 0x00002030, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x4144, 0x00002030, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x4144, 0x00002030, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x4144, 0x00002030, + 0xA0000000, 0x00000000, + 0x4144, 0x00000000, + 0xB0000000, 0x00000000, + 0x4148, 0x00000000, + 0x414C, 0x00000000, + 0x4150, 0x00000000, + 0x4154, 0x00000000, + 0x4158, 0x00000000, + 0x415C, 0x00000000, + 0x4160, 0xF0040FF8, + 0x4164, 0x7F000000, + 0x4168, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x416C, 0x00008000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x416C, 0x00008002, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x416C, 0x00008002, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x416C, 0x00008002, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x416C, 0x00008002, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x416C, 0x00008002, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x416C, 0x00008002, + 0xA0000000, 0x00000000, + 0x416C, 0x00008000, + 0xB0000000, 0x00000000, + 0x4170, 0x00000000, + 0x4174, 0x00000000, + 0x4178, 0x00000000, + 0x417C, 0x00000000, + 0x4180, 0x00000000, + 0x83000000, 0x00000000, 0x40000000, 0x00000000, + 0x4184, 0x02B00000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x4184, 0x03B00000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x4184, 0x03B00000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x4184, 0x03B00000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x4184, 0x03B00000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x4184, 0x03B00000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x4184, 0x03B00000, + 0xA0000000, 0x00000000, + 0x4184, 0x02B00000, + 0xB0000000, 0x00000000, + 0x4188, 0x00000000, + 0x418C, 0x00000000, + 0x4190, 0x00000000, + 0x4194, 0x00000000, + 0x4198, 0x00000000, + 0x41A0, 0x00510000, + 0x41A4, 0x183C1F7F, + 0x41A8, 0x1402C99A, + 0x41AC, 0x00004200, + 0x41B0, 0x0809FB08, + 0x41B0, 0x0809FB09, + 0x41B4, 0x00000000, + 0x41B8, 0x00000000, + 0x41BC, 0x00C3FF80, + 0x41C0, 0x0002D100, + 0x41C4, 0x00000004, + 0x41C8, 0x001FFFE0, + 0x41CC, 0x0809FB08, + 0x41CC, 0x0809FB09, + 0x41D0, 0x00000000, + 0x41D4, 0x00000000, + 0x41D8, 0x00C3FF80, + 0x41DC, 0x0002D100, + 0x41E0, 0x00000004, + 0x41E4, 0x001FFFE0, + 0x41E8, 0x00000200, + 0x41EC, 0x1E008000, + 0x41F0, 0x7F000064, + 0x41F4, 0x1F7DE75C, + 0x41F8, 0x7F7F7F7F, + 0x41FC, 0x7F7F7F7F, + 0x1830, 0x700B8001, + 0x1830, 0x700B8001, + 0x1830, 0x70144001, + 0x1830, 0x70244001, + 0x1830, 0x70344001, + 0x1830, 0x70444001, + 0x1830, 0x705B8001, + 0x1830, 0x70644001, + 0x1830, 0x707B8001, + 0x1830, 0x708B8001, + 0x1830, 0x709B8001, + 0x1830, 0x70AB8001, + 0x1830, 0x70BB8001, + 0x1830, 0x70CB8001, + 0x1830, 0x70DB8001, + 0x1830, 0x70EB8001, + 0x1830, 0x70FB8001, + 0x1830, 0x70FB8001, + 0x4130, 0x700B8001, + 0x4130, 0x700B8001, + 0x4130, 0x70144001, + 0x4130, 0x70244001, + 0x4130, 0x70344001, + 0x4130, 0x70444001, + 0x4130, 0x705B8001, + 0x4130, 0x70644001, + 0x4130, 0x707B8001, + 0x4130, 0x708B8001, + 0x4130, 0x709B8001, + 0x4130, 0x70AB8001, + 0x4130, 0x70BB8001, + 0x4130, 0x70CB8001, + 0x4130, 0x70DB8001, + 0x4130, 0x70EB8001, + 0x4130, 0x70FB8001, + 0x4130, 0x70FB8001, + 0x1A00, 0x00D047C8, + 0x1A04, 0xC0000008, + 0x1A08, 0x88838300, + 0x1A0C, 0x2E20100F, + 0x1A10, 0x9500BB78, + 0x1A14, 0x111440A8, + 0x1A18, 0x00881117, + 0x1A1C, 0x89140F00, + 0x1A20, 0x52840000, + 0x1A24, 0x3E18FEC8, + 0x1A28, 0x00150A88, + 0x1A2C, 0x12988000, + 0x1A30, 0x10114007, + 0x1A34, 0x1011C007, + 0x1A38, 0x00000000, + 0x1A3C, 0x00000000, + 0x1A40, 0x00000000, + 0x1A44, 0x00000000, + 0x1A48, 0x000C0000, + 0x1A4C, 0xB00000C0, + 0x1A50, 0x22040700, + 0x1A54, 0x09003000, + 0x1A58, 0x00000881, + 0x1A5C, 0x00000128, + 0x1A60, 0x85830000, + 0x1A64, 0x00000128, + 0x1A68, 0x00222211, + 0x1A6C, 0x00000000, + 0x1A70, 0x00008000, + 0x1A74, 0x00000048, + 0x1A78, 0x000089F0, + 0x1A7C, 0x225B0606, + 0x1A80, 0x208A7532, + 0x1A84, 0x85200200, + 0x1A88, 0x048C0000, + 0x1A8C, 0x00000000, + 0x1A90, 0x00000000, + 0x1A94, 0x00000000, + 0x1A98, 0xACC4C040, + 0x1A9C, 0x0016C8B2, + 0x1AA0, 0x00FAF0DE, + 0x1AA4, 0x00020000, + 0x1AA8, 0xBA0F0004, + 0x1AAC, 0x00122344, + 0x1AB0, 0x0FFFFFFF, + 0x1AB4, 0x0F201402, + 0x1AB8, 0x00000000, + 0x1ABC, 0xC2008080, + 0x1AC0, 0x54D0A742, + 0x1AC4, 0x00000000, + 0x1AC8, 0x00000807, + 0x1ACC, 0x00000707, + 0x1AD0, 0xA33529CE, + 0x1AD4, 0x0D8D8452, + 0x1AD8, 0x08024024, + 0x1ADC, 0x000D0001, + 0x1AE0, 0x00600391, + 0x1AE4, 0x08000080, + 0x1AE8, 0xC2100002, + 0x1AEC, 0x000000F6, + 0x1AF0, 0x00000000, + 0x1AF4, 0x00000000, + 0x1AF8, 0x00000000, + 0x1AFC, 0x00000000, + 0x1D0C, 0x00400000, + 0x1D0C, 0x00410000, + 0x1EE8, 0x00000003, + 0xC0C, 0x02F1D8BF, + 0x1D94, 0x40000000, + 0x1D94, 0x40010000, + 0x1D94, 0x40020000, + 0x1D94, 0x40030000, + 0x1D94, 0x40040000, + 0x1D94, 0x40050000, + 0x1D94, 0x40060000, + 0x1D94, 0x40070000, + 0x1D94, 0x40080000, + 0x1D94, 0x40090000, + 0x1D94, 0x400A0000, + 0x1D94, 0x400B0000, + 0x1D94, 0x400C0000, + 0x1D94, 0x400D0000, + 0x1D94, 0x400E0000, + 0x1D94, 0x400F0000, + 0x1D94, 0x40100000, + 0x1D94, 0x40110000, + 0x1D94, 0x40120000, + 0x1D94, 0x40130000, + 0x1D94, 0x40140000, + 0x1D94, 0x40150000, + 0x1D94, 0x40160000, + 0x1D94, 0x40170000, + 0x1D94, 0x40180000, + 0x1D94, 0x40190000, + 0x1D94, 0x401A0000, + 0x1D94, 0x401B0000, + 0x1D94, 0x401C0000, + 0x1D94, 0x401D0000, + 0x1D94, 0x401E0000, + 0x1D94, 0x401F0000, + 0x1D94, 0x40200000, + 0x1D94, 0x40210000, + 0x1D94, 0x40220000, + 0x1D94, 0x40230000, + 0x1D94, 0x40240000, + 0x1D94, 0x40250000, + 0x1D94, 0x40260000, + 0x1D94, 0x40270000, + 0x1D94, 0x40280000, + 0x1D94, 0x40290000, + 0x1D94, 0x402A0000, + 0x1D94, 0x402B0000, + 0x1D94, 0x402C0000, + 0x1D94, 0x402D0000, + 0x1D94, 0x402E0000, + 0x1D94, 0x402F0000, + 0x1D94, 0x40300000, + 0x1D94, 0x40310000, + 0x1D94, 0x40320000, + 0x1D94, 0x40330000, + 0x1D94, 0x40340000, + 0x1D94, 0x40350000, + 0x1D94, 0x40360000, + 0x1D94, 0x40370000, + 0x1D94, 0x40380000, + 0x1D94, 0x40390000, + 0x1D94, 0x403A0000, + 0x1D94, 0x403B0000, + 0x1D94, 0x403C0000, + 0x1D94, 0x403D0000, + 0x1D94, 0x403E0000, + 0x1D94, 0x403F0000, + 0x1D94, 0x40400000, + 0x1D94, 0x40410000, + 0x1D94, 0x40420000, + 0x1D94, 0x40430000, + 0x1D94, 0x40440000, + 0x1D94, 0x40450000, + 0x1D94, 0x40460000, + 0x1D94, 0x40470000, + 0x1D94, 0x40480000, + 0x1D94, 0x40490000, + 0x1D94, 0x404A0000, + 0x1D94, 0x404B0000, + 0x1D94, 0x404C0000, + 0x1D94, 0x404D0000, + 0x1D94, 0x404E0000, + 0x1D94, 0x404F0000, + 0x1D94, 0x40500000, + 0x1D94, 0x40510000, + 0x1D94, 0x40520000, + 0x1D94, 0x40530000, + 0x1D94, 0x40540000, + 0x1D94, 0x40550000, + 0x1D94, 0x40560000, + 0x1D94, 0x40570000, + 0x1D94, 0x40580000, + 0x1D94, 0x40590000, + 0x1D94, 0x405A0000, + 0x1D94, 0x405B0000, + 0x1D94, 0x405C0000, + 0x1D94, 0x405D0000, + 0x1D94, 0x405E0000, + 0x1D94, 0x405F0000, + 0x1D94, 0x40600000, + 0x1D94, 0x40610000, + 0x1D94, 0x40620000, + 0x1D94, 0x40630000, + 0x1D94, 0x40640000, + 0x1D94, 0x40650000, + 0x1D94, 0x40660000, + 0x1D94, 0x40670000, + 0x1D94, 0x40680000, + 0x1D94, 0x40690000, + 0x1D94, 0x406A0000, + 0x1D94, 0x406B0000, + 0x1D94, 0x406C0000, + 0x1D94, 0x406D0000, + 0x1D94, 0x406E0000, + 0x1D94, 0x406F0000, + 0x1D94, 0x40700000, + 0x1D94, 0x40710000, + 0x1D94, 0x40720000, + 0x1D94, 0x40730000, + 0x1D94, 0x40740000, + 0x1D94, 0x40750000, + 0x1D94, 0x40760000, + 0x1D94, 0x40770000, + 0x1D94, 0x40780000, + 0x1D94, 0x40790000, + 0x1D94, 0x407A0000, + 0x1D94, 0x407B0000, + 0x1D94, 0x407C0000, + 0x1D94, 0x407D0000, + 0x1D94, 0x407E0000, + 0x1D94, 0x407F0000, + 0x1D94, 0x40800000, + 0x1D94, 0x40810000, + 0x1D94, 0x40820000, + 0x1D94, 0x40830000, + 0x1D94, 0x40840000, + 0x1D94, 0x40850000, + 0x1D94, 0x40860000, + 0x1D94, 0x40870000, + 0x1D94, 0x40880000, + 0x1D94, 0x40890000, + 0x1D94, 0x408A0000, + 0x1D94, 0x408B0000, + 0x1D94, 0x408C0000, + 0x1D94, 0x408D0000, + 0x1D94, 0x408E0000, + 0x1D94, 0x408F0000, + 0x1D94, 0x40900000, + 0x1D94, 0x40910000, + 0x1D94, 0x40920000, + 0x1D94, 0x40930000, + 0x1D94, 0x40940000, + 0x1D94, 0x40950000, + 0x1D94, 0x40960000, + 0x1D94, 0x40970000, + 0x1D94, 0x40980000, + 0x1D94, 0x40990000, + 0x1D94, 0x409A0000, + 0x1D94, 0x409B0000, + 0x1D94, 0x409C0000, + 0x1D94, 0x409D0000, + 0x1D94, 0x409E0000, + 0x1D94, 0x409F0000, + 0x1D94, 0x40A00000, + 0x1D94, 0x40A10000, + 0x1D94, 0x40A20000, + 0x1D94, 0x40A30000, + 0x1D94, 0x40A40000, + 0x1D94, 0x40A50000, + 0x1D94, 0x40A60000, + 0x1D94, 0x40A70000, + 0x1D94, 0x40A80000, + 0x1D94, 0x40A90000, + 0x1D94, 0x40AA0000, + 0x1D94, 0x40AB0000, + 0x1D94, 0x40AC0000, + 0x1D94, 0x40AD0000, + 0x1D94, 0x40AE0000, + 0x1D94, 0x40AF0000, + 0x1D94, 0x40B00000, + 0x1D94, 0x40B10000, + 0x1D94, 0x40B20000, + 0x1D94, 0x40B30000, + 0x1D94, 0x40B40000, + 0x1D94, 0x40B50000, + 0x1D94, 0x40B60000, + 0x1D94, 0x40B70000, + 0x1D94, 0x40B80000, + 0x1D94, 0x40B90000, + 0x1D94, 0x40BA0000, + 0x1D94, 0x40BB0000, + 0x1D94, 0x40BC0000, + 0x1D94, 0x40BD0000, + 0x1D94, 0x40BE0000, + 0x1D94, 0x40BF0000, + 0x1D94, 0x40C00000, + 0x1D94, 0x40C10000, + 0x1D94, 0x40C20000, + 0x1D94, 0x40C30000, + 0x1D94, 0x40C40000, + 0x1D94, 0x40C50000, + 0x1D94, 0x40C60000, + 0x1D94, 0x40C70000, + 0x1D94, 0x40C80000, + 0x1D94, 0x40C90000, + 0x1D94, 0x40CA0000, + 0x1D94, 0x40CB0000, + 0x1D94, 0x40CC0000, + 0x1D94, 0x40CD0000, + 0x1D94, 0x40CE0000, + 0x1D94, 0x40CF0000, + 0x1D94, 0x40D00000, + 0x1D94, 0x40D10000, + 0x1D94, 0x40D20000, + 0x1D94, 0x40D30000, + 0x1D94, 0x40D40000, + 0x1D94, 0x40D50000, + 0x1D94, 0x40D60000, + 0x1D94, 0x40D70000, + 0x1D94, 0x40D80000, + 0x1D94, 0x40D90000, + 0x1D94, 0x40DA0000, + 0x1D94, 0x40DB0000, + 0x1D94, 0x40DC0000, + 0x1D94, 0x40DD0000, + 0x1D94, 0x40DE0000, + 0x1D94, 0x40DF0000, + 0x1D94, 0x40E00000, + 0x1D94, 0x40E10000, + 0x1D94, 0x40E20000, + 0x1D94, 0x40E30000, + 0x1D94, 0x40E40000, + 0x1D94, 0x40E50000, + 0x1D94, 0x40E60000, + 0x1D94, 0x40E70000, + 0x1D94, 0x40E80000, + 0x1D94, 0x40E90000, + 0x1D94, 0x40EA0000, + 0x1D94, 0x40EB0000, + 0x1D94, 0x40EC0000, + 0x1D94, 0x40ED0000, + 0x1D94, 0x40EE0000, + 0x1D94, 0x40EF0000, + 0x1D94, 0x40F00000, + 0x1D94, 0x40F10000, + 0x1D94, 0x40F20000, + 0x1D94, 0x40F30000, + 0x1D94, 0x40F40000, + 0x1D94, 0x40F50000, + 0x1D94, 0x40F60000, + 0x1D94, 0x40F70000, + 0x1D94, 0x40F80000, + 0x1D94, 0x40F90000, + 0x1D94, 0x40FA0000, + 0x1D94, 0x40FB0000, + 0x1D94, 0x40FC0000, + 0x1D94, 0x40FD0000, + 0x1D94, 0x40FE0000, + 0x1D94, 0x40FF0000, + 0xC0C, 0x02F1D8B7, + 0x1EE8, 0x00000000, +}; + +RTW_DECL_TABLE_PHY_COND(rtw8822c_bb, rtw_phy_cfg_bb); + +static const struct rtw_phy_pg_cfg_pair rtw8822c_bb_pg_type0[] = { + { 0, 0, 0, 0x00000c20, 0xffffffff, 0x484c5054, }, + { 0, 0, 0, 0x00000c24, 0xffffffff, 0x54585858, }, + { 0, 0, 0, 0x00000c28, 0xffffffff, 0x44484c50, }, + { 0, 0, 0, 0x00000c2c, 0xffffffff, 0x50545858, }, + { 0, 0, 0, 0x00000c30, 0xffffffff, 0x4044484c, }, + { 0, 0, 1, 0x00000c34, 0xffffffff, 0x50545858, }, + { 0, 0, 1, 0x00000c38, 0xffffffff, 0x4044484c, }, + { 0, 0, 0, 0x00000c3c, 0xffffffff, 0x50545858, }, + { 0, 0, 0, 0x00000c40, 0xffffffff, 0x4044484c, }, + { 0, 0, 0, 0x00000c44, 0xffffffff, 0x5858383c, }, + { 0, 0, 1, 0x00000c48, 0xffffffff, 0x484c5054, }, + { 0, 0, 1, 0x00000c4c, 0xffffffff, 0x383c4044, }, + { 0, 1, 0, 0x00000e20, 0xffffffff, 0x484c5054, }, + { 0, 1, 0, 0x00000e24, 0xffffffff, 0x54585858, }, + { 0, 1, 0, 0x00000e28, 0xffffffff, 0x44484c50, }, + { 0, 1, 0, 0x00000e2c, 0xffffffff, 0x50545858, }, + { 0, 1, 0, 0x00000e30, 0xffffffff, 0x4044484c, }, + { 0, 1, 1, 0x00000e34, 0xffffffff, 0x50545858, }, + { 0, 1, 1, 0x00000e38, 0xffffffff, 0x4044484c, }, + { 0, 1, 0, 0x00000e3c, 0xffffffff, 0x50545858, }, + { 0, 1, 0, 0x00000e40, 0xffffffff, 0x4044484c, }, + { 0, 1, 0, 0x00000e44, 0xffffffff, 0x5858383c, }, + { 0, 1, 1, 0x00000e48, 0xffffffff, 0x484c5054, }, + { 0, 1, 1, 0x00000e4c, 0xffffffff, 0x383c4044, }, + { 1, 0, 0, 0x00000c24, 0xffffffff, 0x54585858, }, + { 1, 0, 0, 0x00000c28, 0xffffffff, 0x44484c50, }, + { 1, 0, 0, 0x00000c2c, 0xffffffff, 0x50545858, }, + { 1, 0, 0, 0x00000c30, 0xffffffff, 0x4044484c, }, + { 1, 0, 1, 0x00000c34, 0xffffffff, 0x50545858, }, + { 1, 0, 1, 0x00000c38, 0xffffffff, 0x4044484c, }, + { 1, 0, 0, 0x00000c3c, 0xffffffff, 0x50545858, }, + { 1, 0, 0, 0x00000c40, 0xffffffff, 0x4044484c, }, + { 1, 0, 0, 0x00000c44, 0xffffffff, 0x5858383c, }, + { 1, 0, 1, 0x00000c48, 0xffffffff, 0x484c5054, }, + { 1, 0, 1, 0x00000c4c, 0xffffffff, 0x383c4044, }, + { 1, 1, 0, 0x00000e24, 0xffffffff, 0x54585858, }, + { 1, 1, 0, 0x00000e28, 0xffffffff, 0x44484c50, }, + { 1, 1, 0, 0x00000e2c, 0xffffffff, 0x50545858, }, + { 1, 1, 0, 0x00000e30, 0xffffffff, 0x4044484c, }, + { 1, 1, 1, 0x00000e34, 0xffffffff, 0x50545858, }, + { 1, 1, 1, 0x00000e38, 0xffffffff, 0x4044484c, }, + { 1, 1, 0, 0x00000e3c, 0xffffffff, 0x50545858, }, + { 1, 1, 0, 0x00000e40, 0xffffffff, 0x4044484c, }, + { 1, 1, 0, 0x00000e44, 0xffffffff, 0x5858383c, }, + { 1, 1, 1, 0x00000e48, 0xffffffff, 0x484c5054, }, + { 1, 1, 1, 0x00000e4c, 0xffffffff, 0x383c4044, }, +}; + +RTW_DECL_TABLE_BB_PG(rtw8822c_bb_pg_type0); + +static const u32 rtw8822c_rf_a[] = { + 0x000, 0x00030000, + 0x018, 0x00013124, + 0x093, 0x0008483F, + 0x0DE, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000B9140, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000B9140, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0xA0000000, 0x00000000, + 0x08E, 0x000A5540, + 0xB0000000, 0x00000000, + 0x081, 0x0000FC01, + 0x081, 0x0002FC01, + 0x081, 0x0003FC01, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x085, 0x0006A06C, + 0xA0000000, 0x00000000, + 0x085, 0x0006A06C, + 0xB0000000, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000002, + 0x03F, 0x0000003F, + 0x0EE, 0x00000000, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000002, + 0x03F, 0x0000003F, + 0x0EE, 0x00000000, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000002, + 0x03F, 0x0000003F, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773E8, + 0x033, 0x0000000E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000D, + 0x03F, 0x00000380, + 0x033, 0x0000000C, + 0x03F, 0x000FF380, + 0x033, 0x0000000B, + 0x03F, 0x00000300, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773E8, + 0x033, 0x0000000E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000D, + 0x03F, 0x00000380, + 0x033, 0x0000000C, + 0x03F, 0x000FF380, + 0x033, 0x0000000B, + 0x03F, 0x00000300, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773E8, + 0x033, 0x0000000E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000D, + 0x03F, 0x00000380, + 0x033, 0x0000000C, + 0x03F, 0x000FF380, + 0x033, 0x0000000B, + 0x03F, 0x00000300, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000003, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773E8, + 0x033, 0x0000001E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001D, + 0x03F, 0x00000380, + 0x033, 0x0000001C, + 0x03F, 0x000FF380, + 0x033, 0x0000001B, + 0x03F, 0x00000300, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773E8, + 0x033, 0x0000001E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001D, + 0x03F, 0x00000380, + 0x033, 0x0000001C, + 0x03F, 0x000FF380, + 0x033, 0x0000001B, + 0x03F, 0x00000300, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773E8, + 0x033, 0x0000001E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001D, + 0x03F, 0x00000380, + 0x033, 0x0000001C, + 0x03F, 0x000FF380, + 0x033, 0x0000001B, + 0x03F, 0x00000300, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000013, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773E8, + 0x033, 0x0000002E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002D, + 0x03F, 0x00000380, + 0x033, 0x0000002C, + 0x03F, 0x000FF380, + 0x033, 0x0000002B, + 0x03F, 0x00000300, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773E8, + 0x033, 0x0000002E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002D, + 0x03F, 0x00000380, + 0x033, 0x0000002C, + 0x03F, 0x000FF380, + 0x033, 0x0000002B, + 0x03F, 0x00000300, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773E8, + 0x033, 0x0000002E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002D, + 0x03F, 0x00000380, + 0x033, 0x0000002C, + 0x03F, 0x000FF380, + 0x033, 0x0000002B, + 0x03F, 0x00000300, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000023, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773E8, + 0x033, 0x0000003E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003D, + 0x03F, 0x00000380, + 0x033, 0x0000003C, + 0x03F, 0x000FF380, + 0x033, 0x0000003B, + 0x03F, 0x00000300, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773E8, + 0x033, 0x0000003E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003D, + 0x03F, 0x00000380, + 0x033, 0x0000003C, + 0x03F, 0x000FF380, + 0x033, 0x0000003B, + 0x03F, 0x00000300, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773E8, + 0x033, 0x0000003E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003D, + 0x03F, 0x00000380, + 0x033, 0x0000003C, + 0x03F, 0x000FF380, + 0x033, 0x0000003B, + 0x03F, 0x00000300, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000033, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773E8, + 0x033, 0x0000004E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004D, + 0x03F, 0x00000380, + 0x033, 0x0000004C, + 0x03F, 0x000FF380, + 0x033, 0x0000004B, + 0x03F, 0x00000300, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773E8, + 0x033, 0x0000004E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004D, + 0x03F, 0x00000380, + 0x033, 0x0000004C, + 0x03F, 0x000FF380, + 0x033, 0x0000004B, + 0x03F, 0x00000300, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773E8, + 0x033, 0x0000004E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004D, + 0x03F, 0x00000380, + 0x033, 0x0000004C, + 0x03F, 0x000FF380, + 0x033, 0x0000004B, + 0x03F, 0x00000300, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000043, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773E8, + 0x033, 0x0000005E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005D, + 0x03F, 0x00000380, + 0x033, 0x0000005C, + 0x03F, 0x000FF380, + 0x033, 0x0000005B, + 0x03F, 0x00000300, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773E8, + 0x033, 0x0000005E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005D, + 0x03F, 0x00000380, + 0x033, 0x0000005C, + 0x03F, 0x000FF380, + 0x033, 0x0000005B, + 0x03F, 0x00000300, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773E8, + 0x033, 0x0000005E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005D, + 0x03F, 0x00000380, + 0x033, 0x0000005C, + 0x03F, 0x000FF380, + 0x033, 0x0000005B, + 0x03F, 0x00000300, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000053, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x08A, 0x000E7DE3, + 0x08B, 0x0008FE00, + 0x0EE, 0x00000008, + 0x033, 0x00000000, + 0x03F, 0x00000023, + 0x033, 0x00000001, + 0x03F, 0x00000023, + 0x0EE, 0x00000000, + 0x0EF, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x0000000F, + 0x033, 0x00000002, + 0x03F, 0x00000000, + 0x0EF, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000010, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000010, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000010, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x0FE, 0x00000000, + 0x01B, 0x00003A40, + 0x061, 0x0000D233, + 0x062, 0x0004D232, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000C02, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000C02, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0xA0000000, 0x00000000, + 0x063, 0x00000C02, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000200, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000233, + 0x030, 0x00001233, + 0x030, 0x00002233, + 0x030, 0x00003233, + 0x030, 0x00004203, + 0x030, 0x00005233, + 0x030, 0x00006233, + 0x030, 0x00007233, + 0x030, 0x00008203, + 0x030, 0x00009233, + 0x030, 0x0000A233, + 0x030, 0x0000B233, + 0x030, 0x0000C233, + 0x030, 0x0000D233, + 0x030, 0x0000E203, + 0x030, 0x0000F233, + 0x030, 0x00010233, + 0x030, 0x00011233, + 0x030, 0x00012203, + 0x030, 0x00013233, + 0x030, 0x00014233, + 0x030, 0x00015233, + 0x030, 0x00016203, + 0x030, 0x00017233, + 0x030, 0x00018203, + 0x030, 0x00019233, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000233, + 0x030, 0x00001233, + 0x030, 0x00002233, + 0x030, 0x00003233, + 0x030, 0x00004203, + 0x030, 0x00005233, + 0x030, 0x00006233, + 0x030, 0x00007233, + 0x030, 0x00008203, + 0x030, 0x00009233, + 0x030, 0x0000A233, + 0x030, 0x0000B233, + 0x030, 0x0000C233, + 0x030, 0x0000D233, + 0x030, 0x0000E203, + 0x030, 0x0000F233, + 0x030, 0x00010233, + 0x030, 0x00011233, + 0x030, 0x00012203, + 0x030, 0x00013233, + 0x030, 0x00014233, + 0x030, 0x00015233, + 0x030, 0x00016203, + 0x030, 0x00017233, + 0x030, 0x00018203, + 0x030, 0x00019233, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000237, + 0x030, 0x00001237, + 0x030, 0x00002237, + 0x030, 0x00003237, + 0x030, 0x00004207, + 0x030, 0x00005237, + 0x030, 0x00006237, + 0x030, 0x00007237, + 0x030, 0x00008207, + 0x030, 0x00009237, + 0x030, 0x0000A237, + 0x030, 0x0000B237, + 0x030, 0x0000C237, + 0x030, 0x0000D237, + 0x030, 0x0000E207, + 0x030, 0x0000F237, + 0x030, 0x00010237, + 0x030, 0x00011237, + 0x030, 0x00012207, + 0x030, 0x00013237, + 0x030, 0x00014237, + 0x030, 0x00015237, + 0x030, 0x00016207, + 0x030, 0x00017237, + 0x030, 0x00018207, + 0x030, 0x00019237, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000237, + 0x030, 0x00001237, + 0x030, 0x00002237, + 0x030, 0x00003237, + 0x030, 0x00004207, + 0x030, 0x00005237, + 0x030, 0x00006237, + 0x030, 0x00007237, + 0x030, 0x00008207, + 0x030, 0x00009237, + 0x030, 0x0000A237, + 0x030, 0x0000B237, + 0x030, 0x0000C237, + 0x030, 0x0000D237, + 0x030, 0x0000E207, + 0x030, 0x0000F237, + 0x030, 0x00010237, + 0x030, 0x00011237, + 0x030, 0x00012207, + 0x030, 0x00013237, + 0x030, 0x00014237, + 0x030, 0x00015237, + 0x030, 0x00016207, + 0x030, 0x00017237, + 0x030, 0x00018207, + 0x030, 0x00019237, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000237, + 0x030, 0x00001237, + 0x030, 0x00002237, + 0x030, 0x00003237, + 0x030, 0x00004207, + 0x030, 0x00005237, + 0x030, 0x00006237, + 0x030, 0x00007237, + 0x030, 0x00008207, + 0x030, 0x00009237, + 0x030, 0x0000A237, + 0x030, 0x0000B237, + 0x030, 0x0000C237, + 0x030, 0x0000D237, + 0x030, 0x0000E207, + 0x030, 0x0000F237, + 0x030, 0x00010237, + 0x030, 0x00011237, + 0x030, 0x00012207, + 0x030, 0x00013237, + 0x030, 0x00014237, + 0x030, 0x00015237, + 0x030, 0x00016207, + 0x030, 0x00017237, + 0x030, 0x00018207, + 0x030, 0x00019237, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000237, + 0x030, 0x00001237, + 0x030, 0x00002237, + 0x030, 0x00003237, + 0x030, 0x00004207, + 0x030, 0x00005237, + 0x030, 0x00006237, + 0x030, 0x00007237, + 0x030, 0x00008207, + 0x030, 0x00009237, + 0x030, 0x0000A237, + 0x030, 0x0000B237, + 0x030, 0x0000C237, + 0x030, 0x0000D237, + 0x030, 0x0000E207, + 0x030, 0x0000F237, + 0x030, 0x00010237, + 0x030, 0x00011237, + 0x030, 0x00012207, + 0x030, 0x00013237, + 0x030, 0x00014237, + 0x030, 0x00015237, + 0x030, 0x00016207, + 0x030, 0x00017237, + 0x030, 0x00018207, + 0x030, 0x00019237, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0xA0000000, 0x00000000, + 0x030, 0x00000233, + 0x030, 0x00001233, + 0x030, 0x00002233, + 0x030, 0x00003233, + 0x030, 0x00004203, + 0x030, 0x00005233, + 0x030, 0x00006233, + 0x030, 0x00007233, + 0x030, 0x00008203, + 0x030, 0x00009233, + 0x030, 0x0000A233, + 0x030, 0x0000B233, + 0x030, 0x0000C233, + 0x030, 0x0000D233, + 0x030, 0x0000E203, + 0x030, 0x0000F233, + 0x030, 0x00010233, + 0x030, 0x00011233, + 0x030, 0x00012203, + 0x030, 0x00013233, + 0x030, 0x00014233, + 0x030, 0x00015233, + 0x030, 0x00016203, + 0x030, 0x00017233, + 0x030, 0x00018203, + 0x030, 0x00019233, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000080, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000232, + 0x030, 0x00001232, + 0x030, 0x00002232, + 0x030, 0x00003232, + 0x030, 0x00004232, + 0x030, 0x00005232, + 0x030, 0x00006232, + 0x030, 0x00007232, + 0x030, 0x00008232, + 0x030, 0x00009232, + 0x030, 0x0000A232, + 0x030, 0x0000B232, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000232, + 0x030, 0x00001232, + 0x030, 0x00002232, + 0x030, 0x00003232, + 0x030, 0x00004232, + 0x030, 0x00005232, + 0x030, 0x00006232, + 0x030, 0x00007232, + 0x030, 0x00008232, + 0x030, 0x00009232, + 0x030, 0x0000A232, + 0x030, 0x0000B232, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0xA0000000, 0x00000000, + 0x030, 0x00000232, + 0x030, 0x00001232, + 0x030, 0x00002232, + 0x030, 0x00003232, + 0x030, 0x00004232, + 0x030, 0x00005232, + 0x030, 0x00006232, + 0x030, 0x00007232, + 0x030, 0x00008232, + 0x030, 0x00009232, + 0x030, 0x0000A232, + 0x030, 0x0000B232, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000770, + 0x030, 0x00001770, + 0x030, 0x00002440, + 0x030, 0x00003440, + 0x030, 0x00004330, + 0x030, 0x00005330, + 0x030, 0x00008770, + 0x030, 0x0000A440, + 0x030, 0x0000C330, + 0x0EF, 0x00000000, + 0x0EE, 0x00010000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0xA0000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0xB0000000, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0xA0000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0xB0000000, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x051, 0x0003C800, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000942CA, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000942CA, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0xA0000000, 0x00000000, + 0x052, 0x000942CA, + 0xB0000000, 0x00000000, + 0x053, 0x000090F9, + 0x054, 0x00088000, + 0x057, 0x0004C80A, + 0x0EF, 0x00000020, + 0x033, 0x00000000, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000001, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000002, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000003, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000004, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000005, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000006, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000007, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000008, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000009, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000A, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000B, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000C, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000D, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00028246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000E, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00010E46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00030246, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000F, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000010, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000011, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000012, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000013, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000014, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000015, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000016, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000017, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000018, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000019, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001A, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001B, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001C, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001D, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00031E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001E, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001F, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000020, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000021, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000022, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000023, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000024, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000025, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000026, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000027, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000028, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00025E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x00000029, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0003D646, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x033, 0x0000002A, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00002A46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000EA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00021E46, + 0xA0000000, 0x00000000, + 0x03F, 0x00002A46, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EE, 0x00010000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000487, + 0x033, 0x00000061, + 0x03F, 0x00000887, + 0x033, 0x00000062, + 0x03F, 0x00000947, + 0x033, 0x00000063, + 0x03F, 0x00000D48, + 0x033, 0x00000064, + 0x03F, 0x00000D88, + 0x033, 0x00000065, + 0x03F, 0x00000DE8, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000487, + 0x033, 0x00000061, + 0x03F, 0x00000887, + 0x033, 0x00000062, + 0x03F, 0x00000947, + 0x033, 0x00000063, + 0x03F, 0x00000D48, + 0x033, 0x00000064, + 0x03F, 0x00000D88, + 0x033, 0x00000065, + 0x03F, 0x00000DE8, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000468, + 0x033, 0x00000061, + 0x03F, 0x00000868, + 0x033, 0x00000062, + 0x03F, 0x00000909, + 0x033, 0x00000063, + 0x03F, 0x00000D0A, + 0x033, 0x00000064, + 0x03F, 0x00000D4A, + 0x033, 0x00000065, + 0x03F, 0x00000D8B, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000468, + 0x033, 0x00000061, + 0x03F, 0x00000868, + 0x033, 0x00000062, + 0x03F, 0x00000909, + 0x033, 0x00000063, + 0x03F, 0x00000D0A, + 0x033, 0x00000064, + 0x03F, 0x00000D4A, + 0x033, 0x00000065, + 0x03F, 0x00000D8B, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000468, + 0x033, 0x00000061, + 0x03F, 0x00000868, + 0x033, 0x00000062, + 0x03F, 0x00000909, + 0x033, 0x00000063, + 0x03F, 0x00000D0A, + 0x033, 0x00000064, + 0x03F, 0x00000D4A, + 0x033, 0x00000065, + 0x03F, 0x00000D8B, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000468, + 0x033, 0x00000061, + 0x03F, 0x00000868, + 0x033, 0x00000062, + 0x03F, 0x00000909, + 0x033, 0x00000063, + 0x03F, 0x00000D0A, + 0x033, 0x00000064, + 0x03F, 0x00000D4A, + 0x033, 0x00000065, + 0x03F, 0x00000D8B, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x000008C8, + 0x033, 0x00000064, + 0x03F, 0x000008CB, + 0x033, 0x00000065, + 0x03F, 0x000008CE, + 0x033, 0x00000066, + 0x03F, 0x000008D1, + 0x033, 0x00000067, + 0x03F, 0x000008D4, + 0x033, 0x00000068, + 0x03F, 0x00000DD1, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0xA0000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000487, + 0x033, 0x00000061, + 0x03F, 0x00000887, + 0x033, 0x00000062, + 0x03F, 0x00000947, + 0x033, 0x00000063, + 0x03F, 0x00000D48, + 0x033, 0x00000064, + 0x03F, 0x00000D88, + 0x033, 0x00000065, + 0x03F, 0x00000DE8, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0xB0000000, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000487, + 0x033, 0x00000021, + 0x03F, 0x00000887, + 0x033, 0x00000022, + 0x03F, 0x00000947, + 0x033, 0x00000023, + 0x03F, 0x00000D48, + 0x033, 0x00000024, + 0x03F, 0x00000D88, + 0x033, 0x00000025, + 0x03F, 0x00000DE8, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000487, + 0x033, 0x00000021, + 0x03F, 0x00000887, + 0x033, 0x00000022, + 0x03F, 0x00000947, + 0x033, 0x00000023, + 0x03F, 0x00000D48, + 0x033, 0x00000024, + 0x03F, 0x00000D88, + 0x033, 0x00000025, + 0x03F, 0x00000DE8, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000468, + 0x033, 0x00000021, + 0x03F, 0x00000868, + 0x033, 0x00000022, + 0x03F, 0x00000909, + 0x033, 0x00000023, + 0x03F, 0x00000D0A, + 0x033, 0x00000024, + 0x03F, 0x00000D4A, + 0x033, 0x00000025, + 0x03F, 0x00000D8B, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000468, + 0x033, 0x00000021, + 0x03F, 0x00000868, + 0x033, 0x00000022, + 0x03F, 0x00000909, + 0x033, 0x00000023, + 0x03F, 0x00000D0A, + 0x033, 0x00000024, + 0x03F, 0x00000D4A, + 0x033, 0x00000025, + 0x03F, 0x00000D8B, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000468, + 0x033, 0x00000021, + 0x03F, 0x00000868, + 0x033, 0x00000022, + 0x03F, 0x00000909, + 0x033, 0x00000023, + 0x03F, 0x00000D0A, + 0x033, 0x00000024, + 0x03F, 0x00000D4A, + 0x033, 0x00000025, + 0x03F, 0x00000D8B, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000468, + 0x033, 0x00000021, + 0x03F, 0x00000868, + 0x033, 0x00000022, + 0x03F, 0x00000909, + 0x033, 0x00000023, + 0x03F, 0x00000D0A, + 0x033, 0x00000024, + 0x03F, 0x00000D4A, + 0x033, 0x00000025, + 0x03F, 0x00000D8B, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0xA0000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000487, + 0x033, 0x00000021, + 0x03F, 0x00000887, + 0x033, 0x00000022, + 0x03F, 0x00000947, + 0x033, 0x00000023, + 0x03F, 0x00000D48, + 0x033, 0x00000024, + 0x03F, 0x00000D88, + 0x033, 0x00000025, + 0x03F, 0x00000DE8, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0xB0000000, 0x00000000, + 0x0EE, 0x00000000, + 0x05C, 0x000FC000, + 0x067, 0x0000A505, + 0x0D3, 0x00000542, + 0x043, 0x00005000, + 0x07F, 0x00000000, + 0x0B0, 0x0001F0FC, + 0x0B1, 0x0007DBE4, + 0x0B2, 0x00022400, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0xA0000000, 0x00000000, + 0x0B3, 0x0007C760, + 0xB0000000, 0x00000000, + 0x0B4, 0x00099D40, + 0x0B5, 0x0004103F, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000187F8, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B6, 0x000387F8, + 0xA0000000, 0x00000000, + 0x0B6, 0x000187F8, + 0xB0000000, 0x00000000, + 0x0B7, 0x00030018, + 0x0BC, 0x00000008, + 0x0D3, 0x00000542, + 0x0DD, 0x00000500, + 0x0BB, 0x00040010, + 0x0B0, 0x0001F0FA, + 0x0FE, 0x00000000, + 0x0CA, 0x00080000, + 0x0CA, 0x00080001, + 0x0FE, 0x00000000, + 0x0B0, 0x0001F0F8, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C700, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C700, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C700, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C700, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C700, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C700, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0xA0000000, 0x00000000, + 0x0B3, 0x0007C700, + 0xB0000000, 0x00000000, + 0x018, 0x0001B124, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x0007C760, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0B3, 0x000FC760, + 0xA0000000, 0x00000000, + 0x0B3, 0x0007C760, + 0xB0000000, 0x00000000, + 0x018, 0x00013124, + 0x0CC, 0x0000F000, + 0x0CD, 0x00089600, + 0x018, 0x00013108, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x0B8, 0x000C0440, + 0x0BA, 0x000E840D, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x018, 0x00013124, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x059, 0x000A0000, + 0x05A, 0x00060000, + 0x05B, 0x00014000, + 0x0ED, 0x00000008, + 0x033, 0x00000001, + 0x03F, 0x0000000F, + 0x0ED, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000500, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000500, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000500, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000500, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000500, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000500, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0DD, 0x00000540, + 0xA0000000, 0x00000000, + 0x0DD, 0x00000500, + 0xB0000000, 0x00000000, + 0x0BC, 0x00000004, + 0x0EE, 0x00000002, + 0x033, 0x00000017, + 0x03F, 0x0000003F, + 0x033, 0x00000018, + 0x03F, 0x0000003F, + 0x033, 0x00000019, + 0x03F, 0x00000000, + 0x033, 0x0000001A, + 0x03F, 0x0000003F, + 0x033, 0x0000001B, + 0x03F, 0x0000003F, + 0x033, 0x0000001C, + 0x03F, 0x0000003F, + 0x0EE, 0x00000000, + 0x0ED, 0x00000200, + 0x033, 0x00000000, + 0x03F, 0x000F45A4, + 0x033, 0x00000001, + 0x03F, 0x000F49A4, + 0x033, 0x00000002, + 0x03F, 0x000F49A4, + 0x033, 0x00000003, + 0x03F, 0x000F69A4, + 0x033, 0x00000004, + 0x03F, 0x000F69A4, + 0x033, 0x00000005, + 0x03F, 0x000F69A4, + 0x033, 0x00000006, + 0x03F, 0x000F6DA4, + 0x033, 0x00000007, + 0x03F, 0x000F6DA4, + 0x033, 0x00000008, + 0x03F, 0x000F6DA4, + 0x033, 0x00000009, + 0x03F, 0x000F8DA4, + 0x033, 0x0000000A, + 0x03F, 0x000F8DA4, + 0x033, 0x0000000B, + 0x03F, 0x000F8DA4, + 0x033, 0x0000000C, + 0x03F, 0x000F91A4, + 0x033, 0x0000000D, + 0x03F, 0x000F91A4, + 0x033, 0x0000000E, + 0x03F, 0x000F91A4, + 0x033, 0x0000000F, + 0x03F, 0x000FB1A4, + 0x033, 0x00000010, + 0x03F, 0x000FB1A4, + 0x033, 0x00000011, + 0x03F, 0x000FB1A4, + 0x033, 0x00000012, + 0x03F, 0x000FB5A4, + 0x033, 0x00000013, + 0x03F, 0x000FB5A4, + 0x033, 0x00000014, + 0x03F, 0x000FD9A4, + 0x033, 0x00000015, + 0x03F, 0x000FD9A4, + 0x033, 0x00000016, + 0x03F, 0x000FF9A4, + 0x033, 0x00000017, + 0x03F, 0x000FF9A4, + 0x033, 0x00000018, + 0x03F, 0x000FFDA4, + 0x033, 0x00000019, + 0x03F, 0x000FFDA4, + 0x033, 0x0000001A, + 0x03F, 0x000FFDA4, + 0x0ED, 0x00000000, + 0x092, 0x00084800, + 0x092, 0x00084801, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x092, 0x00084800, + 0x08F, 0x00001B4C, + 0x088, 0x0004326B, + 0x019, 0x00000005, + 0x0EF, 0x00080000, + 0x033, 0x00000004, + 0x03E, 0x00000003, + 0x03F, 0x000F60FF, + 0x0EF, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000006, + 0x03E, 0x00000003, + 0x03F, 0x000760FF, + 0x0EF, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000007, + 0x03E, 0x00000003, + 0x03F, 0x0007DEFF, + 0x0EF, 0x00000000, +}; + +RTW_DECL_TABLE_RF_RADIO(rtw8822c_rf_a, A); + +static const u32 rtw8822c_rf_b[] = { + 0x000, 0x00030000, + 0x018, 0x00013124, + 0x093, 0x0008483F, + 0x0EF, 0x00080000, + 0x033, 0x00000001, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00091230, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00091230, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00091230, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00091230, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00091230, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00091230, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0009123E, + 0xA0000000, 0x00000000, + 0x03F, 0x00091230, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0DE, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000B9140, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000B9140, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x08E, 0x000A5540, + 0xA0000000, 0x00000000, + 0x08E, 0x000A5540, + 0xB0000000, 0x00000000, + 0x081, 0x0000FC01, + 0x081, 0x0002FC01, + 0x081, 0x0003FC01, + 0x085, 0x0006A06C, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000002, + 0x03F, 0x0000003F, + 0x0EE, 0x00000000, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000002, + 0x03F, 0x0000003F, + 0x0EE, 0x00000000, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000001, + 0x03F, 0x0000002A, + 0x033, 0x00000002, + 0x03F, 0x0000002A, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EE, 0x00000010, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000001, + 0x03F, 0x0000003F, + 0x033, 0x00000002, + 0x03F, 0x0000003F, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773E8, + 0x033, 0x0000000E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000D, + 0x03F, 0x00000380, + 0x033, 0x0000000C, + 0x03F, 0x000FF380, + 0x033, 0x0000000B, + 0x03F, 0x00000300, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773E8, + 0x033, 0x0000000E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000D, + 0x03F, 0x00000380, + 0x033, 0x0000000C, + 0x03F, 0x000FF380, + 0x033, 0x0000000B, + 0x03F, 0x00000300, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773C0, + 0x033, 0x0000000E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000000D, + 0x03F, 0x000773E8, + 0x033, 0x0000000C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000000B, + 0x03F, 0x00000287, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000207, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x0EF, 0x00010000, + 0x033, 0x0000000F, + 0x03F, 0x000773E8, + 0x033, 0x0000000E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000000D, + 0x03F, 0x00000380, + 0x033, 0x0000000C, + 0x03F, 0x000FF380, + 0x033, 0x0000000B, + 0x03F, 0x00000300, + 0x033, 0x0000000A, + 0x03F, 0x000002A8, + 0x033, 0x00000009, + 0x03F, 0x00000280, + 0x033, 0x00000008, + 0x03F, 0x000FF280, + 0x033, 0x00000007, + 0x03F, 0x00000200, + 0x033, 0x00000006, + 0x03F, 0x000001C0, + 0x033, 0x00000005, + 0x03F, 0x00000180, + 0x033, 0x00000004, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000003, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773E8, + 0x033, 0x0000001E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001D, + 0x03F, 0x00000380, + 0x033, 0x0000001C, + 0x03F, 0x000FF380, + 0x033, 0x0000001B, + 0x03F, 0x00000300, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773E8, + 0x033, 0x0000001E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001D, + 0x03F, 0x00000380, + 0x033, 0x0000001C, + 0x03F, 0x000FF380, + 0x033, 0x0000001B, + 0x03F, 0x00000300, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773C0, + 0x033, 0x0000001E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000001D, + 0x03F, 0x000773E8, + 0x033, 0x0000001C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000001B, + 0x03F, 0x00000287, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000207, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x033, 0x0000001F, + 0x03F, 0x000773E8, + 0x033, 0x0000001E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000001D, + 0x03F, 0x00000380, + 0x033, 0x0000001C, + 0x03F, 0x000FF380, + 0x033, 0x0000001B, + 0x03F, 0x00000300, + 0x033, 0x0000001A, + 0x03F, 0x000002A8, + 0x033, 0x00000019, + 0x03F, 0x00000280, + 0x033, 0x00000018, + 0x03F, 0x000FF280, + 0x033, 0x00000017, + 0x03F, 0x00000200, + 0x033, 0x00000016, + 0x03F, 0x000001C0, + 0x033, 0x00000015, + 0x03F, 0x00000180, + 0x033, 0x00000014, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000013, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773E8, + 0x033, 0x0000002E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002D, + 0x03F, 0x00000380, + 0x033, 0x0000002C, + 0x03F, 0x000FF380, + 0x033, 0x0000002B, + 0x03F, 0x00000300, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773E8, + 0x033, 0x0000002E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002D, + 0x03F, 0x00000380, + 0x033, 0x0000002C, + 0x03F, 0x000FF380, + 0x033, 0x0000002B, + 0x03F, 0x00000300, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773C0, + 0x033, 0x0000002E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000002D, + 0x03F, 0x000773E8, + 0x033, 0x0000002C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000002B, + 0x03F, 0x00000287, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000207, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x033, 0x0000002F, + 0x03F, 0x000773E8, + 0x033, 0x0000002E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000002D, + 0x03F, 0x00000380, + 0x033, 0x0000002C, + 0x03F, 0x000FF380, + 0x033, 0x0000002B, + 0x03F, 0x00000300, + 0x033, 0x0000002A, + 0x03F, 0x000002A8, + 0x033, 0x00000029, + 0x03F, 0x00000280, + 0x033, 0x00000028, + 0x03F, 0x000FF280, + 0x033, 0x00000027, + 0x03F, 0x00000200, + 0x033, 0x00000026, + 0x03F, 0x000001C0, + 0x033, 0x00000025, + 0x03F, 0x00000180, + 0x033, 0x00000024, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000023, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773E8, + 0x033, 0x0000003E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003D, + 0x03F, 0x00000380, + 0x033, 0x0000003C, + 0x03F, 0x000FF380, + 0x033, 0x0000003B, + 0x03F, 0x00000300, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773E8, + 0x033, 0x0000003E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003D, + 0x03F, 0x00000380, + 0x033, 0x0000003C, + 0x03F, 0x000FF380, + 0x033, 0x0000003B, + 0x03F, 0x00000300, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773C0, + 0x033, 0x0000003E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000003D, + 0x03F, 0x000773E8, + 0x033, 0x0000003C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000003B, + 0x03F, 0x00000287, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000207, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x033, 0x0000003F, + 0x03F, 0x000773E8, + 0x033, 0x0000003E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000003D, + 0x03F, 0x00000380, + 0x033, 0x0000003C, + 0x03F, 0x000FF380, + 0x033, 0x0000003B, + 0x03F, 0x00000300, + 0x033, 0x0000003A, + 0x03F, 0x000002A8, + 0x033, 0x00000039, + 0x03F, 0x00000280, + 0x033, 0x00000038, + 0x03F, 0x000FF280, + 0x033, 0x00000037, + 0x03F, 0x00000200, + 0x033, 0x00000036, + 0x03F, 0x000001C0, + 0x033, 0x00000035, + 0x03F, 0x00000180, + 0x033, 0x00000034, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000033, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773E8, + 0x033, 0x0000004E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004D, + 0x03F, 0x00000380, + 0x033, 0x0000004C, + 0x03F, 0x000FF380, + 0x033, 0x0000004B, + 0x03F, 0x00000300, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773E8, + 0x033, 0x0000004E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004D, + 0x03F, 0x00000380, + 0x033, 0x0000004C, + 0x03F, 0x000FF380, + 0x033, 0x0000004B, + 0x03F, 0x00000300, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773C0, + 0x033, 0x0000004E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000004D, + 0x03F, 0x000773E8, + 0x033, 0x0000004C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000004B, + 0x03F, 0x00000287, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000207, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x033, 0x0000004F, + 0x03F, 0x000773E8, + 0x033, 0x0000004E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000004D, + 0x03F, 0x00000380, + 0x033, 0x0000004C, + 0x03F, 0x000FF380, + 0x033, 0x0000004B, + 0x03F, 0x00000300, + 0x033, 0x0000004A, + 0x03F, 0x000002A8, + 0x033, 0x00000049, + 0x03F, 0x00000280, + 0x033, 0x00000048, + 0x03F, 0x000FF280, + 0x033, 0x00000047, + 0x03F, 0x00000200, + 0x033, 0x00000046, + 0x03F, 0x000001C0, + 0x033, 0x00000045, + 0x03F, 0x00000180, + 0x033, 0x00000044, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000043, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773E8, + 0x033, 0x0000005E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005D, + 0x03F, 0x00000380, + 0x033, 0x0000005C, + 0x03F, 0x000FF380, + 0x033, 0x0000005B, + 0x03F, 0x00000300, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773E8, + 0x033, 0x0000005E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005D, + 0x03F, 0x00000380, + 0x033, 0x0000005C, + 0x03F, 0x000FF380, + 0x033, 0x0000005B, + 0x03F, 0x00000300, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773C0, + 0x033, 0x0000005E, + 0x03F, 0x000FF3C0, + 0x033, 0x0000005D, + 0x03F, 0x000773E8, + 0x033, 0x0000005C, + 0x03F, 0x000FF3E8, + 0x033, 0x0000005B, + 0x03F, 0x00000287, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000207, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0xA0000000, 0x00000000, + 0x033, 0x0000005F, + 0x03F, 0x000773E8, + 0x033, 0x0000005E, + 0x03F, 0x000FF3A0, + 0x033, 0x0000005D, + 0x03F, 0x00000380, + 0x033, 0x0000005C, + 0x03F, 0x000FF380, + 0x033, 0x0000005B, + 0x03F, 0x00000300, + 0x033, 0x0000005A, + 0x03F, 0x000002A8, + 0x033, 0x00000059, + 0x03F, 0x00000280, + 0x033, 0x00000058, + 0x03F, 0x000FF280, + 0x033, 0x00000057, + 0x03F, 0x00000200, + 0x033, 0x00000056, + 0x03F, 0x000001C0, + 0x033, 0x00000055, + 0x03F, 0x00000180, + 0x033, 0x00000054, + 0x03F, 0x00000040, + 0xB0000000, 0x00000000, + 0x033, 0x00000053, + 0x03F, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x08A, 0x000E7DE3, + 0x08B, 0x0008FE00, + 0x0EE, 0x00000008, + 0x033, 0x00000000, + 0x03F, 0x00000023, + 0x033, 0x00000001, + 0x03F, 0x00000023, + 0x0EE, 0x00000000, + 0x0EF, 0x00004000, + 0x033, 0x00000000, + 0x03F, 0x0000000F, + 0x033, 0x00000002, + 0x03F, 0x00000000, + 0x0EF, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000010, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000010, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000008, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002F81C, + 0x033, 0x00000010, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001C86, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0xA0000000, 0x00000000, + 0x0EF, 0x00020000, + 0x033, 0x00000000, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000001, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000002, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000003, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000004, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000005, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000006, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000007, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000008, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000009, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000000A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000000B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000000C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000000D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000000E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000000F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000010, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000011, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000012, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000013, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000014, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000015, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000016, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000017, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000018, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000019, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000001A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000001B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000001C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000001D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000001E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000001F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000020, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000021, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x00000022, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x00000023, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x00000024, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x00000025, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x00000026, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x00000027, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x033, 0x00000028, + 0x03E, 0x00001910, + 0x03F, 0x00020000, + 0x033, 0x00000029, + 0x03E, 0x00001C02, + 0x03F, 0x00020000, + 0x033, 0x0000002A, + 0x03E, 0x00000F02, + 0x03F, 0x00020000, + 0x033, 0x0000002B, + 0x03E, 0x00000F00, + 0x03F, 0x00020000, + 0x033, 0x0000002C, + 0x03E, 0x00000086, + 0x03F, 0x00020000, + 0x033, 0x0000002D, + 0x03E, 0x00000002, + 0x03F, 0x00020000, + 0x033, 0x0000002E, + 0x03E, 0x00000000, + 0x03F, 0x00020000, + 0x033, 0x0000002F, + 0x03E, 0x00000000, + 0x03F, 0x0002C010, + 0x0EF, 0x00000000, + 0xB0000000, 0x00000000, + 0x0FE, 0x00000000, + 0x01B, 0x00003A40, + 0x061, 0x0000D233, + 0x062, 0x0004D232, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000C02, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000C02, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x063, 0x00000002, + 0xA0000000, 0x00000000, + 0x063, 0x00000C02, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000200, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000233, + 0x030, 0x00001233, + 0x030, 0x00002233, + 0x030, 0x00003233, + 0x030, 0x00004203, + 0x030, 0x00005233, + 0x030, 0x00006233, + 0x030, 0x00007233, + 0x030, 0x00008203, + 0x030, 0x00009233, + 0x030, 0x0000A233, + 0x030, 0x0000B233, + 0x030, 0x0000C233, + 0x030, 0x0000D233, + 0x030, 0x0000E203, + 0x030, 0x0000F233, + 0x030, 0x00010233, + 0x030, 0x00011233, + 0x030, 0x00012203, + 0x030, 0x00013233, + 0x030, 0x00014233, + 0x030, 0x00015233, + 0x030, 0x00016203, + 0x030, 0x00017233, + 0x030, 0x00018203, + 0x030, 0x00019233, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000233, + 0x030, 0x00001233, + 0x030, 0x00002233, + 0x030, 0x00003233, + 0x030, 0x00004203, + 0x030, 0x00005233, + 0x030, 0x00006233, + 0x030, 0x00007233, + 0x030, 0x00008203, + 0x030, 0x00009233, + 0x030, 0x0000A233, + 0x030, 0x0000B233, + 0x030, 0x0000C233, + 0x030, 0x0000D233, + 0x030, 0x0000E203, + 0x030, 0x0000F233, + 0x030, 0x00010233, + 0x030, 0x00011233, + 0x030, 0x00012203, + 0x030, 0x00013233, + 0x030, 0x00014233, + 0x030, 0x00015233, + 0x030, 0x00016203, + 0x030, 0x00017233, + 0x030, 0x00018203, + 0x030, 0x00019233, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000237, + 0x030, 0x00001237, + 0x030, 0x00002237, + 0x030, 0x00003237, + 0x030, 0x00004207, + 0x030, 0x00005237, + 0x030, 0x00006237, + 0x030, 0x00007237, + 0x030, 0x00008207, + 0x030, 0x00009237, + 0x030, 0x0000A237, + 0x030, 0x0000B237, + 0x030, 0x0000C237, + 0x030, 0x0000D237, + 0x030, 0x0000E207, + 0x030, 0x0000F237, + 0x030, 0x00010237, + 0x030, 0x00011237, + 0x030, 0x00012207, + 0x030, 0x00013237, + 0x030, 0x00014237, + 0x030, 0x00015237, + 0x030, 0x00016207, + 0x030, 0x00017237, + 0x030, 0x00018207, + 0x030, 0x00019237, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000237, + 0x030, 0x00001237, + 0x030, 0x00002237, + 0x030, 0x00003237, + 0x030, 0x00004207, + 0x030, 0x00005237, + 0x030, 0x00006237, + 0x030, 0x00007237, + 0x030, 0x00008207, + 0x030, 0x00009237, + 0x030, 0x0000A237, + 0x030, 0x0000B237, + 0x030, 0x0000C237, + 0x030, 0x0000D237, + 0x030, 0x0000E207, + 0x030, 0x0000F237, + 0x030, 0x00010237, + 0x030, 0x00011237, + 0x030, 0x00012207, + 0x030, 0x00013237, + 0x030, 0x00014237, + 0x030, 0x00015237, + 0x030, 0x00016207, + 0x030, 0x00017237, + 0x030, 0x00018207, + 0x030, 0x00019237, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000237, + 0x030, 0x00001237, + 0x030, 0x00002237, + 0x030, 0x00003237, + 0x030, 0x00004207, + 0x030, 0x00005237, + 0x030, 0x00006237, + 0x030, 0x00007237, + 0x030, 0x00008207, + 0x030, 0x00009237, + 0x030, 0x0000A237, + 0x030, 0x0000B237, + 0x030, 0x0000C237, + 0x030, 0x0000D237, + 0x030, 0x0000E207, + 0x030, 0x0000F237, + 0x030, 0x00010237, + 0x030, 0x00011237, + 0x030, 0x00012207, + 0x030, 0x00013237, + 0x030, 0x00014237, + 0x030, 0x00015237, + 0x030, 0x00016207, + 0x030, 0x00017237, + 0x030, 0x00018207, + 0x030, 0x00019237, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000237, + 0x030, 0x00001237, + 0x030, 0x00002237, + 0x030, 0x00003237, + 0x030, 0x00004207, + 0x030, 0x00005237, + 0x030, 0x00006237, + 0x030, 0x00007237, + 0x030, 0x00008207, + 0x030, 0x00009237, + 0x030, 0x0000A237, + 0x030, 0x0000B237, + 0x030, 0x0000C237, + 0x030, 0x0000D237, + 0x030, 0x0000E207, + 0x030, 0x0000F237, + 0x030, 0x00010237, + 0x030, 0x00011237, + 0x030, 0x00012207, + 0x030, 0x00013237, + 0x030, 0x00014237, + 0x030, 0x00015237, + 0x030, 0x00016207, + 0x030, 0x00017237, + 0x030, 0x00018207, + 0x030, 0x00019237, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000238, + 0x030, 0x00001238, + 0x030, 0x00002238, + 0x030, 0x00003238, + 0x030, 0x00004228, + 0x030, 0x00005238, + 0x030, 0x00006238, + 0x030, 0x00007238, + 0x030, 0x00008228, + 0x030, 0x00009238, + 0x030, 0x0000A238, + 0x030, 0x0000B238, + 0x030, 0x0000C238, + 0x030, 0x0000D238, + 0x030, 0x0000E228, + 0x030, 0x0000F238, + 0x030, 0x00010238, + 0x030, 0x00011238, + 0x030, 0x00012228, + 0x030, 0x00013238, + 0x030, 0x00014238, + 0x030, 0x00015238, + 0x030, 0x00016228, + 0x030, 0x00017238, + 0x030, 0x00018228, + 0x030, 0x00019238, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000239, + 0x030, 0x00001239, + 0x030, 0x00002239, + 0x030, 0x00003239, + 0x030, 0x00004239, + 0x030, 0x00005239, + 0x030, 0x00006239, + 0x030, 0x00007239, + 0x030, 0x00008239, + 0x030, 0x00009239, + 0x030, 0x0000A239, + 0x030, 0x0000B239, + 0x030, 0x0000C239, + 0x030, 0x0000D239, + 0x030, 0x0000E209, + 0x030, 0x0000F239, + 0x030, 0x00010239, + 0x030, 0x00011239, + 0x030, 0x00012209, + 0x030, 0x00013239, + 0x030, 0x00014239, + 0x030, 0x00015239, + 0x030, 0x00016209, + 0x030, 0x00017239, + 0x030, 0x00018209, + 0x030, 0x00019239, + 0xA0000000, 0x00000000, + 0x030, 0x00000233, + 0x030, 0x00001233, + 0x030, 0x00002233, + 0x030, 0x00003233, + 0x030, 0x00004203, + 0x030, 0x00005233, + 0x030, 0x00006233, + 0x030, 0x00007233, + 0x030, 0x00008203, + 0x030, 0x00009233, + 0x030, 0x0000A233, + 0x030, 0x0000B233, + 0x030, 0x0000C233, + 0x030, 0x0000D233, + 0x030, 0x0000E203, + 0x030, 0x0000F233, + 0x030, 0x00010233, + 0x030, 0x00011233, + 0x030, 0x00012203, + 0x030, 0x00013233, + 0x030, 0x00014233, + 0x030, 0x00015233, + 0x030, 0x00016203, + 0x030, 0x00017233, + 0x030, 0x00018203, + 0x030, 0x00019233, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000080, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000232, + 0x030, 0x00001232, + 0x030, 0x00002232, + 0x030, 0x00003232, + 0x030, 0x00004232, + 0x030, 0x00005232, + 0x030, 0x00006232, + 0x030, 0x00007232, + 0x030, 0x00008232, + 0x030, 0x00009232, + 0x030, 0x0000A232, + 0x030, 0x0000B232, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000232, + 0x030, 0x00001232, + 0x030, 0x00002232, + 0x030, 0x00003232, + 0x030, 0x00004232, + 0x030, 0x00005232, + 0x030, 0x00006232, + 0x030, 0x00007232, + 0x030, 0x00008232, + 0x030, 0x00009232, + 0x030, 0x0000A232, + 0x030, 0x0000B232, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x00000334, + 0x030, 0x00001334, + 0x030, 0x00002334, + 0x030, 0x00003334, + 0x030, 0x00004334, + 0x030, 0x00005334, + 0x030, 0x00006334, + 0x030, 0x00007334, + 0x030, 0x00008334, + 0x030, 0x00009334, + 0x030, 0x0000A334, + 0x030, 0x0000B334, + 0xA0000000, 0x00000000, + 0x030, 0x00000232, + 0x030, 0x00001232, + 0x030, 0x00002232, + 0x030, 0x00003232, + 0x030, 0x00004232, + 0x030, 0x00005232, + 0x030, 0x00006232, + 0x030, 0x00007232, + 0x030, 0x00008232, + 0x030, 0x00009232, + 0x030, 0x0000A232, + 0x030, 0x0000B232, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EF, 0x00000040, + 0x030, 0x00000770, + 0x030, 0x00001770, + 0x030, 0x00002440, + 0x030, 0x00003440, + 0x030, 0x00004330, + 0x030, 0x00005330, + 0x030, 0x00008770, + 0x030, 0x0000A440, + 0x030, 0x0000C330, + 0x0EF, 0x00000000, + 0x0EE, 0x00010000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x00000005, + 0x033, 0x00000201, + 0x03F, 0x00000008, + 0x033, 0x00000202, + 0x03F, 0x0000000B, + 0x033, 0x00000203, + 0x03F, 0x0000000E, + 0x033, 0x00000204, + 0x03F, 0x0000002B, + 0x033, 0x00000205, + 0x03F, 0x0000002E, + 0x033, 0x00000206, + 0x03F, 0x0000006B, + 0x033, 0x00000207, + 0x03F, 0x0000006E, + 0x033, 0x00000208, + 0x03F, 0x00000071, + 0x033, 0x00000209, + 0x03F, 0x00000074, + 0x033, 0x0000020A, + 0x03F, 0x00000077, + 0xA0000000, 0x00000000, + 0x033, 0x00000200, + 0x03F, 0x0000006A, + 0x033, 0x00000201, + 0x03F, 0x0000006D, + 0x033, 0x00000202, + 0x03F, 0x0000046A, + 0x033, 0x00000203, + 0x03F, 0x0000086A, + 0x033, 0x00000204, + 0x03F, 0x00000C89, + 0x033, 0x00000205, + 0x03F, 0x00000CE8, + 0x033, 0x00000206, + 0x03F, 0x00000CEB, + 0x033, 0x00000207, + 0x03F, 0x00000CEE, + 0x033, 0x00000208, + 0x03F, 0x00000CF1, + 0x033, 0x00000209, + 0x03F, 0x00000CF4, + 0x033, 0x0000020A, + 0x03F, 0x00000CF7, + 0xB0000000, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x00000005, + 0x033, 0x00000281, + 0x03F, 0x00000008, + 0x033, 0x00000282, + 0x03F, 0x0000000B, + 0x033, 0x00000283, + 0x03F, 0x0000000E, + 0x033, 0x00000284, + 0x03F, 0x0000002B, + 0x033, 0x00000285, + 0x03F, 0x0000002E, + 0x033, 0x00000286, + 0x03F, 0x0000006B, + 0x033, 0x00000287, + 0x03F, 0x0000006E, + 0x033, 0x00000288, + 0x03F, 0x00000071, + 0x033, 0x00000289, + 0x03F, 0x00000074, + 0x033, 0x0000028A, + 0x03F, 0x00000077, + 0xA0000000, 0x00000000, + 0x033, 0x00000280, + 0x03F, 0x0000006A, + 0x033, 0x00000281, + 0x03F, 0x0000006D, + 0x033, 0x00000282, + 0x03F, 0x0000046A, + 0x033, 0x00000283, + 0x03F, 0x0000086A, + 0x033, 0x00000284, + 0x03F, 0x00000C89, + 0x033, 0x00000285, + 0x03F, 0x00000CE8, + 0x033, 0x00000286, + 0x03F, 0x00000CEB, + 0x033, 0x00000287, + 0x03F, 0x00000CEE, + 0x033, 0x00000288, + 0x03F, 0x00000CF1, + 0x033, 0x00000289, + 0x03F, 0x00000CF4, + 0x033, 0x0000028A, + 0x03F, 0x00000CF7, + 0xB0000000, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x00000005, + 0x033, 0x00000301, + 0x03F, 0x00000008, + 0x033, 0x00000302, + 0x03F, 0x0000000B, + 0x033, 0x00000303, + 0x03F, 0x0000000E, + 0x033, 0x00000304, + 0x03F, 0x0000002B, + 0x033, 0x00000305, + 0x03F, 0x0000002E, + 0x033, 0x00000306, + 0x03F, 0x00000031, + 0x033, 0x00000307, + 0x03F, 0x00000034, + 0x033, 0x00000308, + 0x03F, 0x00000053, + 0x033, 0x00000309, + 0x03F, 0x00000056, + 0x033, 0x0000030A, + 0x03F, 0x000000D1, + 0x0EE, 0x00000000, + 0xA0000000, 0x00000000, + 0x033, 0x00000300, + 0x03F, 0x0000006A, + 0x033, 0x00000301, + 0x03F, 0x0000006D, + 0x033, 0x00000302, + 0x03F, 0x0000046A, + 0x033, 0x00000303, + 0x03F, 0x0000086A, + 0x033, 0x00000304, + 0x03F, 0x00000C89, + 0x033, 0x00000305, + 0x03F, 0x00000CE8, + 0x033, 0x00000306, + 0x03F, 0x00000CEB, + 0x033, 0x00000307, + 0x03F, 0x00000CEE, + 0x033, 0x00000308, + 0x03F, 0x00000CF1, + 0x033, 0x00000309, + 0x03F, 0x00000CF4, + 0x033, 0x0000030A, + 0x03F, 0x00000CF7, + 0x0EE, 0x00000000, + 0xB0000000, 0x00000000, + 0x051, 0x0003C800, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000942C0, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000942C0, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x000902CA, + 0xA0000000, 0x00000000, + 0x052, 0x000942C0, + 0xB0000000, 0x00000000, + 0x053, 0x000090F9, + 0x054, 0x00088000, + 0x057, 0x0004C80A, + 0x0EF, 0x00000020, + 0x033, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0xB0000000, 0x00000000, + 0x033, 0x00000001, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0xB0000000, 0x00000000, + 0x033, 0x00000002, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000C246, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000C246, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0xA0000000, 0x00000000, + 0x03F, 0x0000C246, + 0xB0000000, 0x00000000, + 0x033, 0x00000003, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0xB0000000, 0x00000000, + 0x033, 0x00000004, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0xB0000000, 0x00000000, + 0x033, 0x00000005, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000C246, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000C246, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0xA0000000, 0x00000000, + 0x03F, 0x0000C246, + 0xB0000000, 0x00000000, + 0x033, 0x00000006, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0xB0000000, 0x00000000, + 0x033, 0x00000007, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0000C246, + 0xB0000000, 0x00000000, + 0x033, 0x00000008, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000C246, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0000C246, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0xA0000000, 0x00000000, + 0x03F, 0x0000C246, + 0xB0000000, 0x00000000, + 0x033, 0x00000009, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000A, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000B, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000C, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000D, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000241C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000E, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002C246, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000000F, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000010, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000011, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00024246, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000012, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000013, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000014, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000015, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000016, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000017, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000018, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000019, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001A, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001B, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001C, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001D, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001E, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000001F, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000020, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000021, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000022, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000023, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0002CA46, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000024, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000025, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000026, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000027, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000028, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03E, 0x00000030, + 0x03F, 0x000209C6, + 0xA0000000, 0x00000000, + 0x03E, 0x00000020, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x00000029, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0002CA46, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x033, 0x0000002A, + 0x03E, 0x00000020, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x00008E46, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x0001CA46, + 0xA0000000, 0x00000000, + 0x03F, 0x00008E46, + 0xB0000000, 0x00000000, + 0x0EF, 0x00000000, + 0x0EE, 0x00010000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000487, + 0x033, 0x00000061, + 0x03F, 0x00000887, + 0x033, 0x00000062, + 0x03F, 0x00000947, + 0x033, 0x00000063, + 0x03F, 0x00000D48, + 0x033, 0x00000064, + 0x03F, 0x00000D88, + 0x033, 0x00000065, + 0x03F, 0x00000DE8, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000487, + 0x033, 0x00000061, + 0x03F, 0x00000887, + 0x033, 0x00000062, + 0x03F, 0x00000947, + 0x033, 0x00000063, + 0x03F, 0x00000D48, + 0x033, 0x00000064, + 0x03F, 0x00000D88, + 0x033, 0x00000065, + 0x03F, 0x00000DE8, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000468, + 0x033, 0x00000061, + 0x03F, 0x00000868, + 0x033, 0x00000062, + 0x03F, 0x00000909, + 0x033, 0x00000063, + 0x03F, 0x00000D0A, + 0x033, 0x00000064, + 0x03F, 0x00000D4A, + 0x033, 0x00000065, + 0x03F, 0x00000D8B, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000468, + 0x033, 0x00000061, + 0x03F, 0x00000868, + 0x033, 0x00000062, + 0x03F, 0x00000909, + 0x033, 0x00000063, + 0x03F, 0x00000D0A, + 0x033, 0x00000064, + 0x03F, 0x00000D4A, + 0x033, 0x00000065, + 0x03F, 0x00000D8B, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000468, + 0x033, 0x00000061, + 0x03F, 0x00000868, + 0x033, 0x00000062, + 0x03F, 0x00000909, + 0x033, 0x00000063, + 0x03F, 0x00000D0A, + 0x033, 0x00000064, + 0x03F, 0x00000D4A, + 0x033, 0x00000065, + 0x03F, 0x00000D8B, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000468, + 0x033, 0x00000061, + 0x03F, 0x00000868, + 0x033, 0x00000062, + 0x03F, 0x00000909, + 0x033, 0x00000063, + 0x03F, 0x00000D0A, + 0x033, 0x00000064, + 0x03F, 0x00000D4A, + 0x033, 0x00000065, + 0x03F, 0x00000D8B, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000467, + 0x033, 0x00000061, + 0x03F, 0x00000867, + 0x033, 0x00000062, + 0x03F, 0x00000908, + 0x033, 0x00000063, + 0x03F, 0x00000CC6, + 0x033, 0x00000064, + 0x03F, 0x00000CC9, + 0x033, 0x00000065, + 0x03F, 0x00000CCC, + 0x033, 0x00000066, + 0x03F, 0x00000CCF, + 0x033, 0x00000067, + 0x03F, 0x00000CD2, + 0x033, 0x00000068, + 0x03F, 0x00000CD5, + 0x033, 0x00000069, + 0x03F, 0x00000DD4, + 0x033, 0x0000006A, + 0x03F, 0x00000DD7, + 0xA0000000, 0x00000000, + 0x033, 0x00000060, + 0x03F, 0x00000487, + 0x033, 0x00000061, + 0x03F, 0x00000887, + 0x033, 0x00000062, + 0x03F, 0x00000947, + 0x033, 0x00000063, + 0x03F, 0x00000D48, + 0x033, 0x00000064, + 0x03F, 0x00000D88, + 0x033, 0x00000065, + 0x03F, 0x00000DE8, + 0x033, 0x00000066, + 0x03F, 0x00000DEB, + 0x033, 0x00000067, + 0x03F, 0x00000DEE, + 0x033, 0x00000068, + 0x03F, 0x00000DF1, + 0x033, 0x00000069, + 0x03F, 0x00000DF4, + 0x033, 0x0000006A, + 0x03F, 0x00000DF7, + 0xB0000000, 0x00000000, + 0x8f000000, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000487, + 0x033, 0x00000021, + 0x03F, 0x00000887, + 0x033, 0x00000022, + 0x03F, 0x00000947, + 0x033, 0x00000023, + 0x03F, 0x00000D48, + 0x033, 0x00000024, + 0x03F, 0x00000D88, + 0x033, 0x00000025, + 0x03F, 0x00000DE8, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x9f000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000487, + 0x033, 0x00000021, + 0x03F, 0x00000887, + 0x033, 0x00000022, + 0x03F, 0x00000947, + 0x033, 0x00000023, + 0x03F, 0x00000D48, + 0x033, 0x00000024, + 0x03F, 0x00000D88, + 0x033, 0x00000025, + 0x03F, 0x00000DE8, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x91000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000468, + 0x033, 0x00000021, + 0x03F, 0x00000868, + 0x033, 0x00000022, + 0x03F, 0x00000909, + 0x033, 0x00000023, + 0x03F, 0x00000D0A, + 0x033, 0x00000024, + 0x03F, 0x00000D4A, + 0x033, 0x00000025, + 0x03F, 0x00000D8B, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x91000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000468, + 0x033, 0x00000021, + 0x03F, 0x00000868, + 0x033, 0x00000022, + 0x03F, 0x00000909, + 0x033, 0x00000023, + 0x03F, 0x00000D0A, + 0x033, 0x00000024, + 0x03F, 0x00000D4A, + 0x033, 0x00000025, + 0x03F, 0x00000D8B, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x92000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000468, + 0x033, 0x00000021, + 0x03F, 0x00000868, + 0x033, 0x00000022, + 0x03F, 0x00000909, + 0x033, 0x00000023, + 0x03F, 0x00000D0A, + 0x033, 0x00000024, + 0x03F, 0x00000D4A, + 0x033, 0x00000025, + 0x03F, 0x00000D8B, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x92000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000468, + 0x033, 0x00000021, + 0x03F, 0x00000868, + 0x033, 0x00000022, + 0x03F, 0x00000909, + 0x033, 0x00000023, + 0x03F, 0x00000D0A, + 0x033, 0x00000024, + 0x03F, 0x00000D4A, + 0x033, 0x00000025, + 0x03F, 0x00000D8B, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x93000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x94000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000001, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000002, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000003, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000004, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000005, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000006, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000015, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0x95000016, 0x00000000, 0x40000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000467, + 0x033, 0x00000021, + 0x03F, 0x00000867, + 0x033, 0x00000022, + 0x03F, 0x00000908, + 0x033, 0x00000023, + 0x03F, 0x00000D09, + 0x033, 0x00000024, + 0x03F, 0x00000D49, + 0x033, 0x00000025, + 0x03F, 0x00000D8A, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0xA0000000, 0x00000000, + 0x033, 0x00000020, + 0x03F, 0x00000487, + 0x033, 0x00000021, + 0x03F, 0x00000887, + 0x033, 0x00000022, + 0x03F, 0x00000947, + 0x033, 0x00000023, + 0x03F, 0x00000D48, + 0x033, 0x00000024, + 0x03F, 0x00000D88, + 0x033, 0x00000025, + 0x03F, 0x00000DE8, + 0x033, 0x00000026, + 0x03F, 0x00000DEB, + 0x033, 0x00000027, + 0x03F, 0x00000DEE, + 0x033, 0x00000028, + 0x03F, 0x00000DF1, + 0x033, 0x00000029, + 0x03F, 0x00000DF4, + 0x033, 0x0000002A, + 0x03F, 0x00000DF7, + 0xB0000000, 0x00000000, + 0x0EE, 0x00000000, + 0x05C, 0x000FC000, + 0x067, 0x0000A505, + 0x0D3, 0x00000542, + 0x043, 0x00005000, + 0x059, 0x000A0000, + 0x05A, 0x00060000, + 0x05B, 0x00014000, + 0x001, 0x00040000, + 0x0EE, 0x00000002, + 0x033, 0x00000017, + 0x03F, 0x0000003F, + 0x033, 0x00000018, + 0x03F, 0x0000003F, + 0x033, 0x00000019, + 0x03F, 0x00000000, + 0x033, 0x0000001A, + 0x03F, 0x0000003F, + 0x033, 0x0000001B, + 0x03F, 0x0000003F, + 0x033, 0x0000001C, + 0x03F, 0x0000003F, + 0x0EE, 0x00000000, + 0x092, 0x00084800, + 0x092, 0x00084801, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x0FE, 0x00000000, + 0x092, 0x00084800, + 0x08F, 0x00001B4C, + 0x088, 0x0004326B, + 0x019, 0x00000005, + 0x0EF, 0x00080000, + 0x033, 0x00000004, + 0x03F, 0x000FD83F, + 0x0EF, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000006, + 0x03F, 0x000DD83F, + 0x0EF, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000007, + 0x03F, 0x000DF7BF, + 0x0EF, 0x00000000, + 0x0EF, 0x00040000, + 0x033, 0x00000006, + 0x03F, 0x00000002, + 0x033, 0x00000007, + 0x03F, 0x00000002, + 0x0EF, 0x00000000, +}; + +RTW_DECL_TABLE_RF_RADIO(rtw8822c_rf_b, B); + +static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type0[] = { + { 0, 0, 0, 0, 1, 72, }, + { 2, 0, 0, 0, 1, 60, }, + { 1, 0, 0, 0, 1, 68, }, + { 3, 0, 0, 0, 1, 72, }, + { 4, 0, 0, 0, 1, 76, }, + { 5, 0, 0, 0, 1, 60, }, + { 6, 0, 0, 0, 1, 72, }, + { 7, 0, 0, 0, 1, 60, }, + { 8, 0, 0, 0, 1, 72, }, + { 9, 0, 0, 0, 1, 60, }, + { 0, 0, 0, 0, 2, 72, }, + { 2, 0, 0, 0, 2, 60, }, + { 1, 0, 0, 0, 2, 68, }, + { 3, 0, 0, 0, 2, 72, }, + { 4, 0, 0, 0, 2, 76, }, + { 5, 0, 0, 0, 2, 60, }, + { 6, 0, 0, 0, 2, 72, }, + { 7, 0, 0, 0, 2, 60, }, + { 8, 0, 0, 0, 2, 72, }, + { 9, 0, 0, 0, 2, 60, }, + { 0, 0, 0, 0, 3, 76, }, + { 2, 0, 0, 0, 3, 60, }, + { 1, 0, 0, 0, 3, 68, }, + { 3, 0, 0, 0, 3, 76, }, + { 4, 0, 0, 0, 3, 76, }, + { 5, 0, 0, 0, 3, 60, }, + { 6, 0, 0, 0, 3, 76, }, + { 7, 0, 0, 0, 3, 60, }, + { 8, 0, 0, 0, 3, 76, }, + { 9, 0, 0, 0, 3, 60, }, + { 0, 0, 0, 0, 4, 76, }, + { 2, 0, 0, 0, 4, 60, }, + { 1, 0, 0, 0, 4, 68, }, + { 3, 0, 0, 0, 4, 76, }, + { 4, 0, 0, 0, 4, 76, }, + { 5, 0, 0, 0, 4, 60, }, + { 6, 0, 0, 0, 4, 76, }, + { 7, 0, 0, 0, 4, 60, }, + { 8, 0, 0, 0, 4, 76, }, + { 9, 0, 0, 0, 4, 60, }, + { 0, 0, 0, 0, 5, 76, }, + { 2, 0, 0, 0, 5, 60, }, + { 1, 0, 0, 0, 5, 68, }, + { 3, 0, 0, 0, 5, 76, }, + { 4, 0, 0, 0, 5, 76, }, + { 5, 0, 0, 0, 5, 60, }, + { 6, 0, 0, 0, 5, 76, }, + { 7, 0, 0, 0, 5, 60, }, + { 8, 0, 0, 0, 5, 76, }, + { 9, 0, 0, 0, 5, 60, }, + { 0, 0, 0, 0, 6, 76, }, + { 2, 0, 0, 0, 6, 60, }, + { 1, 0, 0, 0, 6, 68, }, + { 3, 0, 0, 0, 6, 76, }, + { 4, 0, 0, 0, 6, 76, }, + { 5, 0, 0, 0, 6, 60, }, + { 6, 0, 0, 0, 6, 76, }, + { 7, 0, 0, 0, 6, 60, }, + { 8, 0, 0, 0, 6, 76, }, + { 9, 0, 0, 0, 6, 60, }, + { 0, 0, 0, 0, 7, 76, }, + { 2, 0, 0, 0, 7, 60, }, + { 1, 0, 0, 0, 7, 68, }, + { 3, 0, 0, 0, 7, 76, }, + { 4, 0, 0, 0, 7, 76, }, + { 5, 0, 0, 0, 7, 60, }, + { 6, 0, 0, 0, 7, 76, }, + { 7, 0, 0, 0, 7, 60, }, + { 8, 0, 0, 0, 7, 76, }, + { 9, 0, 0, 0, 7, 60, }, + { 0, 0, 0, 0, 8, 76, }, + { 2, 0, 0, 0, 8, 60, }, + { 1, 0, 0, 0, 8, 68, }, + { 3, 0, 0, 0, 8, 76, }, + { 4, 0, 0, 0, 8, 76, }, + { 5, 0, 0, 0, 8, 60, }, + { 6, 0, 0, 0, 8, 76, }, + { 7, 0, 0, 0, 8, 60, }, + { 8, 0, 0, 0, 8, 76, }, + { 9, 0, 0, 0, 8, 60, }, + { 0, 0, 0, 0, 9, 76, }, + { 2, 0, 0, 0, 9, 60, }, + { 1, 0, 0, 0, 9, 68, }, + { 3, 0, 0, 0, 9, 76, }, + { 4, 0, 0, 0, 9, 76, }, + { 5, 0, 0, 0, 9, 60, }, + { 6, 0, 0, 0, 9, 76, }, + { 7, 0, 0, 0, 9, 60, }, + { 8, 0, 0, 0, 9, 76, }, + { 9, 0, 0, 0, 9, 60, }, + { 0, 0, 0, 0, 10, 72, }, + { 2, 0, 0, 0, 10, 60, }, + { 1, 0, 0, 0, 10, 68, }, + { 3, 0, 0, 0, 10, 72, }, + { 4, 0, 0, 0, 10, 76, }, + { 5, 0, 0, 0, 10, 60, }, + { 6, 0, 0, 0, 10, 72, }, + { 7, 0, 0, 0, 10, 60, }, + { 8, 0, 0, 0, 10, 72, }, + { 9, 0, 0, 0, 10, 60, }, + { 0, 0, 0, 0, 11, 72, }, + { 2, 0, 0, 0, 11, 60, }, + { 1, 0, 0, 0, 11, 68, }, + { 3, 0, 0, 0, 11, 72, }, + { 4, 0, 0, 0, 11, 76, }, + { 5, 0, 0, 0, 11, 60, }, + { 6, 0, 0, 0, 11, 72, }, + { 7, 0, 0, 0, 11, 60, }, + { 8, 0, 0, 0, 11, 72, }, + { 9, 0, 0, 0, 11, 60, }, + { 0, 0, 0, 0, 12, 44, }, + { 2, 0, 0, 0, 12, 60, }, + { 1, 0, 0, 0, 12, 68, }, + { 3, 0, 0, 0, 12, 52, }, + { 4, 0, 0, 0, 12, 76, }, + { 5, 0, 0, 0, 12, 60, }, + { 6, 0, 0, 0, 12, 52, }, + { 7, 0, 0, 0, 12, 60, }, + { 8, 0, 0, 0, 12, 52, }, + { 9, 0, 0, 0, 12, 60, }, + { 0, 0, 0, 0, 13, 40, }, + { 2, 0, 0, 0, 13, 60, }, + { 1, 0, 0, 0, 13, 68, }, + { 3, 0, 0, 0, 13, 48, }, + { 4, 0, 0, 0, 13, 76, }, + { 5, 0, 0, 0, 13, 60, }, + { 6, 0, 0, 0, 13, 48, }, + { 7, 0, 0, 0, 13, 60, }, + { 8, 0, 0, 0, 13, 48, }, + { 9, 0, 0, 0, 13, 60, }, + { 0, 0, 0, 0, 14, 127, }, + { 2, 0, 0, 0, 14, 127, }, + { 1, 0, 0, 0, 14, 68, }, + { 3, 0, 0, 0, 14, 127, }, + { 4, 0, 0, 0, 14, 127, }, + { 5, 0, 0, 0, 14, 127, }, + { 6, 0, 0, 0, 14, 127, }, + { 7, 0, 0, 0, 14, 127, }, + { 8, 0, 0, 0, 14, 127, }, + { 9, 0, 0, 0, 14, 127, }, + { 0, 0, 0, 1, 1, 52, }, + { 2, 0, 0, 1, 1, 60, }, + { 1, 0, 0, 1, 1, 76, }, + { 3, 0, 0, 1, 1, 52, }, + { 4, 0, 0, 1, 1, 76, }, + { 5, 0, 0, 1, 1, 60, }, + { 6, 0, 0, 1, 1, 52, }, + { 7, 0, 0, 1, 1, 60, }, + { 8, 0, 0, 1, 1, 52, }, + { 9, 0, 0, 1, 1, 60, }, + { 0, 0, 0, 1, 2, 60, }, + { 2, 0, 0, 1, 2, 60, }, + { 1, 0, 0, 1, 2, 76, }, + { 3, 0, 0, 1, 2, 60, }, + { 4, 0, 0, 1, 2, 76, }, + { 5, 0, 0, 1, 2, 60, }, + { 6, 0, 0, 1, 2, 60, }, + { 7, 0, 0, 1, 2, 60, }, + { 8, 0, 0, 1, 2, 60, }, + { 9, 0, 0, 1, 2, 60, }, + { 0, 0, 0, 1, 3, 64, }, + { 2, 0, 0, 1, 3, 60, }, + { 1, 0, 0, 1, 3, 76, }, + { 3, 0, 0, 1, 3, 64, }, + { 4, 0, 0, 1, 3, 76, }, + { 5, 0, 0, 1, 3, 60, }, + { 6, 0, 0, 1, 3, 64, }, + { 7, 0, 0, 1, 3, 60, }, + { 8, 0, 0, 1, 3, 64, }, + { 9, 0, 0, 1, 3, 60, }, + { 0, 0, 0, 1, 4, 68, }, + { 2, 0, 0, 1, 4, 60, }, + { 1, 0, 0, 1, 4, 76, }, + { 3, 0, 0, 1, 4, 68, }, + { 4, 0, 0, 1, 4, 76, }, + { 5, 0, 0, 1, 4, 60, }, + { 6, 0, 0, 1, 4, 68, }, + { 7, 0, 0, 1, 4, 60, }, + { 8, 0, 0, 1, 4, 68, }, + { 9, 0, 0, 1, 4, 60, }, + { 0, 0, 0, 1, 5, 76, }, + { 2, 0, 0, 1, 5, 60, }, + { 1, 0, 0, 1, 5, 76, }, + { 3, 0, 0, 1, 5, 76, }, + { 4, 0, 0, 1, 5, 76, }, + { 5, 0, 0, 1, 5, 60, }, + { 6, 0, 0, 1, 5, 76, }, + { 7, 0, 0, 1, 5, 60, }, + { 8, 0, 0, 1, 5, 76, }, + { 9, 0, 0, 1, 5, 60, }, + { 0, 0, 0, 1, 6, 76, }, + { 2, 0, 0, 1, 6, 60, }, + { 1, 0, 0, 1, 6, 76, }, + { 3, 0, 0, 1, 6, 76, }, + { 4, 0, 0, 1, 6, 76, }, + { 5, 0, 0, 1, 6, 60, }, + { 6, 0, 0, 1, 6, 76, }, + { 7, 0, 0, 1, 6, 60, }, + { 8, 0, 0, 1, 6, 76, }, + { 9, 0, 0, 1, 6, 60, }, + { 0, 0, 0, 1, 7, 76, }, + { 2, 0, 0, 1, 7, 60, }, + { 1, 0, 0, 1, 7, 76, }, + { 3, 0, 0, 1, 7, 76, }, + { 4, 0, 0, 1, 7, 76, }, + { 5, 0, 0, 1, 7, 60, }, + { 6, 0, 0, 1, 7, 76, }, + { 7, 0, 0, 1, 7, 60, }, + { 8, 0, 0, 1, 7, 76, }, + { 9, 0, 0, 1, 7, 60, }, + { 0, 0, 0, 1, 8, 68, }, + { 2, 0, 0, 1, 8, 60, }, + { 1, 0, 0, 1, 8, 76, }, + { 3, 0, 0, 1, 8, 68, }, + { 4, 0, 0, 1, 8, 76, }, + { 5, 0, 0, 1, 8, 60, }, + { 6, 0, 0, 1, 8, 68, }, + { 7, 0, 0, 1, 8, 60, }, + { 8, 0, 0, 1, 8, 68, }, + { 9, 0, 0, 1, 8, 60, }, + { 0, 0, 0, 1, 9, 64, }, + { 2, 0, 0, 1, 9, 60, }, + { 1, 0, 0, 1, 9, 76, }, + { 3, 0, 0, 1, 9, 64, }, + { 4, 0, 0, 1, 9, 76, }, + { 5, 0, 0, 1, 9, 60, }, + { 6, 0, 0, 1, 9, 64, }, + { 7, 0, 0, 1, 9, 60, }, + { 8, 0, 0, 1, 9, 64, }, + { 9, 0, 0, 1, 9, 60, }, + { 0, 0, 0, 1, 10, 60, }, + { 2, 0, 0, 1, 10, 60, }, + { 1, 0, 0, 1, 10, 76, }, + { 3, 0, 0, 1, 10, 60, }, + { 4, 0, 0, 1, 10, 76, }, + { 5, 0, 0, 1, 10, 60, }, + { 6, 0, 0, 1, 10, 60, }, + { 7, 0, 0, 1, 10, 60, }, + { 8, 0, 0, 1, 10, 60, }, + { 9, 0, 0, 1, 10, 60, }, + { 0, 0, 0, 1, 11, 52, }, + { 2, 0, 0, 1, 11, 60, }, + { 1, 0, 0, 1, 11, 76, }, + { 3, 0, 0, 1, 11, 52, }, + { 4, 0, 0, 1, 11, 76, }, + { 5, 0, 0, 1, 11, 60, }, + { 6, 0, 0, 1, 11, 52, }, + { 7, 0, 0, 1, 11, 60, }, + { 8, 0, 0, 1, 11, 52, }, + { 9, 0, 0, 1, 11, 60, }, + { 0, 0, 0, 1, 12, 32, }, + { 2, 0, 0, 1, 12, 60, }, + { 1, 0, 0, 1, 12, 76, }, + { 3, 0, 0, 1, 12, 40, }, + { 4, 0, 0, 1, 12, 76, }, + { 5, 0, 0, 1, 12, 60, }, + { 6, 0, 0, 1, 12, 40, }, + { 7, 0, 0, 1, 12, 60, }, + { 8, 0, 0, 1, 12, 40, }, + { 9, 0, 0, 1, 12, 60, }, + { 0, 0, 0, 1, 13, 20, }, + { 2, 0, 0, 1, 13, 60, }, + { 1, 0, 0, 1, 13, 76, }, + { 3, 0, 0, 1, 13, 28, }, + { 4, 0, 0, 1, 13, 70, }, + { 5, 0, 0, 1, 13, 60, }, + { 6, 0, 0, 1, 13, 28, }, + { 7, 0, 0, 1, 13, 60, }, + { 8, 0, 0, 1, 13, 28, }, + { 9, 0, 0, 1, 13, 60, }, + { 0, 0, 0, 1, 14, 127, }, + { 2, 0, 0, 1, 14, 127, }, + { 1, 0, 0, 1, 14, 127, }, + { 3, 0, 0, 1, 14, 127, }, + { 4, 0, 0, 1, 14, 127, }, + { 5, 0, 0, 1, 14, 127, }, + { 6, 0, 0, 1, 14, 127, }, + { 7, 0, 0, 1, 14, 127, }, + { 8, 0, 0, 1, 14, 127, }, + { 9, 0, 0, 1, 14, 127, }, + { 0, 0, 0, 2, 1, 52, }, + { 2, 0, 0, 2, 1, 60, }, + { 1, 0, 0, 2, 1, 76, }, + { 3, 0, 0, 2, 1, 52, }, + { 4, 0, 0, 2, 1, 76, }, + { 5, 0, 0, 2, 1, 60, }, + { 6, 0, 0, 2, 1, 52, }, + { 7, 0, 0, 2, 1, 60, }, + { 8, 0, 0, 2, 1, 52, }, + { 9, 0, 0, 2, 1, 60, }, + { 0, 0, 0, 2, 2, 60, }, + { 2, 0, 0, 2, 2, 60, }, + { 1, 0, 0, 2, 2, 76, }, + { 3, 0, 0, 2, 2, 60, }, + { 4, 0, 0, 2, 2, 76, }, + { 5, 0, 0, 2, 2, 60, }, + { 6, 0, 0, 2, 2, 60, }, + { 7, 0, 0, 2, 2, 60, }, + { 8, 0, 0, 2, 2, 60, }, + { 9, 0, 0, 2, 2, 60, }, + { 0, 0, 0, 2, 3, 64, }, + { 2, 0, 0, 2, 3, 60, }, + { 1, 0, 0, 2, 3, 76, }, + { 3, 0, 0, 2, 3, 64, }, + { 4, 0, 0, 2, 3, 76, }, + { 5, 0, 0, 2, 3, 60, }, + { 6, 0, 0, 2, 3, 64, }, + { 7, 0, 0, 2, 3, 60, }, + { 8, 0, 0, 2, 3, 64, }, + { 9, 0, 0, 2, 3, 60, }, + { 0, 0, 0, 2, 4, 68, }, + { 2, 0, 0, 2, 4, 60, }, + { 1, 0, 0, 2, 4, 76, }, + { 3, 0, 0, 2, 4, 68, }, + { 4, 0, 0, 2, 4, 76, }, + { 5, 0, 0, 2, 4, 60, }, + { 6, 0, 0, 2, 4, 68, }, + { 7, 0, 0, 2, 4, 60, }, + { 8, 0, 0, 2, 4, 68, }, + { 9, 0, 0, 2, 4, 60, }, + { 0, 0, 0, 2, 5, 76, }, + { 2, 0, 0, 2, 5, 60, }, + { 1, 0, 0, 2, 5, 76, }, + { 3, 0, 0, 2, 5, 76, }, + { 4, 0, 0, 2, 5, 76, }, + { 5, 0, 0, 2, 5, 60, }, + { 6, 0, 0, 2, 5, 76, }, + { 7, 0, 0, 2, 5, 60, }, + { 8, 0, 0, 2, 5, 76, }, + { 9, 0, 0, 2, 5, 60, }, + { 0, 0, 0, 2, 6, 76, }, + { 2, 0, 0, 2, 6, 60, }, + { 1, 0, 0, 2, 6, 76, }, + { 3, 0, 0, 2, 6, 76, }, + { 4, 0, 0, 2, 6, 76, }, + { 5, 0, 0, 2, 6, 60, }, + { 6, 0, 0, 2, 6, 76, }, + { 7, 0, 0, 2, 6, 60, }, + { 8, 0, 0, 2, 6, 76, }, + { 9, 0, 0, 2, 6, 60, }, + { 0, 0, 0, 2, 7, 76, }, + { 2, 0, 0, 2, 7, 60, }, + { 1, 0, 0, 2, 7, 76, }, + { 3, 0, 0, 2, 7, 76, }, + { 4, 0, 0, 2, 7, 76, }, + { 5, 0, 0, 2, 7, 60, }, + { 6, 0, 0, 2, 7, 76, }, + { 7, 0, 0, 2, 7, 60, }, + { 8, 0, 0, 2, 7, 76, }, + { 9, 0, 0, 2, 7, 60, }, + { 0, 0, 0, 2, 8, 68, }, + { 2, 0, 0, 2, 8, 60, }, + { 1, 0, 0, 2, 8, 76, }, + { 3, 0, 0, 2, 8, 68, }, + { 4, 0, 0, 2, 8, 76, }, + { 5, 0, 0, 2, 8, 60, }, + { 6, 0, 0, 2, 8, 68, }, + { 7, 0, 0, 2, 8, 60, }, + { 8, 0, 0, 2, 8, 68, }, + { 9, 0, 0, 2, 8, 60, }, + { 0, 0, 0, 2, 9, 64, }, + { 2, 0, 0, 2, 9, 60, }, + { 1, 0, 0, 2, 9, 76, }, + { 3, 0, 0, 2, 9, 64, }, + { 4, 0, 0, 2, 9, 76, }, + { 5, 0, 0, 2, 9, 60, }, + { 6, 0, 0, 2, 9, 64, }, + { 7, 0, 0, 2, 9, 60, }, + { 8, 0, 0, 2, 9, 64, }, + { 9, 0, 0, 2, 9, 60, }, + { 0, 0, 0, 2, 10, 60, }, + { 2, 0, 0, 2, 10, 60, }, + { 1, 0, 0, 2, 10, 76, }, + { 3, 0, 0, 2, 10, 60, }, + { 4, 0, 0, 2, 10, 76, }, + { 5, 0, 0, 2, 10, 60, }, + { 6, 0, 0, 2, 10, 60, }, + { 7, 0, 0, 2, 10, 60, }, + { 8, 0, 0, 2, 10, 60, }, + { 9, 0, 0, 2, 10, 60, }, + { 0, 0, 0, 2, 11, 52, }, + { 2, 0, 0, 2, 11, 60, }, + { 1, 0, 0, 2, 11, 76, }, + { 3, 0, 0, 2, 11, 52, }, + { 4, 0, 0, 2, 11, 76, }, + { 5, 0, 0, 2, 11, 60, }, + { 6, 0, 0, 2, 11, 52, }, + { 7, 0, 0, 2, 11, 60, }, + { 8, 0, 0, 2, 11, 52, }, + { 9, 0, 0, 2, 11, 60, }, + { 0, 0, 0, 2, 12, 32, }, + { 2, 0, 0, 2, 12, 60, }, + { 1, 0, 0, 2, 12, 76, }, + { 3, 0, 0, 2, 12, 40, }, + { 4, 0, 0, 2, 12, 76, }, + { 5, 0, 0, 2, 12, 60, }, + { 6, 0, 0, 2, 12, 40, }, + { 7, 0, 0, 2, 12, 60, }, + { 8, 0, 0, 2, 12, 40, }, + { 9, 0, 0, 2, 12, 60, }, + { 0, 0, 0, 2, 13, 20, }, + { 2, 0, 0, 2, 13, 60, }, + { 1, 0, 0, 2, 13, 76, }, + { 3, 0, 0, 2, 13, 28, }, + { 4, 0, 0, 2, 13, 72, }, + { 5, 0, 0, 2, 13, 60, }, + { 6, 0, 0, 2, 13, 28, }, + { 7, 0, 0, 2, 13, 60, }, + { 8, 0, 0, 2, 13, 28, }, + { 9, 0, 0, 2, 13, 60, }, + { 0, 0, 0, 2, 14, 127, }, + { 2, 0, 0, 2, 14, 127, }, + { 1, 0, 0, 2, 14, 127, }, + { 3, 0, 0, 2, 14, 127, }, + { 4, 0, 0, 2, 14, 127, }, + { 5, 0, 0, 2, 14, 127, }, + { 6, 0, 0, 2, 14, 127, }, + { 7, 0, 0, 2, 14, 127, }, + { 8, 0, 0, 2, 14, 127, }, + { 9, 0, 0, 2, 14, 127, }, + { 0, 0, 0, 3, 1, 52, }, + { 2, 0, 0, 3, 1, 36, }, + { 1, 0, 0, 3, 1, 66, }, + { 3, 0, 0, 3, 1, 52, }, + { 4, 0, 0, 3, 1, 68, }, + { 5, 0, 0, 3, 1, 36, }, + { 6, 0, 0, 3, 1, 52, }, + { 7, 0, 0, 3, 1, 36, }, + { 8, 0, 0, 3, 1, 52, }, + { 9, 0, 0, 3, 1, 36, }, + { 0, 0, 0, 3, 2, 60, }, + { 2, 0, 0, 3, 2, 36, }, + { 1, 0, 0, 3, 2, 66, }, + { 3, 0, 0, 3, 2, 60, }, + { 4, 0, 0, 3, 2, 70, }, + { 5, 0, 0, 3, 2, 36, }, + { 6, 0, 0, 3, 2, 60, }, + { 7, 0, 0, 3, 2, 36, }, + { 8, 0, 0, 3, 2, 60, }, + { 9, 0, 0, 3, 2, 36, }, + { 0, 0, 0, 3, 3, 64, }, + { 2, 0, 0, 3, 3, 36, }, + { 1, 0, 0, 3, 3, 66, }, + { 3, 0, 0, 3, 3, 64, }, + { 4, 0, 0, 3, 3, 70, }, + { 5, 0, 0, 3, 3, 36, }, + { 6, 0, 0, 3, 3, 64, }, + { 7, 0, 0, 3, 3, 36, }, + { 8, 0, 0, 3, 3, 64, }, + { 9, 0, 0, 3, 3, 36, }, + { 0, 0, 0, 3, 4, 68, }, + { 2, 0, 0, 3, 4, 36, }, + { 1, 0, 0, 3, 4, 66, }, + { 3, 0, 0, 3, 4, 68, }, + { 4, 0, 0, 3, 4, 70, }, + { 5, 0, 0, 3, 4, 36, }, + { 6, 0, 0, 3, 4, 68, }, + { 7, 0, 0, 3, 4, 36, }, + { 8, 0, 0, 3, 4, 68, }, + { 9, 0, 0, 3, 4, 36, }, + { 0, 0, 0, 3, 5, 76, }, + { 2, 0, 0, 3, 5, 36, }, + { 1, 0, 0, 3, 5, 66, }, + { 3, 0, 0, 3, 5, 76, }, + { 4, 0, 0, 3, 5, 70, }, + { 5, 0, 0, 3, 5, 36, }, + { 6, 0, 0, 3, 5, 76, }, + { 7, 0, 0, 3, 5, 36, }, + { 8, 0, 0, 3, 5, 76, }, + { 9, 0, 0, 3, 5, 36, }, + { 0, 0, 0, 3, 6, 76, }, + { 2, 0, 0, 3, 6, 36, }, + { 1, 0, 0, 3, 6, 66, }, + { 3, 0, 0, 3, 6, 76, }, + { 4, 0, 0, 3, 6, 70, }, + { 5, 0, 0, 3, 6, 36, }, + { 6, 0, 0, 3, 6, 76, }, + { 7, 0, 0, 3, 6, 36, }, + { 8, 0, 0, 3, 6, 76, }, + { 9, 0, 0, 3, 6, 36, }, + { 0, 0, 0, 3, 7, 76, }, + { 2, 0, 0, 3, 7, 36, }, + { 1, 0, 0, 3, 7, 66, }, + { 3, 0, 0, 3, 7, 76, }, + { 4, 0, 0, 3, 7, 70, }, + { 5, 0, 0, 3, 7, 36, }, + { 6, 0, 0, 3, 7, 76, }, + { 7, 0, 0, 3, 7, 36, }, + { 8, 0, 0, 3, 7, 76, }, + { 9, 0, 0, 3, 7, 36, }, + { 0, 0, 0, 3, 8, 68, }, + { 2, 0, 0, 3, 8, 36, }, + { 1, 0, 0, 3, 8, 66, }, + { 3, 0, 0, 3, 8, 68, }, + { 4, 0, 0, 3, 8, 70, }, + { 5, 0, 0, 3, 8, 36, }, + { 6, 0, 0, 3, 8, 68, }, + { 7, 0, 0, 3, 8, 36, }, + { 8, 0, 0, 3, 8, 68, }, + { 9, 0, 0, 3, 8, 36, }, + { 0, 0, 0, 3, 9, 64, }, + { 2, 0, 0, 3, 9, 36, }, + { 1, 0, 0, 3, 9, 66, }, + { 3, 0, 0, 3, 9, 64, }, + { 4, 0, 0, 3, 9, 70, }, + { 5, 0, 0, 3, 9, 36, }, + { 6, 0, 0, 3, 9, 64, }, + { 7, 0, 0, 3, 9, 36, }, + { 8, 0, 0, 3, 9, 64, }, + { 9, 0, 0, 3, 9, 36, }, + { 0, 0, 0, 3, 10, 60, }, + { 2, 0, 0, 3, 10, 36, }, + { 1, 0, 0, 3, 10, 66, }, + { 3, 0, 0, 3, 10, 60, }, + { 4, 0, 0, 3, 10, 70, }, + { 5, 0, 0, 3, 10, 36, }, + { 6, 0, 0, 3, 10, 60, }, + { 7, 0, 0, 3, 10, 36, }, + { 8, 0, 0, 3, 10, 60, }, + { 9, 0, 0, 3, 10, 36, }, + { 0, 0, 0, 3, 11, 52, }, + { 2, 0, 0, 3, 11, 36, }, + { 1, 0, 0, 3, 11, 66, }, + { 3, 0, 0, 3, 11, 52, }, + { 4, 0, 0, 3, 11, 70, }, + { 5, 0, 0, 3, 11, 36, }, + { 6, 0, 0, 3, 11, 52, }, + { 7, 0, 0, 3, 11, 36, }, + { 8, 0, 0, 3, 11, 52, }, + { 9, 0, 0, 3, 11, 36, }, + { 0, 0, 0, 3, 12, 32, }, + { 2, 0, 0, 3, 12, 36, }, + { 1, 0, 0, 3, 12, 66, }, + { 3, 0, 0, 3, 12, 40, }, + { 4, 0, 0, 3, 12, 70, }, + { 5, 0, 0, 3, 12, 36, }, + { 6, 0, 0, 3, 12, 40, }, + { 7, 0, 0, 3, 12, 36, }, + { 8, 0, 0, 3, 12, 40, }, + { 9, 0, 0, 3, 12, 36, }, + { 0, 0, 0, 3, 13, 20, }, + { 2, 0, 0, 3, 13, 36, }, + { 1, 0, 0, 3, 13, 66, }, + { 3, 0, 0, 3, 13, 28, }, + { 4, 0, 0, 3, 13, 62, }, + { 5, 0, 0, 3, 13, 36, }, + { 6, 0, 0, 3, 13, 28, }, + { 7, 0, 0, 3, 13, 36, }, + { 8, 0, 0, 3, 13, 28, }, + { 9, 0, 0, 3, 13, 36, }, + { 0, 0, 0, 3, 14, 127, }, + { 2, 0, 0, 3, 14, 127, }, + { 1, 0, 0, 3, 14, 127, }, + { 3, 0, 0, 3, 14, 127, }, + { 4, 0, 0, 3, 14, 127, }, + { 5, 0, 0, 3, 14, 127, }, + { 6, 0, 0, 3, 14, 127, }, + { 7, 0, 0, 3, 14, 127, }, + { 8, 0, 0, 3, 14, 127, }, + { 9, 0, 0, 3, 14, 127, }, + { 0, 0, 1, 2, 1, 127, }, + { 2, 0, 1, 2, 1, 127, }, + { 1, 0, 1, 2, 1, 127, }, + { 3, 0, 1, 2, 1, 127, }, + { 4, 0, 1, 2, 1, 127, }, + { 5, 0, 1, 2, 1, 127, }, + { 6, 0, 1, 2, 1, 127, }, + { 7, 0, 1, 2, 1, 127, }, + { 8, 0, 1, 2, 1, 127, }, + { 9, 0, 1, 2, 1, 127, }, + { 0, 0, 1, 2, 2, 127, }, + { 2, 0, 1, 2, 2, 127, }, + { 1, 0, 1, 2, 2, 127, }, + { 3, 0, 1, 2, 2, 127, }, + { 4, 0, 1, 2, 2, 127, }, + { 5, 0, 1, 2, 2, 127, }, + { 6, 0, 1, 2, 2, 127, }, + { 7, 0, 1, 2, 2, 127, }, + { 8, 0, 1, 2, 2, 127, }, + { 9, 0, 1, 2, 2, 127, }, + { 0, 0, 1, 2, 3, 52, }, + { 2, 0, 1, 2, 3, 60, }, + { 1, 0, 1, 2, 3, 72, }, + { 3, 0, 1, 2, 3, 52, }, + { 4, 0, 1, 2, 3, 72, }, + { 5, 0, 1, 2, 3, 60, }, + { 6, 0, 1, 2, 3, 52, }, + { 7, 0, 1, 2, 3, 60, }, + { 8, 0, 1, 2, 3, 52, }, + { 9, 0, 1, 2, 3, 60, }, + { 0, 0, 1, 2, 4, 52, }, + { 2, 0, 1, 2, 4, 60, }, + { 1, 0, 1, 2, 4, 72, }, + { 3, 0, 1, 2, 4, 52, }, + { 4, 0, 1, 2, 4, 72, }, + { 5, 0, 1, 2, 4, 60, }, + { 6, 0, 1, 2, 4, 52, }, + { 7, 0, 1, 2, 4, 60, }, + { 8, 0, 1, 2, 4, 52, }, + { 9, 0, 1, 2, 4, 60, }, + { 0, 0, 1, 2, 5, 60, }, + { 2, 0, 1, 2, 5, 60, }, + { 1, 0, 1, 2, 5, 72, }, + { 3, 0, 1, 2, 5, 60, }, + { 4, 0, 1, 2, 5, 72, }, + { 5, 0, 1, 2, 5, 60, }, + { 6, 0, 1, 2, 5, 60, }, + { 7, 0, 1, 2, 5, 60, }, + { 8, 0, 1, 2, 5, 60, }, + { 9, 0, 1, 2, 5, 60, }, + { 0, 0, 1, 2, 6, 64, }, + { 2, 0, 1, 2, 6, 60, }, + { 1, 0, 1, 2, 6, 72, }, + { 3, 0, 1, 2, 6, 64, }, + { 4, 0, 1, 2, 6, 72, }, + { 5, 0, 1, 2, 6, 60, }, + { 6, 0, 1, 2, 6, 64, }, + { 7, 0, 1, 2, 6, 60, }, + { 8, 0, 1, 2, 6, 64, }, + { 9, 0, 1, 2, 6, 60, }, + { 0, 0, 1, 2, 7, 60, }, + { 2, 0, 1, 2, 7, 60, }, + { 1, 0, 1, 2, 7, 72, }, + { 3, 0, 1, 2, 7, 60, }, + { 4, 0, 1, 2, 7, 72, }, + { 5, 0, 1, 2, 7, 60, }, + { 6, 0, 1, 2, 7, 60, }, + { 7, 0, 1, 2, 7, 60, }, + { 8, 0, 1, 2, 7, 60, }, + { 9, 0, 1, 2, 7, 60, }, + { 0, 0, 1, 2, 8, 52, }, + { 2, 0, 1, 2, 8, 60, }, + { 1, 0, 1, 2, 8, 72, }, + { 3, 0, 1, 2, 8, 52, }, + { 4, 0, 1, 2, 8, 72, }, + { 5, 0, 1, 2, 8, 60, }, + { 6, 0, 1, 2, 8, 52, }, + { 7, 0, 1, 2, 8, 60, }, + { 8, 0, 1, 2, 8, 52, }, + { 9, 0, 1, 2, 8, 60, }, + { 0, 0, 1, 2, 9, 52, }, + { 2, 0, 1, 2, 9, 60, }, + { 1, 0, 1, 2, 9, 72, }, + { 3, 0, 1, 2, 9, 52, }, + { 4, 0, 1, 2, 9, 72, }, + { 5, 0, 1, 2, 9, 60, }, + { 6, 0, 1, 2, 9, 52, }, + { 7, 0, 1, 2, 9, 60, }, + { 8, 0, 1, 2, 9, 52, }, + { 9, 0, 1, 2, 9, 60, }, + { 0, 0, 1, 2, 10, 40, }, + { 2, 0, 1, 2, 10, 60, }, + { 1, 0, 1, 2, 10, 72, }, + { 3, 0, 1, 2, 10, 40, }, + { 4, 0, 1, 2, 10, 72, }, + { 5, 0, 1, 2, 10, 60, }, + { 6, 0, 1, 2, 10, 40, }, + { 7, 0, 1, 2, 10, 60, }, + { 8, 0, 1, 2, 10, 40, }, + { 9, 0, 1, 2, 10, 60, }, + { 0, 0, 1, 2, 11, 28, }, + { 2, 0, 1, 2, 11, 60, }, + { 1, 0, 1, 2, 11, 72, }, + { 3, 0, 1, 2, 11, 28, }, + { 4, 0, 1, 2, 11, 70, }, + { 5, 0, 1, 2, 11, 60, }, + { 6, 0, 1, 2, 11, 28, }, + { 7, 0, 1, 2, 11, 60, }, + { 8, 0, 1, 2, 11, 28, }, + { 9, 0, 1, 2, 11, 60, }, + { 0, 0, 1, 2, 12, 127, }, + { 2, 0, 1, 2, 12, 127, }, + { 1, 0, 1, 2, 12, 127, }, + { 3, 0, 1, 2, 12, 127, }, + { 4, 0, 1, 2, 12, 127, }, + { 5, 0, 1, 2, 12, 127, }, + { 6, 0, 1, 2, 12, 127, }, + { 7, 0, 1, 2, 12, 127, }, + { 8, 0, 1, 2, 12, 127, }, + { 9, 0, 1, 2, 12, 127, }, + { 0, 0, 1, 2, 13, 127, }, + { 2, 0, 1, 2, 13, 127, }, + { 1, 0, 1, 2, 13, 127, }, + { 3, 0, 1, 2, 13, 127, }, + { 4, 0, 1, 2, 13, 127, }, + { 5, 0, 1, 2, 13, 127, }, + { 6, 0, 1, 2, 13, 127, }, + { 7, 0, 1, 2, 13, 127, }, + { 8, 0, 1, 2, 13, 127, }, + { 9, 0, 1, 2, 13, 127, }, + { 0, 0, 1, 2, 14, 127, }, + { 2, 0, 1, 2, 14, 127, }, + { 1, 0, 1, 2, 14, 127, }, + { 3, 0, 1, 2, 14, 127, }, + { 4, 0, 1, 2, 14, 127, }, + { 5, 0, 1, 2, 14, 127, }, + { 6, 0, 1, 2, 14, 127, }, + { 7, 0, 1, 2, 14, 127, }, + { 8, 0, 1, 2, 14, 127, }, + { 9, 0, 1, 2, 14, 127, }, + { 0, 0, 1, 3, 1, 127, }, + { 2, 0, 1, 3, 1, 127, }, + { 1, 0, 1, 3, 1, 127, }, + { 3, 0, 1, 3, 1, 127, }, + { 4, 0, 1, 3, 1, 127, }, + { 5, 0, 1, 3, 1, 127, }, + { 6, 0, 1, 3, 1, 127, }, + { 7, 0, 1, 3, 1, 127, }, + { 8, 0, 1, 3, 1, 127, }, + { 9, 0, 1, 3, 1, 127, }, + { 0, 0, 1, 3, 2, 127, }, + { 2, 0, 1, 3, 2, 127, }, + { 1, 0, 1, 3, 2, 127, }, + { 3, 0, 1, 3, 2, 127, }, + { 4, 0, 1, 3, 2, 127, }, + { 5, 0, 1, 3, 2, 127, }, + { 6, 0, 1, 3, 2, 127, }, + { 7, 0, 1, 3, 2, 127, }, + { 8, 0, 1, 3, 2, 127, }, + { 9, 0, 1, 3, 2, 127, }, + { 0, 0, 1, 3, 3, 48, }, + { 2, 0, 1, 3, 3, 36, }, + { 1, 0, 1, 3, 3, 66, }, + { 3, 0, 1, 3, 3, 48, }, + { 4, 0, 1, 3, 3, 66, }, + { 5, 0, 1, 3, 3, 36, }, + { 6, 0, 1, 3, 3, 48, }, + { 7, 0, 1, 3, 3, 36, }, + { 8, 0, 1, 3, 3, 48, }, + { 9, 0, 1, 3, 3, 36, }, + { 0, 0, 1, 3, 4, 48, }, + { 2, 0, 1, 3, 4, 36, }, + { 1, 0, 1, 3, 4, 66, }, + { 3, 0, 1, 3, 4, 48, }, + { 4, 0, 1, 3, 4, 70, }, + { 5, 0, 1, 3, 4, 36, }, + { 6, 0, 1, 3, 4, 48, }, + { 7, 0, 1, 3, 4, 36, }, + { 8, 0, 1, 3, 4, 48, }, + { 9, 0, 1, 3, 4, 36, }, + { 0, 0, 1, 3, 5, 60, }, + { 2, 0, 1, 3, 5, 36, }, + { 1, 0, 1, 3, 5, 66, }, + { 3, 0, 1, 3, 5, 60, }, + { 4, 0, 1, 3, 5, 70, }, + { 5, 0, 1, 3, 5, 36, }, + { 6, 0, 1, 3, 5, 60, }, + { 7, 0, 1, 3, 5, 36, }, + { 8, 0, 1, 3, 5, 60, }, + { 9, 0, 1, 3, 5, 36, }, + { 0, 0, 1, 3, 6, 64, }, + { 2, 0, 1, 3, 6, 36, }, + { 1, 0, 1, 3, 6, 66, }, + { 3, 0, 1, 3, 6, 64, }, + { 4, 0, 1, 3, 6, 70, }, + { 5, 0, 1, 3, 6, 36, }, + { 6, 0, 1, 3, 6, 64, }, + { 7, 0, 1, 3, 6, 36, }, + { 8, 0, 1, 3, 6, 64, }, + { 9, 0, 1, 3, 6, 36, }, + { 0, 0, 1, 3, 7, 60, }, + { 2, 0, 1, 3, 7, 36, }, + { 1, 0, 1, 3, 7, 66, }, + { 3, 0, 1, 3, 7, 60, }, + { 4, 0, 1, 3, 7, 70, }, + { 5, 0, 1, 3, 7, 36, }, + { 6, 0, 1, 3, 7, 60, }, + { 7, 0, 1, 3, 7, 36, }, + { 8, 0, 1, 3, 7, 60, }, + { 9, 0, 1, 3, 7, 36, }, + { 0, 0, 1, 3, 8, 52, }, + { 2, 0, 1, 3, 8, 36, }, + { 1, 0, 1, 3, 8, 66, }, + { 3, 0, 1, 3, 8, 52, }, + { 4, 0, 1, 3, 8, 70, }, + { 5, 0, 1, 3, 8, 36, }, + { 6, 0, 1, 3, 8, 52, }, + { 7, 0, 1, 3, 8, 36, }, + { 8, 0, 1, 3, 8, 52, }, + { 9, 0, 1, 3, 8, 36, }, + { 0, 0, 1, 3, 9, 52, }, + { 2, 0, 1, 3, 9, 36, }, + { 1, 0, 1, 3, 9, 66, }, + { 3, 0, 1, 3, 9, 52, }, + { 4, 0, 1, 3, 9, 70, }, + { 5, 0, 1, 3, 9, 36, }, + { 6, 0, 1, 3, 9, 52, }, + { 7, 0, 1, 3, 9, 36, }, + { 8, 0, 1, 3, 9, 52, }, + { 9, 0, 1, 3, 9, 36, }, + { 0, 0, 1, 3, 10, 40, }, + { 2, 0, 1, 3, 10, 36, }, + { 1, 0, 1, 3, 10, 66, }, + { 3, 0, 1, 3, 10, 40, }, + { 4, 0, 1, 3, 10, 70, }, + { 5, 0, 1, 3, 10, 36, }, + { 6, 0, 1, 3, 10, 40, }, + { 7, 0, 1, 3, 10, 36, }, + { 8, 0, 1, 3, 10, 40, }, + { 9, 0, 1, 3, 10, 36, }, + { 0, 0, 1, 3, 11, 26, }, + { 2, 0, 1, 3, 11, 36, }, + { 1, 0, 1, 3, 11, 66, }, + { 3, 0, 1, 3, 11, 26, }, + { 4, 0, 1, 3, 11, 66, }, + { 5, 0, 1, 3, 11, 36, }, + { 6, 0, 1, 3, 11, 26, }, + { 7, 0, 1, 3, 11, 36, }, + { 8, 0, 1, 3, 11, 26, }, + { 9, 0, 1, 3, 11, 36, }, + { 0, 0, 1, 3, 12, 127, }, + { 2, 0, 1, 3, 12, 127, }, + { 1, 0, 1, 3, 12, 127, }, + { 3, 0, 1, 3, 12, 127, }, + { 4, 0, 1, 3, 12, 127, }, + { 5, 0, 1, 3, 12, 127, }, + { 6, 0, 1, 3, 12, 127, }, + { 7, 0, 1, 3, 12, 127, }, + { 8, 0, 1, 3, 12, 127, }, + { 9, 0, 1, 3, 12, 127, }, + { 0, 0, 1, 3, 13, 127, }, + { 2, 0, 1, 3, 13, 127, }, + { 1, 0, 1, 3, 13, 127, }, + { 3, 0, 1, 3, 13, 127, }, + { 4, 0, 1, 3, 13, 127, }, + { 5, 0, 1, 3, 13, 127, }, + { 6, 0, 1, 3, 13, 127, }, + { 7, 0, 1, 3, 13, 127, }, + { 8, 0, 1, 3, 13, 127, }, + { 9, 0, 1, 3, 13, 127, }, + { 0, 0, 1, 3, 14, 127, }, + { 2, 0, 1, 3, 14, 127, }, + { 1, 0, 1, 3, 14, 127, }, + { 3, 0, 1, 3, 14, 127, }, + { 4, 0, 1, 3, 14, 127, }, + { 5, 0, 1, 3, 14, 127, }, + { 6, 0, 1, 3, 14, 127, }, + { 7, 0, 1, 3, 14, 127, }, + { 8, 0, 1, 3, 14, 127, }, + { 9, 0, 1, 3, 14, 127, }, + { 0, 1, 0, 1, 36, 74, }, + { 2, 1, 0, 1, 36, 62, }, + { 1, 1, 0, 1, 36, 60, }, + { 3, 1, 0, 1, 36, 62, }, + { 4, 1, 0, 1, 36, 76, }, + { 5, 1, 0, 1, 36, 62, }, + { 6, 1, 0, 1, 36, 64, }, + { 7, 1, 0, 1, 36, 54, }, + { 8, 1, 0, 1, 36, 62, }, + { 9, 1, 0, 1, 36, 62, }, + { 0, 1, 0, 1, 40, 76, }, + { 2, 1, 0, 1, 40, 62, }, + { 1, 1, 0, 1, 40, 62, }, + { 3, 1, 0, 1, 40, 62, }, + { 4, 1, 0, 1, 40, 76, }, + { 5, 1, 0, 1, 40, 62, }, + { 6, 1, 0, 1, 40, 64, }, + { 7, 1, 0, 1, 40, 54, }, + { 8, 1, 0, 1, 40, 62, }, + { 9, 1, 0, 1, 40, 62, }, + { 0, 1, 0, 1, 44, 76, }, + { 2, 1, 0, 1, 44, 62, }, + { 1, 1, 0, 1, 44, 62, }, + { 3, 1, 0, 1, 44, 62, }, + { 4, 1, 0, 1, 44, 76, }, + { 5, 1, 0, 1, 44, 62, }, + { 6, 1, 0, 1, 44, 64, }, + { 7, 1, 0, 1, 44, 54, }, + { 8, 1, 0, 1, 44, 62, }, + { 9, 1, 0, 1, 44, 62, }, + { 0, 1, 0, 1, 48, 76, }, + { 2, 1, 0, 1, 48, 62, }, + { 1, 1, 0, 1, 48, 62, }, + { 3, 1, 0, 1, 48, 62, }, + { 4, 1, 0, 1, 48, 54, }, + { 5, 1, 0, 1, 48, 62, }, + { 6, 1, 0, 1, 48, 64, }, + { 7, 1, 0, 1, 48, 54, }, + { 8, 1, 0, 1, 48, 62, }, + { 9, 1, 0, 1, 48, 62, }, + { 0, 1, 0, 1, 52, 76, }, + { 2, 1, 0, 1, 52, 62, }, + { 1, 1, 0, 1, 52, 62, }, + { 3, 1, 0, 1, 52, 64, }, + { 4, 1, 0, 1, 52, 76, }, + { 5, 1, 0, 1, 52, 62, }, + { 6, 1, 0, 1, 52, 76, }, + { 7, 1, 0, 1, 52, 54, }, + { 8, 1, 0, 1, 52, 76, }, + { 9, 1, 0, 1, 52, 62, }, + { 0, 1, 0, 1, 56, 76, }, + { 2, 1, 0, 1, 56, 62, }, + { 1, 1, 0, 1, 56, 62, }, + { 3, 1, 0, 1, 56, 64, }, + { 4, 1, 0, 1, 56, 76, }, + { 5, 1, 0, 1, 56, 62, }, + { 6, 1, 0, 1, 56, 76, }, + { 7, 1, 0, 1, 56, 54, }, + { 8, 1, 0, 1, 56, 76, }, + { 9, 1, 0, 1, 56, 62, }, + { 0, 1, 0, 1, 60, 76, }, + { 2, 1, 0, 1, 60, 62, }, + { 1, 1, 0, 1, 60, 62, }, + { 3, 1, 0, 1, 60, 64, }, + { 4, 1, 0, 1, 60, 76, }, + { 5, 1, 0, 1, 60, 62, }, + { 6, 1, 0, 1, 60, 76, }, + { 7, 1, 0, 1, 60, 54, }, + { 8, 1, 0, 1, 60, 76, }, + { 9, 1, 0, 1, 60, 62, }, + { 0, 1, 0, 1, 64, 74, }, + { 2, 1, 0, 1, 64, 62, }, + { 1, 1, 0, 1, 64, 60, }, + { 3, 1, 0, 1, 64, 64, }, + { 4, 1, 0, 1, 64, 76, }, + { 5, 1, 0, 1, 64, 62, }, + { 6, 1, 0, 1, 64, 74, }, + { 7, 1, 0, 1, 64, 54, }, + { 8, 1, 0, 1, 64, 74, }, + { 9, 1, 0, 1, 64, 62, }, + { 0, 1, 0, 1, 100, 72, }, + { 2, 1, 0, 1, 100, 62, }, + { 1, 1, 0, 1, 100, 76, }, + { 3, 1, 0, 1, 100, 72, }, + { 4, 1, 0, 1, 100, 76, }, + { 5, 1, 0, 1, 100, 62, }, + { 6, 1, 0, 1, 100, 72, }, + { 7, 1, 0, 1, 100, 54, }, + { 8, 1, 0, 1, 100, 72, }, + { 9, 1, 0, 1, 100, 127, }, + { 0, 1, 0, 1, 104, 76, }, + { 2, 1, 0, 1, 104, 62, }, + { 1, 1, 0, 1, 104, 76, }, + { 3, 1, 0, 1, 104, 76, }, + { 4, 1, 0, 1, 104, 76, }, + { 5, 1, 0, 1, 104, 62, }, + { 6, 1, 0, 1, 104, 76, }, + { 7, 1, 0, 1, 104, 54, }, + { 8, 1, 0, 1, 104, 76, }, + { 9, 1, 0, 1, 104, 127, }, + { 0, 1, 0, 1, 108, 76, }, + { 2, 1, 0, 1, 108, 62, }, + { 1, 1, 0, 1, 108, 76, }, + { 3, 1, 0, 1, 108, 76, }, + { 4, 1, 0, 1, 108, 76, }, + { 5, 1, 0, 1, 108, 62, }, + { 6, 1, 0, 1, 108, 76, }, + { 7, 1, 0, 1, 108, 54, }, + { 8, 1, 0, 1, 108, 76, }, + { 9, 1, 0, 1, 108, 127, }, + { 0, 1, 0, 1, 112, 76, }, + { 2, 1, 0, 1, 112, 62, }, + { 1, 1, 0, 1, 112, 76, }, + { 3, 1, 0, 1, 112, 76, }, + { 4, 1, 0, 1, 112, 76, }, + { 5, 1, 0, 1, 112, 62, }, + { 6, 1, 0, 1, 112, 76, }, + { 7, 1, 0, 1, 112, 54, }, + { 8, 1, 0, 1, 112, 76, }, + { 9, 1, 0, 1, 112, 127, }, + { 0, 1, 0, 1, 116, 76, }, + { 2, 1, 0, 1, 116, 62, }, + { 1, 1, 0, 1, 116, 76, }, + { 3, 1, 0, 1, 116, 76, }, + { 4, 1, 0, 1, 116, 76, }, + { 5, 1, 0, 1, 116, 62, }, + { 6, 1, 0, 1, 116, 76, }, + { 7, 1, 0, 1, 116, 54, }, + { 8, 1, 0, 1, 116, 76, }, + { 9, 1, 0, 1, 116, 127, }, + { 0, 1, 0, 1, 120, 76, }, + { 2, 1, 0, 1, 120, 62, }, + { 1, 1, 0, 1, 120, 76, }, + { 3, 1, 0, 1, 120, 127, }, + { 4, 1, 0, 1, 120, 76, }, + { 5, 1, 0, 1, 120, 127, }, + { 6, 1, 0, 1, 120, 76, }, + { 7, 1, 0, 1, 120, 54, }, + { 8, 1, 0, 1, 120, 76, }, + { 9, 1, 0, 1, 120, 127, }, + { 0, 1, 0, 1, 124, 76, }, + { 2, 1, 0, 1, 124, 62, }, + { 1, 1, 0, 1, 124, 76, }, + { 3, 1, 0, 1, 124, 127, }, + { 4, 1, 0, 1, 124, 76, }, + { 5, 1, 0, 1, 124, 127, }, + { 6, 1, 0, 1, 124, 76, }, + { 7, 1, 0, 1, 124, 54, }, + { 8, 1, 0, 1, 124, 76, }, + { 9, 1, 0, 1, 124, 127, }, + { 0, 1, 0, 1, 128, 76, }, + { 2, 1, 0, 1, 128, 62, }, + { 1, 1, 0, 1, 128, 76, }, + { 3, 1, 0, 1, 128, 127, }, + { 4, 1, 0, 1, 128, 76, }, + { 5, 1, 0, 1, 128, 127, }, + { 6, 1, 0, 1, 128, 76, }, + { 7, 1, 0, 1, 128, 54, }, + { 8, 1, 0, 1, 128, 76, }, + { 9, 1, 0, 1, 128, 127, }, + { 0, 1, 0, 1, 132, 76, }, + { 2, 1, 0, 1, 132, 62, }, + { 1, 1, 0, 1, 132, 76, }, + { 3, 1, 0, 1, 132, 76, }, + { 4, 1, 0, 1, 132, 76, }, + { 5, 1, 0, 1, 132, 62, }, + { 6, 1, 0, 1, 132, 76, }, + { 7, 1, 0, 1, 132, 54, }, + { 8, 1, 0, 1, 132, 76, }, + { 9, 1, 0, 1, 132, 127, }, + { 0, 1, 0, 1, 136, 76, }, + { 2, 1, 0, 1, 136, 62, }, + { 1, 1, 0, 1, 136, 76, }, + { 3, 1, 0, 1, 136, 76, }, + { 4, 1, 0, 1, 136, 76, }, + { 5, 1, 0, 1, 136, 62, }, + { 6, 1, 0, 1, 136, 76, }, + { 7, 1, 0, 1, 136, 54, }, + { 8, 1, 0, 1, 136, 76, }, + { 9, 1, 0, 1, 136, 127, }, + { 0, 1, 0, 1, 140, 72, }, + { 2, 1, 0, 1, 140, 62, }, + { 1, 1, 0, 1, 140, 76, }, + { 3, 1, 0, 1, 140, 72, }, + { 4, 1, 0, 1, 140, 76, }, + { 5, 1, 0, 1, 140, 62, }, + { 6, 1, 0, 1, 140, 72, }, + { 7, 1, 0, 1, 140, 54, }, + { 8, 1, 0, 1, 140, 72, }, + { 9, 1, 0, 1, 140, 127, }, + { 0, 1, 0, 1, 144, 76, }, + { 2, 1, 0, 1, 144, 127, }, + { 1, 1, 0, 1, 144, 127, }, + { 3, 1, 0, 1, 144, 76, }, + { 4, 1, 0, 1, 144, 76, }, + { 5, 1, 0, 1, 144, 127, }, + { 6, 1, 0, 1, 144, 76, }, + { 7, 1, 0, 1, 144, 127, }, + { 8, 1, 0, 1, 144, 76, }, + { 9, 1, 0, 1, 144, 127, }, + { 0, 1, 0, 1, 149, 76, }, + { 2, 1, 0, 1, 149, 54, }, + { 1, 1, 0, 1, 149, 127, }, + { 3, 1, 0, 1, 149, 76, }, + { 4, 1, 0, 1, 149, 74, }, + { 5, 1, 0, 1, 149, 76, }, + { 6, 1, 0, 1, 149, 76, }, + { 7, 1, 0, 1, 149, 54, }, + { 8, 1, 0, 1, 149, 76, }, + { 9, 1, 0, 1, 149, 54, }, + { 0, 1, 0, 1, 153, 76, }, + { 2, 1, 0, 1, 153, 54, }, + { 1, 1, 0, 1, 153, 127, }, + { 3, 1, 0, 1, 153, 76, }, + { 4, 1, 0, 1, 153, 74, }, + { 5, 1, 0, 1, 153, 76, }, + { 6, 1, 0, 1, 153, 76, }, + { 7, 1, 0, 1, 153, 54, }, + { 8, 1, 0, 1, 153, 76, }, + { 9, 1, 0, 1, 153, 54, }, + { 0, 1, 0, 1, 157, 76, }, + { 2, 1, 0, 1, 157, 54, }, + { 1, 1, 0, 1, 157, 127, }, + { 3, 1, 0, 1, 157, 76, }, + { 4, 1, 0, 1, 157, 74, }, + { 5, 1, 0, 1, 157, 76, }, + { 6, 1, 0, 1, 157, 76, }, + { 7, 1, 0, 1, 157, 54, }, + { 8, 1, 0, 1, 157, 76, }, + { 9, 1, 0, 1, 157, 54, }, + { 0, 1, 0, 1, 161, 76, }, + { 2, 1, 0, 1, 161, 54, }, + { 1, 1, 0, 1, 161, 127, }, + { 3, 1, 0, 1, 161, 76, }, + { 4, 1, 0, 1, 161, 74, }, + { 5, 1, 0, 1, 161, 76, }, + { 6, 1, 0, 1, 161, 76, }, + { 7, 1, 0, 1, 161, 54, }, + { 8, 1, 0, 1, 161, 76, }, + { 9, 1, 0, 1, 161, 54, }, + { 0, 1, 0, 1, 165, 76, }, + { 2, 1, 0, 1, 165, 54, }, + { 1, 1, 0, 1, 165, 127, }, + { 3, 1, 0, 1, 165, 76, }, + { 4, 1, 0, 1, 165, 74, }, + { 5, 1, 0, 1, 165, 76, }, + { 6, 1, 0, 1, 165, 76, }, + { 7, 1, 0, 1, 165, 54, }, + { 8, 1, 0, 1, 165, 76, }, + { 9, 1, 0, 1, 165, 54, }, + { 0, 1, 0, 2, 36, 72, }, + { 2, 1, 0, 2, 36, 62, }, + { 1, 1, 0, 2, 36, 62, }, + { 3, 1, 0, 2, 36, 62, }, + { 4, 1, 0, 2, 36, 76, }, + { 5, 1, 0, 2, 36, 62, }, + { 6, 1, 0, 2, 36, 64, }, + { 7, 1, 0, 2, 36, 54, }, + { 8, 1, 0, 2, 36, 62, }, + { 9, 1, 0, 2, 36, 62, }, + { 0, 1, 0, 2, 40, 76, }, + { 2, 1, 0, 2, 40, 62, }, + { 1, 1, 0, 2, 40, 62, }, + { 3, 1, 0, 2, 40, 62, }, + { 4, 1, 0, 2, 40, 76, }, + { 5, 1, 0, 2, 40, 62, }, + { 6, 1, 0, 2, 40, 64, }, + { 7, 1, 0, 2, 40, 54, }, + { 8, 1, 0, 2, 40, 62, }, + { 9, 1, 0, 2, 40, 62, }, + { 0, 1, 0, 2, 44, 76, }, + { 2, 1, 0, 2, 44, 62, }, + { 1, 1, 0, 2, 44, 62, }, + { 3, 1, 0, 2, 44, 62, }, + { 4, 1, 0, 2, 44, 76, }, + { 5, 1, 0, 2, 44, 62, }, + { 6, 1, 0, 2, 44, 64, }, + { 7, 1, 0, 2, 44, 54, }, + { 8, 1, 0, 2, 44, 62, }, + { 9, 1, 0, 2, 44, 62, }, + { 0, 1, 0, 2, 48, 76, }, + { 2, 1, 0, 2, 48, 62, }, + { 1, 1, 0, 2, 48, 62, }, + { 3, 1, 0, 2, 48, 62, }, + { 4, 1, 0, 2, 48, 54, }, + { 5, 1, 0, 2, 48, 62, }, + { 6, 1, 0, 2, 48, 64, }, + { 7, 1, 0, 2, 48, 54, }, + { 8, 1, 0, 2, 48, 62, }, + { 9, 1, 0, 2, 48, 62, }, + { 0, 1, 0, 2, 52, 76, }, + { 2, 1, 0, 2, 52, 62, }, + { 1, 1, 0, 2, 52, 62, }, + { 3, 1, 0, 2, 52, 64, }, + { 4, 1, 0, 2, 52, 76, }, + { 5, 1, 0, 2, 52, 62, }, + { 6, 1, 0, 2, 52, 76, }, + { 7, 1, 0, 2, 52, 54, }, + { 8, 1, 0, 2, 52, 76, }, + { 9, 1, 0, 2, 52, 62, }, + { 0, 1, 0, 2, 56, 76, }, + { 2, 1, 0, 2, 56, 62, }, + { 1, 1, 0, 2, 56, 62, }, + { 3, 1, 0, 2, 56, 64, }, + { 4, 1, 0, 2, 56, 76, }, + { 5, 1, 0, 2, 56, 62, }, + { 6, 1, 0, 2, 56, 76, }, + { 7, 1, 0, 2, 56, 54, }, + { 8, 1, 0, 2, 56, 76, }, + { 9, 1, 0, 2, 56, 62, }, + { 0, 1, 0, 2, 60, 76, }, + { 2, 1, 0, 2, 60, 62, }, + { 1, 1, 0, 2, 60, 62, }, + { 3, 1, 0, 2, 60, 64, }, + { 4, 1, 0, 2, 60, 76, }, + { 5, 1, 0, 2, 60, 62, }, + { 6, 1, 0, 2, 60, 76, }, + { 7, 1, 0, 2, 60, 54, }, + { 8, 1, 0, 2, 60, 76, }, + { 9, 1, 0, 2, 60, 62, }, + { 0, 1, 0, 2, 64, 74, }, + { 2, 1, 0, 2, 64, 62, }, + { 1, 1, 0, 2, 64, 60, }, + { 3, 1, 0, 2, 64, 64, }, + { 4, 1, 0, 2, 64, 74, }, + { 5, 1, 0, 2, 64, 62, }, + { 6, 1, 0, 2, 64, 74, }, + { 7, 1, 0, 2, 64, 54, }, + { 8, 1, 0, 2, 64, 74, }, + { 9, 1, 0, 2, 64, 62, }, + { 0, 1, 0, 2, 100, 70, }, + { 2, 1, 0, 2, 100, 62, }, + { 1, 1, 0, 2, 100, 76, }, + { 3, 1, 0, 2, 100, 70, }, + { 4, 1, 0, 2, 100, 76, }, + { 5, 1, 0, 2, 100, 62, }, + { 6, 1, 0, 2, 100, 70, }, + { 7, 1, 0, 2, 100, 54, }, + { 8, 1, 0, 2, 100, 70, }, + { 9, 1, 0, 2, 100, 127, }, + { 0, 1, 0, 2, 104, 76, }, + { 2, 1, 0, 2, 104, 62, }, + { 1, 1, 0, 2, 104, 76, }, + { 3, 1, 0, 2, 104, 76, }, + { 4, 1, 0, 2, 104, 76, }, + { 5, 1, 0, 2, 104, 62, }, + { 6, 1, 0, 2, 104, 76, }, + { 7, 1, 0, 2, 104, 54, }, + { 8, 1, 0, 2, 104, 76, }, + { 9, 1, 0, 2, 104, 127, }, + { 0, 1, 0, 2, 108, 76, }, + { 2, 1, 0, 2, 108, 62, }, + { 1, 1, 0, 2, 108, 76, }, + { 3, 1, 0, 2, 108, 76, }, + { 4, 1, 0, 2, 108, 76, }, + { 5, 1, 0, 2, 108, 62, }, + { 6, 1, 0, 2, 108, 76, }, + { 7, 1, 0, 2, 108, 54, }, + { 8, 1, 0, 2, 108, 76, }, + { 9, 1, 0, 2, 108, 127, }, + { 0, 1, 0, 2, 112, 76, }, + { 2, 1, 0, 2, 112, 62, }, + { 1, 1, 0, 2, 112, 76, }, + { 3, 1, 0, 2, 112, 76, }, + { 4, 1, 0, 2, 112, 76, }, + { 5, 1, 0, 2, 112, 62, }, + { 6, 1, 0, 2, 112, 76, }, + { 7, 1, 0, 2, 112, 54, }, + { 8, 1, 0, 2, 112, 76, }, + { 9, 1, 0, 2, 112, 127, }, + { 0, 1, 0, 2, 116, 76, }, + { 2, 1, 0, 2, 116, 62, }, + { 1, 1, 0, 2, 116, 76, }, + { 3, 1, 0, 2, 116, 76, }, + { 4, 1, 0, 2, 116, 76, }, + { 5, 1, 0, 2, 116, 62, }, + { 6, 1, 0, 2, 116, 76, }, + { 7, 1, 0, 2, 116, 54, }, + { 8, 1, 0, 2, 116, 76, }, + { 9, 1, 0, 2, 116, 127, }, + { 0, 1, 0, 2, 120, 76, }, + { 2, 1, 0, 2, 120, 62, }, + { 1, 1, 0, 2, 120, 76, }, + { 3, 1, 0, 2, 120, 127, }, + { 4, 1, 0, 2, 120, 76, }, + { 5, 1, 0, 2, 120, 127, }, + { 6, 1, 0, 2, 120, 76, }, + { 7, 1, 0, 2, 120, 54, }, + { 8, 1, 0, 2, 120, 76, }, + { 9, 1, 0, 2, 120, 127, }, + { 0, 1, 0, 2, 124, 76, }, + { 2, 1, 0, 2, 124, 62, }, + { 1, 1, 0, 2, 124, 76, }, + { 3, 1, 0, 2, 124, 127, }, + { 4, 1, 0, 2, 124, 76, }, + { 5, 1, 0, 2, 124, 127, }, + { 6, 1, 0, 2, 124, 76, }, + { 7, 1, 0, 2, 124, 54, }, + { 8, 1, 0, 2, 124, 76, }, + { 9, 1, 0, 2, 124, 127, }, + { 0, 1, 0, 2, 128, 76, }, + { 2, 1, 0, 2, 128, 62, }, + { 1, 1, 0, 2, 128, 76, }, + { 3, 1, 0, 2, 128, 127, }, + { 4, 1, 0, 2, 128, 76, }, + { 5, 1, 0, 2, 128, 127, }, + { 6, 1, 0, 2, 128, 76, }, + { 7, 1, 0, 2, 128, 54, }, + { 8, 1, 0, 2, 128, 76, }, + { 9, 1, 0, 2, 128, 127, }, + { 0, 1, 0, 2, 132, 76, }, + { 2, 1, 0, 2, 132, 62, }, + { 1, 1, 0, 2, 132, 76, }, + { 3, 1, 0, 2, 132, 76, }, + { 4, 1, 0, 2, 132, 76, }, + { 5, 1, 0, 2, 132, 62, }, + { 6, 1, 0, 2, 132, 76, }, + { 7, 1, 0, 2, 132, 54, }, + { 8, 1, 0, 2, 132, 76, }, + { 9, 1, 0, 2, 132, 127, }, + { 0, 1, 0, 2, 136, 76, }, + { 2, 1, 0, 2, 136, 62, }, + { 1, 1, 0, 2, 136, 76, }, + { 3, 1, 0, 2, 136, 76, }, + { 4, 1, 0, 2, 136, 76, }, + { 5, 1, 0, 2, 136, 62, }, + { 6, 1, 0, 2, 136, 76, }, + { 7, 1, 0, 2, 136, 54, }, + { 8, 1, 0, 2, 136, 76, }, + { 9, 1, 0, 2, 136, 127, }, + { 0, 1, 0, 2, 140, 70, }, + { 2, 1, 0, 2, 140, 62, }, + { 1, 1, 0, 2, 140, 76, }, + { 3, 1, 0, 2, 140, 70, }, + { 4, 1, 0, 2, 140, 76, }, + { 5, 1, 0, 2, 140, 62, }, + { 6, 1, 0, 2, 140, 70, }, + { 7, 1, 0, 2, 140, 54, }, + { 8, 1, 0, 2, 140, 70, }, + { 9, 1, 0, 2, 140, 127, }, + { 0, 1, 0, 2, 144, 76, }, + { 2, 1, 0, 2, 144, 127, }, + { 1, 1, 0, 2, 144, 127, }, + { 3, 1, 0, 2, 144, 76, }, + { 4, 1, 0, 2, 144, 76, }, + { 5, 1, 0, 2, 144, 127, }, + { 6, 1, 0, 2, 144, 76, }, + { 7, 1, 0, 2, 144, 127, }, + { 8, 1, 0, 2, 144, 76, }, + { 9, 1, 0, 2, 144, 127, }, + { 0, 1, 0, 2, 149, 76, }, + { 2, 1, 0, 2, 149, 54, }, + { 1, 1, 0, 2, 149, 127, }, + { 3, 1, 0, 2, 149, 76, }, + { 4, 1, 0, 2, 149, 74, }, + { 5, 1, 0, 2, 149, 76, }, + { 6, 1, 0, 2, 149, 76, }, + { 7, 1, 0, 2, 149, 54, }, + { 8, 1, 0, 2, 149, 76, }, + { 9, 1, 0, 2, 149, 54, }, + { 0, 1, 0, 2, 153, 76, }, + { 2, 1, 0, 2, 153, 54, }, + { 1, 1, 0, 2, 153, 127, }, + { 3, 1, 0, 2, 153, 76, }, + { 4, 1, 0, 2, 153, 74, }, + { 5, 1, 0, 2, 153, 76, }, + { 6, 1, 0, 2, 153, 76, }, + { 7, 1, 0, 2, 153, 54, }, + { 8, 1, 0, 2, 153, 76, }, + { 9, 1, 0, 2, 153, 54, }, + { 0, 1, 0, 2, 157, 76, }, + { 2, 1, 0, 2, 157, 54, }, + { 1, 1, 0, 2, 157, 127, }, + { 3, 1, 0, 2, 157, 76, }, + { 4, 1, 0, 2, 157, 74, }, + { 5, 1, 0, 2, 157, 76, }, + { 6, 1, 0, 2, 157, 76, }, + { 7, 1, 0, 2, 157, 54, }, + { 8, 1, 0, 2, 157, 76, }, + { 9, 1, 0, 2, 157, 54, }, + { 0, 1, 0, 2, 161, 76, }, + { 2, 1, 0, 2, 161, 54, }, + { 1, 1, 0, 2, 161, 127, }, + { 3, 1, 0, 2, 161, 76, }, + { 4, 1, 0, 2, 161, 74, }, + { 5, 1, 0, 2, 161, 76, }, + { 6, 1, 0, 2, 161, 76, }, + { 7, 1, 0, 2, 161, 54, }, + { 8, 1, 0, 2, 161, 76, }, + { 9, 1, 0, 2, 161, 54, }, + { 0, 1, 0, 2, 165, 76, }, + { 2, 1, 0, 2, 165, 54, }, + { 1, 1, 0, 2, 165, 127, }, + { 3, 1, 0, 2, 165, 76, }, + { 4, 1, 0, 2, 165, 74, }, + { 5, 1, 0, 2, 165, 76, }, + { 6, 1, 0, 2, 165, 76, }, + { 7, 1, 0, 2, 165, 54, }, + { 8, 1, 0, 2, 165, 76, }, + { 9, 1, 0, 2, 165, 54, }, + { 0, 1, 0, 3, 36, 68, }, + { 2, 1, 0, 3, 36, 38, }, + { 1, 1, 0, 3, 36, 50, }, + { 3, 1, 0, 3, 36, 38, }, + { 4, 1, 0, 3, 36, 66, }, + { 5, 1, 0, 3, 36, 38, }, + { 6, 1, 0, 3, 36, 52, }, + { 7, 1, 0, 3, 36, 30, }, + { 8, 1, 0, 3, 36, 50, }, + { 9, 1, 0, 3, 36, 38, }, + { 0, 1, 0, 3, 40, 68, }, + { 2, 1, 0, 3, 40, 38, }, + { 1, 1, 0, 3, 40, 50, }, + { 3, 1, 0, 3, 40, 38, }, + { 4, 1, 0, 3, 40, 66, }, + { 5, 1, 0, 3, 40, 38, }, + { 6, 1, 0, 3, 40, 52, }, + { 7, 1, 0, 3, 40, 30, }, + { 8, 1, 0, 3, 40, 50, }, + { 9, 1, 0, 3, 40, 38, }, + { 0, 1, 0, 3, 44, 68, }, + { 2, 1, 0, 3, 44, 38, }, + { 1, 1, 0, 3, 44, 50, }, + { 3, 1, 0, 3, 44, 38, }, + { 4, 1, 0, 3, 44, 66, }, + { 5, 1, 0, 3, 44, 38, }, + { 6, 1, 0, 3, 44, 52, }, + { 7, 1, 0, 3, 44, 30, }, + { 8, 1, 0, 3, 44, 50, }, + { 9, 1, 0, 3, 44, 38, }, + { 0, 1, 0, 3, 48, 68, }, + { 2, 1, 0, 3, 48, 38, }, + { 1, 1, 0, 3, 48, 50, }, + { 3, 1, 0, 3, 48, 38, }, + { 4, 1, 0, 3, 48, 36, }, + { 5, 1, 0, 3, 48, 38, }, + { 6, 1, 0, 3, 48, 52, }, + { 7, 1, 0, 3, 48, 30, }, + { 8, 1, 0, 3, 48, 50, }, + { 9, 1, 0, 3, 48, 38, }, + { 0, 1, 0, 3, 52, 68, }, + { 2, 1, 0, 3, 52, 38, }, + { 1, 1, 0, 3, 52, 50, }, + { 3, 1, 0, 3, 52, 40, }, + { 4, 1, 0, 3, 52, 66, }, + { 5, 1, 0, 3, 52, 38, }, + { 6, 1, 0, 3, 52, 68, }, + { 7, 1, 0, 3, 52, 30, }, + { 8, 1, 0, 3, 52, 68, }, + { 9, 1, 0, 3, 52, 38, }, + { 0, 1, 0, 3, 56, 68, }, + { 2, 1, 0, 3, 56, 38, }, + { 1, 1, 0, 3, 56, 50, }, + { 3, 1, 0, 3, 56, 40, }, + { 4, 1, 0, 3, 56, 66, }, + { 5, 1, 0, 3, 56, 38, }, + { 6, 1, 0, 3, 56, 68, }, + { 7, 1, 0, 3, 56, 30, }, + { 8, 1, 0, 3, 56, 68, }, + { 9, 1, 0, 3, 56, 38, }, + { 0, 1, 0, 3, 60, 66, }, + { 2, 1, 0, 3, 60, 38, }, + { 1, 1, 0, 3, 60, 50, }, + { 3, 1, 0, 3, 60, 40, }, + { 4, 1, 0, 3, 60, 66, }, + { 5, 1, 0, 3, 60, 38, }, + { 6, 1, 0, 3, 60, 66, }, + { 7, 1, 0, 3, 60, 30, }, + { 8, 1, 0, 3, 60, 66, }, + { 9, 1, 0, 3, 60, 38, }, + { 0, 1, 0, 3, 64, 68, }, + { 2, 1, 0, 3, 64, 38, }, + { 1, 1, 0, 3, 64, 50, }, + { 3, 1, 0, 3, 64, 40, }, + { 4, 1, 0, 3, 64, 66, }, + { 5, 1, 0, 3, 64, 38, }, + { 6, 1, 0, 3, 64, 68, }, + { 7, 1, 0, 3, 64, 30, }, + { 8, 1, 0, 3, 64, 68, }, + { 9, 1, 0, 3, 64, 38, }, + { 0, 1, 0, 3, 100, 60, }, + { 2, 1, 0, 3, 100, 38, }, + { 1, 1, 0, 3, 100, 70, }, + { 3, 1, 0, 3, 100, 60, }, + { 4, 1, 0, 3, 100, 64, }, + { 5, 1, 0, 3, 100, 38, }, + { 6, 1, 0, 3, 100, 60, }, + { 7, 1, 0, 3, 100, 30, }, + { 8, 1, 0, 3, 100, 60, }, + { 9, 1, 0, 3, 100, 127, }, + { 0, 1, 0, 3, 104, 68, }, + { 2, 1, 0, 3, 104, 38, }, + { 1, 1, 0, 3, 104, 70, }, + { 3, 1, 0, 3, 104, 68, }, + { 4, 1, 0, 3, 104, 64, }, + { 5, 1, 0, 3, 104, 38, }, + { 6, 1, 0, 3, 104, 68, }, + { 7, 1, 0, 3, 104, 30, }, + { 8, 1, 0, 3, 104, 68, }, + { 9, 1, 0, 3, 104, 127, }, + { 0, 1, 0, 3, 108, 68, }, + { 2, 1, 0, 3, 108, 38, }, + { 1, 1, 0, 3, 108, 70, }, + { 3, 1, 0, 3, 108, 68, }, + { 4, 1, 0, 3, 108, 64, }, + { 5, 1, 0, 3, 108, 38, }, + { 6, 1, 0, 3, 108, 68, }, + { 7, 1, 0, 3, 108, 30, }, + { 8, 1, 0, 3, 108, 68, }, + { 9, 1, 0, 3, 108, 127, }, + { 0, 1, 0, 3, 112, 68, }, + { 2, 1, 0, 3, 112, 38, }, + { 1, 1, 0, 3, 112, 70, }, + { 3, 1, 0, 3, 112, 68, }, + { 4, 1, 0, 3, 112, 64, }, + { 5, 1, 0, 3, 112, 38, }, + { 6, 1, 0, 3, 112, 68, }, + { 7, 1, 0, 3, 112, 30, }, + { 8, 1, 0, 3, 112, 68, }, + { 9, 1, 0, 3, 112, 127, }, + { 0, 1, 0, 3, 116, 68, }, + { 2, 1, 0, 3, 116, 38, }, + { 1, 1, 0, 3, 116, 70, }, + { 3, 1, 0, 3, 116, 68, }, + { 4, 1, 0, 3, 116, 64, }, + { 5, 1, 0, 3, 116, 38, }, + { 6, 1, 0, 3, 116, 68, }, + { 7, 1, 0, 3, 116, 30, }, + { 8, 1, 0, 3, 116, 68, }, + { 9, 1, 0, 3, 116, 127, }, + { 0, 1, 0, 3, 120, 68, }, + { 2, 1, 0, 3, 120, 38, }, + { 1, 1, 0, 3, 120, 70, }, + { 3, 1, 0, 3, 120, 127, }, + { 4, 1, 0, 3, 120, 64, }, + { 5, 1, 0, 3, 120, 127, }, + { 6, 1, 0, 3, 120, 68, }, + { 7, 1, 0, 3, 120, 30, }, + { 8, 1, 0, 3, 120, 68, }, + { 9, 1, 0, 3, 120, 127, }, + { 0, 1, 0, 3, 124, 68, }, + { 2, 1, 0, 3, 124, 38, }, + { 1, 1, 0, 3, 124, 70, }, + { 3, 1, 0, 3, 124, 127, }, + { 4, 1, 0, 3, 124, 64, }, + { 5, 1, 0, 3, 124, 127, }, + { 6, 1, 0, 3, 124, 68, }, + { 7, 1, 0, 3, 124, 30, }, + { 8, 1, 0, 3, 124, 68, }, + { 9, 1, 0, 3, 124, 127, }, + { 0, 1, 0, 3, 128, 68, }, + { 2, 1, 0, 3, 128, 38, }, + { 1, 1, 0, 3, 128, 70, }, + { 3, 1, 0, 3, 128, 127, }, + { 4, 1, 0, 3, 128, 64, }, + { 5, 1, 0, 3, 128, 127, }, + { 6, 1, 0, 3, 128, 68, }, + { 7, 1, 0, 3, 128, 30, }, + { 8, 1, 0, 3, 128, 68, }, + { 9, 1, 0, 3, 128, 127, }, + { 0, 1, 0, 3, 132, 68, }, + { 2, 1, 0, 3, 132, 38, }, + { 1, 1, 0, 3, 132, 70, }, + { 3, 1, 0, 3, 132, 68, }, + { 4, 1, 0, 3, 132, 64, }, + { 5, 1, 0, 3, 132, 38, }, + { 6, 1, 0, 3, 132, 68, }, + { 7, 1, 0, 3, 132, 30, }, + { 8, 1, 0, 3, 132, 68, }, + { 9, 1, 0, 3, 132, 127, }, + { 0, 1, 0, 3, 136, 68, }, + { 2, 1, 0, 3, 136, 38, }, + { 1, 1, 0, 3, 136, 70, }, + { 3, 1, 0, 3, 136, 68, }, + { 4, 1, 0, 3, 136, 64, }, + { 5, 1, 0, 3, 136, 38, }, + { 6, 1, 0, 3, 136, 68, }, + { 7, 1, 0, 3, 136, 30, }, + { 8, 1, 0, 3, 136, 68, }, + { 9, 1, 0, 3, 136, 127, }, + { 0, 1, 0, 3, 140, 60, }, + { 2, 1, 0, 3, 140, 38, }, + { 1, 1, 0, 3, 140, 70, }, + { 3, 1, 0, 3, 140, 60, }, + { 4, 1, 0, 3, 140, 64, }, + { 5, 1, 0, 3, 140, 38, }, + { 6, 1, 0, 3, 140, 60, }, + { 7, 1, 0, 3, 140, 30, }, + { 8, 1, 0, 3, 140, 60, }, + { 9, 1, 0, 3, 140, 127, }, + { 0, 1, 0, 3, 144, 68, }, + { 2, 1, 0, 3, 144, 127, }, + { 1, 1, 0, 3, 144, 127, }, + { 3, 1, 0, 3, 144, 68, }, + { 4, 1, 0, 3, 144, 64, }, + { 5, 1, 0, 3, 144, 127, }, + { 6, 1, 0, 3, 144, 68, }, + { 7, 1, 0, 3, 144, 127, }, + { 8, 1, 0, 3, 144, 68, }, + { 9, 1, 0, 3, 144, 127, }, + { 0, 1, 0, 3, 149, 76, }, + { 2, 1, 0, 3, 149, 30, }, + { 1, 1, 0, 3, 149, 127, }, + { 3, 1, 0, 3, 149, 76, }, + { 4, 1, 0, 3, 149, 60, }, + { 5, 1, 0, 3, 149, 76, }, + { 6, 1, 0, 3, 149, 76, }, + { 7, 1, 0, 3, 149, 30, }, + { 8, 1, 0, 3, 149, 72, }, + { 9, 1, 0, 3, 149, 30, }, + { 0, 1, 0, 3, 153, 76, }, + { 2, 1, 0, 3, 153, 30, }, + { 1, 1, 0, 3, 153, 127, }, + { 3, 1, 0, 3, 153, 76, }, + { 4, 1, 0, 3, 153, 60, }, + { 5, 1, 0, 3, 153, 76, }, + { 6, 1, 0, 3, 153, 76, }, + { 7, 1, 0, 3, 153, 30, }, + { 8, 1, 0, 3, 153, 76, }, + { 9, 1, 0, 3, 153, 30, }, + { 0, 1, 0, 3, 157, 76, }, + { 2, 1, 0, 3, 157, 30, }, + { 1, 1, 0, 3, 157, 127, }, + { 3, 1, 0, 3, 157, 76, }, + { 4, 1, 0, 3, 157, 60, }, + { 5, 1, 0, 3, 157, 76, }, + { 6, 1, 0, 3, 157, 76, }, + { 7, 1, 0, 3, 157, 30, }, + { 8, 1, 0, 3, 157, 76, }, + { 9, 1, 0, 3, 157, 30, }, + { 0, 1, 0, 3, 161, 76, }, + { 2, 1, 0, 3, 161, 30, }, + { 1, 1, 0, 3, 161, 127, }, + { 3, 1, 0, 3, 161, 76, }, + { 4, 1, 0, 3, 161, 60, }, + { 5, 1, 0, 3, 161, 76, }, + { 6, 1, 0, 3, 161, 76, }, + { 7, 1, 0, 3, 161, 30, }, + { 8, 1, 0, 3, 161, 76, }, + { 9, 1, 0, 3, 161, 30, }, + { 0, 1, 0, 3, 165, 76, }, + { 2, 1, 0, 3, 165, 30, }, + { 1, 1, 0, 3, 165, 127, }, + { 3, 1, 0, 3, 165, 76, }, + { 4, 1, 0, 3, 165, 60, }, + { 5, 1, 0, 3, 165, 76, }, + { 6, 1, 0, 3, 165, 76, }, + { 7, 1, 0, 3, 165, 30, }, + { 8, 1, 0, 3, 165, 76, }, + { 9, 1, 0, 3, 165, 30, }, + { 0, 1, 1, 2, 38, 66, }, + { 2, 1, 1, 2, 38, 64, }, + { 1, 1, 1, 2, 38, 62, }, + { 3, 1, 1, 2, 38, 64, }, + { 4, 1, 1, 2, 38, 72, }, + { 5, 1, 1, 2, 38, 64, }, + { 6, 1, 1, 2, 38, 64, }, + { 7, 1, 1, 2, 38, 54, }, + { 8, 1, 1, 2, 38, 62, }, + { 9, 1, 1, 2, 38, 64, }, + { 0, 1, 1, 2, 46, 72, }, + { 2, 1, 1, 2, 46, 64, }, + { 1, 1, 1, 2, 46, 62, }, + { 3, 1, 1, 2, 46, 64, }, + { 4, 1, 1, 2, 46, 60, }, + { 5, 1, 1, 2, 46, 64, }, + { 6, 1, 1, 2, 46, 64, }, + { 7, 1, 1, 2, 46, 54, }, + { 8, 1, 1, 2, 46, 62, }, + { 9, 1, 1, 2, 46, 64, }, + { 0, 1, 1, 2, 54, 72, }, + { 2, 1, 1, 2, 54, 64, }, + { 1, 1, 1, 2, 54, 62, }, + { 3, 1, 1, 2, 54, 64, }, + { 4, 1, 1, 2, 54, 72, }, + { 5, 1, 1, 2, 54, 64, }, + { 6, 1, 1, 2, 54, 72, }, + { 7, 1, 1, 2, 54, 54, }, + { 8, 1, 1, 2, 54, 72, }, + { 9, 1, 1, 2, 54, 64, }, + { 0, 1, 1, 2, 62, 64, }, + { 2, 1, 1, 2, 62, 64, }, + { 1, 1, 1, 2, 62, 62, }, + { 3, 1, 1, 2, 62, 64, }, + { 4, 1, 1, 2, 62, 70, }, + { 5, 1, 1, 2, 62, 64, }, + { 6, 1, 1, 2, 62, 64, }, + { 7, 1, 1, 2, 62, 54, }, + { 8, 1, 1, 2, 62, 64, }, + { 9, 1, 1, 2, 62, 64, }, + { 0, 1, 1, 2, 102, 58, }, + { 2, 1, 1, 2, 102, 64, }, + { 1, 1, 1, 2, 102, 72, }, + { 3, 1, 1, 2, 102, 58, }, + { 4, 1, 1, 2, 102, 72, }, + { 5, 1, 1, 2, 102, 64, }, + { 6, 1, 1, 2, 102, 58, }, + { 7, 1, 1, 2, 102, 54, }, + { 8, 1, 1, 2, 102, 58, }, + { 9, 1, 1, 2, 102, 127, }, + { 0, 1, 1, 2, 110, 72, }, + { 2, 1, 1, 2, 110, 64, }, + { 1, 1, 1, 2, 110, 72, }, + { 3, 1, 1, 2, 110, 72, }, + { 4, 1, 1, 2, 110, 72, }, + { 5, 1, 1, 2, 110, 64, }, + { 6, 1, 1, 2, 110, 72, }, + { 7, 1, 1, 2, 110, 54, }, + { 8, 1, 1, 2, 110, 72, }, + { 9, 1, 1, 2, 110, 127, }, + { 0, 1, 1, 2, 118, 72, }, + { 2, 1, 1, 2, 118, 64, }, + { 1, 1, 1, 2, 118, 72, }, + { 3, 1, 1, 2, 118, 127, }, + { 4, 1, 1, 2, 118, 72, }, + { 5, 1, 1, 2, 118, 127, }, + { 6, 1, 1, 2, 118, 72, }, + { 7, 1, 1, 2, 118, 54, }, + { 8, 1, 1, 2, 118, 72, }, + { 9, 1, 1, 2, 118, 127, }, + { 0, 1, 1, 2, 126, 72, }, + { 2, 1, 1, 2, 126, 64, }, + { 1, 1, 1, 2, 126, 72, }, + { 3, 1, 1, 2, 126, 127, }, + { 4, 1, 1, 2, 126, 72, }, + { 5, 1, 1, 2, 126, 127, }, + { 6, 1, 1, 2, 126, 72, }, + { 7, 1, 1, 2, 126, 54, }, + { 8, 1, 1, 2, 126, 72, }, + { 9, 1, 1, 2, 126, 127, }, + { 0, 1, 1, 2, 134, 72, }, + { 2, 1, 1, 2, 134, 64, }, + { 1, 1, 1, 2, 134, 72, }, + { 3, 1, 1, 2, 134, 72, }, + { 4, 1, 1, 2, 134, 72, }, + { 5, 1, 1, 2, 134, 64, }, + { 6, 1, 1, 2, 134, 72, }, + { 7, 1, 1, 2, 134, 54, }, + { 8, 1, 1, 2, 134, 72, }, + { 9, 1, 1, 2, 134, 127, }, + { 0, 1, 1, 2, 142, 72, }, + { 2, 1, 1, 2, 142, 127, }, + { 1, 1, 1, 2, 142, 127, }, + { 3, 1, 1, 2, 142, 72, }, + { 4, 1, 1, 2, 142, 72, }, + { 5, 1, 1, 2, 142, 127, }, + { 6, 1, 1, 2, 142, 72, }, + { 7, 1, 1, 2, 142, 127, }, + { 8, 1, 1, 2, 142, 72, }, + { 9, 1, 1, 2, 142, 127, }, + { 0, 1, 1, 2, 151, 72, }, + { 2, 1, 1, 2, 151, 54, }, + { 1, 1, 1, 2, 151, 127, }, + { 3, 1, 1, 2, 151, 72, }, + { 4, 1, 1, 2, 151, 72, }, + { 5, 1, 1, 2, 151, 72, }, + { 6, 1, 1, 2, 151, 72, }, + { 7, 1, 1, 2, 151, 54, }, + { 8, 1, 1, 2, 151, 72, }, + { 9, 1, 1, 2, 151, 54, }, + { 0, 1, 1, 2, 159, 72, }, + { 2, 1, 1, 2, 159, 54, }, + { 1, 1, 1, 2, 159, 127, }, + { 3, 1, 1, 2, 159, 72, }, + { 4, 1, 1, 2, 159, 72, }, + { 5, 1, 1, 2, 159, 72, }, + { 6, 1, 1, 2, 159, 72, }, + { 7, 1, 1, 2, 159, 54, }, + { 8, 1, 1, 2, 159, 72, }, + { 9, 1, 1, 2, 159, 54, }, + { 0, 1, 1, 3, 38, 60, }, + { 2, 1, 1, 3, 38, 40, }, + { 1, 1, 1, 3, 38, 50, }, + { 3, 1, 1, 3, 38, 40, }, + { 4, 1, 1, 3, 38, 62, }, + { 5, 1, 1, 3, 38, 40, }, + { 6, 1, 1, 3, 38, 52, }, + { 7, 1, 1, 3, 38, 30, }, + { 8, 1, 1, 3, 38, 50, }, + { 9, 1, 1, 3, 38, 40, }, + { 0, 1, 1, 3, 46, 68, }, + { 2, 1, 1, 3, 46, 40, }, + { 1, 1, 1, 3, 46, 50, }, + { 3, 1, 1, 3, 46, 40, }, + { 4, 1, 1, 3, 46, 46, }, + { 5, 1, 1, 3, 46, 40, }, + { 6, 1, 1, 3, 46, 52, }, + { 7, 1, 1, 3, 46, 30, }, + { 8, 1, 1, 3, 46, 50, }, + { 9, 1, 1, 3, 46, 40, }, + { 0, 1, 1, 3, 54, 68, }, + { 2, 1, 1, 3, 54, 40, }, + { 1, 1, 1, 3, 54, 50, }, + { 3, 1, 1, 3, 54, 40, }, + { 4, 1, 1, 3, 54, 62, }, + { 5, 1, 1, 3, 54, 40, }, + { 6, 1, 1, 3, 54, 68, }, + { 7, 1, 1, 3, 54, 30, }, + { 8, 1, 1, 3, 54, 68, }, + { 9, 1, 1, 3, 54, 40, }, + { 0, 1, 1, 3, 62, 58, }, + { 2, 1, 1, 3, 62, 40, }, + { 1, 1, 1, 3, 62, 48, }, + { 3, 1, 1, 3, 62, 40, }, + { 4, 1, 1, 3, 62, 58, }, + { 5, 1, 1, 3, 62, 40, }, + { 6, 1, 1, 3, 62, 58, }, + { 7, 1, 1, 3, 62, 30, }, + { 8, 1, 1, 3, 62, 58, }, + { 9, 1, 1, 3, 62, 40, }, + { 0, 1, 1, 3, 102, 54, }, + { 2, 1, 1, 3, 102, 40, }, + { 1, 1, 1, 3, 102, 70, }, + { 3, 1, 1, 3, 102, 54, }, + { 4, 1, 1, 3, 102, 64, }, + { 5, 1, 1, 3, 102, 40, }, + { 6, 1, 1, 3, 102, 54, }, + { 7, 1, 1, 3, 102, 30, }, + { 8, 1, 1, 3, 102, 54, }, + { 9, 1, 1, 3, 102, 127, }, + { 0, 1, 1, 3, 110, 68, }, + { 2, 1, 1, 3, 110, 40, }, + { 1, 1, 1, 3, 110, 70, }, + { 3, 1, 1, 3, 110, 68, }, + { 4, 1, 1, 3, 110, 64, }, + { 5, 1, 1, 3, 110, 40, }, + { 6, 1, 1, 3, 110, 68, }, + { 7, 1, 1, 3, 110, 30, }, + { 8, 1, 1, 3, 110, 68, }, + { 9, 1, 1, 3, 110, 127, }, + { 0, 1, 1, 3, 118, 68, }, + { 2, 1, 1, 3, 118, 40, }, + { 1, 1, 1, 3, 118, 70, }, + { 3, 1, 1, 3, 118, 127, }, + { 4, 1, 1, 3, 118, 64, }, + { 5, 1, 1, 3, 118, 127, }, + { 6, 1, 1, 3, 118, 68, }, + { 7, 1, 1, 3, 118, 30, }, + { 8, 1, 1, 3, 118, 68, }, + { 9, 1, 1, 3, 118, 127, }, + { 0, 1, 1, 3, 126, 68, }, + { 2, 1, 1, 3, 126, 40, }, + { 1, 1, 1, 3, 126, 70, }, + { 3, 1, 1, 3, 126, 127, }, + { 4, 1, 1, 3, 126, 64, }, + { 5, 1, 1, 3, 126, 127, }, + { 6, 1, 1, 3, 126, 68, }, + { 7, 1, 1, 3, 126, 30, }, + { 8, 1, 1, 3, 126, 68, }, + { 9, 1, 1, 3, 126, 127, }, + { 0, 1, 1, 3, 134, 68, }, + { 2, 1, 1, 3, 134, 40, }, + { 1, 1, 1, 3, 134, 70, }, + { 3, 1, 1, 3, 134, 68, }, + { 4, 1, 1, 3, 134, 64, }, + { 5, 1, 1, 3, 134, 40, }, + { 6, 1, 1, 3, 134, 68, }, + { 7, 1, 1, 3, 134, 30, }, + { 8, 1, 1, 3, 134, 68, }, + { 9, 1, 1, 3, 134, 127, }, + { 0, 1, 1, 3, 142, 68, }, + { 2, 1, 1, 3, 142, 127, }, + { 1, 1, 1, 3, 142, 127, }, + { 3, 1, 1, 3, 142, 68, }, + { 4, 1, 1, 3, 142, 64, }, + { 5, 1, 1, 3, 142, 127, }, + { 6, 1, 1, 3, 142, 68, }, + { 7, 1, 1, 3, 142, 127, }, + { 8, 1, 1, 3, 142, 68, }, + { 9, 1, 1, 3, 142, 127, }, + { 0, 1, 1, 3, 151, 72, }, + { 2, 1, 1, 3, 151, 30, }, + { 1, 1, 1, 3, 151, 127, }, + { 3, 1, 1, 3, 151, 72, }, + { 4, 1, 1, 3, 151, 66, }, + { 5, 1, 1, 3, 151, 72, }, + { 6, 1, 1, 3, 151, 72, }, + { 7, 1, 1, 3, 151, 30, }, + { 8, 1, 1, 3, 151, 68, }, + { 9, 1, 1, 3, 151, 30, }, + { 0, 1, 1, 3, 159, 72, }, + { 2, 1, 1, 3, 159, 30, }, + { 1, 1, 1, 3, 159, 127, }, + { 3, 1, 1, 3, 159, 72, }, + { 4, 1, 1, 3, 159, 66, }, + { 5, 1, 1, 3, 159, 72, }, + { 6, 1, 1, 3, 159, 72, }, + { 7, 1, 1, 3, 159, 30, }, + { 8, 1, 1, 3, 159, 72, }, + { 9, 1, 1, 3, 159, 30, }, + { 0, 1, 2, 4, 42, 64, }, + { 2, 1, 2, 4, 42, 64, }, + { 1, 1, 2, 4, 42, 64, }, + { 3, 1, 2, 4, 42, 64, }, + { 4, 1, 2, 4, 42, 68, }, + { 5, 1, 2, 4, 42, 64, }, + { 6, 1, 2, 4, 42, 64, }, + { 7, 1, 2, 4, 42, 54, }, + { 8, 1, 2, 4, 42, 62, }, + { 9, 1, 2, 4, 42, 64, }, + { 0, 1, 2, 4, 58, 62, }, + { 2, 1, 2, 4, 58, 64, }, + { 1, 1, 2, 4, 58, 64, }, + { 3, 1, 2, 4, 58, 62, }, + { 4, 1, 2, 4, 58, 64, }, + { 5, 1, 2, 4, 58, 64, }, + { 6, 1, 2, 4, 58, 62, }, + { 7, 1, 2, 4, 58, 54, }, + { 8, 1, 2, 4, 58, 62, }, + { 9, 1, 2, 4, 58, 64, }, + { 0, 1, 2, 4, 106, 58, }, + { 2, 1, 2, 4, 106, 64, }, + { 1, 1, 2, 4, 106, 72, }, + { 3, 1, 2, 4, 106, 58, }, + { 4, 1, 2, 4, 106, 66, }, + { 5, 1, 2, 4, 106, 64, }, + { 6, 1, 2, 4, 106, 58, }, + { 7, 1, 2, 4, 106, 54, }, + { 8, 1, 2, 4, 106, 58, }, + { 9, 1, 2, 4, 106, 127, }, + { 0, 1, 2, 4, 122, 72, }, + { 2, 1, 2, 4, 122, 64, }, + { 1, 1, 2, 4, 122, 72, }, + { 3, 1, 2, 4, 122, 127, }, + { 4, 1, 2, 4, 122, 68, }, + { 5, 1, 2, 4, 122, 127, }, + { 6, 1, 2, 4, 122, 72, }, + { 7, 1, 2, 4, 122, 54, }, + { 8, 1, 2, 4, 122, 72, }, + { 9, 1, 2, 4, 122, 127, }, + { 0, 1, 2, 4, 138, 72, }, + { 2, 1, 2, 4, 138, 127, }, + { 1, 1, 2, 4, 138, 127, }, + { 3, 1, 2, 4, 138, 72, }, + { 4, 1, 2, 4, 138, 68, }, + { 5, 1, 2, 4, 138, 127, }, + { 6, 1, 2, 4, 138, 72, }, + { 7, 1, 2, 4, 138, 127, }, + { 8, 1, 2, 4, 138, 72, }, + { 9, 1, 2, 4, 138, 127, }, + { 0, 1, 2, 4, 155, 72, }, + { 2, 1, 2, 4, 155, 54, }, + { 1, 1, 2, 4, 155, 127, }, + { 3, 1, 2, 4, 155, 72, }, + { 4, 1, 2, 4, 155, 68, }, + { 5, 1, 2, 4, 155, 72, }, + { 6, 1, 2, 4, 155, 72, }, + { 7, 1, 2, 4, 155, 54, }, + { 8, 1, 2, 4, 155, 68, }, + { 9, 1, 2, 4, 155, 54, }, + { 0, 1, 2, 5, 42, 54, }, + { 2, 1, 2, 5, 42, 40, }, + { 1, 1, 2, 5, 42, 50, }, + { 3, 1, 2, 5, 42, 40, }, + { 4, 1, 2, 5, 42, 58, }, + { 5, 1, 2, 5, 42, 40, }, + { 6, 1, 2, 5, 42, 52, }, + { 7, 1, 2, 5, 42, 30, }, + { 8, 1, 2, 5, 42, 50, }, + { 9, 1, 2, 5, 42, 40, }, + { 0, 1, 2, 5, 58, 52, }, + { 2, 1, 2, 5, 58, 40, }, + { 1, 1, 2, 5, 58, 50, }, + { 3, 1, 2, 5, 58, 40, }, + { 4, 1, 2, 5, 58, 56, }, + { 5, 1, 2, 5, 58, 40, }, + { 6, 1, 2, 5, 58, 52, }, + { 7, 1, 2, 5, 58, 30, }, + { 8, 1, 2, 5, 58, 52, }, + { 9, 1, 2, 5, 58, 40, }, + { 0, 1, 2, 5, 106, 50, }, + { 2, 1, 2, 5, 106, 40, }, + { 1, 1, 2, 5, 106, 72, }, + { 3, 1, 2, 5, 106, 50, }, + { 4, 1, 2, 5, 106, 56, }, + { 5, 1, 2, 5, 106, 40, }, + { 6, 1, 2, 5, 106, 50, }, + { 7, 1, 2, 5, 106, 30, }, + { 8, 1, 2, 5, 106, 50, }, + { 9, 1, 2, 5, 106, 127, }, + { 0, 1, 2, 5, 122, 66, }, + { 2, 1, 2, 5, 122, 40, }, + { 1, 1, 2, 5, 122, 72, }, + { 3, 1, 2, 5, 122, 127, }, + { 4, 1, 2, 5, 122, 56, }, + { 5, 1, 2, 5, 122, 127, }, + { 6, 1, 2, 5, 122, 66, }, + { 7, 1, 2, 5, 122, 30, }, + { 8, 1, 2, 5, 122, 66, }, + { 9, 1, 2, 5, 122, 127, }, + { 0, 1, 2, 5, 138, 66, }, + { 2, 1, 2, 5, 138, 127, }, + { 1, 1, 2, 5, 138, 127, }, + { 3, 1, 2, 5, 138, 66, }, + { 4, 1, 2, 5, 138, 58, }, + { 5, 1, 2, 5, 138, 127, }, + { 6, 1, 2, 5, 138, 66, }, + { 7, 1, 2, 5, 138, 127, }, + { 8, 1, 2, 5, 138, 66, }, + { 9, 1, 2, 5, 138, 127, }, + { 0, 1, 2, 5, 155, 62, }, + { 2, 1, 2, 5, 155, 30, }, + { 1, 1, 2, 5, 155, 127, }, + { 3, 1, 2, 5, 155, 62, }, + { 4, 1, 2, 5, 155, 58, }, + { 5, 1, 2, 5, 155, 72, }, + { 6, 1, 2, 5, 155, 62, }, + { 7, 1, 2, 5, 155, 30, }, + { 8, 1, 2, 5, 155, 62, }, + { 9, 1, 2, 5, 155, 30, }, +}; + +RTW_DECL_TABLE_TXPWR_LMT(rtw8822c_txpwr_lmt_type0); + +static const struct rtw_txpwr_lmt_cfg_pair rtw8822c_txpwr_lmt_type5[] = { + { 0, 0, 0, 0, 1, 72, }, + { 2, 0, 0, 0, 1, 56, }, + { 1, 0, 0, 0, 1, 72, }, + { 3, 0, 0, 0, 1, 72, }, + { 4, 0, 0, 0, 1, 76, }, + { 5, 0, 0, 0, 1, 56, }, + { 6, 0, 0, 0, 1, 72, }, + { 7, 0, 0, 0, 1, 60, }, + { 8, 0, 0, 0, 1, 72, }, + { 9, 0, 0, 0, 1, 60, }, + { 0, 0, 0, 0, 2, 72, }, + { 2, 0, 0, 0, 2, 56, }, + { 1, 0, 0, 0, 2, 72, }, + { 3, 0, 0, 0, 2, 72, }, + { 4, 0, 0, 0, 2, 76, }, + { 5, 0, 0, 0, 2, 56, }, + { 6, 0, 0, 0, 2, 72, }, + { 7, 0, 0, 0, 2, 60, }, + { 8, 0, 0, 0, 2, 72, }, + { 9, 0, 0, 0, 2, 60, }, + { 0, 0, 0, 0, 3, 76, }, + { 2, 0, 0, 0, 3, 56, }, + { 1, 0, 0, 0, 3, 72, }, + { 3, 0, 0, 0, 3, 76, }, + { 4, 0, 0, 0, 3, 76, }, + { 5, 0, 0, 0, 3, 56, }, + { 6, 0, 0, 0, 3, 76, }, + { 7, 0, 0, 0, 3, 60, }, + { 8, 0, 0, 0, 3, 76, }, + { 9, 0, 0, 0, 3, 60, }, + { 0, 0, 0, 0, 4, 76, }, + { 2, 0, 0, 0, 4, 56, }, + { 1, 0, 0, 0, 4, 72, }, + { 3, 0, 0, 0, 4, 76, }, + { 4, 0, 0, 0, 4, 76, }, + { 5, 0, 0, 0, 4, 56, }, + { 6, 0, 0, 0, 4, 76, }, + { 7, 0, 0, 0, 4, 60, }, + { 8, 0, 0, 0, 4, 76, }, + { 9, 0, 0, 0, 4, 60, }, + { 0, 0, 0, 0, 5, 76, }, + { 2, 0, 0, 0, 5, 56, }, + { 1, 0, 0, 0, 5, 72, }, + { 3, 0, 0, 0, 5, 76, }, + { 4, 0, 0, 0, 5, 76, }, + { 5, 0, 0, 0, 5, 56, }, + { 6, 0, 0, 0, 5, 76, }, + { 7, 0, 0, 0, 5, 60, }, + { 8, 0, 0, 0, 5, 76, }, + { 9, 0, 0, 0, 5, 60, }, + { 0, 0, 0, 0, 6, 76, }, + { 2, 0, 0, 0, 6, 56, }, + { 1, 0, 0, 0, 6, 72, }, + { 3, 0, 0, 0, 6, 76, }, + { 4, 0, 0, 0, 6, 76, }, + { 5, 0, 0, 0, 6, 56, }, + { 6, 0, 0, 0, 6, 76, }, + { 7, 0, 0, 0, 6, 60, }, + { 8, 0, 0, 0, 6, 76, }, + { 9, 0, 0, 0, 6, 60, }, + { 0, 0, 0, 0, 7, 76, }, + { 2, 0, 0, 0, 7, 56, }, + { 1, 0, 0, 0, 7, 72, }, + { 3, 0, 0, 0, 7, 76, }, + { 4, 0, 0, 0, 7, 76, }, + { 5, 0, 0, 0, 7, 56, }, + { 6, 0, 0, 0, 7, 76, }, + { 7, 0, 0, 0, 7, 60, }, + { 8, 0, 0, 0, 7, 76, }, + { 9, 0, 0, 0, 7, 60, }, + { 0, 0, 0, 0, 8, 76, }, + { 2, 0, 0, 0, 8, 56, }, + { 1, 0, 0, 0, 8, 72, }, + { 3, 0, 0, 0, 8, 76, }, + { 4, 0, 0, 0, 8, 76, }, + { 5, 0, 0, 0, 8, 56, }, + { 6, 0, 0, 0, 8, 76, }, + { 7, 0, 0, 0, 8, 60, }, + { 8, 0, 0, 0, 8, 76, }, + { 9, 0, 0, 0, 8, 60, }, + { 0, 0, 0, 0, 9, 76, }, + { 2, 0, 0, 0, 9, 56, }, + { 1, 0, 0, 0, 9, 72, }, + { 3, 0, 0, 0, 9, 76, }, + { 4, 0, 0, 0, 9, 76, }, + { 5, 0, 0, 0, 9, 56, }, + { 6, 0, 0, 0, 9, 76, }, + { 7, 0, 0, 0, 9, 60, }, + { 8, 0, 0, 0, 9, 76, }, + { 9, 0, 0, 0, 9, 60, }, + { 0, 0, 0, 0, 10, 72, }, + { 2, 0, 0, 0, 10, 56, }, + { 1, 0, 0, 0, 10, 72, }, + { 3, 0, 0, 0, 10, 72, }, + { 4, 0, 0, 0, 10, 76, }, + { 5, 0, 0, 0, 10, 56, }, + { 6, 0, 0, 0, 10, 72, }, + { 7, 0, 0, 0, 10, 60, }, + { 8, 0, 0, 0, 10, 72, }, + { 9, 0, 0, 0, 10, 60, }, + { 0, 0, 0, 0, 11, 72, }, + { 2, 0, 0, 0, 11, 56, }, + { 1, 0, 0, 0, 11, 72, }, + { 3, 0, 0, 0, 11, 72, }, + { 4, 0, 0, 0, 11, 76, }, + { 5, 0, 0, 0, 11, 56, }, + { 6, 0, 0, 0, 11, 72, }, + { 7, 0, 0, 0, 11, 60, }, + { 8, 0, 0, 0, 11, 72, }, + { 9, 0, 0, 0, 11, 60, }, + { 0, 0, 0, 0, 12, 44, }, + { 2, 0, 0, 0, 12, 56, }, + { 1, 0, 0, 0, 12, 72, }, + { 3, 0, 0, 0, 12, 52, }, + { 4, 0, 0, 0, 12, 76, }, + { 5, 0, 0, 0, 12, 56, }, + { 6, 0, 0, 0, 12, 52, }, + { 7, 0, 0, 0, 12, 60, }, + { 8, 0, 0, 0, 12, 52, }, + { 9, 0, 0, 0, 12, 60, }, + { 0, 0, 0, 0, 13, 40, }, + { 2, 0, 0, 0, 13, 56, }, + { 1, 0, 0, 0, 13, 72, }, + { 3, 0, 0, 0, 13, 48, }, + { 4, 0, 0, 0, 13, 76, }, + { 5, 0, 0, 0, 13, 56, }, + { 6, 0, 0, 0, 13, 48, }, + { 7, 0, 0, 0, 13, 60, }, + { 8, 0, 0, 0, 13, 48, }, + { 9, 0, 0, 0, 13, 60, }, + { 0, 0, 0, 0, 14, 127, }, + { 2, 0, 0, 0, 14, 127, }, + { 1, 0, 0, 0, 14, 72, }, + { 3, 0, 0, 0, 14, 127, }, + { 4, 0, 0, 0, 14, 127, }, + { 5, 0, 0, 0, 14, 127, }, + { 6, 0, 0, 0, 14, 127, }, + { 7, 0, 0, 0, 14, 127, }, + { 8, 0, 0, 0, 14, 127, }, + { 9, 0, 0, 0, 14, 127, }, + { 0, 0, 0, 1, 1, 52, }, + { 2, 0, 0, 1, 1, 60, }, + { 1, 0, 0, 1, 1, 76, }, + { 3, 0, 0, 1, 1, 52, }, + { 4, 0, 0, 1, 1, 76, }, + { 5, 0, 0, 1, 1, 60, }, + { 6, 0, 0, 1, 1, 52, }, + { 7, 0, 0, 1, 1, 60, }, + { 8, 0, 0, 1, 1, 52, }, + { 9, 0, 0, 1, 1, 60, }, + { 0, 0, 0, 1, 2, 60, }, + { 2, 0, 0, 1, 2, 60, }, + { 1, 0, 0, 1, 2, 76, }, + { 3, 0, 0, 1, 2, 60, }, + { 4, 0, 0, 1, 2, 76, }, + { 5, 0, 0, 1, 2, 60, }, + { 6, 0, 0, 1, 2, 60, }, + { 7, 0, 0, 1, 2, 60, }, + { 8, 0, 0, 1, 2, 60, }, + { 9, 0, 0, 1, 2, 60, }, + { 0, 0, 0, 1, 3, 64, }, + { 2, 0, 0, 1, 3, 60, }, + { 1, 0, 0, 1, 3, 76, }, + { 3, 0, 0, 1, 3, 64, }, + { 4, 0, 0, 1, 3, 76, }, + { 5, 0, 0, 1, 3, 60, }, + { 6, 0, 0, 1, 3, 64, }, + { 7, 0, 0, 1, 3, 60, }, + { 8, 0, 0, 1, 3, 64, }, + { 9, 0, 0, 1, 3, 60, }, + { 0, 0, 0, 1, 4, 68, }, + { 2, 0, 0, 1, 4, 60, }, + { 1, 0, 0, 1, 4, 76, }, + { 3, 0, 0, 1, 4, 68, }, + { 4, 0, 0, 1, 4, 76, }, + { 5, 0, 0, 1, 4, 60, }, + { 6, 0, 0, 1, 4, 68, }, + { 7, 0, 0, 1, 4, 60, }, + { 8, 0, 0, 1, 4, 68, }, + { 9, 0, 0, 1, 4, 60, }, + { 0, 0, 0, 1, 5, 76, }, + { 2, 0, 0, 1, 5, 60, }, + { 1, 0, 0, 1, 5, 76, }, + { 3, 0, 0, 1, 5, 76, }, + { 4, 0, 0, 1, 5, 76, }, + { 5, 0, 0, 1, 5, 60, }, + { 6, 0, 0, 1, 5, 76, }, + { 7, 0, 0, 1, 5, 60, }, + { 8, 0, 0, 1, 5, 76, }, + { 9, 0, 0, 1, 5, 60, }, + { 0, 0, 0, 1, 6, 76, }, + { 2, 0, 0, 1, 6, 60, }, + { 1, 0, 0, 1, 6, 76, }, + { 3, 0, 0, 1, 6, 76, }, + { 4, 0, 0, 1, 6, 76, }, + { 5, 0, 0, 1, 6, 60, }, + { 6, 0, 0, 1, 6, 76, }, + { 7, 0, 0, 1, 6, 60, }, + { 8, 0, 0, 1, 6, 76, }, + { 9, 0, 0, 1, 6, 60, }, + { 0, 0, 0, 1, 7, 76, }, + { 2, 0, 0, 1, 7, 60, }, + { 1, 0, 0, 1, 7, 76, }, + { 3, 0, 0, 1, 7, 76, }, + { 4, 0, 0, 1, 7, 76, }, + { 5, 0, 0, 1, 7, 60, }, + { 6, 0, 0, 1, 7, 76, }, + { 7, 0, 0, 1, 7, 60, }, + { 8, 0, 0, 1, 7, 76, }, + { 9, 0, 0, 1, 7, 60, }, + { 0, 0, 0, 1, 8, 68, }, + { 2, 0, 0, 1, 8, 60, }, + { 1, 0, 0, 1, 8, 76, }, + { 3, 0, 0, 1, 8, 68, }, + { 4, 0, 0, 1, 8, 76, }, + { 5, 0, 0, 1, 8, 60, }, + { 6, 0, 0, 1, 8, 68, }, + { 7, 0, 0, 1, 8, 60, }, + { 8, 0, 0, 1, 8, 68, }, + { 9, 0, 0, 1, 8, 60, }, + { 0, 0, 0, 1, 9, 64, }, + { 2, 0, 0, 1, 9, 60, }, + { 1, 0, 0, 1, 9, 76, }, + { 3, 0, 0, 1, 9, 64, }, + { 4, 0, 0, 1, 9, 76, }, + { 5, 0, 0, 1, 9, 60, }, + { 6, 0, 0, 1, 9, 64, }, + { 7, 0, 0, 1, 9, 60, }, + { 8, 0, 0, 1, 9, 64, }, + { 9, 0, 0, 1, 9, 60, }, + { 0, 0, 0, 1, 10, 60, }, + { 2, 0, 0, 1, 10, 60, }, + { 1, 0, 0, 1, 10, 76, }, + { 3, 0, 0, 1, 10, 60, }, + { 4, 0, 0, 1, 10, 76, }, + { 5, 0, 0, 1, 10, 60, }, + { 6, 0, 0, 1, 10, 60, }, + { 7, 0, 0, 1, 10, 60, }, + { 8, 0, 0, 1, 10, 60, }, + { 9, 0, 0, 1, 10, 60, }, + { 0, 0, 0, 1, 11, 52, }, + { 2, 0, 0, 1, 11, 60, }, + { 1, 0, 0, 1, 11, 76, }, + { 3, 0, 0, 1, 11, 52, }, + { 4, 0, 0, 1, 11, 76, }, + { 5, 0, 0, 1, 11, 60, }, + { 6, 0, 0, 1, 11, 52, }, + { 7, 0, 0, 1, 11, 60, }, + { 8, 0, 0, 1, 11, 52, }, + { 9, 0, 0, 1, 11, 60, }, + { 0, 0, 0, 1, 12, 32, }, + { 2, 0, 0, 1, 12, 60, }, + { 1, 0, 0, 1, 12, 76, }, + { 3, 0, 0, 1, 12, 40, }, + { 4, 0, 0, 1, 12, 76, }, + { 5, 0, 0, 1, 12, 60, }, + { 6, 0, 0, 1, 12, 40, }, + { 7, 0, 0, 1, 12, 60, }, + { 8, 0, 0, 1, 12, 40, }, + { 9, 0, 0, 1, 12, 60, }, + { 0, 0, 0, 1, 13, 20, }, + { 2, 0, 0, 1, 13, 60, }, + { 1, 0, 0, 1, 13, 76, }, + { 3, 0, 0, 1, 13, 28, }, + { 4, 0, 0, 1, 13, 74, }, + { 5, 0, 0, 1, 13, 60, }, + { 6, 0, 0, 1, 13, 28, }, + { 7, 0, 0, 1, 13, 60, }, + { 8, 0, 0, 1, 13, 28, }, + { 9, 0, 0, 1, 13, 60, }, + { 0, 0, 0, 1, 14, 127, }, + { 2, 0, 0, 1, 14, 127, }, + { 1, 0, 0, 1, 14, 127, }, + { 3, 0, 0, 1, 14, 127, }, + { 4, 0, 0, 1, 14, 127, }, + { 5, 0, 0, 1, 14, 127, }, + { 6, 0, 0, 1, 14, 127, }, + { 7, 0, 0, 1, 14, 127, }, + { 8, 0, 0, 1, 14, 127, }, + { 9, 0, 0, 1, 14, 127, }, + { 0, 0, 0, 2, 1, 52, }, + { 2, 0, 0, 2, 1, 60, }, + { 1, 0, 0, 2, 1, 76, }, + { 3, 0, 0, 2, 1, 52, }, + { 4, 0, 0, 2, 1, 76, }, + { 5, 0, 0, 2, 1, 60, }, + { 6, 0, 0, 2, 1, 52, }, + { 7, 0, 0, 2, 1, 60, }, + { 8, 0, 0, 2, 1, 52, }, + { 9, 0, 0, 2, 1, 60, }, + { 0, 0, 0, 2, 2, 60, }, + { 2, 0, 0, 2, 2, 60, }, + { 1, 0, 0, 2, 2, 76, }, + { 3, 0, 0, 2, 2, 60, }, + { 4, 0, 0, 2, 2, 76, }, + { 5, 0, 0, 2, 2, 60, }, + { 6, 0, 0, 2, 2, 60, }, + { 7, 0, 0, 2, 2, 60, }, + { 8, 0, 0, 2, 2, 60, }, + { 9, 0, 0, 2, 2, 60, }, + { 0, 0, 0, 2, 3, 64, }, + { 2, 0, 0, 2, 3, 60, }, + { 1, 0, 0, 2, 3, 76, }, + { 3, 0, 0, 2, 3, 64, }, + { 4, 0, 0, 2, 3, 76, }, + { 5, 0, 0, 2, 3, 60, }, + { 6, 0, 0, 2, 3, 64, }, + { 7, 0, 0, 2, 3, 60, }, + { 8, 0, 0, 2, 3, 64, }, + { 9, 0, 0, 2, 3, 60, }, + { 0, 0, 0, 2, 4, 68, }, + { 2, 0, 0, 2, 4, 60, }, + { 1, 0, 0, 2, 4, 76, }, + { 3, 0, 0, 2, 4, 68, }, + { 4, 0, 0, 2, 4, 76, }, + { 5, 0, 0, 2, 4, 60, }, + { 6, 0, 0, 2, 4, 68, }, + { 7, 0, 0, 2, 4, 60, }, + { 8, 0, 0, 2, 4, 68, }, + { 9, 0, 0, 2, 4, 60, }, + { 0, 0, 0, 2, 5, 76, }, + { 2, 0, 0, 2, 5, 60, }, + { 1, 0, 0, 2, 5, 76, }, + { 3, 0, 0, 2, 5, 76, }, + { 4, 0, 0, 2, 5, 76, }, + { 5, 0, 0, 2, 5, 60, }, + { 6, 0, 0, 2, 5, 76, }, + { 7, 0, 0, 2, 5, 60, }, + { 8, 0, 0, 2, 5, 76, }, + { 9, 0, 0, 2, 5, 60, }, + { 0, 0, 0, 2, 6, 76, }, + { 2, 0, 0, 2, 6, 60, }, + { 1, 0, 0, 2, 6, 76, }, + { 3, 0, 0, 2, 6, 76, }, + { 4, 0, 0, 2, 6, 76, }, + { 5, 0, 0, 2, 6, 60, }, + { 6, 0, 0, 2, 6, 76, }, + { 7, 0, 0, 2, 6, 60, }, + { 8, 0, 0, 2, 6, 76, }, + { 9, 0, 0, 2, 6, 60, }, + { 0, 0, 0, 2, 7, 76, }, + { 2, 0, 0, 2, 7, 60, }, + { 1, 0, 0, 2, 7, 76, }, + { 3, 0, 0, 2, 7, 76, }, + { 4, 0, 0, 2, 7, 76, }, + { 5, 0, 0, 2, 7, 60, }, + { 6, 0, 0, 2, 7, 76, }, + { 7, 0, 0, 2, 7, 60, }, + { 8, 0, 0, 2, 7, 76, }, + { 9, 0, 0, 2, 7, 60, }, + { 0, 0, 0, 2, 8, 68, }, + { 2, 0, 0, 2, 8, 60, }, + { 1, 0, 0, 2, 8, 76, }, + { 3, 0, 0, 2, 8, 68, }, + { 4, 0, 0, 2, 8, 76, }, + { 5, 0, 0, 2, 8, 60, }, + { 6, 0, 0, 2, 8, 68, }, + { 7, 0, 0, 2, 8, 60, }, + { 8, 0, 0, 2, 8, 68, }, + { 9, 0, 0, 2, 8, 60, }, + { 0, 0, 0, 2, 9, 64, }, + { 2, 0, 0, 2, 9, 60, }, + { 1, 0, 0, 2, 9, 76, }, + { 3, 0, 0, 2, 9, 64, }, + { 4, 0, 0, 2, 9, 76, }, + { 5, 0, 0, 2, 9, 60, }, + { 6, 0, 0, 2, 9, 64, }, + { 7, 0, 0, 2, 9, 60, }, + { 8, 0, 0, 2, 9, 64, }, + { 9, 0, 0, 2, 9, 60, }, + { 0, 0, 0, 2, 10, 60, }, + { 2, 0, 0, 2, 10, 60, }, + { 1, 0, 0, 2, 10, 76, }, + { 3, 0, 0, 2, 10, 60, }, + { 4, 0, 0, 2, 10, 76, }, + { 5, 0, 0, 2, 10, 60, }, + { 6, 0, 0, 2, 10, 60, }, + { 7, 0, 0, 2, 10, 60, }, + { 8, 0, 0, 2, 10, 60, }, + { 9, 0, 0, 2, 10, 60, }, + { 0, 0, 0, 2, 11, 52, }, + { 2, 0, 0, 2, 11, 60, }, + { 1, 0, 0, 2, 11, 76, }, + { 3, 0, 0, 2, 11, 52, }, + { 4, 0, 0, 2, 11, 76, }, + { 5, 0, 0, 2, 11, 60, }, + { 6, 0, 0, 2, 11, 52, }, + { 7, 0, 0, 2, 11, 60, }, + { 8, 0, 0, 2, 11, 52, }, + { 9, 0, 0, 2, 11, 60, }, + { 0, 0, 0, 2, 12, 32, }, + { 2, 0, 0, 2, 12, 60, }, + { 1, 0, 0, 2, 12, 76, }, + { 3, 0, 0, 2, 12, 40, }, + { 4, 0, 0, 2, 12, 76, }, + { 5, 0, 0, 2, 12, 60, }, + { 6, 0, 0, 2, 12, 40, }, + { 7, 0, 0, 2, 12, 60, }, + { 8, 0, 0, 2, 12, 40, }, + { 9, 0, 0, 2, 12, 60, }, + { 0, 0, 0, 2, 13, 20, }, + { 2, 0, 0, 2, 13, 60, }, + { 1, 0, 0, 2, 13, 76, }, + { 3, 0, 0, 2, 13, 28, }, + { 4, 0, 0, 2, 13, 74, }, + { 5, 0, 0, 2, 13, 60, }, + { 6, 0, 0, 2, 13, 28, }, + { 7, 0, 0, 2, 13, 60, }, + { 8, 0, 0, 2, 13, 28, }, + { 9, 0, 0, 2, 13, 60, }, + { 0, 0, 0, 2, 14, 127, }, + { 2, 0, 0, 2, 14, 127, }, + { 1, 0, 0, 2, 14, 127, }, + { 3, 0, 0, 2, 14, 127, }, + { 4, 0, 0, 2, 14, 127, }, + { 5, 0, 0, 2, 14, 127, }, + { 6, 0, 0, 2, 14, 127, }, + { 7, 0, 0, 2, 14, 127, }, + { 8, 0, 0, 2, 14, 127, }, + { 9, 0, 0, 2, 14, 127, }, + { 0, 0, 0, 3, 1, 52, }, + { 2, 0, 0, 3, 1, 36, }, + { 1, 0, 0, 3, 1, 66, }, + { 3, 0, 0, 3, 1, 52, }, + { 4, 0, 0, 3, 1, 72, }, + { 5, 0, 0, 3, 1, 36, }, + { 6, 0, 0, 3, 1, 52, }, + { 7, 0, 0, 3, 1, 36, }, + { 8, 0, 0, 3, 1, 52, }, + { 9, 0, 0, 3, 1, 36, }, + { 0, 0, 0, 3, 2, 60, }, + { 2, 0, 0, 3, 2, 36, }, + { 1, 0, 0, 3, 2, 66, }, + { 3, 0, 0, 3, 2, 60, }, + { 4, 0, 0, 3, 2, 72, }, + { 5, 0, 0, 3, 2, 36, }, + { 6, 0, 0, 3, 2, 60, }, + { 7, 0, 0, 3, 2, 36, }, + { 8, 0, 0, 3, 2, 60, }, + { 9, 0, 0, 3, 2, 36, }, + { 0, 0, 0, 3, 3, 64, }, + { 2, 0, 0, 3, 3, 36, }, + { 1, 0, 0, 3, 3, 66, }, + { 3, 0, 0, 3, 3, 64, }, + { 4, 0, 0, 3, 3, 72, }, + { 5, 0, 0, 3, 3, 36, }, + { 6, 0, 0, 3, 3, 64, }, + { 7, 0, 0, 3, 3, 36, }, + { 8, 0, 0, 3, 3, 64, }, + { 9, 0, 0, 3, 3, 36, }, + { 0, 0, 0, 3, 4, 68, }, + { 2, 0, 0, 3, 4, 36, }, + { 1, 0, 0, 3, 4, 66, }, + { 3, 0, 0, 3, 4, 68, }, + { 4, 0, 0, 3, 4, 72, }, + { 5, 0, 0, 3, 4, 36, }, + { 6, 0, 0, 3, 4, 68, }, + { 7, 0, 0, 3, 4, 36, }, + { 8, 0, 0, 3, 4, 68, }, + { 9, 0, 0, 3, 4, 36, }, + { 0, 0, 0, 3, 5, 76, }, + { 2, 0, 0, 3, 5, 36, }, + { 1, 0, 0, 3, 5, 66, }, + { 3, 0, 0, 3, 5, 76, }, + { 4, 0, 0, 3, 5, 72, }, + { 5, 0, 0, 3, 5, 36, }, + { 6, 0, 0, 3, 5, 76, }, + { 7, 0, 0, 3, 5, 36, }, + { 8, 0, 0, 3, 5, 76, }, + { 9, 0, 0, 3, 5, 36, }, + { 0, 0, 0, 3, 6, 76, }, + { 2, 0, 0, 3, 6, 36, }, + { 1, 0, 0, 3, 6, 66, }, + { 3, 0, 0, 3, 6, 76, }, + { 4, 0, 0, 3, 6, 72, }, + { 5, 0, 0, 3, 6, 36, }, + { 6, 0, 0, 3, 6, 76, }, + { 7, 0, 0, 3, 6, 36, }, + { 8, 0, 0, 3, 6, 76, }, + { 9, 0, 0, 3, 6, 36, }, + { 0, 0, 0, 3, 7, 76, }, + { 2, 0, 0, 3, 7, 36, }, + { 1, 0, 0, 3, 7, 66, }, + { 3, 0, 0, 3, 7, 76, }, + { 4, 0, 0, 3, 7, 72, }, + { 5, 0, 0, 3, 7, 36, }, + { 6, 0, 0, 3, 7, 76, }, + { 7, 0, 0, 3, 7, 36, }, + { 8, 0, 0, 3, 7, 76, }, + { 9, 0, 0, 3, 7, 36, }, + { 0, 0, 0, 3, 8, 68, }, + { 2, 0, 0, 3, 8, 36, }, + { 1, 0, 0, 3, 8, 66, }, + { 3, 0, 0, 3, 8, 68, }, + { 4, 0, 0, 3, 8, 72, }, + { 5, 0, 0, 3, 8, 36, }, + { 6, 0, 0, 3, 8, 68, }, + { 7, 0, 0, 3, 8, 36, }, + { 8, 0, 0, 3, 8, 68, }, + { 9, 0, 0, 3, 8, 36, }, + { 0, 0, 0, 3, 9, 64, }, + { 2, 0, 0, 3, 9, 36, }, + { 1, 0, 0, 3, 9, 66, }, + { 3, 0, 0, 3, 9, 64, }, + { 4, 0, 0, 3, 9, 72, }, + { 5, 0, 0, 3, 9, 36, }, + { 6, 0, 0, 3, 9, 64, }, + { 7, 0, 0, 3, 9, 36, }, + { 8, 0, 0, 3, 9, 64, }, + { 9, 0, 0, 3, 9, 36, }, + { 0, 0, 0, 3, 10, 60, }, + { 2, 0, 0, 3, 10, 36, }, + { 1, 0, 0, 3, 10, 66, }, + { 3, 0, 0, 3, 10, 60, }, + { 4, 0, 0, 3, 10, 72, }, + { 5, 0, 0, 3, 10, 36, }, + { 6, 0, 0, 3, 10, 60, }, + { 7, 0, 0, 3, 10, 36, }, + { 8, 0, 0, 3, 10, 60, }, + { 9, 0, 0, 3, 10, 36, }, + { 0, 0, 0, 3, 11, 52, }, + { 2, 0, 0, 3, 11, 36, }, + { 1, 0, 0, 3, 11, 66, }, + { 3, 0, 0, 3, 11, 52, }, + { 4, 0, 0, 3, 11, 72, }, + { 5, 0, 0, 3, 11, 36, }, + { 6, 0, 0, 3, 11, 52, }, + { 7, 0, 0, 3, 11, 36, }, + { 8, 0, 0, 3, 11, 52, }, + { 9, 0, 0, 3, 11, 36, }, + { 0, 0, 0, 3, 12, 32, }, + { 2, 0, 0, 3, 12, 36, }, + { 1, 0, 0, 3, 12, 66, }, + { 3, 0, 0, 3, 12, 40, }, + { 4, 0, 0, 3, 12, 72, }, + { 5, 0, 0, 3, 12, 36, }, + { 6, 0, 0, 3, 12, 40, }, + { 7, 0, 0, 3, 12, 36, }, + { 8, 0, 0, 3, 12, 40, }, + { 9, 0, 0, 3, 12, 36, }, + { 0, 0, 0, 3, 13, 20, }, + { 2, 0, 0, 3, 13, 36, }, + { 1, 0, 0, 3, 13, 66, }, + { 3, 0, 0, 3, 13, 28, }, + { 4, 0, 0, 3, 13, 68, }, + { 5, 0, 0, 3, 13, 36, }, + { 6, 0, 0, 3, 13, 28, }, + { 7, 0, 0, 3, 13, 36, }, + { 8, 0, 0, 3, 13, 28, }, + { 9, 0, 0, 3, 13, 36, }, + { 0, 0, 0, 3, 14, 127, }, + { 2, 0, 0, 3, 14, 127, }, + { 1, 0, 0, 3, 14, 127, }, + { 3, 0, 0, 3, 14, 127, }, + { 4, 0, 0, 3, 14, 127, }, + { 5, 0, 0, 3, 14, 127, }, + { 6, 0, 0, 3, 14, 127, }, + { 7, 0, 0, 3, 14, 127, }, + { 8, 0, 0, 3, 14, 127, }, + { 9, 0, 0, 3, 14, 127, }, + { 0, 0, 1, 2, 1, 127, }, + { 2, 0, 1, 2, 1, 127, }, + { 1, 0, 1, 2, 1, 127, }, + { 3, 0, 1, 2, 1, 127, }, + { 4, 0, 1, 2, 1, 127, }, + { 5, 0, 1, 2, 1, 127, }, + { 6, 0, 1, 2, 1, 127, }, + { 7, 0, 1, 2, 1, 127, }, + { 8, 0, 1, 2, 1, 127, }, + { 9, 0, 1, 2, 1, 127, }, + { 0, 0, 1, 2, 2, 127, }, + { 2, 0, 1, 2, 2, 127, }, + { 1, 0, 1, 2, 2, 127, }, + { 3, 0, 1, 2, 2, 127, }, + { 4, 0, 1, 2, 2, 127, }, + { 5, 0, 1, 2, 2, 127, }, + { 6, 0, 1, 2, 2, 127, }, + { 7, 0, 1, 2, 2, 127, }, + { 8, 0, 1, 2, 2, 127, }, + { 9, 0, 1, 2, 2, 127, }, + { 0, 0, 1, 2, 3, 52, }, + { 2, 0, 1, 2, 3, 60, }, + { 1, 0, 1, 2, 3, 72, }, + { 3, 0, 1, 2, 3, 52, }, + { 4, 0, 1, 2, 3, 72, }, + { 5, 0, 1, 2, 3, 60, }, + { 6, 0, 1, 2, 3, 52, }, + { 7, 0, 1, 2, 3, 60, }, + { 8, 0, 1, 2, 3, 52, }, + { 9, 0, 1, 2, 3, 60, }, + { 0, 0, 1, 2, 4, 52, }, + { 2, 0, 1, 2, 4, 60, }, + { 1, 0, 1, 2, 4, 72, }, + { 3, 0, 1, 2, 4, 52, }, + { 4, 0, 1, 2, 4, 72, }, + { 5, 0, 1, 2, 4, 60, }, + { 6, 0, 1, 2, 4, 52, }, + { 7, 0, 1, 2, 4, 60, }, + { 8, 0, 1, 2, 4, 52, }, + { 9, 0, 1, 2, 4, 60, }, + { 0, 0, 1, 2, 5, 60, }, + { 2, 0, 1, 2, 5, 60, }, + { 1, 0, 1, 2, 5, 72, }, + { 3, 0, 1, 2, 5, 60, }, + { 4, 0, 1, 2, 5, 72, }, + { 5, 0, 1, 2, 5, 60, }, + { 6, 0, 1, 2, 5, 60, }, + { 7, 0, 1, 2, 5, 60, }, + { 8, 0, 1, 2, 5, 60, }, + { 9, 0, 1, 2, 5, 60, }, + { 0, 0, 1, 2, 6, 64, }, + { 2, 0, 1, 2, 6, 60, }, + { 1, 0, 1, 2, 6, 72, }, + { 3, 0, 1, 2, 6, 64, }, + { 4, 0, 1, 2, 6, 72, }, + { 5, 0, 1, 2, 6, 60, }, + { 6, 0, 1, 2, 6, 64, }, + { 7, 0, 1, 2, 6, 60, }, + { 8, 0, 1, 2, 6, 64, }, + { 9, 0, 1, 2, 6, 60, }, + { 0, 0, 1, 2, 7, 60, }, + { 2, 0, 1, 2, 7, 60, }, + { 1, 0, 1, 2, 7, 72, }, + { 3, 0, 1, 2, 7, 60, }, + { 4, 0, 1, 2, 7, 72, }, + { 5, 0, 1, 2, 7, 60, }, + { 6, 0, 1, 2, 7, 60, }, + { 7, 0, 1, 2, 7, 60, }, + { 8, 0, 1, 2, 7, 60, }, + { 9, 0, 1, 2, 7, 60, }, + { 0, 0, 1, 2, 8, 52, }, + { 2, 0, 1, 2, 8, 60, }, + { 1, 0, 1, 2, 8, 72, }, + { 3, 0, 1, 2, 8, 52, }, + { 4, 0, 1, 2, 8, 72, }, + { 5, 0, 1, 2, 8, 60, }, + { 6, 0, 1, 2, 8, 52, }, + { 7, 0, 1, 2, 8, 60, }, + { 8, 0, 1, 2, 8, 52, }, + { 9, 0, 1, 2, 8, 60, }, + { 0, 0, 1, 2, 9, 52, }, + { 2, 0, 1, 2, 9, 60, }, + { 1, 0, 1, 2, 9, 72, }, + { 3, 0, 1, 2, 9, 52, }, + { 4, 0, 1, 2, 9, 72, }, + { 5, 0, 1, 2, 9, 60, }, + { 6, 0, 1, 2, 9, 52, }, + { 7, 0, 1, 2, 9, 60, }, + { 8, 0, 1, 2, 9, 52, }, + { 9, 0, 1, 2, 9, 60, }, + { 0, 0, 1, 2, 10, 40, }, + { 2, 0, 1, 2, 10, 60, }, + { 1, 0, 1, 2, 10, 72, }, + { 3, 0, 1, 2, 10, 40, }, + { 4, 0, 1, 2, 10, 72, }, + { 5, 0, 1, 2, 10, 60, }, + { 6, 0, 1, 2, 10, 40, }, + { 7, 0, 1, 2, 10, 60, }, + { 8, 0, 1, 2, 10, 40, }, + { 9, 0, 1, 2, 10, 60, }, + { 0, 0, 1, 2, 11, 28, }, + { 2, 0, 1, 2, 11, 60, }, + { 1, 0, 1, 2, 11, 72, }, + { 3, 0, 1, 2, 11, 28, }, + { 4, 0, 1, 2, 11, 70, }, + { 5, 0, 1, 2, 11, 60, }, + { 6, 0, 1, 2, 11, 28, }, + { 7, 0, 1, 2, 11, 60, }, + { 8, 0, 1, 2, 11, 28, }, + { 9, 0, 1, 2, 11, 60, }, + { 0, 0, 1, 2, 12, 127, }, + { 2, 0, 1, 2, 12, 127, }, + { 1, 0, 1, 2, 12, 127, }, + { 3, 0, 1, 2, 12, 127, }, + { 4, 0, 1, 2, 12, 127, }, + { 5, 0, 1, 2, 12, 127, }, + { 6, 0, 1, 2, 12, 127, }, + { 7, 0, 1, 2, 12, 127, }, + { 8, 0, 1, 2, 12, 127, }, + { 9, 0, 1, 2, 12, 127, }, + { 0, 0, 1, 2, 13, 127, }, + { 2, 0, 1, 2, 13, 127, }, + { 1, 0, 1, 2, 13, 127, }, + { 3, 0, 1, 2, 13, 127, }, + { 4, 0, 1, 2, 13, 127, }, + { 5, 0, 1, 2, 13, 127, }, + { 6, 0, 1, 2, 13, 127, }, + { 7, 0, 1, 2, 13, 127, }, + { 8, 0, 1, 2, 13, 127, }, + { 9, 0, 1, 2, 13, 127, }, + { 0, 0, 1, 2, 14, 127, }, + { 2, 0, 1, 2, 14, 127, }, + { 1, 0, 1, 2, 14, 127, }, + { 3, 0, 1, 2, 14, 127, }, + { 4, 0, 1, 2, 14, 127, }, + { 5, 0, 1, 2, 14, 127, }, + { 6, 0, 1, 2, 14, 127, }, + { 7, 0, 1, 2, 14, 127, }, + { 8, 0, 1, 2, 14, 127, }, + { 9, 0, 1, 2, 14, 127, }, + { 0, 0, 1, 3, 1, 127, }, + { 2, 0, 1, 3, 1, 127, }, + { 1, 0, 1, 3, 1, 127, }, + { 3, 0, 1, 3, 1, 127, }, + { 4, 0, 1, 3, 1, 127, }, + { 5, 0, 1, 3, 1, 127, }, + { 6, 0, 1, 3, 1, 127, }, + { 7, 0, 1, 3, 1, 127, }, + { 8, 0, 1, 3, 1, 127, }, + { 9, 0, 1, 3, 1, 127, }, + { 0, 0, 1, 3, 2, 127, }, + { 2, 0, 1, 3, 2, 127, }, + { 1, 0, 1, 3, 2, 127, }, + { 3, 0, 1, 3, 2, 127, }, + { 4, 0, 1, 3, 2, 127, }, + { 5, 0, 1, 3, 2, 127, }, + { 6, 0, 1, 3, 2, 127, }, + { 7, 0, 1, 3, 2, 127, }, + { 8, 0, 1, 3, 2, 127, }, + { 9, 0, 1, 3, 2, 127, }, + { 0, 0, 1, 3, 3, 48, }, + { 2, 0, 1, 3, 3, 36, }, + { 1, 0, 1, 3, 3, 66, }, + { 3, 0, 1, 3, 3, 48, }, + { 4, 0, 1, 3, 3, 68, }, + { 5, 0, 1, 3, 3, 36, }, + { 6, 0, 1, 3, 3, 48, }, + { 7, 0, 1, 3, 3, 36, }, + { 8, 0, 1, 3, 3, 48, }, + { 9, 0, 1, 3, 3, 36, }, + { 0, 0, 1, 3, 4, 48, }, + { 2, 0, 1, 3, 4, 36, }, + { 1, 0, 1, 3, 4, 66, }, + { 3, 0, 1, 3, 4, 48, }, + { 4, 0, 1, 3, 4, 70, }, + { 5, 0, 1, 3, 4, 36, }, + { 6, 0, 1, 3, 4, 48, }, + { 7, 0, 1, 3, 4, 36, }, + { 8, 0, 1, 3, 4, 48, }, + { 9, 0, 1, 3, 4, 36, }, + { 0, 0, 1, 3, 5, 60, }, + { 2, 0, 1, 3, 5, 36, }, + { 1, 0, 1, 3, 5, 66, }, + { 3, 0, 1, 3, 5, 60, }, + { 4, 0, 1, 3, 5, 70, }, + { 5, 0, 1, 3, 5, 36, }, + { 6, 0, 1, 3, 5, 60, }, + { 7, 0, 1, 3, 5, 36, }, + { 8, 0, 1, 3, 5, 60, }, + { 9, 0, 1, 3, 5, 36, }, + { 0, 0, 1, 3, 6, 64, }, + { 2, 0, 1, 3, 6, 36, }, + { 1, 0, 1, 3, 6, 66, }, + { 3, 0, 1, 3, 6, 64, }, + { 4, 0, 1, 3, 6, 70, }, + { 5, 0, 1, 3, 6, 36, }, + { 6, 0, 1, 3, 6, 64, }, + { 7, 0, 1, 3, 6, 36, }, + { 8, 0, 1, 3, 6, 64, }, + { 9, 0, 1, 3, 6, 36, }, + { 0, 0, 1, 3, 7, 60, }, + { 2, 0, 1, 3, 7, 36, }, + { 1, 0, 1, 3, 7, 66, }, + { 3, 0, 1, 3, 7, 60, }, + { 4, 0, 1, 3, 7, 70, }, + { 5, 0, 1, 3, 7, 36, }, + { 6, 0, 1, 3, 7, 60, }, + { 7, 0, 1, 3, 7, 36, }, + { 8, 0, 1, 3, 7, 60, }, + { 9, 0, 1, 3, 7, 36, }, + { 0, 0, 1, 3, 8, 52, }, + { 2, 0, 1, 3, 8, 36, }, + { 1, 0, 1, 3, 8, 66, }, + { 3, 0, 1, 3, 8, 52, }, + { 4, 0, 1, 3, 8, 70, }, + { 5, 0, 1, 3, 8, 36, }, + { 6, 0, 1, 3, 8, 52, }, + { 7, 0, 1, 3, 8, 36, }, + { 8, 0, 1, 3, 8, 52, }, + { 9, 0, 1, 3, 8, 36, }, + { 0, 0, 1, 3, 9, 52, }, + { 2, 0, 1, 3, 9, 36, }, + { 1, 0, 1, 3, 9, 66, }, + { 3, 0, 1, 3, 9, 52, }, + { 4, 0, 1, 3, 9, 70, }, + { 5, 0, 1, 3, 9, 36, }, + { 6, 0, 1, 3, 9, 52, }, + { 7, 0, 1, 3, 9, 36, }, + { 8, 0, 1, 3, 9, 52, }, + { 9, 0, 1, 3, 9, 36, }, + { 0, 0, 1, 3, 10, 40, }, + { 2, 0, 1, 3, 10, 36, }, + { 1, 0, 1, 3, 10, 66, }, + { 3, 0, 1, 3, 10, 40, }, + { 4, 0, 1, 3, 10, 70, }, + { 5, 0, 1, 3, 10, 36, }, + { 6, 0, 1, 3, 10, 40, }, + { 7, 0, 1, 3, 10, 36, }, + { 8, 0, 1, 3, 10, 40, }, + { 9, 0, 1, 3, 10, 36, }, + { 0, 0, 1, 3, 11, 26, }, + { 2, 0, 1, 3, 11, 36, }, + { 1, 0, 1, 3, 11, 66, }, + { 3, 0, 1, 3, 11, 26, }, + { 4, 0, 1, 3, 11, 66, }, + { 5, 0, 1, 3, 11, 36, }, + { 6, 0, 1, 3, 11, 26, }, + { 7, 0, 1, 3, 11, 36, }, + { 8, 0, 1, 3, 11, 26, }, + { 9, 0, 1, 3, 11, 36, }, + { 0, 0, 1, 3, 12, 127, }, + { 2, 0, 1, 3, 12, 127, }, + { 1, 0, 1, 3, 12, 127, }, + { 3, 0, 1, 3, 12, 127, }, + { 4, 0, 1, 3, 12, 127, }, + { 5, 0, 1, 3, 12, 127, }, + { 6, 0, 1, 3, 12, 127, }, + { 7, 0, 1, 3, 12, 127, }, + { 8, 0, 1, 3, 12, 127, }, + { 9, 0, 1, 3, 12, 127, }, + { 0, 0, 1, 3, 13, 127, }, + { 2, 0, 1, 3, 13, 127, }, + { 1, 0, 1, 3, 13, 127, }, + { 3, 0, 1, 3, 13, 127, }, + { 4, 0, 1, 3, 13, 127, }, + { 5, 0, 1, 3, 13, 127, }, + { 6, 0, 1, 3, 13, 127, }, + { 7, 0, 1, 3, 13, 127, }, + { 8, 0, 1, 3, 13, 127, }, + { 9, 0, 1, 3, 13, 127, }, + { 0, 0, 1, 3, 14, 127, }, + { 2, 0, 1, 3, 14, 127, }, + { 1, 0, 1, 3, 14, 127, }, + { 3, 0, 1, 3, 14, 127, }, + { 4, 0, 1, 3, 14, 127, }, + { 5, 0, 1, 3, 14, 127, }, + { 6, 0, 1, 3, 14, 127, }, + { 7, 0, 1, 3, 14, 127, }, + { 8, 0, 1, 3, 14, 127, }, + { 9, 0, 1, 3, 14, 127, }, + { 0, 1, 0, 1, 36, 74, }, + { 2, 1, 0, 1, 36, 58, }, + { 1, 1, 0, 1, 36, 62, }, + { 3, 1, 0, 1, 36, 62, }, + { 4, 1, 0, 1, 36, 74, }, + { 5, 1, 0, 1, 36, 58, }, + { 6, 1, 0, 1, 36, 64, }, + { 7, 1, 0, 1, 36, 54, }, + { 8, 1, 0, 1, 36, 62, }, + { 9, 1, 0, 1, 36, 62, }, + { 0, 1, 0, 1, 40, 76, }, + { 2, 1, 0, 1, 40, 58, }, + { 1, 1, 0, 1, 40, 62, }, + { 3, 1, 0, 1, 40, 62, }, + { 4, 1, 0, 1, 40, 76, }, + { 5, 1, 0, 1, 40, 58, }, + { 6, 1, 0, 1, 40, 64, }, + { 7, 1, 0, 1, 40, 54, }, + { 8, 1, 0, 1, 40, 62, }, + { 9, 1, 0, 1, 40, 62, }, + { 0, 1, 0, 1, 44, 76, }, + { 2, 1, 0, 1, 44, 58, }, + { 1, 1, 0, 1, 44, 62, }, + { 3, 1, 0, 1, 44, 62, }, + { 4, 1, 0, 1, 44, 76, }, + { 5, 1, 0, 1, 44, 58, }, + { 6, 1, 0, 1, 44, 64, }, + { 7, 1, 0, 1, 44, 54, }, + { 8, 1, 0, 1, 44, 62, }, + { 9, 1, 0, 1, 44, 62, }, + { 0, 1, 0, 1, 48, 76, }, + { 2, 1, 0, 1, 48, 58, }, + { 1, 1, 0, 1, 48, 62, }, + { 3, 1, 0, 1, 48, 62, }, + { 4, 1, 0, 1, 48, 58, }, + { 5, 1, 0, 1, 48, 58, }, + { 6, 1, 0, 1, 48, 64, }, + { 7, 1, 0, 1, 48, 54, }, + { 8, 1, 0, 1, 48, 62, }, + { 9, 1, 0, 1, 48, 62, }, + { 0, 1, 0, 1, 52, 76, }, + { 2, 1, 0, 1, 52, 58, }, + { 1, 1, 0, 1, 52, 62, }, + { 3, 1, 0, 1, 52, 64, }, + { 4, 1, 0, 1, 52, 76, }, + { 5, 1, 0, 1, 52, 58, }, + { 6, 1, 0, 1, 52, 76, }, + { 7, 1, 0, 1, 52, 54, }, + { 8, 1, 0, 1, 52, 76, }, + { 9, 1, 0, 1, 52, 62, }, + { 0, 1, 0, 1, 56, 76, }, + { 2, 1, 0, 1, 56, 58, }, + { 1, 1, 0, 1, 56, 62, }, + { 3, 1, 0, 1, 56, 64, }, + { 4, 1, 0, 1, 56, 76, }, + { 5, 1, 0, 1, 56, 58, }, + { 6, 1, 0, 1, 56, 76, }, + { 7, 1, 0, 1, 56, 54, }, + { 8, 1, 0, 1, 56, 76, }, + { 9, 1, 0, 1, 56, 62, }, + { 0, 1, 0, 1, 60, 76, }, + { 2, 1, 0, 1, 60, 58, }, + { 1, 1, 0, 1, 60, 62, }, + { 3, 1, 0, 1, 60, 64, }, + { 4, 1, 0, 1, 60, 76, }, + { 5, 1, 0, 1, 60, 58, }, + { 6, 1, 0, 1, 60, 76, }, + { 7, 1, 0, 1, 60, 54, }, + { 8, 1, 0, 1, 60, 76, }, + { 9, 1, 0, 1, 60, 62, }, + { 0, 1, 0, 1, 64, 76, }, + { 2, 1, 0, 1, 64, 58, }, + { 1, 1, 0, 1, 64, 62, }, + { 3, 1, 0, 1, 64, 64, }, + { 4, 1, 0, 1, 64, 76, }, + { 5, 1, 0, 1, 64, 58, }, + { 6, 1, 0, 1, 64, 74, }, + { 7, 1, 0, 1, 64, 54, }, + { 8, 1, 0, 1, 64, 74, }, + { 9, 1, 0, 1, 64, 62, }, + { 0, 1, 0, 1, 100, 68, }, + { 2, 1, 0, 1, 100, 58, }, + { 1, 1, 0, 1, 100, 76, }, + { 3, 1, 0, 1, 100, 68, }, + { 4, 1, 0, 1, 100, 76, }, + { 5, 1, 0, 1, 100, 58, }, + { 6, 1, 0, 1, 100, 72, }, + { 7, 1, 0, 1, 100, 54, }, + { 8, 1, 0, 1, 100, 72, }, + { 9, 1, 0, 1, 100, 127, }, + { 0, 1, 0, 1, 104, 76, }, + { 2, 1, 0, 1, 104, 58, }, + { 1, 1, 0, 1, 104, 76, }, + { 3, 1, 0, 1, 104, 76, }, + { 4, 1, 0, 1, 104, 76, }, + { 5, 1, 0, 1, 104, 58, }, + { 6, 1, 0, 1, 104, 76, }, + { 7, 1, 0, 1, 104, 54, }, + { 8, 1, 0, 1, 104, 76, }, + { 9, 1, 0, 1, 104, 127, }, + { 0, 1, 0, 1, 108, 76, }, + { 2, 1, 0, 1, 108, 58, }, + { 1, 1, 0, 1, 108, 76, }, + { 3, 1, 0, 1, 108, 76, }, + { 4, 1, 0, 1, 108, 76, }, + { 5, 1, 0, 1, 108, 58, }, + { 6, 1, 0, 1, 108, 76, }, + { 7, 1, 0, 1, 108, 54, }, + { 8, 1, 0, 1, 108, 76, }, + { 9, 1, 0, 1, 108, 127, }, + { 0, 1, 0, 1, 112, 76, }, + { 2, 1, 0, 1, 112, 58, }, + { 1, 1, 0, 1, 112, 76, }, + { 3, 1, 0, 1, 112, 76, }, + { 4, 1, 0, 1, 112, 76, }, + { 5, 1, 0, 1, 112, 58, }, + { 6, 1, 0, 1, 112, 76, }, + { 7, 1, 0, 1, 112, 54, }, + { 8, 1, 0, 1, 112, 76, }, + { 9, 1, 0, 1, 112, 127, }, + { 0, 1, 0, 1, 116, 76, }, + { 2, 1, 0, 1, 116, 58, }, + { 1, 1, 0, 1, 116, 76, }, + { 3, 1, 0, 1, 116, 76, }, + { 4, 1, 0, 1, 116, 76, }, + { 5, 1, 0, 1, 116, 58, }, + { 6, 1, 0, 1, 116, 76, }, + { 7, 1, 0, 1, 116, 54, }, + { 8, 1, 0, 1, 116, 76, }, + { 9, 1, 0, 1, 116, 127, }, + { 0, 1, 0, 1, 120, 76, }, + { 2, 1, 0, 1, 120, 58, }, + { 1, 1, 0, 1, 120, 76, }, + { 3, 1, 0, 1, 120, 127, }, + { 4, 1, 0, 1, 120, 76, }, + { 5, 1, 0, 1, 120, 127, }, + { 6, 1, 0, 1, 120, 76, }, + { 7, 1, 0, 1, 120, 54, }, + { 8, 1, 0, 1, 120, 76, }, + { 9, 1, 0, 1, 120, 127, }, + { 0, 1, 0, 1, 124, 76, }, + { 2, 1, 0, 1, 124, 58, }, + { 1, 1, 0, 1, 124, 76, }, + { 3, 1, 0, 1, 124, 127, }, + { 4, 1, 0, 1, 124, 76, }, + { 5, 1, 0, 1, 124, 127, }, + { 6, 1, 0, 1, 124, 76, }, + { 7, 1, 0, 1, 124, 54, }, + { 8, 1, 0, 1, 124, 76, }, + { 9, 1, 0, 1, 124, 127, }, + { 0, 1, 0, 1, 128, 76, }, + { 2, 1, 0, 1, 128, 58, }, + { 1, 1, 0, 1, 128, 76, }, + { 3, 1, 0, 1, 128, 127, }, + { 4, 1, 0, 1, 128, 76, }, + { 5, 1, 0, 1, 128, 127, }, + { 6, 1, 0, 1, 128, 76, }, + { 7, 1, 0, 1, 128, 54, }, + { 8, 1, 0, 1, 128, 76, }, + { 9, 1, 0, 1, 128, 127, }, + { 0, 1, 0, 1, 132, 76, }, + { 2, 1, 0, 1, 132, 58, }, + { 1, 1, 0, 1, 132, 76, }, + { 3, 1, 0, 1, 132, 76, }, + { 4, 1, 0, 1, 132, 76, }, + { 5, 1, 0, 1, 132, 58, }, + { 6, 1, 0, 1, 132, 76, }, + { 7, 1, 0, 1, 132, 54, }, + { 8, 1, 0, 1, 132, 76, }, + { 9, 1, 0, 1, 132, 127, }, + { 0, 1, 0, 1, 136, 76, }, + { 2, 1, 0, 1, 136, 58, }, + { 1, 1, 0, 1, 136, 76, }, + { 3, 1, 0, 1, 136, 76, }, + { 4, 1, 0, 1, 136, 76, }, + { 5, 1, 0, 1, 136, 58, }, + { 6, 1, 0, 1, 136, 76, }, + { 7, 1, 0, 1, 136, 54, }, + { 8, 1, 0, 1, 136, 76, }, + { 9, 1, 0, 1, 136, 127, }, + { 0, 1, 0, 1, 140, 74, }, + { 2, 1, 0, 1, 140, 58, }, + { 1, 1, 0, 1, 140, 76, }, + { 3, 1, 0, 1, 140, 74, }, + { 4, 1, 0, 1, 140, 76, }, + { 5, 1, 0, 1, 140, 58, }, + { 6, 1, 0, 1, 140, 72, }, + { 7, 1, 0, 1, 140, 54, }, + { 8, 1, 0, 1, 140, 72, }, + { 9, 1, 0, 1, 140, 127, }, + { 0, 1, 0, 1, 144, 76, }, + { 2, 1, 0, 1, 144, 127, }, + { 1, 1, 0, 1, 144, 76, }, + { 3, 1, 0, 1, 144, 76, }, + { 4, 1, 0, 1, 144, 76, }, + { 5, 1, 0, 1, 144, 127, }, + { 6, 1, 0, 1, 144, 76, }, + { 7, 1, 0, 1, 144, 127, }, + { 8, 1, 0, 1, 144, 76, }, + { 9, 1, 0, 1, 144, 127, }, + { 0, 1, 0, 1, 149, 76, }, + { 2, 1, 0, 1, 149, 28, }, + { 1, 1, 0, 1, 149, 127, }, + { 3, 1, 0, 1, 149, 76, }, + { 4, 1, 0, 1, 149, 74, }, + { 5, 1, 0, 1, 149, 76, }, + { 6, 1, 0, 1, 149, 76, }, + { 7, 1, 0, 1, 149, 54, }, + { 8, 1, 0, 1, 149, 76, }, + { 9, 1, 0, 1, 149, 28, }, + { 0, 1, 0, 1, 153, 76, }, + { 2, 1, 0, 1, 153, 28, }, + { 1, 1, 0, 1, 153, 127, }, + { 3, 1, 0, 1, 153, 76, }, + { 4, 1, 0, 1, 153, 74, }, + { 5, 1, 0, 1, 153, 76, }, + { 6, 1, 0, 1, 153, 76, }, + { 7, 1, 0, 1, 153, 54, }, + { 8, 1, 0, 1, 153, 76, }, + { 9, 1, 0, 1, 153, 28, }, + { 0, 1, 0, 1, 157, 76, }, + { 2, 1, 0, 1, 157, 28, }, + { 1, 1, 0, 1, 157, 127, }, + { 3, 1, 0, 1, 157, 76, }, + { 4, 1, 0, 1, 157, 74, }, + { 5, 1, 0, 1, 157, 76, }, + { 6, 1, 0, 1, 157, 76, }, + { 7, 1, 0, 1, 157, 54, }, + { 8, 1, 0, 1, 157, 76, }, + { 9, 1, 0, 1, 157, 28, }, + { 0, 1, 0, 1, 161, 76, }, + { 2, 1, 0, 1, 161, 28, }, + { 1, 1, 0, 1, 161, 127, }, + { 3, 1, 0, 1, 161, 76, }, + { 4, 1, 0, 1, 161, 74, }, + { 5, 1, 0, 1, 161, 76, }, + { 6, 1, 0, 1, 161, 76, }, + { 7, 1, 0, 1, 161, 54, }, + { 8, 1, 0, 1, 161, 76, }, + { 9, 1, 0, 1, 161, 28, }, + { 0, 1, 0, 1, 165, 76, }, + { 2, 1, 0, 1, 165, 28, }, + { 1, 1, 0, 1, 165, 127, }, + { 3, 1, 0, 1, 165, 76, }, + { 4, 1, 0, 1, 165, 74, }, + { 5, 1, 0, 1, 165, 76, }, + { 6, 1, 0, 1, 165, 76, }, + { 7, 1, 0, 1, 165, 54, }, + { 8, 1, 0, 1, 165, 76, }, + { 9, 1, 0, 1, 165, 28, }, + { 0, 1, 0, 2, 36, 70, }, + { 2, 1, 0, 2, 36, 58, }, + { 1, 1, 0, 2, 36, 64, }, + { 3, 1, 0, 2, 36, 62, }, + { 4, 1, 0, 2, 36, 76, }, + { 5, 1, 0, 2, 36, 58, }, + { 6, 1, 0, 2, 36, 64, }, + { 7, 1, 0, 2, 36, 54, }, + { 8, 1, 0, 2, 36, 62, }, + { 9, 1, 0, 2, 36, 62, }, + { 0, 1, 0, 2, 40, 76, }, + { 2, 1, 0, 2, 40, 58, }, + { 1, 1, 0, 2, 40, 62, }, + { 3, 1, 0, 2, 40, 62, }, + { 4, 1, 0, 2, 40, 76, }, + { 5, 1, 0, 2, 40, 58, }, + { 6, 1, 0, 2, 40, 64, }, + { 7, 1, 0, 2, 40, 54, }, + { 8, 1, 0, 2, 40, 62, }, + { 9, 1, 0, 2, 40, 62, }, + { 0, 1, 0, 2, 44, 76, }, + { 2, 1, 0, 2, 44, 58, }, + { 1, 1, 0, 2, 44, 62, }, + { 3, 1, 0, 2, 44, 62, }, + { 4, 1, 0, 2, 44, 76, }, + { 5, 1, 0, 2, 44, 58, }, + { 6, 1, 0, 2, 44, 64, }, + { 7, 1, 0, 2, 44, 54, }, + { 8, 1, 0, 2, 44, 62, }, + { 9, 1, 0, 2, 44, 62, }, + { 0, 1, 0, 2, 48, 76, }, + { 2, 1, 0, 2, 48, 58, }, + { 1, 1, 0, 2, 48, 62, }, + { 3, 1, 0, 2, 48, 62, }, + { 4, 1, 0, 2, 48, 58, }, + { 5, 1, 0, 2, 48, 58, }, + { 6, 1, 0, 2, 48, 64, }, + { 7, 1, 0, 2, 48, 54, }, + { 8, 1, 0, 2, 48, 62, }, + { 9, 1, 0, 2, 48, 62, }, + { 0, 1, 0, 2, 52, 76, }, + { 2, 1, 0, 2, 52, 58, }, + { 1, 1, 0, 2, 52, 62, }, + { 3, 1, 0, 2, 52, 64, }, + { 4, 1, 0, 2, 52, 76, }, + { 5, 1, 0, 2, 52, 58, }, + { 6, 1, 0, 2, 52, 76, }, + { 7, 1, 0, 2, 52, 54, }, + { 8, 1, 0, 2, 52, 76, }, + { 9, 1, 0, 2, 52, 62, }, + { 0, 1, 0, 2, 56, 76, }, + { 2, 1, 0, 2, 56, 58, }, + { 1, 1, 0, 2, 56, 62, }, + { 3, 1, 0, 2, 56, 64, }, + { 4, 1, 0, 2, 56, 76, }, + { 5, 1, 0, 2, 56, 58, }, + { 6, 1, 0, 2, 56, 76, }, + { 7, 1, 0, 2, 56, 54, }, + { 8, 1, 0, 2, 56, 76, }, + { 9, 1, 0, 2, 56, 62, }, + { 0, 1, 0, 2, 60, 76, }, + { 2, 1, 0, 2, 60, 58, }, + { 1, 1, 0, 2, 60, 62, }, + { 3, 1, 0, 2, 60, 64, }, + { 4, 1, 0, 2, 60, 76, }, + { 5, 1, 0, 2, 60, 58, }, + { 6, 1, 0, 2, 60, 76, }, + { 7, 1, 0, 2, 60, 54, }, + { 8, 1, 0, 2, 60, 76, }, + { 9, 1, 0, 2, 60, 62, }, + { 0, 1, 0, 2, 64, 70, }, + { 2, 1, 0, 2, 64, 58, }, + { 1, 1, 0, 2, 64, 62, }, + { 3, 1, 0, 2, 64, 64, }, + { 4, 1, 0, 2, 64, 74, }, + { 5, 1, 0, 2, 64, 58, }, + { 6, 1, 0, 2, 64, 74, }, + { 7, 1, 0, 2, 64, 54, }, + { 8, 1, 0, 2, 64, 74, }, + { 9, 1, 0, 2, 64, 62, }, + { 0, 1, 0, 2, 100, 66, }, + { 2, 1, 0, 2, 100, 58, }, + { 1, 1, 0, 2, 100, 76, }, + { 3, 1, 0, 2, 100, 66, }, + { 4, 1, 0, 2, 100, 76, }, + { 5, 1, 0, 2, 100, 58, }, + { 6, 1, 0, 2, 100, 70, }, + { 7, 1, 0, 2, 100, 54, }, + { 8, 1, 0, 2, 100, 70, }, + { 9, 1, 0, 2, 100, 127, }, + { 0, 1, 0, 2, 104, 76, }, + { 2, 1, 0, 2, 104, 58, }, + { 1, 1, 0, 2, 104, 76, }, + { 3, 1, 0, 2, 104, 76, }, + { 4, 1, 0, 2, 104, 76, }, + { 5, 1, 0, 2, 104, 58, }, + { 6, 1, 0, 2, 104, 76, }, + { 7, 1, 0, 2, 104, 54, }, + { 8, 1, 0, 2, 104, 76, }, + { 9, 1, 0, 2, 104, 127, }, + { 0, 1, 0, 2, 108, 76, }, + { 2, 1, 0, 2, 108, 58, }, + { 1, 1, 0, 2, 108, 76, }, + { 3, 1, 0, 2, 108, 76, }, + { 4, 1, 0, 2, 108, 76, }, + { 5, 1, 0, 2, 108, 58, }, + { 6, 1, 0, 2, 108, 76, }, + { 7, 1, 0, 2, 108, 54, }, + { 8, 1, 0, 2, 108, 76, }, + { 9, 1, 0, 2, 108, 127, }, + { 0, 1, 0, 2, 112, 76, }, + { 2, 1, 0, 2, 112, 58, }, + { 1, 1, 0, 2, 112, 76, }, + { 3, 1, 0, 2, 112, 76, }, + { 4, 1, 0, 2, 112, 76, }, + { 5, 1, 0, 2, 112, 58, }, + { 6, 1, 0, 2, 112, 76, }, + { 7, 1, 0, 2, 112, 54, }, + { 8, 1, 0, 2, 112, 76, }, + { 9, 1, 0, 2, 112, 127, }, + { 0, 1, 0, 2, 116, 76, }, + { 2, 1, 0, 2, 116, 58, }, + { 1, 1, 0, 2, 116, 76, }, + { 3, 1, 0, 2, 116, 76, }, + { 4, 1, 0, 2, 116, 76, }, + { 5, 1, 0, 2, 116, 58, }, + { 6, 1, 0, 2, 116, 76, }, + { 7, 1, 0, 2, 116, 54, }, + { 8, 1, 0, 2, 116, 76, }, + { 9, 1, 0, 2, 116, 127, }, + { 0, 1, 0, 2, 120, 76, }, + { 2, 1, 0, 2, 120, 58, }, + { 1, 1, 0, 2, 120, 76, }, + { 3, 1, 0, 2, 120, 127, }, + { 4, 1, 0, 2, 120, 76, }, + { 5, 1, 0, 2, 120, 127, }, + { 6, 1, 0, 2, 120, 76, }, + { 7, 1, 0, 2, 120, 54, }, + { 8, 1, 0, 2, 120, 76, }, + { 9, 1, 0, 2, 120, 127, }, + { 0, 1, 0, 2, 124, 76, }, + { 2, 1, 0, 2, 124, 58, }, + { 1, 1, 0, 2, 124, 76, }, + { 3, 1, 0, 2, 124, 127, }, + { 4, 1, 0, 2, 124, 76, }, + { 5, 1, 0, 2, 124, 127, }, + { 6, 1, 0, 2, 124, 76, }, + { 7, 1, 0, 2, 124, 54, }, + { 8, 1, 0, 2, 124, 76, }, + { 9, 1, 0, 2, 124, 127, }, + { 0, 1, 0, 2, 128, 76, }, + { 2, 1, 0, 2, 128, 58, }, + { 1, 1, 0, 2, 128, 76, }, + { 3, 1, 0, 2, 128, 127, }, + { 4, 1, 0, 2, 128, 76, }, + { 5, 1, 0, 2, 128, 127, }, + { 6, 1, 0, 2, 128, 76, }, + { 7, 1, 0, 2, 128, 54, }, + { 8, 1, 0, 2, 128, 76, }, + { 9, 1, 0, 2, 128, 127, }, + { 0, 1, 0, 2, 132, 76, }, + { 2, 1, 0, 2, 132, 58, }, + { 1, 1, 0, 2, 132, 76, }, + { 3, 1, 0, 2, 132, 76, }, + { 4, 1, 0, 2, 132, 76, }, + { 5, 1, 0, 2, 132, 58, }, + { 6, 1, 0, 2, 132, 76, }, + { 7, 1, 0, 2, 132, 54, }, + { 8, 1, 0, 2, 132, 76, }, + { 9, 1, 0, 2, 132, 127, }, + { 0, 1, 0, 2, 136, 76, }, + { 2, 1, 0, 2, 136, 58, }, + { 1, 1, 0, 2, 136, 76, }, + { 3, 1, 0, 2, 136, 76, }, + { 4, 1, 0, 2, 136, 76, }, + { 5, 1, 0, 2, 136, 58, }, + { 6, 1, 0, 2, 136, 76, }, + { 7, 1, 0, 2, 136, 54, }, + { 8, 1, 0, 2, 136, 76, }, + { 9, 1, 0, 2, 136, 127, }, + { 0, 1, 0, 2, 140, 66, }, + { 2, 1, 0, 2, 140, 58, }, + { 1, 1, 0, 2, 140, 76, }, + { 3, 1, 0, 2, 140, 66, }, + { 4, 1, 0, 2, 140, 76, }, + { 5, 1, 0, 2, 140, 58, }, + { 6, 1, 0, 2, 140, 70, }, + { 7, 1, 0, 2, 140, 54, }, + { 8, 1, 0, 2, 140, 70, }, + { 9, 1, 0, 2, 140, 127, }, + { 0, 1, 0, 2, 144, 76, }, + { 2, 1, 0, 2, 144, 127, }, + { 1, 1, 0, 2, 144, 76, }, + { 3, 1, 0, 2, 144, 76, }, + { 4, 1, 0, 2, 144, 76, }, + { 5, 1, 0, 2, 144, 127, }, + { 6, 1, 0, 2, 144, 76, }, + { 7, 1, 0, 2, 144, 127, }, + { 8, 1, 0, 2, 144, 76, }, + { 9, 1, 0, 2, 144, 127, }, + { 0, 1, 0, 2, 149, 76, }, + { 2, 1, 0, 2, 149, 28, }, + { 1, 1, 0, 2, 149, 127, }, + { 3, 1, 0, 2, 149, 76, }, + { 4, 1, 0, 2, 149, 74, }, + { 5, 1, 0, 2, 149, 76, }, + { 6, 1, 0, 2, 149, 76, }, + { 7, 1, 0, 2, 149, 54, }, + { 8, 1, 0, 2, 149, 76, }, + { 9, 1, 0, 2, 149, 28, }, + { 0, 1, 0, 2, 153, 76, }, + { 2, 1, 0, 2, 153, 28, }, + { 1, 1, 0, 2, 153, 127, }, + { 3, 1, 0, 2, 153, 76, }, + { 4, 1, 0, 2, 153, 74, }, + { 5, 1, 0, 2, 153, 76, }, + { 6, 1, 0, 2, 153, 76, }, + { 7, 1, 0, 2, 153, 54, }, + { 8, 1, 0, 2, 153, 76, }, + { 9, 1, 0, 2, 153, 28, }, + { 0, 1, 0, 2, 157, 76, }, + { 2, 1, 0, 2, 157, 28, }, + { 1, 1, 0, 2, 157, 127, }, + { 3, 1, 0, 2, 157, 76, }, + { 4, 1, 0, 2, 157, 74, }, + { 5, 1, 0, 2, 157, 76, }, + { 6, 1, 0, 2, 157, 76, }, + { 7, 1, 0, 2, 157, 54, }, + { 8, 1, 0, 2, 157, 76, }, + { 9, 1, 0, 2, 157, 28, }, + { 0, 1, 0, 2, 161, 76, }, + { 2, 1, 0, 2, 161, 28, }, + { 1, 1, 0, 2, 161, 127, }, + { 3, 1, 0, 2, 161, 76, }, + { 4, 1, 0, 2, 161, 74, }, + { 5, 1, 0, 2, 161, 76, }, + { 6, 1, 0, 2, 161, 76, }, + { 7, 1, 0, 2, 161, 54, }, + { 8, 1, 0, 2, 161, 76, }, + { 9, 1, 0, 2, 161, 28, }, + { 0, 1, 0, 2, 165, 76, }, + { 2, 1, 0, 2, 165, 28, }, + { 1, 1, 0, 2, 165, 127, }, + { 3, 1, 0, 2, 165, 76, }, + { 4, 1, 0, 2, 165, 74, }, + { 5, 1, 0, 2, 165, 76, }, + { 6, 1, 0, 2, 165, 76, }, + { 7, 1, 0, 2, 165, 54, }, + { 8, 1, 0, 2, 165, 76, }, + { 9, 1, 0, 2, 165, 28, }, + { 0, 1, 0, 3, 36, 64, }, + { 2, 1, 0, 3, 36, 36, }, + { 1, 1, 0, 3, 36, 50, }, + { 3, 1, 0, 3, 36, 38, }, + { 4, 1, 0, 3, 36, 66, }, + { 5, 1, 0, 3, 36, 36, }, + { 6, 1, 0, 3, 36, 52, }, + { 7, 1, 0, 3, 36, 30, }, + { 8, 1, 0, 3, 36, 50, }, + { 9, 1, 0, 3, 36, 38, }, + { 0, 1, 0, 3, 40, 68, }, + { 2, 1, 0, 3, 40, 36, }, + { 1, 1, 0, 3, 40, 50, }, + { 3, 1, 0, 3, 40, 38, }, + { 4, 1, 0, 3, 40, 66, }, + { 5, 1, 0, 3, 40, 36, }, + { 6, 1, 0, 3, 40, 52, }, + { 7, 1, 0, 3, 40, 30, }, + { 8, 1, 0, 3, 40, 50, }, + { 9, 1, 0, 3, 40, 38, }, + { 0, 1, 0, 3, 44, 68, }, + { 2, 1, 0, 3, 44, 36, }, + { 1, 1, 0, 3, 44, 50, }, + { 3, 1, 0, 3, 44, 38, }, + { 4, 1, 0, 3, 44, 66, }, + { 5, 1, 0, 3, 44, 36, }, + { 6, 1, 0, 3, 44, 52, }, + { 7, 1, 0, 3, 44, 30, }, + { 8, 1, 0, 3, 44, 50, }, + { 9, 1, 0, 3, 44, 38, }, + { 0, 1, 0, 3, 48, 68, }, + { 2, 1, 0, 3, 48, 36, }, + { 1, 1, 0, 3, 48, 50, }, + { 3, 1, 0, 3, 48, 38, }, + { 4, 1, 0, 3, 48, 42, }, + { 5, 1, 0, 3, 48, 36, }, + { 6, 1, 0, 3, 48, 52, }, + { 7, 1, 0, 3, 48, 30, }, + { 8, 1, 0, 3, 48, 50, }, + { 9, 1, 0, 3, 48, 38, }, + { 0, 1, 0, 3, 52, 68, }, + { 2, 1, 0, 3, 52, 36, }, + { 1, 1, 0, 3, 52, 50, }, + { 3, 1, 0, 3, 52, 40, }, + { 4, 1, 0, 3, 52, 66, }, + { 5, 1, 0, 3, 52, 36, }, + { 6, 1, 0, 3, 52, 68, }, + { 7, 1, 0, 3, 52, 30, }, + { 8, 1, 0, 3, 52, 68, }, + { 9, 1, 0, 3, 52, 38, }, + { 0, 1, 0, 3, 56, 68, }, + { 2, 1, 0, 3, 56, 36, }, + { 1, 1, 0, 3, 56, 50, }, + { 3, 1, 0, 3, 56, 40, }, + { 4, 1, 0, 3, 56, 66, }, + { 5, 1, 0, 3, 56, 36, }, + { 6, 1, 0, 3, 56, 68, }, + { 7, 1, 0, 3, 56, 30, }, + { 8, 1, 0, 3, 56, 68, }, + { 9, 1, 0, 3, 56, 38, }, + { 0, 1, 0, 3, 60, 68, }, + { 2, 1, 0, 3, 60, 36, }, + { 1, 1, 0, 3, 60, 50, }, + { 3, 1, 0, 3, 60, 40, }, + { 4, 1, 0, 3, 60, 66, }, + { 5, 1, 0, 3, 60, 36, }, + { 6, 1, 0, 3, 60, 66, }, + { 7, 1, 0, 3, 60, 30, }, + { 8, 1, 0, 3, 60, 66, }, + { 9, 1, 0, 3, 60, 38, }, + { 0, 1, 0, 3, 64, 66, }, + { 2, 1, 0, 3, 64, 36, }, + { 1, 1, 0, 3, 64, 50, }, + { 3, 1, 0, 3, 64, 40, }, + { 4, 1, 0, 3, 64, 66, }, + { 5, 1, 0, 3, 64, 36, }, + { 6, 1, 0, 3, 64, 68, }, + { 7, 1, 0, 3, 64, 30, }, + { 8, 1, 0, 3, 64, 68, }, + { 9, 1, 0, 3, 64, 38, }, + { 0, 1, 0, 3, 100, 64, }, + { 2, 1, 0, 3, 100, 36, }, + { 1, 1, 0, 3, 100, 70, }, + { 3, 1, 0, 3, 100, 64, }, + { 4, 1, 0, 3, 100, 66, }, + { 5, 1, 0, 3, 100, 36, }, + { 6, 1, 0, 3, 100, 60, }, + { 7, 1, 0, 3, 100, 30, }, + { 8, 1, 0, 3, 100, 60, }, + { 9, 1, 0, 3, 100, 127, }, + { 0, 1, 0, 3, 104, 68, }, + { 2, 1, 0, 3, 104, 36, }, + { 1, 1, 0, 3, 104, 70, }, + { 3, 1, 0, 3, 104, 68, }, + { 4, 1, 0, 3, 104, 66, }, + { 5, 1, 0, 3, 104, 36, }, + { 6, 1, 0, 3, 104, 68, }, + { 7, 1, 0, 3, 104, 30, }, + { 8, 1, 0, 3, 104, 68, }, + { 9, 1, 0, 3, 104, 127, }, + { 0, 1, 0, 3, 108, 68, }, + { 2, 1, 0, 3, 108, 36, }, + { 1, 1, 0, 3, 108, 70, }, + { 3, 1, 0, 3, 108, 68, }, + { 4, 1, 0, 3, 108, 66, }, + { 5, 1, 0, 3, 108, 36, }, + { 6, 1, 0, 3, 108, 68, }, + { 7, 1, 0, 3, 108, 30, }, + { 8, 1, 0, 3, 108, 68, }, + { 9, 1, 0, 3, 108, 127, }, + { 0, 1, 0, 3, 112, 68, }, + { 2, 1, 0, 3, 112, 36, }, + { 1, 1, 0, 3, 112, 70, }, + { 3, 1, 0, 3, 112, 68, }, + { 4, 1, 0, 3, 112, 66, }, + { 5, 1, 0, 3, 112, 36, }, + { 6, 1, 0, 3, 112, 68, }, + { 7, 1, 0, 3, 112, 30, }, + { 8, 1, 0, 3, 112, 68, }, + { 9, 1, 0, 3, 112, 127, }, + { 0, 1, 0, 3, 116, 68, }, + { 2, 1, 0, 3, 116, 36, }, + { 1, 1, 0, 3, 116, 70, }, + { 3, 1, 0, 3, 116, 68, }, + { 4, 1, 0, 3, 116, 66, }, + { 5, 1, 0, 3, 116, 36, }, + { 6, 1, 0, 3, 116, 68, }, + { 7, 1, 0, 3, 116, 30, }, + { 8, 1, 0, 3, 116, 68, }, + { 9, 1, 0, 3, 116, 127, }, + { 0, 1, 0, 3, 120, 68, }, + { 2, 1, 0, 3, 120, 36, }, + { 1, 1, 0, 3, 120, 70, }, + { 3, 1, 0, 3, 120, 127, }, + { 4, 1, 0, 3, 120, 66, }, + { 5, 1, 0, 3, 120, 127, }, + { 6, 1, 0, 3, 120, 68, }, + { 7, 1, 0, 3, 120, 30, }, + { 8, 1, 0, 3, 120, 68, }, + { 9, 1, 0, 3, 120, 127, }, + { 0, 1, 0, 3, 124, 68, }, + { 2, 1, 0, 3, 124, 36, }, + { 1, 1, 0, 3, 124, 70, }, + { 3, 1, 0, 3, 124, 127, }, + { 4, 1, 0, 3, 124, 66, }, + { 5, 1, 0, 3, 124, 127, }, + { 6, 1, 0, 3, 124, 68, }, + { 7, 1, 0, 3, 124, 30, }, + { 8, 1, 0, 3, 124, 68, }, + { 9, 1, 0, 3, 124, 127, }, + { 0, 1, 0, 3, 128, 68, }, + { 2, 1, 0, 3, 128, 36, }, + { 1, 1, 0, 3, 128, 70, }, + { 3, 1, 0, 3, 128, 127, }, + { 4, 1, 0, 3, 128, 66, }, + { 5, 1, 0, 3, 128, 127, }, + { 6, 1, 0, 3, 128, 68, }, + { 7, 1, 0, 3, 128, 30, }, + { 8, 1, 0, 3, 128, 68, }, + { 9, 1, 0, 3, 128, 127, }, + { 0, 1, 0, 3, 132, 68, }, + { 2, 1, 0, 3, 132, 36, }, + { 1, 1, 0, 3, 132, 70, }, + { 3, 1, 0, 3, 132, 68, }, + { 4, 1, 0, 3, 132, 66, }, + { 5, 1, 0, 3, 132, 36, }, + { 6, 1, 0, 3, 132, 68, }, + { 7, 1, 0, 3, 132, 30, }, + { 8, 1, 0, 3, 132, 68, }, + { 9, 1, 0, 3, 132, 127, }, + { 0, 1, 0, 3, 136, 68, }, + { 2, 1, 0, 3, 136, 36, }, + { 1, 1, 0, 3, 136, 70, }, + { 3, 1, 0, 3, 136, 68, }, + { 4, 1, 0, 3, 136, 66, }, + { 5, 1, 0, 3, 136, 36, }, + { 6, 1, 0, 3, 136, 68, }, + { 7, 1, 0, 3, 136, 30, }, + { 8, 1, 0, 3, 136, 68, }, + { 9, 1, 0, 3, 136, 127, }, + { 0, 1, 0, 3, 140, 58, }, + { 2, 1, 0, 3, 140, 36, }, + { 1, 1, 0, 3, 140, 70, }, + { 3, 1, 0, 3, 140, 58, }, + { 4, 1, 0, 3, 140, 66, }, + { 5, 1, 0, 3, 140, 36, }, + { 6, 1, 0, 3, 140, 60, }, + { 7, 1, 0, 3, 140, 30, }, + { 8, 1, 0, 3, 140, 60, }, + { 9, 1, 0, 3, 140, 127, }, + { 0, 1, 0, 3, 144, 68, }, + { 2, 1, 0, 3, 144, 127, }, + { 1, 1, 0, 3, 144, 70, }, + { 3, 1, 0, 3, 144, 68, }, + { 4, 1, 0, 3, 144, 66, }, + { 5, 1, 0, 3, 144, 127, }, + { 6, 1, 0, 3, 144, 68, }, + { 7, 1, 0, 3, 144, 127, }, + { 8, 1, 0, 3, 144, 68, }, + { 9, 1, 0, 3, 144, 127, }, + { 0, 1, 0, 3, 149, 76, }, + { 2, 1, 0, 3, 149, 4, }, + { 1, 1, 0, 3, 149, 127, }, + { 3, 1, 0, 3, 149, 76, }, + { 4, 1, 0, 3, 149, 62, }, + { 5, 1, 0, 3, 149, 76, }, + { 6, 1, 0, 3, 149, 76, }, + { 7, 1, 0, 3, 149, 30, }, + { 8, 1, 0, 3, 149, 72, }, + { 9, 1, 0, 3, 149, 4, }, + { 0, 1, 0, 3, 153, 76, }, + { 2, 1, 0, 3, 153, 4, }, + { 1, 1, 0, 3, 153, 127, }, + { 3, 1, 0, 3, 153, 76, }, + { 4, 1, 0, 3, 153, 62, }, + { 5, 1, 0, 3, 153, 76, }, + { 6, 1, 0, 3, 153, 76, }, + { 7, 1, 0, 3, 153, 30, }, + { 8, 1, 0, 3, 153, 76, }, + { 9, 1, 0, 3, 153, 4, }, + { 0, 1, 0, 3, 157, 76, }, + { 2, 1, 0, 3, 157, 4, }, + { 1, 1, 0, 3, 157, 127, }, + { 3, 1, 0, 3, 157, 76, }, + { 4, 1, 0, 3, 157, 62, }, + { 5, 1, 0, 3, 157, 76, }, + { 6, 1, 0, 3, 157, 76, }, + { 7, 1, 0, 3, 157, 30, }, + { 8, 1, 0, 3, 157, 76, }, + { 9, 1, 0, 3, 157, 4, }, + { 0, 1, 0, 3, 161, 76, }, + { 2, 1, 0, 3, 161, 4, }, + { 1, 1, 0, 3, 161, 127, }, + { 3, 1, 0, 3, 161, 76, }, + { 4, 1, 0, 3, 161, 62, }, + { 5, 1, 0, 3, 161, 76, }, + { 6, 1, 0, 3, 161, 76, }, + { 7, 1, 0, 3, 161, 30, }, + { 8, 1, 0, 3, 161, 76, }, + { 9, 1, 0, 3, 161, 4, }, + { 0, 1, 0, 3, 165, 76, }, + { 2, 1, 0, 3, 165, 4, }, + { 1, 1, 0, 3, 165, 127, }, + { 3, 1, 0, 3, 165, 76, }, + { 4, 1, 0, 3, 165, 62, }, + { 5, 1, 0, 3, 165, 76, }, + { 6, 1, 0, 3, 165, 76, }, + { 7, 1, 0, 3, 165, 30, }, + { 8, 1, 0, 3, 165, 76, }, + { 9, 1, 0, 3, 165, 4, }, + { 0, 1, 1, 2, 38, 66, }, + { 2, 1, 1, 2, 38, 64, }, + { 1, 1, 1, 2, 38, 64, }, + { 3, 1, 1, 2, 38, 64, }, + { 4, 1, 1, 2, 38, 64, }, + { 5, 1, 1, 2, 38, 64, }, + { 6, 1, 1, 2, 38, 64, }, + { 7, 1, 1, 2, 38, 54, }, + { 8, 1, 1, 2, 38, 62, }, + { 9, 1, 1, 2, 38, 64, }, + { 0, 1, 1, 2, 46, 72, }, + { 2, 1, 1, 2, 46, 64, }, + { 1, 1, 1, 2, 46, 64, }, + { 3, 1, 1, 2, 46, 64, }, + { 4, 1, 1, 2, 46, 70, }, + { 5, 1, 1, 2, 46, 64, }, + { 6, 1, 1, 2, 46, 64, }, + { 7, 1, 1, 2, 46, 54, }, + { 8, 1, 1, 2, 46, 62, }, + { 9, 1, 1, 2, 46, 64, }, + { 0, 1, 1, 2, 54, 72, }, + { 2, 1, 1, 2, 54, 64, }, + { 1, 1, 1, 2, 54, 64, }, + { 3, 1, 1, 2, 54, 64, }, + { 4, 1, 1, 2, 54, 72, }, + { 5, 1, 1, 2, 54, 64, }, + { 6, 1, 1, 2, 54, 72, }, + { 7, 1, 1, 2, 54, 54, }, + { 8, 1, 1, 2, 54, 72, }, + { 9, 1, 1, 2, 54, 64, }, + { 0, 1, 1, 2, 62, 60, }, + { 2, 1, 1, 2, 62, 64, }, + { 1, 1, 1, 2, 62, 62, }, + { 3, 1, 1, 2, 62, 60, }, + { 4, 1, 1, 2, 62, 60, }, + { 5, 1, 1, 2, 62, 64, }, + { 6, 1, 1, 2, 62, 64, }, + { 7, 1, 1, 2, 62, 54, }, + { 8, 1, 1, 2, 62, 64, }, + { 9, 1, 1, 2, 62, 64, }, + { 0, 1, 1, 2, 102, 60, }, + { 2, 1, 1, 2, 102, 64, }, + { 1, 1, 1, 2, 102, 72, }, + { 3, 1, 1, 2, 102, 60, }, + { 4, 1, 1, 2, 102, 64, }, + { 5, 1, 1, 2, 102, 64, }, + { 6, 1, 1, 2, 102, 58, }, + { 7, 1, 1, 2, 102, 54, }, + { 8, 1, 1, 2, 102, 58, }, + { 9, 1, 1, 2, 102, 127, }, + { 0, 1, 1, 2, 110, 72, }, + { 2, 1, 1, 2, 110, 64, }, + { 1, 1, 1, 2, 110, 72, }, + { 3, 1, 1, 2, 110, 72, }, + { 4, 1, 1, 2, 110, 72, }, + { 5, 1, 1, 2, 110, 64, }, + { 6, 1, 1, 2, 110, 72, }, + { 7, 1, 1, 2, 110, 54, }, + { 8, 1, 1, 2, 110, 72, }, + { 9, 1, 1, 2, 110, 127, }, + { 0, 1, 1, 2, 118, 72, }, + { 2, 1, 1, 2, 118, 64, }, + { 1, 1, 1, 2, 118, 72, }, + { 3, 1, 1, 2, 118, 127, }, + { 4, 1, 1, 2, 118, 72, }, + { 5, 1, 1, 2, 118, 127, }, + { 6, 1, 1, 2, 118, 72, }, + { 7, 1, 1, 2, 118, 54, }, + { 8, 1, 1, 2, 118, 72, }, + { 9, 1, 1, 2, 118, 127, }, + { 0, 1, 1, 2, 126, 72, }, + { 2, 1, 1, 2, 126, 64, }, + { 1, 1, 1, 2, 126, 72, }, + { 3, 1, 1, 2, 126, 127, }, + { 4, 1, 1, 2, 126, 72, }, + { 5, 1, 1, 2, 126, 127, }, + { 6, 1, 1, 2, 126, 72, }, + { 7, 1, 1, 2, 126, 54, }, + { 8, 1, 1, 2, 126, 72, }, + { 9, 1, 1, 2, 126, 127, }, + { 0, 1, 1, 2, 134, 72, }, + { 2, 1, 1, 2, 134, 64, }, + { 1, 1, 1, 2, 134, 72, }, + { 3, 1, 1, 2, 134, 72, }, + { 4, 1, 1, 2, 134, 72, }, + { 5, 1, 1, 2, 134, 64, }, + { 6, 1, 1, 2, 134, 72, }, + { 7, 1, 1, 2, 134, 54, }, + { 8, 1, 1, 2, 134, 72, }, + { 9, 1, 1, 2, 134, 127, }, + { 0, 1, 1, 2, 142, 72, }, + { 2, 1, 1, 2, 142, 127, }, + { 1, 1, 1, 2, 142, 72, }, + { 3, 1, 1, 2, 142, 72, }, + { 4, 1, 1, 2, 142, 72, }, + { 5, 1, 1, 2, 142, 127, }, + { 6, 1, 1, 2, 142, 72, }, + { 7, 1, 1, 2, 142, 127, }, + { 8, 1, 1, 2, 142, 72, }, + { 9, 1, 1, 2, 142, 127, }, + { 0, 1, 1, 2, 151, 72, }, + { 2, 1, 1, 2, 151, 28, }, + { 1, 1, 1, 2, 151, 127, }, + { 3, 1, 1, 2, 151, 72, }, + { 4, 1, 1, 2, 151, 72, }, + { 5, 1, 1, 2, 151, 72, }, + { 6, 1, 1, 2, 151, 72, }, + { 7, 1, 1, 2, 151, 54, }, + { 8, 1, 1, 2, 151, 72, }, + { 9, 1, 1, 2, 151, 28, }, + { 0, 1, 1, 2, 159, 72, }, + { 2, 1, 1, 2, 159, 28, }, + { 1, 1, 1, 2, 159, 127, }, + { 3, 1, 1, 2, 159, 72, }, + { 4, 1, 1, 2, 159, 72, }, + { 5, 1, 1, 2, 159, 72, }, + { 6, 1, 1, 2, 159, 72, }, + { 7, 1, 1, 2, 159, 54, }, + { 8, 1, 1, 2, 159, 72, }, + { 9, 1, 1, 2, 159, 28, }, + { 0, 1, 1, 3, 38, 60, }, + { 2, 1, 1, 3, 38, 40, }, + { 1, 1, 1, 3, 38, 50, }, + { 3, 1, 1, 3, 38, 40, }, + { 4, 1, 1, 3, 38, 54, }, + { 5, 1, 1, 3, 38, 40, }, + { 6, 1, 1, 3, 38, 52, }, + { 7, 1, 1, 3, 38, 30, }, + { 8, 1, 1, 3, 38, 50, }, + { 9, 1, 1, 3, 38, 40, }, + { 0, 1, 1, 3, 46, 68, }, + { 2, 1, 1, 3, 46, 40, }, + { 1, 1, 1, 3, 46, 50, }, + { 3, 1, 1, 3, 46, 40, }, + { 4, 1, 1, 3, 46, 54, }, + { 5, 1, 1, 3, 46, 40, }, + { 6, 1, 1, 3, 46, 52, }, + { 7, 1, 1, 3, 46, 30, }, + { 8, 1, 1, 3, 46, 50, }, + { 9, 1, 1, 3, 46, 40, }, + { 0, 1, 1, 3, 54, 68, }, + { 2, 1, 1, 3, 54, 40, }, + { 1, 1, 1, 3, 54, 50, }, + { 3, 1, 1, 3, 54, 40, }, + { 4, 1, 1, 3, 54, 66, }, + { 5, 1, 1, 3, 54, 40, }, + { 6, 1, 1, 3, 54, 68, }, + { 7, 1, 1, 3, 54, 30, }, + { 8, 1, 1, 3, 54, 68, }, + { 9, 1, 1, 3, 54, 40, }, + { 0, 1, 1, 3, 62, 58, }, + { 2, 1, 1, 3, 62, 40, }, + { 1, 1, 1, 3, 62, 48, }, + { 3, 1, 1, 3, 62, 40, }, + { 4, 1, 1, 3, 62, 50, }, + { 5, 1, 1, 3, 62, 40, }, + { 6, 1, 1, 3, 62, 58, }, + { 7, 1, 1, 3, 62, 30, }, + { 8, 1, 1, 3, 62, 58, }, + { 9, 1, 1, 3, 62, 40, }, + { 0, 1, 1, 3, 102, 56, }, + { 2, 1, 1, 3, 102, 40, }, + { 1, 1, 1, 3, 102, 70, }, + { 3, 1, 1, 3, 102, 56, }, + { 4, 1, 1, 3, 102, 54, }, + { 5, 1, 1, 3, 102, 40, }, + { 6, 1, 1, 3, 102, 54, }, + { 7, 1, 1, 3, 102, 30, }, + { 8, 1, 1, 3, 102, 54, }, + { 9, 1, 1, 3, 102, 127, }, + { 0, 1, 1, 3, 110, 68, }, + { 2, 1, 1, 3, 110, 40, }, + { 1, 1, 1, 3, 110, 70, }, + { 3, 1, 1, 3, 110, 68, }, + { 4, 1, 1, 3, 110, 66, }, + { 5, 1, 1, 3, 110, 40, }, + { 6, 1, 1, 3, 110, 68, }, + { 7, 1, 1, 3, 110, 30, }, + { 8, 1, 1, 3, 110, 68, }, + { 9, 1, 1, 3, 110, 127, }, + { 0, 1, 1, 3, 118, 68, }, + { 2, 1, 1, 3, 118, 40, }, + { 1, 1, 1, 3, 118, 70, }, + { 3, 1, 1, 3, 118, 127, }, + { 4, 1, 1, 3, 118, 66, }, + { 5, 1, 1, 3, 118, 127, }, + { 6, 1, 1, 3, 118, 68, }, + { 7, 1, 1, 3, 118, 30, }, + { 8, 1, 1, 3, 118, 68, }, + { 9, 1, 1, 3, 118, 127, }, + { 0, 1, 1, 3, 126, 68, }, + { 2, 1, 1, 3, 126, 40, }, + { 1, 1, 1, 3, 126, 70, }, + { 3, 1, 1, 3, 126, 127, }, + { 4, 1, 1, 3, 126, 66, }, + { 5, 1, 1, 3, 126, 127, }, + { 6, 1, 1, 3, 126, 68, }, + { 7, 1, 1, 3, 126, 30, }, + { 8, 1, 1, 3, 126, 68, }, + { 9, 1, 1, 3, 126, 127, }, + { 0, 1, 1, 3, 134, 68, }, + { 2, 1, 1, 3, 134, 40, }, + { 1, 1, 1, 3, 134, 70, }, + { 3, 1, 1, 3, 134, 68, }, + { 4, 1, 1, 3, 134, 66, }, + { 5, 1, 1, 3, 134, 40, }, + { 6, 1, 1, 3, 134, 68, }, + { 7, 1, 1, 3, 134, 30, }, + { 8, 1, 1, 3, 134, 68, }, + { 9, 1, 1, 3, 134, 127, }, + { 0, 1, 1, 3, 142, 68, }, + { 2, 1, 1, 3, 142, 127, }, + { 1, 1, 1, 3, 142, 70, }, + { 3, 1, 1, 3, 142, 68, }, + { 4, 1, 1, 3, 142, 66, }, + { 5, 1, 1, 3, 142, 127, }, + { 6, 1, 1, 3, 142, 68, }, + { 7, 1, 1, 3, 142, 127, }, + { 8, 1, 1, 3, 142, 68, }, + { 9, 1, 1, 3, 142, 127, }, + { 0, 1, 1, 3, 151, 72, }, + { 2, 1, 1, 3, 151, 4, }, + { 1, 1, 1, 3, 151, 127, }, + { 3, 1, 1, 3, 151, 72, }, + { 4, 1, 1, 3, 151, 66, }, + { 5, 1, 1, 3, 151, 72, }, + { 6, 1, 1, 3, 151, 72, }, + { 7, 1, 1, 3, 151, 30, }, + { 8, 1, 1, 3, 151, 68, }, + { 9, 1, 1, 3, 151, 4, }, + { 0, 1, 1, 3, 159, 72, }, + { 2, 1, 1, 3, 159, 4, }, + { 1, 1, 1, 3, 159, 127, }, + { 3, 1, 1, 3, 159, 72, }, + { 4, 1, 1, 3, 159, 66, }, + { 5, 1, 1, 3, 159, 72, }, + { 6, 1, 1, 3, 159, 72, }, + { 7, 1, 1, 3, 159, 30, }, + { 8, 1, 1, 3, 159, 72, }, + { 9, 1, 1, 3, 159, 4, }, + { 0, 1, 2, 4, 42, 68, }, + { 2, 1, 2, 4, 42, 64, }, + { 1, 1, 2, 4, 42, 64, }, + { 3, 1, 2, 4, 42, 64, }, + { 4, 1, 2, 4, 42, 60, }, + { 5, 1, 2, 4, 42, 64, }, + { 6, 1, 2, 4, 42, 64, }, + { 7, 1, 2, 4, 42, 54, }, + { 8, 1, 2, 4, 42, 62, }, + { 9, 1, 2, 4, 42, 64, }, + { 0, 1, 2, 4, 58, 60, }, + { 2, 1, 2, 4, 58, 64, }, + { 1, 1, 2, 4, 58, 64, }, + { 3, 1, 2, 4, 58, 60, }, + { 4, 1, 2, 4, 58, 56, }, + { 5, 1, 2, 4, 58, 64, }, + { 6, 1, 2, 4, 58, 62, }, + { 7, 1, 2, 4, 58, 54, }, + { 8, 1, 2, 4, 58, 62, }, + { 9, 1, 2, 4, 58, 64, }, + { 0, 1, 2, 4, 106, 60, }, + { 2, 1, 2, 4, 106, 64, }, + { 1, 1, 2, 4, 106, 72, }, + { 3, 1, 2, 4, 106, 60, }, + { 4, 1, 2, 4, 106, 58, }, + { 5, 1, 2, 4, 106, 64, }, + { 6, 1, 2, 4, 106, 58, }, + { 7, 1, 2, 4, 106, 54, }, + { 8, 1, 2, 4, 106, 58, }, + { 9, 1, 2, 4, 106, 127, }, + { 0, 1, 2, 4, 122, 72, }, + { 2, 1, 2, 4, 122, 64, }, + { 1, 1, 2, 4, 122, 72, }, + { 3, 1, 2, 4, 122, 127, }, + { 4, 1, 2, 4, 122, 68, }, + { 5, 1, 2, 4, 122, 127, }, + { 6, 1, 2, 4, 122, 72, }, + { 7, 1, 2, 4, 122, 54, }, + { 8, 1, 2, 4, 122, 72, }, + { 9, 1, 2, 4, 122, 127, }, + { 0, 1, 2, 4, 138, 72, }, + { 2, 1, 2, 4, 138, 127, }, + { 1, 1, 2, 4, 138, 72, }, + { 3, 1, 2, 4, 138, 72, }, + { 4, 1, 2, 4, 138, 70, }, + { 5, 1, 2, 4, 138, 127, }, + { 6, 1, 2, 4, 138, 72, }, + { 7, 1, 2, 4, 138, 127, }, + { 8, 1, 2, 4, 138, 72, }, + { 9, 1, 2, 4, 138, 127, }, + { 0, 1, 2, 4, 155, 72, }, + { 2, 1, 2, 4, 155, 28, }, + { 1, 1, 2, 4, 155, 127, }, + { 3, 1, 2, 4, 155, 72, }, + { 4, 1, 2, 4, 155, 62, }, + { 5, 1, 2, 4, 155, 72, }, + { 6, 1, 2, 4, 155, 72, }, + { 7, 1, 2, 4, 155, 54, }, + { 8, 1, 2, 4, 155, 68, }, + { 9, 1, 2, 4, 155, 28, }, + { 0, 1, 2, 5, 42, 56, }, + { 2, 1, 2, 5, 42, 40, }, + { 1, 1, 2, 5, 42, 50, }, + { 3, 1, 2, 5, 42, 40, }, + { 4, 1, 2, 5, 42, 50, }, + { 5, 1, 2, 5, 42, 40, }, + { 6, 1, 2, 5, 42, 52, }, + { 7, 1, 2, 5, 42, 30, }, + { 8, 1, 2, 5, 42, 50, }, + { 9, 1, 2, 5, 42, 40, }, + { 0, 1, 2, 5, 58, 54, }, + { 2, 1, 2, 5, 58, 40, }, + { 1, 1, 2, 5, 58, 50, }, + { 3, 1, 2, 5, 58, 40, }, + { 4, 1, 2, 5, 58, 46, }, + { 5, 1, 2, 5, 58, 40, }, + { 6, 1, 2, 5, 58, 52, }, + { 7, 1, 2, 5, 58, 30, }, + { 8, 1, 2, 5, 58, 52, }, + { 9, 1, 2, 5, 58, 40, }, + { 0, 1, 2, 5, 106, 48, }, + { 2, 1, 2, 5, 106, 40, }, + { 1, 1, 2, 5, 106, 72, }, + { 3, 1, 2, 5, 106, 48, }, + { 4, 1, 2, 5, 106, 50, }, + { 5, 1, 2, 5, 106, 40, }, + { 6, 1, 2, 5, 106, 50, }, + { 7, 1, 2, 5, 106, 30, }, + { 8, 1, 2, 5, 106, 50, }, + { 9, 1, 2, 5, 106, 127, }, + { 0, 1, 2, 5, 122, 70, }, + { 2, 1, 2, 5, 122, 40, }, + { 1, 1, 2, 5, 122, 72, }, + { 3, 1, 2, 5, 122, 127, }, + { 4, 1, 2, 5, 122, 62, }, + { 5, 1, 2, 5, 122, 127, }, + { 6, 1, 2, 5, 122, 66, }, + { 7, 1, 2, 5, 122, 30, }, + { 8, 1, 2, 5, 122, 66, }, + { 9, 1, 2, 5, 122, 127, }, + { 0, 1, 2, 5, 138, 70, }, + { 2, 1, 2, 5, 138, 127, }, + { 1, 1, 2, 5, 138, 72, }, + { 3, 1, 2, 5, 138, 70, }, + { 4, 1, 2, 5, 138, 62, }, + { 5, 1, 2, 5, 138, 127, }, + { 6, 1, 2, 5, 138, 66, }, + { 7, 1, 2, 5, 138, 127, }, + { 8, 1, 2, 5, 138, 66, }, + { 9, 1, 2, 5, 138, 127, }, + { 0, 1, 2, 5, 155, 72, }, + { 2, 1, 2, 5, 155, 4, }, + { 1, 1, 2, 5, 155, 127, }, + { 3, 1, 2, 5, 155, 72, }, + { 4, 1, 2, 5, 155, 52, }, + { 5, 1, 2, 5, 155, 72, }, + { 6, 1, 2, 5, 155, 62, }, + { 7, 1, 2, 5, 155, 30, }, + { 8, 1, 2, 5, 155, 62, }, + { 9, 1, 2, 5, 155, 4, }, +}; + +RTW_DECL_TABLE_TXPWR_LMT(rtw8822c_txpwr_lmt_type5); + +static const u32 rtw8822c_dpk_afe_no_dpk[] = { + 0x18a4, BIT(7), 0, + 0x41a4, BIT(7), 0, + 0x1c38, MASKDWORD, 0xffa1005e, + 0x1830, MASKDWORD, 0x700b8041, + 0x1830, MASKDWORD, 0x70144041, + 0x1830, MASKDWORD, 0x70244041, + 0x1830, MASKDWORD, 0x70344041, + 0x1830, MASKDWORD, 0x70444041, + 0x1830, MASKDWORD, 0x705b8041, + 0x1830, MASKDWORD, 0x70644041, + 0x4130, MASKDWORD, 0x700b8041, + 0x4130, MASKDWORD, 0x70144041, + 0x4130, MASKDWORD, 0x70244041, + 0x4130, MASKDWORD, 0x70344041, + 0x4130, MASKDWORD, 0x70444041, + 0x4130, MASKDWORD, 0x705b8041, + 0x4130, MASKDWORD, 0x70644041, + 0x1830, MASKDWORD, 0x707b8041, + 0x1830, MASKDWORD, 0x708b8041, + 0x1830, MASKDWORD, 0x709b8041, + 0x1830, MASKDWORD, 0x70ab8041, + 0x1830, MASKDWORD, 0x70bb8041, + 0x1830, MASKDWORD, 0x70cb8041, + 0x1830, MASKDWORD, 0x70db8041, + 0x1830, MASKDWORD, 0x70eb8041, + 0x1830, MASKDWORD, 0x70fb8041, + 0x4130, MASKDWORD, 0x707b8041, + 0x4130, MASKDWORD, 0x708b8041, + 0x4130, MASKDWORD, 0x709b8041, + 0x4130, MASKDWORD, 0x70ab8041, + 0x4130, MASKDWORD, 0x70bb8041, + 0x4130, MASKDWORD, 0x70cb8041, + 0x4130, MASKDWORD, 0x70db8041, + 0x4130, MASKDWORD, 0x70eb8041, + 0x4130, MASKDWORD, 0x70fb8041, +}; + +RTW_DECL_TABLE_DPK(rtw8822c_dpk_afe_no_dpk); + +static const u32 rtw8822c_dpk_afe_is_dpk[] = { + 0x1c38, MASKDWORD, 0xFFFFFFFF, + 0x1830, MASKDWORD, 0x700f0001, + 0x1830, MASKDWORD, 0x700f0001, + 0x1830, MASKDWORD, 0x701f0001, + 0x1830, MASKDWORD, 0x702f0001, + 0x1830, MASKDWORD, 0x703f0001, + 0x1830, MASKDWORD, 0x704f0001, + 0x1830, MASKDWORD, 0x705f0001, + 0x1830, MASKDWORD, 0x706f0001, + 0x1830, MASKDWORD, 0x707f0001, + 0x1830, MASKDWORD, 0x708f0001, + 0x1830, MASKDWORD, 0x709f0001, + 0x1830, MASKDWORD, 0x70af0001, + 0x1830, MASKDWORD, 0x70bf0001, + 0x1830, MASKDWORD, 0x70cf0001, + 0x1830, MASKDWORD, 0x70df0001, + 0x1830, MASKDWORD, 0x70ef0001, + 0x1830, MASKDWORD, 0x70ff0001, + 0x1830, MASKDWORD, 0x70ff0001, + 0x4130, MASKDWORD, 0x700f0001, + 0x4130, MASKDWORD, 0x700f0001, + 0x4130, MASKDWORD, 0x701f0001, + 0x4130, MASKDWORD, 0x702f0001, + 0x4130, MASKDWORD, 0x703f0001, + 0x4130, MASKDWORD, 0x704f0001, + 0x4130, MASKDWORD, 0x705f0001, + 0x4130, MASKDWORD, 0x706f0001, + 0x4130, MASKDWORD, 0x707f0001, + 0x4130, MASKDWORD, 0x708f0001, + 0x4130, MASKDWORD, 0x709f0001, + 0x4130, MASKDWORD, 0x70af0001, + 0x4130, MASKDWORD, 0x70bf0001, + 0x4130, MASKDWORD, 0x70cf0001, + 0x4130, MASKDWORD, 0x70df0001, + 0x4130, MASKDWORD, 0x70ef0001, + 0x4130, MASKDWORD, 0x70ff0001, + 0x4130, MASKDWORD, 0x70ff0001, + 0x18a4, BIT(7), 1, + 0x41a4, BIT(7), 1, +}; + +RTW_DECL_TABLE_DPK(rtw8822c_dpk_afe_is_dpk); + +static const u32 rtw8822c_dpk_mac_bb[] = { + 0x1e24, BIT(17), 0x1, + 0x1d58, GENMASK(11, 3), 0x1ff, + 0x1864, BIT(31), 0x1, + 0x4164, BIT(31), 0x1, + 0x180c, BIT(27), 0x1, + 0x410c, BIT(27), 0x1, + 0x186c, BIT(7), 0x1, + 0x416c, BIT(7), 0x1, + 0x180c, GENMASK(1, 0), 0x0, + 0x410c, GENMASK(1, 0), 0x0, + 0x1a14, GENMASK(9, 8), 0x3, + 0x80c, GENMASK(3, 0), 0x8, + 0x824, GENMASK(19, 16), 0x3, + 0x824, GENMASK(27, 24), 0x3, +}; + +RTW_DECL_TABLE_DPK(rtw8822c_dpk_mac_bb); + +static const u32 rtw8822c_array_mp_cal_init[] = { + 0x1b00, 0x00000008, + 0x1b00, 0x00A70008, + 0x1b00, 0x00150008, + 0x1b00, 0x00000008, + 0x1b04, 0xE2462952, + 0x1b08, 0x00000080, + 0x1b0c, 0x00000000, + 0x1b10, 0x00010C00, + 0x1b14, 0x00000000, + 0x1b18, 0x00292903, + 0x1b1c, 0xA218FC32, + 0x1b20, 0x01040008, + 0x1b24, 0x00060008, + 0x1b28, 0x00060300, + 0x1b2C, 0x00180018, + 0x1b30, 0x40000000, + 0x1b34, 0x00000800, + 0x1b38, 0x40000000, + 0x1b3C, 0x40000000, + 0x1b98, 0x00000000, + 0x1b9c, 0x00000000, + 0x1bc0, 0x01000000, + 0x1bcc, 0x00000000, + 0x1bd8, 0xe0000001, + 0x1be4, 0x00000000, + 0x1bec, 0x40000000, + 0x1b40, 0x40000000, + 0x1b44, 0x20004064, + 0x1b48, 0x0005002D, + 0x1b4c, 0x00000000, + 0x1b60, 0x1F100000, + 0x1b64, 0x12000000, + 0x1b4c, 0x00000000, + 0x1b4c, 0x008a0000, + 0x1b50, 0x000003BE, + 0x1b4c, 0x018a0000, + 0x1b50, 0x0000057A, + 0x1b4c, 0x028a0000, + 0x1b50, 0x000006C8, + 0x1b4c, 0x038a0000, + 0x1b50, 0x000007E0, + 0x1b4c, 0x048a0000, + 0x1b50, 0x000008D5, + 0x1b4c, 0x058a0000, + 0x1b50, 0x000009B2, + 0x1b4c, 0x068a0000, + 0x1b50, 0x00000A7D, + 0x1b4c, 0x078a0000, + 0x1b50, 0x00000B3A, + 0x1b4c, 0x088a0000, + 0x1b50, 0x00000BEB, + 0x1b4c, 0x098a0000, + 0x1b50, 0x00000C92, + 0x1b4c, 0x0A8a0000, + 0x1b50, 0x00000D31, + 0x1b4c, 0x0B8a0000, + 0x1b50, 0x00000DC9, + 0x1b4c, 0x0C8a0000, + 0x1b50, 0x00000E5A, + 0x1b4c, 0x0D8a0000, + 0x1b50, 0x00000EE6, + 0x1b4c, 0x0E8a0000, + 0x1b50, 0x00000F6D, + 0x1b4c, 0x0F8a0000, + 0x1b50, 0x00000FF0, + 0x1b4c, 0x108a0000, + 0x1b50, 0x0000106F, + 0x1b4c, 0x118a0000, + 0x1b50, 0x000010E9, + 0x1b4c, 0x128a0000, + 0x1b50, 0x00001161, + 0x1b4c, 0x138a0000, + 0x1b50, 0x000011D5, + 0x1b4c, 0x148a0000, + 0x1b50, 0x00001247, + 0x1b4c, 0x158a0000, + 0x1b50, 0x000012B5, + 0x1b4c, 0x168a0000, + 0x1b50, 0x00001322, + 0x1b4c, 0x178a0000, + 0x1b50, 0x0000138B, + 0x1b4c, 0x188a0000, + 0x1b50, 0x000013F3, + 0x1b4c, 0x198a0000, + 0x1b50, 0x00001459, + 0x1b4c, 0x1A8a0000, + 0x1b50, 0x000014BD, + 0x1b4c, 0x1B8a0000, + 0x1b50, 0x0000151E, + 0x1b4c, 0x1C8a0000, + 0x1b50, 0x0000157F, + 0x1b4c, 0x1D8a0000, + 0x1b50, 0x000015DD, + 0x1b4c, 0x1E8a0000, + 0x1b50, 0x0000163A, + 0x1b4c, 0x1F8a0000, + 0x1b50, 0x00001695, + 0x1b4c, 0x208a0000, + 0x1b50, 0x000016EF, + 0x1b4c, 0x218a0000, + 0x1b50, 0x00001748, + 0x1b4c, 0x228a0000, + 0x1b50, 0x0000179F, + 0x1b4c, 0x238a0000, + 0x1b50, 0x000017F5, + 0x1b4c, 0x248a0000, + 0x1b50, 0x0000184A, + 0x1b4c, 0x258a0000, + 0x1b50, 0x0000189E, + 0x1b4c, 0x268a0000, + 0x1b50, 0x000018F1, + 0x1b4c, 0x278a0000, + 0x1b50, 0x00001942, + 0x1b4c, 0x288a0000, + 0x1b50, 0x00001993, + 0x1b4c, 0x298a0000, + 0x1b50, 0x000019E2, + 0x1b4c, 0x2A8a0000, + 0x1b50, 0x00001A31, + 0x1b4c, 0x2B8a0000, + 0x1b50, 0x00001A7F, + 0x1b4c, 0x2C8a0000, + 0x1b50, 0x00001ACC, + 0x1b4c, 0x2D8a0000, + 0x1b50, 0x00001B18, + 0x1b4c, 0x2E8a0000, + 0x1b50, 0x00001B63, + 0x1b4c, 0x2F8a0000, + 0x1b50, 0x00001BAD, + 0x1b4c, 0x308a0000, + 0x1b50, 0x00001BF7, + 0x1b4c, 0x318a0000, + 0x1b50, 0x00001C40, + 0x1b4c, 0x328a0000, + 0x1b50, 0x00001C88, + 0x1b4c, 0x338a0000, + 0x1b50, 0x00001CCF, + 0x1b4c, 0x348a0000, + 0x1b50, 0x00001D16, + 0x1b4c, 0x358a0000, + 0x1b50, 0x00001D5C, + 0x1b4c, 0x368a0000, + 0x1b50, 0x00001DA2, + 0x1b4c, 0x378a0000, + 0x1b50, 0x00001DE6, + 0x1b4c, 0x388a0000, + 0x1b50, 0x00001E2B, + 0x1b4c, 0x398a0000, + 0x1b50, 0x00001E6E, + 0x1b4c, 0x3A8a0000, + 0x1b50, 0x00001EB1, + 0x1b4c, 0x3B8a0000, + 0x1b50, 0x00001EF4, + 0x1b4c, 0x3C8a0000, + 0x1b50, 0x00001F35, + 0x1b4c, 0x3D8a0000, + 0x1b50, 0x00001F77, + 0x1b4c, 0x3E8a0000, + 0x1b50, 0x00001FB8, + 0x1b4c, 0x3F8a0000, + 0x1b50, 0x00001FF8, + 0x1b4c, 0x00000000, + 0x1b50, 0x00000000, + 0x1b58, 0x00890000, + 0x1b5C, 0x3C6B3FFF, + 0x1b58, 0x02890000, + 0x1b5C, 0x35D9390A, + 0x1b58, 0x04890000, + 0x1b5C, 0x2FFE32D6, + 0x1b58, 0x06890000, + 0x1b5C, 0x2AC62D4F, + 0x1b58, 0x08890000, + 0x1b5C, 0x261F2862, + 0x1b58, 0x0A890000, + 0x1b5C, 0x21FA23FD, + 0x1b58, 0x0C890000, + 0x1b5C, 0x1E482013, + 0x1b58, 0x0E890000, + 0x1b5C, 0x1AFD1C96, + 0x1b58, 0x10890000, + 0x1b5C, 0x180E197B, + 0x1b58, 0x12890000, + 0x1b5C, 0x157016B5, + 0x1b58, 0x14890000, + 0x1b5C, 0x131B143D, + 0x1b58, 0x16890000, + 0x1b5C, 0x1107120A, + 0x1b58, 0x18890000, + 0x1b5C, 0x0F2D1013, + 0x1b58, 0x1A890000, + 0x1b5C, 0x0D870E54, + 0x1b58, 0x1C890000, + 0x1b5C, 0x0C0E0CC5, + 0x1b58, 0x1E890000, + 0x1b5C, 0x0ABF0B62, + 0x1b58, 0x20890000, + 0x1b5C, 0x09930A25, + 0x1b58, 0x22890000, + 0x1b5C, 0x0889090A, + 0x1b58, 0x24890000, + 0x1b5C, 0x079B080F, + 0x1b58, 0x26890000, + 0x1b5C, 0x06C7072E, + 0x1b58, 0x28890000, + 0x1b5C, 0x060B0666, + 0x1b58, 0x2A890000, + 0x1b5C, 0x056305B4, + 0x1b58, 0x2C890000, + 0x1b5C, 0x04CD0515, + 0x1b58, 0x2E890000, + 0x1b5C, 0x04470488, + 0x1b58, 0x30890000, + 0x1b5C, 0x03D0040A, + 0x1b58, 0x32890000, + 0x1b5C, 0x03660399, + 0x1b58, 0x34890000, + 0x1b5C, 0x03070335, + 0x1b58, 0x36890000, + 0x1b5C, 0x02B302DC, + 0x1b58, 0x38890000, + 0x1b5C, 0x0268028C, + 0x1b58, 0x3A890000, + 0x1b5C, 0x02250245, + 0x1b58, 0x3C890000, + 0x1b5C, 0x01E90206, + 0x1b58, 0x3E890000, + 0x1b5C, 0x01B401CE, + 0x1b58, 0x40890000, + 0x1b5C, 0x0185019C, + 0x1b58, 0x42890000, + 0x1b5C, 0x015A016F, + 0x1b58, 0x44890000, + 0x1b5C, 0x01350147, + 0x1b58, 0x46890000, + 0x1b5C, 0x01130123, + 0x1b58, 0x48890000, + 0x1b5C, 0x00F50104, + 0x1b58, 0x4A890000, + 0x1b5C, 0x00DA00E7, + 0x1b58, 0x4C890000, + 0x1b5C, 0x00C300CE, + 0x1b58, 0x4E890000, + 0x1b5C, 0x00AE00B8, + 0x1b58, 0x50890000, + 0x1b5C, 0x009B00A4, + 0x1b58, 0x52890000, + 0x1b5C, 0x008A0092, + 0x1b58, 0x54890000, + 0x1b5C, 0x007B0082, + 0x1b58, 0x56890000, + 0x1b5C, 0x006E0074, + 0x1b58, 0x58890000, + 0x1b5C, 0x00620067, + 0x1b58, 0x5A890000, + 0x1b5C, 0x0057005C, + 0x1b58, 0x5C890000, + 0x1b5C, 0x004E0052, + 0x1b58, 0x5E890000, + 0x1b5C, 0x00450049, + 0x1b58, 0x60890000, + 0x1b5C, 0x003E0041, + 0x1b58, 0x62890000, + 0x1b5C, 0x0037003A, + 0x1b58, 0x62010000, + 0x1b00, 0x0000000A, + 0x1b00, 0x00A7000A, + 0x1b00, 0x0015000A, + 0x1b00, 0x0000000A, + 0x1b04, 0xE2462952, + 0x1b08, 0x00000080, + 0x1b0c, 0x00000000, + 0x1b10, 0x00010C00, + 0x1b14, 0x00000000, + 0x1b18, 0x00292903, + 0x1b1c, 0xA218FC32, + 0x1b20, 0x01040008, + 0x1b24, 0x00060008, + 0x1b28, 0x00060300, + 0x1b2C, 0x00180018, + 0x1b30, 0x40000000, + 0x1b34, 0x00000800, + 0x1b38, 0x40000000, + 0x1b3C, 0x40000000, + 0x1b98, 0x00000000, + 0x1b9c, 0x00000000, + 0x1bc0, 0x01000000, + 0x1bcc, 0x00000000, + 0x1bd8, 0xe0000001, + 0x1be4, 0x00000000, + 0x1bec, 0x40000000, + 0x1b60, 0x1F100000, + 0x1b64, 0x12000000, + 0x1b58, 0x00890000, + 0x1b5C, 0x3C6B3FFF, + 0x1b58, 0x02890000, + 0x1b5C, 0x35D9390A, + 0x1b58, 0x04890000, + 0x1b5C, 0x2FFE32D6, + 0x1b58, 0x06890000, + 0x1b5C, 0x2AC62D4F, + 0x1b58, 0x08890000, + 0x1b5C, 0x261F2862, + 0x1b58, 0x0A890000, + 0x1b5C, 0x21FA23FD, + 0x1b58, 0x0C890000, + 0x1b5C, 0x1E482013, + 0x1b58, 0x0E890000, + 0x1b5C, 0x1AFD1C96, + 0x1b58, 0x10890000, + 0x1b5C, 0x180E197B, + 0x1b58, 0x12890000, + 0x1b5C, 0x157016B5, + 0x1b58, 0x14890000, + 0x1b5C, 0x131B143D, + 0x1b58, 0x16890000, + 0x1b5C, 0x1107120A, + 0x1b58, 0x18890000, + 0x1b5C, 0x0F2D1013, + 0x1b58, 0x1A890000, + 0x1b5C, 0x0D870E54, + 0x1b58, 0x1C890000, + 0x1b5C, 0x0C0E0CC5, + 0x1b58, 0x1E890000, + 0x1b5C, 0x0ABF0B62, + 0x1b58, 0x20890000, + 0x1b5C, 0x09930A25, + 0x1b58, 0x22890000, + 0x1b5C, 0x0889090A, + 0x1b58, 0x24890000, + 0x1b5C, 0x079B080F, + 0x1b58, 0x26890000, + 0x1b5C, 0x06C7072E, + 0x1b58, 0x28890000, + 0x1b5C, 0x060B0666, + 0x1b58, 0x2A890000, + 0x1b5C, 0x056305B4, + 0x1b58, 0x2C890000, + 0x1b5C, 0x04CD0515, + 0x1b58, 0x2E890000, + 0x1b5C, 0x04470488, + 0x1b58, 0x30890000, + 0x1b5C, 0x03D0040A, + 0x1b58, 0x32890000, + 0x1b5C, 0x03660399, + 0x1b58, 0x34890000, + 0x1b5C, 0x03070335, + 0x1b58, 0x36890000, + 0x1b5C, 0x02B302DC, + 0x1b58, 0x38890000, + 0x1b5C, 0x0268028C, + 0x1b58, 0x3A890000, + 0x1b5C, 0x02250245, + 0x1b58, 0x3C890000, + 0x1b5C, 0x01E90206, + 0x1b58, 0x3E890000, + 0x1b5C, 0x01B401CE, + 0x1b58, 0x40890000, + 0x1b5C, 0x0185019C, + 0x1b58, 0x42890000, + 0x1b5C, 0x015A016F, + 0x1b58, 0x44890000, + 0x1b5C, 0x01350147, + 0x1b58, 0x46890000, + 0x1b5C, 0x01130123, + 0x1b58, 0x48890000, + 0x1b5C, 0x00F50104, + 0x1b58, 0x4A890000, + 0x1b5C, 0x00DA00E7, + 0x1b58, 0x4C890000, + 0x1b5C, 0x00C300CE, + 0x1b58, 0x4E890000, + 0x1b5C, 0x00AE00B8, + 0x1b58, 0x50890000, + 0x1b5C, 0x009B00A4, + 0x1b58, 0x52890000, + 0x1b5C, 0x008A0092, + 0x1b58, 0x54890000, + 0x1b5C, 0x007B0082, + 0x1b58, 0x56890000, + 0x1b5C, 0x006E0074, + 0x1b58, 0x58890000, + 0x1b5C, 0x00620067, + 0x1b58, 0x5A890000, + 0x1b5C, 0x0057005C, + 0x1b58, 0x5C890000, + 0x1b5C, 0x004E0052, + 0x1b58, 0x5E890000, + 0x1b5C, 0x00450049, + 0x1b58, 0x60890000, + 0x1b5C, 0x003E0041, + 0x1b58, 0x62890000, + 0x1b5C, 0x0037003A, + 0x1b58, 0x62010000, + 0x1b00, 0x0000000C, + 0x1bd4, 0x000000F0, + 0x1bb8, 0x20202020, + 0x1bbc, 0x20202020, + 0x1bc0, 0x20202020, + 0x1bc4, 0x20202020, + 0x1bc8, 0x04040404, + 0x1bcc, 0x04040404, + 0x1bd0, 0x04040404, + 0x1bd8, 0x04040404, + 0x1bdc, 0x20202020, + 0x1be0, 0x04040404, + 0x1be4, 0x77472F17, + 0x1be8, 0xEFBFA78F, + 0x1bec, 0x00000000, + 0x1bf0, 0x1F1F1939, + 0x1b04, 0x0000005B, + 0x1b08, 0xB000C000, + 0x1b5c, 0x0000005B, + 0x1b60, 0xB000C000, + 0x1bb4, 0x20000000, + 0x1b00, 0x00000008, + 0x1b80, 0x00000007, + 0x1b80, 0x00080005, + 0x1b80, 0x00080007, + 0x1b80, 0x80000015, + 0x1b80, 0x80000017, + 0x1b80, 0x09080025, + 0x1b80, 0x09080027, + 0x1b80, 0x0f020035, + 0x1b80, 0x0f020037, + 0x1b80, 0x00220045, + 0x1b80, 0x00220047, + 0x1b80, 0x00040055, + 0x1b80, 0x00040057, + 0x1b80, 0x05c00065, + 0x1b80, 0x05c00067, + 0x1b80, 0x00070075, + 0x1b80, 0x00070077, + 0x1b80, 0x64020085, + 0x1b80, 0x64020087, + 0x1b80, 0x00020095, + 0x1b80, 0x00020097, + 0x1b80, 0x000400a5, + 0x1b80, 0x000400a7, + 0x1b80, 0x4a0000b5, + 0x1b80, 0x4a0000b7, + 0x1b80, 0x4b0400c5, + 0x1b80, 0x4b0400c7, + 0x1b80, 0x860300d5, + 0x1b80, 0x860300d7, + 0x1b80, 0x400900e5, + 0x1b80, 0x400900e7, + 0x1b80, 0xe02700f5, + 0x1b80, 0xe02700f7, + 0x1b80, 0x4b050105, + 0x1b80, 0x4b050107, + 0x1b80, 0x87030115, + 0x1b80, 0x87030117, + 0x1b80, 0x400b0125, + 0x1b80, 0x400b0127, + 0x1b80, 0xe0270135, + 0x1b80, 0xe0270137, + 0x1b80, 0x4b060145, + 0x1b80, 0x4b060147, + 0x1b80, 0x88030155, + 0x1b80, 0x88030157, + 0x1b80, 0x400d0165, + 0x1b80, 0x400d0167, + 0x1b80, 0xe0270175, + 0x1b80, 0xe0270177, + 0x1b80, 0x4b000185, + 0x1b80, 0x4b000187, + 0x1b80, 0x00070195, + 0x1b80, 0x00070197, + 0x1b80, 0x4c0001a5, + 0x1b80, 0x4c0001a7, + 0x1b80, 0x000401b5, + 0x1b80, 0x000401b7, + 0x1b80, 0x400801c5, + 0x1b80, 0x400801c7, + 0x1b80, 0x505501d5, + 0x1b80, 0x505501d7, + 0x1b80, 0x090a01e5, + 0x1b80, 0x090a01e7, + 0x1b80, 0x0ffe01f5, + 0x1b80, 0x0ffe01f7, + 0x1b80, 0x00220205, + 0x1b80, 0x00220207, + 0x1b80, 0x00040215, + 0x1b80, 0x00040217, + 0x1b80, 0x05c00225, + 0x1b80, 0x05c00227, + 0x1b80, 0x00070235, + 0x1b80, 0x00070237, + 0x1b80, 0x64000245, + 0x1b80, 0x64000247, + 0x1b80, 0x00020255, + 0x1b80, 0x00020257, + 0x1b80, 0x30000265, + 0x1b80, 0x30000267, + 0x1b80, 0xa5110275, + 0x1b80, 0xa5110277, + 0x1b80, 0xe3ef0285, + 0x1b80, 0xe3ef0287, + 0x1b80, 0xf01f0295, + 0x1b80, 0xf01f0297, + 0x1b80, 0xf11f02a5, + 0x1b80, 0xf11f02a7, + 0x1b80, 0xf21f02b5, + 0x1b80, 0xf21f02b7, + 0x1b80, 0xf31f02c5, + 0x1b80, 0xf31f02c7, + 0x1b80, 0xf41f02d5, + 0x1b80, 0xf41f02d7, + 0x1b80, 0xf51f02e5, + 0x1b80, 0xf51f02e7, + 0x1b80, 0xf61f02f5, + 0x1b80, 0xf61f02f7, + 0x1b80, 0xf71f0305, + 0x1b80, 0xf71f0307, + 0x1b80, 0xf81f0315, + 0x1b80, 0xf81f0317, + 0x1b80, 0xf91f0325, + 0x1b80, 0xf91f0327, + 0x1b80, 0xfa1f0335, + 0x1b80, 0xfa1f0337, + 0x1b80, 0xfb1f0345, + 0x1b80, 0xfb1f0347, + 0x1b80, 0xfc1f0355, + 0x1b80, 0xfc1f0357, + 0x1b80, 0xfd1f0365, + 0x1b80, 0xfd1f0367, + 0x1b80, 0xfe1f0375, + 0x1b80, 0xfe1f0377, + 0x1b80, 0xf11f0385, + 0x1b80, 0xf11f0387, + 0x1b80, 0xf21f0395, + 0x1b80, 0xf21f0397, + 0x1b80, 0xf31f03a5, + 0x1b80, 0xf31f03a7, + 0x1b80, 0xf41f03b5, + 0x1b80, 0xf41f03b7, + 0x1b80, 0xf51f03c5, + 0x1b80, 0xf51f03c7, + 0x1b80, 0xf61f03d5, + 0x1b80, 0xf61f03d7, + 0x1b80, 0xf71f03e5, + 0x1b80, 0xf71f03e7, + 0x1b80, 0xf81f03f5, + 0x1b80, 0xf81f03f7, + 0x1b80, 0xf91f0405, + 0x1b80, 0xf91f0407, + 0x1b80, 0xfa1f0415, + 0x1b80, 0xfa1f0417, + 0x1b80, 0xfb1f0425, + 0x1b80, 0xfb1f0427, + 0x1b80, 0xfc1f0435, + 0x1b80, 0xfc1f0437, + 0x1b80, 0xfd1f0445, + 0x1b80, 0xfd1f0447, + 0x1b80, 0xfe1f0455, + 0x1b80, 0xfe1f0457, + 0x1b80, 0xff1f0465, + 0x1b80, 0xff1f0467, + 0x1b80, 0x00010475, + 0x1b80, 0x00010477, + 0x1b80, 0x30660485, + 0x1b80, 0x30660487, + 0x1b80, 0x307e0495, + 0x1b80, 0x307e0497, + 0x1b80, 0x308204a5, + 0x1b80, 0x308204a7, + 0x1b80, 0x310c04b5, + 0x1b80, 0x310c04b7, + 0x1b80, 0x308904c5, + 0x1b80, 0x308904c7, + 0x1b80, 0x309804d5, + 0x1b80, 0x309804d7, + 0x1b80, 0x30a704e5, + 0x1b80, 0x30a704e7, + 0x1b80, 0x308804f5, + 0x1b80, 0x308804f7, + 0x1b80, 0x30970505, + 0x1b80, 0x30970507, + 0x1b80, 0x30a60515, + 0x1b80, 0x30a60517, + 0x1b80, 0x31100525, + 0x1b80, 0x31100527, + 0x1b80, 0x311b0535, + 0x1b80, 0x311b0537, + 0x1b80, 0x31260545, + 0x1b80, 0x31260547, + 0x1b80, 0x31ae0555, + 0x1b80, 0x31ae0557, + 0x1b80, 0x318b0565, + 0x1b80, 0x318b0567, + 0x1b80, 0x31cb0575, + 0x1b80, 0x31cb0577, + 0x1b80, 0x307e0585, + 0x1b80, 0x307e0587, + 0x1b80, 0x310a0595, + 0x1b80, 0x310a0597, + 0x1b80, 0x31db05a5, + 0x1b80, 0x31db05a7, + 0x1b80, 0x31f405b5, + 0x1b80, 0x31f405b7, + 0x1b80, 0x320e05c5, + 0x1b80, 0x320e05c7, + 0x1b80, 0x321605d5, + 0x1b80, 0x321605d7, + 0x1b80, 0x321e05e5, + 0x1b80, 0x321e05e7, + 0x1b80, 0x322605f5, + 0x1b80, 0x322605f7, + 0x1b80, 0x322e0605, + 0x1b80, 0x322e0607, + 0x1b80, 0x323d0615, + 0x1b80, 0x323d0617, + 0x1b80, 0x324c0625, + 0x1b80, 0x324c0627, + 0x1b80, 0x32520635, + 0x1b80, 0x32520637, + 0x1b80, 0x32580645, + 0x1b80, 0x32580647, + 0x1b80, 0x325e0655, + 0x1b80, 0x325e0657, + 0x1b80, 0xe3880665, + 0x1b80, 0xe3880667, + 0x1b80, 0x4d040675, + 0x1b80, 0x4d040677, + 0x1b80, 0x20800685, + 0x1b80, 0x20800687, + 0x1b80, 0x00000695, + 0x1b80, 0x00000697, + 0x1b80, 0x4d0006a5, + 0x1b80, 0x4d0006a7, + 0x1b80, 0x550706b5, + 0x1b80, 0x550706b7, + 0x1b80, 0xe38006c5, + 0x1b80, 0xe38006c7, + 0x1b80, 0xe38006d5, + 0x1b80, 0xe38006d7, + 0x1b80, 0x4d0406e5, + 0x1b80, 0x4d0406e7, + 0x1b80, 0x208806f5, + 0x1b80, 0x208806f7, + 0x1b80, 0x02000705, + 0x1b80, 0x02000707, + 0x1b80, 0x4d000715, + 0x1b80, 0x4d000717, + 0x1b80, 0x550f0725, + 0x1b80, 0x550f0727, + 0x1b80, 0xe3800735, + 0x1b80, 0xe3800737, + 0x1b80, 0x4f020745, + 0x1b80, 0x4f020747, + 0x1b80, 0x4e000755, + 0x1b80, 0x4e000757, + 0x1b80, 0x53020765, + 0x1b80, 0x53020767, + 0x1b80, 0x52010775, + 0x1b80, 0x52010777, + 0x1b80, 0xe3840785, + 0x1b80, 0xe3840787, + 0x1b80, 0x4d080795, + 0x1b80, 0x4d080797, + 0x1b80, 0x571007a5, + 0x1b80, 0x571007a7, + 0x1b80, 0x570007b5, + 0x1b80, 0x570007b7, + 0x1b80, 0x4d0007c5, + 0x1b80, 0x4d0007c7, + 0x1b80, 0x000107d5, + 0x1b80, 0x000107d7, + 0x1b80, 0xe38807e5, + 0x1b80, 0xe38807e7, + 0x1b80, 0x0bbd07f5, + 0x1b80, 0x0bbd07f7, + 0x1b80, 0xe3e20805, + 0x1b80, 0xe3e20807, + 0x1b80, 0x00010815, + 0x1b80, 0x00010817, + 0x1b80, 0x62060825, + 0x1b80, 0x62060827, + 0x1b80, 0xe3880835, + 0x1b80, 0xe3880837, + 0x1b80, 0x0bbd0845, + 0x1b80, 0x0bbd0847, + 0x1b80, 0xe3e20855, + 0x1b80, 0xe3e20857, + 0x1b80, 0x00010865, + 0x1b80, 0x00010867, + 0x1b80, 0x00010875, + 0x1b80, 0x00010877, + 0x1b80, 0x62060885, + 0x1b80, 0x62060887, + 0x1b80, 0x30bc0895, + 0x1b80, 0x30bc0897, + 0x1b80, 0x002608a5, + 0x1b80, 0x002608a7, + 0x1b80, 0xe3e208b5, + 0x1b80, 0xe3e208b7, + 0x1b80, 0x000208c5, + 0x1b80, 0x000208c7, + 0x1b80, 0x54ec08d5, + 0x1b80, 0x54ec08d7, + 0x1b80, 0x0ba608e5, + 0x1b80, 0x0ba608e7, + 0x1b80, 0x002608f5, + 0x1b80, 0x002608f7, + 0x1b80, 0xe3e20905, + 0x1b80, 0xe3e20907, + 0x1b80, 0x00020915, + 0x1b80, 0x00020917, + 0x1b80, 0xf7f50925, + 0x1b80, 0xf7f50927, + 0x1b80, 0x00300935, + 0x1b80, 0x00300937, + 0x1b80, 0x63c30945, + 0x1b80, 0x63c30947, + 0x1b80, 0x00020955, + 0x1b80, 0x00020957, + 0x1b80, 0x318b0965, + 0x1b80, 0x318b0967, + 0x1b80, 0x62060975, + 0x1b80, 0x62060977, + 0x1b80, 0x30b40985, + 0x1b80, 0x30b40987, + 0x1b80, 0x00240995, + 0x1b80, 0x00240997, + 0x1b80, 0xe3e209a5, + 0x1b80, 0xe3e209a7, + 0x1b80, 0x000209b5, + 0x1b80, 0x000209b7, + 0x1b80, 0x54ea09c5, + 0x1b80, 0x54ea09c7, + 0x1b80, 0x0ba609d5, + 0x1b80, 0x0ba609d7, + 0x1b80, 0x002409e5, + 0x1b80, 0x002409e7, + 0x1b80, 0xe3e209f5, + 0x1b80, 0xe3e209f7, + 0x1b80, 0x00020a05, + 0x1b80, 0x00020a07, + 0x1b80, 0xf8e60a15, + 0x1b80, 0xf8e60a17, + 0x1b80, 0x00300a25, + 0x1b80, 0x00300a27, + 0x1b80, 0x63c30a35, + 0x1b80, 0x63c30a37, + 0x1b80, 0x00020a45, + 0x1b80, 0x00020a47, + 0x1b80, 0x318b0a55, + 0x1b80, 0x318b0a57, + 0x1b80, 0x62060a65, + 0x1b80, 0x62060a67, + 0x1b80, 0x6c100a75, + 0x1b80, 0x6c100a77, + 0x1b80, 0x6d0f0a85, + 0x1b80, 0x6d0f0a87, + 0x1b80, 0xe3880a95, + 0x1b80, 0xe3880a97, + 0x1b80, 0xe3e20aa5, + 0x1b80, 0xe3e20aa7, + 0x1b80, 0x6c240ab5, + 0x1b80, 0x6c240ab7, + 0x1b80, 0xe3880ac5, + 0x1b80, 0xe3880ac7, + 0x1b80, 0xe3e20ad5, + 0x1b80, 0xe3e20ad7, + 0x1b80, 0x6c440ae5, + 0x1b80, 0x6c440ae7, + 0x1b80, 0xe3880af5, + 0x1b80, 0xe3880af7, + 0x1b80, 0xe3e20b05, + 0x1b80, 0xe3e20b07, + 0x1b80, 0x6c640b15, + 0x1b80, 0x6c640b17, + 0x1b80, 0xe3880b25, + 0x1b80, 0xe3880b27, + 0x1b80, 0xe3e20b35, + 0x1b80, 0xe3e20b37, + 0x1b80, 0x0baa0b45, + 0x1b80, 0x0baa0b47, + 0x1b80, 0x6c840b55, + 0x1b80, 0x6c840b57, + 0x1b80, 0x6d0f0b65, + 0x1b80, 0x6d0f0b67, + 0x1b80, 0xe3880b75, + 0x1b80, 0xe3880b77, + 0x1b80, 0xe3e20b85, + 0x1b80, 0xe3e20b87, + 0x1b80, 0x6ca40b95, + 0x1b80, 0x6ca40b97, + 0x1b80, 0xe3880ba5, + 0x1b80, 0xe3880ba7, + 0x1b80, 0xe3e20bb5, + 0x1b80, 0xe3e20bb7, + 0x1b80, 0x0bac0bc5, + 0x1b80, 0x0bac0bc7, + 0x1b80, 0x6cc40bd5, + 0x1b80, 0x6cc40bd7, + 0x1b80, 0x6d0f0be5, + 0x1b80, 0x6d0f0be7, + 0x1b80, 0xe3880bf5, + 0x1b80, 0xe3880bf7, + 0x1b80, 0xe3e20c05, + 0x1b80, 0xe3e20c07, + 0x1b80, 0x6ce40c15, + 0x1b80, 0x6ce40c17, + 0x1b80, 0xe3880c25, + 0x1b80, 0xe3880c27, + 0x1b80, 0xe3e20c35, + 0x1b80, 0xe3e20c37, + 0x1b80, 0x6cf40c45, + 0x1b80, 0x6cf40c47, + 0x1b80, 0xe3880c55, + 0x1b80, 0xe3880c57, + 0x1b80, 0xe3e20c65, + 0x1b80, 0xe3e20c67, + 0x1b80, 0x6c0c0c75, + 0x1b80, 0x6c0c0c77, + 0x1b80, 0x6d000c85, + 0x1b80, 0x6d000c87, + 0x1b80, 0xe3880c95, + 0x1b80, 0xe3880c97, + 0x1b80, 0xe3e20ca5, + 0x1b80, 0xe3e20ca7, + 0x1b80, 0x6c1c0cb5, + 0x1b80, 0x6c1c0cb7, + 0x1b80, 0xe3880cc5, + 0x1b80, 0xe3880cc7, + 0x1b80, 0xe3e20cd5, + 0x1b80, 0xe3e20cd7, + 0x1b80, 0x6c3c0ce5, + 0x1b80, 0x6c3c0ce7, + 0x1b80, 0xe3880cf5, + 0x1b80, 0xe3880cf7, + 0x1b80, 0xe3e20d05, + 0x1b80, 0xe3e20d07, + 0x1b80, 0xf4b90d15, + 0x1b80, 0xf4b90d17, + 0x1b80, 0xf7b80d25, + 0x1b80, 0xf7b80d27, + 0x1b80, 0x6c5c0d35, + 0x1b80, 0x6c5c0d37, + 0x1b80, 0xe3880d45, + 0x1b80, 0xe3880d47, + 0x1b80, 0xe3e20d55, + 0x1b80, 0xe3e20d57, + 0x1b80, 0x6c7c0d65, + 0x1b80, 0x6c7c0d67, + 0x1b80, 0xe3880d75, + 0x1b80, 0xe3880d77, + 0x1b80, 0xe3e20d85, + 0x1b80, 0xe3e20d87, + 0x1b80, 0xf5c00d95, + 0x1b80, 0xf5c00d97, + 0x1b80, 0xf8bf0da5, + 0x1b80, 0xf8bf0da7, + 0x1b80, 0x6c9c0db5, + 0x1b80, 0x6c9c0db7, + 0x1b80, 0xe3880dc5, + 0x1b80, 0xe3880dc7, + 0x1b80, 0xe3e20dd5, + 0x1b80, 0xe3e20dd7, + 0x1b80, 0x6cbc0de5, + 0x1b80, 0x6cbc0de7, + 0x1b80, 0xe3880df5, + 0x1b80, 0xe3880df7, + 0x1b80, 0xe3e20e05, + 0x1b80, 0xe3e20e07, + 0x1b80, 0x6cdc0e15, + 0x1b80, 0x6cdc0e17, + 0x1b80, 0xe3880e25, + 0x1b80, 0xe3880e27, + 0x1b80, 0xe3e20e35, + 0x1b80, 0xe3e20e37, + 0x1b80, 0x6cf00e45, + 0x1b80, 0x6cf00e47, + 0x1b80, 0xe3880e55, + 0x1b80, 0xe3880e57, + 0x1b80, 0xe3e20e65, + 0x1b80, 0xe3e20e67, + 0x1b80, 0xf9a00e75, + 0x1b80, 0xf9a00e77, + 0x1b80, 0x00300e85, + 0x1b80, 0x00300e87, + 0x1b80, 0x63c30e95, + 0x1b80, 0x63c30e97, + 0x1b80, 0x00020ea5, + 0x1b80, 0x00020ea7, + 0x1b80, 0x318b0eb5, + 0x1b80, 0x318b0eb7, + 0x1b80, 0x00300ec5, + 0x1b80, 0x00300ec7, + 0x1b80, 0x00000ed5, + 0x1b80, 0x00000ed7, + 0x1b80, 0x00020ee5, + 0x1b80, 0x00020ee7, + 0x1b80, 0x55010ef5, + 0x1b80, 0x55010ef7, + 0x1b80, 0x57040f05, + 0x1b80, 0x57040f07, + 0x1b80, 0x57000f15, + 0x1b80, 0x57000f17, + 0x1b80, 0x96000f25, + 0x1b80, 0x96000f27, + 0x1b80, 0x00070f35, + 0x1b80, 0x00070f37, + 0x1b80, 0x5be00f45, + 0x1b80, 0x5be00f47, + 0x1b80, 0x5a000f55, + 0x1b80, 0x5a000f57, + 0x1b80, 0x59000f65, + 0x1b80, 0x59000f67, + 0x1b80, 0x58000f75, + 0x1b80, 0x58000f77, + 0x1b80, 0x00040f85, + 0x1b80, 0x00040f87, + 0x1b80, 0x57080f95, + 0x1b80, 0x57080f97, + 0x1b80, 0x57000fa5, + 0x1b80, 0x57000fa7, + 0x1b80, 0x95000fb5, + 0x1b80, 0x95000fb7, + 0x1b80, 0x00070fc5, + 0x1b80, 0x00070fc7, + 0x1b80, 0x58010fd5, + 0x1b80, 0x58010fd7, + 0x1b80, 0x00040fe5, + 0x1b80, 0x00040fe7, + 0x1b80, 0x00300ff5, + 0x1b80, 0x00300ff7, + 0x1b80, 0x00001005, + 0x1b80, 0x00001007, + 0x1b80, 0x00021015, + 0x1b80, 0x00021017, + 0x1b80, 0x63051025, + 0x1b80, 0x63051027, + 0x1b80, 0x7b401035, + 0x1b80, 0x7b401037, + 0x1b80, 0x7a001045, + 0x1b80, 0x7a001047, + 0x1b80, 0x79001055, + 0x1b80, 0x79001057, + 0x1b80, 0x7f401065, + 0x1b80, 0x7f401067, + 0x1b80, 0x7e001075, + 0x1b80, 0x7e001077, + 0x1b80, 0x7d001085, + 0x1b80, 0x7d001087, + 0x1b80, 0x00011095, + 0x1b80, 0x00011097, + 0x1b80, 0xe3b410a5, + 0x1b80, 0xe3b410a7, + 0x1b80, 0x000110b5, + 0x1b80, 0x000110b7, + 0x1b80, 0x5c3210c5, + 0x1b80, 0x5c3210c7, + 0x1b80, 0x54fd10d5, + 0x1b80, 0x54fd10d7, + 0x1b80, 0xe3b410e5, + 0x1b80, 0xe3b410e7, + 0x1b80, 0x000110f5, + 0x1b80, 0x000110f7, + 0x1b80, 0x31471105, + 0x1b80, 0x31471107, + 0x1b80, 0x00261115, + 0x1b80, 0x00261117, + 0x1b80, 0xe3e71125, + 0x1b80, 0xe3e71127, + 0x1b80, 0x00021135, + 0x1b80, 0x00021137, + 0x1b80, 0x54ec1145, + 0x1b80, 0x54ec1147, + 0x1b80, 0x0ba61155, + 0x1b80, 0x0ba61157, + 0x1b80, 0x00261165, + 0x1b80, 0x00261167, + 0x1b80, 0xe3e71175, + 0x1b80, 0xe3e71177, + 0x1b80, 0x00021185, + 0x1b80, 0x00021187, + 0x1b80, 0x63431195, + 0x1b80, 0x63431197, + 0x1b80, 0x30ec11a5, + 0x1b80, 0x30ec11a7, + 0x1b80, 0x313b11b5, + 0x1b80, 0x313b11b7, + 0x1b80, 0x002411c5, + 0x1b80, 0x002411c7, + 0x1b80, 0xe3e711d5, + 0x1b80, 0xe3e711d7, + 0x1b80, 0x000211e5, + 0x1b80, 0x000211e7, + 0x1b80, 0x54ea11f5, + 0x1b80, 0x54ea11f7, + 0x1b80, 0x0ba61205, + 0x1b80, 0x0ba61207, + 0x1b80, 0x00241215, + 0x1b80, 0x00241217, + 0x1b80, 0xe3e71225, + 0x1b80, 0xe3e71227, + 0x1b80, 0x00021235, + 0x1b80, 0x00021237, + 0x1b80, 0x63431245, + 0x1b80, 0x63431247, + 0x1b80, 0x30ec1255, + 0x1b80, 0x30ec1257, + 0x1b80, 0x5c321265, + 0x1b80, 0x5c321267, + 0x1b80, 0x54e61275, + 0x1b80, 0x54e61277, + 0x1b80, 0x6e101285, + 0x1b80, 0x6e101287, + 0x1b80, 0x6f0f1295, + 0x1b80, 0x6f0f1297, + 0x1b80, 0xe3b412a5, + 0x1b80, 0xe3b412a7, + 0x1b80, 0xe3e712b5, + 0x1b80, 0xe3e712b7, + 0x1b80, 0x5c3212c5, + 0x1b80, 0x5c3212c7, + 0x1b80, 0x54e712d5, + 0x1b80, 0x54e712d7, + 0x1b80, 0x6e2412e5, + 0x1b80, 0x6e2412e7, + 0x1b80, 0xe3b412f5, + 0x1b80, 0xe3b412f7, + 0x1b80, 0xe3e71305, + 0x1b80, 0xe3e71307, + 0x1b80, 0x5c321315, + 0x1b80, 0x5c321317, + 0x1b80, 0x54e81325, + 0x1b80, 0x54e81327, + 0x1b80, 0x6e441335, + 0x1b80, 0x6e441337, + 0x1b80, 0xe3b41345, + 0x1b80, 0xe3b41347, + 0x1b80, 0xe3e71355, + 0x1b80, 0xe3e71357, + 0x1b80, 0x5c321365, + 0x1b80, 0x5c321367, + 0x1b80, 0x54e91375, + 0x1b80, 0x54e91377, + 0x1b80, 0x6e641385, + 0x1b80, 0x6e641387, + 0x1b80, 0xe3b41395, + 0x1b80, 0xe3b41397, + 0x1b80, 0xe3e713a5, + 0x1b80, 0xe3e713a7, + 0x1b80, 0x5c3213b5, + 0x1b80, 0x5c3213b7, + 0x1b80, 0x54ea13c5, + 0x1b80, 0x54ea13c7, + 0x1b80, 0x0baa13d5, + 0x1b80, 0x0baa13d7, + 0x1b80, 0x6e8413e5, + 0x1b80, 0x6e8413e7, + 0x1b80, 0x6f0f13f5, + 0x1b80, 0x6f0f13f7, + 0x1b80, 0xe3b41405, + 0x1b80, 0xe3b41407, + 0x1b80, 0xe3e71415, + 0x1b80, 0xe3e71417, + 0x1b80, 0x5c321425, + 0x1b80, 0x5c321427, + 0x1b80, 0x54eb1435, + 0x1b80, 0x54eb1437, + 0x1b80, 0x6ea41445, + 0x1b80, 0x6ea41447, + 0x1b80, 0xe3b41455, + 0x1b80, 0xe3b41457, + 0x1b80, 0xe3e71465, + 0x1b80, 0xe3e71467, + 0x1b80, 0x5c321475, + 0x1b80, 0x5c321477, + 0x1b80, 0x54ec1485, + 0x1b80, 0x54ec1487, + 0x1b80, 0x0bac1495, + 0x1b80, 0x0bac1497, + 0x1b80, 0x6ec414a5, + 0x1b80, 0x6ec414a7, + 0x1b80, 0x6f0f14b5, + 0x1b80, 0x6f0f14b7, + 0x1b80, 0xe3b414c5, + 0x1b80, 0xe3b414c7, + 0x1b80, 0xe3e714d5, + 0x1b80, 0xe3e714d7, + 0x1b80, 0x5c3214e5, + 0x1b80, 0x5c3214e7, + 0x1b80, 0x54ed14f5, + 0x1b80, 0x54ed14f7, + 0x1b80, 0x6ee41505, + 0x1b80, 0x6ee41507, + 0x1b80, 0xe3b41515, + 0x1b80, 0xe3b41517, + 0x1b80, 0xe3e71525, + 0x1b80, 0xe3e71527, + 0x1b80, 0x5c321535, + 0x1b80, 0x5c321537, + 0x1b80, 0x54ee1545, + 0x1b80, 0x54ee1547, + 0x1b80, 0x6ef41555, + 0x1b80, 0x6ef41557, + 0x1b80, 0xe3b41565, + 0x1b80, 0xe3b41567, + 0x1b80, 0xe3e71575, + 0x1b80, 0xe3e71577, + 0x1b80, 0x5c321585, + 0x1b80, 0x5c321587, + 0x1b80, 0x54ef1595, + 0x1b80, 0x54ef1597, + 0x1b80, 0x6e0c15a5, + 0x1b80, 0x6e0c15a7, + 0x1b80, 0x6f0015b5, + 0x1b80, 0x6f0015b7, + 0x1b80, 0xe3b415c5, + 0x1b80, 0xe3b415c7, + 0x1b80, 0xe3e715d5, + 0x1b80, 0xe3e715d7, + 0x1b80, 0x5c3215e5, + 0x1b80, 0x5c3215e7, + 0x1b80, 0x54f015f5, + 0x1b80, 0x54f015f7, + 0x1b80, 0x6e1c1605, + 0x1b80, 0x6e1c1607, + 0x1b80, 0xe3b41615, + 0x1b80, 0xe3b41617, + 0x1b80, 0xe3e71625, + 0x1b80, 0xe3e71627, + 0x1b80, 0x5c321635, + 0x1b80, 0x5c321637, + 0x1b80, 0x54f11645, + 0x1b80, 0x54f11647, + 0x1b80, 0x6e3c1655, + 0x1b80, 0x6e3c1657, + 0x1b80, 0xe3b41665, + 0x1b80, 0xe3b41667, + 0x1b80, 0xe3e71675, + 0x1b80, 0xe3e71677, + 0x1b80, 0xfaa91685, + 0x1b80, 0xfaa91687, + 0x1b80, 0x5c321695, + 0x1b80, 0x5c321697, + 0x1b80, 0x54f216a5, + 0x1b80, 0x54f216a7, + 0x1b80, 0x6e5c16b5, + 0x1b80, 0x6e5c16b7, + 0x1b80, 0xe3b416c5, + 0x1b80, 0xe3b416c7, + 0x1b80, 0xe3e716d5, + 0x1b80, 0xe3e716d7, + 0x1b80, 0x5c3216e5, + 0x1b80, 0x5c3216e7, + 0x1b80, 0x54f316f5, + 0x1b80, 0x54f316f7, + 0x1b80, 0x6e7c1705, + 0x1b80, 0x6e7c1707, + 0x1b80, 0xe3b41715, + 0x1b80, 0xe3b41717, + 0x1b80, 0xe3e71725, + 0x1b80, 0xe3e71727, + 0x1b80, 0xfba91735, + 0x1b80, 0xfba91737, + 0x1b80, 0x5c321745, + 0x1b80, 0x5c321747, + 0x1b80, 0x54f41755, + 0x1b80, 0x54f41757, + 0x1b80, 0x6e9c1765, + 0x1b80, 0x6e9c1767, + 0x1b80, 0xe3b41775, + 0x1b80, 0xe3b41777, + 0x1b80, 0xe3e71785, + 0x1b80, 0xe3e71787, + 0x1b80, 0x5c321795, + 0x1b80, 0x5c321797, + 0x1b80, 0x54f517a5, + 0x1b80, 0x54f517a7, + 0x1b80, 0x6ebc17b5, + 0x1b80, 0x6ebc17b7, + 0x1b80, 0xe3b417c5, + 0x1b80, 0xe3b417c7, + 0x1b80, 0xe3e717d5, + 0x1b80, 0xe3e717d7, + 0x1b80, 0x5c3217e5, + 0x1b80, 0x5c3217e7, + 0x1b80, 0x54f617f5, + 0x1b80, 0x54f617f7, + 0x1b80, 0x6edc1805, + 0x1b80, 0x6edc1807, + 0x1b80, 0xe3b41815, + 0x1b80, 0xe3b41817, + 0x1b80, 0xe3e71825, + 0x1b80, 0xe3e71827, + 0x1b80, 0x5c321835, + 0x1b80, 0x5c321837, + 0x1b80, 0x54f71845, + 0x1b80, 0x54f71847, + 0x1b80, 0x6ef01855, + 0x1b80, 0x6ef01857, + 0x1b80, 0xe3b41865, + 0x1b80, 0xe3b41867, + 0x1b80, 0xe3e71875, + 0x1b80, 0xe3e71877, + 0x1b80, 0x63431885, + 0x1b80, 0x63431887, + 0x1b80, 0x30ec1895, + 0x1b80, 0x30ec1897, + 0x1b80, 0x000118a5, + 0x1b80, 0x000118a7, + 0x1b80, 0x63c318b5, + 0x1b80, 0x63c318b7, + 0x1b80, 0x003018c5, + 0x1b80, 0x003018c7, + 0x1b80, 0x000018d5, + 0x1b80, 0x000018d7, + 0x1b80, 0x000218e5, + 0x1b80, 0x000218e7, + 0x1b80, 0x550118f5, + 0x1b80, 0x550118f7, + 0x1b80, 0x57041905, + 0x1b80, 0x57041907, + 0x1b80, 0x57001915, + 0x1b80, 0x57001917, + 0x1b80, 0x96001925, + 0x1b80, 0x96001927, + 0x1b80, 0x00301935, + 0x1b80, 0x00301937, + 0x1b80, 0x00071945, + 0x1b80, 0x00071947, + 0x1b80, 0x5be01955, + 0x1b80, 0x5be01957, + 0x1b80, 0x5a001965, + 0x1b80, 0x5a001967, + 0x1b80, 0x59001975, + 0x1b80, 0x59001977, + 0x1b80, 0x58001985, + 0x1b80, 0x58001987, + 0x1b80, 0x00041995, + 0x1b80, 0x00041997, + 0x1b80, 0x000219a5, + 0x1b80, 0x000219a7, + 0x1b80, 0x570819b5, + 0x1b80, 0x570819b7, + 0x1b80, 0x570019c5, + 0x1b80, 0x570019c7, + 0x1b80, 0x950019d5, + 0x1b80, 0x950019d7, + 0x1b80, 0x003019e5, + 0x1b80, 0x003019e7, + 0x1b80, 0x000719f5, + 0x1b80, 0x000719f7, + 0x1b80, 0x58011a05, + 0x1b80, 0x58011a07, + 0x1b80, 0x00041a15, + 0x1b80, 0x00041a17, + 0x1b80, 0x00021a25, + 0x1b80, 0x00021a27, + 0x1b80, 0x00301a35, + 0x1b80, 0x00301a37, + 0x1b80, 0x00001a45, + 0x1b80, 0x00001a47, + 0x1b80, 0x00021a55, + 0x1b80, 0x00021a57, + 0x1b80, 0x63051a65, + 0x1b80, 0x63051a67, + 0x1b80, 0x7b401a75, + 0x1b80, 0x7b401a77, + 0x1b80, 0x7a001a85, + 0x1b80, 0x7a001a87, + 0x1b80, 0x79001a95, + 0x1b80, 0x79001a97, + 0x1b80, 0x7f401aa5, + 0x1b80, 0x7f401aa7, + 0x1b80, 0x7e001ab5, + 0x1b80, 0x7e001ab7, + 0x1b80, 0x7d001ac5, + 0x1b80, 0x7d001ac7, + 0x1b80, 0x00011ad5, + 0x1b80, 0x00011ad7, + 0x1b80, 0x00041ae5, + 0x1b80, 0x00041ae7, + 0x1b80, 0x55011af5, + 0x1b80, 0x55011af7, + 0x1b80, 0x5c311b05, + 0x1b80, 0x5c311b07, + 0x1b80, 0x5f821b15, + 0x1b80, 0x5f821b17, + 0x1b80, 0x66051b25, + 0x1b80, 0x66051b27, + 0x1b80, 0x00061b35, + 0x1b80, 0x00061b37, + 0x1b80, 0x5d801b45, + 0x1b80, 0x5d801b47, + 0x1b80, 0x09001b55, + 0x1b80, 0x09001b57, + 0x1b80, 0x0a011b65, + 0x1b80, 0x0a011b67, + 0x1b80, 0x0b401b75, + 0x1b80, 0x0b401b77, + 0x1b80, 0x0d001b85, + 0x1b80, 0x0d001b87, + 0x1b80, 0x0f011b95, + 0x1b80, 0x0f011b97, + 0x1b80, 0x002a1ba5, + 0x1b80, 0x002a1ba7, + 0x1b80, 0x055a1bb5, + 0x1b80, 0x055a1bb7, + 0x1b80, 0x05db1bc5, + 0x1b80, 0x05db1bc7, + 0x1b80, 0xe3d21bd5, + 0x1b80, 0xe3d21bd7, + 0x1b80, 0xe3801be5, + 0x1b80, 0xe3801be7, + 0x1b80, 0x00061bf5, + 0x1b80, 0x00061bf7, + 0x1b80, 0x06da1c05, + 0x1b80, 0x06da1c07, + 0x1b80, 0x07db1c15, + 0x1b80, 0x07db1c17, + 0x1b80, 0xe3d21c25, + 0x1b80, 0xe3d21c27, + 0x1b80, 0xe3801c35, + 0x1b80, 0xe3801c37, + 0x1b80, 0xe3c91c45, + 0x1b80, 0xe3c91c47, + 0x1b80, 0x00021c55, + 0x1b80, 0x00021c57, + 0x1b80, 0xe3ce1c65, + 0x1b80, 0xe3ce1c67, + 0x1b80, 0x5d001c75, + 0x1b80, 0x5d001c77, + 0x1b80, 0x00041c85, + 0x1b80, 0x00041c87, + 0x1b80, 0x5fa21c95, + 0x1b80, 0x5fa21c97, + 0x1b80, 0x00011ca5, + 0x1b80, 0x00011ca7, + 0x1b80, 0x00041cb5, + 0x1b80, 0x00041cb7, + 0x1b80, 0xe2711cc5, + 0x1b80, 0xe2711cc7, + 0x1b80, 0xe2821cd5, + 0x1b80, 0xe2821cd7, + 0x1b80, 0xe28b1ce5, + 0x1b80, 0xe28b1ce7, + 0x1b80, 0xe29c1cf5, + 0x1b80, 0xe29c1cf7, + 0x1b80, 0x00051d05, + 0x1b80, 0x00051d07, + 0x1b80, 0xe2641d15, + 0x1b80, 0xe2641d17, + 0x1b80, 0xe2711d25, + 0x1b80, 0xe2711d27, + 0x1b80, 0xe28b1d35, + 0x1b80, 0xe28b1d37, + 0x1b80, 0xe29c1d45, + 0x1b80, 0xe29c1d47, + 0x1b80, 0x00061d55, + 0x1b80, 0x00061d57, + 0x1b80, 0xe2641d65, + 0x1b80, 0xe2641d67, + 0x1b80, 0xe2711d75, + 0x1b80, 0xe2711d77, + 0x1b80, 0xe2821d85, + 0x1b80, 0xe2821d87, + 0x1b80, 0xe28b1d95, + 0x1b80, 0xe28b1d97, + 0x1b80, 0x00011da5, + 0x1b80, 0x00011da7, + 0x1b80, 0xe2f41db5, + 0x1b80, 0xe2f41db7, + 0x1b80, 0x74081dc5, + 0x1b80, 0x74081dc7, + 0x1b80, 0xe33e1dd5, + 0x1b80, 0xe33e1dd7, + 0x1b80, 0xe3201de5, + 0x1b80, 0xe3201de7, + 0x1b80, 0xe35e1df5, + 0x1b80, 0xe35e1df7, + 0x1b80, 0xb9001e05, + 0x1b80, 0xb9001e07, + 0x1b80, 0x99001e15, + 0x1b80, 0x99001e17, + 0x1b80, 0x00061e25, + 0x1b80, 0x00061e27, + 0x1b80, 0x77001e35, + 0x1b80, 0x77001e37, + 0x1b80, 0x00041e45, + 0x1b80, 0x00041e47, + 0x1b80, 0x49041e55, + 0x1b80, 0x49041e57, + 0x1b80, 0x4bb01e65, + 0x1b80, 0x4bb01e67, + 0x1b80, 0x00061e75, + 0x1b80, 0x00061e77, + 0x1b80, 0x75041e85, + 0x1b80, 0x75041e87, + 0x1b80, 0x77081e95, + 0x1b80, 0x77081e97, + 0x1b80, 0x00071ea5, + 0x1b80, 0x00071ea7, + 0x1b80, 0x77101eb5, + 0x1b80, 0x77101eb7, + 0x1b80, 0x00041ec5, + 0x1b80, 0x00041ec7, + 0x1b80, 0x44801ed5, + 0x1b80, 0x44801ed7, + 0x1b80, 0x45ff1ee5, + 0x1b80, 0x45ff1ee7, + 0x1b80, 0x463f1ef5, + 0x1b80, 0x463f1ef7, + 0x1b80, 0x47311f05, + 0x1b80, 0x47311f07, + 0x1b80, 0x40081f15, + 0x1b80, 0x40081f17, + 0x1b80, 0xe2db1f25, + 0x1b80, 0xe2db1f27, + 0x1b80, 0x00011f35, + 0x1b80, 0x00011f37, + 0x1b80, 0xe2f41f45, + 0x1b80, 0xe2f41f47, + 0x1b80, 0x74081f55, + 0x1b80, 0x74081f57, + 0x1b80, 0xe34e1f65, + 0x1b80, 0xe34e1f67, + 0x1b80, 0xe3201f75, + 0x1b80, 0xe3201f77, + 0x1b80, 0xe3641f85, + 0x1b80, 0xe3641f87, + 0x1b80, 0xb9001f95, + 0x1b80, 0xb9001f97, + 0x1b80, 0x99001fa5, + 0x1b80, 0x99001fa7, + 0x1b80, 0x00061fb5, + 0x1b80, 0x00061fb7, + 0x1b80, 0x77001fc5, + 0x1b80, 0x77001fc7, + 0x1b80, 0x00051fd5, + 0x1b80, 0x00051fd7, + 0x1b80, 0x61041fe5, + 0x1b80, 0x61041fe7, + 0x1b80, 0x63b01ff5, + 0x1b80, 0x63b01ff7, + 0x1b80, 0x00062005, + 0x1b80, 0x00062007, + 0x1b80, 0x75082015, + 0x1b80, 0x75082017, + 0x1b80, 0x77082025, + 0x1b80, 0x77082027, + 0x1b80, 0x00072035, + 0x1b80, 0x00072037, + 0x1b80, 0x77202045, + 0x1b80, 0x77202047, + 0x1b80, 0x00052055, + 0x1b80, 0x00052057, + 0x1b80, 0x5c802065, + 0x1b80, 0x5c802067, + 0x1b80, 0x5dff2075, + 0x1b80, 0x5dff2077, + 0x1b80, 0x5e3f2085, + 0x1b80, 0x5e3f2087, + 0x1b80, 0x5f312095, + 0x1b80, 0x5f312097, + 0x1b80, 0x000420a5, + 0x1b80, 0x000420a7, + 0x1b80, 0x400a20b5, + 0x1b80, 0x400a20b7, + 0x1b80, 0xe2db20c5, + 0x1b80, 0xe2db20c7, + 0x1b80, 0x000120d5, + 0x1b80, 0x000120d7, + 0x1b80, 0xe2f420e5, + 0x1b80, 0xe2f420e7, + 0x1b80, 0x740820f5, + 0x1b80, 0x740820f7, + 0x1b80, 0xe33e2105, + 0x1b80, 0xe33e2107, + 0x1b80, 0xe3202115, + 0x1b80, 0xe3202117, + 0x1b80, 0xe35e2125, + 0x1b80, 0xe35e2127, + 0x1b80, 0xe36a2135, + 0x1b80, 0xe36a2137, + 0x1b80, 0xe2ad2145, + 0x1b80, 0xe2ad2147, + 0x1b80, 0x00012155, + 0x1b80, 0x00012157, + 0x1b80, 0xe2f42165, + 0x1b80, 0xe2f42167, + 0x1b80, 0x74082175, + 0x1b80, 0x74082177, + 0x1b80, 0xe34e2185, + 0x1b80, 0xe34e2187, + 0x1b80, 0xe3202195, + 0x1b80, 0xe3202197, + 0x1b80, 0xe36421a5, + 0x1b80, 0xe36421a7, + 0x1b80, 0xe36a21b5, + 0x1b80, 0xe36a21b7, + 0x1b80, 0xe2c321c5, + 0x1b80, 0xe2c321c7, + 0x1b80, 0x000121d5, + 0x1b80, 0x000121d7, + 0x1b80, 0xe30a21e5, + 0x1b80, 0xe30a21e7, + 0x1b80, 0x740021f5, + 0x1b80, 0x740021f7, + 0x1b80, 0xe33e2205, + 0x1b80, 0xe33e2207, + 0x1b80, 0xe32f2215, + 0x1b80, 0xe32f2217, + 0x1b80, 0xe35e2225, + 0x1b80, 0xe35e2227, + 0x1b80, 0xe36a2235, + 0x1b80, 0xe36a2237, + 0x1b80, 0xe2ad2245, + 0x1b80, 0xe2ad2247, + 0x1b80, 0x00012255, + 0x1b80, 0x00012257, + 0x1b80, 0xe30a2265, + 0x1b80, 0xe30a2267, + 0x1b80, 0x74002275, + 0x1b80, 0x74002277, + 0x1b80, 0xe34e2285, + 0x1b80, 0xe34e2287, + 0x1b80, 0xe32f2295, + 0x1b80, 0xe32f2297, + 0x1b80, 0xe36422a5, + 0x1b80, 0xe36422a7, + 0x1b80, 0xe36a22b5, + 0x1b80, 0xe36a22b7, + 0x1b80, 0xe2c322c5, + 0x1b80, 0xe2c322c7, + 0x1b80, 0x000122d5, + 0x1b80, 0x000122d7, + 0x1b80, 0x000422e5, + 0x1b80, 0x000422e7, + 0x1b80, 0x445b22f5, + 0x1b80, 0x445b22f7, + 0x1b80, 0x47b02305, + 0x1b80, 0x47b02307, + 0x1b80, 0x47302315, + 0x1b80, 0x47302317, + 0x1b80, 0x47002325, + 0x1b80, 0x47002327, + 0x1b80, 0x00062335, + 0x1b80, 0x00062337, + 0x1b80, 0x77082345, + 0x1b80, 0x77082347, + 0x1b80, 0x00042355, + 0x1b80, 0x00042357, + 0x1b80, 0x49402365, + 0x1b80, 0x49402367, + 0x1b80, 0x4bb02375, + 0x1b80, 0x4bb02377, + 0x1b80, 0x00072385, + 0x1b80, 0x00072387, + 0x1b80, 0x54402395, + 0x1b80, 0x54402397, + 0x1b80, 0x000423a5, + 0x1b80, 0x000423a7, + 0x1b80, 0x400823b5, + 0x1b80, 0x400823b7, + 0x1b80, 0x000123c5, + 0x1b80, 0x000123c7, + 0x1b80, 0x000523d5, + 0x1b80, 0x000523d7, + 0x1b80, 0x5c5b23e5, + 0x1b80, 0x5c5b23e7, + 0x1b80, 0x5fb023f5, + 0x1b80, 0x5fb023f7, + 0x1b80, 0x5f302405, + 0x1b80, 0x5f302407, + 0x1b80, 0x5f002415, + 0x1b80, 0x5f002417, + 0x1b80, 0x00062425, + 0x1b80, 0x00062427, + 0x1b80, 0x77082435, + 0x1b80, 0x77082437, + 0x1b80, 0x00052445, + 0x1b80, 0x00052447, + 0x1b80, 0x61402455, + 0x1b80, 0x61402457, + 0x1b80, 0x63b02465, + 0x1b80, 0x63b02467, + 0x1b80, 0x00072475, + 0x1b80, 0x00072477, + 0x1b80, 0x54402485, + 0x1b80, 0x54402487, + 0x1b80, 0x00042495, + 0x1b80, 0x00042497, + 0x1b80, 0x400824a5, + 0x1b80, 0x400824a7, + 0x1b80, 0x000124b5, + 0x1b80, 0x000124b7, + 0x1b80, 0xe2f424c5, + 0x1b80, 0xe2f424c7, + 0x1b80, 0x740824d5, + 0x1b80, 0x740824d7, + 0x1b80, 0xe33e24e5, + 0x1b80, 0xe33e24e7, + 0x1b80, 0x000424f5, + 0x1b80, 0x000424f7, + 0x1b80, 0x40082505, + 0x1b80, 0x40082507, + 0x1b80, 0x00012515, + 0x1b80, 0x00012517, + 0x1b80, 0xe2f42525, + 0x1b80, 0xe2f42527, + 0x1b80, 0x74082535, + 0x1b80, 0x74082537, + 0x1b80, 0xe34e2545, + 0x1b80, 0xe34e2547, + 0x1b80, 0x00042555, + 0x1b80, 0x00042557, + 0x1b80, 0x40082565, + 0x1b80, 0x40082567, + 0x1b80, 0x00012575, + 0x1b80, 0x00012577, + 0x1b80, 0xe30a2585, + 0x1b80, 0xe30a2587, + 0x1b80, 0x74002595, + 0x1b80, 0x74002597, + 0x1b80, 0xe33e25a5, + 0x1b80, 0xe33e25a7, + 0x1b80, 0x000425b5, + 0x1b80, 0x000425b7, + 0x1b80, 0x400825c5, + 0x1b80, 0x400825c7, + 0x1b80, 0x000125d5, + 0x1b80, 0x000125d7, + 0x1b80, 0xe30a25e5, + 0x1b80, 0xe30a25e7, + 0x1b80, 0x740025f5, + 0x1b80, 0x740025f7, + 0x1b80, 0xe34e2605, + 0x1b80, 0xe34e2607, + 0x1b80, 0x00042615, + 0x1b80, 0x00042617, + 0x1b80, 0x40082625, + 0x1b80, 0x40082627, + 0x1b80, 0x00012635, + 0x1b80, 0x00012637, + 0x1b80, 0x40ff2645, + 0x1b80, 0x40ff2647, + 0x1b80, 0x411f2655, + 0x1b80, 0x411f2657, + 0x1b80, 0x42002665, + 0x1b80, 0x42002667, + 0x1b80, 0x43002675, + 0x1b80, 0x43002677, + 0x1b80, 0x44ff2685, + 0x1b80, 0x44ff2687, + 0x1b80, 0x451f2695, + 0x1b80, 0x451f2697, + 0x1b80, 0x460026a5, + 0x1b80, 0x460026a7, + 0x1b80, 0x470026b5, + 0x1b80, 0x470026b7, + 0x1b80, 0x48ff26c5, + 0x1b80, 0x48ff26c7, + 0x1b80, 0x491f26d5, + 0x1b80, 0x491f26d7, + 0x1b80, 0x4a0026e5, + 0x1b80, 0x4a0026e7, + 0x1b80, 0x4b0026f5, + 0x1b80, 0x4b0026f7, + 0x1b80, 0x00012705, + 0x1b80, 0x00012707, + 0x1b80, 0x4cff2715, + 0x1b80, 0x4cff2717, + 0x1b80, 0x4d1f2725, + 0x1b80, 0x4d1f2727, + 0x1b80, 0x4e002735, + 0x1b80, 0x4e002737, + 0x1b80, 0x4f002745, + 0x1b80, 0x4f002747, + 0x1b80, 0x50ff2755, + 0x1b80, 0x50ff2757, + 0x1b80, 0x511f2765, + 0x1b80, 0x511f2767, + 0x1b80, 0x52002775, + 0x1b80, 0x52002777, + 0x1b80, 0x53002785, + 0x1b80, 0x53002787, + 0x1b80, 0x54ff2795, + 0x1b80, 0x54ff2797, + 0x1b80, 0x551f27a5, + 0x1b80, 0x551f27a7, + 0x1b80, 0x560027b5, + 0x1b80, 0x560027b7, + 0x1b80, 0x570027c5, + 0x1b80, 0x570027c7, + 0x1b80, 0x58ff27d5, + 0x1b80, 0x58ff27d7, + 0x1b80, 0x591f27e5, + 0x1b80, 0x591f27e7, + 0x1b80, 0x5a0027f5, + 0x1b80, 0x5a0027f7, + 0x1b80, 0x5b002805, + 0x1b80, 0x5b002807, + 0x1b80, 0x00012815, + 0x1b80, 0x00012817, + 0x1b80, 0x5cff2825, + 0x1b80, 0x5cff2827, + 0x1b80, 0x5d1f2835, + 0x1b80, 0x5d1f2837, + 0x1b80, 0x5e002845, + 0x1b80, 0x5e002847, + 0x1b80, 0x5f002855, + 0x1b80, 0x5f002857, + 0x1b80, 0x60ff2865, + 0x1b80, 0x60ff2867, + 0x1b80, 0x611f2875, + 0x1b80, 0x611f2877, + 0x1b80, 0x62002885, + 0x1b80, 0x62002887, + 0x1b80, 0x63002895, + 0x1b80, 0x63002897, + 0x1b80, 0x000128a5, + 0x1b80, 0x000128a7, + 0x1b80, 0x64ff28b5, + 0x1b80, 0x64ff28b7, + 0x1b80, 0x651f28c5, + 0x1b80, 0x651f28c7, + 0x1b80, 0x660028d5, + 0x1b80, 0x660028d7, + 0x1b80, 0x670028e5, + 0x1b80, 0x670028e7, + 0x1b80, 0x68ff28f5, + 0x1b80, 0x68ff28f7, + 0x1b80, 0x691f2905, + 0x1b80, 0x691f2907, + 0x1b80, 0x6a002915, + 0x1b80, 0x6a002917, + 0x1b80, 0x6b002925, + 0x1b80, 0x6b002927, + 0x1b80, 0x6cff2935, + 0x1b80, 0x6cff2937, + 0x1b80, 0x6d1f2945, + 0x1b80, 0x6d1f2947, + 0x1b80, 0x6e002955, + 0x1b80, 0x6e002957, + 0x1b80, 0x6f002965, + 0x1b80, 0x6f002967, + 0x1b80, 0x70ff2975, + 0x1b80, 0x70ff2977, + 0x1b80, 0x711f2985, + 0x1b80, 0x711f2987, + 0x1b80, 0x72002995, + 0x1b80, 0x72002997, + 0x1b80, 0x730029a5, + 0x1b80, 0x730029a7, + 0x1b80, 0x000129b5, + 0x1b80, 0x000129b7, + 0x1b80, 0x70ff29c5, + 0x1b80, 0x70ff29c7, + 0x1b80, 0x711f29d5, + 0x1b80, 0x711f29d7, + 0x1b80, 0x720029e5, + 0x1b80, 0x720029e7, + 0x1b80, 0x730029f5, + 0x1b80, 0x730029f7, + 0x1b80, 0x74ff2a05, + 0x1b80, 0x74ff2a07, + 0x1b80, 0x751f2a15, + 0x1b80, 0x751f2a17, + 0x1b80, 0x76002a25, + 0x1b80, 0x76002a27, + 0x1b80, 0x77002a35, + 0x1b80, 0x77002a37, + 0x1b80, 0x78ff2a45, + 0x1b80, 0x78ff2a47, + 0x1b80, 0x791f2a55, + 0x1b80, 0x791f2a57, + 0x1b80, 0x7a002a65, + 0x1b80, 0x7a002a67, + 0x1b80, 0x7b002a75, + 0x1b80, 0x7b002a77, + 0x1b80, 0x7cff2a85, + 0x1b80, 0x7cff2a87, + 0x1b80, 0x7d1f2a95, + 0x1b80, 0x7d1f2a97, + 0x1b80, 0x7e002aa5, + 0x1b80, 0x7e002aa7, + 0x1b80, 0x7f002ab5, + 0x1b80, 0x7f002ab7, + 0x1b80, 0x00012ac5, + 0x1b80, 0x00012ac7, + 0x1b80, 0x00042ad5, + 0x1b80, 0x00042ad7, + 0x1b80, 0x49042ae5, + 0x1b80, 0x49042ae7, + 0x1b80, 0x4bb02af5, + 0x1b80, 0x4bb02af7, + 0x1b80, 0x00062b05, + 0x1b80, 0x00062b07, + 0x1b80, 0x75042b15, + 0x1b80, 0x75042b17, + 0x1b80, 0x77082b25, + 0x1b80, 0x77082b27, + 0x1b80, 0x00042b35, + 0x1b80, 0x00042b37, + 0x1b80, 0x44802b45, + 0x1b80, 0x44802b47, + 0x1b80, 0x45ff2b55, + 0x1b80, 0x45ff2b57, + 0x1b80, 0x463f2b65, + 0x1b80, 0x463f2b67, + 0x1b80, 0x47312b75, + 0x1b80, 0x47312b77, + 0x1b80, 0x40082b85, + 0x1b80, 0x40082b87, + 0x1b80, 0xe2db2b95, + 0x1b80, 0xe2db2b97, + 0x1b80, 0x00042ba5, + 0x1b80, 0x00042ba7, + 0x1b80, 0x400c2bb5, + 0x1b80, 0x400c2bb7, + 0x1b80, 0x00062bc5, + 0x1b80, 0x00062bc7, + 0x1b80, 0x75002bd5, + 0x1b80, 0x75002bd7, + 0x1b80, 0x00042be5, + 0x1b80, 0x00042be7, + 0x1b80, 0x445b2bf5, + 0x1b80, 0x445b2bf7, + 0x1b80, 0x47002c05, + 0x1b80, 0x47002c07, + 0x1b80, 0x40082c15, + 0x1b80, 0x40082c17, + 0x1b80, 0x00012c25, + 0x1b80, 0x00012c27, + 0x1b80, 0x00052c35, + 0x1b80, 0x00052c37, + 0x1b80, 0x61042c45, + 0x1b80, 0x61042c47, + 0x1b80, 0x63b02c55, + 0x1b80, 0x63b02c57, + 0x1b80, 0x00062c65, + 0x1b80, 0x00062c67, + 0x1b80, 0x75082c75, + 0x1b80, 0x75082c77, + 0x1b80, 0x77082c85, + 0x1b80, 0x77082c87, + 0x1b80, 0x00052c95, + 0x1b80, 0x00052c97, + 0x1b80, 0x5c802ca5, + 0x1b80, 0x5c802ca7, + 0x1b80, 0x5dff2cb5, + 0x1b80, 0x5dff2cb7, + 0x1b80, 0x5e3f2cc5, + 0x1b80, 0x5e3f2cc7, + 0x1b80, 0x5f312cd5, + 0x1b80, 0x5f312cd7, + 0x1b80, 0x00042ce5, + 0x1b80, 0x00042ce7, + 0x1b80, 0x400a2cf5, + 0x1b80, 0x400a2cf7, + 0x1b80, 0xe2db2d05, + 0x1b80, 0xe2db2d07, + 0x1b80, 0x00042d15, + 0x1b80, 0x00042d17, + 0x1b80, 0x400c2d25, + 0x1b80, 0x400c2d27, + 0x1b80, 0x00062d35, + 0x1b80, 0x00062d37, + 0x1b80, 0x75002d45, + 0x1b80, 0x75002d47, + 0x1b80, 0x00052d55, + 0x1b80, 0x00052d57, + 0x1b80, 0x5c5b2d65, + 0x1b80, 0x5c5b2d67, + 0x1b80, 0x5f002d75, + 0x1b80, 0x5f002d77, + 0x1b80, 0x00042d85, + 0x1b80, 0x00042d87, + 0x1b80, 0x40082d95, + 0x1b80, 0x40082d97, + 0x1b80, 0x00012da5, + 0x1b80, 0x00012da7, + 0x1b80, 0x00072db5, + 0x1b80, 0x00072db7, + 0x1b80, 0x4c122dc5, + 0x1b80, 0x4c122dc7, + 0x1b80, 0x4e202dd5, + 0x1b80, 0x4e202dd7, + 0x1b80, 0x00052de5, + 0x1b80, 0x00052de7, + 0x1b80, 0x598f2df5, + 0x1b80, 0x598f2df7, + 0x1b80, 0x40022e05, + 0x1b80, 0x40022e07, + 0x1b80, 0x4c012e15, + 0x1b80, 0x4c012e17, + 0x1b80, 0x4c002e25, + 0x1b80, 0x4c002e27, + 0x1b80, 0xab002e35, + 0x1b80, 0xab002e37, + 0x1b80, 0x40032e45, + 0x1b80, 0x40032e47, + 0x1b80, 0x49802e55, + 0x1b80, 0x49802e57, + 0x1b80, 0x56c02e65, + 0x1b80, 0x56c02e67, + 0x1b80, 0x54022e75, + 0x1b80, 0x54022e77, + 0x1b80, 0x4c012e85, + 0x1b80, 0x4c012e87, + 0x1b80, 0x4c002e95, + 0x1b80, 0x4c002e97, + 0x1b80, 0xab002ea5, + 0x1b80, 0xab002ea7, + 0x1b80, 0x54002eb5, + 0x1b80, 0x54002eb7, + 0x1b80, 0x00072ec5, + 0x1b80, 0x00072ec7, + 0x1b80, 0x4c002ed5, + 0x1b80, 0x4c002ed7, + 0x1b80, 0x4e002ee5, + 0x1b80, 0x4e002ee7, + 0x1b80, 0x00052ef5, + 0x1b80, 0x00052ef7, + 0x1b80, 0x40042f05, + 0x1b80, 0x40042f07, + 0x1b80, 0x4c012f15, + 0x1b80, 0x4c012f17, + 0x1b80, 0x4c002f25, + 0x1b80, 0x4c002f27, + 0x1b80, 0x00012f35, + 0x1b80, 0x00012f37, + 0x1b80, 0x00042f45, + 0x1b80, 0x00042f47, + 0x1b80, 0x44802f55, + 0x1b80, 0x44802f57, + 0x1b80, 0x4b002f65, + 0x1b80, 0x4b002f67, + 0x1b80, 0x00052f75, + 0x1b80, 0x00052f77, + 0x1b80, 0x5c802f85, + 0x1b80, 0x5c802f87, + 0x1b80, 0x63002f95, + 0x1b80, 0x63002f97, + 0x1b80, 0x00072fa5, + 0x1b80, 0x00072fa7, + 0x1b80, 0x780c2fb5, + 0x1b80, 0x780c2fb7, + 0x1b80, 0x79192fc5, + 0x1b80, 0x79192fc7, + 0x1b80, 0x7a002fd5, + 0x1b80, 0x7a002fd7, + 0x1b80, 0x7b822fe5, + 0x1b80, 0x7b822fe7, + 0x1b80, 0x7b022ff5, + 0x1b80, 0x7b022ff7, + 0x1b80, 0x78143005, + 0x1b80, 0x78143007, + 0x1b80, 0x79ee3015, + 0x1b80, 0x79ee3017, + 0x1b80, 0x7a013025, + 0x1b80, 0x7a013027, + 0x1b80, 0x7b833035, + 0x1b80, 0x7b833037, + 0x1b80, 0x7b033045, + 0x1b80, 0x7b033047, + 0x1b80, 0x78283055, + 0x1b80, 0x78283057, + 0x1b80, 0x79b43065, + 0x1b80, 0x79b43067, + 0x1b80, 0x7a003075, + 0x1b80, 0x7a003077, + 0x1b80, 0x7b003085, + 0x1b80, 0x7b003087, + 0x1b80, 0x00013095, + 0x1b80, 0x00013097, + 0x1b80, 0x000430a5, + 0x1b80, 0x000430a7, + 0x1b80, 0x448030b5, + 0x1b80, 0x448030b7, + 0x1b80, 0x4b0030c5, + 0x1b80, 0x4b0030c7, + 0x1b80, 0x000530d5, + 0x1b80, 0x000530d7, + 0x1b80, 0x5c8030e5, + 0x1b80, 0x5c8030e7, + 0x1b80, 0x630030f5, + 0x1b80, 0x630030f7, + 0x1b80, 0x00073105, + 0x1b80, 0x00073107, + 0x1b80, 0x78103115, + 0x1b80, 0x78103117, + 0x1b80, 0x79133125, + 0x1b80, 0x79133127, + 0x1b80, 0x7a003135, + 0x1b80, 0x7a003137, + 0x1b80, 0x7b803145, + 0x1b80, 0x7b803147, + 0x1b80, 0x7b003155, + 0x1b80, 0x7b003157, + 0x1b80, 0x78db3165, + 0x1b80, 0x78db3167, + 0x1b80, 0x79003175, + 0x1b80, 0x79003177, + 0x1b80, 0x7a003185, + 0x1b80, 0x7a003187, + 0x1b80, 0x7b813195, + 0x1b80, 0x7b813197, + 0x1b80, 0x7b0131a5, + 0x1b80, 0x7b0131a7, + 0x1b80, 0x782831b5, + 0x1b80, 0x782831b7, + 0x1b80, 0x79b431c5, + 0x1b80, 0x79b431c7, + 0x1b80, 0x7a0031d5, + 0x1b80, 0x7a0031d7, + 0x1b80, 0x7b0031e5, + 0x1b80, 0x7b0031e7, + 0x1b80, 0x000131f5, + 0x1b80, 0x000131f7, + 0x1b80, 0x00073205, + 0x1b80, 0x00073207, + 0x1b80, 0x783e3215, + 0x1b80, 0x783e3217, + 0x1b80, 0x79f93225, + 0x1b80, 0x79f93227, + 0x1b80, 0x7a013235, + 0x1b80, 0x7a013237, + 0x1b80, 0x7b823245, + 0x1b80, 0x7b823247, + 0x1b80, 0x7b023255, + 0x1b80, 0x7b023257, + 0x1b80, 0x78a93265, + 0x1b80, 0x78a93267, + 0x1b80, 0x79ed3275, + 0x1b80, 0x79ed3277, + 0x1b80, 0x7b833285, + 0x1b80, 0x7b833287, + 0x1b80, 0x7b033295, + 0x1b80, 0x7b033297, + 0x1b80, 0x782832a5, + 0x1b80, 0x782832a7, + 0x1b80, 0x79b432b5, + 0x1b80, 0x79b432b7, + 0x1b80, 0x7a0032c5, + 0x1b80, 0x7a0032c7, + 0x1b80, 0x7b0032d5, + 0x1b80, 0x7b0032d7, + 0x1b80, 0x000132e5, + 0x1b80, 0x000132e7, + 0x1b80, 0x000732f5, + 0x1b80, 0x000732f7, + 0x1b80, 0x78ae3305, + 0x1b80, 0x78ae3307, + 0x1b80, 0x79fa3315, + 0x1b80, 0x79fa3317, + 0x1b80, 0x7a013325, + 0x1b80, 0x7a013327, + 0x1b80, 0x7b803335, + 0x1b80, 0x7b803337, + 0x1b80, 0x7b003345, + 0x1b80, 0x7b003347, + 0x1b80, 0x787a3355, + 0x1b80, 0x787a3357, + 0x1b80, 0x79f13365, + 0x1b80, 0x79f13367, + 0x1b80, 0x7b813375, + 0x1b80, 0x7b813377, + 0x1b80, 0x7b013385, + 0x1b80, 0x7b013387, + 0x1b80, 0x78283395, + 0x1b80, 0x78283397, + 0x1b80, 0x79b433a5, + 0x1b80, 0x79b433a7, + 0x1b80, 0x7a0033b5, + 0x1b80, 0x7a0033b7, + 0x1b80, 0x7b0033c5, + 0x1b80, 0x7b0033c7, + 0x1b80, 0x000133d5, + 0x1b80, 0x000133d7, + 0x1b80, 0x000733e5, + 0x1b80, 0x000733e7, + 0x1b80, 0x750033f5, + 0x1b80, 0x750033f7, + 0x1b80, 0x76023405, + 0x1b80, 0x76023407, + 0x1b80, 0x77153415, + 0x1b80, 0x77153417, + 0x1b80, 0x00063425, + 0x1b80, 0x00063427, + 0x1b80, 0x74003435, + 0x1b80, 0x74003437, + 0x1b80, 0x76003445, + 0x1b80, 0x76003447, + 0x1b80, 0x77003455, + 0x1b80, 0x77003457, + 0x1b80, 0x75103465, + 0x1b80, 0x75103467, + 0x1b80, 0x75003475, + 0x1b80, 0x75003477, + 0x1b80, 0xb3003485, + 0x1b80, 0xb3003487, + 0x1b80, 0x93003495, + 0x1b80, 0x93003497, + 0x1b80, 0x000734a5, + 0x1b80, 0x000734a7, + 0x1b80, 0x760034b5, + 0x1b80, 0x760034b7, + 0x1b80, 0x770034c5, + 0x1b80, 0x770034c7, + 0x1b80, 0x000134d5, + 0x1b80, 0x000134d7, + 0x1b80, 0x000734e5, + 0x1b80, 0x000734e7, + 0x1b80, 0x750034f5, + 0x1b80, 0x750034f7, + 0x1b80, 0x76023505, + 0x1b80, 0x76023507, + 0x1b80, 0x77253515, + 0x1b80, 0x77253517, + 0x1b80, 0x00063525, + 0x1b80, 0x00063527, + 0x1b80, 0x74003535, + 0x1b80, 0x74003537, + 0x1b80, 0x76003545, + 0x1b80, 0x76003547, + 0x1b80, 0x77013555, + 0x1b80, 0x77013557, + 0x1b80, 0x75103565, + 0x1b80, 0x75103567, + 0x1b80, 0x75003575, + 0x1b80, 0x75003577, + 0x1b80, 0xb3003585, + 0x1b80, 0xb3003587, + 0x1b80, 0x93003595, + 0x1b80, 0x93003597, + 0x1b80, 0x000735a5, + 0x1b80, 0x000735a7, + 0x1b80, 0x760035b5, + 0x1b80, 0x760035b7, + 0x1b80, 0x770035c5, + 0x1b80, 0x770035c7, + 0x1b80, 0x000135d5, + 0x1b80, 0x000135d7, + 0x1b80, 0x000435e5, + 0x1b80, 0x000435e7, + 0x1b80, 0x448035f5, + 0x1b80, 0x448035f7, + 0x1b80, 0x47303605, + 0x1b80, 0x47303607, + 0x1b80, 0x00063615, + 0x1b80, 0x00063617, + 0x1b80, 0x776c3625, + 0x1b80, 0x776c3627, + 0x1b80, 0x00013635, + 0x1b80, 0x00013637, + 0x1b80, 0x00053645, + 0x1b80, 0x00053647, + 0x1b80, 0x5c803655, + 0x1b80, 0x5c803657, + 0x1b80, 0x5f303665, + 0x1b80, 0x5f303667, + 0x1b80, 0x00063675, + 0x1b80, 0x00063677, + 0x1b80, 0x776d3685, + 0x1b80, 0x776d3687, + 0x1b80, 0x00013695, + 0x1b80, 0x00013697, + 0x1b80, 0xb90036a5, + 0x1b80, 0xb90036a7, + 0x1b80, 0x990036b5, + 0x1b80, 0x990036b7, + 0x1b80, 0x000636c5, + 0x1b80, 0x000636c7, + 0x1b80, 0x770036d5, + 0x1b80, 0x770036d7, + 0x1b80, 0x980536e5, + 0x1b80, 0x980536e7, + 0x1b80, 0x000436f5, + 0x1b80, 0x000436f7, + 0x1b80, 0x40083705, + 0x1b80, 0x40083707, + 0x1b80, 0x4a023715, + 0x1b80, 0x4a023717, + 0x1b80, 0x30193725, + 0x1b80, 0x30193727, + 0x1b80, 0x00013735, + 0x1b80, 0x00013737, + 0x1b80, 0x7b483745, + 0x1b80, 0x7b483747, + 0x1b80, 0x7a903755, + 0x1b80, 0x7a903757, + 0x1b80, 0x79003765, + 0x1b80, 0x79003767, + 0x1b80, 0x55033775, + 0x1b80, 0x55033777, + 0x1b80, 0x33803785, + 0x1b80, 0x33803787, + 0x1b80, 0x7b383795, + 0x1b80, 0x7b383797, + 0x1b80, 0x7a8037a5, + 0x1b80, 0x7a8037a7, + 0x1b80, 0x550b37b5, + 0x1b80, 0x550b37b7, + 0x1b80, 0x338037c5, + 0x1b80, 0x338037c7, + 0x1b80, 0x7b4037d5, + 0x1b80, 0x7b4037d7, + 0x1b80, 0x7a0037e5, + 0x1b80, 0x7a0037e7, + 0x1b80, 0x551337f5, + 0x1b80, 0x551337f7, + 0x1b80, 0x74013805, + 0x1b80, 0x74013807, + 0x1b80, 0x74003815, + 0x1b80, 0x74003817, + 0x1b80, 0x8e003825, + 0x1b80, 0x8e003827, + 0x1b80, 0x00013835, + 0x1b80, 0x00013837, + 0x1b80, 0x57023845, + 0x1b80, 0x57023847, + 0x1b80, 0x57003855, + 0x1b80, 0x57003857, + 0x1b80, 0x97003865, + 0x1b80, 0x97003867, + 0x1b80, 0x00013875, + 0x1b80, 0x00013877, + 0x1b80, 0x4f783885, + 0x1b80, 0x4f783887, + 0x1b80, 0x53883895, + 0x1b80, 0x53883897, + 0x1b80, 0xe39438a5, + 0x1b80, 0xe39438a7, + 0x1b80, 0x548038b5, + 0x1b80, 0x548038b7, + 0x1b80, 0x540038c5, + 0x1b80, 0x540038c7, + 0x1b80, 0x548138d5, + 0x1b80, 0x548138d7, + 0x1b80, 0x540038e5, + 0x1b80, 0x540038e7, + 0x1b80, 0x548238f5, + 0x1b80, 0x548238f7, + 0x1b80, 0x54003905, + 0x1b80, 0x54003907, + 0x1b80, 0xe39f3915, + 0x1b80, 0xe39f3917, + 0x1b80, 0xbf1d3925, + 0x1b80, 0xbf1d3927, + 0x1b80, 0x30193935, + 0x1b80, 0x30193937, + 0x1b80, 0xe3743945, + 0x1b80, 0xe3743947, + 0x1b80, 0xe3793955, + 0x1b80, 0xe3793957, + 0x1b80, 0xe37d3965, + 0x1b80, 0xe37d3967, + 0x1b80, 0xe3843975, + 0x1b80, 0xe3843977, + 0x1b80, 0xe3de3985, + 0x1b80, 0xe3de3987, + 0x1b80, 0x55133995, + 0x1b80, 0x55133997, + 0x1b80, 0xe38039a5, + 0x1b80, 0xe38039a7, + 0x1b80, 0x551539b5, + 0x1b80, 0x551539b7, + 0x1b80, 0xe38439c5, + 0x1b80, 0xe38439c7, + 0x1b80, 0xe3de39d5, + 0x1b80, 0xe3de39d7, + 0x1b80, 0x000139e5, + 0x1b80, 0x000139e7, + 0x1b80, 0x54bf39f5, + 0x1b80, 0x54bf39f7, + 0x1b80, 0x54c03a05, + 0x1b80, 0x54c03a07, + 0x1b80, 0x54a33a15, + 0x1b80, 0x54a33a17, + 0x1b80, 0x54c13a25, + 0x1b80, 0x54c13a27, + 0x1b80, 0x54a43a35, + 0x1b80, 0x54a43a37, + 0x1b80, 0x4c183a45, + 0x1b80, 0x4c183a47, + 0x1b80, 0xbf073a55, + 0x1b80, 0xbf073a57, + 0x1b80, 0x54c23a65, + 0x1b80, 0x54c23a67, + 0x1b80, 0x54a43a75, + 0x1b80, 0x54a43a77, + 0x1b80, 0xbf043a85, + 0x1b80, 0xbf043a87, + 0x1b80, 0x54c13a95, + 0x1b80, 0x54c13a97, + 0x1b80, 0x54a33aa5, + 0x1b80, 0x54a33aa7, + 0x1b80, 0xbf013ab5, + 0x1b80, 0xbf013ab7, + 0x1b80, 0xe3ec3ac5, + 0x1b80, 0xe3ec3ac7, + 0x1b80, 0x54df3ad5, + 0x1b80, 0x54df3ad7, + 0x1b80, 0x00013ae5, + 0x1b80, 0x00013ae7, + 0x1b80, 0x54bf3af5, + 0x1b80, 0x54bf3af7, + 0x1b80, 0x54e53b05, + 0x1b80, 0x54e53b07, + 0x1b80, 0x050a3b15, + 0x1b80, 0x050a3b17, + 0x1b80, 0x54df3b25, + 0x1b80, 0x54df3b27, + 0x1b80, 0x00013b35, + 0x1b80, 0x00013b37, + 0x1b80, 0x7f403b45, + 0x1b80, 0x7f403b47, + 0x1b80, 0x7e003b55, + 0x1b80, 0x7e003b57, + 0x1b80, 0x7d003b65, + 0x1b80, 0x7d003b67, + 0x1b80, 0x55013b75, + 0x1b80, 0x55013b77, + 0x1b80, 0x5c313b85, + 0x1b80, 0x5c313b87, + 0x1b80, 0xe3803b95, + 0x1b80, 0xe3803b97, + 0x1b80, 0xe3843ba5, + 0x1b80, 0xe3843ba7, + 0x1b80, 0x54803bb5, + 0x1b80, 0x54803bb7, + 0x1b80, 0x54003bc5, + 0x1b80, 0x54003bc7, + 0x1b80, 0x54813bd5, + 0x1b80, 0x54813bd7, + 0x1b80, 0x54003be5, + 0x1b80, 0x54003be7, + 0x1b80, 0x54823bf5, + 0x1b80, 0x54823bf7, + 0x1b80, 0x54003c05, + 0x1b80, 0x54003c07, + 0x1b80, 0xe39f3c15, + 0x1b80, 0xe39f3c17, + 0x1b80, 0xbfed3c25, + 0x1b80, 0xbfed3c27, + 0x1b80, 0x30193c35, + 0x1b80, 0x30193c37, + 0x1b80, 0x74023c45, + 0x1b80, 0x74023c47, + 0x1b80, 0x003f3c55, + 0x1b80, 0x003f3c57, + 0x1b80, 0x74003c65, + 0x1b80, 0x74003c67, + 0x1b80, 0x00023c75, + 0x1b80, 0x00023c77, + 0x1b80, 0x00013c85, + 0x1b80, 0x00013c87, + 0x1b80, 0x00063c95, + 0x1b80, 0x00063c97, + 0x1b80, 0x5a803ca5, + 0x1b80, 0x5a803ca7, + 0x1b80, 0x5a003cb5, + 0x1b80, 0x5a003cb7, + 0x1b80, 0x92003cc5, + 0x1b80, 0x92003cc7, + 0x1b80, 0x00013cd5, + 0x1b80, 0x00013cd7, + 0x1b80, 0x5b8f3ce5, + 0x1b80, 0x5b8f3ce7, + 0x1b80, 0x5b0f3cf5, + 0x1b80, 0x5b0f3cf7, + 0x1b80, 0x91003d05, + 0x1b80, 0x91003d07, + 0x1b80, 0x00013d15, + 0x1b80, 0x00013d17, + 0x1b80, 0x00063d25, + 0x1b80, 0x00063d27, + 0x1b80, 0x5d803d35, + 0x1b80, 0x5d803d37, + 0x1b80, 0x5e563d45, + 0x1b80, 0x5e563d47, + 0x1b80, 0x00043d55, + 0x1b80, 0x00043d57, + 0x1b80, 0x4d083d65, + 0x1b80, 0x4d083d67, + 0x1b80, 0x57103d75, + 0x1b80, 0x57103d77, + 0x1b80, 0x57003d85, + 0x1b80, 0x57003d87, + 0x1b80, 0x4d003d95, + 0x1b80, 0x4d003d97, + 0x1b80, 0x00063da5, + 0x1b80, 0x00063da7, + 0x1b80, 0x5d003db5, + 0x1b80, 0x5d003db7, + 0x1b80, 0x00043dc5, + 0x1b80, 0x00043dc7, + 0x1b80, 0x00013dd5, + 0x1b80, 0x00013dd7, + 0x1b80, 0x549f3de5, + 0x1b80, 0x549f3de7, + 0x1b80, 0x54ff3df5, + 0x1b80, 0x54ff3df7, + 0x1b80, 0x54003e05, + 0x1b80, 0x54003e07, + 0x1b80, 0x00013e15, + 0x1b80, 0x00013e17, + 0x1b80, 0x5c313e25, + 0x1b80, 0x5c313e27, + 0x1b80, 0x07143e35, + 0x1b80, 0x07143e37, + 0x1b80, 0x54003e45, + 0x1b80, 0x54003e47, + 0x1b80, 0x5c323e55, + 0x1b80, 0x5c323e57, + 0x1b80, 0x00013e65, + 0x1b80, 0x00013e67, + 0x1b80, 0x5c323e75, + 0x1b80, 0x5c323e77, + 0x1b80, 0x07143e85, + 0x1b80, 0x07143e87, + 0x1b80, 0x54003e95, + 0x1b80, 0x54003e97, + 0x1b80, 0x5c313ea5, + 0x1b80, 0x5c313ea7, + 0x1b80, 0x00013eb5, + 0x1b80, 0x00013eb7, + 0x1b80, 0x4c983ec5, + 0x1b80, 0x4c983ec7, + 0x1b80, 0x4c183ed5, + 0x1b80, 0x4c183ed7, + 0x1b80, 0x00013ee5, + 0x1b80, 0x00013ee7, + 0x1b80, 0x5c323ef5, + 0x1b80, 0x5c323ef7, + 0x1b80, 0x62043f05, + 0x1b80, 0x62043f07, + 0x1b80, 0x63033f15, + 0x1b80, 0x63033f17, + 0x1b80, 0x66073f25, + 0x1b80, 0x66073f27, + 0x1b80, 0x7b403f35, + 0x1b80, 0x7b403f37, + 0x1b80, 0x7a003f45, + 0x1b80, 0x7a003f47, + 0x1b80, 0x79003f55, + 0x1b80, 0x79003f57, + 0x1b80, 0x7f403f65, + 0x1b80, 0x7f403f67, + 0x1b80, 0x7e003f75, + 0x1b80, 0x7e003f77, + 0x1b80, 0x7d003f85, + 0x1b80, 0x7d003f87, + 0x1b80, 0x09013f95, + 0x1b80, 0x09013f97, + 0x1b80, 0x0c013fa5, + 0x1b80, 0x0c013fa7, + 0x1b80, 0x0ba63fb5, + 0x1b80, 0x0ba63fb7, + 0x1b80, 0x00013fc5, + 0x1b80, 0x00013fc7, + 0x1b80, 0x00000006, + 0x1b80, 0x00000002, +}; + +RTW_DECL_TABLE_PHY_COND(rtw8822c_array_mp_cal_init, rtw_phy_cfg_bb); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c_table.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c_table.h new file mode 100644 index 0000000000000000000000000000000000000000..2ae2b0aa569966a04769756302d9c799716f37a7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822c_table.h @@ -0,0 +1,21 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW8822C_TABLE_H__ +#define __RTW8822C_TABLE_H__ + +extern const struct rtw_table rtw8822c_mac_tbl; +extern const struct rtw_table rtw8822c_agc_tbl; +extern const struct rtw_table rtw8822c_bb_tbl; +extern const struct rtw_table rtw8822c_bb_pg_type0_tbl; +extern const struct rtw_table rtw8822c_rf_a_tbl; +extern const struct rtw_table rtw8822c_rf_b_tbl; +extern const struct rtw_table rtw8822c_txpwr_lmt_type0_tbl; +extern const struct rtw_table rtw8822c_txpwr_lmt_type5_tbl; +extern const struct rtw_table rtw8822c_dpk_afe_no_dpk_tbl; +extern const struct rtw_table rtw8822c_dpk_afe_is_dpk_tbl; +extern const struct rtw_table rtw8822c_dpk_mac_bb_tbl; +extern const struct rtw_table rtw8822c_array_mp_cal_init_tbl; + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822ce.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822ce.c new file mode 100644 index 0000000000000000000000000000000000000000..e26c6bc82936307063e3d23bdfb23667e6bed7f3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822ce.c @@ -0,0 +1,35 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include "pci.h" +#include "rtw8822c.h" + +static const struct pci_device_id rtw_8822ce_id_table[] = { + { + PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0xC822), + .driver_data = (kernel_ulong_t)&rtw8822c_hw_spec + }, + { + PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0xC82F), + .driver_data = (kernel_ulong_t)&rtw8822c_hw_spec + }, + {} +}; +MODULE_DEVICE_TABLE(pci, rtw_8822ce_id_table); + +static struct pci_driver rtw_8822ce_driver = { + .name = "rtw_8822ce", + .id_table = rtw_8822ce_id_table, + .probe = rtw_pci_probe, + .remove = rtw_pci_remove, + .driver.pm = &rtw_pm_ops, + .shutdown = rtw_pci_shutdown, +}; +module_pci_driver(rtw_8822ce_driver); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822ce driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822ce.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822ce.h new file mode 100644 index 0000000000000000000000000000000000000000..c2c0e8675d742ec977ccd77529d68e55a44a471f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822ce.h @@ -0,0 +1,14 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_8822CE_H_ +#define __RTW_8822CE_H_ + +extern const struct dev_pm_ops rtw_pm_ops; +extern struct rtw_chip_info rtw8822c_hw_spec; +int rtw_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id); +void rtw_pci_remove(struct pci_dev *pdev); +void rtw_pci_shutdown(struct pci_dev *pdev); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822cs.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822cs.c new file mode 100644 index 0000000000000000000000000000000000000000..5d68b9aa5fd7bd71059bce2fbb5f7747ebec0074 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822cs.c @@ -0,0 +1,36 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) Martin Blumenstingl + */ + +#include +#include "sdio_ids.h" +#include +#include "main.h" +#include "rtw8822c.h" +#include "sdio.h" + +static const struct sdio_device_id rtw_8822cs_id_table[] = { + { + SDIO_DEVICE(SDIO_VENDOR_ID_REALTEK, + SDIO_DEVICE_ID_REALTEK_RTW8822CS), + .driver_data = (kernel_ulong_t)&rtw8822c_hw_spec, + }, + {} +}; +MODULE_DEVICE_TABLE(sdio, rtw_8822cs_id_table); + +static struct sdio_driver rtw_8822cs_driver = { + .name = "rtw_8822cs", + .probe = rtw_sdio_probe, + .remove = rtw_sdio_remove, + .id_table = rtw_8822cs_id_table, + .drv = { + .pm = &rtw_sdio_pm_ops, + .shutdown = rtw_sdio_shutdown, + } +}; +module_sdio_driver(rtw_8822cs_driver); + +MODULE_AUTHOR("Martin Blumenstingl "); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822cs driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822cu.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822cu.c new file mode 100644 index 0000000000000000000000000000000000000000..157d5102a4b1db8faa6207a9fb44b7720ae227f7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rtw8822cu.c @@ -0,0 +1,44 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include "main.h" +#include "rtw8822c.h" +#include "usb.h" + +static const struct usb_device_id rtw_8822cu_id_table[] = { + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82c, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc812, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xc82e, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xd820, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(RTW_USB_VENDOR_ID_REALTEK, 0xd82b, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, + { USB_DEVICE_AND_INTERFACE_INFO(0x13b1, 0x0043, 0xff, 0xff, 0xff), + .driver_info = (kernel_ulong_t)&(rtw8822c_hw_spec) }, /* Alpha - Alpha */ + {}, +}; +MODULE_DEVICE_TABLE(usb, rtw_8822cu_id_table); + +static int rtw8822cu_probe(struct usb_interface *intf, + const struct usb_device_id *id) +{ + return rtw_usb_probe(intf, id); +} + +static struct usb_driver rtw_8822cu_driver = { + .name = "rtw_8822cu", + .id_table = rtw_8822cu_id_table, + .probe = rtw8822cu_probe, + .disconnect = rtw_usb_disconnect, +}; +module_usb_driver(rtw_8822cu_driver); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822cu driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rx.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rx.c new file mode 100644 index 0000000000000000000000000000000000000000..b420a39b167d7a0c00ec6774cfbdb2048e21e8c2 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rx.c @@ -0,0 +1,234 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "rx.h" +#include "ps.h" +#include "debug.h" +#include "fw.h" + +void rtw_rx_stats(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct sk_buff *skb) +{ + struct ieee80211_hdr *hdr; + struct rtw_vif *rtwvif; + + hdr = (struct ieee80211_hdr *)skb->data; + + if (!ieee80211_is_data(hdr->frame_control)) + return; + + if (!is_broadcast_ether_addr(hdr->addr1) && + !is_multicast_ether_addr(hdr->addr1)) { + rtwdev->stats.rx_unicast += skb->len; + rtwdev->stats.rx_cnt++; + if (vif) { + rtwvif = (struct rtw_vif *)vif->drv_priv; + rtwvif->stats.rx_unicast += skb->len; + rtwvif->stats.rx_cnt++; + } + } +} +EXPORT_SYMBOL(rtw_rx_stats); + +struct rtw_rx_addr_match_data { + struct rtw_dev *rtwdev; + struct ieee80211_hdr *hdr; + struct rtw_rx_pkt_stat *pkt_stat; + u8 *bssid; +}; + +static void rtw_rx_phy_stat(struct rtw_dev *rtwdev, + struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_hdr *hdr) +{ + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_pkt_count *cur_pkt_cnt = &dm_info->cur_pkt_count; + u8 rate_ss, rate_ss_evm, evm_id; + u8 i, idx; + + dm_info->curr_rx_rate = pkt_stat->rate; + + if (ieee80211_is_beacon(hdr->frame_control)) + cur_pkt_cnt->num_bcn_pkt++; + + switch (pkt_stat->rate) { + case DESC_RATE1M...DESC_RATE11M: + goto pkt_num; + case DESC_RATE6M...DESC_RATE54M: + rate_ss = 0; + rate_ss_evm = 1; + evm_id = RTW_EVM_OFDM; + break; + case DESC_RATEMCS0...DESC_RATEMCS7: + case DESC_RATEVHT1SS_MCS0...DESC_RATEVHT1SS_MCS9: + rate_ss = 1; + rate_ss_evm = 1; + evm_id = RTW_EVM_1SS; + break; + case DESC_RATEMCS8...DESC_RATEMCS15: + case DESC_RATEVHT2SS_MCS0...DESC_RATEVHT2SS_MCS9: + rate_ss = 2; + rate_ss_evm = 2; + evm_id = RTW_EVM_2SS_A; + break; + default: + rtw_warn(rtwdev, "unknown pkt rate = %d\n", pkt_stat->rate); + return; + } + + for (i = 0; i < rate_ss_evm; i++) { + idx = evm_id + i; + ewma_evm_add(&dm_info->ewma_evm[idx], + dm_info->rx_evm_dbm[i]); + } + + for (i = 0; i < rtwdev->hal.rf_path_num; i++) { + idx = RTW_SNR_OFDM_A + 4 * rate_ss + i; + ewma_snr_add(&dm_info->ewma_snr[idx], + dm_info->rx_snr[i]); + } +pkt_num: + cur_pkt_cnt->num_qry_pkt[pkt_stat->rate]++; +} + +static void rtw_rx_addr_match_iter(void *data, u8 *mac, + struct ieee80211_vif *vif) +{ + struct rtw_rx_addr_match_data *iter_data = data; + struct ieee80211_sta *sta; + struct ieee80211_hdr *hdr = iter_data->hdr; + struct rtw_dev *rtwdev = iter_data->rtwdev; + struct rtw_sta_info *si; + struct rtw_rx_pkt_stat *pkt_stat = iter_data->pkt_stat; + u8 *bssid = iter_data->bssid; + + if (!ether_addr_equal(vif->bss_conf.bssid, bssid)) + return; + + if (!(ether_addr_equal(vif->addr, hdr->addr1) || + ieee80211_is_beacon(hdr->frame_control))) + return; + + rtw_rx_phy_stat(rtwdev, pkt_stat, hdr); + sta = ieee80211_find_sta_by_ifaddr(rtwdev->hw, hdr->addr2, + vif->addr); + if (!sta) + return; + + si = (struct rtw_sta_info *)sta->drv_priv; + ewma_rssi_add(&si->avg_rssi, pkt_stat->rssi); +} + +static void rtw_rx_addr_match(struct rtw_dev *rtwdev, + struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_hdr *hdr) +{ + struct rtw_rx_addr_match_data data = {}; + + if (pkt_stat->crc_err || pkt_stat->icv_err || !pkt_stat->phy_status || + ieee80211_is_ctl(hdr->frame_control)) + return; + + data.rtwdev = rtwdev; + data.hdr = hdr; + data.pkt_stat = pkt_stat; + data.bssid = get_hdr_bssid(hdr); + + rtw_iterate_vifs_atomic(rtwdev, rtw_rx_addr_match_iter, &data); +} + +static void rtw_set_rx_freq_by_pktstat(struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_rx_status *rx_status) +{ + rx_status->freq = pkt_stat->freq; + rx_status->band = pkt_stat->band; +} + +void rtw_rx_fill_rx_status(struct rtw_dev *rtwdev, + struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_hdr *hdr, + struct ieee80211_rx_status *rx_status, + u8 *phy_status) +{ + struct ieee80211_hw *hw = rtwdev->hw; + u8 path; + + memset(rx_status, 0, sizeof(*rx_status)); + if (!hw) { + rtw_warn(rtwdev, "hw NULL in %s\n", __func__); + return; + } + if (!hw->conf.chandef.chan) { + rtw_warn(rtwdev, "hw->conf.chandef.chan NULL in %s\n", __func__); + return; + } + + rx_status->freq = hw->conf.chandef.chan->center_freq; + rx_status->band = hw->conf.chandef.chan->band; + if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD) && + test_bit(RTW_FLAG_SCANNING, rtwdev->flags)) + rtw_set_rx_freq_by_pktstat(pkt_stat, rx_status); + if (pkt_stat->crc_err) + rx_status->flag |= RX_FLAG_FAILED_FCS_CRC; + if (pkt_stat->decrypted) + rx_status->flag |= RX_FLAG_DECRYPTED; + + if (pkt_stat->rate >= DESC_RATEVHT1SS_MCS0) +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) + rx_status->encoding = RX_ENC_VHT; +#else + rx_status->flag |= RX_FLAG_VHT; +#endif + else if (pkt_stat->rate >= DESC_RATEMCS0) +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) + rx_status->encoding = RX_ENC_HT; +#else + rx_status->flag |= RX_FLAG_VHT; +#endif + + if (rx_status->band == NL80211_BAND_5GHZ && + pkt_stat->rate >= DESC_RATE6M && + pkt_stat->rate <= DESC_RATE54M) { + rx_status->rate_idx = pkt_stat->rate - DESC_RATE6M; + } else if (rx_status->band == NL80211_BAND_2GHZ && + pkt_stat->rate >= DESC_RATE1M && + pkt_stat->rate <= DESC_RATE54M) { + rx_status->rate_idx = pkt_stat->rate - DESC_RATE1M; + } else if (pkt_stat->rate >= DESC_RATEMCS0) { + rtw_desc_to_mcsrate(pkt_stat->rate, &rx_status->rate_idx, + &rx_status->nss); + } + + rx_status->flag |= RX_FLAG_MACTIME_START; + rx_status->mactime = pkt_stat->tsf_low; + + if (pkt_stat->bw == RTW_CHANNEL_WIDTH_80) +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) + rx_status->bw = RATE_INFO_BW_80; +#else + rx_status->vht_flag |= RX_VHT_FLAG_80MHZ; +#endif + else if (pkt_stat->bw == RTW_CHANNEL_WIDTH_40) +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) + rx_status->bw = RATE_INFO_BW_40; +#else + rx_status->flag |= RX_FLAG_40MHZ; +#endif + else +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) + rx_status->bw = RATE_INFO_BW_20; +#else + /* What goes here? */ +#endif + + rx_status->signal = pkt_stat->signal_power; + for (path = 0; path < rtwdev->hal.rf_path_num; path++) { + rx_status->chains |= BIT(path); + rx_status->chain_signal[path] = pkt_stat->rx_power[path]; + } + + rtw_rx_addr_match(rtwdev, pkt_stat, hdr); +} +EXPORT_SYMBOL(rtw_rx_fill_rx_status); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rx.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rx.h new file mode 100644 index 0000000000000000000000000000000000000000..3342e37612813a7004f2ca1345d5621f59237d6a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/rx.h @@ -0,0 +1,52 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_RX_H_ +#define __RTW_RX_H_ + +enum rtw_rx_desc_enc { + RX_DESC_ENC_NONE = 0, + RX_DESC_ENC_WEP40 = 1, + RX_DESC_ENC_TKIP_WO_MIC = 2, + RX_DESC_ENC_TKIP_MIC = 3, + RX_DESC_ENC_AES = 4, + RX_DESC_ENC_WEP104 = 5, +}; + +#define GET_RX_DESC_PHYST(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x00), BIT(26)) +#define GET_RX_DESC_ICV_ERR(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x00), BIT(15)) +#define GET_RX_DESC_CRC32(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x00), BIT(14)) +#define GET_RX_DESC_SWDEC(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x00), BIT(27)) +#define GET_RX_DESC_C2H(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x02), BIT(28)) +#define GET_RX_DESC_PKT_LEN(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x00), GENMASK(13, 0)) +#define GET_RX_DESC_DRV_INFO_SIZE(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x00), GENMASK(19, 16)) +#define GET_RX_DESC_SHIFT(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x00), GENMASK(25, 24)) +#define GET_RX_DESC_ENC_TYPE(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x00), GENMASK(22, 20)) +#define GET_RX_DESC_RX_RATE(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x03), GENMASK(6, 0)) +#define GET_RX_DESC_MACID(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x01), GENMASK(6, 0)) +#define GET_RX_DESC_PPDU_CNT(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x02), GENMASK(30, 29)) +#define GET_RX_DESC_TSFL(rxdesc) \ + le32_get_bits(*((__le32 *)(rxdesc) + 0x05), GENMASK(31, 0)) + +void rtw_rx_stats(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct sk_buff *skb); +void rtw_rx_fill_rx_status(struct rtw_dev *rtwdev, + struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_hdr *hdr, + struct ieee80211_rx_status *rx_status, + u8 *phy_status); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sar.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sar.c new file mode 100644 index 0000000000000000000000000000000000000000..475e79c91f03b0f49ef4406b5fc5c81e5427d4a4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sar.c @@ -0,0 +1,116 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2021 Realtek Corporation + */ + +#include +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) +#include "sar.h" +#include "phy.h" +#include "debug.h" + +s8 rtw_query_sar(struct rtw_dev *rtwdev, const struct rtw_sar_arg *arg) +{ + const struct rtw_hal *hal = &rtwdev->hal; + const struct rtw_sar *sar = &hal->sar; + + switch (sar->src) { + default: + rtw_warn(rtwdev, "unknown SAR source: %d\n", sar->src); + fallthrough; + case RTW_SAR_SOURCE_NONE: + return (s8)rtwdev->chip->max_power_index; + case RTW_SAR_SOURCE_COMMON: + return sar->cfg[arg->path][arg->rs].common[arg->sar_band]; + } +} + +static int rtw_apply_sar(struct rtw_dev *rtwdev, const struct rtw_sar *new) +{ + struct rtw_hal *hal = &rtwdev->hal; + struct rtw_sar *sar = &hal->sar; + + if (sar->src != RTW_SAR_SOURCE_NONE && new->src != sar->src) { + rtw_warn(rtwdev, "SAR source: %d is in use\n", sar->src); + return -EBUSY; + } + + *sar = *new; + rtw_phy_set_tx_power_level(rtwdev, hal->current_channel); + + return 0; +} + +static s8 rtw_sar_to_phy(struct rtw_dev *rtwdev, u8 fct, s32 sar, + const struct rtw_sar_arg *arg) +{ + struct rtw_hal *hal = &rtwdev->hal; + u8 txgi = rtwdev->chip->txgi_factor; + u8 max = rtwdev->chip->max_power_index; + s32 tmp; + s8 base; + + tmp = fct > txgi ? sar >> (fct - txgi) : sar << (txgi - fct); + base = arg->sar_band == RTW_SAR_BAND_0 ? + hal->tx_pwr_by_rate_base_2g[arg->path][arg->rs] : + hal->tx_pwr_by_rate_base_5g[arg->path][arg->rs]; + + return (s8)clamp_t(s32, tmp, -max - 1, max) - base; +} + +static const struct cfg80211_sar_freq_ranges rtw_common_sar_freq_ranges[] = { + [RTW_SAR_BAND_0] = { .start_freq = 2412, .end_freq = 2484, }, + [RTW_SAR_BAND_1] = { .start_freq = 5180, .end_freq = 5320, }, + [RTW_SAR_BAND_3] = { .start_freq = 5500, .end_freq = 5720, }, + [RTW_SAR_BAND_4] = { .start_freq = 5745, .end_freq = 5825, }, +}; + +const struct cfg80211_sar_capa rtw_sar_capa = { + .type = NL80211_SAR_TYPE_POWER, + .num_freq_ranges = RTW_SAR_BAND_NR, + .freq_ranges = rtw_common_sar_freq_ranges, +}; + +int rtw_set_sar_specs(struct rtw_dev *rtwdev, + const struct cfg80211_sar_specs *sar) +{ + struct rtw_sar_arg arg = {0}; + struct rtw_sar new = {0}; + u32 idx, i, j, k; + s32 power; + s8 val; + + if (sar->type != NL80211_SAR_TYPE_POWER) + return -EINVAL; + + memset(&new, rtwdev->chip->max_power_index, sizeof(new)); + new.src = RTW_SAR_SOURCE_COMMON; + + for (i = 0; i < sar->num_sub_specs; i++) { + idx = sar->sub_specs[i].freq_range_index; + if (idx >= RTW_SAR_BAND_NR) + return -EINVAL; + + power = sar->sub_specs[i].power; + rtw_dbg(rtwdev, RTW_DBG_REGD, "On freq %u to %u, set SAR %d in 1/%lu dBm\n", + rtw_common_sar_freq_ranges[idx].start_freq, + rtw_common_sar_freq_ranges[idx].end_freq, + power, BIT(RTW_COMMON_SAR_FCT)); + + for (j = 0; j < RTW_RF_PATH_MAX; j++) { + for (k = 0; k < RTW_RATE_SECTION_MAX; k++) { + arg = (struct rtw_sar_arg){ + .sar_band = idx, + .path = j, + .rs = k, + }; + val = rtw_sar_to_phy(rtwdev, RTW_COMMON_SAR_FCT, + power, &arg); + new.cfg[j][k].common[idx] = val; + } + } + } + + return rtw_apply_sar(rtwdev, &new); +} +#endif + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sar.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sar.h new file mode 100644 index 0000000000000000000000000000000000000000..75f6118ef92f7f2df4b27f883e5f41e2bb1f4e5b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sar.h @@ -0,0 +1,25 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2021 Realtek Corporation + */ + +#include "main.h" + +/* NL80211_SAR_TYPE_POWER means unit is in 0.25 dBm, + * where 0.25 = 1/4 = 2^(-2), so make factor 2. + */ +#define RTW_COMMON_SAR_FCT 2 + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 11, 0) +struct rtw_sar_arg { + u8 sar_band; + u8 path; + u8 rs; +}; + +extern const struct cfg80211_sar_capa rtw_sar_capa; + +s8 rtw_query_sar(struct rtw_dev *rtwdev, const struct rtw_sar_arg *arg); +int rtw_set_sar_specs(struct rtw_dev *rtwdev, + const struct cfg80211_sar_specs *sar); +#endif + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sch_generic.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sch_generic.h new file mode 100644 index 0000000000000000000000000000000000000000..241a0c597b3ced8debb9669628830212e9f38a7e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sch_generic.h @@ -0,0 +1,849 @@ +#ifndef __NET_SCHED_GENERIC_H +#define __NET_SCHED_GENERIC_H + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +struct Qdisc_ops; +struct qdisc_walker; +struct tcf_walker; +struct module; + +struct qdisc_rate_table { + struct tc_ratespec rate; + u32 data[256]; + struct qdisc_rate_table *next; + int refcnt; +}; + +enum qdisc_state_t { + __QDISC_STATE_SCHED, + __QDISC_STATE_DEACTIVATED, +}; + +struct qdisc_size_table { + struct rcu_head rcu; + struct list_head list; + struct tc_sizespec szopts; + int refcnt; + u16 data[]; +}; + +/* similar to sk_buff_head, but skb->prev pointer is undefined. */ +struct qdisc_skb_head { + struct sk_buff *head; + struct sk_buff *tail; + __u32 qlen; + spinlock_t lock; +}; + +struct Qdisc { + int (*enqueue)(struct sk_buff *skb, + struct Qdisc *sch, + struct sk_buff **to_free); + struct sk_buff * (*dequeue)(struct Qdisc *sch); + unsigned int flags; +#define TCQ_F_BUILTIN 1 +#define TCQ_F_INGRESS 2 +#define TCQ_F_CAN_BYPASS 4 +#define TCQ_F_MQROOT 8 +#define TCQ_F_ONETXQUEUE 0x10 /* dequeue_skb() can assume all skbs are for + * q->dev_queue : It can test + * netif_xmit_frozen_or_stopped() before + * dequeueing next packet. + * Its true for MQ/MQPRIO slaves, or non + * multiqueue device. + */ +#define TCQ_F_WARN_NONWC (1 << 16) +#define TCQ_F_CPUSTATS 0x20 /* run using percpu statistics */ +#define TCQ_F_NOPARENT 0x40 /* root of its hierarchy : + * qdisc_tree_decrease_qlen() should stop. + */ + u32 limit; + const struct Qdisc_ops *ops; + struct qdisc_size_table __rcu *stab; + struct hlist_node hash; + u32 handle; + u32 parent; + void *u32_node; + + struct netdev_queue *dev_queue; + + struct net_rate_estimator __rcu *rate_est; + struct gnet_stats_basic_cpu __percpu *cpu_bstats; + struct gnet_stats_queue __percpu *cpu_qstats; + + /* + * For performance sake on SMP, we put highly modified fields at the end + */ + struct sk_buff *gso_skb ____cacheline_aligned_in_smp; + struct qdisc_skb_head q; + struct gnet_stats_basic_packed bstats; + seqcount_t running; + struct gnet_stats_queue qstats; + unsigned long state; + struct Qdisc *next_sched; + struct sk_buff *skb_bad_txq; + struct rcu_head rcu_head; + int padded; + atomic_t refcnt; + + spinlock_t busylock ____cacheline_aligned_in_smp; +}; + +static inline bool qdisc_is_running(const struct Qdisc *qdisc) +{ + return (raw_read_seqcount(&qdisc->running) & 1) ? true : false; +} + +static inline bool qdisc_run_begin(struct Qdisc *qdisc) +{ + if (qdisc_is_running(qdisc)) + return false; + /* Variant of write_seqcount_begin() telling lockdep a trylock + * was attempted. + */ + raw_write_seqcount_begin(&qdisc->running); + seqcount_acquire(&qdisc->running.dep_map, 0, 1, _RET_IP_); + return true; +} + +static inline void qdisc_run_end(struct Qdisc *qdisc) +{ + write_seqcount_end(&qdisc->running); +} + +static inline bool qdisc_may_bulk(const struct Qdisc *qdisc) +{ + return qdisc->flags & TCQ_F_ONETXQUEUE; +} + +static inline int qdisc_avail_bulklimit(const struct netdev_queue *txq) +{ +#ifdef CONFIG_BQL + /* Non-BQL migrated drivers will return 0, too. */ + return dql_avail(&txq->dql); +#else + return 0; +#endif +} + +struct Qdisc_class_ops { + /* Child qdisc manipulation */ + struct netdev_queue * (*select_queue)(struct Qdisc *, struct tcmsg *); + int (*graft)(struct Qdisc *, unsigned long cl, + struct Qdisc *, struct Qdisc **); + struct Qdisc * (*leaf)(struct Qdisc *, unsigned long cl); + void (*qlen_notify)(struct Qdisc *, unsigned long); + + /* Class manipulation routines */ + unsigned long (*get)(struct Qdisc *, u32 classid); + void (*put)(struct Qdisc *, unsigned long); + int (*change)(struct Qdisc *, u32, u32, + struct nlattr **, unsigned long *); + int (*delete)(struct Qdisc *, unsigned long); + void (*walk)(struct Qdisc *, struct qdisc_walker * arg); + + /* Filter manipulation */ + struct tcf_proto __rcu ** (*tcf_chain)(struct Qdisc *, unsigned long); + bool (*tcf_cl_offload)(u32 classid); + unsigned long (*bind_tcf)(struct Qdisc *, unsigned long, + u32 classid); + void (*unbind_tcf)(struct Qdisc *, unsigned long); + + /* rtnetlink specific */ + int (*dump)(struct Qdisc *, unsigned long, + struct sk_buff *skb, struct tcmsg*); + int (*dump_stats)(struct Qdisc *, unsigned long, + struct gnet_dump *); +}; + +struct Qdisc_ops { + struct Qdisc_ops *next; + const struct Qdisc_class_ops *cl_ops; + char id[IFNAMSIZ]; + int priv_size; + + int (*enqueue)(struct sk_buff *skb, + struct Qdisc *sch, + struct sk_buff **to_free); + struct sk_buff * (*dequeue)(struct Qdisc *); + struct sk_buff * (*peek)(struct Qdisc *); + + int (*init)(struct Qdisc *, struct nlattr *arg); + void (*reset)(struct Qdisc *); + void (*destroy)(struct Qdisc *); + int (*change)(struct Qdisc *, struct nlattr *arg); + void (*attach)(struct Qdisc *); + + int (*dump)(struct Qdisc *, struct sk_buff *); + int (*dump_stats)(struct Qdisc *, struct gnet_dump *); + + struct module *owner; +}; + + +struct tcf_result { + unsigned long class; + u32 classid; +}; + +struct tcf_proto_ops { + struct list_head head; + char kind[IFNAMSIZ]; + + int (*classify)(struct sk_buff *, + const struct tcf_proto *, + struct tcf_result *); + int (*init)(struct tcf_proto*); + bool (*destroy)(struct tcf_proto*, bool); + + unsigned long (*get)(struct tcf_proto*, u32 handle); + int (*change)(struct net *net, struct sk_buff *, + struct tcf_proto*, unsigned long, + u32 handle, struct nlattr **, + unsigned long *, bool); + int (*delete)(struct tcf_proto*, unsigned long); + void (*walk)(struct tcf_proto*, struct tcf_walker *arg); + + /* rtnetlink specific */ + int (*dump)(struct net*, struct tcf_proto*, unsigned long, + struct sk_buff *skb, struct tcmsg*); + + struct module *owner; +}; + +struct tcf_proto { + /* Fast access part */ + struct tcf_proto __rcu *next; + void __rcu *root; + int (*classify)(struct sk_buff *, + const struct tcf_proto *, + struct tcf_result *); + __be16 protocol; + + /* All the rest */ + u32 prio; + u32 classid; + struct Qdisc *q; + void *data; + const struct tcf_proto_ops *ops; + struct rcu_head rcu; +}; + +struct qdisc_skb_cb { + unsigned int pkt_len; + u16 slave_dev_queue_mapping; + u16 tc_classid; +#define QDISC_CB_PRIV_LEN 20 + unsigned char data[QDISC_CB_PRIV_LEN]; +}; + +static inline void qdisc_cb_private_validate(const struct sk_buff *skb, int sz) +{ +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) + struct qdisc_skb_cb *qcb; + + BUILD_BUG_ON(sizeof(skb->cb) < offsetof(struct qdisc_skb_cb, data) + sz); + BUILD_BUG_ON(sizeof(qcb->data) < sz); +#endif +} + +static inline int qdisc_qlen(const struct Qdisc *q) +{ + return q->q.qlen; +} + +static inline struct qdisc_skb_cb *qdisc_skb_cb(const struct sk_buff *skb) +{ + return (struct qdisc_skb_cb *)skb->cb; +} + +static inline spinlock_t *qdisc_lock(struct Qdisc *qdisc) +{ + return &qdisc->q.lock; +} + +static inline struct Qdisc *qdisc_root(const struct Qdisc *qdisc) +{ + struct Qdisc *q = rcu_dereference_rtnl(qdisc->dev_queue->qdisc); + + return q; +} + +static inline struct Qdisc *qdisc_root_sleeping(const struct Qdisc *qdisc) +{ + return qdisc->dev_queue->qdisc_sleeping; +} + +/* The qdisc root lock is a mechanism by which to top level + * of a qdisc tree can be locked from any qdisc node in the + * forest. This allows changing the configuration of some + * aspect of the qdisc tree while blocking out asynchronous + * qdisc access in the packet processing paths. + * + * It is only legal to do this when the root will not change + * on us. Otherwise we'll potentially lock the wrong qdisc + * root. This is enforced by holding the RTNL semaphore, which + * all users of this lock accessor must do. + */ +static inline spinlock_t *qdisc_root_lock(const struct Qdisc *qdisc) +{ + struct Qdisc *root = qdisc_root(qdisc); + + ASSERT_RTNL(); + return qdisc_lock(root); +} + +static inline spinlock_t *qdisc_root_sleeping_lock(const struct Qdisc *qdisc) +{ + struct Qdisc *root = qdisc_root_sleeping(qdisc); + + ASSERT_RTNL(); + return qdisc_lock(root); +} + +static inline seqcount_t *qdisc_root_sleeping_running(const struct Qdisc *qdisc) +{ + struct Qdisc *root = qdisc_root_sleeping(qdisc); + + ASSERT_RTNL(); + return &root->running; +} + +static inline struct net_device *qdisc_dev(const struct Qdisc *qdisc) +{ + return qdisc->dev_queue->dev; +} + +static inline void sch_tree_lock(const struct Qdisc *q) +{ + spin_lock_bh(qdisc_root_sleeping_lock(q)); +} + +static inline void sch_tree_unlock(const struct Qdisc *q) +{ + spin_unlock_bh(qdisc_root_sleeping_lock(q)); +} + +#define tcf_tree_lock(tp) sch_tree_lock((tp)->q) +#define tcf_tree_unlock(tp) sch_tree_unlock((tp)->q) + +extern struct Qdisc noop_qdisc; +extern struct Qdisc_ops noop_qdisc_ops; +extern struct Qdisc_ops pfifo_fast_ops; +extern struct Qdisc_ops mq_qdisc_ops; +extern struct Qdisc_ops noqueue_qdisc_ops; +extern const struct Qdisc_ops *default_qdisc_ops; +static inline const struct Qdisc_ops * +get_default_qdisc_ops(const struct net_device *dev, int ntx) +{ + return ntx < dev->real_num_tx_queues ? + default_qdisc_ops : &pfifo_fast_ops; +} + +struct Qdisc_class_common { + u32 classid; + struct hlist_node hnode; +}; + +struct Qdisc_class_hash { + struct hlist_head *hash; + unsigned int hashsize; + unsigned int hashmask; + unsigned int hashelems; +}; + +static inline unsigned int qdisc_class_hash(u32 id, u32 mask) +{ + id ^= id >> 8; + id ^= id >> 4; + return id & mask; +} + +static inline struct Qdisc_class_common * +qdisc_class_find(const struct Qdisc_class_hash *hash, u32 id) +{ + struct Qdisc_class_common *cl; + unsigned int h; + + h = qdisc_class_hash(id, hash->hashmask); + hlist_for_each_entry(cl, &hash->hash[h], hnode) { + if (cl->classid == id) + return cl; + } + return NULL; +} + +int qdisc_class_hash_init(struct Qdisc_class_hash *); +void qdisc_class_hash_insert(struct Qdisc_class_hash *, + struct Qdisc_class_common *); +void qdisc_class_hash_remove(struct Qdisc_class_hash *, + struct Qdisc_class_common *); +void qdisc_class_hash_grow(struct Qdisc *, struct Qdisc_class_hash *); +void qdisc_class_hash_destroy(struct Qdisc_class_hash *); + +void dev_init_scheduler(struct net_device *dev); +void dev_shutdown(struct net_device *dev); +void dev_activate(struct net_device *dev); +void dev_deactivate(struct net_device *dev); +void dev_deactivate_many(struct list_head *head); +struct Qdisc *dev_graft_qdisc(struct netdev_queue *dev_queue, + struct Qdisc *qdisc); +void qdisc_reset(struct Qdisc *qdisc); +void qdisc_destroy(struct Qdisc *qdisc); +void qdisc_tree_reduce_backlog(struct Qdisc *qdisc, unsigned int n, + unsigned int len); +struct Qdisc *qdisc_alloc(struct netdev_queue *dev_queue, + const struct Qdisc_ops *ops); +struct Qdisc *qdisc_create_dflt(struct netdev_queue *dev_queue, + const struct Qdisc_ops *ops, u32 parentid); +void __qdisc_calculate_pkt_len(struct sk_buff *skb, + const struct qdisc_size_table *stab); +bool tcf_destroy(struct tcf_proto *tp, bool force); +void tcf_destroy_chain(struct tcf_proto __rcu **fl); +int skb_do_redirect(struct sk_buff *); + +static inline bool skb_at_tc_ingress(const struct sk_buff *skb) +{ +#ifdef CONFIG_NET_CLS_ACT + return G_TC_AT(skb->tc_verd) & AT_INGRESS; +#else + return false; +#endif +} + +/* Reset all TX qdiscs greater then index of a device. */ +static inline void qdisc_reset_all_tx_gt(struct net_device *dev, unsigned int i) +{ + struct Qdisc *qdisc; + + for (; i < dev->num_tx_queues; i++) { + qdisc = rtnl_dereference(netdev_get_tx_queue(dev, i)->qdisc); + if (qdisc) { + spin_lock_bh(qdisc_lock(qdisc)); + qdisc_reset(qdisc); + spin_unlock_bh(qdisc_lock(qdisc)); + } + } +} + +static inline void qdisc_reset_all_tx(struct net_device *dev) +{ + qdisc_reset_all_tx_gt(dev, 0); +} + +/* Are all TX queues of the device empty? */ +static inline bool qdisc_all_tx_empty(const struct net_device *dev) +{ + unsigned int i; + + rcu_read_lock(); + for (i = 0; i < dev->num_tx_queues; i++) { + struct netdev_queue *txq = netdev_get_tx_queue(dev, i); + const struct Qdisc *q = rcu_dereference(txq->qdisc); + + if (q->q.qlen) { + rcu_read_unlock(); + return false; + } + } + rcu_read_unlock(); + return true; +} + +/* Are any of the TX qdiscs changing? */ +static inline bool qdisc_tx_changing(const struct net_device *dev) +{ + unsigned int i; + + for (i = 0; i < dev->num_tx_queues; i++) { + struct netdev_queue *txq = netdev_get_tx_queue(dev, i); + if (rcu_access_pointer(txq->qdisc) != txq->qdisc_sleeping) + return true; + } + return false; +} + +/* Is the device using the noop qdisc on all queues? */ +static inline bool qdisc_tx_is_noop(const struct net_device *dev) +{ + unsigned int i; + + for (i = 0; i < dev->num_tx_queues; i++) { + struct netdev_queue *txq = netdev_get_tx_queue(dev, i); + if (rcu_access_pointer(txq->qdisc) != &noop_qdisc) + return false; + } + return true; +} + +static inline unsigned int qdisc_pkt_len(const struct sk_buff *skb) +{ + return qdisc_skb_cb(skb)->pkt_len; +} + +/* additional qdisc xmit flags (NET_XMIT_MASK in linux/netdevice.h) */ +enum net_xmit_qdisc_t { + __NET_XMIT_STOLEN = 0x00010000, + __NET_XMIT_BYPASS = 0x00020000, +}; + +#ifdef CONFIG_NET_CLS_ACT +#define net_xmit_drop_count(e) ((e) & __NET_XMIT_STOLEN ? 0 : 1) +#else +#define net_xmit_drop_count(e) (1) +#endif + +static inline void qdisc_calculate_pkt_len(struct sk_buff *skb, + const struct Qdisc *sch) +{ +#ifdef CONFIG_NET_SCHED + struct qdisc_size_table *stab = rcu_dereference_bh(sch->stab); + + if (stab) + __qdisc_calculate_pkt_len(skb, stab); +#endif +} + +static inline int qdisc_enqueue(struct sk_buff *skb, struct Qdisc *sch, + struct sk_buff **to_free) +{ + qdisc_calculate_pkt_len(skb, sch); + return sch->enqueue(skb, sch, to_free); +} + +static inline bool qdisc_is_percpu_stats(const struct Qdisc *q) +{ + return q->flags & TCQ_F_CPUSTATS; +} + +static inline void _bstats_update(struct gnet_stats_basic_packed *bstats, + __u64 bytes, __u32 packets) +{ + bstats->bytes += bytes; + bstats->packets += packets; +} + +static inline void bstats_update(struct gnet_stats_basic_packed *bstats, + const struct sk_buff *skb) +{ + _bstats_update(bstats, + qdisc_pkt_len(skb), + skb_is_gso(skb) ? skb_shinfo(skb)->gso_segs : 1); +} + +static inline void _bstats_cpu_update(struct gnet_stats_basic_cpu *bstats, + __u64 bytes, __u32 packets) +{ + u64_stats_update_begin(&bstats->syncp); + _bstats_update(&bstats->bstats, bytes, packets); + u64_stats_update_end(&bstats->syncp); +} + +static inline void bstats_cpu_update(struct gnet_stats_basic_cpu *bstats, + const struct sk_buff *skb) +{ + u64_stats_update_begin(&bstats->syncp); + bstats_update(&bstats->bstats, skb); + u64_stats_update_end(&bstats->syncp); +} + +static inline void qdisc_bstats_cpu_update(struct Qdisc *sch, + const struct sk_buff *skb) +{ + bstats_cpu_update(this_cpu_ptr(sch->cpu_bstats), skb); +} + +static inline void qdisc_bstats_update(struct Qdisc *sch, + const struct sk_buff *skb) +{ + bstats_update(&sch->bstats, skb); +} + +static inline void qdisc_qstats_backlog_dec(struct Qdisc *sch, + const struct sk_buff *skb) +{ + sch->qstats.backlog -= qdisc_pkt_len(skb); +} + +static inline void qdisc_qstats_backlog_inc(struct Qdisc *sch, + const struct sk_buff *skb) +{ + sch->qstats.backlog += qdisc_pkt_len(skb); +} + +static inline void __qdisc_qstats_drop(struct Qdisc *sch, int count) +{ + sch->qstats.drops += count; +} + +static inline void qstats_drop_inc(struct gnet_stats_queue *qstats) +{ + qstats->drops++; +} + +static inline void qstats_overlimit_inc(struct gnet_stats_queue *qstats) +{ + qstats->overlimits++; +} + +static inline void qdisc_qstats_drop(struct Qdisc *sch) +{ + qstats_drop_inc(&sch->qstats); +} + +static inline void qdisc_qstats_cpu_drop(struct Qdisc *sch) +{ + this_cpu_inc(sch->cpu_qstats->drops); +} + +static inline void qdisc_qstats_overlimit(struct Qdisc *sch) +{ + sch->qstats.overlimits++; +} + +static inline void qdisc_skb_head_init(struct qdisc_skb_head *qh) +{ + qh->head = NULL; + qh->tail = NULL; + qh->qlen = 0; +} + +static inline int __qdisc_enqueue_tail(struct sk_buff *skb, struct Qdisc *sch, + struct qdisc_skb_head *qh) +{ + struct sk_buff *last = qh->tail; + + if (last) { + skb->next = NULL; + last->next = skb; + qh->tail = skb; + } else { + qh->tail = skb; + qh->head = skb; + } + qh->qlen++; + qdisc_qstats_backlog_inc(sch, skb); + + return NET_XMIT_SUCCESS; +} + +static inline int qdisc_enqueue_tail(struct sk_buff *skb, struct Qdisc *sch) +{ + return __qdisc_enqueue_tail(skb, sch, &sch->q); +} + +static inline struct sk_buff *__qdisc_dequeue_head(struct qdisc_skb_head *qh) +{ + struct sk_buff *skb = qh->head; + + if (likely(skb != NULL)) { + qh->head = skb->next; + qh->qlen--; + if (qh->head == NULL) + qh->tail = NULL; + skb->next = NULL; + } + + return skb; +} + +static inline struct sk_buff *qdisc_dequeue_head(struct Qdisc *sch) +{ + struct sk_buff *skb = __qdisc_dequeue_head(&sch->q); + + if (likely(skb != NULL)) { + qdisc_qstats_backlog_dec(sch, skb); + qdisc_bstats_update(sch, skb); + } + + return skb; +} + +/* Instead of calling kfree_skb() while root qdisc lock is held, + * queue the skb for future freeing at end of __dev_xmit_skb() + */ +static inline void __qdisc_drop(struct sk_buff *skb, struct sk_buff **to_free) +{ + skb->next = *to_free; + *to_free = skb; +} + +static inline unsigned int __qdisc_queue_drop_head(struct Qdisc *sch, + struct qdisc_skb_head *qh, + struct sk_buff **to_free) +{ + struct sk_buff *skb = __qdisc_dequeue_head(qh); + + if (likely(skb != NULL)) { + unsigned int len = qdisc_pkt_len(skb); + + qdisc_qstats_backlog_dec(sch, skb); + __qdisc_drop(skb, to_free); + return len; + } + + return 0; +} + +static inline unsigned int qdisc_queue_drop_head(struct Qdisc *sch, + struct sk_buff **to_free) +{ + return __qdisc_queue_drop_head(sch, &sch->q, to_free); +} + +static inline struct sk_buff *qdisc_peek_head(struct Qdisc *sch) +{ + const struct qdisc_skb_head *qh = &sch->q; + + return qh->head; +} + +/* generic pseudo peek method for non-work-conserving qdisc */ +static inline struct sk_buff *qdisc_peek_dequeued(struct Qdisc *sch) +{ + /* we can reuse ->gso_skb because peek isn't called for root qdiscs */ + if (!sch->gso_skb) { + sch->gso_skb = sch->dequeue(sch); + if (sch->gso_skb) { + /* it's still part of the queue */ + qdisc_qstats_backlog_inc(sch, sch->gso_skb); + sch->q.qlen++; + } + } + + return sch->gso_skb; +} + +/* use instead of qdisc->dequeue() for all qdiscs queried with ->peek() */ +static inline struct sk_buff *qdisc_dequeue_peeked(struct Qdisc *sch) +{ + struct sk_buff *skb = sch->gso_skb; + + if (skb) { + sch->gso_skb = NULL; + qdisc_qstats_backlog_dec(sch, skb); + sch->q.qlen--; + } else { + skb = sch->dequeue(sch); + } + + return skb; +} + +static inline void __qdisc_reset_queue(struct qdisc_skb_head *qh) +{ + /* + * We do not know the backlog in bytes of this list, it + * is up to the caller to correct it + */ + ASSERT_RTNL(); + if (qh->qlen) { + rtnl_kfree_skbs(qh->head, qh->tail); + + qh->head = NULL; + qh->tail = NULL; + qh->qlen = 0; + } +} + +static inline void qdisc_reset_queue(struct Qdisc *sch) +{ + __qdisc_reset_queue(&sch->q); + sch->qstats.backlog = 0; +} + +static inline struct Qdisc *qdisc_replace(struct Qdisc *sch, struct Qdisc *new, + struct Qdisc **pold) +{ + struct Qdisc *old; + + sch_tree_lock(sch); + old = *pold; + *pold = new; + if (old != NULL) { + qdisc_tree_reduce_backlog(old, old->q.qlen, old->qstats.backlog); + qdisc_reset(old); + } + sch_tree_unlock(sch); + + return old; +} + +static inline void rtnl_qdisc_drop(struct sk_buff *skb, struct Qdisc *sch) +{ + rtnl_kfree_skbs(skb, skb); + qdisc_qstats_drop(sch); +} + + +static inline int qdisc_drop(struct sk_buff *skb, struct Qdisc *sch, + struct sk_buff **to_free) +{ + __qdisc_drop(skb, to_free); + qdisc_qstats_drop(sch); + + return NET_XMIT_DROP; +} + +/* Length to Time (L2T) lookup in a qdisc_rate_table, to determine how + long it will take to send a packet given its size. + */ +static inline u32 qdisc_l2t(struct qdisc_rate_table* rtab, unsigned int pktlen) +{ + int slot = pktlen + rtab->rate.cell_align + rtab->rate.overhead; + if (slot < 0) + slot = 0; + slot >>= rtab->rate.cell_log; + if (slot > 255) + return rtab->data[255]*(slot >> 8) + rtab->data[slot & 0xFF]; + return rtab->data[slot]; +} + +struct psched_ratecfg { + u64 rate_bytes_ps; /* bytes per second */ + u32 mult; + u16 overhead; + u8 linklayer; + u8 shift; +}; + +static inline u64 psched_l2t_ns(const struct psched_ratecfg *r, + unsigned int len) +{ + len += r->overhead; + + if (unlikely(r->linklayer == TC_LINKLAYER_ATM)) + return ((u64)(DIV_ROUND_UP(len,48)*53) * r->mult) >> r->shift; + + return ((u64)len * r->mult) >> r->shift; +} + +void psched_ratecfg_precompute(struct psched_ratecfg *r, + const struct tc_ratespec *conf, + u64 rate64); + +static inline void psched_ratecfg_getrate(struct tc_ratespec *res, + const struct psched_ratecfg *r) +{ + memset(res, 0, sizeof(*res)); + + /* legacy struct tc_ratespec has a 32bit @rate field + * Qdisc using 64bit rate should add new attributes + * in order to maintain compatibility. + */ + res->rate = min_t(u64, r->rate_bytes_ps, ~0U); + + res->overhead = r->overhead; + res->linklayer = (r->linklayer & TC_LINKLAYER_MASK); +} + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sdio.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sdio.c new file mode 100644 index 0000000000000000000000000000000000000000..b19262ec5d8cf31c25e81b52c2049dccb31bec5a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sdio.c @@ -0,0 +1,1416 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright (C) 2021 Martin Blumenstingl + * Copyright (C) 2021 Jernej Skrabec + * + * Based on rtw88/pci.c: + * Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include +#include "main.h" +#include "debug.h" +#include "fw.h" +#include "ps.h" +#include "reg.h" +#include "rx.h" +#include "sdio.h" +#include "tx.h" + +#define RTW_SDIO_INDIRECT_RW_RETRIES 50 + +static bool rtw_sdio_is_bus_addr(u32 addr) +{ + return !!(addr & RTW_SDIO_BUS_MSK); +} + +static bool rtw_sdio_bus_claim_needed(struct rtw_sdio *rtwsdio) +{ + return !rtwsdio->irq_thread || + rtwsdio->irq_thread != current; +} + +static u32 rtw_sdio_to_bus_offset(struct rtw_dev *rtwdev, u32 addr) +{ + switch (addr & RTW_SDIO_BUS_MSK) { + case WLAN_IOREG_OFFSET: + addr &= WLAN_IOREG_REG_MSK; + addr |= FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, + REG_SDIO_CMD_ADDR_MAC_REG); + break; + case SDIO_LOCAL_OFFSET: + addr &= SDIO_LOCAL_REG_MSK; + addr |= FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, + REG_SDIO_CMD_ADDR_SDIO_REG); + break; + default: + rtw_warn(rtwdev, "Cannot convert addr 0x%08x to bus offset", + addr); + } + + return addr; +} + +static bool rtw_sdio_use_memcpy_io(struct rtw_dev *rtwdev, u32 addr, + u8 alignment) +{ + return IS_ALIGNED(addr, alignment) && + test_bit(RTW_FLAG_POWERON, rtwdev->flags); +} + +static void rtw_sdio_writel(struct rtw_dev *rtwdev, u32 val, u32 addr, + int *err_ret) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + u8 buf[4]; + int i; + + if (rtw_sdio_use_memcpy_io(rtwdev, addr, 4)) { + sdio_writel(rtwsdio->sdio_func, val, addr, err_ret); + return; + } + + *(__le32 *)buf = cpu_to_le32(val); + + for (i = 0; i < 4; i++) { + sdio_writeb(rtwsdio->sdio_func, buf[i], addr + i, err_ret); + if (*err_ret) + return; + } +} + +static void rtw_sdio_writew(struct rtw_dev *rtwdev, u16 val, u32 addr, + int *err_ret) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + u8 buf[2]; + int i; + + *(__le16 *)buf = cpu_to_le16(val); + + for (i = 0; i < 2; i++) { + sdio_writeb(rtwsdio->sdio_func, buf[i], addr + i, err_ret); + if (*err_ret) + return; + } +} + +static u32 rtw_sdio_readl(struct rtw_dev *rtwdev, u32 addr, int *err_ret) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + u8 buf[4]; + int i; + + if (rtw_sdio_use_memcpy_io(rtwdev, addr, 4)) + return sdio_readl(rtwsdio->sdio_func, addr, err_ret); + + for (i = 0; i < 4; i++) { + buf[i] = sdio_readb(rtwsdio->sdio_func, addr + i, err_ret); + if (*err_ret) + return 0; + } + + return le32_to_cpu(*(__le32 *)buf); +} + +static u16 rtw_sdio_readw(struct rtw_dev *rtwdev, u32 addr, int *err_ret) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + u8 buf[2]; + int i; + + for (i = 0; i < 2; i++) { + buf[i] = sdio_readb(rtwsdio->sdio_func, addr + i, err_ret); + if (*err_ret) + return 0; + } + + return le16_to_cpu(*(__le16 *)buf); +} + +static u32 rtw_sdio_to_io_address(struct rtw_dev *rtwdev, u32 addr, + bool direct) +{ + if (!direct) + return addr; + + if (!rtw_sdio_is_bus_addr(addr)) + addr |= WLAN_IOREG_OFFSET; + + return rtw_sdio_to_bus_offset(rtwdev, addr); +} + +static bool rtw_sdio_use_direct_io(struct rtw_dev *rtwdev, u32 addr) +{ + return !rtw_sdio_is_sdio30_supported(rtwdev) || + rtw_sdio_is_bus_addr(addr); +} + +static int rtw_sdio_indirect_reg_cfg(struct rtw_dev *rtwdev, u32 addr, u32 cfg) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + unsigned int retry; + u32 reg_cfg; + int ret; + u8 tmp; + + reg_cfg = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_CFG); + + rtw_sdio_writel(rtwdev, addr | cfg | BIT_SDIO_INDIRECT_REG_CFG_UNK20, + reg_cfg, &ret); + if (ret) + return ret; + + for (retry = 0; retry < RTW_SDIO_INDIRECT_RW_RETRIES; retry++) { + tmp = sdio_readb(rtwsdio->sdio_func, reg_cfg + 2, &ret); + if (!ret && (tmp & BIT(4))) + return 0; + } + + return -ETIMEDOUT; +} + +static u8 rtw_sdio_indirect_read8(struct rtw_dev *rtwdev, u32 addr, + int *err_ret) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + u32 reg_data; + + *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, + BIT_SDIO_INDIRECT_REG_CFG_READ); + if (*err_ret) + return 0; + + reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); + return sdio_readb(rtwsdio->sdio_func, reg_data, err_ret); +} + +static int rtw_sdio_indirect_read_bytes(struct rtw_dev *rtwdev, u32 addr, + u8 *buf, int count) +{ + int i, ret = 0; + + for (i = 0; i < count; i++) { + buf[i] = rtw_sdio_indirect_read8(rtwdev, addr + i, &ret); + if (ret) + break; + } + + return ret; +} + +static u16 rtw_sdio_indirect_read16(struct rtw_dev *rtwdev, u32 addr, + int *err_ret) +{ + u32 reg_data; + u8 buf[2]; + + if (!IS_ALIGNED(addr, 2)) { + *err_ret = rtw_sdio_indirect_read_bytes(rtwdev, addr, buf, 2); + if (*err_ret) + return 0; + + return le16_to_cpu(*(__le16 *)buf); + } + + *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, + BIT_SDIO_INDIRECT_REG_CFG_READ); + if (*err_ret) + return 0; + + reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); + return rtw_sdio_readw(rtwdev, reg_data, err_ret); +} + +static u32 rtw_sdio_indirect_read32(struct rtw_dev *rtwdev, u32 addr, + int *err_ret) +{ + u32 reg_data; + u8 buf[4]; + + if (!IS_ALIGNED(addr, 4)) { + *err_ret = rtw_sdio_indirect_read_bytes(rtwdev, addr, buf, 4); + if (*err_ret) + return 0; + + return le32_to_cpu(*(__le32 *)buf); + } + + *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, + BIT_SDIO_INDIRECT_REG_CFG_READ); + if (*err_ret) + return 0; + + reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); + return rtw_sdio_readl(rtwdev, reg_data, err_ret); +} + +static u8 rtw_sdio_read8(struct rtw_dev *rtwdev, u32 addr) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + bool direct, bus_claim; + int ret; + u8 val; + + direct = rtw_sdio_use_direct_io(rtwdev, addr); + addr = rtw_sdio_to_io_address(rtwdev, addr, direct); + bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); + + if (bus_claim) + sdio_claim_host(rtwsdio->sdio_func); + + if (direct) + val = sdio_readb(rtwsdio->sdio_func, addr, &ret); + else + val = rtw_sdio_indirect_read8(rtwdev, addr, &ret); + + if (bus_claim) + sdio_release_host(rtwsdio->sdio_func); + + if (ret) + rtw_warn(rtwdev, "sdio read8 failed (0x%x): %d", addr, ret); + + return val; +} + +static u16 rtw_sdio_read16(struct rtw_dev *rtwdev, u32 addr) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + bool direct, bus_claim; + int ret; + u16 val; + + direct = rtw_sdio_use_direct_io(rtwdev, addr); + addr = rtw_sdio_to_io_address(rtwdev, addr, direct); + bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); + + if (bus_claim) + sdio_claim_host(rtwsdio->sdio_func); + + if (direct) + val = rtw_sdio_readw(rtwdev, addr, &ret); + else + val = rtw_sdio_indirect_read16(rtwdev, addr, &ret); + + if (bus_claim) + sdio_release_host(rtwsdio->sdio_func); + + if (ret) + rtw_warn(rtwdev, "sdio read16 failed (0x%x): %d", addr, ret); + + return val; +} + +static u32 rtw_sdio_read32(struct rtw_dev *rtwdev, u32 addr) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + bool direct, bus_claim; + u32 val; + int ret; + + direct = rtw_sdio_use_direct_io(rtwdev, addr); + addr = rtw_sdio_to_io_address(rtwdev, addr, direct); + bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); + + if (bus_claim) + sdio_claim_host(rtwsdio->sdio_func); + + if (direct) + val = rtw_sdio_readl(rtwdev, addr, &ret); + else + val = rtw_sdio_indirect_read32(rtwdev, addr, &ret); + + if (bus_claim) + sdio_release_host(rtwsdio->sdio_func); + + if (ret) + rtw_warn(rtwdev, "sdio read32 failed (0x%x): %d", addr, ret); + + return val; +} + +static void rtw_sdio_indirect_write8(struct rtw_dev *rtwdev, u8 val, u32 addr, + int *err_ret) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + u32 reg_data; + + reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); + sdio_writeb(rtwsdio->sdio_func, val, reg_data, err_ret); + if (*err_ret) + return; + + *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, + BIT_SDIO_INDIRECT_REG_CFG_WRITE); +} + +static void rtw_sdio_indirect_write16(struct rtw_dev *rtwdev, u16 val, u32 addr, + int *err_ret) +{ + u32 reg_data; + + if (!IS_ALIGNED(addr, 2)) { + addr = rtw_sdio_to_io_address(rtwdev, addr, true); + rtw_sdio_writew(rtwdev, val, addr, err_ret); + return; + } + + reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); + rtw_sdio_writew(rtwdev, val, reg_data, err_ret); + if (*err_ret) + return; + + *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, + BIT_SDIO_INDIRECT_REG_CFG_WRITE | + BIT_SDIO_INDIRECT_REG_CFG_WORD); +} + +static void rtw_sdio_indirect_write32(struct rtw_dev *rtwdev, u32 val, + u32 addr, int *err_ret) +{ + u32 reg_data; + + if (!IS_ALIGNED(addr, 4)) { + addr = rtw_sdio_to_io_address(rtwdev, addr, true); + rtw_sdio_writel(rtwdev, val, addr, err_ret); + return; + } + + reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); + rtw_sdio_writel(rtwdev, val, reg_data, err_ret); + + *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, + BIT_SDIO_INDIRECT_REG_CFG_WRITE | + BIT_SDIO_INDIRECT_REG_CFG_DWORD); +} + +static void rtw_sdio_write8(struct rtw_dev *rtwdev, u32 addr, u8 val) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + bool direct, bus_claim; + int ret; + + direct = rtw_sdio_use_direct_io(rtwdev, addr); + addr = rtw_sdio_to_io_address(rtwdev, addr, direct); + bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); + + if (bus_claim) + sdio_claim_host(rtwsdio->sdio_func); + + if (direct) + sdio_writeb(rtwsdio->sdio_func, val, addr, &ret); + else + rtw_sdio_indirect_write8(rtwdev, val, addr, &ret); + + if (bus_claim) + sdio_release_host(rtwsdio->sdio_func); + + if (ret) + rtw_warn(rtwdev, "sdio write8 failed (0x%x): %d", addr, ret); +} + +static void rtw_sdio_write16(struct rtw_dev *rtwdev, u32 addr, u16 val) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + bool direct, bus_claim; + int ret; + + direct = rtw_sdio_use_direct_io(rtwdev, addr); + addr = rtw_sdio_to_io_address(rtwdev, addr, direct); + bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); + + if (bus_claim) + sdio_claim_host(rtwsdio->sdio_func); + + if (direct) + rtw_sdio_writew(rtwdev, val, addr, &ret); + else + rtw_sdio_indirect_write16(rtwdev, val, addr, &ret); + + if (bus_claim) + sdio_release_host(rtwsdio->sdio_func); + + if (ret) + rtw_warn(rtwdev, "sdio write16 failed (0x%x): %d", addr, ret); +} + +static void rtw_sdio_write32(struct rtw_dev *rtwdev, u32 addr, u32 val) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + bool direct, bus_claim; + int ret; + + direct = rtw_sdio_use_direct_io(rtwdev, addr); + addr = rtw_sdio_to_io_address(rtwdev, addr, direct); + bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); + + if (bus_claim) + sdio_claim_host(rtwsdio->sdio_func); + + if (direct) + rtw_sdio_writel(rtwdev, val, addr, &ret); + else + rtw_sdio_indirect_write32(rtwdev, val, addr, &ret); + + if (bus_claim) + sdio_release_host(rtwsdio->sdio_func); + + if (ret) + rtw_warn(rtwdev, "sdio write32 failed (0x%x): %d", addr, ret); +} + +static u32 rtw_sdio_get_tx_addr(struct rtw_dev *rtwdev, size_t size, + enum rtw_tx_queue_type queue) +{ + u32 txaddr; + + switch (queue) { + case RTW_TX_QUEUE_BCN: + case RTW_TX_QUEUE_H2C: + case RTW_TX_QUEUE_HI0: + txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, + REG_SDIO_CMD_ADDR_TXFF_HIGH); + break; + case RTW_TX_QUEUE_VI: + case RTW_TX_QUEUE_VO: + txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, + REG_SDIO_CMD_ADDR_TXFF_NORMAL); + break; + case RTW_TX_QUEUE_BE: + case RTW_TX_QUEUE_BK: + txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, + REG_SDIO_CMD_ADDR_TXFF_LOW); + break; + case RTW_TX_QUEUE_MGMT: + txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, + REG_SDIO_CMD_ADDR_TXFF_EXTRA); + break; + default: + rtw_warn(rtwdev, "Unsupported queue for TX addr: 0x%02x\n", + queue); + return 0; + } + + txaddr += DIV_ROUND_UP(size, 4); + + return txaddr; +}; + +static int rtw_sdio_read_port(struct rtw_dev *rtwdev, u8 *buf, size_t count) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + struct mmc_host *host = rtwsdio->sdio_func->card->host; + bool bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); + u32 rxaddr = rtwsdio->rx_addr++; + size_t bytes; + int ret; + + if (bus_claim) + sdio_claim_host(rtwsdio->sdio_func); + + while (count > 0) { + bytes = min_t(size_t, host->max_req_size, count); + + ret = sdio_memcpy_fromio(rtwsdio->sdio_func, buf, + RTW_SDIO_ADDR_RX_RX0FF_GEN(rxaddr), + bytes); + if (ret) { + rtw_warn(rtwdev, + "Failed to read %zu byte(s) from SDIO port 0x%08x", + bytes, rxaddr); + break; + } + + count -= bytes; + buf += bytes; + } + + if (bus_claim) + sdio_release_host(rtwsdio->sdio_func); + + return ret; +} + +static int rtw_sdio_check_free_txpg(struct rtw_dev *rtwdev, u8 queue, + size_t count) +{ + unsigned int pages_free, pages_needed; + + if (rtw_chip_wcpu_11n(rtwdev)) { + u32 free_txpg; + + free_txpg = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG); + + switch (queue) { + case RTW_TX_QUEUE_BCN: + case RTW_TX_QUEUE_H2C: + case RTW_TX_QUEUE_HI0: + case RTW_TX_QUEUE_MGMT: + /* high */ + pages_free = free_txpg & 0xff; + break; + case RTW_TX_QUEUE_VI: + case RTW_TX_QUEUE_VO: + /* normal */ + pages_free = (free_txpg >> 8) & 0xff; + break; + case RTW_TX_QUEUE_BE: + case RTW_TX_QUEUE_BK: + /* low */ + pages_free = (free_txpg >> 16) & 0xff; + break; + default: + rtw_warn(rtwdev, "Unknown mapping for queue %u\n", queue); + return -EINVAL; + } + + /* add the pages from the public queue */ + pages_free += (free_txpg >> 24) & 0xff; + } else { + u32 free_txpg[3]; + + free_txpg[0] = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG); + free_txpg[1] = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG + 4); + free_txpg[2] = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG + 8); + + switch (queue) { + case RTW_TX_QUEUE_BCN: + case RTW_TX_QUEUE_H2C: + case RTW_TX_QUEUE_HI0: + /* high */ + pages_free = free_txpg[0] & 0xfff; + break; + case RTW_TX_QUEUE_VI: + case RTW_TX_QUEUE_VO: + /* normal */ + pages_free = (free_txpg[0] >> 16) & 0xfff; + break; + case RTW_TX_QUEUE_BE: + case RTW_TX_QUEUE_BK: + /* low */ + pages_free = free_txpg[1] & 0xfff; + break; + case RTW_TX_QUEUE_MGMT: + /* extra */ + pages_free = free_txpg[2] & 0xfff; + break; + default: + rtw_warn(rtwdev, "Unknown mapping for queue %u\n", queue); + return -EINVAL; + } + + /* add the pages from the public queue */ + pages_free += (free_txpg[1] >> 16) & 0xfff; + } + + pages_needed = DIV_ROUND_UP(count, rtwdev->chip->page_size); + + if (pages_needed > pages_free) { + rtw_dbg(rtwdev, RTW_DBG_SDIO, + "Not enough free pages (%u needed, %u free) in queue %u for %zu bytes\n", + pages_needed, pages_free, queue, count); + return -EBUSY; + } + + return 0; +} + +static int rtw_sdio_write_port(struct rtw_dev *rtwdev, struct sk_buff *skb, + enum rtw_tx_queue_type queue) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + bool bus_claim; + size_t txsize; + u32 txaddr; + int ret; + + txaddr = rtw_sdio_get_tx_addr(rtwdev, skb->len, queue); + if (!txaddr) + return -EINVAL; + + txsize = sdio_align_size(rtwsdio->sdio_func, skb->len); + + ret = rtw_sdio_check_free_txpg(rtwdev, queue, txsize); + if (ret) + return ret; + + if (!IS_ALIGNED((unsigned long)skb->data, RTW_SDIO_DATA_PTR_ALIGN)) + rtw_warn(rtwdev, "Got unaligned SKB in %s() for queue %u\n", + __func__, queue); + + bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); + + if (bus_claim) + sdio_claim_host(rtwsdio->sdio_func); + + ret = sdio_memcpy_toio(rtwsdio->sdio_func, txaddr, skb->data, txsize); + + if (bus_claim) + sdio_release_host(rtwsdio->sdio_func); + + if (ret) + rtw_warn(rtwdev, + "Failed to write %zu byte(s) to SDIO port 0x%08x", + txsize, txaddr); + + return ret; +} + +static void rtw_sdio_init(struct rtw_dev *rtwdev) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + + rtwsdio->irq_mask = REG_SDIO_HIMR_RX_REQUEST | REG_SDIO_HIMR_CPWM1; +} + +static void rtw_sdio_enable_rx_aggregation(struct rtw_dev *rtwdev) +{ + u8 size, timeout; + + if (rtw_chip_wcpu_11n(rtwdev)) { + size = 0x6; + timeout = 0x6; + } else { + size = 0xff; + timeout = 0x1; + } + + /* Make the firmware honor the size limit configured below */ + rtw_write32_set(rtwdev, REG_RXDMA_AGG_PG_TH, BIT_EN_PRE_CALC); + + rtw_write8_set(rtwdev, REG_TXDMA_PQ_MAP, BIT_RXDMA_AGG_EN); + + rtw_write16(rtwdev, REG_RXDMA_AGG_PG_TH, + FIELD_PREP(BIT_RXDMA_AGG_PG_TH, size) | + FIELD_PREP(BIT_DMA_AGG_TO_V1, timeout)); + + rtw_write8_set(rtwdev, REG_RXDMA_MODE, BIT_DMA_MODE); +} + +static void rtw_sdio_enable_interrupt(struct rtw_dev *rtwdev) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + + rtw_write32(rtwdev, REG_SDIO_HIMR, rtwsdio->irq_mask); +} + +static void rtw_sdio_disable_interrupt(struct rtw_dev *rtwdev) +{ + rtw_write32(rtwdev, REG_SDIO_HIMR, 0x0); +} + +static u8 rtw_sdio_get_tx_qsel(struct rtw_dev *rtwdev, struct sk_buff *skb, + u8 queue) +{ + switch (queue) { + case RTW_TX_QUEUE_BCN: + return TX_DESC_QSEL_BEACON; + case RTW_TX_QUEUE_H2C: + return TX_DESC_QSEL_H2C; + case RTW_TX_QUEUE_MGMT: + if (rtw_chip_wcpu_11n(rtwdev)) + return TX_DESC_QSEL_HIGH; + else + return TX_DESC_QSEL_MGMT; + case RTW_TX_QUEUE_HI0: + return TX_DESC_QSEL_HIGH; + default: + return skb->priority; + } +} + +static int rtw_sdio_setup(struct rtw_dev *rtwdev) +{ + /* nothing to do */ + return 0; +} + +static int rtw_sdio_start(struct rtw_dev *rtwdev) +{ + rtw_sdio_enable_rx_aggregation(rtwdev); + rtw_sdio_enable_interrupt(rtwdev); + + return 0; +} + +static void rtw_sdio_stop(struct rtw_dev *rtwdev) +{ + rtw_sdio_disable_interrupt(rtwdev); +} + +static void rtw_sdio_deep_ps_enter(struct rtw_dev *rtwdev) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + bool tx_empty = true; + u8 queue; + + if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) { + /* Deep PS state is not allowed to TX-DMA */ + for (queue = 0; queue < RTK_MAX_TX_QUEUE_NUM; queue++) { + /* BCN queue is rsvd page, does not have DMA interrupt + * H2C queue is managed by firmware + */ + if (queue == RTW_TX_QUEUE_BCN || + queue == RTW_TX_QUEUE_H2C) + continue; + + /* check if there is any skb DMAing */ + if (skb_queue_len(&rtwsdio->tx_queue[queue])) { + tx_empty = false; + break; + } + } + } + + if (!tx_empty) { + rtw_dbg(rtwdev, RTW_DBG_PS, + "TX path not empty, cannot enter deep power save state\n"); + return; + } + + set_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags); + rtw_power_mode_change(rtwdev, true); +} + +static void rtw_sdio_deep_ps_leave(struct rtw_dev *rtwdev) +{ + if (test_and_clear_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) + rtw_power_mode_change(rtwdev, false); +} + +static void rtw_sdio_deep_ps(struct rtw_dev *rtwdev, bool enter) +{ + if (enter && !test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) + rtw_sdio_deep_ps_enter(rtwdev); + + if (!enter && test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) + rtw_sdio_deep_ps_leave(rtwdev); +} + +static void rtw_sdio_tx_kick_off(struct rtw_dev *rtwdev) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + + queue_work(rtwsdio->txwq, &rtwsdio->tx_handler_data->work); +} + +static void rtw_sdio_link_ps(struct rtw_dev *rtwdev, bool enter) +{ + /* nothing to do */ +} + +static void rtw_sdio_interface_cfg(struct rtw_dev *rtwdev) +{ + u32 val; + + rtw_read32(rtwdev, REG_SDIO_FREE_TXPG); + + val = rtw_read32(rtwdev, REG_SDIO_TX_CTRL); + val &= 0xfff8; + rtw_write32(rtwdev, REG_SDIO_TX_CTRL, val); +} + +static struct rtw_sdio_tx_data *rtw_sdio_get_tx_data(struct sk_buff *skb) +{ + struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); + + BUILD_BUG_ON(sizeof(struct rtw_sdio_tx_data) > + sizeof(info->status.status_driver_data)); + + return (struct rtw_sdio_tx_data *)info->status.status_driver_data; +} + +static void rtw_sdio_tx_skb_prepare(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb, + enum rtw_tx_queue_type queue) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + unsigned long data_addr, aligned_addr; + size_t offset; + u8 *pkt_desc; + + pkt_desc = skb_push(skb, chip->tx_pkt_desc_sz); + + data_addr = (unsigned long)pkt_desc; + aligned_addr = ALIGN(data_addr, RTW_SDIO_DATA_PTR_ALIGN); + + if (data_addr != aligned_addr) { + /* Ensure that the start of the pkt_desc is always aligned at + * RTW_SDIO_DATA_PTR_ALIGN. + */ + offset = RTW_SDIO_DATA_PTR_ALIGN - (aligned_addr - data_addr); + + pkt_desc = skb_push(skb, offset); + + /* By inserting padding to align the start of the pkt_desc we + * need to inform the firmware that the actual data starts at + * a different offset than normal. + */ + pkt_info->offset += offset; + } + + memset(pkt_desc, 0, chip->tx_pkt_desc_sz); + + pkt_info->qsel = rtw_sdio_get_tx_qsel(rtwdev, skb, queue); + + rtw_tx_fill_tx_desc(pkt_info, skb); + rtw_tx_fill_txdesc_checksum(rtwdev, pkt_info, pkt_desc); +} + +static int rtw_sdio_write_data(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb, + enum rtw_tx_queue_type queue) +{ + int ret; + + rtw_sdio_tx_skb_prepare(rtwdev, pkt_info, skb, queue); + + ret = rtw_sdio_write_port(rtwdev, skb, queue); + dev_kfree_skb_any(skb); + + return ret; +} + +static int rtw_sdio_write_data_rsvd_page(struct rtw_dev *rtwdev, u8 *buf, + u32 size) +{ + struct rtw_tx_pkt_info pkt_info = {}; + struct sk_buff *skb; + + skb = rtw_tx_write_data_rsvd_page_get(rtwdev, &pkt_info, buf, size); + if (!skb) + return -ENOMEM; + + return rtw_sdio_write_data(rtwdev, &pkt_info, skb, RTW_TX_QUEUE_BCN); +} + +static int rtw_sdio_write_data_h2c(struct rtw_dev *rtwdev, u8 *buf, u32 size) +{ + struct rtw_tx_pkt_info pkt_info = {}; + struct sk_buff *skb; + + skb = rtw_tx_write_data_h2c_get(rtwdev, &pkt_info, buf, size); + if (!skb) + return -ENOMEM; + + return rtw_sdio_write_data(rtwdev, &pkt_info, skb, RTW_TX_QUEUE_H2C); +} + +static int rtw_sdio_tx_write(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + enum rtw_tx_queue_type queue = rtw_tx_queue_mapping(skb); + struct rtw_sdio_tx_data *tx_data; + + rtw_sdio_tx_skb_prepare(rtwdev, pkt_info, skb, queue); + + tx_data = rtw_sdio_get_tx_data(skb); + tx_data->sn = pkt_info->sn; + + skb_queue_tail(&rtwsdio->tx_queue[queue], skb); + + return 0; +} + +static void rtw_sdio_tx_err_isr(struct rtw_dev *rtwdev) +{ + u32 val = rtw_read32(rtwdev, REG_TXDMA_STATUS); + + rtw_write32(rtwdev, REG_TXDMA_STATUS, val); +} + +static void rtw_sdio_rx_skb(struct rtw_dev *rtwdev, struct sk_buff *skb, + u32 pkt_offset, struct rtw_rx_pkt_stat *pkt_stat, + struct ieee80211_rx_status *rx_status) +{ + *IEEE80211_SKB_RXCB(skb) = *rx_status; + + if (pkt_stat->is_c2h) { + skb_put(skb, pkt_stat->pkt_len + pkt_offset); + rtw_fw_c2h_cmd_rx_irqsafe(rtwdev, pkt_offset, skb); + return; + } + + skb_put(skb, pkt_stat->pkt_len); + skb_reserve(skb, pkt_offset); + + rtw_rx_stats(rtwdev, pkt_stat->vif, skb); + + ieee80211_rx_irqsafe(rtwdev->hw, skb); +} + +static void rtw_sdio_rxfifo_recv(struct rtw_dev *rtwdev, u32 rx_len) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + const struct rtw_chip_info *chip = rtwdev->chip; + u32 pkt_desc_sz = chip->rx_pkt_desc_sz; + struct ieee80211_rx_status rx_status; + struct rtw_rx_pkt_stat pkt_stat; + struct sk_buff *skb, *split_skb; + u32 pkt_offset, curr_pkt_len; + size_t bufsz; + u8 *rx_desc; + int ret; + + bufsz = sdio_align_size(rtwsdio->sdio_func, rx_len); + + skb = dev_alloc_skb(bufsz); + if (!skb) + return; + + ret = rtw_sdio_read_port(rtwdev, skb->data, bufsz); + if (ret) { + dev_kfree_skb_any(skb); + return; + } + + while (true) { + rx_desc = skb->data; + chip->ops->query_rx_desc(rtwdev, rx_desc, &pkt_stat, + &rx_status); + pkt_offset = pkt_desc_sz + pkt_stat.drv_info_sz + + pkt_stat.shift; + + curr_pkt_len = ALIGN(pkt_offset + pkt_stat.pkt_len, + RTW_SDIO_DATA_PTR_ALIGN); + + if ((curr_pkt_len + pkt_desc_sz) >= rx_len) { + /* Use the original skb (with it's adjusted offset) + * when processing the last (or even the only) entry to + * have it's memory freed automatically. + */ + rtw_sdio_rx_skb(rtwdev, skb, pkt_offset, &pkt_stat, + &rx_status); + break; + } + + split_skb = dev_alloc_skb(curr_pkt_len); + if (!split_skb) { + rtw_sdio_rx_skb(rtwdev, skb, pkt_offset, &pkt_stat, + &rx_status); + break; + } + + skb_copy_header(split_skb, skb); + memcpy(split_skb->data, skb->data, curr_pkt_len); + + rtw_sdio_rx_skb(rtwdev, split_skb, pkt_offset, &pkt_stat, + &rx_status); + + /* Move to the start of the next RX descriptor */ + skb_reserve(skb, curr_pkt_len); + rx_len -= curr_pkt_len; + } +} + +static void rtw_sdio_rx_isr(struct rtw_dev *rtwdev) +{ + u32 rx_len, hisr, total_rx_bytes = 0; + + do { + if (rtw_chip_wcpu_11n(rtwdev)) + rx_len = rtw_read16(rtwdev, REG_SDIO_RX0_REQ_LEN); + else + rx_len = rtw_read32(rtwdev, REG_SDIO_RX0_REQ_LEN); + + if (!rx_len) + break; + + rtw_sdio_rxfifo_recv(rtwdev, rx_len); + + total_rx_bytes += rx_len; + + if (rtw_chip_wcpu_11n(rtwdev)) { + /* Stop if no more RX requests are pending, even if + * rx_len could be greater than zero in the next + * iteration. This is needed because the RX buffer may + * already contain data while either HW or FW are not + * done filling that buffer yet. Still reading the + * buffer can result in packets where + * rtw_rx_pkt_stat.pkt_len is zero or points beyond the + * end of the buffer. + */ + hisr = rtw_read32(rtwdev, REG_SDIO_HISR); + } else { + /* RTW_WCPU_11AC chips have improved hardware or + * firmware and can use rx_len unconditionally. + */ + hisr = REG_SDIO_HISR_RX_REQUEST; + } + } while (total_rx_bytes < SZ_64K && hisr & REG_SDIO_HISR_RX_REQUEST); +} + +static void rtw_sdio_handle_interrupt(struct sdio_func *sdio_func) +{ + struct ieee80211_hw *hw = sdio_get_drvdata(sdio_func); + struct rtw_sdio *rtwsdio; + struct rtw_dev *rtwdev; + u32 hisr; + + rtwdev = hw->priv; + rtwsdio = (struct rtw_sdio *)rtwdev->priv; + + rtwsdio->irq_thread = current; + + hisr = rtw_read32(rtwdev, REG_SDIO_HISR); + + if (hisr & REG_SDIO_HISR_TXERR) + rtw_sdio_tx_err_isr(rtwdev); + if (hisr & REG_SDIO_HISR_RX_REQUEST) { + hisr &= ~REG_SDIO_HISR_RX_REQUEST; + rtw_sdio_rx_isr(rtwdev); + } + + rtw_write32(rtwdev, REG_SDIO_HISR, hisr); + + rtwsdio->irq_thread = NULL; +} + +static int __maybe_unused rtw_sdio_suspend(struct device *dev) +{ + struct sdio_func *func = dev_to_sdio_func(dev); + struct ieee80211_hw *hw = dev_get_drvdata(dev); + struct rtw_dev *rtwdev = hw->priv; + int ret; + + ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER); + if (ret) + rtw_err(rtwdev, "Failed to host PM flag MMC_PM_KEEP_POWER"); + + return ret; +} + +static int __maybe_unused rtw_sdio_resume(struct device *dev) +{ + return 0; +} + +SIMPLE_DEV_PM_OPS(rtw_sdio_pm_ops, rtw_sdio_suspend, rtw_sdio_resume); +EXPORT_SYMBOL(rtw_sdio_pm_ops); + +static int rtw_sdio_claim(struct rtw_dev *rtwdev, struct sdio_func *sdio_func) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + int ret; + + sdio_claim_host(sdio_func); + + ret = sdio_enable_func(sdio_func); + if (ret) { + rtw_err(rtwdev, "Failed to enable SDIO func"); + goto err_release_host; + } + + ret = sdio_set_block_size(sdio_func, RTW_SDIO_BLOCK_SIZE); + if (ret) { + rtw_err(rtwdev, "Failed to set SDIO block size to 512"); + goto err_disable_func; + } + + rtwsdio->sdio_func = sdio_func; + + rtwsdio->sdio3_bus_mode = mmc_card_uhs(sdio_func->card); + + sdio_set_drvdata(sdio_func, rtwdev->hw); + SET_IEEE80211_DEV(rtwdev->hw, &sdio_func->dev); + + sdio_release_host(sdio_func); + + return 0; + +err_disable_func: + sdio_disable_func(sdio_func); +err_release_host: + sdio_release_host(sdio_func); + return ret; +} + +static void rtw_sdio_declaim(struct rtw_dev *rtwdev, + struct sdio_func *sdio_func) +{ + sdio_claim_host(sdio_func); + sdio_disable_func(sdio_func); + sdio_release_host(sdio_func); +} + +static struct rtw_hci_ops rtw_sdio_ops = { + .tx_write = rtw_sdio_tx_write, + .tx_kick_off = rtw_sdio_tx_kick_off, + .setup = rtw_sdio_setup, + .start = rtw_sdio_start, + .stop = rtw_sdio_stop, + .deep_ps = rtw_sdio_deep_ps, + .link_ps = rtw_sdio_link_ps, + .interface_cfg = rtw_sdio_interface_cfg, + + .read8 = rtw_sdio_read8, + .read16 = rtw_sdio_read16, + .read32 = rtw_sdio_read32, + .write8 = rtw_sdio_write8, + .write16 = rtw_sdio_write16, + .write32 = rtw_sdio_write32, + .write_data_rsvd_page = rtw_sdio_write_data_rsvd_page, + .write_data_h2c = rtw_sdio_write_data_h2c, +}; + +static int rtw_sdio_request_irq(struct rtw_dev *rtwdev, + struct sdio_func *sdio_func) +{ + int ret; + + sdio_claim_host(sdio_func); + ret = sdio_claim_irq(sdio_func, &rtw_sdio_handle_interrupt); + sdio_release_host(sdio_func); + + if (ret) { + rtw_err(rtwdev, "failed to claim SDIO IRQ"); + return ret; + } + + return 0; +} + +static void rtw_sdio_indicate_tx_status(struct rtw_dev *rtwdev, + struct sk_buff *skb) +{ + struct rtw_sdio_tx_data *tx_data = rtw_sdio_get_tx_data(skb); + struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); + struct ieee80211_hw *hw = rtwdev->hw; + + /* enqueue to wait for tx report */ + if (info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS) { + rtw_tx_report_enqueue(rtwdev, skb, tx_data->sn); + return; + } + + /* always ACK for others, then they won't be marked as drop */ + ieee80211_tx_info_clear_status(info); + if (info->flags & IEEE80211_TX_CTL_NO_ACK) + info->flags |= IEEE80211_TX_STAT_NOACK_TRANSMITTED; + else + info->flags |= IEEE80211_TX_STAT_ACK; + + ieee80211_tx_status_irqsafe(hw, skb); +} + +static void rtw_sdio_process_tx_queue(struct rtw_dev *rtwdev, + enum rtw_tx_queue_type queue) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + struct sk_buff *skb; + int ret; + + skb = skb_dequeue(&rtwsdio->tx_queue[queue]); + if (!skb) + return; + + ret = rtw_sdio_write_port(rtwdev, skb, queue); + if (ret) { + skb_queue_head(&rtwsdio->tx_queue[queue], skb); + return; + } + + if (queue <= RTW_TX_QUEUE_VO) + rtw_sdio_indicate_tx_status(rtwdev, skb); + else + dev_kfree_skb_any(skb); +} + +static void rtw_sdio_tx_handler(struct work_struct *work) +{ + struct rtw_sdio_work_data *work_data = + container_of(work, struct rtw_sdio_work_data, work); + struct rtw_sdio *rtwsdio; + struct rtw_dev *rtwdev; + int limit, queue; + + rtwdev = work_data->rtwdev; + rtwsdio = (struct rtw_sdio *)rtwdev->priv; + + if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) + rtw_sdio_deep_ps_leave(rtwdev); + + for (queue = RTK_MAX_TX_QUEUE_NUM - 1; queue >= 0; queue--) { + for (limit = 0; limit < 1000; limit++) { + rtw_sdio_process_tx_queue(rtwdev, queue); + + if (skb_queue_empty(&rtwsdio->tx_queue[queue])) + break; + } + } +} + +static void rtw_sdio_free_irq(struct rtw_dev *rtwdev, + struct sdio_func *sdio_func) +{ + sdio_claim_host(sdio_func); + sdio_release_irq(sdio_func); + sdio_release_host(sdio_func); +} + +static int rtw_sdio_init_tx(struct rtw_dev *rtwdev) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + int i; + + rtwsdio->txwq = create_singlethread_workqueue("rtw88_sdio: tx wq"); + if (!rtwsdio->txwq) { + rtw_err(rtwdev, "failed to create TX work queue\n"); + return -ENOMEM; + } + + for (i = 0; i < RTK_MAX_TX_QUEUE_NUM; i++) + skb_queue_head_init(&rtwsdio->tx_queue[i]); + rtwsdio->tx_handler_data = kmalloc(sizeof(*rtwsdio->tx_handler_data), + GFP_KERNEL); + if (!rtwsdio->tx_handler_data) + goto err_destroy_wq; + + rtwsdio->tx_handler_data->rtwdev = rtwdev; + INIT_WORK(&rtwsdio->tx_handler_data->work, rtw_sdio_tx_handler); + + return 0; + +err_destroy_wq: + destroy_workqueue(rtwsdio->txwq); + return -ENOMEM; +} + +static void rtw_sdio_deinit_tx(struct rtw_dev *rtwdev) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + int i; + + for (i = 0; i < RTK_MAX_TX_QUEUE_NUM; i++) + skb_queue_purge(&rtwsdio->tx_queue[i]); + + flush_workqueue(rtwsdio->txwq); + destroy_workqueue(rtwsdio->txwq); + kfree(rtwsdio->tx_handler_data); +} + +int rtw_sdio_probe(struct sdio_func *sdio_func, + const struct sdio_device_id *id) +{ + struct ieee80211_hw *hw; + struct rtw_dev *rtwdev; + int drv_data_size; + int ret; + + drv_data_size = sizeof(struct rtw_dev) + sizeof(struct rtw_sdio); + hw = ieee80211_alloc_hw(drv_data_size, &rtw_ops); + if (!hw) { + dev_err(&sdio_func->dev, "failed to allocate hw"); + return -ENOMEM; + } + + rtwdev = hw->priv; + rtwdev->hw = hw; + rtwdev->dev = &sdio_func->dev; + rtwdev->chip = (struct rtw_chip_info *)id->driver_data; + rtwdev->hci.ops = &rtw_sdio_ops; + rtwdev->hci.type = RTW_HCI_TYPE_SDIO; + + ret = rtw_core_init(rtwdev); + if (ret) + goto err_release_hw; + + rtw_dbg(rtwdev, RTW_DBG_SDIO, + "rtw88 SDIO probe: vendor=0x%04x device=%04x class=%02x", + id->vendor, id->device, id->class); + + ret = rtw_sdio_claim(rtwdev, sdio_func); + if (ret) { + rtw_err(rtwdev, "failed to claim SDIO device"); + goto err_deinit_core; + } + + rtw_sdio_init(rtwdev); + + ret = rtw_sdio_init_tx(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to init SDIO TX queue\n"); + goto err_sdio_declaim; + } + + ret = rtw_chip_info_setup(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to setup chip information"); + goto err_destroy_txwq; + } + + ret = rtw_sdio_request_irq(rtwdev, sdio_func); + if (ret) + goto err_destroy_txwq; + + ret = rtw_register_hw(rtwdev, hw); + if (ret) { + rtw_err(rtwdev, "failed to register hw"); + goto err_free_irq; + } + + return 0; + +err_free_irq: + rtw_sdio_free_irq(rtwdev, sdio_func); +err_destroy_txwq: + rtw_sdio_deinit_tx(rtwdev); +err_sdio_declaim: + rtw_sdio_declaim(rtwdev, sdio_func); +err_deinit_core: + rtw_core_deinit(rtwdev); +err_release_hw: + ieee80211_free_hw(hw); + + return ret; +} +EXPORT_SYMBOL(rtw_sdio_probe); + +void rtw_sdio_remove(struct sdio_func *sdio_func) +{ + struct ieee80211_hw *hw = sdio_get_drvdata(sdio_func); + struct rtw_dev *rtwdev; + + if (!hw) + return; + + rtwdev = hw->priv; + + rtw_unregister_hw(rtwdev, hw); + rtw_sdio_disable_interrupt(rtwdev); + rtw_sdio_free_irq(rtwdev, sdio_func); + rtw_sdio_declaim(rtwdev, sdio_func); + rtw_sdio_deinit_tx(rtwdev); + rtw_core_deinit(rtwdev); + ieee80211_free_hw(hw); +} +EXPORT_SYMBOL(rtw_sdio_remove); + +void rtw_sdio_shutdown(struct device *dev) +{ + struct sdio_func *sdio_func = dev_to_sdio_func(dev); + const struct rtw_chip_info *chip; + struct ieee80211_hw *hw; + struct rtw_dev *rtwdev; + + hw = sdio_get_drvdata(sdio_func); + if (!hw) + return; + + rtwdev = hw->priv; + chip = rtwdev->chip; + + if (chip->ops->shutdown) + chip->ops->shutdown(rtwdev); +} +EXPORT_SYMBOL(rtw_sdio_shutdown); + +MODULE_AUTHOR("Martin Blumenstingl"); +MODULE_AUTHOR("Jernej Skrabec"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless SDIO driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sdio.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sdio.h new file mode 100644 index 0000000000000000000000000000000000000000..3c659ed180f0080d3483be68ba7ba7064d58e02d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sdio.h @@ -0,0 +1,178 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright (C) 2021 Martin Blumenstingl + * Copyright (C) 2021 Jernej Skrabec + */ + +#ifndef __REG_SDIO_H_ +#define __REG_SDIO_H_ + +/* I/O bus domain address mapping */ +#define SDIO_LOCAL_OFFSET 0x10250000 +#define WLAN_IOREG_OFFSET 0x10260000 +#define FIRMWARE_FIFO_OFFSET 0x10270000 +#define TX_HIQ_OFFSET 0x10310000 +#define TX_MIQ_OFFSET 0x10320000 +#define TX_LOQ_OFFSET 0x10330000 +#define TX_EPQ_OFFSET 0x10350000 +#define RX_RX0FF_OFFSET 0x10340000 + +#define RTW_SDIO_BUS_MSK 0xffff0000 +#define SDIO_LOCAL_REG_MSK 0x00000fff +#define WLAN_IOREG_REG_MSK 0x0000ffff + +/* SDIO Tx Control */ +#define REG_SDIO_TX_CTRL (SDIO_LOCAL_OFFSET + 0x0000) + +/*SDIO status timeout*/ +#define REG_SDIO_TIMEOUT (SDIO_LOCAL_OFFSET + 0x0002) + +/* SDIO Host Interrupt Mask */ +#define REG_SDIO_HIMR (SDIO_LOCAL_OFFSET + 0x0014) +#define REG_SDIO_HIMR_RX_REQUEST BIT(0) +#define REG_SDIO_HIMR_AVAL BIT(1) +#define REG_SDIO_HIMR_TXERR BIT(2) +#define REG_SDIO_HIMR_RXERR BIT(3) +#define REG_SDIO_HIMR_TXFOVW BIT(4) +#define REG_SDIO_HIMR_RXFOVW BIT(5) +#define REG_SDIO_HIMR_TXBCNOK BIT(6) +#define REG_SDIO_HIMR_TXBCNERR BIT(7) +#define REG_SDIO_HIMR_BCNERLY_INT BIT(16) +#define REG_SDIO_HIMR_C2HCMD BIT(17) +#define REG_SDIO_HIMR_CPWM1 BIT(18) +#define REG_SDIO_HIMR_CPWM2 BIT(19) +#define REG_SDIO_HIMR_HSISR_IND BIT(20) +#define REG_SDIO_HIMR_GTINT3_IND BIT(21) +#define REG_SDIO_HIMR_GTINT4_IND BIT(22) +#define REG_SDIO_HIMR_PSTIMEOUT BIT(23) +#define REG_SDIO_HIMR_OCPINT BIT(24) +#define REG_SDIO_HIMR_ATIMEND BIT(25) +#define REG_SDIO_HIMR_ATIMEND_E BIT(26) +#define REG_SDIO_HIMR_CTWEND BIT(27) +/* the following two are RTL8188 SDIO Specific */ +#define REG_SDIO_HIMR_MCU_ERR BIT(28) +#define REG_SDIO_HIMR_TSF_BIT32_TOGGLE BIT(29) + +/* SDIO Host Interrupt Service Routine */ +#define REG_SDIO_HISR (SDIO_LOCAL_OFFSET + 0x0018) +#define REG_SDIO_HISR_RX_REQUEST BIT(0) +#define REG_SDIO_HISR_AVAL BIT(1) +#define REG_SDIO_HISR_TXERR BIT(2) +#define REG_SDIO_HISR_RXERR BIT(3) +#define REG_SDIO_HISR_TXFOVW BIT(4) +#define REG_SDIO_HISR_RXFOVW BIT(5) +#define REG_SDIO_HISR_TXBCNOK BIT(6) +#define REG_SDIO_HISR_TXBCNERR BIT(7) +#define REG_SDIO_HISR_BCNERLY_INT BIT(16) +#define REG_SDIO_HISR_C2HCMD BIT(17) +#define REG_SDIO_HISR_CPWM1 BIT(18) +#define REG_SDIO_HISR_CPWM2 BIT(19) +#define REG_SDIO_HISR_HSISR_IND BIT(20) +#define REG_SDIO_HISR_GTINT3_IND BIT(21) +#define REG_SDIO_HISR_GTINT4_IND BIT(22) +#define REG_SDIO_HISR_PSTIMEOUT BIT(23) +#define REG_SDIO_HISR_OCPINT BIT(24) +#define REG_SDIO_HISR_ATIMEND BIT(25) +#define REG_SDIO_HISR_ATIMEND_E BIT(26) +#define REG_SDIO_HISR_CTWEND BIT(27) +/* the following two are RTL8188 SDIO Specific */ +#define REG_SDIO_HISR_MCU_ERR BIT(28) +#define REG_SDIO_HISR_TSF_BIT32_TOGGLE BIT(29) + +/* HCI Current Power Mode */ +#define REG_SDIO_HCPWM (SDIO_LOCAL_OFFSET + 0x0019) +/* RXDMA Request Length */ +#define REG_SDIO_RX0_REQ_LEN (SDIO_LOCAL_OFFSET + 0x001C) +/* OQT Free Page */ +#define REG_SDIO_OQT_FREE_PG (SDIO_LOCAL_OFFSET + 0x001E) +/* Free Tx Buffer Page */ +#define REG_SDIO_FREE_TXPG (SDIO_LOCAL_OFFSET + 0x0020) +/* HCI Current Power Mode 1 */ +#define REG_SDIO_HCPWM1 (SDIO_LOCAL_OFFSET + 0x0024) +/* HCI Current Power Mode 2 */ +#define REG_SDIO_HCPWM2 (SDIO_LOCAL_OFFSET + 0x0026) +/* Free Tx Page Sequence */ +#define REG_SDIO_FREE_TXPG_SEQ (SDIO_LOCAL_OFFSET + 0x0028) +/* HTSF Information */ +#define REG_SDIO_HTSFR_INFO (SDIO_LOCAL_OFFSET + 0x0030) +#define REG_SDIO_HCPWM1_V2 (SDIO_LOCAL_OFFSET + 0x0038) +/* H2C */ +#define REG_SDIO_H2C (SDIO_LOCAL_OFFSET + 0x0060) +/* HCI Request Power Mode 1 */ +#define REG_SDIO_HRPWM1 (SDIO_LOCAL_OFFSET + 0x0080) +/* HCI Request Power Mode 2 */ +#define REG_SDIO_HRPWM2 (SDIO_LOCAL_OFFSET + 0x0082) +/* HCI Power Save Clock */ +#define REG_SDIO_HPS_CLKR (SDIO_LOCAL_OFFSET + 0x0084) +/* SDIO HCI Suspend Control */ +#define REG_SDIO_HSUS_CTRL (SDIO_LOCAL_OFFSET + 0x0086) +#define BIT_HCI_SUS_REQ BIT(0) +#define BIT_HCI_RESUME_RDY BIT(1) +/* SDIO Host Extension Interrupt Mask Always */ +#define REG_SDIO_HIMR_ON (SDIO_LOCAL_OFFSET + 0x0090) +/* SDIO Host Extension Interrupt Status Always */ +#define REG_SDIO_HISR_ON (SDIO_LOCAL_OFFSET + 0x0091) + +#define REG_SDIO_INDIRECT_REG_CFG (SDIO_LOCAL_OFFSET + 0x0040) +#define BIT_SDIO_INDIRECT_REG_CFG_WORD BIT(16) +#define BIT_SDIO_INDIRECT_REG_CFG_DWORD BIT(17) +#define BIT_SDIO_INDIRECT_REG_CFG_WRITE BIT(18) +#define BIT_SDIO_INDIRECT_REG_CFG_READ BIT(19) +#define BIT_SDIO_INDIRECT_REG_CFG_UNK20 BIT(20) +#define REG_SDIO_INDIRECT_REG_DATA (SDIO_LOCAL_OFFSET + 0x0044) + +/* Sdio Address for SDIO Local Reg, TRX FIFO, MAC Reg */ +#define REG_SDIO_CMD_ADDR_MSK GENMASK(16, 13) +#define REG_SDIO_CMD_ADDR_SDIO_REG 0 +#define REG_SDIO_CMD_ADDR_MAC_REG 8 +#define REG_SDIO_CMD_ADDR_TXFF_HIGH 4 +#define REG_SDIO_CMD_ADDR_TXFF_LOW 6 +#define REG_SDIO_CMD_ADDR_TXFF_NORMAL 5 +#define REG_SDIO_CMD_ADDR_TXFF_EXTRA 7 +#define REG_SDIO_CMD_ADDR_RXFF 7 + +#define RTW_SDIO_BLOCK_SIZE 512 +#define RTW_SDIO_ADDR_RX_RX0FF_GEN(_id) (0x0e000 | ((_id) & 0x3)) + +#define RTW_SDIO_DATA_PTR_ALIGN 8 + +struct sdio_func; +struct sdio_device_id; + +struct rtw_sdio_tx_data { + u8 sn; +}; + +struct rtw_sdio_work_data { + struct work_struct work; + struct rtw_dev *rtwdev; +}; + +struct rtw_sdio { + struct sdio_func *sdio_func; + + u32 irq_mask; + u8 rx_addr; + bool sdio3_bus_mode; + + void *irq_thread; + + struct workqueue_struct *txwq; + struct rtw_sdio_work_data *tx_handler_data; + struct sk_buff_head tx_queue[RTK_MAX_TX_QUEUE_NUM]; +}; + +extern const struct dev_pm_ops rtw_sdio_pm_ops; + +int rtw_sdio_probe(struct sdio_func *sdio_func, + const struct sdio_device_id *id); +void rtw_sdio_remove(struct sdio_func *sdio_func); +void rtw_sdio_shutdown(struct device *dev); + +static inline bool rtw_sdio_is_sdio30_supported(struct rtw_dev *rtwdev) +{ + struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; + + return rtwsdio->sdio3_bus_mode; +} + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sdio_ids.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sdio_ids.h new file mode 100644 index 0000000000000000000000000000000000000000..2d1a80776ac13091ea3c7346a56bd2e10cbf7443 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sdio_ids.h @@ -0,0 +1,10 @@ +#define SDIO_VENDOR_ID_REALTEK 0x024c +#define SDIO_DEVICE_ID_REALTEK_RTW8723BS 0xb723 +#define SDIO_DEVICE_ID_REALTEK_RTW8723DS_2ANT 0xd723 +#define SDIO_DEVICE_ID_REALTEK_RTW8723DS_1ANT 0xd724 +#define SDIO_DEVICE_ID_REALTEK_RTW8821BS 0xb821 +#define SDIO_DEVICE_ID_REALTEK_RTW8821CS 0xc821 +#define SDIO_DEVICE_ID_REALTEK_RTW8821DS 0xd821 +#define SDIO_DEVICE_ID_REALTEK_RTW8822BS 0xb822 +#define SDIO_DEVICE_ID_REALTEK_RTW8822CS 0xc822 + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sec.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sec.c new file mode 100644 index 0000000000000000000000000000000000000000..ce46e5b4a60a2c266084c507410df8e8cb46d39c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sec.c @@ -0,0 +1,145 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "sec.h" +#include "reg.h" + +int rtw_sec_get_free_cam(struct rtw_sec_desc *sec) +{ + /* if default key search is enabled, the first 4 cam entries + * are used to direct map to group key with its key->key_idx, so + * driver should use cam entries after 4 to install pairwise key + */ + if (sec->default_key_search) + return find_next_zero_bit(sec->cam_map, RTW_MAX_SEC_CAM_NUM, + RTW_SEC_DEFAULT_KEY_NUM); + + return find_first_zero_bit(sec->cam_map, RTW_MAX_SEC_CAM_NUM); +} + +void rtw_sec_write_cam(struct rtw_dev *rtwdev, + struct rtw_sec_desc *sec, + struct ieee80211_sta *sta, + struct ieee80211_key_conf *key, + u8 hw_key_type, u8 hw_key_idx) +{ + struct rtw_cam_entry *cam = &sec->cam_table[hw_key_idx]; + u32 write_cmd; + u32 command; + u32 content; + u32 addr; + int i, j; + + set_bit(hw_key_idx, sec->cam_map); + cam->valid = true; + cam->group = !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE); + cam->hw_key_type = hw_key_type; + cam->key = key; + if (sta) + ether_addr_copy(cam->addr, sta->addr); + else + eth_broadcast_addr(cam->addr); + + write_cmd = RTW_SEC_CMD_WRITE_ENABLE | RTW_SEC_CMD_POLLING; + addr = hw_key_idx << RTW_SEC_CAM_ENTRY_SHIFT; + for (i = 7; i >= 0; i--) { + switch (i) { + case 0: + content = ((key->keyidx & 0x3)) | + ((hw_key_type & 0x7) << 2) | + (cam->group << 6) | + (cam->valid << 15) | + (cam->addr[0] << 16) | + (cam->addr[1] << 24); + break; + case 1: + content = (cam->addr[2]) | + (cam->addr[3] << 8) | + (cam->addr[4] << 16) | + (cam->addr[5] << 24); + break; + case 6: + case 7: + content = 0; + break; + default: + j = (i - 2) << 2; + content = (key->key[j]) | + (key->key[j + 1] << 8) | + (key->key[j + 2] << 16) | + (key->key[j + 3] << 24); + break; + } + + command = write_cmd | (addr + i); + rtw_write32(rtwdev, RTW_SEC_WRITE_REG, content); + rtw_write32(rtwdev, RTW_SEC_CMD_REG, command); + } +} + +void rtw_sec_clear_cam(struct rtw_dev *rtwdev, + struct rtw_sec_desc *sec, + u8 hw_key_idx) +{ + struct rtw_cam_entry *cam = &sec->cam_table[hw_key_idx]; + u32 write_cmd; + u32 command; + u32 addr; + + clear_bit(hw_key_idx, sec->cam_map); + cam->valid = false; + cam->key = NULL; + eth_zero_addr(cam->addr); + + write_cmd = RTW_SEC_CMD_WRITE_ENABLE | RTW_SEC_CMD_POLLING; + addr = hw_key_idx << RTW_SEC_CAM_ENTRY_SHIFT; + command = write_cmd | addr; + rtw_write32(rtwdev, RTW_SEC_WRITE_REG, 0); + rtw_write32(rtwdev, RTW_SEC_CMD_REG, command); +} + +u8 rtw_sec_cam_pg_backup(struct rtw_dev *rtwdev, u8 *used_cam) +{ + struct rtw_sec_desc *sec = &rtwdev->sec; + u8 offset = 0; + u8 count, n; + + if (!used_cam) + return 0; + + for (count = 0; count < MAX_PG_CAM_BACKUP_NUM; count++) { + n = find_next_bit(sec->cam_map, RTW_MAX_SEC_CAM_NUM, offset); + if (n == RTW_MAX_SEC_CAM_NUM) + break; + + used_cam[count] = n; + offset = n + 1; + } + + return count; +} + +void rtw_sec_enable_sec_engine(struct rtw_dev *rtwdev) +{ + struct rtw_sec_desc *sec = &rtwdev->sec; + u16 ctrl_reg; + u16 sec_config; + + /* default use default key search for now */ + sec->default_key_search = true; + + ctrl_reg = rtw_read16(rtwdev, REG_CR); + ctrl_reg |= RTW_SEC_ENGINE_EN; + rtw_write16(rtwdev, REG_CR, ctrl_reg); + + sec_config = rtw_read16(rtwdev, RTW_SEC_CONFIG); + + sec_config |= RTW_SEC_TX_DEC_EN | RTW_SEC_RX_DEC_EN; + if (sec->default_key_search) + sec_config |= RTW_SEC_TX_UNI_USE_DK | RTW_SEC_RX_UNI_USE_DK | + RTW_SEC_TX_BC_USE_DK | RTW_SEC_RX_BC_USE_DK; + + rtw_write16(rtwdev, RTW_SEC_CONFIG, sec_config); +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sec.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sec.h new file mode 100644 index 0000000000000000000000000000000000000000..efcf45433999af7ae50acd2f67e9b640584b5034 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/sec.h @@ -0,0 +1,40 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_SEC_H_ +#define __RTW_SEC_H_ + +#define RTW_SEC_CMD_REG 0x670 +#define RTW_SEC_WRITE_REG 0x674 +#define RTW_SEC_READ_REG 0x678 +#define RTW_SEC_CONFIG 0x680 + +#define RTW_SEC_CAM_ENTRY_SHIFT 3 +#define RTW_SEC_DEFAULT_KEY_NUM 4 +#define RTW_SEC_CMD_WRITE_ENABLE BIT(16) +#define RTW_SEC_CMD_CLEAR BIT(30) +#define RTW_SEC_CMD_POLLING BIT(31) + +#define RTW_SEC_TX_UNI_USE_DK BIT(0) +#define RTW_SEC_RX_UNI_USE_DK BIT(1) +#define RTW_SEC_TX_DEC_EN BIT(2) +#define RTW_SEC_RX_DEC_EN BIT(3) +#define RTW_SEC_TX_BC_USE_DK BIT(6) +#define RTW_SEC_RX_BC_USE_DK BIT(7) + +#define RTW_SEC_ENGINE_EN BIT(9) + +int rtw_sec_get_free_cam(struct rtw_sec_desc *sec); +void rtw_sec_write_cam(struct rtw_dev *rtwdev, + struct rtw_sec_desc *sec, + struct ieee80211_sta *sta, + struct ieee80211_key_conf *key, + u8 hw_key_type, u8 hw_key_idx); +void rtw_sec_clear_cam(struct rtw_dev *rtwdev, + struct rtw_sec_desc *sec, + u8 hw_key_idx); +u8 rtw_sec_cam_pg_backup(struct rtw_dev *rtwdev, u8 *used_cam); +void rtw_sec_enable_sec_engine(struct rtw_dev *rtwdev); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/tx.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/tx.c new file mode 100644 index 0000000000000000000000000000000000000000..77a8114b06d2c51b28731d9ce5a354dcdf7653b8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/tx.c @@ -0,0 +1,778 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "tx.h" +#include "fw.h" +#include "ps.h" +#include "debug.h" + +static +void rtw_tx_stats(struct rtw_dev *rtwdev, struct ieee80211_vif *vif, + struct sk_buff *skb) +{ + struct ieee80211_hdr *hdr; + struct rtw_vif *rtwvif; + + hdr = (struct ieee80211_hdr *)skb->data; + + if (!ieee80211_is_data(hdr->frame_control)) + return; + + if (!is_broadcast_ether_addr(hdr->addr1) && + !is_multicast_ether_addr(hdr->addr1)) { + rtwdev->stats.tx_unicast += skb->len; + rtwdev->stats.tx_cnt++; + if (vif) { + rtwvif = (struct rtw_vif *)vif->drv_priv; + rtwvif->stats.tx_unicast += skb->len; + rtwvif->stats.tx_cnt++; + } + } +} + +void rtw_tx_fill_tx_desc(struct rtw_tx_pkt_info *pkt_info, struct sk_buff *skb) +{ + struct rtw_tx_desc *tx_desc = (struct rtw_tx_desc *)skb->data; + bool more_data = false; + + if (pkt_info->qsel == TX_DESC_QSEL_HIGH) + more_data = true; + + tx_desc->w0 = le32_encode_bits(pkt_info->tx_pkt_size, RTW_TX_DESC_W0_TXPKTSIZE) | + le32_encode_bits(pkt_info->offset, RTW_TX_DESC_W0_OFFSET) | + le32_encode_bits(pkt_info->bmc, RTW_TX_DESC_W0_BMC) | + le32_encode_bits(pkt_info->ls, RTW_TX_DESC_W0_LS) | + le32_encode_bits(pkt_info->dis_qselseq, RTW_TX_DESC_W0_DISQSELSEQ); + + tx_desc->w1 = le32_encode_bits(pkt_info->qsel, RTW_TX_DESC_W1_QSEL) | + le32_encode_bits(pkt_info->rate_id, RTW_TX_DESC_W1_RATE_ID) | + le32_encode_bits(pkt_info->sec_type, RTW_TX_DESC_W1_SEC_TYPE) | + le32_encode_bits(pkt_info->pkt_offset, RTW_TX_DESC_W1_PKT_OFFSET) | + le32_encode_bits(more_data, RTW_TX_DESC_W1_MORE_DATA); + + tx_desc->w2 = le32_encode_bits(pkt_info->ampdu_en, RTW_TX_DESC_W2_AGG_EN) | + le32_encode_bits(pkt_info->report, RTW_TX_DESC_W2_SPE_RPT) | + le32_encode_bits(pkt_info->ampdu_density, RTW_TX_DESC_W2_AMPDU_DEN) | + le32_encode_bits(pkt_info->bt_null, RTW_TX_DESC_W2_BT_NULL); + + tx_desc->w3 = le32_encode_bits(pkt_info->hw_ssn_sel, RTW_TX_DESC_W3_HW_SSN_SEL) | + le32_encode_bits(pkt_info->use_rate, RTW_TX_DESC_W3_USE_RATE) | + le32_encode_bits(pkt_info->dis_rate_fallback, RTW_TX_DESC_W3_DISDATAFB) | + le32_encode_bits(pkt_info->rts, RTW_TX_DESC_W3_USE_RTS) | + le32_encode_bits(pkt_info->nav_use_hdr, RTW_TX_DESC_W3_NAVUSEHDR) | + le32_encode_bits(pkt_info->ampdu_factor, RTW_TX_DESC_W3_MAX_AGG_NUM); + + tx_desc->w4 = le32_encode_bits(pkt_info->rate, RTW_TX_DESC_W4_DATARATE); + + tx_desc->w5 = le32_encode_bits(pkt_info->short_gi, RTW_TX_DESC_W5_DATA_SHORT) | + le32_encode_bits(pkt_info->bw, RTW_TX_DESC_W5_DATA_BW) | + le32_encode_bits(pkt_info->ldpc, RTW_TX_DESC_W5_DATA_LDPC) | + le32_encode_bits(pkt_info->stbc, RTW_TX_DESC_W5_DATA_STBC); + + tx_desc->w6 = le32_encode_bits(pkt_info->sn, RTW_TX_DESC_W6_SW_DEFINE); + + tx_desc->w8 = le32_encode_bits(pkt_info->en_hwseq, RTW_TX_DESC_W8_EN_HWSEQ); + + tx_desc->w9 = le32_encode_bits(pkt_info->seq, RTW_TX_DESC_W9_SW_SEQ); + + if (pkt_info->rts) { + tx_desc->w4 |= le32_encode_bits(DESC_RATE24M, RTW_TX_DESC_W4_RTSRATE); + tx_desc->w5 |= le32_encode_bits(1, RTW_TX_DESC_W5_DATA_RTS_SHORT); + } + + if (pkt_info->tim_offset) + tx_desc->w9 |= le32_encode_bits(1, RTW_TX_DESC_W9_TIM_EN) | + le32_encode_bits(pkt_info->tim_offset, RTW_TX_DESC_W9_TIM_OFFSET); +} +EXPORT_SYMBOL(rtw_tx_fill_tx_desc); + +static u8 get_tx_ampdu_factor(struct ieee80211_sta *sta) +{ +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + u8 exp = sta->deflink.ht_cap.ampdu_factor; +#else + u8 exp = sta->ht_cap.ampdu_factor; +#endif + + /* the least ampdu factor is 8K, and the value in the tx desc is the + * max aggregation num, which represents val * 2 packets can be + * aggregated in an AMPDU, so here we should use 8/2=4 as the base + */ + return (BIT(2) << exp) - 1; +} + +static u8 get_tx_ampdu_density(struct ieee80211_sta *sta) +{ +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + return sta->deflink.ht_cap.ampdu_density; +#else + return sta->ht_cap.ampdu_density; +#endif +} + +static u8 get_highest_ht_tx_rate(struct rtw_dev *rtwdev, + struct ieee80211_sta *sta) +{ + u8 rate; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + if (rtwdev->hal.rf_type == RF_2T2R && sta->deflink.ht_cap.mcs.rx_mask[1] != 0) +#else + if (rtwdev->hal.rf_type == RF_2T2R && sta->ht_cap.mcs.rx_mask[1] != 0) +#endif + rate = DESC_RATEMCS15; + else + rate = DESC_RATEMCS7; + + return rate; +} + +static u8 get_highest_vht_tx_rate(struct rtw_dev *rtwdev, + struct ieee80211_sta *sta) +{ + struct rtw_efuse *efuse = &rtwdev->efuse; + u8 rate; + u16 tx_mcs_map; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + tx_mcs_map = le16_to_cpu(sta->deflink.vht_cap.vht_mcs.tx_mcs_map); +#else + tx_mcs_map = le16_to_cpu(sta->vht_cap.vht_mcs.tx_mcs_map); +#endif + if (efuse->hw_cap.nss == 1) { + switch (tx_mcs_map & 0x3) { + case IEEE80211_VHT_MCS_SUPPORT_0_7: + rate = DESC_RATEVHT1SS_MCS7; + break; + case IEEE80211_VHT_MCS_SUPPORT_0_8: + rate = DESC_RATEVHT1SS_MCS8; + break; + default: + case IEEE80211_VHT_MCS_SUPPORT_0_9: + rate = DESC_RATEVHT1SS_MCS9; + break; + } + } else if (efuse->hw_cap.nss >= 2) { + switch ((tx_mcs_map & 0xc) >> 2) { + case IEEE80211_VHT_MCS_SUPPORT_0_7: + rate = DESC_RATEVHT2SS_MCS7; + break; + case IEEE80211_VHT_MCS_SUPPORT_0_8: + rate = DESC_RATEVHT2SS_MCS8; + break; + default: + case IEEE80211_VHT_MCS_SUPPORT_0_9: + rate = DESC_RATEVHT2SS_MCS9; + break; + } + } else { + rate = DESC_RATEVHT1SS_MCS9; + } + + return rate; +} + +static void rtw_tx_report_enable(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info) +{ + struct rtw_tx_report *tx_report = &rtwdev->tx_report; + + /* [11:8], reserved, fills with zero + * [7:2], tx report sequence number + * [1:0], firmware use, fills with zero + */ + pkt_info->sn = (atomic_inc_return(&tx_report->sn) << 2) & 0xfc; + pkt_info->report = true; +} + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0) +void rtw_tx_report_purge_timer(struct timer_list *t) +#else +void rtw_tx_report_purge_timer(void *cntx) +#endif +{ +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0) + struct rtw_dev *rtwdev = from_timer(rtwdev, t, tx_report.purge_timer); +#else + struct rtw_dev *rtwdev = (struct rtw_dev *)cntx; +#endif + struct rtw_tx_report *tx_report = &rtwdev->tx_report; + unsigned long flags; + + if (skb_queue_len(&tx_report->queue) == 0) + return; + + rtw_warn(rtwdev, "failed to get tx report from firmware\n"); + + spin_lock_irqsave(&tx_report->q_lock, flags); + skb_queue_purge(&tx_report->queue); + spin_unlock_irqrestore(&tx_report->q_lock, flags); +} + +void rtw_tx_report_enqueue(struct rtw_dev *rtwdev, struct sk_buff *skb, u8 sn) +{ + struct rtw_tx_report *tx_report = &rtwdev->tx_report; + unsigned long flags; + u8 *drv_data; + + /* pass sn to tx report handler through driver data */ + drv_data = (u8 *)IEEE80211_SKB_CB(skb)->status.status_driver_data; + *drv_data = sn; + + spin_lock_irqsave(&tx_report->q_lock, flags); + __skb_queue_tail(&tx_report->queue, skb); + spin_unlock_irqrestore(&tx_report->q_lock, flags); + + mod_timer(&tx_report->purge_timer, jiffies + RTW_TX_PROBE_TIMEOUT); +} +EXPORT_SYMBOL(rtw_tx_report_enqueue); + +static void rtw_tx_report_tx_status(struct rtw_dev *rtwdev, + struct sk_buff *skb, bool acked) +{ + struct ieee80211_tx_info *info; + + info = IEEE80211_SKB_CB(skb); + ieee80211_tx_info_clear_status(info); + if (acked) + info->flags |= IEEE80211_TX_STAT_ACK; + else + info->flags &= ~IEEE80211_TX_STAT_ACK; + + ieee80211_tx_status_irqsafe(rtwdev->hw, skb); +} + +void rtw_tx_report_handle(struct rtw_dev *rtwdev, struct sk_buff *skb, int src) +{ + struct rtw_tx_report *tx_report = &rtwdev->tx_report; + struct rtw_c2h_cmd *c2h; + struct sk_buff *cur, *tmp; + unsigned long flags; + u8 sn, st; + u8 *n; + + c2h = get_c2h_from_skb(skb); + + if (src == C2H_CCX_TX_RPT) { + sn = GET_CCX_REPORT_SEQNUM_V0(c2h->payload); + st = GET_CCX_REPORT_STATUS_V0(c2h->payload); + } else { + sn = GET_CCX_REPORT_SEQNUM_V1(c2h->payload); + st = GET_CCX_REPORT_STATUS_V1(c2h->payload); + } + + spin_lock_irqsave(&tx_report->q_lock, flags); + skb_queue_walk_safe(&tx_report->queue, cur, tmp) { + n = (u8 *)IEEE80211_SKB_CB(cur)->status.status_driver_data; + if (*n == sn) { + __skb_unlink(cur, &tx_report->queue); + rtw_tx_report_tx_status(rtwdev, cur, st == 0); + break; + } + } + spin_unlock_irqrestore(&tx_report->q_lock, flags); +} + +static u8 rtw_get_mgmt_rate(struct rtw_dev *rtwdev, struct sk_buff *skb, + u8 lowest_rate, bool ignore_rate) +{ + struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb); + struct ieee80211_vif *vif = tx_info->control.vif; + bool force_lowest = test_bit(RTW_FLAG_FORCE_LOWEST_RATE, rtwdev->flags); + + if (!vif || !vif->bss_conf.basic_rates || ignore_rate || force_lowest) + return lowest_rate; + + return __ffs(vif->bss_conf.basic_rates) + lowest_rate; +} + +static void rtw_tx_pkt_info_update_rate(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb, + bool ignore_rate) +{ + if (rtwdev->hal.current_band_type == RTW_BAND_2G) { + pkt_info->rate_id = RTW_RATEID_B_20M; + pkt_info->rate = rtw_get_mgmt_rate(rtwdev, skb, DESC_RATE1M, + ignore_rate); + } else { + pkt_info->rate_id = RTW_RATEID_G; + pkt_info->rate = rtw_get_mgmt_rate(rtwdev, skb, DESC_RATE6M, + ignore_rate); + } + + pkt_info->use_rate = true; + pkt_info->dis_rate_fallback = true; +} + +static void rtw_tx_pkt_info_update_sec(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb) +{ + struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); + u8 sec_type = 0; + + if (info && info->control.hw_key) { + struct ieee80211_key_conf *key = info->control.hw_key; + + switch (key->cipher) { + case WLAN_CIPHER_SUITE_WEP40: + case WLAN_CIPHER_SUITE_WEP104: + case WLAN_CIPHER_SUITE_TKIP: + sec_type = 0x01; + break; + case WLAN_CIPHER_SUITE_CCMP: + sec_type = 0x03; + break; + default: + break; + } + } + + pkt_info->sec_type = sec_type; +} + +static void rtw_tx_mgmt_pkt_info_update(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct ieee80211_sta *sta, + struct sk_buff *skb) +{ + rtw_tx_pkt_info_update_rate(rtwdev, pkt_info, skb, false); + pkt_info->dis_qselseq = true; + pkt_info->en_hwseq = true; + pkt_info->hw_ssn_sel = 0; + /* TODO: need to change hw port and hw ssn sel for multiple vifs */ +} + +static void rtw_tx_data_pkt_info_update(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct ieee80211_sta *sta, + struct sk_buff *skb) +{ + struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; + struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); + struct ieee80211_hw *hw = rtwdev->hw; + struct rtw_dm_info *dm_info = &rtwdev->dm_info; + struct rtw_sta_info *si; + u8 fix_rate; + u16 seq; + u8 ampdu_factor = 0; + u8 ampdu_density = 0; + bool ampdu_en = false; + u8 rate = DESC_RATE6M; + u8 rate_id = 6; + u8 bw = RTW_CHANNEL_WIDTH_20; + bool stbc = false; + bool ldpc = false; + + seq = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4; + + /* for broadcast/multicast, use default values */ + if (!sta) + goto out; + + if (info->flags & IEEE80211_TX_CTL_AMPDU) { + ampdu_en = true; + ampdu_factor = get_tx_ampdu_factor(sta); + ampdu_density = get_tx_ampdu_density(sta); + } + + if (info->control.use_rts || skb->len > hw->wiphy->rts_threshold) + pkt_info->rts = true; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 19, 0) + if (sta->deflink.vht_cap.vht_supported) + rate = get_highest_vht_tx_rate(rtwdev, sta); + else if (sta->deflink.ht_cap.ht_supported) + rate = get_highest_ht_tx_rate(rtwdev, sta); + else if (sta->deflink.supp_rates[0] <= 0xf) + rate = DESC_RATE11M; + else + rate = DESC_RATE54M; +#else + if (sta->vht_cap.vht_supported) + rate = get_highest_vht_tx_rate(rtwdev, sta); + else if (sta->ht_cap.ht_supported) + rate = get_highest_ht_tx_rate(rtwdev, sta); + else if (sta->supp_rates[0] <= 0xf) + rate = DESC_RATE11M; + else + rate = DESC_RATE54M; +#endif + + si = (struct rtw_sta_info *)sta->drv_priv; + + bw = si->bw_mode; + rate_id = si->rate_id; + stbc = rtwdev->hal.txrx_1ss ? false : si->stbc_en; + ldpc = si->ldpc_en; + +out: + pkt_info->seq = seq; + pkt_info->ampdu_factor = ampdu_factor; + pkt_info->ampdu_density = ampdu_density; + pkt_info->ampdu_en = ampdu_en; + pkt_info->rate = rate; + pkt_info->rate_id = rate_id; + pkt_info->bw = bw; + pkt_info->stbc = stbc; + pkt_info->ldpc = ldpc; + + fix_rate = dm_info->fix_rate; + if (fix_rate < DESC_RATE_MAX) { + pkt_info->rate = fix_rate; + pkt_info->dis_rate_fallback = true; + pkt_info->use_rate = true; + } +} + +void rtw_tx_pkt_info_update(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct ieee80211_sta *sta, + struct sk_buff *skb) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); + struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; + struct rtw_sta_info *si; + struct ieee80211_vif *vif = NULL; + __le16 fc = hdr->frame_control; + bool bmc; + + if (sta) { + si = (struct rtw_sta_info *)sta->drv_priv; + vif = si->vif; + } + + if (ieee80211_is_mgmt(fc) || ieee80211_is_nullfunc(fc)) + rtw_tx_mgmt_pkt_info_update(rtwdev, pkt_info, sta, skb); + else if (ieee80211_is_data(fc)) + rtw_tx_data_pkt_info_update(rtwdev, pkt_info, sta, skb); + + bmc = is_broadcast_ether_addr(hdr->addr1) || + is_multicast_ether_addr(hdr->addr1); + + if (info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS) + rtw_tx_report_enable(rtwdev, pkt_info); + + pkt_info->bmc = bmc; + rtw_tx_pkt_info_update_sec(rtwdev, pkt_info, skb); + pkt_info->tx_pkt_size = skb->len; + pkt_info->offset = chip->tx_pkt_desc_sz; + pkt_info->qsel = skb->priority; + pkt_info->ls = true; + + /* maybe merge with tx status ? */ + rtw_tx_stats(rtwdev, vif, skb); +} + +void rtw_tx_rsvd_page_pkt_info_update(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb, + enum rtw_rsvd_packet_type type) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; + bool bmc; + + /* A beacon or dummy reserved page packet indicates that it is the first + * reserved page, and the qsel of it will be set in each hci. + */ + if (type != RSVD_BEACON && type != RSVD_DUMMY) + pkt_info->qsel = TX_DESC_QSEL_MGMT; + + rtw_tx_pkt_info_update_rate(rtwdev, pkt_info, skb, true); + + bmc = is_broadcast_ether_addr(hdr->addr1) || + is_multicast_ether_addr(hdr->addr1); + pkt_info->bmc = bmc; + pkt_info->tx_pkt_size = skb->len; + pkt_info->offset = chip->tx_pkt_desc_sz; + pkt_info->ls = true; + if (type == RSVD_PS_POLL) { + pkt_info->nav_use_hdr = true; + } else { + pkt_info->dis_qselseq = true; + pkt_info->en_hwseq = true; + pkt_info->hw_ssn_sel = 0; + } + if (type == RSVD_QOS_NULL) + pkt_info->bt_null = true; + + if (type == RSVD_BEACON) { + struct rtw_rsvd_page *rsvd_pkt; + int hdr_len; + + rsvd_pkt = list_first_entry_or_null(&rtwdev->rsvd_page_list, + struct rtw_rsvd_page, + build_list); + if (rsvd_pkt && rsvd_pkt->tim_offset != 0) { + hdr_len = sizeof(struct ieee80211_hdr_3addr); + pkt_info->tim_offset = rsvd_pkt->tim_offset - hdr_len; + } + } + + rtw_tx_pkt_info_update_sec(rtwdev, pkt_info, skb); + + /* TODO: need to change hw port and hw ssn sel for multiple vifs */ +} + +struct sk_buff * +rtw_tx_write_data_rsvd_page_get(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *buf, u32 size) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct sk_buff *skb; + u32 tx_pkt_desc_sz; + u32 length; + + tx_pkt_desc_sz = chip->tx_pkt_desc_sz; + length = size + tx_pkt_desc_sz; + skb = dev_alloc_skb(length); + if (!skb) { + rtw_err(rtwdev, "failed to alloc write data rsvd page skb\n"); + return NULL; + } + + skb_reserve(skb, tx_pkt_desc_sz); + skb_put_data(skb, buf, size); + rtw_tx_rsvd_page_pkt_info_update(rtwdev, pkt_info, skb, RSVD_BEACON); + + return skb; +} +EXPORT_SYMBOL(rtw_tx_write_data_rsvd_page_get); + +struct sk_buff * +rtw_tx_write_data_h2c_get(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *buf, u32 size) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct sk_buff *skb; + u32 tx_pkt_desc_sz; + u32 length; + + tx_pkt_desc_sz = chip->tx_pkt_desc_sz; + length = size + tx_pkt_desc_sz; + skb = dev_alloc_skb(length); + if (!skb) { + rtw_err(rtwdev, "failed to alloc write data h2c skb\n"); + return NULL; + } + + skb_reserve(skb, tx_pkt_desc_sz); + skb_put_data(skb, buf, size); + pkt_info->tx_pkt_size = size; + + return skb; +} +EXPORT_SYMBOL(rtw_tx_write_data_h2c_get); + +void rtw_tx(struct rtw_dev *rtwdev, + struct ieee80211_tx_control *control, + struct sk_buff *skb) +{ + struct rtw_tx_pkt_info pkt_info = {0}; + int ret; + + rtw_tx_pkt_info_update(rtwdev, &pkt_info, control->sta, skb); + ret = rtw_hci_tx_write(rtwdev, &pkt_info, skb); + if (ret) { + rtw_err(rtwdev, "failed to write TX skb to HCI\n"); + goto out; + } + + rtw_hci_tx_kick_off(rtwdev); + + return; + +out: + ieee80211_free_txskb(rtwdev->hw, skb); +} + +static void rtw_txq_check_agg(struct rtw_dev *rtwdev, + struct rtw_txq *rtwtxq, + struct sk_buff *skb) +{ + struct ieee80211_txq *txq = rtwtxq_to_txq(rtwtxq); + struct ieee80211_tx_info *info; + struct rtw_sta_info *si; + + if (test_bit(RTW_TXQ_AMPDU, &rtwtxq->flags)) { + info = IEEE80211_SKB_CB(skb); + info->flags |= IEEE80211_TX_CTL_AMPDU; + return; + } + + if (skb_get_queue_mapping(skb) == IEEE80211_AC_VO) + return; + + if (test_bit(RTW_TXQ_BLOCK_BA, &rtwtxq->flags)) + return; + + if (unlikely(skb->protocol == cpu_to_be16(ETH_P_PAE))) + return; + + if (!txq->sta) + return; + + si = (struct rtw_sta_info *)txq->sta->drv_priv; + set_bit(txq->tid, si->tid_ba); + + ieee80211_queue_work(rtwdev->hw, &rtwdev->ba_work); +} + +static int rtw_txq_push_skb(struct rtw_dev *rtwdev, + struct rtw_txq *rtwtxq, + struct sk_buff *skb) +{ + struct ieee80211_txq *txq = rtwtxq_to_txq(rtwtxq); + struct rtw_tx_pkt_info pkt_info = {0}; + int ret; + + rtw_txq_check_agg(rtwdev, rtwtxq, skb); + + rtw_tx_pkt_info_update(rtwdev, &pkt_info, txq->sta, skb); + ret = rtw_hci_tx_write(rtwdev, &pkt_info, skb); + if (ret) { + rtw_err(rtwdev, "failed to write TX skb to HCI\n"); + return ret; + } + return 0; +} + +static struct sk_buff *rtw_txq_dequeue(struct rtw_dev *rtwdev, + struct rtw_txq *rtwtxq) +{ + struct ieee80211_txq *txq = rtwtxq_to_txq(rtwtxq); + struct sk_buff *skb; + + skb = ieee80211_tx_dequeue(rtwdev->hw, txq); + if (!skb) + return NULL; + + return skb; +} + +static void rtw_txq_push(struct rtw_dev *rtwdev, + struct rtw_txq *rtwtxq, + unsigned long frames) +{ + struct sk_buff *skb; + int ret; + int i; + + rcu_read_lock(); + + for (i = 0; i < frames; i++) { + skb = rtw_txq_dequeue(rtwdev, rtwtxq); + if (!skb) + break; + + ret = rtw_txq_push_skb(rtwdev, rtwtxq, skb); + if (ret) { + rtw_err(rtwdev, "failed to pusk skb, ret %d\n", ret); + break; + } + } + + rcu_read_unlock(); +} + +void __rtw_tx_work(struct rtw_dev *rtwdev) +{ + struct rtw_txq *rtwtxq, *tmp; + + spin_lock_bh(&rtwdev->txq_lock); + + list_for_each_entry_safe(rtwtxq, tmp, &rtwdev->txqs, list) { + struct ieee80211_txq *txq = rtwtxq_to_txq(rtwtxq); + unsigned long frame_cnt; + unsigned long byte_cnt; + + ieee80211_txq_get_depth(txq, &frame_cnt, &byte_cnt); + rtw_txq_push(rtwdev, rtwtxq, frame_cnt); + + list_del_init(&rtwtxq->list); + } + + rtw_hci_tx_kick_off(rtwdev); + + spin_unlock_bh(&rtwdev->txq_lock); +} + +void rtw_tx_work(struct work_struct *w) +{ + struct rtw_dev *rtwdev = container_of(w, struct rtw_dev, tx_work); + + __rtw_tx_work(rtwdev); +} + +void rtw_txq_init(struct rtw_dev *rtwdev, struct ieee80211_txq *txq) +{ + struct rtw_txq *rtwtxq; + + if (!txq) + return; + + rtwtxq = (struct rtw_txq *)txq->drv_priv; + INIT_LIST_HEAD(&rtwtxq->list); +} + +void rtw_txq_cleanup(struct rtw_dev *rtwdev, struct ieee80211_txq *txq) +{ + struct rtw_txq *rtwtxq; + + if (!txq) + return; + + rtwtxq = (struct rtw_txq *)txq->drv_priv; + spin_lock_bh(&rtwdev->txq_lock); + if (!list_empty(&rtwtxq->list)) + list_del_init(&rtwtxq->list); + spin_unlock_bh(&rtwdev->txq_lock); +} + +static const enum rtw_tx_queue_type ac_to_hwq[] = { + [IEEE80211_AC_VO] = RTW_TX_QUEUE_VO, + [IEEE80211_AC_VI] = RTW_TX_QUEUE_VI, + [IEEE80211_AC_BE] = RTW_TX_QUEUE_BE, + [IEEE80211_AC_BK] = RTW_TX_QUEUE_BK, +}; + +static_assert(ARRAY_SIZE(ac_to_hwq) == IEEE80211_NUM_ACS); + +enum rtw_tx_queue_type rtw_tx_ac_to_hwq(enum ieee80211_ac_numbers ac) +{ + if (WARN_ON(unlikely(ac >= IEEE80211_NUM_ACS))) + return RTW_TX_QUEUE_BE; + + return ac_to_hwq[ac]; +} +EXPORT_SYMBOL(rtw_tx_ac_to_hwq); + +enum rtw_tx_queue_type rtw_tx_queue_mapping(struct sk_buff *skb) +{ + struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; + __le16 fc = hdr->frame_control; + u8 q_mapping = skb_get_queue_mapping(skb); + enum rtw_tx_queue_type queue; + + if (unlikely(ieee80211_is_beacon(fc))) + queue = RTW_TX_QUEUE_BCN; + else if (unlikely(ieee80211_is_mgmt(fc) || ieee80211_is_ctl(fc))) + queue = RTW_TX_QUEUE_MGMT; + else if (is_broadcast_ether_addr(hdr->addr1) || + is_multicast_ether_addr(hdr->addr1)) + queue = RTW_TX_QUEUE_HI0; + else if (WARN_ON_ONCE(q_mapping >= ARRAY_SIZE(ac_to_hwq))) + queue = ac_to_hwq[IEEE80211_AC_BE]; + else + queue = ac_to_hwq[q_mapping]; + + return queue; +} +EXPORT_SYMBOL(rtw_tx_queue_mapping); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/tx.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/tx.h new file mode 100644 index 0000000000000000000000000000000000000000..3241896062577ba771cc6225ae503c273856ada7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/tx.h @@ -0,0 +1,140 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_TX_H_ +#define __RTW_TX_H_ + +#define RTK_TX_MAX_AGG_NUM_MASK 0x1f + +#define RTW_TX_PROBE_TIMEOUT msecs_to_jiffies(500) + +struct rtw_tx_desc { + __le32 w0; + __le32 w1; + __le32 w2; + __le32 w3; + __le32 w4; + __le32 w5; + __le32 w6; + __le32 w7; + __le32 w8; + __le32 w9; +} __packed; + +#define RTW_TX_DESC_W0_TXPKTSIZE GENMASK(15, 0) +#define RTW_TX_DESC_W0_OFFSET GENMASK(23, 16) +#define RTW_TX_DESC_W0_BMC BIT(24) +#define RTW_TX_DESC_W0_LS BIT(26) +#define RTW_TX_DESC_W0_DISQSELSEQ BIT(31) +#define RTW_TX_DESC_W1_QSEL GENMASK(12, 8) +#define RTW_TX_DESC_W1_RATE_ID GENMASK(20, 16) +#define RTW_TX_DESC_W1_SEC_TYPE GENMASK(23, 22) +#define RTW_TX_DESC_W1_PKT_OFFSET GENMASK(28, 24) +#define RTW_TX_DESC_W1_MORE_DATA BIT(29) +#define RTW_TX_DESC_W2_AGG_EN BIT(12) +#define RTW_TX_DESC_W2_SPE_RPT BIT(19) +#define RTW_TX_DESC_W2_AMPDU_DEN GENMASK(22, 20) +#define RTW_TX_DESC_W2_BT_NULL BIT(23) +#define RTW_TX_DESC_W3_HW_SSN_SEL GENMASK(7, 6) +#define RTW_TX_DESC_W3_USE_RATE BIT(8) +#define RTW_TX_DESC_W3_DISDATAFB BIT(10) +#define RTW_TX_DESC_W3_USE_RTS BIT(12) +#define RTW_TX_DESC_W3_NAVUSEHDR BIT(15) +#define RTW_TX_DESC_W3_MAX_AGG_NUM GENMASK(21, 17) +#define RTW_TX_DESC_W4_DATARATE GENMASK(6, 0) +#define RTW_TX_DESC_W4_RTSRATE GENMASK(28, 24) +#define RTW_TX_DESC_W5_DATA_SHORT BIT(4) +#define RTW_TX_DESC_W5_DATA_BW GENMASK(6, 5) +#define RTW_TX_DESC_W5_DATA_LDPC BIT(7) +#define RTW_TX_DESC_W5_DATA_STBC GENMASK(9, 8) +#define RTW_TX_DESC_W5_DATA_RTS_SHORT BIT(12) +#define RTW_TX_DESC_W6_SW_DEFINE GENMASK(11, 0) +#define RTW_TX_DESC_W7_TXDESC_CHECKSUM GENMASK(15, 0) +#define RTW_TX_DESC_W7_DMA_TXAGG_NUM GENMASK(31, 24) +#define RTW_TX_DESC_W8_EN_HWSEQ BIT(15) +#define RTW_TX_DESC_W9_SW_SEQ GENMASK(23, 12) +#define RTW_TX_DESC_W9_TIM_EN BIT(7) +#define RTW_TX_DESC_W9_TIM_OFFSET GENMASK(6, 0) + +enum rtw_tx_desc_queue_select { + TX_DESC_QSEL_TID0 = 0, + TX_DESC_QSEL_TID1 = 1, + TX_DESC_QSEL_TID2 = 2, + TX_DESC_QSEL_TID3 = 3, + TX_DESC_QSEL_TID4 = 4, + TX_DESC_QSEL_TID5 = 5, + TX_DESC_QSEL_TID6 = 6, + TX_DESC_QSEL_TID7 = 7, + TX_DESC_QSEL_TID8 = 8, + TX_DESC_QSEL_TID9 = 9, + TX_DESC_QSEL_TID10 = 10, + TX_DESC_QSEL_TID11 = 11, + TX_DESC_QSEL_TID12 = 12, + TX_DESC_QSEL_TID13 = 13, + TX_DESC_QSEL_TID14 = 14, + TX_DESC_QSEL_TID15 = 15, + TX_DESC_QSEL_BEACON = 16, + TX_DESC_QSEL_HIGH = 17, + TX_DESC_QSEL_MGMT = 18, + TX_DESC_QSEL_H2C = 19, +}; + +enum rtw_rsvd_packet_type; + +void rtw_tx(struct rtw_dev *rtwdev, + struct ieee80211_tx_control *control, + struct sk_buff *skb); +void rtw_txq_init(struct rtw_dev *rtwdev, struct ieee80211_txq *txq); +void rtw_txq_cleanup(struct rtw_dev *rtwdev, struct ieee80211_txq *txq); +void rtw_tx_work(struct work_struct *w); +void __rtw_tx_work(struct rtw_dev *rtwdev); +void rtw_tx_pkt_info_update(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct ieee80211_sta *sta, + struct sk_buff *skb); +void rtw_tx_fill_tx_desc(struct rtw_tx_pkt_info *pkt_info, struct sk_buff *skb); +void rtw_tx_report_enqueue(struct rtw_dev *rtwdev, struct sk_buff *skb, u8 sn); +void rtw_tx_report_handle(struct rtw_dev *rtwdev, struct sk_buff *skb, int src); +void rtw_tx_rsvd_page_pkt_info_update(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb, + enum rtw_rsvd_packet_type type); +struct sk_buff * +rtw_tx_write_data_rsvd_page_get(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *buf, u32 size); +struct sk_buff * +rtw_tx_write_data_h2c_get(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *buf, u32 size); + +enum rtw_tx_queue_type rtw_tx_ac_to_hwq(enum ieee80211_ac_numbers ac); +enum rtw_tx_queue_type rtw_tx_queue_mapping(struct sk_buff *skb); + +static inline +void fill_txdesc_checksum_common(u8 *txdesc, size_t words) +{ + __le16 chksum = 0; + __le16 *data = (__le16 *)(txdesc); + struct rtw_tx_desc *tx_desc = (struct rtw_tx_desc *)txdesc; + + le32p_replace_bits(&tx_desc->w7, 0, RTW_TX_DESC_W7_TXDESC_CHECKSUM); + + while (words--) + chksum ^= *data++; + + le32p_replace_bits(&tx_desc->w7, __le16_to_cpu(chksum), + RTW_TX_DESC_W7_TXDESC_CHECKSUM); +} + +static inline void rtw_tx_fill_txdesc_checksum(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *txdesc) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + + chip->ops->fill_txdesc_checksum(rtwdev, pkt_info, txdesc); +} + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/usb.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/usb.c new file mode 100644 index 0000000000000000000000000000000000000000..f9add1ec33a9f16c1d9e603daad88eb44d24f0de --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/usb.c @@ -0,0 +1,916 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include +#include +#include +#include "main.h" +#include "debug.h" +#include "reg.h" +#include "tx.h" +#include "rx.h" +#include "fw.h" +#include "ps.h" +#include "usb.h" + +#define RTW_USB_MAX_RXQ_LEN 512 + +struct rtw_usb_txcb { + struct rtw_dev *rtwdev; + struct sk_buff_head tx_ack_queue; +}; + +static void rtw_usb_fill_tx_checksum(struct rtw_usb *rtwusb, + struct sk_buff *skb, int agg_num) +{ + struct rtw_tx_desc *tx_desc = (struct rtw_tx_desc *)skb->data; + struct rtw_dev *rtwdev = rtwusb->rtwdev; + struct rtw_tx_pkt_info pkt_info; + + le32p_replace_bits(&tx_desc->w7, agg_num, RTW_TX_DESC_W7_DMA_TXAGG_NUM); + pkt_info.pkt_offset = le32_get_bits(tx_desc->w1, RTW_TX_DESC_W1_PKT_OFFSET); + rtw_tx_fill_txdesc_checksum(rtwdev, &pkt_info, skb->data); +} + +static u32 rtw_usb_read(struct rtw_dev *rtwdev, u32 addr, u16 len) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + struct usb_device *udev = rtwusb->udev; + __le32 *data; + unsigned long flags; + int idx, ret; + static int count; + + spin_lock_irqsave(&rtwusb->usb_lock, flags); + + idx = rtwusb->usb_data_index; + rtwusb->usb_data_index = (idx + 1) & (RTW_USB_MAX_RXTX_COUNT - 1); + + spin_unlock_irqrestore(&rtwusb->usb_lock, flags); + + data = &rtwusb->usb_data[idx]; + + ret = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), + RTW_USB_CMD_REQ, RTW_USB_CMD_READ, addr, + RTW_USB_VENQT_CMD_IDX, data, len, 1000); + if (ret < 0 && ret != -ENODEV && count++ < 4) + rtw_err(rtwdev, "read register 0x%x failed with %d\n", + addr, ret); + + return le32_to_cpu(*data); +} + +static u8 rtw_usb_read8(struct rtw_dev *rtwdev, u32 addr) +{ + return (u8)rtw_usb_read(rtwdev, addr, 1); +} + +static u16 rtw_usb_read16(struct rtw_dev *rtwdev, u32 addr) +{ + return (u16)rtw_usb_read(rtwdev, addr, 2); +} + +static u32 rtw_usb_read32(struct rtw_dev *rtwdev, u32 addr) +{ + return (u32)rtw_usb_read(rtwdev, addr, 4); +} + +static void rtw_usb_write(struct rtw_dev *rtwdev, u32 addr, u32 val, int len) +{ + struct rtw_usb *rtwusb = (struct rtw_usb *)rtwdev->priv; + struct usb_device *udev = rtwusb->udev; + unsigned long flags; + __le32 *data; + int idx, ret; + static int count; + + spin_lock_irqsave(&rtwusb->usb_lock, flags); + + idx = rtwusb->usb_data_index; + rtwusb->usb_data_index = (idx + 1) & (RTW_USB_MAX_RXTX_COUNT - 1); + + spin_unlock_irqrestore(&rtwusb->usb_lock, flags); + + data = &rtwusb->usb_data[idx]; + + *data = cpu_to_le32(val); + + ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), + RTW_USB_CMD_REQ, RTW_USB_CMD_WRITE, + addr, 0, data, len, 30000); + if (ret < 0 && ret != -ENODEV && count++ < 4) + rtw_err(rtwdev, "write register 0x%x failed with %d\n", + addr, ret); +} + +static void rtw_usb_write8(struct rtw_dev *rtwdev, u32 addr, u8 val) +{ + rtw_usb_write(rtwdev, addr, val, 1); +} + +static void rtw_usb_write16(struct rtw_dev *rtwdev, u32 addr, u16 val) +{ + rtw_usb_write(rtwdev, addr, val, 2); +} + +static void rtw_usb_write32(struct rtw_dev *rtwdev, u32 addr, u32 val) +{ + rtw_usb_write(rtwdev, addr, val, 4); +} + +static int dma_mapping_to_ep(enum rtw_dma_mapping dma_mapping) +{ + switch (dma_mapping) { + case RTW_DMA_MAPPING_HIGH: + return 0; + case RTW_DMA_MAPPING_NORMAL: + return 1; + case RTW_DMA_MAPPING_LOW: + return 2; + case RTW_DMA_MAPPING_EXTRA: + return 3; + default: + return -EINVAL; + } +} + +static int rtw_usb_parse(struct rtw_dev *rtwdev, + struct usb_interface *interface) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + struct usb_host_interface *host_interface = &interface->altsetting[0]; + struct usb_interface_descriptor *interface_desc = &host_interface->desc; + struct usb_endpoint_descriptor *endpoint; + int num_out_pipes = 0; + int i; + u8 num; + const struct rtw_chip_info *chip = rtwdev->chip; + const struct rtw_rqpn *rqpn; + + for (i = 0; i < interface_desc->bNumEndpoints; i++) { + endpoint = &host_interface->endpoint[i].desc; + num = usb_endpoint_num(endpoint); + + if (usb_endpoint_dir_in(endpoint) && + usb_endpoint_xfer_bulk(endpoint)) { + if (rtwusb->pipe_in) { + rtw_err(rtwdev, "IN pipes overflow\n"); + return -EINVAL; + } + + rtwusb->pipe_in = num; + } + + if (usb_endpoint_dir_in(endpoint) && + usb_endpoint_xfer_int(endpoint)) { + if (rtwusb->pipe_interrupt) { + rtw_err(rtwdev, "INT pipes overflow\n"); + return -EINVAL; + } + + rtwusb->pipe_interrupt = num; + } + + if (usb_endpoint_dir_out(endpoint) && + usb_endpoint_xfer_bulk(endpoint)) { + if (num_out_pipes >= ARRAY_SIZE(rtwusb->out_ep)) { + rtw_err(rtwdev, "OUT pipes overflow\n"); + return -EINVAL; + } + + rtwusb->out_ep[num_out_pipes++] = num; + } + } + + rtwdev->hci.bulkout_num = num_out_pipes; + + if (num_out_pipes < 1 || num_out_pipes > 4) { + rtw_err(rtwdev, "invalid number of endpoints %d\n", num_out_pipes); + return -EINVAL; + } + + rqpn = &chip->rqpn_table[num_out_pipes]; + + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID0] = dma_mapping_to_ep(rqpn->dma_map_be); + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID1] = dma_mapping_to_ep(rqpn->dma_map_bk); + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID2] = dma_mapping_to_ep(rqpn->dma_map_bk); + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID3] = dma_mapping_to_ep(rqpn->dma_map_be); + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID4] = dma_mapping_to_ep(rqpn->dma_map_vi); + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID5] = dma_mapping_to_ep(rqpn->dma_map_vi); + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID6] = dma_mapping_to_ep(rqpn->dma_map_vo); + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID7] = dma_mapping_to_ep(rqpn->dma_map_vo); + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID8] = -EINVAL; + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID9] = -EINVAL; + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID10] = -EINVAL; + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID11] = -EINVAL; + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID12] = -EINVAL; + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID13] = -EINVAL; + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID14] = -EINVAL; + rtwusb->qsel_to_ep[TX_DESC_QSEL_TID15] = -EINVAL; + rtwusb->qsel_to_ep[TX_DESC_QSEL_BEACON] = dma_mapping_to_ep(rqpn->dma_map_hi); + rtwusb->qsel_to_ep[TX_DESC_QSEL_HIGH] = dma_mapping_to_ep(rqpn->dma_map_hi); + rtwusb->qsel_to_ep[TX_DESC_QSEL_MGMT] = dma_mapping_to_ep(rqpn->dma_map_mg); + rtwusb->qsel_to_ep[TX_DESC_QSEL_H2C] = dma_mapping_to_ep(rqpn->dma_map_hi); + + return 0; +} + +static void rtw_usb_write_port_tx_complete(struct urb *urb) +{ + struct rtw_usb_txcb *txcb = urb->context; + struct rtw_dev *rtwdev = txcb->rtwdev; + struct ieee80211_hw *hw = rtwdev->hw; + + while (true) { + struct sk_buff *skb = skb_dequeue(&txcb->tx_ack_queue); + struct ieee80211_tx_info *info; + struct rtw_usb_tx_data *tx_data; + + if (!skb) + break; + + info = IEEE80211_SKB_CB(skb); + tx_data = rtw_usb_get_tx_data(skb); + + /* enqueue to wait for tx report */ + if (info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS) { + rtw_tx_report_enqueue(rtwdev, skb, tx_data->sn); + continue; + } + + /* always ACK for others, then they won't be marked as drop */ + ieee80211_tx_info_clear_status(info); + if (info->flags & IEEE80211_TX_CTL_NO_ACK) + info->flags |= IEEE80211_TX_STAT_NOACK_TRANSMITTED; + else + info->flags |= IEEE80211_TX_STAT_ACK; + + ieee80211_tx_status_irqsafe(hw, skb); + } + + kfree(txcb); +} + +static int qsel_to_ep(struct rtw_usb *rtwusb, unsigned int qsel) +{ + if (qsel >= ARRAY_SIZE(rtwusb->qsel_to_ep)) + return -EINVAL; + + return rtwusb->qsel_to_ep[qsel]; +} + +static int rtw_usb_write_port(struct rtw_dev *rtwdev, u8 qsel, struct sk_buff *skb, + usb_complete_t cb, void *context) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + struct usb_device *usbd = rtwusb->udev; + struct urb *urb; + unsigned int pipe; + int ret; + int ep = qsel_to_ep(rtwusb, qsel); + + if (ep < 0) + return ep; + + pipe = usb_sndbulkpipe(usbd, rtwusb->out_ep[ep]); + urb = usb_alloc_urb(0, GFP_ATOMIC); + if (!urb) + return -ENOMEM; + + usb_fill_bulk_urb(urb, usbd, pipe, skb->data, skb->len, cb, context); + urb->transfer_flags |= URB_ZERO_PACKET; + ret = usb_submit_urb(urb, GFP_ATOMIC); + + usb_free_urb(urb); + + return ret; +} + +static bool rtw_usb_tx_agg_skb(struct rtw_usb *rtwusb, struct sk_buff_head *list) +{ + struct rtw_dev *rtwdev = rtwusb->rtwdev; + struct rtw_tx_desc *tx_desc; + struct rtw_usb_txcb *txcb; + struct sk_buff *skb_head; + struct sk_buff *skb_iter; + int agg_num = 0; + unsigned int align_next = 0; + u8 qsel; + + if (skb_queue_empty(list)) + return false; + + txcb = kmalloc(sizeof(*txcb), GFP_ATOMIC); + if (!txcb) + return false; + + txcb->rtwdev = rtwdev; + skb_queue_head_init(&txcb->tx_ack_queue); + + skb_iter = skb_dequeue(list); + + if (skb_queue_empty(list)) { + skb_head = skb_iter; + goto queue; + } + + skb_head = dev_alloc_skb(RTW_USB_MAX_XMITBUF_SZ); + if (!skb_head) { + skb_head = skb_iter; + goto queue; + } + + while (skb_iter) { + unsigned long flags; + + skb_put(skb_head, align_next); + skb_put_data(skb_head, skb_iter->data, skb_iter->len); + + align_next = ALIGN(skb_iter->len, 8) - skb_iter->len; + + agg_num++; + + skb_queue_tail(&txcb->tx_ack_queue, skb_iter); + + spin_lock_irqsave(&list->lock, flags); + + skb_iter = skb_peek(list); + + if (skb_iter && skb_iter->len + skb_head->len <= RTW_USB_MAX_XMITBUF_SZ) + __skb_unlink(skb_iter, list); + else + skb_iter = NULL; + spin_unlock_irqrestore(&list->lock, flags); + } + + if (agg_num > 1) + rtw_usb_fill_tx_checksum(rtwusb, skb_head, agg_num); + +queue: + skb_queue_tail(&txcb->tx_ack_queue, skb_head); + tx_desc = (struct rtw_tx_desc *)skb_head->data; + qsel = le32_get_bits(tx_desc->w1, RTW_TX_DESC_W1_QSEL); + + rtw_usb_write_port(rtwdev, qsel, skb_head, rtw_usb_write_port_tx_complete, txcb); + + return true; +} + +static void rtw_usb_tx_handler(struct work_struct *work) +{ + struct rtw_usb *rtwusb = container_of(work, struct rtw_usb, tx_work); + int i, limit; + + for (i = ARRAY_SIZE(rtwusb->tx_queue) - 1; i >= 0; i--) { + for (limit = 0; limit < 200; limit++) { + struct sk_buff_head *list = &rtwusb->tx_queue[i]; + + if (!rtw_usb_tx_agg_skb(rtwusb, list)) + break; + } + } +} + +static void rtw_usb_tx_queue_purge(struct rtw_usb *rtwusb) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(rtwusb->tx_queue); i++) + skb_queue_purge(&rtwusb->tx_queue[i]); +} + +static void rtw_usb_write_port_complete(struct urb *urb) +{ + struct sk_buff *skb = urb->context; + + dev_kfree_skb_any(skb); +} + +static int rtw_usb_write_data(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + u8 *buf) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct sk_buff *skb; + unsigned int desclen, headsize, size; + u8 qsel; + int ret = 0; + + size = pkt_info->tx_pkt_size; + qsel = pkt_info->qsel; + desclen = chip->tx_pkt_desc_sz; + headsize = pkt_info->offset ? pkt_info->offset : desclen; + + skb = dev_alloc_skb(headsize + size); + if (unlikely(!skb)) + return -ENOMEM; + + skb_reserve(skb, headsize); + skb_put_data(skb, buf, size); + skb_push(skb, headsize); + memset(skb->data, 0, headsize); + rtw_tx_fill_tx_desc(pkt_info, skb); + rtw_tx_fill_txdesc_checksum(rtwdev, pkt_info, skb->data); + + ret = rtw_usb_write_port(rtwdev, qsel, skb, + rtw_usb_write_port_complete, skb); + if (unlikely(ret)) + rtw_err(rtwdev, "failed to do USB write, ret=%d\n", ret); + + return ret; +} + +static int rtw_usb_write_data_rsvd_page(struct rtw_dev *rtwdev, u8 *buf, + u32 size) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_tx_pkt_info pkt_info = {0}; + + pkt_info.tx_pkt_size = size; + pkt_info.qsel = TX_DESC_QSEL_BEACON; + pkt_info.offset = chip->tx_pkt_desc_sz; + + return rtw_usb_write_data(rtwdev, &pkt_info, buf); +} + +static int rtw_usb_write_data_h2c(struct rtw_dev *rtwdev, u8 *buf, u32 size) +{ + struct rtw_tx_pkt_info pkt_info = {0}; + + pkt_info.tx_pkt_size = size; + pkt_info.qsel = TX_DESC_QSEL_H2C; + + return rtw_usb_write_data(rtwdev, &pkt_info, buf); +} + +static u8 rtw_usb_tx_queue_mapping_to_qsel(struct sk_buff *skb) +{ + struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; + __le16 fc = hdr->frame_control; + u8 qsel; + + if (unlikely(ieee80211_is_mgmt(fc) || ieee80211_is_ctl(fc))) + qsel = TX_DESC_QSEL_MGMT; + else if (is_broadcast_ether_addr(hdr->addr1) || + is_multicast_ether_addr(hdr->addr1)) + qsel = TX_DESC_QSEL_HIGH; + else if (skb_get_queue_mapping(skb) <= IEEE80211_AC_BK) + qsel = skb->priority; + else + qsel = TX_DESC_QSEL_BEACON; + + return qsel; +} + +static int rtw_usb_tx_write(struct rtw_dev *rtwdev, + struct rtw_tx_pkt_info *pkt_info, + struct sk_buff *skb) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_usb_tx_data *tx_data; + u8 *pkt_desc; + int ep; + + pkt_info->qsel = rtw_usb_tx_queue_mapping_to_qsel(skb); + pkt_desc = skb_push(skb, chip->tx_pkt_desc_sz); + memset(pkt_desc, 0, chip->tx_pkt_desc_sz); + ep = qsel_to_ep(rtwusb, pkt_info->qsel); + rtw_tx_fill_tx_desc(pkt_info, skb); + rtw_tx_fill_txdesc_checksum(rtwdev, pkt_info, skb->data); + tx_data = rtw_usb_get_tx_data(skb); + tx_data->sn = pkt_info->sn; + + skb_queue_tail(&rtwusb->tx_queue[ep], skb); + + return 0; +} + +static void rtw_usb_tx_kick_off(struct rtw_dev *rtwdev) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + + queue_work(rtwusb->txwq, &rtwusb->tx_work); +} + +static void rtw_usb_rx_handler(struct work_struct *work) +{ + struct rtw_usb *rtwusb = container_of(work, struct rtw_usb, rx_work); + struct rtw_dev *rtwdev = rtwusb->rtwdev; + const struct rtw_chip_info *chip = rtwdev->chip; + struct rtw_rx_pkt_stat pkt_stat; + struct ieee80211_rx_status rx_status; + struct sk_buff *skb; + u32 pkt_desc_sz = chip->rx_pkt_desc_sz; + u32 pkt_offset; + u8 *rx_desc; + int limit; + + for (limit = 0; limit < 200; limit++) { + skb = skb_dequeue(&rtwusb->rx_queue); + if (!skb) + break; + + rx_desc = skb->data; + chip->ops->query_rx_desc(rtwdev, rx_desc, &pkt_stat, + &rx_status); + pkt_offset = pkt_desc_sz + pkt_stat.drv_info_sz + + pkt_stat.shift; + + if (pkt_stat.is_c2h) { + skb_put(skb, pkt_stat.pkt_len + pkt_offset); + rtw_fw_c2h_cmd_rx_irqsafe(rtwdev, pkt_offset, skb); + continue; + } + + if (skb_queue_len(&rtwusb->rx_queue) >= RTW_USB_MAX_RXQ_LEN) { + dev_dbg_ratelimited(rtwdev->dev, "failed to get rx_queue, overflow\n"); + dev_kfree_skb_any(skb); + continue; + } + + skb_put(skb, pkt_stat.pkt_len); + skb_reserve(skb, pkt_offset); + memcpy(skb->cb, &rx_status, sizeof(rx_status)); + ieee80211_rx_irqsafe(rtwdev->hw, skb); + } +} + +static void rtw_usb_read_port_complete(struct urb *urb); + +static void rtw_usb_rx_resubmit(struct rtw_usb *rtwusb, struct rx_usb_ctrl_block *rxcb) +{ + struct rtw_dev *rtwdev = rtwusb->rtwdev; + int error; + + rxcb->rx_skb = alloc_skb(RTW_USB_MAX_RECVBUF_SZ, GFP_ATOMIC); + if (!rxcb->rx_skb) + return; + + usb_fill_bulk_urb(rxcb->rx_urb, rtwusb->udev, + usb_rcvbulkpipe(rtwusb->udev, rtwusb->pipe_in), + rxcb->rx_skb->data, RTW_USB_MAX_RECVBUF_SZ, + rtw_usb_read_port_complete, rxcb); + + error = usb_submit_urb(rxcb->rx_urb, GFP_ATOMIC); + if (error) { + kfree_skb(rxcb->rx_skb); + if (error != -ENODEV) + rtw_err(rtwdev, "Err sending rx data urb %d\n", + error); + } +} + +static void rtw_usb_read_port_complete(struct urb *urb) +{ + struct rx_usb_ctrl_block *rxcb = urb->context; + struct rtw_dev *rtwdev = rxcb->rtwdev; + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + struct sk_buff *skb = rxcb->rx_skb; + + if (urb->status == 0) { + if (urb->actual_length >= RTW_USB_MAX_RECVBUF_SZ || + urb->actual_length < 24) { + rtw_err(rtwdev, "failed to get urb length:%d\n", + urb->actual_length); + if (skb) + dev_kfree_skb_any(skb); + } else { + skb_queue_tail(&rtwusb->rx_queue, skb); + queue_work(rtwusb->rxwq, &rtwusb->rx_work); + } + rtw_usb_rx_resubmit(rtwusb, rxcb); + } else { + switch (urb->status) { + case -EINVAL: + case -EPIPE: + case -ENODEV: + case -ESHUTDOWN: + case -ENOENT: + case -EPROTO: + case -EILSEQ: + case -ETIME: + case -ECOMM: + case -EOVERFLOW: + case -EINPROGRESS: + break; + default: + rtw_err(rtwdev, "status %d\n", urb->status); + break; + } + if (skb) + dev_kfree_skb_any(skb); + } +} + +static void rtw_usb_cancel_rx_bufs(struct rtw_usb *rtwusb) +{ + struct rx_usb_ctrl_block *rxcb; + int i; + + for (i = 0; i < RTW_USB_RXCB_NUM; i++) { + rxcb = &rtwusb->rx_cb[i]; + if (rxcb->rx_urb) + usb_kill_urb(rxcb->rx_urb); + } +} + +static void rtw_usb_free_rx_bufs(struct rtw_usb *rtwusb) +{ + struct rx_usb_ctrl_block *rxcb; + int i; + + for (i = 0; i < RTW_USB_RXCB_NUM; i++) { + rxcb = &rtwusb->rx_cb[i]; + if (rxcb->rx_urb) { + usb_kill_urb(rxcb->rx_urb); + usb_free_urb(rxcb->rx_urb); + } + } +} + +static int rtw_usb_alloc_rx_bufs(struct rtw_usb *rtwusb) +{ + int i; + + for (i = 0; i < RTW_USB_RXCB_NUM; i++) { + struct rx_usb_ctrl_block *rxcb = &rtwusb->rx_cb[i]; + + rxcb->rtwdev = rtwusb->rtwdev; + rxcb->rx_urb = usb_alloc_urb(0, GFP_KERNEL); + if (!rxcb->rx_urb) + goto err; + } + + return 0; +err: + rtw_usb_free_rx_bufs(rtwusb); + return -ENOMEM; +} + +static int rtw_usb_setup(struct rtw_dev *rtwdev) +{ + /* empty function for rtw_hci_ops */ + return 0; +} + +static int rtw_usb_start(struct rtw_dev *rtwdev) +{ + return 0; +} + +static void rtw_usb_stop(struct rtw_dev *rtwdev) +{ +} + +static void rtw_usb_deep_ps(struct rtw_dev *rtwdev, bool enter) +{ + /* empty function for rtw_hci_ops */ +} + +static void rtw_usb_link_ps(struct rtw_dev *rtwdev, bool enter) +{ + /* empty function for rtw_hci_ops */ +} + +static void rtw_usb_interface_cfg(struct rtw_dev *rtwdev) +{ + /* empty function for rtw_hci_ops */ +} + +static struct rtw_hci_ops rtw_usb_ops = { + .tx_write = rtw_usb_tx_write, + .tx_kick_off = rtw_usb_tx_kick_off, + .setup = rtw_usb_setup, + .start = rtw_usb_start, + .stop = rtw_usb_stop, + .deep_ps = rtw_usb_deep_ps, + .link_ps = rtw_usb_link_ps, + .interface_cfg = rtw_usb_interface_cfg, + + .write8 = rtw_usb_write8, + .write16 = rtw_usb_write16, + .write32 = rtw_usb_write32, + .read8 = rtw_usb_read8, + .read16 = rtw_usb_read16, + .read32 = rtw_usb_read32, + + .write_data_rsvd_page = rtw_usb_write_data_rsvd_page, + .write_data_h2c = rtw_usb_write_data_h2c, +}; + +static int rtw_usb_init_rx(struct rtw_dev *rtwdev) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + int i; + + rtwusb->rxwq = create_singlethread_workqueue("rtw88_usb: rx wq"); + if (!rtwusb->rxwq) { + rtw_err(rtwdev, "failed to create RX work queue\n"); + return -ENOMEM; + } + + skb_queue_head_init(&rtwusb->rx_queue); + + INIT_WORK(&rtwusb->rx_work, rtw_usb_rx_handler); + + for (i = 0; i < RTW_USB_RXCB_NUM; i++) { + struct rx_usb_ctrl_block *rxcb = &rtwusb->rx_cb[i]; + + rtw_usb_rx_resubmit(rtwusb, rxcb); + } + + return 0; +} + +static void rtw_usb_deinit_rx(struct rtw_dev *rtwdev) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + + skb_queue_purge(&rtwusb->rx_queue); + + flush_workqueue(rtwusb->rxwq); + destroy_workqueue(rtwusb->rxwq); +} + +static int rtw_usb_init_tx(struct rtw_dev *rtwdev) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + int i; + + rtwusb->txwq = create_singlethread_workqueue("rtw88_usb: tx wq"); + if (!rtwusb->txwq) { + rtw_err(rtwdev, "failed to create TX work queue\n"); + return -ENOMEM; + } + + for (i = 0; i < ARRAY_SIZE(rtwusb->tx_queue); i++) + skb_queue_head_init(&rtwusb->tx_queue[i]); + + INIT_WORK(&rtwusb->tx_work, rtw_usb_tx_handler); + + return 0; +} + +static void rtw_usb_deinit_tx(struct rtw_dev *rtwdev) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + + rtw_usb_tx_queue_purge(rtwusb); + flush_workqueue(rtwusb->txwq); + destroy_workqueue(rtwusb->txwq); +} + +static int rtw_usb_intf_init(struct rtw_dev *rtwdev, + struct usb_interface *intf) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + struct usb_device *udev = usb_get_dev(interface_to_usbdev(intf)); + int ret; + + rtwusb->udev = udev; + ret = rtw_usb_parse(rtwdev, intf); + if (ret) + return ret; + + rtwusb->usb_data = kcalloc(RTW_USB_MAX_RXTX_COUNT, sizeof(u32), + GFP_KERNEL); + if (!rtwusb->usb_data) + return -ENOMEM; + + usb_set_intfdata(intf, rtwdev->hw); + + SET_IEEE80211_DEV(rtwdev->hw, &intf->dev); + spin_lock_init(&rtwusb->usb_lock); + + return 0; +} + +static void rtw_usb_intf_deinit(struct rtw_dev *rtwdev, + struct usb_interface *intf) +{ + struct rtw_usb *rtwusb = rtw_get_usb_priv(rtwdev); + + usb_put_dev(rtwusb->udev); + kfree(rtwusb->usb_data); + usb_set_intfdata(intf, NULL); +} + +int rtw_usb_probe(struct usb_interface *intf, const struct usb_device_id *id) +{ + struct rtw_dev *rtwdev; + struct ieee80211_hw *hw; + struct rtw_usb *rtwusb; + int drv_data_size; + int ret; + + drv_data_size = sizeof(struct rtw_dev) + sizeof(struct rtw_usb); + hw = ieee80211_alloc_hw(drv_data_size, &rtw_ops); + if (!hw) + return -ENOMEM; + + rtwdev = hw->priv; + rtwdev->hw = hw; + rtwdev->dev = &intf->dev; + rtwdev->chip = (struct rtw_chip_info *)id->driver_info; + rtwdev->hci.ops = &rtw_usb_ops; + rtwdev->hci.type = RTW_HCI_TYPE_USB; + + rtwusb = rtw_get_usb_priv(rtwdev); + rtwusb->rtwdev = rtwdev; + + ret = rtw_usb_alloc_rx_bufs(rtwusb); + if (ret) + goto err_release_hw; + + ret = rtw_core_init(rtwdev); + if (ret) + goto err_free_rx_bufs; + + ret = rtw_usb_intf_init(rtwdev, intf); + if (ret) { + rtw_err(rtwdev, "failed to init USB interface\n"); + goto err_deinit_core; + } + + ret = rtw_usb_init_tx(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to init USB TX\n"); + goto err_destroy_usb; + } + + ret = rtw_usb_init_rx(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to init USB RX\n"); + goto err_destroy_txwq; + } + + ret = rtw_chip_info_setup(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to setup chip information\n"); + goto err_destroy_rxwq; + } + + ret = rtw_register_hw(rtwdev, rtwdev->hw); + if (ret) { + rtw_err(rtwdev, "failed to register hw\n"); + goto err_destroy_rxwq; + } + + return 0; + +err_destroy_rxwq: + rtw_usb_deinit_rx(rtwdev); + +err_destroy_txwq: + rtw_usb_deinit_tx(rtwdev); + +err_destroy_usb: + rtw_usb_intf_deinit(rtwdev, intf); + +err_deinit_core: + rtw_core_deinit(rtwdev); + +err_free_rx_bufs: + rtw_usb_free_rx_bufs(rtwusb); + +err_release_hw: + ieee80211_free_hw(hw); + + return ret; +} +EXPORT_SYMBOL(rtw_usb_probe); + +void rtw_usb_disconnect(struct usb_interface *intf) +{ + struct ieee80211_hw *hw = usb_get_intfdata(intf); + struct rtw_dev *rtwdev; + struct rtw_usb *rtwusb; + + if (!hw) + return; + + rtwdev = hw->priv; + rtwusb = rtw_get_usb_priv(rtwdev); + + rtw_usb_cancel_rx_bufs(rtwusb); + + rtw_unregister_hw(rtwdev, hw); + rtw_usb_deinit_tx(rtwdev); + rtw_usb_deinit_rx(rtwdev); + + if (rtwusb->udev->state != USB_STATE_NOTATTACHED) + usb_reset_device(rtwusb->udev); + + rtw_usb_free_rx_bufs(rtwusb); + + rtw_usb_intf_deinit(rtwdev, intf); + rtw_core_deinit(rtwdev); + ieee80211_free_hw(hw); +} +EXPORT_SYMBOL(rtw_usb_disconnect); + +MODULE_AUTHOR("Realtek Corporation"); +MODULE_DESCRIPTION("Realtek 802.11ac wireless USB driver"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/usb.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/usb.h new file mode 100644 index 0000000000000000000000000000000000000000..86697a5c0103a5aab8f17f2b0f881b310b4b602c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/usb.h @@ -0,0 +1,100 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_USB_H_ +#define __RTW_USB_H_ + +#define FW_8192C_START_ADDRESS 0x1000 +#define FW_8192C_END_ADDRESS 0x5fff + +#define RTW_USB_MAX_RXTX_COUNT 128 +#define RTW_USB_VENQT_MAX_BUF_SIZE 254 +#define MAX_USBCTRL_VENDORREQ_TIMES 10 + +#define RTW_USB_CMD_READ 0xc0 +#define RTW_USB_CMD_WRITE 0x40 +#define RTW_USB_CMD_REQ 0x05 + +#define RTW_USB_VENQT_CMD_IDX 0x00 + +#define RTW_USB_TX_SEL_HQ BIT(0) +#define RTW_USB_TX_SEL_LQ BIT(1) +#define RTW_USB_TX_SEL_NQ BIT(2) +#define RTW_USB_TX_SEL_EQ BIT(3) + +#define RTW_USB_BULK_IN_ADDR 0x80 +#define RTW_USB_INT_IN_ADDR 0x81 + +#define RTW_USB_HW_QUEUE_ENTRY 8 + +#define RTW_USB_PACKET_OFFSET_SZ 8 +#define RTW_USB_MAX_XMITBUF_SZ (1024 * 20) +#define RTW_USB_MAX_RECVBUF_SZ 32768 + +#define RTW_USB_RECVBUFF_ALIGN_SZ 8 + +#define RTW_USB_RXAGG_SIZE 6 +#define RTW_USB_RXAGG_TIMEOUT 10 + +#define RTW_USB_RXCB_NUM 4 + +#define RTW_USB_EP_MAX 4 + +#define TX_DESC_QSEL_MAX 20 + +#define RTW_USB_VENDOR_ID_REALTEK 0x0bda + +static inline struct rtw_usb *rtw_get_usb_priv(struct rtw_dev *rtwdev) +{ + return (struct rtw_usb *)rtwdev->priv; +} + +struct rx_usb_ctrl_block { + struct rtw_dev *rtwdev; + struct urb *rx_urb; + struct sk_buff *rx_skb; +}; + +struct rtw_usb_tx_data { + u8 sn; +}; + +struct rtw_usb { + struct rtw_dev *rtwdev; + struct usb_device *udev; + + /* protects usb_data_index */ + spinlock_t usb_lock; + __le32 *usb_data; + unsigned int usb_data_index; + + u8 pipe_interrupt; + u8 pipe_in; + u8 out_ep[RTW_USB_EP_MAX]; + int qsel_to_ep[TX_DESC_QSEL_MAX]; + + struct workqueue_struct *txwq, *rxwq; + + struct sk_buff_head tx_queue[RTW_USB_EP_MAX]; + struct work_struct tx_work; + + struct rx_usb_ctrl_block rx_cb[RTW_USB_RXCB_NUM]; + struct sk_buff_head rx_queue; + struct work_struct rx_work; +}; + +static inline struct rtw_usb_tx_data *rtw_usb_get_tx_data(struct sk_buff *skb) +{ + struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); + + BUILD_BUG_ON(sizeof(struct rtw_usb_tx_data) > + sizeof(info->status.status_driver_data)); + + return (struct rtw_usb_tx_data *)info->status.status_driver_data; +} + +int rtw_usb_probe(struct usb_interface *intf, const struct usb_device_id *id); +void rtw_usb_disconnect(struct usb_interface *intf); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/util.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/util.c new file mode 100644 index 0000000000000000000000000000000000000000..e222d3c01a77ec07d3e25455530c88dbd8248072 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/util.c @@ -0,0 +1,207 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "util.h" +#include "reg.h" + +bool check_hw_ready(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 target) +{ + u32 cnt; + + for (cnt = 0; cnt < 1000; cnt++) { + if (rtw_read32_mask(rtwdev, addr, mask) == target) + return true; + + udelay(10); + } + + return false; +} +EXPORT_SYMBOL(check_hw_ready); + +bool ltecoex_read_reg(struct rtw_dev *rtwdev, u16 offset, u32 *val) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + const struct rtw_ltecoex_addr *ltecoex = chip->ltecoex_addr; + + if (!check_hw_ready(rtwdev, ltecoex->ctrl, LTECOEX_READY, 1)) + return false; + + rtw_write32(rtwdev, ltecoex->ctrl, 0x800F0000 | offset); + *val = rtw_read32(rtwdev, ltecoex->rdata); + + return true; +} + +bool ltecoex_reg_write(struct rtw_dev *rtwdev, u16 offset, u32 value) +{ + const struct rtw_chip_info *chip = rtwdev->chip; + const struct rtw_ltecoex_addr *ltecoex = chip->ltecoex_addr; + + if (!check_hw_ready(rtwdev, ltecoex->ctrl, LTECOEX_READY, 1)) + return false; + + rtw_write32(rtwdev, ltecoex->wdata, value); + rtw_write32(rtwdev, ltecoex->ctrl, 0xC00F0000 | offset); + + return true; +} + +void rtw_restore_reg(struct rtw_dev *rtwdev, + struct rtw_backup_info *bckp, u32 num) +{ + u8 len; + u32 reg; + u32 val; + int i; + + for (i = 0; i < num; i++, bckp++) { + len = bckp->len; + reg = bckp->reg; + val = bckp->val; + + switch (len) { + case 1: + rtw_write8(rtwdev, reg, (u8)val); + break; + case 2: + rtw_write16(rtwdev, reg, (u16)val); + break; + case 4: + rtw_write32(rtwdev, reg, (u32)val); + break; + default: + break; + } + } +} +EXPORT_SYMBOL(rtw_restore_reg); + +void rtw_desc_to_mcsrate(u16 rate, u8 *mcs, u8 *nss) +{ + if (rate <= DESC_RATE54M) + return; + + if (rate >= DESC_RATEVHT1SS_MCS0 && + rate <= DESC_RATEVHT1SS_MCS9) { + *nss = 1; + *mcs = rate - DESC_RATEVHT1SS_MCS0; + } else if (rate >= DESC_RATEVHT2SS_MCS0 && + rate <= DESC_RATEVHT2SS_MCS9) { + *nss = 2; + *mcs = rate - DESC_RATEVHT2SS_MCS0; + } else if (rate >= DESC_RATEVHT3SS_MCS0 && + rate <= DESC_RATEVHT3SS_MCS9) { + *nss = 3; + *mcs = rate - DESC_RATEVHT3SS_MCS0; + } else if (rate >= DESC_RATEVHT4SS_MCS0 && + rate <= DESC_RATEVHT4SS_MCS9) { + *nss = 4; + *mcs = rate - DESC_RATEVHT4SS_MCS0; + } else if (rate >= DESC_RATEMCS0 && + rate <= DESC_RATEMCS15) { + *mcs = rate - DESC_RATEMCS0; + } +} + +struct rtw_stas_entry { + struct list_head list; + struct ieee80211_sta *sta; +}; + +struct rtw_iter_stas_data { + struct rtw_dev *rtwdev; + struct list_head list; +}; + +static void rtw_collect_sta_iter(void *data, struct ieee80211_sta *sta) +{ + struct rtw_iter_stas_data *iter_stas = data; + struct rtw_stas_entry *stas_entry; + + stas_entry = kmalloc(sizeof(*stas_entry), GFP_ATOMIC); + if (!stas_entry) + return; + + stas_entry->sta = sta; + list_add_tail(&stas_entry->list, &iter_stas->list); +} + +void rtw_iterate_stas(struct rtw_dev *rtwdev, + void (*iterator)(void *data, + struct ieee80211_sta *sta), + void *data) +{ + struct rtw_iter_stas_data iter_data; + struct rtw_stas_entry *sta_entry, *tmp; + + /* &rtwdev->mutex makes sure no stations can be removed between + * collecting the stations and iterating over them. + */ + lockdep_assert_held(&rtwdev->mutex); + + iter_data.rtwdev = rtwdev; + INIT_LIST_HEAD(&iter_data.list); + + ieee80211_iterate_stations_atomic(rtwdev->hw, rtw_collect_sta_iter, + &iter_data); + + list_for_each_entry_safe(sta_entry, tmp, &iter_data.list, + list) { + list_del_init(&sta_entry->list); + iterator(data, sta_entry->sta); + kfree(sta_entry); + } +} + +struct rtw_vifs_entry { + struct list_head list; + struct ieee80211_vif *vif; +}; + +struct rtw_iter_vifs_data { + struct rtw_dev *rtwdev; + struct list_head list; +}; + +static void rtw_collect_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif) +{ + struct rtw_iter_vifs_data *iter_stas = data; + struct rtw_vifs_entry *vifs_entry; + + vifs_entry = kmalloc(sizeof(*vifs_entry), GFP_ATOMIC); + if (!vifs_entry) + return; + + vifs_entry->vif = vif; + list_add_tail(&vifs_entry->list, &iter_stas->list); +} + +void rtw_iterate_vifs(struct rtw_dev *rtwdev, + void (*iterator)(void *data, struct ieee80211_vif *vif), + void *data) +{ + struct rtw_iter_vifs_data iter_data; + struct rtw_vifs_entry *vif_entry, *tmp; + + /* &rtwdev->mutex makes sure no interfaces can be removed between + * collecting the interfaces and iterating over them. + */ + lockdep_assert_held(&rtwdev->mutex); + + iter_data.rtwdev = rtwdev; + INIT_LIST_HEAD(&iter_data.list); + + ieee80211_iterate_active_interfaces_atomic(rtwdev->hw, + IEEE80211_IFACE_ITER_NORMAL, + rtw_collect_vif_iter, &iter_data); + + list_for_each_entry_safe(vif_entry, tmp, &iter_data.list, + list) { + list_del_init(&vif_entry->list); + iterator(data, vif_entry->vif); + kfree(vif_entry); + } +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/util.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/util.h new file mode 100644 index 0000000000000000000000000000000000000000..f8399128a9a3a0e4559684f78d505712827ed8e9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/util.h @@ -0,0 +1,43 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_UTIL_H__ +#define __RTW_UTIL_H__ + +struct rtw_dev; + +#define rtw_iterate_vifs_atomic(rtwdev, iterator, data) \ + ieee80211_iterate_active_interfaces_atomic(rtwdev->hw, \ + IEEE80211_IFACE_ITER_NORMAL, iterator, data) +#define rtw_iterate_stas_atomic(rtwdev, iterator, data) \ + ieee80211_iterate_stations_atomic(rtwdev->hw, iterator, data) +#define rtw_iterate_keys(rtwdev, vif, iterator, data) \ + ieee80211_iter_keys(rtwdev->hw, vif, iterator, data) +#define rtw_iterate_keys_rcu(rtwdev, vif, iterator, data) \ + ieee80211_iter_keys_rcu((rtwdev)->hw, vif, iterator, data) + +void rtw_iterate_vifs(struct rtw_dev *rtwdev, + void (*iterator)(void *data, struct ieee80211_vif *vif), + void *data); +void rtw_iterate_stas(struct rtw_dev *rtwdev, + void (*iterator)(void *data, + struct ieee80211_sta *sta), + void *data); + +static inline u8 *get_hdr_bssid(struct ieee80211_hdr *hdr) +{ + __le16 fc = hdr->frame_control; + u8 *bssid; + + if (ieee80211_has_tods(fc)) + bssid = hdr->addr1; + else if (ieee80211_has_fromds(fc)) + bssid = hdr->addr2; + else + bssid = hdr->addr3; + + return bssid; +} + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/wow.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/wow.c new file mode 100644 index 0000000000000000000000000000000000000000..16ddee577efec446f89a6024b338261e4ad9c261 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/wow.c @@ -0,0 +1,913 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#include "main.h" +#include "fw.h" +#include "wow.h" +#include "reg.h" +#include "debug.h" +#include "mac.h" +#include "ps.h" + +static void rtw_wow_show_wakeup_reason(struct rtw_dev *rtwdev) +{ + struct cfg80211_wowlan_nd_info nd_info; + struct cfg80211_wowlan_wakeup wakeup = { + .pattern_idx = -1, + }; + u8 reason; + + reason = rtw_read8(rtwdev, REG_WOWLAN_WAKE_REASON); + + switch (reason) { + case RTW_WOW_RSN_RX_DEAUTH: + wakeup.disconnect = true; + rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx deauth\n"); + break; + case RTW_WOW_RSN_DISCONNECT: + wakeup.disconnect = true; + rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: AP is off\n"); + break; + case RTW_WOW_RSN_RX_MAGIC_PKT: + wakeup.magic_pkt = true; + rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx magic packet\n"); + break; + case RTW_WOW_RSN_RX_GTK_REKEY: + wakeup.gtk_rekey_failure = true; + rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx gtk rekey\n"); + break; + case RTW_WOW_RSN_RX_PATTERN_MATCH: + /* Current firmware and driver don't report pattern index + * Use pattern_idx to 0 defaultly. + */ + wakeup.pattern_idx = 0; + rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx pattern match packet\n"); + break; + case RTW_WOW_RSN_RX_NLO: + /* Current firmware and driver don't report ssid index. + * Use 0 for n_matches based on its comment. + */ + nd_info.n_matches = 0; + wakeup.net_detect = &nd_info; + rtw_dbg(rtwdev, RTW_DBG_WOW, "Rx NLO\n"); + break; + default: + rtw_warn(rtwdev, "Unknown wakeup reason %x\n", reason); + ieee80211_report_wowlan_wakeup(rtwdev->wow.wow_vif, NULL, + GFP_KERNEL); + return; + } + ieee80211_report_wowlan_wakeup(rtwdev->wow.wow_vif, &wakeup, + GFP_KERNEL); +} + +static void rtw_wow_pattern_write_cam(struct rtw_dev *rtwdev, u8 addr, + u32 wdata) +{ + rtw_write32(rtwdev, REG_WKFMCAM_RWD, wdata); + rtw_write32(rtwdev, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1 | + BIT_WKFCAM_WE | BIT_WKFCAM_ADDR_V2(addr)); + + if (!check_hw_ready(rtwdev, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1, 0)) + rtw_err(rtwdev, "failed to write pattern cam\n"); +} + +static void rtw_wow_pattern_write_cam_ent(struct rtw_dev *rtwdev, u8 id, + struct rtw_wow_pattern *rtw_pattern) +{ + int i; + u8 addr; + u32 wdata; + + for (i = 0; i < RTW_MAX_PATTERN_MASK_SIZE / 4; i++) { + addr = (id << 3) + i; + wdata = rtw_pattern->mask[i * 4]; + wdata |= rtw_pattern->mask[i * 4 + 1] << 8; + wdata |= rtw_pattern->mask[i * 4 + 2] << 16; + wdata |= rtw_pattern->mask[i * 4 + 3] << 24; + rtw_wow_pattern_write_cam(rtwdev, addr, wdata); + } + + wdata = rtw_pattern->crc; + addr = (id << 3) + RTW_MAX_PATTERN_MASK_SIZE / 4; + + switch (rtw_pattern->type) { + case RTW_PATTERN_BROADCAST: + wdata |= BIT_WKFMCAM_BC | BIT_WKFMCAM_VALID; + break; + case RTW_PATTERN_MULTICAST: + wdata |= BIT_WKFMCAM_MC | BIT_WKFMCAM_VALID; + break; + case RTW_PATTERN_UNICAST: + wdata |= BIT_WKFMCAM_UC | BIT_WKFMCAM_VALID; + break; + default: + break; + } + rtw_wow_pattern_write_cam(rtwdev, addr, wdata); +} + +/* RTK internal CRC16 for Pattern Cam */ +static 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 & BIT(15)) ? 1 : 0); + data_bit = (data & (BIT(0) << index) ? 1 : 0); + shift_in = crc_bit15 ^ data_bit; + + crc_result = crc << 1; + + if (shift_in == 0) + crc_result &= (~BIT(0)); + else + crc_result |= BIT(0); + + crc_bit11 = ((crc & BIT(11)) ? 1 : 0) ^ shift_in; + + if (crc_bit11 == 0) + crc_result &= (~BIT(12)); + else + crc_result |= BIT(12); + + crc_bit4 = ((crc & BIT(4)) ? 1 : 0) ^ shift_in; + + if (crc_bit4 == 0) + crc_result &= (~BIT(5)); + else + crc_result |= BIT(5); + + crc = crc_result; + } + return crc; +} + +static 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 */ + return ~crc; +} + +static void rtw_wow_pattern_generate(struct rtw_dev *rtwdev, + struct rtw_vif *rtwvif, + const struct cfg80211_pkt_pattern *pkt_pattern, + struct rtw_wow_pattern *rtw_pattern) +{ + const u8 *mask; + const u8 *pattern; + u8 mask_hw[RTW_MAX_PATTERN_MASK_SIZE] = {0}; + u8 content[RTW_MAX_PATTERN_SIZE] = {0}; + u8 mac_addr[ETH_ALEN] = {0}; + u8 mask_len; + u16 count; + int len; + int i; + + pattern = pkt_pattern->pattern; + len = pkt_pattern->pattern_len; + mask = pkt_pattern->mask; + + ether_addr_copy(mac_addr, rtwvif->mac_addr); + memset(rtw_pattern, 0, sizeof(*rtw_pattern)); + + mask_len = DIV_ROUND_UP(len, 8); + + if (is_broadcast_ether_addr(pattern)) + rtw_pattern->type = RTW_PATTERN_BROADCAST; + else if (is_multicast_ether_addr(pattern)) + rtw_pattern->type = RTW_PATTERN_MULTICAST; + else if (ether_addr_equal(pattern, mac_addr)) + rtw_pattern->type = RTW_PATTERN_UNICAST; + else + rtw_pattern->type = RTW_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] = u8_get_bits(mask[i], GENMASK(7, 6)); + mask_hw[i] |= u8_get_bits(mask[i + 1], GENMASK(5, 0)) << 2; + } + mask_hw[i] = u8_get_bits(mask[i], GENMASK(7, 6)); + + /* Set bit 0-5 to zero */ + mask_hw[0] &= (~GENMASK(5, 0)); + + memcpy(rtw_pattern->mask, mask_hw, RTW_MAX_PATTERN_MASK_SIZE); + + /* 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++; + } + } + + rtw_pattern->crc = rtw_calc_crc(content, count); +} + +static void rtw_wow_pattern_clear_cam(struct rtw_dev *rtwdev) +{ + bool ret; + + rtw_write32(rtwdev, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1 | + BIT_WKFCAM_CLR_V1); + + ret = check_hw_ready(rtwdev, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1, 0); + if (!ret) + rtw_err(rtwdev, "failed to clean pattern cam\n"); +} + +static void rtw_wow_pattern_write(struct rtw_dev *rtwdev) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + struct rtw_wow_pattern *rtw_pattern = rtw_wow->patterns; + int i = 0; + + for (i = 0; i < rtw_wow->pattern_cnt; i++) + rtw_wow_pattern_write_cam_ent(rtwdev, i, rtw_pattern + i); +} + +static void rtw_wow_pattern_clear(struct rtw_dev *rtwdev) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + + rtw_wow_pattern_clear_cam(rtwdev); + + rtw_wow->pattern_cnt = 0; + memset(rtw_wow->patterns, 0, sizeof(rtw_wow->patterns)); +} + +static void rtw_wow_bb_stop(struct rtw_dev *rtwdev) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + + /* wait 100ms for firmware to finish TX */ + msleep(100); + + if (!rtw_read32_mask(rtwdev, REG_BCNQ_INFO, BIT_MGQ_CPU_EMPTY)) + rtw_warn(rtwdev, "Wrong status of MGQ_CPU empty!\n"); + + rtw_wow->txpause = rtw_read8(rtwdev, REG_TXPAUSE); + rtw_write8(rtwdev, REG_TXPAUSE, 0xff); + rtw_write8_clr(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_BB_RSTB); +} + +static void rtw_wow_bb_start(struct rtw_dev *rtwdev) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + + rtw_write8_set(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_BB_RSTB); + rtw_write8(rtwdev, REG_TXPAUSE, rtw_wow->txpause); +} + +static void rtw_wow_rx_dma_stop(struct rtw_dev *rtwdev) +{ + /* wait 100ms for HW to finish rx dma */ + msleep(100); + + rtw_write32_set(rtwdev, REG_RXPKT_NUM, BIT_RW_RELEASE); + + if (!check_hw_ready(rtwdev, REG_RXPKT_NUM, BIT_RXDMA_IDLE, 1)) + rtw_err(rtwdev, "failed to stop rx dma\n"); +} + +static void rtw_wow_rx_dma_start(struct rtw_dev *rtwdev) +{ + rtw_write32_clr(rtwdev, REG_RXPKT_NUM, BIT_RW_RELEASE); +} + +static int rtw_wow_check_fw_status(struct rtw_dev *rtwdev, bool wow_enable) +{ + int ret; + u8 check; + u32 check_dis; + + if (wow_enable) { + ret = read_poll_timeout(rtw_read8, check, !check, 1000, + 100000, true, rtwdev, + REG_WOWLAN_WAKE_REASON); + if (ret) + goto wow_fail; + } else { + ret = read_poll_timeout(rtw_read32_mask, check_dis, + !check_dis, 1000, 100000, true, rtwdev, + REG_FE1IMR, BIT_FS_RXDONE); + if (ret) + goto wow_fail; + ret = read_poll_timeout(rtw_read32_mask, check_dis, + !check_dis, 1000, 100000, false, rtwdev, + REG_RXPKT_NUM, BIT_RW_RELEASE); + if (ret) + goto wow_fail; + } + + return 0; + +wow_fail: + rtw_err(rtwdev, "failed to check wow status %s\n", + wow_enable ? "enabled" : "disabled"); + return -EBUSY; +} + +static void rtw_wow_fw_security_type_iter(struct ieee80211_hw *hw, + struct ieee80211_vif *vif, + struct ieee80211_sta *sta, + struct ieee80211_key_conf *key, + void *data) +{ + struct rtw_fw_key_type_iter_data *iter_data = data; + struct rtw_dev *rtwdev = hw->priv; + u8 hw_key_type; + + if (vif != rtwdev->wow.wow_vif) + return; + + switch (key->cipher) { + case WLAN_CIPHER_SUITE_WEP40: + hw_key_type = RTW_CAM_WEP40; + break; + case WLAN_CIPHER_SUITE_WEP104: + hw_key_type = RTW_CAM_WEP104; + break; + case WLAN_CIPHER_SUITE_TKIP: + hw_key_type = RTW_CAM_TKIP; + key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC; + break; + case WLAN_CIPHER_SUITE_CCMP: + hw_key_type = RTW_CAM_AES; + key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; + break; + default: + rtw_err(rtwdev, "Unsupported key type for wowlan mode: %#x\n", + key->cipher); + hw_key_type = 0; + break; + } + + if (sta) + iter_data->pairwise_key_type = hw_key_type; + else + iter_data->group_key_type = hw_key_type; +} + +static void rtw_wow_fw_security_type(struct rtw_dev *rtwdev) +{ + struct rtw_fw_key_type_iter_data data = {}; + struct ieee80211_vif *wow_vif = rtwdev->wow.wow_vif; + + data.rtwdev = rtwdev; + rtw_iterate_keys(rtwdev, wow_vif, + rtw_wow_fw_security_type_iter, &data); + rtw_fw_set_aoac_global_info_cmd(rtwdev, data.pairwise_key_type, + data.group_key_type); +} + +static int rtw_wow_fw_start(struct rtw_dev *rtwdev) +{ + if (rtw_wow_mgd_linked(rtwdev)) { + rtw_send_rsvd_page_h2c(rtwdev); + rtw_wow_pattern_write(rtwdev); + rtw_wow_fw_security_type(rtwdev); + rtw_fw_set_disconnect_decision_cmd(rtwdev, true); + rtw_fw_set_keep_alive_cmd(rtwdev, true); + } else if (rtw_wow_no_link(rtwdev)) { + rtw_fw_set_nlo_info(rtwdev, true); + rtw_fw_update_pkt_probe_req(rtwdev, NULL); + rtw_fw_channel_switch(rtwdev, true); + } + + rtw_fw_set_wowlan_ctrl_cmd(rtwdev, true); + rtw_fw_set_remote_wake_ctrl_cmd(rtwdev, true); + + return rtw_wow_check_fw_status(rtwdev, true); +} + +static int rtw_wow_fw_stop(struct rtw_dev *rtwdev) +{ + if (rtw_wow_mgd_linked(rtwdev)) { + rtw_fw_set_disconnect_decision_cmd(rtwdev, false); + rtw_fw_set_keep_alive_cmd(rtwdev, false); + rtw_wow_pattern_clear(rtwdev); + } else if (rtw_wow_no_link(rtwdev)) { + rtw_fw_channel_switch(rtwdev, false); + rtw_fw_set_nlo_info(rtwdev, false); + } + + rtw_fw_set_wowlan_ctrl_cmd(rtwdev, false); + rtw_fw_set_remote_wake_ctrl_cmd(rtwdev, false); + + return rtw_wow_check_fw_status(rtwdev, false); +} + +static void rtw_wow_avoid_reset_mac(struct rtw_dev *rtwdev) +{ + /* When resuming from wowlan mode, some hosts issue signal + * (PCIE: PREST, USB: SE0RST) to device, and lead to reset + * mac core. If it happens, the connection to AP will be lost. + * Setting REG_RSV_CTRL Register can avoid this process. + */ + switch (rtw_hci_type(rtwdev)) { + case RTW_HCI_TYPE_PCIE: + case RTW_HCI_TYPE_USB: + rtw_write8(rtwdev, REG_RSV_CTRL, BIT_WLOCK_1C_B6); + rtw_write8(rtwdev, REG_RSV_CTRL, + BIT_WLOCK_1C_B6 | BIT_R_DIS_PRST); + break; + default: + rtw_warn(rtwdev, "Unsupported hci type to disable reset MAC\n"); + break; + } +} + +static void rtw_wow_fw_media_status_iter(void *data, struct ieee80211_sta *sta) +{ + struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; + struct rtw_fw_media_status_iter_data *iter_data = data; + struct rtw_dev *rtwdev = iter_data->rtwdev; + + rtw_fw_media_status_report(rtwdev, si->mac_id, iter_data->connect); +} + +static void rtw_wow_fw_media_status(struct rtw_dev *rtwdev, bool connect) +{ + struct rtw_fw_media_status_iter_data data; + + data.rtwdev = rtwdev; + data.connect = connect; + + rtw_iterate_stas_atomic(rtwdev, rtw_wow_fw_media_status_iter, &data); +} + +static int rtw_wow_config_wow_fw_rsvd_page(struct rtw_dev *rtwdev) +{ + struct ieee80211_vif *wow_vif = rtwdev->wow.wow_vif; + struct rtw_vif *rtwvif = (struct rtw_vif *)wow_vif->drv_priv; + + rtw_remove_rsvd_page(rtwdev, rtwvif); + + if (rtw_wow_no_link(rtwdev)) + rtw_add_rsvd_page_pno(rtwdev, rtwvif); + else + rtw_add_rsvd_page_sta(rtwdev, rtwvif); + + return rtw_fw_download_rsvd_page(rtwdev); +} + +static int rtw_wow_config_normal_fw_rsvd_page(struct rtw_dev *rtwdev) +{ + struct ieee80211_vif *wow_vif = rtwdev->wow.wow_vif; + struct rtw_vif *rtwvif = (struct rtw_vif *)wow_vif->drv_priv; + + rtw_remove_rsvd_page(rtwdev, rtwvif); + rtw_add_rsvd_page_sta(rtwdev, rtwvif); + + if (rtw_wow_no_link(rtwdev)) + return 0; + + return rtw_fw_download_rsvd_page(rtwdev); +} + +static int rtw_wow_swap_fw(struct rtw_dev *rtwdev, enum rtw_fw_type type) +{ + struct rtw_fw_state *fw; + int ret; + + switch (type) { + case RTW_WOWLAN_FW: + fw = &rtwdev->wow_fw; + break; + + case RTW_NORMAL_FW: + fw = &rtwdev->fw; + break; + + default: + rtw_warn(rtwdev, "unsupported firmware type to swap\n"); + return -ENOENT; + } + + ret = rtw_download_firmware(rtwdev, fw); + if (ret) + goto out; + + rtw_fw_send_general_info(rtwdev); + rtw_fw_send_phydm_info(rtwdev); + rtw_wow_fw_media_status(rtwdev, true); + +out: + return ret; +} + +static void rtw_wow_check_pno(struct rtw_dev *rtwdev, + struct cfg80211_sched_scan_request *nd_config) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + struct rtw_pno_request *pno_req = &rtw_wow->pno_req; + struct ieee80211_channel *channel; + int i, size; + + if (!nd_config->n_match_sets || !nd_config->n_channels) + goto err; + + pno_req->match_set_cnt = nd_config->n_match_sets; + size = sizeof(*pno_req->match_sets) * pno_req->match_set_cnt; + pno_req->match_sets = kmemdup(nd_config->match_sets, size, GFP_KERNEL); + if (!pno_req->match_sets) + goto err; + + pno_req->channel_cnt = nd_config->n_channels; + size = sizeof(*nd_config->channels[0]) * nd_config->n_channels; + pno_req->channels = kmalloc(size, GFP_KERNEL); + if (!pno_req->channels) + goto channel_err; + + for (i = 0 ; i < pno_req->channel_cnt; i++) { + channel = pno_req->channels + i; + memcpy(channel, nd_config->channels[i], sizeof(*channel)); + } + + pno_req->scan_plan = *nd_config->scan_plans; + pno_req->inited = true; + + rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: net-detect is enabled\n"); + + return; + +channel_err: + kfree(pno_req->match_sets); + +err: + rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: net-detect is disabled\n"); +} + +static int rtw_wow_leave_linked_ps(struct rtw_dev *rtwdev) +{ + if (!test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) + cancel_delayed_work_sync(&rtwdev->watch_dog_work); + + rtw_leave_lps(rtwdev); + + return 0; +} + +static int rtw_wow_leave_no_link_ps(struct rtw_dev *rtwdev) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + int ret = 0; + + if (test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) { + if (rtw_get_lps_deep_mode(rtwdev) != LPS_DEEP_MODE_NONE) + rtw_leave_lps_deep(rtwdev); + } else { + if (!test_bit(RTW_FLAG_POWERON, rtwdev->flags)) { + rtw_wow->ips_enabled = true; + ret = rtw_leave_ips(rtwdev); + if (ret) + return ret; + } + } + + return 0; +} + +static int rtw_wow_leave_ps(struct rtw_dev *rtwdev) +{ + int ret = 0; + + if (rtw_wow_mgd_linked(rtwdev)) + ret = rtw_wow_leave_linked_ps(rtwdev); + else if (rtw_wow_no_link(rtwdev)) + ret = rtw_wow_leave_no_link_ps(rtwdev); + + return ret; +} + +static int rtw_wow_restore_ps(struct rtw_dev *rtwdev) +{ + int ret = 0; + + if (rtw_wow_no_link(rtwdev) && rtwdev->wow.ips_enabled) + ret = rtw_enter_ips(rtwdev); + + return ret; +} + +static int rtw_wow_enter_linked_ps(struct rtw_dev *rtwdev) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + struct ieee80211_vif *wow_vif = rtw_wow->wow_vif; + struct rtw_vif *rtwvif = (struct rtw_vif *)wow_vif->drv_priv; + + rtw_enter_lps(rtwdev, rtwvif->port); + + return 0; +} + +static int rtw_wow_enter_no_link_ps(struct rtw_dev *rtwdev) +{ + /* firmware enters deep ps by itself if supported */ + set_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags); + + return 0; +} + +static int rtw_wow_enter_ps(struct rtw_dev *rtwdev) +{ + int ret = 0; + + if (rtw_wow_mgd_linked(rtwdev)) + ret = rtw_wow_enter_linked_ps(rtwdev); + else if (rtw_wow_no_link(rtwdev) && + rtw_get_lps_deep_mode(rtwdev) != LPS_DEEP_MODE_NONE) + ret = rtw_wow_enter_no_link_ps(rtwdev); + + return ret; +} + +static void rtw_wow_stop_trx(struct rtw_dev *rtwdev) +{ + rtw_wow_bb_stop(rtwdev); + rtw_wow_rx_dma_stop(rtwdev); +} + +static int rtw_wow_start(struct rtw_dev *rtwdev) +{ + int ret; + + ret = rtw_wow_fw_start(rtwdev); + if (ret) + goto out; + + rtw_hci_stop(rtwdev); + rtw_wow_bb_start(rtwdev); + rtw_wow_avoid_reset_mac(rtwdev); + +out: + return ret; +} + +static int rtw_wow_enable(struct rtw_dev *rtwdev) +{ + int ret = 0; + + rtw_wow_stop_trx(rtwdev); + + ret = rtw_wow_swap_fw(rtwdev, RTW_WOWLAN_FW); + if (ret) { + rtw_err(rtwdev, "failed to swap wow fw\n"); + goto error; + } + + set_bit(RTW_FLAG_WOWLAN, rtwdev->flags); + + ret = rtw_wow_config_wow_fw_rsvd_page(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to download wowlan rsvd page\n"); + goto error; + } + + ret = rtw_wow_start(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to start wow\n"); + goto error; + } + + return ret; + +error: + clear_bit(RTW_FLAG_WOWLAN, rtwdev->flags); + return ret; +} + +static int rtw_wow_stop(struct rtw_dev *rtwdev) +{ + int ret; + + /* some HCI related registers will be reset after resume, + * need to set them again. + */ + ret = rtw_hci_setup(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to setup hci\n"); + return ret; + } + + ret = rtw_hci_start(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to start hci\n"); + return ret; + } + + ret = rtw_wow_fw_stop(rtwdev); + if (ret) + rtw_err(rtwdev, "failed to stop wowlan fw\n"); + + rtw_wow_bb_stop(rtwdev); + + return ret; +} + +static void rtw_wow_resume_trx(struct rtw_dev *rtwdev) +{ + rtw_wow_rx_dma_start(rtwdev); + rtw_wow_bb_start(rtwdev); + ieee80211_queue_delayed_work(rtwdev->hw, &rtwdev->watch_dog_work, + RTW_WATCH_DOG_DELAY_TIME); +} + +static int rtw_wow_disable(struct rtw_dev *rtwdev) +{ + int ret; + + clear_bit(RTW_FLAG_WOWLAN, rtwdev->flags); + + ret = rtw_wow_stop(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to stop wow\n"); + goto out; + } + + ret = rtw_wow_swap_fw(rtwdev, RTW_NORMAL_FW); + if (ret) { + rtw_err(rtwdev, "failed to swap normal fw\n"); + goto out; + } + + ret = rtw_wow_config_normal_fw_rsvd_page(rtwdev); + if (ret) + rtw_err(rtwdev, "failed to download normal rsvd page\n"); + +out: + rtw_wow_resume_trx(rtwdev); + return ret; +} + +static void rtw_wow_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif) +{ + struct rtw_dev *rtwdev = data; + struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + + /* Current wowlan function support setting of only one STATION vif. + * So when one suitable vif is found, stop the iteration. + */ + if (rtw_wow->wow_vif || vif->type != NL80211_IFTYPE_STATION) + return; + + switch (rtwvif->net_type) { + case RTW_NET_MGD_LINKED: + rtw_wow->wow_vif = vif; + break; + case RTW_NET_NO_LINK: + if (rtw_wow->pno_req.inited) + rtwdev->wow.wow_vif = vif; + break; + default: + break; + } +} + +static int rtw_wow_set_wakeups(struct rtw_dev *rtwdev, + struct cfg80211_wowlan *wowlan) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + struct rtw_wow_pattern *rtw_patterns = rtw_wow->patterns; + struct rtw_vif *rtwvif; + int i; + + if (wowlan->disconnect) + set_bit(RTW_WOW_FLAG_EN_DISCONNECT, rtw_wow->flags); + if (wowlan->magic_pkt) + set_bit(RTW_WOW_FLAG_EN_MAGIC_PKT, rtw_wow->flags); + if (wowlan->gtk_rekey_failure) + set_bit(RTW_WOW_FLAG_EN_REKEY_PKT, rtw_wow->flags); + + if (wowlan->nd_config) + rtw_wow_check_pno(rtwdev, wowlan->nd_config); + + rtw_iterate_vifs_atomic(rtwdev, rtw_wow_vif_iter, rtwdev); + if (!rtw_wow->wow_vif) + return -EPERM; + + rtwvif = (struct rtw_vif *)rtw_wow->wow_vif->drv_priv; + if (wowlan->n_patterns && wowlan->patterns) { + rtw_wow->pattern_cnt = wowlan->n_patterns; + for (i = 0; i < wowlan->n_patterns; i++) + rtw_wow_pattern_generate(rtwdev, rtwvif, + wowlan->patterns + i, + rtw_patterns + i); + } + + return 0; +} + +static void rtw_wow_clear_wakeups(struct rtw_dev *rtwdev) +{ + struct rtw_wow_param *rtw_wow = &rtwdev->wow; + struct rtw_pno_request *pno_req = &rtw_wow->pno_req; + + if (pno_req->inited) { + kfree(pno_req->channels); + kfree(pno_req->match_sets); + } + + memset(rtw_wow, 0, sizeof(rtwdev->wow)); +} + +int rtw_wow_suspend(struct rtw_dev *rtwdev, struct cfg80211_wowlan *wowlan) +{ + int ret = 0; + + ret = rtw_wow_set_wakeups(rtwdev, wowlan); + if (ret) { + rtw_err(rtwdev, "failed to set wakeup event\n"); + goto out; + } + + ret = rtw_wow_leave_ps(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to leave ps from normal mode\n"); + goto out; + } + + ret = rtw_wow_enable(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to enable wow\n"); + rtw_wow_restore_ps(rtwdev); + goto out; + } + + ret = rtw_wow_enter_ps(rtwdev); + if (ret) + rtw_err(rtwdev, "failed to enter ps for wow\n"); + +out: + return ret; +} + +int rtw_wow_resume(struct rtw_dev *rtwdev) +{ + int ret; + + /* If wowlan mode is not enabled, do nothing */ + if (!test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) { + rtw_err(rtwdev, "wow is not enabled\n"); + ret = -EPERM; + goto out; + } + + ret = rtw_wow_leave_ps(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to leave ps from wowlan mode\n"); + goto out; + } + + rtw_wow_show_wakeup_reason(rtwdev); + + ret = rtw_wow_disable(rtwdev); + if (ret) { + rtw_err(rtwdev, "failed to disable wow\n"); + goto out; + } + + ret = rtw_wow_restore_ps(rtwdev); + if (ret) + rtw_err(rtwdev, "failed to restore ps to normal mode\n"); + +out: + rtw_wow_clear_wakeups(rtwdev); + return ret; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/wow.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/wow.h new file mode 100644 index 0000000000000000000000000000000000000000..289368a2cba440b7528817b96aa989b51c25dc62 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/net/wireless/realtek/rtw88/wow.h @@ -0,0 +1,58 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2018-2019 Realtek Corporation + */ + +#ifndef __RTW_WOW_H__ +#define __RTW_WOW_H__ + +#define PNO_CHECK_BYTE 4 + +enum rtw_wow_pattern_type { + RTW_PATTERN_BROADCAST = 0, + RTW_PATTERN_MULTICAST, + RTW_PATTERN_UNICAST, + RTW_PATTERN_VALID, + RTW_PATTERN_INVALID, +}; + +enum rtw_wake_reason { + RTW_WOW_RSN_RX_PTK_REKEY = 0x1, + RTW_WOW_RSN_RX_GTK_REKEY = 0x2, + RTW_WOW_RSN_RX_DEAUTH = 0x8, + RTW_WOW_RSN_DISCONNECT = 0x10, + RTW_WOW_RSN_RX_MAGIC_PKT = 0x21, + RTW_WOW_RSN_RX_PATTERN_MATCH = 0x23, + RTW_WOW_RSN_RX_NLO = 0x55, +}; + +struct rtw_fw_media_status_iter_data { + struct rtw_dev *rtwdev; + u8 connect; +}; + +struct rtw_fw_key_type_iter_data { + struct rtw_dev *rtwdev; + u8 group_key_type; + u8 pairwise_key_type; +}; + +static inline bool rtw_wow_mgd_linked(struct rtw_dev *rtwdev) +{ + struct ieee80211_vif *wow_vif = rtwdev->wow.wow_vif; + struct rtw_vif *rtwvif = (struct rtw_vif *)wow_vif->drv_priv; + + return (rtwvif->net_type == RTW_NET_MGD_LINKED); +} + +static inline bool rtw_wow_no_link(struct rtw_dev *rtwdev) +{ + struct ieee80211_vif *wow_vif = rtwdev->wow.wow_vif; + struct rtw_vif *rtwvif = (struct rtw_vif *)wow_vif->drv_priv; + + return (rtwvif->net_type == RTW_NET_NO_LINK); +} + +int rtw_wow_suspend(struct rtw_dev *rtwdev, struct cfg80211_wowlan *wowlan); +int rtw_wow_resume(struct rtw_dev *rtwdev); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/pwm/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/pwm/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..67592f72fa91b53248cb61a494d54932071087e4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/pwm/Kconfig @@ -0,0 +1,11 @@ +config PWM_PHYTIUM + tristate "Phytium PWM support" + depends on ARCH_PHYTIUM + help + Generic PWM framework driver for the PWM controller found on + Phytium SoCs. + + To compile this driver as a module, choose M here: the module + will be called pwm-phytium. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/pwm/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/pwm/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..b3d6fbbbfdcc0d79035227b1b04b9d153fe4d654 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/pwm/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_PWM_PHYTIUM) += pwm-phytium.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/pwm/pwm-phytium.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/pwm/pwm-phytium.c new file mode 100644 index 0000000000000000000000000000000000000000..1eaf292952c8c9636bcb5304263603abd6ec130d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/pwm/pwm-phytium.c @@ -0,0 +1,568 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium PWM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define REG_TCNT 0x00 +#define REG_TCTRL 0x04 +#define REG_STAT 0x08 + +#define REG_TPERIOD 0x0c +#define REG_PWMCTRL 0x10 +#define REG_PWMCCR 0x14 + +#define TCTRL_DIV_MASK 0x1ff8 +#define TCTRL_PWMMOD_MASK 0x4 +#define TCTRL_CAPMOD_MASK 0x3 +#define PWM_PERIOD_MASK 0xffff +#define PWM_DUTY_MASK 0xffff +#define PWM_MODE_MASK 0x4 +#define PWM_CTRL_INIT 0xc4 + +#define PWM_NUM 2 + +#define REG_DBCTRL 0x00 +#define REG_DBCLY 0x04 +#define PWM_UPDBCLY_MASK 0x3ff +#define PWM_DWDBCLY_MASK 0xffc00 +#define PWM_DB_POLARITY_MASK 0xc + +#define PWM_N(x) ((0x400)*(x)) +#define MAX_PARAMETER 2 + +struct phytium_pwm_state { + int rst; + int cntmod; + int dutymod; + unsigned int div; + int db_rst; + unsigned int updbcly; + unsigned int dwdbcly; + unsigned int dbpolarity; +}; + +struct phytium_pwm_param { + int cntmod; + int dutymod; + unsigned int div; + unsigned int updbcly; + unsigned int dwdbcly; + unsigned int dbpolarity; +}; + +struct phytium_pwm_variant { + u8 rst_mask; + u8 div; + int counter_mode; + int periodns; + int duty_ns; + int pwm_mode; + u8 duty_mode; + int updbcly; + int dwdbcly; +}; + +struct phytium_pwm_channel { + u32 period_ns; + u32 duty_ns; + u32 tin_ns; +}; + +struct phytium_pwm_chip { + struct pwm_chip chip; + struct pwm_state state_pm[PWM_NUM]; + struct phytium_pwm_variant variant; + struct phytium_pwm_state state; + u8 inverter_mask; + u8 disabled_mask; + int db_init; + void __iomem *base; + void __iomem *base1; + struct phytium_pwm_param parameter[MAX_PARAMETER]; + unsigned int num_parameters; + + unsigned long clk_rate; + struct clk *base_clk; +}; + +static inline struct phytium_pwm_chip *to_phytium_pwm_chip(struct pwm_chip *chip) +{ + return container_of(chip, struct phytium_pwm_chip, chip); +} + + +static void pwm_phytium_free(struct pwm_chip *chip, struct pwm_device *pwm) +{ + devm_kfree(chip->dev, pwm_get_chip_data(pwm)); + pwm_set_chip_data(pwm, NULL); +} + +static int pwm_phytium_enable(struct pwm_chip *chip, struct pwm_device *pwm, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); + reg |= 0x2; + our_chip->state_pm[n].enabled = 1; + writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); + + return 0; +} + +static void pwm_phytium_disable(struct pwm_chip *chip, struct pwm_device *pwm, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); + reg &= 0xfffffffd; + our_chip->state_pm[n].enabled = 0; + writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); +} + +static void pwm_phytium_dutymod(struct pwm_chip *chip, int dutymod, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base + PWM_N(n) + REG_PWMCTRL); + + if (dutymod == 0) + reg &= 0xfffffeff; + else if (dutymod == 1) + reg |= 0x100; + + writel(reg, our_chip->base + PWM_N(n) + REG_PWMCTRL); +} + +static void pwm_phytium_set_div(struct pwm_chip *chip, unsigned int div, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); + reg &= 0xffff; + reg |= (div<<16); + writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); +} + +static void pwm_phytium_set_tmode(struct pwm_chip *chip, int tmode, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); + if (tmode == 0) + reg &= 0xfffffffb; + else if (tmode == 1) + reg |= 0x4; + + writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); +} + +static void pwm_phytium_set_periodns(struct pwm_chip *chip, unsigned int periodns, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + int div = our_chip->state.div; + u64 cycles; + + cycles = our_chip->clk_rate; + cycles *= (periodns / (div + 1)); + do_div(cycles, NSEC_PER_SEC); + + reg = readl(our_chip->base + PWM_N(n) + REG_TPERIOD); + cycles = (cycles & PWM_PERIOD_MASK) - 0x1; + our_chip->state_pm[n].period = cycles; + + writel(cycles, our_chip->base + PWM_N(n) + REG_TPERIOD); +} + +static void pwm_phytium_set_duty(struct pwm_chip *chip, unsigned int duty, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + int div = our_chip->state.div; + u64 cycles; + + cycles = our_chip->clk_rate; + cycles *= (duty / (div + 1)); + do_div(cycles, NSEC_PER_SEC); + + reg = readl(our_chip->base + PWM_N(n) + REG_PWMCCR); + cycles = (cycles & PWM_DUTY_MASK) - 0x1; + our_chip->state_pm[n].duty_cycle = cycles; + + writel(cycles, our_chip->base + PWM_N(n) + REG_PWMCCR); +} + +static int pwm_phytium_set_dbcly(struct pwm_chip *chip, unsigned int updbcly, unsigned int dwdbcly) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + u64 dbcly, cycles, upcycles, dwcycles; + + reg = readl(our_chip->base + REG_TPERIOD); + cycles = our_chip->clk_rate; + dbcly &= 0x0; + if (updbcly) { + upcycles = cycles * updbcly; + do_div(upcycles, NSEC_PER_SEC); + + if (upcycles < reg) + dbcly |= (upcycles & PWM_UPDBCLY_MASK); + else + return -EINVAL; + } + + if (dwdbcly) { + dwcycles = cycles * dwdbcly; + do_div(dwcycles, NSEC_PER_SEC); + + if (dwcycles < reg) + dbcly |= ((dwcycles << 10) & PWM_DWDBCLY_MASK); + else + return -EINVAL; + } + + writel(dbcly, our_chip->base1 + REG_DBCLY); + + reg = readl(our_chip->base1 + REG_DBCTRL); + reg |= 0x30; + writel(reg, our_chip->base1 + REG_DBCTRL); + + return 0; +} + +static void pwm_phytium_set_dbpolarity(struct pwm_chip *chip, unsigned int db_polarity) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base1 + REG_DBCTRL); + reg &= 0x33; + reg |= ((db_polarity<<2) & PWM_DB_POLARITY_MASK); + writel(reg, our_chip->base1 + REG_DBCTRL); +} + +static int pwm_phytium_init(struct pwm_chip *chip, struct pwm_device *pwm, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + + writel(PWM_CTRL_INIT, our_chip->base + PWM_N(n) + REG_PWMCTRL); + + pwm_phytium_dutymod(chip, our_chip->state.dutymod, n); + pwm_phytium_set_div(chip, our_chip->state.div, n); + pwm_phytium_set_tmode(chip, our_chip->state.cntmod, n); + + return 0; +} + +static int pwm_phytium_db_init(struct pwm_chip *chip, struct pwm_device *pwm) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + + pwm_phytium_set_dbcly(chip, our_chip->state.updbcly, our_chip->state.dwdbcly); + pwm_phytium_set_dbpolarity(chip, our_chip->state.dbpolarity); + + return 0; +} + +static int __pwm_phytium_config(struct pwm_chip *chip, struct pwm_device *pwm) +{ + pwm_phytium_init(chip, pwm, 0); + pwm_phytium_init(chip, pwm, 1); + return 0; +} + +static int pwm_phytium_set_polarity(struct pwm_chip *chip, enum pwm_polarity polarity, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 value; + + value = readl(our_chip->base + PWM_N(n) + REG_PWMCTRL); + + if (polarity == PWM_POLARITY_INVERSED) { + value &= 0xffffff0f; + value |= 0x30; + } else if (polarity == PWM_POLARITY_NORMAL) { + value &= 0xffffff0f; + value |= 0x40; + } + + our_chip->state_pm[n].polarity = polarity; + writel(value, our_chip->base + PWM_N(n) + REG_PWMCTRL); + + return 0; +} + +static int pwm_phytium_apply(struct pwm_chip *chip, struct pwm_device *pwm, + const struct pwm_state *state) +{ + struct phytium_pwm_chip *phytium_pwm = to_phytium_pwm_chip(chip); + struct pwm_state cstate; + u32 reg; + int n; + + pwm_get_state(pwm, &cstate); + + n = pwm->hwpwm & BIT(0); + + if ((state->polarity != cstate.polarity) && !state->enabled) + pwm_phytium_set_polarity(chip, state->polarity, n); + + if (state->enabled && !cstate.enabled) + pwm_phytium_enable(chip, pwm, n); + + if (!state->enabled && cstate.enabled) + pwm_phytium_disable(chip, pwm, n); + + if (state->period != cstate.period) { + pwm_phytium_set_periodns(chip, state->period, n); + if ((phytium_pwm->db_init == 1) && (n == 0)) + pwm_phytium_db_init(chip, pwm); + } + + if (state->duty_cycle != cstate.duty_cycle) { + if (phytium_pwm->state.dutymod == true) { + reg = readl(phytium_pwm->base + PWM_N(n) + REG_STAT); + if ((reg & 0x8) != 0x8) + pwm_phytium_set_duty(chip, state->duty_cycle, n); + } else { + pwm_phytium_set_duty(chip, state->duty_cycle, n); + } + } + + return 0; +} + +static int pwm_phytium_request(struct pwm_chip *chip, struct pwm_device *pwm) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + struct phytium_pwm_channel *our_chan; + + our_chan = devm_kzalloc(chip->dev, sizeof(*our_chan), GFP_KERNEL); + if (!our_chan) + return -ENOMEM; + + pwm_set_chip_data(pwm, our_chan); + __pwm_phytium_config(&our_chip->chip, our_chip->chip.pwms); + + return 0; +} + +static const struct pwm_ops pwm_phytium_ops = { + .request = pwm_phytium_request, + .free = pwm_phytium_free, + .apply = pwm_phytium_apply, + .owner = THIS_MODULE, +}; + +static int phytium_pwm_set_parameter(struct phytium_pwm_chip *priv) +{ + unsigned int i; + + for (i = 0; i < priv->num_parameters; i++) { + if (priv->parameter[i].updbcly > 0 || priv->parameter[i].dwdbcly > 0) { + priv->db_init = 1; + priv->state.db_rst = 1; + } + + priv->state.cntmod = priv->parameter[i].cntmod; + priv->state.dutymod = priv->parameter[i].dutymod; + priv->state.div = priv->parameter[i].div; + priv->state.updbcly = priv->parameter[i].updbcly; + priv->state.dwdbcly = priv->parameter[i].dwdbcly; + priv->state.dbpolarity = priv->parameter[i].dbpolarity; + } + priv->state.rst = 1; + + return 0; +} + +static int pwm_phytium_probe_parameter(struct phytium_pwm_chip *priv, + struct fwnode_handle *np) +{ + int nb, ret, array_size; + unsigned int i; + + array_size = fwnode_property_read_u32_array(np, "phytium,db", NULL, 0); + nb = array_size / (sizeof(struct phytium_pwm_param) / sizeof(u32)); + if (nb <= 0 || nb > MAX_PARAMETER) + return -EINVAL; + + priv->num_parameters = nb; + ret = fwnode_property_read_u32_array(np, "phytium,db", + (u32 *)priv->parameter, array_size); + if (ret) + return ret; + + for (i = 0; i < priv->num_parameters; i++) { + if (priv->parameter[i].cntmod > 1 || + priv->parameter[i].dutymod > 1 || + priv->parameter[i].div > 4096 || + priv->parameter[i].dbpolarity > 3) + return -EINVAL; + } + + return phytium_pwm_set_parameter(priv); +} +static int pwm_phytium_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct fwnode_handle *np = dev_fwnode(dev); + struct phytium_pwm_chip *chip; + struct resource *res; + int ret; + + chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); + + if (chip == NULL) + return -ENOMEM; + + chip->chip.dev = &pdev->dev; + chip->chip.ops = &pwm_phytium_ops; + chip->chip.base = -1; + chip->chip.npwm = PWM_NUM; + chip->inverter_mask = BIT(PWM_NUM) - 1; + + if (dev->of_node) { + chip->chip.of_xlate = of_pwm_xlate_with_flags; + chip->chip.of_pwm_n_cells = 3; + } + ret = pwm_phytium_probe_parameter(chip, np); + if (ret) { + dev_err(dev, "failed to set parameter\n"); + return ret; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + chip->base1 = devm_ioremap_resource(&pdev->dev, res); + chip->base = (chip->base1 + 0x400); + + if (IS_ERR(chip->base)) { + dev_err(dev, "failed to get base_addr\n"); + return PTR_ERR(chip->base); + } + if (dev->of_node) { + chip->base_clk = devm_clk_get(&pdev->dev, NULL); + if (IS_ERR(chip->base_clk)) { + dev_err(dev, "failed to get clk\n"); + return PTR_ERR(chip->base_clk); + } + + ret = clk_prepare_enable(chip->base_clk); + if (ret < 0) { + dev_err(dev, "failed to enable clk\n"); + return ret; + } + chip->clk_rate = clk_get_rate(chip->base_clk); + } else if (has_acpi_companion(dev)){ + if(fwnode_property_read_u32(dev_fwnode(dev),"clock-frequency", (u32 *)&(chip->clk_rate) ) <0) + chip->clk_rate = 50000000; + } + platform_set_drvdata(pdev, chip); + + ret = pwmchip_add(&chip->chip); + + if (ret < 0) { + dev_err(dev, "failed to register PWM chip\n"); + return ret; + } + + return 0; +} + +static int pwm_phytium_remove(struct platform_device *pdev) +{ + struct phytium_pwm_chip *chip = platform_get_drvdata(pdev); + + pwmchip_remove(&chip->chip); + + clk_disable_unprepare(chip->base_clk); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int pwm_phytium_pm_init(struct phytium_pwm_chip *priv) +{ + int i; + + __pwm_phytium_config(&priv->chip, priv->chip.pwms); + for (i = 0; i < priv->chip.npwm; i++) { + writel(priv->state_pm[i].period, priv->base + PWM_N(i) + REG_TPERIOD); + if ((priv->db_init == 1) && (i == 0)) + pwm_phytium_db_init(&priv->chip, priv->chip.pwms); + writel(priv->state_pm[i].duty_cycle, priv->base + PWM_N(i) + REG_PWMCTRL); + pwm_phytium_set_polarity(&priv->chip, priv->state_pm[i].polarity, i); + if (priv->state_pm[i].enabled) + pwm_phytium_enable(&priv->chip, priv->chip.pwms, i); + } + + return 0; +} + +static int pwm_phytium_suspend(struct device *dev) +{ + return 0; +} + +static int pwm_phytium_resume(struct device *dev) +{ + struct phytium_pwm_chip *priv = dev_get_drvdata(dev); + + pwm_phytium_pm_init(priv); + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_pwm_dev_pm_ops, pwm_phytium_suspend, pwm_phytium_resume); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_pwm_acpi_ids[] = { + { "PHYT0029", 0 }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(acpi, phytium_pwm_acpi_ids); +#endif + +static const struct of_device_id phytium_pwm_matches[] = { + { .compatible = "phytium,pwm" }, + {}, +}; +MODULE_DEVICE_TABLE(of, phytium_pwm_matches); + +static struct platform_driver pwm_phytium_driver = { + .driver = { + .name = "phytium-pwm", + .pm = &phytium_pwm_dev_pm_ops, + .of_match_table = phytium_pwm_matches, + .acpi_match_table = ACPI_PTR(phytium_pwm_acpi_ids), + }, + .probe = pwm_phytium_probe, + .remove = pwm_phytium_remove, +}; +module_platform_driver(pwm_phytium_driver); + +MODULE_DESCRIPTION("Phytium SoC PWM driver"); +MODULE_AUTHOR("Yang Liu "); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/remoteproc/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/remoteproc/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..d21959ab1d3a089804eb70614bee2657350680d4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/remoteproc/Kconfig @@ -0,0 +1,7 @@ +config HOMO_REMOTEPROC + bool "homogeneous remoteproc support" + select RPMSG_VIRTIO + help + Say y here to support homogeneous processors via the remote processor framework. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/remoteproc/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/remoteproc/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..1314f9cae6364ee101c7dfcee8a3c8687145ac0e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/remoteproc/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_HOMO_REMOTEPROC) += homo_remoteproc.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/remoteproc/homo_remoteproc.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/remoteproc/homo_remoteproc.c new file mode 100644 index 0000000000000000000000000000000000000000..219b089a6792235bb66e35e1cec28808e4bcd53b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/remoteproc/homo_remoteproc.c @@ -0,0 +1,349 @@ +/* + * Homogeneous Remote Processor Control Driver + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + * Author: Shaojun Yang + * + * This program is free software; you can redistribute it and/or modify it under the terms + * of the GNU General Public License version 2 as published by the Free Software Foundation. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "../../../drivers/remoteproc/remoteproc_internal.h" + +#define RPROC_RESOURCE_ENTRIES 8 + +#define PSCI_VERSION 0x84000000 +#define CPU_SUSPEND 0xc4000001 +#define CPU_OFF 0x84000002 +#define CPU_ON 0xc4000003 +#define AFFINITY_INFO 0xc4000004 +#define MIGRATE 0xc4000005 + +/* Resource table for the homo remote processors */ +struct homo_resource_table { + unsigned int version; + unsigned int num; + unsigned int reserved[2]; + unsigned int offset[RPROC_RESOURCE_ENTRIES]; + + /* Note: linux kenrel 'struct fw_rsc_vdev' has no 'type' field, here add to align data structre */ + uint32_t type; + /* rpmsg vdev entry */ + struct fw_rsc_vdev rpmsg_vdev; + struct fw_rsc_vdev_vring rpmsg_vring0; + struct fw_rsc_vdev_vring rpmsg_vring1; +}; + +struct homo_rproc { + struct rproc *rproc; + struct homo_resource_table *rsc; + + u64 phys_addr; + void *addr; + u64 size; + + int irq; + int cpu; +}; + +static int homo_rproc_irq; +static struct homo_rproc *g_priv; +static struct work_struct workqueue; + +#define MPIDR_TO_SGI_AFFINITY(cluster_id, level) (MPIDR_AFFINITY_LEVEL(cluster_id, level) << ICC_SGI1R_AFFINITY_## level ## _SHIFT) + +void gicv3_ipi_send_single(int irq, u64 mpidr) +{ + u16 tlist = 0; + u64 cluster_id; + u64 sgi1r; + + /* Ensure stores to Normal memory are visible to other CPUs before sending the IPI. */ + wmb(); + + cluster_id = mpidr & ~0xffUL; + tlist |= 1 << (mpidr & 0xf); + + /* Send the IPIs for the target list of this cluster */ + sgi1r = (MPIDR_TO_SGI_AFFINITY(cluster_id, 3) | + MPIDR_TO_SGI_AFFINITY(cluster_id, 2) | + irq << 24 | + MPIDR_TO_SGI_AFFINITY(cluster_id, 1) | tlist); + gic_write_sgi1r(sgi1r); + + /* Force the above writes to ICC_SGI1R_EL1 to be executed */ + isb(); +} + +static void homo_rproc_vq_irq(struct work_struct *work) +{ + struct homo_rproc *priv = g_priv; + struct homo_resource_table *rsc = priv->rsc; + struct rproc *rproc = priv->rproc; + + rproc_vq_interrupt(rproc, rsc->rpmsg_vring0.notifyid); +} + +static int homo_rproc_start(struct rproc *rproc) +{ + int err; + struct homo_rproc *priv = rproc->priv; + int phys_cpuid = cpu_logical_map(priv->cpu); + struct arm_smccc_res smc_res; + + err = psci_ops.affinity_info(phys_cpuid, 0); + if (err == 0) + remove_cpu(priv->cpu); + + INIT_WORK(&workqueue, homo_rproc_vq_irq); + + priv->rsc = (struct homo_resource_table *)rproc->table_ptr; + + /* ARMv8 requires to clean D-cache and invalidate I-cache for memory containing new instructions. */ + flush_icache_range((unsigned long)priv->addr, (unsigned long)(priv->addr + priv->size)); + + arm_smccc_smc(CPU_ON, phys_cpuid, (unsigned long long)priv->phys_addr, 0, 0, 0, 0, 0, &smc_res); + + return smc_res.a0; +} + +static int homo_rproc_stop(struct rproc *rproc) +{ + int err; + struct homo_rproc *priv = rproc->priv; + + err = psci_ops.affinity_info(cpu_logical_map(priv->cpu), 0); + if (err == 1) + add_cpu(priv->cpu); + + return 0; +} + +static void *homo_rproc_da_to_va(struct rproc *rproc, u64 da, size_t len) +{ + struct homo_rproc *priv = rproc->priv; + + return priv->addr + (da - rproc->bootaddr); +} + +static void homo_rproc_kick(struct rproc *rproc, int vqid) +{ + struct homo_rproc *priv = rproc->priv; + + if (rproc->state == RPROC_RUNNING) + gicv3_ipi_send_single(priv->irq, cpu_logical_map(priv->cpu)); + + return ; +} + +static const struct rproc_ops homo_rproc_ops = { + .start = homo_rproc_start, + .stop = homo_rproc_stop, + .kick = homo_rproc_kick, + .da_to_va = homo_rproc_da_to_va, +}; + +static void __iomem *homo_ioremap_prot(phys_addr_t addr, size_t size, pgprot_t prot) +{ + unsigned long offset, vaddr; + phys_addr_t last_addr; + struct vm_struct *area; + + /* Disallow wrap-around or zero size */ + last_addr = addr + size - 1; + if (!size || last_addr < addr) + return NULL; + + /* Page-align mappings */ + offset = addr & (~PAGE_MASK); + addr -= offset; + size = PAGE_ALIGN(size + offset); + + area = get_vm_area_caller(size, VM_IOREMAP, + __builtin_return_address(0)); + if (!area) + return NULL; + vaddr = (unsigned long)area->addr; + + if (ioremap_page_range(vaddr, vaddr + size, addr, prot)) { + free_vm_area(area); + return NULL; + } + + return (void __iomem *)(vaddr + offset); +} + +static irqreturn_t homo_rproc_irq_handler(int irq, void *data) +{ + schedule_work(&workqueue); + return IRQ_HANDLED; +} + +static int homo_rproc_starting_cpu(unsigned int cpu) +{ + enable_percpu_irq(homo_rproc_irq, irq_get_trigger_type(homo_rproc_irq)); + return 0; +} + +static int homo_rproc_dying_cpu(unsigned int cpu) +{ + disable_percpu_irq(homo_rproc_irq); + return 0; +} + +static int homo_rproc_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct device_node *np = dev->of_node, *p; + struct device_node *np_mem; + struct resource res; + struct rproc *rproc; + const char *fw_name; + struct homo_rproc *priv; + int ret; + unsigned int ipi, cpu; + struct of_phandle_args oirq; + + ret = rproc_of_parse_firmware(dev, 0, &fw_name); + if (ret) { + dev_err(dev, "failed to parse firmware-name property, ret = %d\n", ret); + return ret; + } + + rproc = rproc_alloc(dev, np->name, &homo_rproc_ops, fw_name, sizeof(*priv)); + if (!rproc) + return -ENOMEM; + + rproc->auto_boot = false; + rproc->has_iommu = false; + + platform_set_drvdata(pdev, rproc); + + priv = g_priv = rproc->priv; + priv->rproc = rproc; + + /* The following values can be modified through devicetree 'homo_rproc' node */ + if (of_property_read_u32(np, "remote-processor", &cpu)) { + dev_err(dev, "not found 'remote-processor' property\n"); + return -EINVAL; + } + + if (of_property_read_u32(np, "inter-processor-interrupt", &ipi)) { + dev_err(dev, "not found 'inter-processor-interrupt' property\n"); + return -EINVAL; + } + + /* The gic-v3 driver has registered the 0-7 range of SGI interrupt for system purpose */ + if (ipi < 8) { + dev_err(dev, "'inter-processor-interrupt' is %d, should be between 9~15\n", ipi); + return -EINVAL; + } + + priv->cpu = cpu; + priv->irq = ipi; + + dev_info(dev, "remote-processor = %d, inter-processor-interrupt = %d\n", cpu, ipi); + + np_mem = of_parse_phandle(np, "memory-region", 0); + ret = of_address_to_resource(np_mem, 0, &res); + if (ret) { + dev_err(dev, "can't find memory-region for Baremetal\n"); + return ret; + } + + priv->rsc = NULL; + priv->addr = NULL; + + priv->phys_addr = res.start; + priv->size = resource_size(&res); + + /* Map physical memory region reserved for homo remote processor. */ + priv->addr = homo_ioremap_prot(priv->phys_addr, priv->size, PAGE_KERNEL_EXEC); + if (!priv->addr) { + dev_err(dev, "ioremap failed\n"); + return -ENOMEM; + } + dev_info(dev, "ioremap: phys_addr = %016llx, addr = %llx, size = %lld\n", + priv->phys_addr, (u64)(priv->addr), priv->size); + + /* Look for the interrupt parent. */ + p = of_irq_find_parent(np); + if (p == NULL) { + ret = -EINVAL; + goto err; + } + + oirq.np = p; + oirq.args_count = 1; + oirq.args[0] = ipi; + homo_rproc_irq = irq_create_of_mapping(&oirq); + if (homo_rproc_irq <= 0) { + ret = -EINVAL; + goto err; + } + + ret = request_percpu_irq(homo_rproc_irq, homo_rproc_irq_handler, "homo-rproc-ipi", &cpu_number); + if (ret) { + dev_err(dev, "failed to request percpu irq, status = %d\n", ret); + goto err; + } + + ret = cpuhp_setup_state(CPUHP_AP_HOMO_RPROC_STARTING, "remoteproc/homo_rproc:starting", homo_rproc_starting_cpu, homo_rproc_dying_cpu); + if (ret) { + dev_err(dev, "cpuhp setup state failed, status = %d\n", ret); + goto err; + } + + ret = rproc_add(rproc); + if (ret) { + dev_err(dev, "failed to add register device with remoteproc core, status = %d\n", ret); + goto err; + } + + return 0; + +err: + vunmap((void *)((unsigned long)priv->addr & PAGE_MASK)); + return ret; +} + +static int homo_rproc_remove(struct platform_device *pdev) +{ + struct rproc *rproc = platform_get_drvdata(pdev); + + rproc_del(rproc); + rproc_free(rproc); + + return 0; +} + +static const struct of_device_id homo_rproc_ids[] = { + { .compatible = "homo,rproc", }, + { } +}; +MODULE_DEVICE_TABLE(of, homo_rproc_ids); + +static struct platform_driver homo_rproc_driver = { + .probe = homo_rproc_probe, + .remove = homo_rproc_remove, + .driver = { + .name = "homo-rproc", + .of_match_table = of_match_ptr(homo_rproc_ids), + }, +}; +module_platform_driver(homo_rproc_driver); + +MODULE_DESCRIPTION("Homogeneous Remote Processor Control Driver"); +MODULE_AUTHOR("Shaojun Yang "); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/rtc/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/rtc/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..6567a16253b1449c935b99d266c8ac3aeefc2740 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/rtc/Kconfig @@ -0,0 +1,10 @@ +config RTC_DRV_SD3068 + tristate "ZXW Shenzhen whwave SD3068" + select REGMAP_I2C + help + If you say yes here you get support for the ZXW Shenzhen whwave + SD3068 RTC chips. + + This driver can also be built as a module. If so, the module + will be called rtc-sd3068 + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/rtc/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/rtc/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..1b2c1e9da89989c1a9e151f272b9d2c2db0aa1e0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/rtc/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_RTC_DRV_SD3068) += rtc-sd3068.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/rtc/rtc-sd3068.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/rtc/rtc-sd3068.c new file mode 100755 index 0000000000000000000000000000000000000000..6abd0cd852f3aa70cfb1bd594236baf423f9fbd0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/rtc/rtc-sd3068.c @@ -0,0 +1,255 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * rtc-sd3068.c - RTC driver for some mostly-compatible I2C chips. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define SD3068_REG_SC 0x00 +#define SD3068_REG_MN 0x01 +#define SD3068_REG_HR 0x02 +#define SD3068_REG_DW 0x03 +#define SD3068_REG_DM 0x04 +#define SD3068_REG_MO 0x05 +#define SD3068_REG_YR 0x06 + +#define SD3068_REG_CTRL1 0x0f +#define SD3068_REG_CTRL2 0x10 +#define SD3068_REG_CTRL3 0x11 + +#define KEY_WRITE1 0x80 +#define KEY_WRITE2 0x04 +#define KEY_WRITE3 0x80 + +#define NUM_TIME_REGS (SD3068_REG_YR - SD3068_REG_SC + 1) + +/* + * The sd3068 has write protection + * and we can choose whether or not to use it. + * Write protection is turned off by default. + */ +#define WRITE_PROTECT_EN 1 + +struct sd3068 { + struct rtc_device *rtc; + struct regmap *regmap; +}; + +/* + * In order to prevent arbitrary modification of the time register, + * when modification of the register, + * the "write" bit needs to be written in a certain order. + * 1. set WRITE1 bit + * 2. set WRITE2 bit + * 3. set WRITE3 bit + */ +static void sd3068_enable_reg_write(struct sd3068 *sd3068) +{ + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL2, + KEY_WRITE1, KEY_WRITE1); + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, + KEY_WRITE2, KEY_WRITE2); + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, + KEY_WRITE3, KEY_WRITE3); +} + +#if WRITE_PROTECT_EN +/* + * In order to prevent arbitrary modification of the time register, + * we should disable the write function. + * when disable write, + * the "write" bit needs to be clear in a certain order. + * 1. clear WRITE2 bit + * 2. clear WRITE3 bit + * 3. clear WRITE1 bit + */ +static void sd3068_disable_reg_write(struct sd3068 *sd3068) +{ + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, + KEY_WRITE2, 0); + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, + KEY_WRITE3, 0); + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL2, + KEY_WRITE1, 0); +} +#endif + +static int sd3068_rtc_read_time(struct device *dev, struct rtc_time *tm) +{ + unsigned char hour; + unsigned char rtc_data[NUM_TIME_REGS] = {0}; + struct i2c_client *client = to_i2c_client(dev); + struct sd3068 *sd3068 = i2c_get_clientdata(client); + int ret; + pr_debug("sd3068 read\n"); + + ret = regmap_bulk_read(sd3068->regmap, SD3068_REG_SC, rtc_data, + NUM_TIME_REGS); + if (ret < 0) { + dev_err(dev, "reading from RTC failed with err:%d\n", ret); + return ret; + } + + tm->tm_sec = bcd2bin(rtc_data[SD3068_REG_SC] & 0x7F); + tm->tm_min = bcd2bin(rtc_data[SD3068_REG_MN] & 0x7F); + + /* + * The sd3068 supports 12/24 hour mode. + * When getting time, + * we need to convert the 12 hour mode to the 24 hour mode. + */ + hour = rtc_data[SD3068_REG_HR]; + if (hour & 0x80) /* 24H MODE */ + tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x3F); + else if (hour & 0x20) /* 12H MODE PM */ + tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x1F) + 12; + else /* 12H MODE AM */ + tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x1F); + + tm->tm_mday = bcd2bin(rtc_data[SD3068_REG_DM] & 0x3F); + tm->tm_wday = rtc_data[SD3068_REG_DW] & 0x07; + tm->tm_mon = bcd2bin(rtc_data[SD3068_REG_MO] & 0x1F) - 1; + tm->tm_year = bcd2bin(rtc_data[SD3068_REG_YR]) + 100; + + return 0; +} + +static int sd3068_rtc_set_time(struct device *dev, struct rtc_time *tm) +{ + unsigned char rtc_data[NUM_TIME_REGS]; + struct i2c_client *client = to_i2c_client(dev); + struct sd3068 *sd3068 = i2c_get_clientdata(client); + int ret; + pr_debug("sd3068 set\n"); + + rtc_data[SD3068_REG_SC] = bin2bcd(tm->tm_sec); + rtc_data[SD3068_REG_MN] = bin2bcd(tm->tm_min); + rtc_data[SD3068_REG_HR] = bin2bcd(tm->tm_hour) | 0x80; + rtc_data[SD3068_REG_DM] = bin2bcd(tm->tm_mday); + rtc_data[SD3068_REG_DW] = tm->tm_wday & 0x07; + rtc_data[SD3068_REG_MO] = bin2bcd(tm->tm_mon) + 1; + rtc_data[SD3068_REG_YR] = bin2bcd(tm->tm_year - 100); + +#if WRITE_PROTECT_EN + sd3068_enable_reg_write(sd3068); +#endif + + ret = regmap_bulk_write(sd3068->regmap, SD3068_REG_SC, rtc_data, + NUM_TIME_REGS); + if (ret < 0) { + dev_err(dev, "writing to RTC failed with err:%d\n", ret); + return ret; + } + +#if WRITE_PROTECT_EN + sd3068_disable_reg_write(sd3068); +#endif + + return 0; +} + +static const struct rtc_class_ops sd3068_rtc_ops = { + .read_time = sd3068_rtc_read_time, + .set_time = sd3068_rtc_set_time, +}; + +static const struct regmap_config regmap_config = { + .reg_bits = 8, + .val_bits = 8, + .max_register = 0x11, +}; + +static int sd3068_probe(struct i2c_client *client, + const struct i2c_device_id *id) +{ + int ret; + struct sd3068 *sd3068; + unsigned char rtc_data[NUM_TIME_REGS] = {0}; + pr_debug("probed\n"); + + if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) + return -ENODEV; + + sd3068 = devm_kzalloc(&client->dev, sizeof(*sd3068), GFP_KERNEL); + if (!sd3068) + return -ENOMEM; + + sd3068->regmap = devm_regmap_init_i2c(client, ®map_config); + if (IS_ERR(sd3068->regmap)) { + dev_err(&client->dev, "regmap allocation failed\n"); + return PTR_ERR(sd3068->regmap); + } + + i2c_set_clientdata(client, sd3068); + + sd3068->rtc = devm_rtc_allocate_device(&client->dev); + if (IS_ERR(sd3068->rtc)) + return PTR_ERR(sd3068->rtc); + + sd3068->rtc->ops = &sd3068_rtc_ops; + sd3068->rtc->range_min = RTC_TIMESTAMP_BEGIN_2000; + sd3068->rtc->range_max = RTC_TIMESTAMP_END_2099; + + ret = regmap_bulk_read(sd3068->regmap, SD3068_REG_SC, rtc_data, + NUM_TIME_REGS); + if (ret < 0) { + dev_info(&client->dev, "can not read time data when probe\n"); + return ret; + } + + ret = rtc_register_device(sd3068->rtc); + if (ret) + return ret; + + sd3068_enable_reg_write(sd3068); + + return 0; +} + + +static const struct acpi_device_id ds1307_acpi_ids[] = { + { .id = "DS1339", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, ds1307_acpi_ids); + +static const struct i2c_device_id sd3068_id[] = { + { "sd3068", 0 }, + { } +}; +MODULE_DEVICE_TABLE(i2c,sd3068_id); + +static const struct of_device_id sd3068_of_match[] = { + { .compatible = "wave,sd3068" }, + { } +}; + +static struct i2c_driver sd3068_driver = { + .driver = { + .name = "rtc-sd3068", + .of_match_table = of_match_ptr(sd3068_of_match), + .acpi_match_table = ACPI_PTR(ds1307_acpi_ids), + }, + .probe = sd3068_probe, + .id_table = sd3068_id, +}; + +module_i2c_driver(sd3068_driver); +MODULE_DEVICE_TABLE(of, sd3068_of_match); + +MODULE_DESCRIPTION("RTC driver for SD3068 and similar chips"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..cb9b9baef4b353fcb1410d99ddb97fc22bea7dbd --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/Kconfig @@ -0,0 +1,26 @@ +config SPI_PHYTIUM + tristate + depends on ARCH_PHYTIUM || COMPILE_TEST + +config SPI_PHYTIUM_PLAT + tristate "Phytium SPI controller platform support" + select SPI_PHYTIUM + help + This selects a platform driver for Phytium SPI controller. + + If you say yes to this option, support will be included for + Pd1904 and pd2008 families of SPI controller. + +config SPI_PHYTIUM_PCI + tristate "Phytium SPI controller PCI support" + depends on PCI + select SPI_PHYTIUM + help + This selects a PCI driver for Phytium SPI controller. + + If you say yes to this option, support will be included for + Phytium px210 chipset of SPI controller. + + If unsure, say N. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..99d75cc6a327348b8dc71c358015ca54da0c3e9f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/Makefile @@ -0,0 +1,4 @@ +obj-$(CONFIG_SPI_PHYTIUM) += spi-phytium.o spi-phytium-dma.o +obj-$(CONFIG_SPI_PHYTIUM_PLAT) += spi-phytium-plat.o +obj-$(CONFIG_SPI_PHYTIUM_PCI) += spi-phytium-pci.o +obj-$(CONFIG_SPI_PHYTIUM_QSPI) += spi-phytium-qspi.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-dma.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-dma.c new file mode 100644 index 0000000000000000000000000000000000000000..4f78d0659ef4f0080ae19a4a977c68bc1f1fd862 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-dma.c @@ -0,0 +1,555 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Special handling for phytium DMA core + * + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "spi-phytium.h" + +#define RX_BUSY 0 +#define RX_BURST_LEVEL 16 +#define TX_BUSY 1 +#define TX_BURST_LEVEL 16 + +#define DMA_MAX_BUF_SIZE 4096 + +static void phytium_spi_dma_maxburst_init(struct phytium_spi *fts) +{ + struct dma_slave_caps caps; + u32 max_burst, def_burst; + int ret; + + def_burst = fts->fifo_len / 2; + + ret = dma_get_slave_caps(fts->rxchan, &caps); + if (!ret && caps.max_burst) + max_burst = caps.max_burst; + else + max_burst = RX_BURST_LEVEL; + + fts->rxburst = min(max_burst, def_burst); + phytium_writel(fts, DMARDLR, 0x0); + + ret = dma_get_slave_caps(fts->txchan, &caps); + if (!ret && caps.max_burst) + max_burst = caps.max_burst; + else + max_burst = TX_BURST_LEVEL; + + /* + * Having a Rx DMA channel serviced with higher priority than a Tx DMA + * channel might not be enough to provide a well balanced DMA-based + * SPI transfer interface. There might still be moments when the Tx DMA + * channel is occasionally handled faster than the Rx DMA channel. + * That in its turn will eventually cause the SPI Rx FIFO overflow if + * SPI bus speed is high enough to fill the SPI Rx FIFO in before it's + * cleared by the Rx DMA channel. In order to fix the problem the Tx + * DMA activity is intentionally slowed down by limiting the SPI Tx + * FIFO depth with a value twice bigger than the Tx burst length. + */ + fts->txburst = min(max_burst, def_burst); + /* set dmatdlr to 0 + 1 */ + phytium_writel(fts, DMATDLR, 0); +} + +static void phytium_spi_dma_sg_burst_init(struct phytium_spi *fts) +{ + struct dma_slave_caps tx = {0}, rx = {0}; + + dma_get_slave_caps(fts->txchan, &tx); + dma_get_slave_caps(fts->rxchan, &rx); + + if (tx.max_sg_burst > 0 && rx.max_sg_burst > 0) + fts->dma_sg_burst = min(tx.max_sg_burst, rx.max_sg_burst); + else if (tx.max_sg_burst > 0) + fts->dma_sg_burst = tx.max_sg_burst; + else if (rx.max_sg_burst > 0) + fts->dma_sg_burst = rx.max_sg_burst; + else + fts->dma_sg_burst = 0; +} + +static int phytium_spi_dma_init(struct device *dev, struct phytium_spi *fts) +{ + fts->rxchan = dma_request_chan(dev, "rx"); + if (IS_ERR_OR_NULL(fts->rxchan)) + return -ENODEV; + + fts->txchan = dma_request_chan(dev, "tx"); + if (IS_ERR_OR_NULL(fts->txchan)) { + dev_err(dev, "can't request chan\n"); + dma_release_channel(fts->rxchan); + fts->rxchan = NULL; + return -ENODEV; + } + + fts->master->dma_rx = fts->rxchan; + fts->master->dma_tx = fts->txchan; + init_completion(&fts->dma_completion); + + phytium_spi_dma_maxburst_init(fts); + phytium_spi_dma_sg_burst_init(fts); + + return 0; +} + +static void phytium_spi_dma_exit(struct phytium_spi *fts) +{ + if (fts->txchan) { + dmaengine_terminate_sync(fts->txchan); + dma_release_channel(fts->txchan); + } + + if (fts->rxchan) { + dmaengine_terminate_sync(fts->rxchan); + dma_release_channel(fts->rxchan); + } +} + +static irqreturn_t phytium_spi_dma_transfer_handler(struct phytium_spi *fts) +{ + phytium_spi_check_status(fts, false); + + complete(&fts->dma_completion); + + return IRQ_HANDLED; +} + +static bool phytium_spi_can_dma(struct spi_controller *master, + struct spi_device *spi, struct spi_transfer *xfer) +{ + struct phytium_spi *fts = spi_controller_get_devdata(master); + + return xfer->len > fts->fifo_len; +} + +static enum dma_slave_buswidth phytium_spi_dma_convert_width(u8 n_bytes) +{ + if (n_bytes == 1) + return DMA_SLAVE_BUSWIDTH_1_BYTE; + else if (n_bytes == 2) + return DMA_SLAVE_BUSWIDTH_2_BYTES; + + return DMA_SLAVE_BUSWIDTH_UNDEFINED; +} + +static int phytium_spi_dma_wait(struct phytium_spi *fts, unsigned int len, + u32 speed) +{ + unsigned long long ms; + + ms = len * MSEC_PER_SEC * BITS_PER_BYTE; + do_div(ms, speed); + ms += ms + 200; + + if (ms > UINT_MAX) + ms = UINT_MAX; + + ms = wait_for_completion_timeout(&fts->dma_completion, + msecs_to_jiffies(ms)); + + if (ms == 0) { + dev_err(&fts->master->cur_msg->spi->dev, + "DMA transaction timed out\n"); + return -ETIMEDOUT; + } + + return 0; +} + +static inline bool phytium_spi_dma_tx_busy(struct phytium_spi *fts) +{ + return !(phytium_readl(fts, SR) & SR_TF_EMPT); +} + +static int phytium_spi_dma_wait_tx_done(struct phytium_spi *fts, + struct spi_transfer *xfer) +{ + int retry = SPI_WAIT_RETRIES; + struct spi_delay delay; + u32 nents; + + nents = phytium_readl(fts, TXFLR); + delay.unit = SPI_DELAY_UNIT_SCK; + delay.value = nents * fts->n_bytes * BITS_PER_BYTE; + + while (phytium_spi_dma_tx_busy(fts) && retry--) + spi_delay_exec(&delay, xfer); + + if (retry < 0) { + dev_err(&fts->master->dev, "Tx hanged up\n"); + return -EIO; + } + + return 0; +} + +/* + * fts->dma_chan_busy is set before the dma transfer starts, callback for tx + * channel will clear a corresponding bit. + */ +static void phytium_spi_dma_tx_done(void *arg) +{ + struct phytium_spi *fts = arg; + + clear_bit(TX_BUSY, &fts->dma_chan_busy); + if (test_bit(RX_BUSY, &fts->dma_chan_busy)) + return; + + complete(&fts->dma_completion); +} + +static int phytium_spi_dma_config_tx(struct phytium_spi *fts) +{ + struct dma_slave_config txconf; + + memset(&txconf, 0, sizeof(txconf)); + txconf.direction = DMA_MEM_TO_DEV; + txconf.dst_addr = fts->dma_addr; + txconf.dst_maxburst = fts->txburst; + txconf.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; + txconf.dst_addr_width = phytium_spi_dma_convert_width(fts->n_bytes); + txconf.device_fc = false; + + return dmaengine_slave_config(fts->txchan, &txconf); +} + +static int phytium_spi_dma_submit_tx(struct phytium_spi *fts, struct scatterlist *sgl, + unsigned int nents) +{ + struct dma_async_tx_descriptor *txdesc; + dma_cookie_t cookie; + int ret; + + txdesc = dmaengine_prep_slave_sg(fts->txchan, sgl, nents, + DMA_MEM_TO_DEV, + DMA_PREP_INTERRUPT | DMA_CTRL_ACK); + if (!txdesc) + return -ENOMEM; + + txdesc->callback = phytium_spi_dma_tx_done; + txdesc->callback_param = fts; + + cookie = dmaengine_submit(txdesc); + ret = dma_submit_error(cookie); + if (ret) { + dmaengine_terminate_sync(fts->txchan); + return ret; + } + + set_bit(TX_BUSY, &fts->dma_chan_busy); + + return 0; +} + +static inline bool phytium_spi_dma_rx_busy(struct phytium_spi *fts) +{ + return !!(phytium_readl(fts, SR) & SR_RF_NOT_EMPT); +} + +static int phytium_spi_dma_wait_rx_done(struct phytium_spi *fts) +{ + int retry = SPI_WAIT_RETRIES; + struct spi_delay delay; + unsigned long ns, us; + u32 nents; + + /* + * It's unlikely that DMA engine is still doing the data fetching, but + * if it's let's give it some reasonable time. The timeout calculation + * is based on the synchronous APB/SSI reference clock rate, on a + * number of data entries left in the Rx FIFO, times a number of clock + * periods normally needed for a single APB read/write transaction + * without PREADY signal utilized (which is true for the phytium APB SSI + * controller). + */ + nents = phytium_readl(fts, RXFLR); + ns = 4U * NSEC_PER_SEC / fts->max_freq * nents; + if (ns <= NSEC_PER_USEC) { + delay.unit = SPI_DELAY_UNIT_NSECS; + delay.value = ns; + } else { + us = DIV_ROUND_UP(ns, NSEC_PER_USEC); + delay.unit = SPI_DELAY_UNIT_USECS; + delay.value = clamp_val(us, 0, USHRT_MAX); + } + + while (phytium_spi_dma_rx_busy(fts) && retry--) + spi_delay_exec(&delay, NULL); + + if (retry < 0) { + dev_err(&fts->master->dev, "Rx hanged up, nents = %d\n", nents); + return -EIO; + } + + return 0; +} + +/* + * fts->dma_chan_busy is set before the dma transfer starts, callback for rx + * channel will clear a corresponding bit. + */ +static void phytium_spi_dma_rx_done(void *arg) +{ + struct phytium_spi *fts = arg; + + clear_bit(RX_BUSY, &fts->dma_chan_busy); + if (test_bit(TX_BUSY, &fts->dma_chan_busy)) + return; + + complete(&fts->dma_completion); +} + +static int phytium_spi_dma_config_rx(struct phytium_spi *fts) +{ + struct dma_slave_config rxconf; + + memset(&rxconf, 0, sizeof(rxconf)); + rxconf.direction = DMA_DEV_TO_MEM; + rxconf.src_addr = fts->dma_addr; + rxconf.src_maxburst = fts->rxburst; + rxconf.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; + rxconf.src_addr_width = phytium_spi_dma_convert_width(fts->n_bytes); + rxconf.device_fc = false; + + return dmaengine_slave_config(fts->rxchan, &rxconf); +} + +static int phytium_spi_dma_submit_rx(struct phytium_spi *fts, struct scatterlist *sgl, + unsigned int nents) +{ + struct dma_async_tx_descriptor *rxdesc; + dma_cookie_t cookie; + int ret; + + rxdesc = dmaengine_prep_slave_sg(fts->rxchan, sgl, nents, + DMA_DEV_TO_MEM, + DMA_PREP_INTERRUPT | DMA_CTRL_ACK); + if (!rxdesc) + return -ENOMEM; + + rxdesc->callback = phytium_spi_dma_rx_done; + rxdesc->callback_param = fts; + + cookie = dmaengine_submit(rxdesc); + ret = dma_submit_error(cookie); + if (ret) { + dmaengine_terminate_sync(fts->rxchan); + return ret; + } + + set_bit(RX_BUSY, &fts->dma_chan_busy); + + return 0; +} + +static int phytium_spi_dma_setup(struct phytium_spi *fts, struct spi_transfer *xfer) +{ + u16 imr, dma_ctrl; + int ret; + + if (!xfer->tx_buf) + return -EINVAL; + + /* Setup DMA channels */ + ret = phytium_spi_dma_config_tx(fts); + if (ret) + return ret; + + if (xfer->rx_buf) { + ret = phytium_spi_dma_config_rx(fts); + if (ret) + return ret; + } + + /* Set the DMA handshaking interface */ + dma_ctrl = SPI_DMA_TDMAE; + if (xfer->rx_buf) + dma_ctrl |= SPI_DMA_RDMAE; + phytium_writel(fts, DMACR, dma_ctrl); + + /* Set the interrupt mask */ + imr = INT_TXOI; + if (xfer->rx_buf) + imr |= INT_RXUI | INT_RXOI; + + spi_umask_intr(fts, imr); + + reinit_completion(&fts->dma_completion); + + fts->transfer_handler = phytium_spi_dma_transfer_handler; + + return 0; +} + +static int phytium_spi_dma_transfer_all(struct phytium_spi *fts, + struct spi_transfer *xfer) +{ + int ret; + + /* Submit the DMA Tx transfer */ + ret = phytium_spi_dma_submit_tx(fts, xfer->tx_sg.sgl, xfer->tx_sg.nents); + if (ret) + goto err_clear_dmac; + + /* Submit the DMA Rx transfer if required */ + if (xfer->rx_buf) { + ret = phytium_spi_dma_submit_rx(fts, xfer->rx_sg.sgl, + xfer->rx_sg.nents); + if (ret) + goto err_clear_dmac; + + /* rx must be started before tx due to spi instinct */ + dma_async_issue_pending(fts->rxchan); + } + + dma_async_issue_pending(fts->txchan); + + ret = phytium_spi_dma_wait(fts, xfer->len, xfer->effective_speed_hz); + +err_clear_dmac: + phytium_writel(fts, DMACR, 0); + + return ret; +} + +static int phytium_spi_dma_transfer_one(struct phytium_spi *fts, + struct spi_transfer *xfer) +{ + struct scatterlist *tx_sg = NULL, *rx_sg = NULL, tx_tmp, rx_tmp; + unsigned int tx_len = 0, rx_len = 0; + unsigned int base, len; + int ret; + + sg_init_table(&tx_tmp, 1); + sg_init_table(&rx_tmp, 1); + + for (base = 0, len = 0; base < xfer->len; base += len) { + /* Fetch next Tx DMA data chunk */ + if (!tx_len) { + tx_sg = !tx_sg ? &xfer->tx_sg.sgl[0] : sg_next(tx_sg); + sg_dma_address(&tx_tmp) = sg_dma_address(tx_sg); + tx_len = sg_dma_len(tx_sg); + } + + /* Fetch next Rx DMA data chunk */ + if (!rx_len) { + rx_sg = !rx_sg ? &xfer->rx_sg.sgl[0] : sg_next(rx_sg); + sg_dma_address(&rx_tmp) = sg_dma_address(rx_sg); + rx_len = sg_dma_len(rx_sg); + } + + if ((base + DMA_MAX_BUF_SIZE) > xfer->len) + len = xfer->len - base; + else + len = DMA_MAX_BUF_SIZE; + + len = min3(len, tx_len, rx_len); + + sg_dma_len(&tx_tmp) = len; + sg_dma_len(&rx_tmp) = len; + + /* Submit DMA Tx transfer */ + ret = phytium_spi_dma_submit_tx(fts, &tx_tmp, 1); + if (ret) + break; + + /* Submit DMA Rx transfer */ + ret = phytium_spi_dma_submit_rx(fts, &rx_tmp, 1); + if (ret) + break; + + /* Rx must be started before Tx due to SPI instinct */ + dma_async_issue_pending(fts->rxchan); + + dma_async_issue_pending(fts->txchan); + + /* + * Here we only need to wait for the DMA transfer to be + * finished since SPI controller is kept enabled during the + * procedure this loop implements and there is no risk to lose + * data left in the Tx/Rx FIFOs. + */ + ret = phytium_spi_dma_wait(fts, len, xfer->effective_speed_hz); + if (ret) + break; + + reinit_completion(&fts->dma_completion); + + sg_dma_address(&tx_tmp) += len; + sg_dma_address(&rx_tmp) += len; + tx_len -= len; + rx_len -= len; + } + + phytium_writel(fts, DMACR, 0); + + return ret; +} + +static int phytium_spi_dma_transfer(struct phytium_spi *fts, struct spi_transfer *xfer) +{ + unsigned int nents; + int ret; + + nents = max(xfer->tx_sg.nents, xfer->rx_sg.nents); + + /* + * large transfer length caused spi RX FIFO full event + * transfer 4096 bytes each time + */ + if (xfer->len <= DMA_MAX_BUF_SIZE) + ret = phytium_spi_dma_transfer_all(fts, xfer); + else + ret = phytium_spi_dma_transfer_one(fts, xfer); + if (ret) + return ret; + + if (fts->master->cur_msg->status == -EINPROGRESS) { + ret = phytium_spi_dma_wait_tx_done(fts, xfer); + if (ret) + return ret; + } + + if (xfer->rx_buf && fts->master->cur_msg->status == -EINPROGRESS) + ret = phytium_spi_dma_wait_rx_done(fts); + + return ret; +} + +static void phytium_spi_dma_stop(struct phytium_spi *fts) +{ + if (test_bit(TX_BUSY, &fts->dma_chan_busy)) { + dmaengine_terminate_sync(fts->txchan); + clear_bit(TX_BUSY, &fts->dma_chan_busy); + } + if (test_bit(RX_BUSY, &fts->dma_chan_busy)) { + dmaengine_terminate_sync(fts->rxchan); + clear_bit(RX_BUSY, &fts->dma_chan_busy); + } +} + +static const struct phytium_spi_dma_ops phytium_spi_dma_generic_ops = { + .dma_init = phytium_spi_dma_init, + .dma_exit = phytium_spi_dma_exit, + .dma_setup = phytium_spi_dma_setup, + .can_dma = phytium_spi_can_dma, + .dma_transfer = phytium_spi_dma_transfer, + .dma_stop = phytium_spi_dma_stop, +}; + +void phytium_spi_dmaops_set(struct phytium_spi *fts) +{ + fts->dma_ops = &phytium_spi_dma_generic_ops; +} +EXPORT_SYMBOL_GPL(phytium_spi_dmaops_set); + +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-pci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-pci.c new file mode 100644 index 0000000000000000000000000000000000000000..5bc68634277f3e7036faca9b1b4153e932332141 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-pci.c @@ -0,0 +1,122 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SPI core controller PCI driver. + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "spi-phytium.h" + +#define DRIVER_NAME "phytium_spi_pci" + +static int phytium_spi_pci_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct phytium_spi *fts; + int pci_bar = 0; + int ret; + + fts = devm_kzalloc(&pdev->dev, sizeof(struct phytium_spi), + GFP_KERNEL); + if (!fts) + return -ENOMEM; + + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + ret = pcim_iomap_regions(pdev, 1 << pci_bar, pci_name(pdev)); + if (ret) { + dev_err(&pdev->dev, "pci iomap failed?\n"); + return ret; + } + + fts->regs = pcim_iomap_table(pdev)[pci_bar]; + if (IS_ERR(fts->regs)) { + dev_err(&pdev->dev, "SPI region map failed\n"); + return PTR_ERR(fts->regs); + } + + fts->irq = pdev->irq; + if (fts->irq < 0) { + dev_err(&pdev->dev, "no irq resource?\n"); + return fts->irq; /* -ENXIO */ + } + + fts->bus_num = -1; + + fts->max_freq = 48000000; + + fts->num_cs = 4; + + fts->global_cs = 1; + + ret = phytium_spi_add_host(&pdev->dev, fts); + if (ret) + return ret; + + pci_set_drvdata(pdev, fts); + return 0; +} + +static void phytium_spi_pci_remove(struct pci_dev *pdev) +{ + struct phytium_spi *fts = pci_get_drvdata(pdev); + + phytium_spi_remove_host(fts); +} + + +#ifdef CONFIG_PM_SLEEP +static int spi_suspend(struct device *dev) +{ + struct phytium_spi *fts = dev_get_drvdata(dev); + + return phytium_spi_suspend_host(fts); +} + +static int spi_resume(struct device *dev) +{ + struct phytium_spi *fts = dev_get_drvdata(dev); + + return phytium_spi_resume_host(fts); +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_spi_pm_ops, spi_suspend, spi_resume); + +static const struct pci_device_id phytium_device_pci_tbl[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc2c) }, + {}, +}; + +static struct pci_driver phytium_spi_pci_driver = { + .name = DRIVER_NAME, + .id_table = phytium_device_pci_tbl, + .probe = phytium_spi_pci_probe, + .remove = phytium_spi_pci_remove, + .driver = { + .pm = &phytium_spi_pm_ops, + } +}; + +module_pci_driver(phytium_spi_pci_driver); + +MODULE_AUTHOR("Yiqun Zhang "); +MODULE_DESCRIPTION("PCI Driver for Phytium SPI controller core"); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-plat.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-plat.c new file mode 100644 index 0000000000000000000000000000000000000000..57593cd0e85bd027c16ecea871396c029e24bae3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-plat.c @@ -0,0 +1,204 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SPI core controller platform driver. + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "spi-phytium.h" + +#define DRIVER_NAME "phytium_spi" + +static int phytium_spi_probe(struct platform_device *pdev) +{ + struct phytium_spi *fts; + struct resource *mem; + int ret; + int num_cs; + int cs_gpio; + int global_cs; + int i; + + fts = devm_kzalloc(&pdev->dev, sizeof(struct phytium_spi), + GFP_KERNEL); + if (!fts) + return -ENOMEM; + + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!mem) { + dev_err(&pdev->dev, "no mem resource?\n"); + return -EINVAL; + } + + fts->paddr = mem->start; + fts->regs = devm_ioremap_resource(&pdev->dev, mem); + if (IS_ERR(fts->regs)) { + dev_err(&pdev->dev, "SPI region map failed\n"); + return PTR_ERR(fts->regs); + } + + fts->irq = platform_get_irq(pdev, 0); + if (fts->irq < 0) { + dev_err(&pdev->dev, "no irq resource?\n"); + return fts->irq; /* -ENXIO */ + } + + if (pdev->dev.of_node) { + fts->clk = devm_clk_get(&pdev->dev, NULL); + + if (IS_ERR(fts->clk)) + return PTR_ERR(fts->clk); + ret = clk_prepare_enable(fts->clk); + if (ret) + return ret; + + fts->max_freq = clk_get_rate(fts->clk); + } else if (has_acpi_companion(&pdev->dev)) { + fts->max_freq = 48000000; + } + + fts->bus_num = pdev->id; + device_property_read_u32(&pdev->dev, "reg-io-width", &fts->reg_io_width); + + num_cs = 4; + device_property_read_u32(&pdev->dev, "num-cs", &num_cs); + fts->num_cs = num_cs; + + if (pdev->dev.of_node) { + int i; + + for (i = 0; i < fts->num_cs; i++) { + cs_gpio = of_get_named_gpio(pdev->dev.of_node, + "cs-gpios", i); + + if (cs_gpio == -EPROBE_DEFER) { + ret = cs_gpio; + goto out; + } + + if (gpio_is_valid(cs_gpio)) { + ret = devm_gpio_request(&pdev->dev, cs_gpio, + dev_name(&pdev->dev)); + if (ret) + goto out; + } + } + } else if(has_acpi_companion(&pdev->dev)) { + int n; + int *cs; + struct gpio_desc *gpiod; + + n = gpiod_count(&pdev->dev, "cs"); + + cs = devm_kcalloc(&pdev->dev, n, sizeof(int), GFP_KERNEL); + fts->cs = cs; + + for (i = 0; i < n; i++) { + gpiod = devm_gpiod_get_index_optional(&pdev->dev, "cs", i, + GPIOD_OUT_LOW); + + if (IS_ERR(gpiod)) { + ret = PTR_ERR(gpiod); + goto out; + } + + cs_gpio = desc_to_gpio(gpiod); + cs[i] = cs_gpio; + } + } + + device_property_read_u32(&pdev->dev, "global-cs", &global_cs); + fts->global_cs = global_cs; + + /* check is use dma transfer */ + if ((device_property_read_string_array(&pdev->dev, "dma-names", + NULL, 0) > 0) && + device_property_present(&pdev->dev, "dmas")) { + fts->dma_en = true; + phytium_spi_dmaops_set(fts); + } + + ret = phytium_spi_add_host(&pdev->dev, fts); + if (ret) + goto out; + + platform_set_drvdata(pdev, fts); + return 0; + +out: + clk_disable_unprepare(fts->clk); + return ret; +} + +static int phytium_spi_remove(struct platform_device *pdev) +{ + struct phytium_spi *fts = platform_get_drvdata(pdev); + + phytium_spi_remove_host(fts); + clk_disable_unprepare(fts->clk); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int spi_suspend(struct device *dev) +{ + struct phytium_spi *fts = dev_get_drvdata(dev); + + return phytium_spi_suspend_host(fts); +} + +static int spi_resume(struct device *dev) +{ + struct phytium_spi *fts = dev_get_drvdata(dev); + + return phytium_spi_resume_host(fts); +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_spi_pm_ops, spi_suspend, spi_resume); + +static const struct of_device_id phytium_spi_of_match[] = { + { .compatible = "phytium,spi", .data = (void *)0 }, + { /* end of table */} +}; +MODULE_DEVICE_TABLE(of, phytium_spi_of_match); + +static const struct acpi_device_id phytium_spi_acpi_match[] = { + {"PHYT000E", 0}, + {} +}; +MODULE_DEVICE_TABLE(acpi, phytium_spi_acpi_match); + +static struct platform_driver phytium_spi_driver = { + .probe = phytium_spi_probe, + .remove = phytium_spi_remove, + .driver = { + .name = DRIVER_NAME, + .of_match_table = of_match_ptr(phytium_spi_of_match), + .acpi_match_table = ACPI_PTR(phytium_spi_acpi_match), + .pm = &phytium_spi_pm_ops, + }, +}; +module_platform_driver(phytium_spi_driver); + +MODULE_AUTHOR("Yiqun Zhang "); +MODULE_DESCRIPTION("Platform Driver for Phytium SPI controller core"); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-qspi.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-qspi.c new file mode 100755 index 0000000000000000000000000000000000000000..3ac0baee920c35883a3635ea14918e82f4d2b9e5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium-qspi.c @@ -0,0 +1,801 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium Quad SPI controller driver. + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + + +#define QSPI_FLASH_CAP_REG 0x00 +#define QSPI_FLASH_CAP_NUM_SHIFT 3 +#define QSPI_FLASH_CAP_NUM_MASK (0x3 << QSPI_FLASH_CAP_NUM_SHIFT) +#define QSPI_FLASH_CAP_CAP_SHIFT 0 +#define QSPI_FLASH_CAP_CAP_MASK (0x7 << QSPI_FLASH_CAP_CAP_SHIFT) + +#define QSPI_RD_CFG_REG 0x04 +#define QSPI_RD_CFG_RD_CMD_SHIFT 24 +#define QSPI_RD_CFG_RD_CMD_MASK (0xff << QSPI_RD_CFG_RD_CMD_SHIFT) +#define QSPI_RD_CFG_RD_THROUGH_SHIFT 23 +#define QSPI_RD_CFG_RD_THROUGH_MASK (0x1 << QSPI_RD_CFG_RD_THROUGH_SHIFT) +#define QSPI_RD_CFG_RD_TRANSFER_SHIFT 20 +#define QSPI_RD_CFG_RD_TRANSFER_MASK (0x7 << QSPI_RD_CFG_RD_TRANSFER_SHIFT) +#define QSPI_RD_CFG_RD_ADDR_SEL_SHIFT 19 +#define QSPI_RD_CFG_RD_ADDR_SEL_MASK (0x1 << QSPI_RD_CFG_RD_ADDR_SEL_SHIFT) +#define QSPI_RD_CFG_RD_LATENCY_SHIFT 18 +#define QSPI_RD_CFG_RD_LATENCY_MASK (0x1 << QSPI_RD_CFG_RD_LATENCY_SHIFT) +#define QSPI_RD_CFG_MODE_BYTE_SHIFT 17 +#define QSPI_RD_CFG_MODE_BYTE_MASK (0x1 << QSPI_RD_CFG_MODE_BYTE_SHIFT) +#define QSPI_RD_CFG_CMD_SIGN_SHIFT 9 +#define QSPI_RD_CFG_CMD_SIGN_MASK (0xff << QSPI_RD_CFG_CMD_SIGN_SHIFT) +#define QSPI_RD_CFG_DUMMY_SHIFT 4 +#define QSPI_RD_CFG_DUMMY_MASK (0x1f << QSPI_RD_CFG_DUMMY_SHIFT) +#define QSPI_RD_CFG_D_BUFFER_SHIFT 3 +#define QSPI_RD_CFG_D_BUFFER_MASK (0x1 << QSPI_RD_CFG_D_BUFFER_SHIFT) +#define QSPI_RD_CFG_RD_SCK_SEL_SHIFT 0 +#define QSPI_RD_CFG_RD_SCK_SEL_MASK (0x7 << QSPI_RD_CFG_RD_SCK_SEL_SHIFT) + +#define QSPI_WR_CFG_REG 0x08 +#define QSPI_WR_CFG_WR_CMD_SHIFT 24 +#define QSPI_WR_CFG_WR_CMD_MASK (0xff << QSPI_WR_CFG_WR_CMD_SHIFT) +#define QSPI_WR_CFG_WR_WAIT_SHIFT 9 +#define QSPI_WR_CFG_WR_WAIT_MASK (0x01 << QSPI_WR_CFG_WR_WAIT_SHIFT) +#define QSPI_WR_CFG_WR_THROUGH_SHIFT 8 +#define QSPI_WR_CFG_WR_THROUGH_MASK (0x01 << QSPI_WR_CFG_WR_THROUGH_SHIFT) +#define QSPI_WR_CFG_WR_TRANSFER_SHIFT 5 +#define QSPI_WR_CFG_WR_TRANSFER_MASK (0X7 << QSPI_WR_CFG_WR_TRANSFER_SHIFT) +#define QSPI_WR_CFG_WR_ADDR_SEL_SHIFT 4 +#define QSPI_WR_CFG_WR_ADDR_SEL_MASK (0x1 << QSPI_WR_CFG_WR_ADDR_SEL_SHIFT) +#define QSPI_WR_CFG_WR_MODE_SHIFT 3 +#define QSPI_WR_CFG_WR_MODE_MASK (0x1 << QSPI_WR_CFG_WR_MODE_SHIFT) +#define QSPI_WR_CFG_WR_SCK_SEL_SHIFT 0 +#define QSPI_WR_CFG_WR_SCK_SEL_MASK (0x7 << QSPI_WR_CFG_WR_SCK_SEL_SHIFT) + +#define QSPI_FLUSH_REG 0x0c +#define QSPI_FLUSH_EN (0x1 << 0) + +#define QSPI_CMD_PORT_REG 0x10 +#define QSPI_CMD_PORT_CMD_SHIFT 24 +#define QSPI_CMD_PORT_CMD_MASK (0xff << QSPI_CMD_PORT_CMD_SHIFT) +#define QSPI_CMD_PORT_WAIT_SHIFT 22 +#define QSPI_CMD_PORT_WAIT_MASK (0x1 << QSPI_CMD_PORT_WAIT_SHIFT) +#define QSPI_CMD_PORT_THROUGH_SHIFT 21 +#define QSPI_CMD_PORT_THROUGH_MASK (0x1 << QSPI_CMD_PORT_THROUGH_SHIFT) +#define QSPI_CMD_PORT_CS_SHIFT 19 +#define QSPI_CMD_PORT_CS_MASK (0x3 << QSPI_CMD_PORT_CS_SHIFT) +#define QSPI_CMD_PORT_TRANSFER_SHIFT 16 +#define QSPI_CMD_PORT_TRANSFER_MASK (0x7 << QSPI_CMD_PORT_TRANSFER_SHIFT) +#define QSPI_CMD_PORT_CMD_ADDR_SHIFT 15 +#define QSPI_CMD_PORT_CMD_ADDR_MASK (0x1 << QSPI_CMD_PORT_CMD_ADDR_SHIFT) +#define QSPI_CMD_PORT_LATENCY_SHIFT 14 +#define QSPI_CMD_PORT_LATENCY_MASK (0x1 << QSPI_CMD_PORT_LATENCY_SHIFT) +#define QSPI_CMD_PORT_DATA_XFER_SHIFT 13 +#define QSPI_CMD_PORT_DATA_XFER_MASK (0x1 << QSPI_CMD_PORT_DATA_XFER_SHIFT) +#define QSPI_CMD_PORT_ADDR_SEL_SHIFT 12 +#define QSPI_CMD_PORT_ADDR_SEL_MASK (0x1 << QSPI_CMD_PORT_ADDR_SEL_SHIFT) +#define QSPI_CMD_PORT_DUMMY_SHIFT 7 +#define QSPI_CMD_PORT_DUMMY_MASK (0x1f << QSPI_CMD_PORT_DUMMY_SHIFT) +#define QSPI_CMD_PORT_P_BUFFER_SHIFT 6 +#define QSPI_CMD_PORT_P_BUFFER_MASK (0x1 << QSPI_CMD_PORT_P_BUFFER_SHIFT) +#define QSPI_CMD_PORT_RW_NUM_SHIFT 3 +#define QSPI_CMD_PORT_RW_NUM_MASK (0x7 << QSPI_CMD_PORT_RW_NUM_SHIFT) +#define QSPI_CMD_PORT_SCK_SEL_SHIFT 0 +#define QSPI_CMD_PORT_SCK_SEL_MASK (0x7 << QSPI_CMD_PORT_SCK_SEL_SHIFT) + +#define QSPI_ADDR_PORT_REG 0x14 +#define QSPI_HD_PORT_REG 0x18 +#define QSPI_LD_PORT_REG 0x1c + +#define QSPI_FUN_SET_REG 0x20 +#define QSPI_FUN_SET_HOLD_SHIFT 24 +#define QSPI_FUN_SET_HOLD_MASK (0xff << QSPI_FUN_SET_HOLD_SHIFT) +#define QSPI_FUN_SET_SETUP_SHIFT 16 +#define QSPI_FUN_SET_SETUP_MASK (0xff << QSPI_FUN_SET_SETUP_SHIFT) +#define QSPI_FUN_SET_DELAY_SHIFT 0 +#define QSPI_FUN_SET_DELAY_MASK (0xffff << QSPI_FUN_SET_DELAY_SHIFT) + +#define QSPI_WIP_REG 0x24 +#define QSPI_WIP_W_CMD_SHIFT 24 +#define QSPI_WIP_W_CMD_MASK (0xff << QSPI_WIP_W_CMD_SHIFT) +#define QSPI_WIP_W_TRANSFER_SHIFT 3 +#define QSPI_WIP_W_TRANSFER_MASK (0x3 << QSPI_WIP_W_TRANSFER_SHIFT) +#define QSPI_WIP_W_SCK_SEL_SHIFT 0 +#define QSPI_WIP_W_SCK_SEL_MASK (0x7 << QSPI_WIP_W_SCK_SEL_SHIFT) + +#define QSPI_WP_REG 0x28 +#define QSPI_WP_EN_SHIFT 17 +#define QSPI_WP_EN_MASK (0x1 << QSPI_WP_EN_SHIFT) +#define QSPI_WP_IO2_SHIFT 16 +#define QSPI_WP_IO2_MASK (0x1 << QSPI_WP_IO2_SHIFT) +#define QSPI_WP_HOLD_SHIFT 8 +#define QSPI_WP_HOLD_MASK (0xff << QSPI_WP_HOLD_SHIFT) +#define QSPI_WP_SETUP_SHIFT 0 +#define QSPI_WP_SETUP_MASK (0xff << QSPI_WP_SETUP_SHIFT) + +#define QSPI_MODE_REG 0x2c +#define QSPI_MODE_VALID_SHIFT 8 +#define QSPI_MODE_VALID_MASK (0xff << QSPI_MODE_VALID_SHIFT) +#define QSPI_MODE_SHIFT 0 +#define QSPI_MODE_MASK (0xff << QSPI_MODE_SHIFT) + +#define PHYTIUM_QSPI_MAX_NORCHIP 4 +#define PHYTIUM_QSPI_MAX_MMAP_SZ (SZ_256M * PHYTIUM_QSPI_MAX_NORCHIP) +#define PHYTIUM_QSPI_MAX_XFER_SZ 8 +#define PHYTIUM_QSPI_DEFAULT_SCK_SEL 5 + +#define XFER_PROTO_1_1_1 0x0 +#define XFER_PROTO_1_1_2 0x1 +#define XFER_PROTO_1_1_4 0x2 +#define XFER_PROTO_1_2_2 0x3 +#define XFER_PROTO_1_4_4 0x4 +#define XFER_PROTO_2_2_2 0x5 +#define XFER_PROTO_4_4_4 0x6 + +struct phytium_qspi_flash { + u32 cs; + u32 clk_div; + + void __iomem *base; + resource_size_t size; + struct spi_device *spi; +}; + +struct phytium_qspi { + struct device *dev; + struct spi_controller *ctrl; + + void __iomem *io_base; + void __iomem *mm_base; + resource_size_t mm_size; + resource_size_t used_size; + + struct clk *clk; + u32 clk_rate; + + struct phytium_qspi_flash flash[PHYTIUM_QSPI_MAX_NORCHIP]; + u8 fnum; + bool nodirmap; +}; + +static bool phytium_qspi_check_buswidth(u8 width) +{ + switch (width) { + case 1: + case 2: + case 4: + return 0; + } + + return -ENOTSUPP; +} + +static uint phytium_spi_nor_clac_clk_div(int div) +{ + uint clk_div = 0; + + if (div <= 2) + clk_div = 1; + else if (div <= 4) + clk_div = 2; + else if (div <= 8) + clk_div = 3; + else if (div <= 16) + clk_div = 4; + else if (div <= 32) + clk_div = 5; + else if (div <= 64) + clk_div = 6; + else if (div <= 128) + clk_div = 7; + else + clk_div = 65535; + + return clk_div; +} + +static int phytium_spi_nor_protocol_encode(const struct spi_mem_op *op, u32 *code) +{ + int ret = 0; + + if (op->cmd.buswidth == 1 && + op->addr.buswidth == 1 && + op->data.buswidth == 1) + *code = XFER_PROTO_1_1_1; + else if (op->cmd.buswidth == 1 && + op->addr.buswidth == 1 && + op->data.buswidth == 2) + *code = XFER_PROTO_1_1_2; + else if (op->cmd.buswidth == 1 && + op->addr.buswidth == 1 && + op->data.buswidth == 4) + *code = XFER_PROTO_1_1_4; + else if (op->cmd.buswidth == 1 && + op->addr.buswidth == 2 && + op->data.buswidth == 2) + *code = XFER_PROTO_1_2_2; + else if (op->cmd.buswidth == 1 && + op->addr.buswidth == 4 && + op->data.buswidth == 4) + *code = XFER_PROTO_1_4_4; + else if (op->cmd.buswidth == 2 && + op->addr.buswidth == 2 && + op->data.buswidth == 2) + *code = XFER_PROTO_2_2_2; + else if (op->cmd.buswidth == 4 && + op->addr.buswidth == 4 && + op->data.buswidth == 4) + *code = XFER_PROTO_4_4_4; + else + *code = XFER_PROTO_1_1_1; + + return ret; +} + +static int phytium_qspi_flash_capacity_encode(u32 size, u32 *cap) +{ + int ret = 0; + + switch (size) { + case SZ_4M: + *cap = 0x0; + break; + case SZ_8M: + *cap = 0x1; + break; + case SZ_16M: + *cap = 0x2; + break; + case SZ_32M: + *cap = 0x3; + break; + case SZ_64M: + *cap = 0x4; + break; + case SZ_128M: + *cap = 0x5; + break; + case SZ_256M: + *cap = 0x6; + break; + case SZ_512M: + *cap = 0x7; + break; + default: + ret = -EINVAL; + break; + } + + return ret; +} + +static int phytium_qspi_write_port(struct phytium_qspi *qspi, + const u8 *buf, const size_t len) +{ + u32 bouncebuf[2] = { 0 }; + + if (len > PHYTIUM_QSPI_MAX_XFER_SZ) { + dev_err(qspi->dev, "WRITE data exceeds 8 bytes.\n"); + return -EINVAL; + } + + memcpy(bouncebuf, buf, len); + + if (len > 4) + writel_relaxed(bouncebuf[1], qspi->io_base + QSPI_HD_PORT_REG); + writel_relaxed(bouncebuf[0], qspi->io_base + QSPI_LD_PORT_REG); + + return 0; +} + +static int phytium_qspi_read_port(struct phytium_qspi *qspi, + u8 *buf, size_t len) +{ + u32 bouncebuf[2] = { 0 }; + + if (len > PHYTIUM_QSPI_MAX_XFER_SZ) { + dev_err(qspi->dev, "READ data exceeds 8 bytes.\n"); + return -EINVAL; + } + + /* Dummy write to LD_PORT register and issue READ ops*/ + writel_relaxed(0, qspi->io_base + QSPI_LD_PORT_REG); + + /* Read data */ + bouncebuf[0] = readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); + if (len > 4) + bouncebuf[1] = readl_relaxed(qspi->io_base + QSPI_HD_PORT_REG); + + memcpy(buf, bouncebuf, len); + + return 0; +} + +static int phytium_qspi_adjust_op_size(struct spi_mem *mem, + struct spi_mem_op *op) +{ + if (op->data.nbytes > PHYTIUM_QSPI_MAX_XFER_SZ) + op->data.nbytes = PHYTIUM_QSPI_MAX_XFER_SZ; + + return 0; +} + +static bool phytium_qspi_supports_op(struct spi_mem *mem, + const struct spi_mem_op *op) +{ + int ret; + + ret = phytium_qspi_check_buswidth(op->cmd.buswidth); + + if (op->addr.nbytes) + ret |= phytium_qspi_check_buswidth(op->addr.buswidth); + + if (op->dummy.nbytes) + ret |= phytium_qspi_check_buswidth(op->dummy.buswidth); + + if (op->data.nbytes) + ret |= phytium_qspi_check_buswidth(op->data.buswidth); + + if (ret) + return false; + + /* Max 32 dummy clock cycles supported */ + if (op->dummy.nbytes && + (op->dummy.nbytes * 8 / op->dummy.buswidth > 32)) + return false; + + return spi_mem_default_supports_op(mem, op); +} + +static int phytium_qspi_exec_op(struct spi_mem *mem, + const struct spi_mem_op *op) +{ + struct phytium_qspi *qspi = spi_controller_get_devdata(mem->spi->master); + struct phytium_qspi_flash *flash = &qspi->flash[mem->spi->chip_select]; + u32 cmd, transfer; + int ret; + + dev_dbg(qspi->dev, "cmd:%#x mode: %d.%d.%d.%d addr:%#llx len:%#x\n", + op->cmd.opcode, op->cmd.buswidth, op->addr.buswidth, + op->dummy.buswidth, op->data.buswidth, op->addr.val, + op->data.nbytes); + + cmd = op->cmd.opcode << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + ret = phytium_spi_nor_protocol_encode(op, &transfer); + if (ret) { + dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); + goto out; + } + cmd |= transfer << QSPI_CMD_PORT_TRANSFER_SHIFT; + + if (op->addr.nbytes) { + cmd |= QSPI_CMD_PORT_CMD_ADDR_MASK; + if (op->addr.nbytes == 4) + cmd |= QSPI_CMD_PORT_ADDR_SEL_MASK; + + /* Write target address to ADDR_PORT register */ + writel_relaxed(op->addr.val, qspi->io_base + QSPI_ADDR_PORT_REG); + } + + if (op->dummy.nbytes) { + cmd |= QSPI_CMD_PORT_LATENCY_MASK; + cmd |= ((op->dummy.nbytes * 8) / op->dummy.buswidth) << + QSPI_CMD_PORT_LATENCY_SHIFT; + } + + if (op->data.nbytes) { + cmd |= QSPI_CMD_PORT_DATA_XFER_MASK; + cmd &= ~QSPI_CMD_PORT_P_BUFFER_MASK; + cmd |= (op->data.nbytes-1) << QSPI_CMD_PORT_RW_NUM_SHIFT; + } + + cmd |= flash->clk_div; + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + + if (op->data.dir == SPI_MEM_DATA_IN) { + ret = phytium_qspi_read_port(qspi, op->data.buf.in, op->data.nbytes); + if (ret) { + dev_err(qspi->dev, "Failed to read data from the port.\n"); + goto out; + } + } else if (op->data.dir == SPI_MEM_DATA_OUT) { + ret = phytium_qspi_write_port(qspi, op->data.buf.out, op->data.nbytes); + if (ret) { + dev_err(qspi->dev, "Failed to write data to the port.\n"); + goto out; + } + } else { + /* Dummy write to LD_PORT register and issue the command */ + writel_relaxed(0, qspi->io_base + QSPI_LD_PORT_REG); + } + +out: + return ret; +} + +static int phytium_qspi_dirmap_create(struct spi_mem_dirmap_desc *desc) +{ + struct spi_device *spi = desc->mem->spi; + struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); + struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; + struct spi_nor *nor = spi_mem_get_drvdata(desc->mem); + u32 cmd, transfer; + int ret = 0; + + if (!qspi->mm_base || !qspi->mm_size) { + ret = -EOPNOTSUPP; + goto out; + } + + if (!flash->base) { + flash->base = qspi->mm_base + qspi->used_size; + qspi->used_size += nor->mtd.size; + } + + /* Setup RD/WR_CFG register */ + if (desc->info.op_tmpl.data.dir == SPI_MEM_DATA_IN) { + cmd = desc->info.op_tmpl.cmd.opcode << QSPI_RD_CFG_RD_CMD_SHIFT; + ret = phytium_spi_nor_protocol_encode(&desc->info.op_tmpl, &transfer); + if (ret) { + dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); + goto out; + } + cmd |= transfer << QSPI_RD_CFG_RD_TRANSFER_SHIFT; + + if (desc->info.op_tmpl.addr.nbytes == 4) + cmd |= QSPI_RD_CFG_RD_ADDR_SEL_MASK; + + if (nor->read_dummy) { + cmd |= QSPI_RD_CFG_RD_LATENCY_MASK; + cmd |= (nor->read_dummy - 1) << QSPI_RD_CFG_DUMMY_SHIFT; + } + + cmd |= QSPI_RD_CFG_D_BUFFER_MASK; + cmd |= flash->clk_div & QSPI_RD_CFG_RD_SCK_SEL_MASK; + + writel_relaxed(cmd, qspi->io_base + QSPI_RD_CFG_REG); + + dev_dbg(qspi->dev, "Create read dirmap and setup RD_CFG_REG [%#x].\n", cmd); + } else if (desc->info.op_tmpl.data.dir == SPI_MEM_DATA_OUT) { + cmd = desc->info.op_tmpl.cmd.opcode << QSPI_WR_CFG_WR_CMD_SHIFT; + ret = phytium_spi_nor_protocol_encode(&desc->info.op_tmpl, &transfer); + if (ret) { + dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); + goto out; + } + cmd |= transfer << QSPI_WR_CFG_WR_TRANSFER_SHIFT; + + if (desc->info.op_tmpl.addr.nbytes == 4) + cmd |= QSPI_WR_CFG_WR_ADDR_SEL_MASK; + + cmd |= QSPI_WR_CFG_WR_MODE_MASK; + cmd |= flash->clk_div & QSPI_WR_CFG_WR_SCK_SEL_MASK; + + writel_relaxed(cmd, qspi->io_base + QSPI_WR_CFG_REG); + + dev_dbg(qspi->dev, "Create write dirmap and setup WR_CFG_REG [%#x].\n", cmd); + } else { + ret = -EINVAL; + } + +out: + return ret; +} + +static ssize_t phytium_qspi_dirmap_read(struct spi_mem_dirmap_desc *desc, + u64 offs, size_t len, void *buf) +{ + struct spi_device *spi = desc->mem->spi; + struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); + struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; + + void __iomem *src = flash->base + offs; + u8 *buf_rx = buf; + + memcpy_fromio(buf_rx, src, len); + + return len; +} + +static ssize_t phytium_qspi_dirmap_write(struct spi_mem_dirmap_desc *desc, + u64 offs, size_t len, const void *buf) +{ + struct spi_device *spi = desc->mem->spi; + struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); + struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; + + void __iomem *dst = flash->base + offs; + void __iomem *addr; + int i; + size_t mask = 0x03; + u_char tmp[4] = {0}; + + if (offs & 0x03) { + dev_err(qspi->dev, "Addr not four-byte aligned!\n"); + return -EINVAL; + } + + for (i = 0; i < len / 4; i++) + writel_relaxed(*(u32 *)(buf + 4 * i), dst + 4 * i); + + if (len & mask) { + addr = dst + (len & ~mask); + memcpy(tmp, buf + (len & ~mask), len & mask); + writel_relaxed(*(u32 *)(tmp), addr); + } + + //write cache data to flash + writel_relaxed(QSPI_FLUSH_EN, qspi->io_base + QSPI_FLUSH_REG); + + return len; +} + +static int phytium_qspi_setup(struct spi_device *spi) +{ + struct spi_controller *ctrl = spi->master; + struct phytium_qspi *qspi = spi_controller_get_devdata(ctrl); + struct phytium_qspi_flash *flash; + uint clk_div; + + if (ctrl->busy) + return -EBUSY; + + flash = &qspi->flash[spi->chip_select]; + + flash->cs = spi->chip_select; + flash->spi = spi; + if (flash->cs >= PHYTIUM_QSPI_MAX_NORCHIP) { + dev_err(qspi->dev, "Flash CS is out of range.\n"); + return -EINVAL; + } + qspi->fnum++; + + + if (spi->max_speed_hz) { + clk_div = DIV_ROUND_UP(qspi->clk_rate, spi->max_speed_hz); + flash->clk_div = phytium_spi_nor_clac_clk_div(clk_div); + if (flash->clk_div == 65535) { + dev_err(qspi->dev, "qspi maximum frequency setting is error.\n"); + return -EINVAL; + } + } else + flash->clk_div = PHYTIUM_QSPI_DEFAULT_SCK_SEL; + + return 0; +} + +static struct spi_controller_mem_ops phytium_qspi_mem_ops = { + .adjust_op_size = phytium_qspi_adjust_op_size, + .supports_op = phytium_qspi_supports_op, + .exec_op = phytium_qspi_exec_op, + .dirmap_create = phytium_qspi_dirmap_create, + .dirmap_read = phytium_qspi_dirmap_read, + .dirmap_write = phytium_qspi_dirmap_write, +}; + +/** + * Direct mapping is supported only when all flashes under the controller + * are of the same size and the mapping address is continuous. For those + * cases which flashes are of different sizes, the driver offered a non-dirmap + * mem_ops with which read/write ops is executed through command port. + */ +static struct spi_controller_mem_ops phytium_qspi_mem_ops_nodirmap = { + .adjust_op_size = phytium_qspi_adjust_op_size, + .supports_op = phytium_qspi_supports_op, + .exec_op = phytium_qspi_exec_op, +}; + +/** + * phytium_qspi_probe - Probe method for the QSPI driver + * @pdev: Pointer to the platform_device structure + * + * This function initializes the driver data structures and the hardware. + * + * Return: 0 on success and error value on failure + */ +static int phytium_qspi_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct spi_controller *ctrl; + struct resource *res; + struct phytium_qspi *qspi; + int i, ret; + u32 flash_cap; + struct spi_mem *mem; + struct spi_nor *nor; + + ctrl = spi_alloc_master(dev, sizeof(*qspi)); + if (!ctrl) + return -ENOMEM; + + ctrl->mode_bits = SPI_CPOL | SPI_CPHA | + SPI_RX_DUAL | SPI_RX_QUAD | + SPI_TX_DUAL | SPI_TX_QUAD; + ctrl->setup = phytium_qspi_setup; + ctrl->num_chipselect = PHYTIUM_QSPI_MAX_NORCHIP; + ctrl->dev.of_node = dev->of_node; + + qspi = spi_controller_get_devdata(ctrl); + qspi->ctrl = ctrl; + + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi"); + qspi->io_base = devm_ioremap_resource(dev, res); + if (IS_ERR(qspi->io_base)) { + ret = PTR_ERR(qspi->io_base); + goto probe_master_put; + } + + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi_mm"); + qspi->mm_base = devm_ioremap_resource(dev, res); + if (IS_ERR(qspi->mm_base)) { + ret = PTR_ERR(qspi->mm_base); + goto probe_master_put; + } + + qspi->mm_size = resource_size(res); + if (qspi->mm_size > PHYTIUM_QSPI_MAX_MMAP_SZ) { + ret = -EINVAL; + goto probe_master_put; + } + qspi->used_size = 0; + + qspi->clk = devm_clk_get(dev, NULL); + if (IS_ERR(qspi->clk)) { + ret = PTR_ERR(qspi->clk); + goto probe_master_put; + } + + qspi->clk_rate = clk_get_rate(qspi->clk); + if (!qspi->clk_rate) { + ret = -EINVAL; + goto probe_master_put; + } + + pm_runtime_enable(dev); + ret = pm_runtime_get_sync(dev); + if (ret < 0) { + pm_runtime_put_noidle(dev); + goto probe_master_put; + } + + ret = clk_prepare_enable(qspi->clk); + if (ret) { + dev_err(dev, "Failed to enable PCLK of the controller.\n"); + goto probe_clk_failed; + } + + qspi->nodirmap = device_property_present(dev, "no-direct-mapping"); + ctrl->mem_ops = qspi->nodirmap ? + &phytium_qspi_mem_ops_nodirmap : + &phytium_qspi_mem_ops; + + qspi->dev = dev; + platform_set_drvdata(pdev, qspi); + + ret = devm_spi_register_controller(dev, ctrl); + if (ret) { + dev_err(dev, "failed to register SPI controller: %d\n", ret); + goto probe_setup_failed; + } + + if (!qspi->nodirmap) { + /* + * The controller supports direct mapping access only if all + * flashes are of same size. + */ + + i = 0; + for (i = 0; qspi->fnum > i && i < PHYTIUM_QSPI_MAX_NORCHIP; i++) { + if (qspi->flash[i].spi) { + mem = spi_get_drvdata(qspi->flash[i].spi); + if (mem) { + nor = spi_mem_get_drvdata(mem); + if (nor) + qspi->flash[i].size = nor->mtd.size; + } + } + } + + for (i = 1; qspi->fnum > i && i < PHYTIUM_QSPI_MAX_NORCHIP; i++) { + if (qspi->flash[i].size != qspi->flash[0].size) { + dev_err(dev, "Flashes are of different sizes.\n"); + ret = -EINVAL; + goto probe_setup_failed; + } + } + + ret = phytium_qspi_flash_capacity_encode(qspi->flash[0].size, + &flash_cap); + if (ret) { + dev_err(dev, "Flash size is invalid.\n"); + goto probe_setup_failed; + } + + flash_cap |= qspi->fnum << QSPI_FLASH_CAP_NUM_SHIFT; + + writel_relaxed(flash_cap, qspi->io_base + QSPI_FLASH_CAP_REG); + } + + return 0; + +probe_setup_failed: + clk_disable_unprepare(qspi->clk); +probe_clk_failed: + pm_runtime_put_sync(dev); + pm_runtime_disable(dev); +probe_master_put: + + return ret; +} + +/** + * phytium_qspi_remove - Remove method for the QSPI driver + * @pdev: Pointer to the platform_device structure + * + * This function is called if a device is physically removed from the system + * or if the driver module is being unloaded. It free all resources allocated + * to the device. + * + * Return: 0 on success and error value on failure + */ +static int phytium_qspi_remove(struct platform_device *pdev) +{ + struct phytium_qspi *qspi = platform_get_drvdata(pdev); + + clk_disable_unprepare(qspi->clk); + + pm_runtime_put_sync(&pdev->dev); + pm_runtime_disable(&pdev->dev); + + return 0; +} + +static int __maybe_unused phytium_qspi_suspend(struct device *dev) +{ + return pm_runtime_force_suspend(dev); +} + +static int __maybe_unused phytium_qspi_resume(struct device *dev) +{ + return pm_runtime_force_resume(dev); +} + +static const struct dev_pm_ops phytium_qspi_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_qspi_suspend, + phytium_qspi_resume) +}; + +static const struct of_device_id phytium_qspi_of_match[] = { + { .compatible = "phytium,qspi-nor" }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_qspi_of_match); + +static struct platform_driver phytium_qspi_driver = { + .probe = phytium_qspi_probe, + .remove = phytium_qspi_remove, + .driver = { + .name = "phytium-qspi", + .of_match_table = of_match_ptr(phytium_qspi_of_match), + .pm = &phytium_qspi_pm_ops, + }, +}; +module_platform_driver(phytium_qspi_driver); + +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium Quad SPI driver"); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium.c new file mode 100644 index 0000000000000000000000000000000000000000..4fae2cd2cac1c9b56a0fb56490c4d62b001f613f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium.c @@ -0,0 +1,509 @@ + // SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SPI core controller driver. + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "spi-phytium.h" + +struct phytium_spi_chip { + u8 poll_mode; + u8 type; + void (*cs_control)(u32 command); +}; + +struct chip_data { + u8 cs; + u8 tmode; + u8 type; + + u8 poll_mode; + + u16 clk_div; + u32 speed_hz; + void (*cs_control)(u32 command); +}; + +static void phytium_spi_set_cs(struct spi_device *spi, bool enable) +{ + struct phytium_spi *fts = spi_master_get_devdata(spi->master); + struct chip_data *chip = spi_get_ctldata(spi); + u32 origin; + + if (chip && chip->cs_control) + chip->cs_control(!enable); + + if (!enable) { + phytium_writel(fts, SER, BIT(spi->chip_select)); + if (fts->global_cs) { + origin = phytium_readl(fts, GCSR); + phytium_writel(fts, GCSR, origin | (1 << spi->chip_select)); + } + } else { + if (fts->global_cs) { + origin = phytium_readl(fts, GCSR); + phytium_writel(fts, GCSR, origin & ~(1 << spi->chip_select)); + } + } +} + +static inline u32 tx_max(struct phytium_spi *fts) +{ + u32 tx_left, tx_room, rxtx_gap; + + tx_left = (fts->tx_end - fts->tx) / fts->n_bytes; + tx_room = fts->fifo_len - phytium_readl(fts, TXFLR); + + rxtx_gap = ((fts->rx_end - fts->rx) - (fts->tx_end - fts->tx)) + / fts->n_bytes; + + return min3(tx_left, tx_room, (u32) (fts->fifo_len - rxtx_gap)); +} + +static inline u32 rx_max(struct phytium_spi *fts) +{ + u32 rx_left = (fts->rx_end - fts->rx) / fts->n_bytes; + + return min_t(u32, rx_left, phytium_readl(fts, RXFLR)); +} + +static void phytium_writer(struct phytium_spi *fts) +{ + u32 max = tx_max(fts); + u16 txw = 0; + + while (max--) { + if (fts->tx_end - fts->len) { + if (fts->n_bytes == 1) + txw = *(u8 *)(fts->tx); + else + txw = *(u16 *)(fts->tx); + } + phytium_write_io_reg(fts, DR, txw); + fts->tx += fts->n_bytes; + } +} + +static void phytium_reader(struct phytium_spi *fts) +{ + u32 max = rx_max(fts); + u16 rxw; + + while (max--) { + rxw = phytium_read_io_reg(fts, DR); + if (fts->rx_end - fts->len) { + if (fts->n_bytes == 1) + *(u8 *)(fts->rx) = rxw; + else + *(u16 *)(fts->rx) = rxw; + } + fts->rx += fts->n_bytes; + } +} + +int phytium_spi_check_status(struct phytium_spi *fts, bool raw) +{ + u32 irq_status; + int ret = 0; + + if (raw) + irq_status = phytium_readl(fts, RISR); + else + irq_status = phytium_readl(fts, ISR); + + if (irq_status & INT_RXOI) { + dev_err(&fts->master->dev, "RX FIFO overflow detected\n"); + ret = -EIO; + } + + if (irq_status & INT_RXUI) { + dev_err(&fts->master->dev, "RX FIFO underflow detected\n"); + ret = -EIO; + } + + if (irq_status & INT_TXOI) { + dev_err(&fts->master->dev, "TX FIFO overflow detected\n"); + ret = -EIO; + } + + /* Generically handle the erroneous situation */ + if (ret) { + spi_reset_chip(fts); + if (fts->master->cur_msg) + fts->master->cur_msg->status = ret; + } + + return ret; +} +EXPORT_SYMBOL_GPL(phytium_spi_check_status); + +static void int_error_stop(struct phytium_spi *fts, const char *msg) +{ + spi_reset_chip(fts); + + dev_err(&fts->master->dev, "%s\n", msg); + fts->master->cur_msg->status = -EIO; + spi_finalize_current_transfer(fts->master); +} + +static irqreturn_t interrupt_transfer(struct phytium_spi *fts) +{ + u16 irq_status = phytium_readl(fts, ISR); + + if (irq_status & (INT_TXOI | INT_RXOI | INT_RXUI)) { + phytium_readl(fts, ICR); + int_error_stop(fts, "interrupt_transfer: fifo overrun/underrun"); + return IRQ_HANDLED; + } + + phytium_reader(fts); + if (fts->rx_end == fts->rx) { + spi_mask_intr(fts, INT_TXEI); + spi_finalize_current_transfer(fts->master); + return IRQ_HANDLED; + } + if (irq_status & INT_TXEI) { + spi_mask_intr(fts, INT_TXEI); + phytium_writer(fts); + spi_umask_intr(fts, INT_TXEI); + } + + return IRQ_HANDLED; +} + +static irqreturn_t phytium_spi_irq(int irq, void *dev_id) +{ + struct spi_master *master = dev_id; + struct phytium_spi *fts = spi_master_get_devdata(master); + u16 irq_status = phytium_readl(fts, ISR) & 0x3f; + + if (!irq_status) + return IRQ_NONE; + + if (!master->cur_msg) { + spi_mask_intr(fts, INT_TXEI); + return IRQ_HANDLED; + } + + if (fts->transfer_handler) + return fts->transfer_handler(fts); + else + return IRQ_HANDLED; +} + +static int poll_transfer(struct phytium_spi *fts) +{ + do { + phytium_writer(fts); + phytium_reader(fts); + cpu_relax(); + } while (fts->rx_end > fts->rx); + + return 0; +} + +static int phytium_spi_transfer_one(struct spi_master *master, + struct spi_device *spi, struct spi_transfer *transfer) +{ + struct phytium_spi *fts = spi_master_get_devdata(master); + struct chip_data *chip = spi_get_ctldata(spi); + u8 imask = 0; + u16 txlevel = 0; + u16 clk_div; + u32 cr0; + int ret = 0; + + fts->dma_mapped = 0; + fts->tx = (void *)transfer->tx_buf; + fts->tx_end = fts->tx + transfer->len; + fts->rx = transfer->rx_buf; + fts->rx_end = fts->rx + transfer->len; + fts->len = transfer->len; + + spi_enable_chip(fts, 0); + + if (transfer->speed_hz != fts->current_freq) { + if (transfer->speed_hz != chip->speed_hz) { + clk_div = (fts->max_freq / transfer->speed_hz + 1) & + 0xfffe; + + chip->speed_hz = transfer->speed_hz; + chip->clk_div = clk_div; + } + fts->current_freq = transfer->speed_hz; + spi_set_clk(fts, chip->clk_div); + } + + if (transfer->bits_per_word == 8) { + fts->n_bytes = 1; + } else if (transfer->bits_per_word == 16) { + fts->n_bytes = 2; + } else { + return -EINVAL; + } + + cr0 = (transfer->bits_per_word - 1) + | (chip->type << FRF_OFFSET) + | (spi->mode << MODE_OFFSET) + | (chip->tmode << TMOD_OFFSET); + + if (chip->cs_control) { + if (fts->rx && fts->tx) + chip->tmode = TMOD_TR; + else if (fts->rx) + chip->tmode = TMOD_RO; + else + chip->tmode = TMOD_TO; + + cr0 &= ~TMOD_MASK; + cr0 |= (chip->tmode << TMOD_OFFSET); + } + + phytium_writel(fts, CTRLR0, cr0); + + /* check if current transfer is a DMA transcation */ + if (master->can_dma && master->can_dma(master, spi, transfer)) + fts->dma_mapped = master->cur_msg_mapped; + + spi_mask_intr(fts, 0xff); + + /* DMA setup */ + if (fts->dma_mapped) { + ret = fts->dma_ops->dma_setup(fts, transfer); + if (ret) + return ret; + } + + /* interrupt transfer mode setup */ + if (!chip->poll_mode && !fts->dma_mapped) { + txlevel = min_t(u16, fts->fifo_len / 2, fts->len / fts->n_bytes); + phytium_writel(fts, TXFLTR, txlevel); + + imask |= INT_TXEI | INT_TXOI | + INT_RXUI | INT_RXOI; + spi_umask_intr(fts, imask); + + fts->transfer_handler = interrupt_transfer; + } + + spi_enable_chip(fts, 1); + + if (fts->dma_mapped) + return fts->dma_ops->dma_transfer(fts, transfer); + + if (chip->poll_mode) + return poll_transfer(fts); + + return 1; +} + +static void phytium_spi_handle_err(struct spi_master *master, + struct spi_message *msg) +{ + struct phytium_spi *fts = spi_master_get_devdata(master); + + if (fts->dma_mapped) + fts->dma_ops->dma_stop(fts); + + spi_reset_chip(fts); +} + +static int phytium_spi_setup(struct spi_device *spi) +{ + struct phytium_spi_chip *chip_info = NULL; + struct chip_data *chip; + struct spi_master *master = spi->master; + struct phytium_spi *fts = spi_master_get_devdata(master); + int ret; + u32 cr0; + + spi_enable_chip(fts, 0); + + chip = spi_get_ctldata(spi); + if (!chip) { + chip = kzalloc(sizeof(struct chip_data), GFP_KERNEL); + if (!chip) + return -ENOMEM; + spi_set_ctldata(spi, chip); + } + + chip_info = spi->controller_data; + + if (chip_info) { + if (chip_info->cs_control) + chip->cs_control = chip_info->cs_control; + + chip->poll_mode = chip_info->poll_mode; + chip->type = chip_info->type; + } + + chip->tmode = 0; + + cr0 = (spi->bits_per_word - 1) | (chip->type << FRF_OFFSET) | + (spi->mode << MODE_OFFSET) | (chip->tmode << TMOD_OFFSET); + + phytium_writel(fts, CTRLR0, cr0); + + if (gpio_is_valid(spi->cs_gpio)) { + ret = gpio_direction_output(spi->cs_gpio, + !(spi->mode & SPI_CS_HIGH)); + if (ret) + return ret; + } + + spi_enable_chip(fts, 1); + + return 0; +} + +static void phytium_spi_cleanup(struct spi_device *spi) +{ + struct chip_data *chip = spi_get_ctldata(spi); + + kfree(chip); + spi_set_ctldata(spi, NULL); +} + +static void spi_hw_init(struct device *dev, struct phytium_spi *fts) +{ + spi_reset_chip(fts); + + if (!fts->fifo_len) { + u32 fifo; + + for (fifo = 1; fifo < 256; fifo++) { + phytium_writel(fts, TXFLTR, fifo); + if (fifo != phytium_readl(fts, TXFLTR)) + break; + } + phytium_writel(fts, TXFLTR, 0); + + fts->fifo_len = (fifo == 1) ? 0 : fifo; + dev_dbg(dev, "Detected FIFO size: %u bytes\n", fts->fifo_len); + } +} + +int phytium_spi_add_host(struct device *dev, struct phytium_spi *fts) +{ + struct spi_master *master; + int ret; + + BUG_ON(fts == NULL); + + master = spi_alloc_master(dev, 0); + if (!master) + return -ENOMEM; + + fts->master = master; + fts->dma_addr = (dma_addr_t)(fts->paddr + DR); + snprintf(fts->name, sizeof(fts->name), "phytium_spi%d", fts->bus_num); + + spi_hw_init(dev, fts); + + ret = request_irq(fts->irq, phytium_spi_irq, IRQF_SHARED, fts->name, master); + if (ret < 0) { + dev_err(dev, "can not get IRQ\n"); + goto err_free_master; + } + + master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_LOOP; + master->bits_per_word_mask = SPI_BPW_MASK(8) | SPI_BPW_MASK(16); + master->bus_num = fts->bus_num; + master->num_chipselect = fts->num_cs; + master->setup = phytium_spi_setup; + master->cleanup = phytium_spi_cleanup; + master->set_cs = phytium_spi_set_cs; + master->transfer_one = phytium_spi_transfer_one; + master->handle_err = phytium_spi_handle_err; + master->max_speed_hz = fts->max_freq; + master->dev.of_node = dev->of_node; + master->dev.fwnode = dev->fwnode; + master->flags = SPI_MASTER_GPIO_SS; + master->cs_gpios = fts->cs; + + if (fts->dma_ops && fts->dma_ops->dma_init) { + ret = fts->dma_ops->dma_init(dev, fts); + if (ret) { + dev_warn(dev, "DMA init failed\n"); + } else { + master->can_dma = fts->dma_ops->can_dma; + master->flags |= SPI_CONTROLLER_MUST_TX; + } + } + + spi_master_set_devdata(master, fts); + ret = devm_spi_register_master(dev, master); + if (ret) { + dev_err(&master->dev, "problem registering spi master\n"); + goto err_exit; + } + + return 0; + +err_exit: + if (fts->dma_ops && fts->dma_ops->dma_exit) + fts->dma_ops->dma_exit(fts); + spi_enable_chip(fts, 0); + free_irq(fts->irq, master); +err_free_master: + spi_master_put(master); + return ret; +} +EXPORT_SYMBOL_GPL(phytium_spi_add_host); + +void phytium_spi_remove_host(struct phytium_spi *fts) +{ + if (fts->dma_ops && fts->dma_ops->dma_exit) + fts->dma_ops->dma_exit(fts); + spi_shutdown_chip(fts); + + free_irq(fts->irq, fts->master); +} +EXPORT_SYMBOL_GPL(phytium_spi_remove_host); + +int phytium_spi_suspend_host(struct phytium_spi *fts) +{ + int ret; + + ret = spi_controller_suspend(fts->master); + if (ret) + return ret; + + spi_shutdown_chip(fts); + return 0; +} +EXPORT_SYMBOL_GPL(phytium_spi_suspend_host); + +int phytium_spi_resume_host(struct phytium_spi *fts) +{ + int ret; + + spi_hw_init(&fts->master->dev, fts); + ret = spi_controller_resume(fts->master); + if (ret) + dev_err(&fts->master->dev, "fail to start queue (%d)\n", ret); + return ret; +} +EXPORT_SYMBOL_GPL(phytium_spi_resume_host); + +MODULE_AUTHOR("Zhu Mingshuai "); +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Driver for Phytium SPI controller core"); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium.h new file mode 100644 index 0000000000000000000000000000000000000000..003b08f8c5068c1deb00ba56e858881702945f0b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/spi/spi-phytium.h @@ -0,0 +1,213 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +#ifndef PHYTIUM_SPI_HEADER_H +#define PHYTIUM_SPI_HEADER_H + +#include +#include +#include + +#define CTRLR0 0x00 +#define SSIENR 0x08 +#define SER 0x10 +#define BAUDR 0x14 +#define TXFLTR 0x18 +#define TXFLR 0x20 +#define RXFLR 0x24 +#define SR 0x28 +#define IMR 0x2c +#define ISR 0x30 +#define RISR 0x34 +#define ICR 0x48 +#define DMACR 0x4C +#define DMATDLR 0x50 +#define DMARDLR 0x54 +#define DR 0x60 +#define GCSR 0x100 + +#define FRF_OFFSET 4 +#define MODE_OFFSET 6 +#define TMOD_OFFSET 8 + +#define TMOD_MASK (0x3 << TMOD_OFFSET) +#define TMOD_TR 0x0 +#define TMOD_TO 0x1 +#define TMOD_RO 0x2 + +#define INT_TXEI (1 << 0) +#define INT_TXOI (1 << 1) +#define INT_RXUI (1 << 2) +#define INT_RXOI (1 << 3) + +/* Bit fields in SR, 7 bits */ +#define SR_MASK 0x7f /* cover 7 bits */ +#define SR_BUSY (1 << 0) +#define SR_TF_NOT_FULL (1 << 1) +#define SR_TF_EMPT (1 << 2) +#define SR_RF_NOT_EMPT (1 << 3) +#define SR_RF_FULL (1 << 4) +#define SR_TX_ERR (1 << 5) +#define SR_DCOL (1 << 6) + +/* Bit fields in DMACR */ +#define SPI_DMA_RDMAE (1 << 0) +#define SPI_DMA_TDMAE (1 << 1) + +#define SPI_WAIT_RETRIES 5 + +struct phytium_spi; + +struct phytium_spi_dma_ops { + int (*dma_init)(struct device *dev, struct phytium_spi *fts); + void (*dma_exit)(struct phytium_spi *fts); + int (*dma_setup)(struct phytium_spi *fts, struct spi_transfer *xfer); + bool (*can_dma)(struct spi_controller *master, struct spi_device *spi, + struct spi_transfer *xfer); + int (*dma_transfer)(struct phytium_spi *fts, struct spi_transfer *xfer); + void (*dma_stop)(struct phytium_spi *fts); +}; + +struct phytium_spi { + struct spi_master *master; + char name[16]; + + void __iomem *regs; + bool global_cs; + bool dma_en; + unsigned long paddr; + int irq; + u32 fifo_len; + u32 max_freq; + + u32 reg_io_width; + u16 bus_num; + u16 num_cs; + int *cs; + + size_t len; + void *tx; + void *tx_end; + void *rx; + void *rx_end; + u8 n_bytes; + int dma_mapped; + struct clk *clk; + irqreturn_t (*transfer_handler)(struct phytium_spi *fts); + u32 current_freq; /* frequency in hz */ + + /* DMA info */ + struct dma_chan *txchan; + u32 txburst; + struct dma_chan *rxchan; + u32 rxburst; + u32 dma_sg_burst; + unsigned long dma_chan_busy; + dma_addr_t dma_addr; /* phy address of the Data register */ + const struct phytium_spi_dma_ops *dma_ops; + struct completion dma_completion; +}; + +static inline u32 phytium_readl(struct phytium_spi *fts, u32 offset) +{ + return __raw_readl(fts->regs + offset); +} + +static inline u16 phytium_readw(struct phytium_spi *fts, u32 offset) +{ + return __raw_readw(fts->regs + offset); +} + +static inline void phytium_writel(struct phytium_spi *fts, u32 offset, u32 val) +{ + __raw_writel(val, fts->regs + offset); +} + +static inline void phytium_writew(struct phytium_spi *fts, u32 offset, u16 val) +{ + __raw_writew(val, fts->regs + offset); +} + +static inline u32 phytium_read_io_reg(struct phytium_spi *fts, u32 offset) +{ + switch (fts->reg_io_width) { + case 2: + return phytium_readw(fts, offset); + case 4: + default: + return phytium_readl(fts, offset); + } +} + +static inline void phytium_write_io_reg(struct phytium_spi *fts, u32 offset, u32 val) +{ + switch (fts->reg_io_width) { + case 2: + phytium_writew(fts, offset, val); + break; + case 4: + default: + phytium_writel(fts, offset, val); + break; + } +} + +static inline void spi_enable_chip(struct phytium_spi *fts, int enable) +{ + phytium_writel(fts, SSIENR, (enable ? 1 : 0)); +} + +static inline void spi_set_clk(struct phytium_spi *fts, u16 div) +{ + phytium_writel(fts, BAUDR, div); +} + +static inline void spi_mask_intr(struct phytium_spi *fts, u32 mask) +{ + u32 new_mask; + + new_mask = phytium_readl(fts, IMR) & ~mask; + phytium_writel(fts, IMR, new_mask); +} + +static inline void spi_umask_intr(struct phytium_spi *fts, u32 mask) +{ + u32 new_mask; + + new_mask = phytium_readl(fts, IMR) | mask; + phytium_writel(fts, IMR, new_mask); +} + +static inline void spi_global_cs(struct phytium_spi *fts) +{ + u32 global_cs_en, mask, setmask; + + mask = GENMASK(fts->num_cs-1, 0) << fts->num_cs; + setmask = ~GENMASK(fts->num_cs-1, 0); + global_cs_en = (phytium_readl(fts, GCSR) | mask) & setmask; + + phytium_writel(fts, GCSR, global_cs_en); +} + +static inline void spi_reset_chip(struct phytium_spi *fts) +{ + spi_enable_chip(fts, 0); + if (fts->global_cs) + spi_global_cs(fts); + spi_mask_intr(fts, 0xff); + spi_enable_chip(fts, 1); +} + +static inline void spi_shutdown_chip(struct phytium_spi *fts) +{ + spi_enable_chip(fts, 0); + spi_set_clk(fts, 0); + fts->current_freq = 0; +} + +extern int phytium_spi_add_host(struct device *dev, struct phytium_spi *fts); +extern void phytium_spi_remove_host(struct phytium_spi *fts); +extern int phytium_spi_suspend_host(struct phytium_spi *fts); +extern int phytium_spi_resume_host(struct phytium_spi *fts); +extern void phytium_spi_dmaops_set(struct phytium_spi *fts); +extern int phytium_spi_check_status(struct phytium_spi *fts, bool raw); + +#endif /* PHYTIUM_SPI_HEADER_H */ diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/tty/serial/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/tty/serial/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..faf0ce58dd076efb84447f13dac241afbf6b5ff4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/tty/serial/Kconfig @@ -0,0 +1,12 @@ +config SERIAL_PHYTIUM_PCI + tristate "Phytium PCI serial port support" + depends on PCI + select SERIAL_CORE + help + This driver supports the Phytium UART controller on PCI/PCIe adapters. + If you want to compile this driver into the kernel, say Y here. To + compile this driver as a module, choose M here. + + If unsure, say N. + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/tty/serial/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/tty/serial/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..766f23a0295bb1a03dbc3d866970b7ba50830220 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/tty/serial/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_SERIAL_PHYTIUM_PCI) += phytium-uart.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/tty/serial/phytium-uart.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/tty/serial/phytium-uart.c new file mode 100644 index 0000000000000000000000000000000000000000..928126888c926357f17ee1982f03817beed36ca8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/tty/serial/phytium-uart.c @@ -0,0 +1,922 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for Phytium PCI UART controller + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define DRV_NAME "phytium_uart" + +#define REG_DR 0x00 +#define REG_FR 0x18 +#define REG_IBRD 0x24 +#define REG_FBRD 0x28 +#define REG_LCRH_RX 0x2c +#define REG_LCRH_TX 0x2c +#define REG_CR 0x30 +#define REG_IFLS 0x34 +#define REG_IMSC 0x38 +#define REG_RIS 0x3c +#define REG_MIS 0x40 +#define REG_ICR 0x44 + +#define REG_DR_OE (1 << 11) +#define REG_DR_BE (1 << 10) +#define REG_DR_PE (1 << 9) +#define REG_DR_FE (1 << 8) + +#define REG_LCRH_SPS 0x80 +#define REG_LCRH_WLEN_8 0x60 +#define REG_LCRH_WLEN_7 0x40 +#define REG_LCRH_WLEN_6 0x20 +#define REG_LCRH_WLEN_5 0x00 +#define REG_LCRH_FEN 0x10 +#define REG_LCRH_STP2 0x08 +#define REG_LCRH_EPS 0x04 +#define REG_LCRH_PEN 0x02 +#define REG_LCRH_BRK 0x01 + +#define REG_FR_RI 0x100 +#define REG_FR_TXFE 0x080 +#define REG_FR_RXFF 0x040 +#define REG_FR_TXFF 0x020 +#define REG_FR_RXFE 0x010 +#define REG_FR_BUSY 0x008 +#define REG_FR_DCD 0x004 +#define REG_FR_DSR 0x002 +#define REG_FR_CTS 0x001 +#define REG_FR_TMSK (REG_FR_TXFF + REG_FR_BUSY) + +#define REG_CR_CTSEN 0x8000 /* CTS hardware flow control */ +#define REG_CR_RTSEN 0x4000 /* RTS hardware flow control */ +#define REG_CR_OUT2 0x2000 /* OUT2 */ +#define REG_CR_OUT1 0x1000 /* OUT1 */ +#define REG_CR_RTS 0x0800 /* RTS */ +#define REG_CR_DTR 0x0400 /* DTR */ +#define REG_CR_RXE 0x0200 /* receive enable */ +#define REG_CR_TXE 0x0100 /* transmit enable */ +#define REG_CR_LBE 0x0080 /* loopback enable */ +#define REG_CR_RTIE 0x0040 +#define REG_CR_TIE 0x0020 +#define REG_CR_RIE 0x0010 +#define REG_CR_MSIE 0x0008 +#define REG_CR_IIRLP 0x0004 /* SIR low power mode */ +#define REG_CR_SIREN 0x0002 /* SIR enable */ +#define REG_CR_UARTEN 0x0001 /* UART enable */ + +#define REG_IFLS_RX1_8 (0 << 3) +#define REG_IFLS_RX2_8 (1 << 3) +#define REG_IFLS_RX4_8 (2 << 3) +#define REG_IFLS_RX6_8 (3 << 3) +#define REG_IFLS_RX7_8 (4 << 3) +#define REG_IFLS_TX1_8 (0 << 0) +#define REG_IFLS_TX2_8 (1 << 0) +#define REG_IFLS_TX4_8 (2 << 0) +#define REG_IFLS_TX6_8 (3 << 0) + +#define REG_IMSC_OEIM (1 << 10) /* overrun error interrupt mask */ +#define REG_IMSC_BEIM (1 << 9) /* break error interrupt mask */ +#define REG_IMSC_PEIM (1 << 8) /* parity error interrupt mask */ +#define REG_IMSC_FEIM (1 << 7) /* framing error interrupt mask */ +#define REG_IMSC_RTIM (1 << 6) /* receive timeout interrupt mask */ +#define REG_IMSC_TXIM (1 << 5) /* transmit interrupt mask */ +#define REG_IMSC_RXIM (1 << 4) /* receive interrupt mask */ +#define REG_IMSC_DSRMIM (1 << 3) /* DSR interrupt mask */ +#define REG_IMSC_DCDMIM (1 << 2) /* DCD interrupt mask */ +#define REG_IMSC_CTSMIM (1 << 1) /* CTS interrupt mask */ +#define REG_IMSC_RIMIM (1 << 0) /* RI interrupt mask */ + +#define REG_ICR_OEIS (1 << 10) /* overrun error interrupt status */ +#define REG_ICR_BEIS (1 << 9) /* break error interrupt status */ +#define REG_ICR_PEIS (1 << 8) /* parity error interrupt status */ +#define REG_ICR_FEIS (1 << 7) /* framing error interrupt status */ +#define REG_ICR_RTIS (1 << 6) /* receive timeout interrupt status */ +#define REG_ICR_TXIS (1 << 5) /* transmit interrupt status */ +#define REG_ICR_RXIS (1 << 4) /* receive interrupt status */ +#define REG_ICR_DSRMIS (1 << 3) /* DSR interrupt status */ +#define REG_ICR_DCDMIS (1 << 2) /* DCD interrupt status */ +#define REG_ICR_CTSMIS (1 << 1) /* CTS interrupt status */ +#define REG_ICR_RIMIS (1 << 0) /* RI interrupt status */ + +#define UART_NR 12 + +#define UART_DR_ERROR (REG_DR_OE|REG_DR_BE|REG_DR_PE|REG_DR_FE) +#define UART_DUMMY_DR_RX (1 << 16) + +#define DEFAULT_UARTCLK 48000000 /* 48 MHz */ + +/* + * We wrap our port structure around the generic uart_port. + */ +struct phytium_uart_port { + struct uart_port port; + unsigned int im; /* interrupt mask */ + unsigned int old_status; + unsigned int old_cr; /* state during shutdown */ + char type[12]; +}; + +static unsigned int phytium_uart_read(const struct phytium_uart_port *pup, + unsigned int reg) +{ + void __iomem *addr = pup->port.membase + reg; + + return readl_relaxed(addr); +} + +static void phytium_uart_write(unsigned int val, const struct phytium_uart_port *pup, + unsigned int reg) +{ + void __iomem *addr = pup->port.membase + reg; + + writel_relaxed(val, addr); +} + +static int phytium_fifo_to_tty(struct phytium_uart_port *pup) +{ + u16 status; + unsigned int ch, flag, fifotaken; + + for (fifotaken = 0; fifotaken < 256; fifotaken++) { + status = phytium_uart_read(pup, REG_FR); + if (status & REG_FR_RXFE) + break; + + /* Take chars from the FIFO and update status */ + ch = phytium_uart_read(pup, REG_DR) | UART_DUMMY_DR_RX; + flag = TTY_NORMAL; + pup->port.icount.rx++; + + if (unlikely(ch & UART_DR_ERROR)) { + if (ch & REG_DR_BE) { + ch &= ~(REG_DR_FE | REG_DR_PE); + pup->port.icount.brk++; + if (uart_handle_break(&pup->port)) + continue; + } else if (ch & REG_DR_PE) + pup->port.icount.parity++; + else if (ch & REG_DR_FE) + pup->port.icount.frame++; + if (ch & REG_DR_OE) + pup->port.icount.overrun++; + + ch &= pup->port.read_status_mask; + + if (ch & REG_DR_BE) + flag = TTY_BREAK; + else if (ch & REG_DR_PE) + flag = TTY_PARITY; + else if (ch & REG_DR_FE) + flag = TTY_FRAME; + } + + if (uart_handle_sysrq_char(&pup->port, ch & 255)) + continue; + + uart_insert_char(&pup->port, ch, REG_DR_OE, ch, flag); + } + + return fifotaken; +} + +static void phytium_rx_chars(struct phytium_uart_port *pup) +__releases(&pup->port.lock) +__acquires(&pup->port.lock) +{ + phytium_fifo_to_tty(pup); + + spin_unlock(&pup->port.lock); + tty_flip_buffer_push(&pup->port.state->port); + spin_lock(&pup->port.lock); +} + +static void phytium_stop_tx(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + pup->im &= ~REG_IMSC_TXIM; + phytium_uart_write(pup->im, pup, REG_IMSC); +} + +static bool phytium_tx_char(struct phytium_uart_port *pup, unsigned char c, + bool from_irq) +{ + + if (unlikely(!from_irq) && + phytium_uart_read(pup, REG_FR) & REG_FR_TXFF) + return false; /* unable to transmit character */ + + phytium_uart_write(c, pup, REG_DR); + pup->port.icount.tx++; + + return true; +} + +static bool phytium_tx_chars(struct phytium_uart_port *pup, bool from_irq) +{ + struct circ_buf *xmit = &pup->port.state->xmit; + int count = pup->port.fifosize >> 1; + + if (pup->port.x_char) { + if (!phytium_tx_char(pup, pup->port.x_char, from_irq)) + return true; + pup->port.x_char = 0; + --count; + } + if (uart_circ_empty(xmit) || uart_tx_stopped(&pup->port)) { + phytium_stop_tx(&pup->port); + return false; + } + + do { + if (likely(from_irq) && count-- == 0) + break; + + if (!phytium_tx_char(pup, xmit->buf[xmit->tail], from_irq)) + break; + + xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1); + } while (!uart_circ_empty(xmit)); + + if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) + uart_write_wakeup(&pup->port); + + if (uart_circ_empty(xmit)) { + phytium_stop_tx(&pup->port); + return false; + } + return true; +} + +static void phytium_modem_status(struct phytium_uart_port *pup) +{ + unsigned int status, delta; + + status = phytium_uart_read(pup, REG_FR) & (REG_FR_DCD|REG_FR_DSR|REG_FR_CTS); + + delta = status ^ pup->old_status; + pup->old_status = status; + + if (!delta) + return; + + if (delta & REG_FR_DCD) + uart_handle_dcd_change(&pup->port, status & REG_FR_DCD); + + if (delta & REG_FR_DSR) + pup->port.icount.dsr++; + + if (delta & REG_FR_CTS) + uart_handle_cts_change(&pup->port, status & REG_FR_CTS); + + wake_up_interruptible(&pup->port.state->port.delta_msr_wait); +} + +static irqreturn_t phytium_uart_interrupt(int irq, void *dev_id) +{ + struct phytium_uart_port *pup = dev_id; + unsigned long flags; + unsigned int status, pass_counter = 256; + int handled = 0; + + spin_lock_irqsave(&pup->port.lock, flags); + status = phytium_uart_read(pup, REG_RIS) & pup->im; + if (status) { + do { + phytium_uart_write(status & ~(REG_ICR_TXIS|REG_ICR_RTIS|REG_ICR_RXIS), + pup, REG_ICR); + + if (status & (REG_ICR_RTIS|REG_ICR_RXIS)) + phytium_rx_chars(pup); + + if (status & (REG_ICR_DSRMIS|REG_ICR_DCDMIS| + REG_ICR_CTSMIS|REG_ICR_RIMIS)) + phytium_modem_status(pup); + if (status & REG_ICR_TXIS) + phytium_tx_chars(pup, true); + + if (pass_counter-- == 0) + break; + + status = phytium_uart_read(pup, REG_RIS) & pup->im; + } while (status != 0); + handled = 1; + } + spin_unlock_irqrestore(&pup->port.lock, flags); + + return IRQ_RETVAL(handled); +} + +static unsigned int phytium_tx_empty(struct uart_port *port) +{ + unsigned int status; + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + status = phytium_uart_read(pup, REG_FR) & (REG_FR_BUSY | REG_FR_TXFF); + + return status ? 0 : TIOCSER_TEMT; +} + +static void phytium_set_mctrl(struct uart_port *port, unsigned int mctrl) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + unsigned int cr; + + cr = phytium_uart_read(pup, REG_CR); + +#define TIOCMBIT(tiocmbit, uartbit) \ + do { \ + if (mctrl & tiocmbit) \ + cr |= uartbit; \ + else \ + cr &= ~uartbit; \ + } while (0) + + TIOCMBIT(TIOCM_RTS, REG_CR_RTS); + TIOCMBIT(TIOCM_DTR, REG_CR_DTR); + TIOCMBIT(TIOCM_OUT1, REG_CR_OUT1); + TIOCMBIT(TIOCM_OUT2, REG_CR_OUT2); + TIOCMBIT(TIOCM_LOOP, REG_CR_LBE); + + if (port->status & UPSTAT_AUTORTS) { + /* We need to disable auto-RTS if we want to turn RTS off */ + TIOCMBIT(TIOCM_RTS, REG_CR_RTSEN); + } +#undef TIOCMBIT + + phytium_uart_write(cr, pup, REG_CR); +} + +static unsigned int phytium_get_mctrl(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + unsigned int cr = 0; + unsigned int status = phytium_uart_read(pup, REG_FR); + +#define TIOCMBIT(uartbit, tiocmbit) \ + do { \ + if (status & uartbit) \ + cr |= tiocmbit; \ + } while (0) + + TIOCMBIT(REG_FR_DCD, TIOCM_CAR); + TIOCMBIT(REG_FR_DSR, TIOCM_DSR); + TIOCMBIT(REG_FR_CTS, TIOCM_CTS); + TIOCMBIT(REG_FR_RI, TIOCM_RNG); +#undef TIOCMBIT + return cr; +} + +static void phytium_start_tx(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + if (phytium_tx_chars(pup, false)) { + pup->im |= REG_IMSC_TXIM; + phytium_uart_write(pup->im, pup, REG_IMSC); + } +} + +static void phytium_stop_rx(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + pup->im &= ~(REG_IMSC_RXIM|REG_IMSC_RTIM|REG_IMSC_FEIM| + REG_IMSC_PEIM|REG_IMSC_BEIM|REG_IMSC_OEIM); + phytium_uart_write(pup->im, pup, REG_IMSC); +} + +static void phytium_enable_ms(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + pup->im |= REG_IMSC_RIMIM|REG_IMSC_CTSMIM|REG_IMSC_DCDMIM|REG_IMSC_DSRMIM; + phytium_uart_write(pup->im, pup, REG_IMSC); +} + +static void phytium_break_ctl(struct uart_port *port, int break_state) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + unsigned long flags; + unsigned int lcr_h; + + spin_lock_irqsave(&pup->port.lock, flags); + lcr_h = phytium_uart_read(pup, REG_LCRH_TX); + if (break_state == -1) + lcr_h |= REG_LCRH_BRK; + else + lcr_h &= ~REG_LCRH_BRK; + phytium_uart_write(lcr_h, pup, REG_LCRH_TX); + spin_unlock_irqrestore(&pup->port.lock, flags); +} + +static int phytium_hwinit(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + /* XXX: more configurable setup method in future */ + pup->port.uartclk = DEFAULT_UARTCLK; + + /* Clear pending error and receive interrupts */ + phytium_uart_write(REG_ICR_OEIS | REG_ICR_BEIS | REG_ICR_PEIS | + REG_ICR_FEIS | REG_ICR_RTIS | REG_ICR_RXIS, + pup, REG_ICR); + + /* + * Save interrupts enable mask, and enable RX interrupts in case if + * the interrupt is used for NMI entry. + */ + pup->im = phytium_uart_read(pup, REG_IMSC); + phytium_uart_write(REG_IMSC_RTIM | REG_IMSC_RXIM, pup, REG_IMSC); + + return 0; +} + +static int phytium_uart_allocate_irq(struct phytium_uart_port *pup) +{ + phytium_uart_write(pup->im, pup, REG_IMSC); + + return request_irq(pup->port.irq, phytium_uart_interrupt, IRQF_SHARED, DRV_NAME, pup); +} + +static void phytium_enable_interrtups(struct phytium_uart_port *pup) +{ + unsigned int i; + + spin_lock_irq(&pup->port.lock); + + /* Clear out any spuriously appearing RX interrupts */ + phytium_uart_write(REG_ICR_RTIS | REG_ICR_RXIS, pup, REG_ICR); + + /* + * RXIS is asserted only when the RX FIFO transitions from below + * to above the trigger threshold. If the RX FIFO is already + * full to the threashold this can't happen and RXIS will now be + * stuck off. Drain the RX FIFO explicitly to fix this: + */ + for (i = 0; i < pup->port.fifosize * 2; i++) { + if (phytium_uart_read(pup, REG_FR) & REG_FR_RXFE) + break; + + phytium_uart_read(pup, REG_DR); + } + + pup->im = REG_IMSC_RTIM | REG_IMSC_RXIM; + phytium_uart_write(pup->im, pup, REG_IMSC); + spin_unlock_irq(&pup->port.lock); +} + +static int phytium_startup(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + unsigned int cr; + int ret = 0; + + ret = phytium_hwinit(port); + if (ret) + goto out; + + ret = phytium_uart_allocate_irq(pup); + if (ret) + goto out; + + phytium_uart_write(REG_IFLS_RX4_8|REG_IFLS_TX4_8, pup, REG_IFLS); + + spin_lock_irq(&pup->port.lock); + + /* restore RTS and DTR */ + cr = pup->old_cr & (REG_CR_RTS | REG_CR_DTR); + cr |= REG_CR_UARTEN | REG_CR_RXE | REG_CR_TXE; + phytium_uart_write(cr, pup, REG_CR); + + spin_unlock_irq(&pup->port.lock); + + /* initialise the old status of the modem signals */ + pup->old_status = phytium_uart_read(pup, REG_FR) & (REG_FR_DCD|REG_FR_DSR|REG_FR_CTS); + + phytium_enable_interrtups(pup); + +out: + return ret; +} + +static void phytium_shutdown_channel(struct phytium_uart_port *pup, + unsigned int lcrh) +{ + unsigned long val; + + val = phytium_uart_read(pup, lcrh); + val &= ~(REG_LCRH_BRK | REG_LCRH_FEN); + phytium_uart_write(val, pup, lcrh); +} + +static void phytium_disable_uart(struct phytium_uart_port *pup) +{ + unsigned int cr; + + pup->port.status &= ~(UPSTAT_AUTOCTS | UPSTAT_AUTORTS); + spin_lock_irq(&pup->port.lock); + cr = phytium_uart_read(pup, REG_CR); + pup->old_cr = cr; + cr &= REG_CR_RTS | REG_CR_DTR; + cr |= REG_CR_UARTEN | REG_CR_TXE; + phytium_uart_write(cr, pup, REG_CR); + spin_unlock_irq(&pup->port.lock); + + /* + * disable break condition and fifos + */ + phytium_shutdown_channel(pup, REG_LCRH_RX); +} + +static void phytium_disable_interrupts(struct phytium_uart_port *pup) +{ + spin_lock_irq(&pup->port.lock); + + /* mask all interrupts and clear all pending ones */ + pup->im = 0; + phytium_uart_write(pup->im, pup, REG_IMSC); + phytium_uart_write(0xffff, pup, REG_ICR); + + spin_unlock_irq(&pup->port.lock); +} + +static void phytium_shutdown(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + phytium_disable_interrupts(pup); + + free_irq(pup->port.irq, pup); + + phytium_disable_uart(pup); + + if (pup->port.ops->flush_buffer) + pup->port.ops->flush_buffer(port); +} + +static void +phytium_setup_status_masks(struct uart_port *port, struct ktermios *termios) +{ + port->read_status_mask = REG_DR_OE | 255; + if (termios->c_iflag & INPCK) + port->read_status_mask |= REG_DR_FE | REG_DR_PE; + if (termios->c_iflag & (IGNBRK | BRKINT | PARMRK)) + port->read_status_mask |= REG_DR_BE; + + /* + * Characters to ignore + */ + port->ignore_status_mask = 0; + if (termios->c_iflag & IGNPAR) + port->ignore_status_mask |= REG_DR_FE | REG_DR_PE; + if (termios->c_iflag & IGNBRK) { + port->ignore_status_mask |= REG_DR_BE; + /* + * If we're ignoring parity and break indicators, + * ignore overruns too (for real raw support). + */ + if (termios->c_iflag & IGNPAR) + port->ignore_status_mask |= REG_DR_OE; + } + + /* + * Ignore all characters if CREAD is not set. + */ + if ((termios->c_cflag & CREAD) == 0) + port->ignore_status_mask |= UART_DUMMY_DR_RX; +} + +static void +phytium_set_termios(struct uart_port *port, struct ktermios *termios, struct ktermios *old) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + unsigned int lcr_h, old_cr; + unsigned long flags; + unsigned int baud, quot; + + /* Ask the core to calculate the divisor for us. */ + baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16); + + if (baud > port->uartclk/16) + quot = DIV_ROUND_CLOSEST(port->uartclk * 8, baud); + else + quot = DIV_ROUND_CLOSEST(port->uartclk * 4, baud); + + switch (termios->c_cflag & CSIZE) { + case CS5: + lcr_h = REG_LCRH_WLEN_5; + break; + case CS6: + lcr_h = REG_LCRH_WLEN_6; + break; + case CS7: + lcr_h = REG_LCRH_WLEN_7; + break; + default: /* CS8 */ + lcr_h = REG_LCRH_WLEN_8; + break; + } + if (termios->c_cflag & CSTOPB) + lcr_h |= REG_LCRH_STP2; + if (termios->c_cflag & PARENB) { + lcr_h |= REG_LCRH_PEN; + if (!(termios->c_cflag & PARODD)) + lcr_h |= REG_LCRH_EPS; + if (termios->c_cflag & CMSPAR) + lcr_h |= REG_LCRH_SPS; + } + if (pup->port.fifosize > 1) + lcr_h |= REG_LCRH_FEN; + + spin_lock_irqsave(&port->lock, flags); + + /* + * Update the per-port timeout. + */ + uart_update_timeout(port, termios->c_cflag, baud); + + phytium_setup_status_masks(port, termios); + + if (UART_ENABLE_MS(port, termios->c_cflag)) + phytium_enable_ms(port); + + /* first, disable everything */ + old_cr = phytium_uart_read(pup, REG_CR); + phytium_uart_write(0, pup, REG_CR); + + if (termios->c_cflag & CRTSCTS) { + if (old_cr & REG_CR_RTS) + old_cr |= REG_CR_RTSEN; + + old_cr |= REG_CR_CTSEN; + port->status |= UPSTAT_AUTOCTS | UPSTAT_AUTORTS; + } else { + old_cr &= ~(REG_CR_CTSEN | REG_CR_RTSEN); + port->status &= ~(UPSTAT_AUTOCTS | UPSTAT_AUTORTS); + } + + /* Set baud rate */ + phytium_uart_write(quot & 0x3f, pup, REG_FBRD); + phytium_uart_write(quot >> 6, pup, REG_IBRD); + + phytium_uart_write(lcr_h, pup, REG_LCRH_RX); + phytium_uart_write(old_cr, pup, REG_CR); + + spin_unlock_irqrestore(&port->lock, flags); +} + +static const char *phytium_type(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + return pup->port.type == PORT_PHYTIUM ? pup->type : NULL; +} + +static void phytium_release_port(struct uart_port *port) +{ + /* Nothing to release ... */ +} + +static int phytium_request_port(struct uart_port *port) +{ + /* UARTs always present */ + return 0; +} + +static void phytium_config_port(struct uart_port *port, int flags) +{ + if (flags & UART_CONFIG_TYPE) { + port->type = PORT_PHYTIUM; + phytium_request_port(port); + } +} + +static int phytium_verify_port(struct uart_port *port, struct serial_struct *ser) +{ + int ret = 0; + + if (ser->type != PORT_UNKNOWN && ser->type != PORT_PHYTIUM) + ret = -EINVAL; + if (ser->irq < 0 || ser->irq >= nr_irqs) + ret = -EINVAL; + if (ser->baud_base < 9600) + ret = -EINVAL; + + return ret; +} + +static const struct uart_ops phytium_uart_ops = { + .tx_empty = phytium_tx_empty, + .set_mctrl = phytium_set_mctrl, + .get_mctrl = phytium_get_mctrl, + .stop_tx = phytium_stop_tx, + .start_tx = phytium_start_tx, + .stop_rx = phytium_stop_rx, + .enable_ms = phytium_enable_ms, + .break_ctl = phytium_break_ctl, + .startup = phytium_startup, + .shutdown = phytium_shutdown, + .set_termios = phytium_set_termios, + .type = phytium_type, + .release_port = phytium_release_port, + .request_port = phytium_request_port, + .config_port = phytium_config_port, + .verify_port = phytium_verify_port, +}; + +static struct phytium_uart_port *uart_ports[UART_NR]; + +static struct uart_driver phytium_uart = { + .owner = THIS_MODULE, + .driver_name = DRV_NAME, + .dev_name = "ttyFTX", + .nr = UART_NR, +}; + +void phytium_unregister_port(struct phytium_uart_port *pup) +{ + int i; + bool busy = false; + + for (i = 0; i < ARRAY_SIZE(uart_ports); i++) { + if (uart_ports[i] == pup) + uart_ports[i] = NULL; + else if (uart_ports[i]) + busy = true; + } + + if (!busy) + uart_unregister_driver(&phytium_uart); +} + +static int phytium_find_free_port(void) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(uart_ports); i++) + if (uart_ports[i] == NULL) + return i; + + return -EBUSY; +} + +static int phytium_register_port(struct phytium_uart_port *pup) +{ + int rc; + + /* Ensure interrupts from this UART are masked and cleared */ + phytium_uart_write(0, pup, REG_IMSC); + phytium_uart_write(0xffff, pup, REG_ICR); + + if (!phytium_uart.state) { + rc = uart_register_driver(&phytium_uart); + if (rc < 0) { + dev_err(pup->port.dev, + "Failed to register Phytium PCI UART driver\n"); + return rc; + } + } + + rc = uart_add_one_port(&phytium_uart, &pup->port); + if (rc) + phytium_unregister_port(pup); + + return rc; +} + +static int phytium_uart_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct phytium_uart_port *pup; + int portnr, rc; + + portnr = phytium_find_free_port(); + if (portnr < 0) + return portnr; + + pup = devm_kzalloc(&pdev->dev, sizeof(struct phytium_uart_port), + GFP_KERNEL); + if (!pup) + return -ENOMEM; + + rc = pcim_enable_device(pdev); + if (rc) + return rc; + + rc = pcim_iomap_regions_request_all(pdev, 0x01, pci_name(pdev)); + if (rc) + return rc; + + pup->port.iotype = UPIO_MEM32; + pup->port.irq = pdev->irq; + pup->port.mapbase = pci_resource_start(pdev, 0); + pup->port.membase = pcim_iomap_table(pdev)[0]; + pup->port.ops = &phytium_uart_ops; + pup->port.dev = &pdev->dev; + pup->port.fifosize = 32; + pup->port.flags = UPF_BOOT_AUTOCONF; + pup->port.line = portnr; + + uart_ports[portnr] = pup; + + pup->old_cr = 0; + snprintf(pup->type, sizeof(pup->type), "pci-uart"); + + pci_set_drvdata(pdev, pup); + + return phytium_register_port(pup); +} + +static void phytium_uart_remove(struct pci_dev *pdev) +{ + struct phytium_uart_port *pup = pci_get_drvdata(pdev); + + uart_remove_one_port(&phytium_uart, &pup->port); + phytium_unregister_port(pup); +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_uart_suspend(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_uart_port *pup = pci_get_drvdata(pdev); + + if (pup) + uart_suspend_port(&phytium_uart, &pup->port); + + return 0; +} + +static int phytium_uart_resume(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_uart_port *pup = pci_get_drvdata(pdev); + + if (pup) + uart_resume_port(&phytium_uart, &pup->port); + + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_dev_pm_ops, phytium_uart_suspend, phytium_uart_resume); + +static const struct pci_device_id pci_ids[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc2e) }, + { 0 } +}; +MODULE_DEVICE_TABLE(pci, pci_ids); + +static struct pci_driver phytium_uart_pci_driver = { + .name = DRV_NAME, + .probe = phytium_uart_probe, + .remove = phytium_uart_remove, + .driver = { + .pm = &phytium_dev_pm_ops, + }, + .id_table = pci_ids, +}; + +static int __init phytium_uart_init(void) +{ + pr_info("Serial: Phytium PCI UART driver\n"); + + return pci_register_driver(&phytium_uart_pci_driver); +} + +static void __exit phytium_uart_exit(void) +{ + pci_unregister_driver(&phytium_uart_pci_driver); +} + +module_init(phytium_uart_init); +module_exit(phytium_uart_exit); + +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium PCI serial port driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..f131a3f8865a53c2444e8ab108804fa540509b4c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/Kconfig @@ -0,0 +1,8 @@ +config USB_PHYTIUM + tristate "PHYTIUM USB Support" + depends on USB && USB_GADGET + help + Say Y or M here if your system has a OTG USB Controller based on PHYTIUM SOC. + + If you choose to build this driver is a dynamically linked modules, the module will + be called phytium-usb.ko diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..05d422d4a59bc5dddc5f5483e9eeaf792330ede5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/Makefile @@ -0,0 +1,5 @@ +# SPDX-License-Identifier: GPL-2.0 + +obj-$(CONFIG_USB_PHYTIUM) += phytium-usb.o + +phytium-usb-y := core.o dma.o platform.o host.o gadget.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/core.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/core.c new file mode 100644 index 0000000000000000000000000000000000000000..c0182c0770e5ef5f5baa7d7b1709b844ca8578db --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/core.c @@ -0,0 +1,44 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include "core.h" + +int phytium_core_reset(struct phytium_cusb *config, bool skip_wait) +{ + if (!config) + return 0; + + spin_lock_init(&config->lock); + + return 0; +} + +uint32_t phytium_read32(uint32_t *address) +{ + return readl(address); +} + +void phytium_write32(uint32_t *address, uint32_t value) +{ + writel(value, address); +} + +uint16_t phytium_read16(uint16_t *address) +{ + return readw(address); +} + +void phytium_write16(uint16_t *address, uint16_t value) +{ + writew(value, address); +} + +uint8_t phytium_read8(uint8_t *address) +{ + return readb(address); +} + +void phytium_write8(uint8_t *address, uint8_t value) +{ + writeb(value, address); +} + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/core.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/core.h new file mode 100644 index 0000000000000000000000000000000000000000..f563672ccaa9963859ff3e1bf8ce62276d3c0bce --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/core.h @@ -0,0 +1,98 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef __PHYTIUM_CORE_H__ +#define __PHYTIUM_CORE_H__ + +#include +#include +#include "host_api.h" +#include "gadget.h" + +#define MAX_EPS_CHANNELS 16 + +struct phytium_ep { + struct phytium_cusb *config; + u16 max_packet; + u8 ep_num; + struct GADGET_EP *gadget_ep; + struct list_head req_list; + struct usb_ep end_point; + char name[12]; + u8 is_tx; + const struct usb_endpoint_descriptor *desc; + u8 busy; +}; + +struct phytium_request { + struct usb_request request; + struct GADGET_REQ *gadget_request; + struct list_head list; + struct phytium_ep *ep; + struct phytium_cusb *config; + u8 is_tx; + u8 epnum; +}; + +struct phytium_cusb { + struct device *dev; + void __iomem *regs; + void __iomem *phy_regs; + int irq; + spinlock_t lock; + enum usb_dr_mode dr_mode; + + struct GADGET_OBJ *gadget_obj; + struct GADGET_CFG gadget_cfg; + struct GADGET_CALLBACKS gadget_callbacks; + struct GADGET_SYSREQ gadget_sysreq; + struct GADGET_DEV *gadget_dev; + void *gadget_priv; + + struct usb_gadget gadget; + struct usb_gadget_driver *gadget_driver; + struct phytium_ep endpoints_tx[MAX_EPS_CHANNELS]; + struct phytium_ep endpoints_rx[MAX_EPS_CHANNELS]; + u8 ep0_data_stage_is_tx; + + struct HOST_OBJ *host_obj; + struct HOST_CFG host_cfg; + struct HOST_CALLBACKS host_callbacks; + struct HOST_SYSREQ host_sysreq; + void *host_priv; + struct usb_hcd *hcd; + + struct DMA_OBJ *dma_obj; + struct DMA_CFG dma_cfg; + struct DMA_CALLBACKS dma_callbacks; + struct DMA_SYSREQ dma_sysreq; + bool isVhubHost; +}; + +int phytium_core_reset(struct phytium_cusb *config, bool skip_wait); + +int phytium_host_init(struct phytium_cusb *config); +int phytium_host_uninit(struct phytium_cusb *config); + +#ifdef CONFIG_PM +int phytium_host_resume(void *priv); +int phytium_host_suspend(void *priv); +int phytium_gadget_resume(void *priv); +int phytium_gadget_suspend(void *priv); +#endif + +int phytium_gadget_init(struct phytium_cusb *config); +int phytium_gadget_uninit(struct phytium_cusb *config); + +uint32_t phytium_read32(uint32_t *address); + +void phytium_write32(uint32_t *address, uint32_t value); + +uint16_t phytium_read16(uint16_t *address); + +void phytium_write16(uint16_t *address, uint16_t value); + +uint8_t phytium_read8(uint8_t *address); + +void phytium_write8(uint8_t *address, uint8_t value); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/dma.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/dma.c new file mode 100644 index 0000000000000000000000000000000000000000..2e0d6df3eb344e386c649f2fc2dab7e774969137 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/dma.c @@ -0,0 +1,786 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include +#include +#include "core.h" +#include "dma.h" +#include "hw-regs.h" + +#define TRB_POOL_SIZE (sizeof(struct DMA_Trb) * (NUM_OF_TRB)) +/* burst length 'x' should be multiples of 2 */ +#define TRB_BURST_LENGTH(x) (((x) & 0xFF) << 24) + +#define BUILD_NORMAL_TRB_NO_IOC(trb, data_ptr, data_size, stream_id) { \ + trb.dmaAddr = data_ptr; \ + trb.dmaSize = data_size; \ + trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT; } + +#define BUILD_NORMAL_TRB_NO_IOC_CHAIN(trb, data_ptr, data_size, stream_id) { \ + trb.dmaAddr = data_ptr; \ + trb.dmaSize = data_size; \ + trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT | TDF_CHAIN_BIT; } + +#define BUILD_NORMAL_TRB(trb, data_ptr, data_size, stream_id) { \ + trb.dmaAddr = data_ptr; \ + trb.dmaSize = (data_size) | TRB_BURST_LENGTH(0x80); \ + trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT |\ + TDF_INT_ON_COMPLECTION | TDF_INT_ON_SHORT_PACKET; } + +#define BUILD_LINK_TRB(trb, target_ptr) { \ + trb.dmaAddr = target_ptr; \ + trb.dmaSize = 0; \ + trb.ctrl = TD_TYPE_LINK | TDF_CYCLE_BIT | TDF_CHAIN_BIT; } + +#define BUILD_EMPTY_TRB(trb) { \ + trb.dmaAddr = 0; \ + trb.dmaSize = 0; \ + trb.ctrl = 0; } + + +uint32_t divRoundUp(uint32_t divident, uint32_t divisor) +{ + return divisor ? ((divident + divisor - 1) / divisor) : 0; +} + +static inline struct DMA_TrbChainDesc *GetTrbChainDescEntry(struct list_head *list) +{ + return (struct DMA_TrbChainDesc *)((uintptr_t)list - + (uintptr_t)&(((struct DMA_TrbChainDesc *)0)->chainNode)); +} + +static int32_t phytium_dma_probe(struct DMA_CFG *config, struct DMA_SYSREQ *sysReq) +{ + if (!sysReq) + return -EINVAL; + + sysReq->trbMemSize = TRB_POOL_SIZE; + sysReq->privDataSize = sizeof(struct DMA_CONTROLLER); + + return 0; +} + +static int32_t phytium_dma_init(struct DMA_CONTROLLER *priv, + const struct DMA_CFG *config, struct DMA_CALLBACKS *callbacks) +{ + if (!priv || !config || !callbacks) + return -EINVAL; + + if (!config->trbAddr || !config->trbDmaAddr) + return -EINVAL; + + memset((void *)priv, 0, sizeof(struct DMA_CONTROLLER)); + memset((void *)config->trbAddr, 0, TRB_POOL_SIZE); + + priv->trbDMAPoolAddr = config->trbDmaAddr; + priv->trbPoolAddr = config->trbAddr; + priv->regs = (struct DMARegs *)config->regBase; + priv->dmaCfg = *config; + priv->dmaDrv = DMA_GetInstance(); + priv->dmaCallbacks = *callbacks; + priv->isHostCtrlMode = 0; + return 0; +} + +static void phytium_dma_destroy(struct DMA_CONTROLLER *priv) +{ + +} + +static int32_t phytium_dma_start(struct DMA_CONTROLLER *priv) +{ + int i; + + if (!priv) + return -EINVAL; + + priv->dmaMode = DMA_MODE_CHANNEL_INDIVIDUAL; + if ((priv->dmaCfg.dmaModeRx & priv->dmaCfg.dmaModeTx) == 0xFFFF) { + priv->dmaMode = DMA_MODE_GLOBAL_DMULT; + phytium_write32(&priv->regs->conf, DMARF_DMULT); + } else if ((priv->dmaCfg.dmaModeRx | priv->dmaCfg.dmaModeTx)) { + priv->dmaMode = DMA_MODE_GLOBAL_DSING; + phytium_write32(&priv->regs->conf, DMARF_DSING); + } + + for (i = 0; i < MAX_DMA_CHANNELS; i++) { + if (priv->dmaCfg.dmaModeRx & (1 << i)) { + priv->rx[i].dmultEnabled = 1; + priv->rx[i].maxTrbLen = TD_DMULT_MAX_TRB_DATA_SIZE; + priv->rx[i].maxTdLen = TD_DMULT_MAX_TD_DATA_SIZE; + } else { + priv->rx[i].dmultEnabled = 0; + priv->rx[i].maxTrbLen = TD_SING_MAX_TRB_DATA_SIZE; + priv->rx[i].maxTdLen = TD_SING_MAX_TD_DATA_SIZE; + } + priv->rx[i].lastTransferLength = 0; + + if (priv->dmaCfg.dmaModeTx & (1 << i)) { + priv->tx[i].dmultEnabled = 1; + priv->tx[i].maxTrbLen = TD_DMULT_MAX_TRB_DATA_SIZE; + priv->tx[i].maxTdLen = TD_DMULT_MAX_TD_DATA_SIZE; + } else { + priv->tx[i].dmultEnabled = 0; + priv->tx[i].maxTrbLen = TD_SING_MAX_TRB_DATA_SIZE; + priv->tx[i].maxTdLen = TD_SING_MAX_TD_DATA_SIZE; + } + priv->tx[i].lastTransferLength = 0; + } + + return 0; +} + +static uint32_t phytium_dma_stop(struct DMA_CONTROLLER *priv) +{ + + return 0; +} + +static int32_t updateDescBuffer(struct DMA_CONTROLLER *priv, + struct DMA_TrbChainDesc *trbChainDesc, uint16_t status) +{ + uint32_t ep_sel, i; + struct DMA_Channel *channel; + + if (!priv || !trbChainDesc) + return -EINVAL; + + channel = trbChainDesc->channel; + if (!channel) + return -EINVAL; + + if (channel->isIsoc && trbChainDesc->lastTrbIsLink) { + if (channel->trbChainDescList.prev == channel->trbChainDescList.next) + return 0; + } + + for (i = 0; i < trbChainDesc->numOfTrbs; i++) { + if (trbChainDesc->framesDesc) { + if (trbChainDesc->isoError) + trbChainDesc->framesDesc[i].length = 0; + else + trbChainDesc->framesDesc[i].length = + (uint32_t)trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK; + } + + trbChainDesc->actualLen += + (uint32_t)trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK; + } + + if (trbChainDesc->isoError) + trbChainDesc->actualLen = 0; + + ep_sel = phytium_read32(&priv->regs->ep_sel); + channel->lastTransferLength = trbChainDesc->actualLen; + + if (!trbChainDesc->lastTrbIsLink) { + if (!list_empty(&trbChainDesc->chainNode)) { + for (i = 0; i < trbChainDesc->mapSize; i++) + priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; + + trbChainDesc->channel->numOfTrbChain--; + trbChainDesc->reserved = 0; + list_del(&trbChainDesc->chainNode); + trbChainDesc = NULL; + } + } + + if (channel->trbChainDescList.prev == &channel->trbChainDescList) + channel->status = DMA_STATUS_FREE; + + if (priv->dmaCallbacks.complete) + priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, + channel->isDirTx, false); + + if (channel->trbChainDescList.next != &channel->trbChainDescList) { + trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); + if (trbChainDesc && trbChainDesc->lastTrbIsLink) { + if (!list_empty(&trbChainDesc->chainNode)) { + for (i = 0; i < trbChainDesc->mapSize; i++) + priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; + + trbChainDesc->channel->numOfTrbChain--; + trbChainDesc->reserved = 0; + list_del(&trbChainDesc->chainNode); + } + } + } + + phytium_write32(&priv->regs->ep_sel, ep_sel); + + return 0; +} + +static void phytium_dma_isr(struct DMA_CONTROLLER *priv) +{ + uint32_t ep_sts, ep_ists, ep_cfg; + int i; + uint8_t isDirTx, epNum; + struct DMA_Channel *channel; + struct DMA_TrbChainDesc *trbChainDesc; + + if (!priv) + return; + + ep_ists = phytium_read32(&priv->regs->ep_ists); + if (!ep_ists) { + phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | + DMARF_EP_ISP | DMARF_EP_TRBERR); + return; + } + + for (i = 0; i < 32; i++) { + if (!(ep_ists & (1 << i))) + continue; + + isDirTx = i > 15 ? DMARD_EP_TX : 0u; + epNum = isDirTx ? i - 16 : i; + phytium_write32(&priv->regs->ep_sel, epNum | isDirTx); + + if (isDirTx) + channel = &priv->tx[epNum]; + else + channel = &priv->rx[epNum]; + + ep_sts = phytium_read32(&priv->regs->ep_sts); + + if (ep_sts & DMARF_EP_TRBERR) + phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); + + if ((ep_sts & DMARF_EP_IOC) || (ep_sts & DMARF_EP_ISP) || (channel->dmultGuard + & DMARF_EP_IOC) || (channel->dmultGuard & DMARF_EP_ISP)) { +retransmit: + phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP); + trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); + if (!(ep_sts & DMARF_EP_TRBERR) && channel->dmultEnabled + && !trbChainDesc->lastTrbIsLink) { + if (!priv->isHostCtrlMode && !channel->isDirTx) { + channel->dmultGuard = 0; + phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); + ep_cfg = phytium_read32(&priv->regs->ep_cfg); + ep_cfg &= ~DMARV_EP_ENABLED; + phytium_write32(&priv->regs->ep_cfg, (uint32_t)ep_cfg); + updateDescBuffer(priv, trbChainDesc, 0); + break; + } + channel->dmultGuard = ep_sts; + break; + } + + channel->dmultGuard = 0; + updateDescBuffer(priv, trbChainDesc, 0); + } + + if (ep_sts & DMARF_EP_OUTSMM) + phytium_write32(&priv->regs->ep_sts, DMARF_EP_OUTSMM); + + if (ep_sts & DMARF_EP_DESCMIS) + phytium_write32(&priv->regs->ep_sts, DMARF_EP_DESCMIS); + + if (ep_sts & DMARF_EP_ISOERR) { + phytium_write32(&priv->regs->ep_sts, DMARF_EP_ISOERR); + trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); + trbChainDesc->isoError = 1; + goto retransmit; + } + } +} + +static void phytium_dma_errIsr(struct DMA_CONTROLLER *priv, uint8_t irqNr, uint8_t isDirTx) +{ + struct DMA_Channel *channel; + + if (!priv) + return; + + if (isDirTx) + channel = &priv->tx[irqNr]; + else + channel = &priv->rx[irqNr]; + + if (channel->status >= DMA_STATUS_BUSY) + channel->status = DMA_STATUS_ABORT; + + if (priv->dmaCallbacks.complete) { + if (!irqNr && priv->resubmit) { + priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, + channel->isDirTx, true); + priv->resubmit = false; + } else + priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, + channel->isDirTx, false); + } +} + +static void *phytium_dma_channelAlloc(struct DMA_CONTROLLER *priv, + uint8_t isDirTx, uint8_t hwEpNum, uint8_t isIsoc) +{ + struct DMA_Channel *channel; + uint32_t ep_ien, ep_cfg; + uint16_t dmaMode; + + if (!priv || (hwEpNum >= MAX_DMA_CHANNELS)) + return NULL; + + if (!priv->regs) { + pr_err("dma regs is null\n"); + return NULL; + } + + ep_ien = phytium_read32(&priv->regs->ep_ien); + + if (isDirTx) { + if (priv->tx[hwEpNum].status > DMA_STATUS_FREE) + return NULL; + + channel = &priv->tx[hwEpNum]; + channel->isDirTx = 0x80; + ep_ien |= (0x01 << (hwEpNum + 16)); + dmaMode = priv->dmaCfg.dmaModeTx; + } else { + if (priv->rx[hwEpNum].status > DMA_STATUS_FREE) + return NULL; + + channel = &priv->rx[hwEpNum]; + channel->isDirTx = 0x00; + ep_ien |= (0x01 << hwEpNum); + dmaMode = priv->dmaCfg.dmaModeRx; + } + + channel->isIsoc = 0; + if (isIsoc) + channel->isIsoc = 1; + + INIT_LIST_HEAD(&channel->trbChainDescList); + channel->numOfTrbChain = 0; + channel->controller = priv; + channel->dmultGuard = 0; + channel->status = DMA_STATUS_FREE; + channel->hwUsbEppNum = hwEpNum; + + phytium_write32(&priv->regs->ep_sel, (uint32_t)hwEpNum | channel->isDirTx); + ep_cfg = phytium_read32(&priv->regs->ep_cfg); + + if (priv->dmaMode == DMA_MODE_CHANNEL_INDIVIDUAL) { + if (dmaMode & (1 << hwEpNum)) + ep_cfg |= DMARV_EP_DMULT; + else + ep_cfg |= DMARV_EP_DSING; + } + + phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP | DMARF_EP_TRBERR); + phytium_write32(&priv->regs->ep_cfg, (uint32_t)DMARV_EP_ENABLED | ep_cfg); + phytium_write32(&priv->regs->ep_ien, ep_ien); + phytium_write32(&priv->regs->ep_sts_en, DMARF_EP_TRBERR); + + return channel; +} + +static int32_t phytium_dma_channelRelease(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) +{ + uint32_t ep_ien, i; + struct DMA_TrbChainDesc *trbChainDesc; + + if (!channel || !priv) + return -EINVAL; + + ep_ien = phytium_read32(&priv->regs->ep_ien); + if (channel->isDirTx) + ep_ien &= ~(0x01 << (channel->hwUsbEppNum + 16)); + else + ep_ien &= ~(0x01 << channel->hwUsbEppNum); + + phytium_write32(&priv->regs->ep_sel, (uint32_t)channel->hwUsbEppNum | channel->isDirTx); + phytium_write32(&priv->regs->ep_cfg, (uint32_t)0); + phytium_write32(&priv->regs->ep_ien, ep_ien); + phytium_write32(&priv->regs->ep_sts_en, 0x0); + phytium_write32(&priv->regs->ep_cmd, DMARF_EP_EPRST); + phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP | + DMARF_EP_TRBERR | DMARF_EP_ISOERR); + + if (channel->status >= DMA_STATUS_BUSY) + channel->status = DMA_STATUS_ABORT; + + priv->dmaDrv->dma_channelAbort(priv, channel); + + while (channel->trbChainDescList.next != &channel->trbChainDescList) { + trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); + if (trbChainDesc) { + if (!list_empty(&trbChainDesc->chainNode)) { + for (i = 0; i < trbChainDesc->mapSize; i++) + priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; + + trbChainDesc->channel->numOfTrbChain--; + trbChainDesc->reserved = 0; + list_del(&trbChainDesc->chainNode); + } + } + } + + channel->status = DMA_STATUS_UNKNOW; + + return 0; +} + +static void ShowTrbChain(struct DMA_TrbChainDesc *trbChainDesc) +{ + int i; + + if (!trbChainDesc) + return; + pr_debug("Trb Chain %p for channel %p\n", trbChainDesc, trbChainDesc->channel); + pr_debug("idx | trb size | trb addr | FLAG: NORMAL LINK CHAIN ALL\n"); + for (i = 0; i < trbChainDesc->numOfTrbs + 2; i++) + pr_debug("%02d | %08x | %08x | %d %d %d %08x\n", + i, + trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK, + trbChainDesc->trbPool[i].dmaAddr, + (trbChainDesc->trbPool[i].ctrl & TD_TYPE_NORMAL) ? 1 : 0, + (trbChainDesc->trbPool[i].ctrl & TD_TYPE_LINK) ? 1 : 0, + (trbChainDesc->trbPool[i].ctrl & TDF_CHAIN_BIT) ? 1 : 0, + trbChainDesc->trbPool[i].ctrl); +} + +static uint32_t phytium_dma_NewTd(struct DMA_CONTROLLER *priv, + struct DMA_TrbChainDesc *trbChainDesc) +{ + uint32_t startAddress, dataSize; + struct DMA_Channel *channel; + int i = 0; + uint32_t tmp = 0; + + if (!priv || !trbChainDesc) + return 0; + + startAddress = trbChainDesc->dwStartAddress; + channel = trbChainDesc->channel; + dataSize = channel->maxTrbLen; + + if (trbChainDesc->numOfTrbs > 1) { + for (i = 0; i < (trbChainDesc->numOfTrbs - 1); i++) { + if (channel->dmultEnabled) { + if (trbChainDesc->framesDesc && priv->isHostCtrlMode + && channel->isIsoc) { + BUILD_NORMAL_TRB_NO_IOC(trbChainDesc->trbPool[i], + trbChainDesc->dwStartAddress + + trbChainDesc->framesDesc[i].offset, + trbChainDesc->framesDesc[i].length, 0); + continue; + } else + BUILD_NORMAL_TRB_NO_IOC(trbChainDesc->trbPool[i], + startAddress, dataSize, 0); + } else + BUILD_NORMAL_TRB_NO_IOC_CHAIN(trbChainDesc->trbPool[i], + startAddress, dataSize, 0); + startAddress += dataSize; + tmp += dataSize; + } + } + + if (trbChainDesc->framesDesc && priv->isHostCtrlMode && channel->isIsoc) { + BUILD_NORMAL_TRB(trbChainDesc->trbPool[i], + trbChainDesc->dwStartAddress + trbChainDesc->framesDesc[i].offset, + trbChainDesc->framesDesc[i].length, 0); + } else + BUILD_NORMAL_TRB(trbChainDesc->trbPool[i], startAddress, + trbChainDesc->len - tmp, 0); + + trbChainDesc->lastTrbIsLink = 0; + if (channel->dmultEnabled) { + if (channel->isIsoc) { + trbChainDesc->lastTrbIsLink = 1; + BUILD_LINK_TRB(trbChainDesc->trbPool[i + 1], trbChainDesc->trbDMAAddr); + } else + BUILD_EMPTY_TRB(trbChainDesc->trbPool[i + 1]); + } + + ShowTrbChain(trbChainDesc); + + return 0; +} + +static void phytium_dma_ArmTd(struct DMA_CONTROLLER *priv, struct DMA_TrbChainDesc *trbChainDesc) +{ + uint32_t ep_sts, ep_cfg, ep_cmd; + struct DMA_TrbChainDesc *startedChain; + struct DMA_Trb *lastPrevTrb; + struct DMA_Channel *channel; + + if (!priv || !trbChainDesc) + return; + + channel = trbChainDesc->channel; + phytium_write32(&priv->regs->ep_sel, (channel->isDirTx | channel->hwUsbEppNum)); + + ep_sts = phytium_read32(&priv->regs->ep_sts); + + if (channel->status == DMA_STATUS_FREE) { + phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); + phytium_write32(&priv->regs->traddr, trbChainDesc->trbDMAAddr); + phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); + + ep_cfg = phytium_read32(&priv->regs->ep_cfg); + phytium_write32(&priv->regs->ep_cmd, DMARF_EP_DRDY); + if (!(ep_cfg & DMARV_EP_ENABLED)) { + ep_cfg |= DMARV_EP_ENABLED; + phytium_write32(&priv->regs->ep_cfg, ep_cfg); + } + } else { + if (channel->trbChainDescList.prev != channel->trbChainDescList.next) { + startedChain = GetTrbChainDescEntry(channel->trbChainDescList.prev->prev); + lastPrevTrb = &startedChain->trbPool[startedChain->numOfTrbs]; + startedChain->lastTrbIsLink = 1; + BUILD_LINK_TRB((*lastPrevTrb), trbChainDesc->trbDMAAddr); + ep_cmd = phytium_read32(&priv->regs->ep_cmd); + if (!(ep_cmd & DMARF_EP_DRDY)) { + phytium_write32(&priv->regs->traddr, trbChainDesc->trbDMAAddr); + phytium_write32(&priv->regs->ep_cmd, DMARF_EP_DRDY); + } + ShowTrbChain(startedChain); + } + } +} + +static int32_t phytium_dma_TrbChainAlloc(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel, uint32_t numOfTrbs, struct DMA_TrbChainDesc **chain) +{ + struct DMA_TrbChainDesc *trbChainDesc = NULL; + int i, j; + uint32_t mapcount, count = 0; + + if (!priv || !channel) + return -ENOMEM; + + for (i = 0; i < TAB_SIZE_OF_DMA_CHAIN; i++) { + if (!priv->trbChainDesc[i].reserved) { + trbChainDesc = &priv->trbChainDesc[i]; + break; + } + } + + if (!trbChainDesc) { + pr_err("No Free TRB Chain Descriptor\n"); + return -ENOMEM; + } + + INIT_LIST_HEAD(&trbChainDesc->chainNode); + *chain = NULL; + mapcount = (numOfTrbs + 2 + 7) >> 3; + + for (i = 0; i < TRB_MAP_SIZE; i++) { + if (priv->trbChainFreeMap[i] == 0x0) + count++; + else + count = 0; + + if (count == mapcount) + break; + } + + if (count != mapcount) { + pr_err("No Free TRBs count:0x%x, mapcount:0x%x\n", count, mapcount); + return -ENOMEM; + } + + trbChainDesc->reserved = 1; + trbChainDesc->channel = channel; + trbChainDesc->actualLen = 0; + trbChainDesc->mapSize = mapcount; + trbChainDesc->numOfTrbs = numOfTrbs; + trbChainDesc->start = (i + 1 - mapcount) << 3; + trbChainDesc->end = trbChainDesc->start; + trbChainDesc->trbPool = (struct DMA_Trb *)priv->trbPoolAddr + trbChainDesc->start; + trbChainDesc->trbDMAAddr = (uint32_t)(uintptr_t)((struct DMA_Trb *)priv->trbDMAPoolAddr + + trbChainDesc->start); + trbChainDesc->isoError = 0; + + list_add_tail(&trbChainDesc->chainNode, &channel->trbChainDescList); + + channel->numOfTrbChain++; + + for (j = 0; j < count; j++) + priv->trbChainFreeMap[i - j] = 0xFF; + + *chain = trbChainDesc; + + return 0; +} + +static int32_t phytium_dma_channelProgram(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel, uint16_t packetSize, uintptr_t dmaAddr, + uint32_t len, void *framesDesc, uint32_t framesNumber) +{ + uint32_t numOfTrbs; + uint8_t retval; + struct DMA_TrbChainDesc *trbChainDesc; + + if (!priv || !channel) + return -EINVAL; + + //printk(KERN_ERR "%s %d\n",__func__,__LINE__); + if (framesDesc && priv->isHostCtrlMode && channel->isIsoc) + numOfTrbs = framesNumber; + else + numOfTrbs = divRoundUp(len, channel->maxTrbLen); + + retval = phytium_dma_TrbChainAlloc(priv, channel, numOfTrbs, &trbChainDesc); + if (retval) + return retval; + + trbChainDesc->dwStartAddress = dmaAddr; + trbChainDesc->len = len; + trbChainDesc->framesDesc = framesDesc; + + channel->wMaxPacketSize = packetSize; + phytium_dma_NewTd(priv, trbChainDesc); + channel->lastTransferLength = 0; + phytium_dma_ArmTd(priv, trbChainDesc); + + channel->status = DMA_STATUS_BUSY; + + return 0; +} + +static enum DMA_Status phytium_dma_getChannelStatus(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel) +{ + uint32_t ep_cmd, ep_sts; + + if (!priv || !channel) + return DMA_STATUS_UNKNOW; + + if (channel->status >= DMA_STATUS_BUSY) { + phytium_write32(&priv->regs->ep_sel, channel->isDirTx | channel->hwUsbEppNum); + ep_cmd = phytium_read32(&priv->regs->ep_cmd); + ep_sts = phytium_read32(&priv->regs->ep_sts); + + if ((ep_cmd & DMARF_EP_DRDY) || (ep_sts & DMARF_EP_DBUSY)) + channel->status = DMA_STATUS_ARMED; + else + channel->status = DMA_STATUS_BUSY; + } + + return channel->status; +} + +static int32_t phytium_dma_channelAbort(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) +{ + struct DMA_TrbChainDesc *trbChainDesc; + uint32_t ep_cfg, i; + + if (!priv || !channel) + return -EINVAL; + + if (phytium_dma_getChannelStatus(priv, channel) >= DMA_STATUS_BUSY) + phytium_write32(&priv->regs->conf, DMARF_RESET); + + phytium_write32(&priv->regs->ep_sel, (uint32_t)(channel->isDirTx | channel->hwUsbEppNum)); + ep_cfg = phytium_read32(&priv->regs->ep_cfg); + ep_cfg &= ~DMARV_EP_ENABLED; + phytium_write32(&priv->regs->ep_cfg, ep_cfg); + phytium_write32(&priv->regs->ep_sts, 0xFFFFFFFF); + + while (channel->trbChainDescList.next != &channel->trbChainDescList) { + trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); + if (trbChainDesc) { + if (!list_empty(&trbChainDesc->chainNode)) { + for (i = 0; i < trbChainDesc->mapSize; i++) + priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; + + trbChainDesc->channel->numOfTrbChain--; + trbChainDesc->reserved = 0; + list_del(&trbChainDesc->chainNode); + } + } + } + if (channel->status != DMA_STATUS_UNKNOW) + channel->status = DMA_STATUS_FREE; + + return 0; +} + +static int32_t phytium_dma_getActualLength(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) +{ + if (!priv || !channel) + return -EINVAL; + + return channel->lastTransferLength; +} + +static int32_t phytium_dma_getMaxLength(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) +{ + if (!priv || !channel) + return -EINVAL; + + return channel->maxTdLen; +} + +static int32_t phytium_dma_setMaxLength(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel, uint32_t val) +{ + if (!priv || !channel) + return -EINVAL; + + if (channel->dmultEnabled) + channel->maxTrbLen = val; + else + channel->maxTrbLen = (val > TD_SING_MAX_TRB_DATA_SIZE) ? + TD_SING_MAX_TRB_DATA_SIZE : val; + + return 0; +} + +static void phytium_dma_setParentPriv(struct DMA_CONTROLLER *priv, void *parent) +{ + if (!priv) + return; + + priv->parent = parent; +} + +void phytium_dma_controllerReset(struct DMA_CONTROLLER *priv) +{ + uint32_t conf; + + if (!priv) + return; + + conf = phytium_read32(&priv->regs->conf); + conf |= DMARF_RESET; + phytium_write32(&priv->regs->conf, conf); + + priv->resubmit = true; +} + +void phytium_dma_setHostMode(struct DMA_CONTROLLER *priv) +{ + if (!priv) + return; + + priv->isHostCtrlMode = 1; +} + +struct DMA_OBJ phytium_dma_Drv = { + .dma_probe = phytium_dma_probe, + .dma_init = phytium_dma_init, + .dma_destroy = phytium_dma_destroy, + .dma_start = phytium_dma_start, + .dma_stop = phytium_dma_stop, + .dma_isr = phytium_dma_isr, + .dma_errIsr = phytium_dma_errIsr, + .dma_channelAlloc = phytium_dma_channelAlloc, + .dma_channelRelease = phytium_dma_channelRelease, + .dma_channelProgram = phytium_dma_channelProgram, + .dma_channelAbort = phytium_dma_channelAbort, + .dma_getChannelStatus = phytium_dma_getChannelStatus, + .dma_getActualLength = phytium_dma_getActualLength, + .dma_getMaxLength = phytium_dma_getMaxLength, + .dma_setMaxLength = phytium_dma_setMaxLength, + .dma_setParentPriv = phytium_dma_setParentPriv, + .dma_controllerReset = phytium_dma_controllerReset, + .dma_setHostMode = phytium_dma_setHostMode, +}; + +struct DMA_OBJ *DMA_GetInstance(void) +{ + return &phytium_dma_Drv; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/dma.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/dma.h new file mode 100644 index 0000000000000000000000000000000000000000..073a078c1289625ce4bec236498aa49e651c7375 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/dma.h @@ -0,0 +1,198 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef __PHYTIUM_DMA_H__ +#define __PHYTIUM_DMA_H__ + +#include +//#include "list.h" + +#define NUM_OF_TRB 1024 +#define TRB_MAP_SIZE ((NUM_OF_TRB + (sizeof(uint8_t) * 8) - 1) / (sizeof(uint8_t) * 8)) +#define MAX_DMA_CHANNELS 16 +#define TAB_SIZE_OF_DMA_CHAIN (MAX_DMA_CHANNELS * 2) + +#define DMARD_EP_TX 0x80ul +#define DMARD_EP_RX 0x00ul + +#define DMARF_EP_EPRST 0x00000001ul +#define DMARF_EP_DRDY 0x00000040ul +#define DMARF_EP_DFLUSH 0x00000080ul + +#define DMARF_EP_IOC 0x4ul +#define DMARF_EP_ISP 0x8ul +#define DMARF_EP_DESCMIS 0x10ul +#define DMARF_EP_TRBERR 0x80ul +#define DMARF_EP_DBUSY 0x200ul +#define DMARF_EP_CCS 0x800ul +#define DMARF_EP_OUTSMM 0x4000ul +#define DMARF_EP_ISOERR 0x8000ul +#define DMARF_EP_DTRANS 0x80000000ul + +#define DMARV_EP_DISABLED 0ul +#define DMARV_EP_ENABLED 1ul +#define DMARV_EP_DSING 0x1000ul +#define DMARV_EP_DMULT 0x2000ul + +#define TD_SIZE_MASK 0x00001FFFF + +#define DMARF_RESET 0x00000001ul +#define DMARF_DSING 0x00000100ul +#define DMARF_DMULT 0x00000200ul + +#define TD_DMULT_MAX_TRB_DATA_SIZE 65536u +#define TD_DMULT_MAX_TD_DATA_SIZE (~1u) +#define TD_SING_MAX_TRB_DATA_SIZE 65536u +#define TD_SING_MAX_TD_DATA_SIZE 65536u + +#define TD_TYPE_NORMAL 0x400L +#define TD_TYPE_LINK 0x1800L +#define TDF_CYCLE_BIT 0x1L +#define TDF_TOGGLE_CYCLE_BIT 0x2L +#define TDF_INT_ON_SHORT_PACKET 0x4L +#define TDF_FIFO_MODE 0x8L +#define TDF_CHAIN_BIT 0x10L +#define TDF_INT_ON_COMPLECTION 0x20L +#define TDF_STREAMID_VALID 0x200L + +struct DMA_Trb { + uint32_t dmaAddr; + uint32_t dmaSize; /* 0:16 transfer length; 24:31 burst length */ + uint32_t ctrl; +}; + +enum DMA_Status { + DMA_STATUS_UNKNOW, + DMA_STATUS_FREE, + DMA_STATUS_ABORT, + DMA_STATUS_BUSY, + DMA_STATUS_ARMED +}; + +struct DMA_CFG { + uintptr_t regBase; + uint16_t dmaModeTx; + uint16_t dmaModeRx; + void *trbAddr; + uintptr_t trbDmaAddr; +}; + +struct DMA_SYSREQ { + uint32_t privDataSize; + uint32_t trbMemSize; +}; + +struct DMA_CALLBACKS { + void (*complete)(void *pD, uint8_t epNum, uint8_t dir, bool resubmit); +}; + +struct DMA_CONTROLLER; + +struct DMA_Channel { + struct DMA_CONTROLLER *controller; + uint16_t wMaxPacketSize; + uint8_t hwUsbEppNum; + uint8_t isDirTx; + uint32_t maxTdLen; + uint32_t maxTrbLen; + enum DMA_Status status; + void *priv; + uint32_t dmultGuard; + uint8_t dmultEnabled; + uint8_t numOfTrbChain; + struct list_head trbChainDescList; + uint32_t lastTransferLength; + uint8_t isIsoc; +}; + +struct DMA_OBJ { + int32_t (*dma_probe)(struct DMA_CFG *config, struct DMA_SYSREQ *sysReq); + + int32_t (*dma_init)(struct DMA_CONTROLLER *priv, const struct DMA_CFG *config, + struct DMA_CALLBACKS *callbacks); + + void (*dma_destroy)(struct DMA_CONTROLLER *priv); + + int32_t (*dma_start)(struct DMA_CONTROLLER *priv); + + uint32_t (*dma_stop)(struct DMA_CONTROLLER *priv); + + void (*dma_isr)(struct DMA_CONTROLLER *priv); + + void (*dma_errIsr)(struct DMA_CONTROLLER *priv, uint8_t irqNr, uint8_t isDirTx); + + void * (*dma_channelAlloc)(struct DMA_CONTROLLER *priv, + uint8_t isDirTx, uint8_t hwEpNum, uint8_t isIso); + + int32_t (*dma_channelRelease)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); + + int32_t (*dma_channelProgram)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel, + uint16_t packetSize, uintptr_t dmaAddr, + uint32_t len, void *framesDesc, uint32_t framesNumber); + + int32_t (*dma_channelAbort)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); + + enum DMA_Status (*dma_getChannelStatus)(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel); + + int32_t (*dma_getActualLength)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); + + int32_t (*dma_getMaxLength)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); + + int32_t (*dma_setMaxLength)(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel, uint32_t val); + + void (*dma_setParentPriv)(struct DMA_CONTROLLER *priv, void *parent); + + void (*dma_controllerReset)(struct DMA_CONTROLLER *priv); + + void (*dma_setHostMode)(struct DMA_CONTROLLER *priv); +}; + +enum DMA_Mode { + DMA_MODE_GLOBAL_DMULT, + DMA_MODE_GLOBAL_DSING, + DMA_MODE_CHANNEL_INDIVIDUAL, +}; + +struct DMA_TrbFrameDesc { + uint32_t length; + uint32_t offset; +}; + +struct DMA_TrbChainDesc { + uint8_t reserved; + struct DMA_Channel *channel; + struct DMA_Trb *trbPool; + uint32_t trbDMAAddr; + uint32_t len; + uint32_t dwStartAddress; + uint32_t actualLen; + uint8_t isoError; + uint8_t lastTrbIsLink; + uint32_t mapSize; + uint32_t numOfTrbs; + uint32_t start; + uint32_t end; + struct DMA_TrbFrameDesc *framesDesc; + struct list_head chainNode; +}; + +struct DMA_CONTROLLER { + struct DMARegs *regs; + struct DMA_OBJ *dmaDrv; + struct DMA_CFG dmaCfg; + struct DMA_CALLBACKS dmaCallbacks; + struct DMA_Channel rx[MAX_DMA_CHANNELS]; + struct DMA_Channel tx[MAX_DMA_CHANNELS]; + enum DMA_Mode dmaMode; + uint8_t isHostCtrlMode; + void *parent; + void *trbPoolAddr; + uintptr_t trbDMAPoolAddr; + uint8_t trbChainFreeMap[TRB_MAP_SIZE]; + struct DMA_TrbChainDesc trbChainDesc[TAB_SIZE_OF_DMA_CHAIN]; + bool resubmit; +}; + +struct DMA_OBJ *DMA_GetInstance(void); +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/gadget.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/gadget.c new file mode 100644 index 0000000000000000000000000000000000000000..afcb846c8db342444c4bb853bd92bfd7559c5630 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/gadget.c @@ -0,0 +1,2538 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include +#include "gadget.h" +#include "dma.h" +#include "core.h" +#include "hw-regs.h" + +#define DRV_NAME "phytium_gadget" + +#define GADGET_PRIV_BUFFER_SIZE 64 +#define GADGET_USB_EP_NUMBER_MASK 0xf +#define DMA_ADDR_INVALID (~(dma_addr_t)0) + +#define GADGET_ESTALL 1 +#define GADGET_EUNHANDLED 2 +#define GADGET_EAUTOACK 3 +#define GADGET_ESHUTDOWN 4 +#define GADGET_ECONNRESET 5 +#define GADGET_EAGAIN 6 + +static inline struct GadgetEp *toGadgetEp(struct GADGET_EP *gadget_Ep) +{ + return (struct GadgetEp *)((uintptr_t)gadget_Ep - + ((uintptr_t)&((struct GadgetEp *)0)->gadgetEp)); +} + +static inline struct GadgetRequest *requestToGadgetRequest(struct GADGET_REQ *req) +{ + return (struct GadgetRequest *)((uintptr_t)req - + ((uintptr_t)&((struct GadgetRequest *)0)->request)); +} + +static inline struct GADGET_REQ *listToGadgetRequest(struct list_head *list) +{ + return (struct GADGET_REQ *)((uintptr_t)list - + ((uintptr_t)&((struct GADGET_REQ *)0)->list)); +} + +#define listBrowsingRequest(iterator, head, memeber) \ + for (iterator = listToGadgetRequest((head)->next); \ + &iterator->list != (head); \ + iterator = listToGadgetRequest(iterator->list.next)) + +static inline struct GADGET_REQ *gadgetGetNextReq(struct GadgetEp *gadgetEp) +{ + struct list_head *list = &gadgetEp->request; + + if (list_empty(list)) { + pr_debug("no request available for %s\n", gadgetEp->gadgetEp.name); + return NULL; + } + + return listToGadgetRequest(list->next); +} + +static inline struct GADGET_REQ *gadgetGetNextEp0Req(struct GADGET_CTRL *priv) +{ + struct list_head *queue; + + if (!priv) + return NULL; + + queue = &priv->in[0].request; + + if (list_empty(queue)) + return NULL; + + return listToGadgetRequest(queue->next); +} + +void gadget_giveback(struct phytium_ep *phy_ep, struct usb_request *usb_req, int status) +{ + struct phytium_request *phy_req; + struct phytium_cusb *config; + int busy; + + if (!phy_ep || !usb_req) + return; + + busy = phy_ep->busy; + phy_req = usb_req ? container_of(usb_req, struct phytium_request, request) : NULL; + config = phy_req->config; + + list_del(&phy_req->list); + + if (usb_req->status == -EINPROGRESS) { + if (status == GADGET_ESHUTDOWN) + usb_req->status = -ESHUTDOWN; + else if (status == GADGET_ECONNRESET) + usb_req->status = -ECONNRESET; + else + usb_req->status = -phy_req->gadget_request->status; + } + + if (usb_req->status == 0) + pr_debug("%s done request %p, %d/%d\n", phy_ep->end_point.name, + usb_req, usb_req->actual, usb_req->length); + else + pr_debug("%s request %p, %d/%d fault %d\n", phy_ep->end_point.name, + usb_req, usb_req->actual, usb_req->length, usb_req->status); + + usb_gadget_unmap_request(&config->gadget, &phy_req->request, phy_req->is_tx); + + busy = phy_ep->busy; + phy_ep->busy = 1; + + spin_unlock(&config->lock); + + if (phy_req->request.complete) + phy_req->request.complete(&phy_req->ep->end_point, usb_req); + + spin_lock(&config->lock); + + phy_ep->busy = busy; +} + +static void gadget_callback_complete(struct GADGET_EP *gadget_ep, struct GADGET_REQ *gadget_req) +{ + struct phytium_ep *phy_ep; + struct phytium_request *phy_req; + struct usb_request *usb_req; + + if (!gadget_ep || !gadget_req) + return; + + phy_req = gadget_req->context; + usb_req = &phy_req->request; + phy_ep = phy_req->ep; + usb_req->actual = gadget_req->actual; + usb_req->length = gadget_req->length; + + gadget_giveback(phy_ep, usb_req, gadget_req->status); +} + +static void gadgetDisconnect(struct GADGET_CTRL *priv) +{ + pr_info("Disconnect USB Device Driver\n"); + + if (!priv) + return; + + priv->gadgetDev.speed = USB_SPEED_UNKNOWN; + priv->gadgetDev.state = USB_STATE_NOTATTACHED; + + if (priv->eventCallback.disconnect) + priv->eventCallback.disconnect(priv); +} + +static int gadget_get_frame(struct usb_gadget *gadget) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return 0; +} + +static int gadget_wakeup(struct usb_gadget *gadget) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return 0; +} + +static int gadget_vbus_session(struct usb_gadget *gadget, int is_active) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return 0; +} + +static int gadget_vbus_draw(struct usb_gadget *gadget, unsigned int mA) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return 0; +} + +static int gadget_pullup(struct usb_gadget *gadget, int is_on) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return 0; +} + +static int gadget_udc_start(struct usb_gadget *gadget, struct usb_gadget_driver *driver) +{ + unsigned long flags; + struct phytium_cusb *config; + struct GADGET_CTRL *priv; + uint32_t gen_cfg; + + if (!gadget || !driver) + return -EINVAL; + + if (driver->max_speed < USB_SPEED_HIGH) + return -EINVAL; + + config = container_of(gadget, struct phytium_cusb, gadget); + + pr_info("registering driver %s\n", driver->function); + + spin_lock_irqsave(&config->lock, flags); + config->gadget_driver = driver; + spin_unlock_irqrestore(&config->lock, flags); + + config->gadget_obj->gadget_start(config->gadget_priv); + + priv = (struct GADGET_CTRL *)config->gadget_priv; + if (priv->phy_regs) { + gen_cfg = phytium_read32(&priv->phy_regs->gen_cfg); + gen_cfg = gen_cfg & (~BIT(7)); + phytium_write32(&priv->phy_regs->gen_cfg, gen_cfg); + } + + return 0; +} + +static int gadget_udc_stop(struct usb_gadget *gadget) +{ + struct phytium_cusb *config; + unsigned long flags; + struct GADGET_CTRL *priv; + uint32_t gen_cfg; + + if (!gadget) + return -EINVAL; + + config = container_of(gadget, struct phytium_cusb, gadget); + + priv = (struct GADGET_CTRL *)config->gadget_priv; + if (priv->phy_regs) { + gen_cfg = phytium_read32(&priv->phy_regs->gen_cfg); + gen_cfg = gen_cfg | BIT(7); + phytium_write32(&priv->phy_regs->gen_cfg, gen_cfg); + } + spin_lock_irqsave(&config->lock, flags); + config->gadget_driver = NULL; + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static struct usb_gadget_ops phytium_gadget_ops = { + .get_frame = gadget_get_frame, + .wakeup = gadget_wakeup, + .vbus_session = gadget_vbus_session, + .vbus_draw = gadget_vbus_draw, + .pullup = gadget_pullup, + .udc_start = gadget_udc_start, + .udc_stop = gadget_udc_stop, +}; + +static int gadget_ep_enable(struct usb_ep *ls_ep, const struct usb_endpoint_descriptor *desc) +{ + struct phytium_ep *phy_ep = NULL; + struct phytium_cusb *config; + unsigned long flags; + + if (!ls_ep || !desc) + return -EINVAL; + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + + if (phy_ep->desc) + return -EBUSY; + + spin_lock_irqsave(&config->lock, flags); + + phy_ep->desc = desc; + phy_ep->busy = 0; + config->gadget_obj->gadget_epEnable(config->gadget_priv, phy_ep->gadget_ep, desc); + + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static int gadget_ep_disable(struct usb_ep *ls_ep) +{ + struct phytium_ep *phy_ep = NULL; + struct phytium_cusb *config; + unsigned long flags; + + if (!ls_ep) + return -EBUSY; + + pr_info("%s %d\n", __func__, __LINE__); + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + + spin_lock_irqsave(&config->lock, flags); + + phy_ep->desc = NULL; + phy_ep->busy = 0; + phy_ep->end_point.desc = NULL; + config->gadget_obj->gadget_epDisable(config->gadget_priv, phy_ep->gadget_ep); + + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static struct usb_request *gadget_ep_alloc_request(struct usb_ep *ls_ep, gfp_t gfp_flags) +{ + struct phytium_ep *phy_ep; + struct phytium_cusb *config; + struct GADGET_EP *gadget_ep; + struct phytium_request *phy_request; + + if (!ls_ep) + return NULL; + + pr_info("%s %d\n", __func__, __LINE__); + phy_request = kzalloc(sizeof(*phy_request), gfp_flags); + if (!phy_request) { + pr_err("not enough momory\n"); + return NULL; + } + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + gadget_ep = phy_ep->gadget_ep; + + INIT_LIST_HEAD(&phy_request->list); + phy_request->request.dma = DMA_ADDR_INVALID; + phy_request->epnum = phy_ep->ep_num; + phy_request->ep = phy_ep; + phy_request->config = phy_ep->config; + + config->gadget_obj->gadget_reqAlloc(config->gadget_priv, gadget_ep, + &phy_request->gadget_request); + + return &phy_request->request; +} + +static void gadget_ep_free_request(struct usb_ep *ls_ep, struct usb_request *ls_req) +{ + struct phytium_ep *phy_ep; + struct phytium_cusb *config; + struct phytium_request *phy_request; + + if (!ls_ep || !ls_req) + return; + + pr_info("%s %d\n", __func__, __LINE__); + phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; + config = phy_request->config; + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + + config->gadget_obj->gadget_reqFree(config->gadget_priv, phy_ep->gadget_ep, + phy_request->gadget_request); + kfree(phy_request); +} + +static int gadget_ep_enqueue(struct usb_ep *ls_ep, struct usb_request *ls_req, gfp_t gfp_flags) +{ + struct phytium_ep *phy_ep; + struct phytium_cusb *config; + struct phytium_request *phy_request; + unsigned long flags; + int status = 0; + + if (!ls_ep || !ls_req) + return -EINVAL; + + if (!ls_req->buf) + return -ENODATA; + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; + phy_request->config = config; + + if (phy_request->ep != phy_ep) + return -EINVAL; + + phy_request->request.actual = 0; + phy_request->request.status = -EINPROGRESS; + phy_request->epnum = phy_ep->ep_num; + phy_request->is_tx = phy_ep->is_tx; + + phy_request->gadget_request->length = ls_req->length; + phy_request->gadget_request->status = 0; + phy_request->gadget_request->complete = gadget_callback_complete; + phy_request->gadget_request->buf = ls_req->buf; + phy_request->gadget_request->context = ls_req; + + status = usb_gadget_map_request(&config->gadget, &phy_request->request, phy_request->is_tx); + + if (!phy_ep->desc) { + pr_debug("req %p queued to %s while ep %s\n", phy_request, ls_ep->name, "disabled"); + status = -ESHUTDOWN; + usb_gadget_unmap_request(&config->gadget, &phy_request->request, + phy_request->is_tx); + return status; + } + + spin_lock_irqsave(&config->lock, flags); + + phy_request->gadget_request->dma = phy_request->request.dma; + list_add_tail(&phy_request->list, &phy_ep->req_list); + + pr_debug("queue to %s (%s), length = %d\n", phy_ep->name, + phy_ep->is_tx ? "IN/TX" : "OUT/RX", phy_request->request.length); + + status = config->gadget_obj->gadget_reqQueue(config->gadget_priv, phy_ep->gadget_ep, + phy_request->gadget_request); + + spin_unlock_irqrestore(&config->lock, flags); + + return status; +} + +static int gadget_ep_dequeue(struct usb_ep *ls_ep, struct usb_request *ls_req) +{ + struct phytium_ep *phy_ep; + struct phytium_cusb *config; + unsigned long flags; + int status = 0; + struct phytium_request *phy_request; + struct phytium_request *phy_next_request; + + if (!ls_ep || !ls_req) + return -EINVAL; + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; + + if (phy_request->ep != phy_ep) + return -EINVAL; + + spin_lock_irqsave(&config->lock, flags); + + list_for_each_entry(phy_next_request, &phy_ep->req_list, list) { + if (phy_next_request == phy_request) + break; + } + + if (phy_next_request != phy_request) { + pr_info("request %p not queued to %s\n", phy_request, ls_ep->name); + status = -EINVAL; + goto done; + } + + status = config->gadget_obj->gadget_reqDequeue(config->gadget_priv, phy_ep->gadget_ep, + phy_request->gadget_request); +done: + spin_unlock_irqrestore(&config->lock, flags); + return status; +} + +static int gadget_ep_set_halt(struct usb_ep *ls_ep, int value) +{ + struct phytium_ep *phy_ep; + struct phytium_cusb *config; + struct GADGET_EP *gadget_ep = NULL; + unsigned long flags; + int status = 0; + + if (!ls_ep) + return -EINVAL; + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + gadget_ep = phy_ep->gadget_ep; + + spin_lock_irqsave(&config->lock, flags); + + status = config->gadget_obj->gadget_epSetHalt(config->gadget_priv, + phy_ep->gadget_ep, value); + if (status > 0) { + spin_unlock_irqrestore(&config->lock, flags); + return -status; + } + + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static const struct usb_ep_ops gadget_ep_ops = { + .enable = gadget_ep_enable, + .disable = gadget_ep_disable, + .alloc_request = gadget_ep_alloc_request, + .free_request = gadget_ep_free_request, + .queue = gadget_ep_enqueue, + .dequeue = gadget_ep_dequeue, + .set_halt = gadget_ep_set_halt, +}; + +static int gadget_ep0_enable(struct usb_ep *ep, const struct usb_endpoint_descriptor *desc) +{ + return -EINVAL; +} + +static int gadget_ep0_disable(struct usb_ep *ep) +{ + return -EINVAL; +} + +static int gadget_ep0_enqueue(struct usb_ep *ls_ep, struct usb_request *ls_req, gfp_t gfp_flags) +{ + struct phytium_ep *phy_ep; + struct phytium_request *phy_request; + struct phytium_cusb *config; + int status = 0; + unsigned long flags; + + if (!ls_ep || !ls_req) + return -EINVAL; + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; + + spin_lock_irqsave(&config->lock, flags); + + if (!list_empty(&phy_ep->req_list)) { + status = -EBUSY; + goto cleanup; + } + + phy_request->config = config; + phy_request->request.actual = 0; + phy_request->gadget_request->actual = 0; + phy_request->is_tx = config->ep0_data_stage_is_tx; + phy_request->gadget_request->length = phy_request->request.length; + phy_request->gadget_request->status = 0; + phy_request->gadget_request->complete = gadget_callback_complete; + phy_request->gadget_request->buf = phy_request->request.buf; + phy_request->gadget_request->context = phy_request; + + status = usb_gadget_map_request(&config->gadget, &phy_request->request, phy_request->is_tx); + if (status) { + pr_info("failed to map request\n"); + status = -EINVAL; + goto cleanup; + } + + phy_request->gadget_request->dma = phy_request->request.dma; + list_add_tail(&phy_request->list, &phy_ep->req_list); + + pr_debug("queue to %s (%s), length = %d\n", phy_ep->name, + phy_ep->is_tx ? "IN/TX" : "OUT/RX", phy_request->request.length); + + status = config->gadget_obj->gadget_reqQueue(config->gadget_priv, phy_ep->gadget_ep, + phy_request->gadget_request); + if (status > 0) { + status = -status; + usb_gadget_unmap_request(&config->gadget, &phy_request->request, + phy_request->is_tx); + list_del(&phy_request->list); + goto cleanup; + } + +cleanup: + spin_unlock_irqrestore(&config->lock, flags); + return status; +} + +static int gadget_ep0_dequeue(struct usb_ep *ep, struct usb_request *ls_request) +{ + return -EOPNOTSUPP; +} + +static int gadget_ep0_set_halt(struct usb_ep *ep, int value) +{ + return -EINVAL; +} + + +static const struct usb_ep_ops gadget_ep0_ops = { + .enable = gadget_ep0_enable, + .disable = gadget_ep0_disable, + .alloc_request = gadget_ep_alloc_request, + .free_request = gadget_ep_free_request, + .queue = gadget_ep0_enqueue, + .dequeue = gadget_ep0_dequeue, + .set_halt = gadget_ep0_set_halt, +}; + +static int32_t gadgetWaitForBusyBit(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) +{ + struct GadgetEp *gadgetEp; + uint8_t epNum; + uint8_t txcs = CS_BUSY; + uint8_t buf = 0; + uint8_t bufflag = 0; + + if (!priv || !gadget_Ep) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + epNum = gadgetEp->hwEpNum; + + if (gadgetEp->isInEp || gadgetEp->hwEpNum == 0) + return 0; + + buf = phytium_read8(&priv->regs->ep[epNum - 1].txcon) & CON_BUF; + + while ((txcs & CS_BUSY) || (bufflag == 0)) { + txcs = phytium_read8(&priv->regs->ep[epNum - 1].txcs); + + if (((txcs & CS_NPAK) >> CS_NPAK_OFFSET) == buf || buf == 0) + bufflag = 1; + else + bufflag = 0; + } + + return 0; +} + +static inline void gadgetEpXDataReceive(struct GADGET_CTRL *priv, + struct GadgetRequest *gadgetRequest) +{ + struct GadgetEp *gadgetEp; + struct GADGET_REQ *gadgetReq; + uint8_t epType; + uint32_t requestSize, channelStatus, chMaxLen; + + if (!priv || !gadgetRequest) + return; + + gadgetEp = gadgetRequest->ep; + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); + epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; + channelStatus = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, gadgetEp->channel); + + gadgetReq = &gadgetRequest->request; + if (gadgetReq->actual < gadgetReq->length || gadgetRequest->zlp) { + gadgetRequest->zlp = 0; + if ((gadgetReq->length - gadgetReq->actual) < chMaxLen) + requestSize = gadgetReq->length - gadgetReq->actual; + else + requestSize = chMaxLen; + + priv->dmaDrv->dma_channelProgram(priv->dmaController, gadgetEp->channel, + gadgetEp->gadgetEp.maxPacket, + gadgetReq->dma + gadgetReq->actual, requestSize, NULL, 0); + } +} + +static inline void gadgetEpXDataSend(struct GADGET_CTRL *priv, struct GadgetRequest *gadgetRequest) +{ + struct GadgetEp *gadgetEp; + struct GADGET_REQ *gadgetReq; + uint8_t epType; + uint32_t requestSize, channelStatus, chMaxLen; + + if (!priv || !gadgetRequest) + return; + + gadgetEp = gadgetRequest->ep; + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); + epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; + channelStatus = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, gadgetEp->channel); + + gadgetReq = &gadgetRequest->request; + if ((gadgetReq->length - gadgetReq->actual) < chMaxLen) + requestSize = gadgetReq->length - gadgetReq->actual; + else + requestSize = chMaxLen; + pr_debug("Transmit/IN %s gadgetReq %p gadgetRequest:%p requestSize:0x%x packetSize:0x%x\n", + gadgetEp->gadgetEp.name, gadgetReq, gadgetRequest, + requestSize, gadgetEp->gadgetEp.maxPacket); + + gadgetRequest->zlp = 0; + priv->dmaDrv->dma_channelProgram(priv->dmaController, gadgetEp->channel, + gadgetEp->gadgetEp.maxPacket, + gadgetReq->dma + gadgetReq->actual, requestSize, NULL, 0); +} + +static int32_t gadgetEpXSetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + uint8_t value) +{ + struct GadgetEp *gadgetEp; + uint8_t epType; + struct GADGET_REQ *req = NULL; + struct GadgetRequest *gadgetRequest = NULL; + uint8_t epNum, txcon, rxcon; + uint32_t status = DMA_STATUS_ARMED; + + if (!priv || !gadget_Ep) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; + if (epType == USB_ENDPOINT_XFER_ISOC) + return -EINVAL; + + pr_debug("%s: %s stall\n", gadget_Ep->name, value ? "set" : "clear"); + req = gadgetGetNextReq(gadgetEp); + + if (!value) + gadgetEp->wedged = 0; + + if (value && gadgetEp->isInEp && req && gadgetEp->state == GADGET_EP_BUSY) { + while (status == DMA_STATUS_ARMED) + status = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, + gadgetEp->channel); + + gadgetWaitForBusyBit(priv, gadget_Ep); + } + + epNum = gadgetEp->hwEpNum; + + if (gadgetEp->isInEp) { + txcon = phytium_read8(&priv->regs->ep[epNum - 1].txcon); + if (value) { + phytium_write8(&priv->regs->ep[epNum - 1].txcon, txcon | CON_STALL); + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, + ENDPRST_IO_TX | epNum | ENDPRST_FIFORST); + + } else { + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, + ENDPRST_IO_TX | epNum | ENDPRST_TOGRST); + phytium_write8(&priv->regs->ep[epNum - 1].txcon, txcon & (~CON_STALL)); + } + } else { + rxcon = phytium_read8(&priv->regs->ep[epNum - 1].rxcon); + if (value) { + phytium_write8(&priv->regs->ep[epNum - 1].rxcon, rxcon | CON_STALL); + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, epNum | ENDPRST_FIFORST); + } else { + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, + epNum | ENDPRST_TOGRST | ENDPRST_FIFORST); + phytium_write8(&priv->regs->ep[epNum - 1].rxcon, rxcon & (~CON_STALL)); + } + } + + if (gadgetEp->state != GADGET_EP_BUSY && !value && req) { + gadgetRequest = requestToGadgetRequest(req); + if (gadgetEp->isInEp) + gadgetEpXDataSend(priv, gadgetRequest); + else + gadgetEpXDataReceive(priv, gadgetRequest); + } + + return 0; +} + +static int32_t gadgetEp0SetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + uint8_t value) +{ + struct GadgetEp *gadgetEp; + + if (!priv || !gadget_Ep) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + if (!list_empty(&gadgetEp->request)) + return -EBUSY; + + switch (priv->ep0State) { + case GADGET_EP0_STAGE_IN: + case GADGET_EP0_STAGE_OUT: + case GADGET_EP0_STAGE_ACK: + case GADGET_EP0_STAGE_STATUSIN: + case GADGET_EP0_STAGE_STATUSOUT: + priv->ep0State = GADGET_EP0_STAGE_SETUP; + break; + default: + return -EINVAL; + } + + return 0; +} + + +static void gadgetEp0Callback(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req, uint8_t status) +{ + if (!priv || !gadgetEp || !req) + return; + + priv->ep0State = GADGET_EP0_STAGE_SETUP; + list_del(&req->list); + gadgetEp->requestsInList--; + + if (req->status == EINPROGRESS) + req->status = status; + + if (req->complete) + req->complete(&gadgetEp->gadgetEp, req); +} + +static enum usb_device_speed gadgetGetActualSpeed(struct GADGET_CTRL *priv) +{ + uint8_t speedctrl; + + if (!priv) + return USB_SPEED_UNKNOWN; + + speedctrl = phytium_read8(&priv->regs->speedctrl) & (~SPEEDCTRL_HSDISABLE); + switch (speedctrl) { + case SPEEDCTRL_HS: + return USB_SPEED_HIGH; + case SPEEDCTRL_FS: + return USB_SPEED_FULL; + case SPEEDCTRL_LS: + return USB_SPEED_LOW; + default: + return USB_SPEED_UNKNOWN; + } +} + +static int32_t gadgetServiceSetFeatureReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) +{ + uint8_t epNum, isIn; + struct GadgetEp *gadgetEp; + + if (!priv || !setup) + return 0; + + switch (setup->bRequestType & USB_RECIP_MASK) { + case USB_RECIP_DEVICE: + switch (setup->wValue) { + case USB_DEVICE_REMOTE_WAKEUP: + pr_info("set feature - remote wakup\n"); + priv->isRemoteWakeup = 1; + break; + case USB_DEVICE_B_HNP_ENABLE: + pr_info("set feature - B HNP Enable\n"); + pr_info("otg not implement\n"); + return -EINVAL; + case USB_DEVICE_A_HNP_SUPPORT: + pr_info("set feature - A HNP support\n"); + pr_info("otg not implete\n"); + return -EINVAL; + } + break; + case USB_RECIP_INTERFACE: + break; + case USB_RECIP_ENDPOINT: + epNum = setup->wIndex & 0x0f; + isIn = setup->wIndex & USB_DIR_IN; + if (epNum == 0 || epNum > 15 || setup->wValue != 0) + return -EINVAL; + + gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; + + gadgetEpXSetHalt(priv, &gadgetEp->gadgetEp, 1); + break; + default: + return -EINVAL; + } + return 0; +} + +static int32_t gadgetServiceClearFeatureReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) +{ + uint8_t epNum, isIn; + struct GadgetEp *gadgetEp; + + if (!priv || !setup) + return -EINVAL; + + switch (setup->bRequestType & USB_RECIP_MASK) { + case USB_RECIP_DEVICE: + if (setup->wValue == USB_DEVICE_B_HNP_ENABLE) { + pr_err("otg not implement\n"); + return -EINVAL; + } + + if (setup->wValue != USB_DEVICE_REMOTE_WAKEUP) + return GADGET_EUNHANDLED; + + priv->isRemoteWakeup = 0; + return GADGET_EAUTOACK; + case USB_RECIP_INTERFACE: + break; + case USB_RECIP_ENDPOINT: + pr_info("clear feature wIndex:0x%x wValue:0x%x\n", setup->wIndex, setup->wValue); + epNum = setup->wIndex & 0x7f; + isIn = setup->wIndex & USB_DIR_IN; + if (epNum == 0 || epNum > 15 || setup->wValue != 0) + return GADGET_EUNHANDLED; + + gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; + if (!gadgetEp->gadgetEp.desc) + return -EINVAL; + + if (gadgetEp->wedged) + break; + gadgetEpXSetHalt(priv, &gadgetEp->gadgetEp, 0); + break; + default: + return GADGET_EUNHANDLED; + } + + return 0; +} + +static int32_t gadgetServiceSetupReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) +{ + struct GadgetEp *gadgetEp; + uint8_t isIn, epNum; + uint8_t rxcon, txcon; + int len; + + if (!priv || !setup) + return -EINVAL; + + if ((setup->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) { + if (setup->bRequest != USB_REQ_GET_STATUS) + return GADGET_EUNHANDLED; + } else + return GADGET_EUNHANDLED; + + priv->privBuffAddr[1] = 0; + priv->privBuffAddr[0] = 0; + + switch (setup->bRequest & USB_RECIP_MASK) { + case USB_RECIP_DEVICE: + pr_info("wIndex:0x%x isSelfPowered:%d isRomoteWakeup:%d\n", + setup->wIndex, priv->isSelfPowered, priv->isRemoteWakeup); + + if (setup->wIndex == OTG_STS_SELECTOR) + priv->privBuffAddr[0] = priv->hostRequestFlag; + else { + priv->privBuffAddr[0] = priv->isSelfPowered ? USB_DEVICE_SELF_POWERED : 0; + priv->privBuffAddr[1] = priv->isRemoteWakeup ? USB_DEVICE_REMOTE_WAKEUP : 0; + } + break; + case USB_RECIP_INTERFACE: + break; + case USB_RECIP_ENDPOINT: + epNum = setup->wIndex & 0x0f; + if (!epNum) + break; + + isIn = setup->wIndex & USB_DIR_IN; + + gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; + if (!gadgetEp->gadgetEp.desc) + return -EINVAL; + + if (isIn) { + txcon = phytium_read8(&priv->regs->ep[epNum - 1].txcon); + priv->privBuffAddr[0] = (txcon & CON_STALL) ? 1 : 0; + } else { + rxcon = phytium_read8(&priv->regs->ep[epNum - 1].rxcon); + priv->privBuffAddr[0] = (rxcon & CON_STALL) ? 1 : 0; + } + break; + default: + return GADGET_EUNHANDLED; + } + + len = setup->wLength; + if (len > 2) + len = 2; + + priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->in[0].channel, + priv->in[0].gadgetEp.maxPacket, priv->privBuffDma, len, NULL, 0); + + return 0; +} + +static int32_t gadgetGetSetup(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) +{ + int i; + uint8_t ep0cs; + struct GADGET_REQ *request = NULL; + struct GadgetRequest *gadgetRequest; + + if (!priv || !setup) + return -EINVAL; + + phytium_write8(&priv->regs->ep0cs, EP0CS_CHGSET); + + for (i = 0; i < 8; i++) + ((char *)setup)[i] = phytium_read8(&priv->regs->setupdat[i]); + + ep0cs = phytium_read8(&priv->regs->ep0cs); + if (ep0cs & EP0CS_CHGSET) { + pr_info("setup flags change: not error\n"); + return GADGET_EAUTOACK; + } + + phytium_write8(&priv->regs->usbirq, USBIR_SUDAV); + pr_debug("setup packet: req%02x.%02x v:%04x i:%04x I%d\n", setup->bRequestType, + setup->bRequest, setup->wValue, setup->wIndex, setup->wLength); + + request = gadgetGetNextEp0Req(priv); + if (request) { + gadgetRequest = requestToGadgetRequest(request); + pr_info("Previous request has not been finished but new was received\n"); + gadgetEp0Callback(priv, gadgetRequest->ep, request, 0); + } + + if (setup->wLength) { + if (setup->bRequestType & USB_DIR_IN) + priv->ep0State = GADGET_EP0_STAGE_IN; + else + priv->ep0State = GADGET_EP0_STAGE_OUT; + } else + priv->ep0State = GADGET_EP0_STAGE_ACK; + + return 0; +} + +static void gadgetEp0StageSetup(struct GADGET_CTRL *priv) +{ + struct usb_ctrlrequest setup; + int32_t retval; + uint8_t ep0cs; + + if (!priv) + return; + + retval = gadgetGetSetup(priv, &setup); + + priv->gadgetDev.speed = gadgetGetActualSpeed(priv); + + switch (priv->ep0State) { + case GADGET_EP0_STAGE_ACK: + if ((setup.bRequestType & USB_TYPE_MASK) != USB_TYPE_STANDARD) + retval = GADGET_EUNHANDLED; + else { + switch (setup.bRequest) { + case USB_REQ_SET_ADDRESS: + priv->deviceAddress = setup.wValue & 0x7F; + priv->gadgetDev.state = USB_STATE_ADDRESS; + pr_info("set address: %d\n", priv->deviceAddress); + retval = GADGET_EAUTOACK; + break; + case USB_REQ_SET_FEATURE: + retval = gadgetServiceSetFeatureReq(priv, &setup); + break; + case USB_REQ_CLEAR_FEATURE: + retval = gadgetServiceClearFeatureReq(priv, &setup); + break; + default: + retval = GADGET_EUNHANDLED; + break; + } + } + + if (retval == GADGET_EUNHANDLED) + break; + else if (retval == 0) + phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); + + priv->ep0State = GADGET_EP0_STAGE_SETUP; + break; + case GADGET_EP0_STAGE_IN: + pr_debug("setup data stage in\n"); + retval = gadgetServiceSetupReq(priv, &setup); + + if (retval == 0) + priv->ep0State = GADGET_EP0_STAGE_STATUSOUT; + break; + case GADGET_EP0_STAGE_OUT: + pr_debug("setup data stage out\n"); + phytium_write8(&priv->regs->ep0Rxbc, 0); + retval = GADGET_EUNHANDLED; + break; + default: + if (retval == GADGET_EAUTOACK) + return; + + pr_debug("forward request\n"); + retval = GADGET_EUNHANDLED; + break; + } + + if (retval == GADGET_EUNHANDLED) { + if (priv->eventCallback.setup) + retval = priv->eventCallback.setup(priv, &setup); + + if (retval == 0x7FFF) { + pr_debug("Respond Delayed not finished yet\n"); + return; + } + + if (retval) + retval = GADGET_ESTALL; + } + + if (retval == GADGET_EUNHANDLED || retval == GADGET_ESTALL) { + pr_debug("request not handled - send stall\n"); + ep0cs = phytium_read8(&priv->regs->ep0cs); + ep0cs |= EP0CS_STALL; + phytium_write8(&priv->regs->ep0cs, ep0cs); + priv->ep0State = GADGET_EP0_STAGE_SETUP; + } else if (priv->ep0State == GADGET_EP0_STAGE_ACK) { + priv->ep0State = GADGET_EP0_STAGE_SETUP; + phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); + pr_debug("setup transfer completed\n"); + } +} +static void gadgetEp0DataSend(struct GADGET_CTRL *priv) +{ + struct GADGET_REQ *request; + uint32_t chMaxLen, requestSize; + + if (!priv) + return; + + request = gadgetGetNextEp0Req(priv); + if (!request) { + pr_debug("Ep0 queue is empty\n"); + return; + } + + if (priv->dmaDrv->dma_getChannelStatus(priv->dmaController, priv->in[0].channel) + >= DMA_STATUS_BUSY) { + pr_err("transfer is pending now\n"); + return; + } + + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, priv->in[0].channel); + requestSize = (request->length < chMaxLen) ? request->length : chMaxLen; + pr_debug("usbRequest;%p requestSize:%d packetSize:%d\n", request, requestSize, + priv->in[0].gadgetEp.maxPacket); + priv->ep0State = GADGET_EP0_STAGE_STATUSOUT; + + priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->in[0].channel, + priv->in[0].gadgetEp.maxPacket, request->dma, requestSize, NULL, 0); +} + +static void gadgetEp0DataReceive(struct GADGET_CTRL *priv) +{ + uint32_t chMaxLen, requestSize; + struct GADGET_REQ *request; + + if (!priv) + return; + + request = gadgetGetNextEp0Req(priv); + if (!request) { + pr_debug("Ep0 queue is empty\n"); + return; + } + + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, priv->out[0].channel); + requestSize = (request->length < chMaxLen) ? request->length : chMaxLen; + pr_debug("usbRequest;%p requestSize:%d packetSize:%d\n", request, requestSize, + priv->out[0].gadgetEp.maxPacket); + priv->ep0State = GADGET_EP0_STAGE_STATUSIN; + + priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->out[0].channel, + priv->out[0].gadgetEp.maxPacket, request->dma, requestSize, NULL, 0); +} + +static uint32_t gadgetEp0Irq(struct GADGET_CTRL *priv) +{ + uint8_t usbcs; + struct GADGET_REQ *request; + + if (!priv) + return 0; + + switch (priv->ep0State) { + case GADGET_EP0_STAGE_IN://send data + pr_debug("DATA Stage IN\n"); + gadgetEp0DataSend(priv); + break; + case GADGET_EP0_STAGE_OUT://receive data + pr_debug("DATA Stage OUT\n"); + gadgetEp0DataReceive(priv); + break; + case GADGET_EP0_STAGE_STATUSIN: + pr_debug("DATA Stage STATUS IN\n"); + request = gadgetGetNextEp0Req(priv); + if (request) + request->actual = priv->dmaDrv->dma_getActualLength(priv->dmaController, + priv->out[0].channel); + + priv->ep0State = GADGET_EP0_STAGE_SETUP; + phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); + gadgetEp0Callback(priv, &priv->out[0], request, 0); + break; + case GADGET_EP0_STAGE_STATUSOUT: + pr_debug("DATA Stage STATUS OUT\n"); + request = gadgetGetNextEp0Req(priv); + if (request) + request->actual = priv->dmaDrv->dma_getActualLength(priv->dmaController, + priv->in[0].channel); + + phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); + if (request) + gadgetEp0Callback(priv, &priv->in[0], request, 0); + else + priv->ep0State = GADGET_EP0_STAGE_SETUP; + break; + case GADGET_EP0_STAGE_SETUP: + pr_debug("DATA Stage SETUP\n"); + gadgetEp0StageSetup(priv); + break; + case GADGET_EP0_STAGE_ACK: + pr_debug("DATA Stage ACK\n"); + break; + default: + pr_debug("DATA Stage UNKNOWN\n"); + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs |= EP0CS_STALL; + phytium_write8(&priv->regs->usbcs, usbcs); + break; + } + + return 0; +} + +static void gadgetEpXCallback(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req, uint32_t status) +{ + if (!gadgetEp || !req) + return; + + list_del(&req->list); + gadgetEp->requestsInList--; + req->status = status; + + if (req->complete) + req->complete(&gadgetEp->gadgetEp, req); +} + +static void gadgetEpXDataCallback(struct GADGET_CTRL *priv, uint8_t epNum, uint8_t epDir) +{ + struct GadgetEp *gadgetEp; + struct GADGET_REQ *gadgetReq; + uint32_t actual_length = 0; + uint32_t chMaxLen = 0; + uint8_t epType; + + if (!priv) + return; + + pr_debug("%s %d epNum:%d epDir:%d\n", __func__, __LINE__, epNum, epDir); + gadgetEp = epDir ? &priv->in[epNum] : &priv->out[epNum]; + + gadgetReq = gadgetGetNextReq(gadgetEp); + if (!gadgetReq) { + pr_debug("%s queue is empty\n", gadgetEp->gadgetEp.name); + return; + } + + if (gadgetEp->channel) { + actual_length = priv->dmaDrv->dma_getActualLength(priv->dmaController, + gadgetEp->channel); + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); + gadgetReq->actual += actual_length; + } + + if (gadgetReq->actual == gadgetReq->length || actual_length < chMaxLen) { + gadgetEpXCallback(priv, gadgetEp, gadgetReq, 0); + + if (gadgetEp->gadgetEp.desc) { + epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; + if (epType == USB_ENDPOINT_XFER_ISOC) + return; + + gadgetReq = gadgetGetNextReq(gadgetEp); + gadgetEp->state = GADGET_EP_ALLOCATED; + if (!gadgetReq) { + pr_debug("%s queue is empty\n", gadgetEp->gadgetEp.name); + return; + } + gadgetEp->state = GADGET_EP_BUSY; + if (epDir) + gadgetEpXDataSend(priv, requestToGadgetRequest(gadgetReq)); + else + gadgetEpXDataReceive(priv, requestToGadgetRequest(gadgetReq)); + } + } else { + if (epDir) + gadgetEpXDataSend(priv, requestToGadgetRequest(gadgetReq)); + else + gadgetEpXDataReceive(priv, requestToGadgetRequest(gadgetReq)); + } +} + +void gadget_CallbackTransfer(void *priv, uint8_t epNum, uint8_t epDir, bool resubmit) +{ + if (!epNum) + gadgetEp0Irq(priv); + else + gadgetEpXDataCallback(priv, epNum, epDir); +} + +static void gadgetAbortEndpoint(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) +{ + struct GADGET_REQ *gadgetReq; + + pr_debug("Abort Device endpoint: %s, dma channel: %p\n", gadgetEp->gadgetEp.name, + gadgetEp->channel); + + if (gadgetEp->channel && gadgetEp->hwEpNum != 0) { + priv->dmaDrv->dma_channelRelease(priv->dmaController, gadgetEp->channel); + gadgetEp->channel = NULL; + } + + if (gadgetEp->channel && gadgetEp->hwEpNum == 0) { + if (priv->releaseEp0Flag == 1) { + priv->dmaDrv->dma_channelAbort(priv->dmaController, gadgetEp->channel); + priv->dmaDrv->dma_channelAlloc(priv->dmaController, gadgetEp->isInEp, + gadgetEp->hwEpNum, 0); + } + } + + while (gadgetEp->request.next != &gadgetEp->request) { + gadgetReq = listToGadgetRequest(gadgetEp->request.next); + pr_debug("shutdown request %p form epName:%s\n", gadgetReq, + gadgetEp->gadgetEp.name); + if (!gadgetEp->gadgetEp.address) + gadgetEp0Callback(priv, gadgetEp, gadgetReq, GADGET_ESHUTDOWN); + else + gadgetEpXCallback(priv, gadgetEp, gadgetReq, GADGET_ESHUTDOWN); + } + + gadgetEp->state = GADGET_EP_FREE; +} + +static void gadgetStopActivity(struct GADGET_CTRL *priv) +{ + int i = 0; + struct GadgetEp *gadgetEp; + + pr_debug("USB Stop Activity\n"); + + if (!priv) + return; + + for (i = 0; i < 16; i++) { + gadgetEp = &priv->in[i]; + if (gadgetEp->state != GADGET_EP_NOT_IMPLEMENTED) + gadgetAbortEndpoint(priv, gadgetEp); + + gadgetEp = &priv->out[i]; + if (gadgetEp->state != GADGET_EP_NOT_IMPLEMENTED) + gadgetAbortEndpoint(priv, gadgetEp); + } +} + + +static int32_t gadgetEp0Enable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) +{ + uint8_t txien, rxien; + + if (!priv || !gadgetEp) + return -EINVAL; + + if (gadgetEp->state != GADGET_EP_FREE) + return -EBUSY; + + if (!gadgetEp->isInEp) { + rxien = phytium_read16(&priv->regs->rxien); + rxien &= ~(1 << gadgetEp->hwEpNum); + phytium_write16(&priv->regs->rxien, rxien); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_IO_TX | FIFOCTRL_FIFOAUTO); + } else { + txien = phytium_read16(&priv->regs->txien); + txien &= ~(1 << gadgetEp->hwEpNum); + phytium_write16(&priv->regs->txien, txien); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO); + } + + gadgetEp->gadgetEp.desc = NULL; + gadgetEp->state = GADGET_EP_ALLOCATED; + gadgetEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, + gadgetEp->isInEp, gadgetEp->hwEpNum, 0); + phytium_write8(&priv->regs->ep0maxpack, 0x40); + + return 0; +} + +static int32_t gadgetEpXEnable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + const struct usb_endpoint_descriptor *desc) +{ + uint32_t status = -EINVAL; + uint32_t payload; + uint16_t type, iso = 0; + uint8_t epNum = 0; + + if (!priv || !gadgetEp || !desc) + return -EINVAL; + + pr_debug("enable endpoint %s\n", gadgetEp->gadgetEp.name); + if (gadgetEp->state != GADGET_EP_FREE) { + status = -EBUSY; + goto fail; + } + + payload = desc->wMaxPacketSize & 0x7ff; + if (!payload) { + status = -EINVAL; + goto fail; + } + + epNum = gadgetEp->hwEpNum; + + type = desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; + switch (type) { + case USB_ENDPOINT_XFER_ISOC: + type = CON_TYPE_ISOC; + switch (payload >> 11) { + case 0: + iso = CON_TYPE_ISOC_1_ISOD; + break; + case 1: + payload *= 2; + iso = CON_TYPE_ISOC_2_ISOD; + break; + case 2: + payload *= 3; + iso = CON_TYPE_ISOC_3_ISOD; + break; + } + break; + case USB_ENDPOINT_XFER_INT: + type = CON_TYPE_INT; + break; + case USB_ENDPOINT_XFER_BULK: + type = CON_TYPE_BULK; + break; + } + + if (desc->bEndpointAddress & USB_DIR_IN) { + if (!gadgetEp->isInEp) { + status = -ENODEV; + goto fail; + } + + if (payload > priv->gadgetCfg.epIN[epNum].maxPacketSize) { + status = -EINVAL; + goto fail; + } + + phytium_write16(&priv->regs->txmaxpack[epNum - 1], payload); + phytium_write8(&priv->regs->ep[epNum - 1].txcon, CON_VAL | type + | iso | (priv->gadgetCfg.epIN[epNum - 1].bufferingValue - 1)); + + phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum | + ENDPRST_FIFORST | ENDPRST_TOGRST); + } else { + if (gadgetEp->isInEp) { + status = -ENODEV; + goto fail; + } + + if (payload > priv->gadgetCfg.epOUT[epNum].maxPacketSize) { + status = -EINVAL; + goto fail; + } + + phytium_write16(&priv->regs->rxmaxpack[epNum - 1], payload); + phytium_write8(&priv->regs->ep[epNum - 1].rxcon, CON_VAL | type + | iso | (priv->gadgetCfg.epIN[epNum - 1].bufferingValue - 1)); + + phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | epNum); + phytium_write8(&priv->regs->endprst, epNum); + phytium_write8(&priv->regs->endprst, epNum | ENDPRST_FIFORST | ENDPRST_TOGRST); + } + + if (priv->dmaController) + gadgetEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, + gadgetEp->isInEp, epNum, (type == CON_TYPE_ISOC) ? 1 : 0); + + if (type == CON_TYPE_ISOC) { + if (gadgetEp->isInEp) { + phytium_write16(&priv->regs->isoautodump, 1 << epNum); + phytium_write16(&priv->regs->isodctrl, 1 << epNum); + } + + priv->dmaDrv->dma_setMaxLength(priv->dmaController, gadgetEp->channel, payload); + } + + gadgetEp->state = GADGET_EP_ALLOCATED; + gadgetEp->gadgetEp.desc = desc; +fail: + return status; +} + +static int32_t gadgetEpEnable(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + const struct usb_endpoint_descriptor *desc) +{ + struct GadgetEp *gadgetEp = NULL; + + if (!priv || !gadget_Ep || !desc) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + gadgetEp->wedged = 0; + + if (gadgetEp->hwEpNum) + return gadgetEpXEnable(priv, gadgetEp, desc); + else + return gadgetEp0Enable(priv, gadgetEp); +} + +static int32_t gadgetEpXDisable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) +{ + uint8_t txcon, rxcon; + + if (!priv || !gadgetEp) + return -EINVAL; + + pr_debug("disable endpoint %s\n", gadgetEp->gadgetEp.name); + if (gadgetEp->isInEp) { + txcon = phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon); + txcon &= ~CON_VAL; + phytium_write8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon, txcon); + } else { + rxcon = phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon); + rxcon &= ~CON_VAL; + phytium_write8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon, rxcon); + } + gadgetAbortEndpoint(priv, gadgetEp); + gadgetEp->gadgetEp.desc = 0; + gadgetEp->state = GADGET_EP_FREE; + return 0; +} + +static int32_t gadgetEp0Disable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) +{ + if (!priv || !gadgetEp) + return -EINVAL; + + pr_debug("disable endpoint %s\n", gadgetEp->gadgetEp.name); + gadgetAbortEndpoint(priv, gadgetEp); + + return 0; +} + +static int32_t gadgetEpDisable(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) +{ + struct GadgetEp *gadgetEp = NULL; + + if (!priv || !gadget_Ep) + return -EINVAL; + + if (gadget_Ep->address == 0) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + gadgetEp->wedged = 0; + if (gadgetEp->hwEpNum) + return gadgetEpXDisable(priv, gadgetEp); + else + return gadgetEp0Disable(priv, gadgetEp); +} + +static int32_t gadgetEpXQueue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req) +{ + struct GadgetRequest *gadgetRequest; + + if (!priv || !gadgetEp || !req) + return -EINVAL; + + req->actual = 0; + req->status = EINPROGRESS; + + gadgetRequest = requestToGadgetRequest(req); + gadgetRequest->ep = gadgetEp; + + if (req->length == 0) + gadgetRequest->zlp = 1; + + if (gadgetEp->gadgetEp.desc == NULL) { + pr_info("%s is disabled - can not queue request %p\n", + gadgetEp->gadgetEp.name, req); + return -EINVAL; + } + + list_add_tail(&req->list, &gadgetEp->request); + pr_debug("queue to %s (%s), length:%d\n", gadgetEp->gadgetEp.name, + (gadgetEp->isInEp ? "IN/TX" : "OUT/RX"), req->length); + + if ((gadgetEp->state == GADGET_EP_ALLOCATED) && (&req->list == gadgetEp->request.next)) { + if (gadgetEp->isInEp) { + if (!(phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon) + & CON_STALL)) { + gadgetEp->state = GADGET_EP_BUSY; + gadgetEpXDataSend(priv, gadgetRequest); + } + } else { + if (!(phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon) + & CON_STALL)) { + gadgetEp->state = GADGET_EP_BUSY; + gadgetEpXDataReceive(priv, gadgetRequest); + } + } + } else if (gadgetEp->state == GADGET_EP_BUSY) { + if (usb_endpoint_xfer_isoc(gadgetEp->gadgetEp.desc)) { + if (gadgetEp->isInEp) + gadgetEpXDataSend(priv, gadgetRequest); + else + gadgetEpXDataReceive(priv, gadgetRequest); + } + } + + pr_debug("endpoint %s (%s) now is busy - transfer will be waiting in Queue\n", + gadgetEp->gadgetEp.name, (gadgetEp->isInEp ? "IN/TX" : "OUT/RX")); + + return 0; +} + +static int32_t gadgetEp0Queue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req) +{ + struct GadgetRequest *gadgetRequest; + + if (!priv || !gadgetEp || !req) + return -EINVAL; + + req->actual = 0; + req->status = EINPROGRESS; + + if (!list_empty(&gadgetEp->request)) + return -EBUSY; + + gadgetRequest = requestToGadgetRequest(req); + gadgetRequest->ep = gadgetEp; + + switch (priv->ep0State) { + case GADGET_EP0_STAGE_OUT: + case GADGET_EP0_STAGE_IN: + case GADGET_EP0_STAGE_ACK: + break; + default: + return -EINVAL; + } + + list_add_tail(&req->list, &gadgetEp->request); + gadgetEp->requestsInList++; + + pr_debug("queue to %s (%s), length:%d stage:%d\n", gadgetEp->gadgetEp.name, + gadgetEp->isInEp ? "IN/TX" : "OUT/RX", req->length, priv->ep0State); + + switch (priv->ep0State) { + case GADGET_EP0_STAGE_OUT: + gadgetEp0DataReceive(priv); + break; + case GADGET_EP0_STAGE_IN: + gadgetEp0DataSend(priv); + break; + case GADGET_EP0_STAGE_ACK: + if (req->length) + return -EINVAL; + phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); + gadgetEp0Callback(priv, gadgetRequest->ep, req, 0); + pr_info("control transfer completed\n"); + break; + default: + break; + } + + return 0; +} + +static int32_t gadgetEpQueue(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + struct GADGET_REQ *req) +{ + struct GadgetEp *gadgetEp = NULL; + + if (!priv || !gadget_Ep || !req) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + + if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) + return gadgetEpXQueue(priv, gadgetEp, req); + else + return gadgetEp0Queue(priv, gadgetEp, req); +} + +static int32_t gadgetEpXDequeue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req) +{ + struct GadgetRequest *gadgetRequest; + struct GADGET_REQ *iterator; + + if (!priv || !gadgetEp || !req) + return -EINVAL; + + gadgetRequest = requestToGadgetRequest(req); + if (gadgetRequest->ep != gadgetEp) + return -EINVAL; + + pr_debug("Dequeue request %p form %s\n", req, gadgetEp->gadgetEp.name); + + listBrowsingRequest(iterator, &gadgetEp->request, list) { + if (req == iterator) + break; + } + + if (req != iterator) { + pr_info("request %p not queued to %s\n", req, gadgetEp->gadgetEp.name); + return -EINVAL; + } + + if (gadgetEp->state == GADGET_EP_BUSY) { + priv->dmaDrv->dma_channelAbort(priv->dmaController, gadgetEp->channel); + gadgetEp->state = GADGET_EP_ALLOCATED; + } + + gadgetEpXCallback(priv, gadgetEp, req, GADGET_ECONNRESET); + + return 0; +} + +static int32_t gadgetEp0Dequeue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req) +{ + return 0; +} + +static int32_t gadgetEpDequeue(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + struct GADGET_REQ *req) +{ + struct GadgetEp *gadgetEp = NULL; + + if (!priv || !gadget_Ep || !req) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + + if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) + return gadgetEpXDequeue(priv, gadgetEp, req); + else + return gadgetEp0Dequeue(priv, gadgetEp, req); +} + +static int32_t gadgetEpSetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, uint8_t value) +{ + if (!priv || !gadget_Ep) + return -EINVAL; + + if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) + return gadgetEpXSetHalt(priv, gadget_Ep, value); + else + return gadgetEp0SetHalt(priv, gadget_Ep, value); +} + +static int32_t gadgetEpSetWedge(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) +{ + struct GadgetEp *gadgetEp = NULL; + + if (!priv || !gadget_Ep) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + gadgetEp->wedged = 1; + + return gadgetEpSetHalt(priv, gadget_Ep, 1); +} + +static int32_t gadgetEpFifoStatus(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) +{ + if (!priv || !gadget_Ep) + return -EINVAL; + + return 0; +} + +static void gadgetEpFifoFlush(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) +{ + if (!priv || !gadget_Ep) + return; +} + +static int32_t gadgetEpAllocRequest(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + struct GADGET_REQ **req) +{ + struct GadgetEp *gadgetEp = NULL; + struct GadgetRequest *gadgetRequest = NULL; + + if (!priv || !gadget_Ep || !req) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + if (priv->eventCallback.usbRequestMemAlloc) + gadgetRequest = priv->eventCallback.usbRequestMemAlloc(priv, + sizeof(*gadgetRequest)); + if (!gadgetRequest) + return -ENOMEM; + + memset(gadgetRequest, 0, sizeof(*gadgetRequest)); + *req = &gadgetRequest->request; + INIT_LIST_HEAD(&gadgetRequest->request.list); + gadgetRequest->ep = gadgetEp; + + return 0; +} + +static void gadgetEpFreeRequest(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + struct GADGET_REQ *req) +{ + struct GadgetRequest *gadgetRequest = NULL; + + if (!priv || !gadget_Ep || !req) + return; + + gadgetRequest = requestToGadgetRequest(req); + + if (priv->eventCallback.usbRequestMemFree) + priv->eventCallback.usbRequestMemFree(priv, gadgetRequest); +} + +static struct GADGET_EP_OPS gadgetEpOps = { + .epEnable = gadgetEpEnable, + .epDisable = gadgetEpDisable, + .reqQueue = gadgetEpQueue, + .reqDequeue = gadgetEpDequeue, + .epSetHalt = gadgetEpSetHalt, + .epSetWedge = gadgetEpSetWedge, + .epFifoStatus = gadgetEpFifoStatus, + .reqAlloc = gadgetEpAllocRequest, + .reqFree = gadgetEpFreeRequest +}; + +static void gadgetInitDeviceEp(struct GADGET_CTRL *priv, uint8_t isInEp) +{ + uint8_t num; + struct GadgetEp *gadgetEp; + struct GADGET_EP_CFG epCfg; + + if (!priv) + return; + + for (num = 0; num < 16; num++) { + gadgetEp = isInEp ? &priv->in[num] : &priv->out[num]; + if (num) { + epCfg = isInEp ? priv->gadgetCfg.epIN[num] : priv->gadgetCfg.epOUT[num]; + if (!epCfg.bufferingValue) { + gadgetEp->state = GADGET_EP_NOT_IMPLEMENTED; + gadgetEp->hwEpNum = num; + continue; + } + } + INIT_LIST_HEAD(&gadgetEp->gadgetEp.epList); + INIT_LIST_HEAD(&gadgetEp->request); + gadgetEp->state = GADGET_EP_FREE; + gadgetEp->hwEpNum = num; + gadgetEp->isInEp = isInEp; + gadgetEp->requestsInList = 0; + snprintf(gadgetEp->gadgetEp.name, sizeof(gadgetEp->gadgetEp.name), + "Ep%d%s", num, isInEp ? "in" : "out"); + if (!num) { + gadgetEp->gadgetEp.maxPacket = priv->gadgetCfg.epIN[num].maxPacketSize; + if (isInEp) + priv->gadgetDev.ep0 = &gadgetEp->gadgetEp; + gadgetEp->gadgetEp.ops = &gadgetEpOps; + gadgetEp0Enable(priv, gadgetEp); + continue; + } + + if (isInEp) { + if (epCfg.startBuf) + phytium_write16(&priv->regs->txstaddr[num - 1].addr, + epCfg.startBuf); + phytium_write8(&priv->regs->ep[num - 1].txcon, 0); + gadgetEp->gadgetEp.maxPacket = epCfg.maxPacketSize; + } else { + if (epCfg.startBuf) + phytium_write16(&priv->regs->rxstaddr[num - 1].addr, + epCfg.startBuf); + phytium_write8(&priv->regs->ep[num - 1].rxcon, 0); + gadgetEp->gadgetEp.maxPacket = epCfg.maxPacketSize; + } + + gadgetEp->gadgetEp.ops = &gadgetEpOps; + gadgetEp->gadgetEp.address = isInEp ? (0x80 | num) : num; + gadgetEp->gadgetEp.maxburst = 0; + gadgetEp->gadgetEp.mult = 0; + gadgetEp->gadgetEp.maxStreams = 0; + priv->endpointInList++; + list_add_tail(&gadgetEp->gadgetEp.epList, &priv->gadgetDev.epList); + } +} + +static void gadgetInitEndpoint(struct GADGET_CTRL *priv) +{ + if (!priv) + return; + + gadgetInitDeviceEp(priv, 1); + gadgetInitDeviceEp(priv, 0); +} + +static void gadgetSetup(struct GADGET_CTRL *priv) +{ + if (!priv) + return; + + INIT_LIST_HEAD(&priv->gadgetDev.epList); + priv->gadgetDev.state = USB_STATE_NOTATTACHED; + priv->gadgetDev.maxSpeed = USB_SPEED_HIGH; + priv->gadgetDev.speed = USB_SPEED_FULL; + snprintf(priv->gadgetDev.name, sizeof(priv->gadgetDev.name), "Phytium USB SD Driver"); + + gadgetInitEndpoint(priv); + + phytium_write8(&priv->regs->ep0maxpack, 0x40); + phytium_write16(&priv->regs->rxien, 0); + phytium_write16(&priv->regs->txien, 0); + phytium_write16(&priv->regs->rxirq, 0xFFFF); + phytium_write16(&priv->regs->txirq, 0xFFFF); + phytium_write8(&priv->regs->usbirq, 0xEF); + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); + priv->isReady = 1; +} +int32_t gadgetInit(struct GADGET_CTRL *priv, struct GADGET_CFG *config, + struct GADGET_CALLBACKS *callbacks, struct device *pdev) +{ + struct DMA_SYSREQ dmaSysReq; + uint8_t usbcs; + + if (!priv || !config || !callbacks) + return -EINVAL; + + priv->dev = pdev; + priv->eventCallback = *callbacks; + priv->gadgetCfg = *config; + priv->regs = (struct HW_REGS *)config->regBase; + priv->phy_regs = (struct VHUB_REGS *)config->phy_regBase; + priv->gadgetDrv = GADGET_GetInstance(); + priv->dmaDrv = DMA_GetInstance(); + priv->dmaController = (void *)(priv + 1); + priv->dmaCfg.dmaModeRx = 0xFFFF; + priv->dmaCfg.dmaModeTx = 0xFFFF; + priv->dmaCfg.regBase = config->regBase + 0x400; + priv->dmaCfg.trbAddr = config->trbAddr; + priv->dmaCfg.trbDmaAddr = config->trbDmaAddr; + + priv->dmaDrv->dma_probe(NULL, &dmaSysReq); + priv->privBuffAddr = (uint8_t *)((uintptr_t)config->trbAddr + dmaSysReq.trbMemSize); + priv->privBuffDma = (uintptr_t)((uintptr_t)config->trbDmaAddr + dmaSysReq.trbMemSize); + priv->dmaCallback.complete = gadget_CallbackTransfer; + priv->dmaDrv->dma_init(priv->dmaController, &priv->dmaCfg, &priv->dmaCallback); + priv->dmaDrv->dma_setParentPriv(priv->dmaController, priv); + + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs |= USBCS_DISCON | USBCS_LPMNYET; + phytium_write8(&priv->regs->usbcs, usbcs); + + gadgetSetup(priv); + + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs &= USBCS_DISCON; + phytium_write8(&priv->regs->usbcs, usbcs); + + return 0; +} + +static void gadgetDestroy(struct GADGET_CTRL *priv) +{ + pr_debug("Destroy Device Controller driver\n"); + + if (priv) + return; + gadgetDisconnect(priv); + + gadgetStopActivity(priv); + + phytium_write8(&priv->regs->usbcs, USBCS_DISCON); + + priv->isReady = 0; +} + +static void gadgetStart(struct GADGET_CTRL *priv) +{ + uint8_t usbien, usbcs; + + pr_debug("Usb Device Controller start\n"); + if (!priv) + return; + + usbien = phytium_read8(&priv->regs->usbien); + usbien |= USBIR_URES | USBIR_SUDAV | USBIR_LPMIR; + phytium_write8(&priv->regs->usbien, usbien); + + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs &= ~USBCS_DISCON; + phytium_write8(&priv->regs->usbcs, usbcs); + + priv->dmaDrv->dma_start(priv->dmaController); +} + +static void gadgetReset(struct GADGET_CTRL *priv) +{ + int i = 0; + + pr_debug("Usb Disable Device Activity\n"); + + if (!priv) + return; + + if (priv->gadgetDev.speed != USB_SPEED_UNKNOWN) + gadgetDisconnect(priv); + + priv->gadgetDev.aHnpSupport = 0; + priv->gadgetDev.bHnpEnable = 0; + priv->gadgetDev.state = USB_STATE_DEFAULT; + priv->deviceAddress = 0; + priv->ep0State = GADGET_EP0_STAGE_SETUP; + + gadgetStopActivity(priv); + + for (i = 0; i < 1000; i++) { + priv->gadgetDev.speed = gadgetGetActualSpeed(priv); + if (priv->gadgetDev.speed == USB_SPEED_HIGH) + return; + } +} + +static void gadgetStop(struct GADGET_CTRL *priv) +{ + pr_debug("Usb Device Controller stop\n"); + + if (!priv) + return; + + if (!priv->isReady) + return; + + gadgetReset(priv); + + phytium_write8(&priv->regs->usbien, 0); + priv->dmaDrv->dma_stop(priv->dmaController); + + priv->isReady = 0; +} + +static void gadgetIsr(struct GADGET_CTRL *priv) +{ + uint8_t usbirq, usbien, usbcs; + + if (!priv) + return; + + usbirq = phytium_read8(&priv->regs->usbirq); + usbien = phytium_read8(&priv->regs->usbien); + + pr_debug("usbirq:0x%x usbien:0x%x\n", usbirq, usbien); + + usbirq = usbirq & usbien; + + if (!usbirq) + goto DMA_IRQ; + + if (usbirq & USBIR_LPMIR) { + pr_debug("USBIRQ LPM\n"); + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs &= ~USBCS_LPMNYET; + phytium_write8(&priv->regs->usbcs, usbcs); + phytium_write8(&priv->regs->usbirq, USBIR_LPMIR); + } + + if (usbirq & USBIR_URES) { + pr_debug("USBIRQ RESET\n"); + phytium_write8(&priv->regs->usbirq, USBIR_URES); + priv->releaseEp0Flag = 1; + gadgetReset(priv); + priv->releaseEp0Flag = 0; + priv->gadgetDev.state = USB_STATE_DEFAULT; + if (priv->eventCallback.connect) + priv->eventCallback.connect(priv); + } + + if (usbirq & USBIR_HSPEED) { + pr_debug("USBIRQ HighSpeed\n"); + phytium_write8(&priv->regs->usbirq, USBIR_HSPEED); + priv->gadgetDev.speed = USB_SPEED_HIGH; + } + + if (usbirq & USBIR_SUDAV) { + pr_debug("USBIRQ SUDAV\n"); + priv->ep0State = GADGET_EP0_STAGE_SETUP; + gadgetEp0Irq(priv); + } + + if (usbirq & USBIR_SOF) { + pr_debug("USBIRQ SOF\n"); + phytium_write8(&priv->regs->usbirq, USBIR_SOF); + } + + if (usbirq & USBIR_SUTOK) { + pr_debug("USBIRQ SUTOK\n"); + phytium_write8(&priv->regs->usbirq, USBIR_SUTOK); + } + + if (usbirq & USBIR_SUSP) { + pr_debug("USBIRQ SUSPEND\n"); + phytium_write8(&priv->regs->usbirq, USBIR_SUSP); + } + + return; +DMA_IRQ: + priv->dmaDrv->dma_isr(priv->dmaController); +} + +static void gadgetGetDevInstance(struct GADGET_CTRL *priv, struct GADGET_DEV **dev) +{ + if (!priv || !dev) + return; + + *dev = &priv->gadgetDev; +} + +static int32_t gadgetGetFrame(struct GADGET_CTRL *priv, uint32_t *numOfFrame) +{ + if (!priv || !numOfFrame) + return -EINVAL; + + *numOfFrame = phytium_read16(&priv->regs->frmnr); + + return 0; +} + +static int32_t gadgetWakeUp(struct GADGET_CTRL *priv) +{ + if (!priv) + return -EINVAL; + + return -ENOTSUPP; +} + +static int32_t gadgetSetSelfPowered(struct GADGET_CTRL *priv) +{ + if (!priv) + return -EINVAL; + + priv->isSelfPowered = 1; + + return 0; +} + +static int32_t gadgetClearSelfPowered(struct GADGET_CTRL *priv) +{ + if (!priv) + return -EINVAL; + + priv->isSelfPowered = 0; + + return 0; +} + +static int32_t gadgetVbusSession(struct GADGET_CTRL *priv, uint8_t isActive) +{ + if (!priv) + return -EINVAL; + + return -ENOTSUPP; +} + +static int32_t gadgetVbusDraw(struct GADGET_CTRL *priv, uint8_t mA) +{ + if (!priv) + return -EINVAL; + + return -ENOTSUPP; +} + +static int32_t gadgetPullUp(struct GADGET_CTRL *priv, uint8_t isOn) +{ + if (!priv) + return -EINVAL; + + return -ENOTSUPP; +} + +struct GADGET_OBJ GadgetObj = { + .gadget_init = gadgetInit, + .gadget_destroy = gadgetDestroy, + .gadget_start = gadgetStart, + .gadget_stop = gadgetStop, + .gadget_isr = gadgetIsr, + //endpoint operation + .gadget_epEnable = gadgetEpEnable, + .gadget_epDisable = gadgetEpDisable, + .gadget_epSetHalt = gadgetEpSetHalt, + .gadget_epSetWedge = gadgetEpSetWedge, + .gadget_epFifoStatus = gadgetEpFifoStatus, + .gadget_epFifoFlush = gadgetEpFifoFlush, + .gadget_reqQueue = gadgetEpQueue, + .gadget_reqDequeue = gadgetEpDequeue, + .gadget_reqAlloc = gadgetEpAllocRequest, + .gadget_reqFree = gadgetEpFreeRequest, + + //Device operations + .gadget_getDevInstance = gadgetGetDevInstance, + .gadget_dGetFrame = gadgetGetFrame, + .gadget_dWakeUp = gadgetWakeUp, + .gadget_dSetSelfpowered = gadgetSetSelfPowered, + .gadget_dClearSelfpowered = gadgetClearSelfPowered, + .gadget_dVbusSession = gadgetVbusSession, + .gadget_dVbusDraw = gadgetVbusDraw, + .gadget_dPullUp = gadgetPullUp, +}; + +struct GADGET_OBJ *GADGET_GetInstance(void) +{ + return &GadgetObj; +} + +static int phytium_gadget_set_default_cfg(struct phytium_cusb *config) +{ + int index; + + config->gadget_cfg.regBase = (uintptr_t)config->regs; + config->gadget_cfg.phy_regBase = (uintptr_t)config->phy_regs; + config->gadget_cfg.dmaInterfaceWidth = GADGET_DMA_32_WIDTH; + + for (index = 0; index < 16; index++) { + if (index == 0) { + config->gadget_cfg.epIN[index].bufferingValue = 1; + config->gadget_cfg.epIN[index].maxPacketSize = 64; + config->gadget_cfg.epIN[index].startBuf = 0; + + config->gadget_cfg.epOUT[index].bufferingValue = 1; + config->gadget_cfg.epOUT[index].maxPacketSize = 64; + config->gadget_cfg.epOUT[index].startBuf = 0; + } else { + config->gadget_cfg.epIN[index].bufferingValue = 4; + config->gadget_cfg.epIN[index].maxPacketSize = 1024; + config->gadget_cfg.epIN[index].startBuf = 64 + 4096 * (index - 1); + + config->gadget_cfg.epOUT[index].bufferingValue = 4; + config->gadget_cfg.epOUT[index].maxPacketSize = 1024; + config->gadget_cfg.epOUT[index].startBuf = 64 + 4096 * (index - 1); + } + } + + return 0; +} + +void gadget_callback_connect(struct GADGET_CTRL *priv) +{ + if (!priv) + return; +} + +void gadget_callback_disconnect(struct GADGET_CTRL *priv) +{ + if (!priv) + return; +} + +int32_t gadget_callback_setup(struct GADGET_CTRL *priv, struct usb_ctrlrequest *ctrl) +{ + struct phytium_cusb *config; + int ret = 0; + + if (!priv || !ctrl) + return -EINVAL; + + config = dev_get_drvdata(priv->dev); + if (!config) + return -1; + + if (!config->gadget_driver) + return -EOPNOTSUPP; + + if (ctrl->bRequestType & USB_DIR_IN) + config->ep0_data_stage_is_tx = 1; + else + config->ep0_data_stage_is_tx = 0; + + spin_unlock(&config->lock); + ret = config->gadget_driver->setup(&config->gadget, ctrl); + spin_lock(&config->lock); + + if (ret == 0x7FFF) + return ret; + + if (ret < 0) + return 1; + + return 0; +} + +void *gadget_callback_usbRequestMemAlloc(struct GADGET_CTRL *priv, u32 size) +{ + struct GADGET_REQ *gadget_req = NULL; + + gadget_req = kzalloc(size, GFP_NOWAIT); + if (!gadget_req) + return NULL; + + return gadget_req; +} + +void gadget_callback_usbRequestMemFree(struct GADGET_CTRL *priv, void *usbReq) +{ + if (!usbReq) + return; + + kfree(usbReq); +} + +static void init_peripheral_ep(struct phytium_cusb *config, + struct phytium_ep *phy_ep, struct GADGET_EP *gadget_ep, int is_tx) +{ + if (!config || !phy_ep || !gadget_ep) + return; + + memset(phy_ep, 0, sizeof(*phy_ep)); + phy_ep->config = config; + phy_ep->is_tx = is_tx; + phy_ep->gadget_ep = gadget_ep; + phy_ep->ep_num = gadget_ep->address & 0xF; + phy_ep->end_point.maxpacket = gadget_ep->maxPacket; + phy_ep->end_point.maxpacket_limit = 1024; + + INIT_LIST_HEAD(&phy_ep->req_list); + sprintf(phy_ep->name, "ep%d%s", phy_ep->ep_num, is_tx ? "in" : "out"); + + switch (phy_ep->ep_num) { + case 0: + phy_ep->end_point.caps.type_control = 1; + break; + case 1: + phy_ep->end_point.caps.type_bulk = 1; + break; + case 2: + phy_ep->end_point.caps.type_int = 1; + break; + case 3: + phy_ep->end_point.caps.type_iso = 1; + break; + default: + phy_ep->end_point.caps.type_int = 1; + phy_ep->end_point.caps.type_bulk = 1; + break; + } + + if (is_tx) { + phy_ep->end_point.caps.dir_in = 1; + phy_ep->end_point.caps.dir_out = 0; + } else { + phy_ep->end_point.caps.dir_in = 0; + phy_ep->end_point.caps.dir_out = 1; + } + + phy_ep->end_point.name = phy_ep->name; + + INIT_LIST_HEAD(&phy_ep->end_point.ep_list); + + if (!phy_ep->ep_num) { + phy_ep->end_point.ops = &gadget_ep0_ops; + config->gadget.ep0 = &phy_ep->end_point; + + if (config->gadget_dev->maxSpeed > USB_SPEED_HIGH) + config->gadget.ep0->maxpacket = 9; + } else { + phy_ep->end_point.ops = &gadget_ep_ops; + list_add_tail(&phy_ep->end_point.ep_list, &config->gadget.ep_list); + } +} + +static void gadget_init_endpoint(struct phytium_cusb *config) +{ + struct list_head *list; + struct GADGET_EP *gadget_ep; + + if (!config) + return; + + INIT_LIST_HEAD(&(config->gadget.ep_list)); + + init_peripheral_ep(config, &config->endpoints_tx[0], config->gadget_dev->ep0, 1); + init_peripheral_ep(config, &config->endpoints_rx[0], config->gadget_dev->ep0, 0); + + list_for_each(list, &config->gadget_dev->epList) { + gadget_ep = (struct GADGET_EP *)list; + if (gadget_ep->address & USB_DIR_IN) + init_peripheral_ep(config, &config->endpoints_tx[gadget_ep->address & 0xf], + gadget_ep, 1); + else + init_peripheral_ep(config, &config->endpoints_rx[gadget_ep->address & 0xf], + gadget_ep, 0); + } +} + +static int gadget_setup(struct phytium_cusb *config) +{ + int ret = -1; + + config->gadget_obj->gadget_getDevInstance(config->gadget_priv, &config->gadget_dev); + config->gadget.ops = &phytium_gadget_ops; + config->gadget.max_speed = config->gadget_dev->maxSpeed; + config->gadget.speed = USB_SPEED_HIGH; + config->gadget.name = "phytium_gadget"; + config->gadget.is_otg = 0; + + gadget_init_endpoint(config); + + ret = usb_add_gadget_udc(config->dev, &config->gadget); + if (ret) + goto err; + + return 0; + +err: + config->gadget.dev.parent = NULL; + device_unregister(&config->gadget.dev); + return ret; +} + +int phytium_gadget_reinit(struct phytium_cusb *config) +{ + struct GADGET_CTRL *ctrl; + + if (!config) + return 0; + + ctrl = (struct GADGET_CTRL *)config->gadget_priv; + if (!ctrl) + return 0; + + gadgetStop(ctrl); + + config->gadget_obj->gadget_init(config->gadget_priv, &config->gadget_cfg, + &config->gadget_callbacks, config->dev); + + return 0; +} + +int phytium_gadget_init(struct phytium_cusb *config) +{ + int ret; + + if (!config) + return 0; + + phytium_gadget_set_default_cfg(config); + config->gadget_obj = &GadgetObj; + + config->dma_cfg.regBase = config->gadget_cfg.regBase + 0x400; + config->dma_obj = DMA_GetInstance(); + config->dma_obj->dma_probe(&config->dma_cfg, &config->dma_sysreq); + + config->gadget_sysreq.privDataSize = sizeof(struct GADGET_CTRL); + config->gadget_sysreq.trbMemSize = config->dma_sysreq.trbMemSize + GADGET_PRIV_BUFFER_SIZE; + config->gadget_sysreq.privDataSize += config->dma_sysreq.privDataSize; + + config->gadget_priv = devm_kzalloc(config->dev, + config->gadget_sysreq.privDataSize, GFP_KERNEL); + if (!config->gadget_priv) { + ret = -ENOMEM; + goto err_probe; + } + config->gadget_cfg.trbAddr = dma_alloc_coherent(config->dev, + config->gadget_sysreq.trbMemSize, + (dma_addr_t *)&config->gadget_cfg.trbDmaAddr, GFP_KERNEL); + if (!config->gadget_cfg.trbAddr) { + ret = -ENOMEM; + goto err_dma_coherent; + } + + config->gadget_callbacks.connect = gadget_callback_connect; + config->gadget_callbacks.disconnect = gadget_callback_disconnect; + config->gadget_callbacks.setup = gadget_callback_setup; + config->gadget_callbacks.usbRequestMemAlloc = gadget_callback_usbRequestMemAlloc; + config->gadget_callbacks.usbRequestMemFree = gadget_callback_usbRequestMemFree; + + ret = config->gadget_obj->gadget_init(config->gadget_priv, &config->gadget_cfg, + &config->gadget_callbacks, config->dev); + if (ret) { + ret = -ENODEV; + goto err_init; + } + + //dev_set_drvdata(config->dev, config); + + gadget_setup(config); + + return 0; + +err_init: + dma_free_coherent(config->dev, config->gadget_sysreq.trbMemSize, + config->gadget_cfg.trbAddr, config->gadget_cfg.trbDmaAddr); +err_dma_coherent: +err_probe: + dev_set_drvdata(config->dev, NULL); + + return ret; +} + +int phytium_gadget_uninit(struct phytium_cusb *config) +{ + if (config) + usb_del_gadget_udc(&config->gadget); + + return 0; +} + +#ifdef CONFIG_PM +int phytium_gadget_resume(void *priv) +{ + struct GADGET_CTRL *ctrl; + uint32_t gen_cfg; + unsigned long flags = 0; + struct phytium_cusb *config = (struct phytium_cusb *)priv; + + if (!config) + return 0; + + ctrl = (struct GADGET_CTRL *)config->gadget_priv; + if (!ctrl) + return 0; + + spin_lock_irqsave(&config->lock, flags); + phytium_gadget_reinit(config); + + if (config->gadget_driver) { + config->gadget_obj->gadget_start(config->gadget_priv); + if (ctrl->phy_regs) { + gen_cfg = phytium_read32(&ctrl->phy_regs->gen_cfg); + gen_cfg = gen_cfg & (~BIT(7)); + phytium_write32(&ctrl->phy_regs->gen_cfg, gen_cfg); + } + } + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +int phytium_gadget_suspend(void *priv) +{ + return 0; +} +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/gadget.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/gadget.h new file mode 100644 index 0000000000000000000000000000000000000000..d87b55ade7a70b29189402e8164d833e6340730b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/gadget.h @@ -0,0 +1,253 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef __PHYTIUM_GADGET_H_ +#define __PHYTIUM_GADGET_H_ + +#include +#include +#include "dma.h" + +struct GADGET_CTRL; +struct GADGET_EP; +struct GADGET_REQ; + +enum GADGET_EP_STATE { + GADGET_EP_FREE, + GADGET_EP_ALLOCATED, + GADGET_EP_BUSY, + GADGET_EP_NOT_IMPLEMENTED +}; + +enum GADGET_EP0_STAGE { + GADGET_EP0_STAGE_SETUP, + GADGET_EP0_STAGE_IN, + GADGET_EP0_STAGE_OUT, + GADGET_EP0_STAGE_STATUSIN, + GADGET_EP0_STAGE_STATUSOUT, + GADGET_EP0_STAGE_ACK +}; + +struct GADGET_EP_OPS { + int32_t (*epEnable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + const struct usb_endpoint_descriptor *desc); + + int32_t (*epDisable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*epSetHalt)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, uint8_t value); + + int32_t (*epSetWedge)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*epFifoStatus)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*epFifoFlush)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*reqQueue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); + + int32_t (*reqDequeue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); + + int32_t (*reqAlloc)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ **req); + + void (*reqFree)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); +}; + +struct GADGET_EP { + struct list_head epList; + char name[255]; + struct GADGET_EP_OPS *ops; + uint16_t maxPacket; + uint16_t maxStreams; + uint8_t mult; + uint8_t maxburst; + uint8_t address; + const struct usb_endpoint_descriptor *desc; + const struct usb_ss_ep_comp_descriptor *compDesc; +}; + +enum GADGET_DMAInterfaceWidth { + GADGET_DMA_32_WIDTH = 4, + GADGET_DMA_64_WIDTH = 8, +}; + +struct GADGET_EP_CFG { + uint8_t bufferingValue; + uint16_t startBuf; + uint16_t maxPacketSize; +}; + +struct GADGET_CFG { + uintptr_t regBase; + uintptr_t phy_regBase; + struct GADGET_EP_CFG epIN[16]; + struct GADGET_EP_CFG epOUT[16]; + enum GADGET_DMAInterfaceWidth dmaInterfaceWidth; + void *trbAddr; + uintptr_t trbDmaAddr; +}; + +struct GADGET_SYSREQ { + uint32_t privDataSize; + uint32_t trbMemSize; +}; + +struct GadgetEp { + struct GADGET_EP gadgetEp; + enum GADGET_EP_STATE state; + uint8_t hwEpNum; + uint8_t isInEp; + struct list_head request; + uint8_t iso_flag; + void *channel; + uint32_t requestsInList; + uint8_t wedged; +}; + +struct GADGET_DEV { + struct list_head epList; + struct GADGET_EP *ep0; + unsigned int speed; + unsigned int maxSpeed; + enum usb_device_state state; + uint8_t sgSupported; + uint8_t bHnpEnable; + uint8_t aHnpSupport; + char name[255]; +}; + +struct GADGET_SgList { + uintptr_t link; + uint32_t offset; + uint32_t length; + uintptr_t dmaAddress; +}; + +struct GADGET_REQ { + struct list_head list; + void *buf; + uint32_t length; + uintptr_t dma; + uint32_t numOfSgs; + uint32_t numMappedSgs; + uint16_t streamId; + uint8_t oInterrupt; + uint8_t zero; + uint8_t shortNotOk; + void *context; + uint32_t status; + uint32_t actual; + struct GADGET_SgList *sg; + void (*complete)(struct GADGET_EP *ep, struct GADGET_REQ *req); +}; + + +struct GADGET_CALLBACKS { + void (*disconnect)(struct GADGET_CTRL *priv); + + void (*connect)(struct GADGET_CTRL *priv); + + int32_t (*setup)(struct GADGET_CTRL *priv, + struct usb_ctrlrequest *ctrl); + + void *(*usbRequestMemAlloc)(struct GADGET_CTRL *priv, + uint32_t requiredSize); + + void (*usbRequestMemFree)(struct GADGET_CTRL *priv, void *usbRequest); +}; + +struct GADGET_OBJ { + int32_t (*gadget_init)(struct GADGET_CTRL *priv, struct GADGET_CFG *config, + struct GADGET_CALLBACKS *callbacks, struct device *pdev); + + void (*gadget_destroy)(struct GADGET_CTRL *priv); + + void (*gadget_start)(struct GADGET_CTRL *priv); + + void (*gadget_stop)(struct GADGET_CTRL *priv); + + void (*gadget_isr)(struct GADGET_CTRL *priv); + + int32_t (*gadget_epEnable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + const struct usb_endpoint_descriptor *desc); + + int32_t (*gadget_epDisable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*gadget_epSetHalt)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, uint8_t value); + + int32_t (*gadget_epSetWedge)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*gadget_epFifoStatus)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + void (*gadget_epFifoFlush)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*gadget_reqQueue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); + + int32_t (*gadget_reqDequeue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); + + int32_t (*gadget_reqAlloc)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ **req); + + void (*gadget_reqFree)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); + + void (*gadget_getDevInstance)(struct GADGET_CTRL *priv, struct GADGET_DEV **dev); + + int32_t (*gadget_dGetFrame)(struct GADGET_CTRL *priv, uint32_t *numOfFrame); + + int32_t (*gadget_dWakeUp)(struct GADGET_CTRL *priv); + + int32_t (*gadget_dSetSelfpowered)(struct GADGET_CTRL *priv); + + int32_t (*gadget_dClearSelfpowered)(struct GADGET_CTRL *priv); + + int32_t (*gadget_dVbusSession)(struct GADGET_CTRL *priv, uint8_t isActive); + + int32_t (*gadget_dVbusDraw)(struct GADGET_CTRL *priv, uint8_t mA); + + int32_t (*gadget_dPullUp)(struct GADGET_CTRL *priv, uint8_t isOn); + + void (*gadget_dGetConfigParams)(struct GADGET_CTRL *priv, + struct usb_dcd_config_params *configParams); +}; + +struct GADGET_CTRL { + struct device *dev; + struct GADGET_DEV gadgetDev; + struct HW_REGS *regs; + struct GADGET_OBJ *gadgetDrv; + struct GADGET_CFG gadgetCfg; + struct GADGET_CALLBACKS eventCallback; + struct GadgetEp in[16]; + struct GadgetEp out[16]; + enum GADGET_EP0_STAGE ep0State; + uint8_t isRemoteWakeup; + uint8_t isSelfPowered; + uint8_t deviceAddress; + struct DMA_OBJ *dmaDrv; + void *dmaController; + struct DMA_CFG dmaCfg; + struct DMA_CALLBACKS dmaCallback; + uint8_t releaseEp0Flag; + uint8_t isReady; + uint8_t *privBuffAddr; + uintptr_t privBuffDma; + uint8_t endpointInList; + uint8_t hostRequestFlag; + struct VHUB_REGS *phy_regs; +}; + +struct GadgetRequest { + struct GADGET_REQ request; + struct GadgetEp *ep; + struct GADGET_DEV *dev; + uint8_t zlp; +}; + +struct GADGET_OBJ *GADGET_GetInstance(void); + +#endif /* __LINUX_PHYTIUM_GADGET */ + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/host.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/host.c new file mode 100644 index 0000000000000000000000000000000000000000..00d97248769ff027ef61f44d3f76caa340f3268b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/host.c @@ -0,0 +1,2671 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include +#include +#include +#include +//#include "list.h" +#include "core.h" +#include "dma.h" +#include "hw-regs.h" + +#define DRV_NAME "phytium_usb" + +#define HOST_GENERIC_EP_CONTROLL 0x00 +#define HOST_GENERIC_EP_ISOC 0x01 +#define HOST_GENERIC_EP_BULK 0x02 +#define HOST_GENERIC_EP_INT 0x03 + +#define HOST_ESTALL 1 +#define HOST_EUNHANDLED 2 +#define HOST_EAUTOACK 3 +#define HOST_ESHUTDOWN 4 + +#define HOST_EP_NUM 16 + +static inline struct HOST_REQ *getUsbRequestEntry(struct list_head *list) +{ + return (struct HOST_REQ *)((uintptr_t)list - (uintptr_t)&(((struct HOST_REQ *)0)->list)); +} + +static inline struct HOST_EP_PRIV *getUsbHEpPrivEntry(struct list_head *list) +{ + struct HOST_EP_PRIV *hostEpPriv; + + if (list_empty(list)) + return NULL; + + hostEpPriv = (struct HOST_EP_PRIV *)((uintptr_t)list - + (uintptr_t)&(((struct HOST_EP_PRIV *)0)->node)); + + return hostEpPriv; +} + +static struct HOST_REQ *getNextReq(struct HOST_EP *usbEp) +{ + struct list_head *queue; + + if (!usbEp) + return NULL; + + queue = &usbEp->reqList; + + if (list_empty(queue)) + return NULL; + + return getUsbRequestEntry(queue->next); +} + +static void host_SetVbus(struct HOST_CTRL *priv, uint8_t isOn) +{ + uint8_t otgctrl = phytium_read8(&priv->regs->otgctrl); + + if (isOn) { + if (!(otgctrl & OTGCTRL_BUSREQ) || (otgctrl & OTGCTRL_ABUSDROP)) { + otgctrl &= ~OTGCTRL_ABUSDROP; + otgctrl |= OTGCTRL_BUSREQ; + phytium_write8(&priv->regs->otgctrl, otgctrl); + } + priv->otgState = HOST_OTG_STATE_A_WAIT_BCON; + } else { + if ((otgctrl & OTGCTRL_BUSREQ) || (otgctrl & OTGCTRL_ABUSDROP)) { + otgctrl |= OTGCTRL_ABUSDROP; + otgctrl &= ~OTGCTRL_BUSREQ; + phytium_write8(&priv->regs->otgctrl, otgctrl); + } + priv->otgState = HOST_OTG_STATE_A_IDLE; + } +} + +static inline void disconnectHostDetect(struct HOST_CTRL *priv) +{ + uint8_t otgctrl, otgstate; + uint32_t gen_cfg; + + if (!priv) + return; + + otgctrl = phytium_read8(&priv->regs->otgctrl); + if ((otgctrl & OTGCTRL_ASETBHNPEN) && priv->otgState == HOST_OTG_STATE_A_SUSPEND) + pr_info("Device no Response\n"); + + phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); +retry: + otgstate = phytium_read8(&priv->regs->otgstate); + if ((otgstate == HOST_OTG_STATE_A_HOST || otgstate == HOST_OTG_STATE_B_HOST)) { + pr_info("IRQ OTG: DisconnIrq Babble\n"); + goto retry; + } + + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x04); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | 0 | 0x04); + + priv->portStatus = USB_PORT_STAT_POWER; + priv->portStatus |= USB_PORT_STAT_C_CONNECTION << 16; + + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + + if (priv->otgState == HOST_OTG_STATE_A_SUSPEND) + host_SetVbus(priv, 1); + + priv->otgState = HOST_OTG_STATE_A_IDLE; + if (priv->custom_regs) { + phytium_write32(&priv->custom_regs->wakeup, 1); + } else { + gen_cfg = phytium_read32(&priv->vhub_regs->gen_cfg); + gen_cfg |= BIT(1); + phytium_write32(&priv->vhub_regs->gen_cfg, gen_cfg); + } +} + +static inline void A_IdleDetect(struct HOST_CTRL *priv, uint8_t otgstate) +{ + uint8_t otgctrl; + + if (!priv) + return; + + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); + + if (otgstate != HOST_OTG_STATE_A_IDLE) { + pr_info("IRQ OTG: A_IDLE Babble\n"); + return; + } + + priv->portStatus = 0; + otgctrl = phytium_read8(&priv->regs->otgctrl); + otgctrl &= ~OTGCTRL_ASETBHNPEN; + phytium_write8(&priv->regs->otgctrl, otgctrl); + + host_SetVbus(priv, 1); + + priv->otgState = HOST_OTG_STATE_A_IDLE; +} + +static inline void B_IdleDetect(struct HOST_CTRL *priv, uint8_t otgstate) +{ + uint8_t otgctrl, usbcs; + + if (!priv) + return; + + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); + + if (otgstate != HOST_OTG_STATE_B_IDLE) { + pr_info("IRQ OTG: B_IDLE Babble\n"); + return; + } + + otgctrl = phytium_read8(&priv->regs->otgctrl); + otgctrl &= ~OTGCTRL_ASETBHNPEN; + phytium_write8(&priv->regs->otgctrl, otgctrl); + + host_SetVbus(priv, 0); + + priv->otgState = HOST_OTG_STATE_B_IDLE; + + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs &= ~USBCS_DISCON; + phytium_write8(&priv->regs->usbcs, usbcs); +} + +static uint32_t waitForBusyBit(struct HOST_CTRL *priv, struct HostEp *hwEp) +{ + uint8_t *csReg; + uint8_t flag = CS_BUSY; + uint8_t buf = 0; + uint8_t val = CS_BUSY; + uint8_t otgstate; + uint8_t bufflag = 0; + + if (!priv || !hwEp) + return 0; + + if (hwEp->isInEp) + return 0; + + if (hwEp->hwEpNum == 0) { + csReg = &priv->regs->ep0cs; + flag = EP0CS_TXBUSY_MASK; + buf = 0; + } else { + csReg = &priv->regs->ep[hwEp->hwEpNum - 1].txcs; + buf = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon) & CON_BUF; + } + + while ((val & flag) || bufflag == 0) { + otgstate = phytium_read8(&priv->regs->otgstate); + if (otgstate != HOST_OTG_STATE_B_HOST && otgstate != HOST_OTG_STATE_A_HOST) { + priv->ep0State = HOST_EP0_STAGE_IDLE; + return HOST_ESHUTDOWN; + } + + val = phytium_read8(csReg); + if (((val & CS_NPAK) >> CS_NPAK_OFFSET) == buf || buf == 0) + bufflag = 1; + else + bufflag = 0; + } + + return 0; +} + +static inline void connectHostDetect(struct HOST_CTRL *priv, uint8_t otgState) +{ + uint32_t gen_cfg; + + if (!priv) + return; + pr_debug("otgState:0x%x pirv->otgState:0x%x\n", otgState, priv->otgState); + if (priv->custom_regs) { + phytium_write32(&priv->custom_regs->wakeup, 0); + } else { + gen_cfg = phytium_read32(&priv->vhub_regs->gen_cfg); + gen_cfg &= ~BIT(1); + phytium_write32(&priv->vhub_regs->gen_cfg, gen_cfg); + } + + phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); + + if ((otgState != HOST_OTG_STATE_A_HOST) && (otgState != HOST_OTG_STATE_B_HOST)) + return; + + if ((priv->otgState == HOST_OTG_STATE_A_PERIPHERAL) + || (priv->otgState == HOST_OTG_STATE_B_PERIPHERAL)) + priv->otgState = otgState; + + priv->ep0State = HOST_EP0_STAGE_IDLE; + + priv->portStatus &= ~(USB_PORT_STAT_LOW_SPEED | USB_PORT_STAT_HIGH_SPEED | + USB_PORT_STAT_ENABLE); + + priv->portStatus |= USB_PORT_STAT_C_CONNECTION | (USB_PORT_STAT_C_CONNECTION << 16); + priv->dmaDrv->dma_controllerReset(priv->dmaController); + priv->port_resetting = 1; + host_SetVbus(priv, 1); + + switch (phytium_read8(&priv->regs->speedctrl)) { + case SPEEDCTRL_HS: + priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; + pr_debug("detect High speed device\n"); + break; + case SPEEDCTRL_FS: + priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); + pr_debug("detect Full speed device\n"); + break; + case SPEEDCTRL_LS: + priv->portStatus |= USB_PORT_STAT_LOW_SPEED; + pr_debug("detect Low speed device\n"); + break; + } + + priv->vBusErrCnt = 0; + priv->dmaDrv->dma_setHostMode(priv->dmaController); + + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + + priv->otgState = otgState; +} + +static void hostOtgIrq(struct HOST_CTRL *priv) +{ + uint8_t otgirq, otgien; + uint8_t otgstatus, otgstate; + uint8_t otgctrl; + + if (!priv) + return; + + otgirq = phytium_read8(&priv->regs->otgirq); + otgien = phytium_read8(&priv->regs->otgien); + otgstatus = phytium_read8(&priv->regs->otgstatus); + otgstate = phytium_read8(&priv->regs->otgstate); + otgirq &= otgien; + + if (!otgirq) + return; + + if (otgirq & OTGIRQ_BSE0SRPIRQ) { + otgirq &= ~OTGIRQ_BSE0SRPIRQ; + phytium_write8(&priv->regs->otgirq, OTGIRQ_BSE0SRPIRQ); + + otgctrl = phytium_read8(&priv->regs->otgctrl); + otgctrl &= ~OTGIRQ_BSE0SRPIRQ; + phytium_write8(&priv->regs->otgctrl, otgctrl); + } + + if (otgirq & OTGIRQ_SRPDETIRQ) { + otgirq &= ~OTGIRQ_SRPDETIRQ; + phytium_write8(&priv->regs->otgirq, OTGIRQ_SRPDETIRQ); + + otgctrl = phytium_read8(&priv->regs->otgctrl); + otgctrl &= ~OTGIRQ_SRPDETIRQ; + phytium_write8(&priv->regs->otgctrl, otgctrl); + } + + if (otgirq & OTGIRQ_VBUSERRIRQ) { + otgirq &= ~OTGIRQ_VBUSERRIRQ; + phytium_write8(&priv->regs->otgirq, OTGIRQ_VBUSERRIRQ); + + if (otgstate != HOST_OTG_STATE_A_VBUS_ERR) { + pr_info("IRQ OTG: VBUS ERROR Babble\n"); + return; + } + + host_SetVbus(priv, 0); + priv->otgState = HOST_OTG_STATE_A_VBUS_ERR; + if (priv->portStatus & USB_PORT_STAT_CONNECTION) { + priv->portStatus = USB_PORT_STAT_POWER | (USB_PORT_STAT_C_CONNECTION << 16); + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + return; + } + + if (priv->vBusErrCnt >= 3) { + priv->vBusErrCnt = 0; + pr_info("%s %d VBUS OVER CURRENT\n", __func__, __LINE__); + priv->portStatus |= USB_PORT_STAT_OVERCURRENT | + (USB_PORT_STAT_C_OVERCURRENT << 16); + + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); + } else { + priv->vBusErrCnt++; + host_SetVbus(priv, 1); + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); + } + } + + if (otgirq & OTGIRQ_CONIRQ) { + if (priv->otgState == HOST_OTG_STATE_A_HOST || + priv->otgState == HOST_OTG_STATE_B_HOST || + priv->otgState == HOST_OTG_STATE_A_SUSPEND) { + if (otgstate == HOST_OTG_STATE_A_WAIT_VFALL || + otgstate == HOST_OTG_STATE_A_WAIT_BCON || + otgstate == HOST_OTG_STATE_A_SUSPEND) + disconnectHostDetect(priv); + } else if (priv->otgState != HOST_OTG_STATE_A_HOST && + priv->otgState != HOST_OTG_STATE_B_HOST && + priv->otgState != HOST_OTG_STATE_A_SUSPEND) + connectHostDetect(priv, otgstate); + + phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); + } + + if (otgirq & OTGIRQ_IDLEIRQ) { + if (!(otgstatus & OTGSTATUS_ID)) + A_IdleDetect(priv, otgstate); + else + B_IdleDetect(priv, otgstate); + } + + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDCHANGEIRQ | + OTGIRQ_SRPDETIRQ); +} + +static void hostErrorIrq(struct HOST_CTRL *priv) +{ + uint16_t txerrirq, txerrien; + uint16_t rxerrirq, rxerrien; + uint16_t i, mask; + + if (!priv) + return; + + txerrirq = phytium_read16(&priv->regs->txerrirq); + txerrien = phytium_read16(&priv->regs->txerrien); + txerrirq &= txerrien; + + rxerrirq = phytium_read16(&priv->regs->rxerrirq); + rxerrien = phytium_read16(&priv->regs->rxerrien); + rxerrirq &= rxerrirq; + if (!txerrirq && !rxerrirq) + return; + + for (i = 0; i < HOST_EP_NUM; i++) { + mask = 1 << i; + if (rxerrirq & mask) { + phytium_write16(&priv->regs->rxerrirq, mask); + rxerrien &= ~mask; + phytium_write16(&priv->regs->rxerrien, rxerrien); + priv->dmaDrv->dma_errIsr(priv->dmaController, i, 0); + } + + if (txerrirq & mask) { + phytium_write16(&priv->regs->txerrirq, mask); + txerrien &= ~mask; + phytium_write16(&priv->regs->txerrien, txerrien); + priv->dmaDrv->dma_errIsr(priv->dmaController, i, 1); + } + } +} + +static uint32_t decodeErrorCode(uint8_t code) +{ + uint32_t status = 0; + + switch (code) { + case ERR_NONE: + status = 0; + break; + case ERR_CRC: + pr_info("CRC Error\n"); + status = HOST_ESHUTDOWN; + break; + case ERR_DATA_TOGGLE_MISMATCH: + pr_info("Toggle MisMatch Error\n"); + status = HOST_ESHUTDOWN; + break; + case ERR_STALL: + pr_debug("Stall Error\n"); + status = HOST_ESTALL; + break; + case ERR_TIMEOUT: + pr_debug("Timeout Error\n"); + status = HOST_ESHUTDOWN; + break; + case ERR_PID: + pr_info("PID Error\n"); + status = HOST_ESHUTDOWN; + break; + case ERR_TOO_LONG_PACKET: + pr_info("TOO_LONG_PACKET Error\n"); + status = HOST_ESHUTDOWN; + break; + case ERR_DATA_UNDERRUN: + pr_info("UNDERRUN Error\n"); + status = HOST_ESHUTDOWN; + break; + } + + return status; +} + +static struct HOST_EP_PRIV *getIntTransfer(struct list_head *head) +{ + struct list_head *listEntry = NULL; + struct HOST_EP_PRIV *usbHEpPriv = NULL; + struct HOST_EP_PRIV *usbHEpPrivActual = NULL; + + list_for_each(listEntry, head) { + usbHEpPriv = getUsbHEpPrivEntry(listEntry); + if (!usbHEpPrivActual) + usbHEpPrivActual = usbHEpPriv; + + if (usbHEpPriv->frame < usbHEpPrivActual->frame) + usbHEpPrivActual = usbHEpPriv; + } + + return usbHEpPrivActual; +} + +static void givebackRequest(struct HOST_CTRL *priv, struct HOST_REQ *usbReq, uint32_t status) +{ + if (!priv || !usbReq) + return; + + list_del(&usbReq->list); + + if (usbReq->status == EINPROGRESS) + usbReq->status = status; + + if (priv->hostCallbacks.givebackRequest) + priv->hostCallbacks.givebackRequest(priv, usbReq, status); +} + +static void hostEpProgram(struct HOST_CTRL *priv, struct HostEp *hwEp, + struct HOST_REQ *usbReq, uintptr_t dmaBuff, uint32_t length) +{ + struct HOST_EP *usbHEp; + struct HOST_EP_PRIV *usbEpPriv; + uint32_t chMaxLen; + uint8_t regCon = 0; + uint8_t ep0cs; + uint16_t txerrien = 0; + uint16_t rxerrien = 0; + uint32_t result; + uint8_t txsoftimer, rxsoftimer; + u8 retval = 0; + + if (!priv || !hwEp || !usbReq) + return; + + usbHEp = hwEp->scheduledUsbHEp; + usbEpPriv = (struct HOST_EP_PRIV *)usbHEp->hcPriv; + + if (!hwEp->channel) { + if (usbEpPriv->type == USB_ENDPOINT_XFER_ISOC) + hwEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, + !hwEp->isInEp, hwEp->hwEpNum, 1); + else + hwEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, + !hwEp->isInEp, hwEp->hwEpNum, 0); + } + + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, hwEp->channel); + + pr_debug("chMaxLen:0x%x buffLength:0x%x\n", chMaxLen, usbReq->buffLength); + if (usbReq->buffLength > chMaxLen) + length = chMaxLen; + + switch (usbEpPriv->type) { + case USB_ENDPOINT_XFER_CONTROL: + regCon = CON_TYPE_CONTROL; + break; + case USB_ENDPOINT_XFER_BULK: + regCon = CON_TYPE_BULK; + break; + case USB_ENDPOINT_XFER_INT: + regCon = CON_TYPE_INT; + break; + case USB_ENDPOINT_XFER_ISOC: + if (usbEpPriv->isocEpConfigured) + goto dma_program; + + usbEpPriv->isocEpConfigured = 1; + regCon = CON_TYPE_ISOC; + switch (usbHEp->desc.wMaxPacketSize >> 11) { + case 0: + regCon |= CON_TYPE_ISOC_1_ISOD; + priv->dmaDrv->dma_setMaxLength(priv->dmaController, + hwEp->channel, usbEpPriv->maxPacketSize); + break; + case 1: + regCon |= CON_TYPE_ISOC_2_ISOD; + priv->dmaDrv->dma_setMaxLength(priv->dmaController, + hwEp->channel, 2 * 1024); + break; + case 2: + priv->dmaDrv->dma_setMaxLength(priv->dmaController, + hwEp->channel, 3 * 1024); + regCon |= CON_TYPE_ISOC_3_ISOD; + break; + } + break; + } + + if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { + if (!hwEp->hwEpNum) { + if (phytium_read8(&priv->regs->ep0cs) & 0x4) { + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | + 0 | 0x4); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | + FIFOCTRL_IO_TX | 0 | 0x4); + } + } + if (waitForBusyBit(priv, hwEp) > 0) { + usbReq->status = HOST_ESHUTDOWN; + givebackRequest(priv, usbReq, HOST_ESHUTDOWN); + pr_info("something error happen\n"); + return; + } + } + + if (!hwEp->isInEp) { + if (hwEp->hwEpNum) { + regCon |= hwEp->hwBuffers - 1; + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, regCon); + if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { + retval = priv->hostCallbacks.getEpToggle(priv, + usbReq->usbDev, usbEpPriv->epNum, 0); + if (retval) { + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_IO_TX); + + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_TOGSETQ | ENDPRST_IO_TX | ENDPRST_FIFORST); + } else { + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_IO_TX); + + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_TOGRST | ENDPRST_IO_TX | ENDPRST_FIFORST); + } + } + + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, regCon | CON_VAL); + phytium_write16(&priv->regs->txmaxpack[hwEp->hwEpNum - 1], + usbEpPriv->maxPacketSize); + + phytium_write8(&priv->regs->epExt[hwEp->hwEpNum - 1].txctrl, + usbEpPriv->epNum); + + phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); + + // if (usbEpPriv->type == USB_ENDPOINT_XFER_INT) + txsoftimer = phytium_read8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl); + txsoftimer = txsoftimer | BIT(1); + phytium_write8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl, txsoftimer); + + phytium_write16(&priv->regs->txsoftimer[hwEp->hwEpNum].timer, + usbEpPriv->frame); + + phytium_write8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl, 0x83); + } else { + phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); + phytium_write8(&priv->regs->ep0maxpack, usbEpPriv->maxPacketSize); + phytium_write8(&priv->regs->ep0ctrl, usbEpPriv->epNum); + + if (priv->ep0State == HOST_EP0_STAGE_SETUP) { + ep0cs = phytium_read8(&priv->regs->ep0cs); + ep0cs |= EP0CS_HCSET; + phytium_write8(&priv->regs->ep0cs, ep0cs); + } + } + + phytium_write16(&priv->regs->txerrirq, 1 << hwEp->hwEpNum); + txerrien = phytium_read16(&priv->regs->txerrien); + txerrien |= 1 << hwEp->hwEpNum; + phytium_write16(&priv->regs->txerrien, txerrien); + } else { + if (hwEp->hwEpNum) { + regCon |= hwEp->hwBuffers - 1; + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, regCon); + + if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { + if (priv->hostCallbacks.getEpToggle) { + retval = priv->hostCallbacks.getEpToggle(priv, + usbReq->usbDev, usbEpPriv->epNum, 1); + if (retval) { + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_TOGSETQ | ENDPRST_FIFORST); + } else { + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_TOGRST | ENDPRST_FIFORST); + } + } + } + + phytium_write16(&priv->regs->rxmaxpack[hwEp->hwEpNum - 1], + usbEpPriv->maxPacketSize); + + phytium_write8(&priv->regs->epExt[hwEp->hwEpNum - 1].rxctrl, + usbEpPriv->epNum); + + phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); + + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); + + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, regCon | CON_VAL); + rxsoftimer = phytium_read8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl); + rxsoftimer = rxsoftimer | BIT(1); + phytium_write8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl, rxsoftimer); + + phytium_write16(&priv->regs->rxsoftimer[hwEp->hwEpNum].timer, + usbEpPriv->frame); + + phytium_write8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl, 0x83); + } else { + phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); + phytium_write8(&priv->regs->ep0maxpack, usbEpPriv->maxPacketSize); + phytium_write8(&priv->regs->ep0ctrl, usbEpPriv->epNum); + + if (priv->ep0State == HOST_EP0_STAGE_IN + || priv->ep0State == HOST_EP0_STAGE_STATUSIN) + phytium_write8(&priv->regs->ep0cs, EP0CS_HCSETTOGGLE); + } + + phytium_write16(&priv->regs->rxerrirq, 1 << hwEp->hwEpNum); + rxerrien = phytium_read16(&priv->regs->rxerrien); + rxerrien |= 1 << hwEp->hwEpNum; + phytium_write16(&priv->regs->rxerrien, rxerrien); + } +dma_program: + result = priv->dmaDrv->dma_channelProgram(priv->dmaController, hwEp->channel, + usbEpPriv->maxPacketSize, dmaBuff, length, + (void *)usbReq->isoFramesDesc, usbReq->isoFramesNumber); + if (result) { + if (!hwEp->isInEp) { + txerrien &= ~(1 << hwEp->hwEpNum); + if (hwEp->hwEpNum) + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, 0x08); + phytium_write16(&priv->regs->txerrien, txerrien); + } else { + rxerrien &= ~(1 << hwEp->hwEpNum); + if (hwEp->hwEpNum) + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, 0x08); + phytium_write16(&priv->regs->rxerrien, rxerrien); + } + + priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); + hwEp->channel = NULL; + } +} + +static void hostStartReq(struct HOST_CTRL *priv, struct HOST_REQ *req) +{ + uintptr_t dmaBuff; + uint32_t length; + struct HOST_EP *hostEp; + struct HOST_EP_PRIV *hostEpPriv; + struct HOST_EP_PRIV *hostNewEpPriv; + struct HOST_REQ *usbReq = NULL; + struct HostEp *hwEp = NULL; + int num; + + if (!priv || !req) + return; + + hostEp = req->hcPriv; + if (hostEp) { + hostEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; + if (hostEpPriv) { + hostEpPriv->genericHwEp->state = HOST_EP_BUSY; + switch (hostEpPriv->type) { + case USB_ENDPOINT_XFER_CONTROL: + usbReq = getNextReq(hostEp); + + priv->in[HOST_GENERIC_EP_CONTROLL].scheduledUsbHEp = hostEp; + priv->ep0State = HOST_EP0_STAGE_SETUP; + hostEpPriv->currentHwEp = hostEpPriv->genericHwEp; + hostEpPriv->genericHwEp->scheduledUsbHEp = hostEp; + dmaBuff = usbReq->setupDma; + length = 8; + pr_debug("packet info: %02x %02x %04x %04x %04x\n", + usbReq->setup->bRequestType, + usbReq->setup->bRequest, + usbReq->setup->wValue, + usbReq->setup->wIndex, + usbReq->setup->wLength); + hostEpProgram(priv, hostEpPriv->genericHwEp, + usbReq, dmaBuff, length); + break; + case USB_ENDPOINT_XFER_BULK: + hwEp = hostEpPriv->genericHwEp; + usbReq = getNextReq(hostEp); + hostEpPriv->currentHwEp = hwEp; + hwEp->scheduledUsbHEp = hostEp; + dmaBuff = usbReq->buffDma + usbReq->actualLength; + length = usbReq->buffLength - usbReq->actualLength; + hostEpProgram(priv, hwEp, usbReq, dmaBuff, length); + break; + case USB_ENDPOINT_XFER_INT: + if (hostEpPriv->genericHwEp->scheduledUsbHEp) + return; + + num = req->epNum - 1; + if (hostEpPriv->isIn) + hostNewEpPriv = getIntTransfer(&priv->intInHEpQueue[num]); + else + hostNewEpPriv = getIntTransfer(&priv->intOutHEpQueue[num]); + + hostNewEpPriv->currentHwEp = hostEpPriv->genericHwEp; + hostEpPriv->genericHwEp->scheduledUsbHEp = hostNewEpPriv->usbHEp; + usbReq = getNextReq(hostEp); + dmaBuff = usbReq->buffDma + usbReq->actualLength; + length = usbReq->buffLength - usbReq->actualLength; + hostEpProgram(priv, hostEpPriv->genericHwEp, + usbReq, dmaBuff, length); + break; + case USB_ENDPOINT_XFER_ISOC: + hostEpPriv->currentHwEp = hostEpPriv->genericHwEp; + hostEpPriv->genericHwEp->scheduledUsbHEp = hostEp; + dmaBuff = req->buffDma + req->actualLength; + length = req->buffLength - req->actualLength; + hostEpProgram(priv, hostEpPriv->genericHwEp, req, dmaBuff, length); + break; + } + } + } +} + + +static void scheduleNextTransfer(struct HOST_CTRL *priv, + struct HOST_REQ *usbReq, struct HostEp *hwEp) +{ + struct HOST_EP *usbEp; + struct HOST_EP_PRIV *usbHEpPriv; + uint8_t endprst; + uint32_t status; + struct HOST_REQ *usbNextReq = NULL; + + if (!priv || !usbReq || !hwEp) + return; + + usbEp = hwEp->scheduledUsbHEp; + usbHEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; + if (!usbHEpPriv) + return; + + status = (usbReq->status == EINPROGRESS) ? 0 : usbReq->status; + switch (usbHEpPriv->type) { + case USB_ENDPOINT_XFER_BULK: + case USB_ENDPOINT_XFER_INT: + if (hwEp->isInEp) { + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); + endprst = (phytium_read8(&priv->regs->endprst) & ENDPRST_TOGSETQ) ? 1 : 0; + if (priv->hostCallbacks.setEpToggle) + priv->hostCallbacks.setEpToggle(priv, usbReq->usbDev, + usbHEpPriv->epNum, usbHEpPriv->isIn, endprst); + } else { + if (waitForBusyBit(priv, hwEp) > 0) { + usbReq->status = HOST_ESHUTDOWN; + givebackRequest(priv, usbReq, HOST_ESHUTDOWN); + return; + } + + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | ENDPRST_IO_TX); + endprst = (phytium_read8(&priv->regs->endprst) & ENDPRST_TOGSETQ) ? 1 : 0; + if (priv->hostCallbacks.setEpToggle) + priv->hostCallbacks.setEpToggle(priv, usbReq->usbDev, + usbHEpPriv->epNum, usbHEpPriv->isIn, endprst); + } + break; + } + + if (usbHEpPriv->transferFinished) + givebackRequest(priv, usbReq, status); + + if (list_empty(&usbEp->reqList)) { + if (usbHEpPriv->type == USB_ENDPOINT_XFER_CONTROL) + hwEp->state = HOST_EP_ALLOCATED; + else { + if (usbHEpPriv->genericHwEp == hwEp) + hwEp->state = HOST_EP_ALLOCATED; + else + hwEp->state = HOST_EP_FREE; + } + + usbHEpPriv->epIsReady = 0; + usbHEpPriv->currentHwEp = NULL; + hwEp->scheduledUsbHEp = NULL; + + if (hwEp->channel) { + priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); + hwEp->channel = NULL; + } + + if (usb_endpoint_xfer_int(&usbEp->desc)) + list_del(&usbHEpPriv->node); + usbHEpPriv = NULL; + } else { + if (usbHEpPriv->type == USB_ENDPOINT_XFER_INT) { + usbHEpPriv->currentHwEp = NULL; + hwEp->scheduledUsbHEp = NULL; + } + + if (usbHEpPriv->type == USB_ENDPOINT_XFER_ISOC) + return; + } + + if (usbHEpPriv) { + usbNextReq = getNextReq(usbHEpPriv->usbHEp); + hostStartReq(priv, usbNextReq); + } +} + +static int32_t hostEp0Irq(struct HOST_CTRL *priv, uint8_t isIn) +{ + struct HostEp *hwEp; + struct HOST_EP *hostEp; + struct HOST_REQ *usbReq = NULL; + struct HOST_EP_PRIV *usbHEpPriv; + uint32_t status, length; + uint8_t usbError; + uint8_t nextStage = 0; + int ret = 0; + + if (!priv) + return ret; + + hwEp = isIn ? &priv->in[HOST_GENERIC_EP_CONTROLL] : &priv->out[HOST_GENERIC_EP_CONTROLL]; + hostEp = hwEp->scheduledUsbHEp; + usbHEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; + + usbReq = getNextReq(hostEp); + if (!usbReq) + return 0; + + usbError = isIn ? phytium_read8(&priv->regs->rx0err) : phytium_read8(&priv->regs->tx0err); + usbError = (usbError & ERR_TYPE) >> 2; + status = decodeErrorCode(usbError); + if (status) { + usbReq->status = status; + + if (status == HOST_ESTALL) { + ret = 1; + priv->dmaDrv->dma_controllerReset(priv->dmaController); + } + + phytium_write16(&priv->regs->rxerrirq, 1 << hwEp->hwEpNum); + phytium_write16(&priv->regs->txerrirq, 1 << hwEp->hwEpNum); + + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x4); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | + FIFOCTRL_IO_TX | 0 | 0x4); + } + + length = priv->dmaDrv->dma_getActualLength(priv->dmaController, hwEp->channel); + priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); + hwEp->channel = NULL; + + if (usbReq->status == EINPROGRESS && priv->ep0State < HOST_EP0_STAGE_STATUSIN) { + nextStage = 0; + switch (priv->ep0State) { + case HOST_EP0_STAGE_IN: + pr_debug("Ep0 Data IN\n"); + usbHEpPriv->currentHwEp = &priv->out[HOST_GENERIC_EP_CONTROLL]; + usbReq->actualLength = length; + priv->ep0State = HOST_EP0_STAGE_STATUSOUT; + break; + case HOST_EP0_STAGE_OUT: + pr_debug("Ep0 Data OUT\n"); + usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROLL]; + usbReq->actualLength = length; + priv->ep0State = HOST_EP0_STAGE_STATUSIN; + break; + case HOST_EP0_STAGE_SETUP: + pr_debug("Ep0 Stage Setup\n"); + if (!usbReq->setup->wLength) { + pr_debug("EP0_STAGE_STATUSIN\n"); + priv->ep0State = HOST_EP0_STAGE_STATUSIN; + usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROLL]; + break; + } else if (usbReq->setup->bRequestType & USB_DIR_IN) { + pr_debug("EP0_STAGE_STAGE_IN\n"); + priv->ep0State = HOST_EP0_STAGE_IN; + usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROLL]; + nextStage = 1; + break; + } + priv->ep0State = HOST_EP0_STAGE_OUT; + nextStage = 1; + break; + case HOST_EP0_STAGE_STATUSIN: + case HOST_EP0_STAGE_STATUSOUT: + case HOST_EP0_STAGE_ACK: + case HOST_EP0_STAGE_IDLE: + default: + pr_debug("EP0 STAGE is %d\n", priv->ep0State); + break; + } + + if (nextStage) { + length = usbReq->buffLength; + hostEpProgram(priv, usbHEpPriv->currentHwEp, usbReq, + usbReq->buffDma, length); + } else + hostEpProgram(priv, usbHEpPriv->currentHwEp, usbReq, usbReq->setupDma, 0); + } else + priv->ep0State = HOST_EP0_STAGE_IDLE; + + if (priv->ep0State == HOST_EP0_STAGE_IDLE || usbReq->status != EINPROGRESS) { + usbHEpPriv->transferFinished = 1; + scheduleNextTransfer(priv, usbReq, hwEp); + } + + return 0; +} + +static void updateTimeIntTransfer(struct list_head *head, struct HOST_EP_PRIV *lastFinished) +{ + struct list_head *listEntry = NULL; + struct HOST_EP_PRIV *usbHEpPriv = NULL; + uint16_t time = lastFinished->frame; + + list_for_each(listEntry, head) { + usbHEpPriv = getUsbHEpPrivEntry(listEntry); + if (usbHEpPriv == lastFinished) { + lastFinished->frame = lastFinished->interval; + continue; + } + + if (usbHEpPriv->frame < time) + usbHEpPriv->frame = 0; + else + lastFinished->interval = usbHEpPriv->frame; + } +} + +static int32_t hostEpXIrq(struct HOST_CTRL *priv, uint8_t hwEpNum, uint8_t isIn, bool resubmit) +{ + struct HostEp *hwEp; + struct HOST_EP *hostEp; + struct HOST_EP_PRIV *usbHEpPriv; + struct HOST_REQ *usbReq; + + uint8_t usbError, rxcon, txcon; + uint32_t status, length, chMaxLen; + + if (!priv) + return -EINVAL; + + hwEp = isIn ? &priv->in[hwEpNum] : &priv->out[hwEpNum]; + hostEp = hwEp->scheduledUsbHEp; + if (!hostEp) + return -EINVAL; + + usbHEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; + + usbReq = getNextReq(hostEp); + if (!usbReq) + return 0; + + if (isIn) + usbError = phytium_read8(&priv->regs->epExt[hwEpNum - 1].rxerr); + else + usbError = phytium_read8(&priv->regs->epExt[hwEpNum - 1].txerr); + + usbError = (usbError & ERR_TYPE) >> 2; + status = decodeErrorCode(usbError); + if (status) { + pr_debug("%s %d Aborting\n", __func__, __LINE__); + if (isIn) + phytium_write16(&priv->regs->rxerrirq, 1 << hwEpNum); + else + phytium_write16(&priv->regs->txerrirq, 1 << hwEpNum); + priv->dmaDrv->dma_channelAbort(priv->dmaController, hwEp->channel); + } + + length = priv->dmaDrv->dma_getActualLength(priv->dmaController, hwEp->channel); + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, hwEp->channel); + + if (status != 0) + usbReq->status = status; + + usbReq->actualLength += length; + + if (!resubmit) + usbHEpPriv->transferFinished = 1; + + if (length == chMaxLen) { + if ((usbReq->buffLength - usbReq->actualLength) == 0) + usbHEpPriv->transferFinished = 1; + else + usbHEpPriv->transferFinished = 0; + } + + if (usbHEpPriv->type != USB_ENDPOINT_XFER_ISOC) { + if (!hwEp->isInEp) { + txcon = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon); + txcon &= ~CON_VAL; + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, txcon); + } else { + rxcon = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon); + rxcon &= ~CON_VAL; + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, rxcon); + } + priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); + hwEp->channel = NULL; + } + + if (usbHEpPriv->type == USB_ENDPOINT_XFER_INT) { + if (usbHEpPriv->isIn) + updateTimeIntTransfer(&priv->intInHEpQueue[hwEp->hwEpNum - 1], usbHEpPriv); + else + updateTimeIntTransfer(&priv->intOutHEpQueue[hwEp->hwEpNum - 1], usbHEpPriv); + } + + scheduleNextTransfer(priv, usbReq, hwEp); + + return 0; +} + + +static void host_CallbackTransfer(void *priv, uint8_t epNum, uint8_t isDirTx, bool resubmit) +{ + struct HOST_CTRL *host_priv = (struct HOST_CTRL *)priv; + int i; + int ret = 0; + + if (!epNum) { + ret = hostEp0Irq(host_priv, !isDirTx); + if (resubmit | ret) { + for (i = 1; i < HOST_EP_NUM; i++) { + hostEpXIrq(host_priv, i, !isDirTx, true); + hostEpXIrq(host_priv, i, isDirTx, true); + } + } + } else + hostEpXIrq(host_priv, epNum, !isDirTx, false); +} + +static int hc_reset(struct usb_hcd *hcd) +{ + hcd->speed = HCD_USB2; + hcd->self.root_hub->speed = USB_SPEED_HIGH; + + return 0; +} + +static int hc_start(struct usb_hcd *hcd) +{ + hcd->state = HC_STATE_RUNNING; + return 0; +} + +static void hc_stop(struct usb_hcd *hcd) +{ + struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; + + if (config) + config->host_obj->host_stop(config->host_priv); + + if (config->host_cfg.trbAddr) { + dma_free_coherent(config->dev, config->host_sysreq.trbMemSize, + config->host_cfg.trbAddr, config->host_cfg.trbDmaAddr); + config->host_cfg.trbAddr = NULL; + } + + if (config->host_priv) { + devm_kfree(config->dev, config->host_priv); + config->host_priv = NULL; + } + + hcd->state = HC_STATE_HALT; +} + +static void hc_shutdown(struct usb_hcd *hcd) +{ +} + +static void host_endpoint_update(struct phytium_cusb *config, + struct HOST_USB_DEVICE *udev, struct usb_host_endpoint *ep) +{ + int epnum; + struct HOST_EP *hostEp; + + if (!config || !udev || !ep) + return; + + epnum = usb_endpoint_num(&ep->desc); + if (epnum > MAX_INSTANCE_EP_NUM) + epnum = MAX_INSTANCE_EP_NUM; + + if (usb_endpoint_dir_out(&ep->desc)) { + if (udev->out_ep[epnum] == NULL) { + hostEp = kzalloc(sizeof(struct HOST_EP) + + config->host_obj->host_epGetPrivateDataSize(config->host_priv), + GFP_ATOMIC); + udev->out_ep[epnum] = hostEp; + } else + hostEp = udev->out_ep[epnum]; + } else { + if (udev->in_ep[epnum] == NULL) { + hostEp = kzalloc(sizeof(struct HOST_EP) + + config->host_obj->host_epGetPrivateDataSize(config->host_priv), + GFP_ATOMIC); + udev->in_ep[epnum] = hostEp; + } else + hostEp = udev->in_ep[epnum]; + } + + hostEp->desc = *(struct usb_endpoint_descriptor *)(&ep->desc); + hostEp->userExt = (void *)ep; + INIT_LIST_HEAD(&hostEp->reqList); + hostEp->hcPriv = &((uint8_t *)hostEp)[sizeof(struct HOST_EP)]; +} + +static int hc_urb_enqueue(struct usb_hcd *hcd, struct urb *urb, gfp_t mem_flags) +{ + unsigned long flags; + u32 isoFrameSize; + int retval; + int index; + struct HOST_REQ *req; + struct HOST_CTRL *priv; + struct HOST_USB_DEVICE *usbDev; + struct usb_host_endpoint *host_ep; + struct usb_endpoint_descriptor *host_ep_desc; + struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; + + if (!config) + return -ENODEV; + + priv = config->host_priv; + if (!priv) + return -ENODEV; + + usbDev = priv->host_devices_table[urb->dev->slot_id]; + if (!usbDev) + return -ENODEV; + + host_ep = urb->ep; + host_ep_desc = &host_ep->desc; + + spin_lock_irqsave(&config->lock, flags); + retval = usb_hcd_link_urb_to_ep(hcd, urb); + if (retval < 0) { + spin_unlock_irqrestore(&config->lock, flags); + return retval; + } + spin_unlock_irqrestore(&config->lock, flags); + isoFrameSize = urb->number_of_packets * sizeof(struct HOST_ISOFRAMESDESC); + req = kzalloc((sizeof(struct HOST_REQ) + + isoFrameSize), mem_flags); + if (!req) { + spin_lock_irqsave(&config->lock, flags); + usb_hcd_unlink_urb_from_ep(hcd, urb); + spin_unlock_irqrestore(&config->lock, flags); + return -ENOMEM; + } + + req->isoFramesDesc = NULL; + req->isoFramesNumber = urb->number_of_packets; + req->epNum = usb_endpoint_num(host_ep_desc); + if (req->epNum > MAX_INSTANCE_EP_NUM) + req->epNum = MAX_INSTANCE_EP_NUM; + + if (usb_endpoint_dir_in(host_ep_desc)) { + if (!usbDev->in_ep[req->epNum]) + host_endpoint_update(config, usbDev, host_ep); + } else { + if (!usbDev->out_ep[req->epNum]) + host_endpoint_update(config, usbDev, host_ep); + } + + if (usb_endpoint_xfer_isoc(host_ep_desc)) { + req->isoFramesDesc = (struct HOST_ISOFRAMESDESC *)(&req[1]); + for (index = 0; index < urb->number_of_packets; index++) { + req->isoFramesDesc[index].length = urb->iso_frame_desc[index].length; + req->isoFramesDesc[index].offset = urb->iso_frame_desc[index].offset; + } + } + + spin_lock_irqsave(&config->lock, flags); + INIT_LIST_HEAD(&req->list); + req->userExt = (void *)urb; + req->actualLength = urb->actual_length; + req->bufAddress = urb->transfer_buffer; + req->buffDma = urb->transfer_dma; + req->buffLength = urb->transfer_buffer_length; + req->epIsIn = usb_endpoint_dir_in(host_ep_desc); + req->eptype = usb_endpoint_type(host_ep_desc); + req->faddress = usb_pipedevice(urb->pipe); + req->interval = urb->interval; + req->reqUnlinked = 0; + req->setup = (struct usb_ctrlrequest *)urb->setup_packet; + req->setupDma = urb->setup_dma; + req->status = EINPROGRESS; + req->usbDev = &usbDev->udev; + req->usbEp = req->epIsIn ? usbDev->in_ep[req->epNum] : usbDev->out_ep[req->epNum]; + if (!req->epNum) + usbDev->ep0_hep.desc.wMaxPacketSize = urb->dev->ep0.desc.wMaxPacketSize; + + req->hcPriv = (void *)req->usbEp; + urb->hcpriv = req; + host_ep->hcpriv = (void *)usbDev; + retval = config->host_obj->host_reqQueue(config->host_priv, req); + if (retval) { + usb_hcd_unlink_urb_from_ep(hcd, urb); + urb->hcpriv = NULL; + spin_unlock_irqrestore(&config->lock, flags); + kfree(req); + return -retval; + } + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static int hc_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status) +{ + unsigned long flags; + struct HOST_CTRL *priv; + int ret = 0; + struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; + + if (!config) + return -ENODEV; + + priv = config->host_priv; + if (!priv->host_devices_table[urb->dev->slot_id]) + return -ENODEV; + + spin_lock_irqsave(&config->lock, flags); + if (usb_hcd_check_unlink_urb(hcd, urb, status)) + goto done; + + if (!urb->hcpriv) + goto err_giveback; + + ret = config->host_obj->host_reqDequeue(priv, urb->hcpriv, status); + kfree(urb->hcpriv); + urb->hcpriv = NULL; +done: + spin_unlock_irqrestore(&config->lock, flags); + return ret; + +err_giveback: + kfree(urb->hcpriv); + usb_hcd_unlink_urb_from_ep(hcd, urb); + spin_unlock_irqrestore(&config->lock, flags); + usb_hcd_giveback_urb(hcd, urb, -ESHUTDOWN); + return ret; +} + +static void hc_endpoint_disable(struct usb_hcd *hcd, struct usb_host_endpoint *ld_ep) +{ + struct HOST_USB_DEVICE *usbDev; + int ep_num = usb_endpoint_num(&ld_ep->desc); + + if (ep_num > MAX_INSTANCE_EP_NUM) + ep_num = MAX_INSTANCE_EP_NUM; + + usbDev = (struct HOST_USB_DEVICE *)ld_ep->hcpriv; + if (!usbDev) + return; + + if (ld_ep->desc.bEndpointAddress) { + if (usb_endpoint_dir_in(&ld_ep->desc)) { + if (!usbDev->in_ep[ep_num]) { + usbDev->in_ep[ep_num]->userExt = NULL; + INIT_LIST_HEAD(&usbDev->in_ep[ep_num]->reqList); + kfree(usbDev->in_ep[ep_num]); + usbDev->in_ep[ep_num] = NULL; + } + } else { + if (!usbDev->out_ep[ep_num]) { + usbDev->out_ep[ep_num]->userExt = NULL; + INIT_LIST_HEAD(&usbDev->out_ep[ep_num]->reqList); + kfree(usbDev->out_ep[ep_num]); + usbDev->out_ep[ep_num] = NULL; + } + } + } +} + +static int hc_get_frame(struct usb_hcd *hcd) +{ + return 0; +} + +static int hc_alloc_dev(struct usb_hcd *hcd, struct usb_device *udev) +{ + struct HOST_USB_DEVICE *usbDev; + struct phytium_cusb *config; + struct HOST_CTRL *priv; + unsigned long flags = 0; + int index; + int slot = -EINVAL; + + if (!hcd || !udev) + return -EINVAL; + + config = *(struct phytium_cusb **)hcd->hcd_priv; + if (!config) + return 0; + + spin_lock_irqsave(&config->lock, flags); + priv = config->host_priv; + for (index = 0; index < MAX_SUPPORTED_DEVICES; index++) { + if (priv->host_devices_table[index] == NULL) { + slot = index; + break; + } + } + spin_unlock_irqrestore(&config->lock, flags); + + if (slot < 0) + return -ENOMEM; + + usbDev = kzalloc((sizeof(struct HOST_USB_DEVICE) + + config->host_obj->host_epGetPrivateDataSize(priv)), GFP_KERNEL); + if (!usbDev) + return -ENOMEM; + + usbDev->ep0_hep.hcPriv = &((uint8_t *)usbDev)[sizeof(struct HOST_USB_DEVICE)]; + usbDev->udev.userExt = (void *)usbDev; + usbDev->ld_udev = udev; + usbDev->ld_udev->slot_id = slot; + usbDev->ep0_hep.desc.bLength = 7; + usbDev->ep0_hep.desc.bDescriptorType = USB_DT_ENDPOINT; + usbDev->in_ep[0] = &usbDev->ep0_hep; + usbDev->out_ep[0] = &usbDev->ep0_hep; + INIT_LIST_HEAD(&usbDev->ep0_hep.reqList); + + priv->host_devices_table[slot] = usbDev; + + return 1; +} + +static void hc_free_dev(struct usb_hcd *hcd, struct usb_device *udev) +{ + struct HOST_CTRL *priv; + struct HOST_USB_DEVICE *usbDev; + struct phytium_cusb *config; + int i; + + if (!hcd || !udev) + return; + + config = *(struct phytium_cusb **)(hcd->hcd_priv); + if (!config) + return; + + priv = (struct HOST_CTRL *)config->host_priv; + usbDev = priv->host_devices_table[udev->slot_id]; + if (!usbDev) + return; + + usbDev->in_ep[0] = NULL; + usbDev->out_ep[0] = NULL; + for (i = 1; i < HOST_EP_NUM; i++) { + if (usbDev->in_ep[i]) + hc_endpoint_disable(hcd, + (struct usb_host_endpoint *)usbDev->in_ep[i]->userExt); + if (usbDev->out_ep[i]) + hc_endpoint_disable(hcd, + (struct usb_host_endpoint *)usbDev->out_ep[i]->userExt); + } + + priv->host_devices_table[udev->slot_id] = NULL; + usbDev->ld_udev->slot_id = 0; + usbDev->udev.userExt = (void *)NULL; + kfree(usbDev); +} + +static int hc_reset_device(struct usb_hcd *hcd, struct usb_device *udev) +{ + struct HOST_CTRL *priv; + struct HOST_USB_DEVICE *usb_device; + struct phytium_cusb *config; + + if (!hcd || !udev) + return -EINVAL; + + config = *(struct phytium_cusb **)hcd->hcd_priv; + priv = (struct HOST_CTRL *)config->host_priv; + usb_device = priv->host_devices_table[udev->slot_id]; + if (!usb_device) + return -ENODEV; + + usb_device->udev.speed = usb_device->ld_udev->speed; + usb_device->udev.devnum = usb_device->ld_udev->devnum; + + if (USB_SPEED_HIGH == usb_device->udev.speed || USB_SPEED_FULL == usb_device->udev.speed) + usb_device->ep0_hep.desc.wMaxPacketSize = 64; + else + usb_device->ep0_hep.desc.wMaxPacketSize = 8; + + pr_debug("speed:%d ep0 wMaxPacketSize:%d\n", usb_device->udev.speed, + usb_device->ep0_hep.desc.wMaxPacketSize); + + return 0; +} + +static int hc_update_device(struct usb_hcd *hcd, struct usb_device *udev) +{ + struct HOST_CTRL *priv; + struct HOST_USB_DEVICE *usb_device; + struct phytium_cusb *config; + + if (!hcd || !udev) + return -EINVAL; + + config = *(struct phytium_cusb **)(hcd->hcd_priv); + priv = (struct HOST_CTRL *)config->host_priv; + + usb_device = priv->host_devices_table[udev->slot_id]; + if (!usb_device) + return -ENODEV; + + usb_device->udev.devnum = udev->devnum; + + return 0; +} + +static int hc_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev, + struct usb_host_endpoint *ep) +{ + return 0; +} + +static int hc_drop_endpoint(struct usb_hcd *hcd, struct usb_device *udev, + struct usb_host_endpoint *ep) +{ + return 0; +} + +static int hc_hub_status_data(struct usb_hcd *hcd, char *buf) +{ + struct HOST_CTRL *priv; + struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; + + if (!config) + return 0; + + priv = (struct HOST_CTRL *)config->host_priv; + if (!priv) + return 0; + + if (priv->portStatus & 0xffff0000) { + *buf = 0x02; + return 1; + } + + return 0; +} + +#ifdef CONFIG_PM +static int hc_bus_suspend(struct usb_hcd *hcd) +{ + unsigned long flags; + struct phytium_cusb *config = *(struct phytium_cusb **)(hcd->hcd_priv); + + if (!config) + return 0; + + spin_lock_irqsave(&config->lock, flags); + hcd->state = HC_STATE_SUSPENDED; + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static int hc_bus_resume(struct usb_hcd *hcd) +{ + unsigned long flags; + struct phytium_cusb *config = *(struct phytium_cusb **)(hcd->hcd_priv); + + if (!config) + return 0; + + spin_lock_irqsave(&config->lock, flags); + hcd->state = HC_STATE_RESUMING; + spin_unlock_irqrestore(&config->lock, flags); + return 0; +} +#endif + +static void host_giveback_request(struct HOST_CTRL *priv, + struct HOST_REQ *req, uint32_t status) +{ + struct urb *urb_req; + int urb_status = 0; + int i = 0; + struct phytium_cusb *config; + + if (!priv || !req) + return; + + urb_req = req->userExt; + urb_req->actual_length = req->actualLength; + + switch (status) { + case HOST_ESTALL: + urb_status = -EPIPE; + break; + case HOST_EUNHANDLED: + urb_status = -EPROTO; + break; + case HOST_ESHUTDOWN: + urb_status = -ESHUTDOWN; + break; + default: + urb_status = status; + } + pr_debug("complete %p %pS (%d) dev%d ep%d%s %d/%d\n", + urb_req, urb_req->complete, urb_status, + usb_pipedevice(urb_req->pipe), + usb_pipeendpoint(urb_req->pipe), + usb_pipein(urb_req->pipe) ? "in" : "out", + urb_req->actual_length, + urb_req->transfer_buffer_length); + + if (usb_endpoint_xfer_isoc(&urb_req->ep->desc)) { + for (i = 0; i < urb_req->number_of_packets; i++) { + urb_req->iso_frame_desc[i].status = 0; + urb_req->iso_frame_desc[i].actual_length = req->isoFramesDesc[i].length; + } + } + + config = dev_get_drvdata(priv->dev); + usb_hcd_unlink_urb_from_ep(config->hcd, urb_req); + spin_unlock(&config->lock); + usb_hcd_giveback_urb(config->hcd, urb_req, urb_status); + kfree(req); + spin_lock(&config->lock); +} + +static void host_rh_port_status_change(struct HOST_CTRL *priv) +{ + uint32_t statusHub; + char *status; + uint32_t retval; + struct usb_ctrlrequest setup; + struct phytium_cusb *config; + + if (!priv) + return; + + config = dev_get_drvdata(priv->dev); + if (!config) + return; + + status = (char *)&statusHub; + hc_hub_status_data(config->hcd, status); + + if (status) { + setup.bRequestType = USB_TYPE_CLASS | USB_RECIP_OTHER | USB_DIR_IN;//to host + setup.bRequest = USB_REQ_GET_STATUS; + setup.wValue = 0; + setup.wIndex = 1; + setup.wLength = 4; + retval = config->host_obj->host_vhubControl(priv, &setup, (uint8_t *)&statusHub); + if (retval) + return; + + if (status[1] & USB_PORT_STAT_C_CONNECTION) { + if (status[0] & USB_PORT_STAT_CONNECTION) { + if (config->hcd->status_urb) + usb_hcd_poll_rh_status(config->hcd); + else + usb_hcd_resume_root_hub(config->hcd); + } else { + usb_hcd_resume_root_hub(config->hcd); + usb_hcd_poll_rh_status(config->hcd); + } + } + } else + usb_hcd_resume_root_hub(config->hcd); +} + +static void host_set_ep_toggle(struct HOST_CTRL *priv, + struct HOST_DEVICE *udev, u8 ep_num, u8 is_in, u8 toggle) +{ + struct HOST_USB_DEVICE *device; + + if (!priv || !udev) + return; + + device = (struct HOST_USB_DEVICE *)udev->userExt; + + usb_settoggle(device->ld_udev, ep_num, !is_in, toggle); +} + +static u8 host_get_ep_toggle(struct HOST_CTRL *priv, + struct HOST_DEVICE *udev, u8 ep_num, u8 is_in) +{ + struct HOST_USB_DEVICE *device; + + if (!priv || !udev) + return 0; + + device = (struct HOST_USB_DEVICE *)udev->userExt; + + return usb_gettoggle(device->ld_udev, ep_num, !is_in); +} + +static uint32_t initEndpoints(struct HOST_CTRL *priv) +{ + int epNum; + + if (!priv) + return 0; + + priv->hwEpInCount = 0; + priv->hwEpOutCount = 0; + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | 0); + + for (epNum = 0; epNum < HOST_EP_NUM; epNum++) { + priv->in[epNum].isInEp = 1; + priv->in[epNum].hwEpNum = epNum; + if (priv->hostCfg.epIN[epNum].bufferingValue) { + priv->in[epNum].hwMaxPacketSize = priv->hostCfg.epIN[epNum].maxPacketSize; + priv->in[epNum].hwBuffers = priv->hostCfg.epIN[epNum].bufferingValue; + priv->in[epNum].state = HOST_EP_FREE; + priv->in[epNum].channel = NULL; + priv->hwEpInCount++; + + if (epNum) { + phytium_write16(&priv->regs->rxstaddr[epNum - 1].addr, + priv->hostCfg.epIN[epNum].startBuf); + phytium_write8(&priv->regs->ep[epNum - 1].rxcon, 0x08); + phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | epNum); + phytium_write8(&priv->regs->irqmode[epNum - 1].inirqmode, 0x80); + } + } else + priv->in[epNum].state = HOST_EP_NOT_IMPLEMENTED; + + priv->out[epNum].isInEp = 0; + priv->out[epNum].hwEpNum = epNum; + if (priv->hostCfg.epOUT[epNum].bufferingValue) { + priv->out[epNum].hwMaxPacketSize = priv->hostCfg.epOUT[epNum].maxPacketSize; + priv->out[epNum].hwBuffers = priv->hostCfg.epOUT[epNum].bufferingValue; + priv->out[epNum].state = HOST_EP_FREE; + priv->out[epNum].channel = NULL; + priv->hwEpInCount++; + + if (epNum) { + phytium_write16(&priv->regs->txstaddr[epNum - 1].addr, + priv->hostCfg.epOUT[epNum].startBuf); + phytium_write8(&priv->regs->ep[epNum - 1].txcon, 0x08); + phytium_write8(&priv->regs->fifoctrl, + FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | epNum); + phytium_write8(&priv->regs->irqmode[epNum - 1].outirqmode, 0x80); + } + } else + priv->out[epNum].state = HOST_EP_NOT_IMPLEMENTED; + } + + return 0; +} + +int32_t hostInit(struct HOST_CTRL *priv, struct HOST_CFG *config, + struct HOST_CALLBACKS *callbacks, struct device *pdev, bool isVhubHost) +{ + int index; + + if (!config || !priv || !callbacks || !pdev) + return -EINVAL; + + priv->dev = pdev; + priv->hostCallbacks = *callbacks; + priv->hostCfg = *config; + priv->regs = (struct HW_REGS *)config->regBase; + priv->hostDrv = HOST_GetInstance(); + + priv->dmaDrv = DMA_GetInstance(); + priv->dmaCfg.dmaModeRx = 0xFFFF; + priv->dmaCfg.dmaModeTx = 0xFFFF; + priv->dmaCfg.regBase = config->regBase + 0x400; + priv->dmaCfg.trbAddr = config->trbAddr; + priv->dmaCfg.trbDmaAddr = config->trbDmaAddr; + priv->dmaCallback.complete = host_CallbackTransfer; + + priv->dmaController = (void *)(priv + 1); + priv->dmaDrv->dma_init(priv->dmaController, &priv->dmaCfg, &priv->dmaCallback); + priv->dmaDrv->dma_setParentPriv(priv->dmaController, priv); + + INIT_LIST_HEAD(&priv->ctrlHEpQueue); + + for (index = 0; index < MAX_INSTANCE_EP_NUM; index++) { + INIT_LIST_HEAD(&priv->isoInHEpQueue[index]); + INIT_LIST_HEAD(&priv->isoOutHEpQueue[index]); + INIT_LIST_HEAD(&priv->intInHEpQueue[index]); + INIT_LIST_HEAD(&priv->intOutHEpQueue[index]); + INIT_LIST_HEAD(&priv->bulkInHEpQueue[index]); + INIT_LIST_HEAD(&priv->bulkOutHEpQueue[index]); + } + + phytium_write8(&priv->regs->cpuctrl, BIT(1)); + phytium_write8(&priv->regs->otgctrl, OTGCTRL_ABUSDROP); + phytium_write8(&priv->regs->ep0maxpack, 0x40); + + //disable interrupts + phytium_write8(&priv->regs->otgien, 0x0); + phytium_write8(&priv->regs->usbien, 0x0); + phytium_write16(&priv->regs->txerrien, 0x0); + phytium_write16(&priv->regs->rxerrien, 0x0); + + //clear all interrupt except otg idle irq + phytium_write8(&priv->regs->otgirq, 0xFE); + phytium_write8(&priv->regs->usbirq, 0xFF); + phytium_write16(&priv->regs->txerrirq, 0xFF); + phytium_write16(&priv->regs->rxerrirq, 0xFF); + + phytium_write8(&priv->regs->tawaitbcon, 0x80); + + initEndpoints(priv); + priv->otgState = HOST_OTG_STATE_B_IDLE; + + //reset all endpoint + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); + + if (isVhubHost) + priv->vhub_regs = (struct VHUB_REGS *)(config->phy_regBase); + else + priv->custom_regs = (struct CUSTOM_REGS *)(config->phy_regBase); + + return 0; +} + +void hostDestroy(struct HOST_CTRL *priv) +{ +} + +void hostStart(struct HOST_CTRL *priv) +{ + uint8_t otgstate, usbien; + + if (!priv) + return; + + priv->dmaDrv->dma_start(priv->dmaController); + usbien = phytium_read8(&priv->regs->usbien); + usbien = usbien | USBIR_URES | USBIR_SUSP; + phytium_write8(&priv->regs->usbien, usbien); +retry: + otgstate = phytium_read8(&priv->regs->otgstate); + switch (otgstate) { + case HOST_OTG_STATE_A_IDLE: + priv->ep0State = HOST_EP0_STAGE_IDLE; + priv->otgState = HOST_OTG_STATE_A_IDLE; + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); + host_SetVbus(priv, 1); + break; + case HOST_OTG_STATE_B_IDLE: + host_SetVbus(priv, 1); + break; + case HOST_OTG_STATE_A_WAIT_VFALL: + goto retry; + } + + phytium_write8(&priv->regs->otgien, OTGIRQ_CONIRQ | + OTGIRQ_VBUSERRIRQ | OTGIRQ_SRPDETIRQ); +} + +void hostStop(struct HOST_CTRL *priv) +{ + if (!priv) + return; + + phytium_write8(&priv->regs->otgien, 0x0); + phytium_write8(&priv->regs->usbien, 0x0); + phytium_write16(&priv->regs->txerrien, 0x0); + phytium_write16(&priv->regs->rxerrien, 0x0); + + phytium_write8(&priv->regs->otgirq, 0xFE); + phytium_write8(&priv->regs->usbirq, 0xFF); + phytium_write16(&priv->regs->txerrirq, 0xFF); + phytium_write16(&priv->regs->rxerrirq, 0xFF); + + host_SetVbus(priv, 0); + priv->dmaDrv->dma_stop(priv->dmaController); +} + +static void handleReset(struct HOST_CTRL *priv) +{ + if (!priv) + return; + + if (priv->otgState == HOST_OTG_STATE_A_WAIT_BCON + || priv->otgState == HOST_OTG_STATE_B_WAIT_ACON) { + switch (phytium_read8(&priv->regs->speedctrl)) { + case SPEEDCTRL_HS: + priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; + break; + case SPEEDCTRL_FS: + priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); + break; + case SPEEDCTRL_LS: + priv->portStatus |= USB_PORT_STAT_LOW_SPEED; + break; + } + + priv->dmaDrv->dma_setHostMode(priv->dmaController); + + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + + switch (phytium_read8(&priv->regs->otgstate)) { + case HOST_OTG_STATE_B_HOST: + priv->otgState = HOST_OTG_STATE_B_HOST; + break; + case HOST_OTG_STATE_A_HOST: + break; + default: + priv->otgState = HOST_OTG_STATE_A_HOST; + break; + } + } +} + +void hostIsr(struct HOST_CTRL *priv) +{ + uint8_t usbirq, usbien; + + if (!priv) + return; + + usbirq = phytium_read8(&priv->regs->usbirq); + usbien = phytium_read8(&priv->regs->usbien); + pr_debug("raw usbirq:0x%x usbien:0x%x\n", usbirq, usbien); + usbirq = usbirq & usbien; + + hostErrorIrq(priv); + hostOtgIrq(priv); + + if (!usbirq) + goto DMA_IRQ; + + if (usbirq & USBIR_URES) { + phytium_write8(&priv->regs->usbirq, USBIR_URES); + priv->port_resetting = 0; + handleReset(priv); + } + + if (usbirq & USBIR_SOF) + phytium_write8(&priv->regs->usbirq, USBIR_SOF); + + if (usbirq & USBIR_SUSP) { + pr_debug("clear suspend irq\n"); + phytium_write8(&priv->regs->usbirq, USBIR_SUSP); + phytium_write8(&priv->regs->clkgate, 0x7); + } + + return; +DMA_IRQ: + priv->dmaDrv->dma_isr(priv->dmaController); +} + +int32_t hostEpDisable(struct HOST_CTRL *priv, struct HOST_EP *ep) +{ + return 0; +} + +unsigned int get_endpoint_interval(struct usb_endpoint_descriptor desc, + int speed) +{ + unsigned int interval = 0; + + switch (speed) { + case USB_SPEED_HIGH: + if (usb_endpoint_xfer_control(&desc) || usb_endpoint_xfer_bulk(&desc)) { + if (desc.bInterval == 0) + return interval; + interval = fls(desc.bInterval) - 1; + interval = clamp_val(interval, 0, 15); + interval = 1 << interval; + if (interval != desc.bInterval) + pr_debug("rounding to %d microframes, desc %d microframes\n", + interval, desc.bInterval); + break; + } + + if (usb_endpoint_xfer_isoc(&desc) || usb_endpoint_xfer_int(&desc)) { + interval = clamp_val(desc.bInterval, 1, 16) - 1; + interval = 1 << interval; + if (interval != desc.bInterval - 1) + pr_debug("rounding to %d %sframes\n", interval, + speed == USB_SPEED_FULL ? "" : "micro"); + } + break; + case USB_SPEED_FULL: + if (usb_endpoint_xfer_isoc(&desc)) { + interval = clamp_val(desc.bInterval, 1, 16) - 1; + if (interval != desc.bInterval - 1) + pr_debug("rounding to %d %sframes\n", 1 << interval, + speed == USB_SPEED_FULL ? "" : "micro"); + interval += 3; + break; + } + /* fall through */ + case USB_SPEED_LOW: + if (usb_endpoint_xfer_int(&desc) || usb_endpoint_xfer_isoc(&desc)) { + interval = fls(desc.bInterval * 8) - 1; + interval = clamp_val(interval, 3, 10); + if ((1 << interval) != desc.bInterval * 8) + pr_debug("rounding to %d microframes, desc %d microframes\n", + 1 << interval, desc.bInterval); + } + } + + return interval; +} + +int32_t hostReqQueue(struct HOST_CTRL *priv, struct HOST_REQ *req) +{ + struct HOST_EP_PRIV *hostEpPriv; + struct list_head *hEpQueue = NULL; + uint8_t idleQueue = 0; + + if (!priv || !req) + return -EINVAL; + + list_add_tail((struct list_head *)&req->list, (struct list_head *)&req->usbEp->reqList); + hostEpPriv = (struct HOST_EP_PRIV *)req->usbEp->hcPriv; + + if (hostEpPriv->epIsReady) { + if (usb_endpoint_xfer_isoc(&req->usbEp->desc)) { + hostEpPriv->isocEpConfigured = 1; + hostStartReq(priv, req); + } + return 0; + } + + hostEpPriv->epIsReady = 1; + hostEpPriv->maxPacketSize = req->usbEp->desc.wMaxPacketSize; + hostEpPriv->interval = req->interval; + hostEpPriv->epNum = req->usbEp->desc.bEndpointAddress & 0xf; + hostEpPriv->faddress = req->faddress; + hostEpPriv->usbHEp = req->usbEp; + hostEpPriv->isIn = req->epIsIn; + + hostEpPriv->frame = get_endpoint_interval(req->usbEp->desc, req->usbDev->speed); + hostEpPriv->interval = hostEpPriv->frame; + switch (usb_endpoint_type(&req->usbEp->desc)) { + case USB_ENDPOINT_XFER_CONTROL: + hostEpPriv->isIn = 0; + hEpQueue = &priv->ctrlHEpQueue; + hostEpPriv->type = USB_ENDPOINT_XFER_CONTROL; + break; + case USB_ENDPOINT_XFER_BULK: + hEpQueue = hostEpPriv->isIn ? &priv->bulkInHEpQueue[req->epNum - 1] : + &priv->bulkOutHEpQueue[req->epNum - 1]; + hostEpPriv->type = USB_ENDPOINT_XFER_BULK; + break; + case USB_ENDPOINT_XFER_INT: + hEpQueue = hostEpPriv->isIn ? &priv->intInHEpQueue[req->epNum - 1] : + &priv->intOutHEpQueue[req->epNum - 1]; + hostEpPriv->type = USB_ENDPOINT_XFER_INT; + break; + case USB_ENDPOINT_XFER_ISOC: + hEpQueue = hostEpPriv->isIn ? &priv->isoInHEpQueue[req->epNum - 1] : + &priv->isoOutHEpQueue[req->epNum - 1]; + hostEpPriv->type = USB_ENDPOINT_XFER_ISOC; + break; + default: + break; + } + + if (hostEpPriv->isIn) + hostEpPriv->genericHwEp = &priv->in[req->epNum]; + else + hostEpPriv->genericHwEp = &priv->out[req->epNum]; + + hostEpPriv->genericHwEp->state = HOST_EP_ALLOCATED; + hostEpPriv->genericHwEp->refCount++; + + if (list_empty(hEpQueue)) { + if (hostEpPriv->genericHwEp->state == HOST_EP_BUSY) { + pr_err("Error:Hardware endpoint %d is busy\n", + hostEpPriv->genericHwEp->hwEpNum); + return -EINVAL; + } + idleQueue = 1; + } + + if (usb_endpoint_xfer_int(&req->usbEp->desc)) + list_add_tail(&hostEpPriv->node, hEpQueue); + + if (idleQueue) + hostStartReq(priv, req); + + return 0; +} + +static int abortActuallyUsbRequest(struct HOST_CTRL *priv, + struct HOST_REQ *req, struct HOST_EP *usbEp) +{ + struct HOST_EP_PRIV *usbEpPriv; + struct HostEp *hostEp; + uint16_t rxerrien = 0; + uint16_t txerrien = 0; + uint8_t rxcon, txcon; + + if (!priv || !req || !usbEp) + return -EINVAL; + + usbEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; + hostEp = usbEpPriv->currentHwEp; + + usbEpPriv->transferFinished = 1; + + if (hostEp->isInEp) { + if (hostEp->hwEpNum) { + rxcon = phytium_read8(&priv->regs->ep[hostEp->hwEpNum - 1].rxcon); + rxcon = rxcon & (~BIT(7)); + phytium_write8(&priv->regs->ep[hostEp->hwEpNum - 1].rxcon, rxcon); + } + rxerrien = phytium_read16(&priv->regs->rxerrien); + rxerrien &= ~(1 << hostEp->hwEpNum); + phytium_write16(&priv->regs->rxerrien, rxerrien); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | + ENDPRST_IO_TX | hostEp->hwEpNum); + } else { + if (hostEp->hwEpNum) { + txcon = phytium_read8(&priv->regs->ep[hostEp->hwEpNum - 1].txcon); + txcon = txcon & (~BIT(7)); + phytium_write8(&priv->regs->ep[hostEp->hwEpNum - 1].txcon, txcon); + } + txerrien = phytium_read16(&priv->regs->txerrien); + txerrien &= ~(1 << hostEp->hwEpNum); + phytium_write16(&priv->regs->txerrien, txerrien); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | hostEp->hwEpNum); + } + + scheduleNextTransfer(priv, req, hostEp); + + return 0; +} + +int32_t hostReqDequeue(struct HOST_CTRL *priv, struct HOST_REQ *req, uint32_t status) +{ + struct HOST_EP *usbEp; + struct HOST_EP_PRIV *usbEpPriv; + int ret = 0; + + if (!priv || !req) + return -EINVAL; + + usbEp = req->usbEp; + usbEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; + + pr_debug("Dequeue usbReq:%p dev%d usbEp%d%s\n", req, req->faddress, req->epNum, + req->epIsIn ? "in" : "out"); + + if (!usbEpPriv->epIsReady) + return 0; + + if (!usbEpPriv->currentHwEp || req->list.prev != &usbEp->reqList) { + givebackRequest(priv, req, status); + if (list_empty(&usbEp->reqList)) { + usbEpPriv->epIsReady = 0; + usbEpPriv->currentHwEp = NULL; + if (usb_endpoint_xfer_int(&usbEp->desc)) + list_del(&usbEpPriv->node); + } + } else + ret = abortActuallyUsbRequest(priv, req, usbEp); + + if (usbEpPriv->isocEpConfigured) + usbEpPriv->isocEpConfigured = 0; + + return ret; +} + +int32_t hostVHubStatusData(struct HOST_CTRL *priv, uint8_t *status) +{ + return 0; +} + +int32_t hostGetDevicePD(struct HOST_CTRL *priv) +{ + return 0; +} + +int32_t hostGetPrivateDataSize(struct HOST_CTRL *priv) +{ + if (!priv) + return 0; + + return sizeof(struct HOST_EP_PRIV); +} + +static int hub_descriptor(struct usb_hub_descriptor *buf) +{ + buf->bDescLength = 9; + buf->bDescriptorType = 0x29; + buf->bNbrPorts = 1; + buf->wHubCharacteristics = 0x11; + buf->bPwrOn2PwrGood = 5; + buf->bHubContrCurrent = 0; + buf->u.hs.DeviceRemovable[0] = 0x2; + + return 0; +} + +static int HubPortSuspend(struct HOST_CTRL *priv, u16 on) +{ + uint8_t otgctrl; + + if (!priv) + return 0; + + otgctrl = phytium_read8(&priv->regs->otgctrl); + + if (on) { + otgctrl &= ~OTGCTRL_BUSREQ; + otgctrl &= ~OTGCTRL_BHNPEN; + + priv->portStatus |= USB_PORT_STAT_SUSPEND; + + switch (phytium_read8(&priv->regs->otgstate)) { + case HOST_OTG_STATE_A_HOST: + priv->otgState = HOST_OTG_STATE_A_SUSPEND; + otgctrl |= OTGCTRL_ASETBHNPEN; + break; + case HOST_OTG_STATE_B_HOST: + priv->otgState = HOST_OTG_STATE_B_HOST_2; + break; + default: + break; + } + phytium_write8(&priv->regs->otgctrl, otgctrl); + } else { + otgctrl |= OTGCTRL_BUSREQ; + otgctrl &= ~OTGCTRL_ASETBHNPEN; + phytium_write8(&priv->regs->otgctrl, otgctrl); + priv->portStatus |= USB_PORT_STAT_RESUME; + } + return 0; +} + +static void HubPortReset(struct HOST_CTRL *priv, uint8_t on) +{ + uint8_t speed; + + if (!priv) + return; + + if (on) { + phytium_write16(&priv->regs->txerrirq, 0xFFFF); + phytium_write16(&priv->regs->txirq, 0xFFFF); + phytium_write16(&priv->regs->rxerrirq, 0xFFFF); + phytium_write16(&priv->regs->rxirq, 0xFFFF); + + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | + ENDPRST_TOGRST | ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x04); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | + FIFOCTRL_IO_TX | 0 | 0x04); + + priv->portStatus |= USB_PORT_STAT_RESET; + priv->portStatus &= ~USB_PORT_STAT_ENABLE; + priv->port_resetting = 0; + } else { + speed = phytium_read8(&priv->regs->speedctrl); + if (speed == SPEEDCTRL_HS) + priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; + else if (speed == SPEEDCTRL_FS) + priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); + else + priv->portStatus |= USB_PORT_STAT_LOW_SPEED; + + priv->portStatus &= ~USB_PORT_STAT_RESET; + priv->portStatus |= USB_PORT_STAT_ENABLE | (USB_PORT_STAT_C_RESET << 16) + | (USB_PORT_STAT_C_ENABLE << 16); + + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + } +} + +static int get_PortStatus(struct HOST_CTRL *priv, u16 wIndex, uint8_t *buff) +{ + uint32_t temp = 0; + + if (!priv || !buff) + return 0; + + if ((wIndex & 0xff) != 1) + return 1; + + if (priv->portStatus & USB_PORT_STAT_RESET) { + if (!priv->port_resetting) + HubPortReset(priv, 0); + } + + if (priv->portStatus & USB_PORT_STAT_RESUME) { + priv->portStatus &= ~(USB_PORT_STAT_SUSPEND | USB_PORT_STAT_RESUME); + priv->portStatus |= USB_PORT_STAT_C_SUSPEND << 16; + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + } + + temp = priv->portStatus & (~USB_PORT_STAT_RESUME); + buff[0] = temp; + buff[1] = temp >> 8; + buff[2] = temp >> 16; + buff[3] = temp >> 24; + + return 0; +} + +static int set_PortFeature(struct HOST_CTRL *priv, u16 wValue, u16 wIndex) +{ +// struct HW_Regs *regs = priv->regs; + + if ((wIndex & 0xff) != 1) + return 1; + + switch (wValue) { + case USB_PORT_FEAT_CONNECTION: + break; + case USB_PORT_FEAT_ENABLE: + break; + case USB_PORT_FEAT_SUSPEND: + HubPortSuspend(priv, 1); + break; + case USB_PORT_FEAT_OVER_CURRENT: + break; + case USB_PORT_FEAT_RESET: + HubPortReset(priv, 1); + break; + case USB_PORT_FEAT_L1: + break; + case USB_PORT_FEAT_POWER: + hostStart(priv); + break; + case USB_PORT_FEAT_LOWSPEED: + break; + case USB_PORT_FEAT_C_CONNECTION: + break; + case USB_PORT_FEAT_C_ENABLE: + break; + case USB_PORT_FEAT_C_SUSPEND: + break; + case USB_PORT_FEAT_C_OVER_CURRENT: + break; + case USB_PORT_FEAT_INDICATOR: + break; + case USB_PORT_FEAT_C_PORT_L1: + break; + default: + break; + } + priv->portStatus |= 1 << wValue; + + return 0; +} + +static int Clear_PortFeature(struct HOST_CTRL *priv, u16 wValue, u16 wIndex) +{ + if ((wIndex & 0xff) != 1) + return 1; + + switch (wValue) { + case USB_PORT_FEAT_CONNECTION: + break; + case USB_PORT_FEAT_ENABLE: + break; + case USB_PORT_FEAT_SUSPEND: + HubPortSuspend(priv, 0); + break; + case USB_PORT_FEAT_OVER_CURRENT: + break; + case USB_PORT_FEAT_RESET: + break; + case USB_PORT_FEAT_L1: + break; + case USB_PORT_FEAT_POWER: + break; + case USB_PORT_FEAT_LOWSPEED: + break; + case USB_PORT_FEAT_C_CONNECTION: + break; + case USB_PORT_FEAT_C_ENABLE: + break; + case USB_PORT_FEAT_C_SUSPEND: + break; + case USB_PORT_FEAT_C_OVER_CURRENT: + break; + case USB_PORT_FEAT_INDICATOR: + break; + case USB_PORT_FEAT_C_PORT_L1: + break; + default: + break; + } + priv->portStatus &= ~(1 << wValue); + + return 0; +} + +static int hc_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue, + u16 wIndex, char *buf, u16 wLength) +{ + unsigned long flags = 0; + int retval = 0; + struct HOST_CTRL *priv; + struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; + + if (!config) + return -EINVAL; + + if (!buf) + return -EINVAL; + + if (unlikely(!HCD_HW_ACCESSIBLE(hcd))) { + spin_unlock_irqrestore(&config->lock, flags); + return -ESHUTDOWN; + } + + priv = (struct HOST_CTRL *)config->host_priv; + if (!priv) + return -EINVAL; + + spin_lock_irqsave(&config->lock, flags); + switch (typeReq) { + case GetHubStatus: + break; + case GetPortStatus: + get_PortStatus(priv, wIndex, (uint8_t *)buf); + break; + case GetHubDescriptor: + hub_descriptor((struct usb_hub_descriptor *)buf); + break; + case SetPortFeature: + set_PortFeature(priv, wValue, wIndex); + break; + case ClearPortFeature: + retval = Clear_PortFeature(priv, wValue, wIndex); + break; + case SetHubFeature: + break; + case ClearHubFeature: + break; + default: + break; + } + + spin_unlock_irqrestore(&config->lock, flags); + + return retval; +} + +int32_t hostVHubControl(struct HOST_CTRL *priv, struct usb_ctrlrequest *setup, uint8_t *buff) +{ + uint16_t request; + uint32_t retval = 0; + + if (!priv || !setup || !buff) + return -EINVAL; + + request = setup->bRequestType << 0x08 | setup->bRequest; + switch (request) { + case ClearHubFeature: + break; + case SetHubFeature: + break; + case ClearPortFeature: + retval = Clear_PortFeature(priv, setup->wValue, setup->wIndex); + break; + case SetPortFeature: + retval = set_PortFeature(priv, setup->wValue, setup->wIndex); + break; + case GetHubDescriptor: + retval = hub_descriptor((struct usb_hub_descriptor *)buff); + break; + case GetHubStatus: + break; + case GetPortStatus: + retval = get_PortStatus(priv, setup->wIndex, (uint8_t *)buff); + break; + default: + retval = EOPNOTSUPP; + break; + } + + return retval; +} + +struct HOST_OBJ hostDrv = { + .host_init = hostInit, + .host_destroy = hostDestroy, + .host_start = hostStart, + .host_stop = hostStop, + .host_isr = hostIsr, + + //endpoint operation + .host_epDisable = hostEpDisable, + .host_reqQueue = hostReqQueue, + .host_reqDequeue = hostReqDequeue, + .host_vhubStatusData = hostVHubStatusData, + .host_vhubControl = hostVHubControl, + .host_getDevicePD = hostGetDevicePD, + .host_epGetPrivateDataSize = hostGetPrivateDataSize, +}; + +static struct hc_driver host_driver = { + .description = "phytium-hcd", + .product_desc = "Phytium Host USB Driver", + .hcd_priv_size = sizeof(struct phytium_cusb *), + .flags = HCD_MEMORY | HCD_USB2 | HCD_DMA, + .reset = hc_reset, + .start = hc_start, + .stop = hc_stop, + .shutdown = hc_shutdown, + .urb_enqueue = hc_urb_enqueue, + .urb_dequeue = hc_urb_dequeue, + .endpoint_disable = hc_endpoint_disable, + .get_frame_number = hc_get_frame, + .alloc_dev = hc_alloc_dev, + .free_dev = hc_free_dev, + .reset_device = hc_reset_device, + .update_device = hc_update_device, + .add_endpoint = hc_add_endpoint, + .drop_endpoint = hc_drop_endpoint, + .hub_status_data = hc_hub_status_data, + .hub_control = hc_hub_control, +#ifdef CONFIG_PM + .bus_suspend = hc_bus_suspend, + .bus_resume = hc_bus_resume, +#endif +}; + +static int phytium_host_set_default_cfg(struct phytium_cusb *config) +{ + int index; + + config->host_cfg.regBase = (uintptr_t)config->regs; + config->host_cfg.phy_regBase = (uintptr_t)config->phy_regs; + config->host_cfg.dmultEnabled = 1; + config->host_cfg.memoryAlignment = 0; + config->host_cfg.dmaSupport = 1; + config->host_cfg.isEmbeddedHost = 1; + + for (index = 0; index < HOST_EP_NUM; index++) { + if (index == 0) { + config->host_cfg.epIN[index].bufferingValue = 1; + config->host_cfg.epIN[index].maxPacketSize = 64; + config->host_cfg.epIN[index].startBuf = 0; + + config->host_cfg.epOUT[index].bufferingValue = 1; + config->host_cfg.epOUT[index].maxPacketSize = 64; + config->host_cfg.epOUT[index].startBuf = 0; + } else { + config->host_cfg.epIN[index].bufferingValue = 2; + config->host_cfg.epIN[index].maxPacketSize = 1024; + config->host_cfg.epIN[index].startBuf = 64 + 2 * 1024 * (index - 1); + + config->host_cfg.epOUT[index].bufferingValue = 2; + config->host_cfg.epOUT[index].maxPacketSize = 1024; + config->host_cfg.epOUT[index].startBuf = 64 + 2 * 1024 * (index - 1); + } + } + + return 0; +} + +static int phytium_host_reinit(struct phytium_cusb *config) +{ + struct HOST_CTRL *ctrl; + + if (!config || !config->host_priv) + return 0; + + ctrl = (struct HOST_CTRL *)config->host_priv; + + usb_root_hub_lost_power(config->hcd->self.root_hub); + hostStop(ctrl); + + ctrl->portStatus = 0; + + config->host_obj->host_init(config->host_priv, &config->host_cfg, + &config->host_callbacks, config->dev, config->isVhubHost); + + return 0; +} + +int phytium_host_init(struct phytium_cusb *config) +{ + int ret; + + if (!config) + return 0; + + phytium_host_set_default_cfg(config); + config->host_obj = HOST_GetInstance(); + config->dma_cfg.regBase = config->host_cfg.regBase + 0x400; + + config->dma_obj = DMA_GetInstance(); + config->dma_obj->dma_probe(&config->dma_cfg, &config->dma_sysreq); + + config->host_sysreq.privDataSize = sizeof(struct HOST_CTRL); + config->host_sysreq.trbMemSize = config->dma_sysreq.trbMemSize; + config->host_sysreq.privDataSize += config->dma_sysreq.privDataSize; + + config->host_priv = devm_kzalloc(config->dev, config->host_sysreq.privDataSize, GFP_KERNEL); + if (!config->host_priv) { + ret = -ENOMEM; + goto err_probe; + } + + config->host_cfg.trbAddr = dma_alloc_coherent(config->dev, config->host_sysreq.trbMemSize, + (dma_addr_t *)&config->host_cfg.trbDmaAddr, GFP_KERNEL); + if (!config->host_cfg.trbAddr) { + ret = -ENOMEM; + goto err_dma_coherent; + } + + config->host_callbacks.portStatusChange = host_rh_port_status_change; + config->host_callbacks.getEpToggle = host_get_ep_toggle; + config->host_callbacks.setEpToggle = host_set_ep_toggle; + config->host_callbacks.givebackRequest = host_giveback_request; + + config->host_obj->host_init(config->host_priv, &config->host_cfg, + &config->host_callbacks, config->dev, config->isVhubHost); + + config->hcd = usb_create_hcd(&host_driver, config->dev, dev_name(config->dev)); + if (!config->hcd) { + ret = -ENODEV; + goto err_host; + } + + *config->hcd->hcd_priv = (unsigned long)config; + config->hcd->self.uses_pio_for_control = 0; + config->hcd->uses_new_polling = 1; + config->hcd->has_tt = 1; + + dev_set_drvdata(config->dev, config); + + config->hcd->self.otg_port = 1; + config->hcd->power_budget = 500; + ret = usb_add_hcd(config->hcd, 0, 0); + if (ret < 0) + goto err_setup; + + return 0; +err_setup: + usb_put_hcd(config->hcd); +err_host: + config->host_obj->host_destroy(config->host_priv); + dma_free_coherent(config->dev, config->host_sysreq.trbMemSize, + config->host_cfg.trbAddr, config->host_cfg.trbDmaAddr); +err_dma_coherent: +err_probe: + dev_set_drvdata(config->dev, NULL); + return ret; +} + +int phytium_host_uninit(struct phytium_cusb *config) +{ + if (!config) + return 0; + + if (config->hcd) { + usb_remove_hcd(config->hcd); + usb_put_hcd(config->hcd); + config->hcd = NULL; + } + + return 0; +} + +#ifdef CONFIG_PM +int phytium_host_resume(void *priv) +{ + int otgctrl; + struct phytium_cusb *config = (struct phytium_cusb *)priv; + struct HOST_CTRL *ctrl = (struct HOST_CTRL *)config->host_priv; + + if (!ctrl) + return -EINVAL; + + otgctrl = phytium_read8(&ctrl->regs->otgctrl); + otgctrl |= 1; + phytium_write8(&ctrl->regs->otgctrl, otgctrl); + + phytium_host_reinit(config); + + return 0; +} + +int phytium_host_suspend(void *priv) +{ + int otgctrl; + struct phytium_cusb *config = (struct phytium_cusb *)priv; + struct HOST_CTRL *ctrl = (struct HOST_CTRL *)config->host_priv; + + if (!ctrl) + return -EINVAL; + + otgctrl = phytium_read8(&ctrl->regs->otgctrl); + otgctrl = otgctrl & (~1); + phytium_write8(&ctrl->regs->otgctrl, otgctrl); + + return 0; +} +#endif + +struct HOST_OBJ *HOST_GetInstance(void) +{ + return &hostDrv; +} diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/host_api.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/host_api.h new file mode 100644 index 0000000000000000000000000000000000000000..3d45258278c475fdd4ef15810499e41c73d27948 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/host_api.h @@ -0,0 +1,248 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef __PHYTIUM_HOST_API_H_ +#define __PHYTIUM_HOST_API_H_ + +#include +//#include "list.h" +#include "dma.h" + +#define MAX_SUPPORTED_DEVICES 16 +#define USB_PORT_STAT_RESUME (1 << 31) +#define MAX_INSTANCE_EP_NUM 6 + +enum HOST_OtgState { + HOST_OTG_STATE_A_IDLE, + HOST_OTG_STATE_A_WAIT_VRISE, + HOST_OTG_STATE_A_WAIT_BCON, + HOST_OTG_STATE_A_HOST, + HOST_OTG_STATE_A_SUSPEND, + HOST_OTG_STATE_A_PERIPHERAL, + HOST_OTG_STATE_A_VBUS_ERR, + HOST_OTG_STATE_A_WAIT_VFALL, + HOST_OTG_STATE_B_IDLE = 0x10, + HOST_OTG_STATE_B_PERIPHERAL, + HOST_OTG_STATE_B_WAIT_ACON, + HOST_OTG_STATE_B_HOST, + HOST_OTG_STATE_B_HOST_2, + HOST_OTG_STATE_B_SRP_INT1, + HOST_OTG_STATE_B_SRP_INT2, + HOST_OTG_STATE_B_DISCHRG1, + HOST_OTG_STATE_B_DISCHRG2, + HOST_OTG_STATE_UNKNOWN, +}; + +enum HOST_EP0_STAGE { + HOST_EP0_STAGE_IDLE, + HOST_EP0_STAGE_SETUP, + HOST_EP0_STAGE_IN, + HOST_EP0_STAGE_OUT, + HOST_EP0_STAGE_STATUSIN, + HOST_EP0_STAGE_STATUSOUT, + HOST_EP0_STAGE_ACK, +}; + +enum HOST_EP_STATE { + HOST_EP_FREE, + HOST_EP_ALLOCATED, + HOST_EP_BUSY, + HOST_EP_NOT_IMPLEMENTED +}; + +struct HOST_DEVICE { + uint8_t devnum; + uint8_t hubPort; + unsigned int speed; + struct HOST_DEVICE *parent; + void *hcPriv; + void *userExt; +}; + +struct HOST_EP { + struct usb_endpoint_descriptor desc; + struct list_head reqList; + void *userExt; + uint8_t *hcPriv; +}; + +struct HOST_USB_DEVICE { + struct HOST_EP ep0_hep; + struct HOST_EP *in_ep[16]; + struct HOST_EP *out_ep[16]; + struct HOST_DEVICE udev; + struct usb_device *ld_udev; +}; + +struct HostEp { + uint8_t name[255]; + uint8_t hwEpNum; + uint8_t hwBuffers; + uint16_t hwMaxPacketSize; + uint8_t isInEp; + void *channel; + uint8_t usbEpNum; + uint8_t type; + uint8_t usbPacketSize; + enum HOST_EP_STATE state; + struct HOST_EP *scheduledUsbHEp; + uint8_t refCount; +}; + +struct HOST_ISOFRAMESDESC { + uint32_t length; + uint32_t offset; +}; + +struct HOST_EP_PRIV { + struct list_head node; + struct HostEp *genericHwEp; + struct HostEp *currentHwEp; + uint8_t epIsReady; + uint8_t isIn; + uint8_t type; + uint8_t interval; + uint8_t epNum; + uint8_t faddress; + uint16_t maxPacketSize; + uint32_t frame; + uint8_t hubAddress; + uint8_t portAddress; + uint8_t split; + struct HOST_EP *usbHEp; + uint8_t isocEpConfigured; + uint8_t transferFinished; +}; + +struct HOST_REQ { + struct list_head list; + struct HOST_EP *usbEp; + void *userExt; + void *hcPriv; + struct HOST_DEVICE *usbDev; + struct usb_ctrlrequest *setup; + uintptr_t setupDma; + void *bufAddress; + uintptr_t buffDma; + uint32_t buffLength; + uint32_t actualLength; + uint8_t epIsIn; + uint8_t eptype; + uint8_t epNum; + uint8_t faddress; + uint8_t interval; + uint8_t status; + uint8_t reqUnlinked; + struct HOST_ISOFRAMESDESC *isoFramesDesc; + uint32_t isoFramesNumber; +}; + +struct HOST_SYSREQ { + uint32_t privDataSize; + uint32_t trbMemSize; +}; + +struct HOST_EP_CFG { + uint8_t bufferingValue; + uint16_t startBuf; + uint16_t maxPacketSize; +}; + +struct HOST_CFG { + uintptr_t regBase; + uintptr_t phy_regBase; + struct HOST_EP_CFG epIN[16]; + struct HOST_EP_CFG epOUT[16]; + uint8_t dmultEnabled; + uint8_t memoryAlignment; + uint8_t dmaSupport; + uint8_t isEmbeddedHost; + void *trbAddr; + uintptr_t trbDmaAddr; +}; + +struct HOST_CTRL; + +struct HOST_CALLBACKS { + void (*portStatusChange)(struct HOST_CTRL *priv); + + uint8_t (*getEpToggle)(struct HOST_CTRL *priv, + struct HOST_DEVICE *usbDev, uint8_t epNum, uint8_t isIn); + + void (*setEpToggle)(struct HOST_CTRL *priv, struct HOST_DEVICE *usbDev, + uint8_t epNum, uint8_t isIn, uint8_t toggle); + + void (*givebackRequest)(struct HOST_CTRL *priv, + struct HOST_REQ *usbReq, uint32_t status); + + void (*setTimer)(struct HOST_CTRL *priv, uint32_t time, uint8_t id); +}; + +struct HOST_OBJ { + int32_t (*host_probe)(struct HOST_CFG *config, struct HOST_SYSREQ *sysReq); + + int32_t (*host_init)(struct HOST_CTRL *priv, struct HOST_CFG *config, + struct HOST_CALLBACKS *callbacks, struct device *pdev, bool isVhubHost); + + void (*host_destroy)(struct HOST_CTRL *priv); + + void (*host_start)(struct HOST_CTRL *priv); + + void (*host_stop)(struct HOST_CTRL *priv); + + void (*host_isr)(struct HOST_CTRL *priv); + + int32_t (*host_epDisable)(struct HOST_CTRL *priv, struct HOST_EP *ep); + + int32_t (*host_reqQueue)(struct HOST_CTRL *priv, struct HOST_REQ *req); + + int32_t (*host_reqDequeue)(struct HOST_CTRL *priv, + struct HOST_REQ *req, uint32_t status); + + int32_t (*host_vhubStatusData)(struct HOST_CTRL *priv, uint8_t *status); + + int32_t (*host_vhubControl)(struct HOST_CTRL *priv, + struct usb_ctrlrequest *setup, uint8_t *buff); + + int32_t (*host_getDevicePD)(struct HOST_CTRL *priv); + + int32_t (*host_epGetPrivateDataSize)(struct HOST_CTRL *priv); +}; + +struct HOST_CTRL { + struct device *dev; + struct HW_REGS *regs; + struct HOST_OBJ *hostDrv; + struct HOST_CFG hostCfg; + struct HOST_CALLBACKS hostCallbacks; + struct HostEp in[16]; + struct HostEp out[16]; + uint32_t portStatus; + struct list_head ctrlHEpQueue; + struct list_head isoInHEpQueue[MAX_INSTANCE_EP_NUM]; + struct list_head isoOutHEpQueue[MAX_INSTANCE_EP_NUM]; + struct list_head intInHEpQueue[MAX_INSTANCE_EP_NUM]; + struct list_head intOutHEpQueue[MAX_INSTANCE_EP_NUM]; + struct list_head bulkInHEpQueue[MAX_INSTANCE_EP_NUM]; + struct list_head bulkOutHEpQueue[MAX_INSTANCE_EP_NUM]; + uint8_t hwEpInCount; + uint8_t hwEpOutCount; + unsigned int speed; + enum HOST_OtgState otgState; + enum HOST_EP0_STAGE ep0State; + uint8_t vBusErrCnt; + uint8_t isRemoteWakeup; + uint8_t isSelfPowered; + uint8_t deviceAddress; + struct DMA_OBJ *dmaDrv; + void *dmaController; + struct DMA_CFG dmaCfg; + struct DMA_CALLBACKS dmaCallback; + uint8_t port_resetting; + struct HOST_USB_DEVICE *host_devices_table[MAX_SUPPORTED_DEVICES]; + struct CUSTOM_REGS *custom_regs; + struct VHUB_REGS *vhub_regs; +}; + +struct HOST_OBJ *HOST_GetInstance(void); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/hw-regs.h b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/hw-regs.h new file mode 100644 index 0000000000000000000000000000000000000000..8da9f8e9b92537f20c2be1c232849f331f32baf7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/hw-regs.h @@ -0,0 +1,297 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +#ifndef __LINUX_PHYTIUM_HW_REGS +#define __LINUX_PHYTIUM_HW_REGS + +#define USBIEN 0x198 +#define USBIEN_SUDAVIE BIT(0) +#define USBIEN_SOFIE BIT(1) +#define USBIEN_SUTOKIE BIT(2) +#define USBIEN_SUSPIE BIT(3) +#define USBIEN_URESIE BIT(4) +#define USBIEN_HSPEEDIE BIT(5) +#define USBIEN_LPMIE BIT(7) + +#define USBCS 0x1a3 +#define USBCS_LSMODE BIT(0) +#define USBCS_LPMNYET BIT(1) +#define USBCS_SIGSUME BIT(5) +#define USBCS_DISCON BIT(6) +#define USBCS_WAKESRC BIT(7) + +#define USBIR_SOF BIT(1) +#define USBIR_SUSP BIT(3) +#define USBIR_URES BIT(4) +#define USBIR_HSPEED BIT(5) + +#define USBIR_SUDAV BIT(0) +#define USBIR_SUTOK BIT(2) +#define USBIR_LPMIR BIT(7) + +#define OTGIRQ_IDLEIRQ BIT(0) +#define OTGIRQ_SRPDETIRQ BIT(1) +#define OTGIRQ_CONIRQ BIT(2) +#define OTGIRQ_LOCSOFIRQ BIT(2) +#define OTGIRQ_VBUSERRIRQ BIT(3) +#define OTGIRQ_PERIPHIRQ BIT(4) +#define OTGIRQ_IDCHANGEIRQ BIT(5) +#define OTGIRQ_HOSTDISCON BIT(6) +#define OTGIRQ_BSE0SRPIRQ BIT(7) + +#define OTGCTRL_BUSREQ BIT(0) +#define OTGCTRL_ABUSDROP BIT(1) +#define OTGCTRL_ASETBHNPEN BIT(2) +#define OTGCTRL_BHNPEN BIT(3) +#define OTGCTRL_SRPVBUSDETEN BIT(4) +#define OTGCTRL_SRPDATDETEN BIT(5) +#define OTGCTRL_FORCEBCONN BIT(7) + +#define OTGSTATUS_ID BIT(6) + +#define ENDPRST_EP 0x0f +#define ENDPRST_IO_TX BIT(4) +#define ENDPRST_TOGRST BIT(5) +#define ENDPRST_FIFORST BIT(6) +#define ENDPRST_TOGSETQ BIT(7) + +#define FIFOCTRL_EP 0x0f +#define FIFOCTRL_IO_TX BIT(4) +#define FIFOCTRL_FIFOAUTO BIT(5) + +#define SPEEDCTRL_LS BIT(0) +#define SPEEDCTRL_FS BIT(1) +#define SPEEDCTRL_HS BIT(2) +#define SPEEDCTRL_HSDISABLE BIT(7) + +#define CON_TYPE_CONTROL 0x00 +#define CON_TYPE_ISOC 0x04 +#define CON_TYPE_BULK 0x08 +#define CON_TYPE_INT 0x0C +#define CON_TYPE_ISOC_1_ISOD 0x00 +#define CON_TYPE_ISOC_2_ISOD 0x10 +#define CON_TYPE_ISOC_3_ISOD 0x20 +#define CON_STALL 0x40 +#define CON_VAL 0x80 + +#define ERR_TYPE 0x1c +#define ERR_COUNT 0x03 +#define ERR_RESEND BIT(6) +#define ERR_UNDERRIEN BIT(7) + +#define ERR_NONE 0 +#define ERR_CRC 1 +#define ERR_DATA_TOGGLE_MISMATCH 2 +#define ERR_STALL 3 +#define ERR_TIMEOUT 4 +#define ERR_PID 5 +#define ERR_TOO_LONG_PACKET 6 +#define ERR_DATA_UNDERRUN 7 + +#define EP0CS_HCSETTOGGLE BIT(6) +#define EP0CS_HCSET BIT(4) +#define EP0CS_RXBUSY_MASK BIT(3) +#define EP0CS_TXBUSY_MASK BIT(2) +#define EP0CS_STALL BIT(0) +#define EP0CS_HSNAK BIT(1) +#define EP0CS_DSTALL BIT(4) +#define EP0CS_CHGSET BIT(7) + +#define CS_ERR 0x01 +#define CS_BUSY 0x02 +#define CS_NPAK 0x0c +#define CS_NPAK_OFFSET 0x02 +#define CS_AUTO 0x10 + +#define CON_BUF_SINGLE 0x00 +#define CON_BUF_DOUBLE 0x01 +#define CON_BUF_TRIPLE 0x02 +#define CON_BUF_QUAD 0x03 +#define CON_BUF 0x03 + +struct HW_REGS { + uint8_t ep0Rxbc; /*address 0x00*/ + uint8_t ep0Txbc; /*address 0x01*/ + uint8_t ep0cs; /*address 0x02*/ + int8_t reserved0; /*address 0x03*/ + uint8_t lpmctrll; /*address 0x04*/ + uint8_t lpmctrlh; /*address 0x05*/ + uint8_t lpmclock; + uint8_t ep0fifoctrl; + struct ep { /*address 0x08*/ + uint16_t rxbc; //outbc (hcinbc) + uint8_t rxcon; + uint8_t rxcs; + uint16_t txbc; //inbc (hcoutbc + uint8_t txcon; + uint8_t txcs; + } ep[15]; + uint8_t reserved1[4]; + uint32_t fifodat[15]; /*address 0x84*/ + uint8_t ep0ctrl; /*address 0xC0*/ + uint8_t tx0err; /*address 0xC1*/ + uint8_t reserved2; + uint8_t rx0err; /*address 0xC3*/ + struct epExt { + uint8_t txctrl; + uint8_t txerr; + uint8_t rxctrl; + uint8_t rxerr; + } epExt[15]; + uint8_t ep0datatx[64]; /*address 0x100*/ + uint8_t ep0datarx[64]; /*address 0x140*/ + uint8_t setupdat[8]; /*address 0x180*/ + uint16_t txirq; /*address 0x188*/ + uint16_t rxirq; /*address 0x18A*/ + uint8_t usbirq; /*address 0x18C*/ + uint8_t reserved4; + uint16_t rxpngirq; /*address 0x18E*/ + uint16_t txfullirq; /*address 0x190*/ + uint16_t rxemptirq; /*address 0x192*/ + uint16_t txien; /*address 0x194*/ + uint16_t rxien; /*address 0x196*/ + uint8_t usbien; /*address 0x198*/ + uint8_t reserved6; + uint16_t rxpngien; /*address 0x19A*/ + uint16_t txfullien; /*address 0x19C*/ + uint16_t rxemptien; /*address 0x19E*/ + uint8_t usbivect; /*address 0x1A0*/ + uint8_t fifoivect; /*address 0x1A1*/ + uint8_t endprst; /*address 0x1A2*/ + uint8_t usbcs; /*address 0x1A3*/ + uint16_t frmnr; /*address 0x1A4*/ + uint8_t fnaddr; /*address 0x1A6*/ + uint8_t clkgate; /*address 0x1A7*/ + uint8_t fifoctrl; /*address 0x1A8*/ + uint8_t speedctrl; /*address 0x1A9*/ + uint8_t reserved8[1]; /*address 0x1AA*/ + uint8_t portctrl; /*address 0x1AB*/ + uint16_t hcfrmnr; /*address 0x1AC*/ + uint16_t hcfrmremain; /*address 0x1AE*/ + uint8_t reserved9[4]; /*address 0x1B0*/ + uint16_t rxerrirq; /*address 0x1B4*/ + uint16_t txerrirq; /*address 0x1B6*/ + uint16_t rxerrien; /*address 0x1B8*/ + uint16_t txerrien; /*address 0x1BA*/ + /*OTG extension*/ + uint8_t otgirq; /*address 0x1BC*/ + uint8_t otgstate; /*address 0x1BD*/ + uint8_t otgctrl; /*address 0x1BE*/ + uint8_t otgstatus; /*address 0x1BF*/ + uint8_t otgien; /*address 0x1C0*/ + uint8_t taaidlbdis; /*address 0x1C1*/ + uint8_t tawaitbcon; /*address 0x1C2*/ + uint8_t tbvbuspls; /*address 0x1C3*/ + uint8_t otg2ctrl; /*address 0x1C4*/ + uint8_t reserved10[2]; /*address 0x1C5*/ + uint8_t tbvbusdispls; /*address 0x1C7*/ + uint8_t traddr; /*address 0x1C8*/ + uint8_t trwdata; /*address 0x1C9*/ + uint8_t trrdata; /*address 0x1CA*/ + uint8_t trctrl; /*address 0x1CB*/ + uint16_t isoautoarm; /*address 0x1CC*/ + uint8_t adpbc1ien; /*address 0x1CE*/ + uint8_t adpbc2ien; /*address 0x1CF*/ + uint8_t adpbcctr0; /*address 0x1D0*/ + uint8_t adpbcctr1; /*address 0x1D1*/ + uint8_t adpbcctr2; /*address 0x1D2*/ + uint8_t adpbc1irq; /*address 0x1D3*/ + uint8_t adpbc0status; /*address 0x1D4*/ + uint8_t adpbc1status; /*address 0x1D5*/ + uint8_t adpbc2status; /*address 0x1D6*/ + uint8_t adpbc2irq; /*address 0x1D7*/ + uint16_t isodctrl; /*address 0x1D8*/ + uint8_t reserved11[2]; + uint16_t isoautodump; /*address 0x1DC*/ + uint8_t reserved12[2]; + uint8_t ep0maxpack; /*address 0x1E0*/ + uint8_t reserved13; + uint16_t rxmaxpack[15]; /*address 0x1E2*/ + struct rxsoftimer { /*address 0x200 to 0x23F*/ + uint16_t timer; + uint8_t reserved; + uint8_t ctrl; + } rxsoftimer[16]; + + struct txsoftimer { /*address 0x240 to 0x27F*/ + uint16_t timer; + uint8_t reserved; + uint8_t ctrl; + } txsoftimer[16]; + uint8_t reserved14[132]; + struct rxstaddr { /*address 0x304*/ + uint16_t addr; + uint16_t reserved; + } rxstaddr[15]; + uint8_t reserved15[4]; + struct txstaddr { /*address 0x344*/ + uint16_t addr; + uint16_t reserved; + } txstaddr[15]; + int8_t reserved16[4]; /*address 0x380*/ + struct irqmode { /*address 0x384*/ + int8_t inirqmode; + int8_t reserved21; + int8_t outirqmode; + int8_t reserved22; + } irqmode[15]; + /*The Microprocessor control*/ + uint8_t cpuctrl; /*address 0x3C0*/ + int8_t reserved17[15]; + /*The debug counters and workarounds*/ + uint8_t debug_rx_bcl; /*address 0x3D0*/ + uint8_t debug_rx_bch; /*address 0x3D1*/ + uint8_t debug_rx_status; /*address 0x3D2*/ + uint8_t debug_irq; /*address 0x3D3*/ + uint8_t debug_tx_bcl; /*address 0x3D4*/ + uint8_t debug_tx_bch; /*address 0x3D5*/ + uint8_t debug_tx_status; /*address 0x3D6*/ + uint8_t debug_ien; /*address 0x3D7*/ + uint8_t phywa_en; /*address 0x3D8*/ + /*endian*/ + uint8_t wa1_cnt; /*address 0x3D9*/ + int8_t reserved18[2]; /*address 0x3DA*/ + uint8_t endian_sfr_cs; /*address 0x3DC*/ + int8_t reserved19[2]; /*address 0x3DD*/ + uint8_t endian_sfr_s; /*address 0x3DF*/ + int8_t reserved20[2]; /*address 0x3E0*/ + uint16_t txmaxpack[15]; /*address 0x3E2*/ +}; + +struct CUSTOM_REGS { + uint32_t secure_ctrl; /*address 0x80000*/ + uint32_t secsid_atst; /*address 0x80004*/ + uint32_t nsaid_smmuid; /*address 0x80008*/ + uint32_t ace; /*address 0x8000c*/ + uint32_t wakeup; /*address 0x80010*/ + uint32_t debug; /*address 0x80014*/ +}; + +struct VHUB_REGS { + uint32_t gen_cfg; /*address 0x00*/ + uint32_t gen_st; /*address 0x04*/ + uint32_t bc_cfg; /*address 0x08*/ + uint32_t bc_st; /*address 0x0c*/ + uint32_t adp_cfg; /*address 0x10*/ + uint32_t adp_st; /*address 0x14*/ + uint32_t dbg_cfg; /*address 0x18*/ + uint32_t dbg_st; /*address 0x1c*/ + uint32_t utmip_cfg; /*address 0x20*/ + uint32_t utmip_st; /*address 0x24*/ +}; + +struct DMARegs { + uint32_t conf; /*address 0x400*/ + uint32_t sts; /*address 0x404*/ + uint32_t reserved5[5]; + uint32_t ep_sel; /*address 0x41C*/ + uint32_t traddr; /*address 0x420*/ + uint32_t ep_cfg; /*address 0x424*/ + uint32_t ep_cmd; /*address 0x428*/ + uint32_t ep_sts; /*address 0x42c*/ + uint32_t ep_sts_sid;/*address 0x430*/ + uint32_t ep_sts_en; /*address 0x434*/ + uint32_t drbl; /*address 0x438*/ + uint32_t ep_ien; /*address 0x43C*/ + uint32_t ep_ists; /*address 0x440*/ +}; + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/pci.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/pci.c new file mode 100644 index 0000000000000000000000000000000000000000..964fd67bfc5321a2f5a3f0dfa47dbf5e1ff820a7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/pci.c @@ -0,0 +1,208 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include +#include +#include +#include +#include +#include +#include +#include "core.h" + +#define PHYTIUM_OTG_USB_LOADED 3 + +static bool phytium_hw_is_device(struct phytium_cusb *config) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return false; +} + +static bool phytium_hw_is_host(struct phytium_cusb *config) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return true; +} + +static int phytium_get_dr_mode(struct phytium_cusb *config) +{ + enum usb_dr_mode mode; + + config->dr_mode = usb_get_dr_mode(config->dev); + if (config->dr_mode == USB_DR_MODE_UNKNOWN) + config->dr_mode = USB_DR_MODE_OTG; + + mode = config->dr_mode; + if (phytium_hw_is_device(config)) { + if (IS_ENABLED(CONFIG_USB_PHYTIUM_HOST)) { + dev_err(config->dev, "Controller does not support host mode.\n"); + return -EINVAL; + } + + mode = USB_DR_MODE_PERIPHERAL; + } else if (phytium_hw_is_host(config)) { + if (IS_ENABLED(CONFIG_USB_PHYTIUM_PERIPHERAL)) { + dev_err(config->dev, "Controller does not support device mode.\n"); + return -EINVAL; + } + mode = USB_DR_MODE_HOST; + } else { + if (IS_ENABLED(CONFIG_USB_PHYTIUM_HOST)) + mode = USB_DR_MODE_HOST; + else if (IS_ENABLED(CONFIG_USB_PHYTIUM_PERIPHERAL)) + mode = USB_DR_MODE_PERIPHERAL; + } + + if (mode != config->dr_mode) { + dev_warn(config->dev, "Configuration mismatch. dr_mode forced to %s\n", + mode == USB_DR_MODE_HOST ? "host" : "device"); + config->dr_mode = mode; + } + + return 0; +} + +static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) +{ + struct phytium_cusb *config; + int retval = 0; + + if (usb_disabled()) + return -ENODEV; + + retval = pcim_enable_device(pdev); + if (retval < 0) { + dev_err(&pdev->dev, "pcim_enable_device failed\n"); + return -ENODEV; + } + pci_set_master(pdev); + + config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL); + if (!config) + return -ENOMEM; + + spin_lock_init(&config->lock); + config->dev = &pdev->dev; + + config->irq = pdev->irq; + if (config->irq <= 0) { + dev_err(config->dev, "getting usb irq failed\n"); + return config->irq; + } + + config->regs = pci_iomap(pdev, 0, 0); + if (IS_ERR(config->regs)) { + dev_err(config->dev, "map IOMEM resource failed\n"); + return -1; + } + + if (!pdev->dev.dma_mask) + pdev->dev.dma_mask = &pdev->dev.coherent_dma_mask; + + if (dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64))) + dev_err(&pdev->dev, "failed to set 64-bit dma\n"); + else if (dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32))) + dev_err(&pdev->dev, "failed to set 32-bit dma\n"); + + pci_enable_msi(pdev); + + phytium_get_dr_mode(config); + + phytium_core_reset(config, false); + + if (config->dr_mode == USB_DR_MODE_HOST || config->dr_mode == USB_DR_MODE_OTG) + phytium_host_init(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) + phytium_gadget_init(config); + + dev_set_drvdata(config->dev, config); + + return 0; +} + +static void phytium_pci_remove(struct pci_dev *pdev) +{ + struct phytium_cusb *config = dev_get_drvdata(&pdev->dev); + + phytium_get_dr_mode(config); + if (config->dr_mode == USB_DR_MODE_HOST || config->dr_mode == USB_DR_MODE_OTG) + phytium_host_uninit(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) + phytium_gadget_uninit(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) + usb_del_gadget_udc(&config->gadget); + + dev_set_drvdata(&pdev->dev, NULL); + pr_info("%s %d\n", __func__, __LINE__); +} + +static void phytium_pci_shutdown(struct pci_dev *pdev) +{ + struct phytium_cusb *config; + + config = dev_get_drvdata(&pdev->dev); + + phytium_get_dr_mode(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) + usb_del_gadget_udc(&config->gadget); +} + +#ifdef CONFIG_PM +static int phytium_pci_resume(struct pci_dev *pdev) +{ + unsigned long flags = 0; + struct phytium_cusb *config; + int ret = 0; + + config = dev_get_drvdata(&pdev->dev); + + spin_lock_irqsave(&config->lock, flags); + ret = phytium_host_resume(config); + spin_unlock_irqrestore(&config->lock, flags); + + return ret; +} + +static int phytium_pci_suspend(struct pci_dev *pdev, pm_message_t state) +{ + unsigned long flags = 0; + struct phytium_cusb *config; + int ret; + + config = dev_get_drvdata(&pdev->dev); + + spin_lock_irqsave(&config->lock, flags); + ret = phytium_host_suspend(config); + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} +#endif + +const struct pci_device_id phytium_pci_id_table[] = { + {0x10ee, 0x8012, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, + {} +}; + +static struct pci_driver phytium_otg_driver = { + .name = "phytium_usb", + .id_table = phytium_pci_id_table, + .probe = phytium_pci_probe, + .remove = phytium_pci_remove, + .shutdown = phytium_pci_shutdown, +#ifdef CONFIG_PM + .resume = phytium_pci_resume, + .suspend = phytium_pci_suspend, +#endif +}; + +module_pci_driver(phytium_otg_driver); + +MODULE_AUTHOR("Chen Zhenhua "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium usb pci wrapper"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/platform.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/platform.c new file mode 100644 index 0000000000000000000000000000000000000000..7d39e4b6034d191d0b306b7b15ceadfb6887b79e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/usb/phytium/platform.c @@ -0,0 +1,216 @@ +// SPDX-License-Identifier: GPL-3.0 + +#include +#include +//#include +#include +#include +#include +#include +#include +#include +#include "core.h" +#include "hw-regs.h" + +#define PHYTIUM_OTG_USB_LOADED 3 +#define USB2_2_BASE_ADDRESS 0x31800000 + +static const struct of_device_id phytium_otg_of_match[] = { + { + .compatible = "phytium,usb2", + }, + {}, +}; + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_otg_acpi_match[] = { + { "PHYT0037", 0 }, + { } +}; +#endif + +static int phytium_get_dr_mode(struct phytium_cusb *config) +{ + config->dr_mode = usb_get_dr_mode(config->dev); + if (config->dr_mode == USB_DR_MODE_UNKNOWN) + config->dr_mode = USB_DR_MODE_PERIPHERAL; + + return 0; +} + +static irqreturn_t platform_usb_irq(int irq, void *dev_id) +{ + unsigned long flags; + uint8_t otgstate; + + struct phytium_cusb *config = (struct phytium_cusb *)dev_id; + struct GADGET_CTRL *gadget_ctrl = config->gadget_priv; + struct HOST_CTRL *host_ctrl = config->host_priv; + + if (gadget_ctrl || host_ctrl) { + if (host_ctrl) + otgstate = phytium_read8(&host_ctrl->regs->otgstate); + else + otgstate = phytium_read8(&gadget_ctrl->regs->otgstate); + + spin_lock_irqsave(&config->lock, flags); + if (otgstate > HOST_OTG_STATE_A_WAIT_VFALL) + config->gadget_obj->gadget_isr(config->gadget_priv); + else + config->host_obj->host_isr(config->host_priv); + spin_unlock_irqrestore(&config->lock, flags); + } + + return IRQ_HANDLED; +} + +static int phytium_driver_probe(struct platform_device *pdev) +{ + struct phytium_cusb *config; + struct resource *res, *phy_res; + int retval = 0; + + config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL); + if (!config) + return -ENOMEM; + + spin_lock_init(&config->lock); + config->dev = &pdev->dev; + config->isVhubHost = false; + + config->irq = platform_get_irq(pdev, 0); + if (config->irq <= 0) { + dev_err(config->dev, "getting usb irq failed\n"); + return config->irq; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + config->regs = devm_ioremap(&pdev->dev, res->start, resource_size(res)); + if (IS_ERR(config->regs)) { + dev_err(config->dev, "map IOMEM resource failed\n"); + return -1; + } + + phy_res = platform_get_resource(pdev, IORESOURCE_MEM, 1); + config->phy_regs = devm_ioremap(&pdev->dev, phy_res->start, resource_size(phy_res)); + if (IS_ERR(config->phy_regs)) { + dev_err(config->dev, "map IOMEM phy resource failed\n"); + return -1; + } + + phytium_get_dr_mode(config); + + phytium_core_reset(config, false); + + if (config->dr_mode == USB_DR_MODE_HOST || + config->dr_mode == USB_DR_MODE_OTG) { + if (res->start == USB2_2_BASE_ADDRESS) + config->isVhubHost = true; + + phytium_host_init(config); + } + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || + config->dr_mode == USB_DR_MODE_OTG) + phytium_gadget_init(config); + + dev_set_drvdata(&pdev->dev, config); + + if (config->irq > 0) { + retval = devm_request_irq(config->dev, config->irq, platform_usb_irq, + IRQF_SHARED, "phytium_otg", config); + if (retval != 0) { + dev_err(config->dev, "request irq %d err %d\n", config->irq, retval); + config->irq = 0; + } + } + + return retval; +} + +static int phytium_driver_remove(struct platform_device *dev) +{ + struct phytium_cusb *config = platform_get_drvdata(dev); + + if (!config) + return 0; + + phytium_get_dr_mode(config); + + if (config->dr_mode == USB_DR_MODE_HOST || + config->dr_mode == USB_DR_MODE_OTG) + phytium_host_uninit(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || + config->dr_mode == USB_DR_MODE_OTG) + phytium_gadget_uninit(config); + + dev_set_drvdata(&dev->dev, NULL); + return 0; +} + +static void phytium_driver_shutdown(struct platform_device *dev) +{ + pr_info("%s %d\n", __func__, __LINE__); +} + +#ifdef CONFIG_PM +static int phytium_driver_suspend(struct device *dev) +{ + struct phytium_cusb *config; + int ret = 0; + + config = dev_get_drvdata(dev); + + if (config->dr_mode == USB_DR_MODE_HOST || + config->dr_mode == USB_DR_MODE_OTG) + ret = phytium_host_suspend(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || + config->dr_mode == USB_DR_MODE_OTG) + ret = phytium_gadget_suspend(config); + + return ret; +} + +static int phytium_driver_resume(struct device *dev) +{ + struct phytium_cusb *config; + int ret = 0; + + config = dev_get_drvdata(dev); + if (config->dr_mode == USB_DR_MODE_HOST || + config->dr_mode == USB_DR_MODE_OTG) + ret = phytium_host_resume(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || + config->dr_mode == USB_DR_MODE_OTG) + ret = phytium_gadget_resume(config); + + return ret; +} + +static const struct dev_pm_ops phytium_usb_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_driver_suspend, phytium_driver_resume) +}; +#endif + +static struct platform_driver phytium_otg_driver = { + .driver = { + .name = "phytium-otg", + .of_match_table = of_match_ptr(phytium_otg_of_match), + .acpi_match_table = ACPI_PTR(phytium_otg_acpi_match), +#ifdef CONFIG_PM + .pm = &phytium_usb_pm_ops, +#endif + }, + .probe = phytium_driver_probe, + .remove = phytium_driver_remove, + .shutdown = phytium_driver_shutdown, +}; + +module_platform_driver(phytium_otg_driver); + +MODULE_AUTHOR("Chen Zhenhua "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium usb platform wrapper"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/w1/masters/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/drivers/w1/masters/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..afc204376c862e91753496193937aac2b2bba376 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/w1/masters/Kconfig @@ -0,0 +1,10 @@ +config W1_MASTER_PHYTIUM + tristate "Phytium 1-wire driver" + depends on ARCH_PHYTIUM || COMPILE_TEST + help + Say Y here if you want to get support for the 1-wire interface + on an Phytium SoC. + + This driver can also be built as a module. If so, the module + will be called phytium-w1. + diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/w1/masters/Makefile b/device_soc_phytium/common/kernel/linux-5.10/drivers/w1/masters/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..b85e48ffde2b1c93b74ee0659052bad52dae0b8d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/w1/masters/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_W1_MASTER_PHYTIUM) += phytium_w1.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/drivers/w1/masters/phytium_w1.c b/device_soc_phytium/common/kernel/linux-5.10/drivers/w1/masters/phytium_w1.c new file mode 100644 index 0000000000000000000000000000000000000000..32e41a816637dcb1e51cf00a7a0f77fe3126ec55 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/drivers/w1/masters/phytium_w1.c @@ -0,0 +1,643 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * drivers/w1/masters/phytium_w1m.c + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define PHY_W1M_CTL 0x08 + +/* Simplify mode */ +#define PHY_W1M_CMD 0x04 +#define PHY_W1M_PWM0_START_B 0x30 +#define PHY_W1M_PWM0_END_B 0x34 +#define PHY_W1M_PWM1_START_B 0x38 +#define PHY_W1M_PWM1_END_B 0x3c +#define PHY_W1M_SAMPLE_B 0x40 +#define PHY_W1M_INT_EN_B 0x64 +#define PHY_W1M_INT_STATUS_B 0x74 +#define PHY_W1M_DATA_REG 0x70 + +#define PHY_W1M_CMD_ROM_SEARCH 0xF0 +#define PHY_W1M_CMD_WRITE_BIT 0x35 +#define PHY_W1M_CMD_WRITE_BYTE 0x36 +#define PHY_W1M_CMD_RESET_BUS 0x37 +#define PHY_W1M_CMD_READ_BIT 0x3A +#define PHY_W1M_CMD_READ_BYTE 0x3B +#define PHY_W1M_SLAVE_ROM_ID 0x160 + +#define PHY_W1M_INT_EN_TXCOMPLETE BIT(6) +#define PHY_W1M_INT_EN_RXCOMPLETE BIT(7) + +#define PHY_W1M_INT_STATUS_TXCOMPLETE BIT(6) +#define PHY_W1M_INT_STATUS_RXCOMPLETE BIT(7) + +#define W1M_MOD_W1 1 +#define W1M_MOD_PECI 0 + +#define PHY_W1M_FLAG_CLEAR 0 +#define PHY_W1M_FLAG_SET 1 +#define PHY_W1M_TIMEOUT (HZ/5) + +#define PHY_W1M_MAX_USER 4 + +static DECLARE_WAIT_QUEUE_HEAD(w1m_wait_queue); + +struct w1m_data { + struct device *dev; + void __iomem *w1m_base; + /* lock status update */ + struct mutex w1m_mutex; + int w1m_usecount; + u8 w1m_irqstatus; + /* device lock */ + spinlock_t w1m_spinlock; + /* + * Used to control the call to phytium_w1m_get and phytium_w1m_put. + * Non-w1 Protocol: Write the CMD|REG_address first, followed by + * the data wrire or read. + */ + int init_trans; +}; + +/* W1 register I/O routines */ +static inline u8 phytium_w1m_read(struct w1m_data *w1m_data, u32 offset) +{ + return readl(w1m_data->w1m_base + offset); +} + +static inline void phytium_w1m_write(struct w1m_data *w1m_data, u32 offset, u8 val) +{ + writel(val, w1m_data->w1m_base + offset); +} + +static inline u8 phytium_w1m_merge(struct w1m_data *w1m_data, u32 offset, + u8 val, u8 mask) +{ + u8 new_val = (__raw_readl(w1m_data->w1m_base + offset) & ~mask) + | (val & mask); + writel(new_val, w1m_data->w1m_base + offset); + + return new_val; +} + +static void w1m_disable_interrupt(struct w1m_data *w1m_data, u32 offset, + u32 mask) +{ + u32 ie; + + ie = readl(w1m_data->w1m_base + offset); + writel(ie & mask, w1m_data->w1m_base + offset); +} + +/* write out a byte or bit and fill *status with W1M_INT_STATUS */ +static int phytium_write_data(struct w1m_data *w1m_data, u8 val, u8 *status, bool is_bit) +{ + int ret; + unsigned long irqflags; + + *status = 0; + + spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); + /* clear interrupt flags via a dummy read */ + phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); + /* ISR loads it with new INT_STATUS */ + w1m_data->w1m_irqstatus = 0; + spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); + + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_TXCOMPLETE, + PHY_W1M_INT_EN_TXCOMPLETE); + + phytium_w1m_write(w1m_data, PHY_W1M_DATA_REG, val); + phytium_w1m_write(w1m_data, PHY_W1M_CMD, is_bit ? PHY_W1M_CMD_WRITE_BIT : PHY_W1M_CMD_WRITE_BYTE); + + /* wait for the TXCOMPLETE bit */ + ret = wait_event_timeout(w1m_wait_queue, + w1m_data->w1m_irqstatus, PHY_W1M_TIMEOUT); + if (ret == 0) { + dev_err(w1m_data->dev, "TX wait elapsed\n"); + ret = -ETIMEDOUT; + goto out; + } + + *status = w1m_data->w1m_irqstatus; + /* check irqstatus */ + if (!(*status & PHY_W1M_INT_STATUS_TXCOMPLETE)) { + dev_err(w1m_data->dev, + "timeout waiting for TXCOMPLETE/RXCOMPLETE, %x", *status); + ret = -ETIMEDOUT; + } + +out: + return ret; +} + +static irqreturn_t w1m_isr(int irq, void *_w1m) +{ + struct w1m_data *w1m_data = _w1m; + unsigned long irqflags; + + spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); + w1m_data->w1m_irqstatus = phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); + spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); + + phytium_w1m_write(w1m_data, PHY_W1M_INT_STATUS_B, 0x00); + if (w1m_data->w1m_irqstatus & + (PHY_W1M_INT_STATUS_TXCOMPLETE | PHY_W1M_INT_STATUS_RXCOMPLETE)) { + /* wake up sleeping process */ + wake_up(&w1m_wait_queue); + } + + return IRQ_HANDLED; +} + + +static int phytium_read_data(struct w1m_data *w1m_data, u8 *val, bool is_bit) +{ + int ret = 0; + u8 status; + unsigned long irqflags; + + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + ret = -EINTR; + goto rtn; + } + + if (!w1m_data->w1m_usecount) { + ret = -EINVAL; + goto out; + } + + spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); + /* clear interrupt flags via a dummy read */ + phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); + /* ISR loads it with new INT_STATUS */ + w1m_data->w1m_irqstatus = 0; + spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); + + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_RXCOMPLETE, + PHY_W1M_INT_EN_RXCOMPLETE); + + phytium_w1m_write(w1m_data, PHY_W1M_CMD, is_bit ? PHY_W1M_CMD_READ_BIT : PHY_W1M_CMD_READ_BYTE); + + wait_event_timeout(w1m_wait_queue, + (w1m_data->w1m_irqstatus & PHY_W1M_INT_STATUS_RXCOMPLETE), + PHY_W1M_TIMEOUT); + + status = w1m_data->w1m_irqstatus; + /* check irqstatus */ + if (!(status & PHY_W1M_INT_STATUS_RXCOMPLETE)) { + dev_err(w1m_data->dev, "timeout waiting for RXCOMPLETE, %x", status); + ret = -ETIMEDOUT; + goto out; + } + + /* the data is ready. Read it in! */ + *val = phytium_w1m_read(w1m_data, PHY_W1M_DATA_REG); +out: + mutex_unlock(&w1m_data->w1m_mutex); +rtn: + return ret; +} + + +static int phytium_w1m_get(struct w1m_data *w1m_data) +{ + int ret = 0; + + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + ret = -EINTR; + goto rtn; + } + + if (w1m_data->w1m_usecount == PHY_W1M_MAX_USER) { + dev_warn(w1m_data->dev, "attempt to exceed the max use count"); + ret = -EINVAL; + goto out; + } else { + w1m_data->w1m_usecount++; + try_module_get(THIS_MODULE); + if (w1m_data->w1m_usecount == 1) + pm_runtime_get_sync(w1m_data->dev); + } + +out: + mutex_unlock(&w1m_data->w1m_mutex); +rtn: + return ret; +} + +/* Disable clocks to the module */ +static int phytium_w1m_put(struct w1m_data *w1m_data) +{ + int ret = 0; + + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) + return -EINTR; + + if (w1m_data->w1m_usecount == 0) { + dev_warn(w1m_data->dev, + "attempt to decrement use count when it is zero"); + ret = -EINVAL; + } else { + w1m_data->w1m_usecount--; + module_put(THIS_MODULE); + if (w1m_data->w1m_usecount == 0) + pm_runtime_put_sync(w1m_data->dev); + } + mutex_unlock(&w1m_data->w1m_mutex); + + return ret; +} + +/* + * W1 triplet callback function - used for searching ROM addresses. + * Registered only when controller is in 1-wire mode. + */ +static u8 phytium_w1_triplet(void *_w1m, u8 bdir) +{ + u8 id_bit, comp_bit; + int err; + u8 ret = 0x3; /* no slaves responded */ + struct w1m_data *w1m_data = _w1m; + + phytium_w1m_get(_w1m); + + err = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (err < 0) { + dev_err(w1m_data->dev, "Could not acquire mutex\n"); + goto rtn; + } + + w1m_data->w1m_irqstatus = 0; + /* read id_bit */ + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_RXCOMPLETE, + PHY_W1M_INT_EN_RXCOMPLETE); + phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); + + err = wait_event_timeout(w1m_wait_queue, + (w1m_data->w1m_irqstatus + & PHY_W1M_INT_STATUS_RXCOMPLETE), + PHY_W1M_TIMEOUT); + if (err == 0) { + dev_err(w1m_data->dev, "RX wait elapsed\n"); + goto out; + } + id_bit = (phytium_w1m_read(_w1m, PHY_W1M_DATA_REG) & 0x01); + + w1m_data->w1m_irqstatus = 0; + /* read comp_bit */ + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_RXCOMPLETE, + PHY_W1M_INT_EN_RXCOMPLETE); + phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); + err = wait_event_timeout(w1m_wait_queue, + (w1m_data->w1m_irqstatus + & PHY_W1M_INT_STATUS_RXCOMPLETE), + PHY_W1M_TIMEOUT); + if (err == 0) { + dev_err(w1m_data->dev, "RX wait elapsed\n"); + goto out; + } + comp_bit = (phytium_w1m_read(_w1m, PHY_W1M_DATA_REG) & 0x01); + + if (id_bit && comp_bit) { + ret = 0x03; /* no slaves responded */ + goto out; + } + if (!id_bit && !comp_bit) { + /* Both bits are valid, take the direction given */ + ret = bdir ? 0x04 : 0; + } else { + /* Only one bit is valid, take that direction */ + bdir = id_bit; + ret = id_bit ? 0x05 : 0x02; + } + + w1m_data->w1m_irqstatus = 0; + /* write bdir bit */ + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_TXCOMPLETE, + PHY_W1M_INT_EN_TXCOMPLETE); + + phytium_w1m_write(w1m_data, PHY_W1M_DATA_REG, bdir); + phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x35); + + err = wait_event_timeout(w1m_wait_queue, + (w1m_data->w1m_irqstatus + & PHY_W1M_INT_STATUS_TXCOMPLETE), + PHY_W1M_TIMEOUT); + if (err == 0) { + dev_err(w1m_data->dev, "TX wait elapsed\n"); + goto out; + } + +out: + mutex_unlock(&w1m_data->w1m_mutex); +rtn: + phytium_w1m_put(_w1m); + return ret; +} + +static u8 phytium_w1_touch_bit(void *_w1m, u8 bit) +{ + u8 result = 0; + int err; + struct w1m_data *w1m_data = _w1m; + + phytium_w1m_get(w1m_data); + + w1m_data->init_trans++; + + err = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (err < 0) { + dev_err(w1m_data->dev, "Could not acquired mutex\n"); + goto rtn; + } + + w1m_data->w1m_irqstatus = 0; + + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_RXCOMPLETE, + PHY_W1M_INT_EN_RXCOMPLETE); + phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); + + err = wait_event_timeout(w1m_wait_queue, + (w1m_data->w1m_irqstatus + & PHY_W1M_INT_STATUS_RXCOMPLETE), + PHY_W1M_TIMEOUT); + if (err == 0) { + dev_info(w1m_data->dev, "Rx wait elapsed\n"); + goto out; + } + + result = (phytium_w1m_read(w1m_data, PHY_W1M_DATA_REG) & 0x01); + + w1m_data->w1m_irqstatus = 0; + +out: + mutex_unlock(&w1m_data->w1m_mutex); + +rtn: + phytium_w1m_put(w1m_data); + + return result; +} + +/* reset callback */ +static u8 phytium_w1_reset_bus(void *_w1m) +{ + phytium_w1m_get(_w1m); + phytium_w1m_write(_w1m, PHY_W1M_CMD, 0x37); + mdelay(1); + phytium_w1m_put(_w1m); + return 0; +} + +/* Read a byte of data from the device */ +static u8 phytium_w1_read_data(void *_w1m, bool is_bit) +{ + struct w1m_data *w1m_data = _w1m; + u8 val = 0; + int ret; + + /* First write to initialize the transfer */ + if (w1m_data->init_trans == 0) + phytium_w1m_get(w1m_data); + + w1m_data->init_trans++; + ret = phytium_read_data(w1m_data, &val, is_bit); + if (ret) { + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + dev_err(w1m_data->dev, "Could not acquire mutex\n"); + return -EINTR; + } + w1m_data->init_trans = 0; + mutex_unlock(&w1m_data->w1m_mutex); + phytium_w1m_put(w1m_data); + return -1; + } + + w1m_disable_interrupt(w1m_data, PHY_W1M_INT_EN_B, + ~((u32)PHY_W1M_INT_EN_RXCOMPLETE)); + + /* Write followed by a read, release the module */ + if (w1m_data->init_trans) { + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + dev_err(w1m_data->dev, "Could not acquire mutex\n"); + return -EINTR; + } + w1m_data->init_trans = 0; + mutex_unlock(&w1m_data->w1m_mutex); + phytium_w1m_put(w1m_data); + } + + return val; +} + +static u8 phytium_w1_read_bit(void *_w1m) +{ + return phytium_w1_read_data(_w1m, true); +} + +static u8 phytium_w1_read_byte(void *_w1m) +{ + return phytium_w1_read_data(_w1m, false); +} + +/* Write a byte of data to the device */ +static void phytium_w1_write_data(void *_w1m, u8 byte, bool is_bit) +{ + struct w1m_data *w1m_data = _w1m; + int ret; + u8 status; + + /* First write to initialize the transfer */ + if (w1m_data->init_trans == 0) + phytium_w1m_get(w1m_data); + + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + dev_err(w1m_data->dev, "Could not acquire mutex\n"); + return; + } + mutex_unlock(&w1m_data->w1m_mutex); + + ret = phytium_write_data(w1m_data, byte, &status, is_bit); + if (ret < 0) { + dev_err(w1m_data->dev, "TX failure:Ctrl status %x\n", status); + return; + } + + w1m_data->init_trans++; + w1m_disable_interrupt(w1m_data, PHY_W1M_INT_EN_B, + ~((u32)PHY_W1M_INT_EN_TXCOMPLETE)); + /* Second write, data transferred. Release the module */ + if (w1m_data->init_trans > 1) { + phytium_w1m_put(w1m_data); + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + dev_err(w1m_data->dev, "Could not acquire mutex\n"); + return; + } + w1m_data->init_trans = 0; + mutex_unlock(&w1m_data->w1m_mutex); + } +} + +static void phytium_w1_write_bit(void *_w1m, u8 bit) +{ + phytium_w1_write_data(_w1m, bit, true); +} + +static void phytium_w1_write_byte(void *_w1m, u8 bit) +{ + phytium_w1_write_data(_w1m, bit, false); +} + +static struct w1_bus_master phytium_w1_master = { + .read_byte = phytium_w1_read_byte, + .write_byte = phytium_w1_write_byte, + .read_bit = phytium_w1_read_bit, + .write_bit = phytium_w1_write_bit, + .reset_bus = phytium_w1_reset_bus, + .touch_bit = phytium_w1_touch_bit, +}; + +static int phytium_w1m_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct w1m_data *w1m_data; + struct resource *res; + int ret, irq; + + w1m_data = devm_kzalloc(dev, sizeof(*w1m_data), GFP_KERNEL); + if (!w1m_data) + return -ENOMEM; + + w1m_data->dev = dev; + platform_set_drvdata(pdev, w1m_data); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + w1m_data->w1m_base = devm_ioremap_resource(dev, res); + if (IS_ERR(w1m_data->w1m_base)) + return PTR_ERR(w1m_data->w1m_base); + + w1m_data->w1m_usecount = 0; + mutex_init(&w1m_data->w1m_mutex); + + pm_runtime_enable(&pdev->dev); + ret = pm_runtime_get_sync(&pdev->dev); + if (ret < 0) { + dev_err(&pdev->dev, "pm_runtime_get_sync failed\n"); + goto err_w1; + } + + spin_lock_init(&w1m_data->w1m_spinlock); + + irq = platform_get_irq(pdev, 0); + if (irq < 0) { + dev_err(&pdev->dev, "Failed to get IRQ: %d\n", irq); + ret = irq; + goto err_irq; + } + + ret = devm_request_irq(dev, irq, w1m_isr, 0, "phytium-w1", w1m_data); + if (ret < 0) { + dev_err(&pdev->dev, "could not request irq\n"); + goto err_irq; + } + + pm_runtime_put_sync(&pdev->dev); + + phytium_w1_master.triplet = phytium_w1_triplet; + phytium_w1m_write(w1m_data, PHY_W1M_CTL, 0x10); + phytium_w1m_write(w1m_data, PHY_W1M_INT_EN_B, 0x00); + + phytium_w1_master.data = w1m_data; + + ret = w1_add_master_device(&phytium_w1_master); + if (ret) { + dev_err(&pdev->dev, "Failure in registering w1 master\n"); + goto err_w1; + } + + return 0; + +err_irq: + pm_runtime_put_sync(&pdev->dev); +err_w1: + pm_runtime_disable(&pdev->dev); + + return ret; +} + +static int phytium_w1m_remove(struct platform_device *pdev) +{ + struct w1m_data *w1m_data = platform_get_drvdata(pdev); + + mutex_lock(&w1m_data->w1m_mutex); + + if (w1m_data->w1m_usecount) { + dev_warn(&pdev->dev, "removed when use count is not zero\n"); + mutex_unlock(&w1m_data->w1m_mutex); + return -EBUSY; + } + + mutex_unlock(&w1m_data->w1m_mutex); + + /* remove module dependency */ + pm_runtime_disable(&pdev->dev); + + return 0; +} + +static const struct of_device_id phytium_w1m_dt_ids[] = { + { .compatible = "phytium,w1" }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_w1m_dt_ids); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_w1m_acpi_ids[] = { + { "PHYT0034", 0 }, + { } +}; +#endif + +static struct platform_driver phytium_w1m_driver = { + .probe = phytium_w1m_probe, + .remove = phytium_w1m_remove, + .driver = { + .name = "phytium-w1", + .of_match_table = phytium_w1m_dt_ids, + .acpi_match_table = ACPI_PTR(phytium_w1m_acpi_ids), + }, +}; +module_platform_driver(phytium_w1m_driver); + +MODULE_AUTHOR("Zhu Mingshuai "); +MODULE_DESCRIPTION("Phytium w1 bus master driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..31e43c59c0a78057a74793a73b94aa2413fae33a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/Kconfig @@ -0,0 +1,16 @@ +config SND_HDA_PHYTIUM + tristate "PHYTIUM HD Audio" + depends on SOUND + select SND_HDA + select SND_HDA_ALIGNED_MMIO + help + Say Y here to support the HDA controller present in PHYTIUM + SoCs + + This options enables support for the HD Audio controller + present in some PHYTIUM SoCs, used to communicate audio + to the "High Definition Audio" codec. + + To compile this driver as a module, choose M here: the module + will be called snd-hda-phytium. + diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/Makefile b/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..37f17b56b4f367046a5bf2c4a66d6e4867773cbe --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/Makefile @@ -0,0 +1,2 @@ +snd-hda-phytium-objs := hda_phytium.o +obj-$(CONFIG_SND_HDA_PHYTIUM) += snd-hda-phytium.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/hda_phytium.c b/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/hda_phytium.c new file mode 100644 index 0000000000000000000000000000000000000000..aead6f079e728ab33de2b228bf156d539f297973 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/hda_phytium.c @@ -0,0 +1,1125 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Implementation of primary ALSA driver code for Phytium HD Audio. + * + * Copyright (c) 2018-2024 Phytium Technology Co., Ltd. + */ + +#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 "hda_controller.h" +#include "hda_phytium.h" + +#include "hda_intel_trace.h" + +/* position fix mode */ +enum { + POS_FIX_AUTO, + POS_FIX_LPIB, + POS_FIX_POSBUF, + POS_FIX_VIACOMBO, + POS_FIX_COMBO, +}; + +/* Define IN stream 0 FIFO size offset in VIA controller */ +#define VIA_IN_STREAM0_FIFO_SIZE_OFFSET 0x90 + +/* FT have 4 playback and 4 capture */ +#define FT4C_NUM_CAPTURE 4 +#define FT4C_NUM_PLAYBACK 4 + +#define DWORD_BYTE_WIDTH 4 +#define BYTE_BIT_WIDTH 8 + +static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; +static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; +static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; +static char *model[SNDRV_CARDS]; +static int position_fix[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = 1}; +static int bdl_pos_adj[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = -1}; +static int probe_mask[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = -1}; +static int probe_only[SNDRV_CARDS]; +static int jackpoll_ms[SNDRV_CARDS]; +static int single_cmd = -1; +static int enable_msi = -1; +#ifdef CONFIG_SND_HDA_INPUT_BEEP +static bool beep_mode[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = + CONFIG_SND_HDA_INPUT_BEEP_MODE}; +#endif + +module_param_array(index, int, NULL, 0444); +MODULE_PARM_DESC(index, "Index value for Intel HD audio interface."); +module_param_array(id, charp, NULL, 0444); +MODULE_PARM_DESC(id, "ID string for Intel HD audio interface."); +module_param_array(enable, bool, NULL, 0444); +MODULE_PARM_DESC(enable, "Enable Intel HD audio interface."); +module_param_array(model, charp, NULL, 0444); +MODULE_PARM_DESC(model, "Use the given board model."); +module_param_array(position_fix, int, NULL, 0444); +MODULE_PARM_DESC(position_fix, "DMA pointer read method. (-1 = system default, 0 = auto, 1 = LPIB, 2 = POSBUF, 3 = VIACOMBO, 4 = COMBO)."); +module_param_array(bdl_pos_adj, int, NULL, 0644); +MODULE_PARM_DESC(bdl_pos_adj, "BDL position adjustment offset."); +module_param_array(probe_mask, int, NULL, 0444); +MODULE_PARM_DESC(probe_mask, "Bitmask to probe codecs (default = -1)."); +module_param_array(probe_only, int, NULL, 0444); +MODULE_PARM_DESC(probe_only, "Only probing and no codec initialization."); +module_param_array(jackpoll_ms, int, NULL, 0444); +MODULE_PARM_DESC(jackpoll_ms, "Ms between polling for jack events (default = 0, using unsol events only)"); +module_param(single_cmd, bint, 0444); +MODULE_PARM_DESC(single_cmd, "Use single command to communicate with codecs (for debugging only)."); +module_param(enable_msi, bint, 0444); +MODULE_PARM_DESC(enable_msi, "Enable Message Signaled Interrupt (MSI)"); +#ifdef CONFIG_SND_HDA_INPUT_BEEP +module_param_array(beep_mode, bool, NULL, 0444); +MODULE_PARM_DESC(beep_mode, "Select HDA Beep registration mode (0=off, 1=on) (default=1)."); +#endif + +#define power_save 0 + +static int align_buffer_size = -1; +module_param(align_buffer_size, bint, 0644); +MODULE_PARM_DESC(align_buffer_size, + "Force buffer and period sizes to be multiple of 128 bytes."); + +/* driver types */ +enum { + AZX_DRIVER_ICH, + AZX_DRIVER_PCH, + AZX_DRIVER_SCH, + AZX_DRIVER_HDMI, + AZX_DRIVER_ATI, + AZX_DRIVER_ATIHDMI, + AZX_DRIVER_ATIHDMI_NS, + AZX_DRIVER_VIA, + AZX_DRIVER_SIS, + AZX_DRIVER_ULI, + AZX_DRIVER_NVIDIA, + AZX_DRIVER_TERA, + AZX_DRIVER_CTX, + AZX_DRIVER_CTHDA, + AZX_DRIVER_CMEDIA, + AZX_DRIVER_GENERIC, + AZX_DRIVER_FT, + AZX_NUM_DRIVERS, /* keep this as last entry */ +}; + +/* NOP for other archs */ +static inline void mark_pages_wc(struct azx *chip, struct snd_dma_buffer *buf, + bool on) +{ +} + +static inline void mark_runtime_wc(struct azx *chip, struct azx_dev *azx_dev, + struct snd_pcm_substream *substream, bool on) +{ +} + +static int azx_acquire_irq(struct azx *chip, int do_disconnect); + +/* calculate runtime delay from LPIB */ +static int azx_get_delay_from_lpib(struct azx *chip, struct azx_dev *azx_dev, + unsigned int pos) +{ + struct snd_pcm_substream *substream = azx_dev->core.substream; + int stream = substream->stream; + unsigned int lpib_pos = azx_get_pos_lpib(chip, azx_dev); + int delay; + + if (stream == SNDRV_PCM_STREAM_PLAYBACK) + delay = pos - lpib_pos; + else + delay = lpib_pos - pos; + if (delay < 0) { + if (delay >= azx_dev->core.delay_negative_threshold) + delay = 0; + else + delay += azx_dev->core.bufsize; + } + + if (delay >= azx_dev->core.period_bytes) { + dev_info(chip->card->dev, + "Unstable LPIB (%d >= %d); disabling LPIB delay counting\n", + delay, azx_dev->core.period_bytes); + delay = 0; + chip->driver_caps &= ~AZX_DCAPS_COUNT_LPIB_DELAY; + chip->get_delay[stream] = NULL; + } + + return bytes_to_frames(substream->runtime, delay); +} + +static int azx_position_ok(struct azx *chip, struct azx_dev *azx_dev); + +/* called from IRQ */ +static int azx_position_check(struct azx *chip, struct azx_dev *azx_dev) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + int ok; + + ok = azx_position_ok(chip, azx_dev); + if (ok == 1) { + azx_dev->irq_pending = 0; + return ok; + } else if (ok == 0) { + /* bogus IRQ, process it later */ + azx_dev->irq_pending = 1; + schedule_work(&hda->irq_pending_work); + } + return 0; +} + +static int azx_ft_link_power(struct azx *chip, bool enable) +{ + return 0; +} + +/* + * Check whether the current DMA position is acceptable for updating + * periods. Returns non-zero if it's OK. + * + * Many HD-audio controllers appear pretty inaccurate about + * the update-IRQ timing. The IRQ is issued before actually the + * data is processed. So, we need to process it afterwords in a + * workqueue. + */ +static int azx_position_ok(struct azx *chip, struct azx_dev *azx_dev) +{ + struct snd_pcm_substream *substream = azx_dev->core.substream; + int stream = substream->stream; + u32 wallclk; + unsigned int pos; + + wallclk = (azx_readl(chip, WALLCLK) - azx_dev->core.start_wallclk); + + if (wallclk < (azx_dev->core.period_wallclk * 2) / 3) + return -1; /* bogus (too early) interrupt */ + + if (chip->get_position[stream]) + pos = chip->get_position[stream](chip, azx_dev); + else { /* use the position buffer as default */ + pos = azx_get_pos_posbuf(chip, azx_dev); + if (!pos || pos == (u32)-1) { + dev_info(chip->card->dev, + "Invalid position buffer, using LPIB read method instead.\n"); + chip->get_position[stream] = azx_get_pos_lpib; + if (chip->get_position[0] == azx_get_pos_lpib && + chip->get_position[1] == azx_get_pos_lpib) + azx_bus(chip)->use_posbuf = false; + pos = azx_get_pos_lpib(chip, azx_dev); + chip->get_delay[stream] = NULL; + } else { + chip->get_position[stream] = azx_get_pos_posbuf; + if (chip->driver_caps & AZX_DCAPS_COUNT_LPIB_DELAY) + chip->get_delay[stream] = azx_get_delay_from_lpib; + } + } + + if (pos >= azx_dev->core.bufsize) + pos = 0; + + if (WARN_ONCE(!azx_dev->core.period_bytes, + "hda-ft: zero azx_dev->period_bytes")) + return -1; /* this shouldn't happen! */ + if (wallclk < (azx_dev->core.period_wallclk * 5) / 4 && + pos % azx_dev->core.period_bytes > azx_dev->core.period_bytes / 2) + /* NG - it's below the first next period boundary */ + return chip->bdl_pos_adj ? 0 : -1; + + azx_dev->core.start_wallclk += wallclk; + + return 1; /* OK, it's fine */ +} + +static int hda_ft_dma_configure(struct device *dev) +{ + const struct of_device_id *match_of; + const struct acpi_device_id *match_acpi; + + if (dev->of_node) { + match_of = of_match_device(dev->driver->of_match_table, dev); + if (!match_of) { + dev_err(dev, "Error DT match data is missing\n"); + return -ENODEV; + } + set_dma_ops(dev, NULL); + /* + * Because there is no way to transfer to non-coherent dma in + * of_dma_configure if 'dma-coherent' is described in DT, + * use acpi_dma_configure to alloc dma_ops correctly. + */ + acpi_dma_configure(dev, DEV_DMA_NON_COHERENT); + } else if (has_acpi_companion(dev)) { + match_acpi = acpi_match_device(dev->driver->acpi_match_table, dev); + if (!match_acpi) { + dev_err(dev, "Error ACPI match data is missing\n"); + return -ENODEV; + } + set_dma_ops(dev, NULL); + acpi_dma_configure(dev, DEV_DMA_NON_COHERENT); + } + + return 0; +} + +/* The work for pending PCM period updates. */ +static void azx_irq_pending_work(struct work_struct *work) +{ + struct hda_ft *hda = container_of(work, struct hda_ft, irq_pending_work); + struct azx *chip = &hda->chip; + struct hdac_bus *bus = azx_bus(chip); + struct hdac_stream *s; + int pending, ok; + + if (!hda->irq_pending_warned) { + dev_info(chip->card->dev, + "IRQ timing workaround is activated for card #%d. Suggest a bigger bdl_pos_adj.\n", + chip->card->number); + hda->irq_pending_warned = 1; + } + + for (;;) { + pending = 0; + spin_lock_irq(&bus->reg_lock); + list_for_each_entry(s, &bus->stream_list, list) { + struct azx_dev *azx_dev = stream_to_azx_dev(s); + + if (!azx_dev->irq_pending || + !s->substream || !s->running) + continue; + ok = azx_position_ok(chip, azx_dev); + if (ok > 0) { + azx_dev->irq_pending = 0; + spin_unlock(&bus->reg_lock); + snd_pcm_period_elapsed(s->substream); + spin_lock(&bus->reg_lock); + } else if (ok < 0) { + pending = 0; /* too early */ + } else { + pending++; + } + } + spin_unlock_irq(&bus->reg_lock); + if (!pending) + return; + udelay(1000); + } +} + +/* clear irq_pending flags and assure no on-going workq */ +static void azx_clear_irq_pending(struct azx *chip) +{ + struct hdac_bus *bus = azx_bus(chip); + struct hdac_stream *s; + + spin_lock_irq(&bus->reg_lock); + list_for_each_entry(s, &bus->stream_list, list) { + struct azx_dev *azx_dev = stream_to_azx_dev(s); + + azx_dev->irq_pending = 0; + } + spin_unlock_irq(&bus->reg_lock); +} + +static int azx_acquire_irq(struct azx *chip, int do_disconnect) +{ + struct hdac_bus *bus = azx_bus(chip); + + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + struct platform_device *pdev = to_platform_device(hda->dev); + int irq_id = platform_get_irq(pdev, 0); + int err; + + err = request_irq(irq_id, azx_interrupt, + IRQF_SHARED, KBUILD_MODNAME, chip); + if (err) { + dev_err(chip->card->dev, + "unable to request IRQ %d, disabling device\n", + irq_id); + if (do_disconnect) + snd_card_disconnect(chip->card); + return err; + } + bus->irq = irq_id; + + return 0; +} + +/* get the current DMA position with correction on VIA chips */ +static unsigned int azx_via_get_position(struct azx *chip, + struct azx_dev *azx_dev) +{ + unsigned int link_pos, mini_pos, bound_pos; + unsigned int mod_link_pos, mod_dma_pos, mod_mini_pos; + unsigned int fifo_size; + + link_pos = snd_hdac_stream_get_pos_lpib(azx_stream(azx_dev)); + if (azx_dev->core.substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + /* Playback, no problem using link position */ + return link_pos; + } + + /* Capture */ + /* For new chipset, + * use mod to get the DMA position just like old chipset + */ + mod_dma_pos = le32_to_cpu(*azx_dev->core.posbuf); + mod_dma_pos %= azx_dev->core.period_bytes; + + /* azx_dev->fifo_size can't get FIFO size of in stream. + * Get from base address + offset. + */ + fifo_size = readw(azx_bus(chip)->remap_addr + + VIA_IN_STREAM0_FIFO_SIZE_OFFSET); + + if (azx_dev->insufficient) { + /* Link position never gather than FIFO size */ + if (link_pos <= fifo_size) + return 0; + + azx_dev->insufficient = 0; + } + + if (link_pos <= fifo_size) + mini_pos = azx_dev->core.bufsize + link_pos - fifo_size; + else + mini_pos = link_pos - fifo_size; + + /* Find nearest previous boudary */ + mod_mini_pos = mini_pos % azx_dev->core.period_bytes; + mod_link_pos = link_pos % azx_dev->core.period_bytes; + if (mod_link_pos >= fifo_size) + bound_pos = link_pos - mod_link_pos; + else if (mod_dma_pos >= mod_mini_pos) + bound_pos = mini_pos - mod_mini_pos; + else { + bound_pos = mini_pos - mod_mini_pos + azx_dev->core.period_bytes; + if (bound_pos >= azx_dev->core.bufsize) + bound_pos = 0; + } + + /* Calculate real DMA position we want */ + return bound_pos + mod_dma_pos; +} + +#ifdef CONFIG_PM +static DEFINE_MUTEX(card_list_lock); +static LIST_HEAD(card_list); + +static void azx_add_card_list(struct azx *chip) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + + mutex_lock(&card_list_lock); + list_add(&hda->list, &card_list); + mutex_unlock(&card_list_lock); +} + +static void azx_del_card_list(struct azx *chip) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + + mutex_lock(&card_list_lock); + list_del_init(&hda->list); + mutex_unlock(&card_list_lock); +} + +#else +#define azx_add_card_list(chip) /* NOP */ +#define azx_del_card_list(chip) /* NOP */ +#endif /* CONFIG_PM */ + +#if defined(CONFIG_PM_SLEEP) +/* power management */ +static int azx_suspend(struct device *dev) +{ + struct snd_card *card = dev_get_drvdata(dev); + struct azx *chip; + struct hda_ft *hda; + struct hdac_bus *bus; + + if (!card) + return 0; + + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + if (chip->disabled || !chip->running) + return 0; + + bus = azx_bus(chip); + snd_power_change_state(card, SNDRV_CTL_POWER_D3hot); + azx_clear_irq_pending(chip); + azx_stop_chip(chip); + if (bus->irq >= 0) { + free_irq(bus->irq, (void *)chip); + bus->irq = -1; + } + + return 0; +} + +static int azx_resume(struct device *dev) +{ + struct snd_card *card = dev_get_drvdata(dev); + struct azx *chip; + struct hda_ft *hda; + struct hdac_bus *bus; + int index; + struct snd_pcm_substream *substream; + struct azx_dev *azx_dev; + int err; + + if (!card) + return 0; + + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + bus = azx_bus(chip); + if (chip->disabled || !chip->running) + return 0; + + if (azx_acquire_irq(chip, 1) < 0) + return -EIO; + + index = chip->dev_index; + + snd_hdac_bus_exit_link_reset(bus); + usleep_range(1000, 1200); + + azx_init_chip(chip, 0); + + snd_power_change_state(card, SNDRV_CTL_POWER_D0); + + if (hda->substream && hda->substream->runtime) { + substream = hda->substream; + + if (substream->runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) { + substream->runtime->status->state = + substream->runtime->status->suspended_state; + err = substream->ops->prepare(substream); + if (err < 0) + return err; + } + + azx_dev = get_azx_dev(substream); + hda->substream = NULL; + } + + return 0; +} +#endif /* CONFIG_PM_SLEEP */ + +#ifdef CONFIG_PM +static int azx_runtime_suspend(struct device *dev) +{ + struct snd_card *card = dev_get_drvdata(dev); + struct azx *chip; + struct hda_ft *hda; + + if (!card) + return 0; + + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + if (chip->disabled) + return 0; + + if (!azx_has_pm_runtime(chip)) + return 0; + + azx_stop_chip(chip); + azx_enter_link_reset(chip); + azx_clear_irq_pending(chip); + + return 0; +} + +static int azx_runtime_resume(struct device *dev) +{ + struct snd_card *card = dev_get_drvdata(dev); + struct azx *chip; + struct hda_ft *hda; + struct hdac_bus *bus; + struct hda_codec *codec; + int status; + int index; + + if (!card) + return 0; + + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + bus = azx_bus(chip); + if (chip->disabled) + return 0; + + if (!azx_has_pm_runtime(chip)) + return 0; + + /* Read STATESTS before controller reset */ + status = azx_readw(chip, STATESTS); + + index = chip->dev_index; + + snd_hdac_bus_exit_link_reset(bus); + usleep_range(1000, 1200); + + azx_init_chip(chip, 0); + + if (status) { + list_for_each_codec(codec, &chip->bus) + if (status & (1 << codec->addr)) + schedule_delayed_work(&codec->jackpoll_work, + codec->jackpoll_interval); + } + + return 0; +} + +static int azx_runtime_idle(struct device *dev) +{ + struct snd_card *card = dev_get_drvdata(dev); + struct azx *chip; + struct hda_ft *hda; + + if (!card) + return 0; + + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + if (chip->disabled) + return 0; + + if (!azx_has_pm_runtime(chip) || + azx_bus(chip)->codec_powered || !chip->running) + return -EBUSY; + + return 0; +} + +static const struct dev_pm_ops azx_pm = { + SET_SYSTEM_SLEEP_PM_OPS(azx_suspend, azx_resume) + SET_RUNTIME_PM_OPS(azx_runtime_suspend, azx_runtime_resume, azx_runtime_idle) +}; + +#define hda_ft_pm (&azx_pm) +#else +#define hda_ft_pm NULL +#endif /* CONFIG_PM */ + +static int azx_probe_continue(struct azx *chip); + +/* + * destructor + */ +static int azx_free(struct azx *chip) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + struct hdac_bus *bus = azx_bus(chip); + struct platform_device *pdev = to_platform_device(hda->dev); + struct device *hddev = hda->dev; + struct resource *res; + resource_size_t size; + + if (azx_has_pm_runtime(chip) && chip->running) + pm_runtime_get_noresume(&pdev->dev); + + azx_del_card_list(chip); + + complete_all(&hda->probe_wait); + + if (bus->chip_init) { + azx_clear_irq_pending(chip); + azx_stop_all_streams(chip); + azx_stop_chip(chip); + } + + if (bus->irq >= 0) { + free_irq(bus->irq, (void*)chip); + bus->irq = -1; + } + + devm_iounmap(hddev, bus->remap_addr); + + azx_free_stream_pages(chip); + azx_free_streams(chip); + snd_hdac_bus_exit(bus); + + if (chip->region_requested){ + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + size = resource_size(res); + devm_release_mem_region(hddev, res->start, size); + } + + return 0; +} + +static int azx_dev_disconnect(struct snd_device *device) +{ + struct azx *chip = device->device_data; + + chip->bus.shutdown = 1; + return 0; +} + +static int azx_dev_free(struct snd_device *device) +{ + return azx_free(device->device_data); +} + +static int check_position_fix(struct azx *chip, int fix) +{ + switch (fix) { + case POS_FIX_AUTO: + case POS_FIX_LPIB: + case POS_FIX_POSBUF: + case POS_FIX_VIACOMBO: + case POS_FIX_COMBO: + return fix; + } + + if (chip->driver_caps & AZX_DCAPS_POSFIX_LPIB) { + dev_dbg(chip->card->dev, "Using LPIB position fix\n"); + return POS_FIX_LPIB; + } + return POS_FIX_AUTO; +} + +static void assign_position_fix(struct azx *chip, int fix) +{ + static azx_get_pos_callback_t callbacks[] = { + [POS_FIX_AUTO] = NULL, + [POS_FIX_LPIB] = azx_get_pos_lpib, + [POS_FIX_POSBUF] = azx_get_pos_posbuf, + [POS_FIX_VIACOMBO] = azx_via_get_position, + [POS_FIX_COMBO] = azx_get_pos_lpib, + }; + + chip->get_position[0] = chip->get_position[1] = callbacks[fix]; + + /* combo mode uses LPIB only for playback */ + if (fix == POS_FIX_COMBO) + chip->get_position[1] = NULL; + + if (fix == POS_FIX_POSBUF && + (chip->driver_caps & AZX_DCAPS_COUNT_LPIB_DELAY)) { + chip->get_delay[0] = chip->get_delay[1] = + azx_get_delay_from_lpib; + } + +} + +#define AZX_FORCE_CODEC_MASK 0x100 + +static void check_probe_mask(struct azx *chip, int dev) +{ + chip->codec_probe_mask = probe_mask[dev]; + + /* check forced option */ + if (chip->codec_probe_mask != -1 && + (chip->codec_probe_mask & AZX_FORCE_CODEC_MASK)) { + azx_bus(chip)->codec_mask = chip->codec_probe_mask & 0xff; + dev_info(chip->card->dev, "codec_mask forced to 0x%x\n", + (int)azx_bus(chip)->codec_mask); + } +} + +static void azx_probe_work(struct work_struct *work) +{ + struct hda_ft *hda = container_of(work, struct hda_ft, probe_work); + + azx_probe_continue(&hda->chip); +} + +/* + * constructor + */ +static const struct hda_controller_ops axi_hda_ops; + +static int hda_ft_create(struct snd_card *card, struct platform_device *pdev, + int dev, unsigned int driver_caps, + struct azx **rchip) +{ + static struct snd_device_ops ops = { + .dev_disconnect = azx_dev_disconnect, + .dev_free = azx_dev_free, + }; + struct hda_ft *hda; + struct azx *chip; + int err; + + *rchip = NULL; + + hda = devm_kzalloc(&pdev->dev, sizeof(*hda), GFP_KERNEL); + if (!hda) + return -ENOMEM; + hda->dev = &pdev->dev; + chip = &hda->chip; + mutex_init(&chip->open_mutex); + chip->card = card; + chip->ops = &axi_hda_ops; + chip->driver_caps = driver_caps; + chip->driver_type = driver_caps & 0xff; + chip->dev_index = dev; + if (jackpoll_ms[dev] >= 50 && jackpoll_ms[dev] <= 60000) + chip->jackpoll_interval = msecs_to_jiffies(jackpoll_ms[dev]); + INIT_LIST_HEAD(&chip->pcm_list); + INIT_WORK(&hda->irq_pending_work, azx_irq_pending_work); + INIT_LIST_HEAD(&hda->list); + + init_completion(&hda->probe_wait); + assign_position_fix(chip, check_position_fix(chip, position_fix[dev])); + check_probe_mask(chip, dev); + + if (single_cmd < 0) /* allow fallback to single_cmd at errors */ + chip->fallback_to_single_cmd = 0; + else /* explicitly set to single_cmd or not */ + chip->single_cmd = single_cmd; + + if (bdl_pos_adj[dev] < 0) { + switch (chip->driver_type) { + case AZX_DRIVER_FT: + bdl_pos_adj[dev] = 32; + break; + default: + bdl_pos_adj[dev] = 32; + break; + } + } + chip->bdl_pos_adj = bdl_pos_adj[dev]; + + err = azx_bus_init(chip, model[dev]); + if (err < 0) { + return err; + } + + chip->bus.core.aligned_mmio = 1; + + err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops); + if (err < 0) { + dev_err(card->dev, "Error creating device [card]!\n"); + azx_free(chip); + return err; + } + + /* continue probing in work context as may trigger request module */ + INIT_WORK(&hda->probe_work, azx_probe_work); + + *rchip = chip; + + return 0; +} + +static int azx_first_init(struct azx *chip) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + struct platform_device *pdev = to_platform_device(hda->dev); + struct device *hddev = hda->dev; + + int dev = chip->dev_index; + bool full_reset; + + struct snd_card *card = chip->card; + struct hdac_bus *bus = azx_bus(chip); + int err; + unsigned short gcap; + unsigned int dma_bits = 64; + + struct resource *res; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + hda->regs = devm_ioremap_resource(hddev, res); + if (IS_ERR(hda->regs)) + return PTR_ERR(hda->regs); + chip->region_requested = 1; + + bus->addr = res->start; + bus->remap_addr = hda->regs; + if (bus->remap_addr == NULL) { + dev_err(card->dev, "ioremap error\n"); + return -ENXIO; + } + + bus->cmd_resend = 1; + + synchronize_irq(bus->irq); + + gcap = azx_readw(chip, GCAP); + dev_dbg(card->dev, "chipset global capabilities = 0x%x\n", gcap); + + /* disable 64bit DMA address on some devices */ + if (chip->driver_caps & AZX_DCAPS_NO_64BIT) { + dev_dbg(card->dev, "Disabling 64bit DMA\n"); + gcap &= ~AZX_GCAP_64OK; + } + + /* disable buffer size rounding to 128-byte multiples if supported */ + if (align_buffer_size >= 0) + chip->align_buffer_size = !!align_buffer_size; + else { + if (chip->driver_caps & AZX_DCAPS_NO_ALIGN_BUFSIZE) + chip->align_buffer_size = 0; + else + chip->align_buffer_size = 1; + } + + err = hda_ft_dma_configure(hddev); + if (err < 0) + return err; + + /* allow 64bit DMA address if supported by H/W */ + if (!(gcap & AZX_GCAP_64OK)) + dma_bits = 32; + if (!dma_set_mask(hddev, DMA_BIT_MASK(dma_bits))) { + dma_set_coherent_mask(hddev, DMA_BIT_MASK(dma_bits)); + } else { + dma_set_mask(hddev, DMA_BIT_MASK(32)); + dma_set_coherent_mask(hddev, DMA_BIT_MASK(32)); + } + + /* read number of streams from GCAP register instead of using + * hardcoded value + */ + chip->capture_streams = (gcap >> 8) & 0x0f; + chip->playback_streams = (gcap >> 12) & 0x0f; + if (!chip->playback_streams && !chip->capture_streams) { + /* gcap didn't give any info, switching to old method */ + chip->playback_streams = FT4C_NUM_PLAYBACK; + chip->capture_streams = FT4C_NUM_CAPTURE; + } + chip->capture_index_offset = 0; + chip->playback_index_offset = chip->capture_streams; + chip->num_streams = chip->playback_streams + chip->capture_streams; + + /* initialize streams */ + err = azx_init_streams(chip); + if (err < 0) + return err; + + err = azx_alloc_stream_pages(chip); + if (err < 0) + return err; + + full_reset = (probe_only[dev] & 2) ? false : true; + azx_init_chip(chip, full_reset); + + /* codec detection */ + if (!azx_bus(chip)->codec_mask) { + dev_err(card->dev, "no codecs found!\n"); + return -ENODEV; + } + + if (azx_acquire_irq(chip, 0) < 0) + return -EBUSY; + + strcpy(card->driver, "ft-hda"); + strcpy(card->shortname, "ft-hda"); + snprintf(card->longname, sizeof(card->longname), + "%s at 0x%lx irq %i", + card->shortname, bus->addr, bus->irq); + + return 0; +} + +static void pcm_mmap_prepare(struct snd_pcm_substream *substream, + struct vm_area_struct *area) +{ + +} + +static const struct hda_controller_ops axi_hda_ops = { + .pcm_mmap_prepare = pcm_mmap_prepare, + .position_check = azx_position_check, + .link_power = azx_ft_link_power, +}; + +static DECLARE_BITMAP(probed_devs, SNDRV_CARDS); + +static int hda_ft_probe(struct platform_device *pdev) +{ + const unsigned int driver_flags = AZX_DRIVER_FT; + struct snd_card *card; + struct hda_ft *hda; + struct azx *chip; + bool schedule_probe; + int err; + int dev; + + dev = find_first_zero_bit(probed_devs, SNDRV_CARDS); + + if (dev >= SNDRV_CARDS) + return -ENODEV; + if (!enable[dev]) { + set_bit(dev, probed_devs); + return -ENOENT; + } + + err = snd_card_new(&pdev->dev, index[dev], id[dev], THIS_MODULE, + 0, &card); + if (err < 0) { + dev_err(&pdev->dev, "Error creating card!\n"); + return err; + } + + err = hda_ft_create(card, pdev,dev, driver_flags, &chip); + if (err < 0) + goto out_free; + card->private_data = chip; + hda = container_of(chip, struct hda_ft, chip); + + dev_set_drvdata(&pdev->dev, card); + + schedule_probe = !chip->disabled; + + if (schedule_probe) + schedule_work(&hda->probe_work); + + set_bit(dev, probed_devs); + if (chip->disabled) + complete_all(&hda->probe_wait); + return 0; + +out_free: + snd_card_free(card); + return err; +} + +/* number of codec slots for each chipset: 0 = default slots (i.e. 4) */ +static unsigned int azx_max_codecs[AZX_NUM_DRIVERS] = { + [AZX_DRIVER_FT] = 4, +}; + +static int azx_probe_continue(struct azx *chip) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + struct device *hddev = hda->dev; + int dev = chip->dev_index; + int err; + struct hdac_bus *bus = azx_bus(chip); + + hda->probe_continued = 1; + + err = azx_first_init(chip); + if (err < 0) + goto out_free; + +#ifdef CONFIG_SND_HDA_INPUT_BEEP + chip->beep_mode = beep_mode[dev]; +#endif + + /* create codec instances */ + err = azx_probe_codecs(chip, azx_max_codecs[chip->driver_type]); + if (err < 0) + goto out_free; + + if ((probe_only[dev] & 1) == 0) { + err = azx_codec_configure(chip); + if (err < 0) + goto out_free; + } + + err = snd_card_register(chip->card); + if (err < 0) + goto out_free; + + chip->running = 1; + azx_add_card_list(chip); + snd_hda_set_power_save(&chip->bus, power_save * 1000); + + if (azx_has_pm_runtime(chip)) + pm_runtime_put_noidle(hddev); + return err; + +out_free: + if (bus->irq >= 0) { + free_irq(bus->irq, (void *)chip); + bus->irq = -1; + } + return err; +} + +static int hda_ft_remove(struct platform_device *pdev) +{ + struct snd_card *card = dev_get_drvdata(&pdev->dev); + struct azx *chip; + struct hda_ft *hda; + + if (card) { + /* cancel the pending probing work */ + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + cancel_work_sync(&hda->probe_work); + clear_bit(chip->dev_index, probed_devs); + + snd_card_free(card); + return 0; + } + return 0; +} + +static void hda_ft_shutdown(struct platform_device *pdev) +{ + struct snd_card *card = dev_get_drvdata(&pdev->dev); + struct azx *chip; + + if (!card) + return; + chip = card->private_data; + if (chip && chip->running) + azx_stop_chip(chip); +} + +static const struct of_device_id hda_ft_of_match[] = { + { .compatible = "phytium,hda" }, + {}, +}; +MODULE_DEVICE_TABLE(of, hda_ft_of_match); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id hda_ft_acpi_match[] = { + { .id = "PHYT0006" }, + {} +}; +MODULE_DEVICE_TABLE(acpi, hda_ft_acpi_match); +#else +#define hda_ft_acpi_match NULL +#endif + +static struct platform_driver ft_platform_hda = { + .driver = { + .name = "ft-hda", + .pm = hda_ft_pm, + .of_match_table = hda_ft_of_match, + .acpi_match_table = hda_ft_acpi_match, + }, + .probe = hda_ft_probe, + .remove = hda_ft_remove, + .shutdown = hda_ft_shutdown, +}; + +module_platform_driver(ft_platform_hda); + +MODULE_DESCRIPTION("FT HDA bus driver"); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/hda_phytium.h b/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/hda_phytium.h new file mode 100644 index 0000000000000000000000000000000000000000..ec1f3e7f7b9cfa52ca5af33a376214efd2fb7947 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/pci/hda/hda_phytium.h @@ -0,0 +1,34 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Implementation of primary ALSA driver code base for Phytium HD Audio. + * + * Copyright (c) 2018-2024 Phytium Technology Co., Ltd. + */ +#ifndef __SOUND_HDA_PHYTIUM_H__ +#define __SOUND_HDA_PHYTIUM_H__ + +#include "hda_controller.h" + +struct hda_ft { + struct azx chip; + struct snd_pcm_substream *substream; + struct device *dev; + void __iomem *regs; + + /* for pending irqs */ + struct work_struct irq_pending_work; + + /* sync probing */ + struct completion probe_wait; + struct work_struct probe_work; + + /* card list (for power_save trigger) */ + struct list_head list; + + /* extra flags */ + unsigned int irq_pending_warned:1; + unsigned int probe_continued:1; + +}; + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..2ab9eefb8c73190e19b3cf4f28e93425d0c39595 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/Kconfig @@ -0,0 +1,9 @@ +# SPDX-License-Identifier: GPL-2.0-only +# +# SoC audio configuration +# + +source "sound/soc/phytium/Kconfig" +# Supported codecs +source "sound/soc/codecs/Kconfig" + diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..d9aee6b5dac3d2d1bf5d7cb845cb5e95c17d88fe --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/Kconfig @@ -0,0 +1,18 @@ +# SPDX-License-Identifier: GPL-2.0-only +# Helper to resolve issues with configs that have SPI enabled but I2C +# modular, meaning we can't build the codec driver in with I2C support. +# We use an ordered list of conditional defaults to pick the appropriate +# setting - SPI can't be modular so that case doesn't need to be covered. + +menu "CODEC drivers" + +config SND_SOC_ES8336 + tristate "Everest Semi ES8336 CODEC" + depends on I2C + select GPIO_PHYTIUM_PCI + +config SND_SOC_ES8388 + tristate "Everest Semi ES8388 CODEC" + depends on I2C + +endmenu diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/Makefile b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..07ee92fca5ff0b664c00e6984dea8f66e8c343d6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/Makefile @@ -0,0 +1,9 @@ +# SPDX-License-Identifier: GPL-2.0 + +snd-soc-es8336-objs := es8336.o +snd-soc-es8388-objs := es8388.o + +obj-$(CONFIG_SND_SOC_ES8336) += snd-soc-es8336.o +obj-$(CONFIG_SND_SOC_ES8388) += snd-soc-es8388.o + + diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8336.c b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8336.c new file mode 100644 index 0000000000000000000000000000000000000000..719b7de0e37bc3c1d3973afce4358c5f01746784 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8336.c @@ -0,0 +1,1081 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * es8336.c -- es8336 ALSA SoC audio driver + * Copyright Everest Semiconductor Co.,Ltd + * Phytium Information Technology Co.,Ltd + * + * Author: David Yang + * Yiqun Zhang + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "es8336.h" + +static struct snd_soc_component *es8336_component; + +static const struct reg_default es8336_reg_defaults[] = { + {0x00, 0x03}, {0x01, 0x03}, {0x02, 0x00}, {0x03, 0x20}, + {0x04, 0x11}, {0x05, 0x00}, {0x06, 0x11}, {0x07, 0x00}, + {0x08, 0x00}, {0x09, 0x01}, {0x0a, 0x00}, {0x0b, 0x00}, + {0x0c, 0xf8}, {0x0d, 0x3f}, {0x0e, 0x00}, {0x0f, 0x00}, + {0x10, 0x01}, {0x11, 0xfc}, {0x12, 0x28}, {0x13, 0x00}, + {0x14, 0x00}, {0x15, 0x33}, {0x16, 0x00}, {0x17, 0x00}, + {0x18, 0x88}, {0x19, 0x06}, {0x1a, 0x22}, {0x1b, 0x03}, + {0x1c, 0x0f}, {0x1d, 0x00}, {0x1e, 0x80}, {0x1f, 0x80}, + {0x20, 0x00}, {0x21, 0x00}, {0x22, 0xc0}, {0x23, 0x00}, + {0x24, 0x01}, {0x25, 0x08}, {0x26, 0x10}, {0x27, 0xc0}, + {0x28, 0x00}, {0x29, 0x1c}, {0x2a, 0x00}, {0x2b, 0xb0}, + {0x2c, 0x32}, {0x2d, 0x03}, {0x2e, 0x00}, {0x2f, 0x11}, + {0x30, 0x10}, {0x31, 0x00}, {0x32, 0x00}, {0x33, 0xc0}, + {0x34, 0xc0}, {0x35, 0x1f}, {0x36, 0xf7}, {0x37, 0xfd}, + {0x38, 0xff}, {0x39, 0x1f}, {0x3a, 0xf7}, {0x3b, 0xfd}, + {0x3c, 0xff}, {0x3d, 0x1f}, {0x3e, 0xf7}, {0x3f, 0xfd}, + {0x40, 0xff}, {0x41, 0x1f}, {0x42, 0xf7}, {0x43, 0xfd}, + {0x44, 0xff}, {0x45, 0x1f}, {0x46, 0xf7}, {0x47, 0xfd}, + {0x48, 0xff}, {0x49, 0x1f}, {0x4a, 0xf7}, {0x4b, 0xfd}, + {0x4c, 0xff}, {0x4d, 0x00}, {0x4e, 0x00}, {0x4f, 0xff}, + {0x50, 0x00}, {0x51, 0x00}, {0x52, 0x00}, {0x53, 0x00}, +}; + +/* codec private data */ +struct es8336_priv { + struct regmap *regmap; + unsigned int dmic_amic; + unsigned int sysclk; + struct snd_pcm_hw_constraint_list *sysclk_constraints; + struct clk *mclk; + int debounce_time; + struct delayed_work work; + + struct gpio_desc *spk_ctl_gpio; + struct gpio_desc *hp_det_gpio; + bool muted; + bool hp_inserted; + + u8 mic_src; + int pwr_count; +}; + +/* + * es8336_reset + * write value 0xff to reg0x00, the chip will be in reset mode + * then, writer 0x00 to reg0x00, unreset the chip + */ +static int es8336_reset(struct snd_soc_component *component) +{ + snd_soc_component_write(component, ES8336_RESET_REG00, 0x3F); + usleep_range(5000, 5500); + return snd_soc_component_write(component, ES8336_RESET_REG00, 0x03); +} + +static void es8336_enable_spk(struct es8336_priv *es8336, bool enable) +{ + gpiod_set_value(es8336->spk_ctl_gpio, enable); +} + +static const DECLARE_TLV_DB_SCALE(dac_vol_tlv, -9600, 50, 1); +static const DECLARE_TLV_DB_SCALE(adc_vol_tlv, -9600, 50, 1); +static const DECLARE_TLV_DB_SCALE(hpmixer_gain_tlv, -1200, 150, 0); +static const DECLARE_TLV_DB_SCALE(mic_bst_tlv, 0, 1200, 0); + +static unsigned int linin_pga_tlv[] = { + TLV_DB_RANGE_HEAD(9), + 0, 0, TLV_DB_SCALE_ITEM(0, 0, 0), + 1, 1, TLV_DB_SCALE_ITEM(300, 0, 0), + 2, 2, TLV_DB_SCALE_ITEM(600, 0, 0), + 3, 3, TLV_DB_SCALE_ITEM(900, 0, 0), + 4, 4, TLV_DB_SCALE_ITEM(1200, 0, 0), + 5, 5, TLV_DB_SCALE_ITEM(1500, 0, 0), + 6, 6, TLV_DB_SCALE_ITEM(1800, 0, 0), + 7, 7, TLV_DB_SCALE_ITEM(2100, 0, 0), + 8, 8, TLV_DB_SCALE_ITEM(2400, 0, 0), +}; + +static unsigned int hpout_vol_tlv[] = { + TLV_DB_RANGE_HEAD(1), + 0, 3, TLV_DB_SCALE_ITEM(-4800, 1200, 0), +}; + +static const char *const alc_func_txt[] = { "Off", "On" }; + +static const struct soc_enum alc_func = + SOC_ENUM_SINGLE(ES8336_ADC_ALC1_REG29, 6, 2, alc_func_txt); + +static const char *const ng_type_txt[] = { + "Constant PGA Gain", "Mute ADC Output" }; + +static const struct soc_enum ng_type = + SOC_ENUM_SINGLE(ES8336_ADC_ALC6_REG2E, 6, 2, ng_type_txt); + +static const char *const adcpol_txt[] = { "Normal", "Invert" }; + +static const struct soc_enum adcpol = + SOC_ENUM_SINGLE(ES8336_ADC_MUTE_REG26, 1, 2, adcpol_txt); + +static const char *const dacpol_txt[] = { + "Normal", "R Invert", "L Invert", "L + R Invert" }; + +static const struct soc_enum dacpol = + SOC_ENUM_SINGLE(ES8336_DAC_SET1_REG30, 0, 4, dacpol_txt); + +static const struct snd_kcontrol_new es8336_snd_controls[] = { + /* HP OUT VOLUME */ + SOC_DOUBLE_TLV("HP Playback Volume", ES8336_CPHP_ICAL_VOL_REG18, + 4, 0, 4, 1, hpout_vol_tlv), + /* HPMIXER VOLUME Control */ + SOC_DOUBLE_TLV("HPMixer Gain", ES8336_HPMIX_VOL_REG16, + 0, 4, 7, 0, hpmixer_gain_tlv), + + /* DAC Digital controls */ + SOC_DOUBLE_R_TLV("DAC Playback Volume", ES8336_DAC_VOLL_REG33, + ES8336_DAC_VOLR_REG34, 0, 0xC0, 1, dac_vol_tlv), + + SOC_SINGLE("Enable DAC Soft Ramp", ES8336_DAC_SET1_REG30, 4, 1, 1), + SOC_SINGLE("DAC Soft Ramp Rate", ES8336_DAC_SET1_REG30, 2, 4, 0), + + SOC_ENUM("Playback Polarity", dacpol), + SOC_SINGLE("DAC Notch Filter", ES8336_DAC_SET2_REG31, 6, 1, 0), + SOC_SINGLE("DAC Double Fs Mode", ES8336_DAC_SET2_REG31, 7, 1, 0), + SOC_SINGLE("DAC Volume Control-LeR", ES8336_DAC_SET2_REG31, 2, 1, 0), + SOC_SINGLE("DAC Stereo Enhancement", ES8336_DAC_SET3_REG32, 0, 7, 0), + + /* +20dB D2SE PGA Control */ + SOC_SINGLE_TLV("MIC Boost", ES8336_ADC_D2SEPGA_REG24, + 0, 1, 0, mic_bst_tlv), + /* 0-+24dB Lineinput PGA Control */ + SOC_SINGLE_TLV("Input PGA", ES8336_ADC_PGAGAIN_REG23, + 4, 8, 0, linin_pga_tlv), +}; + +/* Analog Input MUX */ +static const char * const es8336_analog_in_txt[] = { + "lin1-rin1", + "lin2-rin2", + "lin1-rin1 with 15db Boost", + "lin2-rin2 with 15db Boost" +}; + +static const unsigned int es8336_analog_in_values[] = { 0, 1, 2, 3 }; + +static const struct soc_enum es8336_analog_input_enum = + SOC_VALUE_ENUM_SINGLE(ES8336_ADC_PDN_LINSEL_REG22, 4, 3, + ARRAY_SIZE(es8336_analog_in_txt), + es8336_analog_in_txt, + es8336_analog_in_values); + +static const struct snd_kcontrol_new es8336_analog_in_mux_controls = + SOC_DAPM_ENUM("Route", es8336_analog_input_enum); + +/* Dmic MUX */ +static const char * const es8336_dmic_txt[] = { + "dmic disable", + "dmic data at high level", + "dmic data at low level", +}; + +static const unsigned int es8336_dmic_values[] = { 0, 2, 3 }; + +static const struct soc_enum es8336_dmic_src_enum = + SOC_VALUE_ENUM_SINGLE(ES8336_ADC_DMIC_REG25, 0, 3, + ARRAY_SIZE(es8336_dmic_txt), + es8336_dmic_txt, + es8336_dmic_values); + +static const struct snd_kcontrol_new es8336_dmic_src_controls = + SOC_DAPM_ENUM("Route", es8336_dmic_src_enum); + +/* hp mixer mux */ +static const char *const es8336_hpmux_texts[] = { + "lin1-rin1", + "lin2-rin2", + "lin-rin with Boost", + "lin-rin with Boost and PGA" +}; + +static const unsigned int es8336_hpmux_values[] = { 0, 1, 2, 3 }; + +static const struct soc_enum es8336_left_hpmux_enum = + SOC_VALUE_ENUM_SINGLE(ES8336_HPMIX_SEL_REG13, 4, 7, + ARRAY_SIZE(es8336_hpmux_texts), + es8336_hpmux_texts, + es8336_hpmux_values); + +static const struct snd_kcontrol_new es8336_left_hpmux_controls = + SOC_DAPM_ENUM("Route", es8336_left_hpmux_enum); + +static const struct soc_enum es8336_right_hpmux_enum = + SOC_VALUE_ENUM_SINGLE(ES8336_HPMIX_SEL_REG13, 0, 7, + ARRAY_SIZE(es8336_hpmux_texts), + es8336_hpmux_texts, + es8336_hpmux_values); + +static const struct snd_kcontrol_new es8336_right_hpmux_controls = + SOC_DAPM_ENUM("Route", es8336_right_hpmux_enum); + +/* headphone Output Mixer */ +static const struct snd_kcontrol_new es8336_out_left_mix[] = { + SOC_DAPM_SINGLE("LLIN Switch", ES8336_HPMIX_SWITCH_REG14, + 6, 1, 0), + SOC_DAPM_SINGLE("Left DAC Switch", ES8336_HPMIX_SWITCH_REG14, + 7, 1, 0), +}; + +static const struct snd_kcontrol_new es8336_out_right_mix[] = { + SOC_DAPM_SINGLE("RLIN Switch", ES8336_HPMIX_SWITCH_REG14, + 2, 1, 0), + SOC_DAPM_SINGLE("Right DAC Switch", ES8336_HPMIX_SWITCH_REG14, + 3, 1, 0), +}; + +/* DAC data source mux */ +static const char * const es8336_dacsrc_texts[] = { + "LDATA TO LDAC, RDATA TO RDAC", + "LDATA TO LDAC, LDATA TO RDAC", + "RDATA TO LDAC, RDATA TO RDAC", + "RDATA TO LDAC, LDATA TO RDAC", +}; + +static const unsigned int es8336_dacsrc_values[] = { 0, 1, 2, 3 }; + +static const struct soc_enum es8336_dacsrc_mux_enum = + SOC_VALUE_ENUM_SINGLE(ES8336_DAC_SET1_REG30, 6, 4, + ARRAY_SIZE(es8336_dacsrc_texts), + es8336_dacsrc_texts, + es8336_dacsrc_values); +static const struct snd_kcontrol_new es8336_dacsrc_mux_controls = + SOC_DAPM_ENUM("Route", es8336_dacsrc_mux_enum); + +static const struct snd_soc_dapm_widget es8336_dapm_widgets[] = { + /* Input Lines */ + SND_SOC_DAPM_INPUT("DMIC"), + SND_SOC_DAPM_INPUT("MIC1"), + SND_SOC_DAPM_INPUT("MIC2"), + + SND_SOC_DAPM_MICBIAS("micbias", SND_SOC_NOPM, + 0, 0), + /* Input MUX */ + SND_SOC_DAPM_MUX("Differential Mux", SND_SOC_NOPM, 0, 0, + &es8336_analog_in_mux_controls), + + SND_SOC_DAPM_PGA("Line input PGA", ES8336_ADC_PDN_LINSEL_REG22, + 7, 1, NULL, 0), + + /* ADCs */ + SND_SOC_DAPM_ADC("Mono ADC", NULL, ES8336_ADC_PDN_LINSEL_REG22, 6, 1), + + /* Dmic MUX */ + SND_SOC_DAPM_MUX("Digital Mic Mux", SND_SOC_NOPM, 0, 0, + &es8336_dmic_src_controls), + + /* Digital Interface */ + SND_SOC_DAPM_AIF_OUT("I2S OUT", "I2S1 Capture", 1, + SND_SOC_NOPM, 0, 0), + + SND_SOC_DAPM_AIF_IN("I2S IN", "I2S1 Playback", 0, + SND_SOC_NOPM, 0, 0), + + /* DACs DATA SRC MUX */ + SND_SOC_DAPM_MUX("DAC SRC Mux", SND_SOC_NOPM, 0, 0, + &es8336_dacsrc_mux_controls), + /* DACs */ + SND_SOC_DAPM_DAC("Right DAC", NULL, ES8336_DAC_PDN_REG2F, 0, 1), + SND_SOC_DAPM_DAC("Left DAC", NULL, ES8336_DAC_PDN_REG2F, 4, 1), + + /* Headphone Output Side */ + /* hpmux for hp mixer */ + SND_SOC_DAPM_MUX("Left Hp mux", SND_SOC_NOPM, 0, 0, + &es8336_left_hpmux_controls), + SND_SOC_DAPM_MUX("Right Hp mux", SND_SOC_NOPM, 0, 0, + &es8336_right_hpmux_controls), + /* Output mixer */ + SND_SOC_DAPM_MIXER("Left Hp mixer", ES8336_HPMIX_PDN_REG15, + 4, 1, &es8336_out_left_mix[0], + ARRAY_SIZE(es8336_out_left_mix)), + SND_SOC_DAPM_MIXER("Right Hp mixer", ES8336_HPMIX_PDN_REG15, + 0, 1, &es8336_out_right_mix[0], + ARRAY_SIZE(es8336_out_right_mix)), + SND_SOC_DAPM_MIXER("Left Hp mixer2", SND_SOC_NOPM, + 4, 1, &es8336_out_left_mix[0], + ARRAY_SIZE(es8336_out_left_mix)), + SND_SOC_DAPM_MIXER("Right Hp mixer2", SND_SOC_NOPM, + 0, 1, &es8336_out_right_mix[0], + ARRAY_SIZE(es8336_out_right_mix)), + + /* Output charge pump */ + SND_SOC_DAPM_PGA("HPCP L", ES8336_CPHP_OUTEN_REG17, + 6, 0, NULL, 0), + SND_SOC_DAPM_PGA("HPCP R", ES8336_CPHP_OUTEN_REG17, + 2, 0, NULL, 0), + + /* Output Driver */ + SND_SOC_DAPM_PGA("HPVOL L", ES8336_CPHP_OUTEN_REG17, + 5, 0, NULL, 0), + SND_SOC_DAPM_PGA("HPVOL R", ES8336_CPHP_OUTEN_REG17, + 1, 0, NULL, 0), + /* Output Lines */ + SND_SOC_DAPM_OUTPUT("HPOL"), + SND_SOC_DAPM_OUTPUT("HPOR"), +}; + +static const struct snd_soc_dapm_route es8336_dapm_routes[] = { + /* + * record route map + */ + {"MIC1", NULL, "micbias"}, + {"MIC2", NULL, "micbias"}, + {"DMIC", NULL, "micbias"}, + + {"Differential Mux", "lin1-rin1", "MIC1"}, + {"Differential Mux", "lin2-rin2", "MIC2"}, + {"Differential Mux", "lin1-rin1 with 15db Boost", "MIC1"}, + {"Differential Mux", "lin2-rin2 with 15db Boost", "MIC2"}, + {"Line input PGA", NULL, "Differential Mux"}, + + {"Mono ADC", NULL, "Line input PGA"}, + + {"Digital Mic Mux", "dmic disable", "Mono ADC"}, + {"Digital Mic Mux", "dmic data at high level", "DMIC"}, + {"Digital Mic Mux", "dmic data at low level", "DMIC"}, + + {"I2S OUT", NULL, "Digital Mic Mux"}, + /* + * playback route map + */ + {"DAC SRC Mux", "LDATA TO LDAC, RDATA TO RDAC", "I2S IN"}, + {"DAC SRC Mux", "LDATA TO LDAC, LDATA TO RDAC", "I2S IN"}, + {"DAC SRC Mux", "RDATA TO LDAC, RDATA TO RDAC", "I2S IN"}, + {"DAC SRC Mux", "RDATA TO LDAC, LDATA TO RDAC", "I2S IN"}, + + {"Left DAC", NULL, "DAC SRC Mux"}, + {"Right DAC", NULL, "DAC SRC Mux"}, + + {"Left Hp mux", "lin1-rin1", "MIC1"}, + {"Left Hp mux", "lin2-rin2", "MIC2"}, + {"Left Hp mux", "lin-rin with Boost", "Differential Mux"}, + {"Left Hp mux", "lin-rin with Boost and PGA", "Line input PGA"}, + + {"Right Hp mux", "lin1-rin1", "MIC1"}, + {"Right Hp mux", "lin2-rin2", "MIC2"}, + {"Right Hp mux", "lin-rin with Boost", "Differential Mux"}, + {"Right Hp mux", "lin-rin with Boost and PGA", "Line input PGA"}, + + {"Left Hp mixer", "LLIN Switch", "Left Hp mux"}, + {"Left Hp mixer", "Left DAC Switch", "Left DAC"}, + + {"Right Hp mixer", "RLIN Switch", "Right Hp mux"}, + {"Right Hp mixer", "Right DAC Switch", "Right DAC"}, + + {"HPCP L", NULL, "Left Hp mixer"}, + {"HPCP R", NULL, "Right Hp mixer"}, + + {"HPVOL L", NULL, "HPCP L"}, + {"HPVOL R", NULL, "HPCP R"}, + + {"HPOL", NULL, "HPVOL L"}, + {"HPOR", NULL, "HPVOL R"}, +}; + + +/* The set of rates we can generate from the above for each SYSCLK */ + +static unsigned int rates_12288[] = { + 8000, 12000, 16000, 24000, 24000, 32000, 48000, 96000, +}; + +static struct snd_pcm_hw_constraint_list constraints_12288 = { + .count = ARRAY_SIZE(rates_12288), + .list = rates_12288, +}; + +static unsigned int rates_112896[] = { + 8000, 11025, 22050, 44100, +}; + +static struct snd_pcm_hw_constraint_list constraints_112896 = { + .count = ARRAY_SIZE(rates_112896), + .list = rates_112896, +}; + +static unsigned int rates_12[] = { + 8000, 11025, 12000, 16000, 22050, 24000, 32000, 44100, 48000, + 48000, 88235, 96000, +}; + +static struct snd_pcm_hw_constraint_list constraints_12 = { + .count = ARRAY_SIZE(rates_12), + .list = rates_12, +}; + +/* + * Note that this should be called from init rather than from hw_params. + */ +static int es8336_set_dai_sysclk(struct snd_soc_dai *codec_dai, + int clk_id, unsigned int freq, int dir) +{ + struct snd_soc_component *component = codec_dai->component; + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + + switch (freq) { + case 11289600: + case 18432000: + case 22579200: + case 36864000: + es8336->sysclk_constraints = &constraints_112896; + es8336->sysclk = freq; + return 0; + case 12288000: + case 19200000: + case 16934400: + case 24576000: + case 33868800: + es8336->sysclk_constraints = &constraints_12288; + es8336->sysclk = freq; + return 0; + case 12000000: + case 24000000: + es8336->sysclk_constraints = &constraints_12; + es8336->sysclk = freq; + return 0; + } + + return 0; +} + +static int es8336_set_dai_fmt(struct snd_soc_dai *codec_dai, + unsigned int fmt) +{ + struct snd_soc_component *component = codec_dai->component; + u8 iface = 0; + u8 adciface = 0; + u8 daciface = 0; + + iface = snd_soc_component_read(component, ES8336_IFACE); + adciface = snd_soc_component_read(component, ES8336_ADC_IFACE); + daciface = snd_soc_component_read(component, ES8336_DAC_IFACE); + + /* set master/slave audio interface */ + switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { + case SND_SOC_DAIFMT_CBM_CFM: + iface |= 0x80; + break; + case SND_SOC_DAIFMT_CBS_CFS: + iface &= 0x7F; + break; + default: + return -EINVAL; + } + + /* interface format */ + switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { + case SND_SOC_DAIFMT_I2S: + adciface &= 0xFC; + daciface &= 0xFC; + break; + case SND_SOC_DAIFMT_RIGHT_J: + return -EINVAL; + case SND_SOC_DAIFMT_LEFT_J: + adciface &= 0xFC; + daciface &= 0xFC; + adciface |= 0x01; + daciface |= 0x01; + break; + case SND_SOC_DAIFMT_DSP_A: + adciface &= 0xDC; + daciface &= 0xDC; + adciface |= 0x03; + daciface |= 0x03; + break; + case SND_SOC_DAIFMT_DSP_B: + adciface &= 0xDC; + daciface &= 0xDC; + adciface |= 0x23; + daciface |= 0x23; + break; + default: + return -EINVAL; + } + + /* clock inversion */ + switch (fmt & SND_SOC_DAIFMT_INV_MASK) { + case SND_SOC_DAIFMT_NB_NF: + iface &= 0xDF; + adciface &= 0xDF; + daciface &= 0xDF; + break; + case SND_SOC_DAIFMT_IB_IF: + iface |= 0x20; + adciface |= 0x20; + daciface |= 0x20; + break; + case SND_SOC_DAIFMT_IB_NF: + iface |= 0x20; + adciface &= 0xDF; + daciface &= 0xDF; + break; + case SND_SOC_DAIFMT_NB_IF: + iface &= 0xDF; + adciface |= 0x20; + daciface |= 0x20; + break; + default: + return -EINVAL; + } + snd_soc_component_write(component, ES8336_IFACE, iface); + snd_soc_component_write(component, ES8336_ADC_IFACE, adciface); + snd_soc_component_write(component, ES8336_DAC_IFACE, daciface); + return 0; +} + +static int es8336_pcm_startup(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct snd_soc_component *component = dai->component; + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + bool playback = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK); + + snd_soc_component_write(component, ES8336_RESET_REG00, 0xC0); + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); + /* es8336: both playback and capture need dac mclk */ + snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, + ES8336_CLKMGR_MCLK_DIV_MASK | + ES8336_CLKMGR_DAC_MCLK_MASK, + ES8336_CLKMGR_MCLK_DIV_NML | + ES8336_CLKMGR_DAC_MCLK_EN); + es8336->pwr_count++; + + if (playback) { + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x3F); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x1F); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x88); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0xBB); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x10); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x30); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x02); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x00); + snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x66); + snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, + ES8336_CLKMGR_DAC_MCLK_MASK | + ES8336_CLKMGR_DAC_ANALOG_MASK, + ES8336_CLKMGR_DAC_MCLK_EN | + ES8336_CLKMGR_DAC_ANALOG_EN); + msleep(50); + } else { + snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0x00); + snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, + ES8336_CLKMGR_ADC_MCLK_MASK | + ES8336_CLKMGR_ADC_ANALOG_MASK, + ES8336_CLKMGR_ADC_MCLK_EN | + ES8336_CLKMGR_ADC_ANALOG_EN); + } + + return 0; +} + +static void es8336_pcm_shutdown(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct snd_soc_component *component = dai->component; + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + bool playback = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK); + + if (playback) { + snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); + snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, + ES8336_CLKMGR_DAC_ANALOG_MASK, + ES8336_CLKMGR_DAC_ANALOG_DIS); + } else { + snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xc0); + snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, + ES8336_CLKMGR_ADC_MCLK_MASK | + ES8336_CLKMGR_ADC_ANALOG_MASK, + ES8336_CLKMGR_ADC_MCLK_DIS | + ES8336_CLKMGR_ADC_ANALOG_DIS); + } + + if (--es8336->pwr_count == 0) { + if (!es8336->hp_inserted) + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); + snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); + } +} + + +static int es8336_pcm_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params, + struct snd_soc_dai *dai) +{ + struct snd_soc_component *component = dai->component; + int val = 0; + + switch (params_format(params)) { + case SNDRV_PCM_FORMAT_S16_LE: + val = ES8336_DACWL_16; + break; + case SNDRV_PCM_FORMAT_S20_3LE: + val = ES8336_DACWL_20; + break; + case SNDRV_PCM_FORMAT_S24_LE: + val = ES8336_DACWL_24; + break; + case SNDRV_PCM_FORMAT_S32_LE: + val = ES8336_DACWL_32; + break; + default: + val = ES8336_DACWL_16; + break; + } + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + snd_soc_component_update_bits(component, ES8336_SDP_DACFMT_REG0B, + ES8336_DACWL_MASK, val); + else + snd_soc_component_update_bits(component, ES8336_SDP_ADCFMT_REG0A, + ES8336_ADCWL_MASK, val); + + return 0; +} + +static int es8336_mute(struct snd_soc_dai *dai, int mute, int direction) +{ + struct snd_soc_component *component = dai->component; + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + + es8336->muted = mute; + + if (mute) { + es8336_enable_spk(es8336, false); + msleep(100); + snd_soc_component_write(component, ES8336_DAC_SET1_REG30, 0x20); + } + + snd_soc_component_write(component, ES8336_DAC_SET1_REG30, 0x00); + msleep(130); + + if (!es8336->hp_inserted) + es8336_enable_spk(es8336, true); + + return 0; +} + +static int es8336_set_bias_level(struct snd_soc_component *component, + enum snd_soc_bias_level level) +{ + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + + switch (level) { + case SND_SOC_BIAS_ON: + break; + + case SND_SOC_BIAS_PREPARE: + break; + + case SND_SOC_BIAS_STANDBY: + break; + + case SND_SOC_BIAS_OFF: + snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); + snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); + if (!es8336->hp_inserted) + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x3F); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x1F); + snd_soc_component_write(component, ES8336_RESET_REG00, 0x00); + break; + } + + return 0; +} + +#define es8336_RATES SNDRV_PCM_RATE_8000_96000 + +#define es8336_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ + SNDRV_PCM_FMTBIT_S24_LE) + +static const struct snd_soc_dai_ops es8336_ops = { + .startup = es8336_pcm_startup, + .hw_params = es8336_pcm_hw_params, + .set_fmt = es8336_set_dai_fmt, + .set_sysclk = es8336_set_dai_sysclk, + .mute_stream = es8336_mute, + .shutdown = es8336_pcm_shutdown, +}; + +static struct snd_soc_dai_driver es8336_dai = { + .name = "es8336-hifi", + .playback = { + .stream_name = "Playback", + .channels_min = 1, + .channels_max = 2, + .rates = es8336_RATES, + .formats = es8336_FORMATS, + }, + .capture = { + .stream_name = "Capture", + .channels_min = 1, + .channels_max = 2, + .rates = es8336_RATES, + .formats = es8336_FORMATS, + }, + .ops = &es8336_ops, + .symmetric_rates = 1, +}; + +static int es8336_init_regs(struct snd_soc_component *component) +{ + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + snd_soc_component_write(component, ES8336_RESET_REG00, 0x3f); + usleep_range(5000, 5500); + snd_soc_component_write(component, ES8336_RESET_REG00, 0x00); + snd_soc_component_write(component, ES8336_SYS_VMIDSEL_REG0C, 0xFF); + msleep(30); + snd_soc_component_write(component, ES8336_CLKMGR_CLKSEL_REG02, 0x08); + snd_soc_component_write(component, ES8336_CLKMGR_ADCOSR_REG03, 0x20); + snd_soc_component_write(component, ES8336_CLKMGR_ADCDIV1_REG04, 0x11); + snd_soc_component_write(component, ES8336_CLKMGR_ADCDIV2_REG05, 0x00); + snd_soc_component_write(component, ES8336_CLKMGR_DACDIV1_REG06, 0x11); + snd_soc_component_write(component, ES8336_CLKMGR_DACDIV2_REG07, 0x00); + snd_soc_component_write(component, ES8336_CLKMGR_CPDIV_REG08, 0x00); + snd_soc_component_write(component, ES8336_SDP_MS_BCKDIV_REG09, 0x04); + snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0x7F); + snd_soc_component_write(component, ES8336_CAL_TYPE_REG1C, 0x0F); + snd_soc_component_write(component, ES8336_CAL_HPLIV_REG1E, 0x90); + snd_soc_component_write(component, ES8336_CAL_HPRIV_REG1F, 0x90); + snd_soc_component_write(component, ES8336_ADC_VOLUME_REG27, 0x00); + snd_soc_component_write(component, ES8336_ADC_PDN_LINSEL_REG22, es8336->mic_src); + snd_soc_component_write(component, ES8336_ADC_D2SEPGA_REG24, 0x00); + snd_soc_component_write(component, ES8336_ADC_DMIC_REG25, 0x08); + snd_soc_component_write(component, ES8336_DAC_SET2_REG31, 0x20); + snd_soc_component_write(component, ES8336_DAC_SET3_REG32, 0x00); + snd_soc_component_write(component, ES8336_DAC_VOLL_REG33, 0x00); + snd_soc_component_write(component, ES8336_DAC_VOLR_REG34, 0x00); + snd_soc_component_write(component, ES8336_SDP_ADCFMT_REG0A, 0x00); + snd_soc_component_write(component, ES8336_SDP_DACFMT_REG0B, 0x00); + snd_soc_component_write(component, ES8336_SYS_VMIDLOW_REG10, 0x11); + snd_soc_component_write(component, ES8336_SYS_VSEL_REG11, 0xFC); + snd_soc_component_write(component, ES8336_SYS_REF_REG12, 0x28); + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x04); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x0C); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); + snd_soc_component_write(component, ES8336_HPMIX_SEL_REG13, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x88); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0xBB); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x10); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x30); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x02); + snd_soc_component_write(component, ES8336_CPHP_ICAL_VOL_REG18, 0x00); + snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); + snd_soc_component_write(component, ES8336_GPIO_DEBUNCE_INT_REG4E, 0x02); + snd_soc_component_write(component, ES8336_TESTMODE_REG50, 0xA0); + snd_soc_component_write(component, ES8336_TEST1_REG51, 0x00); + snd_soc_component_write(component, ES8336_TEST2_REG52, 0x00); + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); + snd_soc_component_write(component, ES8336_RESET_REG00, 0xC0); + msleep(50); + snd_soc_component_write(component, ES8336_ADC_PGAGAIN_REG23, 0x60); + snd_soc_component_write(component, ES8336_ADC_D2SEPGA_REG24, 0x01); + /* adc ds mode, HPF enable */ + snd_soc_component_write(component, ES8336_ADC_DMIC_REG25, 0x08); + snd_soc_component_write(component, ES8336_ADC_ALC1_REG29, 0xcd); + snd_soc_component_write(component, ES8336_ADC_ALC2_REG2A, 0x08); + snd_soc_component_write(component, ES8336_ADC_ALC3_REG2B, 0xa0); + snd_soc_component_write(component, ES8336_ADC_ALC4_REG2C, 0x05); + snd_soc_component_write(component, ES8336_ADC_ALC5_REG2D, 0x06); + snd_soc_component_write(component, ES8336_ADC_ALC6_REG2E, 0x61); + return 0; +} + +static int es8336_suspend(struct snd_soc_component *component) +{ + return 0; +} + +static int es8336_resume(struct snd_soc_component *component) +{ + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + int ret; + + es8336_reset(component); /* UPDATED BY DAVID,15-3-5 */ + ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); + if (!ret) { + es8336_init_regs(component); + snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); + /* max debance time, enable interrupt, low active */ + snd_soc_component_write(component, ES8336_GPIO_DEBUNCE_INT_REG4E, 0xf3); + /* es8336_set_bias_level(component, SND_SOC_BIAS_OFF); */ + snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); + if (!es8336->hp_inserted) + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); + snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); + snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); + } + return 0; +} + +static irqreturn_t es8336_irq_handler(int irq, void *data) +{ + struct es8336_priv *es8336 = data; + + queue_delayed_work(system_power_efficient_wq, &es8336->work, + msecs_to_jiffies(es8336->debounce_time)); + + return IRQ_HANDLED; +} + +static void hp_work(struct work_struct *work) +{ + struct es8336_priv *es8336; + + es8336 = container_of(work, struct es8336_priv, work.work); + + es8336->hp_inserted = gpiod_get_value(es8336->hp_det_gpio); + if (!es8336->muted) { + if (es8336->hp_inserted) + es8336_enable_spk(es8336, false); + else + es8336_enable_spk(es8336, true); + } +} + +static int es8336_probe(struct snd_soc_component *component) +{ + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + int ret = 0; + + es8336_component = component; + ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); + if (!ret) { + es8336_reset(component); /* UPDATED BY DAVID,15-3-5 */ + ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); + if (!ret) { + es8336_init_regs(component); + snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); + /* max debance time, enable interrupt, low active */ + snd_soc_component_write(component, + ES8336_GPIO_DEBUNCE_INT_REG4E, 0xf3); + + /* es8336_set_bias_level(codec, SND_SOC_BIAS_OFF); */ + snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); + if (!es8336->hp_inserted) + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, + 0x3F); + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); + snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); + snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); + } + } + + return ret; +} + +static void es8336_remove(struct snd_soc_component *component) +{ + es8336_set_bias_level(component, SND_SOC_BIAS_OFF); +} + +const struct regmap_config es8336_regmap_config = { + .reg_bits = 8, + .val_bits = 8, + .max_register = ES8336_TEST3_REG53, + .cache_type = REGCACHE_RBTREE, + .reg_defaults = es8336_reg_defaults, + .num_reg_defaults = ARRAY_SIZE(es8336_reg_defaults), +}; + +static const struct snd_soc_component_driver soc_component_dev_es8336 = { + .probe = es8336_probe, + .remove = es8336_remove, + .suspend = es8336_suspend, + .resume = es8336_resume, + .set_bias_level = es8336_set_bias_level, + + .controls = es8336_snd_controls, + .num_controls = ARRAY_SIZE(es8336_snd_controls), + .dapm_widgets = es8336_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(es8336_dapm_widgets), + .dapm_routes = es8336_dapm_routes, + .num_dapm_routes = ARRAY_SIZE(es8336_dapm_routes), +}; + +static int es8336_i2c_probe(struct i2c_client *i2c, + const struct i2c_device_id *id) +{ + struct es8336_priv *es8336; + int ret = -1; + int hp_irq; + + es8336 = devm_kzalloc(&i2c->dev, sizeof(*es8336), GFP_KERNEL); + if (!es8336) + return -ENOMEM; + + es8336->debounce_time = 200; + es8336->pwr_count = 0; + es8336->hp_inserted = false; + es8336->muted = true; + + es8336->regmap = devm_regmap_init_i2c(i2c, &es8336_regmap_config); + if (IS_ERR(es8336->regmap)) { + ret = PTR_ERR(es8336->regmap); + dev_err(&i2c->dev, "Failed to init regmap: %d\n", ret); + return ret; + } + + i2c_set_clientdata(i2c, es8336); + + es8336->spk_ctl_gpio = devm_gpiod_get_index_optional(&i2c->dev, "sel", 0, + GPIOD_OUT_HIGH); + ret = of_property_read_u8(i2c->dev.of_node, "mic-src", &es8336->mic_src); + if (ret != 0) { + dev_dbg(&i2c->dev, "mic1-src return %d", ret); + es8336->mic_src = 0x20; + } + dev_dbg(&i2c->dev, "mic1-src %x", es8336->mic_src); + + if (IS_ERR_OR_NULL(es8336->spk_ctl_gpio)) + dev_info(&i2c->dev, "Can not get spk_ctl_gpio\n"); + else + es8336_enable_spk(es8336, false); + + es8336->hp_det_gpio = devm_gpiod_get_index_optional(&i2c->dev, "det", 0, + GPIOD_IN); + + if (IS_ERR_OR_NULL(es8336->hp_det_gpio)) { + dev_info(&i2c->dev, "Can not get hp_det_gpio\n"); + } else { + INIT_DELAYED_WORK(&es8336->work, hp_work); + hp_irq = gpiod_to_irq(es8336->hp_det_gpio); + ret = devm_request_threaded_irq(&i2c->dev, hp_irq, NULL, + es8336_irq_handler, + IRQF_TRIGGER_FALLING | + IRQF_TRIGGER_RISING | + IRQF_ONESHOT, + "es8336_interrupt", es8336); + if (ret < 0) { + dev_err(&i2c->dev, "request_irq failed: %d\n", ret); + return ret; + } + + schedule_delayed_work(&es8336->work, + msecs_to_jiffies(es8336->debounce_time)); + } + + ret = snd_soc_register_component(&i2c->dev, + &soc_component_dev_es8336, + &es8336_dai, 1); + + return ret; +} + +static int es8336_i2c_remove(struct i2c_client *client) +{ + kfree(i2c_get_clientdata(client)); + return 0; +} + +static void es8336_i2c_shutdown(struct i2c_client *client) +{ + struct es8336_priv *es8336 = i2c_get_clientdata(client); + + if (es8336_component != NULL) { + es8336_enable_spk(es8336, false); + msleep(20); + es8336_set_bias_level(es8336_component, SND_SOC_BIAS_OFF); + } +} + +static const struct i2c_device_id es8336_i2c_id[] = { + {"es8336", 0}, + {"10ES8336:00", 0}, + {"10ES8336", 0}, + { } +}; +MODULE_DEVICE_TABLE(i2c, es8336_i2c_id); + +static const struct of_device_id es8336_of_match[] = { + { .compatible = "everest,es8336", }, + { } +}; +MODULE_DEVICE_TABLE(of, es8336_of_match); + +static const struct acpi_device_id es8336_acpi_match[] = { + { "ESSX8336", 0}, + { } +}; +MODULE_DEVICE_TABLE(acpi, es8336_acpi_match); + +static struct i2c_driver es8336_i2c_driver = { + .driver = { + .name = "es8336", + .of_match_table = es8336_of_match, + .acpi_match_table = es8336_acpi_match, + }, + .probe = es8336_i2c_probe, + .remove = es8336_i2c_remove, + .shutdown = es8336_i2c_shutdown, + .id_table = es8336_i2c_id, +}; + +module_i2c_driver(es8336_i2c_driver); +MODULE_DESCRIPTION("ASoC es8336 driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8336.h b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8336.h new file mode 100644 index 0000000000000000000000000000000000000000..d2c74c11ffd1e3d1533e0c9e92fe03820cdda575 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8336.h @@ -0,0 +1,161 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright Everest Semiconductor Co.,Ltd + * Phytium Information Technology Co.,Ltd + * + * Author: David Yang + * Yiqun Zhang + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + */ + +#ifndef _ES8336_H +#define _ES8336_H + +/* ES8336 register space */ +/* + * RESET Control + */ +#define ES8336_RESET_REG00 0x00 +/* + * Clock Managerment + */ +#define ES8336_CLKMGR_CLKSW_REG01 0x01 +#define ES8336_CLKMGR_CLKSEL_REG02 0x02 +#define ES8336_CLKMGR_ADCOSR_REG03 0x03 +#define ES8336_CLKMGR_ADCDIV1_REG04 0x04 +#define ES8336_CLKMGR_ADCDIV2_REG05 0x05 +#define ES8336_CLKMGR_DACDIV1_REG06 0x06 +#define ES8336_CLKMGR_DACDIV2_REG07 0x07 +#define ES8336_CLKMGR_CPDIV_REG08 0x08 +/* + * SDP Control + */ +#define ES8336_SDP_MS_BCKDIV_REG09 0x09 +#define ES8336_SDP_ADCFMT_REG0A 0x0a +#define ES8336_SDP_DACFMT_REG0B 0x0b +/* + * System Control + */ +#define ES8336_SYS_VMIDSEL_REG0C 0x0c +#define ES8336_SYS_PDN_REG0D 0x0d +#define ES8336_SYS_LP1_REG0E 0x0e +#define ES8336_SYS_LP2_REG0F 0x0f +#define ES8336_SYS_VMIDLOW_REG10 0x10 +#define ES8336_SYS_VSEL_REG11 0x11 +#define ES8336_SYS_REF_REG12 0x12 +/* + * HP Mixer + */ +#define ES8336_HPMIX_SEL_REG13 0x13 +#define ES8336_HPMIX_SWITCH_REG14 0x14 +#define ES8336_HPMIX_PDN_REG15 0x15 +#define ES8336_HPMIX_VOL_REG16 0x16 +/* + * Charge Pump Headphone driver + */ +#define ES8336_CPHP_OUTEN_REG17 0x17 +#define ES8336_CPHP_ICAL_VOL_REG18 0x18 +#define ES8336_CPHP_PDN1_REG19 0x19 +#define ES8336_CPHP_PDN2_REG1A 0x1a +#define ES8336_CPHP_LDOCTL_REG1B 0x1b +/* + * Calibration + */ +#define ES8336_CAL_TYPE_REG1C 0x1c +#define ES8336_CAL_SET_REG1D 0x1d +#define ES8336_CAL_HPLIV_REG1E 0x1e +#define ES8336_CAL_HPRIV_REG1F 0x1f +#define ES8336_CAL_HPLMV_REG20 0x20 +#define ES8336_CAL_HPRMV_REG21 0x21 +/* + * ADC Control + */ +#define ES8336_ADC_PDN_LINSEL_REG22 0x22 +#define ES8336_ADC_PGAGAIN_REG23 0x23 +#define ES8336_ADC_D2SEPGA_REG24 0x24 +#define ES8336_ADC_DMIC_REG25 0x25 +#define ES8336_ADC_MUTE_REG26 0x26 +#define ES8336_ADC_VOLUME_REG27 0x27 +#define ES8336_ADC_ALC1_REG29 0x29 +#define ES8336_ADC_ALC2_REG2A 0x2a +#define ES8336_ADC_ALC3_REG2B 0x2b +#define ES8336_ADC_ALC4_REG2C 0x2c +#define ES8336_ADC_ALC5_REG2D 0x2d +#define ES8336_ADC_ALC6_REG2E 0x2e +/* + * DAC Control + */ +#define ES8336_DAC_PDN_REG2F 0x2f +#define ES8336_DAC_SET1_REG30 0x30 +#define ES8336_DAC_SET2_REG31 0x31 +#define ES8336_DAC_SET3_REG32 0x32 +#define ES8336_DAC_VOLL_REG33 0x33 +#define ES8336_DAC_VOLR_REG34 0x34 +/* + * GPIO + */ +#define ES8336_GPIO_SEL_REG4D 0x4D +#define ES8336_GPIO_DEBUNCE_INT_REG4E 0x4E +#define ES8336_GPIO_FLAG 0x4F +/* + * TEST MODE + */ +#define ES8336_TESTMODE_REG50 0x50 +#define ES8336_TEST1_REG51 0x51 +#define ES8336_TEST2_REG52 0x52 +#define ES8336_TEST3_REG53 0x53 + +#define ES8336_IFACE ES8336_SDP_MS_BCKDIV_REG09 +#define ES8336_ADC_IFACE ES8336_SDP_ADCFMT_REG0A +#define ES8336_DAC_IFACE ES8336_SDP_DACFMT_REG0B + +#define ES8336_REGNUM 84 + +/* REGISTER 0X01 CLOCK MANAGER */ +#define ES8336_CLKMGR_MCLK_DIV_MASK (0X1<<7) +#define ES8336_CLKMGR_MCLK_DIV_NML (0X0<<7) +#define ES8336_CLKMGR_MCLK_DIV_1 (0X1<<7) +#define ES8336_CLKMGR_ADC_MCLK_MASK (0X1<<3) +#define ES8336_CLKMGR_ADC_MCLK_EN (0X1<<3) +#define ES8336_CLKMGR_ADC_MCLK_DIS (0X0<<3) +#define ES8336_CLKMGR_DAC_MCLK_MASK (0X1<<2) +#define ES8336_CLKMGR_DAC_MCLK_EN (0X1<<2) +#define ES8336_CLKMGR_DAC_MCLK_DIS (0X0<<2) +#define ES8336_CLKMGR_ADC_ANALOG_MASK (0X1<<1) +#define ES8336_CLKMGR_ADC_ANALOG_EN (0X1<<1) +#define ES8336_CLKMGR_ADC_ANALOG_DIS (0X0<<1) +#define ES8336_CLKMGR_DAC_ANALOG_MASK (0X1<<0) +#define ES8336_CLKMGR_DAC_ANALOG_EN (0X1<<0) +#define ES8336_CLKMGR_DAC_ANALOG_DIS (0X0<<0) + +/* REGISTER 0X0A */ +#define ES8336_ADCWL_MASK (0x7 << 2) +#define ES8336_ADCWL_32 (0x4 << 2) +#define ES8336_ADCWL_24 (0x0 << 2) +#define ES8336_ADCWL_20 (0x1 << 2) +#define ES8336_ADCWL_18 (0x2 << 2) +#define ES8336_ADCWL_16 (0x3 << 2) +#define ES8336_ADCFMT_MASK (0x3 << 0) +#define ES8336_ADCFMT_I2S (0x0 << 0) +#define ES8336_ADCWL_LEFT (0x1 << 0) +#define ES8336_ADCWL_RIGHT (0x2 << 0) +#define ES8336_ADCWL_PCM (0x3 << 0) + +/* REGISTER 0X0B */ +#define ES8336_DACWL_MASK (0x7 << 2) +#define ES8336_DACWL_32 (0x4 << 2) +#define ES8336_DACWL_24 (0x0 << 2) +#define ES8336_DACWL_20 (0x1 << 2) +#define ES8336_DACWL_18 (0x2 << 2) +#define ES8336_DACWL_16 (0x3 << 2) +#define ES8336_DACFMT_MASK (0x3 << 0) +#define ES8336_DACFMT_I2S (0x0 << 0) +#define ES8336_DACWL_LEFT (0x1 << 0) +#define ES8336_DACWL_RIGHT (0x2 << 0) +#define ES8336_DACWL_PCM (0x3 << 0) + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8388.c b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8388.c new file mode 100644 index 0000000000000000000000000000000000000000..fbb3f8399ccd636cba8f22e2c4057dd064f6f2a1 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8388.c @@ -0,0 +1,820 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * es8388.c -- ES8388 ALSA SoC Audio driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + * Author: Yiqun Zhang + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "es8388.h" +#include +#include + +static const unsigned int rates_12288[] = { + 8000, 12000, 16000, 24000, 32000, 48000, 96000, +}; + +static const int ratios_12288[] = { + 10, 7, 6, 4, 3, 2, 0, +}; + +static const struct snd_pcm_hw_constraint_list constraints_12288 = { + .count = ARRAY_SIZE(rates_12288), + .list = rates_12288, +}; + +static const unsigned int rates_11289[] = { + 8018, 11025, 22050, 44100, 88200, +}; + +static const int ratios_11289[] = { + 9, 7, 4, 2, 0, +}; + +static const struct snd_pcm_hw_constraint_list constraints_11289 = { + .count = ARRAY_SIZE(rates_11289), + .list = rates_11289, +}; + +#define ES8388_RATES (SNDRV_PCM_RATE_192000 | \ + SNDRV_PCM_RATE_96000 | \ + SNDRV_PCM_RATE_88200 | \ + SNDRV_PCM_RATE_8000_48000) +#define ES8388_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \ + SNDRV_PCM_FMTBIT_S18_3LE | \ + SNDRV_PCM_FMTBIT_S20_3LE | \ + SNDRV_PCM_FMTBIT_S24_LE | \ + SNDRV_PCM_FMTBIT_S32_LE) + +struct es8388_priv { + struct regmap *regmap; + struct clk *clk; + int playback_fs; + bool deemph; + int mclkdiv2; + const struct snd_pcm_hw_constraint_list *sysclk_constraints; + const int *mclk_ratios; + bool master; +}; + +/* + * ES8388 Controls + */ +static const char * const adcpol_txt[] = {"Normal", "L Invert", "R Invert", + "L + R Invert"}; +static SOC_ENUM_SINGLE_DECL(adcpol, + ES8388_ADCCONTROL6, 6, adcpol_txt); + +static const DECLARE_TLV_DB_SCALE(play_tlv, -3000, 100, 0); +static const DECLARE_TLV_DB_SCALE(dac_adc_tlv, -9600, 50, 0); +static const DECLARE_TLV_DB_SCALE(pga_tlv, 0, 300, 0); +static const DECLARE_TLV_DB_SCALE(bypass_tlv, -1500, 300, 0); +static const DECLARE_TLV_DB_SCALE(mic_tlv, 0, 300, 0); + +static const struct { + int rate; + unsigned int val; +} deemph_settings[] = { + { 0, ES8388_DACCONTROL6_DEEMPH_OFF }, + { 32000, ES8388_DACCONTROL6_DEEMPH_32k }, + { 44100, ES8388_DACCONTROL6_DEEMPH_44_1k }, + { 48000, ES8388_DACCONTROL6_DEEMPH_48k }, +}; + +static int es8388_set_deemph(struct snd_soc_component *component) +{ + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + int val, i, best; + + /* + * If we're using deemphasis select the nearest available sample + * rate. + */ + if (es8388->deemph) { + best = 0; + for (i = 1; i < ARRAY_SIZE(deemph_settings); i++) { + if (abs(deemph_settings[i].rate - es8388->playback_fs) < + abs(deemph_settings[best].rate - es8388->playback_fs)) + best = i; + } + + val = deemph_settings[best].val; + } else { + val = ES8388_DACCONTROL6_DEEMPH_OFF; + } + + dev_dbg(component->dev, "Set deemphasis %d\n", val); + + return snd_soc_component_update_bits(component, ES8388_DACCONTROL6, + ES8388_DACCONTROL6_DEEMPH_MASK, val); +} + +static int es8388_get_deemph(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + + ucontrol->value.integer.value[0] = es8388->deemph; + return 0; +} + +static int es8388_put_deemph(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + unsigned int deemph = ucontrol->value.integer.value[0]; + int ret; + + if (deemph > 1) + return -EINVAL; + + ret = es8388_set_deemph(component); + if (ret < 0) + return ret; + + es8388->deemph = deemph; + + return 0; +} + +static const struct snd_kcontrol_new es8388_snd_controls[] = { + SOC_DOUBLE_R_TLV("Capture Digital Volume", + ES8388_ADCCONTROL8, ES8388_ADCCONTROL9, + 0, 0xc0, 1, dac_adc_tlv), + + SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0, + es8388_get_deemph, es8388_put_deemph), + + SOC_ENUM("Capture Polarity", adcpol), + + SOC_SINGLE_TLV("Left Mixer Left Bypass Volume", + ES8388_DACCONTROL17, 3, 7, 1, bypass_tlv), + SOC_SINGLE_TLV("Left Mixer Right Bypass Volume", + ES8388_DACCONTROL19, 3, 7, 1, bypass_tlv), + SOC_SINGLE_TLV("Right Mixer Left Bypass Volume", + ES8388_DACCONTROL18, 3, 7, 1, bypass_tlv), + SOC_SINGLE_TLV("Right Mixer Right Bypass Volume", + ES8388_DACCONTROL20, 3, 7, 1, bypass_tlv), + + SOC_DOUBLE_R_TLV("PCM Volume", + ES8388_LDACVOL, ES8388_RDACVOL, + 0, ES8388_DACVOL_MAX, 1, dac_adc_tlv), + + SOC_DOUBLE_R_TLV("Output 1 Playback Volume", + ES8388_LOUT1VOL, ES8388_ROUT1VOL, + 0, ES8388_OUT1VOL_MAX, 0, play_tlv), + + SOC_DOUBLE_R_TLV("Output 2 Playback Volume", + ES8388_LOUT2VOL, ES8388_ROUT2VOL, + 0, ES8388_OUT2VOL_MAX, 0, play_tlv), + + SOC_DOUBLE_TLV("Mic PGA Volume", ES8388_ADCCONTROL1, + 4, 0, 8, 0, mic_tlv), +}; + +/* + * DAPM Controls + */ +static const char * const es8388_line_texts[] = { + "Line 1", "Line 2", "PGA", "Differential"}; + +static const struct soc_enum es8388_lline_enum = + SOC_ENUM_SINGLE(ES8388_DACCONTROL16, 3, + ARRAY_SIZE(es8388_line_texts), + es8388_line_texts); +static const struct snd_kcontrol_new es8388_left_line_controls = + SOC_DAPM_ENUM("Route", es8388_lline_enum); + +static const struct soc_enum es8388_rline_enum = + SOC_ENUM_SINGLE(ES8388_DACCONTROL16, 0, + ARRAY_SIZE(es8388_line_texts), + es8388_line_texts); +static const struct snd_kcontrol_new es8388_right_line_controls = + SOC_DAPM_ENUM("Route", es8388_lline_enum); + +/* Left Mixer */ +static const struct snd_kcontrol_new es8388_left_mixer_controls[] = { + SOC_DAPM_SINGLE("Playback Switch", ES8388_DACCONTROL17, 7, 1, 0), + SOC_DAPM_SINGLE("Left Bypass Switch", ES8388_DACCONTROL17, 6, 1, 0), + SOC_DAPM_SINGLE("Right Playback Switch", ES8388_DACCONTROL18, 7, 1, 0), + SOC_DAPM_SINGLE("Right Bypass Switch", ES8388_DACCONTROL18, 6, 1, 0), +}; + +/* Right Mixer */ +static const struct snd_kcontrol_new es8388_right_mixer_controls[] = { + SOC_DAPM_SINGLE("Left Playback Switch", ES8388_DACCONTROL19, 7, 1, 0), + SOC_DAPM_SINGLE("Left Bypass Switch", ES8388_DACCONTROL19, 6, 1, 0), + SOC_DAPM_SINGLE("Playback Switch", ES8388_DACCONTROL20, 7, 1, 0), + SOC_DAPM_SINGLE("Right Bypass Switch", ES8388_DACCONTROL20, 6, 1, 0), +}; + +static const char * const es8388_pga_sel[] = { + "Line 1", "Line 2", "Line 3", "Differential"}; + +/* Left PGA Mux */ +static const struct soc_enum es8388_lpga_enum = + SOC_ENUM_SINGLE(ES8388_ADCCONTROL2, 6, + ARRAY_SIZE(es8388_pga_sel), + es8388_pga_sel); +static const struct snd_kcontrol_new es8388_left_pga_controls = + SOC_DAPM_ENUM("Route", es8388_lpga_enum); + +/* Right PGA Mux */ +static const struct soc_enum es8388_rpga_enum = + SOC_ENUM_SINGLE(ES8388_ADCCONTROL2, 4, + ARRAY_SIZE(es8388_pga_sel), + es8388_pga_sel); +static const struct snd_kcontrol_new es8388_right_pga_controls = + SOC_DAPM_ENUM("Route", es8388_rpga_enum); + +/* Differential Mux */ +static const char * const es8388_diff_sel[] = {"Line 1", "Line 2"}; +static SOC_ENUM_SINGLE_DECL(diffmux, + ES8388_ADCCONTROL3, 7, es8388_diff_sel); +static const struct snd_kcontrol_new es8388_diffmux_controls = + SOC_DAPM_ENUM("Route", diffmux); + +/* Mono ADC Mux */ +static const char * const es8388_mono_mux[] = {"Stereo", "Mono (Left)", + "Mono (Right)", "Digital Mono"}; +static SOC_ENUM_SINGLE_DECL(monomux, + ES8388_ADCCONTROL3, 3, es8388_mono_mux); +static const struct snd_kcontrol_new es8388_monomux_controls = + SOC_DAPM_ENUM("Route", monomux); + +static const struct snd_soc_dapm_widget es8388_dapm_widgets[] = { + SND_SOC_DAPM_MUX("Differential Mux", SND_SOC_NOPM, 0, 0, + &es8388_diffmux_controls), + SND_SOC_DAPM_MUX("Left ADC Mux", SND_SOC_NOPM, 0, 0, + &es8388_monomux_controls), + SND_SOC_DAPM_MUX("Right ADC Mux", SND_SOC_NOPM, 0, 0, + &es8388_monomux_controls), + + SND_SOC_DAPM_MUX("Left PGA Mux", ES8388_ADCPOWER, + ES8388_ADCPOWER_AINL_OFF, 1, + &es8388_left_pga_controls), + SND_SOC_DAPM_MUX("Right PGA Mux", ES8388_ADCPOWER, + ES8388_ADCPOWER_AINR_OFF, 1, + &es8388_right_pga_controls), + + SND_SOC_DAPM_MUX("Left Line Mux", SND_SOC_NOPM, 0, 0, + &es8388_left_line_controls), + SND_SOC_DAPM_MUX("Right Line Mux", SND_SOC_NOPM, 0, 0, + &es8388_right_line_controls), + + SND_SOC_DAPM_ADC("Right ADC", "Right Capture", ES8388_ADCPOWER, + ES8388_ADCPOWER_ADCR_OFF, 1), + SND_SOC_DAPM_ADC("Left ADC", "Left Capture", ES8388_ADCPOWER, + ES8388_ADCPOWER_ADCL_OFF, 1), + + SND_SOC_DAPM_SUPPLY("DAC STM", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_DACSTM_RESET, 1, NULL, 0), + SND_SOC_DAPM_SUPPLY("ADC STM", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_ADCSTM_RESET, 1, NULL, 0), + + SND_SOC_DAPM_SUPPLY("DAC DIG", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_DACDIG_OFF, 1, NULL, 0), + SND_SOC_DAPM_SUPPLY("ADC DIG", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_ADCDIG_OFF, 1, NULL, 0), + + SND_SOC_DAPM_SUPPLY("DAC DLL", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_DACDLL_OFF, 1, NULL, 0), + SND_SOC_DAPM_SUPPLY("ADC DLL", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_ADCDLL_OFF, 1, NULL, 0), + + SND_SOC_DAPM_SUPPLY("ADC Vref", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_ADCVREF_OFF, 1, NULL, 0), + SND_SOC_DAPM_SUPPLY("DAC Vref", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_DACVREF_OFF, 1, NULL, 0), + + SND_SOC_DAPM_DAC("Right DAC", "Right Playback", ES8388_DACPOWER, + ES8388_DACPOWER_RDAC_OFF, 1), + SND_SOC_DAPM_DAC("Left DAC", "Left Playback", ES8388_DACPOWER, + ES8388_DACPOWER_LDAC_OFF, 1), + + SND_SOC_DAPM_MIXER("Left Mixer", SND_SOC_NOPM, 0, 0, + &es8388_left_mixer_controls[0], + ARRAY_SIZE(es8388_left_mixer_controls)), + SND_SOC_DAPM_MIXER("Right Mixer", SND_SOC_NOPM, 0, 0, + &es8388_right_mixer_controls[0], + ARRAY_SIZE(es8388_right_mixer_controls)), + + SND_SOC_DAPM_PGA("Right Out 2", ES8388_DACPOWER, + ES8388_DACPOWER_ROUT2_ON, 0, NULL, 0), + SND_SOC_DAPM_PGA("Left Out 2", ES8388_DACPOWER, + ES8388_DACPOWER_LOUT2_ON, 0, NULL, 0), + SND_SOC_DAPM_PGA("Right Out 1", ES8388_DACPOWER, + ES8388_DACPOWER_ROUT1_ON, 0, NULL, 0), + SND_SOC_DAPM_PGA("Left Out 1", ES8388_DACPOWER, + ES8388_DACPOWER_LOUT1_ON, 0, NULL, 0), + + SND_SOC_DAPM_OUTPUT("LOUT1"), + SND_SOC_DAPM_OUTPUT("ROUT1"), + SND_SOC_DAPM_OUTPUT("LOUT2"), + SND_SOC_DAPM_OUTPUT("ROUT2"), + + SND_SOC_DAPM_INPUT("LINPUT1"), + SND_SOC_DAPM_INPUT("LINPUT2"), + SND_SOC_DAPM_INPUT("RINPUT1"), + SND_SOC_DAPM_INPUT("RINPUT2"), +}; + +static const struct snd_soc_dapm_route es8388_dapm_routes[] = { + { "Left Line Mux", "Line 1", "LINPUT1" }, + { "Left Line Mux", "Line 2", "LINPUT2" }, + { "Left Line Mux", "PGA", "Left PGA Mux" }, + { "Left Line Mux", "Differential", "Differential Mux" }, + + { "Right Line Mux", "Line 1", "RINPUT1" }, + { "Right Line Mux", "Line 2", "RINPUT2" }, + { "Right Line Mux", "PGA", "Right PGA Mux" }, + { "Right Line Mux", "Differential", "Differential Mux" }, + + { "Left PGA Mux", "Line 1", "LINPUT1" }, + { "Left PGA Mux", "Line 2", "LINPUT2" }, + { "Left PGA Mux", "Differential", "Differential Mux" }, + + { "Right PGA Mux", "Line 1", "RINPUT1" }, + { "Right PGA Mux", "Line 2", "RINPUT2" }, + { "Right PGA Mux", "Differential", "Differential Mux" }, + + { "Differential Mux", "Line 1", "LINPUT1" }, + { "Differential Mux", "Line 1", "RINPUT1" }, + { "Differential Mux", "Line 2", "LINPUT2" }, + { "Differential Mux", "Line 2", "RINPUT2" }, + + { "Left ADC Mux", "Stereo", "Left PGA Mux" }, + { "Left ADC Mux", "Mono (Left)", "Left PGA Mux" }, + { "Left ADC Mux", "Digital Mono", "Left PGA Mux" }, + + { "Right ADC Mux", "Stereo", "Right PGA Mux" }, + { "Right ADC Mux", "Mono (Right)", "Right PGA Mux" }, + { "Right ADC Mux", "Digital Mono", "Right PGA Mux" }, + + { "Left ADC", NULL, "Left ADC Mux" }, + { "Right ADC", NULL, "Right ADC Mux" }, + + { "ADC DIG", NULL, "ADC STM" }, + { "ADC DIG", NULL, "ADC Vref" }, + { "ADC DIG", NULL, "ADC DLL" }, + + { "Left ADC", NULL, "ADC DIG" }, + { "Right ADC", NULL, "ADC DIG" }, + + { "Left Line Mux", "Line 1", "LINPUT1" }, + { "Left Line Mux", "Line 2", "LINPUT2" }, + { "Left Line Mux", "PGA", "Left PGA Mux" }, + { "Left Line Mux", "Differential", "Differential Mux" }, + + { "Right Line Mux", "Line 1", "RINPUT1" }, + { "Right Line Mux", "Line 2", "RINPUT2" }, + { "Right Line Mux", "PGA", "Right PGA Mux" }, + { "Right Line Mux", "Differential", "Differential Mux" }, + + { "Left Out 1", NULL, "Left DAC" }, + { "Right Out 1", NULL, "Right DAC" }, + { "Left Out 2", NULL, "Left DAC" }, + { "Right Out 2", NULL, "Right DAC" }, + + { "Left Mixer", "Playback Switch", "Left DAC" }, + { "Left Mixer", "Left Bypass Switch", "Left Line Mux" }, + { "Left Mixer", "Right Playback Switch", "Right DAC" }, + { "Left Mixer", "Right Bypass Switch", "Right Line Mux" }, + + { "Right Mixer", "Left Playback Switch", "Left DAC" }, + { "Right Mixer", "Left Bypass Switch", "Left Line Mux" }, + { "Right Mixer", "Playback Switch", "Right DAC" }, + { "Right Mixer", "Right Bypass Switch", "Right Line Mux" }, + + { "DAC DIG", NULL, "DAC STM" }, + { "DAC DIG", NULL, "DAC Vref" }, + { "DAC DIG", NULL, "DAC DLL" }, + + { "Left DAC", NULL, "DAC DIG" }, + { "Right DAC", NULL, "DAC DIG" }, + + { "Left Out 1", NULL, "Left Mixer" }, + { "LOUT1", NULL, "Left Out 1" }, + { "Right Out 1", NULL, "Right Mixer" }, + { "ROUT1", NULL, "Right Out 1" }, + + { "Left Out 2", NULL, "Left Mixer" }, + { "LOUT2", NULL, "Left Out 2" }, + { "Right Out 2", NULL, "Right Mixer" }, + { "ROUT2", NULL, "Right Out 2" }, +}; + +static int es8388_mute(struct snd_soc_dai *dai, int mute, int direction) +{ + return snd_soc_component_update_bits(dai->component, ES8388_DACCONTROL3, + ES8388_DACCONTROL3_DACMUTE, + mute ? ES8388_DACCONTROL3_DACMUTE : 0); +} + +static int es8388_startup(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct snd_soc_component *component = dai->component; + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + + if (es8388->master && es8388->sysclk_constraints) + snd_pcm_hw_constraint_list(substream->runtime, 0, + SNDRV_PCM_HW_PARAM_RATE, + es8388->sysclk_constraints); + + return 0; +} + +static int es8388_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params, + struct snd_soc_dai *dai) +{ + struct snd_soc_component *component = dai->component; + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + int i; + int reg; + int wl; + int ratio; + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + reg = ES8388_DACCONTROL2; + else + reg = ES8388_ADCCONTROL5; + + if (es8388->master) { + if (!es8388->sysclk_constraints) { + dev_err(component->dev, "No MCLK configured\n"); + return -EINVAL; + } + + for (i = 0; i < es8388->sysclk_constraints->count; i++) + if (es8388->sysclk_constraints->list[i] == + params_rate(params)) + break; + + if (i == es8388->sysclk_constraints->count) { + dev_err(component->dev, + "LRCLK %d unsupported with current clock\n", + params_rate(params)); + return -EINVAL; + } + ratio = es8388->mclk_ratios[i]; + } else { + ratio = 0; + es8388->mclkdiv2 = 0; + } + + snd_soc_component_update_bits(component, ES8388_MASTERMODE, + ES8388_MASTERMODE_MCLKDIV2, + es8388->mclkdiv2 ? ES8388_MASTERMODE_MCLKDIV2 : 0); + + switch (params_width(params)) { + case 16: + wl = 3; + break; + case 18: + wl = 2; + break; + case 20: + wl = 1; + break; + case 24: + wl = 0; + break; + case 32: + wl = 4; + break; + default: + return -EINVAL; + } + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + snd_soc_component_update_bits(component, ES8388_DACCONTROL1, + ES8388_DACCONTROL1_DACWL_MASK, + wl << ES8388_DACCONTROL1_DACWL_SHIFT); + + es8388->playback_fs = params_rate(params); + es8388_set_deemph(component); + } else + snd_soc_component_update_bits(component, ES8388_ADCCONTROL4, + ES8388_ADCCONTROL4_ADCWL_MASK, + wl << ES8388_ADCCONTROL4_ADCWL_SHIFT); + + return snd_soc_component_update_bits(component, reg, ES8388_RATEMASK, ratio); +} + +static int es8388_set_sysclk(struct snd_soc_dai *codec_dai, + int clk_id, unsigned int freq, int dir) +{ + struct snd_soc_component *component = codec_dai->component; + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + int mclkdiv2 = 0; + + switch (freq) { + case 0: + es8388->sysclk_constraints = NULL; + es8388->mclk_ratios = NULL; + break; + case 22579200: + mclkdiv2 = 1; + /* fallthru */ + case 11289600: + es8388->sysclk_constraints = &constraints_11289; + es8388->mclk_ratios = ratios_11289; + break; + case 24576000: + mclkdiv2 = 1; + /* fallthru */ + case 12288000: + es8388->sysclk_constraints = &constraints_12288; + es8388->mclk_ratios = ratios_12288; + break; + default: + return -EINVAL; + } + + es8388->mclkdiv2 = mclkdiv2; + return 0; +} + +static int es8388_set_dai_fmt(struct snd_soc_dai *codec_dai, + unsigned int fmt) +{ + struct snd_soc_component *component = codec_dai->component; + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + u8 dac_mode = 0; + u8 adc_mode = 0; + + switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { + case SND_SOC_DAIFMT_CBM_CFM: + /* Master serial port mode, with BCLK generated automatically */ + snd_soc_component_update_bits(component, ES8388_MASTERMODE, + ES8388_MASTERMODE_MSC, + ES8388_MASTERMODE_MSC); + es8388->master = true; + break; + case SND_SOC_DAIFMT_CBS_CFS: + /* Slave serial port mode */ + snd_soc_component_update_bits(component, ES8388_MASTERMODE, + ES8388_MASTERMODE_MSC, 0); + es8388->master = false; + break; + default: + return -EINVAL; + } + + /* interface format */ + switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { + case SND_SOC_DAIFMT_I2S: + dac_mode |= ES8388_DACCONTROL1_DACFORMAT_I2S; + adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_I2S; + break; + case SND_SOC_DAIFMT_RIGHT_J: + dac_mode |= ES8388_DACCONTROL1_DACFORMAT_RJUST; + adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_RJUST; + break; + case SND_SOC_DAIFMT_LEFT_J: + dac_mode |= ES8388_DACCONTROL1_DACFORMAT_LJUST; + adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_LJUST; + break; + default: + return -EINVAL; + } + + /* clock inversion */ + if ((fmt & SND_SOC_DAIFMT_INV_MASK) != SND_SOC_DAIFMT_NB_NF) + return -EINVAL; + + snd_soc_component_update_bits(component, ES8388_DACCONTROL1, + ES8388_DACCONTROL1_DACFORMAT_MASK, dac_mode); + snd_soc_component_update_bits(component, ES8388_ADCCONTROL4, + ES8388_ADCCONTROL4_ADCFORMAT_MASK, adc_mode); + + return 0; +} + +static int es8388_set_bias_level(struct snd_soc_component *component, + enum snd_soc_bias_level level) +{ + switch (level) { + case SND_SOC_BIAS_ON: + break; + + case SND_SOC_BIAS_PREPARE: + /* VREF, VMID=2x50k, digital enabled */ + snd_soc_component_write(component, ES8388_CHIPPOWER, 0); + snd_soc_component_update_bits(component, ES8388_CONTROL1, + ES8388_CONTROL1_VMIDSEL_MASK | + ES8388_CONTROL1_ENREF, + ES8388_CONTROL1_VMIDSEL_50k | + ES8388_CONTROL1_ENREF); + break; + + case SND_SOC_BIAS_STANDBY: + if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) { + snd_soc_component_update_bits(component, ES8388_CONTROL1, + ES8388_CONTROL1_VMIDSEL_MASK | + ES8388_CONTROL1_ENREF, + ES8388_CONTROL1_VMIDSEL_5k | + ES8388_CONTROL1_ENREF); + + /* Charge caps */ + msleep(100); + } + + snd_soc_component_write(component, ES8388_CONTROL2, + ES8388_CONTROL2_OVERCURRENT_ON | + ES8388_CONTROL2_THERMAL_SHUTDOWN_ON); + + /* VREF, VMID=2*500k, digital stopped */ + snd_soc_component_update_bits(component, ES8388_CONTROL1, + ES8388_CONTROL1_VMIDSEL_MASK | + ES8388_CONTROL1_ENREF, + ES8388_CONTROL1_VMIDSEL_500k | + ES8388_CONTROL1_ENREF); + break; + + case SND_SOC_BIAS_OFF: + snd_soc_component_update_bits(component, ES8388_CONTROL1, + ES8388_CONTROL1_VMIDSEL_MASK | + ES8388_CONTROL1_ENREF, + 0); + break; + } + return 0; +} + +static const struct snd_soc_dai_ops es8388_dai_ops = { + .startup = es8388_startup, + .hw_params = es8388_hw_params, + .mute_stream = es8388_mute, + .set_sysclk = es8388_set_sysclk, + .set_fmt = es8388_set_dai_fmt, +}; + +static struct snd_soc_dai_driver es8388_dai = { + .name = "es8388-hifi", + .playback = { + .stream_name = "Playback", + .channels_min = 2, + .channels_max = 2, + .rates = ES8388_RATES, + .formats = ES8388_FORMATS, + }, + .capture = { + .stream_name = "Capture", + .channels_min = 2, + .channels_max = 2, + .rates = ES8388_RATES, + .formats = ES8388_FORMATS, + }, + .ops = &es8388_dai_ops, + .symmetric_rates = 1, +}; + +static int es8388_suspend(struct snd_soc_component *component) +{ + return 0; +} + +static int es8388_resume(struct snd_soc_component *component) +{ + struct regmap *regmap = dev_get_regmap(component->dev, NULL); + struct es8388_priv *es8388; + int ret; + + es8388 = snd_soc_component_get_drvdata(component); + + regcache_mark_dirty(regmap); + ret = regcache_sync(regmap); + if (ret) { + dev_err(component->dev, "unable to sync regcache\n"); + return ret; + } + + return 0; +} + +static int es8388_component_probe(struct snd_soc_component *component) +{ + snd_soc_component_write(component, ES8388_ADCPOWER, 0xf0); + snd_soc_component_write(component, ES8388_CONTROL1, 0x30); + snd_soc_component_write(component, ES8388_DACCONTROL21, 0x80); + snd_soc_component_write(component, ES8388_ADCCONTROL10, 0xda); + + return 0; +} + +static void es8388_remove(struct snd_soc_component *component) +{ +} + +const struct regmap_config es8388_regmap_config = { + .reg_bits = 8, + .val_bits = 8, + .max_register = ES8388_REG_MAX, + .cache_type = REGCACHE_RBTREE, + .use_single_read = true, + .use_single_write = true, +}; +EXPORT_SYMBOL_GPL(es8388_regmap_config); + +static const struct snd_soc_component_driver es8388_component_driver = { + .probe = es8388_component_probe, + .remove = es8388_remove, + .suspend = es8388_suspend, + .resume = es8388_resume, + .set_bias_level = es8388_set_bias_level, + .controls = es8388_snd_controls, + .num_controls = ARRAY_SIZE(es8388_snd_controls), + .dapm_widgets = es8388_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(es8388_dapm_widgets), + .dapm_routes = es8388_dapm_routes, + .num_dapm_routes = ARRAY_SIZE(es8388_dapm_routes), + .suspend_bias_off = 1, + .idle_bias_on = 1, + .use_pmdown_time = 1, + .endianness = 1, + .non_legacy_dai_naming = 1, +}; + +int es8388_probe(struct device *dev, struct regmap *regmap) +{ + struct es8388_priv *es8388; + + if (IS_ERR(regmap)) + return PTR_ERR(regmap); + + es8388 = devm_kzalloc(dev, sizeof(*es8388), GFP_KERNEL); + if (es8388 == NULL) + return -ENOMEM; + + es8388->regmap = regmap; + + dev_set_drvdata(dev, es8388); + + return devm_snd_soc_register_component(dev, + &es8388_component_driver, &es8388_dai, 1); +} +EXPORT_SYMBOL_GPL(es8388_probe); + +static const struct i2c_device_id es8388_id[] = { + { "es8388", 0 }, + { } +}; +MODULE_DEVICE_TABLE(i2c, es8388_id); + +static const struct of_device_id es8388_of_match[] = { + { .compatible = "everest,es8388", }, + { } +}; +MODULE_DEVICE_TABLE(of, es8388_of_match); + +static struct acpi_device_id es8388_acpi_match[] = { + {"ESSX8388", 0 }, + {}, +}; +MODULE_DEVICE_TABLE(acpi, es8388_acpi_match); + +static int es8388_i2c_probe(struct i2c_client *i2c, + const struct i2c_device_id *id) +{ + return es8388_probe(&i2c->dev, + devm_regmap_init_i2c(i2c, &es8388_regmap_config)); +} + +static struct i2c_driver es8388_i2c_driver = { + .driver = { + .name = "es8388", + .of_match_table = es8388_of_match, + .acpi_match_table = es8388_acpi_match, + }, + .probe = es8388_i2c_probe, + .id_table = es8388_id, +}; + +module_i2c_driver(es8388_i2c_driver); + +MODULE_DESCRIPTION("ASoC ES8388 driver"); +MODULE_AUTHOR("Yiqun Zhang "); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8388.h b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8388.h new file mode 100644 index 0000000000000000000000000000000000000000..5858a71261fba6d8258eac45edc2d0cfcbda39ef --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/codecs/es8388.h @@ -0,0 +1,290 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * es8388.h -- ES8388 ALSA SoC Audio driver + */ + +#ifndef _ES8388_H +#define _ES8388_H + +#include + +struct device; + +extern const struct regmap_config es8388_regmap_config; +int es8388_probe(struct device *dev, struct regmap *regmap); + +#define ES8388_DACLVOL 46 +#define ES8388_DACRVOL 47 +#define ES8388_DACCTL 28 +#define ES8388_RATEMASK (0x1f << 0) + +#define ES8388_CONTROL1 0x00 +#define ES8388_CONTROL1_VMIDSEL_OFF (0 << 0) +#define ES8388_CONTROL1_VMIDSEL_50k (1 << 0) +#define ES8388_CONTROL1_VMIDSEL_500k (2 << 0) +#define ES8388_CONTROL1_VMIDSEL_5k (3 << 0) +#define ES8388_CONTROL1_VMIDSEL_MASK (3 << 0) +#define ES8388_CONTROL1_ENREF (1 << 2) +#define ES8388_CONTROL1_SEQEN (1 << 3) +#define ES8388_CONTROL1_SAMEFS (1 << 4) +#define ES8388_CONTROL1_DACMCLK_ADC (0 << 5) +#define ES8388_CONTROL1_DACMCLK_DAC (1 << 5) +#define ES8388_CONTROL1_LRCM (1 << 6) +#define ES8388_CONTROL1_SCP_RESET (1 << 7) + +#define ES8388_CONTROL2 0x01 +#define ES8388_CONTROL2_VREF_BUF_OFF (1 << 0) +#define ES8388_CONTROL2_VREF_LOWPOWER (1 << 1) +#define ES8388_CONTROL2_IBIASGEN_OFF (1 << 2) +#define ES8388_CONTROL2_ANALOG_OFF (1 << 3) +#define ES8388_CONTROL2_VREF_BUF_LOWPOWER (1 << 4) +#define ES8388_CONTROL2_VCM_MOD_LOWPOWER (1 << 5) +#define ES8388_CONTROL2_OVERCURRENT_ON (1 << 6) +#define ES8388_CONTROL2_THERMAL_SHUTDOWN_ON (1 << 7) + +#define ES8388_CHIPPOWER 0x02 +#define ES8388_CHIPPOWER_DACVREF_OFF 0 +#define ES8388_CHIPPOWER_ADCVREF_OFF 1 +#define ES8388_CHIPPOWER_DACDLL_OFF 2 +#define ES8388_CHIPPOWER_ADCDLL_OFF 3 +#define ES8388_CHIPPOWER_DACSTM_RESET 4 +#define ES8388_CHIPPOWER_ADCSTM_RESET 5 +#define ES8388_CHIPPOWER_DACDIG_OFF 6 +#define ES8388_CHIPPOWER_ADCDIG_OFF 7 + +#define ES8388_ADCPOWER 0x03 +#define ES8388_ADCPOWER_INT1_LOWPOWER 0 +#define ES8388_ADCPOWER_FLASH_ADC_LOWPOWER 1 +#define ES8388_ADCPOWER_ADC_BIAS_GEN_OFF 2 +#define ES8388_ADCPOWER_MIC_BIAS_OFF 3 +#define ES8388_ADCPOWER_ADCR_OFF 4 +#define ES8388_ADCPOWER_ADCL_OFF 5 +#define ES8388_ADCPOWER_AINR_OFF 6 +#define ES8388_ADCPOWER_AINL_OFF 7 + +#define ES8388_DACPOWER 0x04 +#define ES8388_DACPOWER_OUT3_ON 0 +#define ES8388_DACPOWER_MONO_ON 1 +#define ES8388_DACPOWER_ROUT2_ON 2 +#define ES8388_DACPOWER_LOUT2_ON 3 +#define ES8388_DACPOWER_ROUT1_ON 4 +#define ES8388_DACPOWER_LOUT1_ON 5 +#define ES8388_DACPOWER_RDAC_OFF 6 +#define ES8388_DACPOWER_LDAC_OFF 7 + +#define ES8388_CHIPLOPOW1 0x05 +#define ES8388_CHIPLOPOW2 0x06 +#define ES8388_ANAVOLMANAG 0x07 + +#define ES8388_MASTERMODE 0x08 +#define ES8388_MASTERMODE_BCLKDIV (0 << 0) +#define ES8388_MASTERMODE_BCLK_INV (1 << 5) +#define ES8388_MASTERMODE_MCLKDIV2 (1 << 6) +#define ES8388_MASTERMODE_MSC (1 << 7) + +#define ES8388_ADCCONTROL1 0x09 +#define ES8388_ADCCONTROL2 0x0a +#define ES8388_ADCCONTROL3 0x0b + +#define ES8388_ADCCONTROL4 0x0c +#define ES8388_ADCCONTROL4_ADCFORMAT_MASK (3 << 0) +#define ES8388_ADCCONTROL4_ADCFORMAT_I2S (0 << 0) +#define ES8388_ADCCONTROL4_ADCFORMAT_LJUST (1 << 0) +#define ES8388_ADCCONTROL4_ADCFORMAT_RJUST (2 << 0) +#define ES8388_ADCCONTROL4_ADCFORMAT_PCM (3 << 0) +#define ES8388_ADCCONTROL4_ADCWL_SHIFT 2 +#define ES8388_ADCCONTROL4_ADCWL_MASK (7 << 2) +#define ES8388_ADCCONTROL4_ADCLRP_I2S_POL_NORMAL (0 << 5) +#define ES8388_ADCCONTROL4_ADCLRP_I2S_POL_INV (1 << 5) +#define ES8388_ADCCONTROL4_ADCLRP_PCM_MSB_CLK2 (0 << 5) +#define ES8388_ADCCONTROL4_ADCLRP_PCM_MSB_CLK1 (1 << 5) + +#define ES8388_ADCCONTROL5 0x0d +#define ES8388_ADCCONTROL5_RATEMASK (0x1f << 0) + +#define ES8388_ADCCONTROL6 0x0e + +#define ES8388_ADCCONTROL7 0x0f +#define ES8388_ADCCONTROL7_ADC_MUTE (1 << 2) +#define ES8388_ADCCONTROL7_ADC_LER (1 << 3) +#define ES8388_ADCCONTROL7_ADC_ZERO_CROSS (1 << 4) +#define ES8388_ADCCONTROL7_ADC_SOFT_RAMP (1 << 5) +#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_4 (0 << 6) +#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_8 (1 << 6) +#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_16 (2 << 6) +#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_32 (3 << 6) + +#define ES8388_ADCCONTROL8 0x10 +#define ES8388_ADCCONTROL9 0x11 +#define ES8388_ADCCONTROL10 0x12 +#define ES8388_ADCCONTROL11 0x13 +#define ES8388_ADCCONTROL12 0x14 +#define ES8388_ADCCONTROL13 0x15 +#define ES8388_ADCCONTROL14 0x16 + +#define ES8388_DACCONTROL1 0x17 +#define ES8388_DACCONTROL1_DACFORMAT_MASK (3 << 1) +#define ES8388_DACCONTROL1_DACFORMAT_I2S (0 << 1) +#define ES8388_DACCONTROL1_DACFORMAT_LJUST (1 << 1) +#define ES8388_DACCONTROL1_DACFORMAT_RJUST (2 << 1) +#define ES8388_DACCONTROL1_DACFORMAT_PCM (3 << 1) +#define ES8388_DACCONTROL1_DACWL_SHIFT 3 +#define ES8388_DACCONTROL1_DACWL_MASK (7 << 3) +#define ES8388_DACCONTROL1_DACLRP_I2S_POL_NORMAL (0 << 6) +#define ES8388_DACCONTROL1_DACLRP_I2S_POL_INV (1 << 6) +#define ES8388_DACCONTROL1_DACLRP_PCM_MSB_CLK2 (0 << 6) +#define ES8388_DACCONTROL1_DACLRP_PCM_MSB_CLK1 (1 << 6) +#define ES8388_DACCONTROL1_LRSWAP (1 << 7) + +#define ES8388_DACCONTROL2 0x18 +#define ES8388_DACCONTROL2_RATEMASK (0x1f << 0) +#define ES8388_DACCONTROL2_DOUBLESPEED (1 << 5) + +#define ES8388_DACCONTROL3 0x19 +#define ES8388_DACCONTROL3_AUTOMUTE (1 << 2) +#define ES8388_DACCONTROL3_DACMUTE (1 << 2) +#define ES8388_DACCONTROL3_LEFTGAINVOL (1 << 3) +#define ES8388_DACCONTROL3_DACZEROCROSS (1 << 4) +#define ES8388_DACCONTROL3_DACSOFTRAMP (1 << 5) +#define ES8388_DACCONTROL3_DACRAMPRATE (3 << 6) + +#define ES8388_LDACVOL 0x1a +#define ES8388_LDACVOL_MASK (0 << 0) +#define ES8388_LDACVOL_MAX (0xc0) + +#define ES8388_RDACVOL 0x1b +#define ES8388_RDACVOL_MASK (0 << 0) +#define ES8388_RDACVOL_MAX (0xc0) + +#define ES8388_DACVOL_MAX (0xc0) + +#define ES8388_DACCONTROL4 0x1a +#define ES8388_DACCONTROL5 0x1b + +#define ES8388_DACCONTROL6 0x1c +#define ES8388_DACCONTROL6_CLICKFREE (1 << 3) +#define ES8388_DACCONTROL6_DAC_INVR (1 << 4) +#define ES8388_DACCONTROL6_DAC_INVL (1 << 5) +#define ES8388_DACCONTROL6_DEEMPH_MASK (3 << 6) +#define ES8388_DACCONTROL6_DEEMPH_OFF (0 << 6) +#define ES8388_DACCONTROL6_DEEMPH_32k (1 << 6) +#define ES8388_DACCONTROL6_DEEMPH_44_1k (2 << 6) +#define ES8388_DACCONTROL6_DEEMPH_48k (3 << 6) + +#define ES8388_DACCONTROL7 0x1d +#define ES8388_DACCONTROL7_VPP_SCALE_3p5 (0 << 0) +#define ES8388_DACCONTROL7_VPP_SCALE_4p0 (1 << 0) +#define ES8388_DACCONTROL7_VPP_SCALE_3p0 (2 << 0) +#define ES8388_DACCONTROL7_VPP_SCALE_2p5 (3 << 0) +#define ES8388_DACCONTROL7_SHELVING_STRENGTH (1 << 2) /* In eights */ +#define ES8388_DACCONTROL7_MONO (1 << 5) +#define ES8388_DACCONTROL7_ZEROR (1 << 6) +#define ES8388_DACCONTROL7_ZEROL (1 << 7) + +/* Shelving filter */ +#define ES8388_DACCONTROL8 0x1e +#define ES8388_DACCONTROL9 0x1f +#define ES8388_DACCONTROL10 0x20 +#define ES8388_DACCONTROL11 0x21 +#define ES8388_DACCONTROL12 0x22 +#define ES8388_DACCONTROL13 0x23 +#define ES8388_DACCONTROL14 0x24 +#define ES8388_DACCONTROL15 0x25 + +#define ES8388_DACCONTROL16 0x26 +#define ES8388_DACCONTROL16_RMIXSEL_RIN1 (0 << 0) +#define ES8388_DACCONTROL16_RMIXSEL_RIN2 (1 << 0) +#define ES8388_DACCONTROL16_RMIXSEL_RIN3 (2 << 0) +#define ES8388_DACCONTROL16_RMIXSEL_RADC (3 << 0) +#define ES8388_DACCONTROL16_LMIXSEL_LIN1 (0 << 3) +#define ES8388_DACCONTROL16_LMIXSEL_LIN2 (1 << 3) +#define ES8388_DACCONTROL16_LMIXSEL_LIN3 (2 << 3) +#define ES8388_DACCONTROL16_LMIXSEL_LADC (3 << 3) + +#define ES8388_DACCONTROL17 0x27 +#define ES8388_DACCONTROL17_LI2LOVOL (7 << 3) +#define ES8388_DACCONTROL17_LI2LO (1 << 6) +#define ES8388_DACCONTROL17_LD2LO (1 << 7) + +#define ES8388_DACCONTROL18 0x28 +#define ES8388_DACCONTROL18_RI2LOVOL (7 << 3) +#define ES8388_DACCONTROL18_RI2LO (1 << 6) +#define ES8388_DACCONTROL18_RD2LO (1 << 7) + +#define ES8388_DACCONTROL19 0x29 +#define ES8388_DACCONTROL19_LI2ROVOL (7 << 3) +#define ES8388_DACCONTROL19_LI2RO (1 << 6) +#define ES8388_DACCONTROL19_LD2RO (1 << 7) + +#define ES8388_DACCONTROL20 0x2a +#define ES8388_DACCONTROL20_RI2ROVOL (7 << 3) +#define ES8388_DACCONTROL20_RI2RO (1 << 6) +#define ES8388_DACCONTROL20_RD2RO (1 << 7) + +#define ES8388_DACCONTROL21 0x2b +#define ES8388_DACCONTROL21_LI2MOVOL (7 << 3) +#define ES8388_DACCONTROL21_LI2MO (1 << 6) +#define ES8388_DACCONTROL21_LD2MO (1 << 7) + +#define ES8388_DACCONTROL22 0x2c +#define ES8388_DACCONTROL22_RI2MOVOL (7 << 3) +#define ES8388_DACCONTROL22_RI2MO (1 << 6) +#define ES8388_DACCONTROL22_RD2MO (1 << 7) + +#define ES8388_DACCONTROL23 0x2d +#define ES8388_DACCONTROL23_MOUTINV (1 << 1) +#define ES8388_DACCONTROL23_HPSWPOL (1 << 2) +#define ES8388_DACCONTROL23_HPSWEN (1 << 3) +#define ES8388_DACCONTROL23_VROI_1p5k (0 << 4) +#define ES8388_DACCONTROL23_VROI_40k (1 << 4) +#define ES8388_DACCONTROL23_OUT3_VREF (0 << 5) +#define ES8388_DACCONTROL23_OUT3_ROUT1 (1 << 5) +#define ES8388_DACCONTROL23_OUT3_MONOOUT (2 << 5) +#define ES8388_DACCONTROL23_OUT3_RIGHT_MIXER (3 << 5) +#define ES8388_DACCONTROL23_ROUT2INV (1 << 7) + +/* LOUT1 Amplifier */ +#define ES8388_LOUT1VOL 0x2e +#define ES8388_LOUT1VOL_MASK (0 << 5) +#define ES8388_LOUT1VOL_MAX (0x24) + +/* ROUT1 Amplifier */ +#define ES8388_ROUT1VOL 0x2f +#define ES8388_ROUT1VOL_MASK (0 << 5) +#define ES8388_ROUT1VOL_MAX (0x24) + +#define ES8388_OUT1VOL_MAX (0x24) + +/* LOUT2 Amplifier */ +#define ES8388_LOUT2VOL 0x30 +#define ES8388_LOUT2VOL_MASK (0 << 5) +#define ES8388_LOUT2VOL_MAX (0x24) + +/* ROUT2 Amplifier */ +#define ES8388_ROUT2VOL 0x31 +#define ES8388_ROUT2VOL_MASK (0 << 5) +#define ES8388_ROUT2VOL_MAX (0x24) + +#define ES8388_OUT2VOL_MAX (0x24) + +/* Mono Out Amplifier */ +#define ES8388_MONOOUTVOL 0x32 +#define ES8388_MONOOUTVOL_MASK (0 << 5) +#define ES8388_MONOOUTVOL_MAX (0x24) + +#define ES8388_DACCONTROL29 0x33 +#define ES8388_DACCONTROL30 0x34 + +#define ES8388_SYSCLK 0 + +#define ES8388_REG_MAX 0x35 + +#define ES8388_1536FS 1536 +#define ES8388_1024FS 1024 +#define ES8388_768FS 768 +#define ES8388_512FS 512 +#define ES8388_384FS 384 +#define ES8388_256FS 256 +#define ES8388_128FS 128 + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..8769ed7ccf92dd4ea63d4a694076c35efecb827f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/Kconfig @@ -0,0 +1,30 @@ +config SND_SOC_PHYTIUM_I2S + tristate "Phytium I2S Device Driver" + help + Say Y or M if you want to add support for I2S driver for + Phytium I2S device . The device supports 2 channels each + for play and record. + +config SND_PMDK_ES8388 + tristate "Phytium machine support with ES8388" + depends on I2C && SND_SOC_PHYTIUM_I2S + select SND_SOC_ES8388 + help + Say Y if you want to add Phytium machine support for + ES8388 codecs. + +config SND_PMDK_ES8336 + tristate "Phytium machine support with ES8336" + depends on I2C && SND_SOC_PHYTIUM_I2S + select SND_SOC_ES8336 + help + Say Y if you want to add Phytium machine support for + ES8336 codecs. + +config SND_PMDK_DP + tristate "Phytium machine support with DP" + depends on I2C && SND_SOC_PHYTIUM_I2S + select SND_SOC_HDMI_CODEC + help + Say Y if you want to add Phytium machine support for + Displayport. diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/Makefile b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..db3c0659e8442884fddeb23499deb0bbea95564c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/Makefile @@ -0,0 +1,13 @@ +# PHYTIUM Platform Support + +snd-soc-phytium-i2s-objs :=phytium_i2s.o +obj-$(CONFIG_SND_SOC_PHYTIUM_I2S) += snd-soc-phytium-i2s.o + +snd-soc-pmdk-es8388-objs :=pmdk_es8388.o +obj-$(CONFIG_SND_PMDK_ES8388) += snd-soc-pmdk-es8388.o + +snd-soc-pmdk-es8336-objs :=pmdk_es8336.o +obj-$(CONFIG_SND_PMDK_ES8336) += snd-soc-pmdk-es8336.o + +snd-soc-pmdk-dp-objs :=pmdk_dp.o +obj-$(CONFIG_SND_PMDK_DP) += snd-soc-pmdk-dp.o diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/local.h b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/local.h new file mode 100644 index 0000000000000000000000000000000000000000..887facdd72524e406c1b8e3ea4a222133b7445d9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/local.h @@ -0,0 +1,328 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_I2S_LOCAL_H +#define __PHYTIUM_I2S_LOCAL_H + +#include +#include +#include +#include + +/* I2S clk setting*/ +#define CLK_CFG0 0xc00 +#define CLK_CFG1 0xc04 + +/* common register for all channel */ +#define I2S_IER 0x000 +#define IRER 0x004 +#define ITER 0x008 +#define CER 0x00C + +#define RXFFR 0x014 +#define TXFFR 0x018 + +/* Interrupt status register fields */ +#define ISR_TXFO BIT(5) +#define ISR_TXFE BIT(4) +#define ISR_RXFO BIT(1) +#define ISR_RXDA BIT(0) + +/* I2STxRxRegisters for all channels */ +#define LRBR_LTHR(x) (0x40 * x + 0x020) +#define RRBR_RTHR(x) (0x40 * x + 0x024) +#define RER(x) (0x40 * x + 0x028) + +#define RCR(x) (0x40 * x + 0x030) + +#define ISR(x) (0x40 * x + 0x038) +#define IMR(x) (0x40 * x + 0x03C) +#define ROR(x) (0x40 * x + 0x040) +#define TOR(x) (0x40 * x + 0x044) +#define RFCR(x) (0x40 * x + 0x048) +#define TFCR(x) (0x40 * x + 0x04C) +#define RFF(x) (0x40 * x + 0x050) +#define TFF(x) (0x40 * x + 0x054) + +/*enable txd and rxd block channel0~3 */ +#define TER(x) (0x40 * x + 0x02C) +#define CCR 0x010 +#define TCR(x) (0x40 * x + 0x034) + + +/* I2SCOMPRegisters */ +#define I2S_COMP_PARAM_2 0x01F0 +#define I2S_COMP_PARAM_1 0x01F4 +#define I2S_COMP_VERSION 0x01F8 +#define I2S_COMP_TYPE 0x01FC + +/***I2S AND DMA***/ + +#define DMA_GCAP 0x0024 + +#define DMA_CHAL_CONFG1 0x0028 + +#define DMA_CHAL_CONFG0 0x0004 +#define DMA_MASK_INT 0x000c +#define DMA_BDLPU(x) (0x40 * x + 0x0040) +#define DMA_BDLPL(x) (0x40 * x + 0x0044) +#define DMA_CHALX_DEV_ADDR(x) (0x40 * x + 0x0048) +#define DMA_CHALX_CBL(x) (0x40 * x + 0x0054) +#define DMA_CHALX_LVI(x) (0x40 * x + 0x004c) + +#define DMA_CHALX_DSIZE(x) (0x40 * x + 0x0064) +#define DMA_CHALX_DLENTH(x) (0x40 * x + 0x0068) +#define DMA_CHALX_CTL(x) (0x40 * x + 0x0058) + + +#define DMA_CTL 0x0000 + +#define DMA_LPIB(x) (0x40 * x + 0x0050) + +#define DMA_STS 0x0008 + +/****************/ + + +/* max number of fragments - we may use more if allocating more pages for BDL */ +#define BDL_SIZE 4096 +#define AZX_MAX_BDL_ENTRIES (BDL_SIZE / 16) + +/* + * Component parameter register fields - define the I2S block's + * configuration. + */ +#define COMP1_TX_WORDSIZE_3(r) (((r) & GENMASK(27, 25)) >> 25) +#define COMP1_TX_WORDSIZE_2(r) (((r) & GENMASK(24, 22)) >> 22) +#define COMP1_TX_WORDSIZE_1(r) (((r) & GENMASK(21, 19)) >> 19) +#define COMP1_TX_WORDSIZE_0(r) (((r) & GENMASK(18, 16)) >> 16) +#define COMP1_TX_CHANNELS(r) (((r) & GENMASK(10, 9)) >> 9) +#define COMP1_RX_CHANNELS(r) (((r) & GENMASK(8, 7)) >> 7) +#define COMP1_RX_ENABLED(r) (((r) & BIT(6)) >> 6) +#define COMP1_TX_ENABLED(r) (((r) & BIT(5)) >> 5) +#define COMP1_MODE_EN(r) (((r) & BIT(4)) >> 4) +#define COMP1_FIFO_DEPTH_GLOBAL(r) (((r) & GENMASK(3, 2)) >> 2) +#define COMP1_APB_DATA_WIDTH(r) (((r) & GENMASK(1, 0)) >> 0) + +#define COMP2_RX_WORDSIZE_3(r) (((r) & GENMASK(12, 10)) >> 10) +#define COMP2_RX_WORDSIZE_2(r) (((r) & GENMASK(9, 7)) >> 7) +#define COMP2_RX_WORDSIZE_1(r) (((r) & GENMASK(5, 3)) >> 3) +#define COMP2_RX_WORDSIZE_0(r) (((r) & GENMASK(2, 0)) >> 0) + +/* Number of entries in WORDSIZE and DATA_WIDTH parameter registers */ +#define COMP_MAX_WORDSIZE (1 << 3) +#define COMP_MAX_DATA_WIDTH (1 << 2) + +#define MAX_CHANNEL_NUM 8 +#define MIN_CHANNEL_NUM 2 + +#define azx_bus(chip) (&(chip)->bus.core) +#define bus_to_azx(_bus) container_of(_bus, struct azx, bus.core) + +#define I2S_UNSOL_QUEUE_SIZE 64 +#define I2S_MAX_CODECS 8 /* limit by controller side */ + + +#define azx_stream(dev) (&(dev)->core) + +struct i2s_clk_config_data { + int chan_nr; + u32 data_width; + u32 sample_rate; +}; + +struct i2sc_bus { + struct device *dev; + const struct i2s_bus_ops *ops; + const struct i2s_io_ops *io_ops; + const struct i2s_ext_bus_ops *ext_ops; + + /* h/w resources */ + unsigned long addr; + void __iomem *remap_addr; + int irq; + + /* codec linked list */ + struct list_head codec_list; + unsigned int num_codecs; + + unsigned int unsol_rp, unsol_wp; + struct work_struct unsol_work; + + struct snd_dma_buffer bdl0; + struct snd_dma_buffer bdl1; + + /* i2s_stream linked list */ + struct list_head stream_list; + + bool reverse_assign; /* assign devices in reverse order */ + + int bdl_pos_adj; /* BDL position adjustment */ + + /* locks */ + spinlock_t reg_lock; +}; + +struct i2s_bus { + struct i2sc_bus core; + + struct snd_card *card; + + struct pci_dev *pci; + + struct mutex prepare_mutex; +}; + + +/* + * i2s stream + */ +struct i2s_stream { + struct i2sc_bus *bus; + struct snd_dma_buffer bdl; /* BDL buffer */ + __le32 *posbuf; /* position buffer pointer */ + int direction; /* playback / capture (SNDRV_PCM_STREAM_*) */ + + unsigned int bufsize; /* size of the play buffer in bytes */ + unsigned int period_bytes; /* size of the period in bytes */ + unsigned int frags; /* number for period in the play buffer */ + unsigned int fifo_size; /* FIFO size */ + + void __iomem *sd_addr; /* stream descriptor pointer */ + + u32 sd_int_sta_mask; /* stream int status mask */ + + /* pcm support */ + struct snd_pcm_substream *substream; /* assigned substream, + * set in PCM open + */ + unsigned int format_val; /* format value to be set in the + * controller and the codec + */ + unsigned char stream_tag; /* assigned stream */ + unsigned char index; /* stream index */ + int assigned_key; /* last device# key assigned to */ + + bool opened; + bool running; + bool prepared; + bool no_period_wakeup; + + int delay_negative_threshold; + + struct list_head list; + +}; + + +struct azx_dev { + struct i2s_stream core; + unsigned int irq_pending:1; +}; + + + +/* PCM setup */ +static inline struct azx_dev *get_azx_dev(struct snd_pcm_substream *substream) +{ + return substream->runtime->private_data; +} + + +#define AZX_MAX_CODECS HDA_MAX_CODECS +#define AZX_DEFAULT_CODECS 4 + +#define stream_to_azx_dev(s) container_of(s, struct azx_dev, core) + +struct azx; + +struct i2s_controller_ops { + int (*substream_alloc_pages)(struct azx *chip, + struct snd_pcm_substream *substream, + size_t size); + int (*substream_free_pages)(struct azx *chip, + struct snd_pcm_substream *substream); + int (*position_check)(struct azx *chip, struct azx_dev *azx_dev); +}; + +struct i2s_io_ops { + int (*dma_alloc_pages)(struct i2sc_bus *bus, int type, size_t size, + struct snd_dma_buffer *buf); + void (*dma_free_pages)(struct i2sc_bus *bus, + struct snd_dma_buffer *buf); +}; + +struct azx { + struct i2s_bus bus; + + struct snd_card *card; + struct pci_dev *pci; + int dev_index; + + int playback_streams; + int playback_index_offset; + int capture_streams; + int capture_index_offset; + int num_streams; + + /* Register interaction. */ + const struct i2s_controller_ops *ops; + + /* locks */ + struct mutex open_mutex; /* Prevents concurrent open/close operations */ + + /* PCM */ + struct list_head pcm_list; /* azx_pcm list */ + + /* flags */ + int bdl_pos_adj; + unsigned int running:1; + unsigned int region_requested:1; + unsigned int disabled:1; +}; +struct i2s_phytium { + struct azx chip; + struct snd_pcm_substream *substream; + struct device *dev; + struct device *pdev; + u32 paddr; + void __iomem *regs; + void __iomem *regs_db; + int irq_id; + + /* for pending irqs */ + struct work_struct irq_pending_work; + + /* sync probing */ + struct completion probe_wait; + struct work_struct probe_work; + + /* extra flags */ + unsigned int pcie:1; + unsigned int irq_pending_warned:1; + unsigned int probe_continued:1; + unsigned int i2s_dp:1; + + unsigned int i2s_reg_comp1; + unsigned int i2s_reg_comp2; + struct clk *clk; + unsigned int capability; + unsigned int quirks; + u32 fifo_th; + int active; + u32 xfer_resolution; + u32 ccr; + u32 clk_base; + + struct i2s_clk_config_data config; + + /*azx_dev*/ + struct i2s_stream core; +}; + +#define azx_alloc_stream_pages(chip) \ + snd_i2s_bus_alloc_stream_pages(azx_bus(chip)) + +#endif diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/phytium_i2s.c b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/phytium_i2s.c new file mode 100755 index 0000000000000000000000000000000000000000..c95cf5edc0421a517932b275f570187a98d4c02a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/phytium_i2s.c @@ -0,0 +1,1424 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium I2S ASoC driver + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + * + * Derived from sound/soc/dwc/dwc-i2s.c + * Copyright (C) 2010 ST Microelectronics + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "local.h" + +#define NUM_CAPTURE 1 +#define NUM_PLAYBACK 1 + +#define PHYTIUM_I2S_PLAY (1 << 0) +#define PHYTIUM_I2S_RECORD (1 << 1) +#define PHYTIUM_I2S_SLAVE (1 << 2) +#define PHYTIUM_I2S_MASTER (1 << 3) + +#define PHYTIUM_I2S_QUIRK_16BIT_IDX_OVERRIDE (1 << 2) + +#define TWO_CHANNEL_SUPPORT 2 /* up to 2.0 */ +#define FOUR_CHANNEL_SUPPORT 4 /* up to 3.1 */ +#define SIX_CHANNEL_SUPPORT 6 /* up to 5.1 */ +#define EIGHT_CHANNEL_SUPPORT 8 /* up to 7.1 */ + +struct pdata_px210_mfd { + struct device *dev; + char *name; + int clk_base; +}; + +static inline void i2s_write_reg(void __iomem *io_base, int reg, u32 val) +{ + writel(val, io_base + reg); +} + +static inline u32 i2s_read_reg(void __iomem *io_base, int reg) +{ + return readl(io_base + reg); +} + +static inline void i2s_disable_channels(struct i2s_phytium *dev, u32 stream) +{ + u32 i = 0; + + if (stream == SNDRV_PCM_STREAM_PLAYBACK) { + for (i = 0; i < 4; i++) + i2s_write_reg(dev->regs, TER(i), 0); + } else { + for (i = 0; i < 4; i++) + i2s_write_reg(dev->regs, RER(i), 0); + } +} + +static int substream_free_pages(struct azx *chip, + struct snd_pcm_substream *substream) +{ + return snd_pcm_lib_free_pages(substream); +} + +static void stream_update(struct i2sc_bus *bus, struct i2s_stream *s) +{ + struct azx *chip = bus_to_azx(bus); + + struct azx_dev *azx_dev = stream_to_azx_dev(s); + + /* check whether this IRQ is really acceptable */ + if (!chip->ops->position_check || + chip->ops->position_check(chip, azx_dev)) { + spin_unlock(&bus->reg_lock); + snd_pcm_period_elapsed(azx_stream(azx_dev)->substream); + spin_lock(&bus->reg_lock); + } + +} + +int snd_i2s_bus_handle_stream_irq(struct i2sc_bus *bus, unsigned int status, + void (*ack)(struct i2sc_bus *, + struct i2s_stream *)) +{ + struct i2s_stream *azx_dev; + u32 sd_status, qc_sd_status; + int handled = 0; + + list_for_each_entry(azx_dev, &bus->stream_list, list) { + + if (status & azx_dev->sd_int_sta_mask) { + sd_status = i2s_read_reg(azx_dev->sd_addr, DMA_STS); + i2s_write_reg(azx_dev->sd_addr, DMA_STS, azx_dev->sd_int_sta_mask); + qc_sd_status = i2s_read_reg(azx_dev->sd_addr, DMA_STS); + handled |= 1 << azx_dev->index; + azx_dev->running = 1; + if (!azx_dev->substream || !azx_dev->running || + !(sd_status & 0xffffffff)) { + continue; + } + if (ack) + ack(bus, azx_dev); + } + } + return handled; +} + +irqreturn_t azx_i2s_interrupt(int irq, void *dev_id) +{ + struct azx *chip = dev_id; + struct i2sc_bus *bus = azx_bus(chip); + u32 status; + bool active, handled = false; + int repeat = 0; /* count for avoiding endless loop */ + + spin_lock(&bus->reg_lock); + + if (chip->disabled) + goto unlock; + + do { + + status = i2s_read_reg(bus->remap_addr, DMA_STS); + + if (status == 0) + break; + + handled = true; + active = false; + if (snd_i2s_bus_handle_stream_irq(bus, status, stream_update)) + active = true; + + + } while (active && ++repeat < 1); + + unlock: + spin_unlock(&bus->reg_lock); + + return IRQ_RETVAL(handled); +} + +static int azx_acquire_irq(struct azx *chip, int do_disconnect) +{ + struct i2sc_bus *bus = azx_bus(chip); + struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); + int err; + + err = devm_request_irq(i2s->dev, i2s->irq_id, azx_i2s_interrupt, IRQF_SHARED, + "phytium i2s", chip); + + if (err < 0) { + dev_err(i2s->dev, "failed to request irq\n"); + return err; + } + + bus->irq = i2s->irq_id; + + return 0; +} + +static void i2s_start(struct i2s_phytium *dev, + struct snd_pcm_substream *substream) +{ + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + i2s_write_reg(dev->regs, ITER, 1); + else + i2s_write_reg(dev->regs, IRER, 1); + + /*enable the clock*/ + i2s_write_reg(dev->regs, CER, 1); + + /*enable the i2s*/ + i2s_write_reg(dev->regs, I2S_IER, 1); +} + +static void i2s_stop(struct i2s_phytium *dev, + struct snd_pcm_substream *substream) +{ + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + i2s_write_reg(dev->regs, ITER, 0); + else + i2s_write_reg(dev->regs, IRER, 0); + + if (!dev->active) { + i2s_write_reg(dev->regs, CER, 0); + i2s_write_reg(dev->regs, I2S_IER, 0); + } +} + +static void phytium_i2s_config(struct i2s_phytium *dev, int stream) +{ + i2s_disable_channels(dev, stream); + + if (stream == SNDRV_PCM_STREAM_PLAYBACK) { + i2s_write_reg(dev->regs, TCR(0), dev->xfer_resolution); + i2s_write_reg(dev->regs, TER(0), 1); + } else { + i2s_write_reg(dev->regs, RCR(0), dev->xfer_resolution); + i2s_write_reg(dev->regs, RER(0), 1); + } +} + +static int phytium_i2s_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) +{ + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); + struct i2s_clk_config_data *config = &dev->config; + u64 fix, point; + u32 cfg = 0; + + switch (params_format(params)) { + case SNDRV_PCM_FORMAT_S16_LE: + config->data_width = 16; + dev->ccr = 0x00; + dev->xfer_resolution = 0x02; + break; + + case SNDRV_PCM_FORMAT_S24_LE: + config->data_width = 24; + dev->ccr = 0x08; + dev->xfer_resolution = 0x04; + break; + + case SNDRV_PCM_FORMAT_S32_LE: + config->data_width = 32; + dev->ccr = 0x10; + dev->xfer_resolution = 0x05; + break; + + default: + dev_err(dev->dev, "phytium-i2s: unsupported PCM fmt"); + return -EINVAL; + } + + config->chan_nr = params_channels(params); + + switch (config->chan_nr) { + case EIGHT_CHANNEL_SUPPORT: + case SIX_CHANNEL_SUPPORT: + case FOUR_CHANNEL_SUPPORT: + case TWO_CHANNEL_SUPPORT: + break; + default: + dev_err(dev->dev, "channel not supported\n"); + return -EINVAL; + } + + phytium_i2s_config(dev, substream->stream); + + i2s_write_reg(dev->regs, CCR, dev->ccr); + + config->sample_rate = params_rate(params); + if (dev->capability & PHYTIUM_I2S_MASTER) { + fix = dev->clk_base / config->sample_rate / config->data_width / 32; + point = ((dev->clk_base / config->sample_rate) << 10) / config->data_width / 32; + point = (point - (fix << 10)) * 10; + cfg = ((u16) fix << 16) | (u16) point; + i2s_write_reg(dev->regs, CLK_CFG0, cfg); + i2s_write_reg(dev->regs, CLK_CFG1, 0xf); + } + return 0; +} + +static int phytium_i2s_prepare(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + i2s_write_reg(dev->regs, TXFFR, 1); + else + i2s_write_reg(dev->regs, RXFFR, 1); + + return 0; +} + +static int phytium_i2s_trigger(struct snd_pcm_substream *substream, + int cmd, struct snd_soc_dai *dai) +{ + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); + int ret = 0; + + switch (cmd) { + case SNDRV_PCM_TRIGGER_START: + case SNDRV_PCM_TRIGGER_RESUME: + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: + dev->active++; + i2s_start(dev, substream); + break; + + case SNDRV_PCM_TRIGGER_STOP: + case SNDRV_PCM_TRIGGER_SUSPEND: + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: + dev->active--; + i2s_stop(dev, substream); + break; + default: + ret = -EINVAL; + break; + } + + return ret; +} + +static int phytium_i2s_set_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt) +{ + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(cpu_dai); + int ret = 0; + + switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { + case SND_SOC_DAIFMT_CBM_CFM: + if (dev->capability & PHYTIUM_I2S_SLAVE) + ret = 0; + else + ret = -EINVAL; + break; + case SND_SOC_DAIFMT_CBS_CFS: + if (dev->capability & PHYTIUM_I2S_MASTER) + ret = 0; + else + ret = -EINVAL; + break; + case SND_SOC_DAIFMT_CBM_CFS: + case SND_SOC_DAIFMT_CBS_CFM: + ret = -EINVAL; + break; + default: + dev_dbg(dev->dev, "phytium/i2s: Invalid master/slave format\n"); + ret = -EINVAL; + break; + } + return ret; +} + +static const struct snd_soc_dai_ops phytium_i2s_dai_ops = { + .hw_params = phytium_i2s_hw_params, + .prepare = phytium_i2s_prepare, + .trigger = phytium_i2s_trigger, + .set_fmt = phytium_i2s_set_fmt, +}; + +#ifdef CONFIG_PM + +static int phytium_i2s_suspend(struct snd_soc_component *component) +{ + return 0; +} + +static int phytium_i2s_resume(struct snd_soc_component *component) +{ + struct i2s_phytium *dev = snd_soc_component_get_drvdata(component); + struct snd_soc_dai *dai; + + for_each_component_dais(component, dai) { + if (snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_PLAYBACK)) + phytium_i2s_config(dev, SNDRV_PCM_STREAM_PLAYBACK); + if (snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_CAPTURE)) + phytium_i2s_config(dev, SNDRV_PCM_STREAM_CAPTURE); + } + + return 0; +} + +#else +#define phytium_i2s_suspend NULL +#define phytium_i2s_resume NULL +#endif + +static struct snd_soc_dai_driver phytium_i2s_dai = { + .playback = { + .stream_name = "i2s-Playback", + .channels_min = 2, + .channels_max = 2, + .rates = SNDRV_PCM_RATE_8000_192000, + .formats = SNDRV_PCM_FMTBIT_S8 | + SNDRV_PCM_FMTBIT_S16_LE | + SNDRV_PCM_FMTBIT_S20_LE | + SNDRV_PCM_FMTBIT_S24_LE | + SNDRV_PCM_FMTBIT_S32_LE, + }, + .capture = { + .stream_name = "i2s-Capture", + .channels_min = 2, + .channels_max = 2, + .rates = SNDRV_PCM_RATE_8000_192000, + .formats = SNDRV_PCM_FMTBIT_S8 | + SNDRV_PCM_FMTBIT_S16_LE | + SNDRV_PCM_FMTBIT_S20_LE | + SNDRV_PCM_FMTBIT_S24_LE | + SNDRV_PCM_FMTBIT_S32_LE, + }, + .ops = &phytium_i2s_dai_ops, + .symmetric_rates = 1, +}; + +static const struct snd_pcm_hardware phytium_pcm_hardware = { + .info = SNDRV_PCM_INFO_INTERLEAVED | + SNDRV_PCM_INFO_MMAP | + SNDRV_PCM_INFO_MMAP_VALID | + SNDRV_PCM_INFO_BLOCK_TRANSFER, + .rates = SNDRV_PCM_RATE_8000 | + SNDRV_PCM_RATE_32000 | + SNDRV_PCM_RATE_44100 | + SNDRV_PCM_RATE_48000, + .rate_min = 8000, + .rate_max = 48000, + .formats = (SNDRV_PCM_FMTBIT_S8 | + SNDRV_PCM_FMTBIT_S16_LE | + SNDRV_PCM_FMTBIT_S20_LE | + SNDRV_PCM_FMTBIT_S24_LE | + SNDRV_PCM_FMTBIT_S32_LE), + .channels_min = 2, + .channels_max = 2, + .buffer_bytes_max = 4096*16, + .period_bytes_min = 1024, + .period_bytes_max = 4096*4, + .periods_min = 2, + .periods_max = 16, + .fifo_size = 16, +}; + +struct i2s_stream *snd_i2s_stream_assign(struct i2sc_bus *bus, + struct snd_pcm_substream *substream) +{ + struct i2s_stream *azx_dev; + struct i2s_stream *res = NULL; + + /* make a non-zero unique key for the substream */ + int key = (substream->pcm->device << 16) | (substream->number << 2) | + (substream->stream + 1); + + list_for_each_entry(azx_dev, &bus->stream_list, list) { + if (azx_dev->direction != substream->stream) + continue; + + azx_dev->opened = 0; + + if (azx_dev->assigned_key == key) { + res = azx_dev; + break; + } + + if (!res || bus->reverse_assign) + res = azx_dev; + } + + if (res) { + spin_lock_irq(&bus->reg_lock); + res->opened = 1; + res->running = 0; + res->assigned_key = key; + res->substream = substream; + spin_unlock_irq(&bus->reg_lock); + } + + return res; +} + +/* assign a stream for the PCM */ +static inline struct azx_dev * +azx_assign_device(struct azx *chip, struct snd_pcm_substream *substream) +{ + struct i2s_stream *s; + + s = snd_i2s_stream_assign(azx_bus(chip), substream); + if (!s) + return NULL; + return stream_to_azx_dev(s); +} + +static int phytium_pcm_open(struct snd_soc_component *component, + struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + struct azx *chip = &dev->chip; + struct azx_dev *azx_dev; + struct snd_pcm_runtime *runtime = substream->runtime; + + azx_dev = azx_assign_device(chip, substream); + if (azx_dev == NULL) + return -EBUSY; + + snd_soc_set_runtime_hwparams(substream, &phytium_pcm_hardware); + snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); + snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 128); + runtime->private_data = azx_dev; + + return 0; +} + +static int phytium_pcm_close(struct snd_soc_component *component, + struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + struct azx *chip = &dev->chip; + struct azx_dev *azx_dev = get_azx_dev(substream); + + mutex_lock(&chip->open_mutex); + azx_stream(azx_dev)->opened = 0; + azx_stream(azx_dev)->running = 0; + azx_stream(azx_dev)->substream = NULL; + + mutex_unlock(&chip->open_mutex); + return 0; +} + +static int phytium_pcm_new(struct snd_soc_component *component, + struct snd_soc_pcm_runtime *rtd) +{ + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + size_t size = phytium_pcm_hardware.buffer_bytes_max; + + snd_pcm_set_managed_buffer_all(rtd->pcm, + SNDRV_DMA_TYPE_DEV, + dev->pdev, size, size); + + return 0; +} + +static const struct i2s_io_ops axi_i2s_io_ops; +static const struct i2s_controller_ops axi_i2s_ops; + +static int phytium_pcm_hw_params(struct snd_soc_component *component, + struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *hw_params) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + + struct azx *chip = &dev->chip; + struct azx_dev *azx_dev = get_azx_dev(substream); + int ret; + + azx_dev->core.bufsize = 0; + azx_dev->core.period_bytes = 0; + azx_dev->core.format_val = 0; + + ret = chip->ops->substream_alloc_pages(chip, substream, + params_buffer_bytes(hw_params)); + + return ret; +} +/* + * set up a BDL entry + */ +static int setup_bdle(struct i2sc_bus *bus, + struct snd_dma_buffer *dmab, + struct i2s_stream *azx_dev, __le32 **bdlp, + int ofs, int size, int with_ioc) +{ + struct snd_pcm_substream *substream = azx_dev->substream; + struct snd_pcm_runtime *runtime = substream->runtime; + __le32 *bdl = *bdlp; + + dmab->addr = runtime->dma_addr; + while (size > 0) { + dma_addr_t addr; + int chunk; + + if (azx_dev->frags >= AZX_MAX_BDL_ENTRIES) + return -EINVAL; + + addr = snd_sgbuf_get_addr(dmab, ofs); + + /* program the address field of the BDL entry */ + bdl[0] = cpu_to_le32((u32)addr); + + bdl[1] = cpu_to_le32(upper_32_bits(addr)); + + /* program the size field of the BDL entry */ + chunk = snd_sgbuf_get_chunk_size(dmab, ofs, size); + + bdl[2] = cpu_to_le32(chunk); + + /* program the IOC to enable interrupt + * only when the whole fragment is processed + */ + size -= chunk; + bdl[3] = (size || !with_ioc) ? 0 : cpu_to_le32(0x01); + + bdl += 4; + azx_dev->frags++; + ofs += chunk; + } + *bdlp = bdl; + return ofs; +} + +int snd_i2s_stream_setup_periods(struct i2s_stream *azx_dev) +{ + struct i2sc_bus *bus = azx_dev->bus; + struct snd_pcm_substream *substream = azx_dev->substream; + struct snd_pcm_runtime *runtime = substream->runtime; + __le32 *bdl; + int i, ofs, periods, period_bytes; + int pos_adj, pos_align; + + period_bytes = azx_dev->period_bytes; + periods = azx_dev->bufsize / period_bytes; + + /* program the initial BDL entries */ + bdl = (__le32 *)azx_dev->bdl.area; + + ofs = 0; + azx_dev->frags = 0; + + pos_adj = bus->bdl_pos_adj; + + if (!azx_dev->no_period_wakeup && pos_adj > 0) { + + pos_align = pos_adj; + pos_adj = (pos_adj * runtime->rate + 47999) / 48000; + if (!pos_adj) + pos_adj = pos_align; + else + pos_adj = ((pos_adj + pos_align - 1) / pos_align) * + pos_align; + pos_adj = frames_to_bytes(runtime, pos_adj); + if (pos_adj >= period_bytes) { + dev_warn(bus->dev, "Too big adjustment %d\n", + pos_adj); + pos_adj = 0; + } else { + + ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), + azx_dev, + &bdl, ofs, pos_adj, true); + if (ofs < 0) + goto error; + } + } else + pos_adj = 0; + + for (i = 0; i < periods; i++) { + if (i == periods - 1 && pos_adj) + ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), + azx_dev, &bdl, ofs, + period_bytes - pos_adj, 0); + else + ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), + azx_dev, &bdl, ofs, + period_bytes, + !azx_dev->no_period_wakeup); + if (ofs < 0) + goto error; + } + return 0; + + error: + dev_err(bus->dev, "Too many BDL entries: buffer=%d, period=%d\n", + azx_dev->bufsize, period_bytes); + return -EINVAL; +} + +int snd_i2s_stream_set_params(struct i2s_stream *azx_dev, + unsigned int format_val) +{ + unsigned int bufsize, period_bytes; + struct snd_pcm_substream *substream = azx_dev->substream; + struct snd_pcm_runtime *runtime; + int err; + + if (!substream) + return -EINVAL; + + runtime = substream->runtime; + bufsize = snd_pcm_lib_buffer_bytes(substream); + period_bytes = snd_pcm_lib_period_bytes(substream); + if (bufsize != azx_dev->bufsize || + period_bytes != azx_dev->period_bytes || + format_val != azx_dev->format_val || + runtime->no_period_wakeup != azx_dev->no_period_wakeup) { + + azx_dev->bufsize = bufsize; + azx_dev->period_bytes = period_bytes; + azx_dev->format_val = format_val; + azx_dev->no_period_wakeup = runtime->no_period_wakeup; + err = snd_i2s_stream_setup_periods(azx_dev); + if (err < 0) + return err; + } + + return 0; +} + +int snd_i2s_stream_setup(struct i2s_stream *azx_dev, int pcie, u32 paddr) +{ + struct snd_pcm_runtime *runtime; + + if (azx_dev->substream) + runtime = azx_dev->substream->runtime; + else + runtime = NULL; + + i2s_write_reg(azx_dev->sd_addr, DMA_CHAL_CONFG0, 0x8180); + i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, 0x80000003); + + if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) { + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(0), (u32)azx_dev->bdl.addr); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(0), upper_32_bits(azx_dev->bdl.addr)); + if (pcie) + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(0), 0x1c8); + else + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(0), paddr + 0x1c8); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CBL(0), azx_dev->bufsize); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_LVI(0), azx_dev->frags - 1); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DSIZE(0), 0x2);//0x2 + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DLENTH(0), 0x0);//0x0 + } else { + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(1), (u32)azx_dev->bdl.addr); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(1), upper_32_bits(azx_dev->bdl.addr)); + if (pcie) + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(1), 0x1c0); + else + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(1), paddr + 0x1c0); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CBL(1), azx_dev->bufsize); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_LVI(1), azx_dev->frags - 1); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DSIZE(1), 0x8);//0x8 + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DLENTH(1), 0x0); + } + + if (runtime && runtime->period_size > 64) + azx_dev->delay_negative_threshold = + -frames_to_bytes(runtime, 64); + else + azx_dev->delay_negative_threshold = 0; + + return 0; +} + +static int phytium_pcm_prepare(struct snd_soc_component *component, + struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + + struct azx *chip = &dev->chip; + struct azx_dev *azx_dev = get_azx_dev(substream); + struct i2sc_bus *bus = azx_bus(chip); + struct i2s_stream *hstr_p; + int err; + + dev->substream = substream; + azx_dev->core.substream = substream; + azx_dev->core.sd_addr = dev->regs_db; + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + azx_dev->core.bdl.area = bus->bdl0.area; + azx_dev->core.bdl.addr = bus->bdl0.addr; + } else { + azx_dev->core.bdl.area = bus->bdl1.area; + azx_dev->core.bdl.addr = bus->bdl1.addr; + } + + if (!substream) + return -EINVAL; + + hstr_p = azx_stream(azx_dev); + hstr_p->direction = substream->stream; + + err = snd_i2s_stream_set_params(azx_stream(azx_dev), 0); + if (err < 0) + goto unlock; + + snd_i2s_stream_setup(azx_stream(azx_dev), dev->pcie, dev->paddr); + + unlock: + if (!err) + azx_stream(azx_dev)->prepared = 1; + + return err; +} + +void snd_i2s_stream_clear(struct i2s_stream *azx_dev) +{ + if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0x0); + else + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0x0); + + azx_dev->running = false; +} + +void snd_i2s_stream_stop(struct i2s_stream *azx_dev) +{ + snd_i2s_stream_clear(azx_dev); +} + +void snd_i2s_stream_start(struct i2s_stream *azx_dev, bool fresh_start) +{ + if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0x1); + else + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0x5); + + azx_dev->running = true; +} + +static int phytium_pcm_trigger(struct snd_soc_component *component, + struct snd_pcm_substream *substream, int cmd) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + + struct azx *chip = &dev->chip; + struct i2sc_bus *bus = azx_bus(chip); + struct azx_dev *azx_dev = get_azx_dev(substream); + struct snd_pcm_substream *s; + struct i2s_stream *hstr; + bool start; + int sbits = 0; + + hstr = azx_stream(azx_dev); + hstr->direction = substream->stream; + + switch (cmd) { + case SNDRV_PCM_TRIGGER_START: + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: + case SNDRV_PCM_TRIGGER_RESUME: + start = true; + break; + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: + case SNDRV_PCM_TRIGGER_SUSPEND: + case SNDRV_PCM_TRIGGER_STOP: + start = false; + break; + default: + return -EINVAL; + } + + snd_pcm_group_for_each_entry(s, substream) { + if (s->pcm->card != substream->pcm->card) + continue; + azx_dev = get_azx_dev(s); + sbits |= 1 << azx_dev->core.index; + snd_pcm_trigger_done(s, substream); + } + + spin_lock(&bus->reg_lock); + + snd_pcm_group_for_each_entry(s, substream) { + if (s->pcm->card != substream->pcm->card) + continue; + azx_dev = get_azx_dev(s); + if (start) + snd_i2s_stream_start(azx_stream(azx_dev), true); + else + snd_i2s_stream_stop(azx_stream(azx_dev)); + } + + i2s_write_reg(dev->regs_db, DMA_CTL, 0x1); + spin_unlock(&bus->reg_lock); + + return 0; +} + +void snd_i2s_stream_cleanup(struct i2s_stream *azx_dev) +{ + int cnt = 10; + u32 mask; + + if (azx_dev->sd_addr) { + if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) { + mask = i2s_read_reg(azx_dev->sd_addr, DMA_MASK_INT); + mask &= ~BIT(0); + i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, mask); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0); + while (cnt--) { + if (i2s_read_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0)) == 0) + break; + } + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 2); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(0), 0); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(0), 0); + } else { + mask = i2s_read_reg(azx_dev->sd_addr, DMA_MASK_INT); + mask &= ~BIT(1); + i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, mask); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0); + while (cnt--) { + if (i2s_read_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1)) == 0) + break; + } + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 2); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(1), 0); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(1), 0); + } + } +} + +static int phytium_pcm_hw_free(struct snd_soc_component *component, + struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + + struct azx *chip = &dev->chip; + struct i2s_stream *hstr_p; + struct azx_dev *azx_dev = get_azx_dev(substream); + int err; + + hstr_p = azx_stream(azx_dev); + hstr_p->direction = substream->stream; + snd_i2s_stream_cleanup(azx_stream(azx_dev)); + + err = chip->ops->substream_free_pages(chip, substream); + azx_stream(azx_dev)->prepared = 0; + + return err; +} + +static snd_pcm_uframes_t phytium_pcm_pointer(struct snd_soc_component *component, + struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + + int stream = substream->stream; + + u32 pos = i2s_read_reg(dev->regs_db, DMA_LPIB(stream)); + + return bytes_to_frames(substream->runtime, pos); +} + +static const struct snd_soc_component_driver phytium_i2s_component = { + .name = "phytium-i2s", + .pcm_construct = phytium_pcm_new, + .suspend = phytium_i2s_suspend, + .resume = phytium_i2s_resume, + + .open = phytium_pcm_open, + .close = phytium_pcm_close, + .hw_params = phytium_pcm_hw_params, + .prepare = phytium_pcm_prepare, + .hw_free = phytium_pcm_hw_free, + .trigger = phytium_pcm_trigger, + .pointer = phytium_pcm_pointer, +}; + +/* Maximum bit resolution of a channel - not uniformly spaced */ +static const u32 fifo_width[COMP_MAX_WORDSIZE] = { + 12, 16, 20, 24, 32, 0, 0, 0 +}; + +/* Width of (DMA) bus */ +static const u32 bus_widths[COMP_MAX_DATA_WIDTH] = { + DMA_SLAVE_BUSWIDTH_1_BYTE, + DMA_SLAVE_BUSWIDTH_2_BYTES, + DMA_SLAVE_BUSWIDTH_4_BYTES, + DMA_SLAVE_BUSWIDTH_UNDEFINED +}; + +/* PCM format to support channel resolution */ +static const u32 formats[COMP_MAX_WORDSIZE] = { + SNDRV_PCM_FMTBIT_S16_LE, + SNDRV_PCM_FMTBIT_S16_LE, + SNDRV_PCM_FMTBIT_S24_LE, + SNDRV_PCM_FMTBIT_S24_LE, + SNDRV_PCM_FMTBIT_S32_LE, + 0, + 0, + 0 +}; + +static int phytium_configure_dai(struct i2s_phytium *dev) +{ + u32 comp1 = i2s_read_reg(dev->regs, dev->i2s_reg_comp1); + u32 comp2 = i2s_read_reg(dev->regs, dev->i2s_reg_comp2); + u32 fifo_depth = 1 << (1 + COMP1_FIFO_DEPTH_GLOBAL(comp1)); + u32 idx; + + if (COMP1_TX_ENABLED(comp1)) { + dev_dbg(dev->dev, " phytium: play supported\n"); + idx = COMP1_TX_WORDSIZE_0(comp1); + if (WARN_ON(idx >= ARRAY_SIZE(formats))) + return -EINVAL; + } + + if (COMP1_RX_ENABLED(comp1)) { + dev_dbg(dev->dev, "phytium: record supported\n"); + idx = COMP2_RX_WORDSIZE_0(comp2); + if (WARN_ON(idx >= ARRAY_SIZE(formats))) + return -EINVAL; + if (dev->quirks & PHYTIUM_I2S_QUIRK_16BIT_IDX_OVERRIDE) + idx = 1; + } + + if (COMP1_MODE_EN(comp1)) { + dev_dbg(dev->dev, "phytium: i2s master mode supported\n"); + dev->capability |= PHYTIUM_I2S_MASTER; + } else { + dev_dbg(dev->dev, "phytium: i2s slave mode supported\n"); + dev->capability |= PHYTIUM_I2S_SLAVE; + } + + dev->fifo_th = fifo_depth / 2; + return 0; +} + +static int phytium_configure_dai_by_dt(struct i2s_phytium *dev) +{ + u32 comp1 = i2s_read_reg(dev->regs, I2S_COMP_PARAM_1); + u32 comp2 = i2s_read_reg(dev->regs, I2S_COMP_PARAM_2); + u32 idx = COMP1_APB_DATA_WIDTH(comp1); + u32 idx2; + int ret; + + if (WARN_ON(idx >= ARRAY_SIZE(bus_widths))) + return -EINVAL; + + ret = phytium_configure_dai(dev); + if (ret < 0) + return ret; + + if (COMP1_TX_ENABLED(comp1)) { + idx2 = COMP1_TX_WORDSIZE_0(comp1); + dev->capability |= PHYTIUM_I2S_PLAY; + } + if (COMP1_RX_ENABLED(comp1)) { + idx2 = COMP2_RX_WORDSIZE_0(comp2); + dev->capability |= PHYTIUM_I2S_RECORD; + } + + return 0; +} + +static int phytium_dma_alloc_pages(struct i2sc_bus *bus, int type, size_t size, + struct snd_dma_buffer *buf) +{ + int err; + + err = snd_dma_alloc_pages(type, bus->dev, size, buf); + if (err < 0) + return err; + + return 0; +} + +int snd_i2s_bus_alloc_stream_pages(struct i2sc_bus *bus) +{ + struct i2s_stream *s; + int num_streams = 0; + int err; + + list_for_each_entry(s, &bus->stream_list, list) { + + /* allocate memory for the BDL for each stream */ + err = bus->io_ops->dma_alloc_pages(bus, SNDRV_DMA_TYPE_DEV, + BDL_SIZE, &s->bdl); + if (num_streams == 0) { + bus->bdl0.addr = s->bdl.addr; + bus->bdl0.area = s->bdl.area; + } else { + bus->bdl1.addr = s->bdl.addr; + bus->bdl1.area = s->bdl.area; + } + num_streams++; + if (err < 0) + return -ENOMEM; + } + + if (WARN_ON(!num_streams)) + return -EINVAL; + + return 0; +} + +static int stream_direction(struct azx *chip, unsigned char index) +{ + if (index >= chip->playback_index_offset && + index < chip->playback_index_offset + chip->playback_streams) + return SNDRV_PCM_STREAM_PLAYBACK; + return SNDRV_PCM_STREAM_CAPTURE; + +} + +void snd_i2s_stream_init(struct i2sc_bus *bus, struct i2s_stream *azx_dev, + int idx, int direction, int tag) +{ + azx_dev->bus = bus; + azx_dev->sd_addr = bus->remap_addr; + + if (idx == 0) + azx_dev->sd_int_sta_mask = 1 << idx; + else + azx_dev->sd_int_sta_mask = 1 << 8; + + azx_dev->index = idx; + azx_dev->direction = direction; + azx_dev->stream_tag = tag; + + list_add_tail(&azx_dev->list, &bus->stream_list); + +} + +int azx_i2s_init_streams(struct azx *chip) +{ + int i; + + for (i = 0; i < chip->num_streams; i++) { + struct azx_dev *azx_dev = kzalloc(sizeof(*azx_dev), GFP_KERNEL); + int dir, tag; + + if (!azx_dev) + return -ENOMEM; + + dir = stream_direction(chip, i); + + tag = i + 1; + + snd_i2s_stream_init(azx_bus(chip), azx_stream(azx_dev), + i, dir, tag); + } + + return 0; +} + +static int azx_first_init(struct azx *chip) +{ + struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); + struct platform_device *pdev = to_platform_device(i2s->dev); + struct device *i2sdev = i2s->dev; + struct i2sc_bus *bus = azx_bus(chip); + struct resource *res; + int err; + unsigned int dma_bits = 64; + + chip->region_requested = 1; + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + bus->addr = res->start; + bus->remap_addr = i2s->regs_db; + bus->dev = i2s->pdev; + + if (bus->remap_addr == NULL) { + dev_err(i2sdev, "ioremap error\n"); + return -ENXIO; + } + + if (azx_acquire_irq(chip, 0) < 0) + return -EBUSY; + + synchronize_irq(bus->irq); + + spin_lock_init(&bus->reg_lock); + + if (!dma_set_mask(i2sdev, DMA_BIT_MASK(dma_bits))) { + err = dma_set_coherent_mask(i2sdev, DMA_BIT_MASK(dma_bits)); + } else { + err = dma_set_mask(i2sdev, DMA_BIT_MASK(32)); + err = dma_set_coherent_mask(i2sdev, DMA_BIT_MASK(32)); + } + + chip->playback_streams = NUM_PLAYBACK; + chip->capture_streams = NUM_CAPTURE; + + chip->playback_index_offset = 0; + chip->capture_index_offset = chip->playback_streams; + chip->num_streams = chip->playback_streams + chip->capture_streams; + + err = azx_i2s_init_streams(chip); + if (err < 0) + return err; + + err = azx_alloc_stream_pages(chip); + if (err < 0) + return err; + + return 0; +} + +static int azx_probe_continue(struct azx *chip) +{ + struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); + int err; + + i2s->probe_continued = 1; + + err = azx_first_init(chip); + if (err < 0) + goto out_free; + + chip->running = 1; + +out_free: + return err; +} + +static void azx_probe_work(struct work_struct *work) +{ + struct i2s_phytium *i2s = container_of(work, struct i2s_phytium, probe_work); + + azx_probe_continue(&i2s->chip); +} + +int azx_i2s_bus_init(struct azx *chip, + const struct i2s_io_ops *io_ops) +{ + struct i2s_bus *bus = &chip->bus; + + bus->core.io_ops = io_ops; + + INIT_LIST_HEAD(&bus->core.stream_list); + bus->card = chip->card; + mutex_init(&bus->prepare_mutex); + bus->pci = chip->pci; + + bus->core.bdl_pos_adj = chip->bdl_pos_adj; + return 0; +} + +static int i2s_phytium_create(struct platform_device *pdev, + int dev, struct azx **rchip, struct i2s_phytium *i2s) +{ + struct azx *chip; + int err; + + *rchip = NULL; + + if (!i2s) + return -ENOMEM; + chip = &i2s->chip; + + mutex_init(&chip->open_mutex); + + chip->ops = &axi_i2s_ops; + chip->dev_index = dev; + + INIT_LIST_HEAD(&chip->pcm_list); + init_completion(&i2s->probe_wait); + + chip->bdl_pos_adj = 32; + err = azx_i2s_bus_init(chip, &axi_i2s_io_ops); + if (err < 0) { + kfree(i2s); + return err; + } + + INIT_WORK(&i2s->probe_work, azx_probe_work); + *rchip = chip; + return 0; +} + +static int substream_alloc_pages(struct azx *chip, + struct snd_pcm_substream *substream, + size_t size) +{ + int ret; + + ret = snd_pcm_lib_malloc_pages(substream, size); + if (ret < 0) + return ret; + + return 0; +} + +static void phytium_dma_free_pages(struct i2sc_bus *bus, + struct snd_dma_buffer *buf) +{ + snd_dma_free_pages(buf); +} + +static const struct i2s_io_ops axi_i2s_io_ops = { + .dma_alloc_pages = phytium_dma_alloc_pages, + .dma_free_pages = phytium_dma_free_pages, +}; + +static const struct i2s_controller_ops axi_i2s_ops = { + .substream_alloc_pages = substream_alloc_pages, + .substream_free_pages = substream_free_pages, +}; + + +static int phytium_i2s_probe(struct platform_device *pdev) +{ + struct i2s_phytium *i2s; + struct azx *chip; + struct resource *res; + struct pdata_px210_mfd *pdata; + struct snd_soc_dai_driver *dai_drv; + struct clk *clk; + int err, ret; + int card_num = 1; + bool schedule_probe; + struct fwnode_handle *np; + + i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL); + if (!i2s) + return -ENOMEM; + + dai_drv = devm_kzalloc(&pdev->dev, sizeof(*dai_drv), GFP_KERNEL); + if (!dai_drv) + return -ENOMEM; + memcpy(dai_drv, &phytium_i2s_dai, sizeof(phytium_i2s_dai)); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + i2s->paddr = res->start; + i2s->regs = devm_ioremap_resource(&pdev->dev, res); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 1); + i2s->regs_db = devm_ioremap_resource(&pdev->dev, res); + + if (IS_ERR(i2s->regs)) + return PTR_ERR(i2s->regs); + + i2s->irq_id = platform_get_irq(pdev, 0); + + if (i2s->irq_id < 0) + return i2s->irq_id; + + i2s->i2s_reg_comp1 = I2S_COMP_PARAM_1; + i2s->i2s_reg_comp2 = I2S_COMP_PARAM_2; + + ret = phytium_configure_dai_by_dt(i2s); + if (ret < 0) + return ret; + + err = i2s_phytium_create(pdev, card_num, &chip, i2s); + if (err < 0) + return err; + i2s = container_of(chip, struct i2s_phytium, chip); + schedule_probe = !chip->disabled; + + dev_set_drvdata(&pdev->dev, i2s); + + pdata = dev_get_platdata(&pdev->dev); + i2s->dev = &pdev->dev; + if (pdata) { + dai_drv->name = pdata->name; + i2s->pdev = pdata->dev; + i2s->clk_base = pdata->clk_base; + i2s->pcie = 1; + } else if (pdev->dev.of_node) { + device_property_read_string(&pdev->dev, "dai-name", &dai_drv->name); + i2s->pdev = &pdev->dev; + clk = devm_clk_get(&pdev->dev, NULL); + i2s->clk_base = clk_get_rate(clk); + } else if (has_acpi_companion(&pdev->dev)) { + np = dev_fwnode(&(pdev->dev)); + ret = fwnode_property_read_string(np, "dai-name", &dai_drv->name); + if (ret < 0) { + dev_err(&pdev->dev, "missing dai-name property from acpi\n"); + goto failed_get_dai_name; + } + i2s->pdev = &pdev->dev; + ret = fwnode_property_read_u32(np, "i2s_clk", &i2s->clk_base); + if (ret < 0) { + dev_err(&pdev->dev, "missing i2s_clk property from acpi\n"); + goto failed_get_dai_name; + } + } + ret = devm_snd_soc_register_component(&pdev->dev, &phytium_i2s_component, + dai_drv, 1); + if (ret != 0) + dev_err(&pdev->dev, "not able to register dai\n"); + + if (schedule_probe) + schedule_work(&i2s->probe_work); + + if (chip->disabled) + complete_all(&i2s->probe_wait); + + return 0; +failed_get_dai_name: + return ret; +} + +static int phytium_i2s_remove(struct platform_device *pdev) +{ + pm_runtime_disable(&pdev->dev); + return 0; +} + +static const struct of_device_id phytium_i2s_of_match[] = { + { .compatible = "phytium,i2s", }, + {}, +}; +MODULE_DEVICE_TABLE(of, phytium_i2s_of_match); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_i2s_acpi_match[] = { + { "PHYT0016", 0}, + { } +}; +MODULE_DEVICE_TABLE(acpi, phytium_i2s_acpi_match); +#else +#define phytium_i2s_acpi_match NULL +#endif + +static struct platform_driver phytium_i2s_driver = { + .probe = phytium_i2s_probe, + .remove = phytium_i2s_remove, + .driver = { + .name = "phytium-i2s", + .of_match_table = of_match_ptr(phytium_i2s_of_match), + .acpi_match_table = phytium_i2s_acpi_match, + }, +}; + +module_platform_driver(phytium_i2s_driver); + +MODULE_DESCRIPTION("Phytium I2S Driver"); +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Zhang Yiqun "); diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/pmdk_dp.c b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/pmdk_dp.c new file mode 100755 index 0000000000000000000000000000000000000000..8f7b72504882fe50159d6a220519ca4c9ed45a2b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/pmdk_dp.c @@ -0,0 +1,235 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include + +#define DAI_CNT(pmdk_dai_) sizeof(pmdk_dai_)/sizeof(struct snd_soc_dai_link) + +struct pmdk_dp_private { + struct snd_soc_jack jack0; + struct snd_soc_jack jack1; + struct snd_soc_jack jack2; +}; + +/* PMDK widgets */ +static const struct snd_soc_dapm_widget pmdk_dp_dapm_widgets[] = { + SND_SOC_DAPM_LINE("DP", NULL), +}; + +/* PMDK control */ +static const struct snd_kcontrol_new pmdk_controls[] = { + SOC_DAPM_PIN_SWITCH("DP"), +}; + +/* PMDK connections */ +static const struct snd_soc_dapm_route pmdk_dp_audio_map[] = { + {"DP", NULL, "TX"}, +}; + +static struct snd_soc_jack_pin dp0_pins[] = { + { + .pin = "HDMI/DP,pcm=0", + .mask = SND_JACK_LINEOUT, + }, +}; + +static struct snd_soc_jack_pin dp1_pins[] = { + { + .pin = "HDMI/DP,pcm=1", + .mask = SND_JACK_LINEOUT, + }, +}; + +static struct snd_soc_jack_pin dp2_pins[] = { + { + .pin = "HDMI/DP,pcm=2", + .mask = SND_JACK_LINEOUT, + }, +}; + +#define SMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ + SND_SOC_DAIFMT_CBS_CFS) + +static int pmdk_dp0_init(struct snd_soc_pcm_runtime *runtime) +{ + struct snd_soc_card *card = runtime->card; + struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); + struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; + int ret; + + ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=0", + SND_JACK_LINEOUT, + &priv->jack0, dp0_pins, + ARRAY_SIZE(dp0_pins)); + if (ret) { + dev_err(card->dev, "Jack creation failed %d\n", ret); + return ret; + } + snd_soc_component_set_jack(component, &priv->jack0, NULL); + return ret; +} + +static int pmdk_dp1_init(struct snd_soc_pcm_runtime *runtime) +{ + struct snd_soc_card *card = runtime->card; + struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); + struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; + int ret; + + ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=1", + SND_JACK_LINEOUT, + &priv->jack1, dp1_pins, + ARRAY_SIZE(dp1_pins)); + + if (ret) { + dev_err(card->dev, "Jack creation failed %d\n", ret); + return ret; + } + snd_soc_component_set_jack(component, &priv->jack1, NULL); + return ret; +} + +static int pmdk_dp2_init(struct snd_soc_pcm_runtime *runtime) +{ + struct snd_soc_card *card = runtime->card; + struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); + struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; + int ret; + + ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=2", + SND_JACK_LINEOUT, + &priv->jack2, dp2_pins, + ARRAY_SIZE(dp2_pins)); + if (ret) { + dev_err(card->dev, "Jack creation failed %d\n", ret); + return ret; + } + snd_soc_component_set_jack(component, &priv->jack2, NULL); + return ret; +} + +SND_SOC_DAILINK_DEFS(pmdk_dp0_dai, + DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp0")), + DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918656", "i2s-hifi")), + DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); + +SND_SOC_DAILINK_DEFS(pmdk_dp1_dai, + DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp1")), + DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918657", "i2s-hifi")), + DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); + +SND_SOC_DAILINK_DEFS(pmdk_dp2_dai, + DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp2")), + DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918658", "i2s-hifi")), + DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); + +static struct snd_soc_dai_link pmdk_dai_local[] = { +{ + .name = "Phytium dp0-audio", + .stream_name = "Playback", + .dai_fmt = SMDK_DAI_FMT, + .init = pmdk_dp0_init, + SND_SOC_DAILINK_REG(pmdk_dp0_dai), +},{ + .name = "Phytium dp1-audio", + .stream_name = "Playback", + .dai_fmt = SMDK_DAI_FMT, + .init = pmdk_dp1_init, + SND_SOC_DAILINK_REG(pmdk_dp1_dai), +}, +{ + .name = "Phytium dp2-audio", + .stream_name = "Playback", + .dai_fmt = SMDK_DAI_FMT, + .init = pmdk_dp2_init, + SND_SOC_DAILINK_REG(pmdk_dp2_dai), +}, +}; + +static struct snd_soc_card pmdk = { + .name = "PMDK-I2S", + .owner = THIS_MODULE, + + .dapm_widgets = pmdk_dp_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(pmdk_dp_dapm_widgets), + .controls = pmdk_controls, + .num_controls = ARRAY_SIZE(pmdk_controls), + .dapm_routes = pmdk_dp_audio_map, + .num_dapm_routes = ARRAY_SIZE(pmdk_dp_audio_map), +}; + +static int pmdk_sound_probe(struct platform_device *pdev) +{ + struct snd_soc_card *card = &pmdk; + struct pmdk_dp_private *priv; + struct snd_soc_dai_link *pmdk_dai; + int num_dp = 2; + char dp_mask = 0x7; + int i,j = 0; + card->dev = &pdev->dev; + + device_property_read_u32(&pdev->dev, "num-dp", &num_dp); + device_property_read_u8(&pdev->dev, "dp-mask", &dp_mask); + pmdk_dai = devm_kzalloc(&pdev->dev, num_dp * sizeof(*pmdk_dai), GFP_KERNEL); + if (!pmdk_dai) + return -ENOMEM; + + if (!num_dp || num_dp > DAI_CNT(pmdk_dai_local)) + return -EINVAL; + + for(i = 0; i < num_dp; i++) { + for (; j < DAI_CNT(pmdk_dai_local); j++) { + if (BIT(j) & dp_mask) { + pmdk_dai[i] = pmdk_dai_local[j]; + j++; + break; + } + } + } + + card->dai_link = pmdk_dai; + card->num_links = num_dp; + + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); + if (!priv) + return -ENOMEM; + + snd_soc_card_set_drvdata(card, priv); + + return devm_snd_soc_register_card(&pdev->dev, card); +} + +static const struct of_device_id pmdk_sound_of_match[] = { + { .compatible = "phytium,pmdk-dp",}, + { } +}; +MODULE_DEVICE_TABLE(of, pmdk_sound_of_match); + +static const struct acpi_device_id pmdk_sound_acpi_match[] = { + { "PHYT8006", 0}, + { } +}; +MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); + +static struct platform_driver pmdk_sound_driver = { + .probe = pmdk_sound_probe, + .driver = { + .name = "pmdk_dp", + .acpi_match_table = pmdk_sound_acpi_match, + .of_match_table = pmdk_sound_of_match, +#ifdef CONFIG_PM + .pm = &snd_soc_pm_ops, +#endif + }, +}; + +module_platform_driver(pmdk_sound_driver); + +MODULE_AUTHOR("Zhang Yiqun"); +MODULE_DESCRIPTION("ALSA SoC PMDK DP"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/pmdk_es8336.c b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/pmdk_es8336.c new file mode 100644 index 0000000000000000000000000000000000000000..680fdbfdd99273ab749582226a232e32d9c0173d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/pmdk_es8336.c @@ -0,0 +1,96 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include + +/* PMDK widgets */ +static const struct snd_soc_dapm_widget pmdk_es8336_dapm_widgets[] = { + SND_SOC_DAPM_HP("HP", NULL), + SND_SOC_DAPM_MIC("Int Mic", NULL), + SND_SOC_DAPM_MIC("Mic In", NULL), +}; + +/* PMDK control */ +static const struct snd_kcontrol_new pmdk_controls[] = { + SOC_DAPM_PIN_SWITCH("HP"), + SOC_DAPM_PIN_SWITCH("Int Mic"), + SOC_DAPM_PIN_SWITCH("Mic In"), +}; + +/* PMDK connections */ +static const struct snd_soc_dapm_route pmdk_es8336_audio_map[] = { + {"DMIC", NULL, "Int Mic"}, + {"MIC1", NULL, "Mic In"}, + {"MIC2", NULL, "Mic In"}, + + {"HP", NULL, "HPOL"}, + {"HP", NULL, "HPOR"}, +}; + +#define PMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ + SND_SOC_DAIFMT_CBS_CFS) + +SND_SOC_DAILINK_DEFS(pmdk_es8366, + DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-lsd")), + DAILINK_COMP_ARRAY(COMP_CODEC("i2c-ESSX8336:00", "es8336-hifi")), + DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); + +static struct snd_soc_dai_link pmdk_dai[] = { + { + .name = "ES8336 HIFI", + .stream_name = "ES8336 HIFI", + .dai_fmt = PMDK_DAI_FMT, + SND_SOC_DAILINK_REG(pmdk_es8366), + }, +}; + +static struct snd_soc_card pmdk = { + .name = "PMDK-I2S", + .owner = THIS_MODULE, + .dai_link = pmdk_dai, + .num_links = ARRAY_SIZE(pmdk_dai), + + .dapm_widgets = pmdk_es8336_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(pmdk_es8336_dapm_widgets), + .controls = pmdk_controls, + .num_controls = ARRAY_SIZE(pmdk_controls), + .dapm_routes = pmdk_es8336_audio_map, + .num_dapm_routes = ARRAY_SIZE(pmdk_es8336_audio_map), +}; + +static int pmdk_sound_probe(struct platform_device *pdev) +{ + struct snd_soc_card *card = &pmdk; + struct device *dev = &pdev->dev; + + card->dev = dev; + + return devm_snd_soc_register_card(&pdev->dev, card); +} + +static const struct acpi_device_id pmdk_sound_acpi_match[] = { + { "PHYT8005", 0}, + { } +}; +MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); + +static struct platform_driver pmdk_sound_driver = { + .probe = pmdk_sound_probe, + .driver = { + .name = "pmdk_es8336", + .acpi_match_table = pmdk_sound_acpi_match, +#ifdef CONFIG_PM + .pm = &snd_soc_pm_ops, +#endif + }, +}; + +module_platform_driver(pmdk_sound_driver); +MODULE_AUTHOR("Zhang Yiqun "); +MODULE_DESCRIPTION("ALSA SoC PMDK ES8336"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/pmdk_es8388.c b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/pmdk_es8388.c new file mode 100644 index 0000000000000000000000000000000000000000..ece718469267d0d3566c944021fcdc0bb0ae4a8f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-5.10/sound/soc/phytium/pmdk_es8388.c @@ -0,0 +1,169 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include + +static struct snd_soc_jack hs_jack; + +/* Headset jack detection DAPM pins */ +static struct snd_soc_jack_pin hs_jack_pins[] = { + { + .pin = "FrontIn", + .mask = SND_JACK_MICROPHONE, + }, + { + .pin = "RearIn", + .mask = SND_JACK_MICROPHONE, + .invert = 1 + }, + { + .pin = "Front", + .mask = SND_JACK_HEADPHONE, + }, + { + .pin = "Rear", + .mask = SND_JACK_HEADPHONE, + .invert = 1 + }, +}; + +/* Headset jack detection gpios */ +static struct snd_soc_jack_gpio hs_jack_gpios[] = { + { + .name = "det", + .report = SND_JACK_HEADSET, + .debounce_time = 200, + .invert = 1, + }, +}; + +/* PMDK widgets */ +static const struct snd_soc_dapm_widget pmdk_es8388_dapm_widgets[] = { + SND_SOC_DAPM_HP("Front", NULL), + SND_SOC_DAPM_HP("Rear", NULL), + + SND_SOC_DAPM_MIC("FrontIn", NULL), + SND_SOC_DAPM_MIC("RearIn", NULL), +}; + +/* PMDK control */ +static const struct snd_kcontrol_new pmdk_controls[] = { + SOC_DAPM_PIN_SWITCH("Front"), + SOC_DAPM_PIN_SWITCH("Rear"), + SOC_DAPM_PIN_SWITCH("FrontIn"), + SOC_DAPM_PIN_SWITCH("RearIn"), +}; + +/* PMDK connections */ +static const struct snd_soc_dapm_route pmdk_es8388_audio_map[] = { + {"LINPUT1", NULL, "FrontIn"}, + {"RINPUT1", NULL, "FrontIn"}, + + {"LINPUT2", NULL, "RearIn"}, + {"RINPUT2", NULL, "RearIn"}, + + {"Front", NULL, "LOUT1"}, + {"Front", NULL, "ROUT1"}, + + {"Rear", NULL, "LOUT2"}, + {"Rear", NULL, "ROUT2"}, +}; + +static int pmdk_es8388_init(struct snd_soc_pcm_runtime *rtd) +{ + int ret; + + /* Jack detection API stuff */ + ret = snd_soc_card_jack_new(rtd->card, "Headset Jack", SND_JACK_HEADSET, + &hs_jack, hs_jack_pins, + ARRAY_SIZE(hs_jack_pins)); + if (ret) + goto err; + + ret = snd_soc_jack_add_gpios(&hs_jack, ARRAY_SIZE(hs_jack_gpios), + hs_jack_gpios); + if (ret) + goto err; + + return 0; + +err: + return ret; +} + +#define PMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ + SND_SOC_DAIFMT_CBS_CFS) + +SND_SOC_DAILINK_DEFS(pmdk_es8388, + DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-lsd")), + DAILINK_COMP_ARRAY(COMP_CODEC("i2c-ESSX8388:00", "es8388-hifi")), + DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); + +static struct snd_soc_dai_link pmdk_dai[] = { + { + .name = "ES8388 HIFI", + .stream_name = "ES8388 HIFI", + .dai_fmt = PMDK_DAI_FMT, + .init = pmdk_es8388_init, + SND_SOC_DAILINK_REG(pmdk_es8388), + }, +}; + +static struct snd_soc_card pmdk = { + .name = "PMDK-I2S", + .owner = THIS_MODULE, + .dai_link = pmdk_dai, + .num_links = ARRAY_SIZE(pmdk_dai), + + .dapm_widgets = pmdk_es8388_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(pmdk_es8388_dapm_widgets), + .controls = pmdk_controls, + .num_controls = ARRAY_SIZE(pmdk_controls), + .dapm_routes = pmdk_es8388_audio_map, + .num_dapm_routes = ARRAY_SIZE(pmdk_es8388_audio_map), +}; + +static int pmdk_sound_probe(struct platform_device *pdev) +{ + struct snd_soc_card *card = &pmdk; + struct device *dev = &pdev->dev; + int n; + + card->dev = dev; + hs_jack_gpios[0].gpiod_dev = dev; + n = gpiod_count(dev, "det"); + + if (n < 0) + pmdk_dai[0].init = NULL; + + return devm_snd_soc_register_card(&pdev->dev, card); +} + +static const struct acpi_device_id pmdk_sound_acpi_match[] = { + { "PHYT8004", 0}, + { } +}; +MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); + +static struct platform_driver pmdk_sound_driver = { + .probe = pmdk_sound_probe, + .driver = { + .name = "pmdk_es8388", + .acpi_match_table = pmdk_sound_acpi_match, +#ifdef CONFIG_PM + .pm = &snd_soc_pm_ops, +#endif + }, +}; + +module_platform_driver(pmdk_sound_driver); + +MODULE_AUTHOR("Zhang Yiqun"); +MODULE_DESCRIPTION("ALSA SoC PMDK ES8388"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/char/hw_random/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/hw_random/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..d820d6ea46bcb82ca25bd9a5d47b1bd38543527e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/hw_random/Kconfig @@ -0,0 +1,12 @@ +config HW_RANDOM_PHYTIUM + tristate "Phytium Random Number Generator support" + depends on ARCH_PHYTIUM || COMPILE_TEST + help + This driver provides kernel-side support for the Random Number + Generator hardware found on Phytium SoCs. + + To compile this driver as a module, choose M here: the + module will be called phytium-rng. + + If unsure, say Y. + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/char/hw_random/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/hw_random/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..5571b11e1a98c5d251a793e485ae9013a0d50bed --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/hw_random/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_HW_RANDOM_PHYTIUM) += phytium-rng.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/char/hw_random/phytium-rng.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/hw_random/phytium-rng.c new file mode 100644 index 0000000000000000000000000000000000000000..367a96c05c2b61f39d6acee70a3cdf0ecf2e0dff --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/hw_random/phytium-rng.c @@ -0,0 +1,154 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SoC RNG Driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define TRNG_CR 0x00 +#define TRNG_CR_RNGEN BIT(0) +#define TRNG_CR_ROSEN_MASK GENMASK(7, 4) +#define TRNG_CR_DIEN BIT(16) +#define TRNG_CR_ERIEN BIT(17) +#define TRNG_CR_IRQEN BIT(24) +#define TRNG_MSEL 0x04 +#define TRNG_MSEL_MSEL BIT(0) +#define TRNG_SR 0x08 +#define TRNG_SR_HTF BIT(0) +#define TRNG_SR_DRDY BIT(1) +#define TRNG_SR_ERERR BIT(3) +#define TRNG_DR 0x0C +#define TRNG_RESEED 0x40 +#define TRNG_RESEED_RSED BIT(0) + +#define DELAY 10 +#define TIMEOUT 100 + +static int msel; +module_param(msel, int, 0444); +MODULE_PARM_DESC(msel, "Phytium RNG mode selection: 0 - TRNG. 1 - PRNG."); + +struct phytium_rng { + struct hwrng rng; + void __iomem *base; +}; + +static int phytium_rng_init(struct hwrng *rng) +{ + struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); + u32 reg; + + /* Mode Selection */ + reg = msel ? TRNG_MSEL_MSEL : 0; + writel(reg, priv->base + TRNG_MSEL); + + /* If PRGN mode is on, do reseed operations */ + if (msel) + writel(TRNG_RESEED_RSED, priv->base + TRNG_RESEED); + + /* Clear status */ + writel(0x7, priv->base + TRNG_SR); + + /* Enable TRNG */ + reg = readl(priv->base + TRNG_CR) | TRNG_CR_ROSEN_MASK | TRNG_CR_RNGEN; + writel(reg, priv->base + TRNG_CR); + + return 0; +} + +static void phytium_rng_cleanup(struct hwrng *rng) +{ + struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); + + writel(0x7, priv->base + TRNG_SR); +} + +static int phytium_rng_read(struct hwrng *rng, void *buf, size_t max, bool wait) +{ + struct phytium_rng *priv = container_of(rng, struct phytium_rng, rng); + u32 reg; + int ret = 0; + + /* TRNG can generate at most 8*32bit random number per time */ + max = max > 8 ? 8 : max; + + reg = readl(priv->base + TRNG_SR); + if (!(reg & TRNG_SR_DRDY) && wait) { + ret = readl_poll_timeout(priv->base + TRNG_SR, reg, + reg & TRNG_SR_DRDY, DELAY, TIMEOUT); + if (ret) { + dev_err((struct device *)priv->rng.priv, + "%s: timeout %x!\n", __func__, reg); + return -EIO; + } + } + + while (max > 4) { + *(u32 *)buf = readl(priv->base + TRNG_DR); + + ret += sizeof(u32); + buf += sizeof(u32); + max -= sizeof(u32); + } + + /* Clear DRDY by writing 1 */ + writel(reg | TRNG_SR_DRDY, priv->base + TRNG_SR); + + return ret; +} + +static int scto_rng_probe(struct platform_device *pdev) +{ + struct phytium_rng *priv; + struct resource *mem; + + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); + if (!priv) + return -ENOMEM; + + platform_set_drvdata(pdev, priv); + + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); + priv->base = devm_ioremap_resource(&pdev->dev, mem); + if (IS_ERR(priv->base)) + return PTR_ERR(priv->base); + + priv->rng.name = pdev->name; + priv->rng.init = phytium_rng_init; + priv->rng.cleanup = phytium_rng_cleanup; + priv->rng.read = phytium_rng_read; + priv->rng.priv = (unsigned long)&pdev->dev; + + return devm_hwrng_register(&pdev->dev, &priv->rng); +} + +static const struct of_device_id phytium_rng_dt_ids[] = { + { .compatible = "phytium,rng" }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_rng_dt_ids); + +static struct platform_driver phytium_rng_driver = { + .probe = scto_rng_probe, + .driver = { + .name = "phytium-rng", + .of_match_table = of_match_ptr(phytium_rng_dt_ids), + } +}; +module_platform_driver(phytium_rng_driver); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium random number generator driver"); +MODULE_AUTHOR("Chen Baozi "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/char/ipmi/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/ipmi/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..e1c26928c397d4cbb5bccdba30fde8c2ea889b68 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/ipmi/Kconfig @@ -0,0 +1,22 @@ +config PHYTIUM_KCS_IPMI_BMC + depends on ARCH_PHYTIUM + select IPMI_KCS_BMC + select REGMAP_MMIO + tristate "PHYTIUM KCS IPMI BMC driver" + help + Provides a driver for the KCS (Kerboard Controller Style) IPMI + interface found on Phytium SOCs. + + The driver implements the BMC side of the KCS controller, it + provides the access of KCS IO space for BMC side. + +config PHYTIUM_BT_IPMI_BMC + depends on ARCH_PHYTIUM + depends on REGMAP && REGMAP_MMIO && MFD_SYSCON + tristate "PHYTIUM BT BMC driver" + help + Provides a driver for the BT (Block Transfer) IPMI interface + found on Phytium SOCs. The driver implements the BMC + side of the BT interface. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/char/ipmi/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/ipmi/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..949b07180e80669a0284afb55f11aadc0658317b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/ipmi/Makefile @@ -0,0 +1,2 @@ +obj-$(CONFIG_PHYTIUM_KCS_IPMI_BMC) += kcs_bmc_phytium.o +obj-$(CONFIG_PHYTIUM_BT_IPMI_BMC) += bt_bmc_phytium.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/char/ipmi/bt_bmc_phytium.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/ipmi/bt_bmc_phytium.c new file mode 100644 index 0000000000000000000000000000000000000000..1d4a50c14fa3001315a8e3291b5c221fbc157a62 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/ipmi/bt_bmc_phytium.c @@ -0,0 +1,533 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + * + * Derived from drivers/char/ipmi/bt-bmc.c + * Copyright (c) 2015-2016, IBM Corporation. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +/* + * This is a BMC device used to communicate to the host + */ +#define DEVICE_NAME "ipmi-bt-host" + +#define BT_IO_BASE 0xe4 +#define BT_IRQ 10 + +#define LPC_HICR0 0x00 +#define LPC_HICR0_LPC3E BIT(7) +#define LPC_HICR0_LPC2E BIT(6) +#define LPC_HICR0_LPC1E BIT(5) +#define LPC_HICR0_SDWNE BIT(3) /* 0:disabl,1:enable for HICR1_SDWNB */ +#define LPC_HICR0_PMEE BIT(2) /* 0:disabl,1:enable for HICR1_PMEB */ + +#define LPC_HICR2 0x08 +#define LPC_HICR2_IBFIF3 BIT(3) /* 0:normal,1:enable irq 3*/ + +#define LPC_HICR4 0x10 +#define LPC_HICR4_LADR12AS BIT(7) +#define LPC_HICR4_KCSENBL BIT(2) +#define LPC_BTENABLE BIT(0) /* share bt channel enable,0:disable,1:enable */ +#define LPC_LADR3H_BT 0x014 +#define LPC_LADR3L_BT 0x018 + +#define BT_CR1 0x4C +#define BT_CR1_IRQ_H2B 0x04 +#define BT_CR1_IRQ_HWRST 0x40 + +#define BT_CSR1 0x54 +#define BT_CSR1_IRQ_H2B 0x04 +#define BT_CSR1_IRQ_HWRST 0x40 + +#define BT_CTRL 0x58 +#define BT_CTRL_B_BUSY 0x80 +#define BT_CTRL_H_BUSY 0x40 +#define BT_CTRL_OEM0 0x20 +#define BT_CTRL_SMS_ATN 0x10 +#define BT_CTRL_B2H_ATN 0x08 +#define BT_CTRL_H2B_ATN 0x04 +#define BT_CTRL_CLR_RD_PTR 0x02 +#define BT_CTRL_CLR_WR_PTR 0x01 +#define BT_BMC2HOST 0x5C +#define BT_HOST2BMC 0x98 +#define BT_INTMASK 0x60 +#define BT_INTMASK_B2H_IRQEN 0x01 +#define BT_INTMASK_B2H_IRQ 0x02 +#define BT_INTMASK_BMC_HWRST 0x80 + +#define BT_BMC_BUFFER_SIZE 256 + +struct bt_bmc { + struct device dev; + struct miscdevice miscdev; + struct regmap *map; + int irq; + wait_queue_head_t queue; + struct timer_list poll_timer; + struct mutex mutex; +}; + +static atomic_t open_count = ATOMIC_INIT(0); + +static const struct regmap_config bt_regmap_cfg = { + .reg_bits = 32, + .val_bits = 32, + .reg_stride = 4, +}; + +static u8 bt_inb(struct bt_bmc *bt_bmc, int reg) +{ + uint32_t val = 0; + int rc; + + rc = regmap_read(bt_bmc->map, reg, &val); + WARN(rc != 0, "regmap_read() failed: %d\n", rc); + + return rc == 0 ? (u8) val : 0; +} + +static void bt_outb(struct bt_bmc *bt_bmc, u8 data, int reg) +{ + int rc; + + rc = regmap_write(bt_bmc->map, reg, data); + WARN(rc != 0, "regmap_write() failed: %d\n", rc); +} + +static void clr_rd_ptr(struct bt_bmc *bt_bmc) +{ + bt_outb(bt_bmc, BT_CTRL_CLR_RD_PTR, BT_CTRL); +} + +static void clr_wr_ptr(struct bt_bmc *bt_bmc) +{ + bt_outb(bt_bmc, BT_CTRL_CLR_WR_PTR, BT_CTRL); +} + +static void clr_h2b_atn(struct bt_bmc *bt_bmc) +{ + bt_outb(bt_bmc, 0, BT_CTRL); +} + +static void set_b_busy(struct bt_bmc *bt_bmc) +{ + if (!(bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_B_BUSY)) + bt_outb(bt_bmc, BT_CTRL_B_BUSY, BT_CTRL); +} + +static void clr_b_busy(struct bt_bmc *bt_bmc) +{ + if (bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_B_BUSY) + bt_outb(bt_bmc, 0, BT_CTRL); +} + +static void set_b2h_atn(struct bt_bmc *bt_bmc) +{ + bt_outb(bt_bmc, BT_CTRL_B2H_ATN, BT_CTRL); +} + +static u8 bt_read(struct bt_bmc *bt_bmc) +{ + return bt_inb(bt_bmc, BT_HOST2BMC); +} + +static ssize_t bt_readn(struct bt_bmc *bt_bmc, u8 *buf, size_t n) +{ + int i; + + for (i = 0; i < n; i++) + buf[i] = bt_read(bt_bmc); + return n; +} + +static void bt_write(struct bt_bmc *bt_bmc, u8 c) +{ + bt_outb(bt_bmc, c, BT_BMC2HOST); +} + +static ssize_t bt_writen(struct bt_bmc *bt_bmc, u8 *buf, size_t n) +{ + int i; + + for (i = 0; i < n; i++) + bt_write(bt_bmc, buf[i]); + return n; +} + +static void set_sms_atn(struct bt_bmc *bt_bmc) +{ + bt_outb(bt_bmc, BT_CTRL_SMS_ATN, BT_CTRL); +} + +static struct bt_bmc *file_bt_bmc(struct file *file) +{ + return container_of(file->private_data, struct bt_bmc, miscdev); +} + +static int bt_bmc_open(struct inode *inode, struct file *file) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + + if (atomic_inc_return(&open_count) == 1) { + clr_b_busy(bt_bmc); + return 0; + } + + atomic_dec(&open_count); + + return -EBUSY; +} + +/* + * The BT (Block Transfer) interface means that entire messages are + * buffered by the host before a notification is sent to the BMC that + * there is data to be read. The first byte is the length and the + * message data follows. The read operation just tries to capture the + * whole before returning it to userspace. + * + * BT Message format : + * + * Byte 1 Byte 2 Byte 3 Byte 4 Byte 5:N + * Length NetFn/LUN Seq Cmd Data + * + */ +static ssize_t bt_bmc_read(struct file *file, char __user *buf, + size_t count, loff_t *ppos) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + u8 len; + int len_byte = 1; + u8 kbuffer[BT_BMC_BUFFER_SIZE]; + ssize_t ret = 0; + ssize_t nread; + + WARN_ON(*ppos); + + if (wait_event_interruptible(bt_bmc->queue, + bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_H2B_ATN)) + return -ERESTARTSYS; + + mutex_lock(&bt_bmc->mutex); + + if (unlikely(!(bt_inb(bt_bmc, BT_CTRL) & BT_CTRL_H2B_ATN))) { + ret = -EIO; + goto out_unlock; + } + + set_b_busy(bt_bmc); + clr_h2b_atn(bt_bmc); + clr_rd_ptr(bt_bmc); + + /* + * The BT frames start with the message length, which does not + * include the length byte. + */ + kbuffer[0] = bt_read(bt_bmc); + len = kbuffer[0]; + + /* We pass the length back to userspace as well */ + if (len + 1 > count) + len = count - 1; + + while (len) { + nread = min_t(ssize_t, len, sizeof(kbuffer) - len_byte); + + bt_readn(bt_bmc, kbuffer + len_byte, nread); + + if (copy_to_user(buf, kbuffer, nread + len_byte)) { + ret = -EFAULT; + break; + } + len -= nread; + buf += nread + len_byte; + ret += nread + len_byte; + len_byte = 0; + } + + clr_b_busy(bt_bmc); + +out_unlock: + mutex_unlock(&bt_bmc->mutex); + return ret; +} + +/* + * BT Message response format : + * + * Byte 1 Byte 2 Byte 3 Byte 4 Byte 5 Byte 6:N + * Length NetFn/LUN Seq Cmd Code Data + */ +static ssize_t bt_bmc_write(struct file *file, const char __user *buf, + size_t count, loff_t *ppos) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + u8 kbuffer[BT_BMC_BUFFER_SIZE]; + ssize_t ret = 0; + ssize_t nwritten; + + /* + * send a minimum response size + */ + if (count < 5) + return -EINVAL; + + WARN_ON(*ppos); + + /* + * There's no interrupt for clearing bmc busy so we have to + * poll + */ + if (wait_event_interruptible(bt_bmc->queue, + !(bt_inb(bt_bmc, BT_CTRL) & + (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN)))) + return -ERESTARTSYS; + + mutex_lock(&bt_bmc->mutex); + + if (unlikely(bt_inb(bt_bmc, BT_CTRL) & + (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN))) { + ret = -EIO; + goto out_unlock; + } + + clr_wr_ptr(bt_bmc); + + while (count) { + nwritten = min_t(ssize_t, count, sizeof(kbuffer)); + if (copy_from_user(&kbuffer, buf, nwritten)) { + ret = -EFAULT; + break; + } + + bt_writen(bt_bmc, kbuffer, nwritten); + + count -= nwritten; + buf += nwritten; + ret += nwritten; + } + + set_b2h_atn(bt_bmc); + +out_unlock: + mutex_unlock(&bt_bmc->mutex); + return ret; +} + +static long bt_bmc_ioctl(struct file *file, unsigned int cmd, + unsigned long param) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + + switch (cmd) { + case BT_BMC_IOCTL_SMS_ATN: + set_sms_atn(bt_bmc); + return 0; + } + return -EINVAL; +} + +static int bt_bmc_release(struct inode *inode, struct file *file) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + + atomic_dec(&open_count); + set_b_busy(bt_bmc); + return 0; +} + +static __poll_t bt_bmc_poll(struct file *file, poll_table *wait) +{ + struct bt_bmc *bt_bmc = file_bt_bmc(file); + __poll_t mask = 0; + u8 ctrl; + + poll_wait(file, &bt_bmc->queue, wait); + + ctrl = bt_inb(bt_bmc, BT_CTRL); + + if (ctrl & BT_CTRL_H2B_ATN) + mask |= EPOLLIN; + + if (!(ctrl & (BT_CTRL_H_BUSY | BT_CTRL_B2H_ATN))) + mask |= EPOLLOUT; + + return mask; +} + +static const struct file_operations bt_bmc_fops = { + .owner = THIS_MODULE, + .open = bt_bmc_open, + .read = bt_bmc_read, + .write = bt_bmc_write, + .release = bt_bmc_release, + .poll = bt_bmc_poll, + .unlocked_ioctl = bt_bmc_ioctl, +}; + +static void poll_timer(struct timer_list *t) +{ + struct bt_bmc *bt_bmc = from_timer(bt_bmc, t, poll_timer); + + bt_bmc->poll_timer.expires += msecs_to_jiffies(500); + wake_up(&bt_bmc->queue); + add_timer(&bt_bmc->poll_timer); +} + +static irqreturn_t bt_bmc_irq(int irq, void *arg) +{ + struct bt_bmc *bt_bmc = arg; + u32 reg, intmsk; + int rc; + + rc = regmap_read(bt_bmc->map, BT_CR1, ®); + if (rc) + return IRQ_NONE; + + reg &= BT_CR1_IRQ_H2B | BT_CR1_IRQ_HWRST; + if (!reg) + return IRQ_NONE; + + /* ack pending IRQs */ + regmap_write(bt_bmc->map, BT_CR1, 0); + + if (reg & BT_CR1_IRQ_HWRST) { + regmap_read(bt_bmc->map, BT_INTMASK, &intmsk); + if (intmsk & BT_INTMASK_BMC_HWRST) + regmap_write(bt_bmc->map, BT_INTMASK, 0); + } + + wake_up(&bt_bmc->queue); + return IRQ_HANDLED; +} + +static int bt_bmc_config_irq(struct bt_bmc *bt_bmc, + struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + int rc; + + bt_bmc->irq = platform_get_irq(pdev, 0); + if (!bt_bmc->irq) + return -ENODEV; + + rc = devm_request_irq(dev, bt_bmc->irq, bt_bmc_irq, IRQF_SHARED, + DEVICE_NAME, bt_bmc); + if (rc < 0) { + dev_warn(dev, "Unable to request IRQ %d\n", bt_bmc->irq); + bt_bmc->irq = 0; + return rc; + } + + /* + * Configure IRQs on the bmc clearing the H2B and HBUSY bits; + * H2B will be asserted when the bmc has data for us; HBUSY + * will be cleared (along with B2H) when we can write the next + * message to the BT buffer + */ + rc = regmap_update_bits(bt_bmc->map, BT_CSR1, + BT_CSR1_IRQ_H2B | BT_CSR1_IRQ_HWRST, + BT_CSR1_IRQ_H2B | BT_CSR1_IRQ_HWRST); + + return rc; +} + +static int bt_bmc_probe(struct platform_device *pdev) +{ + struct bt_bmc *bt_bmc; + struct device *dev; + int rc; + + if (!pdev || !pdev->dev.of_node) + return -ENODEV; + + dev = &pdev->dev; + dev_info(dev, "Found bt bmc device\n"); + + bt_bmc = devm_kzalloc(dev, sizeof(*bt_bmc), GFP_KERNEL); + if (!bt_bmc) + return -ENOMEM; + + dev_set_drvdata(&pdev->dev, bt_bmc); + + bt_bmc->map = syscon_node_to_regmap(pdev->dev.parent->of_node); + + mutex_init(&bt_bmc->mutex); + init_waitqueue_head(&bt_bmc->queue); + + bt_bmc->miscdev.minor = MISC_DYNAMIC_MINOR, + bt_bmc->miscdev.name = DEVICE_NAME, + bt_bmc->miscdev.fops = &bt_bmc_fops, + bt_bmc->miscdev.parent = dev; + rc = misc_register(&bt_bmc->miscdev); + if (rc) { + dev_err(dev, "Unable to register misc device\n"); + return rc; + } + + bt_bmc_config_irq(bt_bmc, pdev); + + if (bt_bmc->irq) { + dev_info(dev, "Using IRQ %d\n", bt_bmc->irq); + } else { + dev_info(dev, "No IRQ; using timer\n"); + timer_setup(&bt_bmc->poll_timer, poll_timer, 0); + bt_bmc->poll_timer.expires = jiffies + msecs_to_jiffies(10); + add_timer(&bt_bmc->poll_timer); + } + + regmap_update_bits(bt_bmc->map, LPC_HICR0, LPC_HICR0_LPC3E, LPC_HICR0_LPC3E); + regmap_update_bits(bt_bmc->map, LPC_HICR4, LPC_BTENABLE, LPC_BTENABLE); + regmap_write(bt_bmc->map, LPC_LADR3H_BT, BT_IO_BASE >> 8); + regmap_write(bt_bmc->map, LPC_LADR3L_BT, BT_IO_BASE); + regmap_update_bits(bt_bmc->map, LPC_HICR2, LPC_HICR2_IBFIF3, LPC_HICR2_IBFIF3); + clr_b_busy(bt_bmc); + + return 0; +} + +static int bt_bmc_remove(struct platform_device *pdev) +{ + struct bt_bmc *bt_bmc = dev_get_drvdata(&pdev->dev); + + misc_deregister(&bt_bmc->miscdev); + if (!bt_bmc->irq) + del_timer_sync(&bt_bmc->poll_timer); + + return 0; +} + +static const struct of_device_id bt_bmc_match[] = { + { .compatible = "phytium,bt-bmc" }, + { }, +}; +MODULE_DEVICE_TABLE(of, bt_bmc_match); + +static struct platform_driver bt_bmc_driver = { + .driver = { + .name = DEVICE_NAME, + .of_match_table = bt_bmc_match, + }, + .probe = bt_bmc_probe, + .remove = bt_bmc_remove, +}; + +module_platform_driver(bt_bmc_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Cheng Quan +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "kcs_bmc_device.h" + +#define DEVICE_NAME "phytium-kcs-bmc" + +#define KCS_CHANNEL_MAX 4 + +/* mapped to lpc-bmc@0 IO space */ +#define LPC_HICR0 0x000 +#define LPC_HICR0_LPC3E BIT(7) +#define LPC_HICR0_LPC2E BIT(6) +#define LPC_HICR0_LPC1E BIT(5) +#define LPC_HICR0_SDWNE BIT(3) /* 0:disabl,1:enable for HICR1_SDWNB */ +#define LPC_HICR0_PMEE BIT(2) /* 0:disabl,1:enable for HICR1_PMEB */ +#define LPC_HICR1 0x004 +#define LPC_HICR1_LPCBSY BIT(7) /* 0:idle,1:trans busy */ +#define LPC_HICR1_IRQBSY BIT(5) /* 0:idle,1:trans data */ +#define LPC_HICR1_LPCSWRST BIT(4) /* 0:normal,1:reset */ +#define LPC_HICR1_SDWNB BIT(3) /* 0:normal,1:software shutdown */ +#define LPC_HICR1_PMEB BIT(2) /* 0:LPCPD low,1:LPCPD high */ +#define LPC_HICR2 0x008 +#define LPC_LPCSWRST_ERRIRQ BIT(6) /* 0:normal,1:reset irq */ +#define LPC_SDWN_ERRIRQ BIT(5) /* 0:normal,1:lpcpd irq */ +#define LPC_ABRT_ERRIRQ BIT(4) /* 0:normal,1:lframe low when busy*/ +#define LPC_HICR2_IBFIF3 BIT(3) /* 0:normal,1:enable irq 3*/ +#define LPC_HICR2_IBFIF2 BIT(2) +#define LPC_HICR2_IBFIF1 BIT(1) +/* 0:normal,1:enable err irq-reset,power down,abort */ +#define LPC_HICR2_ERRIE BIT(0) +#define LPC_HICR3 0x00C +#define LPC_LFRAME_STATUS BIT(7) /* R */ +#define LPC_SERIRQ_STATUS BIT(5) /* R */ +#define LPC_LREST_STATUS BIT(4) /* R */ +#define LPC_LPCPD_STATUS BIT(3) /* R */ +#define LPC_PME_STATUS BIT(2) /* R */ +#define LPC_HICR4 0x010 +#define LPC_HICR4_LADR12AS BIT(7) +#define LPC_HICR4_KCSENBL BIT(2) +#define LPC_BTENABLE BIT(0) /* share bt channel enable,0:disable,1:enable */ +#define LPC_LADR3H 0x014 +#define LPC_LADR3L 0x018 +#define LPC_LADR12H 0x01C +#define LPC_LADR12L 0x020 +#define LPC_IDR1 0x024 +#define LPC_IDR2 0x028 +#define LPC_IDR3 0x02C +#define LPC_ODR1 0x030 +#define LPC_ODR2 0x034 +#define LPC_ODR3 0x038 +#define LPC_STR1 0x03C +#define LPC_STR2 0x040 +#define LPC_STR3 0x044 + +#define LPC_HICRB 0x80 +#define LPC_HICRB_IBFIF4 BIT(1) +#define LPC_HICRB_LPC4E BIT(0) +#define LPC_LADR4 0x88 +#define LPC_IDR4 0x8c +#define LPC_ODR4 0x90 +#define LPC_STR4 0x94 + +#define OBE_POLL_PERIOD (HZ / 2) +struct phytium_kcs_bmc { + struct kcs_bmc_device kcs_bmc; + + struct regmap *map; + + struct { + spinlock_t lock; + bool remove; + struct timer_list timer; + } obe; +}; + +struct phytium_kcs_of_ops { + int (*get_channel)(struct platform_device *pdev); + int (*get_io_address)(struct platform_device *pdev, u32 addr); +}; + +static inline struct phytium_kcs_bmc *to_phytium_kcs_bmc + (struct kcs_bmc_device *kcs_bmc) +{ + return container_of(kcs_bmc, struct phytium_kcs_bmc, kcs_bmc); +} + +static u8 phytium_kcs_inb(struct kcs_bmc_device *kcs_bmc, u32 reg) +{ + struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); + u32 val = 0; + int rc; + + rc = regmap_read(priv->map, reg, &val); + WARN(rc != 0, "regmap_read() failed: %d\n", rc); + + return rc == 0 ? (u8) val : 0; +} + +static void phytium_kcs_outb(struct kcs_bmc_device *kcs_bmc, u32 reg, u8 data) +{ + struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); + int rc; + + rc = regmap_write(priv->map, reg, data); + WARN(rc != 0, "regmap_write() failed: %d\n", rc); +} + +static void phytium_kcs_updateb(struct kcs_bmc_device *kcs_bmc, u32 reg, u8 mask, u8 val) +{ + struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); + int rc; + + rc = regmap_update_bits(priv->map, reg, mask, val); + WARN(rc != 0, "regmap_update_bits() failed: %d\n", rc); +} +/* + * Background: + * we note D for Data, and C for Cmd/Status, default rules are + * A. KCS1 / KCS2 ( D / C:X / X+4 ) + * D / C : CA0h / CA4h + * D / C : CA8h / CACh + * B. KCS3 ( D / C:XX2h / XX3h ) + * D / C : CA2h / CA3h + * D / C : CB2h / CB3h -use + * C. KCS4 + * D / C : CA4h / CA5h + * D / C : CB0h / CB1h -use + */ +static int phytium_kcs_set_address(struct kcs_bmc_device *kcs_bmc, u16 addr) +{ + struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); + + switch (priv->kcs_bmc.channel) { + case 1: + regmap_update_bits(priv->map, LPC_HICR4, LPC_HICR4_LADR12AS, 0); + regmap_write(priv->map, LPC_LADR12H, addr >> 8); + regmap_write(priv->map, LPC_LADR12L, addr & 0xFF); + break; + case 2: + regmap_update_bits(priv->map, LPC_HICR4, + LPC_HICR4_LADR12AS, LPC_HICR4_LADR12AS); + regmap_write(priv->map, LPC_LADR12H, addr >> 8); + regmap_write(priv->map, LPC_LADR12L, addr & 0xFF); + break; + case 3: + regmap_write(priv->map, LPC_LADR3H, addr >> 8); + regmap_write(priv->map, LPC_LADR3L, addr & 0xFF); + break; + case 4: + regmap_write(priv->map, LPC_LADR4, ((addr + 1) << 16) | + addr); + break; + default: + break; + } + return 0; +} + +static void phytium_kcs_enable_channel(struct kcs_bmc_device *kcs_bmc, bool enable) +{ + struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); + + switch (kcs_bmc->channel) { + case 1: + if (enable) { + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC1E, LPC_HICR0_LPC1E); + } else { + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC1E, 0); + } + break; + case 2: + if (enable) { + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC2E, LPC_HICR0_LPC2E); + } else { + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC2E, 0); + } + break; + case 3: + if (enable) { + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC3E, LPC_HICR0_LPC3E); + regmap_update_bits(priv->map, LPC_HICR4, + LPC_HICR4_KCSENBL, LPC_HICR4_KCSENBL); + } else { + regmap_update_bits(priv->map, LPC_HICR0, + LPC_HICR0_LPC3E, 0); + regmap_update_bits(priv->map, LPC_HICR4, + LPC_HICR4_KCSENBL, 0); + } + break; + case 4: + if (enable) + regmap_update_bits(priv->map, LPC_HICRB, + LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E, + LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E); + else + regmap_update_bits(priv->map, LPC_HICRB, + LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E, + 0); + break; + default: + pr_warn("%s: Unsupported channel: %d", __func__, kcs_bmc->channel); + return; + } +} + +static void phytium_kcs_check_obe(struct timer_list *timer) +{ + struct phytium_kcs_bmc *priv = container_of(timer, struct phytium_kcs_bmc, obe.timer); + unsigned long flags; + u8 str; + + spin_lock_irqsave(&priv->obe.lock, flags); + if (priv->obe.remove) { + spin_unlock_irqrestore(&priv->obe.lock, flags); + return; + } + + str = phytium_kcs_inb(&priv->kcs_bmc, priv->kcs_bmc.ioreg.str); + if (str & KCS_BMC_STR_OBF) { + mod_timer(timer, jiffies + OBE_POLL_PERIOD); + spin_unlock_irqrestore(&priv->obe.lock, flags); + return; + } + spin_unlock_irqrestore(&priv->obe.lock, flags); + + kcs_bmc_handle_event(&priv->kcs_bmc); +} + +static void phytium_kcs_irq_mask_update(struct kcs_bmc_device *kcs_bmc, u8 mask, u8 state) +{ + struct phytium_kcs_bmc *priv = to_phytium_kcs_bmc(kcs_bmc); + + if (mask & KCS_BMC_EVENT_TYPE_OBE) { + if (KCS_BMC_EVENT_TYPE_OBE & state) + mod_timer(&priv->obe.timer, jiffies + OBE_POLL_PERIOD); + else + del_timer(&priv->obe.timer); + } + + if (mask & KCS_BMC_EVENT_TYPE_IBF) { + const bool enable = !!(state & KCS_BMC_EVENT_TYPE_IBF); + + switch (kcs_bmc->channel) { + case 1: + regmap_update_bits(priv->map, LPC_HICR2, LPC_HICR2_IBFIF1, + enable * LPC_HICR2_IBFIF1); + return; + case 2: + regmap_update_bits(priv->map, LPC_HICR2, LPC_HICR2_IBFIF2, + enable * LPC_HICR2_IBFIF2); + return; + case 3: + regmap_update_bits(priv->map, LPC_HICR2, LPC_HICR2_IBFIF3, + enable * LPC_HICR2_IBFIF3); + return; + case 4: + regmap_update_bits(priv->map, LPC_HICRB, LPC_HICRB_IBFIF4, + enable * LPC_HICRB_IBFIF4); + return; + default: + pr_warn("%s: Unsupported channel: %d", __func__, kcs_bmc->channel); + return; + } + } +} + + +static const struct kcs_bmc_device_ops phytium_kcs_ops = { + .irq_mask_update = phytium_kcs_irq_mask_update, + .io_inputb = phytium_kcs_inb, + .io_outputb = phytium_kcs_outb, + .io_updateb = phytium_kcs_updateb, +}; + +static irqreturn_t phytium_kcs_irq(int irq, void *arg) +{ + struct kcs_bmc_device *kcs_bmc = arg; + + return kcs_bmc_handle_event(kcs_bmc); +} + +static int phytium_kcs_config_irq(struct kcs_bmc_device *kcs_bmc, + struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + int irq; + + irq = platform_get_irq(pdev, 0); + if (irq < 0) + return irq; + + return devm_request_irq(dev, irq, phytium_kcs_irq, IRQF_SHARED, + dev_name(dev), kcs_bmc); +} + +static const struct kcs_ioreg phytium_kcs_bmc_ioregs[KCS_CHANNEL_MAX] = { + { .idr = LPC_IDR1, .odr = LPC_ODR1, .str = LPC_STR1 }, + { .idr = LPC_IDR2, .odr = LPC_ODR2, .str = LPC_STR2 }, + { .idr = LPC_IDR3, .odr = LPC_ODR3, .str = LPC_STR3 }, + { .idr = LPC_IDR4, .odr = LPC_ODR4, .str = LPC_STR4 }, + +}; + +static int phytium_kcs_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct phytium_kcs_bmc *priv; + struct kcs_bmc_device *kcs_bmc; + struct device_node *np; + u32 chan, addr; + int rc; + + rc = of_property_read_u32(dev->of_node, "kcs_chan", &chan); + if ((rc != 0) || (chan == 0 || chan > KCS_CHANNEL_MAX)) { + dev_err(dev, "no valid 'kcs_chan' configured\n"); + return -ENODEV; + } + rc = of_property_read_u32(dev->of_node, "kcs_addr", &addr); + if (rc) { + dev_err(dev, "no valid 'kcs_addr' configured\n"); + return -ENODEV; + } + + np = pdev->dev.of_node; + + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); + if (!priv) + return -ENOMEM; + + kcs_bmc = &priv->kcs_bmc; + kcs_bmc->dev = &pdev->dev; + kcs_bmc->channel = chan; + kcs_bmc->ioreg = phytium_kcs_bmc_ioregs[chan - 1]; + kcs_bmc->ops = &phytium_kcs_ops; + + priv->map = syscon_node_to_regmap(pdev->dev.parent->of_node); + if (IS_ERR(priv->map)) { + dev_err(&pdev->dev, "Couldn't get regmap\n"); + return -ENODEV; + } + + spin_lock_init(&priv->obe.lock); + priv->obe.remove = false; + timer_setup(&priv->obe.timer, phytium_kcs_check_obe, 0); + + rc = phytium_kcs_set_address(kcs_bmc, addr); + if (rc) + return rc; + + rc = phytium_kcs_config_irq(kcs_bmc, pdev); + if (rc) + return rc; + + platform_set_drvdata(pdev, priv); + + phytium_kcs_irq_mask_update(kcs_bmc, (KCS_BMC_EVENT_TYPE_IBF | KCS_BMC_EVENT_TYPE_OBE), 0); + + phytium_kcs_enable_channel(kcs_bmc, true); + + rc = kcs_bmc_add_device(&priv->kcs_bmc); + if (rc) { + dev_warn(&pdev->dev, "Failed to register channel %d: %d\n", + kcs_bmc->channel, rc); + return rc; + } + + dev_info(&pdev->dev, "Initialised channel %d at 0x%x\n", + kcs_bmc->channel, addr); + + return 0; +} + +static int phytium_kcs_remove(struct platform_device *pdev) +{ + struct phytium_kcs_bmc *priv = platform_get_drvdata(pdev); + struct kcs_bmc_device *kcs_bmc = &priv->kcs_bmc; + + kcs_bmc_remove_device(kcs_bmc); + phytium_kcs_enable_channel(kcs_bmc, false); + phytium_kcs_irq_mask_update(kcs_bmc, (KCS_BMC_EVENT_TYPE_IBF | KCS_BMC_EVENT_TYPE_OBE), 0); + + spin_lock_irq(&priv->obe.lock); + priv->obe.remove = true; + spin_unlock_irq(&priv->obe.lock); + del_timer_sync(&priv->obe.timer); + return 0; +} + +static const struct of_device_id phytium_kcs_bmc_match[] = { + { .compatible = "phytium,kcs-bmc", }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_kcs_bmc_match); + +static struct platform_driver phytium_kcs_bmc_driver = { + .driver = { + .name = DEVICE_NAME, + .of_match_table = phytium_kcs_bmc_match, + }, + .probe = phytium_kcs_probe, + .remove = phytium_kcs_remove, +}; +module_platform_driver(phytium_kcs_bmc_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Cheng Quan "); +MODULE_DESCRIPTION("Phytium device interface to the KCS BMC device"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..26691906dbf4db150ccd0a133dee4c1c1ec4872b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/Kconfig @@ -0,0 +1,13 @@ +# SPDX-License-Identifier: GPL-2.0-only +# +# PCMCIA character device configuration +# +config PHYTNET_LED + tristate "Phytium mac led control module" + depends on PHYTMAC + depends on GPIO_PHYTIUM_PLAT + default m + help + If you have a network (Ethernet) controller of this type and + want to use it control port led say Y or M here. + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..781bc90c1b9c30d7f909b8fad54cd88eb2a01894 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_PHYTNET_LED) += phytnet_led.o \ No newline at end of file diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/phytnet_led.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/phytnet_led.c new file mode 100644 index 0000000000000000000000000000000000000000..e9425f29afb6802fb91a697adf1c0869cea49853 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/phytnet_led.c @@ -0,0 +1,320 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (C) 2022-2023 Phytium Technology Co.,Ltd. + * + */ +#include +#include +#include +#include +#include +#include +#include "phytnet_led.h" + +#define DRIVER_NAME "phytnet_led" +#define DRIVER_VERSION "1.0" +#define DRIVER_AUTHOR "LongShixiang " +#define DRIVER_DESC "net device led control module" +#define NET_DEV_PROPNAME "net_dev" +#define LED_OF_NAME "led" +#define CHECK_INTERVAL 125 /* Unit: ms */ +#define NDEV_CHECK_DELAY 30000 /* Unit: 30s */ +#define LED_ON 1 +#define LED_OFF 0 +#define LINK_OFFSET 0 +#define ACT_OFFSET 1 + +#if defined(CONFIG_OF) +static const struct of_device_id phytnet_led_of_ids[] = { + { .compatible = "phytium,net_led"}, + {} +}; + +MODULE_DEVICE_TABLE(of, phytnet_led_of_ids); +#endif /* CONFIG_OF */ + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytnet_acpi_ids[] = { + { .id = "PHYT800C"}, + {} +}; +MODULE_DEVICE_TABLE(acpi, phytnet_acpi_ids); +#else +#define phytnet_acpi_ids NULL +#endif /* CONFIG_ACPI */ + +static void +led_on(struct gpio_desc *gd) +{ + gpiod_set_value(gd, LED_ON); +} + +static void +led_off(struct gpio_desc *gd) +{ + gpiod_set_value(gd, LED_OFF); +} + +static void +led_blink(struct led_data *phytnet_led) +{ + phytnet_led->act_val = !phytnet_led->act_val; + gpiod_set_value(phytnet_led->act, phytnet_led->act_val); +} + +static int +port_is_linkup(struct led_data *phytnet_led) +{ + if (netif_carrier_ok(phytnet_led->ndev)) + return true; + else + return false; +} + +static bool +port_is_act(struct led_data *phytnet_led) +{ + bool ret = false; + + if (phytnet_led->ndev_rx != phytnet_led->ndev->stats.rx_packets) { + phytnet_led->ndev_rx = phytnet_led->ndev->stats.rx_packets; + ret = true; + } + + if (phytnet_led->ndev_tx != phytnet_led->ndev->stats.tx_packets) { + phytnet_led->ndev_tx = phytnet_led->ndev->stats.tx_packets; + ret = true; + } + + return ret; +} + +static void +led_control(struct led_data *phytnet_led) +{ + while (!phytnet_led->led_stop) { + msleep(CHECK_INTERVAL); + + if (!netif_running(phytnet_led->ndev)) { + led_off(phytnet_led->link); + led_off(phytnet_led->act); + continue; + } + + if (port_is_linkup(phytnet_led)) + led_on(phytnet_led->link); + else + led_off(phytnet_led->link); + + if (port_is_act(phytnet_led)) + led_blink(phytnet_led); + else + led_off(phytnet_led->act); + } +} + +static int +of_ndev_init(struct led_data *phytnet_led) +{ + struct device_node *net_node; + + net_node = of_parse_phandle(phytnet_led->pdev->dev.of_node, NET_DEV_PROPNAME, 0); + if (!net_node) { + dev_err(&phytnet_led->pdev->dev, "Failed to get netdev ofnode from device tree\n"); + return -ENODEV; + } + + phytnet_led->ndev = of_find_net_device_by_node(net_node); + + if (!phytnet_led->ndev) { + dev_err(&phytnet_led->pdev->dev, "Failed to get acpi ndev\n"); + return -ENODEV; + } + + dev_info(&phytnet_led->pdev->dev, "Successfully get ndev...\n"); + dev_hold(phytnet_led->ndev); + + return 0; +} + + +static int +acpi_ndev_init(struct led_data *phytnet_led) +{ + int err; + struct net_device *find_ndev; + const char *ndev_acpi_path; + acpi_handle net_handler; + struct acpi_device *adev; + acpi_status status; + struct device *find_dev; + + err = device_property_read_string(&phytnet_led->pdev->dev, + NET_DEV_PROPNAME, + &ndev_acpi_path); + if (err) { + dev_err(&phytnet_led->pdev->dev, "Failed to read net_dev property!\n"); + return -ENODEV; + } + + status = acpi_get_handle(NULL, (acpi_string)ndev_acpi_path, &net_handler); + if (ACPI_FAILURE(status)) { + dev_err(&phytnet_led->pdev->dev, "Failed to get acpi handler path: %s\n", + ndev_acpi_path); + return -ENODEV; + } + + adev = acpi_get_acpi_dev(net_handler); + if (!err) { + dev_err(&phytnet_led->pdev->dev, "Failed to get adev dev\n"); + return -ENODEV; + } + + for_each_netdev(&init_net, find_ndev) { + if (find_ndev->dev.parent != NULL) { + find_dev = find_ndev->dev.parent; + if (&adev->fwnode == find_dev->fwnode) + phytnet_led->ndev = find_ndev; + } + } + + if (!phytnet_led->ndev) { + dev_err(&phytnet_led->pdev->dev, "Failed to get acpi ndev\n"); + return -ENODEV; + } + + dev_info(&phytnet_led->pdev->dev, "Successfully get ndev...\n"); + dev_hold(phytnet_led->ndev); + + return 0; +} + +static int +gpio_init(struct led_data *phytnet_led) +{ + int err; + + phytnet_led->link = gpiod_get_index(&phytnet_led->pdev->dev, + LED_OF_NAME, + LINK_OFFSET, + GPIOD_OUT_HIGH); + if (IS_ERR(phytnet_led->link)) { + dev_err(&phytnet_led->pdev->dev, "Failed to get link gpio, err: %ld\n", + PTR_ERR(phytnet_led->link)); + return PTR_ERR(phytnet_led->link); + } + + err = gpiod_direction_output(phytnet_led->link, LED_OFF); + if (err) { + dev_err(&phytnet_led->pdev->dev, "Failed to set link dir, err: %ld\n", + PTR_ERR(phytnet_led->link)); + return err; + } + + phytnet_led->act = gpiod_get_index(&phytnet_led->pdev->dev, + LED_OF_NAME, + ACT_OFFSET, + GPIOD_OUT_HIGH); + if (IS_ERR(phytnet_led->act)) { + dev_err(&phytnet_led->pdev->dev, "Failed to get act gpio, err:%d\n", err); + return PTR_ERR(phytnet_led->act); + } + + err = gpiod_direction_output(phytnet_led->act, LED_OFF); + if (err) { + dev_err(&phytnet_led->pdev->dev, "Failed to set act dir, err: %d\n", err); + return err; + } + + return 0; +} + +static void +led_init_and_control(struct work_struct *work) +{ + int err = -1; + struct led_data *phytnet_led = container_of(work, struct led_data, led_control_work.work); + + if (phytnet_led->pdev->dev.of_node) + err = of_ndev_init(phytnet_led); + else if (has_acpi_companion(&phytnet_led->pdev->dev)) + err = acpi_ndev_init(phytnet_led); + + if (err) { + dev_err(&phytnet_led->pdev->dev, "ndev init wrong\n"); + return; + } + + err = gpio_init(phytnet_led); + if (err) { + dev_err(&phytnet_led->pdev->dev, "gpio init wrong\n"); + return; + } + + led_control(phytnet_led); +} + +static int +net_led_probe(struct platform_device *pdev) +{ + struct led_data *phytnet_led = devm_kzalloc(&pdev->dev, + sizeof(struct led_data), + GFP_KERNEL); + + if (!phytnet_led) + return -ENOMEM; + + platform_set_drvdata(pdev, phytnet_led); + + phytnet_led->act = LED_OFF; + phytnet_led->pdev = pdev; + phytnet_led->led_stop = 0; + + INIT_DELAYED_WORK(&phytnet_led->led_control_work, led_init_and_control); + schedule_delayed_work(&phytnet_led->led_control_work, msecs_to_jiffies(NDEV_CHECK_DELAY)); + + return 0; +} + +static int +net_led_remove(struct platform_device *pdev) +{ + struct led_data *phytnet_led = platform_get_drvdata(pdev); + + phytnet_led->led_stop = 1; + cancel_delayed_work_sync(&phytnet_led->led_control_work); + + if (phytnet_led->ndev) + dev_put(phytnet_led->ndev); + + if (phytnet_led->link) { + led_off(phytnet_led->link); + gpiod_put(phytnet_led->link); + } + + if (phytnet_led->act) { + led_off(phytnet_led->act); + gpiod_put(phytnet_led->act); + } + + return 0; +} + +static struct platform_driver net_led_driver = { + .driver = { + .owner = THIS_MODULE, + .name = DRIVER_NAME, + .of_match_table = of_match_ptr(phytnet_led_of_ids), + .acpi_match_table = ACPI_PTR(phytnet_acpi_ids), + }, + .probe = net_led_probe, + .remove = net_led_remove, +}; + +module_platform_driver(net_led_driver); + +MODULE_VERSION(DRIVER_VERSION); +MODULE_LICENSE("GPL"); +MODULE_AUTHOR(DRIVER_AUTHOR); +MODULE_DESCRIPTION(DRIVER_DESC); +MODULE_ALIAS("platform:" DRIVER_NAME); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/phytnet_led.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/phytnet_led.h new file mode 100644 index 0000000000000000000000000000000000000000..8f2fbadde0f8b0ceb336a45d883da5c4580c09e4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/char/phytnetled/phytnet_led.h @@ -0,0 +1,14 @@ +/* SPDX-License-Identifier: GPL-2.0 + * + * Copyright (C) 2022-2023 Phytium Technology Co.,Ltd. + * + */ +struct led_data { + struct platform_device *pdev; + struct net_device *ndev; + unsigned long ndev_rx, ndev_tx; + struct gpio_desc *link, *act; + struct delayed_work led_control_work; + int led_stop; + int act_val; +}; diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..f9fb5a6b3a2bc945a74478040ea38ca663f5a62c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/Kconfig @@ -0,0 +1,27 @@ +config PHYTIUM_DDMA + bool "Phytium PE220x DDMA support" + depends on (ARCH_PHYTIUM || COMPILE_TEST) + select DMA_ENGINE + select DMA_VIRTUAL_CHANNELS + help + Enable support for Phytium PE220x DDMA controller. + +config PHYTIUM_GDMA + bool "Phytium GDMA support" + depends on (ARCH_PHYTIUM || COMPILE_TEST) + select DMA_ENGINE + select DMA_VIRTUAL_CHANNELS + help + Enable support for Phytium GDMA controller. + + This engine provides acceleration for memory copy operations, it does + not support peripherals to memory data transfer. Say Y here if you have + such a chipset. If unsure, say N. + +config PHYTIUM_PCI_DMAC + bool "Phytium px210 PCI DMA support" + depends on OF || COMPILE_TEST + select DMA_ENGINE + select DMA_VIRTUAL_CHANNELS + help + Enable support for Phytium px210 DMA controller diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..1dc7a062ce14737dbbcb7bdc06bb1613f0915c3d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/Makefile @@ -0,0 +1,4 @@ +# SPDX-License-Identifier: GPL-2.0 +obj-$(CONFIG_PHYTIUM_DDMA) += phytium-ddmac.o +obj-$(CONFIG_PHYTIUM_GDMA) += phytium-gdmac.o +obj-$(CONFIG_PHYTIUM_PCI_DMAC) += phytium-dmac-pci.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-ddmac.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-ddmac.c new file mode 100644 index 0000000000000000000000000000000000000000..768236d9947ab6efdce0cf653d9d233283862abc --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-ddmac.c @@ -0,0 +1,957 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium Device DDMA Controller driver. + * + * Copyright (c) 2023-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytium-ddmac.h" + +static inline struct phytium_ddma_device *to_ddma_device(struct dma_chan *chan) +{ + return container_of(chan->device, struct phytium_ddma_device, dma_dev); +} + +static inline struct phytium_ddma_chan *to_ddma_chan(struct dma_chan *chan) +{ + return container_of(chan, struct phytium_ddma_chan, vchan.chan); +} + +static inline struct phytium_ddma_desc *to_ddma_desc(struct virt_dma_desc *vd) +{ + return container_of(vd, struct phytium_ddma_desc, vdesc); +} + +static inline struct device *chan_to_dev(struct phytium_ddma_chan *chan) +{ + return chan->vchan.chan.device->dev; +} + +static inline struct phytium_ddma_device * +chan_to_ddma(struct phytium_ddma_chan *chan) +{ + return to_ddma_device(&chan->vchan.chan); +} + +static inline void +phytium_ddma_iowrite32(const struct phytium_ddma_device *ddma, const u32 reg, + const u32 val) +{ + iowrite32(val, ddma->base + reg); +} + +static inline u32 phytium_ddma_ioread32(const struct phytium_ddma_device *ddma, + const u32 reg) +{ + return ioread32(ddma->base + reg); +} + +static inline void phytium_chan_iowrite32(const struct phytium_ddma_chan *chan, + const u32 reg, const u32 val) +{ + iowrite32(val, chan->base + reg); +} + +static inline u32 phytium_chan_ioread32(const struct phytium_ddma_chan *chan, + const u32 reg) +{ + return ioread32(chan->base + reg); +} + +static void phytium_ddma_disable(const struct phytium_ddma_device *ddma) +{ + dev_dbg(ddma->dev, "ddma disable\n"); + phytium_ddma_iowrite32(ddma, DMA_CTL, !DMA_CTL_EN); +} + +static void phytium_ddma_enable(const struct phytium_ddma_device *ddma) +{ + dev_dbg(ddma->dev, "ddma enable\n"); + phytium_ddma_iowrite32(ddma, DMA_CTL, DMA_CTL_EN); +} + +static void phytium_ddma_reset(const struct phytium_ddma_device *ddma) +{ + u32 val = 0; + + dev_dbg(ddma->dev, "dma reset\n"); + val = phytium_ddma_ioread32(ddma, DMA_CTL); + val |= DMA_CTL_SRST; + phytium_ddma_iowrite32(ddma, DMA_CTL, val); + + udelay(10); + val &= ~DMA_CTL_SRST; + phytium_ddma_iowrite32(ddma, DMA_CTL, val); +} + +static void phytium_ddma_irq_disable(const struct phytium_ddma_device *ddma) +{ + u32 val = 0; + + dev_dbg(ddma->dev, "ddma irq disable\n"); + val = phytium_ddma_ioread32(ddma, DMA_MASK_INT); + val |= DMA_INT_EN; + phytium_ddma_iowrite32(ddma, DMA_MASK_INT, val); +} + +static void phytium_ddma_irq_enable(const struct phytium_ddma_device *ddma) +{ + u32 val = 0; + + dev_dbg(ddma->dev, "ddma irq enable\n"); + val = phytium_ddma_ioread32(ddma, DMA_MASK_INT); + val &= ~DMA_INT_EN; + phytium_ddma_iowrite32(ddma, DMA_MASK_INT, val); +} + +static u32 phytium_ddma_irq_read(const struct phytium_ddma_device *ddma) +{ + u32 val = 0; + + val = phytium_ddma_ioread32(ddma, DMA_STAT); + + return val; +} + +static void phytium_chan_irq_disable(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d irq disable\n", chan->id); + val = phytium_ddma_ioread32(chan_to_ddma(chan), DMA_MASK_INT); + val |= DMA_INT_CHAL_EN(chan->id); + phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_MASK_INT, val); +} + +static void phytium_chan_irq_enable(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d irq enable\n", chan->id); + val = phytium_ddma_ioread32(chan_to_ddma(chan), DMA_MASK_INT); + val &= ~DMA_INT_CHAL_EN(chan->id); + phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_MASK_INT, val); +} + +static void phytium_chan_irq_clear(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d irq clear\n", chan->id); + val = DMA_STAT_CHAL(chan->id); + phytium_ddma_iowrite32(chan_to_ddma(chan), DMA_STAT, val); +} + +static int phytium_chan_disable(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + int ret = 0; + u32 value1; + + dev_dbg(chan_to_dev(chan), "channel %d disable\n", chan->id); + val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); + value1 = val |= DMA_CHAL_EN; + if (value1) { + val &= ~DMA_CHAL_EN; + phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); + + ret = readl_relaxed_poll_timeout_atomic( + chan->base + DMA_CHALX_CTL, val, !(val & DMA_CHAL_EN), + 0, 100000); + } + return ret; +} + +static void phytium_chan_enable(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d enable\n", chan->id); + val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); + val |= DMA_CHAL_EN; + phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); +} + +static bool phytium_chan_is_running(const struct phytium_ddma_chan *chan) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); + + if (val & DMA_CHAL_EN) + return true; + else + return false; +} + +static void phytium_chan_reset(struct phytium_ddma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d reset\n", chan->id); + val = phytium_chan_ioread32(chan, DMA_CHALX_CTL); + val |= DMA_CHAL_SRST; + phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); + + udelay(10); + val &= ~DMA_CHAL_SRST; + phytium_chan_iowrite32(chan, DMA_CHALX_CTL, val); +} + +static void phytium_ddma_vdesc_free(struct virt_dma_desc *vd) +{ + kfree(to_ddma_desc(vd)); +} + +static int phytium_chan_pause(struct dma_chan *chan) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + int ret = 0; + + ret = phytium_chan_disable(pchan); + pchan->busy = false; + pchan->is_pasued = true; + + return ret; +} + +static int phytium_chan_resume(struct dma_chan *chan) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + + phytium_chan_enable(pchan); + pchan->is_pasued = false; + + return 0; +} + +static void phytium_chan_start_xfer(struct phytium_ddma_chan *chan) +{ + struct virt_dma_desc *vdesc = NULL; + struct phytium_ddma_sg_req *sg_req = NULL; + char *tmp = NULL; + int i = 0; + unsigned long flags = 0; + + /* chan first xfer settings */ + if (!chan->desc) { + vdesc = vchan_next_desc(&chan->vchan); + if (!vdesc) + return; + + list_del(&vdesc->node); + chan->desc = to_ddma_desc(vdesc); + chan->next_sg = 0; + chan->current_sg = NULL; + dev_dbg(chan_to_dev(chan), "channel %d xfer start\n", chan->id); + } + + if (chan->next_sg == chan->desc->num_sgs) + chan->next_sg = 0; + + sg_req = &chan->desc->sg_req[chan->next_sg]; + chan->current_sg = sg_req; + /* fill to 4 bytes */ + switch (sg_req->direction) { + case DMA_MEM_TO_DEV: + tmp = phys_to_virt(sg_req->mem_addr_l); + memset(chan->buf, 0, sg_req->len * 4); + for (i = 0; i < sg_req->len; i++) + chan->buf[i * 4] = tmp[i]; + break; + + case DMA_DEV_TO_MEM: + memset(chan->buf, 0, sg_req->len * 4); + break; + + default: + break; + } + + /* start transfer */ + phytium_chan_iowrite32(chan, DMA_CHALX_DDR_LWADDR, + chan->paddr & 0xFFFFFFFF); + phytium_chan_iowrite32(chan, DMA_CHALX_DDR_UPADDR, + (chan->paddr >> 32) & 0xFFFFFFFF); + phytium_chan_iowrite32(chan, DMA_CHALX_DEV_ADDR, sg_req->dev_addr); + phytium_chan_iowrite32(chan, DMA_CHALX_TS, sg_req->len * 4); + + spin_lock_irqsave(&chan_to_ddma(chan)->lock, flags); + phytium_chan_irq_enable(chan); + spin_unlock_irqrestore(&chan_to_ddma(chan)->lock, flags); + phytium_chan_enable(chan); + + chan->next_sg++; + chan->busy = true; +} + +static void phytium_chan_xfer_done(struct phytium_ddma_chan *chan) +{ + struct phytium_ddma_sg_req *sg_req = chan->current_sg; + char *tmp = NULL; + int i = 0; + + if (chan->desc) { + if (sg_req->direction == DMA_DEV_TO_MEM) { + tmp = phys_to_virt(sg_req->mem_addr_l); + for (i = 0; i < sg_req->len; i++) + tmp[i] = chan->buf[i * 4]; + } + + chan->busy = false; + if (chan->next_sg == chan->desc->num_sgs) { + dev_dbg(chan_to_dev(chan), + "channel %d xfer complete\n", chan->id); + vchan_cookie_complete(&chan->desc->vdesc); + chan->desc = NULL; + chan->current_sg = NULL; + } + phytium_chan_disable(chan); + phytium_chan_irq_clear(chan); + phytium_chan_start_xfer(chan); + } +} + +static void phytium_dma_hw_init(struct phytium_ddma_device *ddma) +{ + u32 i = 0; + int ret = 0; + + phytium_ddma_disable(ddma); + phytium_ddma_reset(ddma); + phytium_ddma_irq_enable(ddma); + phytium_ddma_enable(ddma); + + for (i = 0; i < ddma->dma_channels; i++) { + phytium_chan_irq_disable(&ddma->chan[i]); + ret = phytium_chan_disable(&ddma->chan[i]); + if (ret) + dev_err(ddma->dev, "can't disable channel %d\n", i); + } +} + +static size_t phytium_ddma_desc_residue(struct phytium_ddma_chan *chan) +{ + u32 trans_cnt = 0; + u32 residue = 0; + int i = 0; + + trans_cnt = phytium_chan_ioread32(chan, DMA_CHALX_TRANS_CNT); + residue = chan->current_sg->len - trans_cnt; + + for (i = chan->next_sg; i < chan->desc->num_sgs; i++) + residue += chan->desc->sg_req[i].len; + + return residue; +} + +static enum dma_status phytium_ddma_tx_status(struct dma_chan *chan, + dma_cookie_t cookie, + struct dma_tx_state *txstate) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + struct virt_dma_desc *vd = NULL; + enum dma_status ret = 0; + unsigned long flags = 0; + size_t residue = 0; + + ret = dma_cookie_status(chan, cookie, txstate); + if ((ret == DMA_COMPLETE) || !txstate) + return ret; + + spin_lock_irqsave(&pchan->vchan.lock, flags); + vd = vchan_find_desc(&pchan->vchan, cookie); + if (pchan->desc && cookie == pchan->desc->vdesc.tx.cookie) + residue = phytium_ddma_desc_residue(pchan); + + dma_set_residue(txstate, residue); + spin_unlock_irqrestore(&pchan->vchan.lock, flags); + + if (pchan->is_pasued && ret == DMA_IN_PROGRESS) + ret = DMA_PAUSED; + + return ret; +} + +static void phytium_ddma_issue_pending(struct dma_chan *chan) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + unsigned long flags = 0; + + spin_lock_irqsave(&pchan->vchan.lock, flags); + + if (vchan_issue_pending(&pchan->vchan) && !pchan->desc && !pchan->busy) + phytium_chan_start_xfer(pchan); + + spin_unlock_irqrestore(&pchan->vchan.lock, flags); +} + +static int phytium_ddma_terminate_all(struct dma_chan *chan) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + unsigned long flags = 0; + LIST_HEAD(head); + + spin_lock_irqsave(&pchan->vchan.lock, flags); + if (pchan->desc) { + vchan_terminate_vdesc(&pchan->desc->vdesc); + if (pchan->busy) { + u32 tmp_ctl, timeout; + + phytium_chan_disable(pchan); + /* save some registers, reset will clear it */ + timeout = phytium_chan_ioread32(pchan, + DMA_CHALX_TIMEOUT_CNT); + tmp_ctl = phytium_chan_ioread32(pchan, + DMA_CHALX_CTL); + spin_lock(&chan_to_ddma(pchan)->lock); + phytium_chan_irq_disable(pchan); + spin_unlock(&chan_to_ddma(pchan)->lock); + /* need reset when terminate */ + phytium_chan_reset(pchan); + phytium_chan_irq_clear(pchan); + /* recover it */ + phytium_chan_iowrite32(pchan, + DMA_CHALX_CTL, tmp_ctl); + phytium_chan_iowrite32(pchan, + DMA_CHALX_TIMEOUT_CNT, timeout); + pchan->busy = false; + } + pchan->desc = NULL; + } + + vchan_get_all_descriptors(&pchan->vchan, &head); + spin_unlock_irqrestore(&pchan->vchan.lock, flags); + vchan_dma_desc_free_list(&pchan->vchan, &head); + + return 0; +} + +static int phytium_ddma_alloc_chan_resources(struct dma_chan *chan) +{ + struct phytium_ddma_device *ddma = to_ddma_device(chan); + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + u32 bind_status = 0; + int ret = 0; + unsigned long flags = 0; + + bind_status = phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); + + if ((pchan->is_used) || (bind_status & BIT(pchan->id))) { + dev_err(ddma->dev, "channel %d already used\n", pchan->id); + ret = -EBUSY; + goto out; + } + + /* prepare channel */ + ret = phytium_chan_disable(pchan); + if (ret) { + dev_err(ddma->dev, "can't disable channel %d\n", pchan->id); + goto out; + } + phytium_chan_reset(pchan); + phytium_chan_irq_clear(pchan); + + /* channel bind */ + spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); + bind_status |= BIT(pchan->id); + phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, bind_status); + pchan->is_used = true; + spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); + + /* alloc dma memory */ + pchan->buf = dma_alloc_coherent(ddma->dev, 4 * PAGE_SIZE, &pchan->paddr, + GFP_KERNEL); + if (!pchan->buf) { + ret = -EBUSY; + dev_err(ddma->dev, "failed to alloc dma memory\n"); + } + + dev_info(ddma->dev, "alloc channel %d\n", pchan->id); + +out: + return ret; +} + +static void phytium_ddma_free_chan_resources(struct dma_chan *chan) +{ + struct phytium_ddma_device *ddma = to_ddma_device(chan); + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + u32 bind_status = 0; + unsigned long flags = 0; + + if (!pchan->is_used) + return; + + dev_dbg(ddma->dev, "free channel %d\n", pchan->id); + spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); + bind_status = phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); + bind_status &= ~BIT(pchan->id); + phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, bind_status); + spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); + + phytium_chan_disable(pchan); + + spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flags); + phytium_chan_irq_disable(pchan); + spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flags); + + vchan_free_chan_resources(to_virt_chan(chan)); + pchan->is_used = false; + + if (pchan->buf) + dma_free_coherent(ddma->dev, 4 * PAGE_SIZE, pchan->buf, + pchan->paddr); +} + +static int phytium_ddma_slave_config(struct dma_chan *chan, + struct dma_slave_config *config) +{ + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + u32 chal_cfg = 0; + u32 req_mode = 0; + const u32 timeout = 0xffff; + unsigned long flag = 0; + + /* Check if chan will be configured for slave transfers */ + if (!is_slave_direction(config->direction)) + return -EINVAL; + + memcpy(&pchan->dma_config, config, sizeof(*config)); + + /* set channel config reg */ + spin_lock_irqsave(&chan_to_ddma(pchan)->lock, flag); + if (pchan->id > 3) { + chal_cfg = phytium_ddma_ioread32(chan_to_ddma(pchan), + DMA_CHAL_CFG_H); + chal_cfg &= ~(0xFF << ((pchan->id - 4) * 8)); + chal_cfg |= DMA_CHAL_SEL((pchan->id - 4), pchan->request_line); + chal_cfg |= DMA_CHAL_SEL_EN(pchan->id - 4); + phytium_ddma_iowrite32(chan_to_ddma(pchan), DMA_CHAL_CFG_H, + chal_cfg); + } else { + chal_cfg = phytium_ddma_ioread32(chan_to_ddma(pchan), + DMA_CHAL_CFG_L); + chal_cfg &= ~(0xFF << (pchan->id * 8)); + chal_cfg |= DMA_CHAL_SEL((pchan->id), pchan->request_line); + chal_cfg |= DMA_CHAL_SEL_EN(pchan->id); + phytium_ddma_iowrite32(chan_to_ddma(pchan), DMA_CHAL_CFG_L, + chal_cfg); + } + spin_unlock_irqrestore(&chan_to_ddma(pchan)->lock, flag); + + /* set channel mode */ + req_mode = (config->direction == DMA_DEV_TO_MEM) ? DMA_RX_REQ : + DMA_TX_REQ; + phytium_chan_iowrite32(pchan, DMA_CHALX_CTL, req_mode << 2); + + /* set channel timeout */ + phytium_chan_iowrite32(pchan, DMA_CHALX_TIMEOUT_CNT, + timeout | DMA_CHAL_TIMEOUT_EN); + + return 0; +} + +static struct dma_async_tx_descriptor * +phytium_ddma_prep_slave_sg(struct dma_chan *chan, struct scatterlist *sgl, + u32 sg_len, enum dma_transfer_direction direction, + unsigned long flags, void *context) +{ + struct phytium_ddma_device *ddma = to_ddma_device(chan); + struct phytium_ddma_chan *pchan = to_ddma_chan(chan); + struct dma_slave_config *sconfig = &pchan->dma_config; + struct phytium_ddma_desc *desc = NULL; + struct scatterlist *sg = NULL; + int i = 0; + char *tmp; + + if (unlikely(!is_slave_direction(direction))) { + dev_err(ddma->dev, "invalid dma direction\n"); + return NULL; + } + + if (unlikely(sg_len < 1)) { + dev_err(ddma->dev, "invalid segment length: %d\n", sg_len); + return NULL; + } + + desc = kzalloc(struct_size(desc, sg_req, sg_len), GFP_NOWAIT); + if (!desc) + return NULL; + + /* set sg list */ + for_each_sg(sgl, sg, sg_len, i) { + tmp = phys_to_virt(sg_dma_address(sg)); + desc->sg_req[i].direction = direction; + + switch (direction) { + case DMA_MEM_TO_DEV: + desc->sg_req[i].len = sg_dma_len(sg); + desc->sg_req[i].mem_addr_l = sg_dma_address(sg) & + 0xFFFFFFFF; + desc->sg_req[i].mem_addr_h = + (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; + desc->sg_req[i].dev_addr = sconfig->dst_addr & + 0xFFFFFFFF; + break; + + case DMA_DEV_TO_MEM: + desc->sg_req[i].len = sg_dma_len(sg); + desc->sg_req[i].mem_addr_l = sg_dma_address(sg) & + 0xFFFFFFFF; + desc->sg_req[i].mem_addr_h = + (sg_dma_address(sg) >> 32) & 0xFFFFFFFF; + desc->sg_req[i].dev_addr = sconfig->src_addr & + 0xFFFFFFFF; + break; + + default: + return NULL; + } + } + + desc->num_sgs = sg_len; + + return vchan_tx_prep(&pchan->vchan, &desc->vdesc, flags); +} + +static irqreturn_t phytium_dma_interrupt(int irq, void *dev_id) +{ + struct phytium_ddma_device *ddma = dev_id; + struct phytium_ddma_chan *chan; + u32 irq_status = 0; + u32 i = 0; + u32 val = 0; + + phytium_ddma_irq_disable(ddma); + + irq_status = phytium_ddma_irq_read(ddma); + val = phytium_ddma_ioread32(ddma, DMA_CTL); + + /* Poll, clear and process every chanel interrupt status */ + for (i = 0; i < ddma->dma_channels; i++) { + if (!(irq_status & BIT(i * 4))) + continue; + + chan = &ddma->chan[i]; + phytium_chan_xfer_done(chan); + } + + phytium_ddma_irq_enable(ddma); + + return IRQ_HANDLED; +} + +static struct dma_chan *phytium_ddma_of_xlate(struct of_phandle_args *dma_spec, + struct of_dma *ofdma) +{ + struct phytium_ddma_device *ddma = ofdma->of_dma_data; + struct device *dev = ddma->dev; + struct phytium_ddma_chan *chan = NULL; + struct dma_chan *c = NULL; + u32 channel_id = 0; + + channel_id = dma_spec->args[0]; + + if (channel_id > ddma->dma_channels) { + dev_err(dev, "bad channel %d\n", channel_id); + return NULL; + } + + chan = &ddma->chan[channel_id]; + chan->request_line = dma_spec->args[1]; + c = dma_get_slave_channel(&chan->vchan.chan); + if (!c) { + dev_err(dev, "no more channels available\n"); + return NULL; + } + + return c; +} + +static int phytium_ddma_probe(struct platform_device *pdev) +{ + struct phytium_ddma_device *ddma; + struct dma_device *dma_dev; + struct resource *mem; + u32 i = 0; + int ret = 0; + u32 nr_channels = 0; + + ddma = devm_kzalloc(&pdev->dev, sizeof(*ddma), GFP_KERNEL); + if (!ddma) { + ret = -ENOMEM; + goto out; + } + + dma_dev = &ddma->dma_dev; + ddma->dev = &pdev->dev; + + spin_lock_init(&ddma->lock); + + ddma->irq = platform_get_irq(pdev, 0); + if (ddma->irq < 0) { + dev_err(&pdev->dev, "no irq resource\n"); + ret = -EINVAL; + goto out; + } + + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); + ddma->base = devm_ioremap_resource(&pdev->dev, mem); + if (IS_ERR(ddma->base)) { + dev_err(&pdev->dev, "no resource address"); + ret = PTR_ERR(ddma->base); + goto out; + } + + ret = of_property_read_u32(pdev->dev.of_node, "dma-channels", + &nr_channels); + if (ret < 0) { + dev_err(&pdev->dev, + "can't get the number of dma channels: %d\n", ret); + goto out; + } + + if (nr_channels > DDMA_MAX_NR_PCHANNELS) { + dev_warn(&pdev->dev, "over the max number of channels\n"); + nr_channels = DDMA_MAX_NR_PCHANNELS; + } + + ddma->dma_channels = DDMA_MAX_NR_PCHANNELS; + + ret = devm_request_irq(&pdev->dev, ddma->irq, phytium_dma_interrupt, + IRQF_SHARED, dev_name(&pdev->dev), ddma); + if (ret) { + dev_err(&pdev->dev, "could not to request irq %d", ddma->irq); + goto out; + } + + /* Set capabilities */ + dma_cap_set(DMA_SLAVE, ddma->dma_dev.cap_mask); + + /* DMA capabilities */ + dma_dev->dev = ddma->dev; + dma_dev->chancnt = ddma->dma_channels; + dma_dev->src_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_4_BYTES); + dma_dev->dst_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_4_BYTES); + dma_dev->directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV); + dma_dev->residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; + + /* function callback */ + dma_dev->device_tx_status = phytium_ddma_tx_status; + dma_dev->device_issue_pending = phytium_ddma_issue_pending; + dma_dev->device_terminate_all = phytium_ddma_terminate_all; + dma_dev->device_alloc_chan_resources = + phytium_ddma_alloc_chan_resources; + dma_dev->device_free_chan_resources = phytium_ddma_free_chan_resources; + dma_dev->device_config = phytium_ddma_slave_config; + dma_dev->device_prep_slave_sg = phytium_ddma_prep_slave_sg; + dma_dev->device_pause = phytium_chan_pause; + dma_dev->device_resume = phytium_chan_resume; + + /* init dma physical channels */ + INIT_LIST_HEAD(&dma_dev->channels); + ddma->chan = devm_kcalloc(ddma->dev, ddma->dma_channels, + sizeof(*ddma->chan), GFP_KERNEL); + if (!ddma->chan) { + ret = -ENOMEM; + goto out; + } + for (i = 0; i < ddma->dma_channels; i++) { + ddma->chan[i].id = i; + ddma->chan[i].buf = NULL; + ddma->chan[i].base = + ddma->base + DMA_REG_LEN + i * CHAN_REG_LEN; + ddma->chan[i].vchan.desc_free = phytium_ddma_vdesc_free; + ddma->chan[i].desc = NULL; + ddma->chan[i].current_sg = NULL; + vchan_init(&ddma->chan[i].vchan, dma_dev); + } + + phytium_dma_hw_init(ddma); + + ret = dma_async_device_register(dma_dev); + if (ret) + goto out; + + ret = of_dma_controller_register(pdev->dev.of_node, + phytium_ddma_of_xlate, ddma); + if (ret < 0) { + dev_err(&pdev->dev, "phytium ddma of register failed %d\n", + ret); + goto err_unregister; + } + + platform_set_drvdata(pdev, ddma); + dev_info(ddma->dev, "phytium DDMA Controller registered\n"); + + return 0; + +err_unregister: + dma_async_device_unregister(dma_dev); + +out: + return ret; +} + +static void phytium_ddma_chan_remove(struct phytium_ddma_chan *chan) +{ + phytium_chan_irq_disable(chan); + phytium_chan_disable(chan); + + if (chan->buf) + dma_free_coherent(chan_to_dev(chan), 4 * PAGE_SIZE, chan->buf, + chan->paddr); + + tasklet_kill(&chan->vchan.task); + list_del(&chan->vchan.chan.device_node); +} + +static int phytium_ddma_remove(struct platform_device *pdev) +{ + struct phytium_ddma_device *ddma = platform_get_drvdata(pdev); + struct phytium_ddma_chan *chan = NULL; + int i = 0; + + of_dma_controller_free(pdev->dev.of_node); + dma_async_device_unregister(&ddma->dma_dev); + + for (i = 0; i < ddma->dma_channels; i++) { + chan = &ddma->chan[i]; + phytium_ddma_chan_remove(chan); + } + + phytium_ddma_irq_disable(ddma); + phytium_ddma_disable(ddma); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_ddma_suspend(struct device *dev) +{ + struct phytium_ddma_device *ddma = dev_get_drvdata(dev); + int i = 0; + + for (i = 0; i < ddma->dma_channels; i++) { + if (phytium_chan_is_running(&ddma->chan[i])) { + dev_warn(dev, "suspend is prevented by channel %d\n", + i); + return -EBUSY; + } + } + + ddma->dma_reg.dma_chal_cfg0 = + phytium_ddma_ioread32(ddma, DMA_CHAL_CFG_L); + ddma->dma_reg.dma_chal_bind = + phytium_ddma_ioread32(ddma, DMA_CHAL_BIND); + ddma->dma_reg.dma_chal_cfg1 = + phytium_ddma_ioread32(ddma, DMA_CHAL_CFG_H); + + for (i = 0; i < ddma->dma_channels; i++) { + struct phytium_ddma_chan *chan = &ddma->chan[i]; + + if (!chan->is_used) + continue; + ddma->dma_chal_reg[i].dma_chalx_ctl = + phytium_chan_ioread32(chan, DMA_CHALX_CTL); + ddma->dma_chal_reg[i].dma_chalx_timeout_cnt = + phytium_chan_ioread32(chan, DMA_CHALX_TIMEOUT_CNT); + } + + phytium_ddma_irq_disable(ddma); + phytium_ddma_disable(ddma); + pm_runtime_force_suspend(dev); + + return 0; +} + +static int phytium_ddma_resume(struct device *dev) +{ + struct phytium_ddma_device *ddma = dev_get_drvdata(dev); + u32 i = 0; + int ret = 0; + + phytium_dma_hw_init(ddma); + phytium_ddma_iowrite32(ddma, DMA_CHAL_CFG_L, + ddma->dma_reg.dma_chal_cfg0); + phytium_ddma_iowrite32(ddma, DMA_CHAL_BIND, + ddma->dma_reg.dma_chal_bind); + phytium_ddma_iowrite32(ddma, DMA_CHAL_CFG_H, + ddma->dma_reg.dma_chal_cfg1); + + for (i = 0; i < ddma->dma_channels; i++) { + struct phytium_ddma_chan *chan = &ddma->chan[i]; + + if (!chan->is_used) + continue; + phytium_chan_iowrite32(chan, DMA_CHALX_CTL, + ddma->dma_chal_reg[i].dma_chalx_ctl); + phytium_chan_iowrite32(chan, DMA_CHALX_TIMEOUT_CNT, + ddma->dma_chal_reg[i].dma_chalx_timeout_cnt); + } + + ret = pm_runtime_force_resume(dev); + + return ret; +} +#endif + +static const struct dev_pm_ops phytium_ddma_pm_ops = { + SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_ddma_suspend, phytium_ddma_resume) +}; + +static const struct of_device_id phytium_dma_of_id_table[] = { + { .compatible = "phytium,ddma" }, + {} +}; +MODULE_DEVICE_TABLE(of, phytium_dma_of_id_table); + +static struct platform_driver phytium_driver = { + .probe = phytium_ddma_probe, + .remove = phytium_ddma_remove, + .driver = { + .name = "phytium-ddma", + .of_match_table = of_match_ptr(phytium_dma_of_id_table), + .pm = &phytium_ddma_pm_ops, + }, +}; + +static __init int phytium_ddma_init(void) +{ + return platform_driver_register(&phytium_driver); +} + +static void __exit phytium_ddma_exit(void) +{ + platform_driver_unregister(&phytium_driver); +} + +subsys_initcall(phytium_ddma_init); +module_exit(phytium_ddma_exit); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium DDMA Controller platform driver"); +MODULE_AUTHOR("Huang Jie "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-ddmac.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-ddmac.h new file mode 100644 index 0000000000000000000000000000000000000000..7c55c4282873ea91090d0a41a695334dd2bd2cf4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-ddmac.h @@ -0,0 +1,168 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium Device DMA Controller driver. + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + * + */ + +#ifndef _PHYTIUM_DDMAC_H +#define _PHYTIUM_DDMAC_H + +#include +#include +#include +#include +#include +#include "../virt-dma.h" + +/* the number of physical channel */ +#define DDMA_MAX_NR_PCHANNELS 8 + +#define DMAC_MAX_MASTERS 1 +#define DMAC_MAX_BLK_SIZE PAGE_SIZE + +#define CHAN_REG_LEN 0x40 +#define DMA_REG_LEN 0x40 + +#define DMA_CTL 0x00 +#define DMA_CHAL_CFG_L 0x04 +#define DMA_CHAL_CFG_H 0x28 +#define DMA_STAT 0x08 +#define DMA_MASK_INT 0x0C +#define DMA_CHAL_BIND 0x20 +#define DMA_GCAP 0x24 + +#define DMA_CHALX_DDR_UPADDR 0x00 +#define DMA_CHALX_DDR_LWADDR 0x04 +#define DMA_CHALX_DEV_ADDR 0x08 +#define DMA_CHALX_TS 0x0C +#define DMA_CHALX_CRT_UPADDR 0x10 +#define DMA_CHALX_CRT_LWADDR 0x14 +#define DMA_CHALX_CTL 0x18 +#define DMA_CHALX_STS 0x1C +#define DMA_CHALX_TIMEOUT_CNT 0x20 +#define DMA_CHALX_TRANS_CNT 0x24 + +#define DMA_CTL_EN BIT(0) +#define DMA_CTL_SRST BIT(1) + +#define DMA_CHAL_SEL(id, x) (min_t(unsigned int, x, 0x7F) << (id * 8)) +#define DMA_CHAL_SEL_EN(id) BIT(id * 8 + 7) + +#define DMA_STAT_CHAL(id) BIT(id * 4) + +#define DMA_INT_EN BIT(31) +#define DMA_INT_CHAL_EN(id) BIT(id) + +#define DMA_CHAL_EN BIT(0) +#define DMA_CHAL_SRST BIT(1) +#define DMA_CHAL_MODE BIT(2) + +#define DMA_RX_REQ 1 +#define DMA_TX_REQ 0 + +#define DMA_CHAL_TIMEOUT_EN BIT(31) +#define DMA_CHAL_TIMEOUT_CNT(x) min_t(unsigned int, x, 0xFFFFF) + +#define DMA_TIMEOUT 10 + +/** + * struct phytium_ddma_sg_req - scatter-gatter list data info + * @len: number of bytes to transform + * @mem_addr_l: bus address low 32bit + * @mem_addr_h: bus address high 32bit + * @dev_addr: dma cousumer data reg addr + * @direction: dma transmit direction + */ +struct phytium_ddma_sg_req { + u32 len; + u32 mem_addr_l; + u32 mem_addr_h; + u32 dev_addr; + enum dma_transfer_direction direction; +}; + +/** + * struct phytium_ddma_desc - + * the struct holding info describing ddma request + * descriptor + * @vdesc: ddma request descriptor + * @num_sgs: the size of scatter-gatter list + * @sg_req: use to save scatter-gatter list info + */ +struct phytium_ddma_desc { + struct virt_dma_desc vdesc; + u32 num_sgs; + struct phytium_ddma_sg_req sg_req[]; +}; + +/** + * struct phytium_ddma_chan - + * the struct holding info describing dma channel + * @vchan: virtual dma channel + * @base: the mapped register I/O of dma physical channel + * @id: the id of ddma physical channel + * @request_line: the request line of ddma channel + * @desc: the transform request descriptor + * @dma_config: config parameters for dma channel + * @busy: the channel busy flag, this flag set when channel is tansferring + * @is_used: the channel bind flag, this flag set when channel binded + * @next_sg: the index of next scatter-gatter + * @current_sg: use to save the current transfer scatter-gatter info + * @paddr: use to align data between dma provider and consumer + */ +struct phytium_ddma_chan { + struct virt_dma_chan vchan; + void __iomem *base; + u32 id; + u32 request_line; + struct phytium_ddma_desc *desc; + struct dma_slave_config dma_config; + bool busy; + bool is_used; + bool is_pasued; + u32 next_sg; + struct phytium_ddma_sg_req *current_sg; + dma_addr_t paddr; + char *buf; +}; + +struct global_reg { + u32 dma_chal_cfg0; + u32 dma_chal_bind; + u32 dma_chal_cfg1; +}; + +struct channel_reg { + u32 dma_chalx_ctl; + u32 dma_chalx_timeout_cnt; +}; + +/** + * struct phytium_ddma_device - + * the struct holding info describing DDMA device + * @dma_dev: an instance for struct dma_device + * @irq: the irq that DDMA using + * @base: the mapped register I/O base of this DDMA + * @core_clk: DDMA clock + * @dma_channels: the number of DDMA physical channels + * @chan: the phyical channels of DDMA + * @lock: spinlock to lock when set global registers + * @dma_reg: store global register value which need recover after resume + * @dma_chal_reg: store channel register value which need recover after resume + */ +struct phytium_ddma_device { + struct dma_device dma_dev; + struct device *dev; + int irq; + void __iomem *base; + struct clk *core_clk; + u32 dma_channels; + struct phytium_ddma_chan *chan; + spinlock_t lock; + struct global_reg dma_reg; + struct channel_reg dma_chal_reg[DDMA_MAX_NR_PCHANNELS]; +}; + +#endif /* _PHYTIUM_DDMAC_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-dmac-pci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-dmac-pci.c new file mode 100644 index 0000000000000000000000000000000000000000..530b56905b76aac7328a7ff61f42476e4efb4386 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-dmac-pci.c @@ -0,0 +1,1076 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2021 Phytium Limited. + * + * Phytium PCI DMA Controller driver. + * + * 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 +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + +#include +#include +#include +#include +#include + +#include "phytium-dmac-pci.h" +#include "../dmaengine.h" + +static const struct dma_slave_map ft_px210gpu_slave_map[] = { + {"px210-dma", "tx", 0}, + {"px210-dma", "rx", 0}, +}; + +static inline void +phytium_dma_iowrite32(struct phytium_dma_chip *chip, u32 reg, u32 val) +{ + iowrite32(val, chip->regs + reg); +} + +static inline u32 phytium_dma_ioread32(struct phytium_dma_chip *chip, u32 reg) +{ + return ioread32(chip->regs + reg); +} + +static inline void +phytium_chan_iowrite32(struct phytium_dma_chan *chan, u32 reg, u32 val) +{ + iowrite32(val, chan->chan_regs + reg); +} + +static inline u32 phytium_chan_ioread32(struct phytium_dma_chan *chan, u32 reg) +{ + return ioread32(chan->chan_regs + reg); +} + +static inline void phytium_dma_irq_disable(struct phytium_dma_chip *chip) +{ + u32 val; + + val = 0; + phytium_dma_iowrite32(chip, DMA_IRQ_MASK, val); +} + +static inline void phytium_dma_irq_enable(struct phytium_dma_chip *chip) +{ + u32 val; + + val = 0x4077FFFF; + phytium_dma_iowrite32(chip, DMA_IRQ_MASK, val); +} + +static inline void phytium_dma_irq_clear(struct phytium_dma_chip *chip, + u32 irq_status) +{ + phytium_dma_iowrite32(chip, DMA_IRQ_STATUS, irq_status); +} + +static inline u32 phytium_dma_irq_read(struct phytium_dma_chip *chip) +{ + u32 val; + + val = phytium_dma_ioread32(chip, DMA_IRQ_STATUS); + + return val; +} + +static inline u32 phytium_dma_irq_mask_read(struct phytium_dma_chip *chip) +{ + u32 val; + + val = phytium_dma_ioread32(chip, DMA_IRQ_MASK); + + return val; +} + + +static inline void phytium_chan_irq_disable + (struct phytium_dma_chan *chan, u32 irq_mask) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CONTROL); + val &= ~irq_mask; + phytium_chan_iowrite32(chan, DMA_CONTROL, val); +} + +static inline void phytium_chan_irq_set + (struct phytium_dma_chan *chan, u32 irq_mask) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CONTROL); + val &= ~DMA_CTRL_IRQ_MASK(0xF); + val |= irq_mask; + val |= DMA_CTRL_IRQ_ID(1); + phytium_chan_iowrite32(chan, DMA_CONTROL, val); +} + +static inline void phytium_chan_irq_clear + (struct phytium_dma_chan *chan, u32 irq_mask) +{ + u32 val; + + val = phytium_dma_ioread32(chan->chip, DMA_IRQ_STATUS); + val &= ~irq_mask; + phytium_chan_iowrite32(chan, DMA_IRQ_STATUS, val); +} + +static inline u32 phytium_chan_irq_read(struct phytium_dma_chan *chan) +{ + u32 val; + + val = phytium_dma_ioread32(chan->chip, DMA_IRQ_STATUS); + val &= ((chan->id << 0) | (chan->id << 8)); + + return val; +} + +static inline u32 phytium_chan_status_read(struct phytium_dma_chan *chan) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_STATUS); + + return val; +} + +static inline void phytium_chan_disable(struct phytium_dma_chan *chan) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CONTROL); + val &= ~DMA_CTRL_START; + phytium_chan_iowrite32(chan, DMA_CONTROL, val); +} + +static inline void phytium_chan_enable(struct phytium_dma_chan *chan) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CONTROL); + val |= DMA_CTRL_START; + phytium_chan_iowrite32(chan, DMA_CONTROL, val); +} + +static inline const char *phytium_chan_name(struct phytium_dma_chan *chan) +{ + return dma_chan_name(&chan->vc.chan); +} + +static struct phytium_dma_desc *phytium_desc_get(struct phytium_dma_chan *chan) +{ + struct phytium_dma_desc *desc = NULL; + + desc = kmalloc(sizeof(*desc), GFP_KERNEL); + if (unlikely(!desc)) { + dev_err(chan2dev(chan), "%s: not enough descriptors available\n", + phytium_chan_name(chan)); + return NULL; + } + + memset(desc, 0, sizeof(*desc)); + + INIT_LIST_HEAD(&desc->xfer_list); + + return desc; +} + +static void phytium_desc_put(struct phytium_dma_desc *desc) +{ + unsigned int descs_put = 0; + + kfree(desc); + + descs_put++; +} + +static void phytium_vchan_desc_put(struct virt_dma_desc *vdesc) +{ + phytium_desc_put(vd_to_desc(vdesc)); +} + +static inline bool phytium_chan_is_running(struct phytium_dma_chan *chan) +{ + u32 val; + + val = phytium_chan_ioread32(chan, DMA_CONTROL); + + if (val & DMA_CTRL_START) + return true; + else + return false; +} + +/* Called in chan locked context */ +static void phytium_chan_block_xfer_start(struct phytium_dma_chan *chan, + struct phytium_dma_desc *desc) +{ + u32 irq_mask; + u32 val; + + chan->is_idle = false; + if (phytium_chan_is_running(chan)) { + dev_err(chan2dev(chan), "%s is non-idle!\n", + phytium_chan_name(chan)); + return; + } + + phytium_chan_iowrite32(chan, DMA_SRCPARAM, desc->dma_srcparam); + phytium_chan_iowrite32(chan, DMA_DESTPARAM, desc->dma_destparam); + phytium_chan_iowrite32(chan, DMA_SRCADDR_L, desc->dma_srcaddr_l); + phytium_chan_iowrite32(chan, DMA_SRCADDR_H, desc->dma_srcaddr_h); + phytium_chan_iowrite32(chan, DMA_DESTADDR_L, desc->dma_destaddr_l); + phytium_chan_iowrite32(chan, DMA_DESTADDR_H, desc->dma_destaddr_h); + phytium_chan_iowrite32(chan, DMA_LENGTH, desc->dma_len); + + /* SG_TYPE & IRQ_ID & SE_COND & SG_EN */ + val = phytium_chan_ioread32(chan, DMA_CONTROL); + val |= desc->dma_ctrl; + val |= DMA_CTRL_COND_LEN | DMA_CTRL_COND_EOP | DMA_CTRL_COND_ERR; + + phytium_chan_iowrite32(chan, DMA_CONTROL, val); + + irq_mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; + phytium_chan_irq_set(chan, irq_mask); + + phytium_chan_enable(chan); +} + +static void phytium_chan_start_first_queued(struct phytium_dma_chan *chan) +{ + struct phytium_dma_desc *desc = NULL; + struct virt_dma_desc *vd = NULL; + + vd = vchan_next_desc(&chan->vc); + if (!vd) + return; + + desc = vd_to_desc(vd); + dev_dbg(chan2dev(chan), "%s: started %u\n", phytium_chan_name(chan), + vd->tx.cookie); + + phytium_chan_block_xfer_start(chan, desc); +} + +static void phytium_dma_hw_init(struct phytium_dma_chip *chip) +{ + u32 i; + + for (i = 0; i < chip->hdata->nr_channels; i++) { + phytium_chan_irq_disable(&chip->dmac->chan[i], + DMA_CTRL_IRQ_MASK(0xF)); + phytium_chan_disable(&chip->dmac->chan[i]); + } +} + + +static enum dma_status phytium_dma_tx_status(struct dma_chan *dchan, + dma_cookie_t cookie, + struct dma_tx_state *state) +{ + enum dma_status ret; + + ret = dma_cookie_status(dchan, cookie, state); + + return ret; +} + +static void phytium_dma_issue_pending(struct dma_chan *dchan) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + unsigned long flags; + + spin_lock_irqsave(&chan->vc.lock, flags); + if (vchan_issue_pending(&chan->vc) && chan->is_idle) + phytium_chan_start_first_queued(chan); + spin_unlock_irqrestore(&chan->vc.lock, flags); +} + +static void phytium_dma_synchronize(struct dma_chan *dchan) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + + vchan_synchronize(&chan->vc); +} + +static int phytium_dma_terminate_all(struct dma_chan *dchan) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + unsigned long flags; + LIST_HEAD(head); + + spin_lock_irqsave(&chan->vc.lock, flags); + + phytium_chan_disable(chan); + + vchan_get_all_descriptors(&chan->vc, &head); + + /* + * As vchan_dma_desc_free_list can access to desc_allocated list + * we need to call it in vc.lock context. + */ + vchan_dma_desc_free_list(&chan->vc, &head); + + spin_unlock_irqrestore(&chan->vc.lock, flags); + + dev_vdbg(dchan2dev(dchan), "terminated: %s\n", phytium_chan_name(chan)); + + return 0; +} + +static int phytium_dma_alloc_chan_resources(struct dma_chan *dchan) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + + /* ASSERT: channel is idle */ + if (chan->is_used) { + dev_err(chan2dev(chan), "%s is non-idle!\n", + phytium_chan_name(chan)); + return -EBUSY; + } + + chan->is_used = true; + atomic_set(&chan->releasing, 0); + + return 0; +} + +static void phytium_dma_free_chan_resources(struct dma_chan *dchan) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + + atomic_set(&chan->releasing, 1); + + phytium_chan_disable(chan); + phytium_chan_irq_disable(chan, DMA_CTRL_IRQ_MASK(0xF)); + + vchan_free_chan_resources(&chan->vc); + + dev_vdbg(dchan2dev(dchan), + "%s: free resources, descriptor still allocated: %u\n", + phytium_chan_name(chan), atomic_read(&chan->descs_allocated)); + + chan->is_used = false; +} + +static int phytium_dma_slave_config(struct dma_chan *dchan, + struct dma_slave_config *sconfig) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + + /* Check if chan will be configured for slave transfers */ + if (!is_slave_direction(sconfig->direction)) + return -EINVAL; + + memcpy(&chan->dma_sconfig, sconfig, sizeof(*sconfig)); + + return 0; +} + +static struct dma_async_tx_descriptor *phytium_dma_prep_dma_memcpy( + struct dma_chan *dchan, dma_addr_t dst_adr, + dma_addr_t src_adr, size_t len, unsigned long flags) +{ + struct phytium_dma_desc *desc = NULL; + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + struct dma_slave_config *sconfig = &chan->dma_sconfig; + size_t block_ts, max_block_ts, xfer_len; + + chan = dchan_to_dma_chan(dchan); + + dev_info(chan2dev(chan), "%s: memcpy: src: %pad dst: %pad length: %zd flags: %#lx", + phytium_chan_name(chan), &src_adr, &dst_adr, len, flags); + + max_block_ts = chan->chip->hdata->block_size[chan->id]; + if (len > max_block_ts) { + dev_err(chan2dev(chan), + "The data length(%zd) is too long!\n", len); + return NULL; + } + + xfer_len = len; + block_ts = xfer_len >> DMA_SLAVE_BUSWIDTH_4_BYTES; + xfer_len = block_ts << DMA_SLAVE_BUSWIDTH_4_BYTES; + + desc = phytium_desc_get(chan); + if (unlikely(!desc)) + goto err_desc_get; + + switch (sconfig->direction) { + case DMA_MEM_TO_DEV: + desc->dma_srcparam = DMA_SRCP_SRC_ID(0); + desc->dma_destparam = DMA_DESTP_DEST_ID(5); + break; + case DMA_DEV_TO_MEM: + desc->dma_srcparam = DMA_SRCP_SRC_ID(5); + desc->dma_destparam = DMA_DESTP_DEST_ID(0); + break; + default: + return NULL; + } + + desc->dma_ctrl |= DMA_CTRL_SG_EN; + desc->dma_ctrl |= DMA_CTRL_SG_TYPE(0); + + desc->dma_ctrl |= DMA_CTRL_SG_ID(0); + desc->dma_ctrl |= DMA_CTRL_SG2_ID(0); + desc->dma_ctrl |= DMA_CTRL_IRQ_ID(0); + + desc->dma_srcaddr_l = src_adr & 0xFFFFFFFF; + desc->dma_srcaddr_h = (src_adr >> 32) & 0xFFFFFFFF; + desc->dma_destaddr_l = dst_adr & 0xFFFFFFFF; + desc->dma_destaddr_h = (dst_adr >> 32) & 0xFFFFFFFF; + desc->dma_len = xfer_len; + + return vchan_tx_prep(&chan->vc, &desc->vd, flags); + +err_desc_get: + phytium_desc_put(desc); + return NULL; +} + +static struct dma_async_tx_descriptor *phytium_dma_prep_slave_sg( + struct dma_chan *dchan, struct scatterlist *sgl, + u32 sg_len, enum dma_transfer_direction direction, + unsigned long flags, void *context) +{ + struct phytium_dma_chan *chan = dchan_to_dma_chan(dchan); + struct dma_slave_config *sconfig = &chan->dma_sconfig; + struct phytium_dma_desc *desc = NULL; + struct phytium_chan_desc *chan_desc = NULL; + dma_addr_t reg; + unsigned int i = 0; + struct scatterlist *sg = NULL; + size_t total_len = 0; + u32 offset = 0; + + if (unlikely(!is_slave_direction(direction) || !sg_len)) { + dev_err(chan2dev(chan), "%s: bad direction\n", __func__); + return NULL; + } + + if (atomic_read(&chan->releasing)) { + dev_err(chan2dev(chan), + "%s: scheduled for release\n", __func__); + return NULL; + } + + desc = phytium_desc_get(chan); + if (unlikely(!desc)) + goto err_desc_get; + + chan_desc = kzalloc((sg_len + 1) * sizeof(struct phytium_chan_desc), + GFP_KERNEL | GFP_DMA); + if (unlikely(!chan_desc)) { + dev_err(chan->chip->dev, "Malloc space for chan_desc failed\n"); + goto err_desc_get; + } + + desc->cdesc = chan_desc; + + /* Must be aligned on 32-byte boundary */ + offset = (u64)chan_desc & 0x1F; + if (offset) + chan_desc = chan_desc + 32 - offset; + + for_each_sg(sgl, sg, sg_len, i) { + if (!sg) + break; + + if (direction == DMA_MEM_TO_DEV) { + chan_desc[i].desc_src_addr_l = + sg_dma_address(sg) & SG_OFFSET; + chan_desc[i].desc_src_addr_h = + (sg_dma_address(sg) >> 32) & + SG_OFFSET; + } else if (direction == DMA_DEV_TO_MEM) { + chan_desc[i].desc_dst_addr_l = + sg_dma_address(sg) & SG_OFFSET; + chan_desc[i].desc_dst_addr_h = + (sg_dma_address(sg) >> 32) & + SG_OFFSET; + } else { + kfree(desc->cdesc); + goto err_desc_get; + } + + chan_desc[i].desc_control = 0; + chan_desc[i].desc_control |= sg_dma_len(sg) << 8; + + if (sg_is_last(sg)) { + chan_desc[i].desc_next_addr_l = 0x01; + chan_desc[i].desc_next_addr_h = 0; + chan_desc[i].desc_control |= 0x03 << 4; + } else { + chan_desc[i].desc_next_addr_l = + virt_to_phys(&chan_desc[i+1]) & SG_OFFSET; + chan_desc[i].desc_next_addr_l |= 0x01 << 4; + chan_desc[i].desc_next_addr_l |= 0x02; + chan_desc[i].desc_next_addr_h = + (virt_to_phys(&chan_desc[i+1]) >> 32) & + SG_OFFSET; + } + total_len += sg_dma_len(sg); + } + + switch (direction) { + case DMA_MEM_TO_DEV: + reg = sconfig->dst_addr; + + desc->dma_srcparam = DMA_SRCP_SRC_ID(0); + desc->dma_destparam = DMA_DESTP_DEST_ID(5); + desc->dma_ctrl |= DMA_CTRL_SG_TYPE(1); + + desc->dma_srcaddr_l = virt_to_phys(chan_desc) & SG_OFFSET; + desc->dma_srcaddr_h = + (virt_to_phys(chan_desc) >> 32) & SG_OFFSET; + desc->dma_destaddr_l = sconfig->dst_addr & SG_OFFSET; + desc->dma_destaddr_h = (sconfig->dst_addr >> 32) & SG_OFFSET; + break; + case DMA_DEV_TO_MEM: + reg = sconfig->src_addr; + + /* memcpy from device */ + desc->dma_srcparam = DMA_SRCP_SRC_ID(5); + desc->dma_destparam = DMA_DESTP_DEST_ID(0); + desc->dma_ctrl |= DMA_CTRL_SG_TYPE(2); + + desc->dma_srcaddr_l = sconfig->src_addr & SG_OFFSET; + desc->dma_srcaddr_h = (sconfig->src_addr >> 32) & SG_OFFSET; + desc->dma_destaddr_l = + virt_to_phys(chan_desc) & SG_OFFSET; + desc->dma_destaddr_h = + (virt_to_phys(chan_desc) >> 32) & SG_OFFSET; + break; + default: + return NULL; + } + + desc->dma_ctrl |= DMA_CTRL_SG_EN; + + desc->dma_ctrl |= DMA_CTRL_SG_ID(0); + desc->dma_ctrl |= DMA_CTRL_SG2_ID(0); + desc->dma_ctrl |= DMA_CTRL_IRQ_ID(0); + + desc->dma_len = total_len; + + return vchan_tx_prep(&chan->vc, &desc->vd, flags); + +err_desc_get: + dev_err(chan2dev(chan), + "not enough descriptors available. Direction %d\n", direction); + phytium_desc_put(desc); + return NULL; +} + +static void phytium_chan_block_xfer_complete_msi(struct phytium_dma_chan *chan) +{ + struct virt_dma_desc *vd = NULL; + struct phytium_dma_desc *desc = NULL; + + chan->is_idle = true; + if (phytium_chan_is_running(chan)) { + dev_err(chan2dev(chan), "DMA %s is not idle!\n", + phytium_chan_name(chan)); + phytium_chan_disable(chan); + } + + /* The completed descriptor currently is in the head of vc list */ + vd = vchan_next_desc(&chan->vc); + if (!vd) { + dev_err(chan2dev(chan), "complete vchan next desc failed\n"); + return; + } + + desc = vd_to_desc(vd); + if (!desc) { + dev_err(chan2dev(chan), "vd to desc failed\n"); + return; + } + + kfree(desc->cdesc); + + /* Remove the completed descriptor from issued list before completing */ + list_del(&vd->node); + vchan_cookie_complete(vd); + + /* Submit queued descriptors after processing the completed ones */ + phytium_chan_start_first_queued(chan); +} + +static void phytium_chan_block_xfer_complete_intx(struct phytium_dma_chan *chan) +{ + struct virt_dma_desc *vd = NULL; + struct phytium_dma_desc *desc = NULL; + unsigned long flags; + + spin_lock_irqsave(&chan->vc.lock, flags); + chan->is_idle = true; + if (phytium_chan_is_running(chan)) { + dev_err(chan2dev(chan), "DMA %s is not idle!\n", + phytium_chan_name(chan)); + phytium_chan_disable(chan); + } + + /* The completed descriptor currently is in the head of vc list */ + vd = vchan_next_desc(&chan->vc); + if (!vd) { + spin_unlock_irqrestore(&chan->vc.lock, flags); + dev_err(chan2dev(chan), "complete vchan next desc failed\n"); + return; + } + + desc = vd_to_desc(vd); + if (!desc) { + spin_unlock_irqrestore(&chan->vc.lock, flags); + dev_err(chan2dev(chan), "vd to desc failed\n"); + return; + } + + kfree(desc->cdesc); + + /* Remove the completed descriptor from issued list before completing */ + list_del(&vd->node); + vchan_cookie_complete(vd); + + /* Submit queued descriptors after processing the completed ones */ + phytium_chan_start_first_queued(chan); + spin_unlock_irqrestore(&chan->vc.lock, flags); +} + +static irqreturn_t phytium_dma_interrupt_msi(int irq, void *dev_id) +{ + unsigned long flags; + struct phytium_dma_chan *chan = dev_id; + struct phytium_dma_chip *chip = chan->chip; + + u32 irq_status; + u32 irq_mask = 0xffff; + u32 chan_status; + u32 mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; + + spin_lock_irqsave(&chan->vc.lock, flags); + + chan_status = phytium_chan_status_read(chan); + irq_status = phytium_dma_irq_read(chip); + + if (!(irq_status & irq_mask)) { + dev_err(chan2dev(chan), "irq_status = 0x%x, irq_mask = 0x%x, chan_status = 0x%x", + irq_status, irq_mask, chan_status); + if ((chan_status & DMA_STAT_END) | + (chan_status & DMA_STAT_EOP) | + (chan_status & DMA_STAT_EOC) | + (chan_status & DMA_STAT_ERR)) { + irq_status = phytium_dma_irq_read(chip); + goto next; + } else { + return IRQ_NONE; + } + } + +next: + /* Disable DMAC inerrupts. We'll enable them after processing chanels */ + phytium_dma_irq_disable(chip); + phytium_chan_irq_disable(chan, mask); + phytium_chan_irq_clear(chan, mask); + phytium_dma_irq_clear(chip, irq_status); + + if ((chan_status & DMA_STAT_ERR)) { + dev_err(chan2dev(chan), "chan handle err, chan status is %x\n", + chan_status); + } else if ((chan_status & DMA_STAT_END) | (chan_status & DMA_STAT_EOP) | + (chan_status & DMA_STAT_EOC)) { + phytium_chan_block_xfer_complete_msi(chan); + } else { + dev_err(chan2dev(chan), "irq_status = 0x%x, ----unknown reason:%x\n", + irq_status, chan_status); + } + + /* Re-enable interrupts */ + phytium_dma_irq_enable(chip); + + spin_unlock_irqrestore(&chan->vc.lock, flags); + + return IRQ_HANDLED; +} + +static irqreturn_t phytium_dma_interrupt_intx(int irq, void *dev_id) +{ + struct phytium_dma_chip *chip = dev_id; + struct phytium_dma *dmac = chip->dmac; + struct phytium_dma_chan *chan; + u32 irq_status = 0; + u32 irq_mask = 0; + u32 chan_status = 0; + u32 mask = DMA_CTRL_IRQ_END | DMA_CTRL_IRQ_EOP | DMA_CTRL_IRQ_ERR; + u32 i; + + irq_status = phytium_dma_irq_read(chip); + irq_status = irq_status & 0xffff; + irq_mask = phytium_dma_irq_mask_read(chip); + + if (!(irq_status & irq_mask)) + return IRQ_NONE; + + /* Disable DMAC inerrupts. We'll enable them after processing chanels */ + phytium_dma_irq_disable(chip); + phytium_dma_irq_clear(chip, irq_status); + + /* Poll, clear and process every chanel interrupt status */ + for (i = 0; i < chip->hdata->nr_channels; i++) { + if (!(irq_status & BIT(i)) && !(irq_status & BIT(i + 8))) + continue; + + chan = &dmac->chan[i]; + + chan_status = phytium_chan_status_read(chan); + + phytium_chan_irq_disable(chan, mask); + if ((chan_status & DMA_STAT_ERR)) + dev_err(chan2dev(chan), "chan handle err, chan status is %x\n", + chan_status); + else if ((chan_status & DMA_STAT_END) | + (chan_status & DMA_STAT_EOP) | + (chan_status & DMA_STAT_EOC)) + phytium_chan_block_xfer_complete_intx(chan); + else + dev_err(chan2dev(chan), "irq_status = 0x%x, ----unknown reason:%x\n", + irq_status, chan_status); + + phytium_chan_irq_set(chan, mask); + } + + /* Re-enable interrupts */ + phytium_dma_irq_enable(chip); + + return IRQ_HANDLED; +} + +struct phytium_dma_hcfg phytium_octopus_dma_hdata = { + .nr_channels = 4, + .nr_masters = 1, + .m_data_width = DMA_SLAVE_BUSWIDTH_4_BYTES, + .block_size[0] = 0x2000000, + .block_size[1] = 0x2000000, + .priority[0] = 0, + .priority[1] = 1, + .axi_rw_burst_len = 0, + .restrict_axi_burst_len = false, +}; + +static int phytium_dma_probe(struct phytium_dma_chip *chip) +{ + struct phytium_dma_chan *chan; + struct pci_dev *pdev = chip->pdev; + struct phytium_dma *dmac; + struct phytium_dma_hcfg *hdata; + u32 i; + int ret = -1; + + chip->dev = &pdev->dev; + dmac = devm_kzalloc(chip->dev, sizeof(*dmac), GFP_KERNEL); + if (!dmac) { + dev_err(chip->dev, "dmac zalloc failed\n"); + return -ENOMEM; + } + + hdata = devm_kzalloc(chip->dev, sizeof(*hdata), GFP_KERNEL); + + hdata->nr_channels = 4; + memcpy(hdata, &phytium_octopus_dma_hdata, + sizeof(phytium_octopus_dma_hdata)); + + chip->dmac = dmac; + chip->hdata = hdata; + + dmac->chan = devm_kcalloc(chip->dev, hdata->nr_channels, + sizeof(*dmac->chan), GFP_KERNEL); + + /* Set capabilities */ + dma_cap_set(DMA_MEMCPY, dmac->dma.cap_mask); + dma_cap_set(DMA_SLAVE, dmac->dma.cap_mask); + dma_cap_set(DMA_PRIVATE, dmac->dma.cap_mask); + + /* DMA capabilities */ + dmac->dma.chancnt = hdata->nr_channels; + dmac->dma.src_addr_widths = DMA_SLAVE_BUSWIDTH_4_BYTES; + dmac->dma.dst_addr_widths = DMA_SLAVE_BUSWIDTH_4_BYTES; + dmac->dma.directions = BIT(DMA_MEM_TO_MEM) | + BIT(DMA_DEV_TO_MEM) | + BIT(DMA_MEM_TO_DEV); + dmac->dma.residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; + + dmac->dma.dev = chip->dev; + dmac->dma.device_tx_status = phytium_dma_tx_status; + dmac->dma.device_issue_pending = phytium_dma_issue_pending; + dmac->dma.device_terminate_all = phytium_dma_terminate_all; + dmac->dma.device_synchronize = phytium_dma_synchronize; + + dmac->dma.device_alloc_chan_resources = + phytium_dma_alloc_chan_resources; + dmac->dma.device_free_chan_resources = + phytium_dma_free_chan_resources; + + dmac->dma.device_prep_dma_memcpy = phytium_dma_prep_dma_memcpy; + dmac->dma.device_config = phytium_dma_slave_config; + dmac->dma.device_prep_slave_sg = phytium_dma_prep_slave_sg; + + + INIT_LIST_HEAD(&dmac->dma.channels); + for (i = 0; i < chip->hdata->nr_channels; i++) { + chan = &dmac->chan[i]; + chan->chip = chip; + chan->id = i; + chan->chan_regs = chip->regs + i * CHAN_REG_LEN; + chan->is_used = false; + chan->is_idle = true; + chan->is_paused = false; + + chan->vc.desc_free = phytium_vchan_desc_put; + vchan_init(&chan->vc, &dmac->dma); + } + + /* ----lt add begin--- */ + dmac->dma.filter.map = ft_px210gpu_slave_map; + dmac->dma.filter.mapcnt = ARRAY_SIZE(ft_px210gpu_slave_map); + dmac->dma.filter.fn = px210_filter_fn; + /*----lt add end----*/ + + phytium_dma_hw_init(chip); + + ret = dma_async_device_register(&dmac->dma); + if (ret) + goto err_pm_disable; + + ret = pci_alloc_irq_vectors(pdev, 4, 4, PCI_IRQ_MSI); + if (ret < 0) { + dev_err(&pdev->dev, "fialed to allocate MSI entry"); + goto intx; + } + + for (i = 0; i < chip->hdata->nr_channels; i++) { + chan = &dmac->chan[i]; + chan->irq = pci_irq_vector(pdev, i); + dev_err(&pdev->dev, "desc->irq = 0x%x", chan->irq); + + ret = devm_request_irq(&pdev->dev, chan->irq, + phytium_dma_interrupt_msi, 0, + dev_name(chan2dev(chan)), chan); + if (ret) { + dev_err(&pdev->dev, + "faild %d channal with err %d", i, ret); + goto intx; + } + } + goto irq_done; + +intx: + chip->irq = pdev->irq; + ret = devm_request_irq(chip->dev, chip->irq, + phytium_dma_interrupt_intx, + IRQF_SHARED, dev_name(chip->dev), chip); + if (ret) { + dev_err(&pdev->dev, "no interrupt used\n"); + return ret; + } + +irq_done: + return 0; + +err_pm_disable: + pm_runtime_disable(chip->dev); + + return ret; +} + +static int phytium_dma_remove(struct phytium_dma_chip *chip) +{ + struct phytium_dma *dmac = chip->dmac; + struct phytium_dma_chan *chan, *_chan; + + list_for_each_entry_safe(chan, _chan, &dmac->dma.channels, + vc.chan.device_node) { + list_del(&chan->vc.chan.device_node); + tasklet_kill(&chan->vc.task); + } + + dma_async_device_unregister(&dmac->dma); + + return 0; +} + +static int phytium_pci_probe(struct pci_dev *pdev, + const struct pci_device_id *pid) +{ + struct phytium_dma_chip *chip; + int ret; + + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + ret = pcim_iomap_regions(pdev, 1 << 0, pci_name(pdev)); + if (ret) { + dev_err(&pdev->dev, "I/O memory remapping failed\n"); + return ret; + } + + pci_set_master(pdev); + pci_try_set_mwi(pdev); + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 18, 0)) + ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64)); + if (ret) + return ret; +#else + ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); + if (ret) + return ret; + + ret = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); + if (ret) + return ret; +#endif + + chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); + if (!chip) + return -ENOMEM; + + chip->pdev = pdev; + chip->dev = &pdev->dev; + chip->id = pdev->devfn; + chip->regs = pcim_iomap_table(pdev)[0] + COMMON_REG_LEN; + + ret = phytium_dma_probe(chip); + if (ret) + return ret; + + pci_set_drvdata(pdev, chip); + + dev_dbg(&pdev->dev, "Phytium dma device at 0x%p 0x%llx\n", + chip->regs, pdev->resource[0].start); + return 0; +} + +static void phytium_pci_remove(struct pci_dev *pdev) +{ + struct phytium_dma_chip *chip = pci_get_drvdata(pdev); + int ret; + + ret = phytium_dma_remove(chip); + if (ret) + dev_warn(&pdev->dev, "can't remove device properly: %d\n", ret); +} + +static const struct pci_device_id phytium_pci_id_table[] = { + { + vendor:0x1DB7, + device : 0xDC3C, + subvendor : PCI_ANY_ID, + subdevice : PCI_ANY_ID, + class : 0, + class_mask : 0, + driver_data : (kernel_ulong_t)&phytium_octopus_dma_hdata, + }, + { } +}; +MODULE_DEVICE_TABLE(pci, phytium_pci_id_table); +#ifdef CONFIG_PM_SLEEP + +static int phytium_pci_prepare(struct device *dev) +{ + u32 i; + struct pci_dev *pci = to_pci_dev(dev); + struct phytium_dma_chip *chip = pci_get_drvdata(pci); + struct phytium_dma_chan *chan; + + phytium_dma_hw_init(chip); + + for (i = 0; i < chip->hdata->nr_channels; i++) { + chan = &chip->dmac->chan[i]; + if (phytium_chan_is_running(chan)) { + dev_err(chan2dev(chan), + "DMA driver would suspend\n"); + return -1; + } + + } + return 0; +}; + +static int phytium_pci_suspend_late(struct device *dev) +{ + struct pci_dev *pci = to_pci_dev(dev); + struct phytium_dma_chip *chip = pci_get_drvdata(pci); + + phytium_dma_hw_init(chip); + return 0; +}; + +static int phytium_pci_resume_early(struct device *dev) +{ + struct pci_dev *pci = to_pci_dev(dev); + struct phytium_dma_chip *chip = pci_get_drvdata(pci); + + phytium_dma_hw_init(chip); + return 0; +}; + +#endif + +static const struct dev_pm_ops phytium_pci_dev_pm_ops = { + .prepare = phytium_pci_prepare, + SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_pci_suspend_late, + phytium_pci_resume_early) +}; + +static struct pci_driver phytium_pci_driver = { + .name = "phytium_dmac_pci", + .id_table = phytium_pci_id_table, + .probe = phytium_pci_probe, + .remove = phytium_pci_remove, + .driver = { + .pm = &phytium_pci_dev_pm_ops, + }, +}; + +bool px210_filter_fn(struct dma_chan *chan, void *param) +{ + if (chan->device->dev->driver != &phytium_pci_driver.driver) + return false; + + return true; +} + +module_pci_driver(phytium_pci_driver); + +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium DMA Controller platform driver"); +MODULE_AUTHOR("Zhu mingshuai "); +MODULE_AUTHOR("Liu tao "); +MODULE_AUTHOR("Li Wenxiang "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-dmac-pci.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-dmac-pci.h new file mode 100644 index 0000000000000000000000000000000000000000..3d2d2462b3c65e3374f784742816dd50167837e2 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-dmac-pci.h @@ -0,0 +1,188 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium PCI DMA Controller driver. + * + * 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. + */ + +#ifndef _AXI_DMA_PLATFORM_H +#define _AXI_DMA_PLATFORM_H + +#include +#include +#include +#include +#include +#include "../virt-dma.h" + +#define DMAC_MAX_CHANNELS 4 +#define DMAC_MAX_MASTERS 1 +#define DMAC_MAX_BLK_SIZE (1024 * 1024 * 2) +#define SG_OFFSET 0xFFFFFFFF + +struct phytium_dma_hcfg { + u32 nr_channels; + u32 nr_masters; + u32 m_data_width; + u32 block_size[DMAC_MAX_CHANNELS]; + u32 priority[DMAC_MAX_CHANNELS]; + /* maximum supported axi burst length */ + u32 axi_rw_burst_len; + bool restrict_axi_burst_len; +}; + +struct phytium_dma_chan { + struct phytium_dma_chip *chip; + void __iomem *chan_regs; + u8 id; + unsigned int irq; + atomic_t descs_allocated; + atomic_t releasing; + + struct virt_dma_chan vc; + + struct dma_slave_config dma_sconfig; + + bool is_used; + bool is_idle; + /* these other elements are all protected by vc.lock */ + bool is_paused; +}; + +struct phytium_dma { + struct dma_device dma; + //const struct phytium_dma_hcfg *hdata; + + /* channels */ + struct phytium_dma_chan *chan; +}; + +struct phytium_dma_chip { + struct pci_dev *pdev; + struct device *dev; + void __iomem *regs; + struct clk *core_clk; + struct phytium_dma *dmac; + + int irq; + int id; + struct completion complete; + + const struct phytium_dma_hcfg *hdata; + struct phytium_dma_chan chan[4]; +}; + +struct phytium_chan_desc { + u32 desc_status; + u32 desc_control; + u32 desc_next_addr_l; + u32 desc_next_addr_h; + u32 desc_src_addr_l; + u32 desc_src_addr_h; + u32 desc_dst_addr_l; + u32 desc_dst_addr_h; +} __attribute__ ((__packed__)); + +struct phytium_dma_desc { + struct virt_dma_desc vd; + struct phytium_dma_chan *chan; + struct list_head xfer_list; + struct dma_async_tx_descriptor *txd; + struct phytium_chan_desc *cdesc; + struct scatterlist *end_sg; + u32 dma_srcparam; + u32 dma_destparam; + u32 dma_srcaddr_l; + u32 dma_srcaddr_h; + u32 dma_destaddr_l; + u32 dma_destaddr_h; + u32 dma_len; + u32 dma_ctrl; + u32 sg_len; +}; + +bool px210_filter_fn(struct dma_chan *chan, void *param); + +static inline struct device *dchan2dev(struct dma_chan *dchan) +{ + return &dchan->dev->device; +} + +static inline struct device *chan2dev(struct phytium_dma_chan *chan) +{ + return &chan->vc.chan.dev->device; +} + +static inline struct phytium_dma_desc *vd_to_desc(struct virt_dma_desc *vd) +{ + return container_of(vd, struct phytium_dma_desc, vd); +} + +static inline struct phytium_dma_chan *vc_to_dma_chan(struct virt_dma_chan *vc) +{ + return container_of(vc, struct phytium_dma_chan, vc); +} + +static inline struct phytium_dma_chan *dchan_to_dma_chan(struct dma_chan *dchan) +{ + return vc_to_dma_chan(to_virt_chan(dchan)); +} + +#define TX_SG_LEN (1024 * 32) +#define PAGE_SIZE2 (PAGE_SIZE << 1) + +#define COMMON_REG_LEN 0 +#define CHAN_REG_LEN 0x40 + +#define DMA_IRQ_MASK 0x180 +#define DMA_IRQ_STATUS 0x184 +#define DMA_SRCPARAM 0x400 +#define DMA_DESTPARAM 0x404 +#define DMA_SRCADDR_L 0x408 +#define DMA_SRCADDR_H 0x40C +#define DMA_DESTADDR_L 0x410 +#define DMA_DESTADDR_H 0x414 +#define DMA_LENGTH 0x418 +#define DMA_CONTROL 0x41C +#define DMA_STATUS 0x420 +#define DMA_PRC_LEN 0x424 +#define DMA_SHARE_ACCESS 0x428 + +#define DMA_SRCP_SRC_ID(x) min_t(unsigned int, x, 0xF) +#define DMA_SRCP_TRSF_PARAM(x) (min_t(unsigned int, x, 0xFFF) << 16) +#define DMA_DESTP_DEST_ID(x) min_t(unsigned int, x, 0xF) +#define DMA_DESTP_TRSF_PARAM(x) (min_t(unsigned int, x, 0xFFF) << 16) +#define DMA_CTRL_START BIT(0) +#define DMA_CTRL_PAUSE BIT(1) +#define DMA_CTRL_SG_EN BIT(3) +#define DMA_CTRL_COND_LEN BIT(5) +#define DMA_CTRL_COND_EOP BIT(6) +#define DMA_CTRL_COND_ERR BIT(7) +#define DMA_CTRL_COND_MASK(x) (min_t(unsigned int, x, 0xF) << 4) +#define DMA_CTRL_IRQ_END BIT(8) +#define DMA_CTRL_IRQ_ERR BIT(9) +#define DMA_CTRL_IRQ_EOP BIT(10) +#define DMA_CTRL_IRQ_MASK(x) (min_t(unsigned int, x, 0xF) << 8) +#define DMA_CTRL_IRQ_ID(x) (min_t(unsigned int, x, 0x3) << 12) +#define DMA_CTRL_DESC_UPDT BIT(23) +#define DMA_CTRL_SG_TYPE(x) (min_t(unsigned int, x, 0x3) << 24) +#define DMA_CTRL_SG_ID(x) (min_t(unsigned int, x, 0x5) << 26) +#define DMA_CTRL_SG2_ID(x) (min_t(unsigned int, x, 0x5) << 29) +#define DMA_STAT_MASK(x) (min_t(unsigned int, x, 0xFF) << 0) +#define DMA_STAT_END BIT(0) +#define DMA_STAT_EOP BIT(1) +#define DMA_STAT_EOC BIT(2) +#define DMA_STAT_ERR BIT(3) +#define DMA_STAT_OVER BIT(4) +#define DMA_STAT_STOP BIT(6) +#define DMA_STAT_INCORRECT BIT(7) +#define DMA_SRC_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 8) +#define DMA_DEST_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 16) +#define DMA_DESC_ERROR_MASK(x) (min_t(unsigned int, x, 0xFF) << 24) + +#define DMA_TIMEOUT 200 + +#endif /* _AXI_DMA_PLATFORM_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-gdmac.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-gdmac.c new file mode 100644 index 0000000000000000000000000000000000000000..ac8dd74b44c2f881fe2864d593c5400c6d942ac2 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-gdmac.c @@ -0,0 +1,1035 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium Device GDMA Controller driver. + * + * Copyright (c) 2023-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytium-gdmac.h" + +#define PHYTIUM_GDMA_DRIVER_VERSION "1.0.0" + +static inline struct phytium_gdma_device *to_gdma_device(struct dma_chan *chan) +{ + return container_of(chan->device, struct phytium_gdma_device, dma_dev); +} + +static inline struct phytium_gdma_chan *to_gdma_chan(struct dma_chan *chan) +{ + return container_of(chan, struct phytium_gdma_chan, vchan.chan); +} + +static inline struct phytium_gdma_desc *to_gdma_desc(struct virt_dma_desc *vd) +{ + return container_of(vd, struct phytium_gdma_desc, vdesc); +} + +static inline struct device *chan_to_dev(struct phytium_gdma_chan *chan) +{ + return chan->vchan.chan.device->dev; +} + +static inline +struct phytium_gdma_device *chan_to_gdma(struct phytium_gdma_chan *chan) +{ + return to_gdma_device(&chan->vchan.chan); +} + +static inline void phytium_gdma_write(const struct phytium_gdma_device *gdma, + const u32 reg, const u32 val) +{ + iowrite32(val, gdma->base + reg); +} + +static inline u32 phytium_gdma_read(const struct phytium_gdma_device *gdma, + const u32 reg) +{ + return ioread32(gdma->base + reg); +} + +static inline void phytium_chan_write(const struct phytium_gdma_chan *chan, + const u32 reg, const u32 val) +{ + iowrite32(val, chan->base + reg); +} + +static inline u32 phytium_chan_read(const struct phytium_gdma_chan *chan, + const u32 reg) +{ + return ioread32(chan->base + reg); +} + +static void phytium_gdma_dump_reg(struct phytium_gdma_chan *chan) +{ + struct phytium_gdma_device *gdma = chan_to_gdma(chan); + + dev_dbg(chan_to_dev(chan), "gdma registers:\n"); + dev_dbg(chan_to_dev(chan), "\tDMA_CTL: 0x%08x\n", + phytium_gdma_read(gdma, DMA_CTL)); + dev_dbg(chan_to_dev(chan), "\tDMA_STATE: 0x%08x\n", + phytium_gdma_read(gdma, DMA_STATE)); + dev_dbg(chan_to_dev(chan), "\tDMA_INTR_CTL: 0x%08x\n", + phytium_gdma_read(gdma, DMA_INTR_CTL)); + dev_dbg(chan_to_dev(chan), "\tDMA_LP_CTL: 0x%08x\n", + phytium_gdma_read(gdma, DMA_LP_CTL)); + dev_dbg(chan_to_dev(chan), "\tDMA_QOS_CFG: 0x%08x\n", + phytium_gdma_read(gdma, DMA_QOS_CFG)); + + dev_dbg(chan_to_dev(chan), "gdma channel %d registers\n", chan->id); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_CTRL: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_CTRL)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_MODE: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_MODE)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_INTR_CTL: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_INTR_CTL)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_STATE: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_STATE)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_LVI: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_LVI)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_TS: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_TS)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_UPSADDR: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_UPSADDR)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_LWSADDR: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_LWSADDR)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_UPDADDR: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_UPDADDR)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_LWDADDR: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_LWDADDR)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_XFER_CFG: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_XFER_CFG)); + dev_dbg(chan_to_dev(chan), "\tDMA_C%d_LCP: 0x%08x\n", chan->id, + phytium_chan_read(chan, DMA_CX_LCP)); +} + +static void phytium_gdma_disable(const struct phytium_gdma_device *gdma) +{ + u32 val = phytium_gdma_read(gdma, DMA_CTL); + + dev_dbg(gdma->dev, "gdma disable\n"); + val &= ~DMA_CTL_EN; + phytium_gdma_write(gdma, DMA_CTL, !DMA_CTL_EN); +} + +static void phytium_gdma_enable(const struct phytium_gdma_device *gdma) +{ + u32 val = phytium_gdma_read(gdma, DMA_CTL); + + dev_dbg(gdma->dev, "gdma enable\n"); + val |= DMA_CTL_EN; + phytium_gdma_write(gdma, DMA_CTL, DMA_CTL_EN); +} + +static void phytium_gdma_reset(const struct phytium_gdma_device *gdma) +{ + u32 val = 0; + + dev_dbg(gdma->dev, "dma reset\n"); + val = phytium_gdma_read(gdma, DMA_CTL); + val |= DMA_CTL_SRST; + phytium_gdma_write(gdma, DMA_CTL, val); + + udelay(10); + val &= ~DMA_CTL_SRST; + phytium_gdma_write(gdma, DMA_CTL, val); +} + +static void phytium_gdma_irq_disable(const struct phytium_gdma_device *gdma) +{ + u32 val = 0; + + dev_dbg(gdma->dev, "gdma irq disable\n"); + val = phytium_gdma_read(gdma, DMA_INTR_CTL); + val &= ~DMA_INT_EN; + phytium_gdma_write(gdma, DMA_INTR_CTL, val); +} + +static void phytium_gdma_irq_enable(const struct phytium_gdma_device *gdma) +{ + u32 val = 0; + + dev_dbg(gdma->dev, "gdma irq enable\n"); + val = phytium_gdma_read(gdma, DMA_INTR_CTL); + val |= DMA_INT_EN; + phytium_gdma_write(gdma, DMA_INTR_CTL, val); +} + +static void __maybe_unused +phytium_gdma_read_mode_set(struct phytium_gdma_device *gdma, + enum arbitration_mode mode) +{ + u32 val = phytium_gdma_read(gdma, DMA_CTL); + + switch (mode) { + case POLLING_MODE: + dev_dbg(gdma->dev, "set read polling mode\n"); + val &= ~BIT(5); + break; + case QOS_MODE: + dev_dbg(gdma->dev, "set read qos mode\n"); + val |= BIT(5); + break; + } + phytium_gdma_write(gdma, DMA_CTL, val); +} + +static void phytium_gdma_write_mode_set(struct phytium_gdma_device *gdma, + enum arbitration_mode mode) +{ + u32 val = phytium_gdma_read(gdma, DMA_CTL); + + switch (mode) { + case POLLING_MODE: + dev_dbg(gdma->dev, "set write polling mode\n"); + val &= ~BIT(4); + break; + case QOS_MODE: + dev_dbg(gdma->dev, "set write qos mode\n"); + val |= BIT(4); + break; + } + phytium_gdma_write(gdma, DMA_CTL, val); +} + +static void __maybe_unused +phytium_gdma_outstanding_set(struct phytium_gdma_device *gdma, u32 outstanding) +{ + u32 val = 0; + + dev_dbg(gdma->dev, "set dma outstanding %d\n", outstanding); + + val = phytium_gdma_read(gdma, DMA_CTL); + val &= ~DMA_OUTSTANDING_MASK; + val |= ((outstanding - 1) << 8); + phytium_gdma_write(gdma, DMA_CTL, val); +} + +static void __maybe_unused +phytium_gdma_read_qos_set(struct phytium_gdma_device *gdma, u32 qos) +{ + u32 val = 0; + + dev_dbg(gdma->dev, "set read qos %d", qos); + val = phytium_gdma_read(gdma, DMA_QOS_CFG); + val &= ~DMA_READ_QOS_MASK; + val |= (qos << 4); + phytium_gdma_write(gdma, DMA_QOS_CFG, val); +} + +static void __maybe_unused +phytium_gdma_write_qos_set(struct phytium_gdma_device *gdma, u32 qos) +{ + u32 val = phytium_gdma_read(gdma, DMA_QOS_CFG); + + dev_dbg(gdma->dev, "set read qos %d", qos); + val &= ~DMA_WRITE_QOS_MASK; + val |= qos; + phytium_gdma_write(gdma, DMA_QOS_CFG, val); +} + +static void phytium_chan_irq_enable(struct phytium_gdma_chan *chan, u32 mask) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d irq enable\n", chan->id); + val = phytium_gdma_read(chan_to_gdma(chan), DMA_INTR_CTL); + val |= DMA_INT_CHAL_EN(chan->id); + phytium_gdma_write(chan_to_gdma(chan), DMA_INTR_CTL, val); + phytium_chan_write(chan, DMA_CX_INTR_CTL, mask); +} + +static void phytium_chan_irq_disable(struct phytium_gdma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d irq disable\n", chan->id); + val = phytium_gdma_read(chan_to_gdma(chan), DMA_INTR_CTL); + val &= ~DMA_INT_CHAL_EN(chan->id); + phytium_gdma_write(chan_to_gdma(chan), DMA_INTR_CTL, val); +} + +static void phytium_chan_irq_clear(struct phytium_gdma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d irq clear\n", chan->id); + + val = phytium_chan_read(chan, DMA_CX_STATE); + phytium_chan_write(chan, DMA_CX_STATE, val); +} + +static void phytium_chan_disable(struct phytium_gdma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d disable\n", chan->id); + + /* disable channel */ + val = phytium_chan_read(chan, DMA_CX_CTRL); + val &= ~DMA_CHAL_EN; + phytium_chan_write(chan, DMA_CX_CTRL, val); +} + +static void phytium_chan_enable(struct phytium_gdma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d enable\n", chan->id); + + /* enable channel */ + val = phytium_chan_read(chan, DMA_CX_CTRL); + val |= DMA_CHAL_EN; + phytium_chan_write(chan, DMA_CX_CTRL, val); +} + +static void phytium_chan_clk_enable(struct phytium_gdma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d clk enable\n", chan->id); + + /* enable channel clock */ + val = phytium_gdma_read(chan_to_gdma(chan), DMA_LP_CTL); + val &= ~DMA_CX_CLK_EN(chan->id); + phytium_gdma_write(chan_to_gdma(chan), DMA_LP_CTL, val); +} + +static void phytium_chan_clk_disable(struct phytium_gdma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d clk disable\n", chan->id); + + /* disable channel clock */ + val = phytium_gdma_read(chan_to_gdma(chan), DMA_LP_CTL); + val |= DMA_CX_CLK_EN(chan->id); + phytium_gdma_write(chan_to_gdma(chan), DMA_LP_CTL, val); +} + +static void phytium_chan_reset(struct phytium_gdma_chan *chan) +{ + u32 val = 0; + + dev_dbg(chan_to_dev(chan), "channel %d reset\n", chan->id); + val = phytium_chan_read(chan, DMA_CX_CTRL); + val |= DMA_CHAL_SRST; + phytium_chan_write(chan, DMA_CX_CTRL, val); + + udelay(10); + val = phytium_chan_read(chan, DMA_CX_CTRL); + val &= ~DMA_CHAL_SRST; + phytium_chan_write(chan, DMA_CX_CTRL, val); +} + +static void phytium_chan_set_bdl_mode(struct phytium_gdma_chan *chan, bool bdl) +{ + u32 val = 0; + + val = phytium_chan_read(chan, DMA_CX_MODE); + if (bdl) { + dev_dbg(chan_to_dev(chan), "channel %d set bdl mode\n", + chan->id); + val |= DMA_CHAN_BDL_MODE; + } else { + dev_dbg(chan_to_dev(chan), "channel %d set direct mode\n", + chan->id); + val &= ~DMA_CHAN_BDL_MODE; + } + phytium_chan_write(chan, DMA_CX_MODE, val); +} + +static u32 __maybe_unused +phytium_chan_get_bdl_num(struct phytium_gdma_chan *chan) +{ + u32 val = phytium_chan_read(chan, DMA_CX_LVI) + 1; + + return val; +} + +static u32 phytium_gdma_set_xfer_ctrl(u32 burst_width, u32 burst_length, + enum burst_type burst_type) +{ + u32 xfer_ctrl = 0; + + xfer_ctrl = burst_type; + xfer_ctrl |= (ffs(burst_width) - 1) << 4; + xfer_ctrl |= (burst_length - 1) << 8; + + return xfer_ctrl; +} + +static void phytium_chan_set_xfer_cfg(struct phytium_gdma_chan *chan, + u32 burst_width, u32 burst_length, + enum burst_type type) +{ + u32 xfer_ctl = phytium_gdma_set_xfer_ctrl(burst_width, burst_length, + type); + u32 val = xfer_ctl << 16 | xfer_ctl; + + dev_dbg(chan_to_dev(chan), "channel %d set xfer cfg 0x%08x", + chan->id, val); + phytium_chan_write(chan, DMA_CX_XFER_CFG, val); +} + +static void phytium_gdma_vdesc_free(struct virt_dma_desc *vd) +{ + struct phytium_gdma_desc *desc = to_gdma_desc(vd); + int i = 0; + + if (desc->bdl_mode) { + for (i = 0; i < desc->bdl_size; i++) + dma_pool_free(desc->chan->dma_pool, + desc->bdl_list[i].bdl, desc->bdl_list[0].paddr); + } + kfree(desc); +} + +static void phytium_chan_start_desc(struct phytium_gdma_chan *chan) +{ + struct virt_dma_desc *vd = vchan_next_desc(&chan->vchan); + struct phytium_gdma_desc *desc = NULL; + + if (!vd) { + chan->desc = NULL; + return; + } + + list_del(&vd->node); + desc = to_gdma_desc(vd); + chan->desc = desc; + + phytium_chan_clk_enable(chan); + + if (desc->bdl_mode) { + phytium_chan_set_bdl_mode(chan, true); + phytium_chan_write(chan, DMA_CX_UPSADDR, + upper_32_bits(desc->bdl_list[0].paddr)); + phytium_chan_write(chan, DMA_CX_LWSADDR, + lower_32_bits(desc->bdl_list[0].paddr)); + phytium_chan_write(chan, DMA_CX_UPDADDR, 0); + phytium_chan_write(chan, DMA_CX_LWDADDR, 0); + phytium_chan_write(chan, DMA_CX_TS, 0); + phytium_chan_write(chan, DMA_CX_LVI, desc->bdl_size - 1); + } else { + phytium_chan_set_bdl_mode(chan, false); + phytium_chan_set_xfer_cfg(chan, desc->burst_width, + desc->burst_length, BURST_INCR); + phytium_chan_write(chan, DMA_CX_UPSADDR, + upper_32_bits(desc->src)); + phytium_chan_write(chan, DMA_CX_LWSADDR, + lower_32_bits(desc->src)); + phytium_chan_write(chan, DMA_CX_UPDADDR, + upper_32_bits(desc->dst)); + phytium_chan_write(chan, DMA_CX_LWDADDR, + lower_32_bits(desc->dst)); + phytium_chan_write(chan, DMA_CX_TS, desc->len); + } + + phytium_gdma_outstanding_set(chan_to_gdma(chan), desc->outstanding); + phytium_gdma_write_mode_set(chan_to_gdma(chan), POLLING_MODE); + phytium_chan_irq_enable(chan, GDMA_CX_INT_CTRL_TRANS_END_ENABLE); + phytium_gdma_dump_reg(chan); + phytium_chan_enable(chan); +} + +static void phytium_gdma_hw_init(struct phytium_gdma_device *gdma) +{ + u32 i = 0; + + phytium_gdma_disable(gdma); + phytium_gdma_reset(gdma); + phytium_gdma_irq_enable(gdma); + phytium_gdma_enable(gdma); + + for (i = 0; i < gdma->dma_channels; i++) { + phytium_chan_irq_disable(&gdma->chan[i]); + phytium_chan_disable(&gdma->chan[i]); + phytium_chan_clk_disable(&gdma->chan[i]); + } +} + +static int phytium_gdma_terminate_all(struct dma_chan *chan) +{ + struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); + unsigned long flags = 0; + u32 val = 0; + int ret = 0; + LIST_HEAD(head); + + spin_lock_irqsave(&gdma_chan->vchan.lock, flags); + + if (gdma_chan->desc) { + vchan_terminate_vdesc(&gdma_chan->desc->vdesc); + gdma_chan->desc = NULL; + phytium_chan_disable(gdma_chan); + ret = readl_poll_timeout(gdma_chan->base + DMA_CX_STATE, val, + ~(val & BIT(4)), 10, 10000); + if (ret) + dev_err(chan_to_dev(gdma_chan), + "failed to complete writes\n"); + phytium_chan_reset(gdma_chan); + } + + vchan_get_all_descriptors(&gdma_chan->vchan, &head); + spin_unlock_irqrestore(&gdma_chan->vchan.lock, flags); + vchan_dma_desc_free_list(&gdma_chan->vchan, &head); + + return 0; +} + +static int phytium_gdma_alloc_chan_resources(struct dma_chan *chan) +{ + struct phytium_gdma_device *gdma = to_gdma_device(chan); + struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); + struct device *dev = chan_to_dev(gdma_chan); + + /* prepare channel */ + phytium_chan_disable(gdma_chan); + phytium_chan_reset(gdma_chan); + phytium_chan_irq_clear(gdma_chan); + + /* alloc dma memory */ + gdma_chan->dma_pool = dma_pool_create(dev_name(dev), dev, + sizeof(struct phytium_gdma_bdl), + 128, 0); + if (!gdma_chan->dma_pool) { + dev_err(chan_to_dev(gdma_chan), + "unable to allocate descriptor pool\n"); + return -ENOMEM; + } + + dev_info(gdma->dev, "alloc channel %d\n", gdma_chan->id); + + return 0; +} + +static void phytium_gdma_free_chan_resources(struct dma_chan *chan) +{ + struct phytium_gdma_device *gdma = to_gdma_device(chan); + struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); + + phytium_chan_disable(gdma_chan); + phytium_chan_irq_disable(gdma_chan); + + vchan_free_chan_resources(&gdma_chan->vchan); + dma_pool_destroy(gdma_chan->dma_pool); + + dev_dbg(gdma->dev, "free channel %d\n", gdma_chan->id); +} + +static int phytium_gdma_slave_config(struct dma_chan *chan, + struct dma_slave_config *config) +{ + struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); + + gdma_chan->dma_config = *config; + + return 0; +} + + +static enum dma_status phytium_gdma_tx_status(struct dma_chan *chan, + dma_cookie_t cookie, struct dma_tx_state *txstate) +{ + enum dma_status ret; + + ret = dma_cookie_status(chan, cookie, txstate); + + return ret; +} + +static int phytium_gdma_calcu_burst_width(dma_addr_t src, dma_addr_t dst, + u32 len) +{ + enum dma_slave_buswidth max_width = DMA_SLAVE_BUSWIDTH_16_BYTES; + + for (max_width = DMA_SLAVE_BUSWIDTH_16_BYTES; + max_width > DMA_SLAVE_BUSWIDTH_1_BYTE; + max_width >>= 1) { + if ((((len | src | dst) & (max_width - 1)) == 0) && + len > max_width) + break; + } + + return max_width; +} + +static int phytium_gdma_xfer_bdl_mode(struct phytium_gdma_desc *desc, + dma_addr_t dst, dma_addr_t src) +{ + struct phytium_gdma_chan *chan = desc->chan; + struct phytium_gdma_bdl_entry *bdl_entry = NULL; + struct phytium_gdma_bdl *bdl = NULL; + int i = 0; + int ret = 0; + u32 burst_width = 0; + u32 burst_length = 0; + size_t buf_len = desc->len; + + for (i = 0; i < desc->bdl_size; i++) { + bdl_entry = &desc->bdl_list[i]; + bdl_entry->bdl = dma_pool_alloc(chan->dma_pool, GFP_KERNEL, + &bdl_entry->paddr); + + if (!bdl_entry->bdl) { + ret = -ENOMEM; + goto error_bdl; + } + + /* set bdl info */ + bdl = bdl_entry->bdl; + bdl->src_addr_l = lower_32_bits(src); + bdl->src_addr_h = upper_32_bits(src); + bdl->dst_addr_l = lower_32_bits(dst); + bdl->dst_addr_h = upper_32_bits(dst); + bdl->length = min_t(u32, buf_len, GDMA_MAX_LEN); + buf_len -= bdl->length; + src += bdl->length; + dst += bdl->length; + desc->len = bdl->length; + + /* calculate burst width and burst length */ + burst_width = phytium_gdma_calcu_burst_width(src, dst, + bdl->length); + burst_length = min_t(u32, GDMA_MAX_BURST_LENGTH, + bdl->length / burst_width); + bdl->src_xfer_cfg = phytium_gdma_set_xfer_ctrl(burst_width, + burst_length, BURST_INCR); + + bdl->dst_xfer_cfg = bdl->src_xfer_cfg; + + /* not trigger interrupt after bdl transferred */ + bdl->intr_ctl = 0; + + dev_dbg(chan_to_dev(chan), + "channel %d: bdl_mode, frame %d, len %d, burst_width %d, burst_length %d, xfer_cfg 0x%08x, outstanding: %d\n", + chan->id, i, bdl->length, burst_width, burst_length, + bdl->src_xfer_cfg, desc->outstanding); + } + +error_bdl: + return ret; +} + +static struct dma_async_tx_descriptor *phytium_gdma_prep_dma_memcpy( + struct dma_chan *chan, dma_addr_t dst, dma_addr_t src, + size_t len, unsigned long flags) +{ + struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); + struct phytium_gdma_desc *desc = NULL; + struct dma_async_tx_descriptor *tx_desc = NULL; + u32 frames = 0; + u32 max_outstanding = 0; + int ret = 0; + + if (!src || !dst || !len) + return NULL; + + frames = DIV_ROUND_UP(len, GDMA_MAX_LEN); + + desc = kzalloc(struct_size(desc, bdl_list, frames), GFP_KERNEL); + if (IS_ERR_OR_NULL(desc)) + return NULL; + + dev_dbg(chan_to_dev(gdma_chan), + "memcpy: src %lld, dst %lld, len %ld, frames %d\n", + src, dst, len, frames); + + desc->len = len; + desc->chan = gdma_chan; + max_outstanding = chan_to_gdma(gdma_chan)->max_outstanding; + + if (frames > 1) { + /* bdl xfer */ + desc->bdl_mode = true; + desc->bdl_size = frames; + desc->outstanding = min_t(u32, max_outstanding, + len / GDMA_MAX_BURST_SIZE / GDMA_MAX_BURST_LENGTH); + ret = phytium_gdma_xfer_bdl_mode(desc, dst, src); + } else { + /* direct xfer */ + desc->bdl_mode = false; + desc->burst_width = phytium_gdma_calcu_burst_width(src, dst, + len); + desc->burst_length = min_t(u32, GDMA_MAX_BURST_LENGTH, + len / desc->burst_width); + desc->src = src; + desc->dst = dst; + desc->outstanding = min_t(u32, max_outstanding, + len / desc->burst_length / desc->burst_width); + dev_dbg(chan_to_dev(gdma_chan), "channel %d: direct mode, len %ld, burst_width %d, burst_length %d, outstanding %d\n", + gdma_chan->id, desc->len, desc->burst_width, + desc->burst_length, desc->outstanding); + } + + if (!ret) + tx_desc = vchan_tx_prep(&gdma_chan->vchan, &desc->vdesc, flags); + + return tx_desc; +} + +static void phytium_gdma_issue_pending(struct dma_chan *chan) +{ + struct phytium_gdma_chan *gdma_chan = to_gdma_chan(chan); + unsigned long flags = 0; + + spin_lock_irqsave(&gdma_chan->vchan.lock, flags); + if (vchan_issue_pending(&gdma_chan->vchan) && !gdma_chan->desc) + phytium_chan_start_desc(gdma_chan); + + spin_unlock_irqrestore(&gdma_chan->vchan.lock, flags); +} + +static void phytium_chan_irq_handler(struct phytium_gdma_chan *chan) +{ + struct phytium_gdma_desc *desc = NULL; + unsigned long flags = 0; + u32 state = 0; + int ret = 0; + + dev_dbg(chan_to_dev(chan), "channel %d int state %08x", chan->id, + chan->state); + + /* transfer busy */ + if (chan->state & GDMA_CX_INT_STATE_BUSY) { + dev_info(chan_to_dev(chan), "gdma channel %d busy\n", chan->id); + ret = readl_poll_timeout_atomic(chan->base + DMA_CX_STATE, state, + state & GDMA_CX_INT_STATE_TRANS_END, + 10, 2000); + if (ret) { + dev_err(chan_to_dev(chan), + "gdma channel %d xfer timeout\n", chan->id); + } + } + + /* transfer complete */ + if (chan->state & GDMA_CX_INT_STATE_TRANS_END) { + dev_dbg(chan_to_dev(chan), "channel %d xfer complete\n", chan->id); + desc = chan->desc; + spin_lock_irqsave(&chan->vchan.lock, flags); + vchan_cookie_complete(&desc->vdesc); + phytium_chan_start_desc(chan); + spin_unlock_irqrestore(&chan->vchan.lock, flags); + } + + /* fifo fulll */ + if (chan->state & GDMA_CX_INT_STATE_FIFO_FULL) { + dev_err(chan_to_dev(chan), + "gdma channel %d fifo full\n", chan->id); + } +} + +static irqreturn_t phytium_dma_interrupt(int irq, void *dev_id) +{ + struct phytium_gdma_device *gdma = dev_id; + struct phytium_gdma_chan *gdma_chan = NULL; + u32 state = 0; + int i = 0; + + state = phytium_gdma_read(gdma, DMA_STATE); + dev_dbg(gdma->dev, "gdma interrupt, state %04x", state); + + for (i = 0; i < gdma->dma_channels; i++) { + if (state & DMA_CX_INTR_STATE(i)) { + gdma_chan = &gdma->chan[i]; + gdma_chan->state = phytium_chan_read(gdma_chan, + DMA_CX_STATE); + phytium_chan_irq_clear(gdma_chan); + + if (gdma->chan[i].desc) { + phytium_chan_irq_handler(gdma_chan); + phytium_chan_disable(gdma_chan); + phytium_chan_clk_disable(gdma_chan); + } + } + } + + return IRQ_HANDLED; +} + +static struct dma_chan *phytium_gdma_of_xlate(struct of_phandle_args *dma_spec, + struct of_dma *ofdma) +{ + struct phytium_gdma_device *gdma = ofdma->of_dma_data; + struct device *dev = gdma->dev; + struct phytium_gdma_chan *chan = NULL; + struct dma_chan *c = NULL; + u32 channel_id = 0; + + channel_id = dma_spec->args[0]; + + if (channel_id > gdma->dma_channels) { + dev_err(dev, "bad channel %d\n", channel_id); + return NULL; + } + + chan = &gdma->chan[channel_id]; + c = dma_get_slave_channel(&chan->vchan.chan); + if (!c) { + dev_err(dev, "no more channels available\n"); + return NULL; + } + + return c; +} + +static int phytium_gdma_probe(struct platform_device *pdev) +{ + struct phytium_gdma_device *gdma; + struct dma_device *dma_dev; + struct resource *mem; + u32 i = 0; + u32 nr_channels = 0; + u32 max_outstanding = 0; + int irq_count = 0; + int irq = 0; + int ret = 0; + + if (!pdev->dev.dma_mask) + pdev->dev.dma_mask = &pdev->dev.coherent_dma_mask; + + ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64)); + if (ret) { + dev_err(&pdev->dev, "Unable to set DMA mask\n"); + goto out; + } + + gdma = devm_kzalloc(&pdev->dev, sizeof(*gdma), GFP_KERNEL); + if (!gdma) { + ret = -ENOMEM; + goto out; + } + + dma_dev = &gdma->dma_dev; + gdma->dev = &pdev->dev; + + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); + gdma->base = devm_ioremap_resource(&pdev->dev, mem); + if (IS_ERR(gdma->base)) { + dev_err(&pdev->dev, "no resource address"); + ret = PTR_ERR(gdma->base); + goto out; + } + + ret = of_property_read_u32(pdev->dev.of_node, "dma-channels", + &nr_channels); + if (ret < 0) { + dev_err(&pdev->dev, + "can't get the number of dma channels: %d\n", ret); + goto out; + } + gdma->dma_channels = nr_channels; + + ret = of_property_read_u32(pdev->dev.of_node, "max-outstanding", + &max_outstanding); + if (ret < 0) { + dev_err(&pdev->dev, "can't get max outstanding %d\n", ret); + goto out; + } + gdma->max_outstanding = max_outstanding; + + irq_count = platform_irq_count(pdev); + if (irq_count <= 0) { + dev_err(&pdev->dev, "no irq found\n"); + ret = -EINVAL; + goto out; + } + for (i = 0; i < irq_count; i++) { + irq = platform_get_irq(pdev, i); + if (irq < 0) { + dev_err(&pdev->dev, "can't get irq %d\n", i); + continue; + } + ret = devm_request_irq(&pdev->dev, irq, + phytium_dma_interrupt, IRQF_SHARED, + dev_name(&pdev->dev), gdma); + if (ret) { + dev_err(&pdev->dev, "could not to request irq %d", irq); + goto out; + } + } + + /* Set capabilities */ + dma_cap_set(DMA_MEMCPY, gdma->dma_dev.cap_mask); + + /* DMA capabilities */ + dma_dev->dev = gdma->dev; + dma_dev->chancnt = gdma->dma_channels; + dma_dev->max_burst = 8; + dma_dev->src_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_1_BYTE) | + BIT(DMA_SLAVE_BUSWIDTH_2_BYTES) | + BIT(DMA_SLAVE_BUSWIDTH_4_BYTES) | + BIT(DMA_SLAVE_BUSWIDTH_8_BYTES) | + BIT(DMA_SLAVE_BUSWIDTH_16_BYTES); + dma_dev->dst_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_1_BYTE) | + BIT(DMA_SLAVE_BUSWIDTH_2_BYTES) | + BIT(DMA_SLAVE_BUSWIDTH_4_BYTES) | + BIT(DMA_SLAVE_BUSWIDTH_8_BYTES) | + BIT(DMA_SLAVE_BUSWIDTH_16_BYTES); + dma_dev->directions = BIT(DMA_MEM_TO_MEM); + dma_dev->residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; + + /* function callback */ + dma_dev->device_alloc_chan_resources = + phytium_gdma_alloc_chan_resources; + dma_dev->device_free_chan_resources = phytium_gdma_free_chan_resources; + dma_dev->device_tx_status = phytium_gdma_tx_status; + dma_dev->device_config = phytium_gdma_slave_config; + dma_dev->device_prep_dma_memcpy = phytium_gdma_prep_dma_memcpy; + dma_dev->device_issue_pending = phytium_gdma_issue_pending; + dma_dev->device_terminate_all = phytium_gdma_terminate_all; + + /* init dma channels */ + INIT_LIST_HEAD(&dma_dev->channels); + gdma->chan = devm_kcalloc(gdma->dev, gdma->dma_channels, + sizeof(*gdma->chan), GFP_KERNEL); + if (!gdma->chan) { + ret = -ENOMEM; + goto out; + } + for (i = 0; i < gdma->dma_channels; i++) { + gdma->chan[i].id = i; + gdma->chan[i].base = gdma->base + DMA_REG_OFFSET + + i * CHAN_REG_OFFSET; + gdma->chan[i].vchan.desc_free = phytium_gdma_vdesc_free; + gdma->chan[i].desc = NULL; + vchan_init(&gdma->chan[i].vchan, dma_dev); + } + + phytium_gdma_hw_init(gdma); + + ret = dma_async_device_register(dma_dev); + if (ret) + goto out; + + ret = of_dma_controller_register(pdev->dev.of_node, + phytium_gdma_of_xlate, gdma); + if (ret < 0) { + dev_err(&pdev->dev, + "phytium gdma of register failed %d\n", ret); + goto err_unregister; + } + + platform_set_drvdata(pdev, gdma); + dev_info(gdma->dev, "phytium GDMA Controller registered\n"); + + return 0; + +err_unregister: + dma_async_device_unregister(dma_dev); + +out: + return ret; +} + +static void phytium_gdma_chan_remove(struct phytium_gdma_chan *chan) +{ + phytium_chan_irq_disable(chan); + phytium_chan_disable(chan); + + tasklet_kill(&chan->vchan.task); + list_del(&chan->vchan.chan.device_node); +} + +static int phytium_gdma_remove(struct platform_device *pdev) +{ + struct phytium_gdma_device *gdma = platform_get_drvdata(pdev); + struct phytium_gdma_chan *chan = NULL; + int i = 0; + + of_dma_controller_free(pdev->dev.of_node); + dma_async_device_unregister(&gdma->dma_dev); + + for (i = 0; i < gdma->dma_channels; i++) { + chan = &gdma->chan[i]; + phytium_gdma_chan_remove(chan); + } + + phytium_gdma_irq_disable(gdma); + phytium_gdma_disable(gdma); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_gdma_suspend(struct device *dev) +{ + struct phytium_gdma_device *gdma = dev_get_drvdata(dev); + + phytium_gdma_irq_disable(gdma); + phytium_gdma_disable(gdma); + + return 0; +} + +static int phytium_gdma_resume(struct device *dev) +{ + struct phytium_gdma_device *gdma = dev_get_drvdata(dev); + int ret = 0; + + phytium_gdma_hw_init(gdma); + + return ret; +} +#endif + +static const struct dev_pm_ops phytium_gdma_pm_ops = { + SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_gdma_suspend, + phytium_gdma_resume) +}; + +static const struct of_device_id phytium_dma_of_id_table[] = { + { .compatible = "phytium,gdma" }, + {} +}; +MODULE_DEVICE_TABLE(of, phytium_dma_of_id_table); + +static struct platform_driver phytium_gdma_driver = { + .probe = phytium_gdma_probe, + .remove = phytium_gdma_remove, + .driver = { + .name = "phytium-gdma", + .of_match_table = of_match_ptr(phytium_dma_of_id_table), + .pm = &phytium_gdma_pm_ops, + }, +}; + +static __init int phytium_gdma_init(void) +{ + return platform_driver_register(&phytium_gdma_driver); +} + +static __exit void phytium_gdma_exit(void) +{ + return platform_driver_unregister(&phytium_gdma_driver); +} + +subsys_initcall(phytium_gdma_init); +module_exit(phytium_gdma_exit); + +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium gdma Controller platform driver"); +MODULE_AUTHOR("HuangJie "); +MODULE_VERSION(PHYTIUM_GDMA_DRIVER_VERSION); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-gdmac.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-gdmac.h new file mode 100644 index 0000000000000000000000000000000000000000..ae880f85367b35c8a68125875fda1790d26235ee --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/dma/phytium/phytium-gdmac.h @@ -0,0 +1,202 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ +/* + * Phytium Device GDMA Controller driver. + * + * Copyright (c) 2023-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _PHYTIUM_GDMAC_H +#define _PHYTIUM_GDMAC_H + +#include +#include +#include +#include +#include +#include "../virt-dma.h" + + +#define GDMA_MAX_LEN SZ_1G +#define GDMA_MAX_BURST_LENGTH 8 +#define GDMA_MAX_BURST_SIZE 16 + +/* GDMA register address offset */ +#define DMA_REG_OFFSET 0x20 +#define CHAN_REG_OFFSET 0x60 + +#define DMA_CTL 0x00 +#define DMA_STATE 0x04 +#define DMA_INTR_CTL 0x08 +#define DMA_LP_CTL 0x0C +#define DMA_QOS_CFG 0x10 + +#define DMA_CX_CTRL 0x00 +#define DMA_CX_MODE 0x04 +#define DMA_CX_INTR_CTL 0x08 +#define DMA_CX_STATE 0x0C +#define DMA_CX_LVI 0x10 +#define DMA_CX_TS 0x14 +#define DMA_CX_UPSADDR 0x18 +#define DMA_CX_LWSADDR 0x1C +#define DMA_CX_UPDADDR 0x20 +#define DMA_CX_LWDADDR 0x24 +#define DMA_CX_XFER_CFG 0x28 +#define DMA_CX_LCP 0x2C +#define DMA_CX_SECCTL 0x30 +#define DMA_CX_SEC_ATST 0x34 +#define DMA_CX_NSID_STRMID 0x38 +#define DMA_CX_AW_CFG 0x3C +#define DMA_CX_AR_CFG 0x40 +#define DMA_CX_SECRSP 0x44 + +/* DMA_CTL register */ +#define DMA_CTL_EN BIT(0) +#define DMA_CTL_SRST BIT(1) + +#define DMA_OUTSTANDING_MASK GENMASK(11, 8) +#define DMA_WRITE_QOS_MASK GENMASK(3, 0) +#define DMA_READ_QOS_MASK GENMASK(7, 4) + +/* DMA_STATE register */ +#define DMA_CX_INTR_STATE(id) BIT(id) + +/* DMA_INTR_CTL register */ +#define DMA_INT_EN BIT(31) +#define DMA_INT_CHAL_EN(id) BIT(id) + +/* DMA_LP_CTL register */ +#define DMA_CX_CLK_EN(id) BIT(id) + +/* DMA_CX_MODE register */ +#define DMA_CHAN_BDL_MODE BIT(0) + +/* DMA_CX_CTRL register */ +#define DMA_CHAL_EN BIT(0) +#define DMA_CHAL_SRST BIT(4) + +/* DMA_CX_INTR_CTL register, channel interrupt control bits */ +#define GDMA_CX_INT_CTRL_TRANS_END_ENABLE BIT(3) +#define GDMA_CX_INT_CTRL_BDL_END_ENABLE BIT(2) +#define GDMA_CX_INT_CTRL_FIFO_FULL_ENABLE BIT(1) +#define GDMA_CX_INT_CTRL_FIFO_EMPTY_ENABLE BIT(0) + + +/* DMA_CX_STATE register, channel interrupt states */ +#define GDMA_CX_INT_STATE_BUSY BIT(4) +#define GDMA_CX_INT_STATE_TRANS_END BIT(3) +#define GDMA_CX_INT_STATE_BDL_END BIT(2) +#define GDMA_CX_INT_STATE_FIFO_FULL BIT(1) +#define GDMA_CX_INT_STATE_FIFO_EMPTY BIT(0) + + +/* channel modes */ +enum arbitration_mode { + POLLING_MODE, + QOS_MODE +}; + +/* burst type */ +enum burst_type { + BURST_FIX, + BURST_INCR +}; + +/** + * @brief struct phytium_gdma_bdl - describe for bdl list + * @src_addr_l: low 32 bits of src addr + * @src_addr_h: high 32 bits of src addr + * @dst_addr_l: low 32 bits of dst addr + * @dst_addr_h: high 32 bits of dst addr + * @src_xfer_cfg: xfer config for read + * @dst_xfer_cfg: xfer config for write + * @length: xfer length + * @intr_ctl: interrupt enable control + */ +struct phytium_gdma_bdl { + u32 src_addr_l; + u32 src_addr_h; + u32 dst_addr_l; + u32 dst_addr_h; + u32 src_xfer_cfg; + u32 dst_xfer_cfg; + u32 length; + u32 intr_ctl; +}; + +/** + * @brief struct phytium_gdma_bdl_entry - entry for bdl_list + * @bdl: pointer to bdl lists + * @paddr: the first bdl list addr + */ +struct phytium_gdma_bdl_entry { + struct phytium_gdma_bdl *bdl; + dma_addr_t paddr; +}; + +/** + * struct phytium_gdma_desc - the struct holding info describing gdma request + * descriptor + * @chan: the channel belonging to this descriptor + * @vdesc: gdma request descriptor + * @len: total len of dma request + * @bdl_size: store bdl size in bdl mode + * @bdl_mode: the bdl xfer mode flag + * @burst_widht: store burst width in direct xfer mode + * @burst_length: store burst length in direct xfer mode + * @dst: store dst addr in direct xfer mode + * @src: store src addr in direct xfer mode + * @outstanding: store outstanding + * @bdl_list: the entry of bdl lists + */ +struct phytium_gdma_desc { + struct phytium_gdma_chan *chan; + struct virt_dma_desc vdesc; + size_t len; + u32 bdl_size; + bool bdl_mode; + u32 burst_width; + u32 burst_length; + dma_addr_t dst; + dma_addr_t src; + u32 outstanding; + struct phytium_gdma_bdl_entry bdl_list[]; +}; + +/** + * struct phytium_gdma_chan - the struct holding info describing dma channel + * @vchan: virtual dma channel + * @dma_config: config parameters for dma channel + * @desc: the transform request descriptor + * @dma_pool: dma memory for bdl list + * @id: the id of gdma physical channel + * @base: the mapped register I/O of dma physical channel + */ +struct phytium_gdma_chan { + struct virt_dma_chan vchan; + struct dma_slave_config dma_config; + struct phytium_gdma_desc *desc; + struct dma_pool *dma_pool; + + void __iomem *base; + u32 id; + u32 state; +}; + +/** + * struct phytium_gdma_device - the struct holding info describing gdma device + * @dma_dev: an instance for struct dma_device + * @base: the mapped register I/O base of this gdma + * @dma_channels: the number of gdma channels + * @max_outstanding: the max outstanding support + * @chan: the phyical channels of gdma + */ +struct phytium_gdma_device { + struct dma_device dma_dev; + struct device *dev; + void __iomem *base; + u32 dma_channels; + u32 max_outstanding; + struct phytium_gdma_chan *chan; +}; + +#endif /* _PHYTIUM_GDMAC_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/edac/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/edac/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..b362a8aa2cd6b390e3254c1d9dc672166f92b4e0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/edac/Kconfig @@ -0,0 +1,6 @@ +config EDAC_PHYTIUM + tristate "Phytium Pe220x SoC" + depends on (ARM64) + help + Support for error detection and correction on the + Phytium Pe220x family of SOCs. diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/edac/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/edac/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..ae89fc2b7b656a4a96b5bfb2dec7328c4b360e36 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/edac/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_EDAC_PHYTIUM) += phytium_edac.o \ No newline at end of file diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/edac/phytium_edac.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/edac/phytium_edac.c new file mode 100644 index 0000000000000000000000000000000000000000..af6a729816f4afb8212c85f7ee3db1ae0e78c18d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/edac/phytium_edac.c @@ -0,0 +1,481 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium Pe220x EDAC (error detection and correction) + * + * Copyright (c) 2019-2023, Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include "edac_module.h" + +#define EDAC_MOD_STR "phytium_edac" + +/* register offset */ +#define ERR_STATUS(n) (0x10 + ((n) * 64)) +#define ERR_CTLR(n) (0x08 + ((n) * 64)) +#define ERR_MISC0(n) (0x20 + ((n) * 64)) +#define ERR_INJECT 0x7C +#define ERR_DEVID 0xFC8 +#define ERR_GSR 0xE00 + +#define CTLR_ED BIT(0) +#define CTLR_UI BIT(2) +#define CTLR_CFI BIT(8) + +#define MISC0_CEC(x) ((u64)(x) << 32) + +#define ERR_STATUS_CLEAR GENMASK(31, 0) + +#define CORRECTED_ERROR 0 +#define UNCORRECTED_ERROR 1 + +#define MAX_ERR_GROUP 3 + +struct phytium_edac { + struct device *dev; + void __iomem **ras_base; + struct dentry *dfs; + struct edac_device_ctl_info *edac_dev; +}; + +struct ras_error_info { + u32 index; + u32 error_type; + const char *error_str; +}; + +/* error severity definition */ +enum { + SEV_NO = 0x0, + SEV_CORRECTED = 0x1, + SEV_RECOVERABLE = 0x2, + SEV_PANIC = 0x3, +}; + +/* soc error record */ +static const struct ras_error_info pe220x_ras_soc_error[] = { + { 0, UNCORRECTED_ERROR, "lsd_nfc_ras_error" }, + { 1, UNCORRECTED_ERROR, "lsd_lpc_ras_long_wait_to" }, + { 2, UNCORRECTED_ERROR, "lsd_lpc_ras_short_wait_to" }, + { 3, UNCORRECTED_ERROR, "lsd_lpc_ras_sync_err" }, + { 4, UNCORRECTED_ERROR, "lsd_lbc_ras_err" }, + { 5, UNCORRECTED_ERROR, "usb3_err_0" }, + { 6, UNCORRECTED_ERROR, "usb3_err_1" }, + { 7, UNCORRECTED_ERROR, "gsd_gmu_mac0_asf_nonfatal_int" }, + { 8, UNCORRECTED_ERROR, "gsd_gmu_mac0_asf_fatal_int" }, + { 9, UNCORRECTED_ERROR, "gsd_gmu_mac0_asf_trans_to_err" }, + { 10, UNCORRECTED_ERROR, "gsd_gmu_mac0_asf_protocol_err" }, + { 11, UNCORRECTED_ERROR, "gsd_gmu_mac1_asf_nonfatal_int" }, + { 12, UNCORRECTED_ERROR, "gsd_gmu_mac1_asf_fatal_int" }, + { 13, UNCORRECTED_ERROR, "gsd_gmu_mac1_asf_trans_to_err" }, + { 14, UNCORRECTED_ERROR, "gsd_gmu_mac1_asf_protocol_err" }, + { 15, UNCORRECTED_ERROR, "gsd_gmu_mac2_asf_nonfatal_int" }, + { 16, UNCORRECTED_ERROR, "gsd_gmu_mac2_asf_fatal_int" }, + { 17, UNCORRECTED_ERROR, "gsd_gmu_mac2_asf_trans_to_err" }, + { 18, UNCORRECTED_ERROR, "gsd_gmu_mac2_asf_protocol_err" }, + { 19, UNCORRECTED_ERROR, "gsd_gmu_mac3_asf_nonfatal_int" }, + { 20, UNCORRECTED_ERROR, "gsd_gmu_mac3_asf_fatal_int" }, + { 21, UNCORRECTED_ERROR, "gsd_gmu_mac3_asf_trans_to_err" }, + { 22, UNCORRECTED_ERROR, "gsd_gmu_mac3_asf_protocol_err" }, + { 23, CORRECTED_ERROR, "dmu_ras_ecc_corrected_error" }, + { 24, UNCORRECTED_ERROR, "dmu_ras_ecc_uncorrected_error" }, + { 25, UNCORRECTED_ERROR, "cci_ras_nERRIRQ" }, + { 26, UNCORRECTED_ERROR, "smmu_tcu_ras_irpt" }, + { 27, UNCORRECTED_ERROR, "smmu_tbu0_ras_irpt" }, + { 28, UNCORRECTED_ERROR, "smmu_tbu1_ras_irpt" }, + { 29, UNCORRECTED_ERROR, "smmu_tbu2_ras_irpt" }, + { 30, UNCORRECTED_ERROR, "ocm_sram_ue" }, + { 31, CORRECTED_ERROR, "ocm_sram_ce" }, + { 32, UNCORRECTED_ERROR, "int_axim_err" }, + { 33, UNCORRECTED_ERROR, "int_fatal_error" }, + { 34, UNCORRECTED_ERROR, "nEXTERRIRQ_clust0" }, + { 35, UNCORRECTED_ERROR, "nINTERRIRQ_clust0" }, + { 36, UNCORRECTED_ERROR, "nEXTERRIRQ_clust1" }, + { 37, UNCORRECTED_ERROR, "nINTERRIRQ_clust1" }, + { 38, UNCORRECTED_ERROR, "nEXTERRIRQ_clust2" }, + { 39, UNCORRECTED_ERROR, "nINTERRIRQ_clust2" }, + { 40, UNCORRECTED_ERROR, "ams_ame0_ras_err" }, + { 41, UNCORRECTED_ERROR, "ams_ame1_ras_err" }, + { 42, UNCORRECTED_ERROR, "ams_amer_ras_err" }, + { 43, UNCORRECTED_ERROR, "ras_err_ame1" }, +}; + +/* pcie controller error record */ +static const struct ras_error_info pe220x_ras_peu_psu_error[] = { + { 0, CORRECTED_ERROR, "pio_rd_addr_error" }, + { 1, UNCORRECTED_ERROR, "pio_wr_addr_error" }, + { 2, CORRECTED_ERROR, "pio_rd_timeout" }, + { 3, CORRECTED_ERROR, "pio_wr_timeout" }, + { 4, CORRECTED_ERROR, "axi_b_rsp_error" }, + { 5, CORRECTED_ERROR, "axi_r_rsp_error" }, +}; + +static const struct ras_error_info pe220x_ras_peu_error[] = { + { 0, CORRECTED_ERROR, "pio_rd_addr_error" }, + { 1, UNCORRECTED_ERROR, "pio_wr_addr_error" }, + { 2, CORRECTED_ERROR, "pio_rd_timeout" }, + { 3, CORRECTED_ERROR, "pio_wr_timeout" }, + { 4, CORRECTED_ERROR, "axi_b_rsp_error" }, + { 5, CORRECTED_ERROR, "axi_r_rsp_error" }, +}; + +static const struct ras_error_info *pe220x_ras_error[] = { + pe220x_ras_soc_error, pe220x_ras_peu_psu_error, pe220x_ras_peu_error +}; + +static inline unsigned int get_error_num(const struct phytium_edac *edac, + int err_group) +{ + unsigned int error_num = 0; + + error_num = readl(edac->ras_base[err_group] + ERR_DEVID); + + return error_num; +} + +static inline void phytium_ras_setup(const struct phytium_edac *edac) +{ + u64 val = 0; + unsigned int i = 0; + /* + * enable error report and generate interrupt for corrected error event + * first error record owned by node present the node configuration + */ + for (i = 0; i < MAX_ERR_GROUP; i++) { + val = readq(edac->ras_base[i] + ERR_CTLR(0)); + val |= CTLR_ED | CTLR_UI | CTLR_CFI; + writeq(val, edac->ras_base[i] + ERR_CTLR(0)); + } +} + +static ssize_t phytium_edac_inject_ctrl_write(struct file *filp, + const char __user *buf, + size_t size, loff_t *ppos) +{ + int ret = 0; + int res = 0; + unsigned int error_group = 0; + unsigned int error_id = 0; + unsigned int error_num = 0; + struct phytium_edac *edac = filp->private_data; + char str[255]; + char *p_str = str; + char *tmp = NULL; + + if (size > 255) { + ret = -EFAULT; + goto out; + } + + if (copy_from_user(str, buf, size)) { + ret = -EFAULT; + goto out; + } else { + *ppos += size; + ret = size; + } + str[size] = '\0'; + + tmp = strsep(&p_str, ","); + if (!tmp) + goto out; + + res = kstrtouint(tmp, 0, &error_group); + if (res || error_group >= MAX_ERR_GROUP) { + dev_err(edac->dev, "invalid error group parameters"); + goto out; + } + + res = kstrtouint(p_str, 0, &error_id); + if (res) { + dev_err(edac->dev, "invalid error id parameters"); + goto out; + } + + error_num = get_error_num(edac, error_group); + if (error_id >= error_num) { + dev_err(edac->dev, "invalid ras error id.\n"); + goto out; + } + + dev_dbg(edac->dev, "inject group%d, error_id: %d\n", + error_group, error_id); + + if (pe220x_ras_error[error_group][error_id].error_type + == CORRECTED_ERROR) { + writeq(MISC0_CEC(0xFF), + edac->ras_base[error_group] + ERR_MISC0(error_id)); + } + + writel(error_id, edac->ras_base[error_group] + ERR_INJECT); + +out: + return ret; +} + +static const struct file_operations phytium_edac_debug_inject_fops[] = { + { + .open = simple_open, + .write = phytium_edac_inject_ctrl_write, + .llseek = generic_file_llseek, }, + { } +}; + +static void phytium_edac_create_debugfs_nodes(struct phytium_edac *edac) +{ + if (!IS_ENABLED(CONFIG_EDAC_DEBUG) || !edac->dfs) { + dev_info(edac->dev, "edac debug is disable"); + return; + } + + edac_debugfs_create_file("error_inject_ctrl", 0x0200, edac->dfs, edac, + &phytium_edac_debug_inject_fops[0]); +} + +static int phytium_edac_device_add(struct phytium_edac *edac) +{ + struct edac_device_ctl_info *edac_dev; + int res = 0; + + edac_dev = edac_device_alloc_ctl_info( + sizeof(struct edac_device_ctl_info), + "ras", 1, "soc", 1, 0, NULL, + 0, edac_device_alloc_index()); + if (!edac_dev) + res = -ENOMEM; + + edac_dev->dev = edac->dev; + edac_dev->mod_name = EDAC_MOD_STR; + edac_dev->ctl_name = "phytium ras"; + edac_dev->dev_name = "soc"; + + phytium_edac_create_debugfs_nodes(edac); + + res = edac_device_add_device(edac_dev); + if (res > 0) { + dev_err(edac->dev, "edac_device_add_device failed\n"); + goto err_free; + } + + edac->edac_dev = edac_dev; + dev_info(edac->dev, "phytium edac device registered\n"); + return 0; + +err_free: + edac_device_free_ctl_info(edac_dev); + return res; +} + +static int phytium_edac_device_remove(struct phytium_edac *edac) +{ + struct edac_device_ctl_info *edac_dev = edac->edac_dev; + + debugfs_remove_recursive(edac->dfs); + edac_device_del_device(edac_dev->dev); + edac_device_free_ctl_info(edac_dev); + return 0; +} + +static int get_error_id(struct phytium_edac *edac, int *error_id, + int *error_group) +{ + unsigned int error_num = 0; + u64 error_bit = 0; + int ret = 0; + int i = 0; + int err_id = 0; + + /* Iterate over the ras node to check error status */ + for (i = 0; i < MAX_ERR_GROUP; i++) { + error_num = get_error_num(edac, i); + error_bit = readq(edac->ras_base[i] + ERR_GSR); + for (err_id = 0; err_id < error_num; err_id++) { + if (!(error_bit & BIT(err_id))) + continue; + else + break; + } + if (err_id < error_num) { + *error_id = err_id; + *error_group = i; + break; + } + } + + if (i >= MAX_ERR_GROUP) { + ret = -1; + dev_warn(edac->dev, "no error detect.\n"); + } + + return ret; +} + +static void phytium_edac_error_report(struct phytium_edac *edac, + const int error_id, const int error_group) +{ + const struct ras_error_info *err_info = + pe220x_ras_error[error_group]; + + if (err_info[error_id].error_type == UNCORRECTED_ERROR) { + edac_printk(KERN_CRIT, EDAC_MOD_STR, "uncorrected error: %s\n", + err_info[error_id].error_str); + edac_device_handle_ue(edac->edac_dev, 0, 0, + err_info[error_id].error_str); + /* Report the error via the trace interface */ + if (IS_ENABLED(CONFIG_RAS)) + trace_non_standard_event(&NULL_GUID, &NULL_GUID, + EDAC_MOD_STR, SEV_RECOVERABLE, + err_info[error_id].error_str, + strlen(err_info[error_id].error_str)); + } else { + edac_printk(KERN_CRIT, EDAC_MOD_STR, "corrected error: %s\n", + err_info[error_id].error_str); + edac_device_handle_ce(edac->edac_dev, 0, 0, + err_info[error_id].error_str); + if (IS_ENABLED(CONFIG_RAS)) + trace_non_standard_event(&NULL_GUID, &NULL_GUID, + EDAC_MOD_STR, SEV_CORRECTED, + err_info[error_id].error_str, + strlen(err_info[error_id].error_str)); + } +} + +/* + * clear error status and set correct error counter to 0xFE for trigger + * interrupt when next correct error event + */ +static void phytium_edac_clear_error_status(struct phytium_edac *edac, + const int error_id, const int error_group) +{ + writeq(MISC0_CEC(0XFE), edac->ras_base[error_group] + + ERR_MISC0(error_id)); + writeq(GENMASK(31, 0), edac->ras_base[error_group] + + ERR_STATUS(error_id)); +} + +static irqreturn_t phytium_edac_isr(int irq, void *dev_id) +{ + struct phytium_edac *edac = dev_id; + int ret = 0; + int error_group; + int error_id; + + ret = get_error_id(edac, &error_id, &error_group); + if (ret < 0) + goto out; + + phytium_edac_error_report(edac, error_id, error_group); + phytium_edac_clear_error_status(edac, error_id, error_group); + +out: + return IRQ_HANDLED; +} + +static int phytium_edac_probe(struct platform_device *pdev) +{ + struct phytium_edac *edac; + struct resource *res; + int ret = 0; + int irq_cnt = 0; + int irq = 0; + int i = 0; + + edac = devm_kzalloc(&pdev->dev, sizeof(*edac), GFP_KERNEL); + if (!edac) { + ret = -ENOMEM; + goto out; + } + + edac->dev = &pdev->dev; + platform_set_drvdata(pdev, edac); + + edac->ras_base = devm_kcalloc(&pdev->dev, 3, + sizeof(*edac->ras_base), GFP_KERNEL); + if (!edac->ras_base) { + return -ENOMEM; + goto out; + } + + for (i = 0; i < MAX_ERR_GROUP; i++) { + res = platform_get_resource(pdev, IORESOURCE_MEM, i); + edac->ras_base[i] = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(edac->ras_base[i])) { + dev_err(&pdev->dev, "no resource address\n"); + ret = PTR_ERR(edac->ras_base[i]); + goto out; + } + } + + edac->dfs = edac_debugfs_create_dir(EDAC_MOD_STR); + + ret = phytium_edac_device_add(edac); + if (ret) { + dev_err(&pdev->dev, "can't add edac device"); + goto out; + } + + phytium_ras_setup(edac); + + irq_cnt = platform_irq_count(pdev); + if (irq_cnt < 0) { + dev_err(&pdev->dev, "no irq resource\n"); + ret = -EINVAL; + goto out; + } + + for (i = 0; i < irq_cnt; i++) { + irq = platform_get_irq(pdev, i); + if (irq < 0) { + dev_err(&pdev->dev, "invalid irq resource\n"); + ret = -EINVAL; + goto out; + } + ret = devm_request_irq(&pdev->dev, irq, + phytium_edac_isr, IRQF_SHARED, + EDAC_MOD_STR, edac); + if (ret) { + dev_err(&pdev->dev, + "could not request irq %d\n", irq); + goto out; + } + } + +out: + return ret; +} + +static int phytium_edac_remove(struct platform_device *pdev) +{ + struct phytium_edac *edac = dev_get_drvdata(&pdev->dev); + + phytium_edac_device_remove(edac); + + return 0; +} + +static const struct of_device_id phytium_edac_of_match[] = { + { .compatible = "phytium,pe220x-edac" }, + {}, +}; +MODULE_DEVICE_TABLE(of, phytium_edac_of_match); + +static struct platform_driver phytium_edac_driver = { + .probe = phytium_edac_probe, + .remove = phytium_edac_remove, + .driver = { + .name = "phytium-edac", + .of_match_table = phytium_edac_of_match, + }, +}; + +module_platform_driver(phytium_edac_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Huangjie "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..b9ccfe673063f4fc6a78c60e1dccc66880687671 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/Kconfig @@ -0,0 +1,37 @@ +# This symbol is selected by both MMIO and PCI expanders +config GPIO_PHYTIUM_CORE + tristate + +config GPIO_PHYTIUM_PLAT + tristate "Phytium GPIO Platform support" + default y if ARCH_PHYTIUM + depends on ARM64 + select GPIO_PHYTIUM_CORE + select IRQ_DOMAIN + select GENERIC_IRQ_CHIP + select GPIOLIB_IRQCHIP + help + Say yes here to support the on-chip GPIO controller for the + Phytium SoC family. + +config GPIO_PHYTIUM_SGPIO + tristate "Phytium SGPIO support" + default y if ARCH_PHYTIUM + depends on ARM64 + select IRQ_DOMAIN + select GENERIC_IRQ_CHIP + help + Say yes here to enable SGPIO support for Phytium SoCs. + +config GPIO_PHYTIUM_PCI + tristate "Phytium GPIO PCI support" + select GPIO_PHYTIUM_CORE + select IRQ_DOMAIN + select GENERIC_IRQ_CHIP + select GPIOLIB_IRQCHIP + help + Say Y here to support Phytium PCI GPIO controller on px210 chipset. + An interrupt is generated when any of the inputs change state + (low to high or high to low). + + This driver can be used for Phytium px210. diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..f97ee48808be16dc40bd4c8a090e346e3004853b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/Makefile @@ -0,0 +1,8 @@ +# SPDX-License-Identifier: GPL-2.0 +# generic gpio support: platform drivers, dedicated expander chips, etc + +obj-$(CONFIG_GPIO_PHYTIUM_CORE) += gpio-phytium-core.o +obj-$(CONFIG_GPIO_PHYTIUM_PCI) += gpio-phytium-pci.o +obj-$(CONFIG_GPIO_PHYTIUM_PLAT) += gpio-phytium-platform.o +obj-$(CONFIG_GPIO_PHYTIUM_SGPIO) += gpio-phytium-sgpio.o + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-core.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-core.c new file mode 100644 index 0000000000000000000000000000000000000000..8ea7cafc4c479ae9f72005bbe738e8f03ad8f172 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-core.c @@ -0,0 +1,378 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include + +#include "gpio-phytium-core.h" + +static int get_pin_location(struct phytium_gpio *gpio, unsigned int offset, + struct pin_loc *pl) +{ + int ret; + + if (offset < gpio->ngpio[0]) { + pl->port = 0; + pl->offset = offset; + ret = 0; + } else if (offset < (gpio->ngpio[0] + gpio->ngpio[1])) { + pl->port = 1; + pl->offset = offset - gpio->ngpio[0]; + ret = 0; + } else { + ret = -EINVAL; + } + + return ret; +} + +static void phytium_gpio_toggle_trigger(struct phytium_gpio *gpio, + unsigned int offset) +{ + struct gpio_chip *gc; + u32 pol; + int val; + + /* Only port A can provide interrupt source */ + if (offset >= gpio->ngpio[0]) + return; + + gc = &gpio->gc; + + pol = readl(gpio->regs + GPIO_INT_POLARITY); + /* Just read the current value right out of the data register */ + val = gc->get(gc, offset); + if (val) + pol &= ~BIT(offset); + else + pol |= BIT(offset); + + writel(pol, gpio->regs + GPIO_INT_POLARITY); +} + +int phytium_gpio_get(struct gpio_chip *gc, unsigned int offset) +{ + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct pin_loc loc; + void __iomem *dat; + + if (get_pin_location(gpio, offset, &loc)) + return -EINVAL; + + dat = gpio->regs + GPIO_EXT_PORTA + (loc.port * GPIO_PORT_STRIDE); + + return !!(readl(dat) & BIT(loc.offset)); +} +EXPORT_SYMBOL_GPL(phytium_gpio_get); + +void phytium_gpio_set(struct gpio_chip *gc, unsigned int offset, int value) +{ + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct pin_loc loc; + void __iomem *dr; + unsigned long flags; + u32 mask; + + if (get_pin_location(gpio, offset, &loc)) + return; + dr = gpio->regs + GPIO_SWPORTA_DR + (loc.port * GPIO_PORT_STRIDE); + + raw_spin_lock_irqsave(&gpio->lock, flags); + + if (value) + mask = readl(dr) | BIT(loc.offset); + else + mask = readl(dr) & ~BIT(loc.offset); + + writel(mask, dr); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); +} +EXPORT_SYMBOL_GPL(phytium_gpio_set); + +int phytium_gpio_direction_input(struct gpio_chip *gc, unsigned int offset) +{ + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct pin_loc loc; + unsigned long flags; + void __iomem *ddr; + + if (get_pin_location(gpio, offset, &loc)) + return -EINVAL; + ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); + + raw_spin_lock_irqsave(&gpio->lock, flags); + + writel(readl(ddr) & ~(BIT(loc.offset)), ddr); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_gpio_direction_input); + +int phytium_gpio_direction_output(struct gpio_chip *gc, unsigned int offset, + int value) +{ + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct pin_loc loc; + unsigned long flags; + void __iomem *ddr; + + if (get_pin_location(gpio, offset, &loc)) + return -EINVAL; + ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); + + raw_spin_lock_irqsave(&gpio->lock, flags); + + writel(readl(ddr) | BIT(loc.offset), ddr); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + phytium_gpio_set(gc, offset, value); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_gpio_direction_output); + +void phytium_gpio_irq_ack(struct irq_data *d) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + u32 val = BIT(irqd_to_hwirq(d)); + + raw_spin_lock(&gpio->lock); + + writel(val, gpio->regs + GPIO_PORTA_EOI); + + raw_spin_unlock(&gpio->lock); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_ack); + +void phytium_gpio_irq_mask(struct irq_data *d) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + u32 val; + + /* Only port A can provide interrupt source */ + if (irqd_to_hwirq(d) >= gpio->ngpio[0]) + return; + + raw_spin_lock(&gpio->lock); + + val = readl(gpio->regs + GPIO_INTMASK); + val |= BIT(irqd_to_hwirq(d)); + writel(val, gpio->regs + GPIO_INTMASK); + + raw_spin_unlock(&gpio->lock); + + gpiochip_disable_irq(gc, irqd_to_hwirq(d)); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_mask); + +void phytium_gpio_irq_unmask(struct irq_data *d) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + u32 val; + + /* Only port A can provide interrupt source */ + if (irqd_to_hwirq(d) >= gpio->ngpio[0]) + return; + + gpiochip_enable_irq(gc, irqd_to_hwirq(d)); + + raw_spin_lock(&gpio->lock); + + val = readl(gpio->regs + GPIO_INTMASK); + val &= ~BIT(irqd_to_hwirq(d)); + writel(val, gpio->regs + GPIO_INTMASK); + + raw_spin_unlock(&gpio->lock); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_unmask); + +int phytium_gpio_irq_set_type(struct irq_data *d, unsigned int flow_type) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + int hwirq = irqd_to_hwirq(d); + unsigned long flags, lvl, pol; + + if (hwirq < 0 || hwirq >= gpio->ngpio[0]) + return -EINVAL; + + if ((flow_type & (IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW)) && + (flow_type & (IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING))) { + dev_err(gc->parent, + "trying to configure line %d for both level and edge detection, choose one!\n", + hwirq); + return -EINVAL; + } + + raw_spin_lock_irqsave(&gpio->lock, flags); + + lvl = readl(gpio->regs + GPIO_INTTYPE_LEVEL); + pol = readl(gpio->regs + GPIO_INT_POLARITY); + + switch (flow_type) { + case IRQ_TYPE_EDGE_BOTH: + lvl |= BIT(hwirq); + phytium_gpio_toggle_trigger(gpio, hwirq); + irq_set_handler_locked(d, handle_edge_irq); + dev_dbg(gc->parent, "line %d: IRQ on both edges\n", hwirq); + break; + case IRQ_TYPE_EDGE_RISING: + lvl |= BIT(hwirq); + pol |= BIT(hwirq); + irq_set_handler_locked(d, handle_edge_irq); + dev_dbg(gc->parent, "line %d: IRQ on RISING edge\n", hwirq); + break; + case IRQ_TYPE_EDGE_FALLING: + lvl |= BIT(hwirq); + pol &= ~BIT(hwirq); + irq_set_handler_locked(d, handle_edge_irq); + dev_dbg(gc->parent, "line %d: IRQ on FALLING edge\n", hwirq); + break; + case IRQ_TYPE_LEVEL_HIGH: + lvl &= ~BIT(hwirq); + pol |= BIT(hwirq); + irq_set_handler_locked(d, handle_level_irq); + dev_dbg(gc->parent, "line %d: IRQ on HIGH level\n", hwirq); + break; + case IRQ_TYPE_LEVEL_LOW: + lvl &= ~BIT(hwirq); + pol &= ~BIT(hwirq); + irq_set_handler_locked(d, handle_level_irq); + dev_dbg(gc->parent, "line %d: IRQ on LOW level\n", hwirq); + break; + } + + writel(lvl, gpio->regs + GPIO_INTTYPE_LEVEL); + if (flow_type != IRQ_TYPE_EDGE_BOTH) + writel(pol, gpio->regs + GPIO_INT_POLARITY); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_set_type); + +void phytium_gpio_irq_enable(struct irq_data *d) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + unsigned long flags; + u32 val; + + /* Only port A can provide interrupt source */ + if (irqd_to_hwirq(d) >= gpio->ngpio[0]) + return; + + gpiochip_enable_irq(gc, irqd_to_hwirq(d)); + + raw_spin_lock_irqsave(&gpio->lock, flags); + + val = readl(gpio->regs + GPIO_INTEN); + val |= BIT(irqd_to_hwirq(d)); + writel(val, gpio->regs + GPIO_INTEN); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + gpiochip_disable_irq(gc, irqd_to_hwirq(d)); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_enable); + +void phytium_gpio_irq_disable(struct irq_data *d) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(d); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + unsigned long flags; + u32 val; + + /* Only port A can provide interrupt source */ + if (irqd_to_hwirq(d) >= gpio->ngpio[0]) + return; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + val = readl(gpio->regs + GPIO_INTEN); + val &= ~BIT(irqd_to_hwirq(d)); + writel(val, gpio->regs + GPIO_INTEN); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_disable); + +void phytium_gpio_irq_print_chip(struct irq_data *data, struct seq_file *p) +{ + struct gpio_chip *gc = irq_data_get_irq_chip_data(data); + + seq_printf(p, dev_name(gc->parent)); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_print_chip); + +void phytium_gpio_irq_handler(struct irq_desc *desc) +{ + struct gpio_chip *gc = irq_desc_get_handler_data(desc); + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct irq_chip *irqchip = irq_desc_get_chip(desc); + unsigned long pending; + int offset; + + chained_irq_enter(irqchip, desc); + + pending = readl(gpio->regs + GPIO_INTSTATUS); + if (pending) { + for_each_set_bit(offset, &pending, gpio->ngpio[0]) { + int gpio_irq = irq_find_mapping(gc->irq.domain, + offset); + generic_handle_irq(gpio_irq); + + if ((irq_get_trigger_type(gpio_irq) & + IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH) + phytium_gpio_toggle_trigger(gpio, offset); + } + } + + chained_irq_exit(irqchip, desc); +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_handler); + +int phytium_gpio_get_direction(struct gpio_chip *gc, unsigned int offset) +{ + struct phytium_gpio *gpio = gpiochip_get_data(gc); + struct pin_loc loc; + void __iomem *ddr; + + if (get_pin_location(gpio, offset, &loc)) + return -EINVAL; + ddr = gpio->regs + GPIO_SWPORTA_DDR + (loc.port * GPIO_PORT_STRIDE); + + return !(readl(ddr) & BIT(loc.offset)); +} +EXPORT_SYMBOL_GPL(phytium_gpio_get_direction); + +int phytium_gpio_irq_set_affinity(struct irq_data *d, const struct cpumask *mask_val, bool force) +{ + int hwirq = irqd_to_hwirq(d); + struct gpio_chip *chip_data = irq_data_get_irq_chip_data(d); + struct irq_chip *chip = irq_get_chip(chip_data->irq.parents[hwirq]); + struct irq_data *data = irq_get_irq_data(chip_data->irq.parents[hwirq]); + + if (chip && chip->irq_set_affinity) + return chip->irq_set_affinity(data, mask_val, force); + + return -EINVAL; +} +EXPORT_SYMBOL_GPL(phytium_gpio_irq_set_affinity); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium GPIO Controller core"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-core.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-core.h new file mode 100644 index 0000000000000000000000000000000000000000..3d8c6e7b355cec690754abd14d0a5bc4bfd2de79 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-core.h @@ -0,0 +1,87 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _GPIO_PHYTIUM_H +#define _GPIO_PHYTIUM_H + +#include +#include + +#include "gpiolib.h" + +#define GPIO_SWPORTA_DR 0x00 /* WR Port A Output Data Register */ +#define GPIO_SWPORTA_DDR 0x04 /* WR Port A Data Direction Register */ +#define GPIO_EXT_PORTA 0x08 /* RO Port A Input Data Register */ +#define GPIO_SWPORTB_DR 0x0c /* WR Port B Output Data Register */ +#define GPIO_SWPORTB_DDR 0x10 /* WR Port B Data Direction Register */ +#define GPIO_EXT_PORTB 0x14 /* RO Port B Input Data Register */ + +#define GPIO_INTEN 0x18 /* WR Port A Interrput Enable Register */ +#define GPIO_INTMASK 0x1c /* WR Port A Interrupt Mask Register */ +#define GPIO_INTTYPE_LEVEL 0x20 /* WR Port A Interrupt Level Register */ +#define GPIO_INT_POLARITY 0x24 /* WR Port A Interrupt Polarity Register */ +#define GPIO_INTSTATUS 0x28 /* RO Port A Interrupt Status Register */ +#define GPIO_RAW_INTSTATUS 0x2c /* RO Port A Raw Interrupt Status Register */ +#define GPIO_LS_SYNC 0x30 /* WR Level-sensitive Synchronization Enable Register */ +#define GPIO_DEBOUNCE 0x34 /* WR Debounce Enable Register */ +#define GPIO_PORTA_EOI 0x38 /* WO Port A Clear Interrupt Register */ + +#define MAX_NPORTS 2 +#define NGPIO_DEFAULT 8 +#define NGPIO_MAX 32 +#define GPIO_PORT_STRIDE (GPIO_EXT_PORTB - GPIO_EXT_PORTA) + +struct pin_loc { + unsigned int port; + unsigned int offset; +}; + +#ifdef CONFIG_PM_SLEEP +struct phytium_gpio_ctx { + u32 swporta_dr; + u32 swporta_ddr; + u32 ext_porta; + u32 swportb_dr; + u32 swportb_ddr; + u32 ext_portb; + u32 inten; + u32 intmask; + u32 inttype_level; + u32 int_polarity; + u32 intstatus; + u32 raw_intstatus; + u32 ls_sync; + u32 debounce; +}; +#endif + +struct phytium_gpio { + raw_spinlock_t lock; + void __iomem *regs; + struct gpio_chip gc; + unsigned int ngpio[2]; + int irq[32]; +#ifdef CONFIG_PM_SLEEP + struct phytium_gpio_ctx ctx; +#endif +}; + +int phytium_gpio_get(struct gpio_chip *gc, unsigned int offset); +void phytium_gpio_set(struct gpio_chip *gc, unsigned int offset, int value); + +int phytium_gpio_get_direction(struct gpio_chip *gc, unsigned int offset); +int phytium_gpio_direction_input(struct gpio_chip *gc, unsigned int offset); +int phytium_gpio_direction_output(struct gpio_chip *gc, unsigned int offset, int value); + +void phytium_gpio_irq_ack(struct irq_data *d); +void phytium_gpio_irq_mask(struct irq_data *d); +void phytium_gpio_irq_unmask(struct irq_data *d); +int phytium_gpio_irq_set_type(struct irq_data *d, unsigned int flow_type); +void phytium_gpio_irq_print_chip(struct irq_data *data, struct seq_file *p); +void phytium_gpio_irq_enable(struct irq_data *d); +void phytium_gpio_irq_disable(struct irq_data *d); +void phytium_gpio_irq_handler(struct irq_desc *desc); +int phytium_gpio_irq_set_affinity(struct irq_data *d, const struct cpumask *mask_val, bool force); +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-pci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-pci.c new file mode 100644 index 0000000000000000000000000000000000000000..e194e3582f2fa961a892b2197b92aa1ec02c2c0b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-pci.c @@ -0,0 +1,191 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include + +#include "gpio-phytium-core.h" + +static const struct irq_chip phytium_gpio_irq_chip = { + .irq_ack = phytium_gpio_irq_ack, + .irq_mask = phytium_gpio_irq_mask, + .irq_unmask = phytium_gpio_irq_unmask, + .irq_set_type = phytium_gpio_irq_set_type, + .irq_print_chip = phytium_gpio_irq_print_chip, + .irq_enable = phytium_gpio_irq_enable, + .irq_disable = phytium_gpio_irq_disable, + .flags = IRQCHIP_IMMUTABLE, + GPIOCHIP_IRQ_RESOURCE_HELPERS, +}; + +static int phytium_gpio_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) +{ + struct device *dev = &pdev->dev; + struct phytium_gpio *gpio; + struct gpio_irq_chip *girq; + int err; + + gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL); + if (!gpio) + return -ENOMEM; + + err = pcim_enable_device(pdev); + if (err) { + dev_err(dev, "Failed to enable PCI device: err %d\n", err); + goto out; + } + + err = pcim_iomap_regions(pdev, 1 << 0, pci_name(pdev)); + if (err) { + dev_err(dev, "Failed to iomap PCI device: err %d\n", err); + goto out; + } + + gpio->regs = pcim_iomap_table(pdev)[0]; + if (!gpio->regs) { + dev_err(dev, "Cannot map PCI resource\n"); + err = -ENOMEM; + goto out; + } + + err = pci_enable_msi(pdev); + if (err < 0) + goto out; + + pci_set_master(pdev); + + gpio->irq[0] = pdev->irq; + if (gpio->irq[0] < 0) + dev_warn(dev, "no irq is found.\n"); + + /* There is only one group of Pins at the moment. */ + gpio->ngpio[0] = NGPIO_MAX; + + /* irq_chip support */ + raw_spin_lock_init(&gpio->lock); + + gpio->gc.base = -1; + gpio->gc.get_direction = phytium_gpio_get_direction; + gpio->gc.direction_input = phytium_gpio_direction_input; + gpio->gc.direction_output = phytium_gpio_direction_output; + gpio->gc.get = phytium_gpio_get; + gpio->gc.set = phytium_gpio_set; + gpio->gc.ngpio = gpio->ngpio[0] + gpio->ngpio[1]; + gpio->gc.label = dev_name(dev); + gpio->gc.parent = dev; + gpio->gc.owner = THIS_MODULE; + + girq = &gpio->gc.irq; + girq->handler = handle_bad_irq; + girq->default_type = IRQ_TYPE_NONE; + + girq->num_parents = 1; + girq->parents = devm_kcalloc(&pdev->dev, girq->num_parents, + sizeof(*girq->parents), GFP_KERNEL); + if (!girq->parents) + return -ENOMEM; + girq->parents[0] = gpio->irq[0]; + girq->parent_handler = phytium_gpio_irq_handler; + + gpio_irq_chip_set_chip(girq, &phytium_gpio_irq_chip); + + err = devm_gpiochip_add_data(dev, &gpio->gc, gpio); + if (err) + goto out; + + dev_info(dev, "Phytium PCI GPIO controller @%pa registered\n", + &gpio->regs); + + pci_set_drvdata(pdev, gpio); + +out: + return err; +} + +static const struct pci_device_id phytium_gpio_pci_ids[] = { + { PCI_DEVICE(0x1DB7, 0xDC31) }, + { 0 } +}; +MODULE_DEVICE_TABLE(pci, phytium_gpio_pci_ids); + +#ifdef CONFIG_PM_SLEEP +static int phytium_gpio_pci_suspend(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_gpio *gpio = pci_get_drvdata(pdev); + unsigned long flags; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + gpio->ctx.swporta_dr = readl(gpio->regs + GPIO_SWPORTA_DR); + gpio->ctx.swporta_ddr = readl(gpio->regs + GPIO_SWPORTA_DDR); + gpio->ctx.ext_porta = readl(gpio->regs + GPIO_EXT_PORTA); + gpio->ctx.swportb_dr = readl(gpio->regs + GPIO_SWPORTB_DR); + gpio->ctx.swportb_ddr = readl(gpio->regs + GPIO_SWPORTB_DDR); + gpio->ctx.ext_portb = readl(gpio->regs + GPIO_EXT_PORTB); + + gpio->ctx.inten = readl(gpio->regs + GPIO_INTEN); + gpio->ctx.intmask = readl(gpio->regs + GPIO_INTMASK); + gpio->ctx.inttype_level = readl(gpio->regs + GPIO_INTTYPE_LEVEL); + gpio->ctx.int_polarity = readl(gpio->regs + GPIO_INT_POLARITY); + gpio->ctx.debounce = readl(gpio->regs + GPIO_DEBOUNCE); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} + +static int phytium_gpio_pci_resume(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_gpio *gpio = pci_get_drvdata(pdev); + unsigned long flags; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + writel(gpio->ctx.swporta_dr, gpio->regs + GPIO_SWPORTA_DR); + writel(gpio->ctx.swporta_ddr, gpio->regs + GPIO_SWPORTA_DDR); + writel(gpio->ctx.ext_porta, gpio->regs + GPIO_EXT_PORTA); + writel(gpio->ctx.swportb_dr, gpio->regs + GPIO_SWPORTB_DR); + writel(gpio->ctx.swportb_ddr, gpio->regs + GPIO_SWPORTB_DDR); + writel(gpio->ctx.ext_portb, gpio->regs + GPIO_EXT_PORTB); + + writel(gpio->ctx.inten, gpio->regs + GPIO_INTEN); + writel(gpio->ctx.intmask, gpio->regs + GPIO_INTMASK); + writel(gpio->ctx.inttype_level, gpio->regs + GPIO_INTTYPE_LEVEL); + writel(gpio->ctx.int_polarity, gpio->regs + GPIO_INT_POLARITY); + writel(gpio->ctx.debounce, gpio->regs + GPIO_DEBOUNCE); + + writel(0xffffffff, gpio->regs + GPIO_PORTA_EOI); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_gpio_pci_pm_ops, + phytium_gpio_pci_suspend, + phytium_gpio_pci_resume); + +static struct pci_driver phytium_gpio_pci_driver = { + .name = "gpio-phytium-pci", + .id_table = phytium_gpio_pci_ids, + .probe = phytium_gpio_pci_probe, + .driver = { + .pm = &phytium_gpio_pci_pm_ops, + }, +}; + +module_pci_driver(phytium_gpio_pci_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Cheng Quan "); +MODULE_DESCRIPTION("Phytium GPIO PCI Driver"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-platform.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-platform.c new file mode 100644 index 0000000000000000000000000000000000000000..2f808b89e4ed57a670cc9e9ec6f75fb465193506 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-platform.c @@ -0,0 +1,208 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Support functions for Phytium GPIO + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + * + * Derived from drivers/gpio/gpio-pl061.c + * Copyright (C) 2008, 2009 Provigent Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "gpio-phytium-core.h" + +static const struct of_device_id phytium_gpio_of_match[] = { + { .compatible = "phytium,gpio", }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_gpio_of_match); + +static const struct acpi_device_id phytium_gpio_acpi_match[] = { + { "PHYT0001", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, phytium_gpio_acpi_match); + +static const struct irq_chip phytium_gpio_irq_chip = { + .irq_ack = phytium_gpio_irq_ack, + .irq_mask = phytium_gpio_irq_mask, + .irq_unmask = phytium_gpio_irq_unmask, + .irq_set_type = phytium_gpio_irq_set_type, + .irq_print_chip = phytium_gpio_irq_print_chip, + .irq_enable = phytium_gpio_irq_enable, + .irq_disable = phytium_gpio_irq_disable, + .irq_set_affinity = phytium_gpio_irq_set_affinity, + .flags = IRQCHIP_IMMUTABLE, + GPIOCHIP_IRQ_RESOURCE_HELPERS, +}; + +static int phytium_gpio_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct resource *res; + struct phytium_gpio *gpio; + struct gpio_irq_chip *girq; + struct fwnode_handle *fwnode; + int err, irq_count; + + gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL); + if (!gpio) + return -ENOMEM; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + gpio->regs = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(gpio->regs)) + return PTR_ERR(gpio->regs); + + if (!device_get_child_node_count(dev)) + return -ENODEV; + + device_for_each_child_node(dev, fwnode) { + int idx; + + if (fwnode_property_read_u32(fwnode, "reg", &idx) || + idx >= MAX_NPORTS) { + dev_err(dev, "missing/invalid port index\n"); + fwnode_handle_put(fwnode); + return -EINVAL; + } + + if (fwnode_property_read_u32(fwnode, "ngpios", + &gpio->ngpio[idx]) + && fwnode_property_read_u32(fwnode, "nr-gpios", + &gpio->ngpio[idx])) { + dev_info(dev, + "failed to get number of gpios for Port%c\n", + idx ? 'B' : 'A'); + gpio->ngpio[idx] = NGPIO_DEFAULT; + } + } + + /* irq_chip support */ + raw_spin_lock_init(&gpio->lock); + + gpio->gc.base = -1; + gpio->gc.get_direction = phytium_gpio_get_direction; + gpio->gc.direction_input = phytium_gpio_direction_input; + gpio->gc.direction_output = phytium_gpio_direction_output; + gpio->gc.get = phytium_gpio_get; + gpio->gc.set = phytium_gpio_set; + gpio->gc.ngpio = gpio->ngpio[0] + gpio->ngpio[1]; + gpio->gc.label = dev_name(dev); + gpio->gc.parent = dev; + gpio->gc.owner = THIS_MODULE; + + girq = &gpio->gc.irq; + girq->handler = handle_bad_irq; + girq->default_type = IRQ_TYPE_NONE; + + for (irq_count = 0; irq_count < platform_irq_count(pdev); irq_count++) { + gpio->irq[irq_count] = -ENXIO; + gpio->irq[irq_count] = platform_get_irq(pdev, irq_count); + if (gpio->irq[irq_count] < 0) { + dev_warn(dev, "no irq is found.\n"); + break; + } + }; + + girq->num_parents = irq_count; + girq->parents = gpio->irq; + girq->parent_handler = phytium_gpio_irq_handler; + + gpio_irq_chip_set_chip(girq, &phytium_gpio_irq_chip); + + err = devm_gpiochip_add_data(dev, &gpio->gc, gpio); + if (err) + return err; + + platform_set_drvdata(pdev, gpio); + dev_info(dev, "Phytium GPIO controller @%pa registered\n", + &res->start); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_gpio_suspend(struct device *dev) +{ + struct platform_device *pdev = to_platform_device(dev); + struct phytium_gpio *gpio = platform_get_drvdata(pdev); + unsigned long flags; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + gpio->ctx.swporta_dr = readl(gpio->regs + GPIO_SWPORTA_DR); + gpio->ctx.swporta_ddr = readl(gpio->regs + GPIO_SWPORTA_DDR); + gpio->ctx.ext_porta = readl(gpio->regs + GPIO_EXT_PORTA); + gpio->ctx.swportb_dr = readl(gpio->regs + GPIO_SWPORTB_DR); + gpio->ctx.swportb_ddr = readl(gpio->regs + GPIO_SWPORTB_DDR); + gpio->ctx.ext_portb = readl(gpio->regs + GPIO_EXT_PORTB); + + gpio->ctx.inten = readl(gpio->regs + GPIO_INTEN); + gpio->ctx.intmask = readl(gpio->regs + GPIO_INTMASK); + gpio->ctx.inttype_level = readl(gpio->regs + GPIO_INTTYPE_LEVEL); + gpio->ctx.int_polarity = readl(gpio->regs + GPIO_INT_POLARITY); + gpio->ctx.debounce = readl(gpio->regs + GPIO_DEBOUNCE); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} + +static int phytium_gpio_resume(struct device *dev) +{ + struct platform_device *pdev = to_platform_device(dev); + struct phytium_gpio *gpio = platform_get_drvdata(pdev); + unsigned long flags; + + raw_spin_lock_irqsave(&gpio->lock, flags); + + writel(gpio->ctx.swporta_dr, gpio->regs + GPIO_SWPORTA_DR); + writel(gpio->ctx.swporta_ddr, gpio->regs + GPIO_SWPORTA_DDR); + writel(gpio->ctx.ext_porta, gpio->regs + GPIO_EXT_PORTA); + writel(gpio->ctx.swportb_dr, gpio->regs + GPIO_SWPORTB_DR); + writel(gpio->ctx.swportb_ddr, gpio->regs + GPIO_SWPORTB_DDR); + writel(gpio->ctx.ext_portb, gpio->regs + GPIO_EXT_PORTB); + + writel(gpio->ctx.inten, gpio->regs + GPIO_INTEN); + writel(gpio->ctx.intmask, gpio->regs + GPIO_INTMASK); + writel(gpio->ctx.inttype_level, gpio->regs + GPIO_INTTYPE_LEVEL); + writel(gpio->ctx.int_polarity, gpio->regs + GPIO_INT_POLARITY); + writel(gpio->ctx.debounce, gpio->regs + GPIO_DEBOUNCE); + + writel(0xffffffff, gpio->regs + GPIO_PORTA_EOI); + + raw_spin_unlock_irqrestore(&gpio->lock, flags); + + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_gpio_pm_ops, phytium_gpio_suspend, + phytium_gpio_resume); + +static struct platform_driver phytium_gpio_driver = { + .driver = { + .name = "gpio-phytium-platform", + .pm = &phytium_gpio_pm_ops, + .of_match_table = of_match_ptr(phytium_gpio_of_match), + .acpi_match_table = ACPI_PTR(phytium_gpio_acpi_match), + }, + .probe = phytium_gpio_probe, +}; + +module_platform_driver(phytium_gpio_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium GPIO driver"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-sgpio.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-sgpio.c new file mode 100644 index 0000000000000000000000000000000000000000..c661a86ae2ab319c572fd690ce579bd1bfe7e05b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpio-phytium-sgpio.c @@ -0,0 +1,319 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SGPIO Driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define SGPIO_CTL0_REG 0x00 +#define SGPIO_CTL0_REG_ENABLE BIT(0) +#define SGPIO_CTL0_REG_RX_DISABLE BIT(1) +#define SGPIO_CTL0_REG_L3_L0 GENMASK(11, 8) +#define SGPIO_CTL0_REG_CLK_DIV_NUM GENMASK(31, 12) +#define SGPIO_CTL1_REG 0x04 +#define SGPIO_CTL1_REG_READY BIT(0) +#define SGPIO_CTL1_REG_W_UPDATA BIT(1) +#define SGPIO_CTL1_REG_OP_MODE BIT(2) +#define SGPIO_CTL1_REG_OP_STATE BIT(3) +#define SGPIO_CTL1_REG_BIT_NUM GENMASK(14, 8) +#define SGPIO_CTL1_REG_INTERVAL_TIMER GENMASK(31, 16) +#define SGPIO_SOFT_RESET_REG 0x08 +#define SGPIO_SOFT_RESET_REG_MASK BIT(0) +#define SGPIO_IRQ_REG 0x0c +#define SGPIO_IRQ_REG_MASK BIT(0) +#define SGPIO_IRQ_M_REG 0x10 +#define SGPIO_IRQ_M_REG_MASK BIT(0) +#define SGPIO_WDATA0_REG 0x14 +#define SGPIO_WDATA_REG(x) (SGPIO_WDATA0_REG + (x) * 4) +#define SGPIO_RDATA0_REG 0x24 +#define SGPIO_RDATA_REG(x) (SGPIO_RDATA0_REG + (x) * 4) + +#define DEFAULT_L3_L0 0 +#define DEFAULT_CLK 50000000 + +#define GPIO_GROUP(x) ((x) >> 6) +#define GPIO_OFFSET(x) ((x) & GENMASK(5, 0)) +#define GPIO_BIT(x) BIT(GPIO_OFFSET(x) >> 1) + +struct phytium_sgpio { + struct gpio_chip gc; + void __iomem *regs; + unsigned int ngpios; + struct clk *pclk; + + struct mutex lock; + struct completion completion; +}; + +static bool phytium_sgpio_is_input(unsigned int offset) +{ + return !(offset % 2); +} + +static int sgpio_set_value(struct gpio_chip *gc, unsigned int offset, int val) +{ + struct phytium_sgpio *gpio = gpiochip_get_data(gc); + u32 reg; + int rc = 0; + + if (phytium_sgpio_is_input(offset)) + return -EINVAL; + + reinit_completion(&gpio->completion); + + /* + * Since this is an output, read the cached value from rdata, + * then update value. + */ + reg = readl(gpio->regs + SGPIO_RDATA_REG(GPIO_GROUP(offset))); + if (val) + reg |= GPIO_BIT(offset); + else + reg &= GPIO_BIT(offset); + writel(reg, gpio->regs + SGPIO_WDATA_REG(GPIO_GROUP(offset))); + + /* Start transmission and wait for completion */ + writel(readl(gpio->regs + SGPIO_CTL1_REG) | SGPIO_CTL1_REG_W_UPDATA, + gpio->regs + SGPIO_CTL1_REG); + if (!wait_for_completion_timeout(&gpio->completion, msecs_to_jiffies(1000))) + rc = -EINVAL; + + return rc; +} + +static int phytium_sgpio_direction_input(struct gpio_chip *gc, unsigned int offset) +{ + return phytium_sgpio_is_input(offset) ? 0 : -EINVAL; +} + +static int phytium_sgpio_direction_output(struct gpio_chip *gc, unsigned int offset, int val) +{ + struct phytium_sgpio *gpio = gpiochip_get_data(gc); + int rc; + + mutex_lock(&gpio->lock); + + /* + * No special action is required for setting the direction; we'll + * error-out in sgpio_set_value if this isn't an output GPIO + */ + rc = sgpio_set_value(&gpio->gc, offset, val); + + mutex_unlock(&gpio->lock); + + return rc; +} + +static int phytium_sgpio_get_direction(struct gpio_chip *gc, unsigned int offset) +{ + return !!phytium_sgpio_is_input(offset); +} + +static int phytium_sgpio_get(struct gpio_chip *gc, unsigned int offset) +{ + struct phytium_sgpio *gpio = gpiochip_get_data(gc); + int rc = 0; + u32 val, ctl0; + + mutex_lock(&gpio->lock); + + if (!phytium_sgpio_is_input(offset)) { + val = readl(gpio->regs + SGPIO_WDATA_REG(GPIO_GROUP(offset))); + rc = !!(val & GPIO_BIT(offset)); + mutex_unlock(&gpio->lock); + return rc; + } + + reinit_completion(&gpio->completion); + + /* Enable Rx */ + ctl0 = readl(gpio->regs + SGPIO_CTL0_REG); + writel(ctl0 & ~SGPIO_CTL0_REG_RX_DISABLE, gpio->regs + SGPIO_CTL0_REG); + + /* Start reading transaction and wait for completion */ + writel(readl(gpio->regs + SGPIO_CTL1_REG) | SGPIO_CTL1_REG_W_UPDATA, + gpio->regs + SGPIO_CTL1_REG); + if (!wait_for_completion_timeout(&gpio->completion, msecs_to_jiffies(1000))) { + rc = -EINVAL; + goto err; + } + + val = readl(gpio->regs + SGPIO_RDATA_REG(GPIO_GROUP(offset))); + rc = !!(val & GPIO_BIT(offset)); + +err: + /* Disalbe Rx to hold the value */ + writel(ctl0 | SGPIO_CTL0_REG_RX_DISABLE, gpio->regs + SGPIO_CTL0_REG); + mutex_unlock(&gpio->lock); + + return rc; +} + +static void phytium_sgpio_set(struct gpio_chip *gc, unsigned int offset, int val) +{ + struct phytium_sgpio *gpio = gpiochip_get_data(gc); + + mutex_lock(&gpio->lock); + + sgpio_set_value(gc, offset, val); + + mutex_unlock(&gpio->lock); +} + +static irqreturn_t phytium_sgpio_irq_handler(int irq, void *data) +{ + struct phytium_sgpio *gpio = data; + + if (!readl(gpio->regs + SGPIO_IRQ_REG)) + return IRQ_NONE; + + /* Clear the interrupt */ + writel(0, gpio->regs + SGPIO_IRQ_REG); + + /* Check if tx/rx has been done */ + if (!(readl(gpio->regs + SGPIO_CTL1_REG) & SGPIO_CTL1_REG_OP_STATE)) + complete(&gpio->completion); + + return IRQ_HANDLED; +} + +static int phytium_sgpio_probe(struct platform_device *pdev) +{ + u32 pclk_freq, sclk_freq, clk_div; + struct phytium_sgpio *gpio; + struct resource *res; + struct device *dev = &pdev->dev; + int rc; + + gpio = devm_kzalloc(dev, sizeof(*gpio), GFP_KERNEL); + if (!gpio) + return -ENOMEM; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + gpio->regs = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(gpio->regs)) + return PTR_ERR(gpio->regs); + + if (devm_request_irq(dev, platform_get_irq(pdev, 0), + phytium_sgpio_irq_handler, + IRQF_SHARED, dev_name(dev), gpio)) { + dev_err(dev, "failed to request IRQ\n"); + return -ENOENT; + } + + rc = fwnode_property_read_u32(dev_fwnode(dev), "ngpios", &gpio->ngpios); + if (rc < 0) { + dev_err(dev, "Could not read ngpios property\n"); + return -EINVAL; + } else if (gpio->ngpios % 32) { + dev_err(&pdev->dev, "Number of GPIOs not multiple of 32: %d\n", + gpio->ngpios); + return -EINVAL; + } + + rc = fwnode_property_read_u32(dev_fwnode(dev), "bus-frequency", &sclk_freq); + if (rc < 0) { + dev_err(dev, "Could not read bus-frequency property\n"); + return -EINVAL; + } + + if (has_acpi_companion(dev)) { + device_property_read_u32(dev, "pclk_freq", &pclk_freq); + if (!pclk_freq || (pclk_freq != 50000000)) { + dev_err(dev, "Could not get APB clock property from acpi, use default clk!\n"); + pclk_freq = DEFAULT_CLK; + } + + } else { + gpio->pclk = devm_clk_get(dev, NULL); + if (IS_ERR(gpio->pclk)) { + dev_err(dev, "Could not get the APB clock property\n"); + return PTR_ERR(gpio->pclk); + } + rc = clk_prepare_enable(gpio->pclk); + if (rc) { + dev_err(dev, "failed to enable pclk: %d\n", rc); + return rc; + } + pclk_freq = clk_get_rate(gpio->pclk); + } + + /* + * From the datasheet: + * (pclk / 2) / (clk_div + 1) = sclk + */ + if (sclk_freq == 0) { + dev_err(dev, "SCLK should not be 0\n"); + return -EINVAL; + } + + clk_div = (pclk_freq / (sclk_freq * 2)) - 1; + if (clk_div > (1 << 20) - 1) { + dev_err(dev, "clk_div is overflow\n"); + return -EINVAL; + } + + writel(FIELD_PREP(SGPIO_CTL0_REG_CLK_DIV_NUM, clk_div) | + FIELD_PREP(SGPIO_CTL0_REG_L3_L0, DEFAULT_L3_L0) | + SGPIO_CTL0_REG_RX_DISABLE | SGPIO_CTL0_REG_ENABLE, + gpio->regs + SGPIO_CTL0_REG); + + writel(FIELD_PREP(SGPIO_CTL1_REG_BIT_NUM, gpio->ngpios) | + SGPIO_CTL1_REG_READY, gpio->regs + SGPIO_CTL1_REG); + + mutex_init(&gpio->lock); + init_completion(&gpio->completion); + platform_set_drvdata(pdev, gpio); + + gpio->gc.parent = dev; + gpio->gc.base = -1; + gpio->gc.ngpio = gpio->ngpios * 2; + gpio->gc.label = dev_name(dev); + gpio->gc.direction_input = phytium_sgpio_direction_input; + gpio->gc.direction_output = phytium_sgpio_direction_output; + gpio->gc.get_direction = phytium_sgpio_get_direction; + gpio->gc.get = phytium_sgpio_get; + gpio->gc.set = phytium_sgpio_set; + + return devm_gpiochip_add_data(dev, &gpio->gc, gpio); +} + +static const struct of_device_id phytium_sgpio_of_match[] = { + { .compatible = "phytium,sgpio", }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_sgpio_of_match); + +static const struct acpi_device_id phytium_sgpio_acpi_match[] = { + { "PHYT0031", 0}, + {}, +}; +MODULE_DEVICE_TABLE(acpi, phytium_sgpio_acpi_match); + +static struct platform_driver phytium_sgpio_driver = { + .driver = { + .name = KBUILD_MODNAME, + .of_match_table = of_match_ptr(phytium_sgpio_of_match), + .acpi_match_table = ACPI_PTR(phytium_sgpio_acpi_match), + }, + .probe = phytium_sgpio_probe, +}; +module_platform_driver(phytium_sgpio_driver); + +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium SGPIO driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpiolib.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpiolib.h new file mode 100644 index 0000000000000000000000000000000000000000..b674b5bb980e28bd80aeffd8789a5f4d93997bf8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpio/gpiolib.h @@ -0,0 +1,184 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Internal GPIO functions. + * + * Copyright (C) 2013, Intel Corporation + * Author: Mika Westerberg + */ + +#ifndef GPIOLIB_H +#define GPIOLIB_H + +#include +#include /* for enum gpiod_flags */ +#include +#include +#include +#include + +#define GPIOCHIP_NAME "gpiochip" + +/** + * struct gpio_device - internal state container for GPIO devices + * @id: numerical ID number for the GPIO chip + * @dev: the GPIO device struct + * @chrdev: character device for the GPIO device + * @mockdev: class device used by the deprecated sysfs interface (may be + * NULL) + * @owner: helps prevent removal of modules exporting active GPIOs + * @chip: pointer to the corresponding gpiochip, holding static + * data for this device + * @descs: array of ngpio descriptors. + * @ngpio: the number of GPIO lines on this GPIO device, equal to the size + * of the @descs array. + * @base: GPIO base in the DEPRECATED global Linux GPIO numberspace, assigned + * at device creation time. + * @label: a descriptive name for the GPIO device, such as the part number + * or name of the IP component in a System on Chip. + * @data: per-instance data assigned by the driver + * @list: links gpio_device:s together for traversal + * + * This state container holds most of the runtime variable data + * for a GPIO device and can hold references and live on after the + * GPIO chip has been removed, if it is still being used from + * userspace. + */ +struct gpio_device { + int id; + struct device dev; + struct cdev chrdev; + struct device *mockdev; + struct module *owner; + struct gpio_chip *chip; + struct gpio_desc *descs; + int base; + u16 ngpio; + const char *label; + void *data; + struct list_head list; + struct blocking_notifier_head notifier; + +#ifdef CONFIG_PINCTRL + /* + * If CONFIG_PINCTRL is enabled, then gpio controllers can optionally + * describe the actual pin range which they serve in an SoC. This + * information would be used by pinctrl subsystem to configure + * corresponding pins for gpio usage. + */ + struct list_head pin_ranges; +#endif +}; + +/* gpio suffixes used for ACPI and device tree lookup */ +static __maybe_unused const char * const gpio_suffixes[] = { "gpios", "gpio" }; + +struct gpio_array { + struct gpio_desc **desc; + unsigned int size; + struct gpio_chip *chip; + unsigned long *get_mask; + unsigned long *set_mask; + unsigned long invert_mask[]; +}; + +struct gpio_desc *gpiochip_get_desc(struct gpio_chip *gc, unsigned int hwnum); +int gpiod_get_array_value_complex(bool raw, bool can_sleep, + unsigned int array_size, + struct gpio_desc **desc_array, + struct gpio_array *array_info, + unsigned long *value_bitmap); +int gpiod_set_array_value_complex(bool raw, bool can_sleep, + unsigned int array_size, + struct gpio_desc **desc_array, + struct gpio_array *array_info, + unsigned long *value_bitmap); + +extern spinlock_t gpio_lock; +extern struct list_head gpio_devices; + +struct gpio_desc { + struct gpio_device *gdev; + unsigned long flags; +/* flag symbols are bit numbers */ +#define FLAG_REQUESTED 0 +#define FLAG_IS_OUT 1 +#define FLAG_EXPORT 2 /* protected by sysfs_lock */ +#define FLAG_SYSFS 3 /* exported via /sys/class/gpio/control */ +#define FLAG_ACTIVE_LOW 6 /* value has active low */ +#define FLAG_OPEN_DRAIN 7 /* Gpio is open drain type */ +#define FLAG_OPEN_SOURCE 8 /* Gpio is open source type */ +#define FLAG_USED_AS_IRQ 9 /* GPIO is connected to an IRQ */ +#define FLAG_IRQ_IS_ENABLED 10 /* GPIO is connected to an enabled IRQ */ +#define FLAG_IS_HOGGED 11 /* GPIO is hogged */ +#define FLAG_TRANSITORY 12 /* GPIO may lose value in sleep or reset */ +#define FLAG_PULL_UP 13 /* GPIO has pull up enabled */ +#define FLAG_PULL_DOWN 14 /* GPIO has pull down enabled */ +#define FLAG_BIAS_DISABLE 15 /* GPIO has pull disabled */ +#define FLAG_EDGE_RISING 16 /* GPIO CDEV detects rising edge events */ +#define FLAG_EDGE_FALLING 17 /* GPIO CDEV detects falling edge events */ + + /* Connection label */ + const char *label; + /* Name of the GPIO */ + const char *name; +#ifdef CONFIG_OF_DYNAMIC + struct device_node *hog; +#endif +#ifdef CONFIG_GPIO_CDEV + /* debounce period in microseconds */ + unsigned int debounce_period_us; +#endif +}; + +int gpiod_request(struct gpio_desc *desc, const char *label); +void gpiod_free(struct gpio_desc *desc); +int gpiod_configure_flags(struct gpio_desc *desc, const char *con_id, + unsigned long lflags, enum gpiod_flags dflags); +int gpiod_hog(struct gpio_desc *desc, const char *name, + unsigned long lflags, enum gpiod_flags dflags); + +/* + * Return the GPIO number of the passed descriptor relative to its chip + */ +static inline int gpio_chip_hwgpio(const struct gpio_desc *desc) +{ + return desc - &desc->gdev->descs[0]; +} + +/* With descriptor prefix */ + +#define gpiod_emerg(desc, fmt, ...) \ + pr_emerg("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?",\ + ##__VA_ARGS__) +#define gpiod_crit(desc, fmt, ...) \ + pr_crit("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?", \ + ##__VA_ARGS__) +#define gpiod_err(desc, fmt, ...) \ + pr_err("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?", \ + ##__VA_ARGS__) +#define gpiod_warn(desc, fmt, ...) \ + pr_warn("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?", \ + ##__VA_ARGS__) +#define gpiod_info(desc, fmt, ...) \ + pr_info("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?", \ + ##__VA_ARGS__) +#define gpiod_dbg(desc, fmt, ...) \ + pr_debug("gpio-%d (%s): " fmt, desc_to_gpio(desc), desc->label ? : "?",\ + ##__VA_ARGS__) + +/* With chip prefix */ + +#define chip_emerg(gc, fmt, ...) \ + dev_emerg(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) +#define chip_crit(gc, fmt, ...) \ + dev_crit(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) +#define chip_err(gc, fmt, ...) \ + dev_err(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) +#define chip_warn(gc, fmt, ...) \ + dev_warn(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) +#define chip_info(gc, fmt, ...) \ + dev_info(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) +#define chip_dbg(gc, fmt, ...) \ + dev_dbg(&gc->gpiodev->dev, "(%s): " fmt, gc->label, ##__VA_ARGS__) + +#endif /* GPIOLIB_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..d837591461005723d760e7d32b93999edd5b3637 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/Kconfig @@ -0,0 +1,12 @@ +config DRM_PHYTIUM + tristate "DRM Support for Phytium Graphics Card" + depends on DRM + select FB_IOMEM_HELPERS + select DRM_KMS_HELPER + select DRM_DISPLAY_HELPER + select DRM_DISPLAY_DP_HELPER + select DRM_DISPLAY_HDCP_HELPER + select BACKLIGHT_CLASS_DEVICE + help + Choose this option if you have a phytium graphics card. + This driver provides kernel mode setting and buffer management to userspace. diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..2dc7ea1118cd4cbf141215a7f377e258ae2593ba --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/Makefile @@ -0,0 +1,18 @@ +phytium-dc-drm-y := phytium_display_drv.o \ + phytium_plane.o \ + phytium_crtc.o \ + phytium_dp.o \ + phytium_fb.o \ + phytium_gem.o \ + phytium_fbdev.o \ + phytium_debugfs.o \ + px210_dp.o \ + phytium_panel.o \ + px210_dc.o \ + phytium_pci.o \ + pe220x_dp.o \ + pe220x_dc.o \ + phytium_platform.o + +obj-$(CONFIG_DRM_PHYTIUM) += phytium-dc-drm.o +CFLAGS_REMOVE_phytium_crtc.o += -mgeneral-regs-only diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dc.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dc.c new file mode 100644 index 0000000000000000000000000000000000000000..b465dbb615f16fe947564316141186cc0fe4e100 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dc.c @@ -0,0 +1,255 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium Pe220x display controller DRM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "pe220x_reg.h" +#include "phytium_crtc.h" +#include "phytium_plane.h" +#include "phytium_fb.h" +#include "phytium_gem.h" + +void pe220x_dc_hw_disable(struct drm_crtc *crtc); + +static const unsigned int pe220x_primary_formats[] = { + DRM_FORMAT_ARGB2101010, + DRM_FORMAT_ABGR2101010, + DRM_FORMAT_RGBA1010102, + DRM_FORMAT_BGRA1010102, + DRM_FORMAT_ARGB8888, + DRM_FORMAT_ABGR8888, + DRM_FORMAT_RGBA8888, + DRM_FORMAT_BGRA8888, + DRM_FORMAT_XRGB8888, + DRM_FORMAT_XBGR8888, + DRM_FORMAT_RGBX8888, + DRM_FORMAT_BGRX8888, + DRM_FORMAT_ARGB4444, + DRM_FORMAT_ABGR4444, + DRM_FORMAT_RGBA4444, + DRM_FORMAT_BGRA4444, + DRM_FORMAT_XRGB4444, + DRM_FORMAT_XBGR4444, + DRM_FORMAT_RGBX4444, + DRM_FORMAT_BGRX4444, + DRM_FORMAT_ARGB1555, + DRM_FORMAT_ABGR1555, + DRM_FORMAT_RGBA5551, + DRM_FORMAT_BGRA5551, + DRM_FORMAT_XRGB1555, + DRM_FORMAT_XBGR1555, + DRM_FORMAT_RGBX5551, + DRM_FORMAT_BGRX5551, + DRM_FORMAT_RGB565, + DRM_FORMAT_BGR565, + DRM_FORMAT_YUYV, + DRM_FORMAT_UYVY, + DRM_FORMAT_NV16, + DRM_FORMAT_NV12, + DRM_FORMAT_NV21, +}; + +static uint64_t pe220x_primary_formats_modifiers[] = { + DRM_FORMAT_MOD_LINEAR, + DRM_FORMAT_MOD_INVALID +}; + +static uint64_t pe220x_cursor_formats_modifiers[] = { + DRM_FORMAT_MOD_LINEAR, + DRM_FORMAT_MOD_INVALID +}; + +static const unsigned int pe220x_cursor_formats[] = { + DRM_FORMAT_ARGB8888, +}; + +void pe220x_dc_hw_vram_init(struct phytium_display_private *priv, resource_size_t vram_addr, + resource_size_t vram_size) +{ + uint32_t config; + uint32_t group_offset = priv->address_transform_base; + + phytium_writel_reg(priv, (vram_addr & SRC_ADDR_MASK) >> SRC_ADDR_OFFSET, + group_offset, PE220X_DC_ADDRESS_TRANSFORM_SRC_ADDR); + phytium_writel_reg(priv, (vram_size >> SIZE_OFFSET) | ADDRESS_TRANSFORM_ENABLE, + group_offset, PE220X_DC_ADDRESS_TRANSFORM_SIZE); + config = phytium_readl_reg(priv, group_offset, PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR); + phytium_writel_reg(priv, config, group_offset, PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR); +} + +void pe220x_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + int ret = 0; + + /* config pix clock */ + phytium_writel_reg(priv, FLAG_REQUEST | CMD_PIXEL_CLOCK | (clock & PIXEL_CLOCK_MASK), + 0, PE220X_DC_CMD_REGISTER(phys_pipe)); + ret = phytium_wait_cmd_done(priv, PE220X_DC_CMD_REGISTER(phys_pipe), + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to set pixel clock\n", __func__); +} + +void pe220x_dc_hw_reset(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int config = 0; + int phys_pipe = phytium_crtc->phys_pipe; + + /* disable pixel clock for bmc mode */ + if (phys_pipe == 0) + pe220x_dc_hw_disable(crtc); + + config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); + config &= (~(DC0_CORE_RESET | DC1_CORE_RESET | AXI_RESET | AHB_RESET)); + + if (phys_pipe == 0) { + phytium_writel_reg(priv, config | DC0_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET | AHB_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC0_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + } else { + phytium_writel_reg(priv, config | DC1_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET | AHB_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config | DC1_CORE_RESET, + 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + } +} + +void pe220x_dc_hw_disable(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int config = 0; + int phys_pipe = phytium_crtc->phys_pipe; + + /* clear framebuffer */ + phytium_writel_reg(priv, CLEAR_VALUE_BLACK, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE); + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); + config |= FRAMEBUFFER_CLEAR; + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); + + /* disable cursor */ + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); + config = ((config & (~CURSOR_FORMAT_MASK)) | CURSOR_FORMAT_DISABLED); + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); + mdelay(20); + + /* reset pix clock */ + pe220x_dc_hw_config_pix_clock(crtc, 0); + + if (phys_pipe == 0) { + config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, config | DC0_CORE_RESET, 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config & (~DC0_CORE_RESET), 0, PE220X_DC_CLOCK_CONTROL); + } else { + config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, config | DC1_CORE_RESET, 0, PE220X_DC_CLOCK_CONTROL); + udelay(20); + phytium_writel_reg(priv, config & (~DC1_CORE_RESET), 0, PE220X_DC_CLOCK_CONTROL); + } + udelay(20); +} + +int pe220x_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count) +{ + int ret = 0; + + if (mode_cmd->modifier[count] != DRM_FORMAT_MOD_LINEAR) { + DRM_ERROR("unsupported fb modifier 0x%llx\n", mode_cmd->modifier[count]); + ret = -EINVAL; + } + + return ret; +} + +void pe220x_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count) +{ + *format_modifiers = pe220x_primary_formats_modifiers; + *formats = pe220x_primary_formats; + *format_count = ARRAY_SIZE(pe220x_primary_formats); +} + +void pe220x_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count) +{ + *format_modifiers = pe220x_cursor_formats_modifiers; + *formats = pe220x_cursor_formats; + *format_count = ARRAY_SIZE(pe220x_cursor_formats); +} + +void pe220x_dc_hw_update_primary_hi_addr(struct drm_plane *plane) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + int phys_pipe = phytium_plane->phys_pipe; + + phytium_writel_reg(priv, (phytium_plane->iova[0] >> PREFIX_SHIFT) & PREFIX_MASK, + priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_Y_HI_ADDRESS); + + phytium_writel_reg(priv, (phytium_plane->iova[1] >> U_PREFIX_SHIFT) & U_PREFIX_MASK, + priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_U_HI_ADDRESS); + + phytium_writel_reg(priv, (phytium_plane->iova[2] >> V_PREFIX_SHIFT) & V_PREFIX_MASK, + priv->dc_reg_base[phys_pipe], PE220X_DC_FRAMEBUFFER_V_HI_ADDRESS); +} + +void pe220x_dc_hw_update_cursor_hi_addr(struct drm_plane *plane, uint64_t iova) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + int phys_pipe = phytium_plane->phys_pipe; + int config; + + config = ((iova >> CURSOR_PREFIX_SHIFT) & CURSOR_PREFIX_MASK); + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PE220X_DC_CURSOR_HI_ADDRESS); +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dc.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dc.h new file mode 100644 index 0000000000000000000000000000000000000000..5840795cbae61fa97140e5167d2bda960a5fdc65 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dc.h @@ -0,0 +1,31 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium Pe220x display controller DRM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PE220X_DC_H__ +#define __PE220X_DC_H__ + +#define PE220X_DC_PIX_CLOCK_MAX (594000) +#define PE220X_DC_HDISPLAY_MAX 3840 +#define PE220X_DC_VDISPLAY_MAX 2160 +#define PE220X_DC_ADDRESS_MASK 0x7f + +extern void pe220x_dc_hw_vram_init(struct phytium_display_private *priv, + resource_size_t vram_addr, + resource_size_t vram_size); +extern void pe220x_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock); +extern void pe220x_dc_hw_disable(struct drm_crtc *crtc); +extern int pe220x_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count); +extern void pe220x_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); +extern void pe220x_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); +extern void pe220x_dc_hw_update_primary_hi_addr(struct drm_plane *plane); +extern void pe220x_dc_hw_update_cursor_hi_addr(struct drm_plane *plane, uint64_t iova); +void pe220x_dc_hw_reset(struct drm_crtc *crtc); +#endif /* __PE220X_DC_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dp.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dp.c new file mode 100644 index 0000000000000000000000000000000000000000..b56484361084d2a5f70a8ab4e71f5586333b291e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dp.c @@ -0,0 +1,508 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium display port DRM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include "phytium_display_drv.h" +#include "pe220x_reg.h" +#include "phytium_dp.h" +#include "pe220x_dp.h" + +static uint8_t pe220x_dp_source_lane_count[2] = {1, 1}; + +/* [reg][ling_rate 1.62->8.1] */ +static int vco_val[12][4] = { + {0x0509, 0x0509, 0x0509, 0x0509}, /* CP_PADJ */ + {0x0f00, 0x0f00, 0x0f00, 0x0f00}, /* CP_IADJ */ + {0x0F08, 0x0F08, 0x0F08, 0x0F08}, /* FILT_PADJ */ + {0x0061, 0x006C, 0x006C, 0x0051}, /* INTDIV */ + {0x3333, 0x0000, 0x0000, 0x0000}, /* FRACDIVL */ + {0x0000, 0x0000, 0x0000, 0x0000}, /* FRACDIVH */ + {0x0042, 0x0048, 0x0048, 0x0036}, /* HIGH_THR */ + {0x0002, 0x0002, 0x0002, 0x0002}, /* PDIAG_CTRL */ + {0x0c5e, 0x0c5e, 0x0c5e, 0x0c5e}, /* VCOCAL_PLLCNT_START */ + {0x00c7, 0x00c7, 0x00c7, 0x00c7}, /* LOCK_PEFCNT */ + {0x00c7, 0x00c7, 0x00c7, 0x00c7}, /* LOCK_PLLCNT_START */ + {0x0005, 0x0005, 0x0005, 0x0005}, /* LOCK_PLLCNT_THR */ +}; + +/* [link_rate][swing][emphasis] */ +static int mgnfs_val[4][4][4] = { + /* 1.62Gbps */ + { + {0x0026, 0x001f, 0x0012, 0x0000}, + {0x0013, 0x0013, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 2.7Gbps */ + { + {0x0026, 0x001f, 0x0012, 0x0000}, + {0x0013, 0x0013, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 5.4Gbps */ + { + {0x001f, 0x0013, 0x005, 0x0000}, + {0x0018, 0x006, 0x0000, 0x0000}, + {0x000c, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 8.1Gbps */ + { + {0x0026, 0x0013, 0x005, 0x0000}, + {0x0013, 0x006, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, +}; + +/* [link_rate][swing][emphasis] */ +static int cpost_val[4][4][4] = { + /* 1.62Gbps */ + { + {0x0000, 0x0014, 0x0020, 0x002a}, + {0x0000, 0x0010, 0x001f, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 2.7Gbps */ + { + {0x0000, 0x0014, 0x0020, 0x002a}, + {0x0000, 0x0010, 0x001f, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 5.4Gbps */ + { + {0x0005, 0x0014, 0x0022, 0x002e}, + {0x0000, 0x0013, 0x0020, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + /* 8.1Gbps */ + { + {0x0000, 0x0014, 0x0022, 0x002e}, + {0x0000, 0x0013, 0x0020, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, +}; + +static int pe220x_dp_hw_set_phy_lane_and_rate(struct phytium_dp_device *phytium_dp, + uint8_t link_lane_count, uint32_t link_rate) +{ + int port = phytium_dp->port%2; + int i = 0, data, tmp, tmp1, index = 0, mask = 0; + int timeout = 500, ret = 0; + + /* set pma powerdown */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (A3_POWERDOWN3 << (i * A3_POWERDOWN3_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); + + /* lane pll disable */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) { + data |= (PLL_EN << (i * PLL_EN_SHIFT)); + mask |= (((1<source_max_lane_count; i++) + data |= (PLL_EN << (i * PLL_EN_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_EN(port), data); + + /* set pma power active */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (A0_ACTIVE << (i * A0_ACTIVE_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); + + mask = PLL0_LOCK_DONE; + do { + mdelay(1); + timeout--; + tmp = phytium_phy_readl(phytium_dp, PE220X_PHY_PMA_CONTROL2(port)); + } while ((!(tmp & mask)) && timeout); + + if (timeout == 0) { + DRM_ERROR("dp(%d) phy pll lock failed\n", port); + ret = -1; + } + udelay(1); + + return ret; +} + +static void pe220x_dp_hw_set_phy_lane_setting(struct phytium_dp_device *phytium_dp, + uint32_t link_rate, uint8_t train_set) +{ + int port = phytium_dp->port % 3; + int voltage_swing = 0; + int pre_emphasis = 0, link_rate_index = 0; + + switch (train_set & DP_TRAIN_VOLTAGE_SWING_MASK) { + case DP_TRAIN_VOLTAGE_SWING_LEVEL_1: + voltage_swing = 1; + break; + case DP_TRAIN_VOLTAGE_SWING_LEVEL_2: + voltage_swing = 2; + break; + case DP_TRAIN_VOLTAGE_SWING_LEVEL_3: + voltage_swing = 3; + break; + default: + voltage_swing = 0; + break; + } + + switch (train_set & DP_TRAIN_PRE_EMPHASIS_MASK) { + case DP_TRAIN_PRE_EMPH_LEVEL_1: + pre_emphasis = 1; + break; + case DP_TRAIN_PRE_EMPH_LEVEL_2: + pre_emphasis = 2; + break; + case DP_TRAIN_PRE_EMPH_LEVEL_3: + pre_emphasis = 3; + break; + default: + pre_emphasis = 0; + break; + } + + switch (link_rate) { + case 810000: + link_rate_index = 3; + break; + case 540000: + link_rate_index = 2; + break; + case 270000: + link_rate_index = 1; + break; + case 162000: + link_rate_index = 0; + break; + default: + DRM_ERROR("phytium dp rate(%d) not support\n", link_rate); + link_rate_index = 2; + break; + } + + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DIAG_ACYA(port), LOCK); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_TXCC_CTRL(port), TX_TXCC_CTRL); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DRV(port), TX_DRV); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_MGNFS(port), + mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_CPOST(port), + cpost_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL0_TX_DIAG_ACYA(port), UNLOCK); +} + +static int pe220x_dp_hw_init_phy(struct phytium_dp_device *phytium_dp) +{ + int port = phytium_dp->port; + int i = 0, data, tmp, mask; + int timeout = 500, ret = 0; + + phytium_phy_writel(phytium_dp, PE220X_PHY_APB_RESET(port), APB_RESET); + phytium_phy_writel(phytium_dp, PE220X_PHY_PIPE_RESET(port), RESET); + + /* config lane to dp mode */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (LANE_BIT << (i * LANE_BIT_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_MODE(port), data); + + /* pll clock enable */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (PLL_EN << (i * PLL_EN_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_EN(port), data); + + /* config input 20 bit */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (BIT_20 << (i * BIT_20_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PMA_WIDTH(port), data); + + /* config lane active power state */ + data = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) + data |= (A0_ACTIVE << (i * A0_ACTIVE_SHIFT)); + phytium_phy_writel(phytium_dp, PE220X_PHY_PMA0_POWER(port), data); + + /* link reset */ + phytium_phy_writel(phytium_dp, PE220X_PHY_LINK_RESET(port), LINK_RESET); + + phytium_phy_writel(phytium_dp, PE220X_PHY_SGMII_DPSEL_INIT(port), DP_SEL); + + /* config single link */ + phytium_phy_writel(phytium_dp, PE220X_PHY_PLL_CFG(port), SINGLE_LINK); + + /* pipe reset */ + phytium_phy_writel(phytium_dp, PE220X_PHY_PIPE_RESET(port), RESET_DEASSERT); + + mask = PLL0_LOCK_DONE; + do { + mdelay(1); + timeout--; + tmp = phytium_phy_readl(phytium_dp, PE220X_PHY_PMA_CONTROL2(port)); + } while ((!(tmp & mask)) && timeout); + + if (timeout == 0) { + DRM_ERROR("reset dp(%d) phy failed\n", port); + ret = -1; + } + udelay(1); + + return ret; +} + +static void pe220x_dp_hw_poweron_panel(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int ret = 0; + + gpiod_set_value(priv->edp_power_en, 1); + if (ret < 0) + DRM_ERROR("%s: failed to poweron panel\n", __func__); +} + +static void pe220x_dp_hw_poweroff_panel(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int ret = 0; + + gpiod_set_value(priv->edp_power_en, 0); + if (ret < 0) + DRM_ERROR("%s: failed to poweroff panel\n", __func__); +} + +static void pe220x_dp_hw_enable_backlight(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + struct pwm_state state; + int ret = 0; + + pwm_get_state(phytium_dp->pwm, &state); + state.enabled = true; + pwm_set_relative_duty_cycle(&state, 50, 100); + ret = pwm_apply_state(phytium_dp->pwm, &state); + + gpiod_set_value(priv->edp_bl_en, 1); + if (ret < 0) + DRM_ERROR("%s: failed to enable backlight\n", __func__); +} + +static void pe220x_dp_hw_disable_backlight(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int ret = 0; + + gpiod_set_value(priv->edp_bl_en, 0); + if (ret < 0) + DRM_ERROR("%s: failed to disable backlight, ret = %d\n", __func__, ret); +} + +static uint32_t pe220x_dp_hw_get_backlight(struct phytium_dp_device *phytium_dp) +{ + struct pwm_state state; + uint32_t level; + + pwm_get_state(phytium_dp->pwm, &state); + level = pwm_get_relative_duty_cycle(&state, 100); + return level; +} + +static int pe220x_dp_hw_set_backlight(struct phytium_dp_device *phytium_dp, uint32_t level) +{ + struct pwm_state state; + int ret = 0; + + if (level > PE220X_DP_BACKLIGHT_MAX) { + ret = -EINVAL; + goto out; + } + pwm_get_state(phytium_dp->pwm, &state); + state.enabled = true; + state.period = phytium_dp->pwm->args.period; + if (state.period == 0) + DRM_ERROR("%s: set pwm period to 0\n", __func__); + + pwm_set_relative_duty_cycle(&state, level, 100); + + ret = pwm_apply_state(phytium_dp->pwm, &state); + if (ret < 0) + DRM_ERROR("%s: failed to set backlight\n", __func__); +out: + return ret; +} + +bool pe220x_dp_hw_spread_is_enable(struct phytium_dp_device *phytium_dp) +{ + return false; +} + +int pe220x_dp_hw_reset(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, DP_RESET, group_offset, PE220X_DP_CONTROLLER_RESET); + udelay(500); + phytium_writel_reg(priv, AUX_CLK_DIVIDER_100, group_offset, PHYTIUM_DP_AUX_CLK_DIVIDER); + phytium_writel_reg(priv, SUPPORT_EDP_1_4, group_offset, PHYTIUM_EDP_CRC_ENABLE); + + return 0; +} + +uint8_t pe220x_dp_hw_get_source_lane_count(struct phytium_dp_device *phytium_dp) +{ + return pe220x_dp_source_lane_count[phytium_dp->port]; +} + +static struct phytium_dp_func pe220x_dp_funcs = { + .dp_hw_get_source_lane_count = pe220x_dp_hw_get_source_lane_count, + .dp_hw_reset = pe220x_dp_hw_reset, + .dp_hw_spread_is_enable = pe220x_dp_hw_spread_is_enable, + .dp_hw_set_backlight = pe220x_dp_hw_set_backlight, + .dp_hw_get_backlight = pe220x_dp_hw_get_backlight, + .dp_hw_disable_backlight = pe220x_dp_hw_disable_backlight, + .dp_hw_enable_backlight = pe220x_dp_hw_enable_backlight, + .dp_hw_poweroff_panel = pe220x_dp_hw_poweroff_panel, + .dp_hw_poweron_panel = pe220x_dp_hw_poweron_panel, + .dp_hw_init_phy = pe220x_dp_hw_init_phy, + .dp_hw_set_phy_lane_setting = pe220x_dp_hw_set_phy_lane_setting, + .dp_hw_set_phy_lane_and_rate = pe220x_dp_hw_set_phy_lane_and_rate, +}; + +void pe220x_dp_func_register(struct phytium_dp_device *phytium_dp) +{ + phytium_dp->funcs = &pe220x_dp_funcs; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dp.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dp.h new file mode 100644 index 0000000000000000000000000000000000000000..f9cf8a0d4f51d3fa5c589c3ac36f4a8f1751db65 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_dp.h @@ -0,0 +1,15 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium display port DRM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PE220X_DP_H__ +#define __PE220X_DP_H__ + +#define PE220X_DP_BACKLIGHT_MAX 99 +#define PE220X_DP_BACKLIGHT_MIN 2 + +void pe220x_dp_func_register(struct phytium_dp_device *phytium_dp); +#endif /* __PE220X_DP_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_reg.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_reg.h new file mode 100644 index 0000000000000000000000000000000000000000..696be3006734fb5633558e9dde25c78ffdcdfeb0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/pe220x_reg.h @@ -0,0 +1,209 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium Pe220x display engine register + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PE220X_REG_H__ +#define __PE220X_REG_H__ + +#include "phytium_reg.h" + +/* dc register */ +#define PE220X_DC_CLOCK_CONTROL 0x0000 +#define DC1_CORE_RESET (1<<18) +#define DC0_CORE_RESET (1<<17) +#define AXI_RESET (1<<16) +#define AHB_RESET (1<<12) + +#define PE220X_DC_CMD_REGISTER(pipe) (PE220X_DC_BASE(0) + 0x00F0 + 0x4*(pipe)) +#define FLAG_REPLY (1<<31) +#define FLAG_REQUEST (1<<30) +#define CMD_PIXEL_CLOCK (0x0 << 28) +#define CMD_BACKLIGHT (0x1 << 28) +#define CMD_DC_DP_RESET (0x3 << 28) +#define BACKLIGHT_SHIFT 21 +#define BACKLIGHT_MASK 0x7f +#define BACKLIGHT_MAX 100 +#define BACKLIGHT_ENABLE (101 << BACKLIGHT_SHIFT) +#define BACKLIGHT_DISABLE (102 << BACKLIGHT_SHIFT) +#define PANEL_POWER_ENABLE (103 << BACKLIGHT_SHIFT) +#define PANEL_POWER_DISABLE (104 << BACKLIGHT_SHIFT) +#define PIXEL_CLOCK_MASK (0x1fffff) + +#define PE220X_DC_FRAMEBUFFER_Y_HI_ADDRESS 0x1404 +#define PREFIX_MASK 0xff +#define PREFIX_SHIFT 32 + +#define PE220X_DC_CURSOR_HI_ADDRESS 0x1490 +#define CURSOR_PREFIX_MASK 0xff +#define CURSOR_PREFIX_SHIFT 32 + +#define PE220X_DC_FRAMEBUFFER_U_HI_ADDRESS 0x1534 +#define U_PREFIX_MASK 0xff +#define U_PREFIX_SHIFT 32 + +#define PE220X_DC_FRAMEBUFFER_V_HI_ADDRESS 0x153c +#define V_PREFIX_MASK 0xff +#define V_PREFIX_SHIFT 32 + +/* dp register */ +#define PE220X_DP_CONTROLLER_RESET 0x0850 +#define DP_RESET 0x1 + +/* address transform register */ +#define PE220X_DC_ADDRESS_TRANSFORM_SRC_ADDR 0x0 +#define SRC_ADDR_OFFSET 22 +#define SRC_ADDR_MASK 0xffffffffff + +#define PE220X_DC_ADDRESS_TRANSFORM_SIZE 0x4 +#define ADDRESS_TRANSFORM_ENABLE (0x1 << 31) +#define SIZE_OFFSET 22 + +#define PE220X_DC_ADDRESS_TRANSFORM_DST_ADDR 0x8 +#define DST_ADDR_OFFSET 22 + +#define PE220X_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS 0x48 +#define DC_DP_RESET_STATUS(pipe) (1 << pipe) +#define DP_SPREAD_ENABLE(pipe) (0x8 << pipe) + +#define PE220X_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE 0x4c +#define BACKLIGHT_VALUE_MASK (0x7f) +#define BACKLIGHT_VALUE_SHIFT 16 + +/* phy register start */ +#define PE220X_PHY_BASE(pipe) (0x100000*pipe) + +#define PE220X_PHY_PIPE_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40254) +#define RESET 0x0 +#define RESET_DEASSERT 0x1 + +#define PE220X_PHY_MODE(pipe) (PE220X_PHY_BASE(pipe) + 0x40034) +#define LANE_BIT (0x3) +#define LANE_BIT_SHIFT 0x2 + +#define PE220X_PHY_LINK_CFG(pipe) (PE220X_PHY_BASE(pipe) + 0x40044) +#define LANE_MASTER 0x1 +#define LANE_MASTER_SHIFT 1 + +#define PE220X_PHY_PLL_EN(pipe) (PE220X_PHY_BASE(pipe) + 0x40214) +#define PLL_EN 0x1 +#define PLL_EN_SHIFT 1 + +#define PE220X_PHY_PMA_WIDTH(pipe) (PE220X_PHY_BASE(pipe) + 0x4021c) +#define BIT_20 0x5 +#define BIT_20_SHIFT 4 + +#define PE220X_PHY_PLL_SOURCE_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0x4004C) + +#define PE220X_PHY_PMA0_POWER(pipe) (PE220X_PHY_BASE(pipe) + 0x402bc) +#define A0_ACTIVE 0x1 +#define A0_ACTIVE_SHIFT 8 +#define A3_POWERDOWN3 0x8 +#define A3_POWERDOWN3_SHIFT 8 + +#define PE220X_PHY_LINK_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40258) +#define LINK_RESET 0x1 +#define LINK_RESET_MASK 0x1 +#define LINTK_RESET_SHIFT 0x1 + +#define PE220X_PHY_SGMII_DPSEL_INIT(pipe) (PE220X_PHY_BASE(pipe) + 0x40260) +#define DP_SEL 0x1 + +#define PE220X_PHY_APB_RESET(pipe) (PE220X_PHY_BASE(pipe) + 0x40250) +#define APB_RESET 0x1 + +/* phy origin register */ +#define PE220X_PHY_PLL_CFG(pipe) (PE220X_PHY_BASE(pipe) + 0x30038) +#define SINGLE_LINK 0x0 + +#define PE220X_PHY_PMA_CONTROL(pipe) (PE220X_PHY_BASE(pipe) + 0x3800c) +#define CONTROL_ENABLE 0x1 +#define CONTROL_ENABLE_MASK 0x1 +#define CONTROL_ENABLE_SHIFT 0x1 + +#define PE220X_PHY_PMA_CONTROL2(pipe) (PE220X_PHY_BASE(pipe) + 0x38004) +#define PLL0_LOCK_DONE (0x1 << 6) + +#define PE220X_PHY_PLL0_CLK_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0X684) +#define PLL_LINK_RATE_162000 0xf01 +#define PLL_LINK_RATE_270000 0x701 +#define PLL_LINK_RATE_540000 0x301 +#define PLL_LINK_RATE_810000 0x200 + +#define PE220X_PHY_HSCLK0_SEL(pipe) (PE220X_PHY_BASE(pipe) + 0x18398) +#define HSCLK_LINK_0 0x0 +#define HSCLK_LINK_1 0x1 + +#define PE220X_PHY_HSCLK0_DIV(pipe) (PE220X_PHY_BASE(pipe) + 0x1839c) +#define HSCLK_LINK_RATE_162000 0x2 +#define HSCLK_LINK_RATE_270000 0x1 +#define HSCLK_LINK_RATE_540000 0x0 +#define HSCLK_LINK_RATE_810000 0x0 + +#define PE220X_PHY_PLLDRC0_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x18394) +#define PLLDRC_LINK0 0x1 +#define PLLDRC_LINK1 0x9 + +#define PE220X_PHY_PLL0_DSM_M0(pipe) (PE220X_PHY_BASE(pipe) + 0x250) +#define PLL0_DSM_M0 0x4 +#define PE220X_PHY_PLL0_VCOCAL_START(pipe) (PE220X_PHY_BASE(pipe) + 0x218) +#define PLL0_VCOCAL_START 0xc5e +#define PE220X_PHY_PLL0_VCOCAL_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x208) +#define PLL0_VCOCAL_CTRL 0x3 + +#define PE220X_PHY_PLL0_CP_PADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x690) +#define PE220X_PHY_PLL0_CP_IADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x694) +#define PE220X_PHY_PLL0_CP_FILT_PADJ(pipe) (PE220X_PHY_BASE(pipe) + 0x698) +#define PE220X_PHY_PLL0_INTDIV(pipe) (PE220X_PHY_BASE(pipe) + 0x240) +#define PE220X_PHY_PLL0_FRACDIVL(pipe) (PE220X_PHY_BASE(pipe) + 0x244) +#define PE220X_PHY_PLL0_FRACDIVH(pipe) (PE220X_PHY_BASE(pipe) + 0x248) +#define PE220X_PHY_PLL0_HIGH_THR(pipe) (PE220X_PHY_BASE(pipe) + 0x24c) +#define PE220X_PHY_PLL0_PDIAG_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x680) +#define PE220X_PHY_PLL0_VCOCAL_PLLCNT_START(pipe) (PE220X_PHY_BASE(pipe) + 0x220) +#define PE220X_PHY_PLL0_LOCK_PEFCNT(pipe) (PE220X_PHY_BASE(pipe) + 0x270) +#define PE220X_PHY_PLL0_LOCK_PLLCNT_START(pipe) (PE220X_PHY_BASE(pipe) + 0x278) +#define PE220X_PHY_PLL0_LOCK_PLLCNT_THR(pipe) (PE220X_PHY_BASE(pipe) + 0x27c) + +#define PE220X_PHY_PLL0_TX_PSC_A0(pipe) (PE220X_PHY_BASE(pipe) + 0x18400) +#define PLL0_TX_PSC_A0 0xfb +#define PE220X_PHY_PLL0_TX_PSC_A2(pipe) (PE220X_PHY_BASE(pipe) + 0x18408) +#define PLL0_TX_PSC_A2 0x4aa +#define PE220X_PHY_PLL0_TX_PSC_A3(pipe) (PE220X_PHY_BASE(pipe) + 0x1840c) +#define PLL0_TX_PSC_A3 0x4aa +#define PE220X_PHY_PLL0_RX_PSC_A0(pipe) (PE220X_PHY_BASE(pipe) + 0x28000) +#define PLL0_RX_PSC_A0 0x0 +#define PE220X_PHY_PLL0_RX_PSC_A2(pipe) (PE220X_PHY_BASE(pipe) + 0x28008) +#define PLL0_RX_PSC_A2 0x0 +#define PE220X_PHY_PLL0_RX_PSC_A3(pipe) (PE220X_PHY_BASE(pipe) + 0x2800C) +#define PLL0_RX_PSC_A3 0x0 +#define PE220X_PHY_PLL0_RX_PSC_CAL(pipe) (PE220X_PHY_BASE(pipe) + 0x28018) +#define PLL0_RX_PSC_CAL 0x0 + +#define PE220X_PHY_PLL0_XCVR_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x183a8) +#define PLL0_XCVR_CTRL 0xf + +#define PE220X_PHY_PLL0_RX_GCSM1_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28420) +#define PLL0_RX_GCSM1_CTRL 0x0 +#define PE220X_PHY_PLL0_RX_GCSM2_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28440) +#define PLL0_RX_GCSM2_CTRL 0x0 +#define PE220X_PHY_PLL0_RX_PERGCSM_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x28460) +#define PLL0_RX_PERGCSM_CTRL 0x0 + +/* swing and emphasis */ +#define PE220X_PHY_PLL0_TX_DIAG_ACYA(pipe) (PE220X_PHY_BASE(pipe) + 0x1879c) +#define LOCK 1 +#define UNLOCK 0 + +#define PE220X_PHY_PLL0_TX_TXCC_CTRL(pipe) (PE220X_PHY_BASE(pipe) + 0x18100) +#define TX_TXCC_CTRL 0x8a4 + +#define PE220X_PHY_PLL0_TX_DRV(pipe) (PE220X_PHY_BASE(pipe) + 0x18318) +#define TX_DRV 0x3 + +#define PE220X_PHY_PLL0_TX_MGNFS(pipe) (PE220X_PHY_BASE(pipe) + 0x18140) + +#define PE220X_PHY_PLL0_TX_CPOST(pipe) (PE220X_PHY_BASE(pipe) + 0x18130) + +#endif /* __PE220X_REG_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_crtc.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_crtc.c new file mode 100644 index 0000000000000000000000000000000000000000..8adc1c6e10dc839a4fca999ea1b68492cd9a9295 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_crtc.c @@ -0,0 +1,828 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_crtc.h" +#include "phytium_plane.h" +#include "phytium_dp.h" +#include "px210_dc.h" +#include "pe220x_dc.h" +#include "phytium_reg.h" + +#define MAXKERNELSIZE 9 +#define SUBPIXELINDEXBITS 5 +#define SUBPIXELCOUNT (1 << SUBPIXELINDEXBITS) +#define SUBPIXELLOADCOUNT (SUBPIXELCOUNT / 2 + 1) +#define WEIGHTSTATECOUNT (((SUBPIXELLOADCOUNT * MAXKERNELSIZE + 1) & ~1) / 2) +#define KERNELTABLESIZE (SUBPIXELLOADCOUNT * MAXKERNELSIZE * sizeof(uint16_t)) +#define PHYALIGN(n, align) (((n) + ((align) - 1)) & ~((align) - 1)) +#define KERNELSTATES (PHYALIGN(KERNELTABLESIZE + 4, 8)) +#define PHYPI 3.14159265358979323846f + +#define MATH_Add(X, Y) ((float)((X) + (Y))) +#define MATH_Multiply(X, Y) ((float)((X) * (Y))) +#define MATH_Divide(X, Y) ((float)((X) / (Y))) +#define MATH_DivideFromUInteger(X, Y) ((float)(X) / (float)(Y)) +#define MATH_I2Float(X) ((float)(X)) + +struct filter_blit_array { + uint8_t kernelSize; + uint32_t scaleFactor; + uint32_t *kernelStates; +}; + +static uint32_t dc_scaling_get_factor(uint32_t src_size, uint32_t dst_size) +{ + uint32_t factor = 0; + + factor = ((src_size - 1) << SCALE_FACTOR_SRC_OFFSET) / (dst_size - 1); + + return factor; +} + +static float dc_sint(float x) +{ + const float B = 1.2732395477; + const float C = -0.4052847346; + const float P = 0.2310792853; + float y; + + if (x < 0) + y = B*x - C*x*x; + else + y = B*x + C*x*x; + if (y < 0) + y = P * (y * (0 - y) - y) + y; + else + y = P * (y * y - y) + y; + return y; +} + +static float dc_sinc_filter(float x, int radius) +{ + float pit, pitd, f1, f2, result; + float f_radius = MATH_I2Float(radius); + + if (x == 0.0f) { + result = 1.0f; + } else if ((x < -f_radius) || (x > f_radius)) { + result = 0.0f; + } else { + pit = MATH_Multiply(PHYPI, x); + pitd = MATH_Divide(pit, f_radius); + f1 = MATH_Divide(dc_sint(pit), pit); + f2 = MATH_Divide(dc_sint(pitd), pitd); + result = MATH_Multiply(f1, f2); + } + + return result; +} + +static int dc_calculate_sync_table( + uint8_t kernel_size, + uint32_t src_size, + uint32_t dst_size, + struct filter_blit_array *kernel_info) +{ + uint32_t scale_factor; + float f_scale; + int kernel_half; + float f_subpixel_step; + float f_subpixel_offset; + uint32_t subpixel_pos; + int kernel_pos; + int padding; + uint16_t *kernel_array; + int range = 0; + + do { + /* Compute the scale factor. */ + scale_factor = dc_scaling_get_factor(src_size, dst_size); + + /* Same kernel size and ratio as before? */ + if ((kernel_info->kernelSize == kernel_size) && + (kernel_info->scaleFactor == kernel_size)) { + break; + } + + /* check the array */ + if (kernel_info->kernelStates == NULL) + break; + + /* Store new parameters. */ + kernel_info->kernelSize = kernel_size; + kernel_info->scaleFactor = scale_factor; + + /* Compute the scale factor. */ + f_scale = MATH_DivideFromUInteger(dst_size, src_size); + + /* Adjust the factor for magnification. */ + if (f_scale > 1.0f) + f_scale = 1.0f; + + /* Calculate the kernel half. */ + kernel_half = (int) (kernel_info->kernelSize >> 1); + + /* Calculate the subpixel step. */ + f_subpixel_step = MATH_Divide(1.0f, MATH_I2Float(SUBPIXELCOUNT)); + + /* Init the subpixel offset. */ + f_subpixel_offset = 0.5f; + + /* Determine kernel padding size. */ + padding = (MAXKERNELSIZE - kernel_info->kernelSize) / 2; + + /* Set initial kernel array pointer. */ + kernel_array = (uint16_t *) (kernel_info->kernelStates + 1); + + /* Loop through each subpixel. */ + for (subpixel_pos = 0; subpixel_pos < SUBPIXELLOADCOUNT; subpixel_pos++) { + /* Define a temporary set of weights. */ + float fSubpixelSet[MAXKERNELSIZE]; + + /* Init the sum of all weights for the current subpixel. */ + float fWeightSum = 0.0f; + uint16_t weightSum = 0; + short int adjustCount, adjustFrom; + short int adjustment; + + /* Compute weights. */ + for (kernel_pos = 0; kernel_pos < MAXKERNELSIZE; kernel_pos++) { + /* Determine the current index. */ + int index = kernel_pos - padding; + + /* Pad with zeros. */ + if ((index < 0) || (index >= kernel_info->kernelSize)) { + fSubpixelSet[kernel_pos] = 0.0f; + } else { + if (kernel_info->kernelSize == 1) { + fSubpixelSet[kernel_pos] = 1.0f; + } else { + /* Compute the x position for filter function. */ + float fX = MATH_Add( + MATH_I2Float(index - kernel_half), + f_subpixel_offset); + fX = MATH_Multiply(fX, f_scale); + + /* Compute the weight. */ + fSubpixelSet[kernel_pos] = dc_sinc_filter(fX, + kernel_half); + } + + /* Update the sum of weights. */ + fWeightSum = MATH_Add(fWeightSum, + fSubpixelSet[kernel_pos]); + } + } + + /* Adjust weights so that the sum will be 1.0. */ + for (kernel_pos = 0; kernel_pos < MAXKERNELSIZE; kernel_pos++) { + /* Normalize the current weight. */ + float fWeight = MATH_Divide(fSubpixelSet[kernel_pos], + fWeightSum); + + /* Convert the weight to fixed point and store in the table. */ + if (fWeight == 0.0f) + kernel_array[kernel_pos] = 0x0000; + else if (fWeight >= 1.0f) + kernel_array[kernel_pos] = 0x4000; + else if (fWeight <= -1.0f) + kernel_array[kernel_pos] = 0xC000; + else + kernel_array[kernel_pos] = + (int16_t) MATH_Multiply(fWeight, 16384.0f); + weightSum += kernel_array[kernel_pos]; + } + + /* Adjust the fixed point coefficients. */ + adjustCount = 0x4000 - weightSum; + if (adjustCount < 0) { + adjustCount = -adjustCount; + adjustment = -1; + } else { + adjustment = 1; + } + + adjustFrom = (MAXKERNELSIZE - adjustCount) / 2; + for (kernel_pos = 0; kernel_pos < adjustCount; kernel_pos++) { + range = (MAXKERNELSIZE*subpixel_pos + adjustFrom + kernel_pos) * + sizeof(uint16_t); + if ((range >= 0) && (range < KERNELTABLESIZE)) + kernel_array[adjustFrom + kernel_pos] += adjustment; + else + DRM_ERROR("%s failed\n", __func__); + } + + kernel_array += MAXKERNELSIZE; + + /* Advance to the next subpixel. */ + f_subpixel_offset = MATH_Add(f_subpixel_offset, -f_subpixel_step); + } + } while (0); + + return 0; +} + +static void phytium_dc_scaling_config(struct drm_crtc *crtc, + struct drm_crtc_state *old_state) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct drm_display_mode *mode = &crtc->state->adjusted_mode; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + uint32_t scale_factor_x, scale_factor_y, i; + uint32_t kernelStates[128]; + struct filter_blit_array kernel_info_width; + void *tmp = NULL; + + if (mode->hdisplay != mode->crtc_hdisplay || mode->vdisplay != mode->crtc_vdisplay) { + phytium_crtc->src_width = mode->hdisplay; + phytium_crtc->src_height = mode->vdisplay; + phytium_crtc->dst_width = mode->crtc_hdisplay; + phytium_crtc->dst_height = mode->crtc_vdisplay; + + phytium_crtc->dst_x = (mode->crtc_hdisplay - phytium_crtc->dst_width) / 2; + phytium_crtc->dst_y = (mode->crtc_vdisplay - phytium_crtc->dst_height) / 2; + + scale_factor_x = dc_scaling_get_factor(phytium_crtc->src_width, + phytium_crtc->dst_width); + scale_factor_y = dc_scaling_get_factor(phytium_crtc->src_height, + phytium_crtc->dst_height); + if (scale_factor_y > (SCALE_FACTOR_Y_MAX << SCALE_FACTOR_SRC_OFFSET)) + scale_factor_y = (SCALE_FACTOR_Y_MAX << SCALE_FACTOR_SRC_OFFSET); + + phytium_writel_reg(priv, scale_factor_x & SCALE_FACTOR_X_MASK, + group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_X); + phytium_writel_reg(priv, scale_factor_y & SCALE_FACTOR_Y_MASK, + group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_Y); + phytium_writel_reg(priv, FRAMEBUFFER_TAP, + group_offset, PHYTIUM_DC_FRAMEBUFFER_SCALECONFIG); + + tmp = kmalloc(KERNELSTATES, GFP_KERNEL); + if (!tmp) { + DRM_ERROR("malloc %ld failed\n", KERNELSTATES); + return; + } + + memset(&kernel_info_width, 0, sizeof(struct filter_blit_array)); + kernel_info_width.kernelStates = tmp; + memset(kernel_info_width.kernelStates, 0, KERNELSTATES); + kernel_neon_begin(); + dc_calculate_sync_table(FRAMEBUFFER_HORIZONTAL_FILTER_TAP, + phytium_crtc->src_width, + phytium_crtc->dst_width, + &kernel_info_width); + memset(kernelStates, 0, sizeof(kernelStates)); + memcpy(kernelStates, kernel_info_width.kernelStates + 1, KERNELSTATES - 4); + kernel_neon_end(); + phytium_writel_reg(priv, HORI_FILTER_INDEX, + group_offset, PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER_INDEX); + for (i = 0; i < 128; i++) { + phytium_writel_reg(priv, kernelStates[i], + group_offset, PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER); + } + + memset(&kernel_info_width, 0, sizeof(struct filter_blit_array)); + kernel_info_width.kernelStates = tmp; + memset(kernel_info_width.kernelStates, 0, KERNELSTATES); + kernel_neon_begin(); + dc_calculate_sync_table(FRAMEBUFFER_FILTER_TAP, phytium_crtc->src_height, + phytium_crtc->dst_height, &kernel_info_width); + memset(kernelStates, 0, sizeof(kernelStates)); + memcpy(kernelStates, kernel_info_width.kernelStates + 1, KERNELSTATES - 4); + kernel_neon_end(); + phytium_writel_reg(priv, VERT_FILTER_INDEX, + group_offset, PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER_INDEX); + for (i = 0; i < 128; i++) + phytium_writel_reg(priv, kernelStates[i], + group_offset, PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER); + phytium_writel_reg(priv, INITIALOFFSET, + group_offset, PHYTIUM_DC_FRAMEBUFFER_INITIALOFFSET); + kfree(tmp); + phytium_crtc->scale_enable = true; + } else { + phytium_crtc->scale_enable = false; + } +} + +static void phytium_crtc_gamma_set(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + uint32_t config = 0, data; + struct drm_crtc_state *state = crtc->state; + struct drm_color_lut *lut; + unsigned long flags; + uint32_t active_line = 0, timeout = 500; + int i; + + if (state->gamma_lut) { + if (WARN((state->gamma_lut->length/sizeof(struct drm_color_lut) != GAMMA_INDEX_MAX), + "gamma size is not match\n")) + return; + lut = (struct drm_color_lut *)state->gamma_lut->data; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + if (config & FRAMEBUFFER_OUTPUT) { + struct drm_display_mode *mode = &state->adjusted_mode; + uint32_t frame_time; + uint32_t value_a, value_b; + + frame_time = mode->crtc_vtotal * mode->crtc_htotal / mode->crtc_clock; + value_b = (frame_time - 2) * mode->crtc_vtotal; + local_irq_save(flags); + do { + active_line = phytium_readl_reg(priv, group_offset, + PHYTIUM_DC_LOCATION); + active_line = active_line >> LOVATION_Y_SHIFT; + value_a = (mode->crtc_vblank_end - mode->crtc_vblank_start + + active_line) * frame_time; + if (value_a < value_b) + break; + local_irq_restore(flags); + udelay(1000); + timeout--; + local_irq_save(flags); + } while (timeout); + + if (timeout == 0) + DRM_ERROR("wait gamma active line timeout\n"); + } + + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DC_GAMMA_INDEX); + for (i = 0; i < GAMMA_INDEX_MAX; i++) { + data = ((lut[i].red >> 6) & GAMMA_RED_MASK) << GAMMA_RED_SHIFT; + data |= (((lut[i].green >> 6) & GAMMA_GREEN_MASK) << GAMMA_GREEN_SHIFT); + data |= (((lut[i].blue >> 6) & GAMMA_BLUE_MASK) << GAMMA_BLUE_SHIFT); + phytium_writel_reg(priv, data, group_offset, PHYTIUM_DC_GAMMA_DATA); + } + + if (config & FRAMEBUFFER_OUTPUT) + local_irq_restore(flags); + } +} + +static void phytium_crtc_gamma_init(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + struct drm_crtc_state *state = crtc->state; + uint32_t config = 0, data; + uint16_t *red, *green, *blue; + unsigned long flags; + uint32_t active_line = 0, timeout = 500; + int i; + + if (WARN((crtc->gamma_size != GAMMA_INDEX_MAX), "gamma size is not match\n")) + return; + + red = crtc->gamma_store; + green = red + crtc->gamma_size; + blue = green + crtc->gamma_size; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + if (config & FRAMEBUFFER_OUTPUT) { + struct drm_display_mode *mode = &state->adjusted_mode; + uint32_t frame_time; + uint32_t value_a, value_b; + + frame_time = mode->crtc_vtotal * mode->crtc_htotal / mode->crtc_clock; + value_b = (frame_time - 2) * mode->crtc_vtotal; + local_irq_save(flags); + do { + active_line = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_LOCATION); + active_line = active_line >> LOVATION_Y_SHIFT; + value_a = (mode->crtc_vblank_end - mode->crtc_vblank_start + + active_line) * frame_time; + if (value_a < value_b) + break; + local_irq_restore(flags); + udelay(1000); + timeout--; + local_irq_save(flags); + } while (timeout); + + if (timeout == 0) + DRM_ERROR("wait gamma active line timeout\n"); + } + + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DC_GAMMA_INDEX); + for (i = 0; i < GAMMA_INDEX_MAX; i++) { + data = ((*red++ >> 6) & GAMMA_RED_MASK) << GAMMA_RED_SHIFT; + data |= (((*green++ >> 6) & GAMMA_GREEN_MASK) << GAMMA_GREEN_SHIFT); + data |= (((*blue++ >> 6) & GAMMA_BLUE_MASK) << GAMMA_BLUE_SHIFT); + phytium_writel_reg(priv, data, group_offset, PHYTIUM_DC_GAMMA_DATA); + } + + if (config & FRAMEBUFFER_OUTPUT) + local_irq_restore(flags); +} + +static void phytium_crtc_destroy(struct drm_crtc *crtc) +{ + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + + drm_crtc_cleanup(crtc); + kfree(phytium_crtc); +} + +struct drm_crtc_state * +phytium_crtc_atomic_duplicate_state(struct drm_crtc *crtc) +{ + struct phytium_crtc_state *phytium_crtc_state = NULL; + + phytium_crtc_state = kmemdup(crtc->state, sizeof(*phytium_crtc_state), + GFP_KERNEL); + if (!phytium_crtc_state) + return NULL; + __drm_atomic_helper_crtc_duplicate_state(crtc, + &phytium_crtc_state->base); + + return &phytium_crtc_state->base; +} + +void +phytium_crtc_atomic_destroy_state(struct drm_crtc *crtc, + struct drm_crtc_state *state) +{ + struct phytium_crtc_state *phytium_crtc_state = + to_phytium_crtc_state(state); + + phytium_crtc_state = to_phytium_crtc_state(state); + __drm_atomic_helper_crtc_destroy_state(state); + kfree(phytium_crtc_state); +} + +static int phytium_enable_vblank(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + + phytium_writel_reg(priv, INT_ENABLE, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_INT_ENABLE); + + return 0; +} + +static void phytium_disable_vblank(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + + phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_INT_ENABLE); +} + +static const struct drm_crtc_funcs phytium_crtc_funcs = { + .set_config = drm_atomic_helper_set_config, + .destroy = phytium_crtc_destroy, + .page_flip = drm_atomic_helper_page_flip, + .reset = drm_atomic_helper_crtc_reset, + .atomic_duplicate_state = phytium_crtc_atomic_duplicate_state, + .atomic_destroy_state = phytium_crtc_atomic_destroy_state, + .enable_vblank = phytium_enable_vblank, + .disable_vblank = phytium_disable_vblank, +}; + +static void +phytium_crtc_atomic_enable(struct drm_crtc *crtc, + struct drm_atomic_state *state) +{ + struct drm_crtc_state *old_state = drm_atomic_get_old_crtc_state(state, crtc); + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct drm_display_mode *mode = &crtc->state->adjusted_mode; + struct drm_connector_state *new_conn_state; + struct drm_connector *conn; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + int config = 0, i = 0; + + for_each_new_connector_in_state(state, conn, new_conn_state, i) { + if (new_conn_state->crtc != crtc) + continue; + + switch (conn->display_info.bpc) { + case 10: + phytium_crtc->bpc = DP_RGB101010; + break; + case 6: + phytium_crtc->bpc = DP_RGB666; + break; + default: + phytium_crtc->bpc = DP_RGB888; + break; + } + } + + /* config pix clock */ + phytium_crtc->dc_hw_config_pix_clock(crtc, mode->clock); + + phytium_dc_scaling_config(crtc, old_state); + config = ((mode->crtc_hdisplay & HDISPLAY_END_MASK) << HDISPLAY_END_SHIFT) + | ((mode->crtc_htotal&HDISPLAY_TOTAL_MASK) << HDISPLAY_TOTAL_SHIFT); + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_HDISPLAY); + config = ((mode->crtc_hsync_start & HSYNC_START_MASK) << HSYNC_START_SHIFT) + | ((mode->crtc_hsync_end & HSYNC_END_MASK) << HSYNC_END_SHIFT) + | HSYNC_PULSE_ENABLED; + config |= (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : HSYNC_NEGATIVE; + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_HSYNC); + config = ((mode->crtc_vdisplay & VDISPLAY_END_MASK) << VDISPLAY_END_SHIFT) + | ((mode->crtc_vtotal & VDISPLAY_TOTAL_MASK) << VDISPLAY_TOTAL_SHIFT); + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_VDISPLAY); + config = ((mode->crtc_vsync_start & VSYNC_START_MASK) << VSYNC_START_SHIFT) + | ((mode->crtc_vsync_end & VSYNC_END_MASK) << VSYNC_END_SHIFT) + | VSYNC_PULSE_ENABLED; + config |= (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : VSYNC_NEGATIVE; + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_VSYNC); + config = PANEL_DATAENABLE_ENABLE | PANEL_DATA_ENABLE | PANEL_CLOCK_ENABLE; + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_PANEL_CONFIG); + config = phytium_crtc->bpc | OUTPUT_DP; + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_DP_CONFIG); + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + + if (crtc->state->active) + config |= FRAMEBUFFER_OUTPUT | FRAMEBUFFER_RESET; + else + config &= (~(FRAMEBUFFER_OUTPUT | FRAMEBUFFER_RESET)); + + if (phytium_crtc->scale_enable) + config |= FRAMEBUFFER_SCALE_ENABLE; + else + config &= (~FRAMEBUFFER_SCALE_ENABLE); + + config |= FRAMEBUFFER_GAMMA_ENABLE; + + if (crtc->state->gamma_lut) + phytium_crtc_gamma_set(crtc); + else + phytium_crtc_gamma_init(crtc); + + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + drm_crtc_vblank_on(crtc); +} + +static void +phytium_crtc_atomic_disable(struct drm_crtc *crtc, + struct drm_atomic_state *state) +{ + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + + drm_crtc_vblank_off(crtc); + phytium_crtc->dc_hw_disable(crtc); +} + +static void phytium_crtc_update_timing_for_drm_display_mode(struct drm_display_mode *drm_mode, + const struct drm_display_mode *native_mode) +{ + if (native_mode->clock == drm_mode->clock && + native_mode->htotal == drm_mode->htotal && + native_mode->vtotal == drm_mode->vtotal) { + drm_mode->crtc_hdisplay = native_mode->crtc_hdisplay; + drm_mode->crtc_vdisplay = native_mode->crtc_vdisplay; + drm_mode->crtc_clock = native_mode->crtc_clock; + drm_mode->crtc_hblank_start = native_mode->crtc_hblank_start; + drm_mode->crtc_hblank_end = native_mode->crtc_hblank_end; + drm_mode->crtc_hsync_start = native_mode->crtc_hsync_start; + drm_mode->crtc_hsync_end = native_mode->crtc_hsync_end; + drm_mode->crtc_htotal = native_mode->crtc_htotal; + drm_mode->crtc_hskew = native_mode->crtc_hskew; + drm_mode->crtc_vblank_start = native_mode->crtc_vblank_start; + drm_mode->crtc_vblank_end = native_mode->crtc_vblank_end; + drm_mode->crtc_vsync_start = native_mode->crtc_vsync_start; + drm_mode->crtc_vsync_end = native_mode->crtc_vsync_end; + drm_mode->crtc_vtotal = native_mode->crtc_vtotal; + } +} + +static int +phytium_crtc_atomic_check(struct drm_crtc *crtc, struct drm_atomic_state *state) +{ + struct drm_crtc_state *crtc_state = drm_atomic_get_new_crtc_state(state, crtc); + struct drm_plane_state *new_plane_state = NULL; + int ret = 0; + struct drm_connector *connector; + struct drm_connector_state *new_con_state; + uint32_t i; + struct phytium_dp_device *phytium_dp = NULL; + + for_each_new_connector_in_state(state, connector, new_con_state, i) { + if (new_con_state->crtc == crtc) { + phytium_dp = connector_to_dp_device(connector); + break; + } + } + if (phytium_dp) + phytium_crtc_update_timing_for_drm_display_mode(&crtc_state->adjusted_mode, + &phytium_dp->native_mode); + + new_plane_state = drm_atomic_get_new_plane_state(crtc_state->state, + crtc->primary); + if (crtc_state->enable && new_plane_state && !new_plane_state->crtc) { + ret = -EINVAL; + goto fail; + } + + return 0; +fail: + return ret; +} + +static void +phytium_crtc_atomic_begin(struct drm_crtc *crtc, + struct drm_atomic_state *state) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe, config; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + if (config & FRAMEBUFFER_RESET) { + phytium_writel_reg(priv, config | FRAMEBUFFER_VALID_PENDING, + group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + } +} + +static void phytium_crtc_atomic_flush(struct drm_crtc *crtc, + struct drm_atomic_state *state) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + struct phytium_crtc_state *phytium_crtc_state = NULL; + int phys_pipe = phytium_crtc->phys_pipe, config; + uint32_t group_offset = priv->dc_reg_base[phys_pipe]; + + DRM_DEBUG_KMS("crtc->state active:%d enable:%d\n", + crtc->state->active, crtc->state->enable); + phytium_crtc_state = to_phytium_crtc_state(crtc->state); + + if (crtc->state->color_mgmt_changed) + phytium_crtc_gamma_set(crtc); + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + phytium_writel_reg(priv, config&(~FRAMEBUFFER_VALID_PENDING), + group_offset, PHYTIUM_DC_FRAMEBUFFER_CONFIG); + + if (crtc->state->event) { + DRM_DEBUG_KMS("vblank->refcount:%d\n", + atomic_read(&dev->vblank[0].refcount)); + spin_lock_irq(&dev->event_lock); + if (drm_crtc_vblank_get(crtc) == 0) + drm_crtc_arm_vblank_event(crtc, crtc->state->event); + else + drm_crtc_send_vblank_event(crtc, crtc->state->event); + crtc->state->event = NULL; + spin_unlock_irq(&dev->event_lock); + } +} + +static enum drm_mode_status +phytium_crtc_mode_valid(struct drm_crtc *crtc, const struct drm_display_mode *mode) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + + if (mode->crtc_clock > priv->info.crtc_clock_max) + return MODE_CLOCK_HIGH; + + if (mode->hdisplay > priv->info.hdisplay_max) + return MODE_BAD_HVALUE; + + if (mode->vdisplay > priv->info.vdisplay_max) + return MODE_BAD_VVALUE; + + if (mode->flags & DRM_MODE_FLAG_INTERLACE) + return MODE_NO_INTERLACE; + + return MODE_OK; +} + +static const struct drm_crtc_helper_funcs phytium_crtc_helper_funcs = { + .mode_valid = phytium_crtc_mode_valid, + .atomic_check = phytium_crtc_atomic_check, + .atomic_begin = phytium_crtc_atomic_begin, + .atomic_flush = phytium_crtc_atomic_flush, + .atomic_enable = phytium_crtc_atomic_enable, + .atomic_disable = phytium_crtc_atomic_disable, +}; + +void phytium_crtc_resume(struct drm_device *drm_dev) +{ + struct drm_crtc *crtc; + struct phytium_crtc *phytium_crtc = NULL; + + drm_for_each_crtc(crtc, drm_dev) { + phytium_crtc = to_phytium_crtc(crtc); + if (phytium_crtc->dc_hw_reset) + phytium_crtc->dc_hw_reset(crtc); + phytium_crtc_gamma_init(crtc); + } +} + +int phytium_crtc_init(struct drm_device *dev, int phys_pipe) +{ + struct phytium_crtc *phytium_crtc; + struct phytium_crtc_state *phytium_crtc_state; + struct phytium_plane *phytium_primary_plane = NULL; + struct phytium_plane *phytium_cursor_plane = NULL; + struct phytium_display_private *priv = dev->dev_private; + int ret; + + phytium_crtc = kzalloc(sizeof(*phytium_crtc), GFP_KERNEL); + if (!phytium_crtc) { + ret = -ENOMEM; + goto failed_malloc_crtc; + } + + phytium_crtc_state = kzalloc(sizeof(*phytium_crtc_state), GFP_KERNEL); + if (!phytium_crtc_state) { + ret = -ENOMEM; + goto failed_malloc_crtc_state; + } + + phytium_crtc_state->base.crtc = &phytium_crtc->base; + phytium_crtc->base.state = &phytium_crtc_state->base; + phytium_crtc->phys_pipe = phys_pipe; + + if (IS_PX210(priv)) { + phytium_crtc->dc_hw_config_pix_clock = px210_dc_hw_config_pix_clock; + phytium_crtc->dc_hw_disable = px210_dc_hw_disable; + phytium_crtc->dc_hw_reset = NULL; + priv->dc_reg_base[phys_pipe] = PX210_DC_BASE(phys_pipe); + priv->dcreq_reg_base[phys_pipe] = PX210_DCREQ_BASE(phys_pipe); + priv->address_transform_base = PX210_ADDRESS_TRANSFORM_BASE; + } else if (IS_PE220X(priv)) { + phytium_crtc->dc_hw_config_pix_clock = pe220x_dc_hw_config_pix_clock; + phytium_crtc->dc_hw_disable = pe220x_dc_hw_disable; + phytium_crtc->dc_hw_reset = pe220x_dc_hw_reset; + priv->dc_reg_base[phys_pipe] = PE220X_DC_BASE(phys_pipe); + priv->dcreq_reg_base[phys_pipe] = 0x0; + priv->address_transform_base = PE220X_ADDRESS_TRANSFORM_BASE; + } + + phytium_primary_plane = phytium_primary_plane_create(dev, phys_pipe); + if (IS_ERR(phytium_primary_plane)) { + ret = PTR_ERR(phytium_primary_plane); + DRM_ERROR("create primary plane failed, phys_pipe(%d)\n", phys_pipe); + goto failed_create_primary; + } + + phytium_cursor_plane = phytium_cursor_plane_create(dev, phys_pipe); + if (IS_ERR(phytium_cursor_plane)) { + ret = PTR_ERR(phytium_cursor_plane); + DRM_ERROR("create cursor plane failed, phys_pipe(%d)\n", phys_pipe); + goto failed_create_cursor; + } + + ret = drm_crtc_init_with_planes(dev, &phytium_crtc->base, + &phytium_primary_plane->base, + &phytium_cursor_plane->base, + &phytium_crtc_funcs, + "phys_pipe %d", phys_pipe); + + if (ret) { + DRM_ERROR("init crtc with plane failed, phys_pipe(%d)\n", phys_pipe); + goto failed_crtc_init; + } + drm_crtc_helper_add(&phytium_crtc->base, &phytium_crtc_helper_funcs); + drm_crtc_vblank_reset(&phytium_crtc->base); + drm_mode_crtc_set_gamma_size(&phytium_crtc->base, GAMMA_INDEX_MAX); + drm_crtc_enable_color_mgmt(&phytium_crtc->base, 0, false, GAMMA_INDEX_MAX); + if (phytium_crtc->dc_hw_reset) + phytium_crtc->dc_hw_reset(&phytium_crtc->base); + + return 0; + +failed_crtc_init: +failed_create_cursor: + /* drm_mode_config_cleanup() will free any crtcs/planes already initialized */ +failed_create_primary: + kfree(phytium_crtc_state); +failed_malloc_crtc_state: + kfree(phytium_crtc); +failed_malloc_crtc: + return ret; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_crtc.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_crtc.h new file mode 100644 index 0000000000000000000000000000000000000000..8c5b2eb0ec0a25d0ca9df18a3f6684387d8e0a91 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_crtc.h @@ -0,0 +1,39 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_CRTC_H__ +#define __PHYTIUM_CRTC_H__ + +struct phytium_crtc { + struct drm_crtc base; + int phys_pipe; + unsigned int bpc; + + /* scale */ + uint32_t src_width; + uint32_t src_height; + uint32_t dst_width; + uint32_t dst_height; + uint32_t dst_x; + uint32_t dst_y; + bool scale_enable; + bool reserve[3]; + + void (*dc_hw_config_pix_clock)(struct drm_crtc *crtc, int clock); + void (*dc_hw_disable)(struct drm_crtc *crtc); + void (*dc_hw_reset)(struct drm_crtc *crtc); +}; + +struct phytium_crtc_state { + struct drm_crtc_state base; +}; + +#define to_phytium_crtc(x) container_of(x, struct phytium_crtc, base) +#define to_phytium_crtc_state(x) container_of(x, struct phytium_crtc_state, base) + +void phytium_crtc_resume(struct drm_device *drm_dev); +int phytium_crtc_init(struct drm_device *dev, int pipe); +#endif /* __PHYTIUM_CRTC_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_debugfs.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_debugfs.c new file mode 100644 index 0000000000000000000000000000000000000000..8cd6c338d28c0e5efffd1af910399aae767e1222 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_debugfs.c @@ -0,0 +1,456 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_dp.h" +#include "phytium_reg.h" + +const char *const mem_state[PHYTIUM_MEM_STATE_TYPE_COUNT] = { + "Memory_Vram_Total", + "Memory_Vram_Alloc", + "Memory_System_Carveout_Total", + "Memory_System_Carveout_Alloc", + "Memory_System_Alloc", +}; + +static ssize_t +phytium_dp_register_write(struct file *filp, + const char __user *ubuf, + size_t len, + loff_t *ppos) +{ + char tmp[16]; + + if (len >= sizeof(tmp)) + return -EINVAL; + + memset(tmp, 0, sizeof(tmp)); + if (copy_from_user(tmp, ubuf, len)) + return -EFAULT; + tmp[len] = '\0'; + + return len; +} + +static int phytium_dp_register_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_M_VID, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_M_VID)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_N_VID, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_N_VID)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_TRANSFER_UNIT_SIZE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_TRANSFER_UNIT_SIZE)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_DATA_COUNT, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_DATA_COUNT)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HTOTAL, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HTOTAL)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HRES, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HRES)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HSWIDTH, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HSWIDTH)); + seq_printf(m, "addr:h0x%08x h0x%08x\n", PHYTIUM_DP_MAIN_LINK_HSTART, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_HSTART)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VTOTAL, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VTOTAL)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VRES, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VRES)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VSWIDTH, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VSWIDTH)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_VSTART, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_VSTART)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_POLARITY, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_POLARITY)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_MISC0, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_MISC0)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_MAIN_LINK_MISC1, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_MAIN_LINK_MISC1)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_USER_SYNC_POLARITY, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_USER_SYNC_POLARITY)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_VIDEO_STREAM_ENABLE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SECONDARY_STREAM_ENABLE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE)); + seq_puts(m, "audio:\n"); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_INPUT_SELECT, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_INPUT_SELECT)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_DIRECT_CLKDIV, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_DIRECT_CLKDIV)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CHANNEL_COUNT, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CHANNEL_COUNT)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CHANNEL_MAP, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CHANNEL_MAP)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_DATA_WINDOW, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_CATEGORY_CODE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_CATEGORY_CODE)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_MAUD, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_MAUD)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_NAUD, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_NAUD)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CLOCK_MODE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CLOCK_MODE)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_SOURCE_FORMAT, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_SOURCE_FORMAT)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY)); + seq_printf(m, "addr:h'0x%08x h'0x%08x\n", PHYTIUM_DP_SEC_AUDIO_ENABLE, + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE)); + + return 0; +} + +static int phytium_dp_register_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_dp_register_show, inode->i_private); +} + +static const struct file_operations phytium_dp_register_fops = { + .owner = THIS_MODULE, + .open = phytium_dp_register_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, + .write = phytium_dp_register_write, +}; + +static ssize_t +phytium_dp_trigger_train_fail_write(struct file *filp, + const char __user *ubuf, + size_t len, + loff_t *ppos) +{ + struct seq_file *m = filp->private_data; + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + char tmp[16]; + + if (len >= sizeof(tmp)) + return -EINVAL; + + memset(tmp, 0, sizeof(tmp)); + if (copy_from_user(tmp, ubuf, len)) + return -EFAULT; + tmp[len] = '\0'; + + if (kstrtouint(tmp, 10, &phytium_dp->trigger_train_fail) != 0) + return -EINVAL; + + return len; +} + +static int phytium_dp_trigger_train_fail_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + seq_printf(m, "trigger_train_fail: %d\n", phytium_dp->trigger_train_fail); + seq_printf(m, "train_retry_count: %d\n", phytium_dp->train_retry_count); + + return 0; +} + +static int phytium_dp_trigger_train_fail_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_dp_trigger_train_fail_show, inode->i_private); +} + +static const struct file_operations phytium_dp_trigger_train_fail_fops = { + .owner = THIS_MODULE, + .open = phytium_dp_trigger_train_fail_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, + .write = phytium_dp_trigger_train_fail_write, +}; + +static int phytium_edp_backlight_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + if (!phytium_dp->is_edp) + return -ENODEV; + + mutex_lock(&phytium_dp->panel.panel_lock); + seq_printf(m, "backlight: %s\n", phytium_dp->panel.backlight_enabled?"enabled":"disabled"); + mutex_unlock(&phytium_dp->panel.panel_lock); + + return 0; +} + +static int phytium_edp_backlight_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_edp_backlight_show, inode->i_private); +} + +static const struct file_operations phytium_edp_backlight_fops = { + .owner = THIS_MODULE, + .open = phytium_edp_backlight_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static int phytium_edp_power_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + if (!phytium_dp->is_edp) + return -ENODEV; + + mutex_lock(&phytium_dp->panel.panel_lock); + seq_printf(m, "power: %s\n", phytium_dp->panel.power_enabled?"enabled":"disabled"); + mutex_unlock(&phytium_dp->panel.panel_lock); + + return 0; +} + +static int phytium_edp_power_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_edp_power_show, inode->i_private); +} + +static const struct file_operations phytium_edp_power_fops = { + .owner = THIS_MODULE, + .open = phytium_edp_power_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +struct dpcd_block { + /* DPCD dump start address. */ + unsigned int offset; + /* DPCD dump end address, inclusive. If unset, .size will be used. */ + unsigned int end; + /* DPCD dump size. Used if .end is unset. If unset, defaults to 1. */ + size_t size; + /* Only valid for eDP. */ + bool edp; +}; + +static const struct dpcd_block phytium_dpcd_debug[] = { + { .offset = DP_DPCD_REV, .size = DP_RECEIVER_CAP_SIZE }, + { .offset = DP_PSR_SUPPORT, .end = DP_PSR_CAPS }, + { .offset = DP_DOWNSTREAM_PORT_0, .size = 16 }, + { .offset = DP_LINK_BW_SET, .end = DP_EDP_CONFIGURATION_SET }, + { .offset = DP_SINK_COUNT, .end = DP_ADJUST_REQUEST_LANE2_3 }, + { .offset = DP_SET_POWER }, + { .offset = DP_EDP_DPCD_REV }, + { .offset = DP_EDP_GENERAL_CAP_1, .end = DP_EDP_GENERAL_CAP_3 }, + { .offset = DP_EDP_DISPLAY_CONTROL_REGISTER, .end = DP_EDP_BACKLIGHT_FREQ_CAP_MAX_LSB }, + { .offset = DP_EDP_DBC_MINIMUM_BRIGHTNESS_SET, .end = DP_EDP_DBC_MAXIMUM_BRIGHTNESS_SET }, + { .offset = DP_DEVICE_SERVICE_IRQ_VECTOR, .size = 1 }, + { .offset = DP_TEST_REQUEST, .end = DP_TEST_PATTERN }, +}; + +static int phytium_dpcd_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + uint8_t buf[16], i; + ssize_t err; + + if (connector->status != connector_status_connected) + return -ENODEV; + + for (i = 0; i < ARRAY_SIZE(phytium_dpcd_debug); i++) { + const struct dpcd_block *b = &phytium_dpcd_debug[i]; + size_t size = b->end ? b->end - b->offset + 1 : (b->size ?: 1); + + if (WARN_ON(size > sizeof(buf))) + continue; + + err = drm_dp_dpcd_read(&phytium_dp->aux, b->offset, buf, size); + if (err <= 0) { + DRM_ERROR("dpcd read (%zu bytes at %u) failed (%zd)\n", + size, b->offset, err); + continue; + } + + seq_printf(m, "%04x: %*ph\n", b->offset, (int) size, buf); + } + + return 0; +} + +static int phytium_dpcd_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_dpcd_show, inode->i_private); +} + +static const struct file_operations phytium_dpcd_fops = { + .owner = THIS_MODULE, + .open = phytium_dpcd_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static ssize_t +phytium_dp_state_write(struct file *filp, + const char __user *ubuf, + size_t len, + loff_t *ppos) +{ + char tmp[16]; + + if (len >= sizeof(tmp)) + return -EINVAL; + + memset(tmp, 0, sizeof(tmp)); + if (copy_from_user(tmp, ubuf, len)) + return -EFAULT; + tmp[len] = '\0'; + + return len; +} + +static int phytium_dp_state_show(struct seq_file *m, void *data) +{ + struct drm_connector *connector = m->private; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + seq_printf(m, "port number: %d\n", phytium_dp->port); + seq_printf(m, "source_max_lane_count: %d\n", phytium_dp->source_max_lane_count); + seq_printf(m, "max_source_rates: %d\n", + phytium_dp->source_rates[phytium_dp->num_source_rates-1]); + if (connector->status == connector_status_connected) { + seq_printf(m, "sink_max_lane_count: %d\n", phytium_dp->sink_max_lane_count); + seq_printf(m, "max_sink_rates: %d\n", + phytium_dp->sink_rates[phytium_dp->num_sink_rates-1]); + seq_printf(m, "link_rate: %d\n", phytium_dp->link_rate); + seq_printf(m, "link_lane_count: %d\n", phytium_dp->link_lane_count); + seq_printf(m, "train_set[0]: %d\n", phytium_dp->train_set[0]); + seq_printf(m, "has_audio: %s\n", phytium_dp->has_audio?"yes":"no"); + } + + return 0; +} + +static int phytium_dp_state_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_dp_state_show, inode->i_private); +} + +static const struct file_operations phytium_dp_state_fops = { + .owner = THIS_MODULE, + .open = phytium_dp_state_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, + .write = phytium_dp_state_write, +}; + +static const struct phytium_debugfs_files { + const char *name; + const struct file_operations *fops; +} phytium_debugfs_connector_files[] = { + {"dp_state", &phytium_dp_state_fops}, + {"dpcd", &phytium_dpcd_fops}, + {"dp_register", &phytium_dp_register_fops}, + {"dp_trigger_train_fail", &phytium_dp_trigger_train_fail_fops}, +}; + +static const struct phytium_debugfs_files phytium_edp_debugfs_connector_files[] = { + {"edp_power", &phytium_edp_power_fops}, + {"edp_backlight", &phytium_edp_backlight_fops}, +}; + +int phytium_debugfs_connector_add(struct drm_connector *connector) +{ + struct dentry *root = connector->debugfs_entry; + struct dentry *ent; + int i; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + if (!root) + return -ENODEV; + + for (i = 0; i < ARRAY_SIZE(phytium_debugfs_connector_files); i++) { + ent = debugfs_create_file(phytium_debugfs_connector_files[i].name, + 0644, + root, + connector, + phytium_debugfs_connector_files[i].fops); + if (!ent) + return -ENOMEM; + } + + if (phytium_dp->is_edp) + for (i = 0; i < ARRAY_SIZE(phytium_edp_debugfs_connector_files); i++) { + ent = debugfs_create_file(phytium_edp_debugfs_connector_files[i].name, + 0644, + root, + connector, + phytium_edp_debugfs_connector_files[i].fops); + if (!ent) + return -ENOMEM; + } + + return 0; +} + +static int phytium_mem_state_show(struct seq_file *m, void *data) +{ + struct phytium_display_private *priv = m->private; + uint8_t i; + + for (i = 0; i < ARRAY_SIZE(mem_state); i++) + seq_printf(m, "%-34s %10lld\n", mem_state[i], priv->mem_state[i]); + + return 0; +} + +static int phytium_mem_state_open(struct inode *inode, struct file *file) +{ + return single_open(file, phytium_mem_state_show, inode->i_private); +} + +static const struct file_operations phytium_mem_state_fops = { + .owner = THIS_MODULE, + .open = phytium_mem_state_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static const struct phytium_debugfs_files phytium_debugfs_display_files[] = { + {"mem_state", &phytium_mem_state_fops}, +}; + +int phytium_debugfs_display_register(struct phytium_display_private *priv) +{ + struct drm_minor *minor = priv->dev->primary; + struct dentry *root = minor->debugfs_root; + struct dentry *ent; + + if (!root) + return -ENODEV; + + ent = debugfs_create_file(phytium_debugfs_display_files[0].name, + 0644, + root, + priv, + phytium_debugfs_display_files[0].fops); + if (!ent) + return -ENOMEM; + + return 0; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_debugfs.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_debugfs.h new file mode 100644 index 0000000000000000000000000000000000000000..7e632bf9c521cc02340b439b9e7e106389e03794 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_debugfs.h @@ -0,0 +1,13 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_DEBUGFS_H__ +#define __PHYTIUM_DEBUGFS_H__ + +int phytium_debugfs_connector_add(struct drm_connector *connector); +int phytium_debugfs_display_register(struct phytium_display_private *priv); + +#endif /* __PHYTIUM_DEBUGFS_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_display_drv.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_display_drv.c new file mode 100644 index 0000000000000000000000000000000000000000..c311c1c977ccf2edb8d9b811fc90adfd08393eb0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_display_drv.c @@ -0,0 +1,451 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_plane.h" +#include "phytium_crtc.h" +#include "phytium_dp.h" +#include "phytium_gem.h" +#include "phytium_fb.h" +#include "phytium_fbdev.h" +#include "phytium_reg.h" +#include "phytium_pci.h" +#include "phytium_platform.h" +#include "phytium_debugfs.h" + +int dc_fake_mode_enable; +module_param(dc_fake_mode_enable, int, 0644); +MODULE_PARM_DESC(dc_fake_mode_enable, "Enable DC fake mode (0-disabled; 1-enabled; default-0)"); + +int dc_fast_training_check = 1; +module_param(dc_fast_training_check, int, 0644); +MODULE_PARM_DESC(dc_fast_training_check, "Check dp fast training (0-disabled; 1-enabled; default-1)"); + +int num_source_rates = 4; +module_param(num_source_rates, int, 0644); +MODULE_PARM_DESC(num_source_rates, "set the source max rates (1-1.62Gbps; 2-2.7Gbps; 3-5.4Gbps; 4-8.1Gbps; default-4)"); + +int source_max_lane_count = 4; +module_param(source_max_lane_count, int, 0644); +MODULE_PARM_DESC(source_max_lane_count, "set the source lane count (1-1lane; 2-2lane; 4-4lane; default-4)"); + +int link_dynamic_adjust; +module_param(link_dynamic_adjust, int, 0644); +MODULE_PARM_DESC(link_dynamic_adjust, "dynamic select the train pamameter according to the display mode (0-disabled; 1-enabled; default-1)"); + +int phytium_wait_cmd_done(struct phytium_display_private *priv, + uint32_t register_offset, + uint32_t request_bit, + uint32_t reply_bit) +{ + int timeout = 1000, config = 0, ret = 0; + + do { + mdelay(1); + timeout--; + config = phytium_readl_reg(priv, 0, register_offset); + } while ((!(config & reply_bit)) && timeout); + + phytium_writel_reg(priv, config & (~request_bit), 0, register_offset); + + if (timeout == 0) { + DRM_ERROR("wait cmd reply timeout\n"); + ret = -EBUSY; + } else { + timeout = 500; + do { + mdelay(1); + timeout--; + config = phytium_readl_reg(priv, 0, register_offset); + } while ((config & reply_bit) && timeout); + if (timeout == 0) { + DRM_ERROR("clear cmd timeout\n"); + ret = -EBUSY; + } + } + mdelay(5); + + return ret; +} + +static void phytium_irq_preinstall(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + int i, status; + + for_each_pipe_masked(priv, i) { + status = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); + phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[i], PHYTIUM_DC_INT_ENABLE); + } +} + +static void phytium_irq_uninstall(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + int i, status; + + for_each_pipe_masked(priv, i) { + status = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); + phytium_writel_reg(priv, INT_DISABLE, priv->dc_reg_base[i], PHYTIUM_DC_INT_ENABLE); + } +} + +static irqreturn_t phytium_display_irq_handler(int irq, void *data) +{ + struct drm_device *dev = data; + struct phytium_display_private *priv = dev->dev_private; + bool enabled = 0; + int i = 0, virt_pipe = 0; + irqreturn_t ret = IRQ_NONE, ret1 = IRQ_NONE; + + for_each_pipe_masked(priv, i) { + enabled = phytium_readl_reg(priv, priv->dc_reg_base[i], PHYTIUM_DC_INT_STATUS); + if (enabled & INT_STATUS) { + virt_pipe = phytium_get_virt_pipe(priv, i); + if (virt_pipe < 0) + return IRQ_NONE; + drm_handle_vblank(dev, virt_pipe); + ret = IRQ_HANDLED; + if (priv->dc_hw_clear_msi_irq) + priv->dc_hw_clear_msi_irq(priv, i); + } + } + + ret1 = phytium_dp_hpd_irq_handler(priv); + if (ret == IRQ_HANDLED || ret1 == IRQ_HANDLED) + return IRQ_HANDLED; + + return IRQ_NONE; +} + +static const struct drm_mode_config_funcs phytium_mode_funcs = { + .fb_create = phytium_fb_create, + .output_poll_changed = drm_fb_helper_output_poll_changed, + .atomic_check = drm_atomic_helper_check, + .atomic_commit = drm_atomic_helper_commit, +}; + +static void phytium_atomic_commit_tail(struct drm_atomic_state *state) +{ + struct drm_device *dev = state->dev; + + drm_atomic_helper_commit_modeset_disables(dev, state); + drm_atomic_helper_commit_planes(dev, state, false); + drm_atomic_helper_commit_modeset_enables(dev, state); + drm_atomic_helper_commit_hw_done(state); + drm_atomic_helper_wait_for_flip_done(dev, state); + drm_atomic_helper_cleanup_planes(dev, state); +} + +static struct drm_mode_config_helper_funcs phytium_mode_config_helpers = { + .atomic_commit_tail = phytium_atomic_commit_tail, +}; + +static int phytium_modeset_init(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + int i = 0, ret; + + drm_mode_config_init(dev); + dev->mode_config.min_width = 0; + dev->mode_config.min_height = 0; + dev->mode_config.max_width = 16384; + dev->mode_config.max_height = 16384; + dev->mode_config.cursor_width = 32; + dev->mode_config.cursor_height = 32; + + dev->mode_config.preferred_depth = 24; + dev->mode_config.prefer_shadow = 1; + dev->mode_config.fb_modifiers_not_supported = false; + + dev->mode_config.funcs = &phytium_mode_funcs; + dev->mode_config.helper_private = &phytium_mode_config_helpers; + + for_each_pipe_masked(priv, i) { + ret = phytium_crtc_init(dev, i); + if (ret) { + DRM_ERROR("phytium_crtc_init(pipe %d) return failed\n", i); + goto failed_crtc_init; + } + } + + for_each_pipe_masked(priv, i) { + ret = phytium_dp_init(dev, i); + if (ret) { + DRM_ERROR("phytium_dp_init(pipe %d) return failed\n", i); + goto failed_dp_init; + } + } + + drm_mode_config_reset(dev); + + return 0; +failed_dp_init: +failed_crtc_init: + drm_mode_config_cleanup(dev); + return ret; +} + +int phytium_get_virt_pipe(struct phytium_display_private *priv, int phys_pipe) +{ + int i = 0; + int virt_pipe = 0; + + for_each_pipe_masked(priv, i) { + if (i != phys_pipe) + virt_pipe++; + else + return virt_pipe; + } + + DRM_ERROR("%s %d failed\n", __func__, phys_pipe); + return -EINVAL; +} + +int phytium_get_phys_pipe(struct phytium_display_private *priv, int virt_pipe) +{ + int i = 0; + int tmp = 0; + + for_each_pipe_masked(priv, i) { + if (tmp != virt_pipe) + tmp++; + else + return i; + } + + DRM_ERROR("%s %d failed\n", __func__, virt_pipe); + return -EINVAL; +} + +static int phytium_display_load(struct drm_device *dev, unsigned long flags) +{ + struct phytium_display_private *priv = dev->dev_private; + int ret = 0; + + ret = drm_vblank_init(dev, priv->info.num_pipes); + if (ret) { + DRM_ERROR("vblank init failed\n"); + goto failed_vblank_init; + } + + ret = phytium_modeset_init(dev); + if (ret) { + DRM_ERROR("phytium_modeset_init failed\n"); + goto failed_modeset_init; + } + + if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) + priv->vram_hw_init(priv); + + phytium_irq_preinstall(dev); + ret = request_irq(priv->irq, phytium_display_irq_handler, IRQF_SHARED, + dev->driver->name, dev); + if (ret) { + DRM_ERROR("install irq failed\n"); + goto failed_irq_install; + } + + ret = phytium_drm_fbdev_init(dev); + if (ret) + DRM_ERROR("failed to init dev\n"); + + phytium_debugfs_display_register(priv); + + return ret; + +failed_irq_install: + drm_mode_config_cleanup(dev); +failed_modeset_init: +failed_vblank_init: + return ret; +} + +static void phytium_display_unload(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + + phytium_drm_fbdev_fini(dev); + phytium_irq_uninstall(dev); + free_irq(priv->irq, dev); + drm_mode_config_cleanup(dev); +} + +/* phytium display specific ioctls + * The device specific ioctl range is 0x40 to 0x79. + */ +#define DRM_PHYTIUM_VRAM_TYPE_DEVICE 0x0 +#define DRM_IOCTL_PHYTIUM_VRAM_TYPE_DEVICE DRM_IO(DRM_COMMAND_BASE\ + + DRM_PHYTIUM_VRAM_TYPE_DEVICE) + +static int phytium_ioctl_check_vram_device(struct drm_device *dev, void *data, + struct drm_file *file_priv) +{ + struct phytium_display_private *priv = dev->dev_private; + + return ((priv->support_memory_type == MEMORY_TYPE_VRAM_DEVICE) ? 1 : 0); +} + +static const struct drm_ioctl_desc phytium_ioctls[] = { + /* for test, none so far */ + DRM_IOCTL_DEF_DRV(PHYTIUM_VRAM_TYPE_DEVICE, phytium_ioctl_check_vram_device, + DRM_AUTH|DRM_UNLOCKED), +}; + +static const struct file_operations phytium_drm_driver_fops = { + .owner = THIS_MODULE, + .open = drm_open, + .release = drm_release, + .unlocked_ioctl = drm_ioctl, + .compat_ioctl = drm_compat_ioctl, + .poll = drm_poll, + .read = drm_read, + .llseek = no_llseek, + .mmap = phytium_gem_mmap, +}; + +struct drm_driver phytium_display_drm_driver = { + .driver_features = DRIVER_HAVE_IRQ | + DRIVER_MODESET | + DRIVER_ATOMIC | + DRIVER_GEM, + .load = phytium_display_load, + .unload = phytium_display_unload, + .lastclose = drm_fb_helper_lastclose, + .gem_prime_import = drm_gem_prime_import, + .gem_prime_import_sg_table = phytium_gem_prime_import_sg_table, + .dumb_create = phytium_gem_dumb_create, + .ioctls = phytium_ioctls, + .num_ioctls = ARRAY_SIZE(phytium_ioctls), + .fops = &phytium_drm_driver_fops, + .name = DRV_NAME, + .desc = DRV_DESC, + .date = DRV_DATE, + .major = DRV_MAJOR, + .minor = DRV_MINOR, +}; + +static void phytium_display_shutdown(struct drm_device *dev) +{ + drm_atomic_helper_shutdown(dev); +} + +static int phytium_display_pm_suspend(struct drm_device *dev) +{ + struct drm_atomic_state *state; + struct phytium_display_private *priv = dev->dev_private; + int ret, ret1; + + phytium_dp_hpd_irq_setup(dev, false); + cancel_work_sync(&priv->hotplug_work); + drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 1); + state = drm_atomic_helper_suspend(dev); + if (IS_ERR(state)) { + DRM_ERROR("drm_atomic_helper_suspend failed: %ld\n", PTR_ERR(state)); + ret = PTR_ERR(state); + goto suspend_failed; + } + dev->mode_config.suspend_state = state; + ret = phytium_gem_suspend(dev); + if (ret) { + DRM_ERROR("phytium_gem_suspend failed: %d\n", ret); + goto gem_suspend_failed; + } + + return 0; + +gem_suspend_failed: + ret1 = drm_atomic_helper_resume(dev, dev->mode_config.suspend_state); + if (ret1) + DRM_ERROR("Failed to resume (%d)\n", ret1); + dev->mode_config.suspend_state = NULL; +suspend_failed: + drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 0); + phytium_dp_hpd_irq_setup(dev, true); + + return ret; +} + +static int phytium_display_pm_resume(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + int ret = 0; + + if (WARN_ON(!dev->mode_config.suspend_state)) + return -EINVAL; + + ret = phytium_dp_resume(dev); + if (ret) + return -EIO; + + phytium_crtc_resume(dev); + phytium_gem_resume(dev); + + if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) + priv->vram_hw_init(priv); + + ret = drm_atomic_helper_resume(dev, dev->mode_config.suspend_state); + if (ret) { + DRM_ERROR("Failed to resume (%d)\n", ret); + return ret; + } + + dev->mode_config.suspend_state = NULL; + drm_fb_helper_set_suspend_unlocked(dev->fb_helper, 0); + phytium_dp_hpd_irq_setup(dev, true); + + return 0; +} + +void phytium_display_private_init(struct phytium_display_private *priv, struct drm_device *dev) +{ + INIT_LIST_HEAD(&priv->gem_list_head); + spin_lock_init(&priv->hotplug_irq_lock); + INIT_WORK(&priv->hotplug_work, phytium_dp_hpd_work_func); + memset(priv->mem_state, 0, sizeof(priv->mem_state)); + priv->dev = dev; + priv->display_shutdown = phytium_display_shutdown; + priv->display_pm_suspend = phytium_display_pm_suspend; + priv->display_pm_resume = phytium_display_pm_resume; +} + +static int __init phytium_display_init(void) +{ + int ret = 0; + + ret = platform_driver_register(&phytium_platform_driver); + if (ret) + return ret; + + ret = pci_register_driver(&phytium_pci_driver); + + return ret; +} + +static void __exit phytium_display_exit(void) +{ + pci_unregister_driver(&phytium_pci_driver); + + platform_driver_unregister(&phytium_platform_driver); +} + +module_init(phytium_display_init); +module_exit(phytium_display_exit); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Yang Xun "); +MODULE_DESCRIPTION("Phytium Display Controller"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_display_drv.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_display_drv.h new file mode 100644 index 0000000000000000000000000000000000000000..587614f5b2efb7e160d5228216763d8a176e3ea8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_display_drv.h @@ -0,0 +1,180 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_DISPLAY_DRV_H__ +#define __PHYTIUM_DISPLAY_DRV_H__ + +#include +#include +#include + +#define DEBUG_LOG 0 + +#define PHYTIUM_FORMAT_MAX_PLANE 3 +#define DP_MAX_DOWNSTREAM_PORTS 0x10 + +#define DRV_NAME "dc" +#define DRV_DESC "phytium dc" +#define DRV_DATE "20201220" +#define DRV_MAJOR 1 +#define DRV_MINOR 1 + +/* come from GPU */ +#define DRM_FORMAT_MOD_VENDOR_PHYTIUM 0x92 + +/* dc:mode0 8x8 16bpp gpu: FBCDC_8X8_V10 */ +#define DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC fourcc_mod_code(PHYTIUM, 21) +/* dc:mode3 8x4 32bpp gpu: FBCDC_16X4_v10 */ +#define DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC fourcc_mod_code(PHYTIUM, 22) + +#define PIPE_MASK_SHIFT 0x0 +#define PIPE_MASK_MASK 0x7 +#define EDP_MASK_SHIFT 0x3 +#define EDP_MASK_MASK 0x7 + +enum phytium_platform { + PHYTIUM_PLATFORM_UNINITIALIZED = 0, + PHYTIUM_PLATFORM_PX210, + PHYTIUM_PLATFORM_PE220X, +}; + +enum phytium_mem_state_type { + PHYTIUM_MEM_VRAM_TOTAL = 0, + PHYTIUM_MEM_VRAM_ALLOC, + PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL, + PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC, + PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC, + PHYTIUM_MEM_STATE_TYPE_COUNT, +}; + +#define MEMORY_TYPE_VRAM_WC 0x1 +#define MEMORY_TYPE_SYSTEM_CARVEOUT 0x2 +#define MEMORY_TYPE_SYSTEM_UNIFIED 0x4 +#define MEMORY_TYPE_VRAM_DEVICE 0x8 + +#define IS_PLATFORM(priv, p) ((priv)->info.platform_mask & BIT(p)) + +#define IS_PX210(priv) IS_PLATFORM(priv, PHYTIUM_PLATFORM_PX210) +#define IS_PE220X(priv) IS_PLATFORM(priv, PHYTIUM_PLATFORM_PE220X) + +struct phytium_device_info { + unsigned char platform_mask; + unsigned char pipe_mask; + unsigned char num_pipes; + unsigned char total_pipes; + unsigned char edp_mask; + unsigned int crtc_clock_max; + unsigned int hdisplay_max; + unsigned int vdisplay_max; + unsigned int backlight_max; + unsigned int backlight_min; + unsigned long address_mask; + struct pwm_device *pwm; +}; + +struct phytium_display_private { + /* hw */ + void __iomem *regs; + void __iomem *vram_addr; + struct phytium_device_info info; + char support_memory_type; + char reserve[3]; + uint32_t dc_reg_base[3]; + uint32_t dcreq_reg_base[3]; + uint32_t dp_reg_base[3]; + uint32_t address_transform_base; + uint32_t phy_access_base[3]; + + /* drm */ + struct drm_device *dev; + int irq; + + /* fb_dev */ + struct drm_fb_helper fbdev_helper; + struct phytium_gem_object *fbdev_phytium_gem; + + int save_reg[3]; + struct list_head gem_list_head; + + struct work_struct hotplug_work; + spinlock_t hotplug_irq_lock; + + void (*vram_hw_init)(struct phytium_display_private *priv); + void (*display_shutdown)(struct drm_device *dev); + int (*display_pm_suspend)(struct drm_device *dev); + int (*display_pm_resume)(struct drm_device *dev); + void (*dc_hw_clear_msi_irq)(struct phytium_display_private *priv, uint32_t phys_pipe); + int (*dc_hw_fb_format_check)(const struct drm_mode_fb_cmd2 *mode_cmd, int count); + + struct gen_pool *memory_pool; + resource_size_t pool_phys_addr; + resource_size_t pool_size; + void *pool_virt_addr; + uint64_t mem_state[PHYTIUM_MEM_STATE_TYPE_COUNT]; + + /* DMA info */ + int dma_inited; + struct dma_chan *dma_chan; + /*BL GPIO info*/ + struct gpio_desc *edp_bl_en, *edp_power_en; +}; + +static inline unsigned int +phytium_readl_reg(struct phytium_display_private *priv, uint32_t group_offset, uint32_t reg_offset) +{ + unsigned int data; + + data = readl(priv->regs + group_offset + reg_offset); +#if DEBUG_LOG + pr_info("Read 32'h%08x 32'h%08x\n", group_offset + reg_offset, data); +#endif + return data; +} + +static inline void +phytium_writel_reg(struct phytium_display_private *priv, uint32_t data, + uint32_t group_offset, uint32_t reg_offset) +{ + + writel(data, priv->regs + group_offset + reg_offset); +#if DEBUG_LOG + pr_info("Write 32'h%08x 32'h%08x\n", group_offset + reg_offset, data); +#endif +} + +static inline void +phytium_writeb_reg(struct phytium_display_private *priv, uint8_t data, + uint32_t group_offset, uint32_t reg_offset) +{ + writeb(data, priv->regs + group_offset + reg_offset); +#if DEBUG_LOG + pr_info("Write 32'h%08x 8'h%08x\n", group_offset + reg_offset, data); +#endif +} + +#define for_each_pipe(__dev_priv, __p) \ + for ((__p) = 0; (__p) < __dev_priv->info.total_pipes; (__p)++) + +#define for_each_pipe_masked(__dev_priv, __p) \ + for ((__p) = 0; (__p) < __dev_priv->info.total_pipes; (__p)++) \ + for_each_if((__dev_priv->info.pipe_mask) & BIT(__p)) + +int phytium_get_virt_pipe(struct phytium_display_private *priv, int phys_pipe); +int phytium_get_phys_pipe(struct phytium_display_private *priv, int virt_pipe); +int phytium_wait_cmd_done(struct phytium_display_private *priv, + uint32_t register_offset, + uint32_t request_bit, + uint32_t reply_bit); +void phytium_display_private_init(struct phytium_display_private *priv, struct drm_device *dev); + +extern struct drm_driver phytium_display_drm_driver; +extern int dc_fake_mode_enable; +extern int dc_fast_training_check; +extern int num_source_rates; +extern int source_max_lane_count; +extern int link_dynamic_adjust; + +#endif /* __PHYTIUM_DISPLAY_DRV_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_dp.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_dp.c new file mode 100644 index 0000000000000000000000000000000000000000..fdd91daf027b4386ca1f0eaae71c5d3fce292d75 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_dp.c @@ -0,0 +1,2649 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_dp.h" +#include "phytium_debugfs.h" +#include "px210_dp.h" +#include "pe220x_dp.h" +#include "phytium_panel.h" +#include "phytium_reg.h" + +static void phytium_dp_aux_init(struct phytium_dp_device *phytium_dp); +static void handle_plugged_change(struct phytium_dp_device *phytium_dp, bool plugged); +static bool phytium_edp_init_connector(struct phytium_dp_device *phytium_dp); +static void phytium_edp_fini_connector(struct phytium_dp_device *phytium_dp); +static void phytium_edp_panel_poweroff(struct phytium_dp_device *phytium_dp); +static void phytium_dp_audio_codec_fini(struct phytium_dp_device *phytium_dp); + +static int phytium_rate[] = {162000, 270000, 540000, 810000}; +static int codec_id = PHYTIUM_DP_AUDIO_ID; + +void phytium_phy_writel(struct phytium_dp_device *phytium_dp, uint32_t address, uint32_t data) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->phy_access_base[port]; + +#if DEBUG_LOG + pr_info("phy address write: 0x%x data:0x%x\n", address, data); +#endif + phytium_writel_reg(priv, address, group_offset, PHYTIUM_PHY_ACCESS_ADDRESS); + phytium_writel_reg(priv, data, group_offset, PHYTIUM_PHY_WRITE_DATA); + phytium_writel_reg(priv, ACCESS_WRITE, group_offset, PHYTIUM_PHY_ACCESS_CTRL); + udelay(10); +} + +uint32_t phytium_phy_readl(struct phytium_dp_device *phytium_dp, uint32_t address) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->phy_access_base[port]; + uint32_t data; + + phytium_writel_reg(priv, address, group_offset, PHYTIUM_PHY_ACCESS_ADDRESS); + phytium_writel_reg(priv, ACCESS_READ, group_offset, PHYTIUM_PHY_ACCESS_CTRL); + udelay(10); + data = phytium_readl_reg(priv, group_offset, PHYTIUM_PHY_READ_DATA); +#if DEBUG_LOG + pr_info("phy address read: 0x%x data:0x%x\n", address, data); +#endif + + return data; +} + +static int +phytium_dp_hw_aux_transfer_write(struct phytium_dp_device *phytium_dp, struct drm_dp_aux_msg *msg) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + unsigned int i = 0, j = 0; + unsigned int cmd = 0; + unsigned int aux_status = 0, interrupt_status = 0; + unsigned char *data = msg->buffer; + int count_timeout = 0; + long ret = 0; + + for (i = 0; i < 3; i++) { + /* clear PX210_DP_INTERRUPT_RAW_STATUS */ + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); + phytium_writel_reg(priv, msg->address, group_offset, PHYTIUM_DP_AUX_ADDRESS); + for (j = 0; j < msg->size; j++) + phytium_writeb_reg(priv, data[j], group_offset, PHYTIUM_DP_AUX_WRITE_FIFO); + + cmd = ((msg->request & COMMAND_MASK) << COMMAND_SHIFT); + if (msg->size == 0) + cmd |= ADDRESS_ONLY; + else + cmd |= (msg->size-1) & BYTE_COUNT_MASK; + phytium_writel_reg(priv, cmd, group_offset, PHYTIUM_DP_AUX_COMMAND); + + count_timeout = 0; + do { + mdelay(5); + interrupt_status = phytium_readl_reg(priv, group_offset, + PHYTIUM_DP_INTERRUPT_RAW_STATUS); + aux_status = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_STATUS); + if ((aux_status & REPLY_RECEIVED) || (aux_status & REPLY_ERROR) + || (interrupt_status & REPLY_TIMEOUT)) { + DRM_DEBUG_KMS("aux wait exit\n"); + break; + } + count_timeout++; + } while (count_timeout < 6); + + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); + if (interrupt_status & REPLY_TIMEOUT) { + DRM_DEBUG_KMS("aux write reply timeout\n"); + continue; + } else if (aux_status & REPLY_ERROR) { + DRM_DEBUG_KMS("aux write reply error\n"); + continue; + } else if (aux_status & REPLY_RECEIVED) { + DRM_DEBUG_KMS("aux write reply received succussful\n"); + break; + } + } + + if (interrupt_status & REPLY_TIMEOUT) { + DRM_NOTE("aux(%d) write reply timeout\n", phytium_dp->port); + ret = -EIO; + goto out; + } else if (aux_status & REPLY_ERROR) { + DRM_ERROR("aux(%d) write reply error\n", phytium_dp->port); + ret = -EIO; + goto out; + } else if ((aux_status & REPLY_RECEIVED) != REPLY_RECEIVED) { + DRM_ERROR("aux(%d) write reply no response\n", phytium_dp->port); + ret = -EIO; + goto out; + } + + msg->reply = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_CODE); + ret = msg->size; +out: + return ret; +} + +static int +phytium_dp_hw_aux_transfer_read(struct phytium_dp_device *phytium_dp, struct drm_dp_aux_msg *msg) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + unsigned int i = 0; + unsigned int cmd = 0; + unsigned int aux_status = 0, interrupt_status = 0; + unsigned char *data = msg->buffer; + int count_timeout = 0; + long ret = 0; + + for (i = 0; i < 3; i++) { + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); + phytium_writel_reg(priv, msg->address, group_offset, PHYTIUM_DP_AUX_ADDRESS); + cmd = ((msg->request & COMMAND_MASK) << COMMAND_SHIFT); + if (msg->size == 0) + cmd |= ADDRESS_ONLY; + else + cmd |= ((msg->size-1) & BYTE_COUNT_MASK); + phytium_writel_reg(priv, cmd, group_offset, PHYTIUM_DP_AUX_COMMAND); + + count_timeout = 0; + do { + mdelay(5); + interrupt_status = phytium_readl_reg(priv, group_offset, + PHYTIUM_DP_INTERRUPT_RAW_STATUS); + aux_status = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_STATUS); + if ((aux_status & REPLY_RECEIVED) || (aux_status & REPLY_ERROR) + || (interrupt_status & REPLY_TIMEOUT)) { + DRM_DEBUG_KMS("aux wait exit\n"); + break; + } + count_timeout++; + } while (count_timeout < 6); + + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); + if (interrupt_status & REPLY_TIMEOUT) { + DRM_DEBUG_KMS("aux read reply timeout\n"); + continue; + } else if (aux_status & REPLY_ERROR) { + DRM_DEBUG_KMS("aux read reply error\n"); + continue; + } else if (aux_status & REPLY_RECEIVED) { + DRM_DEBUG_KMS("aux read reply received succussful\n"); + break; + } + } + + if (interrupt_status & REPLY_TIMEOUT) { + DRM_NOTE("aux(%d) read reply timeout\n", phytium_dp->port); + ret = -EIO; + goto out; + } else if (aux_status & REPLY_ERROR) { + DRM_ERROR("aux(%d) read reply error\n", phytium_dp->port); + ret = -EIO; + goto out; + } else if ((aux_status & REPLY_RECEIVED) != REPLY_RECEIVED) { + DRM_ERROR("aux(%d) read reply no response\n", phytium_dp->port); + ret = -EIO; + goto out; + } + + msg->reply = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_CODE); + ret = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_DATA_COUNT); + + if (ret > msg->size) { + ret = msg->size; + } else if (ret != msg->size) { + DRM_DEBUG_KMS("aux read count error(ret:0x%lx != 0x%lx)\n", ret, msg->size); + ret = -EBUSY; + goto out; + } + + for (i = 0; i < ret; i++) + data[i] = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_AUX_REPLY_DATA); + +out: + return ret; +} + +static void phytium_get_native_mode(struct phytium_dp_device *phytium_dp) +{ + struct drm_display_mode *t, *mode; + struct drm_connector *connector = &phytium_dp->connector; + struct drm_display_mode *native_mode = &phytium_dp->native_mode; + + list_for_each_entry_safe(mode, t, &connector->probed_modes, head) { + if (mode->type & DRM_MODE_TYPE_PREFERRED) { + if (mode->hdisplay != native_mode->hdisplay || + mode->vdisplay != native_mode->vdisplay) { + memcpy(native_mode, mode, sizeof(*mode)); + drm_mode_set_crtcinfo(native_mode, 0); + } + break; + } + } + + if (&mode->head == &connector->probed_modes) + native_mode->clock = 0; +} + +static int phytium_connector_add_common_modes(struct phytium_dp_device *phytium_dp) +{ + int i = 0, ret = 0; + struct drm_device *dev = phytium_dp->dev; + struct drm_display_mode *mode = NULL, *current_mode = NULL; + struct drm_display_mode *native_mode = &phytium_dp->native_mode; + bool mode_existed = false; + struct mode_size { + char name[DRM_DISPLAY_MODE_LEN]; + int w; + int h; + } common_mode[] = { + { "640x480", 640, 480}, + { "800x600", 800, 600}, + { "1024x768", 1024, 768}, + { "1280x720", 1280, 720}, + { "1280x800", 1280, 800}, + {"1280x1024", 1280, 1024}, + { "1440x900", 1440, 900}, + {"1680x1050", 1680, 1050}, + {"1600x1200", 1600, 1200}, + {"1920x1080", 1920, 1080}, + {"1920x1200", 1920, 1200} + }; + + if (native_mode->clock == 0) + return ret; + + for (i = 0; i < ARRAY_SIZE(common_mode); i++) { + mode_existed = false; + + if (common_mode[i].w > native_mode->hdisplay || + common_mode[i].h > native_mode->vdisplay || + (common_mode[i].w == native_mode->hdisplay && + common_mode[i].h == native_mode->vdisplay)) + continue; + + list_for_each_entry(current_mode, &phytium_dp->connector.probed_modes, head) { + if (common_mode[i].w == current_mode->hdisplay && + common_mode[i].h == current_mode->vdisplay) { + mode_existed = true; + break; + } + } + + if (mode_existed) + continue; + + mode = drm_mode_duplicate(dev, native_mode); + if (mode == NULL) + continue; + + mode->hdisplay = common_mode[i].w; + mode->vdisplay = common_mode[i].h; + mode->type &= ~DRM_MODE_TYPE_PREFERRED; + strscpy(mode->name, common_mode[i].name, DRM_DISPLAY_MODE_LEN); + drm_mode_probed_add(&phytium_dp->connector, mode); + ret++; + } + + return ret; +} + +static int phytium_connector_get_modes(struct drm_connector *connector) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + struct edid *edid; + int ret = 0; + + if (phytium_dp->is_edp) + edid = phytium_dp->edp_edid; + else + edid = drm_get_edid(connector, &phytium_dp->aux.ddc); + + if (edid && drm_edid_is_valid(edid)) { + drm_connector_update_edid_property(connector, edid); + ret = drm_add_edid_modes(connector, edid); + phytium_dp->has_audio = drm_detect_monitor_audio(edid); + phytium_get_native_mode(phytium_dp); + if (dc_fake_mode_enable) + ret += phytium_connector_add_common_modes(phytium_dp); + } else { + drm_connector_update_edid_property(connector, NULL); + phytium_dp->has_audio = false; + } + + if (!phytium_dp->is_edp) + kfree(edid); + + return ret; +} + +static struct drm_encoder *phytium_dp_best_encoder(struct drm_connector *connector) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + return &phytium_dp->encoder; +} + +static const +struct drm_connector_helper_funcs phytium_connector_helper_funcs = { + .get_modes = phytium_connector_get_modes, + .best_encoder = phytium_dp_best_encoder, +}; + +static void phytium_dp_set_sink_rates(struct phytium_dp_device *phytium_dp) +{ + static const int dp_rates[] = {162000, 270000, 540000, 810000}; + int i, max_rate; + + max_rate = drm_dp_bw_code_to_link_rate(phytium_dp->dpcd[DP_MAX_LINK_RATE]); + for (i = 0; i < ARRAY_SIZE(dp_rates); i++) { + if (dp_rates[i] > max_rate) + break; + phytium_dp->sink_rates[i] = dp_rates[i]; + } + phytium_dp->num_sink_rates = i; +} + +static int get_common_rates(const int *source_rates, int source_len, const int *sink_rates, + int sink_len, int *common_rates) +{ + int i = 0, j = 0, k = 0; + + while (i < source_len && j < sink_len) { + if (source_rates[i] == sink_rates[j]) { + if (WARN_ON(k >= DP_MAX_SUPPORTED_RATES)) + return k; + common_rates[k] = source_rates[i]; + ++k; + ++i; + ++j; + } else if (source_rates[i] < sink_rates[j]) { + ++i; + } else { + ++j; + } + } + return k; +} + +static void phytium_dp_set_common_rates(struct phytium_dp_device *phytium_dp) +{ + WARN_ON(!phytium_dp->num_source_rates || !phytium_dp->num_sink_rates); + + phytium_dp->num_common_rates = get_common_rates(phytium_dp->source_rates, + phytium_dp->num_source_rates, + phytium_dp->sink_rates, + phytium_dp->num_sink_rates, + phytium_dp->common_rates); + + if (WARN_ON(phytium_dp->num_common_rates == 0)) { + phytium_dp->common_rates[0] = 162000; + phytium_dp->num_common_rates = 1; + } +} + +static bool phytium_dp_get_dpcd(struct phytium_dp_device *phytium_dp) +{ + int ret; + unsigned char sink_count = 0; + + /* get dpcd capability,but don't check data error; so check revision */ + ret = drm_dp_dpcd_read(&phytium_dp->aux, 0x00, phytium_dp->dpcd, + sizeof(phytium_dp->dpcd)); + if (ret < 0) { + DRM_ERROR("port %d get DPCD capability fail\n", phytium_dp->port); + return false; + } + + if (phytium_dp->dpcd[DP_DPCD_REV] == 0) { + DRM_ERROR("DPCD data error: 0x%x\n", phytium_dp->dpcd[DP_DPCD_REV]); + return false; + } + + /* parse sink support link */ + phytium_dp_set_sink_rates(phytium_dp); + phytium_dp_set_common_rates(phytium_dp); + phytium_dp->sink_max_lane_count = drm_dp_max_lane_count(phytium_dp->dpcd); + phytium_dp->common_max_lane_count = min(phytium_dp->source_max_lane_count, + phytium_dp->sink_max_lane_count); + + /* get dpcd sink count */ + if (drm_dp_dpcd_readb(&phytium_dp->aux, DP_SINK_COUNT, &sink_count) <= 0) { + DRM_ERROR("get DPCD sink_count fail\n"); + return false; + } + + phytium_dp->sink_count = DP_GET_SINK_COUNT(sink_count); + if (!phytium_dp->sink_count) { + DRM_ERROR("DPCD sink_count should not be zero\n"); + return false; + } + + if (!drm_dp_is_branch(phytium_dp->dpcd)) + return true; + + if (phytium_dp->dpcd[DP_DPCD_REV] == 0x10) + return true; + + /* get downstream port for branch device */ + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_DOWNSTREAM_PORT_0, + phytium_dp->downstream_ports, DP_MAX_DOWNSTREAM_PORTS); + if (ret < 0) { + DRM_ERROR("get DPCD DFP fail\n"); + return false; + } + + return true; +} + +static enum drm_connector_status +phytium_dp_detect_dpcd(struct phytium_dp_device *phytium_dp) +{ + if (!phytium_dp_get_dpcd(phytium_dp)) + return connector_status_disconnected; + + if (!drm_dp_is_branch(phytium_dp->dpcd)) + return connector_status_connected; + + if (phytium_dp->downstream_ports[0] & DP_DS_PORT_HPD) { + return phytium_dp->sink_count ? connector_status_connected + : connector_status_disconnected; + } + return connector_status_connected; +} + +static void phytium_get_adjust_train(struct phytium_dp_device *phytium_dp, + const uint8_t link_status[DP_LINK_STATUS_SIZE], uint8_t lane_count) +{ + unsigned char v = 0; + unsigned char p = 0; + int lane; + unsigned char voltage_max; + unsigned char preemph_max; + + /* find max value */ + for (lane = 0; lane < lane_count; lane++) { + uint8_t this_v = drm_dp_get_adjust_request_voltage(link_status, lane); + uint8_t this_p = drm_dp_get_adjust_request_pre_emphasis(link_status, lane); + + if (this_v > v) + v = this_v; + if (this_p > p) + p = this_p; + } + voltage_max = DP_TRAIN_VOLTAGE_SWING_LEVEL_3; + if (v >= voltage_max) + v = voltage_max | DP_TRAIN_MAX_SWING_REACHED; + + preemph_max = DP_TRAIN_PRE_EMPH_LEVEL_3; + if (p >= preemph_max) + p = preemph_max | DP_TRAIN_MAX_PRE_EMPHASIS_REACHED; + + for (lane = 0; lane < 4; lane++) + phytium_dp->train_set[lane] = v | p; +} + +bool phytium_dp_coding_8b10b_need_enable(unsigned char test_pattern) +{ + switch (test_pattern) { + case PHYTIUM_PHY_TP_D10_2: + case PHYTIUM_PHY_TP_SYMBOL_ERROR: + case PHYTIUM_PHY_TP_CP2520_1: + case PHYTIUM_PHY_TP_CP2520_2: + case PHYTIUM_PHY_TP_CP2520_3: + return true; + case PHYTIUM_PHY_TP_PRBS7: + case PHYTIUM_PHY_TP_80BIT_CUSTOM: + return false; + default: + return false; + } +} + +bool phytium_dp_scrambled_need_enable(unsigned char test_pattern) +{ + switch (test_pattern) { + case PHYTIUM_PHY_TP_SYMBOL_ERROR: + case PHYTIUM_PHY_TP_CP2520_1: + case PHYTIUM_PHY_TP_CP2520_2: + case PHYTIUM_PHY_TP_CP2520_3: + return true; + case PHYTIUM_PHY_TP_D10_2: + case PHYTIUM_PHY_TP_PRBS7: + case PHYTIUM_PHY_TP_80BIT_CUSTOM: + return false; + default: + return false; + } +} + +static void phytium_dp_hw_set_lane_setting(struct phytium_dp_device *phytium_dp, + uint32_t link_rate, + uint8_t train_set) +{ + phytium_dp->funcs->dp_hw_set_phy_lane_setting(phytium_dp, link_rate, train_set); +} + +static void phytium_dp_hw_set_link(struct phytium_dp_device *phytium_dp, + uint8_t lane_count, + uint32_t link_rate) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, ret = 0, retry = 3; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, lane_count, + group_offset, PHYTIUM_DP_LANE_COUNT_SET); + phytium_writel_reg(priv, + drm_dp_link_rate_to_bw_code(link_rate), + group_offset, PHYTIUM_DP_LINK_BW_SET); + + if (drm_dp_enhanced_frame_cap(phytium_dp->dpcd)) + phytium_writel_reg(priv, ENHANCED_FRAME_ENABLE, + group_offset, PHYTIUM_DP_ENHANCED_FRAME_EN); + else + phytium_writel_reg(priv, ENHANCED_FRAME_DISABLE, + group_offset, PHYTIUM_DP_ENHANCED_FRAME_EN); + +try_again: + ret = phytium_dp->funcs->dp_hw_set_phy_lane_and_rate(phytium_dp, lane_count, link_rate); + if ((ret < 0) && retry) { + retry--; + goto try_again; + } +} + +static void phytium_dp_hw_set_test_pattern(struct phytium_dp_device *phytium_dp, + uint8_t lane_count, + uint8_t test_pattern, + uint8_t *custom_pattern, + uint32_t custom_pattern_size) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, val = 0, tmp = 0, i; + uint32_t group_offset = priv->dp_reg_base[port]; + + if ((test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) + && custom_pattern && (custom_pattern_size > 0)) { + val = *(int *)custom_pattern; + phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_0); + val = *(int *)(custom_pattern + 4); + phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_1); + val = *(short int *)(custom_pattern + 8); + phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_CUSTOM_80BIT_PATTERN_2); + } + + if (test_pattern == PHYTIUM_PHY_TP_D10_2 || test_pattern == PHYTIUM_PHY_TP_PRBS7 + || test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) + phytium_writel_reg(priv, SCRAMBLING_DISABLE, group_offset, + PHYTIUM_DP_SCRAMBLING_DISABLE); + else + phytium_writel_reg(priv, SCRAMBLING_ENABLE, group_offset, + PHYTIUM_DP_SCRAMBLING_DISABLE); + + tmp = test_pattern - PHYTIUM_PHY_TP_NONE + TEST_PATTERN_NONE; + val = 0; + for (i = 0; i < lane_count; i++) + val |= (tmp << (TEST_PATTERN_LANE_SHIFT * i)); + phytium_writel_reg(priv, val, group_offset, PHYTIUM_DP_LINK_QUAL_PATTERN_SET); +} + +static void phytium_dp_hw_set_train_pattern(struct phytium_dp_device *phytium_dp, + uint8_t train_pattern) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, tmp = 0; + uint32_t group_offset = priv->dp_reg_base[port]; + + /* Scrambling is disabled for TPS1/TPS2/3 and enabled for TPS4 */ + if (train_pattern == DP_TRAINING_PATTERN_4 + || train_pattern == DP_TRAINING_PATTERN_DISABLE) { + phytium_writel_reg(priv, SCRAMBLING_ENABLE, group_offset, + PHYTIUM_DP_SCRAMBLING_DISABLE); + phytium_writel_reg(priv, SCRAMBLER_RESET, group_offset, + PHYTIUM_DP_FORCE_SCRAMBLER_RESET); + } else { + phytium_writel_reg(priv, SCRAMBLING_DISABLE, group_offset, + PHYTIUM_DP_SCRAMBLING_DISABLE); + } + switch (train_pattern) { + case DP_TRAINING_PATTERN_DISABLE: + tmp = TRAINING_OFF; + break; + case DP_TRAINING_PATTERN_1: + tmp = TRAINING_PATTERN_1; + break; + case DP_TRAINING_PATTERN_2: + tmp = TRAINING_PATTERN_2; + break; + case DP_TRAINING_PATTERN_3: + tmp = TRAINING_PATTERN_3; + break; + case DP_TRAINING_PATTERN_4: + tmp = TRAINING_PATTERN_4; + break; + default: + tmp = TRAINING_OFF; + break; + } + + phytium_writel_reg(priv, tmp, group_offset, PHYTIUM_DP_TRAINING_PATTERN_SET); +} + +void phytium_dp_hw_enable_audio(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + int config = 0, config1, data_window = 0; + const struct dp_audio_n_m *n_m = NULL; + uint32_t group_offset = priv->dp_reg_base[port]; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); + phytium_writel_reg(priv, CHANNEL_MUTE_ENABLE, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); + + data_window = 90*(phytium_dp->link_rate)/100 + *(phytium_dp->mode.htotal - phytium_dp->mode.hdisplay) + /phytium_dp->mode.clock/4; + + phytium_writel_reg(priv, data_window, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW); + + n_m = phytium_dp_audio_get_n_m(phytium_dp->link_rate, phytium_dp->audio_info.sample_rate); + if (n_m == NULL) { + DRM_NOTE("can not get n_m for link_rate(%d) and sample_rate(%d)\n", + phytium_dp->link_rate, phytium_dp->audio_info.sample_rate); + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_MAUD); + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_NAUD); + } else { + phytium_writel_reg(priv, n_m->m, group_offset, PHYTIUM_DP_SEC_MAUD); + phytium_writel_reg(priv, n_m->n, group_offset, PHYTIUM_DP_SEC_NAUD); + } + + config1 = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); + phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, + group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); + phytium_writel_reg(priv, config1, group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); + phytium_writel_reg(priv, config, group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); +} + +static void phytium_dp_hw_audio_shutdown(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, + group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); +} + +static void phytium_dp_hw_audio_digital_mute(struct phytium_dp_device *phytium_dp, bool enable) +{ + struct phytium_display_private *priv = phytium_dp->dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + if (enable) + phytium_writel_reg(priv, CHANNEL_MUTE_ENABLE, + group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); + else + phytium_writel_reg(priv, SEC_AUDIO_ENABLE, + group_offset, PHYTIUM_DP_SEC_AUDIO_ENABLE); +} + +static int +phytium_dp_hw_audio_hw_params(struct phytium_dp_device *phytium_dp, struct audio_info audio_info) +{ + struct phytium_display_private *priv = phytium_dp->dev->dev_private; + int port = phytium_dp->port; + int ret = 0, data_window = 0; + const struct dp_audio_n_m *n_m = NULL; + uint32_t fs, ws, fs_accurac; + uint32_t group_offset = priv->dp_reg_base[port]; + + DRM_DEBUG_KMS("%s:set port%d sample_rate(%d) channels(%d) sample_width(%d)\n", + __func__, phytium_dp->port, audio_info.sample_rate, + audio_info.channels, audio_info.sample_width); + + phytium_writel_reg(priv, INPUT_SELECT_I2S, group_offset, PHYTIUM_DP_SEC_INPUT_SELECT); + phytium_writel_reg(priv, APB_CLOCK/audio_info.sample_rate, + group_offset, PHYTIUM_DP_SEC_DIRECT_CLKDIV); + phytium_writel_reg(priv, audio_info.channels & CHANNEL_MASK, + group_offset, PHYTIUM_DP_SEC_CHANNEL_COUNT); + phytium_writel_reg(priv, CHANNEL_MAP_DEFAULT, group_offset, PHYTIUM_DP_SEC_CHANNEL_MAP); + data_window = 90*(phytium_dp->link_rate)/100 + *(phytium_dp->mode.htotal - phytium_dp->mode.hdisplay) + /phytium_dp->mode.clock/4; + phytium_writel_reg(priv, data_window, group_offset, PHYTIUM_DP_SEC_DATA_WINDOW); + phytium_writel_reg(priv, 0xb5, group_offset, PHYTIUM_DP_SEC_CS_CATEGORY_CODE); + + phytium_writel_reg(priv, CLOCK_MODE_SYNC, group_offset, PHYTIUM_DP_SEC_CLOCK_MODE); + phytium_writel_reg(priv, CS_SOURCE_FORMAT_DEFAULT, + group_offset, PHYTIUM_DP_SEC_CS_SOURCE_FORMAT); + + switch (audio_info.sample_rate) { + case 32000: + fs = ORIG_FREQ_32000; + fs_accurac = SAMPLING_FREQ_32000; + break; + case 44100: + fs = ORIG_FREQ_44100; + fs_accurac = SAMPLING_FREQ_44100; + break; + case 48000: + fs = ORIG_FREQ_48000; + fs_accurac = SAMPLING_FREQ_48000; + break; + case 96000: + fs = ORIG_FREQ_96000; + fs_accurac = SAMPLING_FREQ_96000; + break; + case 176400: + fs = ORIG_FREQ_176400; + fs_accurac = SAMPLING_FREQ_176400; + break; + case 192000: + fs = ORIG_FREQ_192000; + fs_accurac = SAMPLING_FREQ_192000; + break; + default: + DRM_ERROR("dp not support sample_rate %d\n", audio_info.sample_rate); + goto out; + } + + switch (audio_info.sample_width) { + case 16: + ws = WORD_LENGTH_16; + break; + case 18: + ws = WORD_LENGTH_18; + break; + case 20: + ws = WORD_LENGTH_20; + break; + case 24: + ws = WORD_LENGTH_24; + break; + default: + DRM_ERROR("dp not support sample_width %d\n", audio_info.sample_width); + goto out; + } + + phytium_writel_reg(priv, ((fs&ORIG_FREQ_MASK)<link_rate, audio_info.sample_rate); + if (n_m == NULL) { + DRM_NOTE("can not get n_m for link_rate(%d) and sample_rate(%d)\n", + phytium_dp->link_rate, audio_info.sample_rate); + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_MAUD); + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_SEC_NAUD); + + } else { + phytium_writel_reg(priv, n_m->m, group_offset, PHYTIUM_DP_SEC_MAUD); + phytium_writel_reg(priv, n_m->n, group_offset, PHYTIUM_DP_SEC_NAUD); + } + phytium_writel_reg(priv, SECONDARY_STREAM_ENABLE, + group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); + phytium_dp->audio_info = audio_info; + + return 0; + +out: + phytium_writel_reg(priv, SECONDARY_STREAM_DISABLE, + group_offset, PHYTIUM_DP_SECONDARY_STREAM_ENABLE); + + return ret; +} + +void phytium_dp_hw_disable_video(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, SST_MST_SOURCE_0_DISABLE, + group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); +} + +bool phytium_dp_hw_video_is_enable(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, config; + uint32_t group_offset = priv->dp_reg_base[port]; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); + return config ? true : false; +} + +void phytium_dp_hw_enable_video(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, SST_MST_SOURCE_0_ENABLE, + group_offset, PHYTIUM_DP_VIDEO_STREAM_ENABLE); + phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); +} + +void phytium_dp_hw_config_video(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + unsigned long link_bw, date_rate = 0; + struct drm_display_info *display_info = &phytium_dp->connector.display_info; + unsigned char tu_size = 64; + unsigned long data_per_tu = 0; + int symbols_per_tu, frac_symbols_per_tu, symbol_count, udc, value; + + /* cal M/N and tu_size */ + phytium_writel_reg(priv, phytium_dp->mode.crtc_clock/10, group_offset, PHYTIUM_DP_M_VID); + phytium_writel_reg(priv, phytium_dp->link_rate/10, group_offset, PHYTIUM_DP_N_VID); + link_bw = phytium_dp->link_rate * phytium_dp->link_lane_count; + date_rate = (phytium_dp->mode.crtc_clock * display_info->bpc * 3)/8; + + /* mul 10 for register setting */ + data_per_tu = 10*tu_size * date_rate/link_bw; + symbols_per_tu = (data_per_tu/10)&0xff; + if (symbols_per_tu == 63) + frac_symbols_per_tu = 0; + else + frac_symbols_per_tu = (data_per_tu%10*16/10) & 0xf; + phytium_writel_reg(priv, frac_symbols_per_tu<<24 | symbols_per_tu<<16 | tu_size, + group_offset, PHYTIUM_DP_TRANSFER_UNIT_SIZE); + + symbol_count = (phytium_dp->mode.crtc_hdisplay*display_info->bpc*3 + 7)/8; + udc = (symbol_count + phytium_dp->link_lane_count - 1)/phytium_dp->link_lane_count; + phytium_writel_reg(priv, udc, group_offset, PHYTIUM_DP_DATA_COUNT); + + /* config main stream attributes */ + phytium_writel_reg(priv, phytium_dp->mode.crtc_htotal, + group_offset, PHYTIUM_DP_MAIN_LINK_HTOTAL); + phytium_writel_reg(priv, phytium_dp->mode.crtc_hdisplay, + group_offset, PHYTIUM_DP_MAIN_LINK_HRES); + phytium_writel_reg(priv, + phytium_dp->mode.crtc_hsync_end - phytium_dp->mode.crtc_hsync_start, + group_offset, PHYTIUM_DP_MAIN_LINK_HSWIDTH); + phytium_writel_reg(priv, phytium_dp->mode.crtc_htotal - phytium_dp->mode.crtc_hsync_start, + group_offset, PHYTIUM_DP_MAIN_LINK_HSTART); + phytium_writel_reg(priv, phytium_dp->mode.crtc_vtotal, + group_offset, PHYTIUM_DP_MAIN_LINK_VTOTAL); + phytium_writel_reg(priv, phytium_dp->mode.crtc_vdisplay, + group_offset, PHYTIUM_DP_MAIN_LINK_VRES); + phytium_writel_reg(priv, + phytium_dp->mode.crtc_vsync_end - phytium_dp->mode.crtc_vsync_start, + group_offset, PHYTIUM_DP_MAIN_LINK_VSWIDTH); + phytium_writel_reg(priv, phytium_dp->mode.crtc_vtotal - phytium_dp->mode.crtc_vsync_start, + group_offset, PHYTIUM_DP_MAIN_LINK_VSTART); + + value = 0; + if (phytium_dp->mode.flags & DRM_MODE_FLAG_PHSYNC) + value = value & (~HSYNC_POLARITY_LOW); + else + value = value | HSYNC_POLARITY_LOW; + + if (phytium_dp->mode.flags & DRM_MODE_FLAG_PVSYNC) + value = value & (~VSYNC_POLARITY_LOW); + else + value = value | VSYNC_POLARITY_LOW; + phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_MAIN_LINK_POLARITY); + + switch (display_info->bpc) { + case 10: + value = (MISC0_BIT_DEPTH_10BIT << MISC0_BIT_DEPTH_OFFSET); + break; + case 6: + value = (MISC0_BIT_DEPTH_6BIT << MISC0_BIT_DEPTH_OFFSET); + break; + default: + value = (MISC0_BIT_DEPTH_8BIT << MISC0_BIT_DEPTH_OFFSET); + break; + } + value |= (MISC0_COMPONENT_FORMAT_RGB << MISC0_COMPONENT_FORMAT_SHIFT) + | MISC0_SYNCHRONOUS_CLOCK; + phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_MAIN_LINK_MISC0); + phytium_writel_reg(priv, 0, group_offset, PHYTIUM_DP_MAIN_LINK_MISC1); + + value = USER_ODDEVEN_POLARITY_HIGH | USER_DATA_ENABLE_POLARITY_HIGH; + if (phytium_dp->mode.flags & DRM_MODE_FLAG_PHSYNC) + value = value | USER_HSYNC_POLARITY_HIGH; + else + value = value & (~USER_HSYNC_POLARITY_HIGH); + if (phytium_dp->mode.flags & DRM_MODE_FLAG_PVSYNC) + value = value | USER_VSYNC_POLARITY_HIGH; + else + value = value & (~USER_VSYNC_POLARITY_HIGH); + phytium_writel_reg(priv, value, group_offset, PHYTIUM_DP_USER_SYNC_POLARITY); +} + +void phytium_dp_hw_disable_output(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, TRANSMITTER_OUTPUT_DISABLE, + group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); + phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); +} + +void phytium_dp_hw_enable_output(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, LINK_SOFT_RESET, group_offset, PHYTIUM_DP_SOFT_RESET); + phytium_writel_reg(priv, TRANSMITTER_OUTPUT_ENABLE, + group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); +} + +void phytium_dp_hw_enable_input_source(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_writel_reg(priv, VIRTUAL_SOURCE_0_ENABLE, + group_offset, PHYTIUM_INPUT_SOURCE_ENABLE); +} + +void phytium_dp_hw_disable_input_source(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + + phytium_writel_reg(priv, (~VIRTUAL_SOURCE_0_ENABLE)&VIRTUAL_SOURCE_0_ENABLE_MASK, + priv->dp_reg_base[port], PHYTIUM_INPUT_SOURCE_ENABLE); +} + +bool phytium_dp_hw_output_is_enable(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + int config = 0; + + config = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE); + return config ? true : false; +} + +static void phytium_dp_hw_get_hpd_state(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t val = 0, raw_state = 0; + uint32_t group_offset = priv->dp_reg_base[port]; + + val = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_RAW_STATUS); + + /* maybe miss hpd, so used for clear PHYTIUM_DP_INTERRUPT_RAW_STATUS */ + phytium_readl_reg(priv, group_offset, PHYTIUM_DP_INTERRUPT_STATUS); + raw_state = phytium_readl_reg(priv, group_offset, PHYTIUM_DP_SINK_HPD_STATE); + if (val & HPD_EVENT) + phytium_dp->dp_hpd_state.hpd_event_state = true; + + if (val & HPD_IRQ) + phytium_dp->dp_hpd_state.hpd_irq_state = true; + + if (raw_state & HPD_CONNECT) + phytium_dp->dp_hpd_state.hpd_raw_state = true; + else + phytium_dp->dp_hpd_state.hpd_raw_state = false; +} + +void phytium_dp_hw_hpd_irq_setup(struct phytium_dp_device *phytium_dp, bool enable) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dp_reg_base[port]; + + phytium_dp->dp_hpd_state.hpd_irq_enable = enable; + if (enable) + phytium_writel_reg(priv, HPD_OTHER_MASK, group_offset, PHYTIUM_DP_INTERRUPT_MASK); + else + phytium_writel_reg(priv, HPD_IRQ_MASK|HPD_EVENT_MASK|HPD_OTHER_MASK, + group_offset, PHYTIUM_DP_INTERRUPT_MASK); +} + +int phytium_dp_hw_init(struct phytium_dp_device *phytium_dp) +{ + int ret = 0; + uint8_t count = 0; + + phytium_dp->source_rates = phytium_rate; + phytium_dp->num_source_rates = num_source_rates; + count = phytium_dp->funcs->dp_hw_get_source_lane_count(phytium_dp); + phytium_dp->source_max_lane_count = count; + + ret = phytium_dp->funcs->dp_hw_reset(phytium_dp); + if (ret) + goto out; + ret = phytium_dp->funcs->dp_hw_init_phy(phytium_dp); + if (ret) + goto out; + + phytium_dp->fast_train_support = false; + phytium_dp->hw_spread_enable = phytium_dp->funcs->dp_hw_spread_is_enable(phytium_dp); + +out: + return ret; +} + +static int phytium_dp_dpcd_get_tp_link(struct phytium_dp_device *phytium_dp, + uint8_t *test_lane_count, + uint32_t *test_link_rate) +{ + uint8_t test_link_bw; + int ret; + + ret = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_LANE_COUNT, + test_lane_count); + if (ret <= 0) { + DRM_DEBUG_KMS("test pattern Lane count read failed(%d)\n", ret); + goto failed; + } + + ret = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_LINK_RATE, + &test_link_bw); + if (ret <= 0) { + DRM_DEBUG_KMS("test pattern link rate read failed(%d)\n", ret); + goto failed; + } + *test_link_rate = drm_dp_bw_code_to_link_rate(test_link_bw); + + return 0; +failed: + return ret; +} + +static int phytium_dp_dpcd_set_link(struct phytium_dp_device *phytium_dp, + uint8_t lane_count, uint32_t link_rate) +{ + uint8_t link_config[2]; + int ret = 0; + + link_config[0] = drm_dp_link_rate_to_bw_code(link_rate); + link_config[1] = lane_count; + if (drm_dp_enhanced_frame_cap(phytium_dp->dpcd)) + link_config[1] |= DP_LANE_COUNT_ENHANCED_FRAME_EN; + ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_LINK_BW_SET, link_config, 2); + if (ret < 0) { + DRM_NOTE("write dpcd DP_LINK_BW_SET fail: ret:%d\n", ret); + goto failed; + } + + if (phytium_dp->hw_spread_enable) + link_config[0] = DP_SPREAD_AMP_0_5; + else + link_config[0] = 0; + link_config[1] = DP_SET_ANSI_8B10B; + ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_DOWNSPREAD_CTRL, link_config, 2); + if (ret < 0) { + DRM_ERROR("write DP_DOWNSPREAD_CTRL fail: ret:%d\n", ret); + goto failed; + } + + return 0; +failed: + return ret; +} + +static int phytium_dp_dpcd_set_test_pattern(struct phytium_dp_device *phytium_dp, + uint8_t test_pattern) +{ + unsigned char value; + int ret; + + if (phytium_dp_coding_8b10b_need_enable(test_pattern)) + value = DP_SET_ANSI_8B10B; + else + value = 0; + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_MAIN_LINK_CHANNEL_CODING_SET, value); + if (ret < 0) { + DRM_ERROR("write DP_MAIN_LINK_CHANNEL_CODING_SET fail: ret:%d\n", ret); + goto failed; + } + + if (phytium_dp_scrambled_need_enable(test_pattern)) + value = DP_TRAINING_PATTERN_DISABLE; + else + value = (DP_TRAINING_PATTERN_DISABLE | DP_LINK_SCRAMBLING_DISABLE); + + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TRAINING_PATTERN_SET, value); + if (ret < 0) { + DRM_ERROR("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); + goto failed; + } + + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_LINK_QUAL_LANE0_SET, test_pattern); + if (ret < 0) { + DRM_ERROR("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); + goto failed; + } + + return 0; +failed: + return ret; +} + +static int phytium_dp_dpcd_set_train_pattern(struct phytium_dp_device *phytium_dp, + uint8_t train_pattern) +{ + uint8_t value; + int ret; + + /* Scrambling is disabled for TPS1/2/3 and enabled for TPS4 */ + if (train_pattern == DP_TRAINING_PATTERN_4 || train_pattern == DP_TRAINING_PATTERN_DISABLE) + value = train_pattern; + else + value = (train_pattern | DP_LINK_SCRAMBLING_DISABLE); + + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TRAINING_PATTERN_SET, value); + if (ret < 0) { + DRM_NOTE("write DP_TRAINING_PATTERN_SET fail: ret:%d\n", ret); + goto failed; + } + + return 0; +failed: + return ret; +} + +static int +phytium_dp_dpcd_set_lane_setting(struct phytium_dp_device *phytium_dp, uint8_t *train_set) +{ + int ret = 0; + + ret = drm_dp_dpcd_write(&phytium_dp->aux, DP_TRAINING_LANE0_SET, + phytium_dp->train_set, 4); + if (ret < 0) { + DRM_ERROR("write DP_TRAINING_LANE0_SET fail: ret:%d\n", ret); + return ret; + } + + return 0; +} + +static int +phytium_dp_dpcd_get_adjust_request(struct phytium_dp_device *phytium_dp, uint8_t lane_count) +{ + int ret = 0; + uint8_t link_status[DP_LINK_STATUS_SIZE]; + + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, + link_status, DP_LINK_STATUS_SIZE); + if (ret < 0) { + DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); + goto failed; + } + phytium_get_adjust_train(phytium_dp, link_status, lane_count); + + return 0; +failed: + return ret; +} + +void phytium_dp_dpcd_sink_dpms(struct phytium_dp_device *phytium_dp, int mode) +{ + int ret, i; + + if (phytium_dp->dpcd[DP_DPCD_REV] < 0x11) + return; + if (mode != DRM_MODE_DPMS_ON) { + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_SET_POWER, DP_SET_POWER_D3); + } else { + for (i = 0; i < 3; i++) { + ret = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_SET_POWER, DP_SET_POWER_D0); + if (ret == 1) + break; + msleep(20); + } + } + + if (ret != 1) + DRM_DEBUG_KMS("failed to %s sink power state\n", + mode == DRM_MODE_DPMS_ON ? "enable" : "disable"); +} + +static bool phytium_dp_link_training_clock_recovery(struct phytium_dp_device *phytium_dp) +{ + int ret; + unsigned char voltage, max_vswing_tries; + int voltage_tries; + + /* clear the test pattern */ + phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->link_lane_count, + PHYTIUM_PHY_TP_NONE, NULL, 0); + + /* config source and sink's link rate and lane count */ + phytium_dp_hw_set_link(phytium_dp, phytium_dp->link_lane_count, phytium_dp->link_rate); + ret = phytium_dp_dpcd_set_link(phytium_dp, phytium_dp->link_lane_count, + phytium_dp->link_rate); + if (ret < 0) { + DRM_NOTE("phytium_dp_dpcd_set_link failed(ret=%d)\n", ret); + return false; + } + + /* config source's voltage swing and pre-emphasis(103-106) */ + memset(phytium_dp->train_set, 0, sizeof(phytium_dp->train_set)); + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, + phytium_dp->train_set[0]); + + /* config train pattern */ + phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); + ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); + return false; + } + + /* config sink's voltage swing and pre-emphasis(103-106) */ + ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); + return false; + } + + voltage_tries = 1; + max_vswing_tries = 0; + for (;;) { + unsigned char link_status[DP_LINK_STATUS_SIZE]; + + drm_dp_link_train_clock_recovery_delay(&phytium_dp->aux, phytium_dp->dpcd); + /* get link status 0x202-0x207 */ + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, + link_status, DP_LINK_STATUS_SIZE); + if (ret < 0) { + DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); + return false; + } + + if (drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("clock revorery ok\n"); + return true; + } + + if (voltage_tries == 5) { + DRM_DEBUG_KMS("Same voltage tried 5 times\n"); + return false; + } + + if (max_vswing_tries == 1) { + DRM_DEBUG_KMS("Max Voltage Swing reached\n"); + return false; + } + + voltage = phytium_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK; + + /* config source and sink's voltage swing and pre-emphasis(103-106) */ + phytium_get_adjust_train(phytium_dp, link_status, phytium_dp->link_lane_count); + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, + phytium_dp->train_set[0]); + ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); + return false; + } + + if ((phytium_dp->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK) == voltage) + ++voltage_tries; + else + voltage_tries = 1; + + if (phytium_dp->train_set[0] & DP_TRAIN_MAX_SWING_REACHED) + ++max_vswing_tries; + + DRM_DEBUG_KMS("try train_set:0x%x voltage_tries:%d max_vswing_tries:%d\n", + phytium_dp->train_set[0], voltage_tries, max_vswing_tries); + } +} + +static unsigned int phytium_dp_get_training_pattern(struct phytium_dp_device *phytium_dp) +{ + bool sink_tps3, sink_tps4; + + sink_tps4 = drm_dp_tps4_supported(phytium_dp->dpcd); + if (sink_tps4) + return DP_TRAINING_PATTERN_4; + else if (phytium_dp->link_rate == 810000) + DRM_DEBUG_KMS("8.1 Gbps link rate without sink TPS4 support\n"); + + sink_tps3 = drm_dp_tps3_supported(phytium_dp->dpcd); + if (sink_tps3) + return DP_TRAINING_PATTERN_3; + else if (phytium_dp->link_rate >= 540000) + DRM_DEBUG_KMS(">=5.4/6.48 Gbps link rate without sink TPS3 support\n"); + + return DP_TRAINING_PATTERN_2; +} + +static bool phytium_dp_link_training_channel_equalization(struct phytium_dp_device *phytium_dp) +{ + unsigned int training_pattern; + int tries, ret; + unsigned char link_status[DP_LINK_STATUS_SIZE]; + bool channel_eq = false; + + /* config source and sink's voltage swing and pre-emphasis(103-106), from clock recovery */ + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, + phytium_dp->train_set[0]); + ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); + return channel_eq; + } + + /* config source and sink's train_pattern x */ + training_pattern = phytium_dp_get_training_pattern(phytium_dp); + phytium_dp_hw_set_train_pattern(phytium_dp, training_pattern); + ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, training_pattern); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); + return channel_eq; + } + + for (tries = 0; tries < 5; tries++) { + drm_dp_link_train_channel_eq_delay(&phytium_dp->aux, phytium_dp->dpcd); + + /* get link status 0x202-0x207 */ + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, + link_status, DP_LINK_STATUS_SIZE); + if (ret < 0) { + DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); + break; + } + + /* Make sure clock is still ok */ + if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("CR check failed, cannot continue channel equalization\n"); + break; + } + + if (drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { + channel_eq = true; + DRM_DEBUG_KMS("Channel EQ done. DP Training successful\n"); + break; + } + + /* config source and sink's voltage swing and pre-emphasis(103-106) */ + phytium_get_adjust_train(phytium_dp, link_status, phytium_dp->link_lane_count); + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, + phytium_dp->train_set[0]); + ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); + break; + } + } + + /* Try 5 times, else fail and try at lower BW */ + if (tries == 5) + DRM_DEBUG_KMS("Channel equalization failed 5 times\n"); + + return channel_eq; +} + +static void phytium_dp_train_retry_work_fn(struct work_struct *work) +{ + struct phytium_dp_device *phytium_dp = train_retry_to_dp_device(work); + struct drm_connector *connector; + + connector = &phytium_dp->connector; + DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector->base.id, connector->name); + mutex_lock(&connector->dev->mode_config.mutex); + drm_connector_set_link_status_property(connector, DRM_MODE_LINK_STATUS_BAD); + mutex_unlock(&connector->dev->mode_config.mutex); + drm_kms_helper_hotplug_event(connector->dev); +} + +/* return index of rate in rates array, or -1 if not found */ +static int phytium_dp_rate_index(const int *rates, int len, int rate) +{ + int i; + + for (i = 0; i < len; i++) + if (rate == rates[i]) + return i; + + return -1; +} + +int phytium_dp_get_link_train_fallback_values(struct phytium_dp_device *phytium_dp) +{ + int index, ret = 0; + + if (phytium_dp->is_edp) { + phytium_dp->train_retry_count++; + DRM_INFO("Retrying Link training for eDP(%d) with same parameters\n", + phytium_dp->port); + goto out; + } else { + index = phytium_dp_rate_index(phytium_dp->common_rates, + phytium_dp->num_common_rates, + phytium_dp->link_rate); + if (index > 0) { + phytium_dp->link_rate = phytium_dp->common_rates[index - 1]; + } else if (phytium_dp->link_lane_count > 1) { + phytium_dp->link_rate = phytium_dp->max_link_rate; + phytium_dp->link_lane_count = phytium_dp->link_lane_count >> 1; + } else { + phytium_dp->train_retry_count++; + phytium_dp->link_rate = phytium_dp->max_link_rate; + phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; + DRM_INFO("Retrying Link training for DP(%d) with maximal parameters\n", + phytium_dp->port); + ret = -1; + } + } + +out: + return ret; +} + +static int +phytium_dp_stop_link_train(struct phytium_dp_device *phytium_dp) +{ + int ret; + + /* config source and sink's train_pattern x: DP_TRAINING_PATTERN_DISABLE */ + phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); + + ret = phytium_dp_dpcd_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); + if (ret < 0) { + DRM_NOTE("phytium_dp_dpcd_set_train_pattern fail: ret:%d\n", ret); + return ret; + } + + return 0; +} + +int phytium_dp_start_link_train(struct phytium_dp_device *phytium_dp) +{ + int ret = 0; + + phytium_dp_hw_disable_output(phytium_dp); + phytium_dp_hw_disable_input_source(phytium_dp); + phytium_dp_hw_disable_video(phytium_dp); + phytium_dp_hw_enable_input_source(phytium_dp); + phytium_dp_hw_enable_output(phytium_dp); + phytium_dp_dpcd_sink_dpms(phytium_dp, DRM_MODE_DPMS_OFF); + phytium_dp_dpcd_sink_dpms(phytium_dp, DRM_MODE_DPMS_ON); + + if (!phytium_dp_link_training_clock_recovery(phytium_dp)) + goto failure_handling; + + if (!phytium_dp_link_training_channel_equalization(phytium_dp)) + goto failure_handling; + + ret = phytium_dp_stop_link_train(phytium_dp); + if (ret < 0) { + DRM_NOTE("phytium_dp_stop_link_train failed: ret = %d\n", ret); + goto out; + } + + if (phytium_dp->trigger_train_fail) { + phytium_dp->trigger_train_fail--; + goto failure_handling; + } + phytium_dp->train_retry_count = 0; + + DRM_DEBUG_KMS("[CONNECTOR:%d:%s] Link Training Pass at Link Rate = %d, Lane count = %d\n", + phytium_dp->connector.base.id, + phytium_dp->connector.name, phytium_dp->link_rate, + phytium_dp->link_lane_count); + + return 0; + +failure_handling: + DRM_INFO("[CONNECTOR:%d:%s] Link Training failed at Link Rate = %d, Lane count = %d", + phytium_dp->connector.base.id, + phytium_dp->connector.name, + phytium_dp->link_rate, phytium_dp->link_lane_count); + + ret = phytium_dp_stop_link_train(phytium_dp); + if (ret < 0) { + DRM_NOTE("phytium_dp_stop_link_train failed: ret = %d\n", ret); + goto out; + } + + phytium_dp_get_link_train_fallback_values(phytium_dp); + if (phytium_dp->train_retry_count < 5) + schedule_work(&phytium_dp->train_retry_work); + else + DRM_ERROR("DP(%d) Link Training Unsuccessful, and stop Training\n", + phytium_dp->port); + +out: + return -1; +} + +static bool phytium_dp_needs_link_retrain(struct phytium_dp_device *phytium_dp) +{ + unsigned char link_status[DP_LINK_STATUS_SIZE]; + int ret = 0; + + /* get link status 0x202-0x207 */ + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, + link_status, DP_LINK_STATUS_SIZE); + if (ret < 0) { + DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); + return true; + } + + if ((phytium_dp->link_rate == 0) || (phytium_dp->link_lane_count == 0)) { + DRM_DEBUG_KMS("link_rate(%d) or lane_count(%d) is invalid\n", + phytium_dp->link_rate, phytium_dp->link_lane_count); + return true; + } + + /* Make sure clock is still ok */ + if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("Clock recovery check failed\n"); + return true; + } + + if (!drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("Channel EQ check failed\n"); + return true; + } + + if (!phytium_dp_hw_output_is_enable(phytium_dp)) { + DRM_DEBUG_KMS("check DP output enable failed\n"); + return true; + } + return false; +} + +static bool +phytium_dp_get_sink_irq(struct phytium_dp_device *phytium_dp, u8 *sink_irq_vector) +{ + return drm_dp_dpcd_readb(&phytium_dp->aux, DP_DEVICE_SERVICE_IRQ_VECTOR, + sink_irq_vector) == 1; +} + +static uint8_t phytium_dp_autotest_phy_pattern(struct phytium_dp_device *phytium_dp) +{ + union phytium_phy_tp phytium_phy_tp; + int ret; + unsigned char test_80_bit_pattern[ + (DP_TEST_80BIT_CUSTOM_PATTERN_79_72 - + DP_TEST_80BIT_CUSTOM_PATTERN_7_0)+1] = {0}; + unsigned char test_pattern; + unsigned int offset; + + offset = DP_PHY_TEST_PATTERN; + + ret = drm_dp_dpcd_read(&phytium_dp->aux, offset, + &phytium_phy_tp.raw, + sizeof(phytium_phy_tp)); + if (ret <= 0) { + DRM_DEBUG_KMS("Could not read DP_TEST_PHY_PATTERN\n"); + goto failed; + } + + test_pattern = phytium_phy_tp.bits.PATTERN; + + if (test_pattern == PHYTIUM_PHY_TP_80BIT_CUSTOM) { + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_TEST_80BIT_CUSTOM_PATTERN_7_0, + test_80_bit_pattern, + sizeof(test_80_bit_pattern)); + if (ret <= 0) { + DRM_DEBUG_KMS("Could not read DP_TEST_PHY_PATTERN\n"); + goto failed; + } + } + + /* config source and sink's link rate and link count */ + ret = phytium_dp_dpcd_get_tp_link(phytium_dp, &phytium_dp->compliance.test_lane_count, + &phytium_dp->compliance.test_link_rate); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_get_tp_link fail: ret:%d\n", ret); + goto failed; + } + + phytium_dp_hw_set_link(phytium_dp, phytium_dp->compliance.test_lane_count, + phytium_dp->compliance.test_link_rate); + ret = phytium_dp_dpcd_set_link(phytium_dp, phytium_dp->compliance.test_lane_count, + phytium_dp->compliance.test_link_rate); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_link fail: ret:%d\n", ret); + goto failed_dpcd_set_link; + } + + /* config source and sink's lane setting: voltage swing and pre-emphasis */ + ret = phytium_dp_dpcd_get_adjust_request(phytium_dp, + phytium_dp->compliance.test_lane_count); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_get_adjust_request fail: ret:%d\n", ret); + goto failed_dpcd_get_adjust_request; + } + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->compliance.test_link_rate, + phytium_dp->train_set[0]); + ret = phytium_dp_dpcd_set_lane_setting(phytium_dp, phytium_dp->train_set); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_lane_setting fail: ret:%d\n", ret); + goto failed_dpcd_set_lane_setting; + } + + /* config test pattern */ + phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->compliance.test_lane_count, + test_pattern, test_80_bit_pattern, + sizeof(test_80_bit_pattern)); + ret = phytium_dp_dpcd_set_test_pattern(phytium_dp, test_pattern); + if (ret < 0) { + DRM_ERROR("phytium_dp_dpcd_set_test_pattern fail: ret:%d\n", ret); + goto failed_dpcd_set_tp; + } + + return DP_TEST_ACK; + +failed_dpcd_set_tp: + phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->compliance.test_lane_count, + PHYTIUM_PHY_TP_NONE, test_80_bit_pattern, + sizeof(test_80_bit_pattern)); +failed_dpcd_set_link: +failed_dpcd_set_lane_setting: +failed_dpcd_get_adjust_request: +failed: + return DP_TEST_NAK; +} + +static void phytium_dp_handle_test_request(struct phytium_dp_device *phytium_dp) +{ + uint8_t response = DP_TEST_NAK; + uint8_t request = 0; + int status; + + status = drm_dp_dpcd_readb(&phytium_dp->aux, DP_TEST_REQUEST, &request); + if (status <= 0) { + DRM_DEBUG_KMS("Could not read test request from sink\n"); + goto update_status; + } + + switch (request) { + case DP_TEST_LINK_TRAINING: + case DP_TEST_LINK_VIDEO_PATTERN: + case DP_TEST_LINK_EDID_READ: + DRM_DEBUG_KMS("Not support test request '%02x'\n", request); + response = DP_TEST_NAK; + break; + case DP_TEST_LINK_PHY_TEST_PATTERN: + DRM_DEBUG_KMS("PHY_PATTERN test requested\n"); + response = phytium_dp_autotest_phy_pattern(phytium_dp); + break; + default: + DRM_DEBUG_KMS("Invalid test request '%02x'\n", request); + break; + } + +update_status: + status = drm_dp_dpcd_writeb(&phytium_dp->aux, DP_TEST_RESPONSE, response); + if (status <= 0) + DRM_DEBUG_KMS("Could not write test response to sink\n"); + +} + +static int phytium_dp_long_pulse(struct drm_connector *connector, bool hpd_raw_state) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + enum drm_connector_status status = connector->status; + bool video_enable = false; + uint32_t index = 0; + struct edid *edid = NULL; + + if (phytium_dp->is_edp) + status = connector_status_connected; + else if (hpd_raw_state) { + if (!phytium_dp_needs_link_retrain(phytium_dp)) { + status = connector_status_connected; + goto out; + } + } else { + status = connector_status_disconnected; + goto out; + } + + if (!phytium_dp->is_edp) { + status = phytium_dp_detect_dpcd(phytium_dp); + if (status == connector_status_disconnected) + goto out; + + index = phytium_dp->num_common_rates-1; + phytium_dp->max_link_rate = phytium_dp->common_rates[index]; + phytium_dp->max_link_lane_count = phytium_dp->common_max_lane_count; + phytium_dp->link_rate = phytium_dp->max_link_rate; + phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; + DRM_DEBUG_KMS("common_max_lane_count: %d, common_max_rate:%d\n", + phytium_dp->max_link_lane_count, phytium_dp->max_link_rate); + + video_enable = phytium_dp_hw_video_is_enable(phytium_dp); + phytium_dp_start_link_train(phytium_dp); + + if (video_enable) { + mdelay(2); + phytium_dp_hw_enable_video(phytium_dp); + } + + edid = drm_get_edid(connector, &phytium_dp->aux.ddc); + + if (edid && drm_edid_is_valid(edid)) + phytium_dp->has_audio = drm_detect_monitor_audio(edid); + else + phytium_dp->has_audio = false; + + kfree(edid); + } + +out: + return status; +} + +static int phytium_dp_short_pulse(struct drm_connector *connector) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + enum drm_connector_status status = connector->status; + u8 sink_irq_vector = 0; + bool video_enable = false; + + /* handle the test pattern */ + if (phytium_dp_get_sink_irq(phytium_dp, &sink_irq_vector) && + sink_irq_vector != 0) { + drm_dp_dpcd_writeb(&phytium_dp->aux, + DP_DEVICE_SERVICE_IRQ_VECTOR, + sink_irq_vector); + if (sink_irq_vector & DP_AUTOMATED_TEST_REQUEST) + phytium_dp_handle_test_request(phytium_dp); + if (sink_irq_vector & (DP_CP_IRQ | DP_SINK_SPECIFIC_IRQ)) + DRM_DEBUG_DRIVER("CP or sink specific irq unhandled\n"); + } + if (!phytium_dp_needs_link_retrain(phytium_dp)) { + status = connector_status_connected; + goto out; + } + + video_enable = phytium_dp_hw_video_is_enable(phytium_dp); + phytium_dp_start_link_train(phytium_dp); + if (video_enable) { + mdelay(2); + phytium_dp_hw_enable_video(phytium_dp); + } + +out: + return status; +} + +void phytium_dp_hpd_poll_handler(struct phytium_display_private *priv) +{ + struct drm_device *dev = priv->dev; + struct drm_connector_list_iter conn_iter; + struct drm_connector *connector; + enum drm_connector_status old_status; + bool changed = false; + + mutex_lock(&dev->mode_config.mutex); + DRM_DEBUG_KMS("running encoder hotplug poll functions\n"); + drm_connector_list_iter_begin(dev, &conn_iter); + drm_for_each_connector_iter(connector, &conn_iter) { + if (connector->force) + continue; + old_status = connector->status; + connector->status = drm_helper_probe_detect(connector, NULL, false); + if (old_status != connector->status) { + const char *old, *new; + + old = drm_get_connector_status_name(old_status); + new = drm_get_connector_status_name(connector->status); + DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n", + connector->base.id, + connector->name, + old, new); + changed = true; + } + } + drm_connector_list_iter_end(&conn_iter); + mutex_unlock(&dev->mode_config.mutex); + + if (changed) + drm_kms_helper_hotplug_event(dev); +} + +void phytium_dp_hpd_irq_setup(struct drm_device *dev, bool enable) +{ + struct phytium_dp_device *phytium_dp; + struct drm_encoder *encoder; + struct phytium_display_private *priv = dev->dev_private; + bool handler = false; + bool hpd_raw_state_old = false; + + /* We might have missed any hotplugs that happened, so polling and handler */ + if (enable) { + spin_lock_irq(&priv->hotplug_irq_lock); + + drm_for_each_encoder(encoder, dev) { + phytium_dp = encoder_to_dp_device(encoder); + if (!phytium_dp->dp_hpd_state.hpd_irq_enable) { + hpd_raw_state_old = phytium_dp->dp_hpd_state.hpd_raw_state; + phytium_dp_hw_get_hpd_state(phytium_dp); + if (phytium_dp->dp_hpd_state.hpd_event_state + || phytium_dp->dp_hpd_state.hpd_irq_state + || (hpd_raw_state_old != phytium_dp->dp_hpd_state.hpd_raw_state)) { + handler = true; + } + } + } + spin_unlock_irq(&priv->hotplug_irq_lock); + if (handler) + phytium_dp_hpd_poll_handler(priv); + } + + drm_for_each_encoder(encoder, dev) { + phytium_dp = encoder_to_dp_device(encoder); + phytium_dp_hw_hpd_irq_setup(phytium_dp, enable); + } +} + +void phytium_dp_hpd_work_func(struct work_struct *work) +{ + struct phytium_display_private *priv = + container_of(work, struct phytium_display_private, hotplug_work); + struct drm_device *dev = priv->dev; + struct drm_connector_list_iter conn_iter; + struct drm_connector *connector; + enum drm_connector_status old_status; + bool changed = false; + + mutex_lock(&dev->mode_config.mutex); + DRM_DEBUG_KMS("running encoder hotplug work functions\n"); + drm_connector_list_iter_begin(dev, &conn_iter); + drm_for_each_connector_iter(connector, &conn_iter) { + if (connector->force) + continue; + old_status = connector->status; + connector->status = drm_helper_probe_detect(connector, NULL, false); + if (old_status != connector->status) { + const char *old, *new; + + old = drm_get_connector_status_name(old_status); + new = drm_get_connector_status_name(connector->status); + DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n", + connector->base.id, + connector->name, + old, new); + changed = true; + } + } + drm_connector_list_iter_end(&conn_iter); + mutex_unlock(&dev->mode_config.mutex); + + if (changed) + drm_kms_helper_hotplug_event(dev); + + phytium_dp_hpd_irq_setup(dev, true); +} + +irqreturn_t phytium_dp_hpd_irq_handler(struct phytium_display_private *priv) +{ + struct drm_encoder *encoder = NULL; + struct phytium_dp_device *phytium_dp = NULL; + struct drm_device *dev = priv->dev; + bool handler = false; + + spin_lock(&priv->hotplug_irq_lock); + + drm_for_each_encoder(encoder, dev) { + phytium_dp = encoder_to_dp_device(encoder); + if (phytium_dp->dp_hpd_state.hpd_irq_enable) { + phytium_dp_hw_get_hpd_state(phytium_dp); + if (phytium_dp->dp_hpd_state.hpd_event_state + || phytium_dp->dp_hpd_state.hpd_irq_state) { + handler = true; + } + } + } + spin_unlock(&priv->hotplug_irq_lock); + + if (handler) { + phytium_dp_hpd_irq_setup(dev, false); + schedule_work(&priv->hotplug_work); + return IRQ_HANDLED; + } + return IRQ_NONE; +} + + +static void phytium_dp_fast_link_train_detect(struct phytium_dp_device *phytium_dp) +{ + phytium_dp->fast_train_support = !!(phytium_dp->dpcd[DP_MAX_DOWNSPREAD] + & DP_NO_AUX_HANDSHAKE_LINK_TRAINING); + DRM_DEBUG_KMS("fast link training %s\n", + phytium_dp->fast_train_support ? "supported" : "unsupported"); +} + +bool phytium_dp_fast_link_train(struct phytium_dp_device *phytium_dp) +{ + int ret = 0; + unsigned int training_pattern; + + /* clear the test pattern */ + phytium_dp_hw_set_test_pattern(phytium_dp, phytium_dp->link_lane_count, + PHYTIUM_PHY_TP_NONE, NULL, 0); + + /* config source and sink's link rate and lane count */ + phytium_dp_hw_set_link(phytium_dp, phytium_dp->link_lane_count, phytium_dp->link_rate); + + /* config source and sink's voltage swing and pre-emphasis(103-106) */ + phytium_dp_hw_set_lane_setting(phytium_dp, phytium_dp->link_rate, + phytium_dp->train_set[0]); + + /* config train pattern */ + phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_1); + usleep_range(500, 600); + + training_pattern = phytium_dp_get_training_pattern(phytium_dp); + phytium_dp_hw_set_train_pattern(phytium_dp, training_pattern); + usleep_range(500, 600); + + phytium_dp_hw_set_train_pattern(phytium_dp, DP_TRAINING_PATTERN_DISABLE); + + if (dc_fast_training_check) { + unsigned char link_status[DP_LINK_STATUS_SIZE]; + + ret = drm_dp_dpcd_read(&phytium_dp->aux, DP_LANE0_1_STATUS, + link_status, DP_LINK_STATUS_SIZE); + if (ret < 0) { + DRM_ERROR("failed to get link status(DP_LANE0_1_STATUS)\n"); + return false; + } + + if (!drm_dp_clock_recovery_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("check clock recovery failed\n"); + return false; + } + + if (!drm_dp_channel_eq_ok(link_status, phytium_dp->link_lane_count)) { + DRM_DEBUG_KMS("check channel equalization failed\n"); + return false; + } + } + + return true; +} + +static enum drm_connector_status +phytium_connector_detect(struct drm_connector *connector, bool force) +{ + enum drm_connector_status status = connector->status; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + bool hpd_event_state, hpd_irq_state, hpd_raw_state; + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + bool plugged = true; + + spin_lock_irq(&priv->hotplug_irq_lock); + hpd_event_state = phytium_dp->dp_hpd_state.hpd_event_state; + hpd_irq_state = phytium_dp->dp_hpd_state.hpd_irq_state; + hpd_raw_state = phytium_dp->dp_hpd_state.hpd_raw_state; + phytium_dp->dp_hpd_state.hpd_event_state = false; + phytium_dp->dp_hpd_state.hpd_irq_state = false; + spin_unlock_irq(&priv->hotplug_irq_lock); + + if (hpd_event_state) + status = phytium_dp_long_pulse(connector, hpd_raw_state); + + if (hpd_irq_state) + status = phytium_dp_short_pulse(connector); + + if (status == connector_status_unknown) + status = connector_status_disconnected; + + if ((!phytium_dp->is_edp) && (!hpd_raw_state)) + status = connector_status_disconnected; + + if (connector->status != status) { + if ((status == connector_status_connected) && phytium_dp->has_audio) + plugged = true; + else + plugged = false; + + handle_plugged_change(phytium_dp, plugged); + } + + return status; +} + +static void +phytium_connector_destroy(struct drm_connector *connector) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + drm_connector_cleanup(connector); + kfree(phytium_dp); +} + +static int +phytium_dp_connector_register(struct drm_connector *connector) +{ + int ret; + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + phytium_dp_aux_init(phytium_dp); + if (phytium_dp->is_edp) { + phytium_edp_init_connector(phytium_dp); + ret = phytium_edp_backlight_device_register(phytium_dp); + if (ret) + DRM_ERROR("failed to register port(%d) backlight device(ret=%d)\n", + phytium_dp->port, ret); + } + + ret = phytium_debugfs_connector_add(connector); + if (ret) + DRM_ERROR("failed to register phytium connector debugfs(ret=%d)\n", ret); + + return 0; +} + +static void +phytium_dp_connector_unregister(struct drm_connector *connector) +{ + struct phytium_dp_device *phytium_dp = connector_to_dp_device(connector); + + if (phytium_dp->is_edp) { + phytium_edp_backlight_device_unregister(phytium_dp); + phytium_edp_fini_connector(phytium_dp); + } + drm_dp_aux_unregister(&phytium_dp->aux); +} + +static const struct drm_connector_funcs phytium_connector_funcs = { + .dpms = drm_helper_connector_dpms, + .detect = phytium_connector_detect, + .fill_modes = drm_helper_probe_single_connector_modes, + .destroy = phytium_connector_destroy, + .reset = drm_atomic_helper_connector_reset, + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, + .late_register = phytium_dp_connector_register, + .early_unregister = phytium_dp_connector_unregister, +}; + +static void phytium_dp_encoder_mode_set(struct drm_encoder *encoder, + struct drm_display_mode *mode, + struct drm_display_mode *adjusted) +{ + struct phytium_dp_device *dp = encoder_to_dp_device(encoder); + + drm_mode_copy(&dp->mode, adjusted); +} + +static void phytium_edp_panel_poweron(struct phytium_dp_device *phytium_dp) +{ + phytium_panel_poweron(&phytium_dp->panel); +} + +static void phytium_edp_panel_poweroff(struct phytium_dp_device *phytium_dp) +{ + phytium_panel_poweroff(&phytium_dp->panel); +} + +static void phytium_edp_backlight_on(struct phytium_dp_device *phytium_dp) +{ + phytium_panel_enable_backlight(&phytium_dp->panel); +} + +static void phytium_edp_backlight_off(struct phytium_dp_device *phytium_dp) +{ + phytium_panel_disable_backlight(&phytium_dp->panel); +} + +static void phytium_encoder_disable(struct drm_encoder *encoder) +{ + struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); + + if (phytium_dp->is_edp) + phytium_edp_backlight_off(phytium_dp); + + phytium_dp_hw_disable_video(phytium_dp); + + mdelay(50); + + if (phytium_dp->is_edp) + phytium_edp_panel_poweroff(phytium_dp); +} + +void phytium_dp_adjust_link_train_parameter(struct phytium_dp_device *phytium_dp) +{ + struct drm_display_info *display_info = &phytium_dp->connector.display_info; + unsigned long link_bw, date_rate = 0, bs_limit, bs_request; + int rate = 0; + + bs_request = phytium_dp->mode.crtc_htotal/(phytium_dp->mode.crtc_clock/1000); + date_rate = (phytium_dp->mode.crtc_clock * display_info->bpc * 3)/8; + + for (;;) { + bs_limit = 8192 / (phytium_dp->link_rate/1000); + link_bw = phytium_dp->link_rate * phytium_dp->link_lane_count; + rate = 10 * date_rate / link_bw; + DRM_DEBUG_KMS("adjust link rate(%d), lane count(%d)\n", + phytium_dp->link_rate, phytium_dp->link_lane_count); + DRM_DEBUG_KMS("for crtc_clock(%d) bs_request(%ld) bs_limit(%ld) rate(%d)\n", + phytium_dp->mode.crtc_clock, bs_request, bs_limit, rate); + if ((link_dynamic_adjust && (bs_request < bs_limit) && rate < 10) || + ((!link_dynamic_adjust) && (rate < 10))) + break; + phytium_dp_get_link_train_fallback_values(phytium_dp); + } + + DRM_DEBUG_KMS("Try link training at Link Rate = %d, Lane count = %d\n", + phytium_dp->link_rate, phytium_dp->link_lane_count); +} + +static void phytium_encoder_enable(struct drm_encoder *encoder) +{ + struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); + int ret = 0; + + phytium_dp_hw_disable_video(phytium_dp); + + if (phytium_dp->is_edp) { + phytium_edp_panel_poweron(phytium_dp); + if (phytium_dp->fast_train_support) + phytium_dp_fast_link_train(phytium_dp); + else + ret = phytium_dp_start_link_train(phytium_dp); + mdelay(2); + phytium_dp_fast_link_train_detect(phytium_dp); + } else { + phytium_dp_adjust_link_train_parameter(phytium_dp); + ret = phytium_dp_start_link_train(phytium_dp); + mdelay(2); + } + + phytium_dp_hw_config_video(phytium_dp); + if (ret == 0) { + phytium_dp_hw_enable_video(phytium_dp); + if (phytium_dp->has_audio) + phytium_dp_hw_enable_audio(phytium_dp); + } + + if (phytium_dp->is_edp) + phytium_edp_backlight_on(phytium_dp); +} + +enum drm_mode_status +phytium_encoder_mode_valid(struct drm_encoder *encoder, const struct drm_display_mode *mode) +{ + struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); + struct drm_display_info *display_info = &phytium_dp->connector.display_info; + unsigned int requested, actual; + + switch (display_info->bpc) { + case 10: + case 6: + case 8: + break; + default: + DRM_INFO("not support bpc(%d)\n", display_info->bpc); + display_info->bpc = 8; + break; + } + + if ((display_info->color_formats & DRM_COLOR_FORMAT_RGB444) == 0) { + DRM_INFO("not support color_format(%d)\n", display_info->color_formats); + display_info->color_formats = DRM_COLOR_FORMAT_RGB444; + } + + requested = mode->clock * display_info->bpc * 3 / 1000; + actual = phytium_dp->max_link_rate * phytium_dp->max_link_lane_count / 100; + actual = actual * 8 / 10; + if (requested >= actual) { + DRM_DEBUG_KMS("requested=%d, actual=%d, clock=%d\n", requested, actual, + mode->clock); + return MODE_CLOCK_HIGH; + } + + if (dc_fake_mode_enable && + (phytium_dp->native_mode.clock == mode->clock) && + (phytium_dp->native_mode.htotal == mode->htotal) && + (phytium_dp->native_mode.vtotal == mode->vtotal)) + return MODE_OK; + + if ((mode->hdisplay == 1600) && (mode->vdisplay == 900)) + return MODE_BAD_HVALUE; + + if ((mode->hdisplay == 1024) && (mode->clock > 78000)) + return MODE_BAD_HVALUE; + + if ((mode->hdisplay < 640) || (mode->vdisplay < 480)) + return MODE_BAD_HVALUE; + + return MODE_OK; +} + +static const struct drm_encoder_helper_funcs phytium_encoder_helper_funcs = { + .mode_set = phytium_dp_encoder_mode_set, + .disable = phytium_encoder_disable, + .enable = phytium_encoder_enable, + .mode_valid = phytium_encoder_mode_valid, +}; + +void phytium_dp_encoder_destroy(struct drm_encoder *encoder) +{ + struct phytium_dp_device *phytium_dp = encoder_to_dp_device(encoder); + + phytium_dp_audio_codec_fini(phytium_dp); + drm_encoder_cleanup(encoder); +} + +static const struct drm_encoder_funcs phytium_encoder_funcs = { + .destroy = phytium_dp_encoder_destroy, +}; + +static const struct dp_audio_n_m phytium_dp_audio_n_m[] = { + { 32000, 162000, 1024, 10125 }, + { 44100, 162000, 784, 5625 }, + { 48000, 162000, 512, 3375 }, + { 64000, 162000, 2048, 10125 }, + { 88200, 162000, 1568, 5625 }, + { 96000, 162000, 1024, 3375 }, + { 128000, 162000, 4096, 10125 }, + { 176400, 162000, 3136, 5625 }, + { 192000, 162000, 2048, 3375 }, + { 32000, 270000, 1024, 16875 }, + { 44100, 270000, 784, 9375 }, + { 48000, 270000, 512, 5625 }, + { 64000, 270000, 2048, 16875 }, + { 88200, 270000, 1568, 9375 }, + { 96000, 270000, 1024, 5625 }, + { 128000, 270000, 4096, 16875 }, + { 176400, 270000, 3136, 9375 }, + { 192000, 270000, 2048, 5625 }, + { 32000, 540000, 1024, 33750 }, + { 44100, 540000, 784, 18750 }, + { 48000, 540000, 512, 11250 }, + { 64000, 540000, 2048, 33750 }, + { 88200, 540000, 1568, 18750 }, + { 96000, 540000, 1024, 11250 }, + { 128000, 540000, 4096, 33750 }, + { 176400, 540000, 3136, 18750 }, + { 192000, 540000, 2048, 11250 }, + { 32000, 810000, 1024, 50625 }, + { 44100, 810000, 784, 28125 }, + { 48000, 810000, 512, 16875 }, + { 64000, 810000, 2048, 50625 }, + { 88200, 810000, 1568, 28125 }, + { 96000, 810000, 1024, 16875 }, + { 128000, 810000, 4096, 50625 }, + { 176400, 810000, 3136, 28125 }, + { 192000, 810000, 2048, 16875 }, +}; + +static int phytium_dp_audio_get_eld(struct device *dev, void *data, u8 *buf, size_t len) +{ + struct phytium_dp_device *phytium_dp = data; + + memcpy(buf, phytium_dp->connector.eld, min(sizeof(phytium_dp->connector.eld), len)); + + return 0; +} + +static int phytium_dp_audio_mute_stream(struct device *dev, void *data, bool enable, int direction) +{ + struct phytium_dp_device *phytium_dp = data; + + phytium_dp_hw_audio_digital_mute(phytium_dp, enable); + + return 0; +} + +const struct dp_audio_n_m *phytium_dp_audio_get_n_m(int link_rate, int sample_rate) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(phytium_dp_audio_n_m); i++) { + if (sample_rate == phytium_dp_audio_n_m[i].sample_rate + && link_rate == phytium_dp_audio_n_m[i].link_rate) + return &phytium_dp_audio_n_m[i]; + } + + return NULL; +} + +static int phytium_dp_audio_hw_params(struct device *dev, void *data, + struct hdmi_codec_daifmt *daifmt, + struct hdmi_codec_params *params) +{ + struct phytium_dp_device *phytium_dp = data; + int ret = 0; + struct audio_info audio_info = { + .sample_width = params->sample_width, + .sample_rate = params->sample_rate, + .channels = params->channels, + }; + + if (daifmt->fmt != HDMI_I2S) { + DRM_ERROR("invalid audio format %d\n", daifmt->fmt); + ret = -EINVAL; + goto failed; + } + + ret = phytium_dp_hw_audio_hw_params(phytium_dp, audio_info); + +failed: + return ret; +} + +static void phytium_dp_audio_shutdown(struct device *dev, void *data) +{ + struct phytium_dp_device *phytium_dp = data; + + phytium_dp_hw_audio_shutdown(phytium_dp); +} + +static void handle_plugged_change(struct phytium_dp_device *phytium_dp, bool plugged) +{ + if (phytium_dp->plugged_cb && phytium_dp->codec_dev) + phytium_dp->plugged_cb(phytium_dp->codec_dev, plugged); +} + +static int phytium_dp_audio_hook_plugged_cb(struct device *dev, void *data, + hdmi_codec_plugged_cb fn, + struct device *codec_dev) +{ + struct phytium_dp_device *phytium_dp = data; + bool plugged; + + phytium_dp->plugged_cb = fn; + phytium_dp->codec_dev = codec_dev; + + if ((phytium_dp->connector.status == connector_status_connected) && phytium_dp->has_audio) + plugged = true; + else + plugged = false; + + handle_plugged_change(phytium_dp, plugged); + return 0; +} + + +static const struct hdmi_codec_ops phytium_audio_codec_ops = { + .hw_params = phytium_dp_audio_hw_params, + .audio_shutdown = phytium_dp_audio_shutdown, + .mute_stream = phytium_dp_audio_mute_stream, + .get_eld = phytium_dp_audio_get_eld, + .hook_plugged_cb = phytium_dp_audio_hook_plugged_cb, +}; + +static int phytium_dp_audio_codec_init(struct phytium_dp_device *phytium_dp, + const int port) +{ + struct device *dev = phytium_dp->dev->dev; + struct hdmi_codec_pdata codec_data = { + .i2s = 1, + .spdif = 0, + .ops = &phytium_audio_codec_ops, + .max_i2s_channels = 2, + .data = phytium_dp, + }; + + phytium_dp->audio_pdev = platform_device_register_data(dev, HDMI_CODEC_DRV_NAME, + codec_id + port, + &codec_data, sizeof(codec_data)); + + return PTR_ERR_OR_ZERO(phytium_dp->audio_pdev); +} + +static void phytium_dp_audio_codec_fini(struct phytium_dp_device *phytium_dp) +{ + + if (!PTR_ERR_OR_ZERO(phytium_dp->audio_pdev)) + platform_device_unregister(phytium_dp->audio_pdev); + phytium_dp->audio_pdev = NULL; +} + +static long phytium_dp_aux_transfer(struct drm_dp_aux *aux, struct drm_dp_aux_msg *msg) +{ + struct phytium_dp_device *phytium_dp = container_of(aux, struct phytium_dp_device, aux); + long ret = 0; + + DRM_DEBUG_KMS("msg->size: 0x%lx\n", msg->size); + + if (WARN_ON(msg->size > 16)) + return -E2BIG; + + switch (msg->request & ~DP_AUX_I2C_MOT) { + case DP_AUX_NATIVE_WRITE: + case DP_AUX_I2C_WRITE: + case DP_AUX_I2C_WRITE_STATUS_UPDATE: + ret = phytium_dp_hw_aux_transfer_write(phytium_dp, msg); + DRM_DEBUG_KMS("aux write reply:0x%x ret:0x%lx\n", msg->reply, ret); + break; + case DP_AUX_NATIVE_READ: + case DP_AUX_I2C_READ: + ret = phytium_dp_hw_aux_transfer_read(phytium_dp, msg); + DRM_DEBUG_KMS("aux read ret:0x%lx\n", ret); + break; + default: + ret = -EINVAL; + break; + } + + return ret; +} + +static void phytium_dp_aux_init(struct phytium_dp_device *phytium_dp) +{ + drm_dp_aux_init(&phytium_dp->aux); + phytium_dp->aux.name = kasprintf(GFP_KERNEL, "dp-%d", phytium_dp->port); + phytium_dp->aux.transfer = phytium_dp_aux_transfer; +} + +int phytium_get_encoder_crtc_mask(struct phytium_dp_device *phytium_dp, int port) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int i, mask = 0; + + for_each_pipe_masked(priv, i) { + if (i != port) + mask++; + else + break; + } + + return BIT(mask); +} + +static bool phytium_dp_is_edp(struct phytium_dp_device *phytium_dp, int port) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + + if (priv->info.edp_mask & BIT(port)) + return true; + else + return false; +} + +static bool phytium_edp_init_connector(struct phytium_dp_device *phytium_dp) +{ + enum drm_connector_status status; + struct drm_connector *connector = &phytium_dp->connector; + + phytium_edp_panel_poweron(phytium_dp); + + status = phytium_dp_detect_dpcd(phytium_dp); + if (status == connector_status_disconnected) { + DRM_ERROR("detect edp dpcd failed\n"); + return false; + } + + phytium_dp->edp_edid = drm_get_edid(connector, &phytium_dp->aux.ddc); + if (!phytium_dp->edp_edid) { + DRM_ERROR("get edp edid failed\n"); + return false; + } + + connector->status = status; + phytium_dp->max_link_rate = phytium_dp->common_rates[phytium_dp->num_common_rates-1]; + phytium_dp->max_link_lane_count = phytium_dp->common_max_lane_count; + phytium_dp->link_rate = phytium_dp->max_link_rate; + phytium_dp->link_lane_count = phytium_dp->max_link_lane_count; + DRM_DEBUG_KMS("common_max_lane_count: %d, common_max_rate:%d\n", + phytium_dp->max_link_lane_count, phytium_dp->max_link_rate); + + return true; +} + +static void phytium_edp_fini_connector(struct phytium_dp_device *phytium_dp) +{ + kfree(phytium_dp->edp_edid); + + phytium_dp->edp_edid = NULL; + phytium_edp_panel_poweroff(phytium_dp); +} + +int phytium_dp_resume(struct drm_device *drm_dev) +{ + struct phytium_dp_device *phytium_dp; + struct drm_encoder *encoder; + int ret = 0; + + drm_for_each_encoder(encoder, drm_dev) { + phytium_dp = encoder_to_dp_device(encoder); + if (phytium_dp->is_edp) { + phytium_edp_backlight_off(phytium_dp); + phytium_edp_panel_poweroff(phytium_dp); + } + ret = phytium_dp_hw_init(phytium_dp); + if (ret) { + DRM_ERROR("failed to initialize dp %d\n", phytium_dp->port); + return -EIO; + } + } + + return 0; +} + +int phytium_dp_init(struct drm_device *dev, int port) +{ + struct phytium_display_private *priv = dev->dev_private; + struct phytium_dp_device *phytium_dp = NULL; + int ret, type; + + DRM_DEBUG_KMS("%s: port %d\n", __func__, port); + phytium_dp = kzalloc(sizeof(*phytium_dp), GFP_KERNEL); + if (!phytium_dp) { + ret = -ENOMEM; + goto failed_malloc_dp; + } + + phytium_dp->dev = dev; + phytium_dp->port = port; + + if (IS_PX210(priv)) { + px210_dp_func_register(phytium_dp); + priv->dp_reg_base[port] = PX210_DP_BASE(port); + priv->phy_access_base[port] = PX210_PHY_ACCESS_BASE(port); + } else if (IS_PE220X(priv)) { + pe220x_dp_func_register(phytium_dp); + priv->dp_reg_base[port] = PE220X_DP_BASE(port); + priv->phy_access_base[port] = PE220X_PHY_ACCESS_BASE(port); + } + + if (phytium_dp_is_edp(phytium_dp, port)) { + phytium_dp->is_edp = true; + type = DRM_MODE_CONNECTOR_eDP; + phytium_dp->pwm = priv->info.pwm; + phytium_dp_panel_init_backlight_funcs(phytium_dp); + phytium_edp_backlight_off(phytium_dp); + phytium_edp_panel_poweroff(phytium_dp); + } else { + phytium_dp->is_edp = false; + type = DRM_MODE_CONNECTOR_DisplayPort; + } + + ret = phytium_dp_hw_init(phytium_dp); + if (ret) { + DRM_ERROR("failed to initialize dp %d\n", phytium_dp->port); + goto failed_init_dp; + } + + ret = drm_encoder_init(dev, &phytium_dp->encoder, + &phytium_encoder_funcs, + DRM_MODE_ENCODER_TMDS, "DP %d", port); + if (ret) { + DRM_ERROR("failed to initialize encoder with drm\n"); + goto failed_encoder_init; + } + drm_encoder_helper_add(&phytium_dp->encoder, &phytium_encoder_helper_funcs); + phytium_dp->encoder.possible_crtcs = phytium_get_encoder_crtc_mask(phytium_dp, port); + + phytium_dp->connector.dpms = DRM_MODE_DPMS_OFF; + phytium_dp->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; + ret = drm_connector_init(dev, &phytium_dp->connector, &phytium_connector_funcs, + type); + if (ret) { + DRM_ERROR("failed to initialize connector with drm\n"); + goto failed_connector_init; + } + drm_connector_helper_add(&phytium_dp->connector, &phytium_connector_helper_funcs); + drm_connector_attach_encoder(&phytium_dp->connector, &phytium_dp->encoder); + + ret = phytium_dp_audio_codec_init(phytium_dp, port); + if (ret) { + DRM_ERROR("failed to initialize audio codec\n"); + goto failed_connector_init; + } + + phytium_dp->train_retry_count = 0; + INIT_WORK(&phytium_dp->train_retry_work, phytium_dp_train_retry_work_fn); + drm_connector_register(&phytium_dp->connector); + + return 0; +failed_connector_init: +failed_encoder_init: +failed_init_dp: + kfree(phytium_dp); +failed_malloc_dp: + return ret; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_dp.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_dp.h new file mode 100644 index 0000000000000000000000000000000000000000..c4915dd403b865d9535e9f634d1b8fc151a404a7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_dp.h @@ -0,0 +1,157 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_DP_H__ +#define __PHYTIUM_DP_H__ + +#include +#include +#include +#include + +struct phytium_dp_device; + +#include "phytium_panel.h" + +struct audio_info { + int sample_rate; + int channels; + int sample_width; +}; + +struct dp_audio_n_m { + int sample_rate; + int link_rate; + u16 m; + u16 n; +}; + +struct phytium_dp_compliance { + unsigned long test_type; + uint32_t test_link_rate; + u8 test_lane_count; + bool test_active; + u8 reserve[2]; +}; + +struct phytium_dp_func { + uint8_t (*dp_hw_get_source_lane_count)(struct phytium_dp_device *phytium_dp); + int (*dp_hw_reset)(struct phytium_dp_device *phytium_dp); + bool (*dp_hw_spread_is_enable)(struct phytium_dp_device *phytium_dp); + int (*dp_hw_set_backlight)(struct phytium_dp_device *phytium_dp, uint32_t level); + uint32_t (*dp_hw_get_backlight)(struct phytium_dp_device *phytium_dp); + void (*dp_hw_disable_backlight)(struct phytium_dp_device *phytium_dp); + void (*dp_hw_enable_backlight)(struct phytium_dp_device *phytium_dp); + void (*dp_hw_poweroff_panel)(struct phytium_dp_device *phytium_dp); + void (*dp_hw_poweron_panel)(struct phytium_dp_device *phytium_dp); + int (*dp_hw_init_phy)(struct phytium_dp_device *phytium_dp); + void (*dp_hw_set_phy_lane_setting)(struct phytium_dp_device *phytium_dp, + uint32_t link_rate, uint8_t train_set); + int (*dp_hw_set_phy_lane_and_rate)(struct phytium_dp_device *phytium_dp, + uint8_t link_lane_count, + uint32_t link_rate); +}; + +struct phytium_dp_hpd_state { + bool hpd_event_state; + bool hpd_irq_state; + bool hpd_raw_state; + bool hpd_irq_enable; +}; + +struct phytium_dp_device { + struct drm_device *dev; + struct drm_encoder encoder; + struct drm_connector connector; + int port; + struct drm_display_mode mode; + bool link_trained; + bool detect_done; + bool is_edp; + bool reserve0; + struct drm_dp_aux aux; + unsigned char dpcd[DP_RECEIVER_CAP_SIZE]; + uint8_t edp_dpcd[EDP_DISPLAY_CTL_CAP_SIZE]; + unsigned char downstream_ports[DP_MAX_DOWNSTREAM_PORTS]; + unsigned char sink_count; + + int *source_rates; + int num_source_rates; + int sink_rates[DP_MAX_SUPPORTED_RATES]; + int num_sink_rates; + int common_rates[DP_MAX_SUPPORTED_RATES]; + int num_common_rates; + + int source_max_lane_count; + int sink_max_lane_count; + int common_max_lane_count; + + int max_link_rate; + int max_link_lane_count; + int link_rate; + int link_lane_count; + struct work_struct train_retry_work; + int train_retry_count; + uint32_t trigger_train_fail; + + unsigned char train_set[4]; + struct edid *edp_edid; + bool has_audio; + bool fast_train_support; + bool hw_spread_enable; + bool reserve[1]; + struct platform_device *audio_pdev; + struct audio_info audio_info; + hdmi_codec_plugged_cb plugged_cb; + struct device *codec_dev; + struct phytium_dp_compliance compliance; + struct phytium_dp_func *funcs; + struct phytium_dp_hpd_state dp_hpd_state; + + struct phytium_panel panel; + struct drm_display_mode native_mode; + struct pwm_device *pwm; +}; + +union phytium_phy_tp { + struct { + /* DpcdPhyTestPatterns. This field is 2 bits for DP1.1 + * and 3 bits for DP1.2. + */ + uint8_t PATTERN :3; + uint8_t RESERVED :5; + } bits; + uint8_t raw; +}; + +/* PHY test patterns + * The order of test patterns follows DPCD register PHY_TEST_PATTERN (0x248) + */ +enum phytium_dpcd_phy_tp { + PHYTIUM_PHY_TP_NONE = 0, + PHYTIUM_PHY_TP_D10_2, + PHYTIUM_PHY_TP_SYMBOL_ERROR, + PHYTIUM_PHY_TP_PRBS7, + PHYTIUM_PHY_TP_80BIT_CUSTOM, + PHYTIUM_PHY_TP_CP2520_1, + PHYTIUM_PHY_TP_CP2520_2, + PHYTIUM_PHY_TP_CP2520_3, +}; +#define PHYTIUM_DP_AUDIO_ID (('P' << 24) + ('H' << 16) + ('Y' << 8)) +#define encoder_to_dp_device(x) container_of(x, struct phytium_dp_device, encoder) +#define connector_to_dp_device(x) container_of(x, struct phytium_dp_device, connector) +#define panel_to_dp_device(x) container_of(x, struct phytium_dp_device, panel) +#define train_retry_to_dp_device(x) container_of(x, struct phytium_dp_device, train_retry_work) +void phytium_phy_writel(struct phytium_dp_device *phytium_dp, uint32_t address, uint32_t data); +uint32_t phytium_phy_readl(struct phytium_dp_device *phytium_dp, uint32_t address); + +int phytium_dp_init(struct drm_device *dev, int pipe); +int phytium_dp_resume(struct drm_device *drm_dev); +void phytium_dp_hpd_irq_setup(struct drm_device *dev, bool enable); +irqreturn_t phytium_dp_hpd_irq_handler(struct phytium_display_private *priv); +void phytium_dp_hpd_work_func(struct work_struct *work); +const struct dp_audio_n_m *phytium_dp_audio_get_n_m(int link_rate, int sample_rate); +#endif /* __PHYTIUM_DP_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fb.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fb.c new file mode 100644 index 0000000000000000000000000000000000000000..230714f79fa735379aa217c7e5b38cc46fa8d4d1 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fb.c @@ -0,0 +1,131 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_fb.h" +#include "phytium_gem.h" + +static int +phytium_fb_create_handle(struct drm_framebuffer *fb, struct drm_file *file_priv, + unsigned int *handle) +{ + struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); + + return drm_gem_handle_create(file_priv, &phytium_fb->phytium_gem_obj[0]->base, handle); +} + +static void phytium_fb_destroy(struct drm_framebuffer *fb) +{ + struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); + int i, num_planes; + struct drm_gem_object *obj = NULL; + const struct drm_format_info *info; + + info = drm_format_info(fb->format->format); + num_planes = info ? info->num_planes : 1; + + for (i = 0; i < num_planes; i++) { + obj = &phytium_fb->phytium_gem_obj[i]->base; + if (obj) + drm_gem_object_put(obj); + } + + drm_framebuffer_cleanup(fb); + kfree(phytium_fb); +} + +static struct drm_framebuffer_funcs viv_fb_funcs = { + .create_handle = phytium_fb_create_handle, + .destroy = phytium_fb_destroy, +}; + +struct phytium_framebuffer * +phytium_fb_alloc(struct drm_device *dev, const struct drm_mode_fb_cmd2 *mode_cmd, + struct phytium_gem_object **phytium_gem_obj, unsigned int num_planes) +{ + struct phytium_framebuffer *phytium_fb; + int ret = 0, i; + + phytium_fb = kzalloc(sizeof(*phytium_fb), GFP_KERNEL); + if (!phytium_fb) + return ERR_PTR(-ENOMEM); + + drm_helper_mode_fill_fb_struct(dev, &phytium_fb->base, mode_cmd); + + ret = drm_framebuffer_init(dev, &phytium_fb->base, &viv_fb_funcs); + + if (ret) { + DRM_ERROR("Failed to initialize framebuffer: %d\n", ret); + kfree(phytium_fb); + return ERR_PTR(ret); + } + + for (i = 0; i < num_planes; i++) { + phytium_fb->phytium_gem_obj[i] = phytium_gem_obj[i]; + phytium_fb->base.obj[i] = &phytium_gem_obj[i]->base; + } + return phytium_fb; +} + +struct drm_framebuffer * +phytium_fb_create(struct drm_device *dev, struct drm_file *file_priv, + const struct drm_mode_fb_cmd2 *mode_cmd) +{ + int ret = 0, i, num_planes; + struct drm_gem_object *obj; + unsigned int hsub, vsub, size; + struct phytium_gem_object *phytium_gem_obj[PHYTIUM_FORMAT_MAX_PLANE] = {0}; + struct phytium_framebuffer *phytium_fb; + struct phytium_display_private *priv = dev->dev_private; + const struct drm_format_info *info; + + info = drm_format_info(mode_cmd->pixel_format); + hsub = info ? info->hsub : 1; + vsub = info ? info->vsub : 1; + num_planes = info ? info->num_planes : 1; + num_planes = min(num_planes, PHYTIUM_FORMAT_MAX_PLANE); + + for (i = 0; i < num_planes; i++) { + unsigned int height = mode_cmd->height / (i ? vsub : 1); + + size = height * mode_cmd->pitches[i] + mode_cmd->offsets[i]; + obj = drm_gem_object_lookup(file_priv, mode_cmd->handles[i]); + if (!obj) { + DRM_ERROR("Failed to lookup GEM object\n"); + ret = -ENXIO; + goto error; + } + + if (obj->size < size) { + drm_gem_object_put(obj); + ret = -EINVAL; + goto error; + } + + phytium_gem_obj[i] = to_phytium_gem_obj(obj); + + ret = priv->dc_hw_fb_format_check(mode_cmd, i); + if (ret < 0) + goto error; + } + + phytium_fb = phytium_fb_alloc(dev, mode_cmd, phytium_gem_obj, i); + if (IS_ERR(phytium_fb)) { + DRM_DEBUG_KMS("phytium_fb_alloc failed\n"); + ret = PTR_ERR(phytium_fb); + goto error; + } + + return &phytium_fb->base; +error: + for (i--; i >= 0; i--) + drm_gem_object_put(&phytium_gem_obj[i]->base); + + return ERR_PTR(ret); +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fb.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fb.h new file mode 100644 index 0000000000000000000000000000000000000000..eb7903f3a10a4f04b36c0f39221a0a065ca20752 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fb.h @@ -0,0 +1,26 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_FB_H__ +#define __PHYTIUM_FB_H__ + +#include + +struct phytium_framebuffer { + struct drm_framebuffer base; + struct phytium_gem_object *phytium_gem_obj[PHYTIUM_FORMAT_MAX_PLANE]; +}; + +#define to_phytium_framebuffer(fb) container_of(fb, struct phytium_framebuffer, base) + +struct phytium_framebuffer *phytium_fb_alloc(struct drm_device *dev, + const struct drm_mode_fb_cmd2 *mode_cmd, + struct phytium_gem_object **phytium_gem_obj, + unsigned int num_planes); + +struct drm_framebuffer *phytium_fb_create(struct drm_device *dev, struct drm_file *file_priv, + const struct drm_mode_fb_cmd2 *mode_cmd); +#endif /* __PHYTIUM_FB_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fbdev.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fbdev.c new file mode 100644 index 0000000000000000000000000000000000000000..8c424fc35e0c137afd254be391c7825bc4ea800b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fbdev.c @@ -0,0 +1,152 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_gem.h" +#include "phytium_fb.h" + + +#define PHYTIUM_MAX_CONNECTOR 1 +#define helper_to_drm_private(x) container_of(x, struct phytium_display_private, fbdev_helper) + +static void phytium_fbdev_destroy(struct fb_info *info) +{ + struct drm_fb_helper *helper = info->par; + struct phytium_display_private *priv = helper_to_drm_private(helper); + + phytium_gem_free_object(&priv->fbdev_phytium_gem->base); +} + +static int phytium_fbdev_mmap(struct fb_info *info, struct vm_area_struct *vma) +{ + struct drm_fb_helper *helper = info->par; + struct phytium_display_private *priv = helper_to_drm_private(helper); + + return phytium_gem_mmap_obj(&priv->fbdev_phytium_gem->base, vma); +} + +static const struct fb_ops phytium_fbdev_ops = { + .owner = THIS_MODULE, + .fb_mmap = phytium_fbdev_mmap, + .fb_destroy = phytium_fbdev_destroy, + DRM_FB_HELPER_DEFAULT_OPS, + __FB_DEFAULT_IOMEM_OPS_RDWR, + __FB_DEFAULT_IOMEM_OPS_DRAW, +}; + +static int +phytium_drm_fbdev_create(struct drm_fb_helper *helper, struct drm_fb_helper_surface_size *sizes) +{ + struct phytium_display_private *priv = helper_to_drm_private(helper); + struct drm_device *dev = helper->dev; + unsigned int bytes_per_pixel; + struct drm_mode_fb_cmd2 mode_cmd = {0}; + struct phytium_framebuffer *phytium_fb = NULL; + struct fb_info *fbi = NULL; + struct drm_framebuffer *fb = NULL; + size_t size = 0; + int ret = 0; + unsigned long offset; + + bytes_per_pixel = DIV_ROUND_UP(sizes->surface_bpp, 8); + mode_cmd.width = sizes->surface_width; + mode_cmd.height = sizes->surface_height; + mode_cmd.pitches[0] = ALIGN(sizes->surface_width * bytes_per_pixel, 128); + mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, sizes->surface_depth); + size = PAGE_ALIGN(mode_cmd.pitches[0] * mode_cmd.height); + + ret = mutex_lock_interruptible(&dev->struct_mutex); + if (ret < 0) { + DRM_ERROR("failed to get mutex lock\n"); + return ret; + } + + priv->fbdev_phytium_gem = phytium_gem_create_object(dev, size); + if (!priv->fbdev_phytium_gem) { + DRM_ERROR("failed to create gem object\n"); + return -ENOMEM; + } + mutex_unlock(&dev->struct_mutex); + + fbi = drm_fb_helper_alloc_info(helper); + if (IS_ERR(fbi)) { + DRM_DEV_ERROR(dev->dev, "Failed to create framebuffer info."); + ret = PTR_ERR(fbi); + goto out; + } + + phytium_fb = phytium_fb_alloc(dev, &mode_cmd, &priv->fbdev_phytium_gem, 1); + if (IS_ERR(phytium_fb)) { + DRM_DEV_ERROR(dev->dev, "Failed to alloc DRM framebuffer.\n"); + ret = PTR_ERR(phytium_fb); + goto out; + } + + helper->fb = &(phytium_fb->base); + fbi->par = helper; + fbi->fbops = &phytium_fbdev_ops; + + fb = helper->fb; + drm_fb_helper_fill_info(fbi, helper, sizes); + + offset = fbi->var.xoffset * bytes_per_pixel; + offset += fbi->var.yoffset * fb->pitches[0]; + fbi->screen_base = priv->fbdev_phytium_gem->vaddr + offset; + fbi->screen_size = priv->fbdev_phytium_gem->base.size; + fbi->fix.smem_len = priv->fbdev_phytium_gem->base.size; + DRM_DEBUG_KMS("FB [%dx%d]-%d kvaddr=%pa offset=%ld size=%zu\n", fb->width, fb->height, + fb->format->depth, &priv->fbdev_phytium_gem->iova, offset, size); + fbi->skip_vt_switch = true; + + return 0; +out: + phytium_gem_free_object(&priv->fbdev_phytium_gem->base); + return ret; +} + +static const struct drm_fb_helper_funcs phytium_drm_fb_helper_funcs = { + .fb_probe = phytium_drm_fbdev_create, +}; + +int phytium_drm_fbdev_init(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + struct drm_fb_helper *helper; + int ret; + + if (!dev->mode_config.num_crtc || !dev->mode_config.num_connector) + return -EINVAL; + + helper = &priv->fbdev_helper; + drm_fb_helper_prepare(dev, helper, 32, &phytium_drm_fb_helper_funcs); + + ret = drm_fb_helper_init(dev, helper); + if (ret < 0) { + DRM_DEV_ERROR(dev->dev, "Failed to initialize drm fb helper -ret %d\n", ret); + return ret; + } + + ret = drm_fb_helper_initial_config(helper); + return 0; +} + +void phytium_drm_fbdev_fini(struct drm_device *dev) +{ + struct phytium_display_private *priv = dev->dev_private; + struct drm_fb_helper *helper; + + helper = &priv->fbdev_helper; + drm_fb_helper_unregister_info(helper); + + if (helper->fb) + drm_framebuffer_put(helper->fb); + + drm_fb_helper_fini(helper); +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fbdev.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fbdev.h new file mode 100644 index 0000000000000000000000000000000000000000..ff63ba84d7728c76635193db762b627ba4a0ac42 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_fbdev.h @@ -0,0 +1,13 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _PHYTIUM_FBDEV_H +#define _PHYTIUM_FBDEV_H + +int phytium_drm_fbdev_init(struct drm_device *dev); +void phytium_drm_fbdev_fini(struct drm_device *dev); + +#endif /* _PHYTIUM_FBDEV_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_gem.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_gem.c new file mode 100644 index 0000000000000000000000000000000000000000..7d962076f7d7f87282f3d4fd640220b310be4c31 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_gem.c @@ -0,0 +1,520 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_gem.h" + +#define VRAM_POOL_ALLOC_ORDER 12 + +int phytium_memory_pool_alloc(struct phytium_display_private *priv, void **pvaddr, + phys_addr_t *phys_addr, uint64_t size) +{ + unsigned long vaddr; + + vaddr = gen_pool_alloc(priv->memory_pool, size); + if (!vaddr) + return -ENOMEM; + + *phys_addr = gen_pool_virt_to_phys(priv->memory_pool, vaddr); + + *pvaddr = (void *)vaddr; + return 0; +} + +void phytium_memory_pool_free(struct phytium_display_private *priv, void *vaddr, uint64_t size) +{ + gen_pool_free(priv->memory_pool, (unsigned long)vaddr, size); +} + +int phytium_memory_pool_init(struct device *dev, struct phytium_display_private *priv) +{ + int ret = 0; + + priv->memory_pool = gen_pool_create(VRAM_POOL_ALLOC_ORDER, -1); + if (priv->memory_pool == NULL) { + DRM_ERROR("fail to create memory pool\n"); + ret = -1; + goto failed_create_pool; + } + + ret = gen_pool_add_virt(priv->memory_pool, (unsigned long)priv->pool_virt_addr, + priv->pool_phys_addr, priv->pool_size, -1); + if (ret) { + DRM_ERROR("fail to add vram pool\n"); + ret = -1; + goto failed_add_pool_virt; + } + + return 0; + +failed_add_pool_virt: + gen_pool_destroy(priv->memory_pool); + +failed_create_pool: + return ret; +} + +void phytium_memory_pool_fini(struct device *dev, struct phytium_display_private *priv) +{ + gen_pool_destroy(priv->memory_pool); +} + +struct sg_table * +phytium_gem_prime_get_sg_table(struct drm_gem_object *obj) +{ + struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); + struct sg_table *sgt; + struct drm_device *dev = obj->dev; + int ret; + struct page *page = NULL; + + sgt = kzalloc(sizeof(*sgt), GFP_KERNEL); + if (!sgt) { + DRM_DEBUG_KMS("malloc sgt fail\n"); + return ERR_PTR(-ENOMEM); + } + + if ((phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) || + (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE) || + (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT)) { + ret = sg_alloc_table(sgt, 1, GFP_KERNEL); + if (ret) { + DRM_ERROR("failed to allocate sg\n"); + goto sgt_free; + } + page = phys_to_page(phytium_gem_obj->phys_addr); + sg_set_page(sgt->sgl, page, PAGE_ALIGN(phytium_gem_obj->size), 0); + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { + ret = dma_get_sgtable_attrs(dev->dev, sgt, phytium_gem_obj->vaddr, + phytium_gem_obj->iova, phytium_gem_obj->size, + DMA_ATTR_WRITE_COMBINE); + if (ret) { + DRM_ERROR("failed to allocate sgt, %d\n", ret); + goto sgt_free; + } + } + + return sgt; +sgt_free: + kfree(sgt); + return ERR_PTR(ret); +} + +struct drm_gem_object * +phytium_gem_prime_import_sg_table(struct drm_device *dev, + struct dma_buf_attachment *attach, + struct sg_table *sgt) +{ + struct phytium_gem_object *phytium_gem_obj = NULL; + struct scatterlist *s; + dma_addr_t expected; + int ret, i; + + phytium_gem_obj = kzalloc(sizeof(*phytium_gem_obj), GFP_KERNEL); + if (!phytium_gem_obj) { + DRM_ERROR("failed to allocate phytium_gem_obj\n"); + ret = -ENOMEM; + goto failed_malloc; + } + + ret = drm_gem_object_init(dev, &phytium_gem_obj->base, attach->dmabuf->size); + if (ret) { + DRM_ERROR("failed to initialize drm gem object: %d\n", ret); + goto failed_object_init; + } + + expected = sg_dma_address(sgt->sgl); + for_each_sg(sgt->sgl, s, sgt->nents, i) { + if (sg_dma_address(s) != expected) { + DRM_ERROR("sg_table is not contiguous"); + ret = -EINVAL; + goto failed_check_continue; + } + expected = sg_dma_address(s) + sg_dma_len(s); + } + + phytium_gem_obj->iova = sg_dma_address(sgt->sgl); + phytium_gem_obj->sgt = sgt; + + return &phytium_gem_obj->base; +failed_check_continue: + drm_gem_object_release(&phytium_gem_obj->base); +failed_object_init: + kfree(phytium_gem_obj); +failed_malloc: + return ERR_PTR(ret); +} + +int phytium_gem_prime_vmap(struct drm_gem_object *obj, struct iosys_map *map) +{ + struct phytium_gem_object *phytium_obj = to_phytium_gem_obj(obj); + + iosys_map_set_vaddr(map, phytium_obj->vaddr); + + return 0; +} + +void phytium_gem_prime_vunmap(struct drm_gem_object *obj, struct iosys_map *map) +{ +} + +int phytium_gem_prime_mmap(struct drm_gem_object *obj, struct vm_area_struct *vma) +{ + return phytium_gem_mmap_obj(obj, vma); +} + +static void phytium_dma_callback(void *callback_param) +{ + struct completion *comp = callback_param; + + complete(comp); +} + +int phytium_dma_transfer(struct drm_device *drm_dev, int dev_to_mem, void *addr, + dma_addr_t iova, uint64_t size) +{ + struct phytium_display_private *priv = drm_dev->dev_private; + struct dma_chan *dma_chan = priv->dma_chan; + struct sg_table st; + struct scatterlist *sgl; + int ret = 0, timeout; + uint32_t nents, i; + struct dma_slave_config cfg = {0}; + struct dma_async_tx_descriptor *desc; + struct completion comp; + enum dma_data_direction dir; + size_t min = 0; + + nents = DIV_ROUND_UP(size, PAGE_SIZE); + ret = sg_alloc_table(&st, nents, GFP_KERNEL); + if (ret) { + DRM_ERROR("failed to allocate sg_table\n"); + ret = -ENOMEM; + goto failed_sg_alloc_table; + } + + for_each_sg(st.sgl, sgl, st.nents, i) { + min = min_t(size_t, size, PAGE_SIZE - offset_in_page(addr)); + sg_set_page(sgl, vmalloc_to_page(addr), min, offset_in_page(addr)); + addr += min; + size -= min; + } + + memset(&cfg, 0, sizeof(cfg)); + if (dev_to_mem) { + cfg.direction = DMA_DEV_TO_MEM; + cfg.src_addr = iova; + cfg.dst_addr = 0; + dir = DMA_FROM_DEVICE; + } else { + cfg.direction = DMA_MEM_TO_DEV; + cfg.src_addr = 0; + cfg.dst_addr = iova; + dir = DMA_TO_DEVICE; + } + + dmaengine_slave_config(dma_chan, &cfg); + + nents = dma_map_sg(dma_chan->device->dev, st.sgl, st.nents, dir); + if (!nents) { + DRM_DEV_ERROR(drm_dev->dev, "failed to dma_map_sg for dmaengine\n"); + ret = -EINVAL; + goto failed_dma_map_sg; + } + st.nents = nents; + dma_sync_sg_for_device(dma_chan->device->dev, st.sgl, st.nents, dir); + + sgl = st.sgl; + desc = dmaengine_prep_slave_sg(dma_chan, + st.sgl, + st.nents, + cfg.direction, + DMA_PREP_INTERRUPT | DMA_CTRL_ACK); + if (!desc) { + DRM_DEV_ERROR(drm_dev->dev, "failed to dmaengine_prep_slave_sg\n"); + ret = -EINVAL; + goto failed_prep_slave_sg; + } + init_completion(&comp); + desc->callback = phytium_dma_callback; + desc->callback_param = ∁ + + dmaengine_submit(desc); + dma_async_issue_pending(dma_chan); + + timeout = wait_for_completion_timeout(&comp, 2 * HZ); + if (timeout == 0) { + DRM_DEV_ERROR(drm_dev->dev, "wait for dma callback timeout\n"); + ret = -EIO; + } + dma_sync_sg_for_cpu(dma_chan->device->dev, st.sgl, st.nents, dir); + +failed_prep_slave_sg: + dma_unmap_sg(dma_chan->device->dev, st.sgl, st.nents, dir); +failed_dma_map_sg: + sg_free_table(&st); +failed_sg_alloc_table: + return ret; +} + +int phytium_gem_suspend(struct drm_device *drm_dev) +{ + struct phytium_display_private *priv = drm_dev->dev_private; + struct phytium_gem_object *phytium_gem_obj = NULL; + int ret = 0; + + list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { + if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && + (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) + continue; + + phytium_gem_obj->vaddr_save = vmalloc(phytium_gem_obj->size); + if (!phytium_gem_obj->vaddr_save) + goto malloc_failed; + + if (priv->dma_inited) + ret = phytium_dma_transfer(drm_dev, 1, phytium_gem_obj->vaddr_save, + phytium_gem_obj->iova, phytium_gem_obj->size); + + if ((!priv->dma_inited) || ret) + memcpy(phytium_gem_obj->vaddr_save, phytium_gem_obj->vaddr, + phytium_gem_obj->size); + } + + return 0; +malloc_failed: + list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { + if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && + (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) + continue; + + if (phytium_gem_obj->vaddr_save) { + vfree(phytium_gem_obj->vaddr_save); + phytium_gem_obj->vaddr_save = NULL; + } + } + return -ENOMEM; +} + +void phytium_gem_resume(struct drm_device *drm_dev) +{ + struct phytium_display_private *priv = drm_dev->dev_private; + struct phytium_gem_object *phytium_gem_obj = NULL; + + list_for_each_entry(phytium_gem_obj, &priv->gem_list_head, list) { + if ((phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_WC) && + (phytium_gem_obj->memory_type != MEMORY_TYPE_VRAM_DEVICE)) + continue; + + memcpy(phytium_gem_obj->vaddr, phytium_gem_obj->vaddr_save, phytium_gem_obj->size); + vfree(phytium_gem_obj->vaddr_save); + phytium_gem_obj->vaddr_save = NULL; + } +} + +void phytium_gem_free_object(struct drm_gem_object *obj) +{ + struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); + struct drm_device *dev = obj->dev; + struct phytium_display_private *priv = dev->dev_private; + uint64_t size = phytium_gem_obj->size; + + DRM_DEBUG_KMS("free phytium_gem_obj iova:0x%pa size:0x%lx\n", + &phytium_gem_obj->iova, phytium_gem_obj->size); + if (phytium_gem_obj->vaddr) { + if ((phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) || + (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE)) { + phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); + priv->mem_state[PHYTIUM_MEM_VRAM_ALLOC] -= size; + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { + dma_unmap_page(dev->dev, phytium_gem_obj->iova, size, DMA_TO_DEVICE); + phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); + priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC] -= size; + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { + dma_free_attrs(dev->dev, size, phytium_gem_obj->vaddr, + phytium_gem_obj->iova, 0); + priv->mem_state[PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC] -= size; + } + list_del(&phytium_gem_obj->list); + } else if (obj->import_attach) + drm_prime_gem_destroy(obj, phytium_gem_obj->sgt); + drm_gem_object_release(obj); + kfree(phytium_gem_obj); +} + +int phytium_gem_mmap_obj(struct drm_gem_object *obj, struct vm_area_struct *vma) +{ + int ret = 0; + struct phytium_gem_object *phytium_gem_obj = to_phytium_gem_obj(obj); + unsigned long pfn = PHYS_PFN(phytium_gem_obj->phys_addr); + /* + * Clear the VM_PFNMAP flag that was set by drm_gem_mmap(), and set the + * vm_pgoff (used as a fake buffer offset by DRM) to 0 as we want to map + * the whole buffer. + */ + vm_flags_clear(vma, VM_PFNMAP); + vma->vm_pgoff = 0; + vma->vm_page_prot = vm_get_page_prot(vma->vm_flags); + + if (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_WC) { + vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot); + ret = remap_pfn_range(vma, vma->vm_start, pfn, + vma->vm_end - vma->vm_start, vma->vm_page_prot); + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_VRAM_DEVICE) { + vma->vm_page_prot = pgprot_device(vma->vm_page_prot); + ret = remap_pfn_range(vma, vma->vm_start, pfn, + vma->vm_end - vma->vm_start, vma->vm_page_prot); + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { + ret = remap_pfn_range(vma, vma->vm_start, pfn, + vma->vm_end - vma->vm_start, vma->vm_page_prot); + } else if (phytium_gem_obj->memory_type == MEMORY_TYPE_SYSTEM_UNIFIED) { + ret = dma_mmap_attrs(obj->dev->dev, vma, phytium_gem_obj->vaddr, + phytium_gem_obj->iova, vma->vm_end - vma->vm_start, 0); + } + if (ret) + drm_gem_vm_close(vma); + + return ret; +} + +int phytium_gem_mmap(struct file *filp, struct vm_area_struct *vma) +{ + int ret = 0; + + ret = drm_gem_mmap(filp, vma); + return ret; +} + +static const struct vm_operations_struct phytium_vm_ops = { + .open = drm_gem_vm_open, + .close = drm_gem_vm_close, +}; + +static const struct drm_gem_object_funcs phytium_drm_gem_object_funcs = { + .free = phytium_gem_free_object, + .get_sg_table = phytium_gem_prime_get_sg_table, + .vmap = phytium_gem_prime_vmap, + .vunmap = phytium_gem_prime_vunmap, + .vm_ops = &phytium_vm_ops, + .mmap = phytium_gem_prime_mmap, +}; + +struct phytium_gem_object *phytium_gem_create_object(struct drm_device *dev, unsigned long size) +{ + struct phytium_gem_object *phytium_gem_obj = NULL; + struct phytium_display_private *priv = dev->dev_private; + struct page *page = NULL; + int ret = 0; + + phytium_gem_obj = kzalloc(sizeof(*phytium_gem_obj), GFP_KERNEL); + if (!phytium_gem_obj) { + DRM_ERROR("failed to allocate phytium_gem_obj\n"); + ret = -ENOMEM; + goto error; + } + + ret = drm_gem_object_init(dev, &phytium_gem_obj->base, size); + if (ret) { + DRM_ERROR("failed to initialize drm gem object: %d\n", ret); + goto failed_object_init; + } + + if (priv->support_memory_type & (MEMORY_TYPE_VRAM_WC | MEMORY_TYPE_VRAM_DEVICE)) { + ret = phytium_memory_pool_alloc(priv, &phytium_gem_obj->vaddr, + &phytium_gem_obj->phys_addr, size); + if (ret) { + DRM_ERROR("fail to allocate vram buffer with size %lx\n", size); + goto failed_dma_alloc; + } + phytium_gem_obj->iova = phytium_gem_obj->phys_addr; + phytium_gem_obj->memory_type = priv->support_memory_type; + priv->mem_state[PHYTIUM_MEM_VRAM_ALLOC] += size; + } else if (priv->support_memory_type & MEMORY_TYPE_SYSTEM_CARVEOUT) { + ret = phytium_memory_pool_alloc(priv, &phytium_gem_obj->vaddr, + &phytium_gem_obj->phys_addr, size); + if (ret) { + DRM_ERROR("fail to allocate carveout memory with size %lx\n", size); + goto failed_dma_alloc; + } + page = phys_to_page(phytium_gem_obj->phys_addr); + phytium_gem_obj->iova = dma_map_page(dev->dev, page, 0, size, DMA_TO_DEVICE); + if (dma_mapping_error(dev->dev, phytium_gem_obj->iova)) { + DRM_ERROR("fail to dma map carveout memory with size %lx\n", size); + phytium_memory_pool_free(priv, phytium_gem_obj->vaddr, size); + ret = -ENOMEM; + goto failed_dma_alloc; + } + phytium_gem_obj->memory_type = MEMORY_TYPE_SYSTEM_CARVEOUT; + priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_ALLOC] += size; + } else if (priv->support_memory_type & MEMORY_TYPE_SYSTEM_UNIFIED) { + phytium_gem_obj->vaddr = dma_alloc_attrs(dev->dev, size, &phytium_gem_obj->iova, + GFP_KERNEL, 0); + if (!phytium_gem_obj->vaddr) { + DRM_ERROR("fail to allocate unified buffer with size %lx\n", size); + ret = -ENOMEM; + goto failed_dma_alloc; + } + phytium_gem_obj->memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; + priv->mem_state[PHYTIUM_MEM_SYSTEM_UNIFIED_ALLOC] += size; + } else { + DRM_ERROR("fail to allocate buffer with size %lx\n", size); + ret = -ENOMEM; + goto failed_dma_alloc; + } + + phytium_gem_obj->base.funcs = &phytium_drm_gem_object_funcs; + + phytium_gem_obj->size = size; + list_add_tail(&phytium_gem_obj->list, &priv->gem_list_head); + DRM_DEBUG_KMS("phytium_gem_obj iova:0x%pa size:0x%lx\n", + &phytium_gem_obj->iova, phytium_gem_obj->size); + return phytium_gem_obj; + +failed_dma_alloc: + drm_gem_object_put(&phytium_gem_obj->base); + + return ERR_PTR(ret); +failed_object_init: + kfree(phytium_gem_obj); +error: + return ERR_PTR(ret); +} + +int phytium_gem_dumb_create(struct drm_file *file, struct drm_device *dev, + struct drm_mode_create_dumb *args) +{ + int size = 0; + struct phytium_gem_object *phytium_gem_obj = NULL; + int ret = 0; + + args->pitch = ALIGN(args->width*DIV_ROUND_UP(args->bpp, 8), 128); + args->size = args->pitch * args->height; + size = PAGE_ALIGN(args->size); + phytium_gem_obj = phytium_gem_create_object(dev, size); + if (IS_ERR(phytium_gem_obj)) + return PTR_ERR(phytium_gem_obj); + ret = drm_gem_handle_create(file, &phytium_gem_obj->base, &args->handle); + if (ret) { + DRM_ERROR("failed to drm_gem_handle_create\n"); + goto failed_gem_handle; + } + drm_gem_object_put(&phytium_gem_obj->base); + + return 0; +failed_gem_handle: + phytium_gem_free_object(&phytium_gem_obj->base); + return ret; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_gem.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_gem.h new file mode 100644 index 0000000000000000000000000000000000000000..693d5408fee0dbf7db7b3fbde88c8fb03e43d650 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_gem.h @@ -0,0 +1,42 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_GEM_H__ +#define __PHYTIUM_GEM_H__ + +#include + +struct phytium_gem_object { + struct drm_gem_object base; + phys_addr_t phys_addr; + dma_addr_t iova; + void *vaddr; + unsigned long size; + struct sg_table *sgt; + char memory_type; + char reserve[3]; + struct list_head list; + void *vaddr_save; +}; + +#define to_phytium_gem_obj(obj) container_of(obj, struct phytium_gem_object, base) + +int phytium_memory_pool_init(struct device *dev, struct phytium_display_private *priv); +void phytium_memory_pool_fini(struct device *dev, struct phytium_display_private *priv); +int phytium_gem_mmap_obj(struct drm_gem_object *obj, struct vm_area_struct *vma); +int phytium_gem_mmap(struct file *filp, struct vm_area_struct *vma); +void phytium_gem_free_object(struct drm_gem_object *obj); +struct sg_table *phytium_gem_prime_get_sg_table(struct drm_gem_object *obj); +struct drm_gem_object *phytium_gem_prime_import_sg_table(struct drm_device *dev, + struct dma_buf_attachment *attach, struct sg_table *sgt); +void phytium_gem_free_object(struct drm_gem_object *obj); +int phytium_gem_dumb_destroy(struct drm_file *file, struct drm_device *dev, unsigned int handle); +struct phytium_gem_object *phytium_gem_create_object(struct drm_device *dev, unsigned long size); +int phytium_gem_dumb_create(struct drm_file *file, struct drm_device *dev, + struct drm_mode_create_dumb *args); +int phytium_gem_suspend(struct drm_device *drm_dev); +void phytium_gem_resume(struct drm_device *drm_dev); +#endif /* __PHYTIUM_GEM_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_panel.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_panel.c new file mode 100644 index 0000000000000000000000000000000000000000..15fe45f42680aa6972963c6ddbff08384f345ea9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_panel.c @@ -0,0 +1,420 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_dp.h" +#include "phytium_panel.h" + +static int +phytium_dp_aux_set_backlight(struct phytium_panel *panel, unsigned int level) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + unsigned char vals[2] = { 0x0 }; + + vals[0] = level; + if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) { + vals[0] = (level & 0xFF00) >> 8; + vals[1] = (level & 0xFF); + } + + if (drm_dp_dpcd_write(&phytium_dp->aux, DP_EDP_BACKLIGHT_BRIGHTNESS_MSB, + vals, sizeof(vals)) < 0) { + DRM_DEBUG_KMS("Failed to write aux backlight level\n"); + return -EIO; + } + + return 0; +} + +static unsigned int phytium_dp_aux_get_backlight(struct phytium_panel *panel) +{ + unsigned char read_val[2] = { 0x0 }; + unsigned char level = 0; + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + if (drm_dp_dpcd_read(&phytium_dp->aux, DP_EDP_BACKLIGHT_BRIGHTNESS_MSB, + &read_val, sizeof(read_val)) < 0) { + DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", + DP_EDP_BACKLIGHT_BRIGHTNESS_MSB); + return 0; + } + + level = read_val[0]; + if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) + level = (read_val[0] << 8 | read_val[1]); + + return level; +} + +static void set_aux_backlight_enable(struct phytium_panel *panel, bool enable) +{ + u8 reg_val = 0; + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + if (!(phytium_dp->edp_dpcd[1] & DP_EDP_BACKLIGHT_AUX_ENABLE_CAP)) + return; + + if (drm_dp_dpcd_readb(&phytium_dp->aux, DP_EDP_DISPLAY_CONTROL_REGISTER, + ®_val) < 0) { + DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", + DP_EDP_DISPLAY_CONTROL_REGISTER); + return; + } + + if (enable) + reg_val |= DP_EDP_BACKLIGHT_ENABLE; + else + reg_val &= ~(DP_EDP_BACKLIGHT_ENABLE); + + if (drm_dp_dpcd_writeb(&phytium_dp->aux, DP_EDP_DISPLAY_CONTROL_REGISTER, + reg_val) != 1) { + DRM_DEBUG_KMS("Failed to %s aux backlight\n", + enable ? "enable" : "disable"); + } +} + +static void phytium_dp_aux_enable_backlight(struct phytium_panel *panel) +{ + unsigned char dpcd_buf, new_dpcd_buf, edp_backlight_mode; + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + if (drm_dp_dpcd_readb(&phytium_dp->aux, + DP_EDP_BACKLIGHT_MODE_SET_REGISTER, &dpcd_buf) != 1) { + DRM_DEBUG_KMS("Failed to read DPCD register 0x%x\n", + DP_EDP_BACKLIGHT_MODE_SET_REGISTER); + return; + } + + new_dpcd_buf = dpcd_buf; + edp_backlight_mode = dpcd_buf & DP_EDP_BACKLIGHT_CONTROL_MODE_MASK; + + switch (edp_backlight_mode) { + case DP_EDP_BACKLIGHT_CONTROL_MODE_PWM: + case DP_EDP_BACKLIGHT_CONTROL_MODE_PRESET: + case DP_EDP_BACKLIGHT_CONTROL_MODE_PRODUCT: + new_dpcd_buf &= ~DP_EDP_BACKLIGHT_CONTROL_MODE_MASK; + new_dpcd_buf |= DP_EDP_BACKLIGHT_CONTROL_MODE_DPCD; + break; + + /* Do nothing when it is already DPCD mode */ + case DP_EDP_BACKLIGHT_CONTROL_MODE_DPCD: + default: + break; + } + + if (new_dpcd_buf != dpcd_buf) { + if (drm_dp_dpcd_writeb(&phytium_dp->aux, + DP_EDP_BACKLIGHT_MODE_SET_REGISTER, new_dpcd_buf) < 0) { + DRM_DEBUG_KMS("Failed to write aux backlight mode\n"); + } + } + + set_aux_backlight_enable(panel, true); + phytium_dp_aux_set_backlight(panel, panel->level); +} + +static void phytium_dp_aux_disable_backlight(struct phytium_panel *panel) +{ + set_aux_backlight_enable(panel, false); +} + +static void phytium_dp_aux_setup_backlight(struct phytium_panel *panel) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + if (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_BYTE_COUNT) + phytium_dp->panel.max = 0xFFFF; + else + phytium_dp->panel.max = 0xFF; + + phytium_dp->panel.min = 0; + phytium_dp->panel.level = phytium_dp_aux_get_backlight(panel); + phytium_dp->panel.backlight_enabled = (phytium_dp->panel.level != 0); +} + +static void phytium_dp_hw_poweron_panel(struct phytium_panel *panel) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + phytium_dp->funcs->dp_hw_poweron_panel(phytium_dp); +} + +static void phytium_dp_hw_poweroff_panel(struct phytium_panel *panel) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + phytium_dp->funcs->dp_hw_poweroff_panel(phytium_dp); +} + +static int +phytium_dp_hw_set_backlight(struct phytium_panel *panel, uint32_t level) +{ + int ret; + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + ret = phytium_dp->funcs->dp_hw_set_backlight(phytium_dp, level); + + return ret; +} + +static uint32_t phytium_dp_hw_get_backlight(struct phytium_panel *panel) +{ + uint32_t ret; + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + ret = phytium_dp->funcs->dp_hw_get_backlight(phytium_dp); + + return ret; +} + +static void phytium_dp_hw_enable_backlight(struct phytium_panel *panel) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + phytium_dp->funcs->dp_hw_set_backlight(phytium_dp, phytium_dp->panel.level); + phytium_dp->funcs->dp_hw_enable_backlight(phytium_dp); +} + +static void phytium_dp_hw_disable_backlight(struct phytium_panel *panel) +{ + struct phytium_dp_device *phytium_dp = panel_to_dp_device(panel); + + phytium_dp->funcs->dp_hw_disable_backlight(phytium_dp); +} + +static void phytium_dp_hw_setup_backlight(struct phytium_panel *panel) +{ + struct drm_device *dev = panel->dev; + struct phytium_display_private *priv = dev->dev_private; + + panel->max = priv->info.backlight_max; + panel->min = priv->info.backlight_min; + panel->level = phytium_dp_hw_get_backlight(panel); +} + +void phytium_dp_panel_init_backlight_funcs(struct phytium_dp_device *phytium_dp) +{ + if (phytium_dp->edp_dpcd[1] & DP_EDP_TCON_BACKLIGHT_ADJUSTMENT_CAP && + (phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_AUX_SET_CAP) && + !(phytium_dp->edp_dpcd[2] & DP_EDP_BACKLIGHT_BRIGHTNESS_PWM_PIN_CAP)) { + DRM_DEBUG_KMS("AUX Backlight Control Supported!\n"); + phytium_dp->panel.setup_backlight = phytium_dp_aux_setup_backlight; + phytium_dp->panel.enable_backlight = phytium_dp_aux_enable_backlight; + phytium_dp->panel.disable_backlight = phytium_dp_aux_disable_backlight; + phytium_dp->panel.set_backlight = phytium_dp_aux_set_backlight; + phytium_dp->panel.get_backlight = phytium_dp_aux_get_backlight; + } else { + DRM_DEBUG_KMS("PWM Backlight Control Supported!\n"); + phytium_dp->panel.setup_backlight = phytium_dp_hw_setup_backlight; + phytium_dp->panel.enable_backlight = phytium_dp_hw_enable_backlight; + phytium_dp->panel.disable_backlight = phytium_dp_hw_disable_backlight; + phytium_dp->panel.set_backlight = phytium_dp_hw_set_backlight; + phytium_dp->panel.get_backlight = phytium_dp_hw_get_backlight; + } + phytium_dp->panel.poweron = phytium_dp_hw_poweron_panel; + phytium_dp->panel.poweroff = phytium_dp_hw_poweroff_panel; + mutex_init(&phytium_dp->panel.panel_lock); + phytium_dp->panel.dev = phytium_dp->dev; + + /* Upper limits from eDP 1.3 spec */ + phytium_dp->panel.panel_power_up_delay = 210; /* t1_t3 */ + phytium_dp->panel.backlight_on_delay = 50; /* t7 */ + phytium_dp->panel.backlight_off_delay = 50; + phytium_dp->panel.panel_power_down_delay = 0; /* t10 */ + phytium_dp->panel.panel_power_cycle_delay = 510; /* t11 + t12 */ +} + +void phytium_dp_panel_release_backlight_funcs(struct phytium_dp_device *phytium_dp) +{ + phytium_dp->panel.setup_backlight = NULL; + phytium_dp->panel.enable_backlight = NULL; + phytium_dp->panel.disable_backlight = NULL; + phytium_dp->panel.set_backlight = NULL; + phytium_dp->panel.get_backlight = NULL; + phytium_dp->panel.poweron = NULL; + phytium_dp->panel.poweroff = NULL; +} + +void phytium_panel_enable_backlight(struct phytium_panel *panel) +{ + + if (panel->enable_backlight) { + mutex_lock(&panel->panel_lock); + msleep(panel->backlight_on_delay); + panel->enable_backlight(panel); + panel->backlight_enabled = true; + mutex_unlock(&panel->panel_lock); + } +} + +void phytium_panel_disable_backlight(struct phytium_panel *panel) +{ + if (panel->disable_backlight) { + mutex_lock(&panel->panel_lock); + panel->disable_backlight(panel); + panel->backlight_enabled = false; + msleep(panel->backlight_off_delay); + mutex_unlock(&panel->panel_lock); + } +} + +void phytium_panel_poweron(struct phytium_panel *panel) +{ + if (panel->poweron) { + mutex_lock(&panel->panel_lock); + panel->poweron(panel); + panel->power_enabled = true; + msleep(panel->panel_power_up_delay); + mutex_unlock(&panel->panel_lock); + } +} + +void phytium_panel_poweroff(struct phytium_panel *panel) +{ + if (panel->poweroff) { + mutex_lock(&panel->panel_lock); + msleep(panel->panel_power_down_delay); + panel->poweroff(panel); + panel->power_enabled = false; + mutex_unlock(&panel->panel_lock); + } +} + +static uint32_t phytium_scale(uint32_t source_val, + uint32_t source_min, uint32_t source_max, + uint32_t target_min, uint32_t target_max) +{ + uint64_t target_val; + + WARN_ON(source_min > source_max); + WARN_ON(target_min > target_max); + + /* defensive */ + source_val = clamp(source_val, source_min, source_max); + + /* avoid overflows */ + target_val = mul_u32_u32(source_val - source_min, target_max - target_min); + target_val = DIV_ROUND_CLOSEST_ULL(target_val, source_max - source_min); + target_val += target_min; + + return target_val; +} + +static inline uint32_t +phytium_scale_hw_to_user(struct phytium_panel *panel, uint32_t hw_level, uint32_t user_max) +{ + return phytium_scale(hw_level, panel->min, panel->max, + 0, user_max); +} + +static inline uint32_t +phytium_scale_user_to_hw(struct phytium_panel *panel, u32 user_level, u32 user_max) +{ + return phytium_scale(user_level, 0, user_max, + panel->min, panel->max); +} + +static int phytium_backlight_device_update_status(struct backlight_device *bd) +{ + struct phytium_panel *panel = bl_get_data(bd); + struct drm_device *dev = panel->dev; + uint32_t hw_level = 0; + int ret = 0; + + DRM_DEBUG_KMS("updating phytium_backlight, brightness=%d/%d\n", + bd->props.brightness, bd->props.max_brightness); + drm_modeset_lock(&dev->mode_config.connection_mutex, NULL); + hw_level = phytium_scale_user_to_hw(panel, bd->props.brightness, bd->props.max_brightness); + + if ((panel->set_backlight) && (panel->backlight_enabled)) { + mutex_lock(&panel->panel_lock); + ret = panel->set_backlight(panel, hw_level); + panel->level = hw_level; + mutex_unlock(&panel->panel_lock); + } + drm_modeset_unlock(&dev->mode_config.connection_mutex); + + return ret; +} + +static int phytium_backlight_device_get_brightness(struct backlight_device *bd) +{ + struct phytium_panel *panel = bl_get_data(bd); + struct drm_device *dev = panel->dev; + uint32_t hw_level = 0; + int ret; + + drm_modeset_lock(&dev->mode_config.connection_mutex, NULL); + if (panel->get_backlight && panel->backlight_enabled) { + mutex_lock(&panel->panel_lock); + hw_level = panel->get_backlight(panel); + panel->level = hw_level; + mutex_unlock(&panel->panel_lock); + } + drm_modeset_unlock(&dev->mode_config.connection_mutex); + ret = phytium_scale_hw_to_user(panel, hw_level, bd->props.max_brightness); + DRM_DEBUG_KMS("get phytium_backlight, brightness=%d/%d\n", + ret, bd->props.max_brightness); + + return ret; +} + +static const struct backlight_ops phytium_backlight_device_ops = { + .update_status = phytium_backlight_device_update_status, + .get_brightness = phytium_backlight_device_get_brightness, +}; + +int phytium_edp_backlight_device_register(struct phytium_dp_device *phytium_dp) +{ + struct backlight_properties props; + char bl_name[16]; + + if (phytium_dp->panel.setup_backlight) { + mutex_lock(&phytium_dp->panel.panel_lock); + phytium_dp->panel.setup_backlight(&phytium_dp->panel); + mutex_unlock(&phytium_dp->panel.panel_lock); + } else { + return -EINVAL; + } + + memset(&props, 0, sizeof(props)); + props.max_brightness = PHYTIUM_MAX_BL_LEVEL; + props.type = BACKLIGHT_RAW; + props.brightness = phytium_scale_hw_to_user(&phytium_dp->panel, phytium_dp->panel.level, + props.max_brightness); + snprintf(bl_name, sizeof(bl_name), "phytium_bl%d", phytium_dp->port); + + phytium_dp->panel.bl_device = + backlight_device_register(bl_name, + phytium_dp->connector.kdev, + &phytium_dp->panel, + &phytium_backlight_device_ops, + &props); + + if (IS_ERR(phytium_dp->panel.bl_device)) { + DRM_ERROR("Failed to register backlight: %ld\n", + PTR_ERR(phytium_dp->panel.bl_device)); + phytium_dp->panel.bl_device = NULL; + return -ENODEV; + } + + DRM_DEBUG_KMS("Connector %s backlight sysfs interface registered\n", + phytium_dp->connector.name); + + return 0; +} + +void phytium_edp_backlight_device_unregister(struct phytium_dp_device *phytium_dp) +{ + if (phytium_dp->panel.bl_device) { + backlight_device_unregister(phytium_dp->panel.bl_device); + phytium_dp->panel.bl_device = NULL; + } +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_panel.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_panel.h new file mode 100644 index 0000000000000000000000000000000000000000..ff4d760d8400766e932fe7657ed82412f9665e83 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_panel.h @@ -0,0 +1,46 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_PANEL_H__ +#define __PHYTIUM_PANEL_H__ +#include "phytium_dp.h" + +#define PHYTIUM_MAX_BL_LEVEL 0xFF + +struct phytium_panel { + struct drm_device *dev; + bool backlight_enabled; + bool power_enabled; + bool reserve1[2]; + unsigned int min; + unsigned int level; + unsigned int max; + struct backlight_device *bl_device; + void (*setup_backlight)(struct phytium_panel *panel); + uint32_t (*get_backlight)(struct phytium_panel *panel); + int (*set_backlight)(struct phytium_panel *panel, uint32_t level); + void (*disable_backlight)(struct phytium_panel *panel); + void (*enable_backlight)(struct phytium_panel *panel); + void (*poweron)(struct phytium_panel *panel); + void (*poweroff)(struct phytium_panel *panel); + struct mutex panel_lock; + uint32_t panel_power_up_delay; + uint32_t backlight_on_delay; + uint32_t backlight_off_delay; + uint32_t panel_power_down_delay; + uint32_t panel_power_cycle_delay; +}; + +void phytium_dp_panel_init_backlight_funcs(struct phytium_dp_device *phytium_dp); +void phytium_panel_release_backlight_funcs(struct phytium_dp_device *phytium_dp); +int phytium_edp_backlight_device_register(struct phytium_dp_device *phytium_dp); +void phytium_edp_backlight_device_unregister(struct phytium_dp_device *phytium_dp); +void phytium_panel_enable_backlight(struct phytium_panel *panel); +void phytium_panel_disable_backlight(struct phytium_panel *panel); +void phytium_panel_poweron(struct phytium_panel *panel); +void phytium_panel_poweroff(struct phytium_panel *panel); + +#endif /* __PHYTIUM_PANEL_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_pci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_pci.c new file mode 100644 index 0000000000000000000000000000000000000000..80a1db064ee4bc7a7bf82c5b2f65c911c4943673 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_pci.c @@ -0,0 +1,433 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_pci.h" +#include "phytium_dp.h" +#include "phytium_gem.h" +#include "px210_dc.h" +#include "px210_dp.h" +#include "pe220x_dc.h" +#include "pe220x_dp.h" + +int dc_msi_enable; +module_param(dc_msi_enable, int, 0644); +MODULE_PARM_DESC(dc_msi_enable, "Enable DC msi interrupt (0-disabled; 1-enabled; default-0)"); + +void phytium_pci_vram_hw_init(struct phytium_display_private *priv) +{ + struct phytium_pci_private *pci_priv = to_pci_priv(priv); + + pci_priv->dc_hw_vram_init(priv, priv->pool_phys_addr, priv->pool_size); +} + +static bool phytium_pci_host_is_5c01(struct pci_bus *bus) +{ + struct pci_bus *child = bus; + struct pci_dev *root = NULL; + + while (child) { + if (child->parent->parent) + child = child->parent; + else + break; + } + + root = child->self; + if ((root->vendor == 0x1db7) && (root->device == 0x5c01)) + return true; + return false; +} + +int phytium_pci_vram_init(struct pci_dev *pdev, struct phytium_display_private *priv) +{ + int ret = 0; + + priv->pool_phys_addr = pci_resource_start(pdev, 2); + priv->pool_size = pci_resource_len(pdev, 2); + if ((priv->pool_phys_addr != 0) && (priv->pool_size != 0)) { + if ((pdev->device == 0xdc3e) && phytium_pci_host_is_5c01(pdev->bus)) { + priv->pool_virt_addr = devm_ioremap(&pdev->dev, priv->pool_phys_addr, + priv->pool_size); + priv->support_memory_type = MEMORY_TYPE_VRAM_DEVICE; + } else { + priv->pool_virt_addr = devm_ioremap_wc(&pdev->dev, priv->pool_phys_addr, + priv->pool_size); + priv->support_memory_type = MEMORY_TYPE_VRAM_WC; + } + if (priv->pool_virt_addr == NULL) { + DRM_ERROR("pci vram ioremap fail, addr:0x%llx, size:0x%llx\n", + priv->pool_phys_addr, priv->pool_size); + ret = -EINVAL; + goto failed_ioremap; + } + ret = phytium_memory_pool_init(&pdev->dev, priv); + if (ret) + goto failed_init_memory_pool; + + priv->mem_state[PHYTIUM_MEM_VRAM_TOTAL] = priv->pool_size; + priv->vram_hw_init = phytium_pci_vram_hw_init; + } else { + DRM_DEBUG_KMS("not support vram\n"); + priv->pool_virt_addr = NULL; + priv->mem_state[PHYTIUM_MEM_VRAM_TOTAL] = 0; + priv->support_memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; + priv->vram_hw_init = NULL; + } + + return 0; + +failed_init_memory_pool: + devm_iounmap(&pdev->dev, priv->pool_virt_addr); +failed_ioremap: + return ret; +} + +void phytium_pci_vram_fini(struct pci_dev *pdev, struct phytium_display_private *priv) +{ + if ((priv->support_memory_type == MEMORY_TYPE_VRAM_WC) || + (priv->support_memory_type == MEMORY_TYPE_VRAM_DEVICE)) { + phytium_memory_pool_fini(&pdev->dev, priv); + devm_iounmap(&pdev->dev, priv->pool_virt_addr); + } +} + +static bool phytium_pci_dma_chan_filter(struct dma_chan *chan, void *param) +{ + struct phytium_dma_slave *s = param; + + if (s->dma_dev != chan->device->dev) + return false; + + if (s->chan_id == chan->chan_id) + return true; + else + return false; +} + +int phytium_pci_dma_init(struct phytium_display_private *priv) +{ + struct pci_dev *dma_dev, *gpu_dev; + struct drm_device *drm_dev = priv->dev; + dma_cap_mask_t mask; + struct phytium_dma_slave s; + int ret = 0; + u16 cmd; + + /* check px210 gpu enable */ + gpu_dev = pci_get_device(PCI_VENDOR_ID_PHYTIUM, 0xdc20, NULL); + if (!gpu_dev) { + DRM_INFO("failed to get gpu_dev\n"); + ret = -ENODEV; + goto failed; + } + + pci_read_config_word(gpu_dev, PCI_COMMAND, &cmd); + if (!(cmd & PCI_COMMAND_MASTER)) { + DRM_INFO("gpu_dev master is disabled\n"); + ret = -ENODEV; + goto failed; + } + + dma_dev = pci_get_device(PCI_VENDOR_ID_PHYTIUM, 0xdc3c, NULL); + if (!dma_dev) { + DRM_INFO("failed to get dma_dev\n"); + ret = -ENODEV; + goto failed; + } + + dma_cap_zero(mask); + dma_cap_set(DMA_SLAVE, mask); + + s.dma_dev = &dma_dev->dev; + s.chan_id = 2; + priv->dma_chan = dma_request_channel(mask, phytium_pci_dma_chan_filter, &s); + if (!priv->dma_chan) { + DRM_DEV_ERROR(drm_dev->dev, "failed to request dma chan\n"); + ret = -EBUSY; + goto failed; + } + priv->dma_inited = 1; + +failed: + return ret; +} + +void phytium_pci_dma_fini(struct phytium_display_private *priv) +{ + if (priv->dma_inited) + dma_release_channel(priv->dma_chan); + priv->dma_inited = 0; + priv->dma_chan = NULL; +} + +static struct phytium_display_private* +phytium_pci_private_init(struct pci_dev *pdev, const struct pci_device_id *ent) +{ + struct drm_device *dev = pci_get_drvdata(pdev); + struct phytium_display_private *priv = NULL; + struct phytium_pci_private *pci_priv = NULL; + struct phytium_device_info *phytium_info = (struct phytium_device_info *)ent->driver_data; + int i = 0; + resource_size_t io_addr, io_size; + + pci_priv = devm_kzalloc(&pdev->dev, sizeof(*pci_priv), GFP_KERNEL); + if (!pci_priv) { + DRM_ERROR("no memory to allocate for drm_display_private\n"); + goto failed_malloc_priv; + } + + memset(pci_priv, 0, sizeof(*pci_priv)); + priv = &pci_priv->base; + phytium_display_private_init(priv, dev); + + memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); + DRM_DEBUG_KMS("priv->info.num_pipes :%d\n", priv->info.num_pipes); + priv->info.pipe_mask = ((pdev->subsystem_device >> PIPE_MASK_SHIFT) & PIPE_MASK_MASK); + priv->info.edp_mask = ((pdev->subsystem_device >> EDP_MASK_SHIFT) & EDP_MASK_MASK); + priv->info.num_pipes = 0; + for_each_pipe_masked(priv, i) + priv->info.num_pipes++; + if (priv->info.num_pipes == 0) { + DRM_ERROR("num_pipes is zero, so exit init\n"); + goto failed_init_numpipe; + } + + io_addr = pci_resource_start(pdev, 0); + io_size = pci_resource_len(pdev, 0); + priv->regs = ioremap(io_addr, io_size); + if (priv->regs == NULL) { + DRM_ERROR("pci bar0 ioremap fail, addr:0x%llx, size:0x%llx\n", io_addr, io_size); + goto failed_ioremap; + } + + priv->irq = pdev->irq; + if (IS_PX210(priv)) { + pci_priv->dc_hw_vram_init = px210_dc_hw_vram_init; + priv->dc_hw_clear_msi_irq = px210_dc_hw_clear_msi_irq; + priv->dc_hw_fb_format_check = px210_dc_hw_fb_format_check; + } else if (IS_PE220X(priv)) { + pci_priv->dc_hw_vram_init = pe220x_dc_hw_vram_init; + priv->dc_hw_clear_msi_irq = NULL; + priv->dc_hw_fb_format_check = pe220x_dc_hw_fb_format_check; + } + + return priv; + +failed_ioremap: +failed_init_numpipe: + devm_kfree(&pdev->dev, pci_priv); +failed_malloc_priv: + return NULL; +} + +static void +phytium_pci_private_fini(struct pci_dev *pdev, struct phytium_display_private *priv) +{ + struct phytium_pci_private *pci_priv = to_pci_priv(priv); + + if (priv->regs) + iounmap(priv->regs); + + devm_kfree(&pdev->dev, pci_priv); +} + +static int phytium_remove_conflicting_framebuffers(struct pci_dev *pdev) +{ + resource_size_t base, size; + + base = pci_resource_start(pdev, 2); + size = pci_resource_len(pdev, 2); + + return drm_aperture_remove_conflicting_framebuffers(base, size, + &phytium_display_drm_driver); + +} + +static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent) +{ + struct phytium_display_private *priv = NULL; + struct drm_device *dev = NULL; + int ret = 0; + + ret = phytium_remove_conflicting_framebuffers(pdev); + if (ret) { + DRM_ERROR("failed to remove conflicting phytium framebuffers\n"); + return ret; + } + + dev = drm_dev_alloc(&phytium_display_drm_driver, &pdev->dev); + if (IS_ERR(dev)) { + DRM_ERROR("failed to allocate drm_device\n"); + return PTR_ERR(dev); + } + pci_set_drvdata(pdev, dev); + pci_set_master(pdev); + ret = pci_enable_device(pdev); + if (ret) { + DRM_ERROR("pci enable device fail\n"); + goto failed_enable_device; + } + + if (dc_msi_enable) { + ret = pci_enable_msi(pdev); + if (ret) + DRM_ERROR("pci enable msi fail\n"); + } + + dma_set_mask(&pdev->dev, DMA_BIT_MASK(40)); + + priv = phytium_pci_private_init(pdev, ent); + if (priv) + dev->dev_private = priv; + else + goto failed_pci_private_init; + + ret = phytium_pci_vram_init(pdev, priv); + if (ret) { + DRM_ERROR("failed to init pci vram\n"); + goto failed_pci_vram_init; + } + + ret = drm_dev_register(dev, 0); + if (ret) { + DRM_ERROR("failed to register drm dev\n"); + goto failed_register_drm; + } + + phytium_dp_hpd_irq_setup(dev, true); + + return 0; + +failed_register_drm: + phytium_pci_vram_fini(pdev, priv); +failed_pci_vram_init: + phytium_pci_private_fini(pdev, priv); +failed_pci_private_init: + if (pdev->msi_enabled) + pci_disable_msi(pdev); + pci_disable_device(pdev); +failed_enable_device: + pci_set_drvdata(pdev, NULL); + drm_dev_put(dev); + + return -1; +} + +static void phytium_pci_remove(struct pci_dev *pdev) +{ + struct drm_device *dev = pci_get_drvdata(pdev); + struct phytium_display_private *priv = dev->dev_private; + + phytium_dp_hpd_irq_setup(dev, false); + cancel_work_sync(&priv->hotplug_work); + drm_dev_unregister(dev); + phytium_pci_vram_fini(pdev, priv); + phytium_pci_private_fini(pdev, priv); + if (pdev->msi_enabled) + pci_disable_msi(pdev); + pci_disable_device(pdev); + pci_set_drvdata(pdev, NULL); + drm_dev_put(dev); +} + +static void phytium_pci_shutdown(struct pci_dev *pdev) +{ + struct drm_device *dev = pci_get_drvdata(pdev); + struct phytium_display_private *priv = dev->dev_private; + + priv->display_shutdown(dev); +} + +static int phytium_pci_pm_suspend(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct drm_device *drm_dev = pci_get_drvdata(pdev); + struct phytium_display_private *priv = drm_dev->dev_private; + int ret = 0; + + if (IS_PX210(priv)) + phytium_pci_dma_init(priv); + + ret = priv->display_pm_suspend(drm_dev); + if (ret < 0) + goto out; + + pci_save_state(pdev); + pci_disable_device(pdev); + pci_set_power_state(pdev, PCI_D3hot); + udelay(200); + +out: + return ret; +} + +static int phytium_pci_pm_resume(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct drm_device *drm_dev = pci_get_drvdata(pdev); + struct phytium_display_private *priv = drm_dev->dev_private; + int ret = 0; + + pci_set_power_state(pdev, PCI_D0); + pci_restore_state(pdev); + ret = pci_enable_device(pdev); + if (ret) + return ret; + pci_set_master(pdev); + + ret = priv->display_pm_resume(drm_dev); + if (IS_PX210(priv)) + phytium_pci_dma_fini(priv); + + return ret; +} + +static const struct dev_pm_ops phytium_pci_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_pci_pm_suspend, phytium_pci_pm_resume) +}; + +static const struct phytium_device_info px210_info = { + .platform_mask = BIT(PHYTIUM_PLATFORM_PX210), + .total_pipes = 3, + .crtc_clock_max = PX210_DC_PIX_CLOCK_MAX, + .hdisplay_max = PX210_DC_HDISPLAY_MAX, + .vdisplay_max = PX210_DC_VDISPLAY_MAX, + .address_mask = PX210_DC_ADDRESS_MASK, + .backlight_max = PX210_DP_BACKLIGHT_MAX, + .backlight_min = PX210_DP_BACKLIGHT_MIN, +}; + +static const struct phytium_device_info pe220x_info = { + .platform_mask = BIT(PHYTIUM_PLATFORM_PE220X), + .total_pipes = 2, + .crtc_clock_max = PE220X_DC_PIX_CLOCK_MAX, + .hdisplay_max = PE220X_DC_HDISPLAY_MAX, + .vdisplay_max = PE220X_DC_VDISPLAY_MAX, + .address_mask = PE220X_DC_ADDRESS_MASK, + .backlight_max = PE220X_DP_BACKLIGHT_MAX, + .backlight_min = PE220X_DP_BACKLIGHT_MIN, +}; + +static const struct pci_device_id phytium_display_pci_ids[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc22), (kernel_ulong_t)&px210_info }, + { PCI_VDEVICE(PHYTIUM, 0xdc3e), (kernel_ulong_t)&pe220x_info }, + { /* End: all zeroes */ } +}; +MODULE_DEVICE_TABLE(pci, phytium_display_pci_ids); + +struct pci_driver phytium_pci_driver = { + .name = "phytium_display_pci", + .id_table = phytium_display_pci_ids, + .probe = phytium_pci_probe, + .remove = phytium_pci_remove, + .shutdown = phytium_pci_shutdown, + .driver.pm = &phytium_pci_pm_ops, +}; diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_pci.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_pci.h new file mode 100644 index 0000000000000000000000000000000000000000..7ac37971759c812d67f9e22768745394d6ad020a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_pci.h @@ -0,0 +1,26 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_PCI_H__ +#define __PHYTIUM_PCI_H__ + +#include "phytium_display_drv.h" + +struct phytium_pci_private { + struct phytium_display_private base; + void (*dc_hw_vram_init)(struct phytium_display_private *priv, resource_size_t vram_addr, + resource_size_t vram_size); +}; + +struct phytium_dma_slave { + struct device *dma_dev; + u32 chan_id; +}; + +#define to_pci_priv(priv) container_of(priv, struct phytium_pci_private, base) + +extern struct pci_driver phytium_pci_driver; +#endif /* __PHYTIUM_PCI_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_plane.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_plane.c new file mode 100644 index 0000000000000000000000000000000000000000..bc28ad8d45c032dabf3ba2d811dbd0496db2e094 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_plane.c @@ -0,0 +1,672 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +#include "phytium_display_drv.h" +#include "phytium_plane.h" +#include "phytium_fb.h" +#include "phytium_gem.h" +#include "phytium_crtc.h" +#include "px210_dc.h" +#include "pe220x_dc.h" +#include "phytium_reg.h" + +#define PHYTIUM_CURS_W_SIZE 32 +#define PHYTIUM_CURS_H_SIZE 32 + +void phytium_plane_destroy(struct drm_plane *plane) +{ + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + + drm_plane_cleanup(plane); + kfree(phytium_plane); +} + +/** + * phytium_plane_atomic_get_property - fetch plane property value + * @plane: plane to fetch property for + * @state: state containing the property value + * @property: property to look up + * @val: pointer to write property value into + * + * The DRM core does not store shadow copies of properties for + * atomic-capable drivers. This entrypoint is used to fetch + * the current value of a driver-specific plane property. + */ +static int +phytium_plane_atomic_get_property(struct drm_plane *plane, + const struct drm_plane_state *state, + struct drm_property *property, + uint64_t *val) +{ + DRM_DEBUG_KMS("Unknown plane property [PROP:%d:%s]\n", property->base.id, property->name); + return -EINVAL; +} + +/** + * phytium_plane_atomic_set_property - set plane property value + * @plane: plane to set property for + * @state: state to update property value in + * @property: property to set + * @val: value to set property to + * + * Writes the specified property value for a plane into the provided atomic + * state object. + * + * Returns 0 on success, -EINVAL on unrecognized properties + */ +int +phytium_plane_atomic_set_property(struct drm_plane *plane, + struct drm_plane_state *state, + struct drm_property *property, + uint64_t val) +{ + DRM_DEBUG_KMS("Unknown plane property [PROP:%d:%s]\n", property->base.id, property->name); + return -EINVAL; +} + +struct drm_plane_state * +phytium_plane_atomic_duplicate_state(struct drm_plane *plane) +{ + struct drm_plane_state *state = NULL; + struct phytium_plane_state *phytium_state = NULL; + + phytium_state = kmemdup(plane->state, sizeof(*phytium_state), GFP_KERNEL); + + if (!phytium_state) + return NULL; + + state = &phytium_state->base; + if (state->fb) + drm_framebuffer_get(state->fb); + + state->fence = NULL; + state->commit = NULL; + + return state; +} + +void +phytium_plane_atomic_destroy_state(struct drm_plane *plane, struct drm_plane_state *state) +{ + struct phytium_plane_state *phytium_state = to_phytium_plane_state(state); + + __drm_atomic_helper_plane_destroy_state(state); + kfree(phytium_state); +} + +static bool phytium_plane_format_mod_supported(struct drm_plane *plane, + uint32_t format, uint64_t modifier) +{ + if (modifier == DRM_FORMAT_MOD_LINEAR) + return true; + + if (modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC) { + switch (format) { + case DRM_FORMAT_ARGB2101010: + case DRM_FORMAT_ABGR2101010: + case DRM_FORMAT_RGBA1010102: + case DRM_FORMAT_BGRA1010102: + case DRM_FORMAT_ARGB8888: + case DRM_FORMAT_ABGR8888: + case DRM_FORMAT_RGBA8888: + case DRM_FORMAT_BGRA8888: + case DRM_FORMAT_XRGB8888: + case DRM_FORMAT_XBGR8888: + case DRM_FORMAT_RGBX8888: + case DRM_FORMAT_BGRX8888: + return true; + default: + return false; + } + } + + return false; +} + +const struct drm_plane_funcs phytium_plane_funcs = { + .update_plane = drm_atomic_helper_update_plane, + .disable_plane = drm_atomic_helper_disable_plane, + .destroy = phytium_plane_destroy, + .reset = drm_atomic_helper_plane_reset, + .atomic_get_property = phytium_plane_atomic_get_property, + .atomic_set_property = phytium_plane_atomic_set_property, + .atomic_duplicate_state = phytium_plane_atomic_duplicate_state, + .atomic_destroy_state = phytium_plane_atomic_destroy_state, + .format_mod_supported = phytium_plane_format_mod_supported, +}; + +static int +phytium_plane_atomic_check(struct drm_plane *plane, struct drm_atomic_state *atomic_state) +{ + struct drm_plane_state *state = drm_atomic_get_new_plane_state(atomic_state, + plane); + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct drm_framebuffer *fb = state->fb; + struct drm_crtc *crtc = state->crtc; + struct drm_crtc_state *crtc_state; + int src_x, src_y, src_w, src_h; + unsigned long base_offset; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + + if ((!fb) || (!crtc)) + return 0; + + crtc_state = drm_atomic_get_crtc_state(state->state, crtc); + if (IS_ERR(crtc_state)) + return PTR_ERR(crtc_state); + + if (plane->type == DRM_PLANE_TYPE_CURSOR) { + src_w = state->src_w >> 16; + src_h = state->src_h >> 16; + if (phytium_crtc->scale_enable) + return -EINVAL; + if ((src_w != PHYTIUM_CURS_W_SIZE) || (src_h != PHYTIUM_CURS_W_SIZE)) { + DRM_INFO("Invalid cursor size(%d, %d)\n", src_w, src_h); + return -EINVAL; + } + } else if (plane->type == DRM_PLANE_TYPE_PRIMARY) { + src_x = state->src_x >> 16; + src_y = state->src_y >> 16; + src_w = state->src_w >> 16; + src_h = state->src_h >> 16; + + base_offset = src_x * fb->format->cpp[0] + src_y*fb->pitches[0]; + if (base_offset & (priv->info.address_mask)) { + DRM_ERROR("fb base address is not aligned by 0x%lx byte\n", + priv->info.address_mask); + return -EINVAL; + } + + if (src_w != state->crtc_w || src_h != state->crtc_h) { + DRM_ERROR("scale not support: crtc_w(0x%x)/h(0x%x) src_w(0x%x)/h(0x%x)\n", + state->crtc_w, state->crtc_h, src_w, src_h); + return -EINVAL; + } + + if ((state->crtc_x < 0) || (state->crtc_y < 0)) { + DRM_ERROR("crtc_x(0x%x)/y(0x%x) of drm plane state is invalid\n", + state->crtc_x, state->crtc_y); + return -EINVAL; + } + + if ((state->crtc_x + state->crtc_w > crtc_state->adjusted_mode.hdisplay) + || (state->crtc_y + state->crtc_h > crtc_state->adjusted_mode.vdisplay)) { + DRM_ERROR("plane out of crtc region\n"); + return -EINVAL; + } + } + + return 0; +} + +static void phytium_dc_get_plane_parameter(struct drm_plane *plane) +{ + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + struct drm_framebuffer *fb = plane->state->fb; + struct phytium_framebuffer *phytium_fb = to_phytium_framebuffer(fb); + struct phytium_gem_object *phytium_gem_obj = NULL; + int i, num_planes = 0; + const struct drm_format_info *info; + + info = drm_format_info(fb->format->format); + num_planes = info ? info->num_planes : 1; + + for (i = 0; i < num_planes; i++) { + phytium_gem_obj = phytium_fb->phytium_gem_obj[i]; + phytium_plane->iova[i] = phytium_gem_obj->iova + fb->offsets[i]; + phytium_plane->size[i] = phytium_gem_obj->size - fb->offsets[i]; + + if (fb->modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC) + phytium_plane->tiling[i] = FRAMEBUFFER_TILE_MODE0; + else if (fb->modifier == DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC) + phytium_plane->tiling[i] = FRAMEBUFFER_TILE_MODE3; + else if (fb->modifier == DRM_FORMAT_MOD_LINEAR) + phytium_plane->tiling[i] = FRAMEBUFFER_LINEAR; + else + phytium_plane->tiling[i] = FRAMEBUFFER_LINEAR; + + if (i == 0) { + switch (fb->format->format) { + case DRM_FORMAT_ARGB2101010: + case DRM_FORMAT_ABGR2101010: + case DRM_FORMAT_RGBA1010102: + case DRM_FORMAT_BGRA1010102: + phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB2101010; + break; + + case DRM_FORMAT_ARGB8888: + case DRM_FORMAT_ABGR8888: + case DRM_FORMAT_RGBA8888: + case DRM_FORMAT_BGRA8888: + phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB8888; + break; + + case DRM_FORMAT_XRGB8888: + case DRM_FORMAT_XBGR8888: + case DRM_FORMAT_RGBX8888: + case DRM_FORMAT_BGRX8888: + phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB8888; + break; + + case DRM_FORMAT_ARGB4444: + case DRM_FORMAT_ABGR4444: + case DRM_FORMAT_RGBA4444: + case DRM_FORMAT_BGRA4444: + phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB4444; + break; + + case DRM_FORMAT_XRGB4444: + case DRM_FORMAT_XBGR4444: + case DRM_FORMAT_RGBX4444: + case DRM_FORMAT_BGRX4444: + phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB4444; + break; + + case DRM_FORMAT_ARGB1555: + case DRM_FORMAT_ABGR1555: + case DRM_FORMAT_RGBA5551: + case DRM_FORMAT_BGRA5551: + phytium_plane->format = FRAMEBUFFER_FORMAT_ARGB1555; + break; + + case DRM_FORMAT_XRGB1555: + case DRM_FORMAT_XBGR1555: + case DRM_FORMAT_RGBX5551: + case DRM_FORMAT_BGRX5551: + phytium_plane->format = FRAMEBUFFER_FORMAT_XRGB1555; + break; + + case DRM_FORMAT_RGB565: + case DRM_FORMAT_BGR565: + phytium_plane->format = FRAMEBUFFER_FORMAT_RGB565; + break; + + case DRM_FORMAT_YUYV: + phytium_plane->format = FRAMEBUFFER_FORMAT_YUYV; + break; + + case DRM_FORMAT_UYVY: + phytium_plane->format = FRAMEBUFFER_FORMAT_UYVY; + break; + case DRM_FORMAT_NV16: + phytium_plane->format = FRAMEBUFFER_FORMAT_NV16; + break; + case DRM_FORMAT_NV12: + phytium_plane->format = FRAMEBUFFER_FORMAT_NV12; + break; + case DRM_FORMAT_NV21: + phytium_plane->format = FRAMEBUFFER_FORMAT_NV12; + break; + default: + DRM_ERROR("unsupported pixel format (format = %d)\n", + fb->format->format); + return; + } + + switch (fb->format->format) { + case DRM_FORMAT_ARGB2101010: + case DRM_FORMAT_ARGB8888: + case DRM_FORMAT_XRGB8888: + case DRM_FORMAT_ARGB4444: + case DRM_FORMAT_XRGB4444: + case DRM_FORMAT_ARGB1555: + case DRM_FORMAT_XRGB1555: + case DRM_FORMAT_RGB565: + phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ARGB; + phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; + break; + + case DRM_FORMAT_ABGR2101010: + case DRM_FORMAT_ABGR8888: + case DRM_FORMAT_XBGR8888: + case DRM_FORMAT_ABGR4444: + case DRM_FORMAT_XBGR4444: + case DRM_FORMAT_ABGR1555: + case DRM_FORMAT_XBGR1555: + case DRM_FORMAT_BGR565: + phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ABGR; + phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; + break; + + case DRM_FORMAT_RGBA1010102: + case DRM_FORMAT_RGBA8888: + case DRM_FORMAT_RGBX8888: + case DRM_FORMAT_RGBA4444: + case DRM_FORMAT_RGBX4444: + case DRM_FORMAT_RGBA5551: + case DRM_FORMAT_RGBX5551: + phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_RGBA; + phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; + break; + + case DRM_FORMAT_BGRA1010102: + case DRM_FORMAT_BGRA8888: + case DRM_FORMAT_BGRX8888: + case DRM_FORMAT_BGRA4444: + case DRM_FORMAT_BGRX4444: + case DRM_FORMAT_BGRA5551: + case DRM_FORMAT_BGRX5551: + phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_BGRA; + phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; + break; + + case DRM_FORMAT_YUYV: + case DRM_FORMAT_UYVY: + case DRM_FORMAT_NV16: + case DRM_FORMAT_NV12: + phytium_plane->swizzle = FRAMEBUFFER_SWIZZLE_ARGB; + phytium_plane->uv_swizzle = FRAMEBUFFER_UVSWIZZLE_DISABLE; + break; + + default: + DRM_ERROR("unsupported pixel format (format = %d)\n", + fb->format->format); + return; + } + } + } +} + +static void phytium_dc_primary_plane_update(struct drm_plane *plane) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + struct drm_framebuffer *fb = plane->state->fb; + int phys_pipe = phytium_plane->phys_pipe; + int src_x, src_y, crtc_x, crtc_y, crtc_w, crtc_h; + unsigned long base_offset; + int config; + + src_x = plane->state->src_x >> 16; + src_y = plane->state->src_y >> 16; + crtc_x = plane->state->crtc_x; + crtc_y = plane->state->crtc_y; + crtc_w = plane->state->crtc_w; + crtc_h = plane->state->crtc_h; + + if (phytium_plane->dc_hw_update_dcreq) + phytium_plane->dc_hw_update_dcreq(plane); + phytium_plane->dc_hw_update_primary_hi_addr(plane); + + /* config dc */ + /* Y */ + base_offset = src_x * fb->format->cpp[0] + src_y*fb->pitches[0]; + phytium_writel_reg(priv, (phytium_plane->iova[0] + base_offset) & ADDRESS_MASK, + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_Y_ADDRESS); + phytium_writel_reg(priv, ALIGN(fb->pitches[0], 128), + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_Y_STRIDE); + + /* U */ + phytium_writel_reg(priv, phytium_plane->iova[1] & 0xffffffff, + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_U_ADDRESS); + phytium_writel_reg(priv, ALIGN(fb->pitches[1], 128), + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_U_STRIDE); + + /* V */ + phytium_writel_reg(priv, phytium_plane->iova[2] & 0xffffffff, + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_V_ADDRESS); + phytium_writel_reg(priv, ALIGN(fb->pitches[2], 128), + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_V_STRIDE); + + /* size */ + phytium_writel_reg(priv, (crtc_w & WIDTH_MASK) | ((crtc_h&HEIGHT_MASK) << HEIGHT_SHIFT), + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_FRAMEBUFFER_SIZE); + /* config */ + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); + config &= ~(FRAMEBUFFER_FORMAT_MASK << FRAMEBUFFER_FORMAT_SHIFT); + config |= (phytium_plane->format << FRAMEBUFFER_FORMAT_SHIFT); + config &= ~(1 << FRAMEBUFFER_UVSWIZZLE_SHIFT); + config |= (phytium_plane->uv_swizzle << FRAMEBUFFER_UVSWIZZLE_SHIFT); + config &= ~(FRAMEBUFFER_SWIZZLE_MASK << FRAMEBUFFER_SWIZZLE_SHIFT); + config |= (phytium_plane->swizzle << FRAMEBUFFER_SWIZZLE_SHIFT); + config &= ~(FRAMEBUFFER_TILE_MODE_MASK << FRAMEBUFFER_TILE_MODE_SHIFT); + config |= (phytium_plane->tiling[0] << FRAMEBUFFER_TILE_MODE_SHIFT); + config &= (~FRAMEBUFFER_CLEAR); + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); +} + +static void phytium_dc_cursor_plane_update(struct drm_plane *plane) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + struct drm_framebuffer *fb = plane->state->fb; + int phys_pipe = phytium_plane->phys_pipe; + int config; + unsigned long iova; + + phytium_plane->enable = 1; + phytium_plane->cursor_hot_x = fb->hot_x; + phytium_plane->cursor_hot_y = fb->hot_y; + phytium_plane->cursor_x = plane->state->crtc_x + fb->hot_x; + phytium_plane->cursor_y = plane->state->crtc_y + fb->hot_y; + + if (phytium_plane->cursor_x < 0) { + phytium_plane->cursor_hot_x = plane->state->crtc_w - 1; + phytium_plane->cursor_x = plane->state->crtc_x + phytium_plane->cursor_hot_x; + } + + if (phytium_plane->cursor_y < 0) { + phytium_plane->cursor_hot_y = plane->state->crtc_h - 1; + phytium_plane->cursor_y = plane->state->crtc_y + phytium_plane->cursor_hot_y; + } + + config = CURSOR_FORMAT_ARGB8888 | + ((phytium_plane->cursor_hot_y & CURSOR_HOT_Y_MASK) << CURSOR_HOT_Y_SHIFT) | + ((phytium_plane->cursor_hot_x & CURSOR_HOT_X_MASK) << CURSOR_HOT_X_SHIFT); + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); + + config = ((phytium_plane->cursor_x & CURSOR_X_MASK) << CURSOR_X_SHIFT) | + ((phytium_plane->cursor_y & CURSOR_Y_MASK) << CURSOR_Y_SHIFT); + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_CURSOR_LOCATION); + iova = phytium_plane->iova[0]; + phytium_writel_reg(priv, iova & 0xffffffff, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_CURSOR_ADDRESS); + if (phytium_plane->dc_hw_update_cursor_hi_addr) + phytium_plane->dc_hw_update_cursor_hi_addr(plane, iova); +} + +static void phytium_plane_atomic_update(struct drm_plane *plane, + struct drm_atomic_state *state) +{ + struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state, plane); + struct drm_framebuffer *fb, *old_fb; + + DRM_DEBUG_KMS("update plane: type=%d\n", plane->type); + if (!plane->state->crtc || !plane->state->fb) + return; + + fb = plane->state->fb; + old_fb = old_state->fb; + + if (fb) + drm_framebuffer_get(fb); + if (old_fb) + drm_framebuffer_put(old_fb); + + phytium_dc_get_plane_parameter(plane); + + if (plane->type == DRM_PLANE_TYPE_PRIMARY) + phytium_dc_primary_plane_update(plane); + else if (plane->type == DRM_PLANE_TYPE_CURSOR) + phytium_dc_cursor_plane_update(plane); +} + +static void phytium_plane_atomic_disable(struct drm_plane *plane, + struct drm_atomic_state *state) +{ + struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state, plane); + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + int phys_pipe = phytium_plane->phys_pipe; + int config; + struct drm_framebuffer *old_fb; + + old_fb = old_state->fb; + if (old_fb) + drm_framebuffer_put(old_fb); + + if (plane->type == DRM_PLANE_TYPE_PRIMARY) { + phytium_writel_reg(priv, CLEAR_VALUE_RED, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE); + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); + config |= FRAMEBUFFER_CLEAR; + phytium_writel_reg(priv, config, priv->dc_reg_base[phys_pipe], + PHYTIUM_DC_FRAMEBUFFER_CONFIG); + } else if (plane->type == DRM_PLANE_TYPE_CURSOR) { + phytium_writel_reg(priv, CURSOR_FORMAT_DISABLED, + priv->dc_reg_base[phys_pipe], PHYTIUM_DC_CURSOR_CONFIG); + } +} + +const struct drm_plane_helper_funcs phytium_plane_helper_funcs = { + .prepare_fb = drm_gem_plane_helper_prepare_fb, + .atomic_check = phytium_plane_atomic_check, + .atomic_update = phytium_plane_atomic_update, + .atomic_disable = phytium_plane_atomic_disable, +}; + +struct phytium_plane *phytium_primary_plane_create(struct drm_device *dev, int phys_pipe) +{ + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = NULL; + struct phytium_plane_state *phytium_plane_state = NULL; + int ret = 0; + unsigned int flags = 0; + const uint32_t *formats = NULL; + uint32_t format_count; + const uint64_t *format_modifiers; + + phytium_plane = kzalloc(sizeof(*phytium_plane), GFP_KERNEL); + if (!phytium_plane) { + ret = -ENOMEM; + goto failed_malloc_plane; + } + + phytium_plane_state = kzalloc(sizeof(*phytium_plane_state), GFP_KERNEL); + if (!phytium_plane_state) { + ret = -ENOMEM; + goto failed_malloc_plane_state; + } + phytium_plane_state->base.plane = &phytium_plane->base; + phytium_plane_state->base.rotation = DRM_MODE_ROTATE_0; + phytium_plane->base.state = &phytium_plane_state->base; + phytium_plane->phys_pipe = phys_pipe; + + if (IS_PX210(priv)) { + phytium_plane->dc_hw_plane_get_format = px210_dc_hw_plane_get_primary_format; + phytium_plane->dc_hw_update_dcreq = px210_dc_hw_update_dcreq; + phytium_plane->dc_hw_update_primary_hi_addr = px210_dc_hw_update_primary_hi_addr; + phytium_plane->dc_hw_update_cursor_hi_addr = NULL; + } else if (IS_PE220X(priv)) { + phytium_plane->dc_hw_plane_get_format = pe220x_dc_hw_plane_get_primary_format; + phytium_plane->dc_hw_update_dcreq = NULL; + phytium_plane->dc_hw_update_primary_hi_addr = pe220x_dc_hw_update_primary_hi_addr; + phytium_plane->dc_hw_update_cursor_hi_addr = NULL; + } + + phytium_plane->dc_hw_plane_get_format(&format_modifiers, &formats, &format_count); + ret = drm_universal_plane_init(dev, &phytium_plane->base, 0x0, + &phytium_plane_funcs, formats, + format_count, + format_modifiers, + DRM_PLANE_TYPE_PRIMARY, "primary %d", phys_pipe); + + if (ret) + goto failed_plane_init; + + flags = DRM_MODE_ROTATE_0; + drm_plane_create_rotation_property(&phytium_plane->base, DRM_MODE_ROTATE_0, flags); + drm_plane_helper_add(&phytium_plane->base, &phytium_plane_helper_funcs); + + return phytium_plane; +failed_plane_init: + kfree(phytium_plane_state); +failed_malloc_plane_state: + kfree(phytium_plane); +failed_malloc_plane: + return ERR_PTR(ret); +} + +struct phytium_plane *phytium_cursor_plane_create(struct drm_device *dev, int phys_pipe) +{ + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = NULL; + struct phytium_plane_state *phytium_plane_state = NULL; + int ret = 0; + unsigned int flags = 0; + const uint32_t *formats = NULL; + uint32_t format_count; + const uint64_t *format_modifiers; + + phytium_plane = kzalloc(sizeof(*phytium_plane), GFP_KERNEL); + if (!phytium_plane) { + ret = -ENOMEM; + goto failed_malloc_plane; + } + + phytium_plane_state = kzalloc(sizeof(*phytium_plane_state), GFP_KERNEL); + if (!phytium_plane_state) { + ret = -ENOMEM; + goto failed_malloc_plane_state; + } + phytium_plane_state->base.plane = &phytium_plane->base; + phytium_plane_state->base.rotation = DRM_MODE_ROTATE_0; + phytium_plane->base.state = &phytium_plane_state->base; + phytium_plane->phys_pipe = phys_pipe; + + if (IS_PX210(priv)) { + phytium_plane->dc_hw_plane_get_format = px210_dc_hw_plane_get_cursor_format; + phytium_plane->dc_hw_update_dcreq = NULL; + phytium_plane->dc_hw_update_primary_hi_addr = NULL; + phytium_plane->dc_hw_update_cursor_hi_addr = NULL; + } else if (IS_PE220X(priv)) { + phytium_plane->dc_hw_plane_get_format = pe220x_dc_hw_plane_get_cursor_format; + phytium_plane->dc_hw_update_dcreq = NULL; + phytium_plane->dc_hw_update_primary_hi_addr = NULL; + phytium_plane->dc_hw_update_cursor_hi_addr = pe220x_dc_hw_update_cursor_hi_addr; + } + + phytium_plane->dc_hw_plane_get_format(&format_modifiers, &formats, &format_count); + ret = drm_universal_plane_init(dev, &phytium_plane->base, 0x0, + &phytium_plane_funcs, + formats, format_count, + format_modifiers, + DRM_PLANE_TYPE_CURSOR, "cursor %d", phys_pipe); + + if (ret) + goto failed_plane_init; + + flags = DRM_MODE_ROTATE_0; + drm_plane_create_rotation_property(&phytium_plane->base, DRM_MODE_ROTATE_0, flags); + drm_plane_helper_add(&phytium_plane->base, &phytium_plane_helper_funcs); + + return phytium_plane; +failed_plane_init: + kfree(phytium_plane_state); +failed_malloc_plane_state: + kfree(phytium_plane); +failed_malloc_plane: + return ERR_PTR(ret); +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_plane.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_plane.h new file mode 100644 index 0000000000000000000000000000000000000000..25b6bba6c87d3b815e6c30b6f4e553dde33b851e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_plane.h @@ -0,0 +1,46 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_PLANE_H__ +#define __PHYTIUM_PLANE_H__ + +struct phytium_plane { + struct drm_plane base; + int phys_pipe; + unsigned long iova[PHYTIUM_FORMAT_MAX_PLANE]; + unsigned long size[PHYTIUM_FORMAT_MAX_PLANE]; + unsigned int format; + unsigned int tiling[PHYTIUM_FORMAT_MAX_PLANE]; + unsigned int swizzle; + unsigned int uv_swizzle; + unsigned int rot_angle; + + /* only for cursor */ + bool enable; + bool reserve[3]; + int cursor_x; + int cursor_y; + int cursor_hot_x; + int cursor_hot_y; + + void (*dc_hw_plane_get_format)(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); + void (*dc_hw_update_dcreq)(struct drm_plane *plane); + void (*dc_hw_update_primary_hi_addr)(struct drm_plane *plane); + void (*dc_hw_update_cursor_hi_addr)(struct drm_plane *plane, uint64_t iova); +}; + +struct phytium_plane_state { + struct drm_plane_state base; +}; + +#define to_phytium_plane(x) container_of(x, struct phytium_plane, base) +#define to_phytium_plane_state(x) container_of(x, struct phytium_plane_state, base) + +struct phytium_plane *phytium_primary_plane_create(struct drm_device *dev, int pipe); +struct phytium_plane *phytium_cursor_plane_create(struct drm_device *dev, int pipe); +#endif /* __PHYTIUM_PLANE_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_platform.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_platform.c new file mode 100644 index 0000000000000000000000000000000000000000..32c4a3efeb02aebaa3f6b48571955a6a43d25cbf --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_platform.c @@ -0,0 +1,371 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium display engine DRM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "phytium_platform.h" +#include "phytium_dp.h" +#include "phytium_gem.h" +#include "pe220x_dc.h" +#include "pe220x_dp.h" + +int phytium_platform_carveout_mem_init(struct platform_device *pdev, + struct phytium_display_private *priv) +{ + struct device_node *np; + struct resource res; + struct resource *pres; + int ret = 0; + + if (pdev->dev.of_node) { + np = of_parse_phandle(pdev->dev.of_node, "memory-region", 0); + if(!np) + goto next; + ret = of_address_to_resource(np, 0, &res); + if(ret) + DRM_ERROR("No memory address assigned to the region\n"); + else { + priv->pool_size = resource_size(&res); + priv->pool_phys_addr = res.start; + } + } + +next: + pres = platform_get_resource(pdev, IORESOURCE_MEM, 1); + if (pres) { + priv->pool_size = resource_size(pres); + priv->pool_phys_addr = pres->start; + } + + if ((priv->pool_phys_addr != 0) && (priv->pool_size != 0)) { + priv->pool_virt_addr = ioremap_cache(priv->pool_phys_addr, priv->pool_size); + if (priv->pool_virt_addr == NULL) { + DRM_ERROR("failed to remap carveout mem(0x%llx)\n", priv->pool_phys_addr); + ret = -EINVAL; + goto failed_ioremap; + } + ret = phytium_memory_pool_init(&pdev->dev, priv); + if (ret) + goto failed_init_memory_pool; + + priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL] = priv->pool_size; + priv->support_memory_type = MEMORY_TYPE_SYSTEM_CARVEOUT; + priv->vram_hw_init = NULL; + } else { + DRM_DEBUG_KMS("not support carveout memory\n"); + priv->mem_state[PHYTIUM_MEM_SYSTEM_CARVEOUT_TOTAL] = 0; + priv->support_memory_type = MEMORY_TYPE_SYSTEM_UNIFIED; + priv->vram_hw_init = NULL; + } + + return 0; + +failed_init_memory_pool: + iounmap(priv->pool_virt_addr); +failed_ioremap: + return ret; +} + +void phytium_platform_carveout_mem_fini(struct platform_device *pdev, + struct phytium_display_private *priv) +{ + if (priv->support_memory_type == MEMORY_TYPE_SYSTEM_CARVEOUT) { + phytium_memory_pool_fini(&pdev->dev, priv); + iounmap(priv->pool_virt_addr); + } +} + +static struct phytium_display_private * +phytium_platform_private_init(struct platform_device *pdev) +{ + struct drm_device *dev = dev_get_drvdata(&pdev->dev); + struct device_node *node; + struct fwnode_handle *np; + struct phytium_display_private *priv = NULL; + struct phytium_platform_private *platform_priv = NULL; + struct phytium_device_info *phytium_info = NULL; + int i = 0, ret = 0; + struct resource *res; + + platform_priv = devm_kzalloc(&pdev->dev, sizeof(*platform_priv), GFP_KERNEL); + if (!platform_priv) { + DRM_ERROR("no memory to allocate for phytium_platform_private\n"); + goto exit; + } + + memset(platform_priv, 0, sizeof(*platform_priv)); + priv = &platform_priv->base; + phytium_display_private_init(priv, dev); + + if (pdev->dev.of_node) { + phytium_info = (struct phytium_device_info *)of_device_get_match_data(&pdev->dev); + if (!phytium_info) { + DRM_ERROR("failed to get dts id data(phytium_info)\n"); + goto failed; + } + + memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); + node = pdev->dev.of_node; + ret = of_property_read_u8(node, "pipe_mask", &priv->info.pipe_mask); + if (ret < 0) { + dev_err(&pdev->dev, "missing pipe_mask property from dts\n"); + goto failed; + } + + ret = of_property_read_u8(node, "edp_mask", &priv->info.edp_mask); + if (ret < 0) { + dev_err(&pdev->dev, "missing edp_mask property from dts\n"); + goto failed; + } + if (priv->info.edp_mask) { + priv->info.pwm = devm_pwm_get(&pdev->dev, NULL); + if (IS_ERR(priv->info.pwm)) { + dev_err(&pdev->dev, "Failed to request PWM device: %ld\n", + PTR_ERR(priv->info.pwm)); + goto failed; + } + priv->edp_bl_en = gpiod_get(&pdev->dev, "edp-bl-en", GPIOD_OUT_HIGH); + if (!priv->edp_bl_en) { + dev_err(&pdev->dev, "Failed to get edp_en gpio\n"); + goto failed; + } + priv->edp_power_en = gpiod_get(&pdev->dev, "edp-power-en", GPIOD_OUT_HIGH); + if (!priv->edp_power_en) { + dev_err(&pdev->dev, "Failed to get edp_pwr_en gpio\n"); + goto failed; + } + // set GPIO pin output + gpiod_direction_output(priv->edp_power_en, 0); + gpiod_direction_output(priv->edp_bl_en, 0); + } + } else if (has_acpi_companion(&pdev->dev)) { + phytium_info = (struct phytium_device_info *)acpi_device_get_match_data(&pdev->dev); + if (!phytium_info) { + DRM_ERROR("failed to get acpi id data(phytium_info)\n"); + goto failed; + } + + memcpy(&(priv->info), phytium_info, sizeof(struct phytium_device_info)); + np = dev_fwnode(&(pdev->dev)); + ret = fwnode_property_read_u8(np, "pipe_mask", &priv->info.pipe_mask); + if (ret < 0) { + dev_err(&pdev->dev, "missing pipe_mask property from acpi\n"); + goto failed; + } + ret = fwnode_property_read_u8(np, "edp_mask", &priv->info.edp_mask); + if (ret < 0) { + dev_err(&pdev->dev, "missing edp_mask property from acpi\n"); + goto failed; + } + if (priv->info.edp_mask) { + priv->info.pwm = devm_pwm_get(&pdev->dev, NULL); + if (IS_ERR(priv->info.pwm)) { + dev_err(&pdev->dev, "Failed to request PWM device: %ld\n", + PTR_ERR(priv->info.pwm)); + goto failed; + } + priv->edp_bl_en = gpiod_get(&pdev->dev, "edp-bl-en", GPIOD_OUT_HIGH); + if (!priv->edp_bl_en) { + dev_err(&pdev->dev, "Failed to get edp_en gpio\n"); + goto failed; + } + priv->edp_power_en = gpiod_get(&pdev->dev, "edp-power-en", GPIOD_OUT_HIGH); + if (!priv->edp_power_en) { + dev_err(&pdev->dev, "Failed to get edp_pwr_en gpio\n"); + goto failed; + } + // set GPIO pin output + gpiod_direction_output(priv->edp_power_en, 0); + gpiod_direction_output(priv->edp_bl_en, 0); + } + } + + priv->info.num_pipes = 0; + for_each_pipe_masked(priv, i) + priv->info.num_pipes++; + if (priv->info.num_pipes == 0) { + DRM_ERROR("num_pipes is zero, so exit init\n"); + goto failed; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + priv->regs = devm_ioremap_resource(&pdev->dev, res); + if (priv->regs == NULL) { + DRM_ERROR("ioremap fail, addr:0x%llx, size:0x%llx\n", res->start, res->end); + goto failed; + } + + priv->irq = platform_get_irq(pdev, 0); + if (priv->irq < 0) { + dev_err(&pdev->dev, "failed to get irq\n"); + goto failed; + } + + if (IS_PE220X(priv)) { + priv->dc_hw_clear_msi_irq = NULL; + priv->dc_hw_fb_format_check = pe220x_dc_hw_fb_format_check; + } + + return priv; + +failed: + devm_kfree(&pdev->dev, platform_priv); +exit: + return NULL; +} + +static void phytium_platform_private_fini(struct platform_device *pdev) +{ + struct drm_device *dev = dev_get_drvdata(&pdev->dev); + struct phytium_display_private *priv = dev->dev_private; + struct phytium_platform_private *platform_priv = to_platform_priv(priv); + + devm_kfree(&pdev->dev, platform_priv); +} + +static int phytium_platform_probe(struct platform_device *pdev) +{ + struct phytium_display_private *priv = NULL; + struct drm_device *dev = NULL; + int ret = 0; + + dev = drm_dev_alloc(&phytium_display_drm_driver, &pdev->dev); + if (IS_ERR(dev)) { + DRM_ERROR("failed to allocate drm_device\n"); + return PTR_ERR(dev); + } + + dev_set_drvdata(&pdev->dev, dev); + dma_set_mask(&pdev->dev, DMA_BIT_MASK(40)); + + priv = phytium_platform_private_init(pdev); + if (priv) + dev->dev_private = priv; + else + goto failed_platform_private_init; + + ret = phytium_platform_carveout_mem_init(pdev, priv); + if (ret) { + DRM_ERROR("failed to init system carveout memory\n"); + goto failed_carveout_mem_init; + } + + ret = drm_dev_register(dev, 0); + if (ret) { + DRM_ERROR("failed to register drm dev\n"); + goto failed_register_drm; + } + + phytium_dp_hpd_irq_setup(dev, true); + + return 0; + +failed_register_drm: + phytium_platform_carveout_mem_fini(pdev, priv); +failed_carveout_mem_init: + phytium_platform_private_fini(pdev); +failed_platform_private_init: + dev_set_drvdata(&pdev->dev, NULL); + drm_dev_put(dev); + return -1; +} + +static int phytium_platform_remove(struct platform_device *pdev) +{ + struct drm_device *dev = dev_get_drvdata(&pdev->dev); + struct phytium_display_private *priv = dev->dev_private; + + phytium_dp_hpd_irq_setup(dev, false); + cancel_work_sync(&priv->hotplug_work); + drm_dev_unregister(dev); + phytium_platform_private_fini(pdev); + dev_set_drvdata(&pdev->dev, NULL); + drm_dev_put(dev); + + return 0; +} + +static void phytium_platform_shutdown(struct platform_device *pdev) +{ + struct drm_device *dev = dev_get_drvdata(&pdev->dev); + struct phytium_display_private *priv = dev->dev_private; + + priv->display_shutdown(dev); +} + +static int phytium_platform_pm_suspend(struct device *dev) +{ + struct drm_device *drm_dev = dev_get_drvdata(dev); + struct phytium_display_private *priv = drm_dev->dev_private; + + return priv->display_pm_suspend(drm_dev); +} + +static int phytium_platform_pm_resume(struct device *dev) +{ + struct drm_device *drm_dev = dev_get_drvdata(dev); + struct phytium_display_private *priv = drm_dev->dev_private; + + return priv->display_pm_resume(drm_dev); +} + +static const struct dev_pm_ops phytium_platform_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_platform_pm_suspend, phytium_platform_pm_resume) +}; + +static const struct phytium_device_info pe220x_info = { + .platform_mask = BIT(PHYTIUM_PLATFORM_PE220X), + .total_pipes = 2, + .crtc_clock_max = PE220X_DC_PIX_CLOCK_MAX, + .hdisplay_max = PE220X_DC_HDISPLAY_MAX, + .vdisplay_max = PE220X_DC_VDISPLAY_MAX, + .address_mask = PE220X_DC_ADDRESS_MASK, + .backlight_max = PE220X_DP_BACKLIGHT_MAX, + .backlight_min = PE220X_DP_BACKLIGHT_MIN, +}; + +static const struct of_device_id display_of_match[] = { + { + .compatible = "phytium,dc", + .data = &pe220x_info, + }, + { } +}; +MODULE_DEVICE_TABLE(of, display_of_match); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id display_acpi_ids[] = { + { + .id = "PHYT0015", + .driver_data = (kernel_ulong_t)&pe220x_info, + }, + {}, +}; + +MODULE_DEVICE_TABLE(acpi, display_acpi_ids); +#else +#define display_acpi_ids NULL +#endif + +struct platform_driver phytium_platform_driver = { + .driver = { + .name = "phytium_display_platform", + .of_match_table = of_match_ptr(display_of_match), + .acpi_match_table = ACPI_PTR(display_acpi_ids), + }, + .probe = phytium_platform_probe, + .remove = phytium_platform_remove, + .shutdown = phytium_platform_shutdown, + .driver.pm = &phytium_platform_pm_ops, +}; diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_platform.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_platform.h new file mode 100644 index 0000000000000000000000000000000000000000..b754ef0a137a3a21a45c62c9aa313b0c6aee18d1 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_platform.h @@ -0,0 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_PLATFORM_H__ +#define __PHYTIUM_PLATFORM_H__ + +struct phytium_platform_private { + struct phytium_display_private base; +}; + +#define to_platform_priv(priv) container_of(priv, struct phytium_platform_private, base) + +extern struct platform_driver phytium_platform_driver; + +#endif /* __PHYTIUM_PLATFORM_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_reg.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_reg.h new file mode 100644 index 0000000000000000000000000000000000000000..f5d4a6945c35b6313156955c56ef4367f86da5dc --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/phytium_reg.h @@ -0,0 +1,366 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_REG_H__ +#define __PHYTIUM_REG_H__ + +/******************************register base******************************************/ +#define PX210_PIPE_BASE(pipe) (0x8000*pipe) +#define PX210_DC_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x0000) +#define PX210_DCREQ_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x2000) +#define PX210_DP_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x3000) +#define PX210_ADDRESS_TRANSFORM_BASE 0x4000 +#define PX210_PHY_ACCESS_BASE(pipe) (PX210_PIPE_BASE(pipe) + 0x5000) + +#define PE220X_DC_BASE(pipe) (0x1000*pipe) +#define PE220X_DP_BASE(pipe) (0x4000 + 0x1000*pipe) +#define PE220X_ADDRESS_TRANSFORM_BASE 0x8000 +#define PE220X_PHY_ACCESS_BASE(pipe) (0x6000 + 0x1000*pipe) +/******************************register base end******************************************/ + +/******************************dc register start******************************************/ +#define PHYTIUM_DC_FRAMEBUFFER_Y_ADDRESS 0x1400 + #define ADDRESS_MASK 0xffffff80 +#define PHYTIUM_DC_FRAMEBUFFER_Y_STRIDE 0x1408 +#define PHYTIUM_DC_PANEL_CONFIG 0x1418 + #define PANEL_DATAENABLE_ENABLE (1<<0) + #define PANEL_DATA_ENABLE (1<<4) + #define PANEL_CLOCK_ENABLE (1<<8) +#define PHYTIUM_DC_HDISPLAY 0x1430 + #define HDISPLAY_END_SHIFT 0 + #define HDISPLAY_END_MASK 0x7fff + #define HDISPLAY_TOTAL_SHIFT 16 + #define HDISPLAY_TOTAL_MASK 0x7fff +#define PHYTIUM_DC_HSYNC 0x1438 + #define HSYNC_START_SHIFT 0 + #define HSYNC_START_MASK 0x7fff + #define HSYNC_END_SHIFT 15 + #define HSYNC_END_MASK 0x7fff + #define HSYNC_PULSE_ENABLED (1<<30) + #define HSYNC_NEGATIVE (1<<31) +#define PHYTIUM_DC_VDISPLAY 0x1440 + #define VDISPLAY_END_SHIFT 0 + #define VDISPLAY_END_MASK 0x7fff + #define VDISPLAY_TOTAL_SHIFT 16 + #define VDISPLAY_TOTAL_MASK 0x7fff +#define PHYTIUM_DC_VSYNC 0x1448 + #define VSYNC_START_SHIFT 0 + #define VSYNC_START_MASK 0x7fff + #define VSYNC_END_SHIFT 15 + #define VSYNC_END_MASK 0x7fff + #define VSYNC_PULSE_ENABLED (1<<30) + #define VSYNC_NEGATIVE (1<<31) +#define PHYTIUM_DC_LOCATION 0x1450 + #define LOVATION_Y_SHIFT 16 +#define PHYTIUM_DC_GAMMA_INDEX 0x1458 + #define GAMMA_INDEX_MAX 256 +#define PHYTIUM_DC_GAMMA_DATA 0x1460 + #define GAMMA_BLUE_SHIFT 0 + #define GAMMA_BLUE_MASK 0x3ff + #define GAMMA_GREEN_SHIFT 10 + #define GAMMA_GREEN_MASK 0x3ff + #define GAMMA_RED_SHIFT 20 + #define GAMMA_RED_MASK 0x3ff +#define PHYTIUM_DC_CURSOR_CONFIG 0x1468 + #define CURSOR_FORMAT_DISABLED 0x0 + #define CURSOR_FORMAT_MASKMODE 0x3 + #define CURSOR_FORMAT_ARGB8888 0x2 + #define CURSOR_FORMAT_MASK 0x3 + #define CURSOR_HOT_Y_SHIFT 8 + #define CURSOR_HOT_Y_MASK 0x1f + #define CURSOR_HOT_X_SHIFT 16 + #define CURSOR_HOT_X_MASK 0x1f +#define PHYTIUM_DC_CURSOR_ADDRESS 0x146c +#define PHYTIUM_DC_CURSOR_LOCATION 0x1470 + #define CURSOR_X_SHIFT 0 + #define CURSOR_X_MASK 0x7fff + #define CURSOR_Y_SHIFT 16 + #define CURSOR_Y_MASK 0x7fff +#define PHYTIUM_DC_CURSOR_BACKGROUND 0x1474 +#define PHYTIUM_DC_CURSOR_FOREGROUND 0x1478 +#define PHYTIUM_DC_INT_STATUS 0x147c + #define INT_STATUS 0x1 +#define PHYTIUM_DC_INT_ENABLE 0x1480 + #define INT_ENABLE 0x1 + #define INT_DISABLE 0x0 + +#define PHYTIUM_DC_FRAMEBUFFER_CONFIG 0x1518 + #define FRAMEBUFFER_OUTPUT BIT(0) + #define FRAMEBUFFER_GAMMA_ENABLE BIT(2) + #define FRAMEBUFFER_VALID_PENDING BIT(3) + #define FRAMEBUFFER_RESET BIT(4) + #define FRAMEBUFFER_PROGRESS BIT(6) + #define FRAMEBUFFER_ROT_ANGLE_SHIFT (11) + #define FRAMEBUFFER_ROT_ANGLE_MASK (0x7) + #define FRAMEBUFFER_ROT_ANGLE_ROT0 (0) + #define FRAMEBUFFER_ROT_ANGLE_FLIP_X (1) + #define FRAMEBUFFER_ROT_ANGLE_FLIP_Y (2) + #define FRAMEBUFFER_TILE_MODE_SHIFT (17) + #define FRAMEBUFFER_TILE_MODE_MASK (0x1f) + #define FRAMEBUFFER_LINEAR 0 + #define FRAMEBUFFER_TILE_MODE0 4 + #define FRAMEBUFFER_TILE_MODE3 7 + #define FRAMEBUFFER_FORMAT_SHIFT 26 + #define FRAMEBUFFER_FORMAT_MASK 0x3f + #define FRAMEBUFFER_FORMAT_XRGB4444 0x0 + #define FRAMEBUFFER_FORMAT_ARGB4444 0x1 + #define FRAMEBUFFER_FORMAT_XRGB1555 0x2 + #define FRAMEBUFFER_FORMAT_ARGB1555 0x3 + #define FRAMEBUFFER_FORMAT_RGB565 0x4 + #define FRAMEBUFFER_FORMAT_XRGB8888 0x5 + #define FRAMEBUFFER_FORMAT_ARGB8888 0x6 + #define FRAMEBUFFER_FORMAT_YUYV 0x7 + #define FRAMEBUFFER_FORMAT_UYVY 0x8 + #define FRAMEBUFFER_FORMAT_NV12 0x11 + #define FRAMEBUFFER_FORMAT_NV16 0x12 + #define FRAMEBUFFER_FORMAT_ARGB2101010 0x16 + #define FRAMEBUFFER_SWIZZLE_SHIFT 23 + #define FRAMEBUFFER_SWIZZLE_MASK 0x3 + #define FRAMEBUFFER_SWIZZLE_ARGB 0 + #define FRAMEBUFFER_SWIZZLE_RGBA 1 + #define FRAMEBUFFER_SWIZZLE_ABGR 2 + #define FRAMEBUFFER_SWIZZLE_BGRA 3 + #define FRAMEBUFFER_UVSWIZZLE_SHIFT 25 + #define FRAMEBUFFER_UVSWIZZLE_DISABLE 0 + #define FRAMEBUFFER_UVSWIZZLE_ENABLE 1 + #define FRAMEBUFFER_CLEAR BIT(8) + #define FRAMEBUFFER_SCALE_ENABLE BIT(22) +#define PHYTIUM_DC_FRAMEBUFFER_SCALECONFIG 0x1520 + #define FRAMEBUFFER_FILTER_TAP 3 + #define FRAMEBUFFER_HORIZONTAL_FILTER_TAP 3 + #define FRAMEBUFFER_TAP 0x33 +#define PHYTIUM_DC_FRAMEBUFFER_U_ADDRESS 0x1530 +#define PHYTIUM_DC_FRAMEBUFFER_V_ADDRESS 0x1538 +#define PHYTIUM_DC_OVERLAY_CONFIG 0x1540 + #define PX210_DC_OVERLAY_ENABLE BIT(24) + +#define PHYTIUM_DC_FRAMEBUFFER_U_STRIDE 0x1800 +#define PHYTIUM_DC_FRAMEBUFFER_V_STRIDE 0x1808 +#define PHYTIUM_DC_FRAMEBUFFER_SIZE 0x1810 + #define WIDTH_SHIFT 0 + #define WIDTH_MASK 0x7fff + #define HEIGHT_SHIFT 15 + #define HEIGHT_MASK 0x7fff + +#define PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_X 0x1828 + #define SCALE_FACTOR_X_MASK 0x7fffffff +#define PHYTIUM_DC_FRAMEBUFFER_SCALE_FACTOR_Y 0x1830 + #define SCALE_FACTOR_Y_MASK 0x7fffffff + #define SCALE_FACTOR_Y_MAX 0x3 + #define SCALE_FACTOR_SRC_OFFSET 16 + +#define PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER_INDEX 0x1838 + #define HORI_FILTER_INDEX 0x0 +#define PHYTIUM_DC_FRAMEBUFFER_HORI_FILTER 0x1a00 +#define PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER_INDEX 0x1a08 + #define VERT_FILTER_INDEX 0x0 +#define PHYTIUM_DC_FRAMEBUFFER_VERT_FILTER 0x1a10 +#define PHYTIUM_DC_FRAMEBUFFER_CLEARVALUE 0x1a18 + #define CLEAR_VALUE_RED 0x00ff0000 + #define CLEAR_VALUE_GREEN 0x0000ff00 + #define CLEAR_VALUE_BLACK 0x00000000 +#define PHYTIUM_DC_FRAMEBUFFER_INITIALOFFSET 0x1a20 + #define INITIALOFFSET (0x8000 | (0X8000 << 16)) +#define PHYTIUM_DC_DP_CONFIG 0x1cd0 + #define OUTPUT_DP (1<<3) + #define DP_RGB666 (0x1) + #define DP_RGB888 (0x2) + #define DP_RGB101010 (0x3) +/******************************dc register end********************************************/ + +/******************************phy access register****************************************/ +#define PHYTIUM_PHY_ACCESS_ADDRESS 0x0000 +#define PHYTIUM_PHY_WRITE_DATA 0x0004 +#define PHYTIUM_PHY_READ_DATA 0x0008 +#define PHYTIUM_PHY_ACCESS_CTRL 0x000c + #define ACCESS_WRITE (1<<0) + #define ACCESS_READ (1<<1) +/******************************phy access register end*************************************/ + +/******************************dp register start******************************************/ +#define PHYTIUM_DP_LINK_BW_SET 0x0000 +#define PHYTIUM_DP_LANE_COUNT_SET 0x0004 +#define PHYTIUM_DP_ENHANCED_FRAME_EN 0x0008 + #define ENHANCED_FRAME_ENABLE 0x1 + #define ENHANCED_FRAME_DISABLE 0x0 +#define PHYTIUM_DP_TRAINING_PATTERN_SET 0x000c + #define TRAINING_OFF 0x0 + #define TRAINING_PATTERN_1 0x1 + #define TRAINING_PATTERN_2 0x2 + #define TRAINING_PATTERN_3 0x3 + #define TRAINING_PATTERN_4 0x4 +#define PHYTIUM_DP_LINK_QUAL_PATTERN_SET 0x0010 + #define TEST_PATTERN_NONE 0x0 + #define TEST_PATTERN_D10_2 0x1 + #define TEST_PATTERN_SYMBOL_ERROR 0x2 + #define TEST_PATTERN_PRBS7 0x3 + #define TEST_PATTERN_80BIT_CUSTOM 0x4 + #define TEST_PATTERN_CP2520_1 0x5 + #define TEST_PATTERN_CP2520_2 0x6 + #define TEST_PATTERN_CP2520_3 0x7 + #define TEST_PATTERN_LANE_SHIFT 8 +#define PHYTIUM_DP_SCRAMBLING_DISABLE 0x0014 + #define SCRAMBLING_ENABLE 0x0 + #define SCRAMBLING_DISABLE 0x1 +#define PHYTIUM_DP_DOWNSPREAD_CTRL 0x0018 +#define PHYTIUM_DP_ALT_SCRAMBLER_RESET 0x001c +#define PHYTIUM_DP_HBR2_SCRAMBLER_RESET 0x0020 +#define PHYTIUM_DP_DISPLAYPORT_VERSION 0x0024 +#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_0 0x0030 +#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_1 0x0034 +#define PHYTIUM_DP_CUSTOM_80BIT_PATTERN_2 0x0038 +#define PHYTIUM_DP_TRANSMITTER_OUTPUT_ENABLE 0x0080 + #define TRANSMITTER_OUTPUT_ENABLE BIT(0) + #define TRANSMITTER_OUTPUT_DISABLE 0 +#define PHYTIUM_DP_VIDEO_STREAM_ENABLE 0x0084 + #define SST_MST_SOURCE_0_ENABLE BIT(0) + #define SST_MST_SOURCE_0_ENABLE_MASK 0x1 + #define SST_MST_SOURCE_0_DISABLE 0 +#define PHYTIUM_DP_SECONDARY_STREAM_ENABLE 0x0088 + #define SECONDARY_STREAM_ENABLE 0x1 + #define SECONDARY_STREAM_DISABLE 0x0 +#define PHYTIUM_DP_SEC_DATA_WINDOW 0x008C +#define PHYTIUM_DP_SOFT_RESET 0x0090 + #define LINK_SOFT_RESET (0x1 << 0) + #define VIDEO_SOFT_RESET (0x1 << 1) +#define PHYTIUM_INPUT_SOURCE_ENABLE 0x0094 + #define VIRTUAL_SOURCE_0_ENABLE BIT(0) + #define VIRTUAL_SOURCE_0_ENABLE_MASK 0x1 +#define PHYTIUM_DP_FORCE_SCRAMBLER_RESET 0x00C0 + #define SCRAMBLER_RESET BIT(0) +#define PHYTIUM_DP_SOURCE_CONTROL_STATUS 0x00C4 +#define PHYTIUM_DP_DATA_CONTROL 0x00C8 +#define PHYTIUM_DP_CORE_CAPABILITY 0x00F8 +#define PHYTIUM_DP_CORE_ID 0x00FC +#define PHYTIUM_DP_AUX_COMMAND 0x0100 + #define BYTE_COUNT_MASK 0xf + #define COMMAND_SHIFT 8 + #define COMMAND_MASK 0xf + #define ADDRESS_ONLY (1<<12) +#define PHYTIUM_DP_AUX_WRITE_FIFO 0x0104 +#define PHYTIUM_DP_AUX_ADDRESS 0x0108 +#define PHYTIUM_DP_AUX_CLK_DIVIDER 0x010C + #define AUX_CLK_DIVIDER 48 + #define AUX_CLK_DIVIDER_100 100 +#define PHYTIUM_DP_SINK_HPD_STATE 0x0128 + #define HPD_CONNECT 0x1 + #define HPD_DISCONNECT 0x0 +#define PHYTIUM_DP_INTERRUPT_RAW_STATUS 0x0130 + #define REPLY_TIMEOUT (1<<3) + #define DP_STATUS_REQUEST_IN_PROGRESS (1<<1) + #define HPD_STATE (0<<1) +#define PHYTIUM_DP_AUX_REPLY_DATA 0x0134 +#define PHYTIUM_DP_AUX_REPLY_CODE 0x0138 + #define AUX_NATIVE_ACK (0x0<<0) + #define AUX_NATIVE_NACK (0x1<<0) + #define AUX_NATIVE_DEFER (0x2<<0) + #define AUX_NATIVE_MASK (0x3 << 0) + #define AUX_I2C_ACK (0x0<<2) + #define AUX_I2C_NACK (0x1<<2) + #define AUX_I2C_DEFER (0x2<<2) + #define AUX_I2C_MASK (0x3 << 2) +#define PHYTIUM_DP_INTERRUPT_STATUS 0x0140 + #define HPD_IRQ (1<<1) + #define HPD_EVENT (1<<0) +#define PHYTIUM_DP_INTERRUPT_MASK 0x0144 + #define HPD_IRQ_MASK (1<<1) + #define HPD_EVENT_MASK (1<<0) + #define HPD_OTHER_MASK 0x7c +#define PHYTIUM_DP_AUX_REPLY_DATA_COUNT 0x0148 +#define PHYTIUM_DP_AUX_STATUS 0x014C + #define REPLY_RECEIVED 0x1 + #define REPLY_IN_PROGRESS 0x2 + #define REQUEST_IN_PROGRESS 0x4 + #define REPLY_ERROR 0x8 +#define PHYTIUM_DP_AUX_TIMER 0x0158 +#define PHYTIUM_DP_MAIN_LINK_HTOTAL 0x0180 +#define PHYTIUM_DP_MAIN_LINK_VTOTAL 0x0184 +#define PHYTIUM_DP_MAIN_LINK_POLARITY 0x0188 + #define VSYNC_POLARITY_LOW BIT(1) + #define HSYNC_POLARITY_LOW BIT(0) +#define PHYTIUM_DP_MAIN_LINK_HSWIDTH 0x018C +#define PHYTIUM_DP_MAIN_LINK_VSWIDTH 0x0190 +#define PHYTIUM_DP_MAIN_LINK_HRES 0x0194 +#define PHYTIUM_DP_MAIN_LINK_VRES 0x0198 +#define PHYTIUM_DP_MAIN_LINK_HSTART 0x019C +#define PHYTIUM_DP_MAIN_LINK_VSTART 0x01A0 +#define PHYTIUM_DP_MAIN_LINK_MISC0 0x01A4 + #define MISC0_SYNCHRONOUS_CLOCK BIT(0) + #define MISC0_BIT_DEPTH_OFFSET 5 + #define MISC0_BIT_DEPTH_6BIT 0x0 + #define MISC0_BIT_DEPTH_8BIT 0x1 + #define MISC0_BIT_DEPTH_10BIT 0x2 + #define MISC0_COMPONENT_FORMAT_SHIFT 1 + #define MISC0_COMPONENT_FORMAT_RGB 0x0 +#define PHYTIUM_DP_MAIN_LINK_MISC1 0x01A8 +#define PHYTIUM_DP_M_VID 0x01AC +#define PHYTIUM_DP_TRANSFER_UNIT_SIZE 0x01B0 +#define PHYTIUM_DP_N_VID 0x01B4 +#define PHYTIUM_DP_USER_PIXEL_WIDTH 0x01B8 +#define PHYTIUM_DP_DATA_COUNT 0x01BC +#define PHYTIUM_DP_INTERLACED 0x01C0 +#define PHYTIUM_DP_USER_SYNC_POLARITY 0x01C4 + #define USER_ODDEVEN_POLARITY_HIGH BIT(3) + #define USER_DATA_ENABLE_POLARITY_HIGH BIT(2) + #define USER_VSYNC_POLARITY_HIGH BIT(1) + #define USER_HSYNC_POLARITY_HIGH BIT(0) +#define PHYTIUM_DP_USER_CONTROL 0x01C8 +#define PHYTIUM_EDP_CRC_ENABLE 0x01D0 + #define SUPPORT_EDP_1_4 BIT(1) +#define PHYTIUM_EDP_CRC_RED 0x01D4 +#define PHYTIUM_EDP_CRC_GREEN 0x01D8 +#define PHYTIUM_EDP_CRC_BLUE 0x01DC +#define PHYTIUM_DP_SEC_AUDIO_ENABLE 0x0300 + #define SEC_AUDIO_ENABLE BIT(0) + #define CHANNEL_MUTE_ENABLE BIT(1) +#define PHYTIUM_DP_SEC_INPUT_SELECT 0x0304 + #define INPUT_SELECT_I2S 0x0 +#define PHYTIUM_DP_SEC_CHANNEL_COUNT 0x0308 + #define CHANNEL_2 0x2 + #define CHANNEL_2_LFE 0x3 + #define CHANNEL_5_1 0x6 + #define CHANNEL_7_1 0x7 + #define CHANNEL_MASK 0xf +#define PHYTIUM_DP_SEC_DIRECT_CLKDIV 0x030c + #define APB_CLOCK 48000000 +#define PHYTIUM_DP_SEC_MAUD 0x0318 +#define PHYTIUM_DP_SEC_NAUD 0x031c +#define PHYTIUM_DP_SEC_CLOCK_MODE 0x0320 + #define CLOCK_MODE_SYNC 0x1 +#define PHYTIUM_DP_SEC_CS_SOURCE_FORMAT 0x0340 + #define CS_SOURCE_FORMAT_DEFAULT 0x0 +#define PHYTIUM_DP_SEC_CS_CATEGORY_CODE 0x0344 +#define PHYTIUM_DP_SEC_CS_LENGTH_ORIG_FREQ 0x0348 + #define ORIG_FREQ_32000 0xc + #define ORIG_FREQ_44100 0xf + #define ORIG_FREQ_48000 0xd + #define ORIG_FREQ_88200 0x7 + #define ORIG_FREQ_96000 0x5 + #define ORIG_FREQ_176400 0x3 + #define ORIG_FREQ_192000 0x1 + #define ORIG_FREQ_MASK 0xf + #define ORIG_FREQ_SHIFT 0 + #define WORD_LENGTH_16 0x4 + #define WORD_LENGTH_18 0x2 + #define WORD_LENGTH_20 0xc + #define WORD_LENGTH_24 0xd + #define WORD_LENGTH_MASK 0xf + #define WORD_LENGTH_SHIFT 4 +#define PHYTIUM_DP_SEC_CS_FREQ_CLOCK_ACCURACY 0x034c // not used + #define SAMPLING_FREQ_32000 0xc + #define SAMPLING_FREQ_44100 0x0 + #define SAMPLING_FREQ_48000 0x4 + #define SAMPLING_FREQ_88200 0x1 + #define SAMPLING_FREQ_96000 0x5 + #define SAMPLING_FREQ_176400 0x3 + #define SAMPLING_FREQ_192000 0x7 + #define SAMPLING_FREQ_MASK 0xf + #define SAMPLING_FREQ_SHIFT 4 +#define PHYTIUM_DP_SEC_CHANNEL_MAP 0x035C + #define CHANNEL_MAP_DEFAULT 0x87654321 +/******************************dp register end********************************************/ + +#endif /* __PHYTIUM_REG_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dc.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dc.c new file mode 100644 index 0000000000000000000000000000000000000000..84fd44a130f07910e324365c911744a203bcf6d5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dc.c @@ -0,0 +1,326 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include "phytium_display_drv.h" +#include "px210_reg.h" +#include "phytium_crtc.h" +#include "phytium_plane.h" +#include "phytium_fb.h" +#include "phytium_gem.h" + +static const unsigned int px210_primary_formats[] = { + DRM_FORMAT_ARGB2101010, + DRM_FORMAT_ABGR2101010, + DRM_FORMAT_RGBA1010102, + DRM_FORMAT_BGRA1010102, + DRM_FORMAT_ARGB8888, + DRM_FORMAT_ABGR8888, + DRM_FORMAT_RGBA8888, + DRM_FORMAT_BGRA8888, + DRM_FORMAT_XRGB8888, + DRM_FORMAT_XBGR8888, + DRM_FORMAT_RGBX8888, + DRM_FORMAT_BGRX8888, + DRM_FORMAT_ARGB4444, + DRM_FORMAT_ABGR4444, + DRM_FORMAT_RGBA4444, + DRM_FORMAT_BGRA4444, + DRM_FORMAT_XRGB4444, + DRM_FORMAT_XBGR4444, + DRM_FORMAT_RGBX4444, + DRM_FORMAT_BGRX4444, + DRM_FORMAT_ARGB1555, + DRM_FORMAT_ABGR1555, + DRM_FORMAT_RGBA5551, + DRM_FORMAT_BGRA5551, + DRM_FORMAT_XRGB1555, + DRM_FORMAT_XBGR1555, + DRM_FORMAT_RGBX5551, + DRM_FORMAT_BGRX5551, + DRM_FORMAT_RGB565, + DRM_FORMAT_BGR565, + DRM_FORMAT_YUYV, + DRM_FORMAT_UYVY, +}; + +static uint64_t px210_primary_formats_modifiers[] = { + DRM_FORMAT_MOD_LINEAR, + DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC, + DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC, + DRM_FORMAT_MOD_INVALID +}; + +static uint64_t px210_cursor_formats_modifiers[] = { + DRM_FORMAT_MOD_LINEAR, + DRM_FORMAT_MOD_INVALID +}; + +static const unsigned int px210_cursor_formats[] = { + DRM_FORMAT_ARGB8888, +}; + +void px210_dc_hw_vram_init(struct phytium_display_private *priv, resource_size_t vram_addr, + resource_size_t vram_size) +{ + uint32_t config; + uint32_t group_offset = priv->address_transform_base; + + config = phytium_readl_reg(priv, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR); + if (config) + phytium_writel_reg(priv, config, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR); + + config = phytium_readl_reg(priv, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_SIZE); + if (config) + phytium_writel_reg(priv, config, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_SIZE); + + config = phytium_readl_reg(priv, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR); + if (config) + phytium_writel_reg(priv, config, group_offset, + PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR); + + phytium_writel_reg(priv, (vram_addr & SRC_ADDR_MASK) >> SRC_ADDR_OFFSET, + group_offset, PX210_DC_ADDRESS_TRANSFORM_SRC_ADDR); + phytium_writel_reg(priv, (vram_size >> SIZE_OFFSET) | ADDRESS_TRANSFORM_ENABLE, + group_offset, PX210_DC_ADDRESS_TRANSFORM_SIZE); + config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DST_ADDR); + phytium_writel_reg(priv, config, group_offset, PX210_DC_ADDRESS_TRANSFORM_DST_ADDR); +} + +void px210_dc_hw_clear_msi_irq(struct phytium_display_private *priv, uint32_t phys_pipe) +{ + phytium_writel_reg(priv, MSI_CLEAR, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_MSI_CLEAR); +} + +void px210_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int phys_pipe = phytium_crtc->phys_pipe; + uint32_t group_offset = priv->dcreq_reg_base[phys_pipe]; + int ret = 0; + + /* config pix clock */ + phytium_writel_reg(priv, FLAG_REQUEST | CMD_PIXEL_CLOCK | (clock & PIXEL_CLOCK_MASK), + group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to set pixel clock\n", __func__); +} + +void px210_dc_hw_disable(struct drm_crtc *crtc) +{ + struct drm_device *dev = crtc->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_crtc *phytium_crtc = to_phytium_crtc(crtc); + int reset_timeout = 100; + int config = 0; + int phys_pipe = phytium_crtc->phys_pipe; + + // reset dc + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, config | SOFT_RESET, priv->dc_reg_base[phys_pipe], + PX210_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, 0, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); + do { + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_IDLE); + if (config | IS_IDLE) + break; + mdelay(1); + reset_timeout--; + } while (reset_timeout); + + /* reset pix clock */ + px210_dc_hw_config_pix_clock(crtc, 0); + + // reset dc + reset_timeout = 100; + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, config | SOFT_RESET, priv->dc_reg_base[phys_pipe], + PX210_DC_CLOCK_CONTROL); + phytium_writel_reg(priv, 0, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_CONTROL); + do { + config = phytium_readl_reg(priv, priv->dc_reg_base[phys_pipe], PX210_DC_CLOCK_IDLE); + if (config | IS_IDLE) + break; + mdelay(1); + reset_timeout--; + } while (reset_timeout); + + /* reset dcreq */ + phytium_writel_reg(priv, DCREQ_PLAN_A, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_PLAN); + phytium_writel_reg(priv, 0, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_CONTROL); + phytium_writel_reg(priv, DCREQ_RESET, priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_RESET); + msleep(20); + phytium_writel_reg(priv, (~DCREQ_RESET)&DCREQ_RESET_MASK, + priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_RESET); +} + +int px210_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count) +{ + int ret = 0; + + switch (mode_cmd->modifier[count]) { + case DRM_FORMAT_MOD_PHYTIUM_TILE_MODE0_FBCDC: + switch (mode_cmd->pixel_format) { + case DRM_FORMAT_ARGB4444: + case DRM_FORMAT_ABGR4444: + case DRM_FORMAT_RGBA4444: + case DRM_FORMAT_BGRA4444: + case DRM_FORMAT_XRGB4444: + case DRM_FORMAT_XBGR4444: + case DRM_FORMAT_RGBX4444: + case DRM_FORMAT_BGRX4444: + case DRM_FORMAT_ARGB1555: + case DRM_FORMAT_ABGR1555: + case DRM_FORMAT_RGBA5551: + case DRM_FORMAT_BGRA5551: + case DRM_FORMAT_XRGB1555: + case DRM_FORMAT_XBGR1555: + case DRM_FORMAT_RGBX5551: + case DRM_FORMAT_BGRX5551: + case DRM_FORMAT_RGB565: + case DRM_FORMAT_BGR565: + case DRM_FORMAT_YUYV: + case DRM_FORMAT_UYVY: + break; + default: + DRM_ERROR("TILE_MODE0_FBCDC not support DRM_FORMAT %d", + mode_cmd->pixel_format); + ret = -EINVAL; + goto error; + } + break; + case DRM_FORMAT_MOD_PHYTIUM_TILE_MODE3_FBCDC: + switch (mode_cmd->pixel_format) { + case DRM_FORMAT_ARGB2101010: + case DRM_FORMAT_ABGR2101010: + case DRM_FORMAT_RGBA1010102: + case DRM_FORMAT_BGRA1010102: + case DRM_FORMAT_ARGB8888: + case DRM_FORMAT_ABGR8888: + case DRM_FORMAT_RGBA8888: + case DRM_FORMAT_BGRA8888: + case DRM_FORMAT_XRGB8888: + case DRM_FORMAT_XBGR8888: + case DRM_FORMAT_RGBX8888: + case DRM_FORMAT_BGRX8888: + break; + default: + DRM_ERROR("TILE_MODE3_FBCDC not support DRM_FORMAT %d", + mode_cmd->pixel_format); + ret = -EINVAL; + goto error; + } + break; + case DRM_FORMAT_MOD_LINEAR: + break; + default: + DRM_ERROR("unsupported fb modifier 0x%llx\n", mode_cmd->modifier[0]); + ret = -EINVAL; + goto error; + } + + return 0; +error: + return ret; +} + +void px210_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count) +{ + *format_modifiers = px210_primary_formats_modifiers; + *formats = px210_primary_formats; + *format_count = ARRAY_SIZE(px210_primary_formats); +} + +void px210_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count) +{ + *format_modifiers = px210_cursor_formats_modifiers; + *formats = px210_cursor_formats; + *format_count = ARRAY_SIZE(px210_cursor_formats); +} + +void px210_dc_hw_update_dcreq(struct drm_plane *plane) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + int phys_pipe = phytium_plane->phys_pipe; + uint32_t group_offset = priv->dcreq_reg_base[phys_pipe]; + int config; + + if (phytium_plane->tiling[0] == FRAMEBUFFER_LINEAR) { + phytium_writel_reg(priv, DCREQ_MODE_LINEAR, + group_offset, PX210_DCREQ_PLANE0_CONFIG); + } else { + config = DCREQ_NO_LOSSY; + if (phytium_plane->tiling[0] == FRAMEBUFFER_TILE_MODE0) + config |= DCREQ_TILE_TYPE_MODE0; + else if (phytium_plane->tiling[0] == FRAMEBUFFER_TILE_MODE3) + config |= DCREQ_TILE_TYPE_MODE3; + else + config |= DCREQ_TILE_TYPE_MODE0; + + switch (phytium_plane->format) { + case FRAMEBUFFER_FORMAT_ARGB8888: + case FRAMEBUFFER_FORMAT_XRGB8888: + config |= DCREQ_COLOURFORMAT_BGRA8888; + break; + case FRAMEBUFFER_FORMAT_ARGB2101010: + config |= DCREQ_COLOURFORMAT_ARGB2101010; + break; + case FRAMEBUFFER_FORMAT_XRGB4444: + case FRAMEBUFFER_FORMAT_ARGB4444: + config |= DCREQ_COLOURFORMAT_ARGB4444; + break; + case FRAMEBUFFER_FORMAT_XRGB1555: + case FRAMEBUFFER_FORMAT_ARGB1555: + config |= DCREQ_COLOURFORMAT_ARGB1555; + break; + case FRAMEBUFFER_FORMAT_RGB565: + config |= DCREQ_COLOURFORMAT_RGB565; + break; + case FRAMEBUFFER_FORMAT_YUYV: + config |= DCREQ_COLOURFORMAT_YUYV; + break; + case FRAMEBUFFER_FORMAT_UYVY: + config |= DCREQ_COLOURFORMAT_UYVY; + break; + } + config |= DCREQ_ARGBSWIZZLE_ARGB; + config |= DCREQ_MODE_TILE; + phytium_writel_reg(priv, phytium_plane->iova[0] & 0xffffffff, + group_offset, PX210_DCREQ_PLANE0_ADDR_START); + phytium_writel_reg(priv, (phytium_plane->iova[0] + phytium_plane->size[0]) & + 0xffffffff, group_offset, PX210_DCREQ_PLANE0_ADDR_END); + phytium_writel_reg(priv, config, group_offset, PX210_DCREQ_PLANE0_CONFIG); + } +} + +void px210_dc_hw_update_primary_hi_addr(struct drm_plane *plane) +{ + struct drm_device *dev = plane->dev; + struct phytium_display_private *priv = dev->dev_private; + struct phytium_plane *phytium_plane = to_phytium_plane(plane); + int phys_pipe = phytium_plane->phys_pipe; + + phytium_writel_reg(priv, (phytium_plane->iova[0] >> PREFIX_SHIFT) & PREFIX_MASK, + priv->dcreq_reg_base[phys_pipe], PX210_DCREQ_PIX_DMA_PREFIX); +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dc.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dc.h new file mode 100644 index 0000000000000000000000000000000000000000..ef2208bf4f3019e464854831581ac5321aba2a0d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dc.h @@ -0,0 +1,30 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PX210_DC_H__ +#define __PX210_DC_H__ + +#define PX210_DC_PIX_CLOCK_MAX (594000) +#define PX210_DC_HDISPLAY_MAX 3840 +#define PX210_DC_VDISPLAY_MAX 2160 +#define PX210_DC_ADDRESS_MASK 0x7f + +extern void px210_dc_hw_vram_init(struct phytium_display_private *priv, + resource_size_t vram_addr, + resource_size_t vram_size); +extern void px210_dc_hw_clear_msi_irq(struct phytium_display_private *priv, uint32_t phys_pipe); +extern void px210_dc_hw_config_pix_clock(struct drm_crtc *crtc, int clock); +extern void px210_dc_hw_disable(struct drm_crtc *crtc); +extern int px210_dc_hw_fb_format_check(const struct drm_mode_fb_cmd2 *mode_cmd, int count); +extern void px210_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); +extern void px210_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, + const uint32_t **formats, + uint32_t *format_count); +void px210_dc_hw_update_dcreq(struct drm_plane *plane); +void px210_dc_hw_update_primary_hi_addr(struct drm_plane *plane); +#endif /* __PX210_DC_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dp.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dp.c new file mode 100644 index 0000000000000000000000000000000000000000..7c655563132a83c0b615ee12d1768d1b702f5056 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dp.c @@ -0,0 +1,920 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include "phytium_display_drv.h" +#include "px210_reg.h" +#include "phytium_dp.h" +#include "px210_dp.h" + +static uint8_t px210_dp_source_lane_count[3] = {4, 4, 1}; + +/* [reg][ling_rate 1.62->8.1] */ +static int vco_val[12][4] = { + {0x0509, 0x0509, 0x0509, 0x0509}, // CP_PADJ + {0x0f00, 0x0f00, 0x0f00, 0x0f00}, // CP_IADJ + {0x0F08, 0x0F08, 0x0F08, 0x0F08}, // FILT_PADJ + {0x0061, 0x006C, 0x006C, 0x0051}, // INTDIV + {0x3333, 0x0000, 0x0000, 0x0000}, // FRACDIVL + {0x0000, 0x0000, 0x0000, 0x0000}, // FRACDIVH + {0x0042, 0x0048, 0x0048, 0x0036}, // HIGH_THR + {0x0002, 0x0002, 0x0002, 0x0002}, // PDIAG_CTRL + {0x0c5e, 0x0c5e, 0x0c5e, 0x0c5e}, // VCOCAL_PLLCNT_START + {0x00c7, 0x00c7, 0x00c7, 0x00c7}, // LOCK_PEFCNT + {0x00c7, 0x00c7, 0x00c7, 0x00c7}, // LOCK_PLLCNT_START + {0x0005, 0x0005, 0x0005, 0x0005}, // LOCK_PLLCNT_THR +}; + +static int mgnfs_val[4][4][4] = // [link_rate][swing][emphasis] +{ + /* 1.62Gbps */ + { + {0x0026, 0x001f, 0x0012, 0x0000}, + {0x0013, 0x0013, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 2.7Gbps */ + { + {0x0026, 0x001f, 0x0012, 0x0000}, + {0x0013, 0x0013, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 5.4Gbps */ + { + {0x0026, 0x0013, 0x005, 0x0000}, + {0x0018, 0x006, 0x0000, 0x0000}, + {0x000c, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 8.1Gbps */ + { + {0x0026, 0x0013, 0x005, 0x0000}, + {0x0013, 0x006, 0x0000, 0x0000}, + {0x0006, 0x0000, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, +}; + +static int cpost_val[4][4][4] = // [link_rate][swing][emphasis] +{ + /* 1.62Gbps */ + { + {0x0000, 0x0014, 0x0020, 0x002a}, + {0x0000, 0x0010, 0x001f, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 2.7Gbps */ + { + {0x0000, 0x0014, 0x0020, 0x002a}, + {0x0000, 0x0010, 0x001f, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 5.4Gbps */ + { + {0x0000, 0x0014, 0x0022, 0x002e}, + {0x0000, 0x0013, 0x0020, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, + + /* 8.1Gbps */ + { + {0x0000, 0x0014, 0x0022, 0x002e}, + {0x0000, 0x0013, 0x0020, 0x0000}, + {0x0000, 0x0013, 0x0000, 0x0000}, + {0x0000, 0x0000, 0x0000, 0x0000}, + }, +}; + +static int px210_dp_hw_set_phy_lane_and_rate(struct phytium_dp_device *phytium_dp, + uint8_t link_lane_count, + uint32_t link_rate) +{ + int port = phytium_dp->port%3; + int i = 0, data, tmp, tmp1, index = 0, mask; + int timeout = 500, ret = 0; + + if (port == 0 || port == 1) { + /* set pma powerdown */ + data = 0; + mask = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) { + data |= (A3_POWERDOWN3 << i*A3_POWERDOWN3_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (PLL_EN << i*PLL_EN_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (PLL_EN << i*PLL_EN_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (A0_ACTIVE << i*A0_ACTIVE_SHIFT); + mask |= (((1<port%3; + int voltage_swing = 0; + int pre_emphasis = 0, link_rate_index = 0; + + switch (train_set & DP_TRAIN_VOLTAGE_SWING_MASK) { + case DP_TRAIN_VOLTAGE_SWING_LEVEL_0: + default: + voltage_swing = 0; + break; + case DP_TRAIN_VOLTAGE_SWING_LEVEL_1: + voltage_swing = 1; + break; + case DP_TRAIN_VOLTAGE_SWING_LEVEL_2: + voltage_swing = 2; + break; + case DP_TRAIN_VOLTAGE_SWING_LEVEL_3: + voltage_swing = 3; + break; + } + switch (train_set & DP_TRAIN_PRE_EMPHASIS_MASK) { + case DP_TRAIN_PRE_EMPH_LEVEL_0: + default: + pre_emphasis = 0; + break; + case DP_TRAIN_PRE_EMPH_LEVEL_1: + pre_emphasis = 1; + break; + case DP_TRAIN_PRE_EMPH_LEVEL_2: + pre_emphasis = 2; + break; + case DP_TRAIN_PRE_EMPH_LEVEL_3: + pre_emphasis = 3; + break; + } + + switch (link_rate) { + case 810000: + link_rate_index = 3; + break; + case 540000: + link_rate_index = 2; + break; + case 270000: + link_rate_index = 1; + break; + case 162000: + link_rate_index = 0; + break; + default: + DRM_ERROR("phytium dp rate(%d) not support\n", link_rate); + link_rate_index = 2; + break; + } + + if (port == 0) { + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DIAG_ACYA, LOCK); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_TXCC_CTRL, TX_TXCC_CTRL); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DRV, TX_DRV); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_MGNFS, + mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_CPOST, + cpost_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL0_TX_DIAG_ACYA, UNLOCK); + + } else if (port == 1) { + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DIAG_ACYA, LOCK); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_TXCC_CTRL, TX_TXCC_CTRL); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DRV, TX_DRV); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_MGNFS, + mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_CPOST, + cpost_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_CPOST1, + cpost_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY0_PLL1_TX_DIAG_ACYA, UNLOCK); + } else { + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DIAG_ACYA, LOCK); + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_TXCC_CTRL, TX_TXCC_CTRL); + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DRV, TX_DRV); + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_MGNFS, + mgnfs_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_CPOST, + cpost_val[link_rate_index][voltage_swing][pre_emphasis]); + phytium_phy_writel(phytium_dp, PX210_PHY1_PLL0_TX_DIAG_ACYA, UNLOCK); + } +} + +static int px210_dp_hw_init_phy(struct phytium_dp_device *phytium_dp) +{ + int port = phytium_dp->port; + int i = 0, data, tmp, mask; + int timeout = 500, ret = 0; + + if (port == 0 || port == 1) { + phytium_phy_writel(phytium_dp, PX210_PHY0_APB_RESET, APB_RESET); + + phytium_phy_writel(phytium_dp, PX210_PHY0_PIPE_RESET, RESET); + + /* config lane to dp mode */ + data = 0; + mask = 0; + for (i = 0; i < phytium_dp->source_max_lane_count; i++) { + data |= (LANE_BIT << i*LANE_BIT_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (LANE_MASTER << i*LANE_MASTER_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (PLL_EN << i*PLL_EN_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (BIT_20 << i*BIT_20_SHIFT); + mask |= (((1<source_max_lane_count; i++) { + data |= (A0_ACTIVE << i*A0_ACTIVE_SHIFT); + mask |= (((1<dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dcreq_reg_base[port]; + int ret = 0; + + phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | PANEL_POWER_ENABLE, + group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to poweron panel\n", __func__); +} + +static void px210_dp_hw_poweroff_panel(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dcreq_reg_base[port]; + int ret = 0; + + phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | PANEL_POWER_DISABLE, + group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to poweroff panel\n", __func__); +} + +static void px210_dp_hw_enable_backlight(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, ret = 0; + uint32_t group_offset = priv->dcreq_reg_base[port]; + + phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | BACKLIGHT_ENABLE, + group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to enable backlight\n", __func__); +} + +static void px210_dp_hw_disable_backlight(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dcreq_reg_base[port]; + int ret = 0; + + phytium_writel_reg(priv, FLAG_REQUEST | CMD_BACKLIGHT | BACKLIGHT_DISABLE, + group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to disable backlight\n", __func__); +} + +static uint32_t px210_dp_hw_get_backlight(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int config; + uint32_t group_offset = priv->address_transform_base; + + config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE); + return ((config >> BACKLIGHT_VALUE_SHIFT) & BACKLIGHT_VALUE_MASK); +} + +static int px210_dp_hw_set_backlight(struct phytium_dp_device *phytium_dp, uint32_t level) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + uint32_t group_offset = priv->dcreq_reg_base[port]; + int config = 0; + int ret = 0; + + if (level > PX210_DP_BACKLIGHT_MAX) { + ret = -EINVAL; + goto out; + } + + config = FLAG_REQUEST | CMD_BACKLIGHT | ((level & BACKLIGHT_MASK) << BACKLIGHT_SHIFT); + phytium_writel_reg(priv, config, group_offset, PX210_DCREQ_CMD_REGISTER); + ret = phytium_wait_cmd_done(priv, group_offset + PX210_DCREQ_CMD_REGISTER, + FLAG_REQUEST, FLAG_REPLY); + if (ret < 0) + DRM_ERROR("%s: failed to set backlight\n", __func__); + +out: + return ret; +} + +bool px210_dp_hw_spread_is_enable(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port, config; + uint32_t group_offset = priv->address_transform_base; + + config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); + + return ((config & DP_SPREAD_ENABLE(port)) ? true:false); +} + +int px210_dp_hw_reset(struct phytium_dp_device *phytium_dp) +{ + struct drm_device *dev = phytium_dp->dev; + struct phytium_display_private *priv = dev->dev_private; + int port = phytium_dp->port; + int timeout = 100, config, ret = 0; + uint32_t group_offset = priv->address_transform_base; + uint32_t group_offset_dp = priv->dp_reg_base[port]; + + config = phytium_readl_reg(priv, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); + config &= (~DC_DP_RESET_STATUS(port)); + + phytium_writel_reg(priv, config, group_offset, PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); + phytium_writel_reg(priv, FLAG_REQUEST | CMD_DC_DP_RESET, + priv->dcreq_reg_base[port], PX210_DCREQ_CMD_REGISTER); + do { + mdelay(10); + timeout--; + config = phytium_readl_reg(priv, group_offset, + PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS); + if (config & DC_DP_RESET_STATUS(port)) + break; + } while (timeout); + if (timeout == 0) { + DRM_ERROR("reset dc/dp pipe(%d) failed\n", port); + ret = -1; + } + + phytium_writel_reg(priv, AUX_CLK_DIVIDER, group_offset_dp, PHYTIUM_DP_AUX_CLK_DIVIDER); + + return ret; +} + +uint8_t px210_dp_hw_get_source_lane_count(struct phytium_dp_device *phytium_dp) +{ + return px210_dp_source_lane_count[phytium_dp->port]; +} + +static struct phytium_dp_func px210_dp_funcs = { + .dp_hw_get_source_lane_count = px210_dp_hw_get_source_lane_count, + .dp_hw_reset = px210_dp_hw_reset, + .dp_hw_spread_is_enable = px210_dp_hw_spread_is_enable, + .dp_hw_set_backlight = px210_dp_hw_set_backlight, + .dp_hw_get_backlight = px210_dp_hw_get_backlight, + .dp_hw_disable_backlight = px210_dp_hw_disable_backlight, + .dp_hw_enable_backlight = px210_dp_hw_enable_backlight, + .dp_hw_poweroff_panel = px210_dp_hw_poweroff_panel, + .dp_hw_poweron_panel = px210_dp_hw_poweron_panel, + .dp_hw_init_phy = px210_dp_hw_init_phy, + .dp_hw_set_phy_lane_setting = px210_dp_hw_set_phy_lane_setting, + .dp_hw_set_phy_lane_and_rate = px210_dp_hw_set_phy_lane_and_rate, +}; + +void px210_dp_func_register(struct phytium_dp_device *phytium_dp) +{ + phytium_dp->funcs = &px210_dp_funcs; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dp.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dp.h new file mode 100644 index 0000000000000000000000000000000000000000..b62a3c833ac7fbb74be44d35f9e227d103f0a887 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_dp.h @@ -0,0 +1,14 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PX210_DP_H__ +#define __PX210_DP_H__ + +#define PX210_DP_BACKLIGHT_MAX 100 +#define PX210_DP_BACKLIGHT_MIN 0 + +void px210_dp_func_register(struct phytium_dp_device *phytium_dp); +#endif /* __PX210_DP_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_reg.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_reg.h new file mode 100644 index 0000000000000000000000000000000000000000..dbe1e537fc4a9db8e0aa5bbfc6686751a5e0bd6b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/gpu/drm/phytium/px210_reg.h @@ -0,0 +1,349 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium display drm driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PX210_REG_H__ +#define __PX210_REG_H__ + +#include "phytium_reg.h" + +/******************************dc register start******************************************/ +#define PX210_DC_CLOCK_CONTROL 0x0000 + #define SOFT_RESET (1<<12) +#define PX210_DC_CLOCK_IDLE 0x0004 + #define IS_IDLE (1<<16) +/******************************dc register end********************************************/ + +/******************************dcreq register start**************************************/ +#define PX210_DCREQ_PLANE0_ADDR_START 0x00 +#define PX210_DCREQ_PLANE0_ADDR_END 0x04 +#define PX210_DCREQ_PLANE1_ADDR_START 0x08 +#define PX210_DCREQ_PLANE1_ADDR_END 0x0c +#define PX210_DCREQ_PLANE0_CONFIG 0x10 + #define DCREQ_NO_LOSSY (0 << 0) + #define DCREQ_LOSSY (1 << 0) + #define DCREQ_TILE_TYPE_MASK (0x3 << 1) + #define DCREQ_TILE_TYPE_MODE0 (0x1 << 1) + #define DCREQ_TILE_TYPE_MODE3 (0x2 << 1) + #define DCREQ_COLOURFORMAT_MASK (0x7f << 8) + #define DCREQ_COLOURFORMAT_RGB565 (0x5 << 8) + #define DCREQ_COLOURFORMAT_ARGB1555 (0x4 << 8) + #define DCREQ_COLOURFORMAT_ARGB4444 (0x02 << 8) + #define DCREQ_COLOURFORMAT_BGRA8888 (0x29 << 8) + #define DCREQ_COLOURFORMAT_ARGB2101010 (0xe << 8) + #define DCREQ_COLOURFORMAT_YUYV (0x59 << 8) + #define DCREQ_COLOURFORMAT_UYVY (0x5b << 8) + #define DCREQ_ARGBSWIZZLE_MASK (0xf << 4) + #define DCREQ_ARGBSWIZZLE_ARGB (0X0 << 4) + #define DCREQ_ARGBSWIZZLE_BGRA (0XC << 4) + #define DCREQ_MODE_MASK (1 << 16) + #define DCREQ_MODE_LINEAR (0 << 16) + #define DCREQ_MODE_TILE (1 << 16) +#define PX210_DCREQ_PLANE1_CONFIG(pipe) 0x14 +#define PX210_DCREQ_PLANE0_CLEAR_COLOR_L 0x18 +#define PX210_DCREQ_PLANE0_CLEAR_COLOR_H 0x1C +#define PX210_DCREQ_PLANE1_CLEAR_COLOR_L 0x20 +#define PX210_DCREQ_PLANE1_CLEAR_COLOR_H 0x24 +#define PX210_DCREQ_CMD_REGISTER 0x38 + #define FLAG_REPLY (1<<31) + #define FLAG_REQUEST (1<<30) + #define CMD_PIXEL_CLOCK (0x0 << 28) + #define CMD_BACKLIGHT (0x1 << 28) + #define CMD_DC_DP_RESET (0x3 << 28) + #define BACKLIGHT_SHIFT 21 + #define BACKLIGHT_MASK 0x7f + #define BACKLIGHT_MAX 100 + #define BACKLIGHT_ENABLE (101 << BACKLIGHT_SHIFT) + #define BACKLIGHT_DISABLE (102 << BACKLIGHT_SHIFT) + #define PANEL_POWER_ENABLE (103 << BACKLIGHT_SHIFT) + #define PANEL_POWER_DISABLE (104 << BACKLIGHT_SHIFT) + #define PIXEL_CLOCK_MASK (0x1fffff) +#define PX210_DCREQ_FBCD_CLOCK_CONFIG 0x3c +#define PX210_DCREQ_PIX_DMA_PREFIX 0x50 + #define PREFIX_MASK 0xff + #define PREFIX_SHIFT 32 +#define PX210_DCREQ_FRAME_START 0x54 +#define PX210_DCREQ_FILTER_CONFIG 0x58 +#define PX210_DCREQ_CONTROL 0x5C + #define DC_REQ_ENABLE (1<<0) +#define PX210_DCREQ_MSI_CLEAR 0x60 + #define MSI_CLEAR 0x0 +#define PX210_DCREQ_RESET 0x68 + #define DCREQ_RESET (0x3 << 0) + #define DCREQ_RESET_MASK 0x3 +#define PX210_DCREQ_PLAN 0x94 + #define DCREQ_PLAN_A 0x0 + #define DCREQ_PLAN_B 0X5 +/******************************dcreq register end**************************************/ + +/******************************address transform register start**************************/ +#define PX210_GPU_ADDRESS_TRANSFORM_SRC_ADDR 0x0 +#define PX210_GPU_ADDRESS_TRANSFORM_SIZE 0x4 +#define PX210_GPU_ADDRESS_TRANSFORM_DST_ADDR 0x8 + +#define PX210_DC_ADDRESS_TRANSFORM_SRC_ADDR 0x24 + #define SRC_ADDR_OFFSET 22 + #define SRC_ADDR_MASK 0xffffffffff +#define PX210_DC_ADDRESS_TRANSFORM_SIZE 0x28 + #define ADDRESS_TRANSFORM_ENABLE (0x1 << 31) + #define SIZE_OFFSET 22 +#define PX210_DC_ADDRESS_TRANSFORM_DST_ADDR 0x2c + #define DST_ADDR_OFFSET 22 +#define PX210_DC_ADDRESS_TRANSFORM_DP_RESET_STATUS 0x48 + #define DC_DP_RESET_STATUS(pipe) (1 << pipe) + #define DP_SPREAD_ENABLE(pipe) (0x8 << pipe) +#define PX210_DC_ADDRESS_TRANSFORM_BACKLIGHT_VALUE 0x4c + #define BACKLIGHT_VALUE_MASK (0x7f) + #define BACKLIGHT_VALUE_SHIFT 16 +/******************************address transform register end**************************/ + +/******************************phy register start******************************************/ +/* self define */ +#define PX210_PHY0_PIPE_RESET 0x40104 + #define RESET 0x0 + #define RESET_DEASSERT 0x1 +#define PX210_PHY1_PIPE_RESET 0x100100 + #define PHY1_PIPE_RESET 0x0 + #define PHY1_PIPE_RESET_DEASSERT 0x4 + +#define PX210_PHY1_EN_REFCLK 0x100070 + +#define PX210_PHY0_MODE 0x40088 + #define LANE_BIT (0x3) + #define LANE_BIT_SHIFT 0x2 +#define PX210_PHY1_SEL 0x100004 + #define PHY1_DP_LANE_BIT 0x1 + #define PHY1_DP_LANE_BIT_SHIFT 2 + +#define PX210_PHY0_LINK_CFG 0x40044 + #define LANE_MASTER 0x1 + #define LANE_MASTER_SHIFT 1 + +#define PX210_PHY0_PLL_EN 0x40010 + #define PLL_EN 0x1 + #define PLL_EN_SHIFT 1 +#define PX210_PHY0_PMA_WIDTH 0x40020 + #define BIT_20 0x5 + #define BIT_20_SHIFT 4 + +#define PX210_PHY0_PMA0_POWER 0x40014 +#define PX210_PHY0_PMA1_POWER 0x40018 + #define A0_ACTIVE 0x1 + #define A0_ACTIVE_SHIFT 8 + #define A3_POWERDOWN3 0x8 + #define A3_POWERDOWN3_SHIFT 8 + +#define PX210_PHY1_PMA_MISC 0x1000a0 + #define PHY1_PLL_EN 0x1 + #define PHY1_PLL_EN_MASK 1 + #define PHY1_PLL_EN_SHIFT 8 + #define PHY1_BIT_20 0x5 + #define PHY1_BIT_20_SHIFT 9 + #define PHY1_A0_ACTIVE 0x1 + #define PHY1_A0_ACTIVE_SHIFT 2 + #define PHY1_A0_ACTIVE_MASK 0x3f + #define PHY1_A3_POWERDOWN3 0x8 + #define PHY1_A3_POWERDOWN3_MASK 0x3f + #define PHY1_A3_POWERDOWN3_SHIFT 2 + +#define PX210_PHY0_LINK_RESET 0x40108 + #define LINK_RESET 0x1 + #define LINK_RESET_MASK 0x1 + #define LINTK_RESET_SHIFT 0x1 + +#define PX210_PHY0_APB_RESET 0x40100 + #define APB_RESET 0x1 +#define PX210_PHY1_APB_RESET 0x100104 + #define PHY1_APB_RESET 0x4 + +/* phy origin register */ +#define PX210_PHY0_PLL_CFG 0x30038 +#define PX210_PHY1_PLL_CFG 0xb0038 + #define SINGLE_LINK 0x0 + #define DOUBLE_LINK 0x2 + +#define PX210_PHY0_PMA_CONTROL 0x3800c +#define PX210_PHY1_PMA_CONTROL 0xb800c + #define CONTROL_ENABLE 0x1 + #define CONTROL_ENABLE_MASK 0x1 + #define CONTROL_ENABLE_SHIFT 0x1 + +#define PX210_PHY0_PMA_CONTROL2 0x38004 +#define PX210_PHY1_PMA_CONTROL2 0xb8004 + #define PLL0_LOCK_DONE (0x1 << 6) + #define PLL1_LOCK_DONE (0x1 << 7) + +#define PX210_PHY0_PLL0_CLK_SEL 0X684 +#define PX210_PHY0_PLL1_CLK_SEL 0x704 +#define PX210_PHY1_PLL_CLK_SEL 0X80684 + #define PLL_LINK_RATE_162000 0xf01 + #define PLL_LINK_RATE_270000 0x701 + #define PLL_LINK_RATE_540000 0x301 + #define PLL_LINK_RATE_810000 0x200 + +#define PX210_PHY0_HSCLK0_SEL 0x18398 +#define PX210_PHY0_HSCLK1_SEL 0x1a398 +#define PX210_PHY1_HSCLK_SEL 0x90398 + #define HSCLK_LINK_0 0x0 + #define HSCLK_LINK_1 0x1 + +#define PX210_PHY0_HSCLK0_DIV 0x1839c +#define PX210_PHY0_HSCLK1_DIV 0x1a39c +#define PX210_PHY1_HSCLK_DIV 0x9039c + #define HSCLK_LINK_RATE_162000 0x2 + #define HSCLK_LINK_RATE_270000 0x1 + #define HSCLK_LINK_RATE_540000 0x0 + #define HSCLK_LINK_RATE_810000 0x0 + +#define PX210_PHY0_PLLDRC0_CTRL 0x18394 +#define PX210_PHY0_PLLDRC1_CTRL 0x1a394 +#define PX210_PHY1_PLLDRC_CTRL 0x90394 + #define PLLDRC_LINK0 0x1 + #define PLLDRC_LINK1 0x9 + +#define PX210_PHY0_PLL0_DSM_M0 0x250 +#define PX210_PHY1_PLL0_DSM_M0 0x80250 + #define PLL0_DSM_M0 0x4 +#define PX210_PHY0_PLL0_VCOCAL_START 0x218 +#define PX210_PHY1_PLL0_VCOCAL_START 0x80218 + #define PLL0_VCOCAL_START 0xc5e +#define PX210_PHY0_PLL0_VCOCAL_CTRL 0x208 +#define PX210_PHY1_PLL0_VCOCAL_CTRL 0x80208 + #define PLL0_VCOCAL_CTRL 0x3 + +#define PX210_PHY0_PLL1_DSM_M0 0x350 + #define PLL1_DSM_M0 0x4 +#define PX210_PHY0_PLL1_VCOCAL_START 0x318 + #define PLL1_VCOCAL_START 0xc5e +#define PX210_PHY0_PLL1_VCOCAL_CTRL 0x308 + #define PLL1_VCOCAL_CTRL 0x3 + +#define PX210_PHY0_PLL0_CP_PADJ 0x690 +#define PX210_PHY0_PLL0_CP_IADJ 0x694 +#define PX210_PHY0_PLL0_CP_FILT_PADJ 0x698 +#define PX210_PHY0_PLL0_INTDIV 0x240 +#define PX210_PHY0_PLL0_FRACDIVL 0x244 +#define PX210_PHY0_PLL0_FRACDIVH 0x248 +#define PX210_PHY0_PLL0_HIGH_THR 0x24c +#define PX210_PHY0_PLL0_PDIAG_CTRL 0x680 +#define PX210_PHY0_PLL0_VCOCAL_PLLCNT_START 0x220 +#define PX210_PHY0_PLL0_LOCK_PEFCNT 0x270 +#define PX210_PHY0_PLL0_LOCK_PLLCNT_START 0x278 +#define PX210_PHY0_PLL0_LOCK_PLLCNT_THR 0x27c + +#define PX210_PHY0_PLL1_CP_PADJ 0x710 +#define PX210_PHY0_PLL1_CP_IADJ 0x714 +#define PX210_PHY0_PLL1_CP_FILT_PADJ 0x718 +#define PX210_PHY0_PLL1_INTDIV 0x340 +#define PX210_PHY0_PLL1_FRACDIVL 0x344 +#define PX210_PHY0_PLL1_FRACDIVH 0x348 +#define PX210_PHY0_PLL1_HIGH_THR 0x34c +#define PX210_PHY0_PLL1_PDIAG_CTRL 0x700 +#define PX210_PHY0_PLL1_VCOCAL_PLLCNT_START 0x320 +#define PX210_PHY0_PLL1_LOCK_PEFCNT 0x370 +#define PX210_PHY0_PLL1_LOCK_PLLCNT_START 0x378 +#define PX210_PHY0_PLL1_LOCK_PLLCNT_THR 0x37c + +#define PX210_PHY1_PLL0_CP_PADJ 0x80690 +#define PX210_PHY1_PLL0_CP_IADJ 0x80694 +#define PX210_PHY1_PLL0_CP_FILT_PADJ 0x80698 +#define PX210_PHY1_PLL0_INTDIV 0x80240 +#define PX210_PHY1_PLL0_FRACDIVL 0x80244 +#define PX210_PHY1_PLL0_FRACDIVH 0x80248 +#define PX210_PHY1_PLL0_HIGH_THR 0x8024c +#define PX210_PHY1_PLL0_PDIAG_CTRL 0x80680 +#define PX210_PHY1_PLL0_VCOCAL_PLLCNT_START 0x80220 +#define PX210_PHY1_PLL0_LOCK_PEFCNT 0x80270 +#define PX210_PHY1_PLL0_LOCK_PLLCNT_START 0x80278 +#define PX210_PHY1_PLL0_LOCK_PLLCNT_THR 0x8027c + +#define PX210_PHY0_PLL0_TX_PSC_A0 0x18400 +#define PX210_PHY1_PLL0_TX_PSC_A0 0x90400 + #define PLL0_TX_PSC_A0 0xfb +#define PX210_PHY0_PLL0_TX_PSC_A2 0x18408 +#define PX210_PHY1_PLL0_TX_PSC_A2 0x90408 + #define PLL0_TX_PSC_A2 0x4aa +#define PX210_PHY0_PLL0_TX_PSC_A3 0x1840c +#define PX210_PHY1_PLL0_TX_PSC_A3 0x9040c + #define PLL0_TX_PSC_A3 0x4aa +#define PX210_PHY0_PLL0_RX_PSC_A0 0x28000 +#define PX210_PHY1_PLL0_RX_PSC_A0 0xa0000 + #define PLL0_RX_PSC_A0 0x0 +#define PX210_PHY0_PLL0_RX_PSC_A2 0x28008 +#define PX210_PHY1_PLL0_RX_PSC_A2 0xa0008 + #define PLL0_RX_PSC_A2 0x0 +#define PX210_PHY0_PLL0_RX_PSC_A3 0x2800C +#define PX210_PHY1_PLL0_RX_PSC_A3 0xa000C + #define PLL0_RX_PSC_A3 0x0 +#define PX210_PHY0_PLL0_RX_PSC_CAL 0x28018 +#define PX210_PHY1_PLL0_RX_PSC_CAL 0xa0018 + #define PLL0_RX_PSC_CAL 0x0 + +#define PX210_PHY0_PLL1_TX_PSC_A0 0x1a400 + #define PLL1_TX_PSC_A0 0xfb +#define PX210_PHY0_PLL1_TX_PSC_A2 0x1a408 + #define PLL1_TX_PSC_A2 0x4aa +#define PX210_PHY0_PLL1_TX_PSC_A3 0x1a40c + #define PLL1_TX_PSC_A3 0x4aa +#define PX210_PHY0_PLL1_RX_PSC_A0 0x2a000 + #define PLL1_RX_PSC_A0 0x0 +#define PX210_PHY0_PLL1_RX_PSC_A2 0x2a008 + #define PLL1_RX_PSC_A2 0x0 +#define PX210_PHY0_PLL1_RX_PSC_A3 0x2a00C + #define PLL1_RX_PSC_A3 0x0 +#define PX210_PHY0_PLL1_RX_PSC_CAL 0x2a018 + #define PLL1_RX_PSC_CAL 0x0 + +#define PX210_PHY0_PLL0_XCVR_CTRL 0x183a8 +#define PX210_PHY1_PLL0_XCVR_CTRL 0x903a8 + #define PLL0_XCVR_CTRL 0xf +#define PX210_PHY0_PLL1_XCVR_CTRL 0x1a3a8 + #define PLL1_XCVR_CTRL 0xf + +#define PX210_PHY0_PLL0_RX_GCSM1_CTRL 0x28420 +#define PX210_PHY1_PLL0_RX_GCSM1_CTRL 0xa0420 + #define PLL0_RX_GCSM1_CTRL 0x0 +#define PX210_PHY0_PLL0_RX_GCSM2_CTRL 0x28440 +#define PX210_PHY1_PLL0_RX_GCSM2_CTRL 0xa0440 + #define PLL0_RX_GCSM2_CTRL 0x0 +#define PX210_PHY0_PLL0_RX_PERGCSM_CTRL 0x28460 +#define PX210_PHY1_PLL0_RX_PERGCSM_CTRL 0xa0460 + #define PLL0_RX_PERGCSM_CTRL 0x0 + +#define PX210_PHY0_PLL1_RX_GCSM1_CTRL 0x2a420 + #define PLL1_RX_GCSM1_CTRL 0x0 +#define PX210_PHY0_PLL1_RX_GCSM2_CTRL 0x2a440 + #define PLL1_RX_GCSM2_CTRL 0x0 +#define PX210_PHY0_PLL1_RX_PERGCSM_CTRL 0x2a460 + #define PLL1_RX_PERGCSM_CTRL 0x0 + +/* swing and emphasis */ +#define PX210_PHY0_PLL0_TX_DIAG_ACYA 0x1879c +#define PX210_PHY0_PLL1_TX_DIAG_ACYA 0x1a79c +#define PX210_PHY1_PLL0_TX_DIAG_ACYA 0x9079c + #define LOCK 1 + #define UNLOCK 0 + +#define PX210_PHY0_PLL0_TX_TXCC_CTRL 0x18100 +#define PX210_PHY0_PLL1_TX_TXCC_CTRL 0x1a100 +#define PX210_PHY1_PLL0_TX_TXCC_CTRL 0x90100 + #define TX_TXCC_CTRL 0x8a4 + +#define PX210_PHY0_PLL0_TX_DRV 0x18318 +#define PX210_PHY0_PLL1_TX_DRV 0x1a318 +#define PX210_PHY1_PLL0_TX_DRV 0x90318 + #define TX_DRV 0x3 + +#define PX210_PHY0_PLL0_TX_MGNFS 0x18140 +#define PX210_PHY0_PLL1_TX_MGNFS 0x1a140 +#define PX210_PHY1_PLL0_TX_MGNFS 0x90140 + +#define PX210_PHY0_PLL0_TX_CPOST 0x18130 +#define PX210_PHY0_PLL1_TX_CPOST 0x1a130 +#define PX210_PHY0_PLL1_TX_CPOST1 0x1a13c +#define PX210_PHY1_PLL0_TX_CPOST 0x90130 + +/******************************phy register end********************************************/ +#endif /* __PX210_REG_H__ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/hwmon/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwmon/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..8cb5b6c96668f4143f53ad8b100b6736aee143c4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwmon/Kconfig @@ -0,0 +1,10 @@ +config SENSORS_PHYTIUM + tristate "Phytium Fan tach and capture counter driver" + help + This driver provides support for Phytium Fan Tacho and capture + counter controllers. + + This driver can also be built as a module. If so, the module + will be called tacho-phytium. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/hwmon/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwmon/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..0023d8f1206dc17c93fb451beb90aee1805368e6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwmon/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_SENSORS_PHYTIUM) += tacho-phytium.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/hwmon/tacho-phytium.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwmon/tacho-phytium.c new file mode 100644 index 0000000000000000000000000000000000000000..00a773014f9c205566d932981ce081e5ced8a37d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwmon/tacho-phytium.c @@ -0,0 +1,416 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Hwmon driver for Phytium tachometer. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +#define TIMER_CTRL_REG 0x00 +#define TIMER_CTRL_MODE_SHIFT 0//0:1 +#define TIMER_CTRL_RESET_SHIFT BIT(2) +#define TIMER_CTRL_FORCE_SHIFT BIT(3) +#define TIMER_CTRL_CAPTURE_EN_SHIFT BIT(4) +#define TIMER_CTRL_CAPTURE_CNT_SHIFT 5//5:11 +#define TIMER_CTRL_ANTI_JITTER_SHIFT 18//18:19 +#define TIMER_CTRL_TACHO_MODE_SHIFT 20//20:21 +#define TIMER_CTRL_TIMER_CNT_MODE_SHIFT BIT(22) +#define TIMER_CTRL_BIT_SET_SHIFT 24 +#define TIMER_CTRL_CNT_EN_SHIFT BIT(25) +#define TIMER_CTRL_CNT_CLR_SHIFT BIT(26) +#define TIMER_CTRL_TIMER_MODE_SHIFT BIT(27) +#define TIMER_CTRL_PULSE_NUM_SHIFT 28//28:30 +#define TIMER_CTRL_TACHO_EN_SHIFT BIT(31) +#define TIMER_TACHO_RES_REG 0x04 +#define TIMER_TACHO_RES_VALID_SHIFT BIT(31) +#define TIMER_TACHO_RES_MASK GENMASK(30, 0) +#define TIMER_CMP_VALUE_UP_REG 0x08 +#define TIMER_CMP_VALUE_LOW_REG 0x1C +#define TIMER_CNT_VALUE_UP_REG 0x20 +#define TIMER_CNT_VALUE_LOW_REG 0x24 +#define TIMER_INT_MASK_REG 0x28 +#define TIMER_INT_STAT_REG 0x2C +#define TIMER_INT_CAPTURE_SHIFT BIT(5) +#define TIMER_INT_CYC_COMP_SHIFT BIT(4) +#define TIMER_INT_ONE_COMP_SHIFT BIT(3) +#define TIMER_INT_ROLLOVER_SHIFT BIT(2) +#define TIMER_INT_TACHO_UNDER_SHIFT BIT(1) +#define TIMER_INT_TACHO_OVER_SHIFT BIT(0) +#define TIMER_TACHO_OVER_REG 0x30 +#define TIMER_TACHO_UNDER_REG 0x34 +#define TIMER_START_VALUE_REG 0x38 + +#define TIMER_INT_CLR_MASK GENMASK(5, 0) + +enum tacho_modes { +tacho_mode = 1, +capture_mode, +}; + +enum edge_modes { +rising_edge, +falling_edge, +double_edge, +}; + +struct phytium_tacho { + struct device *dev; + struct device *hwmon; + void __iomem *base; + struct clk *clk; + u32 freq; + int irq; + u8 work_mode; + u8 edge_mode; + u32 debounce; +}; + +static u16 capture_count; + +static void phytium_tacho_init(struct phytium_tacho *tacho) +{ + u32 val; + + if (tacho->work_mode == tacho_mode) { + val = (TIMER_CTRL_TACHO_EN_SHIFT | + TIMER_CTRL_CNT_EN_SHIFT | + (tacho->edge_mode << TIMER_CTRL_TACHO_MODE_SHIFT) | + (tacho->debounce << TIMER_CTRL_ANTI_JITTER_SHIFT) | + (tacho->work_mode << TIMER_CTRL_MODE_SHIFT)); + writel_relaxed(val, tacho->base + TIMER_CTRL_REG); + writel_relaxed(0x2faf07f, tacho->base + TIMER_CMP_VALUE_LOW_REG); + } else { + val = (TIMER_CTRL_TACHO_EN_SHIFT | + TIMER_CTRL_CNT_EN_SHIFT | + (tacho->edge_mode << TIMER_CTRL_TACHO_MODE_SHIFT) | + (tacho->debounce << TIMER_CTRL_ANTI_JITTER_SHIFT) | + TIMER_CTRL_CAPTURE_EN_SHIFT | + (0x7f << TIMER_CTRL_CAPTURE_CNT_SHIFT) | + (tacho->work_mode << TIMER_CTRL_MODE_SHIFT)), + writel_relaxed(val, tacho->base + TIMER_CTRL_REG); + writel_relaxed(0x20, tacho->base + TIMER_INT_MASK_REG); + } +} + +static int phytium_get_fan_tach_rpm(struct phytium_tacho *priv) +{ + u64 raw_data, tach_div, clk_source; + u8 mode, both; + unsigned long timeout; + unsigned long loopcounter; + + timeout = jiffies + msecs_to_jiffies(500); + + for (loopcounter = 0;; loopcounter++) { + raw_data = readl_relaxed(priv->base + TIMER_TACHO_RES_REG); + + if (raw_data & TIMER_TACHO_RES_VALID_SHIFT) + break; + + if (time_after(jiffies, timeout)) + return -ETIMEDOUT; + + if (loopcounter > 3000) + msleep(20); + else { + udelay(100); + cond_resched(); + } + } + + raw_data = raw_data & TIMER_TACHO_RES_MASK; + clk_source = priv->freq; + mode = priv->edge_mode; + both = (mode == double_edge) ? 1 : 0; + tach_div = 1 << both; + + if (raw_data == 0) + return 0; + + return (clk_source * 60 * raw_data) / 0x2faf080 / tach_div; +} + +static ssize_t show_rpm(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int rpm; + struct phytium_tacho *priv = dev_get_drvdata(dev); + + rpm = phytium_get_fan_tach_rpm(priv); + if (rpm < 0) + return rpm; + + return sprintf(buf, "%d\n", rpm); +} + +static SENSOR_DEVICE_ATTR(fan_input, 0444, + show_rpm, NULL, 0); + +static struct attribute *tacho_dev_attrs[] = { + &sensor_dev_attr_fan_input.dev_attr.attr, + NULL +}; + +static umode_t tacho_dev_is_visible(struct kobject *kobj, + struct attribute *a, int index) +{ + return a->mode; +} + +static const struct attribute_group tacho_group = { + .attrs = tacho_dev_attrs, + .is_visible = tacho_dev_is_visible, +}; + +static const struct attribute_group *tacho_groups[] = { + &tacho_group, + NULL +}; + +static irqreturn_t capture_irq_handler(int irq, void *dev_id) +{ + struct phytium_tacho *priv = dev_id; + u32 status = readl_relaxed(priv->base + TIMER_INT_STAT_REG); + + if (status & TIMER_INT_CAPTURE_SHIFT) { + capture_count++; + + if (capture_count == 0) + dev_err(priv->dev, "Capture counter is overflowed"); + + writel_relaxed(status, priv->base + TIMER_INT_STAT_REG); + return IRQ_HANDLED; + } + return IRQ_NONE; +} + +static ssize_t show_capture(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int cnt; + struct phytium_tacho *priv = dev_get_drvdata(dev); + + cnt = capture_count * 0x7f + readl_relaxed(priv->base + TIMER_CNT_VALUE_LOW_REG); + + return sprintf(buf, "%d\n", cnt); +} + +static SENSOR_DEVICE_ATTR(capture_input, 0444, + show_capture, NULL, 0); + +static struct attribute *capture_dev_attrs[] = { + &sensor_dev_attr_capture_input.dev_attr.attr, + NULL +}; + +static umode_t capture_dev_is_visible(struct kobject *kobj, + struct attribute *a, int index) +{ + return a->mode; +} + +static const struct attribute_group capture_group = { + .attrs = capture_dev_attrs, + .is_visible = capture_dev_is_visible, +}; + +static const struct attribute_group *capture_groups[] = { + &capture_group, + NULL +}; + +static int phytium_tacho_get_work_mode(struct phytium_tacho *tacho) +{ + struct device_node *nc = tacho->dev->of_node; + struct fwnode_handle *fwn = tacho->dev->fwnode; + + if (of_property_read_bool(nc, "tacho")) + return tacho_mode; + else if (has_acpi_companion(tacho->dev) && fwnode_property_read_bool( + fwn, "tacho")) + return tacho_mode; + if (of_property_read_bool(nc, "capture")) + return capture_mode; + else if (has_acpi_companion(tacho->dev) && fwnode_property_read_bool( + fwn, "capture")) + return capture_mode; + return tacho_mode; +} + +static int phytium_tacho_get_edge_mode(struct phytium_tacho *tacho) +{ + struct device_node *nc = tacho->dev->of_node; + struct fwnode_handle *fwn = tacho->dev->fwnode; + + if (of_property_read_bool(nc, "up")) + return rising_edge; + else if (has_acpi_companion(tacho->dev) && fwnode_property_read_bool( + fwn, "up")) + return rising_edge; + if (of_property_read_bool(nc, "down")) + return falling_edge; + else if (has_acpi_companion(tacho->dev) && fwnode_property_read_bool( + fwn, "down")) + return falling_edge; + if (of_property_read_bool(nc, "double")) + return double_edge; + else if (has_acpi_companion(tacho->dev) && fwnode_property_read_bool( + fwn, "double")) + return double_edge; + return rising_edge; +} + +static int phytium_tacho_get_debounce(struct phytium_tacho *tacho) +{ + u32 value; + struct device_node *nc = tacho->dev->of_node; + struct fwnode_handle *fwn = tacho->dev->fwnode; + + if (!of_property_read_u32(nc, "debounce-level", &value)) + return value; + if (has_acpi_companion(tacho->dev)) { + if (!fwnode_property_read_u32(fwn, "debounce-level", &value)) + return value; + } + return 0; +} + +static void phytium_tacho_get_of_data(struct phytium_tacho *tacho) +{ + tacho->work_mode = phytium_tacho_get_work_mode(tacho); + tacho->edge_mode = phytium_tacho_get_edge_mode(tacho); + tacho->debounce = phytium_tacho_get_debounce(tacho); +} + +static int phytium_tacho_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct resource *res; + struct phytium_tacho *tacho; + int ret; + + tacho = devm_kzalloc(dev, sizeof(*tacho), GFP_KERNEL); + if (!tacho) + return -ENOMEM; + + tacho->dev = &pdev->dev; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res) + return -ENOENT; + + tacho->base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(tacho->base)) { + dev_err(&pdev->dev, "region map failed\n"); + return PTR_ERR(tacho->base); + } + + if (!has_acpi_companion(tacho->dev)) { + tacho->clk = devm_clk_get(&pdev->dev, NULL); + if (IS_ERR(tacho->clk)) + return PTR_ERR(tacho->clk); + ret = clk_prepare_enable(tacho->clk); + if (ret) + return ret; + tacho->freq = clk_get_rate(tacho->clk); + } else { + u32 fre; + + ret = clk_prepare_enable(tacho->clk); + if (ret) + return ret; + fwnode_property_read_u32(tacho->dev->fwnode, "clock-frequency", &fre); + tacho->freq = fre; + } + + tacho->irq = platform_get_irq(pdev, 0); + if (tacho->irq < 0) { + dev_err(&pdev->dev, "no irq resource?\n"); + return tacho->irq; + } + + ret = devm_request_irq(dev, tacho->irq, capture_irq_handler, + 0, "phytium_tacho", tacho); + if (ret) { + dev_err(&pdev->dev, "Cannot request IRQ\n"); + return ret; + } + + phytium_tacho_get_of_data(tacho); + + phytium_tacho_init(tacho); + + if (tacho->work_mode == tacho_mode) + tacho->hwmon = devm_hwmon_device_register_with_groups(dev, + "phytium_tacho", + tacho, tacho_groups); + else + tacho->hwmon = devm_hwmon_device_register_with_groups(dev, + "phytium_capture", + tacho, capture_groups); + + platform_set_drvdata(pdev, tacho); + + return PTR_ERR_OR_ZERO(tacho->hwmon); +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_tacho_suspend(struct device *dev) +{ + return 0; +} + +static int phytium_tacho_resume(struct device *dev) +{ + struct phytium_tacho *tacho = dev_get_drvdata(dev); + + phytium_tacho_init(tacho); + + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_tacho_pm, phytium_tacho_suspend, phytium_tacho_resume); + +static const struct of_device_id tacho_of_match[] = { + { .compatible = "phytium,tacho", }, + {}, +}; +MODULE_DEVICE_TABLE(of, tacho_of_match); + +static const struct acpi_device_id tacho_acpi_match[] = { + { "PHYT0033", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, tacho_acpi_match); + +static struct platform_driver phytium_tacho_driver = { + .probe = phytium_tacho_probe, + .driver = { + .name = "phytium_tacho", + .pm = &phytium_tacho_pm, + .of_match_table = of_match_ptr(tacho_of_match), + .acpi_match_table = ACPI_PTR(tacho_acpi_match), + }, +}; + +module_platform_driver(phytium_tacho_driver); + +MODULE_AUTHOR("Zhang Yiqun "); +MODULE_DESCRIPTION("Phytium tachometer driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/hwspinlock/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwspinlock/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..9671c560beffe94878e6dec4780f7696f5d170cd --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwspinlock/Kconfig @@ -0,0 +1,10 @@ +config HWSPINLOCK_PHYTIUM + tristate "Phytium Hardware Spinlock device" + depends on HWSPINLOCK + depends on ARCH_PHYTIUM + help + Say y here to support the Phytium Hardware Spinlock device. + + If unsure, say N. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/hwspinlock/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwspinlock/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..16c328e1ccae5a7c171a6c2655f1c7633bed2b0a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwspinlock/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_HWSPINLOCK_PHYTIUM) += phytium_hwspinlock.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/hwspinlock/phytium_hwspinlock.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwspinlock/phytium_hwspinlock.c new file mode 100644 index 0000000000000000000000000000000000000000..2208105ec9cd8d98558bd21094df3e2934163530 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/hwspinlock/phytium_hwspinlock.c @@ -0,0 +1,189 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium hardware spinlock driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + * + * Derived from drivers/hwspinlock/omap_hwspinlock.c + * Copyright (C) 2010-2015 Texas Instruments Incorporated - http://www.ti.com + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "../../../drivers/hwspinlock/hwspinlock_internal.h" + +/* Spinlock register offsets */ +#define LOCK_BASE 0x10 + +#define SEMA_NOTTAKEN (0) /* free */ +#define SEMA_TAKEN (1) /* locked */ + +static int phytium_hwspinlock_trylock(struct hwspinlock *lock) +{ + void __iomem *lock_addr = lock->priv; + + /* attempt to acquire the lock by reading its value */ + return (readl(lock_addr) == SEMA_NOTTAKEN); +} + +static void phytium_hwspinlock_unlock(struct hwspinlock *lock) +{ + void __iomem *lock_addr = lock->priv; + + /* release the lock by writing 0 to it */ + writel(SEMA_NOTTAKEN, lock_addr); +} + +static void phytium_hwspinlock_relax(struct hwspinlock *lock) +{ + ndelay(50); +} + +static const struct hwspinlock_ops phytium_hwspinlock_ops = { + .trylock = phytium_hwspinlock_trylock, + .unlock = phytium_hwspinlock_unlock, + .relax = phytium_hwspinlock_relax, +}; + +static int phytium_hwspinlock_probe(struct platform_device *pdev) +{ + struct fwnode_handle *np = dev_fwnode(&(pdev->dev)); + struct hwspinlock_device *bank; + struct hwspinlock *hwlock; + struct resource *res; + void __iomem *io_base; + int num_locks, i, ret; + + if (!np) + return -ENODEV; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res) + return -ENODEV; + + io_base = ioremap(res->start, resource_size(res)); + if (!io_base) + return -ENOMEM; + + /* + * make sure the module is enabled and clocked before reading + * the module SYSSTATUS register + */ + pm_runtime_enable(&pdev->dev); + ret = pm_runtime_get_sync(&pdev->dev); + if (ret < 0) { + pm_runtime_put_noidle(&pdev->dev); + goto iounmap_base; + } + + /* Determine number of locks */ + if (fwnode_property_read_u32(np, "nr-locks", &num_locks)) { + dev_err(&pdev->dev, "missing/invalid number of locks\n"); + ret = -EINVAL; + goto iounmap_base; + } + + /* + * runtime PM will make sure the clock of this module is + * enabled again iff at least one lock is requested + */ + ret = pm_runtime_put(&pdev->dev); + if (ret < 0) + goto iounmap_base; + + bank = kzalloc(struct_size(bank, lock, num_locks), GFP_KERNEL); + if (!bank) { + ret = -ENOMEM; + goto iounmap_base; + } + + platform_set_drvdata(pdev, bank); + + for (i = 0, hwlock = &bank->lock[0]; i < num_locks; i++, hwlock++) { + /* Set register address of each lock */ + hwlock->priv = io_base + LOCK_BASE + sizeof(u32) * i; + } + + ret = hwspin_lock_register(bank, &pdev->dev, &phytium_hwspinlock_ops, + 0, num_locks); + if (ret) + goto reg_fail; + + return 0; + +reg_fail: + kfree(bank); +iounmap_base: + iounmap(io_base); + return ret; +} + +static int phytium_hwspinlock_remove(struct platform_device *pdev) +{ + struct hwspinlock_device *bank = platform_get_drvdata(pdev); + void __iomem *io_base = bank->lock[0].priv - LOCK_BASE; + int ret; + + ret = hwspin_lock_unregister(bank); + if (ret) { + dev_err(&pdev->dev, "%s failed: %d\n", __func__, ret); + return ret; + } + + iounmap(io_base); + kfree(bank); + + return 0; +} + +static const struct of_device_id phytium_hwspinlock_of_match[] = { + { .compatible = "phytium,hwspinlock", }, + { /* end */ }, +}; +MODULE_DEVICE_TABLE(of, phytium_hwspinlock_of_match); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_hwspinlock_acpi_match[] = { + { "PHYT0053", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, phytium_hwspinlock_acpi_match); +#endif + +static struct platform_driver phytium_hwspinlock_driver = { + .probe = phytium_hwspinlock_probe, + .remove = phytium_hwspinlock_remove, + .driver = { + .name = "phytium_hwspinlock", + .of_match_table = of_match_ptr(phytium_hwspinlock_of_match), + .acpi_match_table = ACPI_PTR(phytium_hwspinlock_acpi_match), + }, +}; + +static int __init phytium_hwspinlock_init(void) +{ + return platform_driver_register(&phytium_hwspinlock_driver); +} +postcore_initcall(phytium_hwspinlock_init); + +static void __exit phytium_hwspinlock_exit(void) +{ + platform_driver_unregister(&phytium_hwspinlock_driver); +} +module_exit(phytium_hwspinlock_exit); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Hardware spinlock driver for Phytium"); +MODULE_AUTHOR("Chen Baozi "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..7ebaef6574c45971d5c71497b15d99f2a89e23c8 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/Kconfig @@ -0,0 +1,29 @@ +config I2C_PHYTIUM_CORE + tristate + +config I2C_PHYTIUM_PCI + tristate "Phytium I2C PCI" + depends on PCI && ARCH_PHYTIUM + select I2C_PHYTIUM_CORE + select I2C_SMBUS + help + If you say yes to this option, support will be included for the + Phytium I2C adapter. Only master mode is supported. + + This driver can also be built as a module. If so, the module + will be called i2c-phytium-pci. + +config I2C_PHYTIUM_PLATFORM + tristate "Phytium I2C Platform" + depends on (ACPI && COMMON_CLK) || !ACPI + select I2C_SLAVE + select I2C_PHYTIUM_CORE + select I2C_SMBUS + help + If you say yes to this option, support will be included for the + Phytium I2C adapter. Only master mode is supported. + + This driver can also be built as a module. If so, the module + will be called i2c-phytium-platform. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..7c84153daf0961ae12fdaacafab0db8a861bda6c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/Makefile @@ -0,0 +1,4 @@ +obj-$(CONFIG_I2C_PHYTIUM_CORE) += i2c-phytium-core.o +i2c-phytium-core-objs := i2c-phytium-common.o i2c-phytium-master.o i2c-phytium-slave.o +obj-$(CONFIG_I2C_PHYTIUM_PCI) += i2c-phytium-pci.o +obj-$(CONFIG_I2C_PHYTIUM_PLATFORM) += i2c-phytium-platform.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-common.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-common.c new file mode 100644 index 0000000000000000000000000000000000000000..2c866fa8e83c1a9789488b4f2448d4b2f5ee1c31 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-common.c @@ -0,0 +1,206 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * Phytium I2C adapter driver. + * + * Derived from Synopysys I2C driver. + * Copyright (C) 2006 Texas Instruments. + * Copyright (C) 2007 MontaVista Software Inc. + * Copyright (C) 2009 Provigent Ltd. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "i2c-phytium-core.h" + +static char *abort_sources[] = { + [ABRT_7B_ADDR_NOACK] = + "slave address not acknowledged (7bit mode)", + [ABRT_10ADDR1_NOACK] = + "first address byte not acknowledged (10bit mode)", + [ABRT_10ADDR2_NOACK] = + "second address byte not acknowledged (10bit mode)", + [ABRT_TXDATA_NOACK] = + "data not acknowledged", + [ABRT_GCALL_NOACK] = + "no acknowledgment for a general call", + [ABRT_GCALL_READ] = + "read after general call", + [ABRT_SBYTE_ACKDET] = + "start byte acknowledged", + [ABRT_SBYTE_NORSTRT] = + "trying to send start byte when restart is disabled", + [ABRT_10B_RD_NORSTRT] = + "trying to read when restart is disabled (10bit mode)", + [ABRT_MASTER_DIS] = + "trying to use disabled adapter", + [ARB_LOST] = + "lost arbitration", + [ABRT_SLAVE_FLUSH_TXFIFO] = + "read command so flush old data in the TX FIFO", + [ABRT_SLAVE_ARBLOST] = + "slave lost the bus while transmitting data to a remote master", + [ABRT_SLAVE_RD_INTX] = + "incorrect slave-transmitter mode configuration", +}; + +u32 phytium_readl(struct phytium_i2c_dev *dev, int offset) +{ + return readl_relaxed(dev->base + offset); +} + +void phytium_writel(struct phytium_i2c_dev *dev, u32 b, int offset) +{ + writel_relaxed(b, dev->base + offset); +} + +u32 i2c_phytium_scl_hcnt(u32 ic_clk, u32 tSYMBOL, u32 tf, int cond, int offset) +{ + if (cond) + return (ic_clk * tSYMBOL + 500000) / 1000000 - 8 + offset; + else + return (ic_clk * (tSYMBOL + tf) + 500000) / 1000000 - 3 + offset; +} + +u32 i2c_phytium_scl_lcnt(u32 ic_clk, u32 tLOW, u32 tf, int offset) +{ + return ((ic_clk * (tLOW + tf) + 500000) / 1000000) - 1 + offset; +} + +int i2c_phytium_set_sda_hold(struct phytium_i2c_dev *dev) +{ + if (!dev->sda_hold_time) { + /* Keep previous hold time setting if no one set it */ + dev->sda_hold_time = phytium_readl(dev, IC_SDA_HOLD); + } + + if (!(dev->sda_hold_time & IC_SDA_HOLD_RX_MASK)) + dev->sda_hold_time |= 1 << IC_SDA_HOLD_RX_SHIFT; + + dev_dbg(dev->dev, "SDA Hold Time TX:RX = %d:%d\n", + dev->sda_hold_time & ~(u32)IC_SDA_HOLD_RX_MASK, + dev->sda_hold_time >> IC_SDA_HOLD_RX_SHIFT); + + return 0; +} + +void __i2c_phytium_disable(struct phytium_i2c_dev *dev) +{ + int timeout = 100; + + do { + __i2c_phytium_disable_nowait(dev); + if ((phytium_readl(dev, IC_ENABLE_STATUS) & 1) == 0) + return; + + /* + * Wait 10 times the signaling period of the highest I2C + * transfer supported by the driver (for 400KHz this is + * 25us). + */ + usleep_range(25, 250); + } while (timeout--); + + dev_warn(dev->dev, "timeout in disabling adapter\n"); +} + +unsigned long i2c_phytium_clk_rate(struct phytium_i2c_dev *dev) +{ + if (WARN_ON_ONCE(!dev->get_clk_rate_khz)) + return 0; + return dev->get_clk_rate_khz(dev); +} + +int i2c_phytium_prepare_clk(struct phytium_i2c_dev *dev, bool prepare) +{ + if (IS_ERR(dev->clk)) + return PTR_ERR(dev->clk); + + if (prepare) + return clk_prepare_enable(dev->clk); + + clk_disable_unprepare(dev->clk); + return 0; +} +EXPORT_SYMBOL_GPL(i2c_phytium_prepare_clk); + +int i2c_phytium_wait_bus_not_busy(struct phytium_i2c_dev *dev) +{ + int timeout = 20; /* 20 ms */ + + while (phytium_readl(dev, IC_STATUS) & IC_STATUS_ACTIVITY) { + if (timeout <= 0) { + dev_warn(dev->dev, "timeout waiting for bus ready\n"); + i2c_recover_bus(&dev->adapter); + + if (phytium_readl(dev, IC_STATUS) & IC_STATUS_ACTIVITY) + return -ETIMEDOUT; + return 0; + } + timeout--; + usleep_range(1000, 1100); + } + + return 0; +} + +int i2c_phytium_handle_tx_abort(struct phytium_i2c_dev *dev) +{ + unsigned long abort_source = dev->abort_source; + int i; + + if (abort_source & IC_TX_ABRT_NOACK) { + for_each_set_bit(i, &abort_source, ARRAY_SIZE(abort_sources)) + dev_dbg(dev->dev, + "%s: %s\n", __func__, abort_sources[i]); + return -EREMOTEIO; + } + + for_each_set_bit(i, &abort_source, ARRAY_SIZE(abort_sources)) + dev_err(dev->dev, "%s: %s\n", __func__, abort_sources[i]); + + if (abort_source & IC_TX_ARB_LOST) + return -EAGAIN; + else if (abort_source & IC_TX_ABRT_GCALL_READ) + return -EINVAL; + else + return -EIO; + + return 0; +} + +u32 i2c_phytium_func(struct i2c_adapter *adapter) +{ + struct phytium_i2c_dev *dev = i2c_get_adapdata(adapter); + + return dev->functionality; +} + +void i2c_phytium_disable(struct phytium_i2c_dev *dev) +{ + /* Disable controller */ + __i2c_phytium_disable(dev); + + /* Disable all interrupts */ + phytium_writel(dev, 0, IC_INTR_MASK); + phytium_readl(dev, IC_CLR_INTR); +} + +void i2c_phytium_disable_int(struct phytium_i2c_dev *dev) +{ + phytium_writel(dev, 0, IC_INTR_MASK); +} + +MODULE_AUTHOR("Cheng Quan "); +MODULE_DESCRIPTION("Phytium I2C bus adapter core"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-core.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-core.h new file mode 100644 index 0000000000000000000000000000000000000000..7423ccb1b0e896f73d10a25494cbc5f8b06a4950 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-core.h @@ -0,0 +1,259 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium I2C adapter driver. + * + * Derived from Synopysys I2C driver. + * Copyright (C) 2006 Texas Instruments. + * Copyright (C) 2007 MontaVista Software Inc. + * Copyright (C) 2009 Provigent Ltd. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include + +#define IC_DEFAULT_FUNCTIONALITY (I2C_FUNC_I2C | \ + I2C_FUNC_SMBUS_BYTE | \ + I2C_FUNC_SMBUS_BYTE_DATA | \ + I2C_FUNC_SMBUS_WORD_DATA | \ + I2C_FUNC_SMBUS_BLOCK_DATA | \ + I2C_FUNC_SMBUS_I2C_BLOCK) + +#define IC_CON_MASTER 0x1 +#define IC_CON_SPEED_STD 0x2 +#define IC_CON_SPEED_FAST 0x4 +#define IC_CON_SPEED_HIGH 0x6 +#define IC_CON_SPEED_MASK 0x6 +#define IC_CON_10BITADDR_SLAVE 0x8 +#define IC_CON_10BITADDR_MASTER 0x10 +#define IC_CON_RESTART_EN 0x20 +#define IC_CON_SLAVE_DISABLE 0x40 +#define IC_CON_STOP_DET_IFADDRESSED 0x80 +#define IC_CON_TX_EMPTY_CTRL 0x100 +#define IC_CON_RX_FIFO_FULL_HLD_CTRL 0x200 + +#define IC_CON 0x0 +#define IC_TAR 0x4 +#define IC_SAR 0x8 +#define IC_DATA_CMD 0x10 +#define IC_SS_SCL_HCNT 0x14 +#define IC_SS_SCL_LCNT 0x18 +#define IC_FS_SCL_HCNT 0x1c +#define IC_FS_SCL_LCNT 0x20 +#define IC_HS_SCL_HCNT 0x24 +#define IC_HS_SCL_LCNT 0x28 +#define IC_INTR_STAT 0x2c +#define IC_INTR_MASK 0x30 +#define IC_RAW_INTR_STAT 0x34 +#define IC_RX_TL 0x38 +#define IC_TX_TL 0x3c +#define IC_CLR_INTR 0x40 +#define IC_CLR_RX_UNDER 0x44 +#define IC_CLR_RX_OVER 0x48 +#define IC_CLR_TX_OVER 0x4c +#define IC_CLR_RD_REQ 0x50 +#define IC_CLR_TX_ABRT 0x54 +#define IC_CLR_RX_DONE 0x58 +#define IC_CLR_ACTIVITY 0x5c +#define IC_CLR_STOP_DET 0x60 +#define IC_CLR_START_DET 0x64 +#define IC_CLR_GEN_CALL 0x68 +#define IC_ENABLE 0x6c +#define IC_STATUS 0x70 +#define IC_TXFLR 0x74 +#define IC_RXFLR 0x78 +#define IC_SDA_HOLD 0x7c +#define IC_TX_ABRT_SOURCE 0x80 +#define IC_ENABLE_STATUS 0x9c +#define IC_SMBCLK_LOW_MEXT 0xa8 +#define IC_SMBCLK_LOW_TIMEOUT 0xac +#define IC_SMBDAT_STUCK_TIMEOUT 0xb4 +#define IC_CLR_SMBCLK_EXT_LOW_TIMEOUT 0xbc +#define IC_CLR_SMBCLK_TMO_LOW_TIMEOUT 0xc0 +#define IC_CLR_SMBDAT_LOW_TIMEOUT 0xc4 +#define IC_CLR_SMBALERT_IN_N 0xd0 + +#define IC_INTR_RX_UNDER 0x001 +#define IC_INTR_RX_OVER 0x002 +#define IC_INTR_RX_FULL 0x004 +#define IC_INTR_TX_OVER 0x008 +#define IC_INTR_TX_EMPTY 0x010 +#define IC_INTR_RD_REQ 0x020 +#define IC_INTR_TX_ABRT 0x040 +#define IC_INTR_RX_DONE 0x080 +#define IC_INTR_ACTIVITY 0x100 +#define IC_INTR_STOP_DET 0x200 +#define IC_INTR_START_DET 0x400 +#define IC_INTR_GEN_CALL 0x800 +#define IC_INTR_SMBCLK_EXT_LOW_TIMEOUT 0x1000 +#define IC_INTR_SMBCLK_TMO_LOW_TIMEOUT 0x2000 +#define IC_INTR_SMBSDA_LOW_TIMEOUT 0x4000 +#define IC_INTR_SMBALERT_IN_N 0x20000 + +#define IC_INTR_DEFAULT_MASK (IC_INTR_RX_FULL | \ + IC_INTR_TX_ABRT | \ + IC_INTR_STOP_DET) +#define IC_INTR_MASTER_MASK (IC_INTR_DEFAULT_MASK | \ + IC_INTR_TX_EMPTY) +#define IC_INTR_SLAVE_MASK (IC_INTR_DEFAULT_MASK | \ + IC_INTR_RX_DONE | \ + IC_INTR_RX_UNDER | \ + IC_INTR_RD_REQ) +#define IC_INTR_SMBUS_MASK (IC_INTR_MASTER_MASK | \ + IC_INTR_SMBCLK_EXT_LOW_TIMEOUT | \ + IC_INTR_SMBCLK_TMO_LOW_TIMEOUT | \ + IC_INTR_SMBSDA_LOW_TIMEOUT) + +#define IC_STATUS_ACTIVITY 0x1 +#define IC_STATUS_TFE BIT(2) +#define IC_STATUS_MASTER_ACTIVITY BIT(5) +#define IC_STATUS_SLAVE_ACTIVITY BIT(6) + +#define IC_SDA_HOLD_RX_SHIFT 16 +#define IC_SDA_HOLD_RX_MASK GENMASK(23, IC_SDA_HOLD_RX_SHIFT) + +#define IC_ERR_TX_ABRT 0x1 + +#define IC_TAR_10BITADDR_MASTER BIT(12) + +#define IC_COMP_PARAM_1_SPEED_MODE_HIGH (BIT(2) | BIT(3)) +#define IC_COMP_PARAM_1_SPEED_MODE_MASK GENMASK(3, 2) + +#define STATUS_IDLE 0x0 +#define STATUS_WRITE_IN_PROGRESS 0x1 +#define STATUS_READ_IN_PROGRESS 0x2 + +/* + * operation modes + */ +#define PHYTIUM_IC_MASTER 0 +#define PHYTIUM_IC_SLAVE 1 + +#define ABRT_7B_ADDR_NOACK 0 +#define ABRT_10ADDR1_NOACK 1 +#define ABRT_10ADDR2_NOACK 2 +#define ABRT_TXDATA_NOACK 3 +#define ABRT_GCALL_NOACK 4 +#define ABRT_GCALL_READ 5 +#define ABRT_SBYTE_ACKDET 7 +#define ABRT_SBYTE_NORSTRT 9 +#define ABRT_10B_RD_NORSTRT 10 +#define ABRT_MASTER_DIS 11 +#define ARB_LOST 12 +#define ABRT_SLAVE_FLUSH_TXFIFO 13 +#define ABRT_SLAVE_ARBLOST 14 +#define ABRT_SLAVE_RD_INTX 15 + +#define IC_TX_ABRT_7B_ADDR_NOACK (1UL << ABRT_7B_ADDR_NOACK) +#define IC_TX_ABRT_10ADDR1_NOACK (1UL << ABRT_10ADDR1_NOACK) +#define IC_TX_ABRT_10ADDR2_NOACK (1UL << ABRT_10ADDR2_NOACK) +#define IC_TX_ABRT_TXDATA_NOACK (1UL << ABRT_TXDATA_NOACK) +#define IC_TX_ABRT_GCALL_NOACK (1UL << ABRT_GCALL_NOACK) +#define IC_TX_ABRT_GCALL_READ (1UL << ABRT_GCALL_READ) +#define IC_TX_ABRT_SBYTE_ACKDET (1UL << ABRT_SBYTE_ACKDET) +#define IC_TX_ABRT_SBYTE_NORSTRT (1UL << ABRT_SBYTE_NORSTRT) +#define IC_TX_ABRT_10B_RD_NORSTRT (1UL << ABRT_10B_RD_NORSTRT) +#define IC_TX_ABRT_MASTER_DIS (1UL << ABRT_MASTER_DIS) +#define IC_TX_ARB_LOST (1UL << ARB_LOST) +#define IC_RX_ABRT_SLAVE_RD_INTX (1UL << ABRT_SLAVE_RD_INTX) +#define IC_RX_ABRT_SLAVE_ARBLOST (1UL << ABRT_SLAVE_ARBLOST) +#define IC_RX_ABRT_SLAVE_FLUSH_TXFIFO (1UL << ABRT_SLAVE_FLUSH_TXFIFO) + +#define IC_TX_ABRT_NOACK (IC_TX_ABRT_7B_ADDR_NOACK | \ + IC_TX_ABRT_10ADDR1_NOACK | \ + IC_TX_ABRT_10ADDR2_NOACK | \ + IC_TX_ABRT_TXDATA_NOACK | \ + IC_TX_ABRT_GCALL_NOACK) +#define CONTROLLER_TYPE_IIC 0 +#define CONTROLLER_TYPE_SMBUS 1 + +struct phytium_i2c_dev { + struct device *dev; + void __iomem *base; + int irq; + u32 flags; + struct completion cmd_complete; + struct clk *clk; + struct reset_control *rst; + int mode; + struct i2c_client *slave; + u32 (*get_clk_rate_khz)(struct phytium_i2c_dev *dev); + + struct i2c_adapter adapter; + struct i2c_client *ara; + struct i2c_smbus_alert_setup alert_data; + + struct phytium_pci_i2c *controller; + + unsigned int status; + int cmd_err; + u32 abort_source; + + struct i2c_msg *msgs; + int msgs_num; + int msg_write_idx; + int msg_read_idx; + int msg_err; + u32 tx_buf_len; + u8 *tx_buf; + u32 rx_buf_len; + u8 *rx_buf; + + u32 master_cfg; + u32 slave_cfg; + u32 functionality; + unsigned int tx_fifo_depth; + unsigned int rx_fifo_depth; + int rx_outstanding; + + struct i2c_timings timings; + u32 sda_hold_time; + u16 ss_hcnt; + u16 ss_lcnt; + u16 fs_hcnt; + u16 fs_lcnt; + u16 fp_hcnt; + u16 fp_lcnt; + u16 hs_hcnt; + u16 hs_lcnt; + + bool pm_disabled; + void (*disable)(struct phytium_i2c_dev *dev); + void (*disable_int)(struct phytium_i2c_dev *dev); + int (*init)(struct phytium_i2c_dev *dev); +}; + +#define ACCESS_INTR_MASK 0x00000004 + +#define DEFAULT_CLOCK_FREQUENCY 48000000 + +u32 phytium_readl(struct phytium_i2c_dev *dev, int offset); +void phytium_writel(struct phytium_i2c_dev *dev, u32 b, int offset); +unsigned long i2c_phytium_clk_rate(struct phytium_i2c_dev *dev); +int i2c_phytium_prepare_clk(struct phytium_i2c_dev *dev, bool prepare); +int i2c_phytium_wait_bus_not_busy(struct phytium_i2c_dev *dev); +int i2c_phytium_handle_tx_abort(struct phytium_i2c_dev *dev); +u32 i2c_phytium_func(struct i2c_adapter *adap); +void i2c_phytium_disable(struct phytium_i2c_dev *dev); +void i2c_phytium_disable_int(struct phytium_i2c_dev *dev); +int i2c_phytium_set_sda_hold(struct phytium_i2c_dev *dev); +u32 i2c_phytium_scl_hcnt(u32 ic_clk, u32 tSYMBOL, u32 tf, int cond, int offset); +u32 i2c_phytium_scl_lcnt(u32 ic_clk, u32 tLOW, u32 tf, int offset); + +static inline void __i2c_phytium_enable(struct phytium_i2c_dev *dev) +{ + phytium_writel(dev, 1, IC_ENABLE); +} + +static inline void __i2c_phytium_disable_nowait(struct phytium_i2c_dev *dev) +{ + phytium_writel(dev, 0, IC_ENABLE); +} + +void __i2c_phytium_disable(struct phytium_i2c_dev *dev); + +extern int i2c_phytium_probe(struct phytium_i2c_dev *dev); + +extern int i2c_phytium_probe_slave(struct phytium_i2c_dev *dev); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-master.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-master.c new file mode 100644 index 0000000000000000000000000000000000000000..ca745b146b5eee385b6928e5d7e29259cdfcc358 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-master.c @@ -0,0 +1,583 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium I2C adapter driver. + * + * Derived from Synopysys I2C driver. + * Copyright (C) 2006 Texas Instruments. + * Copyright (C) 2007 MontaVista Software Inc. + * Copyright (C) 2009 Provigent Ltd. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "i2c-phytium-core.h" + +static int i2c_phytium_init_master(struct phytium_i2c_dev *dev) +{ + /* Disable the adapter */ + __i2c_phytium_disable(dev); + + /* Write standard speed timing parameters */ + phytium_writel(dev, dev->ss_hcnt, IC_SS_SCL_HCNT); + phytium_writel(dev, dev->ss_lcnt, IC_SS_SCL_LCNT); + + /* Write fast mode/fast mode plus timing parameters */ + phytium_writel(dev, dev->fs_hcnt, IC_FS_SCL_HCNT); + phytium_writel(dev, dev->fs_lcnt, IC_FS_SCL_LCNT); + + /* Write high speed timing parameters if supported */ + if (dev->hs_hcnt && dev->hs_hcnt) { + phytium_writel(dev, dev->hs_hcnt, IC_HS_SCL_HCNT); + phytium_writel(dev, dev->hs_lcnt, IC_HS_SCL_LCNT); + } + + /* Write SDA hold time if supported */ + if (dev->sda_hold_time) + phytium_writel(dev, dev->sda_hold_time, IC_SDA_HOLD); + + /* Configure Tx/Rx FIFO threshold levels */ + phytium_writel(dev, dev->tx_fifo_depth >> 1, IC_TX_TL); + phytium_writel(dev, 0, IC_RX_TL); + + /* Configure the I2C master */ + phytium_writel(dev, dev->master_cfg, IC_CON); + + return 0; +} + +static void i2c_phytium_xfer_init(struct phytium_i2c_dev *dev) +{ + struct i2c_msg *msgs = dev->msgs; + u32 ic_con, ic_tar = 0; + + /* Disable the adapter */ + __i2c_phytium_disable(dev); + + /* If the slave address is 10-bit address, enable 10BITADDR */ + ic_con = phytium_readl(dev, IC_CON); + if (msgs[dev->msg_write_idx].flags & I2C_M_TEN) { + ic_con |= IC_CON_10BITADDR_MASTER; + ic_tar = IC_TAR_10BITADDR_MASTER; + } else { + ic_con &= ~IC_CON_10BITADDR_MASTER; + } + + phytium_writel(dev, ic_con, IC_CON); + + /* + * Set the slave (target) address and enable 10-bit addressing mode + * if applicable. + */ + phytium_writel(dev, msgs[dev->msg_write_idx].addr | ic_tar, IC_TAR); + + /* Enforce disabled interrupts */ + i2c_phytium_disable_int(dev); + + /* Enable the adapter */ + __i2c_phytium_enable(dev); + + /* Dummy read */ + phytium_readl(dev, IC_ENABLE_STATUS); + + /* Clear and enable interrupts */ + phytium_readl(dev, IC_CLR_INTR); + phytium_writel(dev, IC_INTR_SMBUS_MASK, IC_INTR_MASK); +} + +static void i2c_phytium_xfer_msg(struct phytium_i2c_dev *dev) +{ + struct i2c_msg *msgs = dev->msgs; + u32 intr_mask; + int tx_limit, rx_limit; + u32 addr = msgs[dev->msg_write_idx].addr; + u32 buf_len = dev->tx_buf_len; + u8 *buf = dev->tx_buf; + bool need_restart = false; + + intr_mask = IC_INTR_MASTER_MASK; + + for (; dev->msg_write_idx < dev->msgs_num; dev->msg_write_idx++) { + u32 flags = msgs[dev->msg_write_idx].flags; + + if (msgs[dev->msg_write_idx].addr != addr) { + dev_err(dev->dev, + "%s: invalid target address\n", __func__); + dev->msg_err = -EINVAL; + break; + } + + if (!(dev->status & STATUS_WRITE_IN_PROGRESS)) { + /* new i2c_msg */ + buf = msgs[dev->msg_write_idx].buf; + buf_len = msgs[dev->msg_write_idx].len; + + if ((dev->master_cfg & IC_CON_RESTART_EN) && + (dev->msg_write_idx > 0)) + need_restart = true; + } + + tx_limit = dev->tx_fifo_depth - phytium_readl(dev, IC_TXFLR); + rx_limit = dev->tx_fifo_depth - phytium_readl(dev, IC_RXFLR); + + while (buf_len > 0 && tx_limit > 0 && rx_limit > 0) { + u32 cmd = 0; + + if (dev->msg_write_idx == dev->msgs_num - 1 && + buf_len == 1 && !(flags & I2C_M_RECV_LEN)) + cmd |= BIT(9); + + if (need_restart) { + cmd |= BIT(10); + need_restart = false; + } + + if (msgs[dev->msg_write_idx].flags & I2C_M_RD) { + /* avoid rx buffer overrun */ + if (dev->rx_outstanding >= dev->rx_fifo_depth) + break; + + phytium_writel(dev, cmd | 0x100, IC_DATA_CMD); + rx_limit--; + dev->rx_outstanding++; + } else { + phytium_writel(dev, cmd | *buf++, IC_DATA_CMD); + } + tx_limit--; + buf_len--; + } + + dev->tx_buf = buf; + dev->tx_buf_len = buf_len; + + /* + * Because we don't know the buffer length in the + * I2C_FUNC_SMBUS_BLOCK_DATA case, we can't stop + * the transaction here. + */ + if (buf_len > 0 || flags & I2C_M_RECV_LEN) { + /* more bytes to be written */ + dev->status |= STATUS_WRITE_IN_PROGRESS; + break; + } + + dev->status &= ~STATUS_WRITE_IN_PROGRESS; + } + + if (dev->msg_write_idx == dev->msgs_num) + intr_mask &= ~IC_INTR_TX_EMPTY; + + if (dev->msg_err) + intr_mask = 0; + + phytium_writel(dev, intr_mask, IC_INTR_MASK); +} + +static u8 i2c_phytium_recv_len(struct phytium_i2c_dev *dev, u8 len) +{ + struct i2c_msg *msgs = dev->msgs; + u32 flags = msgs[dev->msg_read_idx].flags; + + /* + * Adjust the buffer length and mask the flag + * after receiving the first byte. + */ + len += (flags & I2C_CLIENT_PEC) ? 2 : 1; + dev->tx_buf_len = len - min_t(u8, len, dev->rx_outstanding); + msgs[dev->msg_read_idx].len = len; + msgs[dev->msg_read_idx].flags &= ~I2C_M_RECV_LEN; + + return len; +} + +static void i2c_phytium_read(struct phytium_i2c_dev *dev) +{ + struct i2c_msg *msgs = dev->msgs; + int rx_valid; + + for (; dev->msg_read_idx < dev->msgs_num; dev->msg_read_idx++) { + u32 len; + u8 *buf; + + if (!(msgs[dev->msg_read_idx].flags & I2C_M_RD)) + continue; + + if (!(dev->status & STATUS_READ_IN_PROGRESS)) { + len = msgs[dev->msg_read_idx].len; + buf = msgs[dev->msg_read_idx].buf; + } else { + len = dev->rx_buf_len; + buf = dev->rx_buf; + } + + rx_valid = phytium_readl(dev, IC_RXFLR); + + for (; len > 0 && rx_valid > 0; len--, rx_valid--) { + u32 flags = msgs[dev->msg_read_idx].flags; + + *buf = phytium_readl(dev, IC_DATA_CMD); + /* Ensure length byte is a valid value */ + if (flags & I2C_M_RECV_LEN && + *buf <= I2C_SMBUS_BLOCK_MAX && *buf > 0) { + len = i2c_phytium_recv_len(dev, *buf); + } + buf++; + dev->rx_outstanding--; + } + + if (len > 0) { + dev->status |= STATUS_READ_IN_PROGRESS; + dev->rx_buf_len = len; + dev->rx_buf = buf; + return; + } + + dev->status &= ~STATUS_READ_IN_PROGRESS; + } +} + +static int i2c_phytium_xfer(struct i2c_adapter *adapter, struct i2c_msg msgs[], int num) +{ + struct phytium_i2c_dev *dev = i2c_get_adapdata(adapter); + int ret; + + dev_dbg(dev->dev, "%s: msgs: %d\n", __func__, num); + + pm_runtime_get_sync(dev->dev); + + reinit_completion(&dev->cmd_complete); + dev->msgs = msgs; + dev->msgs_num = num; + dev->cmd_err = 0; + dev->msg_write_idx = 0; + dev->msg_read_idx = 0; + dev->msg_err = 0; + dev->status = STATUS_IDLE; + dev->abort_source = 0; + dev->rx_outstanding = 0; + + ret = i2c_phytium_wait_bus_not_busy(dev); + if (ret < 0) + goto done; + + /* Start the transfers */ + i2c_phytium_xfer_init(dev); + + /* Wait for tx to complete */ + if (!wait_for_completion_timeout(&dev->cmd_complete, adapter->timeout)) { + dev_err(dev->dev, "controller timed out\n"); + i2c_recover_bus(&dev->adapter); + i2c_phytium_init_master(dev); + ret = -ETIMEDOUT; + goto done; + } + + __i2c_phytium_disable_nowait(dev); + + if (dev->msg_err) { + ret = dev->msg_err; + goto done; + } + + if (likely(!dev->cmd_err && !dev->status)) { + ret = num; + goto done; + } + + /* We have got an error */ + if (dev->cmd_err == IC_ERR_TX_ABRT) { + ret = i2c_phytium_handle_tx_abort(dev); + goto done; + } + + if (dev->status) + dev_err(dev->dev, "transfer terminated early.\n"); + + ret = -EIO; + +done: + pm_runtime_mark_last_busy(dev->dev); + pm_runtime_put_autosuspend(dev->dev); + + return ret; +} + +static const struct i2c_algorithm i2c_phytium_algo = { + .master_xfer = i2c_phytium_xfer, + .functionality = i2c_phytium_func, +}; + +static const struct i2c_adapter_quirks i2c_phytium_quirks = { + .flags = I2C_AQ_NO_ZERO_LEN, +}; + +static u32 i2c_phytium_read_clear_intrbits(struct phytium_i2c_dev *dev) +{ + u32 stat; + + stat = phytium_readl(dev, IC_INTR_STAT); + + if (stat & IC_INTR_RX_UNDER) + phytium_readl(dev, IC_CLR_RX_UNDER); + if (stat & IC_INTR_RX_OVER) + phytium_readl(dev, IC_CLR_RX_OVER); + if (stat & IC_INTR_TX_OVER) + phytium_readl(dev, IC_CLR_TX_OVER); + if (stat & IC_INTR_RD_REQ) + phytium_readl(dev, IC_CLR_RD_REQ); + if (stat & IC_INTR_TX_ABRT) { + dev->abort_source = phytium_readl(dev, IC_TX_ABRT_SOURCE); + phytium_readl(dev, IC_CLR_TX_ABRT); + } + if (stat & IC_INTR_RX_DONE) + phytium_readl(dev, IC_CLR_RX_DONE); + if (stat & IC_INTR_ACTIVITY) + phytium_readl(dev, IC_CLR_ACTIVITY); + if (stat & IC_INTR_STOP_DET) + phytium_readl(dev, IC_CLR_STOP_DET); + if (stat & IC_INTR_START_DET) + phytium_readl(dev, IC_CLR_START_DET); + if (stat & IC_INTR_GEN_CALL) + phytium_readl(dev, IC_CLR_GEN_CALL); + if (stat & IC_INTR_SMBCLK_EXT_LOW_TIMEOUT) + phytium_readl(dev, IC_CLR_SMBCLK_EXT_LOW_TIMEOUT); + if (stat & IC_INTR_SMBCLK_TMO_LOW_TIMEOUT) + phytium_readl(dev, IC_CLR_SMBCLK_TMO_LOW_TIMEOUT); + if (stat & IC_INTR_SMBSDA_LOW_TIMEOUT) + phytium_readl(dev, IC_CLR_SMBDAT_LOW_TIMEOUT); + if (stat & IC_INTR_SMBALERT_IN_N) + phytium_readl(dev, IC_CLR_SMBALERT_IN_N); + + return stat; +} + +static int i2c_phytium_irq_handler_master(struct phytium_i2c_dev *dev) +{ + u32 stat; + + stat = i2c_phytium_read_clear_intrbits(dev); + + /* SMBus interrupt */ + if (stat & (IC_INTR_SMBCLK_EXT_LOW_TIMEOUT | IC_INTR_SMBCLK_TMO_LOW_TIMEOUT)) { + phytium_writel(dev, phytium_readl(dev, IC_ENABLE) & (~BIT(6)), + IC_ENABLE); + phytium_writel(dev, phytium_readl(dev, IC_ENABLE) | BIT(4), + IC_ENABLE); + goto abort; + } + + if (stat & IC_INTR_SMBSDA_LOW_TIMEOUT) { + phytium_writel(dev, phytium_readl(dev, IC_ENABLE) | BIT(6), + IC_ENABLE); + goto abort; + } + + if (stat & IC_INTR_SMBALERT_IN_N && dev->ara) + i2c_handle_smbus_alert(dev->ara); + + if (stat & IC_INTR_TX_ABRT) { + dev->cmd_err |= IC_ERR_TX_ABRT; + dev->status = STATUS_IDLE; + + /* Anytime TX_ABRT is set, the contents of the tx/rx + * buffers are flushed. Make sure to skip them. + */ + phytium_writel(dev, 0, IC_INTR_MASK); + goto abort; + } + + if (stat & IC_INTR_RX_FULL) + i2c_phytium_read(dev); + + if (stat & IC_INTR_TX_EMPTY) + i2c_phytium_xfer_msg(dev); + +abort: + if ((stat & (IC_INTR_TX_ABRT | IC_INTR_STOP_DET)) || + dev->msg_err) + complete(&dev->cmd_complete); + else if (unlikely(dev->flags & ACCESS_INTR_MASK)) { + /* Workaround to trigger pending interrupt */ + stat = phytium_readl(dev, IC_INTR_MASK); + i2c_phytium_disable_int(dev); + phytium_writel(dev, stat, IC_INTR_MASK); + } + + return 0; +} + +static int i2c_phytium_set_timings_master(struct phytium_i2c_dev *dev) +{ + const char *mode_str, *fp_str = ""; + u32 sda_falling_time, scl_falling_time; + struct i2c_timings *t = &dev->timings; + u32 ic_clk; + int ret; + + /* Set standard and fast speed dividers for high/low periods */ + sda_falling_time = t->sda_fall_ns ?: 300; /* ns */ + scl_falling_time = t->scl_fall_ns ?: 300; /* ns */ + + /* Calculate SCL timing parameters for standard mode if not set */ + if (!dev->ss_hcnt || !dev->ss_lcnt) { + ic_clk = i2c_phytium_clk_rate(dev); + dev->ss_hcnt = + i2c_phytium_scl_hcnt(ic_clk, + 4000, /* tHD;STA = tHIGH = 4.0 us */ + sda_falling_time, + 0, /* 0: DW default, 1: Ideal */ + 0); /* No offset */ + dev->ss_lcnt = + i2c_phytium_scl_lcnt(ic_clk, + 4700, /* tLOW = 4.7 us */ + scl_falling_time, + 0); /* No offset */ + } + dev_dbg(dev->dev, "Standard Mode HCNT:LCNT = %d:%d\n", + dev->ss_hcnt, dev->ss_lcnt); + /* + * Set SCL timing parameters for fast mode or fast mode plus. Only + * difference is the timing parameter values since the registers are + * the same. + */ + if (t->bus_freq_hz == 1000000) { + /* + * Check are fast mode plus parameters available and use + * fast mode if not. + */ + if (dev->fp_hcnt && dev->fp_lcnt) { + dev->fs_hcnt = dev->fp_hcnt; + dev->fs_lcnt = dev->fp_lcnt; + fp_str = " Plus"; + } + } + /* + * Calculate SCL timing parameters for fast mode if not set. They are + * needed also in high speed mode. + */ + if (!dev->fs_hcnt || !dev->fs_lcnt) { + ic_clk = i2c_phytium_clk_rate(dev); + dev->fs_hcnt = + i2c_phytium_scl_hcnt(ic_clk, + 600, /* tHD;STA = tHIGH = 0.6 us */ + sda_falling_time, + 0, /* 0: DW default, 1: Ideal */ + 0); /* No offset */ + dev->fs_lcnt = + i2c_phytium_scl_lcnt(ic_clk, + 1300, /* tLOW = 1.3 us */ + scl_falling_time, + 0); /* No offset */ + } + dev_dbg(dev->dev, "Fast Mode%s HCNT:LCNT = %d:%d\n", + fp_str, dev->fs_hcnt, dev->fs_lcnt); + + if (dev->hs_hcnt && dev->hs_lcnt) + dev_dbg(dev->dev, "High Speed Mode HCNT:LCNT = %d:%d\n", + dev->hs_hcnt, dev->hs_lcnt); + + ret = i2c_phytium_set_sda_hold(dev); + if (ret) + goto out; + + switch (dev->master_cfg & IC_CON_SPEED_MASK) { + case IC_CON_SPEED_STD: + mode_str = "Standard Mode"; + break; + case IC_CON_SPEED_HIGH: + mode_str = "High Speed Mode"; + break; + default: + mode_str = "Fast Mode"; + } + dev_dbg(dev->dev, "Bus speed: %s%s\n", mode_str, fp_str); + +out: + return ret; +} + +static irqreturn_t i2c_phytium_isr(int this_irq, void *dev_id) +{ + struct phytium_i2c_dev *dev = dev_id; + u32 stat, enabled; + + enabled = phytium_readl(dev, IC_ENABLE); + stat = phytium_readl(dev, IC_RAW_INTR_STAT); + if (!enabled || !(stat & ~IC_INTR_ACTIVITY)) + return IRQ_NONE; + + i2c_phytium_irq_handler_master(dev); + + return IRQ_HANDLED; +} + +int i2c_phytium_probe(struct phytium_i2c_dev *dev) +{ + struct i2c_adapter *adapter = &dev->adapter; + unsigned long irq_flags; + int ret; + + init_completion(&dev->cmd_complete); + + dev->init = i2c_phytium_init_master; + dev->disable = i2c_phytium_disable; + dev->disable_int = i2c_phytium_disable_int; + + ret = i2c_phytium_set_timings_master(dev); + if (ret) + return ret; + + ret = dev->init(dev); + if (ret) + return ret; + + /* XXX: should be initialized in firmware, remove it in future */ +#define DEFAULT_TIMEOUT (DEFAULT_CLOCK_FREQUENCY / 1000 * 35) + phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBCLK_LOW_MEXT); + phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBCLK_LOW_TIMEOUT); + phytium_writel(dev, DEFAULT_TIMEOUT, IC_SMBDAT_STUCK_TIMEOUT); + + snprintf(adapter->name, sizeof(adapter->name), "Phytium I2C adapter"); + adapter->retries = 3; + adapter->algo = &i2c_phytium_algo; + adapter->quirks = &i2c_phytium_quirks; + adapter->dev.parent = dev->dev; + i2c_set_adapdata(adapter, dev); + + irq_flags = IRQF_SHARED | IRQF_COND_SUSPEND; + + i2c_phytium_disable_int(dev); + ret = devm_request_irq(dev->dev, dev->irq, i2c_phytium_isr, irq_flags, + dev_name(dev->dev), dev); + if (ret) { + dev_err(dev->dev, "failed to request irq %i: %d\n", dev->irq, ret); + return ret; + } + + /* + * Increment PM usage count during adapter registration in order to + * avoid possible spurious runtime suspend when adapter device is + * registered to the device core and immediate resume in case bus has + * registered I2C slaves that do I2C transfers in their probe. + */ + pm_runtime_get_noresume(dev->dev); + ret = i2c_add_numbered_adapter(adapter); + if (ret) + dev_err(dev->dev, "fail to add adapter: %d\n", ret); + pm_runtime_put_noidle(dev->dev); + + return ret; +} +EXPORT_SYMBOL_GPL(i2c_phytium_probe); + +MODULE_DESCRIPTION("Phytium I2C bus master adapter"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-pci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-pci.c new file mode 100644 index 0000000000000000000000000000000000000000..c63abddd09b13f5220a4946c74d3de4943dfdb98 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-pci.c @@ -0,0 +1,260 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * PCI driver for Phytium I2C adapter. + * + * Derived from Synopysys I2C driver. + * Copyright (C) 2006 Texas Instruments. + * Copyright (C) 2007 MontaVista Software Inc. + * Copyright (C) 2009 Provigent Ltd. + * Copyright (C) 2011, 2015, 2016 Intel Corporation. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "i2c-phytium-core.h" + +#define DRV_NAME "i2c-phytium-pci" + +int i2c_msi_enable; +module_param(i2c_msi_enable, int, 0644); +MODULE_PARM_DESC(i2c_msi_enable, "Enable I2C msi interrupt (0-disabled; 1-enabled; default-0)"); + +enum phytium_pci_ctl_id_t { + octopus_i2c, +}; + +struct scl_sda_cfg { + u32 ss_hcnt; + u32 fs_hcnt; + u32 ss_lcnt; + u32 fs_lcnt; + u32 sda_hold; +}; + +struct phytium_pci_i2c { + u32 bus_num; + u32 bus_cfg; + u32 tx_fifo_depth; + u32 rx_fifo_depth; + u32 clk_khz; + u32 functionality; + u32 flags; + struct scl_sda_cfg *scl_sda_cfg; + int (*setup)(struct pci_dev *pdev, struct phytium_pci_i2c *c); +}; + +/* Octopus HCNT/LCNT/SDA hold time */ +static struct scl_sda_cfg octopus_config = { + .ss_hcnt = 0x190, + .ss_lcnt = 0x1d6, + .fs_hcnt = 0x3c, + .fs_lcnt = 0x82, + .sda_hold = 0x0, // XXX +}; + +static int octopus_setup(struct pci_dev *pdev, struct phytium_pci_i2c *c) +{ + struct phytium_i2c_dev *i2c = pci_get_drvdata(pdev); + struct i2c_client *ara; + + if (pdev->device == 0xdc32) { + /* + * Since we have already register the adapter, the dev->irq + * must be valid. + */ + i2c->alert_data.irq = i2c->irq; + + ara = i2c_new_smbus_alert_device(&i2c->adapter, &i2c->alert_data); + if (IS_ERR(ara)) + return PTR_ERR(ara); + + i2c->ara = ara; + } + + return 0; +} + +static struct phytium_pci_i2c pci_ctrl_info[] = { + [octopus_i2c] = { + .bus_num = -1, + .bus_cfg = IC_CON_MASTER | IC_CON_SLAVE_DISABLE | + IC_CON_RESTART_EN | IC_CON_SPEED_FAST, + .tx_fifo_depth = 7, + .rx_fifo_depth = 7, + .functionality = I2C_FUNC_10BIT_ADDR, + .clk_khz = 48000000, + .scl_sda_cfg = &octopus_config, + .setup = octopus_setup, + }, +}; + +#ifdef CONFIG_PM +static int i2c_phytium_pci_suspend(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_i2c_dev *i_dev = pci_get_drvdata(pdev); + + i_dev->disable(i_dev); + + return 0; +} + +static int i2c_phytium_pci_resume(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_i2c_dev *i_dev = pci_get_drvdata(pdev); + + return i_dev->init(i_dev); +} +#endif + +static UNIVERSAL_DEV_PM_OPS(i2c_phytium_pm_ops, i2c_phytium_pci_suspend, + i2c_phytium_pci_resume, NULL); + +static u32 i2c_phytium_get_clk_rate_khz(struct phytium_i2c_dev *dev) +{ + return dev->controller->clk_khz; +} + +static int i2c_phytium_pci_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct phytium_i2c_dev *dev; + struct i2c_adapter *adapter; + struct phytium_pci_i2c *controller; + struct scl_sda_cfg *cfg; + int ret; + + if (id->driver_data >= ARRAY_SIZE(pci_ctrl_info)) { + dev_err(&pdev->dev, "%s: invalid driver data %ld\n", __func__, + id->driver_data); + ret = -EINVAL; + goto out; + } + + controller = &pci_ctrl_info[id->driver_data]; + + ret = pcim_enable_device(pdev); + if (ret) { + dev_err(&pdev->dev, "Failed to enable I2C PCI device (%d)\n", ret); + goto out; + } + + ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); + if (ret) { + dev_err(&pdev->dev, "I/O memory remapping failed\n"); + goto out; + } + + dev = devm_kzalloc(&pdev->dev, sizeof(struct phytium_i2c_dev), GFP_KERNEL); + if (!dev) { + ret = -ENOMEM; + goto out; + } + + if (i2c_msi_enable) { + pci_set_master(pdev); + + ret = pci_enable_msi(pdev); + if (ret) { + dev_dbg(&pdev->dev, "Error enabling MSI. ret = %d\n", ret); + goto out; + } + } + + dev->controller = controller; + dev->get_clk_rate_khz = i2c_phytium_get_clk_rate_khz; + dev->base = pcim_iomap_table(pdev)[0]; + dev->dev = &pdev->dev; + dev->irq = pdev->irq; + dev->flags |= controller->flags; + + dev->functionality = controller->functionality | IC_DEFAULT_FUNCTIONALITY; + dev->master_cfg = controller->bus_cfg; + if (controller->scl_sda_cfg) { + cfg = controller->scl_sda_cfg; + dev->ss_hcnt = cfg->ss_hcnt; + dev->fs_hcnt = cfg->fs_hcnt; + dev->ss_lcnt = cfg->ss_lcnt; + dev->fs_lcnt = cfg->fs_lcnt; + dev->sda_hold_time = cfg->sda_hold; + } + + pci_set_drvdata(pdev, dev); + + dev->tx_fifo_depth = controller->tx_fifo_depth; + dev->rx_fifo_depth = controller->rx_fifo_depth; + + adapter = &dev->adapter; + adapter->owner = THIS_MODULE; + adapter->class = 0; + ACPI_COMPANION_SET(&adapter->dev, ACPI_COMPANION(&pdev->dev)); + adapter->nr = controller->bus_num; + + ret = i2c_phytium_probe(dev); + if (ret) + goto out; + + if (controller->setup) { + ret = controller->setup(pdev, controller); + if (ret) + goto out; + } + + pm_runtime_set_autosuspend_delay(&pdev->dev, 1000); + pm_runtime_use_autosuspend(&pdev->dev); + pm_runtime_put_autosuspend(&pdev->dev); + pm_runtime_allow(&pdev->dev); + +out: + return ret; +} + +static void i2c_phytium_pci_remove(struct pci_dev *pdev) +{ + struct phytium_i2c_dev *dev = pci_get_drvdata(pdev); + + dev->disable(dev); + pm_runtime_forbid(&pdev->dev); + pm_runtime_get_noresume(&pdev->dev); + + i2c_del_adapter(&dev->adapter); +} + +static const struct pci_device_id i2_phytium_pci_ids[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc32), octopus_i2c }, + { PCI_VDEVICE(PHYTIUM, 0xdc30), octopus_i2c }, + { } +}; +MODULE_DEVICE_TABLE(pci, i2_phytium_pci_ids); + +static struct pci_driver phytium_i2c_driver = { + .name = DRV_NAME, + .id_table = i2_phytium_pci_ids, + .probe = i2c_phytium_pci_probe, + .remove = i2c_phytium_pci_remove, + .driver = { + .pm = &i2c_phytium_pm_ops, + }, +}; + +module_pci_driver(phytium_i2c_driver); + +MODULE_ALIAS("i2c-phytium-pci"); +MODULE_AUTHOR("Cheng Quan "); +MODULE_DESCRIPTION("Phytium PCI I2C bus adapter"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-platform.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-platform.c new file mode 100644 index 0000000000000000000000000000000000000000..6f4de15570008c96f01ff5298813d981e2cb64a7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-platform.c @@ -0,0 +1,364 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * Phytium I2C adapter driver. + * + * Derived from Synopysys I2C driver. + * Copyright (C) 2006 Texas Instruments. + * Copyright (C) 2007 MontaVista Software Inc. + * Copyright (C) 2009 Provigent Ltd. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "i2c-phytium-core.h" + +#define DRV_NAME "i2c-phytium-platform" + +static u32 i2c_phytium_get_clk_rate_khz(struct phytium_i2c_dev *dev) +{ + return clk_get_rate(dev->clk)/1000; +} + +#ifdef CONFIG_ACPI +static void phytium_i2c_acpi_params(struct platform_device *pdev, char method[], + u16 *hcnt, u16 *lcnt, u32 *sda_hold) +{ + struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER }; + acpi_handle handle = ACPI_HANDLE(&pdev->dev); + union acpi_object *obj; + + if (ACPI_FAILURE(acpi_evaluate_object(handle, method, NULL, &buf))) + return; + + obj = (union acpi_object *)buf.pointer; + if (obj->type == ACPI_TYPE_PACKAGE && obj->package.count == 3) { + const union acpi_object *objs = obj->package.elements; + + *hcnt = (u16)objs[0].integer.value; + *lcnt = (u16)objs[1].integer.value; + *sda_hold = (u32)objs[2].integer.value; + } + + kfree(buf.pointer); +} + +static int phytium_i2c_acpi_configure(struct platform_device *pdev) +{ + struct phytium_i2c_dev *dev = platform_get_drvdata(pdev); + struct i2c_timings *t = &dev->timings; + u32 ss_ht = 0, fp_ht = 0, hs_ht = 0, fs_ht = 0; + const struct acpi_device_id *id; + + dev->adapter.nr = -1; + dev->tx_fifo_depth = 32; + dev->rx_fifo_depth = 32; + + /* + * Try to get SDA hold time and *CNT values from an ACPI method for + * selected speed modes. + */ + phytium_i2c_acpi_params(pdev, "SSCN", &dev->ss_hcnt, &dev->ss_lcnt, &ss_ht); + phytium_i2c_acpi_params(pdev, "FPCN", &dev->fp_hcnt, &dev->fp_lcnt, &fp_ht); + phytium_i2c_acpi_params(pdev, "HSCN", &dev->hs_hcnt, &dev->hs_lcnt, &hs_ht); + phytium_i2c_acpi_params(pdev, "FMCN", &dev->fs_hcnt, &dev->fs_lcnt, &fs_ht); + + switch (t->bus_freq_hz) { + case 100000: + dev->sda_hold_time = ss_ht; + break; + case 1000000: + dev->sda_hold_time = fp_ht; + break; + case 3400000: + dev->sda_hold_time = hs_ht; + break; + case 400000: + default: + dev->sda_hold_time = fs_ht; + break; + } + + id = acpi_match_device(pdev->dev.driver->acpi_match_table, &pdev->dev); + if (id && id->driver_data) + dev->flags |= (u32)id->driver_data; + + return 0; +} + +static const struct acpi_device_id phytium_i2c_acpi_match[] = { + { "PHYT0038", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, phytium_i2c_acpi_match); +#else +static inline int phytium_i2c_acpi_configure(struct platform_device *pdev) +{ + return -ENODEV; +} +#endif + +static void i2c_phytium_configure_master(struct phytium_i2c_dev *dev) +{ + struct i2c_timings *t = &dev->timings; + + dev->functionality = I2C_FUNC_10BIT_ADDR | IC_DEFAULT_FUNCTIONALITY; + + dev->master_cfg = IC_CON_MASTER | IC_CON_SLAVE_DISABLE | + IC_CON_RESTART_EN; + + dev->mode = PHYTIUM_IC_MASTER; + + switch (t->bus_freq_hz) { + case 100000: + dev->master_cfg |= IC_CON_SPEED_STD; + break; + case 3400000: + dev->master_cfg |= IC_CON_SPEED_HIGH; + break; + default: + dev->master_cfg |= IC_CON_SPEED_FAST; + } +} + +static void i2c_phytium_configure_slave(struct phytium_i2c_dev *dev) +{ + dev->functionality = I2C_FUNC_SLAVE | IC_DEFAULT_FUNCTIONALITY; + + dev->slave_cfg = IC_CON_RX_FIFO_FULL_HLD_CTRL | + IC_CON_RESTART_EN | IC_CON_STOP_DET_IFADDRESSED; + + dev->mode = PHYTIUM_IC_SLAVE; +} + +static int phytium_i2c_plat_probe(struct platform_device *pdev) +{ + struct i2c_adapter *adap; + struct phytium_i2c_dev *dev; + struct i2c_timings *t; + u32 acpi_speed; + struct resource *mem; + int irq, ret, i; + static const int supported_speeds[] = { + 0, 100000, 400000, 1000000, 3400000 + }; + + + irq = platform_get_irq(pdev, 0); + if (irq < 0) + return irq; + + dev = devm_kzalloc(&pdev->dev, sizeof(struct phytium_i2c_dev), GFP_KERNEL); + if (!dev) + return -ENOMEM; + + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); + dev->base = devm_ioremap_resource(&pdev->dev, mem); + if (IS_ERR(dev->base)) + return PTR_ERR(dev->base); + + dev->dev = &pdev->dev; + dev->irq = irq; + platform_set_drvdata(pdev, dev); + + dev->rst = devm_reset_control_get_optional_exclusive(&pdev->dev, NULL); + if (IS_ERR(dev->rst)) { + if (PTR_ERR(dev->rst) == -EPROBE_DEFER) + return -EPROBE_DEFER; + } else { + reset_control_deassert(dev->rst); + } + + t = &dev->timings; + i2c_parse_fw_timings(&pdev->dev, t, false); + + acpi_speed = i2c_acpi_find_bus_speed(&pdev->dev); + /* + * Some DSTDs use a non standard speed, round down to the lowest + * standard speed. + */ + for (i = 1; i < ARRAY_SIZE(supported_speeds); i++) { + if (acpi_speed < supported_speeds[i]) + break; + } + acpi_speed = supported_speeds[i - 1]; + + /* + * Find bus speed from the "clock-frequency" device property, ACPI + * or by using fast mode if neither is set. + */ + if (acpi_speed && t->bus_freq_hz) + t->bus_freq_hz = min(t->bus_freq_hz, acpi_speed); + else if (acpi_speed || t->bus_freq_hz) + t->bus_freq_hz = max(t->bus_freq_hz, acpi_speed); + else + t->bus_freq_hz = 400000; + + if (has_acpi_companion(&pdev->dev)) + phytium_i2c_acpi_configure(pdev); + + /* + * Only standard mode at 100kHz, fast mode at 400kHz, + * fast mode plus at 1MHz and high speed mode at 3.4MHz are supported. + */ + if (t->bus_freq_hz != 100000 && t->bus_freq_hz != 400000 && + t->bus_freq_hz != 1000000 && t->bus_freq_hz != 3400000) { + dev_err(&pdev->dev, + "%d Hz is unsupported, only 100kHz, 400kHz, 1MHz and 3.4MHz are supported\n", + t->bus_freq_hz); + ret = -EINVAL; + goto exit_reset; + } + + if (i2c_detect_slave_mode(&pdev->dev)) + i2c_phytium_configure_slave(dev); + else + i2c_phytium_configure_master(dev); + + dev->clk = devm_clk_get(&pdev->dev, NULL); + if (!i2c_phytium_prepare_clk(dev, true)) { + u64 clk_khz; + + dev->get_clk_rate_khz = i2c_phytium_get_clk_rate_khz; + clk_khz = dev->get_clk_rate_khz(dev); + + if (!dev->sda_hold_time && t->sda_hold_ns) + dev->sda_hold_time = + div_u64(clk_khz * t->sda_hold_ns + 500000, 1000000); + } + + dev->tx_fifo_depth = 7; + dev->rx_fifo_depth = 7; + dev->adapter.nr = pdev->id; + + adap = &dev->adapter; + adap->owner = THIS_MODULE; + adap->class = I2C_CLASS_DEPRECATED; + ACPI_COMPANION_SET(&adap->dev, ACPI_COMPANION(&pdev->dev)); + adap->dev.of_node = pdev->dev.of_node; + + dev_pm_set_driver_flags(&pdev->dev, + DPM_FLAG_SMART_PREPARE | + DPM_FLAG_SMART_SUSPEND | + DPM_FLAG_MAY_SKIP_RESUME); + + /* The code below assumes runtime PM to be disabled. */ + WARN_ON(pm_runtime_enabled(&pdev->dev)); + + pm_runtime_set_autosuspend_delay(&pdev->dev, 1000); + pm_runtime_use_autosuspend(&pdev->dev); + pm_runtime_set_active(&pdev->dev); + + pm_runtime_enable(&pdev->dev); + + if (dev->mode == PHYTIUM_IC_SLAVE) + ret = i2c_phytium_probe_slave(dev); + else + ret = i2c_phytium_probe(dev); + + if (ret) + goto exit_probe; + + return ret; + +exit_probe: + pm_runtime_disable(dev->dev); +exit_reset: + if (!IS_ERR_OR_NULL(dev->rst)) + reset_control_assert(dev->rst); + return ret; +} + +static int phytium_i2c_plat_remove(struct platform_device *pdev) +{ + struct phytium_i2c_dev *dev = platform_get_drvdata(pdev); + + pm_runtime_get_sync(&pdev->dev); + + i2c_del_adapter(&dev->adapter); + + dev->disable(dev); + + pm_runtime_dont_use_autosuspend(&pdev->dev); + pm_runtime_put_sync(&pdev->dev); + pm_runtime_disable(dev->dev); + + if (!IS_ERR_OR_NULL(dev->rst)) + reset_control_assert(dev->rst); + + return 0; +} + +#ifdef CONFIG_OF +static const struct of_device_id phytium_i2c_of_match[] = { + { .compatible = "phytium,i2c", }, + {}, +}; +MODULE_DEVICE_TABLE(of, phytium_i2c_of_match); +#endif + +static int __maybe_unused phytium_i2c_plat_suspend(struct device *dev) +{ + struct phytium_i2c_dev *idev = dev_get_drvdata(dev); + + idev->disable(idev); + i2c_phytium_prepare_clk(idev, false); + + return 0; +} + +static int __maybe_unused phytium_i2c_plat_resume(struct device *dev) +{ + struct phytium_i2c_dev *idev = dev_get_drvdata(dev); + + i2c_phytium_prepare_clk(idev, true); + + idev->init(idev); + + return 0; +} + +static const struct dev_pm_ops phytium_i2c_dev_pm_ops = { + SET_LATE_SYSTEM_SLEEP_PM_OPS(phytium_i2c_plat_suspend, + phytium_i2c_plat_resume) + SET_RUNTIME_PM_OPS(phytium_i2c_plat_suspend, + phytium_i2c_plat_resume, NULL) +}; + +static struct platform_driver phytium_i2c_driver = { + .probe = phytium_i2c_plat_probe, + .remove = phytium_i2c_plat_remove, + .driver = { + .name = DRV_NAME, + .of_match_table = of_match_ptr(phytium_i2c_of_match), + .acpi_match_table = ACPI_PTR(phytium_i2c_acpi_match), + .pm = &phytium_i2c_dev_pm_ops, + }, +}; +module_platform_driver(phytium_i2c_driver); + +MODULE_ALIAS("platform:i2c-phytium"); +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium I2C bus adapter"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-slave.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-slave.c new file mode 100644 index 0000000000000000000000000000000000000000..2f0076561b642005215e6fe28161b9783ce8d73f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/i2c/busses/i2c-phytium-slave.c @@ -0,0 +1,265 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium I2C adapter driver (slave only). + * + * Derived from Synopysys I2C driver. + * Copyright (C) 2016 Synopsys Inc. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +#include "i2c-phytium-core.h" + +static void i2c_phytium_configure_fifo_slave(struct phytium_i2c_dev *dev) +{ + /* Configure Tx/Rx FIFO threshold levels. */ + phytium_writel(dev, 0, IC_TX_TL); + phytium_writel(dev, 0, IC_RX_TL); + + /* Configure the I2C slave. */ + phytium_writel(dev, dev->slave_cfg, IC_CON); + phytium_writel(dev, IC_INTR_SLAVE_MASK, IC_INTR_MASK); +} + +static int i2c_phytium_init_slave(struct phytium_i2c_dev *dev) +{ + /* Disable the adapter. */ + __i2c_phytium_disable(dev); + + /* Write SDA hold time if supported */ + if (dev->sda_hold_time) + phytium_writel(dev, dev->sda_hold_time, IC_SDA_HOLD); + + i2c_phytium_configure_fifo_slave(dev); + + return 0; +} + +static int i2c_phytium_reg_slave(struct i2c_client *slave) +{ + struct phytium_i2c_dev *dev = i2c_get_adapdata(slave->adapter); + + if (dev->slave) + return -EBUSY; + if (slave->flags & I2C_CLIENT_TEN) + return -EAFNOSUPPORT; + pm_runtime_get_sync(dev->dev); + + /* + * Set slave address in the IC_SAR register, + * the address to which the i2c responds. + */ + __i2c_phytium_disable_nowait(dev); + phytium_writel(dev, slave->addr, IC_SAR); + dev->slave = slave; + + __i2c_phytium_enable(dev); + + dev->cmd_err = 0; + dev->msg_write_idx = 0; + dev->msg_read_idx = 0; + dev->msg_err = 0; + dev->status = STATUS_IDLE; + dev->abort_source = 0; + dev->rx_outstanding = 0; + + return 0; +} + +static int i2c_phytium_unreg_slave(struct i2c_client *slave) +{ + struct phytium_i2c_dev *dev = i2c_get_adapdata(slave->adapter); + + dev->disable_int(dev); + dev->disable(dev); + dev->slave = NULL; + pm_runtime_put(dev->dev); + + return 0; +} + +static u32 i2c_phytium_read_clear_intrbits_slave(struct phytium_i2c_dev *dev) +{ + u32 stat; + + /* + * The IC_INTR_STAT register just indicates "enabled" interrupts. + * Ths unmasked raw version of interrupt status bits are available + * in the IC_RAW_INTR_STAT register. + * + * That is, + * stat = phytium_readl(IC_INTR_STAT); + * equals to, + * stat = phytium_readl(IC_RAW_INTR_STAT) & phytium_readl(IC_INTR_MASK); + * + * The raw version might be useful for debugging purposes. + */ + stat = phytium_readl(dev, IC_INTR_STAT); + + /* + * Do not use the IC_CLR_INTR register to clear interrupts, or + * you'll miss some interrupts, triggered during the period from + * phytium_readl(IC_INTR_STAT) to phytium_readl(IC_CLR_INTR). + * + * Instead, use the separately-prepared IC_CLR_* registers. + */ + if (stat & IC_INTR_TX_ABRT) + phytium_readl(dev, IC_CLR_TX_ABRT); + if (stat & IC_INTR_RX_UNDER) + phytium_readl(dev, IC_CLR_RX_UNDER); + if (stat & IC_INTR_RX_OVER) + phytium_readl(dev, IC_CLR_RX_OVER); + if (stat & IC_INTR_TX_OVER) + phytium_readl(dev, IC_CLR_TX_OVER); + if (stat & IC_INTR_RX_DONE) + phytium_readl(dev, IC_CLR_RX_DONE); + if (stat & IC_INTR_ACTIVITY) + phytium_readl(dev, IC_CLR_ACTIVITY); + if (stat & IC_INTR_STOP_DET) + phytium_readl(dev, IC_CLR_STOP_DET); + if (stat & IC_INTR_START_DET) + phytium_readl(dev, IC_CLR_START_DET); + if (stat & IC_INTR_GEN_CALL) + phytium_readl(dev, IC_CLR_GEN_CALL); + + return stat; +} + +/* + * Interrupt service routine. This gets called whenever an I2C slave interrupt + * occurs. + */ +static int i2c_phytium_irq_handler_slave(struct phytium_i2c_dev *dev) +{ + u32 raw_stat, stat, enabled; + u8 val, slave_activity; + + stat = phytium_readl(dev, IC_INTR_STAT); + enabled = phytium_readl(dev, IC_ENABLE); + raw_stat = phytium_readl(dev, IC_RAW_INTR_STAT); + slave_activity = ((phytium_readl(dev, IC_STATUS) & + IC_STATUS_SLAVE_ACTIVITY) >> 6); + + if (!enabled || !(raw_stat & ~IC_INTR_ACTIVITY) || !dev->slave) + return 0; + + dev_dbg(dev->dev, + "%#x STATUS SLAVE_ACTIVITY=%#x : RAW_INTR_STAT=%#x : INTR_STAT=%#x\n", + enabled, slave_activity, raw_stat, stat); + + if ((stat & IC_INTR_RX_FULL) && (stat & IC_INTR_STOP_DET)) + i2c_slave_event(dev->slave, I2C_SLAVE_WRITE_REQUESTED, &val); + + if (stat & IC_INTR_RD_REQ) { + if (slave_activity) { + if (stat & IC_INTR_RX_FULL) { + val = phytium_readl(dev, IC_DATA_CMD); + + if (!i2c_slave_event(dev->slave, + I2C_SLAVE_WRITE_RECEIVED, + &val)) { + dev_vdbg(dev->dev, "Byte %X acked!", + val); + } + phytium_readl(dev, IC_CLR_RD_REQ); + stat = i2c_phytium_read_clear_intrbits_slave(dev); + } else { + phytium_readl(dev, IC_CLR_RD_REQ); + phytium_readl(dev, IC_CLR_RX_UNDER); + stat = i2c_phytium_read_clear_intrbits_slave(dev); + } + if (!i2c_slave_event(dev->slave, + I2C_SLAVE_READ_REQUESTED, + &val)) + phytium_writel(dev, val, IC_DATA_CMD); + } + } + + if (stat & IC_INTR_RX_DONE) { + if (!i2c_slave_event(dev->slave, I2C_SLAVE_READ_PROCESSED, + &val)) + phytium_readl(dev, IC_CLR_RX_DONE); + + i2c_slave_event(dev->slave, I2C_SLAVE_STOP, &val); + stat = i2c_phytium_read_clear_intrbits_slave(dev); + return 1; + } + + if (stat & IC_INTR_RX_FULL) { + val = phytium_readl(dev, IC_DATA_CMD); + if (!i2c_slave_event(dev->slave, I2C_SLAVE_WRITE_RECEIVED, + &val)) + dev_vdbg(dev->dev, "Byte %X acked!", val); + } else { + i2c_slave_event(dev->slave, I2C_SLAVE_STOP, &val); + stat = i2c_phytium_read_clear_intrbits_slave(dev); + } + + return 1; +} + +static irqreturn_t i2c_phytium_isr_slave(int this_irq, void *dev_id) +{ + struct phytium_i2c_dev *dev = dev_id; + int ret; + + i2c_phytium_read_clear_intrbits_slave(dev); + ret = i2c_phytium_irq_handler_slave(dev); + if (ret > 0) + complete(&dev->cmd_complete); + + return IRQ_RETVAL(ret); +} + +static const struct i2c_algorithm i2c_phytium_algo = { + .functionality = i2c_phytium_func, + .reg_slave = i2c_phytium_reg_slave, + .unreg_slave = i2c_phytium_unreg_slave, +}; + +int i2c_phytium_probe_slave(struct phytium_i2c_dev *dev) +{ + struct i2c_adapter *adap = &dev->adapter; + int ret; + + init_completion(&dev->cmd_complete); + + dev->init = i2c_phytium_init_slave; + dev->disable = i2c_phytium_disable; + dev->disable_int = i2c_phytium_disable_int; + + ret = dev->init(dev); + if (ret) + return ret; + + snprintf(adap->name, sizeof(adap->name), + "Synopsys DesignWare I2C Slave adapter"); + adap->retries = 3; + adap->algo = &i2c_phytium_algo; + adap->dev.parent = dev->dev; + i2c_set_adapdata(adap, dev); + + ret = devm_request_irq(dev->dev, dev->irq, i2c_phytium_isr_slave, + IRQF_SHARED, dev_name(dev->dev), dev); + if (ret) { + dev_err(dev->dev, "failure requesting irq %i: %d\n", + dev->irq, ret); + return ret; + } + + ret = i2c_add_numbered_adapter(adap); + if (ret) + dev_err(dev->dev, "failure adding adapter: %d\n", ret); + + return ret; +} +EXPORT_SYMBOL_GPL(i2c_phytium_probe_slave); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/iio/adc/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/iio/adc/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..edd18f92d08407d3ed5fbdf288a7d07f870c43fb --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/iio/adc/Kconfig @@ -0,0 +1,13 @@ +config PHYTIUM_ADC + tristate "Phytium ADC driver" + depends on ARCH_PHYTIUM || COMPILE_TEST + select IIO_BUFFER + select IIO_TRIGGERED_BUFFER + help + Say yes here to build support for Phytium analog to digital + converters (ADC). + + To compile this driver as a module, choose M here: the module + will be called phytium-adc. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/iio/adc/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/iio/adc/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..5047e36da2d3eaa296bf63be0407dc71905a66ad --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/iio/adc/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_PHYTIUM_ADC) += phytium-adc.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/iio/adc/phytium-adc.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/iio/adc/phytium-adc.c new file mode 100644 index 0000000000000000000000000000000000000000..3d498e50966e5895566f2acbb357d86750110459 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/iio/adc/phytium-adc.c @@ -0,0 +1,688 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium ADC device driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include +#include +#include +#include + +/* ADC register */ +#define ADC_CTRL_REG 0x00 +#define ADC_CTRL_REG_PD_EN BIT(31) +#define ADC_CTRL_REG_CH_ONLY_S(x) ((x & 0x7) << 16) +#define ADC_CTRL_REG_CLK_DIV(x) ((x) << 12) +#define ADC_CTRL_REG_CHANNEL_EN(x) BIT((x) + 4) +#define ADC_CTRL_REG_CH_ONLY_EN BIT(3) +#define ADC_CTRL_REG_SINGLE_EN BIT(2) +#define ADC_CTRL_REG_SINGLE_SEL BIT(1) +#define ADC_CTRL_REG_SOC_EN BIT(0) +#define ADC_INTER_REG 0x04 +#define ADC_STATE_REG 0x08 +#define ADC_STATE_REG_B_STA(x) ((x) << 8) +#define ADC_STATE_REG_EOC_STA BIT(7) +#define ADC_STATE_REG_S_STA(x) ((x) << 4) +#define ADC_STATE_REG_SOC_STA BIT(3) +#define ADC_STATE_REG_ERR_STA BIT(2) +#define ADC_STATE_REG_COV_FINISH_STA BIT(1) +#define ADC_STATE_REG_ADCCTL_BUSY_STA BIT(0) +#define ADC_ERRCLR_REG 0x0c +#define ADC_LEVEL_REG(x) (0x10 + ((x) << 2)) +#define ADC_LEVEL_REG_HIGH_LEVEL(x) ((x) << 16) +#define ADC_LEVEL_REG_LOW_LEVEL(x) (x) +#define ADC_INTRMASK_REG 0x30 +#define ADC_INTRMASK_REG_ERR_INTR_MASK BIT(24) +#define ADC_INTRMASK_REG_ULIMIT_OFF(x) BIT(9 + ((x) << 1)) +#define ADC_INTRMASK_REG_DLIMIT_MASK(x) BIT(8 + ((x) << 1)) +#define ADC_INTRMASK_REG_COVFIN_MASK(x) BIT((x)) +#define ADC_INTR_REG 0x34 +#define ADC_INTR_REG_ERR BIT(24) +#define ADC_INTR_REG_ULIMIT(x) BIT(9 + ((x) << 1)) +#define ADC_INTR_REG_DLIMIT(x) BIT(8 + ((x) << 1)) +#define ADC_INTR_REG_LIMIT_MASK GENMASK(23, 8) +#define ADC_INTR_REG_COVFIN(x) BIT((x)) +#define ADC_INTR_REG_COVFIN_MASK GENMASK(7, 0) +#define ADC_COV_RESULT_REG(x) (0x38 + ((x) << 2)) +#define ADC_COV_RESULT_REG_MASK GENMASK(9, 0) +#define ADC_FINISH_CNT_REG(x) (0x58 + ((x) << 2)) +#define ADC_HIS_LIMIT_REG(x) (0x78 + ((x) << 2)) + +#define PHYTIUM_MAX_CHANNELS 8 +#define PHYTIUM_ADC_TIMEOUT usecs_to_jiffies(1000 * 1000) + +static const struct iio_event_spec phytium_adc_event[] = { + { + .type = IIO_EV_TYPE_THRESH, + .dir = IIO_EV_DIR_RISING, + .mask_separate = BIT(IIO_EV_INFO_VALUE), + }, { + .type = IIO_EV_TYPE_THRESH, + .dir = IIO_EV_DIR_FALLING, + .mask_separate = BIT(IIO_EV_INFO_VALUE), + }, +}; + +struct phytium_adc_data { + const struct iio_chan_spec *channels; + u8 num_channels; +}; + +struct phytium_adc { + struct device *dev; + void __iomem *regs; + struct clk *adc_clk; + + u32 interval; + u16 thresh_high[PHYTIUM_MAX_CHANNELS]; + u16 thresh_low[PHYTIUM_MAX_CHANNELS]; + u16 last_val[PHYTIUM_MAX_CHANNELS]; + const struct phytium_adc_data *data; + u16 *scan_data; + + struct completion completion; + struct mutex lock; +}; + +static ssize_t phytium_adc_show_conv_interval(struct iio_dev *indio_dev, + uintptr_t priv, + struct iio_chan_spec const *ch, + char *buf) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + + return sprintf(buf, "%u\n", adc->interval); +} + +static ssize_t phytium_adc_store_conv_interval(struct iio_dev *indio_dev, + uintptr_t priv, + struct iio_chan_spec const *ch, + const char *buf, size_t len) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + u32 interval; + int ret; + + ret = kstrtou32(buf, 0, &interval); + if (ret < 0) + return ret; + + mutex_lock(&adc->lock); + adc->interval = interval; + mutex_unlock(&adc->lock); + + return len; +} + +static const struct iio_chan_spec_ext_info phytium_adc_ext_info[] = { + { + .name = "conv_interval", + .read = phytium_adc_show_conv_interval, + .write = phytium_adc_store_conv_interval, + }, + { /* sentinel */ } +}; + +static int phytium_adc_parse_properties(struct platform_device *pdev, struct phytium_adc *adc) +{ + struct iio_chan_spec *chan_array; + struct fwnode_handle *fwnode; + struct phytium_adc_data *data; + unsigned int channel; + int num_channels; + int ret, i = 0; + + data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL); + if (!data) + return -ENOMEM; + + num_channels = device_get_child_node_count(&pdev->dev); + if (!num_channels) { + dev_err(&pdev->dev, "no channel children\n"); + return -ENODEV; + } + + if (num_channels > PHYTIUM_MAX_CHANNELS) { + dev_err(&pdev->dev, "num of channel children out of range\n"); + return -EINVAL; + } + + chan_array = devm_kcalloc(&pdev->dev, num_channels, sizeof(*chan_array), + GFP_KERNEL); + if (!chan_array) + return -ENOMEM; + + device_for_each_child_node(&pdev->dev, fwnode) { + ret = fwnode_property_read_u32(fwnode, "reg", &channel); + if (ret) + return ret; + + if (channel >= PHYTIUM_MAX_CHANNELS) + return -EINVAL; + + chan_array[i].type = IIO_VOLTAGE; + chan_array[i].indexed = 1; + chan_array[i].channel = channel; + chan_array[i].info_mask_separate = BIT(IIO_CHAN_INFO_RAW); + chan_array[i].event_spec = phytium_adc_event; + chan_array[i].num_event_specs = ARRAY_SIZE(phytium_adc_event); + chan_array[i].scan_index = channel; + chan_array[i].scan_type.sign = 'u'; + chan_array[i].scan_type.realbits = 10; + chan_array[i].scan_type.storagebits = 16; + chan_array[i].scan_type.endianness = IIO_LE; + chan_array[i].ext_info = phytium_adc_ext_info; + i++; + } + + data->num_channels = num_channels; + data->channels = chan_array; + adc->data = data; + + return 0; +} + +static void phytium_adc_start_stop(struct phytium_adc *adc, bool start) +{ + u32 ctrl; + + ctrl = readl(adc->regs + ADC_CTRL_REG); + if (start) + ctrl |= ADC_CTRL_REG_SOC_EN | ADC_CTRL_REG_SINGLE_EN; + else + ctrl &= ~ADC_CTRL_REG_SOC_EN; + /* Start conversion */ + writel(ctrl, adc->regs + ADC_CTRL_REG); +} + +static void phytium_adc_power_setup(struct phytium_adc *adc, bool on) +{ + u32 reg; + + reg = readl(adc->regs + ADC_CTRL_REG); + if (on) + reg &= ~ADC_CTRL_REG_PD_EN; + else + reg |= ADC_CTRL_REG_PD_EN; + writel(reg, adc->regs + ADC_CTRL_REG); +} + +static int phytium_adc_hw_init(struct phytium_adc *adc) +{ + int ret; + u32 reg; + + ret = clk_prepare_enable(adc->adc_clk); + if (ret) + return ret; + + /* + * Setup ctrl register: + * - Power up conversion module + * - Set the division by 4 as default + */ + reg = ADC_CTRL_REG_CLK_DIV(4); + writel(reg, adc->regs + ADC_CTRL_REG); + + /* Set all the interrupt mask, unmask them when necessary. */ + writel(0x1ffffff, adc->regs + ADC_INTRMASK_REG); + + /* Set default conversion interval */ + adc->interval = (clk_get_rate(adc->adc_clk) * 1000) / NSEC_PER_SEC; + + phytium_adc_power_setup(adc, true); + + return 0; +} + +static void phytium_adc_intrmask_setup(struct phytium_adc *adc, unsigned long chan_mask, bool on) +{ + u32 reg; + u16 limit_mask = 0; + int ch; + + for_each_set_bit(ch, &chan_mask, PHYTIUM_MAX_CHANNELS) + limit_mask |= BIT(ch << 1) | BIT((ch << 1) + 1); + + reg = readl(adc->regs + ADC_INTRMASK_REG); + if (on) + reg &= ~(ADC_INTRMASK_REG_ERR_INTR_MASK | + (limit_mask << 8) | chan_mask); + else + reg |= (ADC_INTRMASK_REG_ERR_INTR_MASK | + (limit_mask << 8) | chan_mask); + writel(reg, adc->regs + ADC_INTRMASK_REG); +} + +static void phytium_adc_single_conv_setup(struct phytium_adc *adc, u8 ch) +{ + u32 reg; + + /* + * Setup control register: + * - Single conversion mode selection + * - Single conversion enable + * - Fixed channel conversion + * - Target channel + */ + reg = readl(adc->regs + ADC_CTRL_REG); + + /* Clean ch_only_s bits */ + reg &= ~ADC_CTRL_REG_CH_ONLY_S(7); + + /* Clean channel_en bit */ + reg &= 0xFFF00F; + + reg |= ADC_CTRL_REG_SINGLE_SEL | ADC_CTRL_REG_SINGLE_EN | + ADC_CTRL_REG_CH_ONLY_EN | ADC_CTRL_REG_CH_ONLY_S(ch) | ADC_CTRL_REG_CHANNEL_EN(ch); + writel(reg, adc->regs + ADC_CTRL_REG); +} + +static int phytium_adc_single_conv(struct iio_dev *indio_dev, u8 ch) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + int ret; + + ret = iio_device_claim_direct_mode(indio_dev); + if (ret) + return ret; + mutex_lock(&adc->lock); + + phytium_adc_intrmask_setup(adc, BIT(ch), true); + reinit_completion(&adc->completion); + phytium_adc_single_conv_setup(adc, ch); + phytium_adc_start_stop(adc, true); + + if (!wait_for_completion_timeout(&adc->completion, PHYTIUM_ADC_TIMEOUT)) + ret = -ETIMEDOUT; + + phytium_adc_start_stop(adc, false); + phytium_adc_intrmask_setup(adc, BIT(ch), false); + + mutex_unlock(&adc->lock); + iio_device_release_direct_mode(indio_dev); + + return ret; +} + +static int phytium_adc_read_raw(struct iio_dev *indio_dev, + struct iio_chan_spec const *chan, + int *val, int *val2, long mask) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + int ret; + + switch (mask) { + case IIO_CHAN_INFO_RAW: + if (chan->type != IIO_VOLTAGE) + return -EINVAL; + + ret = phytium_adc_single_conv(indio_dev, chan->channel); + if (ret) + return ret; + *val = adc->last_val[chan->channel]; + + return IIO_VAL_INT; + default: + return -EINVAL; + } +} + +static int phytium_read_thresh(struct iio_dev *indio_dev, + const struct iio_chan_spec *chan, + enum iio_event_type type, + enum iio_event_direction dir, + enum iio_event_info iinfo, int *val, int *val2) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + + if (dir == IIO_EV_DIR_FALLING) + *val = adc->thresh_low[chan->channel]; + else + *val = adc->thresh_high[chan->channel]; + + return IIO_VAL_INT; +} + +static int phytium_write_thresh(struct iio_dev *indio_dev, + const struct iio_chan_spec *chan, + enum iio_event_type type, + enum iio_event_direction dir, + enum iio_event_info einfo, int val, int val2) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + u32 thresh; + + switch (dir) { + case IIO_EV_DIR_FALLING: + adc->thresh_low[chan->channel] = val; + thresh = readl(adc->regs + ADC_LEVEL_REG(chan->channel)) & 0x3ff0000; + thresh |= ADC_LEVEL_REG_LOW_LEVEL(val); + writel(thresh, adc->regs + ADC_LEVEL_REG(chan->channel)); + break; + case IIO_EV_DIR_RISING: + adc->thresh_high[chan->channel] = val; + thresh = readl(adc->regs + ADC_LEVEL_REG(chan->channel)) & 0xffff; + thresh |= ADC_LEVEL_REG_HIGH_LEVEL(val); + writel(thresh, adc->regs + ADC_LEVEL_REG(chan->channel)); + break; + default: + return -EINVAL; + } + + return 0; +} + +static int phytium_update_scan_mode(struct iio_dev *indio_dev, const unsigned long *mask) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + unsigned int n; + + n = bitmap_weight(mask, indio_dev->masklength); + + kfree(adc->scan_data); + adc->scan_data = kcalloc(n, sizeof(*adc->scan_data), GFP_KERNEL); + if (!adc->scan_data) + return -ENOMEM; + + return 0; +} + +static const u64 phytium_adc_event_codes[] = { + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 0, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 0, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 1, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 1, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 2, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 2, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 3, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 3, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 4, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 4, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 5, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 5, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 6, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 6, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 7, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_RISING), + IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, 7, + IIO_EV_TYPE_THRESH, IIO_EV_DIR_FALLING), +}; + +static irqreturn_t phytium_adc_threaded_irq(int irq, void *data) +{ + struct iio_dev *indio_dev = data; + struct phytium_adc *adc = iio_priv(indio_dev); + s64 timestamp = iio_get_time_ns(indio_dev); + unsigned long status; + int ch; + u32 intr; + + intr = readl(adc->regs + ADC_INTR_REG); + + if (intr & ADC_INTR_REG_ERR) { + dev_err(adc->dev, "conversion error: ADC_INTR_REG(0x%x)\n", intr); + writel(ADC_INTR_REG_ERR, adc->regs + ADC_INTR_REG); + return IRQ_HANDLED; + } + + status = (intr & ADC_INTR_REG_LIMIT_MASK) >> 8; + if (status) { + for_each_set_bit(ch, &status, PHYTIUM_MAX_CHANNELS * 2) + iio_push_event(indio_dev, phytium_adc_event_codes[ch], timestamp); + } + + status = intr & ADC_INTR_REG_COVFIN_MASK; + if (status) { + for_each_set_bit(ch, &status, PHYTIUM_MAX_CHANNELS) + adc->last_val[ch] = readl(adc->regs + ADC_COV_RESULT_REG(ch)) & + ADC_COV_RESULT_REG_MASK; + + if (iio_buffer_enabled(indio_dev)) + iio_trigger_poll(indio_dev->trig); + else + complete(&adc->completion); + } + + /* Clear all the interrupts */ + writel(status, adc->regs + ADC_INTR_REG); + + return IRQ_HANDLED; +} + +static void phytium_adc_cont_conv_setup(struct phytium_adc *adc, + unsigned long chan_mask, + u32 interval) +{ + u32 reg; + + /* + * Setup control register: + * - Continuous conversion mode + * - Multi-channel rotation mode + * - Channel enablement + */ + reg = readl(adc->regs + ADC_CTRL_REG); + reg &= ~(ADC_CTRL_REG_SINGLE_SEL | ADC_CTRL_REG_SINGLE_EN | + ADC_CTRL_REG_CH_ONLY_EN); + reg |= chan_mask << 4; + writel(reg, adc->regs + ADC_CTRL_REG); + + /* Setup interval between two conversions */ + writel(interval, adc->regs + ADC_INTER_REG); +} + +static int phytium_adc_preenable(struct iio_dev *indio_dev) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + unsigned long scan_mask = *indio_dev->active_scan_mask; + + phytium_adc_cont_conv_setup(adc, scan_mask & 0xff, adc->interval); + phytium_adc_intrmask_setup(adc, scan_mask & 0xff, true); + + return 0; +} + +static int phytium_adc_postenable(struct iio_dev *indio_dev) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + + phytium_adc_start_stop(adc, true); + + return 0; +} + +static int phytium_adc_postdisable(struct iio_dev *indio_dev) +{ + struct phytium_adc *adc = iio_priv(indio_dev); + unsigned long scan_mask = *indio_dev->active_scan_mask; + + phytium_adc_start_stop(adc, false); + phytium_adc_intrmask_setup(adc, scan_mask & 0xff, false); + + return 0; +} + +static const struct iio_buffer_setup_ops phytium_buffer_setup_ops = { + .preenable = &phytium_adc_preenable, + .postenable = &phytium_adc_postenable, + .postdisable = &phytium_adc_postdisable, +}; + +static irqreturn_t phytium_adc_trigger_handler(int irq, void *p) +{ + struct iio_poll_func *pf = p; + struct iio_dev *indio_dev = pf->indio_dev; + struct phytium_adc *adc = iio_priv(indio_dev); + int i, j = 0; + + if (!adc->scan_data) + goto out; + + for_each_set_bit(i, indio_dev->active_scan_mask, indio_dev->masklength) + adc->scan_data[j++] = adc->last_val[i]; + + iio_push_to_buffers(indio_dev, adc->scan_data); + +out: + iio_trigger_notify_done(indio_dev->trig); + + return IRQ_HANDLED; +} + +static const struct iio_info phytium_adc_iio_info = { + .read_raw = &phytium_adc_read_raw, + .read_event_value = &phytium_read_thresh, + .write_event_value = &phytium_write_thresh, + .update_scan_mode = &phytium_update_scan_mode, +}; + +static int phytium_adc_probe(struct platform_device *pdev) +{ + struct phytium_adc *adc; + struct iio_dev *indio_dev; + struct device *dev = &pdev->dev; + struct resource *res; + int ret; + + indio_dev = devm_iio_device_alloc(dev, sizeof(*adc)); + if (!indio_dev) + return -ENOMEM; + + adc = iio_priv(indio_dev); + adc->dev = dev; + + ret = phytium_adc_parse_properties(pdev, adc); + if (ret) + return ret; + + mutex_init(&adc->lock); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + adc->regs = devm_ioremap_resource(dev, res); + if (IS_ERR(adc->regs)) + return PTR_ERR(adc->regs); + + adc->adc_clk = devm_clk_get(dev, NULL); + if (IS_ERR(adc->adc_clk)) + return PTR_ERR(adc->adc_clk); + + init_completion(&adc->completion); + + indio_dev->name = dev_name(dev); + indio_dev->info = &phytium_adc_iio_info; + indio_dev->modes = INDIO_DIRECT_MODE; + indio_dev->channels = adc->data->channels; + indio_dev->num_channels = adc->data->num_channels; + + platform_set_drvdata(pdev, indio_dev); + + ret = devm_request_threaded_irq(adc->dev, platform_get_irq(pdev, 0), + NULL, phytium_adc_threaded_irq, IRQF_ONESHOT, + dev_name(dev), indio_dev); + if (ret) + return ret; + + ret = devm_iio_triggered_buffer_setup(dev, indio_dev, + &iio_pollfunc_store_time, + phytium_adc_trigger_handler, + &phytium_buffer_setup_ops); + if (ret) + return ret; + + ret = phytium_adc_hw_init(adc); + if (ret) { + dev_err(&pdev->dev, "failed to initialize Phytium ADC, %d\n", ret); + return ret; + } + + return iio_device_register(indio_dev); +} + +static int phytium_adc_remove(struct platform_device *pdev) +{ + struct iio_dev *indio_dev = platform_get_drvdata(pdev); + struct phytium_adc *adc = iio_priv(indio_dev); + + phytium_adc_power_setup(adc, false); + iio_device_unregister(indio_dev); + kfree(adc->scan_data); + + return 0; +} + +static const struct of_device_id phytium_of_match[] = { + { .compatible = "phytium,adc", }, + { /* sentinel */ } +}; +MODULE_DEVICE_TABLE(of, phytium_of_match); + +#ifdef CONFIG_PM +static int phytium_adc_suspend(struct device *dev) +{ + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct phytium_adc *adc = iio_priv(indio_dev); + + phytium_adc_power_setup(adc, false); + clk_disable_unprepare(adc->adc_clk); + + return 0; +} + +static int phytium_adc_resume(struct device *dev) +{ + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct phytium_adc *adc = iio_priv(indio_dev); + + clk_prepare_enable(adc->adc_clk); + phytium_adc_power_setup(adc, true); + + return 0; +} +#endif + +SIMPLE_DEV_PM_OPS(phytium_adc_pm_ops, phytium_adc_suspend, phytium_adc_resume); + +static struct platform_driver phytium_adc_driver = { + .driver = { + .name = "phytium_adc", + .of_match_table = phytium_of_match, + .pm = &phytium_adc_pm_ops, + }, + .probe = phytium_adc_probe, + .remove = phytium_adc_remove, +}; +module_platform_driver(phytium_adc_driver); + +MODULE_AUTHOR("Yang Liu "); +MODULE_DESCRIPTION("Phytium ADC driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/input/keyboard/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/keyboard/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..6851cd0f226487df68b4aa04ada7c38cd87f17f2 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/keyboard/Kconfig @@ -0,0 +1,12 @@ +config KEYBOARD_PHYTIUM + tristate "Phytium keypad support" + depends on ARCH_PHYTIUM + select INPUT_MATRIXKMAP + help + Say Y here if you want to enable support for Phytium keypad + port. + + To compile this driver as a module, choose M here: the + module will be called phytium_keypad. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/input/keyboard/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/keyboard/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..bae46ed876c265a29de845a7ec94d78f8ba74281 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/keyboard/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_KEYBOARD_PHYTIUM) += phytium-keypad.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/input/keyboard/phytium-keypad.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/keyboard/phytium-keypad.c new file mode 100644 index 0000000000000000000000000000000000000000..8237c0051e9e12680e471a0d04ff1a325afad4c0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/keyboard/phytium-keypad.c @@ -0,0 +1,583 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for the Phytium keypad port. + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +/* + * Keypad Controller registers + */ +#define KPCR 0x00 /* Keypad Control Register */ + +#define KPSR 0x04 /* Keypad Status Register */ +#define KBD_STAT_KPKD (0x1 << 0) /* Key Press Interrupt Status bit (w1c) */ +#define KBD_STAT_KPKR (0x1 << 1) /* Key Release Interrupt Status bit (w1c) */ +#define KBD_STAT_KDSC (0x1 << 2) /* Key Depress Synch Chain Status bit (w1c)*/ +#define KBD_STAT_KRSS (0x1 << 3) /* Key Release Synch Status bit (w1c)*/ +#define KBD_STAT_KDIE (0x1 << 8) /* Key Depress Interrupt Enable Status bit */ +#define KBD_STAT_KRIE (0x1 << 9) /* Key Release Interrupt Enable */ + +#define KDDR 0x08 /* Keypad Data Direction Register */ +#define KPDR 0x0C /* Keypad Data Register */ + +#define MAX_MATRIX_KEY_ROWS 8 +#define MAX_MATRIX_KEY_COLS 8 + +#define MAX_MATRIX_KEY_NUM (MAX_MATRIX_KEY_ROWS * MAX_MATRIX_KEY_COLS) + +struct phytium_keypad { + struct input_dev *input_dev; + void __iomem *mmio_base; + + int irq; + struct timer_list check_matrix_timer; + + /* + * The matrix is stable only if no changes are detected after + * PHYTIUM_KEYPAD_SCANS_FOR_STABILITY scans + */ +#define PHYTIUM_KEYPAD_SCANS_FOR_STABILITY 3 + + int stable_count; + + bool enabled; + + unsigned int n_rows; + unsigned int n_cols; + int row_shift; + + /* Masks for enabled rows/cols */ + unsigned short rows_en_mask; + unsigned short cols_en_mask; + + unsigned short keycodes[MAX_MATRIX_KEY_NUM]; + + /* + * Matrix states: + * -stable: achieved after a complete debounce process. + * -unstable: used in the debouncing process. + */ + unsigned short matrix_stable_state[MAX_MATRIX_KEY_COLS]; + unsigned short matrix_unstable_state[MAX_MATRIX_KEY_COLS]; +}; + +static u32 phytium_read(struct phytium_keypad *keypad, int reg) +{ + return readl(keypad->mmio_base + reg); +} + +static void phytium_write(struct phytium_keypad *keypad, u32 value, int reg) +{ + writel(value, keypad->mmio_base + reg); +} + +/* Scan the matrix and return the new state in *matrix_volatile_state. */ +static void phytium_keypad_scan_matrix(struct phytium_keypad *keypad, + unsigned short *matrix_volatile_state) +{ + int col; + u32 reg_val; + + for (col = 0; col < keypad->n_cols; col++) { + if ((keypad->cols_en_mask & (1 << col)) == 0) + continue; + /* + * Discharge keypad capacitance: + * 2. write 0s on KDDR[KCD], configure columns as input. + */ + reg_val = phytium_read(keypad, KDDR); + reg_val = 0x00000000; + phytium_write(keypad, reg_val, KDDR); + + /* + * 3. Write a single column to 0, others to 1. + * 4. Sample row inputs and save data. + * 5. Repeat steps 3 - 4 for remaining columns. + */ + reg_val = 0; + reg_val |= (1 << (16 + col)); + phytium_write(keypad, reg_val, KDDR); + reg_val = phytium_read(keypad, KPDR); + reg_val = 0x00000000; + phytium_write(keypad, reg_val, KPDR); + + /* + * Delay added to avoid propagating the 0 from column to row + * when scanning. + */ + udelay(5); + + /* + * 1s in matrix_volatile_state[col] means key pressures + * throw data from non enabled rows. + */ + reg_val = phytium_read(keypad, KPDR); + matrix_volatile_state[col] = (~reg_val) & keypad->rows_en_mask; + } + + /* + * Return in standby mode: + * 6. write 0s to columns + */ + /* Configure columns as output, output 0 */ + reg_val = 0; + reg_val |= (keypad->cols_en_mask & 0xffff) << 16; + phytium_write(keypad, reg_val, KDDR); + phytium_write(keypad, 0x00000000, KPDR); +} + +/* + * Compare the new matrix state (volatile) with the stable one stored in + * keypad->matrix_stable_state and fire events if changes are detected. + */ +static void phytium_keypad_fire_events(struct phytium_keypad *keypad, + unsigned short *matrix_volatile_state) +{ + struct input_dev *input_dev = keypad->input_dev; + int row, col; + + for (col = 0; col < keypad->n_cols; col++) { + unsigned short bits_changed; + int code; + + if ((keypad->cols_en_mask & (1 << col)) == 0) + continue; /* Column is not enabled */ + + bits_changed = keypad->matrix_stable_state[col] ^ + matrix_volatile_state[col]; + + if (bits_changed == 0) + continue; /* Column does not contain changes */ + + for (row = 0; row < keypad->n_rows; row++) { + if ((keypad->rows_en_mask & (1 << row)) == 0) + continue; /* Row is not enabled */ + if ((bits_changed & (1 << row)) == 0) + continue; /* Row does not contain changes */ + + code = MATRIX_SCAN_CODE(row, col, keypad->row_shift); + input_event(input_dev, EV_MSC, MSC_SCAN, code); + input_report_key(input_dev, keypad->keycodes[code], + matrix_volatile_state[col] & (1 << row)); + dev_dbg(&input_dev->dev, "Event code: %d, val: %d", + keypad->keycodes[code], + matrix_volatile_state[col] & (1 << row)); + } + } + input_sync(input_dev); +} + +/* + * phytium_keypad_check_for_events is the timer handler. + */ +static void phytium_keypad_check_for_events(struct timer_list *t) +{ + struct phytium_keypad *keypad = from_timer(keypad, t, check_matrix_timer); + unsigned short matrix_volatile_state[MAX_MATRIX_KEY_COLS]; + u32 reg_val; + bool state_changed, is_zero_matrix; + int i; + + memset(matrix_volatile_state, 0, sizeof(matrix_volatile_state)); + + phytium_keypad_scan_matrix(keypad, matrix_volatile_state); + + state_changed = false; + for (i = 0; i < keypad->n_cols; i++) { + if ((keypad->cols_en_mask & (1 << i)) == 0) + continue; + + if (keypad->matrix_unstable_state[i] ^ matrix_volatile_state[i]) { + state_changed = true; + break; + } + } + + /* + * If the matrix state is changed from the previous scan + * (Re)Begin the debouncing process, saving the new state in + * keypad->matrix_unstable_state. + * else + * Increase the count of number of scans with a stable state. + */ + if (state_changed) { + memcpy(keypad->matrix_unstable_state, matrix_volatile_state, + sizeof(matrix_volatile_state)); + keypad->stable_count = 0; + } else { + keypad->stable_count++; + } + + /* + * If the matrix is not as stable as we want reschedule scan + * in the near future. + */ + if (keypad->stable_count < PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) { + mod_timer(&keypad->check_matrix_timer, + jiffies + msecs_to_jiffies(10)); + return; + } + + /* + * If the matrix state is stable, fire the events and save the new + * stable state. Note, if the matrix is kept stable for longer + * (keypad->stable_count > PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) all + * events have already been generated. + */ + if (keypad->stable_count == PHYTIUM_KEYPAD_SCANS_FOR_STABILITY) { + phytium_keypad_fire_events(keypad, matrix_volatile_state); + memcpy(keypad->matrix_stable_state, matrix_volatile_state, + sizeof(matrix_volatile_state)); + } + + is_zero_matrix = true; + for (i = 0; i < keypad->n_cols; i++) { + if (matrix_volatile_state[i] != 0) { + is_zero_matrix = false; + break; + } + } + + if (is_zero_matrix) { + /* + * All keys have been released. Enable only the KDI + * interrupt for future key presses (clear the KDI + * status bit and its sync chain before that). + */ + reg_val = phytium_read(keypad, KPSR); + reg_val |= KBD_STAT_KPKD | KBD_STAT_KDSC; + phytium_write(keypad, reg_val, KPSR); + + reg_val = phytium_read(keypad, KPSR); + reg_val |= KBD_STAT_KDIE; + reg_val &= ~KBD_STAT_KRIE; + phytium_write(keypad, reg_val, KPSR); + } else { + /* + * Some keys are still pressed. Schedule a rescan in + * attempt to detect multiple key presses and enable + * the KRI interrupt to react quickly to key release + * event. + */ + mod_timer(&keypad->check_matrix_timer, + jiffies + msecs_to_jiffies(60)); + + reg_val = phytium_read(keypad, KPSR); + reg_val |= KBD_STAT_KPKR | KBD_STAT_KRSS; + phytium_write(keypad, reg_val, KPSR); + + reg_val = phytium_read(keypad, KPSR); + reg_val |= KBD_STAT_KRIE; + reg_val &= ~KBD_STAT_KDIE; + phytium_write(keypad, reg_val, KPSR); + } +} + +static irqreturn_t phytium_keypad_irq_handler(int irq, void *dev_id) +{ + struct phytium_keypad *keypad = dev_id; + u32 reg_val; + + reg_val = phytium_read(keypad, KPSR); + /* Disable both interrupt types */ + reg_val &= ~(KBD_STAT_KRIE | KBD_STAT_KDIE); + /* Clear interrupts status bits */ + reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD; + phytium_write(keypad, reg_val, KPSR); + + if (keypad->enabled) { + /* The matrix is supposed to be changed */ + keypad->stable_count = 0; + + /* Schedule the scanning procedure near in the future */ + mod_timer(&keypad->check_matrix_timer, + jiffies + msecs_to_jiffies(2)); + } + + return IRQ_HANDLED; +} + +static void phytium_keypad_config(struct phytium_keypad *keypad) +{ + u32 reg_val; + + /* + * Include enabled rows in interrupt generation (KPCR[15:0]) + * Configure keypad columns as open-drain (KPCR[31:16]) + */ + reg_val = phytium_read(keypad, KPCR); + reg_val |= keypad->rows_en_mask & 0xffff; /* rows */ + reg_val |= (keypad->cols_en_mask & 0xffff) << 16; /* cols */ + phytium_write(keypad, reg_val, KPCR); + + /* Configure columns as output, output 0 */ + reg_val = 0; + reg_val |= (keypad->cols_en_mask & 0xffff) << 16; + phytium_write(keypad, reg_val, KDDR); + phytium_write(keypad, 0x00000000, KPDR); + + /* + * Clear Key Depress and Key Release status bit. + * Clear both synchronizer chain. + */ + reg_val = phytium_read(keypad, KPSR); + reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD | + KBD_STAT_KDSC | KBD_STAT_KRSS; + phytium_write(keypad, reg_val, KPSR); + + /* Enable KDI and disable KRI (avoid false release events). */ + reg_val |= KBD_STAT_KDIE; + reg_val &= ~KBD_STAT_KRIE; + phytium_write(keypad, reg_val, KPSR); +} + +static void phytium_keypad_inhibit(struct phytium_keypad *keypad) +{ + unsigned short reg_val; + + /* Inhibit KDI and KRI interrupts. */ + reg_val = phytium_read(keypad, KPSR); + reg_val &= ~(KBD_STAT_KRIE | KBD_STAT_KDIE); + reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD; + phytium_write(keypad, reg_val, KPSR); +} + +static void phytium_keypad_close(struct input_dev *dev) +{ + struct phytium_keypad *keypad = input_get_drvdata(dev); + + /* Mark keypad as being inactive */ + keypad->enabled = false; + synchronize_irq(keypad->irq); + del_timer_sync(&keypad->check_matrix_timer); + + phytium_keypad_inhibit(keypad); +} + +static int phytium_keypad_open(struct input_dev *dev) +{ + struct phytium_keypad *keypad = input_get_drvdata(dev); + + /* We became active from now */ + keypad->enabled = true; + + phytium_keypad_config(keypad); + + /* Sanity control, not all the rows must be activated now. */ + if ((phytium_read(keypad, KPDR) & keypad->rows_en_mask) == 0) { + dev_err(&dev->dev, + "too many keys pressed, control pins initialisation\n"); + goto open_err; + } + + return 0; + +open_err: + phytium_keypad_close(dev); + return -EIO; +} + +#ifdef CONFIG_OF +static const struct of_device_id phytium_keypad_of_match[] = { + { .compatible = "phytium,keypad", }, + { /* sentinel */ } +}; +MODULE_DEVICE_TABLE(of, phytium_keypad_of_match); +#endif + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_keypad_acpi_match[] = { + { "PHYT0028", 0}, + {} +}; +MODULE_DEVICE_TABLE(acpi, phytium_keypad_acpi_match); +#endif + +static int phytium_keypad_probe(struct platform_device *pdev) +{ + const struct matrix_keymap_data *keymap_data = dev_get_platdata(&pdev->dev); + struct phytium_keypad *keypad; + struct input_dev *input_dev; + struct resource *res; + int irq, error, i, row, col; + + if (!keymap_data && !pdev->dev.of_node && !has_acpi_companion(&pdev->dev)) { + dev_err(&pdev->dev, "no keymap defined\n"); + return -EINVAL; + } + + irq = platform_get_irq(pdev, 0); + if (irq < 0) { + dev_err(&pdev->dev, "no irq defined in platform data\n"); + return irq; + } + + input_dev = devm_input_allocate_device(&pdev->dev); + if (!input_dev) { + dev_err(&pdev->dev, "failed to allocate the input device\n"); + return -ENOMEM; + } + + keypad = devm_kzalloc(&pdev->dev, sizeof(*keypad), GFP_KERNEL); + if (!keypad) + return -ENOMEM; + + keypad->input_dev = input_dev; + keypad->irq = irq; + keypad->stable_count = 0; + + timer_setup(&keypad->check_matrix_timer, + phytium_keypad_check_for_events, 0); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + keypad->mmio_base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(keypad->mmio_base)) + return PTR_ERR(keypad->mmio_base); + + /* Init the Input device */ + input_dev->name = pdev->name; + input_dev->id.bustype = BUS_HOST; + input_dev->dev.parent = &pdev->dev; + input_dev->open = phytium_keypad_open; + input_dev->close = phytium_keypad_close; + + error = matrix_keypad_parse_properties(&pdev->dev, &keypad->n_rows, &keypad->n_cols); + if (error) { + dev_err(&pdev->dev, "failed to parse phytium kp params\n"); + return error; + } + + error = matrix_keypad_build_keymap(keymap_data, NULL, + keypad->n_rows, + keypad->n_cols, + keypad->keycodes, input_dev); + if (error) { + dev_err(&pdev->dev, "failed to build keymap\n"); + return error; + } + + keypad->row_shift = get_count_order(keypad->n_cols); + + /* Search for rows and cols enabled */ + for (row = 0; row < keypad->n_rows; row++) { + for (col = 0; col < keypad->n_cols; col++) { + i = MATRIX_SCAN_CODE(row, col, keypad->row_shift); + if (keypad->keycodes[i] != KEY_RESERVED) { + keypad->rows_en_mask |= 1 << row; + keypad->cols_en_mask |= 1 << col; + } + } + } + + __set_bit(EV_REP, input_dev->evbit); + input_set_capability(input_dev, EV_MSC, MSC_SCAN); + input_set_drvdata(input_dev, keypad); + + phytium_keypad_inhibit(keypad); + + error = devm_request_irq(&pdev->dev, irq, phytium_keypad_irq_handler, 0, + pdev->name, keypad); + if (error) { + dev_err(&pdev->dev, "failed to request IRQ\n"); + return error; + } + + /* Register the input device */ + error = input_register_device(input_dev); + if (error) { + dev_err(&pdev->dev, "failed to register input device\n"); + return error; + } + + platform_set_drvdata(pdev, keypad); + device_init_wakeup(&pdev->dev, 1); + + return 0; +} + +static int phytium_keypad_remove(struct platform_device *pdev) +{ + struct phytium_keypad *keypad = platform_get_drvdata(pdev); + + input_unregister_device(keypad->input_dev); + devm_kfree(&pdev->dev, keypad); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_keypad_suspend(struct device *dev) +{ + struct platform_device *pdev = to_platform_device(dev); + struct phytium_keypad *keypad = platform_get_drvdata(pdev); + struct input_dev *input_dev = keypad->input_dev; + + mutex_lock(&input_dev->mutex); + + if (input_dev->users) + phytium_keypad_inhibit(keypad); + + mutex_unlock(&input_dev->mutex); + + if (device_may_wakeup(&pdev->dev)) + enable_irq_wake(keypad->irq); + + return 0; +} + +static int phytium_keypad_resume(struct device *dev) +{ + struct platform_device *pdev = to_platform_device(dev); + struct phytium_keypad *keypad = platform_get_drvdata(pdev); + struct input_dev *input_dev = keypad->input_dev; + int ret = 0; + + if (device_may_wakeup(&pdev->dev)) + disable_irq_wake(keypad->irq); + + mutex_lock(&input_dev->mutex); + + if (input_dev->users) + phytium_keypad_config(keypad); + + mutex_unlock(&input_dev->mutex); + + return ret; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_keypad_pm_ops, phytium_keypad_suspend, phytium_keypad_resume); + +static struct platform_driver phytium_keypad_driver = { + .driver = { + .name = "phytium-keypad", + .pm = &phytium_keypad_pm_ops, + .of_match_table = of_match_ptr(phytium_keypad_of_match), + .acpi_match_table = ACPI_PTR(phytium_keypad_acpi_match), + }, + .probe = phytium_keypad_probe, + .remove = phytium_keypad_remove, +}; +module_platform_driver(phytium_keypad_driver); + +MODULE_AUTHOR("Song Wenting "); +MODULE_DESCRIPTION("PHYTIUM Keypad Port Driver"); +MODULE_LICENSE("GPL"); +MODULE_ALIAS("platform:phytium-keypad"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/input/serio/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/serio/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..25c414a10541c8cd3cb56f50d453936046b64b1f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/serio/Kconfig @@ -0,0 +1,13 @@ +config SERIO_PHYTIUM_PS2 + depends on SERIO + tristate "PHYTIUM PS/2 (keyboard and mouse)" + default y if ARCH_PHYTIUM + depends on PCI + help + This selects support for the PS/2 Host Controller on + Phytium SoCs. + + To compile this driver as a module, choose M here: the + module will be called phytium-ps2. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/input/serio/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/serio/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..09ab3c8f5df431cadc513f387c7376213cb1be97 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/serio/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_SERIO_PHYTIUM_PS2) += phytium-ps2.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/input/serio/phytium-ps2.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/serio/phytium-ps2.c new file mode 100644 index 0000000000000000000000000000000000000000..902dd7a04f0bd602c201bb338c840a018fa6501b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/input/serio/phytium-ps2.c @@ -0,0 +1,186 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Phytium PS/2 keyboard controller driver. + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +#define DRV_NAME "phytium_ps2_pci" + +#define REG_STAT 0x0 +#define REG_STAT_TX_TIMEOUT 0x1 +#define REG_STAT_RX_TIMEOUT 0x2 +#define REG_STAT_TX_FULL 0x4 +#define REG_CTRL 0x4 +#define REG_CTRL_RESET 0x1 +#define REG_CTRL_TX_TIMEOUT 0x2 +#define REG_CTRL_RX_TIMEOUT 0x4 +#define REG_CTRL_RX_INTR 0x8 +#define REG_INTR 0x8 +#define REG_INTR_TIMEOUT 0x1 +#define REG_INTR_RX 0x2 +#define REG_TX 0xc +#define REG_RX 0x10 +#define REG_TIMER_VAL 0x14 + +#define REG_CTRL_ENABLE (REG_CTRL_TX_TIMEOUT|REG_CTRL_RX_TIMEOUT|REG_CTRL_RX_INTR) +#define REG_DATA_PARITY 0x100 + +#define STAT_RX_COUNTER(stat) ((stat >> 8) & 0x1f) + +struct phytium_ps2_data { + void __iomem *base; + struct serio *io; + struct pci_dev *dev; +}; + +static irqreturn_t phytium_ps2_irq(int irq, void *devid) +{ + struct phytium_ps2_data *ps2if = devid; + u32 status, scancode, val = 0; + unsigned int flag; + int i, rxcount; + + status = readl(ps2if->base + REG_STAT); + if (!status) + return IRQ_NONE; + + /* Check if there is timeout interrupt */ + if (status & (REG_STAT_RX_TIMEOUT|REG_STAT_TX_TIMEOUT)) + val |= REG_INTR_TIMEOUT; + + rxcount = STAT_RX_COUNTER(status); + for (i = 0; i < rxcount; i++) { + scancode = readl(ps2if->base + REG_RX) & 0x1ff; + + if (rxcount <= 16 && scancode != 0x1ff) { + flag = ((scancode & REG_DATA_PARITY) ? SERIO_PARITY : 0); + serio_interrupt(ps2if->io, scancode & 0xff, flag); + } + } + + val |= REG_INTR_RX; + writel(val, ps2if->base + REG_INTR); + + return IRQ_HANDLED; +} + +int phytium_ps2_write(struct serio *serio, unsigned char val) +{ + struct phytium_ps2_data *ps2if = serio->port_data; + unsigned int stat; + + do { + stat = readl(ps2if->base + REG_STAT); + cpu_relax(); + } while (stat & REG_STAT_TX_FULL); + + writel(val, ps2if->base + REG_TX); + + return 0; +} + +int phytium_ps2_open(struct serio *io) +{ + struct phytium_ps2_data *ps2if = io->port_data; + + writel(REG_CTRL_RESET, ps2if->base + REG_CTRL); + /* Wait 4ms for the controller to be reset */ + usleep_range(4000, 6000); + writel(REG_CTRL_ENABLE, ps2if->base + REG_CTRL); + + return 0; +} + +void phytium_ps2_close(struct serio *io) +{ + struct phytium_ps2_data *ps2if = io->port_data; + + writel(0, ps2if->base + REG_CTRL); +} + +static int phytium_pci_ps2_probe(struct pci_dev *pdev, const struct pci_device_id *id) +{ + struct phytium_ps2_data *ps2if; + struct serio *serio; + int ret; + + ret = pcim_enable_device(pdev); + if (ret) + goto out; + + ret = pcim_iomap_regions(pdev, 0x1, DRV_NAME); + if (ret) + goto out; + + ps2if = devm_kzalloc(&pdev->dev, sizeof(struct phytium_ps2_data), GFP_KERNEL); + serio = kzalloc(sizeof(struct serio), GFP_KERNEL); + if (!ps2if || !serio) { + ret = -ENOMEM; + goto free; + } + + serio->id.type = SERIO_8042; + serio->write = phytium_ps2_write; + serio->open = phytium_ps2_open; + serio->close = phytium_ps2_close; + strscpy(serio->name, pci_name(pdev), sizeof(serio->name)); + strscpy(serio->phys, dev_name(&pdev->dev), sizeof(serio->phys)); + serio->port_data = ps2if; + serio->dev.parent = &pdev->dev; + ps2if->io = serio; + ps2if->dev = pdev; + ps2if->base = pcim_iomap_table(pdev)[0]; + + ret = devm_request_irq(&pdev->dev, pdev->irq, phytium_ps2_irq, + IRQF_SHARED, DRV_NAME, ps2if); + if (ret) { + dev_err(&pdev->dev, "could not request IRQ %d\n", pdev->irq); + goto free; + } + + pci_set_drvdata(pdev, ps2if); + serio_register_port(ps2if->io); + + return 0; + +free: + kfree(serio); +out: + return ret; +} + +static void phytium_pci_ps2_remove(struct pci_dev *pdev) +{ + struct phytium_ps2_data *ps2if = pci_get_drvdata(pdev); + + serio_unregister_port(ps2if->io); + pcim_iounmap_regions(pdev, 0x1); +} + +static const struct pci_device_id phytium_pci_ps2_ids[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc34) }, + {}, +}; +MODULE_DEVICE_TABLE(pci, phytium_pci_ps2_ids); + +static struct pci_driver phytium_pci_ps2_driver = { + .name = DRV_NAME, + .id_table = phytium_pci_ps2_ids, + .probe = phytium_pci_ps2_probe, + .remove = phytium_pci_ps2_remove, +}; +module_pci_driver(phytium_pci_ps2_driver); + +MODULE_AUTHOR("Cheng Quan "); +MODULE_DESCRIPTION("Phytium PCI PS/2 controller driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..42d0bc50511372433cd0ef0a8a599a49f043669f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/Kconfig @@ -0,0 +1,13 @@ +config ARM_GIC_PHYTIUM_2500 + bool + select IRQ_DOMAIN_HIERARCHY + select PARTITION_PERCPU + select GENERIC_IRQ_EFFECTIVE_AFF_MASK + +config PHYTIUM_IXIC + bool "Phytium SoC PCI Legacy Interrupt Controller" + depends on ARCH_PHYTIUM + select IRQ_DOMAIN + select IRQ_DOMAIN_HIERARCHY + help + This enables support PCI Legacy Interrupt on Phytium SoC. \ No newline at end of file diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..0f79bc14a9e1201dc0b6b4bd4a49a1c9b66b3a12 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/Makefile @@ -0,0 +1,2 @@ +obj-$(CONFIG_ARM_GIC_PHYTIUM_2500) += irq-gic-phytium-2500.o irq-gic-phytium-2500-its.o +obj-$(CONFIG_PHYTIUM_IXIC) += irq-phytium-ixic.o \ No newline at end of file diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/irq-gic-phytium-2500-its.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/irq-gic-phytium-2500-its.c new file mode 100644 index 0000000000000000000000000000000000000000..d41edb9b9f0072370e1a78a2856aa21f44145ea4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/irq-gic-phytium-2500-its.c @@ -0,0 +1,5694 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#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 "irq-gic-common.h" + +#define ITS_FLAGS_CMDQ_NEEDS_FLUSHING (1ULL << 0) +#define ITS_FLAGS_WORKAROUND_CAVIUM_22375 (1ULL << 1) +#define ITS_FLAGS_WORKAROUND_CAVIUM_23144 (1ULL << 2) + +#define RDIST_FLAGS_PROPBASE_NEEDS_FLUSHING (1 << 0) +#define RDIST_FLAGS_RD_TABLES_PREALLOCATED (1 << 1) + +#define RD_LOCAL_LPI_ENABLED BIT(0) +#define RD_LOCAL_PENDTABLE_PREALLOCATED BIT(1) +#define RD_LOCAL_MEMRESERVE_DONE BIT(2) + +static u32 lpi_id_bits; + +/* + * We allocate memory for PROPBASE to cover 2 ^ lpi_id_bits LPIs to + * deal with (one configuration byte per interrupt). PENDBASE has to + * be 64kB aligned (one bit per LPI, plus 8192 bits for SPI/PPI/SGI). + */ +#define LPI_NRBITS lpi_id_bits +#define LPI_PROPBASE_SZ ALIGN(BIT(LPI_NRBITS), SZ_64K) +#define LPI_PENDBASE_SZ ALIGN(BIT(LPI_NRBITS) / 8, SZ_64K) + +#define LPI_PROP_DEFAULT_PRIO GICD_INT_DEF_PRI + +/* + * Collection structure - just an ID, and a redistributor address to + * ping. We use one per CPU as a bag of interrupts assigned to this + * CPU. + */ +struct its_collection { + u64 target_address; + u16 col_id; +}; + +/* + * The ITS_BASER structure - contains memory information, cached + * value of BASER register configuration and ITS page size. + */ +struct its_baser { + void *base; + u64 val; + u32 order; + u32 psz; +}; + +struct its_device; + +/* + * The ITS structure - contains most of the infrastructure, with the + * top-level MSI domain, the command queue, the collections, and the + * list of devices writing to it. + * + * dev_alloc_lock has to be taken for device allocations, while the + * spinlock must be taken to parse data structures such as the device + * list. + */ +struct its_node { + raw_spinlock_t lock; + struct mutex dev_alloc_lock; + struct list_head entry; + void __iomem *base; + void __iomem *sgir_base; + phys_addr_t phys_base; + struct its_cmd_block *cmd_base; + struct its_cmd_block *cmd_write; + struct its_baser tables[GITS_BASER_NR_REGS]; + struct its_collection *collections; + struct fwnode_handle *fwnode_handle; + u64 (*get_msi_base)(struct its_device *its_dev); + u64 typer; + u64 cbaser_save; + u32 ctlr_save; + u32 mpidr; + struct list_head its_device_list; + u64 flags; + unsigned long list_nr; + int numa_node; + unsigned int msi_domain_flags; + u32 pre_its_base; /* for Socionext Synquacer */ + int vlpi_redist_offset; +}; + +#define is_v4(its) (!!((its)->typer & GITS_TYPER_VLPIS)) +#define is_v4_1(its) (!!((its)->typer & GITS_TYPER_VMAPP)) +#define device_ids(its) (FIELD_GET(GITS_TYPER_DEVBITS, (its)->typer) + 1) + +#define ITS_ITT_ALIGN SZ_256 + +/* The maximum number of VPEID bits supported by VLPI commands */ +#define ITS_MAX_VPEID_BITS \ + ({ \ + int nvpeid = 16; \ + if (gic_rdists->has_rvpeid && \ + gic_rdists->gicd_typer2 & GICD_TYPER2_VIL) \ + nvpeid = 1 + (gic_rdists->gicd_typer2 & \ + GICD_TYPER2_VID); \ + \ + nvpeid; \ + }) +#define ITS_MAX_VPEID (1 << (ITS_MAX_VPEID_BITS)) + +/* Convert page order to size in bytes */ +#define PAGE_ORDER_TO_SIZE(o) (PAGE_SIZE << (o)) + +struct event_lpi_map { + unsigned long *lpi_map; + u16 *col_map; + irq_hw_number_t lpi_base; + int nr_lpis; + raw_spinlock_t vlpi_lock; + struct its_vm *vm; + struct its_vlpi_map *vlpi_maps; + int nr_vlpis; +}; + +/* + * The ITS view of a device - belongs to an ITS, owns an interrupt + * translation table, and a list of interrupts. If it some of its + * LPIs are injected into a guest (GICv4), the event_map.vm field + * indicates which one. + */ +struct its_device { + struct list_head entry; + struct its_node *its; + struct event_lpi_map event_map; + void *itt; + u32 nr_ites; + u32 device_id; + bool shared; +}; + +static struct { + raw_spinlock_t lock; + struct its_device *dev; + struct its_vpe **vpes; + int next_victim; +} vpe_proxy; + +struct cpu_lpi_count { + atomic_t managed; + atomic_t unmanaged; +}; + +static DEFINE_PER_CPU(struct cpu_lpi_count, cpu_lpi_count); + +static LIST_HEAD(its_nodes); +static DEFINE_RAW_SPINLOCK(its_lock); +static struct rdists *gic_rdists; +static struct irq_domain *its_parent; + +static unsigned long its_list_map; +static u16 vmovp_seq_num; +static DEFINE_RAW_SPINLOCK(vmovp_lock); + +static DEFINE_IDA(its_vpeid_ida); + +#define gic_data_rdist() (raw_cpu_ptr(gic_rdists->rdist)) +#define gic_data_rdist_cpu(cpu) (per_cpu_ptr(gic_rdists->rdist, cpu)) +#define gic_data_rdist_rd_base() (gic_data_rdist()->rd_base) +#define gic_data_rdist_vlpi_base() (gic_data_rdist_rd_base() + SZ_128K) + +/* + * Skip ITSs that have no vLPIs mapped, unless we're on GICv4.1, as we + * always have vSGIs mapped. + */ +static bool require_its_list_vmovp(struct its_vm *vm, struct its_node *its) +{ + return (gic_rdists->has_rvpeid || vm->vlpi_count[its->list_nr]); +} + +static u16 get_its_list(struct its_vm *vm) +{ + struct its_node *its; + unsigned long its_list = 0; + + list_for_each_entry(its, &its_nodes, entry) { + if (!is_v4(its)) + continue; + + if (require_its_list_vmovp(vm, its)) + __set_bit(its->list_nr, &its_list); + } + + return (u16)its_list; +} + +static inline u32 its_get_event_id(struct irq_data *d) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + + return d->hwirq - its_dev->event_map.lpi_base; +} + +static struct its_collection *dev_event_to_col(struct its_device *its_dev, + u32 event) +{ + struct its_node *its = its_dev->its; + + return its->collections + its_dev->event_map.col_map[event]; +} + +static struct its_vlpi_map *dev_event_to_vlpi_map(struct its_device *its_dev, + u32 event) +{ + if (WARN_ON_ONCE(event >= its_dev->event_map.nr_lpis)) + return NULL; + + return &its_dev->event_map.vlpi_maps[event]; +} + +static struct its_vlpi_map *get_vlpi_map(struct irq_data *d) +{ + if (irqd_is_forwarded_to_vcpu(d)) { + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + u32 event = its_get_event_id(d); + + return dev_event_to_vlpi_map(its_dev, event); + } + + return NULL; +} + +static int vpe_to_cpuid_lock(struct its_vpe *vpe, unsigned long *flags) +{ + raw_spin_lock_irqsave(&vpe->vpe_lock, *flags); + return vpe->col_idx; +} + +static void vpe_to_cpuid_unlock(struct its_vpe *vpe, unsigned long flags) +{ + raw_spin_unlock_irqrestore(&vpe->vpe_lock, flags); +} + +static int irq_to_cpuid_lock(struct irq_data *d, unsigned long *flags) +{ + struct its_vlpi_map *map = get_vlpi_map(d); + int cpu; + + if (map) { + cpu = vpe_to_cpuid_lock(map->vpe, flags); + } else { + /* Physical LPIs are already locked via the irq_desc lock */ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + + cpu = its_dev->event_map.col_map[its_get_event_id(d)]; + /* Keep GCC quiet... */ + *flags = 0; + } + + return cpu; +} + +static void irq_to_cpuid_unlock(struct irq_data *d, unsigned long flags) +{ + struct its_vlpi_map *map = get_vlpi_map(d); + + if (map) + vpe_to_cpuid_unlock(map->vpe, flags); +} + +static struct its_collection *valid_col(struct its_collection *col) +{ + if (WARN_ON_ONCE(col->target_address & GENMASK_ULL(15, 0))) + return NULL; + + return col; +} + +static struct its_vpe *valid_vpe(struct its_node *its, struct its_vpe *vpe) +{ + if (valid_col(its->collections + vpe->col_idx)) + return vpe; + + return NULL; +} + +/* + * ITS command descriptors - parameters to be encoded in a command + * block. + */ +struct its_cmd_desc { + union { + struct { + struct its_device *dev; + u32 event_id; + } its_inv_cmd; + + struct { + struct its_device *dev; + u32 event_id; + } its_clear_cmd; + + struct { + struct its_device *dev; + u32 event_id; + } its_int_cmd; + + struct { + struct its_device *dev; + int valid; + } its_mapd_cmd; + + struct { + struct its_collection *col; + int valid; + } its_mapc_cmd; + + struct { + struct its_device *dev; + u32 phys_id; + u32 event_id; + } its_mapti_cmd; + + struct { + struct its_device *dev; + struct its_collection *col; + u32 event_id; + } its_movi_cmd; + + struct { + struct its_device *dev; + u32 event_id; + } its_discard_cmd; + + struct { + struct its_collection *col; + } its_invall_cmd; + + struct { + struct its_vpe *vpe; + } its_vinvall_cmd; + + struct { + struct its_vpe *vpe; + struct its_collection *col; + bool valid; + } its_vmapp_cmd; + + struct { + struct its_vpe *vpe; + struct its_device *dev; + u32 virt_id; + u32 event_id; + bool db_enabled; + } its_vmapti_cmd; + + struct { + struct its_vpe *vpe; + struct its_device *dev; + u32 event_id; + bool db_enabled; + } its_vmovi_cmd; + + struct { + struct its_vpe *vpe; + struct its_collection *col; + u16 seq_num; + u16 its_list; + } its_vmovp_cmd; + + struct { + struct its_vpe *vpe; + } its_invdb_cmd; + + struct { + struct its_vpe *vpe; + u8 sgi; + u8 priority; + bool enable; + bool group; + bool clear; + } its_vsgi_cmd; + }; +}; + +/* + * The ITS command block, which is what the ITS actually parses. + */ +struct its_cmd_block { + union { + u64 raw_cmd[4]; + __le64 raw_cmd_le[4]; + }; +}; + +#define ITS_CMD_QUEUE_SZ SZ_64K +#define ITS_CMD_QUEUE_NR_ENTRIES (ITS_CMD_QUEUE_SZ / sizeof(struct its_cmd_block)) + +typedef struct its_collection *(*its_cmd_builder_t)(struct its_node *, + struct its_cmd_block *, + struct its_cmd_desc *); + +typedef struct its_vpe *(*its_cmd_vbuilder_t)(struct its_node *, + struct its_cmd_block *, + struct its_cmd_desc *); + +static void its_mask_encode(u64 *raw_cmd, u64 val, int h, int l) +{ + u64 mask = GENMASK_ULL(h, l); + *raw_cmd &= ~mask; + *raw_cmd |= (val << l) & mask; +} + +static void its_encode_cmd(struct its_cmd_block *cmd, u8 cmd_nr) +{ + its_mask_encode(&cmd->raw_cmd[0], cmd_nr, 7, 0); +} + +static void its_encode_devid(struct its_cmd_block *cmd, u32 devid) +{ + its_mask_encode(&cmd->raw_cmd[0], devid, 63, 32); +} + +static void its_encode_event_id(struct its_cmd_block *cmd, u32 id) +{ + its_mask_encode(&cmd->raw_cmd[1], id, 31, 0); +} + +static void its_encode_phys_id(struct its_cmd_block *cmd, u32 phys_id) +{ + its_mask_encode(&cmd->raw_cmd[1], phys_id, 63, 32); +} + +static void its_encode_size(struct its_cmd_block *cmd, u8 size) +{ + its_mask_encode(&cmd->raw_cmd[1], size, 4, 0); +} + +static void its_encode_itt(struct its_cmd_block *cmd, u64 itt_addr) +{ + its_mask_encode(&cmd->raw_cmd[2], itt_addr >> 8, 51, 8); +} + +static void its_encode_valid(struct its_cmd_block *cmd, int valid) +{ + its_mask_encode(&cmd->raw_cmd[2], !!valid, 63, 63); +} + +static void its_encode_target(struct its_cmd_block *cmd, u64 target_addr) +{ + its_mask_encode(&cmd->raw_cmd[2], target_addr >> 16, 51, 16); +} + +static void its_encode_collection(struct its_cmd_block *cmd, u16 col) +{ + its_mask_encode(&cmd->raw_cmd[2], col, 15, 0); +} + +static void its_encode_vpeid(struct its_cmd_block *cmd, u16 vpeid) +{ + its_mask_encode(&cmd->raw_cmd[1], vpeid, 47, 32); +} + +static void its_encode_virt_id(struct its_cmd_block *cmd, u32 virt_id) +{ + its_mask_encode(&cmd->raw_cmd[2], virt_id, 31, 0); +} + +static void its_encode_db_phys_id(struct its_cmd_block *cmd, u32 db_phys_id) +{ + its_mask_encode(&cmd->raw_cmd[2], db_phys_id, 63, 32); +} + +static void its_encode_db_valid(struct its_cmd_block *cmd, bool db_valid) +{ + its_mask_encode(&cmd->raw_cmd[2], db_valid, 0, 0); +} + +static void its_encode_seq_num(struct its_cmd_block *cmd, u16 seq_num) +{ + its_mask_encode(&cmd->raw_cmd[0], seq_num, 47, 32); +} + +static void its_encode_its_list(struct its_cmd_block *cmd, u16 its_list) +{ + its_mask_encode(&cmd->raw_cmd[1], its_list, 15, 0); +} + +static void its_encode_vpt_addr(struct its_cmd_block *cmd, u64 vpt_pa) +{ + its_mask_encode(&cmd->raw_cmd[3], vpt_pa >> 16, 51, 16); +} + +static void its_encode_vpt_size(struct its_cmd_block *cmd, u8 vpt_size) +{ + its_mask_encode(&cmd->raw_cmd[3], vpt_size, 4, 0); +} + +static void its_encode_vconf_addr(struct its_cmd_block *cmd, u64 vconf_pa) +{ + its_mask_encode(&cmd->raw_cmd[0], vconf_pa >> 16, 51, 16); +} + +static void its_encode_alloc(struct its_cmd_block *cmd, bool alloc) +{ + its_mask_encode(&cmd->raw_cmd[0], alloc, 8, 8); +} + +static void its_encode_ptz(struct its_cmd_block *cmd, bool ptz) +{ + its_mask_encode(&cmd->raw_cmd[0], ptz, 9, 9); +} + +static void its_encode_vmapp_default_db(struct its_cmd_block *cmd, + u32 vpe_db_lpi) +{ + its_mask_encode(&cmd->raw_cmd[1], vpe_db_lpi, 31, 0); +} + +static void its_encode_vmovp_default_db(struct its_cmd_block *cmd, + u32 vpe_db_lpi) +{ + its_mask_encode(&cmd->raw_cmd[3], vpe_db_lpi, 31, 0); +} + +static void its_encode_db(struct its_cmd_block *cmd, bool db) +{ + its_mask_encode(&cmd->raw_cmd[2], db, 63, 63); +} + +static void its_encode_sgi_intid(struct its_cmd_block *cmd, u8 sgi) +{ + its_mask_encode(&cmd->raw_cmd[0], sgi, 35, 32); +} + +static void its_encode_sgi_priority(struct its_cmd_block *cmd, u8 prio) +{ + its_mask_encode(&cmd->raw_cmd[0], prio >> 4, 23, 20); +} + +static void its_encode_sgi_group(struct its_cmd_block *cmd, bool grp) +{ + its_mask_encode(&cmd->raw_cmd[0], grp, 10, 10); +} + +static void its_encode_sgi_clear(struct its_cmd_block *cmd, bool clr) +{ + its_mask_encode(&cmd->raw_cmd[0], clr, 9, 9); +} + +static void its_encode_sgi_enable(struct its_cmd_block *cmd, bool en) +{ + its_mask_encode(&cmd->raw_cmd[0], en, 8, 8); +} + +static inline void its_fixup_cmd(struct its_cmd_block *cmd) +{ + /* Let's fixup BE commands */ + cmd->raw_cmd_le[0] = cpu_to_le64(cmd->raw_cmd[0]); + cmd->raw_cmd_le[1] = cpu_to_le64(cmd->raw_cmd[1]); + cmd->raw_cmd_le[2] = cpu_to_le64(cmd->raw_cmd[2]); + cmd->raw_cmd_le[3] = cpu_to_le64(cmd->raw_cmd[3]); +} + +static struct its_collection *its_build_mapd_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + unsigned long itt_addr; + u8 size = ilog2(desc->its_mapd_cmd.dev->nr_ites); + + itt_addr = virt_to_phys(desc->its_mapd_cmd.dev->itt); + itt_addr = ALIGN(itt_addr, ITS_ITT_ALIGN); + + its_encode_cmd(cmd, GITS_CMD_MAPD); + its_encode_devid(cmd, desc->its_mapd_cmd.dev->device_id); + its_encode_size(cmd, size - 1); + its_encode_itt(cmd, itt_addr); + its_encode_valid(cmd, desc->its_mapd_cmd.valid); + + its_fixup_cmd(cmd); + + return NULL; +} + +static struct its_collection *its_build_mapc_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + its_encode_cmd(cmd, GITS_CMD_MAPC); + its_encode_collection(cmd, desc->its_mapc_cmd.col->col_id); + its_encode_target(cmd, desc->its_mapc_cmd.col->target_address); + its_encode_valid(cmd, desc->its_mapc_cmd.valid); + + its_fixup_cmd(cmd); + + return desc->its_mapc_cmd.col; +} + +static struct its_collection *its_build_mapti_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + struct its_collection *col; + + col = dev_event_to_col(desc->its_mapti_cmd.dev, + desc->its_mapti_cmd.event_id); + if (is_kdump_kernel()) + col->col_id = col->col_id % 65; + else + col->col_id = col->col_id % 64; + + its_encode_cmd(cmd, GITS_CMD_MAPTI); + its_encode_devid(cmd, desc->its_mapti_cmd.dev->device_id); + its_encode_event_id(cmd, desc->its_mapti_cmd.event_id); + its_encode_phys_id(cmd, desc->its_mapti_cmd.phys_id); + its_encode_collection(cmd, col->col_id); + + its_fixup_cmd(cmd); + + return valid_col(col); +} + +static struct its_collection *its_build_movi_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + struct its_collection *col; + + col = dev_event_to_col(desc->its_movi_cmd.dev, + desc->its_movi_cmd.event_id); + + its_encode_cmd(cmd, GITS_CMD_MOVI); + its_encode_devid(cmd, desc->its_movi_cmd.dev->device_id); + its_encode_event_id(cmd, desc->its_movi_cmd.event_id); + its_encode_collection(cmd, desc->its_movi_cmd.col->col_id); + + its_fixup_cmd(cmd); + + return valid_col(col); +} + +static struct its_collection *its_build_discard_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + struct its_collection *col; + + col = dev_event_to_col(desc->its_discard_cmd.dev, + desc->its_discard_cmd.event_id); + + its_encode_cmd(cmd, GITS_CMD_DISCARD); + its_encode_devid(cmd, desc->its_discard_cmd.dev->device_id); + its_encode_event_id(cmd, desc->its_discard_cmd.event_id); + + its_fixup_cmd(cmd); + + return valid_col(col); +} + +static struct its_collection *its_build_inv_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + struct its_collection *col; + + col = dev_event_to_col(desc->its_inv_cmd.dev, + desc->its_inv_cmd.event_id); + + its_encode_cmd(cmd, GITS_CMD_INV); + its_encode_devid(cmd, desc->its_inv_cmd.dev->device_id); + its_encode_event_id(cmd, desc->its_inv_cmd.event_id); + + its_fixup_cmd(cmd); + + return valid_col(col); +} + +static struct its_collection *its_build_int_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + struct its_collection *col; + + col = dev_event_to_col(desc->its_int_cmd.dev, + desc->its_int_cmd.event_id); + + its_encode_cmd(cmd, GITS_CMD_INT); + its_encode_devid(cmd, desc->its_int_cmd.dev->device_id); + its_encode_event_id(cmd, desc->its_int_cmd.event_id); + + its_fixup_cmd(cmd); + + return valid_col(col); +} + +static struct its_collection *its_build_clear_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + struct its_collection *col; + + col = dev_event_to_col(desc->its_clear_cmd.dev, + desc->its_clear_cmd.event_id); + + its_encode_cmd(cmd, GITS_CMD_CLEAR); + its_encode_devid(cmd, desc->its_clear_cmd.dev->device_id); + its_encode_event_id(cmd, desc->its_clear_cmd.event_id); + + its_fixup_cmd(cmd); + + return valid_col(col); +} + +static struct its_collection *its_build_invall_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + its_encode_cmd(cmd, GITS_CMD_INVALL); + its_encode_collection(cmd, desc->its_invall_cmd.col->col_id); + + its_fixup_cmd(cmd); + + return desc->its_invall_cmd.col; +} + +static struct its_vpe *its_build_vinvall_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + its_encode_cmd(cmd, GITS_CMD_VINVALL); + its_encode_vpeid(cmd, desc->its_vinvall_cmd.vpe->vpe_id); + + its_fixup_cmd(cmd); + + return valid_vpe(its, desc->its_vinvall_cmd.vpe); +} + +static struct its_vpe *its_build_vmapp_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + unsigned long vpt_addr, vconf_addr; + u64 target; + bool alloc; + + its_encode_cmd(cmd, GITS_CMD_VMAPP); + its_encode_vpeid(cmd, desc->its_vmapp_cmd.vpe->vpe_id); + its_encode_valid(cmd, desc->its_vmapp_cmd.valid); + + if (!desc->its_vmapp_cmd.valid) { + if (is_v4_1(its)) { + alloc = !atomic_dec_return(&desc->its_vmapp_cmd.vpe->vmapp_count); + its_encode_alloc(cmd, alloc); + } + + goto out; + } + + vpt_addr = virt_to_phys(page_address(desc->its_vmapp_cmd.vpe->vpt_page)); + target = desc->its_vmapp_cmd.col->target_address + its->vlpi_redist_offset; + + its_encode_target(cmd, target); + its_encode_vpt_addr(cmd, vpt_addr); + its_encode_vpt_size(cmd, LPI_NRBITS - 1); + + if (!is_v4_1(its)) + goto out; + + vconf_addr = virt_to_phys(page_address(desc->its_vmapp_cmd.vpe->its_vm->vprop_page)); + + alloc = !atomic_fetch_inc(&desc->its_vmapp_cmd.vpe->vmapp_count); + + its_encode_alloc(cmd, alloc); + + /* + * GICv4.1 provides a way to get the VLPI state, which needs the vPE + * to be unmapped first, and in this case, we may remap the vPE + * back while the VPT is not empty. So we can't assume that the + * VPT is empty on map. This is why we never advertise PTZ. + */ + its_encode_ptz(cmd, false); + its_encode_vconf_addr(cmd, vconf_addr); + its_encode_vmapp_default_db(cmd, desc->its_vmapp_cmd.vpe->vpe_db_lpi); + +out: + its_fixup_cmd(cmd); + + return valid_vpe(its, desc->its_vmapp_cmd.vpe); +} + +static struct its_vpe *its_build_vmapti_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + u32 db; + + if (!is_v4_1(its) && desc->its_vmapti_cmd.db_enabled) + db = desc->its_vmapti_cmd.vpe->vpe_db_lpi; + else + db = 1023; + + its_encode_cmd(cmd, GITS_CMD_VMAPTI); + its_encode_devid(cmd, desc->its_vmapti_cmd.dev->device_id); + its_encode_vpeid(cmd, desc->its_vmapti_cmd.vpe->vpe_id); + its_encode_event_id(cmd, desc->its_vmapti_cmd.event_id); + its_encode_db_phys_id(cmd, db); + its_encode_virt_id(cmd, desc->its_vmapti_cmd.virt_id); + + its_fixup_cmd(cmd); + + return valid_vpe(its, desc->its_vmapti_cmd.vpe); +} + +static struct its_vpe *its_build_vmovi_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + u32 db; + + if (!is_v4_1(its) && desc->its_vmovi_cmd.db_enabled) + db = desc->its_vmovi_cmd.vpe->vpe_db_lpi; + else + db = 1023; + + its_encode_cmd(cmd, GITS_CMD_VMOVI); + its_encode_devid(cmd, desc->its_vmovi_cmd.dev->device_id); + its_encode_vpeid(cmd, desc->its_vmovi_cmd.vpe->vpe_id); + its_encode_event_id(cmd, desc->its_vmovi_cmd.event_id); + its_encode_db_phys_id(cmd, db); + its_encode_db_valid(cmd, true); + + its_fixup_cmd(cmd); + + return valid_vpe(its, desc->its_vmovi_cmd.vpe); +} + +static struct its_vpe *its_build_vmovp_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + u64 target; + + target = desc->its_vmovp_cmd.col->target_address + its->vlpi_redist_offset; + its_encode_cmd(cmd, GITS_CMD_VMOVP); + its_encode_seq_num(cmd, desc->its_vmovp_cmd.seq_num); + its_encode_its_list(cmd, desc->its_vmovp_cmd.its_list); + its_encode_vpeid(cmd, desc->its_vmovp_cmd.vpe->vpe_id); + its_encode_target(cmd, target); + + if (is_v4_1(its)) { + its_encode_db(cmd, true); + its_encode_vmovp_default_db(cmd, desc->its_vmovp_cmd.vpe->vpe_db_lpi); + } + + its_fixup_cmd(cmd); + + return valid_vpe(its, desc->its_vmovp_cmd.vpe); +} + +static struct its_vpe *its_build_vinv_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + struct its_vlpi_map *map; + + map = dev_event_to_vlpi_map(desc->its_inv_cmd.dev, + desc->its_inv_cmd.event_id); + + its_encode_cmd(cmd, GITS_CMD_INV); + its_encode_devid(cmd, desc->its_inv_cmd.dev->device_id); + its_encode_event_id(cmd, desc->its_inv_cmd.event_id); + + its_fixup_cmd(cmd); + + return valid_vpe(its, map->vpe); +} + +static struct its_vpe *its_build_vint_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + struct its_vlpi_map *map; + + map = dev_event_to_vlpi_map(desc->its_int_cmd.dev, + desc->its_int_cmd.event_id); + + its_encode_cmd(cmd, GITS_CMD_INT); + its_encode_devid(cmd, desc->its_int_cmd.dev->device_id); + its_encode_event_id(cmd, desc->its_int_cmd.event_id); + + its_fixup_cmd(cmd); + + return valid_vpe(its, map->vpe); +} + +static struct its_vpe *its_build_vclear_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + struct its_vlpi_map *map; + + map = dev_event_to_vlpi_map(desc->its_clear_cmd.dev, + desc->its_clear_cmd.event_id); + + its_encode_cmd(cmd, GITS_CMD_CLEAR); + its_encode_devid(cmd, desc->its_clear_cmd.dev->device_id); + its_encode_event_id(cmd, desc->its_clear_cmd.event_id); + + its_fixup_cmd(cmd); + + return valid_vpe(its, map->vpe); +} + +static struct its_vpe *its_build_invdb_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + if (WARN_ON(!is_v4_1(its))) + return NULL; + + its_encode_cmd(cmd, GITS_CMD_INVDB); + its_encode_vpeid(cmd, desc->its_invdb_cmd.vpe->vpe_id); + + its_fixup_cmd(cmd); + + return valid_vpe(its, desc->its_invdb_cmd.vpe); +} + +static struct its_vpe *its_build_vsgi_cmd(struct its_node *its, + struct its_cmd_block *cmd, + struct its_cmd_desc *desc) +{ + if (WARN_ON(!is_v4_1(its))) + return NULL; + + its_encode_cmd(cmd, GITS_CMD_VSGI); + its_encode_vpeid(cmd, desc->its_vsgi_cmd.vpe->vpe_id); + its_encode_sgi_intid(cmd, desc->its_vsgi_cmd.sgi); + its_encode_sgi_priority(cmd, desc->its_vsgi_cmd.priority); + its_encode_sgi_group(cmd, desc->its_vsgi_cmd.group); + its_encode_sgi_clear(cmd, desc->its_vsgi_cmd.clear); + its_encode_sgi_enable(cmd, desc->its_vsgi_cmd.enable); + + its_fixup_cmd(cmd); + + return valid_vpe(its, desc->its_vsgi_cmd.vpe); +} + +static u64 its_cmd_ptr_to_offset(struct its_node *its, + struct its_cmd_block *ptr) +{ + return (ptr - its->cmd_base) * sizeof(*ptr); +} + +static int its_queue_full(struct its_node *its) +{ + int widx; + int ridx; + + widx = its->cmd_write - its->cmd_base; + ridx = readl_relaxed(its->base + GITS_CREADR) / sizeof(struct its_cmd_block); + + /* This is incredibly unlikely to happen, unless the ITS locks up. */ + if (((widx + 1) % ITS_CMD_QUEUE_NR_ENTRIES) == ridx) + return 1; + + return 0; +} + +static struct its_cmd_block *its_allocate_entry(struct its_node *its) +{ + struct its_cmd_block *cmd; + u32 count = 1000000; /* 1s! */ + + while (its_queue_full(its)) { + count--; + if (!count) { + pr_err_ratelimited("ITS queue not draining\n"); + return NULL; + } + cpu_relax(); + udelay(1); + } + + cmd = its->cmd_write++; + + /* Handle queue wrapping */ + if (its->cmd_write == (its->cmd_base + ITS_CMD_QUEUE_NR_ENTRIES)) + its->cmd_write = its->cmd_base; + + /* Clear command */ + cmd->raw_cmd[0] = 0; + cmd->raw_cmd[1] = 0; + cmd->raw_cmd[2] = 0; + cmd->raw_cmd[3] = 0; + + return cmd; +} + +static struct its_cmd_block *its_post_commands(struct its_node *its) +{ + u64 wr = its_cmd_ptr_to_offset(its, its->cmd_write); + + writel_relaxed(wr, its->base + GITS_CWRITER); + + return its->cmd_write; +} + +static void its_flush_cmd(struct its_node *its, struct its_cmd_block *cmd) +{ + /* + * Make sure the commands written to memory are observable by + * the ITS. + */ + if (its->flags & ITS_FLAGS_CMDQ_NEEDS_FLUSHING) + gic_flush_dcache_to_poc(cmd, sizeof(*cmd)); + else + dsb(ishst); +} + +static int its_wait_for_range_completion(struct its_node *its, + u64 prev_idx, + struct its_cmd_block *to) +{ + u64 rd_idx, to_idx, linear_idx; + u32 count = 1000000; /* 1s! */ + + /* Linearize to_idx if the command set has wrapped around */ + to_idx = its_cmd_ptr_to_offset(its, to); + if (to_idx < prev_idx) + to_idx += ITS_CMD_QUEUE_SZ; + + linear_idx = prev_idx; + + while (1) { + s64 delta; + + rd_idx = readl_relaxed(its->base + GITS_CREADR); + + /* + * Compute the read pointer progress, taking the + * potential wrap-around into account. + */ + delta = rd_idx - prev_idx; + if (rd_idx < prev_idx) + delta += ITS_CMD_QUEUE_SZ; + + linear_idx += delta; + if (linear_idx >= to_idx) + break; + + count--; + if (!count) { + pr_err_ratelimited("ITS queue timeout (%llu %llu)\n", + to_idx, linear_idx); + return -1; + } + prev_idx = rd_idx; + cpu_relax(); + udelay(1); + } + + return 0; +} + +/* Warning, macro hell follows */ +#define BUILD_SINGLE_CMD_FUNC(name, buildtype, synctype, buildfn) \ +void name(struct its_node *its, \ + buildtype builder, \ + struct its_cmd_desc *desc) \ +{ \ + struct its_cmd_block *cmd, *sync_cmd, *next_cmd; \ + synctype *sync_obj; \ + unsigned long flags; \ + u64 rd_idx; \ + \ + raw_spin_lock_irqsave(&its->lock, flags); \ + \ + cmd = its_allocate_entry(its); \ + if (!cmd) { /* We're soooooo screewed... */ \ + raw_spin_unlock_irqrestore(&its->lock, flags); \ + return; \ + } \ + sync_obj = builder(its, cmd, desc); \ + its_flush_cmd(its, cmd); \ + \ + if (sync_obj) { \ + sync_cmd = its_allocate_entry(its); \ + if (!sync_cmd) \ + goto post; \ + \ + buildfn(its, sync_cmd, sync_obj); \ + its_flush_cmd(its, sync_cmd); \ + } \ + \ +post: \ + rd_idx = readl_relaxed(its->base + GITS_CREADR); \ + next_cmd = its_post_commands(its); \ + raw_spin_unlock_irqrestore(&its->lock, flags); \ + \ + if (its_wait_for_range_completion(its, rd_idx, next_cmd)) \ + pr_err_ratelimited("ITS cmd %ps failed\n", builder); \ +} + +static void its_build_sync_cmd(struct its_node *its, + struct its_cmd_block *sync_cmd, + struct its_collection *sync_col) +{ + its_encode_cmd(sync_cmd, GITS_CMD_SYNC); + its_encode_target(sync_cmd, sync_col->target_address); + + its_fixup_cmd(sync_cmd); +} + +static BUILD_SINGLE_CMD_FUNC(its_send_single_command, its_cmd_builder_t, + struct its_collection, its_build_sync_cmd) + +static void its_build_vsync_cmd(struct its_node *its, + struct its_cmd_block *sync_cmd, + struct its_vpe *sync_vpe) +{ + its_encode_cmd(sync_cmd, GITS_CMD_VSYNC); + its_encode_vpeid(sync_cmd, sync_vpe->vpe_id); + + its_fixup_cmd(sync_cmd); +} + +static BUILD_SINGLE_CMD_FUNC(its_send_single_vcommand, its_cmd_vbuilder_t, + struct its_vpe, its_build_vsync_cmd) + +static void its_send_int(struct its_device *dev, u32 event_id) +{ + struct its_cmd_desc desc; + + desc.its_int_cmd.dev = dev; + desc.its_int_cmd.event_id = event_id; + + its_send_single_command(dev->its, its_build_int_cmd, &desc); +} + +static void its_send_clear(struct its_device *dev, u32 event_id) +{ + struct its_cmd_desc desc; + + desc.its_clear_cmd.dev = dev; + desc.its_clear_cmd.event_id = event_id; + + its_send_single_command(dev->its, its_build_clear_cmd, &desc); +} + +static void its_send_inv(struct its_device *dev, u32 event_id) +{ + struct its_cmd_desc desc; + + desc.its_inv_cmd.dev = dev; + desc.its_inv_cmd.event_id = event_id; + + its_send_single_command(dev->its, its_build_inv_cmd, &desc); +} + +static void its_send_mapd(struct its_device *dev, int valid) +{ + struct its_cmd_desc desc; + + desc.its_mapd_cmd.dev = dev; + desc.its_mapd_cmd.valid = !!valid; + + its_send_single_command(dev->its, its_build_mapd_cmd, &desc); +} + +static void its_send_mapc(struct its_node *its, struct its_collection *col, + int valid) +{ + struct its_cmd_desc desc; + + desc.its_mapc_cmd.col = col; + desc.its_mapc_cmd.valid = !!valid; + + its_send_single_command(its, its_build_mapc_cmd, &desc); +} + +static void its_send_mapti(struct its_device *dev, u32 irq_id, u32 id) +{ + struct its_cmd_desc desc; + + desc.its_mapti_cmd.dev = dev; + desc.its_mapti_cmd.phys_id = irq_id; + desc.its_mapti_cmd.event_id = id; + + its_send_single_command(dev->its, its_build_mapti_cmd, &desc); +} + +static void its_send_movi(struct its_device *dev, + struct its_collection *col, u32 id) +{ + struct its_cmd_desc desc; + + desc.its_movi_cmd.dev = dev; + desc.its_movi_cmd.col = col; + desc.its_movi_cmd.event_id = id; + + its_send_single_command(dev->its, its_build_movi_cmd, &desc); +} + +static void its_send_discard(struct its_device *dev, u32 id) +{ + struct its_cmd_desc desc; + + desc.its_discard_cmd.dev = dev; + desc.its_discard_cmd.event_id = id; + + its_send_single_command(dev->its, its_build_discard_cmd, &desc); +} + +static void its_send_invall(struct its_node *its, struct its_collection *col) +{ + struct its_cmd_desc desc; + + desc.its_invall_cmd.col = col; + + its_send_single_command(its, its_build_invall_cmd, &desc); +} + +static void its_send_vmapti(struct its_device *dev, u32 id) +{ + struct its_vlpi_map *map = dev_event_to_vlpi_map(dev, id); + struct its_cmd_desc desc; + + desc.its_vmapti_cmd.vpe = map->vpe; + desc.its_vmapti_cmd.dev = dev; + desc.its_vmapti_cmd.virt_id = map->vintid; + desc.its_vmapti_cmd.event_id = id; + desc.its_vmapti_cmd.db_enabled = map->db_enabled; + + its_send_single_vcommand(dev->its, its_build_vmapti_cmd, &desc); +} + +static void its_send_vmovi(struct its_device *dev, u32 id) +{ + struct its_vlpi_map *map = dev_event_to_vlpi_map(dev, id); + struct its_cmd_desc desc; + + desc.its_vmovi_cmd.vpe = map->vpe; + desc.its_vmovi_cmd.dev = dev; + desc.its_vmovi_cmd.event_id = id; + desc.its_vmovi_cmd.db_enabled = map->db_enabled; + + its_send_single_vcommand(dev->its, its_build_vmovi_cmd, &desc); +} + +static void its_send_vmapp(struct its_node *its, + struct its_vpe *vpe, bool valid) +{ + struct its_cmd_desc desc; + + desc.its_vmapp_cmd.vpe = vpe; + desc.its_vmapp_cmd.valid = valid; + desc.its_vmapp_cmd.col = &its->collections[vpe->col_idx]; + + its_send_single_vcommand(its, its_build_vmapp_cmd, &desc); +} + +static void its_send_vmovp(struct its_vpe *vpe) +{ + struct its_cmd_desc desc = {}; + struct its_node *its; + unsigned long flags; + int col_id = vpe->col_idx; + + desc.its_vmovp_cmd.vpe = vpe; + + if (!its_list_map) { + its = list_first_entry(&its_nodes, struct its_node, entry); + desc.its_vmovp_cmd.col = &its->collections[col_id]; + its_send_single_vcommand(its, its_build_vmovp_cmd, &desc); + return; + } + + /* + * Yet another marvel of the architecture. If using the + * its_list "feature", we need to make sure that all ITSs + * receive all VMOVP commands in the same order. The only way + * to guarantee this is to make vmovp a serialization point. + * + * Wall <-- Head. + */ + raw_spin_lock_irqsave(&vmovp_lock, flags); + + desc.its_vmovp_cmd.seq_num = vmovp_seq_num++; + desc.its_vmovp_cmd.its_list = get_its_list(vpe->its_vm); + + /* Emit VMOVPs */ + list_for_each_entry(its, &its_nodes, entry) { + if (!is_v4(its)) + continue; + + if (!require_its_list_vmovp(vpe->its_vm, its)) + continue; + + desc.its_vmovp_cmd.col = &its->collections[col_id]; + its_send_single_vcommand(its, its_build_vmovp_cmd, &desc); + } + + raw_spin_unlock_irqrestore(&vmovp_lock, flags); +} + +static void its_send_vinvall(struct its_node *its, struct its_vpe *vpe) +{ + struct its_cmd_desc desc; + + desc.its_vinvall_cmd.vpe = vpe; + its_send_single_vcommand(its, its_build_vinvall_cmd, &desc); +} + +static void its_send_vinv(struct its_device *dev, u32 event_id) +{ + struct its_cmd_desc desc; + + /* + * There is no real VINV command. This is just a normal INV, + * with a VSYNC instead of a SYNC. + */ + desc.its_inv_cmd.dev = dev; + desc.its_inv_cmd.event_id = event_id; + + its_send_single_vcommand(dev->its, its_build_vinv_cmd, &desc); +} + +static void its_send_vint(struct its_device *dev, u32 event_id) +{ + struct its_cmd_desc desc; + + /* + * There is no real VINT command. This is just a normal INT, + * with a VSYNC instead of a SYNC. + */ + desc.its_int_cmd.dev = dev; + desc.its_int_cmd.event_id = event_id; + + its_send_single_vcommand(dev->its, its_build_vint_cmd, &desc); +} + +static void its_send_vclear(struct its_device *dev, u32 event_id) +{ + struct its_cmd_desc desc; + + /* + * There is no real VCLEAR command. This is just a normal CLEAR, + * with a VSYNC instead of a SYNC. + */ + desc.its_clear_cmd.dev = dev; + desc.its_clear_cmd.event_id = event_id; + + its_send_single_vcommand(dev->its, its_build_vclear_cmd, &desc); +} + +static void its_send_invdb(struct its_node *its, struct its_vpe *vpe) +{ + struct its_cmd_desc desc; + + desc.its_invdb_cmd.vpe = vpe; + its_send_single_vcommand(its, its_build_invdb_cmd, &desc); +} + +/* + * irqchip functions - assumes MSI, mostly. + */ +static void lpi_write_config(struct irq_data *d, u8 clr, u8 set) +{ + struct its_vlpi_map *map = get_vlpi_map(d); + irq_hw_number_t hwirq; + void *va; + u8 *cfg; + + if (map) { + va = page_address(map->vm->vprop_page); + hwirq = map->vintid; + + /* Remember the updated property */ + map->properties &= ~clr; + map->properties |= set | LPI_PROP_GROUP1; + } else { + va = gic_rdists->prop_table_va; + hwirq = d->hwirq; + } + + cfg = va + hwirq - 8192; + *cfg &= ~clr; + *cfg |= set | LPI_PROP_GROUP1; + + /* + * Make the above write visible to the redistributors. + * And yes, we're flushing exactly: One. Single. Byte. + * Humpf... + */ + if (gic_rdists->flags & RDIST_FLAGS_PROPBASE_NEEDS_FLUSHING) + gic_flush_dcache_to_poc(cfg, sizeof(*cfg)); + else + dsb(ishst); +} + +static void wait_for_syncr(void __iomem *rdbase) +{ + while (readl_relaxed(rdbase + GICR_SYNCR) & 1) + cpu_relax(); +} + +static void direct_lpi_inv(struct irq_data *d) +{ + struct its_vlpi_map *map = get_vlpi_map(d); + void __iomem *rdbase; + unsigned long flags; + u64 val; + int cpu; + + if (map) { + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + + WARN_ON(!is_v4_1(its_dev->its)); + + val = GICR_INVLPIR_V; + val |= FIELD_PREP(GICR_INVLPIR_VPEID, map->vpe->vpe_id); + val |= FIELD_PREP(GICR_INVLPIR_INTID, map->vintid); + } else { + val = d->hwirq; + } + + /* Target the redistributor this LPI is currently routed to */ + cpu = irq_to_cpuid_lock(d, &flags); + raw_spin_lock(&gic_data_rdist_cpu(cpu)->rd_lock); + rdbase = per_cpu_ptr(gic_rdists->rdist, cpu)->rd_base; + gic_write_lpir(val, rdbase + GICR_INVLPIR); + + wait_for_syncr(rdbase); + raw_spin_unlock(&gic_data_rdist_cpu(cpu)->rd_lock); + irq_to_cpuid_unlock(d, flags); +} + +static void lpi_update_config(struct irq_data *d, u8 clr, u8 set) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + + lpi_write_config(d, clr, set); + if (gic_rdists->has_direct_lpi && + (is_v4_1(its_dev->its) || !irqd_is_forwarded_to_vcpu(d))) + direct_lpi_inv(d); + else if (!irqd_is_forwarded_to_vcpu(d)) + its_send_inv(its_dev, its_get_event_id(d)); + else + its_send_vinv(its_dev, its_get_event_id(d)); +} + +static void its_vlpi_set_doorbell(struct irq_data *d, bool enable) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + u32 event = its_get_event_id(d); + struct its_vlpi_map *map; + + /* + * GICv4.1 does away with the per-LPI nonsense, nothing to do + * here. + */ + if (is_v4_1(its_dev->its)) + return; + + map = dev_event_to_vlpi_map(its_dev, event); + + if (map->db_enabled == enable) + return; + + map->db_enabled = enable; + + /* + * More fun with the architecture: + * + * Ideally, we'd issue a VMAPTI to set the doorbell to its LPI + * value or to 1023, depending on the enable bit. But that + * would be issuing a mapping for an /existing/ DevID+EventID + * pair, which is UNPREDICTABLE. Instead, let's issue a VMOVI + * to the /same/ vPE, using this opportunity to adjust the + * doorbell. Mouahahahaha. We loves it, Precious. + */ + its_send_vmovi(its_dev, event); +} + +static void its_mask_irq(struct irq_data *d) +{ + if (irqd_is_forwarded_to_vcpu(d)) + its_vlpi_set_doorbell(d, false); + + lpi_update_config(d, LPI_PROP_ENABLED, 0); +} + +static void its_unmask_irq(struct irq_data *d) +{ + if (irqd_is_forwarded_to_vcpu(d)) + its_vlpi_set_doorbell(d, true); + + lpi_update_config(d, 0, LPI_PROP_ENABLED); +} + +static __maybe_unused u32 its_read_lpi_count(struct irq_data *d, int cpu) +{ + if (irqd_affinity_is_managed(d)) + return atomic_read(&per_cpu_ptr(&cpu_lpi_count, cpu)->managed); + + return atomic_read(&per_cpu_ptr(&cpu_lpi_count, cpu)->unmanaged); +} + +static void its_inc_lpi_count(struct irq_data *d, int cpu) +{ + if (irqd_affinity_is_managed(d)) + atomic_inc(&per_cpu_ptr(&cpu_lpi_count, cpu)->managed); + else + atomic_inc(&per_cpu_ptr(&cpu_lpi_count, cpu)->unmanaged); +} + +static void its_dec_lpi_count(struct irq_data *d, int cpu) +{ + if (irqd_affinity_is_managed(d)) + atomic_dec(&per_cpu_ptr(&cpu_lpi_count, cpu)->managed); + else + atomic_dec(&per_cpu_ptr(&cpu_lpi_count, cpu)->unmanaged); +} + +static unsigned int cpumask_pick_least_loaded(struct irq_data *d, + const struct cpumask *cpu_mask) +{ + unsigned int cpu = nr_cpu_ids, tmp; + int count = S32_MAX; + + for_each_cpu(tmp, cpu_mask) { + int this_count = its_read_lpi_count(d, tmp); + + if (this_count < count) { + cpu = tmp; + count = this_count; + } + } + + return cpu; +} + +/* + * As suggested by Thomas Gleixner in: + * https://lore.kernel.org/r/87h80q2aoc.fsf@nanos.tec.linutronix.de + */ +static int its_select_cpu(struct irq_data *d, + const struct cpumask *aff_mask) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + static DEFINE_RAW_SPINLOCK(tmpmask_lock); + static struct cpumask __tmpmask; + struct cpumask *tmpmask; + unsigned long flags; + int cpu, node; + + node = its_dev->its->numa_node; + tmpmask = &__tmpmask; + + raw_spin_lock_irqsave(&tmpmask_lock, flags); + + if (!irqd_affinity_is_managed(d)) { + /* First try the NUMA node */ + if (node != NUMA_NO_NODE) { + /* + * Try the intersection of the affinity mask and the + * node mask (and the online mask, just to be safe). + */ + cpumask_and(tmpmask, cpumask_of_node(node), aff_mask); + cpumask_and(tmpmask, tmpmask, cpu_online_mask); + + /* + * Ideally, we would check if the mask is empty, and + * try again on the full node here. + * + * But it turns out that the way ACPI describes the + * affinity for ITSs only deals about memory, and + * not target CPUs, so it cannot describe a single + * ITS placed next to two NUMA nodes. + * + * Instead, just fallback on the online mask. This + * diverges from Thomas' suggestion above. + */ + cpu = cpumask_pick_least_loaded(d, tmpmask); + if (cpu < nr_cpu_ids) + goto out; + + /* If we can't cross sockets, give up */ + if ((its_dev->its->flags & ITS_FLAGS_WORKAROUND_CAVIUM_23144)) + goto out; + + /* If the above failed, expand the search */ + } + + /* Try the intersection of the affinity and online masks */ + cpumask_and(tmpmask, aff_mask, cpu_online_mask); + + /* If that doesn't fly, the online mask is the last resort */ + if (cpumask_empty(tmpmask)) + cpumask_copy(tmpmask, cpu_online_mask); + + cpu = cpumask_pick_least_loaded(d, tmpmask); + } else { + cpumask_copy(tmpmask, aff_mask); + + /* If we cannot cross sockets, limit the search to that node */ + if ((its_dev->its->flags & ITS_FLAGS_WORKAROUND_CAVIUM_23144) && + node != NUMA_NO_NODE) + cpumask_and(tmpmask, tmpmask, cpumask_of_node(node)); + + cpu = cpumask_pick_least_loaded(d, tmpmask); + } +out: + raw_spin_unlock_irqrestore(&tmpmask_lock, flags); + + pr_debug("IRQ%d -> %*pbl CPU%d\n", d->irq, cpumask_pr_args(aff_mask), cpu); + return cpu; +} + +#define MAX_MARS3_SKT_COUNT 8 + +static int its_cpumask_select(struct its_device *its_dev, + const struct cpumask *mask_val, + const struct cpumask *cpu_mask) +{ + unsigned int skt, skt_id, i; + phys_addr_t its_phys_base; + unsigned int cpu, cpus = 0; + + unsigned int skt_cpu_cnt[MAX_MARS3_SKT_COUNT] = {0}; + + its_phys_base = its_dev->its->phys_base; + skt_id = (its_phys_base >> 41) & 0x7; + + for (i = 0; i < nr_cpu_ids; i++) { + skt = (cpu_logical_map(i) >> 16) & 0xff; + if ((skt >= 0) && (skt < MAX_MARS3_SKT_COUNT)) { + if ((is_kdump_kernel()) && (skt_id == skt)) + return i; + + skt_cpu_cnt[skt]++; + } else if (skt != 0xff) { + pr_err("socket address: %d is out of range.", skt); + } + } + + if (skt_id) { + for (i = 0; i < skt_id; i++) + cpus += skt_cpu_cnt[i]; + } + + cpu = cpumask_any_and(mask_val, cpu_mask); + cpus = cpus + cpu % skt_cpu_cnt[skt_id]; + + return cpus; +} + +static int its_set_affinity(struct irq_data *d, const struct cpumask *mask_val, + bool force) +{ + unsigned int cpu; + const struct cpumask *cpu_mask = cpu_online_mask; + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + struct its_collection *target_col; + u32 id = its_get_event_id(d); + int prev_cpu; + unsigned int skt_t1, skt_t2, cpu_idx; + + /* A forwarded interrupt should use irq_set_vcpu_affinity */ + if (irqd_is_forwarded_to_vcpu(d)) + return -EINVAL; + + prev_cpu = its_dev->event_map.col_map[id]; + its_dec_lpi_count(d, prev_cpu); + + cpu_idx = its_cpumask_select(its_dev, mask_val, cpu_mask); + skt_t1 = (cpu_logical_map(cpu_idx) >> 16) & 0xff; + if (!force) + cpu = its_select_cpu(d, mask_val); + else + cpu = cpumask_pick_least_loaded(d, mask_val); + + skt_t2 = (cpu_logical_map(cpu) >> 16) & 0xff; + if (skt_t1 != skt_t2) + cpu = cpu_idx; + + if (cpu < 0 || cpu >= nr_cpu_ids) + goto err; + + /* don't set the affinity when the target cpu is same as current one */ + if (cpu != prev_cpu) { + target_col = &its_dev->its->collections[cpu]; + its_send_movi(its_dev, target_col, id); + its_dev->event_map.col_map[id] = cpu; + irq_data_update_effective_affinity(d, cpumask_of(cpu)); + } + + its_inc_lpi_count(d, cpu); + + return IRQ_SET_MASK_OK_DONE; + +err: + its_inc_lpi_count(d, prev_cpu); + return -EINVAL; +} + +static u64 its_irq_get_msi_base(struct its_device *its_dev) +{ + struct its_node *its = its_dev->its; + + return its->phys_base + GITS_TRANSLATER; +} + +static void its_irq_compose_msi_msg(struct irq_data *d, struct msi_msg *msg) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + struct its_node *its; + u64 addr; + + its = its_dev->its; + addr = its->get_msi_base(its_dev); + + msg->address_lo = lower_32_bits(addr); + msg->address_hi = upper_32_bits(addr); + msg->data = its_get_event_id(d); +} + +static int its_irq_set_irqchip_state(struct irq_data *d, + enum irqchip_irq_state which, + bool state) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + u32 event = its_get_event_id(d); + + if (which != IRQCHIP_STATE_PENDING) + return -EINVAL; + + if (irqd_is_forwarded_to_vcpu(d)) { + if (state) + its_send_vint(its_dev, event); + else + its_send_vclear(its_dev, event); + } else { + if (state) + its_send_int(its_dev, event); + else + its_send_clear(its_dev, event); + } + + return 0; +} + +static int its_irq_retrigger(struct irq_data *d) +{ + return !its_irq_set_irqchip_state(d, IRQCHIP_STATE_PENDING, true); +} + +/* + * Two favourable cases: + * + * (a) Either we have a GICv4.1, and all vPEs have to be mapped at all times + * for vSGI delivery + * + * (b) Or the ITSs do not use a list map, meaning that VMOVP is cheap enough + * and we're better off mapping all VPEs always + * + * If neither (a) nor (b) is true, then we map vPEs on demand. + * + */ +static bool gic_requires_eager_mapping(void) +{ + if (!its_list_map || gic_rdists->has_rvpeid) + return true; + + return false; +} + +static void its_map_vm(struct its_node *its, struct its_vm *vm) +{ + unsigned long flags; + + if (gic_requires_eager_mapping()) + return; + + raw_spin_lock_irqsave(&vmovp_lock, flags); + + /* + * If the VM wasn't mapped yet, iterate over the vpes and get + * them mapped now. + */ + vm->vlpi_count[its->list_nr]++; + + if (vm->vlpi_count[its->list_nr] == 1) { + int i; + + for (i = 0; i < vm->nr_vpes; i++) { + struct its_vpe *vpe = vm->vpes[i]; + struct irq_data *d = irq_get_irq_data(vpe->irq); + + /* Map the VPE to the first possible CPU */ + vpe->col_idx = cpumask_first(cpu_online_mask); + its_send_vmapp(its, vpe, true); + its_send_vinvall(its, vpe); + irq_data_update_effective_affinity(d, cpumask_of(vpe->col_idx)); + } + } + + raw_spin_unlock_irqrestore(&vmovp_lock, flags); +} + +static void its_unmap_vm(struct its_node *its, struct its_vm *vm) +{ + unsigned long flags; + + /* Not using the ITS list? Everything is always mapped. */ + if (gic_requires_eager_mapping()) + return; + + raw_spin_lock_irqsave(&vmovp_lock, flags); + + if (!--vm->vlpi_count[its->list_nr]) { + int i; + + for (i = 0; i < vm->nr_vpes; i++) + its_send_vmapp(its, vm->vpes[i], false); + } + + raw_spin_unlock_irqrestore(&vmovp_lock, flags); +} + +static int its_vlpi_map(struct irq_data *d, struct its_cmd_info *info) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + u32 event = its_get_event_id(d); + int ret = 0; + + if (!info->map) + return -EINVAL; + + raw_spin_lock(&its_dev->event_map.vlpi_lock); + + if (!its_dev->event_map.vm) { + struct its_vlpi_map *maps; + + maps = kcalloc(its_dev->event_map.nr_lpis, sizeof(*maps), + GFP_ATOMIC); + if (!maps) { + ret = -ENOMEM; + goto out; + } + + its_dev->event_map.vm = info->map->vm; + its_dev->event_map.vlpi_maps = maps; + } else if (its_dev->event_map.vm != info->map->vm) { + ret = -EINVAL; + goto out; + } + + /* Get our private copy of the mapping information */ + its_dev->event_map.vlpi_maps[event] = *info->map; + + if (irqd_is_forwarded_to_vcpu(d)) { + /* Already mapped, move it around */ + its_send_vmovi(its_dev, event); + } else { + /* Ensure all the VPEs are mapped on this ITS */ + its_map_vm(its_dev->its, info->map->vm); + + /* + * Flag the interrupt as forwarded so that we can + * start poking the virtual property table. + */ + irqd_set_forwarded_to_vcpu(d); + + /* Write out the property to the prop table */ + lpi_write_config(d, 0xff, info->map->properties); + + /* Drop the physical mapping */ + its_send_discard(its_dev, event); + + /* and install the virtual one */ + its_send_vmapti(its_dev, event); + + /* Increment the number of VLPIs */ + its_dev->event_map.nr_vlpis++; + } + +out: + raw_spin_unlock(&its_dev->event_map.vlpi_lock); + return ret; +} + +static int its_vlpi_get(struct irq_data *d, struct its_cmd_info *info) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + struct its_vlpi_map *map; + int ret = 0; + + raw_spin_lock(&its_dev->event_map.vlpi_lock); + + map = get_vlpi_map(d); + + if (!its_dev->event_map.vm || !map) { + ret = -EINVAL; + goto out; + } + + /* Copy our mapping information to the incoming request */ + *info->map = *map; + +out: + raw_spin_unlock(&its_dev->event_map.vlpi_lock); + return ret; +} + +static int its_vlpi_unmap(struct irq_data *d) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + u32 event = its_get_event_id(d); + int ret = 0; + + raw_spin_lock(&its_dev->event_map.vlpi_lock); + + if (!its_dev->event_map.vm || !irqd_is_forwarded_to_vcpu(d)) { + ret = -EINVAL; + goto out; + } + + /* Drop the virtual mapping */ + its_send_discard(its_dev, event); + + /* and restore the physical one */ + irqd_clr_forwarded_to_vcpu(d); + its_send_mapti(its_dev, d->hwirq, event); + lpi_update_config(d, 0xff, (LPI_PROP_DEFAULT_PRIO | + LPI_PROP_ENABLED | + LPI_PROP_GROUP1)); + + /* Potentially unmap the VM from this ITS */ + its_unmap_vm(its_dev->its, its_dev->event_map.vm); + + /* + * Drop the refcount and make the device available again if + * this was the last VLPI. + */ + if (!--its_dev->event_map.nr_vlpis) { + its_dev->event_map.vm = NULL; + kfree(its_dev->event_map.vlpi_maps); + } + +out: + raw_spin_unlock(&its_dev->event_map.vlpi_lock); + return ret; +} + +static int its_vlpi_prop_update(struct irq_data *d, struct its_cmd_info *info) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + + if (!its_dev->event_map.vm || !irqd_is_forwarded_to_vcpu(d)) + return -EINVAL; + + if (info->cmd_type == PROP_UPDATE_AND_INV_VLPI) + lpi_update_config(d, 0xff, info->config); + else + lpi_write_config(d, 0xff, info->config); + its_vlpi_set_doorbell(d, !!(info->config & LPI_PROP_ENABLED)); + + return 0; +} + +static int its_irq_set_vcpu_affinity(struct irq_data *d, void *vcpu_info) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + struct its_cmd_info *info = vcpu_info; + + /* Need a v4 ITS */ + if (!is_v4(its_dev->its)) + return -EINVAL; + + /* Unmap request? */ + if (!info) + return its_vlpi_unmap(d); + + switch (info->cmd_type) { + case MAP_VLPI: + return its_vlpi_map(d, info); + + case GET_VLPI: + return its_vlpi_get(d, info); + + case PROP_UPDATE_VLPI: + case PROP_UPDATE_AND_INV_VLPI: + return its_vlpi_prop_update(d, info); + + default: + return -EINVAL; + } +} + +static struct irq_chip its_irq_chip = { + .name = "ITS", + .irq_mask = its_mask_irq, + .irq_unmask = its_unmask_irq, + .irq_eoi = irq_chip_eoi_parent, + .irq_set_affinity = its_set_affinity, + .irq_compose_msi_msg = its_irq_compose_msi_msg, + .irq_set_irqchip_state = its_irq_set_irqchip_state, + .irq_retrigger = its_irq_retrigger, + .irq_set_vcpu_affinity = its_irq_set_vcpu_affinity, +}; + + +/* + * How we allocate LPIs: + * + * lpi_range_list contains ranges of LPIs that are to available to + * allocate from. To allocate LPIs, just pick the first range that + * fits the required allocation, and reduce it by the required + * amount. Once empty, remove the range from the list. + * + * To free a range of LPIs, add a free range to the list, sort it and + * merge the result if the new range happens to be adjacent to an + * already free block. + * + * The consequence of the above is that allocation is cost is low, but + * freeing is expensive. We assumes that freeing rarely occurs. + */ +#define ITS_MAX_LPI_NRBITS 16 /* 64K LPIs */ + +static DEFINE_MUTEX(lpi_range_lock); +static LIST_HEAD(lpi_range_list); + +struct lpi_range { + struct list_head entry; + u32 base_id; + u32 span; +}; + +static struct lpi_range *mk_lpi_range(u32 base, u32 span) +{ + struct lpi_range *range; + + range = kmalloc(sizeof(*range), GFP_KERNEL); + if (range) { + range->base_id = base; + range->span = span; + } + + return range; +} + +static int alloc_lpi_range(u32 nr_lpis, u32 *base) +{ + struct lpi_range *range, *tmp; + int err = -ENOSPC; + + mutex_lock(&lpi_range_lock); + + list_for_each_entry_safe(range, tmp, &lpi_range_list, entry) { + if (range->span >= nr_lpis) { + *base = range->base_id; + range->base_id += nr_lpis; + range->span -= nr_lpis; + + if (range->span == 0) { + list_del(&range->entry); + kfree(range); + } + + err = 0; + break; + } + } + + mutex_unlock(&lpi_range_lock); + + pr_debug("ITS: alloc %u:%u\n", *base, nr_lpis); + return err; +} + +static void merge_lpi_ranges(struct lpi_range *a, struct lpi_range *b) +{ + if (&a->entry == &lpi_range_list || &b->entry == &lpi_range_list) + return; + if (a->base_id + a->span != b->base_id) + return; + b->base_id = a->base_id; + b->span += a->span; + list_del(&a->entry); + kfree(a); +} + +static int free_lpi_range(u32 base, u32 nr_lpis) +{ + struct lpi_range *new, *old; + + new = mk_lpi_range(base, nr_lpis); + if (!new) + return -ENOMEM; + + mutex_lock(&lpi_range_lock); + + list_for_each_entry_reverse(old, &lpi_range_list, entry) { + if (old->base_id < base) + break; + } + /* + * old is the last element with ->base_id smaller than base, + * so new goes right after it. If there are no elements with + * ->base_id smaller than base, &old->entry ends up pointing + * at the head of the list, and inserting new it the start of + * the list is the right thing to do in that case as well. + */ + list_add(&new->entry, &old->entry); + /* + * Now check if we can merge with the preceding and/or + * following ranges. + */ + merge_lpi_ranges(old, new); + merge_lpi_ranges(new, list_next_entry(new, entry)); + + mutex_unlock(&lpi_range_lock); + return 0; +} + +static int __init its_lpi_init(u32 id_bits) +{ + u32 lpis = (1UL << id_bits) - 8192; + u32 numlpis; + int err; + + numlpis = 1UL << GICD_TYPER_NUM_LPIS(gic_rdists->gicd_typer); + + if (numlpis > 2 && !WARN_ON(numlpis > lpis)) { + lpis = numlpis; + pr_info("ITS: Using hypervisor restricted LPI range [%u]\n", + lpis); + } + + /* + * Initializing the allocator is just the same as freeing the + * full range of LPIs. + */ + err = free_lpi_range(8192, lpis); + pr_debug("ITS: Allocator initialized for %u LPIs\n", lpis); + return err; +} + +static unsigned long *its_lpi_alloc(int nr_irqs, u32 *base, int *nr_ids) +{ + unsigned long *bitmap = NULL; + int err = 0; + + do { + err = alloc_lpi_range(nr_irqs, base); + if (!err) + break; + + nr_irqs /= 2; + } while (nr_irqs > 0); + + if (!nr_irqs) + err = -ENOSPC; + + if (err) + goto out; + + bitmap = bitmap_zalloc(nr_irqs, GFP_ATOMIC); + if (!bitmap) + goto out; + + *nr_ids = nr_irqs; + +out: + if (!bitmap) + *base = *nr_ids = 0; + + return bitmap; +} + +static void its_lpi_free(unsigned long *bitmap, u32 base, u32 nr_ids) +{ + WARN_ON(free_lpi_range(base, nr_ids)); + bitmap_free(bitmap); +} + +static void gic_reset_prop_table(void *va) +{ + /* Priority 0xa0, Group-1, disabled */ + memset(va, LPI_PROP_DEFAULT_PRIO | LPI_PROP_GROUP1, LPI_PROPBASE_SZ); + + /* Make sure the GIC will observe the written configuration */ + gic_flush_dcache_to_poc(va, LPI_PROPBASE_SZ); +} + +static struct page *its_allocate_prop_table(gfp_t gfp_flags) +{ + struct page *prop_page; + + prop_page = alloc_pages(gfp_flags, get_order(LPI_PROPBASE_SZ)); + if (!prop_page) + return NULL; + + gic_reset_prop_table(page_address(prop_page)); + + return prop_page; +} + +static void its_free_prop_table(struct page *prop_page) +{ + free_pages((unsigned long)page_address(prop_page), + get_order(LPI_PROPBASE_SZ)); +} + +static bool gic_check_reserved_range(phys_addr_t addr, unsigned long size) +{ + phys_addr_t start, end, addr_end; + u64 i; + + /* + * We don't bother checking for a kdump kernel as by + * construction, the LPI tables are out of this kernel's + * memory map. + */ + if (is_kdump_kernel()) + return true; + + addr_end = addr + size - 1; + + for_each_reserved_mem_range(i, &start, &end) { + if (addr >= start && addr_end <= end) + return true; + } + + /* Not found, not a good sign... */ + pr_warn("GIC-S2500: Expected reserved range [%pa:%pa], not found\n", + &addr, &addr_end); + add_taint(TAINT_CRAP, LOCKDEP_STILL_OK); + return false; +} + +static int gic_reserve_range(phys_addr_t addr, unsigned long size) +{ + if (efi_enabled(EFI_CONFIG_TABLES)) + return efi_mem_reserve_persistent(addr, size); + + return 0; +} + +static int __init its_setup_lpi_prop_table(void) +{ + if (gic_rdists->flags & RDIST_FLAGS_RD_TABLES_PREALLOCATED) { + u64 val; + + val = gicr_read_propbaser(gic_data_rdist_rd_base() + GICR_PROPBASER); + lpi_id_bits = (val & GICR_PROPBASER_IDBITS_MASK) + 1; + + gic_rdists->prop_table_pa = val & GENMASK_ULL(51, 12); + gic_rdists->prop_table_va = memremap(gic_rdists->prop_table_pa, + LPI_PROPBASE_SZ, + MEMREMAP_WB); + gic_reset_prop_table(gic_rdists->prop_table_va); + } else { + struct page *page; + + lpi_id_bits = min_t(u32, + GICD_TYPER_ID_BITS(gic_rdists->gicd_typer), + ITS_MAX_LPI_NRBITS); + page = its_allocate_prop_table(GFP_NOWAIT); + if (!page) { + pr_err("Failed to allocate PROPBASE\n"); + return -ENOMEM; + } + + gic_rdists->prop_table_pa = page_to_phys(page); + gic_rdists->prop_table_va = page_address(page); + WARN_ON(gic_reserve_range(gic_rdists->prop_table_pa, + LPI_PROPBASE_SZ)); + } + + pr_info("GICv-S2500: using LPI property table @%pa\n", + &gic_rdists->prop_table_pa); + + return its_lpi_init(lpi_id_bits); +} + +static const char *its_base_type_string[] = { + [GITS_BASER_TYPE_DEVICE] = "Devices", + [GITS_BASER_TYPE_VCPU] = "Virtual CPUs", + [GITS_BASER_TYPE_RESERVED3] = "Reserved (3)", + [GITS_BASER_TYPE_COLLECTION] = "Interrupt Collections", + [GITS_BASER_TYPE_RESERVED5] = "Reserved (5)", + [GITS_BASER_TYPE_RESERVED6] = "Reserved (6)", + [GITS_BASER_TYPE_RESERVED7] = "Reserved (7)", +}; + +static u64 its_read_baser(struct its_node *its, struct its_baser *baser) +{ + u32 idx = baser - its->tables; + + return gits_read_baser(its->base + GITS_BASER + (idx << 3)); +} + +static void its_write_baser(struct its_node *its, struct its_baser *baser, + u64 val) +{ + u32 idx = baser - its->tables; + + gits_write_baser(val, its->base + GITS_BASER + (idx << 3)); + baser->val = its_read_baser(its, baser); +} + +static int its_setup_baser(struct its_node *its, struct its_baser *baser, + u64 cache, u64 shr, u32 order, bool indirect) +{ + u64 val = its_read_baser(its, baser); + u64 esz = GITS_BASER_ENTRY_SIZE(val); + u64 type = GITS_BASER_TYPE(val); + u64 baser_phys, tmp; + u32 alloc_pages, psz; + struct page *page; + void *base; + + psz = baser->psz; + alloc_pages = (PAGE_ORDER_TO_SIZE(order) / psz); + if (alloc_pages > GITS_BASER_PAGES_MAX) { + pr_warn("ITS@%pa: %s too large, reduce ITS pages %u->%u\n", + &its->phys_base, its_base_type_string[type], + alloc_pages, GITS_BASER_PAGES_MAX); + alloc_pages = GITS_BASER_PAGES_MAX; + order = get_order(GITS_BASER_PAGES_MAX * psz); + } + + page = alloc_pages_node(its->numa_node, GFP_KERNEL | __GFP_ZERO, order); + if (!page) + return -ENOMEM; + + base = (void *)page_address(page); + baser_phys = virt_to_phys(base); + + /* Check if the physical address of the memory is above 48bits */ + if (IS_ENABLED(CONFIG_ARM64_64K_PAGES) && (baser_phys >> 48)) { + + /* 52bit PA is supported only when PageSize=64K */ + if (psz != SZ_64K) { + pr_err("ITS: no 52bit PA support when psz=%d\n", psz); + free_pages((unsigned long)base, order); + return -ENXIO; + } + + /* Convert 52bit PA to 48bit field */ + baser_phys = GITS_BASER_PHYS_52_to_48(baser_phys); + } + +retry_baser: + val = (baser_phys | + (type << GITS_BASER_TYPE_SHIFT) | + ((esz - 1) << GITS_BASER_ENTRY_SIZE_SHIFT) | + ((alloc_pages - 1) << GITS_BASER_PAGES_SHIFT) | + cache | + shr | + GITS_BASER_VALID); + + val |= indirect ? GITS_BASER_INDIRECT : 0x0; + + switch (psz) { + case SZ_4K: + val |= GITS_BASER_PAGE_SIZE_4K; + break; + case SZ_16K: + val |= GITS_BASER_PAGE_SIZE_16K; + break; + case SZ_64K: + val |= GITS_BASER_PAGE_SIZE_64K; + break; + } + + its_write_baser(its, baser, val); + tmp = baser->val; + + if ((val ^ tmp) & GITS_BASER_SHAREABILITY_MASK) { + /* + * Shareability didn't stick. Just use + * whatever the read reported, which is likely + * to be the only thing this redistributor + * supports. If that's zero, make it + * non-cacheable as well. + */ + shr = tmp & GITS_BASER_SHAREABILITY_MASK; + if (!shr) { + cache = GITS_BASER_nC; + gic_flush_dcache_to_poc(base, PAGE_ORDER_TO_SIZE(order)); + } + goto retry_baser; + } + + if (val != tmp) { + pr_err("ITS@%pa: %s doesn't stick: %llx %llx\n", + &its->phys_base, its_base_type_string[type], + val, tmp); + free_pages((unsigned long)base, order); + return -ENXIO; + } + + baser->order = order; + baser->base = base; + baser->psz = psz; + tmp = indirect ? GITS_LVL1_ENTRY_SIZE : esz; + + pr_info("ITS@%pa: allocated %d %s @%lx (%s, esz %d, psz %dK, shr %d)\n", + &its->phys_base, (int)(PAGE_ORDER_TO_SIZE(order) / (int)tmp), + its_base_type_string[type], + (unsigned long)virt_to_phys(base), + indirect ? "indirect" : "flat", (int)esz, + psz / SZ_1K, (int)shr >> GITS_BASER_SHAREABILITY_SHIFT); + + return 0; +} + +static bool its_parse_indirect_baser(struct its_node *its, + struct its_baser *baser, + u32 *order, u32 ids) +{ + u64 tmp = its_read_baser(its, baser); + u64 type = GITS_BASER_TYPE(tmp); + u64 esz = GITS_BASER_ENTRY_SIZE(tmp); + u64 val = GITS_BASER_InnerShareable | GITS_BASER_RaWaWb; + u32 new_order = *order; + u32 psz = baser->psz; + bool indirect = false; + + /* No need to enable Indirection if memory requirement < (psz*2)bytes */ + if ((esz << ids) > (psz * 2)) { + /* + * Find out whether hw supports a single or two-level table by + * table by reading bit at offset '62' after writing '1' to it. + */ + its_write_baser(its, baser, val | GITS_BASER_INDIRECT); + indirect = !!(baser->val & GITS_BASER_INDIRECT); + + if (indirect) { + /* + * The size of the lvl2 table is equal to ITS page size + * which is 'psz'. For computing lvl1 table size, + * subtract ID bits that sparse lvl2 table from 'ids' + * which is reported by ITS hardware times lvl1 table + * entry size. + */ + ids -= ilog2(psz / (int)esz); + esz = GITS_LVL1_ENTRY_SIZE; + } + } + + /* + * Allocate as many entries as required to fit the + * range of device IDs that the ITS can grok... The ID + * space being incredibly sparse, this results in a + * massive waste of memory if two-level device table + * feature is not supported by hardware. + */ + new_order = max_t(u32, get_order(esz << ids), new_order); + if (new_order >= MAX_ORDER) { + new_order = MAX_ORDER - 1; + ids = ilog2(PAGE_ORDER_TO_SIZE(new_order) / (int)esz); + pr_warn("ITS@%pa: %s Table too large, reduce ids %llu->%u\n", + &its->phys_base, its_base_type_string[type], + device_ids(its), ids); + } + + *order = new_order; + + return indirect; +} + +static u32 compute_common_aff(u64 val) +{ + u32 aff, clpiaff; + + aff = FIELD_GET(GICR_TYPER_AFFINITY, val); + clpiaff = FIELD_GET(GICR_TYPER_COMMON_LPI_AFF, val); + + return aff & ~(GENMASK(31, 0) >> (clpiaff * 8)); +} + +static u32 compute_its_aff(struct its_node *its) +{ + u64 val; + u32 svpet; + + /* + * Reencode the ITS SVPET and MPIDR as a GICR_TYPER, and compute + * the resulting affinity. We then use that to see if this match + * our own affinity. + */ + svpet = FIELD_GET(GITS_TYPER_SVPET, its->typer); + val = FIELD_PREP(GICR_TYPER_COMMON_LPI_AFF, svpet); + val |= FIELD_PREP(GICR_TYPER_AFFINITY, its->mpidr); + return compute_common_aff(val); +} + +static struct its_node *find_sibling_its(struct its_node *cur_its) +{ + struct its_node *its; + u32 aff; + + if (!FIELD_GET(GITS_TYPER_SVPET, cur_its->typer)) + return NULL; + + aff = compute_its_aff(cur_its); + + list_for_each_entry(its, &its_nodes, entry) { + u64 baser; + + if (!is_v4_1(its) || its == cur_its) + continue; + + if (!FIELD_GET(GITS_TYPER_SVPET, its->typer)) + continue; + + if (aff != compute_its_aff(its)) + continue; + + /* GICv4.1 guarantees that the vPE table is GITS_BASER2 */ + baser = its->tables[2].val; + if (!(baser & GITS_BASER_VALID)) + continue; + + return its; + } + + return NULL; +} + +static void its_free_tables(struct its_node *its) +{ + int i; + + for (i = 0; i < GITS_BASER_NR_REGS; i++) { + if (its->tables[i].base) { + free_pages((unsigned long)its->tables[i].base, + its->tables[i].order); + its->tables[i].base = NULL; + } + } +} + +static int its_probe_baser_psz(struct its_node *its, struct its_baser *baser) +{ + u64 psz = SZ_64K; + + while (psz) { + u64 val, gpsz; + + val = its_read_baser(its, baser); + val &= ~GITS_BASER_PAGE_SIZE_MASK; + + switch (psz) { + case SZ_64K: + gpsz = GITS_BASER_PAGE_SIZE_64K; + break; + case SZ_16K: + gpsz = GITS_BASER_PAGE_SIZE_16K; + break; + case SZ_4K: + default: + gpsz = GITS_BASER_PAGE_SIZE_4K; + break; + } + + gpsz >>= GITS_BASER_PAGE_SIZE_SHIFT; + + val |= FIELD_PREP(GITS_BASER_PAGE_SIZE_MASK, gpsz); + its_write_baser(its, baser, val); + + if (FIELD_GET(GITS_BASER_PAGE_SIZE_MASK, baser->val) == gpsz) + break; + + switch (psz) { + case SZ_64K: + psz = SZ_16K; + break; + case SZ_16K: + psz = SZ_4K; + break; + case SZ_4K: + default: + return -1; + } + } + + baser->psz = psz; + return 0; +} + +static int its_alloc_tables(struct its_node *its) +{ + u64 shr = GITS_BASER_InnerShareable; + u64 cache = GITS_BASER_RaWaWb; + int err, i; + + if (its->flags & ITS_FLAGS_WORKAROUND_CAVIUM_22375) + /* erratum 24313: ignore memory access type */ + cache = GITS_BASER_nCnB; + + for (i = 0; i < GITS_BASER_NR_REGS; i++) { + struct its_baser *baser = its->tables + i; + u64 val = its_read_baser(its, baser); + u64 type = GITS_BASER_TYPE(val); + bool indirect = false; + u32 order; + + if (type == GITS_BASER_TYPE_NONE) + continue; + + if (its_probe_baser_psz(its, baser)) { + its_free_tables(its); + return -ENXIO; + } + + order = get_order(baser->psz); + + switch (type) { + case GITS_BASER_TYPE_DEVICE: + indirect = its_parse_indirect_baser(its, baser, &order, + device_ids(its)); + break; + + case GITS_BASER_TYPE_VCPU: + if (is_v4_1(its)) { + struct its_node *sibling; + + WARN_ON(i != 2); + if ((sibling = find_sibling_its(its))) { + *baser = sibling->tables[2]; + its_write_baser(its, baser, baser->val); + continue; + } + } + + indirect = its_parse_indirect_baser(its, baser, &order, + ITS_MAX_VPEID_BITS); + break; + } + + err = its_setup_baser(its, baser, cache, shr, order, indirect); + if (err < 0) { + its_free_tables(its); + return err; + } + + /* Update settings which will be used for next BASERn */ + cache = baser->val & GITS_BASER_CACHEABILITY_MASK; + shr = baser->val & GITS_BASER_SHAREABILITY_MASK; + } + + return 0; +} + +static u64 inherit_vpe_l1_table_from_its(void) +{ + struct its_node *its; + u64 val; + u32 aff; + + val = gic_read_typer(gic_data_rdist_rd_base() + GICR_TYPER); + aff = compute_common_aff(val); + + list_for_each_entry(its, &its_nodes, entry) { + u64 baser, addr; + + if (!is_v4_1(its)) + continue; + + if (!FIELD_GET(GITS_TYPER_SVPET, its->typer)) + continue; + + if (aff != compute_its_aff(its)) + continue; + + /* GICv4.1 guarantees that the vPE table is GITS_BASER2 */ + baser = its->tables[2].val; + if (!(baser & GITS_BASER_VALID)) + continue; + + /* We have a winner! */ + gic_data_rdist()->vpe_l1_base = its->tables[2].base; + + val = GICR_VPROPBASER_4_1_VALID; + if (baser & GITS_BASER_INDIRECT) + val |= GICR_VPROPBASER_4_1_INDIRECT; + val |= FIELD_PREP(GICR_VPROPBASER_4_1_PAGE_SIZE, + FIELD_GET(GITS_BASER_PAGE_SIZE_MASK, baser)); + switch (FIELD_GET(GITS_BASER_PAGE_SIZE_MASK, baser)) { + case GIC_PAGE_SIZE_64K: + addr = GITS_BASER_ADDR_48_to_52(baser); + break; + default: + addr = baser & GENMASK_ULL(47, 12); + break; + } + val |= FIELD_PREP(GICR_VPROPBASER_4_1_ADDR, addr >> 12); + val |= FIELD_PREP(GICR_VPROPBASER_SHAREABILITY_MASK, + FIELD_GET(GITS_BASER_SHAREABILITY_MASK, baser)); + val |= FIELD_PREP(GICR_VPROPBASER_INNER_CACHEABILITY_MASK, + FIELD_GET(GITS_BASER_INNER_CACHEABILITY_MASK, baser)); + val |= FIELD_PREP(GICR_VPROPBASER_4_1_SIZE, GITS_BASER_NR_PAGES(baser) - 1); + + return val; + } + + return 0; +} + +static u64 inherit_vpe_l1_table_from_rd(cpumask_t **mask) +{ + u32 aff; + u64 val; + int cpu; + + val = gic_read_typer(gic_data_rdist_rd_base() + GICR_TYPER); + aff = compute_common_aff(val); + + for_each_possible_cpu(cpu) { + void __iomem *base = gic_data_rdist_cpu(cpu)->rd_base; + + if (!base || cpu == smp_processor_id()) + continue; + + val = gic_read_typer(base + GICR_TYPER); + if (aff != compute_common_aff(val)) + continue; + + /* + * At this point, we have a victim. This particular CPU + * has already booted, and has an affinity that matches + * ours wrt CommonLPIAff. Let's use its own VPROPBASER. + * Make sure we don't write the Z bit in that case. + */ + val = gicr_read_vpropbaser(base + SZ_128K + GICR_VPROPBASER); + val &= ~GICR_VPROPBASER_4_1_Z; + + gic_data_rdist()->vpe_l1_base = gic_data_rdist_cpu(cpu)->vpe_l1_base; + *mask = gic_data_rdist_cpu(cpu)->vpe_table_mask; + + return val; + } + + return 0; +} + +static bool allocate_vpe_l2_table(int cpu, u32 id) +{ + void __iomem *base = gic_data_rdist_cpu(cpu)->rd_base; + unsigned int psz, esz, idx, npg, gpsz; + u64 val; + struct page *page; + __le64 *table; + + if (!gic_rdists->has_rvpeid) + return true; + + /* Skip non-present CPUs */ + if (!base) + return true; + + val = gicr_read_vpropbaser(base + SZ_128K + GICR_VPROPBASER); + + esz = FIELD_GET(GICR_VPROPBASER_4_1_ENTRY_SIZE, val) + 1; + gpsz = FIELD_GET(GICR_VPROPBASER_4_1_PAGE_SIZE, val); + npg = FIELD_GET(GICR_VPROPBASER_4_1_SIZE, val) + 1; + + switch (gpsz) { + default: + WARN_ON(1); + fallthrough; + case GIC_PAGE_SIZE_4K: + psz = SZ_4K; + break; + case GIC_PAGE_SIZE_16K: + psz = SZ_16K; + break; + case GIC_PAGE_SIZE_64K: + psz = SZ_64K; + break; + } + + /* Don't allow vpe_id that exceeds single, flat table limit */ + if (!(val & GICR_VPROPBASER_4_1_INDIRECT)) + return (id < (npg * psz / (esz * SZ_8))); + + /* Compute 1st level table index & check if that exceeds table limit */ + idx = id >> ilog2(psz / (esz * SZ_8)); + if (idx >= (npg * psz / GITS_LVL1_ENTRY_SIZE)) + return false; + + table = gic_data_rdist_cpu(cpu)->vpe_l1_base; + + /* Allocate memory for 2nd level table */ + if (!table[idx]) { + page = alloc_pages(GFP_KERNEL | __GFP_ZERO, get_order(psz)); + if (!page) + return false; + + /* Flush Lvl2 table to PoC if hw doesn't support coherency */ + if (!(val & GICR_VPROPBASER_SHAREABILITY_MASK)) + gic_flush_dcache_to_poc(page_address(page), psz); + + table[idx] = cpu_to_le64(page_to_phys(page) | GITS_BASER_VALID); + + /* Flush Lvl1 entry to PoC if hw doesn't support coherency */ + if (!(val & GICR_VPROPBASER_SHAREABILITY_MASK)) + gic_flush_dcache_to_poc(table + idx, GITS_LVL1_ENTRY_SIZE); + + /* Ensure updated table contents are visible to RD hardware */ + dsb(sy); + } + + return true; +} + +static int allocate_vpe_l1_table(void) +{ + void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); + u64 val, gpsz, npg, pa; + unsigned int psz = SZ_64K; + unsigned int np, epp, esz; + struct page *page; + + if (!gic_rdists->has_rvpeid) + return 0; + + /* + * if VPENDBASER.Valid is set, disable any previously programmed + * VPE by setting PendingLast while clearing Valid. This has the + * effect of making sure no doorbell will be generated and we can + * then safely clear VPROPBASER.Valid. + */ + if (gicr_read_vpendbaser(vlpi_base + GICR_VPENDBASER) & GICR_VPENDBASER_Valid) + gicr_write_vpendbaser(GICR_VPENDBASER_PendingLast, + vlpi_base + GICR_VPENDBASER); + + /* + * If we can inherit the configuration from another RD, let's do + * so. Otherwise, we have to go through the allocation process. We + * assume that all RDs have the exact same requirements, as + * nothing will work otherwise. + */ + val = inherit_vpe_l1_table_from_rd(&gic_data_rdist()->vpe_table_mask); + if (val & GICR_VPROPBASER_4_1_VALID) + goto out; + + gic_data_rdist()->vpe_table_mask = kzalloc(sizeof(cpumask_t), GFP_ATOMIC); + if (!gic_data_rdist()->vpe_table_mask) + return -ENOMEM; + + val = inherit_vpe_l1_table_from_its(); + if (val & GICR_VPROPBASER_4_1_VALID) + goto out; + + /* First probe the page size */ + val = FIELD_PREP(GICR_VPROPBASER_4_1_PAGE_SIZE, GIC_PAGE_SIZE_64K); + gicr_write_vpropbaser(val, vlpi_base + GICR_VPROPBASER); + val = gicr_read_vpropbaser(vlpi_base + GICR_VPROPBASER); + gpsz = FIELD_GET(GICR_VPROPBASER_4_1_PAGE_SIZE, val); + esz = FIELD_GET(GICR_VPROPBASER_4_1_ENTRY_SIZE, val); + + switch (gpsz) { + default: + gpsz = GIC_PAGE_SIZE_4K; + fallthrough; + case GIC_PAGE_SIZE_4K: + psz = SZ_4K; + break; + case GIC_PAGE_SIZE_16K: + psz = SZ_16K; + break; + case GIC_PAGE_SIZE_64K: + psz = SZ_64K; + break; + } + + /* + * Start populating the register from scratch, including RO fields + * (which we want to print in debug cases...) + */ + val = 0; + val |= FIELD_PREP(GICR_VPROPBASER_4_1_PAGE_SIZE, gpsz); + val |= FIELD_PREP(GICR_VPROPBASER_4_1_ENTRY_SIZE, esz); + + /* How many entries per GIC page? */ + esz++; + epp = psz / (esz * SZ_8); + + /* + * If we need more than just a single L1 page, flag the table + * as indirect and compute the number of required L1 pages. + */ + if (epp < ITS_MAX_VPEID) { + int nl2; + + val |= GICR_VPROPBASER_4_1_INDIRECT; + + /* Number of L2 pages required to cover the VPEID space */ + nl2 = DIV_ROUND_UP(ITS_MAX_VPEID, epp); + + /* Number of L1 pages to point to the L2 pages */ + npg = DIV_ROUND_UP(nl2 * SZ_8, psz); + } else { + npg = 1; + } + + val |= FIELD_PREP(GICR_VPROPBASER_4_1_SIZE, npg - 1); + + /* Right, that's the number of CPU pages we need for L1 */ + np = DIV_ROUND_UP(npg * psz, PAGE_SIZE); + + pr_debug("np = %d, npg = %lld, psz = %d, epp = %d, esz = %d\n", + np, npg, psz, epp, esz); + page = alloc_pages(GFP_ATOMIC | __GFP_ZERO, get_order(np * PAGE_SIZE)); + if (!page) + return -ENOMEM; + + gic_data_rdist()->vpe_l1_base = page_address(page); + pa = virt_to_phys(page_address(page)); + WARN_ON(!IS_ALIGNED(pa, psz)); + + val |= FIELD_PREP(GICR_VPROPBASER_4_1_ADDR, pa >> 12); + val |= GICR_VPROPBASER_RaWb; + val |= GICR_VPROPBASER_InnerShareable; + val |= GICR_VPROPBASER_4_1_Z; + val |= GICR_VPROPBASER_4_1_VALID; + +out: + gicr_write_vpropbaser(val, vlpi_base + GICR_VPROPBASER); + cpumask_set_cpu(smp_processor_id(), gic_data_rdist()->vpe_table_mask); + + pr_debug("CPU%d: VPROPBASER = %llx %*pbl\n", + smp_processor_id(), val, + cpumask_pr_args(gic_data_rdist()->vpe_table_mask)); + + return 0; +} + +static int its_alloc_collections(struct its_node *its) +{ + int i; + + its->collections = kcalloc(nr_cpu_ids, sizeof(*its->collections), + GFP_KERNEL); + if (!its->collections) + return -ENOMEM; + + for (i = 0; i < nr_cpu_ids; i++) + its->collections[i].target_address = ~0ULL; + + return 0; +} + +static struct page *its_allocate_pending_table(gfp_t gfp_flags) +{ + struct page *pend_page; + + pend_page = alloc_pages(gfp_flags | __GFP_ZERO, + get_order(LPI_PENDBASE_SZ)); + if (!pend_page) + return NULL; + + /* Make sure the GIC will observe the zero-ed page */ + gic_flush_dcache_to_poc(page_address(pend_page), LPI_PENDBASE_SZ); + + return pend_page; +} + +static void its_free_pending_table(struct page *pt) +{ + free_pages((unsigned long)page_address(pt), get_order(LPI_PENDBASE_SZ)); +} + +/* + * Booting with kdump and LPIs enabled is generally fine. Any other + * case is wrong in the absence of firmware/EFI support. + */ +static bool enabled_lpis_allowed(void) +{ + phys_addr_t addr; + u64 val; + + /* Check whether the property table is in a reserved region */ + val = gicr_read_propbaser(gic_data_rdist_rd_base() + GICR_PROPBASER); + addr = val & GENMASK_ULL(51, 12); + + return gic_check_reserved_range(addr, LPI_PROPBASE_SZ); +} + +static int __init allocate_lpi_tables(void) +{ + u64 val; + int err, cpu; + + /* + * If LPIs are enabled while we run this from the boot CPU, + * flag the RD tables as pre-allocated if the stars do align. + */ + val = readl_relaxed(gic_data_rdist_rd_base() + GICR_CTLR); + if ((val & GICR_CTLR_ENABLE_LPIS) && enabled_lpis_allowed()) { + gic_rdists->flags |= (RDIST_FLAGS_RD_TABLES_PREALLOCATED | + RDIST_FLAGS_PROPBASE_NEEDS_FLUSHING); + pr_info("GIC-S2500: Using preallocated redistributor tables\n"); + } + + err = its_setup_lpi_prop_table(); + if (err) + return err; + + /* + * We allocate all the pending tables anyway, as we may have a + * mix of RDs that have had LPIs enabled, and some that + * don't. We'll free the unused ones as each CPU comes online. + */ + for_each_possible_cpu(cpu) { + struct page *pend_page; + + pend_page = its_allocate_pending_table(GFP_NOWAIT); + if (!pend_page) { + pr_err("Failed to allocate PENDBASE for CPU%d\n", cpu); + return -ENOMEM; + } + + gic_data_rdist_cpu(cpu)->pend_page = pend_page; + } + + return 0; +} + +static u64 read_vpend_dirty_clear(void __iomem *vlpi_base) +{ + u32 count = 1000000; /* 1s! */ + bool clean; + u64 val; + + do { + val = gicr_read_vpendbaser(vlpi_base + GICR_VPENDBASER); + clean = !(val & GICR_VPENDBASER_Dirty); + if (!clean) { + count--; + cpu_relax(); + udelay(1); + } + } while (!clean && count); + + if (unlikely(!clean)) + pr_err_ratelimited("ITS virtual pending table not cleaning\n"); + + return val; +} + +static u64 its_clear_vpend_valid(void __iomem *vlpi_base, u64 clr, u64 set) +{ + u64 val; + + /* Make sure we wait until the RD is done with the initial scan */ + val = read_vpend_dirty_clear(vlpi_base); + val &= ~GICR_VPENDBASER_Valid; + val &= ~clr; + val |= set; + gicr_write_vpendbaser(val, vlpi_base + GICR_VPENDBASER); + + val = read_vpend_dirty_clear(vlpi_base); + if (unlikely(val & GICR_VPENDBASER_Dirty)) + val |= GICR_VPENDBASER_PendingLast; + + return val; +} + +static void its_cpu_init_lpis(void) +{ + void __iomem *rbase = gic_data_rdist_rd_base(); + struct page *pend_page; + phys_addr_t paddr; + u64 val, tmp; + + if (gic_data_rdist()->flags & RD_LOCAL_LPI_ENABLED) + return; + + val = readl_relaxed(rbase + GICR_CTLR); + if ((gic_rdists->flags & RDIST_FLAGS_RD_TABLES_PREALLOCATED) && + (val & GICR_CTLR_ENABLE_LPIS)) { + /* + * Check that we get the same property table on all + * RDs. If we don't, this is hopeless. + */ + paddr = gicr_read_propbaser(rbase + GICR_PROPBASER); + paddr &= GENMASK_ULL(51, 12); + if (WARN_ON(gic_rdists->prop_table_pa != paddr)) + add_taint(TAINT_CRAP, LOCKDEP_STILL_OK); + + paddr = gicr_read_pendbaser(rbase + GICR_PENDBASER); + paddr &= GENMASK_ULL(51, 16); + + WARN_ON(!gic_check_reserved_range(paddr, LPI_PENDBASE_SZ)); + gic_data_rdist()->flags |= RD_LOCAL_PENDTABLE_PREALLOCATED; + + goto out; + } + + pend_page = gic_data_rdist()->pend_page; + paddr = page_to_phys(pend_page); + + /* set PROPBASE */ + val = (gic_rdists->prop_table_pa | + GICR_PROPBASER_InnerShareable | + GICR_PROPBASER_RaWaWb | + ((LPI_NRBITS - 1) & GICR_PROPBASER_IDBITS_MASK)); + + gicr_write_propbaser(val, rbase + GICR_PROPBASER); + tmp = gicr_read_propbaser(rbase + GICR_PROPBASER); + + if ((tmp ^ val) & GICR_PROPBASER_SHAREABILITY_MASK) { + if (!(tmp & GICR_PROPBASER_SHAREABILITY_MASK)) { + /* + * The HW reports non-shareable, we must + * remove the cacheability attributes as + * well. + */ + val &= ~(GICR_PROPBASER_SHAREABILITY_MASK | + GICR_PROPBASER_CACHEABILITY_MASK); + val |= GICR_PROPBASER_nC; + gicr_write_propbaser(val, rbase + GICR_PROPBASER); + } + pr_info_once("GIC: using cache flushing for LPI property table\n"); + gic_rdists->flags |= RDIST_FLAGS_PROPBASE_NEEDS_FLUSHING; + } + + /* set PENDBASE */ + val = (page_to_phys(pend_page) | + GICR_PENDBASER_InnerShareable | + GICR_PENDBASER_RaWaWb); + + gicr_write_pendbaser(val, rbase + GICR_PENDBASER); + tmp = gicr_read_pendbaser(rbase + GICR_PENDBASER); + + if (!(tmp & GICR_PENDBASER_SHAREABILITY_MASK)) { + /* + * The HW reports non-shareable, we must remove the + * cacheability attributes as well. + */ + val &= ~(GICR_PENDBASER_SHAREABILITY_MASK | + GICR_PENDBASER_CACHEABILITY_MASK); + val |= GICR_PENDBASER_nC; + gicr_write_pendbaser(val, rbase + GICR_PENDBASER); + } + + /* Enable LPIs */ + val = readl_relaxed(rbase + GICR_CTLR); + val |= GICR_CTLR_ENABLE_LPIS; + writel_relaxed(val, rbase + GICR_CTLR); + + if (gic_rdists->has_vlpis && !gic_rdists->has_rvpeid) { + void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); + + /* + * It's possible for CPU to receive VLPIs before it is + * scheduled as a vPE, especially for the first CPU, and the + * VLPI with INTID larger than 2^(IDbits+1) will be considered + * as out of range and dropped by GIC. + * So we initialize IDbits to known value to avoid VLPI drop. + */ + val = (LPI_NRBITS - 1) & GICR_VPROPBASER_IDBITS_MASK; + pr_debug("GICv4: CPU%d: Init IDbits to 0x%llx for GICR_VPROPBASER\n", + smp_processor_id(), val); + gicr_write_vpropbaser(val, vlpi_base + GICR_VPROPBASER); + + /* + * Also clear Valid bit of GICR_VPENDBASER, in case some + * ancient programming gets left in and has possibility of + * corrupting memory. + */ + val = its_clear_vpend_valid(vlpi_base, 0, 0); + } + + if (allocate_vpe_l1_table()) { + /* + * If the allocation has failed, we're in massive trouble. + * Disable direct injection, and pray that no VM was + * already running... + */ + gic_rdists->has_rvpeid = false; + gic_rdists->has_vlpis = false; + } + + /* Make sure the GIC has seen the above */ + dsb(sy); +out: + gic_data_rdist()->flags |= RD_LOCAL_LPI_ENABLED; + pr_info("GIC-2500: CPU%d: using %s LPI pending table @%pa\n", + smp_processor_id(), + gic_data_rdist()->flags & RD_LOCAL_PENDTABLE_PREALLOCATED ? + "reserved" : "allocated", + &paddr); +} + +static void its_cpu_init_collection(struct its_node *its) +{ + int cpu = smp_processor_id(); + u64 target; + + /* avoid cross node collections and its mapping */ + if (its->flags & ITS_FLAGS_WORKAROUND_CAVIUM_23144) { + struct device_node *cpu_node; + + cpu_node = of_get_cpu_node(cpu, NULL); + if (its->numa_node != NUMA_NO_NODE && + its->numa_node != of_node_to_nid(cpu_node)) + return; + } + + /* + * We now have to bind each collection to its target + * redistributor. + */ + if (gic_read_typer(its->base + GITS_TYPER) & GITS_TYPER_PTA) { + /* + * This ITS wants the physical address of the + * redistributor. + */ + target = gic_data_rdist()->phys_base; + } else { + /* This ITS wants a linear CPU number. */ + target = gic_read_typer(gic_data_rdist_rd_base() + GICR_TYPER); + target = GICR_TYPER_CPU_NUMBER(target) << 16; + } + + /* Perform collection mapping */ + its->collections[cpu].target_address = target; + if (is_kdump_kernel()) + its->collections[cpu].col_id = cpu % 65; + else + its->collections[cpu].col_id = cpu % 64; + + its_send_mapc(its, &its->collections[cpu], 1); + its_send_invall(its, &its->collections[cpu]); +} + +static void its_cpu_init_collections(void) +{ + struct its_node *its; + + raw_spin_lock(&its_lock); + + list_for_each_entry(its, &its_nodes, entry) + its_cpu_init_collection(its); + + raw_spin_unlock(&its_lock); +} + +static struct its_device *its_find_device(struct its_node *its, u32 dev_id) +{ + struct its_device *its_dev = NULL, *tmp; + unsigned long flags; + + raw_spin_lock_irqsave(&its->lock, flags); + + list_for_each_entry(tmp, &its->its_device_list, entry) { + if (tmp->device_id == dev_id) { + its_dev = tmp; + break; + } + } + + raw_spin_unlock_irqrestore(&its->lock, flags); + + return its_dev; +} + +static struct its_baser *its_get_baser(struct its_node *its, u32 type) +{ + int i; + + for (i = 0; i < GITS_BASER_NR_REGS; i++) { + if (GITS_BASER_TYPE(its->tables[i].val) == type) + return &its->tables[i]; + } + + return NULL; +} + +static bool its_alloc_table_entry(struct its_node *its, + struct its_baser *baser, u32 id) +{ + struct page *page; + u32 esz, idx; + __le64 *table; + + /* Don't allow device id that exceeds single, flat table limit */ + esz = GITS_BASER_ENTRY_SIZE(baser->val); + if (!(baser->val & GITS_BASER_INDIRECT)) + return (id < (PAGE_ORDER_TO_SIZE(baser->order) / esz)); + + /* Compute 1st level table index & check if that exceeds table limit */ + idx = id >> ilog2(baser->psz / esz); + if (idx >= (PAGE_ORDER_TO_SIZE(baser->order) / GITS_LVL1_ENTRY_SIZE)) + return false; + + table = baser->base; + + /* Allocate memory for 2nd level table */ + if (!table[idx]) { + page = alloc_pages_node(its->numa_node, GFP_KERNEL | __GFP_ZERO, + get_order(baser->psz)); + if (!page) + return false; + + /* Flush Lvl2 table to PoC if hw doesn't support coherency */ + if (!(baser->val & GITS_BASER_SHAREABILITY_MASK)) + gic_flush_dcache_to_poc(page_address(page), baser->psz); + + table[idx] = cpu_to_le64(page_to_phys(page) | GITS_BASER_VALID); + + /* Flush Lvl1 entry to PoC if hw doesn't support coherency */ + if (!(baser->val & GITS_BASER_SHAREABILITY_MASK)) + gic_flush_dcache_to_poc(table + idx, GITS_LVL1_ENTRY_SIZE); + + /* Ensure updated table contents are visible to ITS hardware */ + dsb(sy); + } + + return true; +} + +static bool its_alloc_device_table(struct its_node *its, u32 dev_id) +{ + struct its_baser *baser; + + baser = its_get_baser(its, GITS_BASER_TYPE_DEVICE); + + /* Don't allow device id that exceeds ITS hardware limit */ + if (!baser) + return (ilog2(dev_id) < device_ids(its)); + + return its_alloc_table_entry(its, baser, dev_id); +} + +static bool its_alloc_vpe_table(u32 vpe_id) +{ + struct its_node *its; + int cpu; + + /* + * Make sure the L2 tables are allocated on *all* v4 ITSs. We + * could try and only do it on ITSs corresponding to devices + * that have interrupts targeted at this VPE, but the + * complexity becomes crazy (and you have tons of memory + * anyway, right?). + */ + list_for_each_entry(its, &its_nodes, entry) { + struct its_baser *baser; + + if (!is_v4(its)) + continue; + + baser = its_get_baser(its, GITS_BASER_TYPE_VCPU); + if (!baser) + return false; + + if (!its_alloc_table_entry(its, baser, vpe_id)) + return false; + } + + /* Non v4.1? No need to iterate RDs and go back early. */ + if (!gic_rdists->has_rvpeid) + return true; + + /* + * Make sure the L2 tables are allocated for all copies of + * the L1 table on *all* v4.1 RDs. + */ + for_each_possible_cpu(cpu) { + if (!allocate_vpe_l2_table(cpu, vpe_id)) + return false; + } + + return true; +} + +static struct its_device *its_create_device(struct its_node *its, u32 dev_id, + int nvecs, bool alloc_lpis) +{ + struct its_device *dev; + unsigned long *lpi_map = NULL; + unsigned long flags; + u16 *col_map = NULL; + void *itt; + int lpi_base; + int nr_lpis; + int nr_ites; + int sz; + + if (!its_alloc_device_table(its, dev_id)) + return NULL; + + if (WARN_ON(!is_power_of_2(nvecs))) + nvecs = roundup_pow_of_two(nvecs); + + dev = kzalloc(sizeof(*dev), GFP_KERNEL); + /* + * Even if the device wants a single LPI, the ITT must be + * sized as a power of two (and you need at least one bit...). + */ + nr_ites = max(2, nvecs); + sz = nr_ites * (FIELD_GET(GITS_TYPER_ITT_ENTRY_SIZE, its->typer) + 1); + sz = max(sz, ITS_ITT_ALIGN) + ITS_ITT_ALIGN - 1; + itt = kzalloc_node(sz, GFP_KERNEL, its->numa_node); + if (alloc_lpis) { + lpi_map = its_lpi_alloc(nvecs, &lpi_base, &nr_lpis); + if (lpi_map) + col_map = kcalloc(nr_lpis, sizeof(*col_map), + GFP_KERNEL); + } else { + col_map = kcalloc(nr_ites, sizeof(*col_map), GFP_KERNEL); + nr_lpis = 0; + lpi_base = 0; + } + + if (!dev || !itt || !col_map || (!lpi_map && alloc_lpis)) { + kfree(dev); + kfree(itt); + bitmap_free(lpi_map); + kfree(col_map); + return NULL; + } + + gic_flush_dcache_to_poc(itt, sz); + + dev->its = its; + dev->itt = itt; + dev->nr_ites = nr_ites; + dev->event_map.lpi_map = lpi_map; + dev->event_map.col_map = col_map; + dev->event_map.lpi_base = lpi_base; + dev->event_map.nr_lpis = nr_lpis; + raw_spin_lock_init(&dev->event_map.vlpi_lock); + dev->device_id = dev_id; + INIT_LIST_HEAD(&dev->entry); + + raw_spin_lock_irqsave(&its->lock, flags); + list_add(&dev->entry, &its->its_device_list); + raw_spin_unlock_irqrestore(&its->lock, flags); + + /* Map device to its ITT */ + its_send_mapd(dev, 1); + + return dev; +} + +static void its_free_device(struct its_device *its_dev) +{ + unsigned long flags; + + raw_spin_lock_irqsave(&its_dev->its->lock, flags); + list_del(&its_dev->entry); + raw_spin_unlock_irqrestore(&its_dev->its->lock, flags); + kfree(its_dev->event_map.col_map); + kfree(its_dev->itt); + kfree(its_dev); +} + +static int its_alloc_device_irq(struct its_device *dev, int nvecs, irq_hw_number_t *hwirq) +{ + int idx; + + /* Find a free LPI region in lpi_map and allocate them. */ + idx = bitmap_find_free_region(dev->event_map.lpi_map, + dev->event_map.nr_lpis, + get_count_order(nvecs)); + if (idx < 0) + return -ENOSPC; + + *hwirq = dev->event_map.lpi_base + idx; + + return 0; +} + +static int its_msi_prepare(struct irq_domain *domain, struct device *dev, + int nvec, msi_alloc_info_t *info) +{ + struct its_node *its; + struct its_device *its_dev; + struct msi_domain_info *msi_info; + u32 dev_id; + int err = 0; + + /* + * We ignore "dev" entirely, and rely on the dev_id that has + * been passed via the scratchpad. This limits this domain's + * usefulness to upper layers that definitely know that they + * are built on top of the ITS. + */ + dev_id = info->scratchpad[0].ul; + + msi_info = msi_get_domain_info(domain); + its = msi_info->data; + + if (!gic_rdists->has_direct_lpi && + vpe_proxy.dev && + vpe_proxy.dev->its == its && + dev_id == vpe_proxy.dev->device_id) { + /* Bad luck. Get yourself a better implementation */ + WARN_ONCE(1, "DevId %x clashes with GICv4 VPE proxy device\n", + dev_id); + return -EINVAL; + } + + mutex_lock(&its->dev_alloc_lock); + its_dev = its_find_device(its, dev_id); + if (its_dev) { + /* + * We already have seen this ID, probably through + * another alias (PCI bridge of some sort). No need to + * create the device. + */ + its_dev->shared = true; + pr_debug("Reusing ITT for devID %x\n", dev_id); + goto out; + } + + its_dev = its_create_device(its, dev_id, nvec, true); + if (!its_dev) { + err = -ENOMEM; + goto out; + } + + if (info->flags & MSI_ALLOC_FLAGS_PROXY_DEVICE) + its_dev->shared = true; + + pr_debug("ITT %d entries, %d bits\n", nvec, ilog2(nvec)); +out: + mutex_unlock(&its->dev_alloc_lock); + info->scratchpad[0].ptr = its_dev; + return err; +} + +static struct msi_domain_ops its_msi_domain_ops = { + .msi_prepare = its_msi_prepare, +}; + +static int its_irq_gic_domain_alloc(struct irq_domain *domain, + unsigned int virq, + irq_hw_number_t hwirq) +{ + struct irq_fwspec fwspec; + + if (irq_domain_get_of_node(domain->parent)) { + fwspec.fwnode = domain->parent->fwnode; + fwspec.param_count = 3; + fwspec.param[0] = GIC_IRQ_TYPE_LPI; + fwspec.param[1] = hwirq; + fwspec.param[2] = IRQ_TYPE_EDGE_RISING; + } else if (is_fwnode_irqchip(domain->parent->fwnode)) { + fwspec.fwnode = domain->parent->fwnode; + fwspec.param_count = 2; + fwspec.param[0] = hwirq; + fwspec.param[1] = IRQ_TYPE_EDGE_RISING; + } else { + return -EINVAL; + } + + return irq_domain_alloc_irqs_parent(domain, virq, 1, &fwspec); +} + +static int its_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, + unsigned int nr_irqs, void *args) +{ + msi_alloc_info_t *info = args; + struct its_device *its_dev = info->scratchpad[0].ptr; + struct its_node *its = its_dev->its; + struct irq_data *irqd; + irq_hw_number_t hwirq; + int err; + int i; + + err = its_alloc_device_irq(its_dev, nr_irqs, &hwirq); + if (err) + return err; + + err = iommu_dma_prepare_msi(info->desc, its->get_msi_base(its_dev)); + if (err) + return err; + + for (i = 0; i < nr_irqs; i++) { + err = its_irq_gic_domain_alloc(domain, virq + i, hwirq + i); + if (err) + return err; + + irq_domain_set_hwirq_and_chip(domain, virq + i, + hwirq + i, &its_irq_chip, its_dev); + irqd = irq_get_irq_data(virq + i); + irqd_set_single_target(irqd); + irqd_set_affinity_on_activate(irqd); + pr_debug("ID:%d pID:%d vID:%d\n", + (int)(hwirq + i - its_dev->event_map.lpi_base), + (int)(hwirq + i), virq + i); + } + + return 0; +} + +static int its_cpumask_first(struct its_device *its_dev, + const struct cpumask *cpu_mask) +{ + unsigned int skt, skt_id, i; + phys_addr_t its_phys_base; + unsigned int cpu, cpus = 0; + unsigned int skt_cpu_cnt[MAX_MARS3_SKT_COUNT] = {0}; + + its_phys_base = its_dev->its->phys_base; + skt_id = (its_phys_base >> 41) & 0x7; + + for (i = 0; i < nr_cpu_ids; i++) { + skt = (cpu_logical_map(i) >> 16) & 0xff; + if ((skt >= 0) && (skt < MAX_MARS3_SKT_COUNT)) { + if ((is_kdump_kernel()) && (skt_id == skt)) + return i; + + skt_cpu_cnt[skt]++; + } else if (skt != 0xff) { + pr_err("socket address: %d is out of range.", skt); + } + } + + if (skt_id) { + for (i = 0; i < skt_id; i++) + cpus += skt_cpu_cnt[i]; + } + + cpu = cpumask_first(cpu_mask); + if ((cpu > cpus) && (cpu < (cpus + skt_cpu_cnt[skt_id]))) + cpus = cpu; + + return cpus; +} + +static int its_irq_domain_activate(struct irq_domain *domain, + struct irq_data *d, bool reserve) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + u32 event = its_get_event_id(d); + const struct cpumask *cpu_mask = cpu_online_mask; + int cpu; + + cpu = its_cpumask_first(its_dev, cpu_mask); + + if (cpu < 0 || cpu >= nr_cpu_ids) + return -EINVAL; + + its_inc_lpi_count(d, cpu); + its_dev->event_map.col_map[event] = cpu; + irq_data_update_effective_affinity(d, cpumask_of(cpu)); + + /* Map the GIC IRQ and event to the device */ + its_send_mapti(its_dev, d->hwirq, event); + return 0; +} + +static void its_irq_domain_deactivate(struct irq_domain *domain, + struct irq_data *d) +{ + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + u32 event = its_get_event_id(d); + + its_dec_lpi_count(d, its_dev->event_map.col_map[event]); + /* Stop the delivery of interrupts */ + its_send_discard(its_dev, event); +} + +static void its_irq_domain_free(struct irq_domain *domain, unsigned int virq, + unsigned int nr_irqs) +{ + struct irq_data *d = irq_domain_get_irq_data(domain, virq); + struct its_device *its_dev = irq_data_get_irq_chip_data(d); + struct its_node *its = its_dev->its; + int i; + + bitmap_release_region(its_dev->event_map.lpi_map, + its_get_event_id(irq_domain_get_irq_data(domain, virq)), + get_count_order(nr_irqs)); + + for (i = 0; i < nr_irqs; i++) { + struct irq_data *data = irq_domain_get_irq_data(domain, + virq + i); + /* Nuke the entry in the domain */ + irq_domain_reset_irq_data(data); + } + + mutex_lock(&its->dev_alloc_lock); + + /* + * If all interrupts have been freed, start mopping the + * floor. This is conditioned on the device not being shared. + */ + if (!its_dev->shared && + bitmap_empty(its_dev->event_map.lpi_map, + its_dev->event_map.nr_lpis)) { + its_lpi_free(its_dev->event_map.lpi_map, + its_dev->event_map.lpi_base, + its_dev->event_map.nr_lpis); + + /* Unmap device/itt */ + its_send_mapd(its_dev, 0); + its_free_device(its_dev); + } + + mutex_unlock(&its->dev_alloc_lock); + + irq_domain_free_irqs_parent(domain, virq, nr_irqs); +} + +static const struct irq_domain_ops its_domain_ops = { + .alloc = its_irq_domain_alloc, + .free = its_irq_domain_free, + .activate = its_irq_domain_activate, + .deactivate = its_irq_domain_deactivate, +}; + +/* + * This is insane. + * + * If a GICv4.0 doesn't implement Direct LPIs (which is extremely + * likely), the only way to perform an invalidate is to use a fake + * device to issue an INV command, implying that the LPI has first + * been mapped to some event on that device. Since this is not exactly + * cheap, we try to keep that mapping around as long as possible, and + * only issue an UNMAP if we're short on available slots. + * + * Broken by design(tm). + * + * GICv4.1, on the other hand, mandates that we're able to invalidate + * by writing to a MMIO register. It doesn't implement the whole of + * DirectLPI, but that's good enough. And most of the time, we don't + * even have to invalidate anything, as the redistributor can be told + * whether to generate a doorbell or not (we thus leave it enabled, + * always). + */ +static void its_vpe_db_proxy_unmap_locked(struct its_vpe *vpe) +{ + /* GICv4.1 doesn't use a proxy, so nothing to do here */ + if (gic_rdists->has_rvpeid) + return; + + /* Already unmapped? */ + if (vpe->vpe_proxy_event == -1) + return; + + its_send_discard(vpe_proxy.dev, vpe->vpe_proxy_event); + vpe_proxy.vpes[vpe->vpe_proxy_event] = NULL; + + /* + * We don't track empty slots at all, so let's move the + * next_victim pointer if we can quickly reuse that slot + * instead of nuking an existing entry. Not clear that this is + * always a win though, and this might just generate a ripple + * effect... Let's just hope VPEs don't migrate too often. + */ + if (vpe_proxy.vpes[vpe_proxy.next_victim]) + vpe_proxy.next_victim = vpe->vpe_proxy_event; + + vpe->vpe_proxy_event = -1; +} + +static void its_vpe_db_proxy_unmap(struct its_vpe *vpe) +{ + /* GICv4.1 doesn't use a proxy, so nothing to do here */ + if (gic_rdists->has_rvpeid) + return; + + if (!gic_rdists->has_direct_lpi) { + unsigned long flags; + + raw_spin_lock_irqsave(&vpe_proxy.lock, flags); + its_vpe_db_proxy_unmap_locked(vpe); + raw_spin_unlock_irqrestore(&vpe_proxy.lock, flags); + } +} + +static void its_vpe_db_proxy_map_locked(struct its_vpe *vpe) +{ + /* GICv4.1 doesn't use a proxy, so nothing to do here */ + if (gic_rdists->has_rvpeid) + return; + + /* Already mapped? */ + if (vpe->vpe_proxy_event != -1) + return; + + /* This slot was already allocated. Kick the other VPE out. */ + if (vpe_proxy.vpes[vpe_proxy.next_victim]) + its_vpe_db_proxy_unmap_locked(vpe_proxy.vpes[vpe_proxy.next_victim]); + + /* Map the new VPE instead */ + vpe_proxy.vpes[vpe_proxy.next_victim] = vpe; + vpe->vpe_proxy_event = vpe_proxy.next_victim; + vpe_proxy.next_victim = (vpe_proxy.next_victim + 1) % vpe_proxy.dev->nr_ites; + + vpe_proxy.dev->event_map.col_map[vpe->vpe_proxy_event] = vpe->col_idx; + its_send_mapti(vpe_proxy.dev, vpe->vpe_db_lpi, vpe->vpe_proxy_event); +} + +static void its_vpe_db_proxy_move(struct its_vpe *vpe, int from, int to) +{ + unsigned long flags; + struct its_collection *target_col; + + /* GICv4.1 doesn't use a proxy, so nothing to do here */ + if (gic_rdists->has_rvpeid) + return; + + if (gic_rdists->has_direct_lpi) { + void __iomem *rdbase; + + rdbase = per_cpu_ptr(gic_rdists->rdist, from)->rd_base; + gic_write_lpir(vpe->vpe_db_lpi, rdbase + GICR_CLRLPIR); + wait_for_syncr(rdbase); + + return; + } + + raw_spin_lock_irqsave(&vpe_proxy.lock, flags); + + its_vpe_db_proxy_map_locked(vpe); + + target_col = &vpe_proxy.dev->its->collections[to]; + its_send_movi(vpe_proxy.dev, target_col, vpe->vpe_proxy_event); + vpe_proxy.dev->event_map.col_map[vpe->vpe_proxy_event] = to; + + raw_spin_unlock_irqrestore(&vpe_proxy.lock, flags); +} + +static int its_vpe_set_affinity(struct irq_data *d, + const struct cpumask *mask_val, + bool force) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + int from, cpu = cpumask_first(mask_val); + unsigned long flags; + + /* + * Changing affinity is mega expensive, so let's be as lazy as + * we can and only do it if we really have to. Also, if mapped + * into the proxy device, we need to move the doorbell + * interrupt to its new location. + * + * Another thing is that changing the affinity of a vPE affects + * *other interrupts* such as all the vLPIs that are routed to + * this vPE. This means that the irq_desc lock is not enough to + * protect us, and that we must ensure nobody samples vpe->col_idx + * during the update, hence the lock below which must also be + * taken on any vLPI handling path that evaluates vpe->col_idx. + */ + from = vpe_to_cpuid_lock(vpe, &flags); + if (from == cpu) + goto out; + + vpe->col_idx = cpu; + + /* + * GICv4.1 allows us to skip VMOVP if moving to a cpu whose RD + * is sharing its VPE table with the current one. + */ + if (gic_data_rdist_cpu(cpu)->vpe_table_mask && + cpumask_test_cpu(from, gic_data_rdist_cpu(cpu)->vpe_table_mask)) + goto out; + + its_send_vmovp(vpe); + its_vpe_db_proxy_move(vpe, from, cpu); + +out: + irq_data_update_effective_affinity(d, cpumask_of(cpu)); + vpe_to_cpuid_unlock(vpe, flags); + + return IRQ_SET_MASK_OK_DONE; +} + +static void its_wait_vpt_parse_complete(void) +{ + void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); + u64 val; + + if (!gic_rdists->has_vpend_valid_dirty) + return; + + WARN_ON_ONCE(readq_relaxed_poll_timeout_atomic(vlpi_base + GICR_VPENDBASER, + val, + !(val & GICR_VPENDBASER_Dirty), + 1, 500)); +} + +static void its_vpe_schedule(struct its_vpe *vpe) +{ + void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); + u64 val; + + /* Schedule the VPE */ + val = virt_to_phys(page_address(vpe->its_vm->vprop_page)) & + GENMASK_ULL(51, 12); + val |= (LPI_NRBITS - 1) & GICR_VPROPBASER_IDBITS_MASK; + val |= GICR_VPROPBASER_RaWb; + val |= GICR_VPROPBASER_InnerShareable; + gicr_write_vpropbaser(val, vlpi_base + GICR_VPROPBASER); + + val = virt_to_phys(page_address(vpe->vpt_page)) & + GENMASK_ULL(51, 16); + val |= GICR_VPENDBASER_RaWaWb; + val |= GICR_VPENDBASER_InnerShareable; + /* + * There is no good way of finding out if the pending table is + * empty as we can race against the doorbell interrupt very + * easily. So in the end, vpe->pending_last is only an + * indication that the vcpu has something pending, not one + * that the pending table is empty. A good implementation + * would be able to read its coarse map pretty quickly anyway, + * making this a tolerable issue. + */ + val |= GICR_VPENDBASER_PendingLast; + val |= vpe->idai ? GICR_VPENDBASER_IDAI : 0; + val |= GICR_VPENDBASER_Valid; + gicr_write_vpendbaser(val, vlpi_base + GICR_VPENDBASER); +} + +static void its_vpe_deschedule(struct its_vpe *vpe) +{ + void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); + u64 val; + + val = its_clear_vpend_valid(vlpi_base, 0, 0); + + vpe->idai = !!(val & GICR_VPENDBASER_IDAI); + vpe->pending_last = !!(val & GICR_VPENDBASER_PendingLast); +} + +static void its_vpe_invall(struct its_vpe *vpe) +{ + struct its_node *its; + + list_for_each_entry(its, &its_nodes, entry) { + if (!is_v4(its)) + continue; + + if (its_list_map && !vpe->its_vm->vlpi_count[its->list_nr]) + continue; + + /* + * Sending a VINVALL to a single ITS is enough, as all + * we need is to reach the redistributors. + */ + its_send_vinvall(its, vpe); + return; + } +} + +static int its_vpe_set_vcpu_affinity(struct irq_data *d, void *vcpu_info) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + struct its_cmd_info *info = vcpu_info; + + switch (info->cmd_type) { + case SCHEDULE_VPE: + its_vpe_schedule(vpe); + return 0; + + case DESCHEDULE_VPE: + its_vpe_deschedule(vpe); + return 0; + + case COMMIT_VPE: + its_wait_vpt_parse_complete(); + return 0; + + case INVALL_VPE: + its_vpe_invall(vpe); + return 0; + + default: + return -EINVAL; + } +} + +static void its_vpe_send_cmd(struct its_vpe *vpe, + void (*cmd)(struct its_device *, u32)) +{ + unsigned long flags; + + raw_spin_lock_irqsave(&vpe_proxy.lock, flags); + + its_vpe_db_proxy_map_locked(vpe); + cmd(vpe_proxy.dev, vpe->vpe_proxy_event); + + raw_spin_unlock_irqrestore(&vpe_proxy.lock, flags); +} + +static void its_vpe_send_inv(struct irq_data *d) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + + if (gic_rdists->has_direct_lpi) { + void __iomem *rdbase; + + /* Target the redistributor this VPE is currently known on */ + raw_spin_lock(&gic_data_rdist_cpu(vpe->col_idx)->rd_lock); + rdbase = per_cpu_ptr(gic_rdists->rdist, vpe->col_idx)->rd_base; + gic_write_lpir(d->parent_data->hwirq, rdbase + GICR_INVLPIR); + wait_for_syncr(rdbase); + raw_spin_unlock(&gic_data_rdist_cpu(vpe->col_idx)->rd_lock); + } else { + its_vpe_send_cmd(vpe, its_send_inv); + } +} + +static void its_vpe_mask_irq(struct irq_data *d) +{ + /* + * We need to unmask the LPI, which is described by the parent + * irq_data. Instead of calling into the parent (which won't + * exactly do the right thing, let's simply use the + * parent_data pointer. Yes, I'm naughty. + */ + lpi_write_config(d->parent_data, LPI_PROP_ENABLED, 0); + its_vpe_send_inv(d); +} + +static void its_vpe_unmask_irq(struct irq_data *d) +{ + /* Same hack as above... */ + lpi_write_config(d->parent_data, 0, LPI_PROP_ENABLED); + its_vpe_send_inv(d); +} + +static int its_vpe_set_irqchip_state(struct irq_data *d, + enum irqchip_irq_state which, + bool state) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + + if (which != IRQCHIP_STATE_PENDING) + return -EINVAL; + + if (gic_rdists->has_direct_lpi) { + void __iomem *rdbase; + + rdbase = per_cpu_ptr(gic_rdists->rdist, vpe->col_idx)->rd_base; + if (state) { + gic_write_lpir(vpe->vpe_db_lpi, rdbase + GICR_SETLPIR); + } else { + gic_write_lpir(vpe->vpe_db_lpi, rdbase + GICR_CLRLPIR); + wait_for_syncr(rdbase); + } + } else { + if (state) + its_vpe_send_cmd(vpe, its_send_int); + else + its_vpe_send_cmd(vpe, its_send_clear); + } + + return 0; +} + +static int its_vpe_retrigger(struct irq_data *d) +{ + return !its_vpe_set_irqchip_state(d, IRQCHIP_STATE_PENDING, true); +} + +static struct irq_chip its_vpe_irq_chip = { + .name = "GICv4-vpe", + .irq_mask = its_vpe_mask_irq, + .irq_unmask = its_vpe_unmask_irq, + .irq_eoi = irq_chip_eoi_parent, + .irq_set_affinity = its_vpe_set_affinity, + .irq_retrigger = its_vpe_retrigger, + .irq_set_irqchip_state = its_vpe_set_irqchip_state, + .irq_set_vcpu_affinity = its_vpe_set_vcpu_affinity, +}; + +static struct its_node *find_4_1_its(void) +{ + static struct its_node *its = NULL; + + if (!its) { + list_for_each_entry(its, &its_nodes, entry) { + if (is_v4_1(its)) + return its; + } + + /* Oops? */ + its = NULL; + } + + return its; +} + +static void its_vpe_4_1_send_inv(struct irq_data *d) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + struct its_node *its; + + /* + * GICv4.1 wants doorbells to be invalidated using the + * INVDB command in order to be broadcast to all RDs. Send + * it to the first valid ITS, and let the HW do its magic. + */ + its = find_4_1_its(); + if (its) + its_send_invdb(its, vpe); +} + +static void its_vpe_4_1_mask_irq(struct irq_data *d) +{ + lpi_write_config(d->parent_data, LPI_PROP_ENABLED, 0); + its_vpe_4_1_send_inv(d); +} + +static void its_vpe_4_1_unmask_irq(struct irq_data *d) +{ + lpi_write_config(d->parent_data, 0, LPI_PROP_ENABLED); + its_vpe_4_1_send_inv(d); +} + +static void its_vpe_4_1_schedule(struct its_vpe *vpe, + struct its_cmd_info *info) +{ + void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); + u64 val = 0; + + /* Schedule the VPE */ + val |= GICR_VPENDBASER_Valid; + val |= info->g0en ? GICR_VPENDBASER_4_1_VGRP0EN : 0; + val |= info->g1en ? GICR_VPENDBASER_4_1_VGRP1EN : 0; + val |= FIELD_PREP(GICR_VPENDBASER_4_1_VPEID, vpe->vpe_id); + + gicr_write_vpendbaser(val, vlpi_base + GICR_VPENDBASER); +} + +static void its_vpe_4_1_deschedule(struct its_vpe *vpe, + struct its_cmd_info *info) +{ + void __iomem *vlpi_base = gic_data_rdist_vlpi_base(); + u64 val; + + if (info->req_db) { + unsigned long flags; + + /* + * vPE is going to block: make the vPE non-resident with + * PendingLast clear and DB set. The GIC guarantees that if + * we read-back PendingLast clear, then a doorbell will be + * delivered when an interrupt comes. + * + * Note the locking to deal with the concurrent update of + * pending_last from the doorbell interrupt handler that can + * run concurrently. + */ + raw_spin_lock_irqsave(&vpe->vpe_lock, flags); + val = its_clear_vpend_valid(vlpi_base, + GICR_VPENDBASER_PendingLast, + GICR_VPENDBASER_4_1_DB); + vpe->pending_last = !!(val & GICR_VPENDBASER_PendingLast); + raw_spin_unlock_irqrestore(&vpe->vpe_lock, flags); + } else { + /* + * We're not blocking, so just make the vPE non-resident + * with PendingLast set, indicating that we'll be back. + */ + val = its_clear_vpend_valid(vlpi_base, + 0, + GICR_VPENDBASER_PendingLast); + vpe->pending_last = true; + } +} + +static void its_vpe_4_1_invall(struct its_vpe *vpe) +{ + void __iomem *rdbase; + unsigned long flags; + u64 val; + int cpu; + + val = GICR_INVALLR_V; + val |= FIELD_PREP(GICR_INVALLR_VPEID, vpe->vpe_id); + + /* Target the redistributor this vPE is currently known on */ + cpu = vpe_to_cpuid_lock(vpe, &flags); + raw_spin_lock(&gic_data_rdist_cpu(cpu)->rd_lock); + rdbase = per_cpu_ptr(gic_rdists->rdist, cpu)->rd_base; + gic_write_lpir(val, rdbase + GICR_INVALLR); + + wait_for_syncr(rdbase); + raw_spin_unlock(&gic_data_rdist_cpu(cpu)->rd_lock); + vpe_to_cpuid_unlock(vpe, flags); +} + +static int its_vpe_4_1_set_vcpu_affinity(struct irq_data *d, void *vcpu_info) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + struct its_cmd_info *info = vcpu_info; + + switch (info->cmd_type) { + case SCHEDULE_VPE: + its_vpe_4_1_schedule(vpe, info); + return 0; + + case DESCHEDULE_VPE: + its_vpe_4_1_deschedule(vpe, info); + return 0; + + case COMMIT_VPE: + its_wait_vpt_parse_complete(); + return 0; + + case INVALL_VPE: + its_vpe_4_1_invall(vpe); + return 0; + + default: + return -EINVAL; + } +} + +static struct irq_chip its_vpe_4_1_irq_chip = { + .name = "GICv4.1-vpe", + .irq_mask = its_vpe_4_1_mask_irq, + .irq_unmask = its_vpe_4_1_unmask_irq, + .irq_eoi = irq_chip_eoi_parent, + .irq_set_affinity = its_vpe_set_affinity, + .irq_set_vcpu_affinity = its_vpe_4_1_set_vcpu_affinity, +}; + +static void its_configure_sgi(struct irq_data *d, bool clear) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + struct its_cmd_desc desc; + + desc.its_vsgi_cmd.vpe = vpe; + desc.its_vsgi_cmd.sgi = d->hwirq; + desc.its_vsgi_cmd.priority = vpe->sgi_config[d->hwirq].priority; + desc.its_vsgi_cmd.enable = vpe->sgi_config[d->hwirq].enabled; + desc.its_vsgi_cmd.group = vpe->sgi_config[d->hwirq].group; + desc.its_vsgi_cmd.clear = clear; + + /* + * GICv4.1 allows us to send VSGI commands to any ITS as long as the + * destination VPE is mapped there. Since we map them eagerly at + * activation time, we're pretty sure the first GICv4.1 ITS will do. + */ + its_send_single_vcommand(find_4_1_its(), its_build_vsgi_cmd, &desc); +} + +static void its_sgi_mask_irq(struct irq_data *d) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + + vpe->sgi_config[d->hwirq].enabled = false; + its_configure_sgi(d, false); +} + +static void its_sgi_unmask_irq(struct irq_data *d) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + + vpe->sgi_config[d->hwirq].enabled = true; + its_configure_sgi(d, false); +} + +static int its_sgi_set_affinity(struct irq_data *d, + const struct cpumask *mask_val, + bool force) +{ + /* + * There is no notion of affinity for virtual SGIs, at least + * not on the host (since they can only be targeting a vPE). + * Tell the kernel we've done whatever it asked for. + */ + irq_data_update_effective_affinity(d, mask_val); + return IRQ_SET_MASK_OK; +} + +static int its_sgi_set_irqchip_state(struct irq_data *d, + enum irqchip_irq_state which, + bool state) +{ + if (which != IRQCHIP_STATE_PENDING) + return -EINVAL; + + if (state) { + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + struct its_node *its = find_4_1_its(); + u64 val; + + val = FIELD_PREP(GITS_SGIR_VPEID, vpe->vpe_id); + val |= FIELD_PREP(GITS_SGIR_VINTID, d->hwirq); + writeq_relaxed(val, its->sgir_base + GITS_SGIR - SZ_128K); + } else { + its_configure_sgi(d, true); + } + + return 0; +} + +static int its_sgi_get_irqchip_state(struct irq_data *d, + enum irqchip_irq_state which, bool *val) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + void __iomem *base; + unsigned long flags; + u32 count = 1000000; /* 1s! */ + u32 status; + int cpu; + + if (which != IRQCHIP_STATE_PENDING) + return -EINVAL; + + /* + * Locking galore! We can race against two different events: + * + * - Concurrent vPE affinity change: we must make sure it cannot + * happen, or we'll talk to the wrong redistributor. This is + * identical to what happens with vLPIs. + * + * - Concurrent VSGIPENDR access: As it involves accessing two + * MMIO registers, this must be made atomic one way or another. + */ + cpu = vpe_to_cpuid_lock(vpe, &flags); + raw_spin_lock(&gic_data_rdist_cpu(cpu)->rd_lock); + base = gic_data_rdist_cpu(cpu)->rd_base + SZ_128K; + writel_relaxed(vpe->vpe_id, base + GICR_VSGIR); + do { + status = readl_relaxed(base + GICR_VSGIPENDR); + if (!(status & GICR_VSGIPENDR_BUSY)) + goto out; + + count--; + if (!count) { + pr_err_ratelimited("Unable to get SGI status\n"); + goto out; + } + cpu_relax(); + udelay(1); + } while (count); + +out: + raw_spin_unlock(&gic_data_rdist_cpu(cpu)->rd_lock); + vpe_to_cpuid_unlock(vpe, flags); + + if (!count) + return -ENXIO; + + *val = !!(status & (1 << d->hwirq)); + + return 0; +} + +static int its_sgi_set_vcpu_affinity(struct irq_data *d, void *vcpu_info) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + struct its_cmd_info *info = vcpu_info; + + switch (info->cmd_type) { + case PROP_UPDATE_VSGI: + vpe->sgi_config[d->hwirq].priority = info->priority; + vpe->sgi_config[d->hwirq].group = info->group; + its_configure_sgi(d, false); + return 0; + + default: + return -EINVAL; + } +} + +static struct irq_chip its_sgi_irq_chip = { + .name = "GICv4.1-sgi", + .irq_mask = its_sgi_mask_irq, + .irq_unmask = its_sgi_unmask_irq, + .irq_set_affinity = its_sgi_set_affinity, + .irq_set_irqchip_state = its_sgi_set_irqchip_state, + .irq_get_irqchip_state = its_sgi_get_irqchip_state, + .irq_set_vcpu_affinity = its_sgi_set_vcpu_affinity, +}; + +static int its_sgi_irq_domain_alloc(struct irq_domain *domain, + unsigned int virq, unsigned int nr_irqs, + void *args) +{ + struct its_vpe *vpe = args; + int i; + + /* Yes, we do want 16 SGIs */ + WARN_ON(nr_irqs != 16); + + for (i = 0; i < 16; i++) { + vpe->sgi_config[i].priority = 0; + vpe->sgi_config[i].enabled = false; + vpe->sgi_config[i].group = false; + + irq_domain_set_hwirq_and_chip(domain, virq + i, i, + &its_sgi_irq_chip, vpe); + irq_set_status_flags(virq + i, IRQ_DISABLE_UNLAZY); + } + + return 0; +} + +static void its_sgi_irq_domain_free(struct irq_domain *domain, + unsigned int virq, + unsigned int nr_irqs) +{ + /* Nothing to do */ +} + +static int its_sgi_irq_domain_activate(struct irq_domain *domain, + struct irq_data *d, bool reserve) +{ + /* Write out the initial SGI configuration */ + its_configure_sgi(d, false); + return 0; +} + +static void its_sgi_irq_domain_deactivate(struct irq_domain *domain, + struct irq_data *d) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + + /* + * The VSGI command is awkward: + * + * - To change the configuration, CLEAR must be set to false, + * leaving the pending bit unchanged. + * - To clear the pending bit, CLEAR must be set to true, leaving + * the configuration unchanged. + * + * You just can't do both at once, hence the two commands below. + */ + vpe->sgi_config[d->hwirq].enabled = false; + its_configure_sgi(d, false); + its_configure_sgi(d, true); +} + +static const struct irq_domain_ops its_sgi_domain_ops = { + .alloc = its_sgi_irq_domain_alloc, + .free = its_sgi_irq_domain_free, + .activate = its_sgi_irq_domain_activate, + .deactivate = its_sgi_irq_domain_deactivate, +}; + +static int its_vpe_id_alloc(void) +{ + return ida_simple_get(&its_vpeid_ida, 0, ITS_MAX_VPEID, GFP_KERNEL); +} + +static void its_vpe_id_free(u16 id) +{ + ida_simple_remove(&its_vpeid_ida, id); +} + +static int its_vpe_init(struct its_vpe *vpe) +{ + struct page *vpt_page; + int vpe_id; + + /* Allocate vpe_id */ + vpe_id = its_vpe_id_alloc(); + if (vpe_id < 0) + return vpe_id; + + /* Allocate VPT */ + vpt_page = its_allocate_pending_table(GFP_KERNEL); + if (!vpt_page) { + its_vpe_id_free(vpe_id); + return -ENOMEM; + } + + if (!its_alloc_vpe_table(vpe_id)) { + its_vpe_id_free(vpe_id); + its_free_pending_table(vpt_page); + return -ENOMEM; + } + + raw_spin_lock_init(&vpe->vpe_lock); + vpe->vpe_id = vpe_id; + vpe->vpt_page = vpt_page; + if (gic_rdists->has_rvpeid) + atomic_set(&vpe->vmapp_count, 0); + else + vpe->vpe_proxy_event = -1; + + return 0; +} + +static void its_vpe_teardown(struct its_vpe *vpe) +{ + its_vpe_db_proxy_unmap(vpe); + its_vpe_id_free(vpe->vpe_id); + its_free_pending_table(vpe->vpt_page); +} + +static void its_vpe_irq_domain_free(struct irq_domain *domain, + unsigned int virq, + unsigned int nr_irqs) +{ + struct its_vm *vm = domain->host_data; + int i; + + irq_domain_free_irqs_parent(domain, virq, nr_irqs); + + for (i = 0; i < nr_irqs; i++) { + struct irq_data *data = irq_domain_get_irq_data(domain, + virq + i); + struct its_vpe *vpe = irq_data_get_irq_chip_data(data); + + BUG_ON(vm != vpe->its_vm); + + clear_bit(data->hwirq, vm->db_bitmap); + its_vpe_teardown(vpe); + irq_domain_reset_irq_data(data); + } + + if (bitmap_empty(vm->db_bitmap, vm->nr_db_lpis)) { + its_lpi_free(vm->db_bitmap, vm->db_lpi_base, vm->nr_db_lpis); + its_free_prop_table(vm->vprop_page); + } +} + +static int its_vpe_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, + unsigned int nr_irqs, void *args) +{ + struct irq_chip *irqchip = &its_vpe_irq_chip; + struct its_vm *vm = args; + unsigned long *bitmap; + struct page *vprop_page; + int base, nr_ids, i, err = 0; + + BUG_ON(!vm); + + bitmap = its_lpi_alloc(roundup_pow_of_two(nr_irqs), &base, &nr_ids); + if (!bitmap) + return -ENOMEM; + + if (nr_ids < nr_irqs) { + its_lpi_free(bitmap, base, nr_ids); + return -ENOMEM; + } + + vprop_page = its_allocate_prop_table(GFP_KERNEL); + if (!vprop_page) { + its_lpi_free(bitmap, base, nr_ids); + return -ENOMEM; + } + + vm->db_bitmap = bitmap; + vm->db_lpi_base = base; + vm->nr_db_lpis = nr_ids; + vm->vprop_page = vprop_page; + + if (gic_rdists->has_rvpeid) + irqchip = &its_vpe_4_1_irq_chip; + + for (i = 0; i < nr_irqs; i++) { + vm->vpes[i]->vpe_db_lpi = base + i; + err = its_vpe_init(vm->vpes[i]); + if (err) + break; + err = its_irq_gic_domain_alloc(domain, virq + i, + vm->vpes[i]->vpe_db_lpi); + if (err) + break; + irq_domain_set_hwirq_and_chip(domain, virq + i, i, + irqchip, vm->vpes[i]); + set_bit(i, bitmap); + } + + if (err) { + if (i > 0) + its_vpe_irq_domain_free(domain, virq, i); + + its_lpi_free(bitmap, base, nr_ids); + its_free_prop_table(vprop_page); + } + + return err; +} + +static int its_vpe_irq_domain_activate(struct irq_domain *domain, + struct irq_data *d, bool reserve) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + struct its_node *its; + + /* + * If we use the list map, we issue VMAPP on demand... Unless + * we're on a GICv4.1 and we eagerly map the VPE on all ITSs + * so that VSGIs can work. + */ + if (!gic_requires_eager_mapping()) + return 0; + + /* Map the VPE to the first possible CPU */ + vpe->col_idx = cpumask_first(cpu_online_mask); + + list_for_each_entry(its, &its_nodes, entry) { + if (!is_v4(its)) + continue; + + its_send_vmapp(its, vpe, true); + its_send_vinvall(its, vpe); + } + + irq_data_update_effective_affinity(d, cpumask_of(vpe->col_idx)); + + return 0; +} + +static void its_vpe_irq_domain_deactivate(struct irq_domain *domain, + struct irq_data *d) +{ + struct its_vpe *vpe = irq_data_get_irq_chip_data(d); + struct its_node *its; + + /* + * If we use the list map on GICv4.0, we unmap the VPE once no + * VLPIs are associated with the VM. + */ + if (!gic_requires_eager_mapping()) + return; + + list_for_each_entry(its, &its_nodes, entry) { + if (!is_v4(its)) + continue; + + its_send_vmapp(its, vpe, false); + } + + /* + * There may be a direct read to the VPT after unmapping the + * vPE, to guarantee the validity of this, we make the VPT + * memory coherent with the CPU caches here. + */ + if (find_4_1_its() && !atomic_read(&vpe->vmapp_count)) + gic_flush_dcache_to_poc(page_address(vpe->vpt_page), + LPI_PENDBASE_SZ); +} + +static const struct irq_domain_ops its_vpe_domain_ops = { + .alloc = its_vpe_irq_domain_alloc, + .free = its_vpe_irq_domain_free, + .activate = its_vpe_irq_domain_activate, + .deactivate = its_vpe_irq_domain_deactivate, +}; + +static int its_force_quiescent(void __iomem *base) +{ + u32 count = 1000000; /* 1s */ + u32 val; + + val = readl_relaxed(base + GITS_CTLR); + /* + * GIC architecture specification requires the ITS to be both + * disabled and quiescent for writes to GITS_BASER or + * GITS_CBASER to not have UNPREDICTABLE results. + */ + if ((val & GITS_CTLR_QUIESCENT) && !(val & GITS_CTLR_ENABLE)) + return 0; + + /* Disable the generation of all interrupts to this ITS */ + val &= ~(GITS_CTLR_ENABLE | GITS_CTLR_ImDe); + writel_relaxed(val, base + GITS_CTLR); + + /* Poll GITS_CTLR and wait until ITS becomes quiescent */ + while (1) { + val = readl_relaxed(base + GITS_CTLR); + if (val & GITS_CTLR_QUIESCENT) + return 0; + + count--; + if (!count) + return -EBUSY; + + cpu_relax(); + udelay(1); + } +} + +static bool __maybe_unused its_enable_quirk_cavium_22375(void *data) +{ + struct its_node *its = data; + + /* erratum 22375: only alloc 8MB table size (20 bits) */ + its->typer &= ~GITS_TYPER_DEVBITS; + its->typer |= FIELD_PREP(GITS_TYPER_DEVBITS, 20 - 1); + its->flags |= ITS_FLAGS_WORKAROUND_CAVIUM_22375; + + return true; +} + +static bool __maybe_unused its_enable_quirk_cavium_23144(void *data) +{ + struct its_node *its = data; + + its->flags |= ITS_FLAGS_WORKAROUND_CAVIUM_23144; + + return true; +} + +static bool __maybe_unused its_enable_quirk_qdf2400_e0065(void *data) +{ + struct its_node *its = data; + + /* On QDF2400, the size of the ITE is 16Bytes */ + its->typer &= ~GITS_TYPER_ITT_ENTRY_SIZE; + its->typer |= FIELD_PREP(GITS_TYPER_ITT_ENTRY_SIZE, 16 - 1); + + return true; +} + +static u64 its_irq_get_msi_base_pre_its(struct its_device *its_dev) +{ + struct its_node *its = its_dev->its; + + /* + * The Socionext Synquacer SoC has a so-called 'pre-ITS', + * which maps 32-bit writes targeted at a separate window of + * size '4 << device_id_bits' onto writes to GITS_TRANSLATER + * with device ID taken from bits [device_id_bits + 1:2] of + * the window offset. + */ + return its->pre_its_base + (its_dev->device_id << 2); +} + +static bool __maybe_unused its_enable_quirk_socionext_synquacer(void *data) +{ + struct its_node *its = data; + u32 pre_its_window[2]; + u32 ids; + + if (!fwnode_property_read_u32_array(its->fwnode_handle, + "socionext,synquacer-pre-its", + pre_its_window, + ARRAY_SIZE(pre_its_window))) { + + its->pre_its_base = pre_its_window[0]; + its->get_msi_base = its_irq_get_msi_base_pre_its; + + ids = ilog2(pre_its_window[1]) - 2; + if (device_ids(its) > ids) { + its->typer &= ~GITS_TYPER_DEVBITS; + its->typer |= FIELD_PREP(GITS_TYPER_DEVBITS, ids - 1); + } + + /* the pre-ITS breaks isolation, so disable MSI remapping */ + its->msi_domain_flags &= ~IRQ_DOMAIN_FLAG_ISOLATED_MSI; + return true; + } + return false; +} + +static bool __maybe_unused its_enable_quirk_hip07_161600802(void *data) +{ + struct its_node *its = data; + + /* + * Hip07 insists on using the wrong address for the VLPI + * page. Trick it into doing the right thing... + */ + its->vlpi_redist_offset = SZ_128K; + return true; +} + +static const struct gic_quirk its_quirks[] = { +#ifdef CONFIG_CAVIUM_ERRATUM_22375 + { + .desc = "ITS: Cavium errata 22375, 24313", + .iidr = 0xa100034c, /* ThunderX pass 1.x */ + .mask = 0xffff0fff, + .init = its_enable_quirk_cavium_22375, + }, +#endif +#ifdef CONFIG_CAVIUM_ERRATUM_23144 + { + .desc = "ITS: Cavium erratum 23144", + .iidr = 0xa100034c, /* ThunderX pass 1.x */ + .mask = 0xffff0fff, + .init = its_enable_quirk_cavium_23144, + }, +#endif +#ifdef CONFIG_QCOM_QDF2400_ERRATUM_0065 + { + .desc = "ITS: QDF2400 erratum 0065", + .iidr = 0x00001070, /* QDF2400 ITS rev 1.x */ + .mask = 0xffffffff, + .init = its_enable_quirk_qdf2400_e0065, + }, +#endif +#ifdef CONFIG_SOCIONEXT_SYNQUACER_PREITS + { + /* + * The Socionext Synquacer SoC incorporates ARM's own GIC-500 + * implementation, but with a 'pre-ITS' added that requires + * special handling in software. + */ + .desc = "ITS: Socionext Synquacer pre-ITS", + .iidr = 0x0001143b, + .mask = 0xffffffff, + .init = its_enable_quirk_socionext_synquacer, + }, +#endif +#ifdef CONFIG_HISILICON_ERRATUM_161600802 + { + .desc = "ITS: Hip07 erratum 161600802", + .iidr = 0x00000004, + .mask = 0xffffffff, + .init = its_enable_quirk_hip07_161600802, + }, +#endif + { + } +}; + +static void its_enable_quirks(struct its_node *its) +{ + u32 iidr = readl_relaxed(its->base + GITS_IIDR); + + gic_enable_quirks(iidr, its_quirks, its); +} + +static int its_save_disable(void) +{ + struct its_node *its; + int err = 0; + + raw_spin_lock(&its_lock); + list_for_each_entry(its, &its_nodes, entry) { + void __iomem *base; + + base = its->base; + its->ctlr_save = readl_relaxed(base + GITS_CTLR); + err = its_force_quiescent(base); + if (err) { + pr_err("ITS@%pa: failed to quiesce: %d\n", + &its->phys_base, err); + writel_relaxed(its->ctlr_save, base + GITS_CTLR); + goto err; + } + + its->cbaser_save = gits_read_cbaser(base + GITS_CBASER); + } + +err: + if (err) { + list_for_each_entry_continue_reverse(its, &its_nodes, entry) { + void __iomem *base; + + base = its->base; + writel_relaxed(its->ctlr_save, base + GITS_CTLR); + } + } + raw_spin_unlock(&its_lock); + + return err; +} + +static void its_restore_enable(void) +{ + struct its_node *its; + int ret; + + raw_spin_lock(&its_lock); + list_for_each_entry(its, &its_nodes, entry) { + void __iomem *base; + int i; + + base = its->base; + + /* + * Make sure that the ITS is disabled. If it fails to quiesce, + * don't restore it since writing to CBASER or BASER + * registers is undefined according to the GIC v3 ITS + * Specification. + * + * Firmware resuming with the ITS enabled is terminally broken. + */ + WARN_ON(readl_relaxed(base + GITS_CTLR) & GITS_CTLR_ENABLE); + ret = its_force_quiescent(base); + if (ret) { + pr_err("ITS@%pa: failed to quiesce on resume: %d\n", + &its->phys_base, ret); + continue; + } + + gits_write_cbaser(its->cbaser_save, base + GITS_CBASER); + + /* + * Writing CBASER resets CREADR to 0, so make CWRITER and + * cmd_write line up with it. + */ + its->cmd_write = its->cmd_base; + gits_write_cwriter(0, base + GITS_CWRITER); + + /* Restore GITS_BASER from the value cache. */ + for (i = 0; i < GITS_BASER_NR_REGS; i++) { + struct its_baser *baser = &its->tables[i]; + + if (!(baser->val & GITS_BASER_VALID)) + continue; + + its_write_baser(its, baser, baser->val); + } + writel_relaxed(its->ctlr_save, base + GITS_CTLR); + + /* + * Reinit the collection if it's stored in the ITS. This is + * indicated by the col_id being less than the HCC field. + * CID < HCC as specified in the GIC v3 Documentation. + */ + if (its->collections[smp_processor_id()].col_id < + GITS_TYPER_HCC(gic_read_typer(base + GITS_TYPER))) + its_cpu_init_collection(its); + } + raw_spin_unlock(&its_lock); +} + +static struct syscore_ops its_syscore_ops = { + .suspend = its_save_disable, + .resume = its_restore_enable, +}; + +static void __init __iomem *its_map_one(struct resource *res, int *err) +{ + void __iomem *its_base; + u32 val; + + its_base = ioremap(res->start, SZ_64K); + if (!its_base) { + pr_warn("ITS@%pa: Unable to map ITS registers\n", &res->start); + *err = -ENOMEM; + return NULL; + } + + val = readl_relaxed(its_base + GITS_PIDR2) & GIC_PIDR2_ARCH_MASK; + if (val != 0x30 && val != 0x40) { + pr_warn("ITS@%pa: No ITS detected, giving up\n", &res->start); + *err = -ENODEV; + goto out_unmap; + } + + *err = its_force_quiescent(its_base); + if (*err) { + pr_warn("ITS@%pa: Failed to quiesce, giving up\n", &res->start); + goto out_unmap; + } + + return its_base; + +out_unmap: + iounmap(its_base); + return NULL; +} + +static int its_init_domain(struct fwnode_handle *handle, struct its_node *its) +{ + struct irq_domain *inner_domain; + struct msi_domain_info *info; + + info = kzalloc(sizeof(*info), GFP_KERNEL); + if (!info) + return -ENOMEM; + + inner_domain = irq_domain_create_tree(handle, &its_domain_ops, its); + if (!inner_domain) { + kfree(info); + return -ENOMEM; + } + + inner_domain->parent = its_parent; + irq_domain_update_bus_token(inner_domain, DOMAIN_BUS_NEXUS); + inner_domain->flags |= its->msi_domain_flags; + info->ops = &its_msi_domain_ops; + info->data = its; + inner_domain->host_data = info; + + return 0; +} + +static int its_init_vpe_domain(void) +{ + struct its_node *its; + u32 devid; + int entries; + + if (gic_rdists->has_direct_lpi) { + pr_info("ITS: Using DirectLPI for VPE invalidation\n"); + return 0; + } + + /* Any ITS will do, even if not v4 */ + its = list_first_entry(&its_nodes, struct its_node, entry); + + entries = roundup_pow_of_two(nr_cpu_ids); + vpe_proxy.vpes = kcalloc(entries, sizeof(*vpe_proxy.vpes), + GFP_KERNEL); + if (!vpe_proxy.vpes) + return -ENOMEM; + + /* Use the last possible DevID */ + devid = GENMASK(device_ids(its) - 1, 0); + vpe_proxy.dev = its_create_device(its, devid, entries, false); + if (!vpe_proxy.dev) { + kfree(vpe_proxy.vpes); + pr_err("ITS: Can't allocate GICv4 proxy device\n"); + return -ENOMEM; + } + + BUG_ON(entries > vpe_proxy.dev->nr_ites); + + raw_spin_lock_init(&vpe_proxy.lock); + vpe_proxy.next_victim = 0; + pr_info("ITS: Allocated DevID %x as GICv4 proxy device (%d slots)\n", + devid, vpe_proxy.dev->nr_ites); + + return 0; +} + +static int __init its_compute_its_list_map(struct resource *res, + void __iomem *its_base) +{ + int its_number; + u32 ctlr; + + /* + * This is assumed to be done early enough that we're + * guaranteed to be single-threaded, hence no + * locking. Should this change, we should address + * this. + */ + its_number = find_first_zero_bit(&its_list_map, GICv4_ITS_LIST_MAX); + if (its_number >= GICv4_ITS_LIST_MAX) { + pr_err("ITS@%pa: No ITSList entry available!\n", + &res->start); + return -EINVAL; + } + + ctlr = readl_relaxed(its_base + GITS_CTLR); + ctlr &= ~GITS_CTLR_ITS_NUMBER; + ctlr |= its_number << GITS_CTLR_ITS_NUMBER_SHIFT; + writel_relaxed(ctlr, its_base + GITS_CTLR); + ctlr = readl_relaxed(its_base + GITS_CTLR); + if ((ctlr & GITS_CTLR_ITS_NUMBER) != (its_number << GITS_CTLR_ITS_NUMBER_SHIFT)) { + its_number = ctlr & GITS_CTLR_ITS_NUMBER; + its_number >>= GITS_CTLR_ITS_NUMBER_SHIFT; + } + + if (test_and_set_bit(its_number, &its_list_map)) { + pr_err("ITS@%pa: Duplicate ITSList entry %d\n", + &res->start, its_number); + return -EINVAL; + } + + return its_number; +} + +static int __init its_probe_one(struct resource *res, + struct fwnode_handle *handle, int numa_node) +{ + struct its_node *its; + void __iomem *its_base; + u64 baser, tmp, typer; + struct page *page; + u32 ctlr; + int err; + + its_base = its_map_one(res, &err); + if (!its_base) + return err; + + pr_info("ITS %pR\n", res); + + its = kzalloc(sizeof(*its), GFP_KERNEL); + if (!its) { + err = -ENOMEM; + goto out_unmap; + } + + raw_spin_lock_init(&its->lock); + mutex_init(&its->dev_alloc_lock); + INIT_LIST_HEAD(&its->entry); + INIT_LIST_HEAD(&its->its_device_list); + typer = gic_read_typer(its_base + GITS_TYPER); + its->typer = typer; + its->base = its_base; + its->phys_base = res->start; + if (is_v4(its)) { + if (!(typer & GITS_TYPER_VMOVP)) { + err = its_compute_its_list_map(res, its_base); + if (err < 0) + goto out_free_its; + + its->list_nr = err; + + pr_info("ITS@%pa: Using ITS number %d\n", + &res->start, err); + } else { + pr_info("ITS@%pa: Single VMOVP capable\n", &res->start); + } + + if (is_v4_1(its)) { + u32 svpet = FIELD_GET(GITS_TYPER_SVPET, typer); + + its->sgir_base = ioremap(res->start + SZ_128K, SZ_64K); + if (!its->sgir_base) { + err = -ENOMEM; + goto out_free_its; + } + + its->mpidr = readl_relaxed(its_base + GITS_MPIDR); + + pr_info("ITS@%pa: Using GICv4.1 mode %08x %08x\n", + &res->start, its->mpidr, svpet); + } + } + + its->numa_node = numa_node; + + page = alloc_pages_node(its->numa_node, GFP_KERNEL | __GFP_ZERO, + get_order(ITS_CMD_QUEUE_SZ)); + if (!page) { + err = -ENOMEM; + goto out_unmap_sgir; + } + its->cmd_base = (void *)page_address(page); + its->cmd_write = its->cmd_base; + its->fwnode_handle = handle; + its->get_msi_base = its_irq_get_msi_base; + its->msi_domain_flags = IRQ_DOMAIN_FLAG_ISOLATED_MSI; + + its_enable_quirks(its); + + err = its_alloc_tables(its); + if (err) + goto out_free_cmd; + + err = its_alloc_collections(its); + if (err) + goto out_free_tables; + + baser = (virt_to_phys(its->cmd_base) | + GITS_CBASER_RaWaWb | + GITS_CBASER_InnerShareable | + (ITS_CMD_QUEUE_SZ / SZ_4K - 1) | + GITS_CBASER_VALID); + + gits_write_cbaser(baser, its->base + GITS_CBASER); + tmp = gits_read_cbaser(its->base + GITS_CBASER); + + if ((tmp ^ baser) & GITS_CBASER_SHAREABILITY_MASK) { + if (!(tmp & GITS_CBASER_SHAREABILITY_MASK)) { + /* + * The HW reports non-shareable, we must + * remove the cacheability attributes as + * well. + */ + baser &= ~(GITS_CBASER_SHAREABILITY_MASK | + GITS_CBASER_CACHEABILITY_MASK); + baser |= GITS_CBASER_nC; + gits_write_cbaser(baser, its->base + GITS_CBASER); + } + pr_info("ITS: using cache flushing for cmd queue\n"); + its->flags |= ITS_FLAGS_CMDQ_NEEDS_FLUSHING; + } + + gits_write_cwriter(0, its->base + GITS_CWRITER); + ctlr = readl_relaxed(its->base + GITS_CTLR); + ctlr |= GITS_CTLR_ENABLE; + if (is_v4(its)) + ctlr |= GITS_CTLR_ImDe; + writel_relaxed(ctlr, its->base + GITS_CTLR); + + err = its_init_domain(handle, its); + if (err) + goto out_free_tables; + + raw_spin_lock(&its_lock); + list_add(&its->entry, &its_nodes); + raw_spin_unlock(&its_lock); + + return 0; + +out_free_tables: + its_free_tables(its); +out_free_cmd: + free_pages((unsigned long)its->cmd_base, get_order(ITS_CMD_QUEUE_SZ)); +out_unmap_sgir: + if (its->sgir_base) + iounmap(its->sgir_base); +out_free_its: + kfree(its); +out_unmap: + iounmap(its_base); + pr_err("ITS@%pa: failed probing (%d)\n", &res->start, err); + return err; +} + +static bool gic_rdists_supports_plpis(void) +{ + return !!(gic_read_typer(gic_data_rdist_rd_base() + GICR_TYPER) & GICR_TYPER_PLPIS); +} + +static int redist_disable_lpis(void) +{ + void __iomem *rbase = gic_data_rdist_rd_base(); + u64 timeout = USEC_PER_SEC; + u64 val; + + if (!gic_rdists_supports_plpis()) { + pr_info("CPU%d: LPIs not supported\n", smp_processor_id()); + return -ENXIO; + } + + val = readl_relaxed(rbase + GICR_CTLR); + if (!(val & GICR_CTLR_ENABLE_LPIS)) + return 0; + + /* + * If coming via a CPU hotplug event, we don't need to disable + * LPIs before trying to re-enable them. They are already + * configured and all is well in the world. + * + * If running with preallocated tables, there is nothing to do. + */ + if ((gic_data_rdist()->flags & RD_LOCAL_LPI_ENABLED) || + (gic_rdists->flags & RDIST_FLAGS_RD_TABLES_PREALLOCATED)) + return 0; + + /* + * From that point on, we only try to do some damage control. + */ + pr_warn("GIC-2500: CPU%d: Booted with LPIs enabled, memory probably corrupted\n", + smp_processor_id()); + add_taint(TAINT_CRAP, LOCKDEP_STILL_OK); + + /* Disable LPIs */ + val &= ~GICR_CTLR_ENABLE_LPIS; + writel_relaxed(val, rbase + GICR_CTLR); + + /* Make sure any change to GICR_CTLR is observable by the GIC */ + dsb(sy); + + /* + * Software must observe RWP==0 after clearing GICR_CTLR.EnableLPIs + * from 1 to 0 before programming GICR_PEND{PROP}BASER registers. + * Error out if we time out waiting for RWP to clear. + */ + while (readl_relaxed(rbase + GICR_CTLR) & GICR_CTLR_RWP) { + if (!timeout) { + pr_err("CPU%d: Timeout while disabling LPIs\n", + smp_processor_id()); + return -ETIMEDOUT; + } + udelay(1); + timeout--; + } + + /* + * After it has been written to 1, it is IMPLEMENTATION + * DEFINED whether GICR_CTLR.EnableLPI becomes RES1 or can be + * cleared to 0. Error out if clearing the bit failed. + */ + if (readl_relaxed(rbase + GICR_CTLR) & GICR_CTLR_ENABLE_LPIS) { + pr_err("CPU%d: Failed to disable LPIs\n", smp_processor_id()); + return -EBUSY; + } + + return 0; +} + +int phytium_its_cpu_init(void) +{ + if (!list_empty(&its_nodes)) { + int ret; + + ret = redist_disable_lpis(); + if (ret) + return ret; + + its_cpu_init_lpis(); + its_cpu_init_collections(); + } + + return 0; +} + +static void rdist_memreserve_cpuhp_cleanup_workfn(struct work_struct *work) +{ + cpuhp_remove_state_nocalls(gic_rdists->cpuhp_memreserve_state); + gic_rdists->cpuhp_memreserve_state = CPUHP_INVALID; +} + +static DECLARE_WORK(rdist_memreserve_cpuhp_cleanup_work, + rdist_memreserve_cpuhp_cleanup_workfn); + +static int its_cpu_memreserve_lpi(unsigned int cpu) +{ + struct page *pend_page; + int ret = 0; + + /* This gets to run exactly once per CPU */ + if (gic_data_rdist()->flags & RD_LOCAL_MEMRESERVE_DONE) + return 0; + + pend_page = gic_data_rdist()->pend_page; + if (WARN_ON(!pend_page)) { + ret = -ENOMEM; + goto out; + } + /* + * If the pending table was pre-programmed, free the memory we + * preemptively allocated. Otherwise, reserve that memory for + * later kexecs. + */ + if (gic_data_rdist()->flags & RD_LOCAL_PENDTABLE_PREALLOCATED) { + its_free_pending_table(pend_page); + gic_data_rdist()->pend_page = NULL; + } else { + phys_addr_t paddr = page_to_phys(pend_page); + + WARN_ON(gic_reserve_range(paddr, LPI_PENDBASE_SZ)); + } + +out: + /* Last CPU being brought up gets to issue the cleanup */ + if (!IS_ENABLED(CONFIG_SMP) || + cpumask_equal(&cpus_booted_once_mask, cpu_possible_mask)) + schedule_work(&rdist_memreserve_cpuhp_cleanup_work); + + gic_data_rdist()->flags |= RD_LOCAL_MEMRESERVE_DONE; + return ret; +} + +/* Mark all the BASER registers as invalid before they get reprogrammed */ +static int __init its_reset_one(struct resource *res) +{ + void __iomem *its_base; + int err, i; + + its_base = its_map_one(res, &err); + if (!its_base) + return err; + + for (i = 0; i < GITS_BASER_NR_REGS; i++) + gits_write_baser(0, its_base + GITS_BASER + (i << 3)); + + iounmap(its_base); + return 0; +} + +static const struct of_device_id its_device_id[] = { + { .compatible = "arm,gic-s2500-its", }, + {}, +}; + +static int __init its_of_probe(struct device_node *node) +{ + struct device_node *np; + struct resource res; + + /* + * Make sure *all* the ITS are reset before we probe any, as + * they may be sharing memory. If any of the ITS fails to + * reset, don't even try to go any further, as this could + * result in something even worse. + */ + for (np = of_find_matching_node(node, its_device_id); np; + np = of_find_matching_node(np, its_device_id)) { + int err; + + if (!of_device_is_available(np) || + !of_property_read_bool(np, "msi-controller") || + of_address_to_resource(np, 0, &res)) + continue; + + err = its_reset_one(&res); + if (err) + return err; + } + + for (np = of_find_matching_node(node, its_device_id); np; + np = of_find_matching_node(np, its_device_id)) { + if (!of_device_is_available(np)) + continue; + if (!of_property_read_bool(np, "msi-controller")) { + pr_warn("%pOF: no msi-controller property, ITS ignored\n", + np); + continue; + } + + if (of_address_to_resource(np, 0, &res)) { + pr_warn("%pOF: no regs?\n", np); + continue; + } + + its_probe_one(&res, &np->fwnode, of_node_to_nid(np)); + } + return 0; +} + +#ifdef CONFIG_ACPI + +#define ACPI_GICV3_ITS_MEM_SIZE (SZ_128K) + +#ifdef CONFIG_ACPI_NUMA +struct its_srat_map { + /* numa node id */ + u32 numa_node; + /* GIC ITS ID */ + u32 its_id; +}; + +static struct its_srat_map *its_srat_maps __initdata; +static int its_in_srat __initdata; + +static int __init acpi_get_its_numa_node(u32 its_id) +{ + int i; + + for (i = 0; i < its_in_srat; i++) { + if (its_id == its_srat_maps[i].its_id) + return its_srat_maps[i].numa_node; + } + return NUMA_NO_NODE; +} + +static int __init gic_acpi_match_srat_its(union acpi_subtable_headers *header, + const unsigned long end) +{ + return 0; +} + +static int __init gic_acpi_parse_srat_its(union acpi_subtable_headers *header, + const unsigned long end) +{ + int node; + struct acpi_srat_gic_its_affinity *its_affinity; + + its_affinity = (struct acpi_srat_gic_its_affinity *)header; + if (!its_affinity) + return -EINVAL; + + if (its_affinity->header.length < sizeof(*its_affinity)) { + pr_err("SRAT: Invalid header length %d in ITS affinity\n", + its_affinity->header.length); + return -EINVAL; + } + + /* + * Note that in theory a new proximity node could be created by this + * entry as it is an SRAT resource allocation structure. + * We do not currently support doing so. + */ + node = pxm_to_node(its_affinity->proximity_domain); + + if (node == NUMA_NO_NODE || node >= MAX_NUMNODES) { + pr_err("SRAT: Invalid NUMA node %d in ITS affinity\n", node); + return 0; + } + + its_srat_maps[its_in_srat].numa_node = node; + its_srat_maps[its_in_srat].its_id = its_affinity->its_id; + its_in_srat++; + pr_info("SRAT: PXM %d -> ITS %d -> Node %d\n", + its_affinity->proximity_domain, its_affinity->its_id, node); + + return 0; +} + +static void __init acpi_table_parse_srat_its(void) +{ + int count; + + count = acpi_table_parse_entries(ACPI_SIG_SRAT, + sizeof(struct acpi_table_srat), + ACPI_SRAT_TYPE_GIC_ITS_AFFINITY, + gic_acpi_match_srat_its, 0); + if (count <= 0) + return; + + its_srat_maps = kmalloc_array(count, sizeof(struct its_srat_map), + GFP_KERNEL); + if (!its_srat_maps) + return; + + acpi_table_parse_entries(ACPI_SIG_SRAT, + sizeof(struct acpi_table_srat), + ACPI_SRAT_TYPE_GIC_ITS_AFFINITY, + gic_acpi_parse_srat_its, 0); +} + +/* free the its_srat_maps after ITS probing */ +static void __init acpi_its_srat_maps_free(void) +{ + kfree(its_srat_maps); +} +#else +static void __init acpi_table_parse_srat_its(void) { } +static int __init acpi_get_its_numa_node(u32 its_id) { return NUMA_NO_NODE; } +static void __init acpi_its_srat_maps_free(void) { } +#endif + +static int __init gic_acpi_parse_madt_its(union acpi_subtable_headers *header, + const unsigned long end) +{ + struct acpi_madt_generic_translator *its_entry; + struct fwnode_handle *dom_handle; + struct resource res; + int err; + + its_entry = (struct acpi_madt_generic_translator *)header; + memset(&res, 0, sizeof(res)); + res.start = its_entry->base_address; + res.end = its_entry->base_address + ACPI_GICV3_ITS_MEM_SIZE - 1; + res.flags = IORESOURCE_MEM; + + dom_handle = irq_domain_alloc_fwnode(&res.start); + if (!dom_handle) { + pr_err("ITS@%pa: Unable to allocate GIC-phytium-S2500 ITS domain token\n", + &res.start); + return -ENOMEM; + } + + err = iort_register_domain_token(its_entry->translation_id, res.start, + dom_handle); + if (err) { + pr_err("ITS@%pa: Unable to register GIC-Phytium-S2500 ITS domain token (ITS ID %d) to IORT\n", + &res.start, its_entry->translation_id); + goto dom_err; + } + + err = its_probe_one(&res, dom_handle, + acpi_get_its_numa_node(its_entry->translation_id)); + if (!err) + return 0; + + iort_deregister_domain_token(its_entry->translation_id); +dom_err: + irq_domain_free_fwnode(dom_handle); + return err; +} + +static int __init its_acpi_reset(union acpi_subtable_headers *header, + const unsigned long end) +{ + struct acpi_madt_generic_translator *its_entry; + struct resource res; + + its_entry = (struct acpi_madt_generic_translator *)header; + res = (struct resource) { + .start = its_entry->base_address, + .end = its_entry->base_address + ACPI_GICV3_ITS_MEM_SIZE - 1, + .flags = IORESOURCE_MEM, + }; + + return its_reset_one(&res); +} + +static void __init its_acpi_probe(void) +{ + acpi_table_parse_srat_its(); + /* + * Make sure *all* the ITS are reset before we probe any, as + * they may be sharing memory. If any of the ITS fails to + * reset, don't even try to go any further, as this could + * result in something even worse. + */ + if (acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_TRANSLATOR, + its_acpi_reset, 0) > 0) + acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_TRANSLATOR, + gic_acpi_parse_madt_its, 0); + acpi_its_srat_maps_free(); +} +#else +static void __init its_acpi_probe(void) { } +#endif + +int __init phytium_its_lpi_memreserve_init(void) +{ + int state; + + if (!efi_enabled(EFI_CONFIG_TABLES)) + return 0; + + if (list_empty(&its_nodes)) + return 0; + + gic_rdists->cpuhp_memreserve_state = CPUHP_INVALID; + state = cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, + "irqchip/arm/gic-2500/memreserve:online", + its_cpu_memreserve_lpi, + NULL); + if (state < 0) + return state; + + gic_rdists->cpuhp_memreserve_state = state; + + return 0; +} +int __init phytium_its_init(struct fwnode_handle *handle, struct rdists *rdists, + struct irq_domain *parent_domain) +{ + struct device_node *of_node; + struct its_node *its; + bool has_v4 = false; + bool has_v4_1 = false; + int err; + + gic_rdists = rdists; + + its_parent = parent_domain; + of_node = to_of_node(handle); + if (of_node) + its_of_probe(of_node); + else + its_acpi_probe(); + + if (list_empty(&its_nodes)) { + pr_warn("ITS: No ITS available, not enabling LPIs\n"); + return -ENXIO; + } + + err = allocate_lpi_tables(); + if (err) + return err; + + list_for_each_entry(its, &its_nodes, entry) { + has_v4 |= is_v4(its); + has_v4_1 |= is_v4_1(its); + } + + /* Don't bother with inconsistent systems */ + if (WARN_ON(!has_v4_1 && rdists->has_rvpeid)) + rdists->has_rvpeid = false; + + if (has_v4 & rdists->has_vlpis) { + const struct irq_domain_ops *sgi_ops; + + if (has_v4_1) + sgi_ops = &its_sgi_domain_ops; + else + sgi_ops = NULL; + + if (its_init_vpe_domain() || + its_init_v4(parent_domain, &its_vpe_domain_ops, sgi_ops)) { + rdists->has_vlpis = false; + pr_err("ITS: Disabling GICv4 support\n"); + } + } + + register_syscore_ops(&its_syscore_ops); + + return 0; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/irq-gic-phytium-2500.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/irq-gic-phytium-2500.c new file mode 100644 index 0000000000000000000000000000000000000000..b16dbb4166248640793c48ca7a4013cd6fa12f2a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/irq-gic-phytium-2500.c @@ -0,0 +1,2604 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#define pr_fmt(fmt) "GIC-2500: " fmt + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include + +#include +#include +#include +#include + +#include "irq-gic-common.h" +#include + +#define MAX_MARS3_SOC_COUNT 8 +#define MARS3_ADDR_SKTID_SHIFT 41 + +struct gic_dist_desc { + void __iomem *dist_base; + phys_addr_t phys_base; + unsigned long size; +}; + +#define GICD_INT_NMI_PRI (GICD_INT_DEF_PRI & ~0x80) + +#define FLAGS_WORKAROUND_GICR_WAKER_MSM8996 (1ULL << 0) +#define FLAGS_WORKAROUND_CAVIUM_ERRATUM_38539 (1ULL << 1) + +#define GIC_IRQ_TYPE_PARTITION (GIC_IRQ_TYPE_LPI + 1) + +struct redist_region { + void __iomem *redist_base; + phys_addr_t phys_base; + bool single_redist; +}; + +static struct gic_dist_desc mars3_gic_dists[MAX_MARS3_SOC_COUNT] __read_mostly; + +static unsigned int mars3_sockets_bitmap = 0x1; + +#define mars3_irq_to_skt(hwirq) (((hwirq) - 32) % 8) + +struct gic_chip_data { + struct fwnode_handle *fwnode; + void __iomem *dist_base; + struct redist_region *redist_regions; + struct rdists rdists; + struct irq_domain *domain; + u64 redist_stride; + u32 nr_redist_regions; + u64 flags; + bool has_rss; + unsigned int ppi_nr; + struct partition_desc **ppi_descs; +}; + +static struct gic_chip_data gic_data __read_mostly; +static DEFINE_STATIC_KEY_TRUE(supports_deactivate_key); + +#define GIC_ID_NR (1U << GICD_TYPER_ID_BITS(gic_data.rdists.gicd_typer)) +#define GIC_LINE_NR min(GICD_TYPER_SPIS(gic_data.rdists.gicd_typer), 1020U) +#define GIC_ESPI_NR GICD_TYPER_ESPIS(gic_data.rdists.gicd_typer) + +/* + * The behaviours of RPR and PMR registers differ depending on the value of + * SCR_EL3.FIQ, and the behaviour of non-secure priority registers of the + * distributor and redistributors depends on whether security is enabled in the + * GIC. + * + * When security is enabled, non-secure priority values from the (re)distributor + * are presented to the GIC CPUIF as follow: + * (GIC_(R)DIST_PRI[irq] >> 1) | 0x80; + * + * If SCR_EL3.FIQ == 1, the values written to/read from PMR and RPR at non-secure + * EL1 are subject to a similar operation thus matching the priorities presented + * from the (re)distributor when security is enabled. When SCR_EL3.FIQ == 0, + * these values are unchanged by the GIC. + * + * see GICv3/GICv4 Architecture Specification (IHI0069D): + * - section 4.8.1 Non-secure accesses to register fields for Secure interrupt + * priorities. + * - Figure 4-7 Secure read of the priority field for a Non-secure Group 1 + * interrupt. + */ +static DEFINE_STATIC_KEY_FALSE(supports_pseudo_nmis); + +#ifndef CONFIG_ARM_GIC_V3 +/* + * Global static key controlling whether an update to PMR allowing more + * interrupts requires to be propagated to the redistributor (DSB SY). + * And this needs to be exported for modules to be able to enable + * interrupts... + */ +DEFINE_STATIC_KEY_FALSE(gic_pmr_sync); +EXPORT_SYMBOL(gic_pmr_sync); + +DEFINE_STATIC_KEY_FALSE(gic_nonsecure_priorities); +EXPORT_SYMBOL(gic_nonsecure_priorities); +#else +extern struct static_key_false gic_pmr_sync; +extern struct static_key_false gic_nonsecure_priorities; +#endif + +/* + * When the Non-secure world has access to group 0 interrupts (as a + * consequence of SCR_EL3.FIQ == 0), reading the ICC_RPR_EL1 register will + * return the Distributor's view of the interrupt priority. + * + * When GIC security is enabled (GICD_CTLR.DS == 0), the interrupt priority + * written by software is moved to the Non-secure range by the Distributor. + * + * If both are true (which is when gic_nonsecure_priorities gets enabled), + * we need to shift down the priority programmed by software to match it + * against the value returned by ICC_RPR_EL1. + */ +#define GICD_INT_RPR_PRI(priority) \ + ({ \ + u32 __priority = (priority); \ + if (static_branch_unlikely(&gic_nonsecure_priorities)) \ + __priority = 0x80 | (__priority >> 1); \ + \ + __priority; \ + }) + +/* ppi_nmi_refs[n] == number of cpus having ppi[n + 16] set as NMI */ +static refcount_t *ppi_nmi_refs; + +static struct gic_kvm_info gic_v3_kvm_info __initdata; +static DEFINE_PER_CPU(bool, has_rss); + +#define MPIDR_RS(mpidr) (((mpidr) & 0xF0UL) >> 4) +#define gic_data_rdist() (this_cpu_ptr(gic_data.rdists.rdist)) +#define gic_data_rdist_rd_base() (gic_data_rdist()->rd_base) +#define gic_data_rdist_sgi_base() (gic_data_rdist_rd_base() + SZ_64K) + +/* Our default, arbitrary priority value. Linux only uses one anyway. */ +#define DEFAULT_PMR_VALUE 0xf0 + +enum gic_intid_range { + SGI_RANGE, + PPI_RANGE, + SPI_RANGE, + EPPI_RANGE, + ESPI_RANGE, + LPI_RANGE, + __INVALID_RANGE__ +}; + +static enum gic_intid_range __get_intid_range(irq_hw_number_t hwirq) +{ + switch (hwirq) { + case 0 ... 15: + return SGI_RANGE; + case 16 ... 31: + return PPI_RANGE; + case 32 ... 1019: + return SPI_RANGE; + case EPPI_BASE_INTID ... (EPPI_BASE_INTID + 63): + return EPPI_RANGE; + case ESPI_BASE_INTID ... (ESPI_BASE_INTID + 1023): + return ESPI_RANGE; + case 8192 ... GENMASK(23, 0): + return LPI_RANGE; + default: + return __INVALID_RANGE__; + } +} + +static enum gic_intid_range get_intid_range(struct irq_data *d) +{ + return __get_intid_range(d->hwirq); +} + +static inline unsigned int gic_irq(struct irq_data *d) +{ + return d->hwirq; +} + +static inline bool gic_irq_in_rdist(struct irq_data *d) +{ + switch (get_intid_range(d)) { + case SGI_RANGE: + case PPI_RANGE: + case EPPI_RANGE: + return true; + default: + return false; + } +} + +static inline void __iomem *gic_dist_base(struct irq_data *d) +{ + switch (get_intid_range(d)) { + case SGI_RANGE: + case PPI_RANGE: + case EPPI_RANGE: + /* SGI+PPI -> SGI_base for this CPU */ + return gic_data_rdist_sgi_base(); + + case SPI_RANGE: + case ESPI_RANGE: + /* SPI -> dist_base */ + return gic_data.dist_base; + + default: + return NULL; + } +} + +static void gic_do_wait_for_rwp(void __iomem *base, u32 bit) +{ + u32 count = 1000000; /* 1s! */ + + while (readl_relaxed(base + GICD_CTLR) & bit) { + count--; + if (!count) { + pr_err_ratelimited("RWP timeout, gone fishing\n"); + return; + } + cpu_relax(); + udelay(1); + } +} + +/* Wait for completion of a distributor change */ +static void gic_dist_wait_for_rwp(void) +{ + gic_do_wait_for_rwp(gic_data.dist_base, GICD_CTLR_RWP); +} + +/* Wait for completion of a redistributor change */ +static void gic_redist_wait_for_rwp(void) +{ + gic_do_wait_for_rwp(gic_data_rdist_rd_base(), GICR_CTLR_RWP); +} + +#ifdef CONFIG_ARM64 + +static u64 __maybe_unused gic_read_iar(void) +{ + if (cpus_have_const_cap(ARM64_WORKAROUND_CAVIUM_23154)) + return gic_read_iar_cavium_thunderx(); + else + return gic_read_iar_common(); +} +#endif + +static void gic_enable_redist(bool enable) +{ + void __iomem *rbase; + u32 count = 1000000; /* 1s! */ + u32 val; + unsigned long mpidr; + int i; + + if (gic_data.flags & FLAGS_WORKAROUND_GICR_WAKER_MSM8996) + return; + + rbase = gic_data_rdist_rd_base(); + + val = readl_relaxed(rbase + GICR_WAKER); + if (enable) + /* Wake up this CPU redistributor */ + val &= ~GICR_WAKER_ProcessorSleep; + else + val |= GICR_WAKER_ProcessorSleep; + writel_relaxed(val, rbase + GICR_WAKER); + + if (!enable) { /* Check that GICR_WAKER is writeable */ + val = readl_relaxed(rbase + GICR_WAKER); + if (!(val & GICR_WAKER_ProcessorSleep)) + return; /* No PM support in this redistributor */ + } + + while (--count) { + val = readl_relaxed(rbase + GICR_WAKER); + if (enable ^ (bool)(val & GICR_WAKER_ChildrenAsleep)) + break; + cpu_relax(); + udelay(1); + } + if (!count) + pr_err_ratelimited("redistributor failed to %s...\n", + enable ? "wakeup" : "sleep"); + + mpidr = (unsigned long)cpu_logical_map(smp_processor_id()); + + /* Either Aff0 or Aff1 is not zero */ + if (mpidr & 0xffff) + return; + + /* Skip 64 Redistributors */ + rbase = rbase + 64 * SZ_128K; + + for (i = 0; i < 4; i++) { + val = readl_relaxed(rbase + GICR_WAKER); + if (enable) + val &= ~GICR_WAKER_ProcessorSleep; + else + val |= GICR_WAKER_ProcessorSleep; + writel_relaxed(val, rbase + GICR_WAKER); + + if (!enable) { + val = readl_relaxed(rbase + GICR_WAKER); + if (!(val & GICR_WAKER_ProcessorSleep)) + return; + } + + count = 1000000; /* 1s! */ + while (--count) { + val = readl_relaxed(rbase + GICR_WAKER); + if (enable ^ (bool)(val & GICR_WAKER_ChildrenAsleep)) + break; + cpu_relax(); + udelay(1); + }; + + if (!count) + pr_err_ratelimited("CPU MPIDR 0x%lx: redistributor %d failed to %s...\n", + mpidr, 64 + i, enable ? "wakeup" : "sleep"); + + rbase = rbase + SZ_128K; + } +} + +/* + * Routines to disable, enable, EOI and route interrupts + */ +static u32 convert_offset_index(struct irq_data *d, u32 offset, u32 *index) +{ + switch (get_intid_range(d)) { + case SGI_RANGE: + case PPI_RANGE: + case SPI_RANGE: + *index = d->hwirq; + return offset; + case EPPI_RANGE: + /* + * Contrary to the ESPI range, the EPPI range is contiguous + * to the PPI range in the registers, so let's adjust the + * displacement accordingly. Consistency is overrated. + */ + *index = d->hwirq - EPPI_BASE_INTID + 32; + return offset; + case ESPI_RANGE: + *index = d->hwirq - ESPI_BASE_INTID; + switch (offset) { + case GICD_ISENABLER: + return GICD_ISENABLERnE; + case GICD_ICENABLER: + return GICD_ICENABLERnE; + case GICD_ISPENDR: + return GICD_ISPENDRnE; + case GICD_ICPENDR: + return GICD_ICPENDRnE; + case GICD_ISACTIVER: + return GICD_ISACTIVERnE; + case GICD_ICACTIVER: + return GICD_ICACTIVERnE; + case GICD_IPRIORITYR: + return GICD_IPRIORITYRnE; + case GICD_ICFGR: + return GICD_ICFGRnE; + case GICD_IROUTER: + return GICD_IROUTERnE; + default: + break; + } + break; + default: + break; + } + + WARN_ON(1); + *index = d->hwirq; + return offset; +} + +static int gic_peek_irq(struct irq_data *d, u32 offset) +{ + void __iomem *base; + u32 index, mask, skt; + + offset = convert_offset_index(d, offset, &index); + mask = 1 << (index % 32); + + if (gic_irq_in_rdist(d)) + base = gic_data_rdist_sgi_base(); + else { + skt = mars3_irq_to_skt(gic_irq(d)); + base = mars3_gic_dists[skt].dist_base; + } + + return !!(readl_relaxed(base + offset + (index / 32) * 4) & mask); +} + +static void gic_poke_irq(struct irq_data *d, u32 offset) +{ + void __iomem *base, *rbase; + unsigned long mpidr; + int i; + u32 index, mask, skt; + + offset = convert_offset_index(d, offset, &index); + mask = 1 << (index % 32); + + if (gic_irq_in_rdist(d)) { + base = gic_data_rdist_sgi_base(); + + writel_relaxed(mask, base + offset + (index / 32) * 4); + gic_redist_wait_for_rwp(); + + mpidr = (unsigned long)cpu_logical_map(smp_processor_id()); + + if ((mpidr & 0xffff) == 0) { + rbase = base + 64*SZ_128K; + + for (i = 0; i < 4; i++) { + writel_relaxed(mask, rbase + offset + (index / 32) * 4); + gic_do_wait_for_rwp(rbase - SZ_64K, GICR_CTLR_RWP); + rbase = rbase + SZ_128K; + } + } + } else { + skt = mars3_irq_to_skt(gic_irq(d)); + base = mars3_gic_dists[skt].dist_base; + writel_relaxed(mask, base + offset + (index / 32) * 4); + gic_do_wait_for_rwp(base, GICD_CTLR_RWP); + } +} + +static void gic_mask_irq(struct irq_data *d) +{ + gic_poke_irq(d, GICD_ICENABLER); + if (gic_irq_in_rdist(d)) + gic_redist_wait_for_rwp(); + else + gic_dist_wait_for_rwp(); +} + +static void gic_eoimode1_mask_irq(struct irq_data *d) +{ + gic_mask_irq(d); + /* + * When masking a forwarded interrupt, make sure it is + * deactivated as well. + * + * This ensures that an interrupt that is getting + * disabled/masked will not get "stuck", because there is + * noone to deactivate it (guest is being terminated). + */ + if (irqd_is_forwarded_to_vcpu(d)) + gic_poke_irq(d, GICD_ICACTIVER); +} + +static void gic_unmask_irq(struct irq_data *d) +{ + gic_poke_irq(d, GICD_ISENABLER); +} + +static inline bool gic_supports_nmi(void) +{ + return IS_ENABLED(CONFIG_ARM64_PSEUDO_NMI) && + static_branch_likely(&supports_pseudo_nmis); +} + +static int gic_irq_set_irqchip_state(struct irq_data *d, + enum irqchip_irq_state which, bool val) +{ + u32 reg; + + if (d->hwirq >= 8192) /* SGI/PPI/SPI only */ + return -EINVAL; + + switch (which) { + case IRQCHIP_STATE_PENDING: + reg = val ? GICD_ISPENDR : GICD_ICPENDR; + break; + + case IRQCHIP_STATE_ACTIVE: + reg = val ? GICD_ISACTIVER : GICD_ICACTIVER; + break; + + case IRQCHIP_STATE_MASKED: + if (val) { + gic_mask_irq(d); + return 0; + } + reg = GICD_ISENABLER; + break; + + default: + return -EINVAL; + } + + gic_poke_irq(d, reg); + return 0; +} + +static int gic_irq_get_irqchip_state(struct irq_data *d, + enum irqchip_irq_state which, bool *val) +{ + if (d->hwirq >= 8192) /* PPI/SPI only */ + return -EINVAL; + + switch (which) { + case IRQCHIP_STATE_PENDING: + *val = gic_peek_irq(d, GICD_ISPENDR); + break; + + case IRQCHIP_STATE_ACTIVE: + *val = gic_peek_irq(d, GICD_ISACTIVER); + break; + + case IRQCHIP_STATE_MASKED: + *val = !gic_peek_irq(d, GICD_ISENABLER); + break; + + default: + return -EINVAL; + } + + return 0; +} + +static void gic_irq_set_prio(struct irq_data *d, u8 prio) +{ + void __iomem *base = gic_dist_base(d); + u32 offset, index; + + offset = convert_offset_index(d, GICD_IPRIORITYR, &index); + + writeb_relaxed(prio, base + offset + index); +} + +static u32 __gic_get_ppi_index(irq_hw_number_t hwirq) +{ + switch (__get_intid_range(hwirq)) { + case PPI_RANGE: + return hwirq - 16; + case EPPI_RANGE: + return hwirq - EPPI_BASE_INTID + 16; + default: + unreachable(); + } +} + +static u32 gic_get_ppi_index(struct irq_data *d) +{ + return __gic_get_ppi_index(d->hwirq); +} + +static int gic_irq_nmi_setup(struct irq_data *d) +{ + struct irq_desc *desc = irq_to_desc(d->irq); + + if (!gic_supports_nmi()) + return -EINVAL; + + if (gic_peek_irq(d, GICD_ISENABLER)) { + pr_err("Cannot set NMI property of enabled IRQ %u\n", d->irq); + return -EINVAL; + } + + /* + * A secondary irq_chip should be in charge of LPI request, + * it should not be possible to get there + */ + if (WARN_ON(gic_irq(d) >= 8192)) + return -EINVAL; + + /* desc lock should already be held */ + if (gic_irq_in_rdist(d)) { + u32 idx = gic_get_ppi_index(d); + + /* Setting up PPI as NMI, only switch handler for first NMI */ + if (!refcount_inc_not_zero(&ppi_nmi_refs[idx])) { + refcount_set(&ppi_nmi_refs[idx], 1); + desc->handle_irq = handle_percpu_devid_fasteoi_nmi; + } + } else { + desc->handle_irq = handle_fasteoi_nmi; + } + + gic_irq_set_prio(d, GICD_INT_NMI_PRI); + + return 0; +} + +static void gic_irq_nmi_teardown(struct irq_data *d) +{ + struct irq_desc *desc = irq_to_desc(d->irq); + + if (WARN_ON(!gic_supports_nmi())) + return; + + if (gic_peek_irq(d, GICD_ISENABLER)) { + pr_err("Cannot set NMI property of enabled IRQ %u\n", d->irq); + return; + } + + /* + * A secondary irq_chip should be in charge of LPI request, + * it should not be possible to get there + */ + if (WARN_ON(gic_irq(d) >= 8192)) + return; + + /* desc lock should already be held */ + if (gic_irq_in_rdist(d)) { + u32 idx = gic_get_ppi_index(d); + + /* Tearing down NMI, only switch handler for last NMI */ + if (refcount_dec_and_test(&ppi_nmi_refs[idx])) + desc->handle_irq = handle_percpu_devid_irq; + } else { + desc->handle_irq = handle_fasteoi_irq; + } + + gic_irq_set_prio(d, GICD_INT_DEF_PRI); +} + +static void gic_eoi_irq(struct irq_data *d) +{ + write_gicreg(gic_irq(d), ICC_EOIR1_EL1); + isb(); +} + +static void gic_eoimode1_eoi_irq(struct irq_data *d) +{ + /* + * No need to deactivate an LPI, or an interrupt that + * is getting forwarded to a vcpu. + */ + if (gic_irq(d) >= 8192 || irqd_is_forwarded_to_vcpu(d)) + return; + gic_write_dir(gic_irq(d)); +} + +static int gic_set_type(struct irq_data *d, unsigned int type) +{ + enum gic_intid_range range; + unsigned int irq = gic_irq(d); + void __iomem *base, *rbase; + u32 offset, index, skt; + int ret, i; + unsigned long mpidr; + + range = get_intid_range(d); + /* Interrupt configuration for SGIs can't be changed */ + if (range == SGI_RANGE) + return type != IRQ_TYPE_EDGE_RISING ? -EINVAL : 0; + + /* SPIs have restrictions on the supported types */ + if ((range == SPI_RANGE || range == ESPI_RANGE) && + type != IRQ_TYPE_LEVEL_HIGH && type != IRQ_TYPE_EDGE_RISING) + return -EINVAL; + + offset = convert_offset_index(d, GICD_ICFGR, &index); + + if (gic_irq_in_rdist(d)) { + base = gic_data_rdist_sgi_base(); + ret = gic_configure_irq(index, type, base + offset, gic_redist_wait_for_rwp); + mpidr = (unsigned long)cpu_logical_map(smp_processor_id()); + + if ((mpidr & 0xffff) == 0) { + rbase = base + 64*SZ_128K; + + for (i = 0; i < 4; i++) { + ret = gic_configure_irq(index, type, rbase + offset, NULL); + gic_do_wait_for_rwp(rbase - SZ_64K, GICR_CTLR_RWP); + rbase = rbase + SZ_128K; + } + } + } else { + skt = mars3_irq_to_skt(gic_irq(d)); + base = mars3_gic_dists[skt].dist_base; + ret = gic_configure_irq(index, type, base + offset, NULL); + gic_do_wait_for_rwp(base, GICD_CTLR_RWP); + } + + + if (ret && (range == PPI_RANGE || range == EPPI_RANGE)) { + /* Misconfigured PPIs are usually not fatal */ + pr_warn("GIC: PPI INTID%d is secure or misconfigured\n", irq); + ret = 0; + } + + return ret; +} + +static int gic_irq_set_vcpu_affinity(struct irq_data *d, void *vcpu) +{ + if (get_intid_range(d) == SGI_RANGE) + return -EINVAL; + + if (vcpu) + irqd_set_forwarded_to_vcpu(d); + else + irqd_clr_forwarded_to_vcpu(d); + return 0; +} + +static u64 gic_mpidr_to_affinity(unsigned long mpidr) +{ + u64 aff; + + aff = ((u64)MPIDR_AFFINITY_LEVEL(mpidr, 3) << 32 | + MPIDR_AFFINITY_LEVEL(mpidr, 2) << 16 | + MPIDR_AFFINITY_LEVEL(mpidr, 1) << 8 | + MPIDR_AFFINITY_LEVEL(mpidr, 0)); + + return aff; +} + +static void gic_deactivate_unhandled(u32 irqnr) +{ + if (static_branch_likely(&supports_deactivate_key)) { + if (irqnr < 8192) + gic_write_dir(irqnr); + } else { + write_gicreg(irqnr, ICC_EOIR1_EL1); + isb(); + } +} + +/* + * Follow a read of the IAR with any HW maintenance that needs to happen prior + * to invoking the relevant IRQ handler. We must do two things: + * + * (1) Ensure instruction ordering between a read of IAR and subsequent + * instructions in the IRQ handler using an ISB. + * + * It is possible for the IAR to report an IRQ which was signalled *after* + * the CPU took an IRQ exception as multiple interrupts can race to be + * recognized by the GIC, earlier interrupts could be withdrawn, and/or + * later interrupts could be prioritized by the GIC. + * + * For devices which are tightly coupled to the CPU, such as PMUs, a + * context synchronization event is necessary to ensure that system + * register state is not stale, as these may have been indirectly written + * *after* exception entry. + * + * (2) Deactivate the interrupt when EOI mode 1 is in use. + */ +static inline void gic_complete_ack(u32 irqnr) +{ + if (static_branch_likely(&supports_deactivate_key)) + write_gicreg(irqnr, ICC_EOIR1_EL1); + + isb(); +} + +static bool gic_rpr_is_nmi_prio(void) +{ + if (!gic_supports_nmi()) + return false; + + return unlikely(gic_read_rpr() == GICD_INT_RPR_PRI(GICD_INT_NMI_PRI)); +} + +static bool gic_irqnr_is_special(u32 irqnr) +{ + return irqnr >= 1020 && irqnr <= 1023; +} + +static void __gic_handle_irq(u32 irqnr, struct pt_regs *regs) +{ + if (gic_irqnr_is_special(irqnr)) + return; + + gic_complete_ack(irqnr); + + if (generic_handle_domain_irq(gic_data.domain, irqnr)) { + WARN_ONCE(true, "Unexpected interrupt (irqnr %u)\n", irqnr); + gic_deactivate_unhandled(irqnr); + } +} + +static void __gic_handle_nmi(u32 irqnr, struct pt_regs *regs) +{ + if (gic_irqnr_is_special(irqnr)) + return; + + gic_complete_ack(irqnr); + + if (generic_handle_domain_nmi(gic_data.domain, irqnr)) { + WARN_ONCE(true, "Unexpected pseudo-NMI (irqnr %u)\n", irqnr); + gic_deactivate_unhandled(irqnr); + } +} + +/* + * An exception has been taken from a context with IRQs enabled, and this could + * be an IRQ or an NMI. + * + * The entry code called us with DAIF.IF set to keep NMIs masked. We must clear + * DAIF.IF (and update ICC_PMR_EL1 to mask regular IRQs) prior to returning, + * after handling any NMI but before handling any IRQ. + * + * The entry code has performed IRQ entry, and if an NMI is detected we must + * perform NMI entry/exit around invoking the handler. + */ +static void __gic_handle_irq_from_irqson(struct pt_regs *regs) +{ + bool is_nmi; + u32 irqnr; + + irqnr = gic_read_iar(); + + is_nmi = gic_rpr_is_nmi_prio(); + + if (is_nmi) { + nmi_enter(); + __gic_handle_nmi(irqnr, regs); + nmi_exit(); + } + + if (gic_prio_masking_enabled()) { + gic_pmr_mask_irqs(); + gic_arch_enable_irqs(); + } + + if (!is_nmi) + __gic_handle_irq(irqnr, regs); +} + +/* + * An exception has been taken from a context with IRQs disabled, which can only + * be an NMI. + * + * The entry code called us with DAIF.IF set to keep NMIs masked. We must leave + * DAIF.IF (and ICC_PMR_EL1) unchanged. + * + * The entry code has performed NMI entry. + */ +static void __gic_handle_irq_from_irqsoff(struct pt_regs *regs) +{ + u64 pmr; + u32 irqnr; + + /* + * We were in a context with IRQs disabled. However, the + * entry code has set PMR to a value that allows any + * interrupt to be acknowledged, and not just NMIs. This can + * lead to surprising effects if the NMI has been retired in + * the meantime, and that there is an IRQ pending. The IRQ + * would then be taken in NMI context, something that nobody + * wants to debug twice. + * + * Until we sort this, drop PMR again to a level that will + * actually only allow NMIs before reading IAR, and then + * restore it to what it was. + */ + pmr = gic_read_pmr(); + gic_pmr_mask_irqs(); + isb(); + irqnr = gic_read_iar(); + gic_write_pmr(pmr); + + __gic_handle_nmi(irqnr, regs); +} + +static asmlinkage void __exception_irq_entry gic_handle_irq(struct pt_regs *regs) +{ + if (unlikely(gic_supports_nmi() && !interrupts_enabled(regs))) + __gic_handle_irq_from_irqsoff(regs); + else + __gic_handle_irq_from_irqson(regs); +} + +static u32 gic_get_pribits(void) +{ + u32 pribits; + + pribits = gic_read_ctlr(); + pribits &= ICC_CTLR_EL1_PRI_BITS_MASK; + pribits >>= ICC_CTLR_EL1_PRI_BITS_SHIFT; + pribits++; + + return pribits; +} + +static bool gic_has_group0(void) +{ + u32 val; + u32 old_pmr; + + old_pmr = gic_read_pmr(); + + /* + * Let's find out if Group0 is under control of EL3 or not by + * setting the highest possible, non-zero priority in PMR. + * + * If SCR_EL3.FIQ is set, the priority gets shifted down in + * order for the CPU interface to set bit 7, and keep the + * actual priority in the non-secure range. In the process, it + * looses the least significant bit and the actual priority + * becomes 0x80. Reading it back returns 0, indicating that + * we're don't have access to Group0. + */ + gic_write_pmr(BIT(8 - gic_get_pribits())); + val = gic_read_pmr(); + + gic_write_pmr(old_pmr); + + return val != 0; +} + +static void __init gic_dist_init(void) +{ + unsigned int i; + u64 affinity; + void __iomem *base = gic_data.dist_base; + u32 val, skt; + + for (skt = 0; skt < MAX_MARS3_SOC_COUNT; skt++) { + if (((1U << skt) & mars3_sockets_bitmap) == 0) + continue; + + base = mars3_gic_dists[skt].dist_base; + + /* Disable the distributor */ + writel_relaxed(0, base + GICD_CTLR); + gic_do_wait_for_rwp(base, GICD_CTLR_RWP); + + /* + * Configure SPIs as non-secure Group-1. This will only matter + * if the GIC only has a single security state. This will not + * do the right thing if the kernel is running in secure mode, + * but that's not the intended use case anyway. + */ + for (i = 32; i < GIC_LINE_NR; i += 32) + writel_relaxed(~0, base + GICD_IGROUPR + i / 8); + + /* Extended SPI range, not handled by the GICv2/GICv3 common code */ + for (i = 0; i < GIC_ESPI_NR; i += 32) { + writel_relaxed(~0U, base + GICD_ICENABLERnE + i / 8); + writel_relaxed(~0U, base + GICD_ICACTIVERnE + i / 8); + } + + for (i = 0; i < GIC_ESPI_NR; i += 32) + writel_relaxed(~0U, base + GICD_IGROUPRnE + i / 8); + + for (i = 0; i < GIC_ESPI_NR; i += 16) + writel_relaxed(0, base + GICD_ICFGRnE + i / 4); + + for (i = 0; i < GIC_ESPI_NR; i += 4) + writel_relaxed(GICD_INT_DEF_PRI_X4, base + GICD_IPRIORITYRnE + i); + + /* Now do the common stuff, and wait for the distributor to drain */ + gic_dist_config(base, GIC_LINE_NR, NULL); + gic_do_wait_for_rwp(base, GICD_CTLR_RWP); // do sync outside of gic_dist_config + + val = GICD_CTLR_ARE_NS | GICD_CTLR_ENABLE_G1A | GICD_CTLR_ENABLE_G1; + if (gic_data.rdists.gicd_typer2 & GICD_TYPER2_nASSGIcap) { + pr_info("Enabling SGIs without active state\n"); + val |= GICD_CTLR_nASSGIreq; + } + + /* Enable distributor with ARE, Group1 */ + writel_relaxed(val, base + GICD_CTLR); + + /* + * Set all global interrupts to the boot CPU only. ARE must be + * enabled. + */ + affinity = gic_mpidr_to_affinity(cpu_logical_map(smp_processor_id())); + for (i = 32; i < GIC_LINE_NR; i++) + gic_write_irouter(affinity, base + GICD_IROUTER + i * 8); + + for (i = 0; i < GIC_ESPI_NR; i++) + gic_write_irouter(affinity, base + GICD_IROUTERnE + i * 8); + } +} + +static int gic_iterate_rdists(int (*fn)(struct redist_region *, void __iomem *)) +{ + int ret = -ENODEV; + int i; + + for (i = 0; i < gic_data.nr_redist_regions; i++) { + void __iomem *ptr = gic_data.redist_regions[i].redist_base; + u64 typer; + u32 reg; + + reg = readl_relaxed(ptr + GICR_PIDR2) & GIC_PIDR2_ARCH_MASK; + if (reg != GIC_PIDR2_ARCH_GICv3 && + reg != GIC_PIDR2_ARCH_GICv4) { /* We're in trouble... */ + pr_warn("No redistributor present @%p\n", ptr); + break; + } + + do { + typer = gic_read_typer(ptr + GICR_TYPER); + ret = fn(gic_data.redist_regions + i, ptr); + if (!ret) + return 0; + + if (gic_data.redist_regions[i].single_redist) + break; + + if (gic_data.redist_stride) { + ptr += gic_data.redist_stride; + } else { + ptr += SZ_64K * 2; /* Skip RD_base + SGI_base */ + if (typer & GICR_TYPER_VLPIS) + ptr += SZ_64K * 2; /* Skip VLPI_base + reserved page */ + } + } while (!(typer & GICR_TYPER_LAST)); + } + + return ret ? -ENODEV : 0; +} + +static int __gic_populate_rdist(struct redist_region *region, void __iomem *ptr) +{ + unsigned long mpidr = cpu_logical_map(smp_processor_id()); + u64 typer; + u32 aff, aff2_skt, rdist_skt; + + /* + * Convert affinity to a 32bit value that can be matched to + * GICR_TYPER bits [63:32]. + */ + aff = (MPIDR_AFFINITY_LEVEL(mpidr, 1) << 8 | + MPIDR_AFFINITY_LEVEL(mpidr, 0)); + + aff2_skt = MPIDR_AFFINITY_LEVEL(mpidr, 2) & 0x7; + rdist_skt = (((u64)region->phys_base >> MARS3_ADDR_SKTID_SHIFT) & 0x7); + + if (aff2_skt != rdist_skt) + return 1; + + typer = gic_read_typer(ptr + GICR_TYPER); + if ((typer >> 32) == aff) { + u64 offset = ptr - region->redist_base; + + raw_spin_lock_init(&gic_data_rdist()->rd_lock); + gic_data_rdist_rd_base() = ptr; + gic_data_rdist()->phys_base = region->phys_base + offset; + + pr_info("CPU%d: found redistributor %lx region %d:%pa\n", + smp_processor_id(), mpidr, + (int)(region - gic_data.redist_regions), + &gic_data_rdist()->phys_base); + return 0; + } + + /* Try next one */ + return 1; +} + +static int gic_populate_rdist(void) +{ + if (gic_iterate_rdists(__gic_populate_rdist) == 0) + return 0; + + /* We couldn't even deal with ourselves... */ + WARN(true, "CPU%d: mpidr %lx has no re-distributor!\n", + smp_processor_id(), + (unsigned long)cpu_logical_map(smp_processor_id())); + return -ENODEV; +} + +static int __gic_update_rdist_properties(struct redist_region *region, + void __iomem *ptr) +{ + u64 typer = gic_read_typer(ptr + GICR_TYPER); + u32 ctlr = readl_relaxed(ptr + GICR_CTLR); + + /* Boot-time cleanip */ + if ((typer & GICR_TYPER_VLPIS) && (typer & GICR_TYPER_RVPEID)) { + u64 val; + + /* Deactivate any present vPE */ + val = gicr_read_vpendbaser(ptr + SZ_128K + GICR_VPENDBASER); + if (val & GICR_VPENDBASER_Valid) + gicr_write_vpendbaser(GICR_VPENDBASER_PendingLast, + ptr + SZ_128K + GICR_VPENDBASER); + + /* Mark the VPE table as invalid */ + val = gicr_read_vpropbaser(ptr + SZ_128K + GICR_VPROPBASER); + val &= ~GICR_VPROPBASER_4_1_VALID; + gicr_write_vpropbaser(val, ptr + SZ_128K + GICR_VPROPBASER); + } + + gic_data.rdists.has_vlpis &= !!(typer & GICR_TYPER_VLPIS); + + /* + * TYPER.RVPEID implies some form of DirectLPI, no matter what the + * doc says... :-/ And CTLR.IR implies another subset of DirectLPI + * that the ITS driver can make use of for LPIs (and not VLPIs). + * + * These are 3 different ways to express the same thing, depending + * on the revision of the architecture and its relaxations over + * time. Just group them under the 'direct_lpi' banner. + */ + gic_data.rdists.has_rvpeid &= !!(typer & GICR_TYPER_RVPEID); + gic_data.rdists.has_direct_lpi &= (!!(typer & GICR_TYPER_DirectLPIS) | + !!(ctlr & GICR_CTLR_IR) | + gic_data.rdists.has_rvpeid); + gic_data.rdists.has_vpend_valid_dirty &= !!(typer & GICR_TYPER_DIRTY); + + /* Detect non-sensical configurations */ + if (WARN_ON_ONCE(gic_data.rdists.has_rvpeid && !gic_data.rdists.has_vlpis)) { + gic_data.rdists.has_direct_lpi = false; + gic_data.rdists.has_vlpis = false; + gic_data.rdists.has_rvpeid = false; + } + + gic_data.ppi_nr = min(GICR_TYPER_NR_PPIS(typer), gic_data.ppi_nr); + + return 1; +} + +static void gic_update_rdist_properties(void) +{ + gic_data.ppi_nr = UINT_MAX; + gic_iterate_rdists(__gic_update_rdist_properties); + if (WARN_ON(gic_data.ppi_nr == UINT_MAX)) + gic_data.ppi_nr = 0; + pr_info("GIC-2500 features: %d PPIs%s%s\n", + gic_data.ppi_nr, + gic_data.has_rss ? ", RSS" : "", + gic_data.rdists.has_direct_lpi ? ", DirectLPI" : ""); + + if (gic_data.rdists.has_vlpis) + pr_info("GICv4 features: %s%s%s\n", + gic_data.rdists.has_direct_lpi ? "DirectLPI " : "", + gic_data.rdists.has_rvpeid ? "RVPEID " : "", + gic_data.rdists.has_vpend_valid_dirty ? "Valid+Dirty " : ""); +} + +/* Check whether it's single security state view */ +static inline bool gic_dist_security_disabled(void) +{ + return readl_relaxed(gic_data.dist_base + GICD_CTLR) & GICD_CTLR_DS; +} + +static void gic_cpu_sys_reg_init(void) +{ + int i, cpu = smp_processor_id(); + u64 mpidr = cpu_logical_map(cpu); + u64 need_rss = MPIDR_RS(mpidr); + bool group0; + u32 pribits; + + /* + * Need to check that the SRE bit has actually been set. If + * not, it means that SRE is disabled at EL2. We're going to + * die painfully, and there is nothing we can do about it. + * + * Kindly inform the luser. + */ + if (!gic_enable_sre()) + pr_err("GIC: unable to set SRE (disabled at EL2), panic ahead\n"); + + pribits = gic_get_pribits(); + + group0 = gic_has_group0(); + + /* Set priority mask register */ + if (!gic_prio_masking_enabled()) { + write_gicreg(DEFAULT_PMR_VALUE, ICC_PMR_EL1); + } else if (gic_supports_nmi()) { + /* + * Mismatch configuration with boot CPU, the system is likely + * to die as interrupt masking will not work properly on all + * CPUs + * + * The boot CPU calls this function before enabling NMI support, + * and as a result we'll never see this warning in the boot path + * for that CPU. + */ + if (static_branch_unlikely(&gic_nonsecure_priorities)) + WARN_ON(!group0 || gic_dist_security_disabled()); + else + WARN_ON(group0 && !gic_dist_security_disabled()); + } + + /* + * Some firmwares hand over to the kernel with the BPR changed from + * its reset value (and with a value large enough to prevent + * any pre-emptive interrupts from working at all). Writing a zero + * to BPR restores is reset value. + */ + gic_write_bpr1(0); + + if (static_branch_likely(&supports_deactivate_key)) { + /* EOI drops priority only (mode 1) */ + gic_write_ctlr(ICC_CTLR_EL1_EOImode_drop); + } else { + /* EOI deactivates interrupt too (mode 0) */ + gic_write_ctlr(ICC_CTLR_EL1_EOImode_drop_dir); + } + + /* Always whack Group0 before Group1 */ + if (group0) { + switch (pribits) { + case 8: + case 7: + write_gicreg(0, ICC_AP0R3_EL1); + write_gicreg(0, ICC_AP0R2_EL1); + fallthrough; + case 6: + write_gicreg(0, ICC_AP0R1_EL1); + fallthrough; + case 5: + case 4: + write_gicreg(0, ICC_AP0R0_EL1); + } + + isb(); + } + + switch (pribits) { + case 8: + case 7: + write_gicreg(0, ICC_AP1R3_EL1); + write_gicreg(0, ICC_AP1R2_EL1); + fallthrough; + case 6: + write_gicreg(0, ICC_AP1R1_EL1); + fallthrough; + case 5: + case 4: + write_gicreg(0, ICC_AP1R0_EL1); + } + + isb(); + + /* ... and let's hit the road... */ + gic_write_grpen1(1); + + /* Keep the RSS capability status in per_cpu variable */ + per_cpu(has_rss, cpu) = !!(gic_read_ctlr() & ICC_CTLR_EL1_RSS); + + /* Check all the CPUs have capable of sending SGIs to other CPUs */ + for_each_online_cpu(i) { + bool have_rss = per_cpu(has_rss, i) && per_cpu(has_rss, cpu); + + need_rss |= MPIDR_RS(cpu_logical_map(i)); + if (need_rss && (!have_rss)) + pr_crit("CPU%d (%lx) can't SGI CPU%d (%lx), no RSS\n", + cpu, (unsigned long)mpidr, + i, (unsigned long)cpu_logical_map(i)); + } + + /** + * GIC spec says, when ICC_CTLR_EL1.RSS==1 and GICD_TYPER.RSS==0, + * writing ICC_ASGI1R_EL1 register with RS != 0 is a CONSTRAINED + * UNPREDICTABLE choice of : + * - The write is ignored. + * - The RS field is treated as 0. + */ + if (need_rss && (!gic_data.has_rss)) + pr_crit_once("RSS is required but GICD doesn't support it\n"); +} + +static bool gicv3_nolpi; + +static int __init gicv3_nolpi_cfg(char *buf) +{ + return strtobool(buf, &gicv3_nolpi); +} +early_param("irqchip.gicv3_nolpi", gicv3_nolpi_cfg); + +static int gic_dist_supports_lpis(void) +{ + return (IS_ENABLED(CONFIG_ARM_GIC_V3_ITS) && + !!(readl_relaxed(gic_data.dist_base + GICD_TYPER) & GICD_TYPER_LPIS) && + !gicv3_nolpi); +} + +static void gic_cpu_init(void) +{ + void __iomem *rbase; + int i; + unsigned long mpidr; + + /* Register ourselves with the rest of the world */ + if (gic_populate_rdist()) + return; + + gic_enable_redist(true); + + WARN((gic_data.ppi_nr > 16 || GIC_ESPI_NR != 0) && + !(gic_read_ctlr() & ICC_CTLR_EL1_ExtRange), + "Distributor has extended ranges, but CPU%d doesn't\n", + smp_processor_id()); + + rbase = gic_data_rdist_sgi_base(); + + /* Configure SGIs/PPIs as non-secure Group-1 */ + for (i = 0; i < gic_data.ppi_nr + 16; i += 32) + writel_relaxed(~0, rbase + GICR_IGROUPR0 + i / 8); + + gic_cpu_config(rbase, gic_data.ppi_nr + 16, gic_redist_wait_for_rwp); + + mpidr = (unsigned long)cpu_logical_map(smp_processor_id()); + + if ((mpidr & 0xffff) == 0) { + rbase = rbase + 64*SZ_128K; + + for (i = 0; i < 4; i++) { + /* Configure SGIs/PPIs as non-secure Group-1 */ + writel_relaxed(~0, rbase + GICR_IGROUPR0); + + gic_cpu_config(rbase, gic_data.ppi_nr + 16, NULL); + gic_do_wait_for_rwp(rbase - SZ_64K, GICR_CTLR_RWP); + + rbase = rbase + SZ_128K; + } + } + + /* initialise system registers */ + gic_cpu_sys_reg_init(); +} + +#ifdef CONFIG_SMP + +#define MPIDR_TO_SGI_RS(mpidr) (MPIDR_RS(mpidr) << ICC_SGI1R_RS_SHIFT) +#define MPIDR_TO_SGI_CLUSTER_ID(mpidr) ((mpidr) & ~0xFUL) + +static int gic_starting_cpu(unsigned int cpu) +{ + gic_cpu_init(); + + if (gic_dist_supports_lpis()) + phytium_its_cpu_init(); + + return 0; +} + +static u16 gic_compute_target_list(int *base_cpu, const struct cpumask *mask, + unsigned long cluster_id) +{ + int next_cpu, cpu = *base_cpu; + unsigned long mpidr = cpu_logical_map(cpu); + u16 tlist = 0; + + while (cpu < nr_cpu_ids) { + tlist |= 1 << (mpidr & 0xf); + + next_cpu = cpumask_next(cpu, mask); + if (next_cpu >= nr_cpu_ids) + goto out; + cpu = next_cpu; + + mpidr = cpu_logical_map(cpu); + + if (cluster_id != MPIDR_TO_SGI_CLUSTER_ID(mpidr)) { + cpu--; + goto out; + } + } +out: + *base_cpu = cpu; + return tlist; +} + +#define MPIDR_TO_SGI_AFFINITY(cluster_id, level) \ + (MPIDR_AFFINITY_LEVEL(cluster_id, level) \ + << ICC_SGI1R_AFFINITY_## level ##_SHIFT) + +static void gic_send_sgi(u64 cluster_id, u16 tlist, unsigned int irq) +{ + u64 val; + + val = (MPIDR_TO_SGI_AFFINITY(cluster_id, 3) | + MPIDR_TO_SGI_AFFINITY(cluster_id, 2) | + irq << ICC_SGI1R_SGI_ID_SHIFT | + MPIDR_TO_SGI_AFFINITY(cluster_id, 1) | + MPIDR_TO_SGI_RS(cluster_id) | + tlist << ICC_SGI1R_TARGET_LIST_SHIFT); + + pr_devel("CPU%d: ICC_SGI1R_EL1 %llx\n", smp_processor_id(), val); + gic_write_sgi1r(val); +} + +static void gic_ipi_send_mask(struct irq_data *d, const struct cpumask *mask) +{ + int cpu; + + if (WARN_ON(d->hwirq >= 16)) + return; + + /* + * Ensure that stores to Normal memory are visible to the + * other CPUs before issuing the IPI. + */ + dsb(ishst); + + for_each_cpu(cpu, mask) { + u64 cluster_id = MPIDR_TO_SGI_CLUSTER_ID(cpu_logical_map(cpu)); + u16 tlist; + + tlist = gic_compute_target_list(&cpu, mask, cluster_id); + gic_send_sgi(cluster_id, tlist, d->hwirq); + } + + /* Force the above writes to ICC_SGI1R_EL1 to be executed */ + isb(); +} + +static void __init gic_smp_init(void) +{ + struct irq_fwspec sgi_fwspec = { + .fwnode = gic_data.fwnode, + .param_count = 1, + }; + int base_sgi; + + cpuhp_setup_state_nocalls(CPUHP_AP_IRQ_GIC_STARTING, + "irqchip/arm/gic_phytium_2500:starting", + gic_starting_cpu, NULL); + + /* Register all 8 non-secure SGIs */ + base_sgi = __irq_domain_alloc_irqs(gic_data.domain, -1, 8, + NUMA_NO_NODE, &sgi_fwspec, + false, NULL); + if (WARN_ON(base_sgi <= 0)) + return; + + set_smp_ipi_range(base_sgi, 8); +} + +static int gic_cpumask_select(struct irq_data *d, const struct cpumask *mask_val) +{ + unsigned int skt, irq_skt, i; + unsigned int cpu, cpus = 0; + unsigned int skt_cpu_cnt[MAX_MARS3_SOC_COUNT] = {0}; + + irq_skt = mars3_irq_to_skt(gic_irq(d)); + + for (i = 0; i < nr_cpu_ids; i++) { + skt = (cpu_logical_map(i) >> 16) & 0xff; + if ((skt >= 0) && (skt < MAX_MARS3_SOC_COUNT)) { + if ((is_kdump_kernel()) && (irq_skt == skt)) + return i; + + skt_cpu_cnt[skt]++; + } else if (skt != 0xff) { + pr_err("socket address: %d is out of range.", skt); + } + } + + if (irq_skt) { + for (i = 0; i < irq_skt; i++) + cpus += skt_cpu_cnt[i]; + } + + cpu = cpumask_any_and(mask_val, cpu_online_mask); + cpus = cpus + cpu % skt_cpu_cnt[irq_skt]; + + return cpus; +} + +static int gic_set_affinity(struct irq_data *d, const struct cpumask *mask_val, + bool force) +{ + unsigned int cpu, skt; + u32 offset, index; + void __iomem *reg; + int enabled; + u64 val; + + if (force) + cpu = cpumask_first(mask_val); + else + cpu = gic_cpumask_select(d, mask_val); + + if (cpu >= nr_cpu_ids) + return -EINVAL; + + if (gic_irq_in_rdist(d)) + return -EINVAL; + + /* If interrupt was enabled, disable it first */ + enabled = gic_peek_irq(d, GICD_ISENABLER); + if (enabled) + gic_mask_irq(d); + + offset = convert_offset_index(d, GICD_IROUTER, &index); + + skt = mars3_irq_to_skt(gic_irq(d)); + reg = mars3_gic_dists[skt].dist_base + offset + (index * 8); + val = gic_mpidr_to_affinity(cpu_logical_map(cpu)); + + gic_write_irouter(val, reg); + + /* + * If the interrupt was enabled, enabled it again. Otherwise, + * just wait for the distributor to have digested our changes. + */ + if (enabled) + gic_unmask_irq(d); + + irq_data_update_effective_affinity(d, cpumask_of(cpu)); + + return IRQ_SET_MASK_OK_DONE; +} +#else +#define gic_set_affinity NULL +#define gic_ipi_send_mask NULL +#define gic_smp_init() do { } while (0) +#endif + +static int gic_retrigger(struct irq_data *data) +{ + return !gic_irq_set_irqchip_state(data, IRQCHIP_STATE_PENDING, true); +} + +#ifdef CONFIG_CPU_PM +static int gic_cpu_pm_notifier(struct notifier_block *self, + unsigned long cmd, void *v) +{ + if (cmd == CPU_PM_EXIT) { + if (gic_dist_security_disabled()) + gic_enable_redist(true); + gic_cpu_sys_reg_init(); + } else if (cmd == CPU_PM_ENTER && gic_dist_security_disabled()) { + gic_write_grpen1(0); + gic_enable_redist(false); + } + return NOTIFY_OK; +} + +static struct notifier_block gic_cpu_pm_notifier_block = { + .notifier_call = gic_cpu_pm_notifier, +}; + +static void gic_cpu_pm_init(void) +{ + cpu_pm_register_notifier(&gic_cpu_pm_notifier_block); +} + +#else +static inline void gic_cpu_pm_init(void) { } +#endif /* CONFIG_CPU_PM */ + +static struct irq_chip gic_chip = { + .name = "GIC-Phytium-2500", + .irq_mask = gic_mask_irq, + .irq_unmask = gic_unmask_irq, + .irq_eoi = gic_eoi_irq, + .irq_set_type = gic_set_type, + .irq_set_affinity = gic_set_affinity, + .irq_retrigger = gic_retrigger, + .irq_get_irqchip_state = gic_irq_get_irqchip_state, + .irq_set_irqchip_state = gic_irq_set_irqchip_state, + .irq_nmi_setup = gic_irq_nmi_setup, + .irq_nmi_teardown = gic_irq_nmi_teardown, + .ipi_send_mask = gic_ipi_send_mask, + .flags = IRQCHIP_SET_TYPE_MASKED | + IRQCHIP_SKIP_SET_WAKE | + IRQCHIP_MASK_ON_SUSPEND, +}; + +static struct irq_chip gic_eoimode1_chip = { + .name = "GIC-Phytium-2500", + .irq_mask = gic_eoimode1_mask_irq, + .irq_unmask = gic_unmask_irq, + .irq_eoi = gic_eoimode1_eoi_irq, + .irq_set_type = gic_set_type, + .irq_set_affinity = gic_set_affinity, + .irq_retrigger = gic_retrigger, + .irq_get_irqchip_state = gic_irq_get_irqchip_state, + .irq_set_irqchip_state = gic_irq_set_irqchip_state, + .irq_set_vcpu_affinity = gic_irq_set_vcpu_affinity, + .irq_nmi_setup = gic_irq_nmi_setup, + .irq_nmi_teardown = gic_irq_nmi_teardown, + .ipi_send_mask = gic_ipi_send_mask, + .flags = IRQCHIP_SET_TYPE_MASKED | + IRQCHIP_SKIP_SET_WAKE | + IRQCHIP_MASK_ON_SUSPEND, +}; + +static int gic_irq_domain_map(struct irq_domain *d, unsigned int irq, + irq_hw_number_t hw) +{ + struct irq_chip *chip = &gic_chip; + struct irq_data *irqd = irq_desc_get_irq_data(irq_to_desc(irq)); + + if (static_branch_likely(&supports_deactivate_key)) + chip = &gic_eoimode1_chip; + + switch (__get_intid_range(hw)) { + case SGI_RANGE: + case PPI_RANGE: + case EPPI_RANGE: + irq_set_percpu_devid(irq); + irq_domain_set_info(d, irq, hw, chip, d->host_data, + handle_percpu_devid_irq, NULL, NULL); + break; + + case SPI_RANGE: + case ESPI_RANGE: + irq_domain_set_info(d, irq, hw, chip, d->host_data, + handle_fasteoi_irq, NULL, NULL); + irq_set_probe(irq); + irqd_set_single_target(irqd); + break; + + case LPI_RANGE: + if (!gic_dist_supports_lpis()) + return -EPERM; + irq_domain_set_info(d, irq, hw, chip, d->host_data, + handle_fasteoi_irq, NULL, NULL); + break; + + default: + return -EPERM; + } + + /* Prevents SW retriggers which mess up the ACK/EOI ordering */ + irqd_set_handle_enforce_irqctx(irqd); + return 0; +} + +static int gic_irq_domain_translate(struct irq_domain *d, + struct irq_fwspec *fwspec, + unsigned long *hwirq, + unsigned int *type) +{ + if (fwspec->param_count == 1 && fwspec->param[0] < 16) { + *hwirq = fwspec->param[0]; + *type = IRQ_TYPE_EDGE_RISING; + return 0; + } + + if (is_of_node(fwspec->fwnode)) { + if (fwspec->param_count < 3) + return -EINVAL; + + switch (fwspec->param[0]) { + case 0: /* SPI */ + *hwirq = fwspec->param[1] + 32; + break; + case 1: /* PPI */ + *hwirq = fwspec->param[1] + 16; + break; + case 2: /* ESPI */ + *hwirq = fwspec->param[1] + ESPI_BASE_INTID; + break; + case 3: /* EPPI */ + *hwirq = fwspec->param[1] + EPPI_BASE_INTID; + break; + case GIC_IRQ_TYPE_LPI: /* LPI */ + *hwirq = fwspec->param[1]; + break; + case GIC_IRQ_TYPE_PARTITION: + *hwirq = fwspec->param[1]; + if (fwspec->param[1] >= 16) + *hwirq += EPPI_BASE_INTID - 16; + else + *hwirq += 16; + break; + default: + return -EINVAL; + } + + *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; + + /* + * Make it clear that broken DTs are... broken. + * Partitioned PPIs are an unfortunate exception. + */ + WARN_ON(*type == IRQ_TYPE_NONE && + fwspec->param[0] != GIC_IRQ_TYPE_PARTITION); + return 0; + } + + if (is_fwnode_irqchip(fwspec->fwnode)) { + if (fwspec->param_count != 2) + return -EINVAL; + + if (fwspec->param[0] < 16) { + pr_err(FW_BUG "Illegal GSI%d translation request\n", + fwspec->param[0]); + return -EINVAL; + } + + *hwirq = fwspec->param[0]; + *type = fwspec->param[1]; + + WARN_ON(*type == IRQ_TYPE_NONE); + return 0; + } + + return -EINVAL; +} + +static int gic_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, + unsigned int nr_irqs, void *arg) +{ + int i, ret; + irq_hw_number_t hwirq; + unsigned int type = IRQ_TYPE_NONE; + struct irq_fwspec *fwspec = arg; + + ret = gic_irq_domain_translate(domain, fwspec, &hwirq, &type); + if (ret) + return ret; + + for (i = 0; i < nr_irqs; i++) { + ret = gic_irq_domain_map(domain, virq + i, hwirq + i); + if (ret) + return ret; + } + + return 0; +} + +static void gic_irq_domain_free(struct irq_domain *domain, unsigned int virq, + unsigned int nr_irqs) +{ + int i; + + for (i = 0; i < nr_irqs; i++) { + struct irq_data *d = irq_domain_get_irq_data(domain, virq + i); + + irq_set_handler(virq + i, NULL); + irq_domain_reset_irq_data(d); + } +} + +static bool fwspec_is_partitioned_ppi(struct irq_fwspec *fwspec, + irq_hw_number_t hwirq) +{ + enum gic_intid_range range; + + if (!gic_data.ppi_descs) + return false; + + if (!is_of_node(fwspec->fwnode)) + return false; + + if (fwspec->param_count < 4 || !fwspec->param[3]) + return false; + + range = __get_intid_range(hwirq); + if (range != PPI_RANGE && range != EPPI_RANGE) + return false; + + return true; +} + +static int gic_irq_domain_select(struct irq_domain *d, + struct irq_fwspec *fwspec, + enum irq_domain_bus_token bus_token) +{ + unsigned int type, ret, ppi_idx; + irq_hw_number_t hwirq; + + /* Not for us */ + if (fwspec->fwnode != d->fwnode) + return 0; + + /* If this is not DT, then we have a single domain */ + if (!is_of_node(fwspec->fwnode)) + return 1; + + ret = gic_irq_domain_translate(d, fwspec, &hwirq, &type); + if (WARN_ON_ONCE(ret)) + return 0; + + if (!fwspec_is_partitioned_ppi(fwspec, hwirq)) + return d == gic_data.domain; + + /* + * If this is a PPI and we have a 4th (non-null) parameter, + * then we need to match the partition domain. + */ + ppi_idx = __gic_get_ppi_index(hwirq); + return d == partition_get_domain(gic_data.ppi_descs[ppi_idx]); +} + +static const struct irq_domain_ops gic_irq_domain_ops = { + .translate = gic_irq_domain_translate, + .alloc = gic_irq_domain_alloc, + .free = gic_irq_domain_free, + .select = gic_irq_domain_select, +}; + +static int partition_domain_translate(struct irq_domain *d, + struct irq_fwspec *fwspec, + unsigned long *hwirq, + unsigned int *type) +{ + unsigned long ppi_intid; + struct device_node *np; + unsigned int ppi_idx; + int ret; + + if (!gic_data.ppi_descs) + return -ENOMEM; + + np = of_find_node_by_phandle(fwspec->param[3]); + if (WARN_ON(!np)) + return -EINVAL; + + ret = gic_irq_domain_translate(d, fwspec, &ppi_intid, type); + if (WARN_ON_ONCE(ret)) + return 0; + + ppi_idx = __gic_get_ppi_index(ppi_intid); + ret = partition_translate_id(gic_data.ppi_descs[ppi_idx], + of_node_to_fwnode(np)); + if (ret < 0) + return ret; + + *hwirq = ret; + *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; + + return 0; +} + +static const struct irq_domain_ops partition_domain_ops = { + .translate = partition_domain_translate, + .select = gic_irq_domain_select, +}; + +static void gic_enable_nmi_support(void) +{ + int i; + + if (!gic_prio_masking_enabled()) + return; + + ppi_nmi_refs = kcalloc(gic_data.ppi_nr, sizeof(*ppi_nmi_refs), GFP_KERNEL); + if (!ppi_nmi_refs) + return; + + for (i = 0; i < gic_data.ppi_nr; i++) + refcount_set(&ppi_nmi_refs[i], 0); + + /* + * Linux itself doesn't use 1:N distribution, so has no need to + * set PMHE. The only reason to have it set is if EL3 requires it + * (and we can't change it). + */ + if (gic_read_ctlr() & ICC_CTLR_EL1_PMHE_MASK) + static_branch_enable(&gic_pmr_sync); + + pr_info("Pseudo-NMIs enabled using %s ICC_PMR_EL1 synchronisation\n", + static_branch_unlikely(&gic_pmr_sync) ? "forced" : "relaxed"); + + /* + * How priority values are used by the GIC depends on two things: + * the security state of the GIC (controlled by the GICD_CTRL.DS bit) + * and if Group 0 interrupts can be delivered to Linux in the non-secure + * world as FIQs (controlled by the SCR_EL3.FIQ bit). These affect the + * ICC_PMR_EL1 register and the priority that software assigns to + * interrupts: + * + * GICD_CTRL.DS | SCR_EL3.FIQ | ICC_PMR_EL1 | Group 1 priority + * ----------------------------------------------------------- + * 1 | - | unchanged | unchanged + * ----------------------------------------------------------- + * 0 | 1 | non-secure | non-secure + * ----------------------------------------------------------- + * 0 | 0 | unchanged | non-secure + * + * where non-secure means that the value is right-shifted by one and the + * MSB bit set, to make it fit in the non-secure priority range. + * + * In the first two cases, where ICC_PMR_EL1 and the interrupt priority + * are both either modified or unchanged, we can use the same set of + * priorities. + * + * In the last case, where only the interrupt priorities are modified to + * be in the non-secure range, we use a different PMR value to mask IRQs + * and the rest of the values that we use remain unchanged. + */ + if (gic_has_group0() && !gic_dist_security_disabled()) + static_branch_enable(&gic_nonsecure_priorities); + + static_branch_enable(&supports_pseudo_nmis); + + if (static_branch_likely(&supports_deactivate_key)) + gic_eoimode1_chip.flags |= IRQCHIP_SUPPORTS_NMI; + else + gic_chip.flags |= IRQCHIP_SUPPORTS_NMI; +} + +static int __init gic_init_bases(void __iomem *dist_base, + struct redist_region *rdist_regs, + u32 nr_redist_regions, + u64 redist_stride, + struct fwnode_handle *handle) +{ + u32 typer; + int err; + + if (!is_hyp_mode_available()) + static_branch_disable(&supports_deactivate_key); + + if (static_branch_likely(&supports_deactivate_key)) + pr_info("GIC: Using split EOI/Deactivate mode\n"); + + gic_data.fwnode = handle; + gic_data.dist_base = dist_base; + gic_data.redist_regions = rdist_regs; + gic_data.nr_redist_regions = nr_redist_regions; + gic_data.redist_stride = redist_stride; + + /* + * Find out how many interrupts are supported. + */ + typer = readl_relaxed(gic_data.dist_base + GICD_TYPER); + gic_data.rdists.gicd_typer = typer; + + pr_info("%d SPIs implemented\n", GIC_LINE_NR - 32); + pr_info("%d Extended SPIs implemented\n", GIC_ESPI_NR); + + gic_data.rdists.gicd_typer2 = readl_relaxed(gic_data.dist_base + GICD_TYPER2); + + gic_data.domain = irq_domain_create_tree(handle, &gic_irq_domain_ops, + &gic_data); + gic_data.rdists.rdist = alloc_percpu(typeof(*gic_data.rdists.rdist)); + gic_data.rdists.has_rvpeid = true; + gic_data.rdists.has_vlpis = true; + gic_data.rdists.has_direct_lpi = true; + gic_data.rdists.has_vpend_valid_dirty = true; + + if (WARN_ON(!gic_data.domain) || WARN_ON(!gic_data.rdists.rdist)) { + err = -ENOMEM; + goto out_free; + } + + irq_domain_update_bus_token(gic_data.domain, DOMAIN_BUS_WIRED); + + gic_data.has_rss = !!(typer & GICD_TYPER_RSS); + + if (typer & GICD_TYPER_MBIS) { + err = mbi_init(handle, gic_data.domain); + if (err) + pr_err("Failed to initialize MBIs\n"); + } + + set_handle_irq(gic_handle_irq); + + gic_update_rdist_properties(); + + gic_dist_init(); + gic_cpu_init(); + gic_smp_init(); + gic_cpu_pm_init(); + + if (gic_dist_supports_lpis()) { + phytium_its_init(handle, &gic_data.rdists, gic_data.domain); + phytium_its_cpu_init(); + phytium_its_lpi_memreserve_init(); + } else { + if (IS_ENABLED(CONFIG_ARM_GIC_V2M)) + gicv2m_init(handle, gic_data.domain); + } + + gic_enable_nmi_support(); + + return 0; + +out_free: + if (gic_data.domain) + irq_domain_remove(gic_data.domain); + free_percpu(gic_data.rdists.rdist); + return err; +} + +static int __init gic_validate_dist_version(void __iomem *dist_base) +{ + u32 reg = readl_relaxed(dist_base + GICD_PIDR2) & GIC_PIDR2_ARCH_MASK; + + if (reg != GIC_PIDR2_ARCH_GICv3 && reg != GIC_PIDR2_ARCH_GICv4) + return -ENODEV; + + return 0; +} + +/* Create all possible partitions at boot time */ +static void __init gic_populate_ppi_partitions(struct device_node *gic_node) +{ + struct device_node *parts_node, *child_part; + int part_idx = 0, i; + int nr_parts; + struct partition_affinity *parts; + + parts_node = of_get_child_by_name(gic_node, "ppi-partitions"); + if (!parts_node) + return; + + gic_data.ppi_descs = kcalloc(gic_data.ppi_nr, sizeof(*gic_data.ppi_descs), GFP_KERNEL); + if (!gic_data.ppi_descs) + goto out_put_node; + + nr_parts = of_get_child_count(parts_node); + + if (!nr_parts) + goto out_put_node; + + parts = kcalloc(nr_parts, sizeof(*parts), GFP_KERNEL); + if (WARN_ON(!parts)) + goto out_put_node; + + for_each_child_of_node(parts_node, child_part) { + struct partition_affinity *part; + int n; + + part = &parts[part_idx]; + + part->partition_id = of_node_to_fwnode(child_part); + + pr_info("GIC: PPI partition %pOFn[%d] { ", + child_part, part_idx); + + n = of_property_count_elems_of_size(child_part, "affinity", + sizeof(u32)); + WARN_ON(n <= 0); + + for (i = 0; i < n; i++) { + int err, cpu; + u32 cpu_phandle; + struct device_node *cpu_node; + + err = of_property_read_u32_index(child_part, "affinity", + i, &cpu_phandle); + if (WARN_ON(err)) + continue; + + cpu_node = of_find_node_by_phandle(cpu_phandle); + if (WARN_ON(!cpu_node)) + continue; + + cpu = of_cpu_node_to_id(cpu_node); + if (WARN_ON(cpu < 0)) { + of_node_put(cpu_node); + continue; + } + + pr_cont("%pOF[%d] ", cpu_node, cpu); + + cpumask_set_cpu(cpu, &part->mask); + of_node_put(cpu_node); + } + + pr_cont("}\n"); + part_idx++; + } + + for (i = 0; i < gic_data.ppi_nr; i++) { + unsigned int irq; + struct partition_desc *desc; + struct irq_fwspec ppi_fwspec = { + .fwnode = gic_data.fwnode, + .param_count = 3, + .param = { + [0] = GIC_IRQ_TYPE_PARTITION, + [1] = i, + [2] = IRQ_TYPE_NONE, + }, + }; + + irq = irq_create_fwspec_mapping(&ppi_fwspec); + if (WARN_ON(!irq)) + continue; + desc = partition_create_desc(gic_data.fwnode, parts, nr_parts, + irq, &partition_domain_ops); + if (WARN_ON(!desc)) + continue; + + gic_data.ppi_descs[i] = desc; + } + +out_put_node: + of_node_put(parts_node); +} + +static void __init gic_of_setup_kvm_info(struct device_node *node) +{ + int ret; + struct resource r; + u32 gicv_idx; + + gic_v3_kvm_info.type = GIC_V3; + + gic_v3_kvm_info.maint_irq = irq_of_parse_and_map(node, 0); + if (!gic_v3_kvm_info.maint_irq) + return; + + if (of_property_read_u32(node, "#redistributor-regions", + &gicv_idx)) + gicv_idx = 1; + + gicv_idx += 3; /* Also skip GICD, GICC, GICH */ + ret = of_address_to_resource(node, gicv_idx, &r); + if (!ret) + gic_v3_kvm_info.vcpu = r; + + gic_v3_kvm_info.has_v4 = gic_data.rdists.has_vlpis; + gic_v3_kvm_info.has_v4_1 = gic_data.rdists.has_rvpeid; + vgic_set_kvm_info(&gic_v3_kvm_info); +} + +static void gic_request_region(resource_size_t base, resource_size_t size, + const char *name) +{ + if (!request_mem_region(base, size, name)) + pr_warn_once(FW_BUG "%s region %pa has overlapping address\n", + name, &base); +} + +static void __iomem *gic_of_iomap(struct device_node *node, int idx, + const char *name, struct resource *res) +{ + void __iomem *base; + int ret; + + ret = of_address_to_resource(node, idx, res); + if (ret) + return IOMEM_ERR_PTR(ret); + + gic_request_region(res->start, resource_size(res), name); + base = of_iomap(node, idx); + + return base ?: IOMEM_ERR_PTR(-ENOMEM); +} + +static int __init gic_of_init(struct device_node *node, struct device_node *parent) +{ + void __iomem *dist_base; + struct redist_region *rdist_regs; + u64 redist_stride; + u32 nr_redist_regions; + int err, i; + struct resource res; + unsigned long skt; + + dist_base = gic_of_iomap(node, 0, "GICD", &res); + if (IS_ERR(dist_base)) { + pr_err("%pOF: unable to map gic dist registers\n", node); + return PTR_ERR(dist_base); + } + + err = gic_validate_dist_version(dist_base); + if (err) { + pr_err("%pOF: no distributor detected, giving up\n", node); + goto out_unmap_dist; + } + + if (of_address_to_resource(node, 0, &res)) { + pr_err("Error: No GIC Distributor in FDT\n"); + goto out_unmap_dist; + } + + mars3_gic_dists[0].phys_base = res.start; + mars3_gic_dists[0].size = resource_size(&res); + mars3_gic_dists[0].dist_base = dist_base; + + if (of_property_read_u32(node, "#mars3-soc-bitmap", &mars3_sockets_bitmap)) + mars3_sockets_bitmap = 0x1; + + for (skt = 1; skt < MAX_MARS3_SOC_COUNT; skt++) { + if (((1U << skt) & mars3_sockets_bitmap) == 0) + continue; + + mars3_gic_dists[skt].phys_base = ((unsigned long)skt << MARS3_ADDR_SKTID_SHIFT) | + mars3_gic_dists[0].phys_base; + mars3_gic_dists[skt].size = mars3_gic_dists[0].size; + mars3_gic_dists[skt].dist_base = ioremap(mars3_gic_dists[skt].phys_base, + mars3_gic_dists[skt].size); + } + + if (of_property_read_u32(node, "#redistributor-regions", &nr_redist_regions)) + nr_redist_regions = 1; + + rdist_regs = kcalloc(nr_redist_regions, sizeof(*rdist_regs), + GFP_KERNEL); + if (!rdist_regs) { + err = -ENOMEM; + goto out_unmap_dist; + } + + for (i = 0; i < nr_redist_regions; i++) { + rdist_regs[i].redist_base = gic_of_iomap(node, 1 + i, "GICR", &res); + if (IS_ERR(rdist_regs[i].redist_base)) { + pr_err("%pOF: couldn't map region %d\n", node, i); + err = -ENODEV; + goto out_unmap_rdist; + } + rdist_regs[i].phys_base = res.start; + } + + if (of_property_read_u64(node, "redistributor-stride", &redist_stride)) + redist_stride = 0; + + err = gic_init_bases(dist_base, rdist_regs, nr_redist_regions, + redist_stride, &node->fwnode); + if (err) + goto out_unmap_rdist; + + gic_populate_ppi_partitions(node); + + if (static_branch_likely(&supports_deactivate_key)) + gic_of_setup_kvm_info(node); + return 0; + +out_unmap_rdist: + for (i = 0; i < nr_redist_regions; i++) + if (rdist_regs[i].redist_base && !IS_ERR(rdist_regs[i].redist_base)) + iounmap(rdist_regs[i].redist_base); + kfree(rdist_regs); +out_unmap_dist: + iounmap(dist_base); + return err; +} + +IRQCHIP_DECLARE(gic_phyt_2500, "arm,gic-phytium-2500", gic_of_init); + +#ifdef CONFIG_ACPI +static struct +{ + void __iomem *dist_base; + struct redist_region *redist_regs; + u32 nr_redist_regions; + bool single_redist; + int enabled_rdists; + u32 maint_irq; + int maint_irq_mode; + phys_addr_t vcpu_base; +} acpi_data __initdata; + +static int gic_mars3_sockets_bitmap(void) +{ + unsigned int skt, i; + int skt_bitmap = 0; + unsigned int skt_cpu_cnt[MAX_MARS3_SOC_COUNT] = {0}; + + for (i = 0; i < max_t(unsigned int, nr_cpu_ids, NR_CPUS); i++) { + skt = (cpu_logical_map(i) >> 16) & 0xff; + if ((skt >= 0) && (skt < MAX_MARS3_SOC_COUNT)) + skt_cpu_cnt[skt]++; + else if (skt != 0xff) + pr_err("socket address: %d is out of range.", skt); + } + + for (i = 0; i < MAX_MARS3_SOC_COUNT; i++) { + if (skt_cpu_cnt[i] > 0) + skt_bitmap |= (1 << i); + } + + return skt_bitmap; +} + +static void __init +gic_acpi_register_redist(phys_addr_t phys_base, void __iomem *redist_base) +{ + static int count = 0; + + acpi_data.redist_regs[count].phys_base = phys_base; + acpi_data.redist_regs[count].redist_base = redist_base; + acpi_data.redist_regs[count].single_redist = acpi_data.single_redist; + count++; +} + +static int __init +gic_acpi_parse_madt_redist(union acpi_subtable_headers *header, + const unsigned long end) +{ + struct acpi_madt_generic_redistributor *redist = + (struct acpi_madt_generic_redistributor *)header; + void __iomem *redist_base; + + redist_base = ioremap(redist->base_address, redist->length); + if (!redist_base) { + pr_err("Couldn't map GICR region @%llx\n", redist->base_address); + return -ENOMEM; + } + gic_request_region(redist->base_address, redist->length, "GICR"); + + gic_acpi_register_redist(redist->base_address, redist_base); + return 0; +} + +static int __init +gic_acpi_parse_madt_gicc(union acpi_subtable_headers *header, + const unsigned long end) +{ + struct acpi_madt_generic_interrupt *gicc = + (struct acpi_madt_generic_interrupt *)header; + u32 reg = readl_relaxed(acpi_data.dist_base + GICD_PIDR2) & GIC_PIDR2_ARCH_MASK; + u32 size = reg == GIC_PIDR2_ARCH_GICv4 ? SZ_64K * 4 : SZ_64K * 2; + void __iomem *redist_base; + + /* GICC entry which has !ACPI_MADT_ENABLED is not unusable so skip */ + if (!(gicc->flags & ACPI_MADT_ENABLED)) + return 0; + + redist_base = ioremap(gicc->gicr_base_address, size); + if (!redist_base) + return -ENOMEM; + gic_request_region(gicc->gicr_base_address, size, "GICR"); + + gic_acpi_register_redist(gicc->gicr_base_address, redist_base); + return 0; +} + +static int __init gic_acpi_collect_gicr_base(void) +{ + acpi_tbl_entry_handler redist_parser; + enum acpi_madt_type type; + + if (acpi_data.single_redist) { + type = ACPI_MADT_TYPE_GENERIC_INTERRUPT; + redist_parser = gic_acpi_parse_madt_gicc; + } else { + type = ACPI_MADT_TYPE_GENERIC_REDISTRIBUTOR; + redist_parser = gic_acpi_parse_madt_redist; + } + + /* Collect redistributor base addresses in GICR entries */ + if (acpi_table_parse_madt(type, redist_parser, 0) > 0) + return 0; + + pr_info("No valid GICR entries exist\n"); + return -ENODEV; +} + +static int __init gic_acpi_match_gicr(union acpi_subtable_headers *header, + const unsigned long end) +{ + /* Subtable presence means that redist exists, that's it */ + return 0; +} + +static int __init gic_acpi_match_gicc(union acpi_subtable_headers *header, + const unsigned long end) +{ + struct acpi_madt_generic_interrupt *gicc = + (struct acpi_madt_generic_interrupt *)header; + + /* + * If GICC is enabled and has valid gicr base address, then it means + * GICR base is presented via GICC + */ + if ((gicc->flags & ACPI_MADT_ENABLED) && gicc->gicr_base_address) { + acpi_data.enabled_rdists++; + return 0; + } + + /* + * It's perfectly valid firmware can pass disabled GICC entry, driver + * should not treat as errors, skip the entry instead of probe fail. + */ + if (!(gicc->flags & ACPI_MADT_ENABLED)) + return 0; + + return -ENODEV; +} + +static int __init gic_acpi_count_gicr_regions(void) +{ + int count; + + /* + * Count how many redistributor regions we have. It is not allowed + * to mix redistributor description, GICR and GICC subtables have to be + * mutually exclusive. + */ + count = acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_REDISTRIBUTOR, + gic_acpi_match_gicr, 0); + if (count > 0) { + acpi_data.single_redist = false; + return count; + } + + count = acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_INTERRUPT, + gic_acpi_match_gicc, 0); + if (count > 0) { + acpi_data.single_redist = true; + count = acpi_data.enabled_rdists; + } + + return count; +} + +static bool __init acpi_validate_gic_table(struct acpi_subtable_header *header, + struct acpi_probe_entry *ape) +{ + struct acpi_madt_generic_distributor *dist; + int count; + + dist = (struct acpi_madt_generic_distributor *)header; + if (dist->version != ape->driver_data) + return false; + + /* We need to do that exercise anyway, the sooner the better */ + count = gic_acpi_count_gicr_regions(); + if (count <= 0) + return false; + + acpi_data.nr_redist_regions = count; + return true; +} + +static int __init gic_acpi_parse_virt_madt_gicc(union acpi_subtable_headers *header, + const unsigned long end) +{ + struct acpi_madt_generic_interrupt *gicc = + (struct acpi_madt_generic_interrupt *)header; + int maint_irq_mode; + static int first_madt = true; + + /* Skip unusable CPUs */ + if (!(gicc->flags & ACPI_MADT_ENABLED)) + return 0; + + maint_irq_mode = (gicc->flags & ACPI_MADT_VGIC_IRQ_MODE) ? + ACPI_EDGE_SENSITIVE : ACPI_LEVEL_SENSITIVE; + + if (first_madt) { + first_madt = false; + + acpi_data.maint_irq = gicc->vgic_interrupt; + acpi_data.maint_irq_mode = maint_irq_mode; + acpi_data.vcpu_base = gicc->gicv_base_address; + + return 0; + } + + /* + * The maintenance interrupt and GICV should be the same for every CPU + */ + if ((acpi_data.maint_irq != gicc->vgic_interrupt) || + (acpi_data.maint_irq_mode != maint_irq_mode) || + (acpi_data.vcpu_base != gicc->gicv_base_address)) + return -EINVAL; + + return 0; +} + +static bool __init gic_acpi_collect_virt_info(void) +{ + int count; + + count = acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_INTERRUPT, + gic_acpi_parse_virt_madt_gicc, 0); + + return (count > 0); +} + +#define ACPI_GICV3_DIST_MEM_SIZE (SZ_64K) +#define ACPI_GICV2_VCTRL_MEM_SIZE (SZ_4K) +#define ACPI_GICV2_VCPU_MEM_SIZE (SZ_8K) + +static void __init gic_acpi_setup_kvm_info(void) +{ + int irq; + + if (!gic_acpi_collect_virt_info()) { + pr_warn("Unable to get hardware information used for virtualization\n"); + return; + } + + gic_v3_kvm_info.type = GIC_V3; + + irq = acpi_register_gsi(NULL, acpi_data.maint_irq, + acpi_data.maint_irq_mode, + ACPI_ACTIVE_HIGH); + if (irq <= 0) + return; + + gic_v3_kvm_info.maint_irq = irq; + + if (acpi_data.vcpu_base) { + struct resource *vcpu = &gic_v3_kvm_info.vcpu; + + vcpu->flags = IORESOURCE_MEM; + vcpu->start = acpi_data.vcpu_base; + vcpu->end = vcpu->start + ACPI_GICV2_VCPU_MEM_SIZE - 1; + } + + gic_v3_kvm_info.has_v4 = gic_data.rdists.has_vlpis; + gic_v3_kvm_info.has_v4_1 = gic_data.rdists.has_rvpeid; + vgic_set_kvm_info(&gic_v3_kvm_info); +} + +static struct fwnode_handle *gsi_domain_handle; + +static struct fwnode_handle *gic_s2500_get_gsi_domain_id(u32 gsi) +{ + return gsi_domain_handle; +} + +static int __init +gic_acpi_init(union acpi_subtable_headers *header, const unsigned long end) +{ + struct acpi_madt_generic_distributor *dist; + size_t size; + int i, err, skt; + + /* Get distributor base address */ + dist = (struct acpi_madt_generic_distributor *)header; + acpi_data.dist_base = ioremap(dist->base_address, + ACPI_GICV3_DIST_MEM_SIZE); + if (!acpi_data.dist_base) { + pr_err("Unable to map GICD registers\n"); + return -ENOMEM; + } + gic_request_region(dist->base_address, ACPI_GICV3_DIST_MEM_SIZE, "GICD"); + + err = gic_validate_dist_version(acpi_data.dist_base); + if (err) { + pr_err("No distributor detected at @%p, giving up\n", + acpi_data.dist_base); + goto out_dist_unmap; + } + + mars3_gic_dists[0].phys_base = dist->base_address; + mars3_gic_dists[0].size = ACPI_GICV3_DIST_MEM_SIZE; + mars3_gic_dists[0].dist_base = acpi_data.dist_base; + + mars3_sockets_bitmap = gic_mars3_sockets_bitmap(); + if (mars3_sockets_bitmap == 0) { + mars3_sockets_bitmap = 0x1; + pr_err("No socket, please check cpus MPIDR_AFFINITY_LEVEL!"); + } else + pr_info("mars3_sockets_bitmap = 0x%x\n", mars3_sockets_bitmap); + + for (skt = 1; skt < MAX_MARS3_SOC_COUNT; skt++) { + if (((1U << skt) & mars3_sockets_bitmap) == 0) + continue; + + mars3_gic_dists[skt].phys_base = ((unsigned long)skt << MARS3_ADDR_SKTID_SHIFT) | + mars3_gic_dists[0].phys_base; + mars3_gic_dists[skt].size = mars3_gic_dists[0].size; + mars3_gic_dists[skt].dist_base = ioremap(mars3_gic_dists[skt].phys_base, + mars3_gic_dists[skt].size); + } + + size = sizeof(*acpi_data.redist_regs) * acpi_data.nr_redist_regions; + acpi_data.redist_regs = kzalloc(size, GFP_KERNEL); + if (!acpi_data.redist_regs) { + err = -ENOMEM; + goto out_dist_unmap; + } + + err = gic_acpi_collect_gicr_base(); + if (err) + goto out_redist_unmap; + + gsi_domain_handle = irq_domain_alloc_fwnode(&dist->base_address); + if (!gsi_domain_handle) { + err = -ENOMEM; + goto out_redist_unmap; + } + + err = gic_init_bases(acpi_data.dist_base, acpi_data.redist_regs, + acpi_data.nr_redist_regions, 0, gsi_domain_handle); + if (err) + goto out_fwhandle_free; + + acpi_set_irq_model(ACPI_IRQ_MODEL_GIC, gic_s2500_get_gsi_domain_id); + + if (static_branch_likely(&supports_deactivate_key)) + gic_acpi_setup_kvm_info(); + + return 0; + +out_fwhandle_free: + irq_domain_free_fwnode(gsi_domain_handle); +out_redist_unmap: + for (i = 0; i < acpi_data.nr_redist_regions; i++) + if (acpi_data.redist_regs[i].redist_base) + iounmap(acpi_data.redist_regs[i].redist_base); + kfree(acpi_data.redist_regs); +out_dist_unmap: + iounmap(acpi_data.dist_base); + return err; +} +IRQCHIP_ACPI_DECLARE(gic_phyt_2500, ACPI_MADT_TYPE_OEM_RESERVED, + acpi_validate_gic_table, ACPI_MADT_GIC_VERSION_V3, + gic_acpi_init); +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/irq-phytium-ixic.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/irq-phytium-ixic.c new file mode 100644 index 0000000000000000000000000000000000000000..74b1c8c1af1e0c90f812885333fd53c37b5253f9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/irqchip/irq-phytium-ixic.c @@ -0,0 +1,270 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for Phytium PCIe legacy INTx interrupt controller + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +#define NUM_IRQS 4 + +#define CTR_BANK_NUM 6 +#define CTR_BANK_SIZE 0x10000 +#define CTR_BANK_ISTATUS_LOCAL 0x184 + +#define HPB_INTX_STATUS_0 0x0 +#define HPB_INTX_STATUS_1 0x1000 + +struct ixic_irq_data { + void __iomem *ctr; + void __iomem *hpb; + u32 spi_base; +}; + +static void phytium_ixic_irq_eoi(struct irq_data *d) +{ + struct ixic_irq_data *data = irq_data_get_irq_chip_data(d); + unsigned int intx = irqd_to_hwirq(d); + u32 gstatus = readl(data->hpb) | (readl(data->hpb + HPB_INTX_STATUS_1) << 12); + u32 imask, istatus; + int i; + + WARN_ON(intx >= NUM_IRQS); + imask = 1 << (3 - intx); + istatus = (1 << intx) << 24; + for (i = 0; i < CTR_BANK_NUM; i++, gstatus >>= 4) { + if (gstatus & imask) + writel(istatus, data->ctr + CTR_BANK_SIZE*i + CTR_BANK_ISTATUS_LOCAL); + } + + irq_chip_eoi_parent(d); +} + +static struct irq_chip phytium_ixic_irq_chip = { + .name = "IXIU", + .irq_eoi = phytium_ixic_irq_eoi, + .irq_mask = irq_chip_mask_parent, + .irq_unmask = irq_chip_unmask_parent, + .irq_set_type = irq_chip_set_type_parent, + .irq_set_affinity = irq_chip_set_affinity_parent, + .flags = IRQCHIP_MASK_ON_SUSPEND, +}; + +static int phytium_ixic_translate(struct irq_domain *domain, + struct irq_fwspec *fwspec, + unsigned long *hwirq, + unsigned int *type) +{ + struct ixic_irq_data *info = domain->host_data; + + if (is_of_node(fwspec->fwnode)) { + if (fwspec->param_count != 3) + return -EINVAL; + + if (fwspec->param[0] != GIC_SPI) + return -EINVAL; /* No PPI should point to this domain */ + + *hwirq = fwspec->param[1] - info->spi_base; + *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; + } else { + if (fwspec->param_count != 2) + return -EINVAL; + *hwirq = fwspec->param[0] - info->spi_base; + *type = fwspec->param[1] & IRQ_TYPE_SENSE_MASK; + } + + return 0; +} + +static int phytium_ixic_alloc(struct irq_domain *dom, unsigned int virq, + unsigned int nr_irqs, void *data) +{ + struct irq_fwspec *fwspec = data; + struct irq_fwspec parent_fwspec; + struct ixic_irq_data *info = dom->host_data; + irq_hw_number_t hwirq; + + /* We assume the device use the parent's format directly */ + parent_fwspec = *fwspec; + if (is_of_node(dom->parent->fwnode)) { + if (fwspec->param_count != 3) + return -EINVAL; /* Not GIC compliant */ + if (fwspec->param[0] != GIC_SPI) + return -EINVAL; /* No PPI should point to this domain */ + + /* Get the local hwirq of IXIC */ + hwirq = fwspec->param[1] - info->spi_base; + } else { + hwirq = fwspec->param[0] - info->spi_base; + } + WARN_ON(nr_irqs != 1); + irq_domain_set_hwirq_and_chip(dom, virq, hwirq, &phytium_ixic_irq_chip, info); + + parent_fwspec.fwnode = dom->parent->fwnode; + return irq_domain_alloc_irqs_parent(dom, virq, nr_irqs, &parent_fwspec); +} + +static const struct irq_domain_ops ixic_domain_ops = { + .translate = phytium_ixic_translate, + .alloc = phytium_ixic_alloc, + .free = irq_domain_free_irqs_common, +}; + +static struct ixic_irq_data *phytium_ixic_init(const struct fwnode_handle *fwnode, + struct resource *ctr, struct resource *hpb) +{ + struct ixic_irq_data *data; + int err; + + data = kzalloc(sizeof(*data), GFP_KERNEL); + if (!data) + return ERR_PTR(-ENOMEM); + + if (fwnode_property_read_u32_array(fwnode, "intx-spi-base", + &data->spi_base, 1)) { + err = -ENODEV; + goto out_free; + } + + data->ctr = ioremap(ctr->start, resource_size(ctr)); + if (!data->ctr) { + err = -ENODEV; + goto out_free; + } + + data->hpb = ioremap(hpb->start, resource_size(hpb)); + if (!data->hpb) { + err = -ENODEV; + goto out_free; + } + + return data; + +out_free: + kfree(data); + return ERR_PTR(err); +} + +static int __init phytium_ixic_dt_init(struct device_node *node, + struct device_node *parent) +{ + struct irq_domain *pd, *d; + struct ixic_irq_data *data; + struct resource ctr, hpb; + + if (!parent) { + pr_err("%pOF: no parent, giving up\n", node); + return -ENODEV; + } + + pd = irq_find_host(parent); + if (!pd) { + pr_err("%pOF: unable to obtain parent domain\n", node); + return -ENXIO; + } + + if (of_address_to_resource(node, 0, &ctr)) { + pr_err("%pOF: failed to parse 'ctr' memory resource\n", node); + return -ENXIO; + } + + if (of_address_to_resource(node, 1, &hpb)) { + pr_err("%pOF: failed to parse 'hpb' memory resource\n", node); + return -ENXIO; + } + + data = phytium_ixic_init(of_node_to_fwnode(node), &ctr, &hpb); + if (IS_ERR(data)) + return PTR_ERR(data); + + d = irq_domain_add_hierarchy(pd, 0, NUM_IRQS, node, &ixic_domain_ops, data); + if (!d) { + pr_err("%pOF: failed to allocate domain\n", node); + goto out_unmap; + } + + pr_info("%pOF: %d interrupts forwarded to %pOF\n", node, NUM_IRQS, parent); + + return 0; + +out_unmap: + iounmap(data->ctr); + iounmap(data->hpb); + kfree(data); + return -ENOMEM; +} +IRQCHIP_DECLARE(ixic, "phytium,ixic", phytium_ixic_dt_init); + +#ifdef CONFIG_ACPI +static int phytium_ixic_acpi_probe(struct platform_device *pdev) +{ + struct irq_domain *domain; + struct ixic_irq_data *data; + struct resource *ctr, *hpb; + + ctr = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!ctr) { + dev_err(&pdev->dev, "failed to parse 'ctr' memory resource\n"); + return -ENXIO; + } + + hpb = platform_get_resource(pdev, IORESOURCE_MEM, 1); + if (!hpb) { + dev_err(&pdev->dev, "failed to parse 'hpb' memory resource\n"); + return -ENXIO; + } + + data = phytium_ixic_init(dev_fwnode(&pdev->dev), ctr, hpb); + if (IS_ERR(data)) + return PTR_ERR(data); + + domain = acpi_irq_create_hierarchy(0, NUM_IRQS, dev_fwnode(&pdev->dev), + &ixic_domain_ops, data); + if (!domain) { + dev_err(&pdev->dev, "failed to create IRQ domain\n"); + goto out_unmap; + } + + dev_info(&pdev->dev, "%d interrupts forwarded\n", NUM_IRQS); + + return 0; + +out_unmap: + iounmap(data->ctr); + iounmap(data->hpb); + kfree(data); + return -ENOMEM; +} + +static const struct acpi_device_id phytium_ixic_acpi_ids[] = { + { "PHYT0013" }, + { /* sentinel */ } +}; +MODULE_DEVICE_TABLE(acpi, phytium_ixic_acpi_ids); + +static struct platform_driver phytium_ixic_driver = { + .driver = { + .name = "phytium-ixic", + .acpi_match_table = phytium_ixic_acpi_ids, + }, + .probe = phytium_ixic_acpi_probe, +}; + +static int __init phytium_ixic_driver_init(void) +{ + return platform_driver_register(&phytium_ixic_driver); +} + +core_initcall(phytium_ixic_driver_init); +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mailbox/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/mailbox/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..6d47b0c3b2994bea040fb3143ba304729d9b46e6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mailbox/Kconfig @@ -0,0 +1,10 @@ +config PHYTIUM_MBOX + tristate "Phytium SoC Mailbox Support" + depends on ARCH_PHYTIUM || COMPILE_TEST + help + Mailbox driver implementation for the Phytium platform. It is used + to send message between application processors and on-chip management + firmware. Say Y here if you want to build this mailbox controller + driver. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mailbox/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/mailbox/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..1e576a5426ba27e2b7f5bda89d76f9ecb5dbae68 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mailbox/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_PHYTIUM_MBOX) += phytium_mailbox.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mailbox/phytium_mailbox.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/mailbox/phytium_mailbox.c new file mode 100644 index 0000000000000000000000000000000000000000..14d3b40cbd09dad5e7f01b8ea06aeb26d4422984 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mailbox/phytium_mailbox.c @@ -0,0 +1,216 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SoC mailbox driver + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + * + * Derived from drivers/mailbox/arm_mhu.c + * Copyright (C) 2013-2015 Fujitsu Semiconductor Ltd. + * Copyright (C) 2015 Linaro Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define INTR_STAT 0x0 +#define INTR_SET 0x8 +#define INTR_CLR 0x10 + +#define TX_REG 0x100 + +#define NR_CHANS 1 + +static spinlock_t lock; + +struct phytium_mbox_link { + unsigned int irq; + void __iomem *tx_reg; + void __iomem *rx_reg; +}; + +struct phytium_mbox { + void __iomem *base; + struct phytium_mbox_link mlink; + struct mbox_chan chan; + struct mbox_controller mbox; +}; + +static irqreturn_t phytium_mbox_rx_irq(int irq, void *ch) +{ + struct mbox_chan *chan = ch; + struct phytium_mbox_link *mlink = chan->con_priv; + u32 val; + unsigned long flags = 0; + + spin_lock_irqsave(&lock, flags); + val = readl_relaxed(mlink->rx_reg + INTR_STAT); + spin_unlock_irqrestore(&lock, flags); + if (!val) + return IRQ_NONE; + + mbox_chan_received_data(chan, (void *)&val); + + spin_lock_irqsave(&lock, flags); + writel_relaxed(val, mlink->rx_reg + INTR_CLR); + spin_unlock_irqrestore(&lock, flags); + + return IRQ_HANDLED; +} + +static int phytium_mbox_send_data(struct mbox_chan *chan, void *data) +{ + struct phytium_mbox_link *mlink = chan->con_priv; + u32 *arg = data; + unsigned long flags = 0; + + spin_lock_irqsave(&lock, flags); + writel_relaxed(*arg, mlink->tx_reg + INTR_SET); + spin_unlock_irqrestore(&lock, flags); + + return 0; +} + +static int phytium_mbox_startup(struct mbox_chan *chan) +{ + struct phytium_mbox_link *mlink = chan->con_priv; + u32 val; + int ret; + unsigned long flags = 0; + + spin_lock_irqsave(&lock, flags); + val = readl_relaxed(mlink->tx_reg + INTR_STAT); + writel_relaxed(val, mlink->tx_reg + INTR_CLR); + spin_unlock_irqrestore(&lock, flags); + + ret = request_irq(mlink->irq, phytium_mbox_rx_irq, + IRQF_SHARED, "phytium_mbox_link", chan); + if (ret) { + dev_err(chan->mbox->dev, + "Unable to acquire IRQ %d\n", mlink->irq); + } + + return ret; +} + +static void phytium_mbox_shutdown(struct mbox_chan *chan) +{ + struct phytium_mbox_link *mlink = chan->con_priv; + + free_irq(mlink->irq, chan); +} + +static bool phytium_mbox_last_tx_done(struct mbox_chan *chan) +{ + unsigned long flags; + struct phytium_mbox_link *mlink = chan->con_priv; + u32 val; + + spin_lock_irqsave(&lock, flags); + val = readl_relaxed(mlink->tx_reg + INTR_STAT); + spin_unlock_irqrestore(&lock, flags); + + return (val == (u32)(1U << 31)); +} + +static const struct mbox_chan_ops phytium_mbox_ops = { + .send_data = phytium_mbox_send_data, + .startup = phytium_mbox_startup, + .shutdown = phytium_mbox_shutdown, + .last_tx_done = phytium_mbox_last_tx_done, +}; + +static const struct acpi_device_id phytium_mbox_acpi_match[] = { + { "PHYT0009", 0 }, + { }, +}; +MODULE_DEVICE_TABLE(acpi, phytium_mbox_acpi_match); + +static const struct of_device_id phytium_mbox_of_match[] = { + { .compatible = "phytium,mbox", }, + { }, +}; +MODULE_DEVICE_TABLE(of, phytium_mbox_of_match); + +static int phytium_mbox_probe(struct platform_device *pdev) +{ + struct phytium_mbox *mbox; + struct resource *res; + int err, irq; + + spin_lock_init(&lock); + + /* Allocate memory for device */ + mbox = devm_kzalloc(&pdev->dev, sizeof(*mbox), GFP_KERNEL); + if (!mbox) + return -ENOMEM; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + mbox->base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(mbox->base)) { + dev_err(&pdev->dev, "ioremap base failed\n"); + return PTR_ERR(mbox->base); + } + + irq = platform_get_irq(pdev, 0); + if (irq < 0) { + dev_err(&pdev->dev, "cannot obtain irq\n"); + return irq; + } + + mbox->chan.con_priv = &mbox->mlink; + mbox->mlink.irq = irq; + mbox->mlink.rx_reg = mbox->base; + mbox->mlink.tx_reg = mbox->mlink.rx_reg + TX_REG; + + mbox->mbox.dev = &pdev->dev; + mbox->mbox.chans = &mbox->chan; + mbox->mbox.num_chans = NR_CHANS; + mbox->mbox.ops = &phytium_mbox_ops; + mbox->mbox.txdone_irq = false; + mbox->mbox.txdone_poll = true; + mbox->mbox.txpoll_period = 1; + + platform_set_drvdata(pdev, mbox); + + err = mbox_controller_register(&mbox->mbox); + if (err) { + dev_err(&pdev->dev, "Failed to register mailboxes %d\n", err); + goto fail; + } + + dev_info(&pdev->dev, "Phytium SoC Mailbox registered\n"); +fail: + return err; +} + +static int phytium_mbox_remove(struct platform_device *pdev) +{ + struct phytium_mbox *mbox = platform_get_drvdata(pdev); + + mbox_controller_unregister(&mbox->mbox); + + return 0; +} + +static struct platform_driver phytium_mbox_driver = { + .probe = phytium_mbox_probe, + .remove = phytium_mbox_remove, + .driver = { + .name = "phytium-mbox", + .of_match_table = of_match_ptr(phytium_mbox_of_match), + .acpi_match_table = ACPI_PTR(phytium_mbox_acpi_match), + }, +}; + +module_platform_driver(phytium_mbox_driver); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium SoC Mailbox Driver"); +MODULE_AUTHOR("Chen Baozi "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..498314fbfc94763260f4898ba65195268ff0a378 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/Kconfig @@ -0,0 +1,14 @@ +# SPDX-License-Identifier: GPL-2.0-only + +comment "Phytium media platform drivers" + +config VIDEO_PHYTIUM_JPEG + tristate "Phytium JPEG Encoder Engine driver" + depends on V4L_PLATFORM_DRIVERS + depends on VIDEO_DEV + select VIDEOBUF2_DMA_CONTIG + help + Support for the Phytium JPEG Encoder Engine embedded + in the Phytium SOCs. The engine can capture and + compress video data from digital or analog sources. + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..79b6bfa52d5041b5f3651e7fd05e0286f0dd08ba --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/Makefile @@ -0,0 +1,5 @@ +# SPDX-License-Identifier: GPL-2.0-only +# +phytium_jpeg-objs := phytium_jpeg_core.o + +obj-$(CONFIG_VIDEO_PHYTIUM_JPEG) += phytium_jpeg.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/phytium_jpeg_core.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/phytium_jpeg_core.c new file mode 100644 index 0000000000000000000000000000000000000000..014af0162c49f7e413f4a2b4f62aae77a1994671 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/phytium_jpeg_core.c @@ -0,0 +1,1379 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for Phytium JPEG Encoder Engine + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include "phytium_jpeg_reg.h" +#include "phytium_jpeg_core.h" +#include + +static u32 phytium_jpeg_header[PHYTIUM_JPEG_HEADER_SIZE] = { + 0xe0ffd8ff, 0x464a0100, 0x01004649, 0x01000001, + 0x00000100, 0x4300dbff, 0x0c0b1000, 0x100a0c0e, + 0x120e0d0e, 0x18131011, 0x16181a28, 0x23311816, + 0x3a281d25, 0x393c3d33, 0x40373833, 0x404e5c48, + 0x37455744, 0x516d5038, 0x67625f57, 0x4d3e6768, + 0x64707971, 0x67655c78, 0x00dbff63, 0x12110143, + 0x18151812, 0x2f1a1a2f, 0x42384263, 0x63636363, + 0x63636363, 0x63636363, 0x63636363, 0x63636363, + 0x63636363, 0x63636363, 0x63636363, 0x63636363, + 0x63636363, 0x63636363, 0x63636363, 0xc0ff6363, + /* h_index(40) indicates high 8 bits of the height + * w_index(41) contains the low 8 bits of the height, + * and the width. For example, height 480(0x01e0) + * locates at 0x<01> 081100 and 0x038002 . + * width 640 (0x0280) locates at 0x03 <80> <02> e0. + */ + + /* 0x0200 <11> 01 is a field marks YUV mode */ + 0x01081100, 0x038002e0, 0x02001101, 0x11030111, + 0x00c4ff01, 0x0100001f, 0x01010105, 0x00010101, + 0x00000000, 0x01000000, 0x05040302, 0x09080706, + 0xc4ff0b0a, 0x00011f00, 0x01010103, 0x01010101, + 0x00000101, 0x00000000, 0x04030201, 0x08070605, + 0xff0b0a09, 0x10b500c4, 0x03010200, 0x03040203, + 0x04040505, 0x7d010000, 0x00030201, 0x12051104, + 0x06413121, 0x07615113, 0x32147122, 0x08a19181, + 0xc1b14223, 0xf0d15215, 0x72623324, 0x160a0982, + 0x1a191817, 0x28272625, 0x35342a29, 0x39383736, + 0x4544433a, 0x49484746, 0x5554534a, 0x59585756, + 0x6564635a, 0x69686766, 0x7574736a, 0x79787776, + 0x8584837a, 0x89888786, 0x9493928a, 0x98979695, + 0xa3a29a99, 0xa7a6a5a4, 0xb2aaa9a8, 0xb6b5b4b3, + 0xbab9b8b7, 0xc5c4c3c2, 0xc9c8c7c6, 0xd4d3d2ca, + 0xd8d7d6d5, 0xe2e1dad9, 0xe6e5e4e3, 0xeae9e8e7, + 0xf4f3f2f1, 0xf8f7f6f5, 0xc4fffaf9, 0x0011b500, + 0x04020102, 0x07040304, 0x00040405, 0x00770201, + 0x11030201, 0x31210504, 0x51411206, 0x13716107, + 0x08813222, 0xa1914214, 0x2309c1b1, 0x15f05233, + 0x0ad17262, 0xe1342416, 0x1817f125, 0x27261a19, + 0x352a2928, 0x39383736, 0x4544433a, 0x49484746, + 0x5554534a, 0x59585756, 0x6564635a, 0x69686766, + 0x7574736a, 0x79787776, 0x8483827a, 0x88878685, + 0x93928a89, 0x97969594, 0xa29a9998, 0xa6a5a4a3, + 0xaaa9a8a7, 0xb5b4b3b2, 0xb9b8b7b6, 0xc4c3c2ba, + 0xc8c7c6c5, 0xd3d2cac9, 0xd7d6d5d4, 0xe2dad9d8, + 0xe6e5e4e3, 0xeae9e8e7, 0xf5f4f3f2, 0xf9f8f7f6, + 0x00fefffa, 0x0000008f, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0x00000000, 0x00000000, 0x00000000, 0x00000000, + 0xdaff0000, 0x01030c00, 0x03110200, 0x003f0011 +}; + +static char yuv_mode_str[YUV_MODE_STR_LEN] = { "yuv444" }; + +module_param_string(yuv_mode, yuv_mode_str, sizeof(yuv_mode_str), 0444); +MODULE_PARM_DESC(yuv_mode, "Users select one mode from such modes as 'yuv444', or 'yuv422', or 'yuv420'. If no mode is set, the driver adapts defaults mode 'yuv444'."); + +static u32 phytium_jpeg_read(struct phytium_jpeg_dev *jpeg_dev, u32 reg) +{ + u32 reg_val = readl(jpeg_dev->base_addr + reg); + + dev_dbg(jpeg_dev->dev, "read 0x%p + 0x%x -->val[0x%x]\n", + jpeg_dev->base_addr, reg, reg_val); + + return reg_val; +} + +static void phytium_jpeg_write(struct phytium_jpeg_dev *jpeg_dev, + u32 reg, u32 val) +{ + writel(val, jpeg_dev->base_addr + reg); + dev_dbg(jpeg_dev->dev, "write 0x%x to addr 0x%p + 0x%x\n", + val, jpeg_dev->base_addr, reg); +} + +static void phytium_jpeg_update(struct phytium_jpeg_dev *jpeg_dev, u32 reg, + u32 clear, u32 bits) +{ + u32 reg_val = readl(jpeg_dev->base_addr + reg); + u32 tmp = reg_val; + + reg_val &= ~clear; + reg_val |= bits; + writel(reg_val, jpeg_dev->base_addr + reg); + + dev_dbg(jpeg_dev->dev, "the val of addr 0x%p + 0x%x, from 0x%x to 0x%x\n", + jpeg_dev->base_addr, reg, tmp, readl(jpeg_dev->base_addr + reg)); +} + +static void phytium_jpeg_init_regs(struct phytium_jpeg_dev *jpeg_dev) +{ + u32 transform_info = 0; + u32 disable_all_interrupt = 0; + u32 clear_all_interrupt = INT_FIFO_OVERFLOW | INT_OCM_BUF_OVERFLOW | + INT_JPEG_ENCODE_COMPLETE | INT_VIDEO_FORMAT_CHANGE; + u32 rate_to_reg = 0; + + /* First, disable the JPEG engine, set bit0 = 0*/ + phytium_jpeg_write(jpeg_dev, TRANSFORM_INFO_REG, transform_info); + + /* Second, set VGAvideo_source_information. bit1 = 0 marks VGA */ + transform_info |= 0; + + /* Third, set AXI burst length bit[16:22]= 0xf , default value*/ + transform_info |= (0xF << TRANS_AXI_LEN_SHIFT) & TRANSINFO_AXI_LEN; + + /* Fourth, the default sampling format is YUV422, set bit13 to 0 */ + /* ignore setting sampling interval */ + phytium_jpeg_write(jpeg_dev, TRANSFORM_INFO_REG, transform_info); + udelay(5); + + /* Fifth, setting frame rate. + * Linux driver prohibit float point operations. So use the + * format: reg_val = (1 second * 10^8 / frame_rate / 134 *100) + * write reg_val to register. then enable Highest bit31 = 1 + */ + if (jpeg_dev->frame_rate) { + rate_to_reg = 100000000 / jpeg_dev->frame_rate / 134 * 100; + rate_to_reg |= FRAME_SAMPLE_CTRL_EN; + phytium_jpeg_write(jpeg_dev, FRAME_SAMPLE_CTRL, rate_to_reg); + } + /* Sixth, HUFF_MODE, driver needn't to configure, ignore */ + + /* disable all interrupts and then clear all interrupts */ + phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, + disable_all_interrupt); + udelay(5); + phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, clear_all_interrupt); + + /* Seventh, Sample_mode, hardware default is yuv444 */ + jpeg_dev->yuv420 = false; +} + +/* Turn on the clock of the jpeg engine */ +static void phytium_jpeg_on(struct phytium_jpeg_dev *jpeg_dev) +{ + if (test_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status)) + return; + + /* Turn on the relevant clocks */ + set_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status); +} + +/* Disable the jpeg engine */ +static void phytium_jpeg_off(struct phytium_jpeg_dev *jpeg_dev) +{ + u32 disable_all_interrupt = 0; + u32 clear_all_interrupt = INT_FIFO_OVERFLOW | INT_OCM_BUF_OVERFLOW | + INT_JPEG_ENCODE_COMPLETE | INT_VIDEO_FORMAT_CHANGE; + + if (!test_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status)) { + dev_info(jpeg_dev->dev, "JPEG Engine is already off.\n"); + return; + } + + /* disable all interrupt */ + phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, disable_all_interrupt); + /* clear all interrupt */ + phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, clear_all_interrupt); + /* disable JPEG engine */ + phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 0); + + clear_bit(VIDEO_CLOCKS_ON, &jpeg_dev->status); + /* wait 50 ms */ + mdelay(50); + /* C08 bit7 1:busy */ +} + +static inline void phytium_jpeg_enable_source_detecting(struct phytium_jpeg_dev *jpeg_dev) +{ + /* + * Enable the dectection to discovery + * the source resolution is changed + */ + //phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, DETECT_RESOLUTION_CHANGE_EN); + phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, 0, TRANSINFO_SRC_SELECT); +} + +#define res_check(val) \ + test_and_clear_bit(VIDEO_MODE_DETECT_DONE, &(val)->status) + +static void phytium_jpeg_get_resolution(struct phytium_jpeg_dev *jpeg_dev) +{ + u32 source_info; + u32 width; + u32 height; + struct v4l2_bt_timings *detected_timings = &jpeg_dev->detected_timings; + + /* Before get a new resolution, maybe need to wait 10 us */ + detected_timings->width = MIN_WIDTH; + detected_timings->height = MIN_HEIGHT; + jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; + + + phytium_jpeg_enable_source_detecting(jpeg_dev); + source_info = phytium_jpeg_read(jpeg_dev, SRC_VGA_INFO_REG); + width = (source_info & SRC_HOR_PIXELS) >> SRC_WIDTH_SHIFT; + height = (source_info & SRC_VER_PIXELS) >> SRC_HEIGHT_SHIFT; + + if (width * height != 0) { + detected_timings->width = width; + detected_timings->height = height; + } + + jpeg_dev->v4l2_input_status = 0; + + /* + * Resolution is changed will trigger an interrupt, resolution detecting + * also is disable during process interrupt. So re-enable. + */ + phytium_jpeg_enable_source_detecting(jpeg_dev); + dev_info(jpeg_dev->dev, "Change resolution: %uX%u\n", width, height); +} + +static void phytium_jpeg_set_resolution(struct phytium_jpeg_dev *jpeg_dev) +{ + struct v4l2_bt_timings *active_timings = &jpeg_dev->active_timings; + int i; + int src_addrs[OCM_BUF_NUM]; + /* + * The OCM address space is 0x30C0_0000 ~ 0x30C7_FFFF, JPEG Engine uses the + * high-bottom address. src_0 uses 0x30C4_0000 ~ 0x30c6_0000 (total capacity is + * 128KB, greater than the requirements of the largest resolution). src_1 uses + * 0x30C6_0000 ~ 0x30C7_FFFF. + */ + + /* The OCM address should shift right 8 bits */ + for (i = 0; i < OCM_BUF_NUM; i++) + src_addrs[i] = jpeg_dev->src_addrs[i].dma_addr >> OCM_BUF_SHIFT; + + phytium_jpeg_write(jpeg_dev, OCM_BUF0_ADDR, src_addrs[0]); + phytium_jpeg_write(jpeg_dev, OCM_BUF1_ADDR, src_addrs[1]); + + /* + * In the worst case, the size of one image will be compressed to 25% the + * raw image's size. When a pixel is 4-byte, no need to divide 4. + */ + jpeg_dev->max_compressed_size = active_timings->width * active_timings->height; +} + +/* The below functions is implemented for various v4l2 ioctl operations */ +static int phytium_jpeg_querycap(struct file *file, void *priv, + struct v4l2_capability *cap) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + strscpy(cap->driver, PHYTIUM_JPEG_NAME, sizeof(cap->driver)); + strscpy(cap->card, "Phytium JPEG Engine", sizeof(cap->card)); + snprintf(cap->bus_info, sizeof(cap->bus_info), "platform:%s", dev_name(jpeg_dev->dev)); + + return 0; +} + +static int phytium_jpeg_enum_format(struct file *file, void *priv, + struct v4l2_fmtdesc *f) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + if (f->index) { + dev_err(jpeg_dev->dev, "Failed to enum format\n"); + return -EINVAL; + } + + f->pixelformat = V4L2_PIX_FMT_JPEG; + + return 0; +} + +static int phytium_jpeg_get_format(struct file *file, void *priv, + struct v4l2_format *f) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + f->fmt.pix = jpeg_dev->pix_fmt; + + return 0; +} + +static int phytium_jpeg_enum_input(struct file *file, void *priv, + struct v4l2_input *input) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + if (input->index) { + dev_err(jpeg_dev->dev, "failed to enum input\n"); + return -EINVAL; + } + + strscpy(input->name, "Host DC Capture", sizeof(input->name)); + input->type = V4L2_INPUT_TYPE_CAMERA; + input->capabilities = V4L2_IN_CAP_DV_TIMINGS; + input->status = jpeg_dev->v4l2_input_status; + + return 0; +} + +static int phytium_jpeg_get_input(struct file *file, void *priv, + unsigned int *i) +{ + *i = 0; + return 0; +} + +static int phytium_jpeg_set_input(struct file *file, void *priv, + unsigned int i) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + if (i != 0) { + dev_err(jpeg_dev->dev, "Failed to set input\n"); + return -EINVAL; + } + + return 0; +} + +static int phytium_jpeg_get_parm(struct file *file, void *priv, + struct v4l2_streamparm *stream) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + /* Readbuffers num is 3 */ + stream->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; + stream->parm.capture.readbuffers = CAPTURE_BUF_NUMBER; + stream->parm.capture.timeperframe.denominator = 1; + + if (jpeg_dev->frame_rate == 0) + stream->parm.capture.timeperframe.denominator = MAX_FRAME_RATE; + else + stream->parm.capture.timeperframe.denominator = jpeg_dev->frame_rate; + + return 0; +} + +static int phytium_jpeg_set_parm(struct file *file, void *priv, + struct v4l2_streamparm *stream) +{ + unsigned int frame_rate = 0; + u32 rate_to_reg = 0; + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + /* Readbuffers num is 3 */ + stream->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; + stream->parm.capture.readbuffers = CAPTURE_BUF_NUMBER; + + if (stream->parm.capture.timeperframe.numerator) + frame_rate = stream->parm.capture.timeperframe.denominator / + stream->parm.capture.timeperframe.numerator; + + if (frame_rate == 0 || frame_rate > MAX_FRAME_RATE) { + frame_rate = MAX_FRAME_RATE; + stream->parm.capture.timeperframe.denominator = MAX_FRAME_RATE; + stream->parm.capture.timeperframe.numerator = 1; + } + /* + * reg_val = (1 second * 10^9 / frame_rate / 13.4) + * Linux driver prohibit float point operations. So use the + * format: reg_val = (1 second * 10^8 / frame_rate / 134 *100) + * write reg_val to register. then enable Highest bit31 = 1 + */ + if (jpeg_dev->frame_rate != frame_rate) { + jpeg_dev->frame_rate = frame_rate; + rate_to_reg = 100000000 / jpeg_dev->frame_rate / 134 * 100; + rate_to_reg |= FRAME_SAMPLE_CTRL_EN; + phytium_jpeg_write(jpeg_dev, FRAME_SAMPLE_CTRL, rate_to_reg); + } + + return 0; +} + +static int phytium_jpeg_enum_framesizes(struct file *file, void *priv, + struct v4l2_frmsizeenum *fsize) + +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + if (fsize->index != 0) { + dev_err(jpeg_dev->dev, "Failed to enum framesize.\n"); + return -EINVAL; + } + + if (fsize->pixel_format != V4L2_PIX_FMT_JPEG) { + dev_err(jpeg_dev->dev, "enum framesize pixel_format is not JPEG"); + return -EINVAL; + } + + fsize->discrete.width = jpeg_dev->pix_fmt.width; + fsize->discrete.height = jpeg_dev->pix_fmt.height; + fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; + + return 0; + +} + +static int phytium_jpeg_enum_frameintervals(struct file *file, void *priv, + struct v4l2_frmivalenum *fival) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + if (fival->index != 0) { + dev_err(jpeg_dev->dev, "enum frame intervals failed\n"); + return -EINVAL; + } + + if (fival->width != jpeg_dev->detected_timings.width || + fival->height != jpeg_dev->detected_timings.height) { + dev_err(jpeg_dev->dev, "interval isn't same with the detected_timings.\n"); + return -EINVAL; + } + + if (fival->pixel_format != V4L2_PIX_FMT_JPEG) { + dev_err(jpeg_dev->dev, "enum frame interval pixel fomat is incorrect.\n"); + return -EINVAL; + } + + fival->type = V4L2_FRMIVAL_TYPE_CONTINUOUS; + fival->stepwise.min.denominator = MAX_FRAME_RATE; + fival->stepwise.min.numerator = 1; + fival->stepwise.max.denominator = 1; + fival->stepwise.max.numerator = 1; + fival->stepwise.step = fival->stepwise.max; + + return 0; +} + +static int phytium_jpeg_set_dv_timings(struct file *file, void *priv, + struct v4l2_dv_timings *timings) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + /* the params are passed from user space are same with hardware's params */ + if (timings->bt.width == jpeg_dev->active_timings.width && + timings->bt.height == jpeg_dev->active_timings.height) + return 0; + + if (vb2_is_busy(&jpeg_dev->queue)) { + dev_err(jpeg_dev->dev, "queue is busy during setting dv timings.\n"); + return -EBUSY; + } + + jpeg_dev->active_timings = timings->bt; + phytium_jpeg_set_resolution(jpeg_dev); + jpeg_dev->pix_fmt.width = timings->bt.width; + jpeg_dev->pix_fmt.height = timings->bt.height; + jpeg_dev->pix_fmt.sizeimage = jpeg_dev->max_compressed_size; + timings->type = V4L2_DV_BT_656_1120; + + return 0; +} + +static int phytium_jpeg_get_dv_timings(struct file *file, void *priv, + struct v4l2_dv_timings *timings) +{ + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + timings->type = V4L2_DV_BT_656_1120; + timings->bt = jpeg_dev->active_timings; + + return 0; +} + +static int phytium_jpeg_query_dv_timings(struct file *file, void *priv, + struct v4l2_dv_timings *timings) +{ + int ret; + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + /* + * This blocks only if the driver is currently in the process of + * detecting a new resolution; in the event of no signal or timeout + * this function is woken up. + */ + if ((file->f_flags & O_NONBLOCK) && + test_bit(VIDEO_RES_CHANGE, &jpeg_dev->status)) + return -EAGAIN; + + ret = wait_event_interruptible(jpeg_dev->wait, !test_bit(VIDEO_RES_CHANGE, + &jpeg_dev->status)); + if (ret) { + dev_err(jpeg_dev->dev, "Failed to query dv timing\n"); + return -EINTR; + } + + timings->type = V4L2_DV_BT_656_1120; + timings->bt = jpeg_dev->detected_timings; + + return jpeg_dev->v4l2_input_status ? -ENOLINK : 0; +} + +static const struct v4l2_dv_timings_cap phytium_jpeg_timings_cap = { + .type = V4L2_DV_BT_656_1120, + .bt = { + .min_width = MIN_WIDTH, + .max_width = MAX_WIDTH, + .min_height = MIN_HEIGHT, + .max_height = MAX_HEIGHT, + .min_pixelclock = 6574080, /* 640 x 480 x 24Hz */ + .max_pixelclock = 1244160000, /* 1920 x 1080 x 60Hz */ + .standards = V4L2_DV_BT_STD_CEA861 | V4L2_DV_BT_STD_DMT | + V4L2_DV_BT_STD_CVT | V4L2_DV_BT_STD_GTF, + .capabilities = V4L2_DV_BT_CAP_PROGRESSIVE | + V4L2_DV_BT_CAP_REDUCED_BLANKING | + V4L2_DV_BT_CAP_CUSTOM, + }, +}; + +static int phytium_jpeg_enum_dv_timings(struct file *file, void *priv, + struct v4l2_enum_dv_timings *timings) +{ + return v4l2_enum_dv_timings_cap(timings, &phytium_jpeg_timings_cap, + NULL, NULL); +} + +static int phytium_jpeg_dv_timings_cap(struct file *file, void *priv, + struct v4l2_dv_timings_cap *cap) +{ + *cap = phytium_jpeg_timings_cap; + + return 0; +} + +/* The function is used to notify DV that video resolution is altered */ +static int phytium_jpeg_sub_event(struct v4l2_fh *fh, + const struct v4l2_event_subscription *sub) +{ + switch (sub->type) { + case V4L2_EVENT_SOURCE_CHANGE: + return v4l2_src_change_event_subscribe(fh, sub); + default: + break; + } + + return v4l2_ctrl_subscribe_event(fh, sub); +} + +static const struct v4l2_ioctl_ops phytium_jpeg_ioctl_ops = { + .vidioc_querycap = phytium_jpeg_querycap, + .vidioc_enum_fmt_vid_cap = phytium_jpeg_enum_format, + .vidioc_g_fmt_vid_cap = phytium_jpeg_get_format, + .vidioc_s_fmt_vid_cap = phytium_jpeg_get_format, + .vidioc_try_fmt_vid_cap = phytium_jpeg_get_format, + .vidioc_reqbufs = vb2_ioctl_reqbufs, + .vidioc_querybuf = vb2_ioctl_querybuf, + .vidioc_qbuf = vb2_ioctl_qbuf, + .vidioc_expbuf = vb2_ioctl_expbuf, + .vidioc_dqbuf = vb2_ioctl_dqbuf, + .vidioc_create_bufs = vb2_ioctl_create_bufs, + .vidioc_prepare_buf = vb2_ioctl_prepare_buf, + .vidioc_streamon = vb2_ioctl_streamon, + .vidioc_streamoff = vb2_ioctl_streamoff, + .vidioc_enum_input = phytium_jpeg_enum_input, + .vidioc_g_input = phytium_jpeg_get_input, + .vidioc_s_input = phytium_jpeg_set_input, + .vidioc_g_parm = phytium_jpeg_get_parm, + .vidioc_s_parm = phytium_jpeg_set_parm, + .vidioc_enum_framesizes = phytium_jpeg_enum_framesizes, + .vidioc_enum_frameintervals = phytium_jpeg_enum_frameintervals, + .vidioc_s_dv_timings = phytium_jpeg_set_dv_timings, + .vidioc_g_dv_timings = phytium_jpeg_get_dv_timings, + .vidioc_query_dv_timings = phytium_jpeg_query_dv_timings, + .vidioc_enum_dv_timings = phytium_jpeg_enum_dv_timings, + .vidioc_dv_timings_cap = phytium_jpeg_dv_timings_cap, + .vidioc_subscribe_event = phytium_jpeg_sub_event, + .vidioc_unsubscribe_event = v4l2_event_unsubscribe, +}; + +static void phytium_jpeg_init_jpeg_quant(struct phytium_jpeg_dev *jpeg_dev) +{ + const u32 y_quant_table[QUANT_REG_NUM] = { + 0x08000000, 0x0ba2e8ba, 0x0aaaaaab, 0x09249249, 0x0aaaaaab, + 0x0ccccccc, 0x08000000, 0x09249249, 0x09d89d8a, 0x09249249, + 0x071c71c7, 0x07878788, 0x08000000, 0x06bca1af, 0x05555555, + 0x03333333, 0x04ec4ec5, 0x05555555, 0x05d1745d, 0x05d1745d, + 0x05555555, 0x029cbc15, 0x03a83a84, 0x03759f23, 0x0469ee58, + 0x03333333, 0x0234f72c, 0x02828283, 0x02192e2a, 0x02222222, + 0x023ee090, 0x02828283, 0x02492492, 0x0253c825, 0x02000000, + 0x01c71c72, 0x01642c86, 0x01a41a42, 0x02000000, 0x01e1e1e2, + 0x0178a4c8, 0x01dae607, 0x0253c825, 0x02492492, 0x0199999a, + 0x012c9fb5, 0x01948b10, 0x0178a4c8, 0x0158ed23, 0x014e5e0a, + 0x013e22cc, 0x013b13b1, 0x013e22cc, 0x02108421, 0x01a98ef6, + 0x0121fb78, 0x010ecf57, 0x01249249, 0x013e22cc, 0x01111111, + 0x01642c86, 0x01446f86, 0x013e22cc, 0x014afd6a + }; + + const u32 c_quant_table[QUANT_REG_NUM] = { + 0x07878788, 0x071c71c7, 0x071c71c7, 0x05555555, 0x06186186, + 0x05555555, 0x02b93105, 0x04ec4ec5, 0x04ec4ec5, 0x02b93105, + 0x014afd6a, 0x01f07c1f, 0x02492492, 0x01f07c1f, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a, + 0x014afd6a, 0x014afd6a, 0x014afd6a, 0x014afd6a + }; + int i; + + for (i = 0; i < QUANT_REG_NUM; i++) { + phytium_jpeg_write(jpeg_dev, Y_QUANT_INDEX_ADDR_REG(i), y_quant_table[i]); + phytium_jpeg_write(jpeg_dev, C_QUANT_INDEX_ADDR_REG(i), c_quant_table[i]); + } + +} + +static void phytium_jpeg_start(struct phytium_jpeg_dev *jpeg_dev) +{ + phytium_jpeg_on(jpeg_dev); + phytium_jpeg_init_regs(jpeg_dev); + + /* Resolution set to 640x480 if no signal is found */ + phytium_jpeg_get_resolution(jpeg_dev); + + /* Set timings since the device is being opened for the first tiime */ + jpeg_dev->active_timings = jpeg_dev->detected_timings; + phytium_jpeg_set_resolution(jpeg_dev); + + jpeg_dev->pix_fmt.width = jpeg_dev->active_timings.width; + jpeg_dev->pix_fmt.height = jpeg_dev->active_timings.height; + jpeg_dev->pix_fmt.sizeimage = jpeg_dev->max_compressed_size; +} + +static void phytium_jpeg_stop(struct phytium_jpeg_dev *jpeg_dev) +{ + set_bit(VIDEO_STOPPED, &jpeg_dev->status); + cancel_delayed_work_sync(&jpeg_dev->res_work); + + phytium_jpeg_off(jpeg_dev); + + jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; + jpeg_dev->status = 0; +} + +static int phytium_jpeg_open(struct file *file) +{ + int ret; + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + mutex_lock(&jpeg_dev->video_lock); + + ret = v4l2_fh_open(file); + if (ret != 0) { + mutex_unlock(&jpeg_dev->video_lock); + dev_err(jpeg_dev->dev, "Failed to open the phytium jpeg device.\n"); + return ret; + } + + if (v4l2_fh_is_singular_file(file)) + phytium_jpeg_start(jpeg_dev); + + mutex_unlock(&jpeg_dev->video_lock); + + return 0; +} + +static int phytium_jpeg_release(struct file *file) +{ + int ret; + struct phytium_jpeg_dev *jpeg_dev = video_drvdata(file); + + mutex_lock(&jpeg_dev->video_lock); + + if (v4l2_fh_is_singular_file(file)) + phytium_jpeg_stop(jpeg_dev); + + ret = _vb2_fop_release(file, NULL); + mutex_unlock(&jpeg_dev->video_lock); + + return ret; +} + + +static const struct v4l2_file_operations phytium_jpeg_fops = { + .owner = THIS_MODULE, + .read = vb2_fop_read, + .poll = vb2_fop_poll, + .unlocked_ioctl = video_ioctl2, + .mmap = vb2_fop_mmap, + .open = phytium_jpeg_open, + .release = phytium_jpeg_release, +}; + +static void phytium_jpeg_update_jpeg_header(u32 width, u32 height) +{ + const int h_index = PHYTIUM_JPEG_HEADER_H_INDEX; + const int w_index = PHYTIUM_JPEG_HEADER_W_INDEX; + + /* the high 8 bits of the height locates at bit24~bit31 */ + phytium_jpeg_header[h_index] = phytium_jpeg_header[h_index] & 0x00FFFFFF; + phytium_jpeg_header[h_index] |= ((height >> 8) & 0xFF) << 24; + + /* the low 8 bits of the height locates at bit0~bit7 */ + phytium_jpeg_header[w_index] = phytium_jpeg_header[w_index] & 0xFF000000; + phytium_jpeg_header[w_index] |= height & 0xFF; + + /* the high 8 bits of the width locates at bit8~bit15 */ + phytium_jpeg_header[w_index] |= ((width >> 8) & 0xFF) << 8; + /* the low 8 bits of the width locates at bit16~bit24 */ + phytium_jpeg_header[w_index] |= (width & 0xFF) << 16; +} + +static void phytium_jpeg_fill_header(struct phytium_jpeg_dev *jpeg_dev, + struct phytium_jpeg_buffer *jpeg_buf) +{ + void *vbuf = vb2_plane_vaddr(&jpeg_buf->vb.vb2_buf, 0); + u32 width = jpeg_dev->active_timings.width; + u32 height = jpeg_dev->active_timings.height; + + /* update the contents of the phytium jpeg header according to the resolution */ + phytium_jpeg_update_jpeg_header(width, height); + + /* replenish the contents of the JPEG header */ + memcpy(vbuf, phytium_jpeg_header, PHYTIUM_JPEG_HEADER_LEN); +} + +static int phytium_jpeg_start_frame(struct phytium_jpeg_dev *jpeg_dev) +{ + dma_addr_t dst_addr; + unsigned long status; + struct phytium_jpeg_buffer *jpeg_buf; + + if (jpeg_dev->v4l2_input_status) { + dev_err(jpeg_dev->dev, "No signal; needn't start frame\n"); + return 0; + } + + spin_lock_irqsave(&jpeg_dev->hw_lock, status); + jpeg_buf = list_first_entry_or_null(&jpeg_dev->buffers, + struct phytium_jpeg_buffer, link); + if (jpeg_buf == NULL) { + spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); + dev_err(jpeg_dev->dev, "No buffers; doesn't start frame\n"); + return -EPROTO; + } + + set_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); + dst_addr = vb2_dma_contig_plane_dma_addr(&jpeg_buf->vb.vb2_buf, 0); + spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); + + /* + * Because the JPEG Engine is unable to add a JPEG header, the phytium + * jpeg driver is required to fill the contents of a JPEG header before + * the jpeg engine write datas to the dma address. + */ + phytium_jpeg_fill_header(jpeg_dev, jpeg_buf); + dst_addr += PHYTIUM_JPEG_HEADER_LEN; + /* + * The ikvm application only using the last frame, so the driver replenish + * one output register with a dma address. + */ + dst_addr >>= JPEG_DST_ADDR_SHIFT; + phytium_jpeg_write(jpeg_dev, BUF_LIST_INDEX_ADDR(VB_BUF_NO), dst_addr); + /* Enable the validilty of the buffer marked with index */ + phytium_jpeg_write(jpeg_dev, BUF_LIST_INDEX_CTRL_STS_ADDR(VB_BUF_NO), + STS_JPEG_BUF_HIGH_LEVEL_VALID); + /* Enable the interruption which is used to identify an image was compressed */ + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, STS_VE_JPEG_CODE_COMP_EN); + /* Enable JPEG, start to capture and compress */ + phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 1); + + return 0; +} + +static void phytium_jpeg_resolution_work(struct work_struct *work) +{ + struct delayed_work *dwork = to_delayed_work(work); + struct phytium_jpeg_dev *jpeg_dev = container_of(dwork, + struct phytium_jpeg_dev, res_work); + u32 input_status = jpeg_dev->v4l2_input_status; + + phytium_jpeg_on(jpeg_dev); + + /* Exit early in the case no clients remain */ + if (test_bit(VIDEO_STOPPED, &jpeg_dev->status)) + goto done; + + phytium_jpeg_init_regs(jpeg_dev); + phytium_jpeg_get_resolution(jpeg_dev); + + /* if source's resolution is changed, the event should be enqueued */ + if (jpeg_dev->detected_timings.width != jpeg_dev->active_timings.width || + jpeg_dev->detected_timings.height != jpeg_dev->active_timings.height || + input_status != jpeg_dev->v4l2_input_status) { + + static const struct v4l2_event event = { + .type = V4L2_EVENT_SOURCE_CHANGE, + .u.src_change.changes = V4L2_EVENT_SRC_CH_RESOLUTION, + }; + v4l2_event_queue(&jpeg_dev->vdev, &event); + clear_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); + dev_info(jpeg_dev->dev, "event notifies changing resolution\n"); + } else if (test_bit(VIDEO_STREAMING, &jpeg_dev->status)) { + /* No resolution change so just restart streaming */ + dev_info(jpeg_dev->dev, "resolution doesn't change\n"); + phytium_jpeg_set_resolution(jpeg_dev); + phytium_jpeg_start_frame(jpeg_dev); + } + +done: + clear_bit(VIDEO_RES_CHANGE, &jpeg_dev->status); + wake_up_interruptible_all(&jpeg_dev->wait); +} + +static int phytium_jpeg_queue_setup(struct vb2_queue *q, + unsigned int *num_buffers, + unsigned int *num_planes, + unsigned int sizes[], + struct device *alloc_devs[]) +{ + struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); + + if (*num_planes) { + if (sizes[0] < jpeg_dev->max_compressed_size) { + v4l2_err(&jpeg_dev->v4l2_dev, "queue v4l2_buf's size is invalid\n"); + return -EINVAL; + } + } + + *num_planes = 1; + sizes[0] = jpeg_dev->max_compressed_size; + return 0; +} + +static int phytium_jpeg_buf_prepare(struct vb2_buffer *vb) +{ + struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(vb->vb2_queue); + + if (vb2_plane_size(vb, 0) < jpeg_dev->max_compressed_size) { + v4l2_err(&jpeg_dev->v4l2_dev, "failed to prepare buffer\n"); + return -EINVAL; + } + + return 0; +} + +static inline struct phytium_jpeg_buffer * +phytium_vb2buf_to_dstbuf(struct vb2_v4l2_buffer *buf) +{ + return container_of(buf, struct phytium_jpeg_buffer, vb); +} + +static void phytium_jpeg_buf_queue(struct vb2_buffer *vb) +{ + bool empty; + struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(vb->vb2_queue); + struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); + struct phytium_jpeg_buffer *jpeg_buf = phytium_vb2buf_to_dstbuf(vbuf); + unsigned long status; + + spin_lock_irqsave(&jpeg_dev->hw_lock, status); + empty = list_empty(&jpeg_dev->buffers); + list_add_tail(&jpeg_buf->link, &jpeg_dev->buffers); + spin_unlock_irqrestore(&jpeg_dev->hw_lock, status); + + /* the empty ensures the address of the first node's vb2_v4l2_buf + * in the list is written to output register + */ + if (test_bit(VIDEO_STREAMING, &jpeg_dev->status) && + (!test_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status)) && + empty) + phytium_jpeg_start_frame(jpeg_dev); +} + +static void phytium_jpeg_bufs_done(struct phytium_jpeg_dev *jpeg_dev, + enum vb2_buffer_state state) +{ + unsigned long flags; + struct phytium_jpeg_buffer *buf; + + spin_lock_irqsave(&jpeg_dev->hw_lock, flags); + + list_for_each_entry(buf, &jpeg_dev->buffers, link) + vb2_buffer_done(&buf->vb.vb2_buf, state); + + INIT_LIST_HEAD(&jpeg_dev->buffers); + + spin_unlock_irqrestore(&jpeg_dev->hw_lock, flags); +} + +static void phytium_jpeg_irq_res_change(struct phytium_jpeg_dev *jpeg_dev, + ulong delay) +{ + dev_info(jpeg_dev->dev, "Source resolution is changed, resetting\n"); + + phytium_jpeg_off(jpeg_dev); + + schedule_delayed_work(&jpeg_dev->res_work, delay); +} + +static irqreturn_t phytium_jpeg_irq(int irq, void *arg) +{ + struct phytium_jpeg_dev *jpeg_dev = arg; + u32 status; + struct phytium_jpeg_buffer *buf; + u32 frame_size; + + if (test_bit(VIDEO_POWEROFF, &jpeg_dev->status)) { + dev_info(jpeg_dev->dev, "jpeg engine is requested to poweroff\n"); + return IRQ_HANDLED; + } + + status = phytium_jpeg_read(jpeg_dev, INT_STATUS_CTRL_REG); + + if (status & INT_VIDEO_FORMAT_CHANGE) { + dev_info(jpeg_dev->dev, "receive resolution changed interrupt\n"); + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, + DETECT_RESOLUTION_CHANGE_EN, 0); + phytium_jpeg_write(jpeg_dev, INT_STATUS_CTRL_REG, INT_VIDEO_FORMAT_CHANGE); + phytium_jpeg_irq_res_change(jpeg_dev, RESOLUTION_CHANGE_DELAY); + return IRQ_HANDLED; + } + + /* + * JPEG engine finish compressing a image JPEG encoding to trigger + * a interruption. the status identifies the buffer number. Currently, + * the driver uses one buffer. + * + * Note: Because the JPEG doesn't support adding a JPEG header, and + * driver is also unable to add a JPEG header to vb2_buffers. One + * solution is that a JPEG header is added by an application. + */ + if (status & INT_JPEG_COMP_BUF_LIST_NO) { + frame_size = phytium_jpeg_read(jpeg_dev, jpeg_dev->comp_size_read); + frame_size &= JPEG_BUF_CAPACITY_SIZE; + frame_size >>= JPEG_BUF_CAPACITY_SIZE_SHIFT; + spin_lock(&jpeg_dev->hw_lock); + clear_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status); + /* Delete first node from the queue */ + buf = list_first_entry_or_null(&jpeg_dev->buffers, + struct phytium_jpeg_buffer, link); + if (buf != NULL) { + frame_size += PHYTIUM_JPEG_HEADER_LEN; + vb2_set_plane_payload(&buf->vb.vb2_buf, 0, frame_size); + if (!list_is_last(&buf->link, &jpeg_dev->buffers)) { + buf->vb.vb2_buf.timestamp = ktime_get_ns(); + buf->vb.sequence = jpeg_dev->sequence++; + buf->vb.field = V4L2_FIELD_NONE; + vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE); + list_del(&buf->link); + } + } + + spin_unlock(&jpeg_dev->hw_lock); + /* Disable JPEG engine */ + phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, TRANSINFO_ENABLE_ENGINE, 0); + /* Disable interruption */ + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, STS_VE_JPEG_CODE_COMP_EN, 0); + /* clear all interruption of the hardware's buffers */ + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, INT_JPEG_ENCODE_COMPLETE, 1); + + status &= ~INT_JPEG_COMP_BUF_LIST_NO; + if (test_bit(VIDEO_STREAMING, &jpeg_dev->status) && buf) + phytium_jpeg_start_frame(jpeg_dev); + } + + return IRQ_HANDLED; +} + +/* VIDIOC_STREAMON, all vb2_v4l2_buf' states are queue */ +static int phytium_jpeg_start_streaming(struct vb2_queue *q, unsigned int count) +{ + int ret; + struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); + + jpeg_dev->sequence = 0; + ret = phytium_jpeg_start_frame(jpeg_dev); + if (ret != 0) { + phytium_jpeg_bufs_done(jpeg_dev, VB2_BUF_STATE_QUEUED); + return ret; + } + + /* set the states of the jpeg engine */ + set_bit(VIDEO_STREAMING, &jpeg_dev->status); + return ret; +} + +static void phytium_jpeg_stop_streaming(struct vb2_queue *q) +{ + int ret; + struct phytium_jpeg_dev *jpeg_dev = vb2_get_drv_priv(q); + + clear_bit(VIDEO_STREAMING, &jpeg_dev->status); + ret = wait_event_timeout(jpeg_dev->wait, + !test_bit(VIDEO_FRAME_INPRG, &jpeg_dev->status), + STOP_TIMEOUT); + + /* time out */ + if (ret == 0) { + dev_err(jpeg_dev->dev, "Timed out when stopping streaming.\n"); + /* + * Need to force stop any DMA and try and get HW into a good states + * for future calls to start streaming again. + */ + phytium_jpeg_off(jpeg_dev); + phytium_jpeg_on(jpeg_dev); + phytium_jpeg_init_regs(jpeg_dev); + phytium_jpeg_get_resolution(jpeg_dev); + } + /* first stop jpeg, wait, the free buffer */ + phytium_jpeg_bufs_done(jpeg_dev, VB2_BUF_STATE_ERROR); +} + +static const struct vb2_ops phytium_jpeg_vb2_ops = { + .queue_setup = phytium_jpeg_queue_setup, + .wait_prepare = vb2_ops_wait_prepare, + .wait_finish = vb2_ops_wait_finish, + .buf_prepare = phytium_jpeg_buf_prepare, + .buf_queue = phytium_jpeg_buf_queue, + .start_streaming = phytium_jpeg_start_streaming, + .stop_streaming = phytium_jpeg_stop_streaming, +}; + +static void phytium_jpeg_set_yuv_mode(struct phytium_jpeg_dev *jpeg_dev) +{ + const char *mode = yuv_mode_str; + enum jpeg_yuv_mode yuv_mode; + + if (strstr(mode, "yuv422") != NULL) + yuv_mode = YUV422; + else if (strstr(mode, "yuv420") != NULL) + yuv_mode = YUV420; + else + yuv_mode = YUV444; + + /* set the yuv mode register */ + phytium_jpeg_write(jpeg_dev, SAMPLE_MODE_REG, yuv_mode); + + /* update the field which indicates YUV mode locates in the JPEG header. */ + phytium_jpeg_header[YUVID] &= 0xFFFF00FF; + if (yuv_mode == YUV422) + phytium_jpeg_header[YUVID] |= 0x2100; + else if (yuv_mode == YUV420) + phytium_jpeg_header[YUVID] |= 0x2200; + else + phytium_jpeg_header[YUVID] |= 0x1100; + +} + +static irqreturn_t phytium_jpeg_timer31_irq(int irq, void *arg) +{ + struct phytium_jpeg_dev *jpeg_dev = arg; + + /* disable timer interrupt */ + writel(0, jpeg_dev->timer31_addr); + + /* clear timer interrupt status */ + writel(0x8, jpeg_dev->timer31_addr + 0x2c); + + /* clear JPEG Engine's poweroff status */ + clear_bit(VIDEO_POWEROFF, &jpeg_dev->status); + dev_info(jpeg_dev->dev, "timer31 set jpeg status 0x%lx\n", jpeg_dev->status); + + /* JPEG Engine is poweron, reconfig quntization table and YUV mode */ + phytium_jpeg_init_jpeg_quant(jpeg_dev); + phytium_jpeg_set_yuv_mode(jpeg_dev); + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, 0, DETECT_RESOLUTION_CHANGE_EN); + phytium_jpeg_update(jpeg_dev, TRANSFORM_INFO_REG, 0, TRANSINFO_SRC_SELECT); + + dev_info(jpeg_dev->dev, "reconfigure quant table and yuv mode\n"); + + return IRQ_HANDLED; +} + +static int phytium_jpeg_parser_timer31_irq(struct phytium_jpeg_dev *jpeg_dev) +{ + int irq; + int ret; + struct device *dev = jpeg_dev->dev; + + irq = irq_of_parse_and_map(dev->of_node, 2); + if (!irq) { + dev_err(dev, "Failed to get timer31 IRQ\n"); + return -ENODEV; + } + + ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_timer31_irq, + IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); + if (ret < 0) + dev_err(dev, "Failed to request timer31 IRQ %d\n", irq); + + return ret; +} + +static irqreturn_t phytium_jpeg_timer30_irq(int irq, void *arg) +{ + struct phytium_jpeg_dev *jpeg_dev = arg; + struct arm_smccc_res res; + + /* disable timer interrupt */ + writel(0, jpeg_dev->timer30_addr); + /* clear timer interrupt status */ + writel(0x8, jpeg_dev->timer30_addr + 0x2c); + + /* Disable interruption */ + phytium_jpeg_update(jpeg_dev, INT_STATUS_CTRL_REG, STS_VE_JPEG_CODE_COMP_EN, 0); + + /* call SE to poweroff JPEG Engine */ + arm_smccc_smc(0xc300fff4, 0x9, 0x2, 0x80000020, 0, 0, 0, 0, &res); + + set_bit(VIDEO_RES_CHANGE, &jpeg_dev->status); + /* set JPEG Engine's status is poweroff */ + set_bit(VIDEO_POWEROFF, &jpeg_dev->status); + dev_info(jpeg_dev->dev, "timer30 set jpeg status 0x%lx\n", jpeg_dev->status); + + return IRQ_HANDLED; +} + +static int phytium_jpeg_parser_timer30_irq(struct phytium_jpeg_dev *jpeg_dev) +{ + int irq; + int ret; + struct device *dev = jpeg_dev->dev; + + irq = irq_of_parse_and_map(dev->of_node, 1); + if (!irq) { + dev_err(dev, "Failed to get timer30 IRQ\n"); + return -ENODEV; + } + + ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_timer30_irq, + IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); + if (ret < 0) + dev_err(dev, "Failed to request timer30 IRQ %d\n", irq); + + return ret; +} + +static int phytium_jpeg_init(struct phytium_jpeg_dev *jpeg_dev) +{ + int irq; + int ret; + struct device *dev = jpeg_dev->dev; + u32 ocm_buf_addr[OCM_BUF_NUM]; + int i; + + irq = irq_of_parse_and_map(dev->of_node, 0); + if (!irq) { + dev_err(dev, "Failed to get IRQ\n"); + return -ENODEV; + } + + ret = devm_request_threaded_irq(dev, irq, NULL, phytium_jpeg_irq, + IRQF_ONESHOT, PHYTIUM_JPEG_NAME, jpeg_dev); + if (ret < 0) { + dev_err(dev, "Failed to request IRQ %d\n", irq); + return ret; + } + + ret = phytium_jpeg_parser_timer30_irq(jpeg_dev); + if (ret < 0) + return ret; + + ret = phytium_jpeg_parser_timer31_irq(jpeg_dev); + if (ret < 0) + return ret; + + ret = of_property_read_u32_array(dev->of_node, "phytium,ocm-buf-addr", + ocm_buf_addr, OCM_BUF_NUM); + if (ret != 0) { + dev_err(dev, "Failed to get the OCM address from device tree node.\n"); + return ret; + } + + for (i = 0; i < OCM_BUF_NUM; i++) + jpeg_dev->src_addrs[i].dma_addr = ocm_buf_addr[i]; + + /* CMA memory for JPEG device */ + of_reserved_mem_device_init(dev); + ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(32)); + if (ret != 0) { + dev_err(dev, "Failed to set DMA mask\n"); + return ret; + } + + /* Initializing JPEG Y and CbCr quantization table */ + phytium_jpeg_init_jpeg_quant(jpeg_dev); + + /* Select YUV mode */ + phytium_jpeg_set_yuv_mode(jpeg_dev); + dev_info(dev, "successfully initialize jpeg engine\n"); + return 0; + +} + + +static int phytium_jpeg_setup_video(struct phytium_jpeg_dev *jpeg_dev) +{ + struct v4l2_device *v4l2_dev = &jpeg_dev->v4l2_dev; + struct vb2_queue *dst_vq = &jpeg_dev->queue; + struct video_device *vdev = &jpeg_dev->vdev; + int ret; + + jpeg_dev->pix_fmt.pixelformat = V4L2_PIX_FMT_JPEG; + jpeg_dev->pix_fmt.field = V4L2_FIELD_NONE; + jpeg_dev->pix_fmt.colorspace = V4L2_COLORSPACE_SRGB; /* maybe ARGB */ + jpeg_dev->pix_fmt.quantization = V4L2_QUANTIZATION_FULL_RANGE; + jpeg_dev->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; + + ret = v4l2_device_register(jpeg_dev->dev, v4l2_dev); + if (ret != 0) { + dev_err(jpeg_dev->dev, "Failed to register v4l2 device\n"); + return ret; + } + + /* Register how many v4l2 controls to a handler */ + dst_vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; + dst_vq->io_modes = VB2_MMAP | VB2_READ | VB2_DMABUF; + dst_vq->dev = v4l2_dev->dev; + dst_vq->lock = &jpeg_dev->video_lock; + dst_vq->ops = &phytium_jpeg_vb2_ops; + dst_vq->mem_ops = &vb2_dma_contig_memops; + dst_vq->drv_priv = jpeg_dev; + dst_vq->buf_struct_size = sizeof(struct phytium_jpeg_buffer); + dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; + dst_vq->min_buffers_needed = CAPTURE_BUF_NUMBER; + ret = vb2_queue_init(dst_vq); + if (ret) { + dev_err(jpeg_dev->dev, "Failed to init vb2 queue\n"); + goto err_v4l2_register; + } + + vdev->queue = dst_vq; + vdev->fops = &phytium_jpeg_fops; + vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE | + V4L2_CAP_STREAMING; + vdev->v4l2_dev = v4l2_dev; + strscpy(vdev->name, PHYTIUM_JPEG_NAME, sizeof(vdev->name)); + vdev->vfl_type = VFL_TYPE_VIDEO; + vdev->vfl_dir = VFL_DIR_RX; + vdev->release = video_device_release_empty; + vdev->ioctl_ops = &phytium_jpeg_ioctl_ops; + vdev->lock = &jpeg_dev->video_lock; + + video_set_drvdata(vdev, jpeg_dev); + ret = video_register_device(vdev, VFL_TYPE_VIDEO, 0); + if (ret != 0) { + dev_err(jpeg_dev->dev, "Failed to register video device\n"); + goto err_video_register; + } + + v4l2_info(v4l2_dev, "phytium JPEG registered as /dev/video%d (%d, %d)\n", + jpeg_dev->vdev.num, VIDEO_MAJOR, jpeg_dev->vdev.minor); + return ret; + +err_video_register: + vb2_queue_release(dst_vq); + +err_v4l2_register: + v4l2_device_unregister(v4l2_dev); + return ret; +} + +static const struct phytium_jpeg_config phytium_jpeg_config = { + .comp_size_read = BUF_LIST_INDEX_CTRL_STS_ADDR(VB_BUF_NO), +}; + +static const struct of_device_id phytium_jpeg_match[] = { + { + .compatible = "phytium,jpeg", + .data = &phytium_jpeg_config, + }, + {}, +}; + +MODULE_DEVICE_TABLE(of, phytium_jpeg_match); + +static int phytium_jpeg_probe(struct platform_device *pdev) +{ + struct phytium_jpeg_dev *jpeg_dev; + const struct of_device_id *match; + const struct phytium_jpeg_config *config; + struct resource *res; + int ret; + + jpeg_dev = devm_kzalloc(&pdev->dev, sizeof(*jpeg_dev), GFP_KERNEL); + if (jpeg_dev == NULL) + return -ENOMEM; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + jpeg_dev->base_addr = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(jpeg_dev->base_addr)) { + dev_err(jpeg_dev->dev, "Failed to ioremap.\n"); + return PTR_ERR(jpeg_dev->base_addr); + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 1); + jpeg_dev->timer30_addr = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(jpeg_dev->base_addr)) { + dev_err(jpeg_dev->dev, "Failed to parse timer30.\n"); + return PTR_ERR(jpeg_dev->timer30_addr); + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 2); + jpeg_dev->timer31_addr = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(jpeg_dev->base_addr)) { + dev_err(jpeg_dev->dev, "Failed to parse timer30.\n"); + return PTR_ERR(jpeg_dev->timer31_addr); + } + match = of_match_node(phytium_jpeg_match, pdev->dev.of_node); + if (match == NULL) { + dev_err(jpeg_dev->dev, "Failed to match.\n"); + return -EINVAL; + } + + config = match->data; + jpeg_dev->comp_size_read = config->comp_size_read; + + jpeg_dev->frame_rate = 30; + jpeg_dev->dev = &pdev->dev; + spin_lock_init(&jpeg_dev->hw_lock); + mutex_init(&jpeg_dev->video_lock); + init_waitqueue_head(&jpeg_dev->wait); + INIT_DELAYED_WORK(&jpeg_dev->res_work, phytium_jpeg_resolution_work); + INIT_LIST_HEAD(&jpeg_dev->buffers); + + ret = phytium_jpeg_init(jpeg_dev); + if (ret != 0) { + dev_err(jpeg_dev->dev, "Failed to initialize the JPEG engine.\n"); + return ret; + } + + ret = phytium_jpeg_setup_video(jpeg_dev); + + return ret; +} + +#define to_phytium_jpeg(x) container_of((x), struct phytium_jpeg_dev, v4l2_dev) +static int phytium_jpeg_remove(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct v4l2_device *v4l2_dev = dev_get_drvdata(dev); + struct phytium_jpeg_dev *jpeg_dev = to_phytium_jpeg(v4l2_dev); + + phytium_jpeg_off(jpeg_dev); + + video_unregister_device(&jpeg_dev->vdev); + + vb2_queue_release(&jpeg_dev->queue); + + v4l2_device_unregister(v4l2_dev); + + of_reserved_mem_device_release(dev); + + return 0; +} + +static struct platform_driver phytium_jpeg_driver = { + .probe = phytium_jpeg_probe, + .remove = phytium_jpeg_remove, + .driver = { + .name = PHYTIUM_JPEG_NAME, + .of_match_table = phytium_jpeg_match, + }, +}; + +module_platform_driver(phytium_jpeg_driver); + +MODULE_DESCRIPTION("Phytium JPEG Encoder driver"); +MODULE_AUTHOR("Wang Min "); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/phytium_jpeg_core.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/phytium_jpeg_core.h new file mode 100644 index 0000000000000000000000000000000000000000..27e32b2d3c435cc9c77250c1fbc36200cd2d5fa1 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/phytium_jpeg_core.h @@ -0,0 +1,147 @@ +/* SPDX-License-Identifier: GPL-2.0-or-later */ +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _PHYTIUM_JPEG_CORE_H +#define _PHYTIUM_JPEG_CORE_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 + +#define PHYTIUM_JPEG_NAME "phytium-jpeg" +#define MAX_FRAME_RATE 60 +#define MAX_HEIGHT 1080 +#define MAX_WIDTH 1920 +#define MIN_HEIGHT 480 +#define MIN_WIDTH 640 +#define MIN_PIXEL_CLOCK (640 * 480 * 60) /* 640 x 480 x 60Hz */ +#define MAX_PIXEL_CLOCK (1920 * 1080 * 60) /* 1920 x 1080 x 60Hz */ + +#define SOURCE_RESOLUTION_DETECT_TIMEOUT msecs_to_jiffies(500) +#define RESOLUTION_CHANGE_DELAY msecs_to_jiffies(0) +#define INVALID_RESOLUTION_DELAY msecs_to_jiffies(250) +#define STOP_TIMEOUT msecs_to_jiffies(1000) + +#define INVALID_RESOLUTION_RETRIES 2 +#define CAPTURE_BUF_NUMBER 3 /* using how many buffers */ +#define VB_BUF_NO 0 /* there are 16 buffer, use which one */ + +/* The below macros are defined for the JPEG header of the phytium JPEG Engine */ +#define PHYTIUM_JPEG_HEADER_LEN (256 * 3) +#define PHYTIUM_JPEG_HEADER_SIZE (PHYTIUM_JPEG_HEADER_LEN / sizeof(u32)) +#define PHYTIUM_JPEG_HEADER_H_INDEX 40 +#define PHYTIUM_JPEG_HEADER_W_INDEX 41 + +/* There are two ocm buffers that are used for storaging the inputing video data */ +#define OCM_BUF_NUM 2 + +enum phytium_jpeg_status { + VIDEO_MODE_DETECT_DONE, + VIDEO_RES_CHANGE, + VIDEO_RES_DETECT, + VIDEO_STREAMING, + VIDEO_FRAME_INPRG, + VIDEO_STOPPED, + VIDEO_CLOCKS_ON, + VIDEO_POWEROFF, +}; + +struct phytium_jpeg_addr { + unsigned int size; + dma_addr_t dma_addr; + void *virt_addr; +}; + +struct phytium_jpeg_buffer { + struct vb2_v4l2_buffer vb; + struct list_head link; +}; + +/** + * struct phytium_jpeg - JPEG IP abstraction + * @lock: the mutex protecting this structure + * @hw_lock: spinlock protecting the hw device resource + * @workqueue: decode work queue + * @dev: JPEG device + * @v4l2_dev: v4l2 device for mem2mem mode + * @m2m_dev: v4l2 mem2mem device data + * @alloc_ctx: videobuf2 memory allocator's context + * @dec_vdev: video device node for decoder mem2mem mode + * @dec_reg_base: JPEG registers mapping + * @clk_jdec: JPEG hw working clock + * @clk_jdec_smi: JPEG SMI bus clock + * @larb: SMI device + */ +struct phytium_jpeg_dev { + void __iomem *base_addr; + struct device *dev; + struct v4l2_device v4l2_dev; + struct v4l2_pix_format pix_fmt; + struct v4l2_bt_timings active_timings; + struct v4l2_bt_timings detected_timings; + u32 v4l2_input_status; + struct vb2_queue queue; + struct video_device vdev; + /* v4l2 and videobuf2 lock, protect the structure*/ + struct mutex video_lock; + u32 jpeg_mode; + u32 comp_size_read; + wait_queue_head_t wait; + /* buffer list lock, protecting the hw device resource */ + spinlock_t hw_lock; + struct delayed_work res_work; + struct list_head buffers; + unsigned long status; + unsigned int sequence; + unsigned int max_compressed_size; + struct phytium_jpeg_addr src_addrs[OCM_BUF_NUM]; + struct phytium_jpeg_addr dst_addrs[16]; + + bool yuv420; + unsigned int frame_rate; + void __iomem *timer30_addr; + void __iomem *timer31_addr; +}; + +struct phytium_jpeg_config { + u32 jpeg_mode; + u32 comp_size_read; +}; + +#define YUV_MODE_STR_LEN 8 +#define YUVID 42 + +enum jpeg_yuv_mode { + YUV444 = 0x0, + YUV422 = 0x1, + YUV420 = 0x2 +}; + +#endif /* _PHYTIUM_JPEG_CORE_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/phytium_jpeg_reg.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/phytium_jpeg_reg.h new file mode 100644 index 0000000000000000000000000000000000000000..b0a27e2b7e89b027d1293daa024fa7f13f748f5c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/media/platform/phytium/phytium_jpeg_reg.h @@ -0,0 +1,113 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _PHYTIUM_JPEG_REG_H +#define _PHYTIUM_JPEG_REG_H + +#include +/* define the all kinds of control registers in a JPEG soc */ + +/* The register is used to set the information of the video comes from main memory */ +#define SRC_DDR_INFO_REG 0x00000800 + +/* The register is used to get the information of the video comes from external VGA */ +#define SRC_VGA_INFO_REG 0x00000894 + +#define SRC_FORMAT BIT(0) /* 0:RGB888, 1:RGB565 */ +#define SRC_DE_POLARITY BIT(1) /* 0:low level is effect, other */ +#define SRC_HS_POLARITY BIT(2) /* 0:low level is effect, other */ +#define SRC_VS_POLARITY BIT(3) /* 0:low level is effect, other */ +#define SRC_HOR_PIXELS GENMASK(15, 4) /* the number of the horizontal pixels */ +#define SRC_WIDTH_SHIFT 4 /* shift right to get width */ +#define SRC_VER_PIXELS GENMASK(26, 16) /* the number of the vertical pixels */ +#define SRC_HEIGHT_SHIFT 16 /* shift right to get height */ +/* The below bit fields is only used by image comes from main memory */ +#define SRC_COMP_DDR_IMG_EN BIT(27) /* 0: disable to JPEG compression, others */ + +/* marks which ocm buffer is occupied to store an image */ +#define SRC_DDR_IMG2OCM_VALID GENMASK(29, 28) + +/* The register controls starting work of the JPEG engine */ +#define TRANSFORM_INFO_REG 0x00000804 +#define TRANSINFO_ENABLE_ENGINE BIT(0) /* 1: enable the JPEG engine */ +/* 1: video comes from external VGA, 0: video comes from DDR */ +#define TRANSINFO_SRC_SELECT BIT(1) +/* 0: video comes from external VGA is cached to OCM, 1: DDR */ +#define TRANSINFO_IMAGE_STORE BIT(2) +#define TRANSINFO_FRAME_RATE GENMASK(9, 4) /* the value notes frame rate */ +#define TRANSINFO_BLOCK_SIZE BIT(12) /* 0: 8x8, 1: 16x16 */ +#define TRANSINFO_ENABLE_YUV422 BIT(13) /* 1: JPEG block is populated YUV422 */ +/* support burst with the values such as 1, 2, 4, 8, 16, 32, 64. using default value 0xf */ +#define TRANSINFO_AXI_LEN GENMASK(22, 16) +#define TRANS_AXI_LEN_SHIFT 16 + +/* The interrupt and status register */ +#define INT_STATUS_CTRL_REG 0x00000808 +#define INT_FIFO_OVERFLOW BIT(0) /* video fifo overflow, write 1 to clear */ +#define INT_OCM_BUF_OVERFLOW BIT(1) /* ocm buffer overflow, write 1 to clear */ +/* JPEG engine complete compression, write 1 to clear */ +#define INT_JPEG_ENCODE_COMPLETE BIT(2) +/* in VGA mode, video's format is changed */ +#define INT_VIDEO_FORMAT_CHANGE BIT(3) +/* enable the interrupt of th video fifo overflow and source resolution */ +#define DETECT_RESOLUTION_CHANGE_EN BIT(4) +/* enable the interrupt of the ocm buffer overflow */ +#define STS_VE_OCM_BUF_OVERFLOW_EN BIT(5) +/* enable the interrupt of the JPEG complete compression */ +#define STS_VE_JPEG_CODE_COMP_EN BIT(6) +/* in VGA mode, the bit notes ocm buff is busy */ +#define STS_VE_OCM_BUF_BUSY BIT(7) +/* in VGA mode, the bit notes sequence number of the frame */ +#define STS_VE_CUR_FRAME_NUMBER GENMASK(9, 8) +/* in VGA mode, the bit notes sequence number of the cached frame */ +#define STS_VE_BUF_CACHE_NUMBER GENMASK(11, 10) +/* in VGA mode, the buffer number in buffer list */ +#define STS_JPEG_COMP_BUF_NO GENMASK(15, 12) +#define INT_JPEG_COMP_BUF_LIST_NO GENMASK(31, 16) /* the interrupt number of the buffer */ + +#define OCM_BUF0_ADDR 0x0000080C +#define OCM_BUF1_ADDR 0x00000810 +#define OCM_BUF_SHIFT 8 + +#define BUF_LIST_BASE_ADDR 0x00000814 + +#define PHYTIUM_BUF_LIST_ACTRL_AND_STS_BASE_ADDR_REG 0x00000818 +#define STS_JPEG_BUF_HIGH_LEVEL_VALID BIT(0) /* Hight levle is validity */ +#define JPEG_BUF_CAPACITY_SIZE GENMASK(29, 8) /* the capacity of the buffer */ +#define JPEG_BUF_CAPACITY_SIZE_SHIFT 8 + +/* There are 16 buffers in the buffer list, the width between each other' address is 8 bytes */ +#define BUF_LIST_ADDR_OFFSET 0x8 +#define BUF_LIST_CTRL_AND_STS_OFFSET 0x8 + +/* Get the address of the specific index buffer */ +#define BUF_LIST_INDEX_ADDR(index) \ + (BUF_LIST_BASE_ADDR + (index) * BUF_LIST_ADDR_OFFSET) + +#define JPEG_DST_ADDR_SHIFT 8 + +#define BUF_LIST_INDEX_CTRL_STS_ADDR(index) \ + (PHYTIUM_BUF_LIST_ACTRL_AND_STS_BASE_ADDR_REG + (index) * BUF_LIST_CTRL_AND_STS_OFFSET) + +#define FRAME_SAMPLE_CTRL 0x00000898 +#define FRAME_SAMPLE_CTRL_EN BIT(31) +#define FRAME_SAMPLE_INTERVAL GENMASK(30, 0) + +/* The below registers are all related to quantilize */ +#define HUFF_MODE_REG 0x300 +#define SAMPLE_MODE_REG 0x304 + +#define Y_QUANT_BASE_ADDR_REG 0x400 +#define C_QUANT_BASE_ADDR_REG 0x500 + +#define QUANT_REG_NUM 64 + +#define Y_QUANT_INDEX_ADDR_REG(index) \ + (Y_QUANT_BASE_ADDR_REG + 4 * (index)) + +#define C_QUANT_INDEX_ADDR_REG(index) \ + (C_QUANT_BASE_ADDR_REG + 4 * (index)) + +#endif /* _PHYTIUM_JPEG_REG_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..5bd33c533e04b717e99b5ca5c3e9d99a10d347ec --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/Kconfig @@ -0,0 +1,16 @@ +config MFD_PHYTIUM_I2S_LSD + tristate "PHYTIUM px210 I2S LSD MFD driver" + depends on (PCI && ARCH_PHYTIUM) + select MFD_CORE + help + This enables support for the Phytium px210 LSD I2S controller. + +config MFD_PHYTIUM_I2S_MMD + tristate "PHYTIUM px210 I2S MMD MFD driver" + depends on (PCI && ARCH_PHYTIUM) + select MFD_CORE + help + This enables support for the Phytium px210 MMD I2S controllers + for Display Port. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..279f0d88af6bcd2861eff2024aefa7b2f0f9c296 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/Makefile @@ -0,0 +1,3 @@ +obj-$(CONFIG_MFD_PHYTIUM_I2S_LSD) += phytium_px210_i2s_lsd.o +obj-$(CONFIG_MFD_PHYTIUM_I2S_MMD) += phytium_px210_i2s_mmd.o + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/phytium_px210_i2s_lsd.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/phytium_px210_i2s_lsd.c new file mode 100644 index 0000000000000000000000000000000000000000..1f082a3c802644ecbb89cf6af6e1fa75bd19fee0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/phytium_px210_i2s_lsd.c @@ -0,0 +1,131 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium I2S LSD MFD driver over PCI bus + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include + +struct phytium_px210_mfd { + struct device *dev; +}; + +struct pdata_px210_mfd { + struct device *dev; + char *name; + int clk_base; +}; + +static struct resource phytium_px210_i2s_res0[] = { + [0] = { + .flags = IORESOURCE_MEM, + }, + [1] = { + .flags = IORESOURCE_MEM, + }, + [2] = { + .flags = IORESOURCE_IRQ, + }, +}; + +static struct mfd_cell phytium_px210_mfd_cells[] = { + { + .id = 0, + .name = "phytium-i2s", + .of_compatible = "phytium,i2s", + .resources = phytium_px210_i2s_res0, + .num_resources = ARRAY_SIZE(phytium_px210_i2s_res0), + .ignore_resource_conflicts = true, + }, +}; + +static void phytium_px210_i2s_setup(struct pci_dev *pdev) +{ + struct mfd_cell *cell = &phytium_px210_mfd_cells[0]; + struct resource *res = (struct resource *)cell->resources; + struct pdata_px210_mfd *pdata; + + res[0].start = pci_resource_start(pdev, 0); + res[0].end = pci_resource_start(pdev, 0) + 0x0fff; + + res[1].start = pci_resource_start(pdev, 0) + 0x1000; + res[1].end = pci_resource_start(pdev, 0) + 0x1fff; + + res[2].start = pdev->irq; + res[2].end = pdev->irq; + + pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); + + pdata->dev = &pdev->dev; + pdata->name = "phytium-i2s-lsd"; + pdata->clk_base = 480000000; + + cell->platform_data = pdata; + cell->pdata_size = sizeof(*pdata); +} + +static int phytium_px210_mfd_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct phytium_px210_mfd *phytium_mfd; + int ret; + + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + pci_set_master(pdev); + + phytium_mfd = devm_kzalloc(&pdev->dev, sizeof(*phytium_mfd), GFP_KERNEL); + if (!phytium_mfd) + return -ENOMEM; + + phytium_mfd->dev = &pdev->dev; + dev_set_drvdata(&pdev->dev, phytium_mfd); + + phytium_px210_i2s_setup(pdev); + + ret = mfd_add_devices(&pdev->dev, 0, phytium_px210_mfd_cells, + ARRAY_SIZE(phytium_px210_mfd_cells), NULL, 0, + NULL); + if (ret) + return 0; + + return 0; +} + + +static void phytium_px210_mfd_remove(struct pci_dev *pdev) +{ + mfd_remove_devices(&pdev->dev); +} + +static const struct pci_device_id phytium_px210_mfd_ids[] = { + { + .vendor = 0x1DB7, + .device = 0xDC2B, + .subvendor = PCI_ANY_ID, + .subdevice = PCI_ANY_ID, + .class = 0x3, + .class_mask = 0, + }, + {}, +}; +MODULE_DEVICE_TABLE(pci, phytium_px210_mfd_ids); + +static struct pci_driver phytium_i2s_lsd_mfd_driver = { + .name = "phytium_px210_mfd_i2s", + .id_table = phytium_px210_mfd_ids, + .probe = phytium_px210_mfd_probe, + .remove = phytium_px210_mfd_remove, +}; + +module_pci_driver(phytium_i2s_lsd_mfd_driver); + +MODULE_AUTHOR("Zhang Yiqun "); +MODULE_DESCRIPTION("Phytium Px210 MFD PCI driver for I2S-LSD"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/phytium_px210_i2s_mmd.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/phytium_px210_i2s_mmd.c new file mode 100644 index 0000000000000000000000000000000000000000..d225a22f206eeb6137eef4613d1278b9173efaef --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mfd/phytium_px210_i2s_mmd.c @@ -0,0 +1,185 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium I2S MMD MFD driver over PCI bus + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include + +struct phytium_px210_mfd { + struct device *dev; +}; + +struct pdata_px210_mfd { + struct device *dev; + char *name; + int clk_base; +}; + +static struct resource phytium_px210_i2s_res0[] = { + [0] = { + .flags = IORESOURCE_MEM, + }, + [1] = { + .flags = IORESOURCE_MEM, + }, + [2] = { + .flags = IORESOURCE_IRQ, + }, +}; + +static struct resource phytium_px210_i2s_res1[] = { + [0] = { + .flags = IORESOURCE_MEM, + }, + [1] = { + .flags = IORESOURCE_MEM, + }, + [2] = { + .flags = IORESOURCE_IRQ, + }, +}; + +static struct resource phytium_px210_i2s_res2[] = { + [0] = { + .flags = IORESOURCE_MEM, + }, + [1] = { + .flags = IORESOURCE_MEM, + }, + [2] = { + .flags = IORESOURCE_IRQ, + }, +}; + +static struct mfd_cell phytium_px210_mfd_cells[] = { + { + .id = 1, + .name = "phytium-i2s", + .of_compatible = "phytium,i2s", + .resources = phytium_px210_i2s_res0, + .num_resources = ARRAY_SIZE(phytium_px210_i2s_res0), + .ignore_resource_conflicts = true, + }, + { + .id = 2, + .name = "phytium-i2s", + .of_compatible = "phytium,i2s", + .resources = phytium_px210_i2s_res1, + .num_resources = ARRAY_SIZE(phytium_px210_i2s_res1), + .ignore_resource_conflicts = true, + }, + { + .id = 3, + .name = "phytium-i2s", + .of_compatible = "phytium,i2s", + .resources = phytium_px210_i2s_res2, + .num_resources = ARRAY_SIZE(phytium_px210_i2s_res2), + .ignore_resource_conflicts = true, + }, +}; + +static void phytium_px210_i2s_setup(struct pci_dev *pdev, int i) +{ + struct mfd_cell *cell = &phytium_px210_mfd_cells[i]; + struct resource *res = (struct resource *)cell->resources; + struct pdata_px210_mfd *pdata; + + res[0].start = pci_resource_start(pdev, 0) + 0x2000 * i + 0x1000; + res[0].end = pci_resource_start(pdev, 0) + 0x2000 * i + 0x1fff; + + res[1].start = pci_resource_start(pdev, 0) + 0x2000 * i; + res[1].end = pci_resource_start(pdev, 0) + 0x2000 * i + 0x0fff; + + res[2].start = pdev->irq; + res[2].end = pdev->irq; + + pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); + + pdata->dev = &pdev->dev; + pdata->clk_base = 600000000; + switch (i) { + case 0: + pdata->name = "phytium-i2s-dp0"; + break; + case 1: + pdata->name = "phytium-i2s-dp1"; + break; + case 2: + pdata->name = "phytium-i2s-dp2"; + break; + default: + break; + } + + cell->platform_data = pdata; + cell->pdata_size = sizeof(*pdata); +} + +static int phytium_px210_mfd_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct phytium_px210_mfd *phytium_mfd; + int i; + int ret; + + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + pci_set_master(pdev); + + phytium_mfd = devm_kzalloc(&pdev->dev, sizeof(*phytium_mfd), GFP_KERNEL); + if (!phytium_mfd) + return -ENOMEM; + + phytium_mfd->dev = &pdev->dev; + dev_set_drvdata(&pdev->dev, phytium_mfd); + + for (i = 0; i < 3; i++) + phytium_px210_i2s_setup(pdev, i); + + ret = mfd_add_devices(&pdev->dev, 0, phytium_px210_mfd_cells, + ARRAY_SIZE(phytium_px210_mfd_cells), NULL, 0, + NULL); + if (ret) + return 0; + + return 0; +} + + +static void phytium_px210_mfd_remove(struct pci_dev *pdev) +{ + mfd_remove_devices(&pdev->dev); +} + +static const struct pci_device_id phytium_px210_mfd_ids[] = { + { + .vendor = 0x1DB7, + .device = 0xDC23, + .subvendor = PCI_ANY_ID, + .subdevice = PCI_ANY_ID, + .class = 0x3, + .class_mask = 0, + }, + {}, +}; +MODULE_DEVICE_TABLE(pci, phytium_px210_mfd_ids); + +static struct pci_driver phytium_i2s_mmd_mfd_driver = { + .name = "phytium_px210_mfd_mmd", + .id_table = phytium_px210_mfd_ids, + .probe = phytium_px210_mfd_probe, + .remove = phytium_px210_mfd_remove, +}; + +module_pci_driver(phytium_i2s_mmd_mfd_driver); + +MODULE_AUTHOR("Zhang Yiqun "); +MODULE_DESCRIPTION("Phytium Px210 MFD PCI driver for I2S-DP"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..45668507ed5f488a7f0688ff6d998e7cc6dcbd4f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/Kconfig @@ -0,0 +1,29 @@ +config MMC_PHYTIUM_SDCI + tristate "Phytium SD Host Controller support" + depends on ARM64 + help + This selects support for the Phytium SD Host Controller + + +config MMC_PHYTIUM_MCI_PCI + tristate "Phytium PCI MultiMedia Card Interface support" + depends on ARCH_PHYTIUM + default y if ARCH_PHYTIUM + help + This selects support for the PCI MultiMedia Card Interface on Phytium + px210 chipset. + + If you have a controller with this interface, say Y or M here. + + If unsure, say N. + +config MMC_PHYTIUM_MCI_PLTFM + tristate "Phytium MultiMedia Card Interface support" + depends on ARCH_PHYTIUM && OF + default y if ARCH_PHYTIUM + help + This selects support for the MultiMedia Card Interface on Phytium SoCs. + If you have a controller with this interface, say Y or M here. + + If unsure, say N. + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..6d8510cf5597387f8174e9c22f056f22d3bbd44a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/Makefile @@ -0,0 +1,3 @@ +obj-$(CONFIG_MMC_PHYTIUM_SDCI) += phytium-sdci.o +obj-$(CONFIG_MMC_PHYTIUM_MCI_PCI) += phytium-mci-pci.o phytium-mci.o +obj-$(CONFIG_MMC_PHYTIUM_MCI_PLTFM) += phytium-mci-plat.o phytium-mci.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci-pci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci-pci.c new file mode 100644 index 0000000000000000000000000000000000000000..eb7aa5b11a40b96709db222551ccf15a910f2be2 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci-pci.c @@ -0,0 +1,175 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Phytium Multimedia Card Interface PCI driver + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + * + */ + +#include +#include +#include +#include +#include +#include +#include "phytium-mci.h" + +static u32 sd_caps = MMC_CAP_SD_HIGHSPEED | MMC_CAP_WAIT_WHILE_BUSY | + MMC_CAP_CMD23 | MMC_CAP_4_BIT_DATA; +static u32 sd_caps2 = MMC_CAP2_NO_MMC; + +static u32 emmc_caps = MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA | MMC_CAP_WAIT_WHILE_BUSY | + MMC_CAP_CMD23 | MMC_CAP_HW_RESET | MMC_CAP_MMC_HIGHSPEED | + MMC_CAP_NONREMOVABLE; +static u32 emmc_caps2 = MMC_CAP2_NO_SDIO | MMC_CAP2_NO_SD; + +#define PCI_BAR_NO 0 + +#if defined CONFIG_PM && defined CONFIG_PM_SLEEP +static const struct dev_pm_ops phytium_mci_dev_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_mci_suspend, + phytium_mci_resume) + SET_RUNTIME_PM_OPS(phytium_mci_runtime_suspend, + phytium_mci_runtime_resume, NULL) +}; +#else +#define phytium_mci_dev_pm_ops NULL +#endif + +static int +phytium_mci_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) +{ + struct phytium_mci_host *host; + struct mmc_host *mmc; + int ret; + + ret = pcim_enable_device(pdev); + + if (ret) + return ret; + pci_set_master(pdev); + + mmc = mmc_alloc_host(sizeof(struct phytium_mci_host), &pdev->dev); + + if (!mmc) + return -ENOMEM; + + host = mmc_priv(mmc); + + pci_enable_msi(pdev); + + host->irq = pdev->irq; + host->irq_flags = IRQF_SHARED; + host->dev = &pdev->dev; + ret = pcim_iomap_regions(pdev, 1 << PCI_BAR_NO, pci_name(pdev)); + + if (ret) { + dev_err(&pdev->dev, "I/O memory remapping failed\n"); + goto host_free; + } + + host->base = pcim_iomap_table(pdev)[PCI_BAR_NO]; + host->is_use_dma = 1; + host->is_device_x100 = 1; + + if (pdev->devfn == 2) { + host->caps = emmc_caps; + host->caps2 = emmc_caps2; + } else { + host->caps = sd_caps; + host->caps2 = sd_caps2; + mmc->f_max = 25000000; /* stable frequency */ + } + + host->mmc = mmc; + host->clk_rate = MCI_CLK; + + dev_info(&pdev->dev, "%s %d: [bar %d] addr: 0x%llx size: 0x%llx km: 0x%llx devfn:%d\n", + __func__, __LINE__, PCI_BAR_NO, pci_resource_start(pdev, 0), + pci_resource_len(pdev, 0), (uint64_t)host->base, pdev->devfn); + + dev_dbg(&pdev->dev, "%s %d:irq:0x%x\n", __func__, __LINE__, host->irq); + + ret = phytium_mci_common_probe(host); + + if (ret == MCI_REALEASE_MEM) { + ret = -ENOMEM; + goto release_mem; + } else if (ret) { + goto release; + } + pci_set_drvdata(pdev, mmc); + dev_info(&pdev->dev, "%s %d: probe phytium mci successful.\n", __func__, __LINE__); + return 0; + +release: + phytium_mci_deinit_hw(host); +release_mem: + + if (host->dma.adma_table) { + dma_free_coherent(&pdev->dev, + MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), + host->dma.adma_table, host->dma.adma_addr); + } +host_free: + mmc_free_host(mmc); + pci_disable_device(pdev); + return ret; +} + +static void phytium_mci_pci_remove(struct pci_dev *pdev) +{ + struct phytium_mci_host *host; + struct mmc_host *mmc; + + mmc = pci_get_drvdata(pdev); + if (!mmc) { + dev_info(&pdev->dev, "%s %d: mmc is null.\n", __func__, __LINE__); + return; + } + host = mmc_priv(mmc); + if (!host) { + dev_info(&pdev->dev, "%s %d: host is null.\n", __func__, __LINE__); + mmc_remove_host(mmc); + mmc_free_host(mmc); + return; + } + + del_timer(&host->hotplug_timer); + + mmc_remove_host(host->mmc); + + if (host->dma.adma_table) { + dma_free_coherent(&pdev->dev, + MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), + host->dma.adma_table, host->dma.adma_addr); + } + phytium_mci_deinit_hw(host); + mmc_free_host(mmc); + pci_set_drvdata(pdev, NULL); +} + +static const struct pci_device_id phytium_mci_pci_tbl[] = { + { + PCI_DEVICE(PCI_VENDOR_ID_PHYTIUM, 0xdc28), + .class = 0x5, + .class_mask = 0, + }, + {} +}; +MODULE_DEVICE_TABLE(pci, phytium_mci_pci_tbl); + +static struct pci_driver phytium_mci_pci_driver = { + .name = "phytium-mci-pci", + .id_table = phytium_mci_pci_tbl, + .probe = phytium_mci_pci_probe, + .remove = phytium_mci_pci_remove, + .driver = { + .pm = &phytium_mci_dev_pm_ops, + } +}; +module_pci_driver(phytium_mci_pci_driver); + +MODULE_DESCRIPTION("Phytium Multimedia Card Interface PCI driver"); +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Cheng Quan "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci-plat.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci-plat.c new file mode 100644 index 0000000000000000000000000000000000000000..c18b7dd160d326d0342026bd1245aed54f7b00b5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci-plat.c @@ -0,0 +1,195 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Phytium Multimedia Card Interface PCI driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include "phytium-mci.h" + +static u32 mci_caps = MMC_CAP_CMD23; + +#if defined CONFIG_PM && defined CONFIG_PM_SLEEP + +static const struct dev_pm_ops phytium_mci_dev_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_mci_suspend, + phytium_mci_resume) + SET_RUNTIME_PM_OPS(phytium_mci_runtime_suspend, + phytium_mci_runtime_resume, NULL) +}; +#else +#define phytium_mci_dev_pm_ops NULL +#endif + +static int phytium_mci_probe(struct platform_device *pdev) +{ + struct mmc_host *mmc; + struct phytium_mci_host *host; + struct resource *res; + const struct acpi_device_id *match; + struct device *dev = &pdev->dev; + int ret; + + mmc = mmc_alloc_host(sizeof(struct phytium_mci_host), &pdev->dev); + if (!mmc) + return -ENOMEM; + host = mmc_priv(mmc); + ret = mmc_of_parse(mmc); + if (ret) + goto host_free; + + if (device_property_read_bool(dev, "use-hold")) + host->use_hold = 1; + + if (device_property_read_bool(dev, "clk-set")) + host->clk_set = 1; + + if (host->clk_set) { + host->clk_smpl_drv_25m = -1; + host->clk_smpl_drv_50m = -1; + host->clk_smpl_drv_66m = -1; + host->clk_smpl_drv_100m = -1; + device_property_read_u32(dev, "clk-smpl-drv-25m", &host->clk_smpl_drv_25m); + device_property_read_u32(dev, "clk-smpl-drv-50m", &host->clk_smpl_drv_50m); + device_property_read_u32(dev, "clk-smpl-drv-66m", &host->clk_smpl_drv_66m); + device_property_read_u32(dev, "clk-smpl-drv-100m", &host->clk_smpl_drv_100m); + } + dev_info(dev, "mci clk set %d %d 0x%x 0x%x 0x%x 0x%x\n", + host->use_hold, host->clk_set, host->clk_smpl_drv_25m, + host->clk_smpl_drv_50m, host->clk_smpl_drv_66m, host->clk_smpl_drv_100m); + + if (dev->of_node) { + host->src_clk = devm_clk_get(&pdev->dev, "phytium_mci_clk"); + if (IS_ERR(host->src_clk)) { + ret = PTR_ERR(host->src_clk); + goto host_free; + } + + host->clk_rate = clk_get_rate(host->src_clk); + } else if (has_acpi_companion(dev)) { + match = acpi_match_device(dev->driver->acpi_match_table, dev); + if (!match) { + dev_err(dev, "Error ACPI match data is missing\n"); + return -ENODEV; + } + host->clk_rate = 1200000000; + } + + host->is_use_dma = 1; + host->is_device_x100 = 0; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + host->base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(host->base)) { + ret = PTR_ERR(host->base); + goto host_free; + } + + host->irq = platform_get_irq(pdev, 0); + + if (host->irq < 0) { + ret = -EINVAL; + goto host_free; + } + host->irq_flags = IRQF_SHARED; + dev_dbg(&pdev->dev, "%s %d:irq:%d\n", __func__, __LINE__, host->irq); + host->dev = &pdev->dev; + host->caps = mci_caps; + host->mmc = mmc; + ret = phytium_mci_common_probe(host); + if (ret == MCI_REALEASE_MEM) { + ret = -ENOMEM; + goto release_mem; + } else if (ret) { + goto release; + } + platform_set_drvdata(pdev, mmc); + dev_info(&pdev->dev, "%s %d: probe phytium mci successful.\n", __func__, __LINE__); + return 0; + +release: + phytium_mci_deinit_hw(host); +release_mem: + if (host->dma.adma_table) { + dma_free_coherent(&pdev->dev, + MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), + host->dma.adma_table, host->dma.adma_addr); + } +host_free: + mmc_free_host(mmc); + return ret; +} + +static int phytium_mci_remove(struct platform_device *pdev) +{ + struct mmc_host *mmc; + struct phytium_mci_host *host; + + mmc = platform_get_drvdata(pdev); + if (!mmc) { + dev_info(&pdev->dev, "%s %d: mmc is null.\n", __func__, __LINE__); + return -1; + } + host = mmc_priv(mmc); + if (!host) { + dev_info(&pdev->dev, "%s %d: host is null.\n", __func__, __LINE__); + mmc_remove_host(mmc); + mmc_free_host(mmc); + return -1; + } + del_timer(&host->hotplug_timer); + del_timer_sync(&host->timeout_timer); + mmc_remove_host(host->mmc); + + if (host->dma.adma_table) { + dma_free_coherent(&pdev->dev, + MAX_BD_NUM * sizeof(struct phytium_adma2_64_desc), + host->dma.adma_table, host->dma.adma_addr); + } + phytium_mci_deinit_hw(host); + mmc_free_host(mmc); + platform_set_drvdata(pdev, NULL); + return 0; +} + +static const struct of_device_id phytium_mci_of_ids[] = { + { .compatible = "phytium,mci", }, + {} +}; + +MODULE_DEVICE_TABLE(of, phytium_mci_of_ids); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_mci_acpi_ids[] = { + { .id = "PHYT0017" }, + { } +}; + +MODULE_DEVICE_TABLE(acpi, phytium_mci_acpi_ids); +#else +#define phytium_mci_acpi_ids NULL +#endif + +static struct platform_driver phytium_mci_driver = { + .probe = phytium_mci_probe, + .remove = phytium_mci_remove, + .driver = { + .name = "phytium-mci-platform", + .of_match_table = phytium_mci_of_ids, + .acpi_match_table = phytium_mci_acpi_ids, + .pm = &phytium_mci_dev_pm_ops, + }, +}; + +module_platform_driver(phytium_mci_driver); + +MODULE_DESCRIPTION("Phytium Multimedia Card Interface driver"); +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Cheng Quan "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci.c new file mode 100644 index 0000000000000000000000000000000000000000..b511d893be2e3962cc3cd3843d2ab4075970f065 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci.c @@ -0,0 +1,1578 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Driver for Phytium Multimedia Card Interface + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#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 "phytium-mci.h" + +static const u32 cmd_ints_mask = MCI_INT_MASK_RE | MCI_INT_MASK_CMD | MCI_INT_MASK_RCRC | + MCI_INT_MASK_RTO | MCI_INT_MASK_HTO | MCI_RAW_INTS_HLE; + +static const u32 data_ints_mask = MCI_INT_MASK_DTO | MCI_INT_MASK_DCRC | MCI_INT_MASK_DRTO | + MCI_INT_MASK_SBE_BCI; +static const u32 cmd_err_ints_mask = MCI_INT_MASK_RTO | MCI_INT_MASK_RCRC | MCI_INT_MASK_RE | + MCI_INT_MASK_DCRC | MCI_INT_MASK_DRTO | + MCI_MASKED_INTS_SBE_BCI; + +static const u32 dmac_ints_mask = MCI_DMAC_INT_ENA_FBE | MCI_DMAC_INT_ENA_DU | + MCI_DMAC_INT_ENA_NIS | MCI_DMAC_INT_ENA_AIS; +static const u32 dmac_err_ints_mask = MCI_DMAC_INT_ENA_FBE | MCI_DMAC_INT_ENA_DU | + MCI_DMAC_INT_ENA_AIS; + +static void phytium_mci_cmd_next(struct phytium_mci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd); +static void phytium_mci_adma_reset(struct phytium_mci_host *host); +static void phytium_mci_send_cmd(struct phytium_mci_host *host, u32 cmd, u32 arg); +static bool phytium_mci_data_xfer_done(struct phytium_mci_host *host, u32 events, + struct mmc_request *mrq, struct mmc_data *data); +static void phytium_mci_init_adma_table(struct phytium_mci_host *host, + struct phytium_mci_dma *dma); +static void phytium_mci_init_hw(struct phytium_mci_host *host); +static int phytium_mci_get_cd(struct mmc_host *mmc); +static int phytium_mci_err_irq(struct phytium_mci_host *host, u32 dmac_events, u32 events); + +static void sdr_set_bits(void __iomem *reg, u32 bs) +{ + u32 val = readl(reg); + + val |= bs; + writel(val, reg); +} + +static void sdr_clr_bits(void __iomem *reg, u32 bs) +{ + u32 val = readl(reg); + + val &= ~bs; + writel(val, reg); +} + +static void phytium_mci_reset_hw(struct phytium_mci_host *host) +{ + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET); + + while (readl(host->base + MCI_CNTRL) & (MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET)) + cpu_relax(); + phytium_mci_send_cmd(host, MCI_CMD_UPD_CLK, 0); +} + +static void phytium_mci_update_external_clk(struct phytium_mci_host *host, u32 uhs_reg_value) +{ + writel(0, host->base + MCI_UHS_REG_EXT); + writel(uhs_reg_value, host->base + MCI_UHS_REG_EXT); + while (!(readl(host->base + MCI_CCLK_RDY) & 0x1)) + cpu_relax(); + +} + +static void phytium_mci_prepare_data(struct phytium_mci_host *host, + struct mmc_request *mrq) +{ + struct mmc_data *data = mrq->data; + + if (!(data->host_cookie & MCI_PREPARE_FLAG)) { + data->host_cookie |= MCI_PREPARE_FLAG; + data->sg_count = dma_map_sg(host->dev, data->sg, data->sg_len, + mmc_get_dma_dir(data)); + } +} + +static void phytium_mci_unprepare_data(struct phytium_mci_host *host, + struct mmc_request *mrq) +{ + struct mmc_data *data = mrq->data; + + if (data->host_cookie & MCI_ASYNC_FLAG) + return; + + if (data->host_cookie & MCI_PREPARE_FLAG) { + dma_unmap_sg(host->dev, data->sg, data->sg_len, mmc_get_dma_dir(data)); + data->host_cookie &= ~MCI_PREPARE_FLAG; + } +} + +static void phytium_mci_send_cmd(struct phytium_mci_host *host, u32 cmd, u32 arg) +{ + int rc; + u32 data; + + writel(arg, host->base + MCI_CMDARG); + wmb(); /* drain writebuffer */ + + rc = readl_relaxed_poll_timeout(host->base + MCI_STATUS, + data, + !(data & MCI_STATUS_CARD_BUSY), + 0, 5000 * 1000); + if (rc == -ETIMEDOUT) + pr_debug("%s %d, timeout mci_status: 0x%08x\n", __func__, __LINE__, data); + + writel(MCI_CMD_START | cmd, host->base + MCI_CMD); + + rc = readl_relaxed_poll_timeout(host->base + MCI_CMD, + data, + !(data & MCI_CMD_START), + 0, 5000 * 1000); + if (rc == -ETIMEDOUT) + pr_debug("%s %d, timeout mci_cmd: 0x%08x\n", __func__, __LINE__, data); +} + +static void phytium_mci_update_cmd11(struct phytium_mci_host *host, u32 cmd) +{ + writel(MCI_CMD_START | cmd, host->base + MCI_CMD); + + while (readl(host->base + MCI_CMD) & MCI_CMD_START) + cpu_relax(); +} + +static void phytium_mci_set_clk(struct phytium_mci_host *host, struct mmc_ios *ios) +{ + u32 div = 0xff, drv = 0, sample = 0; + unsigned long clk_rate; + u32 mci_cmd_bits = MCI_CMD_UPD_CLK; + u32 cmd_reg; + u32 cur_cmd_index; + u32 first_uhs_div, tmp_ext_reg; + + cmd_reg = readl(host->base + MCI_CMD); + cur_cmd_index = cmd_reg & 0x3F; + + if (cur_cmd_index == SD_SWITCH_VOLTAGE) + mci_cmd_bits |= MCI_CMD_VOLT_SWITCH; + if (ios->clock) { + if (host->current_ios_clk == ios->clock) + return; + + dev_dbg(host->dev, "will change clock, host->clk_rate: %ld, ios->clock: %d\n", + host->clk_rate, ios->clock); + + if (ios->clock >= 25000000) + tmp_ext_reg = 0x202; + else if (ios->clock == 400000) + tmp_ext_reg = 0x502; + else + tmp_ext_reg = 0x302; + + phytium_mci_update_external_clk(host, tmp_ext_reg); + sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + + if (cur_cmd_index == SD_SWITCH_VOLTAGE) + phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); + else + phytium_mci_send_cmd(host, mci_cmd_bits, 0); + + clk_rate = host->clk_rate; + first_uhs_div = 1 + ((tmp_ext_reg >> 8)&0xFF); + div = clk_rate / (2 * first_uhs_div * ios->clock); + + if (host->clk_smpl_drv_25m >= 0 + && ios->clock == 25000000 && host->clk_set) { + writel((host->clk_smpl_drv_25m << 8) | (div & 0xff), + host->base + MCI_CLKDIV); + } else if (host->clk_smpl_drv_50m >= 0 + && ios->clock == 50000000 && host->clk_set){ + writel((host->clk_smpl_drv_50m << 8) | (div & 0xff), + host->base + MCI_CLKDIV); + } else if (host->clk_smpl_drv_66m >= 0 + && ios->clock == 66000000 && host->clk_set){ + writel((host->clk_smpl_drv_66m << 8) | (div & 0xff), + host->base + MCI_CLKDIV); + } else if (host->clk_smpl_drv_100m >= 0 + && ios->clock == 100000000 && host->clk_set){ + writel((host->clk_smpl_drv_100m << 8) | (div & 0xff), + host->base + MCI_CLKDIV); + } else { + if (div > 2) { + sample = div / 2 + 1; + drv = sample - 1; + writel((sample << 16) | (drv << 8) | (div & 0xff), + host->base + MCI_CLKDIV); + } else if (div == 2) { + drv = 0; + sample = 1; + writel((drv << 8) | (sample << 16) | (div & 0xff), + host->base + MCI_CLKDIV); + } + } + + dev_dbg(host->dev, "UHS_REG_EXT ext: %x, CLKDIV: %x\n", + readl(host->base + MCI_UHS_REG_EXT), readl(host->base + MCI_CLKDIV)); + + sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + + if (cur_cmd_index == SD_SWITCH_VOLTAGE) + phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); + else + phytium_mci_send_cmd(host, mci_cmd_bits, 0); + + host->current_ios_clk = ios->clock; + + dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", + host->clk_rate, ios->clock); + } else { + host->current_ios_clk = 0; + sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + + if (cur_cmd_index == SD_SWITCH_VOLTAGE) + phytium_mci_update_cmd11(host, mci_cmd_bits | cmd_reg); + else + phytium_mci_send_cmd(host, mci_cmd_bits, 0); + + sdr_clr_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); + dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", + host->clk_rate, ios->clock); + } +} + +static inline u32 +phytium_mci_cmd_find_resp(struct phytium_mci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + u32 resp; + + switch (mmc_resp_type(cmd)) { + case MMC_RSP_R1: + case MMC_RSP_R1B: + resp = 0x5; + break; + + case MMC_RSP_R2: + resp = 0x7; + break; + + case MMC_RSP_R3: + resp = 0x1; + break; + + case MMC_RSP_NONE: + default: + resp = 0x0; + break; + } + + return resp; +} + +static inline +u32 phytium_mci_cmd_prepare_raw_cmd(struct phytium_mci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + u32 opcode = cmd->opcode; + u32 resp = phytium_mci_cmd_find_resp(host, mrq, cmd); + u32 rawcmd = ((opcode & 0x3f) | ((resp & 0x7) << 6)); + + if (opcode == MMC_GO_INACTIVE_STATE || + (opcode == SD_IO_RW_DIRECT && ((cmd->arg >> 9) & 0x1FFFF) == SDIO_CCCR_ABORT)) + rawcmd |= (0x1 << 14); + else if (opcode == SD_SWITCH_VOLTAGE) + rawcmd |= (0x1 << 28); + + if (test_and_clear_bit(MCI_CARD_NEED_INIT, &host->flags)) + rawcmd |= (0x1 << 15); + + if (cmd->data) { + struct mmc_data *data = cmd->data; + + rawcmd |= (0x1 << 9); + + if (data->flags & MMC_DATA_WRITE) + rawcmd |= (0x1 << 10); + } + if (host->use_hold) + rawcmd |= (0x1 << 29); + + return (rawcmd | (0x1 << 31)); +} + +static inline void +phytium_mci_adma_write_desc(struct phytium_mci_host *host, + struct phytium_adma2_64_desc *desc, + dma_addr_t addr, u32 len, u32 attribute) +{ + desc->attribute = attribute; + desc->len = len; + desc->addr_lo = lower_32_bits(addr); + desc->addr_hi = upper_32_bits(addr); + dev_dbg(host->dev, "%s %d:addr_lo:0x%x ddr_hi:0x%x\n", __func__, + __LINE__, desc->addr_lo, desc->addr_hi); + + if ((attribute == 0x80000004) || (attribute == 0x8000000c)) { + desc->desc_lo = 0; + desc->desc_hi = 0; + } +} + +static void +phytium_mci_data_sg_write_2_admc_table(struct phytium_mci_host *host, struct mmc_data *data) +{ + struct phytium_adma2_64_desc *desc; + u32 dma_len, i; + dma_addr_t dma_address; + struct scatterlist *sg; + + phytium_mci_init_adma_table(host, &host->dma); + + desc = host->dma.adma_table; + for_each_sg(data->sg, sg, data->sg_count, i) { + dma_address = sg_dma_address(sg); + dma_len = sg_dma_len(sg); + + if (i == 0) { + if (sg_is_last(sg) || (data->sg_count == 1 && dma_len == SD_BLOCK_SIZE)) + phytium_mci_adma_write_desc(host, desc, dma_address, + dma_len, 0x8000000c); + else + phytium_mci_adma_write_desc(host, desc, dma_address, + dma_len, 0x8000001a); + } else if (sg_is_last(sg)) { + phytium_mci_adma_write_desc(host, desc, dma_address, + dma_len, 0x80000004); + } else { + phytium_mci_adma_write_desc(host, desc, dma_address, + dma_len, 0x80000012); + } + + desc++; + } +} + +static void +phytium_mci_data_sg_write_2_fifo(struct phytium_mci_host *host, struct mmc_data *data) +{ + struct scatterlist *sg; + u32 dma_len, i, j; + u32 *virt_addr; + + if (mmc_get_dma_dir(data) == DMA_TO_DEVICE) { + writel(0x1<<10, host->base + MCI_CMD); + for_each_sg(data->sg, sg, data->sg_count, i) { + dma_len = sg_dma_len(sg); + virt_addr = sg_virt(data->sg); + for (j = 0; j < (dma_len / 4); j++) { + writel(*virt_addr, host->base + MCI_DATA); + virt_addr++; + } + } + } +} + +static void phytium_mci_restart_clk(struct phytium_mci_host *host) +{ + u32 clk_div, uhs; + + while (readl(host->base + MCI_CMD) & MCI_CMD_START) + cpu_relax(); + sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + clk_div = readl(host->base + MCI_CLKDIV); + uhs = readl(host->base + MCI_UHS_REG_EXT); + writel(0, host->base + MCI_UHS_REG_EXT); + writel(uhs, host->base + MCI_UHS_REG_EXT); + while (!(readl(host->base + MCI_CCLK_RDY) & 0x1)) + cpu_relax(); + + writel(clk_div, host->base + MCI_CLKDIV); + sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + writel(MCI_CMD_START | MCI_CMD_UPD_CLK, host->base + MCI_CMD); + while (readl(host->base + MCI_CMD) & MCI_CMD_START) + cpu_relax(); +} + +static int +phytim_mci_start_multiple_write(struct phytium_mci_host *host, + struct mmc_request *mrq, u32 cnts, u32 offset) +{ + u32 rawcmd, cmd_status; + struct mmc_command *cmd = mrq->cmd; + u32 *rsp = cmd->resp; + unsigned long deadline_time; + + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) + return -ESHUTDOWN; + + while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) + cpu_relax(); + + writel(0xffffe, host->base + MCI_RAW_INTS); + rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); + writel(mrq->data->blksz, host->base + MCI_BLKSIZ); + writel(cnts * mrq->data->blksz, host->base + MCI_BYTCNT); + writel(cmd->arg + offset, host->base + MCI_CMDARG); + writel(rawcmd, host->base + MCI_CMD); + deadline_time = jiffies + msecs_to_jiffies(200); + + cmd_status = readl(host->base + MCI_RAW_INTS); + while (!(cmd_status & MCI_MASKED_INTS_CMD)) { + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && + readl(host->base + MCI_CARD_DETECT)) + return -ESHUTDOWN; + + cmd_status = readl(host->base + MCI_RAW_INTS); + if (cmd_err_ints_mask & cmd_status) + return -ESHUTDOWN; + + if (cmd_status & MCI_MASKED_INTS_CMD) + break; + + if (time_after(jiffies, deadline_time)) + return -ESHUTDOWN; + } + + if (cmd_status & MCI_MASKED_INTS_CMD) { + if (cmd->flags & MMC_RSP_136) { + rsp[3] = readl(host->base + MCI_RESP0); + rsp[2] = readl(host->base + MCI_RESP1); + rsp[1] = readl(host->base + MCI_RESP2); + rsp[0] = readl(host->base + MCI_RESP3); + } else { + rsp[0] = readl(host->base + MCI_RESP0); + } + } + deadline_time = jiffies + msecs_to_jiffies(1000); + while (!(cmd_status & MCI_MASKED_INTS_DTO)) { + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && + readl(host->base + MCI_CARD_DETECT)) + return -ESHUTDOWN; + cmd_status = readl(host->base + MCI_RAW_INTS); + if (cmd_err_ints_mask & cmd_status) + return -ESHUTDOWN; + if (cmd_status & MCI_MASKED_INTS_DTO) + return 0; + if (time_after(jiffies, deadline_time)) + return -ESHUTDOWN; + } + return 0; +} + +static int +phytium_mci_start_sbc_stop_cmd(struct phytium_mci_host *host, struct mmc_request *mrq, + struct mmc_command *cmd, u32 arg) +{ + u32 rawcmd, cmd_status; + u32 *rsp = cmd->resp; + unsigned long deadline_time; + + writel(0xffffe, host->base + MCI_RAW_INTS); + + while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) + cpu_relax(); + + rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); + writel(arg, host->base + MCI_CMDARG); + writel(rawcmd, host->base + MCI_CMD); + + deadline_time = jiffies + msecs_to_jiffies(200); + cmd_status = readl(host->base + MCI_RAW_INTS); + while (!(cmd_status & MCI_MASKED_INTS_CMD)) { + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && + readl(host->base + MCI_CARD_DETECT)) + return -ENOMEDIUM; + + cmd_status = readl(host->base + MCI_RAW_INTS); + if (cmd_err_ints_mask & cmd_status) + return -ETIMEDOUT; + + if (cmd_status & MCI_MASKED_INTS_CMD) + break; + + if (time_after(jiffies, deadline_time)) + return -ETIMEDOUT; + } + + if (cmd_status & MCI_MASKED_INTS_CMD) { + if (cmd->flags & MMC_RSP_136) { + rsp[3] = readl(host->base + MCI_RESP0); + rsp[2] = readl(host->base + MCI_RESP1); + rsp[1] = readl(host->base + MCI_RESP2); + rsp[0] = readl(host->base + MCI_RESP3); + } else { + rsp[0] = readl(host->base + MCI_RESP0); + } + } + + if (cmd_err_ints_mask & cmd_status) + return -ETIMEDOUT; + + return 0; +} + +static void +phytium_mci_start_write_multiple_non_dma(struct mmc_host *mmc, struct mmc_request *mrq) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + struct mmc_data *data = mrq->data; + u32 write_cnts, last_cnts; + u32 i, j, k, send_cnt_one_sg, block_offset; + int ret = 0, dma_len; + struct scatterlist *sg; + u32 *virt_addr = NULL; + + write_cnts = data->blocks / 4; + (data->blocks % 4) ? write_cnts++ : write_cnts; + last_cnts = data->blocks % 4; + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { + ret = -ENOMEDIUM; + goto write_err; + } + + dev_dbg(host->dev, "%s: cmd:%d, block counts:%d\n", + __func__, mrq->cmd->opcode, data->blocks); + + sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET); + while (readl(host->base + MCI_CNTRL) & MCI_CNTRL_FIFO_RESET) + cpu_relax(); + sdr_clr_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); + + if (mmc_get_dma_dir(data) == DMA_TO_DEVICE) { + block_offset = 0; + for_each_sg(data->sg, sg, data->sg_count, i) { + /* Each SG data transfor starts */ + dma_len = sg_dma_len(sg); + send_cnt_one_sg = (dma_len / MCI_MAX_FIFO_CNT) + 1; + virt_addr = sg_virt(sg); + for (k = 0; k < send_cnt_one_sg; k++) { + if (dma_len && dma_len >= MCI_MAX_FIFO_CNT) { + /*first write sbc cmd*/ + ret = phytium_mci_start_sbc_stop_cmd(host, mrq, + mrq->sbc, 4); + if (ret) + goto write_err; + writel(0x1 << 10, host->base + MCI_CMD); + for (j = 0; j < (MCI_MAX_FIFO_CNT / 4); j++) { + writel(*virt_addr, host->base + MCI_DATA); + virt_addr++; + } + + /*second write cmd25 here*/ + ret = phytim_mci_start_multiple_write(host, mrq, 4, + block_offset); + if (ret) + goto write_err; + block_offset += 4; + dma_len -= MCI_MAX_FIFO_CNT; + } else if (dma_len > 0) { + /*first write sbc cmd*/ + last_cnts = dma_len / 512; + ret = phytium_mci_start_sbc_stop_cmd(host, mrq, mrq->sbc, + last_cnts); + if (ret) + goto write_err; + writel(0x1 << 10, host->base + MCI_CMD); + for (j = 0; j < (dma_len / 4); j++) { + writel(*virt_addr, host->base + MCI_DATA); + virt_addr++; + } + /*second write cmd25 here*/ + ret = phytim_mci_start_multiple_write(host, mrq, last_cnts, + block_offset); + if (ret) + goto write_err; + block_offset += last_cnts; + dma_len = 0; + } else { + dev_dbg(host->dev, "%s: sg %d end\n", __func__, i); + break; + } + } + } + } + +write_err: + host->data = NULL; + host->cmd = NULL; + host->mrq = NULL; + writel(0xffffe, host->base + MCI_RAW_INTS); + if (ret) { + data->bytes_xfered = 0; + if (ret == -ESHUTDOWN) { + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET); + while (readl(host->base + MCI_CNTRL) & MCI_CNTRL_FIFO_RESET) + cpu_relax(); + + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_CONTROLLER_RESET); + while (readl(host->base + MCI_STATUS) & MCI_STATUS_CARD_BUSY) + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_CONTROLLER_RESET); + phytium_mci_restart_clk(host); + phytium_mci_start_sbc_stop_cmd(host, mrq, mrq->stop, mrq->stop->arg); + } + data->error = -ETIMEDOUT; + mrq->cmd->error = -ETIMEDOUT; + mmc_request_done(host->mmc, mrq); + return; + } + data->bytes_xfered = data->blocks * data->blksz; + mmc_request_done(host->mmc, mrq); +} + +static void +phytium_mci_start_data(struct phytium_mci_host *host, struct mmc_request *mrq, + struct mmc_command *cmd, struct mmc_data *data) +{ + bool read; + u32 rawcmd; + unsigned long flags; + + + WARN_ON(host->cmd); + host->cmd = cmd; + cmd->error = 0; + WARN_ON(host->data); + host->data = data; + read = data->flags & MMC_DATA_READ; + + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { + phytium_mci_err_irq(host, 0, MCI_INT_MASK_RTO); + return; + } + /* clear interrupts */ + writel(0xffffe, host->base + MCI_RAW_INTS); + + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET); + + while (readl(host->base + MCI_CNTRL) & (MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET)) + cpu_relax(); + + if (host->adtc_type == COMMOM_ADTC) + sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); + else + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_USE_INTERNAL_DMAC); + wmb(); /* drain writebuffer */ + sdr_clr_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE); + + rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); + if (host->is_use_dma && host->adtc_type == BLOCK_RW_ADTC) + phytium_mci_data_sg_write_2_admc_table(host, data); + else + phytium_mci_data_sg_write_2_fifo(host, data); + + spin_lock_irqsave(&host->lock, flags); + mod_timer(&host->timeout_timer, + jiffies + msecs_to_jiffies(MMC_REQ_TIMEOUT_MS)); + sdr_set_bits(host->base + MCI_INT_MASK, cmd_ints_mask | data_ints_mask); + if (host->is_use_dma && host->adtc_type == BLOCK_RW_ADTC) { + sdr_set_bits(host->base + MCI_DMAC_INT_ENA, dmac_ints_mask); + /* Enable the IDMAC */ + sdr_set_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); + writel((u32)host->dma.adma_addr, host->base + MCI_DESC_LIST_ADDRL); + writel((u32)(host->dma.adma_addr >> 32), host->base + MCI_DESC_LIST_ADDRH); + } + writel(mrq->data->blksz, host->base + MCI_BLKSIZ); + writel(mrq->data->blocks * mrq->data->blksz, host->base + MCI_BYTCNT); + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE); + writel(cmd->arg, host->base + MCI_CMDARG); + wmb(); /* drain writebuffer */ + writel(rawcmd, host->base + MCI_CMD); + spin_unlock_irqrestore(&host->lock, flags); +} + +static void phytium_mci_track_cmd_data(struct phytium_mci_host *host, + struct mmc_command *cmd, + struct mmc_data *data) +{ + if (host->error) + dev_dbg(host->dev, "%s: cmd=%d arg=%08X; host->error=0x%08X\n", + __func__, cmd->opcode, cmd->arg, host->error); +} + +static void phytium_mci_request_done(struct phytium_mci_host *host, struct mmc_request *mrq) +{ + unsigned long flags; + + spin_lock_irqsave(&host->lock, flags); + del_timer(&host->timeout_timer); + host->mrq = NULL; + if (host->cmd) + host->cmd = NULL; + spin_unlock_irqrestore(&host->lock, flags); + phytium_mci_track_cmd_data(host, mrq->cmd, mrq->data); + + if (mrq->data) + phytium_mci_unprepare_data(host, mrq); + + mmc_request_done(host->mmc, mrq); +} + +static bool phytium_mci_cmd_done(struct phytium_mci_host *host, int events, + struct mmc_request *mrq, struct mmc_command *cmd) +{ + bool done = false; + unsigned long flags; + u32 *rsp = cmd->resp; + + if (!(events & (MCI_RAW_INTS_RCRC | MCI_RAW_INTS_RE | MCI_RAW_INTS_CMD | + MCI_RAW_INTS_RTO | MCI_INT_MASK_HTO))) { + dev_err(host->dev, "No interrupt generation:h%x\n", events); + return done; + } + + spin_lock_irqsave(&host->lock, flags); + done = !host->cmd; + host->cmd = NULL; + if (done) { + spin_unlock_irqrestore(&host->lock, flags); + return true; + } + sdr_clr_bits(host->base + MCI_INT_MASK, cmd_ints_mask); + spin_unlock_irqrestore(&host->lock, flags); + + if (cmd->flags & MMC_RSP_PRESENT) { + if (cmd->flags & MMC_RSP_136) { + rsp[3] = readl(host->base + MCI_RESP0); + rsp[2] = readl(host->base + MCI_RESP1); + rsp[1] = readl(host->base + MCI_RESP2); + rsp[0] = readl(host->base + MCI_RESP3); + } else { + /* + * Sometimes get ACMD41 cmd done irq but the respose index still the APP_CMD, + * so polling the mci status entill the respose index change. + */ + if (cmd->opcode == SD_APP_OP_COND) { + int polling_cnt = 20; + while (MMC_APP_CMD == MCI_STATUS_RESPOSE_INDEX(readl(host->base + MCI_STATUS))) { + udelay(100); + polling_cnt --; + if (polling_cnt == 0) { + dev_info(host->dev, "hw respose index not equal cmd opcode, respose value may error\n"); + break; + } + } + } + rsp[0] = readl(host->base + MCI_RESP0); + } + + if (cmd->opcode == SD_SEND_RELATIVE_ADDR) + host->current_rca = rsp[0] & 0xFFFF0000; + } + if (!(events & (MCI_RAW_INTS_CMD | MCI_INT_MASK_HTO))) { + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && (events & MCI_RAW_INTS_RTO) + && readl(host->base + MCI_CARD_DETECT)) { + cmd->error = -ENOMEDIUM; + rsp[0] = 0; + } else if (events & MCI_RAW_INTS_RTO || + (cmd->opcode != MMC_SEND_TUNING_BLOCK && + cmd->opcode != MMC_SEND_TUNING_BLOCK_HS200)) { + cmd->error = -ETIMEDOUT; + } else if (events & MCI_RAW_INTS_RCRC) { + cmd->error = -EILSEQ; + } else { + cmd->error = -ETIMEDOUT; + } + } + phytium_mci_cmd_next(host, mrq, cmd); + return true; +} + +static void phytium_mci_start_command(struct phytium_mci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + u32 rawcmd; + unsigned long flags; + + spin_lock_irqsave(&host->lock, flags); + WARN_ON(host->cmd); + host->cmd = cmd; + cmd->error = 0; + writel(0xffffe, host->base + MCI_RAW_INTS); + + rawcmd = phytium_mci_cmd_prepare_raw_cmd(host, mrq, cmd); + spin_unlock_irqrestore(&host->lock, flags); + + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) && readl(host->base + MCI_CARD_DETECT)) { + phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, cmd); + return; + } + + spin_lock_irqsave(&host->lock, flags); + mod_timer(&host->timeout_timer, + jiffies + msecs_to_jiffies(MMC_REQ_TIMEOUT_MS)); + sdr_set_bits(host->base + MCI_INT_MASK, cmd_ints_mask); + writel(cmd->arg, host->base + MCI_CMDARG); + writel(rawcmd, host->base + MCI_CMD); + spin_unlock_irqrestore(&host->lock, flags); +} + +static void +phytium_mci_cmd_next(struct phytium_mci_host *host, struct mmc_request *mrq, + struct mmc_command *cmd) +{ + if ((cmd->error && !(cmd->opcode == MMC_SEND_TUNING_BLOCK || + cmd->opcode == MMC_SEND_TUNING_BLOCK_HS200)) || + (mrq->sbc && mrq->sbc->error)) { + phytium_mci_request_done(host, mrq); + } else if (cmd == mrq->sbc) { + if ((mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK) || + (mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) || + (mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK) || + (mrq->cmd->opcode == MMC_WRITE_BLOCK)) { + dev_dbg(host->dev, "%s %d:sbc done and next cmd :%d length:%d\n", + __func__, __LINE__, mrq->cmd->opcode, mrq->data->sg->length); + phytium_mci_prepare_data(host, mrq); + if (host->is_use_dma) + host->adtc_type = BLOCK_RW_ADTC; + else + host->adtc_type = COMMOM_ADTC; + phytium_mci_start_data(host, mrq, mrq->cmd, mrq->data); + } else { + dev_err(host->dev, "%s %d:ERROR: cmd %d followers the SBC\n", + __func__, __LINE__, cmd->opcode); + } + } else if (!cmd->data) { + phytium_mci_request_done(host, mrq); + } +} + +static void phytium_mci_ops_request(struct mmc_host *mmc, struct mmc_request *mrq) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + u32 data; + int rc; + + host->error = 0; + WARN_ON(host->mrq); + host->mrq = mrq; + + rc = readl_relaxed_poll_timeout(host->base + MCI_STATUS, + data, + !(data & MCI_STATUS_CARD_BUSY), + 0, 500 * 1000); + if (rc == -ETIMEDOUT) + pr_debug("%s %d, timeout mci_status: 0x%08x\n", __func__, __LINE__, data); + + rc = readl_relaxed_poll_timeout(host->base + MCI_CMD, + data, + !(data & MCI_CMD_START), + 0, 500 * 1000); + if (rc == -ETIMEDOUT) + pr_debug("%s %d, timeout mci_cmd.start_cmd bit clear: 0x%08x\n", __func__, __LINE__, data); + + dev_dbg(host->dev, "%s %d: cmd:%d arg:0x%x\n", __func__, __LINE__, + mrq->cmd->opcode, mrq->cmd->arg); + + if (host->is_device_x100 && mrq->sbc && mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) { + phytium_mci_start_write_multiple_non_dma(mmc, mrq); + return; + } + + if (mrq->sbc) { + phytium_mci_start_command(host, mrq, mrq->sbc); + return; + } + if (mrq->data) { + phytium_mci_prepare_data(host, mrq); + + if ((mrq->data->sg->length >= 512) && host->is_use_dma && + ((mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK) || + (mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK) || + (mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK) || + (mrq->cmd->opcode == MMC_WRITE_BLOCK) || + (mrq->cmd->opcode == SD_IO_RW_EXTENDED))) + + host->adtc_type = BLOCK_RW_ADTC; + else + host->adtc_type = COMMOM_ADTC; + + phytium_mci_start_data(host, mrq, mrq->cmd, mrq->data); + return; + } + phytium_mci_start_command(host, mrq, mrq->cmd); +} + +static void phytium_mci_pre_req(struct mmc_host *mmc, struct mmc_request *mrq) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + struct mmc_data *data = mrq->data; + + if (!data) + return; + + phytium_mci_prepare_data(host, mrq); + data->host_cookie |= MCI_ASYNC_FLAG; +} + +static void phytium_mci_post_req(struct mmc_host *mmc, struct mmc_request *mrq, + int err) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + struct mmc_data *data = mrq->data; + + if (!data) + return; + + if (data->host_cookie & MCI_ASYNC_FLAG) { + data->host_cookie &= ~MCI_ASYNC_FLAG; + phytium_mci_unprepare_data(host, mrq); + } +} + +static void phytium_mci_data_read_without_dma(struct phytium_mci_host *host, + struct mmc_data *data) +{ + u32 length, i, data_val, dma_len, tmp = 0; + u32 *virt_addr; + unsigned long flags; + struct scatterlist *sg; + + length = data->blocks * data->blksz; + + if (mmc_get_dma_dir(data) == DMA_FROM_DEVICE) { + spin_lock_irqsave(&host->lock, flags); + if (data->host_cookie & MCI_ASYNC_FLAG) { + tmp = MCI_ASYNC_FLAG; + phytium_mci_post_req(host->mmc, data->mrq, 0); + } else { + phytium_mci_unprepare_data(host, data->mrq); + } + + for_each_sg(data->sg, sg, data->sg_count, i) { + dma_len = sg_dma_len(sg); + virt_addr = sg_virt(data->sg); + + for (i = 0; i < (dma_len / 4); i++) { + data_val = readl(host->base + MCI_DATA); + memcpy(virt_addr, &data_val, 4); + ++virt_addr; + } + } + + if (tmp & MCI_ASYNC_FLAG) + phytium_mci_pre_req(host->mmc, data->mrq); + else + phytium_mci_prepare_data(host, data->mrq); + + spin_unlock_irqrestore(&host->lock, flags); + } + data->bytes_xfered = length; +} + +static void phytium_mci_data_xfer_next(struct phytium_mci_host *host, + struct mmc_request *mrq, + struct mmc_data *data) +{ + if (mmc_op_multi(mrq->cmd->opcode) && mrq->stop && + (data->error || !mrq->sbc)) { + while ((readl(host->base + MCI_STATUS) & (MCI_STATUS_CARD_BUSY))) + cpu_relax(); + phytium_mci_start_command(host, mrq, mrq->stop); + } else { + phytium_mci_request_done(host, mrq); + } +} + +static bool phytium_mci_data_xfer_done(struct phytium_mci_host *host, u32 events, + struct mmc_request *mrq, struct mmc_data *data) +{ + unsigned long flags; + bool done; + + unsigned int check_data = events & (MCI_RAW_INTS_DTO | MCI_RAW_INTS_RCRC | + MCI_RAW_INTS_DCRC | MCI_RAW_INTS_RE | + MCI_RAW_INTS_DRTO | MCI_RAW_INTS_EBE | + MCI_DMAC_STATUS_AIS | MCI_DMAC_STATUS_DU | + MCI_RAW_INTS_SBE_BCI | MCI_INT_MASK_RTO); + + spin_lock_irqsave(&host->lock, flags); + done = !host->data; + + if (check_data || host->data) + host->data = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + if (done) + return true; + if (check_data) { + spin_lock_irqsave(&host->lock, flags); + sdr_clr_bits(host->base + MCI_DMAC_INT_ENA, dmac_ints_mask); + sdr_clr_bits(host->base + MCI_INT_MASK, data_ints_mask); + /* Stop the IDMAC running */ + sdr_clr_bits(host->base + MCI_BUS_MODE, MCI_BUS_MODE_DE); + dev_dbg(host->dev, "DMA stop\n"); + spin_unlock_irqrestore(&host->lock, flags); + + if (events & MCI_RAW_INTS_DTO) { + if (!host->is_use_dma || + (host->is_use_dma && host->adtc_type == COMMOM_ADTC && + (mrq->cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC)) + phytium_mci_data_read_without_dma(host, data); + else + data->bytes_xfered = data->blocks * data->blksz; + } else { + data->bytes_xfered = 0; + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE) + && readl(host->base + MCI_CARD_DETECT) + && (events & cmd_err_ints_mask)) { + data->error = -ENOMEDIUM; + data->mrq->cmd->error = -ENOMEDIUM; + } else if (events & (MCI_RAW_INTS_DCRC | MCI_RAW_INTS_EBE | + MCI_RAW_INTS_SBE_BCI)) { + data->error = -EILSEQ; + host->cmd = NULL; + } else { + data->error = -ETIMEDOUT; + host->cmd = NULL; + } + } + + phytium_mci_data_xfer_next(host, mrq, data); + done = true; + } + return done; +} + +static int phytium_mci_card_busy(struct mmc_host *mmc) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + u32 status; + + status = readl(host->base + MCI_STATUS); + + return !!(status & MCI_STATUS_CARD_BUSY); +} + +static void __phytium_mci_enable_sdio_irq(struct phytium_mci_host *host, int enable) +{ + if (enable) + sdr_set_bits(host->base + MCI_INT_MASK, MCI_INT_MASK_SDIO); + else + sdr_clr_bits(host->base + MCI_INT_MASK, MCI_INT_MASK_SDIO); +} + +static void phytium_mci_enable_sdio_irq(struct mmc_host *mmc, int enable) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + + __phytium_mci_enable_sdio_irq(host, enable); +} + +static void hotplug_timer_func(struct timer_list *t) +{ + struct phytium_mci_host *host; + u32 status; + + host = from_timer(host, t, hotplug_timer); + if (!host) + return; + + status = readl(host->base + MCI_CARD_DETECT); + + if (status & 0x1) { + if (host->mmc->card) { + cancel_delayed_work(&host->mmc->detect); + mmc_detect_change(host->mmc, msecs_to_jiffies(100)); + } + } else { + cancel_delayed_work(&host->mmc->detect); + mmc_detect_change(host->mmc, msecs_to_jiffies(200)); + } +} + +static void phytium_mci_request_timeout(struct timer_list *t) +{ + struct phytium_mci_host *host = from_timer(host, t, timeout_timer); + + dev_err(host->dev, "request timeout\n"); + if (host->mrq) { + dev_err(host->dev, "aborting mrq=%p cmd=%d\n", + host->mrq, host->mrq->cmd->opcode); + if (host->cmd) { + dev_err(host->dev, "aborting cmd=%d\n", host->cmd->opcode); + phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, host->mrq, host->cmd); + } else if (host->data) { + dev_err(host->dev, "abort data: cmd%d; %d blocks\n", + host->mrq->cmd->opcode, host->data->blocks); + phytium_mci_data_xfer_done(host, MCI_RAW_INTS_RTO, host->mrq, + host->data); + } + } +} + +static int phytium_mci_err_irq(struct phytium_mci_host *host, u32 dmac_events, u32 events) +{ + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + + mrq = host->mrq; + cmd = host->cmd; + data = host->data; + + if (cmd && (cmd == mrq->sbc)) { + phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->sbc); + } else if (cmd && (cmd == mrq->stop)) { + phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->stop); + } else if (data) { + data->error = -ETIMEDOUT; + if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || + (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) + phytium_mci_data_xfer_done(host, events | dmac_events, mrq, data); + } else if (cmd) { + phytium_mci_cmd_done(host, MCI_RAW_INTS_RTO, mrq, mrq->cmd); + } + + return 0; +} + +static irqreturn_t phytium_mci_irq(int irq, void *dev_id) +{ + struct phytium_mci_host *host = (struct phytium_mci_host *) dev_id; + unsigned long flags; + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + u32 events, event_mask, dmac_events, dmac_evt_mask; + + if (!host) + return IRQ_NONE; + writel(0, host->base + 0xfd0); + + spin_lock_irqsave(&host->lock, flags); + events = readl(host->base + MCI_RAW_INTS); + dmac_events = readl(host->base + MCI_DMAC_STATUS); + event_mask = readl(host->base + MCI_INT_MASK); + dmac_evt_mask = readl(host->base + MCI_DMAC_INT_ENA); + if ((!events) && (!(dmac_events&0x1fff))) { + spin_unlock_irqrestore(&host->lock, flags); + return IRQ_NONE; + } + dev_dbg(host->dev, "%s:events:%x,mask:0x%x,dmac_events:%x,dmac_mask:0x%x,cmd:%d\n", + __func__, events, event_mask, dmac_events, dmac_evt_mask, + host->mrq ? host->mrq->cmd->opcode : 255); + + mrq = host->mrq; + cmd = host->cmd; + data = host->data; + + if ((events & event_mask) & MCI_RAW_INTS_SDIO) + __phytium_mci_enable_sdio_irq(host, 0); + + writel((events & event_mask), host->base + MCI_RAW_INTS); + writel(dmac_events, host->base + MCI_DMAC_STATUS); + spin_unlock_irqrestore(&host->lock, flags); + + if ((events & event_mask) & MCI_RAW_INTS_SDIO) + sdio_signal_irq(host->mmc); + + if (((events & event_mask) == 0) && ((dmac_evt_mask & dmac_events) == 0)) + goto irq_out; + + if (((events & event_mask) & MCI_RAW_INTS_CD) && + !(host->mmc->caps & MMC_CAP_NONREMOVABLE)) { + mod_timer(&host->hotplug_timer, jiffies + usecs_to_jiffies(20000)); + dev_dbg(host->dev, "sd status changed here ! status:[%d] [%s %d]", + readl(host->base + MCI_CARD_DETECT), __func__, __LINE__); + + if ((events & event_mask) == MCI_RAW_INTS_CD) + goto irq_out; + } + + if (!mrq) { + if (events & MCI_RAW_INTS_HLE) + dev_dbg(host->dev, + "%s: MRQ=NULL and HW write locked, events=%08x,event_mask=%08x\n", + __func__, events, event_mask); + else + dev_dbg(host->dev, "%s: MRQ=NULL events:%08X evt_mask=%08X,sd_status:%d\n", + __func__, events, event_mask, readl(host->base + MCI_CARD_DETECT)); + goto irq_out; + } + + if ((dmac_events & dmac_err_ints_mask) || (events & cmd_err_ints_mask)) { + dev_dbg(host->dev, "ERR:events:%x,mask:0x%x,dmac_evts:%x,dmac_mask:0x%x,cmd:%d\n", + events, event_mask, dmac_events, dmac_evt_mask, mrq->cmd->opcode); + phytium_mci_err_irq(host, dmac_events & dmac_err_ints_mask, + events & cmd_err_ints_mask); + goto irq_out; + } + + if (cmd && (events & MCI_MASKED_INTS_DTO) && (events & MCI_MASKED_INTS_CMD)) { + phytium_mci_cmd_done(host, events, mrq, cmd); + phytium_mci_data_xfer_done(host, (events & data_ints_mask) | + (dmac_events & dmac_ints_mask), mrq, data); + } else if (cmd && (events & MCI_MASKED_INTS_CMD || + ((events & MCI_INT_MASK_HTO) && (cmd->opcode == SD_SWITCH_VOLTAGE)))) { + phytium_mci_cmd_done(host, events, mrq, cmd); + } else if (events & MCI_MASKED_INTS_DTO) { + phytium_mci_data_xfer_done(host, (events & data_ints_mask) | + (dmac_events & dmac_ints_mask), mrq, data); + } + +irq_out: + return IRQ_HANDLED; +} + +static void phytium_mci_init_hw(struct phytium_mci_host *host) +{ + u32 val; + int uhs_reg_value = 0x502; + + writel(MCI_SET_FIFOTH(0x2, 0x7, 0x100), host->base + MCI_FIFOTH); + writel(0x800001, host->base + MCI_CARD_THRCTL); + sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + phytium_mci_update_external_clk(host, uhs_reg_value); + + sdr_set_bits(host->base + MCI_PWREN, MCI_PWREN_ENABLE); + sdr_set_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + sdr_set_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); + sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); + + phytium_mci_reset_hw(host); + + if (host->mmc->caps & MMC_CAP_NONREMOVABLE) + sdr_set_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); + else + sdr_clr_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); + + writel(0, host->base + MCI_INT_MASK); + val = readl(host->base + MCI_RAW_INTS); + writel(val, host->base + MCI_RAW_INTS); + writel(0, host->base + MCI_DMAC_INT_ENA); + val = readl(host->base + MCI_DMAC_STATUS); + writel(val, host->base + MCI_DMAC_STATUS); + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE)) + writel(MCI_INT_MASK_CD, host->base + MCI_INT_MASK); + + sdr_set_bits(host->base + MCI_CNTRL, MCI_CNTRL_INT_ENABLE | + MCI_CNTRL_USE_INTERNAL_DMAC); + + writel(0xFFFFFFFF, host->base + MCI_TMOUT); + dev_info(host->dev, "init hardware done!"); + +} + +void phytium_mci_deinit_hw(struct phytium_mci_host *host) +{ + u32 val; + + sdr_clr_bits(host->base + MCI_PWREN, MCI_PWREN_ENABLE); + sdr_clr_bits(host->base + MCI_CLKENA, MCI_CLKENA_CCLK_ENABLE); + sdr_clr_bits(host->base + MCI_UHS_REG_EXT, MCI_EXT_CLK_ENABLE); + sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); + writel(0, host->base + MCI_INT_MASK); + val = readl(host->base + MCI_RAW_INTS); + writel(val, host->base + MCI_RAW_INTS); + writel(0, host->base + MCI_DMAC_INT_ENA); + val = readl(host->base + MCI_DMAC_STATUS); + writel(val, host->base + MCI_DMAC_STATUS); + if (!(host->mmc->caps & MMC_CAP_NONREMOVABLE)) + writel(MCI_INT_MASK_CD, host->base + MCI_INT_MASK); +} +EXPORT_SYMBOL_GPL(phytium_mci_deinit_hw); + +static void phytium_mci_adma_reset(struct phytium_mci_host *host) +{ + u32 bmod = readl(host->base + MCI_BUS_MODE); + + bmod |= MCI_BUS_MODE_SWR; + writel(bmod, host->base + MCI_BUS_MODE); +} + +static void phytium_mci_init_adma_table(struct phytium_mci_host *host, + struct phytium_mci_dma *dma) +{ + struct phytium_adma2_64_desc *adma_table = dma->adma_table; + dma_addr_t dma_addr; + int i; + + memset(adma_table, 0, sizeof(struct phytium_adma2_64_desc) * MAX_BD_NUM); + + for (i = 0; i < (MAX_BD_NUM - 1); i++) { + dma_addr = dma->adma_addr + sizeof(*adma_table) * (i + 1); + adma_table[i].desc_lo = lower_32_bits(dma_addr); + adma_table[i].desc_hi = upper_32_bits(dma_addr); + adma_table[i].attribute = 0; + adma_table[i].NON1 = 0; + adma_table[i].len = 0; + adma_table[i].NON2 = 0; + } + + phytium_mci_adma_reset(host); +} + +static void phytium_mci_set_buswidth(struct phytium_mci_host *host, u32 width) +{ + u32 val; + + switch (width) { + case MMC_BUS_WIDTH_1: + val = MCI_BUS_1BITS; + break; + + case MMC_BUS_WIDTH_4: + val = MCI_BUS_4BITS; + break; + + case MMC_BUS_WIDTH_8: + val = MCI_BUS_8BITS; + break; + default: + val = MCI_BUS_4BITS; + break; + } + writel(val, host->base + MCI_CTYPE); + dev_dbg(host->dev, "Bus Width = %d, set value:0x%x\n", width, val); +} + +static void phytium_mci_ops_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + + if (ios->timing == MMC_TIMING_MMC_DDR52 || ios->timing == MMC_TIMING_UHS_DDR50) + sdr_set_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_DDR); + else + sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_DDR); + + phytium_mci_set_buswidth(host, ios->bus_width); + + switch (ios->power_mode) { + case MMC_POWER_UP: + set_bit(MCI_CARD_NEED_INIT, &host->flags); + writel(MCI_POWER_ON, host->base + MCI_PWREN); + break; + + case MMC_POWER_ON: + break; + + case MMC_POWER_OFF: + writel(MCI_POWER_OFF, host->base + MCI_PWREN); + break; + + default: + break; + } + phytium_mci_set_clk(host, ios); +} + +static void phytium_mci_ack_sdio_irq(struct mmc_host *mmc) +{ + unsigned long flags; + struct phytium_mci_host *host = mmc_priv(mmc); + + spin_lock_irqsave(&host->lock, flags); + __phytium_mci_enable_sdio_irq(host, 1); + spin_unlock_irqrestore(&host->lock, flags); +} + +static int phytium_mci_get_cd(struct mmc_host *mmc) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + u32 status; + + if (mmc->caps & MMC_CAP_NONREMOVABLE) + return 1; + + status = readl(host->base + MCI_CARD_DETECT); + + if ((status & 0x1) == 0x1) + return 0; + + return 1; +} + +static int phytium_mci_ops_switch_volt(struct mmc_host *mmc, struct mmc_ios *ios) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + unsigned int is_voltage_180 = 0; + + is_voltage_180 = readl(host->base + MCI_UHS_REG); + if ((mmc->caps & MMC_CAP_NONREMOVABLE) && (ios->signal_voltage != MMC_SIGNAL_VOLTAGE_180)) + return -EINVAL; + + if ((ios->signal_voltage == MMC_SIGNAL_VOLTAGE_330) && (is_voltage_180 & 0x1)) + sdr_clr_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); + else if ((ios->signal_voltage == MMC_SIGNAL_VOLTAGE_180) && (!(is_voltage_180 & 0x1))) + sdr_set_bits(host->base + MCI_UHS_REG, MCI_UHS_REG_VOLT); + else if (ios->signal_voltage == MMC_SIGNAL_VOLTAGE_120) + return -EINVAL; + return 0; +} + +static void phytium_mci_hw_reset(struct mmc_host *mmc) +{ + struct phytium_mci_host *host = mmc_priv(mmc); + u32 reset_flag; + + if (host->is_use_dma) { + reset_flag = MCI_CNTRL_FIFO_RESET | MCI_CNTRL_DMA_RESET; + phytium_mci_adma_reset(host); + sdr_set_bits(host->base + MCI_CNTRL, reset_flag); + } else { + reset_flag = MCI_CNTRL_FIFO_RESET; + sdr_set_bits(host->base + MCI_CNTRL, reset_flag); + } + + while (readl(host->base + MCI_CNTRL) & reset_flag) + cpu_relax(); + + sdr_clr_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); + udelay(5); + sdr_set_bits(host->base + MCI_CARD_RESET, MCI_CARD_RESET_ENABLE); + usleep_range(200, 300); +} + +#ifdef CONFIG_PM_SLEEP +int phytium_mci_suspend(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_mci_host *host = mmc_priv(mmc); + + phytium_mci_deinit_hw(host); + return 0; +} +EXPORT_SYMBOL(phytium_mci_suspend); + +int phytium_mci_resume(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_mci_host *host = mmc_priv(mmc); + + phytium_mci_init_hw(host); + return 0; +} +EXPORT_SYMBOL(phytium_mci_resume); + +#endif + +#ifdef CONFIG_PM +int phytium_mci_runtime_suspend(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_mci_host *host = mmc_priv(mmc); + + phytium_mci_deinit_hw(host); + return 0; +} +EXPORT_SYMBOL(phytium_mci_runtime_suspend); + +int phytium_mci_runtime_resume(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_mci_host *host = mmc_priv(mmc); + + phytium_mci_init_hw(host); + return 0; +} +EXPORT_SYMBOL(phytium_mci_runtime_resume); + +#endif + +static struct mmc_host_ops phytium_mci_ops = { + .post_req = phytium_mci_post_req, + .pre_req = phytium_mci_pre_req, + .request = phytium_mci_ops_request, + .set_ios = phytium_mci_ops_set_ios, + .get_cd = phytium_mci_get_cd, + .enable_sdio_irq = phytium_mci_enable_sdio_irq, + .ack_sdio_irq = phytium_mci_ack_sdio_irq, + .card_busy = phytium_mci_card_busy, + .start_signal_voltage_switch = phytium_mci_ops_switch_volt, + .card_hw_reset = phytium_mci_hw_reset, +}; + +int phytium_mci_common_probe(struct phytium_mci_host *host) +{ + struct mmc_host *mmc = host->mmc; + struct device *dev = host->dev; + int ret; + + dma_set_mask(dev, DMA_BIT_MASK(64)); + dma_set_coherent_mask(dev, DMA_BIT_MASK(64)); + + timer_setup(&host->hotplug_timer, hotplug_timer_func, 0); + timer_setup(&host->timeout_timer, phytium_mci_request_timeout, 0); + + mmc->f_min = MCI_F_MIN; + if (!mmc->f_max) + mmc->f_max = MCI_F_MAX; + + mmc->ops = &phytium_mci_ops; + mmc->ocr_avail_sdio = MMC_VDD_32_33 | MMC_VDD_33_34; + mmc->ocr_avail_sd = MMC_VDD_32_33 | MMC_VDD_33_34; + mmc->ocr_avail_mmc = MMC_VDD_165_195; + mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34 | MMC_VDD_165_195; + mmc->caps |= host->caps; + + if (mmc->caps & MMC_CAP_SDIO_IRQ) { + mmc->caps2 |= MMC_CAP2_SDIO_IRQ_NOTHREAD; + dev_dbg(host->dev, "%s %d: MMC_CAP_SDIO_IRQ\n", __func__, __LINE__); + } + mmc->caps2 |= host->caps2; + if (host->is_use_dma) { + /* MMC core transfer sizes tunable parameters */ + mmc->max_segs = MAX_BD_NUM; + mmc->max_seg_size = 4 * 1024; + mmc->max_blk_size = 512; + mmc->max_req_size = 512 * 1024; + mmc->max_blk_count = mmc->max_req_size / 512; + host->dma.adma_table = dma_alloc_coherent(host->dev, + MAX_BD_NUM * + sizeof(struct phytium_adma2_64_desc), + &host->dma.adma_addr, GFP_KERNEL); + if (!host->dma.adma_table) + return MCI_REALEASE_MEM; + + host->dma.desc_sz = ADMA2_64_DESC_SZ; + phytium_mci_init_adma_table(host, &host->dma); + } else { + mmc->max_segs = MAX_BD_NUM; + mmc->max_seg_size = 4 * 1024; + mmc->max_blk_size = 512; + mmc->max_req_size = 4 * 512; + mmc->max_blk_count = mmc->max_req_size / 512; + } + + spin_lock_init(&host->lock); + + phytium_mci_init_hw(host); + ret = devm_request_irq(host->dev, host->irq, phytium_mci_irq, + host->irq_flags, "phytium-mci", host); + + if (ret) + return ret; + + ret = mmc_add_host(mmc); + + if (ret) { + dev_err(host->dev, "%s %d: mmc add host!\n", __func__, __LINE__); + return ret; + } + return 0; +} +EXPORT_SYMBOL(phytium_mci_common_probe); + +MODULE_DESCRIPTION("Phytium Multimedia Card Interface driver"); +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Cheng Quan "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci.h new file mode 100644 index 0000000000000000000000000000000000000000..90f51b9ee135d7911d5beb100da51a896765dd87 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-mci.h @@ -0,0 +1,362 @@ +/* SPDX-License-Identifier: GPL-2.0+ */ +/* + * Driver for Phytium Multimedia Card Interface + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_MCI_H +#define __PHYTIUM_MCI_H + +#include +#include +#include +#include +#include +#include +#include + +/*------------------------------------------------------*/ +/* Common Definition */ +/*------------------------------------------------------*/ +#define MAX_BD_NUM 128 +#define SD_BLOCK_SIZE 512 + +#define MCI_BUS_1BITS 0x0 +#define MCI_BUS_4BITS 0x1 +#define MCI_BUS_8BITS (0x1 << 16) + +#define MCI_SD_DRV_VALUE 0 +#define MCI_SD_SAMP_VALUE_MAX 0 +#define MCI_SD_SAMP_VALUE_MIN 0 + +#define MCI_TIMEOUT_CMD_VALUE 0xFFFFFFFF +#define MCI_POWER_ON 1 +#define MCI_POWER_OFF 0 + +#define MCI_PREPARE_FLAG (0x1 << 0) +#define MCI_ASYNC_FLAG (0x1 << 1) +#define MCI_MMAP_FLAG (0x1 << 2) + +#define MCI_CMD_TIMEOUT (HZ/10 * 50) /* 100ms x5 */ +#define MCI_DATA_TIMEOUT (HZ * 10) /* 1000ms x5 */ + +#define MCI_CMD_TYPE_ADTC 0x2 + +#define MCI_F_MIN 400000 +#define MCI_F_MAX 50000000 + +#define MCI_CLK 1200000000 +#define MCI_REALEASE_MEM 0x1 +#define MCI_MAX_FIFO_CNT 0x800 + +/* FIFOTH register defines */ +#define MCI_SET_FIFOTH(m, r, t) (((m) & 0x7) << 28 | \ + ((r) & 0xFFF) << 16 | ((t) & 0xFFF)) +/* Card read threshold */ +#define MCI_SET_THLD(v, x) (((v) & 0xFFF) << 16 | (x)) +#define MCI_CARD_WR_THR_EN BIT(2) +#define MCI_CARD_RD_THR_EN BIT(0) + +/*----------------------------------------------------------------------*/ +/* Register Offset */ +/*----------------------------------------------------------------------*/ +#define MCI_CNTRL 0x00 /* the controller config reg */ +#define MCI_PWREN 0x04 /* the power enable reg */ +#define MCI_CLKDIV 0x08 /* the clock divider reg */ +#define MCI_CLKENA 0x10 /* the clock enable reg */ +#define MCI_TMOUT 0x14 /* the timeout reg */ +#define MCI_CTYPE 0x18 /* the card type reg */ +#define MCI_BLKSIZ 0x1C /* the block size reg */ +#define MCI_BYTCNT 0x20 /* the byte count reg */ +#define MCI_INT_MASK 0x24 /* the interrupt mask reg */ +#define MCI_CMDARG 0x28 /* the command argument reg */ +#define MCI_CMD 0x2C /* the command reg */ +#define MCI_RESP0 0x30 /* the response reg0 */ +#define MCI_RESP1 0x34 /* the response reg1 */ +#define MCI_RESP2 0x38 /* the response reg2 */ +#define MCI_RESP3 0X3C /* the response reg3 */ +#define MCI_MASKED_INTS 0x40 /* the masked interrupt status reg */ +#define MCI_RAW_INTS 0x44 /* the raw interrupt status reg */ +#define MCI_STATUS 0x48 /* the status reg */ +#define MCI_FIFOTH 0x4C /* the FIFO threshold watermark reg */ +#define MCI_CARD_DETECT 0x50 /* the card detect reg */ +#define MCI_CARD_WRTPRT 0x54 /* the card write protect reg */ +#define MCI_CCLK_RDY 0x58 /* first div is ready? 1:ready,0:not ready*/ +#define MCI_TRAN_CARD_CNT 0x5C /* the transferred CIU card byte count reg */ +#define MCI_TRAN_FIFO_CNT 0x60 /* the transferred host to FIFO byte count reg */ +#define MCI_DEBNCE 0x64 /* the debounce count reg */ +#define MCI_UID 0x68 /* the user ID reg */ +#define MCI_VID 0x6C /* the controller version ID reg */ +#define MCI_HWCONF 0x70 /* the hardware configuration reg */ +#define MCI_UHS_REG 0x74 /* the UHS-I reg */ +#define MCI_CARD_RESET 0x78 /* the card reset reg */ +#define MCI_BUS_MODE 0x80 /* the bus mode reg */ +#define MCI_DESC_LIST_ADDRL 0x88 /* the descriptor list low base address reg */ +#define MCI_DESC_LIST_ADDRH 0x8C /* the descriptor list high base address reg */ +#define MCI_DMAC_STATUS 0x90 /* the internal DMAC status reg */ +#define MCI_DMAC_INT_ENA 0x94 /* the internal DMAC interrupt enable reg */ +#define MCI_CUR_DESC_ADDRL 0x98 /* the current host descriptor low address reg */ +#define MCI_CUR_DESC_ADDRH 0x9C /* the current host descriptor high address reg */ +#define MCI_CUR_BUF_ADDRL 0xA0 /* the current buffer low address reg */ +#define MCI_CUR_BUF_ADDRH 0xA4 /* the current buffer high address reg */ +#define MCI_CARD_THRCTL 0x100 /* the card threshold control reg */ +#define MCI_UHS_REG_EXT 0x108 /* the UHS register extension */ +#define MCI_EMMC_DDR_REG 0x10C /* the EMMC DDR reg */ +#define MCI_ENABLE_SHIFT 0x110 /* the enable phase shift reg */ +#define MCI_DATA 0x200 /* the data FIFO access */ + +/* Command register defines */ +#define MCI_CMD_START BIT(31) +#define MCI_CMD_USE_HOLD_REG BIT(29) +#define MCI_CMD_VOLT_SWITCH BIT(28) +#define MCI_CMD_CCS_EXP BIT(23) +#define MCI_CMD_CEATA_RD BIT(22) +#define MCI_CMD_UPD_CLK BIT(21) +#define MCI_CMD_INIT BIT(15) +#define MCI_CMD_STOP BIT(14) +#define MCI_CMD_PRV_DAT_WAIT BIT(13) +#define MCI_CMD_SEND_STOP BIT(12) +#define MCI_CMD_STRM_MODE BIT(11) +#define MCI_CMD_DAT_WR BIT(10) +#define MCI_CMD_DAT_EXP BIT(9) +#define MCI_CMD_RESP_CRC BIT(8) +#define MCI_CMD_RESP_LONG BIT(7) +#define MCI_CMD_RESP_EXP BIT(6) +#define MCI_CMD_INDX(n) ((n) & 0x1F) + +/*------------------------------------------------------*/ +/* Register Mask */ +/*------------------------------------------------------*/ +/* MCI_CNTRL mask */ +#define MCI_CNTRL_CONTROLLER_RESET (0x1 << 0) /* RW */ +#define MCI_CNTRL_FIFO_RESET (0x1 << 1) /* RW */ +#define MCI_CNTRL_DMA_RESET (0x1 << 2) /* RW */ +#define MCI_CNTRL_RES (0x1 << 3) /* */ +#define MCI_CNTRL_INT_ENABLE (0x1 << 4) /* RW */ +#define MCI_CNTRL_DMA_ENABLE (0x1 << 5) /* RW */ +#define MCI_CNTRL_READ_WAIT (0x1 << 6) /* RW */ +#define MCI_CNTRL_SEND_IRQ_RESPONSE (0x1 << 7) /* RW */ +#define MCI_CNTRL_ABORT_READ_DATA (0x1 << 8) /* RW */ +#define MCI_CNTRL_ENDIAN (0x1 << 11) /* RW */ +//#define MCI_CNTRL_CARD_VOLTAGE_A (0xF << 16) /* RW */ +//#define MCI_CNTRL_CARD_VOLTAGE_B (0xF << 20) /* RW */ +#define MCI_CNTRL_ENABLE_OD_PULLUP (0x1 << 24) /* RW */ +#define MCI_CNTRL_USE_INTERNAL_DMAC (0x1 << 25) /* RW */ + +/* MCI_PWREN mask */ +#define MCI_PWREN_ENABLE (0x1 << 0) /* RW */ + +/* MCI_CLKENA mask */ +#define MCI_CLKENA_CCLK_ENABLE (0x1 << 0) /* RW */ +#define MCI_CLKENA_CCLK_LOW_POWER (0x1 << 16) /* RW */ +#define MCI_EXT_CLK_ENABLE (0x1 << 1) + +/* MCI_INT_MASK mask */ +#define MCI_INT_MASK_CD (0x1 << 0) /* RW */ +#define MCI_INT_MASK_RE (0x1 << 1) /* RW */ +#define MCI_INT_MASK_CMD (0x1 << 2) /* RW */ +#define MCI_INT_MASK_DTO (0x1 << 3) /* RW */ +#define MCI_INT_MASK_TXDR (0x1 << 4) /* RW */ +#define MCI_INT_MASK_RXDR (0x1 << 5) /* RW */ +#define MCI_INT_MASK_RCRC (0x1 << 6) /* RW */ +#define MCI_INT_MASK_DCRC (0x1 << 7) /* RW */ +#define MCI_INT_MASK_RTO (0x1 << 8) /* RW */ +#define MCI_INT_MASK_DRTO (0x1 << 9) /* RW */ +#define MCI_INT_MASK_HTO (0x1 << 10) /* RW */ +#define MCI_INT_MASK_FRUN (0x1 << 11) /* RW */ +#define MCI_INT_MASK_HLE (0x1 << 12) /* RW */ +#define MCI_INT_MASK_SBE_BCI (0x1 << 13) /* RW */ +#define MCI_INT_MASK_ACD (0x1 << 14) /* RW */ +#define MCI_INT_MASK_EBE (0x1 << 15) /* RW */ +#define MCI_INT_MASK_SDIO (0x1 << 16) /* RW */ + +/* MCI_MASKED_INTS mask */ +#define MCI_MASKED_INTS_CD (0x1 << 0) /* RO */ +#define MCI_MASKED_INTS_RE (0x1 << 1) /* RO */ +#define MCI_MASKED_INTS_CMD (0x1 << 2) /* RO */ +#define MCI_MASKED_INTS_DTO (0x1 << 3) /* RO */ +#define MCI_MASKED_INTS_TXDR (0x1 << 4) /* RO */ +#define MCI_MASKED_INTS_RXDR (0x1 << 5) /* RO */ +#define MCI_MASKED_INTS_RCRC (0x1 << 6) /* RO */ +#define MCI_MASKED_INTS_DCRC (0x1 << 7) /* RO */ +#define MCI_MASKED_INTS_RTO (0x1 << 8) /* RO */ +#define MCI_MASKED_INTS_DRTO (0x1 << 9) /* RO */ +#define MCI_MASKED_INTS_HTO (0x1 << 10) /* RO */ +#define MCI_MASKED_INTS_FRUN (0x1 << 11) /* RO */ +#define MCI_MASKED_INTS_HLE (0x1 << 12) /* RO */ +#define MCI_MASKED_INTS_SBE_BCI (0x1 << 13) /* RO */ +#define MCI_MASKED_INTS_ACD (0x1 << 14) /* RO */ +#define MCI_MASKED_INTS_EBE (0x1 << 15) /* RO */ +#define MCI_MASKED_INTS_SDIO (0x1 << 16) /* RO */ + +/* MCI_RAW_INTS mask */ +#define MCI_RAW_INTS_CD (0x1 << 0) /* W1C */ +#define MCI_RAW_INTS_RE (0x1 << 1) /* W1C */ +#define MCI_RAW_INTS_CMD (0x1 << 2) /* W1C */ +#define MCI_RAW_INTS_DTO (0x1 << 3) /* W1C */ +#define MCI_RAW_INTS_TXDR (0x1 << 4) /* W1C */ +#define MCI_RAW_INTS_RXDR (0x1 << 5) /* W1C */ +#define MCI_RAW_INTS_RCRC (0x1 << 6) /* W1C */ +#define MCI_RAW_INTS_DCRC (0x1 << 7) /* W1C */ +#define MCI_RAW_INTS_RTO (0x1 << 8) /* W1C */ +#define MCI_RAW_INTS_DRTO (0x1 << 9) /* W1C */ +#define MCI_RAW_INTS_HTO (0x1 << 10) /* W1C */ +#define MCI_RAW_INTS_FRUN (0x1 << 11) /* W1C */ +#define MCI_RAW_INTS_HLE (0x1 << 12) /* W1C */ +#define MCI_RAW_INTS_SBE_BCI (0x1 << 13) /* W1C */ +#define MCI_RAW_INTS_ACD (0x1 << 14) /* W1C */ +#define MCI_RAW_INTS_EBE (0x1 << 15) /* W1C */ +#define MCI_RAW_INTS_SDIO (0x1 << 16) /* W1C */ + +/* MCI_STATUS mask */ +#define MCI_STATUS_FIFO_RX (0x1 << 0) /* RO */ +#define MCI_STATUS_FIFO_TX (0x1 << 1) /* RO */ +#define MCI_STATUS_FIFO_EMPTY (0x1 << 2) /* RO */ +#define MCI_STATUS_FIFO_FULL (0x1 << 3) /* RO */ +#define MCI_STATUS_CARD_STATUS (0x1 << 8) /* RO */ +#define MCI_STATUS_CARD_BUSY (0x1 << 9) /* RO */ +#define MCI_STATUS_DATA_BUSY (0x1 << 10) /* RO */ +#define MCI_STATUS_RESPOSE_INDEX_OFFSET (11) +#define MCI_STATUS_RESPOSE_INDEX_MASK (0x3f << MCI_STATUS_RESPOSE_INDEX_OFFSET) /* RO */ +#define MCI_STATUS_RESPOSE_INDEX(reg) (((reg) & MCI_STATUS_RESPOSE_INDEX_MASK) >> MCI_STATUS_RESPOSE_INDEX_OFFSET) +#define MCI_STATUS_DMA_ACK (0x1 << 31) /* RO */ +#define MCI_STATUS_DMA_REQ (0x1 << 32) /* RO */ + +/* MCI_UHS_REG mask */ +#define MCI_UHS_REG_VOLT (0x1 << 0) /* RW */ +#define MCI_UHS_REG_DDR (0x1 << 16) /* RW */ + +/* MCI_CARD_RESET mask */ +#define MCI_CARD_RESET_ENABLE (0x1 << 0) /* RW */ + +/* MCI_BUS_MODE mask */ +#define MCI_BUS_MODE_SWR (0x1 << 0) /* RW */ +#define MCI_BUS_MODE_FB (0x1 << 1) /* RW */ +#define MCI_BUS_MODE_DE (0x1 << 7) /* RW */ + +/* MCI_DMAC_STATUS mask */ +#define MCI_DMAC_STATUS_TI (0x1 << 0) /* RW */ +#define MCI_DMAC_STATUS_RI (0x1 << 1) /* RW */ +#define MCI_DMAC_STATUS_FBE (0x1 << 2) /* RW */ +#define MCI_DMAC_STATUS_DU (0x1 << 4) /* RW */ +#define MCI_DMAC_STATUS_NIS (0x1 << 8) /* RW */ +#define MCI_DMAC_STATUS_AIS (0x1 << 9) /* RW */ + +/* MCI_DMAC_INT_ENA mask */ +#define MCI_DMAC_INT_ENA_TI (0x1 << 0) /* RW */ +#define MCI_DMAC_INT_ENA_RI (0x1 << 1) /* RW */ +#define MCI_DMAC_INT_ENA_FBE (0x1 << 2) /* RW */ +#define MCI_DMAC_INT_ENA_DU (0x1 << 4) /* RW */ +#define MCI_DMAC_INT_ENA_CES (0x1 << 5) /* RW */ +#define MCI_DMAC_INT_ENA_NIS (0x1 << 8) /* RW */ +#define MCI_DMAC_INT_ENA_AIS (0x1 << 9) /* RW */ + +/* MCI_CARD_THRCTL mask */ +#define MCI_CARD_THRCTL_CARDRD (0x1 << 0) /* RW */ +#define MCI_CARD_THRCTL_BUSY_CLR (0x1 << 1) /* RW */ +#define MCI_CARD_THRCTL_CARDWR (0x1 << 2) /* RW */ + +/* MCI_UHS_REG_EXT mask */ +#define MCI_UHS_REG_EXT_MMC_VOLT (0x1 << 0) /* RW */ +#define MCI_UHS_REG_EXT_CLK_ENA (0x1 << 1) /* RW */ + +/* MCI_EMMC_DDR_REG mask */ +#define MCI_EMMC_DDR_CYCLE (0x1 << 0) /* RW */ + +/*--------------------------------------*/ +/* Structure Type */ +/*--------------------------------------*/ +/* Maximum segments assuming a 512KiB maximum requisition */ +/* size and a minimum4KiB page size. */ +#define MCI_MAX_SEGS 128 +/* ADMA2 64-bit DMA descriptor size */ +#define ADMA2_64_DESC_SZ 32 + +/* mmc request timeout 5000ms */ +#define MMC_REQ_TIMEOUT_MS 5000 + +/* Each descriptor can transfer up to 4KB of data in chained mode */ +/*ADMA2 64-bit descriptor.*/ +struct phytium_adma2_64_desc { + u32 attribute; +#define IDMAC_DES0_DIC BIT(1) +#define IDMAC_DES0_LD BIT(2) +#define IDMAC_DES0_FD BIT(3) +#define IDMAC_DES0_CH BIT(4) +#define IDMAC_DES0_ER BIT(5) +#define IDMAC_DES0_CES BIT(30) +#define IDMAC_DES0_OWN BIT(31) + u32 NON1; + u32 len; + u32 NON2; + u32 addr_lo; /* Lower 32-bits of Buffer Address Pointer 1*/ + u32 addr_hi; /* Upper 32-bits of Buffer Address Pointer 1*/ + u32 desc_lo; /* Lower 32-bits of Next Descriptor Address */ + u32 desc_hi; /* Upper 32-bits of Next Descriptor Address */ +} __packed __aligned(4); + +struct phytium_mci_dma { + struct scatterlist *sg; /* I/O scatter list */ + /* ADMA descriptor table, pointer to adma_table array */ + struct phytium_adma2_64_desc *adma_table; + /* Mapped ADMA descr. table, the physical address of adma_table array */ + dma_addr_t adma_addr; + unsigned int desc_sz; /* ADMA descriptor size */ +}; + +enum adtc_t { + COMMOM_ADTC = 0, + BLOCK_RW_ADTC = 1 +}; + +struct phytium_mci_host { + struct device *dev; + struct mmc_host *mmc; + u32 caps; + u32 caps2; + spinlock_t lock; + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + int error; + void __iomem *base; /* host base address */ + void *adma_table1; + dma_addr_t adma_addr1; + struct phytium_mci_dma dma_rx; /* dma channel */ + struct phytium_mci_dma dma_tx; /* dma channel */ + struct phytium_mci_dma dma; /* dma channel */ + u64 dma_mask; + bool vqmmc_enabled; + u32 *sg_virt_addr; + enum adtc_t adtc_type; /* 0:common adtc cmd; 1:block r/w adtc cmd;*/ + struct timer_list hotplug_timer; + struct timer_list timeout_timer; + struct delayed_work req_timeout; + int irq; /* host interrupt */ + u32 current_rca; /*the current rca value*/ + u32 current_ios_clk; + u32 is_use_dma; + u32 is_device_x100; + struct clk *src_clk; /* phytium_mci source clock */ + unsigned long clk_rate; + unsigned long clk_div; + unsigned long irq_flags; + unsigned long flags; +#define MCI_CARD_NEED_INIT 1 + bool use_hold; /*use hold reg*/ + bool clk_set; /*clock set function enable*/ + s32 clk_smpl_drv_25m; /*25M clk smpl & drv*/ + s32 clk_smpl_drv_50m; /*50M clk smpl & drv*/ + s32 clk_smpl_drv_66m; /*66M clk smpl & drv*/ + s32 clk_smpl_drv_100m; /*100M clk smpl & drv*/ +}; + +int phytium_mci_common_probe(struct phytium_mci_host *host); +void phytium_mci_deinit_hw(struct phytium_mci_host *host); +int phytium_mci_runtime_suspend(struct device *dev); +int phytium_mci_runtime_resume(struct device *dev); +int phytium_mci_resume(struct device *dev); +int phytium_mci_suspend(struct device *dev); + +#endif /* __PHYTIUM_MCI_HW_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-sdci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-sdci.c new file mode 100644 index 0000000000000000000000000000000000000000..44379f5589c682f2a2cc1860939f0e054b4cddec --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-sdci.c @@ -0,0 +1,1439 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SDCI dirver + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + * + * 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 +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include +#include +#include + +#include "phytium-sdci.h" + +static const u32 cmd_ints_mask = SDCI_SDCI_NORMAL_ISER_ECC_EN | SDCI_SDCI_NORMAL_ISER_EEI_EN; +static const u32 data_ints_mask = SDCI_BD_ISER_ETRS_EN; +static const u32 err_ints_mask = SDCI_ERROR_ISER_ECTE_EN | SDCI_ERROR_ISR_CCRCE_EN | + SDCI_ERROR_ISR_CIR_EN | SDCI_ERROR_ISR_CNR_EN; + +static void hotplug_timer_func(struct timer_list *t); +static bool phytium_sdci_private_send_cmd(struct phytium_sdci_host *host, + u32 cmd, u32 resp_type, u32 arg); +static bool phytium_sdci_cmd_done(struct phytium_sdci_host *host, int events, + struct mmc_request *mrq, + struct mmc_command *cmd); +static bool phytium_sdci_data_xfer_done(struct phytium_sdci_host *host, + u32 events, struct mmc_request *mrq, + struct mmc_data *data); +static void phytium_sdci_cmd_next(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd); + +static int phytium_sdci_cmd13_process(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_data *data, + u32 wait_timeout_ms, + u32 send_once_time_ms); + +static int phytium_sd_error(struct phytium_sdci_host *host) +{ + int temp; + + temp = readl(host->base + SDCI_NORMAL_ISR); + dev_err(host->dev, "[%s %d]SDCI_NORMAL_ISR:%x\n", __func__, __LINE__, temp); + temp = readl(host->base + SDCI_BD_ISR); + temp = readl(host->base + SDCI_ERROR_ISR); + dev_err(host->dev, "[%s %d]SDCI_ERROR_ISR:%x\n", __func__, __LINE__, temp); + temp = readl(host->base + SDCI_BD_ISR); + dev_err(host->dev, "[%s %d]SDCI_BD_ISR:%x\n", __func__, __LINE__, temp); + temp = readl(host->base + SDCI_RESP0); + dev_err(host->dev, "[%s %d]SDCI_RESP0:%x\n", __func__, __LINE__, temp); + + return 0; +} + +static void sdr_set_bits(void __iomem *reg, u32 bs) +{ + u32 val; + + val = readl(reg); + val |= bs; + + writel(val, reg); +} + +static void sdr_clr_bits(void __iomem *reg, u32 bs) +{ + u32 val; + + val = readl(reg); + val &= ~bs; + + writel(val, reg); +} + +static void phytium_sdci_reset_hw(struct phytium_sdci_host *host) +{ + sdr_set_bits(host->base + SDCI_SOFTWARE, + SDCI_SOFTWARE_SRST); + sdr_clr_bits(host->base + SDCI_SOFTWARE, + SDCI_SOFTWARE_SRST); + while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) + cpu_relax(); +} + +static void phytium_sdci_prepare_data(struct phytium_sdci_host *host, + struct mmc_request *mrq) +{ + struct mmc_data *data = mrq->data; + bool read; + + read = (data->flags & MMC_DATA_READ) != 0; + data->sg_count = dma_map_sg(host->dev, data->sg, data->sg_len, + read ? DMA_FROM_DEVICE : DMA_TO_DEVICE); +} + +static void phytium_sdci_unprepare_data(struct phytium_sdci_host *host, + struct mmc_request *mrq) +{ + bool read; + struct mmc_data *data = mrq->data; + + read = (data->flags & MMC_DATA_READ) != 0; + dma_unmap_sg(host->dev, data->sg, data->sg_len, + read ? DMA_FROM_DEVICE : DMA_TO_DEVICE); +} + +static void phytium_sdci_set_clk(struct phytium_sdci_host *host, + struct mmc_ios *ios) +{ + unsigned long clk_rate; + u32 div = 0xffffffff, div_reg; + + if (ios->clock) { + clk_rate = host->clk_rate; + div = ((clk_rate / (2 * ios->clock)) - 1); + div_reg = readl(host->base + SDCI_CLOCK_D); + if (div_reg == div) + return; + writel(div, host->base + SDCI_CLOCK_D); + writel(0, host->base + SDCI_SD_DRV); + writel(5, host->base + SDCI_SD_SAMP); + + sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); + sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); + while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) + cpu_relax(); + dev_dbg(host->dev, "host->clk_rate: %ld, ios->clock: %d\n", + host->clk_rate, ios->clock); + } +} + + +static inline u32 phytium_sdci_cmd_find_resp(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + u32 resp; + + switch (mmc_resp_type(cmd)) { + case MMC_RSP_R1: + resp = 0x2; + break; + case MMC_RSP_R1B: + resp = 0x2; + break; + case MMC_RSP_R2: + resp = 0x1; + break; + case MMC_RSP_R3: + resp = 0x3; + break; + case MMC_RSP_NONE: + default: + resp = 0x0; + break; + } + + return resp; +} + +static inline u32 phytium_sdci_cmd_prepare_raw_cmd(struct phytium_sdci_host *host, + struct mmc_request *mrq, struct mmc_command *cmd) +{ + /* + * rawcmd : + * trty << 14 | opcode << 8 | cmdw << 6 | cice << 4 | crce << 3 | resp + */ + u32 resp, rawcmd; + u32 opcode = cmd->opcode; + + resp = phytium_sdci_cmd_find_resp(host, mrq, cmd); + rawcmd = ((opcode << 8) | resp); + + if ((cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC) + rawcmd = (rawcmd | (SDCI_CMD_TYPE_ADTC << 14)); + + return rawcmd; +} + +static void +phytium_sdci_unexpected_error_handler(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_data *data, + int err_type) +{ + unsigned long flags; + int error; + + spin_lock_irqsave(&host->lock, flags); + host->mrq = NULL; + host->cmd = NULL; + host->data = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + if (err_type & ERR_CARD_ABSENT) { + host->mmc->detect_change = 1; + dev_dbg(host->dev, "SD is absent when send cmd:%d\n", mrq->cmd->opcode); + } + + switch (err_type) { + case ERR_CARD_ABSENT: + error = -ENOMEDIUM; + break; + case ERR_TIMEOUT: + error = -ETIMEDOUT; + break; + case ERR_CMD_RESPONED: + error = -EIO; + break; + default: + error = -ETIMEDOUT; + break; + } + + if (data) { + data->error = error; + phytium_sdci_unprepare_data(host, mrq); + + if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || + (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) + phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_R, mrq, data); + } else { + mrq->cmd->error = error; + } + + mmc_request_done(host->mmc, mrq); +} + +static bool phytium_sdci_start_data(struct phytium_sdci_host *host, struct mmc_request *mrq, + struct mmc_command *cmd, struct mmc_data *data) +{ + bool read, res; + u32 sg_dma_addrh, sg_dma_addrl; + u32 sd_block_addrh, sd_block_addrl; + u32 temp, timeout, sd_status; + u32 block_cnt = 0; + u32 sd_block_addr = cmd->arg; + u32 private_cmd, resp_type, arg; + u32 j, dma_len; + unsigned long deadline_time; + dma_addr_t dma_address; + struct scatterlist *sg; + int ret; + + WARN_ON(host->cmd); + host->cmd = cmd; + + WARN_ON(host->data); + host->data = data; + read = data->flags & MMC_DATA_READ; + + for_each_sg(data->sg, sg, data->sg_count, j) { + writel(0, host->base + SDCI_COMMAND); + + dma_address = sg_dma_address(sg); + sg_dma_addrh = (u32) (dma_address >> 32); + sg_dma_addrl = (u32) dma_address; + + dma_len = sg_dma_len(sg); + block_cnt = (dma_len / SD_BLOCK_SIZE); + + sd_block_addrh = 0; + sd_block_addrl = sd_block_addr; + + sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_BDRST); + sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_BDRST); + writel(block_cnt, host->base + SDCI_BLK_CNT); + + if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { + writel(sg_dma_addrl, host->base + SDCI_BD_RX); + writel(sg_dma_addrh, host->base + SDCI_BD_RX); + writel(sd_block_addrl, host->base + SDCI_BD_RX); + writel(sd_block_addrh, host->base + SDCI_BD_RX); + timeout = 100 * block_cnt; + } else { + timeout = 250 * block_cnt; + ret = phytium_sdci_cmd13_process(host, mrq, data, timeout, 1); + if (ret != SDCI_CMD13_OK) + return false; + + writel(sg_dma_addrl, host->base + SDCI_BD_TX); + writel(sg_dma_addrh, host->base + SDCI_BD_TX); + writel(sd_block_addrl, host->base + SDCI_BD_TX); + writel(sd_block_addrh, host->base + SDCI_BD_TX); + } + + deadline_time = jiffies + msecs_to_jiffies(timeout); + + temp = readl(host->base + SDCI_BD_ISR); + if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { + while ((temp & SDCI_BD_ISR_TRS_R) != SDCI_BD_ISR_TRS_R) { + sd_status = readl(host->base + SDCI_STATUS); + if (sd_status & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CARD_ABSENT); + if (temp & SDCI_BD_ISR_DAIS) + writel(1, host->base + SDCI_BD_ISR); + return false; + } + + temp = readl(host->base + SDCI_BD_ISR); + if (time_after(jiffies, deadline_time)) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_TIMEOUT); + dev_err(host->dev, + "Read Data timeout:jiffies:0x%lx,dt_jiffies:0x%lx, BD_isr_reg:0x%x,cmd:%d, REG_D0:0x%x\n", + jiffies, jiffies - deadline_time, temp, + cmd->opcode, readl(host->base + SDCI_STATUS)); + + return false; + } + } + } else { + while ((temp & SDCI_BD_ISR_TRS_W) != SDCI_BD_ISR_TRS_W) { + sd_status = readl(host->base + SDCI_STATUS); + if (sd_status & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CARD_ABSENT); + dev_err(host->dev, "[%s][%d]: Card absent ! cmd(%d)\n", + __func__, __LINE__, mrq->cmd->opcode); + return false; + } + + temp = readl(host->base + SDCI_BD_ISR); + if (time_after(jiffies, deadline_time)) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_TIMEOUT); + dev_err(host->dev, + "Write Date timeout: jiffies:0x%lx,dt_jiffies:0x%lx,BD_isr_reg:0x%x\n", + jiffies, jiffies - deadline_time, temp); + return false; + } + } + } + writel(1, host->base + SDCI_BD_ISR); + writel(1, host->base + SDCI_NORMAL_ISR); + sd_block_addr = sd_block_addr + block_cnt; + + if (j < (data->sg_count - 1) && 1 < block_cnt) { + private_cmd = MMC_STOP_TRANSMISSION; + resp_type = 0x2; + arg = 0; + res = phytium_sdci_private_send_cmd(host, private_cmd, + resp_type, arg); + if (!res) { + sd_status = readl(host->base + SDCI_STATUS); + if (sd_status & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CARD_ABSENT); + writel(1, host->base + SDCI_BD_ISR); + dev_err(host->dev, + "[%s][%d]:Card absent ! private_cmd(%d)\n", + __func__, __LINE__, private_cmd); + } else { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CMD_RESPONED); + dev_err(host->dev, + "[%s][%d] cmd(%d) response errored\n", + __func__, __LINE__, mrq->cmd->opcode); + phytium_sd_error(host); + } + writel(1, host->base + SDCI_NORMAL_ISR); + return false; + } + writel(1, host->base + SDCI_NORMAL_ISR); + } + } + + host->is_multi_rw_only_one_blkcnt = false; + + if ((cmd->opcode == MMC_READ_MULTIPLE_BLOCK && block_cnt == 1) || + (cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK && block_cnt == 1)) + host->is_multi_rw_only_one_blkcnt = true; + + phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_CC, mrq, cmd); + if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) + phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_R, + mrq, data); + else + phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_TRS_W, + mrq, data); + + return true; +} + +static int phytium_sdci_auto_cmd_done(struct phytium_sdci_host *host, + int events, struct mmc_command *cmd) +{ + u32 *rsp = cmd->resp; + + rsp[0] = readl(host->base + SDCI_RESP0); + + if (events & SDCI_NORMAL_ISR_CC) + cmd->error = 0; + else { + phytium_sdci_reset_hw(host); + dev_err(host->dev, + "%s: AUTO_CMD%d arg=%08X; rsp %08X; cmd_error=%d\n", + __func__, cmd->opcode, cmd->arg, rsp[0], cmd->error); + } + + return cmd->error; +} + +static void phytium_sdci_track_cmd_data(struct phytium_sdci_host *host, + struct mmc_command *cmd, + struct mmc_data *data) +{ + if (host->error) + dev_dbg(host->dev, "%s: cmd=%d arg=%08X; host->error=0x%08X\n", + __func__, cmd->opcode, cmd->arg, host->error); +} + +static void phytium_sdci_request_done(struct phytium_sdci_host *host, + struct mmc_request *mrq) +{ + unsigned long flags; + + dev_dbg(host->dev, + "%s_%d:mrq->cmd->opcode:%d, mrq->cmd->arg:0x%x resp 0x%x 0x%x 0x%x 0x%x\n", + __func__, __LINE__, mrq->cmd->opcode, mrq->cmd->arg, + mrq->cmd->resp[0], mrq->cmd->resp[1], mrq->cmd->resp[2], + mrq->cmd->resp[3]); + + spin_lock_irqsave(&host->lock, flags); + host->mrq = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + phytium_sdci_track_cmd_data(host, mrq->cmd, mrq->data); + if (mrq->data && host->adtc_type != COMMOM_ADTC) + phytium_sdci_unprepare_data(host, mrq); + mmc_request_done(host->mmc, mrq); +} + +static bool +phytium_sdci_auto_command_done(struct phytium_sdci_host *host, int events, + struct mmc_request *mrq, struct mmc_command *cmd) +{ + u32 *rsp = cmd->resp; + unsigned long flags; + + spin_lock_irqsave(&host->lock, flags); + host->cmd = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + sdr_clr_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); + + rsp[0] = 0x900; + phytium_sdci_request_done(host, mrq); + return true; +} + +/* returns true if command is fully handled; returns false otherwise */ +static bool phytium_sdci_cmd_done(struct phytium_sdci_host *host, int events, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + bool done = false; + bool sbc_error; + unsigned long flags; + u32 *rsp = cmd->resp; + + if (mrq->sbc && cmd == mrq->cmd && + (events & SDCI_NORMAL_ISR_CC)) + phytium_sdci_auto_cmd_done(host, events, mrq->sbc); + + sbc_error = mrq->sbc && mrq->sbc->error; + + if (!sbc_error && !(events & (SDCI_NORMAL_ISR_CC | + SDCI_NORMAL_ISR_CR | + SDCI_NORMAL_ISR_TIMEOUT))) + return done; + + spin_lock_irqsave(&host->lock, flags); + done = !host->cmd; + host->cmd = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + if (done) + return true; + + sdr_clr_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); + + if (cmd->flags & MMC_RSP_PRESENT) { + if (cmd->flags & MMC_RSP_136) { + rsp[0] = readl(host->base + SDCI_RESP0); + rsp[1] = readl(host->base + SDCI_RESP1); + rsp[2] = readl(host->base + SDCI_RESP2); + rsp[3] = readl(host->base + SDCI_RESP3); + } else { + rsp[0] = readl(host->base + SDCI_RESP0); + } + + if (cmd->opcode == SD_SEND_RELATIVE_ADDR) + host->current_rca = rsp[0] & 0xFFFF0000; + } + + if (!sbc_error && + !(events & SDCI_NORMAL_ISR_CC) && + (events & SDCI_NORMAL_ISR_TIMEOUT)) + cmd->error = -ETIMEDOUT; + + if (cmd->error) + dev_dbg(host->dev, + "%s: cmd=%d arg=%08X; rsp %08X; cmd_error=%d\n", + __func__, cmd->opcode, cmd->arg, rsp[0], + cmd->error); + + phytium_sdci_cmd_next(host, mrq, cmd); + + return true; +} + +static bool set_databus_width(struct phytium_sdci_host *host) +{ + bool res; + u32 cmd, resp_type, arg; + + cmd = SD_APP_SET_BUS_WIDTH; + resp_type = 0x2; + arg = 0x2; + res = phytium_sdci_private_send_cmd(host, cmd, resp_type, arg); + if (!res) + return false; + + cmd = MMC_APP_CMD; + resp_type = 0x2; + arg = host->current_rca; + res = phytium_sdci_private_send_cmd(host, cmd, resp_type, arg); + if (!res) + return false; + + return true; +} + + +static void phytium_sdci_start_command(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + u32 rawcmd; + struct mmc_data *data = mrq->data; + dma_addr_t dma_adtc_buf; + u32 dma_bufh, dma_bufl; + u32 block_cnt = 0; + + WARN_ON(host->cmd); + host->cmd = cmd; + + cmd->error = 0; + rawcmd = phytium_sdci_cmd_prepare_raw_cmd(host, mrq, cmd); + if (cmd->opcode == MMC_STOP_TRANSMISSION || + cmd->opcode == MMC_SEND_STATUS) + writel(1, host->base + SDCI_ERROR_ISR); + sdr_set_bits(host->base + SDCI_NORMAL_ISER, cmd_ints_mask); + writel(rawcmd, host->base + SDCI_COMMAND); + + if ((cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC) { + WARN_ON(host->data); + host->data = data; + + dma_adtc_buf = host->dma_rx.bd_addr; + dma_bufh = (u32) (dma_adtc_buf >> 32); + dma_bufl = (u32) dma_adtc_buf; + block_cnt = mrq->data->blocks; + sdr_set_bits(host->base + SDCI_BD_ISER, data_ints_mask); + writel(block_cnt, host->base + SDCI_BLK_CNT); + + if ((mrq->data->flags & MMC_DATA_READ) == MMC_DATA_READ) { + writel(dma_bufl, host->base + SDCI_BD_RX); + writel(dma_bufh, host->base + SDCI_BD_RX); + writel(cmd->arg, host->base + SDCI_BD_RX); + writel(0, host->base + SDCI_BD_RX); + } else { + writel(dma_bufl, host->base + SDCI_BD_TX); + writel(dma_bufh, host->base + SDCI_BD_TX); + writel(cmd->arg, host->base + SDCI_BD_TX); + writel(0, host->base + SDCI_BD_TX); + } + } else { + writel(cmd->arg, host->base + SDCI_ARGUMENT); + } +} + +static void phytium_sdci_cmd_next(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_command *cmd) +{ + if (cmd->error || (mrq->sbc && mrq->sbc->error)) + phytium_sdci_request_done(host, mrq); + else if (cmd == mrq->sbc) + phytium_sdci_start_command(host, mrq, mrq->cmd); + else if (!cmd->data) + phytium_sdci_request_done(host, mrq); +} + +static int phytium_sdci_cmd13_process(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_data *data, + u32 wait_timeout_ms, + u32 send_once_time_ms) +{ + u32 private_cmd, resp_type, arg, temp, sd_status; + unsigned long deadline_time; + bool res; + + deadline_time = jiffies + msecs_to_jiffies(wait_timeout_ms); + + do { + private_cmd = MMC_SEND_STATUS; + resp_type = 0x2; + arg = host->current_rca; + + res = phytium_sdci_private_send_cmd(host, private_cmd, resp_type, arg); + if (!res) { + sd_status = readl(host->base + SDCI_STATUS); + if (sd_status & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CARD_ABSENT); + dev_err(host->dev, + "[%s][%d] Card absent! private_cmd(%d)\n", + __func__, __LINE__, private_cmd); + } else { + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_CMD_RESPONED); + + dev_err(host->dev, + "[%s][%d] private_cmd(%d) response errored\n", + __func__, __LINE__, private_cmd); + phytium_sd_error(host); + } + writel(1, host->base + SDCI_BD_ISR); + return SDCI_CMD13_FAILED; + } + + temp = readl(host->base + SDCI_RESP0); + + if (time_after(jiffies, deadline_time)) { + + if (mrq->cmd->opcode == MMC_SEND_STATUS) + return SDCI_CMD13_OK; + + dev_err(host->dev, + "SD card is not in transfer mode,timeout:%d,rsp[0]:%x\n", + wait_timeout_ms, temp); + + phytium_sdci_unexpected_error_handler(host, mrq, data, + ERR_TIMEOUT); + phytium_sd_error(host); + return SDCI_CMD13_FAILED; + } + + writel(1, host->base + SDCI_NORMAL_ISR); + + if (CARD_TRAN_STATE != (temp & CARD_CURRENT_STATE) && send_once_time_ms) + mdelay(send_once_time_ms); + + } while (CARD_TRAN_STATE != (temp & CARD_CURRENT_STATE)); + + return SDCI_CMD13_OK; +} + +static void phytium_sdci_ops_request(struct mmc_host *mmc, + struct mmc_request *mrq) +{ + struct phytium_sdci_host *host = mmc_priv(mmc); + unsigned long flags; + bool res; + u32 status_sd; + int res_cmd13; + + host->error = 0; + WARN_ON(host->mrq); + host->mrq = mrq; + + dev_dbg(host->dev, "%s: mrq->cmd->opcode:%d, mrq->cmd->arg:0x%x\n", + __func__, mrq->cmd->opcode, mrq->cmd->arg); + + if (mrq->cmd->opcode == MMC_SEND_STATUS && + (mrq->cmd->flags & MMC_CMD_MASK) != MMC_CMD_ADTC) { + u32 status = readl(host->base + SDCI_STATUS); + + if (status & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, NULL, + ERR_CARD_ABSENT); + return; + } + + res_cmd13 = phytium_sdci_cmd13_process(host, mrq, NULL, 400, 5); + if (res_cmd13 == SDCI_CMD13_FAILED) + return; + } else if (mrq->cmd->opcode == MMC_STOP_TRANSMISSION) { + status_sd = readl(host->base + SDCI_STATUS); + if (status_sd & SDCI_STATUS_CDSL) { + phytium_sdci_unexpected_error_handler(host, mrq, NULL, + ERR_CARD_ABSENT); + return; + } + } + + if (mrq->data) { + if (mrq->cmd->opcode == MMC_READ_MULTIPLE_BLOCK || + mrq->cmd->opcode == MMC_READ_SINGLE_BLOCK || + mrq->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK || + mrq->cmd->opcode == MMC_WRITE_BLOCK) { + host->adtc_type = BLOCK_RW_ADTC; + phytium_sdci_prepare_data(host, mrq); + phytium_sdci_start_data(host, mrq, + mrq->cmd, mrq->data); + return; + } + host->adtc_type = COMMOM_ADTC; + } + + if (mrq->cmd->opcode == SD_IO_RW_DIRECT || + mrq->cmd->opcode == SD_IO_SEND_OP_COND) { + spin_lock_irqsave(&host->lock, flags); + host->mrq = NULL; + host->cmd = NULL; + spin_unlock_irqrestore(&host->lock, flags); + mrq->cmd->error = -EINVAL; + mmc_request_done(host->mmc, mrq); + + return; + } + + if (mrq->cmd->opcode == SD_APP_SEND_SCR) { + res = set_databus_width(host); + if (!res) { + phytium_sdci_unexpected_error_handler(host, mrq, NULL, ERR_CMD_RESPONED); + return; + } + } + + /* if SBC is required, we have HW option and SW option. + * if HW option is enabled, and SBC does not have "special" flags, + * use HW option, otherwise use SW option + */ + if (mrq->sbc && + (!mmc_card_mmc(mmc->card) || (mrq->sbc->arg & 0xFFFF0000))) + phytium_sdci_start_command(host, mrq, mrq->sbc); + else + phytium_sdci_start_command(host, mrq, mrq->cmd); +} + +static void phytium_sdci_data_xfer_next(struct phytium_sdci_host *host, + struct mmc_request *mrq, + struct mmc_data *data) +{ + if (mmc_op_multi(mrq->cmd->opcode) && + mrq->stop && !mrq->stop->error && + !mrq->sbc && host->is_multi_rw_only_one_blkcnt) { + host->is_multi_rw_only_one_blkcnt = false; + phytium_sdci_auto_command_done(host, SDCI_NORMAL_ISR_CC, mrq, mrq->stop); + } else if (mmc_op_multi(mrq->cmd->opcode) && + mrq->stop && !mrq->stop->error && + !mrq->sbc) + phytium_sdci_start_command(host, mrq, mrq->stop); + else + phytium_sdci_request_done(host, mrq); +} + +static inline void get_data_buffer(struct mmc_data *data, + u32 *bytes, u32 **pointer) +{ + struct scatterlist *sg; + + sg = &data->sg[0]; + *bytes = sg->length; + *pointer = sg_virt(sg); +} + +static bool phytium_sdci_data_xfer_done(struct phytium_sdci_host *host, + u32 events, struct mmc_request *mrq, + struct mmc_data *data) +{ + struct mmc_command *stop = data->stop; + unsigned long flags; + bool done; + unsigned int check_data; + u32 sg_length, i; + u32 *sg_virt_addr; + + check_data = events & (SDCI_BD_ISR_TRS_R | SDCI_BD_ISR_TRS_W | SDCI_BD_ISR_EDTE); + + spin_lock_irqsave(&host->lock, flags); + done = !host->data; + if (check_data) + host->data = NULL; + spin_unlock_irqrestore(&host->lock, flags); + + if (done) + return true; + + if (check_data || (stop && stop->error)) { + sdr_clr_bits(host->base + SDCI_BD_ISER, data_ints_mask); + dev_dbg(host->dev, "DMA stop\n"); + + if (((events & SDCI_BD_ISR_TRS_R) || + (events & SDCI_BD_ISR_TRS_W)) && + (!stop || !stop->error)) { + if ((mrq->cmd->flags & MMC_CMD_MASK) == MMC_CMD_ADTC && + (host->adtc_type == COMMOM_ADTC)) { + get_data_buffer(data, &sg_length, + &host->sg_virt_addr); + sg_virt_addr = host->sg_virt_addr; + + for (i = 0; i < (sg_length/4); i++) { + *sg_virt_addr = host->dma_rx.buf[i]; + sg_virt_addr++; + } + } + data->bytes_xfered = data->blocks * data->blksz; + } else { + dev_dbg(host->dev, "interrupt events: %x\n", events); + phytium_sdci_reset_hw(host); + data->bytes_xfered = 0; + dev_dbg(host->dev, "%s: cmd=%d; blocks=%d", + __func__, mrq->cmd->opcode, data->blocks); + dev_dbg(host->dev, "data_error=%d xfer_size=%d\n", + (int)data->error, data->bytes_xfered); + } + + phytium_sdci_data_xfer_next(host, mrq, data); + done = true; + } + + return done; +} + + +__maybe_unused static int phytium_sdci_card_busy(struct mmc_host *mmc) +{ + struct phytium_sdci_host *host = mmc_priv(mmc); + u32 status; + + /* check if any pin between dat[0:3] is low */ + status = readl(host->base + SDCI_STATUS); + if (((status >> 20) & 0xf) != 0xf) + return 1; + + return 0; +} + +static void phytium_sdci_request_timeout(struct work_struct *work) +{ + struct phytium_sdci_host *host; + + host = container_of(work, struct phytium_sdci_host, req_timeout.work); + dev_err(host->dev, "%s: aborting cmd/data/mrq\n", __func__); + if (host->mrq) { + dev_err(host->dev, "%s: aborting mrq=%p cmd=%d\n", __func__, + host->mrq, host->mrq->cmd->opcode); + if (host->cmd) { + dev_err(host->dev, "%s: aborting cmd=%d\n", + __func__, host->cmd->opcode); + phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_TIMEOUT, + host->mrq, host->cmd); + } else if (host->data) { + dev_err(host->dev, "%s: abort data: cmd%d; %d blocks\n", + __func__, host->mrq->cmd->opcode, + host->data->blocks); + phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_EDTE, + host->mrq, host->data); + } + } +} + +static void hotplug_timer_func(struct timer_list *t) +{ + struct phytium_sdci_host *host; + u32 status; + + host = from_timer(host, t, hotplug_timer); + if (!host) + dev_err(host->dev, "%s: Not find host!\n", __func__); + status = readl(host->base + SDCI_STATUS); + + if (status & SDCI_STATUS_CDSL) { /* card absent */ + if (host->mmc->card) { + cancel_delayed_work(&host->mmc->detect); + mmc_detect_change(host->mmc, + msecs_to_jiffies(100)); + } + } else { /* card insert */ + cancel_delayed_work(&host->mmc->detect); + mmc_detect_change(host->mmc, msecs_to_jiffies(200)); + } +} + +static irqreturn_t phytium_sdci_irq(int irq, void *dev_id) +{ + struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; + unsigned long flags; + struct mmc_request *mrq; + struct mmc_command *cmd; + u32 events; + + if (!host) + return IRQ_NONE; + + spin_lock_irqsave(&host->lock, flags); + events = readl(host->base + SDCI_NORMAL_ISR); + /* clear interrupts */ + writel(1, host->base + SDCI_NORMAL_ISR); + + mrq = host->mrq; + cmd = host->cmd; + spin_unlock_irqrestore(&host->lock, flags); + + if (events & (SDCI_NORMAL_ISR_CR | SDCI_NORMAL_ISR_CI)) { + mod_timer(&host->hotplug_timer, + jiffies + usecs_to_jiffies(30000)); + goto irq_out; + } + + if (!(events & cmd_ints_mask)) + goto irq_out; + + if (!mrq) { + dev_err(host->dev, "%s: MRQ=NULL; events=%08X\n", + __func__, events); + WARN_ON(1); + goto irq_out; + } + + dev_dbg(host->dev, "%s: events=%08X\n", __func__, events); + + if (cmd) + phytium_sdci_cmd_done(host, events, mrq, cmd); + +irq_out: + return IRQ_HANDLED; +} + +static irqreturn_t phytium_sdci_dma_irq(int irq, void *dev_id) +{ + struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; + unsigned long flags; + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + u32 events; + + spin_lock_irqsave(&host->lock, flags); + events = readl(host->base + SDCI_BD_ISR); + writel(1, host->base + SDCI_BD_ISR); + + mrq = host->mrq; + cmd = host->cmd; + data = host->data; + spin_unlock_irqrestore(&host->lock, flags); + + if (!(events & data_ints_mask)) + goto dma_irq_out; + + if (!mrq) { + dev_err(host->dev, + "%s: MRQ=NULL; events=%08X\n", + __func__, events); + goto dma_irq_out; + } + + dev_dbg(host->dev, "%s: events=%08X\n", __func__, events); + + if (data) + phytium_sdci_data_xfer_done(host, events, mrq, data); + +dma_irq_out: + return IRQ_HANDLED; +} + +static irqreturn_t phytium_sdci_err_irq(int irq, void *dev_id) +{ + struct phytium_sdci_host *host = (struct phytium_sdci_host *) dev_id; + unsigned long flags; + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + u32 events; + + if (!host) + return IRQ_NONE; + + spin_lock_irqsave(&host->lock, flags); + events = readl(host->base + SDCI_ERROR_ISR); + mrq = host->mrq; + cmd = host->cmd; + data = host->data; + spin_unlock_irqrestore(&host->lock, flags); + + if (!(events&err_ints_mask)) + goto err_irq_out; + + if (!mrq) { + sdr_clr_bits(host->base + SDCI_NORMAL_ISER, SDCI_NORMAL_ISR_EI); + writel(1, host->base + SDCI_ERROR_ISR); + dev_err(host->dev, "%s: MRQ=NULL; events=%08X\n", __func__, events); + goto err_irq_out; + } + sdr_clr_bits(host->base + SDCI_NORMAL_ISER, SDCI_NORMAL_ISR_EI); + if (data) { + dev_err(host->dev, + "[%s][%d]: cmd(%d); %d read blocks, status:%x,flag:%x\n", + __func__, __LINE__, mrq->cmd->opcode, data->blocks, events, data->flags); + data->error = -ETIMEDOUT; + if ((data->flags & MMC_DATA_READ) == MMC_DATA_READ || + (data->flags & MMC_DATA_WRITE) == MMC_DATA_WRITE) + phytium_sdci_data_xfer_done(host, SDCI_BD_ISR_EDTE | SDCI_BD_ISR_TRS_R, + mrq, data); + mrq->cmd->error = -ETIMEDOUT; + mmc_request_done(host->mmc, mrq); + } else if (cmd) { + phytium_sdci_cmd_done(host, SDCI_NORMAL_ISR_TIMEOUT, mrq, cmd); + } + + writel(1, host->base + SDCI_NORMAL_ISR); + writel(1, host->base + SDCI_ERROR_ISR); +err_irq_out: + return IRQ_HANDLED; +} + +static void phytium_sdci_init_hw(struct phytium_sdci_host *host) +{ + u32 val; + + /* Reset */ + phytium_sdci_reset_hw(host); + + val = SDCI_SEN_CREFR_VAL | SDCI_SEN_DEBNCE_VAL; + writel(val, host->base + SDCI_SD_SEN); + + /* Disable and clear all interrupts */ + writel(0, host->base + SDCI_NORMAL_ISER); + writel(0, host->base + SDCI_ERROR_ISER); + writel(0, host->base + SDCI_BD_ISER); + + writel(1, host->base + SDCI_NORMAL_ISR); + writel(1, host->base + SDCI_ERROR_ISR); + writel(1, host->base + SDCI_BD_ISR); + + sdr_set_bits(host->base + SDCI_NORMAL_ISER, + SDCI_SDCI_NORMAL_ISER_ECI|SDCI_SDCI_NORMAL_ISER_ECR); + /* Configure default cmd timeout to 0.1(s)s = val/25M */ + val = SDCI_F_MAX / 10; + writel(val, host->base + SDCI_TIMEOUT_CMD); + writel(SDCI_TIMEOUT_DATA_VALUE, host->base + SDCI_TIMEOUT_DATA); + + val = 0x0F00; + writel(val, host->base + SDCI_CONTROLLER); + + dev_dbg(host->dev, "init hardware done!"); +} + +static void phytium_sdci_deinit_hw(struct phytium_sdci_host *host) +{ + /* Disable and clear all interrupts */ + writel(0, host->base + SDCI_NORMAL_ISER); + writel(0, host->base + SDCI_ERROR_ISER); + writel(0, host->base + SDCI_BD_ISER); + + writel(0, host->base + SDCI_NORMAL_ISR); + writel(0, host->base + SDCI_ERROR_ISR); + writel(0, host->base + SDCI_BD_ISR); +} + +static void phytium_sdci_ops_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) +{ + struct phytium_sdci_host *host = mmc_priv(mmc); + + if (ios->bus_width == MMC_BUS_WIDTH_4) + mmc->caps = mmc->caps & (~MMC_CAP_4_BIT_DATA); + + /* Suspend/Resume will do power off/on */ + switch (ios->power_mode) { + case MMC_POWER_UP: + writel(SDCI_POWER_ON, host->base + SDCI_POWER); + break; + case MMC_POWER_ON: + phytium_sdci_set_clk(host, ios); + break; + case MMC_POWER_OFF: + writel(SDCI_POWER_OFF, host->base + SDCI_POWER); + break; + default: + break; + } +} + +static int phytium_sdci_get_cd(struct mmc_host *mmc) +{ + struct phytium_sdci_host *host = mmc_priv(mmc); + u32 status = readl(host->base + SDCI_STATUS); + + if (((status >> 19) & 0x1) == 0x1) + return 0; + + return 1; +} + +static void phytium_sdci_hw_reset(struct mmc_host *mmc) +{ + struct phytium_sdci_host *host = mmc_priv(mmc); + + sdr_set_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); + sdr_clr_bits(host->base + SDCI_SOFTWARE, SDCI_SOFTWARE_SRST); + while (!(readl(host->base + SDCI_STATUS) & SDCI_STATUS_IDIE)) + cpu_relax(); +} + +static struct mmc_host_ops phytium_sdci_ops = { + .request = phytium_sdci_ops_request, + .set_ios = phytium_sdci_ops_set_ios, + .get_cd = phytium_sdci_get_cd, + .card_hw_reset = phytium_sdci_hw_reset, +}; + +static bool phytium_sdci_private_send_cmd(struct phytium_sdci_host *host, + u32 cmd, u32 resp_type, u32 arg) +{ + u32 temp, sd_cmd, sd_arg, sd_status; + unsigned long deadline_time; + + writel(1, host->base + SDCI_NORMAL_ISR); + writel(1, host->base + SDCI_ERROR_ISR); + + sd_cmd = (cmd << 8) | resp_type; + sd_arg = arg; + writel(sd_cmd, host->base + SDCI_COMMAND); + writel(sd_arg, host->base + SDCI_ARGUMENT); + + if (cmd == MMC_STOP_TRANSMISSION) + deadline_time = jiffies + msecs_to_jiffies(1000); + else + deadline_time = jiffies + msecs_to_jiffies(100); + + temp = readl(host->base + SDCI_NORMAL_ISR); + while ((temp & SDCI_NORMAL_ISR_CC) != SDCI_NORMAL_ISR_CC) { + sd_status = readl(host->base + SDCI_STATUS); + if (sd_status & SDCI_STATUS_CDSL) + return false; + + temp = readl(host->base + SDCI_NORMAL_ISR); + if (time_after(jiffies, deadline_time)) + return false; + + if (cmd == MMC_STOP_TRANSMISSION) + mdelay(1); + } + + return true; +} + +static int phytium_sdci_probe(struct platform_device *pdev) +{ + struct mmc_host *mmc; + struct phytium_sdci_host *host; + struct resource *res; + int ret; + const struct acpi_device_id *match; + struct device *dev = &pdev->dev; + + /* Allocate MMC host for this device */ + mmc = mmc_alloc_host(sizeof(struct phytium_sdci_host), &pdev->dev); + if (!mmc) + return -ENOMEM; + + host = mmc_priv(mmc); + ret = mmc_of_parse(mmc); + if (ret) + goto host_free; + + if (dev->of_node) { + host->src_clk = devm_clk_get(&pdev->dev, "phytium_sdc_clk"); + if (IS_ERR(host->src_clk)) { + ret = PTR_ERR(host->src_clk); + goto host_free; + } + + host->clk_rate = clk_get_rate(host->src_clk); + if (device_property_read_bool(dev, "no-dma-coherent")) + dev->dma_coherent = false; + } else if (has_acpi_companion(dev)) { + match = acpi_match_device(dev->driver->acpi_match_table, dev); + if (!match) { + dev_err(dev, "Error ACPI match data is missing\n"); + return -ENODEV; + } + + acpi_dma_configure(dev, DEV_DMA_NON_COHERENT); + + host->clk_rate = 600000000; + } else { + dev_err(&pdev->dev, "No DT found\n"); + return -EINVAL; + } + + dma_set_mask(dev, DMA_BIT_MASK(40)); + dma_set_coherent_mask(dev, DMA_BIT_MASK(40)); + + timer_setup(&host->hotplug_timer, hotplug_timer_func, 0); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + host->base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(host->base)) { + ret = PTR_ERR(host->base); + goto host_free; + } + + host->irq = platform_get_irq(pdev, 1); + if (host->irq < 0) { + ret = -EINVAL; + goto host_free; + } + + host->irq_err = platform_get_irq(pdev, 2); + if (host->irq_err < 0) { + ret = -EINVAL; + goto host_free; + } + + host->irq_bd = platform_get_irq(pdev, 0); + if (host->irq_bd < 0) { + ret = -EINVAL; + goto host_free; + } + + host->dev = &pdev->dev; + host->mmc = mmc; + + if ((4 * SDCI_F_MAX) > host->clk_rate) + host->clk_div = 1; + else + host->clk_div = ((host->clk_rate / (2 * SDCI_F_MAX)) - 1); + + /* Set host parameters to mmc */ + mmc->f_min = SDCI_F_MIN; + mmc->f_max = (host->clk_rate / ((host->clk_div + 1) * 2)); + mmc->ops = &phytium_sdci_ops; + mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; + + mmc->caps |= host->caps; + /* MMC core transfer sizes tunable parameters */ + mmc->max_segs = MAX_BD_NUM; + mmc->max_seg_size = 512 * 1024; + mmc->max_blk_size = 512; + mmc->max_req_size = 512 * 1024; + mmc->max_blk_count = mmc->max_req_size / 512; + + host->dma_rx.buf = dma_alloc_coherent(&pdev->dev, + MAX_BD_NUM, + &host->dma_rx.bd_addr, + GFP_KERNEL); + if (!host->dma_rx.buf) { + ret = -ENOMEM; + goto release_mem; + } + + host->cmd_timeout = msecs_to_jiffies(100); + host->data_timeout = msecs_to_jiffies(250); + + INIT_DELAYED_WORK(&host->req_timeout, phytium_sdci_request_timeout); + spin_lock_init(&host->lock); + + platform_set_drvdata(pdev, mmc); + phytium_sdci_init_hw(host); + + ret = devm_request_irq(&pdev->dev, host->irq, phytium_sdci_irq, + IRQF_SHARED, pdev->name, host); + if (ret) + goto release; + + ret = devm_request_irq(&pdev->dev, host->irq_err, phytium_sdci_err_irq, + IRQF_SHARED, pdev->name, host); + if (ret) + goto release; + + ret = devm_request_irq(&pdev->dev, host->irq_bd, phytium_sdci_dma_irq, + IRQF_SHARED, pdev->name, host); + if (ret) + goto release; + + ret = mmc_add_host(mmc); + if (ret) + goto release; + + return 0; + +release: + platform_set_drvdata(pdev, NULL); + phytium_sdci_deinit_hw(host); +release_mem: + if (host->dma_rx.buf) + dma_free_coherent(&pdev->dev, MAX_BD_NUM, + host->dma_rx.buf, + host->dma_rx.bd_addr); +host_free: + mmc_free_host(mmc); + + return ret; +} + +static int phytium_sdci_remove(struct platform_device *pdev) +{ + struct mmc_host *mmc; + struct phytium_sdci_host *host; + + mmc = platform_get_drvdata(pdev); + host = mmc_priv(mmc); + + cancel_delayed_work_sync(&host->req_timeout); + platform_set_drvdata(pdev, NULL); + mmc_remove_host(host->mmc); + phytium_sdci_deinit_hw(host); + + if (host->dma_rx.buf) + dma_free_coherent(&pdev->dev, MAX_BD_NUM, + host->dma_rx.buf, host->dma_rx.bd_addr); + + mmc_free_host(host->mmc); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_sdci_suspend(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_sdci_host *host = mmc_priv(mmc); + + phytium_sdci_deinit_hw(host); + return 0; +} + +static int phytium_sdci_resume(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_sdci_host *host = mmc_priv(mmc); + + phytium_sdci_init_hw(host); + mmc->caps = mmc->caps | MMC_CAP_4_BIT_DATA; + + return 0; +} +#endif + +#ifdef CONFIG_PM +static int phytium_sdci_runtime_suspend(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_sdci_host *host = mmc_priv(mmc); + + phytium_sdci_deinit_hw(host); + + return 0; +} + +static int phytium_sdci_runtime_resume(struct device *dev) +{ + struct mmc_host *mmc = dev_get_drvdata(dev); + struct phytium_sdci_host *host = mmc_priv(mmc); + + phytium_sdci_init_hw(host); + + return 0; +} + +static const struct dev_pm_ops phytium_sdci_dev_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_sdci_suspend, + phytium_sdci_resume) + SET_RUNTIME_PM_OPS(phytium_sdci_runtime_suspend, + phytium_sdci_runtime_resume, NULL) +}; +#else +#define phytium_sdci_dev_pm_ops NULL +#endif + +static const struct of_device_id phytium_sdci_of_ids[] = { + { .compatible = "phytium,sdci", }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_sdci_of_ids); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_sdci_acpi_ids[] = { + { .id = "PHYT0005" }, + { } +}; + +MODULE_DEVICE_TABLE(acpi, phytium_sdci_acpi_ids); +#else +#define phytium_sdci_acpi_ids NULL +#endif + +static struct platform_driver phytium_sdci_driver = { + .probe = phytium_sdci_probe, + .remove = phytium_sdci_remove, + .driver = { + .name = "sdci-phytium", + .of_match_table = phytium_sdci_of_ids, + .acpi_match_table = phytium_sdci_acpi_ids, + .pm = &phytium_sdci_dev_pm_ops, + }, +}; + +module_platform_driver(phytium_sdci_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Cheng Quan "); +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium SD Card Interface driver"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-sdci.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-sdci.h new file mode 100644 index 0000000000000000000000000000000000000000..87ee37235c9c065ff7ce773e15c945db6f14de04 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mmc/host/phytium-sdci.h @@ -0,0 +1,200 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium SDCI dirver + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + */ + +/*---------------------------------------------------------------------------*/ +/* Common Definition */ +/*---------------------------------------------------------------------------*/ +#define MAX_BD_NUM 0x1000 +#define SD_BLOCK_SIZE 512 + +/*---------------------------------------------------------------------------*/ +/* Register Offset */ +/*---------------------------------------------------------------------------*/ +#define SDCI_CONTROLLER 0x00 /* controller config reg */ +#define SDCI_ARGUMENT 0x04 /* argument reg */ +#define SDCI_COMMAND 0x08 /* command reg */ +#define SDCI_CLOCK_D 0x0C /* clock divide reg */ +#define SDCI_SOFTWARE 0x10 /* controller reset reg */ +#define SDCI_POWER 0X14 /* POWRE CONTROL REG */ +#define SDCI_TIMEOUT_CMD 0x18 /* cmd timeout config reg */ +#define SDCI_TIMEOUT_DATA 0x1C /* data timeout reg */ +#define SDCI_NORMAL_ISER 0x20 /* normal ISR config reg */ +#define SDCI_ERROR_ISER 0x24 /* erroe ISR config reg */ +#define SDCI_BD_ISER 0x28 /* BD ISR config reg */ +#define SDCI_CAPA 0x2C /* BD ISR config reg */ +#define SDCI_SD_DRV 0x30 /* SD card driving phase position reg */ +#define SDCI_SD_SAMP 0x34 /* SD card sampling phase position reg */ +#define SDCI_SD_SEN 0x38 /* SD card detection reg */ +#define SDCI_HDS_AXI 0x3C /* AXI boundary config reg */ +#define SDCI_BD_RX 0x40 /* BD rx addr reg */ +#define SDCI_BD_TX 0x60 /* BD tx addr reg */ +#define SDCI_BLK_CNT 0x80 /* r/w block num reg */ +#define SDCI_NORMAL_ISR 0xC0 /* normal ISR status reg */ +#define SDCI_ERROR_ISR 0xC4 /* error ISR status reg */ +#define SDCI_BD_ISR 0xC8 /* BD ISR status reg */ +#define SDCI_BD_STATUS 0xCC /* BD descriptor status reg */ +#define SDCI_STATUS 0xD0 /* status reg */ +#define SDCI_BLOCK 0xD4 /* block len reg */ +#define SDCI_RESP0 0xE0 /* response reg0 */ +#define SDCI_RESP1 0xE4 /* response reg1 */ +#define SDCI_RESP2 0xE8 /* response reg2 */ +#define SDCI_RESP3 0XEC /* response reg3 */ + +/*---------------------------------------------------------------------------*/ +/* Register Mask */ +/*---------------------------------------------------------------------------*/ +/* SDCI_CONTROLLER mask */ +#define SDCI_CONTROLLER_ECRCWR (0x1 << 0) /* RW */ +#define SDCI_CONTROLLER_ECRCRD (0x1 << 1) /* RW */ +#define SDCI_CONTROLLER_RESEDE (0x1 << 2) /* RW */ +#define SDCI_CONTROLLER_PERMDR (0x3 << 8) /* RW */ +#define SDCI_CONTROLLER_PERMDX (0x3 << 10) /* RW */ + +/* SDCI_SOFTWARE mask */ +#define SDCI_SOFTWARE_SRST (0x1 << 0) /* RW */ +#define SDCI_SOFTWARE_SCRST (0x1 << 1) /* RW */ +#define SDCI_SOFTWARE_BDRST (0x1 << 2) /* RW */ +#define SDCI_SOFTWARE_CFCLF (0x1 << 3) /* RW */ +#define SDCI_SOFTWARE_SDRST (0x1 << 4) /* RW */ + +/* SDCI_NORMAL_ISER mask */ +#define SDCI_SDCI_NORMAL_ISER_ECC_EN (0x1 << 0) /* RW */ +#define SDCI_SDCI_NORMAL_ISER_ECR (0x1 << 1) /* RW */ +#define SDCI_SDCI_NORMAL_ISER_ECI (0x1 << 2) /* RW */ +#define SDCI_SDCI_NORMAL_ISER_EEI_EN (0x1 << 15) /* RW */ + +/* SDCI_NORMAL_ISR mask */ +#define SDCI_NORMAL_ISR_CC (0x1 << 0) /* R */ +#define SDCI_NORMAL_ISR_CR (0x1 << 1) /* R */ +#define SDCI_NORMAL_ISR_CI (0x1 << 2) /* R */ +#define SDCI_NORMAL_ISR_TIMEOUT (0x1 << 3) /* R */ +#define SDCI_NORMAL_ISR_EI (0x1 << 15) /* R */ + +/* SDCI_ERROR_ISER mask */ +#define SDCI_ERROR_ISER_ECTE_EN (0x1 << 0) /* RW */ +#define SDCI_ERROR_ISR_CCRCE_EN (0x1 << 1) /* RW */ +#define SDCI_ERROR_ISR_CIR_EN (0x1 << 3) /* RW */ +#define SDCI_ERROR_ISR_CNR_EN (0x1 << 4) /* RW */ +/* SDCI_ERROR_ISR mask */ +#define SDCI_ERROR_ISR_CTE (0x1 << 0) /* R */ +#define SDCI_ERROR_ISR_CCRCE (0x1 << 1) /* R */ +#define SDCI_ERROR_ISR_CIR (0x1 << 3) /* R */ +#define SDCI_ERROR_ISR_CNR (0x1 << 4) /* R */ + +/* SDCI_BD_ISER mask */ +#define SDCI_BD_ISER_ETRS_EN (0x1 << 8) /* RW */ +#define SDCI_BD_ISER_DATFRAX_EN (0x1 << 7) /* RW */ + +/* SDCI_BD_ISR mask */ +#define SDCI_BD_ISR_TRS_W (0x1 << 0) /* R */ +#define SDCI_BD_ISR_TRS_R (0x1 << 8) /* R */ +#define SDCI_BD_ISR_EDTE (0x1 << 3) /* R */ +#define SDCI_BD_ISR_DAIS (0x1 << 15) /* R */ +#define SDCI_BD_ISR_DATFRAX (0x1 << 7) /* R */ + +/* SDCI_HDS_AXI mask */ +#define SDCI_HDS_AXI_AWDOMAIN (0x1 << 0) /* RW */ +#define SDCI_HDS_AXI_ARDOMAIN (0x1 << 12) /* RW */ +#define SDCI_HDS_AXI_AWCACHE (0x6 << 24) /* RW */ +#define SDCI_HDS_AXI_ARCACHE (0xB << 28) /* RW */ + +/* SDCI_STATUS mask */ +#define SDCI_STATUS_CMD_BUSY (0x0 << 0) /* R */ +#define SDCI_STATUS_CMD_READY (0x1 << 0) /* R */ +#define SDCI_STATUS_IDIE (0x1 << 12) /* R */ +#define SDCI_CARD_BUSY_IN_PRG (0x1 << 20) /* R D0 BUSY:0,IDLE:1 */ + +/* SDCI_STATUS */ +#define SDCI_STATUS_CDSL (0x1 << 19) /* R */ + +/*---------------------------------------------------------------------------*/ +/* Register Value */ +/*---------------------------------------------------------------------------*/ +#define SDCI_SD_DRV_VALUE 0 +#define SDCI_SD_SAMP_VALUE_MAX 50 +#define SDCI_SD_SAMP_VALUE_MIN 0 + +#define SDCI_TIMEOUT_CMD_VALUE 0xFFFFFFFF +#define SDCI_TIMEOUT_DATA_VALUE 0xFFFFFFFF +#define SDCI_POWER_ON 1 +#define SDCI_POWER_OFF 0 + +#define SDCI_CMD_TIMEOUT 10 +#define SDCI_DAT_TIMEOUT 5000 + +#define SDCI_CMD_TYPE_ADTC 0x2 + +#define SDCI_F_MIN 400000 +#define SDCI_F_MAX 25000000 + +#define SDCI_SEN_CREFR_VAL (0x1 << 1) +#define SDCI_SEN_DEBNCE_VAL (0xB << 8) + +#define CARD_CURRENT_STATE (0xF << 9) +#define CARD_PRG_STATE (0x7 << 9) +#define CARD_TRAN_STATE (0x4 << 9) + +#define SDCI_CMD13_OK 1 +#define SDCI_CMD13_FAILED 0 + +#define ERR_TIMEOUT (0x1 << 0) +#define ERR_CARD_ABSENT (0x1 << 1) +#define ERR_CMD_RESPONED (0x1 << 2) + +/*---------------------------------------------------------------------------*/ +/* Structure Type */ +/*---------------------------------------------------------------------------*/ +struct phytium_sdci_dma { + struct scatterlist *sg; + u32 *buf; + dma_addr_t bd_addr; + size_t bytes; +}; + +enum adtc_type { + COMMOM_ADTC = 0, + BLOCK_RW_ADTC = 1 +}; + +struct phytium_sdci_host { + struct device *dev; + struct mmc_host *mmc; + u32 caps; + spinlock_t lock; + + struct mmc_request *mrq; + struct mmc_command *cmd; + struct mmc_data *data; + int error; + + void __iomem *base; + + struct phytium_sdci_dma dma_rx; + struct phytium_sdci_dma dma_tx; + + u32 *sg_virt_addr; + enum adtc_type adtc_type; + + struct timer_list hotplug_timer; + + struct delayed_work req_timeout; + u32 cmd_timeout; + u32 data_timeout; + + int irq; + int irq_err; + int irq_bd; + + struct clk *src_clk; + unsigned long clk_rate; + unsigned long clk_div; + unsigned long real_rate; + + u32 current_rca; + bool is_multi_rw_only_one_blkcnt; +}; + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..6be02bc9739c64e7a05c7cd5de26403db351b58a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/Makefile @@ -0,0 +1 @@ +obj-y += raw/ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..522662b15edaa10ed175772bc9df6fbeebef5230 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/Kconfig @@ -0,0 +1,20 @@ +config MTD_NAND_PHYTIUM + tristate + +config MTD_NAND_PHYTIUM_PCI + tristate "Support Phytium NAND controller as a PCI device" + select MTD_NAND_PHYTIUM + depends on PCI + help + Enable the driver for NAND flash controller of Phytium Px210 chipset, + using the Phytium NAND controller core. + +config MTD_NAND_PHYTIUM_PLAT + tristate "Support Phytium NAND controller as a platform device" + select MTD_NAND_PHYTIUM + depends on ARCH_PHYTIUM + help + Enable the driver for NAND flash controller of Phytium CPU chipset, + using the Phytium NAND controller core. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..77ecd2beb72f440e5cdd00500f542137edf69946 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/Makefile @@ -0,0 +1,4 @@ +obj-$(CONFIG_MTD_NAND_PHYTIUM) += phytium_nand.o +obj-$(CONFIG_MTD_NAND_PHYTIUM_PCI) += phytium_nand_pci.o +obj-$(CONFIG_MTD_NAND_PHYTIUM_PLAT) += phytium_nand_plat.o + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand.c new file mode 100644 index 0000000000000000000000000000000000000000..2763455f3739bba4188e5fafeeeae61b8f2b61a3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand.c @@ -0,0 +1,2089 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Core driver for Phytium NAND flash controller + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "phytium_nand.h" + +u16 timing_asy_mode0[TIMING_ASY_NUM] = { /* x100 pass, sample: 1 */ + 0x03, 0x03, 0x28, 0x28, 0x03, 0x03, 0x06, 0x06, 0x28, 0x70, 0x30, 0x50}; +u16 timing_asy_mode1[TIMING_ASY_NUM] = { /* x100 pass, sample: 1 */ + 0x03, 0x03, 0x14, 0x14, 0x03, 0x03, 0x06, 0x06, 0x14, 0x70, 0x30, 0x28}; +u16 timing_asy_mode2[TIMING_ASY_NUM] = { /* x100 pass, sample: 7/8 (unlic) */ + 0x03, 0x03, 0x0D, 0x0D, 0x03, 0x03, 0x06, 0x06, 0x0D, 0x70, 0x20, 0x1A}; +u16 timing_asy_mode3[TIMING_ASY_NUM] = { /* x100 pass, sample: 4-7 */ + 0x03, 0x03, 0x0A, 0x0A, 0x03, 0x03, 0x06, 0x06, 0x0A, 0x70, 0x20, 0x14}; +u16 timing_asy_mode4[TIMING_ASY_NUM] = { /* x100 1.8v pass */ + 0x03, 0x03, 0x08, 0x08, 0x03, 0x03, 0x06, 0x06, 0x08, 0x70, 0x15, 0x10}; +u16 timing_asy_mode5[TIMING_ASY_NUM] = { /* x100 1.8v pass */ + 0x03, 0x03, 0x07, 0x07, 0x03, 0x03, 0x06, 0x06, 0x07, 0x20, 0x15, 0x0E}; +u16 timing_syn_mode0[TIMING_SYN_NUM] = { /* x100 1.8v pass */ + 0x20, 0x41, 0x05, 0x20, 0x10, 0x19, 0x62, 0x40, 0x38, 0x20, 0x00, 0x09, + 0x50, 0x20}; +u16 timing_syn_mode1[TIMING_SYN_NUM] = { /* x100 1.8v pass */ + 0x18, 0x32, 0x06, 0x18, 0x0C, 0x10, 0x76, 0x40, 0x2A, 0x1E, 0x00, 0x12, + 0x24, 0x18}; +u16 timing_syn_mode2[TIMING_SYN_NUM] = { /* x100 1.8v pass */ + 0x10, 0x0A, 0x04, 0x10, 0x08, 0x0A, 0x6E, 0x50, 0x1D, 0x10, 0x00, 0x0C, + 0x18, 0x10}; +u16 timing_syn_mode3[TIMING_SYN_NUM] = { /* x100 1.8v pass */ + 0x0C, 0x1A, 0x02, 0x0C, 0x06, 0x08, 0x78, 0x7C, 0x15, 0x0C, 0x00, 0x08, + 0x12, 0x0C}; +u16 timing_syn_mode4[TIMING_SYN_NUM] = { /* x100 1.8v failed */ + 0x08, 0x17, 0x05, 0x08, 0x04, 0x01, 0x73, 0x40, 0x0C, 0x08, 0x00, 0x06, + 0x0C, 0x10}; +u16 timing_tog_ddr_mode0[TIMING_TOG_NUM] = { /* 600M clk */ + 0x14, 0x0a, 0x08, 0x08, 0xc8, 0xc8, 0x08, 0x08, 0x20, 0x0a, 0x14, 0x08}; + +static u32 nfc_ecc_errover; +static u32 nfc_ecc_err; +static u32 nfc_irq_st; +static u32 nfc_irq_en; +static u32 nfc_irq_complete; + +static DECLARE_WAIT_QUEUE_HEAD(wait_done); + +/* + * Internal helper to conditionnally apply a delay (from the above structure, + * most of the time). + */ +static void cond_delay(unsigned int ns) +{ + if (!ns) + return; + + if (ns < 10000) + ndelay(ns); + else + udelay(DIV_ROUND_UP(ns, 1000)); +} + +static inline struct phytium_nfc *to_phytium_nfc(struct nand_controller *ctrl) +{ + return container_of(ctrl, struct phytium_nfc, controller); +} + +static inline struct phytium_nand_chip *to_phytium_nand(struct nand_chip *chip) +{ + return container_of(chip, struct phytium_nand_chip, chip); +} + +static u32 phytium_read(struct phytium_nfc *nfc, u32 reg) +{ + return readl_relaxed(nfc->regs + reg); +} + +static void phytium_write(struct phytium_nfc *nfc, u32 reg, u32 value) +{ + return writel_relaxed(value, nfc->regs + reg); +} + +static inline int phytium_wait_busy(struct phytium_nfc *nfc) +{ + u32 status; + + if (nfc_ecc_errover) { + nfc_ecc_errover = 0; + return 0; + } + + return readl_relaxed_poll_timeout(nfc->regs + NDSR, status, + !(status & NDSR_BUSY), 10, 10000); +} + +static void phytium_nfc_disable_int(struct phytium_nfc *nfc, u32 int_mask) +{ + u32 reg; + + reg = phytium_read(nfc, NDIR_MASK); + phytium_write(nfc, NDIR_MASK, reg | int_mask); +} + +static void phytium_nfc_enable_int(struct phytium_nfc *nfc, u32 int_mask) +{ + u32 reg; + + reg = phytium_read(nfc, NDIR_MASK); + phytium_write(nfc, NDIR_MASK, reg & (~int_mask)); +} + +static void phytium_nfc_clear_int(struct phytium_nfc *nfc, u32 int_mask) +{ + phytium_write(nfc, NDIR_MASK, int_mask); +} + +static int phytium_nfc_cmd_correct(struct phytium_nfc_op *nfc_op) +{ + if (!nfc_op) + return -EINVAL; + + if (nfc_op->cmd_len == 0x01) { + nfc_op->cmd[1] = nfc_op->cmd[0]; + nfc_op->cmd[0] = 0; + } + + return 0; +} + +static int phytium_nfc_addr_correct(struct phytium_nfc_op *nfc_op) +{ + u32 len; + int i, j; + + if (!nfc_op) + return -EINVAL; + + len = nfc_op->addr_len > PHYTIUM_NFC_ADDR_MAX_LEN ? + PHYTIUM_NFC_ADDR_MAX_LEN : nfc_op->addr_len; + + if (len == PHYTIUM_NFC_ADDR_MAX_LEN) + return 0; + + for (i = len-1, j = PHYTIUM_NFC_ADDR_MAX_LEN - 1; i >= 0; i--, j--) { + nfc_op->addr[j] = nfc_op->addr[i]; + nfc_op->addr[i] = 0; + } + + return 0; +} + +static void phytium_nfc_parse_instructions(struct nand_chip *chip, + const struct nand_subop *subop, + struct phytium_nfc_op *nfc_op) +{ + struct nand_op_instr *instr = NULL; + bool first_cmd = true; + u32 op_id; + int i; + + /* Reset the input structure as most of its fields will be OR'ed */ + memset(nfc_op, 0, sizeof(struct phytium_nfc_op)); + + for (op_id = 0; op_id < subop->ninstrs; op_id++) { + unsigned int offset, naddrs; + const u8 *addrs; + int len; + + instr = (struct nand_op_instr *)&subop->instrs[op_id]; + + switch (instr->type) { + case NAND_OP_CMD_INSTR: + if (first_cmd) { + nfc_op->cmd[0] = instr->ctx.cmd.opcode; + } else { + nfc_op->cmd[1] = instr->ctx.cmd.opcode; + nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; + } + + nfc_op->cle_ale_delay_ns = instr->delay_ns; + first_cmd = false; + nfc_op->cmd_len++; + + break; + + case NAND_OP_ADDR_INSTR: + offset = nand_subop_get_addr_start_off(subop, op_id); + naddrs = nand_subop_get_num_addr_cyc(subop, op_id); + addrs = &instr->ctx.addr.addrs[offset]; + + nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = naddrs; + + for (i = 0; i < min_t(u32, PHYTIUM_NFC_ADDR_MAX_LEN, naddrs); i++) + nfc_op->addr[i] = addrs[i]; + + nfc_op->cle_ale_delay_ns = instr->delay_ns; + + nfc_op->addr_len = naddrs; + break; + + case NAND_OP_DATA_IN_INSTR: + nfc_op->data_instr = instr; + nfc_op->data_instr_idx = op_id; + nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; + len = nand_subop_get_data_len(subop, op_id); + nfc_op->page_cnt = len; + nfc_op->data_delay_ns = instr->delay_ns; + + break; + + case NAND_OP_DATA_OUT_INSTR: + nfc_op->data_instr = instr; + nfc_op->data_instr_idx = op_id; + nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; + len = nand_subop_get_data_len(subop, op_id); + nfc_op->page_cnt = len; + nfc_op->data_delay_ns = instr->delay_ns; + break; + + case NAND_OP_WAITRDY_INSTR: + nfc_op->rdy_timeout_ms = instr->ctx.waitrdy.timeout_ms; + nfc_op->rdy_delay_ns = instr->delay_ns; + break; + } + } +} + +int phytium_nfc_prepare_cmd(struct nand_chip *chip, + struct phytium_nfc_op *nfc_op, + enum dma_data_direction direction) +{ + struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + int i; + + phytium_nfc_cmd_correct(nfc_op); + phytium_nfc_addr_correct(nfc_op); + + nfc_op->cmd_ctrl.nfc_ctrl.csel = 0x0F ^ (0x01 << phytium_nand->selected_die); + + for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) + nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_prepare_cmd); + +int phytium_nfc_send_cmd(struct nand_chip *chip, + struct phytium_nfc_op *nfc_op) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 value = 0; + + memset((u8 *)nfc->dsp_addr, 0, PAGE_SIZE); + memcpy((u8 *)nfc->dsp_addr, (u8 *)nfc_op, PHYTIUM_NFC_DSP_SIZE); + + if (phytium_wait_busy(nfc) != 0) { + dev_err(nfc->dev, "NFC was always busy\n"); + dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); + dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); + return 0; + } + + spin_lock(&nfc->spinlock); + value = nfc->dsp_phy_addr & 0xFFFFFFFF; + phytium_write(nfc, NDAR0, value); + + /* Don't modify NDAR1_DMA_RLEN & NDAR1_DMA_WLEN */ + value = phytium_read(nfc, NDAR1); + value |= NDAR1_H8((nfc->dsp_phy_addr >> 32) & 0xFF); + phytium_write(nfc, NDAR1, value); + + phytium_nfc_enable_int(nfc, NDIR_CMD_FINISH_MASK); + + value |= NDAR1_DMA_EN; + phytium_write(nfc, NDAR1, value); + spin_unlock(&nfc->spinlock); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_send_cmd); + +int phytium_nfc_prepare_cmd2(struct nand_chip *chip, + struct phytium_nfc_op *nfc_op, + enum dma_data_direction direction, + u32 cmd_num) +{ + struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); + int i; + + for (i = 0; i < cmd_num; i++) { + phytium_nfc_cmd_correct(nfc_op); + phytium_nfc_addr_correct(nfc_op); + nfc_op->cmd_ctrl.nfc_ctrl.csel = 0x0F ^ (0x01 << phytium_nand->selected_die); + nfc_op++; + } + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_prepare_cmd2); + +int phytium_nfc_send_cmd2(struct nand_chip *chip, + struct phytium_nfc_op *nfc_op, + u32 cmd_num) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 value = 0; + int i; + + memset((u8 *)nfc->dsp_addr, 0, PAGE_SIZE); + + for (i = 0; i < cmd_num; i++) { + memcpy((u8 *)nfc->dsp_addr + i*PHYTIUM_NFC_DSP_SIZE, + (u8 *)nfc_op, PHYTIUM_NFC_DSP_SIZE); + nfc_op++; + } + + if (phytium_wait_busy(nfc) != 0) { + dev_err(nfc->dev, "NFC was always busy\n"); + dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); + dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); + return 0; + } + + spin_lock(&nfc->spinlock); + value = nfc->dsp_phy_addr & 0xFFFFFFFF; + phytium_write(nfc, NDAR0, value); + + /* Don't modify NDAR1_DMA_RLEN & NDAR1_DMA_WLEN */ + value = phytium_read(nfc, NDAR1); + value |= NDAR1_H8((nfc->dsp_phy_addr >> 32) & 0xFF); + phytium_write(nfc, NDAR1, value); + + phytium_nfc_enable_int(nfc, NDIR_DMA_FINISH_MASK | NDIR_ECC_ERR_MASK); + + value |= NDAR1_DMA_EN; + phytium_write(nfc, NDAR1, value); + spin_unlock(&nfc->spinlock); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_send_cmd2); + +int phytium_nfc_wait_op(struct nand_chip *chip, + u32 timeout_ms) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + int ret; + + /* Timeout is expressed in ms */ + if (!timeout_ms) + timeout_ms = IRQ_TIMEOUT; + else if (timeout_ms > 1000) + timeout_ms = 1000; + else if (timeout_ms < 100) + timeout_ms = 100; + + ret = wait_event_interruptible_timeout(wait_done, nfc_irq_complete, + msecs_to_jiffies(timeout_ms)); + nfc_irq_complete = false; + if (!ret) { + dev_err(nfc->dev, "Timeout waiting for RB signal\n"); + dev_err(nfc->dev, "NFC state: %x\n", phytium_read(nfc, NDSR)); + dev_err(nfc->dev, "NFC irq state: %x, irq en:%x\n", + phytium_read(nfc, NDIR), phytium_read(nfc, NDIR_MASK)); + dev_err(nfc->dev, "NFC debug: %x\n", phytium_read(nfc, ND_DEBUG)); + + phytium_nfc_clear_int(nfc, NDIR_ALL_INT(nfc->caps->int_mask_bits)); + return -ETIMEDOUT; + } + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_wait_op); + +static int phytium_nfc_xfer_data_pio(struct phytium_nfc *nfc, + const struct nand_subop *subop, + struct phytium_nfc_op *nfc_op) +{ + const struct nand_op_instr *instr = nfc_op->data_instr; + unsigned int op_id = nfc_op->data_instr_idx; + unsigned int len = nand_subop_get_data_len(subop, op_id); + unsigned int offset = nand_subop_get_data_start_off(subop, op_id); + bool reading = (instr->type == NAND_OP_DATA_IN_INSTR); + + if (reading) { + u8 *in = instr->ctx.data.buf.in + offset; + + memcpy(in, nfc->dma_buf, len); + + nfc->dma_offset = 0; + } else { + const u8 *out = instr->ctx.data.buf.out + offset; + + memcpy(nfc->dma_buf, out, len); + } + + return 0; +} + +static int memcpy_to_reg16(struct phytium_nfc *nfc, u32 reg, u16 *buf, size_t len) +{ + int i; + u32 val = 0; + + if (!nfc || !buf || (len >= 16)) + return -EINVAL; + + for (i = 0; i < len; i++) { + val = (val << 16) + buf[i]; + if (i % 2) { + phytium_write(nfc, reg, val); + val = 0; + reg += 4; + } + } + + return 0; +} + +int phytium_nfc_default_data_interface(struct phytium_nfc *nfc) +{ + int value; + + value = phytium_read(nfc, NDCR0); + value &= (~NDCR0_IN_MODE(3)); + value |= NDCR0_IN_MODE(nfc->inter_mode); + phytium_write(nfc, NDCR0, value); + + value = phytium_read(nfc, NDCR1); + value &= (~NDCR1_SAMPL_PHASE(0xFFFF)); + + switch (nfc->inter_mode) { + case ASYN_SDR: + if (nfc->timing_mode == ASY_MODE4) { + memcpy_to_reg16(nfc, NDTR0, timing_asy_mode4, TIMING_ASY_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(4)); + } else if (nfc->timing_mode == ASY_MODE3) { + memcpy_to_reg16(nfc, NDTR0, timing_asy_mode3, TIMING_ASY_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(5)); + } else if (nfc->timing_mode == ASY_MODE2) { + memcpy_to_reg16(nfc, NDTR0, timing_asy_mode2, TIMING_ASY_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(3)); + } else if (nfc->timing_mode == ASY_MODE1) { + memcpy_to_reg16(nfc, NDTR0, timing_asy_mode1, TIMING_ASY_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(2)); + } else { + memcpy_to_reg16(nfc, NDTR0, timing_asy_mode0, TIMING_ASY_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(1)); + } + phytium_write(nfc, ND_INTERVAL_TIME, 0x01); + break; + case ONFI_DDR: + if (nfc->timing_mode == SYN_MODE4) { + memcpy_to_reg16(nfc, NDTR6, timing_syn_mode4, TIMING_SYN_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x0D)); + phytium_write(nfc, ND_INTERVAL_TIME, 0x30); + } else if (nfc->timing_mode == SYN_MODE3) { + memcpy_to_reg16(nfc, NDTR6, timing_syn_mode3, TIMING_SYN_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x05)); + phytium_write(nfc, ND_INTERVAL_TIME, 0x18); + } else if (nfc->timing_mode == SYN_MODE2) { + memcpy_to_reg16(nfc, NDTR6, timing_syn_mode2, TIMING_SYN_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x08)); + phytium_write(nfc, ND_INTERVAL_TIME, 0x20); + } else if (nfc->timing_mode == SYN_MODE1) { + memcpy_to_reg16(nfc, NDTR6, timing_syn_mode1, TIMING_SYN_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x12)); + phytium_write(nfc, ND_INTERVAL_TIME, 0x40); + } else { + memcpy_to_reg16(nfc, NDTR6, timing_syn_mode0, TIMING_SYN_NUM); + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(0x12)); + phytium_write(nfc, ND_INTERVAL_TIME, 0x40); + } + break; + case TOG_ASYN_DDR: + phytium_write(nfc, NDCR1, value | NDCR1_SAMPL_PHASE(8)); + phytium_write(nfc, ND_INTERVAL_TIME, 0xC8); + memcpy_to_reg16(nfc, NDTR13, timing_tog_ddr_mode0, TIMING_TOG_NUM); + break; + } + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_default_data_interface); + +static int phytium_nfc_naked_waitrdy_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + int ret = 0; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + + dev_info(nfc->dev, "Phytium nand command 0x%02x 0x%02x.\n", + nfc_op.cmd[0], nfc_op.cmd[1]); + + switch (nfc_op.cmd[0]) { + case NAND_CMD_PARAM: + memset(nfc->dma_buf, 0, PAGE_SIZE); + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_PARAM; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + if (nfc->inter_pro == NAND_ONFI) + nfc_op.page_cnt = 3 * sizeof(struct nand_onfi_params); + else if (nfc->inter_pro == NAND_JEDEC) + nfc_op.page_cnt = 3 * sizeof(struct nand_jedec_params); + if (nfc_op.page_cnt) + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + nfc->dma_offset = 0; + break; + case NAND_CMD_SET_FEATURES: + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_SET_FTR; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + if (nfc->inter_mode != ASYN_SDR) { + dev_err(nfc->dev, "Not support SET_FEATURES command!\n"); + return 0; + } + break; + case NAND_CMD_GET_FEATURES: + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_GET_FTR; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + break; + case NAND_CMD_READ0: + if (nfc_op.cmd[1] == NAND_CMD_READSTART) { /* large page */ + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + } else if (nfc_op.cmd[1] == NAND_CMD_SEQIN) { /* program page begin */ + nfc_op.cmd[0] = NAND_CMD_SEQIN; + nfc_op.cmd[1] = NAND_CMD_PAGEPROG; + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + } else { /* small page */ + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + } + break; + case NAND_CMD_RNDOUT: /* change read column */ + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + break; + case NAND_CMD_READSTART: /* large page */ + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + break; + case NAND_CMD_RNDOUTSTART: /* change read column */ + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc->dma_offset = nfc_op.addr[1]; + nfc->dma_offset = (nfc->dma_offset << 8) + nfc_op.addr[0]; + break; + case NAND_CMD_SEQIN: /* program begin */ + if (nfc_op.cmd[0] == NAND_CMD_READ0) { + nfc_op.cmd[0] = NAND_CMD_SEQIN; + nfc_op.cmd[1] = NAND_CMD_PAGEPROG; + } + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + break; + case NAND_CMD_RNDIN: /* change write column */ + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_WR_COL; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + break; + case NAND_CMD_PAGEPROG: /* program end */ + nfc_op.cmd[0] = NAND_CMD_RNDIN; + nfc_op.cmd[1] = NAND_CMD_PAGEPROG; + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + break; + default: + dev_err(nfc->dev, "Not support cmd %d.\n", nfc_op.cmd[1]); + ret = -EINVAL; + goto out; + } + + if ((nfc_op.data_instr) && (direction == DMA_TO_DEVICE)) + phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); + + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + nfc_op.rdy_timeout_ms = nfc_op.rdy_timeout_ms; + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + goto out; + + cond_delay(nfc_op.rdy_delay_ns); + + if ((nfc_op.data_instr) && (direction == DMA_FROM_DEVICE)) + phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); + +out: + return ret; +} + +static int phytium_nfc_read_id_type_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + u16 read_len = 0; + int ret; + u8 *buf = nfc->dma_buf; + + memset(nfc->dma_buf, 0, PAGE_SIZE); + direction = DMA_FROM_DEVICE; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + read_len = nfc_op.page_cnt; + nfc_op.page_cnt = (read_len & 0x03) ? ((read_len & 0xFFFC) + 4) : read_len; + + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_ID; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 0; + + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + return ret; + + cond_delay(nfc_op.rdy_delay_ns); + + if (!strncmp(nfc->dma_buf, "ONFI", 4)) { + nfc->inter_pro = NAND_ONFI; + } else if (!strncmp(nfc->dma_buf, "JEDEC", 5)) { + nfc->inter_pro = NAND_JEDEC; + if (buf[5] == 1) + nfc->inter_mode = ASYN_SDR; + else if (buf[5] == 2) + nfc->inter_mode = TOG_ASYN_DDR; + else if (buf[5] == 4) + nfc->inter_mode = ASYN_SDR; + } else { + nfc->inter_pro = NAND_OTHER; + } + + dev_info(nfc->dev, "Nand protocol: %d, interface mode: %d\n", + nfc->inter_pro, nfc->inter_mode); + + phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); + + return 0; +} + +static int phytium_nfc_read_status_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + u16 read_len = 0; + u32 timeout, count = 0; + int ret = 0; + + direction = DMA_FROM_DEVICE; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + read_len = nfc_op.page_cnt; + nfc_op.page_cnt = (read_len & 0x03) ? ((read_len & 0xFFFC) + 4) : read_len; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ_STATUS; + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + +read_status_retry: + count++; + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + timeout = nfc_op.rdy_timeout_ms ? nfc_op.rdy_timeout_ms : 10; + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + goto out; + + phytium_nfc_xfer_data_pio(nfc, subop, &nfc_op); + + if (0xE0 != *(u8 *)(nfc->dma_buf)) { + dev_info(nfc->dev, "Retry to read status (%x)\n", *(u8 *)(nfc->dma_buf)); + + if (count < 10) + goto read_status_retry; + } + +out: + return ret; +} + +static int phytium_nfc_reset_cmd_type_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + + direction = DMA_NONE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_RESET; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + return phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); +} + +static int phytium_nfc_erase_cmd_type_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + direction = DMA_NONE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_ERASE; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + return phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); +} + +static int phytium_nfc_data_in_type_exec(struct nand_chip *chip, + const struct nand_subop *subop) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nfc_op nfc_op; + struct nand_op_instr *instr; + unsigned int op_id; + unsigned int len; + unsigned int offset; + u8 *in = NULL; + + phytium_nfc_parse_instructions(chip, subop, &nfc_op); + if (nfc_op.data_instr->type != NAND_OP_DATA_IN_INSTR) { + dev_err(nfc->dev, "Phytium nfc instrs parser failed!\n"); + return -EINVAL; + } + + instr = nfc_op.data_instr; + op_id = nfc_op.data_instr_idx; + len = nand_subop_get_data_len(subop, op_id); + offset = nand_subop_get_data_start_off(subop, op_id); + in = instr->ctx.data.buf.in + offset; + + memcpy(in, nfc->dma_buf + nfc->dma_offset, len); + nfc->dma_offset += len; + + return 0; +} + +static const struct nand_op_parser phytium_nfc_op_parser = NAND_OP_PARSER( + /* Naked commands not supported, use a function for each pattern */ + NAND_OP_PARSER_PATTERN( + phytium_nfc_read_id_type_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, 8)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_erase_cmd_type_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_read_status_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, 1)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_reset_cmd_type_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_naked_waitrdy_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_WAITRDY_ELEM(false), + NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_naked_waitrdy_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_naked_waitrdy_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_DATA_OUT_ELEM(false, 8), + NAND_OP_PARSER_PAT_WAITRDY_ELEM(false)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_naked_waitrdy_exec, + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_ADDR_ELEM(false, PHYTIUM_NFC_ADDR_MAX_LEN), + NAND_OP_PARSER_PAT_CMD_ELEM(false), + NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), + NAND_OP_PARSER_PATTERN( + phytium_nfc_data_in_type_exec, + NAND_OP_PARSER_PAT_DATA_IN_ELEM(false, MAX_CHUNK_SIZE)), + ); + +static int phytium_nfc_exec_op(struct nand_chip *chip, + const struct nand_operation *op, + bool check_only) +{ + return nand_op_parser_exec_op(chip, &phytium_nfc_op_parser, + op, check_only); +} + +static int phytium_nfc_reset(struct phytium_nfc *nfc) +{ + u32 value; + + phytium_write(nfc, NDIR_MASK, NDIR_ALL_INT(nfc->caps->int_mask_bits)); + phytium_write(nfc, NDSR, NDIR_ALL_INT(nfc->caps->int_mask_bits)); + + phytium_write(nfc, ND_ERR_CLR, 0x0F); + phytium_write(nfc, NDFIFO_CLR, 1); + + value = phytium_read(nfc, NDCR0); + phytium_write(nfc, NDCR0, value & ~(NDCR0_ECC_EN | NDCR0_SPARE_EN)); + + return 0; +} + +static void phytium_nfc_select_chip(struct nand_chip *chip, int die_nr) +{ + struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + + dev_dbg(nfc->dev, "Phytium nand selected chip %d\n", die_nr); + + if (chip == nfc->selected_chip && die_nr == phytium_nand->selected_die) + return; + + if (die_nr < 0 || die_nr >= phytium_nand->nsels) { + nfc->selected_chip = NULL; + phytium_nand->selected_die = -1; + return; + } + + phytium_nfc_reset(nfc); + + nfc->selected_chip = chip; + phytium_nand->selected_die = die_nr; +} + +static int phytium_nand_ooblayout_ecc(struct mtd_info *mtd, int section, + struct mtd_oob_region *oobregion) +{ + struct nand_chip *chip = mtd_to_nand(mtd); + + if (section) + return -ERANGE; + + oobregion->length = chip->ecc.total; + oobregion->offset = mtd->oobsize - oobregion->length; + + return 0; +} + +static int phytium_nand_ooblayout_free(struct mtd_info *mtd, int section, + struct mtd_oob_region *oobregion) +{ + struct nand_chip *chip = mtd_to_nand(mtd); + + if (section) + return -ERANGE; + + /* + * Bootrom looks in bytes 0 & 5 for bad blocks for the + * 4KB page / 4bit BCH combination. + */ + if (mtd->writesize >= SZ_4K) + oobregion->offset = 6; + else + oobregion->offset = 2; + + oobregion->length = mtd->oobsize - chip->ecc.total - oobregion->offset; + + return 0; +} + +static const struct mtd_ooblayout_ops phytium_nand_ooblayout_ops = { + .ecc = phytium_nand_ooblayout_ecc, + .free = phytium_nand_ooblayout_free, +}; + +static void phytium_nfc_enable_hw_ecc(struct nand_chip *chip) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 ndcr0 = phytium_read(nfc, NDCR0); + + if (!(ndcr0 & NDCR0_ECC_EN)) + phytium_write(nfc, NDCR0, ndcr0 | NDCR0_ECC_EN); +} + +static void phytium_nfc_disable_hw_ecc(struct nand_chip *chip) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 ndcr0 = phytium_read(nfc, NDCR0); + + if (ndcr0 & NDCR0_ECC_EN) + phytium_write(nfc, NDCR0, ndcr0 & ~NDCR0_ECC_EN); +} + +irqreturn_t phytium_nfc_isr(int irq, void *dev_id) +{ + struct phytium_nfc *nfc = dev_id; + u32 st = phytium_read(nfc, NDIR); + u32 ien = (~phytium_read(nfc, NDIR_MASK)) & NDIR_ALL_INT(nfc->caps->int_mask_bits); + + if (!(st & ien)) + return IRQ_NONE; + + nfc_irq_st = st; + nfc_irq_en = ien; + phytium_nfc_disable_int(nfc, st & NDIR_ALL_INT(nfc->caps->int_mask_bits)); + phytium_write(nfc, 0xFD0, 0); + + if (st & (NDIR_CMD_FINISH | NDIR_DMA_FINISH)) { + if (st & NDIR_ECC_ERR) + nfc_ecc_err = 1; + phytium_write(nfc, NDIR, st); + nfc_irq_complete = 1; + } else if (st & (NDIR_FIFO_TIMEOUT | NDIR_PGFINISH)) { + phytium_write(nfc, NDIR, st); + phytium_nfc_enable_int(nfc, (~st) & (NDIR_DMA_FINISH_MASK | + NDIR_PGFINISH_MASK | + NDIR_FIFO_TIMEOUT_MASK | + NDIR_CMD_FINISH_MASK)); + nfc_irq_complete = 0; + } else if (st & NDIR_ECC_ERR) { + phytium_write(nfc, ND_ERR_CLR, 0x08); + phytium_write(nfc, NDIR, st); + phytium_write(nfc, NDFIFO_CLR, 0x01); + nfc_irq_complete = 1; + nfc_ecc_errover = 1; + } else { + phytium_write(nfc, NDIR, st); + nfc_irq_complete = 1; + } + + wake_up(&wait_done); + + return IRQ_HANDLED; +} +EXPORT_SYMBOL(phytium_nfc_isr); + +static int phytium_nfc_hw_ecc_correct(struct nand_chip *chip, + char *buf, int len) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 i, j, value, tmp; + u32 ecc_err_reg_nums; + int stat = 0; + + if (!buf) + return -EINVAL; + + if (nfc->caps->hw_ver == 1) + ecc_err_reg_nums = 2; + else + ecc_err_reg_nums = 4; + + for (i = 0; i < chip->ecc.steps; i++) { + for (j = 0; j < ecc_err_reg_nums; j++) { + value = phytium_read(nfc, 0xB8 + 4 * (ecc_err_reg_nums * i + j)); + dev_info(nfc->dev, "ECC_FLAG: offset:%x value:0x%08x\n", + 0xB8 + 4 * (2 * i + j), value); + + tmp = value & 0xFFFF; + if (tmp && (tmp <= 4096)) { + tmp--; + stat++; + buf[chip->ecc.size * i + (tmp >> 3)] ^= (0x01 << tmp % 8); + dev_info(nfc->dev, "ECC_CORRECT %x %02x\n", + chip->ecc.size * i + (tmp >> 3), + buf[chip->ecc.size * i + (tmp >> 3)]); + dev_info(nfc->dev, "ECC_CORRECT xor %x %02x\n", + 0x01 << (tmp % 8), buf[chip->ecc.size * i + (tmp >> 3)]); + } else if (tmp > 4096) { + dev_info(nfc->dev, "ECC_CORRECT offset > 4096!\n"); + } + + tmp = (value >> 16) & 0xFFFF; + if (tmp && (tmp <= 4096)) { + tmp--; + stat++; + buf[chip->ecc.size * i + (tmp >> 3)] ^= (0x01 << tmp % 8); + dev_info(nfc->dev, "ECC_CORRECT %x %02x\n", + chip->ecc.size * i + (tmp >> 3), + buf[chip->ecc.size * i + (tmp >> 3)]); + dev_info(nfc->dev, "ECC_CORRECT xor %x %02x\n", + chip->ecc.size * i + (tmp >> 3), + buf[chip->ecc.size * i + (tmp >> 3)]); + } else if (tmp > 4096) { + dev_info(nfc->dev, "ECC_CORRECT offset > 4096!\n"); + } + } + } + + return stat; +} + +static int phytium_nand_page_read(struct mtd_info *mtd, struct nand_chip *chip, + u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + int ret = 0; + + memset(&nfc_op, 0, sizeof(nfc_op)); + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); + + memset(nfc->dma_buf, 0x0, mtd->writesize + mtd->oobsize); + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op.cmd[0] = NAND_CMD_READ0; + nfc_op.cmd[1] = NAND_CMD_READSTART; + nfc_op.cmd_len = 2; + nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); + nfc_op.rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); + + nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op.addr[2] = page; + nfc_op.addr[3] = page >> 8; + nfc_op.addr[4] = page >> 16; + nfc_op.addr_len = 5; + nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + + nfc_op.page_cnt = mtd->writesize; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; + + /* For data read/program */ + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + return ret; + + if ((direction == DMA_FROM_DEVICE) && buf) + memcpy(buf, nfc->dma_buf, mtd->writesize); + + return ret; +} + +static int phytium_nand_oob_read(struct mtd_info *mtd, struct nand_chip *chip, + u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + int ret = 0; + + memset(&nfc_op, 0, sizeof(nfc_op)); + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); + + memset(nfc->dma_buf, 0x00, mtd->writesize + mtd->oobsize); + direction = DMA_FROM_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op.cmd[0] = NAND_CMD_READ0; + nfc_op.cmd[1] = NAND_CMD_READSTART; + nfc_op.cmd_len = 2; + nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); + nfc_op.rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); + + nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op.addr[2] = page; + nfc_op.addr[3] = page >> 8; + nfc_op.addr[4] = page >> 16; + nfc_op.addr_len = 5; + nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + + nfc_op.page_cnt = oob_len; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; + nfc_op.addr[0] = mtd->writesize & 0xFF; + nfc_op.addr[1] = (mtd->writesize >> 8) & 0xFF; + + /* For data read/program */ + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + return ret; + + cond_delay(nfc_op.rdy_delay_ns); + + if (direction == DMA_FROM_DEVICE) + memcpy(oob_buf, nfc->dma_buf, oob_len); + + return ret; +} + +static int phytium_nand_get_ecc_total(struct mtd_info *mtd, + struct nand_ecc_ctrl *ecc) +{ + int ecc_total = 0; + + switch (mtd->writesize) { + case 0x200: + if (ecc->strength == 8) + ecc_total = 0x0D; + else if (ecc->strength == 4) + ecc_total = 7; + else if (ecc->strength == 2) + ecc_total = 4; + else + ecc_total = 0; + break; + case 0x800: + if (ecc->strength == 8) + ecc_total = 0x34; + else if (ecc->strength == 4) + ecc_total = 0x1a; + else if (ecc->strength == 2) + ecc_total = 0xd; + else + ecc_total = 0; + break; + case 0x1000: + if (ecc->strength == 8) + ecc_total = 0x68; + else if (ecc->strength == 4) + ecc_total = 0x34; + else if (ecc->strength == 2) + ecc_total = 0x1a; + else + ecc_total = 0; + break; + case 0x2000: + if (ecc->strength == 8) + ecc_total = 0xD0; + else if (ecc->strength == 4) + ecc_total = 0x68; + else if (ecc->strength == 2) + ecc_total = 0x34; + else + ecc_total = 0; + break; + case 0x4000: + if (ecc->strength == 8) + ecc_total = 0x1A0; + if (ecc->strength == 4) + ecc_total = 0xD0; + else if (ecc->strength == 2) + ecc_total = 0x68; + else + ecc_total = 0; + break; + default: + ecc_total = 0; + break; + } + + return ecc_total; +} + +static int phytium_nand_page_read_hwecc(struct mtd_info *mtd, struct nand_chip *chip, + u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op *nfc_op = NULL; + enum dma_data_direction direction; + u32 ecc_offset; + int max_bitflips = 0; + u32 nfc_state = 0; + int ret = 0; + int i; + + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); + + ecc_offset = phytium_nand->ecc.offset; + memset(nfc->dma_buf, 0x00, mtd->writesize + mtd->oobsize); + nfc_op = kzalloc(2 * sizeof(struct phytium_nfc_op), GFP_KERNEL); + if (!nfc_op) { + dev_err(nfc->dev, "Can't malloc space for phytium_nfc_op\n"); + return 0; + } + + nfc_op->cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op->rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); + nfc_op->rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); + + direction = DMA_FROM_DEVICE; + nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_READ; + nfc_op->cmd[0] = NAND_CMD_READ0; + nfc_op->cmd[1] = NAND_CMD_READSTART; + nfc_op->cmd_len = 2; + nfc_op->addr_len = 5; + nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op->addr[2] = page; + nfc_op->addr[3] = page >> 8; + nfc_op->addr[4] = page >> 16; + nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc_op->page_cnt = mtd->writesize; + nfc_op->cmd_ctrl.nfc_ctrl.nc = 1; + for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) + nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; + + nfc_op++; + memcpy(nfc_op, nfc_op - 1, sizeof(struct phytium_nfc_op)); + nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_READ_COL; + nfc_op->cmd[0] = NAND_CMD_RNDOUT; + nfc_op->cmd[1] = NAND_CMD_RNDOUTSTART; + memset(&nfc_op->addr, 0, PHYTIUM_NFC_ADDR_MAX_LEN); + nfc_op->addr_len = 2; + nfc_op->addr[0] = mtd->writesize + phytium_nand->ecc.offset; + nfc_op->addr[1] = (mtd->writesize + phytium_nand->ecc.offset) >> 8; + nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x02; + nfc_op->page_cnt = phytium_nand_get_ecc_total(mtd, &chip->ecc); + nfc_op->cmd_ctrl.nfc_ctrl.nc = 0; + nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 0; + nfc_op->cmd_ctrl.nfc_ctrl.ecc_en = 1; + for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) + nfc_op->mem_addr_first[i] = + ((nfc->dma_phy_addr + mtd->writesize) >> (8 * i)) & 0xFF; + + nfc_op--; + phytium_nfc_prepare_cmd2(chip, nfc_op, direction, 2); + phytium_nfc_send_cmd2(chip, nfc_op, 2); + cond_delay(nfc_op->cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op->rdy_timeout_ms); + if (ret) + return ret; + + cond_delay(nfc_op->rdy_delay_ns * 1000); + + if ((direction == DMA_FROM_DEVICE) && buf) { + nfc_state = phytium_read(nfc, NDSR); + if ((nfc_state & NDSR_ECC_ERROVER) || (nfc_ecc_errover == 1)) { + for (i = 0; i < mtd->writesize/16; i++) { + if (0xFF != *(u8 *)(nfc->dma_buf + i)) { + dev_info(nfc->dev, "NFC: NDSR_ECC_ERROVER %x\n", page); + mtd->ecc_stats.failed++; + mtd->ecc_stats.corrected += max_bitflips; + break; + } + } + } else if (nfc_state & NDSR_ECC_ERR) { + max_bitflips = phytium_nfc_hw_ecc_correct(chip, + nfc->dma_buf, mtd->writesize); + mtd->ecc_stats.corrected += max_bitflips; + dev_info(nfc->dev, "NFC: NDSR_ECC_ERR page:%x, bit:%d\n", + page, max_bitflips); + } + + memcpy(buf, nfc->dma_buf, mtd->writesize); + } + + kfree(nfc_op); + return max_bitflips; +} + +static int phytium_nand_page_write(struct mtd_info *mtd, struct nand_chip *chip, + const u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + int ret = 0; + + memset(&nfc_op, 0, sizeof(nfc_op)); + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); + + memcpy(nfc->dma_buf, buf, mtd->writesize); + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op.cmd[0] = NAND_CMD_SEQIN; + nfc_op.cmd[1] = NAND_CMD_PAGEPROG; + nfc_op.cmd_len = 2; + nfc_op.addr_len = 5; + nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tPROG_max); + nfc_op.rdy_delay_ns = 0; + + nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op.addr[2] = page; + nfc_op.addr[3] = page >> 8; + nfc_op.addr[4] = page >> 16; + nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc_op.page_cnt = mtd->writesize; + + /* For data read/program */ + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + goto out; + + cond_delay(nfc_op.rdy_delay_ns); +out: + return ret; +} + +static int phytium_nand_oob_write(struct mtd_info *mtd, struct nand_chip *chip, + u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op nfc_op; + enum dma_data_direction direction; + int ret = 0; + + memset(&nfc_op, 0, sizeof(nfc_op)); + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); + + direction = DMA_TO_DEVICE; + nfc_op.cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op.cmd[0] = NAND_CMD_SEQIN; + nfc_op.cmd[1] = NAND_CMD_PAGEPROG; + nfc_op.cmd_len = 2; + nfc_op.addr_len = 5; + nfc_op.cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op.rdy_timeout_ms = PSEC_TO_MSEC(sdr->tPROG_max); + nfc_op.rdy_delay_ns = 0; + + nfc_op.cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op.addr[2] = page; + nfc_op.addr[3] = page >> 8; + nfc_op.addr[4] = page >> 16; + nfc_op.cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op.cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op.cmd_ctrl.nfc_ctrl.auto_rs = 1; + + nfc_op.page_cnt = oob_len; + nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; + nfc_op.addr[0] = mtd->writesize & 0xFF; + nfc_op.addr[1] = (mtd->writesize >> 8) & 0xFF; + nfc_op.cmd_ctrl.nfc_ctrl.ecc_en = 0; + memcpy(nfc->dma_buf, oob_buf, mtd->oobsize); + + /* For data read/program */ + phytium_nfc_prepare_cmd(chip, &nfc_op, direction); + phytium_nfc_send_cmd(chip, &nfc_op); + cond_delay(nfc_op.cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op.rdy_timeout_ms); + if (ret) + goto out; + + cond_delay(nfc_op.rdy_delay_ns); +out: + return ret; +} + +static int phytium_nand_page_write_hwecc(struct mtd_info *mtd, struct nand_chip *chip, + const u8 *buf, u8 *oob_buf, int oob_len, int page, + bool read) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + struct phytium_nand_chip *phytium_nand = NULL; + const struct nand_sdr_timings *sdr = NULL; + struct phytium_nfc_op *nfc_op; + enum dma_data_direction direction; + u32 ecc_offset; + int ret = 0; + int i; + + phytium_nand = to_phytium_nand(chip); + sdr = nand_get_sdr_timings(nand_get_interface_config(&phytium_nand->chip)); + ecc_offset = phytium_nand->ecc.offset; + + nfc_op = kzalloc(2 * sizeof(struct phytium_nfc_op), GFP_KERNEL); + if (!nfc_op) + return 0; + + nfc_op->cle_ale_delay_ns = PSEC_TO_NSEC(sdr->tWB_max); + nfc_op->rdy_timeout_ms = PSEC_TO_MSEC(sdr->tR_max); + nfc_op->rdy_delay_ns = PSEC_TO_NSEC(sdr->tRR_min); + + direction = DMA_TO_DEVICE; + nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_CH_ROW_ADDR; + nfc_op->cmd[0] = NAND_CMD_SEQIN; + nfc_op->cmd_len = 1; + nfc_op->addr_len = 5; + nfc_op->cmd_ctrl.nfc_ctrl.dbc = 0; + nfc_op->addr[2] = page; + nfc_op->addr[3] = page >> 8; + nfc_op->addr[4] = page >> 16; + nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x05; + nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 0; + nfc_op->cmd_ctrl.nfc_ctrl.nc = 1; + for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) + nfc_op->mem_addr_first[i] = (nfc->dma_phy_addr >> (8 * i)) & 0xFF; + + /* The first dsp must have data to transfer */ + memcpy(nfc->dma_buf, buf, mtd->writesize); + nfc_op->page_cnt = mtd->writesize; + nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; + + nfc_op++; + memcpy(nfc_op, nfc_op - 1, sizeof(struct phytium_nfc_op)); + nfc_op->cmd_ctrl.nfc_ctrl.cmd_type = TYPE_PAGE_PRO; + nfc_op->cmd_ctrl.nfc_ctrl.dbc = 1; + nfc_op->cmd_ctrl.nfc_ctrl.auto_rs = 1; + nfc_op->cmd[0] = NAND_CMD_RNDIN; + nfc_op->cmd[1] = NAND_CMD_PAGEPROG; + memset(&nfc_op->addr, 0, PHYTIUM_NFC_ADDR_MAX_LEN); + nfc_op->addr_len = 2; + nfc_op->cmd_len = 2; + nfc_op->addr[0] = mtd->writesize + ecc_offset; + nfc_op->addr[1] = (mtd->writesize + ecc_offset) >> 8; + nfc_op->cmd_ctrl.nfc_ctrl.addr_cyc = 0x02; + nfc_op->page_cnt = phytium_nand_get_ecc_total(mtd, &chip->ecc); + nfc_op->cmd_ctrl.nfc_ctrl.nc = 0; + nfc_op->cmd_ctrl.nfc_ctrl.dc = 1; + nfc_op->cmd_ctrl.nfc_ctrl.ecc_en = 1; + for (i = 0; i < PHYTIUM_NFC_ADDR_MAX_LEN; i++) + nfc_op->mem_addr_first[i] = + ((nfc->dma_phy_addr + mtd->writesize + ecc_offset) >> (8 * i)) & 0xFF; + + /* when enable ECC, must offer ecc_offset of oob, but no oobdata */ + nfc_op--; + phytium_nfc_prepare_cmd2(chip, nfc_op, direction, 2); + phytium_nfc_send_cmd2(chip, nfc_op, 2); + cond_delay(nfc_op->cle_ale_delay_ns); + + ret = phytium_nfc_wait_op(chip, nfc_op->rdy_timeout_ms); + if (ret) + goto out; + + cond_delay(nfc_op->rdy_delay_ns * 1000); +out: + return ret; +} + +static int phytium_nfc_hw_ecc_bch_read_page_raw(struct nand_chip *chip, + u8 *buf, int oob_required, + int page) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + u32 oob_len = oob_required ? mtd->oobsize : 0; + int ret; + + ret = phytium_nand_page_read(mtd, chip, buf, NULL, 0, page, true); + if (oob_required) + ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, + oob_len, page, true); + + return ret; +} + +static int phytium_nfc_hw_ecc_bch_read_oob_raw(struct nand_chip *chip, int page) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + int ret; + + /* Invalidate page cache */ + chip->pagecache.page = -1; + memset(chip->oob_poi, 0xFF, mtd->oobsize); + + ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, + mtd->oobsize, page, true); + + return ret; +} + +static int phytium_nfc_hw_ecc_bch_read_page(struct nand_chip *chip, + u8 *buf, int oob_required, + int page) +{ + int ret; + struct mtd_info *mtd = nand_to_mtd(chip); + u32 oob_len = oob_required ? mtd->oobsize : 0; + struct phytium_nand_chip *phytium_nand = NULL; + + phytium_nand = to_phytium_nand(chip); + + phytium_nfc_enable_hw_ecc(chip); + cond_delay(20*1000); + + ret = phytium_nand_page_read_hwecc(mtd, chip, buf, NULL, + 0, page, true); + + phytium_nfc_disable_hw_ecc(chip); + + if (oob_required) { + oob_len = mtd->oobsize; + ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, + oob_len, page, true); + } + + return ret; +} + +static int phytium_nfc_hw_ecc_bch_read_oob(struct nand_chip *chip, + int page) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + u32 oob_len = mtd->oobsize; + int ret; + + ret = phytium_nand_oob_read(mtd, chip, NULL, chip->oob_poi, + oob_len, page, true); + + return ret; +} + +static int phytium_nfc_hw_ecc_bch_write_page_raw(struct nand_chip *chip, + const u8 *buf, + int oob_required, int page) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + void *oob_buf = oob_required ? chip->oob_poi : NULL; + + if (oob_required) + phytium_nand_oob_write(mtd, chip, NULL, oob_buf, + mtd->oobsize, page, false); + + return phytium_nand_page_write(mtd, chip, buf, NULL, + 0, page, false); +} + +static int phytium_nfc_hw_ecc_bch_write_page(struct nand_chip *chip, + const u8 *buf, + int oob_required, int page) +{ + int ret; + struct mtd_info *mtd = nand_to_mtd(chip); + void *oob_buf = oob_required ? chip->oob_poi : NULL; + u32 oob_len; + + if (oob_required) { + oob_len = mtd->oobsize; + phytium_nand_oob_write(mtd, chip, NULL, oob_buf, + oob_len, page, false); + } + + phytium_nfc_enable_hw_ecc(chip); + cond_delay(20*1000); + ret = phytium_nand_page_write_hwecc(mtd, chip, buf, NULL, + 0, page, false); + phytium_nfc_disable_hw_ecc(chip); + + return ret; +} + +static int phytium_nfc_hw_ecc_bch_write_oob_raw(struct nand_chip *chip, int page) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + + return phytium_nand_oob_write(mtd, chip, NULL, chip->oob_poi, + mtd->oobsize, page, false); +} + +static int phytium_nfc_hw_ecc_bch_write_oob(struct nand_chip *chip, int page) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); + u32 oob_len = mtd->oobsize - phytium_nand->ecc.length; + + return phytium_nand_oob_write(mtd, chip, NULL, chip->oob_poi, + oob_len, page, false); +} + +static int phytium_nand_hw_ecc_ctrl_init(struct mtd_info *mtd, + struct nand_ecc_ctrl *ecc) +{ + struct nand_chip *chip = mtd_to_nand(mtd); + + if ((mtd->writesize + mtd->oobsize > MAX_CHUNK_SIZE)) + return -EOPNOTSUPP; + + chip->ecc.algo = NAND_ECC_ALGO_BCH; + ecc->read_page_raw = phytium_nfc_hw_ecc_bch_read_page_raw; + ecc->read_page = phytium_nfc_hw_ecc_bch_read_page; + ecc->read_oob_raw = phytium_nfc_hw_ecc_bch_read_oob_raw; + ecc->read_oob = phytium_nfc_hw_ecc_bch_read_oob; + ecc->write_page_raw = phytium_nfc_hw_ecc_bch_write_page_raw; + ecc->write_page = phytium_nfc_hw_ecc_bch_write_page; + ecc->write_oob_raw = phytium_nfc_hw_ecc_bch_write_oob_raw; + ecc->write_oob = phytium_nfc_hw_ecc_bch_write_oob; + + return 0; +} + +static int phytium_nand_ecc_init(struct mtd_info *mtd, + struct nand_ecc_ctrl *ecc) +{ + int ret = 0; + + mtd_set_ooblayout(mtd, &phytium_nand_ooblayout_ops); + + switch (ecc->engine_type) { + case NAND_ECC_ENGINE_TYPE_ON_HOST: + ret = phytium_nand_hw_ecc_ctrl_init(mtd, ecc); + break; + case NAND_ECC_ENGINE_TYPE_NONE: + ecc->read_page_raw = phytium_nfc_hw_ecc_bch_read_page_raw; + ecc->read_oob_raw = phytium_nfc_hw_ecc_bch_read_oob; + ecc->write_page_raw = phytium_nfc_hw_ecc_bch_write_page_raw; + ecc->write_oob_raw = phytium_nfc_hw_ecc_bch_write_oob_raw; + ecc->read_page = ecc->read_page_raw; + ecc->read_oob = ecc->read_oob_raw; + ecc->write_page = ecc->write_page_raw; + ecc->write_oob = ecc->write_oob_raw; + break; + case NAND_ECC_ENGINE_TYPE_SOFT: + case NAND_ECC_ENGINE_TYPE_ON_DIE: + default: + ret = -EINVAL; + break; + } + + return ret; +} + +static u8 bbt_pattern[] = {'P', 'H', 'Y', 'b', 't', '0' }; +static u8 bbt_mirror_pattern[] = {'1', 't', 'b', 'Y', 'H', 'P' }; + +static struct nand_bbt_descr bbt_main_descr = { + .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE | + NAND_BBT_2BIT | NAND_BBT_VERSION, + .offs = 8, + .len = 6, + .veroffs = 14, + .maxblocks = 8, /* Last 8 blocks in each chip */ + .pattern = bbt_pattern +}; + +static struct nand_bbt_descr bbt_mirror_descr = { + .options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE | + NAND_BBT_2BIT | NAND_BBT_VERSION, + .offs = 8, + .len = 6, + .veroffs = 14, + .maxblocks = 8, /* Last 8 blocks in each chip */ + .pattern = bbt_mirror_pattern +}; + +static int phytium_nand_attach_chip(struct nand_chip *chip) +{ + struct mtd_info *mtd = nand_to_mtd(chip); + struct phytium_nand_chip *phytium_nand = to_phytium_nand(chip); + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + u32 value; + int ret = 0; + + if (nfc->caps->flash_bbt) + chip->bbt_options |= NAND_BBT_USE_FLASH; + + if (chip->bbt_options & NAND_BBT_USE_FLASH) { + /* + * We'll use a bad block table stored in-flash and don't + * allow writing the bad block marker to the flash. + */ + chip->bbt_options |= NAND_BBT_NO_OOB_BBM; + chip->bbt_td = &bbt_main_descr; + chip->bbt_md = &bbt_mirror_descr; + } + + if (chip->options & NAND_BUSWIDTH_16) + phytium_nand->ndcr |= NDCR0_WIDTH; + + /* + * On small page NANDs, only one cycle is needed to pass the + * column address. + */ + if (mtd->writesize <= 512) + phytium_nand->addr_cyc = 1; + else + phytium_nand->addr_cyc = 2; + + /* + * Now add the number of cycles needed to pass the row + * address. + * + * Addressing a chip using CS 2 or 3 should also need the third row + * cycle but due to inconsistance in the documentation and lack of + * hardware to test this situation, this case is not supported. + */ + if (chip->options & NAND_ROW_ADDR_3) + phytium_nand->addr_cyc += 3; + else + phytium_nand->addr_cyc += 2; + + if (nfc->caps) { + if (chip->ecc.engine_type == NAND_ECC_ENGINE_TYPE_ON_HOST) { + chip->ecc.size = nfc->caps->ecc_step_size ? + nfc->caps->ecc_step_size : + chip->ecc.size; + chip->ecc.strength = nfc->caps->ecc_strength ? + nfc->caps->ecc_strength : + chip->ecc.strength; + chip->ecc.strength = nfc->caps->ecc_strength; + chip->ecc.bytes = 7; + } else { + chip->ecc.size = 512; + chip->ecc.strength = 1; + chip->ecc.bytes = 0; + } + chip->ecc.engine_type = NAND_ECC_ENGINE_TYPE_ON_HOST; + } + + if (nfc->caps->hw_ver == 1) { + if (chip->ecc.strength == 0x04) + phytium_nand->ndcr |= NDCR0_ECC_STREN(4); + else if (chip->ecc.strength == 0x02) + phytium_nand->ndcr |= NDCR0_ECC_STREN(2); + else + phytium_nand->ndcr |= NDCR0_ECC_STREN(0); + } else { + if (chip->ecc.strength == 0x08) + phytium_nand->ndcr |= NDCR0_ECC_STREN(7); + else if (chip->ecc.strength == 0x04) + phytium_nand->ndcr |= NDCR0_ECC_STREN(3); + else if (chip->ecc.strength == 0x02) + phytium_nand->ndcr |= NDCR0_ECC_STREN(1); + else + phytium_nand->ndcr |= NDCR0_ECC_STREN(0); + } + + value = phytium_read(nfc, NDCR0); + value &= ~NDCR0_EN; + phytium_write(nfc, NDCR0, value); + + value &= ~NDCR0_ECC_STREN(7); + value |= phytium_nand->ndcr; + phytium_write(nfc, NDCR0, value | NDCR0_EN); + + ret = phytium_nand_ecc_init(mtd, &chip->ecc); + if (ret) { + dev_err(nfc->dev, "ECC init failed: %d\n", ret); + goto out; + } + + /* + * Subpage write not available with hardware ECC, prohibit also + * subpage read as in userspace subpage access would still be + * allowed and subpage write, if used, would lead to numerous + * uncorrectable ECC errors. + */ + if (chip->ecc.engine_type == NAND_ECC_ENGINE_TYPE_ON_HOST) + chip->options |= NAND_NO_SUBPAGE_WRITE; + + /* + * We keep the MTD name unchanged to avoid breaking platforms + * where the MTD cmdline parser is used and the bootloader + * has not been updated to use the new naming scheme. + */ + if (nfc->caps->legacy_of_bindings) + mtd->name = "phytium_nand-0"; + +out: + return ret; +} + +static void phytium_nand_chips_cleanup(struct phytium_nfc *nfc) +{ + struct phytium_nand_chip *entry, *temp; + + list_for_each_entry_safe(entry, temp, &nfc->chips, node) { + /* Unregister device */ + WARN_ON(mtd_device_unregister(nand_to_mtd(&entry->chip))); + nand_cleanup(&entry->chip); + list_del(&entry->node); + } +} + +static int phytium_nfc_init_dma(struct phytium_nfc *nfc) +{ + int ret; + + ret = dma_set_mask_and_coherent(nfc->dev, DMA_BIT_MASK(64)); + if (ret) + return ret; + + nfc->dsp_addr = dma_alloc_coherent(nfc->dev, PAGE_SIZE, + &nfc->dsp_phy_addr, GFP_KERNEL | GFP_DMA); + if (!nfc->dsp_addr) + return -ENOMEM; + + nfc->dma_buf = dma_alloc_coherent(nfc->dev, MAX_CHUNK_SIZE, + &nfc->dma_phy_addr, GFP_KERNEL | GFP_DMA); + if (!nfc->dma_buf) + return -ENOMEM; + + dev_info(nfc->dev, "NFC address dsp_phy_addr:%llx, dma_phy_addr:%llx\n", + nfc->dsp_phy_addr, nfc->dma_phy_addr); + + return 0; +} + +int phytium_nfc_init(struct phytium_nfc *nfc) +{ + u32 value; + + nfc->inter_mode = ASYN_SDR; + nfc->timing_mode = ASY_MODE0; + + value = phytium_read(nfc, NDCR1); + value &= (~NDCR1_SAMPL_PHASE(0xFFFF)); + value &= ~NDCR1_ECC_DATA_FIRST_EN; + value |= NDCR1_SAMPL_PHASE(1); + value |= NDCR1_ECC_BYPASS; + phytium_write(nfc, NDCR1, value); + phytium_write(nfc, ND_INTERVAL_TIME, 1); + phytium_write(nfc, NDFIFO_LEVEL0, 4); + phytium_write(nfc, NDFIFO_LEVEL1, 4); + phytium_write(nfc, NDFIFO_CLR, 1); + phytium_write(nfc, ND_ERR_CLR, 1); + + /* Configure the DMA */ + phytium_nfc_init_dma(nfc); + + + + phytium_nfc_reset(nfc); + + value = phytium_read(nfc, NDCR0); + value &= (~NDCR0_IN_MODE(3)); + value |= NDCR0_IN_MODE(nfc->inter_mode); + value |= NDCR0_EN; + + phytium_write(nfc, NDCR0, value); + + nfc_ecc_errover = 0; + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nfc_init); + +static int phytium_nfc_setup_interface(struct nand_chip *chip, int chipnr, + const struct nand_interface_config *conf) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + unsigned int period_ns = 2; + const struct nand_sdr_timings *sdr; + struct phytium_nfc_timings nfc_tmg; + int read_delay; + + sdr = nand_get_sdr_timings(conf); + if (IS_ERR(sdr)) + return PTR_ERR(sdr); + + nfc_tmg.tRP = TO_CYCLES(DIV_ROUND_UP(sdr->tRC_min, 2), period_ns) - 1; + nfc_tmg.tRH = nfc_tmg.tRP; + nfc_tmg.tWP = TO_CYCLES(DIV_ROUND_UP(sdr->tWC_min, 2), period_ns) - 1; + nfc_tmg.tWH = nfc_tmg.tWP; + nfc_tmg.tCS = TO_CYCLES(sdr->tCS_min, period_ns); + nfc_tmg.tCH = TO_CYCLES(sdr->tCH_min, period_ns) - 1; + nfc_tmg.tADL = TO_CYCLES(sdr->tADL_min, period_ns); + dev_info(nfc->dev, "[nfc_tmg]tRP: %d, tRH:%d, tWP:%d tWH:%d\n", + nfc_tmg.tRP, nfc_tmg.tRH, nfc_tmg.tWP, nfc_tmg.tWH); + dev_info(nfc->dev, "[nfc_tmg]tCS: %d, tCH:%d, tADL:%d\n", + nfc_tmg.tCS, nfc_tmg.tCH, nfc_tmg.tADL); + + read_delay = sdr->tRC_min >= 30000 ? + MIN_RD_DEL_CNT : MIN_RD_DEL_CNT + nfc_tmg.tRH; + + nfc_tmg.tAR = TO_CYCLES(sdr->tAR_min, period_ns); + nfc_tmg.tWHR = TO_CYCLES(max_t(int, sdr->tWHR_min, sdr->tCCS_min), + period_ns) - 2, + nfc_tmg.tRHW = TO_CYCLES(max_t(int, sdr->tRHW_min, sdr->tCCS_min), + period_ns); + dev_info(nfc->dev, "[nfc_tmg]tAR: %d, tWHR:%d, tRHW:%d\n", + nfc_tmg.tAR, nfc_tmg.tWHR, nfc_tmg.tRHW); + + nfc_tmg.tR = TO_CYCLES(sdr->tWB_max, period_ns); + + if (chipnr < 0) + return 0; + + if (nfc_tmg.tWP > 0x10) + nfc->timing_mode = ASY_MODE1; + else if (nfc_tmg.tWP < 0x0D) + nfc->timing_mode = ASY_MODE3; + + if (nfc->inter_mode == ONFI_DDR) + nfc->timing_mode = SYN_MODE3; + + phytium_nfc_default_data_interface(nfc); + + return 0; +} + +static int phytium_nand_chip_init(struct phytium_nfc *nfc) +{ + struct device *dev = nfc->dev; + struct phytium_nand_chip *phytium_nand; + struct mtd_info *mtd; + struct nand_chip *chip; + int ret; + + /* Alloc the nand chip structure */ + phytium_nand = devm_kzalloc(dev, sizeof(*phytium_nand), GFP_KERNEL); + if (!phytium_nand) + return -ENOMEM; + + phytium_nand->nsels = 1; + phytium_nand->selected_die = -1; + + chip = &phytium_nand->chip; + chip->controller = &nfc->controller; + chip->legacy.select_chip = phytium_nfc_select_chip; + phytium_nfc_default_data_interface(nfc); + + mtd = nand_to_mtd(chip); + mtd->dev.parent = dev; + mtd->owner = THIS_MODULE; + + /* + * Default to HW ECC engine mode. If the nand-ecc-mode property is given + * in the DT node, this entry will be overwritten in nand_scan_ident(). + */ + chip->ecc.engine_type = NAND_ECC_ENGINE_TYPE_ON_HOST; + + chip->options |= NAND_BUSWIDTH_AUTO; + chip->options |= NAND_SKIP_BBTSCAN; + chip->bbt_options |= NAND_BBT_NO_OOB; + + ret = nand_scan(chip, phytium_nand->nsels); + if (ret) { + dev_err(dev, "could not scan the nand chip\n"); + goto out; + } + + if (nfc->caps->parts) { + ret = mtd_device_register(mtd, nfc->caps->parts, nfc->caps->nr_parts - 1); + } else if (dev->of_node) { + nand_set_flash_node(chip, dev->of_node); + ret = mtd_device_register(mtd, NULL, 0); + } else { + ret = -EINVAL; + } + + if (ret) { + dev_err(dev, "failed to register mtd device: %d\n", ret); + /* Unregister device */ + WARN_ON(mtd_device_unregister(mtd)); + nand_cleanup(mtd_to_nand(mtd)); + return ret; + } + + phytium_nand->ecc.length = phytium_nand_get_ecc_total(mtd, &chip->ecc); + phytium_nand->ecc.offset = mtd->oobsize - phytium_nand->ecc.length; + chip->ecc.total = phytium_nand_get_ecc_total(mtd, &chip->ecc); + + mtd_ooblayout_ecc(mtd, 0, &phytium_nand->ecc); + + dev_info(dev, "ooblayout ecc offset: %x, length: %x\n", + phytium_nand->ecc.offset, phytium_nand->ecc.length); + +out: + list_add_tail(&phytium_nand->node, &nfc->chips); + return 0; +} + +static const struct nand_controller_ops phytium_nand_controller_ops = { + .attach_chip = phytium_nand_attach_chip, + .exec_op = phytium_nfc_exec_op, + .setup_interface = phytium_nfc_setup_interface, +}; + +int phytium_nand_init(struct phytium_nfc *nfc) +{ + int ret; + + nand_controller_init(&nfc->controller); + nfc->controller.ops = &phytium_nand_controller_ops; + INIT_LIST_HEAD(&nfc->chips); + + /* Init the controller and then probe the chips */ + ret = phytium_nfc_init(nfc); + if (ret) + goto out; + + ret = phytium_nand_chip_init(nfc); + if (ret) + goto out; + + spin_lock_init(&nfc->spinlock); + +out: + return ret; +} +EXPORT_SYMBOL_GPL(phytium_nand_init); + +int phytium_nand_remove(struct phytium_nfc *nfc) +{ + phytium_nand_chips_cleanup(nfc); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nand_remove); + +static int phytium_nfc_wait_ndrun(struct nand_chip *chip) +{ + struct phytium_nfc *nfc = to_phytium_nfc(chip->controller); + int ret = 0; + u32 val; + + ret = readl_relaxed_poll_timeout(nfc->regs + NDSR, val, + (val & NDSR_RB) == 0, + 0, 100 * 1000); + if (ret) { + dev_err(nfc->dev, "Timeout on NAND controller run mode\n"); + ret = -EAGAIN; + } + + return ret; +} + +int phytium_nand_prepare(struct phytium_nfc *nfc) +{ + struct phytium_nand_chip *chip = NULL; + + list_for_each_entry(chip, &nfc->chips, node) + phytium_nfc_wait_ndrun(&chip->chip); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nand_prepare); + +int phytium_nand_resume(struct phytium_nfc *nfc) +{ + nfc->selected_chip = NULL; + phytium_nfc_init(nfc); + phytium_nfc_default_data_interface(nfc); + + return 0; +} +EXPORT_SYMBOL_GPL(phytium_nand_resume); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium NAND controller platform driver"); +MODULE_AUTHOR("Zhu Mingshuai "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand.h new file mode 100644 index 0000000000000000000000000000000000000000..d7a85fcaafa43e87e62e512676fb071a79d9e84c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand.h @@ -0,0 +1,449 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium NAND flash controller driver + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ +#ifndef PHYTIUM_NAND_H +#define PHYTIUM_NAND_H + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +/* NFC does not support transfers of larger chunks at a time */ +#define MAX_PAGE_NUM 16 +#define MAX_CHUNK_SIZE ((1024 + 76) * 16) + +#define POLL_PERIOD 0 +#define POLL_TIMEOUT 100000 +/* Interrupt maximum wait period in ms */ +#define IRQ_TIMEOUT 1000 + +/* Latency in clock cycles between SoC pins and NFC logic */ +#define MIN_RD_DEL_CNT 3 + +#define PHYTIUM_NFC_ADDR_MAX_LEN 5 +#define PHYTIUM_NFC_DSP_SIZE 16 + +/* NAND controller flash control register */ +#define NDCR0 0x00 +#define NDCR0_EN BIT(0) +#define NDCR0_WIDTH BIT(1) +#define NDCR0_IN_MODE(x) (min_t(u32, x, 0x3) << 2) +#define NDCR0_ECC_EN BIT(4) +#define NDCR0_ECC_STREN(x) (min_t(u32, x, 0x7) << 5) +#define NDCR0_SPARE_EN BIT(8) +#define NDCR0_SPARE_SIZE(x) (min_t(u32, x, 0xFFF) << 9) +#define NDCR0_GENERIC_FIELDS_MASK + +#define NDCR1 0x04 +#define NDCR1_SAMPL_PHASE(x) min_t(u32, x, 0xFFFF) +#define NDCR1_ECC_DATA_FIRST_EN BIT(16) +#define NDCR1_RB_SHARE_EN BIT(17) +#define NDCR1_ECC_BYPASS BIT(18) + +#define NDAR0 0x08 + +#define NDAR1 0x0C +#define NDAR1_H8(x) min_t(u32, x, 0xFF) +#define NDAR1_DMA_EN BIT(8) +#define NDAR1_EMPTY(x) (min_t(u32, x, 0x7F) << 9) +#define NDAR1_DMA_RLEN(x) (min_t(u32, x, 0xFF) << 9) +#define NDAR1_DMA_WLEN(x) (min_t(u32, x, 0xFF) << 9) + +#define NDTR0 0x10 +#define NDTR0_TCS_TCLS(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR0_TCLS_TWP(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR1 0x14 +#define NDTR1_TWH(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR1_TWP(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR2 0x18 +#define NDTR2_TCH_TCLH(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR2_TCLH_TWH(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR3 0x1c +#define NDTR3_TDQ_EN(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR3_TCH_TWH(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR4 0x20 +#define NDTR4_TWHR_SMX(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR4_TREH(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR5 0x24 +#define NDTR5_TRC(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR5_TADL_SMX(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR6 0x28 +#define NDTR6_TCAD_TCS_SMX(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR6_RES(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR7 0x2c +#define NDTR7_TCK(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR7_TDQ_EN(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR8 0x30 +#define NDTR8_TCAD_TCK_SMX(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR8_HF_TCK(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR9 0x34 +#define NDTR9_TWHR(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR9_TCCS_TCALS_SMX(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR10 0x38 +#define NDTR10_TCK(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR10_MTCK(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR11 0x3c +#define NDTR11_TCK_TCALS(x) (min_t(u32, x, 0xFFFF) << 16) +#define NDTR11_RES(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR12 0x40 +#define NDTR12_TWRCK(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR12_RES(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR13 0x44 +#define NDTR13_TWRHCA(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR13_TRLCA(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR14 0x48 +#define NDTR14_TWRHCE(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR14_RES(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR15 0x4c +#define NDTR15_TCDQSS_TWPRE_TDS(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR15_HFTDSC(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR16 0x50 +#define NDTR16_TWPST_TDH(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR16_TWPSTH(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR17 0x54 +#define NDTR17_TCS_TRPRE(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR17_TRELDQS(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDTR18 0x58 +#define NDTR18_TRPST_TDQSRE(x) (min_t(u32, x, 0xFFFF) << 0) +#define NDTR18_RES(x) (min_t(u32, x, 0xFFFF) << 16) + +#define NDFIFO 0x5c +#define NDFIFO_REV (min_t(u32, x, 0) << 12) +#define NDFIFO_FULL BIT(11) +#define NDFIFO_EMP BIT(10) +#define NDFIFO_CNT(x) (min_t(u32, x, 0x3F) << 0) + +#define ND_INTERVAL_TIME 0x60 +#define NDCMD_INTERVAL_TIME 0x64 +#define NDFIFO_TIMEOUT 0x68 +#define NDFIFO_LEVEL0 0x6c +#define NDFIFO_LEVEL1 0x70 +#define NDWP 0x74 +#define NDFIFO_CLR 0x78 + +#define NDSR 0x7c +#define NDSR_BUSY BIT(0) +#define NDSR_DMA_BUSY BIT(1) +#define NDSR_DMA_PGFINISH BIT(2) +#define NDSR_DMA_FINISH BIT(3) +#define NDSR_FIFO_EMP BIT(4) +#define NDSR_FIFO_FULL BIT(5) +#define NDSR_FIFO_TIMEOUT BIT(6) +#define NDSR_CS(x) (min_t(u32, x, 0xF) << 7) +#define NDSR_CMD_PGFINISH BIT(11) +#define NDSR_PG_PGFINISH BIT(12) +#define NDSR_RE BIT(13) +#define NDSR_DQS BIT(14) +#define NDSR_RB BIT(15) +#define NDSR_ECC_BUSY BIT(16) +#define NDSR_ECC_FINISH BIT(17) +#define NDSR_ECC_RIGHT BIT(18) +#define NDSR_ECC_ERR BIT(19) +#define NDSR_ECC_ERROVER BIT(20) +#define NDSR_AXI_DSP_ERR BIT(21) +#define NDSR_AXI_RD_ERR BIT(22) +#define NDSR_AXI_WR_ERR BIT(23) +#define NDSR_RB_STATUS(x) (min_t(u32, x, 0xF) << 24) +#define NDSR_PROT_ERR BIT(28) +#define NDSR_ECC_BYPASS BIT(29) + +#define NDIR_MASK 0x80 +#define NDIR_BUSY_MASK BIT(0) +#define NDIR_DMA_BUSY_MASK BIT(1) +#define NDIR_DMA_PGFINISH_MASK BIT(2) +#define NDIR_DMA_FINISH_MASK BIT(3) +#define NDIR_FIFO_EMP_MASK BIT(4) +#define NDIR_FIFO_FULL_MASK BIT(5) +#define NDIR_FIFO_TIMEOUT_MASK BIT(6) +#define NDIR_CMD_FINISH_MASK BIT(7) +#define NDIR_PGFINISH_MASK BIT(8) +#define NDIR_RE_MASK BIT(9) +#define NDIR_DQS_MASK BIT(10) +#define NDIR_RB_MASK BIT(11) +#define NDIR_ECC_FINISH_MASK BIT(12) +#define NDIR_ECC_ERR_MASK BIT(13) + +#define NDIR 0x84 +#define NDIR_ALL_INT(x) GENMASK(x, 0) +#define NDIR_BUSY BIT(0) +#define NDIR_DMA_BUSY BIT(1) +#define NDIR_DMA_PGFINISH BIT(2) +#define NDIR_DMA_FINISH BIT(3) +#define NDIR_FIFO_EMP BIT(4) +#define NDIR_FIFO_FULL BIT(5) +#define NDIR_FIFO_TIMEOUT BIT(6) +#define NDIR_CMD_FINISH BIT(7) +#define NDIR_PGFINISH BIT(8) +#define NDIR_RE BIT(9) +#define NDIR_DQS BIT(10) +#define NDIR_RB BIT(11) +#define NDIR_ECC_FINISH BIT(12) +#define NDIR_ECC_ERR BIT(13) + +#define ND_DEBUG 0x88 + +#define ND_ERR_CLR 0x8c +#define ND_DSP_ERR_CLR BIT(0) +#define ND_AXI_RD_ERR_CLR BIT(1) +#define ND_AXI_WR_ERR_CLR BIT(2) +#define ND_ECC_ERR_CLR BIT(3) + +#define NDCR_PAGE_SZ(x) (x >= 2048 ? BIT(24) : 0) + +enum nand_inter_pro { + NAND_ONFI, + NAND_JEDEC, + NAND_OTHER, +}; + +enum nand_inter_mode { + ASYN_SDR, + ONFI_DDR, + TOG_ASYN_DDR, +}; + +enum asy_timing_mode { + ASY_MODE0, + ASY_MODE1, + ASY_MODE2, + ASY_MODE3, + ASY_MODE4, +}; + +enum onfi_syn_timing_mode { + SYN_MODE0 = 0x10, + SYN_MODE1, + SYN_MODE2, + SYN_MODE3, + SYN_MODE4, +}; + +/** + * NAND controller timings expressed in NAND Controller clock cycles + * + * @tRP: ND_nRE pulse width + * @tRH: ND_nRE high duration + * @tWP: ND_nWE pulse time + * @tWH: ND_nWE high duration + * @tCS: Enable signal setup time + * @tCH: Enable signal hold time + * @tADL: Address to write data delay + * @tAR: ND_ALE low to ND_nRE low delay + * @tWHR: ND_nWE high to ND_nRE low for status read + * @tRHW: ND_nRE high duration, read to write delay + * @tR: ND_nWE high to ND_nRE low for read + */ +struct phytium_nfc_timings { + u16 tRP; + u16 tRH; + u16 tWP; /* NDTR1_TWP */ + u16 tWH; /* NDTR1_TWH */ + u16 tCS; + u16 tCH; + u16 tADL; + u16 tAR; + u16 tWHR; + u16 tRHW; + u16 tR; +}; + +/** + * NAND chip structure: stores NAND chip device related information + * + * @chip: Base NAND chip structure + * @node: Used to store NAND chips into a list + * @ndcr: Controller register value for this NAND chip + * @ndtr0: Timing registers 0 value for this NAND chip + * @ndtr1: Timing registers 1 value for this NAND chip + * @selected_die: Current active CS + * @nsels: Number of CS lines required by the NAND chip + */ +struct phytium_nand_chip { + struct nand_chip chip; + struct list_head node; + u32 ndcr; + u32 ndtr0; + u32 ndtr1; + int addr_cyc; + int selected_die; + unsigned int nsels; + struct mtd_oob_region ecc; +}; + +/** + * NAND controller capabilities for distinction between compatible strings + * + * @max_cs_nb: Number of Chip Select lines available + * @max_rb_nb: Number of Ready/Busy lines available + * @legacy_of_bindings: Indicates if DT parsing must be done using the old + * fashion way + * @flash_bbt: + * @ecc_strength: + * @ecc_step_size: + * @parts: + * @nr_parts: + */ +struct phytium_nfc_caps { + unsigned int hw_ver; + unsigned int int_mask_bits; + unsigned int max_cs_nb; + unsigned int max_rb_nb; + bool legacy_of_bindings; + bool flash_bbt; + int ecc_strength; + int ecc_step_size; + struct mtd_partition *parts; + unsigned int nr_parts; +}; + +/** + * NAND controller structure: stores Marvell NAND controller information + * + * @controller: Base controller structure + * @dev: Parent device (used to print error messages) + * @regs: NAND controller registers + * @reg_clk: Regiters clock + * @complete: Completion object to wait for NAND controller events + * @chips: List containing all the NAND chips attached to + * this NAND controller + * @caps: NAND controller capabilities for each compatible string + * @dma_buf: 32-bit aligned buffer for DMA transfers (NFCv1 only) + */ +struct phytium_nfc { + struct nand_controller controller; + struct device *dev; + void __iomem *regs; + int irq; + struct list_head chips; + struct nand_chip *selected_chip; + struct phytium_nfc_caps *caps; + + void *dsp_addr; + dma_addr_t dsp_phy_addr; + + void *dma_buf; + u32 dma_offset; + dma_addr_t dma_phy_addr; + + enum nand_inter_pro inter_pro; + enum nand_inter_mode inter_mode; + u32 timing_mode; + + spinlock_t spinlock; +}; + +/** + * Derives a duration in numbers of clock cycles. + * + * @ps: Duration in pico-seconds + * @period_ns: Clock period in nano-seconds + * + * Convert the duration in nano-seconds, then divide by the period and + * return the number of clock periods. + */ +#define TO_CYCLES(ps, period_ns) (DIV_ROUND_UP(ps / 1000, period_ns)) +#define TO_CYCLES64(ps, period_ns) (DIV_ROUND_UP_ULL(div_u64(ps, 1000), \ + period_ns)) + +struct phytium_nfc_cmd_ctrl { + u16 csel:4; + u16 dbc:1; + u16 addr_cyc:3; + u16 nc:1; +#define TYPE_RESET 0x00 +#define TYPE_SET_FTR 0x01 +#define TYPE_GET_FTR 0x02 +#define TYPE_READ_ID 0x03 +#define TYPE_PAGE_PRO 0x04 +#define TYPE_ERASE 0x05 +#define TYPE_READ 0x06 +#define TYPE_TOGGLE 0x07 +#define TYPE_READ_PARAM 0x02 +#define TYPE_READ_STATUS 0x03 +#define TYPE_CH_READ_COL 0x03 +#define TYPE_CH_ROW_ADDR 0x01 +#define TYPE_CH_WR_COL 0x01 + u16 cmd_type:4; + u16 dc:1; + u16 auto_rs:1; + u16 ecc_en:1; +}; + +/** + * NAND driver structure filled during the parsing of the ->exec_op() subop + * subset of instructions. + * + * @cle_ale_delay_ns: Optional delay after the last CMD or ADDR cycle + * @rdy_timeout_ms: Timeout for waits on Ready/Busy pin + * @rdy_delay_ns: Optional delay after waiting for the RB pin + * @data_delay_ns: Optional delay after the data xfer + * @data_instr_idx: Index of the data instruction in the subop + * @data_instr: Pointer to the data instruction in the subop + */ +struct phytium_nfc_op { + u8 cmd[2]; + union { + u16 ctrl; + struct phytium_nfc_cmd_ctrl nfc_ctrl; + } cmd_ctrl; + u8 addr[PHYTIUM_NFC_ADDR_MAX_LEN]; + u16 page_cnt; + u8 mem_addr_first[PHYTIUM_NFC_ADDR_MAX_LEN]; + + u32 cmd_len; + u32 addr_len; + + u32 cle_ale_delay_ns; + u32 rdy_timeout_ms; + u32 rdy_delay_ns; + u32 data_delay_ns; + u32 data_instr_idx; + struct nand_op_instr *data_instr; +} __packed; + +#define TIMING_ASY_NUM 12 +#define TIMING_SYN_NUM 14 +#define TIMING_TOG_NUM 12 + +#define TMP_DMA_DEBUG 0 /* Temporary dma space */ + +int phytium_nand_init(struct phytium_nfc *nfc); +int phytium_nand_remove(struct phytium_nfc *nfc); +int phytium_nand_prepare(struct phytium_nfc *nfc); +int phytium_nand_suspend(struct phytium_nfc *nfc); +int phytium_nand_resume(struct phytium_nfc *nfc); + +irqreturn_t phytium_nfc_isr(int irq, void *dev_id); + +#endif /* NAND_PHYTIUM_NAND_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand_pci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand_pci.c new file mode 100644 index 0000000000000000000000000000000000000000..62e64adea5454fcd1472b65829549f749a7c73e3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand_pci.c @@ -0,0 +1,150 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * PCI driver for Phytium NAND flash controller + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ +#include +#include +#include + +#include "phytium_nand.h" + +#define DRV_NAME "phytium_nand_pci" + +static struct mtd_partition partition_info[] = { + { + .name = "Flash partition 1", + .offset = 0x0000000, + .size = 0x4000000 }, + { + .name = "Flash partition 2", + .offset = 0x4000000, + .size = 0x8000000 }, + { + .name = "Flash partition 3", + .offset = 0x8000000, + .size = 0x10000000 }, + { + .name = "Flash partition 4", + .offset = 0x10000000, + .size = 0x12000000 }, + { + .name = "Flash partition 5", + .offset = 0x12000000, + .size = 0x14000000 }, +}; + +static struct phytium_nfc_caps x100_nfc_caps = { + .hw_ver = 1, + .int_mask_bits = 13, + .max_cs_nb = 2, + .max_rb_nb = 1, + .legacy_of_bindings = true, + .ecc_strength = 4, + .ecc_step_size = 512, + .nr_parts = 5, + .parts = partition_info, +}; + +static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) +{ + struct phytium_nfc *nfc; + int ret; + + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); + if (ret) { + dev_err(&pdev->dev, "I/O memory remapping failed\n"); + return ret; + } + + pci_set_master(pdev); + pci_try_set_mwi(pdev); + + nfc = devm_kzalloc(&pdev->dev, sizeof(struct phytium_nfc), + GFP_KERNEL); + if (!nfc) + return -ENOMEM; + + nfc->dev = &pdev->dev; + nfc->regs = pcim_iomap_table(pdev)[0]; + nfc->irq = pdev->irq; + nfc->caps = &x100_nfc_caps; + + ret = devm_request_irq(nfc->dev, nfc->irq, phytium_nfc_isr, + IRQF_SHARED, "phytium-nfc-pci", nfc); + if (ret) { + dev_err(nfc->dev, "Failed to register NFC interrupt.\n"); + return ret; + } + + ret = phytium_nand_init(nfc); + if (ret) + return ret; + + pci_set_drvdata(pdev, nfc); + + return ret; +} + +static void phytium_pci_remove(struct pci_dev *pdev) +{ + struct phytium_nfc *nfc = pci_get_drvdata(pdev); + int ret; + + ret = phytium_nand_remove(nfc); + if (ret) + dev_warn(&pdev->dev, "can't remove device properly: %d\n", ret); +} + +static int __maybe_unused phytium_nfc_prepare(struct device *dev) +{ + struct pci_dev *pci = to_pci_dev(dev); + struct phytium_nfc *nfc = pci_get_drvdata(pci); + int ret; + + ret = phytium_nand_prepare(nfc); + + return 0; +} + +static int __maybe_unused phytium_nfc_resume(struct device *dev) +{ + struct pci_dev *pci = to_pci_dev(dev); + struct phytium_nfc *nfc = pci_get_drvdata(pci); + int ret; + + ret = phytium_nand_resume(nfc); + + return ret; +} + +static const struct dev_pm_ops phytium_pci_dev_pm_ops = { + .prepare = phytium_nfc_prepare, + .resume = phytium_nfc_resume, +}; + +static const struct pci_device_id phytium_pci_id_table[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc29) }, + { } +}; +MODULE_DEVICE_TABLE(pci, phytium_pci_id_table); + +static struct pci_driver phytium_pci_driver = { + .name = DRV_NAME, + .id_table = phytium_pci_id_table, + .probe = phytium_pci_probe, + .remove = phytium_pci_remove, + .driver = { + .pm = &phytium_pci_dev_pm_ops, + }, +}; +module_pci_driver(phytium_pci_driver); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("PCI driver for Phytium NAND controller"); +MODULE_AUTHOR("Zhu Mingshuai "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand_plat.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand_plat.c new file mode 100644 index 0000000000000000000000000000000000000000..411a53a667c96a24c30ff29509e37c34a36dc213 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/mtd/nand/raw/phytium_nand_plat.c @@ -0,0 +1,138 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Core driver for Phytium NAND flash controller + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "phytium_nand.h" + +#define DRV_NAME "phytium_nand_plat" + +static int phytium_nfc_plat_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct resource *r; + struct phytium_nfc *nfc; + unsigned int ecc_strength; + unsigned int ecc_step_size; + int ret; + + nfc = devm_kzalloc(&pdev->dev, sizeof(struct phytium_nfc), + GFP_KERNEL); + if (!nfc) + return -ENOMEM; + + nfc->dev = dev; + + r = platform_get_resource(pdev, IORESOURCE_MEM, 0); + nfc->regs = devm_ioremap_resource(dev, r); + if (IS_ERR(nfc->regs)) + return PTR_ERR(nfc->regs); + + dev_info(nfc->dev, "NFC register address :%p, phy address:%llx\n", + nfc->regs, r->start); + + nfc->irq = platform_get_irq(pdev, 0); + if (nfc->irq < 0) { + dev_err(dev, "failed to retrieve irq\n"); + return nfc->irq; + } + + ret = devm_request_irq(dev, nfc->irq, phytium_nfc_isr, 0, + "phytium-nfc-plat", nfc); + if (ret) { + dev_err(nfc->dev, "Failed to register NFC interrupt.\n"); + return ret; + } + + nfc->caps = devm_kzalloc(dev, sizeof(struct phytium_nfc_caps), GFP_KERNEL); + if (!nfc->caps) + return -ENOMEM; + + /* Currently hard-coded parameters */ + nfc->caps->hw_ver = 2; + nfc->caps->int_mask_bits = 17; + nfc->caps->max_cs_nb = 4; + nfc->caps->max_rb_nb = 4; + nfc->caps->nr_parts = 0; + nfc->caps->parts = NULL; + + device_property_read_u32(&pdev->dev, "nand-ecc-strength", &ecc_strength); + nfc->caps->ecc_strength = ecc_strength ? ecc_strength : 8; + + device_property_read_u32(&pdev->dev, "nand-ecc-step-size", &ecc_step_size); + nfc->caps->ecc_step_size = ecc_step_size ? ecc_step_size : 512; + + ret = phytium_nand_init(nfc); + if (ret) + return ret; + + platform_set_drvdata(pdev, nfc); + + return ret; +} + +static int phytium_nfc_plat_remove(struct platform_device *pdev) +{ + struct phytium_nfc *nfc = platform_get_drvdata(pdev); + + return phytium_nand_remove(nfc); +} + +static int __maybe_unused phytium_nfc_plat_prepare(struct device *dev) +{ + struct phytium_nfc *nfc = dev_get_drvdata(dev); + + return phytium_nand_prepare(nfc); +} + +static int __maybe_unused phytium_nfc_plat_resume(struct device *dev) +{ + struct phytium_nfc *nfc = dev_get_drvdata(dev); + int ret; + + ret = phytium_nand_resume(nfc); + + return ret; +} + +static const struct dev_pm_ops phytium_dev_pm_ops = { + .prepare = phytium_nfc_plat_prepare, + .resume = phytium_nfc_plat_resume, +}; + +#ifdef CONFIG_OF +static const struct of_device_id phytium_nfc_of_ids[] = { + { .compatible = "phytium,nfc", }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(of, phytium_nfc_of_ids); +#endif + +static struct platform_driver phytium_nfc_plat_driver = { + .driver = { + .name = DRV_NAME, + .of_match_table = phytium_nfc_of_ids, + .pm = &phytium_dev_pm_ops, + }, + .probe = phytium_nfc_plat_probe, + .remove = phytium_nfc_plat_remove, +}; +module_platform_driver(phytium_nfc_plat_driver) + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium NAND controller Platform driver"); +MODULE_AUTHOR("Zhu Mingshuai "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..a23216d23c22626a97244e0e48f66411ca4ed1b7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/Kconfig @@ -0,0 +1,34 @@ +# SPDX-License-Identifier: GPL-2.0-only +menuconfig CAN_PHYTIUM + tristate "Phytium CAN support" + help + Say Y here if you want support for Phytium CAN controller framework. + This is common support for devices that embed the Phytium CAN IP. + + To compile this driver as a module, choose M here: the module will + be called phytium_can. + +if CAN_PHYTIUM + +config CAN_PHYTIUM_PLATFORM + tristate "Phytium CAN support for io-mapped devices" + depends on HAS_IOMEM + help + Say Y here is you want to support for IO Mapped Phytium CAN controller. + This support is for devices that have the Phytium CAN controller IP + embedded into the device and the IP is IO Mapped to the processor. + + To compile this driver as a module, choose M here: the module will + be called phytium_can_platform. + +config CAN_PHYTIUM_PCI + tristate "Phytium CAN support for PCI devices" + depends on PCI + help + Say Y here is you want to support for Phytium CAN controller connected + to the PCI bus. This support is for devices that have the Phytium CAN + controller IP embedded into a PCI device. + + To compile this driver as a module, choose M here: the module will + be called phytium_can_pci. +endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..7ef554fca58e4b5ded60b3bcdb6f9c282d5deda3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/Makefile @@ -0,0 +1,8 @@ +# +# Makefile for the Phytium CAN controller drivers. +# +# + +obj-$(CONFIG_CAN_PHYTIUM) += phytium_can.o +obj-$(CONFIG_CAN_PHYTIUM_PLATFORM) += phytium_can_platform.o +obj-$(CONFIG_CAN_PHYTIUM_PCI) += phytium_can_pci.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/phytium_can.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/phytium_can.c new file mode 100644 index 0000000000000000000000000000000000000000..52564c4aaa60e3be438e5754fc0e49487a67bf0b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/phytium_can.c @@ -0,0 +1,1191 @@ +// SPDX-License-Identifier: GPL-2.0 +/* CAN bus driver for Phytium CAN controller + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include + +#include "phytium_can.h" + +/* register definition */ +enum phytium_can_reg { + CAN_CTRL = 0x00, /* Global control register */ + CAN_INTR = 0x04, /* Interrupt register */ + CAN_ARB_RATE_CTRL = 0x08, /* Arbitration rate control register */ + CAN_DAT_RATE_CTRL = 0x0c, /* Data rate control register */ + CAN_ACC_ID0 = 0x10, /* Acceptance identifier0 register */ + CAN_ACC_ID1 = 0x14, /* Acceptance identifier1 register */ + CAN_ACC_ID2 = 0x18, /* Acceptance identifier2 register */ + CAN_ACC_ID3 = 0x1c, /* Acceptance identifier3 register */ + CAN_ACC_ID0_MASK = 0x20, /* Acceptance identifier0 mask register */ + CAN_ACC_ID1_MASK = 0x24, /* Acceptance identifier1 mask register */ + CAN_ACC_ID2_MASK = 0x28, /* Acceptance identifier2 mask register */ + CAN_ACC_ID3_MASK = 0x2c, /* Acceptance identifier3 mask register */ + CAN_XFER_STS = 0x30, /* Transfer status register */ + CAN_ERROR_CNT = 0x34, /* Error counter register */ + CAN_FIFO_CNT = 0x38, /* FIFO counter register */ + CAN_DMA_CTRL = 0x3c, /* DMA request control register */ + CAN_XFER_EN = 0x40, /* Transfer enable register */ + CAN_INTR1 = 0x44, /* Interrupt register 1 */ + CAN_FRM_INFO = 0x48, /* Frame valid number register */ + CAN_TIME_OUT = 0x4c, /* Timeout register */ + CAN_TIME_OUT_CNT = 0x50, /* Timeout counter register */ + CAN_INTR2 = 0x54, /* Interrupt register 2 */ + CAN_TX_FIFO = 0x100, /* TX FIFO shadow register */ + CAN_RX_FIFO = 0x200, /* RX FIFO shadow register */ + CAN_RX_INFO_FIFO = 0x300, /* RX information FIFO shadow register */ + CAN_PIDR4 = 0xfd0, /* Peripheral Identification Register 4 */ + CAN_PIDR0 = 0xfe0, /* Peripheral Identification Register 0 */ + CAN_PIDR1 = 0xfe4, /* Peripheral Identification Register 1 */ + CAN_PIDR2 = 0xfe8, /* Peripheral Identification Register 2 */ + CAN_PIDR3 = 0xfec, /* Peripheral Identification Register 3 */ + CAN_CIDR0 = 0xff0, /* Component Identification Register 0 */ + CAN_CIDR1 = 0xff4, /* Component Identification Register 1 */ + CAN_CIDR2 = 0xff8, /* Component Identification Register 2 */ + CAN_CIDR3 = 0xffc, /* Component Identification Register 3 */ +}; + +/* Global control register (CTRL) */ +#define CTRL_XFER BIT(0) /* Transfer enable */ +#define CTRL_TXREQ BIT(1) /* Transmit request */ +#define CTRL_AIME BIT(2) /* Acceptance identifier mask enable */ +#define CTRL_TTS BIT(3) /* Transmit trigger strategy */ +#define CTRL_RST BIT(7) /* Write 1 to soft reset and self clear */ +#define CTRL_RFEIDF BIT(8) /* Allow RX frame end interrupt during ID filtered frame */ +#define CTRL_RFEDT BIT(9) /* Allow RX frame end interrupt during TX frame */ +#define CTRL_IOF BIT(10) /* Ignore overload flag internally */ +#define CTRL_FDCRC BIT(11) /* CANFD CRC mode */ + +/* Interrupt register (INTR) */ +#define INTR_BOIS BIT(0) /* Bus off interrupt status */ +#define INTR_PWIS BIT(1) /* Passive warning interrupt status */ +#define INTR_PEIS BIT(2) /* Passive error interrupt status */ +#define INTR_RFIS BIT(3) /* RX FIFO full interrupt status */ +#define INTR_TFIS BIT(4) /* TX FIFO empty interrupt status */ +#define INTR_REIS BIT(5) /* RX frame end interrupt status */ +#define INTR_TEIS BIT(6) /* TX frame end interrupt status */ +#define INTR_EIS BIT(7) /* Error interrupt status */ +#define INTR_BOIE BIT(8) /* Bus off interrupt enable */ +#define INTR_PWIE BIT(9) /* Passive warning interrupt enable */ +#define INTR_PEIE BIT(10) /* Passive error interrupt enable */ +#define INTR_RFIE BIT(11) /* RX FIFO full interrupt enable */ +#define INTR_TFIE BIT(12) /* TX FIFO empty interrupt enable */ +#define INTR_REIE BIT(13) /* RX frame end interrupt enable */ +#define INTR_TEIE BIT(14) /* TX frame end interrupt enable */ +#define INTR_EIE BIT(15) /* Error interrupt enable */ +#define INTR_BOIC BIT(16) /* Bus off interrupt clear */ +#define INTR_PWIC BIT(17) /* Passive warning interrupt clear */ +#define INTR_PEIC BIT(18) /* Passive error interrupt clear */ +#define INTR_RFIC BIT(19) /* RX FIFO full interrupt clear */ +#define INTR_TFIC BIT(20) /* TX FIFO empty interrupt clear */ +#define INTR_REIC BIT(21) /* RX frame end interrupt clear */ +#define INTR_TEIC BIT(22) /* TX frame end interrupt clear */ +#define INTR_EIC BIT(23) /* Error interrupt clear */ + +#define INTR_STATUS_MASK (INTR_BOIS | INTR_PWIS | INTR_PEIS | INTR_RFIS | \ + INTR_TFIS | INTR_REIS | INTR_TEIS | INTR_EIS) + +#define INTR_EN_MASK (INTR_BOIE | INTR_PWIE | INTR_PEIE | INTR_RFIE | \ + INTR_REIE | INTR_TEIE | INTR_EIE) + +#define INTR_CLEAR_MASK (INTR_BOIC | INTR_PWIC | INTR_PEIC | INTR_RFIC | \ + INTR_TFIC | INTR_REIC | INTR_TEIC | INTR_EIC) + +/* Arbitration rate control register (ARB_RATE_CTRL) */ +#define ARB_RATE_CTRL_ARJW GENMASK(1, 0) /* Arbitration field resync jump width */ +#define ARB_RATE_CTRL_APRS GENMASK(4, 2) /* Arbitration field propagation segment */ +#define ARB_RATE_CTRL_APH1S GENMASK(7, 5) /* Arbitration field phase1 segment */ +#define ARB_RATE_CTRL_APH2S GENMASK(10, 8) /* Arbitration field phase2 segment */ +#define ARB_RATE_CTRL_APD GENMASK(28, 16) /* Arbitration field prescaler divider */ + +/* Data rate control register (DAT_RATE_CTRL) */ +#define DAT_RATE_CTRL_DRJW GENMASK(1, 0) /* Data field resync jump width */ +#define DAT_RATE_CTRL_DPRS GENMASK(4, 2) /* Data field propagation segment */ +#define DAT_RATE_CTRL_DPH1S GENMASK(7, 5) /* Data field phase1 segment */ +#define DAT_RATE_CTRL_DPH2S GENMASK(10, 8) /* Data field phase2 segment */ +#define DAT_RATE_CTRL_DPD GENMASK(28, 16) /* Data field prescaler divider */ + +/* Acceptance identifierX register (ACC_IDX) */ +#define ACC_IDX_AID_MASK GENMASK(28, 0) /* Acceptance identifier */ + +/* Acceptance identifier0 mask register (ACC_ID0_MASK) */ +#define ACC_IDX_MASK_AID_MASK GENMASK(28, 0) /* Acceptance identifier mask */ + +/* Transfer status register (XFER_STS) */ +#define XFER_STS_FRAS GENMASK(2, 0) /* Frame status */ +#define XFER_STS_FIES GENMASK(7, 3) /* Field status */ +#define XFER_STS_FIES_IDLE (0x0) /* idle */ +#define XFER_STS_FIES_ARBITRATION (0x1) /* arbitration */ +#define XFER_STS_FIES_TX_CTRL (0x2) /* transmit control */ +#define XFER_STS_FIES_TX_DATA (0x3) /* transmit data */ +#define XFER_STS_FIES_TX_CRC (0x4) /* transmit crc */ +#define XFER_STS_FIES_TX_FRM (0x5) /* transmit frame */ +#define XFER_STS_FIES_RX_CTRL (0x6) /* receive control */ +#define XFER_STS_FIES_RX_DATA (0x7) /* receive data */ +#define XFER_STS_FIES_RX_CRC (0x8) /* receive crc */ +#define XFER_STS_FIES_RX_FRM (0x9) /* receive frame */ +#define XFER_STS_FIES_INTERMISSION (0xa) /* intermission */ +#define XFER_STS_FIES_TX_SUSPD (0xb) /* transmit suspend */ +#define XFER_STS_FIES_BUS_IDLE (0xc) /* bus idle */ +#define XFER_STS_FIES_OVL_FLAG (0xd) /* overload flag */ +#define XFER_STS_FIES_OVL_DLM (0xe) /* overload delimiter */ +#define XFER_STS_FIES_ERR_FLAG (0xf) /* error flag */ +#define XFER_STS_FIES_ERR_DLM (0x10) /* error delimiter */ +#define XFER_STS_FIES_BUS_OFF (0x11) /* bus off */ +#define XFER_STS_TS BIT(8) /* Transmit status */ +#define XFER_STS_RS BIT(9) /* Receive status */ +#define XFER_STS_XFERS BIT(10) /* Transfer status */ + +/* Error counter register (ERR_CNT) */ +#define ERR_CNT_REC GENMASK(8, 0) /* Receive error counter */ +#define ERR_CNT_TEC GENMASK(24, 16) /* Transmit error counter */ + +/* FIFO counter register (FIFO_CNT) */ +#define FIFO_CNT_RFN GENMASK(6, 0) /* Receive FIFO valid data number */ +#define FIFO_CNT_TFN GENMASK(22, 16) /* Transmit FIFO valid data number */ + +/* DMA request control register (DMA_CTRL) */ +#define DMA_CTRL_RFTH GENMASK(5, 0) /* Receive FIFO DMA request threshold */ +#define DMA_CTRL_RFRE BIT(6) /* Receive FIFO DMA request enable */ +#define DMA_CTRL_TFTH GENMASK(21, 16) /* Transmit FIFO DMA request threshold */ +#define DMA_CTRL_TFRE BIT(22) /* Transmit FIFO DMA request enable */ + +/* Transfer enable register (XFER_EN) */ +#define XFER_EN_XFER BIT(0) /* Transfer enable */ + +/* Interrupt register 1 (INTR1) */ +#define INTR1_RF1IS BIT(0) /* RX FIFO 1/4 interrupt status */ +#define INTR1_RF2IS BIT(1) /* RX FIFO 1/2 interrupt status */ +#define INTR1_RF3IS BIT(2) /* RX FIFO 3/4 interrupt status */ +#define INTR1_RF4IS BIT(3) /* RX FIFO full interrupt status */ +#define INTR1_TF1IS BIT(4) /* TX FIFO 1/4 interrupt status */ +#define INTR1_TF2IS BIT(5) /* TX FIFO 1/2 interrupt status */ +#define INTR1_TF3IS BIT(6) /* TX FIFO 3/4 interrupt status */ +#define INTR1_TF4IS BIT(7) /* TX FIFO empty interrupt status */ +#define INTR1_RF1IE BIT(8) /* RX FIFO 1/4 interrupt enable */ +#define INTR1_RF2IE BIT(9) /* RX FIFO 1/2 interrupt enable */ +#define INTR1_RF3IE BIT(10) /* RX FIFO 3/4 interrupt enable */ +#define INTR1_RF4IE BIT(11) /* RX FIFO full interrupt enable */ +#define INTR1_TF1IE BIT(12) /* TX FIFO 1/4 interrupt enable */ +#define INTR1_TF2IE BIT(13) /* TX FIFO 1/2 interrupt enable */ +#define INTR1_TF3IE BIT(14) /* TX FIFO 3/4 interrupt enable */ +#define INTR1_TF4IE BIT(15) /* TX FIFO empty interrupt enable */ +#define INTR1_RF1IC BIT(16) /* RX FIFO 1/4 interrupt clear */ +#define INTR1_RF2IC BIT(17) /* RX FIFO 1/2 interrupt clear */ +#define INTR1_RF3IC BIT(18) /* RX FIFO 3/4 interrupt clear */ +#define INTR1_RF4IC BIT(19) /* RX FIFO full interrupt clear */ +#define INTR1_TF1IC BIT(20) /* TX FIFO 1/4 interrupt clear */ +#define INTR1_TF2IC BIT(21) /* TX FIFO 1/2 interrupt clear */ +#define INTR1_TF3IC BIT(22) /* TX FIFO 3/4 interrupt clear */ +#define INTR1_TF4IC BIT(23) /* TX FIFO empty interrupt clear */ +#define INTR1_RF1RIS BIT(24) /* RX FIFO 1/4 raw interrupt status */ +#define INTR1_RF2RIS BIT(25) /* RX FIFO 1/2 raw interrupt status */ +#define INTR1_RF3RIS BIT(26) /* RX FIFO 3/4 raw interrupt status */ +#define INTR1_RF4RIS BIT(27) /* RX FIFO full raw interrupt status */ +#define INTR1_TF1RIS BIT(28) /* TX FIFO 1/4 raw interrupt status */ +#define INTR1_TF2RIS BIT(29) /* TX FIFO 1/2 raw interrupt status */ +#define INTR1_TF3RIS BIT(30) /* TX FIFO 3/4 raw interrupt status */ +#define INTR1_TF4RIS BIT(31) /* TX FIFO empty raw interrupt status */ + +/* Frame valid number register (FRM_INFO) */ +#define FRM_INFO_RXFC GENMASK(5, 0) /* Valid frame number in RX FIFO */ +#define FRM_INFO_SSPD GENMASK(31, 16) /* Secondary sample point delay */ + +/* Interrupt register 2 (INTR2) */ +#define INTR2_TOIS BIT(0) /* RX FIFO time out interrupt status */ +#define INTR2_TOIM BIT(8) /* RX FIFO time out interrupt mask */ +#define INTR2_TOIC BIT(16) /* RX FIFO time out interrupt clear */ +#define INTR2_TORIS BIT(24) /* RX FIFO time out raw interrupt status */ + +/* RX information FIFO shadow register (RX_INFO_FIFO) */ +#define RX_INFO_FIFO_WNORF GENMASK(4, 0) /* Word (4-byte) number of current receive frame */ +#define RX_INFO_FIFO_RORF BIT(5) /* RTR value of current receive frame */ +#define RX_INFO_FIFO_FORF BIT(6) /* FDF value of current receive frame */ +#define RX_INFO_FIFO_IORF BIT(7) /* IDE value of current receive frame */ + +/* Arbitration Bits */ +#define CAN_ID1_MASK GENMASK(31, 21) /* Base identifer */ +/* Standard Remote Transmission Request */ +#define CAN_ID1_RTR_MASK BIT(20) +/* Extended Substitute remote TXreq */ +#define CAN_ID2_SRR_MASK BIT(20) +#define CAN_IDE_MASK BIT(19) /* IDentifier extension flag */ +#define CAN_ID2_MASK GENMASK(18, 1) /* Identifier extension */ +/* Extended frames remote TX request */ +#define CAN_ID2_RTR_MASK BIT(0) +#define CAN_ID1_FDF_MASK BIT(18) +#define CAN_ID1_DLC_MASK GENMASK(17, 14) +#define CANFD_ID1_BRS_MASK BIT(16) +#define CANFD_ID1_ESI_MASK BIT(15) +#define CANFD_ID1_DLC_MASK GENMASK(14, 11) + +#define CAN_ID2_FDF_MASK BIT(31) +#define CAN_ID2_DLC_MASK GENMASK(29, 26) +#define CANFD_ID2_BRS_MASK BIT(29) +#define CANFD_ID2_ESI_MASK BIT(28) +#define CANFD_ID2_DLC_MASK GENMASK(27, 24) + +#define CAN_ID1_DLC_OFF 14 +#define CANFD_ID1_DLC_OFF 11 +#define CAN_ID2_DLC_OFF 26 +#define CANFD_ID2_DLC_OFF 24 + +#define CAN_IDR_ID1_SHIFT 21 /* Standard Messg Identifier */ +#define CAN_IDR_ID2_SHIFT 1 /* Extended Message Identifier */ +#define CAN_IDR_SDLC_SHIFT 14 +#define CAN_IDR_EDLC_SHIFT 26 + +/* CANFD Standard msg padding 1 */ +#define CANFD_IDR_PAD_MASK 0x000007FF +#define CAN_IDR_PAD_MASK 0x00003FFF /* Standard msg padding 1 */ + +/** + * phytium_can_set_reg_bits - set a bit value to the device register + * @cdev: Driver private data structure + * @reg: Register offset + * @bs: The bit mask + * + * Read data from the particular CAN register + * Return: value read from the CAN register + */ +static void +phytium_can_set_reg_bits(const struct phytium_can_dev *cdev, + enum phytium_can_reg reg, u32 bs) +{ + u32 val = readl(cdev->base + reg); + + val |= bs; + writel(val, cdev->base + reg); +} + +/** + * phytium_can_clr_reg_bits - clear a bit value to the device register + * @cdev: Driver private data structure + * @reg: Register offset + * @bs: The bit mask + * + * Read data from the particular CAN register + * Return: value read from the CAN register + */ +static void +phytium_can_clr_reg_bits(const struct phytium_can_dev *cdev, + enum phytium_can_reg reg, u32 bs) +{ + u32 val = readl(cdev->base + reg); + + val &= ~bs; + writel(val, cdev->base + reg); +} + +static inline u32 phytium_can_read(const struct phytium_can_dev *cdev, enum phytium_can_reg reg) +{ + return readl(cdev->base + reg); +} + +static inline void phytium_can_write(const struct phytium_can_dev *cdev, enum phytium_can_reg reg, + u32 val) +{ + writel(val, cdev->base + reg); +} + +static inline void phytium_can_enable_all_interrupts(struct phytium_can_dev *cdev) +{ + phytium_can_write(cdev, CAN_INTR, INTR_EN_MASK); +} + +static inline void phytium_can_disable_all_interrupt(struct phytium_can_dev *cdev) +{ + phytium_can_write(cdev, CAN_INTR, 0x0); +} + +static int phytium_can_get_berr_counter(const struct net_device *dev, + struct can_berr_counter *bec) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + + bec->rxerr = phytium_can_read(cdev, CAN_ERROR_CNT) & ERR_CNT_REC; + bec->txerr = (phytium_can_read(cdev, CAN_ERROR_CNT) & ERR_CNT_TEC) >> 16; + + return 0; +} + +static int phytium_can_read_fifo(struct net_device *dev) +{ + struct net_device_stats *stats = &dev->stats; + struct phytium_can_dev *cdev = netdev_priv(dev); + struct canfd_frame *cf; + struct sk_buff *skb; + u32 id, dlc, i; + + /* Read the frame header from FIFO */ + id = phytium_can_read(cdev, CAN_RX_FIFO); + id = be32_to_cpup(&id); + if (id & CAN_IDE_MASK) { + /* Received an extended frame */ + dlc = phytium_can_read(cdev, CAN_RX_FIFO); + dlc = be32_to_cpup(&dlc); + if (dlc & CAN_ID2_FDF_MASK) + skb = alloc_canfd_skb(dev, &cf); + else + skb = alloc_can_skb(dev, (struct can_frame **)&cf); + + if (unlikely(!skb)) { + stats->rx_dropped++; + return 0; + } + + if (dlc & CAN_ID2_FDF_MASK) { + /* CAN FD extended frame */ + if (dlc & CANFD_ID2_BRS_MASK) + cf->flags |= CANFD_BRS; + if (dlc & CANFD_ID2_ESI_MASK) + cf->flags |= CANFD_ESI; + cf->len = can_fd_dlc2len((dlc & CANFD_ID2_DLC_MASK) >> CANFD_ID2_DLC_OFF); + } else { + /* CAN extended frame */ + cf->len = can_cc_dlc2len((dlc & CAN_ID2_DLC_MASK) >> CAN_ID2_DLC_OFF); + } + + cf->can_id = (id & CAN_ID1_MASK) >> 3; + cf->can_id |= (id & CAN_ID2_MASK) >> 1; + cf->can_id |= CAN_EFF_FLAG; + + if (id & CAN_ID2_RTR_MASK) + cf->can_id |= CAN_RTR_FLAG; + } else { + /* Received a standard frame */ + if (id & CAN_ID1_FDF_MASK) + skb = alloc_canfd_skb(dev, &cf); + else + skb = alloc_can_skb(dev, (struct can_frame **)&cf); + + if (unlikely(!skb)) { + stats->rx_dropped++; + return 0; + } + + if (id & CAN_ID1_FDF_MASK) { + /* CAN FD extended frame */ + if (id & CANFD_ID1_BRS_MASK) + cf->flags |= CANFD_BRS; + if (id & CANFD_ID1_ESI_MASK) + cf->flags |= CANFD_ESI; + cf->len = can_fd_dlc2len((id & CANFD_ID1_DLC_MASK) >> CANFD_ID1_DLC_OFF); + } else { + /* CAN extended frame */ + cf->len = can_cc_dlc2len((id & CAN_ID1_DLC_MASK) >> CAN_ID1_DLC_OFF); + } + + cf->can_id = (id & CAN_ID1_MASK) >> 21; + + if (id & CAN_ID1_RTR_MASK) + cf->can_id |= CAN_RTR_FLAG; + } + + if (!(cf->can_id & CAN_RTR_FLAG)) + /* Receive data frames */ + for (i = 0; i < cf->len; i += 4) + *(__be32 *)(cf->data + i) = phytium_can_read(cdev, CAN_RX_FIFO); + + stats->rx_packets++; + stats->rx_bytes += cf->len; + netif_receive_skb(skb); + + return 1; +} + +static int phytium_can_do_rx_poll(struct net_device *dev, int quota) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + u32 rxfs, pkts = 0; + + rxfs = phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_RFN; + if (!rxfs) { + netdev_dbg(dev, "no messages in RX FIFO\n"); + return 0; + } + + while ((rxfs != 0) && (quota > 0)) { + pkts += phytium_can_read_fifo(dev); + quota--; + rxfs = phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_RFN; + netdev_dbg(dev, "Next received %d frame again.\n", rxfs); + } + + return pkts; +} + +static int phytium_can_poll(struct napi_struct *napi, int quota) +{ + struct net_device *dev = napi->dev; + struct phytium_can_dev *cdev = netdev_priv(dev); + int work_done; + unsigned long flags; + + netdev_dbg(dev, "The receive processing is going on !\n"); + + work_done = phytium_can_do_rx_poll(dev, quota); + + /* Don't re-enable interrupts if the driver had a fatal error + * (e.g., FIFO read failure) + */ + if (work_done >= 0 && work_done < quota) { + napi_complete_done(napi, work_done); + + spin_lock_irqsave(&cdev->lock, flags); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_REIE); + spin_unlock_irqrestore(&cdev->lock, flags); + } + + return work_done; +} + +static void phytium_can_write_frame(struct phytium_can_dev *cdev) +{ + struct canfd_frame *cf = (struct canfd_frame *)cdev->tx_skb->data; + struct net_device *dev = cdev->net; + struct net_device_stats *stats = &dev->stats; + struct sk_buff *skb = cdev->tx_skb; + u32 i, id, dlc = 0, frame_head[2] = {0, 0}; + u32 data_len; + unsigned int len; + + data_len = can_fd_len2dlc(cf->len); + cdev->tx_skb = NULL; + + /* Watch carefully on the bit sequence */ + if (cf->can_id & CAN_EFF_FLAG) { + /* Extended CAN ID format */ + id = ((cf->can_id & CAN_EFF_MASK) << 1) & CAN_ID2_MASK; + id |= (((cf->can_id & CAN_EFF_MASK) >> + (CAN_EFF_ID_BITS - CAN_SFF_ID_BITS)) << + CAN_IDR_ID1_SHIFT) & CAN_ID1_MASK; + + /* The substibute remote TX request bit should be "1" + * for extended frames as in the Phytium CAN datasheet + */ + id |= CAN_IDE_MASK | CAN_ID2_SRR_MASK; + + if (cf->can_id & CAN_RTR_FLAG) + /* Extended frames remote TX request */ + id |= CAN_ID2_RTR_MASK; + if ((cdev->can.ctrlmode & CAN_CTRLMODE_FD) && + can_is_canfd_skb(skb)) + dlc = data_len << CANFD_ID2_DLC_OFF; + else + dlc = data_len << CAN_ID2_DLC_OFF; + + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { + dlc |= CAN_ID2_FDF_MASK; + if (cf->flags & CANFD_BRS) + dlc |= CANFD_ID2_BRS_MASK; + if (cf->flags & CANFD_ESI) + dlc |= CANFD_ID2_ESI_MASK; + } + + frame_head[0] = cpu_to_be32p(&id); + frame_head[1] = cpu_to_be32p(&dlc); + + /* Write the Frame to Phytium CAN TX FIFO */ + phytium_can_write(cdev, CAN_TX_FIFO, frame_head[0]); + phytium_can_write(cdev, CAN_TX_FIFO, frame_head[1]); + netdev_dbg(dev, "Write atbitration field [0]:0x%x [1]:0x%x\n", + frame_head[0], frame_head[1]); + } else { + /* Standard CAN ID format */ + id = ((cf->can_id & CAN_SFF_MASK) << CAN_IDR_ID1_SHIFT) + & CAN_ID1_MASK; + + if (cf->can_id & CAN_RTR_FLAG) + /* Standard frames remote TX request */ + id |= CAN_ID1_RTR_MASK; + + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) + dlc = (data_len << CANFD_ID1_DLC_OFF) + | CANFD_IDR_PAD_MASK; + else + dlc = (data_len << CAN_ID1_DLC_OFF) | CAN_IDR_PAD_MASK; + + id |= dlc; + + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { + id |= CAN_ID1_FDF_MASK; + if (cf->flags & CANFD_BRS) + id |= CANFD_ID1_BRS_MASK; + if (cf->flags & CANFD_ESI) + id |= CANFD_ID1_ESI_MASK; + } + + frame_head[0] = cpu_to_be32p(&id); + /* Write the Frame to Phytium CAN TX FIFO */ + phytium_can_write(cdev, CAN_TX_FIFO, frame_head[0]); + netdev_dbg(dev, "Write atbitration field [0] 0x%x\n", + frame_head[0]); + } + + if (!(cf->can_id & CAN_RTR_FLAG)) { + netdev_dbg(dev, "Write CAN data frame\n"); + for (i = 0; i < cf->len; i += 4) { + phytium_can_write(cdev, CAN_TX_FIFO, + *(__be32 *)(cf->data + i)); + netdev_dbg(dev, "[%d]:%x\n", i, + *(__be32 *)(cf->data + i)); + } + } + + stats->tx_bytes += cf->len; + stats->tx_packets++; + + cdev->is_tx_done = false; + cdev->is_need_stop_xmit = true; + mod_timer(&cdev->timer, jiffies + HZ / 10); + + netdev_dbg(dev, "Trigger send message!\n"); + + can_put_echo_skb(skb, dev, 0, 0); + len = can_get_echo_skb(dev, 0, NULL); + return; +} + +static netdev_tx_t phytium_can_tx_handler(struct phytium_can_dev *cdev) +{ + struct net_device *dev = cdev->net; + u32 tx_fifo_used; + unsigned long flags; + + phytium_can_write_frame(cdev); + /* Check if the TX buffer is full */ + tx_fifo_used = 4 * ((phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_TFN) >> 16); + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { + if (CAN_FIFO_BYTE_LEN - tx_fifo_used <= KEEP_CANFD_FIFO_MIN_LEN) { + netif_stop_queue(dev); + spin_lock_irqsave(&cdev->lock, flags); + cdev->is_stop_queue_flag = STOP_QUEUE_TRUE; + spin_unlock_irqrestore(&cdev->lock, flags); + } + } else { + if (CAN_FIFO_BYTE_LEN - tx_fifo_used <= KEEP_CAN_FIFO_MIN_LEN) { + netif_stop_queue(dev); + spin_lock_irqsave(&cdev->lock, flags); + cdev->is_stop_queue_flag = STOP_QUEUE_TRUE; + spin_unlock_irqrestore(&cdev->lock, flags); + } + } + + return NETDEV_TX_OK; +} + +/** + * phytium_can_tx_interrupt - Tx Done Isr + * @ndev: net_device pointer + * @isr: Interrupt status register value + */ +static void phytium_can_tx_interrupt(struct net_device *ndev, u32 isr) +{ + struct phytium_can_dev *cdev = netdev_priv(ndev); + struct net_device_stats *stats = &ndev->stats; + u32 tx_fifo_used = 0; + + if (isr & INTR_TEIS) + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); + + /* Check if the TX buffer is full */ + if (cdev->is_stop_queue_flag) { + tx_fifo_used = 4 * ((phytium_can_read(cdev, CAN_FIFO_CNT) & FIFO_CNT_TFN) >> 16); + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { + if (CAN_FIFO_BYTE_LEN - tx_fifo_used > KEEP_CANFD_FIFO_MIN_LEN) { + netif_wake_queue(ndev); + cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; + } + } else { + if (CAN_FIFO_BYTE_LEN - tx_fifo_used > KEEP_CAN_FIFO_MIN_LEN) { + netif_wake_queue(ndev); + cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; + } + } + } + + cdev->is_tx_done = true; + cdev->is_need_stop_xmit = false; + del_timer(&cdev->timer); + + netdev_dbg(ndev, "Finish transform packets %lu\n", stats->tx_packets); + + + phytium_can_set_reg_bits(cdev, CAN_INTR, (INTR_BOIE | + INTR_PWIE | INTR_PEIE)); +} + +static void phytium_can_tx_done_timeout(struct timer_list *t) +{ + struct phytium_can_dev *priv = from_timer(priv, t, timer); + struct net_device *ndev = priv->net; + + if (!priv->is_tx_done) { + if (priv->is_need_stop_xmit) { + netdev_dbg(ndev, "%s stop xmit\n", __func__); + priv->is_need_stop_xmit = false; + phytium_can_clr_reg_bits(priv, CAN_CTRL, CTRL_XFER); + phytium_can_clr_reg_bits(priv, CAN_INTR, (INTR_BOIE | + INTR_PWIE | INTR_PEIE)); + /* stop xmit and restart after 500ms */ + mod_timer(&priv->timer, jiffies + HZ / 2); + } else { + netdev_dbg(ndev, "%s start xmit\n", __func__); + priv->is_need_stop_xmit = true; + phytium_can_set_reg_bits(priv, CAN_CTRL, CTRL_XFER); + /* start xmit and stop after 250ms */ + mod_timer(&priv->timer, jiffies + HZ / 4); + } + } +} + +static void phytium_can_err_interrupt(struct net_device *ndev, u32 isr) +{ + struct phytium_can_dev *cdev = netdev_priv(ndev); + struct net_device_stats *stats = &ndev->stats; + struct can_frame *cf; + struct sk_buff *skb; + u32 txerr = 0, rxerr = 0; + + skb = alloc_can_err_skb(ndev, &cf); + + rxerr = phytium_can_read(cdev, CAN_ERROR_CNT) & ERR_CNT_REC; + txerr = ((phytium_can_read(cdev, CAN_ERROR_CNT) & ERR_CNT_TEC) >> 16); + + if (isr & INTR_BOIS) { + netdev_dbg(ndev, "bus_off %s: txerr :%u rxerr :%u\n", + __func__, txerr, rxerr); + cdev->can.state = CAN_STATE_BUS_OFF; + cdev->can.can_stats.bus_off++; + /* Leave device in Config Mode in bus-off state */ + phytium_can_write(cdev, CAN_CTRL, CTRL_RST); + can_bus_off(ndev); + if (skb) + cf->can_id |= CAN_ERR_BUSOFF; + } else if ((isr & INTR_PEIS) == INTR_PEIS) { + netdev_dbg(ndev, "error_passive %s: txerr :%u rxerr :%u\n", + __func__, txerr, rxerr); + cdev->can.state = CAN_STATE_ERROR_PASSIVE; + cdev->can.can_stats.error_passive++; + /* Clear interrupt condition */ + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PEIC); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PWIC); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_EIC); + if (skb) { + cf->can_id |= CAN_ERR_CRTL; + cf->data[1] = (rxerr > 127) ? + CAN_ERR_CRTL_RX_PASSIVE : + CAN_ERR_CRTL_TX_PASSIVE; + cf->data[6] = txerr; + cf->data[7] = rxerr; + } + } else if (isr & INTR_PWIS) { + netdev_dbg(ndev, "error_warning %s: txerr :%u rxerr :%u\n", + __func__, txerr, rxerr); + cdev->can.state = CAN_STATE_ERROR_WARNING; + cdev->can.can_stats.error_warning++; + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_PWIC); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TEIC); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_EIC); + if (skb) { + cf->can_id |= CAN_ERR_CRTL; + cf->data[1] |= (txerr > rxerr) ? + CAN_ERR_CRTL_TX_WARNING : + CAN_ERR_CRTL_RX_WARNING; + cf->data[6] = txerr; + cf->data[7] = rxerr; + } + } + + /* Check for RX FIFO Overflow interrupt */ + if (isr & INTR_RFIS) { + stats->rx_over_errors++; + stats->rx_errors++; + + if (skb) { + cf->can_id |= CAN_ERR_CRTL; + cf->data[1] |= CAN_ERR_CRTL_RX_OVERFLOW; + } + } + + if (skb) { + stats->rx_packets++; + stats->rx_bytes += cf->can_dlc; + netif_rx(skb); + } +} + +/** + * phytium_can_isr - CAN Isr + * @irq: irq number + * @dev_id: device id poniter + * + * This is the phytium CAN Isr. It checks for the type of interrupt + * and invokes the corresponding ISR. + * + * Return: + * * IRQ_NONE - If CAN device is in sleep mode, IRQ_HANDLED otherwise + */ +static irqreturn_t phytium_can_isr(int irq, void *dev_id) +{ + struct net_device *dev = (struct net_device *)dev_id; + struct phytium_can_dev *cdev = netdev_priv(dev); + u32 isr; + + /* Get the interrupt status */ + isr = phytium_can_read(cdev, CAN_INTR) & INTR_STATUS_MASK; + if (!isr) + return IRQ_NONE; + + spin_lock(&cdev->lock); + /* Check for FIFO full interrupt and alarm */ + if ((isr & INTR_RFIS)) { + netdev_dbg(dev, "rx_fifo is full!.\n"); + phytium_can_clr_reg_bits(cdev, CAN_INTR, INTR_RFIE); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_RFIC); + napi_schedule(&cdev->napi); + } + + /* Check for FIFO empty interrupt and alarm */ + if ((isr & INTR_TFIS)) { + netdev_dbg(dev, "tx_fifo is empty!.\n"); + isr &= (~INTR_TFIS); + phytium_can_clr_reg_bits(cdev, CAN_INTR, INTR_TFIE); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_TFIC); + } + + /* Check for the type of error interrupt and Processing it */ + if (isr & (INTR_EIS | INTR_RFIS | INTR_BOIS | INTR_PWIS | INTR_PEIS)) { + phytium_can_clr_reg_bits(cdev, CAN_INTR, (INTR_EIE | INTR_RFIE | + INTR_BOIE | INTR_PWIE | INTR_PEIE)); + phytium_can_err_interrupt(dev, isr); + phytium_can_set_reg_bits(cdev, CAN_INTR, (INTR_EIC | INTR_RFIC | + INTR_BOIC | INTR_PWIC | INTR_PEIC)); + spin_unlock(&cdev->lock); + return IRQ_HANDLED; + } + + /* Check for Tx interrupt and Processing it */ + if ((isr & INTR_TEIS)) { + phytium_can_tx_interrupt(dev, isr); + } + + /* Check for the type of receive interrupt and Processing it */ + if (isr & (INTR_REIS)) { + phytium_can_clr_reg_bits(cdev, CAN_INTR, INTR_REIE); + phytium_can_set_reg_bits(cdev, CAN_INTR, INTR_REIC); + napi_schedule(&cdev->napi); + } + spin_unlock(&cdev->lock); + return IRQ_HANDLED; +} + +/** + * phytium_can_set_bittiming - CAN set bit timing routine + * @dev: Pointer to net_device structure + * + * This is the driver set bittiming routine. + * Return: 0 on success and failure value on error + */ +static int phytium_can_set_bittiming(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + const struct can_bittiming *bt = &cdev->can.bittiming; + const struct can_bittiming *dbt = &cdev->can.data_bittiming; + u32 btr, dbtr; + u32 is_config_mode; + + /** + * Check whether Phytium CAN is in configuration mode. + * It cannot set bit timing if Phytium CAN is not in configuration mode. + */ + is_config_mode = phytium_can_read(cdev, CAN_CTRL) & CTRL_XFER; + if (is_config_mode) { + netdev_alert(dev, "BUG! Cannot set bittiming - CAN is not in config mode\n"); + return -EPERM; + } + + /* Setting Baud Rate prescalar value in BRPR Register */ + btr = (bt->brp - 1) << 16; + + /* Setting Time Segment 1 in BTR Register */ + btr |= (bt->prop_seg - 1) << 2; + + btr |= (bt->phase_seg1 - 1) << 5; + + /* Setting Time Segment 2 in BTR Register */ + btr |= (bt->phase_seg2 - 1) << 8; + + /* Setting Synchronous jump width in BTR Register */ + btr |= (bt->sjw - 1); + + dbtr = (dbt->brp - 1) << 16; + dbtr |= (dbt->prop_seg - 1) << 2; + dbtr |= (dbt->phase_seg1 - 1) << 5; + dbtr |= (dbt->phase_seg2 - 1) << 8; + dbtr |= (dbt->sjw - 1); + + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) { + phytium_can_write(cdev, CAN_ARB_RATE_CTRL, btr); + phytium_can_write(cdev, CAN_DAT_RATE_CTRL, dbtr); + } else { + phytium_can_write(cdev, CAN_ARB_RATE_CTRL, btr); + phytium_can_write(cdev, CAN_DAT_RATE_CTRL, btr); + } + + netdev_dbg(dev, "DAT=0x%08x, ARB=0x%08x\n", + phytium_can_read(cdev, CAN_DAT_RATE_CTRL), + phytium_can_read(cdev, CAN_ARB_RATE_CTRL)); + + return 0; +} + +/** + * phytium_can_start - This the drivers start routine + * @dev: Pointer to net_device structure + * + * This is the drivers start routine. + * Based on the State of the CAN device it puts + * the CAN device into a proper mode. + * + * Return: 0 on success and failure value on error + */ +static void phytium_can_start(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + u32 ctrl; + + /* Disable transfer */ + ctrl = phytium_can_read(cdev, CAN_CTRL); + ctrl &= ~CTRL_XFER; + phytium_can_write(cdev, CAN_CTRL, ctrl); + + /* XXX: If CANFD, reset the controller */ + phytium_can_write(cdev, CAN_CTRL, (ctrl | CTRL_RST)); + + /* Bittiming setup */ + phytium_can_set_bittiming(dev); + + /* Acceptance identifier mask setup */ + phytium_can_write(cdev, CAN_ACC_ID0_MASK, ACC_IDX_MASK_AID_MASK); + phytium_can_write(cdev, CAN_ACC_ID1_MASK, ACC_IDX_MASK_AID_MASK); + phytium_can_write(cdev, CAN_ACC_ID2_MASK, ACC_IDX_MASK_AID_MASK); + phytium_can_write(cdev, CAN_ACC_ID3_MASK, ACC_IDX_MASK_AID_MASK); + ctrl |= CTRL_AIME; + + if (cdev->can.ctrlmode & CAN_CTRLMODE_FD) + ctrl |= CTRL_IOF | CTRL_FDCRC; + + phytium_can_write(cdev, CAN_CTRL, ctrl); + + cdev->can.state = CAN_STATE_ERROR_ACTIVE; + + phytium_can_enable_all_interrupts(cdev); + + if (cdev->can.ctrlmode & CAN_CTRLMODE_LISTENONLY) + ctrl |= CTRL_XFER; + else + ctrl |= CTRL_XFER | CTRL_TXREQ; + + phytium_can_write(cdev, CAN_CTRL, ctrl); +} + +/** + * phytium_can_stop - Driver stop routine + * @dev: Pointer to net_device structure + * + * This is the drivers stop routine. It will disable the + * interrupts and put the device into configuration mode. + */ +static void phytium_can_stop(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + u32 ctrl; + + /* Disable all interrupts */ + phytium_can_disable_all_interrupt(cdev); + + /* Disable transfer and switch to receive-only mode */ + ctrl = phytium_can_read(cdev, CAN_CTRL); + ctrl &= ~(CTRL_XFER | CTRL_TXREQ); + phytium_can_write(cdev, CAN_CTRL, ctrl); + + del_timer(&cdev->timer); + + /* Set the state as STOPPED */ + cdev->can.state = CAN_STATE_STOPPED; +} + +static void phytium_can_clean(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + + if (cdev->tx_skb) { + dev->stats.tx_errors++; + can_free_echo_skb(cdev->net, 0, NULL); + cdev->tx_skb = NULL; + } +} + +static int phytium_can_set_mode(struct net_device *dev, enum can_mode mode) +{ + switch (mode) { + case CAN_MODE_START: + phytium_can_clean(dev); + phytium_can_start(dev); + netif_wake_queue(dev); + break; + default: + return -EOPNOTSUPP; + } + return 0; +} + +/** + * phytium_can_open - Driver open routine + * @dev: Pointer to net_device structure + * + * This is the driver open routine. + * Return: 0 on success and failure value on error + */ +static int phytium_can_open(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + int ret; + + ret = pm_runtime_get_sync(cdev->dev); + if (ret < 0) { + netdev_err(dev, "%s: pm_runtime_get failed(%d)\n", + __func__, ret); + return ret; + } + + /* Open the CAN device */ + ret = open_candev(dev); + if (ret) { + netdev_err(dev, "failed to open can device\n"); + goto disable_clk; + } + + /* Register interrupt handler */ + ret = request_irq(dev->irq, phytium_can_isr, + IRQF_SHARED, dev->name, dev); + if (ret < 0) { + netdev_err(dev, "failed to request interrupt\n"); + goto fail; + } + + /* Start the controller */ + phytium_can_start(dev); + + netdev_dbg(dev, "%s is going on\n", __func__); + + napi_enable(&cdev->napi); + cdev->is_stop_queue_flag = STOP_QUEUE_FALSE; + netif_start_queue(dev); + + return 0; + +fail: + pm_runtime_put(cdev->dev); + close_candev(dev); +disable_clk: + pm_runtime_put_sync(cdev->dev); + return ret; +} + +/** + * phytium_can_close - Driver close routine + * @dev: Pointer to net_device structure + * + * Return: 0 always + */ +static int phytium_can_close(struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + + netif_stop_queue(dev); + napi_disable(&cdev->napi); + + phytium_can_stop(dev); + free_irq(dev->irq, dev); + pm_runtime_put_sync(cdev->dev); + + close_candev(dev); + + return 0; +} + +/** + * phytium_can_start_xmit - Starts the transmission + * + * Return: 0 on success. + */ +static netdev_tx_t phytium_can_start_xmit(struct sk_buff *skb, struct net_device *dev) +{ + struct phytium_can_dev *cdev = netdev_priv(dev); + + if (can_dropped_invalid_skb(dev, skb)) + return NETDEV_TX_OK; + + cdev->tx_skb = skb; + + return phytium_can_tx_handler(cdev); +} + +static const struct net_device_ops phytium_can_netdev_ops = { + .ndo_open = phytium_can_open, + .ndo_stop = phytium_can_close, + .ndo_start_xmit = phytium_can_start_xmit, + .ndo_change_mtu = can_change_mtu, +}; + +static int register_phytium_can_dev(struct net_device *dev) +{ + dev->flags |= IFF_ECHO; + dev->netdev_ops = &phytium_can_netdev_ops; + + return register_candev(dev); +} + +static int phytium_can_dev_setup(struct phytium_can_dev *cdev) +{ + struct net_device *dev = cdev->net; + + netif_napi_add(dev, &cdev->napi, phytium_can_poll); + + cdev->can.do_set_mode = phytium_can_set_mode; + cdev->can.do_get_berr_counter = phytium_can_get_berr_counter; + + cdev->can.ctrlmode_supported = CAN_CTRLMODE_LISTENONLY | + CAN_CTRLMODE_BERR_REPORTING; + cdev->can.bittiming_const = cdev->bit_timing; + + if (cdev->fdmode) { + cdev->can.ctrlmode_supported |= CAN_CTRLMODE_FD; + dev->mtu = CANFD_MTU; + cdev->can.ctrlmode = CAN_CTRLMODE_FD; + cdev->can.data_bittiming_const = cdev->bit_timing; + } + spin_lock_init(&cdev->lock); + return 0; +} + +struct phytium_can_dev *phytium_can_allocate_dev(struct device *dev, int sizeof_priv, + int tx_fifo_depth) +{ + struct phytium_can_dev *cdev = NULL; + struct net_device *net_dev; + + /* Allocate the can device struct */ + net_dev = alloc_candev(sizeof_priv, tx_fifo_depth); + if (!net_dev) { + dev_err(dev, "Failed to allocate CAN device.\n"); + goto out; + } + + cdev = netdev_priv(net_dev); + cdev->net = net_dev; + cdev->dev = dev; + SET_NETDEV_DEV(net_dev, dev); + +out: + return cdev; +} +EXPORT_SYMBOL(phytium_can_allocate_dev); + +void phytium_can_free_dev(struct net_device *net) +{ + free_candev(net); +} +EXPORT_SYMBOL(phytium_can_free_dev); + +int phytium_can_register(struct phytium_can_dev *cdev) +{ + int ret; + + ret = phytium_can_dev_setup(cdev); + if (ret) + goto fail; + + ret = register_phytium_can_dev(cdev->net); + if (ret) { + dev_err(cdev->dev, "registering %s failed (err=%d)\n", + cdev->net->name, ret); + goto fail; + } + + cdev->is_tx_done = true; + cdev->is_need_stop_xmit = false; + timer_setup(&cdev->timer, phytium_can_tx_done_timeout, 0); + + dev_info(cdev->dev, "%s device registered (irq=%d)\n", + KBUILD_MODNAME, cdev->net->irq); + + /* Probe finished + * Stop clocks. They will be reactivated once the device is opened. + */ + pm_runtime_put_sync(cdev->dev); + + return 0; + +fail: + pm_runtime_put_sync(cdev->dev); + return ret; +} +EXPORT_SYMBOL(phytium_can_register); + +void phytium_can_unregister(struct phytium_can_dev *cdev) +{ + unregister_candev(cdev->net); +} +EXPORT_SYMBOL(phytium_can_unregister); + +int phytium_can_suspend(struct device *dev) +{ + struct net_device *ndev = dev_get_drvdata(dev); + struct phytium_can_dev *cdev = netdev_priv(ndev); + + if (netif_running(ndev)) { + netif_stop_queue(ndev); + netif_device_detach(ndev); + phytium_can_stop(ndev); + pm_runtime_put_sync(cdev->dev); + } + + cdev->can.state = CAN_STATE_SLEEPING; + + return 0; +} +EXPORT_SYMBOL(phytium_can_suspend); + +int phytium_can_resume(struct device *dev) +{ + struct net_device *ndev = dev_get_drvdata(dev); + struct phytium_can_dev *cdev = netdev_priv(ndev); + int ret; + + cdev->can.state = CAN_STATE_ERROR_ACTIVE; + + if (netif_running(ndev)) { + ret = pm_runtime_resume(cdev->dev); + if (ret) + return ret; + + phytium_can_start(ndev); + netif_device_attach(ndev); + netif_start_queue(ndev); + } + + return 0; +} +EXPORT_SYMBOL(phytium_can_resume); + +MODULE_AUTHOR("Cheng Quan "); +MODULE_AUTHOR("Chen Baozi "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("CAN bus driver for Phytium CAN controller"); + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/phytium_can.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/phytium_can.h new file mode 100644 index 0000000000000000000000000000000000000000..52bddeddc5cfb13b5bf7a96fcd16f00cdc118848 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/phytium_can.h @@ -0,0 +1,74 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* Phytium CAN controller driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _PHYTIUM_CAN_H_ +#define _PHYTIUM_CAN_H_ + +#include +#include + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define KEEP_CAN_FIFO_MIN_LEN 16 +#define KEEP_CANFD_FIFO_MIN_LEN 128 +#define CAN_FIFO_BYTE_LEN 256 +#define STOP_QUEUE_TRUE 1 +#define STOP_QUEUE_FALSE 0 + +enum phytium_can_ip_type { + PHYTIUM_CAN = 0, + PHYTIUM_CANFD, +}; + +struct phytium_can_devtype { + enum phytium_can_ip_type cantype; + const struct can_bittiming_const *bittiming_const; +}; + +struct phytium_can_dev { + struct can_priv can; + + struct napi_struct napi; + struct net_device *net; + struct device *dev; + struct clk *clk; + + struct sk_buff *tx_skb; + + const struct can_bittiming_const *bit_timing; + spinlock_t lock; /*spinlock*/ + int fdmode; + u32 isr; + u32 tx_fifo_depth; + unsigned int is_stop_queue_flag; + void __iomem *base; + + struct timer_list timer; /* xmit done timer */ + u32 is_tx_done; + u32 is_need_stop_xmit; +}; + +struct phytium_can_dev *phytium_can_allocate_dev(struct device *dev, int sizeof_priv, + int tx_fifo_depth); +void phytium_can_free_dev(struct net_device *net); + +int phytium_can_register(struct phytium_can_dev *cdev); +void phytium_can_unregister(struct phytium_can_dev *cdev); + +int phytium_can_suspend(struct device *dev); +int phytium_can_resume(struct device *dev); +#endif /* _PHYTIUM_CAN_H_ */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/phytium_can_pci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/phytium_can_pci.c new file mode 100644 index 0000000000000000000000000000000000000000..a41833b7e8af67555142c6b2df54281e6983ccb4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/can/phytium/phytium_can_pci.c @@ -0,0 +1,148 @@ +// SPDX-License-Identifier: GPL-2.0 +/* Platform CAN bus driver for Phytium CAN controller + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include + +#include "phytium_can.h" + +struct phytium_can_pci_config { + const struct phytium_can_devtype *devtype; + unsigned int clock_freq; + unsigned int tx_fifo_depth; +}; + +#define cdev2priv(dev) container_of(dev, struct phytium_can_pci, cdev) + +struct phytium_can_pci { + struct phytium_can_dev cdev; + + void __iomem *base; +}; + +static const struct can_bittiming_const phytium_bittiming_const_8192 = { + .name = "phytium_can", + .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ + .tseg1_max = 16, + .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ + .tseg2_max = 8, + .sjw_max = 4, /* Synchronisation jump width */ + .brp_min = 1, /* Bit-rate prescaler */ + .brp_max = 8192, + .brp_inc = 2, +}; + +static const struct phytium_can_devtype phytium_can_pci = { + .cantype = PHYTIUM_CAN, + .bittiming_const = &phytium_bittiming_const_8192, +}; + +static const struct phytium_can_pci_config phytium_can_pci_data = { + .devtype = &phytium_can_pci, + .clock_freq = 480000000, + .tx_fifo_depth = 64, +}; + +static int phytium_can_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) +{ + const struct phytium_can_pci_config *cfg; + struct phytium_can_dev *cdev; + struct phytium_can_pci *priv; + int ret; + + cfg = (const struct phytium_can_pci_config *)id->driver_data; + + ret = pcim_enable_device(pdev); + if (ret) + goto err; + + ret = pcim_iomap_regions(pdev, 0x1, pci_name(pdev)); + if (ret) + goto err; + + cdev = phytium_can_allocate_dev(&pdev->dev, sizeof(struct phytium_can_pci), + cfg->tx_fifo_depth); + if (!cdev) + return -ENOMEM; + + priv = cdev2priv(cdev); + priv->base = pcim_iomap_table(pdev)[0]; + + cdev->dev = &pdev->dev; + cdev->fdmode = cfg->devtype->cantype; + cdev->bit_timing = cfg->devtype->bittiming_const; + cdev->can.clock.freq = cfg->clock_freq; + cdev->tx_fifo_depth = cfg->tx_fifo_depth; + + cdev->base = priv->base; + cdev->net->irq = pdev->irq; + + pci_set_drvdata(pdev, cdev->net); + + if (!pm_runtime_enabled(cdev->dev)) + pm_runtime_enable(cdev->dev); + ret = pm_runtime_get_sync(cdev->dev); + if (ret < 0) { + netdev_err(cdev->net, "%s: pm_runtime_get failed(%d)\n", + __func__, ret); + goto err_pmdisable; + } + ret = phytium_can_register(cdev); + if (ret) + goto err; + + return 0; + +err_pmdisable: + pm_runtime_disable(&pdev->dev); +err: + return ret; +} + +static void phytium_can_pci_remove(struct pci_dev *pdev) +{ + struct net_device *dev = pci_get_drvdata(pdev); + struct phytium_can_dev *cdev = netdev_priv(dev); + + pm_runtime_disable(cdev->dev); + + phytium_can_unregister(cdev); + phytium_can_free_dev(cdev->net); +} + +static __maybe_unused int phytium_can_pci_suspend(struct device *dev) +{ + return phytium_can_suspend(dev); +} + +static __maybe_unused int phytium_can_pci_resume(struct device *dev) +{ + return phytium_can_resume(dev); +} + +static SIMPLE_DEV_PM_OPS(phytium_can_pci_pm_ops, + phytium_can_pci_suspend, phytium_can_pci_resume); + +static const struct pci_device_id phytium_can_pci_id_table[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc2d), (kernel_ulong_t)&phytium_can_pci_data, }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(pci, phytium_can_pci_id_table); + +static struct pci_driver phytium_can_pci_driver = { + .name = KBUILD_MODNAME, + .probe = phytium_can_pci_probe, + .remove = phytium_can_pci_remove, + .id_table = phytium_can_pci_id_table, + .driver = { + .pm = &phytium_can_pci_pm_ops, + }, +}; + +module_pci_driver(phytium_can_pci_driver); + +MODULE_AUTHOR("Cheng Quan +#include +#include + +#include "phytium_can.h" + +#define cdev2priv(dev) container_of(dev, struct phytium_can_plat, cdev) + +struct phytium_can_plat { + struct phytium_can_dev cdev; + struct phytium_can_devtype *devtype; + + int irq; + void __iomem *reg_base; +}; + +static const struct can_bittiming_const phytium_bittiming_const_512 = { + .name = "phytium_can", + .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ + .tseg1_max = 16, + .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ + .tseg2_max = 8, + .sjw_max = 4, /* Synchronisation jump width */ + .brp_min = 1, /* Bit-rate prescaler */ + .brp_max = 512, + .brp_inc = 2, +}; + +static const struct can_bittiming_const phytium_bittiming_const_8192 = { + .name = "phytium_can", + .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ + .tseg1_max = 16, + .tseg2_min = 1, /* Time segment 2 = phase_seg2 */ + .tseg2_max = 8, + .sjw_max = 4, /* Synchronisation jump width */ + .brp_min = 1, /* Bit-rate prescaler */ + .brp_max = 8192, + .brp_inc = 2, +}; + +static const struct phytium_can_devtype phytium_can_data = { + .cantype = PHYTIUM_CAN, + .bittiming_const = &phytium_bittiming_const_512, +}; + +static const struct phytium_can_devtype phytium_canfd_data = { + .cantype = PHYTIUM_CANFD, + .bittiming_const = &phytium_bittiming_const_8192, +}; + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_can_acpi_ids[] = { + { "PHYT000A", 0 }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(acpi, phytium_can_acpi_ids); +#endif + +#ifdef CONFIG_OF +static const struct of_device_id phytium_can_of_ids[] = { + { .compatible = "phytium,can", .data = &phytium_can_data }, + { .compatible = "phytium,canfd", .data = &phytium_canfd_data }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(of, phytium_can_of_ids); +#endif + +static int phytium_can_plat_probe(struct platform_device *pdev) +{ + struct phytium_can_dev *cdev; + struct phytium_can_plat *priv; + struct resource *res; + const struct of_device_id *of_id; + const struct phytium_can_devtype *devtype = &phytium_can_data; + u32 tx_fifo_depth; + int ret; + const char *str = "can"; + + ret = fwnode_property_read_u32(dev_fwnode(&pdev->dev), "tx-fifo-depth", &tx_fifo_depth); + if (ret) + tx_fifo_depth = 64; + + cdev = phytium_can_allocate_dev(&pdev->dev, sizeof(struct phytium_can_plat), + tx_fifo_depth); + if (!cdev) + return -ENOMEM; + + priv = cdev2priv(cdev); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + priv->reg_base = devm_ioremap_resource(&pdev->dev, res); + priv->irq = platform_get_irq(pdev, 0); + if (IS_ERR(priv->reg_base) || cdev->net->irq < 0) { + ret = -EINVAL; + goto fail; + } + + if (pdev->dev.of_node) { + cdev->clk = devm_clk_get(&pdev->dev, "can_clk"); + if (IS_ERR(cdev->clk)) { + dev_err(&pdev->dev, "no clock found\n"); + ret = -ENODEV; + goto fail; + } + cdev->can.clock.freq = clk_get_rate(cdev->clk); + + of_id = of_match_device(phytium_can_of_ids, &pdev->dev); + if (of_id && of_id->data) + devtype = of_id->data; + } else if (has_acpi_companion(&pdev->dev)) { + ret = fwnode_property_read_u32(dev_fwnode(&pdev->dev), + "clock-frequency", + &cdev->can.clock.freq); + if (ret < 0) { + dev_err(&pdev->dev, "failed to get clock frequency.\n"); + goto fail; + } + + fwnode_property_read_string(dev_fwnode(&pdev->dev), + "mode-select", &str); + if (!(strcmp(str, "canfd"))) + devtype = &phytium_canfd_data; + } + + cdev->tx_fifo_depth = tx_fifo_depth; + + if (devtype->cantype == PHYTIUM_CANFD) + cdev->fdmode = 1; + else + cdev->fdmode = 0; + + if (fwnode_property_present(dev_fwnode(&pdev->dev), "extend_brp")) + cdev->bit_timing = &phytium_bittiming_const_8192; + else + cdev->bit_timing = devtype->bittiming_const; + cdev->can.bittiming_const = devtype->bittiming_const; + cdev->base = priv->reg_base; + cdev->net->irq = priv->irq; + + platform_set_drvdata(pdev, cdev->net); + + if (!pm_runtime_enabled(cdev->dev)) + pm_runtime_enable(cdev->dev); + ret = pm_runtime_get_sync(cdev->dev); + if (ret < 0) { + netdev_err(cdev->net, "%s: pm_runtime_get failed(%d)\n", + __func__, ret); + goto out_runtime_disable; + } + + ret = phytium_can_register(cdev); + if (ret) + goto out_runtime_disable; + + return ret; + +out_runtime_disable: + pm_runtime_disable(cdev->dev); +fail: + phytium_can_free_dev(cdev->net); + return ret; +} + +static __maybe_unused int phytium_can_plat_suspend(struct device *dev) +{ + return phytium_can_suspend(dev); +} + +static __maybe_unused int phytium_can_plat_resume(struct device *dev) +{ + return phytium_can_resume(dev); +} + +static int phytium_can_plat_remove(struct platform_device *pdev) +{ + struct net_device *dev = platform_get_drvdata(pdev); + struct phytium_can_dev *cdev = netdev_priv(dev); + + phytium_can_unregister(cdev); + + phytium_can_free_dev(cdev->net); + + return 0; +} + +static int __maybe_unused phytium_can_runtime_suspend(struct device *dev) +{ + struct net_device *ndev = dev_get_drvdata(dev); + struct phytium_can_dev *cdev = netdev_priv(ndev); + + clk_disable_unprepare(cdev->clk); + + return 0; +} + +static int __maybe_unused phytium_can_runtime_resume(struct device *dev) +{ + struct net_device *ndev = dev_get_drvdata(dev); + struct phytium_can_dev *cdev = netdev_priv(ndev); + + return clk_prepare_enable(cdev->clk); +} + +static const struct dev_pm_ops phytium_can_plat_pm_ops = { + SET_RUNTIME_PM_OPS(phytium_can_runtime_suspend, + phytium_can_runtime_resume, NULL) + SET_SYSTEM_SLEEP_PM_OPS(phytium_can_suspend, phytium_can_resume) +}; + +static struct platform_driver phytium_can_plat_driver = { + .driver = { + .name = KBUILD_MODNAME, + .of_match_table = of_match_ptr(phytium_can_of_ids), + .acpi_match_table = ACPI_PTR(phytium_can_acpi_ids), + .pm = &phytium_can_plat_pm_ops, + }, + .probe = phytium_can_plat_probe, + .remove = phytium_can_plat_remove, +}; + +module_platform_driver(phytium_can_plat_driver); + +MODULE_AUTHOR("Cheng Quan "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Phytium CAN driver for IO Mapped controllers"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..00c4eda41c388233d3e794ac8501292d8bd88ab5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/Makefile @@ -0,0 +1 @@ +obj-y += phytium/ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..14a77adbfdc12fac3a7ca84fb7b10afb154f9dc9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/Kconfig @@ -0,0 +1,58 @@ +# SPDX-License-Identifier: GPL-2.0-only +# +# Phytium device configuration +# + +config NET_VENDOR_PHYTIUM + bool "Phytium devices" + depends on HAS_IOMEM + default y + help + If you have a network (Ethernet) card belonging to this class, say Y. + + Note that the answer to this question doesn't directly affect the + kernel: saying N will just cause the configurator to skip all the + remaining Cadence network card questions. If you say Y, you will be + asked for your specific card in the following questions. + +if NET_VENDOR_PHYTIUM + +config PHYTMAC + tristate "Phytium GMAC support" + depends on HAS_DMA + select PHYLINK + select CRC32 + help + If you have a network (Ethernet) controller of this type, say Y + or M here. + + To compile this driver as a module, choose M here: the module + will be phytmac. + +config PHYTMAC_ENABLE_PTP + bool "Enable IEEE 1588 hwstamp" + depends on PHYTMAC + depends on PTP_1588_CLOCK + default y + help + Enable IEEE 1588 PTP support for PHYTMAC. + +config PHYTMAC_PLATFORM + tristate "Phytmac Platform support" + depends on PHYTMAC + help + This is Platform driver. + + To compile this driver as a module, choose M here: the module + will be called phytmac_platform. + +config PHYTMAC_PCI + tristate "Phytmac PCI support" + depends on PHYTMAC && PCI + help + This is PCI driver. + + To compile this driver as a module, choose M here: the module + will be called phytmac_pci. + +endif # NET_VENDOR_PHYTIUM diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..6e710d4d54b6641bc1679405d6909827cfd09eeb --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/Makefile @@ -0,0 +1,17 @@ + +# SPDX-License-Identifier: GPL-2.0 +# +# Makefile for the Phytium network device drivers. +# +# + +obj-$(CONFIG_PHYTMAC) += phytmac.o + +phytmac-objs := phytmac_main.o phytmac_ethtool.o phytmac_v1.o phytmac_v2.o +phytmac-$(CONFIG_PHYTMAC_ENABLE_PTP) += phytmac_ptp.o + +obj-$(CONFIG_PHYTMAC_PLATFORM) += phytmac-platform.o +phytmac-platform-objs := phytmac_platform.o + +obj-$(CONFIG_PHYTMAC_PCI) += phytmac-pci.o +phytmac-pci-objs := phytmac_pci.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac.h new file mode 100644 index 0000000000000000000000000000000000000000..b90e1551499ef77b1a228d3adf29327ad3be7ae5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac.h @@ -0,0 +1,591 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ +#ifndef _PHYTMAC_H +#define _PHYTMAC_H + +#include +#include +#include +#include +#include +#include +#include +#include + +#define PHYTMAC_DRV_NAME "phytium-mac" +#define PHYTMAC_DRV_DESC "PHYTIUM Ethernet Driver" + +#define PHYTMAC_DEFAULT_MSG_ENABLE \ + (NETIF_MSG_DRV | \ + NETIF_MSG_PROBE | \ + NETIF_MSG_LINK | \ + NETIF_MSG_INTR | \ + NETIF_MSG_HW |\ + NETIF_MSG_PKTDATA) + +#define IRQ_TYPE_INT 0 +#define IRQ_TYPE_MSI 1 +#define IRQ_TYPE_INTX 2 + +#define PHYTMAC_MAX_QUEUES 8 +#define DEFAULT_DMA_BURST_LENGTH 16 +#define DEFAULT_JUMBO_MAX_LENGTH 10240 +#define PHYTMAC_MAX_TX_LEN 16320 +#define PHYTMAC_MIN_TX_LEN 64 +#define DEFAULT_TX_RING_SIZE 512 +#define DEFAULT_RX_RING_SIZE 512 +#define MAX_TX_RING_SIZE 1024 +#define MAX_RX_RING_SIZE 4096 +#define MIN_TX_RING_SIZE 64 +#define MIN_RX_RING_SIZE 64 +#define DEFAULT_TX_DESC_MIN_FREE 64 +#define DEFAULT_RX_DESC_MIN_FREE 64 + +#define MEMORY_SIZE 4096 +#define MHU_SIZE 0x20 + +#define PHYTMAC_POWEROFF 1 +#define PHYTMAC_POWERON 2 + +#define PHYTMAC_WOL_MAGIC_PACKET 1 + +#define DEFAULT_MSG_RING_SIZE 16 + +#define PHYTMAC_CAPS_JUMBO 0x00000001 +#define PHYTMAC_CAPS_PTP 0x00000002 +#define PHYTMAC_CAPS_BD_RD_PREFETCH 0x00000004 +#define PHYTMAC_CAPS_PCS 0x00000008 +#define PHYTMAC_CAPS_LSO 0x00000010 +#define PHYTMAC_CAPS_SG_DISABLED 0x00000020 +#define PHYTMAC_CAPS_TAILPTR 0x00000040 +#define PHYTMAC_CAPS_START 0x00000080 +#define PHYTMAC_CAPS_NO_WOL 0x0000100 +#define PHYTMAC_CAPS_LPI 0x0000400 +#define PHYTMAC_CAPS_MSG 0x0000800 + +#define PHYTMAC_TX 0x1 +#define PHYTMAC_RX 0x2 + +#define PHYTMAC_GREGS_LEN 16 + +#define PHYTMAC_MTU_MIN_SIZE ETH_MIN_MTU + +#define EQUAL(a, b) ((a) == (b)) + +#define TXD_USE_COUNT(_pdata, s) DIV_ROUND_UP((s), (_pdata)->max_tx_length) + +/* Bit manipulation macros */ +#define PHYTMAC_BIT(_field) \ + (1 << PHYTMAC_##_field##_INDEX) + +#define PHYTMAC_BITS(_field, value) \ + (((value) & ((1 << PHYTMAC_##_field##_WIDTH) - 1)) \ + << PHYTMAC_##_field##_INDEX) + +#define PHYTMAC_GET_BITS(_var, _field) \ + (((_var) >> (PHYTMAC_##_field##_INDEX)) \ + & ((0x1 << (PHYTMAC_##_field##_WIDTH)) - 1)) + +#define PHYTMAC_SET_BITS(_var, _field, _val) \ + (((_var) & ~(((1 << PHYTMAC_##_field##_WIDTH) - 1) \ + << PHYTMAC_##_field##_INDEX)) \ + | (((_val) & ((1 << PHYTMAC_##_field##_WIDTH) - 1)) \ + << PHYTMAC_##_field##_INDEX)) + +#define PHYTMAC_READ(_pdata, _reg) \ + __raw_readl((_pdata)->mac_regs + (_reg)) + +#define PHYTMAC_READ_BITS(_pdata, _reg, _field) \ + PHYTMAC_GET_BITS(PHYTMAC_READ((_pdata), _reg), _field) + +#define PHYTMAC_WRITE(_pdata, _reg, _val) \ + __raw_writel((_val), (_pdata)->mac_regs + (_reg)) + +#define PHYTMAC_MSG_READ(_pdata, _reg) \ + __raw_readl((_pdata)->mac_regs + (_reg)) + +#define PHYTMAC_WRITE(_pdata, _reg, _val) \ + __raw_writel((_val), (_pdata)->mac_regs + (_reg)) + +#define LSO_UFO 1 +#define LSO_TSO 2 + +#define PHYTMAC_INT_TX_COMPLETE 0x1 +#define PHYTMAC_INT_TX_ERR 0x2 +#define PHYTMAC_INT_RX_COMPLETE 0x4 +#define PHYTMAC_INT_RX_OVERRUN 0x8 +#define PHYTMAC_INT_RX_DESC_FULL 0x10 +#define PHYTMAC_RX_INT_FLAGS (PHYTMAC_INT_RX_COMPLETE) +#define PHYTMAC_TX_INT_FLAGS (PHYTMAC_INT_TX_COMPLETE \ + | PHYTMAC_INT_TX_ERR) + +#define PHYTMAC_WAKE_MAGIC 0x00000001 +#define PHYTMAC_WAKE_ARP 0x00000002 +#define PHYTMAC_WAKE_UCAST 0x00000004 +#define PHYTMAC_WAKE_MCAST 0x00000008 + +struct packet_info { + int lso; + int desc_cnt; + int hdrlen; + int nocrc; + u32 mss; + u32 seq; +}; + +#define DEV_TYPE_PLATFORM 0 +#define DEV_TYPE_PCI 1 + +struct phytmac_statistics { + char stat_string[ETH_GSTRING_LEN]; +}; + +#define STAT_TITLE(title) { \ + .stat_string = title, \ +} + +static const struct phytmac_statistics phytmac_statistics[] = { + STAT_TITLE("tx_octets"), + STAT_TITLE("tx_packets"), + STAT_TITLE("tx_bcast_packets"), + STAT_TITLE("tx_mcase_packets"), + STAT_TITLE("tx_pause_packets"), + STAT_TITLE("tx_64_byte_packets"), + STAT_TITLE("tx_65_127_byte_packets"), + STAT_TITLE("tx_128_255_byte_packets"), + STAT_TITLE("tx_256_511_byte_packets"), + STAT_TITLE("tx_512_1023_byte_packets"), + STAT_TITLE("tx_1024_1518_byte_packets"), + STAT_TITLE("tx_more_than_1518_byte_packets"), + STAT_TITLE("tx_underrun"), + STAT_TITLE("tx_single_collisions"), + STAT_TITLE("tx_multiple_collisions"), + STAT_TITLE("tx_excessive_collisions"), + STAT_TITLE("tx_late_collisions"), + STAT_TITLE("tx_deferred"), + STAT_TITLE("tx_carrier_sense_errors"), + STAT_TITLE("rx_octets"), + STAT_TITLE("rx_packets"), + STAT_TITLE("rx_bcast_packets"), + STAT_TITLE("rx_mcast_packets"), + STAT_TITLE("rx_pause_packets"), + STAT_TITLE("rx_64_byte_packets"), + STAT_TITLE("rx_65_127_byte_packets"), + STAT_TITLE("rx_128_255_byte_packets"), + STAT_TITLE("rx_256_511_byte_packets"), + STAT_TITLE("rx_512_1023_byte_packets"), + STAT_TITLE("rx_1024_1518_byte_packets"), + STAT_TITLE("rx_more_than_1518_byte_packets"), + STAT_TITLE("rx_undersized_packets"), + STAT_TITLE("rx_oversize_packets"), + STAT_TITLE("rx_jabbers"), + STAT_TITLE("rx_fcs_errors"), + STAT_TITLE("rx_length_errors"), + STAT_TITLE("rx_symbol_errors"), + STAT_TITLE("rx_alignment_errors"), + STAT_TITLE("rx_resource_over"), + STAT_TITLE("rx_overruns"), + STAT_TITLE("rx_iphdr_csum_errors"), + STAT_TITLE("rx_tcp_csum_errors"), + STAT_TITLE("rx_udp_csum_errors"), +}; + +#define PHYTMAC_STATS_LEN ARRAY_SIZE(phytmac_statistics) + +/* per queue statistics, each should be unsigned long type */ +struct phytmac_queue_stats { + unsigned long rx_packets; + unsigned long rx_bytes; + unsigned long rx_dropped; + unsigned long tx_packets; + unsigned long tx_bytes; + unsigned long tx_dropped; +}; + +static const struct phytmac_statistics queue_statistics[] = { + STAT_TITLE("rx_packets"), + STAT_TITLE("rx_bytes"), + STAT_TITLE("rx_dropped"), + STAT_TITLE("tx_packets"), + STAT_TITLE("tx_bytes"), + STAT_TITLE("tx_dropped"), +}; + +#define QUEUE_STATS_LEN ARRAY_SIZE(queue_statistics) + +struct phytmac_config { + struct phytmac_hw_if *hw_if; + u32 caps; + u32 tsu_rate; + u16 queue_num; +}; + +struct phytmac_stats { + u64 tx_octets; + u64 tx_packets; + u64 tx_bcast_packets; + u64 tx_mcase_packets; + u64 tx_pause_packets; + u64 tx_64_byte_packets; + u64 tx_65_127_byte_packets; + u64 tx_128_255_byte_packets; + u64 tx_256_511_byte_packets; + u64 tx_512_1023_byte_packets; + u64 tx_1024_1518_byte_packets; + u64 tx_more_than_1518_byte_packets; + u64 tx_underrun; + u64 tx_single_collisions; + u64 tx_multiple_collisions; + u64 tx_excessive_collisions; + u64 tx_late_collisions; + u64 tx_deferred; + u64 tx_carrier_sense_errors; + u64 rx_octets; + u64 rx_packets; + u64 rx_bcast_packets; + u64 rx_mcast_packets; + u64 rx_pause_packets; + u64 rx_64_byte_packets; + u64 rx_65_127_byte_packets; + u64 rx_128_255_byte_packets; + u64 rx_256_511_byte_packets; + u64 rx_512_1023_byte_packets; + u64 rx_1024_1518_byte_packets; + u64 rx_more_than_1518_byte_packets; + u64 rx_undersized_packets; + u64 rx_oversize_packets; + u64 rx_jabbers; + u64 rx_fcs_errors; + u64 rx_length_errors; + u64 rx_symbol_errors; + u64 rx_alignment_errors; + u64 rx_resource_over; + u64 rx_overruns; + u64 rx_iphdr_csum_errors; + u64 rx_tcp_csum_errors; + u64 rx_udp_csum_errors; +}; + +struct ts_incr { + u32 sub_ns; + u32 ns; +}; + +enum phytmac_bd_control { + TS_DISABLED, + TS_FRAME_PTP_EVENT_ONLY, + TS_ALL_PTP_FRAMES, + TS_ALL_FRAMES, +}; + +#ifdef CONFIG_PHYTMAC_ENABLE_PTP +struct phytmac_dma_desc { + u32 desc0; + u32 desc1; + u32 desc2; + u32 desc3; + u32 desc4; + u32 desc5; +}; +#else +struct phytmac_dma_desc { + u32 desc0; + u32 desc1; + u32 desc2; + u32 desc3; +}; +#endif + +struct phytmac_tx_skb { + struct sk_buff *skb; + dma_addr_t addr; + size_t length; + bool mapped_as_page; +}; + +struct phytmac_tx_ts { + struct sk_buff *skb; + u32 ts_1; + u32 ts_2; +}; + +struct phytmac_queue { + struct phytmac *pdata; + int irq; + int index; + + /* tx queue info */ + unsigned int tx_head; + unsigned int tx_tail; + unsigned int tx_xmit_more; + dma_addr_t tx_ring_addr; + struct work_struct tx_error_task; + struct napi_struct tx_napi; + struct phytmac_dma_desc *tx_ring; + struct phytmac_tx_skb *tx_skb; + /* Lock to protect tx */ + spinlock_t tx_lock; + + /* rx queue info */ + dma_addr_t rx_ring_addr; + unsigned int rx_head; + unsigned int rx_tail; + struct phytmac_dma_desc *rx_ring; + struct sk_buff **rx_skb; + struct napi_struct rx_napi; + struct phytmac_queue_stats stats; + +#ifdef CONFIG_PHYTMAC_ENABLE_PTP + struct work_struct tx_ts_task; + unsigned int tx_ts_head; + unsigned int tx_ts_tail; + struct phytmac_tx_ts tx_timestamps[128]; +#endif +}; + +struct ethtool_rx_fs_item { + struct ethtool_rx_flow_spec fs; + struct list_head list; +}; + +struct ethtool_rx_fs_list { + struct list_head list; + unsigned int count; +}; + +struct phytmac_msg { + struct completion tx_msg_comp; + u32 tx_msg_ring_size; + u32 rx_msg_ring_size; + u32 tx_msg_head; + u32 tx_msg_tail; + u32 rx_msg_head; + u32 rx_msg_tail; + /* Lock to protect msg */ + spinlock_t msg_lock; +}; + +struct ts_ctrl { + int tx_control; + int rx_control; + int one_step; +}; + +struct phytmac { + void __iomem *mac_regs; + void __iomem *msg_regs; + void __iomem *mhu_regs; + struct pci_dev *pcidev; + struct platform_device *platdev; + struct net_device *ndev; + struct device *dev; + struct ncsi_dev *ncsidev; + struct fwnode_handle *fwnode; + struct phytmac_hw_if *hw_if; + struct phytmac_msg msg_ring; + int dev_type; + int sfp_irq; + int irq_type; + int queue_irq[PHYTMAC_MAX_QUEUES]; + u32 rx_irq_mask; + u32 tx_irq_mask; + u32 msg_enable; + u32 capacities; + u32 max_tx_length; + u32 min_tx_length; + u32 jumbo_len; + u32 wol; + u32 lpi; + u32 power_state; + struct work_struct restart_task; + /* Lock to protect mac config */ + spinlock_t lock; + /* Lock to protect msg tx */ + spinlock_t msg_lock; + u32 rx_ring_size; + u32 tx_ring_size; + u32 dma_data_width; + u32 dma_addr_width; + u32 dma_burst_length; + int rx_bd_prefetch; + int tx_bd_prefetch; + int rx_buffer_len; + u16 queues_max_num; + u16 queues_num; + struct phytmac_queue queues[PHYTMAC_MAX_QUEUES]; + struct phytmac_stats stats; + u64 ethtool_stats[PHYTMAC_STATS_LEN + + QUEUE_STATS_LEN * PHYTMAC_MAX_QUEUES]; + int use_ncsi; + int use_mii; + struct mii_bus *mii_bus; + struct phylink *phylink; + struct phylink_config phylink_config; + struct phylink_pcs phylink_pcs; + int pause; + phy_interface_t phy_interface; + int speed; + int duplex; + int autoneg; + /* 1588 */ + spinlock_t ts_clk_lock; /* clock locking */ + unsigned int ts_rate; + struct ptp_clock *ptp_clock; + struct ptp_clock_info ptp_clock_info; + struct ts_incr ts_incr; + struct hwtstamp_config ts_config; + struct ts_ctrl ts_ctrl; + /* RX queue filer rule set */ + struct ethtool_rx_fs_list rx_fs_list; + /* Lock to protect fs */ + spinlock_t rx_fs_lock; + unsigned int max_rx_fs; +}; + +struct phytmac_hw_if { + int (*init_msg_ring)(struct phytmac *pdata); + int (*init_hw)(struct phytmac *pdata); + void (*reset_hw)(struct phytmac *pdata); + int (*init_ring_hw)(struct phytmac *pdata); + int (*poweron)(struct phytmac *pdata, int on); + int (*set_wol)(struct phytmac *pdata, int wake); + int (*get_feature)(struct phytmac *pdata); + int (*set_mac_address)(struct phytmac *pdata, const u8 *addr); + int (*get_mac_address)(struct phytmac *pdata, u8 *addr); + int (*enable_promise)(struct phytmac *pdata, int enable); + int (*enable_multicast)(struct phytmac *pdata, int enable); + int (*set_hash_table)(struct phytmac *pdata, unsigned long *mc_filter); + int (*enable_rx_csum)(struct phytmac *pdata, int enable); + int (*enable_tx_csum)(struct phytmac *pdata, int enable); + int (*enable_pause)(struct phytmac *pdata, int enable); + int (*enable_autoneg)(struct phytmac *pdata, int enable); + int (*enable_network)(struct phytmac *pdata, int enable, int rx_tx); + void (*get_stats)(struct phytmac *pdata); + void (*get_regs)(struct phytmac *pdata, u32 *reg_buff); + int (*set_speed)(struct phytmac *pdata); + + void (*mac_config)(struct phytmac *pdata, u32 mode, + const struct phylink_link_state *state); + int (*mac_linkup)(struct phytmac *pdata, phy_interface_t interface, + int speed, int duplex); + int (*mac_linkdown)(struct phytmac *pdata); + int (*pcs_linkup)(struct phytmac *pdata, phy_interface_t interface, + int speed, int duplex); + int (*pcs_linkdown)(struct phytmac *pdata); + unsigned int (*get_link)(struct phytmac *pdata, phy_interface_t interface); + + /* For RX coalescing */ + int (*config_rx_coalesce)(struct phytmac *pdata); + int (*config_tx_coalesce)(struct phytmac *pdata); + + /* ethtool nfc */ + int (*add_fdir_entry)(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow); + int (*del_fdir_entry)(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow); + + /* mido ops */ + int (*enable_mdio_control)(struct phytmac *pdata, int enable); + int (*mdio_read)(struct phytmac *pdata, int mii_id, int regnum); + int (*mdio_write)(struct phytmac *pdata, int mii_id, + int regnum, u16 data); + int (*mdio_read_c45)(struct phytmac *pdata, int mii_id, int devad, int regnum); + int (*mdio_write_c45)(struct phytmac *pdata, int mii_id, int devad, + int regnum, u16 data); + void (*enable_irq)(struct phytmac *pdata, int queue_index, u32 mask); + void (*disable_irq)(struct phytmac *pdata, int queue_index, u32 mask); + void (*clear_irq)(struct phytmac *pdata, int queue_index, u32 mask); + void (*mask_irq)(struct phytmac *pdata, int queue_index, u32 mask); + unsigned int (*get_irq)(struct phytmac *pdata, int queue_index); + unsigned int (*get_intx_mask)(struct phytmac *pdata); + unsigned int (*tx_map)(struct phytmac_queue *pdata, u32 tx_tail, + struct packet_info *packet); + void (*init_rx_map)(struct phytmac_queue *queue, u32 index); + unsigned int (*rx_map)(struct phytmac_queue *queue, u32 index, dma_addr_t addr); + unsigned int (*rx_clean)(struct phytmac_queue *queue, u32 cleaned_count); + void (*transmit)(struct phytmac_queue *queue); + void (*restart)(struct phytmac *pdata); + int (*tx_complete)(const struct phytmac_dma_desc *desc); + int (*rx_complete)(const struct phytmac_dma_desc *desc); + int (*get_rx_pkt_len)(struct phytmac *pdata, const struct phytmac_dma_desc *desc); + dma_addr_t (*get_desc_addr)(const struct phytmac_dma_desc *desc); + bool (*rx_checksum)(const struct phytmac_dma_desc *desc); + void (*set_desc_rxused)(struct phytmac_dma_desc *desc); + bool (*rx_single_buffer)(const struct phytmac_dma_desc *desc); + bool (*rx_pkt_start)(const struct phytmac_dma_desc *desc); + bool (*rx_pkt_end)(const struct phytmac_dma_desc *desc); + void (*clear_rx_desc)(struct phytmac_queue *queue, int begin, int end); + void (*clear_tx_desc)(struct phytmac_queue *queue); + /* ptp */ + void (*init_ts_hw)(struct phytmac *pdata); + void (*get_time)(struct phytmac *pdata, struct timespec64 *ts); + void (*set_time)(struct phytmac *pdata, time64_t sec, long nsec); + int (*set_ts_config)(struct phytmac *pdata, struct ts_ctrl *ctrl); + void (*clear_time)(struct phytmac *pdata); + int (*set_incr)(struct phytmac *pdata, struct ts_incr *incr); + int (*adjust_fine)(struct phytmac *pdata, long ppm, bool negative); + int (*adjust_time)(struct phytmac *pdata, s64 delta, int neg); + int (*ts_valid)(struct phytmac *pdata, struct phytmac_dma_desc *desc, + int direction); + void (*get_timestamp)(struct phytmac *pdata, u32 ts_1, u32 ts_2, + struct timespec64 *ts); + unsigned int (*get_ts_rate)(struct phytmac *pdata); +}; + +/* mhu */ +#define PHYTMAC_MHU_AP_CPP_STAT 0x00 +#define PHYTMAC_MHU_AP_CPP_SET 0x04 +#define PHYTMAC_MHU_CPP_DATA0 0x18 +#define PHYTMAC_MHU_CPP_DATA1 0x1c + +#define PHYTMAC_MHU_STAT_BUSY_INDEX 0 +#define PHYTMAC_MHU_STAT_BUSY_WIDTH 1 + +#define PHYTMAC_MHU_SET_INDEX 0 +#define PHYTMAC_MHU_SET_WIDTH 1 + +#define PHYTMAC_DATA0_FREE_INDEX 0 +#define PHYTMAC_DATA0_FREE_WIDTH 1 +#define PHYTMAC_DATA0_DOMAIN_INDEX 1 +#define PHYTMAC_DATA0_DOMAIN_WIDTH 7 +#define PHYTMAC_DATA0_MSG_INDEX 8 +#define PHYTMAC_DATA0_MSG_WIDTH 8 +#define PHYTMAC_MSG_PM 0x04 +#define PHYTMAC_DATA0_PRO_INDEX 16 +#define PHYTMAC_DATA0_PRO_WIDTH 8 +#define PHYTMAC_PRO_ID 0x11 +#define PHYTMAC_DATA0_PAYLOAD_INDEX 24 +#define PHYTMAC_DATA0_PAYLOAD_WIDTH 8 + +#define PHYTMAC_DATA1_STAT_INDEX 0 +#define PHYTMAC_DATA1_STAT_WIDTH 28 +#define PHYTMAC_STATON 8 +#define PHYTMAC_STATOFF 0 +#define PHYTMAC_DATA1_MUST0_INDEX 28 +#define PHYTMAC_DATA1_MUST0_WIDTH 2 +#define PHYTMAC_DATA1_STATTYPE_INDEX 30 +#define PHYTMAC_DATA1_STATTYPE_WIDTH 1 +#define PHYTMAC_STATTYPE 0x1 +#define PHYTMAC_DATA1_MUST1_INDEX 31 +#define PHYTMAC_DATA1_MUST1_WIDTH 1 + +#define PHYTMAC_MHU_READ(_pdata, _reg) \ + __raw_readl((_pdata)->mhu_regs + (_reg)) +#define PHYTMAC_MHU_WRITE(_pdata, _reg, _val) \ + __raw_writel((_val), (_pdata)->mhu_regs + (_reg)) +#define PHYTMAC_READ_STAT(pdata) PHYTMAC_MHU_READ(pdata, PHYTMAC_MHU_AP_CPP_STAT) +#define PHYTMAC_READ_DATA0(pdata) PHYTMAC_MHU_READ(pdata, PHYTMAC_MHU_CPP_DATA0) +#define PHYTMAC_TIMEOUT 1000000000 /* in usecs */ + +struct phytmac_tx_skb *phytmac_get_tx_skb(struct phytmac_queue *queue, + unsigned int index); +inline struct phytmac_dma_desc *phytmac_get_tx_desc(struct phytmac_queue *queue, + unsigned int index); +inline struct phytmac_dma_desc *phytmac_get_rx_desc(struct phytmac_queue *queue, + unsigned int index); +void phytmac_set_ethtool_ops(struct net_device *netdev); +int phytmac_drv_probe(struct phytmac *pdata); +int phytmac_drv_remove(struct phytmac *pdata); +int phytmac_drv_suspend(struct phytmac *pdata); +int phytmac_drv_resume(struct phytmac *pdata); +struct phytmac *phytmac_alloc_pdata(struct device *dev); +void phytmac_free_pdata(struct phytmac *pdata); +int phytmac_reset_ringsize(struct phytmac *pdata, u32 rx_size, u32 tx_size); +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_ethtool.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_ethtool.c new file mode 100644 index 0000000000000000000000000000000000000000..592d2d9dc6d4b27b87594738e5ce2ab09ce20ded --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_ethtool.c @@ -0,0 +1,544 @@ +// SPDX-License-Identifier: GPL-2.0-only + +#include +#include +#include "phytmac.h" +#include "phytmac_v1.h" +#include "phytmac_v2.h" +#include "phytmac_ptp.h" + +static void phytmac_get_ethtool_stats(struct net_device *ndev, + struct ethtool_stats *stats, + u64 *data) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + int i = PHYTMAC_STATS_LEN, j; + int q; + struct phytmac_queue *queue; + unsigned long *stat; + + hw_if->get_stats(pdata); + + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) + for (j = 0, stat = &queue->stats.rx_packets; j < QUEUE_STATS_LEN; ++j, ++stat) + pdata->ethtool_stats[i++] = *stat; + + memcpy(data, &pdata->ethtool_stats, sizeof(u64) + * (PHYTMAC_STATS_LEN + QUEUE_STATS_LEN * pdata->queues_num)); +} + +static inline int phytmac_get_sset_count(struct net_device *ndev, int sset) +{ + struct phytmac *pdata = netdev_priv(ndev); + + switch (sset) { + case ETH_SS_STATS: + return PHYTMAC_STATS_LEN + QUEUE_STATS_LEN * pdata->queues_num; + default: + return -EOPNOTSUPP; + } +} + +static void phytmac_get_ethtool_strings(struct net_device *ndev, u32 sset, u8 *p) +{ + char stat_string[ETH_GSTRING_LEN]; + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_queue *queue; + unsigned int i; + unsigned int q; + + switch (sset) { + case ETH_SS_STATS: + for (i = 0; i < PHYTMAC_STATS_LEN; i++, p += ETH_GSTRING_LEN) + memcpy(p, phytmac_statistics[i].stat_string, + ETH_GSTRING_LEN); + + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { + for (i = 0; i < QUEUE_STATS_LEN; i++, p += ETH_GSTRING_LEN) { + snprintf(stat_string, ETH_GSTRING_LEN, "q%d_%s", + q, queue_statistics[i].stat_string); + memcpy(p, stat_string, ETH_GSTRING_LEN); + } + } + break; + } +} + +static inline int phytmac_get_regs_len(struct net_device *ndev) +{ + return PHYTMAC_GREGS_LEN; +} + +static void phytmac_get_regs(struct net_device *ndev, + struct ethtool_regs *regs, + void *p) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + u32 *regs_buff = p; + + memset(p, 0, PHYTMAC_GREGS_LEN * sizeof(u32)); + + hw_if->get_regs(pdata, regs_buff); +} + +static void phytmac_get_wol(struct net_device *ndev, struct ethtool_wolinfo *wol) +{ + struct phytmac *pdata = netdev_priv(ndev); + + phylink_ethtool_get_wol(pdata->phylink, wol); + + if (pdata->wol & PHYTMAC_WAKE_MAGIC) { + wol->wolopts |= WAKE_MAGIC; + wol->supported |= WAKE_MAGIC; + } + if (pdata->wol & PHYTMAC_WAKE_ARP) { + wol->wolopts |= WAKE_ARP; + wol->supported |= WAKE_ARP; + } + if (pdata->wol & PHYTMAC_WAKE_UCAST) { + wol->wolopts |= WAKE_UCAST; + wol->supported |= WAKE_UCAST; + } + if (pdata->wol & PHYTMAC_WAKE_MCAST) { + wol->wolopts |= WAKE_MCAST; + wol->supported |= WAKE_MCAST; + } +} + +static int phytmac_set_wol(struct net_device *ndev, struct ethtool_wolinfo *wol) +{ + struct phytmac *pdata = netdev_priv(ndev); + int ret; + + ret = phylink_ethtool_set_wol(pdata->phylink, wol); + + if (!ret || ret != -EOPNOTSUPP) + return ret; + + pdata->wol = 0; + + if (wol->wolopts & WAKE_MAGIC) + pdata->wol |= PHYTMAC_WAKE_MAGIC; + if (wol->wolopts & WAKE_ARP) + pdata->wol |= PHYTMAC_WAKE_ARP; + if (wol->wolopts & WAKE_UCAST) + pdata->wol |= PHYTMAC_WAKE_UCAST; + if (wol->wolopts & WAKE_MCAST) + pdata->wol |= PHYTMAC_WAKE_MCAST; + + device_set_wakeup_enable(pdata->dev, pdata->wol ? 1 : 0); + + return 0; +} + +static void phytmac_get_ringparam(struct net_device *ndev, + struct ethtool_ringparam *ring, + struct kernel_ethtool_ringparam *kernel_ring, + struct netlink_ext_ack *extack) +{ + struct phytmac *pdata = netdev_priv(ndev); + + ring->rx_max_pending = MAX_RX_RING_SIZE; + ring->tx_max_pending = MAX_TX_RING_SIZE; + + ring->rx_pending = pdata->rx_ring_size; + ring->tx_pending = pdata->tx_ring_size; +} + +static int phytmac_set_ringparam(struct net_device *ndev, + struct ethtool_ringparam *ring, + struct kernel_ethtool_ringparam *kernel_ring, + struct netlink_ext_ack *extack) +{ + struct phytmac *pdata = netdev_priv(ndev); + u32 new_rx_size, new_tx_size; + + if (ring->rx_mini_pending || ring->rx_jumbo_pending) + return -EINVAL; + + new_rx_size = clamp_t(u32, ring->rx_pending, + MIN_RX_RING_SIZE, MAX_RX_RING_SIZE); + new_rx_size = roundup_pow_of_two(new_rx_size); + + new_tx_size = clamp_t(u32, ring->tx_pending, + MIN_TX_RING_SIZE, MAX_TX_RING_SIZE); + new_tx_size = roundup_pow_of_two(new_tx_size); + + if (EQUAL(new_tx_size, pdata->tx_ring_size) && + EQUAL(new_rx_size, pdata->rx_ring_size)) { + /* nothing to do */ + return 0; + } + + return phytmac_reset_ringsize(pdata, new_rx_size, new_tx_size); +} + +static int phytmac_get_ts_info(struct net_device *ndev, + struct ethtool_ts_info *info) +{ + struct phytmac *pdata = netdev_priv(ndev); + + if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) { + info->so_timestamping = + SOF_TIMESTAMPING_TX_SOFTWARE | + SOF_TIMESTAMPING_RX_SOFTWARE | + SOF_TIMESTAMPING_SOFTWARE | + SOF_TIMESTAMPING_TX_HARDWARE | + SOF_TIMESTAMPING_RX_HARDWARE | + SOF_TIMESTAMPING_RAW_HARDWARE; + info->tx_types = + (1 << HWTSTAMP_TX_ONESTEP_SYNC) | + (1 << HWTSTAMP_TX_OFF) | + (1 << HWTSTAMP_TX_ON); + info->rx_filters = + (1 << HWTSTAMP_FILTER_NONE) | + (1 << HWTSTAMP_FILTER_ALL); + + info->phc_index = pdata->ptp_clock ? ptp_clock_index(pdata->ptp_clock) : -1; + + return 0; + } + + return ethtool_op_get_ts_info(ndev, info); +} + +static int phytmac_add_fdir_ethtool(struct net_device *ndev, + struct ethtool_rxnfc *cmd) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct ethtool_rx_flow_spec *fs = &cmd->fs; + struct ethtool_rx_fs_item *item, *newfs; + unsigned long flags; + int ret = -EINVAL; + bool added = false; + struct phytmac_hw_if *hw_if = pdata->hw_if; + + if (cmd->fs.location >= pdata->max_rx_fs || + cmd->fs.ring_cookie >= pdata->queues_num) { + return -EINVAL; + } + + newfs = kmalloc(sizeof(*newfs), GFP_KERNEL); + if (!newfs) + return -ENOMEM; + memcpy(&newfs->fs, fs, sizeof(newfs->fs)); + + netdev_dbg(ndev, "Adding flow filter entry,type=%u,queue=%u,loc=%u,src=%08X,dst=%08X,ps=%u,pd=%u\n", + fs->flow_type, (int)fs->ring_cookie, fs->location, + htonl(fs->h_u.tcp_ip4_spec.ip4src), + htonl(fs->h_u.tcp_ip4_spec.ip4dst), + htons(fs->h_u.tcp_ip4_spec.psrc), htons(fs->h_u.tcp_ip4_spec.pdst)); + + spin_lock_irqsave(&pdata->rx_fs_lock, flags); + + /* find correct place to add in list */ + list_for_each_entry(item, &pdata->rx_fs_list.list, list) { + if (item->fs.location > newfs->fs.location) { + list_add_tail(&newfs->list, &item->list); + added = true; + break; + } else if (item->fs.location == fs->location) { + netdev_err(ndev, "Rule not added: location %d not free!\n", + fs->location); + ret = -EBUSY; + goto err; + } + } + if (!added) + list_add_tail(&newfs->list, &pdata->rx_fs_list.list); + + hw_if->add_fdir_entry(pdata, fs); + pdata->rx_fs_list.count++; + + spin_unlock_irqrestore(&pdata->rx_fs_lock, flags); + return 0; + +err: + spin_unlock_irqrestore(&pdata->rx_fs_lock, flags); + kfree(newfs); + return ret; +} + +static int phytmac_del_fdir_ethtool(struct net_device *ndev, + struct ethtool_rxnfc *cmd) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct ethtool_rx_fs_item *item; + struct ethtool_rx_flow_spec *fs; + unsigned long flags; + struct phytmac_hw_if *hw_if = pdata->hw_if; + + spin_lock_irqsave(&pdata->rx_fs_lock, flags); + + list_for_each_entry(item, &pdata->rx_fs_list.list, list) { + if (item->fs.location == cmd->fs.location) { + /* disable screener regs for the flow entry */ + fs = &item->fs; + netdev_dbg(ndev, "Deleting flow filter entry,type=%u,queue=%u,loc=%u,src=%08X,dst=%08X,ps=%u,pd=%u\n", + fs->flow_type, (int)fs->ring_cookie, fs->location, + htonl(fs->h_u.tcp_ip4_spec.ip4src), + htonl(fs->h_u.tcp_ip4_spec.ip4dst), + htons(fs->h_u.tcp_ip4_spec.psrc), + htons(fs->h_u.tcp_ip4_spec.pdst)); + + hw_if->del_fdir_entry(pdata, fs); + + list_del(&item->list); + pdata->rx_fs_list.count--; + spin_unlock_irqrestore(&pdata->rx_fs_lock, flags); + kfree(item); + return 0; + } + } + + spin_unlock_irqrestore(&pdata->rx_fs_lock, flags); + return -EINVAL; +} + +static int phytmac_get_fdir_entry(struct net_device *ndev, + struct ethtool_rxnfc *cmd) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct ethtool_rx_fs_item *item; + + list_for_each_entry(item, &pdata->rx_fs_list.list, list) { + if (item->fs.location == cmd->fs.location) { + memcpy(&cmd->fs, &item->fs, sizeof(cmd->fs)); + return 0; + } + } + return -EINVAL; +} + +static int phytmac_get_all_fdir_entries(struct net_device *ndev, + struct ethtool_rxnfc *cmd, + u32 *rule_locs) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct ethtool_rx_fs_item *item; + u32 cnt = 0; + + list_for_each_entry(item, &pdata->rx_fs_list.list, list) { + if (cnt == cmd->rule_cnt) + return -EMSGSIZE; + rule_locs[cnt] = item->fs.location; + cnt++; + } + cmd->data = pdata->max_rx_fs; + cmd->rule_cnt = cnt; + + return 0; +} + +static int phytmac_get_rxnfc(struct net_device *ndev, + struct ethtool_rxnfc *cmd, + u32 *rule_locs) +{ + struct phytmac *pdata = netdev_priv(ndev); + int ret = 0; + + switch (cmd->cmd) { + case ETHTOOL_GRXRINGS: + cmd->data = pdata->queues_num; + break; + case ETHTOOL_GRXCLSRLCNT: + cmd->rule_cnt = pdata->rx_fs_list.count; + break; + case ETHTOOL_GRXCLSRULE: + ret = phytmac_get_fdir_entry(ndev, cmd); + break; + case ETHTOOL_GRXCLSRLALL: + ret = phytmac_get_all_fdir_entries(ndev, cmd, rule_locs); + break; + default: + netdev_err(ndev, "Command parameter %d is not supported\n", cmd->cmd); + ret = -EOPNOTSUPP; + } + + return ret; +} + +static int phytmac_set_rxnfc(struct net_device *ndev, struct ethtool_rxnfc *cmd) +{ + switch (cmd->cmd) { + case ETHTOOL_SRXCLSRLINS: + return phytmac_add_fdir_ethtool(ndev, cmd); + case ETHTOOL_SRXCLSRLDEL: + return phytmac_del_fdir_ethtool(ndev, cmd); + default: + netdev_err(ndev, "Command parameter %d is not supported\n", cmd->cmd); + return -EOPNOTSUPP; + } +} + +static int phytmac_get_link_ksettings(struct net_device *ndev, + struct ethtool_link_ksettings *kset) +{ + int ret = 0; + struct phytmac *pdata = netdev_priv(ndev); + u32 supported = 0; + u32 advertising = 0; + + if (!ndev->phydev) { + if (pdata->phy_interface == PHY_INTERFACE_MODE_USXGMII || + pdata->phy_interface == PHY_INTERFACE_MODE_10GBASER) { + supported = SUPPORTED_10000baseT_Full + | SUPPORTED_FIBRE | SUPPORTED_Pause; + advertising = ADVERTISED_10000baseT_Full + | ADVERTISED_FIBRE | ADVERTISED_Pause; + kset->base.port = PORT_FIBRE; + kset->base.transceiver = XCVR_INTERNAL; + kset->base.duplex = DUPLEX_FULL; + kset->base.speed = SPEED_10000; + } else if (pdata->phy_interface == PHY_INTERFACE_MODE_2500BASEX) { + supported = SUPPORTED_2500baseX_Full | SUPPORTED_Pause; + advertising = ADVERTISED_2500baseX_Full | ADVERTISED_Pause; + kset->base.port = PORT_FIBRE; + kset->base.transceiver = XCVR_INTERNAL; + kset->base.duplex = DUPLEX_FULL; + kset->base.speed = SPEED_2500; + } else if (pdata->phy_interface == PHY_INTERFACE_MODE_1000BASEX) { + supported = SUPPORTED_1000baseT_Full | SUPPORTED_100baseT_Full + | SUPPORTED_10baseT_Full | SUPPORTED_FIBRE + | SUPPORTED_Pause; + advertising = ADVERTISED_1000baseT_Full | ADVERTISED_100baseT_Full + | ADVERTISED_10baseT_Full | ADVERTISED_FIBRE + | ADVERTISED_Pause; + kset->base.port = PORT_FIBRE; + kset->base.transceiver = XCVR_INTERNAL; + kset->base.duplex = DUPLEX_FULL; + kset->base.speed = SPEED_100; + } else if (pdata->phy_interface == PHY_INTERFACE_MODE_SGMII) { + supported = SUPPORTED_1000baseT_Full | SUPPORTED_100baseT_Full + | SUPPORTED_10baseT_Full | SUPPORTED_FIBRE | SUPPORTED_Pause; + advertising = ADVERTISED_1000baseT_Full | ADVERTISED_100baseT_Full + | ADVERTISED_10baseT_Full | ADVERTISED_FIBRE | ADVERTISED_Pause; + kset->base.port = PORT_FIBRE; + kset->base.transceiver = XCVR_INTERNAL; + kset->base.duplex = DUPLEX_FULL; + kset->base.speed = SPEED_1000; + } + + ethtool_convert_legacy_u32_to_link_mode(kset->link_modes.supported, + supported); + ethtool_convert_legacy_u32_to_link_mode(kset->link_modes.advertising, + advertising); + } else { + phy_ethtool_get_link_ksettings(ndev, kset); + } + + return ret; +} + +static int phytmac_set_link_ksettings(struct net_device *ndev, + const struct ethtool_link_ksettings *kset) +{ + int ret = 0; + + if (!ndev->phydev) { + netdev_err(ndev, "fixed link interface not supported set link\n"); + ret = -EOPNOTSUPP; + } else { + phy_ethtool_set_link_ksettings(ndev, kset); + } + + return ret; +} + +static inline void phytmac_get_pauseparam(struct net_device *ndev, + struct ethtool_pauseparam *pause) +{ + struct phytmac *pdata = netdev_priv(ndev); + + pause->rx_pause = pdata->pause; + pause->tx_pause = pdata->pause; +} + +static int phytmac_set_pauseparam(struct net_device *ndev, + struct ethtool_pauseparam *pause) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + + if (pause->rx_pause != pdata->pause) + hw_if->enable_pause(pdata, pause->rx_pause); + + pdata->pause = pause->rx_pause; + + return 0; +} + +static inline void phytmac_get_channels(struct net_device *ndev, + struct ethtool_channels *ch) +{ + struct phytmac *pdata = netdev_priv(ndev); + + ch->max_combined = pdata->queues_max_num; + ch->combined_count = pdata->queues_num; +} + +static int phytmac_set_channels(struct net_device *ndev, + struct ethtool_channels *ch) +{ + struct phytmac *pdata = netdev_priv(ndev); + + if (netif_running(ndev)) + return -EBUSY; + + if (ch->combined_count > pdata->queues_max_num) { + netdev_err(ndev, "combined channel count cannot exceed %u\n", + ch->combined_count); + + return -EINVAL; + } + + pdata->queues_num = ch->combined_count; + + return 0; +} + +static inline u32 phytmac_get_msglevel(struct net_device *ndev) +{ + struct phytmac *pdata = netdev_priv(ndev); + + return pdata->msg_enable; +} + +static inline void phytmac_set_msglevel(struct net_device *ndev, u32 level) +{ + struct phytmac *pdata = netdev_priv(ndev); + + pdata->msg_enable = level; +} + +static const struct ethtool_ops phytmac_ethtool_ops = { + .get_regs_len = phytmac_get_regs_len, + .get_regs = phytmac_get_regs, + .get_msglevel = phytmac_get_msglevel, + .set_msglevel = phytmac_set_msglevel, + .get_link = ethtool_op_get_link, + .get_ts_info = phytmac_get_ts_info, + .get_ethtool_stats = phytmac_get_ethtool_stats, + .get_strings = phytmac_get_ethtool_strings, + .get_sset_count = phytmac_get_sset_count, + .get_link_ksettings = phytmac_get_link_ksettings, + .set_link_ksettings = phytmac_set_link_ksettings, + .get_ringparam = phytmac_get_ringparam, + .set_ringparam = phytmac_set_ringparam, + .get_rxnfc = phytmac_get_rxnfc, + .set_rxnfc = phytmac_set_rxnfc, + .get_pauseparam = phytmac_get_pauseparam, + .set_pauseparam = phytmac_set_pauseparam, + .get_channels = phytmac_get_channels, + .set_channels = phytmac_set_channels, + .get_wol = phytmac_get_wol, + .set_wol = phytmac_set_wol, +}; + +void phytmac_set_ethtool_ops(struct net_device *ndev) +{ + ndev->ethtool_ops = &phytmac_ethtool_ops; +} + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_main.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_main.c new file mode 100644 index 0000000000000000000000000000000000000000..c172103a97362803d1d7db79e43718fbd3c3e90f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_main.c @@ -0,0 +1,2244 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Phytium Ethernet Controller driver + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt +#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 "phytmac.h" +#include "phytmac_ptp.h" + +static int debug; +module_param(debug, int, 0); +MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)"); + +#define RX_BUFFER_MULTIPLE 64 /* bytes */ +#define MAX_MTU 3072 +#define RING_ADDR_INTERVAL 128 + +#define RX_RING_BYTES(pdata) (sizeof(struct phytmac_dma_desc) \ + * (pdata)->rx_ring_size) + +#define TX_RING_BYTES(pdata) (sizeof(struct phytmac_dma_desc)\ + * (pdata)->tx_ring_size) + +/* Max length of transmit frame must be a multiple of 8 bytes */ +#define PHYTMAC_TX_LEN_ALIGN 8 +/* Limit maximum TX length as per Cadence TSO errata. This is to avoid a + * false amba_error in TX path from the DMA assuming there is not enough + * space in the SRAM (16KB) even when there is. + */ + +static int phytmac_change_mtu(struct net_device *ndev, int new_mtu) +{ + if (netif_running(ndev)) + return -EBUSY; + + if (new_mtu > MAX_MTU) { + netdev_info(ndev, "Can not set MTU over %d.\n", MAX_MTU); + return -EINVAL; + } + + ndev->mtu = new_mtu; + + return 0; +} + +static int phytmac_set_mac_address(struct net_device *netdev, void *addr) +{ + struct phytmac *pdata = netdev_priv(netdev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct sockaddr *saddr = addr; + + if (netif_msg_drv(pdata)) + netdev_info(netdev, "phytmac set mac address"); + + if (!is_valid_ether_addr(saddr->sa_data)) + return -EADDRNOTAVAIL; + + eth_hw_addr_set(netdev, saddr->sa_data); + + hw_if->set_mac_address(pdata, saddr->sa_data); + + return 0; +} + +static int phytmac_get_mac_address(struct phytmac *pdata) +{ + struct phytmac_hw_if *hw_if = pdata->hw_if; + u8 addr[6]; + + hw_if->get_mac_address(pdata, addr); + + if (is_valid_ether_addr(addr)) { + eth_hw_addr_set(pdata->ndev, addr); + return 0; + } + dev_info(pdata->dev, "invalid hw address, using random\n"); + eth_hw_addr_random(pdata->ndev); + + return 0; +} + +static int phytmac_mdio_read_c22(struct mii_bus *bus, int mii_id, int regnum) +{ + struct phytmac *pdata = bus->priv; + struct phytmac_hw_if *hw_if = pdata->hw_if; + int data; + + data = hw_if->mdio_read(pdata, mii_id, regnum); + + if (netif_msg_link(pdata)) + netdev_info(pdata->ndev, "mdio read c22 mii_id=%d, regnum=%x, data=%x\n", + mii_id, regnum, data); + + return data; +} + +static int phytmac_mdio_write_c22(struct mii_bus *bus, int mii_id, int regnum, u16 data) +{ + struct phytmac *pdata = bus->priv; + struct phytmac_hw_if *hw_if = pdata->hw_if; + int ret; + + ret = hw_if->mdio_write(pdata, mii_id, regnum, data); + if (ret) + netdev_err(pdata->ndev, "mdio %d, reg %x, data %x write failed!\n", + mii_id, regnum, data); + + if (netif_msg_link(pdata)) + netdev_info(pdata->ndev, "mdio write c22 mii_id=%d, regnum=%x, data=%x\n", + mii_id, regnum, data); + + return 0; +} + +static int phytmac_mdio_read_c45(struct mii_bus *bus, int mii_id, int devad, int regnum) +{ + struct phytmac *pdata = bus->priv; + struct phytmac_hw_if *hw_if = pdata->hw_if; + int data; + + data = hw_if->mdio_read_c45(pdata, mii_id, devad, regnum); + + if (netif_msg_link(pdata)) + netdev_info(pdata->ndev, "mdio read c45 mii_id=%d, regnum=%x, data=%x\n", + mii_id, regnum, data); + + return data; +} + +static int phytmac_mdio_write_c45(struct mii_bus *bus, int mii_id, int devad, int regnum, u16 data) +{ + struct phytmac *pdata = bus->priv; + struct phytmac_hw_if *hw_if = pdata->hw_if; + int ret; + + ret = hw_if->mdio_write_c45(pdata, mii_id, devad, regnum, data); + if (ret) + netdev_err(pdata->ndev, "mdio %d, reg %x, data %x write failed!\n", + mii_id, regnum, data); + + if (netif_msg_link(pdata)) + netdev_info(pdata->ndev, "mdio write c45 mii_id=%d, regnum=%x, data=%x\n", + mii_id, regnum, data); + + return 0; +} + +static inline int hash_bit_value(int bitnr, __u8 *addr) +{ + if (addr[bitnr / 8] & (1 << (bitnr % 8))) + return 1; + return 0; +} + +/* Return the hash index value for the specified address. */ +static int phytmac_get_hash_index(__u8 *addr) +{ + int i, j, bitval; + int hash_index = 0; + + for (j = 0; j < 6; j++) { + for (i = 0, bitval = 0; i < 8; i++) + bitval ^= hash_bit_value(i * 6 + j, addr); + + hash_index |= (bitval << j); + } + + return hash_index; +} + +static void phytmac_set_mac_hash_table(struct net_device *ndev) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct netdev_hw_addr *ha; + unsigned long mc_filter[2]; + unsigned int bitnr; + + mc_filter[0] = 0; + mc_filter[1] = 0; + + netdev_for_each_mc_addr(ha, ndev) { + bitnr = phytmac_get_hash_index(ha->addr); + mc_filter[bitnr >> 5] |= 1 << (bitnr & 31); + } + + hw_if->set_hash_table(pdata, mc_filter); +} + +/* Enable/Disable promiscuous and multicast modes. */ +static void phytmac_set_rx_mode(struct net_device *ndev) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + + hw_if->enable_promise(pdata, ndev->flags & IFF_PROMISC); + + hw_if->enable_multicast(pdata, ndev->flags & IFF_ALLMULTI); + if (!netdev_mc_empty(ndev)) + phytmac_set_mac_hash_table(ndev); +} + +static struct net_device_stats *phytmac_get_stats(struct net_device *dev) +{ + struct phytmac *pdata = netdev_priv(dev); + struct net_device_stats *nstat = &pdata->ndev->stats; + struct phytmac_stats *stat = &pdata->stats; + struct phytmac_hw_if *hw_if = pdata->hw_if; + + if (pdata->power_state == PHYTMAC_POWEROFF) + return nstat; + + hw_if->get_stats(pdata); + + nstat->rx_errors = (stat->rx_fcs_errors + + stat->rx_alignment_errors + + stat->rx_overruns + + stat->rx_oversize_packets + + stat->rx_jabbers + + stat->rx_undersized_packets + + stat->rx_length_errors); + nstat->rx_dropped = stat->rx_resource_over; + nstat->tx_errors = (stat->tx_late_collisions + + stat->tx_excessive_collisions + + stat->tx_underrun + + stat->tx_carrier_sense_errors); + nstat->multicast = stat->rx_mcast_packets; + nstat->collisions = (stat->tx_single_collisions + + stat->tx_multiple_collisions + + stat->tx_excessive_collisions + + stat->tx_late_collisions); + nstat->rx_length_errors = (stat->rx_oversize_packets + + stat->rx_jabbers + + stat->rx_undersized_packets + + stat->rx_length_errors); + nstat->rx_over_errors = stat->rx_resource_over; + nstat->rx_crc_errors = stat->rx_fcs_errors; + nstat->rx_frame_errors = stat->rx_alignment_errors; + nstat->rx_fifo_errors = stat->rx_overruns; + nstat->tx_aborted_errors = stat->tx_excessive_collisions; + nstat->tx_carrier_errors = stat->tx_carrier_sense_errors; + nstat->tx_fifo_errors = stat->tx_underrun; + + return nstat; +} + +static int phytmac_calc_rx_buf_len(struct phytmac *pdata, u32 mtu) +{ + unsigned int size = mtu + ETH_HLEN + ETH_FCS_LEN; + int rx_buf_len = roundup(size, RX_BUFFER_MULTIPLE); + + netdev_dbg(pdata->ndev, "mtu [%u] rx_buffer_size [%u]\n", + mtu, rx_buf_len); + + return rx_buf_len; +} + +inline struct phytmac_dma_desc *phytmac_get_rx_desc(struct phytmac_queue *queue, + unsigned int index) +{ + return &queue->rx_ring[index & (queue->pdata->rx_ring_size - 1)]; +} + +struct sk_buff *phytmac_get_rx_skb(struct phytmac_queue *queue, + unsigned int index) +{ + return queue->rx_skb[index & (queue->pdata->rx_ring_size - 1)]; +} + +struct phytmac_tx_skb *phytmac_get_tx_skb(struct phytmac_queue *queue, + unsigned int index) +{ + return &queue->tx_skb[index & (queue->pdata->tx_ring_size - 1)]; +} + +inline struct phytmac_dma_desc *phytmac_get_tx_desc(struct phytmac_queue *queue, + unsigned int index) +{ + return &queue->tx_ring[index & (queue->pdata->tx_ring_size - 1)]; +} + +static int phytmac_free_tx_resource(struct phytmac *pdata) +{ + struct phytmac_queue *queue; + struct phytmac_dma_desc *tx_ring_base = NULL; + dma_addr_t tx_ring_base_addr; + unsigned int q; + int size; + + queue = pdata->queues; + if (queue->tx_ring) { + tx_ring_base = queue->tx_ring; + tx_ring_base_addr = queue->tx_ring_addr; + } + + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { + kfree(queue->tx_skb); + queue->tx_skb = NULL; + + if (queue->tx_ring) + queue->tx_ring = NULL; + } + + if (tx_ring_base) { + size = pdata->queues_num * (TX_RING_BYTES(pdata) + pdata->tx_bd_prefetch + + RING_ADDR_INTERVAL); + dma_free_coherent(pdata->dev, size, tx_ring_base, tx_ring_base_addr); + } + + return 0; +} + +static int phytmac_free_rx_resource(struct phytmac *pdata) +{ + struct phytmac_queue *queue; + struct sk_buff *skb; + struct phytmac_dma_desc *desc; + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct phytmac_dma_desc *rx_ring_base = NULL; + dma_addr_t rx_ring_base_addr; + dma_addr_t addr; + unsigned int q; + int size, i; + + queue = pdata->queues; + if (queue->rx_ring) { + rx_ring_base = queue->rx_ring; + rx_ring_base_addr = queue->rx_ring_addr; + } + + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { + if (queue->rx_skb) { + for (i = 0; i < pdata->rx_ring_size; i++) { + skb = phytmac_get_rx_skb(queue, i); + if (skb) { + desc = &queue->rx_ring[i]; + addr = hw_if->get_desc_addr(desc); + dma_unmap_single(pdata->dev, addr, pdata->rx_buffer_len, + DMA_FROM_DEVICE); + dev_kfree_skb_any(skb); + skb = NULL; + } + } + + kfree(queue->rx_skb); + queue->rx_skb = NULL; + } + + if (queue->rx_ring) + queue->rx_ring = NULL; + } + + if (rx_ring_base) { + size = pdata->queues_num * (RX_RING_BYTES(pdata) + pdata->rx_bd_prefetch + + RING_ADDR_INTERVAL); + dma_free_coherent(pdata->dev, size, rx_ring_base, rx_ring_base_addr); + } + + return 0; +} + +static int phytmac_alloc_tx_resource(struct phytmac *pdata) +{ + struct phytmac_queue *queue; + struct phytmac_dma_desc *tx_ring_base; + dma_addr_t tx_ring_base_addr; + unsigned int q; + int size; + + size = pdata->queues_num * (TX_RING_BYTES(pdata) + pdata->tx_bd_prefetch + + RING_ADDR_INTERVAL); + tx_ring_base = dma_alloc_coherent(pdata->dev, size, + &tx_ring_base_addr, GFP_KERNEL); + if (!tx_ring_base) + goto err; + + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { + size = TX_RING_BYTES(pdata) + pdata->tx_bd_prefetch + RING_ADDR_INTERVAL; + queue->tx_ring = (void *)tx_ring_base + q * size; + queue->tx_ring_addr = tx_ring_base_addr + q * size; + if (!queue->tx_ring) + goto err; + + if (netif_msg_drv(pdata)) + netdev_info(pdata->ndev, + "Allocated TX ring for queue %u of %d bytes at %08lx\n", + q, size, (unsigned long)queue->tx_ring_addr); + + size = pdata->tx_ring_size * sizeof(struct phytmac_tx_skb); + queue->tx_skb = kzalloc(size, GFP_KERNEL); + if (!queue->tx_skb) + goto err; + + if (netif_msg_drv(pdata)) + netdev_info(pdata->ndev, + "Allocated %d TX struct tx_skb entries at %p\n", + pdata->tx_ring_size, queue->tx_skb); + } + tx_ring_base = NULL; + + return 0; +err: + phytmac_free_tx_resource(pdata); + + return -ENOMEM; +} + +static int phytmac_alloc_rx_resource(struct phytmac *pdata) +{ + struct phytmac_queue *queue; + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct phytmac_dma_desc *rx_ring_base; + dma_addr_t rx_ring_base_addr; + unsigned int q; + int size; + int i; + + size = pdata->queues_num * (RX_RING_BYTES(pdata) + pdata->rx_bd_prefetch + + RING_ADDR_INTERVAL); + rx_ring_base = dma_alloc_coherent(pdata->dev, size, + &rx_ring_base_addr, GFP_KERNEL); + if (!rx_ring_base) + goto err; + + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { + size = RX_RING_BYTES(pdata) + pdata->rx_bd_prefetch + RING_ADDR_INTERVAL; + queue->rx_ring = (void *)rx_ring_base + q * size; + queue->rx_ring_addr = rx_ring_base_addr + q * size; + if (!queue->rx_ring) + goto err; + + if (netif_msg_drv(pdata)) + netdev_info(pdata->ndev, + "Allocated RX ring for queue %u of %d bytes at %08lx\n", + q, size, (unsigned long)queue->rx_ring_addr); + + for (i = 0; i < pdata->rx_ring_size; i++) + hw_if->init_rx_map(queue, i); + + size = pdata->rx_ring_size * sizeof(struct sk_buff *); + queue->rx_skb = kzalloc(size, GFP_KERNEL); + if (!queue->rx_skb) + goto err; + + if (netif_msg_drv(pdata)) + netdev_info(pdata->ndev, + "Allocated %d RX struct sk_buff entries at %p\n", + pdata->rx_ring_size, queue->rx_skb); + } + rx_ring_base = NULL; + + return 0; +err: + phytmac_free_rx_resource(pdata); + + return -ENOMEM; +} + +static int phytmac_alloc_resource(struct phytmac *pdata) +{ + struct net_device *ndev = pdata->ndev; + int ret; + + pdata->rx_buffer_len = phytmac_calc_rx_buf_len(pdata, ndev->mtu); + + if (netif_msg_drv(pdata)) + netdev_info(pdata->ndev, "alloc resource, rx_buffer_len = %d\n", + pdata->rx_buffer_len); + + ret = phytmac_alloc_tx_resource(pdata); + if (ret) + return ret; + + ret = phytmac_alloc_rx_resource(pdata); + if (ret) { + phytmac_free_tx_resource(pdata); + return ret; + } + + return 0; +} + +static void phytmac_free_resource(struct phytmac *pdata) +{ + phytmac_free_tx_resource(pdata); + phytmac_free_rx_resource(pdata); +} + +static irqreturn_t phytmac_irq(int irq, void *data) +{ + struct phytmac_queue *queue = data; + struct phytmac *pdata = queue->pdata; + struct phytmac_hw_if *hw_if = pdata->hw_if; + u32 status; + + status = hw_if->get_irq(pdata, queue->index); + + if (netif_msg_intr(pdata)) + netdev_info(pdata->ndev, "phymac irq status = %x\n", status); + + if (unlikely(!status)) + return IRQ_NONE; + + while (status) { + if (status & pdata->rx_irq_mask) { + /* Disable RX interrupts */ + hw_if->disable_irq(pdata, queue->index, pdata->rx_irq_mask); + hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_RX_COMPLETE); + + if (napi_schedule_prep(&queue->rx_napi)) + __napi_schedule(&queue->rx_napi); + } + + if (status & (PHYTMAC_INT_TX_COMPLETE)) { + /* Disable TX interrupts */ + hw_if->disable_irq(pdata, queue->index, PHYTMAC_INT_TX_COMPLETE); + hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_TX_COMPLETE); + + if (napi_schedule_prep(&queue->tx_napi)) + __napi_schedule(&queue->tx_napi); + } + + if (status & PHYTMAC_INT_TX_ERR) + hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_TX_ERR); + + if (status & PHYTMAC_INT_RX_OVERRUN) { + hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_RX_OVERRUN); + pdata->stats.rx_overruns++; + } + status = hw_if->get_irq(pdata, queue->index); + } + + return IRQ_HANDLED; +} + +static irqreturn_t phytmac_intx_irq(int irq, void *data) +{ + struct phytmac *pdata = data; + struct phytmac_hw_if *hw_if = pdata->hw_if; + u32 irq_mask; + int i; + + irq_mask = hw_if->get_intx_mask(pdata); + + if (unlikely(!irq_mask)) + return IRQ_NONE; + + for (i = 0; i < pdata->queues_num; i++) { + if (irq_mask & BIT(i)) + phytmac_irq(irq, &pdata->queues[i]); + } + + return IRQ_HANDLED; +} + +static void phytmac_dump_pkt(struct phytmac *pdata, struct sk_buff *skb, bool tx) +{ + struct net_device *ndev = pdata->ndev; + + if (tx) { + netdev_dbg(ndev, "start_xmit: queue %u len %u head %p data %p tail %p end %p\n", + skb->queue_mapping, skb->len, skb->head, skb->data, + skb_tail_pointer(skb), skb_end_pointer(skb)); + } else { + netdev_dbg(ndev, "queue %u received skb of length %u, csum: %08x\n", + skb->queue_mapping, skb->len, skb->csum); + print_hex_dump(KERN_DEBUG, " mac: ", DUMP_PREFIX_ADDRESS, 16, 1, + skb_mac_header(skb), 16, true); + } + + print_hex_dump(KERN_DEBUG, "data: ", DUMP_PREFIX_OFFSET, 16, 1, + skb->data, skb->len, true); +} + +static struct sk_buff *phytmac_rx_single(struct phytmac_queue *queue, struct phytmac_dma_desc *desc) +{ + struct phytmac *pdata = queue->pdata; + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct sk_buff *skb; + unsigned int len; + dma_addr_t addr; + + skb = phytmac_get_rx_skb(queue, queue->rx_tail); + if (unlikely(!skb)) { + netdev_err(pdata->ndev, + "inconsistent Rx descriptor chain\n"); + pdata->ndev->stats.rx_dropped++; + queue->stats.rx_dropped++; + return NULL; + } + + queue->rx_skb[queue->rx_tail & (pdata->rx_ring_size - 1)] = NULL; + len = hw_if->get_rx_pkt_len(pdata, desc); + addr = hw_if->get_desc_addr(desc); + + skb_put(skb, len); + dma_unmap_single(pdata->dev, addr, + pdata->rx_buffer_len, DMA_FROM_DEVICE); + skb->protocol = eth_type_trans(skb, pdata->ndev); + skb_checksum_none_assert(skb); + + if (pdata->ndev->features & NETIF_F_RXCSUM && + !(pdata->ndev->flags & IFF_PROMISC) && + hw_if->rx_checksum(desc)) + skb->ip_summed = CHECKSUM_UNNECESSARY; + + if (netif_msg_pktdata(pdata)) + phytmac_dump_pkt(pdata, skb, false); + + return skb; +} + +static struct sk_buff *phytmac_rx_frame(struct phytmac_queue *queue, + unsigned int first_frag, unsigned int last_frag, int len) +{ + unsigned int offset = 0; + unsigned int frag = 0; + unsigned int entry = 0; + dma_addr_t addr = 0; + struct sk_buff *skb; + struct phytmac_dma_desc *desc; + struct phytmac *pdata = queue->pdata; + struct phytmac_hw_if *hw_if = pdata->hw_if; + unsigned int frag_len = pdata->rx_buffer_len; + + if (netif_msg_drv(pdata)) + netdev_info(pdata->ndev, "rx frame %u - %u (len %u)\n", + first_frag, last_frag, len); + + skb = netdev_alloc_skb(pdata->ndev, len); + if (!skb) { + pdata->ndev->stats.rx_dropped++; + netdev_err(pdata->ndev, "rx frame alloc skb failed\n"); + return NULL; + } + + skb_checksum_none_assert(skb); + + if (pdata->ndev->features & NETIF_F_RXCSUM && + !(pdata->ndev->flags & IFF_PROMISC) && + hw_if->rx_checksum(phytmac_get_rx_desc(queue, last_frag))) + skb->ip_summed = CHECKSUM_UNNECESSARY; + + skb_put(skb, len); + + for (frag = first_frag; ; frag++) { + if (offset + frag_len > len) { + if (unlikely(frag != last_frag)) { + dev_kfree_skb_any(skb); + return NULL; + } + frag_len = len - offset; + } + + desc = phytmac_get_rx_desc(queue, frag); + addr = hw_if->get_desc_addr(desc); + dma_sync_single_for_cpu(pdata->dev, addr, frag_len, + DMA_FROM_DEVICE); + + entry = frag & (pdata->rx_ring_size - 1); + skb_copy_to_linear_data_offset(skb, offset, queue->rx_skb[entry]->data, frag_len); + + offset += pdata->rx_buffer_len; + + dma_sync_single_for_device(pdata->dev, addr, frag_len, + DMA_FROM_DEVICE); + + if (frag == last_frag) + break; + } + + skb->protocol = eth_type_trans(skb, pdata->ndev); + if (netif_msg_pktdata(pdata)) + phytmac_dump_pkt(pdata, skb, false); + + return skb; +} + +static struct sk_buff *phytmac_rx_mbuffer(struct phytmac_queue *queue) +{ + struct phytmac *pdata = queue->pdata; + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct phytmac_dma_desc *desc; + struct sk_buff *skb = NULL; + unsigned int rx_tail = 0; + int first_frag = -1; + int len; + + for (rx_tail = queue->rx_tail; ; rx_tail++) { + desc = phytmac_get_rx_desc(queue, rx_tail); + if (hw_if->rx_pkt_start(desc)) { + if (first_frag != -1) + hw_if->clear_rx_desc(queue, first_frag, rx_tail); + first_frag = rx_tail; + continue; + } + + if (hw_if->rx_pkt_end(desc)) { + queue->rx_tail = rx_tail; + len = hw_if->get_rx_pkt_len(pdata, desc); + skb = phytmac_rx_frame(queue, first_frag, rx_tail, len); + first_frag = -1; + break; + } + } + return skb; +} + +static void phytmac_rx_clean(struct phytmac_queue *queue) +{ + struct phytmac *pdata = queue->pdata; + struct phytmac_hw_if *hw_if = pdata->hw_if; + unsigned int index, space; + dma_addr_t paddr; + struct sk_buff *skb; + unsigned int rx_unclean = 0; + + space = CIRC_SPACE(queue->rx_head, queue->rx_tail, + pdata->rx_ring_size); + + if (space < DEFAULT_RX_DESC_MIN_FREE) + return; + + index = queue->rx_head & (pdata->rx_ring_size - 1); + while (space > 0) { + if (!queue->rx_skb[index]) { + skb = netdev_alloc_skb(pdata->ndev, pdata->rx_buffer_len); + if (unlikely(!skb)) { + netdev_err(pdata->ndev, "rx clean alloc skb failed\n"); + break; + } + + paddr = dma_map_single(pdata->dev, skb->data, + pdata->rx_buffer_len, DMA_FROM_DEVICE); + if (dma_mapping_error(pdata->dev, paddr)) { + dev_kfree_skb(skb); + break; + } + + queue->rx_skb[index] = skb; + + hw_if->rx_map(queue, index, paddr); + } + + index = (index + 1) & (pdata->rx_ring_size - 1); + rx_unclean++; + space--; + } + + /* make newly descriptor to hardware */ + wmb(); + hw_if->rx_clean(queue, rx_unclean); + /* make newly descriptor to hardware */ + wmb(); + queue->rx_head += rx_unclean; + if (queue->rx_head >= pdata->rx_ring_size) + queue->rx_head &= (pdata->rx_ring_size - 1); +} + +static int phytmac_rx(struct phytmac_queue *queue, struct napi_struct *napi, + int budget) +{ + struct phytmac *pdata = queue->pdata; + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct sk_buff *skb; + struct phytmac_dma_desc *desc; + int count = 0; + + while (count < budget) { + desc = phytmac_get_rx_desc(queue, queue->rx_tail); + /* make newly desc to cpu */ + rmb(); + + if (!hw_if->rx_complete(desc)) + break; + + /* Ensure ctrl is at least as up-to-date as rxused */ + dma_rmb(); + + if (hw_if->rx_single_buffer(desc)) + skb = phytmac_rx_single(queue, desc); + else + skb = phytmac_rx_mbuffer(queue); + + if (!skb) { + netdev_warn(pdata->ndev, "phytmac rx skb is NULL\n"); + break; + } + + pdata->ndev->stats.rx_packets++; + queue->stats.rx_packets++; + pdata->ndev->stats.rx_bytes += skb->len; + queue->stats.rx_bytes += skb->len; + queue->rx_tail = (queue->rx_tail + 1) & (pdata->rx_ring_size - 1); + + count++; + + if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) + phytmac_ptp_rxstamp(pdata, skb, desc); + + napi_gro_receive(napi, skb); + } + + phytmac_rx_clean(queue); + + return count; +} + +static void phytmac_tx_unmap(struct phytmac *pdata, struct phytmac_tx_skb *tx_skb, int budget) +{ + if (tx_skb->addr) { + if (tx_skb->mapped_as_page) + dma_unmap_page(pdata->dev, tx_skb->addr, + tx_skb->length, DMA_TO_DEVICE); + else + dma_unmap_single(pdata->dev, tx_skb->addr, + tx_skb->length, DMA_TO_DEVICE); + tx_skb->addr = 0; + } + + if (tx_skb->skb) { + napi_consume_skb(tx_skb->skb, budget); + tx_skb->skb = NULL; + } +} + +static int phytmac_maybe_stop_tx_queue(struct phytmac_queue *queue, + unsigned int count) +{ + struct phytmac *pdata = queue->pdata; + int space = CIRC_SPACE(queue->tx_tail, queue->tx_head, + pdata->tx_ring_size); + + if (space < count) { + if (netif_msg_drv(pdata)) + netdev_info(pdata->ndev, "Tx queue %d stopped, not enough descriptors available\n", + queue->index); + + netif_stop_subqueue(pdata->ndev, queue->index); + + return NETDEV_TX_BUSY; + } + + return 0; +} + +static int phytmac_maybe_wake_tx_queue(struct phytmac_queue *queue) +{ + struct phytmac *pdata = queue->pdata; + int space = CIRC_CNT(queue->tx_tail, queue->tx_head, + pdata->tx_ring_size); + + return (space <= (3 * pdata->tx_ring_size / 4)) ? 1 : 0; +} + +static int phytmac_tx_clean(struct phytmac_queue *queue, int budget) +{ + struct phytmac *pdata = queue->pdata; + u16 queue_index = queue->index; + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct phytmac_tx_skb *tx_skb; + struct phytmac_dma_desc *desc; + int complete = 0; + int packet_count = 0; + unsigned int tail = queue->tx_tail; + unsigned int head; + + spin_lock(&pdata->lock); + + for (head = queue->tx_head; head != tail && packet_count < budget; ) { + struct sk_buff *skb; + + desc = phytmac_get_tx_desc(queue, head); + /* make newly desc to cpu */ + rmb(); + if (!hw_if->tx_complete(desc)) + break; + + /* Process all buffers of the current transmitted frame */ + for (;; head++) { + tx_skb = phytmac_get_tx_skb(queue, head); + skb = tx_skb->skb; + + if (skb) { + complete = 1; + if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) { + if (unlikely(skb_shinfo(skb)->tx_flags & + SKBTX_HW_TSTAMP) && + !phytmac_ptp_one_step(skb)) { + phytmac_ptp_txstamp(queue, skb, desc); + } + } + + if (netif_msg_drv(pdata)) + netdev_info(pdata->ndev, "desc %u (data %p) tx complete\n", + head, tx_skb->skb->data); + + pdata->ndev->stats.tx_packets++; + queue->stats.tx_packets++; + pdata->ndev->stats.tx_bytes += tx_skb->skb->len; + queue->stats.tx_bytes += tx_skb->skb->len; + packet_count++; + } + + /* Now we can safely release resources */ + phytmac_tx_unmap(pdata, tx_skb, budget); + + if (complete) { + complete = 0; + break; + } + } + + head++; + if (head >= pdata->tx_ring_size) + head &= (pdata->tx_ring_size - 1); + } + + queue->tx_head = head; + if (__netif_subqueue_stopped(pdata->ndev, queue_index) && + (phytmac_maybe_wake_tx_queue(queue))) + netif_wake_subqueue(pdata->ndev, queue_index); + spin_unlock(&pdata->lock); + + return packet_count; +} + +static int phytmac_rx_poll(struct napi_struct *napi, int budget) +{ + struct phytmac_queue *queue = container_of(napi, struct phytmac_queue, rx_napi); + struct phytmac *pdata = queue->pdata; + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct phytmac_dma_desc *desc; + int work_done; + + work_done = phytmac_rx(queue, napi, budget); + + if (netif_msg_drv(pdata)) + netdev_info(pdata->ndev, "RX poll: queue = %u, work_done = %d, budget = %d\n", + (unsigned int)(queue->index), work_done, budget); + if (work_done < budget && napi_complete_done(napi, work_done)) { + hw_if->enable_irq(pdata, queue->index, pdata->rx_irq_mask); + + desc = phytmac_get_rx_desc(queue, queue->rx_tail); + /* make newly desc to cpu */ + rmb(); + + if (hw_if->rx_complete(desc)) { + hw_if->disable_irq(pdata, queue->index, pdata->rx_irq_mask); + hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_RX_COMPLETE); + + napi_schedule(napi); + } + } + + return work_done; +} + +static int phytmac_tx_poll(struct napi_struct *napi, int budget) +{ + struct phytmac_queue *queue = container_of(napi, struct phytmac_queue, tx_napi); + struct phytmac *pdata = queue->pdata; + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct phytmac_dma_desc *desc; + int work_done; + + work_done = phytmac_tx_clean(queue, budget); + + if (netif_msg_drv(pdata)) + netdev_info(pdata->ndev, "TX poll: queue = %u, work_done = %d, budget = %d\n", + (unsigned int)(queue->index), work_done, budget); + if (work_done < budget && napi_complete_done(napi, work_done)) { + hw_if->enable_irq(pdata, queue->index, PHYTMAC_INT_TX_COMPLETE); + if (queue->tx_head != queue->tx_tail) { + desc = phytmac_get_tx_desc(queue, queue->tx_head); + /* make newly desc to cpu */ + rmb(); + + if (hw_if->tx_complete(desc)) { + hw_if->disable_irq(pdata, queue->index, PHYTMAC_INT_TX_COMPLETE); + hw_if->clear_irq(pdata, queue->index, PHYTMAC_INT_TX_COMPLETE); + + napi_schedule(napi); + } + } + } + + return work_done; +} + +static inline int phytmac_clear_csum(struct sk_buff *skb) +{ + if (skb->ip_summed != CHECKSUM_PARTIAL) + return 0; + + /* make sure we can modify the header */ + if (unlikely(skb_cow_head(skb, 0))) + return -1; + + *(__sum16 *)(skb_checksum_start(skb) + skb->csum_offset) = 0; + return 0; +} + +static int phytmac_add_fcs(struct sk_buff **skb, struct net_device *ndev) +{ + bool cloned = skb_cloned(*skb) || skb_header_cloned(*skb) || + skb_is_nonlinear(*skb); + int padlen = ETH_ZLEN - (*skb)->len; + int headroom = skb_headroom(*skb); + int tailroom = skb_tailroom(*skb); + struct sk_buff *nskb; + u32 fcs; + int i; + + if ((ndev->features & NETIF_F_HW_CSUM) || + !((*skb)->ip_summed != CHECKSUM_PARTIAL) || + skb_shinfo(*skb)->gso_size || phytmac_ptp_one_step(*skb)) + return 0; + + if (padlen <= 0) { + if (tailroom >= ETH_FCS_LEN) + goto add_fcs; + else if (!cloned && headroom + tailroom >= ETH_FCS_LEN) + padlen = 0; + else + padlen = ETH_FCS_LEN; + } else { + padlen += ETH_FCS_LEN; + } + + if (!cloned && headroom + tailroom >= padlen) { + (*skb)->data = memmove((*skb)->head, (*skb)->data, (*skb)->len); + skb_set_tail_pointer(*skb, (*skb)->len); + } else { + nskb = skb_copy_expand(*skb, 0, padlen, GFP_ATOMIC); + if (!nskb) + return -ENOMEM; + + dev_consume_skb_any(*skb); + *skb = nskb; + } + + if (padlen > ETH_FCS_LEN) + skb_put_zero(*skb, padlen - ETH_FCS_LEN); + +add_fcs: + fcs = crc32_le(~0, (*skb)->data, (*skb)->len); + fcs = ~fcs; + + for (i = 0; i < 4; ++i) + skb_put_u8(*skb, (fcs >> (i * 8)) & 0xff); + return 0; +} + +static int phytmac_packet_info(struct phytmac *pdata, + struct phytmac_queue *queue, struct sk_buff *skb, + struct packet_info *packet) +{ + int is_lso; + unsigned int hdrlen, f; + int desc_cnt; + + memset(packet, 0, sizeof(struct packet_info)); + + is_lso = (skb_shinfo(skb)->gso_size != 0); + + if (is_lso) { + /* length of headers */ + if (ip_hdr(skb)->protocol == IPPROTO_UDP) { + /* only queue eth + ip headers separately for UDP */ + hdrlen = skb_transport_offset(skb); + packet->lso = LSO_UFO; + packet->mss = skb_shinfo(skb)->gso_size + hdrlen + ETH_FCS_LEN; + } else { + hdrlen = skb_transport_offset(skb) + tcp_hdrlen(skb); + packet->lso = LSO_TSO; + packet->mss = skb_shinfo(skb)->gso_size; + } + + if (skb_headlen(skb) < hdrlen) { + dev_err(pdata->dev, "Error - LSO headers fragmented!!!\n"); + return NETDEV_TX_BUSY; + } + } else { + hdrlen = min(skb_headlen(skb), pdata->max_tx_length); + packet->lso = 0; + packet->mss = 0; + } + + packet->hdrlen = hdrlen; + + if (is_lso && (skb_headlen(skb) > hdrlen)) + desc_cnt = TXD_USE_COUNT(pdata, (skb_headlen(skb) - hdrlen)) + 1; + else + desc_cnt = TXD_USE_COUNT(pdata, hdrlen); + + for (f = 0; f < skb_shinfo(skb)->nr_frags; f++) + desc_cnt += TXD_USE_COUNT(pdata, skb_frag_size(&skb_shinfo(skb)->frags[f])); + packet->desc_cnt = desc_cnt; + + if ((!(pdata->ndev->features & NETIF_F_HW_CSUM)) && + skb->ip_summed != CHECKSUM_PARTIAL && + !is_lso && + !phytmac_ptp_one_step(skb)) + packet->nocrc = 1; + else + packet->nocrc = 0; + + if (netif_msg_pktdata(pdata)) { + netdev_info(pdata->ndev, "packet info: desc_cnt=%d, nocrc=%d,ip_summed=%d\n", + desc_cnt, packet->nocrc, skb->ip_summed); + netdev_info(pdata->ndev, "packet info: mss=%d, lso=%d,skb_len=%d, nr_frags=%d\n", + packet->mss, packet->lso, skb->len, skb_shinfo(skb)->nr_frags); + } + + return 0; +} + +static unsigned int phytmac_tx_map(struct phytmac *pdata, + struct phytmac_queue *queue, + struct sk_buff *skb, + struct packet_info *packet) +{ + dma_addr_t mapping; + struct phytmac_hw_if *hw_if = pdata->hw_if; + unsigned int len, i, tx_tail = queue->tx_tail; + struct phytmac_tx_skb *tx_skb = NULL; + unsigned int offset, size, count = 0; + unsigned int f, nr_frags = skb_shinfo(skb)->nr_frags; + + len = skb_headlen(skb); + size = packet->hdrlen; + + offset = 0; + tx_tail = queue->tx_tail; + while (len) { + tx_skb = phytmac_get_tx_skb(queue, tx_tail); + + mapping = dma_map_single(pdata->dev, + skb->data + offset, + size, DMA_TO_DEVICE); + if (dma_mapping_error(pdata->dev, mapping)) + goto dma_error; + + /* Save info to properly release resources */ + tx_skb->skb = NULL; + tx_skb->addr = mapping; + tx_skb->length = size; + tx_skb->mapped_as_page = false; + + len -= size; + offset += size; + count++; + tx_tail++; + + size = min(len, pdata->max_tx_length); + } + + /* Then, map paged data from fragments */ + for (f = 0; f < nr_frags; f++) { + const skb_frag_t *frag = &skb_shinfo(skb)->frags[f]; + + len = skb_frag_size(frag); + offset = 0; + while (len) { + size = min(len, pdata->max_tx_length); + tx_skb = phytmac_get_tx_skb(queue, tx_tail); + mapping = skb_frag_dma_map(pdata->dev, frag, + offset, size, DMA_TO_DEVICE); + if (dma_mapping_error(pdata->dev, mapping)) + goto dma_error; + + /* Save info to properly release resources */ + tx_skb->skb = NULL; + tx_skb->addr = mapping; + tx_skb->length = size; + tx_skb->mapped_as_page = true; + + len -= size; + offset += size; + count++; + tx_tail++; + } + } + + /* Should never happen */ + if (unlikely(!tx_skb)) { + netdev_err(pdata->ndev, "BUG! empty skb!\n"); + return 0; + } + + /* This is the last buffer of the frame: save socket buffer */ + tx_skb->skb = skb; + + if (hw_if->tx_map(queue, tx_tail, packet)) { + netdev_err(pdata->ndev, "BUG!hw tx map failed!\n"); + return 0; + } + + queue->tx_tail = tx_tail & (pdata->tx_ring_size - 1); + + return count; + +dma_error: + netdev_err(pdata->ndev, "TX DMA map failed\n"); + + for (i = queue->tx_tail; i != tx_tail; i++) { + tx_skb = phytmac_get_tx_skb(queue, i); + phytmac_tx_unmap(pdata, tx_skb, 0); + } + + return 0; +} + +static inline void phytmac_init_ring(struct phytmac *pdata) +{ + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct phytmac_queue *queue; + unsigned int q = 0; + + for (queue = pdata->queues; q < pdata->queues_num; ++q) { + queue->tx_head = 0; + queue->tx_tail = 0; + hw_if->clear_tx_desc(queue); + + queue->rx_head = 0; + queue->rx_tail = 0; + phytmac_rx_clean(queue); + ++queue; + } + + hw_if->init_ring_hw(pdata); +} + +static netdev_tx_t phytmac_start_xmit(struct sk_buff *skb, struct net_device *ndev) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + u16 queue_index = skb->queue_mapping; + struct phytmac_queue *queue = &pdata->queues[queue_index]; + netdev_tx_t ret = NETDEV_TX_OK; + struct packet_info packet; + unsigned long flags; + + if (phytmac_clear_csum(skb)) { + dev_kfree_skb_any(skb); + return ret; + } + + if (phytmac_add_fcs(&skb, ndev)) { + dev_kfree_skb_any(skb); + return ret; + } + + ret = phytmac_packet_info(pdata, queue, skb, &packet); + if (ret) { + dev_kfree_skb_any(skb); + return ret; + } + + if (netif_msg_pktdata(pdata)) + phytmac_dump_pkt(pdata, skb, true); + + spin_lock_irqsave(&pdata->lock, flags); + /* Check that there are enough descriptors available */ + ret = phytmac_maybe_stop_tx_queue(queue, packet.desc_cnt); + if (ret) + goto tx_return; + + /* Map socket buffer for DMA transfer */ + if (!phytmac_tx_map(pdata, queue, skb, &packet)) { + dev_kfree_skb_any(skb); + goto tx_return; + } + + skb_tx_timestamp(skb); + /* Make newly descriptor to hardware */ + wmb(); + + hw_if->transmit(queue); + +tx_return: + spin_unlock_irqrestore(&pdata->lock, flags); + return ret; +} + +static int phytmac_phylink_connect(struct phytmac *pdata) +{ + struct net_device *ndev = pdata->ndev; + struct phy_device *phydev; + struct fwnode_handle *fwnode = dev_fwnode(pdata->dev); + int ret = 0; + + if (fwnode) + ret = phylink_fwnode_phy_connect(pdata->phylink, fwnode, 0); + + if (!fwnode || ret) { + if (pdata->mii_bus) { + phydev = phy_find_first(pdata->mii_bus); + if (!phydev) { + dev_err(pdata->dev, "no PHY found\n"); + return -ENXIO; + } + /* attach the mac to the phy */ + ret = phylink_connect_phy(pdata->phylink, phydev); + } else { + netdev_err(ndev, "Not mii register\n"); + return -ENXIO; + } + } + + if (ret) { + netdev_err(ndev, "Could not attach PHY (%d)\n", ret); + return ret; + } + + return 0; +} + +int phytmac_pcs_config(struct phylink_pcs *pcs, unsigned int mode, + phy_interface_t interface, + const unsigned long *advertising, + bool permit_pause_to_mac) +{ + return 0; +} + +void phytmac_pcs_link_up(struct phylink_pcs *pcs, unsigned int mode, + phy_interface_t interface, int speed, int duplex) +{ + struct phytmac *pdata = container_of(pcs, struct phytmac, phylink_pcs); + struct phytmac_hw_if *hw_if = pdata->hw_if; + + if (netif_msg_link(pdata)) + netdev_info(pdata->ndev, "pcs link up, interface = %s, speed = %d, duplex = %d\n", + phy_modes(interface), speed, duplex); + hw_if->pcs_linkup(pdata, interface, speed, duplex); +} + +static const struct phylink_pcs_ops phytmac_pcs_phylink_ops = { + .pcs_config = phytmac_pcs_config, + .pcs_link_up = phytmac_pcs_link_up, +}; + +static struct phylink_pcs *phytmac_mac_select_pcs(struct phylink_config *config, + phy_interface_t interface) +{ + struct phytmac *pdata = netdev_priv(to_net_dev(config->dev)); + + if (interface == PHY_INTERFACE_MODE_USXGMII || + interface == PHY_INTERFACE_MODE_10GBASER || + interface == PHY_INTERFACE_MODE_SGMII || + interface == PHY_INTERFACE_MODE_1000BASEX || + interface == PHY_INTERFACE_MODE_2500BASEX) { + pdata->phylink_pcs.ops = &phytmac_pcs_phylink_ops; + } else { + pdata->phylink_pcs.ops = NULL; + } + + return &pdata->phylink_pcs; +} + +static void phytmac_mac_config(struct phylink_config *config, unsigned int mode, + const struct phylink_link_state *state) +{ + struct phytmac *pdata = netdev_priv(to_net_dev(config->dev)); + struct phytmac_hw_if *hw_if = pdata->hw_if; + unsigned long flags; + + if (netif_msg_link(pdata)) { + netdev_info(pdata->ndev, "mac config interface=%s, mode=%d\n", + phy_modes(state->interface), mode); + } + + spin_lock_irqsave(&pdata->lock, flags); + hw_if->mac_config(pdata, mode, state); + spin_unlock_irqrestore(&pdata->lock, flags); +} + +static void phytmac_mac_link_down(struct phylink_config *config, unsigned int mode, + phy_interface_t interface) +{ + struct net_device *ndev = to_net_dev(config->dev); + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct phytmac_queue *queue; + unsigned int q; + unsigned long flags; + struct phytmac_tx_skb *tx_skb; + int i; + + if (netif_msg_link(pdata)) { + netdev_info(ndev, "link down interface:%s, mode=%d\n", + phy_modes(interface), mode); + } + + if (pdata->use_ncsi) + ncsi_stop_dev(pdata->ncsidev); + + spin_lock_irqsave(&pdata->lock, flags); + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { + hw_if->disable_irq(pdata, queue->index, pdata->rx_irq_mask | pdata->tx_irq_mask); + hw_if->clear_irq(pdata, queue->index, pdata->rx_irq_mask | pdata->tx_irq_mask); + } + + /* Disable Rx and Tx */ + hw_if->enable_network(pdata, false, PHYTMAC_RX | PHYTMAC_TX); + + /* Tx clean */ + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { + for (i = 0; i < pdata->tx_ring_size; i++) { + tx_skb = phytmac_get_tx_skb(queue, i); + if (tx_skb) + phytmac_tx_unmap(pdata, tx_skb, 0); + } + } + + spin_unlock_irqrestore(&pdata->lock, flags); + + netif_tx_stop_all_queues(ndev); +} + +static void phytmac_mac_link_up(struct phylink_config *config, + struct phy_device *phy, + unsigned int mode, phy_interface_t interface, + int speed, int duplex, + bool tx_pause, bool rx_pause) +{ + struct net_device *ndev = to_net_dev(config->dev); + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct phytmac_queue *queue; + unsigned long flags; + unsigned int q; + int ret; + + if (netif_msg_link(pdata)) + netdev_info(pdata->ndev, "link up interface:%s, speed:%d, duplex:%s\n", + phy_modes(interface), speed, duplex ? "full-duplex" : "half-duplex"); + + spin_lock_irqsave(&pdata->lock, flags); + + hw_if->mac_linkup(pdata, interface, speed, duplex); + + if (rx_pause != pdata->pause) { + hw_if->enable_pause(pdata, rx_pause); + pdata->pause = rx_pause; + } + + phytmac_init_ring(pdata); + + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) + hw_if->enable_irq(pdata, queue->index, pdata->rx_irq_mask | pdata->tx_irq_mask); + + /* Enable Rx and Tx */ + hw_if->enable_network(pdata, true, PHYTMAC_RX | PHYTMAC_TX); + spin_unlock_irqrestore(&pdata->lock, flags); + + if (pdata->use_ncsi) { + /* Start the NCSI device */ + ret = ncsi_start_dev(pdata->ncsidev); + if (ret) { + netdev_err(pdata->ndev, "Ncsi start dev failed (error %d)\n", ret); + return; + } + } + + netif_tx_wake_all_queues(ndev); +} + +int phytmac_mdio_register(struct phytmac *pdata) +{ + struct phytmac_hw_if *hw_if = pdata->hw_if; + int ret; + + pdata->mii_bus = mdiobus_alloc(); + if (!pdata->mii_bus) { + ret = -ENOMEM; + goto err_out; + } + + pdata->mii_bus->name = "phytmac_mii_bus"; + pdata->mii_bus->read = &phytmac_mdio_read_c22; + pdata->mii_bus->write = &phytmac_mdio_write_c22; + pdata->mii_bus->read_c45 = &phytmac_mdio_read_c45; + pdata->mii_bus->write_c45 = &phytmac_mdio_write_c45; + + if (pdata->platdev) { + snprintf(pdata->mii_bus->id, MII_BUS_ID_SIZE, "%s-%s", + pdata->mii_bus->name, pdata->platdev->name); + } else if (pdata->pcidev) { + snprintf(pdata->mii_bus->id, MII_BUS_ID_SIZE, "%s-%s", + pdata->mii_bus->name, pci_name(pdata->pcidev)); + } else { + ret = -ENOMEM; + goto free_mdio; + } + + pdata->mii_bus->priv = pdata; + pdata->mii_bus->parent = pdata->dev; + + hw_if->enable_mdio_control(pdata, 1); + + return mdiobus_register(pdata->mii_bus); +free_mdio: + mdiobus_free(pdata->mii_bus); + pdata->mii_bus = NULL; + +err_out: + return ret; +} + +static void phytmac_pcs_get_state(struct phylink_config *config, + struct phylink_link_state *state) +{ + struct phytmac *pdata = container_of(config, struct phytmac, phylink_config); + struct phytmac_hw_if *hw_if = pdata->hw_if; + + state->link = hw_if->get_link(pdata, state->interface); +} + +static void phytmac_validate(struct phylink_config *config, + unsigned long *supported, + struct phylink_link_state *state) +{ + struct net_device *ndev = to_net_dev(config->dev); + __ETHTOOL_DECLARE_LINK_MODE_MASK(mask) = { 0, }; + struct phytmac *pdata = netdev_priv(ndev); + + if (state->interface != PHY_INTERFACE_MODE_SGMII && + state->interface != PHY_INTERFACE_MODE_1000BASEX && + state->interface != PHY_INTERFACE_MODE_2500BASEX && + state->interface != PHY_INTERFACE_MODE_5GBASER && + state->interface != PHY_INTERFACE_MODE_10GBASER && + state->interface != PHY_INTERFACE_MODE_USXGMII && + !phy_interface_mode_is_rgmii(state->interface)) { + bitmap_zero(supported, __ETHTOOL_LINK_MODE_MASK_NBITS); + return; + } + + phylink_set_port_modes(mask); + phylink_set(mask, Autoneg); + phylink_set(mask, Asym_Pause); + + if (state->interface == PHY_INTERFACE_MODE_10GBASER || + state->interface == PHY_INTERFACE_MODE_USXGMII) { + pdata->speed = state->speed; + pdata->duplex = state->duplex; + if (pdata->speed == SPEED_5000) { + phylink_set(mask, 5000baseT_Full); + } else { + phylink_set(mask, 10000baseCR_Full); + phylink_set(mask, 10000baseER_Full); + phylink_set(mask, 10000baseKR_Full); + phylink_set(mask, 10000baseLR_Full); + phylink_set(mask, 10000baseLRM_Full); + phylink_set(mask, 10000baseSR_Full); + phylink_set(mask, 10000baseT_Full); + } + } + + if (state->interface == PHY_INTERFACE_MODE_2500BASEX) + phylink_set(mask, 2500baseX_Full); + + if (state->interface == PHY_INTERFACE_MODE_5GBASER) + phylink_set(mask, 5000baseT_Full); + + if (state->interface == PHY_INTERFACE_MODE_1000BASEX || + state->interface == PHY_INTERFACE_MODE_SGMII || + phy_interface_mode_is_rgmii(state->interface)) { + phylink_set(mask, 1000baseT_Full); + phylink_set(mask, 1000baseX_Full); + phylink_set(mask, 1000baseT_Half); + phylink_set(mask, 10baseT_Half); + phylink_set(mask, 10baseT_Full); + phylink_set(mask, 100baseT_Half); + phylink_set(mask, 100baseT_Full); + } + + bitmap_and(supported, supported, mask, __ETHTOOL_LINK_MODE_MASK_NBITS); + bitmap_and(state->advertising, state->advertising, mask, + __ETHTOOL_LINK_MODE_MASK_NBITS); +} + +static const struct phylink_mac_ops phytmac_phylink_ops = { + .validate = phytmac_validate, + .mac_select_pcs = phytmac_mac_select_pcs, + .mac_config = phytmac_mac_config, + .mac_link_down = phytmac_mac_link_down, + .mac_link_up = phytmac_mac_link_up, +}; + +static inline void set_phy_interface(unsigned long *intf) +{ + __set_bit(PHY_INTERFACE_MODE_SGMII, intf); + __set_bit(PHY_INTERFACE_MODE_1000BASEX, intf); + __set_bit(PHY_INTERFACE_MODE_2500BASEX, intf); + __set_bit(PHY_INTERFACE_MODE_USXGMII, intf); + __set_bit(PHY_INTERFACE_MODE_10GBASER, intf); +} + +static int phytmac_phylink_create(struct phytmac *pdata) +{ + struct fwnode_handle *fw_node = dev_fwnode(pdata->dev); + + pdata->phylink_config.dev = &pdata->ndev->dev; + pdata->phylink_config.type = PHYLINK_NETDEV; + if (pdata->phy_interface == PHY_INTERFACE_MODE_SGMII || + pdata->phy_interface == PHY_INTERFACE_MODE_1000BASEX || + pdata->phy_interface == PHY_INTERFACE_MODE_2500BASEX || + pdata->phy_interface == PHY_INTERFACE_MODE_USXGMII || + pdata->phy_interface == PHY_INTERFACE_MODE_10GBASER) { + pdata->phylink_config.poll_fixed_state = true; + pdata->phylink_config.get_fixed_state = phytmac_pcs_get_state; + pdata->phylink_pcs.ops = &phytmac_pcs_phylink_ops; + } + + set_phy_interface(pdata->phylink_config.supported_interfaces); + pdata->phylink = phylink_create(&pdata->phylink_config, fw_node, + pdata->phy_interface, &phytmac_phylink_ops); + if (IS_ERR(pdata->phylink)) { + dev_err(pdata->dev, "Could not create a phylink instance (%ld)\n", + PTR_ERR(pdata->phylink)); + return PTR_ERR(pdata->phylink); + } + + return 0; +} + +static int phytmac_open(struct net_device *ndev) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_queue *queue; + struct phytmac_hw_if *hw_if = pdata->hw_if; + unsigned int q = 0; + int ret; + + if (netif_msg_probe(pdata)) + dev_dbg(pdata->dev, "open\n"); + + /* phytmac_powerup */ + if (pdata->power_state == PHYTMAC_POWEROFF) + hw_if->poweron(pdata, PHYTMAC_POWERON); + + if (hw_if->init_msg_ring) + hw_if->init_msg_ring(pdata); + + ret = hw_if->get_feature(pdata); + if (ret) { + netdev_err(ndev, "phytmac get features failed\n"); + return ret; + } + + hw_if->reset_hw(pdata); + + ret = phytmac_get_mac_address(pdata); + if (ret) { + netdev_err(ndev, "phytmac get mac address failed\n"); + goto reset_hw; + } + + ret = netif_set_real_num_tx_queues(ndev, pdata->queues_num); + if (ret) { + netdev_err(ndev, "error setting real tx queue number\n"); + return ret; + } + ret = netif_set_real_num_rx_queues(ndev, pdata->queues_num); + if (ret) { + netdev_err(ndev, "error setting real tx queue number\n"); + return ret; + } + + /* RX buffers initialization */ + ret = phytmac_alloc_resource(pdata); + if (ret) { + netdev_err(ndev, "Unable to allocate DMA memory (error %d)\n", + ret); + goto reset_hw; + } + + for (queue = pdata->queues; q < pdata->queues_num; ++q) { + napi_enable(&queue->tx_napi); + napi_enable(&queue->rx_napi); + ++queue; + } + + phytmac_init_ring(pdata); + hw_if->init_hw(pdata); + + ret = phytmac_phylink_connect(pdata); + if (ret) { + netdev_err(ndev, "phylink connet failed,(error %d)\n", + ret); + goto reset_hw; + } + + phylink_start(pdata->phylink); + + netif_tx_start_all_queues(pdata->ndev); + + if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) { + ret = phytmac_ptp_register(pdata); + if (ret) { + netdev_err(ndev, "ptp register failed, (error %d)\n", + ret); + goto reset_hw; + } + + phytmac_ptp_init(pdata->ndev); + } + + return 0; + +reset_hw: + hw_if->reset_hw(pdata); + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q) { + napi_disable(&queue->tx_napi); + napi_disable(&queue->rx_napi); + ++queue; + } + phytmac_free_resource(pdata); + return ret; +} + +static int phytmac_close(struct net_device *ndev) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_queue *queue; + struct phytmac_hw_if *hw_if = pdata->hw_if; + unsigned long flags; + unsigned int q; + + if (netif_msg_probe(pdata)) + dev_dbg(pdata->dev, "close"); + + netif_tx_stop_all_queues(ndev); + + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { + napi_disable(&queue->tx_napi); + napi_disable(&queue->rx_napi); + } + + phylink_stop(pdata->phylink); + phylink_disconnect_phy(pdata->phylink); + + netif_carrier_off(ndev); + + spin_lock_irqsave(&pdata->lock, flags); + hw_if->reset_hw(pdata); + spin_unlock_irqrestore(&pdata->lock, flags); + + phytmac_free_resource(pdata); + + if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) + phytmac_ptp_unregister(pdata); + + /* phytmac_powerup */ + if (pdata->power_state == PHYTMAC_POWERON) + hw_if->poweron(pdata, PHYTMAC_POWEROFF); + + return 0; +} + +static int phytmac_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) +{ + struct phytmac *pdata = netdev_priv(dev); + int ret; + + if (!netif_running(dev)) + return -EINVAL; + + switch (cmd) { + case SIOCGMIIPHY: + case SIOCGMIIREG: + case SIOCSMIIREG: + ret = phylink_mii_ioctl(pdata->phylink, rq, cmd); + break; +#ifdef CONFIG_PHYTMAC_ENABLE_PTP + case SIOCSHWTSTAMP: + ret = phytmac_ptp_set_ts_config(dev, rq, cmd); + break; + case SIOCGHWTSTAMP: + ret = phytmac_ptp_get_ts_config(dev, rq); + break; +#endif + default: + break; + } + + return ret; +} + +static inline int phytmac_set_features(struct net_device *netdev, + netdev_features_t features) +{ + struct phytmac *pdata = netdev_priv(netdev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + netdev_features_t changed = features ^ netdev->features; + + /* TX checksum offload */ + if (changed & NETIF_F_HW_CSUM) { + if (features & NETIF_F_HW_CSUM) + hw_if->enable_tx_csum(pdata, 1); + else + hw_if->enable_tx_csum(pdata, 0); + } + + /* RX checksum offload */ + if (changed & NETIF_F_RXCSUM) { + if (features & NETIF_F_RXCSUM && + !(netdev->flags & IFF_PROMISC)) + hw_if->enable_rx_csum(pdata, 1); + else + hw_if->enable_rx_csum(pdata, 0); + } + return 0; +} + +static netdev_features_t phytmac_features_check(struct sk_buff *skb, + struct net_device *dev, + netdev_features_t features) +{ + unsigned int nr_frags, f; + unsigned int hdrlen; + + /* there is only one buffer or protocol is not UDP */ + if (!skb_is_nonlinear(skb) || (ip_hdr(skb)->protocol != IPPROTO_UDP)) + return features; + + /* length of header */ + hdrlen = skb_transport_offset(skb); + + if (!IS_ALIGNED(skb_headlen(skb) - hdrlen, PHYTMAC_TX_LEN_ALIGN)) + return features & ~NETIF_F_TSO; + + nr_frags = skb_shinfo(skb)->nr_frags; + /* No need to check last fragment */ + nr_frags--; + for (f = 0; f < nr_frags; f++) { + const skb_frag_t *frag = &skb_shinfo(skb)->frags[f]; + + if (!IS_ALIGNED(skb_frag_size(frag), PHYTMAC_TX_LEN_ALIGN)) + return features & ~NETIF_F_TSO; + } + return features; +} + +int phytmac_reset_ringsize(struct phytmac *pdata, u32 rx_size, u32 tx_size) +{ + int ret = 0; + int reset = 0; + + if (netif_running(pdata->ndev)) { + reset = 1; + phytmac_close(pdata->ndev); + } + + pdata->rx_ring_size = rx_size; + pdata->tx_ring_size = tx_size; + + if (reset) + phytmac_open(pdata->ndev); + + return ret; +} + +static const struct net_device_ops phytmac_netdev_ops = { + .ndo_open = phytmac_open, + .ndo_stop = phytmac_close, + .ndo_start_xmit = phytmac_start_xmit, + .ndo_set_rx_mode = phytmac_set_rx_mode, + .ndo_get_stats = phytmac_get_stats, + .ndo_eth_ioctl = phytmac_ioctl, + .ndo_validate_addr = eth_validate_addr, + .ndo_change_mtu = phytmac_change_mtu, + .ndo_set_mac_address = phytmac_set_mac_address, + .ndo_set_features = phytmac_set_features, + .ndo_features_check = phytmac_features_check, + .ndo_vlan_rx_add_vid = ncsi_vlan_rx_add_vid, + .ndo_vlan_rx_kill_vid = ncsi_vlan_rx_kill_vid, +}; + +static int phytmac_init(struct phytmac *pdata) +{ + struct net_device *ndev = pdata->ndev; + unsigned int q; + struct phytmac_queue *queue; + int ret; + + if (netif_msg_probe(pdata)) + dev_dbg(pdata->dev, "phytmac init !\n"); + + spin_lock_init(&pdata->lock); + + /* set the queue register mapping once for all: queue0 has a special + * register mapping but we don't want to test the queue index then + * compute the corresponding register offset at run time. + */ + for (q = 0; q < pdata->queues_num; ++q) { + queue = &pdata->queues[q]; + queue->pdata = pdata; + queue->index = q; + spin_lock_init(&queue->tx_lock); + + netif_napi_add(ndev, &queue->tx_napi, phytmac_tx_poll); + netif_napi_add(ndev, &queue->rx_napi, phytmac_rx_poll); + + if (pdata->irq_type == IRQ_TYPE_INT || pdata->irq_type == IRQ_TYPE_MSI) { + queue->irq = pdata->queue_irq[q]; + if (pdata->irq_type == IRQ_TYPE_INT) + ret = devm_request_irq(pdata->dev, queue->irq, phytmac_irq, + IRQF_SHARED, ndev->name, queue); + else + ret = devm_request_irq(pdata->dev, queue->irq, phytmac_irq, + 0, ndev->name, queue); + + if (ret) { + dev_err(pdata->dev, + "Unable to request IRQ %d (error %d)\n", + queue->irq, ret); + return ret; + } + } + } + + if (pdata->irq_type == IRQ_TYPE_INTX) { + ret = devm_request_irq(pdata->dev, pdata->queue_irq[0], phytmac_intx_irq, + IRQF_SHARED, ndev->name, pdata); + if (ret) { + dev_err(pdata->dev, + "Unable to request INTX IRQ %d (error %d)\n", + pdata->queue_irq[0], ret); + return ret; + } + } + + ndev->netdev_ops = &phytmac_netdev_ops; + phytmac_set_ethtool_ops(ndev); + eth_hw_addr_random(pdata->ndev); + + if (ndev->hw_features & NETIF_F_NTUPLE) { + INIT_LIST_HEAD(&pdata->rx_fs_list.list); + pdata->rx_fs_list.count = 0; + spin_lock_init(&pdata->rx_fs_lock); + } + + device_set_wakeup_enable(pdata->dev, pdata->wol ? 1 : 0); + + return 0; +} + +void phytmac_default_config(struct phytmac *pdata) +{ + struct net_device *ndev = pdata->ndev; + + pdata->rx_irq_mask = PHYTMAC_RX_INT_FLAGS; + pdata->tx_irq_mask = PHYTMAC_TX_INT_FLAGS; + pdata->tx_ring_size = DEFAULT_TX_RING_SIZE; + pdata->rx_ring_size = DEFAULT_RX_RING_SIZE; + pdata->max_tx_length = PHYTMAC_MAX_TX_LEN; + pdata->min_tx_length = PHYTMAC_MIN_TX_LEN; + pdata->pause = true; + + ndev->hw_features = NETIF_F_SG; + + if (pdata->capacities & PHYTMAC_CAPS_LSO) + ndev->hw_features |= NETIF_F_TSO; + + if (pdata->use_ncsi) { + ndev->hw_features &= ~(NETIF_F_HW_CSUM | NETIF_F_RXCSUM); + ndev->hw_features |= NETIF_F_HW_VLAN_CTAG_FILTER; + } else { + ndev->hw_features |= NETIF_F_HW_CSUM | NETIF_F_RXCSUM; + } + + if (pdata->capacities & PHYTMAC_CAPS_SG_DISABLED) + ndev->hw_features &= ~NETIF_F_SG; + + ndev->hw_features |= NETIF_F_NTUPLE; + + ndev->min_mtu = ETH_MIN_MTU; + if (pdata->capacities & PHYTMAC_CAPS_JUMBO) + ndev->max_mtu = pdata->jumbo_len - ETH_HLEN - ETH_FCS_LEN; + else + ndev->max_mtu = ETH_DATA_LEN; + + ndev->features = ndev->hw_features; +} + +static void phytmac_ncsi_handler(struct ncsi_dev *nd) +{ + if (unlikely(nd->state != ncsi_dev_state_functional)) + return; + + netdev_dbg(nd->dev, "NCSI interface %s\n", + nd->link_up ? "up" : "down"); +} + +int phytmac_drv_probe(struct phytmac *pdata) +{ + struct net_device *ndev = pdata->ndev; + struct device *dev = pdata->dev; + int ret = 0; + + if (netif_msg_probe(pdata)) + dev_dbg(pdata->dev, "phytmac drv probe start\n"); + + phytmac_default_config(pdata); + + if (dma_set_mask(dev, DMA_BIT_MASK(40)) || + dma_set_mask_and_coherent(dev, DMA_BIT_MASK(40))) { + dev_err(dev, "dma_set_mask or coherent failed\n"); + return 1; + } + + ret = phytmac_init(pdata); + if (ret) + goto err_out; + + if (pdata->use_ncsi) { + pdata->ncsidev = ncsi_register_dev(ndev, phytmac_ncsi_handler); + if (!pdata->ncsidev) + goto err_out; + } + + netif_carrier_off(ndev); + ret = register_netdev(ndev); + if (ret) { + dev_err(pdata->dev, "Cannot register net device, aborting.\n"); + goto err_out; + } + + if (pdata->use_mii && !pdata->mii_bus) { + ret = phytmac_mdio_register(pdata); + if (ret) { + netdev_err(ndev, "MDIO bus registration failed\n"); + goto err_out_free_mdiobus; + } + } + + ret = phytmac_phylink_create(pdata); + if (ret) { + netdev_err(ndev, "phytmac phylink create failed, error %d\n", ret); + goto err_phylink_init; + } + + if (netif_msg_probe(pdata)) + dev_dbg(pdata->dev, "probe successfully! Phytium %s at 0x%08lx irq %d (%pM)\n", + "MAC", ndev->base_addr, ndev->irq, ndev->dev_addr); + + return 0; + +err_phylink_init: + if (pdata->mii_bus) + mdiobus_unregister(pdata->mii_bus); + +err_out_free_mdiobus: + if (pdata->mii_bus) + mdiobus_free(pdata->mii_bus); + + unregister_netdev(ndev); + +err_out: + return ret; +} +EXPORT_SYMBOL_GPL(phytmac_drv_probe); + +int phytmac_drv_remove(struct phytmac *pdata) +{ + struct net_device *ndev = pdata->ndev; + + if (ndev) { + if (pdata->use_ncsi && pdata->ncsidev) + ncsi_unregister_dev(pdata->ncsidev); + + unregister_netdev(ndev); + + if (pdata->use_mii && pdata->mii_bus) { + mdiobus_unregister(pdata->mii_bus); + mdiobus_free(pdata->mii_bus); + } + + if (pdata->phylink) + phylink_destroy(pdata->phylink); + } + + return 0; +} +EXPORT_SYMBOL_GPL(phytmac_drv_remove); + +int phytmac_drv_suspend(struct phytmac *pdata) +{ + int q; + unsigned long flags; + struct phytmac_queue *queue; + struct phytmac_hw_if *hw_if = pdata->hw_if; + + if (!netif_running(pdata->ndev)) + return 0; + + if (pdata->power_state == PHYTMAC_POWEROFF) + return 0; + + netif_carrier_off(pdata->ndev); + netif_device_detach(pdata->ndev); + + /* napi_disable */ + for (q = 0, queue = pdata->queues; q < pdata->queues_num; + ++q, ++queue) { + napi_disable(&queue->tx_napi); + napi_disable(&queue->rx_napi); + } + + if (pdata->wol) { + hw_if->set_wol(pdata, pdata->wol); + } else { + rtnl_lock(); + phylink_stop(pdata->phylink); + rtnl_unlock(); + spin_lock_irqsave(&pdata->lock, flags); + hw_if->reset_hw(pdata); + hw_if->poweron(pdata, PHYTMAC_POWEROFF); + spin_unlock_irqrestore(&pdata->lock, flags); + } + + return 0; +} +EXPORT_SYMBOL_GPL(phytmac_drv_suspend); + +int phytmac_drv_resume(struct phytmac *pdata) +{ + int q; + struct phytmac_queue *queue; + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct ethtool_rx_fs_item *item; + + if (!netif_running(pdata->ndev)) + return 0; + + if (pdata->power_state == PHYTMAC_POWEROFF) + hw_if->poweron(pdata, PHYTMAC_POWERON); + + if (hw_if->init_msg_ring) + hw_if->init_msg_ring(pdata); + + if (pdata->wol) { + hw_if->set_wol(pdata, 0); + rtnl_lock(); + phylink_stop(pdata->phylink); + rtnl_unlock(); + } + + for (q = 0, queue = pdata->queues; q < pdata->queues_num; + ++q, ++queue) { + napi_enable(&queue->tx_napi); + napi_enable(&queue->rx_napi); + } + + hw_if->init_hw(pdata); + phytmac_set_rx_mode(pdata->ndev); + phytmac_set_features(pdata->ndev, pdata->ndev->features); + list_for_each_entry(item, &pdata->rx_fs_list.list, list) + hw_if->add_fdir_entry(pdata, &item->fs); + + rtnl_lock(); + phylink_start(pdata->phylink); + rtnl_unlock(); + + netif_device_attach(pdata->ndev); + + return 0; +} +EXPORT_SYMBOL_GPL(phytmac_drv_resume); + +struct phytmac *phytmac_alloc_pdata(struct device *dev) +{ + struct phytmac *pdata; + struct net_device *netdev; + + netdev = alloc_etherdev_mq(sizeof(struct phytmac), + PHYTMAC_MAX_QUEUES); + if (!netdev) { + dev_err(dev, "alloc_etherdev_mq failed\n"); + return ERR_PTR(-ENOMEM); + } + SET_NETDEV_DEV(netdev, dev); + pdata = netdev_priv(netdev); + pdata->ndev = netdev; + pdata->dev = dev; + + spin_lock_init(&pdata->lock); + spin_lock_init(&pdata->msg_lock); + spin_lock_init(&pdata->ts_clk_lock); + pdata->msg_enable = netif_msg_init(debug, PHYTMAC_DEFAULT_MSG_ENABLE); + + return pdata; +} +EXPORT_SYMBOL_GPL(phytmac_alloc_pdata); + +void phytmac_free_pdata(struct phytmac *pdata) +{ + struct net_device *netdev = pdata->ndev; + + free_netdev(netdev); +} +EXPORT_SYMBOL_GPL(phytmac_free_pdata); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium Ethernet driver"); +MODULE_AUTHOR("Wenting Song"); +MODULE_ALIAS("platform:phytmac"); + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_pci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_pci.c new file mode 100644 index 0000000000000000000000000000000000000000..fd21bf80f1388350d2692f11ebacadc97c701e10 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_pci.c @@ -0,0 +1,318 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Phytium GMAC PCI wrapper. + * + */ + +#include +#include +#include "phytmac.h" +#include "phytmac_v1.h" +#include "phytmac_v2.h" + +#define PCI_DEVICE_ID_GMAC 0xDC3B +#define PCI_SUBDEVICE_ID_SGMII 0x1000 +#define PCI_SUBDEVICE_ID_1000BASEX 0x1001 +#define PCI_SUBDEVICE_ID_2500BASEX 0x1002 +#define PCI_SUBDEVICE_ID_5GBASER 0x1003 +#define PCI_SUBDEVICE_ID_USXGMII 0x1004 +#define PCI_SUBDEVICE_ID_10GBASER 0x1005 + +struct phytmac_data { + struct phytmac_hw_if *hw_if; + u32 caps; + u32 tsu_rate; + u16 queue_num; + int speed; + bool duplex; + bool use_mii; + bool use_ncsi; + phy_interface_t interface; + const struct property_entry *properties; +}; + +static const u32 fixedlink[][5] = { + {0, 1, 1000, 1, 0}, + {0, 1, 2500, 1, 0}, + {0, 1, 5000, 1, 0}, + {0, 1, 10000, 1, 0}, +}; + +static const struct property_entry fl_properties[][2] = { + {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[0]), {} }, + {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[1]), {} }, + {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[2]), {} }, + {PROPERTY_ENTRY_U32_ARRAY("fixed-link", fixedlink[3]), {} }, +}; + +static int phytmac_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) +{ + struct phytmac_data *data = (struct phytmac_data *)id->driver_data; + struct phytmac *pdata; + struct device *dev = &pdev->dev; + void __iomem * const *iomap_table; + struct fwnode_handle *fw_node = NULL; + int bar_mask; + int ret, i; + + pdata = phytmac_alloc_pdata(dev); + if (IS_ERR(pdata)) { + ret = PTR_ERR(pdata); + goto err_alloc; + } + + pdata->pcidev = pdev; + pci_set_drvdata(pdev, pdata); + + ret = pcim_enable_device(pdev); + if (ret) { + dev_err(dev, "pcim_enable_device failed\n"); + goto err_pci_enable; + } + + /* Obtain the mmio areas for the device */ + bar_mask = pci_select_bars(pdev, IORESOURCE_MEM); + ret = pcim_iomap_regions(pdev, bar_mask, PHYTMAC_DRV_NAME); + if (ret) { + dev_err(dev, "pcim_iomap_regions failed\n"); + goto err_pci_enable; + } + + iomap_table = pcim_iomap_table(pdev); + if (!iomap_table) { + dev_err(dev, "pcim_iomap_table failed\n"); + ret = -ENOMEM; + goto err_pci_enable; + } + + pdata->mac_regs = iomap_table[0]; + if (!pdata->mac_regs) { + dev_err(dev, "xgmac ioremap failed\n"); + ret = -ENOMEM; + goto err_pci_enable; + } + + pdata->msg_regs = iomap_table[1]; + if (!pdata->msg_regs) { + dev_err(dev, "xpcs ioremap failed\n"); + ret = -ENOMEM; + goto err_pci_enable; + } + + pci_set_master(pdev); + + /* para */ + pdata->dma_burst_length = DEFAULT_DMA_BURST_LENGTH; + pdata->jumbo_len = DEFAULT_DMA_BURST_LENGTH; + pdata->wol |= PHYTMAC_WAKE_MAGIC; + pdata->use_ncsi = data->use_ncsi; + pdata->use_mii = data->use_mii; + pdata->phy_interface = data->interface; + pdata->queues_num = data->queue_num; + pdata->capacities = data->caps; + pdata->hw_if = data->hw_if; + + if (!pdata->use_mii) { + fw_node = fwnode_create_software_node(data->properties, NULL); + if (IS_ERR(fw_node)) { + dev_err(dev, "Failed to create software node\n"); + goto err_pci_enable; + } + pdata->dev->fwnode = fw_node; + } + + /* irq */ + ret = pci_alloc_irq_vectors(pdev, pdata->queues_num, pdata->queues_num, PCI_IRQ_MSI); + if (ret < 0) { + pdata->irq_type = IRQ_TYPE_INTX; + pdata->queue_irq[0] = pdev->irq; + } else { + pdata->irq_type = IRQ_TYPE_MSI; + for (i = 0; i < pdata->queues_num; i++) + pdata->queue_irq[i] = pci_irq_vector(pdev, i); + } + + /* Configure the netdev resource */ + ret = phytmac_drv_probe(pdata); + if (ret) + goto err_irq_vectors; + + netdev_notice(pdata->ndev, "net device enabled\n"); + + return 0; + +err_irq_vectors: + if (fw_node) + fwnode_remove_software_node(fw_node); + pci_free_irq_vectors(pdata->pcidev); + +err_pci_enable: + phytmac_free_pdata(pdata); + +err_alloc: + dev_notice(dev, "net device not enabled\n"); + + return ret; +} + +static void phytmac_pci_remove(struct pci_dev *pdev) +{ + struct phytmac *pdata = pci_get_drvdata(pdev); + struct fwnode_handle *fw_node = dev_fwnode(pdata->dev); + int i = 0; + int bar_mask; + + if (fw_node) { + fwnode_remove_software_node(fw_node); + pdata->dev->fwnode = NULL; + } + + phytmac_drv_remove(pdata); + + for (i = 0; i < pdata->queues_num; i++) + free_irq(pci_irq_vector(pdev, i), &pdata->queues[i]); + pci_free_irq_vectors(pdev); + + phytmac_free_pdata(pdata); + bar_mask = pci_select_bars(pdev, IORESOURCE_MEM); + pcim_iounmap_regions(pdev, bar_mask); + + pci_disable_device(pdev); +} + +static int __maybe_unused phytmac_pci_suspend(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytmac *pdata = pci_get_drvdata(pdev); + int ret; + + ret = phytmac_drv_suspend(pdata); + + return ret; +} + +static int __maybe_unused phytmac_pci_resume(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytmac *pdata = pci_get_drvdata(pdev); + int ret; + + ret = phytmac_drv_resume(pdata); + + return ret; +} + +struct phytmac_data phytmac_sgmii = { + .hw_if = &phytmac_1p0_hw, + .caps = PHYTMAC_CAPS_TAILPTR + | PHYTMAC_CAPS_START + | PHYTMAC_CAPS_JUMBO + | PHYTMAC_CAPS_LSO, + .queue_num = 4, + .use_ncsi = false, + .use_mii = true, + .interface = PHY_INTERFACE_MODE_SGMII, +}; + +struct phytmac_data phytmac_1000basex = { + .hw_if = &phytmac_1p0_hw, + .caps = PHYTMAC_CAPS_TAILPTR + | PHYTMAC_CAPS_START + | PHYTMAC_CAPS_JUMBO + | PHYTMAC_CAPS_LSO, + .queue_num = 4, + .use_ncsi = false, + .use_mii = false, + .speed = 1000, + .duplex = true, + .interface = PHY_INTERFACE_MODE_SGMII, + .properties = fl_properties[0], +}; + +struct phytmac_data phytmac_2500basex = { + .hw_if = &phytmac_1p0_hw, + .caps = PHYTMAC_CAPS_TAILPTR + | PHYTMAC_CAPS_START + | PHYTMAC_CAPS_JUMBO + | PHYTMAC_CAPS_LSO, + .queue_num = 4, + .use_ncsi = false, + .use_mii = false, + .speed = 2500, + .duplex = true, + .interface = PHY_INTERFACE_MODE_2500BASEX, + .properties = fl_properties[1], +}; + +struct phytmac_data phytmac_5000baser = { + .hw_if = &phytmac_1p0_hw, + .caps = PHYTMAC_CAPS_TAILPTR + | PHYTMAC_CAPS_START + | PHYTMAC_CAPS_JUMBO + | PHYTMAC_CAPS_LSO, + .queue_num = 4, + .use_ncsi = false, + .use_mii = false, + .speed = 5000, + .duplex = true, + .interface = PHY_INTERFACE_MODE_5GBASER, + .properties = fl_properties[2], +}; + +struct phytmac_data phytmac_usxgmii = { + .hw_if = &phytmac_1p0_hw, + .caps = PHYTMAC_CAPS_TAILPTR + | PHYTMAC_CAPS_START + | PHYTMAC_CAPS_JUMBO + | PHYTMAC_CAPS_LSO, + .queue_num = 4, + .use_ncsi = false, + .use_mii = false, + .speed = 10000, + .duplex = true, + .interface = PHY_INTERFACE_MODE_USXGMII, + .properties = fl_properties[3], +}; + +static const struct pci_device_id phytmac_pci_table[] = { + { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, + PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_SGMII), + .driver_data = (kernel_ulong_t)&phytmac_sgmii}, + { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, + PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_1000BASEX), + .driver_data = (kernel_ulong_t)&phytmac_1000basex}, + { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, + PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_2500BASEX), + .driver_data = (kernel_ulong_t)&phytmac_2500basex}, + { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, + PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_5GBASER), + .driver_data = (kernel_ulong_t)&phytmac_5000baser}, + { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, + PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_USXGMII), + .driver_data = (kernel_ulong_t)&phytmac_usxgmii}, + { PCI_DEVICE_SUB(PCI_VENDOR_ID_PHYTIUM, PCI_DEVICE_ID_GMAC, + PCI_VENDOR_ID_PHYTIUM, PCI_SUBDEVICE_ID_10GBASER), + .driver_data = (kernel_ulong_t)&phytmac_usxgmii}, + /* Last entry must be zero */ + { 0, } +}; +MODULE_DEVICE_TABLE(pci, phytmac_pci_table); + +static const struct dev_pm_ops phytmac_pci_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytmac_pci_suspend, phytmac_pci_resume) +}; + +static struct pci_driver phytmac_driver = { + .name = PHYTMAC_DRV_NAME, + .id_table = phytmac_pci_table, + .probe = phytmac_pci_probe, + .remove = phytmac_pci_remove, + .driver = { + .pm = &phytmac_pci_pm_ops, + } +}; + +module_pci_driver(phytmac_driver); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium NIC PCI wrapper"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_platform.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_platform.c new file mode 100644 index 0000000000000000000000000000000000000000..305ff5866e2fe0fdc71b0a347275b95e674f4308 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_platform.c @@ -0,0 +1,255 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Phytium GMAC Platform wrapper. + * + */ + +#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt +#include +#include +#include +#include +#include +#include "phytmac.h" +#include "phytmac_v1.h" +#include "phytmac_v2.h" + +static const struct phytmac_config phytium_1p0_config = { + .hw_if = &phytmac_1p0_hw, + .caps = PHYTMAC_CAPS_TAILPTR + | PHYTMAC_CAPS_START + | PHYTMAC_CAPS_JUMBO + | PHYTMAC_CAPS_LSO, + .queue_num = 4, + .tsu_rate = 300000000, +}; + +static const struct phytmac_config phytium_2p0_config = { + .hw_if = &phytmac_2p0_hw, + .caps = PHYTMAC_CAPS_TAILPTR + | PHYTMAC_CAPS_LPI + | PHYTMAC_CAPS_LSO + | PHYTMAC_CAPS_MSG + | PHYTMAC_CAPS_JUMBO, + .queue_num = 2, + .tsu_rate = 300000000, +}; + +#if defined(CONFIG_OF) +static const struct of_device_id phytmac_dt_ids[] = { + { .compatible = "phytium,gmac-1.0", .data = &phytium_1p0_config }, + { .compatible = "phytium,gmac-2.0", .data = &phytium_2p0_config }, + { /* sentinel */ } +}; +MODULE_DEVICE_TABLE(of, phytmac_dt_ids); +#endif /* CONFIG_OF */ + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytmac_acpi_ids[] = { + { .id = "PHYT0046", .driver_data = (kernel_ulong_t)&phytium_1p0_config }, + { } +}; + +MODULE_DEVICE_TABLE(acpi, phytmac_acpi_ids); +#else +#define phytmac_acpi_ids NULL +#endif + +static int phytmac_get_phy_mode(struct platform_device *pdev) +{ + const char *pm; + int err, i; + + err = device_property_read_string(&pdev->dev, "phy-mode", &pm); + if (err < 0) + return err; + + for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) { + if (!strcasecmp(pm, phy_modes(i))) + return i; + } + + return -ENODEV; +} + +static int phytmac_plat_probe(struct platform_device *pdev) +{ + const struct phytmac_config *phytmac_config = &phytium_1p0_config; + struct device_node *np = pdev->dev.of_node; + struct resource *regs; + struct phytmac *pdata; + int ret, i; + u32 queue_num; + + pdata = phytmac_alloc_pdata(&pdev->dev); + if (IS_ERR(pdata)) { + ret = PTR_ERR(pdata); + goto err_alloc; + } + + platform_set_drvdata(pdev, pdata); + + pdata->platdev = pdev; + + if (pdev->dev.of_node) { + const struct of_device_id *match; + + match = of_match_node(phytmac_dt_ids, np); + if (match && match->data) { + phytmac_config = match->data; + pdata->hw_if = phytmac_config->hw_if; + pdata->capacities = phytmac_config->caps; + pdata->queues_max_num = phytmac_config->queue_num; + } + } else if (has_acpi_companion(&pdev->dev)) { + const struct acpi_device_id *match; + + match = acpi_match_device(phytmac_acpi_ids, &pdev->dev); + if (match && match->driver_data) { + phytmac_config = (void *)match->driver_data; + pdata->hw_if = phytmac_config->hw_if; + pdata->capacities = phytmac_config->caps; + pdata->queues_max_num = phytmac_config->queue_num; + } + } + + i = 0; + pdata->mac_regs = devm_platform_get_and_ioremap_resource(pdev, i, ®s); + if (IS_ERR(pdata->mac_regs)) { + dev_err(&pdev->dev, "mac_regs ioremap failed\n"); + ret = PTR_ERR(pdata->mac_regs); + goto err_mem; + } + pdata->ndev->base_addr = regs->start; + + if (pdata->capacities & PHYTMAC_CAPS_MSG) { + ++i; + regs = platform_get_resource(pdev, IORESOURCE_MEM, i); + if (regs) { + pdata->msg_regs = ioremap_wt(regs->start, MEMORY_SIZE); + if (!pdata->msg_regs) { + dev_err(&pdev->dev, "msg_regs ioremap failed, i=%d\n", i); + goto err_mem; + } + } + } + + if (device_property_read_bool(&pdev->dev, "lpi")) + pdata->capacities |= PHYTMAC_CAPS_LPI; + + if (pdata->capacities & PHYTMAC_CAPS_LPI) { + /* lpi resource */ + ++i; + regs = platform_get_resource(pdev, IORESOURCE_MEM, i); + if (regs) { + pdata->mhu_regs = ioremap(regs->start, MHU_SIZE); + if (!pdata->mhu_regs) + dev_err(&pdev->dev, "mhu_regs ioremap failed, i=%d\n", i); + } + } + + if (device_property_read_u32(&pdev->dev, "dma-burst-length", &pdata->dma_burst_length)) + pdata->dma_burst_length = DEFAULT_DMA_BURST_LENGTH; + + if (device_property_read_u32(&pdev->dev, "jumbo-max-length", &pdata->jumbo_len)) + pdata->jumbo_len = DEFAULT_JUMBO_MAX_LENGTH; + + if (device_property_read_u32(&pdev->dev, "queue-number", &queue_num)) + pdata->queues_num = pdata->queues_max_num; + else + pdata->queues_num = queue_num; + + pdata->wol = 0; + if (device_property_read_bool(&pdev->dev, "magic-packet")) + pdata->wol |= PHYTMAC_WAKE_MAGIC; + + pdata->use_ncsi = device_property_read_bool(&pdev->dev, "use-ncsi"); + pdata->use_mii = device_property_read_bool(&pdev->dev, "use-mii"); + + pdata->power_state = PHYTMAC_POWEROFF; + + device_set_wakeup_capable(&pdev->dev, pdata->wol & PHYTMAC_WOL_MAGIC_PACKET); + + for (i = 0; i < pdata->queues_num; i++) { + pdata->irq_type = IRQ_TYPE_INT; + pdata->queue_irq[i] = platform_get_irq(pdev, i); + } + + ret = phytmac_get_phy_mode(pdev); + if (ret < 0) + pdata->phy_interface = PHY_INTERFACE_MODE_MII; + else + pdata->phy_interface = ret; + + ret = phytmac_drv_probe(pdata); + if (ret) + goto err_mem; + + if (netif_msg_probe(pdata)) { + dev_notice(&pdev->dev, "phytium net device enabled\n"); + dev_dbg(pdata->dev, "use_ncsi:%d, use_mii:%d, wol:%d, queues_num:%d\n", + pdata->use_ncsi, pdata->use_mii, pdata->wol, pdata->queues_num); + } + + return 0; + +err_mem: + phytmac_free_pdata(pdata); + +err_alloc: + dev_err(&pdev->dev, "phytium net device not enabled\n"); + + return ret; +} + +static int phytmac_plat_remove(struct platform_device *pdev) +{ + struct phytmac *pdata = platform_get_drvdata(pdev); + + phytmac_drv_remove(pdata); + phytmac_free_pdata(pdata); + + return 0; +} + +static int __maybe_unused phytmac_plat_suspend(struct device *dev) +{ + struct phytmac *pdata = dev_get_drvdata(dev); + int ret; + + ret = phytmac_drv_suspend(pdata); + + return ret; +} + +static int __maybe_unused phytmac_plat_resume(struct device *dev) +{ + struct phytmac *pdata = dev_get_drvdata(dev); + int ret; + + ret = phytmac_drv_resume(pdata); + + return ret; +} + +static const struct dev_pm_ops phytmac_plat_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytmac_plat_suspend, phytmac_plat_resume) +}; + +static struct platform_driver phytmac_driver = { + .probe = phytmac_plat_probe, + .remove = phytmac_plat_remove, + .driver = { + .name = PHYTMAC_DRV_NAME, + .of_match_table = of_match_ptr(phytmac_dt_ids), + .acpi_match_table = phytmac_acpi_ids, + .pm = &phytmac_plat_pm_ops, + }, +}; + +module_platform_driver(phytmac_driver); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium Ethernet driver"); +MODULE_AUTHOR("Wenting Song"); +MODULE_ALIAS("platform:phytmac"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_ptp.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_ptp.c new file mode 100644 index 0000000000000000000000000000000000000000..26b1b75edbde1ded359a5e6fbef51c3306dc7379 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_ptp.c @@ -0,0 +1,304 @@ +// SPDX-License-Identifier: GPL-2.0-only +/** + * 1588 PTP support for Phytium GMAC device. + * + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytmac.h" +#include "phytmac_ptp.h" + +bool phytmac_ptp_one_step(struct sk_buff *skb) +{ + struct ptp_header *hdr; + unsigned int ptp_class; + u8 msgtype; + + /* No need to parse packet if PTP TS is not involved */ + if (likely(!(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP))) + goto not_oss; + + /* Identify and return whether PTP one step sync is being processed */ + ptp_class = ptp_classify_raw(skb); + if (ptp_class == PTP_CLASS_NONE) + goto not_oss; + + hdr = ptp_parse_header(skb, ptp_class); + if (!hdr) + goto not_oss; + + if (hdr->flag_field[0] & 0x2) + goto not_oss; + + msgtype = ptp_get_msgtype(hdr, ptp_class); + if (msgtype == PTP_MSGTYPE_SYNC) + return true; + +not_oss: + return false; +} + +int phytmac_ptp_gettime(struct ptp_clock_info *ptp, struct timespec64 *ts) +{ + struct phytmac *pdata = container_of(ptp, struct phytmac, ptp_clock_info); + struct phytmac_hw_if *hw_if = pdata->hw_if; + unsigned long flags; + + spin_lock_irqsave(&pdata->ts_clk_lock, flags); + hw_if->get_time(pdata, ts); + spin_unlock_irqrestore(&pdata->ts_clk_lock, flags); + + return 0; +} + +int phytmac_ptp_settime(struct ptp_clock_info *ptp, + const struct timespec64 *ts) +{ + struct phytmac *pdata = container_of(ptp, struct phytmac, ptp_clock_info); + struct phytmac_hw_if *hw_if = pdata->hw_if; + unsigned long flags; + + spin_lock_irqsave(&pdata->ts_clk_lock, flags); + hw_if->set_time(pdata, ts->tv_sec, ts->tv_nsec); + spin_unlock_irqrestore(&pdata->ts_clk_lock, flags); + + return 0; +} + +int phytmac_ptp_adjfine(struct ptp_clock_info *ptp, long scaled_ppm) +{ + struct phytmac *pdata = container_of(ptp, struct phytmac, ptp_clock_info); + struct phytmac_hw_if *hw_if = pdata->hw_if; + bool negative = false; + + if (scaled_ppm < 0) { + negative = true; + scaled_ppm = -scaled_ppm; + } + + hw_if->adjust_fine(pdata, scaled_ppm, negative); + return 0; +} + +int phytmac_ptp_adjtime(struct ptp_clock_info *ptp, s64 delta) +{ + struct phytmac *pdata = container_of(ptp, struct phytmac, ptp_clock_info); + struct phytmac_hw_if *hw_if = pdata->hw_if; + int negative = 0; + + if (delta < 0) { + negative = 1; + delta = -delta; + } + + spin_lock_irq(&pdata->ts_clk_lock); + hw_if->adjust_time(pdata, delta, negative); + spin_unlock_irq(&pdata->ts_clk_lock); + + return 0; +} + +int phytmac_ptp_enable(struct ptp_clock_info *ptp, + struct ptp_clock_request *rq, int on) +{ + return -EOPNOTSUPP; +} + +void phytmac_ptp_init_timer(struct phytmac *pdata) +{ + struct phytmac_hw_if *hw_if = pdata->hw_if; + u32 rem = 0; + u64 adj; + + pdata->ts_rate = hw_if->get_ts_rate(pdata); + pdata->ts_incr.ns = div_u64_rem(NSEC_PER_SEC, pdata->ts_rate, &rem); + if (rem) { + adj = rem; + adj <<= 24; + pdata->ts_incr.sub_ns = div_u64(adj, pdata->ts_rate); + } else { + pdata->ts_incr.sub_ns = 0; + } +} + +void phytmac_ptp_rxstamp(struct phytmac *pdata, struct sk_buff *skb, + struct phytmac_dma_desc *desc) +{ + struct skb_shared_hwtstamps *shhwtstamps = skb_hwtstamps(skb); + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct timespec64 ts; + + if (hw_if->ts_valid(pdata, desc, PHYTMAC_RX)) { + hw_if->get_timestamp(pdata, desc->desc4, desc->desc5, &ts); + memset(shhwtstamps, 0, sizeof(struct skb_shared_hwtstamps)); + shhwtstamps->hwtstamp = ktime_set(ts.tv_sec, ts.tv_nsec); + } +} + +int phytmac_ptp_txstamp(struct phytmac_queue *queue, struct sk_buff *skb, + struct phytmac_dma_desc *desc) +{ + struct phytmac *pdata = queue->pdata; + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct timespec64 ts; + struct skb_shared_hwtstamps shhwtstamps; + + if (queue->pdata->ts_config.tx_type == TS_DISABLED) + return -EOPNOTSUPP; + + if (!hw_if->ts_valid(pdata, desc, PHYTMAC_TX)) + return -EINVAL; + + skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS; + hw_if->get_timestamp(pdata, desc->desc4, desc->desc5, &ts); + memset(&shhwtstamps, 0, sizeof(shhwtstamps)); + shhwtstamps.hwtstamp = ktime_set(ts.tv_sec, ts.tv_nsec); + skb_tstamp_tx(skb, &shhwtstamps); + + return 0; +} + +int phytmac_ptp_register(struct phytmac *pdata) +{ + pdata->ptp_clock_info.owner = THIS_MODULE; + snprintf(pdata->ptp_clock_info.name, 16, "%s", pdata->ndev->name); + pdata->ptp_clock_info.max_adj = 64000000; /* In PPB */ + pdata->ptp_clock_info.n_alarm = 0; + pdata->ptp_clock_info.n_ext_ts = 0; + pdata->ptp_clock_info.n_per_out = 0; + pdata->ptp_clock_info.pps = 1; + pdata->ptp_clock_info.adjfine = phytmac_ptp_adjfine; + pdata->ptp_clock_info.adjtime = phytmac_ptp_adjtime; + pdata->ptp_clock_info.gettime64 = phytmac_ptp_gettime; + pdata->ptp_clock_info.settime64 = phytmac_ptp_settime; + pdata->ptp_clock_info.enable = phytmac_ptp_enable; + pdata->ptp_clock = ptp_clock_register(&pdata->ptp_clock_info, pdata->dev); + if (IS_ERR_OR_NULL(pdata->ptp_clock)) { + dev_err(pdata->dev, "ptp_clock_register failed %lu\n", + PTR_ERR(pdata->ptp_clock)); + return -EINVAL; + } + + return 0; +} + +void phytmac_ptp_unregister(struct phytmac *pdata) +{ + struct phytmac_hw_if *hw_if = pdata->hw_if; + + if (pdata->ptp_clock) + ptp_clock_unregister(pdata->ptp_clock); + pdata->ptp_clock = NULL; + + hw_if->clear_time(pdata); + + dev_info(pdata->dev, "phytmac ptp clock unregistered.\n"); +} + +void phytmac_ptp_init(struct net_device *ndev) +{ + struct phytmac *pdata = netdev_priv(ndev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + + phytmac_ptp_init_timer(pdata); + + hw_if->init_ts_hw(pdata); + + dev_info(pdata->dev, "phytmac ptp clock init success.\n"); +} + +int phytmac_ptp_get_ts_config(struct net_device *dev, struct ifreq *rq) +{ + struct hwtstamp_config *tstamp_config; + struct phytmac *pdata = netdev_priv(dev); + + if (!IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) + return -EOPNOTSUPP; + + tstamp_config = &pdata->ts_config; + + if (copy_to_user(rq->ifr_data, tstamp_config, sizeof(*tstamp_config))) + return -EFAULT; + else + return 0; +} + +int phytmac_ptp_set_ts_config(struct net_device *dev, struct ifreq *ifr, int cmd) +{ + struct hwtstamp_config config; + struct phytmac *pdata = netdev_priv(dev); + struct phytmac_hw_if *hw_if = pdata->hw_if; + struct ts_ctrl tstamp_ctrl; + int ret; + + memset(&tstamp_ctrl, 0, sizeof(struct ts_ctrl)); + + if (copy_from_user(&config, ifr->ifr_data, sizeof(config))) + return -EFAULT; + + switch (config.tx_type) { + case HWTSTAMP_TX_OFF: + break; + case HWTSTAMP_TX_ONESTEP_SYNC: + tstamp_ctrl.one_step = 1; + tstamp_ctrl.tx_control = TS_ALL_FRAMES; + break; + case HWTSTAMP_TX_ON: + tstamp_ctrl.one_step = 0; + tstamp_ctrl.tx_control = TS_ALL_FRAMES; + break; + default: + return -ERANGE; + } + + switch (config.rx_filter) { + case HWTSTAMP_FILTER_NONE: + case HWTSTAMP_FILTER_PTP_V1_L4_SYNC: + case HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ: + break; + case HWTSTAMP_FILTER_PTP_V2_EVENT: + case HWTSTAMP_FILTER_PTP_V2_L2_EVENT: + case HWTSTAMP_FILTER_PTP_V2_L4_EVENT: + case HWTSTAMP_FILTER_PTP_V2_SYNC: + case HWTSTAMP_FILTER_PTP_V2_L2_SYNC: + case HWTSTAMP_FILTER_PTP_V2_L4_SYNC: + case HWTSTAMP_FILTER_PTP_V2_DELAY_REQ: + case HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ: + case HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ: + tstamp_ctrl.rx_control = TS_ALL_PTP_FRAMES; + config.rx_filter = HWTSTAMP_FILTER_PTP_V2_EVENT; + break; + case HWTSTAMP_FILTER_PTP_V1_L4_EVENT: + case HWTSTAMP_FILTER_ALL: + tstamp_ctrl.rx_control = TS_ALL_FRAMES; + config.rx_filter = HWTSTAMP_FILTER_ALL; + break; + default: + config.rx_filter = HWTSTAMP_FILTER_NONE; + return -ERANGE; + } + + ret = hw_if->set_ts_config(pdata, &tstamp_ctrl); + if (ret) + return ret; + + /* save these settings for future reference */ + pdata->ts_config = config; + memcpy(&pdata->ts_config, &config, sizeof(config)); + + if (copy_to_user(ifr->ifr_data, &config, sizeof(config))) + return -EFAULT; + else + return 0; +} + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_ptp.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_ptp.h new file mode 100644 index 0000000000000000000000000000000000000000..72c8b7c67413706496d44d7c7fac110a70513aa4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_ptp.h @@ -0,0 +1,55 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ +/* + * Phytium Ethernet Controller driver + * + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ +#ifndef _PHYTMAC_PTP_H +#define _PHYTMAC_PTP_H + +#ifdef CONFIG_PHYTMAC_ENABLE_PTP +bool phytmac_ptp_one_step(struct sk_buff *skb); +int phytmac_ptp_gettime(struct ptp_clock_info *ptp, struct timespec64 *ts); +int phytmac_ptp_settime(struct ptp_clock_info *ptp, + const struct timespec64 *ts); +int phytmac_ptp_adjfine(struct ptp_clock_info *ptp, long scaled_ppm); +int phytmac_ptp_adjtime(struct ptp_clock_info *ptp, s64 delta); +int phytmac_ptp_enable(struct ptp_clock_info *ptp, + struct ptp_clock_request *rq, int on); +void phytmac_ptp_init_timer(struct phytmac *pdata); +void phytmac_ptp_rxstamp(struct phytmac *pdata, struct sk_buff *skb, + struct phytmac_dma_desc *desc); +int phytmac_ptp_txstamp(struct phytmac_queue *queue, struct sk_buff *skb, + struct phytmac_dma_desc *desc); +int phytmac_ptp_register(struct phytmac *pdata); +void phytmac_ptp_unregister(struct phytmac *pdata); +void phytmac_ptp_init(struct net_device *ndev); +int phytmac_ptp_get_ts_config(struct net_device *dev, struct ifreq *rq); +int phytmac_ptp_set_ts_config(struct net_device *dev, struct ifreq *ifr, int cmd); +#else +static inline bool phytmac_ptp_one_step(struct sk_buff *skb) +{ + return 1; +} + +static inline void phytmac_ptp_rxstamp(struct phytmac *pdata, struct sk_buff *skb, + struct phytmac_dma_desc *desc) {} +static inline int phytmac_ptp_txstamp(struct phytmac_queue *queue, struct sk_buff *skb, + struct phytmac_dma_desc *desc) +{ + return -1; +} + +static inline int phytmac_ptp_register(struct phytmac *pdata) +{ + return 0; +} + +static inline void phytmac_ptp_unregister(struct phytmac *pdata) {} +static inline void phytmac_ptp_init(struct net_device *ndev) {} + +#endif +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v1.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v1.c new file mode 100644 index 0000000000000000000000000000000000000000..ec95c6c79b06681158396f16ab3f0d024ad558d9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v1.c @@ -0,0 +1,1400 @@ +// SPDX-License-Identifier: GPL-2.0-only + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytmac.h" +#include "phytmac_v1.h" + +static int phytmac_enable_promise(struct phytmac *pdata, int enable) +{ + u32 value = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); + + if (enable) + value |= PHYTMAC_BIT(PROMISC); + else + value &= ~PHYTMAC_BIT(PROMISC); + + PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, value); + + return 0; +} + +static int phytmac_enable_multicast(struct phytmac *pdata, int enable) +{ + u32 config; + + if (enable) { + PHYTMAC_WRITE(pdata, PHYTMAC_HASHB, -1); + PHYTMAC_WRITE(pdata, PHYTMAC_HASHT, -1); + config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); + config |= PHYTMAC_BIT(MH_EN); + PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); + } else { + PHYTMAC_WRITE(pdata, PHYTMAC_HASHB, 0); + PHYTMAC_WRITE(pdata, PHYTMAC_HASHT, 0); + config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); + config &= ~PHYTMAC_BIT(MH_EN); + PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); + } + + return 0; +} + +static int phytmac_set_mc_hash(struct phytmac *pdata, unsigned long *mc_filter) +{ + u32 config; + + PHYTMAC_WRITE(pdata, PHYTMAC_HASHB, mc_filter[0]); + PHYTMAC_WRITE(pdata, PHYTMAC_HASHT, mc_filter[1]); + config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); + config |= PHYTMAC_BIT(MH_EN); + PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); + + return 0; +} + +static int phytmac_enable_rxcsum(struct phytmac *pdata, int enable) +{ + u32 value = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); + + if (enable) + value |= PHYTMAC_BIT(RCO_EN); + else + value &= ~PHYTMAC_BIT(RCO_EN); + + PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, value); + + return 0; +} + +static int phytmac_enable_txcsum(struct phytmac *pdata, int enable) +{ + u32 value = PHYTMAC_READ(pdata, PHYTMAC_DCONFIG); + + if (enable) + value |= PHYTMAC_BIT(TCO_EN); + else + value &= ~PHYTMAC_BIT(TCO_EN); + + PHYTMAC_WRITE(pdata, PHYTMAC_DCONFIG, value); + + return 0; +} + +static int phytmac_enable_mdio(struct phytmac *pdata, int enable) +{ + u32 value = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); + + if (enable) + value |= PHYTMAC_BIT(MPE); + else + value &= ~PHYTMAC_BIT(MPE); + + PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, value); + + return 0; +} + +static int phytmac_enable_pause(struct phytmac *pdata, int enable) +{ + u32 value = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); + + if (enable) + value |= PHYTMAC_BIT(PAUSE_EN); + else + value &= ~PHYTMAC_BIT(PAUSE_EN); + + PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, value); + return 0; +} + +static int phytmac_enable_network(struct phytmac *pdata, int enable, int rx_tx) +{ + u32 old_ctrl = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); + u32 ctrl; + + ctrl = old_ctrl; + + if (rx_tx & PHYTMAC_TX) { + if (enable) + ctrl |= PHYTMAC_BIT(TE); + else + ctrl &= ~PHYTMAC_BIT(TE); + } + + if (rx_tx & PHYTMAC_RX) { + if (enable) + ctrl |= PHYTMAC_BIT(RE); + else + ctrl &= ~PHYTMAC_BIT(RE); + } + + if (ctrl ^ old_ctrl) + PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, ctrl); + + return 0; +} + +static int phytmac_enable_autoneg(struct phytmac *pdata, int enable) +{ + u32 value = PHYTMAC_READ(pdata, PHYTMAC_PCSCTRL); + + if (enable) + value |= PHYTMAC_BIT(AUTONEG); + else + value &= ~PHYTMAC_BIT(AUTONEG); + + PHYTMAC_WRITE(pdata, PHYTMAC_PCSCTRL, value); + + return 0; +} + +static int phytmac_pcs_software_reset(struct phytmac *pdata, int reset) +{ + u32 value = PHYTMAC_READ(pdata, PHYTMAC_PCSCTRL); + + if (reset) + value |= PHYTMAC_BIT(PCS_RESET); + else + value &= ~PHYTMAC_BIT(PCS_RESET); + + PHYTMAC_WRITE(pdata, PHYTMAC_PCSCTRL, value); + + return 0; +} + +static int phytmac_mac_linkup(struct phytmac *pdata, phy_interface_t interface, + int speed, int duplex) +{ + u32 ctrl, config; + + config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); + + config &= ~(PHYTMAC_BIT(SPEED) | PHYTMAC_BIT(FD)); + + if (speed == SPEED_100) + config |= PHYTMAC_BIT(SPEED); + else if (speed == SPEED_1000 || speed == SPEED_2500) + config |= PHYTMAC_BIT(GM_EN); + + if (duplex) + config |= PHYTMAC_BIT(FD); + + PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); + + if (speed == SPEED_2500) { + ctrl = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); + ctrl |= PHYTMAC_BIT(2PT5G); + PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, ctrl); + } + + if (speed == SPEED_10000) + PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_10000M); + else if (speed == SPEED_5000) + PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_5000M); + else if (speed == SPEED_2500) + PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_2500M); + else if (speed == SPEED_1000) + PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_1000M); + else + PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_100M); + + return 0; +} + +static int phytmac_mac_linkdown(struct phytmac *pdata) +{ + return 0; +} + +static int phytmac_pcs_linkup(struct phytmac *pdata, phy_interface_t interface, + int speed, int duplex) +{ + u32 config; + + if (interface == PHY_INTERFACE_MODE_USXGMII || + interface == PHY_INTERFACE_MODE_10GBASER) { + config = PHYTMAC_READ(pdata, PHYTMAC_USXCTRL); + if (speed == SPEED_10000) { + config = PHYTMAC_SET_BITS(config, SERDES_RATE, PHYTMAC_SERDES_RATE_10G); + config = PHYTMAC_SET_BITS(config, USX_SPEED, PHYTMAC_SPEED_10000M); + } else if (speed == SPEED_5000) { + config = PHYTMAC_SET_BITS(config, SERDES_RATE, PHYTMAC_SERDES_RATE_5G); + config = PHYTMAC_SET_BITS(config, USX_SPEED, PHYTMAC_SPEED_5000M); + } + + /* reset */ + config &= ~(PHYTMAC_BIT(RX_EN) | PHYTMAC_BIT(TX_EN)); + config |= PHYTMAC_BIT(RX_SYNC_RESET); + + PHYTMAC_WRITE(pdata, PHYTMAC_USXCTRL, config); + + /* enable rx and tx */ + config &= ~(PHYTMAC_BIT(RX_SYNC_RESET)); + config |= PHYTMAC_BIT(RX_EN) | PHYTMAC_BIT(TX_EN); + + PHYTMAC_WRITE(pdata, PHYTMAC_USXCTRL, config); + } + + return 0; +} + +static int phytmac_pcs_linkdown(struct phytmac *pdata) +{ + return 0; +} + +static int phytmac_get_mac_addr(struct phytmac *pdata, u8 *addr) +{ + u32 bottom; + u16 top; + + bottom = PHYTMAC_READ(pdata, PHYTMAC_MAC1B); + top = PHYTMAC_READ(pdata, PHYTMAC_MAC1T); + + addr[0] = bottom & 0xff; + addr[1] = (bottom >> 8) & 0xff; + addr[2] = (bottom >> 16) & 0xff; + addr[3] = (bottom >> 24) & 0xff; + addr[4] = top & 0xff; + addr[5] = (top >> 8) & 0xff; + + return 0; +} + +static int phytmac_set_mac_addr(struct phytmac *pdata, const u8 *addr) +{ + u32 bottom; + u16 top; + + bottom = cpu_to_le32(*((u32 *)addr)); + PHYTMAC_WRITE(pdata, PHYTMAC_MAC1B, bottom); + top = cpu_to_le16(*((u16 *)(addr + 4))); + PHYTMAC_WRITE(pdata, PHYTMAC_MAC1T, top); + + return 0; +} + +static void phytmac_reset_hw(struct phytmac *pdata) +{ + struct phytmac_queue *queue; + unsigned int q; + u32 ctrl; + + ctrl = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); + + ctrl &= ~(PHYTMAC_BIT(RE) | PHYTMAC_BIT(TE)); + ctrl |= PHYTMAC_BIT(CLEARSTAT); + PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, ctrl); + + /* Disable and clear all interrupts and disable queues */ + for (q = 0, queue = pdata->queues; q < pdata->queues_max_num; ++q, ++queue) { + if (q == 0) { + PHYTMAC_WRITE(pdata, PHYTMAC_ID, -1); + PHYTMAC_WRITE(pdata, PHYTMAC_IS, -1); + PHYTMAC_WRITE(pdata, PHYTMAC_TXPTR_Q0, 1); + PHYTMAC_WRITE(pdata, PHYTMAC_RXPTR_Q0, 1); + } else { + PHYTMAC_WRITE(pdata, PHYTMAC_IDR(q - 1), -1); + PHYTMAC_WRITE(pdata, PHYTMAC_ISR(q - 1), -1); + PHYTMAC_WRITE(pdata, PHYTMAC_TXPTR(q - 1), 1); + PHYTMAC_WRITE(pdata, PHYTMAC_RXPTR(q - 1), 1); + } + + PHYTMAC_WRITE(pdata, PHYTMAC_TXPTRH(q), 0); + PHYTMAC_WRITE(pdata, PHYTMAC_RXPTRH(q), 0); + + if (pdata->capacities & PHYTMAC_CAPS_TAILPTR) + PHYTMAC_WRITE(pdata, PHYTMAC_TAILPTR(q), 0); + } +} + +static void phytmac_get_regs(struct phytmac *pdata, u32 *reg_buff) +{ + reg_buff[0] = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); + reg_buff[1] = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); + reg_buff[2] = PHYTMAC_READ(pdata, PHYTMAC_NSTATUS); + reg_buff[3] = PHYTMAC_READ(pdata, PHYTMAC_DCONFIG); + reg_buff[4] = PHYTMAC_READ(pdata, PHYTMAC_TXPTR_Q0); + reg_buff[5] = PHYTMAC_READ(pdata, PHYTMAC_RXPTR_Q0); + reg_buff[6] = PHYTMAC_READ(pdata, PHYTMAC_TXPTR(1)); + reg_buff[7] = PHYTMAC_READ(pdata, PHYTMAC_RXPTR(1)); + reg_buff[8] = PHYTMAC_READ(pdata, PHYTMAC_TXPTR(2)); + reg_buff[9] = PHYTMAC_READ(pdata, PHYTMAC_RXPTR(2)); + reg_buff[10] = PHYTMAC_READ(pdata, PHYTMAC_TXPTR(3)); + reg_buff[11] = PHYTMAC_READ(pdata, PHYTMAC_RXPTR(3)); + reg_buff[12] = PHYTMAC_READ(pdata, PHYTMAC_HCONFIG); + reg_buff[13] = PHYTMAC_READ(pdata, PHYTMAC_IM); + if (pdata->phy_interface == PHY_INTERFACE_MODE_USXGMII || + pdata->phy_interface == PHY_INTERFACE_MODE_10GBASER) { + reg_buff[14] = PHYTMAC_READ(pdata, PHYTMAC_USXCTRL); + reg_buff[15] = PHYTMAC_READ(pdata, PHYTMAC_USXSTATUS); + } else { + reg_buff[14] = PHYTMAC_READ(pdata, PHYTMAC_PCSCTRL); + reg_buff[15] = PHYTMAC_READ(pdata, PHYTMAC_PCSSTATUS); + } +} + +static int phytmac_init_hw(struct phytmac *pdata) +{ + u32 config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); + u32 dmaconfig; + u32 nctrlconfig; + + nctrlconfig = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); + nctrlconfig |= PHYTMAC_BIT(MPE); + PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, nctrlconfig); + + phytmac_set_mac_addr(pdata, pdata->ndev->dev_addr); + + PHYTMAC_WRITE(pdata, PHYTMAC_AXICTRL, 0x1010); + + /* jumbo */ + if (pdata->capacities & PHYTMAC_CAPS_JUMBO) + config |= PHYTMAC_BIT(JUMBO_EN); + else + config |= PHYTMAC_BIT(RCV_BIG); + /* promisc */ + if (pdata->ndev->flags & IFF_PROMISC) + config |= PHYTMAC_BIT(PROMISC); + if (pdata->ndev->features & NETIF_F_RXCSUM) + config |= PHYTMAC_BIT(RCO_EN); + if (pdata->ndev->flags & IFF_BROADCAST) + config &= ~PHYTMAC_BIT(NO_BCAST); + else + config |= PHYTMAC_BIT(NO_BCAST); + + /* pause enable */ + config |= PHYTMAC_BIT(PAUSE_EN); + /* Rx Fcs remove */ + config |= PHYTMAC_BIT(FCS_REMOVE); + if (pdata->dma_data_width == PHYTMAC_DBW_64) + config |= PHYTMAC_BIT(DBW64); + if (pdata->dma_data_width == PHYTMAC_DBW_128) + config |= PHYTMAC_BIT(DBW128); + /* mdc div */ + config = PHYTMAC_SET_BITS(config, MCD, 6); + netdev_dbg(pdata->ndev, "phytmac configure NetConfig with 0x%08x\n", + config); + PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); + + /* init dma */ + dmaconfig = PHYTMAC_READ(pdata, PHYTMAC_DCONFIG); + if (pdata->dma_burst_length) + dmaconfig = PHYTMAC_SET_BITS(dmaconfig, BURST, pdata->dma_burst_length); + /* default in small endian */ + dmaconfig &= ~(PHYTMAC_BIT(ENDIA_PKT) | PHYTMAC_BIT(ENDIA_DESC)); + + if (pdata->ndev->features & NETIF_F_HW_CSUM) + dmaconfig |= PHYTMAC_BIT(TCO_EN); + else + dmaconfig &= ~PHYTMAC_BIT(TCO_EN); + + if (pdata->dma_addr_width) + dmaconfig |= PHYTMAC_BIT(ABW); + + /* fdir ethtype -- ipv4 */ + PHYTMAC_WRITE(pdata, PHYTMAC_ETHT(0), (uint16_t)ETH_P_IP); + + if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) + dmaconfig |= PHYTMAC_BIT(RX_EXBD_EN) | PHYTMAC_BIT(TX_EXBD_EN); + + PHYTMAC_WRITE(pdata, PHYTMAC_DCONFIG, dmaconfig); + + if (pdata->capacities & PHYTMAC_CAPS_TAILPTR) + PHYTMAC_WRITE(pdata, PHYTMAC_TAIL_ENABLE, 0x80000001); + + if (phy_interface_mode_is_8023z(pdata->phy_interface)) + phytmac_pcs_software_reset(pdata, 1); + + return 0; +} + +static int phytmac_powerup_hw(struct phytmac *pdata, int on) +{ + u32 status, data0, data1, rdata1; + int ret; + + if (pdata->capacities & PHYTMAC_CAPS_LPI) { + ret = readx_poll_timeout(PHYTMAC_READ_STAT, pdata, status, !status, + 1, PHYTMAC_TIMEOUT); + if (ret) + netdev_err(pdata->ndev, "mnh status is busy, status=%x\n", status); + + ret = readx_poll_timeout(PHYTMAC_READ_DATA0, pdata, data0, + data0 & PHYTMAC_BIT(DATA0_FREE), + 1, PHYTMAC_TIMEOUT); + if (ret) + netdev_err(pdata->ndev, "mnh data0 is busy, data0=%x\n", data0); + + data0 = 0; + data0 = PHYTMAC_SET_BITS(data0, DATA0_MSG, PHYTMAC_MSG_PM); + data0 = PHYTMAC_SET_BITS(data0, DATA0_PRO, PHYTMAC_PRO_ID); + PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA0, data0); + data1 = 0; + + if (on == PHYTMAC_POWERON) { + data1 = PHYTMAC_SET_BITS(data1, DATA1_STAT, PHYTMAC_STATON); + data1 = PHYTMAC_SET_BITS(data1, DATA1_STATTYPE, PHYTMAC_STATTYPE); + PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA1, data1); + } else { + data1 = PHYTMAC_SET_BITS(data1, DATA1_STAT, PHYTMAC_STATOFF); + data1 = PHYTMAC_SET_BITS(data1, DATA1_STATTYPE, PHYTMAC_STATTYPE); + PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA1, data1); + } + + PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_AP_CPP_SET, 1); + ret = readx_poll_timeout(PHYTMAC_READ_DATA0, pdata, data0, + data0 & PHYTMAC_BIT(DATA0_FREE), + 1, PHYTMAC_TIMEOUT); + if (ret) + netdev_err(pdata->ndev, "mnh data0 is busy"); + + rdata1 = PHYTMAC_MHU_READ(pdata, PHYTMAC_MHU_CPP_DATA1); + if (rdata1 == data1) + netdev_err(pdata->ndev, "gmac power %s success, data1 = %x, rdata1=%x\n", + on ? "up" : "down", data1, rdata1); + else + netdev_err(pdata->ndev, "gmac power %s failed, data1 = %x, rdata1=%x\n", + on ? "up" : "down", data1, rdata1); + } + pdata->power_state = on; + + return 0; +} + +static int phytmac_set_wake(struct phytmac *pdata, int wake) +{ + u32 value = 0; + + if (wake & PHYTMAC_WAKE_MAGIC) + value |= PHYTMAC_BIT(MAGIC); + if (wake & PHYTMAC_WAKE_ARP) + value |= PHYTMAC_BIT(ARP); + if (wake & PHYTMAC_WAKE_UCAST) + value |= PHYTMAC_BIT(UCAST); + if (wake & PHYTMAC_WAKE_MCAST) + value |= PHYTMAC_BIT(MCAST); + + PHYTMAC_WRITE(pdata, PHYTMAC_WOL, value); + + return 0; +} + +static void phytmac_mdio_idle(struct phytmac *pdata) +{ + u32 val; + + /* wait for end of transfer */ + val = PHYTMAC_READ(pdata, PHYTMAC_NSTATUS); + while (!(val & PHYTMAC_BIT(MDIO_IDLE))) { + cpu_relax(); + val = PHYTMAC_READ(pdata, PHYTMAC_NSTATUS); + } +} + +static int phytmac_mdio_data_read_c22(struct phytmac *pdata, int mii_id, int regnum) +{ + u16 data; + + PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C22) + | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C22_READ) + | PHYTMAC_BITS(PHY_ADDR, mii_id) + | PHYTMAC_BITS(REG_ADDR, regnum) + | PHYTMAC_BITS(MUST, 2))); + + phytmac_mdio_idle(pdata); + data = PHYTMAC_READ(pdata, PHYTMAC_MDATA) & 0xffff; + phytmac_mdio_idle(pdata); + + return data; +} + +static int phytmac_mdio_data_write_c22(struct phytmac *pdata, int mii_id, + int regnum, u16 data) +{ + PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C22) + | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C22_WRITE) + | PHYTMAC_BITS(PHY_ADDR, mii_id) + | PHYTMAC_BITS(REG_ADDR, regnum) + | PHYTMAC_BITS(DATA, data) + | PHYTMAC_BITS(MUST, 2))); + phytmac_mdio_idle(pdata); + + return 0; +} + +static int phytmac_mdio_data_read_c45(struct phytmac *pdata, int mii_id, int devad, int regnum) +{ + u16 data; + + PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C45) + | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C45_ADDR) + | PHYTMAC_BITS(PHY_ADDR, mii_id) + | PHYTMAC_BITS(REG_ADDR, devad & 0x1F) + | PHYTMAC_BITS(DATA, regnum & 0xFFFF) + | PHYTMAC_BITS(MUST, 2))); + phytmac_mdio_idle(pdata); + PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C45) + | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C45_READ) + | PHYTMAC_BITS(PHY_ADDR, mii_id) + | PHYTMAC_BITS(REG_ADDR, devad & 0x1F) + | PHYTMAC_BITS(DATA, regnum & 0xFFFF) + | PHYTMAC_BITS(MUST, 2))); + + phytmac_mdio_idle(pdata); + data = PHYTMAC_READ(pdata, PHYTMAC_MDATA) & 0xffff; + phytmac_mdio_idle(pdata); + + return data; +} + +static int phytmac_mdio_data_write_c45(struct phytmac *pdata, int mii_id, int devad, + int regnum, u16 data) +{ + PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C45) + | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C45_ADDR) + | PHYTMAC_BITS(PHY_ADDR, mii_id) + | PHYTMAC_BITS(REG_ADDR, devad & 0x1F) + | PHYTMAC_BITS(DATA, regnum & 0xFFFF) + | PHYTMAC_BITS(MUST, 2))); + phytmac_mdio_idle(pdata); + PHYTMAC_WRITE(pdata, PHYTMAC_MDATA, (PHYTMAC_BITS(CLAUSE_SEL, PHYTMAC_CLAUSE_C45) + | PHYTMAC_BITS(OPS, PHYTMAC_OPS_C45_WRITE) + | PHYTMAC_BITS(PHY_ADDR, mii_id) + | PHYTMAC_BITS(REG_ADDR, devad & 0x1F) + | PHYTMAC_BITS(DATA, data) + | PHYTMAC_BITS(MUST, 2))); + phytmac_mdio_idle(pdata); + + return 0; +} + +static int phytmac_get_feature_all(struct phytmac *pdata) +{ + unsigned int queue_mask; + unsigned int num_queues; + int val; + + /* get max queues */ + queue_mask = 0x1; + queue_mask |= PHYTMAC_READ(pdata, PHYTMAC_DEFAULT2) & 0xff; + num_queues = hweight32(queue_mask); + pdata->queues_max_num = num_queues; + + /* get dma desc prefetch number */ + val = PHYTMAC_READ_BITS(pdata, PHYTMAC_DEFAULT4, TXDESCRD); + if (val) + pdata->tx_bd_prefetch = (2 << (val - 1)) * + sizeof(struct phytmac_dma_desc); + + val = PHYTMAC_READ_BITS(pdata, PHYTMAC_DEFAULT4, RXDESCRD); + if (val) + pdata->rx_bd_prefetch = (2 << (val - 1)) * + sizeof(struct phytmac_dma_desc); + + /* dma bus width */ + pdata->dma_data_width = PHYTMAC_READ_BITS(pdata, PHYTMAC_DEFAULT1, DBW); + + /* dma addr width */ + if (PHYTMAC_READ_BITS(pdata, PHYTMAC_DEFAULT2, DAW64)) + pdata->dma_addr_width = 64; + else + pdata->dma_addr_width = 32; + + /* max rx fs */ + pdata->max_rx_fs = PHYTMAC_READ_BITS(pdata, PHYTMAC_DEFAULT3, SCR2CMP); + + if (netif_msg_hw(pdata)) + netdev_info(pdata->ndev, "get feature queue_num=%d, daw=%d, dbw=%d, rx_fs=%d, rx_bd=%d, tx_bd=%d\n", + pdata->queues_num, pdata->dma_addr_width, pdata->dma_data_width, + pdata->max_rx_fs, pdata->rx_bd_prefetch, pdata->tx_bd_prefetch); + return 0; +} + +static int phytmac_add_fdir_entry(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow) +{ + struct ethtool_tcpip4_spec *tp4sp_v, *tp4sp_m; + u16 index = rx_flow->location; + u32 tmp, fdir_ctrl; + bool ipsrc = false; + bool ipdst = false; + bool port = false; + + tp4sp_v = &rx_flow->h_u.tcp_ip4_spec; + tp4sp_m = &rx_flow->m_u.tcp_ip4_spec; + + if (tp4sp_m->ip4src == 0xFFFFFFFF) { + tmp = 0; + tmp = PHYTMAC_SET_BITS(tmp, OFFSET, ETHTYPE_SIP_OFFSET); + tmp = PHYTMAC_SET_BITS(tmp, OFFSET_TYPE, PHYTMAC_OFFSET_AFTER_L2HEAD); + tmp = PHYTMAC_SET_BITS(tmp, DIS_MASK, 1); + PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index), tp4sp_v->ip4src); + PHYTMAC_WRITE(pdata, PHYTMAC_COMP2(3 * index), tmp); + ipsrc = true; + } + + if (tp4sp_m->ip4dst == 0xFFFFFFFF) { + /* 2nd compare reg - IP destination address */ + tmp = 0; + tmp = PHYTMAC_SET_BITS(tmp, OFFSET, ETHTYPE_DIP_OFFSET); + tmp = PHYTMAC_SET_BITS(tmp, OFFSET_TYPE, PHYTMAC_OFFSET_AFTER_L2HEAD); + tmp = PHYTMAC_SET_BITS(tmp, DIS_MASK, 1); + PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index + 1), tp4sp_v->ip4dst); + PHYTMAC_WRITE(pdata, PHYTMAC_COMP2(3 * index + 1), tmp); + ipdst = true; + } + + if (tp4sp_m->psrc == 0xFFFF || tp4sp_m->pdst == 0xFFFF) { + tmp = 0; + tmp = PHYTMAC_SET_BITS(tmp, OFFSET_TYPE, PHYTMAC_OFFSET_AFTER_L3HEAD); + if (tp4sp_m->psrc == tp4sp_m->pdst) { + tmp = PHYTMAC_SET_BITS(tmp, DIS_MASK, 1); + tmp = PHYTMAC_SET_BITS(tmp, OFFSET, IPHEAD_SPORT_OFFSET); + PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index + 2), + tp4sp_v->psrc | (u32)(tp4sp_v->pdst << 16)); + } else { + tmp = PHYTMAC_SET_BITS(tmp, DIS_MASK, 0); + if (tp4sp_m->psrc == 0xFFFF) { /* src port */ + tmp = PHYTMAC_SET_BITS(tmp, OFFSET, IPHEAD_SPORT_OFFSET); + PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index + 2), + tp4sp_m->psrc | (u32)(tp4sp_v->psrc << 16)); + } else { /* dst port */ + tmp = PHYTMAC_SET_BITS(tmp, OFFSET, IPHEAD_DPORT_OFFSET); + PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index + 2), + tp4sp_m->pdst | (u32)(tp4sp_v->pdst << 16)); + } + } + PHYTMAC_WRITE(pdata, PHYTMAC_COMP2(3 * index + 2), tmp); + port = true; + } + + fdir_ctrl = PHYTMAC_READ(pdata, PHYTMAC_FDIR(rx_flow->location)); + + if (ipsrc) { + fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CA, 3 * index); + fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CA_EN, 1); + } + + if (ipdst) { + fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CB, 3 * index + 1); + fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CB_EN, 1); + } + + if (port) { + fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CC, 3 * index + 2); + fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, CC_EN, 1); + } + + fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, QUEUE_NUM, (rx_flow->ring_cookie) & 0xFF); + fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, ETH_TYPE, 0); + fdir_ctrl = PHYTMAC_SET_BITS(fdir_ctrl, ETH_EN, 1); + + PHYTMAC_WRITE(pdata, PHYTMAC_FDIR(rx_flow->location), fdir_ctrl); + + return 0; +} + +static int phytmac_del_fdir_entry(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow) +{ + int i; + int index = rx_flow->location; + + PHYTMAC_WRITE(pdata, PHYTMAC_FDIR(index), 0); + for (i = 0; i < 3; i++) { + PHYTMAC_WRITE(pdata, PHYTMAC_COMP1(3 * index + i), 0); + PHYTMAC_WRITE(pdata, PHYTMAC_COMP2(3 * index + i), 0); + } + return 0; +} + +static int phytmac_init_ring_hw(struct phytmac *pdata) +{ + struct phytmac_queue *queue; + unsigned int q = 0; + u32 buffer_size = pdata->rx_buffer_len / 64; + + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { + if (q == 0) { + PHYTMAC_WRITE(pdata, PHYTMAC_RXPTR_Q0, + lower_32_bits(queue->rx_ring_addr)); + PHYTMAC_WRITE(pdata, PHYTMAC_TXPTR_Q0, + lower_32_bits(queue->tx_ring_addr)); + PHYTMAC_WRITE(pdata, PHYTMAC_DCONFIG, + PHYTMAC_SET_BITS(PHYTMAC_READ(pdata, PHYTMAC_DCONFIG), + RX_BUF_LEN, buffer_size)); + } else { + PHYTMAC_WRITE(pdata, PHYTMAC_RXPTR(q - 1), + lower_32_bits(queue->rx_ring_addr)); + PHYTMAC_WRITE(pdata, PHYTMAC_TXPTR(q - 1), + lower_32_bits(queue->tx_ring_addr)); + PHYTMAC_WRITE(pdata, PHYTMAC_RBQS(q - 1), buffer_size); + } + + PHYTMAC_WRITE(pdata, PHYTMAC_TXPTRH(q), upper_32_bits(queue->tx_ring_addr)); + PHYTMAC_WRITE(pdata, PHYTMAC_RXPTRH(q), upper_32_bits(queue->rx_ring_addr)); + + if (pdata->capacities & PHYTMAC_CAPS_TAILPTR) + PHYTMAC_WRITE(pdata, PHYTMAC_TAILPTR(q), queue->tx_tail); + } + + return 0; +} + +static u32 phytmac_get_irq_mask(u32 mask) +{ + u32 value = 0; + + value |= (mask & PHYTMAC_INT_TX_COMPLETE) ? PHYTMAC_BIT(TXCOMP) : 0; + value |= (mask & PHYTMAC_INT_TX_ERR) ? PHYTMAC_BIT(BUS_ERR) : 0; + value |= (mask & PHYTMAC_INT_RX_COMPLETE) ? PHYTMAC_BIT(RXCOMP) : 0; + value |= (mask & PHYTMAC_INT_RX_OVERRUN) ? PHYTMAC_BIT(RXOVERRUN) : 0; + value |= (mask & PHYTMAC_INT_RX_DESC_FULL) ? PHYTMAC_BIT(RUB) : 0; + + return value; +} + +static u32 phytmac_get_irq_status(u32 value) +{ + u32 status = 0; + + status |= (value & PHYTMAC_BIT(TXCOMP)) ? PHYTMAC_INT_TX_COMPLETE : 0; + status |= (value & PHYTMAC_BIT(BUS_ERR)) ? PHYTMAC_INT_TX_ERR : 0; + status |= (value & PHYTMAC_BIT(RXCOMP)) ? PHYTMAC_INT_RX_COMPLETE : 0; + status |= (value & PHYTMAC_BIT(RXOVERRUN)) ? PHYTMAC_INT_RX_OVERRUN : 0; + status |= (value & PHYTMAC_BIT(RUB)) ? PHYTMAC_INT_RX_DESC_FULL : 0; + + return status; +} + +static void phytmac_enable_irq(struct phytmac *pdata, + int queue_index, u32 mask) +{ + u32 value; + + value = phytmac_get_irq_mask(mask); + + if (queue_index == 0) + PHYTMAC_WRITE(pdata, PHYTMAC_IE, value); + else + PHYTMAC_WRITE(pdata, PHYTMAC_IER(queue_index - 1), value); +} + +static void phytmac_disable_irq(struct phytmac *pdata, + int queue_index, u32 mask) +{ + u32 value; + + value = phytmac_get_irq_mask(mask); + + if (queue_index == 0) + PHYTMAC_WRITE(pdata, PHYTMAC_ID, value); + else + PHYTMAC_WRITE(pdata, PHYTMAC_IDR(queue_index - 1), value); +} + +static void phytmac_clear_irq(struct phytmac *pdata, + int queue_index, u32 mask) +{ + u32 value; + + value = phytmac_get_irq_mask(mask); + + if (queue_index == 0) + PHYTMAC_WRITE(pdata, PHYTMAC_IS, value); + else + PHYTMAC_WRITE(pdata, PHYTMAC_ISR(queue_index - 1), value); +} + +static unsigned int phytmac_get_intx_mask(struct phytmac *pdata) +{ + u32 value; + + value = PHYTMAC_READ(pdata, PHYTMAC_INTX_IRQ_MASK); + PHYTMAC_WRITE(pdata, PHYTMAC_INTX_IRQ_MASK, value); + + return value; +} + +static unsigned int phytmac_get_irq(struct phytmac *pdata, int queue_index) +{ + u32 status, value; + + if (queue_index == 0) + value = PHYTMAC_READ(pdata, PHYTMAC_IS); + else + value = PHYTMAC_READ(pdata, PHYTMAC_ISR(queue_index - 1)); + + status = phytmac_get_irq_status(value); + + return status; +} + +static unsigned int phytmac_tx_map_desc(struct phytmac_queue *queue, + u32 tx_tail, struct packet_info *packet) +{ + unsigned int i, ctrl; + struct phytmac *pdata = queue->pdata; + struct phytmac_dma_desc *desc; + struct phytmac_tx_skb *tx_skb; + unsigned int eof = 1; + + i = tx_tail; + + if (!(pdata->capacities & PHYTMAC_CAPS_TAILPTR)) { + ctrl = PHYTMAC_BIT(TX_USED); + desc = phytmac_get_tx_desc(queue, i); + desc->desc1 = ctrl; + } + + do { + i--; + tx_skb = phytmac_get_tx_skb(queue, i); + desc = phytmac_get_tx_desc(queue, i); + + ctrl = (u32)tx_skb->length; + if (eof) { + ctrl |= PHYTMAC_BIT(TX_LAST); + eof = 0; + } + + if (unlikely(i == (pdata->tx_ring_size - 1))) + ctrl |= PHYTMAC_BIT(TX_WRAP); + + if (i == queue->tx_tail) { + ctrl |= PHYTMAC_BITS(TX_LSO, packet->lso); + ctrl |= PHYTMAC_BITS(TX_TCP_SEQ_SRC, packet->seq); + if (packet->nocrc) + ctrl |= PHYTMAC_BIT(TX_NOCRC); + } else { + ctrl |= PHYTMAC_BITS(MSS_MFS, packet->mss); + } + + desc->desc2 = upper_32_bits(tx_skb->addr); + desc->desc0 = lower_32_bits(tx_skb->addr); + /* Make newly descriptor visible to hardware */ + wmb(); + desc->desc1 = ctrl; + } while (i != queue->tx_tail); + + return 0; +} + +static void phytmac_init_rx_map_desc(struct phytmac_queue *queue, + u32 index) +{ + struct phytmac_dma_desc *desc; + + desc = phytmac_get_rx_desc(queue, index); + + desc->desc1 = 0; + /* Make newly descriptor to hardware */ + dma_wmb(); + desc->desc0 |= PHYTMAC_BIT(RX_USED); +} + +static unsigned int phytmac_rx_map_desc(struct phytmac_queue *queue, + u32 index, dma_addr_t addr) +{ + struct phytmac *pdata = queue->pdata; + struct phytmac_dma_desc *desc; + + desc = phytmac_get_rx_desc(queue, index); + + if (addr) { + if (unlikely(index == (pdata->rx_ring_size - 1))) + addr |= PHYTMAC_BIT(RX_WRAP); + desc->desc1 = 0; + desc->desc2 = upper_32_bits(addr); + desc->desc0 = lower_32_bits(addr) | PHYTMAC_BIT(RX_USED); + } + return 0; +} + +static unsigned int phytmac_rx_clean_desc(struct phytmac_queue *queue, u32 count) +{ + struct phytmac_dma_desc *desc; + u32 index = queue->rx_head + count - 1; + + while (count) { + desc = phytmac_get_rx_desc(queue, index); + desc->desc0 &= ~PHYTMAC_BIT(RX_USED); + dma_wmb(); + index--; + count--; + } + + return 0; +} + +static void phytmac_tx_start(struct phytmac_queue *queue) +{ + struct phytmac *pdata = queue->pdata; + + if (pdata->capacities & PHYTMAC_CAPS_TAILPTR) + PHYTMAC_WRITE(pdata, PHYTMAC_TAILPTR(queue->index), + BIT(31) | queue->tx_tail); + + if (pdata->capacities & PHYTMAC_CAPS_START) + PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, + PHYTMAC_READ(pdata, PHYTMAC_NCTRL) | PHYTMAC_BIT(TSTART)); +} + +static void phytmac_restart(struct phytmac *pdata) +{ + int q; + struct phytmac_queue *queue; + + for (q = 0; q < pdata->queues_num; q++) { + queue = &pdata->queues[q]; + if (queue->tx_head != queue->tx_tail) { + PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, + PHYTMAC_READ(pdata, PHYTMAC_NCTRL) | PHYTMAC_BIT(TSTART)); + break; + } + } +} + +static int phytmac_tx_complete(const struct phytmac_dma_desc *desc) +{ + return PHYTMAC_GET_BITS(desc->desc1, TX_USED); +} + +static int phytmac_rx_complete(const struct phytmac_dma_desc *desc) +{ + return (desc->desc0 & PHYTMAC_BIT(RX_USED)) != 0; +} + +static int phytmac_rx_pkt_len(struct phytmac *pdata, const struct phytmac_dma_desc *desc) +{ + if (pdata->capacities & PHYTMAC_CAPS_JUMBO) + return desc->desc1 & PHYTMAC_JUMBO_FRAME_MASK; + else + return desc->desc1 & PHYTMAC_FRAME_MASK; +} + +static dma_addr_t phytmac_get_desc_addr(const struct phytmac_dma_desc *desc) +{ + dma_addr_t addr = 0; + + addr = ((u64)(desc->desc2) << 32); + + addr |= (desc->desc0 & 0xfffffffc); + return addr; +} + +static bool phytmac_rx_checksum(const struct phytmac_dma_desc *desc) +{ + u32 value = desc->desc1; + u32 check = value >> PHYTMAC_RX_CSUM_INDEX & 0x3; + + return (check == PHYTMAC_RX_CSUM_IP_TCP || check == PHYTMAC_RX_CSUM_IP_UDP); +} + +static bool phytmac_rx_single_buffer(const struct phytmac_dma_desc *desc) +{ + u32 value = desc->desc1; + + return ((value & PHYTMAC_BIT(RX_SOF)) && (value & PHYTMAC_BIT(RX_EOF))); +} + +static bool phytmac_rx_sof(const struct phytmac_dma_desc *desc) +{ + u32 value = desc->desc1; + + return (value & PHYTMAC_BIT(RX_SOF)); +} + +static bool phytmac_rx_eof(const struct phytmac_dma_desc *desc) +{ + u32 value = desc->desc1; + + return (value & PHYTMAC_BIT(RX_EOF)); +} + +static void phytmac_clear_rx_desc(struct phytmac_queue *queue, int begin, int end) +{ + unsigned int frag; + unsigned int tmp = end; + struct phytmac_dma_desc *desc; + + if (begin > end) + tmp = end + queue->pdata->rx_ring_size; + + for (frag = begin; frag != end; frag++) { + desc = phytmac_get_rx_desc(queue, frag); + desc->desc0 &= ~PHYTMAC_BIT(RX_USED); + } +} + +static void phytmac_mac_interface_config(struct phytmac *pdata, unsigned int mode, + const struct phylink_link_state *state) +{ + u32 old_ctrl, old_config; + u32 ctrl, config, usxctl; + + old_ctrl = PHYTMAC_READ(pdata, PHYTMAC_NCTRL); + old_config = PHYTMAC_READ(pdata, PHYTMAC_NCONFIG); + ctrl = old_ctrl; + config = old_config; + + if (state->speed == SPEED_10000) + PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_10000M); + else if (state->speed == SPEED_5000) + PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_5000M); + else if (state->speed == SPEED_2500) + PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_2500M); + else if (state->speed == SPEED_1000) + PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_1000M); + else if (state->speed == SPEED_100 || state->speed == SPEED_10) + PHYTMAC_WRITE(pdata, PHYTMAC_HCONFIG, PHYTMAC_SPEED_100M); + + config &= ~(PHYTMAC_BIT(SGMII_EN) | PHYTMAC_BIT(PCS_EN) + | PHYTMAC_BIT(SPEED) | PHYTMAC_BIT(FD) | PHYTMAC_BIT(GM_EN)); + ctrl &= ~(PHYTMAC_BIT(HIGHSPEED) | PHYTMAC_BIT(2PT5G)); + + if (state->interface == PHY_INTERFACE_MODE_SGMII) { + config |= PHYTMAC_BIT(SGMII_EN) | PHYTMAC_BIT(PCS_EN); + if (state->speed == SPEED_1000) + config |= PHYTMAC_BIT(GM_EN); + else if (state->speed == SPEED_2500) + config |= PHYTMAC_BIT(2PT5G); + } else if (state->interface == PHY_INTERFACE_MODE_1000BASEX) { + config |= PHYTMAC_BIT(PCS_EN) | PHYTMAC_BIT(GM_EN); + } else if (state->interface == PHY_INTERFACE_MODE_2500BASEX) { + config |= PHYTMAC_BIT(2PT5G) | PHYTMAC_BIT(PCS_EN); + } else if (state->interface == PHY_INTERFACE_MODE_10GBASER || + state->interface == PHY_INTERFACE_MODE_USXGMII || + state->interface == PHY_INTERFACE_MODE_5GBASER) { + usxctl = PHYTMAC_READ(pdata, PHYTMAC_USXCTRL); + if (state->speed == SPEED_10000) { + usxctl = PHYTMAC_SET_BITS(usxctl, SERDES_RATE, PHYTMAC_SERDES_RATE_10G); + usxctl = PHYTMAC_SET_BITS(usxctl, USX_SPEED, PHYTMAC_SPEED_10000M); + } else if (state->speed == SPEED_5000) { + usxctl = PHYTMAC_SET_BITS(usxctl, SERDES_RATE, PHYTMAC_SERDES_RATE_5G); + usxctl = PHYTMAC_SET_BITS(usxctl, USX_SPEED, PHYTMAC_SPEED_5000M); + } + usxctl |= PHYTMAC_BIT(RX_EN) | PHYTMAC_BIT(TX_EN); + PHYTMAC_WRITE(pdata, PHYTMAC_USXCTRL, usxctl); + + config |= PHYTMAC_BIT(PCS_EN); + ctrl |= PHYTMAC_BIT(HIGHSPEED); + } + + if (state->duplex) + config |= PHYTMAC_BIT(FD); + + if (old_ctrl ^ ctrl) + PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, ctrl); + + if (old_config ^ config) + PHYTMAC_WRITE(pdata, PHYTMAC_NCONFIG, config); + + /* Disable AN for SGMII fixed link configuration, enable otherwise.*/ + if (state->interface == PHY_INTERFACE_MODE_SGMII) + phytmac_enable_autoneg(pdata, mode == MLO_AN_FIXED ? 0 : 1); + if (state->interface == PHY_INTERFACE_MODE_1000BASEX) + phytmac_enable_autoneg(pdata, 1); +} + +static unsigned int phytmac_pcs_get_link(struct phytmac *pdata, + phy_interface_t interface) +{ + if (interface == PHY_INTERFACE_MODE_SGMII || + interface == PHY_INTERFACE_MODE_1000BASEX || + interface == PHY_INTERFACE_MODE_2500BASEX) + return PHYTMAC_READ_BITS(pdata, PHYTMAC_NSTATUS, PCS_LINK); + else if (interface == PHY_INTERFACE_MODE_USXGMII || + interface == PHY_INTERFACE_MODE_10GBASER) + return PHYTMAC_READ_BITS(pdata, PHYTMAC_USXSTATUS, USX_PCS_LINK); + + return 0; +} + +static void phytmac_clear_tx_desc(struct phytmac_queue *queue) +{ + struct phytmac *pdata = queue->pdata; + struct phytmac_dma_desc *desc = NULL; + int i; + + for (i = 0; i < queue->pdata->tx_ring_size; i++) { + desc = phytmac_get_tx_desc(queue, i); + desc->desc2 = 0; + desc->desc0 = 0; + /* make newly desc1 to hardware */ + wmb(); + desc->desc1 = PHYTMAC_BIT(TX_USED); + } + desc->desc1 |= PHYTMAC_BIT(TX_WRAP); + + if (pdata->capacities & PHYTMAC_CAPS_TAILPTR) + PHYTMAC_WRITE(pdata, PHYTMAC_TAILPTR(queue->index), queue->tx_tail); +} + +static void phytmac_get_hw_stats(struct phytmac *pdata) +{ + u32 stats[45]; + int i, j; + u64 val; + u64 *p = &pdata->stats.tx_octets; + + for (i = 0 ; i < 45; i++) + stats[i] = PHYTMAC_READ(pdata, PHYTMAC_OCTTX + i * 4); + + for (i = 0, j = 0; i < 45; i++) { + if (i == 0 || i == 20) { + val = (u64)stats[i + 1] << 32 | stats[i]; + *p += val; + pdata->ethtool_stats[j] = *p; + ++j; + ++p; + } else { + if (i != 1 && i != 21) { + val = stats[i]; + *p += val; + pdata->ethtool_stats[j] = *p; + ++j; + ++p; + } + } + } +} + +static void phytmac_get_time(struct phytmac *pdata, struct timespec64 *ts) +{ + u32 ns, secl, sech; + + ns = PHYTMAC_READ(pdata, PHYTMAC_TN); + secl = PHYTMAC_READ(pdata, PHYTMAC_TSL); + sech = PHYTMAC_READ(pdata, PHYTMAC_TSH); + + ts->tv_nsec = ns; + ts->tv_sec = (((u64)sech << 32) | secl) & SEC_MAX_VAL; +} + +static void phytmac_set_time(struct phytmac *pdata, time64_t sec, long nsec) +{ + u32 secl, sech; + + secl = (u32)sec; + sech = (sec >> 32) & (0xffff); + + PHYTMAC_WRITE(pdata, PHYTMAC_TN, 0); + PHYTMAC_WRITE(pdata, PHYTMAC_TSH, sech); + PHYTMAC_WRITE(pdata, PHYTMAC_TSL, secl); + PHYTMAC_WRITE(pdata, PHYTMAC_TN, nsec); +} + +static void phytmac_clear_time(struct phytmac *pdata) +{ + u32 value; + + pdata->ts_incr.sub_ns = 0; + pdata->ts_incr.ns = 0; + + value = PHYTMAC_READ(pdata, PHYTMAC_TISN); + value = PHYTMAC_SET_BITS(value, SUB_NSECL, 0); + value = PHYTMAC_SET_BITS(value, SUB_NSECH, 0); + PHYTMAC_WRITE(pdata, PHYTMAC_TISN, value); + + value = PHYTMAC_READ(pdata, PHYTMAC_TI); + value = PHYTMAC_SET_BITS(value, INCR_NS, 0); + PHYTMAC_WRITE(pdata, PHYTMAC_TI, value); + + PHYTMAC_WRITE(pdata, PHYTMAC_TA, 0); +} + +static int phytmac_set_tsmode(struct phytmac *pdata, struct ts_ctrl *ctrl) +{ + if (ctrl->rx_control == TS_ALL_PTP_FRAMES) + PHYTMAC_WRITE(pdata, PHYTMAC_NCTRL, + PHYTMAC_READ(pdata, PHYTMAC_NCTRL) | PHYTMAC_BIT(STORE_RX_TS)); + + PHYTMAC_WRITE(pdata, PHYTMAC_TXBDCTRL, PHYTMAC_BITS(TX_TSMODE, ctrl->tx_control)); + PHYTMAC_WRITE(pdata, PHYTMAC_RXBDCTRL, PHYTMAC_BITS(RX_TSMODE, ctrl->rx_control)); + + return 0; +} + +static int phytmac_set_tsincr(struct phytmac *pdata, struct ts_incr *incr) +{ + u32 value; + + value = PHYTMAC_BITS(SUB_NSECL, incr->sub_ns) | + PHYTMAC_BITS(SUB_NSECH, incr->sub_ns >> 8); + PHYTMAC_WRITE(pdata, PHYTMAC_TISN, value); + PHYTMAC_WRITE(pdata, PHYTMAC_TI, incr->ns); + + return 0; +} + +static void phytmac_ptp_init_hw(struct phytmac *pdata) +{ + struct timespec64 ts; + + ts = ns_to_timespec64(ktime_to_ns(ktime_get_real())); + phytmac_set_time(pdata, ts.tv_sec, ts.tv_nsec); + + phytmac_set_tsincr(pdata, &pdata->ts_incr); +} + +static int phytmac_adjust_fine(struct phytmac *pdata, long ppm, bool negative) +{ + struct ts_incr ts_incr; + u32 tmp; + u64 adj; + + ts_incr.ns = pdata->ts_incr.ns; + ts_incr.sub_ns = pdata->ts_incr.sub_ns; + + tmp = ((u64)ts_incr.ns << PHYTMAC_SUB_NSECL_INDEX) + ts_incr.sub_ns; + adj = ((u64)ppm * tmp + (USEC_PER_SEC >> 1)) >> PHYTMAC_SUB_NSECL_INDEX; + + adj = div_u64(adj, USEC_PER_SEC); + adj = negative ? (tmp - adj) : (tmp + adj); + + ts_incr.ns = (adj >> PHYTMAC_SUB_NSEC_WIDTH) + & ((1 << PHYTMAC_SUB_NSECL_WIDTH) - 1); + ts_incr.sub_ns = adj & ((1 << PHYTMAC_SUB_NSEC_WIDTH) - 1); + + phytmac_set_tsincr(pdata, &ts_incr); + + return 0; +} + +static int phytmac_adjust_time(struct phytmac *pdata, s64 delta, int neg) +{ + u32 adj; + + if (delta > PHYTMAC_ADJUST_SEC_MAX) { + struct timespec64 now, then; + + if (neg) + then = ns_to_timespec64(-delta); + else + then = ns_to_timespec64(delta); + phytmac_get_time(pdata, &now); + now = timespec64_add(now, then); + phytmac_set_time(pdata, now.tv_sec, now.tv_nsec); + } else { + adj = (neg << PHYTMAC_INCR_ADD_INDEX) | delta; + PHYTMAC_WRITE(pdata, PHYTMAC_TA, adj); + } + + return 0; +} + +static int phytmac_ts_valid(struct phytmac *pdata, struct phytmac_dma_desc *desc, int direction) +{ + int ts_valid = 0; + + if (direction == PHYTMAC_TX) + ts_valid = desc->desc1 & PHYTMAC_BIT(TX_TS_VALID); + else if (direction == PHYTMAC_RX) + ts_valid = desc->desc0 & PHYTMAC_BIT(RX_TS_VALID); + return ts_valid; +} + +static void phytmac_get_dma_ts(struct phytmac *pdata, u32 ts_1, u32 ts_2, struct timespec64 *ts) +{ + struct timespec64 ts2; + + ts->tv_sec = (PHYTMAC_GET_BITS(ts_2, DMA_SECH) << 2) | + PHYTMAC_GET_BITS(ts_1, DMA_SECL); + ts->tv_nsec = PHYTMAC_GET_BITS(ts_1, DMA_NSEC); + + phytmac_get_time(pdata, &ts2); + + if (((ts->tv_sec ^ ts2.tv_sec) & (PHYTMAC_DMA_SEC_TOP >> 1)) != 0) + ts->tv_sec -= PHYTMAC_DMA_SEC_TOP; + + ts->tv_sec += (ts2.tv_sec & (~PHYTMAC_DMA_SEC_MASK)); +} + +static unsigned int phytmac_get_ts_rate(struct phytmac *pdata) +{ + return 300000000; +} + +struct phytmac_hw_if phytmac_1p0_hw = { + .reset_hw = phytmac_reset_hw, + .init_hw = phytmac_init_hw, + .init_ring_hw = phytmac_init_ring_hw, + .get_feature = phytmac_get_feature_all, + .get_regs = phytmac_get_regs, + .get_stats = phytmac_get_hw_stats, + .set_mac_address = phytmac_set_mac_addr, + .get_mac_address = phytmac_get_mac_addr, + .mdio_read = phytmac_mdio_data_read_c22, + .mdio_write = phytmac_mdio_data_write_c22, + .mdio_read_c45 = phytmac_mdio_data_read_c45, + .mdio_write_c45 = phytmac_mdio_data_write_c45, + .poweron = phytmac_powerup_hw, + .set_wol = phytmac_set_wake, + .enable_promise = phytmac_enable_promise, + .enable_multicast = phytmac_enable_multicast, + .set_hash_table = phytmac_set_mc_hash, + .enable_rx_csum = phytmac_enable_rxcsum, + .enable_tx_csum = phytmac_enable_txcsum, + .enable_mdio_control = phytmac_enable_mdio, + .enable_autoneg = phytmac_enable_autoneg, + .enable_pause = phytmac_enable_pause, + .enable_network = phytmac_enable_network, + .add_fdir_entry = phytmac_add_fdir_entry, + .del_fdir_entry = phytmac_del_fdir_entry, + /* mac config */ + .mac_config = phytmac_mac_interface_config, + .mac_linkup = phytmac_mac_linkup, + .mac_linkdown = phytmac_mac_linkdown, + .pcs_linkup = phytmac_pcs_linkup, + .pcs_linkdown = phytmac_pcs_linkdown, + .get_link = phytmac_pcs_get_link, + /* irq */ + .enable_irq = phytmac_enable_irq, + .disable_irq = phytmac_disable_irq, + .clear_irq = phytmac_clear_irq, + .get_irq = phytmac_get_irq, + .get_intx_mask = phytmac_get_intx_mask, + /* tx and rx */ + .tx_map = phytmac_tx_map_desc, + .transmit = phytmac_tx_start, + .restart = phytmac_restart, + .tx_complete = phytmac_tx_complete, + .rx_complete = phytmac_rx_complete, + .get_rx_pkt_len = phytmac_rx_pkt_len, + .get_desc_addr = phytmac_get_desc_addr, + .init_rx_map = phytmac_init_rx_map_desc, + .rx_map = phytmac_rx_map_desc, + .rx_clean = phytmac_rx_clean_desc, + .rx_checksum = phytmac_rx_checksum, + .rx_single_buffer = phytmac_rx_single_buffer, + .rx_pkt_start = phytmac_rx_sof, + .rx_pkt_end = phytmac_rx_eof, + .clear_rx_desc = phytmac_clear_rx_desc, + .clear_tx_desc = phytmac_clear_tx_desc, + /* ptp */ + .init_ts_hw = phytmac_ptp_init_hw, + .set_time = phytmac_set_time, + .clear_time = phytmac_clear_time, + .get_time = phytmac_get_time, + .set_ts_config = phytmac_set_tsmode, + .set_incr = phytmac_set_tsincr, + .adjust_fine = phytmac_adjust_fine, + .adjust_time = phytmac_adjust_time, + .ts_valid = phytmac_ts_valid, + .get_timestamp = phytmac_get_dma_ts, + .get_ts_rate = phytmac_get_ts_rate, +}; +EXPORT_SYMBOL_GPL(phytmac_1p0_hw); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v1.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v1.h new file mode 100644 index 0000000000000000000000000000000000000000..d8de2c26cab4b2543167db3a8f5bb6672bb85ec5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v1.h @@ -0,0 +1,455 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ +#ifndef _PHYTMAC_V1_H +#define _PHYTMAC_V1_H + +extern struct phytmac_hw_if phytmac_1p0_hw; + +#define PHYTMAC_FRAME_MASK 0x1fff +#define PHYTMAC_JUMBO_FRAME_MASK 0x3fff + +#define PHYTMAC_SPEED_100M 0 +#define PHYTMAC_SPEED_1000M 1 +#define PHYTMAC_SPEED_2500M 2 +#define PHYTMAC_SPEED_5000M 3 +#define PHYTMAC_SPEED_10000M 4 +#define PHYTMAC_SERDES_RATE_5G 0 +#define PHYTMAC_SERDES_RATE_10G 1 + +#define PHYTMAC_NCTRL 0x0000 +#define PHYTMAC_NCONFIG 0x0004 +#define PHYTMAC_NSTATUS 0x0008 +#define PHYTMAC_DCONFIG 0x0010 +#define PHYTMAC_RXPTR_Q0 0x0018 +#define PHYTMAC_TXPTR_Q0 0x001C +#define PHYTMAC_IS 0x0024 +#define PHYTMAC_IE 0x0028 +#define PHYTMAC_ID 0x002C +#define PHYTMAC_IM 0x0030 +#define PHYTMAC_MDATA 0x0034 +#define PHYTMAC_HCONFIG 0x0050 +#define PHYTMAC_AXICTRL 0x0054 +#define PHYTMAC_INT_MODERATION 0x005C +#define PHYTMAC_HASHB 0x0080 +#define PHYTMAC_HASHT 0x0084 +#define PHYTMAC_MAC1B 0x0088 +#define PHYTMAC_MAC1T 0x008C +#define PHYTMAC_WOL 0x00B8 +#define PHYTMAC_OCTTX 0x0100 +#define PHYTMAC_TISN 0x01BC +#define PHYTMAC_TSH 0x01C0 +#define PHYTMAC_TSL 0x01D0 +#define PHYTMAC_TN 0x01D4 +#define PHYTMAC_TA 0x01D8 +#define PHYTMAC_TI 0x01DC +#define PHYTMAC_PCSCTRL 0x0200 +#define PHYTMAC_PCSSTATUS 0x0204 +#define PHYTMAC_PCSANLPBASE 0x0214 +#define PHYTMAC_DEFAULT1 0x0280 /* Default HW Config 1 */ +#define PHYTMAC_DEFAULT2 0x0294 /* Default HW Config 2 */ +#define PHYTMAC_DEFAULT3 0x029C /* Default HW Config 3 */ +#define PHYTMAC_DEFAULT4 0x02A4 /* Default HW Config 4 */ +#define PHYTMAC_DEFAULT5 0x02AC /* Default HW Config 5 */ +#define PHYTMAC_USXCTRL 0x0A80 +#define PHYTMAC_USXSTATUS 0x0A88 +#define PHYTMAC_TXBDCTRL 0x04CC +#define PHYTMAC_RXBDCTRL 0x04D0 + +/* Fdir match registers */ +#define PHYTMAC_FDIR(i) (0x0540 + ((i) << 2)) + +/* EtherType registers */ +#define PHYTMAC_ETHT(i) (0x06E0 + ((i) << 2)) + +/* Fdir compare registers */ +#define PHYTMAC_COMP1(i) (0x0700 + ((i) << 3)) +#define PHYTMAC_COMP2(i) (0x0704 + ((i) << 3)) + +#define PHYTMAC_ISR(i) (0x0400 + ((i) << 2)) +#define PHYTMAC_TXPTR(i) (0x0440 + ((i) << 2)) +#define PHYTMAC_RXPTR(i) (0x0480 + ((i) << 2)) +#define PHYTMAC_RBQS(i) (0x04A0 + ((i) << 2)) +#define PHYTMAC_TXPTRH(i) (0x04c8) +#define PHYTMAC_RXPTRH(i) (0x04d4) + +#define PHYTMAC_IER(i) (0x0600 + ((i) << 2)) +#define PHYTMAC_IDR(i) (0x0620 + ((i) << 2)) +#define PHYTMAC_IMR(i) (0x0640 + ((i) << 2)) +#define PHYTMAC_TAIL_ENABLE (0x0e7c) +#define PHYTMAC_TAILPTR(i) (0x0e80 + ((i) << 2)) + +#define PHYTMAC_PHY_INT_ENABLE 0x1C88 +#define PHYTMAC_PHY_INT_CLEAR 0x1C8C +#define PHYTMAC_PHY_INT_STATE 0x1C90 +#define PHYTMAC_INTX_IRQ_MASK 0x1C7C + +#define PHYTMAC_READ_NSTATUS(pdata) PHYTMAC_READ(pdata, PHYTMAC_NSTATUS) + +/* Ethernet Network Control Register */ +#define PHYTMAC_RE_INDEX 2 /* Receive enable */ +#define PHYTMAC_RE_WIDTH 1 +#define PHYTMAC_TE_INDEX 3 /* Transmit enable */ +#define PHYTMAC_TE_WIDTH 1 +#define PHYTMAC_MPE_INDEX 4 /* Management port enable */ +#define PHYTMAC_MPE_WIDTH 1 +#define PHYTMAC_CLEARSTAT_INDEX 5 /* Clear stats regs */ +#define PHYTMAC_CLEARSTAT_WIDTH 1 +#define PHYTMAC_TSTART_INDEX 9 /* Start transmission */ +#define PHYTMAC_TSTART_WIDTH 1 +#define PHYTMAC_THALT_INDEX 10 /* Transmit halt */ +#define PHYTMAC_THALT_WIDTH 1 +#define PHYTMAC_STORE_RX_TS_INDEX 15 +#define PHYTMAC_STORE_RX_TS_WIDTH 1 +#define PHYTMAC_OSSMODE_INDEX 24 /* Enable One Step Synchro Mode */ +#define PHYTMAC_OSSMODE_WIDTH 1 +#define PHYTMAC_2PT5G_INDEX 29 /* 2.5G operation selected */ +#define PHYTMAC_2PT5G_WIDTH 1 +#define PHYTMAC_HIGHSPEED_INDEX 31 /* High speed enable */ +#define PHYTMAC_HIGHSPEED_WIDTH 1 + +/* Ethernet Network Config Register */ +#define PHYTMAC_SPEED_INDEX 0 /* Speed */ +#define PHYTMAC_SPEED_WIDTH 1 +#define PHYTMAC_FD_INDEX 1 /* Full duplex */ +#define PHYTMAC_FD_WIDTH 1 +#define PHYTMAC_JUMBO_EN_INDEX 3 /* Transmit enable */ +#define PHYTMAC_JUMBO_EN_WIDTH 1 +#define PHYTMAC_PROMISC_INDEX 4 /* Copy all frames */ +#define PHYTMAC_PROMISC_WIDTH 1 +#define PHYTMAC_NO_BCAST_INDEX 5 /* No broadcast */ +#define PHYTMAC_NO_BCAST_WIDTH 1 +#define PHYTMAC_MH_EN_INDEX 6 /* Multicast hash enable */ +#define PHYTMAC_MH_EN_WIDTH 1 +#define PHYTMAC_RCV_BIG_INDEX 8 +#define PHYTMAC_RCV_BIG_WIDTH 1 +#define PHYTMAC_GM_EN_INDEX 10 /* Gigabit mode enable */ +#define PHYTMAC_GM_EN_WIDTH 1 +#define PHYTMAC_PCS_EN_INDEX 11 /* PCS select */ +#define PHYTMAC_PCS_EN_WIDTH 1 +#define PHYTMAC_PAUSE_EN_INDEX 13 /* Pause enable */ +#define PHYTMAC_PAUSE_EN_WIDTH 1 +#define PHYTMAC_FCS_REMOVE_INDEX 17 /* FCS remove */ +#define PHYTMAC_FCS_REMOVE_WIDTH 1 +#define PHYTMAC_MCD_INDEX 18 /* MDC clock division */ +#define PHYTMAC_MCD_WIDTH 3 +#define PHYTMAC_DBW64_INDEX 21 /* Data bus width */ +#define PHYTMAC_DBW64_WIDTH 1 +#define PHYTMAC_DBW128_INDEX 22 /* Data bus width */ +#define PHYTMAC_DBW128_WIDTH 1 +#define PHYTMAC_DBW_32 1 +#define PHYTMAC_DBW_64 2 +#define PHYTMAC_DBW_128 4 +#define PHYTMAC_RCO_EN_INDEX 24 /* Receive checksum offload enable */ +#define PHYTMAC_RCO_EN_WIDTH 1 +#define PHYTMAC_SGMII_EN_INDEX 27 /* Sgmii mode enable */ +#define PHYTMAC_SGMII_EN_WIDTH 1 + +/* Ethernet Network Status Register */ +#define PHYTMAC_PCS_LINK_INDEX 0 /* PCS link status */ +#define PHYTMAC_PCS_LINK_WIDTH 1 +#define PHYTMAC_MDIO_IDLE_INDEX 2 /* Mdio idle */ +#define PHYTMAC_MDIO_IDLE_WIDTH 1 +#define PHYTMAC_PCS_FD_INDEX 3 /* PCS auto negotiation duplex resolution */ +#define PHYTMAC_PCS_FD__WIDTH 1 + +/* Ethernet Network Dma config Register */ +#define PHYTMAC_BURST_INDEX 0 /* Amba burst length */ +#define PHYTMAC_BURST_WIDTH 5 +#define PHYTMAC_ENDIA_PKT_INDEX 6 +#define PHYTMAC_ENDIA_PKT_WIDTH 1 +#define PHYTMAC_ENDIA_DESC_INDEX 7 +#define PHYTMAC_ENDIA_DESC_WIDTH 1 +#define PHYTMAC_TCO_EN_INDEX 11 /* Tx Checksum Offload en */ +#define PHYTMAC_TCO_EN_WIDTH 1 +#define PHYTMAC_RX_BUF_LEN_INDEX 16 /* DMA receive buffer size */ +#define PHYTMAC_RX_BUF_LEN_WIDTH 8 +#define PHYTMAC_RX_EXBD_EN_INDEX 28 /* Enable RX extended BD mode */ +#define PHYTMAC_RX_EXBD_EN_WIDTH 1 +#define PHYTMAC_TX_EXBD_EN_INDEX 29 /* Enable TX extended BD mode */ +#define PHYTMAC_TX_EXBD_EN_WIDTH 1 +#define PHYTMAC_ABW_INDEX 30 /* DMA address bus width */ +#define PHYTMAC_ABW_WIDTH 1 + +/* Int stauts/Enable/Disable/Mask Register */ +#define PHYTMAC_RXCOMP_INDEX 1 /* Rx complete */ +#define PHYTMAC_RXCOMP_WIDTH 1 +#define PHYTMAC_RUB_INDEX 2 /* Rx used bit read */ +#define PHYTMAC_RUB_WIDTH 1 +#define PHYTMAC_BUS_ERR_INDEX 6 /* AMBA error */ +#define PHYTMAC_BUS_ERR_WIDTH 1 +#define PHYTMAC_TXCOMP_INDEX 7 /* Tx complete */ +#define PHYTMAC_TXCOMP_WIDTH 1 +#define PHYTMAC_RXOVERRUN_INDEX 10 /* Tx overrun */ +#define PHYTMAC_RXOVERRUN_WIDTH 1 +#define PHYTMAC_RESP_ERR_INDEX 11 /* Resp not ok */ +#define PHYTMAC_RESP_ERR_WIDTH 1 + +/* Mdio read/write Register */ +#define PHYTMAC_DATA_INDEX 0 /* Data */ +#define PHYTMAC_DATA_WIDTH 16 +#define PHYTMAC_MUST_INDEX 16 /* Must Be 10 */ +#define PHYTMAC_MUST_WIDTH 2 +#define PHYTMAC_REG_ADDR_INDEX 18 /* Register address */ +#define PHYTMAC_REG_ADDR_WIDTH 5 +#define PHYTMAC_PHY_ADDR_INDEX 23 /* Phy address */ +#define PHYTMAC_PHY_ADDR_WIDTH 5 +#define PHYTMAC_OPS_INDEX 28 +#define PHYTMAC_OPS_WIDTH 2 +#define PHYTMAC_CLAUSE_SEL_INDEX 30 +#define PHYTMAC_CLAUSE_SEL_WIDTH 1 +#define PHYTMAC_CLAUSE_C22 1 +#define PHYTMAC_CLAUSE_C45 0 +#define PHYTMAC_OPS_C45_ADDR 0 +#define PHYTMAC_OPS_C45_WRITE 1 +#define PHYTMAC_OPS_C45_READ 3 +#define PHYTMAC_OPS_C22_WRITE 1 +#define PHYTMAC_OPS_C22_READ 2 + +/* hs mac config register */ +#define PHYTMAC_HS_SPEED_INDEX 0 +#define PHYTMAC_HS_SPEED_WIDTH 3 +#define PHYTMAC_HS_SPEED_100M 0 +#define PHYTMAC_HS_SPEED_1000M 1 +#define PHYTMAC_HS_SPEED_2500M 2 +#define PHYTMAC_HS_SPEED_5000M 3 +#define PHYTMAC_HS_SPEED_10G 4 + +/* WOL register */ +#define PHYTMAC_ARP_IP_INDEX 0 +#define PHYTMAC_ARP_IP_WIDTH 16 +#define PHYTMAC_MAGIC_INDEX 16 +#define PHYTMAC_MAGIC_WIDTH 1 +#define PHYTMAC_ARP_INDEX 17 +#define PHYTMAC_ARP_WIDTH 1 +#define PHYTMAC_UCAST_INDEX 18 +#define PHYTMAC_UCAST_WIDTH 1 +#define PHYTMAC_MCAST_INDEX 19 +#define PHYTMAC_MCAST_WIDTH 1 + +/* PCSCTRL register */ +#define PHYTMAC_AUTONEG_INDEX 12 +#define PHYTMAC_AUTONEG_WIDTH 1 +#define PHYTMAC_PCS_RESET_INDEX 15 +#define PHYTMAC_PCS_RESET_WIDTH 1 + +/* DEFAULT1 register */ +#define PHYTMAC_DBW_INDEX 25 +#define PHYTMAC_DBW_WIDTH 3 + +/* DEFAULT2 register */ +#define PHYTMAC_DAW64_INDEX 23 +#define PHYTMAC_DAW64_WIDTH 1 + +/* DEFAULT3 register */ +#define PHYTMAC_SCR2CMP_INDEX 0 +#define PHYTMAC_SCR2CMP_WIDTH 8 +#define PHYTMAC_SCR2ETH_INDEX 8 +#define PHYTMAC_SCR2ETH_WIDTH 8 + +/* DEFAULT4 register */ +#define PHYTMAC_TXDESCRD_INDEX 12 +#define PHYTMAC_TXDESCRD_WIDTH 4 +#define PHYTMAC_RXDESCRD_INDEX 8 +#define PHYTMAC_RXDESCRD_WIDTH 4 + +/* USXCTRL register */ +#define PHYTMAC_RX_EN_INDEX 0 +#define PHYTMAC_RX_EN_WIDTH 1 +#define PHYTMAC_TX_EN_INDEX 1 +#define PHYTMAC_TX_EN_WIDTH 1 +#define PHYTMAC_RX_SYNC_RESET_INDEX 2 +#define PHYTMAC_RX_SYNC_RESET_WIDTH 1 +#define PHYTMAC_SERDES_RATE_INDEX 12 +#define PHYTMAC_SERDES_RATE_WIDTH 2 +#define PHYTMAC_USX_SPEED_INDEX 14 +#define PHYTMAC_USX_SPEED_WIDTH 3 + +/* Bitfields in USX_STATUS. */ +#define PHYTMAC_USX_PCS_LINK_INDEX 0 +#define PHYTMAC_USX_PCS_LINK_WIDTH 1 + +/* Bitfields in PHYTMAC_TISN */ +#define PHYTMAC_SUB_NSECH_INDEX 0 +#define PHYTMAC_SUB_NSECH_WIDTH 16 +#define PHYTMAC_SUB_NSECL_INDEX 24 +#define PHYTMAC_SUB_NSECL_WIDTH 8 +#define PHYTMAC_SUB_NSEC_WIDTH 24 + +/* Bitfields in PHYTMAC_TSH */ +#define PHYTMAC_SECH_INDEX 0 +#define PHYTMAC_SECH_WIDTH 16 + +/* Bitfields in PHYTMAC_TSL */ +#define PHYTMAC_SECL_INDEX 0 +#define PHYTMAC_SECL_WIDTH 32 + +/* Bitfields in PHYTMAC_TN */ +#define PHYTMAC_NSEC_INDEX 0 +#define PHYTMAC_NSEC_WIDTH 30 + +/* Bitfields in PHYTMAC_TA */ +#define PHYTMAC_INCR_SEC_INDEX 0 +#define PHYTMAC_INCR_SEC_WIDTH 30 +#define PHYTMAC_INCR_ADD_INDEX 31 +#define PHYTMAC_INCR_ADD_WIDTH 1 +#define PHYTMAC_ADJUST_SEC_MAX ((1 << PHYTMAC_INCR_SEC_WIDTH) - 1) + +/* Bitfields in PHYTMAC_TI */ +#define PHYTMAC_INCR_NS_INDEX 0 +#define PHYTMAC_INCR_NS_WIDTH 8 + +/* PHYTMAC_TXBDCTRL register */ +#define PHYTMAC_TX_TSMODE_INDEX 4 +#define PHYTMAC_TX_TSMODE_WIDTH 2 + +#define PHYTMAC_RX_TSMODE_INDEX 4 +#define PHYTMAC_RX_TSMODE_WIDTH 2 + +/* Bitfields in PHYTMAC_FDIR */ +#define PHYTMAC_QUEUE_NUM_INDEX 0 +#define PHYTMAC_QUEUE_NUM_WIDTH 4 +#define PHYTMAC_VLAN_PRI_INDEX 4 +#define PHYTMAC_VLAN_PRI_WIDTH 3 +#define PHYTMAC_VLAN_EN_INDEX 8 +#define PHYTMAC_VLAN_EN_WIDTH 1 +#define PHYTMAC_ETH_TYPE_INDEX 9 +#define PHYTMAC_ETH_TYPE_WIDTH 3 +#define PHYTMAC_ETH_EN_INDEX 12 +#define PHYTMAC_ETH_EN_WIDTH 1 +#define PHYTMAC_CA_INDEX 13 +#define PHYTMAC_CA_WIDTH 5 +#define PHYTMAC_CA_EN_INDEX 18 +#define PHYTMAC_CA_EN_WIDTH 1 +#define PHYTMAC_CB_INDEX 19 +#define PHYTMAC_CB_WIDTH 5 +#define PHYTMAC_CB_EN_INDEX 24 +#define PHYTMAC_CB_EN_WIDTH 1 +#define PHYTMAC_CC_INDEX 25 +#define PHYTMAC_CC_WIDTH 5 +#define PHYTMAC_CC_EN_INDEX 30 +#define PHYTMAC_CC_EN_WIDTH 1 + +/* Bitfields in PHYTMAC_ETHERTYPE */ +#define PHYTMAC_ETHTYPE_VALUE_INDEX 0 +#define PHYTMAC_ETHTYPE_VALUE_WIDTH 16 + +/* Bitfields in PHYTMAC_COMP1 */ +#define PHYTMAC_SPORT_INDEX 0 +#define PHYTMAC_SPORT_WIDTH 16 +#define PHYTMAC_DPORT_INDEX 16 +#define PHYTMAC_DPORTE_WIDTH 16 + +/* Bitfields in PHYTMAC_COMP2 */ +#define PHYTMAC_OFFSET_INDEX 0 +#define PHYTMAC_OFFSET_WIDTH 7 +#define ETHTYPE_SIP_OFFSET 12 +#define ETHTYPE_DIP_OFFSET 16 +#define IPHEAD_SPORT_OFFSET 0 +#define IPHEAD_DPORT_OFFSET 2 +#define PHYTMAC_OFFSET_TYPE_INDEX 7 +#define PHYTMAC_OFFSET_TYPE_WIDTH 2 +#define PHYTMAC_OFFSET_BEGIN 0 +#define PHYTMAC_OFFSET_AFTER_L2HEAD 1 +#define PHYTMAC_OFFSET_AFTER_L3HEAD 2 +#define PHYTMAC_OFFSET_AFTER_L4HEAD 3 +#define PHYTMAC_DIS_MASK_INDEX 9 +#define PHYTMAC_DIS_MASK_WIDTH 1 +#define PHYTMAC_VLAN_ID_INDEX 10 +#define PHYTMAC_VLAN_ID_WIDTH 1 + +#define PHYTMAC_TSEC_WIDTH (PHYTMAC_SECH_WIDTH + PHYTMAC_SECL_WIDTH) +#define SEC_MAX_VAL (((u64)1 << PHYTMAC_TSEC_WIDTH) - 1) +#define NSEC_MAX_VAL ((1 << PHYTMAC_NSEC_WIDTH) - 1) + +/* rx dma desc bit */ +/* DMA descriptor bitfields */ +#define PHYTMAC_RX_USED_INDEX 0 +#define PHYTMAC_RX_USED_WIDTH 1 +#define PHYTMAC_RX_WRAP_INDEX 1 +#define PHYTMAC_RX_WRAP_WIDTH 1 +#define PHYTMAC_RX_TS_VALID_INDEX 2 +#define PHYTMAC_RX_TS_VALID_WIDTH 1 +#define PHYTMAC_RX_WADDR_INDEX 2 +#define PHYTMAC_RX_WADDR_WIDTH 30 + +#define PHYTMAC_RX_FRMLEN_INDEX 0 +#define PHYTMAC_RX_FRMLEN_WIDTH 12 +#define PHYTMAC_RX_INDEX_INDEX 12 +#define PHYTMAC_RX_INDEX_WIDTH 2 +#define PHYTMAC_RX_SOF_INDEX 14 +#define PHYTMAC_RX_SOF_WIDTH 1 +#define PHYTMAC_RX_EOF_INDEX 15 +#define PHYTMAC_RX_EOF_WIDTH 1 +#define PHYTMAC_RX_CFI_INDEX 16 +#define PHYTMAC_RX_CFI_WIDTH 1 +#define PHYTMAC_RX_VLAN_PRI_INDEX 17 +#define PHYTMAC_RX_VLAN_PRI_WIDTH 3 +#define PHYTMAC_RX_PRI_TAG_INDEX 20 +#define PHYTMAC_RX_PRI_TAG_WIDTH 1 +#define PHYTMAC_RX_VLAN_TAG_INDEX 21 +#define PHYTMAC_RX_VLAN_TAG_WIDTH 1 +#define PHYTMAC_RX_UHASH_MATCH_INDEX 29 +#define PHYTMAC_RX_UHASH_MATCH_WIDTH 1 +#define PHYTMAC_RX_MHASH_MATCH_INDEX 30 +#define PHYTMAC_RX_MHASH_MATCH_WIDTH 1 +#define PHYTMAC_RX_BROADCAST_INDEX 31 +#define PHYTMAC_RX_BROADCAST_WIDTH 1 + +#define PHYTMAC_RX_FRMLEN_MASK 0x1FFF +#define PHYTMAC_RX_JFRMLEN_MASK 0x3FFF + +/* RX checksum offload disabled: bit 24 clear in NCFGR */ +#define PHYTMAC_RX_TYPEID_MATCH_INDEX 22 +#define PHYTMAC_RX_TYPEID_MATCH_WIDTH 2 + +/* RX checksum offload enabled: bit 24 set in NCFGR */ +#define PHYTMAC_RX_CSUM_INDEX 22 +#define PHYTMAC_RX_CSUM_WIDTH 2 + +/* tx dma desc bit */ +#define PHYTMAC_TX_FRMLEN_INDEX 0 +#define PHYTMAC_TX_FRMLEN_WIDTH 14 +#define PHYTMAC_TX_LAST_INDEX 15 +#define PHYTMAC_TX_LAST_WIDTH 1 +#define PHYTMAC_TX_NOCRC_INDEX 16 +#define PHYTMAC_TX_NOCRC_WIDTH 1 +#define PHYTMAC_MSS_MFS_INDEX 16 +#define PHYTMAC_MSS_MFS_WIDTH 14 +#define PHYTMAC_TX_LSO_INDEX 17 +#define PHYTMAC_TX_LSO_WIDTH 2 +#define PHYTMAC_TX_TCP_SEQ_SRC_INDEX 19 +#define PHYTMAC_TX_TCP_SEQ_SRC_WIDTH 1 +#define PHYTMAC_TX_TS_VALID_INDEX 23 +#define PHYTMAC_TX_TS_VALID_WIDTH 1 +#define PHYTMAC_TX_BUF_EXHAUSTED_INDEX 27 +#define PHYTMAC_TX_BUF_EXHAUSTED_WIDTH 1 +#define PHYTMAC_TX_UNDERRUN_INDEX 28 +#define PHYTMAC_TX_UNDERRUN_WIDTH 1 +#define PHYTMAC_TX_ERROR_INDEX 29 +#define PHYTMAC_TX_ERROR_WIDTH 1 +#define PHYTMAC_TX_WRAP_INDEX 30 +#define PHYTMAC_TX_WRAP_WIDTH 1 +#define PHYTMAC_TX_USED_INDEX 31 +#define PHYTMAC_TX_USED_WIDTH 1 + +/* Transmit DMA buffer descriptor Word 4 */ +#define PHYTMAC_DMA_NSEC_INDEX 0 +#define PHYTMAC_DMA_NSEC_WIDTH 30 +#define PHYTMAC_DMA_SECL_INDEX 30 +#define PHYTMAC_DMA_SECL_WIDTH 2 + +/* Transmit DMA buffer descriptor Word 4 */ +#define PHYTMAC_DMA_SECH_INDEX 0 +#define PHYTMAC_DMA_SECH_WIDTH 4 +#define PHYTMAC_DMA_SEC_MASK 0x3f +#define PHYTMAC_DMA_SEC_TOP 0x40 + +/* Buffer descriptor constants */ +#define PHYTMAC_RX_CSUM_NONE 0 +#define PHYTMAC_RX_CSUM_IP_ONLY 1 +#define PHYTMAC_RX_CSUM_IP_TCP 2 +#define PHYTMAC_RX_CSUM_IP_UDP 3 + +/* limit RX checksum offload to TCP and UDP packets */ +#define PHYTMAC_RX_CSUM_CHECKED_MASK 2 + +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v2.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v2.c new file mode 100644 index 0000000000000000000000000000000000000000..df142aa6797f687d35ddb0355fe9c0e57d21a8a4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v2.c @@ -0,0 +1,1254 @@ +// SPDX-License-Identifier: GPL-2.0-only +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "phytmac.h" +#include "phytmac_v2.h" + +static int phytmac_msg_send(struct phytmac *pdata, u16 cmd_id, + u16 cmd_subid, void *data, int len, int wait) +{ + int index = 0; + struct phytmac_msg_info msg; + struct phytmac_msg_info msg_rx; + int ret = 0; + + ++pdata->msg_ring.tx_msg_tail; + if (pdata->msg_ring.tx_msg_tail > pdata->msg_ring.tx_msg_ring_size) + pdata->msg_ring.tx_msg_tail = 1; + index = pdata->msg_ring.tx_msg_tail; + + wait = 1; + memset(&msg, 0, sizeof(msg)); + memset(&msg_rx, 0, sizeof(msg_rx)); + msg.module_id = PHYTMAC_MODULE_ID_GMAC; + msg.cmd_id = cmd_id; + msg.cmd_subid = cmd_subid; + msg.flags = PHYTMAC_FLAGS_MSG_NOINT; + + if (len) + memcpy(&msg.para[0], data, len); + + if (netif_msg_hw(pdata)) { + netdev_info(pdata->ndev, "tx msg: cmdid=%d, subid=%d, flags=%d, len=%d, tail=%d\n", + msg.cmd_id, msg.cmd_subid, msg.flags, len, pdata->msg_ring.tx_msg_tail); + } + + memcpy(pdata->msg_regs + PHYTMAC_MSG(index), &msg, sizeof(msg)); + PHYTMAC_WRITE(pdata, PHYTMAC_TX_MSG_TAIL, + pdata->msg_ring.tx_msg_tail | PHYTMAC_BIT(TX_MSG_INT)); + + if (wait) { + memcpy(&msg_rx, pdata->msg_regs + PHYTMAC_MSG(index), MSG_HDR_LEN); + while (!(msg_rx.flags & 0x1)) { + cpu_relax(); + memcpy(&msg_rx, pdata->msg_regs + PHYTMAC_MSG(index), MSG_HDR_LEN); + } + } + + return ret; +} + +void phytmac_reset_hw(struct phytmac *pdata) +{ + int q; + u16 cmd_id, cmd_subid; + struct phytmac_ring_info ring; + + /* Disable and clear all interrupts and disable queues */ + for (q = 0; q < pdata->queues_max_num; ++q) { + PHYTMAC_WRITE(pdata, PHYTMAC_INT_DR(q), -1); + PHYTMAC_WRITE(pdata, PHYTMAC_INT_SR(q), -1); + PHYTMAC_WRITE(pdata, PHYTMAC_TAIL_PTR(q), 0); + } + + /* reset hw rx/tx enable */ + cmd_id = PHYTMAC_MSG_CMD_DEFAULT; + cmd_subid = PHYTMAC_MSG_CMD_DEFAULT_RESET_HW; + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); + + /* reset tx ring */ + memset(&ring, 0, sizeof(ring)); + ring.queue_num = pdata->queues_max_num; + cmd_subid = PHYTMAC_MSG_CMD_DEFAULT_RESET_TX_QUEUE; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&ring), sizeof(ring), 0); + + /* reset rx ring */ + cmd_subid = PHYTMAC_MSG_CMD_DEFAULT_RESET_RX_QUEUE; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&ring), sizeof(ring), 1); +} + +static int phytmac_get_mac_addr(struct phytmac *pdata, u8 *addr) +{ + int index; + u16 cmd_id, cmd_subid; + struct phytmac_mac para; + + cmd_id = PHYTMAC_MSG_CMD_GET; + cmd_subid = PHYTMAC_MSG_CMD_GET_ADDR; + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); + + index = pdata->msg_ring.tx_msg_tail; + if (index <= 0) + index += pdata->msg_ring.tx_msg_ring_size; + memcpy(¶, pdata->msg_regs + PHYTMAC_MSG(index) + MSG_HDR_LEN, + sizeof(struct phytmac_mac)); + + addr[0] = para.addrl & 0xff; + addr[1] = (para.addrl >> 8) & 0xff; + addr[2] = (para.addrl >> 16) & 0xff; + addr[3] = (para.addrl >> 24) & 0xff; + addr[4] = para.addrh & 0xff; + addr[5] = (para.addrh >> 8) & 0xff; + + return 0; +} + +int phytmac_set_mac_addr(struct phytmac *pdata, const u8 *addr) +{ + u16 cmd_id; + u16 cmd_subid; + struct phytmac_mac para; + + memset(¶, 0, sizeof(para)); + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_ADDR; + para.addrl = cpu_to_le32(*((u32 *)addr)); + para.addrh = cpu_to_le16(*((u16 *)(addr + 4))); + + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); + + return 0; +} + +static int phytmac_init_hw(struct phytmac *pdata) +{ + u16 cmd_id, cmd_subid; + struct phytmac_dma_info dma; + struct phytmac_eth_info eth; + + phytmac_set_mac_addr(pdata, pdata->ndev->dev_addr); + + cmd_id = PHYTMAC_MSG_CMD_SET; + if (pdata->capacities & PHYTMAC_CAPS_JUMBO) + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_JUMBO; + else + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_1536_FRAMES; + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); + + if (pdata->ndev->flags & IFF_PROMISC) { + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_PROMISE; + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); + } + + if (pdata->ndev->features & NETIF_F_RXCSUM) { + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_RXCSUM; + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); + } + + if (!(pdata->ndev->flags & IFF_BROADCAST)) { + cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_BC; + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); + } + + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_PAUSE; + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); + + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_STRIPCRC; + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 0); + + memset(&dma, 0, sizeof(dma)); + cmd_subid = PHYTMAC_MSG_CMD_SET_DMA; + dma.dma_burst_length = pdata->dma_burst_length; + if (pdata->dma_addr_width) + dma.hw_dma_cap |= HW_DMA_CAP_64B; + if (pdata->ndev->features & NETIF_F_HW_CSUM) + dma.hw_dma_cap |= HW_DMA_CAP_CSUM; + if (IS_REACHABLE(CONFIG_PHYTMAC_ENABLE_PTP)) + dma.hw_dma_cap |= HW_DMA_CAP_PTP; + if (pdata->dma_data_width == PHYTMAC_DBW64) + dma.hw_dma_cap |= HW_DMA_CAP_DDW64; + if (pdata->dma_data_width == PHYTMAC_DBW128) + dma.hw_dma_cap |= HW_DMA_CAP_DDW128; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)&dma, sizeof(dma), 0); + + memset(ð, 0, sizeof(eth)); + cmd_subid = PHYTMAC_MSG_CMD_SET_ETH_MATCH; + eth.index = 0; + eth.etype = (uint16_t)ETH_P_IP; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)ð, sizeof(eth), 1); + + return 0; +} + +static int phytmac_enable_multicast(struct phytmac *pdata, int enable) +{ + u16 cmd_id, cmd_subid; + + cmd_id = PHYTMAC_MSG_CMD_SET; + if (enable) + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_MC; + else + cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_MC; + + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); + return 0; +} + +static int phytmac_set_mc_hash(struct phytmac *pdata, unsigned long *mc_filter) +{ + u16 cmd_id, cmd_subid; + struct phytmac_mc_info para; + + memset(¶, 0, sizeof(para)); + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_HASH_MC; + para.mc_bottom = (u32)mc_filter[0]; + para.mc_top = (u32)mc_filter[1]; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); + + return 0; +} + +static int phytmac_init_ring_hw(struct phytmac *pdata) +{ + u16 cmd_id, cmd_subid; + struct phytmac_ring_info rxring; + struct phytmac_ring_info txring; + struct phytmac_rxbuf_info rxbuf; + struct phytmac_queue *queue; + u32 q; + + memset(&rxring, 0, sizeof(rxring)); + memset(&txring, 0, sizeof(txring)); + memset(&rxbuf, 0, sizeof(rxbuf)); + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_INIT_TX_RING; + txring.queue_num = pdata->queues_num; + rxring.queue_num = pdata->queues_num; + txring.hw_dma_cap |= HW_DMA_CAP_64B; + rxring.hw_dma_cap |= HW_DMA_CAP_64B; + for (q = 0, queue = pdata->queues; q < pdata->queues_num; ++q, ++queue) { + PHYTMAC_WRITE(pdata, PHYTMAC_TAIL_PTR(q), queue->tx_head); + txring.addr[q] = queue->tx_ring_addr; + rxring.addr[q] = queue->rx_ring_addr; + } + + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&txring), sizeof(txring), 0); + + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_DMA_RX_BUFSIZE; + rxbuf.queue_num = pdata->queues_num; + rxbuf.buffer_size = pdata->rx_buffer_len / 64; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&rxbuf), sizeof(rxbuf), 0); + + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_INIT_RX_RING; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&rxring), sizeof(rxring), 0); + + return 0; +} + +int phytmac_init_msg_ring(struct phytmac *pdata) +{ + u32 size = 0; + + pdata->msg_ring.tx_msg_tail = PHYTMAC_READ(pdata, PHYTMAC_TX_MSG_TAIL) & 0xff; + size = PHYTMAC_READ_BITS(pdata, PHYTMAC_SIZE, TXRING_SIZE); + pdata->msg_ring.tx_msg_ring_size = size; + if (pdata->msg_ring.tx_msg_tail == size) + pdata->msg_ring.tx_msg_tail = 0; + + PHYTMAC_WRITE(pdata, PHYTMAC_MSG_IMR, 0xfffffffe); + if (netif_msg_hw(pdata)) + netdev_info(pdata->ndev, "mac msg ring: tx_msg_ring_size=%d, tx_msg_tail=%d\n", + size, pdata->msg_ring.tx_msg_tail); + + return 0; +} + +static int phytmac_get_feature_all(struct phytmac *pdata) +{ + u16 cmd_id, cmd_subid; + int index; + struct phytmac_feature para; + + memset(¶, 0, sizeof(para)); + cmd_id = PHYTMAC_MSG_CMD_GET; + cmd_subid = PHYTMAC_MSG_CMD_GET_CAPS; + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); + + index = pdata->msg_ring.tx_msg_tail; + if (index <= 0) + index += pdata->msg_ring.tx_msg_ring_size; + + memcpy(¶, pdata->msg_regs + PHYTMAC_MSG(index) + MSG_HDR_LEN, + sizeof(struct phytmac_feature)); + + pdata->queues_max_num = para.queue_num; + if (para.dma_addr_width) + pdata->dma_addr_width = 64; + else + pdata->dma_addr_width = 32; + pdata->dma_data_width = para.dma_data_width; + pdata->max_rx_fs = para.max_rx_fs; + pdata->tx_bd_prefetch = (2 << (para.tx_bd_prefetch - 1)) * + sizeof(struct phytmac_dma_desc); + pdata->rx_bd_prefetch = (2 << (para.rx_bd_prefetch - 1)) * + sizeof(struct phytmac_dma_desc); + + if (netif_msg_hw(pdata)) { + netdev_info(pdata->ndev, "feature qnum=%d, daw=%d, dbw=%d, rxfs=%d, rxbd=%d, txbd=%d\n", + pdata->queues_num, pdata->dma_addr_width, pdata->dma_data_width, + pdata->max_rx_fs, pdata->rx_bd_prefetch, pdata->tx_bd_prefetch); + } + + return 0; +} + +void phytmac_get_regs(struct phytmac *pdata, u32 *reg_buff) +{ + u16 cmd_id, cmd_subid; + u16 reg_num; + int index; + + cmd_id = PHYTMAC_MSG_CMD_GET; + cmd_subid = PHYTMAC_MSG_CMD_GET_REG_READ; + reg_num = 16; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)®_num, 2, 1); + + index = pdata->msg_ring.tx_msg_tail; + if (index <= 0) + index += pdata->msg_ring.tx_msg_ring_size; + + memcpy(reg_buff, pdata->msg_regs + PHYTMAC_MSG(index) + MSG_HDR_LEN, 64); +} + +static void phytmac_get_hw_stats(struct phytmac *pdata) +{ + u16 cmd_id, cmd_subid; + u8 count; + int i, j, index; + u32 stats[48]; + u64 val; + u64 *p = &pdata->stats.tx_octets; + + cmd_id = PHYTMAC_MSG_CMD_GET; + cmd_subid = PHYTMAC_MSG_CMD_GET_STATS; + count = 1; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)&count, sizeof(count), 0); + + cmd_id = PHYTMAC_MSG_CMD_GET; + cmd_subid = PHYTMAC_MSG_CMD_GET_STATS; + count = 2; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)&count, sizeof(count), 0); + + cmd_id = PHYTMAC_MSG_CMD_GET; + cmd_subid = PHYTMAC_MSG_CMD_GET_STATS; + count = 3; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)&count, sizeof(count), 1); + + for (i = 0; i < 3; i++) { + index = pdata->msg_ring.tx_msg_tail + i - 2; + if (index <= 0) + index += pdata->msg_ring.tx_msg_ring_size; + memcpy(&stats[i * 16], pdata->msg_regs + PHYTMAC_MSG(index) + MSG_HDR_LEN, 64); + } + + for (i = 0, j = 0; i < 44; i++) { + if (i == 0 || i == 20) { + val = (u64)stats[i + 1] << 32 | stats[i]; + *p += val; + pdata->ethtool_stats[j] = *p; + ++j; + ++p; + } else { + if (i != 1 && i != 21) { + val = stats[i]; + *p += val; + pdata->ethtool_stats[j] = *p; + ++j; + ++p; + } + } + } +} + +static void phytmac_mdio_idle(struct phytmac *pdata) +{ + u32 val; + + /* wait for end of transfer */ + val = PHYTMAC_READ(pdata, PHYTMAC_NETWORK_STATUS); + while (!(val & PHYTMAC_BIT(MIDLE))) { + cpu_relax(); + val = PHYTMAC_READ(pdata, PHYTMAC_NETWORK_STATUS); + } +} + +static int phytmac_mdio_data_read_c22(struct phytmac *pdata, int mii_id, int regnum) +{ + u16 data; + + PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C22) + | PHYTMAC_BITS(MDCOPS, PHYTMAC_C22_READ) + | PHYTMAC_BITS(PHYADDR, mii_id) + | PHYTMAC_BITS(REGADDR, regnum) + | PHYTMAC_BITS(CONST, 2))); + phytmac_mdio_idle(pdata); + data = PHYTMAC_READ(pdata, PHYTMAC_MDIO) & 0xffff; + phytmac_mdio_idle(pdata); + return data; +} + +static int phytmac_mdio_data_write_c22(struct phytmac *pdata, int mii_id, + int regnum, u16 data) +{ + PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C22) + | PHYTMAC_BITS(MDCOPS, PHYTMAC_C22_WRITE) + | PHYTMAC_BITS(PHYADDR, mii_id) + | PHYTMAC_BITS(REGADDR, regnum) + | PHYTMAC_BITS(VALUE, data) + | PHYTMAC_BITS(CONST, 2))); + phytmac_mdio_idle(pdata); + + return 0; +} + +static int phytmac_mdio_data_read_c45(struct phytmac *pdata, int mii_id, int devad, int regnum) +{ + u16 data; + + PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C45) + | PHYTMAC_BITS(MDCOPS, PHYTMAC_C45_ADDR) + | PHYTMAC_BITS(PHYADDR, mii_id) + | PHYTMAC_BITS(REGADDR, devad & 0x1F) + | PHYTMAC_BITS(VALUE, regnum & 0xFFFF) + | PHYTMAC_BITS(CONST, 2))); + phytmac_mdio_idle(pdata); + PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C45) + | PHYTMAC_BITS(MDCOPS, PHYTMAC_C45_READ) + | PHYTMAC_BITS(PHYADDR, mii_id) + | PHYTMAC_BITS(REGADDR, devad & 0x1F) + | PHYTMAC_BITS(VALUE, regnum & 0xFFFF) + | PHYTMAC_BITS(CONST, 2))); + phytmac_mdio_idle(pdata); + data = PHYTMAC_READ(pdata, PHYTMAC_MDIO) & 0xffff; + phytmac_mdio_idle(pdata); + return data; +} + +static int phytmac_mdio_data_write_c45(struct phytmac *pdata, int mii_id, int devad, + int regnum, u16 data) +{ + PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C45) + | PHYTMAC_BITS(MDCOPS, PHYTMAC_C45_ADDR) + | PHYTMAC_BITS(PHYADDR, mii_id) + | PHYTMAC_BITS(REGADDR, (regnum >> 16) & 0x1F) + | PHYTMAC_BITS(VALUE, regnum & 0xFFFF) + | PHYTMAC_BITS(CONST, 2))); + phytmac_mdio_idle(pdata); + PHYTMAC_WRITE(pdata, PHYTMAC_MDIO, (PHYTMAC_BITS(CLAUSESEL, PHYTMAC_C45) + | PHYTMAC_BITS(MDCOPS, PHYTMAC_C45_WRITE) + | PHYTMAC_BITS(PHYADDR, mii_id) + | PHYTMAC_BITS(REGADDR, (regnum >> 16) & 0x1F) + | PHYTMAC_BITS(VALUE, data) + | PHYTMAC_BITS(CONST, 2))); + phytmac_mdio_idle(pdata); + + return 0; +} + +static int phytmac_powerup_hw(struct phytmac *pdata, int on) +{ + u32 status, data0, data1, rdata1; + int ret; + + if (pdata->capacities & PHYTMAC_CAPS_LPI) { + ret = readx_poll_timeout(PHYTMAC_READ_STAT, pdata, status, !status, + 1, PHYTMAC_TIMEOUT); + if (ret) + netdev_err(pdata->ndev, "mnh status is busy"); + + ret = readx_poll_timeout(PHYTMAC_READ_DATA0, pdata, data0, + data0 & PHYTMAC_BIT(DATA0_FREE), + 1, PHYTMAC_TIMEOUT); + if (ret) + netdev_err(pdata->ndev, "mnh data0 is busy"); + + data0 = 0; + data0 = PHYTMAC_SET_BITS(data0, DATA0_MSG, PHYTMAC_MSG_PM); + data0 = PHYTMAC_SET_BITS(data0, DATA0_PRO, PHYTMAC_PRO_ID); + PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA0, data0); + data1 = 0; + + if (on == PHYTMAC_POWERON) { + data1 = PHYTMAC_SET_BITS(data1, DATA1_STAT, PHYTMAC_STATON); + data1 = PHYTMAC_SET_BITS(data1, DATA1_STATTYPE, PHYTMAC_STATTYPE); + PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA1, data1); + } else { + data1 = PHYTMAC_SET_BITS(data1, DATA1_STAT, PHYTMAC_STATOFF); + data1 = PHYTMAC_SET_BITS(data1, DATA1_STATTYPE, PHYTMAC_STATTYPE); + PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_CPP_DATA1, data1); + } + + PHYTMAC_MHU_WRITE(pdata, PHYTMAC_MHU_AP_CPP_SET, 1); + ret = readx_poll_timeout(PHYTMAC_READ_DATA0, pdata, data0, + data0 & PHYTMAC_BIT(DATA0_FREE), + 1, PHYTMAC_TIMEOUT); + if (ret) + netdev_err(pdata->ndev, "mnh data0 is busy\n"); + + rdata1 = PHYTMAC_MHU_READ(pdata, PHYTMAC_MHU_CPP_DATA1); + if (rdata1 == data1) + netdev_err(pdata->ndev, "gmac power %s success, data1 = %x, rdata1=%x\n", + on ? "up" : "down", data1, rdata1); + else + netdev_err(pdata->ndev, "gmac power %s failed, data1 = %x, rdata1=%x\n", + on ? "up" : "down", data1, rdata1); + } + + pdata->power_state = on; + + return 0; +} + +static int phytmac_set_wake(struct phytmac *pdata, int wake) +{ + u16 cmd_id, cmd_subid; + u8 wol = (u8)wake; + + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_WOL; + + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&wol), 1, 1); + + return 0; +} + +static int phytmac_enable_promise(struct phytmac *pdata, int enable) +{ + u16 cmd_id, cmd_subid; + u8 rxcsum = 0; + + cmd_id = PHYTMAC_MSG_CMD_SET; + if (enable) { + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_PROMISE; + } else { + cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_PROMISE; + if (pdata->ndev->features & NETIF_F_RXCSUM) + rxcsum = 1; + } + + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&rxcsum), 1, 1); + + return 0; +} + +static int phytmac_enable_rxcsum(struct phytmac *pdata, int enable) +{ + u16 cmd_id, cmd_subid; + + cmd_id = PHYTMAC_MSG_CMD_SET; + if (enable) + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_RXCSUM; + else + cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_RXCSUM; + + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); + + return 0; +} + +static int phytmac_enable_txcsum(struct phytmac *pdata, int enable) +{ + u16 cmd_id, cmd_subid; + + cmd_id = PHYTMAC_MSG_CMD_SET; + if (enable) + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_TXCSUM; + else + cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_TXCSUM; + + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); + + return 0; +} + +static int phytmac_enable_mdio(struct phytmac *pdata, int enable) +{ + u16 cmd_id, cmd_subid; + + cmd_id = PHYTMAC_MSG_CMD_SET; + if (enable) + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_MDIO; + else + cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_MDIO; + + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); + + return 0; +} + +static int phytmac_enable_autoneg(struct phytmac *pdata, int enable) +{ + u16 cmd_id, cmd_subid; + + cmd_id = PHYTMAC_MSG_CMD_SET; + if (enable) + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_AUTONEG; + else + cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_AUTONEG; + + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); + + pdata->autoneg = enable; + return 0; +} + +static int phytmac_enable_pause(struct phytmac *pdata, int enable) +{ + u16 cmd_id, cmd_subid; + + cmd_id = PHYTMAC_MSG_CMD_SET; + if (enable) + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_PAUSE; + else + cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_PAUSE; + + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); + + return 0; +} + +static int phytmac_enable_network(struct phytmac *pdata, int enable, int rx_tx) +{ + u16 cmd_id, cmd_subid; + + cmd_id = PHYTMAC_MSG_CMD_SET; + if (enable) + cmd_subid = PHYTMAC_MSG_CMD_SET_ENABLE_NETWORK; + else + cmd_subid = PHYTMAC_MSG_CMD_SET_DISABLE_NETWORK; + + phytmac_msg_send(pdata, cmd_id, cmd_subid, NULL, 0, 1); + + return 0; +} + +static int phytmac_add_fdir_entry(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow) +{ + struct ethtool_tcpip4_spec *tp4sp_v, *tp4sp_m; + struct phytmac_fdir_info fdir; + u16 cmd_id, cmd_subid; + + memset(&fdir, 0, sizeof(fdir)); + + tp4sp_v = &rx_flow->h_u.tcp_ip4_spec; + tp4sp_m = &rx_flow->m_u.tcp_ip4_spec; + if (tp4sp_m->ip4src == 0xFFFFFFFF) { + fdir.ipsrc_en = true; + fdir.ip4src = tp4sp_v->ip4src; + } + + if (tp4sp_m->ip4dst == 0xFFFFFFFF) { + fdir.ipdst_en = true; + fdir.ip4dst = tp4sp_v->ip4dst; + } + + if (tp4sp_m->psrc == 0xFFFF || tp4sp_m->pdst == 0xFFFF) { + fdir.port_en = true; + fdir.dstport = tp4sp_v->pdst; + fdir.srcport = tp4sp_v->psrc; + fdir.dstport_mask = tp4sp_m->pdst; + fdir.srcport_mask = tp4sp_m->psrc; + } + + fdir.location = rx_flow->location; + fdir.queue = rx_flow->ring_cookie; + + if (fdir.ipsrc_en || fdir.ipdst_en || fdir.port_en) { + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_ADD_FDIR; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&fdir), sizeof(fdir), 1); + } + + return 0; +} + +static int phytmac_del_fdir_entry(struct phytmac *pdata, struct ethtool_rx_flow_spec *rx_flow) +{ + struct phytmac_fdir_info fdir; + u16 cmd_id, cmd_subid; + + memset(&fdir, 0, sizeof(fdir)); + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_DEL_FDIR; + fdir.location = (u8)rx_flow->location; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(&fdir), sizeof(fdir), 1); + + return 0; +} + +static void phytmac_tx_start(struct phytmac_queue *queue) +{ + struct phytmac *pdata = queue->pdata; + + PHYTMAC_WRITE(pdata, PHYTMAC_TAIL_PTR(queue->index), queue->tx_tail); + queue->tx_xmit_more = 0; +} + +static u32 phytmac_get_irq_mask(u32 mask) +{ + u32 value = 0; + + value |= (mask & PHYTMAC_INT_TX_COMPLETE) ? PHYTMAC_BIT(TXCOMP) : 0; + value |= (mask & PHYTMAC_INT_TX_ERR) ? PHYTMAC_BIT(DMA_ERR) : 0; + value |= (mask & PHYTMAC_INT_RX_COMPLETE) ? PHYTMAC_BIT(RXCOMP) : 0; + value |= (mask & PHYTMAC_INT_RX_OVERRUN) ? PHYTMAC_BIT(RXOVERRUN) : 0; + value |= (mask & PHYTMAC_INT_RX_DESC_FULL) ? PHYTMAC_BIT(RUSED) : 0; + + return value; +} + +static u32 phytmac_get_irq_status(u32 value) +{ + u32 status = 0; + + status |= (value & PHYTMAC_BIT(TXCOMP)) ? PHYTMAC_INT_TX_COMPLETE : 0; + status |= (value & PHYTMAC_BIT(DMA_ERR)) ? PHYTMAC_INT_TX_ERR : 0; + status |= (value & PHYTMAC_BIT(RXCOMP)) ? PHYTMAC_INT_RX_COMPLETE : 0; + status |= (value & PHYTMAC_BIT(RXOVERRUN)) ? PHYTMAC_INT_RX_OVERRUN : 0; + status |= (value & PHYTMAC_BIT(RUSED)) ? PHYTMAC_INT_RX_DESC_FULL : 0; + + return status; +} + +static void phytmac_enable_irq(struct phytmac *pdata, + int queue_index, u32 mask) +{ + u32 value; + + value = phytmac_get_irq_mask(mask); + PHYTMAC_WRITE(pdata, PHYTMAC_INT_ER(queue_index), value); +} + +static void phytmac_disable_irq(struct phytmac *pdata, + int queue_index, u32 mask) +{ + u32 value; + + value = phytmac_get_irq_mask(mask); + PHYTMAC_WRITE(pdata, PHYTMAC_INT_DR(queue_index), value); +} + +static void phytmac_clear_irq(struct phytmac *pdata, + int queue_index, u32 mask) +{ + u32 value; + + value = phytmac_get_irq_mask(mask); + PHYTMAC_WRITE(pdata, PHYTMAC_INT_SR(queue_index), value); +} + +static unsigned int phytmac_get_irq(struct phytmac *pdata, int queue_index) +{ + u32 status; + u32 value; + + value = PHYTMAC_READ(pdata, PHYTMAC_INT_SR(queue_index)); + status = phytmac_get_irq_status(value); + + return status; +} + +static void phytmac_interface_config(struct phytmac *pdata, unsigned int mode, + const struct phylink_link_state *state) +{ + struct phytmac_interface_info para; + u16 cmd_id, cmd_subid; + + memset(¶, 0, sizeof(para)); + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_MAC_CONFIG; + para.interface = state->interface; + para.autoneg = (mode == MLO_AN_FIXED ? 0 : 1); + para.speed = state->speed; + para.duplex = state->duplex; + pdata->autoneg = para.autoneg; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); +} + +static int phytmac_interface_linkup(struct phytmac *pdata, phy_interface_t interface, + int speed, int duplex) +{ + struct phytmac_interface_info para; + u16 cmd_id, cmd_subid; + + memset(¶, 0, sizeof(para)); + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_MAC_LINK_CONFIG; + para.interface = interface; + para.duplex = duplex; + para.speed = speed; + para.autoneg = pdata->autoneg; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); + + return 0; +} + +static int phytmac_interface_linkdown(struct phytmac *pdata) +{ + return 0; +} + +static int phytmac_pcs_linkup(struct phytmac *pdata, phy_interface_t interface, + int speed, int duplex) +{ + struct phytmac_interface_info para; + u16 cmd_id, cmd_subid; + + if (interface == PHY_INTERFACE_MODE_USXGMII || + interface == PHY_INTERFACE_MODE_10GBASER) { + memset(¶, 0, sizeof(para)); + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_PCS_LINK_UP; + para.interface = interface; + para.duplex = duplex; + para.speed = speed; + para.autoneg = 0; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); + } + + return 0; +} + +static int phytmac_pcs_linkdown(struct phytmac *pdata) +{ + return 0; +} + +static unsigned int phytmac_pcs_get_link(struct phytmac *pdata, phy_interface_t interface) +{ + if (interface == PHY_INTERFACE_MODE_SGMII || + interface == PHY_INTERFACE_MODE_2500BASEX) + return PHYTMAC_READ_BITS(pdata, PHYTMAC_NETWORK_STATUS, LINK); + else if (interface == PHY_INTERFACE_MODE_USXGMII || + interface == PHY_INTERFACE_MODE_10GBASER) + return PHYTMAC_READ_BITS(pdata, PHYTMAC_USX_LINK_STATUS, USX_LINK); + + return 0; +} + +static unsigned int phytmac_tx_map_desc(struct phytmac_queue *queue, + u32 tx_tail, struct packet_info *packet) +{ + unsigned int i, ctrl; + struct phytmac *pdata = queue->pdata; + struct phytmac_dma_desc *desc; + struct phytmac_tx_skb *tx_skb; + unsigned int eof = 1; + + i = tx_tail; + + do { + i--; + tx_skb = phytmac_get_tx_skb(queue, i); + desc = phytmac_get_tx_desc(queue, i); + + ctrl = (u32)tx_skb->length; + if (eof) { + ctrl |= PHYTMAC_BIT(TXLAST); + eof = 0; + } + + if (unlikely(i == (pdata->tx_ring_size - 1))) + ctrl |= PHYTMAC_BIT(TXWRAP); + + if (i == queue->tx_tail) { + ctrl |= PHYTMAC_BITS(TXLSO, packet->lso); + ctrl |= PHYTMAC_BITS(TXTCP_SEQ_SRC, packet->seq); + if (packet->nocrc) + ctrl |= PHYTMAC_BIT(TXNOCRC); + } else { + ctrl |= PHYTMAC_BITS(MSSMFS, packet->mss); + } + + desc->desc2 = upper_32_bits(tx_skb->addr); + desc->desc0 = lower_32_bits(tx_skb->addr); + /* make newly desc1 to hardware */ + wmb(); + desc->desc1 = ctrl; + } while (i != queue->tx_tail); + + return 0; +} + +static void phytmac_init_rx_map_desc(struct phytmac_queue *queue, + u32 index) +{ + struct phytmac_dma_desc *desc; + + desc = phytmac_get_rx_desc(queue, index); + + desc->desc1 = 0; + /* Make newly descriptor to hardware */ + dma_wmb(); + desc->desc0 |= PHYTMAC_BIT(RXUSED); +} + +static unsigned int phytmac_rx_map_desc(struct phytmac_queue *queue, u32 index, dma_addr_t addr) +{ + struct phytmac *pdata = queue->pdata; + struct phytmac_dma_desc *desc; + + desc = phytmac_get_rx_desc(queue, index); + + if (addr) { + if (unlikely(index == (pdata->rx_ring_size - 1))) + addr |= PHYTMAC_BIT(RXWRAP); + desc->desc1 = 0; + desc->desc2 = upper_32_bits(addr); + /* Make newly descriptor to hardware */ + dma_wmb(); + desc->desc0 = lower_32_bits(addr); + } else { + desc->desc1 = 0; + /* make newly descriptor to hardware */ + dma_wmb(); + desc->desc0 &= ~PHYTMAC_BIT(RXUSED); + } + + return 0; +} + +static int phytmac_tx_complete(const struct phytmac_dma_desc *desc) +{ + return PHYTMAC_GET_BITS(desc->desc1, TXUSED); +} + +static int phytmac_rx_complete(const struct phytmac_dma_desc *desc) +{ + return PHYTMAC_GET_BITS(desc->desc0, RXUSED); +} + +static int phytmac_rx_pkt_len(struct phytmac *pdata, const struct phytmac_dma_desc *desc) +{ + if (pdata->capacities & PHYTMAC_CAPS_JUMBO) + return desc->desc1 & PHYTMAC_RXJFRMLEN_MASK; + else + return desc->desc1 & PHYTMAC_RXFRMLEN_MASK; +} + +static dma_addr_t phytmac_get_desc_addr(const struct phytmac_dma_desc *desc) +{ + dma_addr_t addr = 0; + + addr = ((u64)(desc->desc2) << 32); + + addr |= (desc->desc0 & 0xfffffffc); + return addr; +} + +static bool phytmac_rx_checksum(const struct phytmac_dma_desc *desc) +{ + u32 value = desc->desc1; + u32 check = value >> PHYTMAC_RXCSUM_INDEX & 0x3; + + return (check == PHYTMAC_RXCSUM_IP_TCP || check == PHYTMAC_RXCSUM_IP_UDP); +} + +static bool phytmac_rx_single_buffer(const struct phytmac_dma_desc *desc) +{ + u32 value = desc->desc1; + + return ((value & PHYTMAC_BIT(RXSOF)) && (value & PHYTMAC_BIT(RXEOF))); +} + +static bool phytmac_rx_sof(const struct phytmac_dma_desc *desc) +{ + u32 value = desc->desc1; + + return (value & PHYTMAC_BIT(RXSOF)); +} + +static bool phytmac_rx_eof(const struct phytmac_dma_desc *desc) +{ + u32 value = desc->desc1; + + return (value & PHYTMAC_BIT(RXEOF)); +} + +static void phytmac_clear_rx_desc(struct phytmac_queue *queue, int begin, int end) +{ + unsigned int frag; + unsigned int tmp = end; + struct phytmac_dma_desc *desc; + + if (begin > end) + tmp = end + queue->pdata->rx_ring_size; + + for (frag = begin; frag != end; frag++) { + desc = phytmac_get_rx_desc(queue, frag); + desc->desc0 &= ~PHYTMAC_BIT(RXUSED); + } +} + +static void phytmac_clear_tx_desc(struct phytmac_queue *queue) +{ + struct phytmac *pdata = queue->pdata; + struct phytmac_dma_desc *desc = NULL; + struct phytmac_tx_skb *tx_skb = NULL; + int i; + + for (i = 0; i < queue->pdata->tx_ring_size; i++) { + desc = phytmac_get_tx_desc(queue, i); + tx_skb = phytmac_get_tx_skb(queue, i); + desc->desc2 = upper_32_bits(tx_skb->addr); + desc->desc0 = lower_32_bits(tx_skb->addr); + /* make newly desc to hardware */ + wmb(); + desc->desc1 = PHYTMAC_BIT(TXUSED); + } + desc->desc1 |= PHYTMAC_BIT(TXWRAP); + PHYTMAC_WRITE(pdata, PHYTMAC_TAIL_PTR(queue->index), queue->tx_tail); +} + +static void phytmac_get_time(struct phytmac *pdata, struct timespec64 *ts) +{ + u32 ns, secl, sech; + + ns = PHYTMAC_READ(pdata, PHYTMAC_TIMER_NSEC); + secl = PHYTMAC_READ(pdata, PHYTMAC_TIMER_SEC); + sech = PHYTMAC_READ(pdata, PHYTMAC_TIMER_MSB_SEC); + + ts->tv_nsec = ns; + ts->tv_sec = (((u64)sech << 32) | secl) & TIMER_SEC_MAX_VAL; +} + +void phytmac_set_time(struct phytmac *pdata, time64_t sec, long nsec) +{ + u32 secl, sech; + + secl = (u32)sec; + sech = (sec >> 32) & (0xffff); + + PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_NSEC, 0); + PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_MSB_SEC, sech); + PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_SEC, secl); + PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_NSEC, nsec); +} + +void phytmac_clear_time(struct phytmac *pdata) +{ + u32 value; + + pdata->ts_incr.sub_ns = 0; + pdata->ts_incr.ns = 0; + + value = PHYTMAC_READ(pdata, PHYTMAC_TIMER_INCR); + value = PHYTMAC_SET_BITS(value, INCR_NSEC, 0); + PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_INCR, value); + + value = PHYTMAC_READ(pdata, PHYTMAC_TIMER_INCR_SUB_NSEC); + value = PHYTMAC_SET_BITS(value, INCR_SNSEC, 0); + PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_INCR_SUB_NSEC, value); + + PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_ADJUST, 0); +} + +int phytmac_set_tsmode(struct phytmac *pdata, struct ts_ctrl *ctrl) +{ + u16 cmd_id, cmd_subid; + struct phytmac_ts_config para; + + cmd_id = PHYTMAC_MSG_CMD_SET; + cmd_subid = PHYTMAC_MSG_CMD_SET_TS_CONFIG; + para.tx_mode = ctrl->tx_control; + para.rx_mode = ctrl->rx_control; + para.one_step = ctrl->one_step; + phytmac_msg_send(pdata, cmd_id, cmd_subid, (void *)(¶), sizeof(para), 1); + + return 0; +} + +static int phytmac_set_tsincr(struct phytmac *pdata, struct ts_incr *incr) +{ + u32 value; + + value = PHYTMAC_BITS(INCR_SNSEC, incr->sub_ns); + PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_INCR_SUB_NSEC, value); + PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_INCR, incr->ns); + + return 0; +} + +static void phytmac_ptp_init_hw(struct phytmac *pdata) +{ + struct timespec64 ts; + + ts = ns_to_timespec64(ktime_to_ns(ktime_get_real())); + phytmac_set_time(pdata, ts.tv_sec, ts.tv_nsec); + + phytmac_set_tsincr(pdata, &pdata->ts_incr); +} + +static int phytmac_adjust_fine(struct phytmac *pdata, long ppm, bool negative) +{ + struct ts_incr ts_incr; + u32 tmp; + u64 adj; + + ts_incr.ns = pdata->ts_incr.ns; + ts_incr.sub_ns = pdata->ts_incr.sub_ns; + + /* scaling: unused(8bit) | ns(8bit) | fractions(16bit) */ + tmp = ((u64)ts_incr.ns << PHYTMAC_INCR_SNSECL_INDEX) + ts_incr.sub_ns; + adj = ((u64)ppm * tmp + (USEC_PER_SEC >> 1)) >> PHYTMAC_INCR_SNSECL_INDEX; + + adj = div_u64(adj, USEC_PER_SEC); + adj = negative ? (tmp - adj) : (tmp + adj); + + ts_incr.ns = (adj >> PHYTMAC_INCR_SNSEC_WIDTH) + & ((1 << PHYTMAC_INCR_NSEC_WIDTH) - 1); + ts_incr.sub_ns = adj & ((1 << PHYTMAC_INCR_SNSEC_WIDTH) - 1); + + phytmac_set_tsincr(pdata, &ts_incr); + + return 0; +} + +int phytmac_adjust_time(struct phytmac *pdata, s64 delta, int neg) +{ + u32 adj; + + if (delta > PHYTMAC_ASEC_MAX) { + struct timespec64 now, then; + + then = ns_to_timespec64(delta); + phytmac_get_time(pdata, &now); + now = timespec64_add(now, then); + phytmac_set_time(pdata, now.tv_sec, now.tv_nsec); + } else { + adj = (neg << PHYTMAC_AADD_INDEX) | delta; + PHYTMAC_WRITE(pdata, PHYTMAC_TIMER_ADJUST, adj); + } + + return 0; +} + +static int phytmac_ts_valid(struct phytmac *pdata, struct phytmac_dma_desc *desc, int direction) +{ + int ts_valid = 0; + + if (direction == PHYTMAC_TX) + ts_valid = desc->desc1 & PHYTMAC_BIT(TXTSVALID); + else if (direction == PHYTMAC_RX) + ts_valid = desc->desc0 & PHYTMAC_BIT(RXTSVALID); + return ts_valid; +} + +static void phytmac_get_dma_ts(struct phytmac *pdata, u32 ts_1, u32 ts_2, struct timespec64 *ts) +{ + struct timespec64 ts2; + + ts->tv_sec = (PHYTMAC_GET_BITS(ts_2, TS_SECH) << 2) | + PHYTMAC_GET_BITS(ts_1, TS_SECL); + ts->tv_nsec = PHYTMAC_GET_BITS(ts_1, TS_NSEC); + + phytmac_get_time(pdata, &ts2); + + if (((ts->tv_sec ^ ts2.tv_sec) & (PHYTMAC_TS_SEC_TOP >> 1)) != 0) + ts->tv_sec -= PHYTMAC_TS_SEC_TOP; + + ts->tv_sec += (ts2.tv_sec & (~PHYTMAC_TS_SEC_MASK)); +} + +static unsigned int phytmac_get_ts_rate(struct phytmac *pdata) +{ + return 300000000; +} + +struct phytmac_hw_if phytmac_2p0_hw = { + .init_msg_ring = phytmac_init_msg_ring, + .reset_hw = phytmac_reset_hw, + .init_hw = phytmac_init_hw, + .init_ring_hw = phytmac_init_ring_hw, + .get_feature = phytmac_get_feature_all, + .get_regs = phytmac_get_regs, + .get_stats = phytmac_get_hw_stats, + .set_mac_address = phytmac_set_mac_addr, + .get_mac_address = phytmac_get_mac_addr, + .mdio_read = phytmac_mdio_data_read_c22, + .mdio_write = phytmac_mdio_data_write_c22, + .mdio_read_c45 = phytmac_mdio_data_read_c45, + .mdio_write_c45 = phytmac_mdio_data_write_c45, + .poweron = phytmac_powerup_hw, + .set_wol = phytmac_set_wake, + .enable_promise = phytmac_enable_promise, + .enable_multicast = phytmac_enable_multicast, + .set_hash_table = phytmac_set_mc_hash, + .enable_rx_csum = phytmac_enable_rxcsum, + .enable_tx_csum = phytmac_enable_txcsum, + .enable_mdio_control = phytmac_enable_mdio, + .enable_autoneg = phytmac_enable_autoneg, + .enable_pause = phytmac_enable_pause, + .enable_network = phytmac_enable_network, + .add_fdir_entry = phytmac_add_fdir_entry, + .del_fdir_entry = phytmac_del_fdir_entry, + + /* mac config */ + .mac_config = phytmac_interface_config, + .mac_linkup = phytmac_interface_linkup, + .mac_linkdown = phytmac_interface_linkdown, + .pcs_linkup = phytmac_pcs_linkup, + .pcs_linkdown = phytmac_pcs_linkdown, + .get_link = phytmac_pcs_get_link, + + /* irq */ + .enable_irq = phytmac_enable_irq, + .disable_irq = phytmac_disable_irq, + .clear_irq = phytmac_clear_irq, + .get_irq = phytmac_get_irq, + + /* tx and rx */ + .tx_map = phytmac_tx_map_desc, + .transmit = phytmac_tx_start, + .tx_complete = phytmac_tx_complete, + .rx_complete = phytmac_rx_complete, + .get_rx_pkt_len = phytmac_rx_pkt_len, + .get_desc_addr = phytmac_get_desc_addr, + .init_rx_map = phytmac_init_rx_map_desc, + .rx_map = phytmac_rx_map_desc, + .rx_checksum = phytmac_rx_checksum, + .rx_single_buffer = phytmac_rx_single_buffer, + .rx_pkt_start = phytmac_rx_sof, + .rx_pkt_end = phytmac_rx_eof, + .clear_rx_desc = phytmac_clear_rx_desc, + .clear_tx_desc = phytmac_clear_tx_desc, + + /* ptp */ + .init_ts_hw = phytmac_ptp_init_hw, + .set_time = phytmac_set_time, + .clear_time = phytmac_clear_time, + .get_time = phytmac_get_time, + .set_ts_config = phytmac_set_tsmode, + .set_incr = phytmac_set_tsincr, + .adjust_fine = phytmac_adjust_fine, + .adjust_time = phytmac_adjust_time, + .ts_valid = phytmac_ts_valid, + .get_timestamp = phytmac_get_dma_ts, + .get_ts_rate = phytmac_get_ts_rate, +}; +EXPORT_SYMBOL_GPL(phytmac_2p0_hw); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v2.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v2.h new file mode 100644 index 0000000000000000000000000000000000000000..92e4806ac2c1f7f72be6f0f74d34b6624d23800c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/net/ethernet/phytium/phytmac_v2.h @@ -0,0 +1,362 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ +#ifndef _PHYTMAC_V2_H +#define _PHYTMAC_V2_H + +extern struct phytmac_hw_if phytmac_2p0_hw; + +#define PHYTMAC_MSG_SRAM_SIZE 4096 +#define MSG_HDR_LEN 8 + +#define PHYTMAC_TX_MSG_HEAD 0x000 +#define PHYTMAC_TX_MSG_TAIL 0x004 +#define PHYTMAC_RX_MSG_HEAD 0x008 +#define PHYTMAC_RX_MSG_TAIL 0x00c +#define PHYTMAC_MSG_IMR 0x020 +#define PHYTMAC_MSG_ISR 0x02c + +#define PHYTMAC_SIZE 0x0048 +#define PHYTMAC_NETWORK_STATUS 0x0240 +#define PHYTMAC_PCS_AN_LP 0x0244 +#define PHYTMAC_USX_LINK_STATUS 0x0248 +#define PHYTMAC_MDIO 0x0264 +#define PHYTMAC_TIMER_INCR_SUB_NSEC 0x024c +#define PHYTMAC_TIMER_INCR 0x0250 +#define PHYTMAC_TIMER_MSB_SEC 0x0254 +#define PHYTMAC_TIMER_SEC 0x0258 +#define PHYTMAC_TIMER_NSEC 0x025c +#define PHYTMAC_TIMER_ADJUST 0x0260 +#define PHYTMAC_MSG(i) (((i) - 1) * 0x48) + +#define PHYTMAC_MODULE_ID_GMAC 0x60 +#define PHYTMAC_FLAGS_MSG_COMP 0x1 +#define PHYTMAC_FLAGS_MSG_NOINT 0x2 + +/* Bitfields in PHYTMAC_TX_MSG_TAIL */ +#define PHYTMAC_TX_MSG_INT_INDEX 16 +#define PHYTMAC_TX_MSG_INT_WIDTH 1 + +/* Bitfields in PHYTMAC_MSG_ISR */ +#define PHYTMAC_MSG_COMPLETE_INDEX 0 +#define PHYTMAC_MSG_COMPLETE_WIDTH 1 + +/* Bitfields in PHYTMAC_SIZE */ +#define PHYTMAC_MEM_SIZE_INDEX 0 +#define PHYTMAC_MEM_SIZE_WIDTH 4 +#define PHYTMAC_TXRING_SIZE_INDEX 8 +#define PHYTMAC_TXRING_SIZE_WIDTH 6 + +/* Bitfields in PHYTMAC_TIMER_INCR_SUB_NSEC */ +#define PHYTMAC_INCR_SNSECH_INDEX 0 +#define PHYTMAC_INCR_SNSECH_WIDTH 16 +#define PHYTMAC_INCR_SNSECL_INDEX 24 +#define PHYTMAC_INCR_SNSECL_WIDTH 8 +#define PHYTMAC_INCR_SNSEC_WIDTH 24 + +/* Bitfields in PHYTMAC_TIMER_INCR_SUB_NSEC */ +#define PHYTMAC_INCR_SNSEC_INDEX 0 +#define PHYTMAC_INCR_SNSEC_WIDTH 24 + +/* Bitfields in PHYTMAC_TIMER_INCR */ +#define PHYTMAC_INCR_NSEC_INDEX 0 +#define PHYTMAC_INCR_NSEC_WIDTH 8 + +/* Bitfields in PHYTMAC_TIMER_MSB_SEC */ +#define PHYTMAC_TIMER_SECH_INDEX 0 +#define PHYTMAC_TIMER_SECH_WIDTH 16 + +/* Bitfields in PHYTMAC_TIMER_SEC */ +#define PHYTMAC_TIMER_SECL_INDEX 0 +#define PHYTMAC_TIMER_SECL_WIDTH 32 + +/* Bitfields in PHYTMAC_TIMER_NSEC */ +#define PHYTMAC_TIMER_NSEC_INDEX 0 +#define PHYTMAC_TIMER_NSEC_WIDTH 30 + +/* Bitfields in PHYTMAC_TIMER_ADJUST */ +#define PHYTMAC_ASEC_INDEX 0 +#define PHYTMAC_ASEC_WIDTH 30 +#define PHYTMAC_AADD_INDEX 31 +#define PHYTMAC_AADD_WIDTH 1 +#define PHYTMAC_ASEC_MAX ((1 << PHYTMAC_ASEC_WIDTH) - 1) + +#define PHYTMAC_TIMER_SEC_WIDTH (PHYTMAC_TIMER_SECH_WIDTH + PHYTMAC_TIMER_SECL_WIDTH) +#define TIMER_SEC_MAX_VAL (((u64)1 << PHYTMAC_TIMER_SEC_WIDTH) - 1) +#define TIMER_NSEC_MAX_VAL ((1 << PHYTMAC_TIMER_NSEC_WIDTH) - 1) + +#define PHYTMAC_TAIL_PTR(i) (0x0100 + ((i) * 4)) +#define PHYTMAC_INT_ER(i) (0x0140 + ((i) * 4)) +#define PHYTMAC_INT_DR(i) (0x0180 + ((i) * 4)) +#define PHYTMAC_INT_MR(i) (0x01c0 + ((i) * 4)) +#define PHYTMAC_INT_SR(i) (0x0200 + ((i) * 4)) + +#define PHYTMAC_LINK_INDEX 0 /* PCS link status */ +#define PHYTMAC_LINK_WIDTH 1 +#define PHYTMAC_MIDLE_INDEX 2 /* Mdio idle */ +#define PHYTMAC_MIDLE_WIDTH 1 + +/* Int stauts/Enable/Disable/Mask Register */ +#define PHYTMAC_RXCOMP_INDEX 1 /* Rx complete */ +#define PHYTMAC_RXCOMP_WIDTH 1 +#define PHYTMAC_RUSED_INDEX 2 /* Rx used bit read */ +#define PHYTMAC_RUSED_WIDTH 1 +#define PHYTMAC_DMA_ERR_INDEX 6 /* AMBA error */ +#define PHYTMAC_DMA_ERR_WIDTH 1 +#define PHYTMAC_TXCOMP_INDEX 7 /* Tx complete */ +#define PHYTMAC_TXCOMP_WIDTH 1 +#define PHYTMAC_RXOVERRUN_INDEX 10 /* Rx overrun */ +#define PHYTMAC_RXOVERRUN_WIDTH 1 +#define PHYTMAC_RESP_ERR_INDEX 11 /* Resp not ok */ +#define PHYTMAC_RESP_ERR_WIDTH 1 + +/* pcs an lp */ +#define PHYTMAC_AUTO_NEG_INDEX 12 +#define PHYTMAC_AUTO_NEG_WIDTH 1 + +/* Bitfields in USX_STATUS. */ +#define PHYTMAC_USX_LINK_INDEX 0 +#define PHYTMAC_USX_LINK_WIDTH 1 + +/* Mdio read/write Register */ +#define PHYTMAC_VALUE_INDEX 0 /* value */ +#define PHYTMAC_VALUE_WIDTH 16 +#define PHYTMAC_CONST_INDEX 16 /* Must Be 10 */ +#define PHYTMAC_CONST_WIDTH 2 +#define PHYTMAC_REGADDR_INDEX 18 /* Register address */ +#define PHYTMAC_REGADDR_WIDTH 5 +#define PHYTMAC_PHYADDR_INDEX 23 /* Phy address */ +#define PHYTMAC_PHYADDR_WIDTH 5 +#define PHYTMAC_MDCOPS_INDEX 28 +#define PHYTMAC_MDCOPS_WIDTH 2 +#define PHYTMAC_CLAUSESEL_INDEX 30 +#define PHYTMAC_CLAUSESEL_WIDTH 1 +#define PHYTMAC_C22 1 +#define PHYTMAC_C45 0 +#define PHYTMAC_C45_ADDR 0 +#define PHYTMAC_C45_WRITE 1 +#define PHYTMAC_C45_READ 3 +#define PHYTMAC_C22_WRITE 1 +#define PHYTMAC_C22_READ 2 + +/* rx dma desc bit */ +/* DMA descriptor bitfields */ +#define PHYTMAC_RXUSED_INDEX 0 +#define PHYTMAC_RXUSED_WIDTH 1 +#define PHYTMAC_RXWRAP_INDEX 1 +#define PHYTMAC_RXWRAP_WIDTH 1 +#define PHYTMAC_RXTSVALID_INDEX 2 +#define PHYTMAC_RXTSVALID_WIDTH 1 +#define PHYTMAC_RXWADDR_INDEX 2 +#define PHYTMAC_RXWADDR_WIDTH 30 + +#define PHYTMAC_RXFRMLEN_INDEX 0 +#define PHYTMAC_RXFRMLEN_WIDTH 12 +#define PHYTMAC_RXINDEX_INDEX 12 +#define PHYTMAC_RXINDEX_WIDTH 2 +#define PHYTMAC_RXSOF_INDEX 14 +#define PHYTMAC_RXSOF_WIDTH 1 +#define PHYTMAC_RXEOF_INDEX 15 +#define PHYTMAC_RXEOF_WIDTH 1 + +#define PHYTMAC_RXFRMLEN_MASK 0x1FFF +#define PHYTMAC_RXJFRMLEN_MASK 0x3FFF + +#define PHYTMAC_RXTYPEID_MATCH_INDEX 22 +#define PHYTMAC_RXTYPEID_MATCH_WIDTH 2 +#define PHYTMAC_RXCSUM_INDEX 22 +#define PHYTMAC_RXCSUM_WIDTH 2 + +/* Buffer descriptor constants */ +#define PHYTMAC_RXCSUM_NONE 0 +#define PHYTMAC_RXCSUM_IP 1 +#define PHYTMAC_RXCSUM_IP_TCP 2 +#define PHYTMAC_RXCSUM_IP_UDP 3 + +#define PHYTMAC_TXFRMLEN_INDEX 0 +#define PHYTMAC_TXFRMLEN_WIDTH 14 +#define PHYTMAC_TXLAST_INDEX 15 +#define PHYTMAC_TXLAST_WIDTH 1 +#define PHYTMAC_TXNOCRC_INDEX 16 +#define PHYTMAC_TXNOCRC_WIDTH 1 +#define PHYTMAC_MSSMFS_INDEX 16 +#define PHYTMAC_MSSMFS_WIDTH 14 +#define PHYTMAC_TXLSO_INDEX 17 +#define PHYTMAC_TXLSO_WIDTH 2 +#define PHYTMAC_TXTCP_SEQ_SRC_INDEX 19 +#define PHYTMAC_TXTCP_SEQ_SRC_WIDTH 1 +#define PHYTMAC_TXTSVALID_INDEX 23 +#define PHYTMAC_TXTSVALID_WIDTH 1 +#define PHYTMAC_TXWRAP_INDEX 30 +#define PHYTMAC_TXWRAP_WIDTH 1 +#define PHYTMAC_TXUSED_INDEX 31 +#define PHYTMAC_TXUSED_WIDTH 1 + +/* dma ts */ +#define PHYTMAC_TS_NSEC_INDEX 0 +#define PHYTMAC_TS_NSEC_WIDTH 30 +#define PHYTMAC_TS_SECL_INDEX 30 +#define PHYTMAC_TS_SECL_WIDTH 2 +#define PHYTMAC_TS_SECH_INDEX 0 +#define PHYTMAC_TS_SECH_WIDTH 4 +#define PHYTMAC_TS_SEC_MASK 0x3f +#define PHYTMAC_TS_SEC_TOP 0x40 + +#define HW_DMA_CAP_64B 0x1 +#define HW_DMA_CAP_CSUM 0x2 +#define HW_DMA_CAP_PTP 0x4 +#define HW_DMA_CAP_DDW64 0x8 +#define HW_DMA_CAP_DDW128 0x10 + +#define PHYTMAC_DBW64 2 +#define PHYTMAC_DBW128 4 + +enum phytmac_msg_cmd_id { + PHYTMAC_MSG_CMD_DEFAULT = 0, + PHYTMAC_MSG_CMD_SET, + PHYTMAC_MSG_CMD_GET, + PHYTMAC_MSG_CMD_DATA, + PHYTMAC_MSG_CMD_REPORT, +}; + +enum phytmac_default_subid { + PHYTMAC_MSG_CMD_DEFAULT_RESET_HW = 0, + PHYTMAC_MSG_CMD_DEFAULT_RESET_TX_QUEUE, + PHYTMAC_MSG_CMD_DEFAULT_RESET_RX_QUEUE, +}; + +enum phytmac_set_subid { + PHYTMAC_MSG_CMD_SET_INIT_ALL = 0, + PHYTMAC_MSG_CMD_SET_INIT_RING = 1, + PHYTMAC_MSG_CMD_SET_INIT_TX_RING = 2, + PHYTMAC_MSG_CMD_SET_INIT_RX_RING = 3, + PHYTMAC_MSG_CMD_SET_MAC_CONFIG = 4, + PHYTMAC_MSG_CMD_SET_ADDR = 5, + PHYTMAC_MSG_CMD_SET_DMA_RX_BUFSIZE = 6, + PHYTMAC_MSG_CMD_SET_DMA = 7, + PHYTMAC_MSG_CMD_SET_CAPS = 8, + PHYTMAC_MSG_CMD_SET_TS_CONFIG = 9, + PHYTMAC_MSG_CMD_SET_INIT_TX_ENABLE_TRANSMIT = 10, + PHYTMAC_MSG_CMD_SET_INIT_RX_ENABLE_RECEIVE = 11, + PHYTMAC_MSG_CMD_SET_ENABLE_NETWORK = 12, + PHYTMAC_MSG_CMD_SET_DISABLE_NETWORK = 13, + PHYTMAC_MSG_CMD_SET_ENABLE_MDIO = 14, + PHYTMAC_MSG_CMD_SET_DISABLE_MDIO = 15, + PHYTMAC_MSG_CMD_SET_ENABLE_TXCSUM = 16, + PHYTMAC_MSG_CMD_SET_DISABLE_TXCSUM = 17, + PHYTMAC_MSG_CMD_SET_ENABLE_RXCSUM = 18, + PHYTMAC_MSG_CMD_SET_DISABLE_RXCSUM = 19, + PHYTMAC_MSG_CMD_SET_ENABLE_PROMISE = 20, + PHYTMAC_MSG_CMD_SET_DISABLE_PROMISE = 21, + PHYTMAC_MSG_CMD_SET_ENABLE_MC = 22, + PHYTMAC_MSG_CMD_SET_DISABLE_MC = 23, + PHYTMAC_MSG_CMD_SET_ENABLE_HASH_MC = 24, + PHYTMAC_MSG_CMD_SET_ENABLE_PAUSE = 25, + PHYTMAC_MSG_CMD_SET_DISABLE_PAUSE = 26, + PHYTMAC_MSG_CMD_SET_ENABLE_JUMBO = 27, + PHYTMAC_MSG_CMD_SET_DISABLE_JUMBO = 28, + PHYTMAC_MSG_CMD_SET_ENABLE_1536_FRAMES = 29, + PHYTMAC_MSG_CMD_SET_ENABLE_STRIPCRC = 30, + PHYTMAC_MSG_CMD_SET_DISABLE_STRIPCRC = 31, + PHYTMAC_MSG_CMD_SET_PCS_LINK_UP = 32, + PHYTMAC_MSG_CMD_SET_PCS_LINK_DOWN = 33, + PHYTMAC_MSG_CMD_SET_MAC_LINK_CONFIG = 34, + PHYTMAC_MSG_CMD_SET_REG_WRITE = 35, + PHYTMAC_MSG_CMD_SET_ENABLE_BC = 36, + PHYTMAC_MSG_CMD_SET_DISABLE_BC = 37, + PHYTMAC_MSG_CMD_SET_ETH_MATCH = 38, + PHYTMAC_MSG_CMD_SET_ADD_FDIR = 39, + PHYTMAC_MSG_CMD_SET_DEL_FDIR = 40, + PHYTMAC_MSG_CMD_SET_ENABLE_AUTONEG = 41, + PHYTMAC_MSG_CMD_SET_DISABLE_AUTONEG = 42, + PHYTMAC_MSG_CMD_SET_RX_DATA_OFFSET = 43, + PHYTMAC_MSG_CMD_SET_WOL = 44, +}; + +enum phytmac_get_subid { + PHYTMAC_MSG_CMD_GET_ADDR, + PHYTMAC_MSG_CMD_GET_QUEUENUMS, + PHYTMAC_MSG_CMD_GET_CAPS, + PHYTMAC_MSG_CMD_GET_BD_PREFETCH, + PHYTMAC_MSG_CMD_GET_STATS, + PHYTMAC_MSG_CMD_GET_REG_READ, +}; + +struct phytmac_interface_info { + u8 interface; + u8 autoneg; + u16 duplex; + u32 speed; +} __packed; + +struct phytmac_mc_info { + u32 mc_bottom; + u32 mc_top; +} __packed; + +struct phytmac_fdir_info { + u32 ip4src; + u32 ip4dst; + u16 srcport; + u16 srcport_mask; + u16 dstport; + u16 dstport_mask; + u8 location; + u8 queue; + u8 ipsrc_en; + u8 ipdst_en; + u8 port_en; +} __packed; + +struct phytmac_ts_config { + u8 tx_mode; + u8 rx_mode; + u8 one_step; +} __packed; + +struct phytmac_ring_info { + u64 addr[4]; + u8 queue_num; + u8 hw_dma_cap; +} __packed; + +struct phytmac_rxbuf_info { + u8 queue_num; + u8 buffer_size; +} __packed; + +struct phytmac_dma_info { + u16 dma_burst_length; + u8 hw_dma_cap; +} __packed; + +struct phytmac_eth_info { + u16 index; + u16 etype; +} __packed; + +struct phytmac_mac { + u32 addrl; + u16 addrh; +} __packed; + +struct phytmac_feature { + u8 irq_read_clear; + u8 dma_data_width; + u8 dma_addr_width; + u8 tx_pkt_buffer; + u8 rx_pkt_buffer; + u8 pbuf_lso; + u8 queue_num; + u8 tx_bd_prefetch; + u8 rx_bd_prefetch; + u8 max_rx_fs; +} __packed; + +struct phytmac_msg_info { + u16 module_id; + u16 cmd_id; + u16 cmd_subid; + u16 flags; + u8 para[64]; +} __packed; + +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/of/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/of/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..5c3c14711954a8bb376cd8bb222c1e628f95886c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/of/Kconfig @@ -0,0 +1,10 @@ +config OF_DMA_DEFAULT_COHERENT + # arches should select this if DMA is coherent by default for OF devices + bool + +config OF_CONFIGFS + bool "Device Tree Overlay ConfigFS interface" + select CONFIGFS_FS + select OF_OVERLAY + help + Enable a simple user-space driven DT overlay interface. diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/of/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/of/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..097ed2887e20e29495954aab4eaae7546ca0261f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/of/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_OF_CONFIGFS) += configfs.o \ No newline at end of file diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/of/configfs.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/of/configfs.c new file mode 100644 index 0000000000000000000000000000000000000000..1c30f35c3ca198cac2f8b5ae8027f542fd378c8f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/of/configfs.c @@ -0,0 +1,277 @@ +/* + * Configfs entries for device-tree + * + * Copyright (C) 2013 - Pantelis Antoniou + * + * 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 +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "of_private.h" + +struct cfs_overlay_item { + struct config_item item; + + char path[PATH_MAX]; + + const struct firmware *fw; + struct device_node *overlay; + int ov_id; + + void *dtbo; + int dtbo_size; +}; + +static inline struct cfs_overlay_item *to_cfs_overlay_item( + struct config_item *item) +{ + return item ? container_of(item, struct cfs_overlay_item, item) : NULL; +} + +static ssize_t cfs_overlay_item_path_show(struct config_item *item, + char *page) +{ + struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); + return sprintf(page, "%s\n", overlay->path); +} + +static ssize_t cfs_overlay_item_path_store(struct config_item *item, + const char *page, size_t count) +{ + struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); + const char *p = page; + char *s; + int err; + + /* if it's set do not allow changes */ + if (overlay->path[0] != '\0' || overlay->dtbo_size > 0) + return -EPERM; + + /* copy to path buffer (and make sure it's always zero terminated */ + count = snprintf(overlay->path, sizeof(overlay->path) - 1, "%s", p); + overlay->path[sizeof(overlay->path) - 1] = '\0'; + + /* strip trailing newlines */ + s = overlay->path + strlen(overlay->path); + while (s > overlay->path && *--s == '\n') + *s = '\0'; + + pr_debug("%s: path is '%s'\n", __func__, overlay->path); + + err = request_firmware(&overlay->fw, overlay->path, NULL); + if (err != 0) + goto out_err; + + err = of_overlay_fdt_apply((void *)overlay->fw->data, + (u32)overlay->fw->size, &overlay->ov_id, NULL); + if (err != 0) + goto out_err; + + return count; + +out_err: + + release_firmware(overlay->fw); + overlay->fw = NULL; + + overlay->path[0] = '\0'; + return err; +} + +static ssize_t cfs_overlay_item_status_show(struct config_item *item, + char *page) +{ + struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); + + return sprintf(page, "%s\n", + overlay->ov_id > 0 ? "applied" : "unapplied"); +} + +CONFIGFS_ATTR(cfs_overlay_item_, path); +CONFIGFS_ATTR_RO(cfs_overlay_item_, status); + +static struct configfs_attribute *cfs_overlay_attrs[] = { + &cfs_overlay_item_attr_path, + &cfs_overlay_item_attr_status, + NULL, +}; + +ssize_t cfs_overlay_item_dtbo_read(struct config_item *item, + void *buf, size_t max_count) +{ + struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); + + pr_debug("%s: buf=%p max_count=%zu\n", __func__, + buf, max_count); + + if (overlay->dtbo == NULL) + return 0; + + /* copy if buffer provided */ + if (buf != NULL) { + /* the buffer must be large enough */ + if (overlay->dtbo_size > max_count) + return -ENOSPC; + + memcpy(buf, overlay->dtbo, overlay->dtbo_size); + } + + return overlay->dtbo_size; +} + +ssize_t cfs_overlay_item_dtbo_write(struct config_item *item, + const void *buf, size_t count) +{ + struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); + int err; + + /* if it's set do not allow changes */ + if (overlay->path[0] != '\0' || overlay->dtbo_size > 0) + return -EPERM; + + /* copy the contents */ + overlay->dtbo = kmemdup(buf, count, GFP_KERNEL); + if (overlay->dtbo == NULL) + return -ENOMEM; + + overlay->dtbo_size = count; + + err = of_overlay_fdt_apply(overlay->dtbo, overlay->dtbo_size, + &overlay->ov_id, NULL); + if (err != 0) + goto out_err; + + return count; + +out_err: + kfree(overlay->dtbo); + overlay->dtbo = NULL; + overlay->dtbo_size = 0; + overlay->ov_id = 0; + + return err; +} + +CONFIGFS_BIN_ATTR(cfs_overlay_item_, dtbo, NULL, SZ_1M); + +static struct configfs_bin_attribute *cfs_overlay_bin_attrs[] = { + &cfs_overlay_item_attr_dtbo, + NULL, +}; + +static void cfs_overlay_release(struct config_item *item) +{ + struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); + + if (overlay->ov_id > 0) + of_overlay_remove(&overlay->ov_id); + if (overlay->fw) + release_firmware(overlay->fw); + /* kfree with NULL is safe */ + kfree(overlay->dtbo); + kfree(overlay); +} + +static struct configfs_item_operations cfs_overlay_item_ops = { + .release = cfs_overlay_release, +}; + +static struct config_item_type cfs_overlay_type = { + .ct_item_ops = &cfs_overlay_item_ops, + .ct_attrs = cfs_overlay_attrs, + .ct_bin_attrs = cfs_overlay_bin_attrs, + .ct_owner = THIS_MODULE, +}; + +static struct config_item *cfs_overlay_group_make_item( + struct config_group *group, const char *name) +{ + struct cfs_overlay_item *overlay; + + overlay = kzalloc(sizeof(*overlay), GFP_KERNEL); + if (!overlay) + return ERR_PTR(-ENOMEM); + + config_item_init_type_name(&overlay->item, name, &cfs_overlay_type); + return &overlay->item; +} + +static void cfs_overlay_group_drop_item(struct config_group *group, + struct config_item *item) +{ + struct cfs_overlay_item *overlay = to_cfs_overlay_item(item); + + config_item_put(&overlay->item); +} + +static struct configfs_group_operations overlays_ops = { + .make_item = cfs_overlay_group_make_item, + .drop_item = cfs_overlay_group_drop_item, +}; + +static struct config_item_type overlays_type = { + .ct_group_ops = &overlays_ops, + .ct_owner = THIS_MODULE, +}; + +static struct configfs_group_operations of_cfs_ops = { + /* empty - we don't allow anything to be created */ +}; + +static struct config_item_type of_cfs_type = { + .ct_group_ops = &of_cfs_ops, + .ct_owner = THIS_MODULE, +}; + +struct config_group of_cfs_overlay_group; + +static struct configfs_subsystem of_cfs_subsys = { + .su_group = { + .cg_item = { + .ci_namebuf = "device-tree", + .ci_type = &of_cfs_type, + }, + }, + .su_mutex = __MUTEX_INITIALIZER(of_cfs_subsys.su_mutex), +}; + +static int __init of_cfs_init(void) +{ + int ret; + + pr_info("%s\n", __func__); + + config_group_init(&of_cfs_subsys.su_group); + config_group_init_type_name(&of_cfs_overlay_group, "overlays", + &overlays_type); + configfs_add_default_group(&of_cfs_overlay_group, + &of_cfs_subsys.su_group); + + ret = configfs_register_subsystem(&of_cfs_subsys); + if (ret != 0) { + pr_err("%s: failed to register subsys\n", __func__); + goto out; + } + pr_info("%s: OK\n", __func__); +out: + return ret; +} +late_initcall(of_cfs_init); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..aa7dacaa7d5baf54251eee576d2da9e92d548617 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/Kconfig @@ -0,0 +1,9 @@ +config PCIE_PHYTIUM_EP + tristate "Phytium PCIe endpoint controller" + depends on OF + depends on PCI_ENDPOINT + help + Say Y here if you want to support Phytium PCIe controller in + endpoint mode on Phytium SoC. The controller can act as Root Port + or End Point with different phytium firmware. But End Point mode only support + one physical function. diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..13a7e2d96d88727d843a438d2b67087718c61932 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_PCIE_PHYTIUM_EP) += pcie-phytium-ep.o \ No newline at end of file diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/pcie-phytium-ep.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/pcie-phytium-ep.c new file mode 100644 index 0000000000000000000000000000000000000000..e25c7cdfb4e49144bd453c99b514f69a504bd81a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/pcie-phytium-ep.c @@ -0,0 +1,469 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium PCIe Endpoint controller driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "pcie-phytium-ep.h" +#include "pcie-phytium-register.h" + +#define PHYTIUM_PCIE_EP_IRQ_PCI_ADDR_NONE 0x0 +#define PHYTIUM_PCIE_EP_IRQ_PCI_ADDR_LEGACY 0x1 + +static int phytium_pcie_ep_write_header(struct pci_epc *epc, unsigned char fn, u8 vfn, + struct pci_epf_header *hdr) +{ + struct phytium_pcie_ep *priv = epc_get_drvdata(epc); + u16 tmp = 0; + + phytium_pcie_writew(priv, fn, PHYTIUM_PCI_VENDOR_ID, hdr->vendorid); + phytium_pcie_writew(priv, fn, PHYTIUM_PCI_DEVICE_ID, hdr->deviceid); + phytium_pcie_writeb(priv, fn, PHYTIUM_PCI_REVISION_ID, hdr->revid); + phytium_pcie_writeb(priv, fn, PHYTIUM_PCI_CLASS_PROG, hdr->progif_code); + phytium_pcie_writew(priv, fn, PHYTIUM_PCI_CLASS_DEVICE, + hdr->subclass_code | (hdr->baseclass_code << 8)); + + phytium_pcie_writew(priv, fn, PHYTIUM_PCI_SUBSYS_VENDOR_ID, + hdr->subsys_vendor_id); + phytium_pcie_writew(priv, fn, PHYTIUM_PCI_SUBSYS_DEVICE_ID, + hdr->subsys_id); + + tmp = phytium_pcie_readw(priv, fn, PHYTIUM_PCI_INTERRUPT_PIN); + tmp = ((tmp & (~INTERRUPT_PIN_MASK)) | hdr->interrupt_pin); + phytium_pcie_writew(priv, fn, PHYTIUM_PCI_INTERRUPT_PIN, tmp); + + tmp = phytium_pcie_readw(priv, fn, PHYTIUM_PCI_MSIX_CAP); + phytium_pcie_writew(priv, fn, PHYTIUM_PCI_MSIX_CAP, MSIX_DISABLE); + + return 0; +} + +static int phytium_pcie_ep_set_bar(struct pci_epc *epc, u8 fn, u8 vfn, + struct pci_epf_bar *epf_bar) +{ + struct phytium_pcie_ep *priv = epc_get_drvdata(epc); + u64 sz = 0, sz_mask, atr_size; + int flags = epf_bar->flags; + u32 setting, src_addr0, src_addr1, trsl_addr0, trsl_addr1, trsl_param; + enum pci_barno barno = epf_bar->barno; + struct pci_epc_mem *mem = epc->mem; + + if ((flags & PCI_BASE_ADDRESS_MEM_TYPE_64) && (barno & 1)) { + dev_err(&epc->dev, "bar %d do not support mem64\n", barno); + return -EINVAL; + } + + if (barno & 1) { + dev_err(&epc->dev, "not support bar 1/3/5\n"); + return -EINVAL; + } + dev_dbg(epc->dev.parent, "set bar%d mapping address 0x%pa size 0x%lx\n", + barno, &(epf_bar->phys_addr), epf_bar->size); + + if ((flags & PCI_BASE_ADDRESS_SPACE) == PCI_BASE_ADDRESS_SPACE_IO) { + setting = BAR_IO_TYPE; + sz = max_t(size_t, epf_bar->size, BAR_IO_MIN_APERTURE); + sz = 1 << fls64(sz - 1); + sz_mask = ~(sz - 1); + setting |= sz_mask; + trsl_param = TRSL_ID_IO; + } else { + setting = BAR_MEM_TYPE; + sz = max_t(size_t, epf_bar->size, BAR_MEM_MIN_APERTURE); + sz = 1 << fls64(sz - 1); + sz_mask = ~(sz - 1); + setting |= lower_32_bits(sz_mask); + + if (flags & PCI_BASE_ADDRESS_MEM_TYPE_64) + setting |= BAR_MEM_64BIT; + + if (flags & PCI_BASE_ADDRESS_MEM_PREFETCH) + setting |= BAR_MEM_PREFETCHABLE; + + trsl_param = TRSL_ID_MASTER; + } + + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_BAR(barno), setting); + if (flags & PCI_BASE_ADDRESS_MEM_TYPE_64) + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_BAR(barno + 1), + upper_32_bits(sz_mask)); + dev_dbg(epc->dev.parent, "set bar%d mapping address 0x%pa size 0x%llx 0x%x\n", + barno, &(epf_bar->phys_addr), sz, lower_32_bits(epf_bar->phys_addr)); + sz = ALIGN(sz, mem->window.page_size); + atr_size = fls64(sz - 1) - 1; + src_addr0 = ATR_IMPL | ((atr_size & ATR_SIZE_MASK) << ATR_SIZE_SHIFT); + src_addr1 = 0; + trsl_addr0 = (lower_32_bits(epf_bar->phys_addr) & TRSL_ADDR_32_12_MASK); + trsl_addr1 = upper_32_bits(epf_bar->phys_addr); + + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_SRC_ADDR0(barno), + src_addr0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_SRC_ADDR1(barno), + src_addr1); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_ADDR0(barno), + trsl_addr0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_ADDR1(barno), + trsl_addr1); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_PARAM(barno), + trsl_param); + + return 0; +} + +static void phytium_pcie_ep_clear_bar(struct pci_epc *epc, u8 fn, u8 vfn, + struct pci_epf_bar *epf_bar) +{ + struct phytium_pcie_ep *priv = epc_get_drvdata(epc); + int flags = epf_bar->flags; + enum pci_barno barno = epf_bar->barno; + + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_BAR(barno), 0); + if (flags & PCI_BASE_ADDRESS_MEM_TYPE_64) + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_BAR(barno + 1), 0); + + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_SRC_ADDR0(barno), 0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_SRC_ADDR1(barno), 0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_ADDR0(barno), 0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_ADDR1(barno), 0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_WIN0_TRSL_PARAM(barno), 0); +} + +static int phytium_pcie_ep_map_addr(struct pci_epc *epc, u8 fn, u8 vfn, + phys_addr_t addr, u64 pci_addr, + size_t size) +{ + struct phytium_pcie_ep *priv = epc_get_drvdata(epc); + u32 src_addr0, src_addr1, trsl_addr0, trsl_addr1, trsl_param, atr_size; + u64 sz = 0; + u32 r; + struct pci_epc_mem *mem = epc->mem; + + r = find_first_zero_bit(&priv->ob_region_map, BITS_PER_LONG); + if (r >= priv->max_regions) { + dev_err(&epc->dev, "no free outbound region\n"); + return -EINVAL; + } + + dev_dbg(epc->dev.parent, "set slave %d: mapping address 0x%pa to pci 0x%llx, size 0x%zx\n", + r, &addr, pci_addr, size); + + sz = ALIGN(size, mem->window.page_size); + atr_size = fls64(sz - 1) - 1; + src_addr0 = ATR_IMPL | ((atr_size & ATR_SIZE_MASK) << ATR_SIZE_SHIFT); + src_addr0 |= (lower_32_bits(addr) & SRC_ADDR_32_12_MASK); + src_addr1 = upper_32_bits(addr); + trsl_addr0 = (lower_32_bits(pci_addr) & TRSL_ADDR_32_12_MASK); + trsl_addr1 = upper_32_bits(pci_addr); + trsl_param = TRSL_ID_PCIE_TR; + + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR0(r), + src_addr0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR1(r), + src_addr1); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR0(r), + trsl_addr0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR1(r), + trsl_addr1); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_PARAM(r), + trsl_param); + set_bit(r, &priv->ob_region_map); + priv->ob_addr[r] = addr; + + return 0; +} + +static void phytium_pcie_ep_unmap_addr(struct pci_epc *epc, u8 fn, u8 vfn, + phys_addr_t addr) +{ + struct phytium_pcie_ep *priv = epc_get_drvdata(epc); + u32 r; + + for (r = 0; r < priv->max_regions; r++) + if (priv->ob_addr[r] == addr) + break; + + if (r == priv->max_regions) { + dev_err(&epc->dev, "used unmap addr 0x%pa\n", &addr); + return; + } + dev_dbg(epc->dev.parent, "set slave %d: unmapping address 0x%pa\n", r, &addr); + + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR0(r), 0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR1(r), 0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR0(r), 0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR1(r), 0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_PARAM(r), 0); + priv->ob_addr[r] = 0; + clear_bit(r, &priv->ob_region_map); +} + +static int phytium_pcie_ep_set_msi(struct pci_epc *epc, u8 fn, u8 vfn, u8 mmc) +{ + struct phytium_pcie_ep *priv = epc_get_drvdata(epc); + u16 flags = 0; + + flags = (mmc & MSI_NUM_MASK) << MSI_NUM_SHIFT; + flags &= ~MSI_MASK_SUPPORT; + phytium_pcie_writew(priv, fn, PHYTIUM_PCI_INTERRUPT_PIN, flags); + + return 0; +} + +static int phytium_pcie_ep_get_msi(struct pci_epc *epc, u8 fn, u8 vfn) +{ + struct phytium_pcie_ep *priv = epc_get_drvdata(epc); + u16 flags, mme; + u32 cap = PHYTIUM_PCI_CF_MSI_BASE; + + flags = phytium_pcie_readw(priv, fn, cap + PCI_MSI_FLAGS); + if (!(flags & PCI_MSI_FLAGS_ENABLE)) + return -EINVAL; + + mme = (flags & PCI_MSI_FLAGS_QSIZE) >> 4; + + return mme; +} + +static int phytium_pcie_ep_send_msi_irq(struct phytium_pcie_ep *priv, u8 fn, + u8 interrupt_num) +{ + u32 cap = PHYTIUM_PCI_CF_MSI_BASE; + u16 flags, mme, data_mask, data; + u8 msi_count; + u64 pci_addr, pci_addr_mask = IRQ_MAPPING_SIZE - 1; + u32 src_addr0, src_addr1, trsl_addr0, trsl_addr1, trsl_param, atr_size; + + flags = phytium_pcie_readw(priv, fn, cap + PCI_MSI_FLAGS); + if (!(flags & PCI_MSI_FLAGS_ENABLE)) + return -EINVAL; + + mme = (flags & PCI_MSI_FLAGS_QSIZE) >> 4; + msi_count = 1 << mme; + if (!interrupt_num || interrupt_num > msi_count) + return -EINVAL; + + data_mask = msi_count - 1; + data = phytium_pcie_readw(priv, fn, cap + PCI_MSI_DATA_64); + data = (data & ~data_mask) | ((interrupt_num - 1) & data_mask); + + /* Get the PCI address */ + pci_addr = phytium_pcie_readl(priv, fn, cap + PCI_MSI_ADDRESS_HI); + pci_addr <<= 32; + pci_addr |= phytium_pcie_readl(priv, fn, cap + PCI_MSI_ADDRESS_LO); + pci_addr &= GENMASK_ULL(63, 2); + + if (priv->irq_pci_addr != (pci_addr & ~pci_addr_mask) || (priv->irq_pci_fn != fn)) { + /* First region for IRQ writes. */ + atr_size = fls64(pci_addr_mask) - 1; + src_addr0 = ATR_IMPL | ((atr_size & ATR_SIZE_MASK) << ATR_SIZE_SHIFT); + src_addr0 |= (lower_32_bits(priv->irq_phys_addr) & SRC_ADDR_32_12_MASK); + src_addr1 = upper_32_bits(priv->irq_phys_addr); + trsl_addr0 = (lower_32_bits(pci_addr) & TRSL_ADDR_32_12_MASK); + trsl_addr1 = upper_32_bits(pci_addr); + trsl_param = TRSL_ID_PCIE_TR; + + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR0(0), + src_addr0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_SRC_ADDR1(0), + src_addr1); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR0(0), + trsl_addr0); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_ADDR1(0), + trsl_addr1); + phytium_pcie_writel(priv, fn, PHYTIUM_PCI_SLAVE0_TRSL_PARAM(0), + trsl_param); + priv->irq_pci_addr = (pci_addr & ~pci_addr_mask); + priv->irq_pci_fn = fn; + } + + dev_dbg(priv->epc->dev.parent, "send event %d\n", data); + writew(data, priv->irq_cpu_addr + (pci_addr & pci_addr_mask)); + + return 0; +} + +static int phytium_pcie_ep_raise_irq(struct pci_epc *epc, u8 fn, u8 vfn, + enum pci_epc_irq_type type, + u16 interrupt_num) +{ + struct phytium_pcie_ep *priv = epc_get_drvdata(epc); + + switch (type) { + case PCI_EPC_IRQ_MSI: + return phytium_pcie_ep_send_msi_irq(priv, fn, interrupt_num); + + default: + break; + } + + return -EINVAL; +} + +static int phytium_pcie_ep_start(struct pci_epc *epc) +{ + struct pci_epf *epf; + u32 cfg; + + cfg = BIT(0); + list_for_each_entry(epf, &epc->pci_epf, list) + cfg |= BIT(epf->func_no); + + return 0; +} + +static const struct pci_epc_ops phytium_pcie_epc_ops = { + .write_header = phytium_pcie_ep_write_header, + .set_bar = phytium_pcie_ep_set_bar, + .clear_bar = phytium_pcie_ep_clear_bar, + .map_addr = phytium_pcie_ep_map_addr, + .unmap_addr = phytium_pcie_ep_unmap_addr, + .set_msi = phytium_pcie_ep_set_msi, + .get_msi = phytium_pcie_ep_get_msi, + .raise_irq = phytium_pcie_ep_raise_irq, + .start = phytium_pcie_ep_start, +}; + + + +static int phytium_pcie_ep_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct phytium_pcie_ep *priv = NULL; + struct resource *res; + struct device_node *np = dev->of_node; + struct pci_epc *epc; + int ret = 0, value; + + priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); + if (!priv) + return -ENOMEM; + + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "reg"); + priv->reg_base = devm_ioremap_resource(dev, res); + if (IS_ERR(priv->reg_base)) { + dev_err(dev, "missing \"reg\"\n"); + return PTR_ERR(priv->reg_base); + } + + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mem"); + if (!res) { + dev_err(dev, "missing \"mem\"\n"); + return -EINVAL; + } + priv->mem_res = res; + + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "hpb"); + priv->hpb_base = devm_ioremap_resource(dev, res); + if (IS_ERR(priv->hpb_base)) { + dev_err(dev, "missing \"hpb\"\n"); + return PTR_ERR(priv->hpb_base); + } + + ret = of_property_read_u32(np, "max-outbound-regions", &priv->max_regions); + if (ret < 0) { + dev_err(dev, "missing \"max-outbound-regions\"\n"); + return ret; + } + dev_info(dev, "%s max-outbound-regions %d\n", __func__, priv->max_regions); + + priv->ob_addr = devm_kcalloc(dev, priv->max_regions, + sizeof(*priv->ob_addr), GFP_KERNEL); + if (!priv->ob_addr) + return -ENOMEM; + + platform_set_drvdata(pdev, priv); + + epc = devm_pci_epc_create(dev, &phytium_pcie_epc_ops); + if (IS_ERR(epc)) { + dev_err(dev, "failed to create epc device\n"); + return PTR_ERR(epc); + } + + priv->epc = epc; + epc_set_drvdata(epc, priv); + + if (of_property_read_u8(np, "max-functions", &epc->max_functions) < 0) + epc->max_functions = 1; + dev_info(dev, "%s epc->max_functions %d\n", __func__, epc->max_functions); + + + ret = pci_epc_mem_init(epc, priv->mem_res->start, + resource_size(priv->mem_res), PAGE_SIZE); + if (ret < 0) { + dev_err(dev, "failed to initialize the memory space\n"); + return ret; + } + + priv->irq_cpu_addr = pci_epc_mem_alloc_addr(epc, &priv->irq_phys_addr, + SZ_4K); + if (!priv->irq_cpu_addr) { + dev_err(dev, "failed to reserve memory space for MSI\n"); + ret = -ENOMEM; + goto err_alloc_irq_mem; + } + priv->irq_pci_addr = PHYTIUM_PCIE_EP_IRQ_PCI_ADDR_NONE; + /* Reserve region 0 for IRQS */ + set_bit(0, &priv->ob_region_map); + + value = ((lower_32_bits(priv->mem_res->start) >> C0_PREF_VALUE_SHIFT) + & C0_PREF_BASE_MASK) << C0_PREF_BASE_SHIFT; + value |= (((lower_32_bits(priv->mem_res->end) >> C0_PREF_VALUE_SHIFT) + & C0_PREF_LIMIT_MASK) << C0_PREF_LIMIT_SHIFT); + phytium_hpb_writel(priv, PHYTIUM_HPB_C0_PREF_BASE_LIMIT, value); + + value = ((upper_32_bits(priv->mem_res->start) >> C0_PREF_UP32_VALUE_SHIFT) + & C0_PREF_BASE_UP32_MASK) << C0_PREF_BASE_UP32_SHIFT; + value |= (((upper_32_bits(priv->mem_res->end) >> C0_PREF_UP32_VALUE_SHIFT) + & C0_PREF_LIMIT_UP32_MASK) << C0_PREF_LIMIT_UP32_SHIFT); + phytium_hpb_writel(priv, PHYTIUM_HPB_C0_PREF_BASE_LIMIT_UP32, value); + + dev_dbg(dev, "exit %s successful\n", __func__); + return 0; + +err_alloc_irq_mem: + pci_epc_mem_exit(epc); + return ret; +} + +static int phytium_pcie_ep_remove(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct phytium_pcie_ep *priv = dev_get_drvdata(dev); + struct pci_epc *epc = priv->epc; + + pci_epc_mem_exit(epc); + + return 0; +} + +static const struct of_device_id phytium_pcie_ep_of_match[] = { + { .compatible = "phytium,pd2008-pcie-ep" }, + { }, +}; + +static struct platform_driver phytium_pcie_ep_driver = { + .driver = { + .name = "phytium-pcie-ep", + .of_match_table = phytium_pcie_ep_of_match, + }, + .probe = phytium_pcie_ep_probe, + .remove = phytium_pcie_ep_remove, +}; + +module_platform_driver(phytium_pcie_ep_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Yang Xun "); +MODULE_DESCRIPTION("Phytium PCIe Controller Endpoint driver"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/pcie-phytium-ep.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/pcie-phytium-ep.h new file mode 100644 index 0000000000000000000000000000000000000000..10cece4fc542282885c6c9de61522dd8aff9d3d1 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/pcie-phytium-ep.h @@ -0,0 +1,88 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium endpoint driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PCIE_PHYTIUM_EP_H__ +#define __PCIE_PHYTIUM_EP_H__ + +#include "pcie-phytium-register.h" + +#define IRQ_MAPPING_SIZE 0x1000 +struct phytium_pcie_ep { + void __iomem *reg_base; + struct resource *mem_res; + void __iomem *hpb_base; + unsigned int max_regions; + unsigned long ob_region_map; + phys_addr_t *ob_addr; + phys_addr_t irq_phys_addr; + void __iomem *irq_cpu_addr; + unsigned long irq_pci_addr; + u8 irq_pci_fn; + struct pci_epc *epc; +}; + +static inline void +phytium_pcie_writeb(struct phytium_pcie_ep *priv, u8 fn, u32 reg, u8 value) +{ + pr_debug("Write 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); + writeb(value, priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); +} + +static inline unsigned char +phytium_pcie_readb(struct phytium_pcie_ep *priv, u8 fn, u32 reg) +{ + unsigned char value; + + value = readb(priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); + pr_debug("Read 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); + + return value; +} + +static inline void +phytium_pcie_writew(struct phytium_pcie_ep *priv, u8 fn, u32 reg, u16 value) +{ + pr_debug("Write 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); + writew(value, priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); +} + +static inline unsigned short +phytium_pcie_readw(struct phytium_pcie_ep *priv, u8 fn, u32 reg) +{ + unsigned short value; + + value = readw(priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); + pr_debug("Read 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); + + return value; +} + +static inline void +phytium_pcie_writel(struct phytium_pcie_ep *priv, u8 fn, u32 reg, u32 value) +{ + pr_debug("Write 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); + writel(value, priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); +} + +static inline unsigned int +phytium_pcie_readl(struct phytium_pcie_ep *priv, u8 fn, u32 reg) +{ + unsigned int value; + + value = readl(priv->reg_base + PHYTIUM_PCIE_FUNC_BASE(fn) + reg); + pr_debug("Read 32'h%08lx 32'h%08x\n", PHYTIUM_PCIE_FUNC_BASE(fn) + reg, value); + + return value; +} + +static inline void +phytium_hpb_writel(struct phytium_pcie_ep *priv, u32 reg, u32 value) +{ + pr_debug("Write 32'h%08x 32'h%08x\n", reg, value); + writel(value, priv->hpb_base + reg); +} +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/pcie-phytium-register.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/pcie-phytium-register.h new file mode 100644 index 0000000000000000000000000000000000000000..c2c477cad6118f09fc89488c8a7f5517226153ec --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/pci/controller/pcie-phytium-register.h @@ -0,0 +1,80 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium PCIe Ednpoint controllr driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PCIE_PHYTIUM_REGISTER_H__ +#define __PCIE_PHYTIUM_REGISTER_H__ + +#define PHYTIUM_PCIE_FUNC_BASE(fn) (((fn) << 14) & GENMASK(16, 14)) +#define PHYTIUM_PCI_VENDOR_ID 0x98 +#define PHYTIUM_PCI_DEVICE_ID 0x9a +#define PHYTIUM_PCI_REVISION_ID 0x9c +#define PHYTIUM_PCI_CLASS_PROG 0x9d +#define PHYTIUM_PCI_CLASS_DEVICE 0x9e +#define PHYTIUM_PCI_SUBSYS_VENDOR_ID 0xa0 +#define PHYTIUM_PCI_SUBSYS_DEVICE_ID 0xa2 +#define PHYTIUM_PCI_INTERRUPT_PIN 0xa8 +#define INTERRUPT_PIN_MASK 0x7 +#define MSI_DISABLE (1 << 3) +#define MSI_NUM_MASK (0x7) +#define MSI_NUM_SHIFT 4 +#define MSI_MASK_SUPPORT (1 << 7) +#define PHYTIUM_PCI_MSIX_CAP 0xaa + #define MSIX_DISABLE (0 << 15) + +#define PHYTIUM_PCI_BAR_0 0xe4 +#define PHYTIUM_PCI_BAR(bar_num) (0xe4 + bar_num * 4) +#define BAR_IO_TYPE (1 << 0) +#define BAR_MEM_TYPE (0 << 0) +#define BAR_MEM_64BIT (1 << 2) +#define BAR_MEM_PREFETCHABLE (1 << 3) +#define BAR_IO_MIN_APERTURE 4 +#define BAR_MEM_MIN_APERTURE 16 + + +#define PHYTIUM_PCI_WIN0_BASE 0x600 +#define PHYTIUM_PCI_WIN0_SRC_ADDR0(table) (PHYTIUM_PCI_WIN0_BASE + 0X20 * table + 0x0) +#define ATR_IMPL 0x1 +#define ATR_SIZE_MASK 0x3f +#define ATR_SIZE_SHIFT 1 +#define ATR_SIZE_ALIGN 0x1000 +#define SRC_ADDR_32_12_MASK 0xfffff000 + +#define PHYTIUM_PCI_WIN0_SRC_ADDR1(table) (PHYTIUM_PCI_WIN0_BASE + 0X20 * table + 0x4) +#define PHYTIUM_PCI_WIN0_TRSL_ADDR0(table) (PHYTIUM_PCI_WIN0_BASE + 0X20 * table + 0x8) +#define TRSL_ADDR_32_12_MASK 0xfffff000 + +#define PHYTIUM_PCI_WIN0_TRSL_ADDR1(table) (PHYTIUM_PCI_WIN0_BASE + 0X20 * table + 0xc) +#define PHYTIUM_PCI_WIN0_TRSL_PARAM(table) (PHYTIUM_PCI_WIN0_BASE + 0X20 * table + 0x10) +#define TRSL_ID_IO 0x1 +#define TRSL_ID_MASTER 0x4 +#define TRSL_ID_PCIE_TR 0x0 + +#define PHYTIUM_PCI_SLAVE0_BASE 0x800 +#define PHYTIUM_PCI_SLAVE0_SRC_ADDR0(table) (PHYTIUM_PCI_SLAVE0_BASE + 0X20 * table + 0x0) +#define PHYTIUM_PCI_SLAVE0_SRC_ADDR1(table) (PHYTIUM_PCI_SLAVE0_BASE + 0X20 * table + 0x4) +#define PHYTIUM_PCI_SLAVE0_TRSL_ADDR0(table) (PHYTIUM_PCI_SLAVE0_BASE + 0X20 * table + 0x8) +#define PHYTIUM_PCI_SLAVE0_TRSL_ADDR1(table) (PHYTIUM_PCI_SLAVE0_BASE + 0X20 * table + 0xc) +#define PHYTIUM_PCI_SLAVE0_TRSL_PARAM(table) (PHYTIUM_PCI_SLAVE0_BASE + 0X20 * table + 0x10) + +#define PHYTIUM_PCI_CF_MSI_BASE 0x10e0 +#define PHYTIUM_PCI_CF_MSI_CONTROL 0x10e2 + +#define PHYTIUM_HPB_C0_PREF_BASE_LIMIT 0xa30 + #define C0_PREF_LIMIT_MASK 0xfff + #define C0_PREF_LIMIT_SHIFT 20 + #define C0_PREF_BASE_MASK 0xfff + #define C0_PREF_BASE_SHIFT 4 + #define C0_PREF_VALUE_SHIFT 20 +#define PHYTIUM_HPB_C0_PREF_BASE_LIMIT_UP32 0xa34 + #define C0_PREF_LIMIT_UP32_MASK 0xff + #define C0_PREF_LIMIT_UP32_SHIFT 8 + #define C0_PREF_BASE_UP32_MASK 0xff + #define C0_PREF_BASE_UP32_SHIFT 0 + #define C0_PREF_UP32_VALUE_SHIFT 0 +#endif + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..e9dabba7227eb47e4cda5bf935d8868d1eb84a91 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/Kconfig @@ -0,0 +1,27 @@ +# SPDX-License-Identifier: GPL-2.0 +menuconfig PHYTIUM_PMU + bool "Phytium PMU support" + help + Say Y here if you want to support Phytium performance monitoring + unit (PMU) drivers. + +if PHYTIUM_PMU + +config PHYT_DDR_PMU + tristate "Phytium SoC DDR PMU driver" + depends on (ARCH_PHYTIUM && ACPI) || COMPILE_TEST + default m + help + Provides support for Phytium SoC DDR Controller performance + monitoring unit (PMU). + +config PHYT_PCIE_PMU + tristate "Phytium SoC PCIE PMU driver" + depends on (ARCH_PHYTIUM && ACPI) || COMPILE_TEST + default m + help + Provides support for Phytium SoC PCIe Controller performance + monitoring unit (PMU). + +endif + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..af37afc6920c57169c16c053eb3ceb70dff064d2 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/Makefile @@ -0,0 +1,4 @@ +# SPDX-License-Identifier: GPL-2.0 +# +obj-$(CONFIG_PHYT_DDR_PMU) += phytium_ddr_pmu.o +obj-$(CONFIG_PHYT_PCIE_PMU) += phytium_pcie_pmu.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/phytium_ddr_pmu.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/phytium_ddr_pmu.c new file mode 100644 index 0000000000000000000000000000000000000000..a31bf29c874b14df4032fc4eb05ab220267c3e66 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/phytium_ddr_pmu.c @@ -0,0 +1,753 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SoC DDR performance monitoring unit support + * + * Copyright (c) 2023, Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + +#undef pr_fmt +#define pr_fmt(fmt) "phytium_ddr_pmu: " fmt + +#define PHYTIUM_DDR_MAX_COUNTERS 8 + +#define DDR_START_TIMER 0x000 +#define DDR_STOP_TIMER 0x004 +#define DDR_CLEAR_EVENT 0x008 +#define DDR_SET_TIMER_L 0x00c +#define DDR_SET_TIMER_H 0x010 +#define DDR_TRIG_MODE 0x014 +#define DDR_NOW_STATE 0x0e0 +#define DDR_EVENT_CYCLES 0x0e4 +#define DDR_TPOINT_END_L 0x0e4 +#define DDR_TPOINT_END_H 0x0e8 +#define DDR_STATE_STOP 0x0ec +#define DDR_EVENT_RXREQ 0x100 +#define DDR_EVENT_RXDAT 0x104 +#define DDR_EVENT_TXDAT 0x108 +#define DDR_EVENT_RXREQ_RNS 0x10c +#define DDR_EVENT_RXREQ_WNSP 0x110 +#define DDR_EVENT_RXREQ_WNSF 0x114 +#define DDR_EVENT_BANDWIDTH 0x200 +#define DDR_W_DATA_BASE 0x200 +#define DDR_CLK_FRE 0xe00 +#define DDR_DATA_WIDTH 0xe04 + +#define to_phytium_ddr_pmu(p) (container_of(p, struct phytium_ddr_pmu, pmu)) + +static int phytium_ddr_pmu_hp_state; + +struct phytium_ddr_pmu_hwevents { + struct perf_event *hw_events[PHYTIUM_DDR_MAX_COUNTERS]; + DECLARE_BITMAP(used_mask, PHYTIUM_DDR_MAX_COUNTERS); +}; + +struct phytium_ddr_pmu { + struct device *dev; + void __iomem *base; + void __iomem *csr_base; + struct pmu pmu; + struct phytium_ddr_pmu_hwevents pmu_events; + u32 die_id; + u32 ddr_id; + u32 pmu_id; + int bit_idx; + int on_cpu; + int irq; + struct hlist_node node; +}; + +#define GET_DDR_EVENTID(hwc) (hwc->config_base & 0x7) +#define EVENT_VALID(idx) ((idx >= 0) && (idx < PHYTIUM_DDR_MAX_COUNTERS)) + +static const u32 ddr_counter_reg_offset[] = { + DDR_EVENT_CYCLES, DDR_EVENT_RXREQ, DDR_EVENT_RXDAT, + DDR_EVENT_TXDAT, DDR_EVENT_RXREQ_RNS, DDR_EVENT_RXREQ_WNSP, + DDR_EVENT_RXREQ_WNSF, DDR_EVENT_BANDWIDTH +}; + +ssize_t phytium_ddr_pmu_format_sysfs_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct dev_ext_attribute *eattr; + + eattr = container_of(attr, struct dev_ext_attribute, attr); + + return sprintf(buf, "%s\n", (char *)eattr->var); +} + +ssize_t phytium_ddr_pmu_event_sysfs_show(struct device *dev, + struct device_attribute *attr, + char *page) +{ + struct dev_ext_attribute *eattr; + + eattr = container_of(attr, struct dev_ext_attribute, attr); + + return sprintf(page, "config=0x%lx\n", (unsigned long)eattr->var); +} + +static ssize_t cpumask_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + struct phytium_ddr_pmu *ddr_pmu = + to_phytium_ddr_pmu(dev_get_drvdata(dev)); + + return cpumap_print_to_pagebuf(true, buf, cpumask_of(ddr_pmu->on_cpu)); +} + +#define PHYTIUM_PMU_ATTR(_name, _func, _config) \ + (&((struct dev_ext_attribute[]){ \ + { __ATTR(_name, 0444, _func, NULL), (void *)_config } })[0] \ + .attr.attr) + +#define PHYTIUM_DDR_PMU_FORMAT_ATTR(_name, _config) \ + PHYTIUM_PMU_ATTR(_name, phytium_ddr_pmu_format_sysfs_show, \ + (void *)_config) + +#define PHYTIUM_DDR_PMU_EVENT_ATTR(_name, _config) \ + PHYTIUM_PMU_ATTR(_name, phytium_ddr_pmu_event_sysfs_show, \ + (unsigned long)_config) + +static struct attribute *phytium_ddr_pmu_format_attr[] = { + PHYTIUM_DDR_PMU_FORMAT_ATTR(event, "config:0-2"), + PHYTIUM_DDR_PMU_FORMAT_ATTR(timer, "config1:0-31"), + NULL, +}; + +static const struct attribute_group phytium_ddr_pmu_format_group = { + .name = "format", + .attrs = phytium_ddr_pmu_format_attr, +}; + +static struct attribute *phytium_ddr_pmu_events_attr[] = { + PHYTIUM_DDR_PMU_EVENT_ATTR(cycles, 0x00), + PHYTIUM_DDR_PMU_EVENT_ATTR(rxreq, 0x01), + PHYTIUM_DDR_PMU_EVENT_ATTR(rxdat, 0x02), + PHYTIUM_DDR_PMU_EVENT_ATTR(txdat, 0x03), + PHYTIUM_DDR_PMU_EVENT_ATTR(rxreq_RNS, 0x04), + PHYTIUM_DDR_PMU_EVENT_ATTR(rxreq_WNSP, 0x05), + PHYTIUM_DDR_PMU_EVENT_ATTR(rxreq_WNSF, 0x06), + PHYTIUM_DDR_PMU_EVENT_ATTR(bandwidth, 0x07), + NULL, +}; + +static const struct attribute_group phytium_ddr_pmu_events_group = { + .name = "events", + .attrs = phytium_ddr_pmu_events_attr, +}; + +static DEVICE_ATTR_RO(cpumask); + +static struct attribute *phytium_ddr_pmu_cpumask_attrs[] = { + &dev_attr_cpumask.attr, + NULL, +}; + +static const struct attribute_group phytium_ddr_pmu_cpumask_attr_group = { + .attrs = phytium_ddr_pmu_cpumask_attrs, +}; + +static const struct attribute_group *phytium_ddr_pmu_attr_groups[] = { + &phytium_ddr_pmu_format_group, + &phytium_ddr_pmu_events_group, + &phytium_ddr_pmu_cpumask_attr_group, + NULL, +}; + +static u32 phytium_ddr_pmu_get_event_timer(struct perf_event *event) +{ + return FIELD_GET(GENMASK(31, 0), event->attr.config1); +} + +static u64 phytium_ddr_pmu_read_counter(struct phytium_ddr_pmu *ddr_pmu, + struct hw_perf_event *hwc) +{ + u32 idx = GET_DDR_EVENTID(hwc); + u32 cycle_l, cycle_h, w_data, ddr_data_width; + u64 val64 = 0; + int i; + u32 counter_offset = ddr_counter_reg_offset[idx]; + + if (!EVENT_VALID(idx)) { + dev_err(ddr_pmu->dev, "Unsupported event index:%d!\n", idx); + return 0; + } + + switch (idx) { + case 0: + cycle_l = readl(ddr_pmu->base + counter_offset); + cycle_h = readl(ddr_pmu->base + counter_offset + 4); + val64 = (u64)cycle_h << 32 | (u64)cycle_l; + break; + case 7: + ddr_data_width = readl(ddr_pmu->base + DDR_DATA_WIDTH); + for (i = 0; i < (ddr_data_width / 8); i++) { + w_data = readl(ddr_pmu->base + counter_offset + 4 * i); + val64 += w_data; + } + break; + default: + val64 = readl(ddr_pmu->base + counter_offset); + break; + } + + return val64; +} + +static void phytium_ddr_pmu_enable_clk(struct phytium_ddr_pmu *ddr_pmu) +{ + u32 val; + + val = readl(ddr_pmu->csr_base); + val |= 0xF; + writel(val, ddr_pmu->csr_base); +} + +static void phytium_ddr_pmu_disable_clk(struct phytium_ddr_pmu *ddr_pmu) +{ + u32 val; + + val = readl(ddr_pmu->csr_base); + val &= ~(0xF); + writel(val, ddr_pmu->csr_base); +} + +static void phytium_ddr_pmu_clear_all_counters(struct phytium_ddr_pmu *ddr_pmu) +{ + writel(0x1, ddr_pmu->base + DDR_CLEAR_EVENT); +} + +static void phytium_ddr_pmu_start_all_counters(struct phytium_ddr_pmu *ddr_pmu) +{ + writel(0x1, ddr_pmu->base + DDR_START_TIMER); +} + +static void phytium_ddr_pmu_stop_all_counters(struct phytium_ddr_pmu *ddr_pmu) +{ + writel(0x1, ddr_pmu->base + DDR_STOP_TIMER); +} + +static void phytium_ddr_pmu_set_timer(struct phytium_ddr_pmu *ddr_pmu, + u32 th_val) +{ + u32 val; + + val = readl(ddr_pmu->base + DDR_SET_TIMER_L); + val = readl(ddr_pmu->base + DDR_SET_TIMER_H); + + writel(th_val, ddr_pmu->base + DDR_SET_TIMER_L); + writel(0, ddr_pmu->base + DDR_SET_TIMER_H); +} + +static void phytium_ddr_pmu_reset_timer(struct phytium_ddr_pmu *ddr_pmu) +{ + u32 val; + + val = readl(ddr_pmu->base + DDR_SET_TIMER_L); + val = readl(ddr_pmu->base + DDR_SET_TIMER_H); + + writel(0xFFFFFFFF, ddr_pmu->base + DDR_SET_TIMER_L); + writel(0xFFFFFFFF, ddr_pmu->base + DDR_SET_TIMER_H); +} + +static unsigned long +phytium_ddr_pmu_get_stop_state(struct phytium_ddr_pmu *ddr_pmu) +{ + unsigned long val; + + val = (unsigned long)readl(ddr_pmu->base + DDR_STATE_STOP); + return val; +} + +static unsigned long +phytium_ddr_pmu_get_irq_flag(struct phytium_ddr_pmu *ddr_pmu) +{ + unsigned long val; + + val = (unsigned long)readl(ddr_pmu->csr_base + 4); + return val; +} + +static int phytium_ddr_pmu_mark_event(struct perf_event *event) +{ + struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(event->pmu); + unsigned long *used_mask = ddr_pmu->pmu_events.used_mask; + struct hw_perf_event *hwc = &event->hw; + + int idx = GET_DDR_EVENTID(hwc); + + if (test_bit(idx, used_mask)) + return -EAGAIN; + + set_bit(idx, used_mask); + + return idx; +} + +static void phytium_ddr_pmu_unmark_event(struct phytium_ddr_pmu *ddr_pmu, + int idx) +{ + if (!EVENT_VALID(idx)) { + dev_err(ddr_pmu->dev, "Unsupported event index:%d!\n", idx); + return; + } + + clear_bit(idx, ddr_pmu->pmu_events.used_mask); +} + +int phytium_ddr_pmu_event_init(struct perf_event *event) +{ + struct hw_perf_event *hwc = &event->hw; + struct phytium_ddr_pmu *ddr_pmu; + u32 event_timer; + + if (event->attr.type != event->pmu->type) + return -ENOENT; + + if (is_sampling_event(event) || event->attach_state & PERF_ATTACH_TASK) + return -EOPNOTSUPP; + + ddr_pmu = to_phytium_ddr_pmu(event->pmu); + + if (event->cpu < 0) { + dev_warn(ddr_pmu->dev, "Can't provide per-task data!\n"); + return -EINVAL; + } + + if (event->attr.config > PHYTIUM_DDR_MAX_COUNTERS) + return -EINVAL; + + if (ddr_pmu->on_cpu == -1) + return -EINVAL; + + event_timer = phytium_ddr_pmu_get_event_timer(event); + if (event_timer != 0) + phytium_ddr_pmu_set_timer(ddr_pmu, event_timer); + + hwc->idx = -1; + hwc->config_base = event->attr.config; + + event->cpu = ddr_pmu->on_cpu; + + return 0; +} + +void phytium_ddr_pmu_event_update(struct perf_event *event) +{ + struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(event->pmu); + struct hw_perf_event *hwc = &event->hw; + u64 delta; + + delta = phytium_ddr_pmu_read_counter(ddr_pmu, hwc); + local64_add(delta, &event->count); +} + +void phytium_ddr_pmu_event_start(struct perf_event *event, int flags) +{ + struct hw_perf_event *hwc = &event->hw; + + hwc->state = 0; + perf_event_update_userpage(event); +} + +void phytium_ddr_pmu_event_stop(struct perf_event *event, int flags) +{ + struct hw_perf_event *hwc = &event->hw; + + hwc->state |= PERF_HES_STOPPED; + + if (flags & PERF_EF_UPDATE) + phytium_ddr_pmu_event_update(event); +} + +int phytium_ddr_pmu_event_add(struct perf_event *event, int flags) +{ + struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(event->pmu); + struct hw_perf_event *hwc = &event->hw; + int idx; + + hwc->state |= PERF_HES_STOPPED; + + idx = phytium_ddr_pmu_mark_event(event); + if (idx < 0) + return idx; + + event->hw.idx = idx; + ddr_pmu->pmu_events.hw_events[idx] = event; + + return 0; +} + +void phytium_ddr_pmu_event_del(struct perf_event *event, int flags) +{ + struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(event->pmu); + struct hw_perf_event *hwc = &event->hw; + unsigned long val; + u32 event_timer; + + phytium_ddr_pmu_event_stop(event, PERF_EF_UPDATE); + val = phytium_ddr_pmu_get_irq_flag(ddr_pmu); + val = phytium_ddr_pmu_get_stop_state(ddr_pmu); + phytium_ddr_pmu_unmark_event(ddr_pmu, hwc->idx); + + event_timer = phytium_ddr_pmu_get_event_timer(event); + if (event_timer != 0) + phytium_ddr_pmu_reset_timer(ddr_pmu); + + perf_event_update_userpage(event); + ddr_pmu->pmu_events.hw_events[hwc->idx] = NULL; +} + +void phytium_ddr_pmu_enable(struct pmu *pmu) +{ + struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(pmu); + int event_added = bitmap_weight(ddr_pmu->pmu_events.used_mask, + PHYTIUM_DDR_MAX_COUNTERS); + + if (event_added) { + phytium_ddr_pmu_clear_all_counters(ddr_pmu); + phytium_ddr_pmu_start_all_counters(ddr_pmu); + } +} + +void phytium_ddr_pmu_disable(struct pmu *pmu) +{ + struct phytium_ddr_pmu *ddr_pmu = to_phytium_ddr_pmu(pmu); + int event_added = bitmap_weight(ddr_pmu->pmu_events.used_mask, + PHYTIUM_DDR_MAX_COUNTERS); + + if (event_added) + phytium_ddr_pmu_stop_all_counters(ddr_pmu); +} + +static const struct acpi_device_id phytium_ddr_pmu_acpi_match[] = { + { + "PHYT0043", + }, + {}, +}; +MODULE_DEVICE_TABLE(acpi, phytium_ddr_pmu_acpi_match); + +static irqreturn_t phytium_ddr_pmu_overflow_handler(int irq, void *dev_id) +{ + struct phytium_ddr_pmu *ddr_pmu = dev_id; + struct perf_event *event; + unsigned long overflown, stop_state; + int idx; + unsigned long *used_mask = ddr_pmu->pmu_events.used_mask; + + int event_added = bitmap_weight(used_mask, PHYTIUM_DDR_MAX_COUNTERS); + + overflown = phytium_ddr_pmu_get_irq_flag(ddr_pmu); + + if (!test_bit(ddr_pmu->bit_idx, &overflown)) + return IRQ_NONE; + + stop_state = phytium_ddr_pmu_get_stop_state(ddr_pmu); + + if (bitmap_weight(&stop_state, 6)) { + for_each_set_bit(idx, used_mask, PHYTIUM_DDR_MAX_COUNTERS) { + event = ddr_pmu->pmu_events.hw_events[idx]; + if (!event) + continue; + phytium_ddr_pmu_event_update(event); + } + phytium_ddr_pmu_clear_all_counters(ddr_pmu); + phytium_ddr_pmu_start_all_counters(ddr_pmu); + + return IRQ_HANDLED; + } + + if (!event_added) { + phytium_ddr_pmu_clear_all_counters(ddr_pmu); + return IRQ_HANDLED; + } + + return IRQ_NONE; +} + +static int phytium_ddr_pmu_init_irq(struct phytium_ddr_pmu *ddr_pmu, + struct platform_device *pdev) +{ + int irq, ret; + + irq = platform_get_irq(pdev, 0); + if (irq < 0) + return irq; + + ret = devm_request_irq(&pdev->dev, irq, + phytium_ddr_pmu_overflow_handler, + IRQF_NOBALANCING | IRQF_NO_THREAD | IRQF_SHARED, + dev_name(&pdev->dev), ddr_pmu); + if (ret < 0) { + dev_err(&pdev->dev, "Fail to request IRQ:%d ret:%d\n", irq, + ret); + return ret; + } + + ddr_pmu->irq = irq; + + return 0; +} + +static int phytium_ddr_pmu_init_data(struct platform_device *pdev, + struct phytium_ddr_pmu *ddr_pmu) +{ + struct resource *res, *clkres; + + if (device_property_read_u32(&pdev->dev, "phytium,die-id", + &ddr_pmu->die_id)) { + dev_err(&pdev->dev, "Can not read phytium,die-id!\n"); + return -EINVAL; + } + + if (device_property_read_u32(&pdev->dev, "phytium,ddr-id", + &ddr_pmu->ddr_id)) { + dev_err(&pdev->dev, "Can not read phytium,ddr-id!\n"); + return -EINVAL; + } + + if (device_property_read_u32(&pdev->dev, "phytium,pmu-id", + &ddr_pmu->pmu_id)) { + dev_err(&pdev->dev, "Can not read ddr pmu-id!\n"); + return -EINVAL; + } + + ddr_pmu->bit_idx = ddr_pmu->ddr_id * 2 + ddr_pmu->pmu_id; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + ddr_pmu->base = devm_ioremap_resource(&pdev->dev, res); + + if (IS_ERR(ddr_pmu->base)) { + dev_err(&pdev->dev, + "ioremap failed for ddr_pmu base resource\n"); + return PTR_ERR(ddr_pmu->base); + } + + clkres = platform_get_resource(pdev, IORESOURCE_MEM, 1); + if (!clkres) { + dev_err(&pdev->dev, "failed for get ddr_pmu clk resource.\n"); + return -EINVAL; + } + + ddr_pmu->csr_base = + devm_ioremap(&pdev->dev, clkres->start, resource_size(clkres)); + if (IS_ERR(ddr_pmu->csr_base)) { + dev_err(&pdev->dev, + "ioremap failed for ddr_pmu csr resource\n"); + return PTR_ERR(ddr_pmu->csr_base); + } + + return 0; +} + +static int phytium_ddr_pmu_dev_probe(struct platform_device *pdev, + struct phytium_ddr_pmu *ddr_pmu) +{ + int ret; + + ret = phytium_ddr_pmu_init_data(pdev, ddr_pmu); + if (ret) + return ret; + + ret = phytium_ddr_pmu_init_irq(ddr_pmu, pdev); + if (ret) + return ret; + + ddr_pmu->dev = &pdev->dev; + ddr_pmu->on_cpu = -1; + + return 0; +} + +static int phytium_ddr_pmu_probe(struct platform_device *pdev) +{ + struct phytium_ddr_pmu *ddr_pmu; + char *name; + int ret; + + ddr_pmu = devm_kzalloc(&pdev->dev, sizeof(*ddr_pmu), GFP_KERNEL); + if (!ddr_pmu) + return -ENOMEM; + + platform_set_drvdata(pdev, ddr_pmu); + + ret = phytium_ddr_pmu_dev_probe(pdev, ddr_pmu); + if (ret) + return ret; + + ret = cpuhp_state_add_instance( + phytium_ddr_pmu_hp_state, &ddr_pmu->node); + if (ret) { + dev_err(&pdev->dev, "Error %d registering hotplug;\n", ret); + return ret; + } + + name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "phyt%u_ddr%u_pmu%u", + ddr_pmu->die_id, ddr_pmu->ddr_id, + ddr_pmu->pmu_id); + ddr_pmu->pmu = (struct pmu){ + .name = name, + .module = THIS_MODULE, + .task_ctx_nr = perf_invalid_context, + .event_init = phytium_ddr_pmu_event_init, + .pmu_enable = phytium_ddr_pmu_enable, + .pmu_disable = phytium_ddr_pmu_disable, + .add = phytium_ddr_pmu_event_add, + .del = phytium_ddr_pmu_event_del, + .start = phytium_ddr_pmu_event_start, + .stop = phytium_ddr_pmu_event_stop, + .read = phytium_ddr_pmu_event_update, + .attr_groups = phytium_ddr_pmu_attr_groups, + .capabilities = PERF_PMU_CAP_NO_EXCLUDE, + }; + + ret = perf_pmu_register(&ddr_pmu->pmu, name, -1); + if (ret) { + dev_err(ddr_pmu->dev, "DDR PMU register failed!\n"); + cpuhp_state_remove_instance_nocalls( + phytium_ddr_pmu_hp_state, + &ddr_pmu->node); + } + + phytium_ddr_pmu_enable_clk(ddr_pmu); + + pr_info("Phytium DDR PMU: "); + pr_info(" die_id = %d ddr_id = %d pmu_id = %d.\n", ddr_pmu->die_id, + ddr_pmu->ddr_id, ddr_pmu->pmu_id); + + return ret; +} + +static int phytium_ddr_pmu_remove(struct platform_device *pdev) +{ + struct phytium_ddr_pmu *ddr_pmu = platform_get_drvdata(pdev); + + phytium_ddr_pmu_disable_clk(ddr_pmu); + + perf_pmu_unregister(&ddr_pmu->pmu); + cpuhp_state_remove_instance_nocalls( + phytium_ddr_pmu_hp_state, &ddr_pmu->node); + + return 0; +} + +static struct platform_driver phytium_ddr_pmu_driver = { + .driver = { + .name = "phytium_ddr_pmu", + .acpi_match_table = ACPI_PTR(phytium_ddr_pmu_acpi_match), + .suppress_bind_attrs = true, + }, + .probe = phytium_ddr_pmu_probe, + .remove = phytium_ddr_pmu_remove, +}; + +int phytium_ddr_pmu_online_cpu(unsigned int cpu, struct hlist_node *node) +{ + struct phytium_ddr_pmu *ddr_pmu = + hlist_entry_safe(node, struct phytium_ddr_pmu, node); + + if (!cpumask_test_cpu(cpu, cpumask_of_node(ddr_pmu->die_id))) + return 0; + + if (ddr_pmu->on_cpu != -1) { + if (!cpumask_test_cpu(ddr_pmu->on_cpu, cpumask_of_node(ddr_pmu->die_id))) { + perf_pmu_migrate_context(&ddr_pmu->pmu, ddr_pmu->on_cpu, cpu); + ddr_pmu->on_cpu = cpu; + WARN_ON(irq_set_affinity_hint(ddr_pmu->irq, cpumask_of(cpu))); + } + return 0; + } + + ddr_pmu->on_cpu = cpu; + WARN_ON(irq_set_affinity_hint(ddr_pmu->irq, cpumask_of(cpu))); + + return 0; +} + +int phytium_ddr_pmu_offline_cpu(unsigned int cpu, struct hlist_node *node) +{ + struct phytium_ddr_pmu *ddr_pmu = + hlist_entry_safe(node, struct phytium_ddr_pmu, node); + unsigned int target; + cpumask_t available_cpus; + + if (ddr_pmu->on_cpu != cpu) + return 0; + + if (cpumask_and(&available_cpus, cpumask_of_node(ddr_pmu->die_id), cpu_online_mask) && + cpumask_andnot(&available_cpus, &available_cpus, cpumask_of(cpu))) + target = cpumask_last(&available_cpus); + else { + cpumask_andnot(&available_cpus, cpu_online_mask, cpumask_of(cpu)); + target = cpumask_last(&available_cpus); + } + + if (target >= nr_cpu_ids) { + dev_err(ddr_pmu->dev, "offline cpu%d with no target to migrate.\n", + cpu); + return 0; + } + + perf_pmu_migrate_context(&ddr_pmu->pmu, cpu, target); + WARN_ON(irq_set_affinity_hint(ddr_pmu->irq, cpumask_of(target))); + ddr_pmu->on_cpu = target; + + return 0; +} + +static int __init phytium_ddr_pmu_module_init(void) +{ + int ret; + + phytium_ddr_pmu_hp_state = cpuhp_setup_state_multi(CPUHP_AP_ONLINE_DYN, + "perf/phytium/ddrpmu:online", + phytium_ddr_pmu_online_cpu, phytium_ddr_pmu_offline_cpu); + if (phytium_ddr_pmu_hp_state < 0) { + pr_err("DDR PMU: setup hotplug, phytium_ddr_pmu_hp_state = %d\n", + phytium_ddr_pmu_hp_state); + return phytium_ddr_pmu_hp_state; + } + + ret = platform_driver_register(&phytium_ddr_pmu_driver); + if (ret) + cpuhp_remove_multi_state( + phytium_ddr_pmu_hp_state); + + return ret; +} +module_init(phytium_ddr_pmu_module_init); + +static void __exit phytium_ddr_pmu_module_exit(void) +{ + platform_driver_unregister(&phytium_ddr_pmu_driver); + cpuhp_remove_multi_state(phytium_ddr_pmu_hp_state); +} +module_exit(phytium_ddr_pmu_module_exit); + +MODULE_DESCRIPTION("Phytium DDR PMU driver"); +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Hu Xianghua "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/phytium_pcie_pmu.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/phytium_pcie_pmu.c new file mode 100644 index 0000000000000000000000000000000000000000..e1dfbf11e6514fe89bf9eea52974d29a64b12fa9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/perf/phytium/phytium_pcie_pmu.c @@ -0,0 +1,899 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium Soc PCIe performance monitoring unit support + * + * Copyright (c) 2023, Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + +#undef pr_fmt +#define pr_fmt(fmt) "phytium_pcie_pmu: " fmt + +#define PHYTIUM_PCIE_MAX_COUNTERS 18 + +#define PCIE_START_TIMER 0x000 +#define PCIE_STOP_TIMER 0x004 +#define PCIE_CLEAR_EVENT 0x008 +#define PCIE_SET_TIMER_L 0x00c +#define PCIE_SET_TIMER_H 0x010 +#define PCIE_TRIG_MODE 0x014 + +#define PCIE_NOW_STATE 0x0e0 +#define PCIE_EVENT_CYCLES 0x0e4 +#define PCIE_TPOINT_END_L 0x0e4 +#define PCIE_TPOINT_END_H 0x0e8 +#define PCIE_STATE_STOP 0x0ec + +#define PCIE_EVENT_AW 0x100 +#define PCIE_EVENT_W_LAST 0x104 +#define PCIE_EVENT_B 0x108 +#define PCIE_EVENT_AR 0x10c +#define PCIE_EVENT_R_LAST 0x110 +#define PCIE_EVENT_R_FULL 0x114 +#define PCIE_EVENT_R_ERR 0x118 +#define PCIE_EVENT_W_ERR 0x11c +#define PCIE_EVENT_DELAY_RD 0x120 +#define PCIE_EVENT_DELAY_WR 0x124 +#define PCIE_EVENT_RD_MAX 0x128 +#define PCIE_EVENT_RD_MIN 0x12c +#define PCIE_EVENT_WR_MAX 0x130 +#define PCIE_EVENT_WR_MIN 0x134 + +#define PCIE_EVENT_W_DATA 0x200 +#define PCIE_W_DATA_BASE 0x200 + +#define PCIE_EVENT_RDELAY_TIME 0x300 +#define PCIE_RDELAY_TIME_BASE 0x300 + +#define PCIE_EVENT_WDELAY_TIME 0x700 +#define PCIE_WDELAY_TIME_BASE 0x700 + +#define PCIE_CLK_FRE 0xe00 +#define PCIE_DATA_WIDTH 0xe04 + +#define to_phytium_pcie_pmu(p) (container_of(p, struct phytium_pcie_pmu, pmu)) + +static int phytium_pcie_pmu_hp_state; + +struct phytium_pcie_pmu_hwevents { + struct perf_event *hw_events[PHYTIUM_PCIE_MAX_COUNTERS]; + DECLARE_BITMAP(used_mask, PHYTIUM_PCIE_MAX_COUNTERS); +}; + +struct phytium_pcie_pmu { + struct device *dev; + void __iomem *base; + void __iomem *csr_base; + void __iomem *irq_reg; + struct pmu pmu; + struct phytium_pcie_pmu_hwevents pmu_events; + u32 die_id; + u32 pmu_id; + int on_cpu; + int irq; + struct hlist_node node; + int ctrler_id; + int real_ctrler; + u32 clk_bits; +}; + +#define GET_PCIE_EVENTID(hwc) (hwc->config_base & 0x1F) + +#define EVENT_VALID(idx) ((idx >= 0) && (idx < PHYTIUM_PCIE_MAX_COUNTERS)) + +static const u32 pcie_counter_reg_offset[] = { + PCIE_EVENT_CYCLES, PCIE_EVENT_AW, PCIE_EVENT_W_LAST, + PCIE_EVENT_B, PCIE_EVENT_AR, PCIE_EVENT_R_LAST, + PCIE_EVENT_R_FULL, PCIE_EVENT_R_ERR, PCIE_EVENT_W_ERR, + PCIE_EVENT_DELAY_RD, PCIE_EVENT_DELAY_WR, PCIE_EVENT_RD_MAX, + PCIE_EVENT_RD_MIN, PCIE_EVENT_WR_MAX, PCIE_EVENT_WR_MIN, + PCIE_EVENT_W_DATA, PCIE_EVENT_RDELAY_TIME, PCIE_EVENT_WDELAY_TIME +}; + +ssize_t phytium_pcie_pmu_format_sysfs_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct dev_ext_attribute *eattr; + + eattr = container_of(attr, struct dev_ext_attribute, attr); + + return sprintf(buf, "%s\n", (char *)eattr->var); +} + +ssize_t phytium_pcie_pmu_event_sysfs_show(struct device *dev, + struct device_attribute *attr, + char *page) +{ + struct dev_ext_attribute *eattr; + + eattr = container_of(attr, struct dev_ext_attribute, attr); + + return sprintf(page, "config=0x%lx\n", (unsigned long)eattr->var); +} + +static ssize_t cpumask_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + struct phytium_pcie_pmu *pcie_pmu = + to_phytium_pcie_pmu(dev_get_drvdata(dev)); + + return cpumap_print_to_pagebuf(true, buf, cpumask_of(pcie_pmu->on_cpu)); +} + +#define PHYTIUM_PMU_ATTR(_name, _func, _config) \ + (&((struct dev_ext_attribute[]){ \ + { __ATTR(_name, 0444, _func, NULL), (void *)_config } })[0] \ + .attr.attr) + +#define PHYTIUM_PCIE_PMU_FORMAT_ATTR(_name, _config) \ + PHYTIUM_PMU_ATTR(_name, phytium_pcie_pmu_format_sysfs_show, \ + (void *)_config) + +#define PHYTIUM_PCIE_PMU_EVENT_ATTR(_name, _config) \ + PHYTIUM_PMU_ATTR(_name, phytium_pcie_pmu_event_sysfs_show, \ + (unsigned long)_config) + +static struct attribute *phytium_pcie_pmu_format_attr[] = { + PHYTIUM_PCIE_PMU_FORMAT_ATTR(event, "config:0-4"), + PHYTIUM_PCIE_PMU_FORMAT_ATTR(ctrler, "config:8-10"), + PHYTIUM_PCIE_PMU_FORMAT_ATTR(timer, "config1:0-31"), + NULL, +}; + +static const struct attribute_group phytium_pcie_pmu_format_group = { + .name = "format", + .attrs = phytium_pcie_pmu_format_attr, +}; + +static struct attribute *phytium_pcie_pmu_events_attr[] = { + PHYTIUM_PCIE_PMU_EVENT_ATTR(cycles, 0x00), + PHYTIUM_PCIE_PMU_EVENT_ATTR(aw, 0x01), + PHYTIUM_PCIE_PMU_EVENT_ATTR(w_last, 0x02), + PHYTIUM_PCIE_PMU_EVENT_ATTR(b, 0x03), + PHYTIUM_PCIE_PMU_EVENT_ATTR(ar, 0x04), + PHYTIUM_PCIE_PMU_EVENT_ATTR(r_last, 0x05), + PHYTIUM_PCIE_PMU_EVENT_ATTR(r_full, 0x06), + PHYTIUM_PCIE_PMU_EVENT_ATTR(r_err, 0x07), + PHYTIUM_PCIE_PMU_EVENT_ATTR(w_err, 0x08), + PHYTIUM_PCIE_PMU_EVENT_ATTR(delay_rd, 0x09), + PHYTIUM_PCIE_PMU_EVENT_ATTR(delay_wr, 0x0a), + PHYTIUM_PCIE_PMU_EVENT_ATTR(rd_max, 0x0b), + PHYTIUM_PCIE_PMU_EVENT_ATTR(rd_min, 0x0c), + PHYTIUM_PCIE_PMU_EVENT_ATTR(wr_max, 0x0d), + PHYTIUM_PCIE_PMU_EVENT_ATTR(wr_min, 0x0e), + PHYTIUM_PCIE_PMU_EVENT_ATTR(w_data, 0x0f), + PHYTIUM_PCIE_PMU_EVENT_ATTR(rdelay_time, 0x10), + PHYTIUM_PCIE_PMU_EVENT_ATTR(wdelay_time, 0x11), + NULL, +}; + +static const struct attribute_group phytium_pcie_pmu_events_group = { + .name = "events", + .attrs = phytium_pcie_pmu_events_attr, +}; + +static DEVICE_ATTR_RO(cpumask); + +static struct attribute *phytium_pcie_pmu_cpumask_attrs[] = { + &dev_attr_cpumask.attr, + NULL, +}; + +static const struct attribute_group phytium_pcie_pmu_cpumask_attr_group = { + .attrs = phytium_pcie_pmu_cpumask_attrs, +}; + +static const struct attribute_group *phytium_pcie_pmu_attr_groups[] = { + &phytium_pcie_pmu_format_group, + &phytium_pcie_pmu_events_group, + &phytium_pcie_pmu_cpumask_attr_group, + NULL, +}; + +static u32 phytium_pcie_pmu_get_event_ctrler(struct perf_event *event) +{ + return FIELD_GET(GENMASK(10, 8), event->attr.config); +} + +static u32 phytium_pcie_pmu_get_event_timer(struct perf_event *event) +{ + return FIELD_GET(GENMASK(31, 0), event->attr.config1); +} + +static u64 phytium_pcie_pmu_read_counter(struct phytium_pcie_pmu *pcie_pmu, + struct hw_perf_event *hwc) +{ + u32 idx = GET_PCIE_EVENTID(hwc); + u32 cycle_l, cycle_h, rdelay_l, rdelay_h, w_data, wdelay_l, wdelay_h, + pcie_data_width; + u64 val64 = 0; + int i; + u32 counter_offset = pcie_counter_reg_offset[idx]; + + if (!EVENT_VALID(idx)) { + dev_err(pcie_pmu->dev, "Unsupported event index:%d!\n", idx); + return 0; + } + + switch (idx) { + case 0: + cycle_l = readl(pcie_pmu->base + counter_offset); + cycle_h = readl(pcie_pmu->base + counter_offset + 4); + val64 = (u64)cycle_h << 32 | (u64)cycle_l; + break; + case 15: + pcie_data_width = readl(pcie_pmu->base + PCIE_DATA_WIDTH); + for (i = 0; i < (pcie_data_width / 8); i++) { + w_data = readl(pcie_pmu->base + counter_offset + 4 * i); + val64 += w_data; + } + break; + case 16: + for (i = 0; i <= 127; i = i + 2) { + rdelay_l = + readl(pcie_pmu->base + counter_offset + 4 * i); + rdelay_h = readl(pcie_pmu->base + counter_offset + + 4 * i + 4); + val64 += (u64)rdelay_h << 32 | (u64)rdelay_l; + } + break; + case 17: + for (i = 0; i <= 63; i++) { + wdelay_l = + readl(pcie_pmu->base + counter_offset + 4 * i); + wdelay_h = readl(pcie_pmu->base + counter_offset + + 4 * i + 4); + val64 += (u64)wdelay_h << 32 | (u64)wdelay_l; + } + break; + default: + val64 = readl(pcie_pmu->base + counter_offset); + break; + } + return val64; +} + +static void phytium_pcie_pmu_enable_clk(struct phytium_pcie_pmu *pcie_pmu) +{ + u32 val; + + val = readl(pcie_pmu->csr_base); + val |= (pcie_pmu->clk_bits); + writel(val, pcie_pmu->csr_base); +} + +static void phytium_pcie_pmu_disable_clk(struct phytium_pcie_pmu *pcie_pmu) +{ + u32 val; + + val = readl(pcie_pmu->csr_base); + val &= ~(pcie_pmu->clk_bits); + writel(val, pcie_pmu->csr_base); +} + +static void phytium_pcie_pmu_select_ctrler(struct phytium_pcie_pmu *pcie_pmu) +{ + u32 val, offset = 0; + + if (pcie_pmu->pmu_id != 2) + offset = 0xc; + + val = readl(pcie_pmu->csr_base + offset); + + if (pcie_pmu->pmu_id == 2) { + val &= 0xffffffcf; + val |= pcie_pmu->real_ctrler; + } else { + val &= 0xfffffffc; + val |= pcie_pmu->real_ctrler; + } + + writel(val, pcie_pmu->csr_base + offset); +} + +static void +phytium_pcie_pmu_clear_all_counters(struct phytium_pcie_pmu *pcie_pmu) +{ + writel(0x1, pcie_pmu->base + PCIE_CLEAR_EVENT); +} + +static void +phytium_pcie_pmu_start_all_counters(struct phytium_pcie_pmu *pcie_pmu) +{ + writel(0x1, pcie_pmu->base + PCIE_START_TIMER); +} + +static void +phytium_pcie_pmu_stop_all_counters(struct phytium_pcie_pmu *pcie_pmu) +{ + writel(0x1, pcie_pmu->base + PCIE_STOP_TIMER); +} + +static void phytium_pcie_pmu_set_timer(struct phytium_pcie_pmu *pcie_pmu, + u32 th_val) +{ + u32 val; + + val = readl(pcie_pmu->base + PCIE_SET_TIMER_L); + val = readl(pcie_pmu->base + PCIE_SET_TIMER_H); + + writel(th_val, pcie_pmu->base + PCIE_SET_TIMER_L); + writel(0, pcie_pmu->base + PCIE_SET_TIMER_H); +} + +static void phytium_pcie_pmu_reset_timer(struct phytium_pcie_pmu *pcie_pmu) +{ + u32 val; + + val = readl(pcie_pmu->base + PCIE_SET_TIMER_L); + val = readl(pcie_pmu->base + PCIE_SET_TIMER_H); + + writel(0xFFFFFFFF, pcie_pmu->base + PCIE_SET_TIMER_L); + writel(0xFFFFFFFF, pcie_pmu->base + PCIE_SET_TIMER_H); +} + +static unsigned long +phytium_pcie_pmu_get_stop_state(struct phytium_pcie_pmu *pcie_pmu) +{ + unsigned long val; + + val = (unsigned long)readl(pcie_pmu->base + PCIE_STATE_STOP); + return val; +} + +static unsigned long +phytium_pcie_pmu_get_irq_flag(struct phytium_pcie_pmu *pcie_pmu) +{ + unsigned long val; + + val = (unsigned long)readl(pcie_pmu->irq_reg); + return val; +} + +static int phytium_pcie_pmu_mark_event(struct perf_event *event) +{ + struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(event->pmu); + unsigned long *used_mask = pcie_pmu->pmu_events.used_mask; + struct hw_perf_event *hwc = &event->hw; + + int idx = GET_PCIE_EVENTID(hwc); + + if (test_bit(idx, used_mask)) + return -EAGAIN; + + set_bit(idx, used_mask); + + return idx; +} + +static void phytium_pcie_pmu_unmark_event(struct phytium_pcie_pmu *pcie_pmu, + int idx) +{ + if (!EVENT_VALID(idx)) { + dev_err(pcie_pmu->dev, "Unsupported event index:%d!\n", idx); + return; + } + + clear_bit(idx, pcie_pmu->pmu_events.used_mask); +} + +int phytium_pcie_pmu_event_init(struct perf_event *event) +{ + struct hw_perf_event *hwc = &event->hw; + struct phytium_pcie_pmu *pcie_pmu; + u32 event_ctrler, event_timer; + + if (event->attr.type != event->pmu->type) + return -ENOENT; + + if (is_sampling_event(event) || event->attach_state & PERF_ATTACH_TASK) + return -EOPNOTSUPP; + + pcie_pmu = to_phytium_pcie_pmu(event->pmu); + + if (event->cpu < 0) { + dev_warn(pcie_pmu->dev, "Can't provide per-task data!\n"); + return -EINVAL; + } + + if ((event->attr.config & 0x1F) > PHYTIUM_PCIE_MAX_COUNTERS) + return -EINVAL; + + if (pcie_pmu->on_cpu == -1) + return -EINVAL; + + event_timer = phytium_pcie_pmu_get_event_timer(event); + if (event_timer != 0) + phytium_pcie_pmu_set_timer(pcie_pmu, event_timer); + + event_ctrler = phytium_pcie_pmu_get_event_ctrler(event); + switch (pcie_pmu->pmu_id) { + case 0: + if (event_ctrler != 0) { + dev_warn(pcie_pmu->dev, + "Wrong ctrler id(%d) for pcie-pmu0!\n", + event_ctrler); + return -EINVAL; + } + break; + case 1: + if ((event_ctrler < 1) || (event_ctrler > 3)) { + dev_warn(pcie_pmu->dev, + "Wrong ctrler id(%d) for pcie-pmu1!\n", + event_ctrler); + return -EINVAL; + } + break; + case 2: + if ((event_ctrler < 4) || (event_ctrler > 7)) { + dev_warn(pcie_pmu->dev, + "Wrong ctrler id(%d) for pcie-pmu2!\n", + event_ctrler); + return -EINVAL; + } + break; + default: + dev_err(pcie_pmu->dev, "Unsupported pmu id:%d!\n", + pcie_pmu->pmu_id); + return -EINVAL; + } + + pcie_pmu->ctrler_id = event_ctrler; + switch (pcie_pmu->pmu_id) { + case 0: + case 1: + pcie_pmu->real_ctrler = pcie_pmu->ctrler_id; + break; + case 2: + pcie_pmu->real_ctrler = (pcie_pmu->ctrler_id - 4) * 16; + break; + default: + dev_err(pcie_pmu->dev, "Unsupported pmu id:%d!\n", + pcie_pmu->pmu_id); + return -EINVAL; + } + phytium_pcie_pmu_select_ctrler(pcie_pmu); + + hwc->idx = -1; + hwc->config_base = event->attr.config; + + event->cpu = pcie_pmu->on_cpu; + return 0; +} + +void phytium_pcie_pmu_event_update(struct perf_event *event) +{ + struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(event->pmu); + struct hw_perf_event *hwc = &event->hw; + u64 delta; + + delta = phytium_pcie_pmu_read_counter(pcie_pmu, hwc); + local64_add(delta, &event->count); +} + +void phytium_pcie_pmu_event_start(struct perf_event *event, int flags) +{ + struct hw_perf_event *hwc = &event->hw; + + hwc->state = 0; + perf_event_update_userpage(event); +} + +void phytium_pcie_pmu_event_stop(struct perf_event *event, int flags) +{ + struct hw_perf_event *hwc = &event->hw; + + hwc->state |= PERF_HES_STOPPED; + + if (flags & PERF_EF_UPDATE) + phytium_pcie_pmu_event_update(event); +} + +int phytium_pcie_pmu_event_add(struct perf_event *event, int flags) +{ + struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(event->pmu); + struct hw_perf_event *hwc = &event->hw; + int idx; + + hwc->state |= PERF_HES_STOPPED; + + idx = phytium_pcie_pmu_mark_event(event); + if (idx < 0) + return idx; + + event->hw.idx = idx; + pcie_pmu->pmu_events.hw_events[idx] = event; + + return 0; +} + +void phytium_pcie_pmu_event_del(struct perf_event *event, int flags) +{ + struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(event->pmu); + struct hw_perf_event *hwc = &event->hw; + unsigned long val; + u32 event_timer; + + phytium_pcie_pmu_event_stop(event, PERF_EF_UPDATE); + val = phytium_pcie_pmu_get_irq_flag(pcie_pmu); + val = phytium_pcie_pmu_get_stop_state(pcie_pmu); + phytium_pcie_pmu_unmark_event(pcie_pmu, hwc->idx); + + event_timer = phytium_pcie_pmu_get_event_timer(event); + if (event_timer != 0) + phytium_pcie_pmu_reset_timer(pcie_pmu); + + perf_event_update_userpage(event); + pcie_pmu->pmu_events.hw_events[hwc->idx] = NULL; +} + +void phytium_pcie_pmu_enable(struct pmu *pmu) +{ + struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(pmu); + int event_added = bitmap_weight(pcie_pmu->pmu_events.used_mask, + PHYTIUM_PCIE_MAX_COUNTERS); + + if (event_added) { + phytium_pcie_pmu_clear_all_counters(pcie_pmu); + phytium_pcie_pmu_start_all_counters(pcie_pmu); + } +} + +void phytium_pcie_pmu_disable(struct pmu *pmu) +{ + struct phytium_pcie_pmu *pcie_pmu = to_phytium_pcie_pmu(pmu); + int event_added = bitmap_weight(pcie_pmu->pmu_events.used_mask, + PHYTIUM_PCIE_MAX_COUNTERS); + + if (event_added) + phytium_pcie_pmu_stop_all_counters(pcie_pmu); +} + +static const struct acpi_device_id phytium_pcie_pmu_acpi_match[] = { + { + "PHYT0044", + }, + {}, +}; +MODULE_DEVICE_TABLE(acpi, phytium_pcie_pmu_acpi_match); + +static irqreturn_t phytium_pcie_pmu_overflow_handler(int irq, void *dev_id) +{ + struct phytium_pcie_pmu *pcie_pmu = dev_id; + struct perf_event *event; + unsigned long overflown, stop_state; + int idx; + unsigned long *used_mask = pcie_pmu->pmu_events.used_mask; + int event_added = bitmap_weight(used_mask, PHYTIUM_PCIE_MAX_COUNTERS); + + overflown = phytium_pcie_pmu_get_irq_flag(pcie_pmu); + + if (!test_bit(pcie_pmu->pmu_id + 4, &overflown)) + return IRQ_NONE; + + stop_state = phytium_pcie_pmu_get_stop_state(pcie_pmu); + + if (bitmap_weight(&stop_state, 6)) { + for_each_set_bit(idx, used_mask, PHYTIUM_PCIE_MAX_COUNTERS) { + event = pcie_pmu->pmu_events.hw_events[idx]; + if (!event) + continue; + phytium_pcie_pmu_event_update(event); + } + phytium_pcie_pmu_clear_all_counters(pcie_pmu); + phytium_pcie_pmu_start_all_counters(pcie_pmu); + + return IRQ_HANDLED; + } + if (!event_added) { + phytium_pcie_pmu_clear_all_counters(pcie_pmu); + return IRQ_HANDLED; + } + return IRQ_NONE; +} + +static int phytium_pcie_pmu_init_irq(struct phytium_pcie_pmu *pcie_pmu, + struct platform_device *pdev) +{ + int irq, ret; + + irq = platform_get_irq(pdev, 0); + if (irq < 0) + return irq; + + ret = devm_request_irq(&pdev->dev, irq, + phytium_pcie_pmu_overflow_handler, + IRQF_NOBALANCING | IRQF_NO_THREAD | IRQF_SHARED, + dev_name(&pdev->dev), pcie_pmu); + if (ret < 0) { + dev_err(&pdev->dev, "Fail to request IRQ:%d ret:%d\n", irq, + ret); + return ret; + } + + pcie_pmu->irq = irq; + + return 0; +} + +static int phytium_pcie_pmu_init_data(struct platform_device *pdev, + struct phytium_pcie_pmu *pcie_pmu) +{ + struct resource *res, *clkres, *irqres; + + if (device_property_read_u32(&pdev->dev, "phytium,die-id", + &pcie_pmu->die_id)) { + dev_err(&pdev->dev, "Can not read phytium,die-id!\n"); + return -EINVAL; + } + + if (device_property_read_u32(&pdev->dev, "phytium,pmu-id", + &pcie_pmu->pmu_id)) { + dev_err(&pdev->dev, "Can not read phytium,pmu-id!\n"); + return -EINVAL; + } + + switch (pcie_pmu->pmu_id) { + case 0: + pcie_pmu->clk_bits = 0x1; + break; + case 1: + pcie_pmu->clk_bits = 0xe; + break; + case 2: + pcie_pmu->clk_bits = 0xf; + break; + default: + dev_err(&pdev->dev, "Unsupported pmu id:%d!\n", + pcie_pmu->pmu_id); + break; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + pcie_pmu->base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(pcie_pmu->base)) { + dev_err(&pdev->dev, "ioremap failed for pcie_pmu resource\n"); + return PTR_ERR(pcie_pmu->base); + } + + clkres = platform_get_resource(pdev, IORESOURCE_MEM, 1); + if (!clkres) { + dev_err(&pdev->dev, "failed for get pcie_pmu clk resource.\n"); + return -EINVAL; + } + + pcie_pmu->csr_base = + devm_ioremap(&pdev->dev, clkres->start, resource_size(clkres)); + if (IS_ERR(pcie_pmu->csr_base)) { + dev_err(&pdev->dev, + "ioremap failed for pcie_pmu csr resource\n"); + return PTR_ERR(pcie_pmu->csr_base); + } + + irqres = platform_get_resource(pdev, IORESOURCE_MEM, 2); + if (!irqres) { + dev_err(&pdev->dev, + "failed for get pcie_pmu irq reg resource.\n"); + return -EINVAL; + } + + pcie_pmu->irq_reg = + devm_ioremap(&pdev->dev, irqres->start, resource_size(irqres)); + if (IS_ERR(pcie_pmu->irq_reg)) { + dev_err(&pdev->dev, + "ioremap failed for pcie_pmu irq resource\n"); + return PTR_ERR(pcie_pmu->irq_reg); + } + + return 0; +} + +static int phytium_pcie_pmu_dev_probe(struct platform_device *pdev, + struct phytium_pcie_pmu *pcie_pmu) +{ + int ret; + + ret = phytium_pcie_pmu_init_data(pdev, pcie_pmu); + if (ret) + return ret; + + ret = phytium_pcie_pmu_init_irq(pcie_pmu, pdev); + if (ret) + return ret; + pcie_pmu->dev = &pdev->dev; + pcie_pmu->on_cpu = -1; + pcie_pmu->ctrler_id = -1; + + return 0; +} + +static int phytium_pcie_pmu_probe(struct platform_device *pdev) +{ + struct phytium_pcie_pmu *pcie_pmu; + char *name; + int ret; + + pcie_pmu = devm_kzalloc(&pdev->dev, sizeof(*pcie_pmu), GFP_KERNEL); + if (!pcie_pmu) + return -ENOMEM; + + platform_set_drvdata(pdev, pcie_pmu); + + ret = phytium_pcie_pmu_dev_probe(pdev, pcie_pmu); + if (ret) + return ret; + + ret = cpuhp_state_add_instance( + phytium_pcie_pmu_hp_state, &pcie_pmu->node); + if (ret) { + dev_err(&pdev->dev, "Error %d registering hotplug;\n", ret); + return ret; + } + + name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "phyt%u_pcie_pmu%u", + pcie_pmu->die_id, pcie_pmu->pmu_id); + pcie_pmu->pmu = (struct pmu){ + .name = name, + .module = THIS_MODULE, + .task_ctx_nr = perf_invalid_context, + .event_init = phytium_pcie_pmu_event_init, + .pmu_enable = phytium_pcie_pmu_enable, + .pmu_disable = phytium_pcie_pmu_disable, + .add = phytium_pcie_pmu_event_add, + .del = phytium_pcie_pmu_event_del, + .start = phytium_pcie_pmu_event_start, + .stop = phytium_pcie_pmu_event_stop, + .read = phytium_pcie_pmu_event_update, + .attr_groups = phytium_pcie_pmu_attr_groups, + .capabilities = PERF_PMU_CAP_NO_EXCLUDE, + }; + + ret = perf_pmu_register(&pcie_pmu->pmu, name, -1); + if (ret) { + dev_err(pcie_pmu->dev, "PCIE PMU register failed!\n"); + cpuhp_state_remove_instance_nocalls( + phytium_pcie_pmu_hp_state, + &pcie_pmu->node); + } + + phytium_pcie_pmu_enable_clk(pcie_pmu); + + pr_info("Phytium PCIe PMU: "); + pr_info("die_id = %d pmu_id = %d.\n", pcie_pmu->die_id, + pcie_pmu->pmu_id); + + return ret; +} + +static int phytium_pcie_pmu_remove(struct platform_device *pdev) +{ + struct phytium_pcie_pmu *pcie_pmu = platform_get_drvdata(pdev); + + phytium_pcie_pmu_disable_clk(pcie_pmu); + + perf_pmu_unregister(&pcie_pmu->pmu); + cpuhp_state_remove_instance_nocalls( + phytium_pcie_pmu_hp_state, &pcie_pmu->node); + + return 0; +} + +static struct platform_driver phytium_pcie_pmu_driver = { + .driver = { + .name = "phytium_pcie_pmu", + .acpi_match_table = ACPI_PTR(phytium_pcie_pmu_acpi_match), + .suppress_bind_attrs = true, + }, + .probe = phytium_pcie_pmu_probe, + .remove = phytium_pcie_pmu_remove, +}; + +int phytium_pcie_pmu_online_cpu(unsigned int cpu, struct hlist_node *node) +{ + struct phytium_pcie_pmu *pcie_pmu = + hlist_entry_safe(node, struct phytium_pcie_pmu, node); + + if (!cpumask_test_cpu(cpu, cpumask_of_node(pcie_pmu->die_id))) + return 0; + + if (pcie_pmu->on_cpu != -1) { + if (!cpumask_test_cpu(pcie_pmu->on_cpu, cpumask_of_node(pcie_pmu->die_id))) { + perf_pmu_migrate_context(&pcie_pmu->pmu, pcie_pmu->on_cpu, cpu); + pcie_pmu->on_cpu = cpu; + WARN_ON(irq_set_affinity_hint(pcie_pmu->irq, cpumask_of(cpu))); + } + return 0; + } + + pcie_pmu->on_cpu = cpu; + WARN_ON(irq_set_affinity_hint(pcie_pmu->irq, cpumask_of(cpu))); + + return 0; +} + +int phytium_pcie_pmu_offline_cpu(unsigned int cpu, struct hlist_node *node) +{ + struct phytium_pcie_pmu *pcie_pmu = + hlist_entry_safe(node, struct phytium_pcie_pmu, node); + unsigned int target; + cpumask_t available_cpus; + + if (pcie_pmu->on_cpu != cpu) + return 0; + + if (cpumask_and(&available_cpus, cpumask_of_node(pcie_pmu->die_id), cpu_online_mask) && + cpumask_andnot(&available_cpus, &available_cpus, cpumask_of(cpu))) + target = cpumask_last(&available_cpus); + else { + cpumask_andnot(&available_cpus, cpu_online_mask, cpumask_of(cpu)); + target = cpumask_last(&available_cpus); + } + + if (target >= nr_cpu_ids) { + dev_err(pcie_pmu->dev, "offline cpu%d with no target to migrate.\n", + cpu); + return 0; + } + + perf_pmu_migrate_context(&pcie_pmu->pmu, cpu, target); + WARN_ON(irq_set_affinity_hint(pcie_pmu->irq, cpumask_of(target))); + pcie_pmu->on_cpu = target; + + return 0; +} + +static int __init phytium_pcie_pmu_module_init(void) +{ + int ret; + + phytium_pcie_pmu_hp_state = + cpuhp_setup_state_multi(CPUHP_AP_ONLINE_DYN, + "perf/phytium/pciepmu:online", + phytium_pcie_pmu_online_cpu, phytium_pcie_pmu_offline_cpu); + if (phytium_pcie_pmu_hp_state < 0) { + pr_err("PCIE PMU: setup hotplug, ret = %d\n", + phytium_pcie_pmu_hp_state); + return phytium_pcie_pmu_hp_state; + } + + ret = platform_driver_register(&phytium_pcie_pmu_driver); + if (ret) + cpuhp_remove_multi_state( + phytium_pcie_pmu_hp_state); + + return ret; +} +module_init(phytium_pcie_pmu_module_init); + +static void __exit phytium_pcie_pmu_module_exit(void) +{ + platform_driver_unregister(&phytium_pcie_pmu_driver); + cpuhp_remove_multi_state(phytium_pcie_pmu_hp_state); +} +module_exit(phytium_pcie_pmu_module_exit); + +MODULE_DESCRIPTION("Phytium PCIe PMU driver"); +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Hu Xianghua "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/pwm/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/pwm/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..67592f72fa91b53248cb61a494d54932071087e4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/pwm/Kconfig @@ -0,0 +1,11 @@ +config PWM_PHYTIUM + tristate "Phytium PWM support" + depends on ARCH_PHYTIUM + help + Generic PWM framework driver for the PWM controller found on + Phytium SoCs. + + To compile this driver as a module, choose M here: the module + will be called pwm-phytium. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/pwm/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/pwm/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..b3d6fbbbfdcc0d79035227b1b04b9d153fe4d654 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/pwm/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_PWM_PHYTIUM) += pwm-phytium.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/pwm/pwm-phytium.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/pwm/pwm-phytium.c new file mode 100644 index 0000000000000000000000000000000000000000..98ae864a82cd60588c8964e3e27f2a76ad08b1f7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/pwm/pwm-phytium.c @@ -0,0 +1,590 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium PWM driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define REG_TCNT 0x00 +#define REG_TCTRL 0x04 +#define REG_STAT 0x08 + +#define REG_TPERIOD 0x0c +#define REG_PWMCTRL 0x10 +#define REG_PWMCCR 0x14 + +#define TCTRL_DIV_MASK 0x1ff8 +#define TCTRL_PWMMOD_MASK 0x4 +#define TCTRL_CAPMOD_MASK 0x3 +#define PWM_PERIOD_MASK 0xffff +#define PWM_DUTY_MASK 0xffff +#define PWM_MODE_MASK 0x4 +#define PWM_CTRL_INIT 0xc4 + +#define PWM_NUM 2 + +#define REG_DBCTRL 0x00 +#define REG_DBCLY 0x04 +#define PWM_UPDBCLY_MASK 0x3ff +#define PWM_DWDBCLY_MASK 0xffc00 +#define PWM_DB_POLARITY_MASK 0xc + +#define PWM_N(x) ((0x400)*(x)) +#define MAX_PARAMETER 2 + +struct phytium_pwm_state { + int rst; + int cntmod; + int dutymod; + unsigned int div; + int db_rst; + unsigned int updbcly; + unsigned int dwdbcly; + unsigned int dbpolarity; +}; + +struct phytium_pwm_param { + int cntmod; + int dutymod; + unsigned int div; + unsigned int updbcly; + unsigned int dwdbcly; + unsigned int dbpolarity; +}; + +struct phytium_pwm_variant { + u8 rst_mask; + u8 div; + int counter_mode; + int periodns; + int duty_ns; + int pwm_mode; + u8 duty_mode; + int updbcly; + int dwdbcly; +}; + +struct phytium_pwm_channel { + u32 period_ns; + u32 duty_ns; + u32 tin_ns; +}; + +struct phytium_pwm_chip { + struct pwm_chip chip; + struct pwm_state state_pm[PWM_NUM]; + struct phytium_pwm_variant variant; + struct phytium_pwm_state state; + u8 inverter_mask; + u8 disabled_mask; + int db_init; + void __iomem *base; + void __iomem *base1; + struct phytium_pwm_param parameter[MAX_PARAMETER]; + unsigned int num_parameters; + + struct clk *base_clk; +}; + +static inline struct phytium_pwm_chip *to_phytium_pwm_chip(struct pwm_chip *chip) +{ + return container_of(chip, struct phytium_pwm_chip, chip); +} + + +static void pwm_phytium_free(struct pwm_chip *chip, struct pwm_device *pwm) +{ + devm_kfree(chip->dev, pwm_get_chip_data(pwm)); + pwm_set_chip_data(pwm, NULL); +} + +static int pwm_phytium_enable(struct pwm_chip *chip, struct pwm_device *pwm, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); + reg |= 0x2; + our_chip->state_pm[n].enabled = 1; + writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); + + return 0; +} + +static void pwm_phytium_disable(struct pwm_chip *chip, struct pwm_device *pwm, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); + reg &= 0xfffffffd; + our_chip->state_pm[n].enabled = 0; + writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); +} + +static void pwm_phytium_dutymod(struct pwm_chip *chip, int dutymod, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base + PWM_N(n) + REG_PWMCTRL); + + if (dutymod == 0) + reg &= 0xfffffeff; + else if (dutymod == 1) + reg |= 0x100; + + writel(reg, our_chip->base + PWM_N(n) + REG_PWMCTRL); +} + +static void pwm_phytium_set_div(struct pwm_chip *chip, unsigned int div, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); + reg &= 0xffff; + reg |= (div<<16); + writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); +} + +static void pwm_phytium_set_tmode(struct pwm_chip *chip, int tmode, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base + PWM_N(n) + REG_TCTRL); + if (tmode == 0) + reg &= 0xfffffffb; + else if (tmode == 1) + reg |= 0x4; + + writel(reg, our_chip->base + PWM_N(n) + REG_TCTRL); +} + +static void pwm_phytium_set_periodns(struct pwm_chip *chip, unsigned int periodns, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + int div = our_chip->state.div; + u64 cycles; + + if (has_acpi_companion(chip->dev)) + device_property_read_u64(chip->dev, "clock-frequency", &cycles); + else + cycles = clk_get_rate(our_chip->base_clk); + cycles *= (periodns / (div + 1)); + do_div(cycles, NSEC_PER_SEC); + + reg = readl(our_chip->base + PWM_N(n) + REG_TPERIOD); + cycles = (cycles & PWM_PERIOD_MASK) - 0x1; + our_chip->state_pm[n].period = cycles; + + writel(cycles, our_chip->base + PWM_N(n) + REG_TPERIOD); +} + +static void pwm_phytium_set_duty(struct pwm_chip *chip, unsigned int duty, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + int div = our_chip->state.div; + u64 cycles; + + if (has_acpi_companion(chip->dev)) + device_property_read_u64(chip->dev, "clock-frequency", &cycles); + else + cycles = clk_get_rate(our_chip->base_clk); + cycles *= (duty / (div + 1)); + do_div(cycles, NSEC_PER_SEC); + + reg = readl(our_chip->base + PWM_N(n) + REG_PWMCCR); + cycles = (cycles & PWM_DUTY_MASK) - 0x1; + our_chip->state_pm[n].duty_cycle = cycles; + + writel(cycles, our_chip->base + PWM_N(n) + REG_PWMCCR); +} + +static int pwm_phytium_set_dbcly(struct pwm_chip *chip, unsigned int updbcly, unsigned int dwdbcly) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + u64 dbcly, cycles, upcycles, dwcycles; + + reg = readl(our_chip->base + REG_TPERIOD); + if (has_acpi_companion(chip->dev)) + device_property_read_u64(chip->dev, "clock-frequency", &cycles); + else + cycles = clk_get_rate(our_chip->base_clk); + dbcly &= 0x0; + if (updbcly) { + upcycles = cycles * updbcly; + do_div(upcycles, NSEC_PER_SEC); + + if (upcycles < reg) + dbcly |= (upcycles & PWM_UPDBCLY_MASK); + else + return -EINVAL; + } + + if (dwdbcly) { + dwcycles = cycles * dwdbcly; + do_div(dwcycles, NSEC_PER_SEC); + + if (dwcycles < reg) + dbcly |= ((dwcycles << 10) & PWM_DWDBCLY_MASK); + else + return -EINVAL; + } + + writel(dbcly, our_chip->base1 + REG_DBCLY); + + reg = readl(our_chip->base1 + REG_DBCTRL); + reg |= 0x30; + writel(reg, our_chip->base1 + REG_DBCTRL); + + return 0; +} + +static void pwm_phytium_set_dbpolarity(struct pwm_chip *chip, unsigned int db_polarity) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 reg; + + reg = readl(our_chip->base1 + REG_DBCTRL); + reg &= 0x33; + reg |= ((db_polarity<<2) & PWM_DB_POLARITY_MASK); + writel(reg, our_chip->base1 + REG_DBCTRL); +} + +static int pwm_phytium_init(struct pwm_chip *chip, struct pwm_device *pwm, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + + writel(PWM_CTRL_INIT, our_chip->base + PWM_N(n) + REG_PWMCTRL); + + pwm_phytium_dutymod(chip, our_chip->state.dutymod, n); + pwm_phytium_set_div(chip, our_chip->state.div, n); + pwm_phytium_set_tmode(chip, our_chip->state.cntmod, n); + + return 0; +} + +static int pwm_phytium_db_init(struct pwm_chip *chip, struct pwm_device *pwm) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + + pwm_phytium_set_dbcly(chip, our_chip->state.updbcly, our_chip->state.dwdbcly); + pwm_phytium_set_dbpolarity(chip, our_chip->state.dbpolarity); + + return 0; +} + +static int __pwm_phytium_config(struct pwm_chip *chip, struct pwm_device *pwm) +{ + pwm_phytium_init(chip, pwm, 0); + pwm_phytium_init(chip, pwm, 1); + return 0; +} + +static int pwm_phytium_set_polarity(struct pwm_chip *chip, enum pwm_polarity polarity, int n) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + u32 value; + + value = readl(our_chip->base + PWM_N(n) + REG_PWMCTRL); + + if (polarity == PWM_POLARITY_INVERSED) { + value &= 0xffffff0f; + value |= 0x30; + } else if (polarity == PWM_POLARITY_NORMAL) { + value &= 0xffffff0f; + value |= 0x40; + } + + our_chip->state_pm[n].polarity = polarity; + writel(value, our_chip->base + PWM_N(n) + REG_PWMCTRL); + + return 0; +} + +static int pwm_phytium_apply(struct pwm_chip *chip, struct pwm_device *pwm, + const struct pwm_state *state) +{ + struct phytium_pwm_chip *phytium_pwm = to_phytium_pwm_chip(chip); + struct pwm_state cstate; + u32 reg; + int n; + + pwm_get_state(pwm, &cstate); + + n = pwm->hwpwm & BIT(0); + + if ((state->polarity != cstate.polarity) && !state->enabled) + pwm_phytium_set_polarity(chip, state->polarity, n); + + if (state->enabled && !cstate.enabled) + pwm_phytium_enable(chip, pwm, n); + + if (!state->enabled && cstate.enabled) + pwm_phytium_disable(chip, pwm, n); + + if (state->period != cstate.period) { + pwm_phytium_set_periodns(chip, state->period, n); + if ((phytium_pwm->db_init == 1) && (n == 0)) + pwm_phytium_db_init(chip, pwm); + } + + if (state->duty_cycle != cstate.duty_cycle) { + if (phytium_pwm->state.dutymod == true) { + reg = readl(phytium_pwm->base + PWM_N(n) + REG_STAT); + if ((reg & 0x8) != 0x8) + pwm_phytium_set_duty(chip, state->duty_cycle, n); + } else { + pwm_phytium_set_duty(chip, state->duty_cycle, n); + } + } + + return 0; +} + +static int pwm_phytium_request(struct pwm_chip *chip, struct pwm_device *pwm) +{ + struct phytium_pwm_chip *our_chip = to_phytium_pwm_chip(chip); + struct phytium_pwm_channel *our_chan; + + our_chan = devm_kzalloc(chip->dev, sizeof(*our_chan), GFP_KERNEL); + if (!our_chan) + return -ENOMEM; + + pwm_set_chip_data(pwm, our_chan); + __pwm_phytium_config(&our_chip->chip, our_chip->chip.pwms); + + return 0; +} + +static const struct pwm_ops pwm_phytium_ops = { + .request = pwm_phytium_request, + .free = pwm_phytium_free, + .apply = pwm_phytium_apply, + .owner = THIS_MODULE, +}; + +static int phytium_pwm_set_parameter(struct phytium_pwm_chip *priv) +{ + unsigned int i; + + for (i = 0; i < priv->num_parameters; i++) { + if (priv->parameter[i].updbcly > 0 || priv->parameter[i].dwdbcly > 0) { + priv->db_init = 1; + priv->state.db_rst = 1; + } + + priv->state.cntmod = priv->parameter[i].cntmod; + priv->state.dutymod = priv->parameter[i].dutymod; + priv->state.div = priv->parameter[i].div; + priv->state.updbcly = priv->parameter[i].updbcly; + priv->state.dwdbcly = priv->parameter[i].dwdbcly; + priv->state.dbpolarity = priv->parameter[i].dbpolarity; + } + priv->state.rst = 1; + + return 0; +} + +static int pwm_phytium_probe_parameter(struct phytium_pwm_chip *priv, + struct device_node *np) +{ + int nb, ret, array_size; + unsigned int i; + + if (has_acpi_companion(priv->chip.dev)) { + priv->num_parameters = 1; + array_size = sizeof(struct phytium_pwm_param) / sizeof(u32); + ret = fwnode_property_read_u32_array(dev_fwnode(priv->chip.dev), + "phytium,db", (u32 *)priv->parameter, + array_size); + if (ret < 0) + return ret; + } else { + nb = of_property_count_elems_of_size(np, "phytium,db", + sizeof(struct phytium_pwm_param)); + if (nb <= 0 || nb > MAX_PARAMETER) + return -EINVAL; + + priv->num_parameters = nb; + array_size = nb * sizeof(struct phytium_pwm_param) / sizeof(u32); + ret = of_property_read_u32_array(np, "phytium,db", + (u32 *)priv->parameter, array_size); + if (ret) + return ret; + } + + for (i = 0; i < priv->num_parameters; i++) { + if (priv->parameter[i].cntmod > 1 || + priv->parameter[i].dutymod > 1 || + priv->parameter[i].div > 4096 || + priv->parameter[i].dbpolarity > 3) + return -EINVAL; + } + + return phytium_pwm_set_parameter(priv); +} +static int pwm_phytium_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct device_node *np = dev->of_node; + struct phytium_pwm_chip *chip; + struct resource *res; + int ret; + + chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); + + if (chip == NULL) + return -ENOMEM; + + chip->chip.dev = &pdev->dev; + chip->chip.ops = &pwm_phytium_ops; + chip->chip.base = -1; + chip->chip.npwm = PWM_NUM; + chip->inverter_mask = BIT(PWM_NUM) - 1; + + if (pdev->dev.of_node) { + chip->chip.of_xlate = of_pwm_xlate_with_flags; + chip->chip.of_pwm_n_cells = 3; + } + + ret = pwm_phytium_probe_parameter(chip, np); + if (ret) { + dev_err(dev, "failed to set parameter\n"); + return ret; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + chip->base1 = devm_ioremap_resource(&pdev->dev, res); + chip->base = (chip->base1 + 0x400); + + if (!has_acpi_companion(&pdev->dev)) { + if (IS_ERR(chip->base)) { + dev_err(dev, "failed to get base_addr\n"); + return PTR_ERR(chip->base); + } + + if (pdev->dev.of_node) { + chip->base_clk = devm_clk_get(&pdev->dev, NULL); + if (IS_ERR(chip->base_clk)) { + dev_err(dev, "failed to get clk\n"); + return PTR_ERR(chip->base_clk); + } + + ret = clk_prepare_enable(chip->base_clk); + if (ret < 0) { + dev_err(dev, "failed to enable clk\n"); + return ret; + } + } + } + + platform_set_drvdata(pdev, chip); + + ret = pwmchip_add(&chip->chip); + + if (ret < 0) { + dev_err(dev, "failed to register PWM chip\n"); + return ret; + } + + return 0; +} + +static int pwm_phytium_remove(struct platform_device *pdev) +{ + struct phytium_pwm_chip *chip = platform_get_drvdata(pdev); + + pwmchip_remove(&chip->chip); + + clk_disable_unprepare(chip->base_clk); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int pwm_phytium_pm_init(struct phytium_pwm_chip *priv) +{ + int i; + + __pwm_phytium_config(&priv->chip, priv->chip.pwms); + for (i = 0; i < priv->chip.npwm; i++) { + writel(priv->state_pm[i].period, priv->base + PWM_N(i) + REG_TPERIOD); + if ((priv->db_init == 1) && (i == 0)) + pwm_phytium_db_init(&priv->chip, priv->chip.pwms); + writel(priv->state_pm[i].duty_cycle, priv->base + PWM_N(i) + REG_PWMCTRL); + pwm_phytium_set_polarity(&priv->chip, priv->state_pm[i].polarity, i); + if (priv->state_pm[i].enabled) + pwm_phytium_enable(&priv->chip, priv->chip.pwms, i); + } + + return 0; +} + +static int pwm_phytium_suspend(struct device *dev) +{ + return 0; +} + +static int pwm_phytium_resume(struct device *dev) +{ + struct phytium_pwm_chip *priv = dev_get_drvdata(dev); + + pwm_phytium_pm_init(priv); + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_pwm_dev_pm_ops, pwm_phytium_suspend, pwm_phytium_resume); + +static const struct of_device_id phytium_pwm_matches[] = { + { .compatible = "phytium,pwm" }, + {}, +}; +MODULE_DEVICE_TABLE(of, phytium_pwm_matches); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_pwm_acpi_matches[] = { + { "PHYT0029", 0 }, + {} +}; +MODULE_DEVICE_TABLE(acpi, phytium_pwm_acpi_matches); +#endif + +static struct platform_driver pwm_phytium_driver = { + .driver = { + .name = "phytium-pwm", + .pm = &phytium_pwm_dev_pm_ops, + .of_match_table = phytium_pwm_matches, +#ifdef CONFIG_ACPI + .acpi_match_table = phytium_pwm_acpi_matches, +#endif + }, + .probe = pwm_phytium_probe, + .remove = pwm_phytium_remove, +}; +module_platform_driver(pwm_phytium_driver); + +MODULE_DESCRIPTION("Phytium SoC PWM driver"); +MODULE_AUTHOR("Yang Liu "); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/remoteproc/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/remoteproc/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..d21959ab1d3a089804eb70614bee2657350680d4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/remoteproc/Kconfig @@ -0,0 +1,7 @@ +config HOMO_REMOTEPROC + bool "homogeneous remoteproc support" + select RPMSG_VIRTIO + help + Say y here to support homogeneous processors via the remote processor framework. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/remoteproc/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/remoteproc/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..1314f9cae6364ee101c7dfcee8a3c8687145ac0e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/remoteproc/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_HOMO_REMOTEPROC) += homo_remoteproc.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/remoteproc/homo_remoteproc.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/remoteproc/homo_remoteproc.c new file mode 100644 index 0000000000000000000000000000000000000000..42bf42f48608ce389bdc14fea81d67c55ae04af4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/remoteproc/homo_remoteproc.c @@ -0,0 +1,350 @@ +/* + * Homogeneous Remote Processor Control Driver + * + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + * Author: Shaojun Yang + * + * This program is free software; you can redistribute it and/or modify it under the terms + * of the GNU General Public License version 2 as published by the Free Software Foundation. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "../../../drivers/remoteproc/remoteproc_internal.h" + +#define RPROC_RESOURCE_ENTRIES 8 + +#define PSCI_VERSION 0x84000000 +#define CPU_SUSPEND 0xc4000001 +#define CPU_OFF 0x84000002 +#define CPU_ON 0xc4000003 +#define AFFINITY_INFO 0xc4000004 +#define MIGRATE 0xc4000005 + +/* Resource table for the homo remote processors */ +struct homo_resource_table { + unsigned int version; + unsigned int num; + unsigned int reserved[2]; + unsigned int offset[RPROC_RESOURCE_ENTRIES]; + + /* Note: linux kenrel 'struct fw_rsc_vdev' has no 'type' field, here add to align data structre */ + uint32_t type; + /* rpmsg vdev entry */ + struct fw_rsc_vdev rpmsg_vdev; + struct fw_rsc_vdev_vring rpmsg_vring0; + struct fw_rsc_vdev_vring rpmsg_vring1; +}; + +struct homo_rproc { + struct rproc *rproc; + struct homo_resource_table *rsc; + + u64 phys_addr; + void *addr; + u64 size; + + int irq; + int cpu; +}; + +static int homo_rproc_irq; +static struct homo_rproc *g_priv; +static struct work_struct workqueue; + +#define MPIDR_TO_SGI_AFFINITY(cluster_id, level) (MPIDR_AFFINITY_LEVEL(cluster_id, level) << ICC_SGI1R_AFFINITY_## level ## _SHIFT) + +void gicv3_ipi_send_single(int irq, u64 mpidr) +{ + u16 tlist = 0; + u64 cluster_id; + u64 sgi1r; + + /* Ensure stores to Normal memory are visible to other CPUs before sending the IPI. */ + wmb(); + + cluster_id = mpidr & ~0xffUL; + tlist |= 1 << (mpidr & 0xf); + + /* Send the IPIs for the target list of this cluster */ + sgi1r = (MPIDR_TO_SGI_AFFINITY(cluster_id, 3) | + MPIDR_TO_SGI_AFFINITY(cluster_id, 2) | + irq << 24 | + MPIDR_TO_SGI_AFFINITY(cluster_id, 1) | tlist); + gic_write_sgi1r(sgi1r); + + /* Force the above writes to ICC_SGI1R_EL1 to be executed */ + isb(); +} + +static void homo_rproc_vq_irq(struct work_struct *work) +{ + struct homo_rproc *priv = g_priv; + struct homo_resource_table *rsc = priv->rsc; + struct rproc *rproc = priv->rproc; + + rproc_vq_interrupt(rproc, rsc->rpmsg_vring0.notifyid); +} + +static int homo_rproc_start(struct rproc *rproc) +{ + int err; + struct homo_rproc *priv = rproc->priv; + int phys_cpuid = cpu_logical_map(priv->cpu); + struct arm_smccc_res smc_res; + + err = psci_ops.affinity_info(phys_cpuid, 0); + if (err == 0) + remove_cpu(priv->cpu); + + INIT_WORK(&workqueue, homo_rproc_vq_irq); + + priv->rsc = (struct homo_resource_table *)rproc->table_ptr; + + /* ARMv8 requires to clean D-cache and invalidate I-cache for memory containing new instructions. */ + flush_icache_range((unsigned long)priv->addr, (unsigned long)(priv->addr + priv->size)); + + arm_smccc_smc(CPU_ON, phys_cpuid, (unsigned long long)priv->phys_addr, 0, 0, 0, 0, 0, &smc_res); + + return smc_res.a0; +} + +static int homo_rproc_stop(struct rproc *rproc) +{ + int err; + struct homo_rproc *priv = rproc->priv; + + err = psci_ops.affinity_info(cpu_logical_map(priv->cpu), 0); + if (err == 1) + add_cpu(priv->cpu); + + return 0; +} + +static void *homo_rproc_da_to_va(struct rproc *rproc, u64 da, size_t len, + bool *is_iomem) +{ + struct homo_rproc *priv = rproc->priv; + + return priv->addr + (da - rproc->bootaddr); +} + +static void homo_rproc_kick(struct rproc *rproc, int vqid) +{ + struct homo_rproc *priv = rproc->priv; + + if (rproc->state == RPROC_RUNNING) + gicv3_ipi_send_single(priv->irq, cpu_logical_map(priv->cpu)); + + return ; +} + +static const struct rproc_ops homo_rproc_ops = { + .start = homo_rproc_start, + .stop = homo_rproc_stop, + .kick = homo_rproc_kick, + .da_to_va = homo_rproc_da_to_va, +}; + +static void __iomem *homo_ioremap_prot(phys_addr_t addr, size_t size, pgprot_t prot) +{ + unsigned long offset, vaddr; + phys_addr_t last_addr; + struct vm_struct *area; + + /* Disallow wrap-around or zero size */ + last_addr = addr + size - 1; + if (!size || last_addr < addr) + return NULL; + + /* Page-align mappings */ + offset = addr & (~PAGE_MASK); + addr -= offset; + size = PAGE_ALIGN(size + offset); + + area = get_vm_area_caller(size, VM_IOREMAP, + __builtin_return_address(0)); + if (!area) + return NULL; + vaddr = (unsigned long)area->addr; + + if (ioremap_page_range(vaddr, vaddr + size, addr, prot)) { + free_vm_area(area); + return NULL; + } + + return (void __iomem *)(vaddr + offset); +} + +static irqreturn_t homo_rproc_irq_handler(int irq, void *data) +{ + schedule_work(&workqueue); + return IRQ_HANDLED; +} + +static int homo_rproc_starting_cpu(unsigned int cpu) +{ + enable_percpu_irq(homo_rproc_irq, irq_get_trigger_type(homo_rproc_irq)); + return 0; +} + +static int homo_rproc_dying_cpu(unsigned int cpu) +{ + disable_percpu_irq(homo_rproc_irq); + return 0; +} + +static int homo_rproc_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct device_node *np = dev->of_node, *p; + struct device_node *np_mem; + struct resource res; + struct rproc *rproc; + const char *fw_name; + struct homo_rproc *priv; + int ret; + unsigned int ipi, cpu; + struct of_phandle_args oirq; + + ret = rproc_of_parse_firmware(dev, 0, &fw_name); + if (ret) { + dev_err(dev, "failed to parse firmware-name property, ret = %d\n", ret); + return ret; + } + + rproc = rproc_alloc(dev, np->name, &homo_rproc_ops, fw_name, sizeof(*priv)); + if (!rproc) + return -ENOMEM; + + rproc->auto_boot = false; + rproc->has_iommu = false; + + platform_set_drvdata(pdev, rproc); + + priv = g_priv = rproc->priv; + priv->rproc = rproc; + + /* The following values can be modified through devicetree 'homo_rproc' node */ + if (of_property_read_u32(np, "remote-processor", &cpu)) { + dev_err(dev, "not found 'remote-processor' property\n"); + return -EINVAL; + } + + if (of_property_read_u32(np, "inter-processor-interrupt", &ipi)) { + dev_err(dev, "not found 'inter-processor-interrupt' property\n"); + return -EINVAL; + } + + /* The gic-v3 driver has registered the 0-7 range of SGI interrupt for system purpose */ + if (ipi < 8) { + dev_err(dev, "'inter-processor-interrupt' is %d, should be between 9~15\n", ipi); + return -EINVAL; + } + + priv->cpu = cpu; + priv->irq = ipi; + + dev_info(dev, "remote-processor = %d, inter-processor-interrupt = %d\n", cpu, ipi); + + np_mem = of_parse_phandle(np, "memory-region", 0); + ret = of_address_to_resource(np_mem, 0, &res); + if (ret) { + dev_err(dev, "can't find memory-region for Baremetal\n"); + return ret; + } + + priv->rsc = NULL; + priv->addr = NULL; + + priv->phys_addr = res.start; + priv->size = resource_size(&res); + + /* Map physical memory region reserved for homo remote processor. */ + priv->addr = homo_ioremap_prot(priv->phys_addr, priv->size, PAGE_KERNEL_EXEC); + if (!priv->addr) { + dev_err(dev, "ioremap failed\n"); + return -ENOMEM; + } + dev_info(dev, "ioremap: phys_addr = %016llx, addr = %llx, size = %lld\n", + priv->phys_addr, (u64)(priv->addr), priv->size); + + /* Look for the interrupt parent. */ + p = of_irq_find_parent(np); + if (p == NULL) { + ret = -EINVAL; + goto err; + } + + oirq.np = p; + oirq.args_count = 1; + oirq.args[0] = ipi; + homo_rproc_irq = irq_create_of_mapping(&oirq); + if (homo_rproc_irq <= 0) { + ret = -EINVAL; + goto err; + } + + ret = request_percpu_irq(homo_rproc_irq, homo_rproc_irq_handler, "homo-rproc-ipi", &cpu_number); + if (ret) { + dev_err(dev, "failed to request percpu irq, status = %d\n", ret); + goto err; + } + + ret = cpuhp_setup_state(CPUHP_AP_HOMO_RPROC_STARTING, "remoteproc/homo_rproc:starting", homo_rproc_starting_cpu, homo_rproc_dying_cpu); + if (ret) { + dev_err(dev, "cpuhp setup state failed, status = %d\n", ret); + goto err; + } + + ret = rproc_add(rproc); + if (ret) { + dev_err(dev, "failed to add register device with remoteproc core, status = %d\n", ret); + goto err; + } + + return 0; + +err: + vunmap((void *)((unsigned long)priv->addr & PAGE_MASK)); + return ret; +} + +static int homo_rproc_remove(struct platform_device *pdev) +{ + struct rproc *rproc = platform_get_drvdata(pdev); + + rproc_del(rproc); + rproc_free(rproc); + + return 0; +} + +static const struct of_device_id homo_rproc_ids[] = { + { .compatible = "homo,rproc", }, + { } +}; +MODULE_DEVICE_TABLE(of, homo_rproc_ids); + +static struct platform_driver homo_rproc_driver = { + .probe = homo_rproc_probe, + .remove = homo_rproc_remove, + .driver = { + .name = "homo-rproc", + .of_match_table = of_match_ptr(homo_rproc_ids), + }, +}; +module_platform_driver(homo_rproc_driver); + +MODULE_DESCRIPTION("Homogeneous Remote Processor Control Driver"); +MODULE_AUTHOR("Shaojun Yang "); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/rtc/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/rtc/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..6567a16253b1449c935b99d266c8ac3aeefc2740 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/rtc/Kconfig @@ -0,0 +1,10 @@ +config RTC_DRV_SD3068 + tristate "ZXW Shenzhen whwave SD3068" + select REGMAP_I2C + help + If you say yes here you get support for the ZXW Shenzhen whwave + SD3068 RTC chips. + + This driver can also be built as a module. If so, the module + will be called rtc-sd3068 + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/rtc/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/rtc/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..1b2c1e9da89989c1a9e151f272b9d2c2db0aa1e0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/rtc/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_RTC_DRV_SD3068) += rtc-sd3068.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/rtc/rtc-sd3068.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/rtc/rtc-sd3068.c new file mode 100755 index 0000000000000000000000000000000000000000..4ff94c4a1e3577028c037a85adfc11c8be2afe6a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/rtc/rtc-sd3068.c @@ -0,0 +1,255 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * rtc-sd3068.c - RTC driver for some mostly-compatible I2C chips. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define SD3068_REG_SC 0x00 +#define SD3068_REG_MN 0x01 +#define SD3068_REG_HR 0x02 +#define SD3068_REG_DW 0x03 +#define SD3068_REG_DM 0x04 +#define SD3068_REG_MO 0x05 +#define SD3068_REG_YR 0x06 + +#define SD3068_REG_CTRL1 0x0f +#define SD3068_REG_CTRL2 0x10 +#define SD3068_REG_CTRL3 0x11 + +#define KEY_WRITE1 0x80 +#define KEY_WRITE2 0x04 +#define KEY_WRITE3 0x80 + +#define NUM_TIME_REGS (SD3068_REG_YR - SD3068_REG_SC + 1) + +/* + * The sd3068 has write protection + * and we can choose whether or not to use it. + * Write protection is turned off by default. + */ +#define WRITE_PROTECT_EN 1 + +struct sd3068 { + struct rtc_device *rtc; + struct regmap *regmap; +}; + +/* + * In order to prevent arbitrary modification of the time register, + * when modification of the register, + * the "write" bit needs to be written in a certain order. + * 1. set WRITE1 bit + * 2. set WRITE2 bit + * 3. set WRITE3 bit + */ +static void sd3068_enable_reg_write(struct sd3068 *sd3068) +{ + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL2, + KEY_WRITE1, KEY_WRITE1); + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, + KEY_WRITE2, KEY_WRITE2); + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, + KEY_WRITE3, KEY_WRITE3); +} + +#if WRITE_PROTECT_EN +/* + * In order to prevent arbitrary modification of the time register, + * we should disable the write function. + * when disable write, + * the "write" bit needs to be clear in a certain order. + * 1. clear WRITE2 bit + * 2. clear WRITE3 bit + * 3. clear WRITE1 bit + */ +static void sd3068_disable_reg_write(struct sd3068 *sd3068) +{ + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, + KEY_WRITE2, 0); + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL1, + KEY_WRITE3, 0); + regmap_update_bits(sd3068->regmap, SD3068_REG_CTRL2, + KEY_WRITE1, 0); +} +#endif + +static int sd3068_rtc_read_time(struct device *dev, struct rtc_time *tm) +{ + unsigned char hour; + unsigned char rtc_data[NUM_TIME_REGS] = {0}; + struct i2c_client *client = to_i2c_client(dev); + struct sd3068 *sd3068 = i2c_get_clientdata(client); + int ret; + pr_debug("sd3068 read\n"); + + ret = regmap_bulk_read(sd3068->regmap, SD3068_REG_SC, rtc_data, + NUM_TIME_REGS); + if (ret < 0) { + dev_err(dev, "reading from RTC failed with err:%d\n", ret); + return ret; + } + + tm->tm_sec = bcd2bin(rtc_data[SD3068_REG_SC] & 0x7F); + tm->tm_min = bcd2bin(rtc_data[SD3068_REG_MN] & 0x7F); + + /* + * The sd3068 supports 12/24 hour mode. + * When getting time, + * we need to convert the 12 hour mode to the 24 hour mode. + */ + hour = rtc_data[SD3068_REG_HR]; + if (hour & 0x80) /* 24H MODE */ + tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x3F); + else if (hour & 0x20) /* 12H MODE PM */ + tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x1F) + 12; + else /* 12H MODE AM */ + tm->tm_hour = bcd2bin(rtc_data[SD3068_REG_HR] & 0x1F); + + tm->tm_mday = bcd2bin(rtc_data[SD3068_REG_DM] & 0x3F); + tm->tm_wday = rtc_data[SD3068_REG_DW] & 0x07; + tm->tm_mon = bcd2bin(rtc_data[SD3068_REG_MO] & 0x1F) - 1; + tm->tm_year = bcd2bin(rtc_data[SD3068_REG_YR]) + 100; + + return 0; +} + +static int sd3068_rtc_set_time(struct device *dev, struct rtc_time *tm) +{ + unsigned char rtc_data[NUM_TIME_REGS]; + struct i2c_client *client = to_i2c_client(dev); + struct sd3068 *sd3068 = i2c_get_clientdata(client); + int ret; + pr_debug("sd3068 set\n"); + + rtc_data[SD3068_REG_SC] = bin2bcd(tm->tm_sec); + rtc_data[SD3068_REG_MN] = bin2bcd(tm->tm_min); + rtc_data[SD3068_REG_HR] = bin2bcd(tm->tm_hour) | 0x80; + rtc_data[SD3068_REG_DM] = bin2bcd(tm->tm_mday); + rtc_data[SD3068_REG_DW] = tm->tm_wday & 0x07; + rtc_data[SD3068_REG_MO] = bin2bcd(tm->tm_mon) + 1; + rtc_data[SD3068_REG_YR] = bin2bcd(tm->tm_year - 100); + +#if WRITE_PROTECT_EN + sd3068_enable_reg_write(sd3068); +#endif + + ret = regmap_bulk_write(sd3068->regmap, SD3068_REG_SC, rtc_data, + NUM_TIME_REGS); + if (ret < 0) { + dev_err(dev, "writing to RTC failed with err:%d\n", ret); + return ret; + } + +#if WRITE_PROTECT_EN + sd3068_disable_reg_write(sd3068); +#endif + + return 0; +} + +static const struct rtc_class_ops sd3068_rtc_ops = { + .read_time = sd3068_rtc_read_time, + .set_time = sd3068_rtc_set_time, +}; + +static const struct regmap_config regmap_config = { + .reg_bits = 8, + .val_bits = 8, + .max_register = 0x11, +}; + +static int sd3068_probe(struct i2c_client *client, + const struct i2c_device_id *id) +{ + int ret; + struct sd3068 *sd3068; + unsigned char rtc_data[NUM_TIME_REGS] = {0}; + pr_debug("probed\n"); + + if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) + return -ENODEV; + + sd3068 = devm_kzalloc(&client->dev, sizeof(*sd3068), GFP_KERNEL); + if (!sd3068) + return -ENOMEM; + + sd3068->regmap = devm_regmap_init_i2c(client, ®map_config); + if (IS_ERR(sd3068->regmap)) { + dev_err(&client->dev, "regmap allocation failed\n"); + return PTR_ERR(sd3068->regmap); + } + + i2c_set_clientdata(client, sd3068); + + sd3068->rtc = devm_rtc_allocate_device(&client->dev); + if (IS_ERR(sd3068->rtc)) + return PTR_ERR(sd3068->rtc); + + sd3068->rtc->ops = &sd3068_rtc_ops; + sd3068->rtc->range_min = RTC_TIMESTAMP_BEGIN_2000; + sd3068->rtc->range_max = RTC_TIMESTAMP_END_2099; + + ret = regmap_bulk_read(sd3068->regmap, SD3068_REG_SC, rtc_data, + NUM_TIME_REGS); + if (ret < 0) { + dev_info(&client->dev, "can not read time data when probe\n"); + return ret; + } + + ret = devm_rtc_register_device(sd3068->rtc); + if (ret) + return ret; + + sd3068_enable_reg_write(sd3068); + + return 0; +} + + +static const struct acpi_device_id ds1307_acpi_ids[] = { + { .id = "DS1339", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, ds1307_acpi_ids); + +static const struct i2c_device_id sd3068_id[] = { + { "sd3068", 0 }, + { } +}; +MODULE_DEVICE_TABLE(i2c,sd3068_id); + +static const struct of_device_id sd3068_of_match[] = { + { .compatible = "wave,sd3068" }, + { } +}; + +static struct i2c_driver sd3068_driver = { + .driver = { + .name = "rtc-sd3068", + .of_match_table = of_match_ptr(sd3068_of_match), + .acpi_match_table = ACPI_PTR(ds1307_acpi_ids), + }, + .probe = sd3068_probe, + .id_table = sd3068_id, +}; + +module_i2c_driver(sd3068_driver); +MODULE_DEVICE_TABLE(of, sd3068_of_match); + +MODULE_DESCRIPTION("RTC driver for SD3068 and similar chips"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..be4c4be3bb6c486a31606799055e71eab5dbffbd --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/Kconfig @@ -0,0 +1,38 @@ +config SPI_PHYTIUM + tristate + depends on ARCH_PHYTIUM || COMPILE_TEST + +config SPI_PHYTIUM_PLAT + tristate "Phytium SPI controller platform support" + select SPI_PHYTIUM + help + This selects a platform driver for Phytium SPI controller. + + If you say yes to this option, support will be included for + Pd1904 and pd2008 families of SPI controller. + +config SPI_PHYTIUM_PCI + tristate "Phytium SPI controller PCI support" + depends on PCI + select SPI_PHYTIUM + help + This selects a PCI driver for Phytium SPI controller. + + If you say yes to this option, support will be included for + Phytium px210 chipset of SPI controller. + + If unsure, say N. + +config SPI_PHYTIUM_QSPI + tristate "Phytium Quad SPI controller" + depends on ARCH_PHYTIUM || COMPILE_TEST + depends on OF + depends on SPI_MEM + help + This enables support for Phytium Quad SPI flash controller. + + This driver does not support generic SPI. The implementation only + supports spi-mem interface. + + If unsure, say N. + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..fb9d9df9088a7bfe04c942ac13a8c229c5f92474 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/Makefile @@ -0,0 +1,5 @@ +obj-$(CONFIG_SPI_PHYTIUM) += spi-phytium.o +obj-$(CONFIG_SPI_PHYTIUM_PLAT) += spi-phytium-plat.o +obj-$(CONFIG_SPI_PHYTIUM_PCI) += spi-phytium-pci.o +obj-$(CONFIG_SPI_PHYTIUM_QSPI) += spi-phytium-qspi.o +obj-$(CONFIG_SPI_PHYTIUM) += spi-phytium-dma.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-dma.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-dma.c new file mode 100644 index 0000000000000000000000000000000000000000..25693b633953099d75b3c3a262d7debc237edb07 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-dma.c @@ -0,0 +1,554 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Special handling for phytium DMA core + * + * Copyright (c) 2023-2024 Phytium Technology Co., Ltd. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "spi-phytium.h" + +#define RX_BUSY 0 +#define RX_BURST_LEVEL 16 +#define TX_BUSY 1 +#define TX_BURST_LEVEL 16 + +#define DMA_MAX_BUF_SIZE 4096 + +static void phytium_spi_dma_maxburst_init(struct phytium_spi *fts) +{ + struct dma_slave_caps caps; + u32 max_burst, def_burst; + int ret; + + def_burst = fts->fifo_len / 2; + + ret = dma_get_slave_caps(fts->rxchan, &caps); + if (!ret && caps.max_burst) + max_burst = caps.max_burst; + else + max_burst = RX_BURST_LEVEL; + + fts->rxburst = min(max_burst, def_burst); + phytium_writel(fts, DMARDLR, 0x0); + + ret = dma_get_slave_caps(fts->txchan, &caps); + if (!ret && caps.max_burst) + max_burst = caps.max_burst; + else + max_burst = TX_BURST_LEVEL; + + /* + * Having a Rx DMA channel serviced with higher priority than a Tx DMA + * channel might not be enough to provide a well balanced DMA-based + * SPI transfer interface. There might still be moments when the Tx DMA + * channel is occasionally handled faster than the Rx DMA channel. + * That in its turn will eventually cause the SPI Rx FIFO overflow if + * SPI bus speed is high enough to fill the SPI Rx FIFO in before it's + * cleared by the Rx DMA channel. In order to fix the problem the Tx + * DMA activity is intentionally slowed down by limiting the SPI Tx + * FIFO depth with a value twice bigger than the Tx burst length. + */ + fts->txburst = min(max_burst, def_burst); + /* set dmatdlr to 0 + 1 */ + phytium_writel(fts, DMATDLR, 0); +} + +static int phytium_spi_dma_init(struct device *dev, + struct phytium_spi *fts) +{ + fts->rxchan = dma_request_chan(dev, "rx"); + if (IS_ERR_OR_NULL(fts->rxchan)) + return -ENODEV; + + fts->txchan = dma_request_chan(dev, "tx"); + if (IS_ERR_OR_NULL(fts->txchan)) { + dev_err(dev, "can't request chan\n"); + dma_release_channel(fts->rxchan); + fts->rxchan = NULL; + return -ENODEV; + } + + fts->master->dma_rx = fts->rxchan; + fts->master->dma_tx = fts->txchan; + init_completion(&fts->dma_completion); + + phytium_spi_dma_maxburst_init(fts); + fts->dma_sg_burst = 0; + + return 0; +} + +static void phytium_spi_dma_exit(struct phytium_spi *fts) +{ + if (fts->txchan) { + dmaengine_terminate_sync(fts->txchan); + dma_release_channel(fts->txchan); + } + + if (fts->rxchan) { + dmaengine_terminate_sync(fts->rxchan); + dma_release_channel(fts->rxchan); + } +} + +static irqreturn_t phytium_spi_dma_transfer_handler +(struct phytium_spi *fts) +{ + phytium_spi_check_status(fts, false); + + complete(&fts->dma_completion); + + return IRQ_HANDLED; +} + +static bool phytium_spi_can_dma(struct spi_controller *master, + struct spi_device *spi, struct spi_transfer *xfer) +{ + struct phytium_spi *fts = spi_controller_get_devdata(master); + + return xfer->len > fts->fifo_len; +} + +static enum dma_slave_buswidth phytium_spi_dma_convert_width(u8 n_bytes) +{ + if (n_bytes == 1) + return DMA_SLAVE_BUSWIDTH_1_BYTE; + else if (n_bytes == 2) + return DMA_SLAVE_BUSWIDTH_2_BYTES; + + return DMA_SLAVE_BUSWIDTH_UNDEFINED; +} + +static int phytium_spi_dma_wait(struct phytium_spi *fts, unsigned int len, + u32 speed) +{ + unsigned long long ms; + + ms = len * MSEC_PER_SEC * BITS_PER_BYTE; + do_div(ms, speed); + ms += ms + 200; + + if (ms > UINT_MAX) + ms = UINT_MAX; + + ms = wait_for_completion_timeout(&fts->dma_completion, + msecs_to_jiffies(ms)); + + if (ms == 0) { + dev_err(&fts->master->cur_msg->spi->dev, + "DMA transaction timed out\n"); + return -ETIMEDOUT; + } + + return 0; +} + +static inline bool phytium_spi_dma_tx_busy(struct phytium_spi *fts) +{ + return !(phytium_readl(fts, SR) & SR_TF_EMPT); +} + +static void spi_transfer_delay_ns(u32 ns) +{ + if (!ns) + return; + if (ns <= 1000) { + ndelay(ns); + } else { + u32 us = DIV_ROUND_UP(ns, 1000); + + if (us <= 10) + udelay(us); + else + usleep_range(us, us + DIV_ROUND_UP(us, 10)); + } +} + +static int phytium_spi_dma_wait_tx_done(struct phytium_spi *fts, + struct spi_transfer *xfer) +{ + int retry = SPI_WAIT_RETRIES; + u32 ns = 0; + u32 nents = 0; + + nents = phytium_readl(fts, TXFLR); + ns = nents * fts->n_bytes * BITS_PER_BYTE; + ns *= DIV_ROUND_UP(1000000000, xfer->speed_hz / 2); + + while (phytium_spi_dma_tx_busy(fts) && retry--) + spi_transfer_delay_ns(ns); + + if (retry < 0) { + dev_err(&fts->master->dev, "Tx hanged up\n"); + return -EIO; + } + + return 0; +} + +/* + * fts->dma_chan_busy is set before the dma transfer starts, + * callback for tx + * channel will clear a corresponding bit. + */ +static void phytium_spi_dma_tx_done(void *arg) +{ + struct phytium_spi *fts = arg; + + clear_bit(TX_BUSY, &fts->dma_chan_busy); + if (test_bit(RX_BUSY, &fts->dma_chan_busy)) + return; + + complete(&fts->dma_completion); +} + +static int phytium_spi_dma_config_tx(struct phytium_spi *fts) +{ + struct dma_slave_config txconf; + + memset(&txconf, 0, sizeof(txconf)); + txconf.direction = DMA_MEM_TO_DEV; + txconf.dst_addr = fts->dma_addr; + txconf.dst_maxburst = fts->txburst; + txconf.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; + txconf.dst_addr_width = phytium_spi_dma_convert_width(fts->n_bytes); + txconf.device_fc = false; + + return dmaengine_slave_config(fts->txchan, &txconf); +} + +static int phytium_spi_dma_submit_tx(struct phytium_spi *fts, + struct scatterlist *sgl, unsigned int nents) +{ + struct dma_async_tx_descriptor *txdesc; + dma_cookie_t cookie; + int ret; + + txdesc = dmaengine_prep_slave_sg(fts->txchan, sgl, nents, + DMA_MEM_TO_DEV, + DMA_PREP_INTERRUPT | DMA_CTRL_ACK); + if (!txdesc) + return -ENOMEM; + + txdesc->callback = phytium_spi_dma_tx_done; + txdesc->callback_param = fts; + + cookie = dmaengine_submit(txdesc); + ret = dma_submit_error(cookie); + if (ret) { + dmaengine_terminate_sync(fts->txchan); + return ret; + } + + set_bit(TX_BUSY, &fts->dma_chan_busy); + + return 0; +} + +static inline bool phytium_spi_dma_rx_busy(struct phytium_spi *fts) +{ + return !!(phytium_readl(fts, SR) & SR_RF_NOT_EMPT); +} + +static int phytium_spi_dma_wait_rx_done(struct phytium_spi *fts) +{ + int retry = SPI_WAIT_RETRIES; + unsigned long ns = 0; + u32 nents = 0; + + /* + * It's unlikely that DMA engine is still doing the data fetching, but + * if it's let's give it some reasonable time. The timeout calculation + * is based on the synchronous APB/SSI reference clock rate, on a + * number of data entries left in the Rx FIFO, times a number of clock + * periods normally needed for a single APB read/write transaction + * without PREADY signal utilized (which is true for the phytium APB SSI + * controller). + */ + nents = phytium_readl(fts, RXFLR); + ns = 4U * NSEC_PER_SEC / fts->max_freq * nents; + + while (phytium_spi_dma_rx_busy(fts) && retry--) + spi_transfer_delay_ns(ns); + + if (retry < 0) { + dev_err(&fts->master->dev, "Rx hanged up, nents = %d\n", nents); + return -EIO; + } + + return 0; +} + +/* + * fts->dma_chan_busy is set before the dma transfer starts, + * callback for rx + * channel will clear a corresponding bit. + */ +static void phytium_spi_dma_rx_done(void *arg) +{ + struct phytium_spi *fts = arg; + + clear_bit(RX_BUSY, &fts->dma_chan_busy); + if (test_bit(TX_BUSY, &fts->dma_chan_busy)) + return; + + complete(&fts->dma_completion); +} + +static int phytium_spi_dma_config_rx(struct phytium_spi *fts) +{ + struct dma_slave_config rxconf; + + memset(&rxconf, 0, sizeof(rxconf)); + rxconf.direction = DMA_DEV_TO_MEM; + rxconf.src_addr = fts->dma_addr; + rxconf.src_maxburst = fts->rxburst; + rxconf.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; + rxconf.src_addr_width = phytium_spi_dma_convert_width(fts->n_bytes); + rxconf.device_fc = false; + + return dmaengine_slave_config(fts->rxchan, &rxconf); +} + +static int phytium_spi_dma_submit_rx(struct phytium_spi *fts, + struct scatterlist *sgl, unsigned int nents) +{ + struct dma_async_tx_descriptor *rxdesc; + dma_cookie_t cookie; + int ret; + + rxdesc = dmaengine_prep_slave_sg(fts->rxchan, sgl, nents, + DMA_DEV_TO_MEM, + DMA_PREP_INTERRUPT | DMA_CTRL_ACK); + if (!rxdesc) + return -ENOMEM; + + rxdesc->callback = phytium_spi_dma_rx_done; + rxdesc->callback_param = fts; + + cookie = dmaengine_submit(rxdesc); + ret = dma_submit_error(cookie); + if (ret) { + dmaengine_terminate_sync(fts->rxchan); + return ret; + } + + set_bit(RX_BUSY, &fts->dma_chan_busy); + + return 0; +} + +static int phytium_spi_dma_setup(struct phytium_spi *fts, + struct spi_transfer *xfer) +{ + u16 imr, dma_ctrl; + int ret; + + if (!xfer->tx_buf) + return -EINVAL; + + /* Setup DMA channels */ + ret = phytium_spi_dma_config_tx(fts); + if (ret) + return ret; + + if (xfer->rx_buf) { + ret = phytium_spi_dma_config_rx(fts); + if (ret) + return ret; + } + + /* Set the DMA handshaking interface */ + dma_ctrl = SPI_DMA_TDMAE; + if (xfer->rx_buf) + dma_ctrl |= SPI_DMA_RDMAE; + phytium_writel(fts, DMACR, dma_ctrl); + + /* Set the interrupt mask */ + imr = INT_TXOI; + if (xfer->rx_buf) + imr |= INT_RXUI | INT_RXOI; + + spi_umask_intr(fts, imr); + + reinit_completion(&fts->dma_completion); + + fts->transfer_handler = phytium_spi_dma_transfer_handler; + + return 0; +} + +static int phytium_spi_dma_transfer_all(struct phytium_spi *fts, + struct spi_transfer *xfer) +{ + int ret; + + /* Submit the DMA Tx transfer */ + ret = phytium_spi_dma_submit_tx(fts, xfer->tx_sg.sgl, + xfer->tx_sg.nents); + if (ret) + goto err_clear_dmac; + + /* Submit the DMA Rx transfer if required */ + if (xfer->rx_buf) { + ret = phytium_spi_dma_submit_rx(fts, xfer->rx_sg.sgl, + xfer->rx_sg.nents); + if (ret) + goto err_clear_dmac; + + /* rx must be started before tx due to spi instinct */ + dma_async_issue_pending(fts->rxchan); + } + + dma_async_issue_pending(fts->txchan); + + ret = phytium_spi_dma_wait(fts, xfer->len, xfer->speed_hz); + +err_clear_dmac: + phytium_writel(fts, DMACR, 0); + + return ret; +} + +static int phytium_spi_dma_transfer_one(struct phytium_spi *fts, + struct spi_transfer *xfer) +{ + struct scatterlist *tx_sg = NULL, *rx_sg = NULL, tx_tmp, rx_tmp; + unsigned int tx_len = 0, rx_len = 0; + unsigned int base, len; + int ret; + + sg_init_table(&tx_tmp, 1); + sg_init_table(&rx_tmp, 1); + + for (base = 0, len = 0; base < xfer->len; base += len) { + /* Fetch next Tx DMA data chunk */ + if (!tx_len) { + tx_sg = !tx_sg ? &xfer->tx_sg.sgl[0] : sg_next(tx_sg); + sg_dma_address(&tx_tmp) = sg_dma_address(tx_sg); + tx_len = sg_dma_len(tx_sg); + } + + /* Fetch next Rx DMA data chunk */ + if (!rx_len) { + rx_sg = !rx_sg ? &xfer->rx_sg.sgl[0] : sg_next(rx_sg); + sg_dma_address(&rx_tmp) = sg_dma_address(rx_sg); + rx_len = sg_dma_len(rx_sg); + } + + if ((base + DMA_MAX_BUF_SIZE) > xfer->len) + len = xfer->len - base; + else + len = DMA_MAX_BUF_SIZE; + + len = min3(len, tx_len, rx_len); + + sg_dma_len(&tx_tmp) = len; + sg_dma_len(&rx_tmp) = len; + + /* Submit DMA Tx transfer */ + ret = phytium_spi_dma_submit_tx(fts, &tx_tmp, 1); + if (ret) + break; + + /* Submit DMA Rx transfer */ + ret = phytium_spi_dma_submit_rx(fts, &rx_tmp, 1); + if (ret) + break; + + /* Rx must be started before Tx due to SPI instinct */ + dma_async_issue_pending(fts->rxchan); + + dma_async_issue_pending(fts->txchan); + + /* + * Here we only need to wait for the DMA transfer to be + * finished since SPI controller is kept enabled during the + * procedure this loop implements and there is no risk to lose + * data left in the Tx/Rx FIFOs. + */ + ret = phytium_spi_dma_wait(fts, len, xfer->speed_hz); + if (ret) + break; + + reinit_completion(&fts->dma_completion); + + sg_dma_address(&tx_tmp) += len; + sg_dma_address(&rx_tmp) += len; + tx_len -= len; + rx_len -= len; + } + + phytium_writel(fts, DMACR, 0); + + return ret; +} + +static int phytium_spi_dma_transfer(struct phytium_spi *fts, + struct spi_transfer *xfer) +{ + unsigned int nents; + int ret; + + nents = max(xfer->tx_sg.nents, xfer->rx_sg.nents); + + /* + * large transfer length caused spi RX FIFO full event + * transfer 4096 bytes each time + */ + if (xfer->len <= DMA_MAX_BUF_SIZE) + ret = phytium_spi_dma_transfer_all(fts, xfer); + else + ret = phytium_spi_dma_transfer_one(fts, xfer); + if (ret) + return ret; + + if (fts->master->cur_msg->status == -EINPROGRESS) { + ret = phytium_spi_dma_wait_tx_done(fts, xfer); + if (ret) + return ret; + } + + if (xfer->rx_buf && fts->master->cur_msg->status == -EINPROGRESS) + ret = phytium_spi_dma_wait_rx_done(fts); + + return ret; +} + +static void phytium_spi_dma_stop(struct phytium_spi *fts) +{ + if (test_bit(TX_BUSY, &fts->dma_chan_busy)) { + dmaengine_terminate_sync(fts->txchan); + clear_bit(TX_BUSY, &fts->dma_chan_busy); + } + if (test_bit(RX_BUSY, &fts->dma_chan_busy)) { + dmaengine_terminate_sync(fts->rxchan); + clear_bit(RX_BUSY, &fts->dma_chan_busy); + } +} + +static const struct phytium_spi_dma_ops phytium_spi_dma_generic_ops = { + .dma_init = phytium_spi_dma_init, + .dma_exit = phytium_spi_dma_exit, + .dma_setup = phytium_spi_dma_setup, + .can_dma = phytium_spi_can_dma, + .dma_transfer = phytium_spi_dma_transfer, + .dma_stop = phytium_spi_dma_stop, +}; + +void phytium_spi_dmaops_set(struct phytium_spi *fts) +{ + fts->dma_ops = &phytium_spi_dma_generic_ops; +} +EXPORT_SYMBOL_GPL(phytium_spi_dmaops_set); + +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-pci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-pci.c new file mode 100644 index 0000000000000000000000000000000000000000..6ef8acfe5c85643c8a0281e63f12985fad049e36 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-pci.c @@ -0,0 +1,127 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SPI core controller PCI driver. + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + * + * Derived from drivers/spi/spi-dw-pci.c + * Copyright (c) 2009, 2014 Intel Corporation. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "spi-phytium.h" + +#define DRIVER_NAME "phytium_spi_pci" + +static int phytium_spi_pci_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct phytium_spi *fts; + int pci_bar = 0; + int ret; + + fts = devm_kzalloc(&pdev->dev, sizeof(struct phytium_spi), + GFP_KERNEL); + if (!fts) + return -ENOMEM; + + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + ret = pcim_iomap_regions(pdev, 1 << pci_bar, pci_name(pdev)); + if (ret) { + dev_err(&pdev->dev, "pci iomap failed?\n"); + return ret; + } + + fts->regs = pcim_iomap_table(pdev)[pci_bar]; + if (IS_ERR(fts->regs)) { + dev_err(&pdev->dev, "SPI region map failed\n"); + return PTR_ERR(fts->regs); + } + + fts->irq = pdev->irq; + if (fts->irq < 0) { + dev_err(&pdev->dev, "no irq resource?\n"); + return fts->irq; /* -ENXIO */ + } + + fts->bus_num = -1; + + fts->max_freq = 48000000; + + fts->num_cs = 4; + + fts->global_cs = 1; + + ret = phytium_spi_add_host(&pdev->dev, fts); + if (ret) + return ret; + + pci_set_drvdata(pdev, fts); + return 0; +} + +static void phytium_spi_pci_remove(struct pci_dev *pdev) +{ + struct phytium_spi *fts = pci_get_drvdata(pdev); + + phytium_spi_remove_host(fts); +} + + +#ifdef CONFIG_PM_SLEEP +static int spi_suspend(struct device *dev) +{ + struct spi_master *master = dev_get_drvdata(dev); + struct phytium_spi *fts = spi_master_get_devdata(master); + + return phytium_spi_suspend_host(fts); +} + +static int spi_resume(struct device *dev) +{ + struct spi_master *master = dev_get_drvdata(dev); + struct phytium_spi *fts = spi_master_get_devdata(master); + + return phytium_spi_resume_host(fts); +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_spi_pm_ops, spi_suspend, spi_resume); + +static const struct pci_device_id phytium_device_pci_tbl[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc2c) }, + {}, +}; + +static struct pci_driver phytium_spi_pci_driver = { + .name = DRIVER_NAME, + .id_table = phytium_device_pci_tbl, + .probe = phytium_spi_pci_probe, + .remove = phytium_spi_pci_remove, + .driver = { + .pm = &phytium_spi_pm_ops, + } +}; + +module_pci_driver(phytium_spi_pci_driver); + +MODULE_AUTHOR("Yiqun Zhang "); +MODULE_DESCRIPTION("PCI Driver for Phytium SPI controller core"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-plat.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-plat.c new file mode 100644 index 0000000000000000000000000000000000000000..9b82c5c016092c4bb80cde8cd15685db91a11c9b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-plat.c @@ -0,0 +1,171 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SPI core controller platform driver. + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + * + * Derived from drivers/spi/spi-dw-mmio.c + * Copyright (c) 2010, Octasic semiconductor. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "spi-phytium.h" + +#define DRIVER_NAME "phytium_spi" + +struct phytium_spi_clk { + struct phytium_spi fts; + struct clk *clk; +}; + +static int phytium_spi_probe(struct platform_device *pdev) +{ + struct phytium_spi_clk *ftsc; + struct phytium_spi *fts; + struct resource *mem; + int ret; + int num_cs; + int global_cs; + + ftsc = devm_kzalloc(&pdev->dev, sizeof(struct phytium_spi_clk), + GFP_KERNEL); + if (!ftsc) + return -ENOMEM; + + fts = &ftsc->fts; + + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!mem) { + dev_err(&pdev->dev, "no mem resource?\n"); + return -EINVAL; + } + + fts->paddr = mem->start; + fts->regs = devm_ioremap_resource(&pdev->dev, mem); + if (IS_ERR(fts->regs)) { + dev_err(&pdev->dev, "SPI region map failed\n"); + return PTR_ERR(fts->regs); + } + + fts->irq = platform_get_irq(pdev, 0); + if (fts->irq < 0) { + dev_err(&pdev->dev, "no irq resource?\n"); + return fts->irq; /* -ENXIO */ + } + + if (pdev->dev.of_node) { + ftsc->clk = devm_clk_get(&pdev->dev, NULL); + + if (IS_ERR(ftsc->clk)) + return PTR_ERR(ftsc->clk); + ret = clk_prepare_enable(ftsc->clk); + if (ret) + return ret; + + fts->max_freq = clk_get_rate(ftsc->clk); + } else if (has_acpi_companion(&pdev->dev)) { + fts->max_freq = 48000000; + } + + fts->bus_num = pdev->id; + device_property_read_u32(&pdev->dev, "reg-io-width", &fts->reg_io_width); + + num_cs = 4; + device_property_read_u32(&pdev->dev, "num-cs", &num_cs); + fts->num_cs = num_cs; + + device_property_read_u32(&pdev->dev, "global-cs", &global_cs); + fts->global_cs = global_cs; + + /* check is use dma transfer */ + if ((device_property_read_string_array(&pdev->dev, "dma-names", + NULL, 0) > 0) && + device_property_present(&pdev->dev, "dmas")) { + fts->dma_en = true; + phytium_spi_dmaops_set(fts); + } + + ret = phytium_spi_add_host(&pdev->dev, fts); + if (ret) + goto out; + + platform_set_drvdata(pdev, ftsc); + return 0; + +out: + clk_disable_unprepare(ftsc->clk); + return ret; +} + +static int phytium_spi_remove(struct platform_device *pdev) +{ + struct phytium_spi_clk *ftsc = platform_get_drvdata(pdev); + + phytium_spi_remove_host(&ftsc->fts); + clk_disable_unprepare(ftsc->clk); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int spi_suspend(struct device *dev) +{ + struct phytium_spi_clk *ftsc = dev_get_drvdata(dev); + + return phytium_spi_suspend_host(&ftsc->fts); +} + +static int spi_resume(struct device *dev) +{ + struct phytium_spi_clk *ftsc = dev_get_drvdata(dev); + + return phytium_spi_resume_host(&ftsc->fts); +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_spi_pm_ops, spi_suspend, spi_resume); + +static const struct of_device_id phytium_spi_of_match[] = { + { .compatible = "phytium,spi", .data = (void *)0 }, + { /* end of table */} +}; +MODULE_DEVICE_TABLE(of, phytium_spi_of_match); + +static const struct acpi_device_id phytium_spi_acpi_match[] = { + {"PHYT000E", 0}, + {} +}; +MODULE_DEVICE_TABLE(acpi, phytium_spi_acpi_match); + +static struct platform_driver phytium_spi_driver = { + .probe = phytium_spi_probe, + .remove = phytium_spi_remove, + .driver = { + .name = DRIVER_NAME, + .of_match_table = of_match_ptr(phytium_spi_of_match), + .acpi_match_table = ACPI_PTR(phytium_spi_acpi_match), + .pm = &phytium_spi_pm_ops, + }, +}; +module_platform_driver(phytium_spi_driver); + +MODULE_AUTHOR("Yiqun Zhang "); +MODULE_DESCRIPTION("Platform Driver for Phytium SPI controller core"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-qspi.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-qspi.c new file mode 100644 index 0000000000000000000000000000000000000000..d97e3b7059858e74c559bf06c8ee04bc9b496f07 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium-qspi.c @@ -0,0 +1,857 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium Quad SPI controller driver. + * + * Copyright (c) 2022-2023, Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + + +#define QSPI_FLASH_CAP_REG 0x00 +#define QSPI_FLASH_CAP_NUM_SHIFT 3 +#define QSPI_FLASH_CAP_NUM_MASK (0x3 << QSPI_FLASH_CAP_NUM_SHIFT) +#define QSPI_FLASH_CAP_CAP_SHIFT 0 +#define QSPI_FLASH_CAP_CAP_MASK (0x7 << QSPI_FLASH_CAP_CAP_SHIFT) + +#define QSPI_RD_CFG_REG 0x04 +#define QSPI_RD_CFG_RD_CMD_SHIFT 24 +#define QSPI_RD_CFG_RD_CMD_MASK (0xff << QSPI_RD_CFG_RD_CMD_SHIFT) +#define QSPI_RD_CFG_RD_THROUGH_SHIFT 23 +#define QSPI_RD_CFG_RD_THROUGH_MASK (0x1 << QSPI_RD_CFG_RD_THROUGH_SHIFT) +#define QSPI_RD_CFG_RD_TRANSFER_SHIFT 20 +#define QSPI_RD_CFG_RD_TRANSFER_MASK (0x7 << QSPI_RD_CFG_RD_TRANSFER_SHIFT) +#define QSPI_RD_CFG_RD_ADDR_SEL_SHIFT 19 +#define QSPI_RD_CFG_RD_ADDR_SEL_MASK (0x1 << QSPI_RD_CFG_RD_ADDR_SEL_SHIFT) +#define QSPI_RD_CFG_RD_LATENCY_SHIFT 18 +#define QSPI_RD_CFG_RD_LATENCY_MASK (0x1 << QSPI_RD_CFG_RD_LATENCY_SHIFT) +#define QSPI_RD_CFG_MODE_BYTE_SHIFT 17 +#define QSPI_RD_CFG_MODE_BYTE_MASK (0x1 << QSPI_RD_CFG_MODE_BYTE_SHIFT) +#define QSPI_RD_CFG_CMD_SIGN_SHIFT 9 +#define QSPI_RD_CFG_CMD_SIGN_MASK (0xff << QSPI_RD_CFG_CMD_SIGN_SHIFT) +#define QSPI_RD_CFG_DUMMY_SHIFT 4 +#define QSPI_RD_CFG_DUMMY_MASK (0x1f << QSPI_RD_CFG_DUMMY_SHIFT) +#define QSPI_RD_CFG_D_BUFFER_SHIFT 3 +#define QSPI_RD_CFG_D_BUFFER_MASK (0x1 << QSPI_RD_CFG_D_BUFFER_SHIFT) +#define QSPI_RD_CFG_RD_SCK_SEL_SHIFT 0 +#define QSPI_RD_CFG_RD_SCK_SEL_MASK (0x7 << QSPI_RD_CFG_RD_SCK_SEL_SHIFT) + +#define QSPI_WR_CFG_REG 0x08 +#define QSPI_WR_CFG_WR_CMD_SHIFT 24 +#define QSPI_WR_CFG_WR_CMD_MASK (0xff << QSPI_WR_CFG_WR_CMD_SHIFT) +#define QSPI_WR_CFG_WR_WAIT_SHIFT 9 +#define QSPI_WR_CFG_WR_WAIT_MASK (0x01 << QSPI_WR_CFG_WR_WAIT_SHIFT) +#define QSPI_WR_CFG_WR_THROUGH_SHIFT 8 +#define QSPI_WR_CFG_WR_THROUGH_MASK (0x01 << QSPI_WR_CFG_WR_THROUGH_SHIFT) +#define QSPI_WR_CFG_WR_TRANSFER_SHIFT 5 +#define QSPI_WR_CFG_WR_TRANSFER_MASK (0X7 << QSPI_WR_CFG_WR_TRANSFER_SHIFT) +#define QSPI_WR_CFG_WR_ADDR_SEL_SHIFT 4 +#define QSPI_WR_CFG_WR_ADDR_SEL_MASK (0x1 << QSPI_WR_CFG_WR_ADDR_SEL_SHIFT) +#define QSPI_WR_CFG_WR_MODE_SHIFT 3 +#define QSPI_WR_CFG_WR_MODE_MASK (0x1 << QSPI_WR_CFG_WR_MODE_SHIFT) +#define QSPI_WR_CFG_WR_SCK_SEL_SHIFT 0 +#define QSPI_WR_CFG_WR_SCK_SEL_MASK (0x7 << QSPI_WR_CFG_WR_SCK_SEL_SHIFT) + +#define QSPI_FLUSH_REG 0x0c +#define QSPI_FLUSH_EN (0x1 << 0) + +#define QSPI_CMD_PORT_REG 0x10 +#define QSPI_CMD_PORT_CMD_SHIFT 24 +#define QSPI_CMD_PORT_CMD_MASK (0xff << QSPI_CMD_PORT_CMD_SHIFT) +#define QSPI_CMD_PORT_WAIT_SHIFT 22 +#define QSPI_CMD_PORT_WAIT_MASK (0x1 << QSPI_CMD_PORT_WAIT_SHIFT) +#define QSPI_CMD_PORT_THROUGH_SHIFT 21 +#define QSPI_CMD_PORT_THROUGH_MASK (0x1 << QSPI_CMD_PORT_THROUGH_SHIFT) +#define QSPI_CMD_PORT_CS_SHIFT 19 +#define QSPI_CMD_PORT_CS_MASK (0x3 << QSPI_CMD_PORT_CS_SHIFT) +#define QSPI_CMD_PORT_TRANSFER_SHIFT 16 +#define QSPI_CMD_PORT_TRANSFER_MASK (0x7 << QSPI_CMD_PORT_TRANSFER_SHIFT) +#define QSPI_CMD_PORT_CMD_ADDR_SHIFT 15 +#define QSPI_CMD_PORT_CMD_ADDR_MASK (0x1 << QSPI_CMD_PORT_CMD_ADDR_SHIFT) +#define QSPI_CMD_PORT_LATENCY_SHIFT 14 +#define QSPI_CMD_PORT_LATENCY_MASK (0x1 << QSPI_CMD_PORT_LATENCY_SHIFT) +#define QSPI_CMD_PORT_DATA_XFER_SHIFT 13 +#define QSPI_CMD_PORT_DATA_XFER_MASK (0x1 << QSPI_CMD_PORT_DATA_XFER_SHIFT) +#define QSPI_CMD_PORT_ADDR_SEL_SHIFT 12 +#define QSPI_CMD_PORT_ADDR_SEL_MASK (0x1 << QSPI_CMD_PORT_ADDR_SEL_SHIFT) +#define QSPI_CMD_PORT_DUMMY_SHIFT 7 +#define QSPI_CMD_PORT_DUMMY_MASK (0x1f << QSPI_CMD_PORT_DUMMY_SHIFT) +#define QSPI_CMD_PORT_P_BUFFER_SHIFT 6 +#define QSPI_CMD_PORT_P_BUFFER_MASK (0x1 << QSPI_CMD_PORT_P_BUFFER_SHIFT) +#define QSPI_CMD_PORT_RW_NUM_SHIFT 3 +#define QSPI_CMD_PORT_RW_NUM_MASK (0x7 << QSPI_CMD_PORT_RW_NUM_SHIFT) +#define QSPI_CMD_PORT_SCK_SEL_SHIFT 0 +#define QSPI_CMD_PORT_SCK_SEL_MASK (0x7 << QSPI_CMD_PORT_SCK_SEL_SHIFT) + +#define QSPI_ADDR_PORT_REG 0x14 +#define QSPI_HD_PORT_REG 0x18 +#define QSPI_LD_PORT_REG 0x1c + +#define QSPI_FUN_SET_REG 0x20 +#define QSPI_FUN_SET_HOLD_SHIFT 24 +#define QSPI_FUN_SET_HOLD_MASK (0xff << QSPI_FUN_SET_HOLD_SHIFT) +#define QSPI_FUN_SET_SETUP_SHIFT 16 +#define QSPI_FUN_SET_SETUP_MASK (0xff << QSPI_FUN_SET_SETUP_SHIFT) +#define QSPI_FUN_SET_DELAY_SHIFT 0 +#define QSPI_FUN_SET_DELAY_MASK (0xffff << QSPI_FUN_SET_DELAY_SHIFT) + +#define QSPI_WIP_REG 0x24 +#define QSPI_WIP_W_CMD_SHIFT 24 +#define QSPI_WIP_W_CMD_MASK (0xff << QSPI_WIP_W_CMD_SHIFT) +#define QSPI_WIP_W_TRANSFER_SHIFT 3 +#define QSPI_WIP_W_TRANSFER_MASK (0x3 << QSPI_WIP_W_TRANSFER_SHIFT) +#define QSPI_WIP_W_SCK_SEL_SHIFT 0 +#define QSPI_WIP_W_SCK_SEL_MASK (0x7 << QSPI_WIP_W_SCK_SEL_SHIFT) + +#define QSPI_WP_REG 0x28 +#define QSPI_WP_EN_SHIFT 17 +#define QSPI_WP_EN_MASK (0x1 << QSPI_WP_EN_SHIFT) +#define QSPI_WP_IO2_SHIFT 16 +#define QSPI_WP_IO2_MASK (0x1 << QSPI_WP_IO2_SHIFT) +#define QSPI_WP_HOLD_SHIFT 8 +#define QSPI_WP_HOLD_MASK (0xff << QSPI_WP_HOLD_SHIFT) +#define QSPI_WP_SETUP_SHIFT 0 +#define QSPI_WP_SETUP_MASK (0xff << QSPI_WP_SETUP_SHIFT) + +#define QSPI_MODE_REG 0x2c +#define QSPI_MODE_VALID_SHIFT 8 +#define QSPI_MODE_VALID_MASK (0xff << QSPI_MODE_VALID_SHIFT) +#define QSPI_MODE_SHIFT 0 +#define QSPI_MODE_MASK (0xff << QSPI_MODE_SHIFT) + +#define PHYTIUM_QSPI_MAX_NORCHIP 4 +#define PHYTIUM_QSPI_MAX_MMAP_SZ (SZ_256M * PHYTIUM_QSPI_MAX_NORCHIP) +#define PHYTIUM_QSPI_MAX_XFER_SZ 8 +#define PHYTIUM_QSPI_DEFAULT_SCK_SEL 5 + +#define XFER_PROTO_1_1_1 0x0 +#define XFER_PROTO_1_1_2 0x1 +#define XFER_PROTO_1_1_4 0x2 +#define XFER_PROTO_1_2_2 0x3 +#define XFER_PROTO_1_4_4 0x4 +#define XFER_PROTO_2_2_2 0x5 +#define XFER_PROTO_4_4_4 0x6 + +struct phytium_qspi_flash { + u32 cs; + u32 clk_div; + + void __iomem *base; + resource_size_t size; + struct spi_device *spi; +}; + +struct phytium_qspi { + struct device *dev; + struct spi_controller *ctrl; + + void __iomem *io_base; + void __iomem *mm_base; + resource_size_t mm_size; + resource_size_t used_size; + + struct clk *clk; + u32 clk_rate; + + struct phytium_qspi_flash flash[PHYTIUM_QSPI_MAX_NORCHIP]; + u8 fnum; + bool nodirmap; + + u32 wr_cfg_reg; + u32 rd_cfg_reg; + u32 flash_cap; +}; + +static bool phytium_qspi_check_buswidth(u8 width) +{ + switch (width) { + case 1: + case 2: + case 4: + return 0; + } + + return -EOPNOTSUPP; +} + +static uint phytium_spi_nor_clac_clk_div(int div) +{ + uint clk_div = 0; + + if (div <= 2) + clk_div = 1; + else if (div <= 4) + clk_div = 2; + else if (div <= 8) + clk_div = 3; + else if (div <= 16) + clk_div = 4; + else if (div <= 32) + clk_div = 5; + else if (div <= 64) + clk_div = 6; + else if (div <= 128) + clk_div = 7; + else + clk_div = 65535; + + return clk_div; +} + +static int phytium_spi_nor_protocol_encode(const struct spi_mem_op *op, u32 *code) +{ + int ret = 0; + + if (op->cmd.buswidth == 1 && + op->addr.buswidth == 1 && + op->data.buswidth == 1) + *code = XFER_PROTO_1_1_1; + else if (op->cmd.buswidth == 1 && + op->addr.buswidth == 1 && + op->data.buswidth == 2) + *code = XFER_PROTO_1_1_2; + else if (op->cmd.buswidth == 1 && + op->addr.buswidth == 1 && + op->data.buswidth == 4) + *code = XFER_PROTO_1_1_4; + else if (op->cmd.buswidth == 1 && + op->addr.buswidth == 2 && + op->data.buswidth == 2) + *code = XFER_PROTO_1_2_2; + else if (op->cmd.buswidth == 1 && + op->addr.buswidth == 4 && + op->data.buswidth == 4) + *code = XFER_PROTO_1_4_4; + else if (op->cmd.buswidth == 2 && + op->addr.buswidth == 2 && + op->data.buswidth == 2) + *code = XFER_PROTO_2_2_2; + else if (op->cmd.buswidth == 4 && + op->addr.buswidth == 4 && + op->data.buswidth == 4) + *code = XFER_PROTO_4_4_4; + else + *code = XFER_PROTO_1_1_1; + + return ret; +} + +static int phytium_qspi_flash_capacity_encode(u32 size, u32 *cap) +{ + int ret = 0; + + switch (size) { + case SZ_4M: + *cap = 0x0; + break; + case SZ_8M: + *cap = 0x1; + break; + case SZ_16M: + *cap = 0x2; + break; + case SZ_32M: + *cap = 0x3; + break; + case SZ_64M: + *cap = 0x4; + break; + case SZ_128M: + *cap = 0x5; + break; + case SZ_256M: + *cap = 0x6; + break; + case SZ_512M: + *cap = 0x7; + break; + default: + ret = -EINVAL; + break; + } + + return ret; +} + +static void phytium_qspi_clear_wr(struct phytium_qspi *qspi, + struct phytium_qspi_flash *flash) +{ + u32 cmd = 0; + + cmd |= 0x05 << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= BIT(QSPI_CMD_PORT_TRANSFER_SHIFT); + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); + + /* clear wr_cfg */ + writel_relaxed(0, qspi->io_base + QSPI_WR_CFG_REG); +} + +static int phytium_qspi_write_port(struct phytium_qspi *qspi, + const u8 *buf, const size_t len) +{ + u32 bouncebuf[2] = { 0 }; + + if (len > PHYTIUM_QSPI_MAX_XFER_SZ) { + dev_err(qspi->dev, "WRITE data exceeds 8 bytes.\n"); + return -EINVAL; + } + + memcpy(bouncebuf, buf, len); + + if (len > 4) + writel_relaxed(bouncebuf[1], qspi->io_base + QSPI_HD_PORT_REG); + writel_relaxed(bouncebuf[0], qspi->io_base + QSPI_LD_PORT_REG); + + return 0; +} + +static int phytium_qspi_read_port(struct phytium_qspi *qspi, + u8 *buf, size_t len) +{ + u32 bouncebuf[2] = { 0 }; + + if (len > PHYTIUM_QSPI_MAX_XFER_SZ) { + dev_err(qspi->dev, "READ data exceeds 8 bytes.\n"); + return -EINVAL; + } + + /* Dummy write to LD_PORT register and issue READ ops*/ + writel_relaxed(0, qspi->io_base + QSPI_LD_PORT_REG); + + /* Read data */ + bouncebuf[0] = readl_relaxed(qspi->io_base + QSPI_LD_PORT_REG); + if (len > 4) + bouncebuf[1] = readl_relaxed(qspi->io_base + QSPI_HD_PORT_REG); + + memcpy(buf, bouncebuf, len); + + return 0; +} + +static int phytium_qspi_adjust_op_size(struct spi_mem *mem, + struct spi_mem_op *op) +{ + if (op->data.nbytes > PHYTIUM_QSPI_MAX_XFER_SZ) + op->data.nbytes = PHYTIUM_QSPI_MAX_XFER_SZ; + + return 0; +} + +static bool phytium_qspi_supports_op(struct spi_mem *mem, + const struct spi_mem_op *op) +{ + int ret; + + ret = phytium_qspi_check_buswidth(op->cmd.buswidth); + + if (op->addr.nbytes) + ret |= phytium_qspi_check_buswidth(op->addr.buswidth); + + if (op->dummy.nbytes) + ret |= phytium_qspi_check_buswidth(op->dummy.buswidth); + + if (op->data.nbytes) + ret |= phytium_qspi_check_buswidth(op->data.buswidth); + + if (ret) + return false; + + /* Max 32 dummy clock cycles supported */ + if (op->dummy.nbytes && + (op->dummy.nbytes * 8 / op->dummy.buswidth > 32)) + return false; + + return spi_mem_default_supports_op(mem, op); +} + +static int phytium_qspi_exec_op(struct spi_mem *mem, + const struct spi_mem_op *op) +{ + struct phytium_qspi *qspi = spi_controller_get_devdata(mem->spi->master); + struct phytium_qspi_flash *flash = &qspi->flash[mem->spi->chip_select]; + u32 cmd, transfer; + int ret; + + dev_dbg(qspi->dev, "cmd:%#x mode: %d.%d.%d.%d addr:%#llx len:%#x\n", + op->cmd.opcode, op->cmd.buswidth, op->addr.buswidth, + op->dummy.buswidth, op->data.buswidth, op->addr.val, + op->data.nbytes); + + cmd = op->cmd.opcode << QSPI_CMD_PORT_CMD_SHIFT; + cmd |= flash->cs << QSPI_CMD_PORT_CS_SHIFT; + + ret = phytium_spi_nor_protocol_encode(op, &transfer); + if (ret) { + dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); + goto out; + } + cmd |= transfer << QSPI_CMD_PORT_TRANSFER_SHIFT; + + if (op->addr.nbytes) { + cmd |= QSPI_CMD_PORT_CMD_ADDR_MASK; + if (op->addr.nbytes == 4) + cmd |= QSPI_CMD_PORT_ADDR_SEL_MASK; + + /* Write target address to ADDR_PORT register */ + writel_relaxed(op->addr.val, qspi->io_base + QSPI_ADDR_PORT_REG); + } + + if (op->dummy.nbytes) { + cmd |= QSPI_CMD_PORT_LATENCY_MASK; + cmd |= ((op->dummy.nbytes * 8) / op->dummy.buswidth) << + QSPI_CMD_PORT_LATENCY_SHIFT; + } + + if (op->data.nbytes) { + cmd |= QSPI_CMD_PORT_DATA_XFER_MASK; + cmd &= ~QSPI_CMD_PORT_P_BUFFER_MASK; + cmd |= (op->data.nbytes-1) << QSPI_CMD_PORT_RW_NUM_SHIFT; + } + + cmd |= flash->clk_div; + writel_relaxed(cmd, qspi->io_base + QSPI_CMD_PORT_REG); + + if (op->data.dir == SPI_MEM_DATA_IN) { + ret = phytium_qspi_read_port(qspi, op->data.buf.in, op->data.nbytes); + if (ret) { + dev_err(qspi->dev, "Failed to read data from the port.\n"); + goto out; + } + } else if (op->data.dir == SPI_MEM_DATA_OUT) { + ret = phytium_qspi_write_port(qspi, op->data.buf.out, op->data.nbytes); + if (ret) { + dev_err(qspi->dev, "Failed to write data to the port.\n"); + goto out; + } + } else { + /* Dummy write to LD_PORT register and issue the command */ + writel_relaxed(0, qspi->io_base + QSPI_LD_PORT_REG); + } + +out: + return ret; +} + +static int phytium_qspi_dirmap_create(struct spi_mem_dirmap_desc *desc) +{ + struct spi_device *spi = desc->mem->spi; + struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); + struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; + struct spi_nor *nor = spi_mem_get_drvdata(desc->mem); + u32 cmd, transfer; + int ret = 0; + + if (!qspi->mm_base || !qspi->mm_size) { + ret = -EOPNOTSUPP; + goto out; + } + + if (!flash->base) { + flash->base = qspi->mm_base + qspi->used_size; + qspi->used_size += nor->mtd.size; + } + + /* Setup RD/WR_CFG register */ + if (desc->info.op_tmpl.data.dir == SPI_MEM_DATA_IN) { + cmd = desc->info.op_tmpl.cmd.opcode << QSPI_RD_CFG_RD_CMD_SHIFT; + ret = phytium_spi_nor_protocol_encode(&desc->info.op_tmpl, &transfer); + if (ret) { + dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); + goto out; + } + cmd |= transfer << QSPI_RD_CFG_RD_TRANSFER_SHIFT; + + if (desc->info.op_tmpl.addr.nbytes == 4) + cmd |= QSPI_RD_CFG_RD_ADDR_SEL_MASK; + + if (nor->read_dummy) { + cmd |= QSPI_RD_CFG_RD_LATENCY_MASK; + cmd |= (nor->read_dummy - 1) << QSPI_RD_CFG_DUMMY_SHIFT; + } + + cmd |= QSPI_RD_CFG_D_BUFFER_MASK; + cmd |= flash->clk_div & QSPI_RD_CFG_RD_SCK_SEL_MASK; + + writel_relaxed(cmd, qspi->io_base + QSPI_RD_CFG_REG); + qspi->rd_cfg_reg = cmd; + + dev_dbg(qspi->dev, "Create read dirmap and setup RD_CFG_REG [%#x].\n", cmd); + } else if (desc->info.op_tmpl.data.dir == SPI_MEM_DATA_OUT) { + cmd = desc->info.op_tmpl.cmd.opcode << QSPI_WR_CFG_WR_CMD_SHIFT; + ret = phytium_spi_nor_protocol_encode(&desc->info.op_tmpl, &transfer); + if (ret) { + dev_err(qspi->dev, "Unsupported SPI NOR protocol.\n"); + goto out; + } + cmd |= transfer << QSPI_WR_CFG_WR_TRANSFER_SHIFT; + + if (desc->info.op_tmpl.addr.nbytes == 4) + cmd |= QSPI_WR_CFG_WR_ADDR_SEL_MASK; + + cmd |= QSPI_WR_CFG_WR_MODE_MASK; + cmd |= flash->clk_div & QSPI_WR_CFG_WR_SCK_SEL_MASK; + qspi->wr_cfg_reg = cmd; + } else { + ret = -EINVAL; + } + +out: + return ret; +} + +static ssize_t phytium_qspi_dirmap_read(struct spi_mem_dirmap_desc *desc, + u64 offs, size_t len, void *buf) +{ + struct spi_device *spi = desc->mem->spi; + struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); + struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; + + void __iomem *src = flash->base + offs; + u8 *buf_rx = buf; + + memcpy_fromio(buf_rx, src, len); + + return len; +} + +static ssize_t phytium_qspi_dirmap_write(struct spi_mem_dirmap_desc *desc, + u64 offs, size_t len, const void *buf) +{ + struct spi_device *spi = desc->mem->spi; + struct phytium_qspi *qspi = spi_controller_get_devdata(spi->master); + struct phytium_qspi_flash *flash = &qspi->flash[spi->chip_select]; + + void __iomem *dst = flash->base + offs; + void __iomem *addr; + int i; + size_t mask = 0x03; + u_char tmp[4] = {0}; + + /* set wr_cfg for drimap write */ + writel_relaxed(qspi->wr_cfg_reg, qspi->io_base + QSPI_WR_CFG_REG); + + if (offs & 0x03) { + dev_err(qspi->dev, "Addr not four-byte aligned!\n"); + return -EINVAL; + } + + for (i = 0; i < len / 4; i++) + writel_relaxed(*(u32 *)(buf + 4 * i), dst + 4 * i); + + if (len & mask) { + addr = dst + (len & ~mask); + memcpy(tmp, buf + (len & ~mask), len & mask); + writel_relaxed(*(u32 *)(tmp), addr); + } + + //write cache data to flash + writel_relaxed(QSPI_FLUSH_EN, qspi->io_base + QSPI_FLUSH_REG); + + phytium_qspi_clear_wr(qspi, flash); + + return len; +} + +static int phytium_qspi_setup(struct spi_device *spi) +{ + struct spi_controller *ctrl = spi->master; + struct phytium_qspi *qspi = spi_controller_get_devdata(ctrl); + struct phytium_qspi_flash *flash; + uint clk_div; + + if (ctrl->busy) + return -EBUSY; + + flash = &qspi->flash[spi->chip_select]; + + flash->cs = spi->chip_select; + flash->spi = spi; + if (flash->cs >= PHYTIUM_QSPI_MAX_NORCHIP) { + dev_err(qspi->dev, "Flash CS is out of range.\n"); + return -EINVAL; + } + qspi->fnum++; + + + if (spi->max_speed_hz) { + clk_div = DIV_ROUND_UP(qspi->clk_rate, spi->max_speed_hz); + flash->clk_div = phytium_spi_nor_clac_clk_div(clk_div); + if (flash->clk_div == 65535) { + dev_err(qspi->dev, "qspi maximum frequency setting is error.\n"); + return -EINVAL; + } + } else + flash->clk_div = PHYTIUM_QSPI_DEFAULT_SCK_SEL; + + return 0; +} + +static struct spi_controller_mem_ops phytium_qspi_mem_ops = { + .adjust_op_size = phytium_qspi_adjust_op_size, + .supports_op = phytium_qspi_supports_op, + .exec_op = phytium_qspi_exec_op, + .dirmap_create = phytium_qspi_dirmap_create, + .dirmap_read = phytium_qspi_dirmap_read, + .dirmap_write = phytium_qspi_dirmap_write, +}; + +/** + * Direct mapping is supported only when all flashes under the controller + * are of the same size and the mapping address is continuous. For those + * cases which flashes are of different sizes, the driver offered a non-dirmap + * mem_ops with which read/write ops is executed through command port. + */ +static struct spi_controller_mem_ops phytium_qspi_mem_ops_nodirmap = { + .adjust_op_size = phytium_qspi_adjust_op_size, + .supports_op = phytium_qspi_supports_op, + .exec_op = phytium_qspi_exec_op, +}; + +/** + * phytium_qspi_probe - Probe method for the QSPI driver + * @pdev: Pointer to the platform_device structure + * + * This function initializes the driver data structures and the hardware. + * + * Return: 0 on success and error value on failure + */ +static int phytium_qspi_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct spi_controller *ctrl; + struct resource *res; + struct phytium_qspi *qspi; + int i, ret; + struct spi_mem *mem; + struct spi_nor *nor; + const char **reg_name_array; + + ctrl = spi_alloc_master(dev, sizeof(*qspi)); + if (!ctrl) + return -ENOMEM; + + ctrl->mode_bits = SPI_CPOL | SPI_CPHA | + SPI_RX_DUAL | SPI_RX_QUAD | + SPI_TX_DUAL | SPI_TX_QUAD; + ctrl->setup = phytium_qspi_setup; + ctrl->num_chipselect = PHYTIUM_QSPI_MAX_NORCHIP; + if (IS_ENABLED(CONFIG_OF)) + ctrl->dev.of_node = dev->of_node; + else if (IS_ENABLED(CONFIG_ACPI) && has_acpi_companion(dev)) + ctrl->dev.fwnode = dev->fwnode; + + qspi = spi_controller_get_devdata(ctrl); + qspi->ctrl = ctrl; + + reg_name_array = kcalloc(4, sizeof(*reg_name_array), GFP_KERNEL); + if (dev->of_node) + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi"); + else if (has_acpi_companion(dev)) { + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + fwnode_property_read_string_array(dev->fwnode, + "reg-names", reg_name_array, 2); + res->name = reg_name_array[0]; + } + qspi->io_base = devm_ioremap_resource(dev, res); + if (IS_ERR(qspi->io_base)) { + ret = PTR_ERR(qspi->io_base); + goto probe_master_put; + } + + if (dev->of_node) + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi_mm"); + else if (has_acpi_companion(dev)) { + res = platform_get_resource(pdev, IORESOURCE_MEM, 1); + res->name = reg_name_array[1]; + } + + qspi->mm_base = devm_ioremap_resource(dev, res); + if (IS_ERR(qspi->mm_base)) { + ret = PTR_ERR(qspi->mm_base); + goto probe_master_put; + } + + qspi->mm_size = resource_size(res); + if (qspi->mm_size > PHYTIUM_QSPI_MAX_MMAP_SZ) { + ret = -EINVAL; + goto probe_master_put; + } + qspi->used_size = 0; + + if (dev->of_node) { + qspi->clk = devm_clk_get(dev, NULL); + if (IS_ERR(qspi->clk)) { + ret = PTR_ERR(qspi->clk); + goto probe_master_put; + } + + qspi->clk_rate = clk_get_rate(qspi->clk); + if (!qspi->clk_rate) { + ret = -EINVAL; + goto probe_master_put; + } + + pm_runtime_enable(dev); + ret = pm_runtime_get_sync(dev); + if (ret < 0) { + pm_runtime_put_noidle(dev); + goto probe_master_put; + } + + ret = clk_prepare_enable(qspi->clk); + if (ret) { + dev_err(dev, "Failed to enable PCLK of the controller.\n"); + goto probe_clk_failed; + } + } else if (has_acpi_companion(dev)) { + qspi->clk_rate = 50000000; + } + qspi->nodirmap = device_property_present(dev, "no-direct-mapping"); + ctrl->mem_ops = qspi->nodirmap ? + &phytium_qspi_mem_ops_nodirmap : + &phytium_qspi_mem_ops; + + qspi->dev = dev; + platform_set_drvdata(pdev, qspi); + + ret = devm_spi_register_controller(dev, ctrl); + if (ret) { + dev_err(dev, "failed to register SPI controller: %d\n", ret); + goto probe_setup_failed; + } + + if (!qspi->nodirmap) { + /* + * The controller supports direct mapping access only if all + * flashes are of same size. + */ + + i = 0; + for (i = 0; qspi->fnum > i && i < PHYTIUM_QSPI_MAX_NORCHIP; i++) { + if (qspi->flash[i].spi) { + mem = spi_get_drvdata(qspi->flash[i].spi); + if (mem) { + nor = spi_mem_get_drvdata(mem); + if (nor) + qspi->flash[i].size = nor->mtd.size; + } + } + } + + for (i = 1; qspi->fnum > i && i < PHYTIUM_QSPI_MAX_NORCHIP; i++) { + if (qspi->flash[i].size != qspi->flash[0].size) { + dev_err(dev, "Flashes are of different sizes.\n"); + ret = -EINVAL; + goto probe_setup_failed; + } + } + + ret = phytium_qspi_flash_capacity_encode(qspi->flash[0].size, + &qspi->flash_cap); + if (ret) { + dev_err(dev, "Flash size is invalid.\n"); + goto probe_setup_failed; + } + + qspi->flash_cap |= qspi->fnum << QSPI_FLASH_CAP_NUM_SHIFT; + + writel_relaxed(qspi->flash_cap, qspi->io_base + QSPI_FLASH_CAP_REG); + } + + return 0; + +probe_setup_failed: + clk_disable_unprepare(qspi->clk); +probe_clk_failed: + pm_runtime_put_sync(dev); + pm_runtime_disable(dev); +probe_master_put: + + return ret; +} + +/** + * phytium_qspi_remove - Remove method for the QSPI driver + * @pdev: Pointer to the platform_device structure + * + * This function is called if a device is physically removed from the system + * or if the driver module is being unloaded. It free all resources allocated + * to the device. + * + * Return: 0 on success and error value on failure + */ +static int phytium_qspi_remove(struct platform_device *pdev) +{ + struct phytium_qspi *qspi = platform_get_drvdata(pdev); + + clk_disable_unprepare(qspi->clk); + + pm_runtime_put_sync(&pdev->dev); + pm_runtime_disable(&pdev->dev); + + return 0; +} + +static int __maybe_unused phytium_qspi_suspend(struct device *dev) +{ + return pm_runtime_force_suspend(dev); +} + +static int __maybe_unused phytium_qspi_resume(struct device *dev) +{ + struct phytium_qspi *qspi = dev_get_drvdata(dev); + + /* set rd_cfg reg and flash_capacity reg after resume */ + writel_relaxed(qspi->rd_cfg_reg, qspi->io_base + QSPI_RD_CFG_REG); + writel_relaxed(qspi->flash_cap, qspi->io_base + QSPI_FLASH_CAP_REG); + return pm_runtime_force_resume(dev); +} + +static const struct dev_pm_ops phytium_qspi_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_qspi_suspend, + phytium_qspi_resume) +}; + +static const struct of_device_id phytium_qspi_of_match[] = { + { .compatible = "phytium,qspi-nor" }, + { } +}; +static const struct acpi_device_id phytium_qspi_acpi_match[] = { + { "PHYT0011", 0 }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_qspi_of_match); +MODULE_DEVICE_TABLE(acpi, phytium_qspi_acpi_match); + +static struct platform_driver phytium_qspi_driver = { + .probe = phytium_qspi_probe, + .remove = phytium_qspi_remove, + .driver = { + .name = "phytium-qspi", + .of_match_table = of_match_ptr(phytium_qspi_of_match), + .acpi_match_table = ACPI_PTR(phytium_qspi_acpi_match), + .pm = &phytium_qspi_pm_ops, + }, +}; +module_platform_driver(phytium_qspi_driver); + +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium Quad SPI driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium.c new file mode 100644 index 0000000000000000000000000000000000000000..131baeacdcd14e079584a881de22ab13cbd3a7af --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium.c @@ -0,0 +1,501 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium SPI core controller driver. + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + * + * Derived from drivers/spi/spi-dw.c + * Copyright (c) 2009, Intel Corporation. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "spi-phytium.h" + +struct phytium_spi_chip { + u8 poll_mode; + u8 type; + void (*cs_control)(u32 command); +}; + +struct chip_data { + u8 cs; + u8 tmode; + u8 type; + + u8 poll_mode; + + u16 clk_div; + u32 speed_hz; + void (*cs_control)(u32 command); +}; + +static void phytium_spi_set_cs(struct spi_device *spi, bool enable) +{ + struct phytium_spi *fts = spi_master_get_devdata(spi->master); + struct chip_data *chip = spi_get_ctldata(spi); + u32 origin; + + if (chip && chip->cs_control) + chip->cs_control(!enable); + + if (!enable) { + phytium_writel(fts, SER, BIT(spi->chip_select)); + if (fts->global_cs) { + origin = phytium_readl(fts, GCSR); + phytium_writel(fts, GCSR, origin | (1 << spi->chip_select)); + } + } else { + if (fts->global_cs) { + origin = phytium_readl(fts, GCSR); + phytium_writel(fts, GCSR, origin & ~(1 << spi->chip_select)); + } + } +} + +static inline u32 tx_max(struct phytium_spi *fts) +{ + u32 tx_left, tx_room, rxtx_gap; + + tx_left = (fts->tx_end - fts->tx) / fts->n_bytes; + tx_room = fts->fifo_len - phytium_readl(fts, TXFLR); + + rxtx_gap = ((fts->rx_end - fts->rx) - (fts->tx_end - fts->tx)) + / fts->n_bytes; + + return min3(tx_left, tx_room, (u32) (fts->fifo_len - rxtx_gap)); +} + +static inline u32 rx_max(struct phytium_spi *fts) +{ + u32 rx_left = (fts->rx_end - fts->rx) / fts->n_bytes; + + return min_t(u32, rx_left, phytium_readl(fts, RXFLR)); +} + +static void phytium_writer(struct phytium_spi *fts) +{ + u32 max = tx_max(fts); + u16 txw = 0; + + while (max--) { + if (fts->tx_end - fts->len) { + if (fts->n_bytes == 1) + txw = *(u8 *)(fts->tx); + else + txw = *(u16 *)(fts->tx); + } + phytium_write_io_reg(fts, DR, txw); + fts->tx += fts->n_bytes; + } +} + +static void phytium_reader(struct phytium_spi *fts) +{ + u32 max = rx_max(fts); + u16 rxw; + + while (max--) { + rxw = phytium_read_io_reg(fts, DR); + if (fts->rx_end - fts->len) { + if (fts->n_bytes == 1) + *(u8 *)(fts->rx) = rxw; + else + *(u16 *)(fts->rx) = rxw; + } + fts->rx += fts->n_bytes; + } +} +int phytium_spi_check_status(struct phytium_spi *fts, bool raw) +{ + u32 irq_status; + int ret = 0; + + if (raw) + irq_status = phytium_readl(fts, RISR); + else + irq_status = phytium_readl(fts, ISR); + + if (irq_status & INT_RXOI) { + dev_err(&fts->master->dev, "RX FIFO overflow detected\n"); + ret = -EIO; + } + + if (irq_status & INT_RXUI) { + dev_err(&fts->master->dev, "RX FIFO underflow detected\n"); + ret = -EIO; + } + + if (irq_status & INT_TXOI) { + dev_err(&fts->master->dev, "TX FIFO overflow detected\n"); + ret = -EIO; + } + + /* Generically handle the erroneous situation */ + if (ret) { + spi_reset_chip(fts); + if (fts->master->cur_msg) + fts->master->cur_msg->status = ret; + } + return ret; +} +EXPORT_SYMBOL_GPL(phytium_spi_check_status); + +static void int_error_stop(struct phytium_spi *fts, const char *msg) +{ + spi_reset_chip(fts); + + dev_err(&fts->master->dev, "%s\n", msg); + fts->master->cur_msg->status = -EIO; + spi_finalize_current_transfer(fts->master); +} + +static irqreturn_t interrupt_transfer(struct phytium_spi *fts) +{ + u16 irq_status = phytium_readl(fts, ISR); + + if (irq_status & (INT_TXOI | INT_RXOI | INT_RXUI)) { + phytium_readl(fts, ICR); + int_error_stop(fts, "irq transfer: fifo overrun/underrun"); + return IRQ_HANDLED; + } + + phytium_reader(fts); + if (fts->rx_end == fts->rx) { + spi_mask_intr(fts, INT_TXEI); + spi_finalize_current_transfer(fts->master); + return IRQ_HANDLED; + } + if (irq_status & INT_TXEI) { + spi_mask_intr(fts, INT_TXEI); + phytium_writer(fts); + spi_umask_intr(fts, INT_TXEI); + } + + return IRQ_HANDLED; +} + +static irqreturn_t phytium_spi_irq(int irq, void *dev_id) +{ + struct spi_master *master = dev_id; + struct phytium_spi *fts = spi_master_get_devdata(master); + u16 irq_status = phytium_readl(fts, ISR) & 0x3f; + + if (!irq_status) + return IRQ_NONE; + + if (!master->cur_msg) { + spi_mask_intr(fts, INT_TXEI); + return IRQ_HANDLED; + } + + if (fts->transfer_handler) + return fts->transfer_handler(fts); + else + return IRQ_HANDLED; +} + +static int poll_transfer(struct phytium_spi *fts) +{ + do { + phytium_writer(fts); + phytium_reader(fts); + cpu_relax(); + } while (fts->rx_end > fts->rx); + + return 0; +} + +static int phytium_spi_transfer_one(struct spi_master *master, + struct spi_device *spi, struct spi_transfer *transfer) +{ + struct phytium_spi *fts = spi_master_get_devdata(master); + struct chip_data *chip = spi_get_ctldata(spi); + u8 imask = 0; + u16 txlevel = 0; + u16 clk_div; + u32 cr0; + int ret = 0; + + fts->dma_mapped = 0; + fts->tx = (void *)transfer->tx_buf; + fts->tx_end = fts->tx + transfer->len; + fts->rx = transfer->rx_buf; + fts->rx_end = fts->rx + transfer->len; + fts->len = transfer->len; + + spi_enable_chip(fts, 0); + + if (transfer->speed_hz != fts->current_freq) { + if (transfer->speed_hz != chip->speed_hz) { + clk_div = (fts->max_freq / transfer->speed_hz + 1) & + 0xfffe; + + chip->speed_hz = transfer->speed_hz; + chip->clk_div = clk_div; + } + fts->current_freq = transfer->speed_hz; + spi_set_clk(fts, chip->clk_div); + } + + if (transfer->bits_per_word == 8) + fts->n_bytes = 1; + else if (transfer->bits_per_word == 16) + fts->n_bytes = 2; + else + return -EINVAL; + + cr0 = (transfer->bits_per_word - 1) + | (chip->type << FRF_OFFSET) + | (spi->mode << MODE_OFFSET) + | (chip->tmode << TMOD_OFFSET); + + if (chip->cs_control) { + if (fts->rx && fts->tx) + chip->tmode = TMOD_TR; + else if (fts->rx) + chip->tmode = TMOD_RO; + else + chip->tmode = TMOD_TO; + + cr0 &= ~TMOD_MASK; + cr0 |= (chip->tmode << TMOD_OFFSET); + } + + phytium_writel(fts, CTRLR0, cr0); + + /* check if current transfer is a DMA transcation */ + if (master->can_dma && master->can_dma(master, spi, transfer)) + fts->dma_mapped = master->cur_msg_mapped; + + spi_mask_intr(fts, 0xff); + + /* DMA setup */ + if (fts->dma_mapped) { + ret = fts->dma_ops->dma_setup(fts, transfer); + if (ret) + return ret; + } + /* interrupt transfer mode setup */ + if (!chip->poll_mode && !fts->dma_mapped) { + txlevel = min_t(u16, fts->fifo_len / 2, fts->len / fts->n_bytes); + phytium_writel(fts, TXFLTR, txlevel); + + imask |= INT_TXEI | INT_TXOI | + INT_RXUI | INT_RXOI; + spi_umask_intr(fts, imask); + + fts->transfer_handler = interrupt_transfer; + } + + spi_enable_chip(fts, 1); + + if (fts->dma_mapped) + return fts->dma_ops->dma_transfer(fts, transfer); + + if (chip->poll_mode) + return poll_transfer(fts); + + return 1; +} + +static void phytium_spi_handle_err(struct spi_master *master, + struct spi_message *msg) +{ + struct phytium_spi *fts = spi_master_get_devdata(master); + + if (fts->dma_mapped) + fts->dma_ops->dma_stop(fts); + + spi_reset_chip(fts); +} + +static int phytium_spi_setup(struct spi_device *spi) +{ + struct phytium_spi_chip *chip_info = NULL; + struct chip_data *chip; + struct spi_master *master = spi->master; + struct phytium_spi *fts = spi_master_get_devdata(master); + u32 cr0; + + spi_enable_chip(fts, 0); + + chip = spi_get_ctldata(spi); + if (!chip) { + chip = kzalloc(sizeof(struct chip_data), GFP_KERNEL); + if (!chip) + return -ENOMEM; + spi_set_ctldata(spi, chip); + } + + chip_info = spi->controller_data; + + if (chip_info) { + if (chip_info->cs_control) + chip->cs_control = chip_info->cs_control; + + chip->poll_mode = chip_info->poll_mode; + chip->type = chip_info->type; + } + + chip->tmode = 0; + + cr0 = (spi->bits_per_word - 1) | (chip->type << FRF_OFFSET) | + (spi->mode << MODE_OFFSET) | (chip->tmode << TMOD_OFFSET); + + phytium_writel(fts, CTRLR0, cr0); + + spi_enable_chip(fts, 1); + + return 0; +} + +static void phytium_spi_cleanup(struct spi_device *spi) +{ + struct chip_data *chip = spi_get_ctldata(spi); + + kfree(chip); + spi_set_ctldata(spi, NULL); +} + +static void spi_hw_init(struct device *dev, struct phytium_spi *fts) +{ + spi_reset_chip(fts); + + if (!fts->fifo_len) { + u32 fifo; + + for (fifo = 1; fifo < 256; fifo++) { + phytium_writel(fts, TXFLTR, fifo); + if (fifo != phytium_readl(fts, TXFLTR)) + break; + } + phytium_writel(fts, TXFLTR, 0); + + fts->fifo_len = (fifo == 1) ? 0 : fifo; + dev_dbg(dev, "Detected FIFO size: %u bytes\n", fts->fifo_len); + } +} + +int phytium_spi_add_host(struct device *dev, struct phytium_spi *fts) +{ + struct spi_master *master; + int ret; + + WARN_ON(fts == NULL); + + master = spi_alloc_master(dev, 0); + if (!master) + return -ENOMEM; + + fts->master = master; + fts->dma_addr = (dma_addr_t)(fts->paddr + DR); + snprintf(fts->name, sizeof(fts->name), "phytium_spi%d", fts->bus_num); + + spi_hw_init(dev, fts); + + ret = request_irq(fts->irq, phytium_spi_irq, IRQF_SHARED, fts->name, master); + if (ret < 0) { + dev_err(dev, "can not get IRQ\n"); + goto err_free_master; + } + + master->use_gpio_descriptors = true; + master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_LOOP; + master->bits_per_word_mask = SPI_BPW_MASK(8) | SPI_BPW_MASK(16); + master->bus_num = fts->bus_num; + master->num_chipselect = fts->num_cs; + master->setup = phytium_spi_setup; + master->cleanup = phytium_spi_cleanup; + master->set_cs = phytium_spi_set_cs; + master->transfer_one = phytium_spi_transfer_one; + master->handle_err = phytium_spi_handle_err; + master->max_speed_hz = fts->max_freq; + master->dev.of_node = dev->of_node; + master->dev.fwnode = dev->fwnode; + master->flags = SPI_CONTROLLER_GPIO_SS; + + if (fts->dma_ops && fts->dma_ops->dma_init) { + ret = fts->dma_ops->dma_init(dev, fts); + if (ret) { + dev_warn(dev, "DMA init failed\n"); + } else { + master->can_dma = fts->dma_ops->can_dma; + master->flags |= SPI_CONTROLLER_MUST_TX; + } + } + + spi_master_set_devdata(master, fts); + ret = spi_register_controller(master); + if (ret) { + dev_err(&master->dev, "problem registering spi master\n"); + goto err_exit; + } + + return 0; + +err_exit: + if (fts->dma_ops && fts->dma_ops->dma_exit) + fts->dma_ops->dma_exit(fts); + spi_enable_chip(fts, 0); + free_irq(fts->irq, master); +err_free_master: + spi_master_put(master); + return ret; +} +EXPORT_SYMBOL_GPL(phytium_spi_add_host); + +void phytium_spi_remove_host(struct phytium_spi *fts) +{ + if (fts->dma_ops && fts->dma_ops->dma_exit) + fts->dma_ops->dma_exit(fts); + spi_shutdown_chip(fts); + + spi_unregister_controller(fts->master); + + free_irq(fts->irq, fts->master); +} +EXPORT_SYMBOL_GPL(phytium_spi_remove_host); + +int phytium_spi_suspend_host(struct phytium_spi *fts) +{ + int ret; + + ret = spi_controller_suspend(fts->master); + if (ret) + return ret; + + spi_shutdown_chip(fts); + return 0; +} +EXPORT_SYMBOL_GPL(phytium_spi_suspend_host); + +int phytium_spi_resume_host(struct phytium_spi *fts) +{ + int ret; + + spi_hw_init(&fts->master->dev, fts); + ret = spi_controller_resume(fts->master); + if (ret) + dev_err(&fts->master->dev, "fail to start queue (%d)\n", ret); + return ret; +} +EXPORT_SYMBOL_GPL(phytium_spi_resume_host); + +MODULE_AUTHOR("Zhu Mingshuai "); +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Driver for Phytium SPI controller core"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium.h new file mode 100644 index 0000000000000000000000000000000000000000..781a4fae52dbdb3b58f610df0dab8ed2b6c98a3e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/spi/spi-phytium.h @@ -0,0 +1,197 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Phytium SPI controller driver. + * + * Copyright (c) 2019-2024 Phytium Technology Co., Ltd. + */ +#ifndef PHYTIUM_SPI_HEADER_H +#define PHYTIUM_SPI_HEADER_H + +#include +#include +#include + +#define CTRLR0 0x00 +#define SSIENR 0x08 +#define SER 0x10 +#define BAUDR 0x14 +#define TXFLTR 0x18 +#define TXFLR 0x20 +#define RXFLR 0x24 +#define SR 0x28 +#define IMR 0x2c +#define ISR 0x30 +#define RISR 0x34 +#define ICR 0x48 +#define DMACR 0x4C +#define DMATDLR 0x50 +#define DMARDLR 0x54 +#define DR 0x60 +#define GCSR 0x100 + +#define FRF_OFFSET 4 +#define MODE_OFFSET 6 +#define TMOD_OFFSET 8 + +#define TMOD_MASK (0x3 << TMOD_OFFSET) +#define TMOD_TR 0x0 +#define TMOD_TO 0x1 +#define TMOD_RO 0x2 + +#define INT_TXEI (1 << 0) +#define INT_TXOI (1 << 1) +#define INT_RXUI (1 << 2) +#define INT_RXOI (1 << 3) +/* Bit fields in SR, 7 bits */ +#define SR_MASK 0x7f /* cover 7 bits */ +#define SR_BUSY (1 << 0) +#define SR_TF_NOT_FULL (1 << 1) +#define SR_TF_EMPT (1 << 2) +#define SR_RF_NOT_EMPT (1 << 3) +#define SR_RF_FULL (1 << 4) +#define SR_TX_ERR (1 << 5) +#define SR_DCOL (1 << 6) +/* Bit fields in DMACR */ +#define SPI_DMA_RDMAE (1 << 0) +#define SPI_DMA_TDMAE (1 << 1) +#define SPI_WAIT_RETRIES 5 +struct phytium_spi; +struct phytium_spi_dma_ops { + int (*dma_init)(struct device *dev, struct phytium_spi *fts); + void (*dma_exit)(struct phytium_spi *fts); + int (*dma_setup)(struct phytium_spi *fts, struct spi_transfer *xfer); + bool (*can_dma)(struct spi_controller *master, struct spi_device *spi, + struct spi_transfer *xfer); + int (*dma_transfer)(struct phytium_spi *fts, struct spi_transfer *xfer); + void (*dma_stop)(struct phytium_spi *fts); +}; + +struct phytium_spi { + struct spi_master *master; + char name[16]; + + void __iomem *regs; + bool global_cs; + bool dma_en; + unsigned long paddr; + int irq; + u32 fifo_len; + u32 max_freq; + + u32 reg_io_width; + u16 bus_num; + u16 num_cs; + int *cs; + + size_t len; + void *tx; + void *tx_end; + void *rx; + void *rx_end; + u8 n_bytes; + int dma_mapped; + irqreturn_t (*transfer_handler)(struct phytium_spi *fts); + /* DMA info */ + u32 current_freq; /* frequency in hz */ + struct dma_chan *txchan; + u32 txburst; + struct dma_chan *rxchan; + u32 rxburst; + u32 dma_sg_burst; + unsigned long dma_chan_busy; + dma_addr_t dma_addr; /* phy address of the Data register */ + const struct phytium_spi_dma_ops *dma_ops; + struct completion dma_completion; +}; + +static inline u32 phytium_readl(struct phytium_spi *fts, u32 offset) +{ + return __raw_readl(fts->regs + offset); +} +static inline u16 phytium_readw(struct phytium_spi *fts, u32 offset) +{ + return __raw_readw(fts->regs + offset); +} +static inline void phytium_writel(struct phytium_spi *fts, u32 offset, u32 val) +{ + __raw_writel(val, fts->regs + offset); +} +static inline void phytium_writew(struct phytium_spi *fts, u32 offset, u16 val) +{ + __raw_writew(val, fts->regs + offset); +} +static inline u32 phytium_read_io_reg(struct phytium_spi *fts, u32 offset) +{ + switch (fts->reg_io_width) { + case 2: + return phytium_readw(fts, offset); + case 4: + default: + return phytium_readl(fts, offset); + } +} +static inline void phytium_write_io_reg(struct phytium_spi *fts, + u32 offset, u32 val) +{ + switch (fts->reg_io_width) { + case 2: + phytium_writew(fts, offset, val); + break; + case 4: + default: + phytium_writel(fts, offset, val); + break; + } +} +static inline void spi_enable_chip(struct phytium_spi *fts, int enable) +{ + phytium_writel(fts, SSIENR, (enable ? 1 : 0)); +} +static inline void spi_set_clk(struct phytium_spi *fts, u16 div) +{ + phytium_writel(fts, BAUDR, div); +} +static inline void spi_mask_intr(struct phytium_spi *fts, u32 mask) +{ + u32 new_mask; + + new_mask = phytium_readl(fts, IMR) & ~mask; + phytium_writel(fts, IMR, new_mask); +} +static inline void spi_umask_intr(struct phytium_spi *fts, u32 mask) +{ + u32 new_mask; + + new_mask = phytium_readl(fts, IMR) | mask; + phytium_writel(fts, IMR, new_mask); +} +static inline void spi_global_cs(struct phytium_spi *fts) +{ + u32 global_cs_en, mask, setmask; + + mask = GENMASK(fts->num_cs-1, 0) << fts->num_cs; + setmask = ~GENMASK(fts->num_cs-1, 0); + global_cs_en = (phytium_readl(fts, GCSR) | mask) & setmask; + phytium_writel(fts, GCSR, global_cs_en); +} +static inline void spi_reset_chip(struct phytium_spi *fts) +{ + spi_enable_chip(fts, 0); + if (fts->global_cs) + spi_global_cs(fts); + spi_mask_intr(fts, 0xff); + spi_enable_chip(fts, 1); +} +static inline void spi_shutdown_chip(struct phytium_spi *fts) +{ + spi_enable_chip(fts, 0); + spi_set_clk(fts, 0); + fts->current_freq = 0; +} +extern int phytium_spi_add_host(struct device *dev, struct phytium_spi *fts); +extern void phytium_spi_remove_host(struct phytium_spi *fts); +extern int phytium_spi_suspend_host(struct phytium_spi *fts); +extern int phytium_spi_resume_host(struct phytium_spi *fts); +extern void phytium_spi_dmaops_set(struct phytium_spi *fts); +extern int phytium_spi_check_status(struct phytium_spi *fts, bool raw); +#endif /* PHYTIUM_SPI_HEADER_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..9de946cba80a74991ee16e06d00553151f53877a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_ANDROID) += android/ \ No newline at end of file diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..8d8fd5c29349a836cd3444dac91c2ffa02e10dec --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/Kconfig @@ -0,0 +1,21 @@ +# SPDX-License-Identifier: GPL-2.0 +menu "Android" + +if ANDROID + +config ASHMEM + bool "Enable the Anonymous Shared Memory Subsystem" + depends on SHMEM + help + The ashmem subsystem is a new shared memory allocator, similar to + POSIX SHM but with different behavior and sporting a simpler + file-based API. + + It is, in theory, a good memory allocator for low-memory devices, + because it can discard shared memory units when under memory pressure. + +source "drivers/staging/android/ion/Kconfig" + +endif # if ANDROID + +endmenu diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..3b66cd0b0ec56d3a9d1da56b280333d3a4cdb078 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/Makefile @@ -0,0 +1,6 @@ +# SPDX-License-Identifier: GPL-2.0 +ccflags-y += -I$(src) # needed for trace events + +obj-y += ion/ + +obj-$(CONFIG_ASHMEM) += ashmem.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/TODO b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/TODO new file mode 100644 index 0000000000000000000000000000000000000000..80eccfaf6db53c40f8beadee75e5f778e7532d44 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/TODO @@ -0,0 +1,13 @@ +TODO: + - sparse fixes + - rename files to be not so "generic" + - add proper arch dependencies as needed + - audit userspace interfaces to make sure they are sane + + +ion/ + - Split /dev/ion up into multiple nodes (e.g. /dev/ion/heap0) + - Better test framework (integration with VGEM was suggested) + +Please send patches to Greg Kroah-Hartman and Cc: +Arve Hjønnevåg and Riley Andrews diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ashmem.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ashmem.c new file mode 100644 index 0000000000000000000000000000000000000000..a1d11cc23ff5bc4ada0789ba5a754399d4e85dca --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ashmem.c @@ -0,0 +1,1192 @@ +// SPDX-License-Identifier: GPL-2.0 +/* mm/ashmem.c + * + * Anonymous Shared Memory Subsystem, ashmem + * + * Copyright (C) 2008 Google, Inc. + * + * Robert Love + */ + +#define pr_fmt(fmt) "ashmem: " fmt + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "ashmem.h" + +#define ASHMEM_NAME_PREFIX "dev/ashmem/" +#define ASHMEM_NAME_PREFIX_LEN (sizeof(ASHMEM_NAME_PREFIX) - 1) +#define ASHMEM_FULL_NAME_LEN (ASHMEM_NAME_LEN + ASHMEM_NAME_PREFIX_LEN) + +#ifdef CONFIG_PURGEABLE_ASHMEM +#define PURGEABLE_ASHMEM_INIT_REFCOUNT 1 +#define PURGEABLE_ASHMEM_UNPIN_REFCOUNT 0 +#define PURGEABLE_ASHMEM_PIN_OFFSET 0 +#define PURGEABLE_ASHMEM_PIN_LEN 0 +#endif + +/** + * struct ashmem_area - The anonymous shared memory area + * @name: The optional name in /proc/pid/maps + * @unpinned_list: The list of all ashmem areas + * @file: The shmem-based backing file + * @size: The size of the mapping, in bytes + * @prot_mask: The allowed protection bits, as vm_flags + * + * The lifecycle of this structure is from our parent file's open() until + * its release(). It is also protected by 'ashmem_mutex' + * + * Warning: Mappings do NOT pin this structure; It dies on close() + */ +struct ashmem_area { + char name[ASHMEM_FULL_NAME_LEN]; + struct list_head unpinned_list; + struct file *file; + size_t size; + unsigned long prot_mask; +#ifdef CONFIG_PURGEABLE_ASHMEM + bool is_purgeable; + bool purged; + unsigned int id; + unsigned int create_time; + int ref_count; +#endif +}; + +/** + * struct ashmem_range - A range of unpinned/evictable pages + * @lru: The entry in the LRU list + * @unpinned: The entry in its area's unpinned list + * @asma: The associated anonymous shared memory area. + * @pgstart: The starting page (inclusive) + * @pgend: The ending page (inclusive) + * @purged: The purge status (ASHMEM_NOT or ASHMEM_WAS_PURGED) + * + * The lifecycle of this structure is from unpin to pin. + * It is protected by 'ashmem_mutex' + */ +struct ashmem_range { + struct list_head lru; + struct list_head unpinned; + struct ashmem_area *asma; + size_t pgstart; + size_t pgend; + unsigned int purged; +}; + +/* LRU list of unpinned pages, protected by ashmem_mutex */ +static LIST_HEAD(ashmem_lru_list); + +static atomic_t ashmem_shrink_inflight = ATOMIC_INIT(0); +static DECLARE_WAIT_QUEUE_HEAD(ashmem_shrink_wait); + +/* + * long lru_count - The count of pages on our LRU list. + * + * This is protected by ashmem_mutex. + */ +static unsigned long lru_count; + +/* + * ashmem_mutex - protects the list of and each individual ashmem_area + * + * Lock Ordering: ashmex_mutex -> i_mutex -> i_alloc_sem + */ +static DEFINE_MUTEX(ashmem_mutex); + +static struct kmem_cache *ashmem_area_cachep __read_mostly; +static struct kmem_cache *ashmem_range_cachep __read_mostly; + +/* + * A separate lockdep class for the backing shmem inodes to resolve the lockdep + * warning about the race between kswapd taking fs_reclaim before inode_lock + * and write syscall taking inode_lock and then fs_reclaim. + * Note that such race is impossible because ashmem does not support write + * syscalls operating on the backing shmem. + */ +static struct lock_class_key backing_shmem_inode_class; + +void ashmem_mutex_lock(void) +{ + mutex_lock(&ashmem_mutex); +} + +void ashmem_mutex_unlock(void) +{ + mutex_unlock(&ashmem_mutex); +} + +static inline unsigned long range_size(struct ashmem_range *range) +{ + return range->pgend - range->pgstart + 1; +} + +static inline bool range_on_lru(struct ashmem_range *range) +{ + return range->purged == ASHMEM_NOT_PURGED; +} + +static inline bool page_range_subsumes_range(struct ashmem_range *range, + size_t start, size_t end) +{ + return (range->pgstart >= start) && (range->pgend <= end); +} + +static inline bool page_range_subsumed_by_range(struct ashmem_range *range, + size_t start, size_t end) +{ + return (range->pgstart <= start) && (range->pgend >= end); +} + +static inline bool page_in_range(struct ashmem_range *range, size_t page) +{ + return (range->pgstart <= page) && (range->pgend >= page); +} + +static inline bool page_range_in_range(struct ashmem_range *range, + size_t start, size_t end) +{ + return page_in_range(range, start) || page_in_range(range, end) || + page_range_subsumes_range(range, start, end); +} + +static inline bool range_before_page(struct ashmem_range *range, + size_t page) +{ + return range->pgend < page; +} + +#ifdef CONFIG_PURGEABLE_ASHMEM +static inline bool is_purgeable_ashmem(const struct ashmem_area *asma) +{ + return (asma && asma->is_purgeable); +} +#endif +#define PROT_MASK (PROT_EXEC | PROT_READ | PROT_WRITE) + +/** + * lru_add() - Adds a range of memory to the LRU list + * @range: The memory range being added. + * + * The range is first added to the end (tail) of the LRU list. + * After this, the size of the range is added to @lru_count + */ +static inline void lru_add(struct ashmem_range *range) +{ + list_add_tail(&range->lru, &ashmem_lru_list); + lru_count += range_size(range); +} + +/** + * lru_del() - Removes a range of memory from the LRU list + * @range: The memory range being removed + * + * The range is first deleted from the LRU list. + * After this, the size of the range is removed from @lru_count + */ +static inline void lru_del(struct ashmem_range *range) +{ + list_del(&range->lru); + lru_count -= range_size(range); +} + +/** + * range_alloc() - Allocates and initializes a new ashmem_range structure + * @asma: The associated ashmem_area + * @prev_range: The previous ashmem_range in the sorted asma->unpinned list + * @purged: Initial purge status (ASMEM_NOT_PURGED or ASHMEM_WAS_PURGED) + * @start: The starting page (inclusive) + * @end: The ending page (inclusive) + * + * This function is protected by ashmem_mutex. + */ +static void range_alloc(struct ashmem_area *asma, + struct ashmem_range *prev_range, unsigned int purged, + size_t start, size_t end, + struct ashmem_range **new_range) +{ + struct ashmem_range *range = *new_range; + + *new_range = NULL; + range->asma = asma; + range->pgstart = start; + range->pgend = end; + range->purged = purged; + + list_add_tail(&range->unpinned, &prev_range->unpinned); + + if (range_on_lru(range)) + lru_add(range); +} + +/** + * range_del() - Deletes and deallocates an ashmem_range structure + * @range: The associated ashmem_range that has previously been allocated + */ +static void range_del(struct ashmem_range *range) +{ + list_del(&range->unpinned); + if (range_on_lru(range)) + lru_del(range); + kmem_cache_free(ashmem_range_cachep, range); +} + +/** + * range_shrink() - Shrinks an ashmem_range + * @range: The associated ashmem_range being shrunk + * @start: The starting byte of the new range + * @end: The ending byte of the new range + * + * This does not modify the data inside the existing range in any way - It + * simply shrinks the boundaries of the range. + * + * Theoretically, with a little tweaking, this could eventually be changed + * to range_resize, and expand the lru_count if the new range is larger. + */ +static inline void range_shrink(struct ashmem_range *range, + size_t start, size_t end) +{ + size_t pre = range_size(range); + + range->pgstart = start; + range->pgend = end; + + if (range_on_lru(range)) + lru_count -= pre - range_size(range); +} + +/** + * ashmem_open() - Opens an Anonymous Shared Memory structure + * @inode: The backing file's index node(?) + * @file: The backing file + * + * Please note that the ashmem_area is not returned by this function - It is + * instead written to "file->private_data". + * + * Return: 0 if successful, or another code if unsuccessful. + */ +static int ashmem_open(struct inode *inode, struct file *file) +{ + struct ashmem_area *asma; + int ret; + + ret = generic_file_open(inode, file); + if (ret) + return ret; + + asma = kmem_cache_zalloc(ashmem_area_cachep, GFP_KERNEL); + if (!asma) + return -ENOMEM; + + INIT_LIST_HEAD(&asma->unpinned_list); + memcpy(asma->name, ASHMEM_NAME_PREFIX, ASHMEM_NAME_PREFIX_LEN); + asma->prot_mask = PROT_MASK; + file->private_data = asma; +#ifdef CONFIG_PURGEABLE_ASHMEM + asma->ref_count = PURGEABLE_ASHMEM_INIT_REFCOUNT; + asma->is_purgeable = false; + asma->purged = false; + asma->id = current->pid; + asma->create_time = ktime_get(); +#endif + return 0; +} + +/** + * ashmem_release() - Releases an Anonymous Shared Memory structure + * @ignored: The backing file's Index Node(?) - It is ignored here. + * @file: The backing file + * + * Return: 0 if successful. If it is anything else, go have a coffee and + * try again. + */ +static int ashmem_release(struct inode *ignored, struct file *file) +{ + struct ashmem_area *asma = file->private_data; + struct ashmem_range *range, *next; + + mutex_lock(&ashmem_mutex); + list_for_each_entry_safe(range, next, &asma->unpinned_list, unpinned) + range_del(range); + mutex_unlock(&ashmem_mutex); + + if (asma->file) + fput(asma->file); + kmem_cache_free(ashmem_area_cachep, asma); + + return 0; +} + +static ssize_t ashmem_read_iter(struct kiocb *iocb, struct iov_iter *iter) +{ + struct ashmem_area *asma = iocb->ki_filp->private_data; + int ret = 0; + + mutex_lock(&ashmem_mutex); + + /* If size is not set, or set to 0, always return EOF. */ + if (asma->size == 0) + goto out_unlock; + + if (!asma->file) { + ret = -EBADF; + goto out_unlock; + } + + /* + * asma and asma->file are used outside the lock here. We assume + * once asma->file is set it will never be changed, and will not + * be destroyed until all references to the file are dropped and + * ashmem_release is called. + */ + mutex_unlock(&ashmem_mutex); + ret = vfs_iter_read(asma->file, iter, &iocb->ki_pos, 0); + mutex_lock(&ashmem_mutex); + if (ret > 0) + asma->file->f_pos = iocb->ki_pos; +out_unlock: + mutex_unlock(&ashmem_mutex); + return ret; +} + +static loff_t ashmem_llseek(struct file *file, loff_t offset, int origin) +{ + struct ashmem_area *asma = file->private_data; + loff_t ret; + + mutex_lock(&ashmem_mutex); + + if (asma->size == 0) { + mutex_unlock(&ashmem_mutex); + return -EINVAL; + } + + if (!asma->file) { + mutex_unlock(&ashmem_mutex); + return -EBADF; + } + + mutex_unlock(&ashmem_mutex); + + ret = vfs_llseek(asma->file, offset, origin); + if (ret < 0) + return ret; + + /** Copy f_pos from backing file, since f_ops->llseek() sets it */ + file->f_pos = asma->file->f_pos; + return ret; +} + +static inline vm_flags_t calc_vm_may_flags(unsigned long prot) +{ + return _calc_vm_trans(prot, PROT_READ, VM_MAYREAD) | + _calc_vm_trans(prot, PROT_WRITE, VM_MAYWRITE) | + _calc_vm_trans(prot, PROT_EXEC, VM_MAYEXEC); +} + +static int ashmem_vmfile_mmap(struct file *file, struct vm_area_struct *vma) +{ + /* do not allow to mmap ashmem backing shmem file directly */ + return -EPERM; +} + +static unsigned long +ashmem_vmfile_get_unmapped_area(struct file *file, unsigned long addr, + unsigned long len, unsigned long pgoff, + unsigned long flags) +{ + return current->mm->get_unmapped_area(file, addr, len, pgoff, flags); +} + +static int ashmem_mmap(struct file *file, struct vm_area_struct *vma) +{ + static struct file_operations vmfile_fops; + struct ashmem_area *asma = file->private_data; + int ret = 0; + + mutex_lock(&ashmem_mutex); + + /* user needs to SET_SIZE before mapping */ + if (!asma->size) { + ret = -EINVAL; + goto out; + } + + /* requested mapping size larger than object size */ + if (vma->vm_end - vma->vm_start > PAGE_ALIGN(asma->size)) { + ret = -EINVAL; + goto out; + } + + /* requested protection bits must match our allowed protection mask */ + if ((vma->vm_flags & ~calc_vm_prot_bits(asma->prot_mask, 0)) & + calc_vm_prot_bits(PROT_MASK, 0)) { + ret = -EPERM; + goto out; + } + vm_flags_clear(vma, calc_vm_may_flags(~asma->prot_mask)); + + if (!asma->file) { + char *name = ASHMEM_NAME_DEF; + struct file *vmfile; + struct inode *inode; + + if (asma->name[ASHMEM_NAME_PREFIX_LEN] != '\0') + name = asma->name; + + /* ... and allocate the backing shmem file */ + vmfile = shmem_file_setup(name, asma->size, vma->vm_flags); + if (IS_ERR(vmfile)) { + ret = PTR_ERR(vmfile); + goto out; + } + vmfile->f_mode |= FMODE_LSEEK; + inode = file_inode(vmfile); + lockdep_set_class(&inode->i_rwsem, &backing_shmem_inode_class); + asma->file = vmfile; + /* + * override mmap operation of the vmfile so that it can't be + * remapped which would lead to creation of a new vma with no + * asma permission checks. Have to override get_unmapped_area + * as well to prevent VM_BUG_ON check for f_ops modification. + */ + if (!vmfile_fops.mmap) { + vmfile_fops = *vmfile->f_op; + vmfile_fops.mmap = ashmem_vmfile_mmap; + vmfile_fops.get_unmapped_area = + ashmem_vmfile_get_unmapped_area; + } + vmfile->f_op = &vmfile_fops; + } + get_file(asma->file); + + /* + * XXX - Reworked to use shmem_zero_setup() instead of + * shmem_set_file while we're in staging. -jstultz + */ + if (vma->vm_flags & VM_SHARED) { + ret = shmem_zero_setup(vma); + if (ret) { + fput(asma->file); + goto out; + } + } else { + vma_set_anonymous(vma); + } + + if (vma->vm_file) + fput(vma->vm_file); + vma->vm_file = asma->file; + +out: + mutex_unlock(&ashmem_mutex); + return ret; +} + +/* + * ashmem_shrink - our cache shrinker, called from mm/vmscan.c + * + * 'nr_to_scan' is the number of objects to scan for freeing. + * + * 'gfp_mask' is the mask of the allocation that got us into this mess. + * + * Return value is the number of objects freed or -1 if we cannot + * proceed without risk of deadlock (due to gfp_mask). + * + * We approximate LRU via least-recently-unpinned, jettisoning unpinned partial + * chunks of ashmem regions LRU-wise one-at-a-time until we hit 'nr_to_scan' + * pages freed. + */ +static unsigned long +ashmem_shrink_scan(struct shrinker *shrink, struct shrink_control *sc) +{ + unsigned long freed = 0; + + /* We might recurse into filesystem code, so bail out if necessary */ + if (!(sc->gfp_mask & __GFP_FS)) + return SHRINK_STOP; + + if (!mutex_trylock(&ashmem_mutex)) + return -1; + + while (!list_empty(&ashmem_lru_list)) { + struct ashmem_range *range = + list_first_entry(&ashmem_lru_list, typeof(*range), lru); + loff_t start = range->pgstart * PAGE_SIZE; + loff_t end = (range->pgend + 1) * PAGE_SIZE; + struct file *f = range->asma->file; + + get_file(f); + atomic_inc(&ashmem_shrink_inflight); + range->purged = ASHMEM_WAS_PURGED; +#ifdef CONFIG_PURGEABLE_ASHMEM + if (is_purgeable_ashmem(range->asma)) + range->asma->purged = true; +#endif + lru_del(range); + + freed += range_size(range); + mutex_unlock(&ashmem_mutex); + f->f_op->fallocate(f, + FALLOC_FL_PUNCH_HOLE | FALLOC_FL_KEEP_SIZE, + start, end - start); + fput(f); + if (atomic_dec_and_test(&ashmem_shrink_inflight)) + wake_up_all(&ashmem_shrink_wait); + if (!mutex_trylock(&ashmem_mutex)) + goto out; + if (--sc->nr_to_scan <= 0) + break; + } + mutex_unlock(&ashmem_mutex); +out: + return freed; +} + +static unsigned long +ashmem_shrink_count(struct shrinker *shrink, struct shrink_control *sc) +{ + /* + * note that lru_count is count of pages on the lru, not a count of + * objects on the list. This means the scan function needs to return the + * number of pages freed, not the number of objects scanned. + */ + return lru_count; +} + +static struct shrinker ashmem_shrinker = { + .count_objects = ashmem_shrink_count, + .scan_objects = ashmem_shrink_scan, + /* + * XXX (dchinner): I wish people would comment on why they need on + * significant changes to the default value here + */ + .seeks = DEFAULT_SEEKS * 4, +}; + +static int set_prot_mask(struct ashmem_area *asma, unsigned long prot) +{ + int ret = 0; + + mutex_lock(&ashmem_mutex); + + /* the user can only remove, not add, protection bits */ + if ((asma->prot_mask & prot) != prot) { + ret = -EINVAL; + goto out; + } + + /* does the application expect PROT_READ to imply PROT_EXEC? */ + if ((prot & PROT_READ) && (current->personality & READ_IMPLIES_EXEC)) + prot |= PROT_EXEC; + + asma->prot_mask = prot; + +out: + mutex_unlock(&ashmem_mutex); + return ret; +} + +static int set_name(struct ashmem_area *asma, void __user *name) +{ + int len; + int ret = 0; + char local_name[ASHMEM_NAME_LEN]; + + /* + * Holding the ashmem_mutex while doing a copy_from_user might cause + * an data abort which would try to access mmap_lock. If another + * thread has invoked ashmem_mmap then it will be holding the + * semaphore and will be waiting for ashmem_mutex, there by leading to + * deadlock. We'll release the mutex and take the name to a local + * variable that does not need protection and later copy the local + * variable to the structure member with lock held. + */ + len = strncpy_from_user(local_name, name, ASHMEM_NAME_LEN); + if (len < 0) + return len; + + mutex_lock(&ashmem_mutex); + /* cannot change an existing mapping's name */ + if (asma->file) + ret = -EINVAL; + else + strscpy(asma->name + ASHMEM_NAME_PREFIX_LEN, local_name, + ASHMEM_NAME_LEN); + + mutex_unlock(&ashmem_mutex); + return ret; +} + +static int get_name(struct ashmem_area *asma, void __user *name) +{ + int ret = 0; + size_t len; + /* + * Have a local variable to which we'll copy the content + * from asma with the lock held. Later we can copy this to the user + * space safely without holding any locks. So even if we proceed to + * wait for mmap_lock, it won't lead to deadlock. + */ + char local_name[ASHMEM_NAME_LEN]; + + mutex_lock(&ashmem_mutex); + if (asma->name[ASHMEM_NAME_PREFIX_LEN] != '\0') { + /* + * Copying only `len', instead of ASHMEM_NAME_LEN, bytes + * prevents us from revealing one user's stack to another. + */ + len = strlen(asma->name + ASHMEM_NAME_PREFIX_LEN) + 1; + memcpy(local_name, asma->name + ASHMEM_NAME_PREFIX_LEN, len); + } else { + len = sizeof(ASHMEM_NAME_DEF); + memcpy(local_name, ASHMEM_NAME_DEF, len); + } + mutex_unlock(&ashmem_mutex); + + /* + * Now we are just copying from the stack variable to userland + * No lock held + */ + if (copy_to_user(name, local_name, len)) + ret = -EFAULT; + return ret; +} + +/* + * ashmem_pin - pin the given ashmem region, returning whether it was + * previously purged (ASHMEM_WAS_PURGED) or not (ASHMEM_NOT_PURGED). + * + * Caller must hold ashmem_mutex. + */ +static int ashmem_pin(struct ashmem_area *asma, size_t pgstart, size_t pgend, + struct ashmem_range **new_range) +{ + struct ashmem_range *range, *next; + int ret = ASHMEM_NOT_PURGED; +#ifdef CONFIG_PURGEABLE_ASHMEM + if (is_purgeable_ashmem(asma)) { + asma->ref_count++; + if (asma->ref_count > 1) + return PM_SUCCESS; + } +#endif + list_for_each_entry_safe(range, next, &asma->unpinned_list, unpinned) { + /* moved past last applicable page; we can short circuit */ + if (range_before_page(range, pgstart)) + break; + + /* + * The user can ask us to pin pages that span multiple ranges, + * or to pin pages that aren't even unpinned, so this is messy. + * + * Four cases: + * 1. The requested range subsumes an existing range, so we + * just remove the entire matching range. + * 2. The requested range overlaps the start of an existing + * range, so we just update that range. + * 3. The requested range overlaps the end of an existing + * range, so we just update that range. + * 4. The requested range punches a hole in an existing range, + * so we have to update one side of the range and then + * create a new range for the other side. + */ + if (page_range_in_range(range, pgstart, pgend)) { + ret |= range->purged; + + /* Case #1: Easy. Just nuke the whole thing. */ + if (page_range_subsumes_range(range, pgstart, pgend)) { + range_del(range); + continue; + } + + /* Case #2: We overlap from the start, so adjust it */ + if (range->pgstart >= pgstart) { + range_shrink(range, pgend + 1, range->pgend); + continue; + } + + /* Case #3: We overlap from the rear, so adjust it */ + if (range->pgend <= pgend) { + range_shrink(range, range->pgstart, + pgstart - 1); + continue; + } + + /* + * Case #4: We eat a chunk out of the middle. A bit + * more complicated, we allocate a new range for the + * second half and adjust the first chunk's endpoint. + */ + range_alloc(asma, range, range->purged, + pgend + 1, range->pgend, new_range); + range_shrink(range, range->pgstart, pgstart - 1); + break; + } + } + + return ret; +} + +/* + * ashmem_unpin - unpin the given range of pages. Returns zero on success. + * + * Caller must hold ashmem_mutex. + */ +static int ashmem_unpin(struct ashmem_area *asma, size_t pgstart, size_t pgend, + struct ashmem_range **new_range) +{ + struct ashmem_range *range, *next; + unsigned int purged = ASHMEM_NOT_PURGED; +#ifdef CONFIG_PURGEABLE_ASHMEM + if (is_purgeable_ashmem(asma)) { + if (asma->ref_count > PURGEABLE_ASHMEM_UNPIN_REFCOUNT && + !(--asma->ref_count == PURGEABLE_ASHMEM_UNPIN_REFCOUNT)) + return PM_SUCCESS; + if (asma->ref_count < PURGEABLE_ASHMEM_UNPIN_REFCOUNT) { + asma->ref_count = PURGEABLE_ASHMEM_UNPIN_REFCOUNT; + return PM_FAIL; + } + } +#endif +restart: + list_for_each_entry_safe(range, next, &asma->unpinned_list, unpinned) { + /* short circuit: this is our insertion point */ + if (range_before_page(range, pgstart)) + break; + + /* + * The user can ask us to unpin pages that are already entirely + * or partially pinned. We handle those two cases here. + */ + if (page_range_subsumed_by_range(range, pgstart, pgend)) + return 0; + if (page_range_in_range(range, pgstart, pgend)) { + pgstart = min(range->pgstart, pgstart); + pgend = max(range->pgend, pgend); + purged |= range->purged; + range_del(range); + goto restart; + } + } + + range_alloc(asma, range, purged, pgstart, pgend, new_range); + return 0; +} + +/* + * ashmem_get_pin_status - Returns ASHMEM_IS_UNPINNED if _any_ pages in the + * given interval are unpinned and ASHMEM_IS_PINNED otherwise. + * + * Caller must hold ashmem_mutex. + */ +static int ashmem_get_pin_status(struct ashmem_area *asma, size_t pgstart, + size_t pgend) +{ + struct ashmem_range *range; + int ret = ASHMEM_IS_PINNED; +#ifdef CONFIG_PURGEABLE_ASHMEM + if (is_purgeable_ashmem(asma)) + return asma->ref_count; +#endif + list_for_each_entry(range, &asma->unpinned_list, unpinned) { + if (range_before_page(range, pgstart)) + break; + if (page_range_in_range(range, pgstart, pgend)) { + ret = ASHMEM_IS_UNPINNED; + break; + } + } + + return ret; +} + +static int ashmem_pin_unpin(struct ashmem_area *asma, unsigned long cmd, + void __user *p) +{ + struct ashmem_pin pin; + size_t pgstart, pgend; + int ret = -EINVAL; + struct ashmem_range *range = NULL; + + if (copy_from_user(&pin, p, sizeof(pin))) + return -EFAULT; + + if (cmd == ASHMEM_PIN || cmd == ASHMEM_UNPIN) { + range = kmem_cache_zalloc(ashmem_range_cachep, GFP_KERNEL); + if (!range) + return -ENOMEM; + } + + mutex_lock(&ashmem_mutex); + wait_event(ashmem_shrink_wait, !atomic_read(&ashmem_shrink_inflight)); +#ifdef CONFIG_PURGEABLE_ASHMEM + if (is_purgeable_ashmem(asma)) { + if (pin.offset != PURGEABLE_ASHMEM_PIN_OFFSET || + pin.len != PURGEABLE_ASHMEM_PIN_LEN) { + ret = -EINVAL; + goto out_unlock; + } + } +#endif + if (!asma->file) + goto out_unlock; + + /* per custom, you can pass zero for len to mean "everything onward" */ + if (!pin.len) + pin.len = PAGE_ALIGN(asma->size) - pin.offset; + + if ((pin.offset | pin.len) & ~PAGE_MASK) + goto out_unlock; + + if (((__u32)-1) - pin.offset < pin.len) + goto out_unlock; + + if (PAGE_ALIGN(asma->size) < pin.offset + pin.len) + goto out_unlock; + + pgstart = pin.offset / PAGE_SIZE; + pgend = pgstart + (pin.len / PAGE_SIZE) - 1; + + switch (cmd) { + case ASHMEM_PIN: + ret = ashmem_pin(asma, pgstart, pgend, &range); + break; + case ASHMEM_UNPIN: + ret = ashmem_unpin(asma, pgstart, pgend, &range); + break; + case ASHMEM_GET_PIN_STATUS: + ret = ashmem_get_pin_status(asma, pgstart, pgend); + break; + } + +out_unlock: + mutex_unlock(&ashmem_mutex); + if (range) + kmem_cache_free(ashmem_range_cachep, range); + + return ret; +} + +#ifdef CONFIG_PURGEABLE_ASHMEM +void ashmem_shrinkall(void) +{ + struct shrink_control sc = { + .gfp_mask = GFP_KERNEL, + .nr_to_scan = LONG_MAX, + }; + + ashmem_shrink_scan(&ashmem_shrinker, &sc); +} + +void ashmem_shrink_by_id(const unsigned int ashmem_id, const unsigned int create_time) +{ + struct ashmem_range *range, *next; + bool found = false; + + if (!mutex_trylock(&ashmem_mutex)) + return; + + list_for_each_entry_safe(range, next, &ashmem_lru_list, lru) { + if (!is_purgeable_ashmem(range->asma)) + continue; + if (range->asma->id != ashmem_id || + range->asma->create_time != create_time) + continue; + found = true; + range->asma->purged = true; + break; + } + if (!found) + goto out_unlock; + + loff_t start = range->pgstart * PAGE_SIZE; + loff_t end = (range->pgend + 1) * PAGE_SIZE; + struct file *f = range->asma->file; + + if (!f) + goto out_unlock; + get_file(f); + atomic_inc(&ashmem_shrink_inflight); + range->purged = ASHMEM_WAS_PURGED; + + lru_del(range); + mutex_unlock(&ashmem_mutex); + f->f_op->fallocate(f, FALLOC_FL_PUNCH_HOLE | FALLOC_FL_KEEP_SIZE, + start, end - start); + fput(f); + if (atomic_dec_and_test(&ashmem_shrink_inflight)) + wake_up_all(&ashmem_shrink_wait); + return; + +out_unlock: + mutex_unlock(&ashmem_mutex); +} + +static bool is_ashmem_unpin(struct ashmem_area *asma) +{ + struct ashmem_range *range, *next; + int count = 0; + + mutex_lock(&ashmem_mutex); + if (!asma) { + mutex_unlock(&ashmem_mutex); + return false; + } + list_for_each_entry_safe(range, next, &asma->unpinned_list, unpinned) + count++; + mutex_unlock(&ashmem_mutex); + return count > 0 ? true : false; +} + +static long purgeable_ashmem_cmd(struct ashmem_area *asma, unsigned int cmd) +{ + int ret = -EINVAL; + + if (!is_purgeable_ashmem(asma)) + return ret; + mutex_lock(&ashmem_mutex); + switch (cmd) { + case ASHMEM_GET_PURGEABLE: + ret = asma->is_purgeable; + break; + case PURGEABLE_ASHMEM_IS_PURGED: + ret = asma->purged; + break; + case PURGEABLE_ASHMEM_REBUILD_SUCCESS: + asma->purged = false; + ret = PM_SUCCESS; + break; + } + mutex_unlock(&ashmem_mutex); + return ret; +} + +bool get_purgeable_ashmem_metadata(struct file *f, struct purgeable_ashmem_metadata *pmdata) +{ + struct ashmem_area *asma = f->private_data; + + if (!asma) { + return false; + } + pmdata->name = asma->name; + pmdata->size = asma->size; + pmdata->refc = asma->ref_count; + pmdata->purged = asma->purged; + pmdata->is_purgeable = asma->is_purgeable; + pmdata->id = asma->id; + pmdata->create_time = asma->create_time; + return true; +} +#endif +static long ashmem_ioctl(struct file *file, unsigned int cmd, unsigned long arg) +{ + struct ashmem_area *asma = file->private_data; + long ret = -ENOTTY; + + switch (cmd) { + case ASHMEM_SET_NAME: + ret = set_name(asma, (void __user *)arg); + break; + case ASHMEM_GET_NAME: + ret = get_name(asma, (void __user *)arg); + break; + case ASHMEM_SET_SIZE: + ret = -EINVAL; + mutex_lock(&ashmem_mutex); + if (!asma->file) { + ret = 0; + asma->size = (size_t)arg; + } + mutex_unlock(&ashmem_mutex); + break; + case ASHMEM_GET_SIZE: + ret = asma->size; + break; + case ASHMEM_SET_PROT_MASK: + ret = set_prot_mask(asma, arg); + break; + case ASHMEM_GET_PROT_MASK: + ret = asma->prot_mask; + break; + case ASHMEM_PIN: + case ASHMEM_UNPIN: + case ASHMEM_GET_PIN_STATUS: + ret = ashmem_pin_unpin(asma, cmd, (void __user *)arg); + break; + case ASHMEM_PURGE_ALL_CACHES: + ret = -EPERM; + if (capable(CAP_SYS_ADMIN)) { + struct shrink_control sc = { + .gfp_mask = GFP_KERNEL, + .nr_to_scan = LONG_MAX, + }; + ret = ashmem_shrink_count(&ashmem_shrinker, &sc); + ashmem_shrink_scan(&ashmem_shrinker, &sc); + } + break; +#ifdef CONFIG_PURGEABLE_ASHMEM + case ASHMEM_SET_PURGEABLE: + if (is_ashmem_unpin(asma)) { + ret = PM_FAIL; + break; + } + mutex_lock(&ashmem_mutex); + if (asma) { + asma->is_purgeable = true; + ret = PM_SUCCESS; + } + mutex_unlock(&ashmem_mutex); + break; + case ASHMEM_GET_PURGEABLE: + fallthrough; + case PURGEABLE_ASHMEM_IS_PURGED: + fallthrough; + case PURGEABLE_ASHMEM_REBUILD_SUCCESS: + ret = purgeable_ashmem_cmd(asma, cmd); + break; +#endif + } + return ret; +} + +/* support of 32bit userspace on 64bit platforms */ +#ifdef CONFIG_COMPAT +static long compat_ashmem_ioctl(struct file *file, unsigned int cmd, + unsigned long arg) +{ + switch (cmd) { + case COMPAT_ASHMEM_SET_SIZE: + cmd = ASHMEM_SET_SIZE; + break; + case COMPAT_ASHMEM_SET_PROT_MASK: + cmd = ASHMEM_SET_PROT_MASK; + break; + } + return ashmem_ioctl(file, cmd, arg); +} +#endif +#ifdef CONFIG_PROC_FS +static void ashmem_show_fdinfo(struct seq_file *m, struct file *file) +{ + struct ashmem_area *asma = file->private_data; + + mutex_lock(&ashmem_mutex); + + if (asma->file) + seq_printf(m, "inode:\t%ld\n", file_inode(asma->file)->i_ino); + + if (asma->name[ASHMEM_NAME_PREFIX_LEN] != '\0') + seq_printf(m, "name:\t%s\n", + asma->name + ASHMEM_NAME_PREFIX_LEN); + + mutex_unlock(&ashmem_mutex); +} +#endif +static const struct file_operations ashmem_fops = { + .owner = THIS_MODULE, + .open = ashmem_open, + .release = ashmem_release, + .read_iter = ashmem_read_iter, + .llseek = ashmem_llseek, + .mmap = ashmem_mmap, + .unlocked_ioctl = ashmem_ioctl, +#ifdef CONFIG_COMPAT + .compat_ioctl = compat_ashmem_ioctl, +#endif +#ifdef CONFIG_PROC_FS + .show_fdinfo = ashmem_show_fdinfo, +#endif +}; + +int is_ashmem_file(struct file *file) +{ + return file->f_op == &ashmem_fops; +} + +static struct miscdevice ashmem_misc = { + .minor = MISC_DYNAMIC_MINOR, + .name = "ashmem", + .fops = &ashmem_fops, +}; + +size_t get_ashmem_size_by_file(struct file *f) +{ + struct ashmem_area *asma = f->private_data; + + if (asma) + return asma->size; + return 0; +} + +char *get_ashmem_name_by_file(struct file *f) +{ + struct ashmem_area *asma = f->private_data; + + if (asma) + return asma->name; + return NULL; +} + +static int __init ashmem_init(void) +{ + int ret = -ENOMEM; + + ashmem_area_cachep = kmem_cache_create("ashmem_area_cache", + sizeof(struct ashmem_area), + 0, 0, NULL); + if (!ashmem_area_cachep) { + pr_err("failed to create slab cache\n"); + goto out; + } + + ashmem_range_cachep = kmem_cache_create("ashmem_range_cache", + sizeof(struct ashmem_range), + 0, 0, NULL); + if (!ashmem_range_cachep) { + pr_err("failed to create slab cache\n"); + goto out_free1; + } + + ret = misc_register(&ashmem_misc); + if (ret) { + pr_err("failed to register misc device!\n"); + goto out_free2; + } + + ret = register_shrinker(&ashmem_shrinker, "ashmem-shrinker"); + if (ret) { + pr_err("failed to register shrinker!\n"); + goto out_demisc; + } + init_ashmem_process_info(); +#ifdef CONFIG_PURGEABLE_ASHMEM + init_purgeable_ashmem_trigger(); +#endif + pr_info("initialized\n"); + + return 0; + +out_demisc: + misc_deregister(&ashmem_misc); +out_free2: + kmem_cache_destroy(ashmem_range_cachep); +out_free1: + kmem_cache_destroy(ashmem_area_cachep); +out: + return ret; +} +device_initcall(ashmem_init); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ashmem.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ashmem.h new file mode 100644 index 0000000000000000000000000000000000000000..2f04163c67ed8c5d171e892a1375a5b4b4b84fbc --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ashmem.h @@ -0,0 +1,47 @@ +/* SPDX-License-Identifier: GPL-2.0 OR Apache-2.0 */ +/* + * include/linux/ashmem.h + * + * Copyright 2008 Google Inc. + * Author: Robert Love + */ + +#ifndef _LINUX_ASHMEM_H +#define _LINUX_ASHMEM_H + +#include +#include +#include + +#include "uapi/ashmem.h" + +/* support of 32bit userspace on 64bit platforms */ +#ifdef CONFIG_COMPAT +#define COMPAT_ASHMEM_SET_SIZE _IOW(__ASHMEMIOC, 3, compat_size_t) +#define COMPAT_ASHMEM_SET_PROT_MASK _IOW(__ASHMEMIOC, 5, unsigned int) +#endif + +int is_ashmem_file(struct file *file); +size_t get_ashmem_size_by_file(struct file *f); +char *get_ashmem_name_by_file(struct file *f); +void ashmem_mutex_lock(void); +void ashmem_mutex_unlock(void); + +#ifdef CONFIG_PURGEABLE_ASHMEM +struct purgeable_ashmem_metadata { + char *name; + size_t size; + int refc; + bool purged; + bool is_purgeable; + unsigned int id; + unsigned int create_time; +}; + +void ashmem_shrinkall(void); +void ashmem_shrink_by_id(const unsigned int ashmem_id, + const unsigned int create_time); +bool get_purgeable_ashmem_metadata(struct file *f, + struct purgeable_ashmem_metadata *pmdata); +#endif +#endif /* _LINUX_ASHMEM_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..7b7da979991e486c154e6b90a19b7925655b453b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/Kconfig @@ -0,0 +1,14 @@ +# SPDX-License-Identifier: GPL-2.0 +menuconfig ION + bool "Ion Memory Manager" + depends on HAS_DMA && MMU + select GENERIC_ALLOCATOR + select DMA_SHARED_BUFFER + help + Choose this option to enable the ION Memory Manager, + used by Android to efficiently allocate buffers + from userspace that can be shared between drivers. + If you're not using Android its probably safe to + say N here. + +source "drivers/staging/android/ion/heaps/Kconfig" diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..7f8fd0f537b4a73c37d80b2467b4d022bf5527f9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/Makefile @@ -0,0 +1,4 @@ +# SPDX-License-Identifier: GPL-2.0 +obj-$(CONFIG_ION) += ion.o ion_buffer.o ion_dma_buf.o ion_heap.o +CFLAGS_ion_buffer.o = -I$(src) +obj-y += heaps/ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..5034c45a397d187a9efb5c70420eeeb80d8f68a5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/Kconfig @@ -0,0 +1,15 @@ +# SPDX-License-Identifier: GPL-2.0 +config ION_SYSTEM_HEAP + tristate "Ion system heap" + depends on ION + help + Choose this option to enable the Ion system heap. The system heap + is backed by pages from the buddy allocator. If in doubt, say Y. + +config ION_CMA_HEAP + tristate "Ion CMA heap support" + depends on ION && DMA_CMA + help + Choose this option to enable CMA heaps with Ion. This heap is backed + by the Contiguous Memory Allocator (CMA). If your system has these + regions, you should say Y here. diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..82e36e89e978c6bb6f0b22f4b11fb38241204e7f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/Makefile @@ -0,0 +1,5 @@ +# SPDX-License-Identifier: GPL-2.0 +obj-$(CONFIG_ION_SYSTEM_HEAP) += ion_sys_heap.o +ion_sys_heap-y := ion_system_heap.o ion_page_pool.o + +obj-$(CONFIG_ION_CMA_HEAP) += ion_cma_heap.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_cma_heap.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_cma_heap.c new file mode 100644 index 0000000000000000000000000000000000000000..6ba7fd84c9eec8c39fd6f64b29831fc6bb18225d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_cma_heap.c @@ -0,0 +1,151 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * ION Memory Allocator CMA heap exporter + * + * Copyright (C) Linaro 2012 + * Author: for ST-Ericsson. + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +struct ion_cma_heap { + struct ion_heap heap; + struct cma *cma; +} cma_heaps[MAX_CMA_AREAS]; + +#define to_cma_heap(x) container_of(x, struct ion_cma_heap, heap) + +/* ION CMA heap operations functions */ +static int ion_cma_allocate(struct ion_heap *heap, struct ion_buffer *buffer, + unsigned long len, + unsigned long flags) +{ + struct ion_cma_heap *cma_heap = to_cma_heap(heap); + struct sg_table *table; + struct page *pages; + unsigned long size = PAGE_ALIGN(len); + unsigned long nr_pages = size >> PAGE_SHIFT; + unsigned long align = get_order(size); + int ret; + + if (align > CONFIG_CMA_ALIGNMENT) + align = CONFIG_CMA_ALIGNMENT; + + pages = cma_alloc(cma_heap->cma, nr_pages, align, false); + if (!pages) + return -ENOMEM; + + if (PageHighMem(pages)) { + unsigned long nr_clear_pages = nr_pages; + struct page *page = pages; + + while (nr_clear_pages > 0) { + void *vaddr = kmap_atomic(page); + + memset(vaddr, 0, PAGE_SIZE); + kunmap_atomic(vaddr); + page++; + nr_clear_pages--; + } + } else { + memset(page_address(pages), 0, size); + } + + table = kmalloc(sizeof(*table), GFP_KERNEL); + if (!table) + goto err; + + ret = sg_alloc_table(table, 1, GFP_KERNEL); + if (ret) + goto free_mem; + + sg_set_page(table->sgl, pages, size, 0); + + buffer->priv_virt = pages; + buffer->sg_table = table; + + ion_buffer_prep_noncached(buffer); + + return 0; + +free_mem: + kfree(table); +err: + cma_release(cma_heap->cma, pages, nr_pages); + return -ENOMEM; +} + +static void ion_cma_free(struct ion_buffer *buffer) +{ + struct ion_cma_heap *cma_heap = to_cma_heap(buffer->heap); + struct page *pages = buffer->priv_virt; + unsigned long nr_pages = PAGE_ALIGN(buffer->size) >> PAGE_SHIFT; + + /* release memory */ + cma_release(cma_heap->cma, pages, nr_pages); + /* release sg table */ + sg_free_table(buffer->sg_table); + kfree(buffer->sg_table); +} + +static struct ion_heap_ops ion_cma_ops = { + .allocate = ion_cma_allocate, + .free = ion_cma_free, +}; + +static int __ion_add_cma_heap(struct cma *cma, void *data) +{ + int *cma_nr = data; + struct ion_cma_heap *cma_heap; + int ret; + + if (*cma_nr >= MAX_CMA_AREAS) + return -EINVAL; + + cma_heap = &cma_heaps[*cma_nr]; + cma_heap->heap.ops = &ion_cma_ops; + cma_heap->heap.type = ION_HEAP_TYPE_DMA; + cma_heap->heap.name = cma_get_name(cma); + + ret = ion_device_add_heap(&cma_heap->heap); + if (ret) + goto out; + + cma_heap->cma = cma; + *cma_nr += 1; +out: + return 0; +} + +static int __init ion_cma_heap_init(void) +{ + int ret; + int nr = 0; + + ret = cma_for_each_area(__ion_add_cma_heap, &nr); + if (ret) { + for (nr = 0; nr < MAX_CMA_AREAS && cma_heaps[nr].cma; nr++) + ion_device_remove_heap(&cma_heaps[nr].heap); + } + + return ret; +} + +static void __exit ion_cma_heap_exit(void) +{ + int nr; + + for (nr = 0; nr < MAX_CMA_AREAS && cma_heaps[nr].cma; nr++) + ion_device_remove_heap(&cma_heaps[nr].heap); +} + +module_init(ion_cma_heap_init); +module_exit(ion_cma_heap_exit); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_page_pool.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_page_pool.c new file mode 100644 index 0000000000000000000000000000000000000000..efd6ce4cc0adb08ede39dcb17530520c1493d8f5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_page_pool.c @@ -0,0 +1,172 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * ION Memory Allocator page pool helpers + * + * Copyright (C) 2011 Google, Inc. + */ + +#include +#include +#include +#include + +#include "ion_page_pool.h" + +static inline struct page *ion_page_pool_alloc_pages(struct ion_page_pool *pool) +{ + if (fatal_signal_pending(current)) + return NULL; + return alloc_pages(pool->gfp_mask, pool->order); +} + +static void ion_page_pool_free_pages(struct ion_page_pool *pool, + struct page *page) +{ + __free_pages(page, pool->order); +} + +static void ion_page_pool_add(struct ion_page_pool *pool, struct page *page) +{ + mutex_lock(&pool->mutex); + if (PageHighMem(page)) { + list_add_tail(&page->lru, &pool->high_items); + pool->high_count++; + } else { + list_add_tail(&page->lru, &pool->low_items); + pool->low_count++; + } + + mod_node_page_state(page_pgdat(page), NR_KERNEL_MISC_RECLAIMABLE, + 1 << pool->order); + mutex_unlock(&pool->mutex); +} + +static struct page *ion_page_pool_remove(struct ion_page_pool *pool, bool high) +{ + struct page *page; + + if (high) { + BUG_ON(!pool->high_count); + page = list_first_entry(&pool->high_items, struct page, lru); + pool->high_count--; + } else { + BUG_ON(!pool->low_count); + page = list_first_entry(&pool->low_items, struct page, lru); + pool->low_count--; + } + + list_del(&page->lru); + mod_node_page_state(page_pgdat(page), NR_KERNEL_MISC_RECLAIMABLE, + -(1 << pool->order)); + return page; +} + +struct page *ion_page_pool_alloc(struct ion_page_pool *pool) +{ + struct page *page = NULL; + + BUG_ON(!pool); + + mutex_lock(&pool->mutex); + if (pool->high_count) + page = ion_page_pool_remove(pool, true); + else if (pool->low_count) + page = ion_page_pool_remove(pool, false); + mutex_unlock(&pool->mutex); + + if (!page) + page = ion_page_pool_alloc_pages(pool); + + return page; +} +EXPORT_SYMBOL_GPL(ion_page_pool_alloc); + +void ion_page_pool_free(struct ion_page_pool *pool, struct page *page) +{ + BUG_ON(pool->order != compound_order(page)); + + ion_page_pool_add(pool, page); +} +EXPORT_SYMBOL_GPL(ion_page_pool_free); + +static int ion_page_pool_total(struct ion_page_pool *pool, bool high) +{ + int count = pool->low_count; + + if (high) + count += pool->high_count; + + return count << pool->order; +} + +int ion_page_pool_nr_pages(struct ion_page_pool *pool) +{ + int nr_total_pages; + + mutex_lock(&pool->mutex); + nr_total_pages = ion_page_pool_total(pool, true); + mutex_unlock(&pool->mutex); + + return nr_total_pages; +} +EXPORT_SYMBOL_GPL(ion_page_pool_nr_pages); + +int ion_page_pool_shrink(struct ion_page_pool *pool, gfp_t gfp_mask, + int nr_to_scan) +{ + int freed = 0; + bool high; + + if (current_is_kswapd()) + high = true; + else + high = !!(gfp_mask & __GFP_HIGHMEM); + + if (nr_to_scan == 0) + return ion_page_pool_total(pool, high); + + while (freed < nr_to_scan) { + struct page *page; + + mutex_lock(&pool->mutex); + if (pool->low_count) { + page = ion_page_pool_remove(pool, false); + } else if (high && pool->high_count) { + page = ion_page_pool_remove(pool, true); + } else { + mutex_unlock(&pool->mutex); + break; + } + mutex_unlock(&pool->mutex); + ion_page_pool_free_pages(pool, page); + freed += (1 << pool->order); + } + + return freed; +} +EXPORT_SYMBOL_GPL(ion_page_pool_shrink); + +struct ion_page_pool *ion_page_pool_create(gfp_t gfp_mask, unsigned int order) +{ + struct ion_page_pool *pool = kmalloc(sizeof(*pool), GFP_KERNEL); + + if (!pool) + return NULL; + pool->high_count = 0; + pool->low_count = 0; + INIT_LIST_HEAD(&pool->low_items); + INIT_LIST_HEAD(&pool->high_items); + pool->gfp_mask = gfp_mask | __GFP_COMP; + pool->order = order; + mutex_init(&pool->mutex); + plist_node_init(&pool->list, order); + + return pool; +} +EXPORT_SYMBOL_GPL(ion_page_pool_create); + +void ion_page_pool_destroy(struct ion_page_pool *pool) +{ + kfree(pool); +} +EXPORT_SYMBOL_GPL(ion_page_pool_destroy); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_page_pool.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_page_pool.h new file mode 100644 index 0000000000000000000000000000000000000000..10c79090c7a019fe941e9646d4d47735d15a3126 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_page_pool.h @@ -0,0 +1,67 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * ION Page Pool kernel interface header + * + * Copyright (C) 2011 Google, Inc. + */ + +#ifndef _ION_PAGE_POOL_H +#define _ION_PAGE_POOL_H + +#include +#include +#include +#include + +/** + * functions for creating and destroying a heap pool -- allows you + * to keep a pool of pre allocated memory to use from your heap. Keeping + * a pool of memory that is ready for dma, ie any cached mapping have been + * invalidated from the cache, provides a significant performance benefit on + * many systems + */ + +/** + * struct ion_page_pool - pagepool struct + * @high_count: number of highmem items in the pool + * @low_count: number of lowmem items in the pool + * @high_items: list of highmem items + * @low_items: list of lowmem items + * @mutex: lock protecting this struct and especially the count + * item list + * @gfp_mask: gfp_mask to use from alloc + * @order: order of pages in the pool + * @list: plist node for list of pools + * + * Allows you to keep a pool of pre allocated pages to use from your heap. + * Keeping a pool of pages that is ready for dma, ie any cached mapping have + * been invalidated from the cache, provides a significant performance benefit + * on many systems + */ +struct ion_page_pool { + int high_count; + int low_count; + struct list_head high_items; + struct list_head low_items; + struct mutex mutex; + gfp_t gfp_mask; + unsigned int order; + struct plist_node list; +}; + +struct ion_page_pool *ion_page_pool_create(gfp_t gfp_mask, unsigned int order); +void ion_page_pool_destroy(struct ion_page_pool *pool); +struct page *ion_page_pool_alloc(struct ion_page_pool *pool); +void ion_page_pool_free(struct ion_page_pool *pool, struct page *page); +int ion_page_pool_nr_pages(struct ion_page_pool *pool); + +/** ion_page_pool_shrink - shrinks the size of the memory cached in the pool + * @pool: the pool + * @gfp_mask: the memory type to reclaim + * @nr_to_scan: number of items to shrink in pages + * + * returns the number of items freed in pages + */ +int ion_page_pool_shrink(struct ion_page_pool *pool, gfp_t gfp_mask, + int nr_to_scan); +#endif /* _ION_PAGE_POOL_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_system_heap.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_system_heap.c new file mode 100644 index 0000000000000000000000000000000000000000..45d23bea38228e40f6b75cfe8a7e57d46bddd728 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/heaps/ion_system_heap.c @@ -0,0 +1,344 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * ION Memory Allocator system heap exporter + * + * Copyright (C) 2011 Google, Inc. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "ion_page_pool.h" + +#define NUM_ORDERS ARRAY_SIZE(orders) + +static gfp_t high_order_gfp_flags = (GFP_HIGHUSER | __GFP_ZERO | __GFP_NOWARN | + __GFP_NORETRY) & ~__GFP_RECLAIM; +static gfp_t low_order_gfp_flags = GFP_HIGHUSER | __GFP_ZERO; +static const unsigned int orders[] = {8, 4, 0}; + +static int order_to_index(unsigned int order) +{ + int i; + + for (i = 0; i < NUM_ORDERS; i++) + if (order == orders[i]) + return i; + BUG(); + return -1; +} + +static inline unsigned int order_to_size(int order) +{ + return PAGE_SIZE << order; +} + +struct ion_system_heap { + struct ion_heap heap; + struct ion_page_pool *pools[NUM_ORDERS]; +}; + +static struct page *alloc_buffer_page(struct ion_system_heap *heap, + struct ion_buffer *buffer, + unsigned long order) +{ + struct ion_page_pool *pool = heap->pools[order_to_index(order)]; + + return ion_page_pool_alloc(pool); +} + +static void free_buffer_page(struct ion_system_heap *heap, + struct ion_buffer *buffer, struct page *page) +{ + struct ion_page_pool *pool; + unsigned int order = compound_order(page); + + /* go to system */ + if (buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE) { + __free_pages(page, order); + return; + } + + pool = heap->pools[order_to_index(order)]; + + ion_page_pool_free(pool, page); +} + +static struct page *alloc_largest_available(struct ion_system_heap *heap, + struct ion_buffer *buffer, + unsigned long size, + unsigned int max_order) +{ + struct page *page; + int i; + + for (i = 0; i < NUM_ORDERS; i++) { + if (size < order_to_size(orders[i])) + continue; + if (max_order < orders[i]) + continue; + + page = alloc_buffer_page(heap, buffer, orders[i]); + if (!page) + continue; + + return page; + } + + return NULL; +} + +static int ion_system_heap_allocate(struct ion_heap *heap, + struct ion_buffer *buffer, + unsigned long size, + unsigned long flags) +{ + struct ion_system_heap *sys_heap = container_of(heap, + struct ion_system_heap, + heap); + struct sg_table *table; + struct scatterlist *sg; + struct list_head pages; + struct page *page, *tmp_page; + int i = 0; + unsigned long size_remaining = PAGE_ALIGN(size); + unsigned int max_order = orders[0]; + struct list_head lists[8]; + unsigned int block_index[8] = {0}; + unsigned int block_1M = 0; + unsigned int block_64K = 0; + unsigned int maximum; + int j; + + if (size / PAGE_SIZE > totalram_pages() / 2) + return -ENOMEM; + + INIT_LIST_HEAD(&pages); + for (i = 0; i < 8; i++) + INIT_LIST_HEAD(&lists[i]); + + i = 0; + while (size_remaining > 0) { + page = alloc_largest_available(sys_heap, buffer, size_remaining, + max_order); + if (!page) + goto free_pages; + + size_remaining -= page_size(page); + max_order = compound_order(page); + if (max_order) { + if (max_order == 8) + block_1M++; + if (max_order == 4) + block_64K++; + list_add_tail(&page->lru, &pages); + } else { + dma_addr_t phys = page_to_phys(page); + unsigned int bit12_14 = (phys >> 12) & 0x7; + + list_add_tail(&page->lru, &lists[bit12_14]); + block_index[bit12_14]++; + } + + i++; + } + + pr_debug("%s, %d, i = %d, size = %ld\n", __func__, __LINE__, i, size); + + table = kmalloc(sizeof(*table), GFP_KERNEL); + if (!table) + goto free_pages; + + if (sg_alloc_table(table, i, GFP_KERNEL)) + goto free_table; + + maximum = block_index[0]; + for (i = 1; i < 8; i++) + maximum = max(maximum, block_index[i]); + + pr_debug("%s, %d, maximum = %d, block_1M = %d, block_64K = %d\n", + __func__, __LINE__, maximum, block_1M, block_64K); + + for (i = 0; i < 8; i++) + pr_debug("block_index[%d] = %d\n", i, block_index[i]); + + sg = table->sgl; + list_for_each_entry_safe(page, tmp_page, &pages, lru) { + sg_set_page(sg, page, page_size(page), 0); + sg = sg_next(sg); + list_del(&page->lru); + } + + for (i = 0; i < maximum; i++) { + for (j = 0; j < 8; j++) { + if (!list_empty(&lists[j])) { + page = list_first_entry(&lists[j], struct page, + lru); + sg_set_page(sg, page, PAGE_SIZE, 0); + sg = sg_next(sg); + list_del(&page->lru); + } + } + } + + buffer->sg_table = table; + + ion_buffer_prep_noncached(buffer); + + return 0; + +free_table: + kfree(table); +free_pages: + list_for_each_entry_safe(page, tmp_page, &pages, lru) + free_buffer_page(sys_heap, buffer, page); + + for (i = 0; i < 8; i++) { + list_for_each_entry_safe(page, tmp_page, &lists[i], lru) + free_buffer_page(sys_heap, buffer, page); + } + return -ENOMEM; +} + +static void ion_system_heap_free(struct ion_buffer *buffer) +{ + struct ion_system_heap *sys_heap = container_of(buffer->heap, + struct ion_system_heap, + heap); + struct sg_table *table = buffer->sg_table; + struct scatterlist *sg; + int i; + + /* zero the buffer before goto page pool */ + if (!(buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE)) + ion_buffer_zero(buffer); + + for_each_sgtable_sg(table, sg, i) + free_buffer_page(sys_heap, buffer, sg_page(sg)); + sg_free_table(table); + kfree(table); +} + +static int ion_system_heap_shrink(struct ion_heap *heap, gfp_t gfp_mask, + int nr_to_scan) +{ + struct ion_page_pool *pool; + struct ion_system_heap *sys_heap; + int nr_total = 0; + int i, nr_freed; + int only_scan = 0; + + sys_heap = container_of(heap, struct ion_system_heap, heap); + + if (!nr_to_scan) + only_scan = 1; + + for (i = 0; i < NUM_ORDERS; i++) { + pool = sys_heap->pools[i]; + + if (only_scan) { + nr_total += ion_page_pool_shrink(pool, + gfp_mask, + nr_to_scan); + + } else { + nr_freed = ion_page_pool_shrink(pool, + gfp_mask, + nr_to_scan); + nr_to_scan -= nr_freed; + nr_total += nr_freed; + if (nr_to_scan <= 0) + break; + } + } + return nr_total; +} + +static long ion_system_get_pool_size(struct ion_heap *heap) +{ + struct ion_system_heap *sys_heap; + long total_pages = 0; + int i; + + sys_heap = container_of(heap, struct ion_system_heap, heap); + for (i = 0; i < NUM_ORDERS; i++) + total_pages += ion_page_pool_nr_pages(sys_heap->pools[i]); + + return total_pages; +} + +static void ion_system_heap_destroy_pools(struct ion_page_pool **pools) +{ + int i; + + for (i = 0; i < NUM_ORDERS; i++) + if (pools[i]) + ion_page_pool_destroy(pools[i]); +} + +static int ion_system_heap_create_pools(struct ion_page_pool **pools) +{ + int i; + + for (i = 0; i < NUM_ORDERS; i++) { + struct ion_page_pool *pool; + gfp_t gfp_flags = low_order_gfp_flags; + + if (orders[i] > 4) + gfp_flags = high_order_gfp_flags; + + pool = ion_page_pool_create(gfp_flags, orders[i]); + if (!pool) + goto err_create_pool; + pools[i] = pool; + } + + return 0; + +err_create_pool: + ion_system_heap_destroy_pools(pools); + return -ENOMEM; +} + +static struct ion_heap_ops system_heap_ops = { + .allocate = ion_system_heap_allocate, + .free = ion_system_heap_free, + .shrink = ion_system_heap_shrink, + .get_pool_size = ion_system_get_pool_size, +}; + +static struct ion_system_heap system_heap = { + .heap = { + .ops = &system_heap_ops, + .type = ION_HEAP_TYPE_SYSTEM, + .flags = ION_HEAP_FLAG_DEFER_FREE, + .name = "ion_system_heap", + } +}; + +static int __init ion_system_heap_init(void) +{ + int ret = ion_system_heap_create_pools(system_heap.pools); + if (ret) + return ret; + + return ion_device_add_heap(&system_heap.heap); +} + +static void __exit ion_system_heap_exit(void) +{ + ion_device_remove_heap(&system_heap.heap); + ion_system_heap_destroy_pools(system_heap.pools); +} + +module_init(ion_system_heap_init); +module_exit(ion_system_heap_exit); +MODULE_LICENSE("GPL v2"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion.c new file mode 100644 index 0000000000000000000000000000000000000000..3d9ec5f1045cb83534468a01c4dd955ceaed5f16 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion.c @@ -0,0 +1,518 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * ION Memory Allocator + * + * Copyright (C) 2011 Google, Inc. + * Copyright (c) 2019, The Linux Foundation. All rights reserved. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "ion_private.h" + +#define ION_CURRENT_ABI_VERSION 2 + +static struct ion_device *internal_dev; + +/* Entry into ION allocator for rest of the kernel */ +struct dma_buf *ion_alloc(size_t len, unsigned int heap_id_mask, + unsigned int flags) +{ + return ion_dmabuf_alloc(internal_dev, len, heap_id_mask, flags); +} +EXPORT_SYMBOL_GPL(ion_alloc); + +int ion_free(struct ion_buffer *buffer) +{ + return ion_buffer_destroy(internal_dev, buffer); +} +EXPORT_SYMBOL_GPL(ion_free); + +static int ion_alloc_fd(size_t len, unsigned int heap_id_mask, + unsigned int flags) +{ + int fd; + struct dma_buf *dmabuf; + + dmabuf = ion_dmabuf_alloc(internal_dev, len, heap_id_mask, flags); + if (IS_ERR(dmabuf)) + return PTR_ERR(dmabuf); + + fd = dma_buf_fd(dmabuf, O_CLOEXEC); + if (fd < 0) + dma_buf_put(dmabuf); + + return fd; +} + +size_t ion_query_heaps_kernel(struct ion_heap_data *hdata, size_t size) +{ + struct ion_device *dev = internal_dev; + size_t i = 0, num_heaps = 0; + struct ion_heap *heap; + + down_read(&dev->lock); + + // If size is 0, return without updating hdata. + if (size == 0) { + num_heaps = dev->heap_cnt; + goto out; + } + + plist_for_each_entry(heap, &dev->heaps, node) { + strncpy(hdata[i].name, heap->name, MAX_HEAP_NAME); + hdata[i].name[MAX_HEAP_NAME - 1] = '\0'; + hdata[i].type = heap->type; + hdata[i].heap_id = heap->id; + + i++; + if (i >= size) + break; + } + + num_heaps = i; +out: + up_read(&dev->lock); + return num_heaps; +} +EXPORT_SYMBOL_GPL(ion_query_heaps_kernel); + +static int ion_query_heaps(struct ion_heap_query *query) +{ + struct ion_device *dev = internal_dev; + struct ion_heap_data __user *buffer = u64_to_user_ptr(query->heaps); + int ret = -EINVAL, cnt = 0, max_cnt; + struct ion_heap *heap; + struct ion_heap_data hdata; + + memset(&hdata, 0, sizeof(hdata)); + + down_read(&dev->lock); + if (!buffer) { + query->cnt = dev->heap_cnt; + ret = 0; + goto out; + } + + if (query->cnt <= 0) + goto out; + + max_cnt = query->cnt; + + plist_for_each_entry(heap, &dev->heaps, node) { + strncpy(hdata.name, heap->name, MAX_HEAP_NAME); + hdata.name[sizeof(hdata.name) - 1] = '\0'; + hdata.type = heap->type; + hdata.heap_id = heap->id; + + if (copy_to_user(&buffer[cnt], &hdata, sizeof(hdata))) { + ret = -EFAULT; + goto out; + } + + cnt++; + if (cnt >= max_cnt) + break; + } + + query->cnt = cnt; + ret = 0; +out: + up_read(&dev->lock); + return ret; +} + +union ion_ioctl_arg { + struct ion_allocation_data allocation; + struct ion_heap_query query; + u32 ion_abi_version; +}; + +static int validate_ioctl_arg(unsigned int cmd, union ion_ioctl_arg *arg) +{ + switch (cmd) { + case ION_IOC_HEAP_QUERY: + if (arg->query.reserved0 || + arg->query.reserved1 || + arg->query.reserved2) + return -EINVAL; + break; + default: + break; + } + + return 0; +} + +static long ion_ioctl(struct file *filp, unsigned int cmd, unsigned long arg) +{ + int ret = 0; + union ion_ioctl_arg data; + + if (_IOC_SIZE(cmd) > sizeof(data)) + return -EINVAL; + + /* + * The copy_from_user is unconditional here for both read and write + * to do the validate. If there is no write for the ioctl, the + * buffer is cleared + */ + if (copy_from_user(&data, (void __user *)arg, _IOC_SIZE(cmd))) + return -EFAULT; + + ret = validate_ioctl_arg(cmd, &data); + if (ret) { + pr_warn_once("%s: ioctl validate failed\n", __func__); + return ret; + } + + if (!(_IOC_DIR(cmd) & _IOC_WRITE)) + memset(&data, 0, sizeof(data)); + + switch (cmd) { + case ION_IOC_ALLOC: + { + int fd; + + fd = ion_alloc_fd(data.allocation.len, + data.allocation.heap_id_mask, + data.allocation.flags); + if (fd < 0) + return fd; + + data.allocation.fd = fd; + + break; + } + case ION_IOC_HEAP_QUERY: + ret = ion_query_heaps(&data.query); + break; + case ION_IOC_ABI_VERSION: + data.ion_abi_version = ION_CURRENT_ABI_VERSION; + break; + default: + return -ENOTTY; + } + + if (_IOC_DIR(cmd) & _IOC_READ) { + if (copy_to_user((void __user *)arg, &data, _IOC_SIZE(cmd))) + return -EFAULT; + } + return ret; +} + +static const struct file_operations ion_fops = { + .owner = THIS_MODULE, + .unlocked_ioctl = ion_ioctl, + .compat_ioctl = compat_ptr_ioctl, +}; + +static int debug_shrink_set(void *data, u64 val) +{ + struct ion_heap *heap = data; + struct shrink_control sc; + int objs; + + sc.gfp_mask = GFP_HIGHUSER; + sc.nr_to_scan = val; + + if (!val) { + objs = heap->shrinker.count_objects(&heap->shrinker, &sc); + sc.nr_to_scan = objs; + } + + heap->shrinker.scan_objects(&heap->shrinker, &sc); + return 0; +} + +static int debug_shrink_get(void *data, u64 *val) +{ + struct ion_heap *heap = data; + struct shrink_control sc; + int objs; + + sc.gfp_mask = GFP_HIGHUSER; + sc.nr_to_scan = 0; + + objs = heap->shrinker.count_objects(&heap->shrinker, &sc); + *val = objs; + return 0; +} + +DEFINE_SIMPLE_ATTRIBUTE(debug_shrink_fops, debug_shrink_get, + debug_shrink_set, "%llu\n"); + +static int ion_assign_heap_id(struct ion_heap *heap, struct ion_device *dev) +{ + int id_bit = -EINVAL; + int start_bit = -1, end_bit = -1; + + switch (heap->type) { + case ION_HEAP_TYPE_SYSTEM: + id_bit = __ffs(ION_HEAP_SYSTEM); + break; + case ION_HEAP_TYPE_DMA: + start_bit = __ffs(ION_HEAP_DMA_START); + end_bit = __ffs(ION_HEAP_DMA_END); + break; + case ION_HEAP_TYPE_CUSTOM ... ION_HEAP_TYPE_MAX: + start_bit = __ffs(ION_HEAP_CUSTOM_START); + end_bit = __ffs(ION_HEAP_CUSTOM_END); + break; + default: + return -EINVAL; + } + + /* For carveout, dma & custom heaps, we first let the heaps choose their + * own IDs. This allows the old behaviour of knowing the heap ids + * of these type of heaps in advance in user space. If a heap with + * that ID already exists, it is an error. + * + * If the heap hasn't picked an id by itself, then we assign it + * one. + */ + if (id_bit < 0) { + if (heap->id) { + id_bit = __ffs(heap->id); + if (id_bit < start_bit || id_bit > end_bit) + return -EINVAL; + } else { + id_bit = find_next_zero_bit(dev->heap_ids, end_bit + 1, + start_bit); + if (id_bit > end_bit) + return -ENOSPC; + } + } + + if (test_and_set_bit(id_bit, dev->heap_ids)) + return -EEXIST; + heap->id = id_bit; + dev->heap_cnt++; + + return 0; +} + +int __ion_device_add_heap(struct ion_heap *heap, struct module *owner) +{ + struct ion_device *dev = internal_dev; + int ret; + struct dentry *heap_root; + char debug_name[64]; + + if (!heap || !heap->ops || !heap->ops->allocate || !heap->ops->free) { + pr_err("%s: invalid heap or heap_ops\n", __func__); + ret = -EINVAL; + goto out; + } + + heap->owner = owner; + spin_lock_init(&heap->free_lock); + spin_lock_init(&heap->stat_lock); + heap->free_list_size = 0; + + if (heap->flags & ION_HEAP_FLAG_DEFER_FREE) { + ret = ion_heap_init_deferred_free(heap); + if (ret) + goto out_heap_cleanup; + } + + if ((heap->flags & ION_HEAP_FLAG_DEFER_FREE) || heap->ops->shrink) { + ret = ion_heap_init_shrinker(heap); + if (ret) { + pr_err("%s: Failed to register shrinker\n", __func__); + goto out_heap_cleanup; + } + } + + heap->num_of_buffers = 0; + heap->num_of_alloc_bytes = 0; + heap->alloc_bytes_wm = 0; + + heap_root = debugfs_create_dir(heap->name, dev->debug_root); + debugfs_create_u64("num_of_buffers", + 0444, heap_root, + &heap->num_of_buffers); + debugfs_create_u64("num_of_alloc_bytes", + 0444, + heap_root, + &heap->num_of_alloc_bytes); + debugfs_create_u64("alloc_bytes_wm", + 0444, + heap_root, + &heap->alloc_bytes_wm); + + if (heap->shrinker.count_objects && + heap->shrinker.scan_objects) { + snprintf(debug_name, 64, "%s_shrink", heap->name); + debugfs_create_file(debug_name, + 0644, + heap_root, + heap, + &debug_shrink_fops); + } + + heap->debugfs_dir = heap_root; + down_write(&dev->lock); + ret = ion_assign_heap_id(heap, dev); + if (ret) { + pr_err("%s: Failed to assign heap id for heap type %x\n", + __func__, heap->type); + up_write(&dev->lock); + goto out_debugfs_cleanup; + } + + /* + * use negative heap->id to reverse the priority -- when traversing + * the list later attempt higher id numbers first + */ + plist_node_init(&heap->node, -heap->id); + plist_add(&heap->node, &dev->heaps); + + up_write(&dev->lock); + + return 0; + +out_debugfs_cleanup: + debugfs_remove_recursive(heap->debugfs_dir); +out_heap_cleanup: + ion_heap_cleanup(heap); +out: + return ret; +} +EXPORT_SYMBOL_GPL(__ion_device_add_heap); + +void ion_device_remove_heap(struct ion_heap *heap) +{ + struct ion_device *dev = internal_dev; + + if (!heap) { + pr_err("%s: Invalid argument\n", __func__); + return; + } + + // take semaphore and remove the heap from dev->heap list + down_write(&dev->lock); + /* So no new allocations can happen from this heap */ + plist_del(&heap->node, &dev->heaps); + if (ion_heap_cleanup(heap) != 0) { + pr_warn("%s: failed to cleanup heap (%s)\n", + __func__, heap->name); + } + debugfs_remove_recursive(heap->debugfs_dir); + clear_bit(heap->id, dev->heap_ids); + dev->heap_cnt--; + up_write(&dev->lock); +} +EXPORT_SYMBOL_GPL(ion_device_remove_heap); + +static ssize_t +total_heaps_kb_show(struct kobject *kobj, struct kobj_attribute *attr, + char *buf) +{ + return sprintf(buf, "%llu\n", + div_u64(ion_get_total_heap_bytes(), 1024)); +} + +static ssize_t +total_pools_kb_show(struct kobject *kobj, struct kobj_attribute *attr, + char *buf) +{ + struct ion_device *dev = internal_dev; + struct ion_heap *heap; + u64 total_pages = 0; + + down_read(&dev->lock); + plist_for_each_entry(heap, &dev->heaps, node) + if (heap->ops->get_pool_size) + total_pages += heap->ops->get_pool_size(heap); + up_read(&dev->lock); + + return sprintf(buf, "%llu\n", total_pages * (PAGE_SIZE / 1024)); +} + +static struct kobj_attribute total_heaps_kb_attr = + __ATTR_RO(total_heaps_kb); + +static struct kobj_attribute total_pools_kb_attr = + __ATTR_RO(total_pools_kb); + +static struct attribute *ion_device_attrs[] = { + &total_heaps_kb_attr.attr, + &total_pools_kb_attr.attr, + NULL, +}; + +ATTRIBUTE_GROUPS(ion_device); + +static int ion_init_sysfs(void) +{ + struct kobject *ion_kobj; + int ret; + + ion_kobj = kobject_create_and_add("ion", kernel_kobj); + if (!ion_kobj) + return -ENOMEM; + + ret = sysfs_create_groups(ion_kobj, ion_device_groups); + if (ret) { + kobject_put(ion_kobj); + return ret; + } + + return 0; +} + +static int ion_device_create(void) +{ + struct ion_device *idev; + int ret; + + idev = kzalloc(sizeof(*idev), GFP_KERNEL); + if (!idev) + return -ENOMEM; + + idev->dev.minor = MISC_DYNAMIC_MINOR; + idev->dev.name = "ion"; + idev->dev.fops = &ion_fops; + idev->dev.parent = NULL; + ret = misc_register(&idev->dev); + if (ret) { + pr_err("ion: failed to register misc device.\n"); + goto err_reg; + } + + ret = ion_init_sysfs(); + if (ret) { + pr_err("ion: failed to add sysfs attributes.\n"); + goto err_sysfs; + } + + idev->debug_root = debugfs_create_dir("ion", NULL); + init_rwsem(&idev->lock); + plist_head_init(&idev->heaps); + internal_dev = idev; + return 0; + +err_sysfs: + misc_deregister(&idev->dev); +err_reg: + kfree(idev); + return ret; +} +subsys_initcall(ion_device_create); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_buffer.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_buffer.c new file mode 100644 index 0000000000000000000000000000000000000000..9baca1a472b6a456bf3cbe473d6a76ccc131dbc0 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_buffer.c @@ -0,0 +1,278 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * ION Memory Allocator - buffer interface + * + * Copyright (c) 2019, Google, Inc. + */ + +#include +#include +#include +#include +#include + +#define CREATE_TRACE_POINTS +#include "ion_trace.h" +#include "ion_private.h" + +static atomic_long_t total_heap_bytes; + +static void track_buffer_created(struct ion_buffer *buffer) +{ + long total = atomic_long_add_return(buffer->size, &total_heap_bytes); + + trace_ion_stat(buffer->sg_table, buffer->size, total); +} + +static void track_buffer_destroyed(struct ion_buffer *buffer) +{ + long total = atomic_long_sub_return(buffer->size, &total_heap_bytes); + + trace_ion_stat(buffer->sg_table, -buffer->size, total); +} + +/* this function should only be called while dev->lock is held */ +static struct ion_buffer *ion_buffer_create(struct ion_heap *heap, + struct ion_device *dev, + unsigned long len, + unsigned long flags) +{ + struct ion_buffer *buffer; + int ret; + + buffer = kzalloc(sizeof(*buffer), GFP_KERNEL); + if (!buffer) + return ERR_PTR(-ENOMEM); + + buffer->heap = heap; + buffer->flags = flags; + buffer->size = len; + + ret = heap->ops->allocate(heap, buffer, len, flags); + + if (ret) { + if (!(heap->flags & ION_HEAP_FLAG_DEFER_FREE)) + goto err2; + + ion_heap_freelist_drain(heap, 0); + ret = heap->ops->allocate(heap, buffer, len, flags); + if (ret) + goto err2; + } + + if (!buffer->sg_table) { + WARN_ONCE(1, "This heap needs to set the sgtable"); + ret = -EINVAL; + goto err1; + } + + spin_lock(&heap->stat_lock); + heap->num_of_buffers++; + heap->num_of_alloc_bytes += len; + if (heap->num_of_alloc_bytes > heap->alloc_bytes_wm) + heap->alloc_bytes_wm = heap->num_of_alloc_bytes; + if (heap->num_of_buffers == 1) { + /* This module reference lasts as long as at least one + * buffer is allocated from the heap. We are protected + * against ion_device_remove_heap() with dev->lock, so we can + * safely assume the module reference is going to* succeed. + */ + __module_get(heap->owner); + } + spin_unlock(&heap->stat_lock); + + INIT_LIST_HEAD(&buffer->attachments); + mutex_init(&buffer->lock); + track_buffer_created(buffer); + return buffer; + +err1: + heap->ops->free(buffer); +err2: + kfree(buffer); + return ERR_PTR(ret); +} + +static int ion_clear_pages(struct page **pages, int num, pgprot_t pgprot) +{ + void *addr = vmap(pages, num, VM_MAP, pgprot); + + if (!addr) + return -ENOMEM; + memset(addr, 0, PAGE_SIZE * num); + vunmap(addr); + + return 0; +} + +static int ion_sglist_zero(struct scatterlist *sgl, unsigned int nents, + pgprot_t pgprot) +{ + int p = 0; + int ret = 0; + struct sg_page_iter piter; + struct page *pages[32]; + + for_each_sg_page(sgl, &piter, nents, 0) { + pages[p++] = sg_page_iter_page(&piter); + if (p == ARRAY_SIZE(pages)) { + ret = ion_clear_pages(pages, p, pgprot); + if (ret) + return ret; + p = 0; + } + } + if (p) + ret = ion_clear_pages(pages, p, pgprot); + + return ret; +} + +struct ion_buffer *ion_buffer_alloc(struct ion_device *dev, size_t len, + unsigned int heap_id_mask, + unsigned int flags) +{ + struct ion_buffer *buffer = NULL; + struct ion_heap *heap; + + if (!dev || !len) { + return ERR_PTR(-EINVAL); + } + + /* + * traverse the list of heaps available in this system in priority + * order. If the heap type is supported by the client, and matches the + * request of the caller allocate from it. Repeat until allocate has + * succeeded or all heaps have been tried + */ + len = PAGE_ALIGN(len); + if (!len) + return ERR_PTR(-EINVAL); + + down_read(&dev->lock); + plist_for_each_entry(heap, &dev->heaps, node) { + /* if the caller didn't specify this heap id */ + if (!((1 << heap->id) & heap_id_mask)) + continue; + buffer = ion_buffer_create(heap, dev, len, flags); + if (!IS_ERR(buffer)) + break; + } + up_read(&dev->lock); + + if (!buffer) + return ERR_PTR(-ENODEV); + + if (IS_ERR(buffer)) + return ERR_CAST(buffer); + + return buffer; +} + +int ion_buffer_zero(struct ion_buffer *buffer) +{ + struct sg_table *table; + pgprot_t pgprot; + + if (!buffer) + return -EINVAL; + + table = buffer->sg_table; + if (buffer->flags & ION_FLAG_CACHED) + pgprot = PAGE_KERNEL; + else + pgprot = pgprot_writecombine(PAGE_KERNEL); + + return ion_sglist_zero(table->sgl, table->nents, pgprot); +} +EXPORT_SYMBOL_GPL(ion_buffer_zero); + +void ion_buffer_prep_noncached(struct ion_buffer *buffer) +{ + struct scatterlist *sg; + struct sg_table *table; + int i; + + if (WARN_ONCE(!buffer || !buffer->sg_table, + "%s needs a buffer and a sg_table", __func__) || + buffer->flags & ION_FLAG_CACHED) + return; + + table = buffer->sg_table; + + for_each_sg(table->sgl, sg, table->orig_nents, i) + arch_dma_prep_coherent(sg_page(sg), sg->length); +} +EXPORT_SYMBOL_GPL(ion_buffer_prep_noncached); + +void ion_buffer_release(struct ion_buffer *buffer) +{ + if (buffer->kmap_cnt > 0) { + pr_warn_once("%s: buffer still mapped in the kernel\n", + __func__); + ion_heap_unmap_kernel(buffer->heap, buffer); + } + buffer->heap->ops->free(buffer); + spin_lock(&buffer->heap->stat_lock); + buffer->heap->num_of_buffers--; + buffer->heap->num_of_alloc_bytes -= buffer->size; + if (buffer->heap->num_of_buffers == 0) + module_put(buffer->heap->owner); + spin_unlock(&buffer->heap->stat_lock); + /* drop reference to the heap module */ + + kfree(buffer); +} + +int ion_buffer_destroy(struct ion_device *dev, struct ion_buffer *buffer) +{ + struct ion_heap *heap; + + if (!dev || !buffer) { + pr_warn("%s: invalid argument\n", __func__); + return -EINVAL; + } + + heap = buffer->heap; + track_buffer_destroyed(buffer); + + if (heap->flags & ION_HEAP_FLAG_DEFER_FREE) + ion_heap_freelist_add(heap, buffer); + else + ion_buffer_release(buffer); + + return 0; +} + +void *ion_buffer_kmap_get(struct ion_buffer *buffer) +{ + void *vaddr; + + if (buffer->kmap_cnt) { + buffer->kmap_cnt++; + return buffer->vaddr; + } + vaddr = ion_heap_map_kernel(buffer->heap, buffer); + if (WARN_ONCE(!vaddr, + "heap->ops->map_kernel should return ERR_PTR on error")) + return ERR_PTR(-EINVAL); + if (IS_ERR(vaddr)) + return vaddr; + buffer->vaddr = vaddr; + buffer->kmap_cnt++; + return vaddr; +} + +void ion_buffer_kmap_put(struct ion_buffer *buffer) +{ + buffer->kmap_cnt--; + if (!buffer->kmap_cnt) { + ion_heap_unmap_kernel(buffer->heap, buffer); + buffer->vaddr = NULL; + } +} + +u64 ion_get_total_heap_bytes(void) +{ + return atomic_long_read(&total_heap_bytes); +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_dma_buf.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_dma_buf.c new file mode 100644 index 0000000000000000000000000000000000000000..47ae54af5ccf702067c4da7f6f974b2ee67cc89c --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_dma_buf.c @@ -0,0 +1,359 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * ION Memory Allocator - dmabuf interface + * + * Copyright (c) 2019, Google, Inc. + */ + +#include +#include +#include +#include +#include + +#include "ion_private.h" + +static struct sg_table *dup_sg_table(struct sg_table *table) +{ + struct sg_table *new_table; + int ret, i; + struct scatterlist *sg, *new_sg; + + new_table = kzalloc(sizeof(*new_table), GFP_KERNEL); + if (!new_table) + return ERR_PTR(-ENOMEM); + + ret = sg_alloc_table(new_table, table->nents, GFP_KERNEL); + if (ret) { + kfree(new_table); + return ERR_PTR(-ENOMEM); + } + + new_sg = new_table->sgl; + for_each_sg(table->sgl, sg, table->nents, i) { + memcpy(new_sg, sg, sizeof(*sg)); + new_sg->dma_address = 0; + new_sg = sg_next(new_sg); + } + + return new_table; +} + +static void free_duped_table(struct sg_table *table) +{ + sg_free_table(table); + kfree(table); +} + +static int ion_dma_buf_attach(struct dma_buf *dmabuf, + struct dma_buf_attachment *attachment) +{ + struct ion_dma_buf_attachment *a; + struct sg_table *table; + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + + if (heap->buf_ops.attach) + return heap->buf_ops.attach(dmabuf, attachment); + + a = kzalloc(sizeof(*a), GFP_KERNEL); + if (!a) + return -ENOMEM; + + table = dup_sg_table(buffer->sg_table); + if (IS_ERR(table)) { + kfree(a); + return -ENOMEM; + } + + a->table = table; + a->dev = attachment->dev; + INIT_LIST_HEAD(&a->list); + a->mapped = false; + + attachment->priv = a; + + mutex_lock(&buffer->lock); + list_add(&a->list, &buffer->attachments); + mutex_unlock(&buffer->lock); + + return 0; +} + +static void ion_dma_buf_detatch(struct dma_buf *dmabuf, + struct dma_buf_attachment *attachment) +{ + struct ion_dma_buf_attachment *a = attachment->priv; + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + + if (heap->buf_ops.detach) + return heap->buf_ops.detach(dmabuf, attachment); + + mutex_lock(&buffer->lock); + list_del(&a->list); + mutex_unlock(&buffer->lock); + free_duped_table(a->table); + + kfree(a); +} + +static struct sg_table *ion_map_dma_buf(struct dma_buf_attachment *attachment, + enum dma_data_direction direction) +{ + struct ion_buffer *buffer = attachment->dmabuf->priv; + struct ion_heap *heap = buffer->heap; + struct ion_dma_buf_attachment *a; + struct sg_table *table; + unsigned long attrs = attachment->dma_map_attrs; + + if (heap->buf_ops.map_dma_buf) + return heap->buf_ops.map_dma_buf(attachment, direction); + + a = attachment->priv; + table = a->table; + + if (!(buffer->flags & ION_FLAG_CACHED)) + attrs |= DMA_ATTR_SKIP_CPU_SYNC; + + if (!dma_map_sg_attrs(attachment->dev, table->sgl, table->nents, + direction, attrs)) + return ERR_PTR(-ENOMEM); + + a->mapped = true; + + return table; +} + +static void ion_unmap_dma_buf(struct dma_buf_attachment *attachment, + struct sg_table *table, + enum dma_data_direction direction) +{ + struct ion_buffer *buffer = attachment->dmabuf->priv; + struct ion_heap *heap = buffer->heap; + struct ion_dma_buf_attachment *a = attachment->priv; + unsigned long attrs = attachment->dma_map_attrs; + + if (heap->buf_ops.unmap_dma_buf) + return heap->buf_ops.unmap_dma_buf(attachment, table, + direction); + + a->mapped = false; + + if (!(buffer->flags & ION_FLAG_CACHED)) + attrs |= DMA_ATTR_SKIP_CPU_SYNC; + + dma_unmap_sg_attrs(attachment->dev, table->sgl, table->nents, + direction, attrs); +} + +static void ion_dma_buf_release(struct dma_buf *dmabuf) +{ + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + + if (heap->buf_ops.release) + return heap->buf_ops.release(dmabuf); + + ion_free(buffer); +} + +static int ion_dma_buf_begin_cpu_access(struct dma_buf *dmabuf, + enum dma_data_direction direction) +{ + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + struct ion_dma_buf_attachment *a; + + if (heap->buf_ops.begin_cpu_access) + return heap->buf_ops.begin_cpu_access(dmabuf, direction); + + mutex_lock(&buffer->lock); + if (!(buffer->flags & ION_FLAG_CACHED)) + goto unlock; + + list_for_each_entry(a, &buffer->attachments, list) { + if (!a->mapped) + continue; + dma_sync_sg_for_cpu(a->dev, a->table->sgl, a->table->nents, + direction); + } + +unlock: + mutex_unlock(&buffer->lock); + return 0; +} + +static int +ion_dma_buf_begin_cpu_access_partial(struct dma_buf *dmabuf, + enum dma_data_direction direction, + unsigned int offset, unsigned int len) +{ + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + + /* This is done to make sure partial buffer cache flush / invalidate is + * allowed. The implementation may be vendor specific in this case, so + * ion core does not provide a default implementation + */ + if (!heap->buf_ops.begin_cpu_access_partial) + return -EOPNOTSUPP; + + return heap->buf_ops.begin_cpu_access_partial(dmabuf, direction, offset, + len); +} + +static int ion_dma_buf_end_cpu_access(struct dma_buf *dmabuf, + enum dma_data_direction direction) +{ + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + struct ion_dma_buf_attachment *a; + + if (heap->buf_ops.end_cpu_access) + return heap->buf_ops.end_cpu_access(dmabuf, direction); + + mutex_lock(&buffer->lock); + if (!(buffer->flags & ION_FLAG_CACHED)) + goto unlock; + + list_for_each_entry(a, &buffer->attachments, list) { + if (!a->mapped) + continue; + dma_sync_sg_for_device(a->dev, a->table->sgl, a->table->nents, + direction); + } +unlock: + mutex_unlock(&buffer->lock); + + return 0; +} + +static int ion_dma_buf_end_cpu_access_partial(struct dma_buf *dmabuf, + enum dma_data_direction direction, + unsigned int offset, + unsigned int len) +{ + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + + /* This is done to make sure partial buffer cache flush / invalidate is + * allowed. The implementation may be vendor specific in this case, so + * ion core does not provide a default implementation + */ + if (!heap->buf_ops.end_cpu_access_partial) + return -EOPNOTSUPP; + + return heap->buf_ops.end_cpu_access_partial(dmabuf, direction, offset, + len); +} + +static int ion_dma_buf_mmap(struct dma_buf *dmabuf, struct vm_area_struct *vma) +{ + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + int ret; + + /* now map it to userspace */ + if (heap->buf_ops.mmap) { + ret = heap->buf_ops.mmap(dmabuf, vma); + } else { + mutex_lock(&buffer->lock); + if (!(buffer->flags & ION_FLAG_CACHED)) + vma->vm_page_prot = + pgprot_writecombine(vma->vm_page_prot); + + ret = ion_heap_map_user(heap, buffer, vma); + mutex_unlock(&buffer->lock); + } + + if (ret) + pr_err("%s: failure mapping buffer to userspace\n", __func__); + + return ret; +} + +static void *ion_dma_buf_vmap(struct dma_buf *dmabuf) +{ + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + void *vaddr; + + if (heap->buf_ops.vmap) + return heap->buf_ops.vmap(dmabuf); + + mutex_lock(&buffer->lock); + vaddr = ion_buffer_kmap_get(buffer); + mutex_unlock(&buffer->lock); + + return vaddr; +} + +static void ion_dma_buf_vunmap(struct dma_buf *dmabuf, void *vaddr) +{ + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + + if (heap->buf_ops.vunmap) { + heap->buf_ops.vunmap(dmabuf, vaddr); + return; + } + + mutex_lock(&buffer->lock); + ion_buffer_kmap_put(buffer); + mutex_unlock(&buffer->lock); +} + +static int ion_dma_buf_get_flags(struct dma_buf *dmabuf, unsigned long *flags) +{ + struct ion_buffer *buffer = dmabuf->priv; + struct ion_heap *heap = buffer->heap; + + if (!heap->buf_ops.get_flags) + return -EOPNOTSUPP; + + return heap->buf_ops.get_flags(dmabuf, flags); +} + +static const struct dma_buf_ops dma_buf_ops = { + .attach = ion_dma_buf_attach, + .detach = ion_dma_buf_detatch, + .map_dma_buf = ion_map_dma_buf, + .unmap_dma_buf = ion_unmap_dma_buf, + .release = ion_dma_buf_release, + .begin_cpu_access = ion_dma_buf_begin_cpu_access, + .begin_cpu_access_partial = ion_dma_buf_begin_cpu_access_partial, + .end_cpu_access = ion_dma_buf_end_cpu_access, + .end_cpu_access_partial = ion_dma_buf_end_cpu_access_partial, + .mmap = ion_dma_buf_mmap, + .vmap = ion_dma_buf_vmap, + .vunmap = ion_dma_buf_vunmap, + .get_flags = ion_dma_buf_get_flags, +}; + +struct dma_buf *ion_dmabuf_alloc(struct ion_device *dev, size_t len, + unsigned int heap_id_mask, + unsigned int flags) +{ + struct ion_buffer *buffer; + DEFINE_DMA_BUF_EXPORT_INFO(exp_info); + struct dma_buf *dmabuf; + + pr_debug("%s: len %zu heap_id_mask %u flags %x\n", __func__, + len, heap_id_mask, flags); + + buffer = ion_buffer_alloc(dev, len, heap_id_mask, flags); + if (IS_ERR(buffer)) + return ERR_CAST(buffer); + + exp_info.ops = &dma_buf_ops; + exp_info.size = buffer->size; + exp_info.flags = O_RDWR; + exp_info.priv = buffer; + + dmabuf = dma_buf_export(&exp_info); + if (IS_ERR(dmabuf)) + ion_buffer_destroy(dev, buffer); + + return dmabuf; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_heap.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_heap.c new file mode 100644 index 0000000000000000000000000000000000000000..aa29a4ee48a328e9c460155d87165c819ccbb567 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_heap.c @@ -0,0 +1,291 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * ION Memory Allocator generic heap helpers + * + * Copyright (C) 2011 Google, Inc. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "ion_private.h" + +static unsigned long ion_heap_shrink_count(struct shrinker *shrinker, + struct shrink_control *sc) +{ + struct ion_heap *heap = container_of(shrinker, struct ion_heap, + shrinker); + int total = 0; + + total = ion_heap_freelist_size(heap) / PAGE_SIZE; + + if (heap->ops->shrink) + total += heap->ops->shrink(heap, sc->gfp_mask, 0); + + return total; +} + +static unsigned long ion_heap_shrink_scan(struct shrinker *shrinker, + struct shrink_control *sc) +{ + struct ion_heap *heap = container_of(shrinker, struct ion_heap, + shrinker); + int freed = 0; + int to_scan = sc->nr_to_scan; + + if (to_scan == 0) + return 0; + + /* + * shrink the free list first, no point in zeroing the memory if we're + * just going to reclaim it. Also, skip any possible page pooling. + */ + if (heap->flags & ION_HEAP_FLAG_DEFER_FREE) + freed = ion_heap_freelist_shrink(heap, to_scan * PAGE_SIZE) / + PAGE_SIZE; + + to_scan -= freed; + if (to_scan <= 0) + return freed; + + if (heap->ops->shrink) + freed += heap->ops->shrink(heap, sc->gfp_mask, to_scan); + + return freed; +} + +static size_t _ion_heap_freelist_drain(struct ion_heap *heap, size_t size, + bool skip_pools) +{ + struct ion_buffer *buffer; + size_t total_drained = 0; + + if (ion_heap_freelist_size(heap) == 0) + return 0; + + spin_lock(&heap->free_lock); + if (size == 0) + size = heap->free_list_size; + + while (!list_empty(&heap->free_list)) { + if (total_drained >= size) + break; + buffer = list_first_entry(&heap->free_list, struct ion_buffer, + list); + list_del(&buffer->list); + heap->free_list_size -= buffer->size; + if (skip_pools) + buffer->private_flags |= ION_PRIV_FLAG_SHRINKER_FREE; + total_drained += buffer->size; + spin_unlock(&heap->free_lock); + ion_buffer_release(buffer); + spin_lock(&heap->free_lock); + } + spin_unlock(&heap->free_lock); + + return total_drained; +} + +static int ion_heap_deferred_free(void *data) +{ + struct ion_heap *heap = data; + + while (true) { + struct ion_buffer *buffer; + + wait_event_freezable(heap->waitqueue, + (ion_heap_freelist_size(heap) > 0 || + kthread_should_stop())); + + spin_lock(&heap->free_lock); + if (list_empty(&heap->free_list)) { + spin_unlock(&heap->free_lock); + if (!kthread_should_stop()) + continue; + break; + } + buffer = list_first_entry(&heap->free_list, struct ion_buffer, + list); + list_del(&buffer->list); + heap->free_list_size -= buffer->size; + spin_unlock(&heap->free_lock); + ion_buffer_release(buffer); + } + + return 0; +} + +void *ion_heap_map_kernel(struct ion_heap *heap, + struct ion_buffer *buffer) +{ + struct scatterlist *sg; + int i, j; + void *vaddr; + pgprot_t pgprot; + struct sg_table *table = buffer->sg_table; + int npages = PAGE_ALIGN(buffer->size) / PAGE_SIZE; + struct page **pages = vmalloc(array_size(npages, + sizeof(struct page *))); + struct page **tmp = pages; + + if (!pages) + return ERR_PTR(-ENOMEM); + + if (buffer->flags & ION_FLAG_CACHED) + pgprot = PAGE_KERNEL; + else + pgprot = pgprot_writecombine(PAGE_KERNEL); + + for_each_sg(table->sgl, sg, table->nents, i) { + int npages_this_entry = PAGE_ALIGN(sg->length) / PAGE_SIZE; + struct page *page = sg_page(sg); + + BUG_ON(i >= npages); + for (j = 0; j < npages_this_entry; j++) + *(tmp++) = page++; + } + vaddr = vmap(pages, npages, VM_MAP, pgprot); + vfree(pages); + + if (!vaddr) + return ERR_PTR(-ENOMEM); + + return vaddr; +} +EXPORT_SYMBOL_GPL(ion_heap_map_kernel); + +void ion_heap_unmap_kernel(struct ion_heap *heap, + struct ion_buffer *buffer) +{ + vunmap(buffer->vaddr); +} +EXPORT_SYMBOL_GPL(ion_heap_unmap_kernel); + +int ion_heap_map_user(struct ion_heap *heap, struct ion_buffer *buffer, + struct vm_area_struct *vma) +{ + struct sg_table *table = buffer->sg_table; + unsigned long addr = vma->vm_start; + unsigned long offset = vma->vm_pgoff * PAGE_SIZE; + struct scatterlist *sg; + int i; + int ret; + + for_each_sg(table->sgl, sg, table->nents, i) { + struct page *page = sg_page(sg); + unsigned long remainder = vma->vm_end - addr; + unsigned long len = sg->length; + + if (offset >= sg->length) { + offset -= sg->length; + continue; + } else if (offset) { + page += offset / PAGE_SIZE; + len = sg->length - offset; + offset = 0; + } + len = min(len, remainder); + ret = remap_pfn_range(vma, addr, page_to_pfn(page), len, + vma->vm_page_prot); + if (ret) + return ret; + addr += len; + if (addr >= vma->vm_end) + return 0; + } + + return 0; +} +EXPORT_SYMBOL_GPL(ion_heap_map_user); + +void ion_heap_freelist_add(struct ion_heap *heap, struct ion_buffer *buffer) +{ + spin_lock(&heap->free_lock); + list_add(&buffer->list, &heap->free_list); + heap->free_list_size += buffer->size; + spin_unlock(&heap->free_lock); + wake_up(&heap->waitqueue); +} + +size_t ion_heap_freelist_size(struct ion_heap *heap) +{ + size_t size; + + spin_lock(&heap->free_lock); + size = heap->free_list_size; + spin_unlock(&heap->free_lock); + + return size; +} + +size_t ion_heap_freelist_drain(struct ion_heap *heap, size_t size) +{ + return _ion_heap_freelist_drain(heap, size, false); +} + +size_t ion_heap_freelist_shrink(struct ion_heap *heap, size_t size) +{ + return _ion_heap_freelist_drain(heap, size, true); +} + +int ion_heap_init_deferred_free(struct ion_heap *heap) +{ + INIT_LIST_HEAD(&heap->free_list); + init_waitqueue_head(&heap->waitqueue); + heap->task = kthread_run(ion_heap_deferred_free, heap, + "%s", heap->name); + if (IS_ERR(heap->task)) { + pr_err("%s: creating thread for deferred free failed\n", + __func__); + return PTR_ERR_OR_ZERO(heap->task); + } + sched_set_normal(heap->task, 19); + + return 0; +} + +int ion_heap_init_shrinker(struct ion_heap *heap) +{ + heap->shrinker.count_objects = ion_heap_shrink_count; + heap->shrinker.scan_objects = ion_heap_shrink_scan; + heap->shrinker.seeks = DEFAULT_SEEKS; + heap->shrinker.batch = 0; + + return register_shrinker(&heap->shrinker); +} + +int ion_heap_cleanup(struct ion_heap *heap) +{ + int ret; + + if (heap->flags & ION_HEAP_FLAG_DEFER_FREE && + !IS_ERR_OR_NULL(heap->task)) { + size_t free_list_size = ion_heap_freelist_size(heap); + size_t total_drained = ion_heap_freelist_drain(heap, 0); + + if (total_drained != free_list_size) { + pr_err("%s: %s heap drained %zu bytes, requested %zu\n", + __func__, heap->name, free_list_size, + total_drained); + return -EBUSY; + } + ret = kthread_stop(heap->task); + if (ret < 0) { + pr_err("%s: failed to stop heap free thread\n", + __func__); + return ret; + } + } + + if ((heap->flags & ION_HEAP_FLAG_DEFER_FREE) || heap->ops->shrink) + unregister_shrinker(&heap->shrinker); + + return 0; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_private.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_private.h new file mode 100644 index 0000000000000000000000000000000000000000..db4e90683f4c707d88734e385d2f461d8b133883 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_private.h @@ -0,0 +1,58 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * ION Memory Allocator - Internal header + * + * Copyright (C) 2019 Google, Inc. + */ + +#ifndef _ION_PRIVATE_H +#define _ION_PRIVATE_H + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +/** + * struct ion_device - the metadata of the ion device node + * @dev: the actual misc device + * @lock: rwsem protecting the tree of heaps, heap_bitmap and + * clients + * @heap_ids: bitmap of register heap ids + */ +struct ion_device { + struct miscdevice dev; + struct rw_semaphore lock; + DECLARE_BITMAP(heap_ids, ION_NUM_MAX_HEAPS); + struct plist_head heaps; + struct dentry *debug_root; + int heap_cnt; +}; + +/* ion_buffer manipulators */ +extern struct ion_buffer *ion_buffer_alloc(struct ion_device *dev, size_t len, + unsigned int heap_id_mask, + unsigned int flags); +extern void ion_buffer_release(struct ion_buffer *buffer); +extern int ion_buffer_destroy(struct ion_device *dev, + struct ion_buffer *buffer); +extern void *ion_buffer_kmap_get(struct ion_buffer *buffer); +extern void ion_buffer_kmap_put(struct ion_buffer *buffer); + +/* ion dmabuf allocator */ +extern struct dma_buf *ion_dmabuf_alloc(struct ion_device *dev, size_t len, + unsigned int heap_id_mask, + unsigned int flags); +extern int ion_free(struct ion_buffer *buffer); + +/* ion heap helpers */ +extern int ion_heap_cleanup(struct ion_heap *heap); + +u64 ion_get_total_heap_bytes(void); + +#endif /* _ION_PRIVATE_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_protected_heap.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_protected_heap.c new file mode 100644 index 0000000000000000000000000000000000000000..c7f25373a744699b7690dc38d8d7f7ab09c05be6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_protected_heap.c @@ -0,0 +1,526 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Copyright (c) 2021 Rockchip Electronics Co. Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "ion.h" + +#define ION_HEAP_TYPE_PROTECTED (ION_HEAP_TYPE_CUSTOM + 1) + +#define NUM_ORDERS ARRAY_SIZE(orders) + +static unsigned int orders[] = {8, 4, 0}; + +static struct reserved_mem *protected_reserved_memory; + +#ifdef CONFIG_OF_RESERVED_MEM +static int __init protected_dma_setup(struct reserved_mem *rmem) +{ + protected_reserved_memory = rmem; + + pr_info("ION: created protected pool at %pa, size %ld MiB\n", + &rmem->base, (unsigned long)rmem->size / SZ_1M); + + return 0; +} + +RESERVEDMEM_OF_DECLARE(protected, "protected-dma-pool", protected_dma_setup); +#endif + +static int order_to_index(unsigned int order) +{ + int i; + + for (i = 0; i < NUM_ORDERS; i++) + if (order == orders[i]) + return i; + + return 0; +} + +static inline unsigned int order_to_size(int order) +{ + return PAGE_SIZE << order; +} + +static void protected_pool_add(struct ion_page_pool *pool, struct page *page) +{ + mutex_lock(&pool->mutex); + if (PageHighMem(page)) { + list_add_tail(&page->lru, &pool->high_items); + pool->high_count++; + } else { + list_add_tail(&page->lru, &pool->low_items); + pool->low_count++; + } + mutex_unlock(&pool->mutex); +} + +static struct page *protected_pool_remove(struct ion_page_pool *pool, + bool high) +{ + struct page *page; + + if (high) { + page = list_first_entry(&pool->high_items, struct page, lru); + pool->high_count--; + } else { + page = list_first_entry(&pool->low_items, struct page, lru); + pool->low_count--; + } + list_del(&page->lru); + + return page; +} + +static struct page *protected_pool_alloc(struct ion_page_pool *pool) +{ + struct page *page = NULL; + + mutex_lock(&pool->mutex); + if (pool->high_count) + page = protected_pool_remove(pool, true); + else if (pool->low_count) + page = protected_pool_remove(pool, false); + mutex_unlock(&pool->mutex); + + return page; +} + +static void protected_pool_free(struct ion_page_pool *pool, + struct page *page) +{ + protected_pool_add(pool, page); +} + +static int protected_pool_total(struct ion_page_pool *pool) +{ + return (pool->low_count + pool->high_count) << pool->order; +} + +static int protected_pool_shrink(struct ion_page_pool *pool, + struct gen_pool *rmem, + int nr_to_scan) +{ + int freed = 0; + + if (nr_to_scan == 0) + return protected_pool_total(pool); + + while (freed < nr_to_scan) { + struct page *page; + + mutex_lock(&pool->mutex); + if (pool->low_count) { + page = protected_pool_remove(pool, false); + } else if (pool->high_count) { + page = protected_pool_remove(pool, true); + } else { + mutex_unlock(&pool->mutex); + break; + } + mutex_unlock(&pool->mutex); + gen_pool_free(rmem, page_to_phys(page), + order_to_size(pool->order)); + freed += (1 << pool->order); + } + + return freed; +} + +static struct ion_page_pool *protected_pool_create(unsigned int order) +{ + struct ion_page_pool *pool = kzalloc(sizeof(*pool), GFP_KERNEL); + + if (!pool) + return NULL; + + pool->high_count = 0; + pool->low_count = 0; + INIT_LIST_HEAD(&pool->low_items); + INIT_LIST_HEAD(&pool->high_items); + pool->order = order; + mutex_init(&pool->mutex); + plist_node_init(&pool->list, order); + + return pool; +} + +static void protected_pool_destroy(struct ion_page_pool *pool) +{ + kfree(pool); +} + +struct ion_protected_heap { + struct ion_heap heap; + struct gen_pool *rmem; + struct ion_page_pool *pools[NUM_ORDERS]; +}; + +struct page_info { + struct page *page; + struct list_head list; + unsigned long order; +}; + +static void free_buffer_page(struct ion_heap *heap, + struct ion_buffer *buffer, + struct page *page, + unsigned long order) +{ + struct ion_page_pool *pool; + struct ion_protected_heap *pheap; + + pheap = container_of(heap, struct ion_protected_heap, heap); + if (buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE) { + gen_pool_free(pheap->rmem, page_to_phys(page), + order_to_size(order)); + return; + } + + pool = pheap->pools[order_to_index(order)]; + protected_pool_free(pool, page); +} + +static struct page *alloc_buffer_page(struct ion_heap *heap, + struct ion_buffer *buffer, + unsigned long order) +{ + struct ion_page_pool *pool; + struct ion_protected_heap *pheap; + struct page *page; + unsigned long paddr; + + pheap = container_of(heap, struct ion_protected_heap, heap); + pool = pheap->pools[order_to_index(order)]; + page = protected_pool_alloc(pool); + if (!page) { + paddr = gen_pool_alloc(pheap->rmem, order_to_size(order)); + if (WARN_ON(!paddr)) + return NULL; + page = phys_to_page(paddr); + } + + return page; +} + +static struct page_info *alloc_largest_available(struct ion_heap *heap, + struct ion_buffer *buffer, + unsigned long size, + unsigned int max_order) +{ + struct page_info *info; + struct page *page; + int i; + + info = kmalloc(sizeof(*info), GFP_KERNEL); + if (!info) + return NULL; + + for (i = 0; i < NUM_ORDERS; i++) { + if (size < order_to_size(orders[i])) + continue; + if (max_order < orders[i]) + continue; + + page = alloc_buffer_page(heap, buffer, orders[i]); + if (IS_ERR(page)) + continue; + + info->page = page; + info->order = orders[i]; + INIT_LIST_HEAD(&info->list); + return info; + } + kfree(info); + + return NULL; +} + +static int ion_protected_heap_allocate(struct ion_heap *heap, + struct ion_buffer *buffer, + unsigned long size, + unsigned long flags) +{ + struct list_head pages; + struct list_head lists[8]; + struct page_info *info, *tmp; + struct scatterlist *sg; + struct sg_table *table; + unsigned int block_index[8] = {0}; + unsigned int max_order = orders[0], maximum; + unsigned long size_remaining = PAGE_ALIGN(size); + int i, j; + + if (size / PAGE_SIZE > totalram_pages / 2) + return -ENOMEM; + + INIT_LIST_HEAD(&pages); + for (i = 0; i < 8; i++) + INIT_LIST_HEAD(&lists[i]); + + i = 0; + while (size_remaining > 0) { + info = alloc_largest_available(heap, buffer, size_remaining, + max_order); + if (!info) + goto free_pages; + + size_remaining -= PAGE_SIZE << info->order; + max_order = info->order; + if (max_order) { + list_add_tail(&info->list, &pages); + } else { + dma_addr_t phys = page_to_phys(info->page); + unsigned int bit12_14 = (phys >> 12) & 0x7; + + list_add_tail(&info->list, &lists[bit12_14]); + block_index[bit12_14]++; + } + + i++; + } + + table = kmalloc(sizeof(*table), GFP_KERNEL); + if (!table) + goto free_pages; + + if (sg_alloc_table(table, i, GFP_KERNEL)) + goto free_table; + + maximum = block_index[0]; + for (i = 1; i < 8; i++) + maximum = max(maximum, block_index[i]); + + sg = table->sgl; + list_for_each_entry_safe(info, tmp, &pages, list) { + sg_set_page(sg, info->page, PAGE_SIZE << info->order, 0); + sg = sg_next(sg); + list_del(&info->list); + } + + for (i = 0; i < maximum; i++) { + for (j = 0; j < 8; j++) { + if (list_empty(&lists[j])) + continue; + + info = list_first_entry(&lists[j], struct page_info, + list); + sg_set_page(sg, info->page, PAGE_SIZE, 0); + sg = sg_next(sg); + list_del(&info->list); + } + } + buffer->sg_table = table; + + return 0; +free_table: + kfree(table); +free_pages: + list_for_each_entry_safe(info, tmp, &pages, list) + free_buffer_page(heap, buffer, info->page, info->order); + + for (i = 0; i < 8; i++) { + list_for_each_entry_safe(info, tmp, &lists[i], list) + free_buffer_page(heap, buffer, info->page, info->order); + } + + return -ENOMEM; +} + +static void ion_protected_heap_free(struct ion_buffer *buffer) +{ + struct sg_table *table = buffer->sg_table; + struct scatterlist *sg; + int i; + + /* zero the buffer before goto page pool */ + if (!(buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE)) + ion_heap_buffer_zero(buffer); + + for_each_sg(table->sgl, sg, table->nents, i) + free_buffer_page(buffer->heap, buffer, sg_page(sg), + get_order(sg->length)); + sg_free_table(table); + kfree(table); +} + +static int ion_protected_heap_shrink(struct ion_heap *heap, gfp_t gfp_mask, + int nr_to_scan) +{ + struct ion_page_pool *pool; + struct ion_protected_heap *pheap; + int nr_total = 0; + int i, nr_freed; + int only_scan = 0; + + pheap = container_of(heap, struct ion_protected_heap, heap); + if (!nr_to_scan) + only_scan = 1; + + for (i = 0; i < NUM_ORDERS; i++) { + pool = pheap->pools[i]; + + if (only_scan) { + nr_total += protected_pool_shrink(pool, + pheap->rmem, + nr_to_scan); + + } else { + nr_freed = protected_pool_shrink(pool, + pheap->rmem, + nr_to_scan); + nr_to_scan -= nr_freed; + nr_total += nr_freed; + if (nr_to_scan <= 0) + break; + } + } + + return nr_total; +} + +static struct ion_heap_ops protected_heap_ops = { + .allocate = ion_protected_heap_allocate, + .free = ion_protected_heap_free, + .map_kernel = ion_heap_map_kernel, + .unmap_kernel = ion_heap_unmap_kernel, + .map_user = ion_heap_map_user, + .shrink = ion_protected_heap_shrink, +}; + +static int ion_protected_heap_debug_show(struct ion_heap *heap, + struct seq_file *s, + void *unused) +{ + struct ion_protected_heap *pheap; + struct ion_page_pool *pool; + int i; + + pheap = container_of(heap, struct ion_protected_heap, heap); + for (i = 0; i < NUM_ORDERS; i++) { + pool = pheap->pools[i]; + + seq_printf(s, "%d order %u highmem pages %lu total\n", + pool->high_count, pool->order, + (PAGE_SIZE << pool->order) * pool->high_count); + seq_printf(s, "%d order %u lowmem pages %lu total\n", + pool->low_count, pool->order, + (PAGE_SIZE << pool->order) * pool->low_count); + } + + return 0; +} + +static void ion_protected_heap_destroy_pools(struct ion_page_pool **pools) +{ + int i; + + for (i = 0; i < NUM_ORDERS; i++) + if (pools[i]) + protected_pool_destroy(pools[i]); +} + +static int ion_protected_heap_create_pools(struct ion_page_pool **pools) +{ + struct ion_page_pool *pool; + int i; + + for (i = 0; i < NUM_ORDERS; i++) { + pool = protected_pool_create(orders[i]); + if (!pool) + goto err_create_pool; + + pools[i] = pool; + } + + return 0; +err_create_pool: + ion_protected_heap_destroy_pools(pools); + + return -ENOMEM; +} + +static int ion_protected_heap_create_rmem(struct gen_pool **pool) +{ + struct gen_pool *mpool; + struct reserved_mem *rmem = protected_reserved_memory; + int ret; + + if (!rmem) + return -ENOENT; + + mpool = gen_pool_create(PAGE_SHIFT, -1); + if (!mpool) + return -ENOMEM; + + ret = gen_pool_add(mpool, rmem->base, rmem->size, -1); + if (ret) { + gen_pool_destroy(mpool); + return ret; + } + *pool = mpool; + + return 0; +} + +static struct ion_heap *__ion_protected_heap_create(void) +{ + struct ion_protected_heap *heap; + + heap = kzalloc(sizeof(*heap), GFP_KERNEL); + if (!heap) + return ERR_PTR(-ENOMEM); + + heap->heap.ops = &protected_heap_ops; + heap->heap.type = ION_HEAP_TYPE_PROTECTED; + heap->heap.flags = ION_HEAP_FLAG_DEFER_FREE; + heap->heap.name = "ion_protected_heap"; + + if (ion_protected_heap_create_pools(heap->pools)) + goto free_heap; + + if (ion_protected_heap_create_rmem(&heap->rmem)) + goto destroy_pool; + + heap->heap.debug_show = ion_protected_heap_debug_show; + + return &heap->heap; +destroy_pool: + ion_protected_heap_destroy_pools(heap->pools); +free_heap: + kfree(heap); + + return ERR_PTR(-ENOMEM); +} + +int ion_protected_heap_create(void) +{ + struct ion_heap *heap; + + heap = __ion_protected_heap_create(); + if (IS_ERR(heap)) + return PTR_ERR(heap); + + ion_device_add_heap(heap); + + return 0; +} + +#ifndef CONFIG_ION_MODULE +device_initcall(ion_protected_heap_create); +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_trace.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_trace.h new file mode 100644 index 0000000000000000000000000000000000000000..eacb47d4f13535762d6545e74d2c14119d7a1ec5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/ion_trace.h @@ -0,0 +1,55 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * drivers/staging/android/ion/ion-trace.h + * + * Copyright (C) 2020 Google, Inc. + */ + +#undef TRACE_SYSTEM +#define TRACE_SYSTEM ion + +#if !defined(_ION_TRACE_H) || defined(TRACE_HEADER_MULTI_READ) +#define _ION_TRACE_H + +#include + +#ifndef __ION_PTR_TO_HASHVAL +static unsigned int __maybe_unused __ion_ptr_to_hash(const void *ptr) +{ + unsigned long hashval; + + if (ptr_to_hashval(ptr, &hashval)) + return 0; + + /* The hashed value is only 32-bit */ + return (unsigned int)hashval; +} + +#define __ION_PTR_TO_HASHVAL +#endif + +TRACE_EVENT(ion_stat, + TP_PROTO(const void *addr, long len, + unsigned long total_allocated), + TP_ARGS(addr, len, total_allocated), + TP_STRUCT__entry(__field(unsigned int, buffer_id) + __field(long, len) + __field(unsigned long, total_allocated) + ), + TP_fast_assign(__entry->buffer_id = __ion_ptr_to_hash(addr); + __entry->len = len; + __entry->total_allocated = total_allocated; + ), + TP_printk("buffer_id=%u len=%ldB total_allocated=%ldB", + __entry->buffer_id, + __entry->len, + __entry->total_allocated) + ); + +#endif /* _ION_TRACE_H */ + +/* This part must be outside protection */ +#undef TRACE_INCLUDE_PATH +#define TRACE_INCLUDE_PATH . +#define TRACE_INCLUDE_FILE ion_trace +#include diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/rockchip/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/rockchip/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..89265fcbbe6fa454cc3ff36a04c781ac5484cbc3 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/rockchip/Makefile @@ -0,0 +1,3 @@ +# SPDX-License-Identifier: GPL-2.0 +obj-y += rockchip_ion.o +obj-$(CONFIG_ION_ROCKCHIP_SNAPSHOT) += rockchip_ion_snapshot.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/rockchip/rockchip_ion.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/rockchip/rockchip_ion.c new file mode 100644 index 0000000000000000000000000000000000000000..d3c3d06856ad7564e2e9f504b67e056d229358de --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/rockchip/rockchip_ion.c @@ -0,0 +1,224 @@ +/* + * drivers/staging/android/ion/rockchip/rockchip_ion.c + * + * Copyright (C) 2014 ROCKCHIP, Inc. + * + * This software is licensed under the terms of the GNU General Public + * License version 2, as published by the Free Software Foundation, and + * may be copied, distributed, and modified under those terms. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT 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 +#include +#include +#include +#include + +#include "../ion_priv.h" + +struct ion_device *rockchip_ion_dev; +static struct ion_heap **heaps; + +struct ion_heap_desc { + unsigned int id; + enum ion_heap_type type; + const char *name; +}; + +static struct ion_heap_desc ion_heap_meta[] = { + { + .id = ION_HEAP_TYPE_SYSTEM, + .type = ION_HEAP_TYPE_SYSTEM, + .name = "system-heap", + }, { + .id = ION_HEAP_TYPE_CARVEOUT, + .type = ION_HEAP_TYPE_CARVEOUT, + .name = "carveout-heap", + }, { + .id = ION_HEAP_TYPE_DMA, + .type = ION_HEAP_TYPE_DMA, + .name = "cma-heap", + }, +}; + +/* Return result of step for heap array. */ +static int rk_ion_of_heap(struct ion_platform_heap *myheap, + struct device_node *node) +{ + unsigned int reg[2] = {0,}; + int itype; + + for (itype = 0; itype < ARRAY_SIZE(ion_heap_meta); itype++) { + if (strcmp(ion_heap_meta[itype].name, node->name)) + continue; + + myheap->name = node->name; + myheap->align = SZ_1M; + myheap->id = ion_heap_meta[itype].id; + if (!strcmp("cma-heap", node->name)) { + myheap->type = ION_HEAP_TYPE_DMA; + if (!of_property_read_u32_array(node, "reg", reg, 2)) { + myheap->base = reg[0]; + myheap->size = reg[1]; + } + return 1; + } + + if (!strcmp("system-heap", node->name)) { + myheap->type = ION_HEAP_TYPE_SYSTEM; + return 1; + } + } + + return 0; +} + +static struct ion_platform_data *rk_ion_of(struct device_node *node) +{ + struct ion_platform_data *pdata; + int iheap = 0; + struct device_node *child; + struct ion_platform_heap *myheap; + + pdata = kzalloc(sizeof(*pdata), GFP_KERNEL); + if (!pdata) + return NULL; + + pdata->nr = of_get_child_count(node); +again: + pdata->heaps = kcalloc(pdata->nr, sizeof(*myheap), GFP_KERNEL); + for_each_child_of_node(node, child) { + iheap += rk_ion_of_heap(&pdata->heaps[iheap], child); + } + + if (pdata->nr != iheap) { + pdata->nr = iheap; + iheap = 0; + kfree(pdata->heaps); + pr_err("%s: mismatch, repeating\n", __func__); + goto again; + } + + return pdata; +} + +static int rk_ion_probe(struct platform_device *pdev) +{ + int err; + int i; + struct ion_platform_data *pdata = pdev->dev.platform_data; + struct ion_device *idev; + + err = of_reserved_mem_device_init(&pdev->dev); + if (err) + pr_debug("No reserved memory region assign to ion\n"); + + if (!pdata) { + pdata = rk_ion_of(pdev->dev.of_node); + pdev->dev.platform_data = pdata; + } + + heaps = kcalloc(pdata->nr, sizeof(*heaps), GFP_KERNEL); + + idev = ion_device_create(NULL); + if (IS_ERR_OR_NULL(idev)) { + kfree(heaps); + return PTR_ERR(idev); + } + + ion_device_set_platform(idev, &pdev->dev); + rockchip_ion_dev = idev; + + /* create the heaps as specified in the board file */ + for (i = 0; i < pdata->nr; i++) { + struct ion_platform_heap *heap_data = &pdata->heaps[i]; + + heap_data->priv = &pdev->dev; + heaps[i] = ion_heap_create(heap_data); + if (IS_ERR_OR_NULL(heaps[i])) { + err = PTR_ERR(heaps[i]); + goto err; + } + pr_info("rockchip ion: success to create - %s\n", + heaps[i]->name); + ion_device_add_heap(idev, heaps[i]); + } + platform_set_drvdata(pdev, idev); + + return 0; +err: + for (i = 0; i < pdata->nr; i++) { + if (heaps[i]) + ion_heap_destroy(heaps[i]); + } + + kfree(heaps); + return err; +} + +static int rk_ion_remove(struct platform_device *pdev) +{ + struct ion_platform_data *pdata = pdev->dev.platform_data; + struct ion_device *idev = platform_get_drvdata(pdev); + int i; + + ion_device_destroy(idev); + for (i = 0; i < pdata->nr; i++) + ion_heap_destroy(heaps[i]); + + kfree(heaps); + return 0; +} + +struct ion_client *rockchip_ion_client_create(const char *name) +{ + if (!rockchip_ion_dev) { + pr_err("rockchip ion idev is NULL\n"); + return NULL; + } + + return ion_client_create(rockchip_ion_dev, name); +} +EXPORT_SYMBOL_GPL(rockchip_ion_client_create); + +static const struct of_device_id rk_ion_match[] = { + { .compatible = "rockchip,ion", }, + {} +}; + +static struct platform_driver ion_driver = { + .probe = rk_ion_probe, + .remove = rk_ion_remove, + .driver = { + .name = "ion-rk", + .owner = THIS_MODULE, + .of_match_table = of_match_ptr(rk_ion_match), + }, +}; + +static int __init rk_ion_init(void) +{ + return platform_driver_register(&ion_driver); +} + +static void __exit rk_ion_exit(void) +{ + platform_driver_unregister(&ion_driver); +} + +subsys_initcall(rk_ion_init); +module_exit(rk_ion_exit); + +MODULE_AUTHOR("Meiyou.chen "); +MODULE_DESCRIPTION("ROCKCHIP Ion driver"); +MODULE_LICENSE("GPL v2"); +MODULE_DEVICE_TABLE(of, rk_ion_match); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/rockchip/rockchip_ion_snapshot.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/rockchip/rockchip_ion_snapshot.c new file mode 100644 index 0000000000000000000000000000000000000000..ab27d05319ae8e055a8b7027538a074fe1c50aa7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/ion/rockchip/rockchip_ion_snapshot.c @@ -0,0 +1,145 @@ +/* + * drivers/staging/android/ion/rockchip/rockchip_ion_snapshot.c + * + * Copyright (C) 2011-2014 ROCKCHIP, Inc. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#define pr_fmt(fmt) "ion_snapshot: " fmt +#include +#include +#include +#include +#include +#include +#include + +#define LOG_BUF_LEN (1 << CONFIG_ION_SNAPSHOT_BUF_SHIFT) +#define LOG_BUF_PAGE_ORDER (CONFIG_ION_SNAPSHOT_BUF_SHIFT - PAGE_SHIFT) +// snapshot for last +static char last_ion_buf[LOG_BUF_LEN]; +// snapshot for current +static char* ion_snapshot_buf; + +static ssize_t last_ion_read(struct file *file, char __user *buf, + size_t len, loff_t *offset) +{ + loff_t pos = *offset; + ssize_t count; + + if (pos >= LOG_BUF_LEN || last_ion_buf[0]==0) + return 0; + + count = min(len, (size_t)(LOG_BUF_LEN - pos)); + if (copy_to_user(buf, &last_ion_buf[pos], count)) + return -EFAULT; + + *offset += count; + return count; +} + +static const struct file_operations last_ion_fops = { + .owner = THIS_MODULE, + .read = last_ion_read, +}; + +static ssize_t ion_snapshot_read(struct file *file, char __user *buf, + size_t len, loff_t *offset) +{ + loff_t pos = *offset; + ssize_t count; + + if (pos >= LOG_BUF_LEN || ion_snapshot_buf[0]==0) + return 0; + + count = min(len, (size_t)(LOG_BUF_LEN - pos)); + if (copy_to_user(buf, &ion_snapshot_buf[pos], count)) + return -EFAULT; + + *offset += count; + return count; +} + +static const struct file_operations ion_snapshot_fops = { + .owner = THIS_MODULE, + .read = ion_snapshot_read, +}; + +char *rockchip_ion_snapshot_get(size_t *size) +{ + *size = LOG_BUF_LEN; + return ion_snapshot_buf; +} + +int rockchip_ion_snapshot_debugfs(struct dentry* root) +{ + struct dentry* last_ion_dentry; + struct dentry* ion_snapshot_dentry; + + last_ion_dentry = debugfs_create_file("last_ion", 0664, + root, + NULL, &last_ion_fops); + if (!last_ion_dentry) { + char buf[256], *path; + path = dentry_path(root, buf, 256); + pr_err("Failed to create client debugfs at %s/%s\n", + path, "last_ion"); + } + + ion_snapshot_dentry = debugfs_create_file("ion_snapshot", 0664, + root, + NULL, &ion_snapshot_fops); + if (!ion_snapshot_dentry) { + char buf[256], *path; + path = dentry_path(root, buf, 256); + pr_err("Failed to create client debugfs at %s/%s\n", + path, "ion_snapshot"); + } + + return 0; +} + +static void * __init last_ion_vmap(phys_addr_t start, unsigned int page_count) +{ + struct page *pages[page_count + 1]; + unsigned int i; + + for (i = 0; i < page_count; i++) { + phys_addr_t addr = start + i * PAGE_SIZE; + pages[i] = pfn_to_page(addr >> PAGE_SHIFT); + } + pages[page_count] = pfn_to_page(start >> PAGE_SHIFT); + return vmap(pages, page_count + 1, VM_MAP, pgprot_writecombine(PAGE_KERNEL)); +} + +static int __init rockchip_ion_snapshot_init(void) +{ + char *log_buf; + + log_buf = (char *)__get_free_pages(GFP_KERNEL, LOG_BUF_PAGE_ORDER); + if (!log_buf) { + pr_err("failed to __get_free_pages(%d)\n", LOG_BUF_PAGE_ORDER); + return 0; + } + + ion_snapshot_buf = last_ion_vmap(virt_to_phys(log_buf), 1 << LOG_BUF_PAGE_ORDER); + if (!ion_snapshot_buf) { + pr_err("failed to map %d pages at 0x%lx\n", 1 << LOG_BUF_PAGE_ORDER, + (unsigned long)virt_to_phys(log_buf)); + return 0; + } + + pr_info("0x%lx map to 0x%p and copy to 0x%p (version 0.1)\n", + (unsigned long)virt_to_phys(log_buf), ion_snapshot_buf, + last_ion_buf); + + memcpy(last_ion_buf, ion_snapshot_buf, LOG_BUF_LEN); + memset(ion_snapshot_buf, 0, LOG_BUF_LEN); + + return 0; +} + +postcore_initcall(rockchip_ion_snapshot_init); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/uapi/ashmem.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/uapi/ashmem.h new file mode 100644 index 0000000000000000000000000000000000000000..2d4673b609d6d9ccb830e56346e7a439aedc9d25 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/uapi/ashmem.h @@ -0,0 +1,54 @@ +/* SPDX-License-Identifier: GPL-2.0 OR Apache-2.0 */ +/* + * drivers/staging/android/uapi/ashmem.h + * + * Copyright 2008 Google Inc. + * Author: Robert Love + */ + +#ifndef _UAPI_LINUX_ASHMEM_H +#define _UAPI_LINUX_ASHMEM_H + +#include +#include + +#define ASHMEM_NAME_LEN 256 + +#define ASHMEM_NAME_DEF "dev/ashmem" + +/* Return values from ASHMEM_PIN: Was the mapping purged while unpinned? */ +#define ASHMEM_NOT_PURGED 0 +#define ASHMEM_WAS_PURGED 1 + +/* Return values from ASHMEM_GET_PIN_STATUS: Is the mapping pinned? */ +#define ASHMEM_IS_UNPINNED 0 +#define ASHMEM_IS_PINNED 1 + +struct ashmem_pin { + __u32 offset; /* offset into region, in bytes, page-aligned */ + __u32 len; /* length forward from offset, in bytes, page-aligned */ +}; + +#define __ASHMEMIOC 0x77 + +#define ASHMEM_SET_NAME _IOW(__ASHMEMIOC, 1, char[ASHMEM_NAME_LEN]) +#define ASHMEM_GET_NAME _IOR(__ASHMEMIOC, 2, char[ASHMEM_NAME_LEN]) +#define ASHMEM_SET_SIZE _IOW(__ASHMEMIOC, 3, size_t) +#define ASHMEM_GET_SIZE _IO(__ASHMEMIOC, 4) +#define ASHMEM_SET_PROT_MASK _IOW(__ASHMEMIOC, 5, unsigned long) +#define ASHMEM_GET_PROT_MASK _IO(__ASHMEMIOC, 6) +#define ASHMEM_PIN _IOW(__ASHMEMIOC, 7, struct ashmem_pin) +#define ASHMEM_UNPIN _IOW(__ASHMEMIOC, 8, struct ashmem_pin) +#define ASHMEM_GET_PIN_STATUS _IO(__ASHMEMIOC, 9) +#define ASHMEM_PURGE_ALL_CACHES _IO(__ASHMEMIOC, 10) + +#ifdef CONFIG_PURGEABLE_ASHMEM +#define PM_SUCCESS 0 +#define PM_FAIL 1 + +#define ASHMEM_SET_PURGEABLE _IO(__ASHMEMIOC, 11) +#define ASHMEM_GET_PURGEABLE _IO(__ASHMEMIOC, 12) +#define PURGEABLE_ASHMEM_IS_PURGED _IO(__ASHMEMIOC, 13) +#define PURGEABLE_ASHMEM_REBUILD_SUCCESS _IO(__ASHMEMIOC, 14) +#endif +#endif /* _UAPI_LINUX_ASHMEM_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/uapi/ion.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/uapi/ion.h new file mode 100644 index 0000000000000000000000000000000000000000..46c93fcb46d6e690298f643c6019edaaa47649b9 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/staging/android/uapi/ion.h @@ -0,0 +1,127 @@ +/* SPDX-License-Identifier: GPL-2.0 WITH Linux-syscall-note */ +/* + * drivers/staging/android/uapi/ion.h + * + * Copyright (C) 2011 Google, Inc. + */ + +#ifndef _UAPI_LINUX_ION_H +#define _UAPI_LINUX_ION_H + +#include +#include + +/** + * enum ion_heap_types - list of all possible types of heaps + * @ION_HEAP_TYPE_SYSTEM: memory allocated via vmalloc + * @ION_HEAP_TYPE_SYSTEM_CONTIG: memory allocated via kmalloc + * @ION_HEAP_TYPE_CARVEOUT: memory allocated from a prereserved + * carveout heap, allocations are physically + * contiguous + * @ION_HEAP_TYPE_DMA: memory allocated via DMA API + * @ION_NUM_HEAPS: helper for iterating over heaps, a bit mask + * is used to identify the heaps, so only 32 + * total heap types are supported + */ +enum ion_heap_type { + ION_HEAP_TYPE_SYSTEM, + ION_HEAP_TYPE_SYSTEM_CONTIG, + ION_HEAP_TYPE_CARVEOUT, + ION_HEAP_TYPE_CHUNK, + ION_HEAP_TYPE_DMA, + ION_HEAP_TYPE_CUSTOM, /* + * must be last so device specific heaps always + * are at the end of this enum + */ +}; + +#define ION_NUM_HEAP_IDS (sizeof(unsigned int) * 8) + +/** + * allocation flags - the lower 16 bits are used by core ion, the upper 16 + * bits are reserved for use by the heaps themselves. + */ + +/* + * mappings of this buffer should be cached, ion will do cache maintenance + * when the buffer is mapped for dma + */ +#define ION_FLAG_CACHED 1 + +/** + * DOC: Ion Userspace API + * + * create a client by opening /dev/ion + * most operations handled via following ioctls + * + */ + +/** + * struct ion_allocation_data - metadata passed from userspace for allocations + * @len: size of the allocation + * @heap_id_mask: mask of heap ids to allocate from + * @flags: flags passed to heap + * @handle: pointer that will be populated with a cookie to use to + * refer to this allocation + * + * Provided by userspace as an argument to the ioctl + */ +struct ion_allocation_data { + __u64 len; + __u32 heap_id_mask; + __u32 flags; + __u32 fd; + __u32 unused; +}; + +#define MAX_HEAP_NAME 32 + +/** + * struct ion_heap_data - data about a heap + * @name - first 32 characters of the heap name + * @type - heap type + * @heap_id - heap id for the heap + */ +struct ion_heap_data { + char name[MAX_HEAP_NAME]; + __u32 type; + __u32 heap_id; + __u32 reserved0; + __u32 reserved1; + __u32 reserved2; +}; + +/** + * struct ion_heap_query - collection of data about all heaps + * @cnt - total number of heaps to be copied + * @heaps - buffer to copy heap data + */ +struct ion_heap_query { + __u32 cnt; /* Total number of heaps to be copied */ + __u32 reserved0; /* align to 64bits */ + __u64 heaps; /* buffer to be populated */ + __u32 reserved1; + __u32 reserved2; +}; + +#define ION_IOC_MAGIC 'I' + +/** + * DOC: ION_IOC_ALLOC - allocate memory + * + * Takes an ion_allocation_data struct and returns it with the handle field + * populated with the opaque handle for the allocation. + */ +#define ION_IOC_ALLOC _IOWR(ION_IOC_MAGIC, 0, \ + struct ion_allocation_data) + +/** + * DOC: ION_IOC_HEAP_QUERY - information about available heaps + * + * Takes an ion_heap_query structure and populates information about + * available Ion heaps. + */ +#define ION_IOC_HEAP_QUERY _IOWR(ION_IOC_MAGIC, 8, \ + struct ion_heap_query) + +#endif /* _UAPI_LINUX_ION_H */ diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/tty/serial/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/tty/serial/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..faf0ce58dd076efb84447f13dac241afbf6b5ff4 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/tty/serial/Kconfig @@ -0,0 +1,12 @@ +config SERIAL_PHYTIUM_PCI + tristate "Phytium PCI serial port support" + depends on PCI + select SERIAL_CORE + help + This driver supports the Phytium UART controller on PCI/PCIe adapters. + If you want to compile this driver into the kernel, say Y here. To + compile this driver as a module, choose M here. + + If unsure, say N. + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/tty/serial/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/tty/serial/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..766f23a0295bb1a03dbc3d866970b7ba50830220 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/tty/serial/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_SERIAL_PHYTIUM_PCI) += phytium-uart.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/tty/serial/phytium-uart.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/tty/serial/phytium-uart.c new file mode 100644 index 0000000000000000000000000000000000000000..c21cf9021608dfc06f8bf4d117ac73a4311f8b36 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/tty/serial/phytium-uart.c @@ -0,0 +1,927 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for Phytium PCI UART controller + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + * + * Derived from drivers/tty/serial/amba-pl011.c + * Copyright 1999 ARM Limited + * Copyright (C) 2000 Deep Blue Solutions Ltd. + * Copyright (C) 2010 ST-Ericsson SA + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define DRV_NAME "phytium_uart" + +#define REG_DR 0x00 +#define REG_FR 0x18 +#define REG_IBRD 0x24 +#define REG_FBRD 0x28 +#define REG_LCRH_RX 0x2c +#define REG_LCRH_TX 0x2c +#define REG_CR 0x30 +#define REG_IFLS 0x34 +#define REG_IMSC 0x38 +#define REG_RIS 0x3c +#define REG_MIS 0x40 +#define REG_ICR 0x44 + +#define REG_DR_OE (1 << 11) +#define REG_DR_BE (1 << 10) +#define REG_DR_PE (1 << 9) +#define REG_DR_FE (1 << 8) + +#define REG_LCRH_SPS 0x80 +#define REG_LCRH_WLEN_8 0x60 +#define REG_LCRH_WLEN_7 0x40 +#define REG_LCRH_WLEN_6 0x20 +#define REG_LCRH_WLEN_5 0x00 +#define REG_LCRH_FEN 0x10 +#define REG_LCRH_STP2 0x08 +#define REG_LCRH_EPS 0x04 +#define REG_LCRH_PEN 0x02 +#define REG_LCRH_BRK 0x01 + +#define REG_FR_RI 0x100 +#define REG_FR_TXFE 0x080 +#define REG_FR_RXFF 0x040 +#define REG_FR_TXFF 0x020 +#define REG_FR_RXFE 0x010 +#define REG_FR_BUSY 0x008 +#define REG_FR_DCD 0x004 +#define REG_FR_DSR 0x002 +#define REG_FR_CTS 0x001 +#define REG_FR_TMSK (REG_FR_TXFF + REG_FR_BUSY) + +#define REG_CR_CTSEN 0x8000 /* CTS hardware flow control */ +#define REG_CR_RTSEN 0x4000 /* RTS hardware flow control */ +#define REG_CR_OUT2 0x2000 /* OUT2 */ +#define REG_CR_OUT1 0x1000 /* OUT1 */ +#define REG_CR_RTS 0x0800 /* RTS */ +#define REG_CR_DTR 0x0400 /* DTR */ +#define REG_CR_RXE 0x0200 /* receive enable */ +#define REG_CR_TXE 0x0100 /* transmit enable */ +#define REG_CR_LBE 0x0080 /* loopback enable */ +#define REG_CR_RTIE 0x0040 +#define REG_CR_TIE 0x0020 +#define REG_CR_RIE 0x0010 +#define REG_CR_MSIE 0x0008 +#define REG_CR_IIRLP 0x0004 /* SIR low power mode */ +#define REG_CR_SIREN 0x0002 /* SIR enable */ +#define REG_CR_UARTEN 0x0001 /* UART enable */ + +#define REG_IFLS_RX1_8 (0 << 3) +#define REG_IFLS_RX2_8 (1 << 3) +#define REG_IFLS_RX4_8 (2 << 3) +#define REG_IFLS_RX6_8 (3 << 3) +#define REG_IFLS_RX7_8 (4 << 3) +#define REG_IFLS_TX1_8 (0 << 0) +#define REG_IFLS_TX2_8 (1 << 0) +#define REG_IFLS_TX4_8 (2 << 0) +#define REG_IFLS_TX6_8 (3 << 0) + +#define REG_IMSC_OEIM (1 << 10) /* overrun error interrupt mask */ +#define REG_IMSC_BEIM (1 << 9) /* break error interrupt mask */ +#define REG_IMSC_PEIM (1 << 8) /* parity error interrupt mask */ +#define REG_IMSC_FEIM (1 << 7) /* framing error interrupt mask */ +#define REG_IMSC_RTIM (1 << 6) /* receive timeout interrupt mask */ +#define REG_IMSC_TXIM (1 << 5) /* transmit interrupt mask */ +#define REG_IMSC_RXIM (1 << 4) /* receive interrupt mask */ +#define REG_IMSC_DSRMIM (1 << 3) /* DSR interrupt mask */ +#define REG_IMSC_DCDMIM (1 << 2) /* DCD interrupt mask */ +#define REG_IMSC_CTSMIM (1 << 1) /* CTS interrupt mask */ +#define REG_IMSC_RIMIM (1 << 0) /* RI interrupt mask */ + +#define REG_ICR_OEIS (1 << 10) /* overrun error interrupt status */ +#define REG_ICR_BEIS (1 << 9) /* break error interrupt status */ +#define REG_ICR_PEIS (1 << 8) /* parity error interrupt status */ +#define REG_ICR_FEIS (1 << 7) /* framing error interrupt status */ +#define REG_ICR_RTIS (1 << 6) /* receive timeout interrupt status */ +#define REG_ICR_TXIS (1 << 5) /* transmit interrupt status */ +#define REG_ICR_RXIS (1 << 4) /* receive interrupt status */ +#define REG_ICR_DSRMIS (1 << 3) /* DSR interrupt status */ +#define REG_ICR_DCDMIS (1 << 2) /* DCD interrupt status */ +#define REG_ICR_CTSMIS (1 << 1) /* CTS interrupt status */ +#define REG_ICR_RIMIS (1 << 0) /* RI interrupt status */ + +#define UART_NR 12 + +#define UART_DR_ERROR (REG_DR_OE|REG_DR_BE|REG_DR_PE|REG_DR_FE) +#define UART_DUMMY_DR_RX (1 << 16) + +#define DEFAULT_UARTCLK 48000000 /* 48 MHz */ + +/* + * We wrap our port structure around the generic uart_port. + */ +struct phytium_uart_port { + struct uart_port port; + unsigned int im; /* interrupt mask */ + unsigned int old_status; + unsigned int old_cr; /* state during shutdown */ + char type[12]; +}; + +static unsigned int phytium_uart_read(const struct phytium_uart_port *pup, + unsigned int reg) +{ + void __iomem *addr = pup->port.membase + reg; + + return readl_relaxed(addr); +} + +static void phytium_uart_write(unsigned int val, const struct phytium_uart_port *pup, + unsigned int reg) +{ + void __iomem *addr = pup->port.membase + reg; + + writel_relaxed(val, addr); +} + +static int phytium_fifo_to_tty(struct phytium_uart_port *pup) +{ + u16 status; + unsigned int ch, flag, fifotaken; + + for (fifotaken = 0; fifotaken < 256; fifotaken++) { + status = phytium_uart_read(pup, REG_FR); + if (status & REG_FR_RXFE) + break; + + /* Take chars from the FIFO and update status */ + ch = phytium_uart_read(pup, REG_DR) | UART_DUMMY_DR_RX; + flag = TTY_NORMAL; + pup->port.icount.rx++; + + if (unlikely(ch & UART_DR_ERROR)) { + if (ch & REG_DR_BE) { + ch &= ~(REG_DR_FE | REG_DR_PE); + pup->port.icount.brk++; + if (uart_handle_break(&pup->port)) + continue; + } else if (ch & REG_DR_PE) + pup->port.icount.parity++; + else if (ch & REG_DR_FE) + pup->port.icount.frame++; + if (ch & REG_DR_OE) + pup->port.icount.overrun++; + + ch &= pup->port.read_status_mask; + + if (ch & REG_DR_BE) + flag = TTY_BREAK; + else if (ch & REG_DR_PE) + flag = TTY_PARITY; + else if (ch & REG_DR_FE) + flag = TTY_FRAME; + } + + if (uart_handle_sysrq_char(&pup->port, ch & 255)) + continue; + + uart_insert_char(&pup->port, ch, REG_DR_OE, ch, flag); + } + + return fifotaken; +} + +static void phytium_rx_chars(struct phytium_uart_port *pup) +__releases(&pup->port.lock) +__acquires(&pup->port.lock) +{ + phytium_fifo_to_tty(pup); + + spin_unlock(&pup->port.lock); + tty_flip_buffer_push(&pup->port.state->port); + spin_lock(&pup->port.lock); +} + +static void phytium_stop_tx(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + pup->im &= ~REG_IMSC_TXIM; + phytium_uart_write(pup->im, pup, REG_IMSC); +} + +static bool phytium_tx_char(struct phytium_uart_port *pup, unsigned char c, + bool from_irq) +{ + + if (unlikely(!from_irq) && + phytium_uart_read(pup, REG_FR) & REG_FR_TXFF) + return false; /* unable to transmit character */ + + phytium_uart_write(c, pup, REG_DR); + pup->port.icount.tx++; + + return true; +} + +static bool phytium_tx_chars(struct phytium_uart_port *pup, bool from_irq) +{ + struct circ_buf *xmit = &pup->port.state->xmit; + int count = pup->port.fifosize >> 1; + + if (pup->port.x_char) { + if (!phytium_tx_char(pup, pup->port.x_char, from_irq)) + return true; + pup->port.x_char = 0; + --count; + } + if (uart_circ_empty(xmit) || uart_tx_stopped(&pup->port)) { + phytium_stop_tx(&pup->port); + return false; + } + + do { + if (likely(from_irq) && count-- == 0) + break; + + if (!phytium_tx_char(pup, xmit->buf[xmit->tail], from_irq)) + break; + + xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1); + } while (!uart_circ_empty(xmit)); + + if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) + uart_write_wakeup(&pup->port); + + if (uart_circ_empty(xmit)) { + phytium_stop_tx(&pup->port); + return false; + } + return true; +} + +static void phytium_modem_status(struct phytium_uart_port *pup) +{ + unsigned int status, delta; + + status = phytium_uart_read(pup, REG_FR) & (REG_FR_DCD|REG_FR_DSR|REG_FR_CTS); + + delta = status ^ pup->old_status; + pup->old_status = status; + + if (!delta) + return; + + if (delta & REG_FR_DCD) + uart_handle_dcd_change(&pup->port, status & REG_FR_DCD); + + if (delta & REG_FR_DSR) + pup->port.icount.dsr++; + + if (delta & REG_FR_CTS) + uart_handle_cts_change(&pup->port, status & REG_FR_CTS); + + wake_up_interruptible(&pup->port.state->port.delta_msr_wait); +} + +static irqreturn_t phytium_uart_interrupt(int irq, void *dev_id) +{ + struct phytium_uart_port *pup = dev_id; + unsigned long flags; + unsigned int status, pass_counter = 256; + int handled = 0; + + spin_lock_irqsave(&pup->port.lock, flags); + status = phytium_uart_read(pup, REG_RIS) & pup->im; + if (status) { + do { + phytium_uart_write(status & ~(REG_ICR_TXIS|REG_ICR_RTIS|REG_ICR_RXIS), + pup, REG_ICR); + + if (status & (REG_ICR_RTIS|REG_ICR_RXIS)) + phytium_rx_chars(pup); + + if (status & (REG_ICR_DSRMIS|REG_ICR_DCDMIS| + REG_ICR_CTSMIS|REG_ICR_RIMIS)) + phytium_modem_status(pup); + if (status & REG_ICR_TXIS) + phytium_tx_chars(pup, true); + + if (pass_counter-- == 0) + break; + + status = phytium_uart_read(pup, REG_RIS) & pup->im; + } while (status != 0); + handled = 1; + } + spin_unlock_irqrestore(&pup->port.lock, flags); + + return IRQ_RETVAL(handled); +} + +static unsigned int phytium_tx_empty(struct uart_port *port) +{ + unsigned int status; + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + status = phytium_uart_read(pup, REG_FR) & (REG_FR_BUSY | REG_FR_TXFF); + + return status ? 0 : TIOCSER_TEMT; +} + +static void phytium_set_mctrl(struct uart_port *port, unsigned int mctrl) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + unsigned int cr; + + cr = phytium_uart_read(pup, REG_CR); + +#define TIOCMBIT(tiocmbit, uartbit) \ + do { \ + if (mctrl & tiocmbit) \ + cr |= uartbit; \ + else \ + cr &= ~uartbit; \ + } while (0) + + TIOCMBIT(TIOCM_RTS, REG_CR_RTS); + TIOCMBIT(TIOCM_DTR, REG_CR_DTR); + TIOCMBIT(TIOCM_OUT1, REG_CR_OUT1); + TIOCMBIT(TIOCM_OUT2, REG_CR_OUT2); + TIOCMBIT(TIOCM_LOOP, REG_CR_LBE); + + if (port->status & UPSTAT_AUTORTS) { + /* We need to disable auto-RTS if we want to turn RTS off */ + TIOCMBIT(TIOCM_RTS, REG_CR_RTSEN); + } +#undef TIOCMBIT + + phytium_uart_write(cr, pup, REG_CR); +} + +static unsigned int phytium_get_mctrl(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + unsigned int cr = 0; + unsigned int status = phytium_uart_read(pup, REG_FR); + +#define TIOCMBIT(uartbit, tiocmbit) \ + do { \ + if (status & uartbit) \ + cr |= tiocmbit; \ + } while (0) + + TIOCMBIT(REG_FR_DCD, TIOCM_CAR); + TIOCMBIT(REG_FR_DSR, TIOCM_DSR); + TIOCMBIT(REG_FR_CTS, TIOCM_CTS); + TIOCMBIT(REG_FR_RI, TIOCM_RNG); +#undef TIOCMBIT + return cr; +} + +static void phytium_start_tx(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + if (phytium_tx_chars(pup, false)) { + pup->im |= REG_IMSC_TXIM; + phytium_uart_write(pup->im, pup, REG_IMSC); + } +} + +static void phytium_stop_rx(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + pup->im &= ~(REG_IMSC_RXIM|REG_IMSC_RTIM|REG_IMSC_FEIM| + REG_IMSC_PEIM|REG_IMSC_BEIM|REG_IMSC_OEIM); + phytium_uart_write(pup->im, pup, REG_IMSC); +} + +static void phytium_enable_ms(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + pup->im |= REG_IMSC_RIMIM|REG_IMSC_CTSMIM|REG_IMSC_DCDMIM|REG_IMSC_DSRMIM; + phytium_uart_write(pup->im, pup, REG_IMSC); +} + +static void phytium_break_ctl(struct uart_port *port, int break_state) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + unsigned long flags; + unsigned int lcr_h; + + spin_lock_irqsave(&pup->port.lock, flags); + lcr_h = phytium_uart_read(pup, REG_LCRH_TX); + if (break_state == -1) + lcr_h |= REG_LCRH_BRK; + else + lcr_h &= ~REG_LCRH_BRK; + phytium_uart_write(lcr_h, pup, REG_LCRH_TX); + spin_unlock_irqrestore(&pup->port.lock, flags); +} + +static int phytium_hwinit(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + /* XXX: more configurable setup method in future */ + pup->port.uartclk = DEFAULT_UARTCLK; + + /* Clear pending error and receive interrupts */ + phytium_uart_write(REG_ICR_OEIS | REG_ICR_BEIS | REG_ICR_PEIS | + REG_ICR_FEIS | REG_ICR_RTIS | REG_ICR_RXIS, + pup, REG_ICR); + + /* + * Save interrupts enable mask, and enable RX interrupts in case if + * the interrupt is used for NMI entry. + */ + pup->im = phytium_uart_read(pup, REG_IMSC); + phytium_uart_write(REG_IMSC_RTIM | REG_IMSC_RXIM, pup, REG_IMSC); + + return 0; +} + +static int phytium_uart_allocate_irq(struct phytium_uart_port *pup) +{ + phytium_uart_write(pup->im, pup, REG_IMSC); + + return request_irq(pup->port.irq, phytium_uart_interrupt, IRQF_SHARED, DRV_NAME, pup); +} + +static void phytium_enable_interrtups(struct phytium_uart_port *pup) +{ + unsigned int i; + + spin_lock_irq(&pup->port.lock); + + /* Clear out any spuriously appearing RX interrupts */ + phytium_uart_write(REG_ICR_RTIS | REG_ICR_RXIS, pup, REG_ICR); + + /* + * RXIS is asserted only when the RX FIFO transitions from below + * to above the trigger threshold. If the RX FIFO is already + * full to the threashold this can't happen and RXIS will now be + * stuck off. Drain the RX FIFO explicitly to fix this: + */ + for (i = 0; i < pup->port.fifosize * 2; i++) { + if (phytium_uart_read(pup, REG_FR) & REG_FR_RXFE) + break; + + phytium_uart_read(pup, REG_DR); + } + + pup->im = REG_IMSC_RTIM | REG_IMSC_RXIM; + phytium_uart_write(pup->im, pup, REG_IMSC); + spin_unlock_irq(&pup->port.lock); +} + +static int phytium_startup(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + unsigned int cr; + int ret = 0; + + ret = phytium_hwinit(port); + if (ret) + goto out; + + ret = phytium_uart_allocate_irq(pup); + if (ret) + goto out; + + phytium_uart_write(REG_IFLS_RX4_8|REG_IFLS_TX4_8, pup, REG_IFLS); + + spin_lock_irq(&pup->port.lock); + + /* restore RTS and DTR */ + cr = pup->old_cr & (REG_CR_RTS | REG_CR_DTR); + cr |= REG_CR_UARTEN | REG_CR_RXE | REG_CR_TXE; + phytium_uart_write(cr, pup, REG_CR); + + spin_unlock_irq(&pup->port.lock); + + /* initialise the old status of the modem signals */ + pup->old_status = phytium_uart_read(pup, REG_FR) & (REG_FR_DCD|REG_FR_DSR|REG_FR_CTS); + + phytium_enable_interrtups(pup); + +out: + return ret; +} + +static void phytium_shutdown_channel(struct phytium_uart_port *pup, + unsigned int lcrh) +{ + unsigned long val; + + val = phytium_uart_read(pup, lcrh); + val &= ~(REG_LCRH_BRK | REG_LCRH_FEN); + phytium_uart_write(val, pup, lcrh); +} + +static void phytium_disable_uart(struct phytium_uart_port *pup) +{ + unsigned int cr; + + pup->port.status &= ~(UPSTAT_AUTOCTS | UPSTAT_AUTORTS); + spin_lock_irq(&pup->port.lock); + cr = phytium_uart_read(pup, REG_CR); + pup->old_cr = cr; + cr &= REG_CR_RTS | REG_CR_DTR; + cr |= REG_CR_UARTEN | REG_CR_TXE; + phytium_uart_write(cr, pup, REG_CR); + spin_unlock_irq(&pup->port.lock); + + /* + * disable break condition and fifos + */ + phytium_shutdown_channel(pup, REG_LCRH_RX); +} + +static void phytium_disable_interrupts(struct phytium_uart_port *pup) +{ + spin_lock_irq(&pup->port.lock); + + /* mask all interrupts and clear all pending ones */ + pup->im = 0; + phytium_uart_write(pup->im, pup, REG_IMSC); + phytium_uart_write(0xffff, pup, REG_ICR); + + spin_unlock_irq(&pup->port.lock); +} + +static void phytium_shutdown(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + + phytium_disable_interrupts(pup); + + free_irq(pup->port.irq, pup); + + phytium_disable_uart(pup); + + if (pup->port.ops->flush_buffer) + pup->port.ops->flush_buffer(port); +} + +static void +phytium_setup_status_masks(struct uart_port *port, struct ktermios *termios) +{ + port->read_status_mask = REG_DR_OE | 255; + if (termios->c_iflag & INPCK) + port->read_status_mask |= REG_DR_FE | REG_DR_PE; + if (termios->c_iflag & (IGNBRK | BRKINT | PARMRK)) + port->read_status_mask |= REG_DR_BE; + + /* + * Characters to ignore + */ + port->ignore_status_mask = 0; + if (termios->c_iflag & IGNPAR) + port->ignore_status_mask |= REG_DR_FE | REG_DR_PE; + if (termios->c_iflag & IGNBRK) { + port->ignore_status_mask |= REG_DR_BE; + /* + * If we're ignoring parity and break indicators, + * ignore overruns too (for real raw support). + */ + if (termios->c_iflag & IGNPAR) + port->ignore_status_mask |= REG_DR_OE; + } + + /* + * Ignore all characters if CREAD is not set. + */ + if ((termios->c_cflag & CREAD) == 0) + port->ignore_status_mask |= UART_DUMMY_DR_RX; +} + +static void +phytium_set_termios(struct uart_port *port, struct ktermios *termios, const struct ktermios *old) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + unsigned int lcr_h, old_cr; + unsigned long flags; + unsigned int baud, quot; + + /* Ask the core to calculate the divisor for us. */ + baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16); + + if (baud > port->uartclk/16) + quot = DIV_ROUND_CLOSEST(port->uartclk * 8, baud); + else + quot = DIV_ROUND_CLOSEST(port->uartclk * 4, baud); + + switch (termios->c_cflag & CSIZE) { + case CS5: + lcr_h = REG_LCRH_WLEN_5; + break; + case CS6: + lcr_h = REG_LCRH_WLEN_6; + break; + case CS7: + lcr_h = REG_LCRH_WLEN_7; + break; + default: /* CS8 */ + lcr_h = REG_LCRH_WLEN_8; + break; + } + if (termios->c_cflag & CSTOPB) + lcr_h |= REG_LCRH_STP2; + if (termios->c_cflag & PARENB) { + lcr_h |= REG_LCRH_PEN; + if (!(termios->c_cflag & PARODD)) + lcr_h |= REG_LCRH_EPS; + if (termios->c_cflag & CMSPAR) + lcr_h |= REG_LCRH_SPS; + } + if (pup->port.fifosize > 1) + lcr_h |= REG_LCRH_FEN; + + spin_lock_irqsave(&port->lock, flags); + + /* + * Update the per-port timeout. + */ + uart_update_timeout(port, termios->c_cflag, baud); + + phytium_setup_status_masks(port, termios); + + if (UART_ENABLE_MS(port, termios->c_cflag)) + phytium_enable_ms(port); + + /* first, disable everything */ + old_cr = phytium_uart_read(pup, REG_CR); + phytium_uart_write(0, pup, REG_CR); + + if (termios->c_cflag & CRTSCTS) { + if (old_cr & REG_CR_RTS) + old_cr |= REG_CR_RTSEN; + + old_cr |= REG_CR_CTSEN; + port->status |= UPSTAT_AUTOCTS | UPSTAT_AUTORTS; + } else { + old_cr &= ~(REG_CR_CTSEN | REG_CR_RTSEN); + port->status &= ~(UPSTAT_AUTOCTS | UPSTAT_AUTORTS); + } + + /* Set baud rate */ + phytium_uart_write(quot & 0x3f, pup, REG_FBRD); + phytium_uart_write(quot >> 6, pup, REG_IBRD); + + phytium_uart_write(lcr_h, pup, REG_LCRH_RX); + phytium_uart_write(old_cr, pup, REG_CR); + + spin_unlock_irqrestore(&port->lock, flags); +} + +static const char *phytium_type(struct uart_port *port) +{ + struct phytium_uart_port *pup = + container_of(port, struct phytium_uart_port, port); + return pup->port.type == PORT_PHYTIUM ? pup->type : NULL; +} + +static void phytium_release_port(struct uart_port *port) +{ + /* Nothing to release ... */ +} + +static int phytium_request_port(struct uart_port *port) +{ + /* UARTs always present */ + return 0; +} + +static void phytium_config_port(struct uart_port *port, int flags) +{ + if (flags & UART_CONFIG_TYPE) { + port->type = PORT_PHYTIUM; + phytium_request_port(port); + } +} + +static int phytium_verify_port(struct uart_port *port, struct serial_struct *ser) +{ + int ret = 0; + + if (ser->type != PORT_UNKNOWN && ser->type != PORT_PHYTIUM) + ret = -EINVAL; + if (ser->irq < 0 || ser->irq >= nr_irqs) + ret = -EINVAL; + if (ser->baud_base < 9600) + ret = -EINVAL; + + return ret; +} + +static const struct uart_ops phytium_uart_ops = { + .tx_empty = phytium_tx_empty, + .set_mctrl = phytium_set_mctrl, + .get_mctrl = phytium_get_mctrl, + .stop_tx = phytium_stop_tx, + .start_tx = phytium_start_tx, + .stop_rx = phytium_stop_rx, + .enable_ms = phytium_enable_ms, + .break_ctl = phytium_break_ctl, + .startup = phytium_startup, + .shutdown = phytium_shutdown, + .set_termios = phytium_set_termios, + .type = phytium_type, + .release_port = phytium_release_port, + .request_port = phytium_request_port, + .config_port = phytium_config_port, + .verify_port = phytium_verify_port, +}; + +static struct phytium_uart_port *uart_ports[UART_NR]; + +static struct uart_driver phytium_uart = { + .owner = THIS_MODULE, + .driver_name = DRV_NAME, + .dev_name = "ttyFTX", + .nr = UART_NR, +}; + +void phytium_unregister_port(struct phytium_uart_port *pup) +{ + int i; + bool busy = false; + + for (i = 0; i < ARRAY_SIZE(uart_ports); i++) { + if (uart_ports[i] == pup) + uart_ports[i] = NULL; + else if (uart_ports[i]) + busy = true; + } + + if (!busy) + uart_unregister_driver(&phytium_uart); +} + +static int phytium_find_free_port(void) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(uart_ports); i++) + if (uart_ports[i] == NULL) + return i; + + return -EBUSY; +} + +static int phytium_register_port(struct phytium_uart_port *pup) +{ + int rc; + + /* Ensure interrupts from this UART are masked and cleared */ + phytium_uart_write(0, pup, REG_IMSC); + phytium_uart_write(0xffff, pup, REG_ICR); + + if (!phytium_uart.state) { + rc = uart_register_driver(&phytium_uart); + if (rc < 0) { + dev_err(pup->port.dev, + "Failed to register Phytium PCI UART driver\n"); + return rc; + } + } + + rc = uart_add_one_port(&phytium_uart, &pup->port); + if (rc) + phytium_unregister_port(pup); + + return rc; +} + +static int phytium_uart_probe(struct pci_dev *pdev, + const struct pci_device_id *id) +{ + struct phytium_uart_port *pup; + int portnr, rc; + + portnr = phytium_find_free_port(); + if (portnr < 0) + return portnr; + + pup = devm_kzalloc(&pdev->dev, sizeof(struct phytium_uart_port), + GFP_KERNEL); + if (!pup) + return -ENOMEM; + + rc = pcim_enable_device(pdev); + if (rc) + return rc; + + rc = pcim_iomap_regions_request_all(pdev, 0x01, pci_name(pdev)); + if (rc) + return rc; + + pup->port.iotype = UPIO_MEM32; + pup->port.irq = pdev->irq; + pup->port.mapbase = pci_resource_start(pdev, 0); + pup->port.membase = pcim_iomap_table(pdev)[0]; + pup->port.ops = &phytium_uart_ops; + pup->port.dev = &pdev->dev; + pup->port.fifosize = 32; + pup->port.flags = UPF_BOOT_AUTOCONF; + pup->port.line = portnr; + + uart_ports[portnr] = pup; + + pup->old_cr = 0; + snprintf(pup->type, sizeof(pup->type), "pci-uart"); + + pci_set_drvdata(pdev, pup); + + return phytium_register_port(pup); +} + +static void phytium_uart_remove(struct pci_dev *pdev) +{ + struct phytium_uart_port *pup = pci_get_drvdata(pdev); + + uart_remove_one_port(&phytium_uart, &pup->port); + phytium_unregister_port(pup); +} + +#ifdef CONFIG_PM_SLEEP +static int phytium_uart_suspend(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_uart_port *pup = pci_get_drvdata(pdev); + + if (pup) + uart_suspend_port(&phytium_uart, &pup->port); + + return 0; +} + +static int phytium_uart_resume(struct device *dev) +{ + struct pci_dev *pdev = to_pci_dev(dev); + struct phytium_uart_port *pup = pci_get_drvdata(pdev); + + if (pup) + uart_resume_port(&phytium_uart, &pup->port); + + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(phytium_dev_pm_ops, phytium_uart_suspend, phytium_uart_resume); + +static const struct pci_device_id pci_ids[] = { + { PCI_VDEVICE(PHYTIUM, 0xdc2e) }, + { 0 } +}; +MODULE_DEVICE_TABLE(pci, pci_ids); + +static struct pci_driver phytium_uart_pci_driver = { + .name = DRV_NAME, + .probe = phytium_uart_probe, + .remove = phytium_uart_remove, + .driver = { + .pm = &phytium_dev_pm_ops, + }, + .id_table = pci_ids, +}; + +static int __init phytium_uart_init(void) +{ + pr_info("Serial: Phytium PCI UART driver\n"); + + return pci_register_driver(&phytium_uart_pci_driver); +} + +static void __exit phytium_uart_exit(void) +{ + pci_unregister_driver(&phytium_uart_pci_driver); +} + +module_init(phytium_uart_init); +module_exit(phytium_uart_exit); + +MODULE_AUTHOR("Chen Baozi "); +MODULE_DESCRIPTION("Phytium PCI serial port driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..797d7b4ee1034da3e3d2a88f631de11cc1a9690e --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/Kconfig @@ -0,0 +1,20 @@ +config USB_PHYTIUM + tristate "PHYTIUM USB Support" + depends on USB + depends on USB_GADGET + help + Say Y or M here if your system has a OTG USB Controller based on PHYTIUM SOC. + + If you choose to build this driver is a dynamically linked modules, the module will + be called phytium-usb.ko + +config USB_PHYTIUM_PCI + tristate "PHYTIUM PCI USB Support" + default n + depends on USB + depends on USB_GADGET + help + Say Y or M here if your system has a OTG USB Controller based on PHYTIUM SOC. + + If you choose to build this driver is a dynamically linked modules, the module will + be called phytium-usb-pci.ko diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..e176c334cba560bf54bbbc92a89ea17faeace449 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/Makefile @@ -0,0 +1,7 @@ +# SPDX-License-Identifier: GPL-2.0 + +obj-$(CONFIG_USB_PHYTIUM) += phytium-usb.o +obj-$(CONFIG_USB_PHYTIUM_PCI) += phytium-usb-pci.o + +phytium-usb-y := core.o dma.o platform.o host.o gadget.o +phytium-usb-pci-y := core.o dma.o pci.o host.o gadget.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/core.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/core.c new file mode 100644 index 0000000000000000000000000000000000000000..c0182c0770e5ef5f5baa7d7b1709b844ca8578db --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/core.c @@ -0,0 +1,44 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include "core.h" + +int phytium_core_reset(struct phytium_cusb *config, bool skip_wait) +{ + if (!config) + return 0; + + spin_lock_init(&config->lock); + + return 0; +} + +uint32_t phytium_read32(uint32_t *address) +{ + return readl(address); +} + +void phytium_write32(uint32_t *address, uint32_t value) +{ + writel(value, address); +} + +uint16_t phytium_read16(uint16_t *address) +{ + return readw(address); +} + +void phytium_write16(uint16_t *address, uint16_t value) +{ + writew(value, address); +} + +uint8_t phytium_read8(uint8_t *address) +{ + return readb(address); +} + +void phytium_write8(uint8_t *address, uint8_t value) +{ + writeb(value, address); +} + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/core.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/core.h new file mode 100644 index 0000000000000000000000000000000000000000..f563672ccaa9963859ff3e1bf8ce62276d3c0bce --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/core.h @@ -0,0 +1,98 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef __PHYTIUM_CORE_H__ +#define __PHYTIUM_CORE_H__ + +#include +#include +#include "host_api.h" +#include "gadget.h" + +#define MAX_EPS_CHANNELS 16 + +struct phytium_ep { + struct phytium_cusb *config; + u16 max_packet; + u8 ep_num; + struct GADGET_EP *gadget_ep; + struct list_head req_list; + struct usb_ep end_point; + char name[12]; + u8 is_tx; + const struct usb_endpoint_descriptor *desc; + u8 busy; +}; + +struct phytium_request { + struct usb_request request; + struct GADGET_REQ *gadget_request; + struct list_head list; + struct phytium_ep *ep; + struct phytium_cusb *config; + u8 is_tx; + u8 epnum; +}; + +struct phytium_cusb { + struct device *dev; + void __iomem *regs; + void __iomem *phy_regs; + int irq; + spinlock_t lock; + enum usb_dr_mode dr_mode; + + struct GADGET_OBJ *gadget_obj; + struct GADGET_CFG gadget_cfg; + struct GADGET_CALLBACKS gadget_callbacks; + struct GADGET_SYSREQ gadget_sysreq; + struct GADGET_DEV *gadget_dev; + void *gadget_priv; + + struct usb_gadget gadget; + struct usb_gadget_driver *gadget_driver; + struct phytium_ep endpoints_tx[MAX_EPS_CHANNELS]; + struct phytium_ep endpoints_rx[MAX_EPS_CHANNELS]; + u8 ep0_data_stage_is_tx; + + struct HOST_OBJ *host_obj; + struct HOST_CFG host_cfg; + struct HOST_CALLBACKS host_callbacks; + struct HOST_SYSREQ host_sysreq; + void *host_priv; + struct usb_hcd *hcd; + + struct DMA_OBJ *dma_obj; + struct DMA_CFG dma_cfg; + struct DMA_CALLBACKS dma_callbacks; + struct DMA_SYSREQ dma_sysreq; + bool isVhubHost; +}; + +int phytium_core_reset(struct phytium_cusb *config, bool skip_wait); + +int phytium_host_init(struct phytium_cusb *config); +int phytium_host_uninit(struct phytium_cusb *config); + +#ifdef CONFIG_PM +int phytium_host_resume(void *priv); +int phytium_host_suspend(void *priv); +int phytium_gadget_resume(void *priv); +int phytium_gadget_suspend(void *priv); +#endif + +int phytium_gadget_init(struct phytium_cusb *config); +int phytium_gadget_uninit(struct phytium_cusb *config); + +uint32_t phytium_read32(uint32_t *address); + +void phytium_write32(uint32_t *address, uint32_t value); + +uint16_t phytium_read16(uint16_t *address); + +void phytium_write16(uint16_t *address, uint16_t value); + +uint8_t phytium_read8(uint8_t *address); + +void phytium_write8(uint8_t *address, uint8_t value); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/dma.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/dma.c new file mode 100644 index 0000000000000000000000000000000000000000..acc0674cf5d38bda23e10b2e155723f832de582f --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/dma.c @@ -0,0 +1,784 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include +#include +#include "core.h" +#include "dma.h" +#include "hw-regs.h" + +#define TRB_POOL_SIZE (sizeof(struct DMA_Trb) * (NUM_OF_TRB)) +#define TRB_BURST_LENGTH (0x80 << 24) + +#define BUILD_NORMAL_TRB_NO_IOC(trb, data_ptr, data_size, stream_id) { \ + trb.dmaAddr = data_ptr; \ + trb.dmaSize = data_size; \ + trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT; } + +#define BUILD_NORMAL_TRB_NO_IOC_CHAIN(trb, data_ptr, data_size, stream_id) { \ + trb.dmaAddr = data_ptr; \ + trb.dmaSize = data_size; \ + trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT | TDF_CHAIN_BIT; } + +#define BUILD_NORMAL_TRB(trb, data_ptr, data_size, stream_id) { \ + trb.dmaAddr = data_ptr; \ + trb.dmaSize = (data_size) | TRB_BURST_LENGTH; \ + trb.ctrl = (stream_id << 16) | TD_TYPE_NORMAL | TDF_CYCLE_BIT |\ + TDF_INT_ON_COMPLECTION | TDF_INT_ON_SHORT_PACKET; } + +#define BUILD_LINK_TRB(trb, target_ptr) { \ + trb.dmaAddr = target_ptr; \ + trb.dmaSize = 0; \ + trb.ctrl = TD_TYPE_LINK | TDF_CYCLE_BIT | TDF_CHAIN_BIT; } + +#define BUILD_EMPTY_TRB(trb) { \ + trb.dmaAddr = 0; \ + trb.dmaSize = 0; \ + trb.ctrl = 0; } + + +uint32_t divRoundUp(uint32_t divident, uint32_t divisor) +{ + return divisor ? ((divident + divisor - 1) / divisor) : 0; +} + +static inline struct DMA_TrbChainDesc *GetTrbChainDescEntry(struct list_head *list) +{ + return (struct DMA_TrbChainDesc *)((uintptr_t)list - + (uintptr_t)&(((struct DMA_TrbChainDesc *)0)->chainNode)); +} + +static int32_t phytium_dma_probe(struct DMA_CFG *config, struct DMA_SYSREQ *sysReq) +{ + if (!sysReq) + return -EINVAL; + + sysReq->trbMemSize = TRB_POOL_SIZE; + sysReq->privDataSize = sizeof(struct DMA_CONTROLLER); + + return 0; +} + +static int32_t phytium_dma_init(struct DMA_CONTROLLER *priv, + const struct DMA_CFG *config, struct DMA_CALLBACKS *callbacks) +{ + if (!priv || !config || !callbacks) + return -EINVAL; + + if (!config->trbAddr || !config->trbDmaAddr) + return -EINVAL; + + memset((void *)priv, 0, sizeof(struct DMA_CONTROLLER)); + memset((void *)config->trbAddr, 0, TRB_POOL_SIZE); + + priv->trbDMAPoolAddr = config->trbDmaAddr; + priv->trbPoolAddr = config->trbAddr; + priv->regs = (struct DMARegs *)config->regBase; + priv->dmaCfg = *config; + priv->dmaDrv = DMA_GetInstance(); + priv->dmaCallbacks = *callbacks; + priv->isHostCtrlMode = 0; + return 0; +} + +static void phytium_dma_destroy(struct DMA_CONTROLLER *priv) +{ + +} + +static int32_t phytium_dma_start(struct DMA_CONTROLLER *priv) +{ + int i; + + if (!priv) + return -EINVAL; + + priv->dmaMode = DMA_MODE_CHANNEL_INDIVIDUAL; + if ((priv->dmaCfg.dmaModeRx & priv->dmaCfg.dmaModeTx) == 0xFFFF) { + priv->dmaMode = DMA_MODE_GLOBAL_DMULT; + phytium_write32(&priv->regs->conf, DMARF_DMULT); + } else if ((priv->dmaCfg.dmaModeRx | priv->dmaCfg.dmaModeTx)) { + priv->dmaMode = DMA_MODE_GLOBAL_DSING; + phytium_write32(&priv->regs->conf, DMARF_DSING); + } + + for (i = 0; i < MAX_DMA_CHANNELS; i++) { + if (priv->dmaCfg.dmaModeRx & (1 << i)) { + priv->rx[i].dmultEnabled = 1; + priv->rx[i].maxTrbLen = TD_DMULT_MAX_TRB_DATA_SIZE; + priv->rx[i].maxTdLen = TD_DMULT_MAX_TD_DATA_SIZE; + } else { + priv->rx[i].dmultEnabled = 0; + priv->rx[i].maxTrbLen = TD_SING_MAX_TRB_DATA_SIZE; + priv->rx[i].maxTdLen = TD_SING_MAX_TD_DATA_SIZE; + } + priv->rx[i].lastTransferLength = 0; + + if (priv->dmaCfg.dmaModeTx & (1 << i)) { + priv->tx[i].dmultEnabled = 1; + priv->tx[i].maxTrbLen = TD_DMULT_MAX_TRB_DATA_SIZE; + priv->tx[i].maxTdLen = TD_DMULT_MAX_TD_DATA_SIZE; + } else { + priv->tx[i].dmultEnabled = 0; + priv->tx[i].maxTrbLen = TD_SING_MAX_TRB_DATA_SIZE; + priv->tx[i].maxTdLen = TD_SING_MAX_TD_DATA_SIZE; + } + priv->tx[i].lastTransferLength = 0; + } + + return 0; +} + +static uint32_t phytium_dma_stop(struct DMA_CONTROLLER *priv) +{ + + return 0; +} + +static int32_t updateDescBuffer(struct DMA_CONTROLLER *priv, + struct DMA_TrbChainDesc *trbChainDesc, uint16_t status) +{ + uint32_t ep_sel, i; + struct DMA_Channel *channel; + + if (!priv || !trbChainDesc) + return -EINVAL; + + channel = trbChainDesc->channel; + if (!channel) + return -EINVAL; + + if (channel->isIsoc && trbChainDesc->lastTrbIsLink) { + if (channel->trbChainDescList.prev == channel->trbChainDescList.next) + return 0; + } + + for (i = 0; i < trbChainDesc->numOfTrbs; i++) { + if (trbChainDesc->framesDesc) { + if (trbChainDesc->isoError) + trbChainDesc->framesDesc[i].length = 0; + else + trbChainDesc->framesDesc[i].length = + (uint32_t)trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK; + } + + trbChainDesc->actualLen += + (uint32_t)trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK; + } + + if (trbChainDesc->isoError) + trbChainDesc->actualLen = 0; + + ep_sel = phytium_read32(&priv->regs->ep_sel); + channel->lastTransferLength = trbChainDesc->actualLen; + + if (!trbChainDesc->lastTrbIsLink) { + if (!list_empty(&trbChainDesc->chainNode)) { + for (i = 0; i < trbChainDesc->mapSize; i++) + priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; + + trbChainDesc->channel->numOfTrbChain--; + trbChainDesc->reserved = 0; + list_del(&trbChainDesc->chainNode); + trbChainDesc = NULL; + } + } + + if (channel->trbChainDescList.prev == &channel->trbChainDescList) + channel->status = DMA_STATUS_FREE; + + if (priv->dmaCallbacks.complete) + priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, + channel->isDirTx, false); + + if (channel->trbChainDescList.next != &channel->trbChainDescList) { + trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); + if (trbChainDesc && trbChainDesc->lastTrbIsLink) { + if (!list_empty(&trbChainDesc->chainNode)) { + for (i = 0; i < trbChainDesc->mapSize; i++) + priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; + + trbChainDesc->channel->numOfTrbChain--; + trbChainDesc->reserved = 0; + list_del(&trbChainDesc->chainNode); + } + } + } + phytium_write32(&priv->regs->ep_sel, ep_sel); + + return 0; +} + +static void phytium_dma_isr(struct DMA_CONTROLLER *priv) +{ + uint32_t ep_sts, ep_ists, ep_cfg; + int i; + uint8_t isDirTx, epNum; + struct DMA_Channel *channel; + struct DMA_TrbChainDesc *trbChainDesc; + + if (!priv) + return; + + ep_ists = phytium_read32(&priv->regs->ep_ists); + if (!ep_ists) { + phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | + DMARF_EP_ISP | DMARF_EP_TRBERR); + return; + } + + for (i = 0; i < 32; i++) { + if (!(ep_ists & (1 << i))) + continue; + + isDirTx = i > 15 ? DMARD_EP_TX : 0u; + epNum = isDirTx ? i - 16 : i; + phytium_write32(&priv->regs->ep_sel, epNum | isDirTx); + + if (isDirTx) + channel = &priv->tx[epNum]; + else + channel = &priv->rx[epNum]; + + ep_sts = phytium_read32(&priv->regs->ep_sts); + + if (ep_sts & DMARF_EP_TRBERR) + phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); + + if ((ep_sts & DMARF_EP_IOC) || (ep_sts & DMARF_EP_ISP) || (channel->dmultGuard + & DMARF_EP_IOC) || (channel->dmultGuard & DMARF_EP_ISP)) { +retransmit: + phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP); + trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); + if (!(ep_sts & DMARF_EP_TRBERR) && channel->dmultEnabled + && !trbChainDesc->lastTrbIsLink) { + if (!priv->isHostCtrlMode && !channel->isDirTx) { + channel->dmultGuard = 0; + phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); + ep_cfg = phytium_read32(&priv->regs->ep_cfg); + ep_cfg &= ~DMARV_EP_ENABLED; + phytium_write32(&priv->regs->ep_cfg, (uint32_t)ep_cfg); + updateDescBuffer(priv, trbChainDesc, 0); + break; + } + channel->dmultGuard = ep_sts; + break; + } + + channel->dmultGuard = 0; + updateDescBuffer(priv, trbChainDesc, 0); + } + + if (ep_sts & DMARF_EP_OUTSMM) + phytium_write32(&priv->regs->ep_sts, DMARF_EP_OUTSMM); + + if (ep_sts & DMARF_EP_DESCMIS) + phytium_write32(&priv->regs->ep_sts, DMARF_EP_DESCMIS); + + if (ep_sts & DMARF_EP_ISOERR) { + phytium_write32(&priv->regs->ep_sts, DMARF_EP_ISOERR); + trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); + trbChainDesc->isoError = 1; + goto retransmit; + } + } +} + +static void phytium_dma_errIsr(struct DMA_CONTROLLER *priv, uint8_t irqNr, uint8_t isDirTx) +{ + struct DMA_Channel *channel; + + if (!priv) + return; + + if (isDirTx) + channel = &priv->tx[irqNr]; + else + channel = &priv->rx[irqNr]; + + if (channel->status >= DMA_STATUS_BUSY) + channel->status = DMA_STATUS_ABORT; + + if (priv->dmaCallbacks.complete) { + if (!irqNr && priv->resubmit) { + priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, + channel->isDirTx, true); + priv->resubmit = false; + } else + priv->dmaCallbacks.complete(priv->parent, channel->hwUsbEppNum, + channel->isDirTx, false); + } +} + +static void *phytium_dma_channelAlloc(struct DMA_CONTROLLER *priv, + uint8_t isDirTx, uint8_t hwEpNum, uint8_t isIsoc) +{ + struct DMA_Channel *channel; + uint32_t ep_ien, ep_cfg; + uint16_t dmaMode; + + if (!priv || (hwEpNum >= MAX_DMA_CHANNELS)) + return NULL; + + if (!priv->regs) { + pr_err("dma regs is null\n"); + return NULL; + } + + ep_ien = phytium_read32(&priv->regs->ep_ien); + + if (isDirTx) { + if (priv->tx[hwEpNum].status > DMA_STATUS_FREE) + return NULL; + + channel = &priv->tx[hwEpNum]; + channel->isDirTx = 0x80; + ep_ien |= (0x01 << (hwEpNum + 16)); + dmaMode = priv->dmaCfg.dmaModeTx; + } else { + if (priv->rx[hwEpNum].status > DMA_STATUS_FREE) + return NULL; + + channel = &priv->rx[hwEpNum]; + channel->isDirTx = 0x00; + ep_ien |= (0x01 << hwEpNum); + dmaMode = priv->dmaCfg.dmaModeRx; + } + + channel->isIsoc = 0; + if (isIsoc) + channel->isIsoc = 1; + + INIT_LIST_HEAD(&channel->trbChainDescList); + channel->numOfTrbChain = 0; + channel->controller = priv; + channel->dmultGuard = 0; + channel->status = DMA_STATUS_FREE; + channel->hwUsbEppNum = hwEpNum; + + phytium_write32(&priv->regs->ep_sel, (uint32_t)hwEpNum | channel->isDirTx); + ep_cfg = phytium_read32(&priv->regs->ep_cfg); + + if (priv->dmaMode == DMA_MODE_CHANNEL_INDIVIDUAL) { + if (dmaMode & (1 << hwEpNum)) + ep_cfg |= DMARV_EP_DMULT; + else + ep_cfg |= DMARV_EP_DSING; + } + + phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP | DMARF_EP_TRBERR); + phytium_write32(&priv->regs->ep_cfg, (uint32_t)DMARV_EP_ENABLED | ep_cfg); + phytium_write32(&priv->regs->ep_ien, ep_ien); + phytium_write32(&priv->regs->ep_sts_en, DMARF_EP_TRBERR); + + return channel; +} + +static int32_t phytium_dma_channelRelease(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) +{ + uint32_t ep_ien, i; + struct DMA_TrbChainDesc *trbChainDesc; + + if (!channel || !priv) + return -EINVAL; + + ep_ien = phytium_read32(&priv->regs->ep_ien); + if (channel->isDirTx) + ep_ien &= ~(0x01 << (channel->hwUsbEppNum + 16)); + else + ep_ien &= ~(0x01 << channel->hwUsbEppNum); + + phytium_write32(&priv->regs->ep_sel, (uint32_t)channel->hwUsbEppNum | channel->isDirTx); + phytium_write32(&priv->regs->ep_cfg, (uint32_t)0); + phytium_write32(&priv->regs->ep_ien, ep_ien); + phytium_write32(&priv->regs->ep_sts_en, 0x0); + phytium_write32(&priv->regs->ep_cmd, DMARF_EP_EPRST); + phytium_write32(&priv->regs->ep_sts, DMARF_EP_IOC | DMARF_EP_ISP | + DMARF_EP_TRBERR | DMARF_EP_ISOERR); + + if (channel->status >= DMA_STATUS_BUSY) + channel->status = DMA_STATUS_ABORT; + + priv->dmaDrv->dma_channelAbort(priv, channel); + + while (channel->trbChainDescList.next != &channel->trbChainDescList) { + trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); + if (trbChainDesc) { + if (!list_empty(&trbChainDesc->chainNode)) { + for (i = 0; i < trbChainDesc->mapSize; i++) + priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; + + trbChainDesc->channel->numOfTrbChain--; + trbChainDesc->reserved = 0; + list_del(&trbChainDesc->chainNode); + } + } + } + + channel->status = DMA_STATUS_UNKNOWN; + + return 0; +} + +static void ShowTrbChain(struct DMA_TrbChainDesc *trbChainDesc) +{ + int i; + + if (!trbChainDesc) + return; + pr_debug("Trb Chain %p for channel %p\n", trbChainDesc, trbChainDesc->channel); + pr_debug("idx | trb size | trb addr | FLAG: NORMAL LINK CHAIN ALL\n"); + for (i = 0; i < trbChainDesc->numOfTrbs + 2; i++) + pr_debug("%02d | %08x | %08x | %d %d %d %08x\n", + i, + trbChainDesc->trbPool[i].dmaSize & TD_SIZE_MASK, + trbChainDesc->trbPool[i].dmaAddr, + (trbChainDesc->trbPool[i].ctrl & TD_TYPE_NORMAL) ? 1 : 0, + (trbChainDesc->trbPool[i].ctrl & TD_TYPE_LINK) ? 1 : 0, + (trbChainDesc->trbPool[i].ctrl & TDF_CHAIN_BIT) ? 1 : 0, + trbChainDesc->trbPool[i].ctrl); +} + +static uint32_t phytium_dma_NewTd(struct DMA_CONTROLLER *priv, + struct DMA_TrbChainDesc *trbChainDesc) +{ + uint32_t startAddress, dataSize; + struct DMA_Channel *channel; + int i = 0; + uint32_t tmp = 0; + + if (!priv || !trbChainDesc) + return 0; + + startAddress = trbChainDesc->dwStartAddress; + channel = trbChainDesc->channel; + dataSize = channel->maxTrbLen; + + if (trbChainDesc->numOfTrbs > 1) { + for (i = 0; i < (trbChainDesc->numOfTrbs - 1); i++) { + if (channel->dmultEnabled) { + if (trbChainDesc->framesDesc && priv->isHostCtrlMode + && channel->isIsoc) { + BUILD_NORMAL_TRB_NO_IOC(trbChainDesc->trbPool[i], + trbChainDesc->dwStartAddress + + trbChainDesc->framesDesc[i].offset, + trbChainDesc->framesDesc[i].length, 0); + continue; + } else + BUILD_NORMAL_TRB_NO_IOC(trbChainDesc->trbPool[i], + startAddress, dataSize, 0); + } else + BUILD_NORMAL_TRB_NO_IOC_CHAIN(trbChainDesc->trbPool[i], + startAddress, dataSize, 0); + startAddress += dataSize; + tmp += dataSize; + } + } + + if (trbChainDesc->framesDesc && priv->isHostCtrlMode && channel->isIsoc) { + BUILD_NORMAL_TRB(trbChainDesc->trbPool[i], + trbChainDesc->dwStartAddress + trbChainDesc->framesDesc[i].offset, + trbChainDesc->framesDesc[i].length, 0); + } else + BUILD_NORMAL_TRB(trbChainDesc->trbPool[i], startAddress, + trbChainDesc->len - tmp, 0); + + trbChainDesc->lastTrbIsLink = 0; + if (channel->dmultEnabled) { + if (channel->isIsoc) { + trbChainDesc->lastTrbIsLink = 1; + BUILD_LINK_TRB(trbChainDesc->trbPool[i + 1], trbChainDesc->trbDMAAddr); + } else + BUILD_EMPTY_TRB(trbChainDesc->trbPool[i + 1]); + } + + ShowTrbChain(trbChainDesc); + + return 0; +} + +static void phytium_dma_ArmTd(struct DMA_CONTROLLER *priv, struct DMA_TrbChainDesc *trbChainDesc) +{ + uint32_t ep_sts, ep_cfg, ep_cmd; + struct DMA_TrbChainDesc *startedChain; + struct DMA_Trb *lastPrevTrb; + struct DMA_Channel *channel; + + if (!priv || !trbChainDesc) + return; + + channel = trbChainDesc->channel; + phytium_write32(&priv->regs->ep_sel, (channel->isDirTx | channel->hwUsbEppNum)); + + ep_sts = phytium_read32(&priv->regs->ep_sts); + + if (channel->status == DMA_STATUS_FREE) { + phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); + phytium_write32(&priv->regs->traddr, trbChainDesc->trbDMAAddr); + phytium_write32(&priv->regs->ep_sts, DMARF_EP_TRBERR); + + ep_cfg = phytium_read32(&priv->regs->ep_cfg); + phytium_write32(&priv->regs->ep_cmd, DMARF_EP_DRDY); + if (!(ep_cfg & DMARV_EP_ENABLED)) { + ep_cfg |= DMARV_EP_ENABLED; + phytium_write32(&priv->regs->ep_cfg, ep_cfg); + } + } else { + if (channel->trbChainDescList.prev != channel->trbChainDescList.next) { + startedChain = GetTrbChainDescEntry(channel->trbChainDescList.prev->prev); + lastPrevTrb = &startedChain->trbPool[startedChain->numOfTrbs]; + startedChain->lastTrbIsLink = 1; + BUILD_LINK_TRB((*lastPrevTrb), trbChainDesc->trbDMAAddr); + ep_cmd = phytium_read32(&priv->regs->ep_cmd); + if (!(ep_cmd & DMARF_EP_DRDY)) { + phytium_write32(&priv->regs->traddr, trbChainDesc->trbDMAAddr); + phytium_write32(&priv->regs->ep_cmd, DMARF_EP_DRDY); + } + ShowTrbChain(startedChain); + } + } +} + +static int32_t phytium_dma_TrbChainAlloc(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel, uint32_t numOfTrbs, struct DMA_TrbChainDesc **chain) +{ + struct DMA_TrbChainDesc *trbChainDesc = NULL; + int i, j; + uint32_t mapcount, count = 0; + + if (!priv || !channel) + return -ENOMEM; + + for (i = 0; i < TAB_SIZE_OF_DMA_CHAIN; i++) { + if (!priv->trbChainDesc[i].reserved) { + trbChainDesc = &priv->trbChainDesc[i]; + break; + } + } + + if (!trbChainDesc) { + pr_err("No Free TRB Chain Descriptor\n"); + return -ENOMEM; + } + + INIT_LIST_HEAD(&trbChainDesc->chainNode); + *chain = NULL; + mapcount = (numOfTrbs + 2 + 7) >> 3; + + for (i = 0; i < TRB_MAP_SIZE; i++) { + if (priv->trbChainFreeMap[i] == 0x0) + count++; + else + count = 0; + + if (count == mapcount) + break; + } + + if (count != mapcount) { + pr_err("No Free TRBs count:0x%x, mapcount:0x%x\n", count, mapcount); + return -ENOMEM; + } + + trbChainDesc->reserved = 1; + trbChainDesc->channel = channel; + trbChainDesc->actualLen = 0; + trbChainDesc->mapSize = mapcount; + trbChainDesc->numOfTrbs = numOfTrbs; + trbChainDesc->start = (i + 1 - mapcount) << 3; + trbChainDesc->end = trbChainDesc->start; + trbChainDesc->trbPool = (struct DMA_Trb *)priv->trbPoolAddr + trbChainDesc->start; + trbChainDesc->trbDMAAddr = (uint32_t)(uintptr_t)((struct DMA_Trb *)priv->trbDMAPoolAddr + + trbChainDesc->start); + trbChainDesc->isoError = 0; + + list_add_tail(&trbChainDesc->chainNode, &channel->trbChainDescList); + + channel->numOfTrbChain++; + + for (j = 0; j < count; j++) + priv->trbChainFreeMap[i - j] = 0xFF; + + *chain = trbChainDesc; + + return 0; +} + +static int32_t phytium_dma_channelProgram(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel, uint16_t packetSize, uintptr_t dmaAddr, + uint32_t len, void *framesDesc, uint32_t framesNumber) +{ + uint32_t numOfTrbs; + uint8_t retval; + struct DMA_TrbChainDesc *trbChainDesc; + + if (!priv || !channel) + return -EINVAL; + + //printk(KERN_ERR "%s %d\n",__func__,__LINE__); + if (framesDesc && priv->isHostCtrlMode && channel->isIsoc) + numOfTrbs = framesNumber; + else + numOfTrbs = divRoundUp(len, channel->maxTrbLen); + + retval = phytium_dma_TrbChainAlloc(priv, channel, numOfTrbs, &trbChainDesc); + if (retval) + return retval; + + trbChainDesc->dwStartAddress = dmaAddr; + trbChainDesc->len = len; + trbChainDesc->framesDesc = framesDesc; + + channel->wMaxPacketSize = packetSize; + phytium_dma_NewTd(priv, trbChainDesc); + channel->lastTransferLength = 0; + phytium_dma_ArmTd(priv, trbChainDesc); + + channel->status = DMA_STATUS_BUSY; + + return 0; +} + +static enum DMA_Status phytium_dma_getChannelStatus(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel) +{ + uint32_t ep_cmd, ep_sts; + + if (!priv || !channel) + return DMA_STATUS_UNKNOWN; + + if (channel->status >= DMA_STATUS_BUSY) { + phytium_write32(&priv->regs->ep_sel, channel->isDirTx | channel->hwUsbEppNum); + ep_cmd = phytium_read32(&priv->regs->ep_cmd); + ep_sts = phytium_read32(&priv->regs->ep_sts); + + if ((ep_cmd & DMARF_EP_DRDY) || (ep_sts & DMARF_EP_DBUSY)) + channel->status = DMA_STATUS_ARMED; + else + channel->status = DMA_STATUS_BUSY; + } + + return channel->status; +} + +static int32_t phytium_dma_channelAbort(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) +{ + struct DMA_TrbChainDesc *trbChainDesc; + uint32_t ep_cfg, i; + + if (!priv || !channel) + return -EINVAL; + + if (phytium_dma_getChannelStatus(priv, channel) >= DMA_STATUS_BUSY) + phytium_write32(&priv->regs->conf, DMARF_RESET); + + phytium_write32(&priv->regs->ep_sel, (uint32_t)(channel->isDirTx | channel->hwUsbEppNum)); + ep_cfg = phytium_read32(&priv->regs->ep_cfg); + ep_cfg &= ~DMARV_EP_ENABLED; + phytium_write32(&priv->regs->ep_cfg, ep_cfg); + phytium_write32(&priv->regs->ep_sts, 0xFFFFFFFF); + + while (channel->trbChainDescList.next != &channel->trbChainDescList) { + trbChainDesc = GetTrbChainDescEntry(channel->trbChainDescList.next); + if (trbChainDesc) { + if (!list_empty(&trbChainDesc->chainNode)) { + for (i = 0; i < trbChainDesc->mapSize; i++) + priv->trbChainFreeMap[(trbChainDesc->start >> 3) + i] = 0; + + trbChainDesc->channel->numOfTrbChain--; + trbChainDesc->reserved = 0; + list_del(&trbChainDesc->chainNode); + } + } + } + if (channel->status != DMA_STATUS_UNKNOWN) + channel->status = DMA_STATUS_FREE; + + return 0; +} + +static int32_t phytium_dma_getActualLength(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) +{ + if (!priv || !channel) + return -EINVAL; + + return channel->lastTransferLength; +} + +static int32_t phytium_dma_getMaxLength(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel) +{ + if (!priv || !channel) + return -EINVAL; + + return channel->maxTdLen; +} + +static int32_t phytium_dma_setMaxLength(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel, uint32_t val) +{ + if (!priv || !channel) + return -EINVAL; + + if (channel->dmultEnabled) + channel->maxTrbLen = val; + else + channel->maxTrbLen = (val > TD_SING_MAX_TRB_DATA_SIZE) ? + TD_SING_MAX_TRB_DATA_SIZE : val; + + return 0; +} + +static void phytium_dma_setParentPriv(struct DMA_CONTROLLER *priv, void *parent) +{ + if (!priv) + return; + + priv->parent = parent; +} + +void phytium_dma_controllerReset(struct DMA_CONTROLLER *priv) +{ + uint32_t conf; + + if (!priv) + return; + + conf = phytium_read32(&priv->regs->conf); + conf |= DMARF_RESET; + phytium_write32(&priv->regs->conf, conf); + + priv->resubmit = true; +} + +void phytium_dma_setHostMode(struct DMA_CONTROLLER *priv) +{ + if (!priv) + return; + + priv->isHostCtrlMode = 1; +} + +struct DMA_OBJ phytium_dma_Drv = { + .dma_probe = phytium_dma_probe, + .dma_init = phytium_dma_init, + .dma_destroy = phytium_dma_destroy, + .dma_start = phytium_dma_start, + .dma_stop = phytium_dma_stop, + .dma_isr = phytium_dma_isr, + .dma_errIsr = phytium_dma_errIsr, + .dma_channelAlloc = phytium_dma_channelAlloc, + .dma_channelRelease = phytium_dma_channelRelease, + .dma_channelProgram = phytium_dma_channelProgram, + .dma_channelAbort = phytium_dma_channelAbort, + .dma_getChannelStatus = phytium_dma_getChannelStatus, + .dma_getActualLength = phytium_dma_getActualLength, + .dma_getMaxLength = phytium_dma_getMaxLength, + .dma_setMaxLength = phytium_dma_setMaxLength, + .dma_setParentPriv = phytium_dma_setParentPriv, + .dma_controllerReset = phytium_dma_controllerReset, + .dma_setHostMode = phytium_dma_setHostMode, +}; + +struct DMA_OBJ *DMA_GetInstance(void) +{ + return &phytium_dma_Drv; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/dma.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/dma.h new file mode 100644 index 0000000000000000000000000000000000000000..f2c25e6006e707a2af7ed0051316dc3302c6c430 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/dma.h @@ -0,0 +1,198 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef __PHYTIUM_DMA_H__ +#define __PHYTIUM_DMA_H__ + +#include +//#include "list.h" + +#define NUM_OF_TRB 1024 +#define TRB_MAP_SIZE ((NUM_OF_TRB + (sizeof(uint8_t) * 8) - 1) / (sizeof(uint8_t) * 8)) +#define MAX_DMA_CHANNELS 16 +#define TAB_SIZE_OF_DMA_CHAIN (MAX_DMA_CHANNELS * 2) + +#define DMARD_EP_TX 0x80ul +#define DMARD_EP_RX 0x00ul + +#define DMARF_EP_EPRST 0x00000001ul +#define DMARF_EP_DRDY 0x00000040ul +#define DMARF_EP_DFLUSH 0x00000080ul + +#define DMARF_EP_IOC 0x4ul +#define DMARF_EP_ISP 0x8ul +#define DMARF_EP_DESCMIS 0x10ul +#define DMARF_EP_TRBERR 0x80ul +#define DMARF_EP_DBUSY 0x200ul +#define DMARF_EP_CCS 0x800ul +#define DMARF_EP_OUTSMM 0x4000ul +#define DMARF_EP_ISOERR 0x8000ul +#define DMARF_EP_DTRANS 0x80000000ul + +#define DMARV_EP_DISABLED 0ul +#define DMARV_EP_ENABLED 1ul +#define DMARV_EP_DSING 0x1000ul +#define DMARV_EP_DMULT 0x2000ul + +#define TD_SIZE_MASK 0x00001FFFF + +#define DMARF_RESET 0x00000001ul +#define DMARF_DSING 0x00000100ul +#define DMARF_DMULT 0x00000200ul + +#define TD_DMULT_MAX_TRB_DATA_SIZE 65536u +#define TD_DMULT_MAX_TD_DATA_SIZE (~1u) +#define TD_SING_MAX_TRB_DATA_SIZE 65536u +#define TD_SING_MAX_TD_DATA_SIZE 65536u + +#define TD_TYPE_NORMAL 0x400L +#define TD_TYPE_LINK 0x1800L +#define TDF_CYCLE_BIT 0x1L +#define TDF_TOGGLE_CYCLE_BIT 0x2L +#define TDF_INT_ON_SHORT_PACKET 0x4L +#define TDF_FIFO_MODE 0x8L +#define TDF_CHAIN_BIT 0x10L +#define TDF_INT_ON_COMPLECTION 0x20L +#define TDF_STREAMID_VALID 0x200L + +struct DMA_Trb { + uint32_t dmaAddr; + uint32_t dmaSize; + uint32_t ctrl; +}; + +enum DMA_Status { + DMA_STATUS_UNKNOWN, + DMA_STATUS_FREE, + DMA_STATUS_ABORT, + DMA_STATUS_BUSY, + DMA_STATUS_ARMED +}; + +struct DMA_CFG { + uintptr_t regBase; + uint16_t dmaModeTx; + uint16_t dmaModeRx; + void *trbAddr; + uintptr_t trbDmaAddr; +}; + +struct DMA_SYSREQ { + uint32_t privDataSize; + uint32_t trbMemSize; +}; + +struct DMA_CALLBACKS { + void (*complete)(void *pD, uint8_t epNum, uint8_t dir, bool resubmit); +}; + +struct DMA_CONTROLLER; + +struct DMA_Channel { + struct DMA_CONTROLLER *controller; + uint16_t wMaxPacketSize; + uint8_t hwUsbEppNum; + uint8_t isDirTx; + uint32_t maxTdLen; + uint32_t maxTrbLen; + enum DMA_Status status; + void *priv; + uint32_t dmultGuard; + uint8_t dmultEnabled; + uint8_t numOfTrbChain; + struct list_head trbChainDescList; + uint32_t lastTransferLength; + uint8_t isIsoc; +}; + +struct DMA_OBJ { + int32_t (*dma_probe)(struct DMA_CFG *config, struct DMA_SYSREQ *sysReq); + + int32_t (*dma_init)(struct DMA_CONTROLLER *priv, const struct DMA_CFG *config, + struct DMA_CALLBACKS *callbacks); + + void (*dma_destroy)(struct DMA_CONTROLLER *priv); + + int32_t (*dma_start)(struct DMA_CONTROLLER *priv); + + uint32_t (*dma_stop)(struct DMA_CONTROLLER *priv); + + void (*dma_isr)(struct DMA_CONTROLLER *priv); + + void (*dma_errIsr)(struct DMA_CONTROLLER *priv, uint8_t irqNr, uint8_t isDirTx); + + void * (*dma_channelAlloc)(struct DMA_CONTROLLER *priv, + uint8_t isDirTx, uint8_t hwEpNum, uint8_t isIso); + + int32_t (*dma_channelRelease)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); + + int32_t (*dma_channelProgram)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel, + uint16_t packetSize, uintptr_t dmaAddr, + uint32_t len, void *framesDesc, uint32_t framesNumber); + + int32_t (*dma_channelAbort)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); + + enum DMA_Status (*dma_getChannelStatus)(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel); + + int32_t (*dma_getActualLength)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); + + int32_t (*dma_getMaxLength)(struct DMA_CONTROLLER *priv, struct DMA_Channel *channel); + + int32_t (*dma_setMaxLength)(struct DMA_CONTROLLER *priv, + struct DMA_Channel *channel, uint32_t val); + + void (*dma_setParentPriv)(struct DMA_CONTROLLER *priv, void *parent); + + void (*dma_controllerReset)(struct DMA_CONTROLLER *priv); + + void (*dma_setHostMode)(struct DMA_CONTROLLER *priv); +}; + +enum DMA_Mode { + DMA_MODE_GLOBAL_DMULT, + DMA_MODE_GLOBAL_DSING, + DMA_MODE_CHANNEL_INDIVIDUAL, +}; + +struct DMA_TrbFrameDesc { + uint32_t length; + uint32_t offset; +}; + +struct DMA_TrbChainDesc { + uint8_t reserved; + struct DMA_Channel *channel; + struct DMA_Trb *trbPool; + uint32_t trbDMAAddr; + uint32_t len; + uint32_t dwStartAddress; + uint32_t actualLen; + uint8_t isoError; + uint8_t lastTrbIsLink; + uint32_t mapSize; + uint32_t numOfTrbs; + uint32_t start; + uint32_t end; + struct DMA_TrbFrameDesc *framesDesc; + struct list_head chainNode; +}; + +struct DMA_CONTROLLER { + struct DMARegs *regs; + struct DMA_OBJ *dmaDrv; + struct DMA_CFG dmaCfg; + struct DMA_CALLBACKS dmaCallbacks; + struct DMA_Channel rx[MAX_DMA_CHANNELS]; + struct DMA_Channel tx[MAX_DMA_CHANNELS]; + enum DMA_Mode dmaMode; + uint8_t isHostCtrlMode; + void *parent; + void *trbPoolAddr; + uintptr_t trbDMAPoolAddr; + uint8_t trbChainFreeMap[TRB_MAP_SIZE]; + struct DMA_TrbChainDesc trbChainDesc[TAB_SIZE_OF_DMA_CHAIN]; + bool resubmit; +}; + +struct DMA_OBJ *DMA_GetInstance(void); +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/gadget.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/gadget.c new file mode 100644 index 0000000000000000000000000000000000000000..e5e1625d785f89f44153f12985c3e22680bef55a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/gadget.c @@ -0,0 +1,2538 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include +#include "gadget.h" +#include "dma.h" +#include "core.h" +#include "hw-regs.h" + +#define DRV_NAME "phytium_gadget" + +#define GADGET_PRIV_BUFFER_SIZE 64 +#define GADGET_USB_EP_NUMBER_MASK 0xf +#define DMA_ADDR_INVALID (~(dma_addr_t)0) + +#define GADGET_ESTALL 1 +#define GADGET_EUNHANDLED 2 +#define GADGET_EAUTOACK 3 +#define GADGET_ESHUTDOWN 4 +#define GADGET_ECONNRESET 5 +#define GADGET_EAGAIN 6 + +static inline struct GadgetEp *toGadgetEp(struct GADGET_EP *gadget_Ep) +{ + return (struct GadgetEp *)((uintptr_t)gadget_Ep - + ((uintptr_t)&((struct GadgetEp *)0)->gadgetEp)); +} + +static inline struct GadgetRequest *requestToGadgetRequest(struct GADGET_REQ *req) +{ + return (struct GadgetRequest *)((uintptr_t)req - + ((uintptr_t)&((struct GadgetRequest *)0)->request)); +} + +static inline struct GADGET_REQ *listToGadgetRequest(struct list_head *list) +{ + return (struct GADGET_REQ *)((uintptr_t)list - + ((uintptr_t)&((struct GADGET_REQ *)0)->list)); +} + +#define listBrowsingRequest(iterator, head, memeber) \ + for (iterator = listToGadgetRequest((head)->next); \ + &iterator->list != (head); \ + iterator = listToGadgetRequest(iterator->list.next)) + +static inline struct GADGET_REQ *gadgetGetNextReq(struct GadgetEp *gadgetEp) +{ + struct list_head *list = &gadgetEp->request; + + if (list_empty(list)) { + pr_debug("no request available for %s\n", gadgetEp->gadgetEp.name); + return NULL; + } + + return listToGadgetRequest(list->next); +} + +static inline struct GADGET_REQ *gadgetGetNextEp0Req(struct GADGET_CTRL *priv) +{ + struct list_head *queue; + + if (!priv) + return NULL; + + queue = &priv->in[0].request; + + if (list_empty(queue)) + return NULL; + + return listToGadgetRequest(queue->next); +} + +void gadget_giveback(struct phytium_ep *phy_ep, struct usb_request *usb_req, int status) +{ + struct phytium_request *phy_req; + struct phytium_cusb *config; + int busy; + + if (!phy_ep || !usb_req) + return; + + busy = phy_ep->busy; + phy_req = usb_req ? container_of(usb_req, struct phytium_request, request) : NULL; + config = phy_req->config; + + list_del(&phy_req->list); + + if (usb_req->status == -EINPROGRESS) { + if (status == GADGET_ESHUTDOWN) + usb_req->status = -ESHUTDOWN; + else if (status == GADGET_ECONNRESET) + usb_req->status = -ECONNRESET; + else + usb_req->status = -phy_req->gadget_request->status; + } + + if (usb_req->status == 0) + pr_debug("%s done request %p, %d/%d\n", phy_ep->end_point.name, + usb_req, usb_req->actual, usb_req->length); + else + pr_debug("%s request %p, %d/%d fault %d\n", phy_ep->end_point.name, + usb_req, usb_req->actual, usb_req->length, usb_req->status); + + usb_gadget_unmap_request(&config->gadget, &phy_req->request, phy_req->is_tx); + + busy = phy_ep->busy; + phy_ep->busy = 1; + + spin_unlock(&config->lock); + + if (phy_req->request.complete) + phy_req->request.complete(&phy_req->ep->end_point, usb_req); + + spin_lock(&config->lock); + + phy_ep->busy = busy; +} + +static void gadget_callback_complete(struct GADGET_EP *gadget_ep, struct GADGET_REQ *gadget_req) +{ + struct phytium_ep *phy_ep; + struct phytium_request *phy_req; + struct usb_request *usb_req; + + if (!gadget_ep || !gadget_req) + return; + + phy_req = gadget_req->context; + usb_req = &phy_req->request; + phy_ep = phy_req->ep; + usb_req->actual = gadget_req->actual; + usb_req->length = gadget_req->length; + + gadget_giveback(phy_ep, usb_req, gadget_req->status); +} + +static void gadgetDisconnect(struct GADGET_CTRL *priv) +{ + pr_info("Disconnect USB Device Driver\n"); + + if (!priv) + return; + + priv->gadgetDev.speed = USB_SPEED_UNKNOWN; + priv->gadgetDev.state = USB_STATE_NOTATTACHED; + + if (priv->eventCallback.disconnect) + priv->eventCallback.disconnect(priv); +} + +static int gadget_get_frame(struct usb_gadget *gadget) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return 0; +} + +static int gadget_wakeup(struct usb_gadget *gadget) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return 0; +} + +static int gadget_vbus_session(struct usb_gadget *gadget, int is_active) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return 0; +} + +static int gadget_vbus_draw(struct usb_gadget *gadget, unsigned int mA) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return 0; +} + +static int gadget_pullup(struct usb_gadget *gadget, int is_on) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return 0; +} + +static int gadget_udc_start(struct usb_gadget *gadget, struct usb_gadget_driver *driver) +{ + unsigned long flags; + struct phytium_cusb *config; + struct GADGET_CTRL *priv; + uint32_t gen_cfg; + + if (!gadget || !driver) + return -EINVAL; + + if (driver->max_speed < USB_SPEED_HIGH) + return -EINVAL; + + config = container_of(gadget, struct phytium_cusb, gadget); + + pr_info("registering driver %s\n", driver->function); + + spin_lock_irqsave(&config->lock, flags); + config->gadget_driver = driver; + spin_unlock_irqrestore(&config->lock, flags); + + config->gadget_obj->gadget_start(config->gadget_priv); + + priv = (struct GADGET_CTRL *)config->gadget_priv; + if (priv->phy_regs) { + gen_cfg = phytium_read32(&priv->phy_regs->gen_cfg); + gen_cfg = gen_cfg & (~BIT(7)); + phytium_write32(&priv->phy_regs->gen_cfg, gen_cfg); + } + + return 0; +} + +static int gadget_udc_stop(struct usb_gadget *gadget) +{ + struct phytium_cusb *config; + unsigned long flags; + struct GADGET_CTRL *priv; + uint32_t gen_cfg; + + if (!gadget) + return -EINVAL; + + config = container_of(gadget, struct phytium_cusb, gadget); + + priv = (struct GADGET_CTRL *)config->gadget_priv; + if (priv->phy_regs) { + gen_cfg = phytium_read32(&priv->phy_regs->gen_cfg); + gen_cfg = gen_cfg | BIT(7); + phytium_write32(&priv->phy_regs->gen_cfg, gen_cfg); + } + spin_lock_irqsave(&config->lock, flags); + config->gadget_driver = NULL; + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static struct usb_gadget_ops phytium_gadget_ops = { + .get_frame = gadget_get_frame, + .wakeup = gadget_wakeup, + .vbus_session = gadget_vbus_session, + .vbus_draw = gadget_vbus_draw, + .pullup = gadget_pullup, + .udc_start = gadget_udc_start, + .udc_stop = gadget_udc_stop, +}; + +static int gadget_ep_enable(struct usb_ep *ls_ep, const struct usb_endpoint_descriptor *desc) +{ + struct phytium_ep *phy_ep = NULL; + struct phytium_cusb *config; + unsigned long flags; + + if (!ls_ep || !desc) + return -EINVAL; + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + + if (phy_ep->desc) + return -EBUSY; + + spin_lock_irqsave(&config->lock, flags); + + phy_ep->desc = desc; + phy_ep->busy = 0; + config->gadget_obj->gadget_epEnable(config->gadget_priv, phy_ep->gadget_ep, desc); + + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static int gadget_ep_disable(struct usb_ep *ls_ep) +{ + struct phytium_ep *phy_ep = NULL; + struct phytium_cusb *config; + unsigned long flags; + + if (!ls_ep) + return -EBUSY; + + pr_info("%s %d\n", __func__, __LINE__); + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + + spin_lock_irqsave(&config->lock, flags); + + phy_ep->desc = NULL; + phy_ep->busy = 0; + phy_ep->end_point.desc = NULL; + config->gadget_obj->gadget_epDisable(config->gadget_priv, phy_ep->gadget_ep); + + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static struct usb_request *gadget_ep_alloc_request(struct usb_ep *ls_ep, gfp_t gfp_flags) +{ + struct phytium_ep *phy_ep; + struct phytium_cusb *config; + struct GADGET_EP *gadget_ep; + struct phytium_request *phy_request; + + if (!ls_ep) + return NULL; + + pr_info("%s %d\n", __func__, __LINE__); + phy_request = kzalloc(sizeof(*phy_request), gfp_flags); + if (!phy_request) { + pr_err("not enough momory\n"); + return NULL; + } + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + gadget_ep = phy_ep->gadget_ep; + + INIT_LIST_HEAD(&phy_request->list); + phy_request->request.dma = DMA_ADDR_INVALID; + phy_request->epnum = phy_ep->ep_num; + phy_request->ep = phy_ep; + phy_request->config = phy_ep->config; + + config->gadget_obj->gadget_reqAlloc(config->gadget_priv, gadget_ep, + &phy_request->gadget_request); + + return &phy_request->request; +} + +static void gadget_ep_free_request(struct usb_ep *ls_ep, struct usb_request *ls_req) +{ + struct phytium_ep *phy_ep; + struct phytium_cusb *config; + struct phytium_request *phy_request; + + if (!ls_ep || !ls_req) + return; + + pr_info("%s %d\n", __func__, __LINE__); + phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; + config = phy_request->config; + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + + config->gadget_obj->gadget_reqFree(config->gadget_priv, phy_ep->gadget_ep, + phy_request->gadget_request); + kfree(phy_request); +} + +static int gadget_ep_enqueue(struct usb_ep *ls_ep, struct usb_request *ls_req, gfp_t gfp_flags) +{ + struct phytium_ep *phy_ep; + struct phytium_cusb *config; + struct phytium_request *phy_request; + unsigned long flags; + int status = 0; + + if (!ls_ep || !ls_req) + return -EINVAL; + + if (!ls_req->buf) + return -ENODATA; + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; + phy_request->config = config; + + if (phy_request->ep != phy_ep) + return -EINVAL; + + phy_request->request.actual = 0; + phy_request->request.status = -EINPROGRESS; + phy_request->epnum = phy_ep->ep_num; + phy_request->is_tx = phy_ep->is_tx; + + phy_request->gadget_request->length = ls_req->length; + phy_request->gadget_request->status = 0; + phy_request->gadget_request->complete = gadget_callback_complete; + phy_request->gadget_request->buf = ls_req->buf; + phy_request->gadget_request->context = ls_req; + + status = usb_gadget_map_request(&config->gadget, &phy_request->request, phy_request->is_tx); + + if (!phy_ep->desc) { + pr_debug("req %p queued to %s while ep %s\n", phy_request, ls_ep->name, "disabled"); + status = -ESHUTDOWN; + usb_gadget_unmap_request(&config->gadget, &phy_request->request, + phy_request->is_tx); + return status; + } + + spin_lock_irqsave(&config->lock, flags); + + phy_request->gadget_request->dma = phy_request->request.dma; + list_add_tail(&phy_request->list, &phy_ep->req_list); + + pr_debug("queue to %s (%s), length = %d\n", phy_ep->name, + phy_ep->is_tx ? "IN/TX" : "OUT/RX", phy_request->request.length); + + status = config->gadget_obj->gadget_reqQueue(config->gadget_priv, phy_ep->gadget_ep, + phy_request->gadget_request); + + spin_unlock_irqrestore(&config->lock, flags); + + return status; +} + +static int gadget_ep_dequeue(struct usb_ep *ls_ep, struct usb_request *ls_req) +{ + struct phytium_ep *phy_ep; + struct phytium_cusb *config; + unsigned long flags; + int status = 0; + struct phytium_request *phy_request; + struct phytium_request *phy_next_request; + + if (!ls_ep || !ls_req) + return -EINVAL; + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; + + if (phy_request->ep != phy_ep) + return -EINVAL; + + spin_lock_irqsave(&config->lock, flags); + + list_for_each_entry(phy_next_request, &phy_ep->req_list, list) { + if (phy_next_request == phy_request) + break; + } + + if (phy_next_request != phy_request) { + pr_info("request %p not queued to %s\n", phy_request, ls_ep->name); + status = -EINVAL; + goto done; + } + + status = config->gadget_obj->gadget_reqDequeue(config->gadget_priv, phy_ep->gadget_ep, + phy_request->gadget_request); +done: + spin_unlock_irqrestore(&config->lock, flags); + return status; +} + +static int gadget_ep_set_halt(struct usb_ep *ls_ep, int value) +{ + struct phytium_ep *phy_ep; + struct phytium_cusb *config; + struct GADGET_EP *gadget_ep = NULL; + unsigned long flags; + int status = 0; + + if (!ls_ep) + return -EINVAL; + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + gadget_ep = phy_ep->gadget_ep; + + spin_lock_irqsave(&config->lock, flags); + + status = config->gadget_obj->gadget_epSetHalt(config->gadget_priv, + phy_ep->gadget_ep, value); + if (status > 0) { + spin_unlock_irqrestore(&config->lock, flags); + return -status; + } + + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static const struct usb_ep_ops gadget_ep_ops = { + .enable = gadget_ep_enable, + .disable = gadget_ep_disable, + .alloc_request = gadget_ep_alloc_request, + .free_request = gadget_ep_free_request, + .queue = gadget_ep_enqueue, + .dequeue = gadget_ep_dequeue, + .set_halt = gadget_ep_set_halt, +}; + +static int gadget_ep0_enable(struct usb_ep *ep, const struct usb_endpoint_descriptor *desc) +{ + return -EINVAL; +} + +static int gadget_ep0_disable(struct usb_ep *ep) +{ + return -EINVAL; +} + +static int gadget_ep0_enqueue(struct usb_ep *ls_ep, struct usb_request *ls_req, gfp_t gfp_flags) +{ + struct phytium_ep *phy_ep; + struct phytium_request *phy_request; + struct phytium_cusb *config; + int status = 0; + unsigned long flags; + + if (!ls_ep || !ls_req) + return -EINVAL; + + phy_ep = ls_ep ? container_of(ls_ep, struct phytium_ep, end_point) : NULL; + config = phy_ep->config; + phy_request = ls_req ? container_of(ls_req, struct phytium_request, request) : NULL; + + spin_lock_irqsave(&config->lock, flags); + + if (!list_empty(&phy_ep->req_list)) { + status = -EBUSY; + goto cleanup; + } + + phy_request->config = config; + phy_request->request.actual = 0; + phy_request->gadget_request->actual = 0; + phy_request->is_tx = config->ep0_data_stage_is_tx; + phy_request->gadget_request->length = phy_request->request.length; + phy_request->gadget_request->status = 0; + phy_request->gadget_request->complete = gadget_callback_complete; + phy_request->gadget_request->buf = phy_request->request.buf; + phy_request->gadget_request->context = phy_request; + + status = usb_gadget_map_request(&config->gadget, &phy_request->request, phy_request->is_tx); + if (status) { + pr_info("failed to map request\n"); + status = -EINVAL; + goto cleanup; + } + + phy_request->gadget_request->dma = phy_request->request.dma; + list_add_tail(&phy_request->list, &phy_ep->req_list); + + pr_debug("queue to %s (%s), length = %d\n", phy_ep->name, + phy_ep->is_tx ? "IN/TX" : "OUT/RX", phy_request->request.length); + + status = config->gadget_obj->gadget_reqQueue(config->gadget_priv, phy_ep->gadget_ep, + phy_request->gadget_request); + if (status > 0) { + status = -status; + usb_gadget_unmap_request(&config->gadget, &phy_request->request, + phy_request->is_tx); + list_del(&phy_request->list); + goto cleanup; + } + +cleanup: + spin_unlock_irqrestore(&config->lock, flags); + return status; +} + +static int gadget_ep0_dequeue(struct usb_ep *ep, struct usb_request *ls_request) +{ + return -EOPNOTSUPP; +} + +static int gadget_ep0_set_halt(struct usb_ep *ep, int value) +{ + return -EINVAL; +} + + +static const struct usb_ep_ops gadget_ep0_ops = { + .enable = gadget_ep0_enable, + .disable = gadget_ep0_disable, + .alloc_request = gadget_ep_alloc_request, + .free_request = gadget_ep_free_request, + .queue = gadget_ep0_enqueue, + .dequeue = gadget_ep0_dequeue, + .set_halt = gadget_ep0_set_halt, +}; + +static int32_t gadgetWaitForBusyBit(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) +{ + struct GadgetEp *gadgetEp; + uint8_t epNum; + uint8_t txcs = CS_BUSY; + uint8_t buf = 0; + uint8_t bufflag = 0; + + if (!priv || !gadget_Ep) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + epNum = gadgetEp->hwEpNum; + + if (gadgetEp->isInEp || gadgetEp->hwEpNum == 0) + return 0; + + buf = phytium_read8(&priv->regs->ep[epNum - 1].txcon) & CON_BUF; + + while ((txcs & CS_BUSY) || (bufflag == 0)) { + txcs = phytium_read8(&priv->regs->ep[epNum - 1].txcs); + + if (((txcs & CS_NPAK) >> CS_NPAK_OFFSET) == buf || buf == 0) + bufflag = 1; + else + bufflag = 0; + } + + return 0; +} + +static inline void gadgetEpXDataReceive(struct GADGET_CTRL *priv, + struct GadgetRequest *gadgetRequest) +{ + struct GadgetEp *gadgetEp; + struct GADGET_REQ *gadgetReq; + uint8_t epType; + uint32_t requestSize, channelStatus, chMaxLen; + + if (!priv || !gadgetRequest) + return; + + gadgetEp = gadgetRequest->ep; + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); + epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; + channelStatus = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, gadgetEp->channel); + + gadgetReq = &gadgetRequest->request; + if (gadgetReq->actual < gadgetReq->length || gadgetRequest->zlp) { + gadgetRequest->zlp = 0; + if ((gadgetReq->length - gadgetReq->actual) < chMaxLen) + requestSize = gadgetReq->length - gadgetReq->actual; + else + requestSize = chMaxLen; + + priv->dmaDrv->dma_channelProgram(priv->dmaController, gadgetEp->channel, + gadgetEp->gadgetEp.maxPacket, + gadgetReq->dma + gadgetReq->actual, requestSize, NULL, 0); + } +} + +static inline void gadgetEpXDataSend(struct GADGET_CTRL *priv, struct GadgetRequest *gadgetRequest) +{ + struct GadgetEp *gadgetEp; + struct GADGET_REQ *gadgetReq; + uint8_t epType; + uint32_t requestSize, channelStatus, chMaxLen; + + if (!priv || !gadgetRequest) + return; + + gadgetEp = gadgetRequest->ep; + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); + epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; + channelStatus = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, gadgetEp->channel); + + gadgetReq = &gadgetRequest->request; + if ((gadgetReq->length - gadgetReq->actual) < chMaxLen) + requestSize = gadgetReq->length - gadgetReq->actual; + else + requestSize = chMaxLen; + pr_debug("Transmit/IN %s gadgetReq %p gadgetRequest:%p requestSize:0x%x packetSize:0x%x\n", + gadgetEp->gadgetEp.name, gadgetReq, gadgetRequest, + requestSize, gadgetEp->gadgetEp.maxPacket); + + gadgetRequest->zlp = 0; + priv->dmaDrv->dma_channelProgram(priv->dmaController, gadgetEp->channel, + gadgetEp->gadgetEp.maxPacket, + gadgetReq->dma + gadgetReq->actual, requestSize, NULL, 0); +} + +static int32_t gadgetEpXSetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + uint8_t value) +{ + struct GadgetEp *gadgetEp; + uint8_t epType; + struct GADGET_REQ *req = NULL; + struct GadgetRequest *gadgetRequest = NULL; + uint8_t epNum, txcon, rxcon; + uint32_t status = DMA_STATUS_ARMED; + + if (!priv || !gadget_Ep) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; + if (epType == USB_ENDPOINT_XFER_ISOC) + return -EINVAL; + + pr_debug("%s: %s stall\n", gadget_Ep->name, value ? "set" : "clear"); + req = gadgetGetNextReq(gadgetEp); + + if (!value) + gadgetEp->wedged = 0; + + if (value && gadgetEp->isInEp && req && gadgetEp->state == GADGET_EP_BUSY) { + while (status == DMA_STATUS_ARMED) + status = priv->dmaDrv->dma_getChannelStatus(priv->dmaController, + gadgetEp->channel); + + gadgetWaitForBusyBit(priv, gadget_Ep); + } + + epNum = gadgetEp->hwEpNum; + + if (gadgetEp->isInEp) { + txcon = phytium_read8(&priv->regs->ep[epNum - 1].txcon); + if (value) { + phytium_write8(&priv->regs->ep[epNum - 1].txcon, txcon | CON_STALL); + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, + ENDPRST_IO_TX | epNum | ENDPRST_FIFORST); + + } else { + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, + ENDPRST_IO_TX | epNum | ENDPRST_TOGRST); + phytium_write8(&priv->regs->ep[epNum - 1].txcon, txcon & (~CON_STALL)); + } + } else { + rxcon = phytium_read8(&priv->regs->ep[epNum - 1].rxcon); + if (value) { + phytium_write8(&priv->regs->ep[epNum - 1].rxcon, rxcon | CON_STALL); + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, epNum | ENDPRST_FIFORST); + } else { + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, + epNum | ENDPRST_TOGRST | ENDPRST_FIFORST); + phytium_write8(&priv->regs->ep[epNum - 1].rxcon, rxcon & (~CON_STALL)); + } + } + + if (gadgetEp->state != GADGET_EP_BUSY && !value && req) { + gadgetRequest = requestToGadgetRequest(req); + if (gadgetEp->isInEp) + gadgetEpXDataSend(priv, gadgetRequest); + else + gadgetEpXDataReceive(priv, gadgetRequest); + } + + return 0; +} + +static int32_t gadgetEp0SetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + uint8_t value) +{ + struct GadgetEp *gadgetEp; + + if (!priv || !gadget_Ep) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + if (!list_empty(&gadgetEp->request)) + return -EBUSY; + + switch (priv->ep0State) { + case GADGET_EP0_STAGE_IN: + case GADGET_EP0_STAGE_OUT: + case GADGET_EP0_STAGE_ACK: + case GADGET_EP0_STAGE_STATUSIN: + case GADGET_EP0_STAGE_STATUSOUT: + priv->ep0State = GADGET_EP0_STAGE_SETUP; + break; + default: + return -EINVAL; + } + + return 0; +} + + +static void gadgetEp0Callback(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req, uint8_t status) +{ + if (!priv || !gadgetEp || !req) + return; + + priv->ep0State = GADGET_EP0_STAGE_SETUP; + list_del(&req->list); + gadgetEp->requestsInList--; + + if (req->status == EINPROGRESS) + req->status = status; + + if (req->complete) + req->complete(&gadgetEp->gadgetEp, req); +} + +static enum usb_device_speed gadgetGetActualSpeed(struct GADGET_CTRL *priv) +{ + uint8_t speedctrl; + + if (!priv) + return USB_SPEED_UNKNOWN; + + speedctrl = phytium_read8(&priv->regs->speedctrl) & (~SPEEDCTRL_HSDISABLE); + switch (speedctrl) { + case SPEEDCTRL_HS: + return USB_SPEED_HIGH; + case SPEEDCTRL_FS: + return USB_SPEED_FULL; + case SPEEDCTRL_LS: + return USB_SPEED_LOW; + default: + return USB_SPEED_UNKNOWN; + } +} + +static int32_t gadgetServiceSetFeatureReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) +{ + uint8_t epNum, isIn; + struct GadgetEp *gadgetEp; + + if (!priv || !setup) + return 0; + + switch (setup->bRequestType & USB_RECIP_MASK) { + case USB_RECIP_DEVICE: + switch (setup->wValue) { + case USB_DEVICE_REMOTE_WAKEUP: + pr_info("set feature - remote wakup\n"); + priv->isRemoteWakeup = 1; + break; + case USB_DEVICE_B_HNP_ENABLE: + pr_info("set feature - B HNP Enable\n"); + pr_info("otg not implement\n"); + return -EINVAL; + case USB_DEVICE_A_HNP_SUPPORT: + pr_info("set feature - A HNP support\n"); + pr_info("otg not implete\n"); + return -EINVAL; + } + break; + case USB_RECIP_INTERFACE: + break; + case USB_RECIP_ENDPOINT: + epNum = setup->wIndex & 0x0f; + isIn = setup->wIndex & USB_DIR_IN; + if (epNum == 0 || epNum > 15 || setup->wValue != 0) + return -EINVAL; + + gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; + + gadgetEpXSetHalt(priv, &gadgetEp->gadgetEp, 1); + break; + default: + return -EINVAL; + } + return 0; +} + +static int32_t gadgetServiceClearFeatureReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) +{ + uint8_t epNum, isIn; + struct GadgetEp *gadgetEp; + + if (!priv || !setup) + return -EINVAL; + + switch (setup->bRequestType & USB_RECIP_MASK) { + case USB_RECIP_DEVICE: + if (setup->wValue == USB_DEVICE_B_HNP_ENABLE) { + pr_err("otg not implement\n"); + return -EINVAL; + } + + if (setup->wValue != USB_DEVICE_REMOTE_WAKEUP) + return GADGET_EUNHANDLED; + + priv->isRemoteWakeup = 0; + return GADGET_EAUTOACK; + case USB_RECIP_INTERFACE: + break; + case USB_RECIP_ENDPOINT: + pr_info("clear feature wIndex:0x%x wValue:0x%x\n", setup->wIndex, setup->wValue); + epNum = setup->wIndex & 0x7f; + isIn = setup->wIndex & USB_DIR_IN; + if (epNum == 0 || epNum > 15 || setup->wValue != 0) + return GADGET_EUNHANDLED; + + gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; + if (!gadgetEp->gadgetEp.desc) + return -EINVAL; + + if (gadgetEp->wedged) + break; + gadgetEpXSetHalt(priv, &gadgetEp->gadgetEp, 0); + break; + default: + return GADGET_EUNHANDLED; + } + + return 0; +} + +static int32_t gadgetServiceSetupReq(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) +{ + struct GadgetEp *gadgetEp; + uint8_t isIn, epNum; + uint8_t rxcon, txcon; + int len; + + if (!priv || !setup) + return -EINVAL; + + if ((setup->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) { + if (setup->bRequest != USB_REQ_GET_STATUS) + return GADGET_EUNHANDLED; + } else + return GADGET_EUNHANDLED; + + priv->privBuffAddr[1] = 0; + priv->privBuffAddr[0] = 0; + + switch (setup->bRequest & USB_RECIP_MASK) { + case USB_RECIP_DEVICE: + pr_info("wIndex:0x%x isSelfPowered:%d isRomoteWakeup:%d\n", + setup->wIndex, priv->isSelfPowered, priv->isRemoteWakeup); + + if (setup->wIndex == OTG_STS_SELECTOR) + priv->privBuffAddr[0] = priv->hostRequestFlag; + else { + priv->privBuffAddr[0] = priv->isSelfPowered ? USB_DEVICE_SELF_POWERED : 0; + priv->privBuffAddr[1] = priv->isRemoteWakeup ? USB_DEVICE_REMOTE_WAKEUP : 0; + } + break; + case USB_RECIP_INTERFACE: + break; + case USB_RECIP_ENDPOINT: + epNum = setup->wIndex & 0x0f; + if (!epNum) + break; + + isIn = setup->wIndex & USB_DIR_IN; + + gadgetEp = isIn ? &priv->in[epNum] : &priv->out[epNum]; + if (!gadgetEp->gadgetEp.desc) + return -EINVAL; + + if (isIn) { + txcon = phytium_read8(&priv->regs->ep[epNum - 1].txcon); + priv->privBuffAddr[0] = (txcon & CON_STALL) ? 1 : 0; + } else { + rxcon = phytium_read8(&priv->regs->ep[epNum - 1].rxcon); + priv->privBuffAddr[0] = (rxcon & CON_STALL) ? 1 : 0; + } + break; + default: + return GADGET_EUNHANDLED; + } + + len = setup->wLength; + if (len > 2) + len = 2; + + priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->in[0].channel, + priv->in[0].gadgetEp.maxPacket, priv->privBuffDma, len, NULL, 0); + + return 0; +} + +static int32_t gadgetGetSetup(struct GADGET_CTRL *priv, struct usb_ctrlrequest *setup) +{ + int i; + uint8_t ep0cs; + struct GADGET_REQ *request = NULL; + struct GadgetRequest *gadgetRequest; + + if (!priv || !setup) + return -EINVAL; + + phytium_write8(&priv->regs->ep0cs, EP0CS_CHGSET); + + for (i = 0; i < 8; i++) + ((char *)setup)[i] = phytium_read8(&priv->regs->setupdat[i]); + + ep0cs = phytium_read8(&priv->regs->ep0cs); + if (ep0cs & EP0CS_CHGSET) { + pr_info("setup flags change: not error\n"); + return GADGET_EAUTOACK; + } + + phytium_write8(&priv->regs->usbirq, USBIR_SUDAV); + pr_debug("setup packet: req%02x.%02x v:%04x i:%04x I%d\n", setup->bRequestType, + setup->bRequest, setup->wValue, setup->wIndex, setup->wLength); + + request = gadgetGetNextEp0Req(priv); + if (request) { + gadgetRequest = requestToGadgetRequest(request); + pr_info("Previous request has not been finished but new was received\n"); + gadgetEp0Callback(priv, gadgetRequest->ep, request, 0); + } + + if (setup->wLength) { + if (setup->bRequestType & USB_DIR_IN) + priv->ep0State = GADGET_EP0_STAGE_IN; + else + priv->ep0State = GADGET_EP0_STAGE_OUT; + } else + priv->ep0State = GADGET_EP0_STAGE_ACK; + + return 0; +} + +static void gadgetEp0StageSetup(struct GADGET_CTRL *priv) +{ + struct usb_ctrlrequest setup; + int32_t retval; + uint8_t ep0cs; + + if (!priv) + return; + + retval = gadgetGetSetup(priv, &setup); + + priv->gadgetDev.speed = gadgetGetActualSpeed(priv); + + switch (priv->ep0State) { + case GADGET_EP0_STAGE_ACK: + if ((setup.bRequestType & USB_TYPE_MASK) != USB_TYPE_STANDARD) + retval = GADGET_EUNHANDLED; + else { + switch (setup.bRequest) { + case USB_REQ_SET_ADDRESS: + priv->deviceAddress = setup.wValue & 0x7F; + priv->gadgetDev.state = USB_STATE_ADDRESS; + pr_info("set address: %d\n", priv->deviceAddress); + retval = GADGET_EAUTOACK; + break; + case USB_REQ_SET_FEATURE: + retval = gadgetServiceSetFeatureReq(priv, &setup); + break; + case USB_REQ_CLEAR_FEATURE: + retval = gadgetServiceClearFeatureReq(priv, &setup); + break; + default: + retval = GADGET_EUNHANDLED; + break; + } + } + + if (retval == GADGET_EUNHANDLED) + break; + else if (retval == 0) + phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); + + priv->ep0State = GADGET_EP0_STAGE_SETUP; + break; + case GADGET_EP0_STAGE_IN: + pr_debug("setup data stage in\n"); + retval = gadgetServiceSetupReq(priv, &setup); + + if (retval == 0) + priv->ep0State = GADGET_EP0_STAGE_STATUSOUT; + break; + case GADGET_EP0_STAGE_OUT: + pr_debug("setup data stage out\n"); + phytium_write8(&priv->regs->ep0Rxbc, 0); + retval = GADGET_EUNHANDLED; + break; + default: + if (retval == GADGET_EAUTOACK) + return; + + pr_debug("forward request\n"); + retval = GADGET_EUNHANDLED; + break; + } + + if (retval == GADGET_EUNHANDLED) { + if (priv->eventCallback.setup) + retval = priv->eventCallback.setup(priv, &setup); + + if (retval == 0x7FFF) { + pr_debug("Respond Delayed not finished yet\n"); + return; + } + + if (retval) + retval = GADGET_ESTALL; + } + + if (retval == GADGET_EUNHANDLED || retval == GADGET_ESTALL) { + pr_debug("request not handled - send stall\n"); + ep0cs = phytium_read8(&priv->regs->ep0cs); + ep0cs |= EP0CS_STALL; + phytium_write8(&priv->regs->ep0cs, ep0cs); + priv->ep0State = GADGET_EP0_STAGE_SETUP; + } else if (priv->ep0State == GADGET_EP0_STAGE_ACK) { + priv->ep0State = GADGET_EP0_STAGE_SETUP; + phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); + pr_debug("setup transfer completed\n"); + } +} +static void gadgetEp0DataSend(struct GADGET_CTRL *priv) +{ + struct GADGET_REQ *request; + uint32_t chMaxLen, requestSize; + + if (!priv) + return; + + request = gadgetGetNextEp0Req(priv); + if (!request) { + pr_debug("Ep0 queue is empty\n"); + return; + } + + if (priv->dmaDrv->dma_getChannelStatus(priv->dmaController, priv->in[0].channel) + >= DMA_STATUS_BUSY) { + pr_err("transfer is pending now\n"); + return; + } + + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, priv->in[0].channel); + requestSize = (request->length < chMaxLen) ? request->length : chMaxLen; + pr_debug("usbRequest;%p requestSize:%d packetSize:%d\n", request, requestSize, + priv->in[0].gadgetEp.maxPacket); + priv->ep0State = GADGET_EP0_STAGE_STATUSOUT; + + priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->in[0].channel, + priv->in[0].gadgetEp.maxPacket, request->dma, requestSize, NULL, 0); +} + +static void gadgetEp0DataReceive(struct GADGET_CTRL *priv) +{ + uint32_t chMaxLen, requestSize; + struct GADGET_REQ *request; + + if (!priv) + return; + + request = gadgetGetNextEp0Req(priv); + if (!request) { + pr_debug("Ep0 queue is empty\n"); + return; + } + + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, priv->out[0].channel); + requestSize = (request->length < chMaxLen) ? request->length : chMaxLen; + pr_debug("usbRequest;%p requestSize:%d packetSize:%d\n", request, requestSize, + priv->out[0].gadgetEp.maxPacket); + priv->ep0State = GADGET_EP0_STAGE_STATUSIN; + + priv->dmaDrv->dma_channelProgram(priv->dmaController, priv->out[0].channel, + priv->out[0].gadgetEp.maxPacket, request->dma, requestSize, NULL, 0); +} + +static uint32_t gadgetEp0Irq(struct GADGET_CTRL *priv) +{ + uint8_t usbcs; + struct GADGET_REQ *request; + + if (!priv) + return 0; + + switch (priv->ep0State) { + case GADGET_EP0_STAGE_IN://send data + pr_debug("DATA Stage IN\n"); + gadgetEp0DataSend(priv); + break; + case GADGET_EP0_STAGE_OUT://receive data + pr_debug("DATA Stage OUT\n"); + gadgetEp0DataReceive(priv); + break; + case GADGET_EP0_STAGE_STATUSIN: + pr_debug("DATA Stage STATUS IN\n"); + request = gadgetGetNextEp0Req(priv); + if (request) + request->actual = priv->dmaDrv->dma_getActualLength(priv->dmaController, + priv->out[0].channel); + + priv->ep0State = GADGET_EP0_STAGE_SETUP; + phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); + gadgetEp0Callback(priv, &priv->out[0], request, 0); + break; + case GADGET_EP0_STAGE_STATUSOUT: + pr_debug("DATA Stage STATUS OUT\n"); + request = gadgetGetNextEp0Req(priv); + if (request) + request->actual = priv->dmaDrv->dma_getActualLength(priv->dmaController, + priv->in[0].channel); + + phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); + if (request) + gadgetEp0Callback(priv, &priv->in[0], request, 0); + else + priv->ep0State = GADGET_EP0_STAGE_SETUP; + break; + case GADGET_EP0_STAGE_SETUP: + pr_debug("DATA Stage SETUP\n"); + gadgetEp0StageSetup(priv); + break; + case GADGET_EP0_STAGE_ACK: + pr_debug("DATA Stage ACK\n"); + break; + default: + pr_debug("DATA Stage UNKNOWN\n"); + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs |= EP0CS_STALL; + phytium_write8(&priv->regs->usbcs, usbcs); + break; + } + + return 0; +} + +static void gadgetEpXCallback(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req, uint32_t status) +{ + if (!gadgetEp || !req) + return; + + list_del(&req->list); + gadgetEp->requestsInList--; + req->status = status; + + if (req->complete) + req->complete(&gadgetEp->gadgetEp, req); +} + +static void gadgetEpXDataCallback(struct GADGET_CTRL *priv, uint8_t epNum, uint8_t epDir) +{ + struct GadgetEp *gadgetEp; + struct GADGET_REQ *gadgetReq; + uint32_t actual_length = 0; + uint32_t chMaxLen = 0; + uint8_t epType; + + if (!priv) + return; + + pr_debug("%s %d epNum:%d epDir:%d\n", __func__, __LINE__, epNum, epDir); + gadgetEp = epDir ? &priv->in[epNum] : &priv->out[epNum]; + + gadgetReq = gadgetGetNextReq(gadgetEp); + if (!gadgetReq) { + pr_debug("%s queue is empty\n", gadgetEp->gadgetEp.name); + return; + } + + if (gadgetEp->channel) { + actual_length = priv->dmaDrv->dma_getActualLength(priv->dmaController, + gadgetEp->channel); + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, gadgetEp->channel); + gadgetReq->actual += actual_length; + } + + if (gadgetReq->actual == gadgetReq->length || actual_length < chMaxLen) { + gadgetEpXCallback(priv, gadgetEp, gadgetReq, 0); + + if (gadgetEp->gadgetEp.desc) { + epType = gadgetEp->gadgetEp.desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; + if (epType == USB_ENDPOINT_XFER_ISOC) + return; + + gadgetReq = gadgetGetNextReq(gadgetEp); + gadgetEp->state = GADGET_EP_ALLOCATED; + if (!gadgetReq) { + pr_debug("%s queue is empty\n", gadgetEp->gadgetEp.name); + return; + } + gadgetEp->state = GADGET_EP_BUSY; + if (epDir) + gadgetEpXDataSend(priv, requestToGadgetRequest(gadgetReq)); + else + gadgetEpXDataReceive(priv, requestToGadgetRequest(gadgetReq)); + } + } else { + if (epDir) + gadgetEpXDataSend(priv, requestToGadgetRequest(gadgetReq)); + else + gadgetEpXDataReceive(priv, requestToGadgetRequest(gadgetReq)); + } +} + +void gadget_CallbackTransfer(void *priv, uint8_t epNum, uint8_t epDir, bool resubmit) +{ + if (!epNum) + gadgetEp0Irq(priv); + else + gadgetEpXDataCallback(priv, epNum, epDir); +} + +static void gadgetAbortEndpoint(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) +{ + struct GADGET_REQ *gadgetReq; + + pr_debug("Abort Device endpoint: %s, dma channel: %p\n", gadgetEp->gadgetEp.name, + gadgetEp->channel); + + if (gadgetEp->channel && gadgetEp->hwEpNum != 0) { + priv->dmaDrv->dma_channelRelease(priv->dmaController, gadgetEp->channel); + gadgetEp->channel = NULL; + } + + if (gadgetEp->channel && gadgetEp->hwEpNum == 0) { + if (priv->releaseEp0Flag == 1) { + priv->dmaDrv->dma_channelAbort(priv->dmaController, gadgetEp->channel); + priv->dmaDrv->dma_channelAlloc(priv->dmaController, gadgetEp->isInEp, + gadgetEp->hwEpNum, 0); + } + } + + while (gadgetEp->request.next != &gadgetEp->request) { + gadgetReq = listToGadgetRequest(gadgetEp->request.next); + pr_debug("shutdown request %p form epName:%s\n", gadgetReq, + gadgetEp->gadgetEp.name); + if (!gadgetEp->gadgetEp.address) + gadgetEp0Callback(priv, gadgetEp, gadgetReq, GADGET_ESHUTDOWN); + else + gadgetEpXCallback(priv, gadgetEp, gadgetReq, GADGET_ESHUTDOWN); + } + + gadgetEp->state = GADGET_EP_FREE; +} + +static void gadgetStopActivity(struct GADGET_CTRL *priv) +{ + int i = 0; + struct GadgetEp *gadgetEp; + + pr_debug("USB Stop Activity\n"); + + if (!priv) + return; + + for (i = 0; i < 16; i++) { + gadgetEp = &priv->in[i]; + if (gadgetEp->state != GADGET_EP_NOT_IMPLEMENTED) + gadgetAbortEndpoint(priv, gadgetEp); + + gadgetEp = &priv->out[i]; + if (gadgetEp->state != GADGET_EP_NOT_IMPLEMENTED) + gadgetAbortEndpoint(priv, gadgetEp); + } +} + + +static int32_t gadgetEp0Enable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) +{ + uint8_t txien, rxien; + + if (!priv || !gadgetEp) + return -EINVAL; + + if (gadgetEp->state != GADGET_EP_FREE) + return -EBUSY; + + if (!gadgetEp->isInEp) { + rxien = phytium_read16(&priv->regs->rxien); + rxien &= ~(1 << gadgetEp->hwEpNum); + phytium_write16(&priv->regs->rxien, rxien); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_IO_TX | FIFOCTRL_FIFOAUTO); + } else { + txien = phytium_read16(&priv->regs->txien); + txien &= ~(1 << gadgetEp->hwEpNum); + phytium_write16(&priv->regs->txien, txien); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO); + } + + gadgetEp->gadgetEp.desc = NULL; + gadgetEp->state = GADGET_EP_ALLOCATED; + gadgetEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, + gadgetEp->isInEp, gadgetEp->hwEpNum, 0); + phytium_write8(&priv->regs->ep0maxpack, 0x40); + + return 0; +} + +static int32_t gadgetEpXEnable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + const struct usb_endpoint_descriptor *desc) +{ + uint32_t status = -EINVAL; + uint32_t payload; + uint16_t type, iso = 0; + uint8_t epNum = 0; + + if (!priv || !gadgetEp || !desc) + return -EINVAL; + + pr_debug("enable endpoint %s\n", gadgetEp->gadgetEp.name); + if (gadgetEp->state != GADGET_EP_FREE) { + status = -EBUSY; + goto fail; + } + + payload = desc->wMaxPacketSize & 0x7ff; + if (!payload) { + status = -EINVAL; + goto fail; + } + + epNum = gadgetEp->hwEpNum; + + type = desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; + switch (type) { + case USB_ENDPOINT_XFER_ISOC: + type = CON_TYPE_ISOC; + switch (payload >> 11) { + case 0: + iso = CON_TYPE_ISOC_1_ISOD; + break; + case 1: + payload *= 2; + iso = CON_TYPE_ISOC_2_ISOD; + break; + case 2: + payload *= 3; + iso = CON_TYPE_ISOC_3_ISOD; + break; + } + break; + case USB_ENDPOINT_XFER_INT: + type = CON_TYPE_INT; + break; + case USB_ENDPOINT_XFER_BULK: + type = CON_TYPE_BULK; + break; + } + + if (desc->bEndpointAddress & USB_DIR_IN) { + if (!gadgetEp->isInEp) { + status = -ENODEV; + goto fail; + } + + if (payload > priv->gadgetCfg.epIN[epNum].maxPacketSize) { + status = -EINVAL; + goto fail; + } + + phytium_write16(&priv->regs->txmaxpack[epNum - 1], payload); + phytium_write8(&priv->regs->ep[epNum - 1].txcon, CON_VAL | type + | iso | (priv->gadgetCfg.epIN[epNum - 1].bufferingValue - 1)); + + phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum); + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX | epNum | + ENDPRST_FIFORST | ENDPRST_TOGRST); + } else { + if (gadgetEp->isInEp) { + status = -ENODEV; + goto fail; + } + + if (payload > priv->gadgetCfg.epOUT[epNum].maxPacketSize) { + status = -EINVAL; + goto fail; + } + + phytium_write16(&priv->regs->rxmaxpack[epNum - 1], payload); + phytium_write8(&priv->regs->ep[epNum - 1].rxcon, CON_VAL | type + | iso | (priv->gadgetCfg.epIN[epNum - 1].bufferingValue - 1)); + + phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | epNum); + phytium_write8(&priv->regs->endprst, epNum); + phytium_write8(&priv->regs->endprst, epNum | ENDPRST_FIFORST | ENDPRST_TOGRST); + } + + if (priv->dmaController) + gadgetEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, + gadgetEp->isInEp, epNum, (type == CON_TYPE_ISOC) ? 1 : 0); + + if (type == CON_TYPE_ISOC) { + if (gadgetEp->isInEp) { + phytium_write16(&priv->regs->isoautodump, 1 << epNum); + phytium_write16(&priv->regs->isodctrl, 1 << epNum); + } + + priv->dmaDrv->dma_setMaxLength(priv->dmaController, gadgetEp->channel, payload); + } + + gadgetEp->state = GADGET_EP_ALLOCATED; + gadgetEp->gadgetEp.desc = desc; +fail: + return status; +} + +static int32_t gadgetEpEnable(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + const struct usb_endpoint_descriptor *desc) +{ + struct GadgetEp *gadgetEp = NULL; + + if (!priv || !gadget_Ep || !desc) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + gadgetEp->wedged = 0; + + if (gadgetEp->hwEpNum) + return gadgetEpXEnable(priv, gadgetEp, desc); + else + return gadgetEp0Enable(priv, gadgetEp); +} + +static int32_t gadgetEpXDisable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) +{ + uint8_t txcon, rxcon; + + if (!priv || !gadgetEp) + return -EINVAL; + + pr_debug("disable endpoint %s\n", gadgetEp->gadgetEp.name); + if (gadgetEp->isInEp) { + txcon = phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon); + txcon &= ~CON_VAL; + phytium_write8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon, txcon); + } else { + rxcon = phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon); + rxcon &= ~CON_VAL; + phytium_write8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon, rxcon); + } + gadgetAbortEndpoint(priv, gadgetEp); + gadgetEp->gadgetEp.desc = 0; + gadgetEp->state = GADGET_EP_FREE; + return 0; +} + +static int32_t gadgetEp0Disable(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp) +{ + if (!priv || !gadgetEp) + return -EINVAL; + + pr_debug("disable endpoint %s\n", gadgetEp->gadgetEp.name); + gadgetAbortEndpoint(priv, gadgetEp); + + return 0; +} + +static int32_t gadgetEpDisable(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) +{ + struct GadgetEp *gadgetEp = NULL; + + if (!priv || !gadget_Ep) + return -EINVAL; + + if (gadget_Ep->address == 0) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + gadgetEp->wedged = 0; + if (gadgetEp->hwEpNum) + return gadgetEpXDisable(priv, gadgetEp); + else + return gadgetEp0Disable(priv, gadgetEp); +} + +static int32_t gadgetEpXQueue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req) +{ + struct GadgetRequest *gadgetRequest; + + if (!priv || !gadgetEp || !req) + return -EINVAL; + + req->actual = 0; + req->status = EINPROGRESS; + + gadgetRequest = requestToGadgetRequest(req); + gadgetRequest->ep = gadgetEp; + + if (req->length == 0) + gadgetRequest->zlp = 1; + + if (gadgetEp->gadgetEp.desc == NULL) { + pr_info("%s is disabled - can not queue request %p\n", + gadgetEp->gadgetEp.name, req); + return -EINVAL; + } + + list_add_tail(&req->list, &gadgetEp->request); + pr_debug("queue to %s (%s), length:%d\n", gadgetEp->gadgetEp.name, + (gadgetEp->isInEp ? "IN/TX" : "OUT/RX"), req->length); + + if ((gadgetEp->state == GADGET_EP_ALLOCATED) && (&req->list == gadgetEp->request.next)) { + if (gadgetEp->isInEp) { + if (!(phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].txcon) + & CON_STALL)) { + gadgetEp->state = GADGET_EP_BUSY; + gadgetEpXDataSend(priv, gadgetRequest); + } + } else { + if (!(phytium_read8(&priv->regs->ep[gadgetEp->hwEpNum - 1].rxcon) + & CON_STALL)) { + gadgetEp->state = GADGET_EP_BUSY; + gadgetEpXDataReceive(priv, gadgetRequest); + } + } + } else if (gadgetEp->state == GADGET_EP_BUSY) { + if (usb_endpoint_xfer_isoc(gadgetEp->gadgetEp.desc)) { + if (gadgetEp->isInEp) + gadgetEpXDataSend(priv, gadgetRequest); + else + gadgetEpXDataReceive(priv, gadgetRequest); + } + } + + pr_debug("endpoint %s (%s) now is busy - transfer will be waiting in Queue\n", + gadgetEp->gadgetEp.name, (gadgetEp->isInEp ? "IN/TX" : "OUT/RX")); + + return 0; +} + +static int32_t gadgetEp0Queue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req) +{ + struct GadgetRequest *gadgetRequest; + + if (!priv || !gadgetEp || !req) + return -EINVAL; + + req->actual = 0; + req->status = EINPROGRESS; + + if (!list_empty(&gadgetEp->request)) + return -EBUSY; + + gadgetRequest = requestToGadgetRequest(req); + gadgetRequest->ep = gadgetEp; + + switch (priv->ep0State) { + case GADGET_EP0_STAGE_OUT: + case GADGET_EP0_STAGE_IN: + case GADGET_EP0_STAGE_ACK: + break; + default: + return -EINVAL; + } + + list_add_tail(&req->list, &gadgetEp->request); + gadgetEp->requestsInList++; + + pr_debug("queue to %s (%s), length:%d stage:%d\n", gadgetEp->gadgetEp.name, + gadgetEp->isInEp ? "IN/TX" : "OUT/RX", req->length, priv->ep0State); + + switch (priv->ep0State) { + case GADGET_EP0_STAGE_OUT: + gadgetEp0DataReceive(priv); + break; + case GADGET_EP0_STAGE_IN: + gadgetEp0DataSend(priv); + break; + case GADGET_EP0_STAGE_ACK: + if (req->length) + return -EINVAL; + phytium_write8(&priv->regs->ep0cs, EP0CS_HSNAK); + gadgetEp0Callback(priv, gadgetRequest->ep, req, 0); + pr_info("control transfer completed\n"); + break; + default: + break; + } + + return 0; +} + +static int32_t gadgetEpQueue(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + struct GADGET_REQ *req) +{ + struct GadgetEp *gadgetEp = NULL; + + if (!priv || !gadget_Ep || !req) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + + if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) + return gadgetEpXQueue(priv, gadgetEp, req); + else + return gadgetEp0Queue(priv, gadgetEp, req); +} + +static int32_t gadgetEpXDequeue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req) +{ + struct GadgetRequest *gadgetRequest; + struct GADGET_REQ *iterator; + + if (!priv || !gadgetEp || !req) + return -EINVAL; + + gadgetRequest = requestToGadgetRequest(req); + if (gadgetRequest->ep != gadgetEp) + return -EINVAL; + + pr_debug("Dequeue request %p form %s\n", req, gadgetEp->gadgetEp.name); + + listBrowsingRequest(iterator, &gadgetEp->request, list) { + if (req == iterator) + break; + } + + if (req != iterator) { + pr_info("request %p not queued to %s\n", req, gadgetEp->gadgetEp.name); + return -EINVAL; + } + + if (gadgetEp->state == GADGET_EP_BUSY) { + priv->dmaDrv->dma_channelAbort(priv->dmaController, gadgetEp->channel); + gadgetEp->state = GADGET_EP_ALLOCATED; + } + + gadgetEpXCallback(priv, gadgetEp, req, GADGET_ECONNRESET); + + return 0; +} + +static int32_t gadgetEp0Dequeue(struct GADGET_CTRL *priv, struct GadgetEp *gadgetEp, + struct GADGET_REQ *req) +{ + return 0; +} + +static int32_t gadgetEpDequeue(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + struct GADGET_REQ *req) +{ + struct GadgetEp *gadgetEp = NULL; + + if (!priv || !gadget_Ep || !req) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + + if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) + return gadgetEpXDequeue(priv, gadgetEp, req); + else + return gadgetEp0Dequeue(priv, gadgetEp, req); +} + +static int32_t gadgetEpSetHalt(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, uint8_t value) +{ + if (!priv || !gadget_Ep) + return -EINVAL; + + if (gadget_Ep->address & GADGET_USB_EP_NUMBER_MASK) + return gadgetEpXSetHalt(priv, gadget_Ep, value); + else + return gadgetEp0SetHalt(priv, gadget_Ep, value); +} + +static int32_t gadgetEpSetWedge(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) +{ + struct GadgetEp *gadgetEp = NULL; + + if (!priv || !gadget_Ep) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + gadgetEp->wedged = 1; + + return gadgetEpSetHalt(priv, gadget_Ep, 1); +} + +static int32_t gadgetEpFifoStatus(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) +{ + if (!priv || !gadget_Ep) + return -EINVAL; + + return 0; +} + +static void gadgetEpFifoFlush(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep) +{ + if (!priv || !gadget_Ep) + return; +} + +static int32_t gadgetEpAllocRequest(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + struct GADGET_REQ **req) +{ + struct GadgetEp *gadgetEp = NULL; + struct GadgetRequest *gadgetRequest = NULL; + + if (!priv || !gadget_Ep || !req) + return -EINVAL; + + gadgetEp = toGadgetEp(gadget_Ep); + if (priv->eventCallback.usbRequestMemAlloc) + gadgetRequest = priv->eventCallback.usbRequestMemAlloc(priv, + sizeof(*gadgetRequest)); + if (!gadgetRequest) + return -ENOMEM; + + memset(gadgetRequest, 0, sizeof(*gadgetRequest)); + *req = &gadgetRequest->request; + INIT_LIST_HEAD(&gadgetRequest->request.list); + gadgetRequest->ep = gadgetEp; + + return 0; +} + +static void gadgetEpFreeRequest(struct GADGET_CTRL *priv, struct GADGET_EP *gadget_Ep, + struct GADGET_REQ *req) +{ + struct GadgetRequest *gadgetRequest = NULL; + + if (!priv || !gadget_Ep || !req) + return; + + gadgetRequest = requestToGadgetRequest(req); + + if (priv->eventCallback.usbRequestMemFree) + priv->eventCallback.usbRequestMemFree(priv, gadgetRequest); +} + +static struct GADGET_EP_OPS gadgetEpOps = { + .epEnable = gadgetEpEnable, + .epDisable = gadgetEpDisable, + .reqQueue = gadgetEpQueue, + .reqDequeue = gadgetEpDequeue, + .epSetHalt = gadgetEpSetHalt, + .epSetWedge = gadgetEpSetWedge, + .epFifoStatus = gadgetEpFifoStatus, + .reqAlloc = gadgetEpAllocRequest, + .reqFree = gadgetEpFreeRequest +}; + +static void gadgetInitDeviceEp(struct GADGET_CTRL *priv, uint8_t isInEp) +{ + uint8_t num; + struct GadgetEp *gadgetEp; + struct GADGET_EP_CFG epCfg; + + if (!priv) + return; + + for (num = 0; num < 16; num++) { + gadgetEp = isInEp ? &priv->in[num] : &priv->out[num]; + if (num) { + epCfg = isInEp ? priv->gadgetCfg.epIN[num] : priv->gadgetCfg.epOUT[num]; + if (!epCfg.bufferingValue) { + gadgetEp->state = GADGET_EP_NOT_IMPLEMENTED; + gadgetEp->hwEpNum = num; + continue; + } + } + INIT_LIST_HEAD(&gadgetEp->gadgetEp.epList); + INIT_LIST_HEAD(&gadgetEp->request); + gadgetEp->state = GADGET_EP_FREE; + gadgetEp->hwEpNum = num; + gadgetEp->isInEp = isInEp; + gadgetEp->requestsInList = 0; + snprintf(gadgetEp->gadgetEp.name, sizeof(gadgetEp->gadgetEp.name), + "Ep%d%s", num, isInEp ? "in" : "out"); + if (!num) { + gadgetEp->gadgetEp.maxPacket = priv->gadgetCfg.epIN[num].maxPacketSize; + if (isInEp) + priv->gadgetDev.ep0 = &gadgetEp->gadgetEp; + gadgetEp->gadgetEp.ops = &gadgetEpOps; + gadgetEp0Enable(priv, gadgetEp); + continue; + } + + if (isInEp) { + if (epCfg.startBuf) + phytium_write16(&priv->regs->txstaddr[num - 1].addr, + epCfg.startBuf); + phytium_write8(&priv->regs->ep[num - 1].txcon, 0); + gadgetEp->gadgetEp.maxPacket = epCfg.maxPacketSize; + } else { + if (epCfg.startBuf) + phytium_write16(&priv->regs->rxstaddr[num - 1].addr, + epCfg.startBuf); + phytium_write8(&priv->regs->ep[num - 1].rxcon, 0); + gadgetEp->gadgetEp.maxPacket = epCfg.maxPacketSize; + } + + gadgetEp->gadgetEp.ops = &gadgetEpOps; + gadgetEp->gadgetEp.address = isInEp ? (0x80 | num) : num; + gadgetEp->gadgetEp.maxburst = 0; + gadgetEp->gadgetEp.mult = 0; + gadgetEp->gadgetEp.maxStreams = 0; + priv->endpointInList++; + list_add_tail(&gadgetEp->gadgetEp.epList, &priv->gadgetDev.epList); + } +} + +static void gadgetInitEndpoint(struct GADGET_CTRL *priv) +{ + if (!priv) + return; + + gadgetInitDeviceEp(priv, 1); + gadgetInitDeviceEp(priv, 0); +} + +static void gadgetSetup(struct GADGET_CTRL *priv) +{ + if (!priv) + return; + + INIT_LIST_HEAD(&priv->gadgetDev.epList); + priv->gadgetDev.state = USB_STATE_NOTATTACHED; + priv->gadgetDev.maxSpeed = USB_SPEED_HIGH; + priv->gadgetDev.speed = USB_SPEED_FULL; + snprintf(priv->gadgetDev.name, sizeof(priv->gadgetDev.name), "Phytium USB SD Driver"); + + gadgetInitEndpoint(priv); + + phytium_write8(&priv->regs->ep0maxpack, 0x40); + phytium_write16(&priv->regs->rxien, 0); + phytium_write16(&priv->regs->txien, 0); + phytium_write16(&priv->regs->rxirq, 0xFFFF); + phytium_write16(&priv->regs->txirq, 0xFFFF); + phytium_write8(&priv->regs->usbirq, 0xEF); + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); + priv->isReady = 1; +} +int32_t gadgetInit(struct GADGET_CTRL *priv, struct GADGET_CFG *config, + struct GADGET_CALLBACKS *callbacks, struct device *pdev) +{ + struct DMA_SYSREQ dmaSysReq; + uint8_t usbcs; + + if (!priv || !config || !callbacks) + return -EINVAL; + + priv->dev = pdev; + priv->eventCallback = *callbacks; + priv->gadgetCfg = *config; + priv->regs = (struct HW_REGS *)config->regBase; + priv->phy_regs = (struct VHUB_REGS *)config->phy_regBase; + priv->gadgetDrv = GADGET_GetInstance(); + priv->dmaDrv = DMA_GetInstance(); + priv->dmaController = (void *)(priv + 1); + priv->dmaCfg.dmaModeRx = 0xFFFF; + priv->dmaCfg.dmaModeTx = 0xFFFF; + priv->dmaCfg.regBase = config->regBase + 0x400; + priv->dmaCfg.trbAddr = config->trbAddr; + priv->dmaCfg.trbDmaAddr = config->trbDmaAddr; + + priv->dmaDrv->dma_probe(NULL, &dmaSysReq); + priv->privBuffAddr = (uint8_t *)((uintptr_t)config->trbAddr + dmaSysReq.trbMemSize); + priv->privBuffDma = (uintptr_t)((uintptr_t)config->trbDmaAddr + dmaSysReq.trbMemSize); + priv->dmaCallback.complete = gadget_CallbackTransfer; + priv->dmaDrv->dma_init(priv->dmaController, &priv->dmaCfg, &priv->dmaCallback); + priv->dmaDrv->dma_setParentPriv(priv->dmaController, priv); + + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs |= USBCS_DISCON | USBCS_LPMNYET; + phytium_write8(&priv->regs->usbcs, usbcs); + + gadgetSetup(priv); + + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs &= USBCS_DISCON; + phytium_write8(&priv->regs->usbcs, usbcs); + + return 0; +} + +static void gadgetDestroy(struct GADGET_CTRL *priv) +{ + pr_debug("Destroy Device Controller driver\n"); + + if (priv) + return; + gadgetDisconnect(priv); + + gadgetStopActivity(priv); + + phytium_write8(&priv->regs->usbcs, USBCS_DISCON); + + priv->isReady = 0; +} + +static void gadgetStart(struct GADGET_CTRL *priv) +{ + uint8_t usbien, usbcs; + + pr_debug("Usb Device Controller start\n"); + if (!priv) + return; + + usbien = phytium_read8(&priv->regs->usbien); + usbien |= USBIR_URES | USBIR_SUDAV | USBIR_LPMIR; + phytium_write8(&priv->regs->usbien, usbien); + + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs &= ~USBCS_DISCON; + phytium_write8(&priv->regs->usbcs, usbcs); + + priv->dmaDrv->dma_start(priv->dmaController); +} + +static void gadgetReset(struct GADGET_CTRL *priv) +{ + int i = 0; + + pr_debug("Usb Disable Device Activity\n"); + + if (!priv) + return; + + if (priv->gadgetDev.speed != USB_SPEED_UNKNOWN) + gadgetDisconnect(priv); + + priv->gadgetDev.aHnpSupport = 0; + priv->gadgetDev.bHnpEnable = 0; + priv->gadgetDev.state = USB_STATE_DEFAULT; + priv->deviceAddress = 0; + priv->ep0State = GADGET_EP0_STAGE_SETUP; + + gadgetStopActivity(priv); + + for (i = 0; i < 1000; i++) { + priv->gadgetDev.speed = gadgetGetActualSpeed(priv); + if (priv->gadgetDev.speed == USB_SPEED_HIGH) + return; + } +} + +static void gadgetStop(struct GADGET_CTRL *priv) +{ + pr_debug("Usb Device Controller stop\n"); + + if (!priv) + return; + + if (!priv->isReady) + return; + + gadgetReset(priv); + + phytium_write8(&priv->regs->usbien, 0); + priv->dmaDrv->dma_stop(priv->dmaController); + + priv->isReady = 0; +} + +static void gadgetIsr(struct GADGET_CTRL *priv) +{ + uint8_t usbirq, usbien, usbcs; + + if (!priv) + return; + + usbirq = phytium_read8(&priv->regs->usbirq); + usbien = phytium_read8(&priv->regs->usbien); + + pr_debug("usbirq:0x%x usbien:0x%x\n", usbirq, usbien); + + usbirq = usbirq & usbien; + + if (!usbirq) + goto DMA_IRQ; + + if (usbirq & USBIR_LPMIR) { + pr_debug("USBIRQ LPM\n"); + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs &= ~USBCS_LPMNYET; + phytium_write8(&priv->regs->usbcs, usbcs); + phytium_write8(&priv->regs->usbirq, USBIR_LPMIR); + } + + if (usbirq & USBIR_URES) { + pr_debug("USBIRQ RESET\n"); + phytium_write8(&priv->regs->usbirq, USBIR_URES); + priv->releaseEp0Flag = 1; + gadgetReset(priv); + priv->releaseEp0Flag = 0; + priv->gadgetDev.state = USB_STATE_DEFAULT; + if (priv->eventCallback.connect) + priv->eventCallback.connect(priv); + } + + if (usbirq & USBIR_HSPEED) { + pr_debug("USBIRQ HighSpeed\n"); + phytium_write8(&priv->regs->usbirq, USBIR_HSPEED); + priv->gadgetDev.speed = USB_SPEED_HIGH; + } + + if (usbirq & USBIR_SUDAV) { + pr_debug("USBIRQ SUDAV\n"); + priv->ep0State = GADGET_EP0_STAGE_SETUP; + gadgetEp0Irq(priv); + } + + if (usbirq & USBIR_SOF) { + pr_debug("USBIRQ SOF\n"); + phytium_write8(&priv->regs->usbirq, USBIR_SOF); + } + + if (usbirq & USBIR_SUTOK) { + pr_debug("USBIRQ SUTOK\n"); + phytium_write8(&priv->regs->usbirq, USBIR_SUTOK); + } + + if (usbirq & USBIR_SUSP) { + pr_debug("USBIRQ SUSPEND\n"); + phytium_write8(&priv->regs->usbirq, USBIR_SUSP); + } + + return; +DMA_IRQ: + priv->dmaDrv->dma_isr(priv->dmaController); +} + +static void gadgetGetDevInstance(struct GADGET_CTRL *priv, struct GADGET_DEV **dev) +{ + if (!priv || !dev) + return; + + *dev = &priv->gadgetDev; +} + +static int32_t gadgetGetFrame(struct GADGET_CTRL *priv, uint32_t *numOfFrame) +{ + if (!priv || !numOfFrame) + return -EINVAL; + + *numOfFrame = phytium_read16(&priv->regs->frmnr); + + return 0; +} + +static int32_t gadgetWakeUp(struct GADGET_CTRL *priv) +{ + if (!priv) + return -EINVAL; + + return -EOPNOTSUPP; +} + +static int32_t gadgetSetSelfPowered(struct GADGET_CTRL *priv) +{ + if (!priv) + return -EINVAL; + + priv->isSelfPowered = 1; + + return 0; +} + +static int32_t gadgetClearSelfPowered(struct GADGET_CTRL *priv) +{ + if (!priv) + return -EINVAL; + + priv->isSelfPowered = 0; + + return 0; +} + +static int32_t gadgetVbusSession(struct GADGET_CTRL *priv, uint8_t isActive) +{ + if (!priv) + return -EINVAL; + + return -EOPNOTSUPP; +} + +static int32_t gadgetVbusDraw(struct GADGET_CTRL *priv, uint8_t mA) +{ + if (!priv) + return -EINVAL; + + return -EOPNOTSUPP; +} + +static int32_t gadgetPullUp(struct GADGET_CTRL *priv, uint8_t isOn) +{ + if (!priv) + return -EINVAL; + + return -EOPNOTSUPP; +} + +struct GADGET_OBJ GadgetObj = { + .gadget_init = gadgetInit, + .gadget_destroy = gadgetDestroy, + .gadget_start = gadgetStart, + .gadget_stop = gadgetStop, + .gadget_isr = gadgetIsr, + //endpoint operation + .gadget_epEnable = gadgetEpEnable, + .gadget_epDisable = gadgetEpDisable, + .gadget_epSetHalt = gadgetEpSetHalt, + .gadget_epSetWedge = gadgetEpSetWedge, + .gadget_epFifoStatus = gadgetEpFifoStatus, + .gadget_epFifoFlush = gadgetEpFifoFlush, + .gadget_reqQueue = gadgetEpQueue, + .gadget_reqDequeue = gadgetEpDequeue, + .gadget_reqAlloc = gadgetEpAllocRequest, + .gadget_reqFree = gadgetEpFreeRequest, + + //Device operations + .gadget_getDevInstance = gadgetGetDevInstance, + .gadget_dGetFrame = gadgetGetFrame, + .gadget_dWakeUp = gadgetWakeUp, + .gadget_dSetSelfpowered = gadgetSetSelfPowered, + .gadget_dClearSelfpowered = gadgetClearSelfPowered, + .gadget_dVbusSession = gadgetVbusSession, + .gadget_dVbusDraw = gadgetVbusDraw, + .gadget_dPullUp = gadgetPullUp, +}; + +struct GADGET_OBJ *GADGET_GetInstance(void) +{ + return &GadgetObj; +} + +static int phytium_gadget_set_default_cfg(struct phytium_cusb *config) +{ + int index; + + config->gadget_cfg.regBase = (uintptr_t)config->regs; + config->gadget_cfg.phy_regBase = (uintptr_t)config->phy_regs; + config->gadget_cfg.dmaInterfaceWidth = GADGET_DMA_32_WIDTH; + + for (index = 0; index < 16; index++) { + if (index == 0) { + config->gadget_cfg.epIN[index].bufferingValue = 1; + config->gadget_cfg.epIN[index].maxPacketSize = 64; + config->gadget_cfg.epIN[index].startBuf = 0; + + config->gadget_cfg.epOUT[index].bufferingValue = 1; + config->gadget_cfg.epOUT[index].maxPacketSize = 64; + config->gadget_cfg.epOUT[index].startBuf = 0; + } else { + config->gadget_cfg.epIN[index].bufferingValue = 4; + config->gadget_cfg.epIN[index].maxPacketSize = 1024; + config->gadget_cfg.epIN[index].startBuf = 64 + 4096 * (index - 1); + + config->gadget_cfg.epOUT[index].bufferingValue = 4; + config->gadget_cfg.epOUT[index].maxPacketSize = 1024; + config->gadget_cfg.epOUT[index].startBuf = 64 + 4096 * (index - 1); + } + } + + return 0; +} + +void gadget_callback_connect(struct GADGET_CTRL *priv) +{ + if (!priv) + return; +} + +void gadget_callback_disconnect(struct GADGET_CTRL *priv) +{ + if (!priv) + return; +} + +int32_t gadget_callback_setup(struct GADGET_CTRL *priv, struct usb_ctrlrequest *ctrl) +{ + struct phytium_cusb *config; + int ret = 0; + + if (!priv || !ctrl) + return -EINVAL; + + config = dev_get_drvdata(priv->dev); + if (!config) + return -1; + + if (!config->gadget_driver) + return -EOPNOTSUPP; + + if (ctrl->bRequestType & USB_DIR_IN) + config->ep0_data_stage_is_tx = 1; + else + config->ep0_data_stage_is_tx = 0; + + spin_unlock(&config->lock); + ret = config->gadget_driver->setup(&config->gadget, ctrl); + spin_lock(&config->lock); + + if (ret == 0x7FFF) + return ret; + + if (ret < 0) + return 1; + + return 0; +} + +void *gadget_callback_usbRequestMemAlloc(struct GADGET_CTRL *priv, u32 size) +{ + struct GADGET_REQ *gadget_req = NULL; + + gadget_req = kzalloc(size, GFP_NOWAIT); + if (!gadget_req) + return NULL; + + return gadget_req; +} + +void gadget_callback_usbRequestMemFree(struct GADGET_CTRL *priv, void *usbReq) +{ + if (!usbReq) + return; + + kfree(usbReq); +} + +static void init_peripheral_ep(struct phytium_cusb *config, + struct phytium_ep *phy_ep, struct GADGET_EP *gadget_ep, int is_tx) +{ + if (!config || !phy_ep || !gadget_ep) + return; + + memset(phy_ep, 0, sizeof(*phy_ep)); + phy_ep->config = config; + phy_ep->is_tx = is_tx; + phy_ep->gadget_ep = gadget_ep; + phy_ep->ep_num = gadget_ep->address & 0xF; + phy_ep->end_point.maxpacket = gadget_ep->maxPacket; + phy_ep->end_point.maxpacket_limit = 1024; + + INIT_LIST_HEAD(&phy_ep->req_list); + sprintf(phy_ep->name, "ep%d%s", phy_ep->ep_num, is_tx ? "in" : "out"); + + switch (phy_ep->ep_num) { + case 0: + phy_ep->end_point.caps.type_control = 1; + break; + case 1: + phy_ep->end_point.caps.type_bulk = 1; + break; + case 2: + phy_ep->end_point.caps.type_int = 1; + break; + case 3: + phy_ep->end_point.caps.type_iso = 1; + break; + default: + phy_ep->end_point.caps.type_int = 1; + phy_ep->end_point.caps.type_bulk = 1; + break; + } + + if (is_tx) { + phy_ep->end_point.caps.dir_in = 1; + phy_ep->end_point.caps.dir_out = 0; + } else { + phy_ep->end_point.caps.dir_in = 0; + phy_ep->end_point.caps.dir_out = 1; + } + + phy_ep->end_point.name = phy_ep->name; + + INIT_LIST_HEAD(&phy_ep->end_point.ep_list); + + if (!phy_ep->ep_num) { + phy_ep->end_point.ops = &gadget_ep0_ops; + config->gadget.ep0 = &phy_ep->end_point; + + if (config->gadget_dev->maxSpeed > USB_SPEED_HIGH) + config->gadget.ep0->maxpacket = 9; + } else { + phy_ep->end_point.ops = &gadget_ep_ops; + list_add_tail(&phy_ep->end_point.ep_list, &config->gadget.ep_list); + } +} + +static void gadget_init_endpoint(struct phytium_cusb *config) +{ + struct list_head *list; + struct GADGET_EP *gadget_ep; + + if (!config) + return; + + INIT_LIST_HEAD(&(config->gadget.ep_list)); + + init_peripheral_ep(config, &config->endpoints_tx[0], config->gadget_dev->ep0, 1); + init_peripheral_ep(config, &config->endpoints_rx[0], config->gadget_dev->ep0, 0); + + list_for_each(list, &config->gadget_dev->epList) { + gadget_ep = (struct GADGET_EP *)list; + if (gadget_ep->address & USB_DIR_IN) + init_peripheral_ep(config, &config->endpoints_tx[gadget_ep->address & 0xf], + gadget_ep, 1); + else + init_peripheral_ep(config, &config->endpoints_rx[gadget_ep->address & 0xf], + gadget_ep, 0); + } +} + +static int gadget_setup(struct phytium_cusb *config) +{ + int ret = -1; + + config->gadget_obj->gadget_getDevInstance(config->gadget_priv, &config->gadget_dev); + config->gadget.ops = &phytium_gadget_ops; + config->gadget.max_speed = config->gadget_dev->maxSpeed; + config->gadget.speed = USB_SPEED_HIGH; + config->gadget.name = "phytium_gadget"; + config->gadget.is_otg = 0; + + gadget_init_endpoint(config); + + ret = usb_add_gadget_udc(config->dev, &config->gadget); + if (ret) + goto err; + + return 0; + +err: + config->gadget.dev.parent = NULL; + device_unregister(&config->gadget.dev); + return ret; +} + +int phytium_gadget_reinit(struct phytium_cusb *config) +{ + struct GADGET_CTRL *ctrl; + + if (!config) + return 0; + + ctrl = (struct GADGET_CTRL *)config->gadget_priv; + if (!ctrl) + return 0; + + gadgetStop(ctrl); + + config->gadget_obj->gadget_init(config->gadget_priv, &config->gadget_cfg, + &config->gadget_callbacks, config->dev); + + return 0; +} + +int phytium_gadget_init(struct phytium_cusb *config) +{ + int ret; + + if (!config) + return 0; + + phytium_gadget_set_default_cfg(config); + config->gadget_obj = &GadgetObj; + + config->dma_cfg.regBase = config->gadget_cfg.regBase + 0x400; + config->dma_obj = DMA_GetInstance(); + config->dma_obj->dma_probe(&config->dma_cfg, &config->dma_sysreq); + + config->gadget_sysreq.privDataSize = sizeof(struct GADGET_CTRL); + config->gadget_sysreq.trbMemSize = config->dma_sysreq.trbMemSize + GADGET_PRIV_BUFFER_SIZE; + config->gadget_sysreq.privDataSize += config->dma_sysreq.privDataSize; + + config->gadget_priv = devm_kzalloc(config->dev, + config->gadget_sysreq.privDataSize, GFP_KERNEL); + if (!config->gadget_priv) { + ret = -ENOMEM; + goto err_probe; + } + config->gadget_cfg.trbAddr = dma_alloc_coherent(config->dev, + config->gadget_sysreq.trbMemSize, + (dma_addr_t *)&config->gadget_cfg.trbDmaAddr, GFP_KERNEL); + if (!config->gadget_cfg.trbAddr) { + ret = -ENOMEM; + goto err_dma_coherent; + } + + config->gadget_callbacks.connect = gadget_callback_connect; + config->gadget_callbacks.disconnect = gadget_callback_disconnect; + config->gadget_callbacks.setup = gadget_callback_setup; + config->gadget_callbacks.usbRequestMemAlloc = gadget_callback_usbRequestMemAlloc; + config->gadget_callbacks.usbRequestMemFree = gadget_callback_usbRequestMemFree; + + ret = config->gadget_obj->gadget_init(config->gadget_priv, &config->gadget_cfg, + &config->gadget_callbacks, config->dev); + if (ret) { + ret = -ENODEV; + goto err_init; + } + + //dev_set_drvdata(config->dev, config); + + gadget_setup(config); + + return 0; + +err_init: + dma_free_coherent(config->dev, config->gadget_sysreq.trbMemSize, + config->gadget_cfg.trbAddr, config->gadget_cfg.trbDmaAddr); +err_dma_coherent: +err_probe: + dev_set_drvdata(config->dev, NULL); + + return ret; +} + +int phytium_gadget_uninit(struct phytium_cusb *config) +{ + if (config) + usb_del_gadget_udc(&config->gadget); + + return 0; +} + +#ifdef CONFIG_PM +int phytium_gadget_resume(void *priv) +{ + struct GADGET_CTRL *ctrl; + uint32_t gen_cfg; + unsigned long flags = 0; + struct phytium_cusb *config = (struct phytium_cusb *)priv; + + if (!config) + return 0; + + ctrl = (struct GADGET_CTRL *)config->gadget_priv; + if (!ctrl) + return 0; + + spin_lock_irqsave(&config->lock, flags); + phytium_gadget_reinit(config); + + if (config->gadget_driver) { + config->gadget_obj->gadget_start(config->gadget_priv); + if (ctrl->phy_regs) { + gen_cfg = phytium_read32(&ctrl->phy_regs->gen_cfg); + gen_cfg = gen_cfg & (~BIT(7)); + phytium_write32(&ctrl->phy_regs->gen_cfg, gen_cfg); + } + } + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +int phytium_gadget_suspend(void *priv) +{ + return 0; +} +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/gadget.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/gadget.h new file mode 100644 index 0000000000000000000000000000000000000000..d87b55ade7a70b29189402e8164d833e6340730b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/gadget.h @@ -0,0 +1,253 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef __PHYTIUM_GADGET_H_ +#define __PHYTIUM_GADGET_H_ + +#include +#include +#include "dma.h" + +struct GADGET_CTRL; +struct GADGET_EP; +struct GADGET_REQ; + +enum GADGET_EP_STATE { + GADGET_EP_FREE, + GADGET_EP_ALLOCATED, + GADGET_EP_BUSY, + GADGET_EP_NOT_IMPLEMENTED +}; + +enum GADGET_EP0_STAGE { + GADGET_EP0_STAGE_SETUP, + GADGET_EP0_STAGE_IN, + GADGET_EP0_STAGE_OUT, + GADGET_EP0_STAGE_STATUSIN, + GADGET_EP0_STAGE_STATUSOUT, + GADGET_EP0_STAGE_ACK +}; + +struct GADGET_EP_OPS { + int32_t (*epEnable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + const struct usb_endpoint_descriptor *desc); + + int32_t (*epDisable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*epSetHalt)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, uint8_t value); + + int32_t (*epSetWedge)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*epFifoStatus)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*epFifoFlush)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*reqQueue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); + + int32_t (*reqDequeue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); + + int32_t (*reqAlloc)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ **req); + + void (*reqFree)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); +}; + +struct GADGET_EP { + struct list_head epList; + char name[255]; + struct GADGET_EP_OPS *ops; + uint16_t maxPacket; + uint16_t maxStreams; + uint8_t mult; + uint8_t maxburst; + uint8_t address; + const struct usb_endpoint_descriptor *desc; + const struct usb_ss_ep_comp_descriptor *compDesc; +}; + +enum GADGET_DMAInterfaceWidth { + GADGET_DMA_32_WIDTH = 4, + GADGET_DMA_64_WIDTH = 8, +}; + +struct GADGET_EP_CFG { + uint8_t bufferingValue; + uint16_t startBuf; + uint16_t maxPacketSize; +}; + +struct GADGET_CFG { + uintptr_t regBase; + uintptr_t phy_regBase; + struct GADGET_EP_CFG epIN[16]; + struct GADGET_EP_CFG epOUT[16]; + enum GADGET_DMAInterfaceWidth dmaInterfaceWidth; + void *trbAddr; + uintptr_t trbDmaAddr; +}; + +struct GADGET_SYSREQ { + uint32_t privDataSize; + uint32_t trbMemSize; +}; + +struct GadgetEp { + struct GADGET_EP gadgetEp; + enum GADGET_EP_STATE state; + uint8_t hwEpNum; + uint8_t isInEp; + struct list_head request; + uint8_t iso_flag; + void *channel; + uint32_t requestsInList; + uint8_t wedged; +}; + +struct GADGET_DEV { + struct list_head epList; + struct GADGET_EP *ep0; + unsigned int speed; + unsigned int maxSpeed; + enum usb_device_state state; + uint8_t sgSupported; + uint8_t bHnpEnable; + uint8_t aHnpSupport; + char name[255]; +}; + +struct GADGET_SgList { + uintptr_t link; + uint32_t offset; + uint32_t length; + uintptr_t dmaAddress; +}; + +struct GADGET_REQ { + struct list_head list; + void *buf; + uint32_t length; + uintptr_t dma; + uint32_t numOfSgs; + uint32_t numMappedSgs; + uint16_t streamId; + uint8_t oInterrupt; + uint8_t zero; + uint8_t shortNotOk; + void *context; + uint32_t status; + uint32_t actual; + struct GADGET_SgList *sg; + void (*complete)(struct GADGET_EP *ep, struct GADGET_REQ *req); +}; + + +struct GADGET_CALLBACKS { + void (*disconnect)(struct GADGET_CTRL *priv); + + void (*connect)(struct GADGET_CTRL *priv); + + int32_t (*setup)(struct GADGET_CTRL *priv, + struct usb_ctrlrequest *ctrl); + + void *(*usbRequestMemAlloc)(struct GADGET_CTRL *priv, + uint32_t requiredSize); + + void (*usbRequestMemFree)(struct GADGET_CTRL *priv, void *usbRequest); +}; + +struct GADGET_OBJ { + int32_t (*gadget_init)(struct GADGET_CTRL *priv, struct GADGET_CFG *config, + struct GADGET_CALLBACKS *callbacks, struct device *pdev); + + void (*gadget_destroy)(struct GADGET_CTRL *priv); + + void (*gadget_start)(struct GADGET_CTRL *priv); + + void (*gadget_stop)(struct GADGET_CTRL *priv); + + void (*gadget_isr)(struct GADGET_CTRL *priv); + + int32_t (*gadget_epEnable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + const struct usb_endpoint_descriptor *desc); + + int32_t (*gadget_epDisable)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*gadget_epSetHalt)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, uint8_t value); + + int32_t (*gadget_epSetWedge)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*gadget_epFifoStatus)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + void (*gadget_epFifoFlush)(struct GADGET_CTRL *priv, struct GADGET_EP *ep); + + int32_t (*gadget_reqQueue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); + + int32_t (*gadget_reqDequeue)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); + + int32_t (*gadget_reqAlloc)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ **req); + + void (*gadget_reqFree)(struct GADGET_CTRL *priv, struct GADGET_EP *ep, + struct GADGET_REQ *req); + + void (*gadget_getDevInstance)(struct GADGET_CTRL *priv, struct GADGET_DEV **dev); + + int32_t (*gadget_dGetFrame)(struct GADGET_CTRL *priv, uint32_t *numOfFrame); + + int32_t (*gadget_dWakeUp)(struct GADGET_CTRL *priv); + + int32_t (*gadget_dSetSelfpowered)(struct GADGET_CTRL *priv); + + int32_t (*gadget_dClearSelfpowered)(struct GADGET_CTRL *priv); + + int32_t (*gadget_dVbusSession)(struct GADGET_CTRL *priv, uint8_t isActive); + + int32_t (*gadget_dVbusDraw)(struct GADGET_CTRL *priv, uint8_t mA); + + int32_t (*gadget_dPullUp)(struct GADGET_CTRL *priv, uint8_t isOn); + + void (*gadget_dGetConfigParams)(struct GADGET_CTRL *priv, + struct usb_dcd_config_params *configParams); +}; + +struct GADGET_CTRL { + struct device *dev; + struct GADGET_DEV gadgetDev; + struct HW_REGS *regs; + struct GADGET_OBJ *gadgetDrv; + struct GADGET_CFG gadgetCfg; + struct GADGET_CALLBACKS eventCallback; + struct GadgetEp in[16]; + struct GadgetEp out[16]; + enum GADGET_EP0_STAGE ep0State; + uint8_t isRemoteWakeup; + uint8_t isSelfPowered; + uint8_t deviceAddress; + struct DMA_OBJ *dmaDrv; + void *dmaController; + struct DMA_CFG dmaCfg; + struct DMA_CALLBACKS dmaCallback; + uint8_t releaseEp0Flag; + uint8_t isReady; + uint8_t *privBuffAddr; + uintptr_t privBuffDma; + uint8_t endpointInList; + uint8_t hostRequestFlag; + struct VHUB_REGS *phy_regs; +}; + +struct GadgetRequest { + struct GADGET_REQ request; + struct GadgetEp *ep; + struct GADGET_DEV *dev; + uint8_t zlp; +}; + +struct GADGET_OBJ *GADGET_GetInstance(void); + +#endif /* __LINUX_PHYTIUM_GADGET */ + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/host.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/host.c new file mode 100644 index 0000000000000000000000000000000000000000..8d58eaa99dd56bfa755a1174f435c89ad54a146d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/host.c @@ -0,0 +1,2780 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include +#include +#include +#include +//#include "list.h" +#include "core.h" +#include "dma.h" +#include "hw-regs.h" + +#define DRV_NAME "phytium_usb" + +#define HOST_GENERIC_EP_CONTROL 0x00 +#define HOST_GENERIC_EP_ISOC 0x01 +#define HOST_GENERIC_EP_BULK 0x02 +#define HOST_GENERIC_EP_INT 0x03 + +#define HOST_ESTALL 1 +#define HOST_EUNHANDLED 2 +#define HOST_EAUTOACK 3 +#define HOST_ESHUTDOWN 4 + +#define HOST_EP_NUM 16 + +static void dump_ep_remap_pool(struct HOST_CTRL *priv, bool dirIn) +{ + int index, dir = 0; + + if (!dirIn) + dir = 1; + + pr_info("%s dir endpoint remap table\n", dir ? "OUT" : "IN"); + + for (index = 1; index <= MAX_INSTANCE_EP_NUM; index++) + pr_info("ep_remap_pool[%d][%d]->%d\n", dir, index, + priv->ep_remap_pool[dir][index]); +} + +static int get_epnum_from_pool(struct HOST_CTRL *priv, int real_epNum, bool dirIn) +{ + int index, dir = 0; + int ret = 0; + + if (!priv || real_epNum == 0) + return 0; + + if (!dirIn) + dir = 1; + + for (index = 1; index <= MAX_INSTANCE_EP_NUM; index++) { + if (priv->ep_remap_pool[dir][index] == real_epNum) { + ret = index; + goto out; + } + } + + for (index = 1; index <= MAX_INSTANCE_EP_NUM; index++) { + if (!priv->ep_remap_pool[dir][index]) { + priv->ep_remap_pool[dir][index] = real_epNum; + ret = index; + goto out; + } + } + + if (index > MAX_INSTANCE_EP_NUM) + return index; + +out: + return ret; +} + +static int release_epnum_from_pool(struct HOST_CTRL *priv, int real_epNum, bool dirIn) +{ + int index = 0; + int dir = 0; + + if (!priv || real_epNum == 0) + return 0; + + if (!dirIn) + dir = 1; + + for (index = 1; index <= MAX_INSTANCE_EP_NUM; index++) { + if (priv->ep_remap_pool[dir][index] == real_epNum) { + priv->ep_remap_pool[dir][index] = 0; + + return 0; + } + } + + return 0; +} + +static inline struct HOST_REQ *getUsbRequestEntry(struct list_head *list) +{ + return (struct HOST_REQ *)((uintptr_t)list - (uintptr_t)&(((struct HOST_REQ *)0)->list)); +} + +static inline struct HOST_EP_PRIV *getUsbHEpPrivEntry(struct list_head *list) +{ + struct HOST_EP_PRIV *hostEpPriv; + + if (list_empty(list)) + return NULL; + + hostEpPriv = (struct HOST_EP_PRIV *)((uintptr_t)list - + (uintptr_t)&(((struct HOST_EP_PRIV *)0)->node)); + + return hostEpPriv; +} + +static struct HOST_REQ *getNextReq(struct HOST_EP *usbEp) +{ + struct list_head *queue; + + if (!usbEp) + return NULL; + + queue = &usbEp->reqList; + + if (list_empty(queue)) + return NULL; + + return getUsbRequestEntry(queue->next); +} + +static void host_SetVbus(struct HOST_CTRL *priv, uint8_t isOn) +{ + uint8_t otgctrl = phytium_read8(&priv->regs->otgctrl); + + if (isOn) { + if (!(otgctrl & OTGCTRL_BUSREQ) || (otgctrl & OTGCTRL_ABUSDROP)) { + otgctrl &= ~OTGCTRL_ABUSDROP; + otgctrl |= OTGCTRL_BUSREQ; + phytium_write8(&priv->regs->otgctrl, otgctrl); + } + priv->otgState = HOST_OTG_STATE_A_WAIT_BCON; + } else { + if ((otgctrl & OTGCTRL_BUSREQ) || (otgctrl & OTGCTRL_ABUSDROP)) { + otgctrl |= OTGCTRL_ABUSDROP; + otgctrl &= ~OTGCTRL_BUSREQ; + phytium_write8(&priv->regs->otgctrl, otgctrl); + } + priv->otgState = HOST_OTG_STATE_A_IDLE; + } +} + +static inline void disconnectHostDetect(struct HOST_CTRL *priv) +{ + uint8_t otgctrl, otgstate; + uint32_t gen_cfg; + + if (!priv) + return; + + otgctrl = phytium_read8(&priv->regs->otgctrl); + if ((otgctrl & OTGCTRL_ASETBHNPEN) && priv->otgState == HOST_OTG_STATE_A_SUSPEND) + pr_info("Device no Response\n"); + + phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); +retry: + otgstate = phytium_read8(&priv->regs->otgstate); + if ((otgstate == HOST_OTG_STATE_A_HOST || otgstate == HOST_OTG_STATE_B_HOST)) { + pr_info("IRQ OTG: DisconnIrq Babble\n"); + goto retry; + } + + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x04); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | 0 | 0x04); + + priv->portStatus = USB_PORT_STAT_POWER; + priv->portStatus |= USB_PORT_STAT_C_CONNECTION << 16; + + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + + if (priv->otgState == HOST_OTG_STATE_A_SUSPEND) + host_SetVbus(priv, 1); + + priv->otgState = HOST_OTG_STATE_A_IDLE; + if (priv->custom_regs) { + phytium_write32(&priv->custom_regs->wakeup, 1); + } else { + gen_cfg = phytium_read32(&priv->vhub_regs->gen_cfg); + gen_cfg |= BIT(1); + phytium_write32(&priv->vhub_regs->gen_cfg, gen_cfg); + } +} + +static inline void A_IdleDetect(struct HOST_CTRL *priv, uint8_t otgstate) +{ + uint8_t otgctrl; + + if (!priv) + return; + + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); + + if (otgstate != HOST_OTG_STATE_A_IDLE) { + pr_info("IRQ OTG: A_IDLE Babble\n"); + return; + } + + priv->portStatus = 0; + otgctrl = phytium_read8(&priv->regs->otgctrl); + otgctrl &= ~OTGCTRL_ASETBHNPEN; + phytium_write8(&priv->regs->otgctrl, otgctrl); + + host_SetVbus(priv, 1); + + priv->otgState = HOST_OTG_STATE_A_IDLE; +} + +static inline void B_IdleDetect(struct HOST_CTRL *priv, uint8_t otgstate) +{ + uint8_t otgctrl, usbcs; + + if (!priv) + return; + + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); + + if (otgstate != HOST_OTG_STATE_B_IDLE) { + pr_info("IRQ OTG: B_IDLE Babble\n"); + return; + } + + otgctrl = phytium_read8(&priv->regs->otgctrl); + otgctrl &= ~OTGCTRL_ASETBHNPEN; + phytium_write8(&priv->regs->otgctrl, otgctrl); + + host_SetVbus(priv, 0); + + priv->otgState = HOST_OTG_STATE_B_IDLE; + + usbcs = phytium_read8(&priv->regs->usbcs); + usbcs &= ~USBCS_DISCON; + phytium_write8(&priv->regs->usbcs, usbcs); +} + +static uint32_t waitForBusyBit(struct HOST_CTRL *priv, struct HostEp *hwEp) +{ + uint8_t *csReg; + uint8_t flag = CS_BUSY; + uint8_t buf = 0; + uint8_t val = CS_BUSY; + uint8_t otgstate; + uint8_t bufflag = 0; + + if (!priv || !hwEp) + return 0; + + if (hwEp->isInEp) + return 0; + + if (hwEp->hwEpNum == 0) { + csReg = &priv->regs->ep0cs; + flag = EP0CS_TXBUSY_MASK; + buf = 0; + } else { + csReg = &priv->regs->ep[hwEp->hwEpNum - 1].txcs; + buf = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon) & CON_BUF; + } + + while ((val & flag) || bufflag == 0) { + otgstate = phytium_read8(&priv->regs->otgstate); + if (otgstate != HOST_OTG_STATE_B_HOST && otgstate != HOST_OTG_STATE_A_HOST) { + priv->ep0State = HOST_EP0_STAGE_IDLE; + return HOST_ESHUTDOWN; + } + + val = phytium_read8(csReg); + if (((val & CS_NPAK) >> CS_NPAK_OFFSET) == buf || buf == 0) + bufflag = 1; + else + bufflag = 0; + } + + return 0; +} + +static inline void connectHostDetect(struct HOST_CTRL *priv, uint8_t otgState) +{ + uint32_t gen_cfg; + + if (!priv) + return; + + memset(priv->ep_remap_pool, 0, sizeof(priv->ep_remap_pool)); + pr_debug("otgState:0x%x pirv->otgState:0x%x\n", otgState, priv->otgState); + if (priv->custom_regs) { + phytium_write32(&priv->custom_regs->wakeup, 0); + } else { + gen_cfg = phytium_read32(&priv->vhub_regs->gen_cfg); + gen_cfg &= ~BIT(1); + phytium_write32(&priv->vhub_regs->gen_cfg, gen_cfg); + } + + phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); + + if ((otgState != HOST_OTG_STATE_A_HOST) && (otgState != HOST_OTG_STATE_B_HOST)) + return; + + if ((priv->otgState == HOST_OTG_STATE_A_PERIPHERAL) + || (priv->otgState == HOST_OTG_STATE_B_PERIPHERAL)) + priv->otgState = otgState; + + priv->ep0State = HOST_EP0_STAGE_IDLE; + + priv->portStatus &= ~(USB_PORT_STAT_LOW_SPEED | USB_PORT_STAT_HIGH_SPEED | + USB_PORT_STAT_ENABLE); + + priv->portStatus |= USB_PORT_STAT_C_CONNECTION | (USB_PORT_STAT_C_CONNECTION << 16); + priv->dmaDrv->dma_controllerReset(priv->dmaController); + priv->port_resetting = 1; + host_SetVbus(priv, 1); + + switch (phytium_read8(&priv->regs->speedctrl)) { + case SPEEDCTRL_HS: + priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; + pr_debug("detect High speed device\n"); + break; + case SPEEDCTRL_FS: + priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); + pr_debug("detect Full speed device\n"); + break; + case SPEEDCTRL_LS: + priv->portStatus |= USB_PORT_STAT_LOW_SPEED; + pr_debug("detect Low speed device\n"); + break; + } + + priv->vBusErrCnt = 0; + priv->dmaDrv->dma_setHostMode(priv->dmaController); + + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + + priv->otgState = otgState; +} + +static void hostOtgIrq(struct HOST_CTRL *priv) +{ + uint8_t otgirq, otgien; + uint8_t otgstatus, otgstate; + uint8_t otgctrl; + + if (!priv) + return; + + otgirq = phytium_read8(&priv->regs->otgirq); + otgien = phytium_read8(&priv->regs->otgien); + otgstatus = phytium_read8(&priv->regs->otgstatus); + otgstate = phytium_read8(&priv->regs->otgstate); + otgirq &= otgien; + + if (!otgirq) + return; + + if (otgirq & OTGIRQ_BSE0SRPIRQ) { + otgirq &= ~OTGIRQ_BSE0SRPIRQ; + phytium_write8(&priv->regs->otgirq, OTGIRQ_BSE0SRPIRQ); + + otgctrl = phytium_read8(&priv->regs->otgctrl); + otgctrl &= ~OTGIRQ_BSE0SRPIRQ; + phytium_write8(&priv->regs->otgctrl, otgctrl); + } + + if (otgirq & OTGIRQ_SRPDETIRQ) { + otgirq &= ~OTGIRQ_SRPDETIRQ; + phytium_write8(&priv->regs->otgirq, OTGIRQ_SRPDETIRQ); + + otgctrl = phytium_read8(&priv->regs->otgctrl); + otgctrl &= ~OTGIRQ_SRPDETIRQ; + phytium_write8(&priv->regs->otgctrl, otgctrl); + } + + if (otgirq & OTGIRQ_VBUSERRIRQ) { + otgirq &= ~OTGIRQ_VBUSERRIRQ; + phytium_write8(&priv->regs->otgirq, OTGIRQ_VBUSERRIRQ); + + if (otgstate != HOST_OTG_STATE_A_VBUS_ERR) { + pr_info("IRQ OTG: VBUS ERROR Babble\n"); + return; + } + + host_SetVbus(priv, 0); + priv->otgState = HOST_OTG_STATE_A_VBUS_ERR; + if (priv->portStatus & USB_PORT_STAT_CONNECTION) { + priv->portStatus = USB_PORT_STAT_POWER | (USB_PORT_STAT_C_CONNECTION << 16); + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + return; + } + + if (priv->vBusErrCnt >= 3) { + priv->vBusErrCnt = 0; + pr_info("%s %d VBUS OVER CURRENT\n", __func__, __LINE__); + priv->portStatus |= USB_PORT_STAT_OVERCURRENT | + (USB_PORT_STAT_C_OVERCURRENT << 16); + + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); + } else { + priv->vBusErrCnt++; + host_SetVbus(priv, 1); + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); + } + } + + if (otgirq & OTGIRQ_CONIRQ) { + if (priv->otgState == HOST_OTG_STATE_A_HOST || + priv->otgState == HOST_OTG_STATE_B_HOST || + priv->otgState == HOST_OTG_STATE_A_SUSPEND) { + if (otgstate == HOST_OTG_STATE_A_WAIT_VFALL || + otgstate == HOST_OTG_STATE_A_WAIT_BCON || + otgstate == HOST_OTG_STATE_A_SUSPEND) + disconnectHostDetect(priv); + } else if (priv->otgState != HOST_OTG_STATE_A_HOST && + priv->otgState != HOST_OTG_STATE_B_HOST && + priv->otgState != HOST_OTG_STATE_A_SUSPEND) + connectHostDetect(priv, otgstate); + + phytium_write8(&priv->regs->otgirq, OTGIRQ_CONIRQ); + } + + if (otgirq & OTGIRQ_IDLEIRQ) { + if (!(otgstatus & OTGSTATUS_ID)) + A_IdleDetect(priv, otgstate); + else + B_IdleDetect(priv, otgstate); + } + + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDCHANGEIRQ | + OTGIRQ_SRPDETIRQ); +} + +static void hostErrorIrq(struct HOST_CTRL *priv) +{ + uint16_t txerrirq, txerrien; + uint16_t rxerrirq, rxerrien; + uint16_t i, mask; + + if (!priv) + return; + + txerrirq = phytium_read16(&priv->regs->txerrirq); + txerrien = phytium_read16(&priv->regs->txerrien); + txerrirq &= txerrien; + + rxerrirq = phytium_read16(&priv->regs->rxerrirq); + rxerrien = phytium_read16(&priv->regs->rxerrien); + rxerrirq &= rxerrirq; + if (!txerrirq && !rxerrirq) + return; + + for (i = 0; i < HOST_EP_NUM; i++) { + mask = 1 << i; + if (rxerrirq & mask) { + phytium_write16(&priv->regs->rxerrirq, mask); + rxerrien &= ~mask; + phytium_write16(&priv->regs->rxerrien, rxerrien); + priv->dmaDrv->dma_errIsr(priv->dmaController, i, 0); + } + + if (txerrirq & mask) { + phytium_write16(&priv->regs->txerrirq, mask); + txerrien &= ~mask; + phytium_write16(&priv->regs->txerrien, txerrien); + priv->dmaDrv->dma_errIsr(priv->dmaController, i, 1); + } + } +} + +static uint32_t decodeErrorCode(uint8_t code) +{ + uint32_t status = 0; + + switch (code) { + case ERR_NONE: + status = 0; + break; + case ERR_CRC: + pr_info("CRC Error\n"); + status = HOST_ESHUTDOWN; + break; + case ERR_DATA_TOGGLE_MISMATCH: + pr_info("Toggle MisMatch Error\n"); + status = HOST_ESHUTDOWN; + break; + case ERR_STALL: + pr_debug("Stall Error\n"); + status = HOST_ESTALL; + break; + case ERR_TIMEOUT: + pr_debug("Timeout Error\n"); + status = HOST_ESHUTDOWN; + break; + case ERR_PID: + pr_info("PID Error\n"); + status = HOST_ESHUTDOWN; + break; + case ERR_TOO_LONG_PACKET: + pr_info("TOO_LONG_PACKET Error\n"); + status = HOST_ESHUTDOWN; + break; + case ERR_DATA_UNDERRUN: + pr_info("UNDERRUN Error\n"); + status = HOST_ESHUTDOWN; + break; + } + + return status; +} + +static struct HOST_EP_PRIV *getIntTransfer(struct list_head *head) +{ + struct list_head *listEntry = NULL; + struct HOST_EP_PRIV *usbHEpPriv = NULL; + struct HOST_EP_PRIV *usbHEpPrivActual = NULL; + + list_for_each(listEntry, head) { + usbHEpPriv = getUsbHEpPrivEntry(listEntry); + if (!usbHEpPrivActual) + usbHEpPrivActual = usbHEpPriv; + + if (usbHEpPriv->frame < usbHEpPrivActual->frame) + usbHEpPrivActual = usbHEpPriv; + } + + return usbHEpPrivActual; +} + +static void givebackRequest(struct HOST_CTRL *priv, struct HOST_REQ *usbReq, uint32_t status) +{ + if (!priv || !usbReq) + return; + + list_del(&usbReq->list); + + if (usbReq->status == EINPROGRESS) + usbReq->status = status; + + if (priv->hostCallbacks.givebackRequest) + priv->hostCallbacks.givebackRequest(priv, usbReq, status); +} + +static void hostEpProgram(struct HOST_CTRL *priv, struct HostEp *hwEp, + struct HOST_REQ *usbReq, uintptr_t dmaBuff, uint32_t length) +{ + struct HOST_EP *usbHEp; + struct HOST_EP_PRIV *usbEpPriv; + uint32_t chMaxLen; + uint8_t regCon = 0; + uint8_t ep0cs; + uint16_t txerrien = 0; + uint16_t rxerrien = 0; + uint32_t result; + uint8_t txsoftimer, rxsoftimer; + u8 retval = 0; + + if (!priv || !hwEp || !usbReq) + return; + + usbHEp = hwEp->scheduledUsbHEp; + usbEpPriv = (struct HOST_EP_PRIV *)usbHEp->hcPriv; + + if (!hwEp->channel) { + if (usbEpPriv->type == USB_ENDPOINT_XFER_ISOC) + hwEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, + !hwEp->isInEp, hwEp->hwEpNum, 1); + else + hwEp->channel = priv->dmaDrv->dma_channelAlloc(priv->dmaController, + !hwEp->isInEp, hwEp->hwEpNum, 0); + } + + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, hwEp->channel); + + pr_debug("chMaxLen:0x%x buffLength:0x%x\n", chMaxLen, usbReq->buffLength); + if (usbReq->buffLength > chMaxLen) + length = chMaxLen; + + switch (usbEpPriv->type) { + case USB_ENDPOINT_XFER_CONTROL: + regCon = CON_TYPE_CONTROL; + break; + case USB_ENDPOINT_XFER_BULK: + regCon = CON_TYPE_BULK; + break; + case USB_ENDPOINT_XFER_INT: + regCon = CON_TYPE_INT; + break; + case USB_ENDPOINT_XFER_ISOC: + if (usbEpPriv->isocEpConfigured) + goto dma_program; + + usbEpPriv->isocEpConfigured = 1; + regCon = CON_TYPE_ISOC; + switch (usbHEp->desc.wMaxPacketSize >> 11) { + case 0: + regCon |= CON_TYPE_ISOC_1_ISOD; + priv->dmaDrv->dma_setMaxLength(priv->dmaController, + hwEp->channel, usbEpPriv->maxPacketSize); + break; + case 1: + regCon |= CON_TYPE_ISOC_2_ISOD; + priv->dmaDrv->dma_setMaxLength(priv->dmaController, + hwEp->channel, 2 * 1024); + break; + case 2: + priv->dmaDrv->dma_setMaxLength(priv->dmaController, + hwEp->channel, 3 * 1024); + regCon |= CON_TYPE_ISOC_3_ISOD; + break; + } + break; + } + + if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { + if (!hwEp->hwEpNum) { + if (phytium_read8(&priv->regs->ep0cs) & 0x4) { + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | + 0 | 0x4); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | + FIFOCTRL_IO_TX | 0 | 0x4); + } + } + if (waitForBusyBit(priv, hwEp) > 0) { + usbReq->status = HOST_ESHUTDOWN; + givebackRequest(priv, usbReq, HOST_ESHUTDOWN); + pr_info("something error happen\n"); + return; + } + } + + if (!hwEp->isInEp) { + if (hwEp->hwEpNum) { + regCon |= hwEp->hwBuffers - 1; + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, regCon); + if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { + retval = priv->hostCallbacks.getEpToggle(priv, + usbReq->usbDev, usbHEp->device_epNum, 0); + if (retval) { + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_IO_TX); + + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_TOGSETQ | ENDPRST_IO_TX | ENDPRST_FIFORST); + } else { + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_IO_TX); + + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_TOGRST | ENDPRST_IO_TX | ENDPRST_FIFORST); + } + } + + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, regCon | CON_VAL); + phytium_write16(&priv->regs->txmaxpack[hwEp->hwEpNum - 1], + usbEpPriv->maxPacketSize); + + phytium_write8(&priv->regs->epExt[hwEp->hwEpNum - 1].txctrl, + usbHEp->device_epNum); + + phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); + + // if (usbEpPriv->type == USB_ENDPOINT_XFER_INT) + txsoftimer = phytium_read8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl); + txsoftimer = txsoftimer | BIT(1); + phytium_write8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl, txsoftimer); + + phytium_write16(&priv->regs->txsoftimer[hwEp->hwEpNum].timer, + usbEpPriv->frame); + + phytium_write8(&priv->regs->txsoftimer[hwEp->hwEpNum].ctrl, 0x83); + } else { + phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); + phytium_write8(&priv->regs->ep0maxpack, usbEpPriv->maxPacketSize); + phytium_write8(&priv->regs->ep0ctrl, usbEpPriv->epNum); + + if (priv->ep0State == HOST_EP0_STAGE_SETUP) { + ep0cs = phytium_read8(&priv->regs->ep0cs); + ep0cs |= EP0CS_HCSET; + phytium_write8(&priv->regs->ep0cs, ep0cs); + } + } + + phytium_write16(&priv->regs->txerrirq, 1 << hwEp->hwEpNum); + txerrien = phytium_read16(&priv->regs->txerrien); + txerrien |= 1 << hwEp->hwEpNum; + phytium_write16(&priv->regs->txerrien, txerrien); + } else { + if (hwEp->hwEpNum) { + regCon |= hwEp->hwBuffers - 1; + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, regCon); + + if (usbEpPriv->type != USB_ENDPOINT_XFER_ISOC) { + if (priv->hostCallbacks.getEpToggle) { + retval = priv->hostCallbacks.getEpToggle(priv, + usbReq->usbDev, usbHEp->device_epNum, 1); + if (retval) { + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_TOGSETQ | ENDPRST_FIFORST); + } else { + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | + ENDPRST_TOGRST | ENDPRST_FIFORST); + } + } + } + + phytium_write16(&priv->regs->rxmaxpack[hwEp->hwEpNum - 1], + usbEpPriv->maxPacketSize); + + phytium_write8(&priv->regs->epExt[hwEp->hwEpNum - 1].rxctrl, + usbHEp->device_epNum); + + phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); + + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcs, 1); + + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, regCon | CON_VAL); + rxsoftimer = phytium_read8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl); + rxsoftimer = rxsoftimer | BIT(1); + phytium_write8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl, rxsoftimer); + + phytium_write16(&priv->regs->rxsoftimer[hwEp->hwEpNum].timer, + usbEpPriv->frame); + + phytium_write8(&priv->regs->rxsoftimer[hwEp->hwEpNum].ctrl, 0x83); + } else { + phytium_write8(&priv->regs->fnaddr, usbEpPriv->faddress); + phytium_write8(&priv->regs->ep0maxpack, usbEpPriv->maxPacketSize); + phytium_write8(&priv->regs->ep0ctrl, usbEpPriv->epNum); + + if (priv->ep0State == HOST_EP0_STAGE_IN + || priv->ep0State == HOST_EP0_STAGE_STATUSIN) + phytium_write8(&priv->regs->ep0cs, EP0CS_HCSETTOGGLE); + } + + phytium_write16(&priv->regs->rxerrirq, 1 << hwEp->hwEpNum); + rxerrien = phytium_read16(&priv->regs->rxerrien); + rxerrien |= 1 << hwEp->hwEpNum; + phytium_write16(&priv->regs->rxerrien, rxerrien); + } +dma_program: + result = priv->dmaDrv->dma_channelProgram(priv->dmaController, hwEp->channel, + usbEpPriv->maxPacketSize, dmaBuff, length, + (void *)usbReq->isoFramesDesc, usbReq->isoFramesNumber); + if (result) { + if (!hwEp->isInEp) { + txerrien &= ~(1 << hwEp->hwEpNum); + if (hwEp->hwEpNum) + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, 0x08); + phytium_write16(&priv->regs->txerrien, txerrien); + } else { + rxerrien &= ~(1 << hwEp->hwEpNum); + if (hwEp->hwEpNum) + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, 0x08); + phytium_write16(&priv->regs->rxerrien, rxerrien); + } + + priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); + hwEp->channel = NULL; + } +} + +static void hostStartReq(struct HOST_CTRL *priv, struct HOST_REQ *req) +{ + uintptr_t dmaBuff; + uint32_t length; + struct HOST_EP *hostEp; + struct HOST_EP_PRIV *hostEpPriv; + struct HOST_EP_PRIV *hostNewEpPriv; + struct HOST_REQ *usbReq = NULL; + struct HostEp *hwEp = NULL; + int num; + + if (!priv || !req) + return; + + hostEp = req->hcPriv; + if (hostEp) { + hostEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; + if (hostEpPriv) { + hostEpPriv->genericHwEp->state = HOST_EP_BUSY; + switch (hostEpPriv->type) { + case USB_ENDPOINT_XFER_CONTROL: + usbReq = getNextReq(hostEp); + + priv->in[HOST_GENERIC_EP_CONTROL].scheduledUsbHEp = hostEp; + priv->ep0State = HOST_EP0_STAGE_SETUP; + hostEpPriv->currentHwEp = hostEpPriv->genericHwEp; + hostEpPriv->genericHwEp->scheduledUsbHEp = hostEp; + dmaBuff = usbReq->setupDma; + length = 8; + pr_debug("packet info: %02x %02x %04x %04x %04x\n", + usbReq->setup->bRequestType, + usbReq->setup->bRequest, + usbReq->setup->wValue, + usbReq->setup->wIndex, + usbReq->setup->wLength); + hostEpProgram(priv, hostEpPriv->genericHwEp, + usbReq, dmaBuff, length); + break; + case USB_ENDPOINT_XFER_BULK: + hwEp = hostEpPriv->genericHwEp; + usbReq = getNextReq(hostEp); + hostEpPriv->currentHwEp = hwEp; + hwEp->scheduledUsbHEp = hostEp; + dmaBuff = usbReq->buffDma + usbReq->actualLength; + length = usbReq->buffLength - usbReq->actualLength; + hostEpProgram(priv, hwEp, usbReq, dmaBuff, length); + break; + case USB_ENDPOINT_XFER_INT: + if (hostEpPriv->genericHwEp->scheduledUsbHEp) + return; + + num = req->epNum - 1; + if (hostEpPriv->isIn) + hostNewEpPriv = getIntTransfer(&priv->intInHEpQueue[num]); + else + hostNewEpPriv = getIntTransfer(&priv->intOutHEpQueue[num]); + + hostNewEpPriv->currentHwEp = hostEpPriv->genericHwEp; + hostEpPriv->genericHwEp->scheduledUsbHEp = hostNewEpPriv->usbHEp; + usbReq = getNextReq(hostEp); + dmaBuff = usbReq->buffDma + usbReq->actualLength; + length = usbReq->buffLength - usbReq->actualLength; + hostEpProgram(priv, hostEpPriv->genericHwEp, + usbReq, dmaBuff, length); + break; + case USB_ENDPOINT_XFER_ISOC: + hostEpPriv->currentHwEp = hostEpPriv->genericHwEp; + hostEpPriv->genericHwEp->scheduledUsbHEp = hostEp; + dmaBuff = req->buffDma + req->actualLength; + length = req->buffLength - req->actualLength; + hostEpProgram(priv, hostEpPriv->genericHwEp, req, dmaBuff, length); + break; + } + } + } +} + +static void abortTransfer(struct HOST_CTRL *priv, + struct HOST_REQ *usbReq, struct HostEp *hwEp) +{ + struct HOST_EP *usbEp; + struct HOST_EP_PRIV *usbHEpPriv; + uint32_t status; + + if (!priv || !usbReq || !hwEp || !hwEp->scheduledUsbHEp) + return; + + usbEp = hwEp->scheduledUsbHEp; + usbHEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; + if (!usbHEpPriv) + return; + + status = (usbReq->status == EINPROGRESS) ? 0 : usbReq->status; + givebackRequest(priv, usbReq, status); + + if (list_empty(&usbEp->reqList)) { + usbHEpPriv->epIsReady = 0; + usbHEpPriv->currentHwEp = NULL; + hwEp->scheduledUsbHEp = NULL; + + if (hwEp->channel) { + priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); + hwEp->channel = NULL; + } + + if (usb_endpoint_xfer_int(&usbEp->desc)) + list_del(&usbHEpPriv->node); + } +} + +static void scheduleNextTransfer(struct HOST_CTRL *priv, + struct HOST_REQ *usbReq, struct HostEp *hwEp) +{ + struct HOST_EP *usbEp; + struct HOST_EP_PRIV *usbHEpPriv; + uint8_t endprst; + uint32_t status; + struct HOST_REQ *usbNextReq = NULL; + + if (!priv || !usbReq || !hwEp) + return; + + usbEp = hwEp->scheduledUsbHEp; + usbHEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; + if (!usbHEpPriv) + return; + + status = (usbReq->status == EINPROGRESS) ? 0 : usbReq->status; + switch (usbHEpPriv->type) { + case USB_ENDPOINT_XFER_BULK: + case USB_ENDPOINT_XFER_INT: + if (hwEp->isInEp) { + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum); + endprst = (phytium_read8(&priv->regs->endprst) & ENDPRST_TOGSETQ) ? 1 : 0; + if (priv->hostCallbacks.setEpToggle) + priv->hostCallbacks.setEpToggle(priv, usbReq->usbDev, + usbEp->device_epNum, usbHEpPriv->isIn, endprst); + } else { + if (waitForBusyBit(priv, hwEp) > 0) { + usbReq->status = HOST_ESHUTDOWN; + givebackRequest(priv, usbReq, HOST_ESHUTDOWN); + return; + } + + phytium_write8(&priv->regs->endprst, hwEp->hwEpNum | ENDPRST_IO_TX); + endprst = (phytium_read8(&priv->regs->endprst) & ENDPRST_TOGSETQ) ? 1 : 0; + if (priv->hostCallbacks.setEpToggle) + priv->hostCallbacks.setEpToggle(priv, usbReq->usbDev, + usbEp->device_epNum, usbHEpPriv->isIn, endprst); + } + break; + } + + if (usbHEpPriv->transferFinished) + givebackRequest(priv, usbReq, status); + + if (list_empty(&usbEp->reqList)) { + if (usbHEpPriv->type == USB_ENDPOINT_XFER_CONTROL) + hwEp->state = HOST_EP_ALLOCATED; + else { + if (usbHEpPriv->genericHwEp == hwEp) + hwEp->state = HOST_EP_ALLOCATED; + else + hwEp->state = HOST_EP_FREE; + } + + usbHEpPriv->epIsReady = 0; + usbHEpPriv->currentHwEp = NULL; + hwEp->scheduledUsbHEp = NULL; + + if (hwEp->channel) { + priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); + hwEp->channel = NULL; + } + + if (usb_endpoint_xfer_int(&usbEp->desc)) + list_del(&usbHEpPriv->node); + usbHEpPriv = NULL; + } else { + if (usbHEpPriv->type == USB_ENDPOINT_XFER_INT) { + usbHEpPriv->currentHwEp = NULL; + hwEp->scheduledUsbHEp = NULL; + } + + if (usbHEpPriv->type == USB_ENDPOINT_XFER_ISOC) + return; + } + + if (usbHEpPriv) { + usbNextReq = getNextReq(usbHEpPriv->usbHEp); + hostStartReq(priv, usbNextReq); + } +} + +static int32_t hostEp0Irq(struct HOST_CTRL *priv, uint8_t isIn) +{ + struct HostEp *hwEp; + struct HOST_EP *hostEp; + struct HOST_REQ *usbReq = NULL; + struct HOST_EP_PRIV *usbHEpPriv; + uint32_t status, length; + uint8_t usbError; + uint8_t nextStage = 0; + int ret = 0; + + if (!priv) + return 0; + + hwEp = isIn ? &priv->in[HOST_GENERIC_EP_CONTROL] : &priv->out[HOST_GENERIC_EP_CONTROL]; + hostEp = hwEp->scheduledUsbHEp; + usbHEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; + + usbReq = getNextReq(hostEp); + if (!usbReq) + return 0; + + usbError = isIn ? phytium_read8(&priv->regs->rx0err) : phytium_read8(&priv->regs->tx0err); + usbError = (usbError & ERR_TYPE) >> 2; + status = decodeErrorCode(usbError); + if (status) { + usbReq->status = status; + + if (status == HOST_ESTALL) { + ret = 1; + priv->dmaDrv->dma_controllerReset(priv->dmaController); + } + + phytium_write16(&priv->regs->rxerrirq, 1 << hwEp->hwEpNum); + phytium_write16(&priv->regs->txerrirq, 1 << hwEp->hwEpNum); + + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x4); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | + FIFOCTRL_IO_TX | 0 | 0x4); + } + + length = priv->dmaDrv->dma_getActualLength(priv->dmaController, hwEp->channel); + priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); + hwEp->channel = NULL; + + if (usbReq->status == EINPROGRESS && priv->ep0State < HOST_EP0_STAGE_STATUSIN) { + nextStage = 0; + switch (priv->ep0State) { + case HOST_EP0_STAGE_IN: + pr_debug("Ep0 Data IN\n"); + usbHEpPriv->currentHwEp = &priv->out[HOST_GENERIC_EP_CONTROL]; + usbReq->actualLength = length; + priv->ep0State = HOST_EP0_STAGE_STATUSOUT; + break; + case HOST_EP0_STAGE_OUT: + pr_debug("Ep0 Data OUT\n"); + usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROL]; + usbReq->actualLength = length; + priv->ep0State = HOST_EP0_STAGE_STATUSIN; + break; + case HOST_EP0_STAGE_SETUP: + pr_debug("Ep0 Stage Setup\n"); + if (!usbReq->setup->wLength) { + pr_debug("EP0_STAGE_STATUSIN\n"); + priv->ep0State = HOST_EP0_STAGE_STATUSIN; + usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROL]; + break; + } else if (usbReq->setup->bRequestType & USB_DIR_IN) { + pr_debug("EP0_STAGE_STAGE_IN\n"); + priv->ep0State = HOST_EP0_STAGE_IN; + usbHEpPriv->currentHwEp = &priv->in[HOST_GENERIC_EP_CONTROL]; + nextStage = 1; + break; + } + priv->ep0State = HOST_EP0_STAGE_OUT; + nextStage = 1; + break; + case HOST_EP0_STAGE_STATUSIN: + case HOST_EP0_STAGE_STATUSOUT: + case HOST_EP0_STAGE_ACK: + case HOST_EP0_STAGE_IDLE: + default: + pr_debug("EP0 STAGE is %d\n", priv->ep0State); + break; + } + + if (nextStage) { + length = usbReq->buffLength; + hostEpProgram(priv, usbHEpPriv->currentHwEp, usbReq, + usbReq->buffDma, length); + } else + hostEpProgram(priv, usbHEpPriv->currentHwEp, usbReq, usbReq->setupDma, 0); + } else + priv->ep0State = HOST_EP0_STAGE_IDLE; + + if (priv->ep0State == HOST_EP0_STAGE_IDLE || usbReq->status != EINPROGRESS) { + usbHEpPriv->transferFinished = 1; + scheduleNextTransfer(priv, usbReq, hwEp); + } + + return ret; +} + +static void updateTimeIntTransfer(struct list_head *head, struct HOST_EP_PRIV *lastFinished) +{ + struct list_head *listEntry = NULL; + struct HOST_EP_PRIV *usbHEpPriv = NULL; + uint16_t time = lastFinished->frame; + + list_for_each(listEntry, head) { + usbHEpPriv = getUsbHEpPrivEntry(listEntry); + if (usbHEpPriv == lastFinished) { + lastFinished->frame = lastFinished->interval; + continue; + } + + if (usbHEpPriv->frame < time) + usbHEpPriv->frame = 0; + else + lastFinished->interval = usbHEpPriv->frame; + } +} + +static int32_t hostEpXIrq(struct HOST_CTRL *priv, uint8_t hwEpNum, uint8_t isIn, bool resubmit) +{ + struct HostEp *hwEp; + struct HOST_EP *hostEp; + struct HOST_EP_PRIV *usbHEpPriv; + struct HOST_REQ *usbReq; + + uint8_t usbError, rxcon, txcon; + uint32_t status, length, chMaxLen; + + if (!priv) + return -EINVAL; + + hwEp = isIn ? &priv->in[hwEpNum] : &priv->out[hwEpNum]; + hostEp = hwEp->scheduledUsbHEp; + if (!hostEp) + return -EINVAL; + + usbHEpPriv = (struct HOST_EP_PRIV *)hostEp->hcPriv; + + usbReq = getNextReq(hostEp); + if (!usbReq) + return 0; + + if (isIn) + usbError = phytium_read8(&priv->regs->epExt[hwEpNum - 1].rxerr); + else + usbError = phytium_read8(&priv->regs->epExt[hwEpNum - 1].txerr); + + usbError = (usbError & ERR_TYPE) >> 2; + status = decodeErrorCode(usbError); + if (status) { + pr_debug("%s %d Aborting\n", __func__, __LINE__); + if (isIn) + phytium_write16(&priv->regs->rxerrirq, 1 << hwEpNum); + else + phytium_write16(&priv->regs->txerrirq, 1 << hwEpNum); + priv->dmaDrv->dma_channelAbort(priv->dmaController, hwEp->channel); + } + + length = priv->dmaDrv->dma_getActualLength(priv->dmaController, hwEp->channel); + chMaxLen = priv->dmaDrv->dma_getMaxLength(priv->dmaController, hwEp->channel); + + if (status != 0) + usbReq->status = status; + + usbReq->actualLength += length; + + if (!resubmit) + usbHEpPriv->transferFinished = 1; + + if (length == chMaxLen) { + if ((usbReq->buffLength - usbReq->actualLength) == 0) + usbHEpPriv->transferFinished = 1; + else + usbHEpPriv->transferFinished = 0; + } + + if (usbHEpPriv->type != USB_ENDPOINT_XFER_ISOC) { + if (!hwEp->isInEp) { + txcon = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon); + txcon &= ~CON_VAL; + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].txcon, txcon); + } else { + rxcon = phytium_read8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon); + rxcon &= ~CON_VAL; + phytium_write8(&priv->regs->ep[hwEp->hwEpNum - 1].rxcon, rxcon); + } + priv->dmaDrv->dma_channelRelease(priv->dmaController, hwEp->channel); + hwEp->channel = NULL; + } + + if (usbHEpPriv->type == USB_ENDPOINT_XFER_INT) { + if (usbHEpPriv->isIn) + updateTimeIntTransfer(&priv->intInHEpQueue[hwEp->hwEpNum - 1], usbHEpPriv); + else + updateTimeIntTransfer(&priv->intOutHEpQueue[hwEp->hwEpNum - 1], usbHEpPriv); + } + + scheduleNextTransfer(priv, usbReq, hwEp); + + return 0; +} + + +static void host_CallbackTransfer(void *priv, uint8_t epNum, uint8_t isDirTx, bool resubmit) +{ + struct HOST_CTRL *host_priv = (struct HOST_CTRL *)priv; + int i; + int ret = 0; + + if (!epNum) { + ret = hostEp0Irq(host_priv, !isDirTx); + if (resubmit | ret) { + for (i = 1; i < HOST_EP_NUM; i++) { + hostEpXIrq(host_priv, i, !isDirTx, true); + hostEpXIrq(host_priv, i, isDirTx, true); + } + } + } else + hostEpXIrq(host_priv, epNum, !isDirTx, false); +} + +static int hc_reset(struct usb_hcd *hcd) +{ + hcd->speed = HCD_USB2; + hcd->self.root_hub->speed = USB_SPEED_HIGH; + + return 0; +} + +static int hc_start(struct usb_hcd *hcd) +{ + hcd->state = HC_STATE_RUNNING; + return 0; +} + +static void hc_stop(struct usb_hcd *hcd) +{ + struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; + + if (config) + config->host_obj->host_stop(config->host_priv); + + if (config->host_cfg.trbAddr) { + dma_free_coherent(config->dev, config->host_sysreq.trbMemSize, + config->host_cfg.trbAddr, config->host_cfg.trbDmaAddr); + config->host_cfg.trbAddr = NULL; + } + + if (config->host_priv) { + devm_kfree(config->dev, config->host_priv); + config->host_priv = NULL; + } + + hcd->state = HC_STATE_HALT; +} + +static void hc_shutdown(struct usb_hcd *hcd) +{ +} + +static void host_endpoint_update(struct phytium_cusb *config, + struct HOST_USB_DEVICE *udev, struct usb_host_endpoint *ep) +{ + int epnum; + struct HOST_EP *hostEp; + + if (!config || !udev || !ep) + return; + + epnum = get_epnum_from_pool(config->host_priv, usb_endpoint_num(&ep->desc), + usb_endpoint_dir_in(&ep->desc)); + + if (usb_endpoint_dir_out(&ep->desc)) { + if (udev->out_ep[epnum] == NULL) { + hostEp = kzalloc(sizeof(struct HOST_EP) + + config->host_obj->host_epGetPrivateDataSize(config->host_priv), + GFP_ATOMIC); + udev->out_ep[epnum] = hostEp; + } else + hostEp = udev->out_ep[epnum]; + } else { + if (udev->in_ep[epnum] == NULL) { + hostEp = kzalloc(sizeof(struct HOST_EP) + + config->host_obj->host_epGetPrivateDataSize(config->host_priv), + GFP_ATOMIC); + udev->in_ep[epnum] = hostEp; + } else + hostEp = udev->in_ep[epnum]; + } + + hostEp->desc = *(struct usb_endpoint_descriptor *)(&ep->desc); + hostEp->userExt = (void *)ep; + INIT_LIST_HEAD(&hostEp->reqList); + hostEp->hcPriv = &((uint8_t *)hostEp)[sizeof(struct HOST_EP)]; +} + +static int hc_urb_enqueue(struct usb_hcd *hcd, struct urb *urb, gfp_t mem_flags) +{ + unsigned long flags; + u32 isoFrameSize; + int retval; + int index; + struct HOST_REQ *req; + struct HOST_CTRL *priv; + struct HOST_USB_DEVICE *usbDev; + struct usb_host_endpoint *host_ep; + struct usb_endpoint_descriptor *host_ep_desc; + struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; + + if (!config) + return -ENODEV; + + priv = config->host_priv; + if (!priv) + return -ENODEV; + + usbDev = priv->host_devices_table[urb->dev->slot_id]; + if (!usbDev) + return -ENODEV; + + host_ep = urb->ep; + host_ep_desc = &host_ep->desc; + + spin_lock_irqsave(&config->lock, flags); + retval = usb_hcd_link_urb_to_ep(hcd, urb); + if (retval < 0) { + spin_unlock_irqrestore(&config->lock, flags); + return retval; + } + spin_unlock_irqrestore(&config->lock, flags); + isoFrameSize = urb->number_of_packets * sizeof(struct HOST_ISOFRAMESDESC); + req = kzalloc((sizeof(struct HOST_REQ) + + isoFrameSize), mem_flags); + if (!req) { + spin_lock_irqsave(&config->lock, flags); + usb_hcd_unlink_urb_from_ep(hcd, urb); + spin_unlock_irqrestore(&config->lock, flags); + return -ENOMEM; + } + + req->isoFramesDesc = NULL; + req->isoFramesNumber = urb->number_of_packets; + req->epNum = get_epnum_from_pool(config->host_priv, usb_endpoint_num(host_ep_desc), + usb_endpoint_dir_in(host_ep_desc)); + if (req->epNum > MAX_INSTANCE_EP_NUM) { + pr_err("Not enough endpoint resource for remap\n"); + dump_ep_remap_pool(priv, usb_endpoint_dir_in(host_ep_desc)); + req->epNum = MAX_INSTANCE_EP_NUM; + } + + if (usb_endpoint_dir_in(host_ep_desc)) { + if (!usbDev->in_ep[req->epNum]) + host_endpoint_update(config, usbDev, host_ep); + } else { + if (!usbDev->out_ep[req->epNum]) + host_endpoint_update(config, usbDev, host_ep); + } + + if (usb_endpoint_xfer_isoc(host_ep_desc)) { + req->isoFramesDesc = (struct HOST_ISOFRAMESDESC *)(&req[1]); + for (index = 0; index < urb->number_of_packets; index++) { + req->isoFramesDesc[index].length = urb->iso_frame_desc[index].length; + req->isoFramesDesc[index].offset = urb->iso_frame_desc[index].offset; + } + } + + spin_lock_irqsave(&config->lock, flags); + INIT_LIST_HEAD(&req->list); + req->userExt = (void *)urb; + req->actualLength = urb->actual_length; + req->bufAddress = urb->transfer_buffer; + req->buffDma = urb->transfer_dma; + req->buffLength = urb->transfer_buffer_length; + req->epIsIn = usb_endpoint_dir_in(host_ep_desc); + req->eptype = usb_endpoint_type(host_ep_desc); + req->faddress = usb_pipedevice(urb->pipe); + req->interval = urb->interval; + req->reqUnlinked = 0; + req->setup = (struct usb_ctrlrequest *)urb->setup_packet; + req->setupDma = urb->setup_dma; + req->status = EINPROGRESS; + req->usbDev = &usbDev->udev; + req->usbEp = req->epIsIn ? usbDev->in_ep[req->epNum] : usbDev->out_ep[req->epNum]; + req->usbEp->device_epNum = usb_endpoint_num(host_ep_desc); + if (!req->epNum) + usbDev->ep0_hep.desc.wMaxPacketSize = urb->dev->ep0.desc.wMaxPacketSize; + + req->hcPriv = (void *)req->usbEp; + urb->hcpriv = req; + host_ep->hcpriv = (void *)usbDev; + retval = config->host_obj->host_reqQueue(config->host_priv, req); + if (retval) { + usb_hcd_unlink_urb_from_ep(hcd, urb); + urb->hcpriv = NULL; + spin_unlock_irqrestore(&config->lock, flags); + kfree(req); + return -retval; + } + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static int hc_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status) +{ + unsigned long flags; + struct HOST_CTRL *priv; + int ret = 0; + struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; + + if (!config) + return -ENODEV; + + priv = config->host_priv; + if (!priv->host_devices_table[urb->dev->slot_id]) + return -ENODEV; + + spin_lock_irqsave(&config->lock, flags); + if (usb_hcd_check_unlink_urb(hcd, urb, status)) + goto done; + + if (!urb->hcpriv) + goto err_giveback; + + ret = config->host_obj->host_reqDequeue(priv, urb->hcpriv, status); + + release_epnum_from_pool(config->host_priv, usb_pipeendpoint(urb->pipe), + usb_pipein(urb->pipe)); + + kfree(urb->hcpriv); + urb->hcpriv = NULL; +done: + spin_unlock_irqrestore(&config->lock, flags); + return ret; + +err_giveback: + kfree(urb->hcpriv); + usb_hcd_unlink_urb_from_ep(hcd, urb); + spin_unlock_irqrestore(&config->lock, flags); + usb_hcd_giveback_urb(hcd, urb, -ESHUTDOWN); + return ret; +} + +static void hc_endpoint_disable(struct usb_hcd *hcd, struct usb_host_endpoint *ld_ep) +{ + struct HOST_USB_DEVICE *usbDev; + int ep_num; + struct phytium_cusb *config; + struct HOST_CTRL *priv; + + config = *(struct phytium_cusb **)hcd->hcd_priv; + if (!config) + return; + + ep_num = get_epnum_from_pool(config->host_priv, usb_endpoint_num(&ld_ep->desc), + usb_endpoint_dir_in(&ld_ep->desc)); + + priv = config->host_priv; + + usbDev = (struct HOST_USB_DEVICE *)ld_ep->hcpriv; + if (!usbDev) + return; + + if (ld_ep->desc.bEndpointAddress) { + if (usb_endpoint_dir_in(&ld_ep->desc)) { + if (usbDev->in_ep[ep_num]) { + usbDev->in_ep[ep_num]->userExt = NULL; + INIT_LIST_HEAD(&usbDev->in_ep[ep_num]->reqList); + kfree(usbDev->in_ep[ep_num]); + usbDev->in_ep[ep_num] = NULL; + priv->ep_remap_pool[0][ep_num] = 0; + } + } else { + if (usbDev->out_ep[ep_num]) { + usbDev->out_ep[ep_num]->userExt = NULL; + INIT_LIST_HEAD(&usbDev->out_ep[ep_num]->reqList); + kfree(usbDev->out_ep[ep_num]); + usbDev->out_ep[ep_num] = NULL; + priv->ep_remap_pool[1][ep_num] = 0; + } + } + } +} + +static int hc_get_frame(struct usb_hcd *hcd) +{ + return 0; +} + +static int hc_alloc_dev(struct usb_hcd *hcd, struct usb_device *udev) +{ + struct HOST_USB_DEVICE *usbDev; + struct phytium_cusb *config; + struct HOST_CTRL *priv; + unsigned long flags = 0; + int index; + int slot = -EINVAL; + + if (!hcd || !udev) + return -EINVAL; + + config = *(struct phytium_cusb **)hcd->hcd_priv; + if (!config) + return 0; + + spin_lock_irqsave(&config->lock, flags); + priv = config->host_priv; + for (index = 0; index < MAX_SUPPORTED_DEVICES; index++) { + if (priv->host_devices_table[index] == NULL) { + slot = index; + break; + } + } + spin_unlock_irqrestore(&config->lock, flags); + + if (slot < 0) + return -ENOMEM; + + usbDev = kzalloc((sizeof(struct HOST_USB_DEVICE) + + config->host_obj->host_epGetPrivateDataSize(priv)), GFP_KERNEL); + if (!usbDev) + return -ENOMEM; + + usbDev->ep0_hep.hcPriv = &((uint8_t *)usbDev)[sizeof(struct HOST_USB_DEVICE)]; + usbDev->udev.userExt = (void *)usbDev; + usbDev->ld_udev = udev; + usbDev->ld_udev->slot_id = slot; + usbDev->ep0_hep.desc.bLength = 7; + usbDev->ep0_hep.desc.bDescriptorType = USB_DT_ENDPOINT; + usbDev->in_ep[0] = &usbDev->ep0_hep; + usbDev->out_ep[0] = &usbDev->ep0_hep; + INIT_LIST_HEAD(&usbDev->ep0_hep.reqList); + + priv->host_devices_table[slot] = usbDev; + + return 1; +} + +static void hc_free_dev(struct usb_hcd *hcd, struct usb_device *udev) +{ + struct HOST_CTRL *priv; + struct HOST_USB_DEVICE *usbDev; + struct phytium_cusb *config; + int i; + + if (!hcd || !udev) + return; + + config = *(struct phytium_cusb **)(hcd->hcd_priv); + if (!config) + return; + + priv = (struct HOST_CTRL *)config->host_priv; + usbDev = priv->host_devices_table[udev->slot_id]; + if (!usbDev) + return; + + usbDev->in_ep[0] = NULL; + usbDev->out_ep[0] = NULL; + for (i = 1; i < HOST_EP_NUM; i++) { + if (usbDev->in_ep[i]) + hc_endpoint_disable(hcd, + (struct usb_host_endpoint *)usbDev->in_ep[i]->userExt); + if (usbDev->out_ep[i]) + hc_endpoint_disable(hcd, + (struct usb_host_endpoint *)usbDev->out_ep[i]->userExt); + } + + priv->host_devices_table[udev->slot_id] = NULL; + usbDev->ld_udev->slot_id = 0; + usbDev->udev.userExt = (void *)NULL; + kfree(usbDev); +} + +static int hc_reset_device(struct usb_hcd *hcd, struct usb_device *udev) +{ + struct HOST_CTRL *priv; + struct HOST_USB_DEVICE *usb_device; + struct phytium_cusb *config; + + if (!hcd || !udev) + return -EINVAL; + + config = *(struct phytium_cusb **)hcd->hcd_priv; + priv = (struct HOST_CTRL *)config->host_priv; + usb_device = priv->host_devices_table[udev->slot_id]; + if (!usb_device) + return -ENODEV; + + usb_device->udev.speed = usb_device->ld_udev->speed; + usb_device->udev.devnum = usb_device->ld_udev->devnum; + + if (USB_SPEED_HIGH == usb_device->udev.speed || USB_SPEED_FULL == usb_device->udev.speed) + usb_device->ep0_hep.desc.wMaxPacketSize = 64; + else + usb_device->ep0_hep.desc.wMaxPacketSize = 8; + + pr_debug("speed:%d ep0 wMaxPacketSize:%d\n", usb_device->udev.speed, + usb_device->ep0_hep.desc.wMaxPacketSize); + + return 0; +} + +static int hc_update_device(struct usb_hcd *hcd, struct usb_device *udev) +{ + struct HOST_CTRL *priv; + struct HOST_USB_DEVICE *usb_device; + struct phytium_cusb *config; + + if (!hcd || !udev) + return -EINVAL; + + config = *(struct phytium_cusb **)(hcd->hcd_priv); + priv = (struct HOST_CTRL *)config->host_priv; + + usb_device = priv->host_devices_table[udev->slot_id]; + if (!usb_device) + return -ENODEV; + + usb_device->udev.devnum = udev->devnum; + + return 0; +} + +static int hc_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev, + struct usb_host_endpoint *ep) +{ + return 0; +} + +static int hc_drop_endpoint(struct usb_hcd *hcd, struct usb_device *udev, + struct usb_host_endpoint *ep) +{ + return 0; +} + +static int hc_hub_status_data(struct usb_hcd *hcd, char *buf) +{ + struct HOST_CTRL *priv; + struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; + + if (!config) + return 0; + + priv = (struct HOST_CTRL *)config->host_priv; + if (!priv) + return 0; + + if (priv->portStatus & 0xffff0000) { + *buf = 0x02; + return 1; + } + + return 0; +} + +#ifdef CONFIG_PM +static int hc_bus_suspend(struct usb_hcd *hcd) +{ + unsigned long flags; + struct phytium_cusb *config = *(struct phytium_cusb **)(hcd->hcd_priv); + + if (!config) + return 0; + + spin_lock_irqsave(&config->lock, flags); + hcd->state = HC_STATE_SUSPENDED; + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} + +static int hc_bus_resume(struct usb_hcd *hcd) +{ + unsigned long flags; + struct phytium_cusb *config = *(struct phytium_cusb **)(hcd->hcd_priv); + + if (!config) + return 0; + + spin_lock_irqsave(&config->lock, flags); + hcd->state = HC_STATE_RESUMING; + spin_unlock_irqrestore(&config->lock, flags); + return 0; +} +#endif + +static void host_giveback_request(struct HOST_CTRL *priv, + struct HOST_REQ *req, uint32_t status) +{ + struct urb *urb_req; + int urb_status = 0; + int i = 0; + struct phytium_cusb *config; + + if (!priv || !req) + return; + + urb_req = req->userExt; + urb_req->actual_length = req->actualLength; + + switch (status) { + case HOST_ESTALL: + urb_status = -EPIPE; + break; + case HOST_EUNHANDLED: + urb_status = -EPROTO; + break; + case HOST_ESHUTDOWN: + urb_status = -ESHUTDOWN; + break; + default: + urb_status = status; + } + pr_debug("complete %p %pS (%d) dev%d ep%d%s %d/%d\n", + urb_req, urb_req->complete, urb_status, + usb_pipedevice(urb_req->pipe), + usb_pipeendpoint(urb_req->pipe), + usb_pipein(urb_req->pipe) ? "in" : "out", + urb_req->actual_length, + urb_req->transfer_buffer_length); + + if (usb_endpoint_xfer_isoc(&urb_req->ep->desc)) { + for (i = 0; i < urb_req->number_of_packets; i++) { + urb_req->iso_frame_desc[i].status = 0; + urb_req->iso_frame_desc[i].actual_length = req->isoFramesDesc[i].length; + } + } + + config = dev_get_drvdata(priv->dev); + usb_hcd_unlink_urb_from_ep(config->hcd, urb_req); + spin_unlock(&config->lock); + usb_hcd_giveback_urb(config->hcd, urb_req, urb_status); + kfree(req); + spin_lock(&config->lock); +} + +static void host_rh_port_status_change(struct HOST_CTRL *priv) +{ + uint32_t statusHub; + char *status; + uint32_t retval; + struct usb_ctrlrequest setup; + struct phytium_cusb *config; + + if (!priv) + return; + + config = dev_get_drvdata(priv->dev); + if (!config) + return; + + status = (char *)&statusHub; + hc_hub_status_data(config->hcd, status); + + if (status) { + setup.bRequestType = USB_TYPE_CLASS | USB_RECIP_OTHER | USB_DIR_IN;//to host + setup.bRequest = USB_REQ_GET_STATUS; + setup.wValue = 0; + setup.wIndex = 1; + setup.wLength = 4; + retval = config->host_obj->host_vhubControl(priv, &setup, (uint8_t *)&statusHub); + if (retval) + return; + + if (status[1] & USB_PORT_STAT_C_CONNECTION) { + if (status[0] & USB_PORT_STAT_CONNECTION) { + if (config->hcd->status_urb) + usb_hcd_poll_rh_status(config->hcd); + else + usb_hcd_resume_root_hub(config->hcd); + } else { + usb_hcd_resume_root_hub(config->hcd); + usb_hcd_poll_rh_status(config->hcd); + } + } + } else + usb_hcd_resume_root_hub(config->hcd); +} + +static void host_set_ep_toggle(struct HOST_CTRL *priv, + struct HOST_DEVICE *udev, u8 ep_num, u8 is_in, u8 toggle) +{ + struct HOST_USB_DEVICE *device; + + if (!priv || !udev) + return; + + device = (struct HOST_USB_DEVICE *)udev->userExt; + + usb_settoggle(device->ld_udev, ep_num, !is_in, toggle); +} + +static u8 host_get_ep_toggle(struct HOST_CTRL *priv, + struct HOST_DEVICE *udev, u8 ep_num, u8 is_in) +{ + struct HOST_USB_DEVICE *device; + + if (!priv || !udev) + return 0; + + device = (struct HOST_USB_DEVICE *)udev->userExt; + + return usb_gettoggle(device->ld_udev, ep_num, !is_in); +} + +static uint32_t initEndpoints(struct HOST_CTRL *priv) +{ + int epNum; + + if (!priv) + return 0; + + priv->hwEpInCount = 0; + priv->hwEpOutCount = 0; + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | 0); + memset(priv->ep_remap_pool, 0, sizeof(priv->ep_remap_pool)); + + for (epNum = 0; epNum < HOST_EP_NUM; epNum++) { + priv->in[epNum].isInEp = 1; + priv->in[epNum].hwEpNum = epNum; + if (priv->hostCfg.epIN[epNum].bufferingValue) { + priv->in[epNum].hwMaxPacketSize = priv->hostCfg.epIN[epNum].maxPacketSize; + priv->in[epNum].hwBuffers = priv->hostCfg.epIN[epNum].bufferingValue; + priv->in[epNum].state = HOST_EP_FREE; + priv->in[epNum].channel = NULL; + priv->hwEpInCount++; + + if (epNum) { + phytium_write16(&priv->regs->rxstaddr[epNum - 1].addr, + priv->hostCfg.epIN[epNum].startBuf); + phytium_write8(&priv->regs->ep[epNum - 1].rxcon, 0x08); + phytium_write8(&priv->regs->fifoctrl, FIFOCTRL_FIFOAUTO | epNum); + phytium_write8(&priv->regs->irqmode[epNum - 1].inirqmode, 0x80); + } + } else + priv->in[epNum].state = HOST_EP_NOT_IMPLEMENTED; + + priv->out[epNum].isInEp = 0; + priv->out[epNum].hwEpNum = epNum; + if (priv->hostCfg.epOUT[epNum].bufferingValue) { + priv->out[epNum].hwMaxPacketSize = priv->hostCfg.epOUT[epNum].maxPacketSize; + priv->out[epNum].hwBuffers = priv->hostCfg.epOUT[epNum].bufferingValue; + priv->out[epNum].state = HOST_EP_FREE; + priv->out[epNum].channel = NULL; + priv->hwEpInCount++; + + if (epNum) { + phytium_write16(&priv->regs->txstaddr[epNum - 1].addr, + priv->hostCfg.epOUT[epNum].startBuf); + phytium_write8(&priv->regs->ep[epNum - 1].txcon, 0x08); + phytium_write8(&priv->regs->fifoctrl, + FIFOCTRL_FIFOAUTO | FIFOCTRL_IO_TX | epNum); + phytium_write8(&priv->regs->irqmode[epNum - 1].outirqmode, 0x80); + } + } else + priv->out[epNum].state = HOST_EP_NOT_IMPLEMENTED; + } + + return 0; +} + +int32_t hostInit(struct HOST_CTRL *priv, struct HOST_CFG *config, + struct HOST_CALLBACKS *callbacks, struct device *pdev, bool isVhubHost) +{ + int index; + + if (!config || !priv || !callbacks || !pdev) + return -EINVAL; + + priv->dev = pdev; + priv->hostCallbacks = *callbacks; + priv->hostCfg = *config; + priv->regs = (struct HW_REGS *)config->regBase; + priv->hostDrv = HOST_GetInstance(); + + priv->dmaDrv = DMA_GetInstance(); + priv->dmaCfg.dmaModeRx = 0xFFFF; + priv->dmaCfg.dmaModeTx = 0xFFFF; + priv->dmaCfg.regBase = config->regBase + 0x400; + priv->dmaCfg.trbAddr = config->trbAddr; + priv->dmaCfg.trbDmaAddr = config->trbDmaAddr; + priv->dmaCallback.complete = host_CallbackTransfer; + + priv->dmaController = (void *)(priv + 1); + priv->dmaDrv->dma_init(priv->dmaController, &priv->dmaCfg, &priv->dmaCallback); + priv->dmaDrv->dma_setParentPriv(priv->dmaController, priv); + + INIT_LIST_HEAD(&priv->ctrlHEpQueue); + + for (index = 0; index < MAX_INSTANCE_EP_NUM; index++) { + INIT_LIST_HEAD(&priv->isoInHEpQueue[index]); + INIT_LIST_HEAD(&priv->isoOutHEpQueue[index]); + INIT_LIST_HEAD(&priv->intInHEpQueue[index]); + INIT_LIST_HEAD(&priv->intOutHEpQueue[index]); + INIT_LIST_HEAD(&priv->bulkInHEpQueue[index]); + INIT_LIST_HEAD(&priv->bulkOutHEpQueue[index]); + } + + phytium_write8(&priv->regs->cpuctrl, BIT(1)); + phytium_write8(&priv->regs->otgctrl, OTGCTRL_ABUSDROP); + phytium_write8(&priv->regs->ep0maxpack, 0x40); + + //disable interrupts + phytium_write8(&priv->regs->otgien, 0x0); + phytium_write8(&priv->regs->usbien, 0x0); + phytium_write16(&priv->regs->txerrien, 0x0); + phytium_write16(&priv->regs->rxerrien, 0x0); + + //clear all interrupt except otg idle irq + phytium_write8(&priv->regs->otgirq, 0xFE); + phytium_write8(&priv->regs->usbirq, 0xFF); + phytium_write16(&priv->regs->txerrirq, 0xFF); + phytium_write16(&priv->regs->rxerrirq, 0xFF); + + phytium_write8(&priv->regs->tawaitbcon, 0x80); + + initEndpoints(priv); + priv->otgState = HOST_OTG_STATE_B_IDLE; + + //reset all endpoint + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST | ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); + + if (isVhubHost) + priv->vhub_regs = (struct VHUB_REGS *)(config->phy_regBase); + else + priv->custom_regs = (struct CUSTOM_REGS *)(config->phy_regBase); + + return 0; +} + +void hostDestroy(struct HOST_CTRL *priv) +{ +} + +void hostStart(struct HOST_CTRL *priv) +{ + uint8_t otgstate, usbien; + + if (!priv) + return; + + priv->dmaDrv->dma_start(priv->dmaController); + usbien = phytium_read8(&priv->regs->usbien); + usbien = usbien | USBIR_URES | USBIR_SUSP; + phytium_write8(&priv->regs->usbien, usbien); +retry: + otgstate = phytium_read8(&priv->regs->otgstate); + switch (otgstate) { + case HOST_OTG_STATE_A_IDLE: + priv->ep0State = HOST_EP0_STAGE_IDLE; + priv->otgState = HOST_OTG_STATE_A_IDLE; + phytium_write8(&priv->regs->otgirq, OTGIRQ_IDLEIRQ); + host_SetVbus(priv, 1); + break; + case HOST_OTG_STATE_B_IDLE: + host_SetVbus(priv, 1); + break; + case HOST_OTG_STATE_A_WAIT_VFALL: + goto retry; + } + + phytium_write8(&priv->regs->otgien, OTGIRQ_CONIRQ | + OTGIRQ_VBUSERRIRQ | OTGIRQ_SRPDETIRQ); +} + +void hostStop(struct HOST_CTRL *priv) +{ + if (!priv) + return; + + phytium_write8(&priv->regs->otgien, 0x0); + phytium_write8(&priv->regs->usbien, 0x0); + phytium_write16(&priv->regs->txerrien, 0x0); + phytium_write16(&priv->regs->rxerrien, 0x0); + + phytium_write8(&priv->regs->otgirq, 0xFE); + phytium_write8(&priv->regs->usbirq, 0xFF); + phytium_write16(&priv->regs->txerrirq, 0xFF); + phytium_write16(&priv->regs->rxerrirq, 0xFF); + + host_SetVbus(priv, 0); + priv->dmaDrv->dma_stop(priv->dmaController); +} + +static void handleReset(struct HOST_CTRL *priv) +{ + if (!priv) + return; + + if (priv->otgState == HOST_OTG_STATE_A_WAIT_BCON + || priv->otgState == HOST_OTG_STATE_B_WAIT_ACON) { + switch (phytium_read8(&priv->regs->speedctrl)) { + case SPEEDCTRL_HS: + priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; + break; + case SPEEDCTRL_FS: + priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); + break; + case SPEEDCTRL_LS: + priv->portStatus |= USB_PORT_STAT_LOW_SPEED; + break; + } + + priv->dmaDrv->dma_setHostMode(priv->dmaController); + + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + + switch (phytium_read8(&priv->regs->otgstate)) { + case HOST_OTG_STATE_B_HOST: + priv->otgState = HOST_OTG_STATE_B_HOST; + break; + case HOST_OTG_STATE_A_HOST: + break; + default: + priv->otgState = HOST_OTG_STATE_A_HOST; + break; + } + } +} + +void hostIsr(struct HOST_CTRL *priv) +{ + uint8_t usbirq, usbien; + + if (!priv) + return; + + usbirq = phytium_read8(&priv->regs->usbirq); + usbien = phytium_read8(&priv->regs->usbien); + pr_debug("raw usbirq:0x%x usbien:0x%x\n", usbirq, usbien); + usbirq = usbirq & usbien; + + hostErrorIrq(priv); + hostOtgIrq(priv); + + if (!usbirq) + goto DMA_IRQ; + + if (usbirq & USBIR_URES) { + phytium_write8(&priv->regs->usbirq, USBIR_URES); + priv->port_resetting = 0; + handleReset(priv); + } + + if (usbirq & USBIR_SOF) + phytium_write8(&priv->regs->usbirq, USBIR_SOF); + + if (usbirq & USBIR_SUSP) { + pr_debug("clear suspend irq\n"); + phytium_write8(&priv->regs->usbirq, USBIR_SUSP); + phytium_write8(&priv->regs->clkgate, 0x7); + } + + return; +DMA_IRQ: + priv->dmaDrv->dma_isr(priv->dmaController); +} + +int32_t hostEpDisable(struct HOST_CTRL *priv, struct HOST_EP *ep) +{ + return 0; +} + +unsigned int get_endpoint_interval(struct usb_endpoint_descriptor desc, + int speed) +{ + unsigned int interval = 0; + + switch (speed) { + case USB_SPEED_HIGH: + if (usb_endpoint_xfer_control(&desc) || usb_endpoint_xfer_bulk(&desc)) { + if (desc.bInterval == 0) + return interval; + interval = fls(desc.bInterval) - 1; + interval = clamp_val(interval, 0, 15); + interval = 1 << interval; + if ((1 << interval) != desc.bInterval) + pr_debug("rounding to %d microframes, desc %d microframes\n", + 1 << interval, desc.bInterval); + break; + } + + if (usb_endpoint_xfer_isoc(&desc) || usb_endpoint_xfer_int(&desc)) { + interval = clamp_val(desc.bInterval, 1, 16) - 1; + interval = 1 << interval; + if (interval != desc.bInterval - 1) + pr_debug("rounding to %d %sframes\n", 1 << interval, + speed == USB_SPEED_FULL ? "" : "micro"); + } + break; + case USB_SPEED_FULL: + if (usb_endpoint_xfer_isoc(&desc)) { + interval = clamp_val(desc.bInterval, 1, 16) - 1; + if (interval != desc.bInterval - 1) + pr_debug("rounding to %d %sframes\n", 1 << interval, + speed == USB_SPEED_FULL ? "" : "micro"); + interval += 3; + break; + } + fallthrough; + case USB_SPEED_LOW: + if (usb_endpoint_xfer_int(&desc) || usb_endpoint_xfer_isoc(&desc)) { + interval = fls(desc.bInterval * 8) - 1; + interval = clamp_val(interval, 3, 10); + if ((1 << interval) != desc.bInterval * 8) + pr_debug("rounding to %d microframes, desc %d microframes\n", + 1 << interval, desc.bInterval); + } + } + + return interval; +} + +int32_t hostReqQueue(struct HOST_CTRL *priv, struct HOST_REQ *req) +{ + struct HOST_EP_PRIV *hostEpPriv; + struct list_head *hEpQueue = NULL; + uint8_t idleQueue = 0; + + if (!priv || !req) + return -EINVAL; + + list_add_tail((struct list_head *)&req->list, (struct list_head *)&req->usbEp->reqList); + hostEpPriv = (struct HOST_EP_PRIV *)req->usbEp->hcPriv; + + if (hostEpPriv->epIsReady) { + if (usb_endpoint_xfer_isoc(&req->usbEp->desc)) { + hostEpPriv->isocEpConfigured = 1; + hostStartReq(priv, req); + } + return 0; + } + + hostEpPriv->epIsReady = 1; + hostEpPriv->maxPacketSize = req->usbEp->desc.wMaxPacketSize; + hostEpPriv->interval = req->interval; + hostEpPriv->epNum = req->usbEp->desc.bEndpointAddress & 0xf; + hostEpPriv->faddress = req->faddress; + hostEpPriv->usbHEp = req->usbEp; + hostEpPriv->isIn = req->epIsIn; + + hostEpPriv->frame = get_endpoint_interval(req->usbEp->desc, req->usbDev->speed); + hostEpPriv->interval = hostEpPriv->frame; + switch (usb_endpoint_type(&req->usbEp->desc)) { + case USB_ENDPOINT_XFER_CONTROL: + hostEpPriv->isIn = 0; + hEpQueue = &priv->ctrlHEpQueue; + hostEpPriv->type = USB_ENDPOINT_XFER_CONTROL; + break; + case USB_ENDPOINT_XFER_BULK: + hEpQueue = hostEpPriv->isIn ? &priv->bulkInHEpQueue[req->epNum - 1] : + &priv->bulkOutHEpQueue[req->epNum - 1]; + hostEpPriv->type = USB_ENDPOINT_XFER_BULK; + break; + case USB_ENDPOINT_XFER_INT: + hEpQueue = hostEpPriv->isIn ? &priv->intInHEpQueue[req->epNum - 1] : + &priv->intOutHEpQueue[req->epNum - 1]; + hostEpPriv->type = USB_ENDPOINT_XFER_INT; + break; + case USB_ENDPOINT_XFER_ISOC: + hEpQueue = hostEpPriv->isIn ? &priv->isoInHEpQueue[req->epNum - 1] : + &priv->isoOutHEpQueue[req->epNum - 1]; + hostEpPriv->type = USB_ENDPOINT_XFER_ISOC; + break; + default: + break; + } + + if (hostEpPriv->isIn) + hostEpPriv->genericHwEp = &priv->in[req->epNum]; + else + hostEpPriv->genericHwEp = &priv->out[req->epNum]; + + hostEpPriv->genericHwEp->state = HOST_EP_ALLOCATED; + hostEpPriv->genericHwEp->refCount++; + + if (list_empty(hEpQueue)) { + if (hostEpPriv->genericHwEp->state == HOST_EP_BUSY) { + pr_err("Error:Hardware endpoint %d is busy\n", + hostEpPriv->genericHwEp->hwEpNum); + return -EINVAL; + } + idleQueue = 1; + } + + if (usb_endpoint_xfer_int(&req->usbEp->desc)) + list_add_tail(&hostEpPriv->node, hEpQueue); + + if (idleQueue) + hostStartReq(priv, req); + + return 0; +} + +static int abortActuallyUsbRequest(struct HOST_CTRL *priv, + struct HOST_REQ *req, struct HOST_EP *usbEp) +{ + struct HOST_EP_PRIV *usbEpPriv; + struct HostEp *hostEp; + uint8_t rxcon, txcon; + + if (!priv || !req || !usbEp) + return -EINVAL; + + usbEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; + hostEp = usbEpPriv->currentHwEp; + + usbEpPriv->transferFinished = 1; + if (hostEp->isInEp) { + if (hostEp->hwEpNum) { + rxcon = phytium_read8(&priv->regs->ep[hostEp->hwEpNum - 1].rxcon); + rxcon = rxcon & (~BIT(7)); + phytium_write8(&priv->regs->ep[hostEp->hwEpNum - 1].rxcon, rxcon); + } + } else { + if (hostEp->hwEpNum) { + txcon = phytium_read8(&priv->regs->ep[hostEp->hwEpNum - 1].txcon); + txcon = txcon & (~BIT(7)); + phytium_write8(&priv->regs->ep[hostEp->hwEpNum - 1].txcon, txcon); + } + } + abortTransfer(priv, req, hostEp); + + return 0; +} + +int32_t hostReqDequeue(struct HOST_CTRL *priv, struct HOST_REQ *req, uint32_t status) +{ + struct HOST_EP *usbEp; + struct HOST_EP_PRIV *usbEpPriv; + int ret = 0; + + if (!priv || !req) + return -EINVAL; + + usbEp = req->usbEp; + usbEpPriv = (struct HOST_EP_PRIV *)usbEp->hcPriv; + + pr_debug("Dequeue usbReq:%p dev%d usbEp%d%s\n", req, req->faddress, req->epNum, + req->epIsIn ? "in" : "out"); + + if (!usbEpPriv->epIsReady) + return 0; + + if (!usbEpPriv->currentHwEp || req->list.prev != &usbEp->reqList) { + givebackRequest(priv, req, status); + if (list_empty(&usbEp->reqList)) { + usbEpPriv->epIsReady = 0; + usbEpPriv->currentHwEp = NULL; + if (usb_endpoint_xfer_int(&usbEp->desc)) + list_del(&usbEpPriv->node); + } + } else + ret = abortActuallyUsbRequest(priv, req, usbEp); + + if (usbEpPriv->isocEpConfigured) + usbEpPriv->isocEpConfigured = 0; + + return ret; +} + +int32_t hostVHubStatusData(struct HOST_CTRL *priv, uint8_t *status) +{ + return 0; +} + +int32_t hostGetDevicePD(struct HOST_CTRL *priv) +{ + return 0; +} + +int32_t hostGetPrivateDataSize(struct HOST_CTRL *priv) +{ + if (!priv) + return 0; + + return sizeof(struct HOST_EP_PRIV); +} + +static int hub_descriptor(struct usb_hub_descriptor *buf) +{ + buf->bDescLength = 9; + buf->bDescriptorType = 0x29; + buf->bNbrPorts = 1; + buf->wHubCharacteristics = 0x11; + buf->bPwrOn2PwrGood = 5; + buf->bHubContrCurrent = 0; + buf->u.hs.DeviceRemovable[0] = 0x2; + + return 0; +} + +static int HubPortSuspend(struct HOST_CTRL *priv, u16 on) +{ + uint8_t otgctrl; + + if (!priv) + return 0; + + otgctrl = phytium_read8(&priv->regs->otgctrl); + + if (on) { + otgctrl &= ~OTGCTRL_BUSREQ; + otgctrl &= ~OTGCTRL_BHNPEN; + + priv->portStatus |= USB_PORT_STAT_SUSPEND; + + switch (phytium_read8(&priv->regs->otgstate)) { + case HOST_OTG_STATE_A_HOST: + priv->otgState = HOST_OTG_STATE_A_SUSPEND; + otgctrl |= OTGCTRL_ASETBHNPEN; + break; + case HOST_OTG_STATE_B_HOST: + priv->otgState = HOST_OTG_STATE_B_HOST_2; + break; + default: + break; + } + phytium_write8(&priv->regs->otgctrl, otgctrl); + } else { + otgctrl |= OTGCTRL_BUSREQ; + otgctrl &= ~OTGCTRL_ASETBHNPEN; + phytium_write8(&priv->regs->otgctrl, otgctrl); + priv->portStatus |= USB_PORT_STAT_RESUME; + } + return 0; +} + +static void HubPortReset(struct HOST_CTRL *priv, uint8_t on) +{ + uint8_t speed; + + if (!priv) + return; + + if (on) { + phytium_write16(&priv->regs->txerrirq, 0xFFFF); + phytium_write16(&priv->regs->txirq, 0xFFFF); + phytium_write16(&priv->regs->rxerrirq, 0xFFFF); + phytium_write16(&priv->regs->rxirq, 0xFFFF); + + phytium_write8(&priv->regs->endprst, ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | + ENDPRST_TOGRST | ENDPRST_IO_TX); + phytium_write8(&priv->regs->endprst, ENDPRST_FIFORST | ENDPRST_TOGRST); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | 0 | 0x04); + phytium_write8(&priv->regs->ep0fifoctrl, FIFOCTRL_FIFOAUTO | + FIFOCTRL_IO_TX | 0 | 0x04); + + priv->portStatus |= USB_PORT_STAT_RESET; + priv->portStatus &= ~USB_PORT_STAT_ENABLE; + priv->port_resetting = 0; + } else { + speed = phytium_read8(&priv->regs->speedctrl); + if (speed == SPEEDCTRL_HS) + priv->portStatus |= USB_PORT_STAT_HIGH_SPEED; + else if (speed == SPEEDCTRL_FS) + priv->portStatus &= ~(USB_PORT_STAT_HIGH_SPEED | USB_PORT_STAT_LOW_SPEED); + else + priv->portStatus |= USB_PORT_STAT_LOW_SPEED; + + priv->portStatus &= ~USB_PORT_STAT_RESET; + priv->portStatus |= USB_PORT_STAT_ENABLE | (USB_PORT_STAT_C_RESET << 16) + | (USB_PORT_STAT_C_ENABLE << 16); + + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + } +} + +static int get_PortStatus(struct HOST_CTRL *priv, u16 wIndex, uint8_t *buff) +{ + uint32_t temp = 0; + + if (!priv || !buff) + return 0; + + if ((wIndex & 0xff) != 1) + return 1; + + if (priv->portStatus & USB_PORT_STAT_RESET) { + if (!priv->port_resetting) + HubPortReset(priv, 0); + } + + if (priv->portStatus & USB_PORT_STAT_RESUME) { + priv->portStatus &= ~(USB_PORT_STAT_SUSPEND | USB_PORT_STAT_RESUME); + priv->portStatus |= USB_PORT_STAT_C_SUSPEND << 16; + if (priv->hostCallbacks.portStatusChange) + priv->hostCallbacks.portStatusChange(priv); + } + + temp = priv->portStatus & (~USB_PORT_STAT_RESUME); + buff[0] = temp; + buff[1] = temp >> 8; + buff[2] = temp >> 16; + buff[3] = temp >> 24; + + return 0; +} + +static int set_PortFeature(struct HOST_CTRL *priv, u16 wValue, u16 wIndex) +{ +// struct HW_Regs *regs = priv->regs; + + if ((wIndex & 0xff) != 1) + return 1; + + switch (wValue) { + case USB_PORT_FEAT_CONNECTION: + break; + case USB_PORT_FEAT_ENABLE: + break; + case USB_PORT_FEAT_SUSPEND: + HubPortSuspend(priv, 1); + break; + case USB_PORT_FEAT_OVER_CURRENT: + break; + case USB_PORT_FEAT_RESET: + HubPortReset(priv, 1); + break; + case USB_PORT_FEAT_L1: + break; + case USB_PORT_FEAT_POWER: + hostStart(priv); + break; + case USB_PORT_FEAT_LOWSPEED: + break; + case USB_PORT_FEAT_C_CONNECTION: + break; + case USB_PORT_FEAT_C_ENABLE: + break; + case USB_PORT_FEAT_C_SUSPEND: + break; + case USB_PORT_FEAT_C_OVER_CURRENT: + break; + case USB_PORT_FEAT_INDICATOR: + break; + case USB_PORT_FEAT_C_PORT_L1: + break; + default: + break; + } + priv->portStatus |= 1 << wValue; + + return 0; +} + +static int Clear_PortFeature(struct HOST_CTRL *priv, u16 wValue, u16 wIndex) +{ + if ((wIndex & 0xff) != 1) + return 1; + + switch (wValue) { + case USB_PORT_FEAT_CONNECTION: + break; + case USB_PORT_FEAT_ENABLE: + break; + case USB_PORT_FEAT_SUSPEND: + HubPortSuspend(priv, 0); + break; + case USB_PORT_FEAT_OVER_CURRENT: + break; + case USB_PORT_FEAT_RESET: + break; + case USB_PORT_FEAT_L1: + break; + case USB_PORT_FEAT_POWER: + break; + case USB_PORT_FEAT_LOWSPEED: + break; + case USB_PORT_FEAT_C_CONNECTION: + break; + case USB_PORT_FEAT_C_ENABLE: + break; + case USB_PORT_FEAT_C_SUSPEND: + break; + case USB_PORT_FEAT_C_OVER_CURRENT: + break; + case USB_PORT_FEAT_INDICATOR: + break; + case USB_PORT_FEAT_C_PORT_L1: + break; + default: + break; + } + priv->portStatus &= ~(1 << wValue); + + return 0; +} + +static int hc_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue, + u16 wIndex, char *buf, u16 wLength) +{ + unsigned long flags = 0; + int retval = 0; + struct HOST_CTRL *priv; + struct phytium_cusb *config = *(struct phytium_cusb **)hcd->hcd_priv; + + if (!config) + return -EINVAL; + + if (!buf) + return -EINVAL; + + if (unlikely(!HCD_HW_ACCESSIBLE(hcd))) { + spin_unlock_irqrestore(&config->lock, flags); + return -ESHUTDOWN; + } + + priv = (struct HOST_CTRL *)config->host_priv; + if (!priv) + return -EINVAL; + + spin_lock_irqsave(&config->lock, flags); + switch (typeReq) { + case GetHubStatus: + break; + case GetPortStatus: + get_PortStatus(priv, wIndex, (uint8_t *)buf); + break; + case GetHubDescriptor: + hub_descriptor((struct usb_hub_descriptor *)buf); + break; + case SetPortFeature: + set_PortFeature(priv, wValue, wIndex); + break; + case ClearPortFeature: + retval = Clear_PortFeature(priv, wValue, wIndex); + break; + case SetHubFeature: + break; + case ClearHubFeature: + break; + default: + break; + } + + spin_unlock_irqrestore(&config->lock, flags); + + return retval; +} + +int32_t hostVHubControl(struct HOST_CTRL *priv, struct usb_ctrlrequest *setup, uint8_t *buff) +{ + uint16_t request; + uint32_t retval = 0; + + if (!priv || !setup || !buff) + return -EINVAL; + + request = setup->bRequestType << 0x08 | setup->bRequest; + switch (request) { + case ClearHubFeature: + break; + case SetHubFeature: + break; + case ClearPortFeature: + retval = Clear_PortFeature(priv, setup->wValue, setup->wIndex); + break; + case SetPortFeature: + retval = set_PortFeature(priv, setup->wValue, setup->wIndex); + break; + case GetHubDescriptor: + retval = hub_descriptor((struct usb_hub_descriptor *)buff); + break; + case GetHubStatus: + break; + case GetPortStatus: + retval = get_PortStatus(priv, setup->wIndex, (uint8_t *)buff); + break; + default: + retval = EOPNOTSUPP; + break; + } + + return retval; +} + +struct HOST_OBJ hostDrv = { + .host_init = hostInit, + .host_destroy = hostDestroy, + .host_start = hostStart, + .host_stop = hostStop, + .host_isr = hostIsr, + + //endpoint operation + .host_epDisable = hostEpDisable, + .host_reqQueue = hostReqQueue, + .host_reqDequeue = hostReqDequeue, + .host_vhubStatusData = hostVHubStatusData, + .host_vhubControl = hostVHubControl, + .host_getDevicePD = hostGetDevicePD, + .host_epGetPrivateDataSize = hostGetPrivateDataSize, +}; + +static struct hc_driver host_driver = { + .description = "phytium-hcd", + .product_desc = "Phytium Host USB Driver", + .hcd_priv_size = sizeof(struct phytium_cusb *), + .flags = HCD_MEMORY | HCD_USB2 | HCD_DMA, + .reset = hc_reset, + .start = hc_start, + .stop = hc_stop, + .shutdown = hc_shutdown, + .urb_enqueue = hc_urb_enqueue, + .urb_dequeue = hc_urb_dequeue, + .endpoint_disable = hc_endpoint_disable, + .get_frame_number = hc_get_frame, + .alloc_dev = hc_alloc_dev, + .free_dev = hc_free_dev, + .reset_device = hc_reset_device, + .update_device = hc_update_device, + .add_endpoint = hc_add_endpoint, + .drop_endpoint = hc_drop_endpoint, + .hub_status_data = hc_hub_status_data, + .hub_control = hc_hub_control, +#ifdef CONFIG_PM + .bus_suspend = hc_bus_suspend, + .bus_resume = hc_bus_resume, +#endif +}; + +static int phytium_host_set_default_cfg(struct phytium_cusb *config) +{ + int index; + + config->host_cfg.regBase = (uintptr_t)config->regs; + config->host_cfg.phy_regBase = (uintptr_t)config->phy_regs; + config->host_cfg.dmultEnabled = 1; + config->host_cfg.memoryAlignment = 0; + config->host_cfg.dmaSupport = 1; + config->host_cfg.isEmbeddedHost = 1; + + for (index = 0; index < HOST_EP_NUM; index++) { + if (index == 0) { + config->host_cfg.epIN[index].bufferingValue = 1; + config->host_cfg.epIN[index].maxPacketSize = 64; + config->host_cfg.epIN[index].startBuf = 0; + + config->host_cfg.epOUT[index].bufferingValue = 1; + config->host_cfg.epOUT[index].maxPacketSize = 64; + config->host_cfg.epOUT[index].startBuf = 0; + } else { + config->host_cfg.epIN[index].bufferingValue = 2; + config->host_cfg.epIN[index].maxPacketSize = 1024; + config->host_cfg.epIN[index].startBuf = 64 + 2 * 1024 * (index - 1); + + config->host_cfg.epOUT[index].bufferingValue = 2; + config->host_cfg.epOUT[index].maxPacketSize = 1024; + config->host_cfg.epOUT[index].startBuf = 64 + 2 * 1024 * (index - 1); + } + } + + return 0; +} + +static int phytium_host_reinit(struct phytium_cusb *config) +{ + struct HOST_CTRL *ctrl; + + if (!config || !config->host_priv) + return 0; + + ctrl = (struct HOST_CTRL *)config->host_priv; + + usb_root_hub_lost_power(config->hcd->self.root_hub); + hostStop(ctrl); + + ctrl->portStatus = 0; + + config->host_obj->host_init(config->host_priv, &config->host_cfg, + &config->host_callbacks, config->dev, config->isVhubHost); + + return 0; +} + +int phytium_host_init(struct phytium_cusb *config) +{ + int ret; + + if (!config) + return 0; + + phytium_host_set_default_cfg(config); + config->host_obj = HOST_GetInstance(); + config->dma_cfg.regBase = config->host_cfg.regBase + 0x400; + + config->dma_obj = DMA_GetInstance(); + config->dma_obj->dma_probe(&config->dma_cfg, &config->dma_sysreq); + + config->host_sysreq.privDataSize = sizeof(struct HOST_CTRL); + config->host_sysreq.trbMemSize = config->dma_sysreq.trbMemSize; + config->host_sysreq.privDataSize += config->dma_sysreq.privDataSize; + + config->host_priv = devm_kzalloc(config->dev, config->host_sysreq.privDataSize, GFP_KERNEL); + if (!config->host_priv) { + ret = -ENOMEM; + goto err_probe; + } + + config->host_cfg.trbAddr = dma_alloc_coherent(config->dev, config->host_sysreq.trbMemSize, + (dma_addr_t *)&config->host_cfg.trbDmaAddr, GFP_KERNEL); + if (!config->host_cfg.trbAddr) { + ret = -ENOMEM; + goto err_dma_coherent; + } + + config->host_callbacks.portStatusChange = host_rh_port_status_change; + config->host_callbacks.getEpToggle = host_get_ep_toggle; + config->host_callbacks.setEpToggle = host_set_ep_toggle; + config->host_callbacks.givebackRequest = host_giveback_request; + + config->host_obj->host_init(config->host_priv, &config->host_cfg, + &config->host_callbacks, config->dev, config->isVhubHost); + + config->hcd = usb_create_hcd(&host_driver, config->dev, dev_name(config->dev)); + if (!config->hcd) { + ret = -ENODEV; + goto err_host; + } + + *config->hcd->hcd_priv = (unsigned long)config; + config->hcd->self.uses_pio_for_control = 0; + config->hcd->uses_new_polling = 1; + config->hcd->has_tt = 1; + + dev_set_drvdata(config->dev, config); + + config->hcd->self.otg_port = 1; + config->hcd->power_budget = 500; + ret = usb_add_hcd(config->hcd, 0, 0); + if (ret < 0) + goto err_setup; + + return 0; +err_setup: + usb_put_hcd(config->hcd); +err_host: + config->host_obj->host_destroy(config->host_priv); + dma_free_coherent(config->dev, config->host_sysreq.trbMemSize, + config->host_cfg.trbAddr, config->host_cfg.trbDmaAddr); +err_dma_coherent: +err_probe: + dev_set_drvdata(config->dev, NULL); + return ret; +} + +int phytium_host_uninit(struct phytium_cusb *config) +{ + if (!config) + return 0; + + if (config->hcd) { + usb_remove_hcd(config->hcd); + usb_put_hcd(config->hcd); + config->hcd = NULL; + } + + return 0; +} + +#ifdef CONFIG_PM +int phytium_host_resume(void *priv) +{ + int otgctrl; + struct phytium_cusb *config = (struct phytium_cusb *)priv; + struct HOST_CTRL *ctrl = (struct HOST_CTRL *)config->host_priv; + + if (!ctrl) + return -EINVAL; + + otgctrl = phytium_read8(&ctrl->regs->otgctrl); + otgctrl |= 1; + phytium_write8(&ctrl->regs->otgctrl, otgctrl); + + phytium_host_reinit(config); + + return 0; +} + +int phytium_host_suspend(void *priv) +{ + int otgctrl; + struct phytium_cusb *config = (struct phytium_cusb *)priv; + struct HOST_CTRL *ctrl = (struct HOST_CTRL *)config->host_priv; + + if (!ctrl) + return -EINVAL; + + otgctrl = phytium_read8(&ctrl->regs->otgctrl); + otgctrl = otgctrl & (~1); + phytium_write8(&ctrl->regs->otgctrl, otgctrl); + + return 0; +} +#endif + +struct HOST_OBJ *HOST_GetInstance(void) +{ + return &hostDrv; +} diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/host_api.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/host_api.h new file mode 100644 index 0000000000000000000000000000000000000000..b99d2b4980fbe09ab31f8591b0cd528f6516d6f5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/host_api.h @@ -0,0 +1,251 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef __PHYTIUM_HOST_API_H_ +#define __PHYTIUM_HOST_API_H_ + +#include +//#include "list.h" +#include "dma.h" + +#define MAX_SUPPORTED_DEVICES 16 +#define USB_PORT_STAT_RESUME (1 << 31) +#define MAX_INSTANCE_EP_NUM 6 +#define ENDPOINT_DIR 2 + +enum HOST_OtgState { + HOST_OTG_STATE_A_IDLE, + HOST_OTG_STATE_A_WAIT_VRISE, + HOST_OTG_STATE_A_WAIT_BCON, + HOST_OTG_STATE_A_HOST, + HOST_OTG_STATE_A_SUSPEND, + HOST_OTG_STATE_A_PERIPHERAL, + HOST_OTG_STATE_A_VBUS_ERR, + HOST_OTG_STATE_A_WAIT_VFALL, + HOST_OTG_STATE_B_IDLE = 0x10, + HOST_OTG_STATE_B_PERIPHERAL, + HOST_OTG_STATE_B_WAIT_ACON, + HOST_OTG_STATE_B_HOST, + HOST_OTG_STATE_B_HOST_2, + HOST_OTG_STATE_B_SRP_INT1, + HOST_OTG_STATE_B_SRP_INT2, + HOST_OTG_STATE_B_DISCHRG1, + HOST_OTG_STATE_B_DISCHRG2, + HOST_OTG_STATE_UNKNOWN, +}; + +enum HOST_EP0_STAGE { + HOST_EP0_STAGE_IDLE, + HOST_EP0_STAGE_SETUP, + HOST_EP0_STAGE_IN, + HOST_EP0_STAGE_OUT, + HOST_EP0_STAGE_STATUSIN, + HOST_EP0_STAGE_STATUSOUT, + HOST_EP0_STAGE_ACK, +}; + +enum HOST_EP_STATE { + HOST_EP_FREE, + HOST_EP_ALLOCATED, + HOST_EP_BUSY, + HOST_EP_NOT_IMPLEMENTED +}; + +struct HOST_DEVICE { + uint8_t devnum; + uint8_t hubPort; + unsigned int speed; + struct HOST_DEVICE *parent; + void *hcPriv; + void *userExt; +}; + +struct HOST_EP { + struct usb_endpoint_descriptor desc; + struct list_head reqList; + void *userExt; + uint8_t *hcPriv; + uint8_t device_epNum; +}; + +struct HOST_USB_DEVICE { + struct HOST_EP ep0_hep; + struct HOST_EP *in_ep[16]; + struct HOST_EP *out_ep[16]; + struct HOST_DEVICE udev; + struct usb_device *ld_udev; +}; + +struct HostEp { + uint8_t name[255]; + uint8_t hwEpNum; + uint8_t hwBuffers; + uint16_t hwMaxPacketSize; + uint8_t isInEp; + void *channel; + uint8_t usbEpNum; + uint8_t type; + uint8_t usbPacketSize; + enum HOST_EP_STATE state; + struct HOST_EP *scheduledUsbHEp; + uint8_t refCount; +}; + +struct HOST_ISOFRAMESDESC { + uint32_t length; + uint32_t offset; +}; + +struct HOST_EP_PRIV { + struct list_head node; + struct HostEp *genericHwEp; + struct HostEp *currentHwEp; + uint8_t epIsReady; + uint8_t isIn; + uint8_t type; + uint8_t interval; + uint8_t epNum; + uint8_t faddress; + uint16_t maxPacketSize; + uint32_t frame; + uint8_t hubAddress; + uint8_t portAddress; + uint8_t split; + struct HOST_EP *usbHEp; + uint8_t isocEpConfigured; + uint8_t transferFinished; +}; + +struct HOST_REQ { + struct list_head list; + struct HOST_EP *usbEp; + void *userExt; + void *hcPriv; + struct HOST_DEVICE *usbDev; + struct usb_ctrlrequest *setup; + uintptr_t setupDma; + void *bufAddress; + uintptr_t buffDma; + uint32_t buffLength; + uint32_t actualLength; + uint8_t epIsIn; + uint8_t eptype; + uint8_t epNum; + uint8_t faddress; + uint8_t interval; + uint8_t status; + uint8_t reqUnlinked; + struct HOST_ISOFRAMESDESC *isoFramesDesc; + uint32_t isoFramesNumber; +}; + +struct HOST_SYSREQ { + uint32_t privDataSize; + uint32_t trbMemSize; +}; + +struct HOST_EP_CFG { + uint8_t bufferingValue; + uint16_t startBuf; + uint16_t maxPacketSize; +}; + +struct HOST_CFG { + uintptr_t regBase; + uintptr_t phy_regBase; + struct HOST_EP_CFG epIN[16]; + struct HOST_EP_CFG epOUT[16]; + uint8_t dmultEnabled; + uint8_t memoryAlignment; + uint8_t dmaSupport; + uint8_t isEmbeddedHost; + void *trbAddr; + uintptr_t trbDmaAddr; +}; + +struct HOST_CTRL; + +struct HOST_CALLBACKS { + void (*portStatusChange)(struct HOST_CTRL *priv); + + uint8_t (*getEpToggle)(struct HOST_CTRL *priv, + struct HOST_DEVICE *usbDev, uint8_t epNum, uint8_t isIn); + + void (*setEpToggle)(struct HOST_CTRL *priv, struct HOST_DEVICE *usbDev, + uint8_t epNum, uint8_t isIn, uint8_t toggle); + + void (*givebackRequest)(struct HOST_CTRL *priv, + struct HOST_REQ *usbReq, uint32_t status); + + void (*setTimer)(struct HOST_CTRL *priv, uint32_t time, uint8_t id); +}; + +struct HOST_OBJ { + int32_t (*host_probe)(struct HOST_CFG *config, struct HOST_SYSREQ *sysReq); + + int32_t (*host_init)(struct HOST_CTRL *priv, struct HOST_CFG *config, + struct HOST_CALLBACKS *callbacks, struct device *pdev, bool isVhubHost); + + void (*host_destroy)(struct HOST_CTRL *priv); + + void (*host_start)(struct HOST_CTRL *priv); + + void (*host_stop)(struct HOST_CTRL *priv); + + void (*host_isr)(struct HOST_CTRL *priv); + + int32_t (*host_epDisable)(struct HOST_CTRL *priv, struct HOST_EP *ep); + + int32_t (*host_reqQueue)(struct HOST_CTRL *priv, struct HOST_REQ *req); + + int32_t (*host_reqDequeue)(struct HOST_CTRL *priv, + struct HOST_REQ *req, uint32_t status); + + int32_t (*host_vhubStatusData)(struct HOST_CTRL *priv, uint8_t *status); + + int32_t (*host_vhubControl)(struct HOST_CTRL *priv, + struct usb_ctrlrequest *setup, uint8_t *buff); + + int32_t (*host_getDevicePD)(struct HOST_CTRL *priv); + + int32_t (*host_epGetPrivateDataSize)(struct HOST_CTRL *priv); +}; + +struct HOST_CTRL { + struct device *dev; + struct HW_REGS *regs; + struct HOST_OBJ *hostDrv; + struct HOST_CFG hostCfg; + struct HOST_CALLBACKS hostCallbacks; + struct HostEp in[16]; + struct HostEp out[16]; + uint32_t portStatus; + struct list_head ctrlHEpQueue; + struct list_head isoInHEpQueue[MAX_INSTANCE_EP_NUM]; + struct list_head isoOutHEpQueue[MAX_INSTANCE_EP_NUM]; + struct list_head intInHEpQueue[MAX_INSTANCE_EP_NUM]; + struct list_head intOutHEpQueue[MAX_INSTANCE_EP_NUM]; + struct list_head bulkInHEpQueue[MAX_INSTANCE_EP_NUM]; + struct list_head bulkOutHEpQueue[MAX_INSTANCE_EP_NUM]; + uint8_t hwEpInCount; + uint8_t hwEpOutCount; + unsigned int speed; + enum HOST_OtgState otgState; + enum HOST_EP0_STAGE ep0State; + uint8_t vBusErrCnt; + uint8_t isRemoteWakeup; + uint8_t isSelfPowered; + uint8_t deviceAddress; + struct DMA_OBJ *dmaDrv; + void *dmaController; + struct DMA_CFG dmaCfg; + struct DMA_CALLBACKS dmaCallback; + uint8_t port_resetting; + struct HOST_USB_DEVICE *host_devices_table[MAX_SUPPORTED_DEVICES]; + struct CUSTOM_REGS *custom_regs; + struct VHUB_REGS *vhub_regs; + int ep_remap_pool[ENDPOINT_DIR][MAX_INSTANCE_EP_NUM + 1]; +}; + +struct HOST_OBJ *HOST_GetInstance(void); + +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/hw-regs.h b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/hw-regs.h new file mode 100644 index 0000000000000000000000000000000000000000..8da9f8e9b92537f20c2be1c232849f331f32baf7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/hw-regs.h @@ -0,0 +1,297 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +#ifndef __LINUX_PHYTIUM_HW_REGS +#define __LINUX_PHYTIUM_HW_REGS + +#define USBIEN 0x198 +#define USBIEN_SUDAVIE BIT(0) +#define USBIEN_SOFIE BIT(1) +#define USBIEN_SUTOKIE BIT(2) +#define USBIEN_SUSPIE BIT(3) +#define USBIEN_URESIE BIT(4) +#define USBIEN_HSPEEDIE BIT(5) +#define USBIEN_LPMIE BIT(7) + +#define USBCS 0x1a3 +#define USBCS_LSMODE BIT(0) +#define USBCS_LPMNYET BIT(1) +#define USBCS_SIGSUME BIT(5) +#define USBCS_DISCON BIT(6) +#define USBCS_WAKESRC BIT(7) + +#define USBIR_SOF BIT(1) +#define USBIR_SUSP BIT(3) +#define USBIR_URES BIT(4) +#define USBIR_HSPEED BIT(5) + +#define USBIR_SUDAV BIT(0) +#define USBIR_SUTOK BIT(2) +#define USBIR_LPMIR BIT(7) + +#define OTGIRQ_IDLEIRQ BIT(0) +#define OTGIRQ_SRPDETIRQ BIT(1) +#define OTGIRQ_CONIRQ BIT(2) +#define OTGIRQ_LOCSOFIRQ BIT(2) +#define OTGIRQ_VBUSERRIRQ BIT(3) +#define OTGIRQ_PERIPHIRQ BIT(4) +#define OTGIRQ_IDCHANGEIRQ BIT(5) +#define OTGIRQ_HOSTDISCON BIT(6) +#define OTGIRQ_BSE0SRPIRQ BIT(7) + +#define OTGCTRL_BUSREQ BIT(0) +#define OTGCTRL_ABUSDROP BIT(1) +#define OTGCTRL_ASETBHNPEN BIT(2) +#define OTGCTRL_BHNPEN BIT(3) +#define OTGCTRL_SRPVBUSDETEN BIT(4) +#define OTGCTRL_SRPDATDETEN BIT(5) +#define OTGCTRL_FORCEBCONN BIT(7) + +#define OTGSTATUS_ID BIT(6) + +#define ENDPRST_EP 0x0f +#define ENDPRST_IO_TX BIT(4) +#define ENDPRST_TOGRST BIT(5) +#define ENDPRST_FIFORST BIT(6) +#define ENDPRST_TOGSETQ BIT(7) + +#define FIFOCTRL_EP 0x0f +#define FIFOCTRL_IO_TX BIT(4) +#define FIFOCTRL_FIFOAUTO BIT(5) + +#define SPEEDCTRL_LS BIT(0) +#define SPEEDCTRL_FS BIT(1) +#define SPEEDCTRL_HS BIT(2) +#define SPEEDCTRL_HSDISABLE BIT(7) + +#define CON_TYPE_CONTROL 0x00 +#define CON_TYPE_ISOC 0x04 +#define CON_TYPE_BULK 0x08 +#define CON_TYPE_INT 0x0C +#define CON_TYPE_ISOC_1_ISOD 0x00 +#define CON_TYPE_ISOC_2_ISOD 0x10 +#define CON_TYPE_ISOC_3_ISOD 0x20 +#define CON_STALL 0x40 +#define CON_VAL 0x80 + +#define ERR_TYPE 0x1c +#define ERR_COUNT 0x03 +#define ERR_RESEND BIT(6) +#define ERR_UNDERRIEN BIT(7) + +#define ERR_NONE 0 +#define ERR_CRC 1 +#define ERR_DATA_TOGGLE_MISMATCH 2 +#define ERR_STALL 3 +#define ERR_TIMEOUT 4 +#define ERR_PID 5 +#define ERR_TOO_LONG_PACKET 6 +#define ERR_DATA_UNDERRUN 7 + +#define EP0CS_HCSETTOGGLE BIT(6) +#define EP0CS_HCSET BIT(4) +#define EP0CS_RXBUSY_MASK BIT(3) +#define EP0CS_TXBUSY_MASK BIT(2) +#define EP0CS_STALL BIT(0) +#define EP0CS_HSNAK BIT(1) +#define EP0CS_DSTALL BIT(4) +#define EP0CS_CHGSET BIT(7) + +#define CS_ERR 0x01 +#define CS_BUSY 0x02 +#define CS_NPAK 0x0c +#define CS_NPAK_OFFSET 0x02 +#define CS_AUTO 0x10 + +#define CON_BUF_SINGLE 0x00 +#define CON_BUF_DOUBLE 0x01 +#define CON_BUF_TRIPLE 0x02 +#define CON_BUF_QUAD 0x03 +#define CON_BUF 0x03 + +struct HW_REGS { + uint8_t ep0Rxbc; /*address 0x00*/ + uint8_t ep0Txbc; /*address 0x01*/ + uint8_t ep0cs; /*address 0x02*/ + int8_t reserved0; /*address 0x03*/ + uint8_t lpmctrll; /*address 0x04*/ + uint8_t lpmctrlh; /*address 0x05*/ + uint8_t lpmclock; + uint8_t ep0fifoctrl; + struct ep { /*address 0x08*/ + uint16_t rxbc; //outbc (hcinbc) + uint8_t rxcon; + uint8_t rxcs; + uint16_t txbc; //inbc (hcoutbc + uint8_t txcon; + uint8_t txcs; + } ep[15]; + uint8_t reserved1[4]; + uint32_t fifodat[15]; /*address 0x84*/ + uint8_t ep0ctrl; /*address 0xC0*/ + uint8_t tx0err; /*address 0xC1*/ + uint8_t reserved2; + uint8_t rx0err; /*address 0xC3*/ + struct epExt { + uint8_t txctrl; + uint8_t txerr; + uint8_t rxctrl; + uint8_t rxerr; + } epExt[15]; + uint8_t ep0datatx[64]; /*address 0x100*/ + uint8_t ep0datarx[64]; /*address 0x140*/ + uint8_t setupdat[8]; /*address 0x180*/ + uint16_t txirq; /*address 0x188*/ + uint16_t rxirq; /*address 0x18A*/ + uint8_t usbirq; /*address 0x18C*/ + uint8_t reserved4; + uint16_t rxpngirq; /*address 0x18E*/ + uint16_t txfullirq; /*address 0x190*/ + uint16_t rxemptirq; /*address 0x192*/ + uint16_t txien; /*address 0x194*/ + uint16_t rxien; /*address 0x196*/ + uint8_t usbien; /*address 0x198*/ + uint8_t reserved6; + uint16_t rxpngien; /*address 0x19A*/ + uint16_t txfullien; /*address 0x19C*/ + uint16_t rxemptien; /*address 0x19E*/ + uint8_t usbivect; /*address 0x1A0*/ + uint8_t fifoivect; /*address 0x1A1*/ + uint8_t endprst; /*address 0x1A2*/ + uint8_t usbcs; /*address 0x1A3*/ + uint16_t frmnr; /*address 0x1A4*/ + uint8_t fnaddr; /*address 0x1A6*/ + uint8_t clkgate; /*address 0x1A7*/ + uint8_t fifoctrl; /*address 0x1A8*/ + uint8_t speedctrl; /*address 0x1A9*/ + uint8_t reserved8[1]; /*address 0x1AA*/ + uint8_t portctrl; /*address 0x1AB*/ + uint16_t hcfrmnr; /*address 0x1AC*/ + uint16_t hcfrmremain; /*address 0x1AE*/ + uint8_t reserved9[4]; /*address 0x1B0*/ + uint16_t rxerrirq; /*address 0x1B4*/ + uint16_t txerrirq; /*address 0x1B6*/ + uint16_t rxerrien; /*address 0x1B8*/ + uint16_t txerrien; /*address 0x1BA*/ + /*OTG extension*/ + uint8_t otgirq; /*address 0x1BC*/ + uint8_t otgstate; /*address 0x1BD*/ + uint8_t otgctrl; /*address 0x1BE*/ + uint8_t otgstatus; /*address 0x1BF*/ + uint8_t otgien; /*address 0x1C0*/ + uint8_t taaidlbdis; /*address 0x1C1*/ + uint8_t tawaitbcon; /*address 0x1C2*/ + uint8_t tbvbuspls; /*address 0x1C3*/ + uint8_t otg2ctrl; /*address 0x1C4*/ + uint8_t reserved10[2]; /*address 0x1C5*/ + uint8_t tbvbusdispls; /*address 0x1C7*/ + uint8_t traddr; /*address 0x1C8*/ + uint8_t trwdata; /*address 0x1C9*/ + uint8_t trrdata; /*address 0x1CA*/ + uint8_t trctrl; /*address 0x1CB*/ + uint16_t isoautoarm; /*address 0x1CC*/ + uint8_t adpbc1ien; /*address 0x1CE*/ + uint8_t adpbc2ien; /*address 0x1CF*/ + uint8_t adpbcctr0; /*address 0x1D0*/ + uint8_t adpbcctr1; /*address 0x1D1*/ + uint8_t adpbcctr2; /*address 0x1D2*/ + uint8_t adpbc1irq; /*address 0x1D3*/ + uint8_t adpbc0status; /*address 0x1D4*/ + uint8_t adpbc1status; /*address 0x1D5*/ + uint8_t adpbc2status; /*address 0x1D6*/ + uint8_t adpbc2irq; /*address 0x1D7*/ + uint16_t isodctrl; /*address 0x1D8*/ + uint8_t reserved11[2]; + uint16_t isoautodump; /*address 0x1DC*/ + uint8_t reserved12[2]; + uint8_t ep0maxpack; /*address 0x1E0*/ + uint8_t reserved13; + uint16_t rxmaxpack[15]; /*address 0x1E2*/ + struct rxsoftimer { /*address 0x200 to 0x23F*/ + uint16_t timer; + uint8_t reserved; + uint8_t ctrl; + } rxsoftimer[16]; + + struct txsoftimer { /*address 0x240 to 0x27F*/ + uint16_t timer; + uint8_t reserved; + uint8_t ctrl; + } txsoftimer[16]; + uint8_t reserved14[132]; + struct rxstaddr { /*address 0x304*/ + uint16_t addr; + uint16_t reserved; + } rxstaddr[15]; + uint8_t reserved15[4]; + struct txstaddr { /*address 0x344*/ + uint16_t addr; + uint16_t reserved; + } txstaddr[15]; + int8_t reserved16[4]; /*address 0x380*/ + struct irqmode { /*address 0x384*/ + int8_t inirqmode; + int8_t reserved21; + int8_t outirqmode; + int8_t reserved22; + } irqmode[15]; + /*The Microprocessor control*/ + uint8_t cpuctrl; /*address 0x3C0*/ + int8_t reserved17[15]; + /*The debug counters and workarounds*/ + uint8_t debug_rx_bcl; /*address 0x3D0*/ + uint8_t debug_rx_bch; /*address 0x3D1*/ + uint8_t debug_rx_status; /*address 0x3D2*/ + uint8_t debug_irq; /*address 0x3D3*/ + uint8_t debug_tx_bcl; /*address 0x3D4*/ + uint8_t debug_tx_bch; /*address 0x3D5*/ + uint8_t debug_tx_status; /*address 0x3D6*/ + uint8_t debug_ien; /*address 0x3D7*/ + uint8_t phywa_en; /*address 0x3D8*/ + /*endian*/ + uint8_t wa1_cnt; /*address 0x3D9*/ + int8_t reserved18[2]; /*address 0x3DA*/ + uint8_t endian_sfr_cs; /*address 0x3DC*/ + int8_t reserved19[2]; /*address 0x3DD*/ + uint8_t endian_sfr_s; /*address 0x3DF*/ + int8_t reserved20[2]; /*address 0x3E0*/ + uint16_t txmaxpack[15]; /*address 0x3E2*/ +}; + +struct CUSTOM_REGS { + uint32_t secure_ctrl; /*address 0x80000*/ + uint32_t secsid_atst; /*address 0x80004*/ + uint32_t nsaid_smmuid; /*address 0x80008*/ + uint32_t ace; /*address 0x8000c*/ + uint32_t wakeup; /*address 0x80010*/ + uint32_t debug; /*address 0x80014*/ +}; + +struct VHUB_REGS { + uint32_t gen_cfg; /*address 0x00*/ + uint32_t gen_st; /*address 0x04*/ + uint32_t bc_cfg; /*address 0x08*/ + uint32_t bc_st; /*address 0x0c*/ + uint32_t adp_cfg; /*address 0x10*/ + uint32_t adp_st; /*address 0x14*/ + uint32_t dbg_cfg; /*address 0x18*/ + uint32_t dbg_st; /*address 0x1c*/ + uint32_t utmip_cfg; /*address 0x20*/ + uint32_t utmip_st; /*address 0x24*/ +}; + +struct DMARegs { + uint32_t conf; /*address 0x400*/ + uint32_t sts; /*address 0x404*/ + uint32_t reserved5[5]; + uint32_t ep_sel; /*address 0x41C*/ + uint32_t traddr; /*address 0x420*/ + uint32_t ep_cfg; /*address 0x424*/ + uint32_t ep_cmd; /*address 0x428*/ + uint32_t ep_sts; /*address 0x42c*/ + uint32_t ep_sts_sid;/*address 0x430*/ + uint32_t ep_sts_en; /*address 0x434*/ + uint32_t drbl; /*address 0x438*/ + uint32_t ep_ien; /*address 0x43C*/ + uint32_t ep_ists; /*address 0x440*/ +}; + +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/pci.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/pci.c new file mode 100644 index 0000000000000000000000000000000000000000..b4d675effb88b56a36f41e2a94e5b78f4eff5c17 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/pci.c @@ -0,0 +1,208 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include +#include +#include +#include +#include +#include +#include +#include "core.h" + +#define PHYTIUM_OTG_USB_LOADED 3 + +static bool phytium_hw_is_device(struct phytium_cusb *config) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return false; +} + +static bool phytium_hw_is_host(struct phytium_cusb *config) +{ + pr_info("%s %d\n", __func__, __LINE__); + + return true; +} + +static int phytium_get_dr_mode(struct phytium_cusb *config) +{ + enum usb_dr_mode mode; + + config->dr_mode = usb_get_dr_mode(config->dev); + if (config->dr_mode == USB_DR_MODE_UNKNOWN) + config->dr_mode = USB_DR_MODE_OTG; + + mode = config->dr_mode; + if (phytium_hw_is_device(config)) { + if (IS_ENABLED(CONFIG_USB_PHYTIUM_HOST)) { + dev_err(config->dev, "Controller does not support host mode.\n"); + return -EINVAL; + } + + mode = USB_DR_MODE_PERIPHERAL; + } else if (phytium_hw_is_host(config)) { + if (IS_ENABLED(CONFIG_USB_PHYTIUM_PERIPHERAL)) { + dev_err(config->dev, "Controller does not support device mode.\n"); + return -EINVAL; + } + mode = USB_DR_MODE_HOST; + } else { + if (IS_ENABLED(CONFIG_USB_PHYTIUM_HOST)) + mode = USB_DR_MODE_HOST; + else if (IS_ENABLED(CONFIG_USB_PHYTIUM_PERIPHERAL)) + mode = USB_DR_MODE_PERIPHERAL; + } + + if (mode != config->dr_mode) { + dev_warn(config->dev, "Configuration mismatch. dr_mode forced to %s\n", + mode == USB_DR_MODE_HOST ? "host" : "device"); + config->dr_mode = mode; + } + + return 0; +} + +static int phytium_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid) +{ + struct phytium_cusb *config; + int retval = 0; + + if (usb_disabled()) + return -ENODEV; + + retval = pcim_enable_device(pdev); + if (retval < 0) { + dev_err(&pdev->dev, "pcim_enable_device failed\n"); + return -ENODEV; + } + pci_set_master(pdev); + + config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL); + if (!config) + return -ENOMEM; + + spin_lock_init(&config->lock); + config->dev = &pdev->dev; + + config->irq = pdev->irq; + if (config->irq <= 0) { + dev_err(config->dev, "getting usb irq failed\n"); + return config->irq; + } + + config->regs = pci_iomap(pdev, 0, 0); + if (IS_ERR(config->regs)) { + dev_err(config->dev, "map IOMEM resource failed\n"); + return -1; + } + + if (!pdev->dev.dma_mask) + pdev->dev.dma_mask = &pdev->dev.coherent_dma_mask; + + if (dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64))) + dev_err(&pdev->dev, "failed to set 64-bit dma\n"); + else if (dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32))) + dev_err(&pdev->dev, "failed to set 32-bit dma\n"); + + pci_enable_msi(pdev); + + phytium_get_dr_mode(config); + + phytium_core_reset(config, false); + + if (config->dr_mode == USB_DR_MODE_HOST || config->dr_mode == USB_DR_MODE_OTG) + phytium_host_init(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) + phytium_gadget_init(config); + + dev_set_drvdata(config->dev, config); + + return 0; +} + +static void phytium_pci_remove(struct pci_dev *pdev) +{ + struct phytium_cusb *config = dev_get_drvdata(&pdev->dev); + + phytium_get_dr_mode(config); + if (config->dr_mode == USB_DR_MODE_HOST || config->dr_mode == USB_DR_MODE_OTG) + phytium_host_uninit(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) + phytium_gadget_uninit(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) + usb_del_gadget_udc(&config->gadget); + + dev_set_drvdata(&pdev->dev, NULL); + pr_info("%s %d\n", __func__, __LINE__); +} + +static void phytium_pci_shutdown(struct pci_dev *pdev) +{ + struct phytium_cusb *config; + + config = dev_get_drvdata(&pdev->dev); + + phytium_get_dr_mode(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || config->dr_mode == USB_DR_MODE_OTG) + usb_del_gadget_udc(&config->gadget); +} + +#ifdef CONFIG_PM +static int phytium_pci_resume(struct pci_dev *pdev) +{ + unsigned long flags = 0; + struct phytium_cusb *config; + int ret = 0; + + config = dev_get_drvdata(&pdev->dev); + + spin_lock_irqsave(&config->lock, flags); + ret = phytium_host_resume(config); + spin_unlock_irqrestore(&config->lock, flags); + + return ret; +} + +static int phytium_pci_suspend(struct pci_dev *pdev, pm_message_t state) +{ + unsigned long flags = 0; + struct phytium_cusb *config; + int ret; + + config = dev_get_drvdata(&pdev->dev); + + spin_lock_irqsave(&config->lock, flags); + ret = phytium_host_suspend(config); + spin_unlock_irqrestore(&config->lock, flags); + + return 0; +} +#endif + +const struct pci_device_id phytium_pci_id_table[] = { + {0x10ee, 0x8012, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, + {} +}; + +static struct pci_driver phytium_otg_driver = { + .name = "phytium_usb", + .id_table = phytium_pci_id_table, + .probe = phytium_pci_probe, + .remove = phytium_pci_remove, + .shutdown = phytium_pci_shutdown, +#ifdef CONFIG_PM + .resume = phytium_pci_resume, + .suspend = phytium_pci_suspend, +#endif +}; + +module_pci_driver(phytium_otg_driver); + +MODULE_AUTHOR("Chen Zhenhua "); +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium usb pci wrapper"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/platform.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/platform.c new file mode 100644 index 0000000000000000000000000000000000000000..48f35b19ade72ac5b518b2d3bdc7070b6388d0a1 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/usb/phytium/platform.c @@ -0,0 +1,217 @@ +// SPDX-License-Identifier: GPL-2.0 +#include +#include +//#include +#include +#include +#include +#include +#include +#include +#include "core.h" +#include "hw-regs.h" + +#define PHYTIUM_OTG_USB_LOADED 3 +#define USB2_2_BASE_ADDRESS 0x31800000 + +static const struct of_device_id phytium_otg_of_match[] = { + { + .compatible = "phytium,usb2", + }, + {}, +}; +MODULE_DEVICE_TABLE(of, phytium_otg_of_match); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_otg_acpi_match[] = { + { "PHYT0037", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, phytium_otg_acpi_match); +#endif + +static int phytium_get_dr_mode(struct phytium_cusb *config) +{ + config->dr_mode = usb_get_dr_mode(config->dev); + if (config->dr_mode == USB_DR_MODE_UNKNOWN) + config->dr_mode = USB_DR_MODE_PERIPHERAL; + + return 0; +} + +static irqreturn_t platform_usb_irq(int irq, void *dev_id) +{ + unsigned long flags; + uint8_t otgstate; + + struct phytium_cusb *config = (struct phytium_cusb *)dev_id; + struct GADGET_CTRL *gadget_ctrl = config->gadget_priv; + struct HOST_CTRL *host_ctrl = config->host_priv; + + if (gadget_ctrl || host_ctrl) { + if (host_ctrl) + otgstate = phytium_read8(&host_ctrl->regs->otgstate); + else + otgstate = phytium_read8(&gadget_ctrl->regs->otgstate); + + spin_lock_irqsave(&config->lock, flags); + if (otgstate > HOST_OTG_STATE_A_WAIT_VFALL) + config->gadget_obj->gadget_isr(config->gadget_priv); + else + config->host_obj->host_isr(config->host_priv); + spin_unlock_irqrestore(&config->lock, flags); + } + + return IRQ_HANDLED; +} + +static int phytium_driver_probe(struct platform_device *pdev) +{ + struct phytium_cusb *config; + struct resource *res, *phy_res; + int retval = 0; + + config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL); + if (!config) + return -ENOMEM; + + spin_lock_init(&config->lock); + config->dev = &pdev->dev; + config->isVhubHost = false; + + config->irq = platform_get_irq(pdev, 0); + if (config->irq <= 0) { + dev_err(config->dev, "getting usb irq failed\n"); + return config->irq; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + config->regs = devm_ioremap(&pdev->dev, res->start, resource_size(res)); + if (IS_ERR(config->regs)) { + dev_err(config->dev, "map IOMEM resource failed\n"); + return -1; + } + + phy_res = platform_get_resource(pdev, IORESOURCE_MEM, 1); + config->phy_regs = devm_ioremap(&pdev->dev, phy_res->start, resource_size(phy_res)); + if (IS_ERR(config->phy_regs)) { + dev_err(config->dev, "map IOMEM phy resource failed\n"); + return -1; + } + + phytium_get_dr_mode(config); + + phytium_core_reset(config, false); + + if (config->dr_mode == USB_DR_MODE_HOST || + config->dr_mode == USB_DR_MODE_OTG) { + if (res->start == USB2_2_BASE_ADDRESS) + config->isVhubHost = true; + + phytium_host_init(config); + } + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || + config->dr_mode == USB_DR_MODE_OTG) + phytium_gadget_init(config); + + dev_set_drvdata(&pdev->dev, config); + + if (config->irq > 0) { + retval = devm_request_irq(config->dev, config->irq, platform_usb_irq, + IRQF_SHARED, "phytium_otg", config); + if (retval != 0) { + dev_err(config->dev, "request irq %d err %d\n", config->irq, retval); + config->irq = 0; + } + } + + return retval; +} + +static int phytium_driver_remove(struct platform_device *dev) +{ + struct phytium_cusb *config = platform_get_drvdata(dev); + + if (!config) + return 0; + + phytium_get_dr_mode(config); + + if (config->dr_mode == USB_DR_MODE_HOST || + config->dr_mode == USB_DR_MODE_OTG) + phytium_host_uninit(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || + config->dr_mode == USB_DR_MODE_OTG) + phytium_gadget_uninit(config); + + dev_set_drvdata(&dev->dev, NULL); + return 0; +} + +static void phytium_driver_shutdown(struct platform_device *dev) +{ + pr_info("%s %d\n", __func__, __LINE__); +} + +#ifdef CONFIG_PM +static int phytium_driver_suspend(struct device *dev) +{ + struct phytium_cusb *config; + int ret = 0; + + config = dev_get_drvdata(dev); + + if (config->dr_mode == USB_DR_MODE_HOST || + config->dr_mode == USB_DR_MODE_OTG) + ret = phytium_host_suspend(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || + config->dr_mode == USB_DR_MODE_OTG) + ret = phytium_gadget_suspend(config); + + return ret; +} + +static int phytium_driver_resume(struct device *dev) +{ + struct phytium_cusb *config; + int ret = 0; + + config = dev_get_drvdata(dev); + if (config->dr_mode == USB_DR_MODE_HOST || + config->dr_mode == USB_DR_MODE_OTG) + ret = phytium_host_resume(config); + + if (config->dr_mode == USB_DR_MODE_PERIPHERAL || + config->dr_mode == USB_DR_MODE_OTG) + ret = phytium_gadget_resume(config); + + return ret; +} + +static const struct dev_pm_ops phytium_usb_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(phytium_driver_suspend, phytium_driver_resume) +}; +#endif + +static struct platform_driver phytium_otg_driver = { + .driver = { + .name = "phytium-otg", + .of_match_table = of_match_ptr(phytium_otg_of_match), + .acpi_match_table = ACPI_PTR(phytium_otg_acpi_match), +#ifdef CONFIG_PM + .pm = &phytium_usb_pm_ops, +#endif + }, + .probe = phytium_driver_probe, + .remove = phytium_driver_remove, + .shutdown = phytium_driver_shutdown, +}; + +module_platform_driver(phytium_otg_driver); + +MODULE_AUTHOR("Chen Zhenhua "); +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Phytium usb platform wrapper"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/w1/masters/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/drivers/w1/masters/Kconfig new file mode 100755 index 0000000000000000000000000000000000000000..5be3069c6b248440254cdf107bef78f550af8385 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/w1/masters/Kconfig @@ -0,0 +1,10 @@ +config W1_MASTER_PHYTIUM + bool "Phytium 1-wire driver" + depends on ARCH_PHYTIUM || COMPILE_TEST + help + Say Y here if you want to get support for the 1-wire interface + on an Phytium SoC. + + This driver can also be built as a module. If so, the module + will be called phytium-w1. + diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/w1/masters/Makefile b/device_soc_phytium/common/kernel/linux-6.6/drivers/w1/masters/Makefile new file mode 100755 index 0000000000000000000000000000000000000000..b85e48ffde2b1c93b74ee0659052bad52dae0b8d --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/w1/masters/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_W1_MASTER_PHYTIUM) += phytium_w1.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/drivers/w1/masters/phytium_w1.c b/device_soc_phytium/common/kernel/linux-6.6/drivers/w1/masters/phytium_w1.c new file mode 100644 index 0000000000000000000000000000000000000000..0cb62258daec91f8cfc6eb2b13667fbe4c298494 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/drivers/w1/masters/phytium_w1.c @@ -0,0 +1,643 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium 1-wire bus master driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +#define PHY_W1M_CTL 0x08 + +/* Simplify mode */ +#define PHY_W1M_CMD 0x04 +#define PHY_W1M_PWM0_START_B 0x30 +#define PHY_W1M_PWM0_END_B 0x34 +#define PHY_W1M_PWM1_START_B 0x38 +#define PHY_W1M_PWM1_END_B 0x3c +#define PHY_W1M_SAMPLE_B 0x40 +#define PHY_W1M_INT_EN_B 0x64 +#define PHY_W1M_INT_STATUS_B 0x74 +#define PHY_W1M_DATA_REG 0x70 + +#define PHY_W1M_CMD_ROM_SEARCH 0xF0 +#define PHY_W1M_CMD_WRITE_BIT 0x35 +#define PHY_W1M_CMD_WRITE_BYTE 0x36 +#define PHY_W1M_CMD_RESET_BUS 0x37 +#define PHY_W1M_CMD_READ_BIT 0x3A +#define PHY_W1M_CMD_READ_BYTE 0x3B +#define PHY_W1M_SLAVE_ROM_ID 0x160 + +#define PHY_W1M_INT_EN_TXCOMPLETE BIT(6) +#define PHY_W1M_INT_EN_RXCOMPLETE BIT(7) + +#define PHY_W1M_INT_STATUS_TXCOMPLETE BIT(6) +#define PHY_W1M_INT_STATUS_RXCOMPLETE BIT(7) + +#define W1M_MOD_W1 1 +#define W1M_MOD_PECI 0 + +#define PHY_W1M_FLAG_CLEAR 0 +#define PHY_W1M_FLAG_SET 1 +#define PHY_W1M_TIMEOUT (HZ/5) + +#define PHY_W1M_MAX_USER 4 + +static DECLARE_WAIT_QUEUE_HEAD(w1m_wait_queue); + +struct w1m_data { + struct device *dev; + void __iomem *w1m_base; + /* lock status update */ + struct mutex w1m_mutex; + int w1m_usecount; + u8 w1m_irqstatus; + /* device lock */ + spinlock_t w1m_spinlock; + /* + * Used to control the call to phytium_w1m_get and phytium_w1m_put. + * Non-w1 Protocol: Write the CMD|REG_address first, followed by + * the data wrire or read. + */ + int init_trans; +}; + +/* W1 register I/O routines */ +static inline u8 phytium_w1m_read(struct w1m_data *w1m_data, u32 offset) +{ + return readl(w1m_data->w1m_base + offset); +} + +static inline void phytium_w1m_write(struct w1m_data *w1m_data, u32 offset, u8 val) +{ + writel(val, w1m_data->w1m_base + offset); +} + +static inline u8 phytium_w1m_merge(struct w1m_data *w1m_data, u32 offset, + u8 val, u8 mask) +{ + u8 new_val = (__raw_readl(w1m_data->w1m_base + offset) & ~mask) + | (val & mask); + writel(new_val, w1m_data->w1m_base + offset); + + return new_val; +} + +static void w1m_disable_interrupt(struct w1m_data *w1m_data, u32 offset, + u32 mask) +{ + u32 ie; + + ie = readl(w1m_data->w1m_base + offset); + writel(ie & mask, w1m_data->w1m_base + offset); +} + +/* write out a byte or bit and fill *status with W1M_INT_STATUS */ +static int phytium_write_data(struct w1m_data *w1m_data, u8 val, u8 *status, bool is_bit) +{ + int ret; + unsigned long irqflags; + + *status = 0; + + spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); + /* clear interrupt flags via a dummy read */ + phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); + /* ISR loads it with new INT_STATUS */ + w1m_data->w1m_irqstatus = 0; + spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); + + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_TXCOMPLETE, + PHY_W1M_INT_EN_TXCOMPLETE); + + phytium_w1m_write(w1m_data, PHY_W1M_DATA_REG, val); + phytium_w1m_write(w1m_data, PHY_W1M_CMD, is_bit ? PHY_W1M_CMD_WRITE_BIT : PHY_W1M_CMD_WRITE_BYTE); + + /* wait for the TXCOMPLETE bit */ + ret = wait_event_timeout(w1m_wait_queue, + w1m_data->w1m_irqstatus, PHY_W1M_TIMEOUT); + if (ret == 0) { + dev_err(w1m_data->dev, "TX wait elapsed\n"); + ret = -ETIMEDOUT; + goto out; + } + + *status = w1m_data->w1m_irqstatus; + /* check irqstatus */ + if (!(*status & PHY_W1M_INT_STATUS_TXCOMPLETE)) { + dev_err(w1m_data->dev, + "timeout waiting for TXCOMPLETE/RXCOMPLETE, %x", *status); + ret = -ETIMEDOUT; + } + +out: + return ret; +} + +static irqreturn_t w1m_isr(int irq, void *_w1m) +{ + struct w1m_data *w1m_data = _w1m; + unsigned long irqflags; + + spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); + w1m_data->w1m_irqstatus = phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); + spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); + + phytium_w1m_write(w1m_data, PHY_W1M_INT_STATUS_B, 0x00); + if (w1m_data->w1m_irqstatus & + (PHY_W1M_INT_STATUS_TXCOMPLETE | PHY_W1M_INT_STATUS_RXCOMPLETE)) { + /* wake up sleeping process */ + wake_up(&w1m_wait_queue); + } + + return IRQ_HANDLED; +} + + +static int phytium_read_data(struct w1m_data *w1m_data, u8 *val, bool is_bit) +{ + int ret = 0; + u8 status; + unsigned long irqflags; + + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + ret = -EINTR; + goto rtn; + } + + if (!w1m_data->w1m_usecount) { + ret = -EINVAL; + goto out; + } + + spin_lock_irqsave(&w1m_data->w1m_spinlock, irqflags); + /* clear interrupt flags via a dummy read */ + phytium_w1m_read(w1m_data, PHY_W1M_INT_STATUS_B); + /* ISR loads it with new INT_STATUS */ + w1m_data->w1m_irqstatus = 0; + spin_unlock_irqrestore(&w1m_data->w1m_spinlock, irqflags); + + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_RXCOMPLETE, + PHY_W1M_INT_EN_RXCOMPLETE); + + phytium_w1m_write(w1m_data, PHY_W1M_CMD, is_bit ? PHY_W1M_CMD_READ_BIT : PHY_W1M_CMD_READ_BYTE); + + wait_event_timeout(w1m_wait_queue, + (w1m_data->w1m_irqstatus & PHY_W1M_INT_STATUS_RXCOMPLETE), + PHY_W1M_TIMEOUT); + + status = w1m_data->w1m_irqstatus; + /* check irqstatus */ + if (!(status & PHY_W1M_INT_STATUS_RXCOMPLETE)) { + dev_err(w1m_data->dev, "timeout waiting for RXCOMPLETE, %x", status); + ret = -ETIMEDOUT; + goto out; + } + + /* the data is ready. Read it in! */ + *val = phytium_w1m_read(w1m_data, PHY_W1M_DATA_REG); +out: + mutex_unlock(&w1m_data->w1m_mutex); +rtn: + return ret; +} + + +static int phytium_w1m_get(struct w1m_data *w1m_data) +{ + int ret = 0; + + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + ret = -EINTR; + goto rtn; + } + + if (w1m_data->w1m_usecount == PHY_W1M_MAX_USER) { + dev_warn(w1m_data->dev, "attempt to exceed the max use count"); + ret = -EINVAL; + goto out; + } else { + w1m_data->w1m_usecount++; + try_module_get(THIS_MODULE); + if (w1m_data->w1m_usecount == 1) + pm_runtime_get_sync(w1m_data->dev); + } + +out: + mutex_unlock(&w1m_data->w1m_mutex); +rtn: + return ret; +} + +/* Disable clocks to the module */ +static int phytium_w1m_put(struct w1m_data *w1m_data) +{ + int ret = 0; + + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) + return -EINTR; + + if (w1m_data->w1m_usecount == 0) { + dev_warn(w1m_data->dev, + "attempt to decrement use count when it is zero"); + ret = -EINVAL; + } else { + w1m_data->w1m_usecount--; + module_put(THIS_MODULE); + if (w1m_data->w1m_usecount == 0) + pm_runtime_put_sync(w1m_data->dev); + } + mutex_unlock(&w1m_data->w1m_mutex); + + return ret; +} + +/* + * W1 triplet callback function - used for searching ROM addresses. + * Registered only when controller is in 1-wire mode. + */ +static u8 phytium_w1_triplet(void *_w1m, u8 bdir) +{ + u8 id_bit, comp_bit; + int err; + u8 ret = 0x3; /* no slaves responded */ + struct w1m_data *w1m_data = _w1m; + + phytium_w1m_get(_w1m); + + err = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (err < 0) { + dev_err(w1m_data->dev, "Could not acquire mutex\n"); + goto rtn; + } + + w1m_data->w1m_irqstatus = 0; + /* read id_bit */ + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_RXCOMPLETE, + PHY_W1M_INT_EN_RXCOMPLETE); + phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); + + err = wait_event_timeout(w1m_wait_queue, + (w1m_data->w1m_irqstatus + & PHY_W1M_INT_STATUS_RXCOMPLETE), + PHY_W1M_TIMEOUT); + if (err == 0) { + dev_err(w1m_data->dev, "RX wait elapsed\n"); + goto out; + } + id_bit = (phytium_w1m_read(_w1m, PHY_W1M_DATA_REG) & 0x01); + + w1m_data->w1m_irqstatus = 0; + /* read comp_bit */ + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_RXCOMPLETE, + PHY_W1M_INT_EN_RXCOMPLETE); + phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); + err = wait_event_timeout(w1m_wait_queue, + (w1m_data->w1m_irqstatus + & PHY_W1M_INT_STATUS_RXCOMPLETE), + PHY_W1M_TIMEOUT); + if (err == 0) { + dev_err(w1m_data->dev, "RX wait elapsed\n"); + goto out; + } + comp_bit = (phytium_w1m_read(_w1m, PHY_W1M_DATA_REG) & 0x01); + + if (id_bit && comp_bit) { + ret = 0x03; /* no slaves responded */ + goto out; + } + if (!id_bit && !comp_bit) { + /* Both bits are valid, take the direction given */ + ret = bdir ? 0x04 : 0; + } else { + /* Only one bit is valid, take that direction */ + bdir = id_bit; + ret = id_bit ? 0x05 : 0x02; + } + + w1m_data->w1m_irqstatus = 0; + /* write bdir bit */ + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_TXCOMPLETE, + PHY_W1M_INT_EN_TXCOMPLETE); + + phytium_w1m_write(w1m_data, PHY_W1M_DATA_REG, bdir); + phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x35); + + err = wait_event_timeout(w1m_wait_queue, + (w1m_data->w1m_irqstatus + & PHY_W1M_INT_STATUS_TXCOMPLETE), + PHY_W1M_TIMEOUT); + if (err == 0) { + dev_err(w1m_data->dev, "TX wait elapsed\n"); + goto out; + } + +out: + mutex_unlock(&w1m_data->w1m_mutex); +rtn: + phytium_w1m_put(_w1m); + return ret; +} + +static u8 phytium_w1_touch_bit(void *_w1m, u8 bit) +{ + u8 result = 0; + int err; + struct w1m_data *w1m_data = _w1m; + + phytium_w1m_get(w1m_data); + + w1m_data->init_trans++; + + err = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (err < 0) { + dev_err(w1m_data->dev, "Could not acquired mutex\n"); + goto rtn; + } + + w1m_data->w1m_irqstatus = 0; + + phytium_w1m_merge(w1m_data, PHY_W1M_INT_EN_B, + PHY_W1M_INT_EN_RXCOMPLETE, + PHY_W1M_INT_EN_RXCOMPLETE); + phytium_w1m_write(w1m_data, PHY_W1M_CMD, 0x3a); + + err = wait_event_timeout(w1m_wait_queue, + (w1m_data->w1m_irqstatus & PHY_W1M_INT_STATUS_RXCOMPLETE), + PHY_W1M_TIMEOUT); + if (err == 0) { + dev_info(w1m_data->dev, "Rx wait elapsed\n"); + goto out; + } + + result = (phytium_w1m_read(w1m_data, PHY_W1M_DATA_REG) & 0x01); + + w1m_data->w1m_irqstatus = 0; + +out: + mutex_unlock(&w1m_data->w1m_mutex); +rtn: + phytium_w1m_put(w1m_data); + + return result; +} + +/* reset callback */ +static u8 phytium_w1_reset_bus(void *_w1m) +{ + phytium_w1m_get(_w1m); + phytium_w1m_write(_w1m, PHY_W1M_CMD, 0x37); + mdelay(1); + phytium_w1m_put(_w1m); + return 0; +} + +/* Read a byte of data from the device */ +static u8 phytium_w1_read_data(void *_w1m, bool is_bit) +{ + struct w1m_data *w1m_data = _w1m; + u8 val = 0; + int ret; + + /* First write to initialize the transfer */ + if (w1m_data->init_trans == 0) + phytium_w1m_get(w1m_data); + + w1m_data->init_trans++; + ret = phytium_read_data(w1m_data, &val, is_bit); + if (ret) { + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + dev_err(w1m_data->dev, "Could not acquire mutex\n"); + return -EINTR; + } + w1m_data->init_trans = 0; + mutex_unlock(&w1m_data->w1m_mutex); + phytium_w1m_put(w1m_data); + return -1; + } + + w1m_disable_interrupt(w1m_data, PHY_W1M_INT_EN_B, + ~((u32)PHY_W1M_INT_EN_RXCOMPLETE)); + + /* Write followed by a read, release the module */ + if (w1m_data->init_trans) { + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + dev_err(w1m_data->dev, "Could not acquire mutex\n"); + return -EINTR; + } + w1m_data->init_trans = 0; + mutex_unlock(&w1m_data->w1m_mutex); + phytium_w1m_put(w1m_data); + } + + return val; +} + +static u8 phytium_w1_read_bit(void *_w1m) +{ + return phytium_w1_read_data(_w1m, true); +} + +static u8 phytium_w1_read_byte(void *_w1m) +{ + return phytium_w1_read_data(_w1m, false); +} + +/* Write a byte of data to the device */ +static void phytium_w1_write_data(void *_w1m, u8 byte, bool is_bit) +{ + struct w1m_data *w1m_data = _w1m; + int ret; + u8 status; + + /* First write to initialize the transfer */ + if (w1m_data->init_trans == 0) + phytium_w1m_get(w1m_data); + + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + dev_err(w1m_data->dev, "Could not acquire mutex\n"); + return; + } + mutex_unlock(&w1m_data->w1m_mutex); + + ret = phytium_write_data(w1m_data, byte, &status, is_bit); + if (ret < 0) { + dev_err(w1m_data->dev, "TX failure:Ctrl status %x\n", status); + return; + } + + w1m_data->init_trans++; + w1m_disable_interrupt(w1m_data, PHY_W1M_INT_EN_B, + ~((u32)PHY_W1M_INT_EN_TXCOMPLETE)); + /* Second write, data transferred. Release the module */ + if (w1m_data->init_trans > 1) { + phytium_w1m_put(w1m_data); + ret = mutex_lock_interruptible(&w1m_data->w1m_mutex); + if (ret < 0) { + dev_err(w1m_data->dev, "Could not acquire mutex\n"); + return; + } + w1m_data->init_trans = 0; + mutex_unlock(&w1m_data->w1m_mutex); + } +} + +static void phytium_w1_write_bit(void *_w1m, u8 bit) +{ + phytium_w1_write_data(_w1m, bit, true); +} + +static void phytium_w1_write_byte(void *_w1m, u8 bit) +{ + phytium_w1_write_data(_w1m, bit, false); +} + +static struct w1_bus_master phytium_w1_master = { + .read_byte = phytium_w1_read_byte, + .write_byte = phytium_w1_write_byte, + .read_bit = phytium_w1_read_bit, + .write_bit = phytium_w1_write_bit, + .reset_bus = phytium_w1_reset_bus, + .touch_bit = phytium_w1_touch_bit, +}; + +static int phytium_w1m_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct w1m_data *w1m_data; + struct resource *res; + int ret, irq; + + w1m_data = devm_kzalloc(dev, sizeof(*w1m_data), GFP_KERNEL); + if (!w1m_data) + return -ENOMEM; + + w1m_data->dev = dev; + platform_set_drvdata(pdev, w1m_data); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + w1m_data->w1m_base = devm_ioremap_resource(dev, res); + if (IS_ERR(w1m_data->w1m_base)) + return PTR_ERR(w1m_data->w1m_base); + + w1m_data->w1m_usecount = 0; + mutex_init(&w1m_data->w1m_mutex); + + pm_runtime_enable(&pdev->dev); + ret = pm_runtime_get_sync(&pdev->dev); + if (ret < 0) { + dev_err(&pdev->dev, "pm_runtime_get_sync failed\n"); + goto err_w1; + } + + spin_lock_init(&w1m_data->w1m_spinlock); + + irq = platform_get_irq(pdev, 0); + if (irq < 0) { + dev_err(&pdev->dev, "Failed to get IRQ: %d\n", irq); + ret = irq; + goto err_irq; + } + + ret = devm_request_irq(dev, irq, w1m_isr, 0, "phytium-w1", w1m_data); + if (ret < 0) { + dev_err(&pdev->dev, "could not request irq\n"); + goto err_irq; + } + + pm_runtime_put_sync(&pdev->dev); + + phytium_w1_master.triplet = phytium_w1_triplet; + phytium_w1m_write(w1m_data, PHY_W1M_CTL, 0x10); + phytium_w1m_write(w1m_data, PHY_W1M_INT_EN_B, 0x00); + + phytium_w1_master.data = w1m_data; + + ret = w1_add_master_device(&phytium_w1_master); + if (ret) { + dev_err(&pdev->dev, "Failure in registering w1 master\n"); + goto err_w1; + } + + return 0; + +err_irq: + pm_runtime_put_sync(&pdev->dev); +err_w1: + pm_runtime_disable(&pdev->dev); + + return ret; +} + +static int phytium_w1m_remove(struct platform_device *pdev) +{ + struct w1m_data *w1m_data = platform_get_drvdata(pdev); + + mutex_lock(&w1m_data->w1m_mutex); + + if (w1m_data->w1m_usecount) { + dev_warn(&pdev->dev, "removed when use count is not zero\n"); + mutex_unlock(&w1m_data->w1m_mutex); + return -EBUSY; + } + + mutex_unlock(&w1m_data->w1m_mutex); + + /* remove module dependency */ + pm_runtime_disable(&pdev->dev); + + return 0; +} + +static const struct of_device_id phytium_w1m_dt_ids[] = { + { .compatible = "phytium,w1" }, + { } +}; +MODULE_DEVICE_TABLE(of, phytium_w1m_dt_ids); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_w1m_acpi_ids[] = { + { "PHYT0034", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, phytium_w1m_acpi_ids); +#endif + +static struct platform_driver phytium_w1m_driver = { + .probe = phytium_w1m_probe, + .remove = phytium_w1m_remove, + .driver = { + .name = "phytium-w1", + .of_match_table = phytium_w1m_dt_ids, + .acpi_match_table = ACPI_PTR(phytium_w1m_acpi_ids), + }, +}; +module_platform_driver(phytium_w1m_driver); + +MODULE_AUTHOR("Zhu Mingshuai "); +MODULE_DESCRIPTION("Phytium w1 bus master driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..31e43c59c0a78057a74793a73b94aa2413fae33a --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/Kconfig @@ -0,0 +1,16 @@ +config SND_HDA_PHYTIUM + tristate "PHYTIUM HD Audio" + depends on SOUND + select SND_HDA + select SND_HDA_ALIGNED_MMIO + help + Say Y here to support the HDA controller present in PHYTIUM + SoCs + + This options enables support for the HD Audio controller + present in some PHYTIUM SoCs, used to communicate audio + to the "High Definition Audio" codec. + + To compile this driver as a module, choose M here: the module + will be called snd-hda-phytium. + diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/Makefile b/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..37f17b56b4f367046a5bf2c4a66d6e4867773cbe --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/Makefile @@ -0,0 +1,2 @@ +snd-hda-phytium-objs := hda_phytium.o +obj-$(CONFIG_SND_HDA_PHYTIUM) += snd-hda-phytium.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/hda_phytium.c b/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/hda_phytium.c new file mode 100644 index 0000000000000000000000000000000000000000..86cd17120b0d529ebb9e30b7873ccc7589248008 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/hda_phytium.c @@ -0,0 +1,1086 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Implementation of primary ALSA driver code for Phytium HD Audio. + * + * Copyright (c) 2018-2024 Phytium Technology Co., Ltd. + */ + +#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 "hda_controller.h" +#include "hda_phytium.h" + +#include "hda_intel_trace.h" + +/* position fix mode */ +enum { + POS_FIX_AUTO, + POS_FIX_LPIB, + POS_FIX_POSBUF, + POS_FIX_VIACOMBO, + POS_FIX_COMBO, +}; + +/* Define IN stream 0 FIFO size offset in VIA controller */ +#define VIA_IN_STREAM0_FIFO_SIZE_OFFSET 0x90 + +/* FT have 4 playback and 4 capture */ +#define FT4C_NUM_CAPTURE 4 +#define FT4C_NUM_PLAYBACK 4 + +#define DWORD_BYTE_WIDTH 4 +#define BYTE_BIT_WIDTH 8 + +static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; +static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; +static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; +static char *model[SNDRV_CARDS]; +static int position_fix[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = 1}; +static int bdl_pos_adj[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = -1}; +static int probe_mask[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = -1}; +static int probe_only[SNDRV_CARDS]; +static int jackpoll_ms[SNDRV_CARDS]; +static int single_cmd = -1; +static int enable_msi = -1; +#ifdef CONFIG_SND_HDA_INPUT_BEEP +static bool beep_mode[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = + CONFIG_SND_HDA_INPUT_BEEP_MODE}; +#endif + +module_param_array(index, int, NULL, 0444); +MODULE_PARM_DESC(index, "Index value for Intel HD audio interface."); +module_param_array(id, charp, NULL, 0444); +MODULE_PARM_DESC(id, "ID string for Intel HD audio interface."); +module_param_array(enable, bool, NULL, 0444); +MODULE_PARM_DESC(enable, "Enable Intel HD audio interface."); +module_param_array(model, charp, NULL, 0444); +MODULE_PARM_DESC(model, "Use the given board model."); +module_param_array(position_fix, int, NULL, 0444); +MODULE_PARM_DESC(position_fix, "DMA pointer read method. (-1 = system default, 0 = auto, 1 = LPIB, 2 = POSBUF, 3 = VIACOMBO, 4 = COMBO)."); +module_param_array(bdl_pos_adj, int, NULL, 0644); +MODULE_PARM_DESC(bdl_pos_adj, "BDL position adjustment offset."); +module_param_array(probe_mask, int, NULL, 0444); +MODULE_PARM_DESC(probe_mask, "Bitmask to probe codecs (default = -1)."); +module_param_array(probe_only, int, NULL, 0444); +MODULE_PARM_DESC(probe_only, "Only probing and no codec initialization."); +module_param_array(jackpoll_ms, int, NULL, 0444); +MODULE_PARM_DESC(jackpoll_ms, "Ms between polling for jack events (default = 0, using unsol events only)"); +module_param(single_cmd, bint, 0444); +MODULE_PARM_DESC(single_cmd, "Use single command to communicate with codecs (for debugging only)."); +module_param(enable_msi, bint, 0444); +MODULE_PARM_DESC(enable_msi, "Enable Message Signaled Interrupt (MSI)"); +#ifdef CONFIG_SND_HDA_INPUT_BEEP +module_param_array(beep_mode, bool, NULL, 0444); +MODULE_PARM_DESC(beep_mode, "Select HDA Beep registration mode (0=off, 1=on) (default=1)."); +#endif + +#define power_save 0 + +static int align_buffer_size = -1; +module_param(align_buffer_size, bint, 0644); +MODULE_PARM_DESC(align_buffer_size, + "Force buffer and period sizes to be multiple of 128 bytes."); + +/* driver types */ +enum { + AZX_DRIVER_ICH, + AZX_DRIVER_PCH, + AZX_DRIVER_SCH, + AZX_DRIVER_HDMI, + AZX_DRIVER_ATI, + AZX_DRIVER_ATIHDMI, + AZX_DRIVER_ATIHDMI_NS, + AZX_DRIVER_VIA, + AZX_DRIVER_SIS, + AZX_DRIVER_ULI, + AZX_DRIVER_NVIDIA, + AZX_DRIVER_TERA, + AZX_DRIVER_CTX, + AZX_DRIVER_CTHDA, + AZX_DRIVER_CMEDIA, + AZX_DRIVER_GENERIC, + AZX_DRIVER_FT, + AZX_NUM_DRIVERS, /* keep this as last entry */ +}; + +/* NOP for other archs */ +static inline void mark_pages_wc(struct azx *chip, struct snd_dma_buffer *buf, + bool on) +{ +} + +static inline void mark_runtime_wc(struct azx *chip, struct azx_dev *azx_dev, + struct snd_pcm_substream *substream, bool on) +{ +} + +static int azx_acquire_irq(struct azx *chip, int do_disconnect); + +/* calculate runtime delay from LPIB */ +static int azx_get_delay_from_lpib(struct azx *chip, struct azx_dev *azx_dev, + unsigned int pos) +{ + struct snd_pcm_substream *substream = azx_dev->core.substream; + int stream = substream->stream; + unsigned int lpib_pos = azx_get_pos_lpib(chip, azx_dev); + int delay; + + if (stream == SNDRV_PCM_STREAM_PLAYBACK) + delay = pos - lpib_pos; + else + delay = lpib_pos - pos; + if (delay < 0) { + if (delay >= azx_dev->core.delay_negative_threshold) + delay = 0; + else + delay += azx_dev->core.bufsize; + } + + if (delay >= azx_dev->core.period_bytes) { + dev_info(chip->card->dev, + "Unstable LPIB (%d >= %d); disabling LPIB delay counting\n", + delay, azx_dev->core.period_bytes); + delay = 0; + chip->driver_caps &= ~AZX_DCAPS_COUNT_LPIB_DELAY; + chip->get_delay[stream] = NULL; + } + + return bytes_to_frames(substream->runtime, delay); +} + +static int azx_position_ok(struct azx *chip, struct azx_dev *azx_dev); + +/* called from IRQ */ +static int azx_position_check(struct azx *chip, struct azx_dev *azx_dev) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + int ok; + + ok = azx_position_ok(chip, azx_dev); + if (ok == 1) { + azx_dev->irq_pending = 0; + return ok; + } else if (ok == 0) { + /* bogus IRQ, process it later */ + azx_dev->irq_pending = 1; + schedule_work(&hda->irq_pending_work); + } + return 0; +} + +static int azx_ft_link_power(struct azx *chip, bool enable) +{ + return 0; +} + +/* + * Check whether the current DMA position is acceptable for updating + * periods. Returns non-zero if it's OK. + * + * Many HD-audio controllers appear pretty inaccurate about + * the update-IRQ timing. The IRQ is issued before actually the + * data is processed. So, we need to process it afterwords in a + * workqueue. + */ +static int azx_position_ok(struct azx *chip, struct azx_dev *azx_dev) +{ + struct snd_pcm_substream *substream = azx_dev->core.substream; + int stream = substream->stream; + u32 wallclk; + unsigned int pos; + + wallclk = (azx_readl(chip, WALLCLK) - azx_dev->core.start_wallclk); + + if (wallclk < (azx_dev->core.period_wallclk * 2) / 3) + return -1; /* bogus (too early) interrupt */ + + if (chip->get_position[stream]) + pos = chip->get_position[stream](chip, azx_dev); + else { /* use the position buffer as default */ + pos = azx_get_pos_posbuf(chip, azx_dev); + if (!pos || pos == (u32)-1) { + dev_info(chip->card->dev, + "Invalid position buffer, using LPIB read method instead.\n"); + chip->get_position[stream] = azx_get_pos_lpib; + if (chip->get_position[0] == azx_get_pos_lpib && + chip->get_position[1] == azx_get_pos_lpib) + azx_bus(chip)->use_posbuf = false; + pos = azx_get_pos_lpib(chip, azx_dev); + chip->get_delay[stream] = NULL; + } else { + chip->get_position[stream] = azx_get_pos_posbuf; + if (chip->driver_caps & AZX_DCAPS_COUNT_LPIB_DELAY) + chip->get_delay[stream] = azx_get_delay_from_lpib; + } + } + + if (pos >= azx_dev->core.bufsize) + pos = 0; + + if (WARN_ONCE(!azx_dev->core.period_bytes, + "hda-ft: zero azx_dev->period_bytes")) + return -1; /* this shouldn't happen! */ + if (wallclk < (azx_dev->core.period_wallclk * 5) / 4 && + pos % azx_dev->core.period_bytes > azx_dev->core.period_bytes / 2) + /* NG - it's below the first next period boundary */ + return chip->bdl_pos_adj ? 0 : -1; + + azx_dev->core.start_wallclk += wallclk; + + return 1; /* OK, it's fine */ +} + +/* The work for pending PCM period updates. */ +static void azx_irq_pending_work(struct work_struct *work) +{ + struct hda_ft *hda = container_of(work, struct hda_ft, irq_pending_work); + struct azx *chip = &hda->chip; + struct hdac_bus *bus = azx_bus(chip); + struct hdac_stream *s; + int pending, ok; + + if (!hda->irq_pending_warned) { + dev_info(chip->card->dev, + "IRQ timing workaround is activated for card #%d. Suggest a bigger bdl_pos_adj.\n", + chip->card->number); + hda->irq_pending_warned = 1; + } + + for (;;) { + pending = 0; + spin_lock_irq(&bus->reg_lock); + list_for_each_entry(s, &bus->stream_list, list) { + struct azx_dev *azx_dev = stream_to_azx_dev(s); + + if (!azx_dev->irq_pending || + !s->substream || !s->running) + continue; + ok = azx_position_ok(chip, azx_dev); + if (ok > 0) { + azx_dev->irq_pending = 0; + spin_unlock(&bus->reg_lock); + snd_pcm_period_elapsed(s->substream); + spin_lock(&bus->reg_lock); + } else if (ok < 0) { + pending = 0; /* too early */ + } else { + pending++; + } + } + spin_unlock_irq(&bus->reg_lock); + if (!pending) + return; + udelay(1000); + } +} + +/* clear irq_pending flags and assure no on-going workq */ +static void azx_clear_irq_pending(struct azx *chip) +{ + struct hdac_bus *bus = azx_bus(chip); + struct hdac_stream *s; + + spin_lock_irq(&bus->reg_lock); + list_for_each_entry(s, &bus->stream_list, list) { + struct azx_dev *azx_dev = stream_to_azx_dev(s); + + azx_dev->irq_pending = 0; + } + spin_unlock_irq(&bus->reg_lock); +} + +static int azx_acquire_irq(struct azx *chip, int do_disconnect) +{ + struct hdac_bus *bus = azx_bus(chip); + + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + struct platform_device *pdev = to_platform_device(hda->dev); + int irq_id = platform_get_irq(pdev, 0); + int err; + + err = request_irq(irq_id, azx_interrupt, + IRQF_SHARED, KBUILD_MODNAME, chip); + if (err) { + dev_err(chip->card->dev, + "unable to request IRQ %d, disabling device\n", + irq_id); + if (do_disconnect) + snd_card_disconnect(chip->card); + return err; + } + bus->irq = irq_id; + + return 0; +} + +/* get the current DMA position with correction on VIA chips */ +static unsigned int azx_via_get_position(struct azx *chip, + struct azx_dev *azx_dev) +{ + unsigned int link_pos, mini_pos, bound_pos; + unsigned int mod_link_pos, mod_dma_pos, mod_mini_pos; + unsigned int fifo_size; + + link_pos = snd_hdac_stream_get_pos_lpib(azx_stream(azx_dev)); + if (azx_dev->core.substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + /* Playback, no problem using link position */ + return link_pos; + } + + /* Capture */ + /* For new chipset, + * use mod to get the DMA position just like old chipset + */ + mod_dma_pos = le32_to_cpu(*azx_dev->core.posbuf); + mod_dma_pos %= azx_dev->core.period_bytes; + + /* azx_dev->fifo_size can't get FIFO size of in stream. + * Get from base address + offset. + */ + fifo_size = readw(azx_bus(chip)->remap_addr + + VIA_IN_STREAM0_FIFO_SIZE_OFFSET); + + if (azx_dev->insufficient) { + /* Link position never gather than FIFO size */ + if (link_pos <= fifo_size) + return 0; + + azx_dev->insufficient = 0; + } + + if (link_pos <= fifo_size) + mini_pos = azx_dev->core.bufsize + link_pos - fifo_size; + else + mini_pos = link_pos - fifo_size; + + /* Find nearest previous boudary */ + mod_mini_pos = mini_pos % azx_dev->core.period_bytes; + mod_link_pos = link_pos % azx_dev->core.period_bytes; + if (mod_link_pos >= fifo_size) + bound_pos = link_pos - mod_link_pos; + else if (mod_dma_pos >= mod_mini_pos) + bound_pos = mini_pos - mod_mini_pos; + else { + bound_pos = mini_pos - mod_mini_pos + azx_dev->core.period_bytes; + if (bound_pos >= azx_dev->core.bufsize) + bound_pos = 0; + } + + /* Calculate real DMA position we want */ + return bound_pos + mod_dma_pos; +} + +#ifdef CONFIG_PM +static DEFINE_MUTEX(card_list_lock); +static LIST_HEAD(card_list); + +static void azx_add_card_list(struct azx *chip) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + + mutex_lock(&card_list_lock); + list_add(&hda->list, &card_list); + mutex_unlock(&card_list_lock); +} + +static void azx_del_card_list(struct azx *chip) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + + mutex_lock(&card_list_lock); + list_del_init(&hda->list); + mutex_unlock(&card_list_lock); +} + +#else +#define azx_add_card_list(chip) /* NOP */ +#define azx_del_card_list(chip) /* NOP */ +#endif /* CONFIG_PM */ + +#if defined(CONFIG_PM_SLEEP) +/* power management */ +static int azx_suspend(struct device *dev) +{ + struct snd_card *card = dev_get_drvdata(dev); + struct azx *chip; + struct hda_ft *hda; + struct hdac_bus *bus; + + if (!card) + return 0; + + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + if (chip->disabled || !chip->running) + return 0; + + bus = azx_bus(chip); + snd_power_change_state(card, SNDRV_CTL_POWER_D3hot); + azx_clear_irq_pending(chip); + azx_stop_chip(chip); + if (bus->irq >= 0) { + free_irq(bus->irq, (void *)chip); + bus->irq = -1; + } + + return 0; +} + +static int azx_resume(struct device *dev) +{ + struct snd_card *card = dev_get_drvdata(dev); + struct azx *chip; + struct hda_ft *hda; + struct hdac_bus *bus; + int index; + struct snd_pcm_substream *substream; + struct azx_dev *azx_dev; + int err; + + if (!card) + return 0; + + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + bus = azx_bus(chip); + if (chip->disabled || !chip->running) + return 0; + + if (azx_acquire_irq(chip, 1) < 0) + return -EIO; + + index = chip->dev_index; + + snd_hdac_bus_exit_link_reset(bus); + usleep_range(1000, 1200); + + azx_init_chip(chip, 0); + + snd_power_change_state(card, SNDRV_CTL_POWER_D0); + + if (hda->substream && hda->substream->runtime) { + substream = hda->substream; + + if (substream->runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) { + substream->runtime->status->state = + substream->runtime->status->suspended_state; + err = substream->ops->prepare(substream); + if (err < 0) + return err; + } + + azx_dev = get_azx_dev(substream); + hda->substream = NULL; + } + + return 0; +} +#endif /* CONFIG_PM_SLEEP */ + +#ifdef CONFIG_PM +static int azx_runtime_suspend(struct device *dev) +{ + struct snd_card *card = dev_get_drvdata(dev); + struct azx *chip; + struct hda_ft *hda; + + if (!card) + return 0; + + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + if (chip->disabled) + return 0; + + if (!azx_has_pm_runtime(chip)) + return 0; + + azx_stop_chip(chip); + azx_enter_link_reset(chip); + azx_clear_irq_pending(chip); + + return 0; +} + +static int azx_runtime_resume(struct device *dev) +{ + struct snd_card *card = dev_get_drvdata(dev); + struct azx *chip; + struct hda_ft *hda; + struct hdac_bus *bus; + struct hda_codec *codec; + int status; + int index; + + if (!card) + return 0; + + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + bus = azx_bus(chip); + if (chip->disabled) + return 0; + + if (!azx_has_pm_runtime(chip)) + return 0; + + /* Read STATESTS before controller reset */ + status = azx_readw(chip, STATESTS); + + index = chip->dev_index; + + snd_hdac_bus_exit_link_reset(bus); + usleep_range(1000, 1200); + + azx_init_chip(chip, 0); + + if (status) { + list_for_each_codec(codec, &chip->bus) + if (status & (1 << codec->addr)) + schedule_delayed_work(&codec->jackpoll_work, + codec->jackpoll_interval); + } + + return 0; +} + +static int azx_runtime_idle(struct device *dev) +{ + struct snd_card *card = dev_get_drvdata(dev); + struct azx *chip; + struct hda_ft *hda; + + if (!card) + return 0; + + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + if (chip->disabled) + return 0; + + if (!azx_has_pm_runtime(chip) || + azx_bus(chip)->codec_powered || !chip->running) + return -EBUSY; + + return 0; +} + +static const struct dev_pm_ops azx_pm = { + SET_SYSTEM_SLEEP_PM_OPS(azx_suspend, azx_resume) + SET_RUNTIME_PM_OPS(azx_runtime_suspend, azx_runtime_resume, azx_runtime_idle) +}; + +#define hda_ft_pm (&azx_pm) +#else +#define hda_ft_pm NULL +#endif /* CONFIG_PM */ + +static int azx_probe_continue(struct azx *chip); + +/* + * destructor + */ +static int azx_free(struct azx *chip) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + struct hdac_bus *bus = azx_bus(chip); + struct platform_device *pdev = to_platform_device(hda->dev); + struct device *hddev = hda->dev; + + if (azx_has_pm_runtime(chip) && chip->running) + pm_runtime_get_noresume(&pdev->dev); + + azx_del_card_list(chip); + + complete_all(&hda->probe_wait); + + if (bus->chip_init) { + azx_clear_irq_pending(chip); + azx_stop_all_streams(chip); + azx_stop_chip(chip); + } + + if (bus->irq >= 0) { + free_irq(bus->irq, (void *)chip); + bus->irq = -1; + } + + devm_iounmap(hddev, bus->remap_addr); + + azx_free_stream_pages(chip); + azx_free_streams(chip); + snd_hdac_bus_exit(bus); + + return 0; +} + +static int azx_dev_disconnect(struct snd_device *device) +{ + struct azx *chip = device->device_data; + + chip->bus.shutdown = 1; + return 0; +} + +static int azx_dev_free(struct snd_device *device) +{ + return azx_free(device->device_data); +} + +static int check_position_fix(struct azx *chip, int fix) +{ + switch (fix) { + case POS_FIX_AUTO: + case POS_FIX_LPIB: + case POS_FIX_POSBUF: + case POS_FIX_VIACOMBO: + case POS_FIX_COMBO: + return fix; + } + + if (chip->driver_caps & AZX_DCAPS_POSFIX_LPIB) { + dev_dbg(chip->card->dev, "Using LPIB position fix\n"); + return POS_FIX_LPIB; + } + return POS_FIX_AUTO; +} + +static void assign_position_fix(struct azx *chip, int fix) +{ + static azx_get_pos_callback_t callbacks[] = { + [POS_FIX_AUTO] = NULL, + [POS_FIX_LPIB] = azx_get_pos_lpib, + [POS_FIX_POSBUF] = azx_get_pos_posbuf, + [POS_FIX_VIACOMBO] = azx_via_get_position, + [POS_FIX_COMBO] = azx_get_pos_lpib, + }; + + chip->get_position[0] = chip->get_position[1] = callbacks[fix]; + + /* combo mode uses LPIB only for playback */ + if (fix == POS_FIX_COMBO) + chip->get_position[1] = NULL; + + if (fix == POS_FIX_POSBUF && + (chip->driver_caps & AZX_DCAPS_COUNT_LPIB_DELAY)) { + chip->get_delay[0] = chip->get_delay[1] = + azx_get_delay_from_lpib; + } + +} + +#define AZX_FORCE_CODEC_MASK 0x100 + +static void check_probe_mask(struct azx *chip, int dev) +{ + chip->codec_probe_mask = probe_mask[dev]; + + /* check forced option */ + if (chip->codec_probe_mask != -1 && + (chip->codec_probe_mask & AZX_FORCE_CODEC_MASK)) { + azx_bus(chip)->codec_mask = chip->codec_probe_mask & 0xff; + dev_info(chip->card->dev, "codec_mask forced to 0x%x\n", + (int)azx_bus(chip)->codec_mask); + } +} + +static void azx_probe_work(struct work_struct *work) +{ + struct hda_ft *hda = container_of(work, struct hda_ft, probe_work); + + azx_probe_continue(&hda->chip); +} + +/* + * constructor + */ +static const struct hda_controller_ops axi_hda_ops; + +static int hda_ft_create(struct snd_card *card, struct platform_device *pdev, + int dev, unsigned int driver_caps, + struct azx **rchip) +{ + static struct snd_device_ops ops = { + .dev_disconnect = azx_dev_disconnect, + .dev_free = azx_dev_free, + }; + struct hda_ft *hda; + struct azx *chip; + int err; + + *rchip = NULL; + + hda = devm_kzalloc(&pdev->dev, sizeof(*hda), GFP_KERNEL); + if (!hda) + return -ENOMEM; + hda->dev = &pdev->dev; + chip = &hda->chip; + mutex_init(&chip->open_mutex); + chip->card = card; + chip->ops = &axi_hda_ops; + chip->driver_caps = driver_caps; + chip->driver_type = driver_caps & 0xff; + chip->dev_index = dev; + if (jackpoll_ms[dev] >= 50 && jackpoll_ms[dev] <= 60000) + chip->jackpoll_interval = msecs_to_jiffies(jackpoll_ms[dev]); + INIT_LIST_HEAD(&chip->pcm_list); + INIT_WORK(&hda->irq_pending_work, azx_irq_pending_work); + INIT_LIST_HEAD(&hda->list); + + init_completion(&hda->probe_wait); + assign_position_fix(chip, check_position_fix(chip, position_fix[dev])); + check_probe_mask(chip, dev); + + if (single_cmd < 0) /* allow fallback to single_cmd at errors */ + chip->fallback_to_single_cmd = 0; + else /* explicitly set to single_cmd or not */ + chip->single_cmd = single_cmd; + + if (bdl_pos_adj[dev] < 0) { + switch (chip->driver_type) { + case AZX_DRIVER_FT: + bdl_pos_adj[dev] = 32; + break; + default: + bdl_pos_adj[dev] = 32; + break; + } + } + chip->bdl_pos_adj = bdl_pos_adj[dev]; + + err = azx_bus_init(chip, model[dev]); + if (err < 0) { + return err; + } + + chip->bus.core.aligned_mmio = 1; + + err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops); + if (err < 0) { + dev_err(card->dev, "Error creating device [card]!\n"); + azx_free(chip); + return err; + } + + /* continue probing in work context as may trigger request module */ + INIT_WORK(&hda->probe_work, azx_probe_work); + + *rchip = chip; + + return 0; +} + +static int azx_first_init(struct azx *chip) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + struct platform_device *pdev = to_platform_device(hda->dev); + struct device *hddev = hda->dev; + + int dev = chip->dev_index; + bool full_reset; + + struct snd_card *card = chip->card; + struct hdac_bus *bus = azx_bus(chip); + int err; + unsigned short gcap; + unsigned int dma_bits = 64; + + struct resource *res; + const struct acpi_device_id *match; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + hda->regs = devm_ioremap_resource(hddev, res); + if (IS_ERR(hda->regs)) + return PTR_ERR(hda->regs); + + bus->addr = res->start; + bus->remap_addr = hda->regs; + if (bus->remap_addr == NULL) { + dev_err(card->dev, "ioremap error\n"); + return -ENXIO; + } + + bus->cmd_resend = 1; + + synchronize_irq(bus->irq); + + gcap = azx_readw(chip, GCAP); + dev_dbg(card->dev, "chipset global capabilities = 0x%x\n", gcap); + + /* disable 64bit DMA address on some devices */ + if (chip->driver_caps & AZX_DCAPS_NO_64BIT) { + dev_dbg(card->dev, "Disabling 64bit DMA\n"); + gcap &= ~AZX_GCAP_64OK; + } + + /* disable buffer size rounding to 128-byte multiples if supported */ + if (align_buffer_size >= 0) + chip->align_buffer_size = !!align_buffer_size; + else { + if (chip->driver_caps & AZX_DCAPS_NO_ALIGN_BUFSIZE) + chip->align_buffer_size = 0; + else + chip->align_buffer_size = 1; + } + + if (has_acpi_companion(hddev)) { + match = acpi_match_device(hddev->driver->acpi_match_table, hddev); + if (!match) { + dev_err(hddev, "Error ACPI match data is missing\n"); + return -ENODEV; + } + set_dma_ops(hddev, NULL); + acpi_dma_configure(hddev, DEV_DMA_NON_COHERENT); + } + + /* allow 64bit DMA address if supported by H/W */ + if (!(gcap & AZX_GCAP_64OK)) + dma_bits = 32; + if (!dma_set_mask(hddev, DMA_BIT_MASK(dma_bits))) { + dma_set_coherent_mask(hddev, DMA_BIT_MASK(dma_bits)); + } else { + dma_set_mask(hddev, DMA_BIT_MASK(32)); + dma_set_coherent_mask(hddev, DMA_BIT_MASK(32)); + } + + /* read number of streams from GCAP register instead of using + * hardcoded value + */ + chip->capture_streams = (gcap >> 8) & 0x0f; + chip->playback_streams = (gcap >> 12) & 0x0f; + if (!chip->playback_streams && !chip->capture_streams) { + /* gcap didn't give any info, switching to old method */ + chip->playback_streams = FT4C_NUM_PLAYBACK; + chip->capture_streams = FT4C_NUM_CAPTURE; + } + chip->capture_index_offset = 0; + chip->playback_index_offset = chip->capture_streams; + chip->num_streams = chip->playback_streams + chip->capture_streams; + + /* initialize streams */ + err = azx_init_streams(chip); + if (err < 0) + return err; + + err = azx_alloc_stream_pages(chip); + if (err < 0) + return err; + + full_reset = (probe_only[dev] & 2) ? false : true; + azx_init_chip(chip, full_reset); + + /* codec detection */ + if (!azx_bus(chip)->codec_mask) { + dev_err(card->dev, "no codecs found!\n"); + return -ENODEV; + } + + if (azx_acquire_irq(chip, 0) < 0) + return -EBUSY; + + strscpy(card->driver, "ft-hda", sizeof(card->driver)); + strscpy(card->shortname, "ft-hda", sizeof(card->shortname)); + snprintf(card->longname, sizeof(card->longname), + "%s at 0x%lx irq %i", + card->shortname, bus->addr, bus->irq); + + return 0; +} + + +static const struct hda_controller_ops axi_hda_ops = { + .position_check = azx_position_check, + .link_power = azx_ft_link_power, +}; + +static DECLARE_BITMAP(probed_devs, SNDRV_CARDS); + +static int hda_ft_probe(struct platform_device *pdev) +{ + const unsigned int driver_flags = AZX_DRIVER_FT; + struct snd_card *card; + struct hda_ft *hda; + struct azx *chip; + bool schedule_probe; + int err; + int dev; + + dev = find_first_zero_bit(probed_devs, SNDRV_CARDS); + + if (dev >= SNDRV_CARDS) + return -ENODEV; + if (!enable[dev]) { + set_bit(dev, probed_devs); + return -ENOENT; + } + + err = snd_card_new(&pdev->dev, index[dev], id[dev], THIS_MODULE, + 0, &card); + if (err < 0) { + dev_err(&pdev->dev, "Error creating card!\n"); + return err; + } + + err = hda_ft_create(card, pdev, dev, driver_flags, &chip); + if (err < 0) + goto out_free; + card->private_data = chip; + hda = container_of(chip, struct hda_ft, chip); + + dev_set_drvdata(&pdev->dev, card); + + schedule_probe = !chip->disabled; + + if (schedule_probe) + schedule_work(&hda->probe_work); + + set_bit(dev, probed_devs); + if (chip->disabled) + complete_all(&hda->probe_wait); + return 0; + +out_free: + snd_card_free(card); + return err; +} + +/* number of codec slots for each chipset: 0 = default slots (i.e. 4) */ +static unsigned int azx_max_codecs[AZX_NUM_DRIVERS] = { + [AZX_DRIVER_FT] = 4, +}; + +static int azx_probe_continue(struct azx *chip) +{ + struct hda_ft *hda = container_of(chip, struct hda_ft, chip); + struct device *hddev = hda->dev; + int dev = chip->dev_index; + int err; + struct hdac_bus *bus = azx_bus(chip); + + hda->probe_continued = 1; + + err = azx_first_init(chip); + if (err < 0) + goto out_free; + +#ifdef CONFIG_SND_HDA_INPUT_BEEP + chip->beep_mode = beep_mode[dev]; +#endif + + /* create codec instances */ + err = azx_probe_codecs(chip, azx_max_codecs[chip->driver_type]); + if (err < 0) + goto out_free; + + if ((probe_only[dev] & 1) == 0) { + err = azx_codec_configure(chip); + if (err < 0) + goto out_free; + } + + err = snd_card_register(chip->card); + if (err < 0) + goto out_free; + + chip->running = 1; + azx_add_card_list(chip); + snd_hda_set_power_save(&chip->bus, power_save * 1000); + + if (azx_has_pm_runtime(chip)) + pm_runtime_put_noidle(hddev); + return err; + +out_free: + if (bus->irq >= 0) { + free_irq(bus->irq, (void *)chip); + bus->irq = -1; + } + return err; +} + +static int hda_ft_remove(struct platform_device *pdev) +{ + struct snd_card *card = dev_get_drvdata(&pdev->dev); + struct azx *chip; + struct hda_ft *hda; + + if (card) { + /* cancel the pending probing work */ + chip = card->private_data; + hda = container_of(chip, struct hda_ft, chip); + cancel_work_sync(&hda->probe_work); + clear_bit(chip->dev_index, probed_devs); + + snd_card_free(card); + return 0; + } + return 0; +} + +static void hda_ft_shutdown(struct platform_device *pdev) +{ + struct snd_card *card = dev_get_drvdata(&pdev->dev); + struct azx *chip; + + if (!card) + return; + chip = card->private_data; + if (chip && chip->running) + azx_stop_chip(chip); +} + +static const struct of_device_id hda_ft_of_match[] = { + { .compatible = "phytium,hda" }, + {}, +}; +MODULE_DEVICE_TABLE(of, hda_ft_of_match); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id hda_ft_acpi_match[] = { + { .id = "PHYT0006" }, + {} +}; +MODULE_DEVICE_TABLE(acpi, hda_ft_acpi_match); +#else +#define hda_ft_acpi_match NULL +#endif + +static struct platform_driver ft_platform_hda = { + .driver = { + .name = "ft-hda", + .pm = hda_ft_pm, + .of_match_table = hda_ft_of_match, + .acpi_match_table = hda_ft_acpi_match, + }, + .probe = hda_ft_probe, + .remove = hda_ft_remove, + .shutdown = hda_ft_shutdown, +}; + +module_platform_driver(ft_platform_hda); + +MODULE_DESCRIPTION("FT HDA bus driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/hda_phytium.h b/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/hda_phytium.h new file mode 100644 index 0000000000000000000000000000000000000000..ec1f3e7f7b9cfa52ca5af33a376214efd2fb7947 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/pci/hda/hda_phytium.h @@ -0,0 +1,34 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Implementation of primary ALSA driver code base for Phytium HD Audio. + * + * Copyright (c) 2018-2024 Phytium Technology Co., Ltd. + */ +#ifndef __SOUND_HDA_PHYTIUM_H__ +#define __SOUND_HDA_PHYTIUM_H__ + +#include "hda_controller.h" + +struct hda_ft { + struct azx chip; + struct snd_pcm_substream *substream; + struct device *dev; + void __iomem *regs; + + /* for pending irqs */ + struct work_struct irq_pending_work; + + /* sync probing */ + struct completion probe_wait; + struct work_struct probe_work; + + /* card list (for power_save trigger) */ + struct list_head list; + + /* extra flags */ + unsigned int irq_pending_warned:1; + unsigned int probe_continued:1; + +}; + +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..2ab9eefb8c73190e19b3cf4f28e93425d0c39595 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/Kconfig @@ -0,0 +1,9 @@ +# SPDX-License-Identifier: GPL-2.0-only +# +# SoC audio configuration +# + +source "sound/soc/phytium/Kconfig" +# Supported codecs +source "sound/soc/codecs/Kconfig" + diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..d9aee6b5dac3d2d1bf5d7cb845cb5e95c17d88fe --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/Kconfig @@ -0,0 +1,18 @@ +# SPDX-License-Identifier: GPL-2.0-only +# Helper to resolve issues with configs that have SPI enabled but I2C +# modular, meaning we can't build the codec driver in with I2C support. +# We use an ordered list of conditional defaults to pick the appropriate +# setting - SPI can't be modular so that case doesn't need to be covered. + +menu "CODEC drivers" + +config SND_SOC_ES8336 + tristate "Everest Semi ES8336 CODEC" + depends on I2C + select GPIO_PHYTIUM_PCI + +config SND_SOC_ES8388 + tristate "Everest Semi ES8388 CODEC" + depends on I2C + +endmenu diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/Makefile b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..07ee92fca5ff0b664c00e6984dea8f66e8c343d6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/Makefile @@ -0,0 +1,9 @@ +# SPDX-License-Identifier: GPL-2.0 + +snd-soc-es8336-objs := es8336.o +snd-soc-es8388-objs := es8388.o + +obj-$(CONFIG_SND_SOC_ES8336) += snd-soc-es8336.o +obj-$(CONFIG_SND_SOC_ES8388) += snd-soc-es8388.o + + diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8336.c b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8336.c new file mode 100644 index 0000000000000000000000000000000000000000..2d666ab2831c1a9f06251374f04ebbacc202dfd1 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8336.c @@ -0,0 +1,1073 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * es8336 ALSA SoC audio driver + * + * Copyright (C) Everest Semiconductor Co.,Ltd + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "es8336.h" +#define ES8336_MUTE (1 << 5) + +static struct snd_soc_component *es8336_component; + +static const struct reg_default es8336_reg_defaults[] = { + {0x00, 0x03}, {0x01, 0x03}, {0x02, 0x00}, {0x03, 0x20}, + {0x04, 0x11}, {0x05, 0x00}, {0x06, 0x11}, {0x07, 0x00}, + {0x08, 0x00}, {0x09, 0x01}, {0x0a, 0x00}, {0x0b, 0x00}, + {0x0c, 0xf8}, {0x0d, 0x3f}, {0x0e, 0x00}, {0x0f, 0x00}, + {0x10, 0x01}, {0x11, 0xfc}, {0x12, 0x28}, {0x13, 0x00}, + {0x14, 0x00}, {0x15, 0x33}, {0x16, 0x00}, {0x17, 0x00}, + {0x18, 0x88}, {0x19, 0x06}, {0x1a, 0x22}, {0x1b, 0x03}, + {0x1c, 0x0f}, {0x1d, 0x00}, {0x1e, 0x80}, {0x1f, 0x80}, + {0x20, 0x00}, {0x21, 0x00}, {0x22, 0xc0}, {0x23, 0x00}, + {0x24, 0x01}, {0x25, 0x08}, {0x26, 0x10}, {0x27, 0xc0}, + {0x28, 0x00}, {0x29, 0x1c}, {0x2a, 0x00}, {0x2b, 0xb0}, + {0x2c, 0x32}, {0x2d, 0x03}, {0x2e, 0x00}, {0x2f, 0x11}, + {0x30, 0x10}, {0x31, 0x00}, {0x32, 0x00}, {0x33, 0xc0}, + {0x34, 0xc0}, {0x35, 0x1f}, {0x36, 0xf7}, {0x37, 0xfd}, + {0x38, 0xff}, {0x39, 0x1f}, {0x3a, 0xf7}, {0x3b, 0xfd}, + {0x3c, 0xff}, {0x3d, 0x1f}, {0x3e, 0xf7}, {0x3f, 0xfd}, + {0x40, 0xff}, {0x41, 0x1f}, {0x42, 0xf7}, {0x43, 0xfd}, + {0x44, 0xff}, {0x45, 0x1f}, {0x46, 0xf7}, {0x47, 0xfd}, + {0x48, 0xff}, {0x49, 0x1f}, {0x4a, 0xf7}, {0x4b, 0xfd}, + {0x4c, 0xff}, {0x4d, 0x00}, {0x4e, 0x00}, {0x4f, 0xff}, + {0x50, 0x00}, {0x51, 0x00}, {0x52, 0x00}, {0x53, 0x00}, +}; + +/* codec private data */ +struct es8336_priv { + struct regmap *regmap; + unsigned int dmic_amic; + unsigned int sysclk; + struct snd_pcm_hw_constraint_list *sysclk_constraints; + struct clk *mclk; + int debounce_time; + struct delayed_work work; + + struct gpio_desc *spk_ctl_gpio; + struct gpio_desc *hp_det_gpio; + bool muted; + bool hp_inserted; + bool spk_active_level; + u8 mic_src; + int pwr_count; +}; + +/* + * es8336_reset + * write value 0xff to reg0x00, the chip will be in reset mode + * then, writer 0x00 to reg0x00, unreset the chip + */ +static int es8336_reset(struct snd_soc_component *component) +{ + snd_soc_component_write(component, ES8336_RESET_REG00, 0x3F); + usleep_range(5000, 5500); + return snd_soc_component_write(component, ES8336_RESET_REG00, 0x03); +} + +static void es8336_enable_spk(struct es8336_priv *es8336, bool enable) +{ + bool level; + level = enable ? es8336->spk_active_level : !es8336->spk_active_level; + gpiod_set_value(es8336->spk_ctl_gpio, level); +} + +static const DECLARE_TLV_DB_SCALE(dac_vol_tlv, -9600, 50, 1); +static const DECLARE_TLV_DB_SCALE(adc_vol_tlv, -9600, 50, 1); +static const DECLARE_TLV_DB_SCALE(hpmixer_gain_tlv, -1200, 150, 0); +static const DECLARE_TLV_DB_SCALE(mic_bst_tlv, 0, 1200, 0); + +static unsigned int linin_pga_tlv[] = { + TLV_DB_RANGE_HEAD(9), + 0, 0, TLV_DB_SCALE_ITEM(0, 0, 0), + 1, 1, TLV_DB_SCALE_ITEM(300, 0, 0), + 2, 2, TLV_DB_SCALE_ITEM(600, 0, 0), + 3, 3, TLV_DB_SCALE_ITEM(900, 0, 0), + 4, 4, TLV_DB_SCALE_ITEM(1200, 0, 0), + 5, 5, TLV_DB_SCALE_ITEM(1500, 0, 0), + 6, 6, TLV_DB_SCALE_ITEM(1800, 0, 0), + 7, 7, TLV_DB_SCALE_ITEM(2100, 0, 0), + 8, 8, TLV_DB_SCALE_ITEM(2400, 0, 0), +}; + +static unsigned int hpout_vol_tlv[] = { + TLV_DB_RANGE_HEAD(1), + 0, 3, TLV_DB_SCALE_ITEM(-4800, 1200, 0), +}; + +static const char *const alc_func_txt[] = { "Off", "On" }; + +static const struct soc_enum alc_func = + SOC_ENUM_SINGLE(ES8336_ADC_ALC1_REG29, 6, 2, alc_func_txt); + +static const char *const ng_type_txt[] = { + "Constant PGA Gain", "Mute ADC Output" }; + +static const struct soc_enum ng_type = + SOC_ENUM_SINGLE(ES8336_ADC_ALC6_REG2E, 6, 2, ng_type_txt); + +static const char *const adcpol_txt[] = { "Normal", "Invert" }; + +static const struct soc_enum adcpol = + SOC_ENUM_SINGLE(ES8336_ADC_MUTE_REG26, 1, 2, adcpol_txt); + +static const char *const dacpol_txt[] = { + "Normal", "R Invert", "L Invert", "L + R Invert" }; + +static const struct soc_enum dacpol = + SOC_ENUM_SINGLE(ES8336_DAC_SET1_REG30, 0, 4, dacpol_txt); + +static const struct snd_kcontrol_new es8336_snd_controls[] = { + /* HP OUT VOLUME */ + SOC_DOUBLE_TLV("HP Playback Volume", ES8336_CPHP_ICAL_VOL_REG18, + 4, 0, 4, 1, hpout_vol_tlv), + /* HPMIXER VOLUME Control */ + SOC_DOUBLE_TLV("HPMixer Gain", ES8336_HPMIX_VOL_REG16, + 0, 4, 7, 0, hpmixer_gain_tlv), + + /* DAC Digital controls */ + SOC_DOUBLE_R_TLV("DAC Playback Volume", ES8336_DAC_VOLL_REG33, + ES8336_DAC_VOLR_REG34, 0, 0xC0, 1, dac_vol_tlv), + + SOC_SINGLE("Enable DAC Soft Ramp", ES8336_DAC_SET1_REG30, 4, 1, 1), + SOC_SINGLE("DAC Soft Ramp Rate", ES8336_DAC_SET1_REG30, 2, 4, 0), + + SOC_ENUM("Playback Polarity", dacpol), + SOC_SINGLE("DAC Notch Filter", ES8336_DAC_SET2_REG31, 6, 1, 0), + SOC_SINGLE("DAC Double Fs Mode", ES8336_DAC_SET2_REG31, 7, 1, 0), + SOC_SINGLE("DAC Volume Control-LeR", ES8336_DAC_SET2_REG31, 2, 1, 0), + SOC_SINGLE("DAC Stereo Enhancement", ES8336_DAC_SET3_REG32, 0, 7, 0), + + /* +20dB D2SE PGA Control */ + SOC_SINGLE_TLV("MIC Boost", ES8336_ADC_D2SEPGA_REG24, + 0, 1, 0, mic_bst_tlv), + /* 0-+24dB Lineinput PGA Control */ + SOC_SINGLE_TLV("Input PGA", ES8336_ADC_PGAGAIN_REG23, + 4, 8, 0, linin_pga_tlv), +}; + +/* Analog Input MUX */ +static const char * const es8336_analog_in_txt[] = { + "lin1-rin1", + "lin2-rin2", + "lin1-rin1 with 15db Boost", + "lin2-rin2 with 15db Boost" +}; + +static const unsigned int es8336_analog_in_values[] = { 0, 1, 2, 3 }; + +static const struct soc_enum es8336_analog_input_enum = + SOC_VALUE_ENUM_SINGLE(ES8336_ADC_PDN_LINSEL_REG22, 4, 3, + ARRAY_SIZE(es8336_analog_in_txt), + es8336_analog_in_txt, + es8336_analog_in_values); + +static const struct snd_kcontrol_new es8336_analog_in_mux_controls = + SOC_DAPM_ENUM("Route", es8336_analog_input_enum); + +/* Dmic MUX */ +static const char * const es8336_dmic_txt[] = { + "dmic disable", + "dmic data at high level", + "dmic data at low level", +}; + +static const unsigned int es8336_dmic_values[] = { 0, 2, 3 }; + +static const struct soc_enum es8336_dmic_src_enum = + SOC_VALUE_ENUM_SINGLE(ES8336_ADC_DMIC_REG25, 0, 3, + ARRAY_SIZE(es8336_dmic_txt), + es8336_dmic_txt, + es8336_dmic_values); + +static const struct snd_kcontrol_new es8336_dmic_src_controls = + SOC_DAPM_ENUM("Route", es8336_dmic_src_enum); + +/* hp mixer mux */ +static const char *const es8336_hpmux_texts[] = { + "lin1-rin1", + "lin2-rin2", + "lin-rin with Boost", + "lin-rin with Boost and PGA" +}; + +static const unsigned int es8336_hpmux_values[] = { 0, 1, 2, 3 }; + +static const struct soc_enum es8336_left_hpmux_enum = + SOC_VALUE_ENUM_SINGLE(ES8336_HPMIX_SEL_REG13, 4, 7, + ARRAY_SIZE(es8336_hpmux_texts), + es8336_hpmux_texts, + es8336_hpmux_values); + +static const struct snd_kcontrol_new es8336_left_hpmux_controls = + SOC_DAPM_ENUM("Route", es8336_left_hpmux_enum); + +static const struct soc_enum es8336_right_hpmux_enum = + SOC_VALUE_ENUM_SINGLE(ES8336_HPMIX_SEL_REG13, 0, 7, + ARRAY_SIZE(es8336_hpmux_texts), + es8336_hpmux_texts, + es8336_hpmux_values); + +static const struct snd_kcontrol_new es8336_right_hpmux_controls = + SOC_DAPM_ENUM("Route", es8336_right_hpmux_enum); + +/* headphone Output Mixer */ +static const struct snd_kcontrol_new es8336_out_left_mix[] = { + SOC_DAPM_SINGLE("LLIN Switch", ES8336_HPMIX_SWITCH_REG14, + 6, 1, 0), + SOC_DAPM_SINGLE("Left DAC Switch", ES8336_HPMIX_SWITCH_REG14, + 7, 1, 0), +}; + +static const struct snd_kcontrol_new es8336_out_right_mix[] = { + SOC_DAPM_SINGLE("RLIN Switch", ES8336_HPMIX_SWITCH_REG14, + 2, 1, 0), + SOC_DAPM_SINGLE("Right DAC Switch", ES8336_HPMIX_SWITCH_REG14, + 3, 1, 0), +}; + +/* DAC data source mux */ +static const char * const es8336_dacsrc_texts[] = { + "LDATA TO LDAC, RDATA TO RDAC", + "LDATA TO LDAC, LDATA TO RDAC", + "RDATA TO LDAC, RDATA TO RDAC", + "RDATA TO LDAC, LDATA TO RDAC", +}; + +static const unsigned int es8336_dacsrc_values[] = { 0, 1, 2, 3 }; + +static const struct soc_enum es8336_dacsrc_mux_enum = + SOC_VALUE_ENUM_SINGLE(ES8336_DAC_SET1_REG30, 6, 4, + ARRAY_SIZE(es8336_dacsrc_texts), + es8336_dacsrc_texts, + es8336_dacsrc_values); +static const struct snd_kcontrol_new es8336_dacsrc_mux_controls = + SOC_DAPM_ENUM("Route", es8336_dacsrc_mux_enum); + +static const struct snd_soc_dapm_widget es8336_dapm_widgets[] = { + /* Input Lines */ + SND_SOC_DAPM_INPUT("DMIC"), + SND_SOC_DAPM_INPUT("MIC1"), + SND_SOC_DAPM_INPUT("MIC2"), + + SND_SOC_DAPM_MICBIAS("micbias", SND_SOC_NOPM, + 0, 0), + /* Input MUX */ + SND_SOC_DAPM_MUX("Differential Mux", SND_SOC_NOPM, 0, 0, + &es8336_analog_in_mux_controls), + + SND_SOC_DAPM_PGA("Line input PGA", ES8336_ADC_PDN_LINSEL_REG22, + 7, 1, NULL, 0), + + /* ADCs */ + SND_SOC_DAPM_ADC("Mono ADC", NULL, ES8336_ADC_PDN_LINSEL_REG22, 6, 1), + + /* Dmic MUX */ + SND_SOC_DAPM_MUX("Digital Mic Mux", SND_SOC_NOPM, 0, 0, + &es8336_dmic_src_controls), + + /* Digital Interface */ + SND_SOC_DAPM_AIF_OUT("I2S OUT", "I2S1 Capture", 1, + SND_SOC_NOPM, 0, 0), + + SND_SOC_DAPM_AIF_IN("I2S IN", "I2S1 Playback", 0, + SND_SOC_NOPM, 0, 0), + + /* DACs DATA SRC MUX */ + SND_SOC_DAPM_MUX("DAC SRC Mux", SND_SOC_NOPM, 0, 0, + &es8336_dacsrc_mux_controls), + /* DACs */ + SND_SOC_DAPM_DAC("Right DAC", NULL, ES8336_DAC_PDN_REG2F, 0, 1), + SND_SOC_DAPM_DAC("Left DAC", NULL, ES8336_DAC_PDN_REG2F, 4, 1), + + /* Headphone Output Side */ + /* hpmux for hp mixer */ + SND_SOC_DAPM_MUX("Left Hp mux", SND_SOC_NOPM, 0, 0, + &es8336_left_hpmux_controls), + SND_SOC_DAPM_MUX("Right Hp mux", SND_SOC_NOPM, 0, 0, + &es8336_right_hpmux_controls), + /* Output mixer */ + SND_SOC_DAPM_MIXER("Left Hp mixer", ES8336_HPMIX_PDN_REG15, + 4, 1, &es8336_out_left_mix[0], + ARRAY_SIZE(es8336_out_left_mix)), + SND_SOC_DAPM_MIXER("Right Hp mixer", ES8336_HPMIX_PDN_REG15, + 0, 1, &es8336_out_right_mix[0], + ARRAY_SIZE(es8336_out_right_mix)), + + /* Output charge pump */ + SND_SOC_DAPM_PGA("HPCP L", ES8336_CPHP_OUTEN_REG17, + 6, 0, NULL, 0), + SND_SOC_DAPM_PGA("HPCP R", ES8336_CPHP_OUTEN_REG17, + 2, 0, NULL, 0), + + /* Output Driver */ + SND_SOC_DAPM_PGA("HPVOL L", ES8336_CPHP_OUTEN_REG17, + 5, 0, NULL, 0), + SND_SOC_DAPM_PGA("HPVOL R", ES8336_CPHP_OUTEN_REG17, + 1, 0, NULL, 0), + /* Output Lines */ + SND_SOC_DAPM_OUTPUT("HPOL"), + SND_SOC_DAPM_OUTPUT("HPOR"), +}; + +static const struct snd_soc_dapm_route es8336_dapm_routes[] = { + /* + * record route map + */ + {"MIC1", NULL, "micbias"}, + {"MIC2", NULL, "micbias"}, + {"DMIC", NULL, "micbias"}, + + {"Differential Mux", "lin1-rin1", "MIC1"}, + {"Differential Mux", "lin2-rin2", "MIC2"}, + {"Differential Mux", "lin1-rin1 with 15db Boost", "MIC1"}, + {"Differential Mux", "lin2-rin2 with 15db Boost", "MIC2"}, + {"Line input PGA", NULL, "Differential Mux"}, + + {"Mono ADC", NULL, "Line input PGA"}, + + {"Digital Mic Mux", "dmic disable", "Mono ADC"}, + {"Digital Mic Mux", "dmic data at high level", "DMIC"}, + {"Digital Mic Mux", "dmic data at low level", "DMIC"}, + + {"I2S OUT", NULL, "Digital Mic Mux"}, + /* + * playback route map + */ + {"DAC SRC Mux", "LDATA TO LDAC, RDATA TO RDAC", "I2S IN"}, + {"DAC SRC Mux", "LDATA TO LDAC, LDATA TO RDAC", "I2S IN"}, + {"DAC SRC Mux", "RDATA TO LDAC, RDATA TO RDAC", "I2S IN"}, + {"DAC SRC Mux", "RDATA TO LDAC, LDATA TO RDAC", "I2S IN"}, + + {"Left DAC", NULL, "DAC SRC Mux"}, + {"Right DAC", NULL, "DAC SRC Mux"}, + + {"Left Hp mux", "lin1-rin1", "MIC1"}, + {"Left Hp mux", "lin2-rin2", "MIC2"}, + {"Left Hp mux", "lin-rin with Boost", "Differential Mux"}, + {"Left Hp mux", "lin-rin with Boost and PGA", "Line input PGA"}, + + {"Right Hp mux", "lin1-rin1", "MIC1"}, + {"Right Hp mux", "lin2-rin2", "MIC2"}, + {"Right Hp mux", "lin-rin with Boost", "Differential Mux"}, + {"Right Hp mux", "lin-rin with Boost and PGA", "Line input PGA"}, + + {"Left Hp mixer", "LLIN Switch", "Left Hp mux"}, + {"Left Hp mixer", "Left DAC Switch", "Left DAC"}, + + {"Right Hp mixer", "RLIN Switch", "Right Hp mux"}, + {"Right Hp mixer", "Right DAC Switch", "Right DAC"}, + + {"HPCP L", NULL, "Left Hp mixer"}, + {"HPCP R", NULL, "Right Hp mixer"}, + + {"HPVOL L", NULL, "HPCP L"}, + {"HPVOL R", NULL, "HPCP R"}, + + {"HPOL", NULL, "HPVOL L"}, + {"HPOR", NULL, "HPVOL R"}, +}; + + +/* The set of rates we can generate from the above for each SYSCLK */ + +static unsigned int rates_12288[] = { + 8000, 12000, 16000, 24000, 24000, 32000, 48000, 96000, +}; + +static struct snd_pcm_hw_constraint_list constraints_12288 = { + .count = ARRAY_SIZE(rates_12288), + .list = rates_12288, +}; + +static unsigned int rates_112896[] = { + 8000, 11025, 22050, 44100, +}; + +static struct snd_pcm_hw_constraint_list constraints_112896 = { + .count = ARRAY_SIZE(rates_112896), + .list = rates_112896, +}; + +static unsigned int rates_12[] = { + 8000, 11025, 12000, 16000, 22050, 24000, 32000, 44100, 48000, + 48000, 88235, 96000, +}; + +static struct snd_pcm_hw_constraint_list constraints_12 = { + .count = ARRAY_SIZE(rates_12), + .list = rates_12, +}; + +/* + * Note that this should be called from init rather than from hw_params. + */ +static int es8336_set_dai_sysclk(struct snd_soc_dai *codec_dai, + int clk_id, unsigned int freq, int dir) +{ + struct snd_soc_component *component = codec_dai->component; + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + + switch (freq) { + case 11289600: + case 18432000: + case 22579200: + case 36864000: + es8336->sysclk_constraints = &constraints_112896; + es8336->sysclk = freq; + return 0; + case 12288000: + case 19200000: + case 16934400: + case 24576000: + case 33868800: + es8336->sysclk_constraints = &constraints_12288; + es8336->sysclk = freq; + return 0; + case 12000000: + case 24000000: + es8336->sysclk_constraints = &constraints_12; + es8336->sysclk = freq; + return 0; + } + + return 0; +} + +static int es8336_set_dai_fmt(struct snd_soc_dai *codec_dai, + unsigned int fmt) +{ + struct snd_soc_component *component = codec_dai->component; + u8 iface = 0; + u8 adciface = 0; + u8 daciface = 0; + + iface = snd_soc_component_read(component, ES8336_IFACE); + adciface = snd_soc_component_read(component, ES8336_ADC_IFACE); + daciface = snd_soc_component_read(component, ES8336_DAC_IFACE); + + /* set master/slave audio interface */ + switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { + case SND_SOC_DAIFMT_CBM_CFM: + iface |= 0x80; + break; + case SND_SOC_DAIFMT_CBS_CFS: + iface &= 0x7F; + break; + default: + return -EINVAL; + } + + /* interface format */ + switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { + case SND_SOC_DAIFMT_I2S: + adciface &= 0xFC; + daciface &= 0xFC; + break; + case SND_SOC_DAIFMT_RIGHT_J: + return -EINVAL; + case SND_SOC_DAIFMT_LEFT_J: + adciface &= 0xFC; + daciface &= 0xFC; + adciface |= 0x01; + daciface |= 0x01; + break; + case SND_SOC_DAIFMT_DSP_A: + adciface &= 0xDC; + daciface &= 0xDC; + adciface |= 0x03; + daciface |= 0x03; + break; + case SND_SOC_DAIFMT_DSP_B: + adciface &= 0xDC; + daciface &= 0xDC; + adciface |= 0x23; + daciface |= 0x23; + break; + default: + return -EINVAL; + } + + /* clock inversion */ + switch (fmt & SND_SOC_DAIFMT_INV_MASK) { + case SND_SOC_DAIFMT_NB_NF: + iface &= 0xDF; + adciface &= 0xDF; + daciface &= 0xDF; + break; + case SND_SOC_DAIFMT_IB_IF: + iface |= 0x20; + adciface |= 0x20; + daciface |= 0x20; + break; + case SND_SOC_DAIFMT_IB_NF: + iface |= 0x20; + adciface &= 0xDF; + daciface &= 0xDF; + break; + case SND_SOC_DAIFMT_NB_IF: + iface &= 0xDF; + adciface |= 0x20; + daciface |= 0x20; + break; + default: + return -EINVAL; + } + snd_soc_component_write(component, ES8336_IFACE, iface); + snd_soc_component_write(component, ES8336_ADC_IFACE, adciface); + snd_soc_component_write(component, ES8336_DAC_IFACE, daciface); + return 0; +} + +static int es8336_pcm_startup(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct snd_soc_component *component = dai->component; + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + bool playback = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK); + + snd_soc_component_write(component, ES8336_RESET_REG00, 0xC0); + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); + /* es8336: both playback and capture need dac mclk */ + snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, + ES8336_CLKMGR_MCLK_DIV_MASK | + ES8336_CLKMGR_DAC_MCLK_MASK, + ES8336_CLKMGR_MCLK_DIV_NML | + ES8336_CLKMGR_DAC_MCLK_EN); + es8336->pwr_count++; + + if (playback) { + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x3F); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x1F); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x88); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0xBB); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x10); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x30); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x02); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x00); + snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x66); + snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, + ES8336_CLKMGR_DAC_MCLK_MASK | + ES8336_CLKMGR_DAC_ANALOG_MASK, + ES8336_CLKMGR_DAC_MCLK_EN | + ES8336_CLKMGR_DAC_ANALOG_EN); + msleep(50); + } else { + snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0x00); + snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, + ES8336_CLKMGR_ADC_MCLK_MASK | + ES8336_CLKMGR_ADC_ANALOG_MASK, + ES8336_CLKMGR_ADC_MCLK_EN | + ES8336_CLKMGR_ADC_ANALOG_EN); + } + + return 0; +} + +static void es8336_pcm_shutdown(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct snd_soc_component *component = dai->component; + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + bool playback = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK); + + if (playback) { + snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); + snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, + ES8336_CLKMGR_DAC_ANALOG_MASK, + ES8336_CLKMGR_DAC_ANALOG_DIS); + } else { + snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xc0); + snd_soc_component_update_bits(component, ES8336_CLKMGR_CLKSW_REG01, + ES8336_CLKMGR_ADC_MCLK_MASK | + ES8336_CLKMGR_ADC_ANALOG_MASK, + ES8336_CLKMGR_ADC_MCLK_DIS | + ES8336_CLKMGR_ADC_ANALOG_DIS); + } + + if (--es8336->pwr_count == 0) { + if (!es8336->hp_inserted) + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); + snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); + } +} + + +static int es8336_pcm_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params, + struct snd_soc_dai *dai) +{ + struct snd_soc_component *component = dai->component; + int val = 0; + + switch (params_format(params)) { + case SNDRV_PCM_FORMAT_S16_LE: + val = ES8336_DACWL_16; + break; + case SNDRV_PCM_FORMAT_S20_3LE: + val = ES8336_DACWL_20; + break; + case SNDRV_PCM_FORMAT_S24_LE: + val = ES8336_DACWL_24; + break; + case SNDRV_PCM_FORMAT_S32_LE: + val = ES8336_DACWL_32; + break; + default: + val = ES8336_DACWL_16; + break; + } + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + snd_soc_component_update_bits(component, ES8336_SDP_DACFMT_REG0B, + ES8336_DACWL_MASK, val); + else + snd_soc_component_update_bits(component, ES8336_SDP_ADCFMT_REG0A, + ES8336_ADCWL_MASK, val); + + return 0; +} + +static int es8336_mute(struct snd_soc_dai *dai, int mute, int direction) +{ + struct snd_soc_component *component = dai->component; + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + + es8336->muted = mute; + if (!es8336->hp_inserted) + es8336_enable_spk(es8336, true); + else + es8336_enable_spk(es8336, false); + if (direction) + return snd_soc_component_update_bits(dai->component, ES8336_ADC_MUTE_REG26, + ES8336_MUTE, + mute ? ES8336_MUTE : 0); + else + return snd_soc_component_update_bits(dai->component, ES8336_DAC_SET1_REG30, + ES8336_MUTE, + mute ? ES8336_MUTE : 0); +} + +static int es8336_set_bias_level(struct snd_soc_component *component, + enum snd_soc_bias_level level) +{ + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + + switch (level) { + case SND_SOC_BIAS_ON: + break; + + case SND_SOC_BIAS_PREPARE: + break; + + case SND_SOC_BIAS_STANDBY: + break; + + case SND_SOC_BIAS_OFF: + snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); + snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); + if (!es8336->hp_inserted) + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x3F); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x1F); + snd_soc_component_write(component, ES8336_RESET_REG00, 0x00); + break; + } + + return 0; +} + +#define es8336_RATES SNDRV_PCM_RATE_8000_96000 + +#define es8336_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ + SNDRV_PCM_FMTBIT_S24_LE) + +static const struct snd_soc_dai_ops es8336_ops = { + .startup = es8336_pcm_startup, + .hw_params = es8336_pcm_hw_params, + .set_fmt = es8336_set_dai_fmt, + .set_sysclk = es8336_set_dai_sysclk, + .mute_stream = es8336_mute, + .shutdown = es8336_pcm_shutdown, + .no_capture_mute = 1, +}; + +static struct snd_soc_dai_driver es8336_dai = { + .name = "es8336-hifi", + .playback = { + .stream_name = "Playback", + .channels_min = 1, + .channels_max = 2, + .rates = es8336_RATES, + .formats = es8336_FORMATS, + }, + .capture = { + .stream_name = "Capture", + .channels_min = 1, + .channels_max = 2, + .rates = es8336_RATES, + .formats = es8336_FORMATS, + }, + .ops = &es8336_ops, + .symmetric_rate = 1, +}; + +static int es8336_init_regs(struct snd_soc_component *component) +{ + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + snd_soc_component_write(component, ES8336_RESET_REG00, 0x3f); + usleep_range(5000, 5500); + snd_soc_component_write(component, ES8336_RESET_REG00, 0x00); + snd_soc_component_write(component, ES8336_SYS_VMIDSEL_REG0C, 0xFF); + msleep(30); + snd_soc_component_write(component, ES8336_CLKMGR_CLKSEL_REG02, 0x08); + snd_soc_component_write(component, ES8336_CLKMGR_ADCOSR_REG03, 0x20); + snd_soc_component_write(component, ES8336_CLKMGR_ADCDIV1_REG04, 0x11); + snd_soc_component_write(component, ES8336_CLKMGR_ADCDIV2_REG05, 0x00); + snd_soc_component_write(component, ES8336_CLKMGR_DACDIV1_REG06, 0x11); + snd_soc_component_write(component, ES8336_CLKMGR_DACDIV2_REG07, 0x00); + snd_soc_component_write(component, ES8336_CLKMGR_CPDIV_REG08, 0x00); + snd_soc_component_write(component, ES8336_SDP_MS_BCKDIV_REG09, 0x04); + snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0x7F); + snd_soc_component_write(component, ES8336_CAL_TYPE_REG1C, 0x0F); + snd_soc_component_write(component, ES8336_CAL_HPLIV_REG1E, 0x90); + snd_soc_component_write(component, ES8336_CAL_HPRIV_REG1F, 0x90); + snd_soc_component_write(component, ES8336_ADC_VOLUME_REG27, 0x00); + snd_soc_component_write(component, ES8336_ADC_PDN_LINSEL_REG22, es8336->mic_src); + snd_soc_component_write(component, ES8336_ADC_D2SEPGA_REG24, 0x00); + snd_soc_component_write(component, ES8336_ADC_DMIC_REG25, 0x08); + snd_soc_component_write(component, ES8336_DAC_SET2_REG31, 0x20); + snd_soc_component_write(component, ES8336_DAC_SET3_REG32, 0x00); + snd_soc_component_write(component, ES8336_DAC_VOLL_REG33, 0x00); + snd_soc_component_write(component, ES8336_DAC_VOLR_REG34, 0x00); + snd_soc_component_write(component, ES8336_SDP_ADCFMT_REG0A, 0x00); + snd_soc_component_write(component, ES8336_SDP_DACFMT_REG0B, 0x00); + snd_soc_component_write(component, ES8336_SYS_VMIDLOW_REG10, 0x11); + snd_soc_component_write(component, ES8336_SYS_VSEL_REG11, 0xFC); + snd_soc_component_write(component, ES8336_SYS_REF_REG12, 0x28); + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0x04); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0x0C); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); + snd_soc_component_write(component, ES8336_HPMIX_SEL_REG13, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x88); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0xBB); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x10); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x30); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x02); + snd_soc_component_write(component, ES8336_CPHP_ICAL_VOL_REG18, 0x00); + snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); + snd_soc_component_write(component, ES8336_GPIO_DEBUNCE_INT_REG4E, 0x02); + snd_soc_component_write(component, ES8336_TESTMODE_REG50, 0xA0); + snd_soc_component_write(component, ES8336_TEST1_REG51, 0x00); + snd_soc_component_write(component, ES8336_TEST2_REG52, 0x00); + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x00); + snd_soc_component_write(component, ES8336_RESET_REG00, 0xC0); + msleep(50); + snd_soc_component_write(component, ES8336_ADC_PGAGAIN_REG23, 0x60); + snd_soc_component_write(component, ES8336_ADC_D2SEPGA_REG24, 0x01); + /* adc ds mode, HPF enable */ + snd_soc_component_write(component, ES8336_ADC_DMIC_REG25, 0x08); + snd_soc_component_write(component, ES8336_ADC_ALC1_REG29, 0xcd); + snd_soc_component_write(component, ES8336_ADC_ALC2_REG2A, 0x08); + snd_soc_component_write(component, ES8336_ADC_ALC3_REG2B, 0xa0); + snd_soc_component_write(component, ES8336_ADC_ALC4_REG2C, 0x05); + snd_soc_component_write(component, ES8336_ADC_ALC5_REG2D, 0x06); + snd_soc_component_write(component, ES8336_ADC_ALC6_REG2E, 0x61); + return 0; +} + +static int es8336_suspend(struct snd_soc_component *component) +{ + return 0; +} + +static int es8336_resume(struct snd_soc_component *component) +{ + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + int ret; + + es8336_reset(component); /* UPDATED BY DAVID,15-3-5 */ + ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); + if (!ret) { + es8336_init_regs(component); + snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); + /* max debance time, enable interrupt, low active */ + snd_soc_component_write(component, ES8336_GPIO_DEBUNCE_INT_REG4E, 0xf3); + /* es8336_set_bias_level(component, SND_SOC_BIAS_OFF); */ + snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); + if (!es8336->hp_inserted) + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, 0x3F); + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); + snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); + snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); + } + return 0; +} + +static irqreturn_t es8336_irq_handler(int irq, void *data) +{ + struct es8336_priv *es8336 = data; + + queue_delayed_work(system_power_efficient_wq, &es8336->work, + msecs_to_jiffies(es8336->debounce_time)); + + return IRQ_HANDLED; +} + +static void hp_work(struct work_struct *work) +{ + struct es8336_priv *es8336; + + es8336 = container_of(work, struct es8336_priv, work.work); + + es8336->hp_inserted = gpiod_get_value(es8336->hp_det_gpio); + if (!es8336->muted) { + if (es8336->hp_inserted) + es8336_enable_spk(es8336, false); + else + es8336_enable_spk(es8336, true); + } +} + +static int es8336_probe(struct snd_soc_component *component) +{ + struct es8336_priv *es8336 = snd_soc_component_get_drvdata(component); + int ret = 0; + + es8336_component = component; + ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); + if (!ret) { + es8336_reset(component); /* UPDATED BY DAVID,15-3-5 */ + ret = snd_soc_component_read(component, ES8336_CLKMGR_ADCDIV2_REG05); + if (!ret) { + es8336_init_regs(component); + snd_soc_component_write(component, ES8336_GPIO_SEL_REG4D, 0x02); + /* max debance time, enable interrupt, low active */ + snd_soc_component_write(component, + ES8336_GPIO_DEBUNCE_INT_REG4E, 0xf3); + + /* es8336_set_bias_level(codec, SND_SOC_BIAS_OFF); */ + snd_soc_component_write(component, ES8336_CPHP_OUTEN_REG17, 0x00); + snd_soc_component_write(component, ES8336_DAC_PDN_REG2F, 0x11); + snd_soc_component_write(component, ES8336_CPHP_LDOCTL_REG1B, 0x03); + snd_soc_component_write(component, ES8336_CPHP_PDN2_REG1A, 0x22); + snd_soc_component_write(component, ES8336_CPHP_PDN1_REG19, 0x06); + snd_soc_component_write(component, ES8336_HPMIX_SWITCH_REG14, 0x00); + snd_soc_component_write(component, ES8336_HPMIX_PDN_REG15, 0x33); + snd_soc_component_write(component, ES8336_HPMIX_VOL_REG16, 0x00); + if (!es8336->hp_inserted) + snd_soc_component_write(component, ES8336_SYS_PDN_REG0D, + 0x3F); + snd_soc_component_write(component, ES8336_SYS_LP1_REG0E, 0xFF); + snd_soc_component_write(component, ES8336_SYS_LP2_REG0F, 0xFF); + snd_soc_component_write(component, ES8336_CLKMGR_CLKSW_REG01, 0xF3); + snd_soc_component_update_bits(component, ES8336_ADC_PDN_LINSEL_REG22, 0xC0, 0xC0); + } + } + + return ret; +} + +static void es8336_remove(struct snd_soc_component *component) +{ + es8336_set_bias_level(component, SND_SOC_BIAS_OFF); +} + +const struct regmap_config es8336_regmap_config = { + .reg_bits = 8, + .val_bits = 8, + .max_register = ES8336_TEST3_REG53, + .cache_type = REGCACHE_RBTREE, + .reg_defaults = es8336_reg_defaults, + .num_reg_defaults = ARRAY_SIZE(es8336_reg_defaults), +}; + +static const struct snd_soc_component_driver soc_component_dev_es8336 = { + .probe = es8336_probe, + .remove = es8336_remove, + .suspend = es8336_suspend, + .resume = es8336_resume, + .set_bias_level = es8336_set_bias_level, + + .controls = es8336_snd_controls, + .num_controls = ARRAY_SIZE(es8336_snd_controls), + .dapm_widgets = es8336_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(es8336_dapm_widgets), + .dapm_routes = es8336_dapm_routes, + .num_dapm_routes = ARRAY_SIZE(es8336_dapm_routes), +}; + +static int es8336_i2c_probe(struct i2c_client *i2c) +{ + struct es8336_priv *es8336; + int ret = -1; + int hp_irq; + int active_level = 0; + + es8336 = devm_kzalloc(&i2c->dev, sizeof(*es8336), GFP_KERNEL); + if (!es8336) + return -ENOMEM; + + es8336->debounce_time = 200; + es8336->pwr_count = 0; + es8336->hp_inserted = false; + es8336->muted = true; + + es8336->regmap = devm_regmap_init_i2c(i2c, &es8336_regmap_config); + if (IS_ERR(es8336->regmap)) { + ret = PTR_ERR(es8336->regmap); + dev_err(&i2c->dev, "Failed to init regmap: %d\n", ret); + return ret; + } + + i2c_set_clientdata(i2c, es8336); + + es8336->spk_ctl_gpio = devm_gpiod_get_index_optional(&i2c->dev, "sel", 0, + GPIOD_OUT_HIGH); + device_property_read_u32(&i2c->dev, "spk-active-level", &active_level); + ret = of_property_read_u8(i2c->dev.of_node, "mic-src", &es8336->mic_src); + if (ret != 0) { + dev_dbg(&i2c->dev, "mic1-src return %d", ret); + es8336->mic_src = 0x20; + } + dev_dbg(&i2c->dev, "mic1-src %x", es8336->mic_src); + + if (IS_ERR_OR_NULL(es8336->spk_ctl_gpio)) + dev_info(&i2c->dev, "Can not get spk_ctl_gpio\n"); + else { + es8336->spk_active_level = active_level; + es8336_enable_spk(es8336, false); + } + + es8336->hp_det_gpio = devm_gpiod_get_index_optional(&i2c->dev, "det", 0, + GPIOD_IN); + + if (IS_ERR_OR_NULL(es8336->hp_det_gpio)) { + dev_info(&i2c->dev, "Can not get hp_det_gpio\n"); + } else { + INIT_DELAYED_WORK(&es8336->work, hp_work); + hp_irq = gpiod_to_irq(es8336->hp_det_gpio); + ret = devm_request_threaded_irq(&i2c->dev, hp_irq, NULL, + es8336_irq_handler, + IRQF_TRIGGER_FALLING | + IRQF_TRIGGER_RISING | + IRQF_ONESHOT, + "es8336_interrupt", es8336); + if (ret < 0) { + dev_err(&i2c->dev, "request_irq failed: %d\n", ret); + return ret; + } + + schedule_delayed_work(&es8336->work, + msecs_to_jiffies(es8336->debounce_time)); + } + + ret = devm_snd_soc_register_component(&i2c->dev, + &soc_component_dev_es8336, + &es8336_dai, 1); + + return ret; +} + +static void es8336_i2c_remove(struct i2c_client *client) +{ + +} + +static void es8336_i2c_shutdown(struct i2c_client *client) +{ + struct es8336_priv *es8336 = i2c_get_clientdata(client); + + if (es8336_component != NULL) { + es8336_enable_spk(es8336, false); + msleep(20); + es8336_set_bias_level(es8336_component, SND_SOC_BIAS_OFF); + } +} + +static const struct i2c_device_id es8336_i2c_id[] = { + {"es8336", 0}, + {"10ES8336:00", 0}, + {"10ES8336", 0}, + { } +}; +MODULE_DEVICE_TABLE(i2c, es8336_i2c_id); + +static const struct of_device_id es8336_of_match[] = { + { .compatible = "everest,es8336", }, + { } +}; +MODULE_DEVICE_TABLE(of, es8336_of_match); + +static const struct acpi_device_id es8336_acpi_match[] = { + { "ESSX8336", 0}, + { } +}; +MODULE_DEVICE_TABLE(acpi, es8336_acpi_match); + +static struct i2c_driver es8336_i2c_driver = { + .driver = { + .name = "es8336", + .of_match_table = es8336_of_match, + .acpi_match_table = es8336_acpi_match, + }, + .probe = es8336_i2c_probe, + .remove = es8336_i2c_remove, + .shutdown = es8336_i2c_shutdown, + .id_table = es8336_i2c_id, +}; + +module_i2c_driver(es8336_i2c_driver); +MODULE_DESCRIPTION("ASoC es8336 driver"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8336.h b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8336.h new file mode 100644 index 0000000000000000000000000000000000000000..2bcf67b8a4d27009be71eb1e1e82fe41e53cee27 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8336.h @@ -0,0 +1,153 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (C) Everest Semiconductor Co.,Ltd + * Copyright (c) 2022-2024 Phytium Technology Co., Ltd. + */ + +#ifndef _ES8336_H +#define _ES8336_H + +/* ES8336 register space */ +/* + * RESET Control + */ +#define ES8336_RESET_REG00 0x00 +/* + * Clock Managerment + */ +#define ES8336_CLKMGR_CLKSW_REG01 0x01 +#define ES8336_CLKMGR_CLKSEL_REG02 0x02 +#define ES8336_CLKMGR_ADCOSR_REG03 0x03 +#define ES8336_CLKMGR_ADCDIV1_REG04 0x04 +#define ES8336_CLKMGR_ADCDIV2_REG05 0x05 +#define ES8336_CLKMGR_DACDIV1_REG06 0x06 +#define ES8336_CLKMGR_DACDIV2_REG07 0x07 +#define ES8336_CLKMGR_CPDIV_REG08 0x08 +/* + * SDP Control + */ +#define ES8336_SDP_MS_BCKDIV_REG09 0x09 +#define ES8336_SDP_ADCFMT_REG0A 0x0a +#define ES8336_SDP_DACFMT_REG0B 0x0b +/* + * System Control + */ +#define ES8336_SYS_VMIDSEL_REG0C 0x0c +#define ES8336_SYS_PDN_REG0D 0x0d +#define ES8336_SYS_LP1_REG0E 0x0e +#define ES8336_SYS_LP2_REG0F 0x0f +#define ES8336_SYS_VMIDLOW_REG10 0x10 +#define ES8336_SYS_VSEL_REG11 0x11 +#define ES8336_SYS_REF_REG12 0x12 +/* + * HP Mixer + */ +#define ES8336_HPMIX_SEL_REG13 0x13 +#define ES8336_HPMIX_SWITCH_REG14 0x14 +#define ES8336_HPMIX_PDN_REG15 0x15 +#define ES8336_HPMIX_VOL_REG16 0x16 +/* + * Charge Pump Headphone driver + */ +#define ES8336_CPHP_OUTEN_REG17 0x17 +#define ES8336_CPHP_ICAL_VOL_REG18 0x18 +#define ES8336_CPHP_PDN1_REG19 0x19 +#define ES8336_CPHP_PDN2_REG1A 0x1a +#define ES8336_CPHP_LDOCTL_REG1B 0x1b +/* + * Calibration + */ +#define ES8336_CAL_TYPE_REG1C 0x1c +#define ES8336_CAL_SET_REG1D 0x1d +#define ES8336_CAL_HPLIV_REG1E 0x1e +#define ES8336_CAL_HPRIV_REG1F 0x1f +#define ES8336_CAL_HPLMV_REG20 0x20 +#define ES8336_CAL_HPRMV_REG21 0x21 +/* + * ADC Control + */ +#define ES8336_ADC_PDN_LINSEL_REG22 0x22 +#define ES8336_ADC_PGAGAIN_REG23 0x23 +#define ES8336_ADC_D2SEPGA_REG24 0x24 +#define ES8336_ADC_DMIC_REG25 0x25 +#define ES8336_ADC_MUTE_REG26 0x26 +#define ES8336_ADC_VOLUME_REG27 0x27 +#define ES8336_ADC_ALC1_REG29 0x29 +#define ES8336_ADC_ALC2_REG2A 0x2a +#define ES8336_ADC_ALC3_REG2B 0x2b +#define ES8336_ADC_ALC4_REG2C 0x2c +#define ES8336_ADC_ALC5_REG2D 0x2d +#define ES8336_ADC_ALC6_REG2E 0x2e +/* + * DAC Control + */ +#define ES8336_DAC_PDN_REG2F 0x2f +#define ES8336_DAC_SET1_REG30 0x30 +#define ES8336_DAC_SET2_REG31 0x31 +#define ES8336_DAC_SET3_REG32 0x32 +#define ES8336_DAC_VOLL_REG33 0x33 +#define ES8336_DAC_VOLR_REG34 0x34 +/* + * GPIO + */ +#define ES8336_GPIO_SEL_REG4D 0x4D +#define ES8336_GPIO_DEBUNCE_INT_REG4E 0x4E +#define ES8336_GPIO_FLAG 0x4F +/* + * TEST MODE + */ +#define ES8336_TESTMODE_REG50 0x50 +#define ES8336_TEST1_REG51 0x51 +#define ES8336_TEST2_REG52 0x52 +#define ES8336_TEST3_REG53 0x53 + +#define ES8336_IFACE ES8336_SDP_MS_BCKDIV_REG09 +#define ES8336_ADC_IFACE ES8336_SDP_ADCFMT_REG0A +#define ES8336_DAC_IFACE ES8336_SDP_DACFMT_REG0B + +#define ES8336_REGNUM 84 + +/* REGISTER 0X01 CLOCK MANAGER */ +#define ES8336_CLKMGR_MCLK_DIV_MASK (0X1<<7) +#define ES8336_CLKMGR_MCLK_DIV_NML (0X0<<7) +#define ES8336_CLKMGR_MCLK_DIV_1 (0X1<<7) +#define ES8336_CLKMGR_ADC_MCLK_MASK (0X1<<3) +#define ES8336_CLKMGR_ADC_MCLK_EN (0X1<<3) +#define ES8336_CLKMGR_ADC_MCLK_DIS (0X0<<3) +#define ES8336_CLKMGR_DAC_MCLK_MASK (0X1<<2) +#define ES8336_CLKMGR_DAC_MCLK_EN (0X1<<2) +#define ES8336_CLKMGR_DAC_MCLK_DIS (0X0<<2) +#define ES8336_CLKMGR_ADC_ANALOG_MASK (0X1<<1) +#define ES8336_CLKMGR_ADC_ANALOG_EN (0X1<<1) +#define ES8336_CLKMGR_ADC_ANALOG_DIS (0X0<<1) +#define ES8336_CLKMGR_DAC_ANALOG_MASK (0X1<<0) +#define ES8336_CLKMGR_DAC_ANALOG_EN (0X1<<0) +#define ES8336_CLKMGR_DAC_ANALOG_DIS (0X0<<0) + +/* REGISTER 0X0A */ +#define ES8336_ADCWL_MASK (0x7 << 2) +#define ES8336_ADCWL_32 (0x4 << 2) +#define ES8336_ADCWL_24 (0x0 << 2) +#define ES8336_ADCWL_20 (0x1 << 2) +#define ES8336_ADCWL_18 (0x2 << 2) +#define ES8336_ADCWL_16 (0x3 << 2) +#define ES8336_ADCFMT_MASK (0x3 << 0) +#define ES8336_ADCFMT_I2S (0x0 << 0) +#define ES8336_ADCWL_LEFT (0x1 << 0) +#define ES8336_ADCWL_RIGHT (0x2 << 0) +#define ES8336_ADCWL_PCM (0x3 << 0) + +/* REGISTER 0X0B */ +#define ES8336_DACWL_MASK (0x7 << 2) +#define ES8336_DACWL_32 (0x4 << 2) +#define ES8336_DACWL_24 (0x0 << 2) +#define ES8336_DACWL_20 (0x1 << 2) +#define ES8336_DACWL_18 (0x2 << 2) +#define ES8336_DACWL_16 (0x3 << 2) +#define ES8336_DACFMT_MASK (0x3 << 0) +#define ES8336_DACFMT_I2S (0x0 << 0) +#define ES8336_DACWL_LEFT (0x1 << 0) +#define ES8336_DACWL_RIGHT (0x2 << 0) +#define ES8336_DACWL_PCM (0x3 << 0) + +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8388.c b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8388.c new file mode 100644 index 0000000000000000000000000000000000000000..11959e97e61bcf1c1465080c893618c99a6ceb5b --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8388.c @@ -0,0 +1,819 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * es8388.c -- ES8388 ALSA SoC Audio driver + * + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "es8388.h" +#include +#include + +static const unsigned int rates_12288[] = { + 8000, 12000, 16000, 24000, 32000, 48000, 96000, +}; + +static const int ratios_12288[] = { + 10, 7, 6, 4, 3, 2, 0, +}; + +static const struct snd_pcm_hw_constraint_list constraints_12288 = { + .count = ARRAY_SIZE(rates_12288), + .list = rates_12288, +}; + +static const unsigned int rates_11289[] = { + 8018, 11025, 22050, 44100, 88200, +}; + +static const int ratios_11289[] = { + 9, 7, 4, 2, 0, +}; + +static const struct snd_pcm_hw_constraint_list constraints_11289 = { + .count = ARRAY_SIZE(rates_11289), + .list = rates_11289, +}; + +#define ES8388_RATES (SNDRV_PCM_RATE_192000 | \ + SNDRV_PCM_RATE_96000 | \ + SNDRV_PCM_RATE_88200 | \ + SNDRV_PCM_RATE_8000_48000) +#define ES8388_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \ + SNDRV_PCM_FMTBIT_S18_3LE | \ + SNDRV_PCM_FMTBIT_S20_3LE | \ + SNDRV_PCM_FMTBIT_S24_LE | \ + SNDRV_PCM_FMTBIT_S32_LE) + +struct es8388_priv { + struct regmap *regmap; + struct clk *clk; + int playback_fs; + bool deemph; + int mclkdiv2; + const struct snd_pcm_hw_constraint_list *sysclk_constraints; + const int *mclk_ratios; + bool master; +}; + +/* + * ES8388 Controls + */ +static const char * const adcpol_txt[] = {"Normal", "L Invert", "R Invert", + "L + R Invert"}; +static SOC_ENUM_SINGLE_DECL(adcpol, + ES8388_ADCCONTROL6, 6, adcpol_txt); + +static const DECLARE_TLV_DB_SCALE(play_tlv, -3000, 100, 0); +static const DECLARE_TLV_DB_SCALE(dac_adc_tlv, -9600, 50, 0); +static const DECLARE_TLV_DB_SCALE(pga_tlv, 0, 300, 0); +static const DECLARE_TLV_DB_SCALE(bypass_tlv, -1500, 300, 0); +static const DECLARE_TLV_DB_SCALE(mic_tlv, 0, 300, 0); + +static const struct { + int rate; + unsigned int val; +} deemph_settings[] = { + { 0, ES8388_DACCONTROL6_DEEMPH_OFF }, + { 32000, ES8388_DACCONTROL6_DEEMPH_32k }, + { 44100, ES8388_DACCONTROL6_DEEMPH_44_1k }, + { 48000, ES8388_DACCONTROL6_DEEMPH_48k }, +}; + +static int es8388_set_deemph(struct snd_soc_component *component) +{ + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + int val, i, best; + + /* + * If we're using deemphasis select the nearest available sample + * rate. + */ + if (es8388->deemph) { + best = 0; + for (i = 1; i < ARRAY_SIZE(deemph_settings); i++) { + if (abs(deemph_settings[i].rate - es8388->playback_fs) < + abs(deemph_settings[best].rate - es8388->playback_fs)) + best = i; + } + + val = deemph_settings[best].val; + } else { + val = ES8388_DACCONTROL6_DEEMPH_OFF; + } + + dev_dbg(component->dev, "Set deemphasis %d\n", val); + + return snd_soc_component_update_bits(component, ES8388_DACCONTROL6, + ES8388_DACCONTROL6_DEEMPH_MASK, val); +} + +static int es8388_get_deemph(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + + ucontrol->value.integer.value[0] = es8388->deemph; + return 0; +} + +static int es8388_put_deemph(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + unsigned int deemph = ucontrol->value.integer.value[0]; + int ret; + + if (deemph > 1) + return -EINVAL; + + ret = es8388_set_deemph(component); + if (ret < 0) + return ret; + + es8388->deemph = deemph; + + return 0; +} + +static const struct snd_kcontrol_new es8388_snd_controls[] = { + SOC_DOUBLE_R_TLV("Capture Digital Volume", + ES8388_ADCCONTROL8, ES8388_ADCCONTROL9, + 0, 0xc0, 1, dac_adc_tlv), + + SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0, + es8388_get_deemph, es8388_put_deemph), + + SOC_ENUM("Capture Polarity", adcpol), + + SOC_SINGLE_TLV("Left Mixer Left Bypass Volume", + ES8388_DACCONTROL17, 3, 7, 1, bypass_tlv), + SOC_SINGLE_TLV("Left Mixer Right Bypass Volume", + ES8388_DACCONTROL19, 3, 7, 1, bypass_tlv), + SOC_SINGLE_TLV("Right Mixer Left Bypass Volume", + ES8388_DACCONTROL18, 3, 7, 1, bypass_tlv), + SOC_SINGLE_TLV("Right Mixer Right Bypass Volume", + ES8388_DACCONTROL20, 3, 7, 1, bypass_tlv), + + SOC_DOUBLE_R_TLV("PCM Volume", + ES8388_LDACVOL, ES8388_RDACVOL, + 0, ES8388_DACVOL_MAX, 1, dac_adc_tlv), + + SOC_DOUBLE_R_TLV("Output 1 Playback Volume", + ES8388_LOUT1VOL, ES8388_ROUT1VOL, + 0, ES8388_OUT1VOL_MAX, 0, play_tlv), + + SOC_DOUBLE_R_TLV("Output 2 Playback Volume", + ES8388_LOUT2VOL, ES8388_ROUT2VOL, + 0, ES8388_OUT2VOL_MAX, 0, play_tlv), + + SOC_DOUBLE_TLV("Mic PGA Volume", ES8388_ADCCONTROL1, + 4, 0, 8, 0, mic_tlv), +}; + +/* + * DAPM Controls + */ +static const char * const es8388_line_texts[] = { + "Line 1", "Line 2", "PGA", "Differential"}; + +static const struct soc_enum es8388_lline_enum = + SOC_ENUM_SINGLE(ES8388_DACCONTROL16, 3, + ARRAY_SIZE(es8388_line_texts), + es8388_line_texts); +static const struct snd_kcontrol_new es8388_left_line_controls = + SOC_DAPM_ENUM("Route", es8388_lline_enum); + +static const struct soc_enum es8388_rline_enum = + SOC_ENUM_SINGLE(ES8388_DACCONTROL16, 0, + ARRAY_SIZE(es8388_line_texts), + es8388_line_texts); +static const struct snd_kcontrol_new es8388_right_line_controls = + SOC_DAPM_ENUM("Route", es8388_lline_enum); + +/* Left Mixer */ +static const struct snd_kcontrol_new es8388_left_mixer_controls[] = { + SOC_DAPM_SINGLE("Playback Switch", ES8388_DACCONTROL17, 7, 1, 0), + SOC_DAPM_SINGLE("Left Bypass Switch", ES8388_DACCONTROL17, 6, 1, 0), + SOC_DAPM_SINGLE("Right Playback Switch", ES8388_DACCONTROL18, 7, 1, 0), + SOC_DAPM_SINGLE("Right Bypass Switch", ES8388_DACCONTROL18, 6, 1, 0), +}; + +/* Right Mixer */ +static const struct snd_kcontrol_new es8388_right_mixer_controls[] = { + SOC_DAPM_SINGLE("Left Playback Switch", ES8388_DACCONTROL19, 7, 1, 0), + SOC_DAPM_SINGLE("Left Bypass Switch", ES8388_DACCONTROL19, 6, 1, 0), + SOC_DAPM_SINGLE("Playback Switch", ES8388_DACCONTROL20, 7, 1, 0), + SOC_DAPM_SINGLE("Right Bypass Switch", ES8388_DACCONTROL20, 6, 1, 0), +}; + +static const char * const es8388_pga_sel[] = { + "Line 1", "Line 2", "Line 3", "Differential"}; + +/* Left PGA Mux */ +static const struct soc_enum es8388_lpga_enum = + SOC_ENUM_SINGLE(ES8388_ADCCONTROL2, 6, + ARRAY_SIZE(es8388_pga_sel), + es8388_pga_sel); +static const struct snd_kcontrol_new es8388_left_pga_controls = + SOC_DAPM_ENUM("Route", es8388_lpga_enum); + +/* Right PGA Mux */ +static const struct soc_enum es8388_rpga_enum = + SOC_ENUM_SINGLE(ES8388_ADCCONTROL2, 4, + ARRAY_SIZE(es8388_pga_sel), + es8388_pga_sel); +static const struct snd_kcontrol_new es8388_right_pga_controls = + SOC_DAPM_ENUM("Route", es8388_rpga_enum); + +/* Differential Mux */ +static const char * const es8388_diff_sel[] = {"Line 1", "Line 2"}; +static SOC_ENUM_SINGLE_DECL(diffmux, + ES8388_ADCCONTROL3, 7, es8388_diff_sel); +static const struct snd_kcontrol_new es8388_diffmux_controls = + SOC_DAPM_ENUM("Route", diffmux); + +/* Mono ADC Mux */ +static const char * const es8388_mono_mux[] = {"Stereo", "Mono (Left)", + "Mono (Right)", "Digital Mono"}; +static SOC_ENUM_SINGLE_DECL(monomux, + ES8388_ADCCONTROL3, 3, es8388_mono_mux); +static const struct snd_kcontrol_new es8388_monomux_controls = + SOC_DAPM_ENUM("Route", monomux); + +static const struct snd_soc_dapm_widget es8388_dapm_widgets[] = { + SND_SOC_DAPM_MUX("Differential Mux", SND_SOC_NOPM, 0, 0, + &es8388_diffmux_controls), + SND_SOC_DAPM_MUX("Left ADC Mux", SND_SOC_NOPM, 0, 0, + &es8388_monomux_controls), + SND_SOC_DAPM_MUX("Right ADC Mux", SND_SOC_NOPM, 0, 0, + &es8388_monomux_controls), + + SND_SOC_DAPM_MUX("Left PGA Mux", ES8388_ADCPOWER, + ES8388_ADCPOWER_AINL_OFF, 1, + &es8388_left_pga_controls), + SND_SOC_DAPM_MUX("Right PGA Mux", ES8388_ADCPOWER, + ES8388_ADCPOWER_AINR_OFF, 1, + &es8388_right_pga_controls), + + SND_SOC_DAPM_MUX("Left Line Mux", SND_SOC_NOPM, 0, 0, + &es8388_left_line_controls), + SND_SOC_DAPM_MUX("Right Line Mux", SND_SOC_NOPM, 0, 0, + &es8388_right_line_controls), + + SND_SOC_DAPM_ADC("Right ADC", "Right Capture", ES8388_ADCPOWER, + ES8388_ADCPOWER_ADCR_OFF, 1), + SND_SOC_DAPM_ADC("Left ADC", "Left Capture", ES8388_ADCPOWER, + ES8388_ADCPOWER_ADCL_OFF, 1), + + SND_SOC_DAPM_SUPPLY("DAC STM", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_DACSTM_RESET, 1, NULL, 0), + SND_SOC_DAPM_SUPPLY("ADC STM", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_ADCSTM_RESET, 1, NULL, 0), + + SND_SOC_DAPM_SUPPLY("DAC DIG", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_DACDIG_OFF, 1, NULL, 0), + SND_SOC_DAPM_SUPPLY("ADC DIG", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_ADCDIG_OFF, 1, NULL, 0), + + SND_SOC_DAPM_SUPPLY("DAC DLL", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_DACDLL_OFF, 1, NULL, 0), + SND_SOC_DAPM_SUPPLY("ADC DLL", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_ADCDLL_OFF, 1, NULL, 0), + + SND_SOC_DAPM_SUPPLY("ADC Vref", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_ADCVREF_OFF, 1, NULL, 0), + SND_SOC_DAPM_SUPPLY("DAC Vref", ES8388_CHIPPOWER, + ES8388_CHIPPOWER_DACVREF_OFF, 1, NULL, 0), + + SND_SOC_DAPM_DAC("Right DAC", "Right Playback", ES8388_DACPOWER, + ES8388_DACPOWER_RDAC_OFF, 1), + SND_SOC_DAPM_DAC("Left DAC", "Left Playback", ES8388_DACPOWER, + ES8388_DACPOWER_LDAC_OFF, 1), + + SND_SOC_DAPM_MIXER("Left Mixer", SND_SOC_NOPM, 0, 0, + &es8388_left_mixer_controls[0], + ARRAY_SIZE(es8388_left_mixer_controls)), + SND_SOC_DAPM_MIXER("Right Mixer", SND_SOC_NOPM, 0, 0, + &es8388_right_mixer_controls[0], + ARRAY_SIZE(es8388_right_mixer_controls)), + + SND_SOC_DAPM_PGA("Right Out 2", ES8388_DACPOWER, + ES8388_DACPOWER_ROUT2_ON, 0, NULL, 0), + SND_SOC_DAPM_PGA("Left Out 2", ES8388_DACPOWER, + ES8388_DACPOWER_LOUT2_ON, 0, NULL, 0), + SND_SOC_DAPM_PGA("Right Out 1", ES8388_DACPOWER, + ES8388_DACPOWER_ROUT1_ON, 0, NULL, 0), + SND_SOC_DAPM_PGA("Left Out 1", ES8388_DACPOWER, + ES8388_DACPOWER_LOUT1_ON, 0, NULL, 0), + + SND_SOC_DAPM_OUTPUT("LOUT1"), + SND_SOC_DAPM_OUTPUT("ROUT1"), + SND_SOC_DAPM_OUTPUT("LOUT2"), + SND_SOC_DAPM_OUTPUT("ROUT2"), + + SND_SOC_DAPM_INPUT("LINPUT1"), + SND_SOC_DAPM_INPUT("LINPUT2"), + SND_SOC_DAPM_INPUT("RINPUT1"), + SND_SOC_DAPM_INPUT("RINPUT2"), +}; + +static const struct snd_soc_dapm_route es8388_dapm_routes[] = { + { "Left Line Mux", "Line 1", "LINPUT1" }, + { "Left Line Mux", "Line 2", "LINPUT2" }, + { "Left Line Mux", "PGA", "Left PGA Mux" }, + { "Left Line Mux", "Differential", "Differential Mux" }, + + { "Right Line Mux", "Line 1", "RINPUT1" }, + { "Right Line Mux", "Line 2", "RINPUT2" }, + { "Right Line Mux", "PGA", "Right PGA Mux" }, + { "Right Line Mux", "Differential", "Differential Mux" }, + + { "Left PGA Mux", "Line 1", "LINPUT1" }, + { "Left PGA Mux", "Line 2", "LINPUT2" }, + { "Left PGA Mux", "Differential", "Differential Mux" }, + + { "Right PGA Mux", "Line 1", "RINPUT1" }, + { "Right PGA Mux", "Line 2", "RINPUT2" }, + { "Right PGA Mux", "Differential", "Differential Mux" }, + + { "Differential Mux", "Line 1", "LINPUT1" }, + { "Differential Mux", "Line 1", "RINPUT1" }, + { "Differential Mux", "Line 2", "LINPUT2" }, + { "Differential Mux", "Line 2", "RINPUT2" }, + + { "Left ADC Mux", "Stereo", "Left PGA Mux" }, + { "Left ADC Mux", "Mono (Left)", "Left PGA Mux" }, + { "Left ADC Mux", "Digital Mono", "Left PGA Mux" }, + + { "Right ADC Mux", "Stereo", "Right PGA Mux" }, + { "Right ADC Mux", "Mono (Right)", "Right PGA Mux" }, + { "Right ADC Mux", "Digital Mono", "Right PGA Mux" }, + + { "Left ADC", NULL, "Left ADC Mux" }, + { "Right ADC", NULL, "Right ADC Mux" }, + + { "ADC DIG", NULL, "ADC STM" }, + { "ADC DIG", NULL, "ADC Vref" }, + { "ADC DIG", NULL, "ADC DLL" }, + + { "Left ADC", NULL, "ADC DIG" }, + { "Right ADC", NULL, "ADC DIG" }, + + { "Left Line Mux", "Line 1", "LINPUT1" }, + { "Left Line Mux", "Line 2", "LINPUT2" }, + { "Left Line Mux", "PGA", "Left PGA Mux" }, + { "Left Line Mux", "Differential", "Differential Mux" }, + + { "Right Line Mux", "Line 1", "RINPUT1" }, + { "Right Line Mux", "Line 2", "RINPUT2" }, + { "Right Line Mux", "PGA", "Right PGA Mux" }, + { "Right Line Mux", "Differential", "Differential Mux" }, + + { "Left Out 1", NULL, "Left DAC" }, + { "Right Out 1", NULL, "Right DAC" }, + { "Left Out 2", NULL, "Left DAC" }, + { "Right Out 2", NULL, "Right DAC" }, + + { "Left Mixer", "Playback Switch", "Left DAC" }, + { "Left Mixer", "Left Bypass Switch", "Left Line Mux" }, + { "Left Mixer", "Right Playback Switch", "Right DAC" }, + { "Left Mixer", "Right Bypass Switch", "Right Line Mux" }, + + { "Right Mixer", "Left Playback Switch", "Left DAC" }, + { "Right Mixer", "Left Bypass Switch", "Left Line Mux" }, + { "Right Mixer", "Playback Switch", "Right DAC" }, + { "Right Mixer", "Right Bypass Switch", "Right Line Mux" }, + + { "DAC DIG", NULL, "DAC STM" }, + { "DAC DIG", NULL, "DAC Vref" }, + { "DAC DIG", NULL, "DAC DLL" }, + + { "Left DAC", NULL, "DAC DIG" }, + { "Right DAC", NULL, "DAC DIG" }, + + { "Left Out 1", NULL, "Left Mixer" }, + { "LOUT1", NULL, "Left Out 1" }, + { "Right Out 1", NULL, "Right Mixer" }, + { "ROUT1", NULL, "Right Out 1" }, + + { "Left Out 2", NULL, "Left Mixer" }, + { "LOUT2", NULL, "Left Out 2" }, + { "Right Out 2", NULL, "Right Mixer" }, + { "ROUT2", NULL, "Right Out 2" }, +}; + +static int es8388_mute(struct snd_soc_dai *dai, int mute, int direction) +{ + if (direction) + return snd_soc_component_update_bits(dai->component, ES8388_ADCCONTROL7, + ES8388_ADCCONTROL7_ADC_MUTE, + mute ? ES8388_ADCCONTROL7_ADC_MUTE : 0); + else + return snd_soc_component_update_bits(dai->component, ES8388_DACCONTROL3, + ES8388_DACCONTROL3_DACMUTE, + mute ? ES8388_DACCONTROL3_DACMUTE : 0); +} + +static int es8388_startup(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct snd_soc_component *component = dai->component; + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + + if (es8388->master && es8388->sysclk_constraints) + snd_pcm_hw_constraint_list(substream->runtime, 0, + SNDRV_PCM_HW_PARAM_RATE, + es8388->sysclk_constraints); + + return 0; +} + +static int es8388_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params, + struct snd_soc_dai *dai) +{ + struct snd_soc_component *component = dai->component; + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + int i; + int reg; + int wl; + int ratio; + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + reg = ES8388_DACCONTROL2; + else + reg = ES8388_ADCCONTROL5; + + if (es8388->master) { + if (!es8388->sysclk_constraints) { + dev_err(component->dev, "No MCLK configured\n"); + return -EINVAL; + } + + for (i = 0; i < es8388->sysclk_constraints->count; i++) + if (es8388->sysclk_constraints->list[i] == + params_rate(params)) + break; + + if (i == es8388->sysclk_constraints->count) { + dev_err(component->dev, + "LRCLK %d unsupported with current clock\n", + params_rate(params)); + return -EINVAL; + } + ratio = es8388->mclk_ratios[i]; + } else { + ratio = 0; + es8388->mclkdiv2 = 0; + } + + snd_soc_component_update_bits(component, ES8388_MASTERMODE, + ES8388_MASTERMODE_MCLKDIV2, + es8388->mclkdiv2 ? ES8388_MASTERMODE_MCLKDIV2 : 0); + + switch (params_width(params)) { + case 16: + wl = 3; + break; + case 18: + wl = 2; + break; + case 20: + wl = 1; + break; + case 24: + wl = 0; + break; + case 32: + wl = 4; + break; + default: + return -EINVAL; + } + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + snd_soc_component_update_bits(component, ES8388_DACCONTROL1, + ES8388_DACCONTROL1_DACWL_MASK, + wl << ES8388_DACCONTROL1_DACWL_SHIFT); + + es8388->playback_fs = params_rate(params); + es8388_set_deemph(component); + } else + snd_soc_component_update_bits(component, ES8388_ADCCONTROL4, + ES8388_ADCCONTROL4_ADCWL_MASK, + wl << ES8388_ADCCONTROL4_ADCWL_SHIFT); + + return snd_soc_component_update_bits(component, reg, ES8388_RATEMASK, ratio); +} + +static int es8388_set_sysclk(struct snd_soc_dai *codec_dai, + int clk_id, unsigned int freq, int dir) +{ + struct snd_soc_component *component = codec_dai->component; + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + int mclkdiv2 = 0; + + switch (freq) { + case 0: + es8388->sysclk_constraints = NULL; + es8388->mclk_ratios = NULL; + break; + case 22579200: + mclkdiv2 = 1; + fallthrough; + case 11289600: + es8388->sysclk_constraints = &constraints_11289; + es8388->mclk_ratios = ratios_11289; + break; + case 24576000: + mclkdiv2 = 1; + fallthrough; + case 12288000: + es8388->sysclk_constraints = &constraints_12288; + es8388->mclk_ratios = ratios_12288; + break; + default: + return -EINVAL; + } + + es8388->mclkdiv2 = mclkdiv2; + return 0; +} + +static int es8388_set_dai_fmt(struct snd_soc_dai *codec_dai, + unsigned int fmt) +{ + struct snd_soc_component *component = codec_dai->component; + struct es8388_priv *es8388 = snd_soc_component_get_drvdata(component); + u8 dac_mode = 0; + u8 adc_mode = 0; + + switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { + case SND_SOC_DAIFMT_CBM_CFM: + /* Master serial port mode, with BCLK generated automatically */ + snd_soc_component_update_bits(component, ES8388_MASTERMODE, + ES8388_MASTERMODE_MSC, + ES8388_MASTERMODE_MSC); + es8388->master = true; + break; + case SND_SOC_DAIFMT_CBS_CFS: + /* Slave serial port mode */ + snd_soc_component_update_bits(component, ES8388_MASTERMODE, + ES8388_MASTERMODE_MSC, 0); + es8388->master = false; + break; + default: + return -EINVAL; + } + + /* interface format */ + switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { + case SND_SOC_DAIFMT_I2S: + dac_mode |= ES8388_DACCONTROL1_DACFORMAT_I2S; + adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_I2S; + break; + case SND_SOC_DAIFMT_RIGHT_J: + dac_mode |= ES8388_DACCONTROL1_DACFORMAT_RJUST; + adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_RJUST; + break; + case SND_SOC_DAIFMT_LEFT_J: + dac_mode |= ES8388_DACCONTROL1_DACFORMAT_LJUST; + adc_mode |= ES8388_ADCCONTROL4_ADCFORMAT_LJUST; + break; + default: + return -EINVAL; + } + + /* clock inversion */ + if ((fmt & SND_SOC_DAIFMT_INV_MASK) != SND_SOC_DAIFMT_NB_NF) + return -EINVAL; + + snd_soc_component_update_bits(component, ES8388_DACCONTROL1, + ES8388_DACCONTROL1_DACFORMAT_MASK, dac_mode); + snd_soc_component_update_bits(component, ES8388_ADCCONTROL4, + ES8388_ADCCONTROL4_ADCFORMAT_MASK, adc_mode); + + return 0; +} + +static int es8388_set_bias_level(struct snd_soc_component *component, + enum snd_soc_bias_level level) +{ + switch (level) { + case SND_SOC_BIAS_ON: + break; + + case SND_SOC_BIAS_PREPARE: + /* VREF, VMID=2x50k, digital enabled */ + snd_soc_component_write(component, ES8388_CHIPPOWER, 0); + snd_soc_component_update_bits(component, ES8388_CONTROL1, + ES8388_CONTROL1_VMIDSEL_MASK | + ES8388_CONTROL1_ENREF, + ES8388_CONTROL1_VMIDSEL_50k | + ES8388_CONTROL1_ENREF); + break; + + case SND_SOC_BIAS_STANDBY: + if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) { + snd_soc_component_update_bits(component, ES8388_CONTROL1, + ES8388_CONTROL1_VMIDSEL_MASK | + ES8388_CONTROL1_ENREF, + ES8388_CONTROL1_VMIDSEL_5k | + ES8388_CONTROL1_ENREF); + + /* Charge caps */ + msleep(100); + } + + snd_soc_component_write(component, ES8388_CONTROL2, + ES8388_CONTROL2_OVERCURRENT_ON | + ES8388_CONTROL2_THERMAL_SHUTDOWN_ON); + + /* VREF, VMID=2*500k, digital stopped */ + snd_soc_component_update_bits(component, ES8388_CONTROL1, + ES8388_CONTROL1_VMIDSEL_MASK | + ES8388_CONTROL1_ENREF, + ES8388_CONTROL1_VMIDSEL_500k | + ES8388_CONTROL1_ENREF); + break; + + case SND_SOC_BIAS_OFF: + snd_soc_component_update_bits(component, ES8388_CONTROL1, + ES8388_CONTROL1_VMIDSEL_MASK | + ES8388_CONTROL1_ENREF, + 0); + break; + } + return 0; +} + +static const struct snd_soc_dai_ops es8388_dai_ops = { + .startup = es8388_startup, + .hw_params = es8388_hw_params, + .mute_stream = es8388_mute, + .set_sysclk = es8388_set_sysclk, + .set_fmt = es8388_set_dai_fmt, + .no_capture_mute = 1, +}; + +static struct snd_soc_dai_driver es8388_dai = { + .name = "es8388-hifi", + .playback = { + .stream_name = "Playback", + .channels_min = 2, + .channels_max = 2, + .rates = ES8388_RATES, + .formats = ES8388_FORMATS, + }, + .capture = { + .stream_name = "Capture", + .channels_min = 2, + .channels_max = 2, + .rates = ES8388_RATES, + .formats = ES8388_FORMATS, + }, + .ops = &es8388_dai_ops, + .symmetric_rate = 1, +}; + +static int es8388_suspend(struct snd_soc_component *component) +{ + return 0; +} + +static int es8388_resume(struct snd_soc_component *component) +{ + struct regmap *regmap = dev_get_regmap(component->dev, NULL); + struct es8388_priv *es8388; + int ret; + + es8388 = snd_soc_component_get_drvdata(component); + + regcache_mark_dirty(regmap); + ret = regcache_sync(regmap); + if (ret) { + dev_err(component->dev, "unable to sync regcache\n"); + return ret; + } + + return 0; +} + +static int es8388_component_probe(struct snd_soc_component *component) +{ + snd_soc_component_write(component, ES8388_ADCPOWER, 0xf0); + snd_soc_component_write(component, ES8388_CONTROL1, 0x30); + snd_soc_component_write(component, ES8388_DACCONTROL21, 0x80); + snd_soc_component_write(component, ES8388_ADCCONTROL10, 0xda); + + return 0; +} + +static void es8388_remove(struct snd_soc_component *component) +{ +} + +const struct regmap_config es8388_regmap_config = { + .reg_bits = 8, + .val_bits = 8, + .max_register = ES8388_REG_MAX, + .cache_type = REGCACHE_RBTREE, + .use_single_read = true, + .use_single_write = true, +}; +EXPORT_SYMBOL_GPL(es8388_regmap_config); + +static const struct snd_soc_component_driver es8388_component_driver = { + .probe = es8388_component_probe, + .remove = es8388_remove, + .suspend = es8388_suspend, + .resume = es8388_resume, + .set_bias_level = es8388_set_bias_level, + .controls = es8388_snd_controls, + .num_controls = ARRAY_SIZE(es8388_snd_controls), + .dapm_widgets = es8388_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(es8388_dapm_widgets), + .dapm_routes = es8388_dapm_routes, + .num_dapm_routes = ARRAY_SIZE(es8388_dapm_routes), + .suspend_bias_off = 1, + .idle_bias_on = 1, + .use_pmdown_time = 1, + .endianness = 1, +}; + +int es8388_probe(struct device *dev, struct regmap *regmap) +{ + struct es8388_priv *es8388; + + if (IS_ERR(regmap)) + return PTR_ERR(regmap); + + es8388 = devm_kzalloc(dev, sizeof(*es8388), GFP_KERNEL); + if (es8388 == NULL) + return -ENOMEM; + + es8388->regmap = regmap; + + dev_set_drvdata(dev, es8388); + + return devm_snd_soc_register_component(dev, + &es8388_component_driver, &es8388_dai, 1); +} +EXPORT_SYMBOL_GPL(es8388_probe); + +static const struct i2c_device_id es8388_id[] = { + { "es8388", 0 }, + { } +}; +MODULE_DEVICE_TABLE(i2c, es8388_id); + +static const struct of_device_id es8388_of_match[] = { + { .compatible = "everest,es8388", }, + { } +}; +MODULE_DEVICE_TABLE(of, es8388_of_match); + +static struct acpi_device_id es8388_acpi_match[] = { + {"ESSX8388", 0 }, + {}, +}; +MODULE_DEVICE_TABLE(acpi, es8388_acpi_match); + +static int es8388_i2c_probe(struct i2c_client *i2c) +{ + return es8388_probe(&i2c->dev, + devm_regmap_init_i2c(i2c, &es8388_regmap_config)); +} + +static struct i2c_driver es8388_i2c_driver = { + .driver = { + .name = "es8388", + .of_match_table = es8388_of_match, + .acpi_match_table = es8388_acpi_match, + }, + .probe = es8388_i2c_probe, + .id_table = es8388_id, +}; + +module_i2c_driver(es8388_i2c_driver); + +MODULE_DESCRIPTION("ASoC ES8388 driver"); +MODULE_AUTHOR("Yiqun Zhang "); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8388.h b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8388.h new file mode 100644 index 0000000000000000000000000000000000000000..5858a71261fba6d8258eac45edc2d0cfcbda39ef --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/codecs/es8388.h @@ -0,0 +1,290 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * es8388.h -- ES8388 ALSA SoC Audio driver + */ + +#ifndef _ES8388_H +#define _ES8388_H + +#include + +struct device; + +extern const struct regmap_config es8388_regmap_config; +int es8388_probe(struct device *dev, struct regmap *regmap); + +#define ES8388_DACLVOL 46 +#define ES8388_DACRVOL 47 +#define ES8388_DACCTL 28 +#define ES8388_RATEMASK (0x1f << 0) + +#define ES8388_CONTROL1 0x00 +#define ES8388_CONTROL1_VMIDSEL_OFF (0 << 0) +#define ES8388_CONTROL1_VMIDSEL_50k (1 << 0) +#define ES8388_CONTROL1_VMIDSEL_500k (2 << 0) +#define ES8388_CONTROL1_VMIDSEL_5k (3 << 0) +#define ES8388_CONTROL1_VMIDSEL_MASK (3 << 0) +#define ES8388_CONTROL1_ENREF (1 << 2) +#define ES8388_CONTROL1_SEQEN (1 << 3) +#define ES8388_CONTROL1_SAMEFS (1 << 4) +#define ES8388_CONTROL1_DACMCLK_ADC (0 << 5) +#define ES8388_CONTROL1_DACMCLK_DAC (1 << 5) +#define ES8388_CONTROL1_LRCM (1 << 6) +#define ES8388_CONTROL1_SCP_RESET (1 << 7) + +#define ES8388_CONTROL2 0x01 +#define ES8388_CONTROL2_VREF_BUF_OFF (1 << 0) +#define ES8388_CONTROL2_VREF_LOWPOWER (1 << 1) +#define ES8388_CONTROL2_IBIASGEN_OFF (1 << 2) +#define ES8388_CONTROL2_ANALOG_OFF (1 << 3) +#define ES8388_CONTROL2_VREF_BUF_LOWPOWER (1 << 4) +#define ES8388_CONTROL2_VCM_MOD_LOWPOWER (1 << 5) +#define ES8388_CONTROL2_OVERCURRENT_ON (1 << 6) +#define ES8388_CONTROL2_THERMAL_SHUTDOWN_ON (1 << 7) + +#define ES8388_CHIPPOWER 0x02 +#define ES8388_CHIPPOWER_DACVREF_OFF 0 +#define ES8388_CHIPPOWER_ADCVREF_OFF 1 +#define ES8388_CHIPPOWER_DACDLL_OFF 2 +#define ES8388_CHIPPOWER_ADCDLL_OFF 3 +#define ES8388_CHIPPOWER_DACSTM_RESET 4 +#define ES8388_CHIPPOWER_ADCSTM_RESET 5 +#define ES8388_CHIPPOWER_DACDIG_OFF 6 +#define ES8388_CHIPPOWER_ADCDIG_OFF 7 + +#define ES8388_ADCPOWER 0x03 +#define ES8388_ADCPOWER_INT1_LOWPOWER 0 +#define ES8388_ADCPOWER_FLASH_ADC_LOWPOWER 1 +#define ES8388_ADCPOWER_ADC_BIAS_GEN_OFF 2 +#define ES8388_ADCPOWER_MIC_BIAS_OFF 3 +#define ES8388_ADCPOWER_ADCR_OFF 4 +#define ES8388_ADCPOWER_ADCL_OFF 5 +#define ES8388_ADCPOWER_AINR_OFF 6 +#define ES8388_ADCPOWER_AINL_OFF 7 + +#define ES8388_DACPOWER 0x04 +#define ES8388_DACPOWER_OUT3_ON 0 +#define ES8388_DACPOWER_MONO_ON 1 +#define ES8388_DACPOWER_ROUT2_ON 2 +#define ES8388_DACPOWER_LOUT2_ON 3 +#define ES8388_DACPOWER_ROUT1_ON 4 +#define ES8388_DACPOWER_LOUT1_ON 5 +#define ES8388_DACPOWER_RDAC_OFF 6 +#define ES8388_DACPOWER_LDAC_OFF 7 + +#define ES8388_CHIPLOPOW1 0x05 +#define ES8388_CHIPLOPOW2 0x06 +#define ES8388_ANAVOLMANAG 0x07 + +#define ES8388_MASTERMODE 0x08 +#define ES8388_MASTERMODE_BCLKDIV (0 << 0) +#define ES8388_MASTERMODE_BCLK_INV (1 << 5) +#define ES8388_MASTERMODE_MCLKDIV2 (1 << 6) +#define ES8388_MASTERMODE_MSC (1 << 7) + +#define ES8388_ADCCONTROL1 0x09 +#define ES8388_ADCCONTROL2 0x0a +#define ES8388_ADCCONTROL3 0x0b + +#define ES8388_ADCCONTROL4 0x0c +#define ES8388_ADCCONTROL4_ADCFORMAT_MASK (3 << 0) +#define ES8388_ADCCONTROL4_ADCFORMAT_I2S (0 << 0) +#define ES8388_ADCCONTROL4_ADCFORMAT_LJUST (1 << 0) +#define ES8388_ADCCONTROL4_ADCFORMAT_RJUST (2 << 0) +#define ES8388_ADCCONTROL4_ADCFORMAT_PCM (3 << 0) +#define ES8388_ADCCONTROL4_ADCWL_SHIFT 2 +#define ES8388_ADCCONTROL4_ADCWL_MASK (7 << 2) +#define ES8388_ADCCONTROL4_ADCLRP_I2S_POL_NORMAL (0 << 5) +#define ES8388_ADCCONTROL4_ADCLRP_I2S_POL_INV (1 << 5) +#define ES8388_ADCCONTROL4_ADCLRP_PCM_MSB_CLK2 (0 << 5) +#define ES8388_ADCCONTROL4_ADCLRP_PCM_MSB_CLK1 (1 << 5) + +#define ES8388_ADCCONTROL5 0x0d +#define ES8388_ADCCONTROL5_RATEMASK (0x1f << 0) + +#define ES8388_ADCCONTROL6 0x0e + +#define ES8388_ADCCONTROL7 0x0f +#define ES8388_ADCCONTROL7_ADC_MUTE (1 << 2) +#define ES8388_ADCCONTROL7_ADC_LER (1 << 3) +#define ES8388_ADCCONTROL7_ADC_ZERO_CROSS (1 << 4) +#define ES8388_ADCCONTROL7_ADC_SOFT_RAMP (1 << 5) +#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_4 (0 << 6) +#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_8 (1 << 6) +#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_16 (2 << 6) +#define ES8388_ADCCONTROL7_ADC_RAMP_RATE_32 (3 << 6) + +#define ES8388_ADCCONTROL8 0x10 +#define ES8388_ADCCONTROL9 0x11 +#define ES8388_ADCCONTROL10 0x12 +#define ES8388_ADCCONTROL11 0x13 +#define ES8388_ADCCONTROL12 0x14 +#define ES8388_ADCCONTROL13 0x15 +#define ES8388_ADCCONTROL14 0x16 + +#define ES8388_DACCONTROL1 0x17 +#define ES8388_DACCONTROL1_DACFORMAT_MASK (3 << 1) +#define ES8388_DACCONTROL1_DACFORMAT_I2S (0 << 1) +#define ES8388_DACCONTROL1_DACFORMAT_LJUST (1 << 1) +#define ES8388_DACCONTROL1_DACFORMAT_RJUST (2 << 1) +#define ES8388_DACCONTROL1_DACFORMAT_PCM (3 << 1) +#define ES8388_DACCONTROL1_DACWL_SHIFT 3 +#define ES8388_DACCONTROL1_DACWL_MASK (7 << 3) +#define ES8388_DACCONTROL1_DACLRP_I2S_POL_NORMAL (0 << 6) +#define ES8388_DACCONTROL1_DACLRP_I2S_POL_INV (1 << 6) +#define ES8388_DACCONTROL1_DACLRP_PCM_MSB_CLK2 (0 << 6) +#define ES8388_DACCONTROL1_DACLRP_PCM_MSB_CLK1 (1 << 6) +#define ES8388_DACCONTROL1_LRSWAP (1 << 7) + +#define ES8388_DACCONTROL2 0x18 +#define ES8388_DACCONTROL2_RATEMASK (0x1f << 0) +#define ES8388_DACCONTROL2_DOUBLESPEED (1 << 5) + +#define ES8388_DACCONTROL3 0x19 +#define ES8388_DACCONTROL3_AUTOMUTE (1 << 2) +#define ES8388_DACCONTROL3_DACMUTE (1 << 2) +#define ES8388_DACCONTROL3_LEFTGAINVOL (1 << 3) +#define ES8388_DACCONTROL3_DACZEROCROSS (1 << 4) +#define ES8388_DACCONTROL3_DACSOFTRAMP (1 << 5) +#define ES8388_DACCONTROL3_DACRAMPRATE (3 << 6) + +#define ES8388_LDACVOL 0x1a +#define ES8388_LDACVOL_MASK (0 << 0) +#define ES8388_LDACVOL_MAX (0xc0) + +#define ES8388_RDACVOL 0x1b +#define ES8388_RDACVOL_MASK (0 << 0) +#define ES8388_RDACVOL_MAX (0xc0) + +#define ES8388_DACVOL_MAX (0xc0) + +#define ES8388_DACCONTROL4 0x1a +#define ES8388_DACCONTROL5 0x1b + +#define ES8388_DACCONTROL6 0x1c +#define ES8388_DACCONTROL6_CLICKFREE (1 << 3) +#define ES8388_DACCONTROL6_DAC_INVR (1 << 4) +#define ES8388_DACCONTROL6_DAC_INVL (1 << 5) +#define ES8388_DACCONTROL6_DEEMPH_MASK (3 << 6) +#define ES8388_DACCONTROL6_DEEMPH_OFF (0 << 6) +#define ES8388_DACCONTROL6_DEEMPH_32k (1 << 6) +#define ES8388_DACCONTROL6_DEEMPH_44_1k (2 << 6) +#define ES8388_DACCONTROL6_DEEMPH_48k (3 << 6) + +#define ES8388_DACCONTROL7 0x1d +#define ES8388_DACCONTROL7_VPP_SCALE_3p5 (0 << 0) +#define ES8388_DACCONTROL7_VPP_SCALE_4p0 (1 << 0) +#define ES8388_DACCONTROL7_VPP_SCALE_3p0 (2 << 0) +#define ES8388_DACCONTROL7_VPP_SCALE_2p5 (3 << 0) +#define ES8388_DACCONTROL7_SHELVING_STRENGTH (1 << 2) /* In eights */ +#define ES8388_DACCONTROL7_MONO (1 << 5) +#define ES8388_DACCONTROL7_ZEROR (1 << 6) +#define ES8388_DACCONTROL7_ZEROL (1 << 7) + +/* Shelving filter */ +#define ES8388_DACCONTROL8 0x1e +#define ES8388_DACCONTROL9 0x1f +#define ES8388_DACCONTROL10 0x20 +#define ES8388_DACCONTROL11 0x21 +#define ES8388_DACCONTROL12 0x22 +#define ES8388_DACCONTROL13 0x23 +#define ES8388_DACCONTROL14 0x24 +#define ES8388_DACCONTROL15 0x25 + +#define ES8388_DACCONTROL16 0x26 +#define ES8388_DACCONTROL16_RMIXSEL_RIN1 (0 << 0) +#define ES8388_DACCONTROL16_RMIXSEL_RIN2 (1 << 0) +#define ES8388_DACCONTROL16_RMIXSEL_RIN3 (2 << 0) +#define ES8388_DACCONTROL16_RMIXSEL_RADC (3 << 0) +#define ES8388_DACCONTROL16_LMIXSEL_LIN1 (0 << 3) +#define ES8388_DACCONTROL16_LMIXSEL_LIN2 (1 << 3) +#define ES8388_DACCONTROL16_LMIXSEL_LIN3 (2 << 3) +#define ES8388_DACCONTROL16_LMIXSEL_LADC (3 << 3) + +#define ES8388_DACCONTROL17 0x27 +#define ES8388_DACCONTROL17_LI2LOVOL (7 << 3) +#define ES8388_DACCONTROL17_LI2LO (1 << 6) +#define ES8388_DACCONTROL17_LD2LO (1 << 7) + +#define ES8388_DACCONTROL18 0x28 +#define ES8388_DACCONTROL18_RI2LOVOL (7 << 3) +#define ES8388_DACCONTROL18_RI2LO (1 << 6) +#define ES8388_DACCONTROL18_RD2LO (1 << 7) + +#define ES8388_DACCONTROL19 0x29 +#define ES8388_DACCONTROL19_LI2ROVOL (7 << 3) +#define ES8388_DACCONTROL19_LI2RO (1 << 6) +#define ES8388_DACCONTROL19_LD2RO (1 << 7) + +#define ES8388_DACCONTROL20 0x2a +#define ES8388_DACCONTROL20_RI2ROVOL (7 << 3) +#define ES8388_DACCONTROL20_RI2RO (1 << 6) +#define ES8388_DACCONTROL20_RD2RO (1 << 7) + +#define ES8388_DACCONTROL21 0x2b +#define ES8388_DACCONTROL21_LI2MOVOL (7 << 3) +#define ES8388_DACCONTROL21_LI2MO (1 << 6) +#define ES8388_DACCONTROL21_LD2MO (1 << 7) + +#define ES8388_DACCONTROL22 0x2c +#define ES8388_DACCONTROL22_RI2MOVOL (7 << 3) +#define ES8388_DACCONTROL22_RI2MO (1 << 6) +#define ES8388_DACCONTROL22_RD2MO (1 << 7) + +#define ES8388_DACCONTROL23 0x2d +#define ES8388_DACCONTROL23_MOUTINV (1 << 1) +#define ES8388_DACCONTROL23_HPSWPOL (1 << 2) +#define ES8388_DACCONTROL23_HPSWEN (1 << 3) +#define ES8388_DACCONTROL23_VROI_1p5k (0 << 4) +#define ES8388_DACCONTROL23_VROI_40k (1 << 4) +#define ES8388_DACCONTROL23_OUT3_VREF (0 << 5) +#define ES8388_DACCONTROL23_OUT3_ROUT1 (1 << 5) +#define ES8388_DACCONTROL23_OUT3_MONOOUT (2 << 5) +#define ES8388_DACCONTROL23_OUT3_RIGHT_MIXER (3 << 5) +#define ES8388_DACCONTROL23_ROUT2INV (1 << 7) + +/* LOUT1 Amplifier */ +#define ES8388_LOUT1VOL 0x2e +#define ES8388_LOUT1VOL_MASK (0 << 5) +#define ES8388_LOUT1VOL_MAX (0x24) + +/* ROUT1 Amplifier */ +#define ES8388_ROUT1VOL 0x2f +#define ES8388_ROUT1VOL_MASK (0 << 5) +#define ES8388_ROUT1VOL_MAX (0x24) + +#define ES8388_OUT1VOL_MAX (0x24) + +/* LOUT2 Amplifier */ +#define ES8388_LOUT2VOL 0x30 +#define ES8388_LOUT2VOL_MASK (0 << 5) +#define ES8388_LOUT2VOL_MAX (0x24) + +/* ROUT2 Amplifier */ +#define ES8388_ROUT2VOL 0x31 +#define ES8388_ROUT2VOL_MASK (0 << 5) +#define ES8388_ROUT2VOL_MAX (0x24) + +#define ES8388_OUT2VOL_MAX (0x24) + +/* Mono Out Amplifier */ +#define ES8388_MONOOUTVOL 0x32 +#define ES8388_MONOOUTVOL_MASK (0 << 5) +#define ES8388_MONOOUTVOL_MAX (0x24) + +#define ES8388_DACCONTROL29 0x33 +#define ES8388_DACCONTROL30 0x34 + +#define ES8388_SYSCLK 0 + +#define ES8388_REG_MAX 0x35 + +#define ES8388_1536FS 1536 +#define ES8388_1024FS 1024 +#define ES8388_768FS 768 +#define ES8388_512FS 512 +#define ES8388_384FS 384 +#define ES8388_256FS 256 +#define ES8388_128FS 128 + +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/Kconfig b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..b4fd9ae0b654bd337194dd15e02663060dfdf6a6 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/Kconfig @@ -0,0 +1,32 @@ +# SPDX-License-Identifier: GPL-2.0 +config SND_SOC_PHYTIUM_I2S + tristate "Phytium I2S Device Driver" + depends on ARCH_PHYTIUM + help + Say Y or M if you want to add support for I2S driver for + Phytium I2S device . The device supports 2 channels each + for play and record. + +config SND_PMDK_ES8388 + tristate "Phytium machine support with ES8388" + depends on I2C && SND_SOC_PHYTIUM_I2S + select SND_SOC_ES8388 + help + Say Y if you want to add Phytium machine support for + ES8388 codecs. + +config SND_PMDK_ES8336 + tristate "Phytium machine support with ES8336" + depends on I2C && SND_SOC_PHYTIUM_I2S + select SND_SOC_ES8336 + help + Say Y if you want to add Phytium machine support for + ES8336 codecs. + +config SND_PMDK_DP + tristate "Phytium machine support with DP" + depends on I2C && SND_SOC_PHYTIUM_I2S + select SND_SOC_HDMI_CODEC + help + Say Y if you want to add Phytium machine support for + Displayport. diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/Makefile b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..45cd2ed9d420cce7c1e2cd52a617e7cc4e6c0175 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/Makefile @@ -0,0 +1,14 @@ +# SPDX-License-Identifier: GPL-2.0 +# PHYTIUM Platform Support + +snd-soc-phytium-i2s-objs :=phytium_i2s.o +obj-$(CONFIG_SND_SOC_PHYTIUM_I2S) += snd-soc-phytium-i2s.o + +snd-soc-pmdk-es8388-objs :=pmdk_es8388.o +obj-$(CONFIG_SND_PMDK_ES8388) += snd-soc-pmdk-es8388.o + +snd-soc-pmdk-es8336-objs :=pmdk_es8336.o +obj-$(CONFIG_SND_PMDK_ES8336) += snd-soc-pmdk-es8336.o + +snd-soc-pmdk-dp-objs :=pmdk_dp.o +obj-$(CONFIG_SND_PMDK_DP) += snd-soc-pmdk-dp.o diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/local.h b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/local.h new file mode 100644 index 0000000000000000000000000000000000000000..8cc80d1d1040e1f0e5ea6179e63a115c5d048f46 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/local.h @@ -0,0 +1,319 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + */ + +#ifndef __PHYTIUM_I2S_LOCAL_H +#define __PHYTIUM_I2S_LOCAL_H + +#include +#include +#include +#include + +/* I2S clk setting*/ +#define CLK_CFG0 0xc00 +#define CLK_CFG1 0xc04 + +/* Common register for all channel */ +#define I2S_IER 0x000 +#define IRER 0x004 +#define ITER 0x008 +#define CER 0x00C + +#define RXFFR 0x014 +#define TXFFR 0x018 + +/* Interrupt status register fields */ +#define ISR_TXFO BIT(5) +#define ISR_TXFE BIT(4) +#define ISR_RXFO BIT(1) +#define ISR_RXDA BIT(0) + +/* I2STxRxRegisters for all channels */ +#define LRBR_LTHR(x) (0x40 * x + 0x020) +#define RRBR_RTHR(x) (0x40 * x + 0x024) +#define RER(x) (0x40 * x + 0x028) + +#define RCR(x) (0x40 * x + 0x030) + +#define ISR(x) (0x40 * x + 0x038) +#define IMR(x) (0x40 * x + 0x03C) +#define ROR(x) (0x40 * x + 0x040) +#define TOR(x) (0x40 * x + 0x044) +#define RFCR(x) (0x40 * x + 0x048) +#define TFCR(x) (0x40 * x + 0x04C) +#define RFF(x) (0x40 * x + 0x050) +#define TFF(x) (0x40 * x + 0x054) + +/* Enable txd and rxd block channel0~3 */ +#define TER(x) (0x40 * x + 0x02C) +#define CCR 0x010 +#define TCR(x) (0x40 * x + 0x034) + +/* I2SCOMPRegisters */ +#define I2S_COMP_PARAM_2 0x01F0 +#define I2S_COMP_PARAM_1 0x01F4 +#define I2S_COMP_VERSION 0x01F8 +#define I2S_COMP_TYPE 0x01FC + +/* I2S AND DMA */ +#define DMA_GCAP 0x0024 + +#define DMA_CHAL_CONFG1 0x0028 + +#define DMA_CHAL_CONFG0 0x0004 +#define DMA_MASK_INT 0x000c +#define DMA_BDLPU(x) (0x40 * x + 0x0040) +#define DMA_BDLPL(x) (0x40 * x + 0x0044) +#define DMA_CHALX_DEV_ADDR(x) (0x40 * x + 0x0048) +#define DMA_CHALX_CBL(x) (0x40 * x + 0x0054) +#define DMA_CHALX_LVI(x) (0x40 * x + 0x004c) + +#define DMA_CHALX_DSIZE(x) (0x40 * x + 0x0064) +#define DMA_CHALX_DLENTH(x) (0x40 * x + 0x0068) +#define DMA_CHALX_CTL(x) (0x40 * x + 0x0058) + + +#define DMA_CTL 0x0000 + +#define DMA_LPIB(x) (0x40 * x + 0x0050) + +#define DMA_STS 0x0008 + +/* max number of fragments - we may use more if allocating more pages for BDL */ +#define BDL_SIZE 4096 +#define AZX_MAX_BDL_ENTRIES (BDL_SIZE / 16) + +/* + * Component parameter register fields - define the I2S block's + * configuration. + */ +#define COMP1_TX_WORDSIZE_3(r) (((r) & GENMASK(27, 25)) >> 25) +#define COMP1_TX_WORDSIZE_2(r) (((r) & GENMASK(24, 22)) >> 22) +#define COMP1_TX_WORDSIZE_1(r) (((r) & GENMASK(21, 19)) >> 19) +#define COMP1_TX_WORDSIZE_0(r) (((r) & GENMASK(18, 16)) >> 16) +#define COMP1_TX_CHANNELS(r) (((r) & GENMASK(10, 9)) >> 9) +#define COMP1_RX_CHANNELS(r) (((r) & GENMASK(8, 7)) >> 7) +#define COMP1_RX_ENABLED(r) (((r) & BIT(6)) >> 6) +#define COMP1_TX_ENABLED(r) (((r) & BIT(5)) >> 5) +#define COMP1_MODE_EN(r) (((r) & BIT(4)) >> 4) +#define COMP1_FIFO_DEPTH_GLOBAL(r) (((r) & GENMASK(3, 2)) >> 2) +#define COMP1_APB_DATA_WIDTH(r) (((r) & GENMASK(1, 0)) >> 0) + +#define COMP2_RX_WORDSIZE_3(r) (((r) & GENMASK(12, 10)) >> 10) +#define COMP2_RX_WORDSIZE_2(r) (((r) & GENMASK(9, 7)) >> 7) +#define COMP2_RX_WORDSIZE_1(r) (((r) & GENMASK(5, 3)) >> 3) +#define COMP2_RX_WORDSIZE_0(r) (((r) & GENMASK(2, 0)) >> 0) + +/* Number of entries in WORDSIZE and DATA_WIDTH parameter registers */ +#define COMP_MAX_WORDSIZE (1 << 3) +#define COMP_MAX_DATA_WIDTH (1 << 2) + +#define MAX_CHANNEL_NUM 8 +#define MIN_CHANNEL_NUM 2 + +#define azx_bus(chip) (&(chip)->bus.core) +#define bus_to_azx(_bus) container_of(_bus, struct azx, bus.core) + +#define I2S_UNSOL_QUEUE_SIZE 64 +#define I2S_MAX_CODECS 8 /* limit by controller side */ + +#define azx_stream(dev) (&(dev)->core) + +struct i2s_clk_config_data { + int chan_nr; + u32 data_width; + u32 sample_rate; +}; + +struct i2sc_bus { + struct device *dev; + const struct i2s_bus_ops *ops; + const struct i2s_io_ops *io_ops; + const struct i2s_ext_bus_ops *ext_ops; + + /* h/w resources */ + unsigned long addr; + void __iomem *remap_addr; + int irq; + + /* codec linked list */ + struct list_head codec_list; + unsigned int num_codecs; + + unsigned int unsol_rp, unsol_wp; + struct work_struct unsol_work; + + struct snd_dma_buffer bdl0; + struct snd_dma_buffer bdl1; + + /* i2s_stream linked list */ + struct list_head stream_list; + + bool reverse_assign; /* assign devices in reverse order */ + + int bdl_pos_adj; /* BDL position adjustment */ + + /* locks */ + spinlock_t reg_lock; +}; + +struct i2s_bus { + struct i2sc_bus core; + + struct snd_card *card; + + struct pci_dev *pci; + + struct mutex prepare_mutex; +}; + + +/* + * i2s stream + */ +struct i2s_stream { + struct i2sc_bus *bus; + struct snd_dma_buffer bdl; /* BDL buffer */ + __le32 *posbuf; /* position buffer pointer */ + int direction; /* playback / capture (SNDRV_PCM_STREAM_*) */ + + unsigned int bufsize; /* size of the play buffer in bytes */ + unsigned int period_bytes; /* size of the period in bytes */ + unsigned int frags; /* number for period in the play buffer */ + unsigned int fifo_size; /* FIFO size */ + + void __iomem *sd_addr; /* stream descriptor pointer */ + + u32 sd_int_sta_mask; /* stream int status mask */ + + /* pcm support */ + struct snd_pcm_substream *substream; /* assigned substream, + * set in PCM open + */ + unsigned int format_val; /* format value to be set in the + * controller and the codec + */ + unsigned char stream_tag; /* assigned stream */ + unsigned char index; /* stream index */ + int assigned_key; /* last device# key assigned to */ + + bool opened; + bool running; + bool prepared; + bool no_period_wakeup; + + int delay_negative_threshold; + + struct list_head list; + +}; + +struct azx_dev { + struct i2s_stream core; + unsigned int irq_pending:1; +}; + +/* PCM setup */ +static inline struct azx_dev *get_azx_dev(struct snd_pcm_substream *substream) +{ + return substream->runtime->private_data; +} + +#define AZX_MAX_CODECS HDA_MAX_CODECS +#define AZX_DEFAULT_CODECS 4 + +#define stream_to_azx_dev(s) container_of(s, struct azx_dev, core) + +struct azx; + +struct i2s_controller_ops { + int (*substream_alloc_pages)(struct azx *chip, + struct snd_pcm_substream *substream, + size_t size); + int (*substream_free_pages)(struct azx *chip, + struct snd_pcm_substream *substream); + int (*position_check)(struct azx *chip, struct azx_dev *azx_dev); +}; + +struct i2s_io_ops { + int (*dma_alloc_pages)(struct i2sc_bus *bus, int type, size_t size, + struct snd_dma_buffer *buf); + void (*dma_free_pages)(struct i2sc_bus *bus, + struct snd_dma_buffer *buf); +}; + +struct azx { + struct i2s_bus bus; + + struct snd_card *card; + struct pci_dev *pci; + int dev_index; + + int playback_streams; + int playback_index_offset; + int capture_streams; + int capture_index_offset; + int num_streams; + + /* Register interaction. */ + const struct i2s_controller_ops *ops; + + /* locks */ + struct mutex open_mutex; /* Prevents concurrent open/close operations */ + + /* PCM */ + struct list_head pcm_list; /* azx_pcm list */ + + /* flags */ + int bdl_pos_adj; + unsigned int running:1; + unsigned int region_requested:1; + unsigned int disabled:1; +}; + +struct i2s_phytium { + struct azx chip; + struct snd_pcm_substream *substream; + struct device *dev; + struct device *pdev; + u32 paddr; + void __iomem *regs; + void __iomem *regs_db; + int irq_id; + + /* for pending irqs */ + struct work_struct irq_pending_work; + + /* sync probing */ + struct completion probe_wait; + struct work_struct probe_work; + + /* extra flags */ + unsigned int pcie:1; + unsigned int irq_pending_warned:1; + unsigned int probe_continued:1; + unsigned int i2s_dp:1; + + unsigned int i2s_reg_comp1; + unsigned int i2s_reg_comp2; + struct clk *clk; + unsigned int capability; + unsigned int quirks; + u32 fifo_th; + int active; + u32 xfer_resolution; + u32 ccr; + u32 clk_base; + u32 cfg; + struct i2s_clk_config_data config; + + /*azx_dev*/ + struct i2s_stream core; +}; + +#define azx_alloc_stream_pages(chip) \ + snd_i2s_bus_alloc_stream_pages(azx_bus(chip)) + +#endif diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/phytium_i2s.c b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/phytium_i2s.c new file mode 100644 index 0000000000000000000000000000000000000000..9119cdae1c24909a20eade6d96a737c0e0c62598 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/phytium_i2s.c @@ -0,0 +1,1433 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phytium I2S ASoC driver + * + * Copyright (c) 2020-2024 Phytium Technology Co., Ltd. + * + * Derived from sound/soc/dwc/dwc-i2s.c + * Copyright (C) 2010 ST Microelectronics + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "local.h" + +#define NUM_CAPTURE 1 +#define NUM_PLAYBACK 1 + +#define PHYTIUM_I2S_PLAY (1 << 0) +#define PHYTIUM_I2S_RECORD (1 << 1) +#define PHYTIUM_I2S_SLAVE (1 << 2) +#define PHYTIUM_I2S_MASTER (1 << 3) + +#define PHYTIUM_I2S_QUIRK_16BIT_IDX_OVERRIDE (1 << 2) + +#define TWO_CHANNEL_SUPPORT 2 /* up to 2.0 */ +#define FOUR_CHANNEL_SUPPORT 4 /* up to 3.1 */ +#define SIX_CHANNEL_SUPPORT 6 /* up to 5.1 */ +#define EIGHT_CHANNEL_SUPPORT 8 /* up to 7.1 */ + +struct pdata_px210_mfd { + struct device *dev; + char *name; + int clk_base; +}; + +static inline void i2s_write_reg(void __iomem *io_base, int reg, u32 val) +{ + writel(val, io_base + reg); +} + +static inline u32 i2s_read_reg(void __iomem *io_base, int reg) +{ + return readl(io_base + reg); +} + +static inline void i2s_disable_channels(struct i2s_phytium *dev, u32 stream) +{ + u32 i = 0; + + if (stream == SNDRV_PCM_STREAM_PLAYBACK) { + for (i = 0; i < 4; i++) + i2s_write_reg(dev->regs, TER(i), 0); + } else { + for (i = 0; i < 4; i++) + i2s_write_reg(dev->regs, RER(i), 0); + } +} + +static int substream_free_pages(struct azx *chip, + struct snd_pcm_substream *substream) +{ + return snd_pcm_lib_free_pages(substream); +} + +static void stream_update(struct i2sc_bus *bus, struct i2s_stream *s) +{ + struct azx *chip = bus_to_azx(bus); + + struct azx_dev *azx_dev = stream_to_azx_dev(s); + + /* check whether this IRQ is really acceptable */ + if (!chip->ops->position_check || + chip->ops->position_check(chip, azx_dev)) { + spin_unlock(&bus->reg_lock); + snd_pcm_period_elapsed(azx_stream(azx_dev)->substream); + spin_lock(&bus->reg_lock); + } +} + +int snd_i2s_bus_handle_stream_irq(struct i2sc_bus *bus, unsigned int status, + void (*ack)(struct i2sc_bus *, struct i2s_stream *)) +{ + struct i2s_stream *azx_dev; + u32 sd_status, qc_sd_status; + int handled = 0; + + list_for_each_entry(azx_dev, &bus->stream_list, list) { + if (status & azx_dev->sd_int_sta_mask) { + sd_status = i2s_read_reg(azx_dev->sd_addr, DMA_STS); + i2s_write_reg(azx_dev->sd_addr, DMA_STS, azx_dev->sd_int_sta_mask); + qc_sd_status = i2s_read_reg(azx_dev->sd_addr, DMA_STS); + handled |= 1 << azx_dev->index; + azx_dev->running = 1; + if (!azx_dev->substream || !azx_dev->running || + !(sd_status & 0xffffffff)) { + continue; + } + if (ack) + ack(bus, azx_dev); + } + } + + return handled; +} + +irqreturn_t azx_i2s_interrupt(int irq, void *dev_id) +{ + struct azx *chip = dev_id; + struct i2sc_bus *bus = azx_bus(chip); + u32 status; + bool active, handled = false; + int repeat = 0; /* count for avoiding endless loop */ + + spin_lock(&bus->reg_lock); + + if (chip->disabled) + goto unlock; + + do { + status = i2s_read_reg(bus->remap_addr, DMA_STS); + + if (status == 0) + break; + + handled = true; + active = false; + if (snd_i2s_bus_handle_stream_irq(bus, status, stream_update)) + active = true; + } while (active && ++repeat < 1); + + unlock: + spin_unlock(&bus->reg_lock); + return IRQ_RETVAL(handled); +} + +static int azx_acquire_irq(struct azx *chip, int do_disconnect) +{ + struct i2sc_bus *bus = azx_bus(chip); + struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); + int err; + + err = devm_request_irq(i2s->dev, i2s->irq_id, azx_i2s_interrupt, IRQF_SHARED, + "phytium i2s", chip); + + if (err < 0) { + dev_err(i2s->dev, "failed to request irq\n"); + return err; + } + + bus->irq = i2s->irq_id; + + return 0; +} + +static void i2s_start(struct i2s_phytium *dev, + struct snd_pcm_substream *substream) +{ + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + i2s_write_reg(dev->regs, ITER, 1); + else + i2s_write_reg(dev->regs, IRER, 1); + + /*enable the clock*/ + i2s_write_reg(dev->regs, CER, 1); + + /*enable the i2s*/ + i2s_write_reg(dev->regs, I2S_IER, 1); +} + +static void i2s_stop(struct i2s_phytium *dev, struct snd_pcm_substream *substream) +{ + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + i2s_write_reg(dev->regs, ITER, 0); + else + i2s_write_reg(dev->regs, IRER, 0); + + if (!dev->active) { + i2s_write_reg(dev->regs, CER, 0); + i2s_write_reg(dev->regs, I2S_IER, 0); + } +} + +static void phytium_i2s_config(struct i2s_phytium *dev, int stream) +{ + i2s_disable_channels(dev, stream); + + if (stream == SNDRV_PCM_STREAM_PLAYBACK) { + i2s_write_reg(dev->regs, TCR(0), dev->xfer_resolution); + i2s_write_reg(dev->regs, TER(0), 1); + } else { + i2s_write_reg(dev->regs, RCR(0), dev->xfer_resolution); + i2s_write_reg(dev->regs, RER(0), 1); + } +} + +static int phytium_i2s_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params, + struct snd_soc_dai *dai) +{ + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); + struct i2s_clk_config_data *config = &dev->config; + u64 fix, point; + u32 cfg = 0; + + switch (params_format(params)) { + case SNDRV_PCM_FORMAT_S16_LE: + config->data_width = 16; + dev->ccr = 0x00; + dev->xfer_resolution = 0x02; + break; + + case SNDRV_PCM_FORMAT_S24_LE: + config->data_width = 24; + dev->ccr = 0x08; + dev->xfer_resolution = 0x04; + break; + + case SNDRV_PCM_FORMAT_S32_LE: + config->data_width = 32; + dev->ccr = 0x10; + dev->xfer_resolution = 0x05; + break; + + default: + dev_err(dev->dev, "phytium-i2s: unsupported PCM fmt"); + return -EINVAL; + } + + config->chan_nr = params_channels(params); + + switch (config->chan_nr) { + case EIGHT_CHANNEL_SUPPORT: + case SIX_CHANNEL_SUPPORT: + case FOUR_CHANNEL_SUPPORT: + case TWO_CHANNEL_SUPPORT: + break; + default: + dev_err(dev->dev, "channel not supported\n"); + return -EINVAL; + } + + phytium_i2s_config(dev, substream->stream); + + i2s_write_reg(dev->regs, CCR, dev->ccr); + + config->sample_rate = params_rate(params); + if (dev->capability & PHYTIUM_I2S_MASTER) { + fix = dev->clk_base / config->sample_rate / config->data_width / 32; + point = ((dev->clk_base / config->sample_rate) << 10) / config->data_width / 32; + point = (point - (fix << 10)) * 10; + cfg = ((u16) fix << 16) | (u16) point; + i2s_write_reg(dev->regs, CLK_CFG0, cfg); + i2s_write_reg(dev->regs, CLK_CFG1, 0xf); + } + dev->cfg = cfg; + return 0; +} + +static int phytium_i2s_prepare(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + i2s_write_reg(dev->regs, TXFFR, 1); + else + i2s_write_reg(dev->regs, RXFFR, 1); + + return 0; +} + +static int phytium_i2s_trigger(struct snd_pcm_substream *substream, + int cmd, struct snd_soc_dai *dai) +{ + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(dai); + int ret = 0; + + switch (cmd) { + case SNDRV_PCM_TRIGGER_START: + case SNDRV_PCM_TRIGGER_RESUME: + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: + dev->active++; + i2s_start(dev, substream); + break; + case SNDRV_PCM_TRIGGER_STOP: + case SNDRV_PCM_TRIGGER_SUSPEND: + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: + dev->active--; + i2s_stop(dev, substream); + break; + default: + ret = -EINVAL; + break; + } + + return ret; +} + +static int phytium_i2s_set_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt) +{ + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(cpu_dai); + int ret = 0; + + switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { + case SND_SOC_DAIFMT_BC_FC: + if (dev->capability & PHYTIUM_I2S_SLAVE) + ret = 0; + else + ret = -EINVAL; + break; + case SND_SOC_DAIFMT_BP_FP: + if (dev->capability & PHYTIUM_I2S_MASTER) + ret = 0; + else + ret = -EINVAL; + break; + case SND_SOC_DAIFMT_CBM_CFS: + case SND_SOC_DAIFMT_CBS_CFM: + ret = -EINVAL; + break; + default: + dev_dbg(dev->dev, "phytium/i2s: Invalid master/slave format\n"); + ret = -EINVAL; + break; + } + return ret; +} + +static const struct snd_soc_dai_ops phytium_i2s_dai_ops = { + .hw_params = phytium_i2s_hw_params, + .prepare = phytium_i2s_prepare, + .trigger = phytium_i2s_trigger, + .set_fmt = phytium_i2s_set_fmt, +}; + +#ifdef CONFIG_PM +static int phytium_i2s_suspend(struct snd_soc_component *component) +{ + return 0; +} + +static int phytium_i2s_resume(struct snd_soc_component *component) +{ + struct i2s_phytium *dev = snd_soc_component_get_drvdata(component); + struct snd_soc_dai *dai; + + for_each_component_dais(component, dai) { + if (snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_PLAYBACK)) + phytium_i2s_config(dev, SNDRV_PCM_STREAM_PLAYBACK); + if (snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_CAPTURE)) + phytium_i2s_config(dev, SNDRV_PCM_STREAM_CAPTURE); + } + i2s_write_reg(dev->regs, CLK_CFG0, dev->cfg); + i2s_write_reg(dev->regs, CLK_CFG1, 0xf); + return 0; +} +#else +#define phytium_i2s_suspend NULL +#define phytium_i2s_resume NULL +#endif + +static struct snd_soc_dai_driver phytium_i2s_dai = { + .playback = { + .stream_name = "i2s-Playback", + .channels_min = 2, + .channels_max = 2, + .rates = SNDRV_PCM_RATE_8000_192000, + .formats = SNDRV_PCM_FMTBIT_S8 | + SNDRV_PCM_FMTBIT_S16_LE | + SNDRV_PCM_FMTBIT_S20_LE | + SNDRV_PCM_FMTBIT_S24_LE | + SNDRV_PCM_FMTBIT_S32_LE, + }, + .capture = { + .stream_name = "i2s-Capture", + .channels_min = 2, + .channels_max = 2, + .rates = SNDRV_PCM_RATE_8000_192000, + .formats = SNDRV_PCM_FMTBIT_S8 | + SNDRV_PCM_FMTBIT_S16_LE | + SNDRV_PCM_FMTBIT_S20_LE | + SNDRV_PCM_FMTBIT_S24_LE | + SNDRV_PCM_FMTBIT_S32_LE, + }, + .ops = &phytium_i2s_dai_ops, + .symmetric_rate = 1, +}; + +static const struct snd_pcm_hardware phytium_pcm_hardware = { + .info = SNDRV_PCM_INFO_INTERLEAVED | + SNDRV_PCM_INFO_MMAP | + SNDRV_PCM_INFO_MMAP_VALID | + SNDRV_PCM_INFO_BLOCK_TRANSFER, + .rates = SNDRV_PCM_RATE_8000 | + SNDRV_PCM_RATE_32000 | + SNDRV_PCM_RATE_44100 | + SNDRV_PCM_RATE_48000, + .rate_min = 8000, + .rate_max = 48000, + .formats = (SNDRV_PCM_FMTBIT_S8 | + SNDRV_PCM_FMTBIT_S16_LE | + SNDRV_PCM_FMTBIT_S20_LE | + SNDRV_PCM_FMTBIT_S24_LE | + SNDRV_PCM_FMTBIT_S32_LE), + .channels_min = 2, + .channels_max = 2, + .buffer_bytes_max = 4096*16, + .period_bytes_min = 1024, + .period_bytes_max = 4096*4, + .periods_min = 2, + .periods_max = 16, + .fifo_size = 16, +}; + +struct i2s_stream *snd_i2s_stream_assign(struct i2sc_bus *bus, + struct snd_pcm_substream *substream) +{ + struct i2s_stream *azx_dev; + struct i2s_stream *res = NULL; + + /* make a non-zero unique key for the substream */ + int key = (substream->pcm->device << 16) | (substream->number << 2) | + (substream->stream + 1); + + list_for_each_entry(azx_dev, &bus->stream_list, list) { + if (azx_dev->direction != substream->stream) + continue; + + azx_dev->opened = 0; + + if (azx_dev->assigned_key == key) { + res = azx_dev; + break; + } + + if (!res || bus->reverse_assign) + res = azx_dev; + } + + if (res) { + spin_lock_irq(&bus->reg_lock); + res->opened = 1; + res->running = 0; + res->assigned_key = key; + res->substream = substream; + spin_unlock_irq(&bus->reg_lock); + } + + return res; +} + +/* assign a stream for the PCM */ +static inline struct azx_dev * +azx_assign_device(struct azx *chip, struct snd_pcm_substream *substream) +{ + struct i2s_stream *s; + + s = snd_i2s_stream_assign(azx_bus(chip), substream); + if (!s) + return NULL; + return stream_to_azx_dev(s); +} + +static int phytium_pcm_open(struct snd_soc_component *component, + struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + + struct azx *chip = &dev->chip; + struct azx_dev *azx_dev; + struct snd_pcm_runtime *runtime = substream->runtime; + + azx_dev = azx_assign_device(chip, substream); + if (azx_dev == NULL) + return -EBUSY; + + snd_soc_set_runtime_hwparams(substream, &phytium_pcm_hardware); + snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); + snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 128); + runtime->private_data = azx_dev; + + return 0; +} + +static int phytium_pcm_close(struct snd_soc_component *component, + struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + struct azx *chip = &dev->chip; + struct azx_dev *azx_dev = get_azx_dev(substream); + + mutex_lock(&chip->open_mutex); + azx_stream(azx_dev)->opened = 0; + azx_stream(azx_dev)->running = 0; + azx_stream(azx_dev)->substream = NULL; + + mutex_unlock(&chip->open_mutex); + return 0; +} + +static int phytium_pcm_new(struct snd_soc_component *component, + struct snd_soc_pcm_runtime *rtd) +{ + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + size_t size = phytium_pcm_hardware.buffer_bytes_max; + + snd_pcm_set_managed_buffer_all(rtd->pcm, + SNDRV_DMA_TYPE_DEV, + dev->pdev, size, size); + + return 0; +} + +static const struct i2s_io_ops axi_i2s_io_ops; +static const struct i2s_controller_ops axi_i2s_ops; + +static int phytium_pcm_hw_params(struct snd_soc_component *component, + struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *hw_params) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + struct azx *chip = &dev->chip; + struct azx_dev *azx_dev = get_azx_dev(substream); + int ret; + + azx_dev->core.bufsize = 0; + azx_dev->core.period_bytes = 0; + azx_dev->core.format_val = 0; + + switch (params_format(hw_params)) { + case SNDRV_PCM_FORMAT_S16_LE: + azx_dev->core.format_val = 2; + break; + + case SNDRV_PCM_FORMAT_S24_LE: + azx_dev->core.format_val = 0; + break; + + case SNDRV_PCM_FORMAT_S32_LE: + azx_dev->core.format_val = 0; + break; + + default: + dev_err(dev->dev, "phytium-i2s: unsupported PCM fmt"); + return -EINVAL; + } + + + ret = chip->ops->substream_alloc_pages(chip, substream, + params_buffer_bytes(hw_params)); + + return ret; +} +/* + * set up a BDL entry + */ +static int setup_bdle(struct i2sc_bus *bus, + struct snd_dma_buffer *dmab, + struct i2s_stream *azx_dev, __le32 **bdlp, + int ofs, int size, int with_ioc) +{ + struct snd_pcm_substream *substream = azx_dev->substream; + struct snd_pcm_runtime *runtime = substream->runtime; + __le32 *bdl = *bdlp; + + dmab->addr = runtime->dma_addr; + while (size > 0) { + dma_addr_t addr; + int chunk; + + if (azx_dev->frags >= AZX_MAX_BDL_ENTRIES) + return -EINVAL; + + addr = snd_sgbuf_get_addr(dmab, ofs); + + /* program the address field of the BDL entry */ + bdl[0] = cpu_to_le32((u32)addr); + + bdl[1] = cpu_to_le32(upper_32_bits(addr)); + + /* program the size field of the BDL entry */ + chunk = snd_sgbuf_get_chunk_size(dmab, ofs, size); + + bdl[2] = cpu_to_le32(chunk); + + /* program the IOC to enable interrupt + * only when the whole fragment is processed + */ + size -= chunk; + bdl[3] = (size || !with_ioc) ? 0 : cpu_to_le32(0x01); + + bdl += 4; + azx_dev->frags++; + ofs += chunk; + } + *bdlp = bdl; + return ofs; +} + +int snd_i2s_stream_setup_periods(struct i2s_stream *azx_dev) +{ + struct i2sc_bus *bus = azx_dev->bus; + struct snd_pcm_substream *substream = azx_dev->substream; + struct snd_pcm_runtime *runtime = substream->runtime; + __le32 *bdl; + int i, ofs, periods, period_bytes; + int pos_adj, pos_align; + + period_bytes = azx_dev->period_bytes; + periods = azx_dev->bufsize / period_bytes; + + /* program the initial BDL entries */ + bdl = (__le32 *)azx_dev->bdl.area; + + ofs = 0; + azx_dev->frags = 0; + + pos_adj = bus->bdl_pos_adj; + + if (!azx_dev->no_period_wakeup && pos_adj > 0) { + + pos_align = pos_adj; + pos_adj = (pos_adj * runtime->rate + 47999) / 48000; + + if (!pos_adj) + pos_adj = pos_align; + else + pos_adj = ((pos_adj + pos_align - 1) / pos_align) * + pos_align; + + pos_adj = frames_to_bytes(runtime, pos_adj); + if (pos_adj >= period_bytes) { + dev_warn(bus->dev, "Too big adjustment %d\n", + pos_adj); + pos_adj = 0; + } else { + ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), + azx_dev, + &bdl, ofs, pos_adj, true); + if (ofs < 0) + goto error; + } + } else { + pos_adj = 0; + } + + for (i = 0; i < periods; i++) { + if (i == periods - 1 && pos_adj) + ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), + azx_dev, &bdl, ofs, + period_bytes - pos_adj, 0); + else + ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), + azx_dev, &bdl, ofs, + period_bytes, + !azx_dev->no_period_wakeup); + if (ofs < 0) + goto error; + } + + return 0; + error: + dev_err(bus->dev, "Too many BDL entries: buffer=%d, period=%d\n", + azx_dev->bufsize, period_bytes); + return -EINVAL; +} + +int snd_i2s_stream_set_params(struct i2s_stream *azx_dev, + unsigned int format_val) +{ + unsigned int bufsize, period_bytes; + struct snd_pcm_substream *substream = azx_dev->substream; + struct snd_pcm_runtime *runtime; + int err; + + if (!substream) + return -EINVAL; + + runtime = substream->runtime; + bufsize = snd_pcm_lib_buffer_bytes(substream); + period_bytes = snd_pcm_lib_period_bytes(substream); + if (bufsize != azx_dev->bufsize || + period_bytes != azx_dev->period_bytes || + runtime->no_period_wakeup != azx_dev->no_period_wakeup) { + azx_dev->bufsize = bufsize; + azx_dev->period_bytes = period_bytes; + azx_dev->no_period_wakeup = runtime->no_period_wakeup; + err = snd_i2s_stream_setup_periods(azx_dev); + if (err < 0) + return err; + } + + return 0; +} + +int snd_i2s_stream_setup(struct i2s_stream *azx_dev, int pcie, u32 paddr) +{ + struct snd_pcm_runtime *runtime; + + if (azx_dev->substream) + runtime = azx_dev->substream->runtime; + else + runtime = NULL; + + i2s_write_reg(azx_dev->sd_addr, DMA_CHAL_CONFG0, 0x8081); + i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, 0x80000003); + + if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) { + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(1), (u32)azx_dev->bdl.addr); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(1), upper_32_bits(azx_dev->bdl.addr)); + if (pcie) + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(1), 0x1c8); + else + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(1), paddr + 0x1c8); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CBL(1), azx_dev->bufsize); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_LVI(1), azx_dev->frags - 1); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DSIZE(1), azx_dev->format_val);//0x2 + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DLENTH(1), 0x0);//0x0 + } else { + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(0), (u32)azx_dev->bdl.addr); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(0), upper_32_bits(azx_dev->bdl.addr)); + if (pcie) + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(0), 0x1c0); + else + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DEV_ADDR(0), paddr + 0x1c0); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CBL(0), azx_dev->bufsize); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_LVI(0), azx_dev->frags - 1); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DSIZE(0), azx_dev->format_val << 2);//0x8 + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_DLENTH(0), 0x0); + } + + if (runtime && runtime->period_size > 64) + azx_dev->delay_negative_threshold = + -frames_to_bytes(runtime, 64); + else + azx_dev->delay_negative_threshold = 0; + + return 0; +} + +static int phytium_pcm_prepare(struct snd_soc_component *component, + struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + struct azx *chip = &dev->chip; + struct azx_dev *azx_dev = get_azx_dev(substream); + struct i2sc_bus *bus = azx_bus(chip); + struct i2s_stream *hstr_p; + int err; + + dev->substream = substream; + azx_dev->core.substream = substream; + azx_dev->core.sd_addr = dev->regs_db; + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + azx_dev->core.bdl.area = bus->bdl0.area; + azx_dev->core.bdl.addr = bus->bdl0.addr; + } else { + azx_dev->core.bdl.area = bus->bdl1.area; + azx_dev->core.bdl.addr = bus->bdl1.addr; + } + + if (!substream) + return -EINVAL; + + hstr_p = azx_stream(azx_dev); + hstr_p->direction = substream->stream; + + err = snd_i2s_stream_set_params(azx_stream(azx_dev), 0); + if (err < 0) + goto unlock; + + snd_i2s_stream_setup(azx_stream(azx_dev), dev->pcie, dev->paddr); + + unlock: + if (!err) + azx_stream(azx_dev)->prepared = 1; + + return err; +} + +void snd_i2s_stream_clear(struct i2s_stream *azx_dev) +{ + if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0x0); + else + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0x0); + + azx_dev->running = false; +} + +void snd_i2s_stream_stop(struct i2s_stream *azx_dev) +{ + snd_i2s_stream_clear(azx_dev); +} + +void snd_i2s_stream_start(struct i2s_stream *azx_dev, bool fresh_start) +{ + if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0x1); + else + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0x5); + + azx_dev->running = true; +} + +static int phytium_pcm_trigger(struct snd_soc_component *component, + struct snd_pcm_substream *substream, int cmd) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + struct azx *chip = &dev->chip; + struct i2sc_bus *bus = azx_bus(chip); + struct azx_dev *azx_dev = get_azx_dev(substream); + struct snd_pcm_substream *s; + struct i2s_stream *hstr; + bool start; + int sbits = 0; + + hstr = azx_stream(azx_dev); + hstr->direction = substream->stream; + + switch (cmd) { + case SNDRV_PCM_TRIGGER_START: + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: + case SNDRV_PCM_TRIGGER_RESUME: + start = true; + break; + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: + case SNDRV_PCM_TRIGGER_SUSPEND: + case SNDRV_PCM_TRIGGER_STOP: + start = false; + break; + default: + return -EINVAL; + } + + snd_pcm_group_for_each_entry(s, substream) { + if (s->pcm->card != substream->pcm->card) + continue; + azx_dev = get_azx_dev(s); + sbits |= 1 << azx_dev->core.index; + snd_pcm_trigger_done(s, substream); + } + + spin_lock(&bus->reg_lock); + + snd_pcm_group_for_each_entry(s, substream) { + if (s->pcm->card != substream->pcm->card) + continue; + azx_dev = get_azx_dev(s); + if (start) + snd_i2s_stream_start(azx_stream(azx_dev), true); + else + snd_i2s_stream_stop(azx_stream(azx_dev)); + } + + i2s_write_reg(dev->regs_db, DMA_CTL, 0x1); + spin_unlock(&bus->reg_lock); + + return 0; +} + +void snd_i2s_stream_cleanup(struct i2s_stream *azx_dev) +{ + int cnt = 10; + u32 mask; + + if (azx_dev->sd_addr) { + if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) { + mask = i2s_read_reg(azx_dev->sd_addr, DMA_MASK_INT); + mask &= ~BIT(1); + i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, mask); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0); + while (cnt--) { + if (i2s_read_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1)) == 0) + break; + } + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 2); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(1), 0); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(1), 0); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(1), 0); + i2s_write_reg(azx_dev->sd_addr, DMA_STS, azx_dev->sd_int_sta_mask); + } else { + mask = i2s_read_reg(azx_dev->sd_addr, DMA_MASK_INT); + mask &= ~BIT(0); + i2s_write_reg(azx_dev->sd_addr, DMA_MASK_INT, mask); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0); + while (cnt--) { + if (i2s_read_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0)) == 0) + break; + } + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 2); + i2s_write_reg(azx_dev->sd_addr, DMA_CHALX_CTL(0), 0); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPL(0), 0); + i2s_write_reg(azx_dev->sd_addr, DMA_BDLPU(0), 0); + i2s_write_reg(azx_dev->sd_addr, DMA_STS, azx_dev->sd_int_sta_mask); + } + } +} + +static int phytium_pcm_hw_free(struct snd_soc_component *component, + struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + struct azx *chip = &dev->chip; + struct i2s_stream *hstr_p; + struct azx_dev *azx_dev = get_azx_dev(substream); + int err; + + hstr_p = azx_stream(azx_dev); + hstr_p->direction = substream->stream; + snd_i2s_stream_cleanup(azx_stream(azx_dev)); + + err = chip->ops->substream_free_pages(chip, substream); + azx_stream(azx_dev)->prepared = 0; + + return err; +} + +static snd_pcm_uframes_t phytium_pcm_pointer(struct snd_soc_component *component, + struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct i2s_phytium *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); + u32 pos = 0; + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + pos = i2s_read_reg(dev->regs_db, DMA_LPIB(1)); + else + pos = i2s_read_reg(dev->regs_db, DMA_LPIB(0)); + + return bytes_to_frames(substream->runtime, pos); +} + +static const struct snd_soc_component_driver phytium_i2s_component = { + .name = "phytium-i2s", + .pcm_construct = phytium_pcm_new, + .open = phytium_pcm_open, + .close = phytium_pcm_close, + .hw_params = phytium_pcm_hw_params, + .hw_free = phytium_pcm_hw_free, + .prepare = phytium_pcm_prepare, + .trigger = phytium_pcm_trigger, + .pointer = phytium_pcm_pointer, + .suspend = phytium_i2s_suspend, + .resume = phytium_i2s_resume, + .legacy_dai_naming = 1, +}; + +/* Maximum bit resolution of a channel - not uniformly spaced */ +static const u32 fifo_width[COMP_MAX_WORDSIZE] = { + 12, 16, 20, 24, 32, 0, 0, 0 +}; + +/* Width of (DMA) bus */ +static const u32 bus_widths[COMP_MAX_DATA_WIDTH] = { + DMA_SLAVE_BUSWIDTH_1_BYTE, + DMA_SLAVE_BUSWIDTH_2_BYTES, + DMA_SLAVE_BUSWIDTH_4_BYTES, + DMA_SLAVE_BUSWIDTH_UNDEFINED +}; + +/* PCM format to support channel resolution */ +static const u32 formats[COMP_MAX_WORDSIZE] = { + SNDRV_PCM_FMTBIT_S16_LE, + SNDRV_PCM_FMTBIT_S16_LE, + SNDRV_PCM_FMTBIT_S24_LE, + SNDRV_PCM_FMTBIT_S24_LE, + SNDRV_PCM_FMTBIT_S32_LE, + 0, + 0, + 0 +}; + +static int phytium_configure_dai(struct i2s_phytium *dev) +{ + u32 comp1 = i2s_read_reg(dev->regs, dev->i2s_reg_comp1); + u32 comp2 = i2s_read_reg(dev->regs, dev->i2s_reg_comp2); + u32 fifo_depth = 1 << (1 + COMP1_FIFO_DEPTH_GLOBAL(comp1)); + u32 idx; + + if (COMP1_TX_ENABLED(comp1)) { + dev_dbg(dev->dev, " phytium: play supported\n"); + idx = COMP1_TX_WORDSIZE_0(comp1); + if (WARN_ON(idx >= ARRAY_SIZE(formats))) + return -EINVAL; + } + + if (COMP1_RX_ENABLED(comp1)) { + dev_dbg(dev->dev, "phytium: record supported\n"); + idx = COMP2_RX_WORDSIZE_0(comp2); + if (WARN_ON(idx >= ARRAY_SIZE(formats))) + return -EINVAL; + if (dev->quirks & PHYTIUM_I2S_QUIRK_16BIT_IDX_OVERRIDE) + idx = 1; + } + + if (COMP1_MODE_EN(comp1)) { + dev_dbg(dev->dev, "phytium: i2s master mode supported\n"); + dev->capability |= PHYTIUM_I2S_MASTER; + } else { + dev_dbg(dev->dev, "phytium: i2s slave mode supported\n"); + dev->capability |= PHYTIUM_I2S_SLAVE; + } + + dev->fifo_th = fifo_depth / 2; + return 0; +} + +static int phytium_configure_dai_by_dt(struct i2s_phytium *dev) +{ + u32 comp1 = i2s_read_reg(dev->regs, I2S_COMP_PARAM_1); + u32 comp2 = i2s_read_reg(dev->regs, I2S_COMP_PARAM_2); + u32 idx = COMP1_APB_DATA_WIDTH(comp1); + u32 idx2; + int ret; + + if (WARN_ON(idx >= ARRAY_SIZE(bus_widths))) + return -EINVAL; + + ret = phytium_configure_dai(dev); + if (ret < 0) + return ret; + + if (COMP1_TX_ENABLED(comp1)) { + idx2 = COMP1_TX_WORDSIZE_0(comp1); + dev->capability |= PHYTIUM_I2S_PLAY; + } + if (COMP1_RX_ENABLED(comp1)) { + idx2 = COMP2_RX_WORDSIZE_0(comp2); + dev->capability |= PHYTIUM_I2S_RECORD; + } + + return 0; +} + +static int phytium_i2s_dma_alloc_pages(struct i2sc_bus *bus, int type, size_t size, + struct snd_dma_buffer *buf) +{ + int err; + + err = snd_dma_alloc_pages(type, bus->dev, size, buf); + if (err < 0) + return err; + + return 0; +} + +int snd_i2s_bus_alloc_stream_pages(struct i2sc_bus *bus) +{ + struct i2s_stream *s; + int num_streams = 0; + int err; + + list_for_each_entry(s, &bus->stream_list, list) { + /* allocate memory for the BDL for each stream */ + err = bus->io_ops->dma_alloc_pages(bus, SNDRV_DMA_TYPE_DEV, + BDL_SIZE, &s->bdl); + if (num_streams == 0) { + bus->bdl0.addr = s->bdl.addr; + bus->bdl0.area = s->bdl.area; + } else { + bus->bdl1.addr = s->bdl.addr; + bus->bdl1.area = s->bdl.area; + } + num_streams++; + if (err < 0) + return -ENOMEM; + } + + if (WARN_ON(!num_streams)) + return -EINVAL; + + return 0; +} + +static int stream_direction(struct azx *chip, unsigned char index) +{ + if (index >= chip->playback_index_offset && + index < chip->playback_index_offset + chip->playback_streams) + return SNDRV_PCM_STREAM_PLAYBACK; + return SNDRV_PCM_STREAM_CAPTURE; +} + +void snd_i2s_stream_init(struct i2sc_bus *bus, struct i2s_stream *stream, + int idx, int direction, int tag) +{ + stream->bus = bus; + stream->sd_addr = bus->remap_addr; + + if (idx == 0) + stream->sd_int_sta_mask = 1 << 8; + else + stream->sd_int_sta_mask = 1; + + stream->index = idx; + stream->direction = direction; + stream->stream_tag = tag; + + list_add_tail(&stream->list, &bus->stream_list); +} + +int azx_i2s_init_streams(struct azx *chip) +{ + int i; + + for (i = 0; i < chip->num_streams; i++) { + struct azx_dev *azx_dev = kzalloc(sizeof(*azx_dev), GFP_KERNEL); + int dir, tag; + + if (!azx_dev) + return -ENOMEM; + + dir = stream_direction(chip, i); + + tag = i + 1; + + snd_i2s_stream_init(azx_bus(chip), azx_stream(azx_dev), i, dir, tag); + } + + return 0; +} + +static int azx_first_init(struct azx *chip) +{ + struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); + struct platform_device *pdev = to_platform_device(i2s->dev); + struct device *i2sdev = i2s->dev; + struct i2sc_bus *bus = azx_bus(chip); + struct resource *res; + int err; + unsigned int dma_bits = 64; + + chip->region_requested = 1; + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + bus->addr = res->start; + bus->remap_addr = i2s->regs_db; + bus->dev = i2s->pdev; + + if (bus->remap_addr == NULL) { + dev_err(i2sdev, "ioremap error\n"); + return -ENXIO; + } + + if (azx_acquire_irq(chip, 0) < 0) + return -EBUSY; + + synchronize_irq(bus->irq); + + spin_lock_init(&bus->reg_lock); + + if (!dma_set_mask(i2sdev, DMA_BIT_MASK(dma_bits))) { + err = dma_set_coherent_mask(i2sdev, DMA_BIT_MASK(dma_bits)); + } else { + err = dma_set_mask(i2sdev, DMA_BIT_MASK(32)); + err = dma_set_coherent_mask(i2sdev, DMA_BIT_MASK(32)); + } + + chip->playback_streams = NUM_PLAYBACK; + chip->capture_streams = NUM_CAPTURE; + + chip->playback_index_offset = 0; + chip->capture_index_offset = chip->playback_streams; + chip->num_streams = chip->playback_streams + chip->capture_streams; + + err = azx_i2s_init_streams(chip); + if (err < 0) + return err; + + err = azx_alloc_stream_pages(chip); + if (err < 0) + return err; + + return 0; +} + +static int azx_probe_continue(struct azx *chip) +{ + struct i2s_phytium *i2s = container_of(chip, struct i2s_phytium, chip); + int err; + + i2s->probe_continued = 1; + + err = azx_first_init(chip); + if (err < 0) + goto out_free; + + chip->running = 1; + +out_free: + return err; +} + +static void azx_probe_work(struct work_struct *work) +{ + struct i2s_phytium *i2s = container_of(work, struct i2s_phytium, probe_work); + + azx_probe_continue(&i2s->chip); +} + +int azx_i2s_bus_init(struct azx *chip, + const struct i2s_io_ops *io_ops) +{ + struct i2s_bus *bus = &chip->bus; + + bus->core.io_ops = io_ops; + + INIT_LIST_HEAD(&bus->core.stream_list); + bus->card = chip->card; + mutex_init(&bus->prepare_mutex); + bus->pci = chip->pci; + + bus->core.bdl_pos_adj = chip->bdl_pos_adj; + return 0; +} + +static int i2s_phytium_create(struct platform_device *pdev, + int dev, struct azx **rchip, struct i2s_phytium *i2s) +{ + struct azx *chip; + int err; + + *rchip = NULL; + + if (!i2s) + return -ENOMEM; + chip = &i2s->chip; + + mutex_init(&chip->open_mutex); + + chip->ops = &axi_i2s_ops; + chip->dev_index = dev; + + INIT_LIST_HEAD(&chip->pcm_list); + init_completion(&i2s->probe_wait); + + chip->bdl_pos_adj = 32; + err = azx_i2s_bus_init(chip, &axi_i2s_io_ops); + if (err < 0) { + kfree(i2s); + return err; + } + + INIT_WORK(&i2s->probe_work, azx_probe_work); + *rchip = chip; + return 0; +} + +static int substream_alloc_pages(struct azx *chip, + struct snd_pcm_substream *substream, + size_t size) +{ + int ret; + + ret = snd_pcm_lib_malloc_pages(substream, size); + if (ret < 0) + return ret; + + return 0; +} + +static void phytium_i2s_dma_free_pages(struct i2sc_bus *bus, + struct snd_dma_buffer *buf) +{ + snd_dma_free_pages(buf); +} + +static const struct i2s_io_ops axi_i2s_io_ops = { + .dma_alloc_pages = phytium_i2s_dma_alloc_pages, + .dma_free_pages = phytium_i2s_dma_free_pages, +}; + +static const struct i2s_controller_ops axi_i2s_ops = { + .substream_alloc_pages = substream_alloc_pages, + .substream_free_pages = substream_free_pages, +}; + +static int phytium_i2s_probe(struct platform_device *pdev) +{ + struct i2s_phytium *i2s; + struct azx *chip; + struct resource *res; + struct pdata_px210_mfd *pdata; + struct snd_soc_dai_driver *dai_drv; + struct clk *clk; + int err, ret; + int card_num = 1; + bool schedule_probe; + struct fwnode_handle *np; + + i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL); + if (!i2s) + return -ENOMEM; + + dai_drv = devm_kzalloc(&pdev->dev, sizeof(*dai_drv), GFP_KERNEL); + if (!dai_drv) + return -ENOMEM; + memcpy(dai_drv, &phytium_i2s_dai, sizeof(phytium_i2s_dai)); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + i2s->paddr = res->start; + i2s->regs = devm_ioremap_resource(&pdev->dev, res); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 1); + i2s->regs_db = devm_ioremap_resource(&pdev->dev, res); + + if (IS_ERR(i2s->regs)) + return PTR_ERR(i2s->regs); + + i2s->irq_id = platform_get_irq(pdev, 0); + + if (i2s->irq_id < 0) + return i2s->irq_id; + + i2s->i2s_reg_comp1 = I2S_COMP_PARAM_1; + i2s->i2s_reg_comp2 = I2S_COMP_PARAM_2; + + ret = phytium_configure_dai_by_dt(i2s); + if (ret < 0) + return ret; + + err = i2s_phytium_create(pdev, card_num, &chip, i2s); + if (err < 0) + return err; + schedule_probe = !chip->disabled; + + dev_set_drvdata(&pdev->dev, i2s); + + pdata = dev_get_platdata(&pdev->dev); + i2s->dev = &pdev->dev; + if (pdata) { + dai_drv->name = pdata->name; + i2s->pdev = pdata->dev; + i2s->clk_base = pdata->clk_base; + i2s->pcie = 1; + } else if (pdev->dev.of_node) { + device_property_read_string(&pdev->dev, "dai-name", &dai_drv->name); + i2s->pdev = &pdev->dev; + clk = devm_clk_get(&pdev->dev, NULL); + i2s->clk_base = clk_get_rate(clk); + } else if (has_acpi_companion(&pdev->dev)) { + np = dev_fwnode(&(pdev->dev)); + ret = fwnode_property_read_string(np, "dai-name", &dai_drv->name); + if (ret < 0) { + dev_err(&pdev->dev, "missing dai-name property from acpi\n"); + goto failed_get_dai_name; + } + + i2s->pdev = &pdev->dev; + ret = fwnode_property_read_u32(np, "i2s_clk", &i2s->clk_base); + if (ret < 0) { + dev_err(&pdev->dev, "missing i2s_clk property from acpi\n"); + goto failed_get_dai_name; + } + } + + ret = devm_snd_soc_register_component(&pdev->dev, &phytium_i2s_component, + dai_drv, 1); + if (ret != 0) + dev_err(&pdev->dev, "not able to register dai\n"); + + if (schedule_probe) + schedule_work(&i2s->probe_work); + + if (chip->disabled) + complete_all(&i2s->probe_wait); + + return 0; + +failed_get_dai_name: + return ret; +} + +static int phytium_i2s_remove(struct platform_device *pdev) +{ + pm_runtime_disable(&pdev->dev); + return 0; +} + +static const struct of_device_id phytium_i2s_of_match[] = { + { .compatible = "phytium,i2s", }, + {}, +}; +MODULE_DEVICE_TABLE(of, phytium_i2s_of_match); + +#ifdef CONFIG_ACPI +static const struct acpi_device_id phytium_i2s_acpi_match[] = { + { "PHYT0016", 0 }, + { } +}; +MODULE_DEVICE_TABLE(acpi, phytium_i2s_acpi_match); +#else +#define phytium_i2s_acpi_match NULL +#endif + +static struct platform_driver phytium_i2s_driver = { + .probe = phytium_i2s_probe, + .remove = phytium_i2s_remove, + .driver = { + .name = "phytium-i2s", + .of_match_table = of_match_ptr(phytium_i2s_of_match), + .acpi_match_table = phytium_i2s_acpi_match, + }, +}; + +module_platform_driver(phytium_i2s_driver); + +MODULE_DESCRIPTION("Phytium I2S Driver"); +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Zhang Yiqun "); diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/pmdk_dp.c b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/pmdk_dp.c new file mode 100644 index 0000000000000000000000000000000000000000..85ff8e5667a8d5b9667687ec4b802dacbec28cd5 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/pmdk_dp.c @@ -0,0 +1,214 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include + +#define DAI_CNT(pmdk_dai_) sizeof(pmdk_dai_)/sizeof(struct snd_soc_dai_link) + +struct pmdk_dp_private { + struct snd_soc_jack jack0; + struct snd_soc_jack jack1; + struct snd_soc_jack jack2; +}; + +/* PMDK widgets */ +static const struct snd_soc_dapm_widget pmdk_dp_dapm_widgets[] = { + SND_SOC_DAPM_LINE("DP", NULL), +}; + +/* PMDK control */ +static const struct snd_kcontrol_new pmdk_controls[] = { + SOC_DAPM_PIN_SWITCH("DP"), +}; + +/* PMDK connections */ +static const struct snd_soc_dapm_route pmdk_dp_audio_map[] = { + {"DP", NULL, "TX"}, +}; + +#define SMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ + SND_SOC_DAIFMT_CBS_CFS) + +static int pmdk_dp0_init(struct snd_soc_pcm_runtime *runtime) +{ + struct snd_soc_card *card = runtime->card; + struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); + struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; + int ret; + + ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=0", SND_JACK_LINEOUT, + &priv->jack0); + + if (ret) { + dev_err(card->dev, "Jack creation failed %d\n", ret); + return ret; + } + + snd_soc_component_set_jack(component, &priv->jack0, NULL); + return ret; +} + +static int pmdk_dp1_init(struct snd_soc_pcm_runtime *runtime) +{ + struct snd_soc_card *card = runtime->card; + struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); + struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; + int ret; + + ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=1", SND_JACK_LINEOUT, + &priv->jack1); + + if (ret) { + dev_err(card->dev, "Jack creation failed %d\n", ret); + return ret; + } + snd_soc_component_set_jack(component, &priv->jack1, NULL); + return ret; +} + +static int pmdk_dp2_init(struct snd_soc_pcm_runtime *runtime) +{ + struct snd_soc_card *card = runtime->card; + struct pmdk_dp_private *priv = snd_soc_card_get_drvdata(card); + struct snd_soc_component *component = asoc_rtd_to_codec(runtime, 0)->component; + int ret; + + ret = snd_soc_card_jack_new(card, "HDMI/DP,pcm=2", SND_JACK_LINEOUT, + &priv->jack2); + + if (ret) { + dev_err(card->dev, "Jack creation failed %d\n", ret); + return ret; + } + snd_soc_component_set_jack(component, &priv->jack2, NULL); + return ret; +} + +SND_SOC_DAILINK_DEFS(pmdk_dp0_dai, + DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp0")), + DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918656", "i2s-hifi")), + DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); + +SND_SOC_DAILINK_DEFS(pmdk_dp1_dai, + DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp1")), + DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918657", "i2s-hifi")), + DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); + +SND_SOC_DAILINK_DEFS(pmdk_dp2_dai, + DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-dp2")), + DAILINK_COMP_ARRAY(COMP_CODEC("hdmi-audio-codec.1346918658", "i2s-hifi")), + DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); + +static struct snd_soc_dai_link pmdk_dai_local[] = { +{ + .name = "Phytium dp0-audio", + .stream_name = "Playback", + .dai_fmt = SMDK_DAI_FMT, + .init = pmdk_dp0_init, + .playback_only = true, + SND_SOC_DAILINK_REG(pmdk_dp0_dai), +},{ + .name = "Phytium dp1-audio", + .stream_name = "Playback", + .dai_fmt = SMDK_DAI_FMT, + .init = pmdk_dp1_init, + .playback_only = true, + SND_SOC_DAILINK_REG(pmdk_dp1_dai), +}, +{ + .name = "Phytium dp2-audio", + .stream_name = "Playback", + .dai_fmt = SMDK_DAI_FMT, + .init = pmdk_dp2_init, + .playback_only = true, + SND_SOC_DAILINK_REG(pmdk_dp2_dai), +}, +}; + +static struct snd_soc_card pmdk = { + .name = "PMDK-I2S", + .owner = THIS_MODULE, + + .dapm_widgets = pmdk_dp_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(pmdk_dp_dapm_widgets), + .controls = pmdk_controls, + .num_controls = ARRAY_SIZE(pmdk_controls), + .dapm_routes = pmdk_dp_audio_map, + .num_dapm_routes = ARRAY_SIZE(pmdk_dp_audio_map), +}; + +static int pmdk_sound_probe(struct platform_device *pdev) +{ + struct snd_soc_card *card = &pmdk; + struct pmdk_dp_private *priv; + struct snd_soc_dai_link *pmdk_dai; + int num_dp = 2; + char dp_mask = 0x7; + int i,j = 0; + card->dev = &pdev->dev; + + device_property_read_u32(&pdev->dev, "num-dp", &num_dp); + device_property_read_u8(&pdev->dev, "dp-mask", &dp_mask); + pmdk_dai = devm_kzalloc(&pdev->dev, num_dp * sizeof(*pmdk_dai), GFP_KERNEL); + if (!pmdk_dai) + return -ENOMEM; + + if (!num_dp || num_dp > DAI_CNT(pmdk_dai_local)) + return -EINVAL; + + for(i = 0; i < num_dp; i++) { + for (; j < DAI_CNT(pmdk_dai_local); j++) { + if (BIT(j) & dp_mask) { + pmdk_dai[i] = pmdk_dai_local[j]; + j++; + break; + } + } + } + + card->dai_link = pmdk_dai; + card->num_links = num_dp; + + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); + if (!priv) + return -ENOMEM; + + snd_soc_card_set_drvdata(card, priv); + + return devm_snd_soc_register_card(&pdev->dev, card); +} + +static const struct of_device_id pmdk_sound_of_match[] = { + { .compatible = "phytium,pmdk-dp",}, + { } +}; +MODULE_DEVICE_TABLE(of, pmdk_sound_of_match); + +static const struct acpi_device_id pmdk_sound_acpi_match[] = { + { "PHYT8006", 0}, + { } +}; +MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); + +static struct platform_driver pmdk_sound_driver = { + .probe = pmdk_sound_probe, + .driver = { + .name = "pmdk_dp", + .acpi_match_table = pmdk_sound_acpi_match, + .of_match_table = pmdk_sound_of_match, +#ifdef CONFIG_PM + .pm = &snd_soc_pm_ops, +#endif + }, +}; + +module_platform_driver(pmdk_sound_driver); + +MODULE_AUTHOR("Zhang Yiqun"); +MODULE_DESCRIPTION("ALSA SoC PMDK DP"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/pmdk_es8336.c b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/pmdk_es8336.c new file mode 100644 index 0000000000000000000000000000000000000000..258aa64035b891a1a651282fa671131814984bda --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/pmdk_es8336.c @@ -0,0 +1,97 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include + + +/* PMDK widgets */ +static const struct snd_soc_dapm_widget pmdk_es8336_dapm_widgets[] = { + SND_SOC_DAPM_HP("HP", NULL), + SND_SOC_DAPM_MIC("Int Mic", NULL), + SND_SOC_DAPM_MIC("Mic In", NULL), +}; + +/* PMDK control */ +static const struct snd_kcontrol_new pmdk_controls[] = { + SOC_DAPM_PIN_SWITCH("HP"), + SOC_DAPM_PIN_SWITCH("Int Mic"), + SOC_DAPM_PIN_SWITCH("Mic In"), +}; + +/* PMDK connections */ +static const struct snd_soc_dapm_route pmdk_es8336_audio_map[] = { + {"DMIC", NULL, "Int Mic"}, + {"MIC1", NULL, "Mic In"}, + {"MIC2", NULL, "Mic In"}, + + {"HP", NULL, "HPOL"}, + {"HP", NULL, "HPOR"}, +}; + +#define PMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ + SND_SOC_DAIFMT_CBS_CFS) + +SND_SOC_DAILINK_DEFS(pmdk_es8366, + DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-lsd")), + DAILINK_COMP_ARRAY(COMP_CODEC("i2c-ESSX8336:00", "es8336-hifi")), + DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); + +static struct snd_soc_dai_link pmdk_dai[] = { + { + .name = "ES8336 HIFI", + .stream_name = "ES8336 HIFI", + .dai_fmt = PMDK_DAI_FMT, + SND_SOC_DAILINK_REG(pmdk_es8366), + }, +}; + +static struct snd_soc_card pmdk = { + .name = "PMDK-I2S", + .owner = THIS_MODULE, + .dai_link = pmdk_dai, + .num_links = ARRAY_SIZE(pmdk_dai), + + .dapm_widgets = pmdk_es8336_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(pmdk_es8336_dapm_widgets), + .controls = pmdk_controls, + .num_controls = ARRAY_SIZE(pmdk_controls), + .dapm_routes = pmdk_es8336_audio_map, + .num_dapm_routes = ARRAY_SIZE(pmdk_es8336_audio_map), +}; + +static int pmdk_sound_probe(struct platform_device *pdev) +{ + struct snd_soc_card *card = &pmdk; + struct device *dev = &pdev->dev; + + card->dev = dev; + + return devm_snd_soc_register_card(&pdev->dev, card); +} + +static const struct acpi_device_id pmdk_sound_acpi_match[] = { + { "PHYT8005", 0}, + { } +}; +MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); + +static struct platform_driver pmdk_sound_driver = { + .probe = pmdk_sound_probe, + .driver = { + .name = "pmdk_es8336", + .acpi_match_table = pmdk_sound_acpi_match, +#ifdef CONFIG_PM + .pm = &snd_soc_pm_ops, +#endif + }, +}; + +module_platform_driver(pmdk_sound_driver); +MODULE_AUTHOR("Zhang Yiqun "); +MODULE_DESCRIPTION("ALSA SoC PMDK ES8336"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/pmdk_es8388.c b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/pmdk_es8388.c new file mode 100644 index 0000000000000000000000000000000000000000..dcee078b17e62bdb1f89f8cf61cd1ad18fe580b7 --- /dev/null +++ b/device_soc_phytium/common/kernel/linux-6.6/sound/soc/phytium/pmdk_es8388.c @@ -0,0 +1,169 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2021-2024 Phytium Technology Co., Ltd. + */ + +#include +#include +#include +#include +#include + +static struct snd_soc_jack hs_jack; + +/* Headset jack detection DAPM pins */ +static struct snd_soc_jack_pin hs_jack_pins[] = { + { + .pin = "FrontIn", + .mask = SND_JACK_MICROPHONE, + }, + { + .pin = "RearIn", + .mask = SND_JACK_MICROPHONE, + .invert = 1 + }, + { + .pin = "Front", + .mask = SND_JACK_HEADPHONE, + }, + { + .pin = "Rear", + .mask = SND_JACK_HEADPHONE, + .invert = 1 + }, +}; + +/* Headset jack detection gpios */ +static struct snd_soc_jack_gpio hs_jack_gpios[] = { + { + .name = "det", + .report = SND_JACK_HEADSET, + .debounce_time = 200, + .invert = 1, + }, +}; + +/* PMDK widgets */ +static const struct snd_soc_dapm_widget pmdk_es8388_dapm_widgets[] = { + SND_SOC_DAPM_HP("Front", NULL), + SND_SOC_DAPM_HP("Rear", NULL), + + SND_SOC_DAPM_MIC("FrontIn", NULL), + SND_SOC_DAPM_MIC("RearIn", NULL), +}; + +/* PMDK control */ +static const struct snd_kcontrol_new pmdk_controls[] = { + SOC_DAPM_PIN_SWITCH("Front"), + SOC_DAPM_PIN_SWITCH("Rear"), + SOC_DAPM_PIN_SWITCH("FrontIn"), + SOC_DAPM_PIN_SWITCH("RearIn"), +}; + +/* PMDK connections */ +static const struct snd_soc_dapm_route pmdk_es8388_audio_map[] = { + {"LINPUT1", NULL, "FrontIn"}, + {"RINPUT1", NULL, "FrontIn"}, + + {"LINPUT2", NULL, "RearIn"}, + {"RINPUT2", NULL, "RearIn"}, + + {"Front", NULL, "LOUT1"}, + {"Front", NULL, "ROUT1"}, + + {"Rear", NULL, "LOUT2"}, + {"Rear", NULL, "ROUT2"}, +}; + +static int pmdk_es8388_init(struct snd_soc_pcm_runtime *rtd) +{ + int ret; + + /* Jack detection API stuff */ + ret = snd_soc_card_jack_new_pins(rtd->card, "Headset Jack", + SND_JACK_HEADSET, &hs_jack, + hs_jack_pins, ARRAY_SIZE(hs_jack_pins)); + if (ret) + goto err; + + ret = snd_soc_jack_add_gpios(&hs_jack, ARRAY_SIZE(hs_jack_gpios), + hs_jack_gpios); + if (ret) + goto err; + + return 0; + +err: + return ret; +} + +#define PMDK_DAI_FMT (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | \ + SND_SOC_DAIFMT_CBS_CFS) + +SND_SOC_DAILINK_DEFS(pmdk_es8388, + DAILINK_COMP_ARRAY(COMP_CPU("phytium-i2s-lsd")), + DAILINK_COMP_ARRAY(COMP_CODEC("i2c-ESSX8388:00", "es8388-hifi")), + DAILINK_COMP_ARRAY(COMP_PLATFORM("snd-soc-dummy"))); + +static struct snd_soc_dai_link pmdk_dai[] = { + { + .name = "ES8388 HIFI", + .stream_name = "ES8388 HIFI", + .dai_fmt = PMDK_DAI_FMT, + .init = pmdk_es8388_init, + SND_SOC_DAILINK_REG(pmdk_es8388), + }, +}; + +static struct snd_soc_card pmdk = { + .name = "PMDK-I2S", + .owner = THIS_MODULE, + .dai_link = pmdk_dai, + .num_links = ARRAY_SIZE(pmdk_dai), + + .dapm_widgets = pmdk_es8388_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(pmdk_es8388_dapm_widgets), + .controls = pmdk_controls, + .num_controls = ARRAY_SIZE(pmdk_controls), + .dapm_routes = pmdk_es8388_audio_map, + .num_dapm_routes = ARRAY_SIZE(pmdk_es8388_audio_map), +}; + +static int pmdk_sound_probe(struct platform_device *pdev) +{ + struct snd_soc_card *card = &pmdk; + struct device *dev = &pdev->dev; + int n; + + card->dev = dev; + hs_jack_gpios[0].gpiod_dev = dev; + n = gpiod_count(dev, "det"); + + if (n < 0) + pmdk_dai[0].init = NULL; + + return devm_snd_soc_register_card(&pdev->dev, card); +} + +static const struct acpi_device_id pmdk_sound_acpi_match[] = { + { "PHYT8004", 0}, + { } +}; +MODULE_DEVICE_TABLE(acpi, pmdk_sound_acpi_match); + +static struct platform_driver pmdk_sound_driver = { + .probe = pmdk_sound_probe, + .driver = { + .name = "pmdk_es8388", + .acpi_match_table = pmdk_sound_acpi_match, +#ifdef CONFIG_PM + .pm = &snd_soc_pm_ops, +#endif + }, +}; + +module_platform_driver(pmdk_sound_driver); + +MODULE_AUTHOR("Zhang Yiqun"); +MODULE_DESCRIPTION("ALSA SoC PMDK ES8388"); +MODULE_LICENSE("GPL"); diff --git a/device_soc_phytium/pd2x08/hal/usb/pd2x08/include/default_config.h b/device_soc_phytium/pd2x08/hal/usb/include/default_config.h similarity index 100% rename from device_soc_phytium/pd2x08/hal/usb/pd2x08/include/default_config.h rename to device_soc_phytium/pd2x08/hal/usb/include/default_config.h diff --git a/device_soc_phytium/phytiumpi/hal/usb/include/default_config.h b/device_soc_phytium/phytiumpi/hal/usb/include/default_config.h new file mode 100755 index 0000000000000000000000000000000000000000..476160c6ae7040b45a11ba696b40134d5ea47595 --- /dev/null +++ b/device_soc_phytium/phytiumpi/hal/usb/include/default_config.h @@ -0,0 +1,28 @@ +/* + * Copyright (c) 2024 Phytium Technology Co., Ltd. + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#ifndef DEFAULT_CONFIG_H +#define DEFAULT_CONFIG_H +#ifdef __cplusplus +extern "C" { +#endif + +#define PORT_FILE_PATH "/sys/kernel/debug/usb/fcc00000.dwc3/mode" +#define UDC_NAME "fcc00000.dwc3" + +#ifdef __cplusplus +} +#endif +#endif // DEFAULT_CONFIG_H diff --git a/device_soc_phytium/phytiumpi/soc.gni b/device_soc_phytium/phytiumpi/soc.gni new file mode 100755 index 0000000000000000000000000000000000000000..cd7175cf79ff5dd28b2e5dde7f98f265f30f316c --- /dev/null +++ b/device_soc_phytium/phytiumpi/soc.gni @@ -0,0 +1,15 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +usb_default_config_path = "//device/soc/phytium/phytiumpi/hal/usb/include" +display_device_hal = "//device/soc/phytium/common/hardware" diff --git a/vendor_phytium/gpu_model/README.md b/vendor_phytium/gpu_model/README.md index a65f443e9bc2f8fe88ff67603a3641293a9fb6c3..629fe21ef6c4d18c48a012d1753fb2a94eb50a1b 100644 --- a/vendor_phytium/gpu_model/README.md +++ b/vendor_phytium/gpu_model/README.md @@ -28,6 +28,9 @@ vendor/phytium/gpu_model | ├── BUILD.gn │   ├── gpu │   └── readme.txt +├── egl_loader +│   ├── include +│   └── libPhy_EGL.so └── README.md ``` diff --git a/vendor_phytium/gpu_model/amd/BUILD.gn b/vendor_phytium/gpu_model/amd/BUILD.gn index a101a09f378b68f9c2f4e759609963cd33ed9b3b..1bca76b34e8b741457cd80339b120abc983a5aec 100644 --- a/vendor_phytium/gpu_model/amd/BUILD.gn +++ b/vendor_phytium/gpu_model/amd/BUILD.gn @@ -15,6 +15,6 @@ import("//build/ohos.gni") group("gpu_group") { deps = [ - "//vendor/phytium/gpu_model/${gpu_model}/gpu:mesa-pvr-gpu-libs", + "//vendor/phytium/gpu_model/amd/gpu:mesa-amd-gpu-libs", ] } diff --git a/vendor_phytium/gpu_model/amd/gpu/BUILD.gn b/vendor_phytium/gpu_model/amd/gpu/BUILD.gn index 5c52b16c61ba10c7bcbd04838e036de562474fe7..5991d77b7473650b683ca0eae0ed368479690f9e 100644 --- a/vendor_phytium/gpu_model/amd/gpu/BUILD.gn +++ b/vendor_phytium/gpu_model/amd/gpu/BUILD.gn @@ -19,20 +19,24 @@ import("radeon.gni") partname="device_${product_name}" mesa3d_libs_dir = "lib" mesa3d_all_lib_items = [ - ["libEGL_", "libEGL.so.1.0.0", ["libEGL.so.1", "libEGL_impl.so"]], - ["libGLESv1", "libGLESv1_CM.so.1.1.0", ["libGLESv1_CM.so","libGLESv1_impl.so"]], - ["libGLESv2", "libGLESv2.so.2.0.0", ["libGLESv2.so", "libGLESv2_impl.so","libGLESv3_impl.so"]], - ["libglapi", "libglapi.so.0.0.0", ["libglapi.so", "libglapi.so.0"]], - ["libgallium_dri", "libgallium_dri.so", ["libgallium_dri.so", "r600_dri.so", "r300_dri.so", "radeonsi_dri.so", "mwv207_dri.so"]], - ["libgbm", "libgbm.so.1.0.0", ["libgbm.so", "libgbm.so.1"]], - ["libexpat", "libexpat.so.1.6.7", ["libexpat.so.1", "libexpat.so"]], - ["libomx_mesa", "libomx_mesa.so", ["libomx_mesa.so.0"]], - ["libomxil-bellagio", "libomxil-bellagio.so.0.9.3", ["libomxil-bellagio.so", "libomxil-bellagio.so.0"]] + ["libEGL_amd", "libEGL.so.1.0.0", ["libEGL.so.1", "libEGL_impl.so"]], + ["libGLESv1_amd", "libGLESv1_CM.so.1.1.0", ["libGLESv1_CM.so","libGLESv1_impl.so"]], + ["libGLESv2_amd", "libGLESv2.so.2.0.0", ["libGLESv2.so", "libGLESv2_impl.so","libGLESv3_impl.so"]], + ["libglapi_amd", "libglapi.so.0.0.0", ["libglapi.so", "libglapi.so.0"]], + # ["libgallium_dri", "libgallium_dri.so", ["libgallium_dri.so", "r600_dri.so", "r300_dri.so", "radeonsi_dri.so", "mwv207_dri.so"]], + ["libgbm_amd", "libgbm.so.1.0.0", ["libgbm.so", "libgbm.so.1"]], + ["libexpat_amd", "libexpat.so.1.6.7", ["libexpat.so.1", "libexpat.so"]], + ["libomx_mesa_amd", "libomx_mesa.so", ["libomx_mesa.so.0"]], + ["libomxil-bellagio_amd", "libomxil-bellagio.so.0.9.3", ["libomxil-bellagio.so", "libomxil-bellagio.so.0"]] +] + +mesa3d_all_dri_items = [ + ["libgallium_dri_amd", "libgallium_dri.so", ["libgallium_dri.so", "r600_dri.so", "r300_dri.so", "radeonsi_dri.so", "mwv207_dri.so"]] ] mesa3d_all_lib_deps = [] -foreach(item, mesa3d_all_lib_items) { +foreach(item, mesa3d_all_dri_items) { name = item[1] prebuild_name = item[0] ohos_prebuilt_shared_library(prebuild_name) { @@ -47,22 +51,38 @@ foreach(item, mesa3d_all_lib_items) { mesa3d_all_lib_deps += [ ":$prebuild_name" ] } +foreach(item, mesa3d_all_lib_items) { + name = item[1] + prebuild_name = item[0] + ohos_prebuilt_shared_library(prebuild_name) { + source = "$mesa3d_libs_dir/$name" + symlink_target_name = item[2] + install_enable = true + install_images = [ chipset_base_dir ] + relative_install_dir = "chipsetsdk/amd" + subsystem_name = "phytium_products" + part_name = "${partname}" + } + mesa3d_all_lib_deps += [ ":$prebuild_name" ] +} + if (enable_ramdisk) { foreach(item, mesa3d_all_amdgpu_deps) { name = item[0] prebuild_name = item[0] - prebuild_amdpu_name = "amdpu_${prebuild_name}" - ohos_prebuilt_etc(prebuild_amdpu_name) { + prebuild_amdgpu_name = "amdgpu_${prebuild_name}" + ohos_prebuilt_etc(prebuild_amdgpu_name) { source = "$mesa3d_libs_dir/firmware/amdgpu/$name" subsystem_name = "phytium_products" part_name = "${partname}" install_enable = true install_images = [ - "ramdisk" + "ramdisk", + "updater" ] module_install_dir = "lib/firmware/amdgpu" } - mesa3d_all_lib_deps += [ ":$prebuild_amdpu_name" ] + mesa3d_all_lib_deps += [ ":$prebuild_amdgpu_name" ] } foreach(item, mesa3d_all_radeon_deps) { @@ -74,7 +94,8 @@ if (enable_ramdisk) { part_name = "${partname}" install_enable = true install_images = [ - "ramdisk" + "ramdisk", + "updater" ] module_install_dir = "lib/firmware/radeon" } @@ -82,7 +103,7 @@ if (enable_ramdisk) { } } -group("mesa-pvr-gpu-libs"){ +group("mesa-amd-gpu-libs"){ deps = mesa3d_all_lib_deps } \ No newline at end of file diff --git a/vendor_phytium/gpu_model/amd/kernel_source/linux-5.10/mwv207_gpu.patch b/vendor_phytium/gpu_model/amd/kernel_source/linux-5.10/mwv207_gpu.patch deleted file mode 100644 index bc0254cea5ccec2c780745c9fb532ff3a4599989..0000000000000000000000000000000000000000 --- a/vendor_phytium/gpu_model/amd/kernel_source/linux-5.10/mwv207_gpu.patch +++ /dev/null @@ -1,10770 +0,0 @@ -From 8a4053005027c7af8f2344512903d4bee68b12ae Mon Sep 17 00:00:00 2001 -From: tangkaiwen -Date: Fri, 1 Nov 2024 15:18:53 +0800 -Subject: [PATCH] add mwv207 - -Change-Id: I1e29757071181d983530515a7a74eed6580aa17e ---- - drivers/gpu/drm/Kconfig | 1 + - drivers/gpu/drm/Makefile | 1 + - drivers/gpu/drm/mwv207/Kconfig | 13 + - drivers/gpu/drm/mwv207/Makefile | 33 + - drivers/gpu/drm/mwv207/dc/mwv207_dvo.c | 180 +++ - drivers/gpu/drm/mwv207/dc/mwv207_edp.c | 22 + - drivers/gpu/drm/mwv207/dc/mwv207_fb.c | 181 +++ - drivers/gpu/drm/mwv207/dc/mwv207_hdmi.c | 1086 +++++++++++++++++ - drivers/gpu/drm/mwv207/dc/mwv207_i2c.c | 312 +++++ - drivers/gpu/drm/mwv207/dc/mwv207_kms.c | 204 ++++ - drivers/gpu/drm/mwv207/dc/mwv207_kms.h | 33 + - drivers/gpu/drm/mwv207/dc/mwv207_va.c | 719 +++++++++++ - drivers/gpu/drm/mwv207/dc/mwv207_va.h | 29 + - drivers/gpu/drm/mwv207/dc/mwv207_vga.c | 289 +++++ - drivers/gpu/drm/mwv207/dc/mwv207_vi.c | 89 ++ - drivers/gpu/drm/mwv207/dc/mwv207_vi.h | 101 ++ - drivers/gpu/drm/mwv207/mwv207.h | 127 ++ - drivers/gpu/drm/mwv207/mwv207_bo.c | 299 +++++ - drivers/gpu/drm/mwv207/mwv207_bo.h | 111 ++ - drivers/gpu/drm/mwv207/mwv207_ctx.c | 242 ++++ - drivers/gpu/drm/mwv207/mwv207_ctx.h | 51 + - drivers/gpu/drm/mwv207/mwv207_db.c | 138 +++ - drivers/gpu/drm/mwv207/mwv207_db.h | 32 + - drivers/gpu/drm/mwv207/mwv207_devfreq.c | 279 +++++ - drivers/gpu/drm/mwv207/mwv207_devfreq.h | 31 + - drivers/gpu/drm/mwv207/mwv207_dma.h | 29 + - drivers/gpu/drm/mwv207/mwv207_drm.h | 160 +++ - drivers/gpu/drm/mwv207/mwv207_drv.c | 547 +++++++++ - drivers/gpu/drm/mwv207/mwv207_gem.c | 155 +++ - drivers/gpu/drm/mwv207/mwv207_gem.h | 39 + - drivers/gpu/drm/mwv207/mwv207_irq.c | 190 +++ - drivers/gpu/drm/mwv207/mwv207_irq.h | 26 + - drivers/gpu/drm/mwv207/mwv207_pipe_2d.c | 567 +++++++++ - drivers/gpu/drm/mwv207/mwv207_pipe_3d.c | 613 ++++++++++ - .../gpu/drm/mwv207/mwv207_pipe_codec_common.c | 87 ++ - .../gpu/drm/mwv207/mwv207_pipe_codec_common.h | 42 + - drivers/gpu/drm/mwv207/mwv207_pipe_dec.c | 264 ++++ - drivers/gpu/drm/mwv207/mwv207_pipe_dma.c | 418 +++++++ - drivers/gpu/drm/mwv207/mwv207_pipe_enc.c | 266 ++++ - drivers/gpu/drm/mwv207/mwv207_sched.c | 378 ++++++ - drivers/gpu/drm/mwv207/mwv207_sched.h | 153 +++ - drivers/gpu/drm/mwv207/mwv207_submit.c | 638 ++++++++++ - drivers/gpu/drm/mwv207/mwv207_submit.h | 23 + - drivers/gpu/drm/mwv207/mwv207_ttm.c | 613 ++++++++++ - drivers/gpu/drm/mwv207/mwv207_ttm.h | 25 + - drivers/gpu/drm/mwv207/mwv207_vbios.c | 189 +++ - drivers/gpu/drm/mwv207/mwv207_vbios.h | 51 + - drivers/gpu/drm/mwv207/mwv207_vcmd.c | 178 +++ - drivers/gpu/drm/mwv207/selftest/selftest.c | 107 ++ - 49 files changed, 10361 insertions(+) - create mode 100644 drivers/gpu/drm/mwv207/Kconfig - create mode 100644 drivers/gpu/drm/mwv207/Makefile - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_dvo.c - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_edp.c - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_fb.c - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_hdmi.c - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_i2c.c - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_kms.c - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_kms.h - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_va.c - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_va.h - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_vga.c - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_vi.c - create mode 100644 drivers/gpu/drm/mwv207/dc/mwv207_vi.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_bo.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_bo.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_ctx.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_ctx.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_db.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_db.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_devfreq.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_devfreq.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_dma.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_drm.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_drv.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_gem.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_gem.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_irq.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_irq.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_pipe_2d.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_pipe_3d.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_pipe_dec.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_pipe_dma.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_pipe_enc.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_sched.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_sched.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_submit.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_submit.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_ttm.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_ttm.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_vbios.c - create mode 100644 drivers/gpu/drm/mwv207/mwv207_vbios.h - create mode 100644 drivers/gpu/drm/mwv207/mwv207_vcmd.c - create mode 100644 drivers/gpu/drm/mwv207/selftest/selftest.c - -diff --git a/drivers/gpu/drm/Kconfig b/drivers/gpu/drm/Kconfig -index 518fd948c..9e41c74d6 100644 ---- a/drivers/gpu/drm/Kconfig -+++ b/drivers/gpu/drm/Kconfig -@@ -395,6 +395,7 @@ source "drivers/gpu/drm/xlnx/Kconfig" - - source "drivers/gpu/drm/phytium/Kconfig" - -+source "drivers/gpu/drm/mwv207/Kconfig" - # Keep legacy drivers last - - menuconfig DRM_LEGACY -diff --git a/drivers/gpu/drm/Makefile b/drivers/gpu/drm/Makefile -index d78dc598c..226e00a3e 100644 ---- a/drivers/gpu/drm/Makefile -+++ b/drivers/gpu/drm/Makefile -@@ -125,3 +125,4 @@ obj-$(CONFIG_DRM_MCDE) += mcde/ - obj-$(CONFIG_DRM_TIDSS) += tidss/ - obj-y += xlnx/ - obj-$(CONFIG_DRM_PHYTIUM) += phytium/ -+obj-y += mwv207/ -diff --git a/drivers/gpu/drm/mwv207/Kconfig b/drivers/gpu/drm/mwv207/Kconfig -new file mode 100644 -index 000000000..f09174add ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/Kconfig -@@ -0,0 +1,13 @@ -+config DRM_MWV207 -+ tristate "MWV207 chip" -+ depends on DRM -+ select DRM_KMS_HELPER -+ select SND_PCM -+ select DRM_VRAM_HELPER -+ select DRM_SCHED -+ select DRM_TTM -+ select DRM_TTM_HELPER -+ help -+ Choose this option if you have a Jingjia graphics card. -+ If M is selected, the module will be called mwv207 (JM9100). -+ -diff --git a/drivers/gpu/drm/mwv207/Makefile b/drivers/gpu/drm/mwv207/Makefile -new file mode 100644 -index 000000000..5ead6cb5d ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/Makefile -@@ -0,0 +1,33 @@ -+ -+mwv207-y := mwv207_drv.o \ -+ mwv207_irq.o \ -+ mwv207_db.o \ -+ mwv207_ctx.o \ -+ mwv207_submit.o \ -+ mwv207_sched.o \ -+ mwv207_pipe_codec_common.o \ -+ mwv207_devfreq.o \ -+ mwv207_pipe_2d.o \ -+ mwv207_pipe_3d.o \ -+ mwv207_pipe_dec.o \ -+ mwv207_pipe_enc.o \ -+ mwv207_pipe_dma.o \ -+ mwv207_gem.o \ -+ mwv207_bo.o \ -+ mwv207_ttm.o \ -+ mwv207_vcmd.o \ -+ mwv207_vbios.o \ -+ dc/mwv207_kms.o \ -+ dc/mwv207_fb.o \ -+ dc/mwv207_va.o \ -+ dc/mwv207_edp.o \ -+ dc/mwv207_hdmi.o \ -+ dc/mwv207_vga.o \ -+ dc/mwv207_dvo.o \ -+ dc/mwv207_vi.o \ -+ dc/mwv207_i2c.o \ -+ selftest/selftest.o \ -+ -+obj-$(CONFIG_DRM_MWV207) := mwv207.o -+ -+ccflags-y := -I$(src) -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_dvo.c b/drivers/gpu/drm/mwv207/dc/mwv207_dvo.c -new file mode 100644 -index 000000000..f0c0eda04 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_dvo.c -@@ -0,0 +1,180 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_vi.h" -+ -+static void mwv207_dvo_switch(struct mwv207_output *output, bool on) -+{ -+ mwv207_output_modify(output, 0x200, -+ 0x1 << 0, (on ? 1 : 0) << 0); -+} -+ -+static void mwv207_dvo_config(struct mwv207_output *output) -+{ -+ struct drm_display_mode *mode = &output->cur_crtc->state->adjusted_mode; -+ int hpol, vpol; -+ -+ hpol = (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : 1; -+ vpol = (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : 1; -+ -+ mwv207_output_modify(output, 0x200, 0x1 << 9, hpol << 9); -+ mwv207_output_modify(output, 0x200, 0x1 << 8, vpol << 8); -+ -+} -+ -+static void mwv207_dvo_select_crtc(struct mwv207_output *output) -+{ -+ -+ mwv207_output_modify(output, 0x200, 0x7 << 16, -+ drm_crtc_index(output->cur_crtc) << 16); -+ -+ jdev_modify(output->jdev, 0x9b003c, 0xf, -+ drm_crtc_index(output->cur_crtc)); -+} -+static enum drm_mode_status mwv207_dvo_mode_valid(struct mwv207_output *output, -+ const struct drm_display_mode *mode) -+{ -+ -+ if (mode->clock > 162000) -+ return MODE_CLOCK_HIGH; -+ -+ return MODE_OK; -+} -+ -+static enum drm_mode_status mwv207_dvo_connector_mode_valid(struct drm_connector *connector, -+ struct drm_display_mode *mode) -+{ -+ return mwv207_dvo_mode_valid(connector_to_output(connector), mode); -+} -+ -+static int mwv207_dvo_detect_ctx(struct drm_connector *connector, -+ struct drm_modeset_acquire_ctx *ctx, -+ bool force) -+{ -+ struct mwv207_output *output = connector_to_output(connector); -+ -+ if (mwv207_i2c_probe(output->ddc)) -+ return connector_status_connected; -+ else -+ return connector_status_disconnected; -+} -+ -+static void mwv207_dvo_destroy(struct drm_connector *conn) -+{ -+ drm_connector_unregister(conn); -+ drm_connector_cleanup(conn); -+} -+ -+static const struct drm_connector_helper_funcs mwv207_dvo_connector_helper_funcs = { -+ .get_modes = mwv207_output_get_modes, -+ .mode_valid = mwv207_dvo_connector_mode_valid, -+ .detect_ctx = mwv207_dvo_detect_ctx -+}; -+ -+static const struct drm_connector_funcs mwv207_dvo_connector_funcs = { -+ .reset = drm_atomic_helper_connector_reset, -+ .fill_modes = drm_helper_probe_single_connector_modes, -+ .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, -+ .destroy = mwv207_dvo_destroy, -+ .late_register = mwv207_output_late_register, -+ .early_unregister = mwv207_output_early_unregister, -+}; -+ -+static enum drm_mode_status mwv207_dvo_encoder_mode_valid(struct drm_encoder *encoder, -+ const struct drm_display_mode *mode) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ return mwv207_dvo_mode_valid(output, mode); -+} -+ -+static int mwv207_dvo_encoder_atomic_check(struct drm_encoder *encoder, -+ struct drm_crtc_state *crtc_state, -+ struct drm_connector_state *conn_state) -+{ -+ return 0; -+} -+ -+static void mwv207_dvo_encoder_enable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_dvo_select_crtc(output); -+ -+ mwv207_dvo_config(output); -+ -+ mwv207_dvo_switch(output, true); -+} -+ -+static void mwv207_dvo_encoder_disable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_dvo_switch(output, false); -+} -+ -+static void mwv207_dvo_encoder_reset(struct drm_encoder *encoder) -+{ -+ mwv207_dvo_encoder_disable(encoder); -+} -+ -+static const struct drm_encoder_funcs mwv207_dvo_encoder_funcs = { -+ .destroy = drm_encoder_cleanup, -+ .reset = mwv207_dvo_encoder_reset, -+}; -+ -+static const struct drm_encoder_helper_funcs mwv207_dvo_encoder_helper_funcs = { -+ .mode_valid = mwv207_dvo_encoder_mode_valid, -+ .atomic_check = mwv207_dvo_encoder_atomic_check, -+ .enable = mwv207_dvo_encoder_enable, -+ .disable = mwv207_dvo_encoder_disable, -+}; -+ -+int mwv207_dvo_init(struct mwv207_device *jdev) -+{ -+ struct mwv207_output *output; -+ int ret; -+ -+ output = devm_kzalloc(jdev->dev, sizeof(*output), GFP_KERNEL); -+ if (!output) -+ return -ENOMEM; -+ -+ output->jdev = jdev; -+ output->idx = 0; -+ output->mmio = jdev->mmio + 0x9a0000; -+ output->i2c_chan = 5; -+ -+ output->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; -+ ret = drm_connector_init(&jdev->base, &output->connector, -+ &mwv207_dvo_connector_funcs, DRM_MODE_CONNECTOR_DVII); -+ if (ret) -+ return ret; -+ drm_connector_helper_add(&output->connector, &mwv207_dvo_connector_helper_funcs); -+ -+ output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; -+ ret = drm_encoder_init(&jdev->base, &output->encoder, -+ &mwv207_dvo_encoder_funcs, DRM_MODE_ENCODER_DAC, -+ "dvo-%d", output->idx); -+ if (ret) -+ return ret; -+ drm_encoder_helper_add(&output->encoder, &mwv207_dvo_encoder_helper_funcs); -+ -+ ret = drm_connector_attach_encoder(&output->connector, &output->encoder); -+ if (ret) -+ return ret; -+ -+ return drm_connector_register(&output->connector); -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_edp.c b/drivers/gpu/drm/mwv207/dc/mwv207_edp.c -new file mode 100644 -index 000000000..790b186a1 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_edp.c -@@ -0,0 +1,22 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_vi.h" -+ -+int mwv207_edp_init(struct mwv207_device *jdev) -+{ -+ pr_info("%s TBD", __func__); -+ return 0; -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_fb.c b/drivers/gpu/drm/mwv207/dc/mwv207_fb.c -new file mode 100644 -index 000000000..96147148a ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_fb.c -@@ -0,0 +1,181 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_bo.h" -+#include "mwv207_drm.h" -+#include "mwv207_gem.h" -+#include "mwv207_kms.h" -+ -+static struct fb_ops mwv207_fb_ops = { -+ .owner = THIS_MODULE, -+ DRM_FB_HELPER_DEFAULT_OPS, -+ .fb_fillrect = drm_fb_helper_cfb_fillrect, -+ .fb_copyarea = drm_fb_helper_cfb_copyarea, -+ .fb_imageblit = drm_fb_helper_cfb_imageblit, -+}; -+ -+static int mwv207_drm_fb_helper_init(struct drm_device *dev, -+ struct drm_fb_helper *fb_helper, -+ unsigned int crtc_count, -+ unsigned int max_conn_count) -+{ -+ return drm_fb_helper_init(dev, fb_helper); -+} -+ -+static int mwv207_fb_create(struct drm_fb_helper *fb_helper, -+ struct drm_fb_helper_surface_size *sizes) -+{ -+ struct drm_mode_fb_cmd2 mode_cmd; -+ struct drm_framebuffer *fb; -+ struct mwv207_device *jdev; -+ struct mwv207_bo *jbo; -+ struct fb_info *info; -+ u32 bytes; -+ void *logical; -+ int ret; -+ -+ jdev = fb_helper->dev->dev_private; -+ memset(&mode_cmd, 0, sizeof(mode_cmd)); -+ mode_cmd.width = sizes->surface_width; -+ mode_cmd.height = sizes->surface_height; -+ if (sizes->surface_bpp == 24) -+ sizes->surface_bpp = 32; -+ -+ mode_cmd.pitches[0] = mode_cmd.width * ((sizes->surface_bpp + 7)/8); -+ mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, -+ sizes->surface_depth); -+ -+ info = drm_fb_helper_alloc_fbi(fb_helper); -+ if (IS_ERR(info)) -+ return PTR_ERR(info); -+ -+ bytes = mode_cmd.pitches[0] * mode_cmd.height; -+ bytes = ALIGN(bytes, PAGE_SIZE); -+ ret = mwv207_bo_create(jdev, bytes, 0x10000, ttm_bo_type_kernel, -+ 0x2, (1<<0), &jbo); -+ if (ret) -+ return ret; -+ -+ fb = kzalloc(sizeof(*fb), GFP_KERNEL); -+ if (fb == NULL) { -+ ret = -ENOMEM; -+ goto free_bo; -+ } -+ -+ ret = mwv207_framebuffer_init(jdev, fb, &mode_cmd, mwv207_gem_from_bo(jbo)); -+ if (ret) -+ goto free_fb; -+ -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) -+ goto free_fb; -+ ret = mwv207_bo_pin_reserved(jbo, 0x2); -+ if (ret) -+ goto unreserve_bo; -+ -+ ret = mwv207_bo_kmap_reserved(jbo, &logical); -+ if (ret) -+ goto unpin_bo; -+ -+ memset(logical, 0x0, bytes); -+ -+ fb_helper->fb = fb; -+ info->skip_vt_switch = true; -+ info->fbops = &mwv207_fb_ops; -+ info->screen_size = fb->height * fb->pitches[0]; -+ info->fix.smem_len = info->screen_size; -+ info->screen_base = logical; -+ -+ drm_fb_helper_fill_info(info, fb_helper, sizes); -+ -+ mwv207_bo_unreserve(jbo); -+ return 0; -+ -+unpin_bo: -+ mwv207_bo_unpin(jbo); -+unreserve_bo: -+ mwv207_bo_unreserve(jbo); -+free_fb: -+ kfree(fb); -+free_bo: -+ mwv207_bo_unref(jbo); -+ return ret; -+} -+ -+static const struct drm_fb_helper_funcs mwv207_fb_helper_funcs = { -+ .fb_probe = mwv207_fb_create, -+}; -+ -+int mwv207_fbdev_init(struct mwv207_device *jdev) -+{ -+ struct drm_fb_helper *fb_helper; -+ int preferred_bpp = 32; -+ int ret; -+ -+ fb_helper = devm_kzalloc(jdev->dev, sizeof(*fb_helper), GFP_KERNEL); -+ if (!fb_helper) -+ return -ENOMEM; -+ -+ drm_fb_helper_prepare(&jdev->base, fb_helper, &mwv207_fb_helper_funcs); -+ ret = mwv207_drm_fb_helper_init(&jdev->base, fb_helper, -+ jdev->base.num_crtcs, jdev->base.num_crtcs); -+ if (ret) { -+ DRM_ERROR("Failed to initialize fbdev helper\n"); -+ return ret; -+ } -+ -+ ret = drm_fb_helper_initial_config(fb_helper, preferred_bpp); -+ if (ret) { -+ DRM_ERROR("Failed to set fbdev configuration\n"); -+ goto err; -+ } -+ -+ jdev->fb_helper = fb_helper; -+ return 0; -+err: -+ drm_fb_helper_fini(fb_helper); -+ return ret; -+} -+ -+void mwv207_fbdev_fini(struct mwv207_device *jdev) -+{ -+ struct drm_framebuffer *fb; -+ struct mwv207_bo *jbo; -+ int ret; -+ -+ drm_fb_helper_unregister_fbi(jdev->fb_helper); -+ -+ fb = jdev->fb_helper ? jdev->fb_helper->fb : NULL; -+ if (fb == NULL) -+ return; -+ -+ jbo = mwv207_bo_from_gem(fb->obj[0]); -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret == 0) { -+ mwv207_bo_kunmap_reserved(jbo); -+ mwv207_bo_unpin_reserved(jbo); -+ mwv207_bo_unreserve(jbo); -+ mwv207_gem_object_put(fb->obj[0]); -+ drm_framebuffer_cleanup(fb); -+ } -+ -+ drm_fb_helper_fini(jdev->fb_helper); -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_hdmi.c b/drivers/gpu/drm/mwv207/dc/mwv207_hdmi.c -new file mode 100644 -index 000000000..49e83a72b ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_hdmi.c -@@ -0,0 +1,1086 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include "mwv207_vi.h" -+#include "mwv207_vbios.h" -+ -+/* hdmi specific, accessed by mwv207_hdmi_read/write */ -+#define MWV207_HDMI_BASE(idx) (0x1200000 + 0x40000 * (idx)) -+ -+/* vi global, accessed by mwv207_output_read/write */ -+#define MWV207_HDMI_CTRL(idx) (0x400 + 0x100 * (idx)) -+#define MWV207_HDMI_PHY(idx) (0x6000 + 0x800 * (idx)) -+ -+#define connector_to_hdmi(conn) container_of(conn, struct mwv207_hdmi, base.connector) -+#define encoder_to_hdmi(encoder) container_of(encoder, struct mwv207_hdmi, base.encoder) -+ -+struct mwv207_hdmi_phy_data { -+ u32 min_freq_khz; -+ u32 max_freq_khz; -+ u32 bpp; -+ u8 config[47]; -+ u8 padding; -+} __packed; -+ -+static const struct mwv207_hdmi_phy_data -+default_phy_data[19] = { -+ { 24000, 47999, 8, -+ { 0xD2, 0x78, 0xB0, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x8B, 0xF0, -+ 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 28000, 95999, 8, -+ { 0xD2, 0x3C, 0x50, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x85, 0xF0, -+ 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 96000, 143999, 8, -+ { 0xD4, 0x50, 0x30, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x83, 0xF0, -+ 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 144000, 296999, 8, -+ { 0xD8, 0x50, 0x10, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x81, 0xF0, -+ 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 297000, 340000, 8, -+ { 0xDC, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x80, 0xF0, -+ 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 340001, 595000, 8, -+ { 0xDC, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x80, 0xC0, -+ 0xF4, 0x69, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, -+ 0xFF, 0x00, 0x00}}, -+ { 24000, 27999, 10, -+ { 0xD2, 0x7D, 0x90, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x99, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 28000, 55999, 10, -+ { 0xD4, 0xC8, 0x70, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x97, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 56000, 111999, 10, -+ { 0xD4, 0x64, 0x30, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x93, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 112000, 223999, 10, -+ { 0xD8, 0x64, 0x10, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x91, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 224000, 272000, 10, -+ { 0xDC, 0x4B, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x90, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 272001, 340000, 10, -+ { 0xDC, 0x4B, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x90, 0xC0, -+ 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 340001, 475200, 10, -+ { 0xDC, 0x4B, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x90, 0xC0, -+ 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, -+ 0xFF, 0x00, 0x00}}, -+ { 24000, 47999, 12, -+ { 0xD1, 0x3C, 0x70, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA7, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 48000, 95999, 12, -+ { 0xD2, 0x3C, 0x30, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA3, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 96000, 197999, 12, -+ { 0xD4, 0x3C, 0x10, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA1, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 198000, 226999, 12, -+ { 0xD8, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA0, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 227000, 340000, 12, -+ { 0xD8, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA0, 0xC0, -+ 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 340001, 396000, 12, -+ { 0xD8, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA0, 0xC0, -+ 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, -+ 0xFF, 0x00, 0x00}}, -+}; -+ -+struct mwv207_hdmi { -+ struct mwv207_output base; -+ -+ void __iomem *mmio; -+ bool sink_is_hdmi; -+ bool sink_has_audio; -+ int vic; -+ -+ int irq; -+ -+ u8 mc_clkdis; -+ bool rgb_limited_range; -+ struct mwv207_hdmi_phy_data phy_data[19]; -+}; -+ -+static const u16 csc_coeff_default[3][4] = { -+ { 0x2000, 0x0000, 0x0000, 0x0000 }, -+ { 0x0000, 0x2000, 0x0000, 0x0000 }, -+ { 0x0000, 0x0000, 0x2000, 0x0000 } -+}; -+ -+static const u16 csc_coeff_rgb_full_to_rgb_limited[3][4] = { -+ { 0x1b7c, 0x0000, 0x0000, 0x0020 }, -+ { 0x0000, 0x1b7c, 0x0000, 0x0020 }, -+ { 0x0000, 0x0000, 0x1b7c, 0x0020 } -+}; -+ -+static inline u8 mwv207_hdmi_readb(struct mwv207_hdmi *hdmi, u32 reg) -+{ -+ return readl(hdmi->mmio + reg * 4); -+} -+ -+static inline void mwv207_hdmi_writeb(struct mwv207_hdmi *hdmi, u8 value, u32 reg) -+{ -+ writel_relaxed(value, hdmi->mmio + reg * 4); -+} -+ -+static inline void mwv207_hdmi_modb(struct mwv207_hdmi *hdmi, u8 value, u8 mask, u32 reg) -+{ -+ u8 rvalue = mwv207_hdmi_readb(hdmi, reg); -+ -+ rvalue = (rvalue & ~mask) | (value & mask); -+ mwv207_hdmi_writeb(hdmi, rvalue, reg); -+} -+ -+static void mwv207_hdmi_mask_writeb(struct mwv207_hdmi *hdmi, u8 data, unsigned int reg, -+ u8 shift, u8 mask) -+{ -+ mwv207_hdmi_modb(hdmi, data << shift, mask, reg); -+} -+ -+static int mwv207_hdmi_phy_data_from_cfg(struct mwv207_hdmi *hdmi) -+{ -+ const struct mwv207_vdat *vdat; -+ int i; -+ -+ vdat = mwv207_vbios_vdat(hdmi->base.jdev, 0xfff0 + hdmi->base.idx); -+ if (!vdat) -+ return -ENOENT; -+ if (vdat->len != sizeof(hdmi->phy_data)) -+ return -EINVAL; -+ memcpy(hdmi->phy_data, vdat->dat, vdat->len); -+ for (i = 0; i < 19; ++i) { -+ hdmi->phy_data[i].min_freq_khz = le32_to_cpu(hdmi->phy_data[i].min_freq_khz); -+ hdmi->phy_data[i].max_freq_khz = le32_to_cpu(hdmi->phy_data[i].max_freq_khz); -+ hdmi->phy_data[i].bpp = le32_to_cpu(hdmi->phy_data[i].bpp); -+ } -+ return 0; -+} -+ -+static void mwv207_hdmi_phy_data_init(struct mwv207_hdmi *hdmi) -+{ -+ if (!mwv207_hdmi_phy_data_from_cfg(hdmi)) -+ return; -+ -+ DRM_INFO("mwv207: hdmi%d use default phy data", hdmi->base.idx); -+ -+ BUILD_BUG_ON(sizeof(hdmi->phy_data) != sizeof(default_phy_data)); -+ -+ memcpy(hdmi->phy_data, default_phy_data, sizeof(hdmi->phy_data)); -+} -+ -+static void mwv207_hdmi_phy_configure_data(struct mwv207_hdmi *hdmi, int kfreq, int bpp) -+{ -+ struct mwv207_output *output = &hdmi->base; -+ u32 regbase = MWV207_HDMI_PHY(output->idx); -+ int i, cfg, offset; -+ -+ for (i = 0; i < 19; ++i) { -+ if (kfreq >= hdmi->phy_data[i].min_freq_khz -+ && kfreq <= hdmi->phy_data[i].max_freq_khz -+ && bpp == hdmi->phy_data[i].bpp) -+ break; -+ } -+ if (i >= 19) { -+ pr_warn("mwv207: no matching hdmi phydata found"); -+ return; -+ } -+ -+ cfg = i; -+ mwv207_output_write(output, regbase + 0x70, 0xc8); -+ mwv207_output_write(output, regbase + 0x74, 0x2); -+ for (i = 0; i < 47; i++) { -+ offset = 0x4 + i * 4; -+ if (offset == 0x84 || offset == 0x88 || offset == 0xB8) -+ continue; -+ -+ mwv207_output_write(output, regbase + offset, -+ hdmi->phy_data[cfg].config[i]); -+ } -+} -+ -+static void mwv207_hdmi_phy_switch(struct mwv207_hdmi *hdmi, int enable) -+{ -+ struct mwv207_output *output = &hdmi->base; -+ u32 regbase = MWV207_HDMI_PHY(output->idx); -+ -+ if (enable) { -+ mwv207_output_write(output, regbase + 0x84, 0x80); -+ mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), 1 << 28, 0 << 28); -+ } else { -+ mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), 1 << 28, 1 << 28); -+ mwv207_output_write(output, regbase + 0x84, 0x00); -+ } -+} -+ -+static void mwv207_hdmi_phy_power_on(struct mwv207_hdmi *hdmi) -+{ -+ u8 val; -+ int i; -+ -+ mwv207_hdmi_phy_switch(hdmi, 1); -+ -+ for (i = 0; i < 5; ++i) { -+ val = mwv207_hdmi_readb(hdmi, 0x3004) & 0x01; -+ if (val) -+ break; -+ usleep_range(1000, 2000); -+ } -+ -+ if (!val) -+ pr_warn("mwv207: hdmi PHY PLL failed to lock\n"); -+} -+ -+static void mwv207_hdmi_phy_power_off(struct mwv207_hdmi *hdmi) -+{ -+ u8 val; -+ int i; -+ -+ mwv207_hdmi_phy_switch(hdmi, 0); -+ -+ for (i = 0; i < 5; ++i) { -+ val = mwv207_hdmi_readb(hdmi, 0x3004); -+ if (!(val & 0x01)) -+ break; -+ -+ usleep_range(1000, 2000); -+ } -+ -+ if (val & 0x01) -+ pr_warn("mwv207: PHY failed to power down\n"); -+} -+ -+static void mwv207_hdmi_phy_configure(struct mwv207_hdmi *hdmi, int kfreq, int bpp) -+{ -+ mwv207_hdmi_phy_power_off(hdmi); -+ -+ mwv207_hdmi_phy_configure_data(hdmi, kfreq, bpp); -+ -+ mwv207_hdmi_phy_power_on(hdmi); -+} -+ -+static void mwv207_hdmi_clear_overflow(struct mwv207_hdmi *hdmi) -+{ -+ u8 val; -+ -+ mwv207_hdmi_writeb(hdmi, (u8) ~0x02, 0x4002); -+ -+ val = mwv207_hdmi_readb(hdmi, 0x1000); -+ mwv207_hdmi_writeb(hdmi, val, 0x1000); -+} -+ -+static void mwv207_hdmi_ih_mutes(struct mwv207_hdmi *hdmi) -+{ -+ u8 ih_mute; -+ -+ ih_mute = mwv207_hdmi_readb(hdmi, 0x01FF) | 0x2 | 0x1; -+ -+ mwv207_hdmi_writeb(hdmi, ih_mute, 0x01FF); -+ -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0807); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x10D2); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x10D6); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x10DA); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3006); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3027); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3028); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3102); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3302); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3404); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3505); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x5008); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x7E05); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x7E06); -+ -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0180); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0181); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0182); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0183); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0184); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0185); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0186); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0187); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0188); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0189); -+ -+ ih_mute &= ~(0x2 | 0x1); -+ mwv207_hdmi_writeb(hdmi, ih_mute, 0x01FF); -+} -+ -+static void mwv207_hdmi_phy_setup_hpd(struct mwv207_hdmi *hdmi) -+{ -+ mwv207_hdmi_writeb(hdmi, 0x02, 0x3007); -+ mwv207_hdmi_writeb(hdmi, 0x1, 0x0104); -+ -+ mwv207_hdmi_writeb(hdmi, ~0x02, 0x3006); -+ -+ mwv207_hdmi_writeb(hdmi, 0x1, 0x0104); -+ mwv207_hdmi_writeb(hdmi, ~0x1, 0x0184); -+} -+ -+static irqreturn_t mwv207_hdmi_hard_irq(int irq, void *dev_id) -+{ -+ struct mwv207_hdmi *hdmi = dev_id; -+ irqreturn_t ret = IRQ_NONE; -+ u8 intr_stat; -+ -+ intr_stat = mwv207_hdmi_readb(hdmi, 0x0104); -+ if (intr_stat) { -+ mwv207_hdmi_writeb(hdmi, ~0, 0x0184); -+ return IRQ_WAKE_THREAD; -+ } -+ -+ return ret; -+} -+ -+static irqreturn_t mwv207_hdmi_irq(int irq, void *dev_id) -+{ -+ u8 intr_stat, phy_int_pol, phy_pol_mask, phy_stat; -+ struct mwv207_hdmi *hdmi = dev_id; -+ -+ intr_stat = mwv207_hdmi_readb(hdmi, 0x0104); -+ phy_int_pol = mwv207_hdmi_readb(hdmi, 0x3007); -+ phy_stat = mwv207_hdmi_readb(hdmi, 0x3004); -+ -+ phy_pol_mask = 0; -+ if (intr_stat & 0x1) -+ phy_pol_mask |= 0x02; -+ if (intr_stat & 0x4) -+ phy_pol_mask |= 0x10; -+ if (intr_stat & 0x8) -+ phy_pol_mask |= 0x20; -+ if (intr_stat & 0x10) -+ phy_pol_mask |= 0x40; -+ if (intr_stat & 0x20) -+ phy_pol_mask |= 0x80; -+ -+ if (phy_pol_mask) -+ mwv207_hdmi_modb(hdmi, ~phy_int_pol, phy_pol_mask, 0x3007); -+ -+ if (intr_stat & 0x1) -+ drm_helper_hpd_irq_event(&hdmi->base.jdev->base); -+ -+ mwv207_hdmi_writeb(hdmi, intr_stat, 0x0104); -+ mwv207_hdmi_writeb(hdmi, ~0x1, 0x0184); -+ -+ return IRQ_HANDLED; -+} -+ -+static void mwv207_hdmi_switch(struct mwv207_output *output, bool on) -+{ -+ mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), 1, on ? 1 : 0); -+} -+ -+static void mwv207_hdmi_select_crtc(struct mwv207_output *output) -+{ -+ -+ mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), -+ 0x3 << 4, drm_crtc_index(output->cur_crtc) << 4); -+ -+ jdev_modify(output->jdev, 0x9b003c, 0b111 << (8 + output->idx * 4), -+ drm_crtc_index(output->cur_crtc) << (8 + output->idx * 4)); -+} -+ -+static void mwv207_hdmi_disable_overflow_interrupts(struct mwv207_hdmi *hdmi) -+{ -+ mwv207_hdmi_writeb(hdmi, 0x03, 0x0182); -+} -+ -+static bool mwv207_hdmi_support_scdc(struct mwv207_hdmi *hdmi, -+ const struct drm_display_info *display) -+{ -+ -+ if (!display->hdmi.scdc.supported || -+ !display->hdmi.scdc.scrambling.supported) -+ return false; -+ -+ if (!display->hdmi.scdc.scrambling.low_rates && -+ display->max_tmds_clock <= 340000) -+ return false; -+ -+ return true; -+} -+ -+static void mwv207_hdmi_av_composer(struct mwv207_hdmi *hdmi, const struct drm_display_mode *mode) -+{ -+ const struct drm_display_info *display = &hdmi->base.connector.display_info; -+ const struct drm_hdmi_info *hdmi_info = &display->hdmi; -+ int hblank, vblank, h_de_hs, v_de_vs, hsync_len, vsync_len; -+ struct mwv207_output *output = &hdmi->base; -+ unsigned int vdisplay, hdisplay; -+ u32 tmdsclock, rate; -+ u8 inv_val, bytes; -+ -+ tmdsclock = mode->clock * 1000; -+ -+ inv_val = (mwv207_hdmi_support_scdc(hdmi, display) && -+ (tmdsclock > 340000000 || -+ hdmi_info->scdc.scrambling.low_rates) ? 0x80 : 0x00); -+ -+ inv_val |= mode->flags & DRM_MODE_FLAG_PVSYNC ? 0x40 : 0x00; -+ -+ inv_val |= mode->flags & DRM_MODE_FLAG_PHSYNC ? 0x20 : 0x00; -+ -+ inv_val |= 0x10; -+ -+ if (hdmi->vic == 39) -+ inv_val |= 0x2; -+ else -+ inv_val |= mode->flags & DRM_MODE_FLAG_INTERLACE ? 0x2 : 0x0; -+ -+ inv_val |= mode->flags & DRM_MODE_FLAG_INTERLACE ? 0x1 : 0x0; -+ -+ inv_val |= hdmi->sink_is_hdmi ? 0x8 : 0x0; -+ -+ mwv207_hdmi_writeb(hdmi, inv_val, 0x1000); -+ -+ rate = drm_mode_vrefresh(mode) * 1000; -+ mwv207_hdmi_writeb(hdmi, rate >> 16, 0x1010); -+ mwv207_hdmi_writeb(hdmi, rate >> 8, 0x100F); -+ mwv207_hdmi_writeb(hdmi, rate, 0x100E); -+ -+ -+ mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), 0x1 << 9, -+ (mode->flags & DRM_MODE_FLAG_PHSYNC ? 1 : 0) << 9); -+ mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), 0x1 << 8, -+ (mode->flags & DRM_MODE_FLAG_PVSYNC ? 1 : 0) << 8); -+ mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), 0x1 << 10, 1 << 10); -+ -+ hdisplay = mode->hdisplay; -+ hblank = mode->htotal - mode->hdisplay; -+ h_de_hs = mode->hsync_start - mode->hdisplay; -+ hsync_len = mode->hsync_end - mode->hsync_start; -+ -+ vdisplay = mode->vdisplay; -+ vblank = mode->vtotal - mode->vdisplay; -+ v_de_vs = mode->vsync_start - mode->vdisplay; -+ vsync_len = mode->vsync_end - mode->vsync_start; -+ -+ if (mode->flags & DRM_MODE_FLAG_INTERLACE) { -+ vdisplay /= 2; -+ vblank /= 2; -+ v_de_vs /= 2; -+ vsync_len /= 2; -+ } -+ -+ if (mwv207_hdmi_support_scdc(hdmi, display)) { -+ if (tmdsclock > 340000000 || -+ hdmi_info->scdc.scrambling.low_rates) { -+ drm_scdc_readb(hdmi->base.ddc, SCDC_SINK_VERSION, -+ &bytes); -+ drm_scdc_writeb(hdmi->base.ddc, SCDC_SOURCE_VERSION, -+ min_t(u8, bytes, 0x1)); -+ -+ drm_scdc_set_scrambling(hdmi->base.ddc, 1); -+ -+ mwv207_hdmi_writeb(hdmi, (u8)~0x02, 0x4002); -+ mwv207_hdmi_writeb(hdmi, 1, 0x10E1); -+ } else { -+ mwv207_hdmi_writeb(hdmi, 0, 0x10E1); -+ mwv207_hdmi_writeb(hdmi, (u8)~0x02, 0x4002); -+ drm_scdc_set_scrambling(hdmi->base.ddc, 0); -+ } -+ } -+ -+ mwv207_hdmi_writeb(hdmi, hdisplay >> 8, 0x1002); -+ mwv207_hdmi_writeb(hdmi, hdisplay, 0x1001); -+ -+ mwv207_hdmi_writeb(hdmi, vdisplay >> 8, 0x1006); -+ mwv207_hdmi_writeb(hdmi, vdisplay, 0x1005); -+ -+ mwv207_hdmi_writeb(hdmi, hblank >> 8, 0x1004); -+ mwv207_hdmi_writeb(hdmi, hblank, 0x1003); -+ -+ mwv207_hdmi_writeb(hdmi, vblank >> 8, 0x102E); -+ mwv207_hdmi_writeb(hdmi, vblank, 0x1007); -+ -+ mwv207_hdmi_writeb(hdmi, h_de_hs >> 8, 0x1009); -+ mwv207_hdmi_writeb(hdmi, h_de_hs, 0x1008); -+ -+ mwv207_hdmi_writeb(hdmi, v_de_vs >> 8, 0x102F); -+ mwv207_hdmi_writeb(hdmi, v_de_vs, 0x100C); -+ -+ mwv207_hdmi_writeb(hdmi, hsync_len >> 8, 0x100B); -+ mwv207_hdmi_writeb(hdmi, hsync_len, 0x100A); -+ -+ mwv207_hdmi_writeb(hdmi, vsync_len, 0x100D); -+} -+ -+static void mwv207_hdmi_enable_video_path(struct mwv207_hdmi *hdmi) -+{ -+ mwv207_hdmi_writeb(hdmi, 12, 0x1011); -+ mwv207_hdmi_writeb(hdmi, 32, 0x1012); -+ mwv207_hdmi_writeb(hdmi, 1, 0x1013); -+ -+ mwv207_hdmi_writeb(hdmi, 0x0B, 0x1014); -+ mwv207_hdmi_writeb(hdmi, 0x16, 0x1015); -+ mwv207_hdmi_writeb(hdmi, 0x21, 0x1016); -+ -+ hdmi->mc_clkdis |= 0x40 | 0x8 | 0x10 | 0x4 | 0x2; -+ hdmi->mc_clkdis &= ~0x1; -+ mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); -+ -+ hdmi->mc_clkdis &= ~0x2; -+ mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); -+ -+ if (hdmi->rgb_limited_range) { -+ hdmi->mc_clkdis &= ~0x10; -+ mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); -+ -+ mwv207_hdmi_writeb(hdmi, 0x1, 0x4004); -+ } else { -+ hdmi->mc_clkdis |= 0x10; -+ mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); -+ -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x4004); -+ } -+} -+ -+static void mwv207_hdmi_enable_audio_clk(struct mwv207_hdmi *hdmi, bool enable) -+{ -+ if (enable) -+ hdmi->mc_clkdis &= ~0x8; -+ else -+ hdmi->mc_clkdis |= 0x8; -+ mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); -+} -+ -+static void mwv207_hdmi_config_AVI(struct mwv207_hdmi *hdmi, -+ struct drm_connector *connector, -+ const struct drm_display_mode *mode) -+{ -+ struct hdmi_avi_infoframe frame; -+ u8 val; -+ -+ -+ drm_hdmi_avi_infoframe_from_display_mode(&frame, connector, mode); -+ -+ drm_hdmi_avi_infoframe_quant_range(&frame, connector, mode, -+ hdmi->rgb_limited_range ? -+ HDMI_QUANTIZATION_RANGE_LIMITED : -+ HDMI_QUANTIZATION_RANGE_FULL); -+ -+ frame.colorspace = HDMI_COLORSPACE_RGB; -+ frame.colorimetry = HDMI_COLORIMETRY_NONE; -+ frame.extended_colorimetry = -+ HDMI_EXTENDED_COLORIMETRY_XV_YCC_601; -+ -+ val = (frame.scan_mode & 3) << 4 | (frame.colorspace & 3); -+ if (frame.active_aspect & 15) -+ val |= 0x40; -+ if (frame.top_bar || frame.bottom_bar) -+ val |= 0x08; -+ if (frame.left_bar || frame.right_bar) -+ val |= 0x04; -+ mwv207_hdmi_writeb(hdmi, val, 0x1019); -+ -+ -+ val = ((frame.colorimetry & 0x3) << 6) | -+ ((frame.picture_aspect & 0x3) << 4) | -+ (frame.active_aspect & 0xf); -+ mwv207_hdmi_writeb(hdmi, val, 0x101A); -+ -+ -+ val = ((frame.extended_colorimetry & 0x7) << 4) | -+ ((frame.quantization_range & 0x3) << 2) | -+ (frame.nups & 0x3); -+ if (frame.itc) -+ val |= 0x80; -+ mwv207_hdmi_writeb(hdmi, val, 0x101B); -+ -+ -+ val = frame.video_code & 0x7f; -+ mwv207_hdmi_writeb(hdmi, val, 0x101C); -+ -+ -+ val = ((1 << 4) & 0xF0); -+ mwv207_hdmi_writeb(hdmi, val, 0x10E0); -+ -+ val = ((frame.ycc_quantization_range & 0x3) << 2) | -+ (frame.content_type & 0x3); -+ mwv207_hdmi_writeb(hdmi, val, 0x1017); -+ -+ mwv207_hdmi_writeb(hdmi, frame.top_bar & 0xff, 0x101D); -+ mwv207_hdmi_writeb(hdmi, (frame.top_bar >> 8) & 0xff, 0x101E); -+ mwv207_hdmi_writeb(hdmi, frame.bottom_bar & 0xff, 0x101F); -+ mwv207_hdmi_writeb(hdmi, (frame.bottom_bar >> 8) & 0xff, 0x1020); -+ mwv207_hdmi_writeb(hdmi, frame.left_bar & 0xff, 0x1021); -+ mwv207_hdmi_writeb(hdmi, (frame.left_bar >> 8) & 0xff, 0x1022); -+ mwv207_hdmi_writeb(hdmi, frame.right_bar & 0xff, 0x1023); -+ mwv207_hdmi_writeb(hdmi, (frame.right_bar >> 8) & 0xff, 0x1024); -+} -+ -+static void mwv207_hdmi_config_vendor_specific_infoframe(struct mwv207_hdmi *hdmi, -+ struct drm_connector *connector, -+ const struct drm_display_mode *mode) -+{ -+ struct hdmi_vendor_infoframe frame; -+ u8 buffer[10]; -+ ssize_t err; -+ -+ err = drm_hdmi_vendor_infoframe_from_display_mode(&frame, connector, -+ mode); -+ if (err < 0) -+ return; -+ -+ err = hdmi_vendor_infoframe_pack(&frame, buffer, sizeof(buffer)); -+ if (err < 0) { -+ DRM_ERROR("Failed to pack vendor infoframe: %zd\n", err); -+ return; -+ } -+ mwv207_hdmi_mask_writeb(hdmi, 0, 0x10B3, 3, 0x08); -+ -+ mwv207_hdmi_writeb(hdmi, buffer[2], 0x102A); -+ -+ mwv207_hdmi_writeb(hdmi, buffer[4], 0x1029); -+ mwv207_hdmi_writeb(hdmi, buffer[5], 0x1030); -+ mwv207_hdmi_writeb(hdmi, buffer[6], 0x1031); -+ -+ mwv207_hdmi_writeb(hdmi, buffer[7], 0x1032); -+ mwv207_hdmi_writeb(hdmi, buffer[8], 0x1033); -+ -+ if (frame.s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF) -+ mwv207_hdmi_writeb(hdmi, buffer[9], 0x1034); -+ -+ mwv207_hdmi_writeb(hdmi, 1, 0x10B4); -+ -+ mwv207_hdmi_writeb(hdmi, 0x11, 0x10B5); -+ -+ mwv207_hdmi_mask_writeb(hdmi, 1, 0x10B3, 3, 0x08); -+} -+ -+static void mwv207_hdmi_config_drm_infoframe(struct mwv207_hdmi *hdmi, -+ const struct drm_connector *connector) -+{ -+ const struct drm_connector_state *conn_state = connector->state; -+ struct hdmi_drm_infoframe frame; -+ u8 buffer[30]; -+ ssize_t err; -+ int i; -+ -+ mwv207_hdmi_modb(hdmi, 0x00, 0x80, 0x10E3); -+ -+ err = drm_hdmi_infoframe_set_hdr_metadata(&frame, conn_state); -+ if (err < 0) -+ return; -+ -+ err = hdmi_drm_infoframe_pack(&frame, buffer, sizeof(buffer)); -+ if (err < 0) -+ return; -+ -+ mwv207_hdmi_writeb(hdmi, frame.version, 0x1168); -+ mwv207_hdmi_writeb(hdmi, frame.length, 0x1169); -+ -+ for (i = 0; i < frame.length; i++) -+ mwv207_hdmi_writeb(hdmi, buffer[4 + i], 0x116A + i); -+ -+ mwv207_hdmi_writeb(hdmi, 1, 0x1167); -+ mwv207_hdmi_modb(hdmi, 0x80, 0x80, 0x10E3); -+} -+ -+static void mwv207_hdmi_video_packetize(struct mwv207_hdmi *hdmi) -+{ -+ unsigned int output_select = 0x3; -+ unsigned int remap_size = 0x0; -+ unsigned int color_depth = 4; -+ u8 val, vp_conf; -+ -+ val = ((color_depth << 4) & 0xF0); -+ mwv207_hdmi_writeb(hdmi, val, 0x0801); -+ -+ mwv207_hdmi_modb(hdmi, 0x1, 0x1, 0x0802); -+ -+ vp_conf = 0x00 | 0x4; -+ -+ mwv207_hdmi_modb(hdmi, vp_conf, 0x10 | 0x4, 0x0804); -+ -+ mwv207_hdmi_modb(hdmi, 1 << 5, 0x20, 0x0802); -+ -+ mwv207_hdmi_writeb(hdmi, remap_size, 0x0803); -+ -+ vp_conf = 0x40 | 0x00 | 0x0; -+ -+ mwv207_hdmi_modb(hdmi, vp_conf, 0x40 | 0x20 | 0x8, 0x0804); -+ -+ mwv207_hdmi_modb(hdmi, 0x2 | 0x4, 0x2 | 0x4, 0x0802); -+ -+ mwv207_hdmi_modb(hdmi, output_select, 0x3, 0x0804); -+} -+ -+static void mwv207_hdmi_update_csc_coeffs(struct mwv207_hdmi *hdmi) -+{ -+ const u16 (*csc_coeff)[3][4] = &csc_coeff_default; -+ unsigned int i; -+ u32 csc_scale = 1; -+ -+ if (hdmi->rgb_limited_range) -+ csc_coeff = &csc_coeff_rgb_full_to_rgb_limited; -+ else -+ csc_coeff = &csc_coeff_default; -+ -+ for (i = 0; i < ARRAY_SIZE(csc_coeff_default[0]); i++) { -+ u16 coeff_a = (*csc_coeff)[0][i]; -+ u16 coeff_b = (*csc_coeff)[1][i]; -+ u16 coeff_c = (*csc_coeff)[2][i]; -+ -+ mwv207_hdmi_writeb(hdmi, coeff_a & 0xff, 0x4103 + i * 2); -+ mwv207_hdmi_writeb(hdmi, coeff_a >> 8, 0x4102 + i * 2); -+ mwv207_hdmi_writeb(hdmi, coeff_b & 0xff, 0x410B + i * 2); -+ mwv207_hdmi_writeb(hdmi, coeff_b >> 8, 0x410A + i * 2); -+ mwv207_hdmi_writeb(hdmi, coeff_c & 0xff, 0x4113 + i * 2); -+ mwv207_hdmi_writeb(hdmi, coeff_c >> 8, 0x4112 + i * 2); -+ } -+ -+ mwv207_hdmi_modb(hdmi, csc_scale, 0x03, 0x4101); -+} -+ -+static void mwv207_hdmi_video_csc(struct mwv207_hdmi *hdmi) -+{ -+ int color_depth = 0x00; -+ -+ mwv207_hdmi_writeb(hdmi, 0, 0x4100); -+ mwv207_hdmi_modb(hdmi, color_depth, 0xF0, 0x4101); -+ -+ mwv207_hdmi_update_csc_coeffs(hdmi); -+} -+ -+static void mwv207_hdmi_video_sample(struct mwv207_hdmi *hdmi) -+{ -+ int color_format = 1; -+ u8 val; -+ -+ val = 0x00 | ((color_format << 0) & 0x1F); -+ mwv207_hdmi_writeb(hdmi, val, 0x0200); -+ -+ val = 0x4 | 0x2 | 0x1; -+ mwv207_hdmi_writeb(hdmi, val, 0x0201); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0202); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0203); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0204); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0205); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0206); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0207); -+} -+ -+static void mwv207_hdmi_tx_hdcp_config(struct mwv207_hdmi *hdmi) -+{ -+ u8 de = 0x10; -+ -+ mwv207_hdmi_modb(hdmi, 0x0, 0x4, 0x5000); -+ -+ mwv207_hdmi_modb(hdmi, de, 0x10, 0x5009); -+ -+ mwv207_hdmi_modb(hdmi, 0x2, 0x2, 0x5001); -+} -+ -+static void mwv207_hdmi_set_timing(struct mwv207_hdmi *hdmi) -+{ -+ struct drm_display_mode *mode; -+ -+ mwv207_hdmi_disable_overflow_interrupts(hdmi); -+ -+ mode = &hdmi->base.cur_crtc->state->adjusted_mode; -+ hdmi->vic = drm_match_cea_mode(mode); -+ -+ hdmi->rgb_limited_range = hdmi->sink_is_hdmi && -+ drm_default_rgb_quant_range(mode) == -+ HDMI_QUANTIZATION_RANGE_LIMITED; -+ -+ mwv207_hdmi_av_composer(hdmi, mode); -+ -+ mwv207_hdmi_phy_configure(hdmi, mode->clock, 8); -+ -+ mwv207_hdmi_enable_video_path(hdmi); -+ -+ if (hdmi->sink_has_audio) { -+ mwv207_hdmi_enable_audio_clk(hdmi, 1); -+ } -+ -+ if (hdmi->sink_is_hdmi) { -+ struct drm_connector *conn = &hdmi->base.connector; -+ -+ mwv207_hdmi_config_AVI(hdmi, conn, mode); -+ mwv207_hdmi_config_vendor_specific_infoframe(hdmi, conn, mode); -+ mwv207_hdmi_config_drm_infoframe(hdmi, conn); -+ } -+ -+ mwv207_hdmi_video_packetize(hdmi); -+ mwv207_hdmi_video_csc(hdmi); -+ mwv207_hdmi_video_sample(hdmi); -+ mwv207_hdmi_tx_hdcp_config(hdmi); -+ -+ mwv207_hdmi_clear_overflow(hdmi); -+} -+ -+static int mwv207_hdmi_get_modes(struct drm_connector *connector) -+{ -+ struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); -+ int count; -+ -+ count = mwv207_output_get_modes(connector); -+ -+ if (connector->edid_blob_ptr) { -+ struct edid *edid; -+ -+ edid = (struct edid *)connector->edid_blob_ptr->data; -+ hdmi->sink_is_hdmi = drm_detect_hdmi_monitor(edid); -+ hdmi->sink_has_audio = drm_detect_monitor_audio(edid); -+ } else { -+ hdmi->sink_is_hdmi = false; -+ hdmi->sink_has_audio = false; -+ } -+ -+ return count; -+} -+ -+static enum drm_mode_status mwv207_hdmi_mode_valid(struct mwv207_hdmi *hdmi, -+ const struct drm_display_mode *mode) -+{ -+ if (mode->clock >= 384000) -+ return MODE_CLOCK_HIGH; -+ -+ if (mode->clock > 594000) -+ return MODE_CLOCK_HIGH; -+ -+ if (!hdmi->sink_is_hdmi && mode->clock >= 165000) -+ return MODE_CLOCK_HIGH; -+ -+ return MODE_OK; -+} -+ -+static enum drm_mode_status mwv207_hdmi_connector_mode_valid(struct drm_connector *connector, -+ struct drm_display_mode *mode) -+{ -+ struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); -+ -+ return mwv207_hdmi_mode_valid(hdmi, mode); -+} -+ -+static int mwv207_hdmi_detect_ctx(struct drm_connector *connector, -+ struct drm_modeset_acquire_ctx *ctx, -+ bool force) -+{ -+ struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); -+ u32 value; -+ -+ value = mwv207_hdmi_readb(hdmi, 0x3004); -+ if (value & 0x2) -+ return connector_status_connected; -+ else -+ return connector_status_disconnected; -+} -+ -+static void mwv207_hdmi_destroy(struct drm_connector *conn) -+{ -+ struct mwv207_hdmi *hdmi = connector_to_hdmi(conn); -+ -+ free_irq(hdmi->irq, hdmi); -+ drm_connector_unregister(conn); -+ drm_connector_cleanup(conn); -+} -+ -+static const struct drm_connector_helper_funcs mwv207_hdmi_connector_helper_funcs = { -+ .get_modes = mwv207_hdmi_get_modes, -+ .mode_valid = mwv207_hdmi_connector_mode_valid, -+ .detect_ctx = mwv207_hdmi_detect_ctx -+}; -+ -+static const struct drm_connector_funcs mwv207_hdmi_connector_funcs = { -+ .reset = drm_atomic_helper_connector_reset, -+ .fill_modes = drm_helper_probe_single_connector_modes, -+ .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, -+ .destroy = mwv207_hdmi_destroy, -+ .late_register = mwv207_output_late_register, -+ .early_unregister = mwv207_output_early_unregister, -+}; -+ -+static enum drm_mode_status mwv207_hdmi_encoder_mode_valid(struct drm_encoder *encoder, -+ const struct drm_display_mode *mode) -+{ -+ struct mwv207_hdmi *hdmi = encoder_to_hdmi(encoder); -+ -+ return mwv207_hdmi_mode_valid(hdmi, mode); -+} -+ -+static int mwv207_hdmi_encoder_atomic_check(struct drm_encoder *encoder, -+ struct drm_crtc_state *crtc_state, -+ struct drm_connector_state *conn_state) -+{ -+ return 0; -+} -+ -+static void mwv207_hdmi_encoder_enable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_hdmi_select_crtc(output); -+ -+ mwv207_hdmi_set_timing(encoder_to_hdmi(encoder)); -+ -+ mwv207_hdmi_switch(output, true); -+} -+ -+static void mwv207_hdmi_encoder_disable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_hdmi_switch(output, false); -+} -+ -+static void mwv207_hdmi_encoder_reset(struct drm_encoder *encoder) -+{ -+ mwv207_hdmi_encoder_disable(encoder); -+ mwv207_hdmi_ih_mutes(encoder_to_hdmi(encoder)); -+ mwv207_hdmi_phy_setup_hpd(encoder_to_hdmi(encoder)); -+} -+ -+static const struct drm_encoder_funcs mwv207_hdmi_encoder_funcs = { -+ .destroy = drm_encoder_cleanup, -+ .reset = mwv207_hdmi_encoder_reset, -+}; -+ -+static const struct drm_encoder_helper_funcs mwv207_hdmi_encoder_helper_funcs = { -+ .mode_valid = mwv207_hdmi_encoder_mode_valid, -+ .atomic_check = mwv207_hdmi_encoder_atomic_check, -+ .enable = mwv207_hdmi_encoder_enable, -+ .disable = mwv207_hdmi_encoder_disable, -+}; -+ -+static int mwv207_hdmi_init_single(struct mwv207_device *jdev, int idx) -+{ -+ struct mwv207_output *output; -+ struct mwv207_hdmi *hdmi; -+ int ret; -+ -+ hdmi = devm_kzalloc(jdev->dev, sizeof(*hdmi), GFP_KERNEL); -+ if (!hdmi) -+ return -ENOMEM; -+ -+ output = &hdmi->base; -+ output->jdev = jdev; -+ output->idx = idx; -+ output->mmio = jdev->mmio + 0x9a0000; -+ output->i2c_chan = 0 + idx; -+ hdmi->mmio = jdev->mmio + MWV207_HDMI_BASE(idx); -+ hdmi->mc_clkdis = 0x7f; -+ -+ mwv207_hdmi_phy_data_init(hdmi); -+ -+ output->connector.polled = DRM_CONNECTOR_POLL_HPD; -+ ret = drm_connector_init(&jdev->base, &output->connector, -+ &mwv207_hdmi_connector_funcs, DRM_MODE_CONNECTOR_HDMIA); -+ if (ret) -+ return ret; -+ drm_connector_helper_add(&output->connector, &mwv207_hdmi_connector_helper_funcs); -+ -+ output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; -+ ret = drm_encoder_init(&jdev->base, &output->encoder, -+ &mwv207_hdmi_encoder_funcs, DRM_MODE_ENCODER_TMDS, -+ "hdmi-%d", output->idx); -+ if (ret) -+ return ret; -+ drm_encoder_helper_add(&output->encoder, &mwv207_hdmi_encoder_helper_funcs); -+ -+ ret = drm_connector_attach_encoder(&output->connector, &output->encoder); -+ if (ret) -+ return ret; -+ -+ hdmi->irq = irq_find_mapping(jdev->irq_domain, output->idx + 32); -+ BUG_ON(hdmi->irq == 0); -+ -+ ret = request_threaded_irq(hdmi->irq, -+ mwv207_hdmi_hard_irq, mwv207_hdmi_irq, -+ IRQF_SHARED, output->encoder.name, hdmi); -+ if (ret) -+ return ret; -+ -+ ret = drm_connector_register(&output->connector); -+ if (ret) -+ free_irq(hdmi->irq, hdmi); -+ -+ return ret; -+} -+ -+int mwv207_hdmi_init(struct mwv207_device *jdev) -+{ -+ int i, ret; -+ -+ for (i = 0; i < 4; i++) { -+ -+ if (jdev_read(jdev, MWV207_HDMI_BASE(i)) != 0x21) -+ continue; -+ ret = mwv207_hdmi_init_single(jdev, i); -+ if (ret) -+ return ret; -+ } -+ -+ return 0; -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_i2c.c b/drivers/gpu/drm/mwv207/dc/mwv207_i2c.c -new file mode 100644 -index 000000000..bcfbef8d5 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_i2c.c -@@ -0,0 +1,312 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_vi.h" -+ -+static int i2c_scl_gpio[8] = {19, 21, 23, 25, 27, 29, 31, 33}; -+static int i2c_sda_gpio[8] = {20, 22, 24, 26, 28, 30, 32, 34}; -+ -+struct mwv207_i2c { -+ struct i2c_adapter adapter; -+ struct mwv207_device *jdev; -+ struct i2c_algo_bit_data bit; -+ struct mutex *mutex; -+ u32 sda_in_addr; -+ u32 sda_out_addr; -+ u32 sda_mask; -+ u32 sda_dir; -+ u32 scl_in_addr; -+ u32 scl_out_addr; -+ u32 scl_mask; -+ u32 scl_dir; -+}; -+ -+static inline void mwv207_i2c_set_dir(struct mwv207_i2c *i2c, u32 mask, -+ u32 reg, bool is_input) -+{ -+ mb(); -+ -+ jdev_modify(i2c->jdev, reg, mask, is_input ? mask : 0); -+ -+ mb(); -+} -+ -+ -+static void mwv207_i2c_gpio_multi(struct mwv207_i2c *i2c, int mask) -+{ -+ struct mwv207_device *jdev = i2c->jdev; -+ -+ switch (mask) { -+ case (1 << 19): -+ -+ jdev_modify(jdev, (0x9b0918), 0x3 << 12, 0); -+ jdev_modify(jdev, (0x9b0918), 0x3 << 16, 0); -+ break; -+ case (1 << 21): -+ -+ jdev_modify(jdev, (0x9b0918), 0x3 << 20, 0); -+ jdev_modify(jdev, (0x9b0918), 0x3 << 24, 0); -+ break; -+ case (1 << 23): -+ -+ jdev_modify(jdev, (0x9b0918), 0x3 << 28, 0); -+ jdev_modify(jdev, (0x9b091c), 0x3, 0); -+ break; -+ case (1 << 25): -+ -+ jdev_modify(jdev, (0x9b091c), 0x3 << 4, 0); -+ jdev_modify(jdev, (0x9b091c), 0x3 << 8, 0); -+ break; -+ case (1 << 27): -+ -+ jdev_modify(jdev, (0x9b091c), 0x3 << 12, 0); -+ jdev_modify(jdev, (0x9b091c), 0x3 << 16, 0); -+ break; -+ case (1 << 29): -+ -+ jdev_modify(jdev, (0x9b091c), 0x3 << 20, 0); -+ jdev_modify(jdev, (0x9b091c), 0x3 << 24, 0); -+ break; -+ case (1 << 31): -+ -+ jdev_modify(jdev, (0x9b091c), 0x3 << 28, 0); -+ jdev_modify(jdev, (0x9b0910), 0x3, 0); -+ break; -+ case (1 << 1): -+ -+ jdev_modify(jdev, (0x9b0910), 0x3 << 4, 0); -+ jdev_modify(jdev, (0x9b0910), 0x3 << 8, 0); -+ break; -+ default: -+ break; -+ } -+} -+ -+static int mwv207_i2c_pre_xfer(struct i2c_adapter *i2c_adap) -+{ -+ struct mwv207_i2c *i2c = i2c_get_adapdata(i2c_adap); -+ struct mwv207_device *jdev = i2c->jdev; -+ -+ mutex_lock(i2c->mutex); -+ mwv207_i2c_gpio_multi(i2c, i2c->scl_mask); -+ -+ jdev_modify(jdev, i2c->scl_out_addr, i2c->scl_mask, 0); -+ jdev_modify(jdev, i2c->sda_out_addr, i2c->sda_mask, 0); -+ -+ mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 1); -+ mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); -+ -+ return 0; -+} -+ -+static void mwv207_i2c_post_xfer(struct i2c_adapter *i2c_adap) -+{ -+ struct mwv207_i2c *i2c = i2c_get_adapdata(i2c_adap); -+ -+ mutex_unlock(i2c->mutex); -+} -+ -+static int mwv207_i2c_get_clock(void *i2c_priv) -+{ -+ struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; -+ struct mwv207_device *jdev = i2c->jdev; -+ u32 val; -+ -+ mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 1); -+ -+ val = jdev_read(jdev, i2c->scl_in_addr); -+ val &= i2c->scl_mask; -+ -+ return val ? 1 : 0; -+} -+ -+static int mwv207_i2c_get_data(void *i2c_priv) -+{ -+ struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; -+ struct mwv207_device *jdev = i2c->jdev; -+ u32 val; -+ -+ mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); -+ -+ val = jdev_read(jdev, i2c->sda_in_addr); -+ val &= i2c->sda_mask; -+ -+ return val ? 1 : 0; -+} -+ -+static void mwv207_i2c_set_clock(void *i2c_priv, int clock) -+{ -+ struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; -+ struct mwv207_device *jdev = i2c->jdev; -+ -+ mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 0); -+ jdev_modify(jdev, i2c->scl_out_addr, i2c->scl_mask, clock ? i2c->scl_mask : 0); -+} -+ -+static void mwv207_i2c_set_data(void *i2c_priv, int data) -+{ -+ struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; -+ -+ if (data) -+ mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); -+ else -+ mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 0); -+} -+ -+static int mwv207_i2c_set_addr(struct mwv207_i2c *i2c, int channel) -+{ -+ switch (channel) { -+ case 0: -+ case 1: -+ case 2: -+ case 3: -+ case 4: -+ case 5: -+ i2c->sda_in_addr = (0x9aa000); -+ i2c->scl_in_addr = (0x9aa000); -+ i2c->sda_out_addr = (0x9aa004); -+ i2c->scl_out_addr = (0x9aa004); -+ i2c->scl_mask = (1 << i2c_scl_gpio[channel]); -+ i2c->sda_mask = (1 << i2c_sda_gpio[channel]); -+ i2c->scl_dir = (0x9aa008); -+ i2c->sda_dir = (0x9aa008); -+ break; -+ case 6: -+ i2c->sda_in_addr = (0x9aa000); -+ i2c->scl_in_addr = (0x9aa010); -+ i2c->sda_out_addr = (0x9aa004); -+ i2c->scl_out_addr = (0x9aa014); -+ i2c->scl_mask = (1 << i2c_scl_gpio[channel]); -+ i2c->sda_mask = (1 << (i2c_sda_gpio[channel] - 32)); -+ i2c->scl_dir = (0x9aa008); -+ i2c->sda_dir = (0x9aa018); -+ break; -+ case 7: -+ i2c->sda_in_addr = (0x9aa010); -+ i2c->scl_in_addr = (0x9aa010); -+ i2c->sda_out_addr = (0x9aa014); -+ i2c->scl_out_addr = (0x9aa014); -+ i2c->scl_mask = (1 << (i2c_scl_gpio[channel] - 32)); -+ i2c->sda_mask = (1 << (i2c_sda_gpio[channel] - 32)); -+ i2c->scl_dir = (0x9aa018); -+ i2c->sda_dir = (0x9aa018); -+ break; -+ } -+ -+ return 0; -+} -+ -+void mwv207_i2c_put_byte(struct i2c_adapter *i2c, -+ u8 slave_addr, -+ u8 addr, -+ u8 val) -+{ -+ uint8_t out_buf[2]; -+ struct i2c_msg msg = { -+ .addr = slave_addr, -+ .flags = 0, -+ .len = 2, -+ .buf = out_buf, -+ }; -+ -+ out_buf[0] = addr; -+ out_buf[1] = val; -+ -+ if (i2c_transfer(i2c, &msg, 1) != 1) -+ pr_warn("i2c 0x%02x 0x%02x write failed\n", -+ addr, val); -+} -+ -+void mwv207_i2c_destroy(struct i2c_adapter *adapter) -+{ -+ i2c_del_adapter(adapter); -+} -+ -+struct i2c_adapter *mwv207_i2c_create(struct mwv207_device *jdev, int i2c_chan) -+{ -+ struct mwv207_i2c *i2c; -+ int ret; -+ -+ if (i2c_chan < 0 || i2c_chan >= 6) -+ return NULL; -+ -+ i2c = devm_kzalloc(jdev->dev, sizeof(*i2c), GFP_KERNEL); -+ if (!i2c) -+ return NULL; -+ -+ if (mwv207_i2c_set_addr(i2c, i2c_chan)) -+ return NULL; -+ -+ i2c->adapter.owner = THIS_MODULE; -+ i2c->adapter.class = I2C_CLASS_DDC; -+ i2c->adapter.dev.parent = jdev->dev; -+ i2c_set_adapdata(&i2c->adapter, i2c); -+ i2c->mutex = &jdev->gpio_lock; -+ i2c->jdev = jdev; -+ -+ snprintf(i2c->adapter.name, sizeof(i2c->adapter.name), -+ "MWV207_I2C_%d", i2c_chan); -+ i2c->adapter.algo_data = &i2c->bit; -+ i2c->bit.pre_xfer = mwv207_i2c_pre_xfer; -+ i2c->bit.post_xfer = mwv207_i2c_post_xfer; -+ i2c->bit.setsda = mwv207_i2c_set_data; -+ i2c->bit.setscl = mwv207_i2c_set_clock; -+ i2c->bit.getsda = mwv207_i2c_get_data; -+ i2c->bit.getscl = mwv207_i2c_get_clock; -+ i2c->bit.udelay = 10; -+ i2c->bit.timeout = usecs_to_jiffies(2200); -+ i2c->bit.data = i2c; -+ -+ ret = i2c_bit_add_bus(&i2c->adapter); -+ if (ret) -+ return NULL; -+ -+ return &i2c->adapter; -+} -+ -+bool mwv207_i2c_probe(struct i2c_adapter *i2c_bus) -+{ -+ u8 out = 0x0; -+ u8 buf[8]; -+ int ret; -+ struct i2c_msg msgs[] = { -+ { -+ .addr = DDC_ADDR, -+ .flags = 0, -+ .len = 1, -+ .buf = &out, -+ }, -+ { -+ .addr = DDC_ADDR, -+ .flags = I2C_M_RD, -+ .len = 8, -+ .buf = buf, -+ } -+ }; -+ -+ ret = i2c_transfer(i2c_bus, msgs, 2); -+ if (ret != 2) { -+ -+ return false; -+ } -+ -+ if (drm_edid_header_is_valid(buf) < 6) { -+ return false; -+ } -+ return true; -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_kms.c b/drivers/gpu/drm/mwv207/dc/mwv207_kms.c -new file mode 100644 -index 000000000..e4887e2c3 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_kms.c -@@ -0,0 +1,204 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207_gem.h" -+#include "mwv207_kms.h" -+#include "mwv207_va.h" -+#include "mwv207_vi.h" -+ -+static const struct drm_framebuffer_funcs fb_funcs = { -+ .destroy = drm_gem_fb_destroy, -+ .create_handle = drm_gem_fb_create_handle, -+}; -+ -+int mwv207_framebuffer_init(struct mwv207_device *jdev, struct drm_framebuffer *fb, -+ const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object *gobj) -+{ -+ int ret; -+ -+ fb->obj[0] = gobj; -+ drm_helper_mode_fill_fb_struct(&jdev->base, fb, mode_cmd); -+ -+ ret = drm_framebuffer_init(&jdev->base, fb, &fb_funcs); -+ return ret; -+} -+ -+static struct drm_framebuffer *mwv207_framebuffer_create( -+ struct drm_device *dev, -+ struct drm_file *filp, -+ const struct drm_mode_fb_cmd2 *mode_cmd) -+{ -+ struct drm_gem_object *gobj = drm_gem_object_lookup(filp, mode_cmd->handles[0]); -+ struct drm_framebuffer *fb; -+ int err = -ENOENT; -+ -+ if (!gobj) { -+ DRM_DEBUG_DRIVER("fbdev failed to lookup gem object, handle = %d\n", -+ mode_cmd->handles[0]); -+ return ERR_PTR(-ENOENT); -+ } -+ -+ fb = kzalloc(sizeof(*fb), GFP_KERNEL); -+ if (!fb) { -+ err = -ENOMEM; -+ goto err_unref; -+ } -+ -+ err = mwv207_framebuffer_init(dev->dev_private, fb, mode_cmd, gobj); -+ if (err) -+ goto err_free; -+ -+ return fb; -+err_free: -+ kfree(fb); -+err_unref: -+ mwv207_gem_object_put(gobj); -+ return ERR_PTR(err); -+} -+ -+static void mwv207_atomic_prepare_vblank(struct drm_device *dev, -+ struct drm_atomic_state *old_state) -+{ -+ struct drm_crtc_state *new_crtc_state; -+ struct drm_crtc *crtc; -+ int i; -+ -+ for_each_new_crtc_in_state(old_state, crtc, new_crtc_state, i) -+ mwv207_crtc_prepare_vblank(crtc); -+} -+ -+static void mwv207_atomic_commit_tail(struct drm_atomic_state *old_state) -+{ -+ struct drm_device *dev = old_state->dev; -+ -+ drm_atomic_helper_commit_modeset_disables(dev, old_state); -+ drm_atomic_helper_commit_planes(dev, old_state, 0); -+ drm_atomic_helper_commit_modeset_enables(dev, old_state); -+ -+ mwv207_atomic_prepare_vblank(dev, old_state); -+ -+ drm_atomic_helper_commit_hw_done(old_state); -+ -+ drm_atomic_helper_wait_for_vblanks(dev, old_state); -+ drm_atomic_helper_cleanup_planes(dev, old_state); -+} -+ -+static struct drm_mode_config_helper_funcs mwv207_mode_config_helper_funcs = { -+ .atomic_commit_tail = mwv207_atomic_commit_tail, -+}; -+ -+static const struct drm_mode_config_funcs mwv207_mode_config_funcs = { -+ .fb_create = mwv207_framebuffer_create, -+ .atomic_check = drm_atomic_helper_check, -+ .atomic_commit = drm_atomic_helper_commit, -+ .output_poll_changed = drm_fb_helper_output_poll_changed, -+}; -+ -+static void mwv207_modeset_init(struct drm_device *dev) -+{ -+ drm_mode_config_init(dev); -+ -+ dev->mode_config.min_width = 20; -+ dev->mode_config.min_height = 20; -+ -+ dev->mode_config.max_width = 4096 * 4; -+ dev->mode_config.max_height = 4096 * 4; -+ -+ dev->mode_config.preferred_depth = 24; -+ dev->mode_config.prefer_shadow = 1; -+ dev->mode_config.allow_fb_modifiers = true; -+ -+ dev->mode_config.async_page_flip = true; -+ -+ dev->mode_config.funcs = &mwv207_mode_config_funcs; -+ dev->mode_config.helper_private = &mwv207_mode_config_helper_funcs; -+ -+ dev->mode_config.cursor_width = 64; -+ dev->mode_config.cursor_height = 64; -+} -+ -+int mwv207_kms_suspend(struct mwv207_device *jdev) -+{ -+ return drm_mode_config_helper_suspend(&jdev->base); -+} -+ -+int mwv207_kms_resume(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ ret = drm_mode_config_helper_resume(&jdev->base); -+ if (ret) -+ pr_warn("mwv207: failed to resume kms, ret: %d", ret); -+ -+ return ret; -+} -+ -+int mwv207_kms_init(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ mwv207_modeset_init(&jdev->base); -+ -+ ret = mwv207_va_init(jdev); -+ if (ret) -+ goto cleanup; -+ -+ ret = mwv207_vi_init(jdev); -+ if (ret) -+ goto cleanup; -+ -+ jdev->va_irq = irq_find_mapping(jdev->irq_domain, 42); -+ BUG_ON(jdev->va_irq == 0); -+ ret = request_irq(jdev->va_irq, mwv207_va_handle_vblank, 0, "mwv207_va", jdev); -+ if (ret) -+ goto cleanup; -+ jdev->base.irq_enabled = true; -+ -+ ret = drm_vblank_init(&jdev->base, jdev->base.mode_config.num_crtc); -+ if (ret) -+ goto free_irq; -+ -+ drm_mode_config_reset(&jdev->base); -+ -+ drm_kms_helper_poll_init(&jdev->base); -+ -+ DRM_INFO("number of crtc: %d\n", jdev->base.mode_config.num_crtc); -+ DRM_INFO("number of encoder: %d\n", jdev->base.mode_config.num_encoder); -+ DRM_INFO("number of connector: %d\n", jdev->base.mode_config.num_connector); -+ -+ return 0; -+free_irq: -+ free_irq(jdev->va_irq, jdev); -+cleanup: -+ drm_mode_config_cleanup(&jdev->base); -+ return ret; -+} -+ -+void mwv207_kms_fini(struct mwv207_device *jdev) -+{ -+ drm_kms_helper_poll_fini(&jdev->base); -+ drm_atomic_helper_shutdown(&jdev->base); -+ free_irq(jdev->va_irq, jdev); -+ drm_mode_config_cleanup(&jdev->base); -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_kms.h b/drivers/gpu/drm/mwv207/dc/mwv207_kms.h -new file mode 100644 -index 000000000..eedb428f6 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_kms.h -@@ -0,0 +1,33 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_KMS_H_VBCHTKVP -+#define MWV207_KMS_H_VBCHTKVP -+ -+#include -+#include "mwv207.h" -+ -+int mwv207_framebuffer_init(struct mwv207_device *jdev, struct drm_framebuffer *fb, -+ const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object *gobj); -+ -+int mwv207_fbdev_init(struct mwv207_device *jdev); -+void mwv207_fbdev_fini(struct mwv207_device *jdev); -+ -+int mwv207_kms_init(struct mwv207_device *jdev); -+void mwv207_kms_fini(struct mwv207_device *jdev); -+ -+int mwv207_kms_suspend(struct mwv207_device *jdev); -+int mwv207_kms_resume(struct mwv207_device *jdev); -+#endif -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_va.c b/drivers/gpu/drm/mwv207/dc/mwv207_va.c -new file mode 100644 -index 000000000..9a8c1d14d ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_va.c -@@ -0,0 +1,719 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207_bo.h" -+#include "mwv207_va.h" -+#include "mwv207_vi.h" -+#include "mwv207_vbios.h" -+ -+#define MWV207_WIN_BASE(idx) (0x990000 + 0x100 * (idx) + ((idx) > 1 ? 0xC00 : 0)) -+ -+#define MWV207_VA_BASE(idx) (0x990000 + 0x100 * (idx) + ((idx) > 1 ? 0x600 : 0)) -+ -+#define crtc_to_va(crtc) container_of(crtc, struct mwv207_va, crtc) -+#define plane_to_va(plane) (((plane)->type == DRM_PLANE_TYPE_PRIMARY) \ -+ ? container_of(plane, struct mwv207_va, primary) \ -+ : container_of(plane, struct mwv207_va, cursor)) -+struct mwv207_va { -+ struct drm_crtc crtc; -+ struct drm_plane primary; -+ struct drm_plane cursor; -+ void __iomem *mmio; -+ struct mwv207_device *jdev; -+ struct drm_pending_vblank_event *event; -+ int idx; -+ uint16_t lutdata[768]; -+}; -+ -+static u32 rgb_formats[] = { -+ DRM_FORMAT_RGB565, -+ DRM_FORMAT_RGB888, -+ DRM_FORMAT_XRGB8888, -+ DRM_FORMAT_ARGB8888, -+ DRM_FORMAT_XRGB2101010, -+}; -+ -+static uint64_t format_modifiers[] = { -+ DRM_FORMAT_MOD_LINEAR, -+ DRM_FORMAT_MOD_INVALID -+}; -+ -+static u32 cursor_formats[] = { -+ DRM_FORMAT_ARGB8888, -+}; -+ -+static inline u32 mwv207_va_read(struct mwv207_va *va, u32 reg) -+{ -+ return readl(va->mmio + reg); -+} -+ -+static inline void mwv207_va_write(struct mwv207_va *va, u32 reg, u32 value) -+{ -+ writel_relaxed(value, va->mmio + reg); -+} -+ -+static inline void mwv207_va_modify(struct mwv207_va *va, u32 reg, -+ u32 mask, u32 value) -+{ -+ u32 rvalue = mwv207_va_read(va, reg); -+ -+ rvalue = (rvalue & ~mask) | (value & mask); -+ mwv207_va_write(va, reg, rvalue); -+} -+ -+static bool mwv207_plane_format_mod_supported(struct drm_plane *plane, -+ uint32_t format, uint64_t modifier) -+{ -+ if (modifier == DRM_FORMAT_MOD_LINEAR) -+ return true; -+ return false; -+} -+ -+static int mwv207_plane_atomic_check(struct drm_plane *plane, -+ struct drm_plane_state *state) -+{ -+ -+ return 0; -+} -+ -+static int mwv207_plane_prepare_fb(struct drm_plane *plane, -+ struct drm_plane_state *new_state) -+{ -+ struct mwv207_bo *jbo; -+ int ret; -+ -+ if (!new_state->fb) -+ return 0; -+ -+ jbo = mwv207_bo_from_gem(new_state->fb->obj[0]); -+ -+ ret = mwv207_bo_reserve(jbo, false); -+ if (ret) -+ return ret; -+ -+ -+ jbo->flags |= (1<<0); -+ ret = mwv207_bo_pin_reserved(jbo, 0x2); -+ mwv207_bo_unreserve(jbo); -+ if (ret) -+ return ret; -+ -+ mwv207_bo_ref(jbo); -+ -+ drm_gem_fb_prepare_fb(plane, new_state); -+ -+ return 0; -+} -+ -+static void mwv207_plane_cleanup_fb(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ struct mwv207_bo *jbo; -+ -+ if (!old_state->fb) -+ return; -+ -+ jbo = mwv207_bo_from_gem(old_state->fb->obj[0]); -+ if (!jbo) -+ return; -+ -+ mwv207_bo_unpin(jbo); -+ mwv207_bo_unref(jbo); -+} -+ -+static u64 mwv207_plane_fb_addr(struct drm_plane *plane) -+{ -+ struct drm_framebuffer *fb; -+ struct mwv207_bo *bo; -+ u32 src_x, src_y; -+ u64 fbaddr; -+ -+ -+ src_x = plane->state->src_x >> 16; -+ src_y = plane->state->src_y >> 16; -+ -+ fb = plane->state->fb; -+ bo = mwv207_bo_from_gem(fb->obj[0]); -+ fbaddr = mwv207_bo_gpu_phys(bo); -+ fbaddr += src_x * fb->format->cpp[0] + fb->pitches[0] * src_y; -+ -+ return fbaddr; -+} -+ -+static void mwv207_primary_atomic_update(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ struct mwv207_va *va = plane_to_va(plane); -+ struct drm_framebuffer *fb; -+ u32 src_w, src_h; -+ u64 fbaddr; -+ -+ -+ if (!plane->state->fb || !plane->state->crtc) -+ return; -+ -+ -+ src_w = plane->state->src_w >> 16; -+ src_h = plane->state->src_h >> 16; -+ fbaddr = mwv207_plane_fb_addr(plane); -+ fb = plane->state->fb; -+ -+ -+ mwv207_va_write(va, 0x434, fb->pitches[0] >> 4); -+ -+ -+ mwv207_va_write(va, 0x43C, ((src_h - 1) << 16) | (src_w - 1) | 0x3); -+ -+ -+ mwv207_va_write(va, 0x4F8, (src_w - 1) << 16); -+ -+ -+ mwv207_va_write(va, 0x438, fbaddr >> 6); -+ -+ -+ switch (fb->format->format) { -+ case DRM_FORMAT_RGB565: -+ mwv207_va_modify(va, 0x430, 1, 1); -+ break; -+ case DRM_FORMAT_XRGB2101010: -+ case DRM_FORMAT_ARGB2101010: -+ mwv207_va_modify(va, 0x430, 1 << 1, 1 << 1); -+ break; -+ case DRM_FORMAT_ARGB8888: -+ mwv207_va_modify(va, 0x430, 0x3, 0); -+ break; -+ default: -+ break; -+ } -+} -+ -+static void mwv207_primary_atomic_disable(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ -+} -+ -+/* turn on / off cursor */ -+static void mwv207_cursor_switch(struct mwv207_va *va, bool on) -+{ -+ mwv207_va_modify(va, 0x478, 0xff, on ? 6 : 0); -+} -+ -+static void mwv207_cursor_atomic_update(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ int crtc_x, crtc_y, pos_x, pos_y, hot_x, hot_y; -+ struct mwv207_va *va = plane_to_va(plane); -+ u64 fbaddr; -+ -+ -+ if (!plane->state->fb || !plane->state->crtc) -+ return; -+ -+ -+ crtc_x = plane->state->crtc_x; -+ crtc_y = plane->state->crtc_y; -+ fbaddr = mwv207_plane_fb_addr(plane); -+ -+ -+ mwv207_va_write(va, 0x4B4, fbaddr >> 6); -+ -+ -+ pos_x = crtc_x < 0 ? 0 : crtc_x; -+ hot_x = crtc_x < 0 ? -crtc_x : 0; -+ pos_y = crtc_y < 0 ? 0 : crtc_y; -+ hot_y = crtc_y < 0 ? -crtc_y : 0; -+ mwv207_va_write(va, 0x454, (hot_x & 0x3f) | ((hot_y & 0x3f) << 16)); -+ mwv207_va_write(va, 0x4A8, (pos_x & 0xffff) | ((pos_y & 0xffff) << 16)); -+ -+ -+ mwv207_cursor_switch(va, 1); -+} -+ -+static void mwv207_cursor_atomic_disable(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ struct mwv207_va *va = plane_to_va(plane); -+ -+ -+ mwv207_cursor_switch(va, 0); -+} -+ -+static const struct drm_plane_funcs mwv207_plane_funcs = { -+ .reset = drm_atomic_helper_plane_reset, -+ .update_plane = drm_atomic_helper_update_plane, -+ .disable_plane = drm_atomic_helper_disable_plane, -+ .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_plane_destroy_state, -+ .format_mod_supported = mwv207_plane_format_mod_supported, -+ .destroy = drm_plane_cleanup, -+}; -+ -+static const struct drm_plane_helper_funcs mwv207_primary_helper_funcs = { -+ .prepare_fb = mwv207_plane_prepare_fb, -+ .cleanup_fb = mwv207_plane_cleanup_fb, -+ .atomic_check = mwv207_plane_atomic_check, -+ .atomic_update = mwv207_primary_atomic_update, -+ .atomic_disable = mwv207_primary_atomic_disable, -+}; -+ -+static const struct drm_plane_helper_funcs mwv207_cursor_helper_funcs = { -+ .prepare_fb = mwv207_plane_prepare_fb, -+ .cleanup_fb = mwv207_plane_cleanup_fb, -+ .atomic_check = mwv207_plane_atomic_check, -+ .atomic_update = mwv207_cursor_atomic_update, -+ .atomic_disable = mwv207_cursor_atomic_disable, -+}; -+ -+static void mwv207_va_misc_reset(struct mwv207_va *va) -+{ -+ struct mwv207_device *jdev = va->jdev; -+ -+ -+ jdev_write(jdev, (0x9b001c), 0xfffff); -+ jdev_write(jdev, (0x9b0020), 0xfffff); -+ jdev_write(jdev, (0x9b0024), 0xfffff); -+ -+ -+ jdev_write(jdev, (0x9b0028), 0x03020100); -+ -+ -+ jdev_write(jdev, MWV207_WIN_BASE(va->idx) + 0x2c, 0); -+} -+ -+static int mwv207_va_lut_fifo_wait(struct mwv207_va *va, u32 used) -+{ -+ int i; -+ -+ -+ mb(); -+ for (i = 0; i < 120; ++i) { -+ if (mwv207_va_read(va, 0x450) <= used) -+ return 0; -+ usleep_range(1000, 1001); -+ } -+ -+ return -EBUSY; -+} -+ -+static void mwv207_va_lut_fifo_activate(struct mwv207_va *va, int rgb) -+{ -+ -+ mb(); -+ mwv207_va_write(va, 0x44C, rgb); -+ mwv207_va_write(va, 0x448, 1); -+ udelay(2); -+ mwv207_va_write(va, 0x448, 0); -+ udelay(2); -+} -+ -+static int mwv207_va_lut_fifo_input(struct mwv207_va *va, u32 value) -+{ -+ int ret; -+ -+ -+ ret = mwv207_va_lut_fifo_wait(va, 10); -+ if (ret) -+ return ret; -+ -+ mb(); -+ mwv207_va_write(va, 0x444, value); -+ -+ return 0; -+} -+ -+static void mwv207_va_lut_enable(struct mwv207_va *va) -+{ -+ u32 active_ram, value; -+ int i, ram, rgb; -+ u16 *data; -+ -+ mwv207_va_modify(va, 0x460, 1 << 31, 0 << 31); -+ value = (va->lutdata[384] * 15 / 8) | 0x80000000; -+ jdev_write(va->jdev, MWV207_WIN_BASE(va->idx) + 0x38, value); -+ -+ for (ram = 0; ram < 2; ram++) { -+ active_ram = mwv207_va_read(va, 0x440); -+ for (rgb = 0; rgb < 3; rgb++) { -+ data = &va->lutdata[rgb * 256]; -+ mwv207_va_lut_fifo_activate(va, rgb); -+ for (i = 0; i < 1024; i++) { -+ -+ value = min_t(u32, 1024 - 5, (data[i / 4] << 2) | 0x03); -+ if (mwv207_va_lut_fifo_input(va, value)) -+ pr_warn("mwv207: failed to write lut"); -+ } -+ -+ if (mwv207_va_lut_fifo_wait(va, 0)) -+ pr_warn("mwv207: failed to configure lut"); -+ } -+ -+ mb(); -+ mwv207_va_write(va, 0x440, 1 - active_ram); -+ } -+} -+ -+static void mwv207_mode_fixup(struct drm_display_mode *adjusted_mode, struct drm_display_mode *mode) -+{ -+ memcpy(adjusted_mode, mode, sizeof(*adjusted_mode)); -+ -+ mode->crtc_hdisplay = adjusted_mode->crtc_hdisplay * 2; -+ mode->crtc_hblank_start = adjusted_mode->crtc_hblank_start * 2; -+ mode->crtc_hblank_end = adjusted_mode->crtc_hblank_end * 2; -+ mode->crtc_hsync_start = adjusted_mode->crtc_hsync_start * 2; -+ mode->crtc_hsync_end = adjusted_mode->crtc_hsync_end * 2; -+ mode->crtc_htotal = adjusted_mode->crtc_htotal * 2; -+ mode->crtc_clock = adjusted_mode->crtc_clock * 2; -+} -+ -+static void mwv207_va_config_timing(struct mwv207_va *va) -+{ -+ struct drm_display_mode *m = &va->crtc.state->adjusted_mode; -+ struct drm_display_mode *native = NULL; -+ u32 hsbegin, hsend, hblankbegin, hblankend, htotal, hhalf; -+ u32 vblank_1field_begin, vblank_1field_end; -+ u32 vblank_2field_begin, vblank_2field_end; -+ u32 vs_1field_begin, vs_1field_end; -+ u32 vs_2field_begin, vs_2field_end; -+ u32 is_interleaved; -+ u32 vfrontporch, vsync, vtotal; -+ int ret, value; -+ -+ ret = mwv207_vbios_set_pll(va->jdev, va->idx + MWV207_PLL_GRAPH0, m->crtc_clock); -+ if (ret) { -+ DRM_ERROR("mwv207: failed to set crtc clock: %d", ret); -+ return; -+ } -+ -+ is_interleaved = DRM_MODE_FLAG_INTERLACE & m->flags ? 1 : 0; -+ if (is_interleaved && m->crtc_hdisplay == 720) { -+ native = kmalloc(sizeof(*m), GFP_KERNEL); -+ if (!native) { -+ DRM_ERROR("mwv207: failed to kmalloc native mode\r\n"); -+ return; -+ } -+ mwv207_mode_fixup(m, native); -+ m = native; -+ } -+ -+ -+ hblankbegin = 0; -+ hblankend = m->crtc_htotal - m->crtc_hdisplay; -+ htotal = m->crtc_htotal; -+ hsbegin = m->crtc_hsync_start - m->crtc_hdisplay; -+ hsend = m->crtc_hsync_end - m->crtc_hdisplay; -+ hhalf = is_interleaved ? (htotal / 2 + hsbegin) : htotal / 2; -+ -+ -+ vblank_1field_begin = 0; -+ vblank_1field_end = is_interleaved ? -+ ((m->crtc_vtotal - m->crtc_vdisplay) * 2) -+ : (m->crtc_vtotal - m->crtc_vdisplay); -+ -+ vblank_2field_begin = -+ (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2; -+ vblank_2field_end = -+ (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + -+ (m->crtc_vtotal - m->crtc_vdisplay + 1) * 2; -+ -+ vtotal = m->crtc_vtotal; -+ vfrontporch = m->crtc_vsync_start - m->crtc_vdisplay; -+ vsync = m->crtc_vsync_end - m->crtc_vsync_start; -+ vs_1field_begin = is_interleaved ? (vfrontporch * 2) : (vfrontporch); -+ vs_1field_end = is_interleaved ? ((vfrontporch + vsync) * 2) -+ : (vfrontporch + vsync); -+ vs_2field_begin = -+ (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + -+ vfrontporch * 2 + 1; -+ vs_2field_end = -+ (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + -+ (vfrontporch + vsync) * 2 + 1; -+ -+ -+ mwv207_va_write(va, 0x400, hsbegin | (hsend << 16)); -+ mwv207_va_write(va, 0x404, hblankbegin | (hblankend << 16)); -+ mwv207_va_write(va, 0x408, htotal | (hhalf << 16)); -+ -+ -+ mwv207_va_write(va, 0x40C, vblank_1field_begin | (vblank_1field_end << 16)); -+ mwv207_va_write(va, 0x458, vblank_1field_begin | (vblank_1field_end << 16)); -+ mwv207_va_write(va, 0x410, vblank_2field_begin | (vblank_2field_end << 16)); -+ mwv207_va_write(va, 0x45C, vblank_2field_begin | (vblank_2field_end << 16)); -+ -+ mwv207_va_write(va, 0x418, vs_1field_begin | (vs_1field_end << 16)); -+ mwv207_va_write(va, 0x41C, vs_2field_begin | (vs_2field_end << 16)); -+ -+ mwv207_va_modify(va, 0x414, 0xffff, vtotal); -+ -+ value = is_interleaved; -+ if (is_interleaved && m->crtc_hdisplay == 1440) -+ value |= 0x2; -+ mwv207_va_write(va, 0x464, value); -+ -+ -+ mwv207_va_write(va, 0x420, 1); -+ -+ -+ value = mwv207_va_read(va, 0x2a0); -+ value &= ~0x6; -+ value |= 1; -+ mwv207_va_write(va, 0x2a0, value); -+ -+ kfree(native); -+} -+ -+static int mwv207_crtc_enable_vblank(struct drm_crtc *crtc) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ -+ jdev_modify(va->jdev, (0x9907f0), -+ 1 << (12 + va->idx), 1 << (12 + va->idx)); -+ jdev_modify(va->jdev, (0x9907f8), -+ 1 << (12 + va->idx), 1 << (12 + va->idx)); -+ return 0; -+} -+ -+static void mwv207_crtc_disable_vblank(struct drm_crtc *crtc) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ -+ jdev_modify(va->jdev, (0x9907f0), -+ 1 << (12 + va->idx), 0 << (12 + va->idx)); -+ jdev_modify(va->jdev, (0x9907f8), -+ 1 << (12 + va->idx), 0 << (12 + va->idx)); -+} -+ -+static int mwv207_crtc_atomic_check(struct drm_crtc *crtc, -+ struct drm_crtc_state *state) -+{ -+ if (state->gamma_lut && drm_color_lut_size(state->gamma_lut) != 256) -+ return -EINVAL; -+ return 0; -+} -+ -+static void mwv207_crtc_atomic_enable(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_crtc_state) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ struct drm_encoder *encoder; -+ -+ drm_for_each_encoder_mask(encoder, crtc->dev, crtc->state->encoder_mask) -+ mwv207_output_set_crtc(encoder, crtc); -+ -+ mwv207_va_config_timing(va); -+ drm_crtc_vblank_on(crtc); -+} -+ -+static void mwv207_crtc_atomic_disable(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_crtc_state) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ -+ drm_crtc_vblank_off(crtc); -+ -+ -+ mwv207_va_write(va, 0x2c4, 0); -+ mwv207_va_write(va, 0x2c0, 0); -+ mwv207_va_write(va, 0x2a0, 2); -+ mwv207_va_write(va, 0x2c4, 1); -+ -+} -+ -+static void mwv207_crtc_atomic_flush(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_crtc_state) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ struct drm_color_lut *lut; -+ int i; -+ -+ if (crtc->state->color_mgmt_changed) { -+ if (crtc->state->gamma_lut) { -+ lut = (struct drm_color_lut *)crtc->state->gamma_lut->data; -+ for (i = 0; i < 256; i++) { -+ va->lutdata[i] = drm_color_lut_extract(lut[i].red, 8); -+ va->lutdata[i + 256] = drm_color_lut_extract(lut[i].green, 8); -+ va->lutdata[i + 512] = drm_color_lut_extract(lut[i].blue, 8); -+ } -+ mwv207_va_lut_enable(va); -+ } -+ } -+} -+ -+ -+static void mwv207_va_reset(struct drm_crtc *crtc) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ -+ -+ mwv207_cursor_switch(va, 0); -+ -+ -+ mwv207_va_lut_enable(va); -+ mwv207_va_misc_reset(va); -+ drm_atomic_helper_crtc_reset(crtc); -+} -+ -+static const struct drm_crtc_funcs mwv207_crtc_funcs = { -+ .reset = mwv207_va_reset, -+ .destroy = drm_crtc_cleanup, -+ .set_config = drm_atomic_helper_set_config, -+ .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state, -+ .gamma_set = drm_atomic_helper_legacy_gamma_set, -+ .page_flip = drm_atomic_helper_page_flip, -+ .enable_vblank = mwv207_crtc_enable_vblank, -+ .disable_vblank = mwv207_crtc_disable_vblank, -+}; -+ -+static const struct drm_crtc_helper_funcs mwv207_crtc_helper_funcs = { -+ .atomic_check = mwv207_crtc_atomic_check, -+ .atomic_flush = mwv207_crtc_atomic_flush, -+ .atomic_enable = mwv207_crtc_atomic_enable, -+ .atomic_disable = mwv207_crtc_atomic_disable, -+}; -+ -+void mwv207_crtc_prepare_vblank(struct drm_crtc *crtc) -+{ -+ struct drm_pending_vblank_event *event = crtc->state->event; -+ struct mwv207_va *va = crtc_to_va(crtc); -+ unsigned long flags; -+ -+ if (event) { -+ if (crtc->state->active) { -+ WARN_ON(drm_crtc_vblank_get(crtc) != 0); -+ spin_lock_irqsave(&crtc->dev->event_lock, flags); -+ va->event = event; -+ spin_unlock_irqrestore(&crtc->dev->event_lock, flags); -+ } else { -+ spin_lock_irqsave(&crtc->dev->event_lock, flags); -+ drm_crtc_send_vblank_event(crtc, crtc->state->event); -+ spin_unlock_irqrestore(&crtc->dev->event_lock, flags); -+ } -+ crtc->state->event = NULL; -+ } -+} -+ -+void mwv207_crtc_finish_vblank(struct drm_crtc *crtc) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ int put_vblank = false; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&crtc->dev->event_lock, flags); -+ if (va->event) { -+ drm_crtc_send_vblank_event(crtc, va->event); -+ va->event = NULL; -+ put_vblank = true; -+ } -+ spin_unlock_irqrestore(&crtc->dev->event_lock, flags); -+ -+ if (put_vblank) -+ drm_crtc_vblank_put(crtc); -+} -+ -+irqreturn_t mwv207_va_handle_vblank(int irq, void *data) -+{ -+ struct mwv207_device *jdev = data; -+ struct drm_crtc *crtc; -+ u32 fired; -+ -+ -+ fired = jdev_read(jdev, (0x9907f4)); -+ if (!fired) -+ return IRQ_NONE; -+ jdev_write(jdev, (0x9907f4), fired); -+ -+ fired = (fired >> 12) & 0xf; -+ drm_for_each_crtc(crtc, &jdev->base) { -+ if (fired & (1 << drm_crtc_index(crtc))) { -+ drm_crtc_handle_vblank(crtc); -+ mwv207_crtc_finish_vblank(crtc); -+ } -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static int mwv207_va_init_single(struct mwv207_device *jdev, int idx) -+{ -+ struct mwv207_va *va; -+ uint16_t *lut; -+ int ret, i; -+ -+ va = devm_kzalloc(jdev->dev, sizeof(*va), GFP_KERNEL); -+ if (!va) -+ return -ENOMEM; -+ -+ va->mmio = jdev->mmio + MWV207_VA_BASE(idx); -+ va->jdev = jdev; -+ va->idx = idx; -+ -+ ret = drm_universal_plane_init(&jdev->base, &va->primary, 1 << idx, -+ &mwv207_plane_funcs, -+ rgb_formats, ARRAY_SIZE(rgb_formats), -+ format_modifiers, DRM_PLANE_TYPE_PRIMARY, "primary_plane_%d", idx); -+ if (ret) -+ return ret; -+ ret = drm_universal_plane_init(&jdev->base, &va->cursor, 1 << idx, -+ &mwv207_plane_funcs, -+ cursor_formats, ARRAY_SIZE(cursor_formats), -+ format_modifiers, DRM_PLANE_TYPE_CURSOR, "cursor_%d", idx); -+ if (ret) -+ return ret; -+ -+ drm_plane_helper_add(&va->primary, &mwv207_primary_helper_funcs); -+ drm_plane_helper_add(&va->cursor, &mwv207_cursor_helper_funcs); -+ -+ ret = drm_crtc_init_with_planes(&jdev->base, &va->crtc, -+ &va->primary, &va->cursor, &mwv207_crtc_funcs, "crtc_%d", -+ idx); -+ if (ret) -+ return ret; -+ -+ drm_crtc_helper_add(&va->crtc, &mwv207_crtc_helper_funcs); -+ -+ lut = &va->lutdata[0]; -+ for (i = 0; i < 256; i++) -+ lut[i] = lut[i + 256] = lut[i + 512] = i; -+ drm_crtc_enable_color_mgmt(&va->crtc, 768, true, 768); -+ ret = drm_mode_crtc_set_gamma_size(&va->crtc, 256); -+ -+ -+ BUG_ON(drm_crtc_index(&va->crtc) != va->idx); -+ -+ return ret; -+} -+ -+int mwv207_va_init(struct mwv207_device *jdev) -+{ -+ int i, nr, ret; -+ -+ nr = jdev->lite ? 2 : 4; -+ for (i = 0; i < nr; i++) { -+ ret = mwv207_va_init_single(jdev, i); -+ if (ret) -+ return ret; -+ } -+ -+ return 0; -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_va.h b/drivers/gpu/drm/mwv207/dc/mwv207_va.h -new file mode 100644 -index 000000000..ffc3540f7 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_va.h -@@ -0,0 +1,29 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#ifndef MWV207_VA_H_BSY8LF4F -+#define MWV207_VA_H_BSY8LF4F -+ -+struct drm_crtc; -+/* Note: any resources allocated should be: -+ * 1. devres managed or -+ * 2. cleaned up by drm_mode_config_cleanup -+ */ -+int mwv207_va_init(struct mwv207_device *jdev); -+ -+void mwv207_crtc_prepare_vblank(struct drm_crtc *crtc); -+irqreturn_t mwv207_va_handle_vblank(int irq, void *data); -+#endif -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_vga.c b/drivers/gpu/drm/mwv207/dc/mwv207_vga.c -new file mode 100644 -index 000000000..dc2e15213 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_vga.c -@@ -0,0 +1,289 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_vi.h" -+ -+#define MWV207_DAC_HPD_VS_CLC(_chan) (0x64 + (_chan) * 0x14) -+#define MWV207_DAC_HPD_PULSE_H(_chan) (0x68 + (_chan) * 0x14) -+#define MWV207_DAC_HPD_PULSE_L(_chan) (0x6C + (_chan) * 0x14) -+#define MWV207_DAC_HPD_DET_PER(_chan) (0x70 + (_chan) * 0x14) -+#define MWV207_DAC_HPD_DET_THR(_chan) (0x74 + (_chan) * 0x14) -+ -+#define output_to_vga(output) container_of(output, struct mwv207_vga, base) -+ -+static uint mwv207_vga_load_detect = 1; -+module_param(mwv207_vga_load_detect, uint, 0444); -+MODULE_PARM_DESC(mwv207_vga_load_detect, "Enable vga load detect if set to 1, default is 1"); -+ -+struct mwv207_vga { -+ struct mwv207_output base; -+ spinlock_t load_detect_lock; -+ bool active; -+}; -+ -+static void mwv207_vga_set_detect_mode(struct mwv207_output *output, bool active) -+{ -+ u32 val, status, load_mode; -+ int i; -+ -+ mwv207_output_write(output, 0xA4, 0); -+ -+ val = 0x3ff * 7 / 10; -+ status = mwv207_output_read(output, 0xA8); -+ mwv207_output_write(output, 0xA8, status); -+ -+ status = val << 20 | val << 10 | val; -+ mwv207_output_write(output, 0xAC, status); -+ -+ load_mode = active ? 1 : 0; -+ status = load_mode << 20 | load_mode << 16 | load_mode << 12 | 0x1 << 8 | 0x1 << 4 | 0x1; -+ mwv207_output_write(output, 0xAC, status); -+ -+ for (i = 0; i < 3; i++) { -+ if (active) { -+ mwv207_output_write(output, MWV207_DAC_HPD_VS_CLC(i), 256); -+ mwv207_output_write(output, MWV207_DAC_HPD_PULSE_H(i), 48); -+ mwv207_output_write(output, MWV207_DAC_HPD_DET_PER(i), 188); -+ mwv207_output_write(output, MWV207_DAC_HPD_DET_THR(i), 164); -+ } else { -+ mwv207_output_write(output, MWV207_DAC_HPD_PULSE_H(i), 1600000); -+ mwv207_output_write(output, MWV207_DAC_HPD_PULSE_L(i), 798400000); -+ mwv207_output_write(output, MWV207_DAC_HPD_DET_PER(i), 1600128); -+ mwv207_output_write(output, MWV207_DAC_HPD_DET_THR(i), 8128); -+ } -+ } -+ -+ mwv207_output_write(output, 0xA4, 0x111111); -+} -+ -+static void mwv207_vga_switch(struct mwv207_output *output, bool on) -+{ -+ struct mwv207_vga *vga = output_to_vga(output); -+ -+ if (!output->jdev->lite || !mwv207_vga_load_detect) { -+ mwv207_output_modify(output, 0x0, 1 << 31, (on ? 1 : 0) << 31); -+ return; -+ } -+ -+ spin_lock(&vga->load_detect_lock); -+ mwv207_output_modify(output, 0x0, 1 << 31, (on ? 1 : 0) << 31); -+ mwv207_vga_set_detect_mode(output, on); -+ vga->active = on; -+ spin_unlock(&vga->load_detect_lock); -+} -+ -+static void mwv207_vga_config(struct mwv207_output *output) -+{ -+ struct drm_display_mode *mode = &output->cur_crtc->state->adjusted_mode; -+ int hpol, vpol; -+ -+ hpol = (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : 1; -+ vpol = (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : 1; -+ -+ mwv207_output_write(output, 0x4C, 0); -+ mwv207_output_modify(output, 0x0, 0x7 << 16, 0x7 << 16); -+ mwv207_output_modify(output, 0x0, 0x1 << 2, hpol << 2); -+ mwv207_output_modify(output, 0x0, 0x1 << 3, vpol << 3); -+ -+ mwv207_output_write(output, 0x4, 0x1666); -+ mwv207_output_write(output, 0x18, 0x1666); -+ mwv207_output_write(output, 0x2C, 0x1666); -+} -+ -+static void mwv207_vga_select_crtc(struct mwv207_output *output) -+{ -+ -+ mwv207_output_modify(output, 0x0, 0x3 << 24, -+ drm_crtc_index(output->cur_crtc) << 24); -+ -+ jdev_modify(output->jdev, 0x9b0038, 0xf << 16, -+ drm_crtc_index(output->cur_crtc) << 16); -+} -+static enum drm_mode_status mwv207_vga_mode_valid(struct mwv207_output *output, -+ const struct drm_display_mode *mode) -+{ -+ -+ if (mode->clock > 193250) -+ return MODE_CLOCK_HIGH; -+ -+ return MODE_OK; -+} -+ -+static enum drm_mode_status mwv207_vga_connector_mode_valid(struct drm_connector *connector, -+ struct drm_display_mode *mode) -+{ -+ return mwv207_vga_mode_valid(connector_to_output(connector), mode); -+} -+ -+static int mwv207_vga_detect_load(struct mwv207_output *output) -+{ -+ struct mwv207_vga *vga = output_to_vga(output); -+ u32 r_state, g_state, b_state, value; -+ bool active; -+ -+ -+ if (mwv207_i2c_probe(output->ddc)) -+ return connector_status_connected; -+ -+ spin_lock(&vga->load_detect_lock); -+ value = mwv207_output_read(output, 0xA8); -+ active = vga->active; -+ spin_unlock(&vga->load_detect_lock); -+ -+ r_state = (value >> 8) & 0x1; -+ g_state = (value >> 4) & 0x1; -+ b_state = (value >> 0) & 0x1; -+ DRM_DEBUG_DRIVER("active %d r_state = 0x%x, g_state = 0x%x, b_state = 0x%x", -+ active, r_state, g_state, b_state); -+ -+ if (active) -+ return (r_state && g_state && b_state) ? -+ connector_status_disconnected : connector_status_connected; -+ -+ return (r_state || g_state || b_state) ? -+ connector_status_connected : connector_status_disconnected; -+} -+ -+static int mwv207_vga_detect_ctx(struct drm_connector *connector, -+ struct drm_modeset_acquire_ctx *ctx, -+ bool force) -+{ -+ struct mwv207_output *output = connector_to_output(connector); -+ -+ if (!output->jdev->lite || !mwv207_vga_load_detect) -+ return mwv207_i2c_probe(output->ddc) ? -+ connector_status_connected : connector_status_disconnected; -+ -+ -+ return mwv207_vga_detect_load(output); -+} -+ -+static void mwv207_vga_destroy(struct drm_connector *conn) -+{ -+ drm_connector_unregister(conn); -+ drm_connector_cleanup(conn); -+} -+ -+static const struct drm_connector_helper_funcs mwv207_vga_connector_helper_funcs = { -+ .get_modes = mwv207_output_get_modes, -+ .mode_valid = mwv207_vga_connector_mode_valid, -+ .detect_ctx = mwv207_vga_detect_ctx -+}; -+ -+static const struct drm_connector_funcs mwv207_vga_connector_funcs = { -+ .reset = drm_atomic_helper_connector_reset, -+ .fill_modes = drm_helper_probe_single_connector_modes, -+ .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, -+ .destroy = mwv207_vga_destroy, -+ .late_register = mwv207_output_late_register, -+ .early_unregister = mwv207_output_early_unregister, -+}; -+ -+static enum drm_mode_status mwv207_vga_encoder_mode_valid(struct drm_encoder *encoder, -+ const struct drm_display_mode *mode) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ return mwv207_vga_mode_valid(output, mode); -+} -+ -+static int mwv207_vga_encoder_atomic_check(struct drm_encoder *encoder, -+ struct drm_crtc_state *crtc_state, -+ struct drm_connector_state *conn_state) -+{ -+ return 0; -+} -+ -+static void mwv207_vga_encoder_enable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_vga_select_crtc(output); -+ -+ mwv207_vga_config(output); -+ -+ mwv207_vga_switch(output, true); -+} -+ -+static void mwv207_vga_encoder_disable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_vga_switch(output, false); -+} -+ -+static void mwv207_vga_encoder_reset(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ if (output->jdev->lite && !mwv207_vga_load_detect) { -+ mwv207_output_write(output, 0xA4, 0); -+ mwv207_output_modify(output, 0x58, 0x1 << 16, 0); -+ } -+ -+ mwv207_vga_encoder_disable(encoder); -+} -+ -+static const struct drm_encoder_funcs mwv207_vga_encoder_funcs = { -+ .destroy = drm_encoder_cleanup, -+ .reset = mwv207_vga_encoder_reset, -+}; -+ -+static const struct drm_encoder_helper_funcs mwv207_vga_encoder_helper_funcs = { -+ .mode_valid = mwv207_vga_encoder_mode_valid, -+ .atomic_check = mwv207_vga_encoder_atomic_check, -+ .enable = mwv207_vga_encoder_enable, -+ .disable = mwv207_vga_encoder_disable, -+}; -+ -+int mwv207_vga_init(struct mwv207_device *jdev) -+{ -+ struct mwv207_output *output; -+ struct mwv207_vga *vga; -+ int ret; -+ -+ vga = devm_kzalloc(jdev->dev, sizeof(*vga), GFP_KERNEL); -+ if (!vga) -+ return -ENOMEM; -+ -+ spin_lock_init(&vga->load_detect_lock); -+ output = &vga->base; -+ output->jdev = jdev; -+ output->idx = 0; -+ output->mmio = jdev->mmio + 0x9a0000; -+ output->i2c_chan = 4; -+ -+ output->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; -+ ret = drm_connector_init(&jdev->base, &output->connector, -+ &mwv207_vga_connector_funcs, DRM_MODE_CONNECTOR_VGA); -+ if (ret) -+ return ret; -+ drm_connector_helper_add(&output->connector, &mwv207_vga_connector_helper_funcs); -+ -+ output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; -+ ret = drm_encoder_init(&jdev->base, &output->encoder, -+ &mwv207_vga_encoder_funcs, DRM_MODE_ENCODER_DAC, -+ "vga-%d", output->idx); -+ if (ret) -+ return ret; -+ drm_encoder_helper_add(&output->encoder, &mwv207_vga_encoder_helper_funcs); -+ -+ ret = drm_connector_attach_encoder(&output->connector, &output->encoder); -+ if (ret) -+ return ret; -+ -+ return drm_connector_register(&output->connector); -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_vi.c b/drivers/gpu/drm/mwv207/dc/mwv207_vi.c -new file mode 100644 -index 000000000..92346d85e ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_vi.c -@@ -0,0 +1,89 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_vi.h" -+ -+/* userspace interfaces should be registered here, e.g i2c/backlight etc */ -+int mwv207_output_late_register(struct drm_connector *connector) -+{ -+ struct mwv207_output *output = connector_to_output(connector); -+ -+ output->ddc = mwv207_i2c_create(output->jdev, output->i2c_chan); -+ if (!output->ddc) { -+ DRM_ERROR("Failed to create i2c adapter\n"); -+ return -ENODEV; -+ } -+ -+ return 0; -+} -+ -+void mwv207_output_early_unregister(struct drm_connector *connector) -+{ -+ struct mwv207_output *output = connector_to_output(connector); -+ -+ mwv207_i2c_destroy(output->ddc); -+} -+ -+ -+int mwv207_output_get_modes(struct drm_connector *connector) -+{ -+ struct mwv207_output *output = connector_to_output(connector); -+ struct edid *edid; -+ int count; -+ -+ if (output->edidforce && output->edid) -+ edid = output->edid; -+ else -+ edid = drm_get_edid(connector, output->ddc); -+ -+ -+ output->has_audio = drm_detect_monitor_audio(edid); -+ drm_connector_update_edid_property(connector, edid); -+ count = drm_add_edid_modes(connector, edid); -+ -+ if (!(output->edidforce && output->edid)) -+ kfree(edid); -+ -+ return count; -+} -+ -+void mwv207_output_set_crtc(struct drm_encoder *encoder, struct drm_crtc *crtc) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ output->cur_crtc = crtc; -+} -+ -+int mwv207_vi_init(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ mutex_init(&jdev->gpio_lock); -+ -+ ret = mwv207_edp_init(jdev); -+ if (ret) -+ return ret; -+ ret = mwv207_hdmi_init(jdev); -+ if (ret) -+ return ret; -+ ret = mwv207_vga_init(jdev); -+ if (ret) -+ return ret; -+ ret = mwv207_dvo_init(jdev); -+ if (ret) -+ return ret; -+ -+ return 0; -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_vi.h b/drivers/gpu/drm/mwv207/dc/mwv207_vi.h -new file mode 100644 -index 000000000..95f78ded0 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_vi.h -@@ -0,0 +1,101 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207.h" -+#include -+#include -+#include -+#include -+#include -+ -+#ifndef MWV207_DAL_H_OUVHEJAX -+#define MWV207_DAL_H_OUVHEJAX -+ -+ -+ -+struct i2c_adapter; -+ -+ -+struct mwv207_output { -+ struct drm_connector connector; -+ struct drm_encoder encoder; -+ -+ -+ struct drm_crtc *cur_crtc; -+ -+ /* mapped to video interface global control regs -+ * which are shared among all outputs -+ */ -+ void __iomem *mmio; -+ struct mwv207_device *jdev; -+ -+ struct i2c_adapter *ddc; -+ struct edid *edid; -+ bool edidforce; -+ int i2c_chan; -+ -+ /* local index, e.g. hdmi0/1/2/3, edp0/1 */ -+ int idx; -+ -+ bool has_audio; -+}; -+#define connector_to_output(conn) container_of(conn, struct mwv207_output, connector) -+#define encoder_to_output(encoder) container_of(encoder, struct mwv207_output, encoder) -+ -+/* Note: any resources allocated by following funcs should be: -+ * 1. devres managed or -+ * 2. cleaned up by drm_mode_config_cleanup -+ */ -+int mwv207_vi_init(struct mwv207_device *jdev); -+int mwv207_edp_init(struct mwv207_device *jdev); -+int mwv207_hdmi_init(struct mwv207_device *jdev); -+int mwv207_vga_init(struct mwv207_device *jdev); -+int mwv207_dvo_init(struct mwv207_device *jdev); -+ -+struct i2c_adapter *mwv207_i2c_create(struct mwv207_device *jdev, int i2c_chan); -+void mwv207_i2c_destroy(struct i2c_adapter *adapter); -+bool mwv207_i2c_probe(struct i2c_adapter *i2c_bus); -+ -+int mwv207_output_late_register(struct drm_connector *connector); -+void mwv207_output_early_unregister(struct drm_connector *connector); -+ -+ -+int mwv207_output_get_modes(struct drm_connector *connector); -+void mwv207_output_set_crtc(struct drm_encoder *encoder, struct drm_crtc *crtc); -+ -+static inline u32 mwv207_output_read(struct mwv207_output *output, u32 reg) -+{ -+ BUG_ON(reg >= 0x8000); -+ return readl(output->mmio + reg); -+} -+ -+static inline void mwv207_output_write(struct mwv207_output *output, u32 reg, u32 value) -+{ -+ BUG_ON(reg >= 0x8000); -+ writel_relaxed(value, output->mmio + reg); -+} -+ -+static inline void mwv207_output_modify(struct mwv207_output *output, u32 reg, -+ u32 mask, u32 value) -+{ -+ u32 rvalue; -+ -+ BUG_ON(reg >= 0x8000); -+ rvalue = mwv207_output_read(output, reg); -+ rvalue = (rvalue & ~mask) | (value & mask); -+ mwv207_output_write(output, reg, rvalue); -+} -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207.h b/drivers/gpu/drm/mwv207/mwv207.h -new file mode 100644 -index 000000000..84419cc49 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207.h -@@ -0,0 +1,127 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_H_VTIQLF2Y -+#define MWV207_H_VTIQLF2Y -+ -+#include -+#include -+#include -+#include -+#include -+ -+struct mwv207_db; -+ -+struct mwv207_vbios { -+ -+ struct mutex vcmd_lock; -+ -+ -+ struct mutex cfg_lock; -+ struct idr cfg_table; -+ -+ int indexer_valid; -+ int sector_count; -+}; -+ -+#define ddev_to_jdev(ddev) ((struct mwv207_device *) (ddev)->dev_private) -+#define bdev_to_jdev(dev) container_of(dev, struct mwv207_device, bdev) -+struct mwv207_device { -+ struct drm_device base; -+ struct ttm_bo_device bdev; -+ -+ void __iomem *mmio; -+ void __iomem *iatu; -+ -+ void *win; -+ -+ -+ spinlock_t win_lock; -+ u64 visible_vram_size; -+ u64 vram_size; -+ u64 vram_bar_base; -+ u64 vram_last_win; -+ u64 pci_win_base; -+ -+ struct device *dev; -+ struct drm_fb_helper *fb_helper; -+ -+ struct drm_gpu_scheduler *sched[6]; -+ -+ struct drm_gpu_scheduler **sched_3d; -+ struct drm_gpu_scheduler **sched_dec; -+ struct drm_gpu_scheduler **sched_enc; -+ struct drm_gpu_scheduler **sched_2d; -+ struct drm_gpu_scheduler **sched_dma; -+ int nr_3d; -+ int nr_2d; -+ int nr_dec; -+ int nr_enc; -+ int nr_dma; -+ -+ -+ struct drm_sched_entity *dma_entity; -+ -+ -+ spinlock_t irq_lock; -+ struct irq_domain *irq_domain; -+ u32 irq_enable_reg[2]; -+ int va_irq; -+ -+ /* key/value database */ -+ struct mwv207_db *db; -+ -+ struct mwv207_vbios vbios; -+ -+ struct mutex gpio_lock; -+ -+ bool lite; -+}; -+ -+struct mwv207_ctx_mgr { -+ struct mutex lock; -+ struct idr handle_table; -+}; -+ -+struct mwv207_fpriv { -+ struct mwv207_ctx_mgr ctx_mgr; -+}; -+ -+int mwv207_test(struct mwv207_device *jdev); -+void jdev_write_vram(struct mwv207_device *jdev, u64 vram_addr, void *buf, int size); -+ -+static inline void jdev_write(struct mwv207_device *jdev, u32 reg, u32 value) -+{ -+ BUG_ON(reg <= 0x100000); -+ writel_relaxed(value, jdev->mmio + reg); -+} -+ -+static inline u32 jdev_read(struct mwv207_device *jdev, u32 reg) -+{ -+ return readl(jdev->mmio + reg); -+} -+ -+static inline void jdev_modify(struct mwv207_device *jdev, u32 reg, u32 mask, u32 value) -+{ -+ u32 rvalue = jdev_read(jdev, reg); -+ -+ rvalue = (rvalue & ~mask) | (value & mask); -+ jdev_write(jdev, reg, rvalue); -+ BUG_ON(reg <= 0x100000); -+} -+ -+#define to_fpriv(drm_file) ((drm_file)->driver_priv) -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_bo.c b/drivers/gpu/drm/mwv207/mwv207_bo.c -new file mode 100644 -index 000000000..ef63abedc ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_bo.c -@@ -0,0 +1,299 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include "mwv207_drm.h" -+#include "mwv207_bo.h" -+ -+static void mwv207_ttm_bo_destroy(struct ttm_buffer_object *bo) -+{ -+ struct mwv207_bo *jbo = to_jbo(bo); -+ -+ WARN_ON_ONCE(jbo->map_count > 0); -+ if (bo->base.import_attach) -+ drm_prime_gem_destroy(&bo->base, NULL); -+ drm_gem_object_release(&jbo->tbo.base); -+ kfree(jbo); -+} -+ -+bool mwv207_ttm_bo_is_mwv207_bo(struct ttm_buffer_object *jbo) -+{ -+ if (jbo->destroy == &mwv207_ttm_bo_destroy) -+ return true; -+ return false; -+} -+ -+void mwv207_bo_placement_from_domain(struct mwv207_bo *jbo, u32 domain, bool pinned) -+{ -+ struct mwv207_device *jdev = bdev_to_jdev(jbo->tbo.bdev); -+ u32 c = 0; -+ u32 pflag = 0; -+ -+ if (pinned) -+ pflag |= TTM_PL_FLAG_NO_EVICT; -+ -+ jbo->placement.placement = jbo->placements; -+ jbo->placement.busy_placement = jbo->placements; -+ -+ if (domain & 0x2) { -+ jbo->placements[c].fpfn = 0; -+ -+ if (jbo->flags & (1<<2)) -+ jbo->placements[c].lpfn = 0x100000000ul >> PAGE_SHIFT; -+ else -+ jbo->placements[c].lpfn = 0; -+ -+ if (jbo->flags & (1<<0)) -+ jbo->placements[c].lpfn = jdev->visible_vram_size >> PAGE_SHIFT; -+ else -+ pflag |= TTM_PL_FLAG_TOPDOWN; -+ -+ jbo->placements[c].mem_type = TTM_PL_VRAM; -+ jbo->placements[c].flags = TTM_PL_FLAG_UNCACHED | TTM_PL_FLAG_WC | pflag; -+#ifdef MWV207_DEBUG_BO_MIGRATION -+ if (!pinned) { -+ if (jbo->placements[c].lpfn == 0 -+ || jbo->placements[c].lpfn >= jdev->vram_size >> PAGE_SHIFT) -+ jbo->placements[c].lpfn = jdev->vram_size >> PAGE_SHIFT; -+ if (jbo->toggle & 0x1) -+ jbo->placements[c].fpfn = jbo->placements[c].lpfn / 2; -+ else -+ jbo->placements[c].lpfn = jbo->placements[c].lpfn / 2; -+ jbo->toggle ^= 0x1; -+ } -+#endif -+ c++; -+ } -+ if (domain & 0x4) { -+ jbo->placements[c].fpfn = 0; -+ jbo->placements[c].lpfn = 0; -+ jbo->placements[c].flags = TTM_PL_MASK_CACHING | pflag; -+ jbo->placements[c].mem_type = TTM_PL_TT; -+ c++; -+ } -+ if (domain & 0x1) { -+ jbo->placements[c].fpfn = 0; -+ jbo->placements[c].lpfn = 0; -+ jbo->placements[c].flags = TTM_PL_MASK_CACHING | pflag; -+ jbo->placements[c].mem_type = TTM_PL_SYSTEM; -+ c++; -+ } -+ if (!c) { -+ jbo->placements[c].fpfn = 0; -+ jbo->placements[c].lpfn = 0; -+ jbo->placements[c].flags = TTM_PL_MASK_CACHING; -+ jbo->placements[c].mem_type = TTM_PL_SYSTEM; -+ c++; -+ } -+ -+ BUG_ON(c > 3); -+ jbo->placement.num_placement = c; -+ jbo->placement.num_busy_placement = c; -+} -+ -+int mwv207_bo_create(struct mwv207_device *jdev, -+ u64 size, u64 align, enum ttm_bo_type type, -+ u32 domain, u32 flags, -+ struct mwv207_bo **pbo) -+{ -+ struct mwv207_bo *jbo; -+ unsigned long acc_size; -+ int ret; -+ -+ *pbo = NULL; -+ if ((flags & (1<<2)) && !(domain & 0x2)) -+ return -EINVAL; -+ -+ jbo = kzalloc(sizeof(struct mwv207_bo), GFP_KERNEL); -+ if (jbo == NULL) -+ return -ENOMEM; -+ size = roundup(size, PAGE_SIZE); -+ ret = drm_gem_object_init(&jdev->base, &jbo->tbo.base, size); -+ if (unlikely(ret)) { -+ kfree(jbo); -+ return ret; -+ } -+ jbo->flags = flags; -+ jbo->domain = domain; -+ jbo->pin_count = 0; -+ -+ acc_size = ttm_bo_dma_acc_size(&jdev->bdev, size, sizeof(*jbo)); -+ -+ jbo->tbo.bdev = &jdev->bdev; -+ mwv207_bo_placement_from_domain(jbo, domain, false); -+ -+ ret = ttm_bo_init(&jdev->bdev, &jbo->tbo, size, type, -+ &jbo->placement, align >> PAGE_SHIFT, -+ type != ttm_bo_type_kernel, acc_size, -+ NULL, NULL, &mwv207_ttm_bo_destroy); -+ -+ if (unlikely(ret)) -+ return ret; -+ *pbo = jbo; -+ return 0; -+} -+ -+int mwv207_bo_reserve(struct mwv207_bo *jbo, bool no_intr) -+{ -+ int ret; -+ -+ ret = ttm_bo_reserve(&jbo->tbo, !no_intr, false, NULL); -+ if (unlikely(ret)) { -+ if (ret != -ERESTARTSYS) -+ DRM_ERROR("bo reserve failed\n"); -+ return ret; -+ } -+ return 0; -+} -+ -+void mwv207_bo_unreserve(struct mwv207_bo *jbo) -+{ -+ ttm_bo_unreserve(&jbo->tbo); -+} -+ -+int mwv207_bo_kmap_reserved(struct mwv207_bo *jbo, void **ptr) -+{ -+ bool is_iomem; -+ int ret; -+ -+ if (!jbo->flags & (1<<0)) -+ return -EPERM; -+ -+ if (jbo->kptr) { -+ if (ptr) -+ *ptr = jbo->kptr; -+ jbo->map_count++; -+ return 0; -+ } -+ ret = ttm_bo_kmap(&jbo->tbo, 0, jbo->tbo.num_pages, &jbo->kmap); -+ if (ret) -+ return ret; -+ jbo->kptr = ttm_kmap_obj_virtual(&jbo->kmap, &is_iomem); -+ if (ptr) -+ *ptr = jbo->kptr; -+ jbo->map_count = 1; -+ return 0; -+} -+ -+void mwv207_bo_kunmap_reserved(struct mwv207_bo *jbo) -+{ -+ if (WARN_ON_ONCE(jbo->kptr == NULL)) -+ return; -+ jbo->map_count--; -+ if (jbo->map_count > 0) -+ return; -+ jbo->kptr = NULL; -+ ttm_bo_kunmap(&jbo->kmap); -+} -+ -+void mwv207_bo_unref(struct mwv207_bo *jbo) -+{ -+ if (jbo == NULL) -+ return; -+ -+ ttm_bo_put(&jbo->tbo); -+} -+ -+struct mwv207_bo *mwv207_bo_ref(struct mwv207_bo *jbo) -+{ -+ if (jbo == NULL) -+ return NULL; -+ -+ ttm_bo_get(&jbo->tbo); -+ return jbo; -+} -+ -+int mwv207_bo_pin_reserved(struct mwv207_bo *jbo, u32 domain) -+{ -+ struct ttm_operation_ctx ctx = {false, false}; -+ int ret; -+ -+ if (jbo->pin_count) { -+ jbo->pin_count++; -+ return 0; -+ } -+ -+ jbo->flags |= (1<<2); -+ mwv207_bo_placement_from_domain(jbo, domain, true); -+ ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); -+ if (ret) -+ return ret; -+ -+ jbo->pin_count = 1; -+ -+ return 0; -+} -+ -+int mwv207_bo_unpin_reserved(struct mwv207_bo *jbo) -+{ -+ struct ttm_operation_ctx ctx = {false, false}; -+ int ret, i; -+ -+ if (WARN_ON_ONCE(!jbo->pin_count)) -+ return 0; -+ -+ jbo->pin_count--; -+ if (jbo->pin_count) -+ return 0; -+ -+ for (i = 0; i < jbo->placement.num_placement; i++) -+ jbo->placements[i].flags &= ~TTM_PL_FLAG_NO_EVICT; -+ -+ ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); -+ if (unlikely(ret)) -+ DRM_ERROR("validate failed for unpin"); -+ -+ return ret; -+} -+ -+int mwv207_bo_pin(struct mwv207_bo *jbo, u32 domain) -+{ -+ int ret; -+ -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) -+ return ret; -+ ret = mwv207_bo_pin_reserved(jbo, domain); -+ mwv207_bo_unreserve(jbo); -+ return ret; -+} -+ -+int mwv207_bo_unpin(struct mwv207_bo *jbo) -+{ -+ int ret; -+ -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) -+ return ret; -+ ret = mwv207_bo_unpin_reserved(jbo); -+ mwv207_bo_unreserve(jbo); -+ return ret; -+} -+ -+int mwv207_bo_wait(struct mwv207_bo *jbo, bool no_wait) -+{ -+ int ret; -+ -+ ret = ttm_bo_reserve(&jbo->tbo, true, no_wait, NULL); -+ if (unlikely(ret)) { -+ if (ret != -ERESTARTSYS && ret != -EBUSY) -+ DRM_ERROR("bo reserve failed for wait\n"); -+ return ret; -+ } -+ ret = ttm_bo_wait(&jbo->tbo, true, no_wait); -+ ttm_bo_unreserve(&jbo->tbo); -+ return ret; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_bo.h b/drivers/gpu/drm/mwv207/mwv207_bo.h -new file mode 100644 -index 000000000..ab10994d1 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_bo.h -@@ -0,0 +1,111 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_BO_H_T4ETFCB2 -+#define MWV207_BO_H_T4ETFCB2 -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_drm.h" -+ -+#undef MWV207_DEBUG_BO_MIGRATION -+ -+#define to_jbo(bo) container_of(bo, struct mwv207_bo, tbo) -+struct mwv207_bo { -+ struct ttm_buffer_object tbo; -+ struct ttm_placement placement; -+ struct ttm_bo_kmap_obj kmap; -+ struct ttm_place placements[3]; -+ u32 domain; -+ u32 flags; -+ int pin_count; -+ int map_count; -+ void *kptr; -+#ifdef MWV207_DEBUG_BO_MIGRATION -+ int toggle; -+#endif -+}; -+ -+struct mwv207_ttm_tt { -+ struct ttm_dma_tt ttm; -+ struct mwv207_device *jdev; -+}; -+#define to_gtt(ttm_tt) container_of(ttm_tt, struct mwv207_ttm_tt, ttm.ttm) -+ -+static inline struct mwv207_bo *mwv207_bo_from_gem(struct drm_gem_object *gobj) -+{ -+ struct ttm_buffer_object *tbo = container_of(gobj, struct ttm_buffer_object, base); -+ -+ return container_of(tbo, struct mwv207_bo, tbo); -+} -+ -+static inline struct drm_gem_object *mwv207_gem_from_bo(struct mwv207_bo *jbo) -+{ -+ return &jbo->tbo.base; -+} -+ -+static inline u64 mwv207_bo_size(struct mwv207_bo *jbo) -+{ -+ return jbo->tbo.num_pages << PAGE_SHIFT; -+} -+ -+static inline u64 mwv207_bo_mmap_offset(struct drm_gem_object *gobj) -+{ -+ struct mwv207_bo *jbo = mwv207_bo_from_gem(gobj); -+ -+ return drm_vma_node_offset_addr(&jbo->tbo.base.vma_node); -+} -+ -+static inline u64 mwv207_bo_gpu_phys(struct mwv207_bo *jbo) -+{ -+ return jbo->tbo.mem.start << PAGE_SHIFT; -+} -+ -+void mwv207_bo_placement_from_domain(struct mwv207_bo *jbo, u32 domain, bool pinned); -+ -+bool mwv207_ttm_bo_is_mwv207_bo(struct ttm_buffer_object *tbo); -+void mwv207_bo_placement(struct mwv207_bo *jbo, int domain); -+ -+int mwv207_bo_create(struct mwv207_device *jdev, -+ u64 size, u64 align, enum ttm_bo_type type, -+ u32 domain, u32 flags, -+ struct mwv207_bo **pbo); -+ -+int mwv207_bo_reserve(struct mwv207_bo *jbo, bool no_intr); -+void mwv207_bo_unreserve(struct mwv207_bo *jbo); -+ -+int mwv207_bo_pin_reserved(struct mwv207_bo *jbo, u32 domain); -+int mwv207_bo_unpin_reserved(struct mwv207_bo *jbo); -+ -+int mwv207_bo_pin(struct mwv207_bo *jbo, u32 domain); -+int mwv207_bo_unpin(struct mwv207_bo *jbo); -+ -+int mwv207_bo_kmap_reserved(struct mwv207_bo *jbo, void **ptr); -+void mwv207_bo_kunmap_reserved(struct mwv207_bo *jbo); -+ -+struct mwv207_bo *mwv207_bo_ref(struct mwv207_bo *jbo); -+void mwv207_bo_unref(struct mwv207_bo *jbo); -+ -+int mwv207_ttm_init(struct mwv207_device *jdev); -+void mwv207_ttm_fini(struct mwv207_device *jdev); -+ -+int mwv207_bo_wait(struct mwv207_bo *jbo, bool no_wait); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_ctx.c b/drivers/gpu/drm/mwv207/mwv207_ctx.c -new file mode 100644 -index 000000000..595d6a943 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_ctx.c -@@ -0,0 +1,242 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_drm.h" -+#include "mwv207_ctx.h" -+ -+#define MAX(a, b) ((a) > (b) ? (a) : (b)) -+struct mwv207_ctx *mwv207_ctx_lookup(struct drm_device *dev, -+ struct drm_file *filp, u32 handle) -+{ -+ struct mwv207_fpriv *fpriv = to_fpriv(filp); -+ struct mwv207_ctx_mgr *mgr = &fpriv->ctx_mgr; -+ struct mwv207_ctx *ctx; -+ -+ mutex_lock(&mgr->lock); -+ ctx = idr_find(&mgr->handle_table, handle); -+ if (ctx) -+ kref_get(&ctx->refcnt); -+ mutex_unlock(&mgr->lock); -+ -+ return ctx; -+} -+ -+static void mwv207_ctx_entity_fini(struct mwv207_ctx *ctx) -+{ -+ int i; -+ -+ for (i = 0; i < 11; i++) { -+ if (ctx->entities[i]) { -+ drm_sched_entity_destroy(ctx->entities[i]); -+ kfree(ctx->entities[i]); -+ ctx->entities[i] = NULL; -+ } -+ } -+} -+ -+ -+static int mwv207_ctx_entity_init_single(struct mwv207_ctx *ctx, -+ struct drm_gpu_scheduler **sched, -+ struct drm_sched_entity **entities, int nr) -+{ -+ struct drm_gpu_scheduler *scheds[6]; -+ struct drm_sched_entity *entity; -+ int i, ret; -+ -+ -+ for (i = 0; i < nr; i++) { -+ scheds[i] = sched[i]; -+ entity = kmalloc(sizeof(struct drm_sched_entity), GFP_KERNEL); -+ if (!entity) -+ return -ENOMEM; -+ ret = drm_sched_entity_init(entity, DRM_SCHED_PRIORITY_NORMAL, &scheds[i], 1, &ctx->guilty); -+ if (ret) { -+ kfree(entity); -+ return ret; -+ } -+ entities[i] = entity; -+ } -+ if (i) { -+ -+ entity = kmalloc(sizeof(struct drm_sched_entity), GFP_KERNEL); -+ if (!entity) -+ return -ENOMEM; -+ ret = drm_sched_entity_init(entity, DRM_SCHED_PRIORITY_NORMAL, &scheds[0], 1, &ctx->guilty); -+ if (ret) { -+ kfree(entity); -+ return ret; -+ } -+ entities[i] = entity; -+ } -+ -+ return 0; -+} -+ -+static int mwv207_ctx_entity_init(struct drm_device *dev, struct mwv207_ctx *ctx) -+{ -+ struct mwv207_device *jdev = ddev_to_jdev(dev); -+ int ret; -+ -+ -+ ctx->entity_3d = &ctx->entities[0]; -+ ctx->entity_dec = &ctx->entity_3d[2 + 1]; -+ ctx->entity_enc = &ctx->entity_dec[1 + 1]; -+ ctx->entity_2d = &ctx->entity_enc[1 + 1]; -+ ctx->entity_dma = &ctx->entity_2d[1 + 1]; -+ BUG_ON(ctx->entity_dma[1] != ctx->entities[11 - 1]); -+ -+ ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_3d, ctx->entity_3d, jdev->nr_3d); -+ if (ret) -+ goto fini; -+ ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_dec, ctx->entity_dec, jdev->nr_dec); -+ if (ret) -+ goto fini; -+ ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_enc, ctx->entity_enc, jdev->nr_enc); -+ if (ret) -+ goto fini; -+ ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_2d, ctx->entity_2d, jdev->nr_2d); -+ if (ret) -+ goto fini; -+ ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_dma, ctx->entity_dma, jdev->nr_dma); -+ if (ret) -+ goto fini; -+ return 0; -+fini: -+ mwv207_ctx_entity_fini(ctx); -+ return ret; -+} -+ -+static int mwv207_ctx_create(struct drm_device *dev, struct mwv207_ctx_mgr *mgr, -+ u32 flags, u32 *handle) -+{ -+ struct mwv207_ctx *ctx; -+ int ret; -+ -+ ctx = kzalloc(sizeof(struct mwv207_ctx), GFP_KERNEL); -+ if (ctx == NULL) -+ return -ENOMEM; -+ -+ ctx->jdev = ddev_to_jdev(dev); -+ kref_init(&ctx->refcnt); -+ -+ ret = mwv207_ctx_entity_init(dev, ctx); -+ if (ret) -+ goto out_free; -+ -+ mutex_lock(&mgr->lock); -+ ret = idr_alloc(&mgr->handle_table, ctx, 1, 0, GFP_KERNEL); -+ mutex_unlock(&mgr->lock); -+ -+ if (ret < 0) -+ goto out_fini_entites; -+ -+ *handle = ret; -+ return 0; -+out_fini_entites: -+ mwv207_ctx_entity_fini(ctx); -+out_free: -+ kfree(ctx); -+ return ret; -+} -+ -+static void mwv207_ctx_release(struct kref *kref) -+{ -+ struct mwv207_ctx *ctx = container_of(kref, struct mwv207_ctx, refcnt); -+ -+ mwv207_ctx_entity_fini(ctx); -+ kfree(ctx); -+} -+ -+int mwv207_ctx_put(struct mwv207_ctx *ctx) -+{ -+ return kref_put(&ctx->refcnt, mwv207_ctx_release); -+} -+ -+static int mwv207_ctx_destroy(struct drm_device *dev, struct mwv207_ctx_mgr *mgr, u32 handle) -+{ -+ struct mwv207_ctx *ctx; -+ -+ mutex_lock(&mgr->lock); -+ ctx = idr_remove(&mgr->handle_table, handle); -+ mutex_unlock(&mgr->lock); -+ -+ if (ctx == NULL) -+ return -EINVAL; -+ -+ mwv207_ctx_put(ctx); -+ return 0; -+} -+ -+int mwv207_ctx_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ struct drm_mwv207_ctx *args = (struct drm_mwv207_ctx *)data; -+ struct mwv207_fpriv *fpriv = to_fpriv(filp); -+ -+ if (args->resv || args->flags) -+ return -EINVAL; -+ -+ switch (args->op) { -+ case 0: -+ return mwv207_ctx_create(dev, &fpriv->ctx_mgr, args->flags, &args->handle); -+ case 1: -+ return mwv207_ctx_destroy(dev, &fpriv->ctx_mgr, args->handle); -+ default: -+ return -EINVAL; -+ } -+} -+ -+int mwv207_ctx_mgr_init(struct drm_device *dev, struct mwv207_ctx_mgr *mgr) -+{ -+ mutex_init(&mgr->lock); -+ idr_init(&mgr->handle_table); -+ return 0; -+} -+ -+void mwv207_ctx_mgr_fini(struct drm_device *dev, struct mwv207_ctx_mgr *mgr) -+{ -+ struct mwv207_ctx *ctx; -+ uint32_t id; -+ -+ idr_for_each_entry(&mgr->handle_table, ctx, id) -+ mwv207_ctx_put(ctx); -+ -+ idr_destroy(&mgr->handle_table); -+ mutex_destroy(&mgr->lock); -+} -+ -+int mwv207_kctx_init(struct mwv207_device *jdev) -+{ -+ struct drm_gpu_scheduler *scheds[1]; -+ int i; -+ -+ for (i = 0; i < 1; i++) -+ scheds[i] = jdev->sched_dma[i]; -+ -+ jdev->dma_entity = devm_kzalloc(jdev->dev, sizeof(struct drm_sched_entity), GFP_KERNEL); -+ if (!jdev->dma_entity) -+ return -ENOMEM; -+ -+ return drm_sched_entity_init(jdev->dma_entity, DRM_SCHED_PRIORITY_NORMAL, &scheds[0], i, NULL); -+} -+ -+void mwv207_kctx_fini(struct mwv207_device *jdev) -+{ -+ drm_sched_entity_destroy(jdev->dma_entity); -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_ctx.h b/drivers/gpu/drm/mwv207/mwv207_ctx.h -new file mode 100644 -index 000000000..67c02d439 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_ctx.h -@@ -0,0 +1,51 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_CTX_H_QFMRESBO -+#define MWV207_CTX_H_QFMRESBO -+#include -+#include -+#include "mwv207.h" -+ -+struct mwv207_ctx { -+ struct kref refcnt; -+ -+ struct drm_sched_entity *entities[11]; -+ -+ -+ struct drm_sched_entity **entity_3d; -+ struct drm_sched_entity **entity_dec; -+ struct drm_sched_entity **entity_enc; -+ struct drm_sched_entity **entity_2d; -+ struct drm_sched_entity **entity_dma; -+ -+ struct mwv207_device *jdev; -+ atomic_t guilty; -+}; -+ -+struct mwv207_ctx *mwv207_ctx_lookup(struct drm_device *dev, -+ struct drm_file *filp, u32 handle); -+int mwv207_ctx_put(struct mwv207_ctx *ctx); -+ -+int mwv207_ctx_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+int mwv207_ctx_mgr_init(struct drm_device *dev, struct mwv207_ctx_mgr *mgr); -+void mwv207_ctx_mgr_fini(struct drm_device *dev, struct mwv207_ctx_mgr *mgr); -+ -+int mwv207_kctx_init(struct mwv207_device *jdev); -+void mwv207_kctx_fini(struct mwv207_device *jdev); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_db.c b/drivers/gpu/drm/mwv207/mwv207_db.c -new file mode 100644 -index 000000000..ce906afeb ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_db.c -@@ -0,0 +1,138 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include "mwv207_db.h" -+#include "mwv207.h" -+#include "mwv207_drm.h" -+ -+struct mwv207_db { -+ u32 nr; -+ u32 max_nr; -+ u32 sorted; -+ u32 pad; -+ struct drm_mwv207_info_rec *db; -+}; -+ -+int mwv207_db_init(struct mwv207_device *jdev) -+{ -+ struct mwv207_db *db; -+ u32 size; -+ -+ size = sizeof(struct mwv207_db); -+ size += 2048 * sizeof(struct drm_mwv207_info_rec); -+ db = devm_kmalloc(jdev->dev, size, GFP_KERNEL); -+ if (!db) -+ return -ENOMEM; -+ -+ db->db = (struct drm_mwv207_info_rec *)(db + 1); -+ db->max_nr = 2048; -+ db->nr = 0; -+ db->sorted = 0; -+ jdev->db = db; -+ return 0; -+} -+ -+void mwv207_db_fini(struct mwv207_device *jdev) -+{ -+ devm_kfree(jdev->dev, jdev->db); -+} -+ -+int mwv207_db_add(struct mwv207_device *jdev, u32 key, u32 val) -+{ -+ struct mwv207_db *db = jdev->db; -+ -+ if (db->nr >= db->max_nr) { -+ WARN_ONCE(1, "mwv207: maximum key count reached"); -+ return -ENOMEM; -+ } -+ -+ db->db[db->nr].key = key; -+ db->db[db->nr].val = val; -+ db->nr++; -+ -+ -+ if (db->sorted) -+ mwv207_db_sort(jdev); -+ -+ return 0; -+} -+ -+static int cmp_key(const void *a, const void *b) -+{ -+ struct drm_mwv207_info_rec const *rec_a = a, *rec_b = b; -+ -+ if (rec_a->key < rec_b->key) -+ return -1; -+ else if (rec_a->key > rec_b->key) -+ return 1; -+ else -+ return 0; -+} -+ -+void mwv207_db_sort(struct mwv207_device *jdev) -+{ -+ struct mwv207_db *db = jdev->db; -+ int i; -+ -+ db->sorted = 1; -+ if (db->nr < 2) -+ return; -+ -+ sort(db->db, db->nr, 8, cmp_key, NULL); -+ -+ -+ for (i = 0; i < db->nr - 1; ++i) { -+ if (db->db[i].key == db->db[i + 1].key) { -+ WARN_ONCE(1, "mwv207 key: %d is duplicated", db->db[i].key); -+ break; -+ } -+ } -+} -+ -+int mwv207_db_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ struct mwv207_device *jdev = dev->dev_private; -+ struct drm_mwv207_info_rec rec, *result; -+ struct drm_mwv207_info *args = data; -+ struct mwv207_db *db = jdev->db; -+ -+ switch (args->op) { -+ case 1: -+ rec.key = args->nr_recs; -+ result = bsearch(&rec, db->db, db->nr, 8, cmp_key); -+ if (!result) { -+ args->recs = 0; -+ return -ENOENT; -+ } -+ args->recs = result->val; -+ -+ break; -+ case 0: -+ if (args->recs) -+ return copy_to_user((void __user *)args->recs, db->db, -+ db->nr * sizeof(struct drm_mwv207_info_rec)); -+ args->nr_recs = db->nr; -+ -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ return 0; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_db.h b/drivers/gpu/drm/mwv207/mwv207_db.h -new file mode 100644 -index 000000000..fd5c685d4 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_db.h -@@ -0,0 +1,32 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include "mwv207_drm.h" -+#ifndef MWV207_DB_H_AGPY6ZIQ -+#define MWV207_DB_H_AGPY6ZIQ -+ -+struct mwv207_device; -+ -+int mwv207_db_init(struct mwv207_device *jdev); -+void mwv207_db_fini(struct mwv207_device *jdev); -+void mwv207_db_sort(struct mwv207_device *jdev); -+ -+int mwv207_db_add(struct mwv207_device *jdev, u32 key, u32 val); -+ -+int mwv207_db_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_devfreq.c b/drivers/gpu/drm/mwv207/mwv207_devfreq.c -new file mode 100644 -index 000000000..de1266989 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_devfreq.c -@@ -0,0 +1,279 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and * confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include "mwv207_devfreq.h" -+#include "mwv207_vbios.h" -+#include "mwv207_sched.h" -+ -+#define MIN_FREQ 50 -+#define MAX_FREQ 600 -+ -+static void mwv207_devfreq_update_utilization(struct mwv207_pipe *pipe) -+{ -+ ktime_t now; -+ ktime_t last; -+ -+ now = ktime_get(); -+ last = pipe->time_last_update; -+ -+ dev_dbg(pipe->dev, "pipe [%s] busy_count: %d", pipe->fname, pipe->busy_count); -+ -+ if (pipe->busy_count > 0) -+ pipe->busy_time += ktime_sub(now, last); -+ else -+ pipe->idle_time += ktime_sub(now, last); -+ -+ pipe->time_last_update = now; -+} -+ -+static int mwv207_devfreq_get_cur_freq(struct device *dev, unsigned long *freq) -+{ -+ struct mwv207_pipe *pipe = dev_get_drvdata(dev); -+ unsigned long freq_khz; -+ int ret; -+ -+ ret = mwv207_vbios_get_pll(pipe->jdev, pipe->pll_id, &freq_khz); -+ if (ret) -+ *freq = MIN_FREQ; -+ else -+ *freq = freq_khz / 1000; -+ -+ return 0; -+} -+ -+static int mwv207_devfreq_target(struct device *dev, unsigned long *freq, u32 flags) -+{ -+ struct mwv207_pipe *pipe = dev_get_drvdata(dev); -+ struct dev_pm_opp *opp; -+ unsigned long target_freq; -+ int ret; -+ -+ opp = devfreq_recommended_opp(dev, freq, flags); -+ if (IS_ERR(opp)) -+ return PTR_ERR(opp); -+ -+ target_freq = dev_pm_opp_get_freq(opp); -+ dev_pm_opp_put(opp); -+ -+ dev_dbg(dev, "pipe [%s] target freq: %lu", pipe->fname, target_freq); -+ -+ ret = mwv207_vbios_set_pll(pipe->jdev, pipe->pll_id, target_freq * 1000); -+ if (ret) -+ return ret; -+ -+ return 0; -+} -+ -+static void mwv207_devfreq_pipe_reset(struct mwv207_pipe *pipe) -+{ -+ pipe->busy_time = 0; -+ pipe->idle_time = 0; -+ pipe->time_last_update = ktime_get(); -+} -+ -+static int mwv207_devfreq_get_dev_status(struct device *dev, struct devfreq_dev_status *status) -+{ -+ struct mwv207_pipe *pipe = dev_get_drvdata(dev); -+ unsigned long flags; -+ -+ mwv207_devfreq_get_cur_freq(dev, &status->current_frequency); -+ -+ spin_lock_irqsave(&pipe->devfreq_lock, flags); -+ -+ mwv207_devfreq_update_utilization(pipe); -+ -+ status->total_time = ktime_to_ns(ktime_add(pipe->busy_time, -+ pipe->idle_time)); -+ -+ status->busy_time = ktime_to_ns(pipe->busy_time); -+ -+ mwv207_devfreq_pipe_reset(pipe); -+ -+ spin_unlock_irqrestore(&pipe->devfreq_lock, flags); -+ -+ return 0; -+} -+ -+static struct devfreq_dev_profile mwv207_devfreq_profile = { -+ .polling_ms = 50, -+ .target = mwv207_devfreq_target, -+ .get_dev_status = mwv207_devfreq_get_dev_status, -+ .get_cur_freq = mwv207_devfreq_get_cur_freq, -+}; -+ -+static ssize_t utilization_show(struct device *dev, struct device_attribute *attr, char *buf) -+{ -+ struct mwv207_pipe *pipe = dev_get_drvdata(dev); -+ unsigned long busy_time, total_time, flags; -+ -+ spin_lock_irqsave(&pipe->devfreq_lock, flags); -+ -+ mwv207_devfreq_update_utilization(pipe); -+ -+ total_time = ktime_to_ns(ktime_add(pipe->busy_time, pipe->idle_time)); -+ -+ busy_time = ktime_to_ns(pipe->busy_time); -+ -+ if (strncmp(pipe->devfreq->governor_name, DEVFREQ_GOV_SIMPLE_ONDEMAND, DEVFREQ_NAME_LEN)) -+ mwv207_devfreq_pipe_reset(pipe); -+ -+ spin_unlock_irqrestore(&pipe->devfreq_lock, flags); -+ -+ if (total_time == 0) -+ return sprintf(buf, "%d\n", 100); -+ else -+ return sprintf(buf, "%llu\n", div_u64(busy_time, total_time / 100)); -+} -+ -+static DEVICE_ATTR_RO(utilization); -+ -+void mwv207_devfreq_unregister(struct mwv207_pipe *pipe) -+{ -+ if (!pipe->devfreq) -+ return; -+ -+ device_remove_file(pipe->dev, &dev_attr_utilization); -+ sysfs_remove_link(&pipe->dev->kobj, "stats"); -+ dev_pm_opp_remove_all_dynamic(pipe->dev); -+ device_unregister(pipe->dev); -+} -+ -+static void mwv207_devfreq_dev_release(struct device *dev) -+{ -+ kfree(dev); -+} -+ -+int mwv207_devfreq_register(struct mwv207_pipe *pipe, unsigned long max_freq) -+{ -+ struct device *dev; -+ unsigned long freq; -+ int ret; -+ -+ dev = kzalloc(sizeof(struct device), GFP_KERNEL); -+ if (!dev) -+ return -ENOMEM; -+ -+ dev->parent = pipe->jdev->dev; -+ dev->release = mwv207_devfreq_dev_release; -+ dev_set_name(dev, "devfreq_%s", pipe->fname); -+ dev_set_drvdata(dev, pipe); -+ -+ ret = device_register(dev); -+ if (ret) { -+ put_device(dev); -+ goto err_out; -+ } -+ -+ pipe->dev = dev; -+ pipe->busy_count = 0; -+ spin_lock_init(&pipe->devfreq_lock); -+ -+ mwv207_devfreq_profile.initial_freq = max_freq; -+ -+ for (freq = MIN_FREQ; freq <= max_freq; freq += 50) { -+ ret = dev_pm_opp_add(dev, freq, 0); -+ if (ret) -+ goto remove_opps; -+ } -+ -+ pipe->devfreq = devm_devfreq_add_device(dev, &mwv207_devfreq_profile, -+ DEVFREQ_GOV_PERFORMANCE, NULL); -+ if (IS_ERR(pipe->devfreq)) { -+ ret = PTR_ERR(pipe->devfreq); -+ dev_dbg(dev, "Couldn't initialize devfreq: %d", ret); -+ goto remove_opps; -+ } -+ -+ mwv207_devfreq_pipe_reset(pipe); -+ -+ pipe->devfreq->suspend_freq = MIN_FREQ; -+ -+ ret = sysfs_create_link(&dev->kobj, &pipe->devfreq->dev.kobj, "stats"); -+ if (ret) { -+ dev_dbg(dev, "Couldn't create sys link for stats: %d", ret); -+ goto remove_opps; -+ } -+ -+ ret = device_create_file(dev, &dev_attr_utilization); -+ if (ret) { -+ dev_dbg(dev, "Couldn't create device file for utilization: %d", ret); -+ goto remove_link; -+ } -+ -+ return 0; -+ -+remove_link: -+ sysfs_remove_link(&dev->kobj, "stats"); -+remove_opps: -+ dev_pm_opp_remove_all_dynamic(dev); -+ device_unregister(dev); -+err_out: -+ return ret; -+} -+ -+int mwv207_devfreq_resume(struct mwv207_pipe *pipe) -+{ -+ unsigned long flags; -+ -+ if (!pipe->devfreq) -+ return 0; -+ -+ spin_lock_irqsave(&pipe->devfreq_lock, flags); -+ -+ mwv207_devfreq_pipe_reset(pipe); -+ -+ spin_unlock_irqrestore(&pipe->devfreq_lock, flags); -+ -+ return devfreq_resume_device(pipe->devfreq); -+} -+ -+int mwv207_devfreq_suspend(struct mwv207_pipe *pipe) -+{ -+ if (!pipe->devfreq) -+ return 0; -+ -+ return devfreq_suspend_device(pipe->devfreq); -+} -+ -+void mwv207_devfreq_record_busy(struct mwv207_pipe *pipe) -+{ -+ unsigned long flags; -+ -+ if (!pipe->devfreq) -+ return; -+ -+ spin_lock_irqsave(&pipe->devfreq_lock, flags); -+ -+ mwv207_devfreq_update_utilization(pipe); -+ pipe->busy_count++; -+ -+ spin_unlock_irqrestore(&pipe->devfreq_lock, flags); -+} -+ -+void mwv207_devfreq_record_idle(struct mwv207_pipe *pipe) -+{ -+ unsigned long flags; -+ -+ if (!pipe->devfreq) -+ return; -+ -+ spin_lock_irqsave(&pipe->devfreq_lock, flags); -+ -+ mwv207_devfreq_update_utilization(pipe); -+ WARN_ON(--pipe->busy_count < 0); -+ -+ spin_unlock_irqrestore(&pipe->devfreq_lock, flags); -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_devfreq.h b/drivers/gpu/drm/mwv207/mwv207_devfreq.h -new file mode 100644 -index 000000000..5cabf1c3a ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_devfreq.h -@@ -0,0 +1,31 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+ -+#ifndef __MWV207_DEVFREQ_H__ -+#define __MWV207_DEVFREQ_H__ -+ -+struct mwv207_pipe; -+ -+void mwv207_devfreq_unregister(struct mwv207_pipe *pipe); -+int mwv207_devfreq_register(struct mwv207_pipe *pipe, unsigned long max_freq); -+ -+void mwv207_devfreq_record_busy(struct mwv207_pipe *pipe); -+void mwv207_devfreq_record_idle(struct mwv207_pipe *pipe); -+ -+int mwv207_devfreq_suspend(struct mwv207_pipe *pipe); -+int mwv207_devfreq_resume(struct mwv207_pipe *pipe); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_dma.h b/drivers/gpu/drm/mwv207/mwv207_dma.h -new file mode 100644 -index 000000000..ff70d9a0e ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_dma.h -@@ -0,0 +1,29 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_EDMA_H_EPAWCJ4N -+#define MWV207_EDMA_H_EPAWCJ4N -+#include "mwv207.h" -+ -+struct mwv207_dma; -+struct mwv207_dma *mwv207_dma_create(struct device *dev, -+ void __iomem *regbase, u8 alignment); -+void mwv207_dma_destroy(struct mwv207_dma *dma); -+ -+int mwv207_dma_to_vram(struct mwv207_dma *dma, u64 vram_addr, void *va, u64 size); -+int mwv207_dma_to_ram(struct mwv207_dma *dma, void *va, u64 vram_addr, u64 size); -+int mwv207_dma_vram_vram(struct mwv207_dma *dma, u64 dst_vram_addr, u64 src_vram_addr, u64 size); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_drm.h b/drivers/gpu/drm/mwv207/mwv207_drm.h -new file mode 100644 -index 000000000..b6c2ff624 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_drm.h -@@ -0,0 +1,160 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef __MWV207_DRM_H__ -+#define __MWV207_DRM_H__ -+ -+ -+#include "drm/drm.h" -+ -+#if defined(__cplusplus) -+extern "C" { -+#endif -+ -+/**********************GEM interface*************************/ -+ -+struct drm_mwv207_gem_create_in { -+ __u64 size; -+ __u64 alignment; -+ __u32 preferred_domain; -+ __u32 flags; -+}; -+struct drm_mwv207_gem_create_out { -+ __u32 handle; -+ __u32 resv; -+}; -+union drm_mwv207_gem_create { -+ struct drm_mwv207_gem_create_in in; -+ struct drm_mwv207_gem_create_out out; -+}; -+ -+struct drm_mwv207_gem_mmap_in { -+ __u32 handle; -+ __u32 pad; -+}; -+struct drm_mwv207_gem_mmap_out { -+ __u64 offset; -+}; -+union drm_mwv207_gem_mmap { -+ struct drm_mwv207_gem_mmap_in in; -+ struct drm_mwv207_gem_mmap_out out; -+}; -+ -+struct drm_mwv207_gem_wait { -+ __u32 handle; -+ __u32 op; -+ __s64 timeout; -+}; -+ -+/**********************context interface*************************/ -+struct drm_mwv207_ctx { -+ __u32 op; -+ __u32 flags; -+ __u32 handle; -+ __u32 resv; -+}; -+ -+/**********************submission interface************************* -+ * 1. a submission is sent to a single ctx -+ * 2. a submission optionally contains a relocation table and a bo table -+ * 3. bo table should not contain duplicates; -+ * 4. cmd buffer size should be limited to 16K -+ */ -+ -+struct drm_mwv207_submit { -+ __u32 ctx; -+ __u32 engine_type; -+ __u32 engine_id; -+ __u32 flags; -+ __u32 fence_fd; /* in/out fence fd, according to MWV207_SUBMIT_FLAG_FENCE_IN/OUT */ -+ __u32 cmd_size; -+ __u32 nr_relocs; -+ __u32 nr_bos; -+ __u32 nr_cmd_dat; -+ __u32 padding; -+ __u64 cmds; -+ __u64 relocs; -+ __u64 bos; -+ __u64 cmd_dats; -+ /* syncobj support, reserved for vulkan -+ * __u32 nr_in_syncobjs; -+ * __u32 nr_out_syncobjs; -+ * __u64 in_syncobjs; -+ * __u64 out_syncobjs; -+ */ -+}; -+ -+/* in_syncobjs/out_syncobjs array element, reserved for vulkan */ -+struct drm_mwv207_submit_syncobj { -+ __u32 handle; -+ __u32 flags; -+ __u64 point; -+}; -+ -+struct drm_mwv207_bo_acc { -+ __u32 handle; -+ __u32 flags; -+}; -+ -+struct drm_mwv207_submit_reloc { -+ __u32 idx; /* bo/cmd_dat idx in submit bos/cmd_dats */ -+ __u32 cmd_offset; -+ __u64 bo_offset; -+ __u32 type; -+ __u32 pad; -+}; -+ -+ -+struct drm_mwv207_submit_cmd_dat { -+ __u32 nr_relocs; -+ __u32 dat_size; -+ __u64 relocs; -+ __u64 dat; -+}; -+ -+/**************** card capability interface *****************/ -+/* XXX: keys are user/kernel ABI, DO THINK TWICE when -+ * add keys, once added it can never be removed. -+ */ -+enum drm_mwv207_info_key { -+ DRM_MWV207_ACTIVE_3D_NR = 0, -+ DRM_MWV207_ACTIVE_DEC_NR, -+ DRM_MWV207_ACTIVE_ENC_NR, -+ DRM_MWV207_ACTIVE_2D_NR, -+ DRM_MWV207_ACTIVE_DMA_NR, -+}; -+ -+struct drm_mwv207_info_rec { -+ __u32 key; -+ __u32 val; -+}; -+ -+struct drm_mwv207_info { -+ __u32 op; -+ __u32 nr_recs; -+ __u64 recs; -+}; -+ -+#define DRM_IOCTL_MWV207_INFO DRM_IOWR(DRM_COMMAND_BASE + 0x00, struct drm_mwv207_info) -+#define DRM_IOCTL_MWV207_GEM_CREATE DRM_IOWR(DRM_COMMAND_BASE + 0x01, union drm_mwv207_gem_create) -+#define DRM_IOCTL_MWV207_GEM_MMAP DRM_IOWR(DRM_COMMAND_BASE + 0x02, union drm_mwv207_gem_mmap) -+#define DRM_IOCTL_MWV207_GEM_WAIT DRM_IOWR(DRM_COMMAND_BASE + 0x03, struct drm_mwv207_gem_wait) -+#define DRM_IOCTL_MWV207_CTX DRM_IOWR(DRM_COMMAND_BASE + 0x04, struct drm_mwv207_ctx) -+#define DRM_IOCTL_MWV207_SUBMIT DRM_IOWR(DRM_COMMAND_BASE + 0x05, struct drm_mwv207_submit) -+#if defined(__cplusplus) -+} -+#endif -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_drv.c b/drivers/gpu/drm/mwv207/mwv207_drv.c -new file mode 100644 -index 000000000..e9b005c9f ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_drv.c -@@ -0,0 +1,547 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207_drm.h" -+#include "mwv207_gem.h" -+#include "mwv207_bo.h" -+#include "dc/mwv207_kms.h" -+#include "mwv207_ctx.h" -+#include "mwv207_submit.h" -+#include "mwv207_sched.h" -+#include "mwv207_irq.h" -+#include "mwv207_db.h" -+#include "mwv207_vbios.h" -+ -+#define DRIVER_NAME "mwv207" -+#define DRIVER_DESC "mwv207 gpu driver" -+#define DRIVER_DATE "20220407" -+#define DRIVER_MAJOR 0 -+#define DRIVER_MINOR 1 -+ -+#define WIN_SIZE 0x10000 -+ -+#define IATU_BAR_LOW_OFFSET 0x108 -+#define IATU_BAR_HIGH_OFFSET 0x10c -+#define IATU_BAR_LIMIT_LOW_OFFSET 0x110 -+ -+#define IATU_REGION_MODE_ADDR 0 -+ -+static int selftest; -+module_param(selftest, int, 0644); -+MODULE_PARM_DESC(selftest, "run selftest when startup"); -+ -+static int mwv207_driver_open(struct drm_device *dev, struct drm_file *file_priv) -+{ -+ struct mwv207_fpriv *fpriv; -+ -+ fpriv = kzalloc(sizeof(struct mwv207_fpriv), GFP_KERNEL); -+ if (fpriv == NULL) -+ return -ENOMEM; -+ -+ mwv207_ctx_mgr_init(dev, &fpriv->ctx_mgr); -+ -+ file_priv->driver_priv = fpriv; -+ -+ return 0; -+} -+ -+static void mwv207_driver_postclose(struct drm_device *dev, -+ struct drm_file *file_priv) -+{ -+ struct mwv207_fpriv *fpriv = to_fpriv(file_priv); -+ -+ mwv207_ctx_mgr_fini(dev, &fpriv->ctx_mgr); -+ kfree(fpriv); -+} -+ -+static int mwv207_mmap(struct file *filp, struct vm_area_struct *vma) -+{ -+ struct drm_file *file_priv; -+ struct mwv207_device *jdev; -+ int ret; -+ -+ file_priv = filp->private_data; -+ jdev = file_priv->minor->dev->dev_private; -+ ret = ttm_bo_mmap(filp, vma, &jdev->bdev); -+ -+ return ret; -+} -+ -+static const struct file_operations mwv207_driver_fops = { -+ .owner = THIS_MODULE, -+ .open = drm_open, -+ .mmap = mwv207_mmap, -+ .unlocked_ioctl = drm_ioctl, -+#ifdef CONFIG_COMPAT -+ .compat_ioctl = drm_compat_ioctl, -+#endif -+ .poll = drm_poll, -+ .read = drm_read, -+ .llseek = no_llseek, -+ .release = drm_release, -+}; -+ -+static const struct drm_ioctl_desc mwv207_ioctls_drm[] = { -+ DRM_IOCTL_DEF_DRV(MWV207_INFO, mwv207_db_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+ DRM_IOCTL_DEF_DRV(MWV207_GEM_CREATE, mwv207_gem_create_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+ DRM_IOCTL_DEF_DRV(MWV207_GEM_MMAP, mwv207_gem_mmap_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+ DRM_IOCTL_DEF_DRV(MWV207_GEM_WAIT, mwv207_gem_wait_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+ DRM_IOCTL_DEF_DRV(MWV207_CTX, mwv207_ctx_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+ DRM_IOCTL_DEF_DRV(MWV207_SUBMIT, mwv207_submit_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+}; -+ -+static struct drm_driver mwv207_drm_driver = { -+ .driver_features = DRIVER_MODESET | DRIVER_ATOMIC | DRIVER_GEM | DRIVER_RENDER, -+ .fops = &mwv207_driver_fops, -+ .open = mwv207_driver_open, -+ .postclose = mwv207_driver_postclose, -+ -+ .dumb_create = mwv207_gem_dumb_create, -+ .dumb_map_offset = drm_gem_dumb_map_offset, -+ .dumb_destroy = drm_gem_dumb_destroy, -+ -+ .gem_free_object_unlocked = mwv207_gem_free_object, -+ -+ .prime_handle_to_fd = drm_gem_prime_handle_to_fd, -+ .prime_fd_to_handle = drm_gem_prime_fd_to_handle, -+ .gem_prime_export = drm_gem_prime_export, -+ .gem_prime_import = drm_gem_prime_import, -+ .gem_prime_mmap = drm_gem_prime_mmap, -+ -+ .ioctls = mwv207_ioctls_drm, -+ .num_ioctls = ARRAY_SIZE(mwv207_ioctls_drm), -+ -+ .name = DRIVER_NAME, -+ .desc = DRIVER_DESC, -+ .date = DRIVER_DATE, -+ .major = DRIVER_MAJOR, -+ .minor = DRIVER_MINOR, -+}; -+ -+static inline void iatu_write(struct mwv207_device *jdev, int index, u32 offset, u32 value) -+{ -+ u32 region_base = 0x10000 + index * 0x200; -+ writel(value, jdev->iatu + region_base + offset); -+} -+ -+static inline u32 iatu_read(struct mwv207_device *jdev, int index, u32 offset) -+{ -+ u32 region_base = 0x10000 + index * 0x200; -+ return readl(jdev->iatu + region_base + offset); -+} -+ -+static void mwv207_win_slide(struct mwv207_device *jdev, int region, -+ u64 pci_win_base, u64 axi_win_base) -+{ -+ iatu_write(jdev, region, IATU_BAR_LOW_OFFSET, pci_win_base & 0xffffffff); -+ iatu_write(jdev, region, IATU_BAR_HIGH_OFFSET, pci_win_base >> 32); -+ iatu_write(jdev, region, 0x114, axi_win_base & 0xffffffff); -+ iatu_write(jdev, region, 0x118, axi_win_base >> 32); -+ -+ iatu_write(jdev, region, IATU_BAR_LIMIT_LOW_OFFSET, -+ (pci_win_base + WIN_SIZE - 1) & 0xffffffff); -+ iatu_write(jdev, region, 0x100, 0x00); -+ iatu_write(jdev, region, 0x104, -+ 1 << 31 -+ | IATU_REGION_MODE_ADDR << 30 -+ | 6 << 8); -+ -+ -+ mb(); -+ if (iatu_read(jdev, region, 0x118) != (axi_win_base >> 32)) -+ pr_warn("mwv207: sliding window failed"); -+} -+ -+static int mwv207_iatu_map_bar(struct mwv207_device *jdev, int bar, u64 axi_addr) -+{ -+ iatu_write(jdev, bar + 9, 0x114, axi_addr & 0xffffffff); -+ iatu_write(jdev, bar + 9, 0x118, axi_addr >> 32); -+ iatu_write(jdev, bar + 9, 0x100, 0x00); -+ iatu_write(jdev, bar + 9, 0x104, -+ 1 << 31 -+ | 1 << 30 -+ | bar << 8); -+ -+ -+ mb(); -+ if (iatu_read(jdev, bar + 9, 0x114) != (axi_addr & 0xffffffff)) -+ return -ENODEV; -+ -+ return 0; -+} -+ -+static int mwv207_iatu_init(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ ret = mwv207_iatu_map_bar(jdev, 0, 0x10000000); -+ if (ret) -+ return ret; -+ -+ ret = mwv207_iatu_map_bar(jdev, 1, 0x00000000); -+ if (ret) -+ return ret; -+ -+ ret = mwv207_iatu_map_bar(jdev, 2, 0x10000000); -+ if (ret) -+ return ret; -+ -+ spin_lock_init(&jdev->win_lock); -+ -+ jdev->pci_win_base = pci_bus_address(jdev->base.pdev, 2) -+ + pci_resource_len(jdev->base.pdev, 2) - WIN_SIZE; -+ -+ mwv207_win_slide(jdev, 0, jdev->pci_win_base, 0x10000000); -+ -+ jdev->vram_last_win = 0; -+ -+ return 0; -+} -+ -+static void *mwv207_remap_region(struct mwv207_device *jdev, u64 vram_addr, u32 *len) -+{ -+ u64 vram_win_base = (vram_addr & (~(WIN_SIZE - 1))); -+ u64 winlimit = vram_win_base + WIN_SIZE; -+ -+ if (vram_win_base != jdev->vram_last_win) { -+ mwv207_win_slide(jdev, 0, jdev->pci_win_base, vram_win_base + 0x10000000); -+ jdev->vram_last_win = vram_win_base; -+ } -+ -+ if (*len > winlimit - vram_addr) -+ *len = winlimit - vram_addr; -+ -+ return jdev->win + vram_addr - vram_win_base; -+} -+ -+void jdev_write_vram(struct mwv207_device *jdev, u64 vram_addr, void *buf, int size) -+{ -+ int remain, len; -+ void *va; -+ -+ for (remain = size; remain > 0; remain -= len, buf += len, vram_addr += len) { -+ len = remain; -+ spin_lock(&jdev->win_lock); -+ va = mwv207_remap_region(jdev, vram_addr, &len); -+ if (!va || len <= 0) { -+ spin_unlock(&jdev->win_lock); -+ pr_warn("mwv207: write vram faild"); -+ return; -+ } -+ memcpy_toio(va, buf, len); -+ spin_unlock(&jdev->win_lock); -+ } -+} -+ -+static int mwv207_kick_out_firmware_fb(struct pci_dev *pdev) -+{ -+ struct apertures_struct *ap; -+ bool primary = false; -+ -+ ap = alloc_apertures(1); -+ if (!ap) -+ return -ENOMEM; -+ -+ ap->ranges[0].base = pci_resource_start(pdev, 0); -+ ap->ranges[0].size = pci_resource_len(pdev, 0); -+ -+#ifdef CONFIG_X86 -+ primary = pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW; -+#endif -+ drm_fb_helper_remove_conflicting_framebuffers(ap, "mwv207drmfb", primary); -+ kfree(ap); -+ -+ return 0; -+} -+ -+static u64 mwv207_vram_size(struct mwv207_device *jdev) -+{ -+ int nr = 0; -+ u64 size; -+ -+ switch (jdev_read(jdev, 0x9b0190) & 0x7) { -+ case 0: -+ size = 2048; -+ break; -+ case 1: -+ size = 1024; -+ break; -+ case 2: -+ size = 4096; -+ break; -+ case 3: -+ size = 8192; -+ break; -+ default: -+ pr_warn("mwv207: ddr size default to 256MB"); -+ return 256UL * 1024 * 1024; -+ } -+ -+ if (jdev->lite) { -+ nr += jdev_read(jdev, 0xd101bc) & 0x1; -+ nr += jdev_read(jdev, 0xd11cbc) & 0x1; -+ } else { -+ nr += (jdev_read(jdev, 0x9702f4) & 0x02000000) ? 1 : 0; -+ nr += (jdev_read(jdev, 0x9802f4) & 0x02000000) ? 1 : 0; -+ } -+ if (!nr) { -+ nr = 1; -+ pr_warn("mwv207: ddr cnt default to 1"); -+ } -+ -+ return size * 1024 * 1024 * nr; -+} -+ -+static int mwv207_pci_probe(struct pci_dev *pdev, -+ const struct pci_device_id *ent) -+{ -+ struct mwv207_device *jdev; -+ int ret; -+ -+ ret = mwv207_kick_out_firmware_fb(pdev); -+ if (ret) -+ return ret; -+ -+ pci_set_master(pdev); -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ jdev = devm_drm_dev_alloc(&pdev->dev, &mwv207_drm_driver, -+ struct mwv207_device, base); -+ if (IS_ERR(jdev)) -+ return PTR_ERR(jdev); -+ -+ jdev->dev = &pdev->dev; -+ jdev->base.pdev = pdev; -+ jdev->base.dev_private = jdev; -+ -+ jdev->mmio = devm_ioremap(jdev->dev, -+ pci_resource_start(pdev, 1), pci_resource_len(pdev, 1)); -+ if (!jdev->mmio) -+ return -ENOMEM; -+ -+ jdev->iatu = devm_ioremap(jdev->dev, -+ pci_resource_start(pdev, 4), pci_resource_len(pdev, 4)); -+ if (!jdev->iatu) -+ return -ENOMEM; -+ -+ jdev->win = devm_ioremap(jdev->dev, -+ pci_resource_end(pdev, 2) - WIN_SIZE + 1, WIN_SIZE); -+ if (!jdev->win) -+ return -ENOMEM; -+ -+ ret = mwv207_iatu_init(jdev); -+ if (ret) -+ return ret; -+ -+ /* magic: use hdmi-3 to probe for 92/91 (full/lite) */ -+ jdev->lite = jdev_read(jdev, 0x12c0000) == 0x21 ? false : true; -+ -+ pci_set_drvdata(pdev, jdev); -+ -+ ret = mwv207_db_init(jdev); -+ if (ret) -+ return ret; -+ -+ mwv207_vbios_init(jdev); -+ -+ ret = mwv207_irq_init(jdev); -+ if (ret) -+ goto err_vbios; -+ -+ jdev->visible_vram_size = pci_resource_len(pdev, 2) - WIN_SIZE; -+ jdev->vram_size = mwv207_vram_size(jdev); -+ jdev->vram_bar_base = pci_resource_start(pdev, 2); -+ -+ ret = mwv207_ttm_init(jdev); -+ if (ret) -+ goto err_irq; -+ -+ ret = mwv207_sched_init(jdev); -+ if (ret) -+ goto err_ttm; -+ -+ ret = mwv207_kctx_init(jdev); -+ if (ret) -+ goto err_sched; -+ -+ ret = mwv207_kms_init(jdev); -+ if (ret) -+ goto err_kctx; -+ -+ if (selftest) { -+ ret = mwv207_test(jdev); -+ if (ret) -+ goto err_kms; -+ } -+ -+ mwv207_db_sort(jdev); -+ ret = drm_dev_register(&jdev->base, 0); -+ if (ret) -+ goto err_kms; -+ ret = mwv207_fbdev_init(jdev); -+ if (ret) -+ goto err_drm; -+ -+ return 0; -+err_drm: -+ drm_dev_unregister(&jdev->base); -+err_kms: -+ mwv207_kms_fini(jdev); -+err_kctx: -+ mwv207_kctx_fini(jdev); -+err_sched: -+ mwv207_sched_fini(jdev); -+err_ttm: -+ mwv207_ttm_fini(jdev); -+err_irq: -+ mwv207_irq_fini(jdev); -+err_vbios: -+ mwv207_vbios_fini(jdev); -+ mwv207_db_fini(jdev); -+ return ret; -+} -+ -+static void mwv207_pci_remove(struct pci_dev *pdev) -+{ -+ struct mwv207_device *jdev = pci_get_drvdata(pdev); -+ -+ mwv207_fbdev_fini(jdev); -+ drm_dev_unregister(&jdev->base); -+ mwv207_kms_fini(jdev); -+ mwv207_kctx_fini(jdev); -+ mwv207_sched_fini(jdev); -+ mwv207_ttm_fini(jdev); -+ mwv207_irq_fini(jdev); -+ mwv207_vbios_fini(jdev); -+ mwv207_db_fini(jdev); -+ pci_clear_master(pdev); -+ pci_set_drvdata(pdev, NULL); -+} -+ -+static int mwv207_pmops_suspend(struct device *dev) -+{ -+ struct mwv207_device *jdev = dev_get_drvdata(dev); -+ struct pci_dev *pdev = to_pci_dev(dev); -+ int ret; -+ -+ ret = mwv207_kms_suspend(jdev); -+ if (ret) -+ return ret; -+ -+ /* kernel permanently pinned boes won't be evicted, they are -+ * handled by each module in whatever ways suitable -+ */ -+ ret = ttm_bo_evict_mm(&jdev->bdev, TTM_PL_VRAM); -+ if (ret) -+ goto fail; -+ -+ ret = mwv207_sched_suspend(jdev); -+ if (ret) -+ goto fail; -+ -+ mwv207_irq_suspend(jdev); -+ -+ pci_save_state(pdev); -+ pci_disable_device(pdev); -+ pci_set_power_state(pdev, PCI_D3hot); -+ udelay(200); -+ return 0; -+fail: -+ mwv207_kms_resume(jdev); -+ return ret; -+} -+ -+static int mwv207_pmops_resume(struct device *dev) -+{ -+ struct mwv207_device *jdev = dev_get_drvdata(dev); -+ struct pci_dev *pdev = to_pci_dev(dev); -+ int ret; -+ -+ msleep(100); -+ -+ pci_set_power_state(pdev, PCI_D0); -+ pci_restore_state(pdev); -+ ret = pci_enable_device(pdev); -+ if (ret) { -+ pr_err("mwv207: failed to enable pci device"); -+ return ret; -+ } -+ pci_set_master(pdev); -+ -+ ret = mwv207_iatu_init(jdev); -+ if (ret) -+ return ret; -+ -+ mwv207_irq_resume(jdev); -+ -+ ret = mwv207_sched_resume(jdev); -+ if (ret) -+ return ret; -+ -+ return mwv207_kms_resume(jdev); -+} -+ -+static SIMPLE_DEV_PM_OPS(mwv207_pm_ops, mwv207_pmops_suspend, mwv207_pmops_resume); -+ -+#define MWV207_PCI_DEVICE_DATA(vend, dev, data) \ -+ .vendor = vend, .device = dev, .driver_data = (kernel_ulong_t)(data), \ -+ .subvendor = PCI_ANY_ID, .subdevice = PCI_ANY_ID, \ -+ .class = 0, .class_mask = 0 -+ -+static const struct pci_device_id pciidlist[] = { -+ {MWV207_PCI_DEVICE_DATA(0x0731, 0x9100, NULL)}, -+ {0}, -+}; -+ -+MODULE_DEVICE_TABLE(pci, pciidlist); -+static struct pci_driver mwv207_pci_driver = { -+ .name = DRIVER_NAME, -+ .id_table = pciidlist, -+ .probe = mwv207_pci_probe, -+ .remove = mwv207_pci_remove, -+ .driver.pm = &mwv207_pm_ops, -+}; -+ -+static int __init mwv207_init(void) -+{ -+ return pci_register_driver(&mwv207_pci_driver); -+} -+ -+static void __exit mwv207_exit(void) -+{ -+ pci_unregister_driver(&mwv207_pci_driver); -+} -+ -+module_init(mwv207_init); -+module_exit(mwv207_exit); -+MODULE_DESCRIPTION("MWV207 Graphics Driver"); -+MODULE_AUTHOR("shanjinkui"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/gpu/drm/mwv207/mwv207_gem.c b/drivers/gpu/drm/mwv207/mwv207_gem.c -new file mode 100644 -index 000000000..26c9ef167 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_gem.c -@@ -0,0 +1,155 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include "mwv207_drm.h" -+#include "mwv207_gem.h" -+#include "mwv207_bo.h" -+ -+static int mwv207_gem_create(struct mwv207_device *jdev, -+ u64 size, u64 align, u32 preferred_domain, -+ u32 flags, struct drm_gem_object **gobj) -+{ -+ struct mwv207_bo *jbo; -+ int ret; -+ -+retry: -+ -+ ret = mwv207_bo_create(jdev, size, align, ttm_bo_type_device, -+ preferred_domain, flags, &jbo); -+ if (ret) { -+ if (ret != -ERESTARTSYS) { -+ if (flags & (1<<0)) { -+ flags &= ~(1<<0); -+ goto retry; -+ } -+ if (preferred_domain == 0x2) { -+ preferred_domain |= 0x1; -+ goto retry; -+ } -+ DRM_DEBUG("Failed to allocate GEM object (%lld, %d, %llu, %d)\n", -+ size, preferred_domain, align, ret); -+ } -+ return ret; -+ } -+ -+ *gobj = mwv207_gem_from_bo(jbo); -+ return 0; -+} -+ -+int mwv207_gem_dumb_create(struct drm_file *file, struct drm_device *dev, -+ struct drm_mode_create_dumb *args) -+{ -+ struct mwv207_device *jdev = dev->dev_private; -+ struct drm_gem_object *gobj; -+ u32 handle; -+ int ret; -+ -+ args->pitch = ALIGN(args->width * DIV_ROUND_UP(args->bpp, 8), 64); -+ args->size = args->pitch * args->height; -+ ret = mwv207_gem_create(jdev, args->size, 0x10000, -+ 0x2, -+ (1<<0), -+ &gobj); -+ if (ret) -+ return ret; -+ -+ ret = drm_gem_handle_create(file, gobj, &handle); -+ mwv207_gem_object_put(gobj); -+ if (ret) -+ return ret; -+ -+ args->handle = handle; -+ return 0; -+} -+ -+void mwv207_gem_free_object(struct drm_gem_object *gobj) -+{ -+ struct mwv207_bo *jbo; -+ -+ if (!gobj) -+ return; -+ -+ jbo = mwv207_bo_from_gem(gobj); -+ mwv207_bo_unref(jbo); -+} -+ -+int mwv207_gem_create_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ struct mwv207_device *jdev = dev->dev_private; -+ union drm_mwv207_gem_create *args = data; -+ struct drm_gem_object *gobj; -+ int ret; -+ -+ if (args->in.size == 0) -+ return -EINVAL; -+ if (args->in.alignment & (args->in.alignment - 1)) -+ return -EINVAL; -+ if (args->in.preferred_domain & ~0x7) -+ return -EINVAL; -+ if (args->in.flags & ~((1<<0)|(1<<1)|(1<<2))) -+ return -EINVAL; -+ -+ ret = mwv207_gem_create(jdev, args->in.size, args->in.alignment, -+ args->in.preferred_domain, -+ args->in.flags, &gobj); -+ if (ret) -+ return ret; -+ -+ ret = drm_gem_handle_create(filp, gobj, &args->out.handle); -+ mwv207_gem_object_put(gobj); -+ -+ return ret; -+} -+ -+int mwv207_gem_mmap_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ union drm_mwv207_gem_mmap *args = data; -+ struct drm_gem_object *obj; -+ -+ if (args->in.pad) -+ return -EINVAL; -+ -+ obj = drm_gem_object_lookup(filp, args->in.handle); -+ if (!obj) -+ return -ENOENT; -+ args->out.offset = mwv207_bo_mmap_offset(obj); -+ mwv207_gem_object_put(obj); -+ -+ return 0; -+} -+ -+int mwv207_gem_wait_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ struct drm_mwv207_gem_wait *args = (struct drm_mwv207_gem_wait *)data; -+ long timeout; -+ bool write; -+ int ret; -+ -+ if (args->op & ~(0x00000002 | 0x00000001)) -+ return -EINVAL; -+ -+ write = args->op & 0x00000002; -+ timeout = drm_timeout_abs_to_jiffies(args->timeout); -+ -+ ret = drm_gem_dma_resv_wait(filp, args->handle, write, timeout); -+ if (ret == -ETIME) -+ ret = timeout ? -ETIMEDOUT : -EBUSY; -+ -+ return ret; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_gem.h b/drivers/gpu/drm/mwv207/mwv207_gem.h -new file mode 100644 -index 000000000..52c208d17 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_gem.h -@@ -0,0 +1,39 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_GEM_H_TJTW9M4R -+#define MWV207_GEM_H_TJTW9M4R -+#include -+#include -+#include -+#include "mwv207.h" -+ -+int mwv207_gem_dumb_create(struct drm_file *file, struct drm_device *dev, -+ struct drm_mode_create_dumb *args); -+ -+void mwv207_gem_free_object(struct drm_gem_object *obj); -+ -+int mwv207_gem_create_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+int mwv207_gem_mmap_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+int mwv207_gem_wait_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+#define mwv207_gem_object_put drm_gem_object_put -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_irq.c b/drivers/gpu/drm/mwv207/mwv207_irq.c -new file mode 100644 -index 000000000..987d8a91e ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_irq.c -@@ -0,0 +1,190 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_irq.h" -+ -+static irqreturn_t mwv207_isr(int irq_unused, void *dev_id) -+{ -+ struct mwv207_device *jdev = dev_id; -+ int i, j, hwirq, virq, ret = IRQ_NONE; -+ u32 stat; -+ -+ for (i = 0; i < 2; ++i) { -+ stat = jdev_read(jdev, (0x009A802c) + i * 4); -+ stat &= jdev->irq_enable_reg[i]; -+ while ((j = ffs(stat))) { -+ j--; -+ hwirq = i * 32 + j; -+ virq = irq_find_mapping(jdev->irq_domain, hwirq); -+ if (virq) { -+ ret = generic_handle_irq(virq); -+ if (ret < 0) -+ pr_warn("mwv207: hwirq(%d) handled with %d", hwirq, ret); -+ } else -+ pr_warn("mwv207: no irq mapping set on %d", hwirq); -+ -+ -+ jdev_write(jdev, (0x009A802c) + i * 4, (1UL << j)); -+ stat &= ~(1UL << j); -+ ret = IRQ_HANDLED; -+ } -+ } -+ -+ return ret; -+} -+ -+static void mwv207_irq_mask(struct irq_data *d) -+{ -+ struct mwv207_device *jdev = irq_data_get_irq_chip_data(d); -+ int irq = irqd_to_hwirq(d); -+ unsigned long flags; -+ u32 reg; -+ -+ reg = (0x009A8020) + (irq / 32) * 4; -+ -+ spin_lock_irqsave(&jdev->irq_lock, flags); -+ jdev_modify(jdev, reg, 1 << (irq % 32), 0); -+ jdev->irq_enable_reg[irq / 32] = jdev_read(jdev, reg); -+ spin_unlock_irqrestore(&jdev->irq_lock, flags); -+} -+ -+static void mwv207_irq_unmask(struct irq_data *d) -+{ -+ struct mwv207_device *jdev = irq_data_get_irq_chip_data(d); -+ int irq = irqd_to_hwirq(d); -+ unsigned long flags; -+ u32 reg; -+ -+ reg = (0x009A8020) + (irq / 32) * 4; -+ -+ spin_lock_irqsave(&jdev->irq_lock, flags); -+ jdev_modify(jdev, reg, 1 << (irq % 32), 1 << (irq % 32)); -+ jdev->irq_enable_reg[irq / 32] = jdev_read(jdev, reg); -+ spin_unlock_irqrestore(&jdev->irq_lock, flags); -+} -+ -+void mwv207_irq_suspend(struct mwv207_device *jdev) -+{ -+ int i; -+ -+ for (i = 0; i < 2; ++i) -+ jdev->irq_enable_reg[i] = jdev_read(jdev, -+ (0x009A8020) + i * 4); -+} -+ -+void mwv207_irq_resume(struct mwv207_device *jdev) -+{ -+ int i; -+ -+ for (i = 0; i < 2; ++i) { -+ jdev_write(jdev, (0x009A802c) + i * 4, 0xffffffff); -+ jdev_write(jdev, (0x009A8020) + i * 4, -+ jdev->irq_enable_reg[i]); -+ } -+} -+ -+static struct irq_chip mwv207_irq_chip = { -+ .name = "mwv207", -+ .irq_mask = mwv207_irq_mask, -+ .irq_unmask = mwv207_irq_unmask, -+}; -+ -+static int mwv207_irq_domain_map(struct irq_domain *d, unsigned int irq, -+ irq_hw_number_t hwirq) -+{ -+ struct mwv207_device *jdev = d->host_data; -+ -+ if (hwirq >= 64) -+ return -EPERM; -+ -+ irq_set_chip_and_handler(irq, &mwv207_irq_chip, handle_simple_irq); -+ irq_set_chip_data(irq, jdev); -+ -+ return 0; -+} -+ -+static const struct irq_domain_ops mwv207_irq_domain_ops = { -+ .map = mwv207_irq_domain_map, -+}; -+ -+int mwv207_irq_init(struct mwv207_device *jdev) -+{ -+ struct pci_dev *pdev = jdev->base.pdev; -+ int ret, i; -+ -+ -+ for (i = 0; i < 2; ++i) { -+ jdev_write(jdev, (0x009A802c) + i * 4, 0xffffffff); -+ jdev_write(jdev, (0x009A8020) + i * 4, 0); -+ } -+ -+ spin_lock_init(&jdev->irq_lock); -+ -+ jdev->irq_domain = irq_domain_add_linear(NULL, 64, -+ &mwv207_irq_domain_ops, jdev); -+ if (!jdev->irq_domain) -+ return -ENODEV; -+ -+ -+ for (i = 0; i < 64; ++i) -+ irq_create_mapping(jdev->irq_domain, i); -+ -+ ret = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_MSI | PCI_IRQ_LEGACY); -+ if (ret < 1) { -+ ret = -ENODEV; -+ goto free_mapping; -+ } -+ -+ ret = request_irq(pdev->irq, mwv207_isr, IRQF_SHARED, "mwv207_isr", jdev); -+ if (ret) -+ goto free_vec; -+ -+ return 0; -+ -+free_vec: -+ pci_free_irq_vectors(pdev); -+free_mapping: -+ for (i = 0; i < 64; ++i) { -+ int irq = irq_find_mapping(jdev->irq_domain, i); -+ -+ irq_dispose_mapping(irq); -+ } -+ -+ irq_domain_remove(jdev->irq_domain); -+ -+ return ret; -+} -+ -+void mwv207_irq_fini(struct mwv207_device *jdev) -+{ -+ struct pci_dev *pdev = jdev->base.pdev; -+ int i; -+ -+ free_irq(pdev->irq, jdev); -+ pci_free_irq_vectors(pdev); -+ -+ for (i = 0; i < 64; ++i) { -+ int irq = irq_find_mapping(jdev->irq_domain, i); -+ -+ irq_dispose_mapping(irq); -+ } -+ -+ irq_domain_remove(jdev->irq_domain); -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_irq.h b/drivers/gpu/drm/mwv207/mwv207_irq.h -new file mode 100644 -index 000000000..eabcc61e6 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_irq.h -@@ -0,0 +1,26 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_IRQ_H_Z8YGVNB2 -+#define MWV207_IRQ_H_Z8YGVNB2 -+ -+struct mwv207_device; -+ -+int mwv207_irq_init(struct mwv207_device *jdev); -+void mwv207_irq_fini(struct mwv207_device *jdev); -+ -+void mwv207_irq_suspend(struct mwv207_device *jdev); -+void mwv207_irq_resume(struct mwv207_device *jdev); -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_2d.c b/drivers/gpu/drm/mwv207/mwv207_pipe_2d.c -new file mode 100644 -index 000000000..439cc048c ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_2d.c -@@ -0,0 +1,567 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "mwv207_bo.h" -+#include "mwv207_sched.h" -+#include "mwv207_vbios.h" -+#include "mwv207_devfreq.h" -+ -+#define DEFAULT_MAX_FREQ_2D 600 -+ -+#define wait_for(COND, MS) ({ \ -+ unsigned long timeout__ = jiffies + msecs_to_jiffies(MS) + 1; \ -+ int ret__ = 0; \ -+ while (!(COND)) { \ -+ if (time_after(jiffies, timeout__)) { \ -+ if (!(COND)) \ -+ ret__ = -ETIMEDOUT; \ -+ break; \ -+ } \ -+ msleep(1); \ -+ } \ -+ ret__; \ -+}) -+ -+struct mwv207_pipe_2d { -+ struct mwv207_pipe base; -+ struct mwv207_bo *ring_bo; -+ struct mwv207_device *jdev; -+ u32 *ring_start; -+ u32 *ring_end; -+ u32 *head; -+ u32 *tail; -+ u32 *last_wait; -+ u64 ring_start_addr; -+ int id; -+ unsigned int irq; -+ -+ u64 fence_ctx; -+ u32 next_fence; -+ u32 completed_fence; -+ spinlock_t fence_lock; -+ spinlock_t fence_queue_lock; -+ struct list_head fence_queue; -+}; -+ -+struct pipe_2d_fence { -+ struct dma_fence base; -+ struct mwv207_pipe_2d *pipe; -+ u32 *rpos; -+ -+ struct list_head q; -+}; -+ -+#define to_pipe_2d(p) container_of(p, struct mwv207_pipe_2d, base) -+#define to_pipe_2d_fence(f) container_of(f, struct pipe_2d_fence, base) -+ -+static inline void pipe_2d_write(struct mwv207_pipe_2d *pipe, -+ u32 reg, u32 value) -+{ -+ pipe_write(&pipe->base, reg, value); -+} -+ -+static inline u32 pipe_2d_read(struct mwv207_pipe_2d *pipe, u32 reg) -+{ -+ return pipe_read(&pipe->base, reg); -+} -+ -+static inline void pipe_2d_barrier(struct mwv207_pipe_2d *pipe) -+{ -+ pipe_2d_read(pipe, 0x4100); -+ mb(); -+} -+ -+ -+static inline bool fence16_after(u16 a, u16 b) -+{ -+ return (s16)(a - b) > 0; -+} -+ -+static inline bool fence_after(u32 a, u32 b) -+{ -+ return (s32)(a - b) > 0; -+} -+ -+static const char *pipe_2d_fence_get_driver_name(struct dma_fence *fence) -+{ -+ return "mwv207"; -+} -+ -+static const char *pipe_2d_fence_get_timeline_name(struct dma_fence *fence) -+{ -+ return to_pipe_2d_fence(fence)->pipe->base.fname; -+} -+ -+static bool pipe_2d_fence_signaled(struct dma_fence *fence) -+{ -+ struct pipe_2d_fence *f = to_pipe_2d_fence(fence); -+ -+ return fence_after(f->pipe->completed_fence, f->base.seqno); -+} -+ -+static void pipe_2d_fence_release(struct dma_fence *fence) -+{ -+ struct pipe_2d_fence *f = to_pipe_2d_fence(fence); -+ -+ kfree_rcu(f, base.rcu); -+} -+ -+static const struct dma_fence_ops pipe_2d_fence_ops = { -+ .get_driver_name = pipe_2d_fence_get_driver_name, -+ .get_timeline_name = pipe_2d_fence_get_timeline_name, -+ .signaled = pipe_2d_fence_signaled, -+ .release = pipe_2d_fence_release, -+}; -+ -+static inline u32 pipe_2d_ptr_span(void *end, void *start) -+{ -+ return (unsigned long)end - (unsigned long)start; -+} -+ -+static inline u32 pipe_2d_gpu_addr(struct mwv207_pipe_2d *pipe, u32 *ptr) -+{ -+ return pipe->ring_start_addr + pipe_2d_ptr_span(ptr, pipe->ring_start); -+} -+ -+static inline bool pipe_2d_idle_on_noc(struct mwv207_pipe_2d *pipe) -+{ -+ struct mwv207_device *jdev = pipe->jdev; -+ u32 pending1, pending2; -+ u32 val; -+ -+ pending1 = jdev->lite ? 0x70038000 : 0xF87FC000; -+ pending2 = jdev->lite ? 0x00000000 : 0x0000000F; -+ -+ val = jdev_read(jdev, (0x009B0194)); -+ if ((val & pending1) != pending1) -+ return false; -+ val = jdev_read(jdev, (0x009B0198)); -+ if ((val & pending2) != pending2) -+ return false; -+ return true; -+} -+ -+static int pipe_2d_hw_init(struct mwv207_pipe_2d *pipe) -+{ -+ int ret; -+ u32 val; -+ -+ ret = wait_for(pipe_2d_idle_on_noc(pipe), 5000); -+ if (ret) { -+ pr_err("mwv207: failed to wait %s idle, %#x %#x", -+ pipe->base.fname, -+ jdev_read(pipe->jdev, (0x009B0194)), -+ jdev_read(pipe->jdev, (0x009B0198))); -+ return ret; -+ } -+ -+ -+ val = jdev_read(pipe->jdev, (0x009B0048)); -+ val &= ~(1 << 8); -+ jdev_write(pipe->jdev, (0x009B0048), val); -+ -+ -+ val = jdev_read(pipe->jdev, (0x009B0014)); -+ val &= ~(1 << 16); -+ jdev_write(pipe->jdev, (0x009B0014), val); -+ -+ -+ val = jdev_read(pipe->jdev, (0x009B0048)); -+ val |= 1 << 8; -+ jdev_write(pipe->jdev, (0x009B0048), val); -+ -+ -+ val = jdev_read(pipe->jdev, (0x009B0014)); -+ val |= 1 << 16; -+ jdev_write(pipe->jdev, (0x009B0014), val); -+ -+ msleep(10); -+ -+ -+ pipe_2d_write(pipe, 0x4800, 0); -+ -+ ret = wait_for(pipe_2d_read(pipe, 0x4800), 5000); -+ if (ret) { -+ pr_err("mwv207: failed to reset %s status RAM", -+ pipe->base.fname); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static void pipe_2d_reset_ring(struct mwv207_pipe_2d *pipe) -+{ -+ struct pipe_2d_fence *fence, *p; -+ unsigned long flags; -+ -+ pipe->head = pipe->ring_start; -+ pipe->tail = pipe->ring_start; -+ -+ spin_lock_irqsave(&pipe->fence_queue_lock, flags); -+ list_for_each_entry_safe(fence, p, &pipe->fence_queue, q) { -+ list_del(&fence->q); -+ dma_fence_put(&fence->base); -+ } -+ spin_unlock_irqrestore(&pipe->fence_queue_lock, flags); -+} -+ -+static u32 *pipe_2d_append_wl(struct mwv207_pipe_2d *pipe) -+{ -+ u32 *wait = pipe->tail; -+ -+ *pipe->tail++ = 0x88000000; -+ *pipe->tail++ = 0x80000000; -+ *pipe->tail++ = 0x89000000; -+ *pipe->tail++ = pipe_2d_gpu_addr(pipe, wait);; -+ -+ return wait; -+} -+ -+static void pipe_2d_start(struct mwv207_pipe_2d *pipe) -+{ -+ u32 regval = pipe->ring_start_addr >> 4 | 1 << 29; -+ -+ pipe_2d_write(pipe, 0x4200, regval); -+ -+ *pipe->tail++ = 0x80000000; -+ *pipe->tail++ = 1; -+ *pipe->tail++ = 0x80000000; -+ *pipe->tail++ = 0x80000000; -+ -+ pipe->last_wait = pipe_2d_append_wl(pipe); -+ BUG_ON(pipe_2d_ptr_span(pipe->tail, pipe->ring_start) != 32); -+ pipe_2d_barrier(pipe); -+ pipe_2d_write(pipe, 0x4C00, 1); -+ -+ dev_dbg(pipe->base.jdev->dev, "start 2d wait link at 0x%llx", -+ pipe->ring_start_addr); -+} -+ -+static inline void pipe_2d_stop(struct mwv207_pipe_2d *pipe) -+{ -+ pr_info("mwv207: %s %s TBD", pipe->base.fname, __func__); -+} -+ -+static void mwv207_pipe_2d_reset(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); -+ -+ if (pipe_2d_hw_init(pipe)) -+ return; -+ pipe_2d_reset_ring(pipe); -+ pipe_2d_start(pipe); -+} -+ -+static u32 *pipe_2d_wait_for_space(struct mwv207_pipe_2d *pipe, u32 size) -+{ -+ int i; -+ -+ for (i = 0; i < 10000; i++) { -+ u32 *head = READ_ONCE(pipe->head); -+ if (head <= pipe->tail) { -+ if (pipe_2d_ptr_span(pipe->ring_end, pipe->tail) >= size) -+ return pipe->tail; -+ if (pipe_2d_ptr_span(head, pipe->ring_start) >= size) -+ return pipe->ring_start; -+ } else { -+ if (pipe_2d_ptr_span(head, pipe->tail) >= size) -+ return pipe->tail; -+ } -+ usleep_range(200, 200); -+ } -+ -+ return NULL; -+} -+ -+static struct dma_fence *pipe_2d_append_fence(struct mwv207_pipe_2d *pipe) -+{ -+ struct pipe_2d_fence *fence; -+ unsigned long flags; -+ u32 regno; -+ -+ fence = kzalloc(sizeof(struct pipe_2d_fence), GFP_KERNEL); -+ if (!fence) { -+ pr_err("mwv207: failed to alloc memory for %s", -+ pipe->base.fname); -+ return ERR_PTR(-ENOMEM); -+ } -+ dma_fence_init(&fence->base, &pipe_2d_fence_ops, &pipe->fence_lock, -+ pipe->fence_ctx, ++pipe->next_fence); -+ fence->pipe = pipe; -+ fence->rpos = pipe->tail; -+ regno = (pipe->next_fence & 0x1f) + 1; -+ -+ spin_lock_irqsave(&pipe->fence_queue_lock, flags); -+ list_add_tail(&fence->q, &pipe->fence_queue); -+ spin_unlock_irqrestore(&pipe->fence_queue_lock, flags); -+ -+ *pipe->tail++ = (0x40000000 | 0x6000 | (0) << 2); -+ *pipe->tail++ = (u32)(fence->base.seqno & 0xffff); -+ *pipe->tail++ = (0x40000000 | 0x6000 | (regno) << 2); -+ *pipe->tail++ = regno; -+ -+ pipe_2d_write(pipe, 0x6000 + regno * 4, regno); -+ -+ dma_fence_get(&fence->base); -+ return &fence->base; -+} -+ -+static void pipe_2d_wtol(struct mwv207_pipe_2d *pipe, u32 *start, u32 *new_wait) -+{ -+ u32 *pos = pipe->last_wait; -+ -+ pos[1] = pipe_2d_gpu_addr(pipe, start); -+ pipe_2d_barrier(pipe); -+ pos[0] = 0x89000000; -+ pipe_2d_barrier(pipe); -+ pipe_2d_write(pipe, 0x4C00, 1); -+ -+ pipe->last_wait = new_wait; -+} -+ -+static void mwv207_pipe_2d_dump_state(struct mwv207_pipe *mpipe) -+{ -+ pr_info("%s %08x: %08x, %08x: %08x", mpipe->fname, -+ 0x4100, pipe_read(mpipe, 0x4100), -+ 0x961100, jdev_read(mpipe->jdev, 0x961100)); -+} -+ -+static struct dma_fence * -+mwv207_pipe_2d_submit(struct mwv207_pipe *mpipe, struct mwv207_job *mjob) -+{ -+ struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); -+ u32 size = ALIGN(mjob->cmd_size, 16) + 128; -+ u32 *start, *wait, *last_tail, nop_cnt; -+ struct dma_fence *fence; -+ -+ start = pipe_2d_wait_for_space(pipe, size); -+ if (!start) { -+ pr_err("mwv207: %s is stuck", mpipe->fname); -+ return ERR_PTR(-EBUSY); -+ } -+ last_tail = pipe->tail; -+ pipe->tail = start; -+ -+ -+ *pipe->tail++ = 0x80000000; -+ pipe->tail++; -+ *pipe->tail++ = 0x80000000; -+ *pipe->tail++ = 0x80000000; -+ -+ -+ memcpy_toio(pipe->tail, mjob->cmds, mjob->cmd_size); -+ pipe->tail += mjob->cmd_size >> 2; -+ for (nop_cnt = (ALIGN(mjob->cmd_size, 16) - mjob->cmd_size); -+ nop_cnt > 0; nop_cnt -= 4) -+ *pipe->tail++ = 0x80000000; -+ -+ -+ fence = pipe_2d_append_fence(pipe); -+ if (IS_ERR(fence)) { -+ pipe->tail = last_tail; -+ return fence; -+ } -+ -+ -+ wait = pipe_2d_append_wl(pipe); -+ -+ -+ BUG_ON(pipe_2d_ptr_span(pipe->tail, start) & 0xf); -+ start[1] = pipe_2d_ptr_span(pipe->tail, start) / 16 - 1; -+ -+ -+ pipe_2d_wtol(pipe, start, wait); -+ -+ BUG_ON(pipe_2d_ptr_span(pipe->tail, start) > size); -+ -+ return fence; -+} -+ -+static irqreturn_t mwv207_pipe_2d_isr(int irq_unused, void *data) -+{ -+ struct mwv207_pipe_2d *pipe = data; -+ struct pipe_2d_fence *fence, *p; -+ u32 seqno; -+ -+ pipe_2d_write(pipe, 0x4308, 0xFFFFFFFF); -+ seqno = pipe_2d_read(pipe, 0x6000); -+ -+ spin_lock(&pipe->fence_queue_lock); -+ list_for_each_entry_safe(fence, p, &pipe->fence_queue, q) { -+ if (fence16_after(fence->base.seqno & 0xffff, seqno & 0xffff)) -+ break; -+ list_del(&fence->q); -+ pipe->completed_fence = fence->base.seqno; -+ WRITE_ONCE(pipe->head, fence->rpos); -+ mwv207_devfreq_record_idle(&pipe->base); -+ dma_fence_signal(&fence->base); -+ dma_fence_put(&fence->base); -+ } -+ spin_unlock(&pipe->fence_queue_lock); -+ -+ return IRQ_HANDLED; -+} -+ -+static void mwv207_pipe_2d_destroy(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); -+ struct mwv207_bo *mbo = pipe->ring_bo; -+ int ret; -+ -+ free_irq(pipe->irq, pipe); -+ pipe_2d_stop(pipe); -+ -+ ret = mwv207_bo_reserve(mbo, true); -+ if (ret) { -+ pr_err("mwv207: failed to reserve bo"); -+ return; -+ } -+ mwv207_bo_kunmap_reserved(mbo); -+ mwv207_bo_unpin_reserved(mbo); -+ mwv207_bo_unreserve(mbo); -+ mwv207_bo_unref(mbo); -+ -+ mwv207_devfreq_unregister(mpipe); -+} -+ -+static unsigned long pipe_2d_max_freq_get(struct mwv207_device *jdev) -+{ -+ unsigned long freq; -+ -+ switch (jdev->base.pdev->subsystem_device) { -+ case 0x9103: -+ freq = 600; -+ break; -+ case 0x9210: -+ case 0x9211: -+ freq = 800; -+ break; -+ case 0x930B: -+ freq = 1000; -+ break; -+ case 0x9101: -+ case 0x9102: -+ case 0x910A: -+ case 0x910B: -+ case 0x910C: -+ case 0x9200: -+ case 0x920A: -+ case 0x920B: -+ case 0x920C: -+ case 0x9230: -+ case 0x9231: -+ case 0x930A: -+ case 0x930C: -+ freq = 1200; -+ break; -+ default: -+ freq = DEFAULT_MAX_FREQ_2D; -+ break; -+ } -+ -+ return freq; -+} -+ -+struct mwv207_pipe *mwv207_pipe_2d_create(struct mwv207_device *jdev, -+ int id, u32 regbase, -+ const char *fname) -+{ -+ struct mwv207_pipe_2d *pipe; -+ struct mwv207_bo *mbo; -+ void *addr; -+ int ret; -+ -+ pipe = devm_kzalloc(jdev->dev, sizeof(*pipe), GFP_KERNEL); -+ if (!pipe) -+ return NULL; -+ pipe->base.pll_id = MWV207_PLL_GU2D_PLL; -+ pipe->base.jdev = jdev; -+ pipe->base.fname = fname; -+ pipe->base.regbase = jdev->mmio + regbase; -+ pipe->base.iosize = 32 * 1024; -+ pipe->base.submit = mwv207_pipe_2d_submit; -+ pipe->base.reset = mwv207_pipe_2d_reset; -+ pipe->base.destroy = mwv207_pipe_2d_destroy; -+ pipe->base.dump_state = mwv207_pipe_2d_dump_state; -+ -+ pipe->jdev = jdev; -+ pipe->id = id; -+ pipe->fence_ctx = dma_fence_context_alloc(1); -+ INIT_LIST_HEAD(&pipe->fence_queue); -+ spin_lock_init(&pipe->fence_lock); -+ spin_lock_init(&pipe->fence_queue_lock); -+ -+ ret = mwv207_devfreq_register(&pipe->base, pipe_2d_max_freq_get(jdev)); -+ if (ret) -+ pipe->base.devfreq = NULL; -+ -+ ret = mwv207_bo_create(jdev, 0x40000, 0x1000, -+ ttm_bo_type_kernel, 0x2, -+ (1<<0), &mbo); -+ if (ret) -+ goto unregister_devfreq; -+ -+ ret = mwv207_bo_reserve(mbo, true); -+ if (ret) -+ goto free_bo; -+ ret = mwv207_bo_pin_reserved(mbo, 0x2); -+ if (ret) -+ goto unreserve_bo; -+ ret = mwv207_bo_kmap_reserved(mbo, &addr); -+ if (ret) -+ goto unpin_bo; -+ pipe->ring_bo = mbo; -+ -+ pipe->ring_start = (u32 *)addr; -+ pipe->ring_start_addr = mwv207_bo_gpu_phys(mbo); -+ pipe->ring_end = pipe->ring_start + (0x40000 >> 2); -+ -+ mwv207_pipe_2d_reset(&pipe->base); -+ -+ pipe->irq = irq_find_mapping(jdev->irq_domain, 17 + id); -+ if (pipe->irq == 0) { -+ pr_err("mwv207: failed to find %s irq mapping", fname); -+ goto unmap_bo; -+ } -+ -+ ret = request_irq(pipe->irq, mwv207_pipe_2d_isr, 0, fname, pipe); -+ if (ret) { -+ pr_err("mwv207: failed to request irq for %s", fname); -+ goto unmap_bo; -+ } -+ -+ mwv207_bo_unreserve(mbo); -+ -+ return &pipe->base; -+unmap_bo: -+ mwv207_bo_kunmap_reserved(mbo); -+unpin_bo: -+ mwv207_bo_unpin_reserved(mbo); -+unreserve_bo: -+ mwv207_bo_unreserve(mbo); -+free_bo: -+ mwv207_bo_unref(mbo); -+unregister_devfreq: -+ mwv207_devfreq_unregister(&pipe->base); -+ return NULL; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_3d.c b/drivers/gpu/drm/mwv207/mwv207_pipe_3d.c -new file mode 100644 -index 000000000..db6b9d977 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_3d.c -@@ -0,0 +1,613 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207_bo.h" -+#include "mwv207_sched.h" -+#include "mwv207_vbios.h" -+#include "mwv207_devfreq.h" -+ -+#define DEFAULT_MAX_FREQ_3D 600 -+ -+#define to_3d_pipe(pipe) container_of(pipe, struct mwv207_pipe_3d, base) -+struct mwv207_pipe_3d { -+ struct mwv207_pipe base; -+ struct mwv207_bo *ringbuf_bo; -+ u32 *ringbuf; -+ u32 *head; -+ u32 *tail; -+ u32 *end; -+ u32 ringbuf_gpu_addr; -+ int unit; -+ unsigned int irq; -+ -+ u64 fence_ctx; -+ u32 next_fence; -+ u32 completed_fence; -+ spinlock_t fence_lock; -+ -+ DECLARE_BITMAP(event_bitmap, 30); -+ struct dma_fence *event_fence[30]; -+ spinlock_t event_lock; -+}; -+ -+#define to_pipe_3d_fence(f) container_of(f, struct pipe_3d_fence, base) -+struct pipe_3d_fence { -+ struct dma_fence base; -+ u32 *rpos; -+ struct mwv207_pipe_3d *pipe; -+}; -+ -+static inline void pipe_3d_write(struct mwv207_pipe_3d *pipe, u32 reg, u32 value) -+{ -+ pipe_write(&pipe->base, reg, value); -+} -+ -+static inline u32 pipe_3d_read(struct mwv207_pipe_3d *pipe, u32 reg) -+{ -+ return pipe_read(&pipe->base, reg); -+} -+ -+ -+static inline bool fence_after(u32 a, u32 b) -+{ -+ return (s32)(a - b) > 0; -+} -+ -+static const char *pipe_3d_fence_get_driver_name(struct dma_fence *fence) -+{ -+ return "mwv207"; -+} -+ -+static const char *pipe_3d_fence_get_timeline_name(struct dma_fence *fence) -+{ -+ return to_pipe_3d_fence(fence)->pipe->base.fname; -+} -+ -+static bool pipe_3d_fence_signaled(struct dma_fence *fence) -+{ -+ struct pipe_3d_fence *f = to_pipe_3d_fence(fence); -+ -+ return fence_after(f->pipe->completed_fence, f->base.seqno); -+} -+ -+static void pipe_3d_fence_release(struct dma_fence *fence) -+{ -+ struct pipe_3d_fence *f = to_pipe_3d_fence(fence); -+ -+ kfree_rcu(f, base.rcu); -+} -+ -+static const struct dma_fence_ops pipe_3d_fence_ops = { -+ .get_driver_name = pipe_3d_fence_get_driver_name, -+ .get_timeline_name = pipe_3d_fence_get_timeline_name, -+ .signaled = pipe_3d_fence_signaled, -+ .release = pipe_3d_fence_release, -+}; -+ -+ -+static inline struct dma_fence *pipe_3d_event_pop_irq(struct mwv207_pipe_3d *pipe, u32 event) -+{ -+ struct dma_fence *fence; -+ -+ spin_lock(&pipe->event_lock); -+ fence = pipe->event_fence[event]; -+ pipe->event_fence[event] = NULL; -+ clear_bit(event, pipe->event_bitmap); -+ spin_unlock(&pipe->event_lock); -+ -+ return fence; -+} -+ -+ -+static inline u32 pipe_3d_event_push(struct mwv207_pipe_3d *pipe, struct dma_fence *fence) -+{ -+ u32 event; -+ -+ spin_lock_irq(&pipe->event_lock); -+ event = find_first_zero_bit(pipe->event_bitmap, 30); -+ if (likely(event < 30)) -+ pipe->event_fence[event] = dma_fence_get(fence); -+ set_bit(event, pipe->event_bitmap); -+ spin_unlock_irq(&pipe->event_lock); -+ -+ -+ BUG_ON(event >= 30); -+ -+ return event; -+} -+ -+static inline u32 pipe_3d_ptr_span(void *end, void *start) -+{ -+ return (unsigned long)end - (unsigned long)start; -+} -+ -+static inline u32 pipe_3d_gpu_addr(struct mwv207_pipe_3d *pipe, u32 *ptr) -+{ -+ return pipe->ringbuf_gpu_addr + pipe_3d_ptr_span(ptr, pipe->ringbuf); -+} -+ -+static inline void pipe_3d_link(struct mwv207_pipe_3d *pipe, u32 prefetch, u32 addr) -+{ -+ pipe->tail = PTR_ALIGN(pipe->tail, 8); -+ BUG_ON(pipe->tail >= pipe->end - 1 -+ || (((prefetch + 7) / 8) & 0xffff0000) -+ || addr & 0x7); -+ *pipe->tail++ = 0x40000000 | ((prefetch + 7) / 8); -+ *pipe->tail++ = addr; -+} -+ -+static inline void pipe_3d_wait(struct mwv207_pipe_3d *pipe) -+{ -+ pipe->tail = PTR_ALIGN(pipe->tail, 8); -+ BUG_ON(pipe->tail >= pipe->end); -+ -+ *pipe->tail++ = 0x38000000 | 200; -+} -+ -+static inline void pipe_3d_wl(struct mwv207_pipe_3d *pipe) -+{ -+ pipe_3d_wait(pipe); -+ pipe_3d_link(pipe, 16, pipe_3d_gpu_addr(pipe, pipe->tail) - 4); -+} -+ -+static inline void pipe_3d_wtol(struct mwv207_pipe_3d *pipe, u32 *w, u32 target, u32 size) -+{ -+ BUG_ON((((size + 7) / 8) & 0xffff0000) || target & 0x7 -+ || w < pipe->ringbuf || w >= pipe->end - 1); -+ w[1] = target; -+ pipe_3d_read(pipe, 0x4); -+ mb(); -+ w[0] = 0x40000000 | ((size + 7) / 8); -+} -+ -+static inline void pipe_3d_loadstate(struct mwv207_pipe_3d *pipe, u32 reg, u32 val) -+{ -+ pipe->tail = PTR_ALIGN(pipe->tail, 8); -+ BUG_ON(pipe->tail >= pipe->end - 1); -+ -+ *pipe->tail++ = 0x08010000 | reg; -+ *pipe->tail++ = val; -+} -+ -+static inline void pipe_3d_sem(struct mwv207_pipe_3d *pipe, u32 from, u32 to) -+{ -+ from &= 0x1f; -+ to &= 0x1f; -+ to <<= 8; -+ pipe_3d_loadstate(pipe, 0x0e02, from | to); -+} -+ -+static inline void pipe_3d_stall(struct mwv207_pipe_3d *pipe, u32 from, u32 to) -+{ -+ pipe->tail = PTR_ALIGN(pipe->tail, 8); -+ BUG_ON(pipe->tail >= pipe->end - 1); -+ from &= 0x1f; -+ to &= 0x1f; -+ to <<= 8; -+ *pipe->tail++ = 0x48000000; -+ *pipe->tail++ = from | to; -+} -+ -+static inline void pipe_3d_start(struct mwv207_pipe_3d *pipe) -+{ -+ u32 *start = pipe->tail; -+ u32 len; -+ -+ dev_dbg(pipe->base.jdev->dev, "start wait link at 0x%x", pipe->ringbuf_gpu_addr); -+ pipe_3d_loadstate(pipe, 0x0e21, 0x00020202); -+ pipe_3d_loadstate(pipe, 0x0e44, 0x0000000f); -+ pipe_3d_loadstate(pipe, 0x0e80, 0x00000000); -+ pipe_3d_loadstate(pipe, 0x7003, 0x00000001); -+ -+ pipe_3d_wl(pipe); -+ -+ len = (pipe->tail - start) * 4; -+ pipe_3d_write(pipe, 0x014, 0xffffffff); -+ pipe_3d_write(pipe, 0x654, pipe->ringbuf_gpu_addr); -+ pipe_3d_read(pipe, 0x4); -+ mb(); -+ pipe_3d_write(pipe, 0x658, 0x10000 | (len / 8)); -+ pipe_3d_write(pipe, 0x3a4, 0x10000 | (len / 8)); -+} -+ -+static inline int pipe_3d_stop(struct mwv207_pipe_3d *pipe) -+{ -+ pr_info("%s TBD", __func__); -+ return 0; -+} -+ -+static void pipe_3d_core_reset(struct mwv207_pipe_3d *pipe) -+{ -+ int i; -+ -+ for (i = 0; i < 2; i++) { -+ -+ pipe_3d_write(pipe, 0x104, 0); -+ -+ pipe_3d_write(pipe, 0x10c, 0x015b0880); -+ pipe_3d_write(pipe, 0x10c, 0x015b0881); -+ pipe_3d_write(pipe, 0x10c, 0x015b0880); -+ -+ pipe_3d_write(pipe, 0x000, 0x00010b00); -+ pipe_3d_write(pipe, 0x000, 0x00010900); -+ -+ usleep_range(1000, 1001); -+ -+ pipe_3d_write(pipe, 0x000, 0x00090900); -+ -+ -+ pipe_3d_write(pipe, 0x3a8, 1); -+ pipe_3d_write(pipe, 0x3a8, 0); -+ -+ -+ usleep_range(1000, 1001); -+ -+ -+ pipe_3d_write(pipe, 0x000, 0x00010900); -+ } -+} -+ -+static void pipe_3d_hw_init(struct mwv207_pipe_3d *pipe) -+{ -+ pipe_3d_write(pipe, 0x000, 0x00010900); -+ pipe_3d_core_reset(pipe); -+ -+ pipe_3d_write(pipe, 0x55c, 0x00ffffff); -+ pipe_3d_write(pipe, 0x414, 0x3c000000); -+ pipe_3d_write(pipe, 0x090, -+ pipe_3d_read(pipe, 0x090) & 0xffffffbf); -+ -+ pipe_3d_write(pipe, 0x000, 0x00010900); -+ pipe_3d_write(pipe, 0x000, 0x00070100); -+ pipe_3d_write(pipe, 0x3ac, 0x00002300); -+ pipe_3d_write(pipe, 0x3a8, 0x2); -+ -+ pipe_3d_write(pipe, 0x03c, 0xffffffff); -+ pipe_3d_write(pipe, 0x03c, 0x00000000); -+ -+ pipe_3d_write(pipe, 0x100, 0x00140021); -+ -+ -+ -+ pipe_3d_write(pipe, 0x154, 0x1); -+ pipe_3d_write(pipe, 0x104, 0x00430408); -+ pipe_3d_write(pipe, 0x10c, 0x015b0880); -+} -+ -+static void mwv207_pipe_3d_reset(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); -+ int i; -+ -+ -+ spin_lock_irq(&pipe->event_lock); -+ bitmap_zero(pipe->event_bitmap, 30); -+ for (i = 0; i < 30; i++) { -+ dma_fence_put(pipe->event_fence[i]); -+ pipe->event_fence[i] = NULL; -+ } -+ spin_unlock_irq(&pipe->event_lock); -+ -+ pipe_3d_hw_init(pipe); -+ pipe->tail = pipe->ringbuf; -+ pipe->head = pipe->ringbuf; -+ -+ pipe_3d_start(pipe); -+} -+ -+ -+static u32 *pipe_3d_wait_for_space(struct mwv207_pipe_3d *pipe, u32 size) -+{ -+ u32 *head; -+ int i; -+ -+ for (i = 0; i < 10000; ++i) { -+ head = READ_ONCE(pipe->head); -+ -+ if (head <= pipe->tail) { -+ if (pipe_3d_ptr_span(pipe->end, pipe->tail) >= size) -+ return pipe->tail; -+ if (pipe_3d_ptr_span(head, pipe->ringbuf) >= size) -+ return pipe->ringbuf; -+ } else { -+ if (pipe_3d_ptr_span(head, pipe->tail) >= size) -+ return pipe->tail; -+ } -+ usleep_range(200, 200); -+ } -+ return NULL; -+} -+ -+static struct dma_fence *mwv207_pipe_3d_submit(struct mwv207_pipe *mpipe, -+ struct mwv207_job *mjob) -+{ -+ struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); -+ struct pipe_3d_fence *fence; -+ u32 *last_tail, *start; -+ u32 size, event; -+ -+ size = ALIGN(mjob->cmd_size, 8) + 256; -+ last_tail = pipe->tail; -+ start = pipe_3d_wait_for_space(pipe, size); -+ if (start == NULL) { -+ pr_err("mwv207: engine 3d is stuck"); -+ -+ return ERR_PTR(-EBUSY); -+ } -+ memcpy_toio(start, mjob->cmds, mjob->cmd_size); -+ pipe->tail = start + mjob->cmd_size / 4; -+ -+ pipe_3d_loadstate(pipe, 0x0e03, 0xc63); -+ pipe_3d_loadstate(pipe, 0x594, 0x41); -+ -+ pipe_3d_sem(pipe, 0x7, 0x1); -+ pipe_3d_stall(pipe, 0x7, 0x1); -+ pipe_3d_loadstate(pipe, 0x502e, 0x1); -+ pipe_3d_loadstate(pipe, 0x502b, 0x3); -+ pipe_3d_sem(pipe, 0x10, 0x1); -+ pipe_3d_stall(pipe, 0x10, 0x1); -+ pipe_3d_loadstate(pipe, 0x502e, 0x0); -+ -+ -+ fence = kzalloc(sizeof(struct pipe_3d_fence), GFP_KERNEL); -+ if (!fence) { -+ pipe->tail = last_tail; -+ pr_err("mwv207: failed to alloc memory for 3d pipe"); -+ -+ return ERR_PTR(-ENOMEM); -+ } -+ dma_fence_init(&fence->base, &pipe_3d_fence_ops, &pipe->fence_lock, -+ pipe->fence_ctx, ++pipe->next_fence); -+ fence->rpos = pipe->tail; -+ fence->pipe = pipe; -+ event = pipe_3d_event_push(pipe, &fence->base); -+ -+ -+ pipe_3d_loadstate(pipe, 0x502e, 0x1); -+ pipe_3d_loadstate(pipe, 0x50ce, 0xf); -+ pipe_3d_loadstate(pipe, 0x0e01, 0x80 | event); -+ pipe_3d_loadstate(pipe, 0x502e, 0x0); -+ -+ -+ pipe_3d_wl(pipe); -+ BUG_ON(pipe_3d_ptr_span(pipe->tail, start) > size); -+ pipe_3d_wtol(pipe, last_tail - 4, pipe_3d_gpu_addr(pipe, start), -+ pipe_3d_ptr_span(pipe->tail, start)); -+ return &fence->base; -+} -+ -+static void mwv207_pipe_3d_dump_state(struct mwv207_pipe *mpipe) -+{ -+ u32 state0, addr0; -+ u32 state1, addr1; -+ int i; -+ -+ state0 = pipe_read(mpipe, 0x660); -+ addr0 = pipe_read(mpipe, 0x664); -+ for (i = 0; i < 500; ++i) { -+ state1 = pipe_read(mpipe, 0x660); -+ addr1 = pipe_read(mpipe, 0x664); -+ if (state1 != state0 || addr1 != addr0) -+ break; -+ } -+ -+ if (state1 != state0) -+ pr_info("%s state changing, s0: 0x%08x, s1: 0x%08x", mpipe->fname, state0, state1); -+ pr_info("%s current stat: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x660)); -+ -+ if (addr1 != addr0) -+ pr_info("%s addr changing, a0: 0x%08x, a1: 0x%08x", mpipe->fname, addr0, addr1); -+ pr_info("%s current addr: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x664)); -+ -+ pr_info("%s current cmdl: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x668)); -+ pr_info("%s current cmdh: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x66c)); -+} -+ -+static irqreturn_t mwv207_pipe_3d_isr(int irq_unused, void *dev_id) -+{ -+ struct mwv207_pipe_3d *pipe = dev_id; -+ struct dma_fence *fence; -+ u32 event, intr; -+ -+ intr = pipe_3d_read(pipe, 0x10); -+ if (unlikely(!intr)) { -+ pr_warn("mwv207: 3d interrupt with no event"); -+ return IRQ_NONE; -+ } -+ if (unlikely(intr & 0x80000000)) { -+ pr_warn("mwv207: 3d axi bus error"); -+ intr &= ~0x80000000; -+ } -+ if (unlikely(intr & 0x40000000)) { -+ pr_warn("mwv207: 3d mmu error"); -+ intr &= ~0x40000000; -+ } -+ while ((event = ffs(intr))) { -+ event -= 1; -+ intr &= ~(1 << event); -+ -+ fence = pipe_3d_event_pop_irq(pipe, event); -+ if (!fence) { -+ pr_warn("unexpected event: %d", event); -+ continue; -+ } -+ -+ if (fence_after(fence->seqno, pipe->completed_fence)) { -+ struct pipe_3d_fence *pipe_fence = to_pipe_3d_fence(fence); -+ -+ pipe->completed_fence = fence->seqno; -+ pipe->head = pipe_fence->rpos; -+ } -+ mwv207_devfreq_record_idle(&pipe->base); -+ dma_fence_signal(fence); -+ dma_fence_put(fence); -+ } -+ return IRQ_HANDLED; -+} -+ -+static void mwv207_pipe_3d_destroy(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); -+ struct mwv207_bo *jbo; -+ int ret; -+ -+ free_irq(pipe->irq, pipe); -+ pipe_3d_stop(pipe); -+ -+ jbo = pipe->ringbuf_bo; -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) { -+ pr_info("failed to reserve bo"); -+ return; -+ } -+ mwv207_bo_kunmap_reserved(jbo); -+ mwv207_bo_unpin_reserved(jbo); -+ mwv207_bo_unreserve(jbo); -+ mwv207_bo_unref(jbo); -+ -+ mwv207_devfreq_unregister(mpipe); -+} -+ -+static unsigned long pipe_3d_max_freq_get(struct mwv207_device *jdev) -+{ -+ unsigned long freq; -+ -+ switch (jdev->base.pdev->subsystem_device) { -+ case 0x9103: -+ freq = 600; -+ break; -+ case 0x9210: -+ case 0x9211: -+ freq = 800; -+ break; -+ case 0x9101: -+ case 0x9102: -+ case 0x910A: -+ case 0x910B: -+ case 0x910C: -+ case 0x920C: -+ case 0x930B: -+ freq = 1000; -+ break; -+ case 0x9200: -+ case 0x920A: -+ case 0x920B: -+ case 0x9230: -+ case 0x9231: -+ case 0x930A: -+ case 0x930C: -+ freq = 1200; -+ break; -+ default: -+ freq = DEFAULT_MAX_FREQ_3D; -+ break; -+ } -+ -+ return freq; -+} -+ -+struct mwv207_pipe *mwv207_pipe_3d_create(struct mwv207_device *jdev, int unit, u32 regbase, -+ const char *fname) -+{ -+ struct mwv207_pipe_3d *pipe; -+ struct mwv207_bo *jbo; -+ void *logical; -+ int ret; -+ -+ if (jdev->lite && unit) -+ return NULL; -+ -+ pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_3d), GFP_KERNEL); -+ if (!pipe) -+ return NULL; -+ -+ pipe->base.pll_id = unit ? MWV207_PLL_GU3D1 : MWV207_PLL_GU3D0; -+ pipe->base.jdev = jdev; -+ pipe->base.fname = fname; -+ pipe->base.regbase = jdev->mmio + regbase; -+ pipe->base.iosize = 16 * 1024; -+ pipe->base.submit = mwv207_pipe_3d_submit; -+ pipe->base.reset = mwv207_pipe_3d_reset; -+ pipe->base.destroy = mwv207_pipe_3d_destroy; -+ pipe->base.dump_state = mwv207_pipe_3d_dump_state; -+ -+ pipe->unit = unit; -+ pipe->fence_ctx = dma_fence_context_alloc(1); -+ spin_lock_init(&pipe->fence_lock); -+ spin_lock_init(&pipe->event_lock); -+ -+ ret = mwv207_devfreq_register(&pipe->base, pipe_3d_max_freq_get(jdev)); -+ if (ret) -+ pipe->base.devfreq = NULL; -+ -+ ret = mwv207_bo_create(jdev, 0x40000, 0x1000, -+ ttm_bo_type_kernel, 0x2, (1<<0), -+ &jbo); -+ if (ret) -+ goto unregister_devfreq; -+ -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) -+ goto free_bo; -+ -+ ret = mwv207_bo_pin_reserved(jbo, 0x2); -+ if (ret) -+ goto unreserve_bo; -+ -+ ret = mwv207_bo_kmap_reserved(jbo, &logical); -+ if (ret) -+ goto unpin_bo; -+ -+ pipe->ringbuf_bo = jbo; -+ -+ -+ pipe->ringbuf = (u32 *)logical; -+ pipe->ringbuf_gpu_addr = mwv207_bo_gpu_phys(jbo); -+ pipe->end = pipe->ringbuf + (0x40000 / 4); -+ -+ mwv207_pipe_3d_reset(&pipe->base); -+ -+ pipe->irq = irq_find_mapping(jdev->irq_domain, 19 + unit); -+ if (pipe->irq == 0) { -+ pr_err("mwv207: failed to create 3D irq mapping"); -+ goto unmap_bo; -+ } -+ -+ ret = request_irq(pipe->irq, mwv207_pipe_3d_isr, 0, fname, pipe); -+ if (ret) { -+ pr_err("mwv207: failed to request 3d irq"); -+ goto unmap_bo; -+ } -+ -+ mwv207_bo_unreserve(jbo); -+ return &pipe->base; -+unmap_bo: -+ mwv207_bo_kunmap_reserved(jbo); -+unpin_bo: -+ mwv207_bo_unpin_reserved(jbo); -+unreserve_bo: -+ mwv207_bo_unreserve(jbo); -+free_bo: -+ mwv207_bo_unref(pipe->ringbuf_bo); -+unregister_devfreq: -+ mwv207_devfreq_unregister(&pipe->base); -+ return NULL; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.c b/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.c -new file mode 100644 -index 000000000..335fed150 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.c -@@ -0,0 +1,87 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_pipe_codec_common.h" -+ -+static void pipe_codec_sw_pp_submit_ex(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, -+ u64 vram, u32 reg, int nr) -+{ -+ if (sw_pp->wb_cnt >= JPIPE_WRITE_ENTRY_SIZE) { -+ dev_dbg(pipe->jdev->dev, "mwv207: too much write back entry"); -+ return; -+ } -+ -+ sw_pp->wb[sw_pp->wb_cnt].vram = vram; -+ sw_pp->wb[sw_pp->wb_cnt].reg = reg; -+ sw_pp->wb[sw_pp->wb_cnt].nr = nr; -+ -+ sw_pp->wb_cnt++; -+ sw_pp->pending = true; -+} -+ -+void pipe_codec_sw_pp_reset(struct pipe_codec_sw_pp *sw_pp) -+{ -+ sw_pp->wb_cnt = 0; -+} -+ -+void pipe_codec_sw_pp_excute(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe) -+{ -+ int i, j; -+ -+ if (!sw_pp->pending) -+ return; -+ -+ for (i = 0; i < sw_pp->wb_cnt; i++) { -+ for (j = 0; j < sw_pp->wb[i].nr && sw_pp->wb[i].reg + j * 4 <= pipe->iosize - 4; j++) -+ sw_pp->wb_buf[j] = pipe_read(pipe, sw_pp->wb[i].reg + j * 4); -+ -+ if (!j) -+ continue; -+ -+ jdev_write_vram(pipe->jdev, sw_pp->wb[i].vram, &sw_pp->wb_buf[0], j * 4); -+ } -+ -+ -+ wmb(); -+ -+ sw_pp->wb_cnt = 0; -+ sw_pp->pending = false; -+} -+ -+void pipe_codec_sw_pp_submit(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, -+ struct mwv207_job *mjob, int pos, int *cmdlen) -+{ -+ int nr, reg; -+ u64 vram; -+ u32 cmd; -+ -+ *cmdlen = 16; -+ -+ if (pos + 16 > mjob->cmd_size) { -+ dev_dbg(pipe->jdev->dev, -+ "mwv207: cmd %d write back out of range", pos); -+ return; -+ } -+ -+ cmd = *(u32 *)(mjob->cmds + pos); -+ reg = (cmd & 0xffff) * 4; -+ nr = (cmd >> 16) & 0x3ff; -+ if (nr == 0) -+ nr = 1024; -+ -+ vram = *(u64 *)(mjob->cmds + pos + 8); -+ pipe_codec_sw_pp_submit_ex(sw_pp, pipe, vram, reg, nr); -+} -+ -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.h b/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.h -new file mode 100644 -index 000000000..46ebfb86b ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.h -@@ -0,0 +1,42 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_sched.h" -+ -+#define MAX(a, b) ((a) > (b) ? (a) : (b)) -+#define JPIPE_WRITE_ENTRY_SIZE 16 -+#define JPIPE_ENC_REG_NUM 500 -+#define JPIPE_DEC_REG_NUM 503 -+#define JPIPE_REG_NUM MAX(JPIPE_ENC_REG_NUM, JPIPE_DEC_REG_NUM) -+ -+struct pipe_codec_wb_entry { -+ u64 vram; -+ u32 reg; -+ u32 nr; -+}; -+ -+ -+struct pipe_codec_sw_pp { -+ struct pipe_codec_wb_entry wb[JPIPE_WRITE_ENTRY_SIZE]; -+ u32 wb_buf[JPIPE_REG_NUM]; -+ int wb_cnt; -+ bool pending; -+}; -+ -+void pipe_codec_sw_pp_reset(struct pipe_codec_sw_pp *sw_pp); -+void pipe_codec_sw_pp_excute(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe); -+void pipe_codec_sw_pp_submit(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, -+ struct mwv207_job *mjob, int pos, int *cmdlen); -+ -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_dec.c b/drivers/gpu/drm/mwv207/mwv207_pipe_dec.c -new file mode 100644 -index 000000000..3b63a1cb3 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_dec.c -@@ -0,0 +1,264 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include "mwv207_pipe_codec_common.h" -+ -+#define to_dec_pipe(pipe) container_of(pipe, struct mwv207_pipe_dec, base) -+struct pipe_dec_fence; -+struct mwv207_pipe_dec { -+ struct mwv207_pipe base; -+ -+ u64 fence_ctx; -+ u64 fence_seqno; -+ spinlock_t fence_lock; -+ -+ struct pipe_dec_fence *current_fence; -+ struct task_struct *poll_thread; -+ struct pipe_codec_sw_pp sw_pp; -+}; -+ -+#define to_pipe_dec_fence(f) container_of(f, struct pipe_dec_fence, base) -+struct pipe_dec_fence { -+ struct dma_fence base; -+ struct mwv207_pipe_dec *pipe; -+ struct list_head node; -+}; -+ -+static inline void pipe_dec_write(struct mwv207_pipe_dec *pipe, u32 reg, u32 value) -+{ -+ pipe_write(&pipe->base, reg, value); -+} -+ -+static inline u32 pipe_dec_read(struct mwv207_pipe_dec *pipe, u32 reg) -+{ -+ return pipe_read(&pipe->base, reg); -+} -+ -+static const char *pipe_dec_fence_get_driver_name(struct dma_fence *fence) -+{ -+ return "mwv207"; -+} -+ -+static const char *pipe_dec_fence_get_timeline_name(struct dma_fence *fence) -+{ -+ return to_pipe_dec_fence(fence)->pipe->base.fname; -+} -+ -+static void pipe_dec_fence_release(struct dma_fence *fence) -+{ -+ struct pipe_dec_fence *f = to_pipe_dec_fence(fence); -+ -+ kfree_rcu(f, base.rcu); -+} -+ -+static const struct dma_fence_ops pipe_dec_fence_ops = { -+ .get_driver_name = pipe_dec_fence_get_driver_name, -+ .get_timeline_name = pipe_dec_fence_get_timeline_name, -+ .release = pipe_dec_fence_release, -+}; -+ -+static void pipe_dec_stat_reset(struct mwv207_pipe_dec *pipe, u32 stat) -+{ -+ pipe_dec_write(pipe, 0x4, 0x0); -+} -+ -+static int pipe_dec_polling(void *priv) -+{ -+ struct mwv207_pipe_dec *pipe = priv; -+ struct pipe_dec_fence *fence; -+ u32 stat; -+ -+ set_freezable(); -+ while (!kthread_should_stop()) { -+ usleep_range(1000, 1001); -+ try_to_freeze(); -+ -+ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence == NULL) -+ continue; -+ -+ stat = pipe_dec_read(pipe, 0x4); -+ if ((stat & 0x1100) != 0x1100) -+ continue; -+ -+ pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); -+ pipe_dec_stat_reset(pipe, stat); -+ -+ -+ smp_store_release(&pipe->current_fence, NULL); -+ -+ dma_fence_signal(&fence->base); -+ dma_fence_put(&fence->base); -+ } -+ -+ return 0; -+} -+ -+static void mwv207_pipe_dec_reset(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); -+ struct pipe_dec_fence *fence; -+ u32 stat; -+ int i; -+ -+ pipe_codec_sw_pp_reset(&pipe->sw_pp); -+ -+ stat = pipe_dec_read(pipe, 0x4); -+ if (stat & 0x1) -+ pipe_dec_write(pipe, 0x4, -+ 0x20 | 0x30); -+ -+ pipe_dec_write(pipe, 0x4, 0); -+ pipe_dec_write(pipe, 0x8, 0x454); -+ -+ -+ for (i = 12; i < pipe->base.iosize; i += 0x4) -+ pipe_dec_write(pipe, i, 0); -+ -+ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence) { -+ dma_fence_put(&fence->base); -+ -+ smp_store_release(&pipe->current_fence, NULL); -+ } -+} -+ -+static struct dma_fence *mwv207_pipe_dec_submit(struct mwv207_pipe *mpipe, -+ struct mwv207_job *mjob) -+{ -+ struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); -+ struct pipe_dec_fence *fence; -+ int i, nr, pos, cmdlen; -+ bool hw_run = 0; -+ u32 cmd, reg; -+ -+ /* sanity check, there should be no previous job. -+ * acquire pairs with release in polling thread -+ */ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence) -+ return ERR_PTR(-EBUSY); -+ -+ -+ for (pos = 0; pos <= mjob->cmd_size - 4; pos += cmdlen) { -+ cmd = *(u32 *)(mjob->cmds + pos); -+ switch ((cmd >> 27) & 0x1f) { -+ case 0x01: -+ if ((cmd >> 26) & 0x1) -+ return ERR_PTR(-EINVAL); -+ reg = (cmd & 0xffff) * 4; -+ nr = (cmd >> 16) & 0x3ff; -+ if (nr == 0) -+ nr = 1024; -+ for (i = pos + 4; i <= pos + nr * 4 -+ && i <= mjob->cmd_size - 4 -+ && reg <= pipe->base.iosize - 4; -+ i += 4, reg += 4) { -+ if (reg == 4) { -+ pipe_dec_read(pipe, 0x4); -+ hw_run = (*(u32 *)(mjob->cmds + i)) & 0x1; -+ -+ mb(); -+ } -+ pipe_dec_write(pipe, reg, *(u32 *)(mjob->cmds + i)); -+ } -+ -+ if (i <= pos + nr * 4) -+ dev_dbg(mpipe->jdev->dev, -+ "mwv207: invalid dec register writes dropped"); -+ -+ cmdlen = ALIGN(4 + nr * 4, 8); -+ break; -+ case 0x02: -+ pipe_codec_sw_pp_submit(&pipe->sw_pp, &pipe->base, mjob, pos, &cmdlen); -+ break; -+ default: -+ -+ return ERR_PTR(-EINVAL); -+ } -+ } -+ -+ -+ fence = kzalloc(sizeof(struct pipe_dec_fence), GFP_KERNEL); -+ if (!fence) -+ return ERR_PTR(-ENOMEM); -+ fence->pipe = pipe; -+ dma_fence_init(&fence->base, &pipe_dec_fence_ops, &pipe->fence_lock, -+ pipe->fence_ctx, ++pipe->fence_seqno); -+ -+ if (hw_run) { -+ dma_fence_get(&fence->base); -+ -+ smp_store_release(&pipe->current_fence, fence); -+ } else { -+ pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); -+ dma_fence_signal(&fence->base); -+ } -+ -+ return &fence->base; -+} -+ -+static void mwv207_pipe_dec_dump_state(struct mwv207_pipe *mpipe) -+{ -+ pr_info("%s irq state reg: 0x%08x", mpipe->fname, -+ pipe_read(mpipe, 0x4)); -+} -+ -+static void mwv207_pipe_dec_destroy(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); -+ -+ kthread_stop(pipe->poll_thread); -+} -+ -+struct mwv207_pipe *mwv207_pipe_dec_create(struct mwv207_device *jdev, int unit, u32 regbase, -+ const char *fname) -+{ -+ struct mwv207_pipe_dec *pipe; -+ -+ if (jdev->lite && unit) -+ return NULL; -+ -+ pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_dec), GFP_KERNEL); -+ if (!pipe) -+ return NULL; -+ -+ pipe->base.jdev = jdev; -+ pipe->base.fname = fname; -+ pipe->base.regbase = jdev->mmio + regbase; -+ pipe->base.iosize = JPIPE_DEC_REG_NUM * 4; -+ pipe->base.submit = mwv207_pipe_dec_submit; -+ pipe->base.reset = mwv207_pipe_dec_reset; -+ pipe->base.destroy = mwv207_pipe_dec_destroy; -+ pipe->base.dump_state = mwv207_pipe_dec_dump_state; -+ -+ spin_lock_init(&pipe->fence_lock); -+ pipe->fence_ctx = dma_fence_context_alloc(1); -+ pipe->fence_seqno = 0; -+ -+ mwv207_pipe_dec_reset(&pipe->base); -+ -+ pipe->poll_thread = kthread_run(pipe_dec_polling, pipe, "dec_polling"); -+ if (IS_ERR(pipe->poll_thread)) -+ return NULL; -+ -+ return &pipe->base; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_dma.c b/drivers/gpu/drm/mwv207/mwv207_pipe_dma.c -new file mode 100644 -index 000000000..974129a6b ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_dma.c -@@ -0,0 +1,418 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207_bo.h" -+#include "mwv207_sched.h" -+ -+#undef MWV207_DMA_DEBUG -+ -+#define DMA_MAX_LLI_COUNT (0x400000 / sizeof(struct mwv207_lli)) -+ -+#define DMA_TS_NOT_ALIGNED(size) ((size) - 1) -+#define DMA_TS_ALIGNED(size, alignment) (((size) >= (alignment)) ? ((size) / (alignment) - 1) : 0) -+#define DMA_CTL_NOT_ALIGNED ((1UL<<(63)) \ -+ | (1UL<<(58)) \ -+ | (1UL<<(30)) \ -+ | (1UL<<(38)) \ -+ | (1UL<<(47)) \ -+ | ((32ul & (0xFF))<<(39)) \ -+ | ((32ul & (0xFF))<<(48)) \ -+ | ((0UL & (0x7))<<(8)) \ -+ | ((0UL & (0x7))<<(11))) -+ -+#define DMA_CTL_ALIGNED(a) ((1UL<<(63)) \ -+ | (1UL<<(58)) \ -+ | (1UL<<(30)) \ -+ | (1UL<<(38)) \ -+ | (1UL<<(47)) \ -+ | ((32ul & (0xFF))<<(39)) \ -+ | ((32ul & (0xFF))<<(48)) \ -+ | (((((a) == 64)?6UL:5UL) & (0x7))<<(8)) \ -+ | (((((a) == 64)?6UL:5UL) & (0x7))<<(11))) -+ -+#define mwv207_timed_loop(tick, cond, timeout) \ -+ for ((tick) = jiffies; (cond) && time_before(jiffies, (tick) + msecs_to_jiffies(timeout));) -+ -+struct mwv207_lli { -+ u64 sar; -+ u64 dar; -+ u32 ts; -+ u32 resv1; -+ u64 llp; -+ u64 ctl; -+ u32 sstat; -+ u32 dstat; -+ u64 llpstat; -+ u32 resv2; -+ u32 resv3; -+}; -+ -+#define to_dma_pipe(pipe) container_of(pipe, struct mwv207_pipe_dma, base) -+struct mwv207_pipe_dma { -+ struct mwv207_pipe base; -+ int unit; -+ u32 alignment; -+ struct mwv207_lli *lli; -+ struct mwv207_lli *last_lli; -+ dma_addr_t lli_bus_addr; -+ int cur_idx; -+ -+ bool coherent; -+}; -+ -+struct mwv207_dma_cursor { -+ bool is_vram; -+ u64 line_pos; -+ u64 cur_pos; -+ -+ -+ dma_addr_t *dma_address; -+ u64 nr_pages; -+ -+ u64 width; -+ u64 stride; -+}; -+static inline void pipe_dma_write(struct mwv207_pipe_dma *pipe, u32 reg, u32 value) -+{ -+ pipe_write(&pipe->base, reg, value); -+} -+ -+static inline u32 pipe_dma_read(struct mwv207_pipe_dma *pipe, u32 reg) -+{ -+ return pipe_read(&pipe->base, reg); -+} -+ -+static inline void pipe_dma_chan_write(struct mwv207_pipe_dma *pipe, int chan, u32 reg, u32 val) -+{ -+ pipe_dma_write(pipe, chan * 0x200 + reg, val); -+} -+ -+static inline u32 pipe_dma_chan_read(struct mwv207_pipe_dma *pipe, int chan, u32 reg) -+{ -+ return pipe_dma_read(pipe, chan * 0x200 + reg); -+} -+ -+static inline int pipe_dma_chan_done(struct mwv207_pipe_dma *pipe, int chan) -+{ -+ u32 status; -+ -+ if (pipe->last_lli->ctl & (1UL << (63))) -+ return 0; -+ -+ status = pipe_dma_chan_read(pipe, chan, (0x188)); -+ return !!(status & (1 << (1))); -+} -+ -+static inline void pipe_dma_chan_clear(struct mwv207_pipe_dma *pipe, int chan) -+{ -+ pipe_dma_chan_write(pipe, chan, (0x198), 1 << (1)); -+} -+ -+static inline int pipe_dma_stop(struct mwv207_pipe_dma *pipe) -+{ -+ pr_info("%s TBD", __func__); -+ return 0; -+} -+ -+static void mwv207_pipe_dma_reset(struct mwv207_pipe *mpipe) -+{ -+ pr_info("%s todo", __func__); -+} -+ -+static void pipe_dma_commit(struct mwv207_pipe_dma *pipe) -+{ -+ unsigned long tick; -+ int chan = 0; -+ u64 llp; -+ -+ if (pipe->cur_idx == 0) -+ return; -+ -+ pipe->last_lli = &pipe->lli[pipe->cur_idx - 1]; -+ pipe->last_lli->ctl |= (1UL << (62)); -+ -+ -+ mb(); -+ -+ -+ pipe_dma_chan_write(pipe, chan, (0x120), -+ ((0x3)<<(2)) -+ |((0x3)<<(0))); -+ pipe_dma_chan_write(pipe, chan, (0x124), 0x3b8e0000); -+ -+ -+ llp = pipe->lli_bus_addr + 0x800000000ULL; -+ pipe_dma_chan_write(pipe, chan, (0x128), llp & 0xFFFFFFFF); -+ pipe_dma_chan_write(pipe, chan, (0x12C), llp >> 32); -+ -+ -+ pipe_dma_write(pipe, (0x10), -+ (1 << (1)) -+ |(1 << (0))); -+ -+ -+ pipe_dma_write(pipe, (0x18), -+ ((1<cur_idx = 0; -+} -+ -+static void pipe_dma_fill_lli(struct mwv207_pipe_dma *pipe, u64 src, u64 dst, u64 len) -+{ -+ struct mwv207_lli *lli; -+ -+ if (pipe->cur_idx >= DMA_MAX_LLI_COUNT) -+ pipe_dma_commit(pipe); -+ -+ lli = &pipe->lli[pipe->cur_idx]; -+ lli->sar = src; -+ lli->dar = dst; -+ -+ if (IS_ALIGNED(src, pipe->alignment) && -+ IS_ALIGNED(dst, pipe->alignment) && -+ IS_ALIGNED(len, pipe->alignment)) { -+ lli->ts = DMA_TS_ALIGNED(len, pipe->alignment); -+ lli->ctl = DMA_CTL_ALIGNED(pipe->alignment); -+ } else { -+ lli->ts = DMA_TS_NOT_ALIGNED(len); -+ lli->ctl = DMA_CTL_NOT_ALIGNED; -+ } -+ -+#ifdef MWV207_DMA_DEBUG -+ { -+ pr_info("[dma]: lli[%04d] sar = 0x%010llx", pipe->cur_idx, lli->sar); -+ pr_info("[dma]: lli[%04d] dar = 0x%010llx", pipe->cur_idx, lli->dar); -+ pr_info("[dma]: lli[%04d] ts = 0x%08x", pipe->cur_idx, lli->ts); -+ pr_info("[dma]: lli[%04d] llp = 0x%010llx", pipe->cur_idx, lli->llp); -+ pr_info("[dma]: lli[%04d] ctl = 0x%010llx", pipe->cur_idx, lli->ctl); -+ } -+#endif -+ pipe->cur_idx++; -+} -+ -+static void mwv207_cursor_init(struct mwv207_dma_cursor *cursor, struct mwv207_dma_loc *loc, -+ u64 width, u64 stride) -+{ -+ cursor->width = width; -+ cursor->stride = stride; -+ cursor->is_vram = MWV207_DMA_IS_VRAM(loc->pg_nr_type); -+ if (cursor->is_vram) { -+ cursor->line_pos = loc->base + loc->offset; -+ cursor->cur_pos = cursor->line_pos; -+ cursor->dma_address = NULL; -+ cursor->nr_pages = MWV207_DMA_NR_PAGES(loc->pg_nr_type); -+ } else { -+ cursor->line_pos = loc->offset; -+ cursor->cur_pos = cursor->line_pos; -+ cursor->dma_address = (dma_addr_t *)loc->base; -+ cursor->nr_pages = MWV207_DMA_NR_PAGES(loc->pg_nr_type); -+ } -+} -+ -+static void mwv207_cursor_reset(struct mwv207_dma_cursor *cursor, struct mwv207_dma_loc *loc) -+{ -+ if (cursor->is_vram) { -+ cursor->line_pos = loc->base + loc->offset; -+ cursor->cur_pos = cursor->line_pos; -+ } else { -+ cursor->line_pos = loc->offset; -+ cursor->cur_pos = cursor->line_pos; -+ } -+} -+ -+static inline u64 cursor_seg_len(struct mwv207_dma_cursor *cursor) -+{ -+ u64 len = cursor->line_pos + cursor->width - cursor->cur_pos; -+ u64 offset, idx, contig_len; -+ -+ if (cursor->is_vram) -+ return len; -+ offset = cursor->cur_pos & (PAGE_SIZE - 1); -+ idx = cursor->cur_pos >> PAGE_SHIFT; -+ -+ contig_len = PAGE_SIZE - offset; -+ while (contig_len < len && -+ idx + 1 < cursor->nr_pages && -+ cursor->dma_address[idx] + PAGE_SIZE == cursor->dma_address[idx + 1]) { -+ contig_len += PAGE_SIZE; -+ idx++; -+ } -+ return min_t(u64, len, contig_len); -+} -+ -+static inline u64 cursor_axi(struct mwv207_dma_cursor *cursor) -+{ -+ u64 idx, offset; -+ -+ if (cursor->is_vram) -+ return cursor->cur_pos; -+ -+ idx = cursor->cur_pos >> PAGE_SHIFT; -+ offset = cursor->cur_pos & (PAGE_SIZE - 1); -+ return 0x800000000ULL + cursor->dma_address[idx] + offset; -+} -+ -+static inline void cursor_advance(struct mwv207_dma_cursor *cursor, u64 len) -+{ -+ BUG_ON(cursor->cur_pos + len > cursor->line_pos + cursor->width); -+ -+ if (cursor->cur_pos + len == cursor->line_pos + cursor->width) { -+ cursor->line_pos += cursor->stride; -+ cursor->cur_pos = cursor->line_pos; -+ } else -+ cursor->cur_pos += len; -+} -+ -+static void pipe_dma_flush(struct mwv207_pipe_dma *pipe, -+ struct mwv207_dma_cursor *cursor, u64 size) -+{ -+ u64 remain, len; -+ -+ if (cursor->is_vram || pipe->coherent) -+ return; -+ -+ for (remain = size; remain > 0; remain -= len) { -+ len = min_t(u64, cursor_seg_len(cursor), remain); -+ dma_sync_single_for_device(pipe->base.jdev->dev, -+ cursor_axi(cursor) - 0x800000000ULL, -+ len, DMA_TO_DEVICE); -+ cursor_advance(cursor, len); -+ } -+} -+ -+static void pipe_dma_invalidate(struct mwv207_pipe_dma *pipe, -+ struct mwv207_dma_cursor *cursor, u64 size) -+{ -+ u64 remain, len; -+ -+ if (cursor->is_vram || pipe->coherent) -+ return; -+ -+ for (remain = size; remain > 0; remain -= len) { -+ len = min_t(u64, cursor_seg_len(cursor), remain); -+ dma_sync_single_for_cpu(pipe->base.jdev->dev, -+ cursor_axi(cursor) - 0x800000000ULL, -+ len, DMA_FROM_DEVICE); -+ cursor_advance(cursor, len); -+ } -+} -+ -+static struct dma_fence *mwv207_pipe_dma_submit(struct mwv207_pipe *mpipe, -+ struct mwv207_job *mjob) -+{ -+ struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); -+ struct mwv207_dma_cmd *cmd = (struct mwv207_dma_cmd *)mjob->cmds; -+ struct mwv207_dma_cursor src, dst; -+ u64 remain, len; -+ -+ BUG_ON(mjob->cmd_size != sizeof(struct mwv207_dma_cmd)); -+ -+ -+ mwv207_cursor_init(&src, &cmd->src, cmd->width, cmd->src.stride); -+ pipe_dma_flush(pipe, &src, cmd->width * cmd->height); -+ -+ mwv207_cursor_reset(&src, &cmd->src); -+ mwv207_cursor_init(&dst, &cmd->dst, cmd->width, cmd->dst.stride); -+ for (remain = cmd->width * cmd->height; remain > 0; remain -= len) { -+ len = min_t(u64, cursor_seg_len(&src), 0x400000); -+ len = min_t(u64, cursor_seg_len(&dst), len); -+ len = min_t(u64, len, remain); -+ -+ pipe_dma_fill_lli(pipe, cursor_axi(&src), cursor_axi(&dst), len); -+ -+ cursor_advance(&src, len); -+ cursor_advance(&dst, len); -+ } -+ pipe_dma_commit(pipe); -+ -+ -+ mwv207_cursor_reset(&dst, &cmd->dst); -+ pipe_dma_invalidate(pipe, &dst, cmd->width * cmd->height); -+ -+ return dma_fence_get_stub(); -+} -+ -+static void mwv207_pipe_dma_dump_state(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); -+ pr_info("%s todo: %p", __func__, pipe); -+} -+ -+static void mwv207_pipe_dma_destroy(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); -+ -+ pr_info("%s todo: %p", __func__, pipe); -+} -+ -+struct mwv207_pipe *mwv207_pipe_dma_create(struct mwv207_device *jdev, int unit, u32 regbase, -+ const char *fname) -+{ -+ struct mwv207_pipe_dma *pipe; -+ u64 llp; -+ int i; -+ -+ pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_dma), GFP_KERNEL); -+ if (!pipe) -+ return NULL; -+ -+ pipe->base.jdev = jdev; -+ pipe->base.fname = fname; -+ pipe->base.regbase = jdev->mmio + regbase; -+ pipe->base.iosize = 16 * 1024; -+ pipe->base.submit = mwv207_pipe_dma_submit; -+ pipe->base.reset = mwv207_pipe_dma_reset; -+ pipe->base.destroy = mwv207_pipe_dma_destroy; -+ pipe->base.dump_state = mwv207_pipe_dma_dump_state; -+ -+ pipe->coherent = true; -+ -+ pipe->alignment = jdev->lite ? 32 : 64; -+ pipe->unit = unit; -+ -+ pipe->lli = dmam_alloc_coherent(jdev->dev, -+ sizeof(struct mwv207_lli) * DMA_MAX_LLI_COUNT, -+ &pipe->lli_bus_addr, GFP_KERNEL); -+ if (!pipe->lli) -+ return NULL; -+ -+ memset(pipe->lli, 0, sizeof(struct mwv207_lli) * DMA_MAX_LLI_COUNT); -+ llp = pipe->lli_bus_addr + 0x800000000ULL; -+ for (i = 0; i < DMA_MAX_LLI_COUNT; i++) { -+ llp += sizeof(struct mwv207_lli); -+ pipe->lli[i].llp = llp; -+ } -+ pipe->cur_idx = 0; -+ -+ mwv207_pipe_dma_reset(&pipe->base); -+ return &pipe->base; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_enc.c b/drivers/gpu/drm/mwv207/mwv207_pipe_enc.c -new file mode 100644 -index 000000000..2dc6bf808 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_enc.c -@@ -0,0 +1,266 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include "mwv207_pipe_codec_common.h" -+ -+#define JPIPE_STATUS_ALL \ -+ (0x1000 | 0x200 | \ -+ 0x100 | 0x080 | \ -+ 0x040 | 0x020 | \ -+ 0x010 | 0x008 | 0x004) -+ -+#define to_enc_pipe(pipe) container_of(pipe, struct mwv207_pipe_enc, base) -+struct pipe_enc_fence; -+struct mwv207_pipe_enc { -+ struct mwv207_pipe base; -+ -+ u64 fence_ctx; -+ u64 fence_seqno; -+ spinlock_t fence_lock; -+ -+ struct pipe_enc_fence *current_fence; -+ struct task_struct *poll_thread; -+ struct pipe_codec_sw_pp sw_pp; -+}; -+ -+#define to_pipe_enc_fence(f) container_of(f, struct pipe_enc_fence, base) -+struct pipe_enc_fence { -+ struct dma_fence base; -+ struct mwv207_pipe_enc *pipe; -+ struct list_head node; -+}; -+ -+static inline void pipe_enc_write(struct mwv207_pipe_enc *pipe, u32 reg, u32 value) -+{ -+ pipe_write(&pipe->base, reg, value); -+} -+ -+static inline u32 pipe_enc_read(struct mwv207_pipe_enc *pipe, u32 reg) -+{ -+ return pipe_read(&pipe->base, reg); -+} -+ -+static const char *pipe_enc_fence_get_driver_name(struct dma_fence *fence) -+{ -+ return "mwv207"; -+} -+ -+static const char *pipe_enc_fence_get_timeline_name(struct dma_fence *fence) -+{ -+ return to_pipe_enc_fence(fence)->pipe->base.fname; -+} -+ -+static void pipe_enc_fence_release(struct dma_fence *fence) -+{ -+ struct pipe_enc_fence *f = to_pipe_enc_fence(fence); -+ -+ kfree_rcu(f, base.rcu); -+} -+ -+static const struct dma_fence_ops pipe_enc_fence_ops = { -+ .get_driver_name = pipe_enc_fence_get_driver_name, -+ .get_timeline_name = pipe_enc_fence_get_timeline_name, -+ .release = pipe_enc_fence_release, -+}; -+ -+static void pipe_enc_stat_reset(struct mwv207_pipe_enc *pipe, u32 stat) -+{ -+ if (stat & 0x20) -+ pipe_enc_write(pipe, 0x14, 0); -+ -+ pipe_enc_write(pipe, 0x4, stat & (~0x1FD)); -+} -+ -+static int pipe_enc_polling(void *priv) -+{ -+ struct mwv207_pipe_enc *pipe = priv; -+ struct pipe_enc_fence *fence; -+ u32 stat; -+ -+ set_freezable(); -+ while (!kthread_should_stop()) { -+ usleep_range(1000, 1001); -+ try_to_freeze(); -+ -+ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence == NULL) -+ continue; -+ -+ stat = pipe_enc_read(pipe, 0x4); -+ if (!(stat & JPIPE_STATUS_ALL)) -+ continue; -+ -+ pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); -+ pipe_enc_stat_reset(pipe, stat); -+ -+ -+ smp_store_release(&pipe->current_fence, NULL); -+ -+ dma_fence_signal(&fence->base); -+ dma_fence_put(&fence->base); -+ } -+ -+ return 0; -+} -+ -+static void mwv207_pipe_enc_reset(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); -+ struct pipe_enc_fence *fence; -+ int i; -+ -+ pipe_codec_sw_pp_reset(&pipe->sw_pp); -+ -+ pipe_enc_write(pipe, 0x14, 0); -+ -+ -+ for (i = 4; i < pipe->base.iosize; i += 0x4) -+ pipe_enc_write(pipe, i, 0); -+ -+ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence) { -+ dma_fence_put(&fence->base); -+ -+ smp_store_release(&pipe->current_fence, NULL); -+ } -+} -+ -+static struct dma_fence *mwv207_pipe_enc_submit(struct mwv207_pipe *mpipe, -+ struct mwv207_job *mjob) -+{ -+ struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); -+ struct pipe_enc_fence *fence; -+ int i, nr, pos, cmdlen; -+ bool hw_run = 0; -+ u32 cmd, reg; -+ -+ /* sanity check, there should be no previous job. -+ * acquire pairs with release in polling thread -+ */ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence) -+ return ERR_PTR(-EBUSY); -+ -+ -+ for (pos = 0; pos <= mjob->cmd_size - 4; pos += cmdlen) { -+ cmd = *(u32 *)(mjob->cmds + pos); -+ switch ((cmd >> 27) & 0x1f) { -+ case 0x01: -+ if ((cmd >> 26) & 0x1) -+ return ERR_PTR(-EINVAL); -+ reg = (cmd & 0xffff) * 4; -+ nr = (cmd >> 16) & 0x3ff; -+ if (nr == 0) -+ nr = 1024; -+ for (i = pos + 4; i <= pos + nr * 4 -+ && i <= mjob->cmd_size - 4 -+ && reg <= pipe->base.iosize - 4; -+ i += 4, reg += 4) { -+ if (reg == 20) { -+ pipe_enc_read(pipe, 0x14); -+ hw_run = (*(u32 *)(mjob->cmds + i)) & 0x1; -+ -+ mb(); -+ } -+ pipe_enc_write(pipe, reg, *(u32 *)(mjob->cmds + i)); -+ } -+ -+ if (i <= pos + nr * 4) -+ dev_dbg(mpipe->jdev->dev, -+ "mwv207: invalid enc register writes dropped"); -+ -+ cmdlen = ALIGN(4 + nr * 4, 8); -+ break; -+ case 0x02: -+ pipe_codec_sw_pp_submit(&pipe->sw_pp, &pipe->base, mjob, pos, &cmdlen); -+ break; -+ default: -+ -+ return ERR_PTR(-EINVAL); -+ } -+ } -+ -+ -+ fence = kzalloc(sizeof(struct pipe_enc_fence), GFP_KERNEL); -+ if (!fence) -+ return ERR_PTR(-ENOMEM); -+ fence->pipe = pipe; -+ dma_fence_init(&fence->base, &pipe_enc_fence_ops, &pipe->fence_lock, -+ pipe->fence_ctx, ++pipe->fence_seqno); -+ -+ if (hw_run) { -+ dma_fence_get(&fence->base); -+ -+ smp_store_release(&pipe->current_fence, fence); -+ } else { -+ pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); -+ dma_fence_signal(&fence->base); -+ } -+ -+ return &fence->base; -+} -+ -+static void mwv207_pipe_enc_dump_state(struct mwv207_pipe *mpipe) -+{ -+ pr_info("%s irq state reg: 0x%08x", mpipe->fname, -+ pipe_read(mpipe, 0x4)); -+} -+ -+static void mwv207_pipe_enc_destroy(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); -+ -+ kthread_stop(pipe->poll_thread); -+} -+ -+struct mwv207_pipe *mwv207_pipe_enc_create(struct mwv207_device *jdev, u32 regbase, -+ const char *fname) -+{ -+ struct mwv207_pipe_enc *pipe; -+ -+ if (jdev->lite) -+ return NULL; -+ -+ pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_enc), GFP_KERNEL); -+ if (!pipe) -+ return NULL; -+ -+ pipe->base.jdev = jdev; -+ pipe->base.fname = fname; -+ pipe->base.regbase = jdev->mmio + regbase; -+ pipe->base.iosize = JPIPE_ENC_REG_NUM * 4; -+ pipe->base.submit = mwv207_pipe_enc_submit; -+ pipe->base.reset = mwv207_pipe_enc_reset; -+ pipe->base.destroy = mwv207_pipe_enc_destroy; -+ pipe->base.dump_state = mwv207_pipe_enc_dump_state; -+ -+ spin_lock_init(&pipe->fence_lock); -+ pipe->fence_ctx = dma_fence_context_alloc(1); -+ pipe->fence_seqno = 0; -+ -+ mwv207_pipe_enc_reset(&pipe->base); -+ -+ pipe->poll_thread = kthread_run(pipe_enc_polling, pipe, "enc_polling"); -+ if (IS_ERR(pipe->poll_thread)) -+ return NULL; -+ -+ return &pipe->base; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_sched.c b/drivers/gpu/drm/mwv207/mwv207_sched.c -new file mode 100644 -index 000000000..890dd2856 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_sched.c -@@ -0,0 +1,378 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include "mwv207.h" -+#include "mwv207_sched.h" -+#include "mwv207_bo.h" -+#include "mwv207_ctx.h" -+#include "mwv207_db.h" -+#include "mwv207_devfreq.h" -+ -+static int dump_hang_job = 1; -+module_param(dump_hang_job, int, 0644); -+MODULE_PARM_DESC(dump_hang_job, "dump time out job"); -+ -+struct mwv207_job *mwv207_job_alloc(void) -+{ -+ struct mwv207_job *mjob; -+ -+ mjob = kzalloc(sizeof(*mjob), GFP_KERNEL); -+ if (!mjob) -+ return NULL; -+ -+ kref_init(&mjob->refcount); -+ INIT_LIST_HEAD(&mjob->tvblist); -+ return mjob; -+} -+ -+static void mwv207_job_fini(struct kref *kref) -+{ -+ struct mwv207_job *mjob = container_of(kref, struct mwv207_job, refcount); -+ struct mwv207_tvb *mtvb; -+ struct mwv207_submit_cmd_dat *dat; -+ int i; -+ -+ dma_fence_put(mjob->fence_in); -+ if (mjob->base.s_fence) -+ drm_sched_job_cleanup(&mjob->base); -+ -+ -+ mwv207_for_each_mtvb(mtvb, mjob) { -+ for (i = 0; i < mtvb->nr_shared; ++i) -+ dma_fence_put(mtvb->shared[i]); -+ dma_fence_put(mtvb->excl); -+ kfree(mtvb->shared); -+ mwv207_bo_unref(to_jbo(mtvb->base.bo)); -+ } -+ -+ if (mjob->nr_cmd_dat) { -+ for (i = 0; i < mjob->nr_cmd_dat; ++i) { -+ dat = &mjob->cmd_dats[i]; -+ kvfree(dat->dat); -+ kvfree(dat->relocs); -+ mwv207_bo_unref(dat->jbo); -+ } -+ } -+ -+ if (mjob->ctx) -+ mwv207_ctx_put(mjob->ctx); -+ -+ kvfree(mjob->cmd_dats); -+ kvfree(mjob->mtvb); -+ kvfree(mjob->relocs); -+ kvfree(mjob->cmds); -+ -+ kfree(mjob); -+} -+ -+struct mwv207_job *mwv207_job_get(struct mwv207_job *mjob) -+{ -+ kref_get(&mjob->refcount); -+ return mjob; -+} -+ -+void mwv207_job_put(struct mwv207_job *mjob) -+{ -+ kref_put(&mjob->refcount, mwv207_job_fini); -+} -+ -+static void mwv207_sched_dump_job(struct mwv207_job *mjob) -+{ -+ int lines, i; -+ u32 *cmd; -+ -+ cmd = (u32 *)mjob->cmds; -+ lines = (mjob->cmd_size / 4) & ~0x3; -+ for (i = 0; i < lines; i += 4) { -+ pr_info("0x%08x : %08x %08x %08x %08x", i, -+ cmd[i], cmd[i+1], cmd[i+2], cmd[i+3]); -+ } -+ -+ switch (mjob->cmd_size / 4 - lines) { -+ case 0: -+ return; -+ case 1: -+ pr_info("0x%08x : %08x", i, cmd[i]); -+ break; -+ case 2: -+ pr_info("0x%08x : %08x %08x", i, cmd[i], cmd[i+1]); -+ break; -+ case 3: -+ pr_info("0x%08x : %08x %08x %08x", i, -+ cmd[i], cmd[i+1], cmd[i+2]); -+ break; -+ default: -+ pr_err("should never happen"); -+ break; -+ -+ } -+} -+ -+static struct dma_fence *mwv207_sched_dependency(struct drm_sched_job *job, -+ struct drm_sched_entity *entity) -+{ -+ struct mwv207_job *mjob = to_mwv207_job(job); -+ struct mwv207_tvb *mtvb; -+ struct dma_fence *fence; -+ int i; -+ -+ if (unlikely(mjob->fence_in)) { -+ fence = mjob->fence_in; -+ mjob->fence_in = NULL; -+ if (!dma_fence_is_signaled(fence)) -+ return fence; -+ dma_fence_put(fence); -+ } -+ -+ mwv207_for_each_mtvb(mtvb, mjob) { -+ if (mtvb->excl) { -+ fence = mtvb->excl; -+ mtvb->excl = NULL; -+ if (!dma_fence_is_signaled(fence)) -+ return fence; -+ dma_fence_put(fence); -+ } -+ -+ for (i = 0; i < mtvb->nr_shared; i++) { -+ if (!mtvb->shared[i]) -+ continue; -+ fence = mtvb->shared[i]; -+ mtvb->shared[i] = NULL; -+ if (!dma_fence_is_signaled(fence)) -+ return fence; -+ dma_fence_put(fence); -+ } -+ kfree(mtvb->shared); -+ mtvb->nr_shared = 0; -+ mtvb->shared = NULL; -+ } -+ -+ return NULL; -+} -+ -+static struct dma_fence *mwv207_sched_run_job(struct drm_sched_job *job) -+{ -+ struct mwv207_sched *sched = to_mwv207_sched(job->sched); -+ struct dma_fence *fence; -+ -+ if (unlikely(job->s_fence->finished.error)) -+ return ERR_PTR(-ECANCELED); -+ -+ mwv207_devfreq_record_busy(sched->pipe); -+ -+ fence = sched->pipe->submit(sched->pipe, to_mwv207_job(job)); -+ if (IS_ERR_OR_NULL(fence)) -+ DRM_ERROR("%s: submit failed, errcode=%ld", -+ sched->pipe->fname, PTR_ERR(fence)); -+ return fence; -+} -+ -+static void mwv207_sched_timedout_job(struct drm_sched_job *job) -+{ -+ struct mwv207_sched *sched = to_mwv207_sched(job->sched); -+ struct mwv207_job *mjob = to_mwv207_job(job); -+ struct drm_sched_job *timedout_job; -+ -+ pr_info("mwv207: job from '%s' to '%s', timed out!", -+ mjob->comm, sched->pipe->fname); -+ -+ drm_sched_stop(&sched->base, job); -+ -+ if (dump_hang_job) { -+ sched->pipe->dump_state(sched->pipe); -+ mwv207_sched_dump_job(mjob); -+ } -+ -+ drm_sched_increase_karma(job); -+ -+ sched->pipe->reset(sched->pipe); -+ -+ list_for_each_entry(timedout_job, &sched->base.ring_mirror_list, node) -+ mwv207_devfreq_record_idle(sched->pipe); -+ -+ drm_sched_resubmit_jobs(&sched->base); -+ -+ -+ drm_sched_start(&sched->base, true); -+} -+ -+static void mwv207_sched_free_job(struct drm_sched_job *job) -+{ -+ struct mwv207_job *mjob = to_mwv207_job(job); -+ -+ mwv207_job_put(mjob); -+} -+ -+static const struct drm_sched_backend_ops mwv207_sched_ops = { -+ .dependency = mwv207_sched_dependency, -+ .run_job = mwv207_sched_run_job, -+ .timedout_job = mwv207_sched_timedout_job, -+ .free_job = mwv207_sched_free_job, -+}; -+ -+static struct drm_gpu_scheduler *mwv207_sched_create(struct mwv207_device *jdev, -+ unsigned int hw_submission, unsigned int hang_limit, long timeout, -+ struct mwv207_pipe *pipe) -+{ -+ struct mwv207_sched *sched; -+ int ret; -+ -+ if (pipe == NULL) -+ return NULL; -+ -+ sched = devm_kzalloc(jdev->dev, sizeof(struct mwv207_sched), GFP_KERNEL); -+ if (!sched) -+ goto err; -+ -+ sched->pipe = pipe; -+ -+ ret = drm_sched_init(&sched->base, &mwv207_sched_ops, hw_submission, hang_limit, -+ msecs_to_jiffies(timeout), pipe->fname); -+ if (ret) -+ goto err; -+ -+ return &sched->base; -+err: -+ sched->pipe->destroy(sched->pipe); -+ return NULL; -+} -+ -+static void mwv207_sched_destroy(struct drm_gpu_scheduler *sched) -+{ -+ struct mwv207_sched *msched = to_mwv207_sched(sched); -+ -+ if (sched == NULL) -+ return; -+ -+ drm_sched_fini(sched); -+ msched->pipe->destroy(msched->pipe); -+} -+ -+int mwv207_sched_suspend(struct mwv207_device *jdev) -+{ -+ struct mwv207_sched *sched; -+ int i, ret; -+ -+ -+ for (i = 0; i < 6; i++) { -+ if (!jdev->sched[i]) -+ continue; -+ sched = to_mwv207_sched(jdev->sched[i]); -+ -+ if (atomic_read(&jdev->sched[i]->hw_rq_count)) -+ return -EBUSY; -+ -+ ret = mwv207_devfreq_suspend(sched->pipe); -+ if (ret) -+ return ret; -+ } -+ -+ return 0; -+} -+ -+int mwv207_sched_resume(struct mwv207_device *jdev) -+{ -+ struct mwv207_sched *sched; -+ int i, ret; -+ -+ for (i = 0; i < 6; i++) { -+ if (!jdev->sched[i]) -+ continue; -+ sched = to_mwv207_sched(jdev->sched[i]); -+ -+ ret = mwv207_devfreq_resume(sched->pipe); -+ if (ret) -+ dev_err(sched->pipe->dev, "devfreq resume failed: %d", ret); -+ -+ sched->pipe->reset(sched->pipe); -+ } -+ -+ return 0; -+} -+ -+int mwv207_sched_init(struct mwv207_device *jdev) -+{ -+ struct mwv207_pipe *pipe; -+ -+ jdev->sched_3d = &jdev->sched[0]; -+ jdev->sched_dec = &jdev->sched_3d[2]; -+ jdev->sched_enc = &jdev->sched_dec[1]; -+ jdev->sched_2d = &jdev->sched_enc[1]; -+ jdev->sched_dma = &jdev->sched_2d[1]; -+ -+ /* ownership of pipe passed to mwv207_sched_create, don't reference -+ * this pipe after call to mwv207_sched_create. -+ * -+ * Note sched limit of 3d should be lower than hw event count, which -+ * is 30 for 91/92. otherwise pipe 3d will BUG_ON -+ */ -+ pipe = mwv207_pipe_3d_create(jdev, 0, 0x900000, "mwv207_3d0"); -+ jdev->sched_3d[0] = mwv207_sched_create(jdev, 30, 5, 2000, pipe); -+ if (jdev->sched_3d[0] == NULL) -+ return -ENODEV; -+ -+ pipe = mwv207_pipe_3d_create(jdev, 1, 0x910000, "mwv207_3d1"); -+ jdev->sched_3d[1] = mwv207_sched_create(jdev, 30, 5, 2000, pipe); -+ -+ pipe = mwv207_pipe_dec_create(jdev, 0, 0x930000, "mwv207_dec0"); -+ jdev->sched_dec[0] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); -+ if (jdev->sched_dec[0] == NULL) -+ goto err; -+ -+ pipe = mwv207_pipe_dec_create(jdev, 1, 0x940000, "mwv207_dec1"); -+ jdev->sched_dec[1] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); -+ -+ pipe = mwv207_pipe_enc_create(jdev, 0x920000, "mwv207_enc0"); -+ jdev->sched_enc[0] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); -+ -+ pipe = mwv207_pipe_2d_create(jdev, 0, 0x968000, "mwv207_2d0"); -+ jdev->sched_2d[0] = mwv207_sched_create(jdev, 30, 5, 2000, pipe); -+ if (jdev->sched_2d[0] == NULL) -+ goto err; -+ -+ pipe = mwv207_pipe_dma_create(jdev, 0, 0x9d0000, "mwv207_dma0"); -+ jdev->sched_dma[0] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); -+ if (jdev->sched_dma[0] == NULL) -+ goto err; -+ -+ jdev->nr_3d = jdev->sched_3d[1] ? 2 : 1; -+ jdev->nr_enc = jdev->sched_enc[0] ? 1 : 0; -+ jdev->nr_dec = jdev->sched_dec[1] ? 2 : 1; -+ jdev->nr_2d = 1; -+ jdev->nr_dma = 1; -+ -+ mwv207_db_add(jdev, DRM_MWV207_ACTIVE_3D_NR, jdev->nr_3d); -+ mwv207_db_add(jdev, DRM_MWV207_ACTIVE_ENC_NR, jdev->nr_enc); -+ mwv207_db_add(jdev, DRM_MWV207_ACTIVE_DEC_NR, jdev->nr_dec); -+ mwv207_db_add(jdev, DRM_MWV207_ACTIVE_2D_NR, jdev->nr_2d); -+ mwv207_db_add(jdev, DRM_MWV207_ACTIVE_DMA_NR, jdev->nr_dma); -+ -+ return 0; -+err: -+ mwv207_sched_fini(jdev); -+ return -ENODEV; -+} -+ -+void mwv207_sched_fini(struct mwv207_device *jdev) -+{ -+ int i; -+ -+ for (i = 0; i < 6; ++i) { -+ if (!jdev->sched[i]) -+ continue; -+ mwv207_sched_destroy(jdev->sched[i]); -+ } -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_sched.h b/drivers/gpu/drm/mwv207/mwv207_sched.h -new file mode 100644 -index 000000000..17272e1a8 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_sched.h -@@ -0,0 +1,153 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_SCHED_H_TGQQ2LXS -+#define MWV207_SCHED_H_TGQQ2LXS -+#include -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_bo.h" -+ -+struct mwv207_submit_cmd_dat { -+ int nr_relocs; -+ int dat_size; -+ struct drm_mwv207_submit_reloc *relocs; -+ char *dat; -+ struct mwv207_bo *jbo; -+}; -+ -+struct mwv207_tvb { -+ struct ttm_validate_buffer base; -+ struct dma_fence *excl; -+ unsigned int nr_shared; -+ struct dma_fence **shared; -+}; -+ -+#define to_mwv207_job(job) container_of(job, struct mwv207_job, base) -+struct mwv207_job { -+ struct drm_sched_job base; -+ -+ struct list_head tvblist; -+ struct mwv207_tvb *mtvb; -+ int nr_bos; -+ -+ struct drm_mwv207_submit_reloc *relocs; -+ int nr_relocs; -+ -+ struct mwv207_submit_cmd_dat *cmd_dats; -+ int nr_cmd_dat; -+ -+ char *cmds; -+ int cmd_size; -+ -+ struct dma_fence *fence_in; -+ -+ -+ struct mwv207_ctx *ctx; -+ struct drm_sched_entity *engine_entity; -+ -+ struct kref refcount; -+ -+ -+ bool is_dma; -+ -+ char comm[TASK_COMM_LEN]; -+}; -+#define mwv207_for_each_mtvb(mtvb, mjob) list_for_each_entry(mtvb, &(mjob)->tvblist, base.head) -+ -+struct mwv207_job *mwv207_job_alloc(void); -+struct mwv207_job *mwv207_job_get(struct mwv207_job *mjob); -+void mwv207_job_put(struct mwv207_job *mjob); -+ -+static inline struct mwv207_bo *mwv207_job_bo(struct mwv207_job *mjob, int idx) -+{ -+ BUG_ON(idx >= mjob->nr_bos + mjob->nr_cmd_dat); -+ return to_jbo(mjob->mtvb[idx].base.bo); -+} -+ -+struct mwv207_dma_loc { -+ u64 base; -+ u64 pg_nr_type; -+ u64 offset; -+ u64 stride; -+}; -+#define MWV207_DMA_NR_PAGES_VRAM(nr) ((nr) | (0ULL << 63)) -+#define MWV207_DMA_NR_PAGES_RAM(nr) ((nr) | (1ULL << 63)) -+#define MWV207_DMA_NR_PAGES(nr) ((nr) & ~(1ULL << 63)) -+#define MWV207_DMA_IS_VRAM(nr) (((nr) >> 63) == 0) -+ -+ -+struct mwv207_dma_cmd { -+ struct mwv207_dma_loc src; -+ struct mwv207_dma_loc dst; -+ u64 width; -+ u64 height; -+}; -+ -+struct devfreq; -+#define to_mwv207_sched(sched) container_of(sched, struct mwv207_sched, base) -+struct mwv207_pipe { -+ struct dma_fence* (*submit)(struct mwv207_pipe *pipe, struct mwv207_job *job); -+ void (*reset)(struct mwv207_pipe *pipe); -+ void (*destroy)(struct mwv207_pipe *pipe); -+ void (*dump_state)(struct mwv207_pipe *pipe); -+ struct mwv207_device *jdev; -+ const char *fname; -+ int iosize; -+ void __iomem *regbase; -+ -+ -+ struct device *dev; -+ struct devfreq *devfreq; -+ spinlock_t devfreq_lock; -+ int busy_count; -+ int pll_id; -+ ktime_t busy_time; -+ ktime_t idle_time; -+ ktime_t time_last_update; -+}; -+ -+struct mwv207_sched { -+ struct drm_gpu_scheduler base; -+ struct mwv207_pipe *pipe; -+}; -+ -+static inline void pipe_write(struct mwv207_pipe *pipe, u32 reg, u32 value) -+{ -+ writel_relaxed(value, pipe->regbase + reg); -+} -+ -+static inline u32 pipe_read(struct mwv207_pipe *pipe, u32 reg) -+{ -+ return readl(pipe->regbase + reg); -+} -+ -+int mwv207_sched_init(struct mwv207_device *jdev); -+void mwv207_sched_fini(struct mwv207_device *jdev); -+int mwv207_sched_suspend(struct mwv207_device *jdev); -+int mwv207_sched_resume(struct mwv207_device *jdev); -+ -+struct mwv207_pipe *mwv207_pipe_3d_create(struct mwv207_device *jdev, int unit, -+ u32 regbase, const char *fname); -+struct mwv207_pipe *mwv207_pipe_2d_create(struct mwv207_device *jdev, int unit, -+ u32 regbase, const char *fname); -+struct mwv207_pipe *mwv207_pipe_dec_create(struct mwv207_device *jdev, int unit, -+ u32 regbase, const char *fname); -+struct mwv207_pipe *mwv207_pipe_enc_create(struct mwv207_device *jdev, -+ u32 regbase, const char *fname); -+struct mwv207_pipe *mwv207_pipe_dma_create(struct mwv207_device *jdev, int unit, -+ u32 regbase, const char *fname); -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_submit.c b/drivers/gpu/drm/mwv207/mwv207_submit.c -new file mode 100644 -index 000000000..7a3a373dd ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_submit.c -@@ -0,0 +1,638 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include "mwv207_drm.h" -+#include "mwv207_submit.h" -+#include "mwv207_sched.h" -+#include "mwv207_ctx.h" -+#include "mwv207_bo.h" -+#include "mwv207_gem.h" -+ -+static inline int mwv207_submit_select_engine(struct drm_device *dev, struct mwv207_job *mjob, -+ struct drm_mwv207_submit *args) -+{ -+ struct mwv207_device *jdev = ddev_to_jdev(dev); -+ struct drm_sched_entity **entity_array; -+ int id_max, id; -+ -+ switch (args->engine_type) { -+ case 0: -+ entity_array = &mjob->ctx->entity_3d[0]; -+ id_max = jdev->nr_3d; -+ break; -+ case 1: -+ entity_array = &mjob->ctx->entity_dec[0]; -+ id_max = jdev->nr_dec; -+ break; -+ case 2: -+ entity_array = &mjob->ctx->entity_enc[0]; -+ id_max = jdev->nr_enc; -+ break; -+ case 3: -+ entity_array = &mjob->ctx->entity_2d[0]; -+ id_max = jdev->nr_2d; -+ break; -+ case 4: -+ entity_array = &mjob->ctx->entity_dma[0]; -+ id_max = jdev->nr_dma; -+ mjob->is_dma = true; -+ break; -+ -+ default: -+ id_max = 0; -+ } -+ if (id_max <= 0) -+ return -ENODEV; -+ -+ if (args->engine_id == 0xffffffff) -+ id = id_max; -+ else if (args->engine_id >= 0 && args->engine_id < id_max) -+ id = args->engine_id; -+ else -+ return -ENODEV; -+ mjob->engine_entity = entity_array[id]; -+ return 0; -+} -+ -+static int mwv207_submit_init_job_reloc(struct mwv207_job *mjob, struct drm_mwv207_submit *args) -+{ -+ if ((int)args->nr_relocs < 0) -+ return -EINVAL; -+ mjob->nr_relocs = (int)args->nr_relocs; -+ if (mjob->nr_relocs == 0) -+ return 0; -+ if (args->relocs == 0) -+ return -EINVAL; -+ -+ mjob->relocs = kvmalloc_array(mjob->nr_relocs, -+ sizeof(struct drm_mwv207_submit_reloc), GFP_KERNEL); -+ -+ return copy_from_user(mjob->relocs, (void __user *)args->relocs, -+ sizeof(struct drm_mwv207_submit_reloc) * mjob->nr_relocs); -+} -+ -+static int mwv207_submit_init_job_bo(struct mwv207_job *mjob, -+ struct drm_mwv207_submit *args, struct drm_file *filp) -+{ -+ struct drm_mwv207_bo_acc ubos_stack[32]; -+ struct drm_mwv207_bo_acc *ubos = ubos_stack; -+ struct ttm_validate_buffer *tvb; -+ struct drm_gem_object *gobj; -+ int ret = 0, i; -+ -+ if ((int)args->nr_bos < 0) -+ return -EINVAL; -+ -+ mjob->nr_bos = (int)args->nr_bos; -+ if (mjob->nr_bos == 0) { -+ if (mjob->nr_cmd_dat) -+ goto setup_mtvb; -+ return 0; -+ } -+ -+ if (!args->bos) -+ return -EINVAL; -+ -+ if (mjob->nr_bos > 32) -+ ubos = kvmalloc_array(mjob->nr_bos, sizeof(*ubos), GFP_KERNEL); -+ if (unlikely(!ubos)) -+ return -ENOMEM; -+ -+ ret = copy_from_user(ubos, (void __user *)args->bos, -+ mjob->nr_bos * sizeof(*ubos)); -+ if (ret) -+ goto out; -+setup_mtvb: -+ mjob->mtvb = kvcalloc(mjob->nr_bos + mjob->nr_cmd_dat, -+ sizeof(struct mwv207_tvb), GFP_KERNEL); -+ if (!mjob->mtvb) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ spin_lock(&filp->table_lock); -+ for (i = 0; i < mjob->nr_bos; i++) { -+ tvb = &mjob->mtvb[i].base; -+ tvb->num_shared = (ubos[i].flags & 0x00000001) ? 0 : 1; -+ gobj = idr_find(&filp->object_idr, ubos[i].handle); -+ if (unlikely(!gobj)) { -+ spin_unlock(&filp->table_lock); -+ ret = -ENOENT; -+ goto out; -+ } -+ tvb->bo = &mwv207_bo_ref(mwv207_bo_from_gem(gobj))->tbo; -+ list_add_tail(&tvb->head, &mjob->tvblist); -+ } -+ spin_unlock(&filp->table_lock); -+ for (i = 0; i < mjob->nr_cmd_dat; i++) { -+ tvb = &mjob->mtvb[mjob->nr_bos + i].base; -+ tvb->num_shared = 0; -+ tvb->bo = &mwv207_bo_ref(mjob->cmd_dats[i].jbo)->tbo; -+ list_add_tail(&tvb->head, &mjob->tvblist); -+ } -+out: -+ if (unlikely(ubos != ubos_stack)) -+ kvfree(ubos); -+ -+ return ret; -+} -+ -+static int mwv207_submit_init_job_cmd(struct mwv207_job *mjob, struct drm_mwv207_submit *args) -+{ -+ mjob->cmd_size = args->cmd_size; -+ if ((int)mjob->cmd_size <= 0) -+ return -EINVAL; -+ -+ if (mjob->cmd_size > 0x20000) -+ return -E2BIG; -+ -+ if (args->cmds == 0) -+ return -EINVAL; -+ -+ -+ if (mjob->is_dma) -+ mjob->cmds = kmalloc(args->cmd_size, GFP_KERNEL); -+ else -+ mjob->cmds = kvmalloc(args->cmd_size, GFP_KERNEL); -+ if (!mjob->cmds) -+ return -ENOMEM; -+ -+ return copy_from_user(mjob->cmds, (void __user *)args->cmds, mjob->cmd_size); -+} -+ -+static int mwv207_submit_init_job_cmd_dat(struct drm_device *dev, -+ struct mwv207_job *mjob, struct drm_mwv207_submit *args) -+{ -+ struct drm_mwv207_submit_cmd_dat udats_stack[8]; -+ struct drm_mwv207_submit_cmd_dat *udats = udats_stack; -+ struct mwv207_device *jdev = ddev_to_jdev(dev); -+ struct mwv207_submit_cmd_dat *mdat; -+ int ret, i; -+ -+ if ((int)args->nr_cmd_dat < 0) -+ return -EINVAL; -+ mjob->nr_cmd_dat = args->nr_cmd_dat; -+ if (mjob->nr_cmd_dat == 0) -+ return 0; -+ if (args->cmd_dats == 0) -+ return -EINVAL; -+ if (mjob->nr_cmd_dat > 8) -+ udats = kvmalloc_array(mjob->nr_cmd_dat, -+ sizeof(struct drm_mwv207_submit_cmd_dat), GFP_KERNEL); -+ -+ if (unlikely(!udats)) -+ return -ENOMEM; -+ -+ mjob->cmd_dats = kvcalloc(mjob->nr_cmd_dat, -+ sizeof(struct mwv207_submit_cmd_dat), GFP_KERNEL); -+ if (!mjob->cmd_dats) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ ret = copy_from_user(udats, (void __user *)args->cmd_dats, -+ mjob->nr_cmd_dat * sizeof(struct drm_mwv207_submit_cmd_dat)); -+ if (ret) -+ goto out; -+ -+ for (i = 0; i < mjob->nr_cmd_dat; ++i) { -+ if ((int)udats[i].nr_relocs < 0) { -+ ret = -EINVAL; -+ goto out; -+ } -+ if ((int)udats[i].dat_size <= 0 || udats[i].dat == 0) { -+ ret = -EINVAL; -+ goto out; -+ } -+ if (udats[i].nr_relocs != 0 && udats[i].relocs == 0) { -+ ret = -EINVAL; -+ goto out; -+ } -+ if (udats[i].dat_size > 0x20000) { -+ ret = -E2BIG; -+ goto out; -+ } -+ mdat = &mjob->cmd_dats[i]; -+ mdat->nr_relocs = udats[i].nr_relocs; -+ if (mdat->nr_relocs) { -+ mdat->relocs = kvmalloc_array(mdat->nr_relocs, -+ sizeof(struct drm_mwv207_submit_reloc), GFP_KERNEL); -+ if (!mdat->relocs) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ ret = copy_from_user(mdat->relocs, (void __user *)udats[i].relocs, -+ mdat->nr_relocs * sizeof(struct drm_mwv207_submit_reloc)); -+ if (ret) -+ goto out; -+ } -+ mdat->dat_size = udats[i].dat_size; -+ mdat->dat = kvmalloc(mdat->dat_size, GFP_KERNEL); -+ if (!mdat->dat) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ ret = copy_from_user(mdat->dat, (void __user *)udats[i].dat, mdat->dat_size); -+ if (ret) -+ goto out; -+ ret = mwv207_bo_create(jdev, mdat->dat_size, 0x1000, ttm_bo_type_device, -+ 0x2, (1<<0), -+ &mdat->jbo); -+ if (ret) -+ goto out; -+ } -+ -+out: -+ if (unlikely(udats != udats_stack)) -+ kvfree(udats); -+ return ret; -+} -+ -+static int mwv207_submit_init_job(struct drm_device *dev, struct mwv207_job *mjob, -+ struct drm_mwv207_submit *args, struct drm_file *filp) -+{ -+ int ret; -+ -+ get_task_comm(mjob->comm, current); -+ -+ -+ mjob->ctx = mwv207_ctx_lookup(dev, filp, args->ctx); -+ if (!mjob->ctx) -+ return -ENOENT; -+ ret = mwv207_submit_select_engine(dev, mjob, args); -+ if (ret) -+ return ret; -+ ret = mwv207_submit_init_job_cmd_dat(dev, mjob, args); -+ if (ret) -+ return ret; -+ ret = mwv207_submit_init_job_bo(mjob, args, filp); -+ if (ret) -+ return ret; -+ ret = mwv207_submit_init_job_reloc(mjob, args); -+ if (ret) -+ return ret; -+ ret = mwv207_submit_init_job_cmd(mjob, args); -+ if (ret) -+ return ret; -+ -+ return 0; -+} -+ -+static struct mwv207_job *mwv207_submit_init(struct drm_device *dev, struct drm_file *filp, -+ struct drm_mwv207_submit *args) -+{ -+ struct mwv207_job *mjob; -+ int ret; -+ -+ mjob = mwv207_job_alloc(); -+ if (!mjob) -+ return ERR_PTR(-ENOMEM); -+ -+ ret = mwv207_submit_init_job(dev, mjob, args, filp); -+ if (ret) -+ goto err; -+ -+ return mjob; -+err: -+ mwv207_job_put(mjob); -+ return ERR_PTR(ret); -+} -+ -+static int mwv207_submit_patch_entry(struct mwv207_job *mjob, -+ struct drm_mwv207_submit_reloc *reloc, -+ struct mwv207_bo *jbo, char *dat, u32 dat_size) -+{ -+ u64 addr, bo_size; -+ -+ if (reloc->pad) -+ return -EINVAL; -+ -+ bo_size = mwv207_bo_size(jbo); -+ if (reloc->bo_offset >= bo_size) -+ return -ERANGE; -+ addr = mwv207_bo_gpu_phys(jbo) + reloc->bo_offset; -+ -+ -+ switch (reloc->type & 0xffff) { -+ case 0: -+ if (reloc->cmd_offset + 8 > dat_size) -+ return -ERANGE; -+ *(u64 *)(dat + reloc->cmd_offset) = addr; -+ break; -+ case 1: -+ if (reloc->cmd_offset + 4 > dat_size) -+ return -ERANGE; -+ *(u32 *)(dat + reloc->cmd_offset) = addr & 0xffffffff; -+ break; -+ case 2: -+ if (reloc->cmd_offset + 4 > dat_size) -+ return -ERANGE; -+ *(u32 *)(dat + reloc->cmd_offset) = addr >> 32; -+ break; -+ case 3: -+ if (reloc->cmd_offset + 2 > dat_size) -+ return -ERANGE; -+ *(u16 *)(dat + reloc->cmd_offset) = (addr >> 16) & 0xffff; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int mwv207_submit_patch_single(struct mwv207_job *mjob, -+ struct drm_mwv207_submit_reloc *reloc, char *dat, u32 dat_size) -+{ -+ struct mwv207_bo *jbo; -+ -+ if (reloc->type & 0x80000000) { -+ if (reloc->idx >= mjob->nr_cmd_dat) -+ return -EINVAL; -+ jbo = mwv207_job_bo(mjob, reloc->idx + mjob->nr_bos); -+ } else { -+ if (reloc->idx >= mjob->nr_bos) -+ return -EINVAL; -+ jbo = mwv207_job_bo(mjob, reloc->idx); -+ } -+ -+ return mwv207_submit_patch_entry(mjob, reloc, jbo, dat, dat_size); -+} -+ -+static int mwv207_submit_patch_dma_entry(struct mwv207_job *mjob, -+ struct mwv207_dma_loc *loc, struct mwv207_bo *jbo, -+ u64 width, u64 height) -+{ -+ struct mwv207_ttm_tt *gtt; -+ -+ if (loc->stride == 0 || loc->pg_nr_type != 0 || width == 0 || height == 0) -+ return -EINVAL; -+ -+ switch (jbo->tbo.mem.mem_type) { -+ case TTM_PL_VRAM: -+ loc->base = mwv207_bo_gpu_phys(jbo); -+ loc->pg_nr_type = MWV207_DMA_NR_PAGES_VRAM(jbo->tbo.num_pages); -+ break; -+ case TTM_PL_TT: -+ gtt = to_gtt(jbo->tbo.ttm); -+ loc->base = (u64)gtt->ttm.dma_address; -+ loc->pg_nr_type = MWV207_DMA_NR_PAGES_RAM(jbo->tbo.num_pages); -+ break; -+ default: -+ BUG_ON(1); -+ break; -+ } -+ -+ -+ if (loc->offset >= mwv207_bo_size(jbo)) -+ return -ERANGE; -+ if (loc->offset + loc->stride * (height - 1) + width <= loc->offset) -+ return -ERANGE; -+ if (loc->offset + loc->stride * (height - 1) + width > mwv207_bo_size(jbo)) -+ return -ERANGE; -+ -+ -+ if ((loc->offset % loc->stride) + width > loc->stride) -+ return -ERANGE; -+ -+ return 0; -+} -+ -+static int mwv207_submit_patch_dma(struct drm_device *dev, struct mwv207_job *mjob) -+{ -+ struct mwv207_bo *src_bo, *dst_bo, *jbo; -+ struct drm_mwv207_submit_reloc *reloc; -+ struct mwv207_dma_cmd *dma_cmd; -+ int i, ret; -+ -+ if (mjob->nr_bos != 2 || mjob->nr_relocs != 2 || mjob->nr_cmd_dat) -+ return -EINVAL; -+ if (mjob->cmd_size != sizeof(struct mwv207_dma_cmd)) -+ return -EINVAL; -+ -+ src_bo = dst_bo = NULL; -+ for (i = 0; i < mjob->nr_relocs; i++) { -+ reloc = &mjob->relocs[i]; -+ if (reloc->type & 0x80000000) -+ return -EINVAL; -+ if ((reloc->type & 0xffff) != 0) -+ return -EINVAL; -+ if (reloc->bo_offset) -+ return -EINVAL; -+ jbo = mwv207_job_bo(mjob, reloc->idx); -+ if (reloc->cmd_offset == offsetof(struct mwv207_dma_cmd, src.base)) -+ src_bo = jbo; -+ else if (reloc->cmd_offset == offsetof(struct mwv207_dma_cmd, dst.base)) -+ dst_bo = jbo; -+ } -+ if (!src_bo || !dst_bo || src_bo == dst_bo) -+ return -EINVAL; -+ -+ dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; -+ ret = mwv207_submit_patch_dma_entry(mjob, &dma_cmd->src, src_bo, -+ dma_cmd->width, dma_cmd->height); -+ if (ret) -+ return ret; -+ return mwv207_submit_patch_dma_entry(mjob, &dma_cmd->dst, dst_bo, -+ dma_cmd->width, dma_cmd->height); -+} -+ -+static int mwv207_submit_patch(struct drm_device *dev, struct mwv207_job *mjob) -+{ -+ struct mwv207_bo *jbo; -+ int i, j, ret; -+ void *ptr; -+ -+ if (mjob->is_dma) -+ return mwv207_submit_patch_dma(dev, mjob); -+ -+ for (i = 0; i < mjob->nr_relocs; ++i) { -+ ret = mwv207_submit_patch_single(mjob, &mjob->relocs[i], -+ mjob->cmds, mjob->cmd_size); -+ if (ret) -+ return ret; -+ } -+ -+ for (i = 0; i < mjob->nr_cmd_dat; ++i) { -+ if (mjob->cmd_dats[i].nr_relocs) { -+ for (j = 0; j < mjob->cmd_dats[i].nr_relocs; j++) { -+ ret = mwv207_submit_patch_single(mjob, &mjob->cmd_dats[i].relocs[j], -+ mjob->cmd_dats[i].dat, mjob->cmd_dats[i].dat_size); -+ if (ret) -+ return ret; -+ } -+ } -+ -+ -+ jbo = mjob->cmd_dats[i].jbo; -+ -+ -+ ret = ttm_bo_wait(&jbo->tbo, true, false); -+ if (ret) -+ return ret; -+ -+ ret = mwv207_bo_kmap_reserved(jbo, &ptr); -+ if (ret) -+ return ret; -+ memcpy_toio(ptr, mjob->cmd_dats[i].dat, mjob->cmd_dats[i].dat_size); -+ mwv207_bo_kunmap_reserved(jbo); -+ } -+ -+ return 0; -+} -+ -+static int mwv207_submit_validate(struct drm_device *dev, struct mwv207_job *mjob) -+{ -+ struct ttm_operation_ctx ctx = { -+ .interruptible = true, -+ .no_wait_gpu = false -+ }; -+ struct mwv207_bo *jbo; -+ int i, ret; -+ -+ for (i = 0; i < mjob->nr_bos + mjob->nr_cmd_dat; ++i) { -+ jbo = mwv207_job_bo(mjob, i); -+ -+ if (jbo->pin_count) -+ continue; -+ -+ if (mjob->is_dma) { -+ if (jbo->tbo.mem.mem_type != TTM_PL_SYSTEM) -+ continue; -+ -+ mwv207_bo_placement_from_domain(jbo, 0x4, 0); -+ } else { -+ -+ jbo->flags |= (1<<2); -+ if (i >= mjob->nr_bos) -+ jbo->flags |= (1<<0); -+ mwv207_bo_placement_from_domain(jbo, 0x2, 0); -+ } -+ -+ ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); -+ if (ret) -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static int mwv207_submit_attach_dependency(struct mwv207_job *mjob, struct drm_mwv207_submit *args) -+{ -+ struct dma_resv *resv; -+ struct mwv207_tvb *mtvb; -+ int ret; -+ -+ mwv207_for_each_mtvb(mtvb, mjob) { -+ resv = mtvb->base.bo->base.resv; -+ if (mtvb->base.num_shared == 0) { -+ ret = dma_resv_get_fences_rcu(resv, &mtvb->excl, -+ &mtvb->nr_shared, &mtvb->shared); -+ if (ret) -+ return ret; -+ } else -+ mtvb->excl = dma_resv_get_excl_rcu(resv); -+ } -+ -+ if (unlikely(args->flags & 0x00000001)) { -+ mjob->fence_in = sync_file_get_fence(args->fence_fd); -+ if (!mjob->fence_in) -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int mwv207_submit_commit(struct mwv207_job *mjob, -+ struct drm_mwv207_submit *args, struct dma_fence **fence) -+{ -+ int ret; -+ -+ /* XXX: job init and push should be protected with common lock, -+ * refer to drm_sched_entity_push_job documentation for details -+ */ -+ ret = drm_sched_job_init(&mjob->base, mjob->engine_entity, mjob->ctx); -+ if (ret) -+ return ret; -+ -+ if (args->flags & 0x00000002) { -+ struct sync_file *sync_file; -+ int fd; -+ -+ fd = get_unused_fd_flags(O_CLOEXEC); -+ if (fd < 0) -+ return fd; -+ sync_file = sync_file_create(&mjob->base.s_fence->finished); -+ if (!sync_file) { -+ put_unused_fd(fd); -+ return -ENOMEM; -+ } -+ fd_install(fd, sync_file->file); -+ args->fence_fd = fd; -+ } -+ -+ -+ *fence = &mjob->base.s_fence->finished; -+ -+ -+ mwv207_job_get(mjob); -+ drm_sched_entity_push_job(&mjob->base, mjob->engine_entity); -+ return 0; -+} -+ -+int mwv207_submit_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ struct drm_mwv207_submit *args = data; -+ struct ww_acquire_ctx ticket; -+ struct mwv207_job *mjob; -+ struct dma_fence *fence = NULL; -+ int ret; -+ -+ if (args->padding || (args->flags & ~0x00000003)) -+ return -EINVAL; -+ if (args->cmd_size == 0 || args->cmds == 0) -+ return -EINVAL; -+ -+ mjob = mwv207_submit_init(dev, filp, args); -+ if (IS_ERR(mjob)) -+ return PTR_ERR(mjob); -+ ret = ttm_eu_reserve_buffers(&ticket, &mjob->tvblist, true, NULL); -+ if (ret) -+ goto put_job; -+ ret = mwv207_submit_validate(dev, mjob); -+ if (ret) -+ goto unreserve; -+ ret = mwv207_submit_patch(dev, mjob); -+ if (ret) -+ goto unreserve; -+ ret = mwv207_submit_attach_dependency(mjob, args); -+ if (ret) -+ goto unreserve; -+ ret = mwv207_submit_commit(mjob, args, &fence); -+ if (ret) -+ goto unreserve; -+unreserve: -+ if (likely(fence)) -+ ttm_eu_fence_buffer_objects(&ticket, &mjob->tvblist, fence); -+ else -+ ttm_eu_backoff_reservation(&ticket, &mjob->tvblist); -+put_job: -+ mwv207_job_put(mjob); -+ -+ return ret; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_submit.h b/drivers/gpu/drm/mwv207/mwv207_submit.h -new file mode 100644 -index 000000000..194fceafa ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_submit.h -@@ -0,0 +1,23 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#ifndef MWV207_SUBMIT_H_2S1GH9LD -+#define MWV207_SUBMIT_H_2S1GH9LD -+ -+int mwv207_submit_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_ttm.c b/drivers/gpu/drm/mwv207/mwv207_ttm.c -new file mode 100644 -index 000000000..45cdf2e73 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_ttm.c -@@ -0,0 +1,613 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "mwv207.h" -+#include "mwv207_bo.h" -+#include "mwv207_drm.h" -+#include "mwv207_sched.h" -+ -+static int mwv207_mem_visible(struct mwv207_device *jdev, struct ttm_resource *mem) -+{ -+ if (mem->mem_type == TTM_PL_SYSTEM || -+ mem->mem_type == TTM_PL_TT) -+ return true; -+ if (mem->mem_type != TTM_PL_VRAM) -+ return false; -+ -+ -+ return ((mem->start << PAGE_SHIFT) + mem->size < jdev->visible_vram_size); -+} -+ -+ -+static void mwv207_evict_flags(struct ttm_buffer_object *bo, -+ struct ttm_placement *placement) -+{ -+ struct mwv207_device *jdev; -+ struct mwv207_bo *jbo; -+ static const struct ttm_place placements = { -+ .fpfn = 0, -+ .lpfn = 0, -+ .flags = 0, -+ .mem_type = TTM_PL_SYSTEM -+ }; -+ -+ if (!mwv207_ttm_bo_is_mwv207_bo(bo)) { -+ placement->placement = &placements; -+ placement->busy_placement = &placements; -+ placement->num_placement = 1; -+ placement->num_busy_placement = 1; -+ return; -+ } -+ -+ jbo = to_jbo(bo); -+ jdev = ddev_to_jdev(jbo->tbo.base.dev); -+ -+ /* evict order: * visible vram -> invisible vram -> GTT -> SYSTEM */ -+ if (bo->mem.mem_type == TTM_PL_VRAM) { -+ if (jdev->visible_vram_size != jdev->vram_size -+ && mwv207_mem_visible(jdev, &bo->mem)) { -+ jbo->flags &= ~((1<<0) | (1<<2)); -+ mwv207_bo_placement_from_domain(jbo, -+ 0x2 | 0x4, -+ false); -+ BUG_ON(!(jbo->placements[0].mem_type & TTM_PL_VRAM)); -+ BUG_ON(!(jbo->placements[1].mem_type & TTM_PL_TT)); -+ jbo->placements[0].fpfn = jdev->visible_vram_size >> PAGE_SHIFT; -+ jbo->placements[0].lpfn = 0; -+ jbo->placement.placement = &jbo->placements[0]; -+ jbo->placement.busy_placement = &jbo->placements[1]; -+ jbo->placement.num_placement = 1; -+ jbo->placement.num_busy_placement = 1; -+ } else -+ mwv207_bo_placement_from_domain(jbo, 0x4, false); -+ } else -+ mwv207_bo_placement_from_domain(jbo, 0x1, false); -+ -+ *placement = jbo->placement; -+} -+ -+static int mwv207_ttm_io_mem_reserve(struct ttm_bo_device *bdev, -+ struct ttm_resource *mem) -+{ -+ struct mwv207_device *jdev = bdev_to_jdev(bdev); -+ size_t bus_size = (size_t)mem->num_pages << PAGE_SHIFT; -+ -+ mem->bus.addr = NULL; -+ mem->bus.offset = 0; -+ mem->bus.is_iomem = false; -+ -+ switch (mem->mem_type) { -+ case TTM_PL_SYSTEM: -+ case TTM_PL_TT: -+ -+ return 0; -+ case TTM_PL_VRAM: -+ -+ mem->bus.offset = mem->start << PAGE_SHIFT; -+ if (mem->bus.offset + bus_size > jdev->visible_vram_size) -+ return -EINVAL; -+ mem->bus.is_iomem = true; -+ mem->bus.offset += jdev->vram_bar_base; -+ break; -+ default: -+ return -EINVAL; -+ } -+ return 0; -+} -+ -+static int mwv207_ttm_tt_bind(struct ttm_bo_device *bdev, -+ struct ttm_tt *ttm, -+ struct ttm_resource *bo_mem) -+{ -+ if (!bo_mem) -+ return -EINVAL; -+ return 0; -+} -+ -+static void mwv207_ttm_tt_unbind(struct ttm_bo_device *bdev, -+ struct ttm_tt *ttm) -+{ -+ return ; -+} -+ -+static void mwv207_ttm_tt_destroy(struct ttm_bo_device *bdev, -+ struct ttm_tt *ttm) -+{ -+ struct mwv207_ttm_tt *gtt = to_gtt(ttm); -+ ttm_tt_destroy_common(bdev, ttm); -+ -+ ttm_dma_tt_fini(>t->ttm); -+ kfree(gtt); -+} -+ -+static struct ttm_tt *mwv207_ttm_tt_create(struct ttm_buffer_object *bo, -+ u32 page_flags) -+{ -+ struct mwv207_device *jdev; -+ struct mwv207_ttm_tt *gtt; -+ -+ jdev = ddev_to_jdev(bo->base.dev); -+ gtt = kzalloc(sizeof(struct mwv207_ttm_tt), GFP_KERNEL); -+ if (gtt == NULL) -+ return NULL; -+ gtt->jdev = jdev; -+ if (ttm_dma_tt_init(>t->ttm, bo, page_flags)) { -+ kfree(gtt); -+ return NULL; -+ } -+ return >t->ttm.ttm; -+} -+ -+static int mwv207_ttm_tt_populate(struct ttm_bo_device *bdev, -+ struct ttm_tt *ttm, -+ struct ttm_operation_ctx *ctx) -+{ -+ struct mwv207_ttm_tt *gtt = to_gtt(ttm); -+ struct mwv207_device *jdev = bdev_to_jdev(bdev); -+ -+ return ttm_dma_populate(>t->ttm, jdev->dev, ctx); -+} -+ -+static void mwv207_ttm_tt_unpopulate(struct ttm_bo_device *bdev, -+ struct ttm_tt *ttm) -+{ -+ struct mwv207_ttm_tt *gtt = to_gtt(ttm); -+ struct mwv207_device *jdev = bdev_to_jdev(bdev); -+ -+ ttm_dma_unpopulate(>t->ttm, jdev->dev); -+} -+ -+static int mwv207_ttm_job_submit(struct mwv207_job *mjob, struct dma_fence **fence) -+{ -+ int ret; -+ -+ ret = drm_sched_job_init(&mjob->base, mjob->engine_entity, NULL); -+ if (ret) -+ return ret; -+ -+ *fence = &mjob->base.s_fence->finished; -+ -+ mwv207_job_get(mjob); -+ drm_sched_entity_push_job(&mjob->base, mjob->engine_entity); -+ -+ return 0; -+} -+ -+static struct mwv207_job *mwv207_ttm_job_alloc(struct ttm_buffer_object *bo) -+{ -+ struct mwv207_job *mjob = mwv207_job_alloc(); -+ struct mwv207_dma_cmd *dma_cmd; -+ struct mwv207_tvb *mtvb; -+ int ret; -+ -+ if (!mjob) -+ return ERR_PTR(-ENOMEM); -+ -+ -+ dma_cmd = kmalloc(sizeof(*dma_cmd), GFP_KERNEL); -+ if (!dma_cmd) { -+ ret = -ENOMEM; -+ goto err; -+ } -+ dma_cmd->src.offset = 0; -+ dma_cmd->src.stride = bo->mem.size; -+ dma_cmd->dst.offset = 0; -+ dma_cmd->dst.stride = bo->mem.size; -+ dma_cmd->width = bo->mem.size; -+ dma_cmd->height = 1; -+ -+ mjob->cmds = (char *)dma_cmd; -+ mjob->cmd_size = sizeof(*dma_cmd); -+ mjob->engine_entity = ddev_to_jdev(bo->base.dev)->dma_entity; -+ mjob->is_dma = true; -+ -+ -+ mjob->mtvb = kzalloc(sizeof(struct mwv207_tvb), GFP_KERNEL); -+ if (!mjob->mtvb) { -+ ret = -ENOMEM; -+ goto err; -+ } -+ mtvb = &mjob->mtvb[0]; -+ list_add_tail(&mtvb->base.head, &mjob->tvblist); -+ -+ ret = dma_resv_get_fences_rcu(bo->base.resv, &mtvb->excl, -+ &mtvb->nr_shared, &mtvb->shared); -+ if (ret) -+ goto err; -+ -+ return mjob; -+err: -+ mwv207_job_put(mjob); -+ return ERR_PTR(ret); -+} -+ -+static int mwv207_move_vram_gtt(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct ttm_tt *ttm = bo->ttm; -+ struct mwv207_ttm_tt *gtt = to_gtt(ttm); -+ struct mwv207_dma_cmd *dma_cmd; -+ struct mwv207_job *mjob; -+ struct dma_fence *fence; -+ int ret; -+ -+ mjob = mwv207_ttm_job_alloc(bo); -+ if (IS_ERR(mjob)) -+ return PTR_ERR(mjob); -+ -+ dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; -+ dma_cmd->src.base = bo->mem.start << PAGE_SHIFT; -+ dma_cmd->src.pg_nr_type = MWV207_DMA_NR_PAGES_VRAM(bo->mem.num_pages); -+ dma_cmd->dst.base = (u64)gtt->ttm.dma_address; -+ dma_cmd->dst.pg_nr_type = MWV207_DMA_NR_PAGES_RAM(ttm->num_pages); -+ -+ ret = mwv207_ttm_job_submit(mjob, &fence); -+ if (!ret) -+ ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); -+ -+ mwv207_job_put(mjob); -+ return ret; -+} -+ -+static int mwv207_move_gtt_vram(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct ttm_tt *ttm = bo->ttm; -+ struct mwv207_ttm_tt *gtt = to_gtt(ttm); -+ struct mwv207_dma_cmd *dma_cmd; -+ struct mwv207_job *mjob; -+ struct dma_fence *fence; -+ int ret; -+ -+ mjob = mwv207_ttm_job_alloc(bo); -+ if (IS_ERR(mjob)) -+ return PTR_ERR(mjob); -+ -+ dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; -+ dma_cmd->src.base = (u64)gtt->ttm.dma_address; -+ dma_cmd->src.pg_nr_type = MWV207_DMA_NR_PAGES_RAM(ttm->num_pages); -+ dma_cmd->dst.base = new_mem->start << PAGE_SHIFT; -+ dma_cmd->dst.pg_nr_type = MWV207_DMA_NR_PAGES_VRAM(bo->mem.num_pages); -+ -+ ret = mwv207_ttm_job_submit(mjob, &fence); -+ if (!ret) -+ ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); -+ -+ mwv207_job_put(mjob); -+ return ret; -+} -+ -+static int mwv207_move_vram_vram(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct mwv207_dma_cmd *dma_cmd; -+ struct mwv207_job *mjob; -+ struct dma_fence *fence; -+ int ret; -+ -+ mjob = mwv207_ttm_job_alloc(bo); -+ if (IS_ERR(mjob)) -+ return PTR_ERR(mjob); -+ -+ dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; -+ dma_cmd->src.base = bo->mem.start << PAGE_SHIFT; -+ dma_cmd->src.pg_nr_type = MWV207_DMA_NR_PAGES_VRAM(bo->mem.num_pages); -+ dma_cmd->dst.base = new_mem->start << PAGE_SHIFT; -+ dma_cmd->dst.pg_nr_type = MWV207_DMA_NR_PAGES_VRAM(new_mem->num_pages); -+ -+ ret = mwv207_ttm_job_submit(mjob, &fence); -+ if (!ret) -+ ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); -+ -+ mwv207_job_put(mjob); -+ return ret; -+} -+ -+static int mwv207_move_vram_ram(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct ttm_placement placement; -+ struct ttm_place placements; -+ struct ttm_resource tmp_mem; -+ int ret; -+ -+ if (new_mem->mem_type == TTM_PL_TT) -+ return mwv207_move_vram_gtt(bo, evict, ctx, new_mem); -+ -+ -+ tmp_mem = *new_mem; -+ tmp_mem.mm_node = NULL; -+ placement.num_placement = 1; -+ placement.placement = &placements; -+ placement.num_busy_placement = 1; -+ placement.busy_placement = &placements; -+ placements.fpfn = 0; -+ placements.lpfn = 0; -+ placements.flags = TTM_PL_MASK_CACHING; -+ placements.mem_type = TTM_PL_TT; -+ ret = ttm_bo_mem_space(bo, &placement, &tmp_mem, ctx); -+ if (unlikely(ret)) -+ return ret; -+ -+ ret = ttm_tt_set_placement_caching(bo->ttm, tmp_mem.placement); -+ if (unlikely(ret)) -+ goto out; -+ -+ ret = ttm_tt_populate(bo->bdev, bo->ttm, ctx); -+ if (unlikely(ret)) -+ goto out; -+ -+ ret = mwv207_move_vram_gtt(bo, evict, ctx, &tmp_mem); -+ if (likely(!ret)) -+ ret = ttm_bo_move_ttm(bo, ctx, new_mem); -+out: -+ ttm_resource_free(bo, &tmp_mem); -+ return ret; -+} -+ -+static int mwv207_move_ram_vram(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct ttm_placement placement; -+ struct ttm_place placements; -+ struct ttm_resource tmp_mem; -+ int ret; -+ -+ if (bo->mem.mem_type == TTM_PL_TT) -+ return mwv207_move_gtt_vram(bo, evict, ctx, new_mem); -+ -+ -+ tmp_mem = *new_mem; -+ tmp_mem.mm_node = NULL; -+ placement.num_placement = 1; -+ placement.placement = &placements; -+ placement.num_busy_placement = 1; -+ placement.busy_placement = &placements; -+ placements.fpfn = 0; -+ placements.lpfn = 0; -+ placements.flags = TTM_PL_MASK_CACHING; -+ placements.mem_type = TTM_PL_TT; -+ ret = ttm_bo_mem_space(bo, &placement, &tmp_mem, ctx); -+ if (unlikely(ret)) -+ return ret; -+ -+ ret = ttm_bo_move_ttm(bo, ctx, &tmp_mem); -+ if (unlikely(ret)) -+ goto out; -+ -+ ret = mwv207_move_gtt_vram(bo, evict, ctx, new_mem); -+out: -+ ttm_resource_free(bo, &tmp_mem); -+ return ret; -+} -+ -+static int mwv207_mem_in_ram(struct ttm_resource *mem) -+{ -+ return mem->mem_type == TTM_PL_SYSTEM || mem->mem_type == TTM_PL_TT; -+} -+ -+static int mwv207_bo_move(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct ttm_resource *old_mem = &bo->mem; -+ struct mwv207_bo *jbo = to_jbo(bo); -+ struct mwv207_device *jdev; -+ int ret; -+ -+ if (WARN_ON_ONCE(jbo->pin_count > 0)) -+ return -EINVAL; -+ -+ jdev = ddev_to_jdev(jbo->tbo.base.dev); -+ if (old_mem->mem_type == TTM_PL_SYSTEM && bo->ttm == NULL) { -+ -+ ttm_bo_move_null(bo, new_mem); -+ return 0; -+ } -+ -+ if (mwv207_mem_in_ram(old_mem) && mwv207_mem_in_ram(new_mem)) { -+ -+ ttm_bo_move_null(bo, new_mem); -+ return 0; -+ } -+ -+ if (old_mem->mem_type == TTM_PL_VRAM && -+ mwv207_mem_in_ram(new_mem)) { -+ ret = mwv207_move_vram_ram(bo, evict, ctx, new_mem); -+ } else if (mwv207_mem_in_ram(old_mem) && -+ new_mem->mem_type == TTM_PL_VRAM) { -+ ret = mwv207_move_ram_vram(bo, evict, ctx, new_mem); -+ } else if (old_mem->mem_type == TTM_PL_VRAM && -+ new_mem->mem_type == TTM_PL_VRAM) { -+ ret = mwv207_move_vram_vram(bo, evict, ctx, new_mem); -+ } else { -+ ret = -EINVAL; -+ } -+ -+ if (ret == 0) -+ goto moved; -+ -+ -+ if (!mwv207_mem_visible(jdev, new_mem) -+ || !mwv207_mem_visible(jdev, old_mem)) { -+ pr_err("mwv207: can't move invisible mem by cpu"); -+ return ret; -+ } -+ ret = ttm_bo_move_memcpy(bo, ctx, new_mem); -+ if (ret) -+ return ret; -+moved: -+ if (!mwv207_mem_visible(jdev, new_mem)) -+ jbo->flags &= ~(1<<0); -+ -+ return 0; -+} -+ -+static void mwv207_bo_move_notify(struct ttm_buffer_object *bo, -+ bool evict, -+ struct ttm_resource *new_mem) -+{ -+ struct mwv207_bo *jbo; -+ struct mwv207_device *jdev; -+ -+ if (!mwv207_ttm_bo_is_mwv207_bo(bo)) -+ return; -+ jbo = to_jbo(bo); -+ jdev = ddev_to_jdev(jbo->tbo.base.dev); -+} -+ -+static int mwv207_bo_fault_reserve_notify(struct ttm_buffer_object *bo) -+{ -+ struct ttm_operation_ctx ctx = { -+ .interruptible = true, -+ .no_wait_gpu = false -+ }; -+ struct mwv207_device *jdev; -+ struct mwv207_bo *jbo; -+ u64 size, offset; -+ u32 domain; -+ int ret; -+ -+ if (!mwv207_ttm_bo_is_mwv207_bo(bo)) -+ return 0; -+ if (bo->mem.mem_type != TTM_PL_VRAM) -+ return 0; -+ -+ jbo = to_jbo(bo); -+ jdev = ddev_to_jdev(jbo->tbo.base.dev); -+ size = bo->mem.num_pages << PAGE_SHIFT; -+ offset = bo->mem.start << PAGE_SHIFT; -+ -+ jbo->flags |= (1<<0); -+ -+ if ((offset + size) <= jdev->visible_vram_size) -+ return 0; -+ -+ if (jbo->pin_count > 0) -+ return -EINVAL; -+ -+ /* TODO: -+ * 1. moving to RAM won't invoke swap, and thus causing ENOMEM when -+ * system memory is low. figure out why. -+ * 2. slide iatu window to optimize out this validation. -+ */ -+ domain = 0x2; -+retry: -+ mwv207_bo_placement_from_domain(jbo, domain, false); -+ ret = ttm_bo_validate(bo, &jbo->placement, &ctx); -+ if (unlikely(ret)) { -+ if (ret != -ERESTARTSYS) { -+ if (domain == 0x2) { -+ -+ domain = 0x1; -+ goto retry; -+ } -+ } -+ return ret; -+ } -+ -+ -+ offset = bo->mem.start << PAGE_SHIFT; -+ if (bo->mem.mem_type == TTM_PL_VRAM && -+ (offset + size) > jdev->visible_vram_size) { -+ DRM_ERROR("bo validation goes crazy"); -+ return -EINVAL; -+ } -+ -+ return ret; -+} -+ -+static int mwv207_bo_verify_access(struct ttm_buffer_object *tbo, struct file *filp) -+{ -+ return drm_vma_node_verify_access(&tbo->base.vma_node, -+ filp->private_data); -+} -+ -+static struct ttm_bo_driver mwv207_bo_driver = { -+ .ttm_tt_create = mwv207_ttm_tt_create, -+ .ttm_tt_populate = mwv207_ttm_tt_populate, -+ .ttm_tt_unpopulate = mwv207_ttm_tt_unpopulate, -+ .ttm_tt_bind = &mwv207_ttm_tt_bind, -+ .ttm_tt_unbind = &mwv207_ttm_tt_unbind, -+ .ttm_tt_destroy = &mwv207_ttm_tt_destroy, -+ .eviction_valuable = ttm_bo_eviction_valuable, -+ .evict_flags = mwv207_evict_flags, -+ .move = mwv207_bo_move, -+ .io_mem_reserve = mwv207_ttm_io_mem_reserve, -+ .move_notify = mwv207_bo_move_notify, -+ .fault_reserve_notify = &mwv207_bo_fault_reserve_notify, -+ .verify_access = mwv207_bo_verify_access, -+}; -+ -+int mwv207_ttm_init(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ ret = ttm_bo_device_init(&jdev->bdev, -+ &mwv207_bo_driver, -+ jdev->base.anon_inode->i_mapping, -+ jdev->base.vma_offset_manager, -+ true); -+ if (ret) { -+ DRM_ERROR("failed to initialize buffer object driver(%d).\n", ret); -+ return ret; -+ } -+ -+ -+ ret = ttm_range_man_init(&jdev->bdev, TTM_PL_TT, true, -+ 0x80000000ULL >> PAGE_SHIFT); -+ if (ret) { -+ DRM_ERROR("failed to initialize GTT heap.\n"); -+ goto out_no_vram; -+ } -+ -+ -+ ret = ttm_range_man_init(&jdev->bdev, TTM_PL_VRAM, false, -+ jdev->vram_size >> PAGE_SHIFT); -+ if (ret) { -+ DRM_ERROR("failed to initialize VRAM heap.\n"); -+ goto out_no_vram; -+ } -+ DRM_INFO("mwv207: %lldM of VRAM memory size\n", jdev->vram_size / (1024 * 1024)); -+ return 0; -+ -+out_no_vram: -+ ttm_bo_device_release(&jdev->bdev); -+ return ret; -+} -+ -+void mwv207_ttm_fini(struct mwv207_device *jdev) -+{ -+ ttm_range_man_fini(&jdev->bdev, TTM_PL_VRAM); -+ ttm_range_man_fini(&jdev->bdev, TTM_PL_TT); -+ ttm_bo_device_release(&jdev->bdev); -+ DRM_INFO("mwv207: ttm finalized\n"); -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_ttm.h b/drivers/gpu/drm/mwv207/mwv207_ttm.h -new file mode 100644 -index 000000000..9cbf61ed3 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_ttm.h -@@ -0,0 +1,25 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_TTM_H_TJTW9M4R -+#define MWV207_TTM_H_TJTW9M4R -+#include -+#include -+#include -+#include "mwv207.h" -+ -+int mwv207_bo_fault_reserve_notify(struct ttm_buffer_object *bo); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_vbios.c b/drivers/gpu/drm/mwv207/mwv207_vbios.c -new file mode 100644 -index 000000000..0da8244ef ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_vbios.c -@@ -0,0 +1,189 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207.h" -+#include "mwv207_vbios.h" -+ -+/* -+ */ -+static inline u8 mwv207_flash_read8(struct mwv207_device *jdev, u32 offset) -+{ -+ return ioread8(jdev->mmio + 0x100000 + offset); -+} -+ -+static inline u16 mwv207_flash_read16(struct mwv207_device *jdev, u32 offset) -+{ -+ u16 dat = ioread16(jdev->mmio + 0x100000 + offset); -+ -+ return le16_to_cpu(dat); -+} -+ -+static inline u32 mwv207_flash_read32(struct mwv207_device *jdev, u32 offset) -+{ -+ u32 dat = ioread32(jdev->mmio + 0x100000 + offset); -+ -+ return le32_to_cpu(dat); -+} -+ -+static inline void mwv207_flash_cpy(struct mwv207_device *jdev, void *dst, u32 offset, u32 len) -+{ -+ memcpy_fromio(dst, jdev->mmio + 0x100000 + offset, len); -+} -+ -+static int mwv207_vbios_check_indexer(struct mwv207_device *jdev, u32 offset) -+{ -+ u16 count, chksum, calc; -+ -+ if (mwv207_flash_read16(jdev, offset) != 0xaa55) -+ return -EINVAL; -+ -+ count = mwv207_flash_read16(jdev, offset + 2); -+ chksum = mwv207_flash_read16(jdev, offset + 4); -+ -+ jdev->vbios.sector_count = count; -+ for (calc = 0, offset += 8, count *= 8; count > 0; count--) -+ calc += mwv207_flash_read8(jdev, offset++); -+ -+ if (calc != chksum) -+ return -EINVAL; -+ -+ jdev->vbios.indexer_valid = 1; -+ return 0; -+} -+ -+static inline int mwv207_vbios_sector(struct mwv207_device *jdev, u32 idx, u32 *poffset) -+{ -+ if (poffset == NULL || !jdev->vbios.indexer_valid || idx >= jdev->vbios.sector_count) -+ return -EINVAL; -+ -+ *poffset = mwv207_flash_read32(jdev, 0xa000 + 0x8 + idx * 8 + 4); -+ return 0; -+} -+ -+static inline int mwv207_vbios_insert_vdat(struct mwv207_device *jdev, u32 key, -+ struct mwv207_vdat *vdat) -+{ -+ int ret; -+ -+ mutex_lock(&jdev->vbios.cfg_lock); -+ ret = idr_alloc(&jdev->vbios.cfg_table, vdat, key, key + 1, GFP_KERNEL); -+ mutex_unlock(&jdev->vbios.cfg_lock); -+ -+ return ret; -+} -+ -+static void mwv207_vbios_parse_hdmi(struct mwv207_device *jdev) -+{ -+ u32 count, offset, chksum, len; -+ struct mwv207_vdat *vdat[4]; -+ u32 select[4]; -+ u8 magic[8]; -+ int ret, i; -+ -+ ret = mwv207_vbios_sector(jdev, 0xa, &offset); -+ if (ret) -+ return; -+ -+ mwv207_flash_cpy(jdev, magic, offset, 8); -+ if (memcmp(magic, "JMPHYCFG", 8)) -+ return; -+ -+ len = mwv207_flash_read32(jdev, offset + 0x18); -+ if (len > 0x1200 || (len % 1140)) -+ return; -+ count = len / 1140; -+ -+ for (chksum = 0, i = 0; i < len; i += 4) -+ chksum += mwv207_flash_read32(jdev, offset + 0x20 + i); -+ if (chksum != mwv207_flash_read32(jdev, offset + 0x14)) -+ return; -+ -+ for (i = 0; i < 4; i++) { -+ select[i] = mwv207_flash_read8(jdev, offset + 0x1c + i); -+ if (select[i] > min_t(u32, 3, count - 1)) -+ return; -+ } -+ -+ for (i = 0; i < 4; i++) { -+ void *dat; -+ -+ vdat[i] = devm_kzalloc(jdev->dev, sizeof(*vdat[i]), GFP_KERNEL); -+ if (!vdat[i]) -+ return; -+ vdat[i]->len = 1140; -+ dat = devm_kmalloc(jdev->dev, vdat[i]->len, GFP_KERNEL); -+ if (!dat) -+ return; -+ mwv207_flash_cpy(jdev, dat, -+ offset + 0x20 + select[i] * 1140, -+ 1140); -+ -+ vdat[i]->dat = dat; -+ -+ (void)mwv207_vbios_insert_vdat(jdev, 0xfff0 + i, vdat[i]); -+ } -+} -+ -+static void mwv207_vbios_parse_edp(struct mwv207_device *jdev) -+{ -+ -+} -+ -+static void mwv207_vbios_parse_cfg(struct mwv207_device *jdev) -+{ -+ -+} -+ -+const struct mwv207_vdat *mwv207_vbios_vdat(struct mwv207_device *jdev, u32 key) -+{ -+ struct mwv207_vdat *dat; -+ -+ mutex_lock(&jdev->vbios.cfg_lock); -+ dat = idr_find(&jdev->vbios.cfg_table, key); -+ mutex_unlock(&jdev->vbios.cfg_lock); -+ -+ return dat; -+} -+ -+void mwv207_vbios_init(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ mutex_init(&jdev->vbios.vcmd_lock); -+ mutex_init(&jdev->vbios.cfg_lock); -+ idr_init(&jdev->vbios.cfg_table); -+ -+ ret = mwv207_vbios_check_indexer(jdev, 0xa000); -+ if (ret) { -+ pr_warn("mwv207: vbios indexer is not valid"); -+ return; -+ } -+ -+ mwv207_vbios_parse_hdmi(jdev); -+ mwv207_vbios_parse_edp(jdev); -+ mwv207_vbios_parse_cfg(jdev); -+} -+ -+void mwv207_vbios_fini(struct mwv207_device *jdev) -+{ -+ struct mwv207_vdat *vdat; -+ u32 id; -+ -+ idr_for_each_entry(&jdev->vbios.cfg_table, vdat, id) { -+ devm_kfree(jdev->dev, vdat->dat); -+ devm_kfree(jdev->dev, vdat); -+ } -+ idr_destroy(&jdev->vbios.cfg_table); -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_vbios.h b/drivers/gpu/drm/mwv207/mwv207_vbios.h -new file mode 100644 -index 000000000..75796f865 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_vbios.h -@@ -0,0 +1,51 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_VBIOS_H_D2JHN3FG -+#define MWV207_VBIOS_H_D2JHN3FG -+ -+struct mwv207_device; -+ -+enum pll_id { -+ MWV207_PLL_GPU = 0, -+ MWV207_PLL_GRAPH0, -+ MWV207_PLL_GRAPH1, -+ MWV207_PLL_GRAPH2, -+ MWV207_PLL_GRAPH3, -+ MWV207_PLL_GRAPH4, -+ MWV207_PLL_HD, -+ MWV207_PLL_GU3D0, -+ MWV207_PLL_EDP, -+ MWV207_PLL_GU3D1, -+ MWV207_PLL_RESERVED, -+ MWV207_PLL_GU2D_PLL, -+ MWV207_PLL_DDR, -+ MWV207_PLL_COUNT -+}; -+ -+struct mwv207_vdat { -+ const void *dat; -+ u32 len; -+}; -+ -+int mwv207_vbios_set_pll(struct mwv207_device *jdev, int pll_id, u32 kfreq); -+ -+int mwv207_vbios_get_pll(struct mwv207_device *jdev, int pll_idx, unsigned long *kfreq); -+ -+const struct mwv207_vdat *mwv207_vbios_vdat(struct mwv207_device *jdev, u32 key); -+ -+void mwv207_vbios_init(struct mwv207_device *jdev); -+void mwv207_vbios_fini(struct mwv207_device *jdev); -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_vcmd.c b/drivers/gpu/drm/mwv207/mwv207_vcmd.c -new file mode 100644 -index 000000000..6c2385987 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_vcmd.c -@@ -0,0 +1,178 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_vbios.h" -+ -+#define MWV207_PLL_TIMEOUT msecs_to_jiffies(1000) -+ -+#define MWV207_PLL_STATE_INDEX(id) (0x100 * ((id) / 6) + 0x20 * ((id) % 6)) -+#define MWV207_PLL_STATE_BASE(id) (0x9b0000 + 0xA00 + MWV207_PLL_STATE_INDEX(id)) -+ -+#define MWV207_PLL_FBDIV_REFDIV(id) (MWV207_PLL_STATE_BASE(id) + 0x00) -+#define MWV207_PLL_FRAC(id) (MWV207_PLL_STATE_BASE(id) + 0x04) -+#define MWV207_PLL_POSTDIV(id) (MWV207_PLL_STATE_BASE(id) + 0x08) -+ -+static inline int mwv207_vcmd_idle(struct mwv207_device *jdev) -+{ -+ u32 state; -+ -+ state = jdev_read(jdev, (0x9b0144)) >> 28; -+ -+ return state == 0; -+} -+ -+static inline int mwv207_vcmd_wait_idle(struct mwv207_device *jdev) -+{ -+ int i; -+ -+ -+ for (i = 0; i < 1000 && !mwv207_vcmd_idle(jdev); i++) -+ usleep_range(1000, 1001); -+ return mwv207_vcmd_idle(jdev) ? 0 : -ETIMEDOUT; -+} -+ -+static inline void mwv207_vcmd_req(struct mwv207_device *jdev, int cmd, -+ int idx, u32 value, int enable) -+{ -+ u32 req; -+ -+ req = cmd << 28; -+ req |= idx << 24; -+ req |= value << 1; -+ req |= enable ? 1 : 0; -+ -+ jdev_write(jdev, (0x9b0140), req); -+} -+ -+static inline void mwv207_vcmd_start(struct mwv207_device *jdev) -+{ -+ jdev_write(jdev, (0x9b0144), 1 << 28); -+} -+ -+static inline int mwv207_vcmd_result(struct mwv207_device *jdev) -+{ -+ return (jdev_read(jdev, (0x9b0144)) >> 24) & 0xf; -+} -+ -+static int mwv207_vcmd_execute(struct mwv207_device *jdev, int cmd, -+ int idx, u32 value, int enable) -+{ -+ int ret; -+ -+ mutex_lock(&jdev->vbios.vcmd_lock); -+ -+ -+ ret = mwv207_vcmd_wait_idle(jdev); -+ if (ret) -+ goto unlock; -+ -+ -+ mwv207_vcmd_req(jdev, cmd, idx, value, enable); -+ -+ -+ mwv207_vcmd_start(jdev); -+ -+ -+ ret = mwv207_vcmd_wait_idle(jdev); -+ if (ret) -+ goto unlock; -+ -+ ret = mwv207_vcmd_result(jdev); -+ switch (ret) { -+ case 0: -+ goto unlock; -+ case 1: -+ pr_err("unsupport pll type!)"); -+ break; -+ case 2: -+ -+ pr_info_once("pll set, invalid freq!"); -+ break; -+ case 3: -+ pr_err("pll busy!"); -+ break; -+ case 4: -+ pr_err("pll set, invalid argument!"); -+ break; -+ case 9: -+ pr_err("PLL REQ cmd code unsupport!"); -+ break; -+ default: -+ pr_err("unknown pll error! (code 0x%x)", ret); -+ break; -+ } -+ ret = -EIO; -+unlock: -+ mutex_unlock(&jdev->vbios.vcmd_lock); -+ return ret; -+} -+ -+int mwv207_vbios_set_pll(struct mwv207_device *jdev, int pll_idx, u32 kfreq) -+{ -+ if (pll_idx >= MWV207_PLL_COUNT) -+ return -EINVAL; -+ -+ return mwv207_vcmd_execute(jdev, 1, pll_idx, -+ kfreq, kfreq ? 1 : 0); -+} -+ -+int mwv207_vbios_get_pll(struct mwv207_device *jdev, int pll_idx, unsigned long *kfreq) -+{ -+ u32 port, state1, state2, state3; -+ u32 refdiv, fbintdiv, fbracdiv, postdiv1, postdiv2; -+ u32 postdiv_mask, postdiv_offset; -+ u64 freq; -+ -+ if (pll_idx >= MWV207_PLL_COUNT) -+ return -EINVAL; -+ -+ port = pll_idx ? 0 : 1; -+ -+ mutex_lock(&jdev->vbios.vcmd_lock); -+ state1 = jdev_read(jdev, MWV207_PLL_FBDIV_REFDIV(pll_idx)); -+ state2 = jdev_read(jdev, MWV207_PLL_FRAC(pll_idx)); -+ state3 = jdev_read(jdev, MWV207_PLL_POSTDIV(pll_idx)); -+ mutex_unlock(&jdev->vbios.vcmd_lock); -+ -+ refdiv = state1 & 0x3f; -+ fbintdiv = (state1 & 0xfff0000) >> 16; -+ fbracdiv = state2 & 0xffffff; -+ postdiv1 = 4; -+ -+ postdiv_offset = 8 * (port % 4); -+ postdiv_mask = 0x7f << postdiv_offset; -+ postdiv2 = (state3 & postdiv_mask) >> postdiv_offset; -+ -+ if (!refdiv || !postdiv1 || !postdiv2) { -+ dev_dbg(jdev->dev, "get pll failed"); -+ return -EINVAL; -+ } -+ -+ freq = 100000 * 100000ull / refdiv; -+ freq = freq * fbintdiv + ((freq * fbracdiv) >> 24); -+ freq /= postdiv1; -+ freq /= postdiv2; -+ freq = DIV_ROUND_CLOSEST_ULL(freq, 100000); -+ -+ *kfreq = freq; -+ -+ dev_dbg(jdev->dev, "get pll result: freq %llu kHz\n", freq); -+ -+ return 0; -+} -+ -diff --git a/drivers/gpu/drm/mwv207/selftest/selftest.c b/drivers/gpu/drm/mwv207/selftest/selftest.c -new file mode 100644 -index 000000000..03cc940dd ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/selftest/selftest.c -@@ -0,0 +1,107 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207.h" -+#include "mwv207_bo.h" -+#include "mwv207_dma.h" -+ -+ -+static int mwv207_test_create_and_map_bo(struct mwv207_device *jdev, u64 size, -+ u32 domain, u32 flags, struct mwv207_bo **pjbo, void **plogical) -+{ -+ struct mwv207_bo *jbo; -+ void *logical; -+ int ret; -+ -+ ret = mwv207_bo_create(jdev, size, 0, ttm_bo_type_kernel, -+ domain, flags, &jbo); -+ if (ret) -+ return ret; -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) -+ goto free_bo; -+ ret = mwv207_bo_kmap_reserved(jbo, &logical); -+ if (ret) -+ goto unreserve_bo; -+ -+ *pjbo = jbo; -+ *plogical = logical; -+ return 0; -+ -+unreserve_bo: -+ mwv207_bo_unreserve(jbo); -+free_bo: -+ mwv207_bo_unref(jbo); -+ return ret; -+} -+ -+static void mwv207_test_destroy_and_unmap_bo(struct mwv207_bo *jbo) -+{ -+ if (!jbo) -+ return; -+ -+ mwv207_bo_kunmap_reserved(jbo); -+ mwv207_bo_unreserve(jbo); -+ mwv207_bo_unref(jbo); -+} -+ -+ -+static int mwv207_test_bo_acc(struct mwv207_device *jdev) -+{ -+ struct mwv207_bo *jbo; -+ int i, ret; -+ void *logical; -+ -+ ret = mwv207_test_create_and_map_bo(jdev, 0x1000, -+ 0x2, (1<<0), &jbo, &logical); -+ if (ret) -+ return ret; -+ -+ memset(logical, 0x5a, 0x1000); -+ for (i = 0; i < 0x1000; i++) { -+ if (*((char *)logical + i) != 0x5a) { -+ ret = -EIO; -+ break; -+ } -+ } -+ -+ mwv207_test_destroy_and_unmap_bo(jbo); -+ -+ return ret; -+} -+ -+static int mwv207_test_bo(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ ret = mwv207_test_bo_acc(jdev); -+ if (ret) { -+ pr_err("mwv207: bo access test failed with %d", ret); -+ return ret; -+ } -+ -+ return ret; -+} -+ -+int mwv207_test(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ ret = mwv207_test_bo(jdev); -+ if (ret == 0) -+ pr_info("mwv207 selftest passed"); -+ -+ return ret; -+} --- -2.25.1 - diff --git a/vendor_phytium/gpu_model/egl_loader/include/egl_phytium_wrapper_loader.h b/vendor_phytium/gpu_model/egl_loader/include/egl_phytium_wrapper_loader.h new file mode 100755 index 0000000000000000000000000000000000000000..5cf594c66643f9b34ec24152c43b19029a0cc42e --- /dev/null +++ b/vendor_phytium/gpu_model/egl_loader/include/egl_phytium_wrapper_loader.h @@ -0,0 +1,49 @@ +/* + * Copyright (c) 2025 Phytium Technology Co., Ltd. All rights reserved. + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#ifndef FRAMEWORKS_OPENGL_PHY_WRAPPER_EGL_WRAPPER_LOADER_H +#define FRAMEWORKS_OPENGL_PHY_WRAPPER_EGL_WRAPPER_LOADER_H +#include + +namespace OHOS { +struct EglWrapperDispatchTable; +struct EglHookTable; +struct GlHookTable; + +using FunctionPointerType = __eglMustCastToProperFunctionPointerType; + +class EglPhyWrapperLoader { +public: + static EglPhyWrapperLoader& GetInstance(); + ~EglPhyWrapperLoader(); + bool Load(EglWrapperDispatchTable *table); + bool Unload(EglWrapperDispatchTable *table); + void *GetProcAddrFromDriver(const char *name); + char *GetMultiGpuPath(); + char *SetMultiGpuPath(char *driver_name); +private: + EglPhyWrapperLoader() : dlEglHandle_(nullptr), dlGlHandle1_(nullptr), + dlGlHandle2_(nullptr), dlGlHandle3_(nullptr) {}; + bool LoadEgl(const char *libName, EglHookTable *table); + void *LoadGl(const char *libName, char const * const *glName, FunctionPointerType *entry); + bool LoadVendorDriver(EglWrapperDispatchTable *table); + void *dlEglHandle_; + void *dlGlHandle1_; + void *dlGlHandle2_; + void *dlGlHandle3_; + char * multi_path = nullptr; +}; +} // namespace OHOS +#endif // FRAMEWORKS_OPENGL_PHY_WRAPPER_EGL_WRAPPER_LOADER_H diff --git a/vendor_phytium/gpu_model/egl_loader/libPhy_EGL.so b/vendor_phytium/gpu_model/egl_loader/libPhy_EGL.so new file mode 100755 index 0000000000000000000000000000000000000000..75b444c6ae9c739ccce3f0b6a78164b393c38c4f Binary files /dev/null and b/vendor_phytium/gpu_model/egl_loader/libPhy_EGL.so differ diff --git a/vendor_phytium/gpu_model/jm/BUILD.gn b/vendor_phytium/gpu_model/jm/BUILD.gn index a101a09f378b68f9c2f4e759609963cd33ed9b3b..4a1c0d437f844c08c932fe6f188d0f7aaede3e82 100644 --- a/vendor_phytium/gpu_model/jm/BUILD.gn +++ b/vendor_phytium/gpu_model/jm/BUILD.gn @@ -15,6 +15,6 @@ import("//build/ohos.gni") group("gpu_group") { deps = [ - "//vendor/phytium/gpu_model/${gpu_model}/gpu:mesa-pvr-gpu-libs", + "//vendor/phytium/gpu_model/jm/gpu:mesa-jm-gpu-libs", ] } diff --git a/vendor_phytium/gpu_model/jm/gpu/BUILD.gn b/vendor_phytium/gpu_model/jm/gpu/BUILD.gn index 92e83e28f57be695714afcfc23aad0b179f948ba..340558c7983a8ba8813a3c9bac59567d33554b18 100644 --- a/vendor_phytium/gpu_model/jm/gpu/BUILD.gn +++ b/vendor_phytium/gpu_model/jm/gpu/BUILD.gn @@ -16,27 +16,20 @@ import("//build/ohos/ndk/ndk.gni") partname="device_${product_name}" mesa3d_libs_dir = "mesa3d_jm9100" + mesa3d_all_lib_items = [ - ["libEGL_", "libEGL.so.1.0.0", ["libEGL.so.1", "libEGL_impl.so"]], - ["libGLESv1", "libGLESv1_CM.so.1.1.0", ["libGLESv1_CM.so.1", "libGLESv1_impl.so"]], - ["libGLESv2", "libGLESv2.so.2.0.0", ["libGLESv2.so.2", "libGLESv2_impl.so","libGLESv3_impl.so"]], - ["libgbm", "libgbm.so.1.0.0", ["libgbm.so", "libgbm.so.1"]], - ["libglapi", "libglapi.so.0.0.0", ["libglapi.so", "libglapi.so.0"]], - ["libexpat", "libexpat.so.1.6.7", ["libexpat.so.1", "libexpat.so"]], - ["libomx_mesa", "libomx_mesa.so", ["libomx_mesa.so.0"]], - ["libomxil-bellagio", "libomxil-bellagio.so.0.9.3", ["libomxil-bellagio.so", "libomxil-bellagio.so.0"]] + ["libEGL_jm", "libEGL.so.1.0.0", ["libEGL.so.1", "libEGL_impl.so"]], + ["libGLESv1_jm", "libGLESv1_CM.so.1.1.0", ["libGLESv1_CM.so.1", "libGLESv1_impl.so"]], + ["libGLESv2_jm", "libGLESv2.so.2.0.0", ["libGLESv2.so.2", "libGLESv2_impl.so","libGLESv3_impl.so"]], + ["libgbm_jm", "libgbm.so.1.0.0", ["libgbm.so", "libgbm.so.1"]], + ["libgallium_dri", "libgallium_dri.so", ["libgallium_dri.so", "mwv207_dri.so"]], + ["libglapi_jm", "libglapi.so.0.0.0", ["libglapi.so", "libglapi.so.0"]], + ["libexpat_jm", "libexpat.so.1.6.7", ["libexpat.so.1", "libexpat.so"]], + ["libomx_mesa_jm", "libomx_mesa.so", ["libomx_mesa.so.0"]], + ["libomxil-bellagio_jm", "libomxil-bellagio.so.0.9.3", ["libomxil-bellagio.so", "libomxil-bellagio.so.0"]] ] mesa3d_all_lib_deps = [] -ohos_prebuilt_shared_library("lib_pvr_dri") { - source = "$mesa3d_libs_dir/mwv207_dri.so" - install_images = [ "system" ] - install_enable = true - subsystem_name = "phytium_products" - part_name = "${partname}" -} -mesa3d_all_lib_deps += [ ":lib_pvr_dri" ] - foreach(item, mesa3d_all_lib_items) { name = item[1] prebuild_name = item[0] @@ -45,14 +38,14 @@ foreach(item, mesa3d_all_lib_items) { symlink_target_name = item[2] install_enable = true install_images = [ chipset_base_dir ] - relative_install_dir = "chipsetsdk" + relative_install_dir = "chipsetsdk/jm" subsystem_name = "phytium_products" part_name = "${partname}" } mesa3d_all_lib_deps += [ ":$prebuild_name" ] } -group("mesa-pvr-gpu-libs"){ +group("mesa-jm-gpu-libs"){ deps = mesa3d_all_lib_deps } diff --git a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libEGL.so.1.0.0 b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libEGL.so.1.0.0 index b09a32304b0fcbbce4871e6db03d482b37ac89d0..5e73562b0a6b785a730fdf3433bc6c5670a26d93 100755 Binary files a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libEGL.so.1.0.0 and b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libEGL.so.1.0.0 differ diff --git a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libGLESv1_CM.so.1.1.0 b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libGLESv1_CM.so.1.1.0 old mode 100644 new mode 100755 index 0edbf831c5fae6f80975fd219c550d0f72e1e808..80cae49c764cb69e9dbc5e1633f6d8e9183963f3 Binary files a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libGLESv1_CM.so.1.1.0 and b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libGLESv1_CM.so.1.1.0 differ diff --git a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libGLESv2.so.2.0.0 b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libGLESv2.so.2.0.0 old mode 100644 new mode 100755 index f5691c8c77a6abed516c9998ae045e51ad215ed8..8aa7c867bdec36d96c2fafbcde235199faa1a586 Binary files a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libGLESv2.so.2.0.0 and b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libGLESv2.so.2.0.0 differ diff --git a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libexpat.so.1.6.7 b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libexpat.so.1.6.7 old mode 100644 new mode 100755 index 760626fe8f978829ca87f0d77dbccb53f07be095..119db545cd4c30d5a19d4e6220aa4f129edfb2a0 Binary files a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libexpat.so.1.6.7 and b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libexpat.so.1.6.7 differ diff --git a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/mwv207_dri.so b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libgallium_dri.so old mode 100644 new mode 100755 similarity index 34% rename from vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/mwv207_dri.so rename to vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libgallium_dri.so index 130b9a2d2a348faad90da16ec9ef0ecb2d9cc37a..6805d7d4b2a2fdcf809459062b1929773b08025f Binary files a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/mwv207_dri.so and b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libgallium_dri.so differ diff --git a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libgbm.so.1.0.0 b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libgbm.so.1.0.0 old mode 100644 new mode 100755 index a6344201e24ec561e181fc8d2d7afe1c3bc0ce64..c7bc39ab98fc8f330702162d57f729a19f384994 Binary files a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libgbm.so.1.0.0 and b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libgbm.so.1.0.0 differ diff --git a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libglapi.so.0.0.0 b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libglapi.so.0.0.0 old mode 100644 new mode 100755 index a0edb7640a5f7889916df405466db4a257f6e351..71db9f58ff96acb45a59ccaf0d824ff3afda1f23 Binary files a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libglapi.so.0.0.0 and b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libglapi.so.0.0.0 differ diff --git a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libomx_mesa.so b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libomx_mesa.so old mode 100644 new mode 100755 index 1d0e3e0710e79d8aed13a1a9ac9921ec6015fc15..98602eb96306d567b86f683ff7bfd7ef8a7ec6b0 Binary files a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libomx_mesa.so and b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libomx_mesa.so differ diff --git a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libomxil-bellagio.so.0.9.3 b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libomxil-bellagio.so.0.9.3 old mode 100644 new mode 100755 index cc97d163a8ef8f138507587e3abc7749ec7e6db2..089aeff01ea71801d7c436d37a2dcd08488db656 Binary files a/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libomxil-bellagio.so.0.9.3 and b/vendor_phytium/gpu_model/jm/gpu/mesa3d_jm9100/libomxil-bellagio.so.0.9.3 differ diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/Kconfig b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..f09174add415f3494b21ed674b4ff1cf1b338b04 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/Kconfig @@ -0,0 +1,13 @@ +config DRM_MWV207 + tristate "MWV207 chip" + depends on DRM + select DRM_KMS_HELPER + select SND_PCM + select DRM_VRAM_HELPER + select DRM_SCHED + select DRM_TTM + select DRM_TTM_HELPER + help + Choose this option if you have a Jingjia graphics card. + If M is selected, the module will be called mwv207 (JM9100). + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/Makefile b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..66d12ba6130c8ed4008134350f92e0142458c9e8 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/Makefile @@ -0,0 +1,44 @@ +ifneq ($(KERNELRELEASE),) + +obj-y := mwv207.o +mwv207-objs := mwv207_drv.o \ + mwv207_irq.o \ + mwv207_db.o \ + mwv207_ctx.o \ + mwv207_submit.o \ + mwv207_sched.o \ + mwv207_pipe_codec_common.o \ + mwv207_devfreq.o \ + mwv207_pipe_2d.o \ + mwv207_pipe_3d.o \ + mwv207_pipe_dec.o \ + mwv207_pipe_enc.o \ + mwv207_pipe_dma.o \ + mwv207_gem.o \ + mwv207_bo.o \ + mwv207_ttm.o \ + mwv207_vcmd.o \ + mwv207_vbios.o \ + dc/mwv207_kms.o \ + dc/mwv207_fb.o \ + dc/mwv207_va.o \ + dc/mwv207_edp.o \ + dc/mwv207_hdmi.o \ + dc/mwv207_vga.o \ + dc/mwv207_dvo.o \ + dc/mwv207_vi.o \ + dc/mwv207_i2c.o \ + selftest/selftest.o \ + +ccflags-y := -I$(src) +else + +KERNELDIR ?= /lib/modules/$(shell uname -r)/build +PWD := $(shell pwd) + +default: + $(MAKE) -C $(KERNELDIR) M=$(PWD) modules +clean: + $(MAKE) -C $(KERNELDIR) M=$(PWD) clean + +endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_dvo.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_dvo.c new file mode 100644 index 0000000000000000000000000000000000000000..f0c0eda04a31b7666038868a4315a29b95122df3 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_dvo.c @@ -0,0 +1,180 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_vi.h" + +static void mwv207_dvo_switch(struct mwv207_output *output, bool on) +{ + mwv207_output_modify(output, 0x200, + 0x1 << 0, (on ? 1 : 0) << 0); +} + +static void mwv207_dvo_config(struct mwv207_output *output) +{ + struct drm_display_mode *mode = &output->cur_crtc->state->adjusted_mode; + int hpol, vpol; + + hpol = (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : 1; + vpol = (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : 1; + + mwv207_output_modify(output, 0x200, 0x1 << 9, hpol << 9); + mwv207_output_modify(output, 0x200, 0x1 << 8, vpol << 8); + +} + +static void mwv207_dvo_select_crtc(struct mwv207_output *output) +{ + + mwv207_output_modify(output, 0x200, 0x7 << 16, + drm_crtc_index(output->cur_crtc) << 16); + + jdev_modify(output->jdev, 0x9b003c, 0xf, + drm_crtc_index(output->cur_crtc)); +} +static enum drm_mode_status mwv207_dvo_mode_valid(struct mwv207_output *output, + const struct drm_display_mode *mode) +{ + + if (mode->clock > 162000) + return MODE_CLOCK_HIGH; + + return MODE_OK; +} + +static enum drm_mode_status mwv207_dvo_connector_mode_valid(struct drm_connector *connector, + struct drm_display_mode *mode) +{ + return mwv207_dvo_mode_valid(connector_to_output(connector), mode); +} + +static int mwv207_dvo_detect_ctx(struct drm_connector *connector, + struct drm_modeset_acquire_ctx *ctx, + bool force) +{ + struct mwv207_output *output = connector_to_output(connector); + + if (mwv207_i2c_probe(output->ddc)) + return connector_status_connected; + else + return connector_status_disconnected; +} + +static void mwv207_dvo_destroy(struct drm_connector *conn) +{ + drm_connector_unregister(conn); + drm_connector_cleanup(conn); +} + +static const struct drm_connector_helper_funcs mwv207_dvo_connector_helper_funcs = { + .get_modes = mwv207_output_get_modes, + .mode_valid = mwv207_dvo_connector_mode_valid, + .detect_ctx = mwv207_dvo_detect_ctx +}; + +static const struct drm_connector_funcs mwv207_dvo_connector_funcs = { + .reset = drm_atomic_helper_connector_reset, + .fill_modes = drm_helper_probe_single_connector_modes, + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, + .destroy = mwv207_dvo_destroy, + .late_register = mwv207_output_late_register, + .early_unregister = mwv207_output_early_unregister, +}; + +static enum drm_mode_status mwv207_dvo_encoder_mode_valid(struct drm_encoder *encoder, + const struct drm_display_mode *mode) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + return mwv207_dvo_mode_valid(output, mode); +} + +static int mwv207_dvo_encoder_atomic_check(struct drm_encoder *encoder, + struct drm_crtc_state *crtc_state, + struct drm_connector_state *conn_state) +{ + return 0; +} + +static void mwv207_dvo_encoder_enable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_dvo_select_crtc(output); + + mwv207_dvo_config(output); + + mwv207_dvo_switch(output, true); +} + +static void mwv207_dvo_encoder_disable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_dvo_switch(output, false); +} + +static void mwv207_dvo_encoder_reset(struct drm_encoder *encoder) +{ + mwv207_dvo_encoder_disable(encoder); +} + +static const struct drm_encoder_funcs mwv207_dvo_encoder_funcs = { + .destroy = drm_encoder_cleanup, + .reset = mwv207_dvo_encoder_reset, +}; + +static const struct drm_encoder_helper_funcs mwv207_dvo_encoder_helper_funcs = { + .mode_valid = mwv207_dvo_encoder_mode_valid, + .atomic_check = mwv207_dvo_encoder_atomic_check, + .enable = mwv207_dvo_encoder_enable, + .disable = mwv207_dvo_encoder_disable, +}; + +int mwv207_dvo_init(struct mwv207_device *jdev) +{ + struct mwv207_output *output; + int ret; + + output = devm_kzalloc(jdev->dev, sizeof(*output), GFP_KERNEL); + if (!output) + return -ENOMEM; + + output->jdev = jdev; + output->idx = 0; + output->mmio = jdev->mmio + 0x9a0000; + output->i2c_chan = 5; + + output->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; + ret = drm_connector_init(&jdev->base, &output->connector, + &mwv207_dvo_connector_funcs, DRM_MODE_CONNECTOR_DVII); + if (ret) + return ret; + drm_connector_helper_add(&output->connector, &mwv207_dvo_connector_helper_funcs); + + output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; + ret = drm_encoder_init(&jdev->base, &output->encoder, + &mwv207_dvo_encoder_funcs, DRM_MODE_ENCODER_DAC, + "dvo-%d", output->idx); + if (ret) + return ret; + drm_encoder_helper_add(&output->encoder, &mwv207_dvo_encoder_helper_funcs); + + ret = drm_connector_attach_encoder(&output->connector, &output->encoder); + if (ret) + return ret; + + return drm_connector_register(&output->connector); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_edp.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_edp.c new file mode 100644 index 0000000000000000000000000000000000000000..790b186a1521f4cfe8d67c31ab5bc6fb3f86b82a --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_edp.c @@ -0,0 +1,22 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_vi.h" + +int mwv207_edp_init(struct mwv207_device *jdev) +{ + pr_info("%s TBD", __func__); + return 0; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_fb.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_fb.c new file mode 100644 index 0000000000000000000000000000000000000000..220c5401c738e2b4a2a592e4a3be1bd48cecf2c1 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_fb.c @@ -0,0 +1,181 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include "mwv207.h" +#include "mwv207_bo.h" +#include "mwv207_drm.h" +#include "mwv207_gem.h" +#include "mwv207_kms.h" + +static struct fb_ops mwv207_fb_ops = { + .owner = THIS_MODULE, + DRM_FB_HELPER_DEFAULT_OPS, + .fb_fillrect = drm_fb_helper_cfb_fillrect, + .fb_copyarea = drm_fb_helper_cfb_copyarea, + .fb_imageblit = drm_fb_helper_cfb_imageblit, +}; + +static int mwv207_drm_fb_helper_init(struct drm_device *dev, + struct drm_fb_helper *fb_helper, + unsigned int crtc_count, + unsigned int max_conn_count) +{ + return drm_fb_helper_init(dev, fb_helper); +} + +static int mwv207_fb_create(struct drm_fb_helper *fb_helper, + struct drm_fb_helper_surface_size *sizes) +{ + struct drm_mode_fb_cmd2 mode_cmd; + struct drm_framebuffer *fb; + struct mwv207_device *jdev; + struct mwv207_bo *jbo; + struct fb_info *info; + u32 bytes; + void *logical; + int ret; + + jdev = fb_helper->dev->dev_private; + memset(&mode_cmd, 0, sizeof(mode_cmd)); + mode_cmd.width = sizes->surface_width; + mode_cmd.height = sizes->surface_height; + if (sizes->surface_bpp == 24) + sizes->surface_bpp = 32; + + mode_cmd.pitches[0] = mode_cmd.width * ((sizes->surface_bpp + 7)/8); + mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, + sizes->surface_depth); + + info = drm_fb_helper_alloc_fbi(fb_helper); + if (IS_ERR(info)) + return PTR_ERR(info); + + bytes = mode_cmd.pitches[0] * mode_cmd.height; + bytes = ALIGN(bytes, PAGE_SIZE); + ret = mwv207_bo_create(jdev, bytes, 0x10000, ttm_bo_type_kernel, + 0x2, (1<<0), &jbo); + if (ret) + return ret; + + fb = kzalloc(sizeof(*fb), GFP_KERNEL); + if (fb == NULL) { + ret = -ENOMEM; + goto free_bo; + } + + ret = mwv207_framebuffer_init(jdev, fb, &mode_cmd, mwv207_gem_from_bo(jbo)); + if (ret) + goto free_fb; + + ret = mwv207_bo_reserve(jbo, true); + if (ret) + goto free_fb; + ret = mwv207_bo_pin_reserved(jbo, 0x2); + if (ret) + goto unreserve_bo; + + ret = mwv207_bo_kmap_reserved(jbo, &logical); + if (ret) + goto unpin_bo; + + memset(logical, 0x0, bytes); + + fb_helper->fb = fb; + info->skip_vt_switch = true; + info->fbops = &mwv207_fb_ops; + info->screen_size = fb->height * fb->pitches[0]; + info->fix.smem_len = info->screen_size; + info->screen_base = logical; + + drm_fb_helper_fill_info(info, fb_helper, sizes); + + mwv207_bo_unreserve(jbo); + return 0; + +unpin_bo: + mwv207_bo_unpin(jbo); +unreserve_bo: + mwv207_bo_unreserve(jbo); +free_fb: + kfree(fb); +free_bo: + mwv207_bo_unref(jbo); + return ret; +} + +static const struct drm_fb_helper_funcs mwv207_fb_helper_funcs = { + .fb_probe = mwv207_fb_create, +}; + +int mwv207_fbdev_init(struct mwv207_device *jdev) +{ + struct drm_fb_helper *fb_helper; + int preferred_bpp = 32; + int ret; + + fb_helper = devm_kzalloc(jdev->dev, sizeof(*fb_helper), GFP_KERNEL); + if (!fb_helper) + return -ENOMEM; + + drm_fb_helper_prepare(&jdev->base, fb_helper, &mwv207_fb_helper_funcs); + ret = mwv207_drm_fb_helper_init(&jdev->base, fb_helper, + jdev->base.num_crtcs, jdev->base.num_crtcs); + if (ret) { + DRM_ERROR("Failed to initialize fbdev helper\n"); + return ret; + } + + ret = drm_fb_helper_initial_config(fb_helper, preferred_bpp); + if (ret) { + DRM_ERROR("Failed to set fbdev configuration\n"); + goto err; + } + + jdev->fb_helper = fb_helper; + return 0; +err: + drm_fb_helper_fini(fb_helper); + return ret; +} + +void mwv207_fbdev_fini(struct mwv207_device *jdev) +{ + struct drm_framebuffer *fb; + struct mwv207_bo *jbo; + int ret; + + drm_fb_helper_unregister_fbi(jdev->fb_helper); + + fb = jdev->fb_helper ? jdev->fb_helper->fb : NULL; + if (fb == NULL) + return; + + jbo = mwv207_bo_from_gem(fb->obj[0]); + ret = mwv207_bo_reserve(jbo, true); + if (ret == 0) { + mwv207_bo_kunmap_reserved(jbo); + mwv207_bo_unpin_reserved(jbo); + mwv207_bo_unreserve(jbo); + drm_gem_object_put(fb->obj[0]); + drm_framebuffer_cleanup(fb); + } + + drm_fb_helper_fini(jdev->fb_helper); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_hdmi.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_hdmi.c new file mode 100644 index 0000000000000000000000000000000000000000..7eff1169cb72ac020fb8d5ff75c9863e9a383e30 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_hdmi.c @@ -0,0 +1,1083 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include "mwv207_vi.h" +#include "mwv207_vbios.h" + +/* hdmi specific, accessed by mwv207_hdmi_read/write */ + +/* vi global, accessed by mwv207_output_read/write */ + +#define connector_to_hdmi(conn) container_of(conn, struct mwv207_hdmi, base.connector) +#define encoder_to_hdmi(encoder) container_of(encoder, struct mwv207_hdmi, base.encoder) + +struct mwv207_hdmi_phy_data { + u32 min_freq_khz; + u32 max_freq_khz; + u32 bpp; + u8 config[47]; + u8 padding; +} __packed; + +static const struct mwv207_hdmi_phy_data +default_phy_data[19] = { + { 24000, 47999, 8, + { 0xD2, 0x78, 0xB0, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x8B, 0xF0, + 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 28000, 95999, 8, + { 0xD2, 0x3C, 0x50, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x85, 0xF0, + 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 96000, 143999, 8, + { 0xD4, 0x50, 0x30, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x83, 0xF0, + 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 144000, 296999, 8, + { 0xD8, 0x50, 0x10, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x81, 0xF0, + 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 297000, 340000, 8, + { 0xDC, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x80, 0xF0, + 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 340001, 595000, 8, + { 0xDC, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x80, 0xC0, + 0xF4, 0x69, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, + 0xFF, 0x00, 0x00}}, + { 24000, 27999, 10, + { 0xD2, 0x7D, 0x90, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x99, 0xC0, + 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 28000, 55999, 10, + { 0xD4, 0xC8, 0x70, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x97, 0xC0, + 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 56000, 111999, 10, + { 0xD4, 0x64, 0x30, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x93, 0xC0, + 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 112000, 223999, 10, + { 0xD8, 0x64, 0x10, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x91, 0xC0, + 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 224000, 272000, 10, + { 0xDC, 0x4B, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x90, 0xC0, + 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 272001, 340000, 10, + { 0xDC, 0x4B, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x90, 0xC0, + 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 340001, 475200, 10, + { 0xDC, 0x4B, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x90, 0xC0, + 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, + 0xFF, 0x00, 0x00}}, + { 24000, 47999, 12, + { 0xD1, 0x3C, 0x70, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA7, 0xC0, + 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 48000, 95999, 12, + { 0xD2, 0x3C, 0x30, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA3, 0xC0, + 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 96000, 197999, 12, + { 0xD4, 0x3C, 0x10, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA1, 0xC0, + 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 198000, 226999, 12, + { 0xD8, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA0, 0xC0, + 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 227000, 340000, 12, + { 0xD8, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA0, 0xC0, + 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, + 0xF8, 0x00, 0x00}}, + { 340001, 396000, 12, + { 0xD8, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, + 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA0, 0xC0, + 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, + 0xFF, 0x00, 0x00}}, +}; + +struct mwv207_hdmi { + struct mwv207_output base; + + void __iomem *mmio; + bool sink_is_hdmi; + bool sink_has_audio; + int vic; + + int irq; + + u8 mc_clkdis; + bool rgb_limited_range; + struct mwv207_hdmi_phy_data phy_data[19]; +}; + +static const u16 csc_coeff_default[3][4] = { + { 0x2000, 0x0000, 0x0000, 0x0000 }, + { 0x0000, 0x2000, 0x0000, 0x0000 }, + { 0x0000, 0x0000, 0x2000, 0x0000 } +}; + +static const u16 csc_coeff_rgb_full_to_rgb_limited[3][4] = { + { 0x1b7c, 0x0000, 0x0000, 0x0020 }, + { 0x0000, 0x1b7c, 0x0000, 0x0020 }, + { 0x0000, 0x0000, 0x1b7c, 0x0020 } +}; + +static inline u8 mwv207_hdmi_readb(struct mwv207_hdmi *hdmi, u32 reg) +{ + return readl(hdmi->mmio + reg * 4); +} + +static inline void mwv207_hdmi_writeb(struct mwv207_hdmi *hdmi, u8 value, u32 reg) +{ + writel_relaxed(value, hdmi->mmio + reg * 4); +} + +static inline void mwv207_hdmi_modb(struct mwv207_hdmi *hdmi, u8 value, u8 mask, u32 reg) +{ + u8 rvalue = mwv207_hdmi_readb(hdmi, reg); + + rvalue = (rvalue & ~mask) | (value & mask); + mwv207_hdmi_writeb(hdmi, rvalue, reg); +} + +static void mwv207_hdmi_mask_writeb(struct mwv207_hdmi *hdmi, u8 data, unsigned int reg, + u8 shift, u8 mask) +{ + mwv207_hdmi_modb(hdmi, data << shift, mask, reg); +} + +static int mwv207_hdmi_phy_data_from_cfg(struct mwv207_hdmi *hdmi) +{ + const struct mwv207_vdat *vdat; + int i; + + vdat = mwv207_vbios_vdat(hdmi->base.jdev, 0xfff0 + hdmi->base.idx); + if (!vdat) + return -ENOENT; + if (vdat->len != sizeof(hdmi->phy_data)) + return -EINVAL; + memcpy(hdmi->phy_data, vdat->dat, vdat->len); + for (i = 0; i < 19; ++i) { + hdmi->phy_data[i].min_freq_khz = le32_to_cpu(hdmi->phy_data[i].min_freq_khz); + hdmi->phy_data[i].max_freq_khz = le32_to_cpu(hdmi->phy_data[i].max_freq_khz); + hdmi->phy_data[i].bpp = le32_to_cpu(hdmi->phy_data[i].bpp); + } + return 0; +} + +static void mwv207_hdmi_phy_data_init(struct mwv207_hdmi *hdmi) +{ + if (!mwv207_hdmi_phy_data_from_cfg(hdmi)) + return; + + DRM_INFO("mwv207: hdmi%d use default phy data", hdmi->base.idx); + + BUILD_BUG_ON(sizeof(hdmi->phy_data) != sizeof(default_phy_data)); + + memcpy(hdmi->phy_data, default_phy_data, sizeof(hdmi->phy_data)); +} + +static void mwv207_hdmi_phy_configure_data(struct mwv207_hdmi *hdmi, int kfreq, int bpp) +{ + struct mwv207_output *output = &hdmi->base; + u32 regbase = (0x6000 + 0x800 * (output->idx)); + int i, cfg, offset; + + for (i = 0; i < 19; ++i) { + if (kfreq >= hdmi->phy_data[i].min_freq_khz + && kfreq <= hdmi->phy_data[i].max_freq_khz + && bpp == hdmi->phy_data[i].bpp) + break; + } + if (i >= 19) { + pr_warn("mwv207: no matching hdmi phydata found"); + return; + } + + cfg = i; + mwv207_output_write(output, regbase + 0x70, 0xc8); + mwv207_output_write(output, regbase + 0x74, 0x2); + for (i = 0; i < 47; i++) { + offset = 0x4 + i * 4; + if (offset == 0x84 || offset == 0x88 || offset == 0xB8) + continue; + + mwv207_output_write(output, regbase + offset, + hdmi->phy_data[cfg].config[i]); + } +} + +static void mwv207_hdmi_phy_switch(struct mwv207_hdmi *hdmi, int enable) +{ + struct mwv207_output *output = &hdmi->base; + u32 regbase = (0x6000 + 0x800 * (output->idx)); + + if (enable) { + mwv207_output_write(output, regbase + 0x84, 0x80); + mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 1 << 28, 0 << 28); + } else { + mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 1 << 28, 1 << 28); + mwv207_output_write(output, regbase + 0x84, 0x00); + } +} + +static void mwv207_hdmi_phy_power_on(struct mwv207_hdmi *hdmi) +{ + u8 val; + int i; + + mwv207_hdmi_phy_switch(hdmi, 1); + + for (i = 0; i < 5; ++i) { + val = mwv207_hdmi_readb(hdmi, 0x3004) & 0x01; + if (val) + break; + usleep_range(1000, 2000); + } + + if (!val) + pr_warn("mwv207: hdmi PHY PLL failed to lock\n"); +} + +static void mwv207_hdmi_phy_power_off(struct mwv207_hdmi *hdmi) +{ + u8 val; + int i; + + mwv207_hdmi_phy_switch(hdmi, 0); + + for (i = 0; i < 5; ++i) { + val = mwv207_hdmi_readb(hdmi, 0x3004); + if (!(val & 0x01)) + break; + + usleep_range(1000, 2000); + } + + if (val & 0x01) + pr_warn("mwv207: PHY failed to power down\n"); +} + +static void mwv207_hdmi_phy_configure(struct mwv207_hdmi *hdmi, int kfreq, int bpp) +{ + mwv207_hdmi_phy_power_off(hdmi); + + mwv207_hdmi_phy_configure_data(hdmi, kfreq, bpp); + + mwv207_hdmi_phy_power_on(hdmi); +} + +static void mwv207_hdmi_clear_overflow(struct mwv207_hdmi *hdmi) +{ + u8 val; + + mwv207_hdmi_writeb(hdmi, (u8) ~0x02, 0x4002); + + val = mwv207_hdmi_readb(hdmi, 0x1000); + mwv207_hdmi_writeb(hdmi, val, 0x1000); +} + +static void mwv207_hdmi_ih_mutes(struct mwv207_hdmi *hdmi) +{ + u8 ih_mute; + + ih_mute = mwv207_hdmi_readb(hdmi, 0x01FF) | 0x2 | 0x1; + + mwv207_hdmi_writeb(hdmi, ih_mute, 0x01FF); + + mwv207_hdmi_writeb(hdmi, 0xff, 0x0807); + mwv207_hdmi_writeb(hdmi, 0xff, 0x10D2); + mwv207_hdmi_writeb(hdmi, 0xff, 0x10D6); + mwv207_hdmi_writeb(hdmi, 0xff, 0x10DA); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3006); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3027); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3028); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3102); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3302); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3404); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3505); + mwv207_hdmi_writeb(hdmi, 0xff, 0x5008); + mwv207_hdmi_writeb(hdmi, 0xff, 0x7E05); + mwv207_hdmi_writeb(hdmi, 0xff, 0x7E06); + + mwv207_hdmi_writeb(hdmi, 0xff, 0x0180); + mwv207_hdmi_writeb(hdmi, 0xff, 0x0181); + mwv207_hdmi_writeb(hdmi, 0xff, 0x0182); + mwv207_hdmi_writeb(hdmi, 0xff, 0x0183); + mwv207_hdmi_writeb(hdmi, 0xff, 0x0184); + mwv207_hdmi_writeb(hdmi, 0xff, 0x0185); + mwv207_hdmi_writeb(hdmi, 0xff, 0x0186); + mwv207_hdmi_writeb(hdmi, 0xff, 0x0187); + mwv207_hdmi_writeb(hdmi, 0xff, 0x0188); + mwv207_hdmi_writeb(hdmi, 0xff, 0x0189); + + ih_mute &= ~(0x2 | 0x1); + mwv207_hdmi_writeb(hdmi, ih_mute, 0x01FF); +} + +static void mwv207_hdmi_phy_setup_hpd(struct mwv207_hdmi *hdmi) +{ + mwv207_hdmi_writeb(hdmi, 0x02, 0x3007); + mwv207_hdmi_writeb(hdmi, 0x1, 0x0104); + + mwv207_hdmi_writeb(hdmi, ~0x02, 0x3006); + + mwv207_hdmi_writeb(hdmi, 0x1, 0x0104); + mwv207_hdmi_writeb(hdmi, ~0x1, 0x0184); +} + +static irqreturn_t mwv207_hdmi_hard_irq(int irq, void *dev_id) +{ + struct mwv207_hdmi *hdmi = dev_id; + irqreturn_t ret = IRQ_NONE; + u8 intr_stat; + + intr_stat = mwv207_hdmi_readb(hdmi, 0x0104); + if (intr_stat) { + mwv207_hdmi_writeb(hdmi, ~0, 0x0184); + return IRQ_WAKE_THREAD; + } + + return ret; +} + +static irqreturn_t mwv207_hdmi_irq(int irq, void *dev_id) +{ + u8 intr_stat, phy_int_pol, phy_pol_mask, phy_stat; + struct mwv207_hdmi *hdmi = dev_id; + + intr_stat = mwv207_hdmi_readb(hdmi, 0x0104); + phy_int_pol = mwv207_hdmi_readb(hdmi, 0x3007); + phy_stat = mwv207_hdmi_readb(hdmi, 0x3004); + + phy_pol_mask = 0; + if (intr_stat & 0x1) + phy_pol_mask |= 0x02; + if (intr_stat & 0x4) + phy_pol_mask |= 0x10; + if (intr_stat & 0x8) + phy_pol_mask |= 0x20; + if (intr_stat & 0x10) + phy_pol_mask |= 0x40; + if (intr_stat & 0x20) + phy_pol_mask |= 0x80; + + if (phy_pol_mask) + mwv207_hdmi_modb(hdmi, ~phy_int_pol, phy_pol_mask, 0x3007); + + if (intr_stat & 0x1) + drm_helper_hpd_irq_event(&hdmi->base.jdev->base); + + mwv207_hdmi_writeb(hdmi, intr_stat, 0x0104); + mwv207_hdmi_writeb(hdmi, ~0x1, 0x0184); + + return IRQ_HANDLED; +} + +static void mwv207_hdmi_switch(struct mwv207_output *output, bool on) +{ + mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 1, on ? 1 : 0); +} + +static void mwv207_hdmi_select_crtc(struct mwv207_output *output) +{ + + mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), + 0x3 << 4, drm_crtc_index(output->cur_crtc) << 4); + + jdev_modify(output->jdev, 0x9b003c, 0b111 << (8 + output->idx * 4), + drm_crtc_index(output->cur_crtc) << (8 + output->idx * 4)); +} + +static void mwv207_hdmi_disable_overflow_interrupts(struct mwv207_hdmi *hdmi) +{ + mwv207_hdmi_writeb(hdmi, 0x03, 0x0182); +} + +static bool mwv207_hdmi_support_scdc(struct mwv207_hdmi *hdmi, + const struct drm_display_info *display) +{ + + if (!display->hdmi.scdc.supported || + !display->hdmi.scdc.scrambling.supported) + return false; + + if (!display->hdmi.scdc.scrambling.low_rates && + display->max_tmds_clock <= 340000) + return false; + + return true; +} + +static void mwv207_hdmi_av_composer(struct mwv207_hdmi *hdmi, const struct drm_display_mode *mode) +{ + const struct drm_display_info *display = &hdmi->base.connector.display_info; + const struct drm_hdmi_info *hdmi_info = &display->hdmi; + int hblank, vblank, h_de_hs, v_de_vs, hsync_len, vsync_len; + struct mwv207_output *output = &hdmi->base; + unsigned int vdisplay, hdisplay; + u32 tmdsclock, rate; + u8 inv_val, bytes; + + tmdsclock = mode->clock * 1000; + + inv_val = (mwv207_hdmi_support_scdc(hdmi, display) && + (tmdsclock > 340000000 || + hdmi_info->scdc.scrambling.low_rates) ? 0x80 : 0x00); + + inv_val |= mode->flags & DRM_MODE_FLAG_PVSYNC ? 0x40 : 0x00; + + inv_val |= mode->flags & DRM_MODE_FLAG_PHSYNC ? 0x20 : 0x00; + + inv_val |= 0x10; + + if (hdmi->vic == 39) + inv_val |= 0x2; + else + inv_val |= mode->flags & DRM_MODE_FLAG_INTERLACE ? 0x2 : 0x0; + + inv_val |= mode->flags & DRM_MODE_FLAG_INTERLACE ? 0x1 : 0x0; + + inv_val |= hdmi->sink_is_hdmi ? 0x8 : 0x0; + + mwv207_hdmi_writeb(hdmi, inv_val, 0x1000); + + rate = drm_mode_vrefresh(mode) * 1000; + mwv207_hdmi_writeb(hdmi, rate >> 16, 0x1010); + mwv207_hdmi_writeb(hdmi, rate >> 8, 0x100F); + mwv207_hdmi_writeb(hdmi, rate, 0x100E); + + + mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 0x1 << 9, + (mode->flags & DRM_MODE_FLAG_PHSYNC ? 1 : 0) << 9); + mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 0x1 << 8, + (mode->flags & DRM_MODE_FLAG_PVSYNC ? 1 : 0) << 8); + mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 0x1 << 10, 1 << 10); + + hdisplay = mode->hdisplay; + hblank = mode->htotal - mode->hdisplay; + h_de_hs = mode->hsync_start - mode->hdisplay; + hsync_len = mode->hsync_end - mode->hsync_start; + + vdisplay = mode->vdisplay; + vblank = mode->vtotal - mode->vdisplay; + v_de_vs = mode->vsync_start - mode->vdisplay; + vsync_len = mode->vsync_end - mode->vsync_start; + + if (mode->flags & DRM_MODE_FLAG_INTERLACE) { + vdisplay /= 2; + vblank /= 2; + v_de_vs /= 2; + vsync_len /= 2; + } + + if (mwv207_hdmi_support_scdc(hdmi, display)) { + if (tmdsclock > 340000000 || + hdmi_info->scdc.scrambling.low_rates) { + drm_scdc_readb(hdmi->base.ddc, SCDC_SINK_VERSION, + &bytes); + drm_scdc_writeb(hdmi->base.ddc, SCDC_SOURCE_VERSION, + min_t(u8, bytes, 0x1)); + + drm_scdc_set_scrambling(hdmi->base.ddc, 1); + + mwv207_hdmi_writeb(hdmi, (u8)~0x02, 0x4002); + mwv207_hdmi_writeb(hdmi, 1, 0x10E1); + } else { + mwv207_hdmi_writeb(hdmi, 0, 0x10E1); + mwv207_hdmi_writeb(hdmi, (u8)~0x02, 0x4002); + drm_scdc_set_scrambling(hdmi->base.ddc, 0); + } + } + + mwv207_hdmi_writeb(hdmi, hdisplay >> 8, 0x1002); + mwv207_hdmi_writeb(hdmi, hdisplay, 0x1001); + + mwv207_hdmi_writeb(hdmi, vdisplay >> 8, 0x1006); + mwv207_hdmi_writeb(hdmi, vdisplay, 0x1005); + + mwv207_hdmi_writeb(hdmi, hblank >> 8, 0x1004); + mwv207_hdmi_writeb(hdmi, hblank, 0x1003); + + mwv207_hdmi_writeb(hdmi, vblank >> 8, 0x102E); + mwv207_hdmi_writeb(hdmi, vblank, 0x1007); + + mwv207_hdmi_writeb(hdmi, h_de_hs >> 8, 0x1009); + mwv207_hdmi_writeb(hdmi, h_de_hs, 0x1008); + + mwv207_hdmi_writeb(hdmi, v_de_vs >> 8, 0x102F); + mwv207_hdmi_writeb(hdmi, v_de_vs, 0x100C); + + mwv207_hdmi_writeb(hdmi, hsync_len >> 8, 0x100B); + mwv207_hdmi_writeb(hdmi, hsync_len, 0x100A); + + mwv207_hdmi_writeb(hdmi, vsync_len, 0x100D); +} + +static void mwv207_hdmi_enable_video_path(struct mwv207_hdmi *hdmi) +{ + mwv207_hdmi_writeb(hdmi, 12, 0x1011); + mwv207_hdmi_writeb(hdmi, 32, 0x1012); + mwv207_hdmi_writeb(hdmi, 1, 0x1013); + + mwv207_hdmi_writeb(hdmi, 0x0B, 0x1014); + mwv207_hdmi_writeb(hdmi, 0x16, 0x1015); + mwv207_hdmi_writeb(hdmi, 0x21, 0x1016); + + hdmi->mc_clkdis |= 0x40 | 0x8 | 0x10 | 0x4 | 0x2; + hdmi->mc_clkdis &= ~0x1; + mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); + + hdmi->mc_clkdis &= ~0x2; + mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); + + if (hdmi->rgb_limited_range) { + hdmi->mc_clkdis &= ~0x10; + mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); + + mwv207_hdmi_writeb(hdmi, 0x1, 0x4004); + } else { + hdmi->mc_clkdis |= 0x10; + mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); + + mwv207_hdmi_writeb(hdmi, 0x0, 0x4004); + } +} + +static void mwv207_hdmi_enable_audio_clk(struct mwv207_hdmi *hdmi, bool enable) +{ + if (enable) + hdmi->mc_clkdis &= ~0x8; + else + hdmi->mc_clkdis |= 0x8; + mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); +} + +static void mwv207_hdmi_config_AVI(struct mwv207_hdmi *hdmi, + struct drm_connector *connector, + const struct drm_display_mode *mode) +{ + struct hdmi_avi_infoframe frame; + u8 val; + + + drm_hdmi_avi_infoframe_from_display_mode(&frame, connector, mode); + + drm_hdmi_avi_infoframe_quant_range(&frame, connector, mode, + hdmi->rgb_limited_range ? + HDMI_QUANTIZATION_RANGE_LIMITED : + HDMI_QUANTIZATION_RANGE_FULL); + + frame.colorspace = HDMI_COLORSPACE_RGB; + frame.colorimetry = HDMI_COLORIMETRY_NONE; + frame.extended_colorimetry = + HDMI_EXTENDED_COLORIMETRY_XV_YCC_601; + + val = (frame.scan_mode & 3) << 4 | (frame.colorspace & 3); + if (frame.active_aspect & 15) + val |= 0x40; + if (frame.top_bar || frame.bottom_bar) + val |= 0x08; + if (frame.left_bar || frame.right_bar) + val |= 0x04; + mwv207_hdmi_writeb(hdmi, val, 0x1019); + + + val = ((frame.colorimetry & 0x3) << 6) | + ((frame.picture_aspect & 0x3) << 4) | + (frame.active_aspect & 0xf); + mwv207_hdmi_writeb(hdmi, val, 0x101A); + + + val = ((frame.extended_colorimetry & 0x7) << 4) | + ((frame.quantization_range & 0x3) << 2) | + (frame.nups & 0x3); + if (frame.itc) + val |= 0x80; + mwv207_hdmi_writeb(hdmi, val, 0x101B); + + + val = frame.video_code & 0x7f; + mwv207_hdmi_writeb(hdmi, val, 0x101C); + + + val = ((1 << 4) & 0xF0); + mwv207_hdmi_writeb(hdmi, val, 0x10E0); + + val = ((frame.ycc_quantization_range & 0x3) << 2) | + (frame.content_type & 0x3); + mwv207_hdmi_writeb(hdmi, val, 0x1017); + + mwv207_hdmi_writeb(hdmi, frame.top_bar & 0xff, 0x101D); + mwv207_hdmi_writeb(hdmi, (frame.top_bar >> 8) & 0xff, 0x101E); + mwv207_hdmi_writeb(hdmi, frame.bottom_bar & 0xff, 0x101F); + mwv207_hdmi_writeb(hdmi, (frame.bottom_bar >> 8) & 0xff, 0x1020); + mwv207_hdmi_writeb(hdmi, frame.left_bar & 0xff, 0x1021); + mwv207_hdmi_writeb(hdmi, (frame.left_bar >> 8) & 0xff, 0x1022); + mwv207_hdmi_writeb(hdmi, frame.right_bar & 0xff, 0x1023); + mwv207_hdmi_writeb(hdmi, (frame.right_bar >> 8) & 0xff, 0x1024); +} + +static void mwv207_hdmi_config_vendor_specific_infoframe(struct mwv207_hdmi *hdmi, + struct drm_connector *connector, + const struct drm_display_mode *mode) +{ + struct hdmi_vendor_infoframe frame; + u8 buffer[10]; + ssize_t err; + + err = drm_hdmi_vendor_infoframe_from_display_mode(&frame, connector, + mode); + if (err < 0) + return; + + err = hdmi_vendor_infoframe_pack(&frame, buffer, sizeof(buffer)); + if (err < 0) { + DRM_ERROR("Failed to pack vendor infoframe: %zd\n", err); + return; + } + mwv207_hdmi_mask_writeb(hdmi, 0, 0x10B3, 3, 0x08); + + mwv207_hdmi_writeb(hdmi, buffer[2], 0x102A); + + mwv207_hdmi_writeb(hdmi, buffer[4], 0x1029); + mwv207_hdmi_writeb(hdmi, buffer[5], 0x1030); + mwv207_hdmi_writeb(hdmi, buffer[6], 0x1031); + + mwv207_hdmi_writeb(hdmi, buffer[7], 0x1032); + mwv207_hdmi_writeb(hdmi, buffer[8], 0x1033); + + if (frame.s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF) + mwv207_hdmi_writeb(hdmi, buffer[9], 0x1034); + + mwv207_hdmi_writeb(hdmi, 1, 0x10B4); + + mwv207_hdmi_writeb(hdmi, 0x11, 0x10B5); + + mwv207_hdmi_mask_writeb(hdmi, 1, 0x10B3, 3, 0x08); +} + +static void mwv207_hdmi_config_drm_infoframe(struct mwv207_hdmi *hdmi, + const struct drm_connector *connector) +{ + const struct drm_connector_state *conn_state = connector->state; + struct hdmi_drm_infoframe frame; + u8 buffer[30]; + ssize_t err; + int i; + + mwv207_hdmi_modb(hdmi, 0x00, 0x80, 0x10E3); + + err = drm_hdmi_infoframe_set_hdr_metadata(&frame, conn_state); + if (err < 0) + return; + + err = hdmi_drm_infoframe_pack(&frame, buffer, sizeof(buffer)); + if (err < 0) + return; + + mwv207_hdmi_writeb(hdmi, frame.version, 0x1168); + mwv207_hdmi_writeb(hdmi, frame.length, 0x1169); + + for (i = 0; i < frame.length; i++) + mwv207_hdmi_writeb(hdmi, buffer[4 + i], 0x116A + i); + + mwv207_hdmi_writeb(hdmi, 1, 0x1167); + mwv207_hdmi_modb(hdmi, 0x80, 0x80, 0x10E3); +} + +static void mwv207_hdmi_video_packetize(struct mwv207_hdmi *hdmi) +{ + unsigned int output_select = 0x3; + unsigned int remap_size = 0x0; + unsigned int color_depth = 4; + u8 val, vp_conf; + + val = ((color_depth << 4) & 0xF0); + mwv207_hdmi_writeb(hdmi, val, 0x0801); + + mwv207_hdmi_modb(hdmi, 0x1, 0x1, 0x0802); + + vp_conf = 0x00 | 0x4; + + mwv207_hdmi_modb(hdmi, vp_conf, 0x10 | 0x4, 0x0804); + + mwv207_hdmi_modb(hdmi, 1 << 5, 0x20, 0x0802); + + mwv207_hdmi_writeb(hdmi, remap_size, 0x0803); + + vp_conf = 0x40 | 0x00 | 0x0; + + mwv207_hdmi_modb(hdmi, vp_conf, 0x40 | 0x20 | 0x8, 0x0804); + + mwv207_hdmi_modb(hdmi, 0x2 | 0x4, 0x2 | 0x4, 0x0802); + + mwv207_hdmi_modb(hdmi, output_select, 0x3, 0x0804); +} + +static void mwv207_hdmi_update_csc_coeffs(struct mwv207_hdmi *hdmi) +{ + const u16 (*csc_coeff)[3][4] = &csc_coeff_default; + unsigned int i; + u32 csc_scale = 1; + + if (hdmi->rgb_limited_range) + csc_coeff = &csc_coeff_rgb_full_to_rgb_limited; + else + csc_coeff = &csc_coeff_default; + + for (i = 0; i < ARRAY_SIZE(csc_coeff_default[0]); i++) { + u16 coeff_a = (*csc_coeff)[0][i]; + u16 coeff_b = (*csc_coeff)[1][i]; + u16 coeff_c = (*csc_coeff)[2][i]; + + mwv207_hdmi_writeb(hdmi, coeff_a & 0xff, 0x4103 + i * 2); + mwv207_hdmi_writeb(hdmi, coeff_a >> 8, 0x4102 + i * 2); + mwv207_hdmi_writeb(hdmi, coeff_b & 0xff, 0x410B + i * 2); + mwv207_hdmi_writeb(hdmi, coeff_b >> 8, 0x410A + i * 2); + mwv207_hdmi_writeb(hdmi, coeff_c & 0xff, 0x4113 + i * 2); + mwv207_hdmi_writeb(hdmi, coeff_c >> 8, 0x4112 + i * 2); + } + + mwv207_hdmi_modb(hdmi, csc_scale, 0x03, 0x4101); +} + +static void mwv207_hdmi_video_csc(struct mwv207_hdmi *hdmi) +{ + int color_depth = 0x00; + + mwv207_hdmi_writeb(hdmi, 0, 0x4100); + mwv207_hdmi_modb(hdmi, color_depth, 0xF0, 0x4101); + + mwv207_hdmi_update_csc_coeffs(hdmi); +} + +static void mwv207_hdmi_video_sample(struct mwv207_hdmi *hdmi) +{ + int color_format = 1; + u8 val; + + val = 0x00 | ((color_format << 0) & 0x1F); + mwv207_hdmi_writeb(hdmi, val, 0x0200); + + val = 0x4 | 0x2 | 0x1; + mwv207_hdmi_writeb(hdmi, val, 0x0201); + mwv207_hdmi_writeb(hdmi, 0x0, 0x0202); + mwv207_hdmi_writeb(hdmi, 0x0, 0x0203); + mwv207_hdmi_writeb(hdmi, 0x0, 0x0204); + mwv207_hdmi_writeb(hdmi, 0x0, 0x0205); + mwv207_hdmi_writeb(hdmi, 0x0, 0x0206); + mwv207_hdmi_writeb(hdmi, 0x0, 0x0207); +} + +static void mwv207_hdmi_tx_hdcp_config(struct mwv207_hdmi *hdmi) +{ + u8 de = 0x10; + + mwv207_hdmi_modb(hdmi, 0x0, 0x4, 0x5000); + + mwv207_hdmi_modb(hdmi, de, 0x10, 0x5009); + + mwv207_hdmi_modb(hdmi, 0x2, 0x2, 0x5001); +} + +static void mwv207_hdmi_set_timing(struct mwv207_hdmi *hdmi) +{ + struct drm_display_mode *mode; + + mwv207_hdmi_disable_overflow_interrupts(hdmi); + + mode = &hdmi->base.cur_crtc->state->adjusted_mode; + hdmi->vic = drm_match_cea_mode(mode); + + hdmi->rgb_limited_range = hdmi->sink_is_hdmi && + drm_default_rgb_quant_range(mode) == + HDMI_QUANTIZATION_RANGE_LIMITED; + + mwv207_hdmi_av_composer(hdmi, mode); + + mwv207_hdmi_phy_configure(hdmi, mode->clock, 8); + + mwv207_hdmi_enable_video_path(hdmi); + + if (hdmi->sink_has_audio) { + mwv207_hdmi_enable_audio_clk(hdmi, 1); + } + + if (hdmi->sink_is_hdmi) { + struct drm_connector *conn = &hdmi->base.connector; + + mwv207_hdmi_config_AVI(hdmi, conn, mode); + mwv207_hdmi_config_vendor_specific_infoframe(hdmi, conn, mode); + mwv207_hdmi_config_drm_infoframe(hdmi, conn); + } + + mwv207_hdmi_video_packetize(hdmi); + mwv207_hdmi_video_csc(hdmi); + mwv207_hdmi_video_sample(hdmi); + mwv207_hdmi_tx_hdcp_config(hdmi); + + mwv207_hdmi_clear_overflow(hdmi); +} + +static int mwv207_hdmi_get_modes(struct drm_connector *connector) +{ + struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); + int count; + + count = mwv207_output_get_modes(connector); + + if (connector->edid_blob_ptr) { + struct edid *edid; + + edid = (struct edid *)connector->edid_blob_ptr->data; + hdmi->sink_is_hdmi = drm_detect_hdmi_monitor(edid); + hdmi->sink_has_audio = drm_detect_monitor_audio(edid); + } else { + hdmi->sink_is_hdmi = false; + hdmi->sink_has_audio = false; + } + + return count; +} + +static enum drm_mode_status mwv207_hdmi_mode_valid(struct mwv207_hdmi *hdmi, + const struct drm_display_mode *mode) +{ + if (mode->clock >= 384000) + return MODE_CLOCK_HIGH; + + if (mode->clock > 594000) + return MODE_CLOCK_HIGH; + + if (!hdmi->sink_is_hdmi && mode->clock >= 165000) + return MODE_CLOCK_HIGH; + + return MODE_OK; +} + +static enum drm_mode_status mwv207_hdmi_connector_mode_valid(struct drm_connector *connector, + struct drm_display_mode *mode) +{ + struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); + + return mwv207_hdmi_mode_valid(hdmi, mode); +} + +static int mwv207_hdmi_detect_ctx(struct drm_connector *connector, + struct drm_modeset_acquire_ctx *ctx, + bool force) +{ + struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); + u32 value; + + value = mwv207_hdmi_readb(hdmi, 0x3004); + if (value & 0x2) + return connector_status_connected; + else + return connector_status_disconnected; +} + +static void mwv207_hdmi_destroy(struct drm_connector *conn) +{ + struct mwv207_hdmi *hdmi = connector_to_hdmi(conn); + + free_irq(hdmi->irq, hdmi); + drm_connector_unregister(conn); + drm_connector_cleanup(conn); +} + +static const struct drm_connector_helper_funcs mwv207_hdmi_connector_helper_funcs = { + .get_modes = mwv207_hdmi_get_modes, + .mode_valid = mwv207_hdmi_connector_mode_valid, + .detect_ctx = mwv207_hdmi_detect_ctx +}; + +static const struct drm_connector_funcs mwv207_hdmi_connector_funcs = { + .reset = drm_atomic_helper_connector_reset, + .fill_modes = drm_helper_probe_single_connector_modes, + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, + .destroy = mwv207_hdmi_destroy, + .late_register = mwv207_output_late_register, + .early_unregister = mwv207_output_early_unregister, +}; + +static enum drm_mode_status mwv207_hdmi_encoder_mode_valid(struct drm_encoder *encoder, + const struct drm_display_mode *mode) +{ + struct mwv207_hdmi *hdmi = encoder_to_hdmi(encoder); + + return mwv207_hdmi_mode_valid(hdmi, mode); +} + +static int mwv207_hdmi_encoder_atomic_check(struct drm_encoder *encoder, + struct drm_crtc_state *crtc_state, + struct drm_connector_state *conn_state) +{ + return 0; +} + +static void mwv207_hdmi_encoder_enable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_hdmi_select_crtc(output); + + mwv207_hdmi_set_timing(encoder_to_hdmi(encoder)); + + mwv207_hdmi_switch(output, true); +} + +static void mwv207_hdmi_encoder_disable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_hdmi_switch(output, false); +} + +static void mwv207_hdmi_encoder_reset(struct drm_encoder *encoder) +{ + mwv207_hdmi_encoder_disable(encoder); + mwv207_hdmi_ih_mutes(encoder_to_hdmi(encoder)); + mwv207_hdmi_phy_setup_hpd(encoder_to_hdmi(encoder)); +} + +static const struct drm_encoder_funcs mwv207_hdmi_encoder_funcs = { + .destroy = drm_encoder_cleanup, + .reset = mwv207_hdmi_encoder_reset, +}; + +static const struct drm_encoder_helper_funcs mwv207_hdmi_encoder_helper_funcs = { + .mode_valid = mwv207_hdmi_encoder_mode_valid, + .atomic_check = mwv207_hdmi_encoder_atomic_check, + .enable = mwv207_hdmi_encoder_enable, + .disable = mwv207_hdmi_encoder_disable, +}; + +static int mwv207_hdmi_init_single(struct mwv207_device *jdev, int idx) +{ + struct mwv207_output *output; + struct mwv207_hdmi *hdmi; + int ret; + + hdmi = devm_kzalloc(jdev->dev, sizeof(*hdmi), GFP_KERNEL); + if (!hdmi) + return -ENOMEM; + + output = &hdmi->base; + output->jdev = jdev; + output->idx = idx; + output->mmio = jdev->mmio + 0x9a0000; + output->i2c_chan = 0 + idx; + hdmi->mmio = jdev->mmio + (0x1200000 + 0x40000 * (idx)); + hdmi->mc_clkdis = 0x7f; + + mwv207_hdmi_phy_data_init(hdmi); + + output->connector.polled = DRM_CONNECTOR_POLL_HPD; + ret = drm_connector_init(&jdev->base, &output->connector, + &mwv207_hdmi_connector_funcs, DRM_MODE_CONNECTOR_HDMIA); + if (ret) + return ret; + drm_connector_helper_add(&output->connector, &mwv207_hdmi_connector_helper_funcs); + + output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; + ret = drm_encoder_init(&jdev->base, &output->encoder, + &mwv207_hdmi_encoder_funcs, DRM_MODE_ENCODER_TMDS, + "hdmi-%d", output->idx); + if (ret) + return ret; + drm_encoder_helper_add(&output->encoder, &mwv207_hdmi_encoder_helper_funcs); + + ret = drm_connector_attach_encoder(&output->connector, &output->encoder); + if (ret) + return ret; + + hdmi->irq = irq_find_mapping(jdev->irq_domain, output->idx + 32); + BUG_ON(hdmi->irq == 0); + + ret = request_threaded_irq(hdmi->irq, + mwv207_hdmi_hard_irq, mwv207_hdmi_irq, + IRQF_SHARED, output->encoder.name, hdmi); + if (ret) + return ret; + + ret = drm_connector_register(&output->connector); + if (ret) + free_irq(hdmi->irq, hdmi); + + return ret; +} + +int mwv207_hdmi_init(struct mwv207_device *jdev) +{ + int i, ret; + + for (i = 0; i < 4; i++) { + + if (jdev_read(jdev, (0x1200000 + 0x40000 * (i))) != 0x21) + continue; + ret = mwv207_hdmi_init_single(jdev, i); + if (ret) + return ret; + } + + return 0; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_i2c.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_i2c.c new file mode 100644 index 0000000000000000000000000000000000000000..bcfbef8d57a94e9cb36a41c8862d13f49f83c840 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_i2c.c @@ -0,0 +1,312 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include "mwv207.h" +#include "mwv207_vi.h" + +static int i2c_scl_gpio[8] = {19, 21, 23, 25, 27, 29, 31, 33}; +static int i2c_sda_gpio[8] = {20, 22, 24, 26, 28, 30, 32, 34}; + +struct mwv207_i2c { + struct i2c_adapter adapter; + struct mwv207_device *jdev; + struct i2c_algo_bit_data bit; + struct mutex *mutex; + u32 sda_in_addr; + u32 sda_out_addr; + u32 sda_mask; + u32 sda_dir; + u32 scl_in_addr; + u32 scl_out_addr; + u32 scl_mask; + u32 scl_dir; +}; + +static inline void mwv207_i2c_set_dir(struct mwv207_i2c *i2c, u32 mask, + u32 reg, bool is_input) +{ + mb(); + + jdev_modify(i2c->jdev, reg, mask, is_input ? mask : 0); + + mb(); +} + + +static void mwv207_i2c_gpio_multi(struct mwv207_i2c *i2c, int mask) +{ + struct mwv207_device *jdev = i2c->jdev; + + switch (mask) { + case (1 << 19): + + jdev_modify(jdev, (0x9b0918), 0x3 << 12, 0); + jdev_modify(jdev, (0x9b0918), 0x3 << 16, 0); + break; + case (1 << 21): + + jdev_modify(jdev, (0x9b0918), 0x3 << 20, 0); + jdev_modify(jdev, (0x9b0918), 0x3 << 24, 0); + break; + case (1 << 23): + + jdev_modify(jdev, (0x9b0918), 0x3 << 28, 0); + jdev_modify(jdev, (0x9b091c), 0x3, 0); + break; + case (1 << 25): + + jdev_modify(jdev, (0x9b091c), 0x3 << 4, 0); + jdev_modify(jdev, (0x9b091c), 0x3 << 8, 0); + break; + case (1 << 27): + + jdev_modify(jdev, (0x9b091c), 0x3 << 12, 0); + jdev_modify(jdev, (0x9b091c), 0x3 << 16, 0); + break; + case (1 << 29): + + jdev_modify(jdev, (0x9b091c), 0x3 << 20, 0); + jdev_modify(jdev, (0x9b091c), 0x3 << 24, 0); + break; + case (1 << 31): + + jdev_modify(jdev, (0x9b091c), 0x3 << 28, 0); + jdev_modify(jdev, (0x9b0910), 0x3, 0); + break; + case (1 << 1): + + jdev_modify(jdev, (0x9b0910), 0x3 << 4, 0); + jdev_modify(jdev, (0x9b0910), 0x3 << 8, 0); + break; + default: + break; + } +} + +static int mwv207_i2c_pre_xfer(struct i2c_adapter *i2c_adap) +{ + struct mwv207_i2c *i2c = i2c_get_adapdata(i2c_adap); + struct mwv207_device *jdev = i2c->jdev; + + mutex_lock(i2c->mutex); + mwv207_i2c_gpio_multi(i2c, i2c->scl_mask); + + jdev_modify(jdev, i2c->scl_out_addr, i2c->scl_mask, 0); + jdev_modify(jdev, i2c->sda_out_addr, i2c->sda_mask, 0); + + mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 1); + mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); + + return 0; +} + +static void mwv207_i2c_post_xfer(struct i2c_adapter *i2c_adap) +{ + struct mwv207_i2c *i2c = i2c_get_adapdata(i2c_adap); + + mutex_unlock(i2c->mutex); +} + +static int mwv207_i2c_get_clock(void *i2c_priv) +{ + struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; + struct mwv207_device *jdev = i2c->jdev; + u32 val; + + mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 1); + + val = jdev_read(jdev, i2c->scl_in_addr); + val &= i2c->scl_mask; + + return val ? 1 : 0; +} + +static int mwv207_i2c_get_data(void *i2c_priv) +{ + struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; + struct mwv207_device *jdev = i2c->jdev; + u32 val; + + mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); + + val = jdev_read(jdev, i2c->sda_in_addr); + val &= i2c->sda_mask; + + return val ? 1 : 0; +} + +static void mwv207_i2c_set_clock(void *i2c_priv, int clock) +{ + struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; + struct mwv207_device *jdev = i2c->jdev; + + mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 0); + jdev_modify(jdev, i2c->scl_out_addr, i2c->scl_mask, clock ? i2c->scl_mask : 0); +} + +static void mwv207_i2c_set_data(void *i2c_priv, int data) +{ + struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; + + if (data) + mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); + else + mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 0); +} + +static int mwv207_i2c_set_addr(struct mwv207_i2c *i2c, int channel) +{ + switch (channel) { + case 0: + case 1: + case 2: + case 3: + case 4: + case 5: + i2c->sda_in_addr = (0x9aa000); + i2c->scl_in_addr = (0x9aa000); + i2c->sda_out_addr = (0x9aa004); + i2c->scl_out_addr = (0x9aa004); + i2c->scl_mask = (1 << i2c_scl_gpio[channel]); + i2c->sda_mask = (1 << i2c_sda_gpio[channel]); + i2c->scl_dir = (0x9aa008); + i2c->sda_dir = (0x9aa008); + break; + case 6: + i2c->sda_in_addr = (0x9aa000); + i2c->scl_in_addr = (0x9aa010); + i2c->sda_out_addr = (0x9aa004); + i2c->scl_out_addr = (0x9aa014); + i2c->scl_mask = (1 << i2c_scl_gpio[channel]); + i2c->sda_mask = (1 << (i2c_sda_gpio[channel] - 32)); + i2c->scl_dir = (0x9aa008); + i2c->sda_dir = (0x9aa018); + break; + case 7: + i2c->sda_in_addr = (0x9aa010); + i2c->scl_in_addr = (0x9aa010); + i2c->sda_out_addr = (0x9aa014); + i2c->scl_out_addr = (0x9aa014); + i2c->scl_mask = (1 << (i2c_scl_gpio[channel] - 32)); + i2c->sda_mask = (1 << (i2c_sda_gpio[channel] - 32)); + i2c->scl_dir = (0x9aa018); + i2c->sda_dir = (0x9aa018); + break; + } + + return 0; +} + +void mwv207_i2c_put_byte(struct i2c_adapter *i2c, + u8 slave_addr, + u8 addr, + u8 val) +{ + uint8_t out_buf[2]; + struct i2c_msg msg = { + .addr = slave_addr, + .flags = 0, + .len = 2, + .buf = out_buf, + }; + + out_buf[0] = addr; + out_buf[1] = val; + + if (i2c_transfer(i2c, &msg, 1) != 1) + pr_warn("i2c 0x%02x 0x%02x write failed\n", + addr, val); +} + +void mwv207_i2c_destroy(struct i2c_adapter *adapter) +{ + i2c_del_adapter(adapter); +} + +struct i2c_adapter *mwv207_i2c_create(struct mwv207_device *jdev, int i2c_chan) +{ + struct mwv207_i2c *i2c; + int ret; + + if (i2c_chan < 0 || i2c_chan >= 6) + return NULL; + + i2c = devm_kzalloc(jdev->dev, sizeof(*i2c), GFP_KERNEL); + if (!i2c) + return NULL; + + if (mwv207_i2c_set_addr(i2c, i2c_chan)) + return NULL; + + i2c->adapter.owner = THIS_MODULE; + i2c->adapter.class = I2C_CLASS_DDC; + i2c->adapter.dev.parent = jdev->dev; + i2c_set_adapdata(&i2c->adapter, i2c); + i2c->mutex = &jdev->gpio_lock; + i2c->jdev = jdev; + + snprintf(i2c->adapter.name, sizeof(i2c->adapter.name), + "MWV207_I2C_%d", i2c_chan); + i2c->adapter.algo_data = &i2c->bit; + i2c->bit.pre_xfer = mwv207_i2c_pre_xfer; + i2c->bit.post_xfer = mwv207_i2c_post_xfer; + i2c->bit.setsda = mwv207_i2c_set_data; + i2c->bit.setscl = mwv207_i2c_set_clock; + i2c->bit.getsda = mwv207_i2c_get_data; + i2c->bit.getscl = mwv207_i2c_get_clock; + i2c->bit.udelay = 10; + i2c->bit.timeout = usecs_to_jiffies(2200); + i2c->bit.data = i2c; + + ret = i2c_bit_add_bus(&i2c->adapter); + if (ret) + return NULL; + + return &i2c->adapter; +} + +bool mwv207_i2c_probe(struct i2c_adapter *i2c_bus) +{ + u8 out = 0x0; + u8 buf[8]; + int ret; + struct i2c_msg msgs[] = { + { + .addr = DDC_ADDR, + .flags = 0, + .len = 1, + .buf = &out, + }, + { + .addr = DDC_ADDR, + .flags = I2C_M_RD, + .len = 8, + .buf = buf, + } + }; + + ret = i2c_transfer(i2c_bus, msgs, 2); + if (ret != 2) { + + return false; + } + + if (drm_edid_header_is_valid(buf) < 6) { + return false; + } + return true; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_kms.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_kms.c new file mode 100644 index 0000000000000000000000000000000000000000..b5c22f033e52cc48fef836c0bc3a5f20da290ee0 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_kms.c @@ -0,0 +1,204 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "mwv207_gem.h" +#include "mwv207_kms.h" +#include "mwv207_va.h" +#include "mwv207_vi.h" + +static const struct drm_framebuffer_funcs fb_funcs = { + .destroy = drm_gem_fb_destroy, + .create_handle = drm_gem_fb_create_handle, +}; + +int mwv207_framebuffer_init(struct mwv207_device *jdev, struct drm_framebuffer *fb, + const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object *gobj) +{ + int ret; + + fb->obj[0] = gobj; + drm_helper_mode_fill_fb_struct(&jdev->base, fb, mode_cmd); + + ret = drm_framebuffer_init(&jdev->base, fb, &fb_funcs); + return ret; +} + +static struct drm_framebuffer *mwv207_framebuffer_create( + struct drm_device *dev, + struct drm_file *filp, + const struct drm_mode_fb_cmd2 *mode_cmd) +{ + struct drm_gem_object *gobj = drm_gem_object_lookup(filp, mode_cmd->handles[0]); + struct drm_framebuffer *fb; + int err = -ENOENT; + + if (!gobj) { + DRM_DEBUG_DRIVER("fbdev failed to lookup gem object, handle = %d\n", + mode_cmd->handles[0]); + return ERR_PTR(-ENOENT); + } + + fb = kzalloc(sizeof(*fb), GFP_KERNEL); + if (!fb) { + err = -ENOMEM; + goto err_unref; + } + + err = mwv207_framebuffer_init(dev->dev_private, fb, mode_cmd, gobj); + if (err) + goto err_free; + + return fb; +err_free: + kfree(fb); +err_unref: + drm_gem_object_put(gobj); + return ERR_PTR(err); +} + +static void mwv207_atomic_prepare_vblank(struct drm_device *dev, + struct drm_atomic_state *old_state) +{ + struct drm_crtc_state *new_crtc_state; + struct drm_crtc *crtc; + int i; + + for_each_new_crtc_in_state(old_state, crtc, new_crtc_state, i) + mwv207_crtc_prepare_vblank(crtc); +} + +static void mwv207_atomic_commit_tail(struct drm_atomic_state *old_state) +{ + struct drm_device *dev = old_state->dev; + + drm_atomic_helper_commit_modeset_disables(dev, old_state); + drm_atomic_helper_commit_planes(dev, old_state, 0); + drm_atomic_helper_commit_modeset_enables(dev, old_state); + + mwv207_atomic_prepare_vblank(dev, old_state); + + drm_atomic_helper_commit_hw_done(old_state); + + drm_atomic_helper_wait_for_vblanks(dev, old_state); + drm_atomic_helper_cleanup_planes(dev, old_state); +} + +static struct drm_mode_config_helper_funcs mwv207_mode_config_helper_funcs = { + .atomic_commit_tail = mwv207_atomic_commit_tail, +}; + +static const struct drm_mode_config_funcs mwv207_mode_config_funcs = { + .fb_create = mwv207_framebuffer_create, + .atomic_check = drm_atomic_helper_check, + .atomic_commit = drm_atomic_helper_commit, + .output_poll_changed = drm_fb_helper_output_poll_changed, +}; + +static void mwv207_modeset_init(struct drm_device *dev) +{ + drm_mode_config_init(dev); + + dev->mode_config.min_width = 20; + dev->mode_config.min_height = 20; + + dev->mode_config.max_width = 4096 * 4; + dev->mode_config.max_height = 4096 * 4; + + dev->mode_config.preferred_depth = 24; + dev->mode_config.prefer_shadow = 1; + dev->mode_config.allow_fb_modifiers = true; + + dev->mode_config.async_page_flip = true; + + dev->mode_config.funcs = &mwv207_mode_config_funcs; + dev->mode_config.helper_private = &mwv207_mode_config_helper_funcs; + + dev->mode_config.cursor_width = 64; + dev->mode_config.cursor_height = 64; +} + +int mwv207_kms_suspend(struct mwv207_device *jdev) +{ + return drm_mode_config_helper_suspend(&jdev->base); +} + +int mwv207_kms_resume(struct mwv207_device *jdev) +{ + int ret; + + ret = drm_mode_config_helper_resume(&jdev->base); + if (ret) + pr_warn("mwv207: failed to resume kms, ret: %d", ret); + + return ret; +} + +int mwv207_kms_init(struct mwv207_device *jdev) +{ + int ret; + + mwv207_modeset_init(&jdev->base); + + ret = mwv207_va_init(jdev); + if (ret) + goto cleanup; + + ret = mwv207_vi_init(jdev); + if (ret) + goto cleanup; + + jdev->va_irq = irq_find_mapping(jdev->irq_domain, 42); + BUG_ON(jdev->va_irq == 0); + ret = request_irq(jdev->va_irq, mwv207_va_handle_vblank, 0, "mwv207_va", jdev); + if (ret) + goto cleanup; + jdev->base.irq_enabled = true; + + ret = drm_vblank_init(&jdev->base, jdev->base.mode_config.num_crtc); + if (ret) + goto free_irq; + + drm_mode_config_reset(&jdev->base); + + drm_kms_helper_poll_init(&jdev->base); + + DRM_INFO("number of crtc: %d\n", jdev->base.mode_config.num_crtc); + DRM_INFO("number of encoder: %d\n", jdev->base.mode_config.num_encoder); + DRM_INFO("number of connector: %d\n", jdev->base.mode_config.num_connector); + + return 0; +free_irq: + free_irq(jdev->va_irq, jdev); +cleanup: + drm_mode_config_cleanup(&jdev->base); + return ret; +} + +void mwv207_kms_fini(struct mwv207_device *jdev) +{ + drm_kms_helper_poll_fini(&jdev->base); + drm_atomic_helper_shutdown(&jdev->base); + free_irq(jdev->va_irq, jdev); + drm_mode_config_cleanup(&jdev->base); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_kms.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_kms.h new file mode 100644 index 0000000000000000000000000000000000000000..eedb428f638d63c1f54a63631c6c6b0a40805d4c --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_kms.h @@ -0,0 +1,33 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_KMS_H_VBCHTKVP +#define MWV207_KMS_H_VBCHTKVP + +#include +#include "mwv207.h" + +int mwv207_framebuffer_init(struct mwv207_device *jdev, struct drm_framebuffer *fb, + const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object *gobj); + +int mwv207_fbdev_init(struct mwv207_device *jdev); +void mwv207_fbdev_fini(struct mwv207_device *jdev); + +int mwv207_kms_init(struct mwv207_device *jdev); +void mwv207_kms_fini(struct mwv207_device *jdev); + +int mwv207_kms_suspend(struct mwv207_device *jdev); +int mwv207_kms_resume(struct mwv207_device *jdev); +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_va.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_va.c new file mode 100644 index 0000000000000000000000000000000000000000..e51e3638ea9b9ba9b0b783ffe27c93aab05b63ff --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_va.c @@ -0,0 +1,717 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include +#include +#include "mwv207_bo.h" +#include "mwv207_va.h" +#include "mwv207_vi.h" +#include "mwv207_vbios.h" + + + +#define crtc_to_va(crtc) container_of(crtc, struct mwv207_va, crtc) +#define plane_to_va(plane) (((plane)->type == DRM_PLANE_TYPE_PRIMARY) \ + ? container_of(plane, struct mwv207_va, primary) \ + : container_of(plane, struct mwv207_va, cursor)) +struct mwv207_va { + struct drm_crtc crtc; + struct drm_plane primary; + struct drm_plane cursor; + void __iomem *mmio; + struct mwv207_device *jdev; + struct drm_pending_vblank_event *event; + int idx; + uint16_t lutdata[768]; +}; + +static u32 rgb_formats[] = { + DRM_FORMAT_RGB565, + DRM_FORMAT_RGB888, + DRM_FORMAT_XRGB8888, + DRM_FORMAT_ARGB8888, + DRM_FORMAT_XRGB2101010, +}; + +static uint64_t format_modifiers[] = { + DRM_FORMAT_MOD_LINEAR, + DRM_FORMAT_MOD_INVALID +}; + +static u32 cursor_formats[] = { + DRM_FORMAT_ARGB8888, +}; + +static inline u32 mwv207_va_read(struct mwv207_va *va, u32 reg) +{ + return readl(va->mmio + reg); +} + +static inline void mwv207_va_write(struct mwv207_va *va, u32 reg, u32 value) +{ + writel_relaxed(value, va->mmio + reg); +} + +static inline void mwv207_va_modify(struct mwv207_va *va, u32 reg, + u32 mask, u32 value) +{ + u32 rvalue = mwv207_va_read(va, reg); + + rvalue = (rvalue & ~mask) | (value & mask); + mwv207_va_write(va, reg, rvalue); +} + +static bool mwv207_plane_format_mod_supported(struct drm_plane *plane, + uint32_t format, uint64_t modifier) +{ + if (modifier == DRM_FORMAT_MOD_LINEAR) + return true; + return false; +} + +static int mwv207_plane_atomic_check(struct drm_plane *plane, + struct drm_plane_state *state) +{ + + return 0; +} + +static int mwv207_plane_prepare_fb(struct drm_plane *plane, + struct drm_plane_state *new_state) +{ + struct mwv207_bo *jbo; + int ret; + + if (!new_state->fb) + return 0; + + jbo = mwv207_bo_from_gem(new_state->fb->obj[0]); + + ret = mwv207_bo_reserve(jbo, false); + if (ret) + return ret; + + + jbo->flags |= (1<<0); + ret = mwv207_bo_pin_reserved(jbo, 0x2); + mwv207_bo_unreserve(jbo); + if (ret) + return ret; + + mwv207_bo_ref(jbo); + + drm_gem_fb_prepare_fb(plane, new_state); + + return 0; +} + +static void mwv207_plane_cleanup_fb(struct drm_plane *plane, + struct drm_plane_state *old_state) +{ + struct mwv207_bo *jbo; + + if (!old_state->fb) + return; + + jbo = mwv207_bo_from_gem(old_state->fb->obj[0]); + if (!jbo) + return; + + mwv207_bo_unpin(jbo); + mwv207_bo_unref(jbo); +} + +static u64 mwv207_plane_fb_addr(struct drm_plane *plane) +{ + struct drm_framebuffer *fb; + struct mwv207_bo *bo; + u32 src_x, src_y; + u64 fbaddr; + + + src_x = plane->state->src_x >> 16; + src_y = plane->state->src_y >> 16; + + fb = plane->state->fb; + bo = mwv207_bo_from_gem(fb->obj[0]); + fbaddr = mwv207_bo_gpu_phys(bo); + fbaddr += src_x * fb->format->cpp[0] + fb->pitches[0] * src_y; + + return fbaddr; +} + +static void mwv207_primary_atomic_update(struct drm_plane *plane, + struct drm_plane_state *old_state) +{ + struct mwv207_va *va = plane_to_va(plane); + struct drm_framebuffer *fb; + u32 src_w, src_h; + u64 fbaddr; + + + if (!plane->state->fb || !plane->state->crtc) + return; + + + src_w = plane->state->src_w >> 16; + src_h = plane->state->src_h >> 16; + fbaddr = mwv207_plane_fb_addr(plane); + fb = plane->state->fb; + + + mwv207_va_write(va, 0x434, fb->pitches[0] >> 4); + + + mwv207_va_write(va, 0x43C, ((src_h - 1) << 16) | (src_w - 1) | 0x3); + + + mwv207_va_write(va, 0x4F8, (src_w - 1) << 16); + + + mwv207_va_write(va, 0x438, fbaddr >> 6); + + + switch (fb->format->format) { + case DRM_FORMAT_RGB565: + mwv207_va_modify(va, 0x430, 1, 1); + break; + case DRM_FORMAT_XRGB2101010: + case DRM_FORMAT_ARGB2101010: + mwv207_va_modify(va, 0x430, 1 << 1, 1 << 1); + break; + case DRM_FORMAT_ARGB8888: + mwv207_va_modify(va, 0x430, 0x3, 0); + break; + default: + break; + } +} + +static void mwv207_primary_atomic_disable(struct drm_plane *plane, + struct drm_plane_state *old_state) +{ + +} + +/* turn on / off cursor */ +static void mwv207_cursor_switch(struct mwv207_va *va, bool on) +{ + mwv207_va_modify(va, 0x478, 0xff, on ? 6 : 0); +} + +static void mwv207_cursor_atomic_update(struct drm_plane *plane, + struct drm_plane_state *old_state) +{ + int crtc_x, crtc_y, pos_x, pos_y, hot_x, hot_y; + struct mwv207_va *va = plane_to_va(plane); + u64 fbaddr; + + + if (!plane->state->fb || !plane->state->crtc) + return; + + + crtc_x = plane->state->crtc_x; + crtc_y = plane->state->crtc_y; + fbaddr = mwv207_plane_fb_addr(plane); + + + mwv207_va_write(va, 0x4B4, fbaddr >> 6); + + + pos_x = crtc_x < 0 ? 0 : crtc_x; + hot_x = crtc_x < 0 ? -crtc_x : 0; + pos_y = crtc_y < 0 ? 0 : crtc_y; + hot_y = crtc_y < 0 ? -crtc_y : 0; + mwv207_va_write(va, 0x454, (hot_x & 0x3f) | ((hot_y & 0x3f) << 16)); + mwv207_va_write(va, 0x4A8, (pos_x & 0xffff) | ((pos_y & 0xffff) << 16)); + + + mwv207_cursor_switch(va, 1); +} + +static void mwv207_cursor_atomic_disable(struct drm_plane *plane, + struct drm_plane_state *old_state) +{ + struct mwv207_va *va = plane_to_va(plane); + + + mwv207_cursor_switch(va, 0); +} + +static const struct drm_plane_funcs mwv207_plane_funcs = { + .reset = drm_atomic_helper_plane_reset, + .update_plane = drm_atomic_helper_update_plane, + .disable_plane = drm_atomic_helper_disable_plane, + .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_plane_destroy_state, + .format_mod_supported = mwv207_plane_format_mod_supported, + .destroy = drm_plane_cleanup, +}; + +static const struct drm_plane_helper_funcs mwv207_primary_helper_funcs = { + .prepare_fb = mwv207_plane_prepare_fb, + .cleanup_fb = mwv207_plane_cleanup_fb, + .atomic_check = mwv207_plane_atomic_check, + .atomic_update = mwv207_primary_atomic_update, + .atomic_disable = mwv207_primary_atomic_disable, +}; + +static const struct drm_plane_helper_funcs mwv207_cursor_helper_funcs = { + .prepare_fb = mwv207_plane_prepare_fb, + .cleanup_fb = mwv207_plane_cleanup_fb, + .atomic_check = mwv207_plane_atomic_check, + .atomic_update = mwv207_cursor_atomic_update, + .atomic_disable = mwv207_cursor_atomic_disable, +}; + +static void mwv207_va_misc_reset(struct mwv207_va *va) +{ + struct mwv207_device *jdev = va->jdev; + + + jdev_write(jdev, (0x9b001c), 0xfffff); + jdev_write(jdev, (0x9b0020), 0xfffff); + jdev_write(jdev, (0x9b0024), 0xfffff); + + + jdev_write(jdev, (0x9b0028), 0x03020100); + + + jdev_write(jdev, (0x990000 + 0x100 * (va->idx) + ((va->idx) > 1 ? 0xC00 : 0)) + 0x2c, 0); +} + +static int mwv207_va_lut_fifo_wait(struct mwv207_va *va, u32 used) +{ + int i; + + + mb(); + for (i = 0; i < 120; ++i) { + if (mwv207_va_read(va, 0x450) <= used) + return 0; + usleep_range(1000, 1001); + } + + return -EBUSY; +} + +static void mwv207_va_lut_fifo_activate(struct mwv207_va *va, int rgb) +{ + + mb(); + mwv207_va_write(va, 0x44C, rgb); + mwv207_va_write(va, 0x448, 1); + udelay(2); + mwv207_va_write(va, 0x448, 0); + udelay(2); +} + +static int mwv207_va_lut_fifo_input(struct mwv207_va *va, u32 value) +{ + int ret; + + + ret = mwv207_va_lut_fifo_wait(va, 10); + if (ret) + return ret; + + mb(); + mwv207_va_write(va, 0x444, value); + + return 0; +} + +static void mwv207_va_lut_enable(struct mwv207_va *va) +{ + u32 active_ram, value; + int i, ram, rgb; + u16 *data; + + mwv207_va_modify(va, 0x460, 1 << 31, 0 << 31); + value = (va->lutdata[384] * 15 / 8) | 0x80000000; + jdev_write(va->jdev, (0x990000 + 0x100 * (va->idx) + ((va->idx) > 1 ? 0xC00 : 0)) + 0x38, value); + + for (ram = 0; ram < 2; ram++) { + active_ram = mwv207_va_read(va, 0x440); + for (rgb = 0; rgb < 3; rgb++) { + data = &va->lutdata[rgb * 256]; + mwv207_va_lut_fifo_activate(va, rgb); + for (i = 0; i < 1024; i++) { + + value = min_t(u32, 1024 - 5, (data[i / 4] << 2) | 0x03); + if (mwv207_va_lut_fifo_input(va, value)) + pr_warn("mwv207: failed to write lut"); + } + + if (mwv207_va_lut_fifo_wait(va, 0)) + pr_warn("mwv207: failed to configure lut"); + } + + mb(); + mwv207_va_write(va, 0x440, 1 - active_ram); + } +} + +static void mwv207_mode_fixup(struct drm_display_mode *adjusted_mode, struct drm_display_mode *mode) +{ + memcpy(adjusted_mode, mode, sizeof(*adjusted_mode)); + + mode->crtc_hdisplay = adjusted_mode->crtc_hdisplay * 2; + mode->crtc_hblank_start = adjusted_mode->crtc_hblank_start * 2; + mode->crtc_hblank_end = adjusted_mode->crtc_hblank_end * 2; + mode->crtc_hsync_start = adjusted_mode->crtc_hsync_start * 2; + mode->crtc_hsync_end = adjusted_mode->crtc_hsync_end * 2; + mode->crtc_htotal = adjusted_mode->crtc_htotal * 2; + mode->crtc_clock = adjusted_mode->crtc_clock * 2; +} + +static void mwv207_va_config_timing(struct mwv207_va *va) +{ + struct drm_display_mode *m = &va->crtc.state->adjusted_mode; + struct drm_display_mode *native = NULL; + u32 hsbegin, hsend, hblankbegin, hblankend, htotal, hhalf; + u32 vblank_1field_begin, vblank_1field_end; + u32 vblank_2field_begin, vblank_2field_end; + u32 vs_1field_begin, vs_1field_end; + u32 vs_2field_begin, vs_2field_end; + u32 is_interleaved; + u32 vfrontporch, vsync, vtotal; + int ret, value; + + ret = mwv207_vbios_set_pll(va->jdev, va->idx + MWV207_PLL_GRAPH0, m->crtc_clock); + if (ret) { + DRM_ERROR("mwv207: failed to set crtc clock: %d", ret); + return; + } + + is_interleaved = DRM_MODE_FLAG_INTERLACE & m->flags ? 1 : 0; + if (is_interleaved && m->crtc_hdisplay == 720) { + native = kmalloc(sizeof(*m), GFP_KERNEL); + if (!native) { + DRM_ERROR("mwv207: failed to kmalloc native mode\r\n"); + return; + } + mwv207_mode_fixup(m, native); + m = native; + } + + + hblankbegin = 0; + hblankend = m->crtc_htotal - m->crtc_hdisplay; + htotal = m->crtc_htotal; + hsbegin = m->crtc_hsync_start - m->crtc_hdisplay; + hsend = m->crtc_hsync_end - m->crtc_hdisplay; + hhalf = is_interleaved ? (htotal / 2 + hsbegin) : htotal / 2; + + + vblank_1field_begin = 0; + vblank_1field_end = is_interleaved ? + ((m->crtc_vtotal - m->crtc_vdisplay) * 2) + : (m->crtc_vtotal - m->crtc_vdisplay); + + vblank_2field_begin = + (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2; + vblank_2field_end = + (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + + (m->crtc_vtotal - m->crtc_vdisplay + 1) * 2; + + vtotal = m->crtc_vtotal; + vfrontporch = m->crtc_vsync_start - m->crtc_vdisplay; + vsync = m->crtc_vsync_end - m->crtc_vsync_start; + vs_1field_begin = is_interleaved ? (vfrontporch * 2) : (vfrontporch); + vs_1field_end = is_interleaved ? ((vfrontporch + vsync) * 2) + : (vfrontporch + vsync); + vs_2field_begin = + (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + + vfrontporch * 2 + 1; + vs_2field_end = + (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + + (vfrontporch + vsync) * 2 + 1; + + + mwv207_va_write(va, 0x400, hsbegin | (hsend << 16)); + mwv207_va_write(va, 0x404, hblankbegin | (hblankend << 16)); + mwv207_va_write(va, 0x408, htotal | (hhalf << 16)); + + + mwv207_va_write(va, 0x40C, vblank_1field_begin | (vblank_1field_end << 16)); + mwv207_va_write(va, 0x458, vblank_1field_begin | (vblank_1field_end << 16)); + mwv207_va_write(va, 0x410, vblank_2field_begin | (vblank_2field_end << 16)); + mwv207_va_write(va, 0x45C, vblank_2field_begin | (vblank_2field_end << 16)); + + mwv207_va_write(va, 0x418, vs_1field_begin | (vs_1field_end << 16)); + mwv207_va_write(va, 0x41C, vs_2field_begin | (vs_2field_end << 16)); + + mwv207_va_modify(va, 0x414, 0xffff, vtotal); + + value = is_interleaved; + if (is_interleaved && m->crtc_hdisplay == 1440) + value |= 0x2; + mwv207_va_write(va, 0x464, value); + + + mwv207_va_write(va, 0x420, 1); + + + value = mwv207_va_read(va, 0x2a0); + value &= ~0x6; + value |= 1; + mwv207_va_write(va, 0x2a0, value); + + kfree(native); +} + +static int mwv207_crtc_enable_vblank(struct drm_crtc *crtc) +{ + struct mwv207_va *va = crtc_to_va(crtc); + + jdev_modify(va->jdev, (0x9907f0), + 1 << (12 + va->idx), 1 << (12 + va->idx)); + jdev_modify(va->jdev, (0x9907f8), + 1 << (12 + va->idx), 1 << (12 + va->idx)); + return 0; +} + +static void mwv207_crtc_disable_vblank(struct drm_crtc *crtc) +{ + struct mwv207_va *va = crtc_to_va(crtc); + + jdev_modify(va->jdev, (0x9907f0), + 1 << (12 + va->idx), 0 << (12 + va->idx)); + jdev_modify(va->jdev, (0x9907f8), + 1 << (12 + va->idx), 0 << (12 + va->idx)); +} + +static int mwv207_crtc_atomic_check(struct drm_crtc *crtc, + struct drm_crtc_state *state) +{ + if (state->gamma_lut && drm_color_lut_size(state->gamma_lut) != 256) + return -EINVAL; + return 0; +} + +static void mwv207_crtc_atomic_enable(struct drm_crtc *crtc, + struct drm_crtc_state *old_crtc_state) +{ + struct mwv207_va *va = crtc_to_va(crtc); + struct drm_encoder *encoder; + + drm_for_each_encoder_mask(encoder, crtc->dev, crtc->state->encoder_mask) + mwv207_output_set_crtc(encoder, crtc); + + mwv207_va_config_timing(va); + drm_crtc_vblank_on(crtc); +} + +static void mwv207_crtc_atomic_disable(struct drm_crtc *crtc, + struct drm_crtc_state *old_crtc_state) +{ + struct mwv207_va *va = crtc_to_va(crtc); + + drm_crtc_vblank_off(crtc); + + + mwv207_va_write(va, 0x2c4, 0); + mwv207_va_write(va, 0x2c0, 0); + mwv207_va_write(va, 0x2a0, 2); + mwv207_va_write(va, 0x2c4, 1); + +} + +static void mwv207_crtc_atomic_flush(struct drm_crtc *crtc, + struct drm_crtc_state *old_crtc_state) +{ + struct mwv207_va *va = crtc_to_va(crtc); + struct drm_color_lut *lut; + int i; + + if (crtc->state->color_mgmt_changed) { + if (crtc->state->gamma_lut) { + lut = (struct drm_color_lut *)crtc->state->gamma_lut->data; + for (i = 0; i < 256; i++) { + va->lutdata[i] = drm_color_lut_extract(lut[i].red, 8); + va->lutdata[i + 256] = drm_color_lut_extract(lut[i].green, 8); + va->lutdata[i + 512] = drm_color_lut_extract(lut[i].blue, 8); + } + mwv207_va_lut_enable(va); + } + } +} + + +static void mwv207_va_reset(struct drm_crtc *crtc) +{ + struct mwv207_va *va = crtc_to_va(crtc); + + + mwv207_cursor_switch(va, 0); + + + mwv207_va_lut_enable(va); + mwv207_va_misc_reset(va); + drm_atomic_helper_crtc_reset(crtc); +} + +static const struct drm_crtc_funcs mwv207_crtc_funcs = { + .reset = mwv207_va_reset, + .destroy = drm_crtc_cleanup, + .set_config = drm_atomic_helper_set_config, + .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state, + .gamma_set = drm_atomic_helper_legacy_gamma_set, + .page_flip = drm_atomic_helper_page_flip, + .enable_vblank = mwv207_crtc_enable_vblank, + .disable_vblank = mwv207_crtc_disable_vblank, +}; + +static const struct drm_crtc_helper_funcs mwv207_crtc_helper_funcs = { + .atomic_check = mwv207_crtc_atomic_check, + .atomic_flush = mwv207_crtc_atomic_flush, + .atomic_enable = mwv207_crtc_atomic_enable, + .atomic_disable = mwv207_crtc_atomic_disable, +}; + +void mwv207_crtc_prepare_vblank(struct drm_crtc *crtc) +{ + struct drm_pending_vblank_event *event = crtc->state->event; + struct mwv207_va *va = crtc_to_va(crtc); + unsigned long flags; + + if (event) { + if (crtc->state->active) { + WARN_ON(drm_crtc_vblank_get(crtc) != 0); + spin_lock_irqsave(&crtc->dev->event_lock, flags); + va->event = event; + spin_unlock_irqrestore(&crtc->dev->event_lock, flags); + } else { + spin_lock_irqsave(&crtc->dev->event_lock, flags); + drm_crtc_send_vblank_event(crtc, crtc->state->event); + spin_unlock_irqrestore(&crtc->dev->event_lock, flags); + } + crtc->state->event = NULL; + } +} + +void mwv207_crtc_finish_vblank(struct drm_crtc *crtc) +{ + struct mwv207_va *va = crtc_to_va(crtc); + int put_vblank = false; + unsigned long flags; + + spin_lock_irqsave(&crtc->dev->event_lock, flags); + if (va->event) { + drm_crtc_send_vblank_event(crtc, va->event); + va->event = NULL; + put_vblank = true; + } + spin_unlock_irqrestore(&crtc->dev->event_lock, flags); + + if (put_vblank) + drm_crtc_vblank_put(crtc); +} + +irqreturn_t mwv207_va_handle_vblank(int irq, void *data) +{ + struct mwv207_device *jdev = data; + struct drm_crtc *crtc; + u32 fired; + + + fired = jdev_read(jdev, (0x9907f4)); + if (!fired) + return IRQ_NONE; + jdev_write(jdev, (0x9907f4), fired); + + fired = (fired >> 12) & 0xf; + drm_for_each_crtc(crtc, &jdev->base) { + if (fired & (1 << drm_crtc_index(crtc))) { + drm_crtc_handle_vblank(crtc); + mwv207_crtc_finish_vblank(crtc); + } + } + + return IRQ_HANDLED; +} + +static int mwv207_va_init_single(struct mwv207_device *jdev, int idx) +{ + struct mwv207_va *va; + uint16_t *lut; + int ret, i; + + va = devm_kzalloc(jdev->dev, sizeof(*va), GFP_KERNEL); + if (!va) + return -ENOMEM; + + va->mmio = jdev->mmio + (0x990000 + 0x100 * (idx) + ((idx) > 1 ? 0x600 : 0)); + va->jdev = jdev; + va->idx = idx; + + ret = drm_universal_plane_init(&jdev->base, &va->primary, 1 << idx, + &mwv207_plane_funcs, + rgb_formats, ARRAY_SIZE(rgb_formats), + format_modifiers, DRM_PLANE_TYPE_PRIMARY, "primary_plane_%d", idx); + if (ret) + return ret; + ret = drm_universal_plane_init(&jdev->base, &va->cursor, 1 << idx, + &mwv207_plane_funcs, + cursor_formats, ARRAY_SIZE(cursor_formats), + format_modifiers, DRM_PLANE_TYPE_CURSOR, "cursor_%d", idx); + if (ret) + return ret; + + drm_plane_helper_add(&va->primary, &mwv207_primary_helper_funcs); + drm_plane_helper_add(&va->cursor, &mwv207_cursor_helper_funcs); + + ret = drm_crtc_init_with_planes(&jdev->base, &va->crtc, + &va->primary, &va->cursor, &mwv207_crtc_funcs, "crtc_%d", + idx); + if (ret) + return ret; + + drm_crtc_helper_add(&va->crtc, &mwv207_crtc_helper_funcs); + + lut = &va->lutdata[0]; + for (i = 0; i < 256; i++) + lut[i] = lut[i + 256] = lut[i + 512] = i; + drm_crtc_enable_color_mgmt(&va->crtc, 768, true, 768); + ret = drm_mode_crtc_set_gamma_size(&va->crtc, 256); + + + BUG_ON(drm_crtc_index(&va->crtc) != va->idx); + + return ret; +} + +int mwv207_va_init(struct mwv207_device *jdev) +{ + int i, nr, ret; + + nr = jdev->lite ? 2 : 4; + for (i = 0; i < nr; i++) { + ret = mwv207_va_init_single(jdev, i); + if (ret) + return ret; + } + + return 0; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_va.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_va.h new file mode 100644 index 0000000000000000000000000000000000000000..ffc3540f7a35ffaa020384b922b912a5f864c7c8 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_va.h @@ -0,0 +1,29 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#ifndef MWV207_VA_H_BSY8LF4F +#define MWV207_VA_H_BSY8LF4F + +struct drm_crtc; +/* Note: any resources allocated should be: + * 1. devres managed or + * 2. cleaned up by drm_mode_config_cleanup + */ +int mwv207_va_init(struct mwv207_device *jdev); + +void mwv207_crtc_prepare_vblank(struct drm_crtc *crtc); +irqreturn_t mwv207_va_handle_vblank(int irq, void *data); +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_vga.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_vga.c new file mode 100644 index 0000000000000000000000000000000000000000..3dc5bc664d312138556ea5f9963198881726072b --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_vga.c @@ -0,0 +1,284 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_vi.h" + + +#define output_to_vga(output) container_of(output, struct mwv207_vga, base) + +static uint mwv207_vga_load_detect = 1; +module_param(mwv207_vga_load_detect, uint, 0444); +MODULE_PARM_DESC(mwv207_vga_load_detect, "Enable vga load detect if set to 1, default is 1"); + +struct mwv207_vga { + struct mwv207_output base; + spinlock_t load_detect_lock; + bool active; +}; + +static void mwv207_vga_set_detect_mode(struct mwv207_output *output, bool active) +{ + u32 val, status, load_mode; + int i; + + mwv207_output_write(output, 0xA4, 0); + + val = 0x3ff * 7 / 10; + status = mwv207_output_read(output, 0xA8); + mwv207_output_write(output, 0xA8, status); + + status = val << 20 | val << 10 | val; + mwv207_output_write(output, 0xAC, status); + + load_mode = active ? 1 : 0; + status = load_mode << 20 | load_mode << 16 | load_mode << 12 | 0x1 << 8 | 0x1 << 4 | 0x1; + mwv207_output_write(output, 0xAC, status); + + for (i = 0; i < 3; i++) { + if (active) { + mwv207_output_write(output, (0x64 + (i) * 0x14), 256); + mwv207_output_write(output, (0x68 + (i) * 0x14), 48); + mwv207_output_write(output, (0x70 + (i) * 0x14), 188); + mwv207_output_write(output, (0x74 + (i) * 0x14), 164); + } else { + mwv207_output_write(output, (0x68 + (i) * 0x14), 1600000); + mwv207_output_write(output, (0x6C + (i) * 0x14), 798400000); + mwv207_output_write(output, (0x70 + (i) * 0x14), 1600128); + mwv207_output_write(output, (0x74 + (i) * 0x14), 8128); + } + } + + mwv207_output_write(output, 0xA4, 0x111111); +} + +static void mwv207_vga_switch(struct mwv207_output *output, bool on) +{ + struct mwv207_vga *vga = output_to_vga(output); + + if (!output->jdev->lite || !mwv207_vga_load_detect) { + mwv207_output_modify(output, 0x0, 1 << 31, (on ? 1 : 0) << 31); + return; + } + + spin_lock(&vga->load_detect_lock); + mwv207_output_modify(output, 0x0, 1 << 31, (on ? 1 : 0) << 31); + mwv207_vga_set_detect_mode(output, on); + vga->active = on; + spin_unlock(&vga->load_detect_lock); +} + +static void mwv207_vga_config(struct mwv207_output *output) +{ + struct drm_display_mode *mode = &output->cur_crtc->state->adjusted_mode; + int hpol, vpol; + + hpol = (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : 1; + vpol = (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : 1; + + mwv207_output_write(output, 0x4C, 0); + mwv207_output_modify(output, 0x0, 0x7 << 16, 0x7 << 16); + mwv207_output_modify(output, 0x0, 0x1 << 2, hpol << 2); + mwv207_output_modify(output, 0x0, 0x1 << 3, vpol << 3); + + mwv207_output_write(output, 0x4, 0x1666); + mwv207_output_write(output, 0x18, 0x1666); + mwv207_output_write(output, 0x2C, 0x1666); +} + +static void mwv207_vga_select_crtc(struct mwv207_output *output) +{ + + mwv207_output_modify(output, 0x0, 0x3 << 24, + drm_crtc_index(output->cur_crtc) << 24); + + jdev_modify(output->jdev, 0x9b0038, 0xf << 16, + drm_crtc_index(output->cur_crtc) << 16); +} +static enum drm_mode_status mwv207_vga_mode_valid(struct mwv207_output *output, + const struct drm_display_mode *mode) +{ + + if (mode->clock > 193250) + return MODE_CLOCK_HIGH; + + return MODE_OK; +} + +static enum drm_mode_status mwv207_vga_connector_mode_valid(struct drm_connector *connector, + struct drm_display_mode *mode) +{ + return mwv207_vga_mode_valid(connector_to_output(connector), mode); +} + +static int mwv207_vga_detect_load(struct mwv207_output *output) +{ + struct mwv207_vga *vga = output_to_vga(output); + u32 r_state, g_state, b_state, value; + bool active; + + + if (mwv207_i2c_probe(output->ddc)) + return connector_status_connected; + + spin_lock(&vga->load_detect_lock); + value = mwv207_output_read(output, 0xA8); + active = vga->active; + spin_unlock(&vga->load_detect_lock); + + r_state = (value >> 8) & 0x1; + g_state = (value >> 4) & 0x1; + b_state = (value >> 0) & 0x1; + DRM_DEBUG_DRIVER("active %d r_state = 0x%x, g_state = 0x%x, b_state = 0x%x", + active, r_state, g_state, b_state); + + if (active) + return (r_state && g_state && b_state) ? + connector_status_disconnected : connector_status_connected; + + return (r_state || g_state || b_state) ? + connector_status_connected : connector_status_disconnected; +} + +static int mwv207_vga_detect_ctx(struct drm_connector *connector, + struct drm_modeset_acquire_ctx *ctx, + bool force) +{ + struct mwv207_output *output = connector_to_output(connector); + + if (!output->jdev->lite || !mwv207_vga_load_detect) + return mwv207_i2c_probe(output->ddc) ? + connector_status_connected : connector_status_disconnected; + + + return mwv207_vga_detect_load(output); +} + +static void mwv207_vga_destroy(struct drm_connector *conn) +{ + drm_connector_unregister(conn); + drm_connector_cleanup(conn); +} + +static const struct drm_connector_helper_funcs mwv207_vga_connector_helper_funcs = { + .get_modes = mwv207_output_get_modes, + .mode_valid = mwv207_vga_connector_mode_valid, + .detect_ctx = mwv207_vga_detect_ctx +}; + +static const struct drm_connector_funcs mwv207_vga_connector_funcs = { + .reset = drm_atomic_helper_connector_reset, + .fill_modes = drm_helper_probe_single_connector_modes, + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, + .destroy = mwv207_vga_destroy, + .late_register = mwv207_output_late_register, + .early_unregister = mwv207_output_early_unregister, +}; + +static enum drm_mode_status mwv207_vga_encoder_mode_valid(struct drm_encoder *encoder, + const struct drm_display_mode *mode) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + return mwv207_vga_mode_valid(output, mode); +} + +static int mwv207_vga_encoder_atomic_check(struct drm_encoder *encoder, + struct drm_crtc_state *crtc_state, + struct drm_connector_state *conn_state) +{ + return 0; +} + +static void mwv207_vga_encoder_enable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_vga_select_crtc(output); + + mwv207_vga_config(output); + + mwv207_vga_switch(output, true); +} + +static void mwv207_vga_encoder_disable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_vga_switch(output, false); +} + +static void mwv207_vga_encoder_reset(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + if (output->jdev->lite && !mwv207_vga_load_detect) { + mwv207_output_write(output, 0xA4, 0); + mwv207_output_modify(output, 0x58, 0x1 << 16, 0); + } + + mwv207_vga_encoder_disable(encoder); +} + +static const struct drm_encoder_funcs mwv207_vga_encoder_funcs = { + .destroy = drm_encoder_cleanup, + .reset = mwv207_vga_encoder_reset, +}; + +static const struct drm_encoder_helper_funcs mwv207_vga_encoder_helper_funcs = { + .mode_valid = mwv207_vga_encoder_mode_valid, + .atomic_check = mwv207_vga_encoder_atomic_check, + .enable = mwv207_vga_encoder_enable, + .disable = mwv207_vga_encoder_disable, +}; + +int mwv207_vga_init(struct mwv207_device *jdev) +{ + struct mwv207_output *output; + struct mwv207_vga *vga; + int ret; + + vga = devm_kzalloc(jdev->dev, sizeof(*vga), GFP_KERNEL); + if (!vga) + return -ENOMEM; + + spin_lock_init(&vga->load_detect_lock); + output = &vga->base; + output->jdev = jdev; + output->idx = 0; + output->mmio = jdev->mmio + 0x9a0000; + output->i2c_chan = 4; + + output->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; + ret = drm_connector_init(&jdev->base, &output->connector, + &mwv207_vga_connector_funcs, DRM_MODE_CONNECTOR_VGA); + if (ret) + return ret; + drm_connector_helper_add(&output->connector, &mwv207_vga_connector_helper_funcs); + + output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; + ret = drm_encoder_init(&jdev->base, &output->encoder, + &mwv207_vga_encoder_funcs, DRM_MODE_ENCODER_DAC, + "vga-%d", output->idx); + if (ret) + return ret; + drm_encoder_helper_add(&output->encoder, &mwv207_vga_encoder_helper_funcs); + + ret = drm_connector_attach_encoder(&output->connector, &output->encoder); + if (ret) + return ret; + + return drm_connector_register(&output->connector); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_vi.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_vi.c new file mode 100644 index 0000000000000000000000000000000000000000..92346d85eaa62c0114c234f38b3dc7d1aae7ef77 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_vi.c @@ -0,0 +1,89 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_vi.h" + +/* userspace interfaces should be registered here, e.g i2c/backlight etc */ +int mwv207_output_late_register(struct drm_connector *connector) +{ + struct mwv207_output *output = connector_to_output(connector); + + output->ddc = mwv207_i2c_create(output->jdev, output->i2c_chan); + if (!output->ddc) { + DRM_ERROR("Failed to create i2c adapter\n"); + return -ENODEV; + } + + return 0; +} + +void mwv207_output_early_unregister(struct drm_connector *connector) +{ + struct mwv207_output *output = connector_to_output(connector); + + mwv207_i2c_destroy(output->ddc); +} + + +int mwv207_output_get_modes(struct drm_connector *connector) +{ + struct mwv207_output *output = connector_to_output(connector); + struct edid *edid; + int count; + + if (output->edidforce && output->edid) + edid = output->edid; + else + edid = drm_get_edid(connector, output->ddc); + + + output->has_audio = drm_detect_monitor_audio(edid); + drm_connector_update_edid_property(connector, edid); + count = drm_add_edid_modes(connector, edid); + + if (!(output->edidforce && output->edid)) + kfree(edid); + + return count; +} + +void mwv207_output_set_crtc(struct drm_encoder *encoder, struct drm_crtc *crtc) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + output->cur_crtc = crtc; +} + +int mwv207_vi_init(struct mwv207_device *jdev) +{ + int ret; + + mutex_init(&jdev->gpio_lock); + + ret = mwv207_edp_init(jdev); + if (ret) + return ret; + ret = mwv207_hdmi_init(jdev); + if (ret) + return ret; + ret = mwv207_vga_init(jdev); + if (ret) + return ret; + ret = mwv207_dvo_init(jdev); + if (ret) + return ret; + + return 0; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_vi.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_vi.h new file mode 100644 index 0000000000000000000000000000000000000000..95f78ded017f05e4a3d960d17ebb5ee1e8fa0de8 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/dc/mwv207_vi.h @@ -0,0 +1,101 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207.h" +#include +#include +#include +#include +#include + +#ifndef MWV207_DAL_H_OUVHEJAX +#define MWV207_DAL_H_OUVHEJAX + + + +struct i2c_adapter; + + +struct mwv207_output { + struct drm_connector connector; + struct drm_encoder encoder; + + + struct drm_crtc *cur_crtc; + + /* mapped to video interface global control regs + * which are shared among all outputs + */ + void __iomem *mmio; + struct mwv207_device *jdev; + + struct i2c_adapter *ddc; + struct edid *edid; + bool edidforce; + int i2c_chan; + + /* local index, e.g. hdmi0/1/2/3, edp0/1 */ + int idx; + + bool has_audio; +}; +#define connector_to_output(conn) container_of(conn, struct mwv207_output, connector) +#define encoder_to_output(encoder) container_of(encoder, struct mwv207_output, encoder) + +/* Note: any resources allocated by following funcs should be: + * 1. devres managed or + * 2. cleaned up by drm_mode_config_cleanup + */ +int mwv207_vi_init(struct mwv207_device *jdev); +int mwv207_edp_init(struct mwv207_device *jdev); +int mwv207_hdmi_init(struct mwv207_device *jdev); +int mwv207_vga_init(struct mwv207_device *jdev); +int mwv207_dvo_init(struct mwv207_device *jdev); + +struct i2c_adapter *mwv207_i2c_create(struct mwv207_device *jdev, int i2c_chan); +void mwv207_i2c_destroy(struct i2c_adapter *adapter); +bool mwv207_i2c_probe(struct i2c_adapter *i2c_bus); + +int mwv207_output_late_register(struct drm_connector *connector); +void mwv207_output_early_unregister(struct drm_connector *connector); + + +int mwv207_output_get_modes(struct drm_connector *connector); +void mwv207_output_set_crtc(struct drm_encoder *encoder, struct drm_crtc *crtc); + +static inline u32 mwv207_output_read(struct mwv207_output *output, u32 reg) +{ + BUG_ON(reg >= 0x8000); + return readl(output->mmio + reg); +} + +static inline void mwv207_output_write(struct mwv207_output *output, u32 reg, u32 value) +{ + BUG_ON(reg >= 0x8000); + writel_relaxed(value, output->mmio + reg); +} + +static inline void mwv207_output_modify(struct mwv207_output *output, u32 reg, + u32 mask, u32 value) +{ + u32 rvalue; + + BUG_ON(reg >= 0x8000); + rvalue = mwv207_output_read(output, reg); + rvalue = (rvalue & ~mask) | (value & mask); + mwv207_output_write(output, reg, rvalue); +} + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207.h new file mode 100644 index 0000000000000000000000000000000000000000..84419cc4977d7365cf47d01de9a7dad7b278e3e4 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207.h @@ -0,0 +1,127 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_H_VTIQLF2Y +#define MWV207_H_VTIQLF2Y + +#include +#include +#include +#include +#include + +struct mwv207_db; + +struct mwv207_vbios { + + struct mutex vcmd_lock; + + + struct mutex cfg_lock; + struct idr cfg_table; + + int indexer_valid; + int sector_count; +}; + +#define ddev_to_jdev(ddev) ((struct mwv207_device *) (ddev)->dev_private) +#define bdev_to_jdev(dev) container_of(dev, struct mwv207_device, bdev) +struct mwv207_device { + struct drm_device base; + struct ttm_bo_device bdev; + + void __iomem *mmio; + void __iomem *iatu; + + void *win; + + + spinlock_t win_lock; + u64 visible_vram_size; + u64 vram_size; + u64 vram_bar_base; + u64 vram_last_win; + u64 pci_win_base; + + struct device *dev; + struct drm_fb_helper *fb_helper; + + struct drm_gpu_scheduler *sched[6]; + + struct drm_gpu_scheduler **sched_3d; + struct drm_gpu_scheduler **sched_dec; + struct drm_gpu_scheduler **sched_enc; + struct drm_gpu_scheduler **sched_2d; + struct drm_gpu_scheduler **sched_dma; + int nr_3d; + int nr_2d; + int nr_dec; + int nr_enc; + int nr_dma; + + + struct drm_sched_entity *dma_entity; + + + spinlock_t irq_lock; + struct irq_domain *irq_domain; + u32 irq_enable_reg[2]; + int va_irq; + + /* key/value database */ + struct mwv207_db *db; + + struct mwv207_vbios vbios; + + struct mutex gpio_lock; + + bool lite; +}; + +struct mwv207_ctx_mgr { + struct mutex lock; + struct idr handle_table; +}; + +struct mwv207_fpriv { + struct mwv207_ctx_mgr ctx_mgr; +}; + +int mwv207_test(struct mwv207_device *jdev); +void jdev_write_vram(struct mwv207_device *jdev, u64 vram_addr, void *buf, int size); + +static inline void jdev_write(struct mwv207_device *jdev, u32 reg, u32 value) +{ + BUG_ON(reg <= 0x100000); + writel_relaxed(value, jdev->mmio + reg); +} + +static inline u32 jdev_read(struct mwv207_device *jdev, u32 reg) +{ + return readl(jdev->mmio + reg); +} + +static inline void jdev_modify(struct mwv207_device *jdev, u32 reg, u32 mask, u32 value) +{ + u32 rvalue = jdev_read(jdev, reg); + + rvalue = (rvalue & ~mask) | (value & mask); + jdev_write(jdev, reg, rvalue); + BUG_ON(reg <= 0x100000); +} + +#define to_fpriv(drm_file) ((drm_file)->driver_priv) + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_bo.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_bo.c new file mode 100644 index 0000000000000000000000000000000000000000..ef63abedc3e47e4eb08b23fb388cf309b4e90aa0 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_bo.c @@ -0,0 +1,299 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include "mwv207_drm.h" +#include "mwv207_bo.h" + +static void mwv207_ttm_bo_destroy(struct ttm_buffer_object *bo) +{ + struct mwv207_bo *jbo = to_jbo(bo); + + WARN_ON_ONCE(jbo->map_count > 0); + if (bo->base.import_attach) + drm_prime_gem_destroy(&bo->base, NULL); + drm_gem_object_release(&jbo->tbo.base); + kfree(jbo); +} + +bool mwv207_ttm_bo_is_mwv207_bo(struct ttm_buffer_object *jbo) +{ + if (jbo->destroy == &mwv207_ttm_bo_destroy) + return true; + return false; +} + +void mwv207_bo_placement_from_domain(struct mwv207_bo *jbo, u32 domain, bool pinned) +{ + struct mwv207_device *jdev = bdev_to_jdev(jbo->tbo.bdev); + u32 c = 0; + u32 pflag = 0; + + if (pinned) + pflag |= TTM_PL_FLAG_NO_EVICT; + + jbo->placement.placement = jbo->placements; + jbo->placement.busy_placement = jbo->placements; + + if (domain & 0x2) { + jbo->placements[c].fpfn = 0; + + if (jbo->flags & (1<<2)) + jbo->placements[c].lpfn = 0x100000000ul >> PAGE_SHIFT; + else + jbo->placements[c].lpfn = 0; + + if (jbo->flags & (1<<0)) + jbo->placements[c].lpfn = jdev->visible_vram_size >> PAGE_SHIFT; + else + pflag |= TTM_PL_FLAG_TOPDOWN; + + jbo->placements[c].mem_type = TTM_PL_VRAM; + jbo->placements[c].flags = TTM_PL_FLAG_UNCACHED | TTM_PL_FLAG_WC | pflag; +#ifdef MWV207_DEBUG_BO_MIGRATION + if (!pinned) { + if (jbo->placements[c].lpfn == 0 + || jbo->placements[c].lpfn >= jdev->vram_size >> PAGE_SHIFT) + jbo->placements[c].lpfn = jdev->vram_size >> PAGE_SHIFT; + if (jbo->toggle & 0x1) + jbo->placements[c].fpfn = jbo->placements[c].lpfn / 2; + else + jbo->placements[c].lpfn = jbo->placements[c].lpfn / 2; + jbo->toggle ^= 0x1; + } +#endif + c++; + } + if (domain & 0x4) { + jbo->placements[c].fpfn = 0; + jbo->placements[c].lpfn = 0; + jbo->placements[c].flags = TTM_PL_MASK_CACHING | pflag; + jbo->placements[c].mem_type = TTM_PL_TT; + c++; + } + if (domain & 0x1) { + jbo->placements[c].fpfn = 0; + jbo->placements[c].lpfn = 0; + jbo->placements[c].flags = TTM_PL_MASK_CACHING | pflag; + jbo->placements[c].mem_type = TTM_PL_SYSTEM; + c++; + } + if (!c) { + jbo->placements[c].fpfn = 0; + jbo->placements[c].lpfn = 0; + jbo->placements[c].flags = TTM_PL_MASK_CACHING; + jbo->placements[c].mem_type = TTM_PL_SYSTEM; + c++; + } + + BUG_ON(c > 3); + jbo->placement.num_placement = c; + jbo->placement.num_busy_placement = c; +} + +int mwv207_bo_create(struct mwv207_device *jdev, + u64 size, u64 align, enum ttm_bo_type type, + u32 domain, u32 flags, + struct mwv207_bo **pbo) +{ + struct mwv207_bo *jbo; + unsigned long acc_size; + int ret; + + *pbo = NULL; + if ((flags & (1<<2)) && !(domain & 0x2)) + return -EINVAL; + + jbo = kzalloc(sizeof(struct mwv207_bo), GFP_KERNEL); + if (jbo == NULL) + return -ENOMEM; + size = roundup(size, PAGE_SIZE); + ret = drm_gem_object_init(&jdev->base, &jbo->tbo.base, size); + if (unlikely(ret)) { + kfree(jbo); + return ret; + } + jbo->flags = flags; + jbo->domain = domain; + jbo->pin_count = 0; + + acc_size = ttm_bo_dma_acc_size(&jdev->bdev, size, sizeof(*jbo)); + + jbo->tbo.bdev = &jdev->bdev; + mwv207_bo_placement_from_domain(jbo, domain, false); + + ret = ttm_bo_init(&jdev->bdev, &jbo->tbo, size, type, + &jbo->placement, align >> PAGE_SHIFT, + type != ttm_bo_type_kernel, acc_size, + NULL, NULL, &mwv207_ttm_bo_destroy); + + if (unlikely(ret)) + return ret; + *pbo = jbo; + return 0; +} + +int mwv207_bo_reserve(struct mwv207_bo *jbo, bool no_intr) +{ + int ret; + + ret = ttm_bo_reserve(&jbo->tbo, !no_intr, false, NULL); + if (unlikely(ret)) { + if (ret != -ERESTARTSYS) + DRM_ERROR("bo reserve failed\n"); + return ret; + } + return 0; +} + +void mwv207_bo_unreserve(struct mwv207_bo *jbo) +{ + ttm_bo_unreserve(&jbo->tbo); +} + +int mwv207_bo_kmap_reserved(struct mwv207_bo *jbo, void **ptr) +{ + bool is_iomem; + int ret; + + if (!jbo->flags & (1<<0)) + return -EPERM; + + if (jbo->kptr) { + if (ptr) + *ptr = jbo->kptr; + jbo->map_count++; + return 0; + } + ret = ttm_bo_kmap(&jbo->tbo, 0, jbo->tbo.num_pages, &jbo->kmap); + if (ret) + return ret; + jbo->kptr = ttm_kmap_obj_virtual(&jbo->kmap, &is_iomem); + if (ptr) + *ptr = jbo->kptr; + jbo->map_count = 1; + return 0; +} + +void mwv207_bo_kunmap_reserved(struct mwv207_bo *jbo) +{ + if (WARN_ON_ONCE(jbo->kptr == NULL)) + return; + jbo->map_count--; + if (jbo->map_count > 0) + return; + jbo->kptr = NULL; + ttm_bo_kunmap(&jbo->kmap); +} + +void mwv207_bo_unref(struct mwv207_bo *jbo) +{ + if (jbo == NULL) + return; + + ttm_bo_put(&jbo->tbo); +} + +struct mwv207_bo *mwv207_bo_ref(struct mwv207_bo *jbo) +{ + if (jbo == NULL) + return NULL; + + ttm_bo_get(&jbo->tbo); + return jbo; +} + +int mwv207_bo_pin_reserved(struct mwv207_bo *jbo, u32 domain) +{ + struct ttm_operation_ctx ctx = {false, false}; + int ret; + + if (jbo->pin_count) { + jbo->pin_count++; + return 0; + } + + jbo->flags |= (1<<2); + mwv207_bo_placement_from_domain(jbo, domain, true); + ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); + if (ret) + return ret; + + jbo->pin_count = 1; + + return 0; +} + +int mwv207_bo_unpin_reserved(struct mwv207_bo *jbo) +{ + struct ttm_operation_ctx ctx = {false, false}; + int ret, i; + + if (WARN_ON_ONCE(!jbo->pin_count)) + return 0; + + jbo->pin_count--; + if (jbo->pin_count) + return 0; + + for (i = 0; i < jbo->placement.num_placement; i++) + jbo->placements[i].flags &= ~TTM_PL_FLAG_NO_EVICT; + + ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); + if (unlikely(ret)) + DRM_ERROR("validate failed for unpin"); + + return ret; +} + +int mwv207_bo_pin(struct mwv207_bo *jbo, u32 domain) +{ + int ret; + + ret = mwv207_bo_reserve(jbo, true); + if (ret) + return ret; + ret = mwv207_bo_pin_reserved(jbo, domain); + mwv207_bo_unreserve(jbo); + return ret; +} + +int mwv207_bo_unpin(struct mwv207_bo *jbo) +{ + int ret; + + ret = mwv207_bo_reserve(jbo, true); + if (ret) + return ret; + ret = mwv207_bo_unpin_reserved(jbo); + mwv207_bo_unreserve(jbo); + return ret; +} + +int mwv207_bo_wait(struct mwv207_bo *jbo, bool no_wait) +{ + int ret; + + ret = ttm_bo_reserve(&jbo->tbo, true, no_wait, NULL); + if (unlikely(ret)) { + if (ret != -ERESTARTSYS && ret != -EBUSY) + DRM_ERROR("bo reserve failed for wait\n"); + return ret; + } + ret = ttm_bo_wait(&jbo->tbo, true, no_wait); + ttm_bo_unreserve(&jbo->tbo); + return ret; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_bo.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_bo.h new file mode 100644 index 0000000000000000000000000000000000000000..ab10994d19cb6c9fd7bf57a2cd249dbae14e30ff --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_bo.h @@ -0,0 +1,111 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_BO_H_T4ETFCB2 +#define MWV207_BO_H_T4ETFCB2 +#include +#include +#include +#include +#include +#include +#include +#include "mwv207.h" +#include "mwv207_drm.h" + +#undef MWV207_DEBUG_BO_MIGRATION + +#define to_jbo(bo) container_of(bo, struct mwv207_bo, tbo) +struct mwv207_bo { + struct ttm_buffer_object tbo; + struct ttm_placement placement; + struct ttm_bo_kmap_obj kmap; + struct ttm_place placements[3]; + u32 domain; + u32 flags; + int pin_count; + int map_count; + void *kptr; +#ifdef MWV207_DEBUG_BO_MIGRATION + int toggle; +#endif +}; + +struct mwv207_ttm_tt { + struct ttm_dma_tt ttm; + struct mwv207_device *jdev; +}; +#define to_gtt(ttm_tt) container_of(ttm_tt, struct mwv207_ttm_tt, ttm.ttm) + +static inline struct mwv207_bo *mwv207_bo_from_gem(struct drm_gem_object *gobj) +{ + struct ttm_buffer_object *tbo = container_of(gobj, struct ttm_buffer_object, base); + + return container_of(tbo, struct mwv207_bo, tbo); +} + +static inline struct drm_gem_object *mwv207_gem_from_bo(struct mwv207_bo *jbo) +{ + return &jbo->tbo.base; +} + +static inline u64 mwv207_bo_size(struct mwv207_bo *jbo) +{ + return jbo->tbo.num_pages << PAGE_SHIFT; +} + +static inline u64 mwv207_bo_mmap_offset(struct drm_gem_object *gobj) +{ + struct mwv207_bo *jbo = mwv207_bo_from_gem(gobj); + + return drm_vma_node_offset_addr(&jbo->tbo.base.vma_node); +} + +static inline u64 mwv207_bo_gpu_phys(struct mwv207_bo *jbo) +{ + return jbo->tbo.mem.start << PAGE_SHIFT; +} + +void mwv207_bo_placement_from_domain(struct mwv207_bo *jbo, u32 domain, bool pinned); + +bool mwv207_ttm_bo_is_mwv207_bo(struct ttm_buffer_object *tbo); +void mwv207_bo_placement(struct mwv207_bo *jbo, int domain); + +int mwv207_bo_create(struct mwv207_device *jdev, + u64 size, u64 align, enum ttm_bo_type type, + u32 domain, u32 flags, + struct mwv207_bo **pbo); + +int mwv207_bo_reserve(struct mwv207_bo *jbo, bool no_intr); +void mwv207_bo_unreserve(struct mwv207_bo *jbo); + +int mwv207_bo_pin_reserved(struct mwv207_bo *jbo, u32 domain); +int mwv207_bo_unpin_reserved(struct mwv207_bo *jbo); + +int mwv207_bo_pin(struct mwv207_bo *jbo, u32 domain); +int mwv207_bo_unpin(struct mwv207_bo *jbo); + +int mwv207_bo_kmap_reserved(struct mwv207_bo *jbo, void **ptr); +void mwv207_bo_kunmap_reserved(struct mwv207_bo *jbo); + +struct mwv207_bo *mwv207_bo_ref(struct mwv207_bo *jbo); +void mwv207_bo_unref(struct mwv207_bo *jbo); + +int mwv207_ttm_init(struct mwv207_device *jdev); +void mwv207_ttm_fini(struct mwv207_device *jdev); + +int mwv207_bo_wait(struct mwv207_bo *jbo, bool no_wait); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ctx.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ctx.c new file mode 100644 index 0000000000000000000000000000000000000000..595d6a943b4712a022d247f001ff957dd1043de7 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ctx.c @@ -0,0 +1,242 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include "mwv207.h" +#include "mwv207_drm.h" +#include "mwv207_ctx.h" + +#define MAX(a, b) ((a) > (b) ? (a) : (b)) +struct mwv207_ctx *mwv207_ctx_lookup(struct drm_device *dev, + struct drm_file *filp, u32 handle) +{ + struct mwv207_fpriv *fpriv = to_fpriv(filp); + struct mwv207_ctx_mgr *mgr = &fpriv->ctx_mgr; + struct mwv207_ctx *ctx; + + mutex_lock(&mgr->lock); + ctx = idr_find(&mgr->handle_table, handle); + if (ctx) + kref_get(&ctx->refcnt); + mutex_unlock(&mgr->lock); + + return ctx; +} + +static void mwv207_ctx_entity_fini(struct mwv207_ctx *ctx) +{ + int i; + + for (i = 0; i < 11; i++) { + if (ctx->entities[i]) { + drm_sched_entity_destroy(ctx->entities[i]); + kfree(ctx->entities[i]); + ctx->entities[i] = NULL; + } + } +} + + +static int mwv207_ctx_entity_init_single(struct mwv207_ctx *ctx, + struct drm_gpu_scheduler **sched, + struct drm_sched_entity **entities, int nr) +{ + struct drm_gpu_scheduler *scheds[6]; + struct drm_sched_entity *entity; + int i, ret; + + + for (i = 0; i < nr; i++) { + scheds[i] = sched[i]; + entity = kmalloc(sizeof(struct drm_sched_entity), GFP_KERNEL); + if (!entity) + return -ENOMEM; + ret = drm_sched_entity_init(entity, DRM_SCHED_PRIORITY_NORMAL, &scheds[i], 1, &ctx->guilty); + if (ret) { + kfree(entity); + return ret; + } + entities[i] = entity; + } + if (i) { + + entity = kmalloc(sizeof(struct drm_sched_entity), GFP_KERNEL); + if (!entity) + return -ENOMEM; + ret = drm_sched_entity_init(entity, DRM_SCHED_PRIORITY_NORMAL, &scheds[0], 1, &ctx->guilty); + if (ret) { + kfree(entity); + return ret; + } + entities[i] = entity; + } + + return 0; +} + +static int mwv207_ctx_entity_init(struct drm_device *dev, struct mwv207_ctx *ctx) +{ + struct mwv207_device *jdev = ddev_to_jdev(dev); + int ret; + + + ctx->entity_3d = &ctx->entities[0]; + ctx->entity_dec = &ctx->entity_3d[2 + 1]; + ctx->entity_enc = &ctx->entity_dec[1 + 1]; + ctx->entity_2d = &ctx->entity_enc[1 + 1]; + ctx->entity_dma = &ctx->entity_2d[1 + 1]; + BUG_ON(ctx->entity_dma[1] != ctx->entities[11 - 1]); + + ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_3d, ctx->entity_3d, jdev->nr_3d); + if (ret) + goto fini; + ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_dec, ctx->entity_dec, jdev->nr_dec); + if (ret) + goto fini; + ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_enc, ctx->entity_enc, jdev->nr_enc); + if (ret) + goto fini; + ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_2d, ctx->entity_2d, jdev->nr_2d); + if (ret) + goto fini; + ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_dma, ctx->entity_dma, jdev->nr_dma); + if (ret) + goto fini; + return 0; +fini: + mwv207_ctx_entity_fini(ctx); + return ret; +} + +static int mwv207_ctx_create(struct drm_device *dev, struct mwv207_ctx_mgr *mgr, + u32 flags, u32 *handle) +{ + struct mwv207_ctx *ctx; + int ret; + + ctx = kzalloc(sizeof(struct mwv207_ctx), GFP_KERNEL); + if (ctx == NULL) + return -ENOMEM; + + ctx->jdev = ddev_to_jdev(dev); + kref_init(&ctx->refcnt); + + ret = mwv207_ctx_entity_init(dev, ctx); + if (ret) + goto out_free; + + mutex_lock(&mgr->lock); + ret = idr_alloc(&mgr->handle_table, ctx, 1, 0, GFP_KERNEL); + mutex_unlock(&mgr->lock); + + if (ret < 0) + goto out_fini_entites; + + *handle = ret; + return 0; +out_fini_entites: + mwv207_ctx_entity_fini(ctx); +out_free: + kfree(ctx); + return ret; +} + +static void mwv207_ctx_release(struct kref *kref) +{ + struct mwv207_ctx *ctx = container_of(kref, struct mwv207_ctx, refcnt); + + mwv207_ctx_entity_fini(ctx); + kfree(ctx); +} + +int mwv207_ctx_put(struct mwv207_ctx *ctx) +{ + return kref_put(&ctx->refcnt, mwv207_ctx_release); +} + +static int mwv207_ctx_destroy(struct drm_device *dev, struct mwv207_ctx_mgr *mgr, u32 handle) +{ + struct mwv207_ctx *ctx; + + mutex_lock(&mgr->lock); + ctx = idr_remove(&mgr->handle_table, handle); + mutex_unlock(&mgr->lock); + + if (ctx == NULL) + return -EINVAL; + + mwv207_ctx_put(ctx); + return 0; +} + +int mwv207_ctx_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + struct drm_mwv207_ctx *args = (struct drm_mwv207_ctx *)data; + struct mwv207_fpriv *fpriv = to_fpriv(filp); + + if (args->resv || args->flags) + return -EINVAL; + + switch (args->op) { + case 0: + return mwv207_ctx_create(dev, &fpriv->ctx_mgr, args->flags, &args->handle); + case 1: + return mwv207_ctx_destroy(dev, &fpriv->ctx_mgr, args->handle); + default: + return -EINVAL; + } +} + +int mwv207_ctx_mgr_init(struct drm_device *dev, struct mwv207_ctx_mgr *mgr) +{ + mutex_init(&mgr->lock); + idr_init(&mgr->handle_table); + return 0; +} + +void mwv207_ctx_mgr_fini(struct drm_device *dev, struct mwv207_ctx_mgr *mgr) +{ + struct mwv207_ctx *ctx; + uint32_t id; + + idr_for_each_entry(&mgr->handle_table, ctx, id) + mwv207_ctx_put(ctx); + + idr_destroy(&mgr->handle_table); + mutex_destroy(&mgr->lock); +} + +int mwv207_kctx_init(struct mwv207_device *jdev) +{ + struct drm_gpu_scheduler *scheds[1]; + int i; + + for (i = 0; i < 1; i++) + scheds[i] = jdev->sched_dma[i]; + + jdev->dma_entity = devm_kzalloc(jdev->dev, sizeof(struct drm_sched_entity), GFP_KERNEL); + if (!jdev->dma_entity) + return -ENOMEM; + + return drm_sched_entity_init(jdev->dma_entity, DRM_SCHED_PRIORITY_NORMAL, &scheds[0], i, NULL); +} + +void mwv207_kctx_fini(struct mwv207_device *jdev) +{ + drm_sched_entity_destroy(jdev->dma_entity); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ctx.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ctx.h new file mode 100644 index 0000000000000000000000000000000000000000..67c02d439ba3c07bf11616224c6f641bb002ca58 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ctx.h @@ -0,0 +1,51 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_CTX_H_QFMRESBO +#define MWV207_CTX_H_QFMRESBO +#include +#include +#include "mwv207.h" + +struct mwv207_ctx { + struct kref refcnt; + + struct drm_sched_entity *entities[11]; + + + struct drm_sched_entity **entity_3d; + struct drm_sched_entity **entity_dec; + struct drm_sched_entity **entity_enc; + struct drm_sched_entity **entity_2d; + struct drm_sched_entity **entity_dma; + + struct mwv207_device *jdev; + atomic_t guilty; +}; + +struct mwv207_ctx *mwv207_ctx_lookup(struct drm_device *dev, + struct drm_file *filp, u32 handle); +int mwv207_ctx_put(struct mwv207_ctx *ctx); + +int mwv207_ctx_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +int mwv207_ctx_mgr_init(struct drm_device *dev, struct mwv207_ctx_mgr *mgr); +void mwv207_ctx_mgr_fini(struct drm_device *dev, struct mwv207_ctx_mgr *mgr); + +int mwv207_kctx_init(struct mwv207_device *jdev); +void mwv207_kctx_fini(struct mwv207_device *jdev); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_db.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_db.c new file mode 100644 index 0000000000000000000000000000000000000000..ce906afeb44add720953098f03c835b911fb0832 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_db.c @@ -0,0 +1,138 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include "mwv207_db.h" +#include "mwv207.h" +#include "mwv207_drm.h" + +struct mwv207_db { + u32 nr; + u32 max_nr; + u32 sorted; + u32 pad; + struct drm_mwv207_info_rec *db; +}; + +int mwv207_db_init(struct mwv207_device *jdev) +{ + struct mwv207_db *db; + u32 size; + + size = sizeof(struct mwv207_db); + size += 2048 * sizeof(struct drm_mwv207_info_rec); + db = devm_kmalloc(jdev->dev, size, GFP_KERNEL); + if (!db) + return -ENOMEM; + + db->db = (struct drm_mwv207_info_rec *)(db + 1); + db->max_nr = 2048; + db->nr = 0; + db->sorted = 0; + jdev->db = db; + return 0; +} + +void mwv207_db_fini(struct mwv207_device *jdev) +{ + devm_kfree(jdev->dev, jdev->db); +} + +int mwv207_db_add(struct mwv207_device *jdev, u32 key, u32 val) +{ + struct mwv207_db *db = jdev->db; + + if (db->nr >= db->max_nr) { + WARN_ONCE(1, "mwv207: maximum key count reached"); + return -ENOMEM; + } + + db->db[db->nr].key = key; + db->db[db->nr].val = val; + db->nr++; + + + if (db->sorted) + mwv207_db_sort(jdev); + + return 0; +} + +static int cmp_key(const void *a, const void *b) +{ + struct drm_mwv207_info_rec const *rec_a = a, *rec_b = b; + + if (rec_a->key < rec_b->key) + return -1; + else if (rec_a->key > rec_b->key) + return 1; + else + return 0; +} + +void mwv207_db_sort(struct mwv207_device *jdev) +{ + struct mwv207_db *db = jdev->db; + int i; + + db->sorted = 1; + if (db->nr < 2) + return; + + sort(db->db, db->nr, 8, cmp_key, NULL); + + + for (i = 0; i < db->nr - 1; ++i) { + if (db->db[i].key == db->db[i + 1].key) { + WARN_ONCE(1, "mwv207 key: %d is duplicated", db->db[i].key); + break; + } + } +} + +int mwv207_db_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + struct mwv207_device *jdev = dev->dev_private; + struct drm_mwv207_info_rec rec, *result; + struct drm_mwv207_info *args = data; + struct mwv207_db *db = jdev->db; + + switch (args->op) { + case 1: + rec.key = args->nr_recs; + result = bsearch(&rec, db->db, db->nr, 8, cmp_key); + if (!result) { + args->recs = 0; + return -ENOENT; + } + args->recs = result->val; + + break; + case 0: + if (args->recs) + return copy_to_user((void __user *)args->recs, db->db, + db->nr * sizeof(struct drm_mwv207_info_rec)); + args->nr_recs = db->nr; + + break; + default: + return -EINVAL; + } + + return 0; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_db.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_db.h new file mode 100644 index 0000000000000000000000000000000000000000..fd5c685d4ca33e3c60cf7bf398e5c3ed74ced7b1 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_db.h @@ -0,0 +1,32 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include "mwv207_drm.h" +#ifndef MWV207_DB_H_AGPY6ZIQ +#define MWV207_DB_H_AGPY6ZIQ + +struct mwv207_device; + +int mwv207_db_init(struct mwv207_device *jdev); +void mwv207_db_fini(struct mwv207_device *jdev); +void mwv207_db_sort(struct mwv207_device *jdev); + +int mwv207_db_add(struct mwv207_device *jdev, u32 key, u32 val); + +int mwv207_db_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_devfreq.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_devfreq.c new file mode 100644 index 0000000000000000000000000000000000000000..cf800eb6b3623912242b87251e728999ccce58ea --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_devfreq.c @@ -0,0 +1,277 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and * confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include "mwv207_devfreq.h" +#include "mwv207_vbios.h" +#include "mwv207_sched.h" + + +static void mwv207_devfreq_update_utilization(struct mwv207_pipe *pipe) +{ + ktime_t now; + ktime_t last; + + now = ktime_get(); + last = pipe->time_last_update; + + dev_dbg(pipe->dev, "pipe [%s] busy_count: %d", pipe->fname, pipe->busy_count); + + if (pipe->busy_count > 0) + pipe->busy_time += ktime_sub(now, last); + else + pipe->idle_time += ktime_sub(now, last); + + pipe->time_last_update = now; +} + +static int mwv207_devfreq_get_cur_freq(struct device *dev, unsigned long *freq) +{ + struct mwv207_pipe *pipe = dev_get_drvdata(dev); + unsigned long freq_khz; + int ret; + + ret = mwv207_vbios_get_pll(pipe->jdev, pipe->pll_id, &freq_khz); + if (ret) + *freq = 0x32; + else + *freq = freq_khz / 1000; + + return 0; +} + +static int mwv207_devfreq_target(struct device *dev, unsigned long *freq, u32 flags) +{ + struct mwv207_pipe *pipe = dev_get_drvdata(dev); + struct dev_pm_opp *opp; + unsigned long target_freq; + int ret; + + opp = devfreq_recommended_opp(dev, freq, flags); + if (IS_ERR(opp)) + return PTR_ERR(opp); + + target_freq = dev_pm_opp_get_freq(opp); + dev_pm_opp_put(opp); + + dev_dbg(dev, "pipe [%s] target freq: %lu", pipe->fname, target_freq); + + ret = mwv207_vbios_set_pll(pipe->jdev, pipe->pll_id, target_freq * 1000); + if (ret) + return ret; + + return 0; +} + +static void mwv207_devfreq_pipe_reset(struct mwv207_pipe *pipe) +{ + pipe->busy_time = 0; + pipe->idle_time = 0; + pipe->time_last_update = ktime_get(); +} + +static int mwv207_devfreq_get_dev_status(struct device *dev, struct devfreq_dev_status *status) +{ + struct mwv207_pipe *pipe = dev_get_drvdata(dev); + unsigned long flags; + + mwv207_devfreq_get_cur_freq(dev, &status->current_frequency); + + spin_lock_irqsave(&pipe->devfreq_lock, flags); + + mwv207_devfreq_update_utilization(pipe); + + status->total_time = ktime_to_ns(ktime_add(pipe->busy_time, + pipe->idle_time)); + + status->busy_time = ktime_to_ns(pipe->busy_time); + + mwv207_devfreq_pipe_reset(pipe); + + spin_unlock_irqrestore(&pipe->devfreq_lock, flags); + + return 0; +} + +static struct devfreq_dev_profile mwv207_devfreq_profile = { + .polling_ms = 50, + .target = mwv207_devfreq_target, + .get_dev_status = mwv207_devfreq_get_dev_status, + .get_cur_freq = mwv207_devfreq_get_cur_freq, +}; + +static ssize_t utilization_show(struct device *dev, struct device_attribute *attr, char *buf) +{ + struct mwv207_pipe *pipe = dev_get_drvdata(dev); + unsigned long busy_time, total_time, flags; + + spin_lock_irqsave(&pipe->devfreq_lock, flags); + + mwv207_devfreq_update_utilization(pipe); + + total_time = ktime_to_ns(ktime_add(pipe->busy_time, pipe->idle_time)); + + busy_time = ktime_to_ns(pipe->busy_time); + + if (strncmp(pipe->devfreq->governor_name, DEVFREQ_GOV_SIMPLE_ONDEMAND, DEVFREQ_NAME_LEN)) + mwv207_devfreq_pipe_reset(pipe); + + spin_unlock_irqrestore(&pipe->devfreq_lock, flags); + + if (total_time == 0) + return sprintf(buf, "%d\n", 100); + else + return sprintf(buf, "%llu\n", div_u64(busy_time, total_time / 100)); +} + +static DEVICE_ATTR_RO(utilization); + +void mwv207_devfreq_unregister(struct mwv207_pipe *pipe) +{ + if (!pipe->devfreq) + return; + + device_remove_file(pipe->dev, &dev_attr_utilization); + sysfs_remove_link(&pipe->dev->kobj, "stats"); + dev_pm_opp_remove_all_dynamic(pipe->dev); + device_unregister(pipe->dev); +} + +static void mwv207_devfreq_dev_release(struct device *dev) +{ + kfree(dev); +} + +int mwv207_devfreq_register(struct mwv207_pipe *pipe, unsigned long max_freq) +{ + struct device *dev; + unsigned long freq; + int ret; + + dev = kzalloc(sizeof(struct device), GFP_KERNEL); + if (!dev) + return -ENOMEM; + + dev->parent = pipe->jdev->dev; + dev->release = mwv207_devfreq_dev_release; + dev_set_name(dev, "devfreq_%s", pipe->fname); + dev_set_drvdata(dev, pipe); + + ret = device_register(dev); + if (ret) { + put_device(dev); + goto err_out; + } + + pipe->dev = dev; + pipe->busy_count = 0; + spin_lock_init(&pipe->devfreq_lock); + + mwv207_devfreq_profile.initial_freq = max_freq; + + for (freq = 0x32; freq <= max_freq; freq += 50) { + ret = dev_pm_opp_add(dev, freq, 0); + if (ret) + goto remove_opps; + } + + pipe->devfreq = devm_devfreq_add_device(dev, &mwv207_devfreq_profile, + DEVFREQ_GOV_PERFORMANCE, NULL); + if (IS_ERR(pipe->devfreq)) { + ret = PTR_ERR(pipe->devfreq); + dev_dbg(dev, "Couldn't initialize devfreq: %d", ret); + goto remove_opps; + } + + mwv207_devfreq_pipe_reset(pipe); + + pipe->devfreq->suspend_freq = 0x32; + + ret = sysfs_create_link(&dev->kobj, &pipe->devfreq->dev.kobj, "stats"); + if (ret) { + dev_dbg(dev, "Couldn't create sys link for stats: %d", ret); + goto remove_opps; + } + + ret = device_create_file(dev, &dev_attr_utilization); + if (ret) { + dev_dbg(dev, "Couldn't create device file for utilization: %d", ret); + goto remove_link; + } + + return 0; + +remove_link: + sysfs_remove_link(&dev->kobj, "stats"); +remove_opps: + dev_pm_opp_remove_all_dynamic(dev); + device_unregister(dev); +err_out: + return ret; +} + +int mwv207_devfreq_resume(struct mwv207_pipe *pipe) +{ + unsigned long flags; + + if (!pipe->devfreq) + return 0; + + spin_lock_irqsave(&pipe->devfreq_lock, flags); + + mwv207_devfreq_pipe_reset(pipe); + + spin_unlock_irqrestore(&pipe->devfreq_lock, flags); + + return devfreq_resume_device(pipe->devfreq); +} + +int mwv207_devfreq_suspend(struct mwv207_pipe *pipe) +{ + if (!pipe->devfreq) + return 0; + + return devfreq_suspend_device(pipe->devfreq); +} + +void mwv207_devfreq_record_busy(struct mwv207_pipe *pipe) +{ + unsigned long flags; + + if (!pipe->devfreq) + return; + + spin_lock_irqsave(&pipe->devfreq_lock, flags); + + mwv207_devfreq_update_utilization(pipe); + pipe->busy_count++; + + spin_unlock_irqrestore(&pipe->devfreq_lock, flags); +} + +void mwv207_devfreq_record_idle(struct mwv207_pipe *pipe) +{ + unsigned long flags; + + if (!pipe->devfreq) + return; + + spin_lock_irqsave(&pipe->devfreq_lock, flags); + + mwv207_devfreq_update_utilization(pipe); + WARN_ON(--pipe->busy_count < 0); + + spin_unlock_irqrestore(&pipe->devfreq_lock, flags); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_devfreq.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_devfreq.h new file mode 100644 index 0000000000000000000000000000000000000000..5cabf1c3a39c22f6d2e00d82080b4100be2a2272 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_devfreq.h @@ -0,0 +1,31 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ + +#ifndef __MWV207_DEVFREQ_H__ +#define __MWV207_DEVFREQ_H__ + +struct mwv207_pipe; + +void mwv207_devfreq_unregister(struct mwv207_pipe *pipe); +int mwv207_devfreq_register(struct mwv207_pipe *pipe, unsigned long max_freq); + +void mwv207_devfreq_record_busy(struct mwv207_pipe *pipe); +void mwv207_devfreq_record_idle(struct mwv207_pipe *pipe); + +int mwv207_devfreq_suspend(struct mwv207_pipe *pipe); +int mwv207_devfreq_resume(struct mwv207_pipe *pipe); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_dma.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_dma.h new file mode 100644 index 0000000000000000000000000000000000000000..ff70d9a0e89ad231e277d083b254d7c661c9c0f3 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_dma.h @@ -0,0 +1,29 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_EDMA_H_EPAWCJ4N +#define MWV207_EDMA_H_EPAWCJ4N +#include "mwv207.h" + +struct mwv207_dma; +struct mwv207_dma *mwv207_dma_create(struct device *dev, + void __iomem *regbase, u8 alignment); +void mwv207_dma_destroy(struct mwv207_dma *dma); + +int mwv207_dma_to_vram(struct mwv207_dma *dma, u64 vram_addr, void *va, u64 size); +int mwv207_dma_to_ram(struct mwv207_dma *dma, void *va, u64 vram_addr, u64 size); +int mwv207_dma_vram_vram(struct mwv207_dma *dma, u64 dst_vram_addr, u64 src_vram_addr, u64 size); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_drm.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_drm.h new file mode 100644 index 0000000000000000000000000000000000000000..b6c2ff6248baff415ed7d11404dde42650533607 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_drm.h @@ -0,0 +1,160 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef __MWV207_DRM_H__ +#define __MWV207_DRM_H__ + + +#include "drm/drm.h" + +#if defined(__cplusplus) +extern "C" { +#endif + +/**********************GEM interface*************************/ + +struct drm_mwv207_gem_create_in { + __u64 size; + __u64 alignment; + __u32 preferred_domain; + __u32 flags; +}; +struct drm_mwv207_gem_create_out { + __u32 handle; + __u32 resv; +}; +union drm_mwv207_gem_create { + struct drm_mwv207_gem_create_in in; + struct drm_mwv207_gem_create_out out; +}; + +struct drm_mwv207_gem_mmap_in { + __u32 handle; + __u32 pad; +}; +struct drm_mwv207_gem_mmap_out { + __u64 offset; +}; +union drm_mwv207_gem_mmap { + struct drm_mwv207_gem_mmap_in in; + struct drm_mwv207_gem_mmap_out out; +}; + +struct drm_mwv207_gem_wait { + __u32 handle; + __u32 op; + __s64 timeout; +}; + +/**********************context interface*************************/ +struct drm_mwv207_ctx { + __u32 op; + __u32 flags; + __u32 handle; + __u32 resv; +}; + +/**********************submission interface************************* + * 1. a submission is sent to a single ctx + * 2. a submission optionally contains a relocation table and a bo table + * 3. bo table should not contain duplicates; + * 4. cmd buffer size should be limited to 16K + */ + +struct drm_mwv207_submit { + __u32 ctx; + __u32 engine_type; + __u32 engine_id; + __u32 flags; + __u32 fence_fd; /* in/out fence fd, according to MWV207_SUBMIT_FLAG_FENCE_IN/OUT */ + __u32 cmd_size; + __u32 nr_relocs; + __u32 nr_bos; + __u32 nr_cmd_dat; + __u32 padding; + __u64 cmds; + __u64 relocs; + __u64 bos; + __u64 cmd_dats; + /* syncobj support, reserved for vulkan + * __u32 nr_in_syncobjs; + * __u32 nr_out_syncobjs; + * __u64 in_syncobjs; + * __u64 out_syncobjs; + */ +}; + +/* in_syncobjs/out_syncobjs array element, reserved for vulkan */ +struct drm_mwv207_submit_syncobj { + __u32 handle; + __u32 flags; + __u64 point; +}; + +struct drm_mwv207_bo_acc { + __u32 handle; + __u32 flags; +}; + +struct drm_mwv207_submit_reloc { + __u32 idx; /* bo/cmd_dat idx in submit bos/cmd_dats */ + __u32 cmd_offset; + __u64 bo_offset; + __u32 type; + __u32 pad; +}; + + +struct drm_mwv207_submit_cmd_dat { + __u32 nr_relocs; + __u32 dat_size; + __u64 relocs; + __u64 dat; +}; + +/**************** card capability interface *****************/ +/* XXX: keys are user/kernel ABI, DO THINK TWICE when + * add keys, once added it can never be removed. + */ +enum drm_mwv207_info_key { + DRM_MWV207_ACTIVE_3D_NR = 0, + DRM_MWV207_ACTIVE_DEC_NR, + DRM_MWV207_ACTIVE_ENC_NR, + DRM_MWV207_ACTIVE_2D_NR, + DRM_MWV207_ACTIVE_DMA_NR, +}; + +struct drm_mwv207_info_rec { + __u32 key; + __u32 val; +}; + +struct drm_mwv207_info { + __u32 op; + __u32 nr_recs; + __u64 recs; +}; + +#define DRM_IOCTL_MWV207_INFO DRM_IOWR(DRM_COMMAND_BASE + 0x00, struct drm_mwv207_info) +#define DRM_IOCTL_MWV207_GEM_CREATE DRM_IOWR(DRM_COMMAND_BASE + 0x01, union drm_mwv207_gem_create) +#define DRM_IOCTL_MWV207_GEM_MMAP DRM_IOWR(DRM_COMMAND_BASE + 0x02, union drm_mwv207_gem_mmap) +#define DRM_IOCTL_MWV207_GEM_WAIT DRM_IOWR(DRM_COMMAND_BASE + 0x03, struct drm_mwv207_gem_wait) +#define DRM_IOCTL_MWV207_CTX DRM_IOWR(DRM_COMMAND_BASE + 0x04, struct drm_mwv207_ctx) +#define DRM_IOCTL_MWV207_SUBMIT DRM_IOWR(DRM_COMMAND_BASE + 0x05, struct drm_mwv207_submit) +#if defined(__cplusplus) +} +#endif + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_drv.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_drv.c new file mode 100644 index 0000000000000000000000000000000000000000..53c18aed844a8bda21d6b8443dd3ffd89dba37a7 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_drv.c @@ -0,0 +1,540 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "mwv207_drm.h" +#include "mwv207_gem.h" +#include "mwv207_bo.h" +#include "dc/mwv207_kms.h" +#include "mwv207_ctx.h" +#include "mwv207_submit.h" +#include "mwv207_sched.h" +#include "mwv207_irq.h" +#include "mwv207_db.h" +#include "mwv207_vbios.h" + +#define DRIVER_NAME "mwv207" +#define DRIVER_DESC "mwv207 gpu driver" +#define DRIVER_DATE "20220407" + + + + +static int selftest; +module_param(selftest, int, 0644); +MODULE_PARM_DESC(selftest, "run selftest when startup"); + +static int mwv207_driver_open(struct drm_device *dev, struct drm_file *file_priv) +{ + struct mwv207_fpriv *fpriv; + + fpriv = kzalloc(sizeof(struct mwv207_fpriv), GFP_KERNEL); + if (fpriv == NULL) + return -ENOMEM; + + mwv207_ctx_mgr_init(dev, &fpriv->ctx_mgr); + + file_priv->driver_priv = fpriv; + + return 0; +} + +static void mwv207_driver_postclose(struct drm_device *dev, + struct drm_file *file_priv) +{ + struct mwv207_fpriv *fpriv = to_fpriv(file_priv); + + mwv207_ctx_mgr_fini(dev, &fpriv->ctx_mgr); + kfree(fpriv); +} + +static int mwv207_mmap(struct file *filp, struct vm_area_struct *vma) +{ + struct drm_file *file_priv; + struct mwv207_device *jdev; + int ret; + + file_priv = filp->private_data; + jdev = file_priv->minor->dev->dev_private; + ret = ttm_bo_mmap(filp, vma, &jdev->bdev); + + return ret; +} + +static const struct file_operations mwv207_driver_fops = { + .owner = THIS_MODULE, + .open = drm_open, + .mmap = mwv207_mmap, + .unlocked_ioctl = drm_ioctl, +#ifdef CONFIG_COMPAT + .compat_ioctl = drm_compat_ioctl, +#endif + .poll = drm_poll, + .read = drm_read, + .llseek = no_llseek, + .release = drm_release, +}; + +static const struct drm_ioctl_desc mwv207_ioctls_drm[] = { + DRM_IOCTL_DEF_DRV(MWV207_INFO, mwv207_db_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), + DRM_IOCTL_DEF_DRV(MWV207_GEM_CREATE, mwv207_gem_create_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), + DRM_IOCTL_DEF_DRV(MWV207_GEM_MMAP, mwv207_gem_mmap_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), + DRM_IOCTL_DEF_DRV(MWV207_GEM_WAIT, mwv207_gem_wait_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), + DRM_IOCTL_DEF_DRV(MWV207_CTX, mwv207_ctx_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), + DRM_IOCTL_DEF_DRV(MWV207_SUBMIT, mwv207_submit_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), +}; + +static struct drm_driver mwv207_drm_driver = { + .driver_features = DRIVER_MODESET | DRIVER_ATOMIC | DRIVER_GEM | DRIVER_RENDER, + .fops = &mwv207_driver_fops, + .open = mwv207_driver_open, + .postclose = mwv207_driver_postclose, + + .dumb_create = mwv207_gem_dumb_create, + .dumb_map_offset = drm_gem_dumb_map_offset, + .dumb_destroy = drm_gem_dumb_destroy, + + .gem_free_object_unlocked = mwv207_gem_free_object, + + .prime_handle_to_fd = drm_gem_prime_handle_to_fd, + .prime_fd_to_handle = drm_gem_prime_fd_to_handle, + .gem_prime_export = drm_gem_prime_export, + .gem_prime_import = drm_gem_prime_import, + .gem_prime_mmap = drm_gem_prime_mmap, + + .ioctls = mwv207_ioctls_drm, + .num_ioctls = ARRAY_SIZE(mwv207_ioctls_drm), + + .name = DRIVER_NAME, + .desc = DRIVER_DESC, + .date = DRIVER_DATE, + .major = 0x0, + .minor = 0x1, +}; + +static inline void iatu_write(struct mwv207_device *jdev, int index, u32 offset, u32 value) +{ + u32 region_base = 0x10000 + index * 0x200; + writel(value, jdev->iatu + region_base + offset); +} + +static inline u32 iatu_read(struct mwv207_device *jdev, int index, u32 offset) +{ + u32 region_base = 0x10000 + index * 0x200; + return readl(jdev->iatu + region_base + offset); +} + +static void mwv207_win_slide(struct mwv207_device *jdev, int region, + u64 pci_win_base, u64 axi_win_base) +{ + iatu_write(jdev, region, 0x108, pci_win_base & 0xffffffff); + iatu_write(jdev, region, 0x10C, pci_win_base >> 32); + iatu_write(jdev, region, 0x114, axi_win_base & 0xffffffff); + iatu_write(jdev, region, 0x118, axi_win_base >> 32); + + iatu_write(jdev, region, 0x110, + (pci_win_base + 0x10000 - 1) & 0xffffffff); + iatu_write(jdev, region, 0x100, 0x00); + iatu_write(jdev, region, 0x104, + 1 << 31 + | 0x0 << 30 + | 6 << 8); + + + mb(); + if (iatu_read(jdev, region, 0x118) != (axi_win_base >> 32)) + pr_warn("mwv207: sliding window failed"); +} + +static int mwv207_iatu_map_bar(struct mwv207_device *jdev, int bar, u64 axi_addr) +{ + iatu_write(jdev, bar + 9, 0x114, axi_addr & 0xffffffff); + iatu_write(jdev, bar + 9, 0x118, axi_addr >> 32); + iatu_write(jdev, bar + 9, 0x100, 0x00); + iatu_write(jdev, bar + 9, 0x104, + 1 << 31 + | 1 << 30 + | bar << 8); + + + mb(); + if (iatu_read(jdev, bar + 9, 0x114) != (axi_addr & 0xffffffff)) + return -ENODEV; + + return 0; +} + +static int mwv207_iatu_init(struct mwv207_device *jdev) +{ + int ret; + + ret = mwv207_iatu_map_bar(jdev, 0, 0x10000000); + if (ret) + return ret; + + ret = mwv207_iatu_map_bar(jdev, 1, 0x00000000); + if (ret) + return ret; + + ret = mwv207_iatu_map_bar(jdev, 2, 0x10000000); + if (ret) + return ret; + + spin_lock_init(&jdev->win_lock); + + jdev->pci_win_base = pci_bus_address(jdev->base.pdev, 2) + + pci_resource_len(jdev->base.pdev, 2) - 0x10000; + + mwv207_win_slide(jdev, 0, jdev->pci_win_base, 0x10000000); + + jdev->vram_last_win = 0; + + return 0; +} + +static void *mwv207_remap_region(struct mwv207_device *jdev, u64 vram_addr, u32 *len) +{ + u64 vram_win_base = (vram_addr & (~(0x10000 - 1))); + u64 winlimit = vram_win_base + 0x10000; + + if (vram_win_base != jdev->vram_last_win) { + mwv207_win_slide(jdev, 0, jdev->pci_win_base, vram_win_base + 0x10000000); + jdev->vram_last_win = vram_win_base; + } + + if (*len > winlimit - vram_addr) + *len = winlimit - vram_addr; + + return jdev->win + vram_addr - vram_win_base; +} + +void jdev_write_vram(struct mwv207_device *jdev, u64 vram_addr, void *buf, int size) +{ + int remain, len; + void *va; + + for (remain = size; remain > 0; remain -= len, buf += len, vram_addr += len) { + len = remain; + spin_lock(&jdev->win_lock); + va = mwv207_remap_region(jdev, vram_addr, &len); + if (!va || len <= 0) { + spin_unlock(&jdev->win_lock); + pr_warn("mwv207: write vram faild"); + return; + } + memcpy_toio(va, buf, len); + spin_unlock(&jdev->win_lock); + } +} + +static int mwv207_kick_out_firmware_fb(struct pci_dev *pdev) +{ + struct apertures_struct *ap; + bool primary = false; + + ap = alloc_apertures(1); + if (!ap) + return -ENOMEM; + + ap->ranges[0].base = pci_resource_start(pdev, 0); + ap->ranges[0].size = pci_resource_len(pdev, 0); + +#ifdef CONFIG_X86 + primary = pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW; +#endif + drm_fb_helper_remove_conflicting_framebuffers(ap, "mwv207drmfb", primary); + kfree(ap); + + return 0; +} + +static u64 mwv207_vram_size(struct mwv207_device *jdev) +{ + int nr = 0; + u64 size; + + switch (jdev_read(jdev, 0x9b0190) & 0x7) { + case 0: + size = 2048; + break; + case 1: + size = 1024; + break; + case 2: + size = 4096; + break; + case 3: + size = 8192; + break; + default: + pr_warn("mwv207: ddr size default to 256MB"); + return 256UL * 1024 * 1024; + } + + if (jdev->lite) { + nr += jdev_read(jdev, 0xd101bc) & 0x1; + nr += jdev_read(jdev, 0xd11cbc) & 0x1; + } else { + nr += (jdev_read(jdev, 0x9702f4) & 0x02000000) ? 1 : 0; + nr += (jdev_read(jdev, 0x9802f4) & 0x02000000) ? 1 : 0; + } + if (!nr) { + nr = 1; + pr_warn("mwv207: ddr cnt default to 1"); + } + + return size * 1024 * 1024 * nr; +} + +static int mwv207_pci_probe(struct pci_dev *pdev, + const struct pci_device_id *ent) +{ + struct mwv207_device *jdev; + int ret; + + ret = mwv207_kick_out_firmware_fb(pdev); + if (ret) + return ret; + + pci_set_master(pdev); + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + jdev = devm_drm_dev_alloc(&pdev->dev, &mwv207_drm_driver, + struct mwv207_device, base); + if (IS_ERR(jdev)) + return PTR_ERR(jdev); + + jdev->dev = &pdev->dev; + jdev->base.pdev = pdev; + jdev->base.dev_private = jdev; + + jdev->mmio = devm_ioremap(jdev->dev, + pci_resource_start(pdev, 1), pci_resource_len(pdev, 1)); + if (!jdev->mmio) + return -ENOMEM; + + jdev->iatu = devm_ioremap(jdev->dev, + pci_resource_start(pdev, 4), pci_resource_len(pdev, 4)); + if (!jdev->iatu) + return -ENOMEM; + + jdev->win = devm_ioremap(jdev->dev, + pci_resource_end(pdev, 2) - 0x10000 + 1, 0x10000); + if (!jdev->win) + return -ENOMEM; + + ret = mwv207_iatu_init(jdev); + if (ret) + return ret; + + /* magic: use hdmi-3 to probe for 92/91 (full/lite) */ + jdev->lite = jdev_read(jdev, 0x12c0000) == 0x21 ? false : true; + + pci_set_drvdata(pdev, jdev); + + ret = mwv207_db_init(jdev); + if (ret) + return ret; + + mwv207_vbios_init(jdev); + + ret = mwv207_irq_init(jdev); + if (ret) + goto err_vbios; + + jdev->visible_vram_size = pci_resource_len(pdev, 2) - 0x10000; + jdev->vram_size = mwv207_vram_size(jdev); + jdev->vram_bar_base = pci_resource_start(pdev, 2); + + ret = mwv207_ttm_init(jdev); + if (ret) + goto err_irq; + + ret = mwv207_sched_init(jdev); + if (ret) + goto err_ttm; + + ret = mwv207_kctx_init(jdev); + if (ret) + goto err_sched; + + ret = mwv207_kms_init(jdev); + if (ret) + goto err_kctx; + + if (selftest) { + ret = mwv207_test(jdev); + if (ret) + goto err_kms; + } + + mwv207_db_sort(jdev); + ret = drm_dev_register(&jdev->base, 0); + if (ret) + goto err_kms; + ret = mwv207_fbdev_init(jdev); + if (ret) + goto err_drm; + + return 0; +err_drm: + drm_dev_unregister(&jdev->base); +err_kms: + mwv207_kms_fini(jdev); +err_kctx: + mwv207_kctx_fini(jdev); +err_sched: + mwv207_sched_fini(jdev); +err_ttm: + mwv207_ttm_fini(jdev); +err_irq: + mwv207_irq_fini(jdev); +err_vbios: + mwv207_vbios_fini(jdev); + mwv207_db_fini(jdev); + return ret; +} + +static void mwv207_pci_remove(struct pci_dev *pdev) +{ + struct mwv207_device *jdev = pci_get_drvdata(pdev); + + mwv207_fbdev_fini(jdev); + drm_dev_unregister(&jdev->base); + mwv207_kms_fini(jdev); + mwv207_kctx_fini(jdev); + mwv207_sched_fini(jdev); + mwv207_ttm_fini(jdev); + mwv207_irq_fini(jdev); + mwv207_vbios_fini(jdev); + mwv207_db_fini(jdev); + pci_clear_master(pdev); + pci_set_drvdata(pdev, NULL); +} + +static int mwv207_pmops_suspend(struct device *dev) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + struct pci_dev *pdev = to_pci_dev(dev); + int ret; + + ret = mwv207_kms_suspend(jdev); + if (ret) + return ret; + + /* kernel permanently pinned boes won't be evicted, they are + * handled by each module in whatever ways suitable + */ + ret = ttm_bo_evict_mm(&jdev->bdev, TTM_PL_VRAM); + if (ret) + goto fail; + + ret = mwv207_sched_suspend(jdev); + if (ret) + goto fail; + + mwv207_irq_suspend(jdev); + + pci_save_state(pdev); + pci_disable_device(pdev); + pci_set_power_state(pdev, PCI_D3hot); + udelay(200); + return 0; +fail: + mwv207_kms_resume(jdev); + return ret; +} + +static int mwv207_pmops_resume(struct device *dev) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + struct pci_dev *pdev = to_pci_dev(dev); + int ret; + + msleep(100); + + pci_set_power_state(pdev, PCI_D0); + pci_restore_state(pdev); + ret = pci_enable_device(pdev); + if (ret) { + pr_err("mwv207: failed to enable pci device"); + return ret; + } + pci_set_master(pdev); + + ret = mwv207_iatu_init(jdev); + if (ret) + return ret; + + mwv207_irq_resume(jdev); + + ret = mwv207_sched_resume(jdev); + if (ret) + return ret; + + return mwv207_kms_resume(jdev); +} + +static SIMPLE_DEV_PM_OPS(mwv207_pm_ops, mwv207_pmops_suspend, mwv207_pmops_resume); + +#define MWV207_PCI_DEVICE_DATA(vend, dev, data) \ + .vendor = vend, .device = dev, .driver_data = (kernel_ulong_t)(data), \ + .subvendor = PCI_ANY_ID, .subdevice = PCI_ANY_ID, \ + .class = 0, .class_mask = 0 + +static const struct pci_device_id pciidlist[] = { + {MWV207_PCI_DEVICE_DATA(0x0731, 0x9100, NULL)}, + {0}, +}; + +MODULE_DEVICE_TABLE(pci, pciidlist); +static struct pci_driver mwv207_pci_driver = { + .name = DRIVER_NAME, + .id_table = pciidlist, + .probe = mwv207_pci_probe, + .remove = mwv207_pci_remove, + .driver.pm = &mwv207_pm_ops, +}; + +static int __init mwv207_init(void) +{ + return pci_register_driver(&mwv207_pci_driver); +} + +static void __exit mwv207_exit(void) +{ + pci_unregister_driver(&mwv207_pci_driver); +} + +module_init(mwv207_init); +module_exit(mwv207_exit); +MODULE_DESCRIPTION("MWV207 Graphics Driver"); +MODULE_AUTHOR("shanjinkui"); +MODULE_LICENSE("GPL"); diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_gem.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_gem.c new file mode 100644 index 0000000000000000000000000000000000000000..70b60b7e0b6ca4340bcdb901f918072372baed5e --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_gem.c @@ -0,0 +1,155 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include "mwv207_drm.h" +#include "mwv207_gem.h" +#include "mwv207_bo.h" + +static int mwv207_gem_create(struct mwv207_device *jdev, + u64 size, u64 align, u32 preferred_domain, + u32 flags, struct drm_gem_object **gobj) +{ + struct mwv207_bo *jbo; + int ret; + +retry: + + ret = mwv207_bo_create(jdev, size, align, ttm_bo_type_device, + preferred_domain, flags, &jbo); + if (ret) { + if (ret != -ERESTARTSYS) { + if (flags & (1<<0)) { + flags &= ~(1<<0); + goto retry; + } + if (preferred_domain == 0x2) { + preferred_domain |= 0x1; + goto retry; + } + DRM_DEBUG("Failed to allocate GEM object (%lld, %d, %llu, %d)\n", + size, preferred_domain, align, ret); + } + return ret; + } + + *gobj = mwv207_gem_from_bo(jbo); + return 0; +} + +int mwv207_gem_dumb_create(struct drm_file *file, struct drm_device *dev, + struct drm_mode_create_dumb *args) +{ + struct mwv207_device *jdev = dev->dev_private; + struct drm_gem_object *gobj; + u32 handle; + int ret; + + args->pitch = ALIGN(args->width * DIV_ROUND_UP(args->bpp, 8), 64); + args->size = args->pitch * args->height; + ret = mwv207_gem_create(jdev, args->size, 0x10000, + 0x2, + (1<<0), + &gobj); + if (ret) + return ret; + + ret = drm_gem_handle_create(file, gobj, &handle); + drm_gem_object_put(gobj); + if (ret) + return ret; + + args->handle = handle; + return 0; +} + +void mwv207_gem_free_object(struct drm_gem_object *gobj) +{ + struct mwv207_bo *jbo; + + if (!gobj) + return; + + jbo = mwv207_bo_from_gem(gobj); + mwv207_bo_unref(jbo); +} + +int mwv207_gem_create_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + struct mwv207_device *jdev = dev->dev_private; + union drm_mwv207_gem_create *args = data; + struct drm_gem_object *gobj; + int ret; + + if (args->in.size == 0) + return -EINVAL; + if (args->in.alignment & (args->in.alignment - 1)) + return -EINVAL; + if (args->in.preferred_domain & ~0x7) + return -EINVAL; + if (args->in.flags & ~((1<<0)|(1<<1)|(1<<2))) + return -EINVAL; + + ret = mwv207_gem_create(jdev, args->in.size, args->in.alignment, + args->in.preferred_domain, + args->in.flags, &gobj); + if (ret) + return ret; + + ret = drm_gem_handle_create(filp, gobj, &args->out.handle); + drm_gem_object_put(gobj); + + return ret; +} + +int mwv207_gem_mmap_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + union drm_mwv207_gem_mmap *args = data; + struct drm_gem_object *obj; + + if (args->in.pad) + return -EINVAL; + + obj = drm_gem_object_lookup(filp, args->in.handle); + if (!obj) + return -ENOENT; + args->out.offset = mwv207_bo_mmap_offset(obj); + drm_gem_object_put(obj); + + return 0; +} + +int mwv207_gem_wait_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + struct drm_mwv207_gem_wait *args = (struct drm_mwv207_gem_wait *)data; + long timeout; + bool write; + int ret; + + if (args->op & ~(0x00000002 | 0x00000001)) + return -EINVAL; + + write = args->op & 0x00000002; + timeout = drm_timeout_abs_to_jiffies(args->timeout); + + ret = drm_gem_dma_resv_wait(filp, args->handle, write, timeout); + if (ret == -ETIME) + ret = timeout ? -ETIMEDOUT : -EBUSY; + + return ret; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_gem.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_gem.h new file mode 100644 index 0000000000000000000000000000000000000000..5a776b242e1be05b1df806fae2574bb0df443957 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_gem.h @@ -0,0 +1,38 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_GEM_H_TJTW9M4R +#define MWV207_GEM_H_TJTW9M4R +#include +#include +#include +#include "mwv207.h" + +int mwv207_gem_dumb_create(struct drm_file *file, struct drm_device *dev, + struct drm_mode_create_dumb *args); + +void mwv207_gem_free_object(struct drm_gem_object *obj); + +int mwv207_gem_create_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +int mwv207_gem_mmap_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +int mwv207_gem_wait_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_irq.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_irq.c new file mode 100644 index 0000000000000000000000000000000000000000..987d8a91eddb7538facd7182fd8af4fbfd126404 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_irq.c @@ -0,0 +1,190 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include "mwv207.h" +#include "mwv207_irq.h" + +static irqreturn_t mwv207_isr(int irq_unused, void *dev_id) +{ + struct mwv207_device *jdev = dev_id; + int i, j, hwirq, virq, ret = IRQ_NONE; + u32 stat; + + for (i = 0; i < 2; ++i) { + stat = jdev_read(jdev, (0x009A802c) + i * 4); + stat &= jdev->irq_enable_reg[i]; + while ((j = ffs(stat))) { + j--; + hwirq = i * 32 + j; + virq = irq_find_mapping(jdev->irq_domain, hwirq); + if (virq) { + ret = generic_handle_irq(virq); + if (ret < 0) + pr_warn("mwv207: hwirq(%d) handled with %d", hwirq, ret); + } else + pr_warn("mwv207: no irq mapping set on %d", hwirq); + + + jdev_write(jdev, (0x009A802c) + i * 4, (1UL << j)); + stat &= ~(1UL << j); + ret = IRQ_HANDLED; + } + } + + return ret; +} + +static void mwv207_irq_mask(struct irq_data *d) +{ + struct mwv207_device *jdev = irq_data_get_irq_chip_data(d); + int irq = irqd_to_hwirq(d); + unsigned long flags; + u32 reg; + + reg = (0x009A8020) + (irq / 32) * 4; + + spin_lock_irqsave(&jdev->irq_lock, flags); + jdev_modify(jdev, reg, 1 << (irq % 32), 0); + jdev->irq_enable_reg[irq / 32] = jdev_read(jdev, reg); + spin_unlock_irqrestore(&jdev->irq_lock, flags); +} + +static void mwv207_irq_unmask(struct irq_data *d) +{ + struct mwv207_device *jdev = irq_data_get_irq_chip_data(d); + int irq = irqd_to_hwirq(d); + unsigned long flags; + u32 reg; + + reg = (0x009A8020) + (irq / 32) * 4; + + spin_lock_irqsave(&jdev->irq_lock, flags); + jdev_modify(jdev, reg, 1 << (irq % 32), 1 << (irq % 32)); + jdev->irq_enable_reg[irq / 32] = jdev_read(jdev, reg); + spin_unlock_irqrestore(&jdev->irq_lock, flags); +} + +void mwv207_irq_suspend(struct mwv207_device *jdev) +{ + int i; + + for (i = 0; i < 2; ++i) + jdev->irq_enable_reg[i] = jdev_read(jdev, + (0x009A8020) + i * 4); +} + +void mwv207_irq_resume(struct mwv207_device *jdev) +{ + int i; + + for (i = 0; i < 2; ++i) { + jdev_write(jdev, (0x009A802c) + i * 4, 0xffffffff); + jdev_write(jdev, (0x009A8020) + i * 4, + jdev->irq_enable_reg[i]); + } +} + +static struct irq_chip mwv207_irq_chip = { + .name = "mwv207", + .irq_mask = mwv207_irq_mask, + .irq_unmask = mwv207_irq_unmask, +}; + +static int mwv207_irq_domain_map(struct irq_domain *d, unsigned int irq, + irq_hw_number_t hwirq) +{ + struct mwv207_device *jdev = d->host_data; + + if (hwirq >= 64) + return -EPERM; + + irq_set_chip_and_handler(irq, &mwv207_irq_chip, handle_simple_irq); + irq_set_chip_data(irq, jdev); + + return 0; +} + +static const struct irq_domain_ops mwv207_irq_domain_ops = { + .map = mwv207_irq_domain_map, +}; + +int mwv207_irq_init(struct mwv207_device *jdev) +{ + struct pci_dev *pdev = jdev->base.pdev; + int ret, i; + + + for (i = 0; i < 2; ++i) { + jdev_write(jdev, (0x009A802c) + i * 4, 0xffffffff); + jdev_write(jdev, (0x009A8020) + i * 4, 0); + } + + spin_lock_init(&jdev->irq_lock); + + jdev->irq_domain = irq_domain_add_linear(NULL, 64, + &mwv207_irq_domain_ops, jdev); + if (!jdev->irq_domain) + return -ENODEV; + + + for (i = 0; i < 64; ++i) + irq_create_mapping(jdev->irq_domain, i); + + ret = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_MSI | PCI_IRQ_LEGACY); + if (ret < 1) { + ret = -ENODEV; + goto free_mapping; + } + + ret = request_irq(pdev->irq, mwv207_isr, IRQF_SHARED, "mwv207_isr", jdev); + if (ret) + goto free_vec; + + return 0; + +free_vec: + pci_free_irq_vectors(pdev); +free_mapping: + for (i = 0; i < 64; ++i) { + int irq = irq_find_mapping(jdev->irq_domain, i); + + irq_dispose_mapping(irq); + } + + irq_domain_remove(jdev->irq_domain); + + return ret; +} + +void mwv207_irq_fini(struct mwv207_device *jdev) +{ + struct pci_dev *pdev = jdev->base.pdev; + int i; + + free_irq(pdev->irq, jdev); + pci_free_irq_vectors(pdev); + + for (i = 0; i < 64; ++i) { + int irq = irq_find_mapping(jdev->irq_domain, i); + + irq_dispose_mapping(irq); + } + + irq_domain_remove(jdev->irq_domain); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_irq.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_irq.h new file mode 100644 index 0000000000000000000000000000000000000000..eabcc61e62c479c5d865f3b251de76e2ef592b95 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_irq.h @@ -0,0 +1,26 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_IRQ_H_Z8YGVNB2 +#define MWV207_IRQ_H_Z8YGVNB2 + +struct mwv207_device; + +int mwv207_irq_init(struct mwv207_device *jdev); +void mwv207_irq_fini(struct mwv207_device *jdev); + +void mwv207_irq_suspend(struct mwv207_device *jdev); +void mwv207_irq_resume(struct mwv207_device *jdev); +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_2d.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_2d.c new file mode 100644 index 0000000000000000000000000000000000000000..b34c0c781ba9ff6f66e1811ddd5b5afdc11c48c1 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_2d.c @@ -0,0 +1,566 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include + +#include "mwv207_bo.h" +#include "mwv207_sched.h" +#include "mwv207_vbios.h" +#include "mwv207_devfreq.h" + + +#define wait_for(COND, MS) ({ \ + unsigned long timeout__ = jiffies + msecs_to_jiffies(MS) + 1; \ + int ret__ = 0; \ + while (!(COND)) { \ + if (time_after(jiffies, timeout__)) { \ + if (!(COND)) \ + ret__ = -ETIMEDOUT; \ + break; \ + } \ + msleep(1); \ + } \ + ret__; \ +}) + +struct mwv207_pipe_2d { + struct mwv207_pipe base; + struct mwv207_bo *ring_bo; + struct mwv207_device *jdev; + u32 *ring_start; + u32 *ring_end; + u32 *head; + u32 *tail; + u32 *last_wait; + u64 ring_start_addr; + int id; + unsigned int irq; + + u64 fence_ctx; + u32 next_fence; + u32 completed_fence; + spinlock_t fence_lock; + spinlock_t fence_queue_lock; + struct list_head fence_queue; +}; + +struct pipe_2d_fence { + struct dma_fence base; + struct mwv207_pipe_2d *pipe; + u32 *rpos; + + struct list_head q; +}; + +#define to_pipe_2d(p) container_of(p, struct mwv207_pipe_2d, base) +#define to_pipe_2d_fence(f) container_of(f, struct pipe_2d_fence, base) + +static inline void pipe_2d_write(struct mwv207_pipe_2d *pipe, + u32 reg, u32 value) +{ + pipe_write(&pipe->base, reg, value); +} + +static inline u32 pipe_2d_read(struct mwv207_pipe_2d *pipe, u32 reg) +{ + return pipe_read(&pipe->base, reg); +} + +static inline void pipe_2d_barrier(struct mwv207_pipe_2d *pipe) +{ + pipe_2d_read(pipe, 0x4100); + mb(); +} + + +static inline bool fence16_after(u16 a, u16 b) +{ + return (s16)(a - b) > 0; +} + +static inline bool fence_after(u32 a, u32 b) +{ + return (s32)(a - b) > 0; +} + +static const char *pipe_2d_fence_get_driver_name(struct dma_fence *fence) +{ + return "mwv207"; +} + +static const char *pipe_2d_fence_get_timeline_name(struct dma_fence *fence) +{ + return to_pipe_2d_fence(fence)->pipe->base.fname; +} + +static bool pipe_2d_fence_signaled(struct dma_fence *fence) +{ + struct pipe_2d_fence *f = to_pipe_2d_fence(fence); + + return fence_after(f->pipe->completed_fence, f->base.seqno); +} + +static void pipe_2d_fence_release(struct dma_fence *fence) +{ + struct pipe_2d_fence *f = to_pipe_2d_fence(fence); + + kfree_rcu(f, base.rcu); +} + +static const struct dma_fence_ops pipe_2d_fence_ops = { + .get_driver_name = pipe_2d_fence_get_driver_name, + .get_timeline_name = pipe_2d_fence_get_timeline_name, + .signaled = pipe_2d_fence_signaled, + .release = pipe_2d_fence_release, +}; + +static inline u32 pipe_2d_ptr_span(void *end, void *start) +{ + return (unsigned long)end - (unsigned long)start; +} + +static inline u32 pipe_2d_gpu_addr(struct mwv207_pipe_2d *pipe, u32 *ptr) +{ + return pipe->ring_start_addr + pipe_2d_ptr_span(ptr, pipe->ring_start); +} + +static inline bool pipe_2d_idle_on_noc(struct mwv207_pipe_2d *pipe) +{ + struct mwv207_device *jdev = pipe->jdev; + u32 pending1, pending2; + u32 val; + + pending1 = jdev->lite ? 0x70038000 : 0xF87FC000; + pending2 = jdev->lite ? 0x00000000 : 0x0000000F; + + val = jdev_read(jdev, (0x009B0194)); + if ((val & pending1) != pending1) + return false; + val = jdev_read(jdev, (0x009B0198)); + if ((val & pending2) != pending2) + return false; + return true; +} + +static int pipe_2d_hw_init(struct mwv207_pipe_2d *pipe) +{ + int ret; + u32 val; + + ret = wait_for(pipe_2d_idle_on_noc(pipe), 5000); + if (ret) { + pr_err("mwv207: failed to wait %s idle, %#x %#x", + pipe->base.fname, + jdev_read(pipe->jdev, (0x009B0194)), + jdev_read(pipe->jdev, (0x009B0198))); + return ret; + } + + + val = jdev_read(pipe->jdev, (0x009B0048)); + val &= ~(1 << 8); + jdev_write(pipe->jdev, (0x009B0048), val); + + + val = jdev_read(pipe->jdev, (0x009B0014)); + val &= ~(1 << 16); + jdev_write(pipe->jdev, (0x009B0014), val); + + + val = jdev_read(pipe->jdev, (0x009B0048)); + val |= 1 << 8; + jdev_write(pipe->jdev, (0x009B0048), val); + + + val = jdev_read(pipe->jdev, (0x009B0014)); + val |= 1 << 16; + jdev_write(pipe->jdev, (0x009B0014), val); + + msleep(10); + + + pipe_2d_write(pipe, 0x4800, 0); + + ret = wait_for(pipe_2d_read(pipe, 0x4800), 5000); + if (ret) { + pr_err("mwv207: failed to reset %s status RAM", + pipe->base.fname); + return ret; + } + + return 0; +} + +static void pipe_2d_reset_ring(struct mwv207_pipe_2d *pipe) +{ + struct pipe_2d_fence *fence, *p; + unsigned long flags; + + pipe->head = pipe->ring_start; + pipe->tail = pipe->ring_start; + + spin_lock_irqsave(&pipe->fence_queue_lock, flags); + list_for_each_entry_safe(fence, p, &pipe->fence_queue, q) { + list_del(&fence->q); + dma_fence_put(&fence->base); + } + spin_unlock_irqrestore(&pipe->fence_queue_lock, flags); +} + +static u32 *pipe_2d_append_wl(struct mwv207_pipe_2d *pipe) +{ + u32 *wait = pipe->tail; + + *pipe->tail++ = 0x88000000; + *pipe->tail++ = 0x80000000; + *pipe->tail++ = 0x89000000; + *pipe->tail++ = pipe_2d_gpu_addr(pipe, wait);; + + return wait; +} + +static void pipe_2d_start(struct mwv207_pipe_2d *pipe) +{ + u32 regval = pipe->ring_start_addr >> 4 | 1 << 29; + + pipe_2d_write(pipe, 0x4200, regval); + + *pipe->tail++ = 0x80000000; + *pipe->tail++ = 1; + *pipe->tail++ = 0x80000000; + *pipe->tail++ = 0x80000000; + + pipe->last_wait = pipe_2d_append_wl(pipe); + BUG_ON(pipe_2d_ptr_span(pipe->tail, pipe->ring_start) != 32); + pipe_2d_barrier(pipe); + pipe_2d_write(pipe, 0x4C00, 1); + + dev_dbg(pipe->base.jdev->dev, "start 2d wait link at 0x%llx", + pipe->ring_start_addr); +} + +static inline void pipe_2d_stop(struct mwv207_pipe_2d *pipe) +{ + pr_info("mwv207: %s %s TBD", pipe->base.fname, __func__); +} + +static void mwv207_pipe_2d_reset(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); + + if (pipe_2d_hw_init(pipe)) + return; + pipe_2d_reset_ring(pipe); + pipe_2d_start(pipe); +} + +static u32 *pipe_2d_wait_for_space(struct mwv207_pipe_2d *pipe, u32 size) +{ + int i; + + for (i = 0; i < 10000; i++) { + u32 *head = READ_ONCE(pipe->head); + if (head <= pipe->tail) { + if (pipe_2d_ptr_span(pipe->ring_end, pipe->tail) >= size) + return pipe->tail; + if (pipe_2d_ptr_span(head, pipe->ring_start) >= size) + return pipe->ring_start; + } else { + if (pipe_2d_ptr_span(head, pipe->tail) >= size) + return pipe->tail; + } + usleep_range(200, 200); + } + + return NULL; +} + +static struct dma_fence *pipe_2d_append_fence(struct mwv207_pipe_2d *pipe) +{ + struct pipe_2d_fence *fence; + unsigned long flags; + u32 regno; + + fence = kzalloc(sizeof(struct pipe_2d_fence), GFP_KERNEL); + if (!fence) { + pr_err("mwv207: failed to alloc memory for %s", + pipe->base.fname); + return ERR_PTR(-ENOMEM); + } + dma_fence_init(&fence->base, &pipe_2d_fence_ops, &pipe->fence_lock, + pipe->fence_ctx, ++pipe->next_fence); + fence->pipe = pipe; + fence->rpos = pipe->tail; + regno = (pipe->next_fence & 0x1f) + 1; + + spin_lock_irqsave(&pipe->fence_queue_lock, flags); + list_add_tail(&fence->q, &pipe->fence_queue); + spin_unlock_irqrestore(&pipe->fence_queue_lock, flags); + + *pipe->tail++ = (0x40000000 | 0x6000 | (0) << 2); + *pipe->tail++ = (u32)(fence->base.seqno & 0xffff); + *pipe->tail++ = (0x40000000 | 0x6000 | (regno) << 2); + *pipe->tail++ = regno; + + pipe_2d_write(pipe, 0x6000 + regno * 4, regno); + + dma_fence_get(&fence->base); + return &fence->base; +} + +static void pipe_2d_wtol(struct mwv207_pipe_2d *pipe, u32 *start, u32 *new_wait) +{ + u32 *pos = pipe->last_wait; + + pos[1] = pipe_2d_gpu_addr(pipe, start); + pipe_2d_barrier(pipe); + pos[0] = 0x89000000; + pipe_2d_barrier(pipe); + pipe_2d_write(pipe, 0x4C00, 1); + + pipe->last_wait = new_wait; +} + +static void mwv207_pipe_2d_dump_state(struct mwv207_pipe *mpipe) +{ + pr_info("%s %08x: %08x, %08x: %08x", mpipe->fname, + 0x4100, pipe_read(mpipe, 0x4100), + 0x961100, jdev_read(mpipe->jdev, 0x961100)); +} + +static struct dma_fence * +mwv207_pipe_2d_submit(struct mwv207_pipe *mpipe, struct mwv207_job *mjob) +{ + struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); + u32 size = ALIGN(mjob->cmd_size, 16) + 128; + u32 *start, *wait, *last_tail, nop_cnt; + struct dma_fence *fence; + + start = pipe_2d_wait_for_space(pipe, size); + if (!start) { + pr_err("mwv207: %s is stuck", mpipe->fname); + return ERR_PTR(-EBUSY); + } + last_tail = pipe->tail; + pipe->tail = start; + + + *pipe->tail++ = 0x80000000; + pipe->tail++; + *pipe->tail++ = 0x80000000; + *pipe->tail++ = 0x80000000; + + + memcpy_toio(pipe->tail, mjob->cmds, mjob->cmd_size); + pipe->tail += mjob->cmd_size >> 2; + for (nop_cnt = (ALIGN(mjob->cmd_size, 16) - mjob->cmd_size); + nop_cnt > 0; nop_cnt -= 4) + *pipe->tail++ = 0x80000000; + + + fence = pipe_2d_append_fence(pipe); + if (IS_ERR(fence)) { + pipe->tail = last_tail; + return fence; + } + + + wait = pipe_2d_append_wl(pipe); + + + BUG_ON(pipe_2d_ptr_span(pipe->tail, start) & 0xf); + start[1] = pipe_2d_ptr_span(pipe->tail, start) / 16 - 1; + + + pipe_2d_wtol(pipe, start, wait); + + BUG_ON(pipe_2d_ptr_span(pipe->tail, start) > size); + + return fence; +} + +static irqreturn_t mwv207_pipe_2d_isr(int irq_unused, void *data) +{ + struct mwv207_pipe_2d *pipe = data; + struct pipe_2d_fence *fence, *p; + u32 seqno; + + pipe_2d_write(pipe, 0x4308, 0xFFFFFFFF); + seqno = pipe_2d_read(pipe, 0x6000); + + spin_lock(&pipe->fence_queue_lock); + list_for_each_entry_safe(fence, p, &pipe->fence_queue, q) { + if (fence16_after(fence->base.seqno & 0xffff, seqno & 0xffff)) + break; + list_del(&fence->q); + pipe->completed_fence = fence->base.seqno; + WRITE_ONCE(pipe->head, fence->rpos); + mwv207_devfreq_record_idle(&pipe->base); + dma_fence_signal(&fence->base); + dma_fence_put(&fence->base); + } + spin_unlock(&pipe->fence_queue_lock); + + return IRQ_HANDLED; +} + +static void mwv207_pipe_2d_destroy(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); + struct mwv207_bo *mbo = pipe->ring_bo; + int ret; + + free_irq(pipe->irq, pipe); + pipe_2d_stop(pipe); + + ret = mwv207_bo_reserve(mbo, true); + if (ret) { + pr_err("mwv207: failed to reserve bo"); + return; + } + mwv207_bo_kunmap_reserved(mbo); + mwv207_bo_unpin_reserved(mbo); + mwv207_bo_unreserve(mbo); + mwv207_bo_unref(mbo); + + mwv207_devfreq_unregister(mpipe); +} + +static unsigned long pipe_2d_max_freq_get(struct mwv207_device *jdev) +{ + unsigned long freq; + + switch (jdev->base.pdev->subsystem_device) { + case 0x9103: + freq = 600; + break; + case 0x9210: + case 0x9211: + freq = 800; + break; + case 0x930B: + freq = 1000; + break; + case 0x9101: + case 0x9102: + case 0x910A: + case 0x910B: + case 0x910C: + case 0x9200: + case 0x920A: + case 0x920B: + case 0x920C: + case 0x9230: + case 0x9231: + case 0x930A: + case 0x930C: + freq = 1200; + break; + default: + freq = 0x258; + break; + } + + return freq; +} + +struct mwv207_pipe *mwv207_pipe_2d_create(struct mwv207_device *jdev, + int id, u32 regbase, + const char *fname) +{ + struct mwv207_pipe_2d *pipe; + struct mwv207_bo *mbo; + void *addr; + int ret; + + pipe = devm_kzalloc(jdev->dev, sizeof(*pipe), GFP_KERNEL); + if (!pipe) + return NULL; + pipe->base.pll_id = MWV207_PLL_GU2D_PLL; + pipe->base.jdev = jdev; + pipe->base.fname = fname; + pipe->base.regbase = jdev->mmio + regbase; + pipe->base.iosize = 32 * 1024; + pipe->base.submit = mwv207_pipe_2d_submit; + pipe->base.reset = mwv207_pipe_2d_reset; + pipe->base.destroy = mwv207_pipe_2d_destroy; + pipe->base.dump_state = mwv207_pipe_2d_dump_state; + + pipe->jdev = jdev; + pipe->id = id; + pipe->fence_ctx = dma_fence_context_alloc(1); + INIT_LIST_HEAD(&pipe->fence_queue); + spin_lock_init(&pipe->fence_lock); + spin_lock_init(&pipe->fence_queue_lock); + + ret = mwv207_devfreq_register(&pipe->base, pipe_2d_max_freq_get(jdev)); + if (ret) + pipe->base.devfreq = NULL; + + ret = mwv207_bo_create(jdev, 0x40000, 0x1000, + ttm_bo_type_kernel, 0x2, + (1<<0), &mbo); + if (ret) + goto unregister_devfreq; + + ret = mwv207_bo_reserve(mbo, true); + if (ret) + goto free_bo; + ret = mwv207_bo_pin_reserved(mbo, 0x2); + if (ret) + goto unreserve_bo; + ret = mwv207_bo_kmap_reserved(mbo, &addr); + if (ret) + goto unpin_bo; + pipe->ring_bo = mbo; + + pipe->ring_start = (u32 *)addr; + pipe->ring_start_addr = mwv207_bo_gpu_phys(mbo); + pipe->ring_end = pipe->ring_start + (0x40000 >> 2); + + mwv207_pipe_2d_reset(&pipe->base); + + pipe->irq = irq_find_mapping(jdev->irq_domain, 17 + id); + if (pipe->irq == 0) { + pr_err("mwv207: failed to find %s irq mapping", fname); + goto unmap_bo; + } + + ret = request_irq(pipe->irq, mwv207_pipe_2d_isr, 0, fname, pipe); + if (ret) { + pr_err("mwv207: failed to request irq for %s", fname); + goto unmap_bo; + } + + mwv207_bo_unreserve(mbo); + + return &pipe->base; +unmap_bo: + mwv207_bo_kunmap_reserved(mbo); +unpin_bo: + mwv207_bo_unpin_reserved(mbo); +unreserve_bo: + mwv207_bo_unreserve(mbo); +free_bo: + mwv207_bo_unref(mbo); +unregister_devfreq: + mwv207_devfreq_unregister(&pipe->base); + return NULL; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_3d.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_3d.c new file mode 100644 index 0000000000000000000000000000000000000000..d20bac764879e8a2fac7fd31e9ce473d51654af0 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_3d.c @@ -0,0 +1,612 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include "mwv207_bo.h" +#include "mwv207_sched.h" +#include "mwv207_vbios.h" +#include "mwv207_devfreq.h" + + +#define to_3d_pipe(pipe) container_of(pipe, struct mwv207_pipe_3d, base) +struct mwv207_pipe_3d { + struct mwv207_pipe base; + struct mwv207_bo *ringbuf_bo; + u32 *ringbuf; + u32 *head; + u32 *tail; + u32 *end; + u32 ringbuf_gpu_addr; + int unit; + unsigned int irq; + + u64 fence_ctx; + u32 next_fence; + u32 completed_fence; + spinlock_t fence_lock; + + DECLARE_BITMAP(event_bitmap, 30); + struct dma_fence *event_fence[30]; + spinlock_t event_lock; +}; + +#define to_pipe_3d_fence(f) container_of(f, struct pipe_3d_fence, base) +struct pipe_3d_fence { + struct dma_fence base; + u32 *rpos; + struct mwv207_pipe_3d *pipe; +}; + +static inline void pipe_3d_write(struct mwv207_pipe_3d *pipe, u32 reg, u32 value) +{ + pipe_write(&pipe->base, reg, value); +} + +static inline u32 pipe_3d_read(struct mwv207_pipe_3d *pipe, u32 reg) +{ + return pipe_read(&pipe->base, reg); +} + + +static inline bool fence_after(u32 a, u32 b) +{ + return (s32)(a - b) > 0; +} + +static const char *pipe_3d_fence_get_driver_name(struct dma_fence *fence) +{ + return "mwv207"; +} + +static const char *pipe_3d_fence_get_timeline_name(struct dma_fence *fence) +{ + return to_pipe_3d_fence(fence)->pipe->base.fname; +} + +static bool pipe_3d_fence_signaled(struct dma_fence *fence) +{ + struct pipe_3d_fence *f = to_pipe_3d_fence(fence); + + return fence_after(f->pipe->completed_fence, f->base.seqno); +} + +static void pipe_3d_fence_release(struct dma_fence *fence) +{ + struct pipe_3d_fence *f = to_pipe_3d_fence(fence); + + kfree_rcu(f, base.rcu); +} + +static const struct dma_fence_ops pipe_3d_fence_ops = { + .get_driver_name = pipe_3d_fence_get_driver_name, + .get_timeline_name = pipe_3d_fence_get_timeline_name, + .signaled = pipe_3d_fence_signaled, + .release = pipe_3d_fence_release, +}; + + +static inline struct dma_fence *pipe_3d_event_pop_irq(struct mwv207_pipe_3d *pipe, u32 event) +{ + struct dma_fence *fence; + + spin_lock(&pipe->event_lock); + fence = pipe->event_fence[event]; + pipe->event_fence[event] = NULL; + clear_bit(event, pipe->event_bitmap); + spin_unlock(&pipe->event_lock); + + return fence; +} + + +static inline u32 pipe_3d_event_push(struct mwv207_pipe_3d *pipe, struct dma_fence *fence) +{ + u32 event; + + spin_lock_irq(&pipe->event_lock); + event = find_first_zero_bit(pipe->event_bitmap, 30); + if (likely(event < 30)) + pipe->event_fence[event] = dma_fence_get(fence); + set_bit(event, pipe->event_bitmap); + spin_unlock_irq(&pipe->event_lock); + + + BUG_ON(event >= 30); + + return event; +} + +static inline u32 pipe_3d_ptr_span(void *end, void *start) +{ + return (unsigned long)end - (unsigned long)start; +} + +static inline u32 pipe_3d_gpu_addr(struct mwv207_pipe_3d *pipe, u32 *ptr) +{ + return pipe->ringbuf_gpu_addr + pipe_3d_ptr_span(ptr, pipe->ringbuf); +} + +static inline void pipe_3d_link(struct mwv207_pipe_3d *pipe, u32 prefetch, u32 addr) +{ + pipe->tail = PTR_ALIGN(pipe->tail, 8); + BUG_ON(pipe->tail >= pipe->end - 1 + || (((prefetch + 7) / 8) & 0xffff0000) + || addr & 0x7); + *pipe->tail++ = 0x40000000 | ((prefetch + 7) / 8); + *pipe->tail++ = addr; +} + +static inline void pipe_3d_wait(struct mwv207_pipe_3d *pipe) +{ + pipe->tail = PTR_ALIGN(pipe->tail, 8); + BUG_ON(pipe->tail >= pipe->end); + + *pipe->tail++ = 0x38000000 | 200; +} + +static inline void pipe_3d_wl(struct mwv207_pipe_3d *pipe) +{ + pipe_3d_wait(pipe); + pipe_3d_link(pipe, 16, pipe_3d_gpu_addr(pipe, pipe->tail) - 4); +} + +static inline void pipe_3d_wtol(struct mwv207_pipe_3d *pipe, u32 *w, u32 target, u32 size) +{ + BUG_ON((((size + 7) / 8) & 0xffff0000) || target & 0x7 + || w < pipe->ringbuf || w >= pipe->end - 1); + w[1] = target; + pipe_3d_read(pipe, 0x4); + mb(); + w[0] = 0x40000000 | ((size + 7) / 8); +} + +static inline void pipe_3d_loadstate(struct mwv207_pipe_3d *pipe, u32 reg, u32 val) +{ + pipe->tail = PTR_ALIGN(pipe->tail, 8); + BUG_ON(pipe->tail >= pipe->end - 1); + + *pipe->tail++ = 0x08010000 | reg; + *pipe->tail++ = val; +} + +static inline void pipe_3d_sem(struct mwv207_pipe_3d *pipe, u32 from, u32 to) +{ + from &= 0x1f; + to &= 0x1f; + to <<= 8; + pipe_3d_loadstate(pipe, 0x0e02, from | to); +} + +static inline void pipe_3d_stall(struct mwv207_pipe_3d *pipe, u32 from, u32 to) +{ + pipe->tail = PTR_ALIGN(pipe->tail, 8); + BUG_ON(pipe->tail >= pipe->end - 1); + from &= 0x1f; + to &= 0x1f; + to <<= 8; + *pipe->tail++ = 0x48000000; + *pipe->tail++ = from | to; +} + +static inline void pipe_3d_start(struct mwv207_pipe_3d *pipe) +{ + u32 *start = pipe->tail; + u32 len; + + dev_dbg(pipe->base.jdev->dev, "start wait link at 0x%x", pipe->ringbuf_gpu_addr); + pipe_3d_loadstate(pipe, 0x0e21, 0x00020202); + pipe_3d_loadstate(pipe, 0x0e44, 0x0000000f); + pipe_3d_loadstate(pipe, 0x0e80, 0x00000000); + pipe_3d_loadstate(pipe, 0x7003, 0x00000001); + + pipe_3d_wl(pipe); + + len = (pipe->tail - start) * 4; + pipe_3d_write(pipe, 0x014, 0xffffffff); + pipe_3d_write(pipe, 0x654, pipe->ringbuf_gpu_addr); + pipe_3d_read(pipe, 0x4); + mb(); + pipe_3d_write(pipe, 0x658, 0x10000 | (len / 8)); + pipe_3d_write(pipe, 0x3a4, 0x10000 | (len / 8)); +} + +static inline int pipe_3d_stop(struct mwv207_pipe_3d *pipe) +{ + pr_info("%s TBD", __func__); + return 0; +} + +static void pipe_3d_core_reset(struct mwv207_pipe_3d *pipe) +{ + int i; + + for (i = 0; i < 2; i++) { + + pipe_3d_write(pipe, 0x104, 0); + + pipe_3d_write(pipe, 0x10c, 0x015b0880); + pipe_3d_write(pipe, 0x10c, 0x015b0881); + pipe_3d_write(pipe, 0x10c, 0x015b0880); + + pipe_3d_write(pipe, 0x000, 0x00010b00); + pipe_3d_write(pipe, 0x000, 0x00010900); + + usleep_range(1000, 1001); + + pipe_3d_write(pipe, 0x000, 0x00090900); + + + pipe_3d_write(pipe, 0x3a8, 1); + pipe_3d_write(pipe, 0x3a8, 0); + + + usleep_range(1000, 1001); + + + pipe_3d_write(pipe, 0x000, 0x00010900); + } +} + +static void pipe_3d_hw_init(struct mwv207_pipe_3d *pipe) +{ + pipe_3d_write(pipe, 0x000, 0x00010900); + pipe_3d_core_reset(pipe); + + pipe_3d_write(pipe, 0x55c, 0x00ffffff); + pipe_3d_write(pipe, 0x414, 0x3c000000); + pipe_3d_write(pipe, 0x090, + pipe_3d_read(pipe, 0x090) & 0xffffffbf); + + pipe_3d_write(pipe, 0x000, 0x00010900); + pipe_3d_write(pipe, 0x000, 0x00070100); + pipe_3d_write(pipe, 0x3ac, 0x00002300); + pipe_3d_write(pipe, 0x3a8, 0x2); + + pipe_3d_write(pipe, 0x03c, 0xffffffff); + pipe_3d_write(pipe, 0x03c, 0x00000000); + + pipe_3d_write(pipe, 0x100, 0x00140021); + + + + pipe_3d_write(pipe, 0x154, 0x1); + pipe_3d_write(pipe, 0x104, 0x00430408); + pipe_3d_write(pipe, 0x10c, 0x015b0880); +} + +static void mwv207_pipe_3d_reset(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); + int i; + + + spin_lock_irq(&pipe->event_lock); + bitmap_zero(pipe->event_bitmap, 30); + for (i = 0; i < 30; i++) { + dma_fence_put(pipe->event_fence[i]); + pipe->event_fence[i] = NULL; + } + spin_unlock_irq(&pipe->event_lock); + + pipe_3d_hw_init(pipe); + pipe->tail = pipe->ringbuf; + pipe->head = pipe->ringbuf; + + pipe_3d_start(pipe); +} + + +static u32 *pipe_3d_wait_for_space(struct mwv207_pipe_3d *pipe, u32 size) +{ + u32 *head; + int i; + + for (i = 0; i < 10000; ++i) { + head = READ_ONCE(pipe->head); + + if (head <= pipe->tail) { + if (pipe_3d_ptr_span(pipe->end, pipe->tail) >= size) + return pipe->tail; + if (pipe_3d_ptr_span(head, pipe->ringbuf) >= size) + return pipe->ringbuf; + } else { + if (pipe_3d_ptr_span(head, pipe->tail) >= size) + return pipe->tail; + } + usleep_range(200, 200); + } + return NULL; +} + +static struct dma_fence *mwv207_pipe_3d_submit(struct mwv207_pipe *mpipe, + struct mwv207_job *mjob) +{ + struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); + struct pipe_3d_fence *fence; + u32 *last_tail, *start; + u32 size, event; + + size = ALIGN(mjob->cmd_size, 8) + 256; + last_tail = pipe->tail; + start = pipe_3d_wait_for_space(pipe, size); + if (start == NULL) { + pr_err("mwv207: engine 3d is stuck"); + + return ERR_PTR(-EBUSY); + } + memcpy_toio(start, mjob->cmds, mjob->cmd_size); + pipe->tail = start + mjob->cmd_size / 4; + + pipe_3d_loadstate(pipe, 0x0e03, 0xc63); + pipe_3d_loadstate(pipe, 0x594, 0x41); + + pipe_3d_sem(pipe, 0x7, 0x1); + pipe_3d_stall(pipe, 0x7, 0x1); + pipe_3d_loadstate(pipe, 0x502e, 0x1); + pipe_3d_loadstate(pipe, 0x502b, 0x3); + pipe_3d_sem(pipe, 0x10, 0x1); + pipe_3d_stall(pipe, 0x10, 0x1); + pipe_3d_loadstate(pipe, 0x502e, 0x0); + + + fence = kzalloc(sizeof(struct pipe_3d_fence), GFP_KERNEL); + if (!fence) { + pipe->tail = last_tail; + pr_err("mwv207: failed to alloc memory for 3d pipe"); + + return ERR_PTR(-ENOMEM); + } + dma_fence_init(&fence->base, &pipe_3d_fence_ops, &pipe->fence_lock, + pipe->fence_ctx, ++pipe->next_fence); + fence->rpos = pipe->tail; + fence->pipe = pipe; + event = pipe_3d_event_push(pipe, &fence->base); + + + pipe_3d_loadstate(pipe, 0x502e, 0x1); + pipe_3d_loadstate(pipe, 0x50ce, 0xf); + pipe_3d_loadstate(pipe, 0x0e01, 0x80 | event); + pipe_3d_loadstate(pipe, 0x502e, 0x0); + + + pipe_3d_wl(pipe); + BUG_ON(pipe_3d_ptr_span(pipe->tail, start) > size); + pipe_3d_wtol(pipe, last_tail - 4, pipe_3d_gpu_addr(pipe, start), + pipe_3d_ptr_span(pipe->tail, start)); + return &fence->base; +} + +static void mwv207_pipe_3d_dump_state(struct mwv207_pipe *mpipe) +{ + u32 state0, addr0; + u32 state1, addr1; + int i; + + state0 = pipe_read(mpipe, 0x660); + addr0 = pipe_read(mpipe, 0x664); + for (i = 0; i < 500; ++i) { + state1 = pipe_read(mpipe, 0x660); + addr1 = pipe_read(mpipe, 0x664); + if (state1 != state0 || addr1 != addr0) + break; + } + + if (state1 != state0) + pr_info("%s state changing, s0: 0x%08x, s1: 0x%08x", mpipe->fname, state0, state1); + pr_info("%s current stat: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x660)); + + if (addr1 != addr0) + pr_info("%s addr changing, a0: 0x%08x, a1: 0x%08x", mpipe->fname, addr0, addr1); + pr_info("%s current addr: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x664)); + + pr_info("%s current cmdl: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x668)); + pr_info("%s current cmdh: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x66c)); +} + +static irqreturn_t mwv207_pipe_3d_isr(int irq_unused, void *dev_id) +{ + struct mwv207_pipe_3d *pipe = dev_id; + struct dma_fence *fence; + u32 event, intr; + + intr = pipe_3d_read(pipe, 0x10); + if (unlikely(!intr)) { + pr_warn("mwv207: 3d interrupt with no event"); + return IRQ_NONE; + } + if (unlikely(intr & 0x80000000)) { + pr_warn("mwv207: 3d axi bus error"); + intr &= ~0x80000000; + } + if (unlikely(intr & 0x40000000)) { + pr_warn("mwv207: 3d mmu error"); + intr &= ~0x40000000; + } + while ((event = ffs(intr))) { + event -= 1; + intr &= ~(1 << event); + + fence = pipe_3d_event_pop_irq(pipe, event); + if (!fence) { + pr_warn("unexpected event: %d", event); + continue; + } + + if (fence_after(fence->seqno, pipe->completed_fence)) { + struct pipe_3d_fence *pipe_fence = to_pipe_3d_fence(fence); + + pipe->completed_fence = fence->seqno; + pipe->head = pipe_fence->rpos; + } + mwv207_devfreq_record_idle(&pipe->base); + dma_fence_signal(fence); + dma_fence_put(fence); + } + return IRQ_HANDLED; +} + +static void mwv207_pipe_3d_destroy(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); + struct mwv207_bo *jbo; + int ret; + + free_irq(pipe->irq, pipe); + pipe_3d_stop(pipe); + + jbo = pipe->ringbuf_bo; + ret = mwv207_bo_reserve(jbo, true); + if (ret) { + pr_info("failed to reserve bo"); + return; + } + mwv207_bo_kunmap_reserved(jbo); + mwv207_bo_unpin_reserved(jbo); + mwv207_bo_unreserve(jbo); + mwv207_bo_unref(jbo); + + mwv207_devfreq_unregister(mpipe); +} + +static unsigned long pipe_3d_max_freq_get(struct mwv207_device *jdev) +{ + unsigned long freq; + + switch (jdev->base.pdev->subsystem_device) { + case 0x9103: + freq = 600; + break; + case 0x9210: + case 0x9211: + freq = 800; + break; + case 0x9101: + case 0x9102: + case 0x910A: + case 0x910B: + case 0x910C: + case 0x920C: + case 0x930B: + freq = 1000; + break; + case 0x9200: + case 0x920A: + case 0x920B: + case 0x9230: + case 0x9231: + case 0x930A: + case 0x930C: + freq = 1200; + break; + default: + freq = 0x258; + break; + } + + return freq; +} + +struct mwv207_pipe *mwv207_pipe_3d_create(struct mwv207_device *jdev, int unit, u32 regbase, + const char *fname) +{ + struct mwv207_pipe_3d *pipe; + struct mwv207_bo *jbo; + void *logical; + int ret; + + if (jdev->lite && unit) + return NULL; + + pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_3d), GFP_KERNEL); + if (!pipe) + return NULL; + + pipe->base.pll_id = unit ? MWV207_PLL_GU3D1 : MWV207_PLL_GU3D0; + pipe->base.jdev = jdev; + pipe->base.fname = fname; + pipe->base.regbase = jdev->mmio + regbase; + pipe->base.iosize = 16 * 1024; + pipe->base.submit = mwv207_pipe_3d_submit; + pipe->base.reset = mwv207_pipe_3d_reset; + pipe->base.destroy = mwv207_pipe_3d_destroy; + pipe->base.dump_state = mwv207_pipe_3d_dump_state; + + pipe->unit = unit; + pipe->fence_ctx = dma_fence_context_alloc(1); + spin_lock_init(&pipe->fence_lock); + spin_lock_init(&pipe->event_lock); + + ret = mwv207_devfreq_register(&pipe->base, pipe_3d_max_freq_get(jdev)); + if (ret) + pipe->base.devfreq = NULL; + + ret = mwv207_bo_create(jdev, 0x40000, 0x1000, + ttm_bo_type_kernel, 0x2, (1<<0), + &jbo); + if (ret) + goto unregister_devfreq; + + ret = mwv207_bo_reserve(jbo, true); + if (ret) + goto free_bo; + + ret = mwv207_bo_pin_reserved(jbo, 0x2); + if (ret) + goto unreserve_bo; + + ret = mwv207_bo_kmap_reserved(jbo, &logical); + if (ret) + goto unpin_bo; + + pipe->ringbuf_bo = jbo; + + + pipe->ringbuf = (u32 *)logical; + pipe->ringbuf_gpu_addr = mwv207_bo_gpu_phys(jbo); + pipe->end = pipe->ringbuf + (0x40000 / 4); + + mwv207_pipe_3d_reset(&pipe->base); + + pipe->irq = irq_find_mapping(jdev->irq_domain, 19 + unit); + if (pipe->irq == 0) { + pr_err("mwv207: failed to create 3D irq mapping"); + goto unmap_bo; + } + + ret = request_irq(pipe->irq, mwv207_pipe_3d_isr, 0, fname, pipe); + if (ret) { + pr_err("mwv207: failed to request 3d irq"); + goto unmap_bo; + } + + mwv207_bo_unreserve(jbo); + return &pipe->base; +unmap_bo: + mwv207_bo_kunmap_reserved(jbo); +unpin_bo: + mwv207_bo_unpin_reserved(jbo); +unreserve_bo: + mwv207_bo_unreserve(jbo); +free_bo: + mwv207_bo_unref(pipe->ringbuf_bo); +unregister_devfreq: + mwv207_devfreq_unregister(&pipe->base); + return NULL; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_codec_common.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_codec_common.c new file mode 100644 index 0000000000000000000000000000000000000000..ca7e8b2c601f2ea59be0a1566924779984338885 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_codec_common.c @@ -0,0 +1,87 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_pipe_codec_common.h" + +static void pipe_codec_sw_pp_submit_ex(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, + u64 vram, u32 reg, int nr) +{ + if (sw_pp->wb_cnt >= 0x10) { + dev_dbg(pipe->jdev->dev, "mwv207: too much write back entry"); + return; + } + + sw_pp->wb[sw_pp->wb_cnt].vram = vram; + sw_pp->wb[sw_pp->wb_cnt].reg = reg; + sw_pp->wb[sw_pp->wb_cnt].nr = nr; + + sw_pp->wb_cnt++; + sw_pp->pending = true; +} + +void pipe_codec_sw_pp_reset(struct pipe_codec_sw_pp *sw_pp) +{ + sw_pp->wb_cnt = 0; +} + +void pipe_codec_sw_pp_excute(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe) +{ + int i, j; + + if (!sw_pp->pending) + return; + + for (i = 0; i < sw_pp->wb_cnt; i++) { + for (j = 0; j < sw_pp->wb[i].nr && sw_pp->wb[i].reg + j * 4 <= pipe->iosize - 4; j++) + sw_pp->wb_buf[j] = pipe_read(pipe, sw_pp->wb[i].reg + j * 4); + + if (!j) + continue; + + jdev_write_vram(pipe->jdev, sw_pp->wb[i].vram, &sw_pp->wb_buf[0], j * 4); + } + + + wmb(); + + sw_pp->wb_cnt = 0; + sw_pp->pending = false; +} + +void pipe_codec_sw_pp_submit(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, + struct mwv207_job *mjob, int pos, int *cmdlen) +{ + int nr, reg; + u64 vram; + u32 cmd; + + *cmdlen = 16; + + if (pos + 16 > mjob->cmd_size) { + dev_dbg(pipe->jdev->dev, + "mwv207: cmd %d write back out of range", pos); + return; + } + + cmd = *(u32 *)(mjob->cmds + pos); + reg = (cmd & 0xffff) * 4; + nr = (cmd >> 16) & 0x3ff; + if (nr == 0) + nr = 1024; + + vram = *(u64 *)(mjob->cmds + pos + 8); + pipe_codec_sw_pp_submit_ex(sw_pp, pipe, vram, reg, nr); +} + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_codec_common.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_codec_common.h new file mode 100644 index 0000000000000000000000000000000000000000..c00b1a1c5796393eb6f0c14e073ac92009a0211a --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_codec_common.h @@ -0,0 +1,38 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_sched.h" + +#define MAX(a, b) ((a) > (b) ? (a) : (b)) + +struct pipe_codec_wb_entry { + u64 vram; + u32 reg; + u32 nr; +}; + + +struct pipe_codec_sw_pp { + struct pipe_codec_wb_entry wb[0x10]; + u32 wb_buf[MAX(0x1F4,0x1F7)]; + int wb_cnt; + bool pending; +}; + +void pipe_codec_sw_pp_reset(struct pipe_codec_sw_pp *sw_pp); +void pipe_codec_sw_pp_excute(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe); +void pipe_codec_sw_pp_submit(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, + struct mwv207_job *mjob, int pos, int *cmdlen); + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_dec.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_dec.c new file mode 100644 index 0000000000000000000000000000000000000000..e5f94fc718a609fad660899cdae1ac38db4df865 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_dec.c @@ -0,0 +1,264 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include "mwv207_pipe_codec_common.h" + +#define to_dec_pipe(pipe) container_of(pipe, struct mwv207_pipe_dec, base) +struct pipe_dec_fence; +struct mwv207_pipe_dec { + struct mwv207_pipe base; + + u64 fence_ctx; + u64 fence_seqno; + spinlock_t fence_lock; + + struct pipe_dec_fence *current_fence; + struct task_struct *poll_thread; + struct pipe_codec_sw_pp sw_pp; +}; + +#define to_pipe_dec_fence(f) container_of(f, struct pipe_dec_fence, base) +struct pipe_dec_fence { + struct dma_fence base; + struct mwv207_pipe_dec *pipe; + struct list_head node; +}; + +static inline void pipe_dec_write(struct mwv207_pipe_dec *pipe, u32 reg, u32 value) +{ + pipe_write(&pipe->base, reg, value); +} + +static inline u32 pipe_dec_read(struct mwv207_pipe_dec *pipe, u32 reg) +{ + return pipe_read(&pipe->base, reg); +} + +static const char *pipe_dec_fence_get_driver_name(struct dma_fence *fence) +{ + return "mwv207"; +} + +static const char *pipe_dec_fence_get_timeline_name(struct dma_fence *fence) +{ + return to_pipe_dec_fence(fence)->pipe->base.fname; +} + +static void pipe_dec_fence_release(struct dma_fence *fence) +{ + struct pipe_dec_fence *f = to_pipe_dec_fence(fence); + + kfree_rcu(f, base.rcu); +} + +static const struct dma_fence_ops pipe_dec_fence_ops = { + .get_driver_name = pipe_dec_fence_get_driver_name, + .get_timeline_name = pipe_dec_fence_get_timeline_name, + .release = pipe_dec_fence_release, +}; + +static void pipe_dec_stat_reset(struct mwv207_pipe_dec *pipe, u32 stat) +{ + pipe_dec_write(pipe, 0x4, 0x0); +} + +static int pipe_dec_polling(void *priv) +{ + struct mwv207_pipe_dec *pipe = priv; + struct pipe_dec_fence *fence; + u32 stat; + + set_freezable(); + while (!kthread_should_stop()) { + usleep_range(1000, 1001); + try_to_freeze(); + + + fence = smp_load_acquire(&pipe->current_fence); + if (fence == NULL) + continue; + + stat = pipe_dec_read(pipe, 0x4); + if ((stat & 0x1100) != 0x1100) + continue; + + pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); + pipe_dec_stat_reset(pipe, stat); + + + smp_store_release(&pipe->current_fence, NULL); + + dma_fence_signal(&fence->base); + dma_fence_put(&fence->base); + } + + return 0; +} + +static void mwv207_pipe_dec_reset(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); + struct pipe_dec_fence *fence; + u32 stat; + int i; + + pipe_codec_sw_pp_reset(&pipe->sw_pp); + + stat = pipe_dec_read(pipe, 0x4); + if (stat & 0x1) + pipe_dec_write(pipe, 0x4, + 0x20 | 0x30); + + pipe_dec_write(pipe, 0x4, 0); + pipe_dec_write(pipe, 0x8, 0x454); + + + for (i = 12; i < pipe->base.iosize; i += 0x4) + pipe_dec_write(pipe, i, 0); + + + fence = smp_load_acquire(&pipe->current_fence); + if (fence) { + dma_fence_put(&fence->base); + + smp_store_release(&pipe->current_fence, NULL); + } +} + +static struct dma_fence *mwv207_pipe_dec_submit(struct mwv207_pipe *mpipe, + struct mwv207_job *mjob) +{ + struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); + struct pipe_dec_fence *fence; + int i, nr, pos, cmdlen; + bool hw_run = 0; + u32 cmd, reg; + + /* sanity check, there should be no previous job. + * acquire pairs with release in polling thread + */ + fence = smp_load_acquire(&pipe->current_fence); + if (fence) + return ERR_PTR(-EBUSY); + + + for (pos = 0; pos <= mjob->cmd_size - 4; pos += cmdlen) { + cmd = *(u32 *)(mjob->cmds + pos); + switch ((cmd >> 27) & 0x1f) { + case 0x01: + if ((cmd >> 26) & 0x1) + return ERR_PTR(-EINVAL); + reg = (cmd & 0xffff) * 4; + nr = (cmd >> 16) & 0x3ff; + if (nr == 0) + nr = 1024; + for (i = pos + 4; i <= pos + nr * 4 + && i <= mjob->cmd_size - 4 + && reg <= pipe->base.iosize - 4; + i += 4, reg += 4) { + if (reg == 4) { + pipe_dec_read(pipe, 0x4); + hw_run = (*(u32 *)(mjob->cmds + i)) & 0x1; + + mb(); + } + pipe_dec_write(pipe, reg, *(u32 *)(mjob->cmds + i)); + } + + if (i <= pos + nr * 4) + dev_dbg(mpipe->jdev->dev, + "mwv207: invalid dec register writes dropped"); + + cmdlen = ALIGN(4 + nr * 4, 8); + break; + case 0x02: + pipe_codec_sw_pp_submit(&pipe->sw_pp, &pipe->base, mjob, pos, &cmdlen); + break; + default: + + return ERR_PTR(-EINVAL); + } + } + + + fence = kzalloc(sizeof(struct pipe_dec_fence), GFP_KERNEL); + if (!fence) + return ERR_PTR(-ENOMEM); + fence->pipe = pipe; + dma_fence_init(&fence->base, &pipe_dec_fence_ops, &pipe->fence_lock, + pipe->fence_ctx, ++pipe->fence_seqno); + + if (hw_run) { + dma_fence_get(&fence->base); + + smp_store_release(&pipe->current_fence, fence); + } else { + pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); + dma_fence_signal(&fence->base); + } + + return &fence->base; +} + +static void mwv207_pipe_dec_dump_state(struct mwv207_pipe *mpipe) +{ + pr_info("%s irq state reg: 0x%08x", mpipe->fname, + pipe_read(mpipe, 0x4)); +} + +static void mwv207_pipe_dec_destroy(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); + + kthread_stop(pipe->poll_thread); +} + +struct mwv207_pipe *mwv207_pipe_dec_create(struct mwv207_device *jdev, int unit, u32 regbase, + const char *fname) +{ + struct mwv207_pipe_dec *pipe; + + if (jdev->lite && unit) + return NULL; + + pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_dec), GFP_KERNEL); + if (!pipe) + return NULL; + + pipe->base.jdev = jdev; + pipe->base.fname = fname; + pipe->base.regbase = jdev->mmio + regbase; + pipe->base.iosize = 0x1F7 * 4; + pipe->base.submit = mwv207_pipe_dec_submit; + pipe->base.reset = mwv207_pipe_dec_reset; + pipe->base.destroy = mwv207_pipe_dec_destroy; + pipe->base.dump_state = mwv207_pipe_dec_dump_state; + + spin_lock_init(&pipe->fence_lock); + pipe->fence_ctx = dma_fence_context_alloc(1); + pipe->fence_seqno = 0; + + mwv207_pipe_dec_reset(&pipe->base); + + pipe->poll_thread = kthread_run(pipe_dec_polling, pipe, "dec_polling"); + if (IS_ERR(pipe->poll_thread)) + return NULL; + + return &pipe->base; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_dma.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_dma.c new file mode 100644 index 0000000000000000000000000000000000000000..3729aeb01ecf8652e533a60908a30b592a3efa4c --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_dma.c @@ -0,0 +1,416 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include "mwv207_bo.h" +#include "mwv207_sched.h" + +#undef MWV207_DMA_DEBUG + + +#define DMA_TS_ALIGNED(size, alignment) (((size) >= (alignment)) ? ((size) / (alignment) - 1) : 0) +#define DMA_CTL_NOT_ALIGNED ((1UL<<(63)) \ + | (1UL<<(58)) \ + | (1UL<<(30)) \ + | (1UL<<(38)) \ + | (1UL<<(47)) \ + | ((32ul & (0xFF))<<(39)) \ + | ((32ul & (0xFF))<<(48)) \ + | ((0UL & (0x7))<<(8)) \ + | ((0UL & (0x7))<<(11))) + +#define DMA_CTL_ALIGNED(a) ((1UL<<(63)) \ + | (1UL<<(58)) \ + | (1UL<<(30)) \ + | (1UL<<(38)) \ + | (1UL<<(47)) \ + | ((32ul & (0xFF))<<(39)) \ + | ((32ul & (0xFF))<<(48)) \ + | (((((a) == 64)?6UL:5UL) & (0x7))<<(8)) \ + | (((((a) == 64)?6UL:5UL) & (0x7))<<(11))) + +#define mwv207_timed_loop(tick, cond, timeout) \ + for ((tick) = jiffies; (cond) && time_before(jiffies, (tick) + msecs_to_jiffies(timeout));) + +struct mwv207_lli { + u64 sar; + u64 dar; + u32 ts; + u32 resv1; + u64 llp; + u64 ctl; + u32 sstat; + u32 dstat; + u64 llpstat; + u32 resv2; + u32 resv3; +}; + +#define to_dma_pipe(pipe) container_of(pipe, struct mwv207_pipe_dma, base) +struct mwv207_pipe_dma { + struct mwv207_pipe base; + int unit; + u32 alignment; + struct mwv207_lli *lli; + struct mwv207_lli *last_lli; + dma_addr_t lli_bus_addr; + int cur_idx; + + bool coherent; +}; + +struct mwv207_dma_cursor { + bool is_vram; + u64 line_pos; + u64 cur_pos; + + + dma_addr_t *dma_address; + u64 nr_pages; + + u64 width; + u64 stride; +}; +static inline void pipe_dma_write(struct mwv207_pipe_dma *pipe, u32 reg, u32 value) +{ + pipe_write(&pipe->base, reg, value); +} + +static inline u32 pipe_dma_read(struct mwv207_pipe_dma *pipe, u32 reg) +{ + return pipe_read(&pipe->base, reg); +} + +static inline void pipe_dma_chan_write(struct mwv207_pipe_dma *pipe, int chan, u32 reg, u32 val) +{ + pipe_dma_write(pipe, chan * 0x200 + reg, val); +} + +static inline u32 pipe_dma_chan_read(struct mwv207_pipe_dma *pipe, int chan, u32 reg) +{ + return pipe_dma_read(pipe, chan * 0x200 + reg); +} + +static inline int pipe_dma_chan_done(struct mwv207_pipe_dma *pipe, int chan) +{ + u32 status; + + if (pipe->last_lli->ctl & (1UL << (63))) + return 0; + + status = pipe_dma_chan_read(pipe, chan, (0x188)); + return !!(status & (1 << (1))); +} + +static inline void pipe_dma_chan_clear(struct mwv207_pipe_dma *pipe, int chan) +{ + pipe_dma_chan_write(pipe, chan, (0x198), 1 << (1)); +} + +static inline int pipe_dma_stop(struct mwv207_pipe_dma *pipe) +{ + pr_info("%s TBD", __func__); + return 0; +} + +static void mwv207_pipe_dma_reset(struct mwv207_pipe *mpipe) +{ + pr_info("%s todo", __func__); +} + +static void pipe_dma_commit(struct mwv207_pipe_dma *pipe) +{ + unsigned long tick; + int chan = 0; + u64 llp; + + if (pipe->cur_idx == 0) + return; + + pipe->last_lli = &pipe->lli[pipe->cur_idx - 1]; + pipe->last_lli->ctl |= (1UL << (62)); + + + mb(); + + + pipe_dma_chan_write(pipe, chan, (0x120), + ((0x3)<<(2)) + |((0x3)<<(0))); + pipe_dma_chan_write(pipe, chan, (0x124), 0x3b8e0000); + + + llp = pipe->lli_bus_addr + 0x800000000ULL; + pipe_dma_chan_write(pipe, chan, (0x128), llp & 0xFFFFFFFF); + pipe_dma_chan_write(pipe, chan, (0x12C), llp >> 32); + + + pipe_dma_write(pipe, (0x10), + (1 << (1)) + |(1 << (0))); + + + pipe_dma_write(pipe, (0x18), + ((1<cur_idx = 0; +} + +static void pipe_dma_fill_lli(struct mwv207_pipe_dma *pipe, u64 src, u64 dst, u64 len) +{ + struct mwv207_lli *lli; + + if (pipe->cur_idx >= (0x400000 / sizeof(struct mwv207_lli))) + pipe_dma_commit(pipe); + + lli = &pipe->lli[pipe->cur_idx]; + lli->sar = src; + lli->dar = dst; + + if (IS_ALIGNED(src, pipe->alignment) && + IS_ALIGNED(dst, pipe->alignment) && + IS_ALIGNED(len, pipe->alignment)) { + lli->ts = DMA_TS_ALIGNED(len, pipe->alignment); + lli->ctl = DMA_CTL_ALIGNED(pipe->alignment); + } else { + lli->ts = ((len) - 1); + lli->ctl = DMA_CTL_NOT_ALIGNED; + } + +#ifdef MWV207_DMA_DEBUG + { + pr_info("[dma]: lli[%04d] sar = 0x%010llx", pipe->cur_idx, lli->sar); + pr_info("[dma]: lli[%04d] dar = 0x%010llx", pipe->cur_idx, lli->dar); + pr_info("[dma]: lli[%04d] ts = 0x%08x", pipe->cur_idx, lli->ts); + pr_info("[dma]: lli[%04d] llp = 0x%010llx", pipe->cur_idx, lli->llp); + pr_info("[dma]: lli[%04d] ctl = 0x%010llx", pipe->cur_idx, lli->ctl); + } +#endif + pipe->cur_idx++; +} + +static void mwv207_cursor_init(struct mwv207_dma_cursor *cursor, struct mwv207_dma_loc *loc, + u64 width, u64 stride) +{ + cursor->width = width; + cursor->stride = stride; + cursor->is_vram = (((loc->pg_nr_type) >> 63) == 0); + if (cursor->is_vram) { + cursor->line_pos = loc->base + loc->offset; + cursor->cur_pos = cursor->line_pos; + cursor->dma_address = NULL; + cursor->nr_pages = ((loc->pg_nr_type) & ~(1ULL << 63)); + } else { + cursor->line_pos = loc->offset; + cursor->cur_pos = cursor->line_pos; + cursor->dma_address = (dma_addr_t *)loc->base; + cursor->nr_pages = ((loc->pg_nr_type) & ~(1ULL << 63)); + } +} + +static void mwv207_cursor_reset(struct mwv207_dma_cursor *cursor, struct mwv207_dma_loc *loc) +{ + if (cursor->is_vram) { + cursor->line_pos = loc->base + loc->offset; + cursor->cur_pos = cursor->line_pos; + } else { + cursor->line_pos = loc->offset; + cursor->cur_pos = cursor->line_pos; + } +} + +static inline u64 cursor_seg_len(struct mwv207_dma_cursor *cursor) +{ + u64 len = cursor->line_pos + cursor->width - cursor->cur_pos; + u64 offset, idx, contig_len; + + if (cursor->is_vram) + return len; + offset = cursor->cur_pos & (PAGE_SIZE - 1); + idx = cursor->cur_pos >> PAGE_SHIFT; + + contig_len = PAGE_SIZE - offset; + while (contig_len < len && + idx + 1 < cursor->nr_pages && + cursor->dma_address[idx] + PAGE_SIZE == cursor->dma_address[idx + 1]) { + contig_len += PAGE_SIZE; + idx++; + } + return min_t(u64, len, contig_len); +} + +static inline u64 cursor_axi(struct mwv207_dma_cursor *cursor) +{ + u64 idx, offset; + + if (cursor->is_vram) + return cursor->cur_pos; + + idx = cursor->cur_pos >> PAGE_SHIFT; + offset = cursor->cur_pos & (PAGE_SIZE - 1); + return 0x800000000ULL + cursor->dma_address[idx] + offset; +} + +static inline void cursor_advance(struct mwv207_dma_cursor *cursor, u64 len) +{ + BUG_ON(cursor->cur_pos + len > cursor->line_pos + cursor->width); + + if (cursor->cur_pos + len == cursor->line_pos + cursor->width) { + cursor->line_pos += cursor->stride; + cursor->cur_pos = cursor->line_pos; + } else + cursor->cur_pos += len; +} + +static void pipe_dma_flush(struct mwv207_pipe_dma *pipe, + struct mwv207_dma_cursor *cursor, u64 size) +{ + u64 remain, len; + + if (cursor->is_vram || pipe->coherent) + return; + + for (remain = size; remain > 0; remain -= len) { + len = min_t(u64, cursor_seg_len(cursor), remain); + dma_sync_single_for_device(pipe->base.jdev->dev, + cursor_axi(cursor) - 0x800000000ULL, + len, DMA_TO_DEVICE); + cursor_advance(cursor, len); + } +} + +static void pipe_dma_invalidate(struct mwv207_pipe_dma *pipe, + struct mwv207_dma_cursor *cursor, u64 size) +{ + u64 remain, len; + + if (cursor->is_vram || pipe->coherent) + return; + + for (remain = size; remain > 0; remain -= len) { + len = min_t(u64, cursor_seg_len(cursor), remain); + dma_sync_single_for_cpu(pipe->base.jdev->dev, + cursor_axi(cursor) - 0x800000000ULL, + len, DMA_FROM_DEVICE); + cursor_advance(cursor, len); + } +} + +static struct dma_fence *mwv207_pipe_dma_submit(struct mwv207_pipe *mpipe, + struct mwv207_job *mjob) +{ + struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); + struct mwv207_dma_cmd *cmd = (struct mwv207_dma_cmd *)mjob->cmds; + struct mwv207_dma_cursor src, dst; + u64 remain, len; + + BUG_ON(mjob->cmd_size != sizeof(struct mwv207_dma_cmd)); + + + mwv207_cursor_init(&src, &cmd->src, cmd->width, cmd->src.stride); + pipe_dma_flush(pipe, &src, cmd->width * cmd->height); + + mwv207_cursor_reset(&src, &cmd->src); + mwv207_cursor_init(&dst, &cmd->dst, cmd->width, cmd->dst.stride); + for (remain = cmd->width * cmd->height; remain > 0; remain -= len) { + len = min_t(u64, cursor_seg_len(&src), 0x400000); + len = min_t(u64, cursor_seg_len(&dst), len); + len = min_t(u64, len, remain); + + pipe_dma_fill_lli(pipe, cursor_axi(&src), cursor_axi(&dst), len); + + cursor_advance(&src, len); + cursor_advance(&dst, len); + } + pipe_dma_commit(pipe); + + + mwv207_cursor_reset(&dst, &cmd->dst); + pipe_dma_invalidate(pipe, &dst, cmd->width * cmd->height); + + return dma_fence_get_stub(); +} + +static void mwv207_pipe_dma_dump_state(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); + pr_info("%s todo: %p", __func__, pipe); +} + +static void mwv207_pipe_dma_destroy(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); + + pr_info("%s todo: %p", __func__, pipe); +} + +struct mwv207_pipe *mwv207_pipe_dma_create(struct mwv207_device *jdev, int unit, u32 regbase, + const char *fname) +{ + struct mwv207_pipe_dma *pipe; + u64 llp; + int i; + + pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_dma), GFP_KERNEL); + if (!pipe) + return NULL; + + pipe->base.jdev = jdev; + pipe->base.fname = fname; + pipe->base.regbase = jdev->mmio + regbase; + pipe->base.iosize = 16 * 1024; + pipe->base.submit = mwv207_pipe_dma_submit; + pipe->base.reset = mwv207_pipe_dma_reset; + pipe->base.destroy = mwv207_pipe_dma_destroy; + pipe->base.dump_state = mwv207_pipe_dma_dump_state; + + pipe->coherent = true; + + pipe->alignment = jdev->lite ? 32 : 64; + pipe->unit = unit; + + pipe->lli = dmam_alloc_coherent(jdev->dev, + sizeof(struct mwv207_lli) * (0x400000 / sizeof(struct mwv207_lli)), + &pipe->lli_bus_addr, GFP_KERNEL); + if (!pipe->lli) + return NULL; + + memset(pipe->lli, 0, sizeof(struct mwv207_lli) * (0x400000 / sizeof(struct mwv207_lli))); + llp = pipe->lli_bus_addr + 0x800000000ULL; + for (i = 0; i < (0x400000 / sizeof(struct mwv207_lli)); i++) { + llp += sizeof(struct mwv207_lli); + pipe->lli[i].llp = llp; + } + pipe->cur_idx = 0; + + mwv207_pipe_dma_reset(&pipe->base); + return &pipe->base; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_enc.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_enc.c new file mode 100644 index 0000000000000000000000000000000000000000..2978bcdcd9b1db8b373bfc8e63e38193a0f4355b --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_pipe_enc.c @@ -0,0 +1,266 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include "mwv207_pipe_codec_common.h" + +#define JPIPE_STATUS_ALL \ + (0x1000 | 0x200 | \ + 0x100 | 0x080 | \ + 0x040 | 0x020 | \ + 0x010 | 0x008 | 0x004) + +#define to_enc_pipe(pipe) container_of(pipe, struct mwv207_pipe_enc, base) +struct pipe_enc_fence; +struct mwv207_pipe_enc { + struct mwv207_pipe base; + + u64 fence_ctx; + u64 fence_seqno; + spinlock_t fence_lock; + + struct pipe_enc_fence *current_fence; + struct task_struct *poll_thread; + struct pipe_codec_sw_pp sw_pp; +}; + +#define to_pipe_enc_fence(f) container_of(f, struct pipe_enc_fence, base) +struct pipe_enc_fence { + struct dma_fence base; + struct mwv207_pipe_enc *pipe; + struct list_head node; +}; + +static inline void pipe_enc_write(struct mwv207_pipe_enc *pipe, u32 reg, u32 value) +{ + pipe_write(&pipe->base, reg, value); +} + +static inline u32 pipe_enc_read(struct mwv207_pipe_enc *pipe, u32 reg) +{ + return pipe_read(&pipe->base, reg); +} + +static const char *pipe_enc_fence_get_driver_name(struct dma_fence *fence) +{ + return "mwv207"; +} + +static const char *pipe_enc_fence_get_timeline_name(struct dma_fence *fence) +{ + return to_pipe_enc_fence(fence)->pipe->base.fname; +} + +static void pipe_enc_fence_release(struct dma_fence *fence) +{ + struct pipe_enc_fence *f = to_pipe_enc_fence(fence); + + kfree_rcu(f, base.rcu); +} + +static const struct dma_fence_ops pipe_enc_fence_ops = { + .get_driver_name = pipe_enc_fence_get_driver_name, + .get_timeline_name = pipe_enc_fence_get_timeline_name, + .release = pipe_enc_fence_release, +}; + +static void pipe_enc_stat_reset(struct mwv207_pipe_enc *pipe, u32 stat) +{ + if (stat & 0x20) + pipe_enc_write(pipe, 0x14, 0); + + pipe_enc_write(pipe, 0x4, stat & (~0x1FD)); +} + +static int pipe_enc_polling(void *priv) +{ + struct mwv207_pipe_enc *pipe = priv; + struct pipe_enc_fence *fence; + u32 stat; + + set_freezable(); + while (!kthread_should_stop()) { + usleep_range(1000, 1001); + try_to_freeze(); + + + fence = smp_load_acquire(&pipe->current_fence); + if (fence == NULL) + continue; + + stat = pipe_enc_read(pipe, 0x4); + if (!(stat & JPIPE_STATUS_ALL)) + continue; + + pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); + pipe_enc_stat_reset(pipe, stat); + + + smp_store_release(&pipe->current_fence, NULL); + + dma_fence_signal(&fence->base); + dma_fence_put(&fence->base); + } + + return 0; +} + +static void mwv207_pipe_enc_reset(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); + struct pipe_enc_fence *fence; + int i; + + pipe_codec_sw_pp_reset(&pipe->sw_pp); + + pipe_enc_write(pipe, 0x14, 0); + + + for (i = 4; i < pipe->base.iosize; i += 0x4) + pipe_enc_write(pipe, i, 0); + + + fence = smp_load_acquire(&pipe->current_fence); + if (fence) { + dma_fence_put(&fence->base); + + smp_store_release(&pipe->current_fence, NULL); + } +} + +static struct dma_fence *mwv207_pipe_enc_submit(struct mwv207_pipe *mpipe, + struct mwv207_job *mjob) +{ + struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); + struct pipe_enc_fence *fence; + int i, nr, pos, cmdlen; + bool hw_run = 0; + u32 cmd, reg; + + /* sanity check, there should be no previous job. + * acquire pairs with release in polling thread + */ + fence = smp_load_acquire(&pipe->current_fence); + if (fence) + return ERR_PTR(-EBUSY); + + + for (pos = 0; pos <= mjob->cmd_size - 4; pos += cmdlen) { + cmd = *(u32 *)(mjob->cmds + pos); + switch ((cmd >> 27) & 0x1f) { + case 0x01: + if ((cmd >> 26) & 0x1) + return ERR_PTR(-EINVAL); + reg = (cmd & 0xffff) * 4; + nr = (cmd >> 16) & 0x3ff; + if (nr == 0) + nr = 1024; + for (i = pos + 4; i <= pos + nr * 4 + && i <= mjob->cmd_size - 4 + && reg <= pipe->base.iosize - 4; + i += 4, reg += 4) { + if (reg == 20) { + pipe_enc_read(pipe, 0x14); + hw_run = (*(u32 *)(mjob->cmds + i)) & 0x1; + + mb(); + } + pipe_enc_write(pipe, reg, *(u32 *)(mjob->cmds + i)); + } + + if (i <= pos + nr * 4) + dev_dbg(mpipe->jdev->dev, + "mwv207: invalid enc register writes dropped"); + + cmdlen = ALIGN(4 + nr * 4, 8); + break; + case 0x02: + pipe_codec_sw_pp_submit(&pipe->sw_pp, &pipe->base, mjob, pos, &cmdlen); + break; + default: + + return ERR_PTR(-EINVAL); + } + } + + + fence = kzalloc(sizeof(struct pipe_enc_fence), GFP_KERNEL); + if (!fence) + return ERR_PTR(-ENOMEM); + fence->pipe = pipe; + dma_fence_init(&fence->base, &pipe_enc_fence_ops, &pipe->fence_lock, + pipe->fence_ctx, ++pipe->fence_seqno); + + if (hw_run) { + dma_fence_get(&fence->base); + + smp_store_release(&pipe->current_fence, fence); + } else { + pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); + dma_fence_signal(&fence->base); + } + + return &fence->base; +} + +static void mwv207_pipe_enc_dump_state(struct mwv207_pipe *mpipe) +{ + pr_info("%s irq state reg: 0x%08x", mpipe->fname, + pipe_read(mpipe, 0x4)); +} + +static void mwv207_pipe_enc_destroy(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); + + kthread_stop(pipe->poll_thread); +} + +struct mwv207_pipe *mwv207_pipe_enc_create(struct mwv207_device *jdev, u32 regbase, + const char *fname) +{ + struct mwv207_pipe_enc *pipe; + + if (jdev->lite) + return NULL; + + pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_enc), GFP_KERNEL); + if (!pipe) + return NULL; + + pipe->base.jdev = jdev; + pipe->base.fname = fname; + pipe->base.regbase = jdev->mmio + regbase; + pipe->base.iosize = 0x1F4 * 4; + pipe->base.submit = mwv207_pipe_enc_submit; + pipe->base.reset = mwv207_pipe_enc_reset; + pipe->base.destroy = mwv207_pipe_enc_destroy; + pipe->base.dump_state = mwv207_pipe_enc_dump_state; + + spin_lock_init(&pipe->fence_lock); + pipe->fence_ctx = dma_fence_context_alloc(1); + pipe->fence_seqno = 0; + + mwv207_pipe_enc_reset(&pipe->base); + + pipe->poll_thread = kthread_run(pipe_enc_polling, pipe, "enc_polling"); + if (IS_ERR(pipe->poll_thread)) + return NULL; + + return &pipe->base; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_sched.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_sched.c new file mode 100644 index 0000000000000000000000000000000000000000..890dd2856e4cbc1bbe048ea50ebfb9f8127dc338 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_sched.c @@ -0,0 +1,378 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include "mwv207.h" +#include "mwv207_sched.h" +#include "mwv207_bo.h" +#include "mwv207_ctx.h" +#include "mwv207_db.h" +#include "mwv207_devfreq.h" + +static int dump_hang_job = 1; +module_param(dump_hang_job, int, 0644); +MODULE_PARM_DESC(dump_hang_job, "dump time out job"); + +struct mwv207_job *mwv207_job_alloc(void) +{ + struct mwv207_job *mjob; + + mjob = kzalloc(sizeof(*mjob), GFP_KERNEL); + if (!mjob) + return NULL; + + kref_init(&mjob->refcount); + INIT_LIST_HEAD(&mjob->tvblist); + return mjob; +} + +static void mwv207_job_fini(struct kref *kref) +{ + struct mwv207_job *mjob = container_of(kref, struct mwv207_job, refcount); + struct mwv207_tvb *mtvb; + struct mwv207_submit_cmd_dat *dat; + int i; + + dma_fence_put(mjob->fence_in); + if (mjob->base.s_fence) + drm_sched_job_cleanup(&mjob->base); + + + mwv207_for_each_mtvb(mtvb, mjob) { + for (i = 0; i < mtvb->nr_shared; ++i) + dma_fence_put(mtvb->shared[i]); + dma_fence_put(mtvb->excl); + kfree(mtvb->shared); + mwv207_bo_unref(to_jbo(mtvb->base.bo)); + } + + if (mjob->nr_cmd_dat) { + for (i = 0; i < mjob->nr_cmd_dat; ++i) { + dat = &mjob->cmd_dats[i]; + kvfree(dat->dat); + kvfree(dat->relocs); + mwv207_bo_unref(dat->jbo); + } + } + + if (mjob->ctx) + mwv207_ctx_put(mjob->ctx); + + kvfree(mjob->cmd_dats); + kvfree(mjob->mtvb); + kvfree(mjob->relocs); + kvfree(mjob->cmds); + + kfree(mjob); +} + +struct mwv207_job *mwv207_job_get(struct mwv207_job *mjob) +{ + kref_get(&mjob->refcount); + return mjob; +} + +void mwv207_job_put(struct mwv207_job *mjob) +{ + kref_put(&mjob->refcount, mwv207_job_fini); +} + +static void mwv207_sched_dump_job(struct mwv207_job *mjob) +{ + int lines, i; + u32 *cmd; + + cmd = (u32 *)mjob->cmds; + lines = (mjob->cmd_size / 4) & ~0x3; + for (i = 0; i < lines; i += 4) { + pr_info("0x%08x : %08x %08x %08x %08x", i, + cmd[i], cmd[i+1], cmd[i+2], cmd[i+3]); + } + + switch (mjob->cmd_size / 4 - lines) { + case 0: + return; + case 1: + pr_info("0x%08x : %08x", i, cmd[i]); + break; + case 2: + pr_info("0x%08x : %08x %08x", i, cmd[i], cmd[i+1]); + break; + case 3: + pr_info("0x%08x : %08x %08x %08x", i, + cmd[i], cmd[i+1], cmd[i+2]); + break; + default: + pr_err("should never happen"); + break; + + } +} + +static struct dma_fence *mwv207_sched_dependency(struct drm_sched_job *job, + struct drm_sched_entity *entity) +{ + struct mwv207_job *mjob = to_mwv207_job(job); + struct mwv207_tvb *mtvb; + struct dma_fence *fence; + int i; + + if (unlikely(mjob->fence_in)) { + fence = mjob->fence_in; + mjob->fence_in = NULL; + if (!dma_fence_is_signaled(fence)) + return fence; + dma_fence_put(fence); + } + + mwv207_for_each_mtvb(mtvb, mjob) { + if (mtvb->excl) { + fence = mtvb->excl; + mtvb->excl = NULL; + if (!dma_fence_is_signaled(fence)) + return fence; + dma_fence_put(fence); + } + + for (i = 0; i < mtvb->nr_shared; i++) { + if (!mtvb->shared[i]) + continue; + fence = mtvb->shared[i]; + mtvb->shared[i] = NULL; + if (!dma_fence_is_signaled(fence)) + return fence; + dma_fence_put(fence); + } + kfree(mtvb->shared); + mtvb->nr_shared = 0; + mtvb->shared = NULL; + } + + return NULL; +} + +static struct dma_fence *mwv207_sched_run_job(struct drm_sched_job *job) +{ + struct mwv207_sched *sched = to_mwv207_sched(job->sched); + struct dma_fence *fence; + + if (unlikely(job->s_fence->finished.error)) + return ERR_PTR(-ECANCELED); + + mwv207_devfreq_record_busy(sched->pipe); + + fence = sched->pipe->submit(sched->pipe, to_mwv207_job(job)); + if (IS_ERR_OR_NULL(fence)) + DRM_ERROR("%s: submit failed, errcode=%ld", + sched->pipe->fname, PTR_ERR(fence)); + return fence; +} + +static void mwv207_sched_timedout_job(struct drm_sched_job *job) +{ + struct mwv207_sched *sched = to_mwv207_sched(job->sched); + struct mwv207_job *mjob = to_mwv207_job(job); + struct drm_sched_job *timedout_job; + + pr_info("mwv207: job from '%s' to '%s', timed out!", + mjob->comm, sched->pipe->fname); + + drm_sched_stop(&sched->base, job); + + if (dump_hang_job) { + sched->pipe->dump_state(sched->pipe); + mwv207_sched_dump_job(mjob); + } + + drm_sched_increase_karma(job); + + sched->pipe->reset(sched->pipe); + + list_for_each_entry(timedout_job, &sched->base.ring_mirror_list, node) + mwv207_devfreq_record_idle(sched->pipe); + + drm_sched_resubmit_jobs(&sched->base); + + + drm_sched_start(&sched->base, true); +} + +static void mwv207_sched_free_job(struct drm_sched_job *job) +{ + struct mwv207_job *mjob = to_mwv207_job(job); + + mwv207_job_put(mjob); +} + +static const struct drm_sched_backend_ops mwv207_sched_ops = { + .dependency = mwv207_sched_dependency, + .run_job = mwv207_sched_run_job, + .timedout_job = mwv207_sched_timedout_job, + .free_job = mwv207_sched_free_job, +}; + +static struct drm_gpu_scheduler *mwv207_sched_create(struct mwv207_device *jdev, + unsigned int hw_submission, unsigned int hang_limit, long timeout, + struct mwv207_pipe *pipe) +{ + struct mwv207_sched *sched; + int ret; + + if (pipe == NULL) + return NULL; + + sched = devm_kzalloc(jdev->dev, sizeof(struct mwv207_sched), GFP_KERNEL); + if (!sched) + goto err; + + sched->pipe = pipe; + + ret = drm_sched_init(&sched->base, &mwv207_sched_ops, hw_submission, hang_limit, + msecs_to_jiffies(timeout), pipe->fname); + if (ret) + goto err; + + return &sched->base; +err: + sched->pipe->destroy(sched->pipe); + return NULL; +} + +static void mwv207_sched_destroy(struct drm_gpu_scheduler *sched) +{ + struct mwv207_sched *msched = to_mwv207_sched(sched); + + if (sched == NULL) + return; + + drm_sched_fini(sched); + msched->pipe->destroy(msched->pipe); +} + +int mwv207_sched_suspend(struct mwv207_device *jdev) +{ + struct mwv207_sched *sched; + int i, ret; + + + for (i = 0; i < 6; i++) { + if (!jdev->sched[i]) + continue; + sched = to_mwv207_sched(jdev->sched[i]); + + if (atomic_read(&jdev->sched[i]->hw_rq_count)) + return -EBUSY; + + ret = mwv207_devfreq_suspend(sched->pipe); + if (ret) + return ret; + } + + return 0; +} + +int mwv207_sched_resume(struct mwv207_device *jdev) +{ + struct mwv207_sched *sched; + int i, ret; + + for (i = 0; i < 6; i++) { + if (!jdev->sched[i]) + continue; + sched = to_mwv207_sched(jdev->sched[i]); + + ret = mwv207_devfreq_resume(sched->pipe); + if (ret) + dev_err(sched->pipe->dev, "devfreq resume failed: %d", ret); + + sched->pipe->reset(sched->pipe); + } + + return 0; +} + +int mwv207_sched_init(struct mwv207_device *jdev) +{ + struct mwv207_pipe *pipe; + + jdev->sched_3d = &jdev->sched[0]; + jdev->sched_dec = &jdev->sched_3d[2]; + jdev->sched_enc = &jdev->sched_dec[1]; + jdev->sched_2d = &jdev->sched_enc[1]; + jdev->sched_dma = &jdev->sched_2d[1]; + + /* ownership of pipe passed to mwv207_sched_create, don't reference + * this pipe after call to mwv207_sched_create. + * + * Note sched limit of 3d should be lower than hw event count, which + * is 30 for 91/92. otherwise pipe 3d will BUG_ON + */ + pipe = mwv207_pipe_3d_create(jdev, 0, 0x900000, "mwv207_3d0"); + jdev->sched_3d[0] = mwv207_sched_create(jdev, 30, 5, 2000, pipe); + if (jdev->sched_3d[0] == NULL) + return -ENODEV; + + pipe = mwv207_pipe_3d_create(jdev, 1, 0x910000, "mwv207_3d1"); + jdev->sched_3d[1] = mwv207_sched_create(jdev, 30, 5, 2000, pipe); + + pipe = mwv207_pipe_dec_create(jdev, 0, 0x930000, "mwv207_dec0"); + jdev->sched_dec[0] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); + if (jdev->sched_dec[0] == NULL) + goto err; + + pipe = mwv207_pipe_dec_create(jdev, 1, 0x940000, "mwv207_dec1"); + jdev->sched_dec[1] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); + + pipe = mwv207_pipe_enc_create(jdev, 0x920000, "mwv207_enc0"); + jdev->sched_enc[0] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); + + pipe = mwv207_pipe_2d_create(jdev, 0, 0x968000, "mwv207_2d0"); + jdev->sched_2d[0] = mwv207_sched_create(jdev, 30, 5, 2000, pipe); + if (jdev->sched_2d[0] == NULL) + goto err; + + pipe = mwv207_pipe_dma_create(jdev, 0, 0x9d0000, "mwv207_dma0"); + jdev->sched_dma[0] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); + if (jdev->sched_dma[0] == NULL) + goto err; + + jdev->nr_3d = jdev->sched_3d[1] ? 2 : 1; + jdev->nr_enc = jdev->sched_enc[0] ? 1 : 0; + jdev->nr_dec = jdev->sched_dec[1] ? 2 : 1; + jdev->nr_2d = 1; + jdev->nr_dma = 1; + + mwv207_db_add(jdev, DRM_MWV207_ACTIVE_3D_NR, jdev->nr_3d); + mwv207_db_add(jdev, DRM_MWV207_ACTIVE_ENC_NR, jdev->nr_enc); + mwv207_db_add(jdev, DRM_MWV207_ACTIVE_DEC_NR, jdev->nr_dec); + mwv207_db_add(jdev, DRM_MWV207_ACTIVE_2D_NR, jdev->nr_2d); + mwv207_db_add(jdev, DRM_MWV207_ACTIVE_DMA_NR, jdev->nr_dma); + + return 0; +err: + mwv207_sched_fini(jdev); + return -ENODEV; +} + +void mwv207_sched_fini(struct mwv207_device *jdev) +{ + int i; + + for (i = 0; i < 6; ++i) { + if (!jdev->sched[i]) + continue; + mwv207_sched_destroy(jdev->sched[i]); + } +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_sched.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_sched.h new file mode 100644 index 0000000000000000000000000000000000000000..2b515ff4d015bf8f3a4384585d73deea85c3b315 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_sched.h @@ -0,0 +1,149 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_SCHED_H_TGQQ2LXS +#define MWV207_SCHED_H_TGQQ2LXS +#include +#include +#include +#include "mwv207.h" +#include "mwv207_bo.h" + +struct mwv207_submit_cmd_dat { + int nr_relocs; + int dat_size; + struct drm_mwv207_submit_reloc *relocs; + char *dat; + struct mwv207_bo *jbo; +}; + +struct mwv207_tvb { + struct ttm_validate_buffer base; + struct dma_fence *excl; + unsigned int nr_shared; + struct dma_fence **shared; +}; + +#define to_mwv207_job(job) container_of(job, struct mwv207_job, base) +struct mwv207_job { + struct drm_sched_job base; + + struct list_head tvblist; + struct mwv207_tvb *mtvb; + int nr_bos; + + struct drm_mwv207_submit_reloc *relocs; + int nr_relocs; + + struct mwv207_submit_cmd_dat *cmd_dats; + int nr_cmd_dat; + + char *cmds; + int cmd_size; + + struct dma_fence *fence_in; + + + struct mwv207_ctx *ctx; + struct drm_sched_entity *engine_entity; + + struct kref refcount; + + + bool is_dma; + + char comm[TASK_COMM_LEN]; +}; +#define mwv207_for_each_mtvb(mtvb, mjob) list_for_each_entry(mtvb, &(mjob)->tvblist, base.head) + +struct mwv207_job *mwv207_job_alloc(void); +struct mwv207_job *mwv207_job_get(struct mwv207_job *mjob); +void mwv207_job_put(struct mwv207_job *mjob); + +static inline struct mwv207_bo *mwv207_job_bo(struct mwv207_job *mjob, int idx) +{ + BUG_ON(idx >= mjob->nr_bos + mjob->nr_cmd_dat); + return to_jbo(mjob->mtvb[idx].base.bo); +} + +struct mwv207_dma_loc { + u64 base; + u64 pg_nr_type; + u64 offset; + u64 stride; +}; + + +struct mwv207_dma_cmd { + struct mwv207_dma_loc src; + struct mwv207_dma_loc dst; + u64 width; + u64 height; +}; + +struct devfreq; +#define to_mwv207_sched(sched) container_of(sched, struct mwv207_sched, base) +struct mwv207_pipe { + struct dma_fence* (*submit)(struct mwv207_pipe *pipe, struct mwv207_job *job); + void (*reset)(struct mwv207_pipe *pipe); + void (*destroy)(struct mwv207_pipe *pipe); + void (*dump_state)(struct mwv207_pipe *pipe); + struct mwv207_device *jdev; + const char *fname; + int iosize; + void __iomem *regbase; + + + struct device *dev; + struct devfreq *devfreq; + spinlock_t devfreq_lock; + int busy_count; + int pll_id; + ktime_t busy_time; + ktime_t idle_time; + ktime_t time_last_update; +}; + +struct mwv207_sched { + struct drm_gpu_scheduler base; + struct mwv207_pipe *pipe; +}; + +static inline void pipe_write(struct mwv207_pipe *pipe, u32 reg, u32 value) +{ + writel_relaxed(value, pipe->regbase + reg); +} + +static inline u32 pipe_read(struct mwv207_pipe *pipe, u32 reg) +{ + return readl(pipe->regbase + reg); +} + +int mwv207_sched_init(struct mwv207_device *jdev); +void mwv207_sched_fini(struct mwv207_device *jdev); +int mwv207_sched_suspend(struct mwv207_device *jdev); +int mwv207_sched_resume(struct mwv207_device *jdev); + +struct mwv207_pipe *mwv207_pipe_3d_create(struct mwv207_device *jdev, int unit, + u32 regbase, const char *fname); +struct mwv207_pipe *mwv207_pipe_2d_create(struct mwv207_device *jdev, int unit, + u32 regbase, const char *fname); +struct mwv207_pipe *mwv207_pipe_dec_create(struct mwv207_device *jdev, int unit, + u32 regbase, const char *fname); +struct mwv207_pipe *mwv207_pipe_enc_create(struct mwv207_device *jdev, + u32 regbase, const char *fname); +struct mwv207_pipe *mwv207_pipe_dma_create(struct mwv207_device *jdev, int unit, + u32 regbase, const char *fname); +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_submit.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_submit.c new file mode 100644 index 0000000000000000000000000000000000000000..f434b1a61fdd81af4273184dfdc8df8a4a9258a9 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_submit.c @@ -0,0 +1,638 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include "mwv207_drm.h" +#include "mwv207_submit.h" +#include "mwv207_sched.h" +#include "mwv207_ctx.h" +#include "mwv207_bo.h" +#include "mwv207_gem.h" + +static inline int mwv207_submit_select_engine(struct drm_device *dev, struct mwv207_job *mjob, + struct drm_mwv207_submit *args) +{ + struct mwv207_device *jdev = ddev_to_jdev(dev); + struct drm_sched_entity **entity_array; + int id_max, id; + + switch (args->engine_type) { + case 0: + entity_array = &mjob->ctx->entity_3d[0]; + id_max = jdev->nr_3d; + break; + case 1: + entity_array = &mjob->ctx->entity_dec[0]; + id_max = jdev->nr_dec; + break; + case 2: + entity_array = &mjob->ctx->entity_enc[0]; + id_max = jdev->nr_enc; + break; + case 3: + entity_array = &mjob->ctx->entity_2d[0]; + id_max = jdev->nr_2d; + break; + case 4: + entity_array = &mjob->ctx->entity_dma[0]; + id_max = jdev->nr_dma; + mjob->is_dma = true; + break; + + default: + id_max = 0; + } + if (id_max <= 0) + return -ENODEV; + + if (args->engine_id == 0xffffffff) + id = id_max; + else if (args->engine_id >= 0 && args->engine_id < id_max) + id = args->engine_id; + else + return -ENODEV; + mjob->engine_entity = entity_array[id]; + return 0; +} + +static int mwv207_submit_init_job_reloc(struct mwv207_job *mjob, struct drm_mwv207_submit *args) +{ + if ((int)args->nr_relocs < 0) + return -EINVAL; + mjob->nr_relocs = (int)args->nr_relocs; + if (mjob->nr_relocs == 0) + return 0; + if (args->relocs == 0) + return -EINVAL; + + mjob->relocs = kvmalloc_array(mjob->nr_relocs, + sizeof(struct drm_mwv207_submit_reloc), GFP_KERNEL); + + return copy_from_user(mjob->relocs, (void __user *)args->relocs, + sizeof(struct drm_mwv207_submit_reloc) * mjob->nr_relocs); +} + +static int mwv207_submit_init_job_bo(struct mwv207_job *mjob, + struct drm_mwv207_submit *args, struct drm_file *filp) +{ + struct drm_mwv207_bo_acc ubos_stack[32]; + struct drm_mwv207_bo_acc *ubos = ubos_stack; + struct ttm_validate_buffer *tvb; + struct drm_gem_object *gobj; + int ret = 0, i; + + if ((int)args->nr_bos < 0) + return -EINVAL; + + mjob->nr_bos = (int)args->nr_bos; + if (mjob->nr_bos == 0) { + if (mjob->nr_cmd_dat) + goto setup_mtvb; + return 0; + } + + if (!args->bos) + return -EINVAL; + + if (mjob->nr_bos > 32) + ubos = kvmalloc_array(mjob->nr_bos, sizeof(*ubos), GFP_KERNEL); + if (unlikely(!ubos)) + return -ENOMEM; + + ret = copy_from_user(ubos, (void __user *)args->bos, + mjob->nr_bos * sizeof(*ubos)); + if (ret) + goto out; +setup_mtvb: + mjob->mtvb = kvcalloc(mjob->nr_bos + mjob->nr_cmd_dat, + sizeof(struct mwv207_tvb), GFP_KERNEL); + if (!mjob->mtvb) { + ret = -ENOMEM; + goto out; + } + spin_lock(&filp->table_lock); + for (i = 0; i < mjob->nr_bos; i++) { + tvb = &mjob->mtvb[i].base; + tvb->num_shared = (ubos[i].flags & 0x00000001) ? 0 : 1; + gobj = idr_find(&filp->object_idr, ubos[i].handle); + if (unlikely(!gobj)) { + spin_unlock(&filp->table_lock); + ret = -ENOENT; + goto out; + } + tvb->bo = &mwv207_bo_ref(mwv207_bo_from_gem(gobj))->tbo; + list_add_tail(&tvb->head, &mjob->tvblist); + } + spin_unlock(&filp->table_lock); + for (i = 0; i < mjob->nr_cmd_dat; i++) { + tvb = &mjob->mtvb[mjob->nr_bos + i].base; + tvb->num_shared = 0; + tvb->bo = &mwv207_bo_ref(mjob->cmd_dats[i].jbo)->tbo; + list_add_tail(&tvb->head, &mjob->tvblist); + } +out: + if (unlikely(ubos != ubos_stack)) + kvfree(ubos); + + return ret; +} + +static int mwv207_submit_init_job_cmd(struct mwv207_job *mjob, struct drm_mwv207_submit *args) +{ + mjob->cmd_size = args->cmd_size; + if ((int)mjob->cmd_size <= 0) + return -EINVAL; + + if (mjob->cmd_size > 0x20000) + return -E2BIG; + + if (args->cmds == 0) + return -EINVAL; + + + if (mjob->is_dma) + mjob->cmds = kmalloc(args->cmd_size, GFP_KERNEL); + else + mjob->cmds = kvmalloc(args->cmd_size, GFP_KERNEL); + if (!mjob->cmds) + return -ENOMEM; + + return copy_from_user(mjob->cmds, (void __user *)args->cmds, mjob->cmd_size); +} + +static int mwv207_submit_init_job_cmd_dat(struct drm_device *dev, + struct mwv207_job *mjob, struct drm_mwv207_submit *args) +{ + struct drm_mwv207_submit_cmd_dat udats_stack[8]; + struct drm_mwv207_submit_cmd_dat *udats = udats_stack; + struct mwv207_device *jdev = ddev_to_jdev(dev); + struct mwv207_submit_cmd_dat *mdat; + int ret, i; + + if ((int)args->nr_cmd_dat < 0) + return -EINVAL; + mjob->nr_cmd_dat = args->nr_cmd_dat; + if (mjob->nr_cmd_dat == 0) + return 0; + if (args->cmd_dats == 0) + return -EINVAL; + if (mjob->nr_cmd_dat > 8) + udats = kvmalloc_array(mjob->nr_cmd_dat, + sizeof(struct drm_mwv207_submit_cmd_dat), GFP_KERNEL); + + if (unlikely(!udats)) + return -ENOMEM; + + mjob->cmd_dats = kvcalloc(mjob->nr_cmd_dat, + sizeof(struct mwv207_submit_cmd_dat), GFP_KERNEL); + if (!mjob->cmd_dats) { + ret = -ENOMEM; + goto out; + } + + ret = copy_from_user(udats, (void __user *)args->cmd_dats, + mjob->nr_cmd_dat * sizeof(struct drm_mwv207_submit_cmd_dat)); + if (ret) + goto out; + + for (i = 0; i < mjob->nr_cmd_dat; ++i) { + if ((int)udats[i].nr_relocs < 0) { + ret = -EINVAL; + goto out; + } + if ((int)udats[i].dat_size <= 0 || udats[i].dat == 0) { + ret = -EINVAL; + goto out; + } + if (udats[i].nr_relocs != 0 && udats[i].relocs == 0) { + ret = -EINVAL; + goto out; + } + if (udats[i].dat_size > 0x20000) { + ret = -E2BIG; + goto out; + } + mdat = &mjob->cmd_dats[i]; + mdat->nr_relocs = udats[i].nr_relocs; + if (mdat->nr_relocs) { + mdat->relocs = kvmalloc_array(mdat->nr_relocs, + sizeof(struct drm_mwv207_submit_reloc), GFP_KERNEL); + if (!mdat->relocs) { + ret = -ENOMEM; + goto out; + } + ret = copy_from_user(mdat->relocs, (void __user *)udats[i].relocs, + mdat->nr_relocs * sizeof(struct drm_mwv207_submit_reloc)); + if (ret) + goto out; + } + mdat->dat_size = udats[i].dat_size; + mdat->dat = kvmalloc(mdat->dat_size, GFP_KERNEL); + if (!mdat->dat) { + ret = -ENOMEM; + goto out; + } + ret = copy_from_user(mdat->dat, (void __user *)udats[i].dat, mdat->dat_size); + if (ret) + goto out; + ret = mwv207_bo_create(jdev, mdat->dat_size, 0x1000, ttm_bo_type_device, + 0x2, (1<<0), + &mdat->jbo); + if (ret) + goto out; + } + +out: + if (unlikely(udats != udats_stack)) + kvfree(udats); + return ret; +} + +static int mwv207_submit_init_job(struct drm_device *dev, struct mwv207_job *mjob, + struct drm_mwv207_submit *args, struct drm_file *filp) +{ + int ret; + + get_task_comm(mjob->comm, current); + + + mjob->ctx = mwv207_ctx_lookup(dev, filp, args->ctx); + if (!mjob->ctx) + return -ENOENT; + ret = mwv207_submit_select_engine(dev, mjob, args); + if (ret) + return ret; + ret = mwv207_submit_init_job_cmd_dat(dev, mjob, args); + if (ret) + return ret; + ret = mwv207_submit_init_job_bo(mjob, args, filp); + if (ret) + return ret; + ret = mwv207_submit_init_job_reloc(mjob, args); + if (ret) + return ret; + ret = mwv207_submit_init_job_cmd(mjob, args); + if (ret) + return ret; + + return 0; +} + +static struct mwv207_job *mwv207_submit_init(struct drm_device *dev, struct drm_file *filp, + struct drm_mwv207_submit *args) +{ + struct mwv207_job *mjob; + int ret; + + mjob = mwv207_job_alloc(); + if (!mjob) + return ERR_PTR(-ENOMEM); + + ret = mwv207_submit_init_job(dev, mjob, args, filp); + if (ret) + goto err; + + return mjob; +err: + mwv207_job_put(mjob); + return ERR_PTR(ret); +} + +static int mwv207_submit_patch_entry(struct mwv207_job *mjob, + struct drm_mwv207_submit_reloc *reloc, + struct mwv207_bo *jbo, char *dat, u32 dat_size) +{ + u64 addr, bo_size; + + if (reloc->pad) + return -EINVAL; + + bo_size = mwv207_bo_size(jbo); + if (reloc->bo_offset >= bo_size) + return -ERANGE; + addr = mwv207_bo_gpu_phys(jbo) + reloc->bo_offset; + + + switch (reloc->type & 0xffff) { + case 0: + if (reloc->cmd_offset + 8 > dat_size) + return -ERANGE; + *(u64 *)(dat + reloc->cmd_offset) = addr; + break; + case 1: + if (reloc->cmd_offset + 4 > dat_size) + return -ERANGE; + *(u32 *)(dat + reloc->cmd_offset) = addr & 0xffffffff; + break; + case 2: + if (reloc->cmd_offset + 4 > dat_size) + return -ERANGE; + *(u32 *)(dat + reloc->cmd_offset) = addr >> 32; + break; + case 3: + if (reloc->cmd_offset + 2 > dat_size) + return -ERANGE; + *(u16 *)(dat + reloc->cmd_offset) = (addr >> 16) & 0xffff; + break; + default: + return -EINVAL; + } + + return 0; +} + +static int mwv207_submit_patch_single(struct mwv207_job *mjob, + struct drm_mwv207_submit_reloc *reloc, char *dat, u32 dat_size) +{ + struct mwv207_bo *jbo; + + if (reloc->type & 0x80000000) { + if (reloc->idx >= mjob->nr_cmd_dat) + return -EINVAL; + jbo = mwv207_job_bo(mjob, reloc->idx + mjob->nr_bos); + } else { + if (reloc->idx >= mjob->nr_bos) + return -EINVAL; + jbo = mwv207_job_bo(mjob, reloc->idx); + } + + return mwv207_submit_patch_entry(mjob, reloc, jbo, dat, dat_size); +} + +static int mwv207_submit_patch_dma_entry(struct mwv207_job *mjob, + struct mwv207_dma_loc *loc, struct mwv207_bo *jbo, + u64 width, u64 height) +{ + struct mwv207_ttm_tt *gtt; + + if (loc->stride == 0 || loc->pg_nr_type != 0 || width == 0 || height == 0) + return -EINVAL; + + switch (jbo->tbo.mem.mem_type) { + case TTM_PL_VRAM: + loc->base = mwv207_bo_gpu_phys(jbo); + loc->pg_nr_type = ((jbo->tbo.num_pages) | (0ULL << 63)); + break; + case TTM_PL_TT: + gtt = to_gtt(jbo->tbo.ttm); + loc->base = (u64)gtt->ttm.dma_address; + loc->pg_nr_type = ((jbo->tbo.num_pages) | (1ULL << 63)); + break; + default: + BUG_ON(1); + break; + } + + + if (loc->offset >= mwv207_bo_size(jbo)) + return -ERANGE; + if (loc->offset + loc->stride * (height - 1) + width <= loc->offset) + return -ERANGE; + if (loc->offset + loc->stride * (height - 1) + width > mwv207_bo_size(jbo)) + return -ERANGE; + + + if ((loc->offset % loc->stride) + width > loc->stride) + return -ERANGE; + + return 0; +} + +static int mwv207_submit_patch_dma(struct drm_device *dev, struct mwv207_job *mjob) +{ + struct mwv207_bo *src_bo, *dst_bo, *jbo; + struct drm_mwv207_submit_reloc *reloc; + struct mwv207_dma_cmd *dma_cmd; + int i, ret; + + if (mjob->nr_bos != 2 || mjob->nr_relocs != 2 || mjob->nr_cmd_dat) + return -EINVAL; + if (mjob->cmd_size != sizeof(struct mwv207_dma_cmd)) + return -EINVAL; + + src_bo = dst_bo = NULL; + for (i = 0; i < mjob->nr_relocs; i++) { + reloc = &mjob->relocs[i]; + if (reloc->type & 0x80000000) + return -EINVAL; + if ((reloc->type & 0xffff) != 0) + return -EINVAL; + if (reloc->bo_offset) + return -EINVAL; + jbo = mwv207_job_bo(mjob, reloc->idx); + if (reloc->cmd_offset == offsetof(struct mwv207_dma_cmd, src.base)) + src_bo = jbo; + else if (reloc->cmd_offset == offsetof(struct mwv207_dma_cmd, dst.base)) + dst_bo = jbo; + } + if (!src_bo || !dst_bo || src_bo == dst_bo) + return -EINVAL; + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + ret = mwv207_submit_patch_dma_entry(mjob, &dma_cmd->src, src_bo, + dma_cmd->width, dma_cmd->height); + if (ret) + return ret; + return mwv207_submit_patch_dma_entry(mjob, &dma_cmd->dst, dst_bo, + dma_cmd->width, dma_cmd->height); +} + +static int mwv207_submit_patch(struct drm_device *dev, struct mwv207_job *mjob) +{ + struct mwv207_bo *jbo; + int i, j, ret; + void *ptr; + + if (mjob->is_dma) + return mwv207_submit_patch_dma(dev, mjob); + + for (i = 0; i < mjob->nr_relocs; ++i) { + ret = mwv207_submit_patch_single(mjob, &mjob->relocs[i], + mjob->cmds, mjob->cmd_size); + if (ret) + return ret; + } + + for (i = 0; i < mjob->nr_cmd_dat; ++i) { + if (mjob->cmd_dats[i].nr_relocs) { + for (j = 0; j < mjob->cmd_dats[i].nr_relocs; j++) { + ret = mwv207_submit_patch_single(mjob, &mjob->cmd_dats[i].relocs[j], + mjob->cmd_dats[i].dat, mjob->cmd_dats[i].dat_size); + if (ret) + return ret; + } + } + + + jbo = mjob->cmd_dats[i].jbo; + + + ret = ttm_bo_wait(&jbo->tbo, true, false); + if (ret) + return ret; + + ret = mwv207_bo_kmap_reserved(jbo, &ptr); + if (ret) + return ret; + memcpy_toio(ptr, mjob->cmd_dats[i].dat, mjob->cmd_dats[i].dat_size); + mwv207_bo_kunmap_reserved(jbo); + } + + return 0; +} + +static int mwv207_submit_validate(struct drm_device *dev, struct mwv207_job *mjob) +{ + struct ttm_operation_ctx ctx = { + .interruptible = true, + .no_wait_gpu = false + }; + struct mwv207_bo *jbo; + int i, ret; + + for (i = 0; i < mjob->nr_bos + mjob->nr_cmd_dat; ++i) { + jbo = mwv207_job_bo(mjob, i); + + if (jbo->pin_count) + continue; + + if (mjob->is_dma) { + if (jbo->tbo.mem.mem_type != TTM_PL_SYSTEM) + continue; + + mwv207_bo_placement_from_domain(jbo, 0x4, 0); + } else { + + jbo->flags |= (1<<2); + if (i >= mjob->nr_bos) + jbo->flags |= (1<<0); + mwv207_bo_placement_from_domain(jbo, 0x2, 0); + } + + ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); + if (ret) + return ret; + } + + return 0; +} + +static int mwv207_submit_attach_dependency(struct mwv207_job *mjob, struct drm_mwv207_submit *args) +{ + struct dma_resv *resv; + struct mwv207_tvb *mtvb; + int ret; + + mwv207_for_each_mtvb(mtvb, mjob) { + resv = mtvb->base.bo->base.resv; + if (mtvb->base.num_shared == 0) { + ret = dma_resv_get_fences_rcu(resv, &mtvb->excl, + &mtvb->nr_shared, &mtvb->shared); + if (ret) + return ret; + } else + mtvb->excl = dma_resv_get_excl_rcu(resv); + } + + if (unlikely(args->flags & 0x00000001)) { + mjob->fence_in = sync_file_get_fence(args->fence_fd); + if (!mjob->fence_in) + return -EINVAL; + } + + return 0; +} + +static int mwv207_submit_commit(struct mwv207_job *mjob, + struct drm_mwv207_submit *args, struct dma_fence **fence) +{ + int ret; + + /* XXX: job init and push should be protected with common lock, + * refer to drm_sched_entity_push_job documentation for details + */ + ret = drm_sched_job_init(&mjob->base, mjob->engine_entity, mjob->ctx); + if (ret) + return ret; + + if (args->flags & 0x00000002) { + struct sync_file *sync_file; + int fd; + + fd = get_unused_fd_flags(O_CLOEXEC); + if (fd < 0) + return fd; + sync_file = sync_file_create(&mjob->base.s_fence->finished); + if (!sync_file) { + put_unused_fd(fd); + return -ENOMEM; + } + fd_install(fd, sync_file->file); + args->fence_fd = fd; + } + + + *fence = &mjob->base.s_fence->finished; + + + mwv207_job_get(mjob); + drm_sched_entity_push_job(&mjob->base, mjob->engine_entity); + return 0; +} + +int mwv207_submit_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + struct drm_mwv207_submit *args = data; + struct ww_acquire_ctx ticket; + struct mwv207_job *mjob; + struct dma_fence *fence = NULL; + int ret; + + if (args->padding || (args->flags & ~0x00000003)) + return -EINVAL; + if (args->cmd_size == 0 || args->cmds == 0) + return -EINVAL; + + mjob = mwv207_submit_init(dev, filp, args); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + ret = ttm_eu_reserve_buffers(&ticket, &mjob->tvblist, true, NULL); + if (ret) + goto put_job; + ret = mwv207_submit_validate(dev, mjob); + if (ret) + goto unreserve; + ret = mwv207_submit_patch(dev, mjob); + if (ret) + goto unreserve; + ret = mwv207_submit_attach_dependency(mjob, args); + if (ret) + goto unreserve; + ret = mwv207_submit_commit(mjob, args, &fence); + if (ret) + goto unreserve; +unreserve: + if (likely(fence)) + ttm_eu_fence_buffer_objects(&ticket, &mjob->tvblist, fence); + else + ttm_eu_backoff_reservation(&ticket, &mjob->tvblist); +put_job: + mwv207_job_put(mjob); + + return ret; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_submit.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_submit.h new file mode 100644 index 0000000000000000000000000000000000000000..194fceafa88eed72a966d63c12f94c34a0328c22 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_submit.h @@ -0,0 +1,23 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#ifndef MWV207_SUBMIT_H_2S1GH9LD +#define MWV207_SUBMIT_H_2S1GH9LD + +int mwv207_submit_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ttm.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ttm.c new file mode 100644 index 0000000000000000000000000000000000000000..01d6ad563f5d545da4c660b924f762f9bf79dd04 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ttm.c @@ -0,0 +1,613 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "mwv207.h" +#include "mwv207_bo.h" +#include "mwv207_drm.h" +#include "mwv207_sched.h" + +static int mwv207_mem_visible(struct mwv207_device *jdev, struct ttm_resource *mem) +{ + if (mem->mem_type == TTM_PL_SYSTEM || + mem->mem_type == TTM_PL_TT) + return true; + if (mem->mem_type != TTM_PL_VRAM) + return false; + + + return ((mem->start << PAGE_SHIFT) + mem->size < jdev->visible_vram_size); +} + + +static void mwv207_evict_flags(struct ttm_buffer_object *bo, + struct ttm_placement *placement) +{ + struct mwv207_device *jdev; + struct mwv207_bo *jbo; + static const struct ttm_place placements = { + .fpfn = 0, + .lpfn = 0, + .flags = 0, + .mem_type = TTM_PL_SYSTEM + }; + + if (!mwv207_ttm_bo_is_mwv207_bo(bo)) { + placement->placement = &placements; + placement->busy_placement = &placements; + placement->num_placement = 1; + placement->num_busy_placement = 1; + return; + } + + jbo = to_jbo(bo); + jdev = ddev_to_jdev(jbo->tbo.base.dev); + + /* evict order: * visible vram -> invisible vram -> GTT -> SYSTEM */ + if (bo->mem.mem_type == TTM_PL_VRAM) { + if (jdev->visible_vram_size != jdev->vram_size + && mwv207_mem_visible(jdev, &bo->mem)) { + jbo->flags &= ~((1<<0) | (1<<2)); + mwv207_bo_placement_from_domain(jbo, + 0x2 | 0x4, + false); + BUG_ON(!(jbo->placements[0].mem_type & TTM_PL_VRAM)); + BUG_ON(!(jbo->placements[1].mem_type & TTM_PL_TT)); + jbo->placements[0].fpfn = jdev->visible_vram_size >> PAGE_SHIFT; + jbo->placements[0].lpfn = 0; + jbo->placement.placement = &jbo->placements[0]; + jbo->placement.busy_placement = &jbo->placements[1]; + jbo->placement.num_placement = 1; + jbo->placement.num_busy_placement = 1; + } else + mwv207_bo_placement_from_domain(jbo, 0x4, false); + } else + mwv207_bo_placement_from_domain(jbo, 0x1, false); + + *placement = jbo->placement; +} + +static int mwv207_ttm_io_mem_reserve(struct ttm_bo_device *bdev, + struct ttm_resource *mem) +{ + struct mwv207_device *jdev = bdev_to_jdev(bdev); + size_t bus_size = (size_t)mem->num_pages << PAGE_SHIFT; + + mem->bus.addr = NULL; + mem->bus.offset = 0; + mem->bus.is_iomem = false; + + switch (mem->mem_type) { + case TTM_PL_SYSTEM: + case TTM_PL_TT: + + return 0; + case TTM_PL_VRAM: + + mem->bus.offset = mem->start << PAGE_SHIFT; + if (mem->bus.offset + bus_size > jdev->visible_vram_size) + return -EINVAL; + mem->bus.is_iomem = true; + mem->bus.offset += jdev->vram_bar_base; + break; + default: + return -EINVAL; + } + return 0; +} + +static int mwv207_ttm_tt_bind(struct ttm_bo_device *bdev, + struct ttm_tt *ttm, + struct ttm_resource *bo_mem) +{ + if (!bo_mem) + return -EINVAL; + return 0; +} + +static void mwv207_ttm_tt_unbind(struct ttm_bo_device *bdev, + struct ttm_tt *ttm) +{ + return ; +} + +static void mwv207_ttm_tt_destroy(struct ttm_bo_device *bdev, + struct ttm_tt *ttm) +{ + struct mwv207_ttm_tt *gtt = to_gtt(ttm); + ttm_tt_destroy_common(bdev, ttm); + + ttm_dma_tt_fini(>t->ttm); + kfree(gtt); +} + +static struct ttm_tt *mwv207_ttm_tt_create(struct ttm_buffer_object *bo, + u32 page_flags) +{ + struct mwv207_device *jdev; + struct mwv207_ttm_tt *gtt; + + jdev = ddev_to_jdev(bo->base.dev); + gtt = kzalloc(sizeof(struct mwv207_ttm_tt), GFP_KERNEL); + if (gtt == NULL) + return NULL; + gtt->jdev = jdev; + if (ttm_dma_tt_init(>t->ttm, bo, page_flags)) { + kfree(gtt); + return NULL; + } + return >t->ttm.ttm; +} + +static int mwv207_ttm_tt_populate(struct ttm_bo_device *bdev, + struct ttm_tt *ttm, + struct ttm_operation_ctx *ctx) +{ + struct mwv207_ttm_tt *gtt = to_gtt(ttm); + struct mwv207_device *jdev = bdev_to_jdev(bdev); + + return ttm_dma_populate(>t->ttm, jdev->dev, ctx); +} + +static void mwv207_ttm_tt_unpopulate(struct ttm_bo_device *bdev, + struct ttm_tt *ttm) +{ + struct mwv207_ttm_tt *gtt = to_gtt(ttm); + struct mwv207_device *jdev = bdev_to_jdev(bdev); + + ttm_dma_unpopulate(>t->ttm, jdev->dev); +} + +static int mwv207_ttm_job_submit(struct mwv207_job *mjob, struct dma_fence **fence) +{ + int ret; + + ret = drm_sched_job_init(&mjob->base, mjob->engine_entity, NULL); + if (ret) + return ret; + + *fence = &mjob->base.s_fence->finished; + + mwv207_job_get(mjob); + drm_sched_entity_push_job(&mjob->base, mjob->engine_entity); + + return 0; +} + +static struct mwv207_job *mwv207_ttm_job_alloc(struct ttm_buffer_object *bo) +{ + struct mwv207_job *mjob = mwv207_job_alloc(); + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_tvb *mtvb; + int ret; + + if (!mjob) + return ERR_PTR(-ENOMEM); + + + dma_cmd = kmalloc(sizeof(*dma_cmd), GFP_KERNEL); + if (!dma_cmd) { + ret = -ENOMEM; + goto err; + } + dma_cmd->src.offset = 0; + dma_cmd->src.stride = bo->mem.size; + dma_cmd->dst.offset = 0; + dma_cmd->dst.stride = bo->mem.size; + dma_cmd->width = bo->mem.size; + dma_cmd->height = 1; + + mjob->cmds = (char *)dma_cmd; + mjob->cmd_size = sizeof(*dma_cmd); + mjob->engine_entity = ddev_to_jdev(bo->base.dev)->dma_entity; + mjob->is_dma = true; + + + mjob->mtvb = kzalloc(sizeof(struct mwv207_tvb), GFP_KERNEL); + if (!mjob->mtvb) { + ret = -ENOMEM; + goto err; + } + mtvb = &mjob->mtvb[0]; + list_add_tail(&mtvb->base.head, &mjob->tvblist); + + ret = dma_resv_get_fences_rcu(bo->base.resv, &mtvb->excl, + &mtvb->nr_shared, &mtvb->shared); + if (ret) + goto err; + + return mjob; +err: + mwv207_job_put(mjob); + return ERR_PTR(ret); +} + +static int mwv207_move_vram_gtt(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct ttm_tt *ttm = bo->ttm; + struct mwv207_ttm_tt *gtt = to_gtt(ttm); + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_job *mjob; + struct dma_fence *fence; + int ret; + + mjob = mwv207_ttm_job_alloc(bo); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + dma_cmd->src.base = bo->mem.start << PAGE_SHIFT; + dma_cmd->src.pg_nr_type = ((bo->mem.num_pages) | (0ULL << 63)); + dma_cmd->dst.base = (u64)gtt->ttm.dma_address; + dma_cmd->dst.pg_nr_type = ((ttm->num_pages) | (1ULL << 63)); + + ret = mwv207_ttm_job_submit(mjob, &fence); + if (!ret) + ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); + + mwv207_job_put(mjob); + return ret; +} + +static int mwv207_move_gtt_vram(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct ttm_tt *ttm = bo->ttm; + struct mwv207_ttm_tt *gtt = to_gtt(ttm); + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_job *mjob; + struct dma_fence *fence; + int ret; + + mjob = mwv207_ttm_job_alloc(bo); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + dma_cmd->src.base = (u64)gtt->ttm.dma_address; + dma_cmd->src.pg_nr_type = ((ttm->num_pages) | (1ULL << 63)); + dma_cmd->dst.base = new_mem->start << PAGE_SHIFT; + dma_cmd->dst.pg_nr_type = ((bo->mem.num_pages) | (0ULL << 63)); + + ret = mwv207_ttm_job_submit(mjob, &fence); + if (!ret) + ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); + + mwv207_job_put(mjob); + return ret; +} + +static int mwv207_move_vram_vram(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_job *mjob; + struct dma_fence *fence; + int ret; + + mjob = mwv207_ttm_job_alloc(bo); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + dma_cmd->src.base = bo->mem.start << PAGE_SHIFT; + dma_cmd->src.pg_nr_type = ((bo->mem.num_pages) | (0ULL << 63)); + dma_cmd->dst.base = new_mem->start << PAGE_SHIFT; + dma_cmd->dst.pg_nr_type = ((new_mem->num_pages) | (0ULL << 63)); + + ret = mwv207_ttm_job_submit(mjob, &fence); + if (!ret) + ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); + + mwv207_job_put(mjob); + return ret; +} + +static int mwv207_move_vram_ram(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct ttm_placement placement; + struct ttm_place placements; + struct ttm_resource tmp_mem; + int ret; + + if (new_mem->mem_type == TTM_PL_TT) + return mwv207_move_vram_gtt(bo, evict, ctx, new_mem); + + + tmp_mem = *new_mem; + tmp_mem.mm_node = NULL; + placement.num_placement = 1; + placement.placement = &placements; + placement.num_busy_placement = 1; + placement.busy_placement = &placements; + placements.fpfn = 0; + placements.lpfn = 0; + placements.flags = TTM_PL_MASK_CACHING; + placements.mem_type = TTM_PL_TT; + ret = ttm_bo_mem_space(bo, &placement, &tmp_mem, ctx); + if (unlikely(ret)) + return ret; + + ret = ttm_tt_set_placement_caching(bo->ttm, tmp_mem.placement); + if (unlikely(ret)) + goto out; + + ret = ttm_tt_populate(bo->bdev, bo->ttm, ctx); + if (unlikely(ret)) + goto out; + + ret = mwv207_move_vram_gtt(bo, evict, ctx, &tmp_mem); + if (likely(!ret)) + ret = ttm_bo_move_ttm(bo, ctx, new_mem); +out: + ttm_resource_free(bo, &tmp_mem); + return ret; +} + +static int mwv207_move_ram_vram(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct ttm_placement placement; + struct ttm_place placements; + struct ttm_resource tmp_mem; + int ret; + + if (bo->mem.mem_type == TTM_PL_TT) + return mwv207_move_gtt_vram(bo, evict, ctx, new_mem); + + + tmp_mem = *new_mem; + tmp_mem.mm_node = NULL; + placement.num_placement = 1; + placement.placement = &placements; + placement.num_busy_placement = 1; + placement.busy_placement = &placements; + placements.fpfn = 0; + placements.lpfn = 0; + placements.flags = TTM_PL_MASK_CACHING; + placements.mem_type = TTM_PL_TT; + ret = ttm_bo_mem_space(bo, &placement, &tmp_mem, ctx); + if (unlikely(ret)) + return ret; + + ret = ttm_bo_move_ttm(bo, ctx, &tmp_mem); + if (unlikely(ret)) + goto out; + + ret = mwv207_move_gtt_vram(bo, evict, ctx, new_mem); +out: + ttm_resource_free(bo, &tmp_mem); + return ret; +} + +static int mwv207_mem_in_ram(struct ttm_resource *mem) +{ + return mem->mem_type == TTM_PL_SYSTEM || mem->mem_type == TTM_PL_TT; +} + +static int mwv207_bo_move(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct ttm_resource *old_mem = &bo->mem; + struct mwv207_bo *jbo = to_jbo(bo); + struct mwv207_device *jdev; + int ret; + + if (WARN_ON_ONCE(jbo->pin_count > 0)) + return -EINVAL; + + jdev = ddev_to_jdev(jbo->tbo.base.dev); + if (old_mem->mem_type == TTM_PL_SYSTEM && bo->ttm == NULL) { + + ttm_bo_move_null(bo, new_mem); + return 0; + } + + if (mwv207_mem_in_ram(old_mem) && mwv207_mem_in_ram(new_mem)) { + + ttm_bo_move_null(bo, new_mem); + return 0; + } + + if (old_mem->mem_type == TTM_PL_VRAM && + mwv207_mem_in_ram(new_mem)) { + ret = mwv207_move_vram_ram(bo, evict, ctx, new_mem); + } else if (mwv207_mem_in_ram(old_mem) && + new_mem->mem_type == TTM_PL_VRAM) { + ret = mwv207_move_ram_vram(bo, evict, ctx, new_mem); + } else if (old_mem->mem_type == TTM_PL_VRAM && + new_mem->mem_type == TTM_PL_VRAM) { + ret = mwv207_move_vram_vram(bo, evict, ctx, new_mem); + } else { + ret = -EINVAL; + } + + if (ret == 0) + goto moved; + + + if (!mwv207_mem_visible(jdev, new_mem) + || !mwv207_mem_visible(jdev, old_mem)) { + pr_err("mwv207: can't move invisible mem by cpu"); + return ret; + } + ret = ttm_bo_move_memcpy(bo, ctx, new_mem); + if (ret) + return ret; +moved: + if (!mwv207_mem_visible(jdev, new_mem)) + jbo->flags &= ~(1<<0); + + return 0; +} + +static void mwv207_bo_move_notify(struct ttm_buffer_object *bo, + bool evict, + struct ttm_resource *new_mem) +{ + struct mwv207_bo *jbo; + struct mwv207_device *jdev; + + if (!mwv207_ttm_bo_is_mwv207_bo(bo)) + return; + jbo = to_jbo(bo); + jdev = ddev_to_jdev(jbo->tbo.base.dev); +} + +static int mwv207_bo_fault_reserve_notify(struct ttm_buffer_object *bo) +{ + struct ttm_operation_ctx ctx = { + .interruptible = true, + .no_wait_gpu = false + }; + struct mwv207_device *jdev; + struct mwv207_bo *jbo; + u64 size, offset; + u32 domain; + int ret; + + if (!mwv207_ttm_bo_is_mwv207_bo(bo)) + return 0; + if (bo->mem.mem_type != TTM_PL_VRAM) + return 0; + + jbo = to_jbo(bo); + jdev = ddev_to_jdev(jbo->tbo.base.dev); + size = bo->mem.num_pages << PAGE_SHIFT; + offset = bo->mem.start << PAGE_SHIFT; + + jbo->flags |= (1<<0); + + if ((offset + size) <= jdev->visible_vram_size) + return 0; + + if (jbo->pin_count > 0) + return -EINVAL; + + /* TODO: + * 1. moving to RAM won't invoke swap, and thus causing ENOMEM when + * system memory is low. figure out why. + * 2. slide iatu window to optimize out this validation. + */ + domain = 0x2; +retry: + mwv207_bo_placement_from_domain(jbo, domain, false); + ret = ttm_bo_validate(bo, &jbo->placement, &ctx); + if (unlikely(ret)) { + if (ret != -ERESTARTSYS) { + if (domain == 0x2) { + + domain = 0x1; + goto retry; + } + } + return ret; + } + + + offset = bo->mem.start << PAGE_SHIFT; + if (bo->mem.mem_type == TTM_PL_VRAM && + (offset + size) > jdev->visible_vram_size) { + DRM_ERROR("bo validation goes crazy"); + return -EINVAL; + } + + return ret; +} + +static int mwv207_bo_verify_access(struct ttm_buffer_object *tbo, struct file *filp) +{ + return drm_vma_node_verify_access(&tbo->base.vma_node, + filp->private_data); +} + +static struct ttm_bo_driver mwv207_bo_driver = { + .ttm_tt_create = mwv207_ttm_tt_create, + .ttm_tt_populate = mwv207_ttm_tt_populate, + .ttm_tt_unpopulate = mwv207_ttm_tt_unpopulate, + .ttm_tt_bind = &mwv207_ttm_tt_bind, + .ttm_tt_unbind = &mwv207_ttm_tt_unbind, + .ttm_tt_destroy = &mwv207_ttm_tt_destroy, + .eviction_valuable = ttm_bo_eviction_valuable, + .evict_flags = mwv207_evict_flags, + .move = mwv207_bo_move, + .io_mem_reserve = mwv207_ttm_io_mem_reserve, + .move_notify = mwv207_bo_move_notify, + .fault_reserve_notify = &mwv207_bo_fault_reserve_notify, + .verify_access = mwv207_bo_verify_access, +}; + +int mwv207_ttm_init(struct mwv207_device *jdev) +{ + int ret; + + ret = ttm_bo_device_init(&jdev->bdev, + &mwv207_bo_driver, + jdev->base.anon_inode->i_mapping, + jdev->base.vma_offset_manager, + true); + if (ret) { + DRM_ERROR("failed to initialize buffer object driver(%d).\n", ret); + return ret; + } + + + ret = ttm_range_man_init(&jdev->bdev, TTM_PL_TT, true, + 0x80000000ULL >> PAGE_SHIFT); + if (ret) { + DRM_ERROR("failed to initialize GTT heap.\n"); + goto out_no_vram; + } + + + ret = ttm_range_man_init(&jdev->bdev, TTM_PL_VRAM, false, + jdev->vram_size >> PAGE_SHIFT); + if (ret) { + DRM_ERROR("failed to initialize VRAM heap.\n"); + goto out_no_vram; + } + DRM_INFO("mwv207: %lldM of VRAM memory size\n", jdev->vram_size / (1024 * 1024)); + return 0; + +out_no_vram: + ttm_bo_device_release(&jdev->bdev); + return ret; +} + +void mwv207_ttm_fini(struct mwv207_device *jdev) +{ + ttm_range_man_fini(&jdev->bdev, TTM_PL_VRAM); + ttm_range_man_fini(&jdev->bdev, TTM_PL_TT); + ttm_bo_device_release(&jdev->bdev); + DRM_INFO("mwv207: ttm finalized\n"); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ttm.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ttm.h new file mode 100644 index 0000000000000000000000000000000000000000..9cbf61ed32004b48fb1f1887492eb576331cc4cd --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_ttm.h @@ -0,0 +1,25 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_TTM_H_TJTW9M4R +#define MWV207_TTM_H_TJTW9M4R +#include +#include +#include +#include "mwv207.h" + +int mwv207_bo_fault_reserve_notify(struct ttm_buffer_object *bo); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_vbios.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_vbios.c new file mode 100644 index 0000000000000000000000000000000000000000..0da8244efdb97a98cc4a9f4601455e2667801eef --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_vbios.c @@ -0,0 +1,189 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207.h" +#include "mwv207_vbios.h" + +/* + */ +static inline u8 mwv207_flash_read8(struct mwv207_device *jdev, u32 offset) +{ + return ioread8(jdev->mmio + 0x100000 + offset); +} + +static inline u16 mwv207_flash_read16(struct mwv207_device *jdev, u32 offset) +{ + u16 dat = ioread16(jdev->mmio + 0x100000 + offset); + + return le16_to_cpu(dat); +} + +static inline u32 mwv207_flash_read32(struct mwv207_device *jdev, u32 offset) +{ + u32 dat = ioread32(jdev->mmio + 0x100000 + offset); + + return le32_to_cpu(dat); +} + +static inline void mwv207_flash_cpy(struct mwv207_device *jdev, void *dst, u32 offset, u32 len) +{ + memcpy_fromio(dst, jdev->mmio + 0x100000 + offset, len); +} + +static int mwv207_vbios_check_indexer(struct mwv207_device *jdev, u32 offset) +{ + u16 count, chksum, calc; + + if (mwv207_flash_read16(jdev, offset) != 0xaa55) + return -EINVAL; + + count = mwv207_flash_read16(jdev, offset + 2); + chksum = mwv207_flash_read16(jdev, offset + 4); + + jdev->vbios.sector_count = count; + for (calc = 0, offset += 8, count *= 8; count > 0; count--) + calc += mwv207_flash_read8(jdev, offset++); + + if (calc != chksum) + return -EINVAL; + + jdev->vbios.indexer_valid = 1; + return 0; +} + +static inline int mwv207_vbios_sector(struct mwv207_device *jdev, u32 idx, u32 *poffset) +{ + if (poffset == NULL || !jdev->vbios.indexer_valid || idx >= jdev->vbios.sector_count) + return -EINVAL; + + *poffset = mwv207_flash_read32(jdev, 0xa000 + 0x8 + idx * 8 + 4); + return 0; +} + +static inline int mwv207_vbios_insert_vdat(struct mwv207_device *jdev, u32 key, + struct mwv207_vdat *vdat) +{ + int ret; + + mutex_lock(&jdev->vbios.cfg_lock); + ret = idr_alloc(&jdev->vbios.cfg_table, vdat, key, key + 1, GFP_KERNEL); + mutex_unlock(&jdev->vbios.cfg_lock); + + return ret; +} + +static void mwv207_vbios_parse_hdmi(struct mwv207_device *jdev) +{ + u32 count, offset, chksum, len; + struct mwv207_vdat *vdat[4]; + u32 select[4]; + u8 magic[8]; + int ret, i; + + ret = mwv207_vbios_sector(jdev, 0xa, &offset); + if (ret) + return; + + mwv207_flash_cpy(jdev, magic, offset, 8); + if (memcmp(magic, "JMPHYCFG", 8)) + return; + + len = mwv207_flash_read32(jdev, offset + 0x18); + if (len > 0x1200 || (len % 1140)) + return; + count = len / 1140; + + for (chksum = 0, i = 0; i < len; i += 4) + chksum += mwv207_flash_read32(jdev, offset + 0x20 + i); + if (chksum != mwv207_flash_read32(jdev, offset + 0x14)) + return; + + for (i = 0; i < 4; i++) { + select[i] = mwv207_flash_read8(jdev, offset + 0x1c + i); + if (select[i] > min_t(u32, 3, count - 1)) + return; + } + + for (i = 0; i < 4; i++) { + void *dat; + + vdat[i] = devm_kzalloc(jdev->dev, sizeof(*vdat[i]), GFP_KERNEL); + if (!vdat[i]) + return; + vdat[i]->len = 1140; + dat = devm_kmalloc(jdev->dev, vdat[i]->len, GFP_KERNEL); + if (!dat) + return; + mwv207_flash_cpy(jdev, dat, + offset + 0x20 + select[i] * 1140, + 1140); + + vdat[i]->dat = dat; + + (void)mwv207_vbios_insert_vdat(jdev, 0xfff0 + i, vdat[i]); + } +} + +static void mwv207_vbios_parse_edp(struct mwv207_device *jdev) +{ + +} + +static void mwv207_vbios_parse_cfg(struct mwv207_device *jdev) +{ + +} + +const struct mwv207_vdat *mwv207_vbios_vdat(struct mwv207_device *jdev, u32 key) +{ + struct mwv207_vdat *dat; + + mutex_lock(&jdev->vbios.cfg_lock); + dat = idr_find(&jdev->vbios.cfg_table, key); + mutex_unlock(&jdev->vbios.cfg_lock); + + return dat; +} + +void mwv207_vbios_init(struct mwv207_device *jdev) +{ + int ret; + + mutex_init(&jdev->vbios.vcmd_lock); + mutex_init(&jdev->vbios.cfg_lock); + idr_init(&jdev->vbios.cfg_table); + + ret = mwv207_vbios_check_indexer(jdev, 0xa000); + if (ret) { + pr_warn("mwv207: vbios indexer is not valid"); + return; + } + + mwv207_vbios_parse_hdmi(jdev); + mwv207_vbios_parse_edp(jdev); + mwv207_vbios_parse_cfg(jdev); +} + +void mwv207_vbios_fini(struct mwv207_device *jdev) +{ + struct mwv207_vdat *vdat; + u32 id; + + idr_for_each_entry(&jdev->vbios.cfg_table, vdat, id) { + devm_kfree(jdev->dev, vdat->dat); + devm_kfree(jdev->dev, vdat); + } + idr_destroy(&jdev->vbios.cfg_table); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_vbios.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_vbios.h new file mode 100644 index 0000000000000000000000000000000000000000..75796f865645b5bd3ed8687fadcb6b5e6716416a --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_vbios.h @@ -0,0 +1,51 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_VBIOS_H_D2JHN3FG +#define MWV207_VBIOS_H_D2JHN3FG + +struct mwv207_device; + +enum pll_id { + MWV207_PLL_GPU = 0, + MWV207_PLL_GRAPH0, + MWV207_PLL_GRAPH1, + MWV207_PLL_GRAPH2, + MWV207_PLL_GRAPH3, + MWV207_PLL_GRAPH4, + MWV207_PLL_HD, + MWV207_PLL_GU3D0, + MWV207_PLL_EDP, + MWV207_PLL_GU3D1, + MWV207_PLL_RESERVED, + MWV207_PLL_GU2D_PLL, + MWV207_PLL_DDR, + MWV207_PLL_COUNT +}; + +struct mwv207_vdat { + const void *dat; + u32 len; +}; + +int mwv207_vbios_set_pll(struct mwv207_device *jdev, int pll_id, u32 kfreq); + +int mwv207_vbios_get_pll(struct mwv207_device *jdev, int pll_idx, unsigned long *kfreq); + +const struct mwv207_vdat *mwv207_vbios_vdat(struct mwv207_device *jdev, u32 key); + +void mwv207_vbios_init(struct mwv207_device *jdev); +void mwv207_vbios_fini(struct mwv207_device *jdev); +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_vcmd.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_vcmd.c new file mode 100644 index 0000000000000000000000000000000000000000..ecb373c472481d885458100dc143e00b2989cd10 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/mwv207_vcmd.c @@ -0,0 +1,172 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include "mwv207.h" +#include "mwv207_vbios.h" + + + + +static inline int mwv207_vcmd_idle(struct mwv207_device *jdev) +{ + u32 state; + + state = jdev_read(jdev, (0x9b0144)) >> 28; + + return state == 0; +} + +static inline int mwv207_vcmd_wait_idle(struct mwv207_device *jdev) +{ + int i; + + + for (i = 0; i < 1000 && !mwv207_vcmd_idle(jdev); i++) + usleep_range(1000, 1001); + return mwv207_vcmd_idle(jdev) ? 0 : -ETIMEDOUT; +} + +static inline void mwv207_vcmd_req(struct mwv207_device *jdev, int cmd, + int idx, u32 value, int enable) +{ + u32 req; + + req = cmd << 28; + req |= idx << 24; + req |= value << 1; + req |= enable ? 1 : 0; + + jdev_write(jdev, (0x9b0140), req); +} + +static inline void mwv207_vcmd_start(struct mwv207_device *jdev) +{ + jdev_write(jdev, (0x9b0144), 1 << 28); +} + +static inline int mwv207_vcmd_result(struct mwv207_device *jdev) +{ + return (jdev_read(jdev, (0x9b0144)) >> 24) & 0xf; +} + +static int mwv207_vcmd_execute(struct mwv207_device *jdev, int cmd, + int idx, u32 value, int enable) +{ + int ret; + + mutex_lock(&jdev->vbios.vcmd_lock); + + + ret = mwv207_vcmd_wait_idle(jdev); + if (ret) + goto unlock; + + + mwv207_vcmd_req(jdev, cmd, idx, value, enable); + + + mwv207_vcmd_start(jdev); + + + ret = mwv207_vcmd_wait_idle(jdev); + if (ret) + goto unlock; + + ret = mwv207_vcmd_result(jdev); + switch (ret) { + case 0: + goto unlock; + case 1: + pr_err("unsupport pll type!)"); + break; + case 2: + + pr_info_once("pll set, invalid freq!"); + break; + case 3: + pr_err("pll busy!"); + break; + case 4: + pr_err("pll set, invalid argument!"); + break; + case 9: + pr_err("PLL REQ cmd code unsupport!"); + break; + default: + pr_err("unknown pll error! (code 0x%x)", ret); + break; + } + ret = -EIO; +unlock: + mutex_unlock(&jdev->vbios.vcmd_lock); + return ret; +} + +int mwv207_vbios_set_pll(struct mwv207_device *jdev, int pll_idx, u32 kfreq) +{ + if (pll_idx >= MWV207_PLL_COUNT) + return -EINVAL; + + return mwv207_vcmd_execute(jdev, 1, pll_idx, + kfreq, kfreq ? 1 : 0); +} + +int mwv207_vbios_get_pll(struct mwv207_device *jdev, int pll_idx, unsigned long *kfreq) +{ + u32 port, state1, state2, state3; + u32 refdiv, fbintdiv, fbracdiv, postdiv1, postdiv2; + u32 postdiv_mask, postdiv_offset; + u64 freq; + + if (pll_idx >= MWV207_PLL_COUNT) + return -EINVAL; + + port = pll_idx ? 0 : 1; + + mutex_lock(&jdev->vbios.vcmd_lock); + state1 = jdev_read(jdev, ((0x9B0000 + 0xA00 + (0x100 * ((pll_idx) / 6) + 0x20 * ((pll_idx) % 6))) + 0x00) ); + state2 = jdev_read(jdev, ((0x9B0000 + 0xA00 + (0x100 * ((pll_idx) / 6) + 0x20 * ((pll_idx) % 6))) + 0x04)); + state3 = jdev_read(jdev, ((0x9B0000 + 0xA00 + (0x100 * ((pll_idx) / 6) + 0x20 * ((pll_idx) % 6))) + 0x08)); + mutex_unlock(&jdev->vbios.vcmd_lock); + + refdiv = state1 & 0x3f; + fbintdiv = (state1 & 0xfff0000) >> 16; + fbracdiv = state2 & 0xffffff; + postdiv1 = 4; + + postdiv_offset = 8 * (port % 4); + postdiv_mask = 0x7f << postdiv_offset; + postdiv2 = (state3 & postdiv_mask) >> postdiv_offset; + + if (!refdiv || !postdiv1 || !postdiv2) { + dev_dbg(jdev->dev, "get pll failed"); + return -EINVAL; + } + + freq = 100000 * 100000ull / refdiv; + freq = freq * fbintdiv + ((freq * fbracdiv) >> 24); + freq /= postdiv1; + freq /= postdiv2; + freq = DIV_ROUND_CLOSEST_ULL(freq, 100000); + + *kfreq = freq; + + dev_dbg(jdev->dev, "get pll result: freq %llu kHz\n", freq); + + return 0; +} + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/selftest/selftest.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/selftest/selftest.c new file mode 100644 index 0000000000000000000000000000000000000000..03cc940dd46e2a49cd27605e37bb5966fd4fb68f --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207/selftest/selftest.c @@ -0,0 +1,107 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207.h" +#include "mwv207_bo.h" +#include "mwv207_dma.h" + + +static int mwv207_test_create_and_map_bo(struct mwv207_device *jdev, u64 size, + u32 domain, u32 flags, struct mwv207_bo **pjbo, void **plogical) +{ + struct mwv207_bo *jbo; + void *logical; + int ret; + + ret = mwv207_bo_create(jdev, size, 0, ttm_bo_type_kernel, + domain, flags, &jbo); + if (ret) + return ret; + ret = mwv207_bo_reserve(jbo, true); + if (ret) + goto free_bo; + ret = mwv207_bo_kmap_reserved(jbo, &logical); + if (ret) + goto unreserve_bo; + + *pjbo = jbo; + *plogical = logical; + return 0; + +unreserve_bo: + mwv207_bo_unreserve(jbo); +free_bo: + mwv207_bo_unref(jbo); + return ret; +} + +static void mwv207_test_destroy_and_unmap_bo(struct mwv207_bo *jbo) +{ + if (!jbo) + return; + + mwv207_bo_kunmap_reserved(jbo); + mwv207_bo_unreserve(jbo); + mwv207_bo_unref(jbo); +} + + +static int mwv207_test_bo_acc(struct mwv207_device *jdev) +{ + struct mwv207_bo *jbo; + int i, ret; + void *logical; + + ret = mwv207_test_create_and_map_bo(jdev, 0x1000, + 0x2, (1<<0), &jbo, &logical); + if (ret) + return ret; + + memset(logical, 0x5a, 0x1000); + for (i = 0; i < 0x1000; i++) { + if (*((char *)logical + i) != 0x5a) { + ret = -EIO; + break; + } + } + + mwv207_test_destroy_and_unmap_bo(jbo); + + return ret; +} + +static int mwv207_test_bo(struct mwv207_device *jdev) +{ + int ret; + + ret = mwv207_test_bo_acc(jdev); + if (ret) { + pr_err("mwv207: bo access test failed with %d", ret); + return ret; + } + + return ret; +} + +int mwv207_test(struct mwv207_device *jdev) +{ + int ret; + + ret = mwv207_test_bo(jdev); + if (ret == 0) + pr_info("mwv207 selftest passed"); + + return ret; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207_gpu.patch b/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207_gpu.patch deleted file mode 100644 index a5a97c54e8eeb289aee61d26e3947a855fd39c19..0000000000000000000000000000000000000000 --- a/vendor_phytium/gpu_model/jm/kernel_source/linux-5.10/mwv207_gpu.patch +++ /dev/null @@ -1,10636 +0,0 @@ -diff --git a/drivers/gpu/drm/Kconfig b/drivers/gpu/drm/Kconfig -index 518fd948c..a36269ea9 100644 ---- a/drivers/gpu/drm/Kconfig -+++ b/drivers/gpu/drm/Kconfig -@@ -395,6 +395,8 @@ source "drivers/gpu/drm/xlnx/Kconfig" - - source "drivers/gpu/drm/phytium/Kconfig" - -+source "drivers/gpu/drm/mwv207/Kconfig" -+ - # Keep legacy drivers last - - menuconfig DRM_LEGACY -diff --git a/drivers/gpu/drm/Makefile b/drivers/gpu/drm/Makefile -index d78dc598c..c08d9b4d9 100644 ---- a/drivers/gpu/drm/Makefile -+++ b/drivers/gpu/drm/Makefile -@@ -125,3 +125,4 @@ obj-$(CONFIG_DRM_MCDE) += mcde/ - obj-$(CONFIG_DRM_TIDSS) += tidss/ - obj-y += xlnx/ - obj-$(CONFIG_DRM_PHYTIUM) += phytium/ -+obj-y += mwv207/ -diff --git a/drivers/gpu/drm/mwv207/Kconfig b/drivers/gpu/drm/mwv207/Kconfig -new file mode 100644 -index 000000000..f09174add ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/Kconfig -@@ -0,0 +1,13 @@ -+config DRM_MWV207 -+ tristate "MWV207 chip" -+ depends on DRM -+ select DRM_KMS_HELPER -+ select SND_PCM -+ select DRM_VRAM_HELPER -+ select DRM_SCHED -+ select DRM_TTM -+ select DRM_TTM_HELPER -+ help -+ Choose this option if you have a Jingjia graphics card. -+ If M is selected, the module will be called mwv207 (JM9100). -+ -diff --git a/drivers/gpu/drm/mwv207/Makefile b/drivers/gpu/drm/mwv207/Makefile -new file mode 100644 -index 000000000..66d12ba61 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/Makefile -@@ -0,0 +1,44 @@ -+ifneq ($(KERNELRELEASE),) -+ -+obj-y := mwv207.o -+mwv207-objs := mwv207_drv.o \ -+ mwv207_irq.o \ -+ mwv207_db.o \ -+ mwv207_ctx.o \ -+ mwv207_submit.o \ -+ mwv207_sched.o \ -+ mwv207_pipe_codec_common.o \ -+ mwv207_devfreq.o \ -+ mwv207_pipe_2d.o \ -+ mwv207_pipe_3d.o \ -+ mwv207_pipe_dec.o \ -+ mwv207_pipe_enc.o \ -+ mwv207_pipe_dma.o \ -+ mwv207_gem.o \ -+ mwv207_bo.o \ -+ mwv207_ttm.o \ -+ mwv207_vcmd.o \ -+ mwv207_vbios.o \ -+ dc/mwv207_kms.o \ -+ dc/mwv207_fb.o \ -+ dc/mwv207_va.o \ -+ dc/mwv207_edp.o \ -+ dc/mwv207_hdmi.o \ -+ dc/mwv207_vga.o \ -+ dc/mwv207_dvo.o \ -+ dc/mwv207_vi.o \ -+ dc/mwv207_i2c.o \ -+ selftest/selftest.o \ -+ -+ccflags-y := -I$(src) -+else -+ -+KERNELDIR ?= /lib/modules/$(shell uname -r)/build -+PWD := $(shell pwd) -+ -+default: -+ $(MAKE) -C $(KERNELDIR) M=$(PWD) modules -+clean: -+ $(MAKE) -C $(KERNELDIR) M=$(PWD) clean -+ -+endif -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_dvo.c b/drivers/gpu/drm/mwv207/dc/mwv207_dvo.c -new file mode 100644 -index 000000000..f0c0eda04 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_dvo.c -@@ -0,0 +1,180 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_vi.h" -+ -+static void mwv207_dvo_switch(struct mwv207_output *output, bool on) -+{ -+ mwv207_output_modify(output, 0x200, -+ 0x1 << 0, (on ? 1 : 0) << 0); -+} -+ -+static void mwv207_dvo_config(struct mwv207_output *output) -+{ -+ struct drm_display_mode *mode = &output->cur_crtc->state->adjusted_mode; -+ int hpol, vpol; -+ -+ hpol = (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : 1; -+ vpol = (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : 1; -+ -+ mwv207_output_modify(output, 0x200, 0x1 << 9, hpol << 9); -+ mwv207_output_modify(output, 0x200, 0x1 << 8, vpol << 8); -+ -+} -+ -+static void mwv207_dvo_select_crtc(struct mwv207_output *output) -+{ -+ -+ mwv207_output_modify(output, 0x200, 0x7 << 16, -+ drm_crtc_index(output->cur_crtc) << 16); -+ -+ jdev_modify(output->jdev, 0x9b003c, 0xf, -+ drm_crtc_index(output->cur_crtc)); -+} -+static enum drm_mode_status mwv207_dvo_mode_valid(struct mwv207_output *output, -+ const struct drm_display_mode *mode) -+{ -+ -+ if (mode->clock > 162000) -+ return MODE_CLOCK_HIGH; -+ -+ return MODE_OK; -+} -+ -+static enum drm_mode_status mwv207_dvo_connector_mode_valid(struct drm_connector *connector, -+ struct drm_display_mode *mode) -+{ -+ return mwv207_dvo_mode_valid(connector_to_output(connector), mode); -+} -+ -+static int mwv207_dvo_detect_ctx(struct drm_connector *connector, -+ struct drm_modeset_acquire_ctx *ctx, -+ bool force) -+{ -+ struct mwv207_output *output = connector_to_output(connector); -+ -+ if (mwv207_i2c_probe(output->ddc)) -+ return connector_status_connected; -+ else -+ return connector_status_disconnected; -+} -+ -+static void mwv207_dvo_destroy(struct drm_connector *conn) -+{ -+ drm_connector_unregister(conn); -+ drm_connector_cleanup(conn); -+} -+ -+static const struct drm_connector_helper_funcs mwv207_dvo_connector_helper_funcs = { -+ .get_modes = mwv207_output_get_modes, -+ .mode_valid = mwv207_dvo_connector_mode_valid, -+ .detect_ctx = mwv207_dvo_detect_ctx -+}; -+ -+static const struct drm_connector_funcs mwv207_dvo_connector_funcs = { -+ .reset = drm_atomic_helper_connector_reset, -+ .fill_modes = drm_helper_probe_single_connector_modes, -+ .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, -+ .destroy = mwv207_dvo_destroy, -+ .late_register = mwv207_output_late_register, -+ .early_unregister = mwv207_output_early_unregister, -+}; -+ -+static enum drm_mode_status mwv207_dvo_encoder_mode_valid(struct drm_encoder *encoder, -+ const struct drm_display_mode *mode) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ return mwv207_dvo_mode_valid(output, mode); -+} -+ -+static int mwv207_dvo_encoder_atomic_check(struct drm_encoder *encoder, -+ struct drm_crtc_state *crtc_state, -+ struct drm_connector_state *conn_state) -+{ -+ return 0; -+} -+ -+static void mwv207_dvo_encoder_enable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_dvo_select_crtc(output); -+ -+ mwv207_dvo_config(output); -+ -+ mwv207_dvo_switch(output, true); -+} -+ -+static void mwv207_dvo_encoder_disable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_dvo_switch(output, false); -+} -+ -+static void mwv207_dvo_encoder_reset(struct drm_encoder *encoder) -+{ -+ mwv207_dvo_encoder_disable(encoder); -+} -+ -+static const struct drm_encoder_funcs mwv207_dvo_encoder_funcs = { -+ .destroy = drm_encoder_cleanup, -+ .reset = mwv207_dvo_encoder_reset, -+}; -+ -+static const struct drm_encoder_helper_funcs mwv207_dvo_encoder_helper_funcs = { -+ .mode_valid = mwv207_dvo_encoder_mode_valid, -+ .atomic_check = mwv207_dvo_encoder_atomic_check, -+ .enable = mwv207_dvo_encoder_enable, -+ .disable = mwv207_dvo_encoder_disable, -+}; -+ -+int mwv207_dvo_init(struct mwv207_device *jdev) -+{ -+ struct mwv207_output *output; -+ int ret; -+ -+ output = devm_kzalloc(jdev->dev, sizeof(*output), GFP_KERNEL); -+ if (!output) -+ return -ENOMEM; -+ -+ output->jdev = jdev; -+ output->idx = 0; -+ output->mmio = jdev->mmio + 0x9a0000; -+ output->i2c_chan = 5; -+ -+ output->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; -+ ret = drm_connector_init(&jdev->base, &output->connector, -+ &mwv207_dvo_connector_funcs, DRM_MODE_CONNECTOR_DVII); -+ if (ret) -+ return ret; -+ drm_connector_helper_add(&output->connector, &mwv207_dvo_connector_helper_funcs); -+ -+ output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; -+ ret = drm_encoder_init(&jdev->base, &output->encoder, -+ &mwv207_dvo_encoder_funcs, DRM_MODE_ENCODER_DAC, -+ "dvo-%d", output->idx); -+ if (ret) -+ return ret; -+ drm_encoder_helper_add(&output->encoder, &mwv207_dvo_encoder_helper_funcs); -+ -+ ret = drm_connector_attach_encoder(&output->connector, &output->encoder); -+ if (ret) -+ return ret; -+ -+ return drm_connector_register(&output->connector); -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_edp.c b/drivers/gpu/drm/mwv207/dc/mwv207_edp.c -new file mode 100644 -index 000000000..790b186a1 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_edp.c -@@ -0,0 +1,22 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_vi.h" -+ -+int mwv207_edp_init(struct mwv207_device *jdev) -+{ -+ pr_info("%s TBD", __func__); -+ return 0; -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_fb.c b/drivers/gpu/drm/mwv207/dc/mwv207_fb.c -new file mode 100644 -index 000000000..220c5401c ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_fb.c -@@ -0,0 +1,181 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_bo.h" -+#include "mwv207_drm.h" -+#include "mwv207_gem.h" -+#include "mwv207_kms.h" -+ -+static struct fb_ops mwv207_fb_ops = { -+ .owner = THIS_MODULE, -+ DRM_FB_HELPER_DEFAULT_OPS, -+ .fb_fillrect = drm_fb_helper_cfb_fillrect, -+ .fb_copyarea = drm_fb_helper_cfb_copyarea, -+ .fb_imageblit = drm_fb_helper_cfb_imageblit, -+}; -+ -+static int mwv207_drm_fb_helper_init(struct drm_device *dev, -+ struct drm_fb_helper *fb_helper, -+ unsigned int crtc_count, -+ unsigned int max_conn_count) -+{ -+ return drm_fb_helper_init(dev, fb_helper); -+} -+ -+static int mwv207_fb_create(struct drm_fb_helper *fb_helper, -+ struct drm_fb_helper_surface_size *sizes) -+{ -+ struct drm_mode_fb_cmd2 mode_cmd; -+ struct drm_framebuffer *fb; -+ struct mwv207_device *jdev; -+ struct mwv207_bo *jbo; -+ struct fb_info *info; -+ u32 bytes; -+ void *logical; -+ int ret; -+ -+ jdev = fb_helper->dev->dev_private; -+ memset(&mode_cmd, 0, sizeof(mode_cmd)); -+ mode_cmd.width = sizes->surface_width; -+ mode_cmd.height = sizes->surface_height; -+ if (sizes->surface_bpp == 24) -+ sizes->surface_bpp = 32; -+ -+ mode_cmd.pitches[0] = mode_cmd.width * ((sizes->surface_bpp + 7)/8); -+ mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, -+ sizes->surface_depth); -+ -+ info = drm_fb_helper_alloc_fbi(fb_helper); -+ if (IS_ERR(info)) -+ return PTR_ERR(info); -+ -+ bytes = mode_cmd.pitches[0] * mode_cmd.height; -+ bytes = ALIGN(bytes, PAGE_SIZE); -+ ret = mwv207_bo_create(jdev, bytes, 0x10000, ttm_bo_type_kernel, -+ 0x2, (1<<0), &jbo); -+ if (ret) -+ return ret; -+ -+ fb = kzalloc(sizeof(*fb), GFP_KERNEL); -+ if (fb == NULL) { -+ ret = -ENOMEM; -+ goto free_bo; -+ } -+ -+ ret = mwv207_framebuffer_init(jdev, fb, &mode_cmd, mwv207_gem_from_bo(jbo)); -+ if (ret) -+ goto free_fb; -+ -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) -+ goto free_fb; -+ ret = mwv207_bo_pin_reserved(jbo, 0x2); -+ if (ret) -+ goto unreserve_bo; -+ -+ ret = mwv207_bo_kmap_reserved(jbo, &logical); -+ if (ret) -+ goto unpin_bo; -+ -+ memset(logical, 0x0, bytes); -+ -+ fb_helper->fb = fb; -+ info->skip_vt_switch = true; -+ info->fbops = &mwv207_fb_ops; -+ info->screen_size = fb->height * fb->pitches[0]; -+ info->fix.smem_len = info->screen_size; -+ info->screen_base = logical; -+ -+ drm_fb_helper_fill_info(info, fb_helper, sizes); -+ -+ mwv207_bo_unreserve(jbo); -+ return 0; -+ -+unpin_bo: -+ mwv207_bo_unpin(jbo); -+unreserve_bo: -+ mwv207_bo_unreserve(jbo); -+free_fb: -+ kfree(fb); -+free_bo: -+ mwv207_bo_unref(jbo); -+ return ret; -+} -+ -+static const struct drm_fb_helper_funcs mwv207_fb_helper_funcs = { -+ .fb_probe = mwv207_fb_create, -+}; -+ -+int mwv207_fbdev_init(struct mwv207_device *jdev) -+{ -+ struct drm_fb_helper *fb_helper; -+ int preferred_bpp = 32; -+ int ret; -+ -+ fb_helper = devm_kzalloc(jdev->dev, sizeof(*fb_helper), GFP_KERNEL); -+ if (!fb_helper) -+ return -ENOMEM; -+ -+ drm_fb_helper_prepare(&jdev->base, fb_helper, &mwv207_fb_helper_funcs); -+ ret = mwv207_drm_fb_helper_init(&jdev->base, fb_helper, -+ jdev->base.num_crtcs, jdev->base.num_crtcs); -+ if (ret) { -+ DRM_ERROR("Failed to initialize fbdev helper\n"); -+ return ret; -+ } -+ -+ ret = drm_fb_helper_initial_config(fb_helper, preferred_bpp); -+ if (ret) { -+ DRM_ERROR("Failed to set fbdev configuration\n"); -+ goto err; -+ } -+ -+ jdev->fb_helper = fb_helper; -+ return 0; -+err: -+ drm_fb_helper_fini(fb_helper); -+ return ret; -+} -+ -+void mwv207_fbdev_fini(struct mwv207_device *jdev) -+{ -+ struct drm_framebuffer *fb; -+ struct mwv207_bo *jbo; -+ int ret; -+ -+ drm_fb_helper_unregister_fbi(jdev->fb_helper); -+ -+ fb = jdev->fb_helper ? jdev->fb_helper->fb : NULL; -+ if (fb == NULL) -+ return; -+ -+ jbo = mwv207_bo_from_gem(fb->obj[0]); -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret == 0) { -+ mwv207_bo_kunmap_reserved(jbo); -+ mwv207_bo_unpin_reserved(jbo); -+ mwv207_bo_unreserve(jbo); -+ drm_gem_object_put(fb->obj[0]); -+ drm_framebuffer_cleanup(fb); -+ } -+ -+ drm_fb_helper_fini(jdev->fb_helper); -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_hdmi.c b/drivers/gpu/drm/mwv207/dc/mwv207_hdmi.c -new file mode 100644 -index 000000000..7eff1169c ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_hdmi.c -@@ -0,0 +1,1083 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include "mwv207_vi.h" -+#include "mwv207_vbios.h" -+ -+/* hdmi specific, accessed by mwv207_hdmi_read/write */ -+ -+/* vi global, accessed by mwv207_output_read/write */ -+ -+#define connector_to_hdmi(conn) container_of(conn, struct mwv207_hdmi, base.connector) -+#define encoder_to_hdmi(encoder) container_of(encoder, struct mwv207_hdmi, base.encoder) -+ -+struct mwv207_hdmi_phy_data { -+ u32 min_freq_khz; -+ u32 max_freq_khz; -+ u32 bpp; -+ u8 config[47]; -+ u8 padding; -+} __packed; -+ -+static const struct mwv207_hdmi_phy_data -+default_phy_data[19] = { -+ { 24000, 47999, 8, -+ { 0xD2, 0x78, 0xB0, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x8B, 0xF0, -+ 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 28000, 95999, 8, -+ { 0xD2, 0x3C, 0x50, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x85, 0xF0, -+ 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 96000, 143999, 8, -+ { 0xD4, 0x50, 0x30, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x83, 0xF0, -+ 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 144000, 296999, 8, -+ { 0xD8, 0x50, 0x10, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x81, 0xF0, -+ 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 297000, 340000, 8, -+ { 0xDC, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x80, 0xF0, -+ 0x22, 0x82, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 340001, 595000, 8, -+ { 0xDC, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0x01, 0x25, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x80, 0xC0, -+ 0xF4, 0x69, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, -+ 0xFF, 0x00, 0x00}}, -+ { 24000, 27999, 10, -+ { 0xD2, 0x7D, 0x90, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x99, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 28000, 55999, 10, -+ { 0xD4, 0xC8, 0x70, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x97, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 56000, 111999, 10, -+ { 0xD4, 0x64, 0x30, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x93, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 112000, 223999, 10, -+ { 0xD8, 0x64, 0x10, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x91, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 224000, 272000, 10, -+ { 0xDC, 0x4B, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x90, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 272001, 340000, 10, -+ { 0xDC, 0x4B, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x90, 0xC0, -+ 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 340001, 475200, 10, -+ { 0xDC, 0x4B, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xCD, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0x90, 0xC0, -+ 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, -+ 0xFF, 0x00, 0x00}}, -+ { 24000, 47999, 12, -+ { 0xD1, 0x3C, 0x70, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA7, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 48000, 95999, 12, -+ { 0xD2, 0x3C, 0x30, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA3, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 96000, 197999, 12, -+ { 0xD4, 0x3C, 0x10, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA1, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 198000, 226999, 12, -+ { 0xD8, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA0, 0xC0, -+ 0x3A, 0x74, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 227000, 340000, 12, -+ { 0xD8, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA0, 0xC0, -+ 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE0, 0x83, 0x0F, 0x3E, -+ 0xF8, 0x00, 0x00}}, -+ { 340001, 396000, 12, -+ { 0xD8, 0x3C, 0x00, 0x01, 0x00, 0x88, 0x02, 0x4F, 0x30, 0x33, 0x65, -+ 0x00, 0xAB, 0x24, 0x80, 0x6C, 0xF2, 0x67, 0x00, 0x10, 0xA0, 0xC0, -+ 0x3D, 0xFA, 0x8F, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0xFF, -+ 0xFF, 0x00, 0x00}}, -+}; -+ -+struct mwv207_hdmi { -+ struct mwv207_output base; -+ -+ void __iomem *mmio; -+ bool sink_is_hdmi; -+ bool sink_has_audio; -+ int vic; -+ -+ int irq; -+ -+ u8 mc_clkdis; -+ bool rgb_limited_range; -+ struct mwv207_hdmi_phy_data phy_data[19]; -+}; -+ -+static const u16 csc_coeff_default[3][4] = { -+ { 0x2000, 0x0000, 0x0000, 0x0000 }, -+ { 0x0000, 0x2000, 0x0000, 0x0000 }, -+ { 0x0000, 0x0000, 0x2000, 0x0000 } -+}; -+ -+static const u16 csc_coeff_rgb_full_to_rgb_limited[3][4] = { -+ { 0x1b7c, 0x0000, 0x0000, 0x0020 }, -+ { 0x0000, 0x1b7c, 0x0000, 0x0020 }, -+ { 0x0000, 0x0000, 0x1b7c, 0x0020 } -+}; -+ -+static inline u8 mwv207_hdmi_readb(struct mwv207_hdmi *hdmi, u32 reg) -+{ -+ return readl(hdmi->mmio + reg * 4); -+} -+ -+static inline void mwv207_hdmi_writeb(struct mwv207_hdmi *hdmi, u8 value, u32 reg) -+{ -+ writel_relaxed(value, hdmi->mmio + reg * 4); -+} -+ -+static inline void mwv207_hdmi_modb(struct mwv207_hdmi *hdmi, u8 value, u8 mask, u32 reg) -+{ -+ u8 rvalue = mwv207_hdmi_readb(hdmi, reg); -+ -+ rvalue = (rvalue & ~mask) | (value & mask); -+ mwv207_hdmi_writeb(hdmi, rvalue, reg); -+} -+ -+static void mwv207_hdmi_mask_writeb(struct mwv207_hdmi *hdmi, u8 data, unsigned int reg, -+ u8 shift, u8 mask) -+{ -+ mwv207_hdmi_modb(hdmi, data << shift, mask, reg); -+} -+ -+static int mwv207_hdmi_phy_data_from_cfg(struct mwv207_hdmi *hdmi) -+{ -+ const struct mwv207_vdat *vdat; -+ int i; -+ -+ vdat = mwv207_vbios_vdat(hdmi->base.jdev, 0xfff0 + hdmi->base.idx); -+ if (!vdat) -+ return -ENOENT; -+ if (vdat->len != sizeof(hdmi->phy_data)) -+ return -EINVAL; -+ memcpy(hdmi->phy_data, vdat->dat, vdat->len); -+ for (i = 0; i < 19; ++i) { -+ hdmi->phy_data[i].min_freq_khz = le32_to_cpu(hdmi->phy_data[i].min_freq_khz); -+ hdmi->phy_data[i].max_freq_khz = le32_to_cpu(hdmi->phy_data[i].max_freq_khz); -+ hdmi->phy_data[i].bpp = le32_to_cpu(hdmi->phy_data[i].bpp); -+ } -+ return 0; -+} -+ -+static void mwv207_hdmi_phy_data_init(struct mwv207_hdmi *hdmi) -+{ -+ if (!mwv207_hdmi_phy_data_from_cfg(hdmi)) -+ return; -+ -+ DRM_INFO("mwv207: hdmi%d use default phy data", hdmi->base.idx); -+ -+ BUILD_BUG_ON(sizeof(hdmi->phy_data) != sizeof(default_phy_data)); -+ -+ memcpy(hdmi->phy_data, default_phy_data, sizeof(hdmi->phy_data)); -+} -+ -+static void mwv207_hdmi_phy_configure_data(struct mwv207_hdmi *hdmi, int kfreq, int bpp) -+{ -+ struct mwv207_output *output = &hdmi->base; -+ u32 regbase = (0x6000 + 0x800 * (output->idx)); -+ int i, cfg, offset; -+ -+ for (i = 0; i < 19; ++i) { -+ if (kfreq >= hdmi->phy_data[i].min_freq_khz -+ && kfreq <= hdmi->phy_data[i].max_freq_khz -+ && bpp == hdmi->phy_data[i].bpp) -+ break; -+ } -+ if (i >= 19) { -+ pr_warn("mwv207: no matching hdmi phydata found"); -+ return; -+ } -+ -+ cfg = i; -+ mwv207_output_write(output, regbase + 0x70, 0xc8); -+ mwv207_output_write(output, regbase + 0x74, 0x2); -+ for (i = 0; i < 47; i++) { -+ offset = 0x4 + i * 4; -+ if (offset == 0x84 || offset == 0x88 || offset == 0xB8) -+ continue; -+ -+ mwv207_output_write(output, regbase + offset, -+ hdmi->phy_data[cfg].config[i]); -+ } -+} -+ -+static void mwv207_hdmi_phy_switch(struct mwv207_hdmi *hdmi, int enable) -+{ -+ struct mwv207_output *output = &hdmi->base; -+ u32 regbase = (0x6000 + 0x800 * (output->idx)); -+ -+ if (enable) { -+ mwv207_output_write(output, regbase + 0x84, 0x80); -+ mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 1 << 28, 0 << 28); -+ } else { -+ mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 1 << 28, 1 << 28); -+ mwv207_output_write(output, regbase + 0x84, 0x00); -+ } -+} -+ -+static void mwv207_hdmi_phy_power_on(struct mwv207_hdmi *hdmi) -+{ -+ u8 val; -+ int i; -+ -+ mwv207_hdmi_phy_switch(hdmi, 1); -+ -+ for (i = 0; i < 5; ++i) { -+ val = mwv207_hdmi_readb(hdmi, 0x3004) & 0x01; -+ if (val) -+ break; -+ usleep_range(1000, 2000); -+ } -+ -+ if (!val) -+ pr_warn("mwv207: hdmi PHY PLL failed to lock\n"); -+} -+ -+static void mwv207_hdmi_phy_power_off(struct mwv207_hdmi *hdmi) -+{ -+ u8 val; -+ int i; -+ -+ mwv207_hdmi_phy_switch(hdmi, 0); -+ -+ for (i = 0; i < 5; ++i) { -+ val = mwv207_hdmi_readb(hdmi, 0x3004); -+ if (!(val & 0x01)) -+ break; -+ -+ usleep_range(1000, 2000); -+ } -+ -+ if (val & 0x01) -+ pr_warn("mwv207: PHY failed to power down\n"); -+} -+ -+static void mwv207_hdmi_phy_configure(struct mwv207_hdmi *hdmi, int kfreq, int bpp) -+{ -+ mwv207_hdmi_phy_power_off(hdmi); -+ -+ mwv207_hdmi_phy_configure_data(hdmi, kfreq, bpp); -+ -+ mwv207_hdmi_phy_power_on(hdmi); -+} -+ -+static void mwv207_hdmi_clear_overflow(struct mwv207_hdmi *hdmi) -+{ -+ u8 val; -+ -+ mwv207_hdmi_writeb(hdmi, (u8) ~0x02, 0x4002); -+ -+ val = mwv207_hdmi_readb(hdmi, 0x1000); -+ mwv207_hdmi_writeb(hdmi, val, 0x1000); -+} -+ -+static void mwv207_hdmi_ih_mutes(struct mwv207_hdmi *hdmi) -+{ -+ u8 ih_mute; -+ -+ ih_mute = mwv207_hdmi_readb(hdmi, 0x01FF) | 0x2 | 0x1; -+ -+ mwv207_hdmi_writeb(hdmi, ih_mute, 0x01FF); -+ -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0807); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x10D2); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x10D6); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x10DA); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3006); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3027); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3028); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3102); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3302); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3404); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x3505); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x5008); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x7E05); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x7E06); -+ -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0180); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0181); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0182); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0183); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0184); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0185); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0186); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0187); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0188); -+ mwv207_hdmi_writeb(hdmi, 0xff, 0x0189); -+ -+ ih_mute &= ~(0x2 | 0x1); -+ mwv207_hdmi_writeb(hdmi, ih_mute, 0x01FF); -+} -+ -+static void mwv207_hdmi_phy_setup_hpd(struct mwv207_hdmi *hdmi) -+{ -+ mwv207_hdmi_writeb(hdmi, 0x02, 0x3007); -+ mwv207_hdmi_writeb(hdmi, 0x1, 0x0104); -+ -+ mwv207_hdmi_writeb(hdmi, ~0x02, 0x3006); -+ -+ mwv207_hdmi_writeb(hdmi, 0x1, 0x0104); -+ mwv207_hdmi_writeb(hdmi, ~0x1, 0x0184); -+} -+ -+static irqreturn_t mwv207_hdmi_hard_irq(int irq, void *dev_id) -+{ -+ struct mwv207_hdmi *hdmi = dev_id; -+ irqreturn_t ret = IRQ_NONE; -+ u8 intr_stat; -+ -+ intr_stat = mwv207_hdmi_readb(hdmi, 0x0104); -+ if (intr_stat) { -+ mwv207_hdmi_writeb(hdmi, ~0, 0x0184); -+ return IRQ_WAKE_THREAD; -+ } -+ -+ return ret; -+} -+ -+static irqreturn_t mwv207_hdmi_irq(int irq, void *dev_id) -+{ -+ u8 intr_stat, phy_int_pol, phy_pol_mask, phy_stat; -+ struct mwv207_hdmi *hdmi = dev_id; -+ -+ intr_stat = mwv207_hdmi_readb(hdmi, 0x0104); -+ phy_int_pol = mwv207_hdmi_readb(hdmi, 0x3007); -+ phy_stat = mwv207_hdmi_readb(hdmi, 0x3004); -+ -+ phy_pol_mask = 0; -+ if (intr_stat & 0x1) -+ phy_pol_mask |= 0x02; -+ if (intr_stat & 0x4) -+ phy_pol_mask |= 0x10; -+ if (intr_stat & 0x8) -+ phy_pol_mask |= 0x20; -+ if (intr_stat & 0x10) -+ phy_pol_mask |= 0x40; -+ if (intr_stat & 0x20) -+ phy_pol_mask |= 0x80; -+ -+ if (phy_pol_mask) -+ mwv207_hdmi_modb(hdmi, ~phy_int_pol, phy_pol_mask, 0x3007); -+ -+ if (intr_stat & 0x1) -+ drm_helper_hpd_irq_event(&hdmi->base.jdev->base); -+ -+ mwv207_hdmi_writeb(hdmi, intr_stat, 0x0104); -+ mwv207_hdmi_writeb(hdmi, ~0x1, 0x0184); -+ -+ return IRQ_HANDLED; -+} -+ -+static void mwv207_hdmi_switch(struct mwv207_output *output, bool on) -+{ -+ mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 1, on ? 1 : 0); -+} -+ -+static void mwv207_hdmi_select_crtc(struct mwv207_output *output) -+{ -+ -+ mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), -+ 0x3 << 4, drm_crtc_index(output->cur_crtc) << 4); -+ -+ jdev_modify(output->jdev, 0x9b003c, 0b111 << (8 + output->idx * 4), -+ drm_crtc_index(output->cur_crtc) << (8 + output->idx * 4)); -+} -+ -+static void mwv207_hdmi_disable_overflow_interrupts(struct mwv207_hdmi *hdmi) -+{ -+ mwv207_hdmi_writeb(hdmi, 0x03, 0x0182); -+} -+ -+static bool mwv207_hdmi_support_scdc(struct mwv207_hdmi *hdmi, -+ const struct drm_display_info *display) -+{ -+ -+ if (!display->hdmi.scdc.supported || -+ !display->hdmi.scdc.scrambling.supported) -+ return false; -+ -+ if (!display->hdmi.scdc.scrambling.low_rates && -+ display->max_tmds_clock <= 340000) -+ return false; -+ -+ return true; -+} -+ -+static void mwv207_hdmi_av_composer(struct mwv207_hdmi *hdmi, const struct drm_display_mode *mode) -+{ -+ const struct drm_display_info *display = &hdmi->base.connector.display_info; -+ const struct drm_hdmi_info *hdmi_info = &display->hdmi; -+ int hblank, vblank, h_de_hs, v_de_vs, hsync_len, vsync_len; -+ struct mwv207_output *output = &hdmi->base; -+ unsigned int vdisplay, hdisplay; -+ u32 tmdsclock, rate; -+ u8 inv_val, bytes; -+ -+ tmdsclock = mode->clock * 1000; -+ -+ inv_val = (mwv207_hdmi_support_scdc(hdmi, display) && -+ (tmdsclock > 340000000 || -+ hdmi_info->scdc.scrambling.low_rates) ? 0x80 : 0x00); -+ -+ inv_val |= mode->flags & DRM_MODE_FLAG_PVSYNC ? 0x40 : 0x00; -+ -+ inv_val |= mode->flags & DRM_MODE_FLAG_PHSYNC ? 0x20 : 0x00; -+ -+ inv_val |= 0x10; -+ -+ if (hdmi->vic == 39) -+ inv_val |= 0x2; -+ else -+ inv_val |= mode->flags & DRM_MODE_FLAG_INTERLACE ? 0x2 : 0x0; -+ -+ inv_val |= mode->flags & DRM_MODE_FLAG_INTERLACE ? 0x1 : 0x0; -+ -+ inv_val |= hdmi->sink_is_hdmi ? 0x8 : 0x0; -+ -+ mwv207_hdmi_writeb(hdmi, inv_val, 0x1000); -+ -+ rate = drm_mode_vrefresh(mode) * 1000; -+ mwv207_hdmi_writeb(hdmi, rate >> 16, 0x1010); -+ mwv207_hdmi_writeb(hdmi, rate >> 8, 0x100F); -+ mwv207_hdmi_writeb(hdmi, rate, 0x100E); -+ -+ -+ mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 0x1 << 9, -+ (mode->flags & DRM_MODE_FLAG_PHSYNC ? 1 : 0) << 9); -+ mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 0x1 << 8, -+ (mode->flags & DRM_MODE_FLAG_PVSYNC ? 1 : 0) << 8); -+ mwv207_output_modify(output, (0x400 + 0x100 * (output->idx)), 0x1 << 10, 1 << 10); -+ -+ hdisplay = mode->hdisplay; -+ hblank = mode->htotal - mode->hdisplay; -+ h_de_hs = mode->hsync_start - mode->hdisplay; -+ hsync_len = mode->hsync_end - mode->hsync_start; -+ -+ vdisplay = mode->vdisplay; -+ vblank = mode->vtotal - mode->vdisplay; -+ v_de_vs = mode->vsync_start - mode->vdisplay; -+ vsync_len = mode->vsync_end - mode->vsync_start; -+ -+ if (mode->flags & DRM_MODE_FLAG_INTERLACE) { -+ vdisplay /= 2; -+ vblank /= 2; -+ v_de_vs /= 2; -+ vsync_len /= 2; -+ } -+ -+ if (mwv207_hdmi_support_scdc(hdmi, display)) { -+ if (tmdsclock > 340000000 || -+ hdmi_info->scdc.scrambling.low_rates) { -+ drm_scdc_readb(hdmi->base.ddc, SCDC_SINK_VERSION, -+ &bytes); -+ drm_scdc_writeb(hdmi->base.ddc, SCDC_SOURCE_VERSION, -+ min_t(u8, bytes, 0x1)); -+ -+ drm_scdc_set_scrambling(hdmi->base.ddc, 1); -+ -+ mwv207_hdmi_writeb(hdmi, (u8)~0x02, 0x4002); -+ mwv207_hdmi_writeb(hdmi, 1, 0x10E1); -+ } else { -+ mwv207_hdmi_writeb(hdmi, 0, 0x10E1); -+ mwv207_hdmi_writeb(hdmi, (u8)~0x02, 0x4002); -+ drm_scdc_set_scrambling(hdmi->base.ddc, 0); -+ } -+ } -+ -+ mwv207_hdmi_writeb(hdmi, hdisplay >> 8, 0x1002); -+ mwv207_hdmi_writeb(hdmi, hdisplay, 0x1001); -+ -+ mwv207_hdmi_writeb(hdmi, vdisplay >> 8, 0x1006); -+ mwv207_hdmi_writeb(hdmi, vdisplay, 0x1005); -+ -+ mwv207_hdmi_writeb(hdmi, hblank >> 8, 0x1004); -+ mwv207_hdmi_writeb(hdmi, hblank, 0x1003); -+ -+ mwv207_hdmi_writeb(hdmi, vblank >> 8, 0x102E); -+ mwv207_hdmi_writeb(hdmi, vblank, 0x1007); -+ -+ mwv207_hdmi_writeb(hdmi, h_de_hs >> 8, 0x1009); -+ mwv207_hdmi_writeb(hdmi, h_de_hs, 0x1008); -+ -+ mwv207_hdmi_writeb(hdmi, v_de_vs >> 8, 0x102F); -+ mwv207_hdmi_writeb(hdmi, v_de_vs, 0x100C); -+ -+ mwv207_hdmi_writeb(hdmi, hsync_len >> 8, 0x100B); -+ mwv207_hdmi_writeb(hdmi, hsync_len, 0x100A); -+ -+ mwv207_hdmi_writeb(hdmi, vsync_len, 0x100D); -+} -+ -+static void mwv207_hdmi_enable_video_path(struct mwv207_hdmi *hdmi) -+{ -+ mwv207_hdmi_writeb(hdmi, 12, 0x1011); -+ mwv207_hdmi_writeb(hdmi, 32, 0x1012); -+ mwv207_hdmi_writeb(hdmi, 1, 0x1013); -+ -+ mwv207_hdmi_writeb(hdmi, 0x0B, 0x1014); -+ mwv207_hdmi_writeb(hdmi, 0x16, 0x1015); -+ mwv207_hdmi_writeb(hdmi, 0x21, 0x1016); -+ -+ hdmi->mc_clkdis |= 0x40 | 0x8 | 0x10 | 0x4 | 0x2; -+ hdmi->mc_clkdis &= ~0x1; -+ mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); -+ -+ hdmi->mc_clkdis &= ~0x2; -+ mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); -+ -+ if (hdmi->rgb_limited_range) { -+ hdmi->mc_clkdis &= ~0x10; -+ mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); -+ -+ mwv207_hdmi_writeb(hdmi, 0x1, 0x4004); -+ } else { -+ hdmi->mc_clkdis |= 0x10; -+ mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); -+ -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x4004); -+ } -+} -+ -+static void mwv207_hdmi_enable_audio_clk(struct mwv207_hdmi *hdmi, bool enable) -+{ -+ if (enable) -+ hdmi->mc_clkdis &= ~0x8; -+ else -+ hdmi->mc_clkdis |= 0x8; -+ mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); -+} -+ -+static void mwv207_hdmi_config_AVI(struct mwv207_hdmi *hdmi, -+ struct drm_connector *connector, -+ const struct drm_display_mode *mode) -+{ -+ struct hdmi_avi_infoframe frame; -+ u8 val; -+ -+ -+ drm_hdmi_avi_infoframe_from_display_mode(&frame, connector, mode); -+ -+ drm_hdmi_avi_infoframe_quant_range(&frame, connector, mode, -+ hdmi->rgb_limited_range ? -+ HDMI_QUANTIZATION_RANGE_LIMITED : -+ HDMI_QUANTIZATION_RANGE_FULL); -+ -+ frame.colorspace = HDMI_COLORSPACE_RGB; -+ frame.colorimetry = HDMI_COLORIMETRY_NONE; -+ frame.extended_colorimetry = -+ HDMI_EXTENDED_COLORIMETRY_XV_YCC_601; -+ -+ val = (frame.scan_mode & 3) << 4 | (frame.colorspace & 3); -+ if (frame.active_aspect & 15) -+ val |= 0x40; -+ if (frame.top_bar || frame.bottom_bar) -+ val |= 0x08; -+ if (frame.left_bar || frame.right_bar) -+ val |= 0x04; -+ mwv207_hdmi_writeb(hdmi, val, 0x1019); -+ -+ -+ val = ((frame.colorimetry & 0x3) << 6) | -+ ((frame.picture_aspect & 0x3) << 4) | -+ (frame.active_aspect & 0xf); -+ mwv207_hdmi_writeb(hdmi, val, 0x101A); -+ -+ -+ val = ((frame.extended_colorimetry & 0x7) << 4) | -+ ((frame.quantization_range & 0x3) << 2) | -+ (frame.nups & 0x3); -+ if (frame.itc) -+ val |= 0x80; -+ mwv207_hdmi_writeb(hdmi, val, 0x101B); -+ -+ -+ val = frame.video_code & 0x7f; -+ mwv207_hdmi_writeb(hdmi, val, 0x101C); -+ -+ -+ val = ((1 << 4) & 0xF0); -+ mwv207_hdmi_writeb(hdmi, val, 0x10E0); -+ -+ val = ((frame.ycc_quantization_range & 0x3) << 2) | -+ (frame.content_type & 0x3); -+ mwv207_hdmi_writeb(hdmi, val, 0x1017); -+ -+ mwv207_hdmi_writeb(hdmi, frame.top_bar & 0xff, 0x101D); -+ mwv207_hdmi_writeb(hdmi, (frame.top_bar >> 8) & 0xff, 0x101E); -+ mwv207_hdmi_writeb(hdmi, frame.bottom_bar & 0xff, 0x101F); -+ mwv207_hdmi_writeb(hdmi, (frame.bottom_bar >> 8) & 0xff, 0x1020); -+ mwv207_hdmi_writeb(hdmi, frame.left_bar & 0xff, 0x1021); -+ mwv207_hdmi_writeb(hdmi, (frame.left_bar >> 8) & 0xff, 0x1022); -+ mwv207_hdmi_writeb(hdmi, frame.right_bar & 0xff, 0x1023); -+ mwv207_hdmi_writeb(hdmi, (frame.right_bar >> 8) & 0xff, 0x1024); -+} -+ -+static void mwv207_hdmi_config_vendor_specific_infoframe(struct mwv207_hdmi *hdmi, -+ struct drm_connector *connector, -+ const struct drm_display_mode *mode) -+{ -+ struct hdmi_vendor_infoframe frame; -+ u8 buffer[10]; -+ ssize_t err; -+ -+ err = drm_hdmi_vendor_infoframe_from_display_mode(&frame, connector, -+ mode); -+ if (err < 0) -+ return; -+ -+ err = hdmi_vendor_infoframe_pack(&frame, buffer, sizeof(buffer)); -+ if (err < 0) { -+ DRM_ERROR("Failed to pack vendor infoframe: %zd\n", err); -+ return; -+ } -+ mwv207_hdmi_mask_writeb(hdmi, 0, 0x10B3, 3, 0x08); -+ -+ mwv207_hdmi_writeb(hdmi, buffer[2], 0x102A); -+ -+ mwv207_hdmi_writeb(hdmi, buffer[4], 0x1029); -+ mwv207_hdmi_writeb(hdmi, buffer[5], 0x1030); -+ mwv207_hdmi_writeb(hdmi, buffer[6], 0x1031); -+ -+ mwv207_hdmi_writeb(hdmi, buffer[7], 0x1032); -+ mwv207_hdmi_writeb(hdmi, buffer[8], 0x1033); -+ -+ if (frame.s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF) -+ mwv207_hdmi_writeb(hdmi, buffer[9], 0x1034); -+ -+ mwv207_hdmi_writeb(hdmi, 1, 0x10B4); -+ -+ mwv207_hdmi_writeb(hdmi, 0x11, 0x10B5); -+ -+ mwv207_hdmi_mask_writeb(hdmi, 1, 0x10B3, 3, 0x08); -+} -+ -+static void mwv207_hdmi_config_drm_infoframe(struct mwv207_hdmi *hdmi, -+ const struct drm_connector *connector) -+{ -+ const struct drm_connector_state *conn_state = connector->state; -+ struct hdmi_drm_infoframe frame; -+ u8 buffer[30]; -+ ssize_t err; -+ int i; -+ -+ mwv207_hdmi_modb(hdmi, 0x00, 0x80, 0x10E3); -+ -+ err = drm_hdmi_infoframe_set_hdr_metadata(&frame, conn_state); -+ if (err < 0) -+ return; -+ -+ err = hdmi_drm_infoframe_pack(&frame, buffer, sizeof(buffer)); -+ if (err < 0) -+ return; -+ -+ mwv207_hdmi_writeb(hdmi, frame.version, 0x1168); -+ mwv207_hdmi_writeb(hdmi, frame.length, 0x1169); -+ -+ for (i = 0; i < frame.length; i++) -+ mwv207_hdmi_writeb(hdmi, buffer[4 + i], 0x116A + i); -+ -+ mwv207_hdmi_writeb(hdmi, 1, 0x1167); -+ mwv207_hdmi_modb(hdmi, 0x80, 0x80, 0x10E3); -+} -+ -+static void mwv207_hdmi_video_packetize(struct mwv207_hdmi *hdmi) -+{ -+ unsigned int output_select = 0x3; -+ unsigned int remap_size = 0x0; -+ unsigned int color_depth = 4; -+ u8 val, vp_conf; -+ -+ val = ((color_depth << 4) & 0xF0); -+ mwv207_hdmi_writeb(hdmi, val, 0x0801); -+ -+ mwv207_hdmi_modb(hdmi, 0x1, 0x1, 0x0802); -+ -+ vp_conf = 0x00 | 0x4; -+ -+ mwv207_hdmi_modb(hdmi, vp_conf, 0x10 | 0x4, 0x0804); -+ -+ mwv207_hdmi_modb(hdmi, 1 << 5, 0x20, 0x0802); -+ -+ mwv207_hdmi_writeb(hdmi, remap_size, 0x0803); -+ -+ vp_conf = 0x40 | 0x00 | 0x0; -+ -+ mwv207_hdmi_modb(hdmi, vp_conf, 0x40 | 0x20 | 0x8, 0x0804); -+ -+ mwv207_hdmi_modb(hdmi, 0x2 | 0x4, 0x2 | 0x4, 0x0802); -+ -+ mwv207_hdmi_modb(hdmi, output_select, 0x3, 0x0804); -+} -+ -+static void mwv207_hdmi_update_csc_coeffs(struct mwv207_hdmi *hdmi) -+{ -+ const u16 (*csc_coeff)[3][4] = &csc_coeff_default; -+ unsigned int i; -+ u32 csc_scale = 1; -+ -+ if (hdmi->rgb_limited_range) -+ csc_coeff = &csc_coeff_rgb_full_to_rgb_limited; -+ else -+ csc_coeff = &csc_coeff_default; -+ -+ for (i = 0; i < ARRAY_SIZE(csc_coeff_default[0]); i++) { -+ u16 coeff_a = (*csc_coeff)[0][i]; -+ u16 coeff_b = (*csc_coeff)[1][i]; -+ u16 coeff_c = (*csc_coeff)[2][i]; -+ -+ mwv207_hdmi_writeb(hdmi, coeff_a & 0xff, 0x4103 + i * 2); -+ mwv207_hdmi_writeb(hdmi, coeff_a >> 8, 0x4102 + i * 2); -+ mwv207_hdmi_writeb(hdmi, coeff_b & 0xff, 0x410B + i * 2); -+ mwv207_hdmi_writeb(hdmi, coeff_b >> 8, 0x410A + i * 2); -+ mwv207_hdmi_writeb(hdmi, coeff_c & 0xff, 0x4113 + i * 2); -+ mwv207_hdmi_writeb(hdmi, coeff_c >> 8, 0x4112 + i * 2); -+ } -+ -+ mwv207_hdmi_modb(hdmi, csc_scale, 0x03, 0x4101); -+} -+ -+static void mwv207_hdmi_video_csc(struct mwv207_hdmi *hdmi) -+{ -+ int color_depth = 0x00; -+ -+ mwv207_hdmi_writeb(hdmi, 0, 0x4100); -+ mwv207_hdmi_modb(hdmi, color_depth, 0xF0, 0x4101); -+ -+ mwv207_hdmi_update_csc_coeffs(hdmi); -+} -+ -+static void mwv207_hdmi_video_sample(struct mwv207_hdmi *hdmi) -+{ -+ int color_format = 1; -+ u8 val; -+ -+ val = 0x00 | ((color_format << 0) & 0x1F); -+ mwv207_hdmi_writeb(hdmi, val, 0x0200); -+ -+ val = 0x4 | 0x2 | 0x1; -+ mwv207_hdmi_writeb(hdmi, val, 0x0201); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0202); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0203); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0204); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0205); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0206); -+ mwv207_hdmi_writeb(hdmi, 0x0, 0x0207); -+} -+ -+static void mwv207_hdmi_tx_hdcp_config(struct mwv207_hdmi *hdmi) -+{ -+ u8 de = 0x10; -+ -+ mwv207_hdmi_modb(hdmi, 0x0, 0x4, 0x5000); -+ -+ mwv207_hdmi_modb(hdmi, de, 0x10, 0x5009); -+ -+ mwv207_hdmi_modb(hdmi, 0x2, 0x2, 0x5001); -+} -+ -+static void mwv207_hdmi_set_timing(struct mwv207_hdmi *hdmi) -+{ -+ struct drm_display_mode *mode; -+ -+ mwv207_hdmi_disable_overflow_interrupts(hdmi); -+ -+ mode = &hdmi->base.cur_crtc->state->adjusted_mode; -+ hdmi->vic = drm_match_cea_mode(mode); -+ -+ hdmi->rgb_limited_range = hdmi->sink_is_hdmi && -+ drm_default_rgb_quant_range(mode) == -+ HDMI_QUANTIZATION_RANGE_LIMITED; -+ -+ mwv207_hdmi_av_composer(hdmi, mode); -+ -+ mwv207_hdmi_phy_configure(hdmi, mode->clock, 8); -+ -+ mwv207_hdmi_enable_video_path(hdmi); -+ -+ if (hdmi->sink_has_audio) { -+ mwv207_hdmi_enable_audio_clk(hdmi, 1); -+ } -+ -+ if (hdmi->sink_is_hdmi) { -+ struct drm_connector *conn = &hdmi->base.connector; -+ -+ mwv207_hdmi_config_AVI(hdmi, conn, mode); -+ mwv207_hdmi_config_vendor_specific_infoframe(hdmi, conn, mode); -+ mwv207_hdmi_config_drm_infoframe(hdmi, conn); -+ } -+ -+ mwv207_hdmi_video_packetize(hdmi); -+ mwv207_hdmi_video_csc(hdmi); -+ mwv207_hdmi_video_sample(hdmi); -+ mwv207_hdmi_tx_hdcp_config(hdmi); -+ -+ mwv207_hdmi_clear_overflow(hdmi); -+} -+ -+static int mwv207_hdmi_get_modes(struct drm_connector *connector) -+{ -+ struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); -+ int count; -+ -+ count = mwv207_output_get_modes(connector); -+ -+ if (connector->edid_blob_ptr) { -+ struct edid *edid; -+ -+ edid = (struct edid *)connector->edid_blob_ptr->data; -+ hdmi->sink_is_hdmi = drm_detect_hdmi_monitor(edid); -+ hdmi->sink_has_audio = drm_detect_monitor_audio(edid); -+ } else { -+ hdmi->sink_is_hdmi = false; -+ hdmi->sink_has_audio = false; -+ } -+ -+ return count; -+} -+ -+static enum drm_mode_status mwv207_hdmi_mode_valid(struct mwv207_hdmi *hdmi, -+ const struct drm_display_mode *mode) -+{ -+ if (mode->clock >= 384000) -+ return MODE_CLOCK_HIGH; -+ -+ if (mode->clock > 594000) -+ return MODE_CLOCK_HIGH; -+ -+ if (!hdmi->sink_is_hdmi && mode->clock >= 165000) -+ return MODE_CLOCK_HIGH; -+ -+ return MODE_OK; -+} -+ -+static enum drm_mode_status mwv207_hdmi_connector_mode_valid(struct drm_connector *connector, -+ struct drm_display_mode *mode) -+{ -+ struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); -+ -+ return mwv207_hdmi_mode_valid(hdmi, mode); -+} -+ -+static int mwv207_hdmi_detect_ctx(struct drm_connector *connector, -+ struct drm_modeset_acquire_ctx *ctx, -+ bool force) -+{ -+ struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); -+ u32 value; -+ -+ value = mwv207_hdmi_readb(hdmi, 0x3004); -+ if (value & 0x2) -+ return connector_status_connected; -+ else -+ return connector_status_disconnected; -+} -+ -+static void mwv207_hdmi_destroy(struct drm_connector *conn) -+{ -+ struct mwv207_hdmi *hdmi = connector_to_hdmi(conn); -+ -+ free_irq(hdmi->irq, hdmi); -+ drm_connector_unregister(conn); -+ drm_connector_cleanup(conn); -+} -+ -+static const struct drm_connector_helper_funcs mwv207_hdmi_connector_helper_funcs = { -+ .get_modes = mwv207_hdmi_get_modes, -+ .mode_valid = mwv207_hdmi_connector_mode_valid, -+ .detect_ctx = mwv207_hdmi_detect_ctx -+}; -+ -+static const struct drm_connector_funcs mwv207_hdmi_connector_funcs = { -+ .reset = drm_atomic_helper_connector_reset, -+ .fill_modes = drm_helper_probe_single_connector_modes, -+ .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, -+ .destroy = mwv207_hdmi_destroy, -+ .late_register = mwv207_output_late_register, -+ .early_unregister = mwv207_output_early_unregister, -+}; -+ -+static enum drm_mode_status mwv207_hdmi_encoder_mode_valid(struct drm_encoder *encoder, -+ const struct drm_display_mode *mode) -+{ -+ struct mwv207_hdmi *hdmi = encoder_to_hdmi(encoder); -+ -+ return mwv207_hdmi_mode_valid(hdmi, mode); -+} -+ -+static int mwv207_hdmi_encoder_atomic_check(struct drm_encoder *encoder, -+ struct drm_crtc_state *crtc_state, -+ struct drm_connector_state *conn_state) -+{ -+ return 0; -+} -+ -+static void mwv207_hdmi_encoder_enable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_hdmi_select_crtc(output); -+ -+ mwv207_hdmi_set_timing(encoder_to_hdmi(encoder)); -+ -+ mwv207_hdmi_switch(output, true); -+} -+ -+static void mwv207_hdmi_encoder_disable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_hdmi_switch(output, false); -+} -+ -+static void mwv207_hdmi_encoder_reset(struct drm_encoder *encoder) -+{ -+ mwv207_hdmi_encoder_disable(encoder); -+ mwv207_hdmi_ih_mutes(encoder_to_hdmi(encoder)); -+ mwv207_hdmi_phy_setup_hpd(encoder_to_hdmi(encoder)); -+} -+ -+static const struct drm_encoder_funcs mwv207_hdmi_encoder_funcs = { -+ .destroy = drm_encoder_cleanup, -+ .reset = mwv207_hdmi_encoder_reset, -+}; -+ -+static const struct drm_encoder_helper_funcs mwv207_hdmi_encoder_helper_funcs = { -+ .mode_valid = mwv207_hdmi_encoder_mode_valid, -+ .atomic_check = mwv207_hdmi_encoder_atomic_check, -+ .enable = mwv207_hdmi_encoder_enable, -+ .disable = mwv207_hdmi_encoder_disable, -+}; -+ -+static int mwv207_hdmi_init_single(struct mwv207_device *jdev, int idx) -+{ -+ struct mwv207_output *output; -+ struct mwv207_hdmi *hdmi; -+ int ret; -+ -+ hdmi = devm_kzalloc(jdev->dev, sizeof(*hdmi), GFP_KERNEL); -+ if (!hdmi) -+ return -ENOMEM; -+ -+ output = &hdmi->base; -+ output->jdev = jdev; -+ output->idx = idx; -+ output->mmio = jdev->mmio + 0x9a0000; -+ output->i2c_chan = 0 + idx; -+ hdmi->mmio = jdev->mmio + (0x1200000 + 0x40000 * (idx)); -+ hdmi->mc_clkdis = 0x7f; -+ -+ mwv207_hdmi_phy_data_init(hdmi); -+ -+ output->connector.polled = DRM_CONNECTOR_POLL_HPD; -+ ret = drm_connector_init(&jdev->base, &output->connector, -+ &mwv207_hdmi_connector_funcs, DRM_MODE_CONNECTOR_HDMIA); -+ if (ret) -+ return ret; -+ drm_connector_helper_add(&output->connector, &mwv207_hdmi_connector_helper_funcs); -+ -+ output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; -+ ret = drm_encoder_init(&jdev->base, &output->encoder, -+ &mwv207_hdmi_encoder_funcs, DRM_MODE_ENCODER_TMDS, -+ "hdmi-%d", output->idx); -+ if (ret) -+ return ret; -+ drm_encoder_helper_add(&output->encoder, &mwv207_hdmi_encoder_helper_funcs); -+ -+ ret = drm_connector_attach_encoder(&output->connector, &output->encoder); -+ if (ret) -+ return ret; -+ -+ hdmi->irq = irq_find_mapping(jdev->irq_domain, output->idx + 32); -+ BUG_ON(hdmi->irq == 0); -+ -+ ret = request_threaded_irq(hdmi->irq, -+ mwv207_hdmi_hard_irq, mwv207_hdmi_irq, -+ IRQF_SHARED, output->encoder.name, hdmi); -+ if (ret) -+ return ret; -+ -+ ret = drm_connector_register(&output->connector); -+ if (ret) -+ free_irq(hdmi->irq, hdmi); -+ -+ return ret; -+} -+ -+int mwv207_hdmi_init(struct mwv207_device *jdev) -+{ -+ int i, ret; -+ -+ for (i = 0; i < 4; i++) { -+ -+ if (jdev_read(jdev, (0x1200000 + 0x40000 * (i))) != 0x21) -+ continue; -+ ret = mwv207_hdmi_init_single(jdev, i); -+ if (ret) -+ return ret; -+ } -+ -+ return 0; -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_i2c.c b/drivers/gpu/drm/mwv207/dc/mwv207_i2c.c -new file mode 100644 -index 000000000..bcfbef8d5 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_i2c.c -@@ -0,0 +1,312 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_vi.h" -+ -+static int i2c_scl_gpio[8] = {19, 21, 23, 25, 27, 29, 31, 33}; -+static int i2c_sda_gpio[8] = {20, 22, 24, 26, 28, 30, 32, 34}; -+ -+struct mwv207_i2c { -+ struct i2c_adapter adapter; -+ struct mwv207_device *jdev; -+ struct i2c_algo_bit_data bit; -+ struct mutex *mutex; -+ u32 sda_in_addr; -+ u32 sda_out_addr; -+ u32 sda_mask; -+ u32 sda_dir; -+ u32 scl_in_addr; -+ u32 scl_out_addr; -+ u32 scl_mask; -+ u32 scl_dir; -+}; -+ -+static inline void mwv207_i2c_set_dir(struct mwv207_i2c *i2c, u32 mask, -+ u32 reg, bool is_input) -+{ -+ mb(); -+ -+ jdev_modify(i2c->jdev, reg, mask, is_input ? mask : 0); -+ -+ mb(); -+} -+ -+ -+static void mwv207_i2c_gpio_multi(struct mwv207_i2c *i2c, int mask) -+{ -+ struct mwv207_device *jdev = i2c->jdev; -+ -+ switch (mask) { -+ case (1 << 19): -+ -+ jdev_modify(jdev, (0x9b0918), 0x3 << 12, 0); -+ jdev_modify(jdev, (0x9b0918), 0x3 << 16, 0); -+ break; -+ case (1 << 21): -+ -+ jdev_modify(jdev, (0x9b0918), 0x3 << 20, 0); -+ jdev_modify(jdev, (0x9b0918), 0x3 << 24, 0); -+ break; -+ case (1 << 23): -+ -+ jdev_modify(jdev, (0x9b0918), 0x3 << 28, 0); -+ jdev_modify(jdev, (0x9b091c), 0x3, 0); -+ break; -+ case (1 << 25): -+ -+ jdev_modify(jdev, (0x9b091c), 0x3 << 4, 0); -+ jdev_modify(jdev, (0x9b091c), 0x3 << 8, 0); -+ break; -+ case (1 << 27): -+ -+ jdev_modify(jdev, (0x9b091c), 0x3 << 12, 0); -+ jdev_modify(jdev, (0x9b091c), 0x3 << 16, 0); -+ break; -+ case (1 << 29): -+ -+ jdev_modify(jdev, (0x9b091c), 0x3 << 20, 0); -+ jdev_modify(jdev, (0x9b091c), 0x3 << 24, 0); -+ break; -+ case (1 << 31): -+ -+ jdev_modify(jdev, (0x9b091c), 0x3 << 28, 0); -+ jdev_modify(jdev, (0x9b0910), 0x3, 0); -+ break; -+ case (1 << 1): -+ -+ jdev_modify(jdev, (0x9b0910), 0x3 << 4, 0); -+ jdev_modify(jdev, (0x9b0910), 0x3 << 8, 0); -+ break; -+ default: -+ break; -+ } -+} -+ -+static int mwv207_i2c_pre_xfer(struct i2c_adapter *i2c_adap) -+{ -+ struct mwv207_i2c *i2c = i2c_get_adapdata(i2c_adap); -+ struct mwv207_device *jdev = i2c->jdev; -+ -+ mutex_lock(i2c->mutex); -+ mwv207_i2c_gpio_multi(i2c, i2c->scl_mask); -+ -+ jdev_modify(jdev, i2c->scl_out_addr, i2c->scl_mask, 0); -+ jdev_modify(jdev, i2c->sda_out_addr, i2c->sda_mask, 0); -+ -+ mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 1); -+ mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); -+ -+ return 0; -+} -+ -+static void mwv207_i2c_post_xfer(struct i2c_adapter *i2c_adap) -+{ -+ struct mwv207_i2c *i2c = i2c_get_adapdata(i2c_adap); -+ -+ mutex_unlock(i2c->mutex); -+} -+ -+static int mwv207_i2c_get_clock(void *i2c_priv) -+{ -+ struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; -+ struct mwv207_device *jdev = i2c->jdev; -+ u32 val; -+ -+ mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 1); -+ -+ val = jdev_read(jdev, i2c->scl_in_addr); -+ val &= i2c->scl_mask; -+ -+ return val ? 1 : 0; -+} -+ -+static int mwv207_i2c_get_data(void *i2c_priv) -+{ -+ struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; -+ struct mwv207_device *jdev = i2c->jdev; -+ u32 val; -+ -+ mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); -+ -+ val = jdev_read(jdev, i2c->sda_in_addr); -+ val &= i2c->sda_mask; -+ -+ return val ? 1 : 0; -+} -+ -+static void mwv207_i2c_set_clock(void *i2c_priv, int clock) -+{ -+ struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; -+ struct mwv207_device *jdev = i2c->jdev; -+ -+ mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 0); -+ jdev_modify(jdev, i2c->scl_out_addr, i2c->scl_mask, clock ? i2c->scl_mask : 0); -+} -+ -+static void mwv207_i2c_set_data(void *i2c_priv, int data) -+{ -+ struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; -+ -+ if (data) -+ mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); -+ else -+ mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 0); -+} -+ -+static int mwv207_i2c_set_addr(struct mwv207_i2c *i2c, int channel) -+{ -+ switch (channel) { -+ case 0: -+ case 1: -+ case 2: -+ case 3: -+ case 4: -+ case 5: -+ i2c->sda_in_addr = (0x9aa000); -+ i2c->scl_in_addr = (0x9aa000); -+ i2c->sda_out_addr = (0x9aa004); -+ i2c->scl_out_addr = (0x9aa004); -+ i2c->scl_mask = (1 << i2c_scl_gpio[channel]); -+ i2c->sda_mask = (1 << i2c_sda_gpio[channel]); -+ i2c->scl_dir = (0x9aa008); -+ i2c->sda_dir = (0x9aa008); -+ break; -+ case 6: -+ i2c->sda_in_addr = (0x9aa000); -+ i2c->scl_in_addr = (0x9aa010); -+ i2c->sda_out_addr = (0x9aa004); -+ i2c->scl_out_addr = (0x9aa014); -+ i2c->scl_mask = (1 << i2c_scl_gpio[channel]); -+ i2c->sda_mask = (1 << (i2c_sda_gpio[channel] - 32)); -+ i2c->scl_dir = (0x9aa008); -+ i2c->sda_dir = (0x9aa018); -+ break; -+ case 7: -+ i2c->sda_in_addr = (0x9aa010); -+ i2c->scl_in_addr = (0x9aa010); -+ i2c->sda_out_addr = (0x9aa014); -+ i2c->scl_out_addr = (0x9aa014); -+ i2c->scl_mask = (1 << (i2c_scl_gpio[channel] - 32)); -+ i2c->sda_mask = (1 << (i2c_sda_gpio[channel] - 32)); -+ i2c->scl_dir = (0x9aa018); -+ i2c->sda_dir = (0x9aa018); -+ break; -+ } -+ -+ return 0; -+} -+ -+void mwv207_i2c_put_byte(struct i2c_adapter *i2c, -+ u8 slave_addr, -+ u8 addr, -+ u8 val) -+{ -+ uint8_t out_buf[2]; -+ struct i2c_msg msg = { -+ .addr = slave_addr, -+ .flags = 0, -+ .len = 2, -+ .buf = out_buf, -+ }; -+ -+ out_buf[0] = addr; -+ out_buf[1] = val; -+ -+ if (i2c_transfer(i2c, &msg, 1) != 1) -+ pr_warn("i2c 0x%02x 0x%02x write failed\n", -+ addr, val); -+} -+ -+void mwv207_i2c_destroy(struct i2c_adapter *adapter) -+{ -+ i2c_del_adapter(adapter); -+} -+ -+struct i2c_adapter *mwv207_i2c_create(struct mwv207_device *jdev, int i2c_chan) -+{ -+ struct mwv207_i2c *i2c; -+ int ret; -+ -+ if (i2c_chan < 0 || i2c_chan >= 6) -+ return NULL; -+ -+ i2c = devm_kzalloc(jdev->dev, sizeof(*i2c), GFP_KERNEL); -+ if (!i2c) -+ return NULL; -+ -+ if (mwv207_i2c_set_addr(i2c, i2c_chan)) -+ return NULL; -+ -+ i2c->adapter.owner = THIS_MODULE; -+ i2c->adapter.class = I2C_CLASS_DDC; -+ i2c->adapter.dev.parent = jdev->dev; -+ i2c_set_adapdata(&i2c->adapter, i2c); -+ i2c->mutex = &jdev->gpio_lock; -+ i2c->jdev = jdev; -+ -+ snprintf(i2c->adapter.name, sizeof(i2c->adapter.name), -+ "MWV207_I2C_%d", i2c_chan); -+ i2c->adapter.algo_data = &i2c->bit; -+ i2c->bit.pre_xfer = mwv207_i2c_pre_xfer; -+ i2c->bit.post_xfer = mwv207_i2c_post_xfer; -+ i2c->bit.setsda = mwv207_i2c_set_data; -+ i2c->bit.setscl = mwv207_i2c_set_clock; -+ i2c->bit.getsda = mwv207_i2c_get_data; -+ i2c->bit.getscl = mwv207_i2c_get_clock; -+ i2c->bit.udelay = 10; -+ i2c->bit.timeout = usecs_to_jiffies(2200); -+ i2c->bit.data = i2c; -+ -+ ret = i2c_bit_add_bus(&i2c->adapter); -+ if (ret) -+ return NULL; -+ -+ return &i2c->adapter; -+} -+ -+bool mwv207_i2c_probe(struct i2c_adapter *i2c_bus) -+{ -+ u8 out = 0x0; -+ u8 buf[8]; -+ int ret; -+ struct i2c_msg msgs[] = { -+ { -+ .addr = DDC_ADDR, -+ .flags = 0, -+ .len = 1, -+ .buf = &out, -+ }, -+ { -+ .addr = DDC_ADDR, -+ .flags = I2C_M_RD, -+ .len = 8, -+ .buf = buf, -+ } -+ }; -+ -+ ret = i2c_transfer(i2c_bus, msgs, 2); -+ if (ret != 2) { -+ -+ return false; -+ } -+ -+ if (drm_edid_header_is_valid(buf) < 6) { -+ return false; -+ } -+ return true; -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_kms.c b/drivers/gpu/drm/mwv207/dc/mwv207_kms.c -new file mode 100644 -index 000000000..b5c22f033 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_kms.c -@@ -0,0 +1,204 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207_gem.h" -+#include "mwv207_kms.h" -+#include "mwv207_va.h" -+#include "mwv207_vi.h" -+ -+static const struct drm_framebuffer_funcs fb_funcs = { -+ .destroy = drm_gem_fb_destroy, -+ .create_handle = drm_gem_fb_create_handle, -+}; -+ -+int mwv207_framebuffer_init(struct mwv207_device *jdev, struct drm_framebuffer *fb, -+ const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object *gobj) -+{ -+ int ret; -+ -+ fb->obj[0] = gobj; -+ drm_helper_mode_fill_fb_struct(&jdev->base, fb, mode_cmd); -+ -+ ret = drm_framebuffer_init(&jdev->base, fb, &fb_funcs); -+ return ret; -+} -+ -+static struct drm_framebuffer *mwv207_framebuffer_create( -+ struct drm_device *dev, -+ struct drm_file *filp, -+ const struct drm_mode_fb_cmd2 *mode_cmd) -+{ -+ struct drm_gem_object *gobj = drm_gem_object_lookup(filp, mode_cmd->handles[0]); -+ struct drm_framebuffer *fb; -+ int err = -ENOENT; -+ -+ if (!gobj) { -+ DRM_DEBUG_DRIVER("fbdev failed to lookup gem object, handle = %d\n", -+ mode_cmd->handles[0]); -+ return ERR_PTR(-ENOENT); -+ } -+ -+ fb = kzalloc(sizeof(*fb), GFP_KERNEL); -+ if (!fb) { -+ err = -ENOMEM; -+ goto err_unref; -+ } -+ -+ err = mwv207_framebuffer_init(dev->dev_private, fb, mode_cmd, gobj); -+ if (err) -+ goto err_free; -+ -+ return fb; -+err_free: -+ kfree(fb); -+err_unref: -+ drm_gem_object_put(gobj); -+ return ERR_PTR(err); -+} -+ -+static void mwv207_atomic_prepare_vblank(struct drm_device *dev, -+ struct drm_atomic_state *old_state) -+{ -+ struct drm_crtc_state *new_crtc_state; -+ struct drm_crtc *crtc; -+ int i; -+ -+ for_each_new_crtc_in_state(old_state, crtc, new_crtc_state, i) -+ mwv207_crtc_prepare_vblank(crtc); -+} -+ -+static void mwv207_atomic_commit_tail(struct drm_atomic_state *old_state) -+{ -+ struct drm_device *dev = old_state->dev; -+ -+ drm_atomic_helper_commit_modeset_disables(dev, old_state); -+ drm_atomic_helper_commit_planes(dev, old_state, 0); -+ drm_atomic_helper_commit_modeset_enables(dev, old_state); -+ -+ mwv207_atomic_prepare_vblank(dev, old_state); -+ -+ drm_atomic_helper_commit_hw_done(old_state); -+ -+ drm_atomic_helper_wait_for_vblanks(dev, old_state); -+ drm_atomic_helper_cleanup_planes(dev, old_state); -+} -+ -+static struct drm_mode_config_helper_funcs mwv207_mode_config_helper_funcs = { -+ .atomic_commit_tail = mwv207_atomic_commit_tail, -+}; -+ -+static const struct drm_mode_config_funcs mwv207_mode_config_funcs = { -+ .fb_create = mwv207_framebuffer_create, -+ .atomic_check = drm_atomic_helper_check, -+ .atomic_commit = drm_atomic_helper_commit, -+ .output_poll_changed = drm_fb_helper_output_poll_changed, -+}; -+ -+static void mwv207_modeset_init(struct drm_device *dev) -+{ -+ drm_mode_config_init(dev); -+ -+ dev->mode_config.min_width = 20; -+ dev->mode_config.min_height = 20; -+ -+ dev->mode_config.max_width = 4096 * 4; -+ dev->mode_config.max_height = 4096 * 4; -+ -+ dev->mode_config.preferred_depth = 24; -+ dev->mode_config.prefer_shadow = 1; -+ dev->mode_config.allow_fb_modifiers = true; -+ -+ dev->mode_config.async_page_flip = true; -+ -+ dev->mode_config.funcs = &mwv207_mode_config_funcs; -+ dev->mode_config.helper_private = &mwv207_mode_config_helper_funcs; -+ -+ dev->mode_config.cursor_width = 64; -+ dev->mode_config.cursor_height = 64; -+} -+ -+int mwv207_kms_suspend(struct mwv207_device *jdev) -+{ -+ return drm_mode_config_helper_suspend(&jdev->base); -+} -+ -+int mwv207_kms_resume(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ ret = drm_mode_config_helper_resume(&jdev->base); -+ if (ret) -+ pr_warn("mwv207: failed to resume kms, ret: %d", ret); -+ -+ return ret; -+} -+ -+int mwv207_kms_init(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ mwv207_modeset_init(&jdev->base); -+ -+ ret = mwv207_va_init(jdev); -+ if (ret) -+ goto cleanup; -+ -+ ret = mwv207_vi_init(jdev); -+ if (ret) -+ goto cleanup; -+ -+ jdev->va_irq = irq_find_mapping(jdev->irq_domain, 42); -+ BUG_ON(jdev->va_irq == 0); -+ ret = request_irq(jdev->va_irq, mwv207_va_handle_vblank, 0, "mwv207_va", jdev); -+ if (ret) -+ goto cleanup; -+ jdev->base.irq_enabled = true; -+ -+ ret = drm_vblank_init(&jdev->base, jdev->base.mode_config.num_crtc); -+ if (ret) -+ goto free_irq; -+ -+ drm_mode_config_reset(&jdev->base); -+ -+ drm_kms_helper_poll_init(&jdev->base); -+ -+ DRM_INFO("number of crtc: %d\n", jdev->base.mode_config.num_crtc); -+ DRM_INFO("number of encoder: %d\n", jdev->base.mode_config.num_encoder); -+ DRM_INFO("number of connector: %d\n", jdev->base.mode_config.num_connector); -+ -+ return 0; -+free_irq: -+ free_irq(jdev->va_irq, jdev); -+cleanup: -+ drm_mode_config_cleanup(&jdev->base); -+ return ret; -+} -+ -+void mwv207_kms_fini(struct mwv207_device *jdev) -+{ -+ drm_kms_helper_poll_fini(&jdev->base); -+ drm_atomic_helper_shutdown(&jdev->base); -+ free_irq(jdev->va_irq, jdev); -+ drm_mode_config_cleanup(&jdev->base); -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_kms.h b/drivers/gpu/drm/mwv207/dc/mwv207_kms.h -new file mode 100644 -index 000000000..eedb428f6 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_kms.h -@@ -0,0 +1,33 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_KMS_H_VBCHTKVP -+#define MWV207_KMS_H_VBCHTKVP -+ -+#include -+#include "mwv207.h" -+ -+int mwv207_framebuffer_init(struct mwv207_device *jdev, struct drm_framebuffer *fb, -+ const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object *gobj); -+ -+int mwv207_fbdev_init(struct mwv207_device *jdev); -+void mwv207_fbdev_fini(struct mwv207_device *jdev); -+ -+int mwv207_kms_init(struct mwv207_device *jdev); -+void mwv207_kms_fini(struct mwv207_device *jdev); -+ -+int mwv207_kms_suspend(struct mwv207_device *jdev); -+int mwv207_kms_resume(struct mwv207_device *jdev); -+#endif -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_va.c b/drivers/gpu/drm/mwv207/dc/mwv207_va.c -new file mode 100644 -index 000000000..e51e3638e ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_va.c -@@ -0,0 +1,717 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207_bo.h" -+#include "mwv207_va.h" -+#include "mwv207_vi.h" -+#include "mwv207_vbios.h" -+ -+ -+ -+#define crtc_to_va(crtc) container_of(crtc, struct mwv207_va, crtc) -+#define plane_to_va(plane) (((plane)->type == DRM_PLANE_TYPE_PRIMARY) \ -+ ? container_of(plane, struct mwv207_va, primary) \ -+ : container_of(plane, struct mwv207_va, cursor)) -+struct mwv207_va { -+ struct drm_crtc crtc; -+ struct drm_plane primary; -+ struct drm_plane cursor; -+ void __iomem *mmio; -+ struct mwv207_device *jdev; -+ struct drm_pending_vblank_event *event; -+ int idx; -+ uint16_t lutdata[768]; -+}; -+ -+static u32 rgb_formats[] = { -+ DRM_FORMAT_RGB565, -+ DRM_FORMAT_RGB888, -+ DRM_FORMAT_XRGB8888, -+ DRM_FORMAT_ARGB8888, -+ DRM_FORMAT_XRGB2101010, -+}; -+ -+static uint64_t format_modifiers[] = { -+ DRM_FORMAT_MOD_LINEAR, -+ DRM_FORMAT_MOD_INVALID -+}; -+ -+static u32 cursor_formats[] = { -+ DRM_FORMAT_ARGB8888, -+}; -+ -+static inline u32 mwv207_va_read(struct mwv207_va *va, u32 reg) -+{ -+ return readl(va->mmio + reg); -+} -+ -+static inline void mwv207_va_write(struct mwv207_va *va, u32 reg, u32 value) -+{ -+ writel_relaxed(value, va->mmio + reg); -+} -+ -+static inline void mwv207_va_modify(struct mwv207_va *va, u32 reg, -+ u32 mask, u32 value) -+{ -+ u32 rvalue = mwv207_va_read(va, reg); -+ -+ rvalue = (rvalue & ~mask) | (value & mask); -+ mwv207_va_write(va, reg, rvalue); -+} -+ -+static bool mwv207_plane_format_mod_supported(struct drm_plane *plane, -+ uint32_t format, uint64_t modifier) -+{ -+ if (modifier == DRM_FORMAT_MOD_LINEAR) -+ return true; -+ return false; -+} -+ -+static int mwv207_plane_atomic_check(struct drm_plane *plane, -+ struct drm_plane_state *state) -+{ -+ -+ return 0; -+} -+ -+static int mwv207_plane_prepare_fb(struct drm_plane *plane, -+ struct drm_plane_state *new_state) -+{ -+ struct mwv207_bo *jbo; -+ int ret; -+ -+ if (!new_state->fb) -+ return 0; -+ -+ jbo = mwv207_bo_from_gem(new_state->fb->obj[0]); -+ -+ ret = mwv207_bo_reserve(jbo, false); -+ if (ret) -+ return ret; -+ -+ -+ jbo->flags |= (1<<0); -+ ret = mwv207_bo_pin_reserved(jbo, 0x2); -+ mwv207_bo_unreserve(jbo); -+ if (ret) -+ return ret; -+ -+ mwv207_bo_ref(jbo); -+ -+ drm_gem_fb_prepare_fb(plane, new_state); -+ -+ return 0; -+} -+ -+static void mwv207_plane_cleanup_fb(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ struct mwv207_bo *jbo; -+ -+ if (!old_state->fb) -+ return; -+ -+ jbo = mwv207_bo_from_gem(old_state->fb->obj[0]); -+ if (!jbo) -+ return; -+ -+ mwv207_bo_unpin(jbo); -+ mwv207_bo_unref(jbo); -+} -+ -+static u64 mwv207_plane_fb_addr(struct drm_plane *plane) -+{ -+ struct drm_framebuffer *fb; -+ struct mwv207_bo *bo; -+ u32 src_x, src_y; -+ u64 fbaddr; -+ -+ -+ src_x = plane->state->src_x >> 16; -+ src_y = plane->state->src_y >> 16; -+ -+ fb = plane->state->fb; -+ bo = mwv207_bo_from_gem(fb->obj[0]); -+ fbaddr = mwv207_bo_gpu_phys(bo); -+ fbaddr += src_x * fb->format->cpp[0] + fb->pitches[0] * src_y; -+ -+ return fbaddr; -+} -+ -+static void mwv207_primary_atomic_update(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ struct mwv207_va *va = plane_to_va(plane); -+ struct drm_framebuffer *fb; -+ u32 src_w, src_h; -+ u64 fbaddr; -+ -+ -+ if (!plane->state->fb || !plane->state->crtc) -+ return; -+ -+ -+ src_w = plane->state->src_w >> 16; -+ src_h = plane->state->src_h >> 16; -+ fbaddr = mwv207_plane_fb_addr(plane); -+ fb = plane->state->fb; -+ -+ -+ mwv207_va_write(va, 0x434, fb->pitches[0] >> 4); -+ -+ -+ mwv207_va_write(va, 0x43C, ((src_h - 1) << 16) | (src_w - 1) | 0x3); -+ -+ -+ mwv207_va_write(va, 0x4F8, (src_w - 1) << 16); -+ -+ -+ mwv207_va_write(va, 0x438, fbaddr >> 6); -+ -+ -+ switch (fb->format->format) { -+ case DRM_FORMAT_RGB565: -+ mwv207_va_modify(va, 0x430, 1, 1); -+ break; -+ case DRM_FORMAT_XRGB2101010: -+ case DRM_FORMAT_ARGB2101010: -+ mwv207_va_modify(va, 0x430, 1 << 1, 1 << 1); -+ break; -+ case DRM_FORMAT_ARGB8888: -+ mwv207_va_modify(va, 0x430, 0x3, 0); -+ break; -+ default: -+ break; -+ } -+} -+ -+static void mwv207_primary_atomic_disable(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ -+} -+ -+/* turn on / off cursor */ -+static void mwv207_cursor_switch(struct mwv207_va *va, bool on) -+{ -+ mwv207_va_modify(va, 0x478, 0xff, on ? 6 : 0); -+} -+ -+static void mwv207_cursor_atomic_update(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ int crtc_x, crtc_y, pos_x, pos_y, hot_x, hot_y; -+ struct mwv207_va *va = plane_to_va(plane); -+ u64 fbaddr; -+ -+ -+ if (!plane->state->fb || !plane->state->crtc) -+ return; -+ -+ -+ crtc_x = plane->state->crtc_x; -+ crtc_y = plane->state->crtc_y; -+ fbaddr = mwv207_plane_fb_addr(plane); -+ -+ -+ mwv207_va_write(va, 0x4B4, fbaddr >> 6); -+ -+ -+ pos_x = crtc_x < 0 ? 0 : crtc_x; -+ hot_x = crtc_x < 0 ? -crtc_x : 0; -+ pos_y = crtc_y < 0 ? 0 : crtc_y; -+ hot_y = crtc_y < 0 ? -crtc_y : 0; -+ mwv207_va_write(va, 0x454, (hot_x & 0x3f) | ((hot_y & 0x3f) << 16)); -+ mwv207_va_write(va, 0x4A8, (pos_x & 0xffff) | ((pos_y & 0xffff) << 16)); -+ -+ -+ mwv207_cursor_switch(va, 1); -+} -+ -+static void mwv207_cursor_atomic_disable(struct drm_plane *plane, -+ struct drm_plane_state *old_state) -+{ -+ struct mwv207_va *va = plane_to_va(plane); -+ -+ -+ mwv207_cursor_switch(va, 0); -+} -+ -+static const struct drm_plane_funcs mwv207_plane_funcs = { -+ .reset = drm_atomic_helper_plane_reset, -+ .update_plane = drm_atomic_helper_update_plane, -+ .disable_plane = drm_atomic_helper_disable_plane, -+ .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_plane_destroy_state, -+ .format_mod_supported = mwv207_plane_format_mod_supported, -+ .destroy = drm_plane_cleanup, -+}; -+ -+static const struct drm_plane_helper_funcs mwv207_primary_helper_funcs = { -+ .prepare_fb = mwv207_plane_prepare_fb, -+ .cleanup_fb = mwv207_plane_cleanup_fb, -+ .atomic_check = mwv207_plane_atomic_check, -+ .atomic_update = mwv207_primary_atomic_update, -+ .atomic_disable = mwv207_primary_atomic_disable, -+}; -+ -+static const struct drm_plane_helper_funcs mwv207_cursor_helper_funcs = { -+ .prepare_fb = mwv207_plane_prepare_fb, -+ .cleanup_fb = mwv207_plane_cleanup_fb, -+ .atomic_check = mwv207_plane_atomic_check, -+ .atomic_update = mwv207_cursor_atomic_update, -+ .atomic_disable = mwv207_cursor_atomic_disable, -+}; -+ -+static void mwv207_va_misc_reset(struct mwv207_va *va) -+{ -+ struct mwv207_device *jdev = va->jdev; -+ -+ -+ jdev_write(jdev, (0x9b001c), 0xfffff); -+ jdev_write(jdev, (0x9b0020), 0xfffff); -+ jdev_write(jdev, (0x9b0024), 0xfffff); -+ -+ -+ jdev_write(jdev, (0x9b0028), 0x03020100); -+ -+ -+ jdev_write(jdev, (0x990000 + 0x100 * (va->idx) + ((va->idx) > 1 ? 0xC00 : 0)) + 0x2c, 0); -+} -+ -+static int mwv207_va_lut_fifo_wait(struct mwv207_va *va, u32 used) -+{ -+ int i; -+ -+ -+ mb(); -+ for (i = 0; i < 120; ++i) { -+ if (mwv207_va_read(va, 0x450) <= used) -+ return 0; -+ usleep_range(1000, 1001); -+ } -+ -+ return -EBUSY; -+} -+ -+static void mwv207_va_lut_fifo_activate(struct mwv207_va *va, int rgb) -+{ -+ -+ mb(); -+ mwv207_va_write(va, 0x44C, rgb); -+ mwv207_va_write(va, 0x448, 1); -+ udelay(2); -+ mwv207_va_write(va, 0x448, 0); -+ udelay(2); -+} -+ -+static int mwv207_va_lut_fifo_input(struct mwv207_va *va, u32 value) -+{ -+ int ret; -+ -+ -+ ret = mwv207_va_lut_fifo_wait(va, 10); -+ if (ret) -+ return ret; -+ -+ mb(); -+ mwv207_va_write(va, 0x444, value); -+ -+ return 0; -+} -+ -+static void mwv207_va_lut_enable(struct mwv207_va *va) -+{ -+ u32 active_ram, value; -+ int i, ram, rgb; -+ u16 *data; -+ -+ mwv207_va_modify(va, 0x460, 1 << 31, 0 << 31); -+ value = (va->lutdata[384] * 15 / 8) | 0x80000000; -+ jdev_write(va->jdev, (0x990000 + 0x100 * (va->idx) + ((va->idx) > 1 ? 0xC00 : 0)) + 0x38, value); -+ -+ for (ram = 0; ram < 2; ram++) { -+ active_ram = mwv207_va_read(va, 0x440); -+ for (rgb = 0; rgb < 3; rgb++) { -+ data = &va->lutdata[rgb * 256]; -+ mwv207_va_lut_fifo_activate(va, rgb); -+ for (i = 0; i < 1024; i++) { -+ -+ value = min_t(u32, 1024 - 5, (data[i / 4] << 2) | 0x03); -+ if (mwv207_va_lut_fifo_input(va, value)) -+ pr_warn("mwv207: failed to write lut"); -+ } -+ -+ if (mwv207_va_lut_fifo_wait(va, 0)) -+ pr_warn("mwv207: failed to configure lut"); -+ } -+ -+ mb(); -+ mwv207_va_write(va, 0x440, 1 - active_ram); -+ } -+} -+ -+static void mwv207_mode_fixup(struct drm_display_mode *adjusted_mode, struct drm_display_mode *mode) -+{ -+ memcpy(adjusted_mode, mode, sizeof(*adjusted_mode)); -+ -+ mode->crtc_hdisplay = adjusted_mode->crtc_hdisplay * 2; -+ mode->crtc_hblank_start = adjusted_mode->crtc_hblank_start * 2; -+ mode->crtc_hblank_end = adjusted_mode->crtc_hblank_end * 2; -+ mode->crtc_hsync_start = adjusted_mode->crtc_hsync_start * 2; -+ mode->crtc_hsync_end = adjusted_mode->crtc_hsync_end * 2; -+ mode->crtc_htotal = adjusted_mode->crtc_htotal * 2; -+ mode->crtc_clock = adjusted_mode->crtc_clock * 2; -+} -+ -+static void mwv207_va_config_timing(struct mwv207_va *va) -+{ -+ struct drm_display_mode *m = &va->crtc.state->adjusted_mode; -+ struct drm_display_mode *native = NULL; -+ u32 hsbegin, hsend, hblankbegin, hblankend, htotal, hhalf; -+ u32 vblank_1field_begin, vblank_1field_end; -+ u32 vblank_2field_begin, vblank_2field_end; -+ u32 vs_1field_begin, vs_1field_end; -+ u32 vs_2field_begin, vs_2field_end; -+ u32 is_interleaved; -+ u32 vfrontporch, vsync, vtotal; -+ int ret, value; -+ -+ ret = mwv207_vbios_set_pll(va->jdev, va->idx + MWV207_PLL_GRAPH0, m->crtc_clock); -+ if (ret) { -+ DRM_ERROR("mwv207: failed to set crtc clock: %d", ret); -+ return; -+ } -+ -+ is_interleaved = DRM_MODE_FLAG_INTERLACE & m->flags ? 1 : 0; -+ if (is_interleaved && m->crtc_hdisplay == 720) { -+ native = kmalloc(sizeof(*m), GFP_KERNEL); -+ if (!native) { -+ DRM_ERROR("mwv207: failed to kmalloc native mode\r\n"); -+ return; -+ } -+ mwv207_mode_fixup(m, native); -+ m = native; -+ } -+ -+ -+ hblankbegin = 0; -+ hblankend = m->crtc_htotal - m->crtc_hdisplay; -+ htotal = m->crtc_htotal; -+ hsbegin = m->crtc_hsync_start - m->crtc_hdisplay; -+ hsend = m->crtc_hsync_end - m->crtc_hdisplay; -+ hhalf = is_interleaved ? (htotal / 2 + hsbegin) : htotal / 2; -+ -+ -+ vblank_1field_begin = 0; -+ vblank_1field_end = is_interleaved ? -+ ((m->crtc_vtotal - m->crtc_vdisplay) * 2) -+ : (m->crtc_vtotal - m->crtc_vdisplay); -+ -+ vblank_2field_begin = -+ (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2; -+ vblank_2field_end = -+ (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + -+ (m->crtc_vtotal - m->crtc_vdisplay + 1) * 2; -+ -+ vtotal = m->crtc_vtotal; -+ vfrontporch = m->crtc_vsync_start - m->crtc_vdisplay; -+ vsync = m->crtc_vsync_end - m->crtc_vsync_start; -+ vs_1field_begin = is_interleaved ? (vfrontporch * 2) : (vfrontporch); -+ vs_1field_end = is_interleaved ? ((vfrontporch + vsync) * 2) -+ : (vfrontporch + vsync); -+ vs_2field_begin = -+ (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + -+ vfrontporch * 2 + 1; -+ vs_2field_end = -+ (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + -+ (vfrontporch + vsync) * 2 + 1; -+ -+ -+ mwv207_va_write(va, 0x400, hsbegin | (hsend << 16)); -+ mwv207_va_write(va, 0x404, hblankbegin | (hblankend << 16)); -+ mwv207_va_write(va, 0x408, htotal | (hhalf << 16)); -+ -+ -+ mwv207_va_write(va, 0x40C, vblank_1field_begin | (vblank_1field_end << 16)); -+ mwv207_va_write(va, 0x458, vblank_1field_begin | (vblank_1field_end << 16)); -+ mwv207_va_write(va, 0x410, vblank_2field_begin | (vblank_2field_end << 16)); -+ mwv207_va_write(va, 0x45C, vblank_2field_begin | (vblank_2field_end << 16)); -+ -+ mwv207_va_write(va, 0x418, vs_1field_begin | (vs_1field_end << 16)); -+ mwv207_va_write(va, 0x41C, vs_2field_begin | (vs_2field_end << 16)); -+ -+ mwv207_va_modify(va, 0x414, 0xffff, vtotal); -+ -+ value = is_interleaved; -+ if (is_interleaved && m->crtc_hdisplay == 1440) -+ value |= 0x2; -+ mwv207_va_write(va, 0x464, value); -+ -+ -+ mwv207_va_write(va, 0x420, 1); -+ -+ -+ value = mwv207_va_read(va, 0x2a0); -+ value &= ~0x6; -+ value |= 1; -+ mwv207_va_write(va, 0x2a0, value); -+ -+ kfree(native); -+} -+ -+static int mwv207_crtc_enable_vblank(struct drm_crtc *crtc) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ -+ jdev_modify(va->jdev, (0x9907f0), -+ 1 << (12 + va->idx), 1 << (12 + va->idx)); -+ jdev_modify(va->jdev, (0x9907f8), -+ 1 << (12 + va->idx), 1 << (12 + va->idx)); -+ return 0; -+} -+ -+static void mwv207_crtc_disable_vblank(struct drm_crtc *crtc) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ -+ jdev_modify(va->jdev, (0x9907f0), -+ 1 << (12 + va->idx), 0 << (12 + va->idx)); -+ jdev_modify(va->jdev, (0x9907f8), -+ 1 << (12 + va->idx), 0 << (12 + va->idx)); -+} -+ -+static int mwv207_crtc_atomic_check(struct drm_crtc *crtc, -+ struct drm_crtc_state *state) -+{ -+ if (state->gamma_lut && drm_color_lut_size(state->gamma_lut) != 256) -+ return -EINVAL; -+ return 0; -+} -+ -+static void mwv207_crtc_atomic_enable(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_crtc_state) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ struct drm_encoder *encoder; -+ -+ drm_for_each_encoder_mask(encoder, crtc->dev, crtc->state->encoder_mask) -+ mwv207_output_set_crtc(encoder, crtc); -+ -+ mwv207_va_config_timing(va); -+ drm_crtc_vblank_on(crtc); -+} -+ -+static void mwv207_crtc_atomic_disable(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_crtc_state) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ -+ drm_crtc_vblank_off(crtc); -+ -+ -+ mwv207_va_write(va, 0x2c4, 0); -+ mwv207_va_write(va, 0x2c0, 0); -+ mwv207_va_write(va, 0x2a0, 2); -+ mwv207_va_write(va, 0x2c4, 1); -+ -+} -+ -+static void mwv207_crtc_atomic_flush(struct drm_crtc *crtc, -+ struct drm_crtc_state *old_crtc_state) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ struct drm_color_lut *lut; -+ int i; -+ -+ if (crtc->state->color_mgmt_changed) { -+ if (crtc->state->gamma_lut) { -+ lut = (struct drm_color_lut *)crtc->state->gamma_lut->data; -+ for (i = 0; i < 256; i++) { -+ va->lutdata[i] = drm_color_lut_extract(lut[i].red, 8); -+ va->lutdata[i + 256] = drm_color_lut_extract(lut[i].green, 8); -+ va->lutdata[i + 512] = drm_color_lut_extract(lut[i].blue, 8); -+ } -+ mwv207_va_lut_enable(va); -+ } -+ } -+} -+ -+ -+static void mwv207_va_reset(struct drm_crtc *crtc) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ -+ -+ mwv207_cursor_switch(va, 0); -+ -+ -+ mwv207_va_lut_enable(va); -+ mwv207_va_misc_reset(va); -+ drm_atomic_helper_crtc_reset(crtc); -+} -+ -+static const struct drm_crtc_funcs mwv207_crtc_funcs = { -+ .reset = mwv207_va_reset, -+ .destroy = drm_crtc_cleanup, -+ .set_config = drm_atomic_helper_set_config, -+ .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state, -+ .gamma_set = drm_atomic_helper_legacy_gamma_set, -+ .page_flip = drm_atomic_helper_page_flip, -+ .enable_vblank = mwv207_crtc_enable_vblank, -+ .disable_vblank = mwv207_crtc_disable_vblank, -+}; -+ -+static const struct drm_crtc_helper_funcs mwv207_crtc_helper_funcs = { -+ .atomic_check = mwv207_crtc_atomic_check, -+ .atomic_flush = mwv207_crtc_atomic_flush, -+ .atomic_enable = mwv207_crtc_atomic_enable, -+ .atomic_disable = mwv207_crtc_atomic_disable, -+}; -+ -+void mwv207_crtc_prepare_vblank(struct drm_crtc *crtc) -+{ -+ struct drm_pending_vblank_event *event = crtc->state->event; -+ struct mwv207_va *va = crtc_to_va(crtc); -+ unsigned long flags; -+ -+ if (event) { -+ if (crtc->state->active) { -+ WARN_ON(drm_crtc_vblank_get(crtc) != 0); -+ spin_lock_irqsave(&crtc->dev->event_lock, flags); -+ va->event = event; -+ spin_unlock_irqrestore(&crtc->dev->event_lock, flags); -+ } else { -+ spin_lock_irqsave(&crtc->dev->event_lock, flags); -+ drm_crtc_send_vblank_event(crtc, crtc->state->event); -+ spin_unlock_irqrestore(&crtc->dev->event_lock, flags); -+ } -+ crtc->state->event = NULL; -+ } -+} -+ -+void mwv207_crtc_finish_vblank(struct drm_crtc *crtc) -+{ -+ struct mwv207_va *va = crtc_to_va(crtc); -+ int put_vblank = false; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&crtc->dev->event_lock, flags); -+ if (va->event) { -+ drm_crtc_send_vblank_event(crtc, va->event); -+ va->event = NULL; -+ put_vblank = true; -+ } -+ spin_unlock_irqrestore(&crtc->dev->event_lock, flags); -+ -+ if (put_vblank) -+ drm_crtc_vblank_put(crtc); -+} -+ -+irqreturn_t mwv207_va_handle_vblank(int irq, void *data) -+{ -+ struct mwv207_device *jdev = data; -+ struct drm_crtc *crtc; -+ u32 fired; -+ -+ -+ fired = jdev_read(jdev, (0x9907f4)); -+ if (!fired) -+ return IRQ_NONE; -+ jdev_write(jdev, (0x9907f4), fired); -+ -+ fired = (fired >> 12) & 0xf; -+ drm_for_each_crtc(crtc, &jdev->base) { -+ if (fired & (1 << drm_crtc_index(crtc))) { -+ drm_crtc_handle_vblank(crtc); -+ mwv207_crtc_finish_vblank(crtc); -+ } -+ } -+ -+ return IRQ_HANDLED; -+} -+ -+static int mwv207_va_init_single(struct mwv207_device *jdev, int idx) -+{ -+ struct mwv207_va *va; -+ uint16_t *lut; -+ int ret, i; -+ -+ va = devm_kzalloc(jdev->dev, sizeof(*va), GFP_KERNEL); -+ if (!va) -+ return -ENOMEM; -+ -+ va->mmio = jdev->mmio + (0x990000 + 0x100 * (idx) + ((idx) > 1 ? 0x600 : 0)); -+ va->jdev = jdev; -+ va->idx = idx; -+ -+ ret = drm_universal_plane_init(&jdev->base, &va->primary, 1 << idx, -+ &mwv207_plane_funcs, -+ rgb_formats, ARRAY_SIZE(rgb_formats), -+ format_modifiers, DRM_PLANE_TYPE_PRIMARY, "primary_plane_%d", idx); -+ if (ret) -+ return ret; -+ ret = drm_universal_plane_init(&jdev->base, &va->cursor, 1 << idx, -+ &mwv207_plane_funcs, -+ cursor_formats, ARRAY_SIZE(cursor_formats), -+ format_modifiers, DRM_PLANE_TYPE_CURSOR, "cursor_%d", idx); -+ if (ret) -+ return ret; -+ -+ drm_plane_helper_add(&va->primary, &mwv207_primary_helper_funcs); -+ drm_plane_helper_add(&va->cursor, &mwv207_cursor_helper_funcs); -+ -+ ret = drm_crtc_init_with_planes(&jdev->base, &va->crtc, -+ &va->primary, &va->cursor, &mwv207_crtc_funcs, "crtc_%d", -+ idx); -+ if (ret) -+ return ret; -+ -+ drm_crtc_helper_add(&va->crtc, &mwv207_crtc_helper_funcs); -+ -+ lut = &va->lutdata[0]; -+ for (i = 0; i < 256; i++) -+ lut[i] = lut[i + 256] = lut[i + 512] = i; -+ drm_crtc_enable_color_mgmt(&va->crtc, 768, true, 768); -+ ret = drm_mode_crtc_set_gamma_size(&va->crtc, 256); -+ -+ -+ BUG_ON(drm_crtc_index(&va->crtc) != va->idx); -+ -+ return ret; -+} -+ -+int mwv207_va_init(struct mwv207_device *jdev) -+{ -+ int i, nr, ret; -+ -+ nr = jdev->lite ? 2 : 4; -+ for (i = 0; i < nr; i++) { -+ ret = mwv207_va_init_single(jdev, i); -+ if (ret) -+ return ret; -+ } -+ -+ return 0; -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_va.h b/drivers/gpu/drm/mwv207/dc/mwv207_va.h -new file mode 100644 -index 000000000..ffc3540f7 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_va.h -@@ -0,0 +1,29 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#ifndef MWV207_VA_H_BSY8LF4F -+#define MWV207_VA_H_BSY8LF4F -+ -+struct drm_crtc; -+/* Note: any resources allocated should be: -+ * 1. devres managed or -+ * 2. cleaned up by drm_mode_config_cleanup -+ */ -+int mwv207_va_init(struct mwv207_device *jdev); -+ -+void mwv207_crtc_prepare_vblank(struct drm_crtc *crtc); -+irqreturn_t mwv207_va_handle_vblank(int irq, void *data); -+#endif -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_vga.c b/drivers/gpu/drm/mwv207/dc/mwv207_vga.c -new file mode 100644 -index 000000000..3dc5bc664 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_vga.c -@@ -0,0 +1,284 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_vi.h" -+ -+ -+#define output_to_vga(output) container_of(output, struct mwv207_vga, base) -+ -+static uint mwv207_vga_load_detect = 1; -+module_param(mwv207_vga_load_detect, uint, 0444); -+MODULE_PARM_DESC(mwv207_vga_load_detect, "Enable vga load detect if set to 1, default is 1"); -+ -+struct mwv207_vga { -+ struct mwv207_output base; -+ spinlock_t load_detect_lock; -+ bool active; -+}; -+ -+static void mwv207_vga_set_detect_mode(struct mwv207_output *output, bool active) -+{ -+ u32 val, status, load_mode; -+ int i; -+ -+ mwv207_output_write(output, 0xA4, 0); -+ -+ val = 0x3ff * 7 / 10; -+ status = mwv207_output_read(output, 0xA8); -+ mwv207_output_write(output, 0xA8, status); -+ -+ status = val << 20 | val << 10 | val; -+ mwv207_output_write(output, 0xAC, status); -+ -+ load_mode = active ? 1 : 0; -+ status = load_mode << 20 | load_mode << 16 | load_mode << 12 | 0x1 << 8 | 0x1 << 4 | 0x1; -+ mwv207_output_write(output, 0xAC, status); -+ -+ for (i = 0; i < 3; i++) { -+ if (active) { -+ mwv207_output_write(output, (0x64 + (i) * 0x14), 256); -+ mwv207_output_write(output, (0x68 + (i) * 0x14), 48); -+ mwv207_output_write(output, (0x70 + (i) * 0x14), 188); -+ mwv207_output_write(output, (0x74 + (i) * 0x14), 164); -+ } else { -+ mwv207_output_write(output, (0x68 + (i) * 0x14), 1600000); -+ mwv207_output_write(output, (0x6C + (i) * 0x14), 798400000); -+ mwv207_output_write(output, (0x70 + (i) * 0x14), 1600128); -+ mwv207_output_write(output, (0x74 + (i) * 0x14), 8128); -+ } -+ } -+ -+ mwv207_output_write(output, 0xA4, 0x111111); -+} -+ -+static void mwv207_vga_switch(struct mwv207_output *output, bool on) -+{ -+ struct mwv207_vga *vga = output_to_vga(output); -+ -+ if (!output->jdev->lite || !mwv207_vga_load_detect) { -+ mwv207_output_modify(output, 0x0, 1 << 31, (on ? 1 : 0) << 31); -+ return; -+ } -+ -+ spin_lock(&vga->load_detect_lock); -+ mwv207_output_modify(output, 0x0, 1 << 31, (on ? 1 : 0) << 31); -+ mwv207_vga_set_detect_mode(output, on); -+ vga->active = on; -+ spin_unlock(&vga->load_detect_lock); -+} -+ -+static void mwv207_vga_config(struct mwv207_output *output) -+{ -+ struct drm_display_mode *mode = &output->cur_crtc->state->adjusted_mode; -+ int hpol, vpol; -+ -+ hpol = (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : 1; -+ vpol = (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : 1; -+ -+ mwv207_output_write(output, 0x4C, 0); -+ mwv207_output_modify(output, 0x0, 0x7 << 16, 0x7 << 16); -+ mwv207_output_modify(output, 0x0, 0x1 << 2, hpol << 2); -+ mwv207_output_modify(output, 0x0, 0x1 << 3, vpol << 3); -+ -+ mwv207_output_write(output, 0x4, 0x1666); -+ mwv207_output_write(output, 0x18, 0x1666); -+ mwv207_output_write(output, 0x2C, 0x1666); -+} -+ -+static void mwv207_vga_select_crtc(struct mwv207_output *output) -+{ -+ -+ mwv207_output_modify(output, 0x0, 0x3 << 24, -+ drm_crtc_index(output->cur_crtc) << 24); -+ -+ jdev_modify(output->jdev, 0x9b0038, 0xf << 16, -+ drm_crtc_index(output->cur_crtc) << 16); -+} -+static enum drm_mode_status mwv207_vga_mode_valid(struct mwv207_output *output, -+ const struct drm_display_mode *mode) -+{ -+ -+ if (mode->clock > 193250) -+ return MODE_CLOCK_HIGH; -+ -+ return MODE_OK; -+} -+ -+static enum drm_mode_status mwv207_vga_connector_mode_valid(struct drm_connector *connector, -+ struct drm_display_mode *mode) -+{ -+ return mwv207_vga_mode_valid(connector_to_output(connector), mode); -+} -+ -+static int mwv207_vga_detect_load(struct mwv207_output *output) -+{ -+ struct mwv207_vga *vga = output_to_vga(output); -+ u32 r_state, g_state, b_state, value; -+ bool active; -+ -+ -+ if (mwv207_i2c_probe(output->ddc)) -+ return connector_status_connected; -+ -+ spin_lock(&vga->load_detect_lock); -+ value = mwv207_output_read(output, 0xA8); -+ active = vga->active; -+ spin_unlock(&vga->load_detect_lock); -+ -+ r_state = (value >> 8) & 0x1; -+ g_state = (value >> 4) & 0x1; -+ b_state = (value >> 0) & 0x1; -+ DRM_DEBUG_DRIVER("active %d r_state = 0x%x, g_state = 0x%x, b_state = 0x%x", -+ active, r_state, g_state, b_state); -+ -+ if (active) -+ return (r_state && g_state && b_state) ? -+ connector_status_disconnected : connector_status_connected; -+ -+ return (r_state || g_state || b_state) ? -+ connector_status_connected : connector_status_disconnected; -+} -+ -+static int mwv207_vga_detect_ctx(struct drm_connector *connector, -+ struct drm_modeset_acquire_ctx *ctx, -+ bool force) -+{ -+ struct mwv207_output *output = connector_to_output(connector); -+ -+ if (!output->jdev->lite || !mwv207_vga_load_detect) -+ return mwv207_i2c_probe(output->ddc) ? -+ connector_status_connected : connector_status_disconnected; -+ -+ -+ return mwv207_vga_detect_load(output); -+} -+ -+static void mwv207_vga_destroy(struct drm_connector *conn) -+{ -+ drm_connector_unregister(conn); -+ drm_connector_cleanup(conn); -+} -+ -+static const struct drm_connector_helper_funcs mwv207_vga_connector_helper_funcs = { -+ .get_modes = mwv207_output_get_modes, -+ .mode_valid = mwv207_vga_connector_mode_valid, -+ .detect_ctx = mwv207_vga_detect_ctx -+}; -+ -+static const struct drm_connector_funcs mwv207_vga_connector_funcs = { -+ .reset = drm_atomic_helper_connector_reset, -+ .fill_modes = drm_helper_probe_single_connector_modes, -+ .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, -+ .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, -+ .destroy = mwv207_vga_destroy, -+ .late_register = mwv207_output_late_register, -+ .early_unregister = mwv207_output_early_unregister, -+}; -+ -+static enum drm_mode_status mwv207_vga_encoder_mode_valid(struct drm_encoder *encoder, -+ const struct drm_display_mode *mode) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ return mwv207_vga_mode_valid(output, mode); -+} -+ -+static int mwv207_vga_encoder_atomic_check(struct drm_encoder *encoder, -+ struct drm_crtc_state *crtc_state, -+ struct drm_connector_state *conn_state) -+{ -+ return 0; -+} -+ -+static void mwv207_vga_encoder_enable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_vga_select_crtc(output); -+ -+ mwv207_vga_config(output); -+ -+ mwv207_vga_switch(output, true); -+} -+ -+static void mwv207_vga_encoder_disable(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ mwv207_vga_switch(output, false); -+} -+ -+static void mwv207_vga_encoder_reset(struct drm_encoder *encoder) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ if (output->jdev->lite && !mwv207_vga_load_detect) { -+ mwv207_output_write(output, 0xA4, 0); -+ mwv207_output_modify(output, 0x58, 0x1 << 16, 0); -+ } -+ -+ mwv207_vga_encoder_disable(encoder); -+} -+ -+static const struct drm_encoder_funcs mwv207_vga_encoder_funcs = { -+ .destroy = drm_encoder_cleanup, -+ .reset = mwv207_vga_encoder_reset, -+}; -+ -+static const struct drm_encoder_helper_funcs mwv207_vga_encoder_helper_funcs = { -+ .mode_valid = mwv207_vga_encoder_mode_valid, -+ .atomic_check = mwv207_vga_encoder_atomic_check, -+ .enable = mwv207_vga_encoder_enable, -+ .disable = mwv207_vga_encoder_disable, -+}; -+ -+int mwv207_vga_init(struct mwv207_device *jdev) -+{ -+ struct mwv207_output *output; -+ struct mwv207_vga *vga; -+ int ret; -+ -+ vga = devm_kzalloc(jdev->dev, sizeof(*vga), GFP_KERNEL); -+ if (!vga) -+ return -ENOMEM; -+ -+ spin_lock_init(&vga->load_detect_lock); -+ output = &vga->base; -+ output->jdev = jdev; -+ output->idx = 0; -+ output->mmio = jdev->mmio + 0x9a0000; -+ output->i2c_chan = 4; -+ -+ output->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; -+ ret = drm_connector_init(&jdev->base, &output->connector, -+ &mwv207_vga_connector_funcs, DRM_MODE_CONNECTOR_VGA); -+ if (ret) -+ return ret; -+ drm_connector_helper_add(&output->connector, &mwv207_vga_connector_helper_funcs); -+ -+ output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; -+ ret = drm_encoder_init(&jdev->base, &output->encoder, -+ &mwv207_vga_encoder_funcs, DRM_MODE_ENCODER_DAC, -+ "vga-%d", output->idx); -+ if (ret) -+ return ret; -+ drm_encoder_helper_add(&output->encoder, &mwv207_vga_encoder_helper_funcs); -+ -+ ret = drm_connector_attach_encoder(&output->connector, &output->encoder); -+ if (ret) -+ return ret; -+ -+ return drm_connector_register(&output->connector); -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_vi.c b/drivers/gpu/drm/mwv207/dc/mwv207_vi.c -new file mode 100644 -index 000000000..92346d85e ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_vi.c -@@ -0,0 +1,89 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_vi.h" -+ -+/* userspace interfaces should be registered here, e.g i2c/backlight etc */ -+int mwv207_output_late_register(struct drm_connector *connector) -+{ -+ struct mwv207_output *output = connector_to_output(connector); -+ -+ output->ddc = mwv207_i2c_create(output->jdev, output->i2c_chan); -+ if (!output->ddc) { -+ DRM_ERROR("Failed to create i2c adapter\n"); -+ return -ENODEV; -+ } -+ -+ return 0; -+} -+ -+void mwv207_output_early_unregister(struct drm_connector *connector) -+{ -+ struct mwv207_output *output = connector_to_output(connector); -+ -+ mwv207_i2c_destroy(output->ddc); -+} -+ -+ -+int mwv207_output_get_modes(struct drm_connector *connector) -+{ -+ struct mwv207_output *output = connector_to_output(connector); -+ struct edid *edid; -+ int count; -+ -+ if (output->edidforce && output->edid) -+ edid = output->edid; -+ else -+ edid = drm_get_edid(connector, output->ddc); -+ -+ -+ output->has_audio = drm_detect_monitor_audio(edid); -+ drm_connector_update_edid_property(connector, edid); -+ count = drm_add_edid_modes(connector, edid); -+ -+ if (!(output->edidforce && output->edid)) -+ kfree(edid); -+ -+ return count; -+} -+ -+void mwv207_output_set_crtc(struct drm_encoder *encoder, struct drm_crtc *crtc) -+{ -+ struct mwv207_output *output = encoder_to_output(encoder); -+ -+ output->cur_crtc = crtc; -+} -+ -+int mwv207_vi_init(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ mutex_init(&jdev->gpio_lock); -+ -+ ret = mwv207_edp_init(jdev); -+ if (ret) -+ return ret; -+ ret = mwv207_hdmi_init(jdev); -+ if (ret) -+ return ret; -+ ret = mwv207_vga_init(jdev); -+ if (ret) -+ return ret; -+ ret = mwv207_dvo_init(jdev); -+ if (ret) -+ return ret; -+ -+ return 0; -+} -diff --git a/drivers/gpu/drm/mwv207/dc/mwv207_vi.h b/drivers/gpu/drm/mwv207/dc/mwv207_vi.h -new file mode 100644 -index 000000000..95f78ded0 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/dc/mwv207_vi.h -@@ -0,0 +1,101 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207.h" -+#include -+#include -+#include -+#include -+#include -+ -+#ifndef MWV207_DAL_H_OUVHEJAX -+#define MWV207_DAL_H_OUVHEJAX -+ -+ -+ -+struct i2c_adapter; -+ -+ -+struct mwv207_output { -+ struct drm_connector connector; -+ struct drm_encoder encoder; -+ -+ -+ struct drm_crtc *cur_crtc; -+ -+ /* mapped to video interface global control regs -+ * which are shared among all outputs -+ */ -+ void __iomem *mmio; -+ struct mwv207_device *jdev; -+ -+ struct i2c_adapter *ddc; -+ struct edid *edid; -+ bool edidforce; -+ int i2c_chan; -+ -+ /* local index, e.g. hdmi0/1/2/3, edp0/1 */ -+ int idx; -+ -+ bool has_audio; -+}; -+#define connector_to_output(conn) container_of(conn, struct mwv207_output, connector) -+#define encoder_to_output(encoder) container_of(encoder, struct mwv207_output, encoder) -+ -+/* Note: any resources allocated by following funcs should be: -+ * 1. devres managed or -+ * 2. cleaned up by drm_mode_config_cleanup -+ */ -+int mwv207_vi_init(struct mwv207_device *jdev); -+int mwv207_edp_init(struct mwv207_device *jdev); -+int mwv207_hdmi_init(struct mwv207_device *jdev); -+int mwv207_vga_init(struct mwv207_device *jdev); -+int mwv207_dvo_init(struct mwv207_device *jdev); -+ -+struct i2c_adapter *mwv207_i2c_create(struct mwv207_device *jdev, int i2c_chan); -+void mwv207_i2c_destroy(struct i2c_adapter *adapter); -+bool mwv207_i2c_probe(struct i2c_adapter *i2c_bus); -+ -+int mwv207_output_late_register(struct drm_connector *connector); -+void mwv207_output_early_unregister(struct drm_connector *connector); -+ -+ -+int mwv207_output_get_modes(struct drm_connector *connector); -+void mwv207_output_set_crtc(struct drm_encoder *encoder, struct drm_crtc *crtc); -+ -+static inline u32 mwv207_output_read(struct mwv207_output *output, u32 reg) -+{ -+ BUG_ON(reg >= 0x8000); -+ return readl(output->mmio + reg); -+} -+ -+static inline void mwv207_output_write(struct mwv207_output *output, u32 reg, u32 value) -+{ -+ BUG_ON(reg >= 0x8000); -+ writel_relaxed(value, output->mmio + reg); -+} -+ -+static inline void mwv207_output_modify(struct mwv207_output *output, u32 reg, -+ u32 mask, u32 value) -+{ -+ u32 rvalue; -+ -+ BUG_ON(reg >= 0x8000); -+ rvalue = mwv207_output_read(output, reg); -+ rvalue = (rvalue & ~mask) | (value & mask); -+ mwv207_output_write(output, reg, rvalue); -+} -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207.h b/drivers/gpu/drm/mwv207/mwv207.h -new file mode 100644 -index 000000000..84419cc49 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207.h -@@ -0,0 +1,127 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_H_VTIQLF2Y -+#define MWV207_H_VTIQLF2Y -+ -+#include -+#include -+#include -+#include -+#include -+ -+struct mwv207_db; -+ -+struct mwv207_vbios { -+ -+ struct mutex vcmd_lock; -+ -+ -+ struct mutex cfg_lock; -+ struct idr cfg_table; -+ -+ int indexer_valid; -+ int sector_count; -+}; -+ -+#define ddev_to_jdev(ddev) ((struct mwv207_device *) (ddev)->dev_private) -+#define bdev_to_jdev(dev) container_of(dev, struct mwv207_device, bdev) -+struct mwv207_device { -+ struct drm_device base; -+ struct ttm_bo_device bdev; -+ -+ void __iomem *mmio; -+ void __iomem *iatu; -+ -+ void *win; -+ -+ -+ spinlock_t win_lock; -+ u64 visible_vram_size; -+ u64 vram_size; -+ u64 vram_bar_base; -+ u64 vram_last_win; -+ u64 pci_win_base; -+ -+ struct device *dev; -+ struct drm_fb_helper *fb_helper; -+ -+ struct drm_gpu_scheduler *sched[6]; -+ -+ struct drm_gpu_scheduler **sched_3d; -+ struct drm_gpu_scheduler **sched_dec; -+ struct drm_gpu_scheduler **sched_enc; -+ struct drm_gpu_scheduler **sched_2d; -+ struct drm_gpu_scheduler **sched_dma; -+ int nr_3d; -+ int nr_2d; -+ int nr_dec; -+ int nr_enc; -+ int nr_dma; -+ -+ -+ struct drm_sched_entity *dma_entity; -+ -+ -+ spinlock_t irq_lock; -+ struct irq_domain *irq_domain; -+ u32 irq_enable_reg[2]; -+ int va_irq; -+ -+ /* key/value database */ -+ struct mwv207_db *db; -+ -+ struct mwv207_vbios vbios; -+ -+ struct mutex gpio_lock; -+ -+ bool lite; -+}; -+ -+struct mwv207_ctx_mgr { -+ struct mutex lock; -+ struct idr handle_table; -+}; -+ -+struct mwv207_fpriv { -+ struct mwv207_ctx_mgr ctx_mgr; -+}; -+ -+int mwv207_test(struct mwv207_device *jdev); -+void jdev_write_vram(struct mwv207_device *jdev, u64 vram_addr, void *buf, int size); -+ -+static inline void jdev_write(struct mwv207_device *jdev, u32 reg, u32 value) -+{ -+ BUG_ON(reg <= 0x100000); -+ writel_relaxed(value, jdev->mmio + reg); -+} -+ -+static inline u32 jdev_read(struct mwv207_device *jdev, u32 reg) -+{ -+ return readl(jdev->mmio + reg); -+} -+ -+static inline void jdev_modify(struct mwv207_device *jdev, u32 reg, u32 mask, u32 value) -+{ -+ u32 rvalue = jdev_read(jdev, reg); -+ -+ rvalue = (rvalue & ~mask) | (value & mask); -+ jdev_write(jdev, reg, rvalue); -+ BUG_ON(reg <= 0x100000); -+} -+ -+#define to_fpriv(drm_file) ((drm_file)->driver_priv) -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_bo.c b/drivers/gpu/drm/mwv207/mwv207_bo.c -new file mode 100644 -index 000000000..ef63abedc ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_bo.c -@@ -0,0 +1,299 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include "mwv207_drm.h" -+#include "mwv207_bo.h" -+ -+static void mwv207_ttm_bo_destroy(struct ttm_buffer_object *bo) -+{ -+ struct mwv207_bo *jbo = to_jbo(bo); -+ -+ WARN_ON_ONCE(jbo->map_count > 0); -+ if (bo->base.import_attach) -+ drm_prime_gem_destroy(&bo->base, NULL); -+ drm_gem_object_release(&jbo->tbo.base); -+ kfree(jbo); -+} -+ -+bool mwv207_ttm_bo_is_mwv207_bo(struct ttm_buffer_object *jbo) -+{ -+ if (jbo->destroy == &mwv207_ttm_bo_destroy) -+ return true; -+ return false; -+} -+ -+void mwv207_bo_placement_from_domain(struct mwv207_bo *jbo, u32 domain, bool pinned) -+{ -+ struct mwv207_device *jdev = bdev_to_jdev(jbo->tbo.bdev); -+ u32 c = 0; -+ u32 pflag = 0; -+ -+ if (pinned) -+ pflag |= TTM_PL_FLAG_NO_EVICT; -+ -+ jbo->placement.placement = jbo->placements; -+ jbo->placement.busy_placement = jbo->placements; -+ -+ if (domain & 0x2) { -+ jbo->placements[c].fpfn = 0; -+ -+ if (jbo->flags & (1<<2)) -+ jbo->placements[c].lpfn = 0x100000000ul >> PAGE_SHIFT; -+ else -+ jbo->placements[c].lpfn = 0; -+ -+ if (jbo->flags & (1<<0)) -+ jbo->placements[c].lpfn = jdev->visible_vram_size >> PAGE_SHIFT; -+ else -+ pflag |= TTM_PL_FLAG_TOPDOWN; -+ -+ jbo->placements[c].mem_type = TTM_PL_VRAM; -+ jbo->placements[c].flags = TTM_PL_FLAG_UNCACHED | TTM_PL_FLAG_WC | pflag; -+#ifdef MWV207_DEBUG_BO_MIGRATION -+ if (!pinned) { -+ if (jbo->placements[c].lpfn == 0 -+ || jbo->placements[c].lpfn >= jdev->vram_size >> PAGE_SHIFT) -+ jbo->placements[c].lpfn = jdev->vram_size >> PAGE_SHIFT; -+ if (jbo->toggle & 0x1) -+ jbo->placements[c].fpfn = jbo->placements[c].lpfn / 2; -+ else -+ jbo->placements[c].lpfn = jbo->placements[c].lpfn / 2; -+ jbo->toggle ^= 0x1; -+ } -+#endif -+ c++; -+ } -+ if (domain & 0x4) { -+ jbo->placements[c].fpfn = 0; -+ jbo->placements[c].lpfn = 0; -+ jbo->placements[c].flags = TTM_PL_MASK_CACHING | pflag; -+ jbo->placements[c].mem_type = TTM_PL_TT; -+ c++; -+ } -+ if (domain & 0x1) { -+ jbo->placements[c].fpfn = 0; -+ jbo->placements[c].lpfn = 0; -+ jbo->placements[c].flags = TTM_PL_MASK_CACHING | pflag; -+ jbo->placements[c].mem_type = TTM_PL_SYSTEM; -+ c++; -+ } -+ if (!c) { -+ jbo->placements[c].fpfn = 0; -+ jbo->placements[c].lpfn = 0; -+ jbo->placements[c].flags = TTM_PL_MASK_CACHING; -+ jbo->placements[c].mem_type = TTM_PL_SYSTEM; -+ c++; -+ } -+ -+ BUG_ON(c > 3); -+ jbo->placement.num_placement = c; -+ jbo->placement.num_busy_placement = c; -+} -+ -+int mwv207_bo_create(struct mwv207_device *jdev, -+ u64 size, u64 align, enum ttm_bo_type type, -+ u32 domain, u32 flags, -+ struct mwv207_bo **pbo) -+{ -+ struct mwv207_bo *jbo; -+ unsigned long acc_size; -+ int ret; -+ -+ *pbo = NULL; -+ if ((flags & (1<<2)) && !(domain & 0x2)) -+ return -EINVAL; -+ -+ jbo = kzalloc(sizeof(struct mwv207_bo), GFP_KERNEL); -+ if (jbo == NULL) -+ return -ENOMEM; -+ size = roundup(size, PAGE_SIZE); -+ ret = drm_gem_object_init(&jdev->base, &jbo->tbo.base, size); -+ if (unlikely(ret)) { -+ kfree(jbo); -+ return ret; -+ } -+ jbo->flags = flags; -+ jbo->domain = domain; -+ jbo->pin_count = 0; -+ -+ acc_size = ttm_bo_dma_acc_size(&jdev->bdev, size, sizeof(*jbo)); -+ -+ jbo->tbo.bdev = &jdev->bdev; -+ mwv207_bo_placement_from_domain(jbo, domain, false); -+ -+ ret = ttm_bo_init(&jdev->bdev, &jbo->tbo, size, type, -+ &jbo->placement, align >> PAGE_SHIFT, -+ type != ttm_bo_type_kernel, acc_size, -+ NULL, NULL, &mwv207_ttm_bo_destroy); -+ -+ if (unlikely(ret)) -+ return ret; -+ *pbo = jbo; -+ return 0; -+} -+ -+int mwv207_bo_reserve(struct mwv207_bo *jbo, bool no_intr) -+{ -+ int ret; -+ -+ ret = ttm_bo_reserve(&jbo->tbo, !no_intr, false, NULL); -+ if (unlikely(ret)) { -+ if (ret != -ERESTARTSYS) -+ DRM_ERROR("bo reserve failed\n"); -+ return ret; -+ } -+ return 0; -+} -+ -+void mwv207_bo_unreserve(struct mwv207_bo *jbo) -+{ -+ ttm_bo_unreserve(&jbo->tbo); -+} -+ -+int mwv207_bo_kmap_reserved(struct mwv207_bo *jbo, void **ptr) -+{ -+ bool is_iomem; -+ int ret; -+ -+ if (!jbo->flags & (1<<0)) -+ return -EPERM; -+ -+ if (jbo->kptr) { -+ if (ptr) -+ *ptr = jbo->kptr; -+ jbo->map_count++; -+ return 0; -+ } -+ ret = ttm_bo_kmap(&jbo->tbo, 0, jbo->tbo.num_pages, &jbo->kmap); -+ if (ret) -+ return ret; -+ jbo->kptr = ttm_kmap_obj_virtual(&jbo->kmap, &is_iomem); -+ if (ptr) -+ *ptr = jbo->kptr; -+ jbo->map_count = 1; -+ return 0; -+} -+ -+void mwv207_bo_kunmap_reserved(struct mwv207_bo *jbo) -+{ -+ if (WARN_ON_ONCE(jbo->kptr == NULL)) -+ return; -+ jbo->map_count--; -+ if (jbo->map_count > 0) -+ return; -+ jbo->kptr = NULL; -+ ttm_bo_kunmap(&jbo->kmap); -+} -+ -+void mwv207_bo_unref(struct mwv207_bo *jbo) -+{ -+ if (jbo == NULL) -+ return; -+ -+ ttm_bo_put(&jbo->tbo); -+} -+ -+struct mwv207_bo *mwv207_bo_ref(struct mwv207_bo *jbo) -+{ -+ if (jbo == NULL) -+ return NULL; -+ -+ ttm_bo_get(&jbo->tbo); -+ return jbo; -+} -+ -+int mwv207_bo_pin_reserved(struct mwv207_bo *jbo, u32 domain) -+{ -+ struct ttm_operation_ctx ctx = {false, false}; -+ int ret; -+ -+ if (jbo->pin_count) { -+ jbo->pin_count++; -+ return 0; -+ } -+ -+ jbo->flags |= (1<<2); -+ mwv207_bo_placement_from_domain(jbo, domain, true); -+ ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); -+ if (ret) -+ return ret; -+ -+ jbo->pin_count = 1; -+ -+ return 0; -+} -+ -+int mwv207_bo_unpin_reserved(struct mwv207_bo *jbo) -+{ -+ struct ttm_operation_ctx ctx = {false, false}; -+ int ret, i; -+ -+ if (WARN_ON_ONCE(!jbo->pin_count)) -+ return 0; -+ -+ jbo->pin_count--; -+ if (jbo->pin_count) -+ return 0; -+ -+ for (i = 0; i < jbo->placement.num_placement; i++) -+ jbo->placements[i].flags &= ~TTM_PL_FLAG_NO_EVICT; -+ -+ ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); -+ if (unlikely(ret)) -+ DRM_ERROR("validate failed for unpin"); -+ -+ return ret; -+} -+ -+int mwv207_bo_pin(struct mwv207_bo *jbo, u32 domain) -+{ -+ int ret; -+ -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) -+ return ret; -+ ret = mwv207_bo_pin_reserved(jbo, domain); -+ mwv207_bo_unreserve(jbo); -+ return ret; -+} -+ -+int mwv207_bo_unpin(struct mwv207_bo *jbo) -+{ -+ int ret; -+ -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) -+ return ret; -+ ret = mwv207_bo_unpin_reserved(jbo); -+ mwv207_bo_unreserve(jbo); -+ return ret; -+} -+ -+int mwv207_bo_wait(struct mwv207_bo *jbo, bool no_wait) -+{ -+ int ret; -+ -+ ret = ttm_bo_reserve(&jbo->tbo, true, no_wait, NULL); -+ if (unlikely(ret)) { -+ if (ret != -ERESTARTSYS && ret != -EBUSY) -+ DRM_ERROR("bo reserve failed for wait\n"); -+ return ret; -+ } -+ ret = ttm_bo_wait(&jbo->tbo, true, no_wait); -+ ttm_bo_unreserve(&jbo->tbo); -+ return ret; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_bo.h b/drivers/gpu/drm/mwv207/mwv207_bo.h -new file mode 100644 -index 000000000..ab10994d1 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_bo.h -@@ -0,0 +1,111 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_BO_H_T4ETFCB2 -+#define MWV207_BO_H_T4ETFCB2 -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_drm.h" -+ -+#undef MWV207_DEBUG_BO_MIGRATION -+ -+#define to_jbo(bo) container_of(bo, struct mwv207_bo, tbo) -+struct mwv207_bo { -+ struct ttm_buffer_object tbo; -+ struct ttm_placement placement; -+ struct ttm_bo_kmap_obj kmap; -+ struct ttm_place placements[3]; -+ u32 domain; -+ u32 flags; -+ int pin_count; -+ int map_count; -+ void *kptr; -+#ifdef MWV207_DEBUG_BO_MIGRATION -+ int toggle; -+#endif -+}; -+ -+struct mwv207_ttm_tt { -+ struct ttm_dma_tt ttm; -+ struct mwv207_device *jdev; -+}; -+#define to_gtt(ttm_tt) container_of(ttm_tt, struct mwv207_ttm_tt, ttm.ttm) -+ -+static inline struct mwv207_bo *mwv207_bo_from_gem(struct drm_gem_object *gobj) -+{ -+ struct ttm_buffer_object *tbo = container_of(gobj, struct ttm_buffer_object, base); -+ -+ return container_of(tbo, struct mwv207_bo, tbo); -+} -+ -+static inline struct drm_gem_object *mwv207_gem_from_bo(struct mwv207_bo *jbo) -+{ -+ return &jbo->tbo.base; -+} -+ -+static inline u64 mwv207_bo_size(struct mwv207_bo *jbo) -+{ -+ return jbo->tbo.num_pages << PAGE_SHIFT; -+} -+ -+static inline u64 mwv207_bo_mmap_offset(struct drm_gem_object *gobj) -+{ -+ struct mwv207_bo *jbo = mwv207_bo_from_gem(gobj); -+ -+ return drm_vma_node_offset_addr(&jbo->tbo.base.vma_node); -+} -+ -+static inline u64 mwv207_bo_gpu_phys(struct mwv207_bo *jbo) -+{ -+ return jbo->tbo.mem.start << PAGE_SHIFT; -+} -+ -+void mwv207_bo_placement_from_domain(struct mwv207_bo *jbo, u32 domain, bool pinned); -+ -+bool mwv207_ttm_bo_is_mwv207_bo(struct ttm_buffer_object *tbo); -+void mwv207_bo_placement(struct mwv207_bo *jbo, int domain); -+ -+int mwv207_bo_create(struct mwv207_device *jdev, -+ u64 size, u64 align, enum ttm_bo_type type, -+ u32 domain, u32 flags, -+ struct mwv207_bo **pbo); -+ -+int mwv207_bo_reserve(struct mwv207_bo *jbo, bool no_intr); -+void mwv207_bo_unreserve(struct mwv207_bo *jbo); -+ -+int mwv207_bo_pin_reserved(struct mwv207_bo *jbo, u32 domain); -+int mwv207_bo_unpin_reserved(struct mwv207_bo *jbo); -+ -+int mwv207_bo_pin(struct mwv207_bo *jbo, u32 domain); -+int mwv207_bo_unpin(struct mwv207_bo *jbo); -+ -+int mwv207_bo_kmap_reserved(struct mwv207_bo *jbo, void **ptr); -+void mwv207_bo_kunmap_reserved(struct mwv207_bo *jbo); -+ -+struct mwv207_bo *mwv207_bo_ref(struct mwv207_bo *jbo); -+void mwv207_bo_unref(struct mwv207_bo *jbo); -+ -+int mwv207_ttm_init(struct mwv207_device *jdev); -+void mwv207_ttm_fini(struct mwv207_device *jdev); -+ -+int mwv207_bo_wait(struct mwv207_bo *jbo, bool no_wait); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_ctx.c b/drivers/gpu/drm/mwv207/mwv207_ctx.c -new file mode 100644 -index 000000000..595d6a943 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_ctx.c -@@ -0,0 +1,242 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_drm.h" -+#include "mwv207_ctx.h" -+ -+#define MAX(a, b) ((a) > (b) ? (a) : (b)) -+struct mwv207_ctx *mwv207_ctx_lookup(struct drm_device *dev, -+ struct drm_file *filp, u32 handle) -+{ -+ struct mwv207_fpriv *fpriv = to_fpriv(filp); -+ struct mwv207_ctx_mgr *mgr = &fpriv->ctx_mgr; -+ struct mwv207_ctx *ctx; -+ -+ mutex_lock(&mgr->lock); -+ ctx = idr_find(&mgr->handle_table, handle); -+ if (ctx) -+ kref_get(&ctx->refcnt); -+ mutex_unlock(&mgr->lock); -+ -+ return ctx; -+} -+ -+static void mwv207_ctx_entity_fini(struct mwv207_ctx *ctx) -+{ -+ int i; -+ -+ for (i = 0; i < 11; i++) { -+ if (ctx->entities[i]) { -+ drm_sched_entity_destroy(ctx->entities[i]); -+ kfree(ctx->entities[i]); -+ ctx->entities[i] = NULL; -+ } -+ } -+} -+ -+ -+static int mwv207_ctx_entity_init_single(struct mwv207_ctx *ctx, -+ struct drm_gpu_scheduler **sched, -+ struct drm_sched_entity **entities, int nr) -+{ -+ struct drm_gpu_scheduler *scheds[6]; -+ struct drm_sched_entity *entity; -+ int i, ret; -+ -+ -+ for (i = 0; i < nr; i++) { -+ scheds[i] = sched[i]; -+ entity = kmalloc(sizeof(struct drm_sched_entity), GFP_KERNEL); -+ if (!entity) -+ return -ENOMEM; -+ ret = drm_sched_entity_init(entity, DRM_SCHED_PRIORITY_NORMAL, &scheds[i], 1, &ctx->guilty); -+ if (ret) { -+ kfree(entity); -+ return ret; -+ } -+ entities[i] = entity; -+ } -+ if (i) { -+ -+ entity = kmalloc(sizeof(struct drm_sched_entity), GFP_KERNEL); -+ if (!entity) -+ return -ENOMEM; -+ ret = drm_sched_entity_init(entity, DRM_SCHED_PRIORITY_NORMAL, &scheds[0], 1, &ctx->guilty); -+ if (ret) { -+ kfree(entity); -+ return ret; -+ } -+ entities[i] = entity; -+ } -+ -+ return 0; -+} -+ -+static int mwv207_ctx_entity_init(struct drm_device *dev, struct mwv207_ctx *ctx) -+{ -+ struct mwv207_device *jdev = ddev_to_jdev(dev); -+ int ret; -+ -+ -+ ctx->entity_3d = &ctx->entities[0]; -+ ctx->entity_dec = &ctx->entity_3d[2 + 1]; -+ ctx->entity_enc = &ctx->entity_dec[1 + 1]; -+ ctx->entity_2d = &ctx->entity_enc[1 + 1]; -+ ctx->entity_dma = &ctx->entity_2d[1 + 1]; -+ BUG_ON(ctx->entity_dma[1] != ctx->entities[11 - 1]); -+ -+ ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_3d, ctx->entity_3d, jdev->nr_3d); -+ if (ret) -+ goto fini; -+ ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_dec, ctx->entity_dec, jdev->nr_dec); -+ if (ret) -+ goto fini; -+ ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_enc, ctx->entity_enc, jdev->nr_enc); -+ if (ret) -+ goto fini; -+ ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_2d, ctx->entity_2d, jdev->nr_2d); -+ if (ret) -+ goto fini; -+ ret = mwv207_ctx_entity_init_single(ctx, jdev->sched_dma, ctx->entity_dma, jdev->nr_dma); -+ if (ret) -+ goto fini; -+ return 0; -+fini: -+ mwv207_ctx_entity_fini(ctx); -+ return ret; -+} -+ -+static int mwv207_ctx_create(struct drm_device *dev, struct mwv207_ctx_mgr *mgr, -+ u32 flags, u32 *handle) -+{ -+ struct mwv207_ctx *ctx; -+ int ret; -+ -+ ctx = kzalloc(sizeof(struct mwv207_ctx), GFP_KERNEL); -+ if (ctx == NULL) -+ return -ENOMEM; -+ -+ ctx->jdev = ddev_to_jdev(dev); -+ kref_init(&ctx->refcnt); -+ -+ ret = mwv207_ctx_entity_init(dev, ctx); -+ if (ret) -+ goto out_free; -+ -+ mutex_lock(&mgr->lock); -+ ret = idr_alloc(&mgr->handle_table, ctx, 1, 0, GFP_KERNEL); -+ mutex_unlock(&mgr->lock); -+ -+ if (ret < 0) -+ goto out_fini_entites; -+ -+ *handle = ret; -+ return 0; -+out_fini_entites: -+ mwv207_ctx_entity_fini(ctx); -+out_free: -+ kfree(ctx); -+ return ret; -+} -+ -+static void mwv207_ctx_release(struct kref *kref) -+{ -+ struct mwv207_ctx *ctx = container_of(kref, struct mwv207_ctx, refcnt); -+ -+ mwv207_ctx_entity_fini(ctx); -+ kfree(ctx); -+} -+ -+int mwv207_ctx_put(struct mwv207_ctx *ctx) -+{ -+ return kref_put(&ctx->refcnt, mwv207_ctx_release); -+} -+ -+static int mwv207_ctx_destroy(struct drm_device *dev, struct mwv207_ctx_mgr *mgr, u32 handle) -+{ -+ struct mwv207_ctx *ctx; -+ -+ mutex_lock(&mgr->lock); -+ ctx = idr_remove(&mgr->handle_table, handle); -+ mutex_unlock(&mgr->lock); -+ -+ if (ctx == NULL) -+ return -EINVAL; -+ -+ mwv207_ctx_put(ctx); -+ return 0; -+} -+ -+int mwv207_ctx_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ struct drm_mwv207_ctx *args = (struct drm_mwv207_ctx *)data; -+ struct mwv207_fpriv *fpriv = to_fpriv(filp); -+ -+ if (args->resv || args->flags) -+ return -EINVAL; -+ -+ switch (args->op) { -+ case 0: -+ return mwv207_ctx_create(dev, &fpriv->ctx_mgr, args->flags, &args->handle); -+ case 1: -+ return mwv207_ctx_destroy(dev, &fpriv->ctx_mgr, args->handle); -+ default: -+ return -EINVAL; -+ } -+} -+ -+int mwv207_ctx_mgr_init(struct drm_device *dev, struct mwv207_ctx_mgr *mgr) -+{ -+ mutex_init(&mgr->lock); -+ idr_init(&mgr->handle_table); -+ return 0; -+} -+ -+void mwv207_ctx_mgr_fini(struct drm_device *dev, struct mwv207_ctx_mgr *mgr) -+{ -+ struct mwv207_ctx *ctx; -+ uint32_t id; -+ -+ idr_for_each_entry(&mgr->handle_table, ctx, id) -+ mwv207_ctx_put(ctx); -+ -+ idr_destroy(&mgr->handle_table); -+ mutex_destroy(&mgr->lock); -+} -+ -+int mwv207_kctx_init(struct mwv207_device *jdev) -+{ -+ struct drm_gpu_scheduler *scheds[1]; -+ int i; -+ -+ for (i = 0; i < 1; i++) -+ scheds[i] = jdev->sched_dma[i]; -+ -+ jdev->dma_entity = devm_kzalloc(jdev->dev, sizeof(struct drm_sched_entity), GFP_KERNEL); -+ if (!jdev->dma_entity) -+ return -ENOMEM; -+ -+ return drm_sched_entity_init(jdev->dma_entity, DRM_SCHED_PRIORITY_NORMAL, &scheds[0], i, NULL); -+} -+ -+void mwv207_kctx_fini(struct mwv207_device *jdev) -+{ -+ drm_sched_entity_destroy(jdev->dma_entity); -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_ctx.h b/drivers/gpu/drm/mwv207/mwv207_ctx.h -new file mode 100644 -index 000000000..67c02d439 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_ctx.h -@@ -0,0 +1,51 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_CTX_H_QFMRESBO -+#define MWV207_CTX_H_QFMRESBO -+#include -+#include -+#include "mwv207.h" -+ -+struct mwv207_ctx { -+ struct kref refcnt; -+ -+ struct drm_sched_entity *entities[11]; -+ -+ -+ struct drm_sched_entity **entity_3d; -+ struct drm_sched_entity **entity_dec; -+ struct drm_sched_entity **entity_enc; -+ struct drm_sched_entity **entity_2d; -+ struct drm_sched_entity **entity_dma; -+ -+ struct mwv207_device *jdev; -+ atomic_t guilty; -+}; -+ -+struct mwv207_ctx *mwv207_ctx_lookup(struct drm_device *dev, -+ struct drm_file *filp, u32 handle); -+int mwv207_ctx_put(struct mwv207_ctx *ctx); -+ -+int mwv207_ctx_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+int mwv207_ctx_mgr_init(struct drm_device *dev, struct mwv207_ctx_mgr *mgr); -+void mwv207_ctx_mgr_fini(struct drm_device *dev, struct mwv207_ctx_mgr *mgr); -+ -+int mwv207_kctx_init(struct mwv207_device *jdev); -+void mwv207_kctx_fini(struct mwv207_device *jdev); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_db.c b/drivers/gpu/drm/mwv207/mwv207_db.c -new file mode 100644 -index 000000000..ce906afeb ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_db.c -@@ -0,0 +1,138 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include "mwv207_db.h" -+#include "mwv207.h" -+#include "mwv207_drm.h" -+ -+struct mwv207_db { -+ u32 nr; -+ u32 max_nr; -+ u32 sorted; -+ u32 pad; -+ struct drm_mwv207_info_rec *db; -+}; -+ -+int mwv207_db_init(struct mwv207_device *jdev) -+{ -+ struct mwv207_db *db; -+ u32 size; -+ -+ size = sizeof(struct mwv207_db); -+ size += 2048 * sizeof(struct drm_mwv207_info_rec); -+ db = devm_kmalloc(jdev->dev, size, GFP_KERNEL); -+ if (!db) -+ return -ENOMEM; -+ -+ db->db = (struct drm_mwv207_info_rec *)(db + 1); -+ db->max_nr = 2048; -+ db->nr = 0; -+ db->sorted = 0; -+ jdev->db = db; -+ return 0; -+} -+ -+void mwv207_db_fini(struct mwv207_device *jdev) -+{ -+ devm_kfree(jdev->dev, jdev->db); -+} -+ -+int mwv207_db_add(struct mwv207_device *jdev, u32 key, u32 val) -+{ -+ struct mwv207_db *db = jdev->db; -+ -+ if (db->nr >= db->max_nr) { -+ WARN_ONCE(1, "mwv207: maximum key count reached"); -+ return -ENOMEM; -+ } -+ -+ db->db[db->nr].key = key; -+ db->db[db->nr].val = val; -+ db->nr++; -+ -+ -+ if (db->sorted) -+ mwv207_db_sort(jdev); -+ -+ return 0; -+} -+ -+static int cmp_key(const void *a, const void *b) -+{ -+ struct drm_mwv207_info_rec const *rec_a = a, *rec_b = b; -+ -+ if (rec_a->key < rec_b->key) -+ return -1; -+ else if (rec_a->key > rec_b->key) -+ return 1; -+ else -+ return 0; -+} -+ -+void mwv207_db_sort(struct mwv207_device *jdev) -+{ -+ struct mwv207_db *db = jdev->db; -+ int i; -+ -+ db->sorted = 1; -+ if (db->nr < 2) -+ return; -+ -+ sort(db->db, db->nr, 8, cmp_key, NULL); -+ -+ -+ for (i = 0; i < db->nr - 1; ++i) { -+ if (db->db[i].key == db->db[i + 1].key) { -+ WARN_ONCE(1, "mwv207 key: %d is duplicated", db->db[i].key); -+ break; -+ } -+ } -+} -+ -+int mwv207_db_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ struct mwv207_device *jdev = dev->dev_private; -+ struct drm_mwv207_info_rec rec, *result; -+ struct drm_mwv207_info *args = data; -+ struct mwv207_db *db = jdev->db; -+ -+ switch (args->op) { -+ case 1: -+ rec.key = args->nr_recs; -+ result = bsearch(&rec, db->db, db->nr, 8, cmp_key); -+ if (!result) { -+ args->recs = 0; -+ return -ENOENT; -+ } -+ args->recs = result->val; -+ -+ break; -+ case 0: -+ if (args->recs) -+ return copy_to_user((void __user *)args->recs, db->db, -+ db->nr * sizeof(struct drm_mwv207_info_rec)); -+ args->nr_recs = db->nr; -+ -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ return 0; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_db.h b/drivers/gpu/drm/mwv207/mwv207_db.h -new file mode 100644 -index 000000000..fd5c685d4 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_db.h -@@ -0,0 +1,32 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include "mwv207_drm.h" -+#ifndef MWV207_DB_H_AGPY6ZIQ -+#define MWV207_DB_H_AGPY6ZIQ -+ -+struct mwv207_device; -+ -+int mwv207_db_init(struct mwv207_device *jdev); -+void mwv207_db_fini(struct mwv207_device *jdev); -+void mwv207_db_sort(struct mwv207_device *jdev); -+ -+int mwv207_db_add(struct mwv207_device *jdev, u32 key, u32 val); -+ -+int mwv207_db_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_devfreq.c b/drivers/gpu/drm/mwv207/mwv207_devfreq.c -new file mode 100644 -index 000000000..cf800eb6b ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_devfreq.c -@@ -0,0 +1,277 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and * confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include "mwv207_devfreq.h" -+#include "mwv207_vbios.h" -+#include "mwv207_sched.h" -+ -+ -+static void mwv207_devfreq_update_utilization(struct mwv207_pipe *pipe) -+{ -+ ktime_t now; -+ ktime_t last; -+ -+ now = ktime_get(); -+ last = pipe->time_last_update; -+ -+ dev_dbg(pipe->dev, "pipe [%s] busy_count: %d", pipe->fname, pipe->busy_count); -+ -+ if (pipe->busy_count > 0) -+ pipe->busy_time += ktime_sub(now, last); -+ else -+ pipe->idle_time += ktime_sub(now, last); -+ -+ pipe->time_last_update = now; -+} -+ -+static int mwv207_devfreq_get_cur_freq(struct device *dev, unsigned long *freq) -+{ -+ struct mwv207_pipe *pipe = dev_get_drvdata(dev); -+ unsigned long freq_khz; -+ int ret; -+ -+ ret = mwv207_vbios_get_pll(pipe->jdev, pipe->pll_id, &freq_khz); -+ if (ret) -+ *freq = 0x32; -+ else -+ *freq = freq_khz / 1000; -+ -+ return 0; -+} -+ -+static int mwv207_devfreq_target(struct device *dev, unsigned long *freq, u32 flags) -+{ -+ struct mwv207_pipe *pipe = dev_get_drvdata(dev); -+ struct dev_pm_opp *opp; -+ unsigned long target_freq; -+ int ret; -+ -+ opp = devfreq_recommended_opp(dev, freq, flags); -+ if (IS_ERR(opp)) -+ return PTR_ERR(opp); -+ -+ target_freq = dev_pm_opp_get_freq(opp); -+ dev_pm_opp_put(opp); -+ -+ dev_dbg(dev, "pipe [%s] target freq: %lu", pipe->fname, target_freq); -+ -+ ret = mwv207_vbios_set_pll(pipe->jdev, pipe->pll_id, target_freq * 1000); -+ if (ret) -+ return ret; -+ -+ return 0; -+} -+ -+static void mwv207_devfreq_pipe_reset(struct mwv207_pipe *pipe) -+{ -+ pipe->busy_time = 0; -+ pipe->idle_time = 0; -+ pipe->time_last_update = ktime_get(); -+} -+ -+static int mwv207_devfreq_get_dev_status(struct device *dev, struct devfreq_dev_status *status) -+{ -+ struct mwv207_pipe *pipe = dev_get_drvdata(dev); -+ unsigned long flags; -+ -+ mwv207_devfreq_get_cur_freq(dev, &status->current_frequency); -+ -+ spin_lock_irqsave(&pipe->devfreq_lock, flags); -+ -+ mwv207_devfreq_update_utilization(pipe); -+ -+ status->total_time = ktime_to_ns(ktime_add(pipe->busy_time, -+ pipe->idle_time)); -+ -+ status->busy_time = ktime_to_ns(pipe->busy_time); -+ -+ mwv207_devfreq_pipe_reset(pipe); -+ -+ spin_unlock_irqrestore(&pipe->devfreq_lock, flags); -+ -+ return 0; -+} -+ -+static struct devfreq_dev_profile mwv207_devfreq_profile = { -+ .polling_ms = 50, -+ .target = mwv207_devfreq_target, -+ .get_dev_status = mwv207_devfreq_get_dev_status, -+ .get_cur_freq = mwv207_devfreq_get_cur_freq, -+}; -+ -+static ssize_t utilization_show(struct device *dev, struct device_attribute *attr, char *buf) -+{ -+ struct mwv207_pipe *pipe = dev_get_drvdata(dev); -+ unsigned long busy_time, total_time, flags; -+ -+ spin_lock_irqsave(&pipe->devfreq_lock, flags); -+ -+ mwv207_devfreq_update_utilization(pipe); -+ -+ total_time = ktime_to_ns(ktime_add(pipe->busy_time, pipe->idle_time)); -+ -+ busy_time = ktime_to_ns(pipe->busy_time); -+ -+ if (strncmp(pipe->devfreq->governor_name, DEVFREQ_GOV_SIMPLE_ONDEMAND, DEVFREQ_NAME_LEN)) -+ mwv207_devfreq_pipe_reset(pipe); -+ -+ spin_unlock_irqrestore(&pipe->devfreq_lock, flags); -+ -+ if (total_time == 0) -+ return sprintf(buf, "%d\n", 100); -+ else -+ return sprintf(buf, "%llu\n", div_u64(busy_time, total_time / 100)); -+} -+ -+static DEVICE_ATTR_RO(utilization); -+ -+void mwv207_devfreq_unregister(struct mwv207_pipe *pipe) -+{ -+ if (!pipe->devfreq) -+ return; -+ -+ device_remove_file(pipe->dev, &dev_attr_utilization); -+ sysfs_remove_link(&pipe->dev->kobj, "stats"); -+ dev_pm_opp_remove_all_dynamic(pipe->dev); -+ device_unregister(pipe->dev); -+} -+ -+static void mwv207_devfreq_dev_release(struct device *dev) -+{ -+ kfree(dev); -+} -+ -+int mwv207_devfreq_register(struct mwv207_pipe *pipe, unsigned long max_freq) -+{ -+ struct device *dev; -+ unsigned long freq; -+ int ret; -+ -+ dev = kzalloc(sizeof(struct device), GFP_KERNEL); -+ if (!dev) -+ return -ENOMEM; -+ -+ dev->parent = pipe->jdev->dev; -+ dev->release = mwv207_devfreq_dev_release; -+ dev_set_name(dev, "devfreq_%s", pipe->fname); -+ dev_set_drvdata(dev, pipe); -+ -+ ret = device_register(dev); -+ if (ret) { -+ put_device(dev); -+ goto err_out; -+ } -+ -+ pipe->dev = dev; -+ pipe->busy_count = 0; -+ spin_lock_init(&pipe->devfreq_lock); -+ -+ mwv207_devfreq_profile.initial_freq = max_freq; -+ -+ for (freq = 0x32; freq <= max_freq; freq += 50) { -+ ret = dev_pm_opp_add(dev, freq, 0); -+ if (ret) -+ goto remove_opps; -+ } -+ -+ pipe->devfreq = devm_devfreq_add_device(dev, &mwv207_devfreq_profile, -+ DEVFREQ_GOV_PERFORMANCE, NULL); -+ if (IS_ERR(pipe->devfreq)) { -+ ret = PTR_ERR(pipe->devfreq); -+ dev_dbg(dev, "Couldn't initialize devfreq: %d", ret); -+ goto remove_opps; -+ } -+ -+ mwv207_devfreq_pipe_reset(pipe); -+ -+ pipe->devfreq->suspend_freq = 0x32; -+ -+ ret = sysfs_create_link(&dev->kobj, &pipe->devfreq->dev.kobj, "stats"); -+ if (ret) { -+ dev_dbg(dev, "Couldn't create sys link for stats: %d", ret); -+ goto remove_opps; -+ } -+ -+ ret = device_create_file(dev, &dev_attr_utilization); -+ if (ret) { -+ dev_dbg(dev, "Couldn't create device file for utilization: %d", ret); -+ goto remove_link; -+ } -+ -+ return 0; -+ -+remove_link: -+ sysfs_remove_link(&dev->kobj, "stats"); -+remove_opps: -+ dev_pm_opp_remove_all_dynamic(dev); -+ device_unregister(dev); -+err_out: -+ return ret; -+} -+ -+int mwv207_devfreq_resume(struct mwv207_pipe *pipe) -+{ -+ unsigned long flags; -+ -+ if (!pipe->devfreq) -+ return 0; -+ -+ spin_lock_irqsave(&pipe->devfreq_lock, flags); -+ -+ mwv207_devfreq_pipe_reset(pipe); -+ -+ spin_unlock_irqrestore(&pipe->devfreq_lock, flags); -+ -+ return devfreq_resume_device(pipe->devfreq); -+} -+ -+int mwv207_devfreq_suspend(struct mwv207_pipe *pipe) -+{ -+ if (!pipe->devfreq) -+ return 0; -+ -+ return devfreq_suspend_device(pipe->devfreq); -+} -+ -+void mwv207_devfreq_record_busy(struct mwv207_pipe *pipe) -+{ -+ unsigned long flags; -+ -+ if (!pipe->devfreq) -+ return; -+ -+ spin_lock_irqsave(&pipe->devfreq_lock, flags); -+ -+ mwv207_devfreq_update_utilization(pipe); -+ pipe->busy_count++; -+ -+ spin_unlock_irqrestore(&pipe->devfreq_lock, flags); -+} -+ -+void mwv207_devfreq_record_idle(struct mwv207_pipe *pipe) -+{ -+ unsigned long flags; -+ -+ if (!pipe->devfreq) -+ return; -+ -+ spin_lock_irqsave(&pipe->devfreq_lock, flags); -+ -+ mwv207_devfreq_update_utilization(pipe); -+ WARN_ON(--pipe->busy_count < 0); -+ -+ spin_unlock_irqrestore(&pipe->devfreq_lock, flags); -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_devfreq.h b/drivers/gpu/drm/mwv207/mwv207_devfreq.h -new file mode 100644 -index 000000000..5cabf1c3a ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_devfreq.h -@@ -0,0 +1,31 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+ -+#ifndef __MWV207_DEVFREQ_H__ -+#define __MWV207_DEVFREQ_H__ -+ -+struct mwv207_pipe; -+ -+void mwv207_devfreq_unregister(struct mwv207_pipe *pipe); -+int mwv207_devfreq_register(struct mwv207_pipe *pipe, unsigned long max_freq); -+ -+void mwv207_devfreq_record_busy(struct mwv207_pipe *pipe); -+void mwv207_devfreq_record_idle(struct mwv207_pipe *pipe); -+ -+int mwv207_devfreq_suspend(struct mwv207_pipe *pipe); -+int mwv207_devfreq_resume(struct mwv207_pipe *pipe); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_dma.h b/drivers/gpu/drm/mwv207/mwv207_dma.h -new file mode 100644 -index 000000000..ff70d9a0e ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_dma.h -@@ -0,0 +1,29 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_EDMA_H_EPAWCJ4N -+#define MWV207_EDMA_H_EPAWCJ4N -+#include "mwv207.h" -+ -+struct mwv207_dma; -+struct mwv207_dma *mwv207_dma_create(struct device *dev, -+ void __iomem *regbase, u8 alignment); -+void mwv207_dma_destroy(struct mwv207_dma *dma); -+ -+int mwv207_dma_to_vram(struct mwv207_dma *dma, u64 vram_addr, void *va, u64 size); -+int mwv207_dma_to_ram(struct mwv207_dma *dma, void *va, u64 vram_addr, u64 size); -+int mwv207_dma_vram_vram(struct mwv207_dma *dma, u64 dst_vram_addr, u64 src_vram_addr, u64 size); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_drm.h b/drivers/gpu/drm/mwv207/mwv207_drm.h -new file mode 100644 -index 000000000..b6c2ff624 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_drm.h -@@ -0,0 +1,160 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef __MWV207_DRM_H__ -+#define __MWV207_DRM_H__ -+ -+ -+#include "drm/drm.h" -+ -+#if defined(__cplusplus) -+extern "C" { -+#endif -+ -+/**********************GEM interface*************************/ -+ -+struct drm_mwv207_gem_create_in { -+ __u64 size; -+ __u64 alignment; -+ __u32 preferred_domain; -+ __u32 flags; -+}; -+struct drm_mwv207_gem_create_out { -+ __u32 handle; -+ __u32 resv; -+}; -+union drm_mwv207_gem_create { -+ struct drm_mwv207_gem_create_in in; -+ struct drm_mwv207_gem_create_out out; -+}; -+ -+struct drm_mwv207_gem_mmap_in { -+ __u32 handle; -+ __u32 pad; -+}; -+struct drm_mwv207_gem_mmap_out { -+ __u64 offset; -+}; -+union drm_mwv207_gem_mmap { -+ struct drm_mwv207_gem_mmap_in in; -+ struct drm_mwv207_gem_mmap_out out; -+}; -+ -+struct drm_mwv207_gem_wait { -+ __u32 handle; -+ __u32 op; -+ __s64 timeout; -+}; -+ -+/**********************context interface*************************/ -+struct drm_mwv207_ctx { -+ __u32 op; -+ __u32 flags; -+ __u32 handle; -+ __u32 resv; -+}; -+ -+/**********************submission interface************************* -+ * 1. a submission is sent to a single ctx -+ * 2. a submission optionally contains a relocation table and a bo table -+ * 3. bo table should not contain duplicates; -+ * 4. cmd buffer size should be limited to 16K -+ */ -+ -+struct drm_mwv207_submit { -+ __u32 ctx; -+ __u32 engine_type; -+ __u32 engine_id; -+ __u32 flags; -+ __u32 fence_fd; /* in/out fence fd, according to MWV207_SUBMIT_FLAG_FENCE_IN/OUT */ -+ __u32 cmd_size; -+ __u32 nr_relocs; -+ __u32 nr_bos; -+ __u32 nr_cmd_dat; -+ __u32 padding; -+ __u64 cmds; -+ __u64 relocs; -+ __u64 bos; -+ __u64 cmd_dats; -+ /* syncobj support, reserved for vulkan -+ * __u32 nr_in_syncobjs; -+ * __u32 nr_out_syncobjs; -+ * __u64 in_syncobjs; -+ * __u64 out_syncobjs; -+ */ -+}; -+ -+/* in_syncobjs/out_syncobjs array element, reserved for vulkan */ -+struct drm_mwv207_submit_syncobj { -+ __u32 handle; -+ __u32 flags; -+ __u64 point; -+}; -+ -+struct drm_mwv207_bo_acc { -+ __u32 handle; -+ __u32 flags; -+}; -+ -+struct drm_mwv207_submit_reloc { -+ __u32 idx; /* bo/cmd_dat idx in submit bos/cmd_dats */ -+ __u32 cmd_offset; -+ __u64 bo_offset; -+ __u32 type; -+ __u32 pad; -+}; -+ -+ -+struct drm_mwv207_submit_cmd_dat { -+ __u32 nr_relocs; -+ __u32 dat_size; -+ __u64 relocs; -+ __u64 dat; -+}; -+ -+/**************** card capability interface *****************/ -+/* XXX: keys are user/kernel ABI, DO THINK TWICE when -+ * add keys, once added it can never be removed. -+ */ -+enum drm_mwv207_info_key { -+ DRM_MWV207_ACTIVE_3D_NR = 0, -+ DRM_MWV207_ACTIVE_DEC_NR, -+ DRM_MWV207_ACTIVE_ENC_NR, -+ DRM_MWV207_ACTIVE_2D_NR, -+ DRM_MWV207_ACTIVE_DMA_NR, -+}; -+ -+struct drm_mwv207_info_rec { -+ __u32 key; -+ __u32 val; -+}; -+ -+struct drm_mwv207_info { -+ __u32 op; -+ __u32 nr_recs; -+ __u64 recs; -+}; -+ -+#define DRM_IOCTL_MWV207_INFO DRM_IOWR(DRM_COMMAND_BASE + 0x00, struct drm_mwv207_info) -+#define DRM_IOCTL_MWV207_GEM_CREATE DRM_IOWR(DRM_COMMAND_BASE + 0x01, union drm_mwv207_gem_create) -+#define DRM_IOCTL_MWV207_GEM_MMAP DRM_IOWR(DRM_COMMAND_BASE + 0x02, union drm_mwv207_gem_mmap) -+#define DRM_IOCTL_MWV207_GEM_WAIT DRM_IOWR(DRM_COMMAND_BASE + 0x03, struct drm_mwv207_gem_wait) -+#define DRM_IOCTL_MWV207_CTX DRM_IOWR(DRM_COMMAND_BASE + 0x04, struct drm_mwv207_ctx) -+#define DRM_IOCTL_MWV207_SUBMIT DRM_IOWR(DRM_COMMAND_BASE + 0x05, struct drm_mwv207_submit) -+#if defined(__cplusplus) -+} -+#endif -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_drv.c b/drivers/gpu/drm/mwv207/mwv207_drv.c -new file mode 100644 -index 000000000..53c18aed8 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_drv.c -@@ -0,0 +1,540 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207_drm.h" -+#include "mwv207_gem.h" -+#include "mwv207_bo.h" -+#include "dc/mwv207_kms.h" -+#include "mwv207_ctx.h" -+#include "mwv207_submit.h" -+#include "mwv207_sched.h" -+#include "mwv207_irq.h" -+#include "mwv207_db.h" -+#include "mwv207_vbios.h" -+ -+#define DRIVER_NAME "mwv207" -+#define DRIVER_DESC "mwv207 gpu driver" -+#define DRIVER_DATE "20220407" -+ -+ -+ -+ -+static int selftest; -+module_param(selftest, int, 0644); -+MODULE_PARM_DESC(selftest, "run selftest when startup"); -+ -+static int mwv207_driver_open(struct drm_device *dev, struct drm_file *file_priv) -+{ -+ struct mwv207_fpriv *fpriv; -+ -+ fpriv = kzalloc(sizeof(struct mwv207_fpriv), GFP_KERNEL); -+ if (fpriv == NULL) -+ return -ENOMEM; -+ -+ mwv207_ctx_mgr_init(dev, &fpriv->ctx_mgr); -+ -+ file_priv->driver_priv = fpriv; -+ -+ return 0; -+} -+ -+static void mwv207_driver_postclose(struct drm_device *dev, -+ struct drm_file *file_priv) -+{ -+ struct mwv207_fpriv *fpriv = to_fpriv(file_priv); -+ -+ mwv207_ctx_mgr_fini(dev, &fpriv->ctx_mgr); -+ kfree(fpriv); -+} -+ -+static int mwv207_mmap(struct file *filp, struct vm_area_struct *vma) -+{ -+ struct drm_file *file_priv; -+ struct mwv207_device *jdev; -+ int ret; -+ -+ file_priv = filp->private_data; -+ jdev = file_priv->minor->dev->dev_private; -+ ret = ttm_bo_mmap(filp, vma, &jdev->bdev); -+ -+ return ret; -+} -+ -+static const struct file_operations mwv207_driver_fops = { -+ .owner = THIS_MODULE, -+ .open = drm_open, -+ .mmap = mwv207_mmap, -+ .unlocked_ioctl = drm_ioctl, -+#ifdef CONFIG_COMPAT -+ .compat_ioctl = drm_compat_ioctl, -+#endif -+ .poll = drm_poll, -+ .read = drm_read, -+ .llseek = no_llseek, -+ .release = drm_release, -+}; -+ -+static const struct drm_ioctl_desc mwv207_ioctls_drm[] = { -+ DRM_IOCTL_DEF_DRV(MWV207_INFO, mwv207_db_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+ DRM_IOCTL_DEF_DRV(MWV207_GEM_CREATE, mwv207_gem_create_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+ DRM_IOCTL_DEF_DRV(MWV207_GEM_MMAP, mwv207_gem_mmap_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+ DRM_IOCTL_DEF_DRV(MWV207_GEM_WAIT, mwv207_gem_wait_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+ DRM_IOCTL_DEF_DRV(MWV207_CTX, mwv207_ctx_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+ DRM_IOCTL_DEF_DRV(MWV207_SUBMIT, mwv207_submit_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), -+}; -+ -+static struct drm_driver mwv207_drm_driver = { -+ .driver_features = DRIVER_MODESET | DRIVER_ATOMIC | DRIVER_GEM | DRIVER_RENDER, -+ .fops = &mwv207_driver_fops, -+ .open = mwv207_driver_open, -+ .postclose = mwv207_driver_postclose, -+ -+ .dumb_create = mwv207_gem_dumb_create, -+ .dumb_map_offset = drm_gem_dumb_map_offset, -+ .dumb_destroy = drm_gem_dumb_destroy, -+ -+ .gem_free_object_unlocked = mwv207_gem_free_object, -+ -+ .prime_handle_to_fd = drm_gem_prime_handle_to_fd, -+ .prime_fd_to_handle = drm_gem_prime_fd_to_handle, -+ .gem_prime_export = drm_gem_prime_export, -+ .gem_prime_import = drm_gem_prime_import, -+ .gem_prime_mmap = drm_gem_prime_mmap, -+ -+ .ioctls = mwv207_ioctls_drm, -+ .num_ioctls = ARRAY_SIZE(mwv207_ioctls_drm), -+ -+ .name = DRIVER_NAME, -+ .desc = DRIVER_DESC, -+ .date = DRIVER_DATE, -+ .major = 0x0, -+ .minor = 0x1, -+}; -+ -+static inline void iatu_write(struct mwv207_device *jdev, int index, u32 offset, u32 value) -+{ -+ u32 region_base = 0x10000 + index * 0x200; -+ writel(value, jdev->iatu + region_base + offset); -+} -+ -+static inline u32 iatu_read(struct mwv207_device *jdev, int index, u32 offset) -+{ -+ u32 region_base = 0x10000 + index * 0x200; -+ return readl(jdev->iatu + region_base + offset); -+} -+ -+static void mwv207_win_slide(struct mwv207_device *jdev, int region, -+ u64 pci_win_base, u64 axi_win_base) -+{ -+ iatu_write(jdev, region, 0x108, pci_win_base & 0xffffffff); -+ iatu_write(jdev, region, 0x10C, pci_win_base >> 32); -+ iatu_write(jdev, region, 0x114, axi_win_base & 0xffffffff); -+ iatu_write(jdev, region, 0x118, axi_win_base >> 32); -+ -+ iatu_write(jdev, region, 0x110, -+ (pci_win_base + 0x10000 - 1) & 0xffffffff); -+ iatu_write(jdev, region, 0x100, 0x00); -+ iatu_write(jdev, region, 0x104, -+ 1 << 31 -+ | 0x0 << 30 -+ | 6 << 8); -+ -+ -+ mb(); -+ if (iatu_read(jdev, region, 0x118) != (axi_win_base >> 32)) -+ pr_warn("mwv207: sliding window failed"); -+} -+ -+static int mwv207_iatu_map_bar(struct mwv207_device *jdev, int bar, u64 axi_addr) -+{ -+ iatu_write(jdev, bar + 9, 0x114, axi_addr & 0xffffffff); -+ iatu_write(jdev, bar + 9, 0x118, axi_addr >> 32); -+ iatu_write(jdev, bar + 9, 0x100, 0x00); -+ iatu_write(jdev, bar + 9, 0x104, -+ 1 << 31 -+ | 1 << 30 -+ | bar << 8); -+ -+ -+ mb(); -+ if (iatu_read(jdev, bar + 9, 0x114) != (axi_addr & 0xffffffff)) -+ return -ENODEV; -+ -+ return 0; -+} -+ -+static int mwv207_iatu_init(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ ret = mwv207_iatu_map_bar(jdev, 0, 0x10000000); -+ if (ret) -+ return ret; -+ -+ ret = mwv207_iatu_map_bar(jdev, 1, 0x00000000); -+ if (ret) -+ return ret; -+ -+ ret = mwv207_iatu_map_bar(jdev, 2, 0x10000000); -+ if (ret) -+ return ret; -+ -+ spin_lock_init(&jdev->win_lock); -+ -+ jdev->pci_win_base = pci_bus_address(jdev->base.pdev, 2) -+ + pci_resource_len(jdev->base.pdev, 2) - 0x10000; -+ -+ mwv207_win_slide(jdev, 0, jdev->pci_win_base, 0x10000000); -+ -+ jdev->vram_last_win = 0; -+ -+ return 0; -+} -+ -+static void *mwv207_remap_region(struct mwv207_device *jdev, u64 vram_addr, u32 *len) -+{ -+ u64 vram_win_base = (vram_addr & (~(0x10000 - 1))); -+ u64 winlimit = vram_win_base + 0x10000; -+ -+ if (vram_win_base != jdev->vram_last_win) { -+ mwv207_win_slide(jdev, 0, jdev->pci_win_base, vram_win_base + 0x10000000); -+ jdev->vram_last_win = vram_win_base; -+ } -+ -+ if (*len > winlimit - vram_addr) -+ *len = winlimit - vram_addr; -+ -+ return jdev->win + vram_addr - vram_win_base; -+} -+ -+void jdev_write_vram(struct mwv207_device *jdev, u64 vram_addr, void *buf, int size) -+{ -+ int remain, len; -+ void *va; -+ -+ for (remain = size; remain > 0; remain -= len, buf += len, vram_addr += len) { -+ len = remain; -+ spin_lock(&jdev->win_lock); -+ va = mwv207_remap_region(jdev, vram_addr, &len); -+ if (!va || len <= 0) { -+ spin_unlock(&jdev->win_lock); -+ pr_warn("mwv207: write vram faild"); -+ return; -+ } -+ memcpy_toio(va, buf, len); -+ spin_unlock(&jdev->win_lock); -+ } -+} -+ -+static int mwv207_kick_out_firmware_fb(struct pci_dev *pdev) -+{ -+ struct apertures_struct *ap; -+ bool primary = false; -+ -+ ap = alloc_apertures(1); -+ if (!ap) -+ return -ENOMEM; -+ -+ ap->ranges[0].base = pci_resource_start(pdev, 0); -+ ap->ranges[0].size = pci_resource_len(pdev, 0); -+ -+#ifdef CONFIG_X86 -+ primary = pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW; -+#endif -+ drm_fb_helper_remove_conflicting_framebuffers(ap, "mwv207drmfb", primary); -+ kfree(ap); -+ -+ return 0; -+} -+ -+static u64 mwv207_vram_size(struct mwv207_device *jdev) -+{ -+ int nr = 0; -+ u64 size; -+ -+ switch (jdev_read(jdev, 0x9b0190) & 0x7) { -+ case 0: -+ size = 2048; -+ break; -+ case 1: -+ size = 1024; -+ break; -+ case 2: -+ size = 4096; -+ break; -+ case 3: -+ size = 8192; -+ break; -+ default: -+ pr_warn("mwv207: ddr size default to 256MB"); -+ return 256UL * 1024 * 1024; -+ } -+ -+ if (jdev->lite) { -+ nr += jdev_read(jdev, 0xd101bc) & 0x1; -+ nr += jdev_read(jdev, 0xd11cbc) & 0x1; -+ } else { -+ nr += (jdev_read(jdev, 0x9702f4) & 0x02000000) ? 1 : 0; -+ nr += (jdev_read(jdev, 0x9802f4) & 0x02000000) ? 1 : 0; -+ } -+ if (!nr) { -+ nr = 1; -+ pr_warn("mwv207: ddr cnt default to 1"); -+ } -+ -+ return size * 1024 * 1024 * nr; -+} -+ -+static int mwv207_pci_probe(struct pci_dev *pdev, -+ const struct pci_device_id *ent) -+{ -+ struct mwv207_device *jdev; -+ int ret; -+ -+ ret = mwv207_kick_out_firmware_fb(pdev); -+ if (ret) -+ return ret; -+ -+ pci_set_master(pdev); -+ ret = pcim_enable_device(pdev); -+ if (ret) -+ return ret; -+ -+ jdev = devm_drm_dev_alloc(&pdev->dev, &mwv207_drm_driver, -+ struct mwv207_device, base); -+ if (IS_ERR(jdev)) -+ return PTR_ERR(jdev); -+ -+ jdev->dev = &pdev->dev; -+ jdev->base.pdev = pdev; -+ jdev->base.dev_private = jdev; -+ -+ jdev->mmio = devm_ioremap(jdev->dev, -+ pci_resource_start(pdev, 1), pci_resource_len(pdev, 1)); -+ if (!jdev->mmio) -+ return -ENOMEM; -+ -+ jdev->iatu = devm_ioremap(jdev->dev, -+ pci_resource_start(pdev, 4), pci_resource_len(pdev, 4)); -+ if (!jdev->iatu) -+ return -ENOMEM; -+ -+ jdev->win = devm_ioremap(jdev->dev, -+ pci_resource_end(pdev, 2) - 0x10000 + 1, 0x10000); -+ if (!jdev->win) -+ return -ENOMEM; -+ -+ ret = mwv207_iatu_init(jdev); -+ if (ret) -+ return ret; -+ -+ /* magic: use hdmi-3 to probe for 92/91 (full/lite) */ -+ jdev->lite = jdev_read(jdev, 0x12c0000) == 0x21 ? false : true; -+ -+ pci_set_drvdata(pdev, jdev); -+ -+ ret = mwv207_db_init(jdev); -+ if (ret) -+ return ret; -+ -+ mwv207_vbios_init(jdev); -+ -+ ret = mwv207_irq_init(jdev); -+ if (ret) -+ goto err_vbios; -+ -+ jdev->visible_vram_size = pci_resource_len(pdev, 2) - 0x10000; -+ jdev->vram_size = mwv207_vram_size(jdev); -+ jdev->vram_bar_base = pci_resource_start(pdev, 2); -+ -+ ret = mwv207_ttm_init(jdev); -+ if (ret) -+ goto err_irq; -+ -+ ret = mwv207_sched_init(jdev); -+ if (ret) -+ goto err_ttm; -+ -+ ret = mwv207_kctx_init(jdev); -+ if (ret) -+ goto err_sched; -+ -+ ret = mwv207_kms_init(jdev); -+ if (ret) -+ goto err_kctx; -+ -+ if (selftest) { -+ ret = mwv207_test(jdev); -+ if (ret) -+ goto err_kms; -+ } -+ -+ mwv207_db_sort(jdev); -+ ret = drm_dev_register(&jdev->base, 0); -+ if (ret) -+ goto err_kms; -+ ret = mwv207_fbdev_init(jdev); -+ if (ret) -+ goto err_drm; -+ -+ return 0; -+err_drm: -+ drm_dev_unregister(&jdev->base); -+err_kms: -+ mwv207_kms_fini(jdev); -+err_kctx: -+ mwv207_kctx_fini(jdev); -+err_sched: -+ mwv207_sched_fini(jdev); -+err_ttm: -+ mwv207_ttm_fini(jdev); -+err_irq: -+ mwv207_irq_fini(jdev); -+err_vbios: -+ mwv207_vbios_fini(jdev); -+ mwv207_db_fini(jdev); -+ return ret; -+} -+ -+static void mwv207_pci_remove(struct pci_dev *pdev) -+{ -+ struct mwv207_device *jdev = pci_get_drvdata(pdev); -+ -+ mwv207_fbdev_fini(jdev); -+ drm_dev_unregister(&jdev->base); -+ mwv207_kms_fini(jdev); -+ mwv207_kctx_fini(jdev); -+ mwv207_sched_fini(jdev); -+ mwv207_ttm_fini(jdev); -+ mwv207_irq_fini(jdev); -+ mwv207_vbios_fini(jdev); -+ mwv207_db_fini(jdev); -+ pci_clear_master(pdev); -+ pci_set_drvdata(pdev, NULL); -+} -+ -+static int mwv207_pmops_suspend(struct device *dev) -+{ -+ struct mwv207_device *jdev = dev_get_drvdata(dev); -+ struct pci_dev *pdev = to_pci_dev(dev); -+ int ret; -+ -+ ret = mwv207_kms_suspend(jdev); -+ if (ret) -+ return ret; -+ -+ /* kernel permanently pinned boes won't be evicted, they are -+ * handled by each module in whatever ways suitable -+ */ -+ ret = ttm_bo_evict_mm(&jdev->bdev, TTM_PL_VRAM); -+ if (ret) -+ goto fail; -+ -+ ret = mwv207_sched_suspend(jdev); -+ if (ret) -+ goto fail; -+ -+ mwv207_irq_suspend(jdev); -+ -+ pci_save_state(pdev); -+ pci_disable_device(pdev); -+ pci_set_power_state(pdev, PCI_D3hot); -+ udelay(200); -+ return 0; -+fail: -+ mwv207_kms_resume(jdev); -+ return ret; -+} -+ -+static int mwv207_pmops_resume(struct device *dev) -+{ -+ struct mwv207_device *jdev = dev_get_drvdata(dev); -+ struct pci_dev *pdev = to_pci_dev(dev); -+ int ret; -+ -+ msleep(100); -+ -+ pci_set_power_state(pdev, PCI_D0); -+ pci_restore_state(pdev); -+ ret = pci_enable_device(pdev); -+ if (ret) { -+ pr_err("mwv207: failed to enable pci device"); -+ return ret; -+ } -+ pci_set_master(pdev); -+ -+ ret = mwv207_iatu_init(jdev); -+ if (ret) -+ return ret; -+ -+ mwv207_irq_resume(jdev); -+ -+ ret = mwv207_sched_resume(jdev); -+ if (ret) -+ return ret; -+ -+ return mwv207_kms_resume(jdev); -+} -+ -+static SIMPLE_DEV_PM_OPS(mwv207_pm_ops, mwv207_pmops_suspend, mwv207_pmops_resume); -+ -+#define MWV207_PCI_DEVICE_DATA(vend, dev, data) \ -+ .vendor = vend, .device = dev, .driver_data = (kernel_ulong_t)(data), \ -+ .subvendor = PCI_ANY_ID, .subdevice = PCI_ANY_ID, \ -+ .class = 0, .class_mask = 0 -+ -+static const struct pci_device_id pciidlist[] = { -+ {MWV207_PCI_DEVICE_DATA(0x0731, 0x9100, NULL)}, -+ {0}, -+}; -+ -+MODULE_DEVICE_TABLE(pci, pciidlist); -+static struct pci_driver mwv207_pci_driver = { -+ .name = DRIVER_NAME, -+ .id_table = pciidlist, -+ .probe = mwv207_pci_probe, -+ .remove = mwv207_pci_remove, -+ .driver.pm = &mwv207_pm_ops, -+}; -+ -+static int __init mwv207_init(void) -+{ -+ return pci_register_driver(&mwv207_pci_driver); -+} -+ -+static void __exit mwv207_exit(void) -+{ -+ pci_unregister_driver(&mwv207_pci_driver); -+} -+ -+module_init(mwv207_init); -+module_exit(mwv207_exit); -+MODULE_DESCRIPTION("MWV207 Graphics Driver"); -+MODULE_AUTHOR("shanjinkui"); -+MODULE_LICENSE("GPL"); -diff --git a/drivers/gpu/drm/mwv207/mwv207_gem.c b/drivers/gpu/drm/mwv207/mwv207_gem.c -new file mode 100644 -index 000000000..70b60b7e0 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_gem.c -@@ -0,0 +1,155 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include "mwv207_drm.h" -+#include "mwv207_gem.h" -+#include "mwv207_bo.h" -+ -+static int mwv207_gem_create(struct mwv207_device *jdev, -+ u64 size, u64 align, u32 preferred_domain, -+ u32 flags, struct drm_gem_object **gobj) -+{ -+ struct mwv207_bo *jbo; -+ int ret; -+ -+retry: -+ -+ ret = mwv207_bo_create(jdev, size, align, ttm_bo_type_device, -+ preferred_domain, flags, &jbo); -+ if (ret) { -+ if (ret != -ERESTARTSYS) { -+ if (flags & (1<<0)) { -+ flags &= ~(1<<0); -+ goto retry; -+ } -+ if (preferred_domain == 0x2) { -+ preferred_domain |= 0x1; -+ goto retry; -+ } -+ DRM_DEBUG("Failed to allocate GEM object (%lld, %d, %llu, %d)\n", -+ size, preferred_domain, align, ret); -+ } -+ return ret; -+ } -+ -+ *gobj = mwv207_gem_from_bo(jbo); -+ return 0; -+} -+ -+int mwv207_gem_dumb_create(struct drm_file *file, struct drm_device *dev, -+ struct drm_mode_create_dumb *args) -+{ -+ struct mwv207_device *jdev = dev->dev_private; -+ struct drm_gem_object *gobj; -+ u32 handle; -+ int ret; -+ -+ args->pitch = ALIGN(args->width * DIV_ROUND_UP(args->bpp, 8), 64); -+ args->size = args->pitch * args->height; -+ ret = mwv207_gem_create(jdev, args->size, 0x10000, -+ 0x2, -+ (1<<0), -+ &gobj); -+ if (ret) -+ return ret; -+ -+ ret = drm_gem_handle_create(file, gobj, &handle); -+ drm_gem_object_put(gobj); -+ if (ret) -+ return ret; -+ -+ args->handle = handle; -+ return 0; -+} -+ -+void mwv207_gem_free_object(struct drm_gem_object *gobj) -+{ -+ struct mwv207_bo *jbo; -+ -+ if (!gobj) -+ return; -+ -+ jbo = mwv207_bo_from_gem(gobj); -+ mwv207_bo_unref(jbo); -+} -+ -+int mwv207_gem_create_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ struct mwv207_device *jdev = dev->dev_private; -+ union drm_mwv207_gem_create *args = data; -+ struct drm_gem_object *gobj; -+ int ret; -+ -+ if (args->in.size == 0) -+ return -EINVAL; -+ if (args->in.alignment & (args->in.alignment - 1)) -+ return -EINVAL; -+ if (args->in.preferred_domain & ~0x7) -+ return -EINVAL; -+ if (args->in.flags & ~((1<<0)|(1<<1)|(1<<2))) -+ return -EINVAL; -+ -+ ret = mwv207_gem_create(jdev, args->in.size, args->in.alignment, -+ args->in.preferred_domain, -+ args->in.flags, &gobj); -+ if (ret) -+ return ret; -+ -+ ret = drm_gem_handle_create(filp, gobj, &args->out.handle); -+ drm_gem_object_put(gobj); -+ -+ return ret; -+} -+ -+int mwv207_gem_mmap_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ union drm_mwv207_gem_mmap *args = data; -+ struct drm_gem_object *obj; -+ -+ if (args->in.pad) -+ return -EINVAL; -+ -+ obj = drm_gem_object_lookup(filp, args->in.handle); -+ if (!obj) -+ return -ENOENT; -+ args->out.offset = mwv207_bo_mmap_offset(obj); -+ drm_gem_object_put(obj); -+ -+ return 0; -+} -+ -+int mwv207_gem_wait_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ struct drm_mwv207_gem_wait *args = (struct drm_mwv207_gem_wait *)data; -+ long timeout; -+ bool write; -+ int ret; -+ -+ if (args->op & ~(0x00000002 | 0x00000001)) -+ return -EINVAL; -+ -+ write = args->op & 0x00000002; -+ timeout = drm_timeout_abs_to_jiffies(args->timeout); -+ -+ ret = drm_gem_dma_resv_wait(filp, args->handle, write, timeout); -+ if (ret == -ETIME) -+ ret = timeout ? -ETIMEDOUT : -EBUSY; -+ -+ return ret; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_gem.h b/drivers/gpu/drm/mwv207/mwv207_gem.h -new file mode 100644 -index 000000000..5a776b242 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_gem.h -@@ -0,0 +1,38 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_GEM_H_TJTW9M4R -+#define MWV207_GEM_H_TJTW9M4R -+#include -+#include -+#include -+#include "mwv207.h" -+ -+int mwv207_gem_dumb_create(struct drm_file *file, struct drm_device *dev, -+ struct drm_mode_create_dumb *args); -+ -+void mwv207_gem_free_object(struct drm_gem_object *obj); -+ -+int mwv207_gem_create_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+int mwv207_gem_mmap_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+int mwv207_gem_wait_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_irq.c b/drivers/gpu/drm/mwv207/mwv207_irq.c -new file mode 100644 -index 000000000..987d8a91e ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_irq.c -@@ -0,0 +1,190 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_irq.h" -+ -+static irqreturn_t mwv207_isr(int irq_unused, void *dev_id) -+{ -+ struct mwv207_device *jdev = dev_id; -+ int i, j, hwirq, virq, ret = IRQ_NONE; -+ u32 stat; -+ -+ for (i = 0; i < 2; ++i) { -+ stat = jdev_read(jdev, (0x009A802c) + i * 4); -+ stat &= jdev->irq_enable_reg[i]; -+ while ((j = ffs(stat))) { -+ j--; -+ hwirq = i * 32 + j; -+ virq = irq_find_mapping(jdev->irq_domain, hwirq); -+ if (virq) { -+ ret = generic_handle_irq(virq); -+ if (ret < 0) -+ pr_warn("mwv207: hwirq(%d) handled with %d", hwirq, ret); -+ } else -+ pr_warn("mwv207: no irq mapping set on %d", hwirq); -+ -+ -+ jdev_write(jdev, (0x009A802c) + i * 4, (1UL << j)); -+ stat &= ~(1UL << j); -+ ret = IRQ_HANDLED; -+ } -+ } -+ -+ return ret; -+} -+ -+static void mwv207_irq_mask(struct irq_data *d) -+{ -+ struct mwv207_device *jdev = irq_data_get_irq_chip_data(d); -+ int irq = irqd_to_hwirq(d); -+ unsigned long flags; -+ u32 reg; -+ -+ reg = (0x009A8020) + (irq / 32) * 4; -+ -+ spin_lock_irqsave(&jdev->irq_lock, flags); -+ jdev_modify(jdev, reg, 1 << (irq % 32), 0); -+ jdev->irq_enable_reg[irq / 32] = jdev_read(jdev, reg); -+ spin_unlock_irqrestore(&jdev->irq_lock, flags); -+} -+ -+static void mwv207_irq_unmask(struct irq_data *d) -+{ -+ struct mwv207_device *jdev = irq_data_get_irq_chip_data(d); -+ int irq = irqd_to_hwirq(d); -+ unsigned long flags; -+ u32 reg; -+ -+ reg = (0x009A8020) + (irq / 32) * 4; -+ -+ spin_lock_irqsave(&jdev->irq_lock, flags); -+ jdev_modify(jdev, reg, 1 << (irq % 32), 1 << (irq % 32)); -+ jdev->irq_enable_reg[irq / 32] = jdev_read(jdev, reg); -+ spin_unlock_irqrestore(&jdev->irq_lock, flags); -+} -+ -+void mwv207_irq_suspend(struct mwv207_device *jdev) -+{ -+ int i; -+ -+ for (i = 0; i < 2; ++i) -+ jdev->irq_enable_reg[i] = jdev_read(jdev, -+ (0x009A8020) + i * 4); -+} -+ -+void mwv207_irq_resume(struct mwv207_device *jdev) -+{ -+ int i; -+ -+ for (i = 0; i < 2; ++i) { -+ jdev_write(jdev, (0x009A802c) + i * 4, 0xffffffff); -+ jdev_write(jdev, (0x009A8020) + i * 4, -+ jdev->irq_enable_reg[i]); -+ } -+} -+ -+static struct irq_chip mwv207_irq_chip = { -+ .name = "mwv207", -+ .irq_mask = mwv207_irq_mask, -+ .irq_unmask = mwv207_irq_unmask, -+}; -+ -+static int mwv207_irq_domain_map(struct irq_domain *d, unsigned int irq, -+ irq_hw_number_t hwirq) -+{ -+ struct mwv207_device *jdev = d->host_data; -+ -+ if (hwirq >= 64) -+ return -EPERM; -+ -+ irq_set_chip_and_handler(irq, &mwv207_irq_chip, handle_simple_irq); -+ irq_set_chip_data(irq, jdev); -+ -+ return 0; -+} -+ -+static const struct irq_domain_ops mwv207_irq_domain_ops = { -+ .map = mwv207_irq_domain_map, -+}; -+ -+int mwv207_irq_init(struct mwv207_device *jdev) -+{ -+ struct pci_dev *pdev = jdev->base.pdev; -+ int ret, i; -+ -+ -+ for (i = 0; i < 2; ++i) { -+ jdev_write(jdev, (0x009A802c) + i * 4, 0xffffffff); -+ jdev_write(jdev, (0x009A8020) + i * 4, 0); -+ } -+ -+ spin_lock_init(&jdev->irq_lock); -+ -+ jdev->irq_domain = irq_domain_add_linear(NULL, 64, -+ &mwv207_irq_domain_ops, jdev); -+ if (!jdev->irq_domain) -+ return -ENODEV; -+ -+ -+ for (i = 0; i < 64; ++i) -+ irq_create_mapping(jdev->irq_domain, i); -+ -+ ret = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_MSI | PCI_IRQ_LEGACY); -+ if (ret < 1) { -+ ret = -ENODEV; -+ goto free_mapping; -+ } -+ -+ ret = request_irq(pdev->irq, mwv207_isr, IRQF_SHARED, "mwv207_isr", jdev); -+ if (ret) -+ goto free_vec; -+ -+ return 0; -+ -+free_vec: -+ pci_free_irq_vectors(pdev); -+free_mapping: -+ for (i = 0; i < 64; ++i) { -+ int irq = irq_find_mapping(jdev->irq_domain, i); -+ -+ irq_dispose_mapping(irq); -+ } -+ -+ irq_domain_remove(jdev->irq_domain); -+ -+ return ret; -+} -+ -+void mwv207_irq_fini(struct mwv207_device *jdev) -+{ -+ struct pci_dev *pdev = jdev->base.pdev; -+ int i; -+ -+ free_irq(pdev->irq, jdev); -+ pci_free_irq_vectors(pdev); -+ -+ for (i = 0; i < 64; ++i) { -+ int irq = irq_find_mapping(jdev->irq_domain, i); -+ -+ irq_dispose_mapping(irq); -+ } -+ -+ irq_domain_remove(jdev->irq_domain); -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_irq.h b/drivers/gpu/drm/mwv207/mwv207_irq.h -new file mode 100644 -index 000000000..eabcc61e6 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_irq.h -@@ -0,0 +1,26 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_IRQ_H_Z8YGVNB2 -+#define MWV207_IRQ_H_Z8YGVNB2 -+ -+struct mwv207_device; -+ -+int mwv207_irq_init(struct mwv207_device *jdev); -+void mwv207_irq_fini(struct mwv207_device *jdev); -+ -+void mwv207_irq_suspend(struct mwv207_device *jdev); -+void mwv207_irq_resume(struct mwv207_device *jdev); -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_2d.c b/drivers/gpu/drm/mwv207/mwv207_pipe_2d.c -new file mode 100644 -index 000000000..b34c0c781 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_2d.c -@@ -0,0 +1,566 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "mwv207_bo.h" -+#include "mwv207_sched.h" -+#include "mwv207_vbios.h" -+#include "mwv207_devfreq.h" -+ -+ -+#define wait_for(COND, MS) ({ \ -+ unsigned long timeout__ = jiffies + msecs_to_jiffies(MS) + 1; \ -+ int ret__ = 0; \ -+ while (!(COND)) { \ -+ if (time_after(jiffies, timeout__)) { \ -+ if (!(COND)) \ -+ ret__ = -ETIMEDOUT; \ -+ break; \ -+ } \ -+ msleep(1); \ -+ } \ -+ ret__; \ -+}) -+ -+struct mwv207_pipe_2d { -+ struct mwv207_pipe base; -+ struct mwv207_bo *ring_bo; -+ struct mwv207_device *jdev; -+ u32 *ring_start; -+ u32 *ring_end; -+ u32 *head; -+ u32 *tail; -+ u32 *last_wait; -+ u64 ring_start_addr; -+ int id; -+ unsigned int irq; -+ -+ u64 fence_ctx; -+ u32 next_fence; -+ u32 completed_fence; -+ spinlock_t fence_lock; -+ spinlock_t fence_queue_lock; -+ struct list_head fence_queue; -+}; -+ -+struct pipe_2d_fence { -+ struct dma_fence base; -+ struct mwv207_pipe_2d *pipe; -+ u32 *rpos; -+ -+ struct list_head q; -+}; -+ -+#define to_pipe_2d(p) container_of(p, struct mwv207_pipe_2d, base) -+#define to_pipe_2d_fence(f) container_of(f, struct pipe_2d_fence, base) -+ -+static inline void pipe_2d_write(struct mwv207_pipe_2d *pipe, -+ u32 reg, u32 value) -+{ -+ pipe_write(&pipe->base, reg, value); -+} -+ -+static inline u32 pipe_2d_read(struct mwv207_pipe_2d *pipe, u32 reg) -+{ -+ return pipe_read(&pipe->base, reg); -+} -+ -+static inline void pipe_2d_barrier(struct mwv207_pipe_2d *pipe) -+{ -+ pipe_2d_read(pipe, 0x4100); -+ mb(); -+} -+ -+ -+static inline bool fence16_after(u16 a, u16 b) -+{ -+ return (s16)(a - b) > 0; -+} -+ -+static inline bool fence_after(u32 a, u32 b) -+{ -+ return (s32)(a - b) > 0; -+} -+ -+static const char *pipe_2d_fence_get_driver_name(struct dma_fence *fence) -+{ -+ return "mwv207"; -+} -+ -+static const char *pipe_2d_fence_get_timeline_name(struct dma_fence *fence) -+{ -+ return to_pipe_2d_fence(fence)->pipe->base.fname; -+} -+ -+static bool pipe_2d_fence_signaled(struct dma_fence *fence) -+{ -+ struct pipe_2d_fence *f = to_pipe_2d_fence(fence); -+ -+ return fence_after(f->pipe->completed_fence, f->base.seqno); -+} -+ -+static void pipe_2d_fence_release(struct dma_fence *fence) -+{ -+ struct pipe_2d_fence *f = to_pipe_2d_fence(fence); -+ -+ kfree_rcu(f, base.rcu); -+} -+ -+static const struct dma_fence_ops pipe_2d_fence_ops = { -+ .get_driver_name = pipe_2d_fence_get_driver_name, -+ .get_timeline_name = pipe_2d_fence_get_timeline_name, -+ .signaled = pipe_2d_fence_signaled, -+ .release = pipe_2d_fence_release, -+}; -+ -+static inline u32 pipe_2d_ptr_span(void *end, void *start) -+{ -+ return (unsigned long)end - (unsigned long)start; -+} -+ -+static inline u32 pipe_2d_gpu_addr(struct mwv207_pipe_2d *pipe, u32 *ptr) -+{ -+ return pipe->ring_start_addr + pipe_2d_ptr_span(ptr, pipe->ring_start); -+} -+ -+static inline bool pipe_2d_idle_on_noc(struct mwv207_pipe_2d *pipe) -+{ -+ struct mwv207_device *jdev = pipe->jdev; -+ u32 pending1, pending2; -+ u32 val; -+ -+ pending1 = jdev->lite ? 0x70038000 : 0xF87FC000; -+ pending2 = jdev->lite ? 0x00000000 : 0x0000000F; -+ -+ val = jdev_read(jdev, (0x009B0194)); -+ if ((val & pending1) != pending1) -+ return false; -+ val = jdev_read(jdev, (0x009B0198)); -+ if ((val & pending2) != pending2) -+ return false; -+ return true; -+} -+ -+static int pipe_2d_hw_init(struct mwv207_pipe_2d *pipe) -+{ -+ int ret; -+ u32 val; -+ -+ ret = wait_for(pipe_2d_idle_on_noc(pipe), 5000); -+ if (ret) { -+ pr_err("mwv207: failed to wait %s idle, %#x %#x", -+ pipe->base.fname, -+ jdev_read(pipe->jdev, (0x009B0194)), -+ jdev_read(pipe->jdev, (0x009B0198))); -+ return ret; -+ } -+ -+ -+ val = jdev_read(pipe->jdev, (0x009B0048)); -+ val &= ~(1 << 8); -+ jdev_write(pipe->jdev, (0x009B0048), val); -+ -+ -+ val = jdev_read(pipe->jdev, (0x009B0014)); -+ val &= ~(1 << 16); -+ jdev_write(pipe->jdev, (0x009B0014), val); -+ -+ -+ val = jdev_read(pipe->jdev, (0x009B0048)); -+ val |= 1 << 8; -+ jdev_write(pipe->jdev, (0x009B0048), val); -+ -+ -+ val = jdev_read(pipe->jdev, (0x009B0014)); -+ val |= 1 << 16; -+ jdev_write(pipe->jdev, (0x009B0014), val); -+ -+ msleep(10); -+ -+ -+ pipe_2d_write(pipe, 0x4800, 0); -+ -+ ret = wait_for(pipe_2d_read(pipe, 0x4800), 5000); -+ if (ret) { -+ pr_err("mwv207: failed to reset %s status RAM", -+ pipe->base.fname); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static void pipe_2d_reset_ring(struct mwv207_pipe_2d *pipe) -+{ -+ struct pipe_2d_fence *fence, *p; -+ unsigned long flags; -+ -+ pipe->head = pipe->ring_start; -+ pipe->tail = pipe->ring_start; -+ -+ spin_lock_irqsave(&pipe->fence_queue_lock, flags); -+ list_for_each_entry_safe(fence, p, &pipe->fence_queue, q) { -+ list_del(&fence->q); -+ dma_fence_put(&fence->base); -+ } -+ spin_unlock_irqrestore(&pipe->fence_queue_lock, flags); -+} -+ -+static u32 *pipe_2d_append_wl(struct mwv207_pipe_2d *pipe) -+{ -+ u32 *wait = pipe->tail; -+ -+ *pipe->tail++ = 0x88000000; -+ *pipe->tail++ = 0x80000000; -+ *pipe->tail++ = 0x89000000; -+ *pipe->tail++ = pipe_2d_gpu_addr(pipe, wait);; -+ -+ return wait; -+} -+ -+static void pipe_2d_start(struct mwv207_pipe_2d *pipe) -+{ -+ u32 regval = pipe->ring_start_addr >> 4 | 1 << 29; -+ -+ pipe_2d_write(pipe, 0x4200, regval); -+ -+ *pipe->tail++ = 0x80000000; -+ *pipe->tail++ = 1; -+ *pipe->tail++ = 0x80000000; -+ *pipe->tail++ = 0x80000000; -+ -+ pipe->last_wait = pipe_2d_append_wl(pipe); -+ BUG_ON(pipe_2d_ptr_span(pipe->tail, pipe->ring_start) != 32); -+ pipe_2d_barrier(pipe); -+ pipe_2d_write(pipe, 0x4C00, 1); -+ -+ dev_dbg(pipe->base.jdev->dev, "start 2d wait link at 0x%llx", -+ pipe->ring_start_addr); -+} -+ -+static inline void pipe_2d_stop(struct mwv207_pipe_2d *pipe) -+{ -+ pr_info("mwv207: %s %s TBD", pipe->base.fname, __func__); -+} -+ -+static void mwv207_pipe_2d_reset(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); -+ -+ if (pipe_2d_hw_init(pipe)) -+ return; -+ pipe_2d_reset_ring(pipe); -+ pipe_2d_start(pipe); -+} -+ -+static u32 *pipe_2d_wait_for_space(struct mwv207_pipe_2d *pipe, u32 size) -+{ -+ int i; -+ -+ for (i = 0; i < 10000; i++) { -+ u32 *head = READ_ONCE(pipe->head); -+ if (head <= pipe->tail) { -+ if (pipe_2d_ptr_span(pipe->ring_end, pipe->tail) >= size) -+ return pipe->tail; -+ if (pipe_2d_ptr_span(head, pipe->ring_start) >= size) -+ return pipe->ring_start; -+ } else { -+ if (pipe_2d_ptr_span(head, pipe->tail) >= size) -+ return pipe->tail; -+ } -+ usleep_range(200, 200); -+ } -+ -+ return NULL; -+} -+ -+static struct dma_fence *pipe_2d_append_fence(struct mwv207_pipe_2d *pipe) -+{ -+ struct pipe_2d_fence *fence; -+ unsigned long flags; -+ u32 regno; -+ -+ fence = kzalloc(sizeof(struct pipe_2d_fence), GFP_KERNEL); -+ if (!fence) { -+ pr_err("mwv207: failed to alloc memory for %s", -+ pipe->base.fname); -+ return ERR_PTR(-ENOMEM); -+ } -+ dma_fence_init(&fence->base, &pipe_2d_fence_ops, &pipe->fence_lock, -+ pipe->fence_ctx, ++pipe->next_fence); -+ fence->pipe = pipe; -+ fence->rpos = pipe->tail; -+ regno = (pipe->next_fence & 0x1f) + 1; -+ -+ spin_lock_irqsave(&pipe->fence_queue_lock, flags); -+ list_add_tail(&fence->q, &pipe->fence_queue); -+ spin_unlock_irqrestore(&pipe->fence_queue_lock, flags); -+ -+ *pipe->tail++ = (0x40000000 | 0x6000 | (0) << 2); -+ *pipe->tail++ = (u32)(fence->base.seqno & 0xffff); -+ *pipe->tail++ = (0x40000000 | 0x6000 | (regno) << 2); -+ *pipe->tail++ = regno; -+ -+ pipe_2d_write(pipe, 0x6000 + regno * 4, regno); -+ -+ dma_fence_get(&fence->base); -+ return &fence->base; -+} -+ -+static void pipe_2d_wtol(struct mwv207_pipe_2d *pipe, u32 *start, u32 *new_wait) -+{ -+ u32 *pos = pipe->last_wait; -+ -+ pos[1] = pipe_2d_gpu_addr(pipe, start); -+ pipe_2d_barrier(pipe); -+ pos[0] = 0x89000000; -+ pipe_2d_barrier(pipe); -+ pipe_2d_write(pipe, 0x4C00, 1); -+ -+ pipe->last_wait = new_wait; -+} -+ -+static void mwv207_pipe_2d_dump_state(struct mwv207_pipe *mpipe) -+{ -+ pr_info("%s %08x: %08x, %08x: %08x", mpipe->fname, -+ 0x4100, pipe_read(mpipe, 0x4100), -+ 0x961100, jdev_read(mpipe->jdev, 0x961100)); -+} -+ -+static struct dma_fence * -+mwv207_pipe_2d_submit(struct mwv207_pipe *mpipe, struct mwv207_job *mjob) -+{ -+ struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); -+ u32 size = ALIGN(mjob->cmd_size, 16) + 128; -+ u32 *start, *wait, *last_tail, nop_cnt; -+ struct dma_fence *fence; -+ -+ start = pipe_2d_wait_for_space(pipe, size); -+ if (!start) { -+ pr_err("mwv207: %s is stuck", mpipe->fname); -+ return ERR_PTR(-EBUSY); -+ } -+ last_tail = pipe->tail; -+ pipe->tail = start; -+ -+ -+ *pipe->tail++ = 0x80000000; -+ pipe->tail++; -+ *pipe->tail++ = 0x80000000; -+ *pipe->tail++ = 0x80000000; -+ -+ -+ memcpy_toio(pipe->tail, mjob->cmds, mjob->cmd_size); -+ pipe->tail += mjob->cmd_size >> 2; -+ for (nop_cnt = (ALIGN(mjob->cmd_size, 16) - mjob->cmd_size); -+ nop_cnt > 0; nop_cnt -= 4) -+ *pipe->tail++ = 0x80000000; -+ -+ -+ fence = pipe_2d_append_fence(pipe); -+ if (IS_ERR(fence)) { -+ pipe->tail = last_tail; -+ return fence; -+ } -+ -+ -+ wait = pipe_2d_append_wl(pipe); -+ -+ -+ BUG_ON(pipe_2d_ptr_span(pipe->tail, start) & 0xf); -+ start[1] = pipe_2d_ptr_span(pipe->tail, start) / 16 - 1; -+ -+ -+ pipe_2d_wtol(pipe, start, wait); -+ -+ BUG_ON(pipe_2d_ptr_span(pipe->tail, start) > size); -+ -+ return fence; -+} -+ -+static irqreturn_t mwv207_pipe_2d_isr(int irq_unused, void *data) -+{ -+ struct mwv207_pipe_2d *pipe = data; -+ struct pipe_2d_fence *fence, *p; -+ u32 seqno; -+ -+ pipe_2d_write(pipe, 0x4308, 0xFFFFFFFF); -+ seqno = pipe_2d_read(pipe, 0x6000); -+ -+ spin_lock(&pipe->fence_queue_lock); -+ list_for_each_entry_safe(fence, p, &pipe->fence_queue, q) { -+ if (fence16_after(fence->base.seqno & 0xffff, seqno & 0xffff)) -+ break; -+ list_del(&fence->q); -+ pipe->completed_fence = fence->base.seqno; -+ WRITE_ONCE(pipe->head, fence->rpos); -+ mwv207_devfreq_record_idle(&pipe->base); -+ dma_fence_signal(&fence->base); -+ dma_fence_put(&fence->base); -+ } -+ spin_unlock(&pipe->fence_queue_lock); -+ -+ return IRQ_HANDLED; -+} -+ -+static void mwv207_pipe_2d_destroy(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); -+ struct mwv207_bo *mbo = pipe->ring_bo; -+ int ret; -+ -+ free_irq(pipe->irq, pipe); -+ pipe_2d_stop(pipe); -+ -+ ret = mwv207_bo_reserve(mbo, true); -+ if (ret) { -+ pr_err("mwv207: failed to reserve bo"); -+ return; -+ } -+ mwv207_bo_kunmap_reserved(mbo); -+ mwv207_bo_unpin_reserved(mbo); -+ mwv207_bo_unreserve(mbo); -+ mwv207_bo_unref(mbo); -+ -+ mwv207_devfreq_unregister(mpipe); -+} -+ -+static unsigned long pipe_2d_max_freq_get(struct mwv207_device *jdev) -+{ -+ unsigned long freq; -+ -+ switch (jdev->base.pdev->subsystem_device) { -+ case 0x9103: -+ freq = 600; -+ break; -+ case 0x9210: -+ case 0x9211: -+ freq = 800; -+ break; -+ case 0x930B: -+ freq = 1000; -+ break; -+ case 0x9101: -+ case 0x9102: -+ case 0x910A: -+ case 0x910B: -+ case 0x910C: -+ case 0x9200: -+ case 0x920A: -+ case 0x920B: -+ case 0x920C: -+ case 0x9230: -+ case 0x9231: -+ case 0x930A: -+ case 0x930C: -+ freq = 1200; -+ break; -+ default: -+ freq = 0x258; -+ break; -+ } -+ -+ return freq; -+} -+ -+struct mwv207_pipe *mwv207_pipe_2d_create(struct mwv207_device *jdev, -+ int id, u32 regbase, -+ const char *fname) -+{ -+ struct mwv207_pipe_2d *pipe; -+ struct mwv207_bo *mbo; -+ void *addr; -+ int ret; -+ -+ pipe = devm_kzalloc(jdev->dev, sizeof(*pipe), GFP_KERNEL); -+ if (!pipe) -+ return NULL; -+ pipe->base.pll_id = MWV207_PLL_GU2D_PLL; -+ pipe->base.jdev = jdev; -+ pipe->base.fname = fname; -+ pipe->base.regbase = jdev->mmio + regbase; -+ pipe->base.iosize = 32 * 1024; -+ pipe->base.submit = mwv207_pipe_2d_submit; -+ pipe->base.reset = mwv207_pipe_2d_reset; -+ pipe->base.destroy = mwv207_pipe_2d_destroy; -+ pipe->base.dump_state = mwv207_pipe_2d_dump_state; -+ -+ pipe->jdev = jdev; -+ pipe->id = id; -+ pipe->fence_ctx = dma_fence_context_alloc(1); -+ INIT_LIST_HEAD(&pipe->fence_queue); -+ spin_lock_init(&pipe->fence_lock); -+ spin_lock_init(&pipe->fence_queue_lock); -+ -+ ret = mwv207_devfreq_register(&pipe->base, pipe_2d_max_freq_get(jdev)); -+ if (ret) -+ pipe->base.devfreq = NULL; -+ -+ ret = mwv207_bo_create(jdev, 0x40000, 0x1000, -+ ttm_bo_type_kernel, 0x2, -+ (1<<0), &mbo); -+ if (ret) -+ goto unregister_devfreq; -+ -+ ret = mwv207_bo_reserve(mbo, true); -+ if (ret) -+ goto free_bo; -+ ret = mwv207_bo_pin_reserved(mbo, 0x2); -+ if (ret) -+ goto unreserve_bo; -+ ret = mwv207_bo_kmap_reserved(mbo, &addr); -+ if (ret) -+ goto unpin_bo; -+ pipe->ring_bo = mbo; -+ -+ pipe->ring_start = (u32 *)addr; -+ pipe->ring_start_addr = mwv207_bo_gpu_phys(mbo); -+ pipe->ring_end = pipe->ring_start + (0x40000 >> 2); -+ -+ mwv207_pipe_2d_reset(&pipe->base); -+ -+ pipe->irq = irq_find_mapping(jdev->irq_domain, 17 + id); -+ if (pipe->irq == 0) { -+ pr_err("mwv207: failed to find %s irq mapping", fname); -+ goto unmap_bo; -+ } -+ -+ ret = request_irq(pipe->irq, mwv207_pipe_2d_isr, 0, fname, pipe); -+ if (ret) { -+ pr_err("mwv207: failed to request irq for %s", fname); -+ goto unmap_bo; -+ } -+ -+ mwv207_bo_unreserve(mbo); -+ -+ return &pipe->base; -+unmap_bo: -+ mwv207_bo_kunmap_reserved(mbo); -+unpin_bo: -+ mwv207_bo_unpin_reserved(mbo); -+unreserve_bo: -+ mwv207_bo_unreserve(mbo); -+free_bo: -+ mwv207_bo_unref(mbo); -+unregister_devfreq: -+ mwv207_devfreq_unregister(&pipe->base); -+ return NULL; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_3d.c b/drivers/gpu/drm/mwv207/mwv207_pipe_3d.c -new file mode 100644 -index 000000000..d20bac764 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_3d.c -@@ -0,0 +1,612 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207_bo.h" -+#include "mwv207_sched.h" -+#include "mwv207_vbios.h" -+#include "mwv207_devfreq.h" -+ -+ -+#define to_3d_pipe(pipe) container_of(pipe, struct mwv207_pipe_3d, base) -+struct mwv207_pipe_3d { -+ struct mwv207_pipe base; -+ struct mwv207_bo *ringbuf_bo; -+ u32 *ringbuf; -+ u32 *head; -+ u32 *tail; -+ u32 *end; -+ u32 ringbuf_gpu_addr; -+ int unit; -+ unsigned int irq; -+ -+ u64 fence_ctx; -+ u32 next_fence; -+ u32 completed_fence; -+ spinlock_t fence_lock; -+ -+ DECLARE_BITMAP(event_bitmap, 30); -+ struct dma_fence *event_fence[30]; -+ spinlock_t event_lock; -+}; -+ -+#define to_pipe_3d_fence(f) container_of(f, struct pipe_3d_fence, base) -+struct pipe_3d_fence { -+ struct dma_fence base; -+ u32 *rpos; -+ struct mwv207_pipe_3d *pipe; -+}; -+ -+static inline void pipe_3d_write(struct mwv207_pipe_3d *pipe, u32 reg, u32 value) -+{ -+ pipe_write(&pipe->base, reg, value); -+} -+ -+static inline u32 pipe_3d_read(struct mwv207_pipe_3d *pipe, u32 reg) -+{ -+ return pipe_read(&pipe->base, reg); -+} -+ -+ -+static inline bool fence_after(u32 a, u32 b) -+{ -+ return (s32)(a - b) > 0; -+} -+ -+static const char *pipe_3d_fence_get_driver_name(struct dma_fence *fence) -+{ -+ return "mwv207"; -+} -+ -+static const char *pipe_3d_fence_get_timeline_name(struct dma_fence *fence) -+{ -+ return to_pipe_3d_fence(fence)->pipe->base.fname; -+} -+ -+static bool pipe_3d_fence_signaled(struct dma_fence *fence) -+{ -+ struct pipe_3d_fence *f = to_pipe_3d_fence(fence); -+ -+ return fence_after(f->pipe->completed_fence, f->base.seqno); -+} -+ -+static void pipe_3d_fence_release(struct dma_fence *fence) -+{ -+ struct pipe_3d_fence *f = to_pipe_3d_fence(fence); -+ -+ kfree_rcu(f, base.rcu); -+} -+ -+static const struct dma_fence_ops pipe_3d_fence_ops = { -+ .get_driver_name = pipe_3d_fence_get_driver_name, -+ .get_timeline_name = pipe_3d_fence_get_timeline_name, -+ .signaled = pipe_3d_fence_signaled, -+ .release = pipe_3d_fence_release, -+}; -+ -+ -+static inline struct dma_fence *pipe_3d_event_pop_irq(struct mwv207_pipe_3d *pipe, u32 event) -+{ -+ struct dma_fence *fence; -+ -+ spin_lock(&pipe->event_lock); -+ fence = pipe->event_fence[event]; -+ pipe->event_fence[event] = NULL; -+ clear_bit(event, pipe->event_bitmap); -+ spin_unlock(&pipe->event_lock); -+ -+ return fence; -+} -+ -+ -+static inline u32 pipe_3d_event_push(struct mwv207_pipe_3d *pipe, struct dma_fence *fence) -+{ -+ u32 event; -+ -+ spin_lock_irq(&pipe->event_lock); -+ event = find_first_zero_bit(pipe->event_bitmap, 30); -+ if (likely(event < 30)) -+ pipe->event_fence[event] = dma_fence_get(fence); -+ set_bit(event, pipe->event_bitmap); -+ spin_unlock_irq(&pipe->event_lock); -+ -+ -+ BUG_ON(event >= 30); -+ -+ return event; -+} -+ -+static inline u32 pipe_3d_ptr_span(void *end, void *start) -+{ -+ return (unsigned long)end - (unsigned long)start; -+} -+ -+static inline u32 pipe_3d_gpu_addr(struct mwv207_pipe_3d *pipe, u32 *ptr) -+{ -+ return pipe->ringbuf_gpu_addr + pipe_3d_ptr_span(ptr, pipe->ringbuf); -+} -+ -+static inline void pipe_3d_link(struct mwv207_pipe_3d *pipe, u32 prefetch, u32 addr) -+{ -+ pipe->tail = PTR_ALIGN(pipe->tail, 8); -+ BUG_ON(pipe->tail >= pipe->end - 1 -+ || (((prefetch + 7) / 8) & 0xffff0000) -+ || addr & 0x7); -+ *pipe->tail++ = 0x40000000 | ((prefetch + 7) / 8); -+ *pipe->tail++ = addr; -+} -+ -+static inline void pipe_3d_wait(struct mwv207_pipe_3d *pipe) -+{ -+ pipe->tail = PTR_ALIGN(pipe->tail, 8); -+ BUG_ON(pipe->tail >= pipe->end); -+ -+ *pipe->tail++ = 0x38000000 | 200; -+} -+ -+static inline void pipe_3d_wl(struct mwv207_pipe_3d *pipe) -+{ -+ pipe_3d_wait(pipe); -+ pipe_3d_link(pipe, 16, pipe_3d_gpu_addr(pipe, pipe->tail) - 4); -+} -+ -+static inline void pipe_3d_wtol(struct mwv207_pipe_3d *pipe, u32 *w, u32 target, u32 size) -+{ -+ BUG_ON((((size + 7) / 8) & 0xffff0000) || target & 0x7 -+ || w < pipe->ringbuf || w >= pipe->end - 1); -+ w[1] = target; -+ pipe_3d_read(pipe, 0x4); -+ mb(); -+ w[0] = 0x40000000 | ((size + 7) / 8); -+} -+ -+static inline void pipe_3d_loadstate(struct mwv207_pipe_3d *pipe, u32 reg, u32 val) -+{ -+ pipe->tail = PTR_ALIGN(pipe->tail, 8); -+ BUG_ON(pipe->tail >= pipe->end - 1); -+ -+ *pipe->tail++ = 0x08010000 | reg; -+ *pipe->tail++ = val; -+} -+ -+static inline void pipe_3d_sem(struct mwv207_pipe_3d *pipe, u32 from, u32 to) -+{ -+ from &= 0x1f; -+ to &= 0x1f; -+ to <<= 8; -+ pipe_3d_loadstate(pipe, 0x0e02, from | to); -+} -+ -+static inline void pipe_3d_stall(struct mwv207_pipe_3d *pipe, u32 from, u32 to) -+{ -+ pipe->tail = PTR_ALIGN(pipe->tail, 8); -+ BUG_ON(pipe->tail >= pipe->end - 1); -+ from &= 0x1f; -+ to &= 0x1f; -+ to <<= 8; -+ *pipe->tail++ = 0x48000000; -+ *pipe->tail++ = from | to; -+} -+ -+static inline void pipe_3d_start(struct mwv207_pipe_3d *pipe) -+{ -+ u32 *start = pipe->tail; -+ u32 len; -+ -+ dev_dbg(pipe->base.jdev->dev, "start wait link at 0x%x", pipe->ringbuf_gpu_addr); -+ pipe_3d_loadstate(pipe, 0x0e21, 0x00020202); -+ pipe_3d_loadstate(pipe, 0x0e44, 0x0000000f); -+ pipe_3d_loadstate(pipe, 0x0e80, 0x00000000); -+ pipe_3d_loadstate(pipe, 0x7003, 0x00000001); -+ -+ pipe_3d_wl(pipe); -+ -+ len = (pipe->tail - start) * 4; -+ pipe_3d_write(pipe, 0x014, 0xffffffff); -+ pipe_3d_write(pipe, 0x654, pipe->ringbuf_gpu_addr); -+ pipe_3d_read(pipe, 0x4); -+ mb(); -+ pipe_3d_write(pipe, 0x658, 0x10000 | (len / 8)); -+ pipe_3d_write(pipe, 0x3a4, 0x10000 | (len / 8)); -+} -+ -+static inline int pipe_3d_stop(struct mwv207_pipe_3d *pipe) -+{ -+ pr_info("%s TBD", __func__); -+ return 0; -+} -+ -+static void pipe_3d_core_reset(struct mwv207_pipe_3d *pipe) -+{ -+ int i; -+ -+ for (i = 0; i < 2; i++) { -+ -+ pipe_3d_write(pipe, 0x104, 0); -+ -+ pipe_3d_write(pipe, 0x10c, 0x015b0880); -+ pipe_3d_write(pipe, 0x10c, 0x015b0881); -+ pipe_3d_write(pipe, 0x10c, 0x015b0880); -+ -+ pipe_3d_write(pipe, 0x000, 0x00010b00); -+ pipe_3d_write(pipe, 0x000, 0x00010900); -+ -+ usleep_range(1000, 1001); -+ -+ pipe_3d_write(pipe, 0x000, 0x00090900); -+ -+ -+ pipe_3d_write(pipe, 0x3a8, 1); -+ pipe_3d_write(pipe, 0x3a8, 0); -+ -+ -+ usleep_range(1000, 1001); -+ -+ -+ pipe_3d_write(pipe, 0x000, 0x00010900); -+ } -+} -+ -+static void pipe_3d_hw_init(struct mwv207_pipe_3d *pipe) -+{ -+ pipe_3d_write(pipe, 0x000, 0x00010900); -+ pipe_3d_core_reset(pipe); -+ -+ pipe_3d_write(pipe, 0x55c, 0x00ffffff); -+ pipe_3d_write(pipe, 0x414, 0x3c000000); -+ pipe_3d_write(pipe, 0x090, -+ pipe_3d_read(pipe, 0x090) & 0xffffffbf); -+ -+ pipe_3d_write(pipe, 0x000, 0x00010900); -+ pipe_3d_write(pipe, 0x000, 0x00070100); -+ pipe_3d_write(pipe, 0x3ac, 0x00002300); -+ pipe_3d_write(pipe, 0x3a8, 0x2); -+ -+ pipe_3d_write(pipe, 0x03c, 0xffffffff); -+ pipe_3d_write(pipe, 0x03c, 0x00000000); -+ -+ pipe_3d_write(pipe, 0x100, 0x00140021); -+ -+ -+ -+ pipe_3d_write(pipe, 0x154, 0x1); -+ pipe_3d_write(pipe, 0x104, 0x00430408); -+ pipe_3d_write(pipe, 0x10c, 0x015b0880); -+} -+ -+static void mwv207_pipe_3d_reset(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); -+ int i; -+ -+ -+ spin_lock_irq(&pipe->event_lock); -+ bitmap_zero(pipe->event_bitmap, 30); -+ for (i = 0; i < 30; i++) { -+ dma_fence_put(pipe->event_fence[i]); -+ pipe->event_fence[i] = NULL; -+ } -+ spin_unlock_irq(&pipe->event_lock); -+ -+ pipe_3d_hw_init(pipe); -+ pipe->tail = pipe->ringbuf; -+ pipe->head = pipe->ringbuf; -+ -+ pipe_3d_start(pipe); -+} -+ -+ -+static u32 *pipe_3d_wait_for_space(struct mwv207_pipe_3d *pipe, u32 size) -+{ -+ u32 *head; -+ int i; -+ -+ for (i = 0; i < 10000; ++i) { -+ head = READ_ONCE(pipe->head); -+ -+ if (head <= pipe->tail) { -+ if (pipe_3d_ptr_span(pipe->end, pipe->tail) >= size) -+ return pipe->tail; -+ if (pipe_3d_ptr_span(head, pipe->ringbuf) >= size) -+ return pipe->ringbuf; -+ } else { -+ if (pipe_3d_ptr_span(head, pipe->tail) >= size) -+ return pipe->tail; -+ } -+ usleep_range(200, 200); -+ } -+ return NULL; -+} -+ -+static struct dma_fence *mwv207_pipe_3d_submit(struct mwv207_pipe *mpipe, -+ struct mwv207_job *mjob) -+{ -+ struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); -+ struct pipe_3d_fence *fence; -+ u32 *last_tail, *start; -+ u32 size, event; -+ -+ size = ALIGN(mjob->cmd_size, 8) + 256; -+ last_tail = pipe->tail; -+ start = pipe_3d_wait_for_space(pipe, size); -+ if (start == NULL) { -+ pr_err("mwv207: engine 3d is stuck"); -+ -+ return ERR_PTR(-EBUSY); -+ } -+ memcpy_toio(start, mjob->cmds, mjob->cmd_size); -+ pipe->tail = start + mjob->cmd_size / 4; -+ -+ pipe_3d_loadstate(pipe, 0x0e03, 0xc63); -+ pipe_3d_loadstate(pipe, 0x594, 0x41); -+ -+ pipe_3d_sem(pipe, 0x7, 0x1); -+ pipe_3d_stall(pipe, 0x7, 0x1); -+ pipe_3d_loadstate(pipe, 0x502e, 0x1); -+ pipe_3d_loadstate(pipe, 0x502b, 0x3); -+ pipe_3d_sem(pipe, 0x10, 0x1); -+ pipe_3d_stall(pipe, 0x10, 0x1); -+ pipe_3d_loadstate(pipe, 0x502e, 0x0); -+ -+ -+ fence = kzalloc(sizeof(struct pipe_3d_fence), GFP_KERNEL); -+ if (!fence) { -+ pipe->tail = last_tail; -+ pr_err("mwv207: failed to alloc memory for 3d pipe"); -+ -+ return ERR_PTR(-ENOMEM); -+ } -+ dma_fence_init(&fence->base, &pipe_3d_fence_ops, &pipe->fence_lock, -+ pipe->fence_ctx, ++pipe->next_fence); -+ fence->rpos = pipe->tail; -+ fence->pipe = pipe; -+ event = pipe_3d_event_push(pipe, &fence->base); -+ -+ -+ pipe_3d_loadstate(pipe, 0x502e, 0x1); -+ pipe_3d_loadstate(pipe, 0x50ce, 0xf); -+ pipe_3d_loadstate(pipe, 0x0e01, 0x80 | event); -+ pipe_3d_loadstate(pipe, 0x502e, 0x0); -+ -+ -+ pipe_3d_wl(pipe); -+ BUG_ON(pipe_3d_ptr_span(pipe->tail, start) > size); -+ pipe_3d_wtol(pipe, last_tail - 4, pipe_3d_gpu_addr(pipe, start), -+ pipe_3d_ptr_span(pipe->tail, start)); -+ return &fence->base; -+} -+ -+static void mwv207_pipe_3d_dump_state(struct mwv207_pipe *mpipe) -+{ -+ u32 state0, addr0; -+ u32 state1, addr1; -+ int i; -+ -+ state0 = pipe_read(mpipe, 0x660); -+ addr0 = pipe_read(mpipe, 0x664); -+ for (i = 0; i < 500; ++i) { -+ state1 = pipe_read(mpipe, 0x660); -+ addr1 = pipe_read(mpipe, 0x664); -+ if (state1 != state0 || addr1 != addr0) -+ break; -+ } -+ -+ if (state1 != state0) -+ pr_info("%s state changing, s0: 0x%08x, s1: 0x%08x", mpipe->fname, state0, state1); -+ pr_info("%s current stat: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x660)); -+ -+ if (addr1 != addr0) -+ pr_info("%s addr changing, a0: 0x%08x, a1: 0x%08x", mpipe->fname, addr0, addr1); -+ pr_info("%s current addr: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x664)); -+ -+ pr_info("%s current cmdl: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x668)); -+ pr_info("%s current cmdh: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x66c)); -+} -+ -+static irqreturn_t mwv207_pipe_3d_isr(int irq_unused, void *dev_id) -+{ -+ struct mwv207_pipe_3d *pipe = dev_id; -+ struct dma_fence *fence; -+ u32 event, intr; -+ -+ intr = pipe_3d_read(pipe, 0x10); -+ if (unlikely(!intr)) { -+ pr_warn("mwv207: 3d interrupt with no event"); -+ return IRQ_NONE; -+ } -+ if (unlikely(intr & 0x80000000)) { -+ pr_warn("mwv207: 3d axi bus error"); -+ intr &= ~0x80000000; -+ } -+ if (unlikely(intr & 0x40000000)) { -+ pr_warn("mwv207: 3d mmu error"); -+ intr &= ~0x40000000; -+ } -+ while ((event = ffs(intr))) { -+ event -= 1; -+ intr &= ~(1 << event); -+ -+ fence = pipe_3d_event_pop_irq(pipe, event); -+ if (!fence) { -+ pr_warn("unexpected event: %d", event); -+ continue; -+ } -+ -+ if (fence_after(fence->seqno, pipe->completed_fence)) { -+ struct pipe_3d_fence *pipe_fence = to_pipe_3d_fence(fence); -+ -+ pipe->completed_fence = fence->seqno; -+ pipe->head = pipe_fence->rpos; -+ } -+ mwv207_devfreq_record_idle(&pipe->base); -+ dma_fence_signal(fence); -+ dma_fence_put(fence); -+ } -+ return IRQ_HANDLED; -+} -+ -+static void mwv207_pipe_3d_destroy(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); -+ struct mwv207_bo *jbo; -+ int ret; -+ -+ free_irq(pipe->irq, pipe); -+ pipe_3d_stop(pipe); -+ -+ jbo = pipe->ringbuf_bo; -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) { -+ pr_info("failed to reserve bo"); -+ return; -+ } -+ mwv207_bo_kunmap_reserved(jbo); -+ mwv207_bo_unpin_reserved(jbo); -+ mwv207_bo_unreserve(jbo); -+ mwv207_bo_unref(jbo); -+ -+ mwv207_devfreq_unregister(mpipe); -+} -+ -+static unsigned long pipe_3d_max_freq_get(struct mwv207_device *jdev) -+{ -+ unsigned long freq; -+ -+ switch (jdev->base.pdev->subsystem_device) { -+ case 0x9103: -+ freq = 600; -+ break; -+ case 0x9210: -+ case 0x9211: -+ freq = 800; -+ break; -+ case 0x9101: -+ case 0x9102: -+ case 0x910A: -+ case 0x910B: -+ case 0x910C: -+ case 0x920C: -+ case 0x930B: -+ freq = 1000; -+ break; -+ case 0x9200: -+ case 0x920A: -+ case 0x920B: -+ case 0x9230: -+ case 0x9231: -+ case 0x930A: -+ case 0x930C: -+ freq = 1200; -+ break; -+ default: -+ freq = 0x258; -+ break; -+ } -+ -+ return freq; -+} -+ -+struct mwv207_pipe *mwv207_pipe_3d_create(struct mwv207_device *jdev, int unit, u32 regbase, -+ const char *fname) -+{ -+ struct mwv207_pipe_3d *pipe; -+ struct mwv207_bo *jbo; -+ void *logical; -+ int ret; -+ -+ if (jdev->lite && unit) -+ return NULL; -+ -+ pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_3d), GFP_KERNEL); -+ if (!pipe) -+ return NULL; -+ -+ pipe->base.pll_id = unit ? MWV207_PLL_GU3D1 : MWV207_PLL_GU3D0; -+ pipe->base.jdev = jdev; -+ pipe->base.fname = fname; -+ pipe->base.regbase = jdev->mmio + regbase; -+ pipe->base.iosize = 16 * 1024; -+ pipe->base.submit = mwv207_pipe_3d_submit; -+ pipe->base.reset = mwv207_pipe_3d_reset; -+ pipe->base.destroy = mwv207_pipe_3d_destroy; -+ pipe->base.dump_state = mwv207_pipe_3d_dump_state; -+ -+ pipe->unit = unit; -+ pipe->fence_ctx = dma_fence_context_alloc(1); -+ spin_lock_init(&pipe->fence_lock); -+ spin_lock_init(&pipe->event_lock); -+ -+ ret = mwv207_devfreq_register(&pipe->base, pipe_3d_max_freq_get(jdev)); -+ if (ret) -+ pipe->base.devfreq = NULL; -+ -+ ret = mwv207_bo_create(jdev, 0x40000, 0x1000, -+ ttm_bo_type_kernel, 0x2, (1<<0), -+ &jbo); -+ if (ret) -+ goto unregister_devfreq; -+ -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) -+ goto free_bo; -+ -+ ret = mwv207_bo_pin_reserved(jbo, 0x2); -+ if (ret) -+ goto unreserve_bo; -+ -+ ret = mwv207_bo_kmap_reserved(jbo, &logical); -+ if (ret) -+ goto unpin_bo; -+ -+ pipe->ringbuf_bo = jbo; -+ -+ -+ pipe->ringbuf = (u32 *)logical; -+ pipe->ringbuf_gpu_addr = mwv207_bo_gpu_phys(jbo); -+ pipe->end = pipe->ringbuf + (0x40000 / 4); -+ -+ mwv207_pipe_3d_reset(&pipe->base); -+ -+ pipe->irq = irq_find_mapping(jdev->irq_domain, 19 + unit); -+ if (pipe->irq == 0) { -+ pr_err("mwv207: failed to create 3D irq mapping"); -+ goto unmap_bo; -+ } -+ -+ ret = request_irq(pipe->irq, mwv207_pipe_3d_isr, 0, fname, pipe); -+ if (ret) { -+ pr_err("mwv207: failed to request 3d irq"); -+ goto unmap_bo; -+ } -+ -+ mwv207_bo_unreserve(jbo); -+ return &pipe->base; -+unmap_bo: -+ mwv207_bo_kunmap_reserved(jbo); -+unpin_bo: -+ mwv207_bo_unpin_reserved(jbo); -+unreserve_bo: -+ mwv207_bo_unreserve(jbo); -+free_bo: -+ mwv207_bo_unref(pipe->ringbuf_bo); -+unregister_devfreq: -+ mwv207_devfreq_unregister(&pipe->base); -+ return NULL; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.c b/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.c -new file mode 100644 -index 000000000..ca7e8b2c6 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.c -@@ -0,0 +1,87 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_pipe_codec_common.h" -+ -+static void pipe_codec_sw_pp_submit_ex(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, -+ u64 vram, u32 reg, int nr) -+{ -+ if (sw_pp->wb_cnt >= 0x10) { -+ dev_dbg(pipe->jdev->dev, "mwv207: too much write back entry"); -+ return; -+ } -+ -+ sw_pp->wb[sw_pp->wb_cnt].vram = vram; -+ sw_pp->wb[sw_pp->wb_cnt].reg = reg; -+ sw_pp->wb[sw_pp->wb_cnt].nr = nr; -+ -+ sw_pp->wb_cnt++; -+ sw_pp->pending = true; -+} -+ -+void pipe_codec_sw_pp_reset(struct pipe_codec_sw_pp *sw_pp) -+{ -+ sw_pp->wb_cnt = 0; -+} -+ -+void pipe_codec_sw_pp_excute(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe) -+{ -+ int i, j; -+ -+ if (!sw_pp->pending) -+ return; -+ -+ for (i = 0; i < sw_pp->wb_cnt; i++) { -+ for (j = 0; j < sw_pp->wb[i].nr && sw_pp->wb[i].reg + j * 4 <= pipe->iosize - 4; j++) -+ sw_pp->wb_buf[j] = pipe_read(pipe, sw_pp->wb[i].reg + j * 4); -+ -+ if (!j) -+ continue; -+ -+ jdev_write_vram(pipe->jdev, sw_pp->wb[i].vram, &sw_pp->wb_buf[0], j * 4); -+ } -+ -+ -+ wmb(); -+ -+ sw_pp->wb_cnt = 0; -+ sw_pp->pending = false; -+} -+ -+void pipe_codec_sw_pp_submit(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, -+ struct mwv207_job *mjob, int pos, int *cmdlen) -+{ -+ int nr, reg; -+ u64 vram; -+ u32 cmd; -+ -+ *cmdlen = 16; -+ -+ if (pos + 16 > mjob->cmd_size) { -+ dev_dbg(pipe->jdev->dev, -+ "mwv207: cmd %d write back out of range", pos); -+ return; -+ } -+ -+ cmd = *(u32 *)(mjob->cmds + pos); -+ reg = (cmd & 0xffff) * 4; -+ nr = (cmd >> 16) & 0x3ff; -+ if (nr == 0) -+ nr = 1024; -+ -+ vram = *(u64 *)(mjob->cmds + pos + 8); -+ pipe_codec_sw_pp_submit_ex(sw_pp, pipe, vram, reg, nr); -+} -+ -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.h b/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.h -new file mode 100644 -index 000000000..c00b1a1c5 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_codec_common.h -@@ -0,0 +1,38 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207_sched.h" -+ -+#define MAX(a, b) ((a) > (b) ? (a) : (b)) -+ -+struct pipe_codec_wb_entry { -+ u64 vram; -+ u32 reg; -+ u32 nr; -+}; -+ -+ -+struct pipe_codec_sw_pp { -+ struct pipe_codec_wb_entry wb[0x10]; -+ u32 wb_buf[MAX(0x1F4,0x1F7)]; -+ int wb_cnt; -+ bool pending; -+}; -+ -+void pipe_codec_sw_pp_reset(struct pipe_codec_sw_pp *sw_pp); -+void pipe_codec_sw_pp_excute(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe); -+void pipe_codec_sw_pp_submit(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, -+ struct mwv207_job *mjob, int pos, int *cmdlen); -+ -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_dec.c b/drivers/gpu/drm/mwv207/mwv207_pipe_dec.c -new file mode 100644 -index 000000000..e5f94fc71 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_dec.c -@@ -0,0 +1,264 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include "mwv207_pipe_codec_common.h" -+ -+#define to_dec_pipe(pipe) container_of(pipe, struct mwv207_pipe_dec, base) -+struct pipe_dec_fence; -+struct mwv207_pipe_dec { -+ struct mwv207_pipe base; -+ -+ u64 fence_ctx; -+ u64 fence_seqno; -+ spinlock_t fence_lock; -+ -+ struct pipe_dec_fence *current_fence; -+ struct task_struct *poll_thread; -+ struct pipe_codec_sw_pp sw_pp; -+}; -+ -+#define to_pipe_dec_fence(f) container_of(f, struct pipe_dec_fence, base) -+struct pipe_dec_fence { -+ struct dma_fence base; -+ struct mwv207_pipe_dec *pipe; -+ struct list_head node; -+}; -+ -+static inline void pipe_dec_write(struct mwv207_pipe_dec *pipe, u32 reg, u32 value) -+{ -+ pipe_write(&pipe->base, reg, value); -+} -+ -+static inline u32 pipe_dec_read(struct mwv207_pipe_dec *pipe, u32 reg) -+{ -+ return pipe_read(&pipe->base, reg); -+} -+ -+static const char *pipe_dec_fence_get_driver_name(struct dma_fence *fence) -+{ -+ return "mwv207"; -+} -+ -+static const char *pipe_dec_fence_get_timeline_name(struct dma_fence *fence) -+{ -+ return to_pipe_dec_fence(fence)->pipe->base.fname; -+} -+ -+static void pipe_dec_fence_release(struct dma_fence *fence) -+{ -+ struct pipe_dec_fence *f = to_pipe_dec_fence(fence); -+ -+ kfree_rcu(f, base.rcu); -+} -+ -+static const struct dma_fence_ops pipe_dec_fence_ops = { -+ .get_driver_name = pipe_dec_fence_get_driver_name, -+ .get_timeline_name = pipe_dec_fence_get_timeline_name, -+ .release = pipe_dec_fence_release, -+}; -+ -+static void pipe_dec_stat_reset(struct mwv207_pipe_dec *pipe, u32 stat) -+{ -+ pipe_dec_write(pipe, 0x4, 0x0); -+} -+ -+static int pipe_dec_polling(void *priv) -+{ -+ struct mwv207_pipe_dec *pipe = priv; -+ struct pipe_dec_fence *fence; -+ u32 stat; -+ -+ set_freezable(); -+ while (!kthread_should_stop()) { -+ usleep_range(1000, 1001); -+ try_to_freeze(); -+ -+ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence == NULL) -+ continue; -+ -+ stat = pipe_dec_read(pipe, 0x4); -+ if ((stat & 0x1100) != 0x1100) -+ continue; -+ -+ pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); -+ pipe_dec_stat_reset(pipe, stat); -+ -+ -+ smp_store_release(&pipe->current_fence, NULL); -+ -+ dma_fence_signal(&fence->base); -+ dma_fence_put(&fence->base); -+ } -+ -+ return 0; -+} -+ -+static void mwv207_pipe_dec_reset(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); -+ struct pipe_dec_fence *fence; -+ u32 stat; -+ int i; -+ -+ pipe_codec_sw_pp_reset(&pipe->sw_pp); -+ -+ stat = pipe_dec_read(pipe, 0x4); -+ if (stat & 0x1) -+ pipe_dec_write(pipe, 0x4, -+ 0x20 | 0x30); -+ -+ pipe_dec_write(pipe, 0x4, 0); -+ pipe_dec_write(pipe, 0x8, 0x454); -+ -+ -+ for (i = 12; i < pipe->base.iosize; i += 0x4) -+ pipe_dec_write(pipe, i, 0); -+ -+ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence) { -+ dma_fence_put(&fence->base); -+ -+ smp_store_release(&pipe->current_fence, NULL); -+ } -+} -+ -+static struct dma_fence *mwv207_pipe_dec_submit(struct mwv207_pipe *mpipe, -+ struct mwv207_job *mjob) -+{ -+ struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); -+ struct pipe_dec_fence *fence; -+ int i, nr, pos, cmdlen; -+ bool hw_run = 0; -+ u32 cmd, reg; -+ -+ /* sanity check, there should be no previous job. -+ * acquire pairs with release in polling thread -+ */ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence) -+ return ERR_PTR(-EBUSY); -+ -+ -+ for (pos = 0; pos <= mjob->cmd_size - 4; pos += cmdlen) { -+ cmd = *(u32 *)(mjob->cmds + pos); -+ switch ((cmd >> 27) & 0x1f) { -+ case 0x01: -+ if ((cmd >> 26) & 0x1) -+ return ERR_PTR(-EINVAL); -+ reg = (cmd & 0xffff) * 4; -+ nr = (cmd >> 16) & 0x3ff; -+ if (nr == 0) -+ nr = 1024; -+ for (i = pos + 4; i <= pos + nr * 4 -+ && i <= mjob->cmd_size - 4 -+ && reg <= pipe->base.iosize - 4; -+ i += 4, reg += 4) { -+ if (reg == 4) { -+ pipe_dec_read(pipe, 0x4); -+ hw_run = (*(u32 *)(mjob->cmds + i)) & 0x1; -+ -+ mb(); -+ } -+ pipe_dec_write(pipe, reg, *(u32 *)(mjob->cmds + i)); -+ } -+ -+ if (i <= pos + nr * 4) -+ dev_dbg(mpipe->jdev->dev, -+ "mwv207: invalid dec register writes dropped"); -+ -+ cmdlen = ALIGN(4 + nr * 4, 8); -+ break; -+ case 0x02: -+ pipe_codec_sw_pp_submit(&pipe->sw_pp, &pipe->base, mjob, pos, &cmdlen); -+ break; -+ default: -+ -+ return ERR_PTR(-EINVAL); -+ } -+ } -+ -+ -+ fence = kzalloc(sizeof(struct pipe_dec_fence), GFP_KERNEL); -+ if (!fence) -+ return ERR_PTR(-ENOMEM); -+ fence->pipe = pipe; -+ dma_fence_init(&fence->base, &pipe_dec_fence_ops, &pipe->fence_lock, -+ pipe->fence_ctx, ++pipe->fence_seqno); -+ -+ if (hw_run) { -+ dma_fence_get(&fence->base); -+ -+ smp_store_release(&pipe->current_fence, fence); -+ } else { -+ pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); -+ dma_fence_signal(&fence->base); -+ } -+ -+ return &fence->base; -+} -+ -+static void mwv207_pipe_dec_dump_state(struct mwv207_pipe *mpipe) -+{ -+ pr_info("%s irq state reg: 0x%08x", mpipe->fname, -+ pipe_read(mpipe, 0x4)); -+} -+ -+static void mwv207_pipe_dec_destroy(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); -+ -+ kthread_stop(pipe->poll_thread); -+} -+ -+struct mwv207_pipe *mwv207_pipe_dec_create(struct mwv207_device *jdev, int unit, u32 regbase, -+ const char *fname) -+{ -+ struct mwv207_pipe_dec *pipe; -+ -+ if (jdev->lite && unit) -+ return NULL; -+ -+ pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_dec), GFP_KERNEL); -+ if (!pipe) -+ return NULL; -+ -+ pipe->base.jdev = jdev; -+ pipe->base.fname = fname; -+ pipe->base.regbase = jdev->mmio + regbase; -+ pipe->base.iosize = 0x1F7 * 4; -+ pipe->base.submit = mwv207_pipe_dec_submit; -+ pipe->base.reset = mwv207_pipe_dec_reset; -+ pipe->base.destroy = mwv207_pipe_dec_destroy; -+ pipe->base.dump_state = mwv207_pipe_dec_dump_state; -+ -+ spin_lock_init(&pipe->fence_lock); -+ pipe->fence_ctx = dma_fence_context_alloc(1); -+ pipe->fence_seqno = 0; -+ -+ mwv207_pipe_dec_reset(&pipe->base); -+ -+ pipe->poll_thread = kthread_run(pipe_dec_polling, pipe, "dec_polling"); -+ if (IS_ERR(pipe->poll_thread)) -+ return NULL; -+ -+ return &pipe->base; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_dma.c b/drivers/gpu/drm/mwv207/mwv207_pipe_dma.c -new file mode 100644 -index 000000000..3729aeb01 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_dma.c -@@ -0,0 +1,416 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include "mwv207_bo.h" -+#include "mwv207_sched.h" -+ -+#undef MWV207_DMA_DEBUG -+ -+ -+#define DMA_TS_ALIGNED(size, alignment) (((size) >= (alignment)) ? ((size) / (alignment) - 1) : 0) -+#define DMA_CTL_NOT_ALIGNED ((1UL<<(63)) \ -+ | (1UL<<(58)) \ -+ | (1UL<<(30)) \ -+ | (1UL<<(38)) \ -+ | (1UL<<(47)) \ -+ | ((32ul & (0xFF))<<(39)) \ -+ | ((32ul & (0xFF))<<(48)) \ -+ | ((0UL & (0x7))<<(8)) \ -+ | ((0UL & (0x7))<<(11))) -+ -+#define DMA_CTL_ALIGNED(a) ((1UL<<(63)) \ -+ | (1UL<<(58)) \ -+ | (1UL<<(30)) \ -+ | (1UL<<(38)) \ -+ | (1UL<<(47)) \ -+ | ((32ul & (0xFF))<<(39)) \ -+ | ((32ul & (0xFF))<<(48)) \ -+ | (((((a) == 64)?6UL:5UL) & (0x7))<<(8)) \ -+ | (((((a) == 64)?6UL:5UL) & (0x7))<<(11))) -+ -+#define mwv207_timed_loop(tick, cond, timeout) \ -+ for ((tick) = jiffies; (cond) && time_before(jiffies, (tick) + msecs_to_jiffies(timeout));) -+ -+struct mwv207_lli { -+ u64 sar; -+ u64 dar; -+ u32 ts; -+ u32 resv1; -+ u64 llp; -+ u64 ctl; -+ u32 sstat; -+ u32 dstat; -+ u64 llpstat; -+ u32 resv2; -+ u32 resv3; -+}; -+ -+#define to_dma_pipe(pipe) container_of(pipe, struct mwv207_pipe_dma, base) -+struct mwv207_pipe_dma { -+ struct mwv207_pipe base; -+ int unit; -+ u32 alignment; -+ struct mwv207_lli *lli; -+ struct mwv207_lli *last_lli; -+ dma_addr_t lli_bus_addr; -+ int cur_idx; -+ -+ bool coherent; -+}; -+ -+struct mwv207_dma_cursor { -+ bool is_vram; -+ u64 line_pos; -+ u64 cur_pos; -+ -+ -+ dma_addr_t *dma_address; -+ u64 nr_pages; -+ -+ u64 width; -+ u64 stride; -+}; -+static inline void pipe_dma_write(struct mwv207_pipe_dma *pipe, u32 reg, u32 value) -+{ -+ pipe_write(&pipe->base, reg, value); -+} -+ -+static inline u32 pipe_dma_read(struct mwv207_pipe_dma *pipe, u32 reg) -+{ -+ return pipe_read(&pipe->base, reg); -+} -+ -+static inline void pipe_dma_chan_write(struct mwv207_pipe_dma *pipe, int chan, u32 reg, u32 val) -+{ -+ pipe_dma_write(pipe, chan * 0x200 + reg, val); -+} -+ -+static inline u32 pipe_dma_chan_read(struct mwv207_pipe_dma *pipe, int chan, u32 reg) -+{ -+ return pipe_dma_read(pipe, chan * 0x200 + reg); -+} -+ -+static inline int pipe_dma_chan_done(struct mwv207_pipe_dma *pipe, int chan) -+{ -+ u32 status; -+ -+ if (pipe->last_lli->ctl & (1UL << (63))) -+ return 0; -+ -+ status = pipe_dma_chan_read(pipe, chan, (0x188)); -+ return !!(status & (1 << (1))); -+} -+ -+static inline void pipe_dma_chan_clear(struct mwv207_pipe_dma *pipe, int chan) -+{ -+ pipe_dma_chan_write(pipe, chan, (0x198), 1 << (1)); -+} -+ -+static inline int pipe_dma_stop(struct mwv207_pipe_dma *pipe) -+{ -+ pr_info("%s TBD", __func__); -+ return 0; -+} -+ -+static void mwv207_pipe_dma_reset(struct mwv207_pipe *mpipe) -+{ -+ pr_info("%s todo", __func__); -+} -+ -+static void pipe_dma_commit(struct mwv207_pipe_dma *pipe) -+{ -+ unsigned long tick; -+ int chan = 0; -+ u64 llp; -+ -+ if (pipe->cur_idx == 0) -+ return; -+ -+ pipe->last_lli = &pipe->lli[pipe->cur_idx - 1]; -+ pipe->last_lli->ctl |= (1UL << (62)); -+ -+ -+ mb(); -+ -+ -+ pipe_dma_chan_write(pipe, chan, (0x120), -+ ((0x3)<<(2)) -+ |((0x3)<<(0))); -+ pipe_dma_chan_write(pipe, chan, (0x124), 0x3b8e0000); -+ -+ -+ llp = pipe->lli_bus_addr + 0x800000000ULL; -+ pipe_dma_chan_write(pipe, chan, (0x128), llp & 0xFFFFFFFF); -+ pipe_dma_chan_write(pipe, chan, (0x12C), llp >> 32); -+ -+ -+ pipe_dma_write(pipe, (0x10), -+ (1 << (1)) -+ |(1 << (0))); -+ -+ -+ pipe_dma_write(pipe, (0x18), -+ ((1<cur_idx = 0; -+} -+ -+static void pipe_dma_fill_lli(struct mwv207_pipe_dma *pipe, u64 src, u64 dst, u64 len) -+{ -+ struct mwv207_lli *lli; -+ -+ if (pipe->cur_idx >= (0x400000 / sizeof(struct mwv207_lli))) -+ pipe_dma_commit(pipe); -+ -+ lli = &pipe->lli[pipe->cur_idx]; -+ lli->sar = src; -+ lli->dar = dst; -+ -+ if (IS_ALIGNED(src, pipe->alignment) && -+ IS_ALIGNED(dst, pipe->alignment) && -+ IS_ALIGNED(len, pipe->alignment)) { -+ lli->ts = DMA_TS_ALIGNED(len, pipe->alignment); -+ lli->ctl = DMA_CTL_ALIGNED(pipe->alignment); -+ } else { -+ lli->ts = ((len) - 1); -+ lli->ctl = DMA_CTL_NOT_ALIGNED; -+ } -+ -+#ifdef MWV207_DMA_DEBUG -+ { -+ pr_info("[dma]: lli[%04d] sar = 0x%010llx", pipe->cur_idx, lli->sar); -+ pr_info("[dma]: lli[%04d] dar = 0x%010llx", pipe->cur_idx, lli->dar); -+ pr_info("[dma]: lli[%04d] ts = 0x%08x", pipe->cur_idx, lli->ts); -+ pr_info("[dma]: lli[%04d] llp = 0x%010llx", pipe->cur_idx, lli->llp); -+ pr_info("[dma]: lli[%04d] ctl = 0x%010llx", pipe->cur_idx, lli->ctl); -+ } -+#endif -+ pipe->cur_idx++; -+} -+ -+static void mwv207_cursor_init(struct mwv207_dma_cursor *cursor, struct mwv207_dma_loc *loc, -+ u64 width, u64 stride) -+{ -+ cursor->width = width; -+ cursor->stride = stride; -+ cursor->is_vram = (((loc->pg_nr_type) >> 63) == 0); -+ if (cursor->is_vram) { -+ cursor->line_pos = loc->base + loc->offset; -+ cursor->cur_pos = cursor->line_pos; -+ cursor->dma_address = NULL; -+ cursor->nr_pages = ((loc->pg_nr_type) & ~(1ULL << 63)); -+ } else { -+ cursor->line_pos = loc->offset; -+ cursor->cur_pos = cursor->line_pos; -+ cursor->dma_address = (dma_addr_t *)loc->base; -+ cursor->nr_pages = ((loc->pg_nr_type) & ~(1ULL << 63)); -+ } -+} -+ -+static void mwv207_cursor_reset(struct mwv207_dma_cursor *cursor, struct mwv207_dma_loc *loc) -+{ -+ if (cursor->is_vram) { -+ cursor->line_pos = loc->base + loc->offset; -+ cursor->cur_pos = cursor->line_pos; -+ } else { -+ cursor->line_pos = loc->offset; -+ cursor->cur_pos = cursor->line_pos; -+ } -+} -+ -+static inline u64 cursor_seg_len(struct mwv207_dma_cursor *cursor) -+{ -+ u64 len = cursor->line_pos + cursor->width - cursor->cur_pos; -+ u64 offset, idx, contig_len; -+ -+ if (cursor->is_vram) -+ return len; -+ offset = cursor->cur_pos & (PAGE_SIZE - 1); -+ idx = cursor->cur_pos >> PAGE_SHIFT; -+ -+ contig_len = PAGE_SIZE - offset; -+ while (contig_len < len && -+ idx + 1 < cursor->nr_pages && -+ cursor->dma_address[idx] + PAGE_SIZE == cursor->dma_address[idx + 1]) { -+ contig_len += PAGE_SIZE; -+ idx++; -+ } -+ return min_t(u64, len, contig_len); -+} -+ -+static inline u64 cursor_axi(struct mwv207_dma_cursor *cursor) -+{ -+ u64 idx, offset; -+ -+ if (cursor->is_vram) -+ return cursor->cur_pos; -+ -+ idx = cursor->cur_pos >> PAGE_SHIFT; -+ offset = cursor->cur_pos & (PAGE_SIZE - 1); -+ return 0x800000000ULL + cursor->dma_address[idx] + offset; -+} -+ -+static inline void cursor_advance(struct mwv207_dma_cursor *cursor, u64 len) -+{ -+ BUG_ON(cursor->cur_pos + len > cursor->line_pos + cursor->width); -+ -+ if (cursor->cur_pos + len == cursor->line_pos + cursor->width) { -+ cursor->line_pos += cursor->stride; -+ cursor->cur_pos = cursor->line_pos; -+ } else -+ cursor->cur_pos += len; -+} -+ -+static void pipe_dma_flush(struct mwv207_pipe_dma *pipe, -+ struct mwv207_dma_cursor *cursor, u64 size) -+{ -+ u64 remain, len; -+ -+ if (cursor->is_vram || pipe->coherent) -+ return; -+ -+ for (remain = size; remain > 0; remain -= len) { -+ len = min_t(u64, cursor_seg_len(cursor), remain); -+ dma_sync_single_for_device(pipe->base.jdev->dev, -+ cursor_axi(cursor) - 0x800000000ULL, -+ len, DMA_TO_DEVICE); -+ cursor_advance(cursor, len); -+ } -+} -+ -+static void pipe_dma_invalidate(struct mwv207_pipe_dma *pipe, -+ struct mwv207_dma_cursor *cursor, u64 size) -+{ -+ u64 remain, len; -+ -+ if (cursor->is_vram || pipe->coherent) -+ return; -+ -+ for (remain = size; remain > 0; remain -= len) { -+ len = min_t(u64, cursor_seg_len(cursor), remain); -+ dma_sync_single_for_cpu(pipe->base.jdev->dev, -+ cursor_axi(cursor) - 0x800000000ULL, -+ len, DMA_FROM_DEVICE); -+ cursor_advance(cursor, len); -+ } -+} -+ -+static struct dma_fence *mwv207_pipe_dma_submit(struct mwv207_pipe *mpipe, -+ struct mwv207_job *mjob) -+{ -+ struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); -+ struct mwv207_dma_cmd *cmd = (struct mwv207_dma_cmd *)mjob->cmds; -+ struct mwv207_dma_cursor src, dst; -+ u64 remain, len; -+ -+ BUG_ON(mjob->cmd_size != sizeof(struct mwv207_dma_cmd)); -+ -+ -+ mwv207_cursor_init(&src, &cmd->src, cmd->width, cmd->src.stride); -+ pipe_dma_flush(pipe, &src, cmd->width * cmd->height); -+ -+ mwv207_cursor_reset(&src, &cmd->src); -+ mwv207_cursor_init(&dst, &cmd->dst, cmd->width, cmd->dst.stride); -+ for (remain = cmd->width * cmd->height; remain > 0; remain -= len) { -+ len = min_t(u64, cursor_seg_len(&src), 0x400000); -+ len = min_t(u64, cursor_seg_len(&dst), len); -+ len = min_t(u64, len, remain); -+ -+ pipe_dma_fill_lli(pipe, cursor_axi(&src), cursor_axi(&dst), len); -+ -+ cursor_advance(&src, len); -+ cursor_advance(&dst, len); -+ } -+ pipe_dma_commit(pipe); -+ -+ -+ mwv207_cursor_reset(&dst, &cmd->dst); -+ pipe_dma_invalidate(pipe, &dst, cmd->width * cmd->height); -+ -+ return dma_fence_get_stub(); -+} -+ -+static void mwv207_pipe_dma_dump_state(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); -+ pr_info("%s todo: %p", __func__, pipe); -+} -+ -+static void mwv207_pipe_dma_destroy(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); -+ -+ pr_info("%s todo: %p", __func__, pipe); -+} -+ -+struct mwv207_pipe *mwv207_pipe_dma_create(struct mwv207_device *jdev, int unit, u32 regbase, -+ const char *fname) -+{ -+ struct mwv207_pipe_dma *pipe; -+ u64 llp; -+ int i; -+ -+ pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_dma), GFP_KERNEL); -+ if (!pipe) -+ return NULL; -+ -+ pipe->base.jdev = jdev; -+ pipe->base.fname = fname; -+ pipe->base.regbase = jdev->mmio + regbase; -+ pipe->base.iosize = 16 * 1024; -+ pipe->base.submit = mwv207_pipe_dma_submit; -+ pipe->base.reset = mwv207_pipe_dma_reset; -+ pipe->base.destroy = mwv207_pipe_dma_destroy; -+ pipe->base.dump_state = mwv207_pipe_dma_dump_state; -+ -+ pipe->coherent = true; -+ -+ pipe->alignment = jdev->lite ? 32 : 64; -+ pipe->unit = unit; -+ -+ pipe->lli = dmam_alloc_coherent(jdev->dev, -+ sizeof(struct mwv207_lli) * (0x400000 / sizeof(struct mwv207_lli)), -+ &pipe->lli_bus_addr, GFP_KERNEL); -+ if (!pipe->lli) -+ return NULL; -+ -+ memset(pipe->lli, 0, sizeof(struct mwv207_lli) * (0x400000 / sizeof(struct mwv207_lli))); -+ llp = pipe->lli_bus_addr + 0x800000000ULL; -+ for (i = 0; i < (0x400000 / sizeof(struct mwv207_lli)); i++) { -+ llp += sizeof(struct mwv207_lli); -+ pipe->lli[i].llp = llp; -+ } -+ pipe->cur_idx = 0; -+ -+ mwv207_pipe_dma_reset(&pipe->base); -+ return &pipe->base; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_pipe_enc.c b/drivers/gpu/drm/mwv207/mwv207_pipe_enc.c -new file mode 100644 -index 000000000..2978bcdcd ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_pipe_enc.c -@@ -0,0 +1,266 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include "mwv207_pipe_codec_common.h" -+ -+#define JPIPE_STATUS_ALL \ -+ (0x1000 | 0x200 | \ -+ 0x100 | 0x080 | \ -+ 0x040 | 0x020 | \ -+ 0x010 | 0x008 | 0x004) -+ -+#define to_enc_pipe(pipe) container_of(pipe, struct mwv207_pipe_enc, base) -+struct pipe_enc_fence; -+struct mwv207_pipe_enc { -+ struct mwv207_pipe base; -+ -+ u64 fence_ctx; -+ u64 fence_seqno; -+ spinlock_t fence_lock; -+ -+ struct pipe_enc_fence *current_fence; -+ struct task_struct *poll_thread; -+ struct pipe_codec_sw_pp sw_pp; -+}; -+ -+#define to_pipe_enc_fence(f) container_of(f, struct pipe_enc_fence, base) -+struct pipe_enc_fence { -+ struct dma_fence base; -+ struct mwv207_pipe_enc *pipe; -+ struct list_head node; -+}; -+ -+static inline void pipe_enc_write(struct mwv207_pipe_enc *pipe, u32 reg, u32 value) -+{ -+ pipe_write(&pipe->base, reg, value); -+} -+ -+static inline u32 pipe_enc_read(struct mwv207_pipe_enc *pipe, u32 reg) -+{ -+ return pipe_read(&pipe->base, reg); -+} -+ -+static const char *pipe_enc_fence_get_driver_name(struct dma_fence *fence) -+{ -+ return "mwv207"; -+} -+ -+static const char *pipe_enc_fence_get_timeline_name(struct dma_fence *fence) -+{ -+ return to_pipe_enc_fence(fence)->pipe->base.fname; -+} -+ -+static void pipe_enc_fence_release(struct dma_fence *fence) -+{ -+ struct pipe_enc_fence *f = to_pipe_enc_fence(fence); -+ -+ kfree_rcu(f, base.rcu); -+} -+ -+static const struct dma_fence_ops pipe_enc_fence_ops = { -+ .get_driver_name = pipe_enc_fence_get_driver_name, -+ .get_timeline_name = pipe_enc_fence_get_timeline_name, -+ .release = pipe_enc_fence_release, -+}; -+ -+static void pipe_enc_stat_reset(struct mwv207_pipe_enc *pipe, u32 stat) -+{ -+ if (stat & 0x20) -+ pipe_enc_write(pipe, 0x14, 0); -+ -+ pipe_enc_write(pipe, 0x4, stat & (~0x1FD)); -+} -+ -+static int pipe_enc_polling(void *priv) -+{ -+ struct mwv207_pipe_enc *pipe = priv; -+ struct pipe_enc_fence *fence; -+ u32 stat; -+ -+ set_freezable(); -+ while (!kthread_should_stop()) { -+ usleep_range(1000, 1001); -+ try_to_freeze(); -+ -+ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence == NULL) -+ continue; -+ -+ stat = pipe_enc_read(pipe, 0x4); -+ if (!(stat & JPIPE_STATUS_ALL)) -+ continue; -+ -+ pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); -+ pipe_enc_stat_reset(pipe, stat); -+ -+ -+ smp_store_release(&pipe->current_fence, NULL); -+ -+ dma_fence_signal(&fence->base); -+ dma_fence_put(&fence->base); -+ } -+ -+ return 0; -+} -+ -+static void mwv207_pipe_enc_reset(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); -+ struct pipe_enc_fence *fence; -+ int i; -+ -+ pipe_codec_sw_pp_reset(&pipe->sw_pp); -+ -+ pipe_enc_write(pipe, 0x14, 0); -+ -+ -+ for (i = 4; i < pipe->base.iosize; i += 0x4) -+ pipe_enc_write(pipe, i, 0); -+ -+ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence) { -+ dma_fence_put(&fence->base); -+ -+ smp_store_release(&pipe->current_fence, NULL); -+ } -+} -+ -+static struct dma_fence *mwv207_pipe_enc_submit(struct mwv207_pipe *mpipe, -+ struct mwv207_job *mjob) -+{ -+ struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); -+ struct pipe_enc_fence *fence; -+ int i, nr, pos, cmdlen; -+ bool hw_run = 0; -+ u32 cmd, reg; -+ -+ /* sanity check, there should be no previous job. -+ * acquire pairs with release in polling thread -+ */ -+ fence = smp_load_acquire(&pipe->current_fence); -+ if (fence) -+ return ERR_PTR(-EBUSY); -+ -+ -+ for (pos = 0; pos <= mjob->cmd_size - 4; pos += cmdlen) { -+ cmd = *(u32 *)(mjob->cmds + pos); -+ switch ((cmd >> 27) & 0x1f) { -+ case 0x01: -+ if ((cmd >> 26) & 0x1) -+ return ERR_PTR(-EINVAL); -+ reg = (cmd & 0xffff) * 4; -+ nr = (cmd >> 16) & 0x3ff; -+ if (nr == 0) -+ nr = 1024; -+ for (i = pos + 4; i <= pos + nr * 4 -+ && i <= mjob->cmd_size - 4 -+ && reg <= pipe->base.iosize - 4; -+ i += 4, reg += 4) { -+ if (reg == 20) { -+ pipe_enc_read(pipe, 0x14); -+ hw_run = (*(u32 *)(mjob->cmds + i)) & 0x1; -+ -+ mb(); -+ } -+ pipe_enc_write(pipe, reg, *(u32 *)(mjob->cmds + i)); -+ } -+ -+ if (i <= pos + nr * 4) -+ dev_dbg(mpipe->jdev->dev, -+ "mwv207: invalid enc register writes dropped"); -+ -+ cmdlen = ALIGN(4 + nr * 4, 8); -+ break; -+ case 0x02: -+ pipe_codec_sw_pp_submit(&pipe->sw_pp, &pipe->base, mjob, pos, &cmdlen); -+ break; -+ default: -+ -+ return ERR_PTR(-EINVAL); -+ } -+ } -+ -+ -+ fence = kzalloc(sizeof(struct pipe_enc_fence), GFP_KERNEL); -+ if (!fence) -+ return ERR_PTR(-ENOMEM); -+ fence->pipe = pipe; -+ dma_fence_init(&fence->base, &pipe_enc_fence_ops, &pipe->fence_lock, -+ pipe->fence_ctx, ++pipe->fence_seqno); -+ -+ if (hw_run) { -+ dma_fence_get(&fence->base); -+ -+ smp_store_release(&pipe->current_fence, fence); -+ } else { -+ pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); -+ dma_fence_signal(&fence->base); -+ } -+ -+ return &fence->base; -+} -+ -+static void mwv207_pipe_enc_dump_state(struct mwv207_pipe *mpipe) -+{ -+ pr_info("%s irq state reg: 0x%08x", mpipe->fname, -+ pipe_read(mpipe, 0x4)); -+} -+ -+static void mwv207_pipe_enc_destroy(struct mwv207_pipe *mpipe) -+{ -+ struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); -+ -+ kthread_stop(pipe->poll_thread); -+} -+ -+struct mwv207_pipe *mwv207_pipe_enc_create(struct mwv207_device *jdev, u32 regbase, -+ const char *fname) -+{ -+ struct mwv207_pipe_enc *pipe; -+ -+ if (jdev->lite) -+ return NULL; -+ -+ pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_enc), GFP_KERNEL); -+ if (!pipe) -+ return NULL; -+ -+ pipe->base.jdev = jdev; -+ pipe->base.fname = fname; -+ pipe->base.regbase = jdev->mmio + regbase; -+ pipe->base.iosize = 0x1F4 * 4; -+ pipe->base.submit = mwv207_pipe_enc_submit; -+ pipe->base.reset = mwv207_pipe_enc_reset; -+ pipe->base.destroy = mwv207_pipe_enc_destroy; -+ pipe->base.dump_state = mwv207_pipe_enc_dump_state; -+ -+ spin_lock_init(&pipe->fence_lock); -+ pipe->fence_ctx = dma_fence_context_alloc(1); -+ pipe->fence_seqno = 0; -+ -+ mwv207_pipe_enc_reset(&pipe->base); -+ -+ pipe->poll_thread = kthread_run(pipe_enc_polling, pipe, "enc_polling"); -+ if (IS_ERR(pipe->poll_thread)) -+ return NULL; -+ -+ return &pipe->base; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_sched.c b/drivers/gpu/drm/mwv207/mwv207_sched.c -new file mode 100644 -index 000000000..890dd2856 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_sched.c -@@ -0,0 +1,378 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include "mwv207.h" -+#include "mwv207_sched.h" -+#include "mwv207_bo.h" -+#include "mwv207_ctx.h" -+#include "mwv207_db.h" -+#include "mwv207_devfreq.h" -+ -+static int dump_hang_job = 1; -+module_param(dump_hang_job, int, 0644); -+MODULE_PARM_DESC(dump_hang_job, "dump time out job"); -+ -+struct mwv207_job *mwv207_job_alloc(void) -+{ -+ struct mwv207_job *mjob; -+ -+ mjob = kzalloc(sizeof(*mjob), GFP_KERNEL); -+ if (!mjob) -+ return NULL; -+ -+ kref_init(&mjob->refcount); -+ INIT_LIST_HEAD(&mjob->tvblist); -+ return mjob; -+} -+ -+static void mwv207_job_fini(struct kref *kref) -+{ -+ struct mwv207_job *mjob = container_of(kref, struct mwv207_job, refcount); -+ struct mwv207_tvb *mtvb; -+ struct mwv207_submit_cmd_dat *dat; -+ int i; -+ -+ dma_fence_put(mjob->fence_in); -+ if (mjob->base.s_fence) -+ drm_sched_job_cleanup(&mjob->base); -+ -+ -+ mwv207_for_each_mtvb(mtvb, mjob) { -+ for (i = 0; i < mtvb->nr_shared; ++i) -+ dma_fence_put(mtvb->shared[i]); -+ dma_fence_put(mtvb->excl); -+ kfree(mtvb->shared); -+ mwv207_bo_unref(to_jbo(mtvb->base.bo)); -+ } -+ -+ if (mjob->nr_cmd_dat) { -+ for (i = 0; i < mjob->nr_cmd_dat; ++i) { -+ dat = &mjob->cmd_dats[i]; -+ kvfree(dat->dat); -+ kvfree(dat->relocs); -+ mwv207_bo_unref(dat->jbo); -+ } -+ } -+ -+ if (mjob->ctx) -+ mwv207_ctx_put(mjob->ctx); -+ -+ kvfree(mjob->cmd_dats); -+ kvfree(mjob->mtvb); -+ kvfree(mjob->relocs); -+ kvfree(mjob->cmds); -+ -+ kfree(mjob); -+} -+ -+struct mwv207_job *mwv207_job_get(struct mwv207_job *mjob) -+{ -+ kref_get(&mjob->refcount); -+ return mjob; -+} -+ -+void mwv207_job_put(struct mwv207_job *mjob) -+{ -+ kref_put(&mjob->refcount, mwv207_job_fini); -+} -+ -+static void mwv207_sched_dump_job(struct mwv207_job *mjob) -+{ -+ int lines, i; -+ u32 *cmd; -+ -+ cmd = (u32 *)mjob->cmds; -+ lines = (mjob->cmd_size / 4) & ~0x3; -+ for (i = 0; i < lines; i += 4) { -+ pr_info("0x%08x : %08x %08x %08x %08x", i, -+ cmd[i], cmd[i+1], cmd[i+2], cmd[i+3]); -+ } -+ -+ switch (mjob->cmd_size / 4 - lines) { -+ case 0: -+ return; -+ case 1: -+ pr_info("0x%08x : %08x", i, cmd[i]); -+ break; -+ case 2: -+ pr_info("0x%08x : %08x %08x", i, cmd[i], cmd[i+1]); -+ break; -+ case 3: -+ pr_info("0x%08x : %08x %08x %08x", i, -+ cmd[i], cmd[i+1], cmd[i+2]); -+ break; -+ default: -+ pr_err("should never happen"); -+ break; -+ -+ } -+} -+ -+static struct dma_fence *mwv207_sched_dependency(struct drm_sched_job *job, -+ struct drm_sched_entity *entity) -+{ -+ struct mwv207_job *mjob = to_mwv207_job(job); -+ struct mwv207_tvb *mtvb; -+ struct dma_fence *fence; -+ int i; -+ -+ if (unlikely(mjob->fence_in)) { -+ fence = mjob->fence_in; -+ mjob->fence_in = NULL; -+ if (!dma_fence_is_signaled(fence)) -+ return fence; -+ dma_fence_put(fence); -+ } -+ -+ mwv207_for_each_mtvb(mtvb, mjob) { -+ if (mtvb->excl) { -+ fence = mtvb->excl; -+ mtvb->excl = NULL; -+ if (!dma_fence_is_signaled(fence)) -+ return fence; -+ dma_fence_put(fence); -+ } -+ -+ for (i = 0; i < mtvb->nr_shared; i++) { -+ if (!mtvb->shared[i]) -+ continue; -+ fence = mtvb->shared[i]; -+ mtvb->shared[i] = NULL; -+ if (!dma_fence_is_signaled(fence)) -+ return fence; -+ dma_fence_put(fence); -+ } -+ kfree(mtvb->shared); -+ mtvb->nr_shared = 0; -+ mtvb->shared = NULL; -+ } -+ -+ return NULL; -+} -+ -+static struct dma_fence *mwv207_sched_run_job(struct drm_sched_job *job) -+{ -+ struct mwv207_sched *sched = to_mwv207_sched(job->sched); -+ struct dma_fence *fence; -+ -+ if (unlikely(job->s_fence->finished.error)) -+ return ERR_PTR(-ECANCELED); -+ -+ mwv207_devfreq_record_busy(sched->pipe); -+ -+ fence = sched->pipe->submit(sched->pipe, to_mwv207_job(job)); -+ if (IS_ERR_OR_NULL(fence)) -+ DRM_ERROR("%s: submit failed, errcode=%ld", -+ sched->pipe->fname, PTR_ERR(fence)); -+ return fence; -+} -+ -+static void mwv207_sched_timedout_job(struct drm_sched_job *job) -+{ -+ struct mwv207_sched *sched = to_mwv207_sched(job->sched); -+ struct mwv207_job *mjob = to_mwv207_job(job); -+ struct drm_sched_job *timedout_job; -+ -+ pr_info("mwv207: job from '%s' to '%s', timed out!", -+ mjob->comm, sched->pipe->fname); -+ -+ drm_sched_stop(&sched->base, job); -+ -+ if (dump_hang_job) { -+ sched->pipe->dump_state(sched->pipe); -+ mwv207_sched_dump_job(mjob); -+ } -+ -+ drm_sched_increase_karma(job); -+ -+ sched->pipe->reset(sched->pipe); -+ -+ list_for_each_entry(timedout_job, &sched->base.ring_mirror_list, node) -+ mwv207_devfreq_record_idle(sched->pipe); -+ -+ drm_sched_resubmit_jobs(&sched->base); -+ -+ -+ drm_sched_start(&sched->base, true); -+} -+ -+static void mwv207_sched_free_job(struct drm_sched_job *job) -+{ -+ struct mwv207_job *mjob = to_mwv207_job(job); -+ -+ mwv207_job_put(mjob); -+} -+ -+static const struct drm_sched_backend_ops mwv207_sched_ops = { -+ .dependency = mwv207_sched_dependency, -+ .run_job = mwv207_sched_run_job, -+ .timedout_job = mwv207_sched_timedout_job, -+ .free_job = mwv207_sched_free_job, -+}; -+ -+static struct drm_gpu_scheduler *mwv207_sched_create(struct mwv207_device *jdev, -+ unsigned int hw_submission, unsigned int hang_limit, long timeout, -+ struct mwv207_pipe *pipe) -+{ -+ struct mwv207_sched *sched; -+ int ret; -+ -+ if (pipe == NULL) -+ return NULL; -+ -+ sched = devm_kzalloc(jdev->dev, sizeof(struct mwv207_sched), GFP_KERNEL); -+ if (!sched) -+ goto err; -+ -+ sched->pipe = pipe; -+ -+ ret = drm_sched_init(&sched->base, &mwv207_sched_ops, hw_submission, hang_limit, -+ msecs_to_jiffies(timeout), pipe->fname); -+ if (ret) -+ goto err; -+ -+ return &sched->base; -+err: -+ sched->pipe->destroy(sched->pipe); -+ return NULL; -+} -+ -+static void mwv207_sched_destroy(struct drm_gpu_scheduler *sched) -+{ -+ struct mwv207_sched *msched = to_mwv207_sched(sched); -+ -+ if (sched == NULL) -+ return; -+ -+ drm_sched_fini(sched); -+ msched->pipe->destroy(msched->pipe); -+} -+ -+int mwv207_sched_suspend(struct mwv207_device *jdev) -+{ -+ struct mwv207_sched *sched; -+ int i, ret; -+ -+ -+ for (i = 0; i < 6; i++) { -+ if (!jdev->sched[i]) -+ continue; -+ sched = to_mwv207_sched(jdev->sched[i]); -+ -+ if (atomic_read(&jdev->sched[i]->hw_rq_count)) -+ return -EBUSY; -+ -+ ret = mwv207_devfreq_suspend(sched->pipe); -+ if (ret) -+ return ret; -+ } -+ -+ return 0; -+} -+ -+int mwv207_sched_resume(struct mwv207_device *jdev) -+{ -+ struct mwv207_sched *sched; -+ int i, ret; -+ -+ for (i = 0; i < 6; i++) { -+ if (!jdev->sched[i]) -+ continue; -+ sched = to_mwv207_sched(jdev->sched[i]); -+ -+ ret = mwv207_devfreq_resume(sched->pipe); -+ if (ret) -+ dev_err(sched->pipe->dev, "devfreq resume failed: %d", ret); -+ -+ sched->pipe->reset(sched->pipe); -+ } -+ -+ return 0; -+} -+ -+int mwv207_sched_init(struct mwv207_device *jdev) -+{ -+ struct mwv207_pipe *pipe; -+ -+ jdev->sched_3d = &jdev->sched[0]; -+ jdev->sched_dec = &jdev->sched_3d[2]; -+ jdev->sched_enc = &jdev->sched_dec[1]; -+ jdev->sched_2d = &jdev->sched_enc[1]; -+ jdev->sched_dma = &jdev->sched_2d[1]; -+ -+ /* ownership of pipe passed to mwv207_sched_create, don't reference -+ * this pipe after call to mwv207_sched_create. -+ * -+ * Note sched limit of 3d should be lower than hw event count, which -+ * is 30 for 91/92. otherwise pipe 3d will BUG_ON -+ */ -+ pipe = mwv207_pipe_3d_create(jdev, 0, 0x900000, "mwv207_3d0"); -+ jdev->sched_3d[0] = mwv207_sched_create(jdev, 30, 5, 2000, pipe); -+ if (jdev->sched_3d[0] == NULL) -+ return -ENODEV; -+ -+ pipe = mwv207_pipe_3d_create(jdev, 1, 0x910000, "mwv207_3d1"); -+ jdev->sched_3d[1] = mwv207_sched_create(jdev, 30, 5, 2000, pipe); -+ -+ pipe = mwv207_pipe_dec_create(jdev, 0, 0x930000, "mwv207_dec0"); -+ jdev->sched_dec[0] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); -+ if (jdev->sched_dec[0] == NULL) -+ goto err; -+ -+ pipe = mwv207_pipe_dec_create(jdev, 1, 0x940000, "mwv207_dec1"); -+ jdev->sched_dec[1] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); -+ -+ pipe = mwv207_pipe_enc_create(jdev, 0x920000, "mwv207_enc0"); -+ jdev->sched_enc[0] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); -+ -+ pipe = mwv207_pipe_2d_create(jdev, 0, 0x968000, "mwv207_2d0"); -+ jdev->sched_2d[0] = mwv207_sched_create(jdev, 30, 5, 2000, pipe); -+ if (jdev->sched_2d[0] == NULL) -+ goto err; -+ -+ pipe = mwv207_pipe_dma_create(jdev, 0, 0x9d0000, "mwv207_dma0"); -+ jdev->sched_dma[0] = mwv207_sched_create(jdev, 1, 5, 2000, pipe); -+ if (jdev->sched_dma[0] == NULL) -+ goto err; -+ -+ jdev->nr_3d = jdev->sched_3d[1] ? 2 : 1; -+ jdev->nr_enc = jdev->sched_enc[0] ? 1 : 0; -+ jdev->nr_dec = jdev->sched_dec[1] ? 2 : 1; -+ jdev->nr_2d = 1; -+ jdev->nr_dma = 1; -+ -+ mwv207_db_add(jdev, DRM_MWV207_ACTIVE_3D_NR, jdev->nr_3d); -+ mwv207_db_add(jdev, DRM_MWV207_ACTIVE_ENC_NR, jdev->nr_enc); -+ mwv207_db_add(jdev, DRM_MWV207_ACTIVE_DEC_NR, jdev->nr_dec); -+ mwv207_db_add(jdev, DRM_MWV207_ACTIVE_2D_NR, jdev->nr_2d); -+ mwv207_db_add(jdev, DRM_MWV207_ACTIVE_DMA_NR, jdev->nr_dma); -+ -+ return 0; -+err: -+ mwv207_sched_fini(jdev); -+ return -ENODEV; -+} -+ -+void mwv207_sched_fini(struct mwv207_device *jdev) -+{ -+ int i; -+ -+ for (i = 0; i < 6; ++i) { -+ if (!jdev->sched[i]) -+ continue; -+ mwv207_sched_destroy(jdev->sched[i]); -+ } -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_sched.h b/drivers/gpu/drm/mwv207/mwv207_sched.h -new file mode 100644 -index 000000000..2b515ff4d ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_sched.h -@@ -0,0 +1,149 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_SCHED_H_TGQQ2LXS -+#define MWV207_SCHED_H_TGQQ2LXS -+#include -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_bo.h" -+ -+struct mwv207_submit_cmd_dat { -+ int nr_relocs; -+ int dat_size; -+ struct drm_mwv207_submit_reloc *relocs; -+ char *dat; -+ struct mwv207_bo *jbo; -+}; -+ -+struct mwv207_tvb { -+ struct ttm_validate_buffer base; -+ struct dma_fence *excl; -+ unsigned int nr_shared; -+ struct dma_fence **shared; -+}; -+ -+#define to_mwv207_job(job) container_of(job, struct mwv207_job, base) -+struct mwv207_job { -+ struct drm_sched_job base; -+ -+ struct list_head tvblist; -+ struct mwv207_tvb *mtvb; -+ int nr_bos; -+ -+ struct drm_mwv207_submit_reloc *relocs; -+ int nr_relocs; -+ -+ struct mwv207_submit_cmd_dat *cmd_dats; -+ int nr_cmd_dat; -+ -+ char *cmds; -+ int cmd_size; -+ -+ struct dma_fence *fence_in; -+ -+ -+ struct mwv207_ctx *ctx; -+ struct drm_sched_entity *engine_entity; -+ -+ struct kref refcount; -+ -+ -+ bool is_dma; -+ -+ char comm[TASK_COMM_LEN]; -+}; -+#define mwv207_for_each_mtvb(mtvb, mjob) list_for_each_entry(mtvb, &(mjob)->tvblist, base.head) -+ -+struct mwv207_job *mwv207_job_alloc(void); -+struct mwv207_job *mwv207_job_get(struct mwv207_job *mjob); -+void mwv207_job_put(struct mwv207_job *mjob); -+ -+static inline struct mwv207_bo *mwv207_job_bo(struct mwv207_job *mjob, int idx) -+{ -+ BUG_ON(idx >= mjob->nr_bos + mjob->nr_cmd_dat); -+ return to_jbo(mjob->mtvb[idx].base.bo); -+} -+ -+struct mwv207_dma_loc { -+ u64 base; -+ u64 pg_nr_type; -+ u64 offset; -+ u64 stride; -+}; -+ -+ -+struct mwv207_dma_cmd { -+ struct mwv207_dma_loc src; -+ struct mwv207_dma_loc dst; -+ u64 width; -+ u64 height; -+}; -+ -+struct devfreq; -+#define to_mwv207_sched(sched) container_of(sched, struct mwv207_sched, base) -+struct mwv207_pipe { -+ struct dma_fence* (*submit)(struct mwv207_pipe *pipe, struct mwv207_job *job); -+ void (*reset)(struct mwv207_pipe *pipe); -+ void (*destroy)(struct mwv207_pipe *pipe); -+ void (*dump_state)(struct mwv207_pipe *pipe); -+ struct mwv207_device *jdev; -+ const char *fname; -+ int iosize; -+ void __iomem *regbase; -+ -+ -+ struct device *dev; -+ struct devfreq *devfreq; -+ spinlock_t devfreq_lock; -+ int busy_count; -+ int pll_id; -+ ktime_t busy_time; -+ ktime_t idle_time; -+ ktime_t time_last_update; -+}; -+ -+struct mwv207_sched { -+ struct drm_gpu_scheduler base; -+ struct mwv207_pipe *pipe; -+}; -+ -+static inline void pipe_write(struct mwv207_pipe *pipe, u32 reg, u32 value) -+{ -+ writel_relaxed(value, pipe->regbase + reg); -+} -+ -+static inline u32 pipe_read(struct mwv207_pipe *pipe, u32 reg) -+{ -+ return readl(pipe->regbase + reg); -+} -+ -+int mwv207_sched_init(struct mwv207_device *jdev); -+void mwv207_sched_fini(struct mwv207_device *jdev); -+int mwv207_sched_suspend(struct mwv207_device *jdev); -+int mwv207_sched_resume(struct mwv207_device *jdev); -+ -+struct mwv207_pipe *mwv207_pipe_3d_create(struct mwv207_device *jdev, int unit, -+ u32 regbase, const char *fname); -+struct mwv207_pipe *mwv207_pipe_2d_create(struct mwv207_device *jdev, int unit, -+ u32 regbase, const char *fname); -+struct mwv207_pipe *mwv207_pipe_dec_create(struct mwv207_device *jdev, int unit, -+ u32 regbase, const char *fname); -+struct mwv207_pipe *mwv207_pipe_enc_create(struct mwv207_device *jdev, -+ u32 regbase, const char *fname); -+struct mwv207_pipe *mwv207_pipe_dma_create(struct mwv207_device *jdev, int unit, -+ u32 regbase, const char *fname); -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_submit.c b/drivers/gpu/drm/mwv207/mwv207_submit.c -new file mode 100644 -index 000000000..f434b1a61 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_submit.c -@@ -0,0 +1,638 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include "mwv207_drm.h" -+#include "mwv207_submit.h" -+#include "mwv207_sched.h" -+#include "mwv207_ctx.h" -+#include "mwv207_bo.h" -+#include "mwv207_gem.h" -+ -+static inline int mwv207_submit_select_engine(struct drm_device *dev, struct mwv207_job *mjob, -+ struct drm_mwv207_submit *args) -+{ -+ struct mwv207_device *jdev = ddev_to_jdev(dev); -+ struct drm_sched_entity **entity_array; -+ int id_max, id; -+ -+ switch (args->engine_type) { -+ case 0: -+ entity_array = &mjob->ctx->entity_3d[0]; -+ id_max = jdev->nr_3d; -+ break; -+ case 1: -+ entity_array = &mjob->ctx->entity_dec[0]; -+ id_max = jdev->nr_dec; -+ break; -+ case 2: -+ entity_array = &mjob->ctx->entity_enc[0]; -+ id_max = jdev->nr_enc; -+ break; -+ case 3: -+ entity_array = &mjob->ctx->entity_2d[0]; -+ id_max = jdev->nr_2d; -+ break; -+ case 4: -+ entity_array = &mjob->ctx->entity_dma[0]; -+ id_max = jdev->nr_dma; -+ mjob->is_dma = true; -+ break; -+ -+ default: -+ id_max = 0; -+ } -+ if (id_max <= 0) -+ return -ENODEV; -+ -+ if (args->engine_id == 0xffffffff) -+ id = id_max; -+ else if (args->engine_id >= 0 && args->engine_id < id_max) -+ id = args->engine_id; -+ else -+ return -ENODEV; -+ mjob->engine_entity = entity_array[id]; -+ return 0; -+} -+ -+static int mwv207_submit_init_job_reloc(struct mwv207_job *mjob, struct drm_mwv207_submit *args) -+{ -+ if ((int)args->nr_relocs < 0) -+ return -EINVAL; -+ mjob->nr_relocs = (int)args->nr_relocs; -+ if (mjob->nr_relocs == 0) -+ return 0; -+ if (args->relocs == 0) -+ return -EINVAL; -+ -+ mjob->relocs = kvmalloc_array(mjob->nr_relocs, -+ sizeof(struct drm_mwv207_submit_reloc), GFP_KERNEL); -+ -+ return copy_from_user(mjob->relocs, (void __user *)args->relocs, -+ sizeof(struct drm_mwv207_submit_reloc) * mjob->nr_relocs); -+} -+ -+static int mwv207_submit_init_job_bo(struct mwv207_job *mjob, -+ struct drm_mwv207_submit *args, struct drm_file *filp) -+{ -+ struct drm_mwv207_bo_acc ubos_stack[32]; -+ struct drm_mwv207_bo_acc *ubos = ubos_stack; -+ struct ttm_validate_buffer *tvb; -+ struct drm_gem_object *gobj; -+ int ret = 0, i; -+ -+ if ((int)args->nr_bos < 0) -+ return -EINVAL; -+ -+ mjob->nr_bos = (int)args->nr_bos; -+ if (mjob->nr_bos == 0) { -+ if (mjob->nr_cmd_dat) -+ goto setup_mtvb; -+ return 0; -+ } -+ -+ if (!args->bos) -+ return -EINVAL; -+ -+ if (mjob->nr_bos > 32) -+ ubos = kvmalloc_array(mjob->nr_bos, sizeof(*ubos), GFP_KERNEL); -+ if (unlikely(!ubos)) -+ return -ENOMEM; -+ -+ ret = copy_from_user(ubos, (void __user *)args->bos, -+ mjob->nr_bos * sizeof(*ubos)); -+ if (ret) -+ goto out; -+setup_mtvb: -+ mjob->mtvb = kvcalloc(mjob->nr_bos + mjob->nr_cmd_dat, -+ sizeof(struct mwv207_tvb), GFP_KERNEL); -+ if (!mjob->mtvb) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ spin_lock(&filp->table_lock); -+ for (i = 0; i < mjob->nr_bos; i++) { -+ tvb = &mjob->mtvb[i].base; -+ tvb->num_shared = (ubos[i].flags & 0x00000001) ? 0 : 1; -+ gobj = idr_find(&filp->object_idr, ubos[i].handle); -+ if (unlikely(!gobj)) { -+ spin_unlock(&filp->table_lock); -+ ret = -ENOENT; -+ goto out; -+ } -+ tvb->bo = &mwv207_bo_ref(mwv207_bo_from_gem(gobj))->tbo; -+ list_add_tail(&tvb->head, &mjob->tvblist); -+ } -+ spin_unlock(&filp->table_lock); -+ for (i = 0; i < mjob->nr_cmd_dat; i++) { -+ tvb = &mjob->mtvb[mjob->nr_bos + i].base; -+ tvb->num_shared = 0; -+ tvb->bo = &mwv207_bo_ref(mjob->cmd_dats[i].jbo)->tbo; -+ list_add_tail(&tvb->head, &mjob->tvblist); -+ } -+out: -+ if (unlikely(ubos != ubos_stack)) -+ kvfree(ubos); -+ -+ return ret; -+} -+ -+static int mwv207_submit_init_job_cmd(struct mwv207_job *mjob, struct drm_mwv207_submit *args) -+{ -+ mjob->cmd_size = args->cmd_size; -+ if ((int)mjob->cmd_size <= 0) -+ return -EINVAL; -+ -+ if (mjob->cmd_size > 0x20000) -+ return -E2BIG; -+ -+ if (args->cmds == 0) -+ return -EINVAL; -+ -+ -+ if (mjob->is_dma) -+ mjob->cmds = kmalloc(args->cmd_size, GFP_KERNEL); -+ else -+ mjob->cmds = kvmalloc(args->cmd_size, GFP_KERNEL); -+ if (!mjob->cmds) -+ return -ENOMEM; -+ -+ return copy_from_user(mjob->cmds, (void __user *)args->cmds, mjob->cmd_size); -+} -+ -+static int mwv207_submit_init_job_cmd_dat(struct drm_device *dev, -+ struct mwv207_job *mjob, struct drm_mwv207_submit *args) -+{ -+ struct drm_mwv207_submit_cmd_dat udats_stack[8]; -+ struct drm_mwv207_submit_cmd_dat *udats = udats_stack; -+ struct mwv207_device *jdev = ddev_to_jdev(dev); -+ struct mwv207_submit_cmd_dat *mdat; -+ int ret, i; -+ -+ if ((int)args->nr_cmd_dat < 0) -+ return -EINVAL; -+ mjob->nr_cmd_dat = args->nr_cmd_dat; -+ if (mjob->nr_cmd_dat == 0) -+ return 0; -+ if (args->cmd_dats == 0) -+ return -EINVAL; -+ if (mjob->nr_cmd_dat > 8) -+ udats = kvmalloc_array(mjob->nr_cmd_dat, -+ sizeof(struct drm_mwv207_submit_cmd_dat), GFP_KERNEL); -+ -+ if (unlikely(!udats)) -+ return -ENOMEM; -+ -+ mjob->cmd_dats = kvcalloc(mjob->nr_cmd_dat, -+ sizeof(struct mwv207_submit_cmd_dat), GFP_KERNEL); -+ if (!mjob->cmd_dats) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ ret = copy_from_user(udats, (void __user *)args->cmd_dats, -+ mjob->nr_cmd_dat * sizeof(struct drm_mwv207_submit_cmd_dat)); -+ if (ret) -+ goto out; -+ -+ for (i = 0; i < mjob->nr_cmd_dat; ++i) { -+ if ((int)udats[i].nr_relocs < 0) { -+ ret = -EINVAL; -+ goto out; -+ } -+ if ((int)udats[i].dat_size <= 0 || udats[i].dat == 0) { -+ ret = -EINVAL; -+ goto out; -+ } -+ if (udats[i].nr_relocs != 0 && udats[i].relocs == 0) { -+ ret = -EINVAL; -+ goto out; -+ } -+ if (udats[i].dat_size > 0x20000) { -+ ret = -E2BIG; -+ goto out; -+ } -+ mdat = &mjob->cmd_dats[i]; -+ mdat->nr_relocs = udats[i].nr_relocs; -+ if (mdat->nr_relocs) { -+ mdat->relocs = kvmalloc_array(mdat->nr_relocs, -+ sizeof(struct drm_mwv207_submit_reloc), GFP_KERNEL); -+ if (!mdat->relocs) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ ret = copy_from_user(mdat->relocs, (void __user *)udats[i].relocs, -+ mdat->nr_relocs * sizeof(struct drm_mwv207_submit_reloc)); -+ if (ret) -+ goto out; -+ } -+ mdat->dat_size = udats[i].dat_size; -+ mdat->dat = kvmalloc(mdat->dat_size, GFP_KERNEL); -+ if (!mdat->dat) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ ret = copy_from_user(mdat->dat, (void __user *)udats[i].dat, mdat->dat_size); -+ if (ret) -+ goto out; -+ ret = mwv207_bo_create(jdev, mdat->dat_size, 0x1000, ttm_bo_type_device, -+ 0x2, (1<<0), -+ &mdat->jbo); -+ if (ret) -+ goto out; -+ } -+ -+out: -+ if (unlikely(udats != udats_stack)) -+ kvfree(udats); -+ return ret; -+} -+ -+static int mwv207_submit_init_job(struct drm_device *dev, struct mwv207_job *mjob, -+ struct drm_mwv207_submit *args, struct drm_file *filp) -+{ -+ int ret; -+ -+ get_task_comm(mjob->comm, current); -+ -+ -+ mjob->ctx = mwv207_ctx_lookup(dev, filp, args->ctx); -+ if (!mjob->ctx) -+ return -ENOENT; -+ ret = mwv207_submit_select_engine(dev, mjob, args); -+ if (ret) -+ return ret; -+ ret = mwv207_submit_init_job_cmd_dat(dev, mjob, args); -+ if (ret) -+ return ret; -+ ret = mwv207_submit_init_job_bo(mjob, args, filp); -+ if (ret) -+ return ret; -+ ret = mwv207_submit_init_job_reloc(mjob, args); -+ if (ret) -+ return ret; -+ ret = mwv207_submit_init_job_cmd(mjob, args); -+ if (ret) -+ return ret; -+ -+ return 0; -+} -+ -+static struct mwv207_job *mwv207_submit_init(struct drm_device *dev, struct drm_file *filp, -+ struct drm_mwv207_submit *args) -+{ -+ struct mwv207_job *mjob; -+ int ret; -+ -+ mjob = mwv207_job_alloc(); -+ if (!mjob) -+ return ERR_PTR(-ENOMEM); -+ -+ ret = mwv207_submit_init_job(dev, mjob, args, filp); -+ if (ret) -+ goto err; -+ -+ return mjob; -+err: -+ mwv207_job_put(mjob); -+ return ERR_PTR(ret); -+} -+ -+static int mwv207_submit_patch_entry(struct mwv207_job *mjob, -+ struct drm_mwv207_submit_reloc *reloc, -+ struct mwv207_bo *jbo, char *dat, u32 dat_size) -+{ -+ u64 addr, bo_size; -+ -+ if (reloc->pad) -+ return -EINVAL; -+ -+ bo_size = mwv207_bo_size(jbo); -+ if (reloc->bo_offset >= bo_size) -+ return -ERANGE; -+ addr = mwv207_bo_gpu_phys(jbo) + reloc->bo_offset; -+ -+ -+ switch (reloc->type & 0xffff) { -+ case 0: -+ if (reloc->cmd_offset + 8 > dat_size) -+ return -ERANGE; -+ *(u64 *)(dat + reloc->cmd_offset) = addr; -+ break; -+ case 1: -+ if (reloc->cmd_offset + 4 > dat_size) -+ return -ERANGE; -+ *(u32 *)(dat + reloc->cmd_offset) = addr & 0xffffffff; -+ break; -+ case 2: -+ if (reloc->cmd_offset + 4 > dat_size) -+ return -ERANGE; -+ *(u32 *)(dat + reloc->cmd_offset) = addr >> 32; -+ break; -+ case 3: -+ if (reloc->cmd_offset + 2 > dat_size) -+ return -ERANGE; -+ *(u16 *)(dat + reloc->cmd_offset) = (addr >> 16) & 0xffff; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int mwv207_submit_patch_single(struct mwv207_job *mjob, -+ struct drm_mwv207_submit_reloc *reloc, char *dat, u32 dat_size) -+{ -+ struct mwv207_bo *jbo; -+ -+ if (reloc->type & 0x80000000) { -+ if (reloc->idx >= mjob->nr_cmd_dat) -+ return -EINVAL; -+ jbo = mwv207_job_bo(mjob, reloc->idx + mjob->nr_bos); -+ } else { -+ if (reloc->idx >= mjob->nr_bos) -+ return -EINVAL; -+ jbo = mwv207_job_bo(mjob, reloc->idx); -+ } -+ -+ return mwv207_submit_patch_entry(mjob, reloc, jbo, dat, dat_size); -+} -+ -+static int mwv207_submit_patch_dma_entry(struct mwv207_job *mjob, -+ struct mwv207_dma_loc *loc, struct mwv207_bo *jbo, -+ u64 width, u64 height) -+{ -+ struct mwv207_ttm_tt *gtt; -+ -+ if (loc->stride == 0 || loc->pg_nr_type != 0 || width == 0 || height == 0) -+ return -EINVAL; -+ -+ switch (jbo->tbo.mem.mem_type) { -+ case TTM_PL_VRAM: -+ loc->base = mwv207_bo_gpu_phys(jbo); -+ loc->pg_nr_type = ((jbo->tbo.num_pages) | (0ULL << 63)); -+ break; -+ case TTM_PL_TT: -+ gtt = to_gtt(jbo->tbo.ttm); -+ loc->base = (u64)gtt->ttm.dma_address; -+ loc->pg_nr_type = ((jbo->tbo.num_pages) | (1ULL << 63)); -+ break; -+ default: -+ BUG_ON(1); -+ break; -+ } -+ -+ -+ if (loc->offset >= mwv207_bo_size(jbo)) -+ return -ERANGE; -+ if (loc->offset + loc->stride * (height - 1) + width <= loc->offset) -+ return -ERANGE; -+ if (loc->offset + loc->stride * (height - 1) + width > mwv207_bo_size(jbo)) -+ return -ERANGE; -+ -+ -+ if ((loc->offset % loc->stride) + width > loc->stride) -+ return -ERANGE; -+ -+ return 0; -+} -+ -+static int mwv207_submit_patch_dma(struct drm_device *dev, struct mwv207_job *mjob) -+{ -+ struct mwv207_bo *src_bo, *dst_bo, *jbo; -+ struct drm_mwv207_submit_reloc *reloc; -+ struct mwv207_dma_cmd *dma_cmd; -+ int i, ret; -+ -+ if (mjob->nr_bos != 2 || mjob->nr_relocs != 2 || mjob->nr_cmd_dat) -+ return -EINVAL; -+ if (mjob->cmd_size != sizeof(struct mwv207_dma_cmd)) -+ return -EINVAL; -+ -+ src_bo = dst_bo = NULL; -+ for (i = 0; i < mjob->nr_relocs; i++) { -+ reloc = &mjob->relocs[i]; -+ if (reloc->type & 0x80000000) -+ return -EINVAL; -+ if ((reloc->type & 0xffff) != 0) -+ return -EINVAL; -+ if (reloc->bo_offset) -+ return -EINVAL; -+ jbo = mwv207_job_bo(mjob, reloc->idx); -+ if (reloc->cmd_offset == offsetof(struct mwv207_dma_cmd, src.base)) -+ src_bo = jbo; -+ else if (reloc->cmd_offset == offsetof(struct mwv207_dma_cmd, dst.base)) -+ dst_bo = jbo; -+ } -+ if (!src_bo || !dst_bo || src_bo == dst_bo) -+ return -EINVAL; -+ -+ dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; -+ ret = mwv207_submit_patch_dma_entry(mjob, &dma_cmd->src, src_bo, -+ dma_cmd->width, dma_cmd->height); -+ if (ret) -+ return ret; -+ return mwv207_submit_patch_dma_entry(mjob, &dma_cmd->dst, dst_bo, -+ dma_cmd->width, dma_cmd->height); -+} -+ -+static int mwv207_submit_patch(struct drm_device *dev, struct mwv207_job *mjob) -+{ -+ struct mwv207_bo *jbo; -+ int i, j, ret; -+ void *ptr; -+ -+ if (mjob->is_dma) -+ return mwv207_submit_patch_dma(dev, mjob); -+ -+ for (i = 0; i < mjob->nr_relocs; ++i) { -+ ret = mwv207_submit_patch_single(mjob, &mjob->relocs[i], -+ mjob->cmds, mjob->cmd_size); -+ if (ret) -+ return ret; -+ } -+ -+ for (i = 0; i < mjob->nr_cmd_dat; ++i) { -+ if (mjob->cmd_dats[i].nr_relocs) { -+ for (j = 0; j < mjob->cmd_dats[i].nr_relocs; j++) { -+ ret = mwv207_submit_patch_single(mjob, &mjob->cmd_dats[i].relocs[j], -+ mjob->cmd_dats[i].dat, mjob->cmd_dats[i].dat_size); -+ if (ret) -+ return ret; -+ } -+ } -+ -+ -+ jbo = mjob->cmd_dats[i].jbo; -+ -+ -+ ret = ttm_bo_wait(&jbo->tbo, true, false); -+ if (ret) -+ return ret; -+ -+ ret = mwv207_bo_kmap_reserved(jbo, &ptr); -+ if (ret) -+ return ret; -+ memcpy_toio(ptr, mjob->cmd_dats[i].dat, mjob->cmd_dats[i].dat_size); -+ mwv207_bo_kunmap_reserved(jbo); -+ } -+ -+ return 0; -+} -+ -+static int mwv207_submit_validate(struct drm_device *dev, struct mwv207_job *mjob) -+{ -+ struct ttm_operation_ctx ctx = { -+ .interruptible = true, -+ .no_wait_gpu = false -+ }; -+ struct mwv207_bo *jbo; -+ int i, ret; -+ -+ for (i = 0; i < mjob->nr_bos + mjob->nr_cmd_dat; ++i) { -+ jbo = mwv207_job_bo(mjob, i); -+ -+ if (jbo->pin_count) -+ continue; -+ -+ if (mjob->is_dma) { -+ if (jbo->tbo.mem.mem_type != TTM_PL_SYSTEM) -+ continue; -+ -+ mwv207_bo_placement_from_domain(jbo, 0x4, 0); -+ } else { -+ -+ jbo->flags |= (1<<2); -+ if (i >= mjob->nr_bos) -+ jbo->flags |= (1<<0); -+ mwv207_bo_placement_from_domain(jbo, 0x2, 0); -+ } -+ -+ ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); -+ if (ret) -+ return ret; -+ } -+ -+ return 0; -+} -+ -+static int mwv207_submit_attach_dependency(struct mwv207_job *mjob, struct drm_mwv207_submit *args) -+{ -+ struct dma_resv *resv; -+ struct mwv207_tvb *mtvb; -+ int ret; -+ -+ mwv207_for_each_mtvb(mtvb, mjob) { -+ resv = mtvb->base.bo->base.resv; -+ if (mtvb->base.num_shared == 0) { -+ ret = dma_resv_get_fences_rcu(resv, &mtvb->excl, -+ &mtvb->nr_shared, &mtvb->shared); -+ if (ret) -+ return ret; -+ } else -+ mtvb->excl = dma_resv_get_excl_rcu(resv); -+ } -+ -+ if (unlikely(args->flags & 0x00000001)) { -+ mjob->fence_in = sync_file_get_fence(args->fence_fd); -+ if (!mjob->fence_in) -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int mwv207_submit_commit(struct mwv207_job *mjob, -+ struct drm_mwv207_submit *args, struct dma_fence **fence) -+{ -+ int ret; -+ -+ /* XXX: job init and push should be protected with common lock, -+ * refer to drm_sched_entity_push_job documentation for details -+ */ -+ ret = drm_sched_job_init(&mjob->base, mjob->engine_entity, mjob->ctx); -+ if (ret) -+ return ret; -+ -+ if (args->flags & 0x00000002) { -+ struct sync_file *sync_file; -+ int fd; -+ -+ fd = get_unused_fd_flags(O_CLOEXEC); -+ if (fd < 0) -+ return fd; -+ sync_file = sync_file_create(&mjob->base.s_fence->finished); -+ if (!sync_file) { -+ put_unused_fd(fd); -+ return -ENOMEM; -+ } -+ fd_install(fd, sync_file->file); -+ args->fence_fd = fd; -+ } -+ -+ -+ *fence = &mjob->base.s_fence->finished; -+ -+ -+ mwv207_job_get(mjob); -+ drm_sched_entity_push_job(&mjob->base, mjob->engine_entity); -+ return 0; -+} -+ -+int mwv207_submit_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp) -+{ -+ struct drm_mwv207_submit *args = data; -+ struct ww_acquire_ctx ticket; -+ struct mwv207_job *mjob; -+ struct dma_fence *fence = NULL; -+ int ret; -+ -+ if (args->padding || (args->flags & ~0x00000003)) -+ return -EINVAL; -+ if (args->cmd_size == 0 || args->cmds == 0) -+ return -EINVAL; -+ -+ mjob = mwv207_submit_init(dev, filp, args); -+ if (IS_ERR(mjob)) -+ return PTR_ERR(mjob); -+ ret = ttm_eu_reserve_buffers(&ticket, &mjob->tvblist, true, NULL); -+ if (ret) -+ goto put_job; -+ ret = mwv207_submit_validate(dev, mjob); -+ if (ret) -+ goto unreserve; -+ ret = mwv207_submit_patch(dev, mjob); -+ if (ret) -+ goto unreserve; -+ ret = mwv207_submit_attach_dependency(mjob, args); -+ if (ret) -+ goto unreserve; -+ ret = mwv207_submit_commit(mjob, args, &fence); -+ if (ret) -+ goto unreserve; -+unreserve: -+ if (likely(fence)) -+ ttm_eu_fence_buffer_objects(&ticket, &mjob->tvblist, fence); -+ else -+ ttm_eu_backoff_reservation(&ticket, &mjob->tvblist); -+put_job: -+ mwv207_job_put(mjob); -+ -+ return ret; -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_submit.h b/drivers/gpu/drm/mwv207/mwv207_submit.h -new file mode 100644 -index 000000000..194fceafa ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_submit.h -@@ -0,0 +1,23 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#ifndef MWV207_SUBMIT_H_2S1GH9LD -+#define MWV207_SUBMIT_H_2S1GH9LD -+ -+int mwv207_submit_ioctl(struct drm_device *dev, void *data, -+ struct drm_file *filp); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_ttm.c b/drivers/gpu/drm/mwv207/mwv207_ttm.c -new file mode 100644 -index 000000000..01d6ad563 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_ttm.c -@@ -0,0 +1,613 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "mwv207.h" -+#include "mwv207_bo.h" -+#include "mwv207_drm.h" -+#include "mwv207_sched.h" -+ -+static int mwv207_mem_visible(struct mwv207_device *jdev, struct ttm_resource *mem) -+{ -+ if (mem->mem_type == TTM_PL_SYSTEM || -+ mem->mem_type == TTM_PL_TT) -+ return true; -+ if (mem->mem_type != TTM_PL_VRAM) -+ return false; -+ -+ -+ return ((mem->start << PAGE_SHIFT) + mem->size < jdev->visible_vram_size); -+} -+ -+ -+static void mwv207_evict_flags(struct ttm_buffer_object *bo, -+ struct ttm_placement *placement) -+{ -+ struct mwv207_device *jdev; -+ struct mwv207_bo *jbo; -+ static const struct ttm_place placements = { -+ .fpfn = 0, -+ .lpfn = 0, -+ .flags = 0, -+ .mem_type = TTM_PL_SYSTEM -+ }; -+ -+ if (!mwv207_ttm_bo_is_mwv207_bo(bo)) { -+ placement->placement = &placements; -+ placement->busy_placement = &placements; -+ placement->num_placement = 1; -+ placement->num_busy_placement = 1; -+ return; -+ } -+ -+ jbo = to_jbo(bo); -+ jdev = ddev_to_jdev(jbo->tbo.base.dev); -+ -+ /* evict order: * visible vram -> invisible vram -> GTT -> SYSTEM */ -+ if (bo->mem.mem_type == TTM_PL_VRAM) { -+ if (jdev->visible_vram_size != jdev->vram_size -+ && mwv207_mem_visible(jdev, &bo->mem)) { -+ jbo->flags &= ~((1<<0) | (1<<2)); -+ mwv207_bo_placement_from_domain(jbo, -+ 0x2 | 0x4, -+ false); -+ BUG_ON(!(jbo->placements[0].mem_type & TTM_PL_VRAM)); -+ BUG_ON(!(jbo->placements[1].mem_type & TTM_PL_TT)); -+ jbo->placements[0].fpfn = jdev->visible_vram_size >> PAGE_SHIFT; -+ jbo->placements[0].lpfn = 0; -+ jbo->placement.placement = &jbo->placements[0]; -+ jbo->placement.busy_placement = &jbo->placements[1]; -+ jbo->placement.num_placement = 1; -+ jbo->placement.num_busy_placement = 1; -+ } else -+ mwv207_bo_placement_from_domain(jbo, 0x4, false); -+ } else -+ mwv207_bo_placement_from_domain(jbo, 0x1, false); -+ -+ *placement = jbo->placement; -+} -+ -+static int mwv207_ttm_io_mem_reserve(struct ttm_bo_device *bdev, -+ struct ttm_resource *mem) -+{ -+ struct mwv207_device *jdev = bdev_to_jdev(bdev); -+ size_t bus_size = (size_t)mem->num_pages << PAGE_SHIFT; -+ -+ mem->bus.addr = NULL; -+ mem->bus.offset = 0; -+ mem->bus.is_iomem = false; -+ -+ switch (mem->mem_type) { -+ case TTM_PL_SYSTEM: -+ case TTM_PL_TT: -+ -+ return 0; -+ case TTM_PL_VRAM: -+ -+ mem->bus.offset = mem->start << PAGE_SHIFT; -+ if (mem->bus.offset + bus_size > jdev->visible_vram_size) -+ return -EINVAL; -+ mem->bus.is_iomem = true; -+ mem->bus.offset += jdev->vram_bar_base; -+ break; -+ default: -+ return -EINVAL; -+ } -+ return 0; -+} -+ -+static int mwv207_ttm_tt_bind(struct ttm_bo_device *bdev, -+ struct ttm_tt *ttm, -+ struct ttm_resource *bo_mem) -+{ -+ if (!bo_mem) -+ return -EINVAL; -+ return 0; -+} -+ -+static void mwv207_ttm_tt_unbind(struct ttm_bo_device *bdev, -+ struct ttm_tt *ttm) -+{ -+ return ; -+} -+ -+static void mwv207_ttm_tt_destroy(struct ttm_bo_device *bdev, -+ struct ttm_tt *ttm) -+{ -+ struct mwv207_ttm_tt *gtt = to_gtt(ttm); -+ ttm_tt_destroy_common(bdev, ttm); -+ -+ ttm_dma_tt_fini(>t->ttm); -+ kfree(gtt); -+} -+ -+static struct ttm_tt *mwv207_ttm_tt_create(struct ttm_buffer_object *bo, -+ u32 page_flags) -+{ -+ struct mwv207_device *jdev; -+ struct mwv207_ttm_tt *gtt; -+ -+ jdev = ddev_to_jdev(bo->base.dev); -+ gtt = kzalloc(sizeof(struct mwv207_ttm_tt), GFP_KERNEL); -+ if (gtt == NULL) -+ return NULL; -+ gtt->jdev = jdev; -+ if (ttm_dma_tt_init(>t->ttm, bo, page_flags)) { -+ kfree(gtt); -+ return NULL; -+ } -+ return >t->ttm.ttm; -+} -+ -+static int mwv207_ttm_tt_populate(struct ttm_bo_device *bdev, -+ struct ttm_tt *ttm, -+ struct ttm_operation_ctx *ctx) -+{ -+ struct mwv207_ttm_tt *gtt = to_gtt(ttm); -+ struct mwv207_device *jdev = bdev_to_jdev(bdev); -+ -+ return ttm_dma_populate(>t->ttm, jdev->dev, ctx); -+} -+ -+static void mwv207_ttm_tt_unpopulate(struct ttm_bo_device *bdev, -+ struct ttm_tt *ttm) -+{ -+ struct mwv207_ttm_tt *gtt = to_gtt(ttm); -+ struct mwv207_device *jdev = bdev_to_jdev(bdev); -+ -+ ttm_dma_unpopulate(>t->ttm, jdev->dev); -+} -+ -+static int mwv207_ttm_job_submit(struct mwv207_job *mjob, struct dma_fence **fence) -+{ -+ int ret; -+ -+ ret = drm_sched_job_init(&mjob->base, mjob->engine_entity, NULL); -+ if (ret) -+ return ret; -+ -+ *fence = &mjob->base.s_fence->finished; -+ -+ mwv207_job_get(mjob); -+ drm_sched_entity_push_job(&mjob->base, mjob->engine_entity); -+ -+ return 0; -+} -+ -+static struct mwv207_job *mwv207_ttm_job_alloc(struct ttm_buffer_object *bo) -+{ -+ struct mwv207_job *mjob = mwv207_job_alloc(); -+ struct mwv207_dma_cmd *dma_cmd; -+ struct mwv207_tvb *mtvb; -+ int ret; -+ -+ if (!mjob) -+ return ERR_PTR(-ENOMEM); -+ -+ -+ dma_cmd = kmalloc(sizeof(*dma_cmd), GFP_KERNEL); -+ if (!dma_cmd) { -+ ret = -ENOMEM; -+ goto err; -+ } -+ dma_cmd->src.offset = 0; -+ dma_cmd->src.stride = bo->mem.size; -+ dma_cmd->dst.offset = 0; -+ dma_cmd->dst.stride = bo->mem.size; -+ dma_cmd->width = bo->mem.size; -+ dma_cmd->height = 1; -+ -+ mjob->cmds = (char *)dma_cmd; -+ mjob->cmd_size = sizeof(*dma_cmd); -+ mjob->engine_entity = ddev_to_jdev(bo->base.dev)->dma_entity; -+ mjob->is_dma = true; -+ -+ -+ mjob->mtvb = kzalloc(sizeof(struct mwv207_tvb), GFP_KERNEL); -+ if (!mjob->mtvb) { -+ ret = -ENOMEM; -+ goto err; -+ } -+ mtvb = &mjob->mtvb[0]; -+ list_add_tail(&mtvb->base.head, &mjob->tvblist); -+ -+ ret = dma_resv_get_fences_rcu(bo->base.resv, &mtvb->excl, -+ &mtvb->nr_shared, &mtvb->shared); -+ if (ret) -+ goto err; -+ -+ return mjob; -+err: -+ mwv207_job_put(mjob); -+ return ERR_PTR(ret); -+} -+ -+static int mwv207_move_vram_gtt(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct ttm_tt *ttm = bo->ttm; -+ struct mwv207_ttm_tt *gtt = to_gtt(ttm); -+ struct mwv207_dma_cmd *dma_cmd; -+ struct mwv207_job *mjob; -+ struct dma_fence *fence; -+ int ret; -+ -+ mjob = mwv207_ttm_job_alloc(bo); -+ if (IS_ERR(mjob)) -+ return PTR_ERR(mjob); -+ -+ dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; -+ dma_cmd->src.base = bo->mem.start << PAGE_SHIFT; -+ dma_cmd->src.pg_nr_type = ((bo->mem.num_pages) | (0ULL << 63)); -+ dma_cmd->dst.base = (u64)gtt->ttm.dma_address; -+ dma_cmd->dst.pg_nr_type = ((ttm->num_pages) | (1ULL << 63)); -+ -+ ret = mwv207_ttm_job_submit(mjob, &fence); -+ if (!ret) -+ ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); -+ -+ mwv207_job_put(mjob); -+ return ret; -+} -+ -+static int mwv207_move_gtt_vram(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct ttm_tt *ttm = bo->ttm; -+ struct mwv207_ttm_tt *gtt = to_gtt(ttm); -+ struct mwv207_dma_cmd *dma_cmd; -+ struct mwv207_job *mjob; -+ struct dma_fence *fence; -+ int ret; -+ -+ mjob = mwv207_ttm_job_alloc(bo); -+ if (IS_ERR(mjob)) -+ return PTR_ERR(mjob); -+ -+ dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; -+ dma_cmd->src.base = (u64)gtt->ttm.dma_address; -+ dma_cmd->src.pg_nr_type = ((ttm->num_pages) | (1ULL << 63)); -+ dma_cmd->dst.base = new_mem->start << PAGE_SHIFT; -+ dma_cmd->dst.pg_nr_type = ((bo->mem.num_pages) | (0ULL << 63)); -+ -+ ret = mwv207_ttm_job_submit(mjob, &fence); -+ if (!ret) -+ ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); -+ -+ mwv207_job_put(mjob); -+ return ret; -+} -+ -+static int mwv207_move_vram_vram(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct mwv207_dma_cmd *dma_cmd; -+ struct mwv207_job *mjob; -+ struct dma_fence *fence; -+ int ret; -+ -+ mjob = mwv207_ttm_job_alloc(bo); -+ if (IS_ERR(mjob)) -+ return PTR_ERR(mjob); -+ -+ dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; -+ dma_cmd->src.base = bo->mem.start << PAGE_SHIFT; -+ dma_cmd->src.pg_nr_type = ((bo->mem.num_pages) | (0ULL << 63)); -+ dma_cmd->dst.base = new_mem->start << PAGE_SHIFT; -+ dma_cmd->dst.pg_nr_type = ((new_mem->num_pages) | (0ULL << 63)); -+ -+ ret = mwv207_ttm_job_submit(mjob, &fence); -+ if (!ret) -+ ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); -+ -+ mwv207_job_put(mjob); -+ return ret; -+} -+ -+static int mwv207_move_vram_ram(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct ttm_placement placement; -+ struct ttm_place placements; -+ struct ttm_resource tmp_mem; -+ int ret; -+ -+ if (new_mem->mem_type == TTM_PL_TT) -+ return mwv207_move_vram_gtt(bo, evict, ctx, new_mem); -+ -+ -+ tmp_mem = *new_mem; -+ tmp_mem.mm_node = NULL; -+ placement.num_placement = 1; -+ placement.placement = &placements; -+ placement.num_busy_placement = 1; -+ placement.busy_placement = &placements; -+ placements.fpfn = 0; -+ placements.lpfn = 0; -+ placements.flags = TTM_PL_MASK_CACHING; -+ placements.mem_type = TTM_PL_TT; -+ ret = ttm_bo_mem_space(bo, &placement, &tmp_mem, ctx); -+ if (unlikely(ret)) -+ return ret; -+ -+ ret = ttm_tt_set_placement_caching(bo->ttm, tmp_mem.placement); -+ if (unlikely(ret)) -+ goto out; -+ -+ ret = ttm_tt_populate(bo->bdev, bo->ttm, ctx); -+ if (unlikely(ret)) -+ goto out; -+ -+ ret = mwv207_move_vram_gtt(bo, evict, ctx, &tmp_mem); -+ if (likely(!ret)) -+ ret = ttm_bo_move_ttm(bo, ctx, new_mem); -+out: -+ ttm_resource_free(bo, &tmp_mem); -+ return ret; -+} -+ -+static int mwv207_move_ram_vram(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct ttm_placement placement; -+ struct ttm_place placements; -+ struct ttm_resource tmp_mem; -+ int ret; -+ -+ if (bo->mem.mem_type == TTM_PL_TT) -+ return mwv207_move_gtt_vram(bo, evict, ctx, new_mem); -+ -+ -+ tmp_mem = *new_mem; -+ tmp_mem.mm_node = NULL; -+ placement.num_placement = 1; -+ placement.placement = &placements; -+ placement.num_busy_placement = 1; -+ placement.busy_placement = &placements; -+ placements.fpfn = 0; -+ placements.lpfn = 0; -+ placements.flags = TTM_PL_MASK_CACHING; -+ placements.mem_type = TTM_PL_TT; -+ ret = ttm_bo_mem_space(bo, &placement, &tmp_mem, ctx); -+ if (unlikely(ret)) -+ return ret; -+ -+ ret = ttm_bo_move_ttm(bo, ctx, &tmp_mem); -+ if (unlikely(ret)) -+ goto out; -+ -+ ret = mwv207_move_gtt_vram(bo, evict, ctx, new_mem); -+out: -+ ttm_resource_free(bo, &tmp_mem); -+ return ret; -+} -+ -+static int mwv207_mem_in_ram(struct ttm_resource *mem) -+{ -+ return mem->mem_type == TTM_PL_SYSTEM || mem->mem_type == TTM_PL_TT; -+} -+ -+static int mwv207_bo_move(struct ttm_buffer_object *bo, bool evict, -+ struct ttm_operation_ctx *ctx, -+ struct ttm_resource *new_mem) -+{ -+ struct ttm_resource *old_mem = &bo->mem; -+ struct mwv207_bo *jbo = to_jbo(bo); -+ struct mwv207_device *jdev; -+ int ret; -+ -+ if (WARN_ON_ONCE(jbo->pin_count > 0)) -+ return -EINVAL; -+ -+ jdev = ddev_to_jdev(jbo->tbo.base.dev); -+ if (old_mem->mem_type == TTM_PL_SYSTEM && bo->ttm == NULL) { -+ -+ ttm_bo_move_null(bo, new_mem); -+ return 0; -+ } -+ -+ if (mwv207_mem_in_ram(old_mem) && mwv207_mem_in_ram(new_mem)) { -+ -+ ttm_bo_move_null(bo, new_mem); -+ return 0; -+ } -+ -+ if (old_mem->mem_type == TTM_PL_VRAM && -+ mwv207_mem_in_ram(new_mem)) { -+ ret = mwv207_move_vram_ram(bo, evict, ctx, new_mem); -+ } else if (mwv207_mem_in_ram(old_mem) && -+ new_mem->mem_type == TTM_PL_VRAM) { -+ ret = mwv207_move_ram_vram(bo, evict, ctx, new_mem); -+ } else if (old_mem->mem_type == TTM_PL_VRAM && -+ new_mem->mem_type == TTM_PL_VRAM) { -+ ret = mwv207_move_vram_vram(bo, evict, ctx, new_mem); -+ } else { -+ ret = -EINVAL; -+ } -+ -+ if (ret == 0) -+ goto moved; -+ -+ -+ if (!mwv207_mem_visible(jdev, new_mem) -+ || !mwv207_mem_visible(jdev, old_mem)) { -+ pr_err("mwv207: can't move invisible mem by cpu"); -+ return ret; -+ } -+ ret = ttm_bo_move_memcpy(bo, ctx, new_mem); -+ if (ret) -+ return ret; -+moved: -+ if (!mwv207_mem_visible(jdev, new_mem)) -+ jbo->flags &= ~(1<<0); -+ -+ return 0; -+} -+ -+static void mwv207_bo_move_notify(struct ttm_buffer_object *bo, -+ bool evict, -+ struct ttm_resource *new_mem) -+{ -+ struct mwv207_bo *jbo; -+ struct mwv207_device *jdev; -+ -+ if (!mwv207_ttm_bo_is_mwv207_bo(bo)) -+ return; -+ jbo = to_jbo(bo); -+ jdev = ddev_to_jdev(jbo->tbo.base.dev); -+} -+ -+static int mwv207_bo_fault_reserve_notify(struct ttm_buffer_object *bo) -+{ -+ struct ttm_operation_ctx ctx = { -+ .interruptible = true, -+ .no_wait_gpu = false -+ }; -+ struct mwv207_device *jdev; -+ struct mwv207_bo *jbo; -+ u64 size, offset; -+ u32 domain; -+ int ret; -+ -+ if (!mwv207_ttm_bo_is_mwv207_bo(bo)) -+ return 0; -+ if (bo->mem.mem_type != TTM_PL_VRAM) -+ return 0; -+ -+ jbo = to_jbo(bo); -+ jdev = ddev_to_jdev(jbo->tbo.base.dev); -+ size = bo->mem.num_pages << PAGE_SHIFT; -+ offset = bo->mem.start << PAGE_SHIFT; -+ -+ jbo->flags |= (1<<0); -+ -+ if ((offset + size) <= jdev->visible_vram_size) -+ return 0; -+ -+ if (jbo->pin_count > 0) -+ return -EINVAL; -+ -+ /* TODO: -+ * 1. moving to RAM won't invoke swap, and thus causing ENOMEM when -+ * system memory is low. figure out why. -+ * 2. slide iatu window to optimize out this validation. -+ */ -+ domain = 0x2; -+retry: -+ mwv207_bo_placement_from_domain(jbo, domain, false); -+ ret = ttm_bo_validate(bo, &jbo->placement, &ctx); -+ if (unlikely(ret)) { -+ if (ret != -ERESTARTSYS) { -+ if (domain == 0x2) { -+ -+ domain = 0x1; -+ goto retry; -+ } -+ } -+ return ret; -+ } -+ -+ -+ offset = bo->mem.start << PAGE_SHIFT; -+ if (bo->mem.mem_type == TTM_PL_VRAM && -+ (offset + size) > jdev->visible_vram_size) { -+ DRM_ERROR("bo validation goes crazy"); -+ return -EINVAL; -+ } -+ -+ return ret; -+} -+ -+static int mwv207_bo_verify_access(struct ttm_buffer_object *tbo, struct file *filp) -+{ -+ return drm_vma_node_verify_access(&tbo->base.vma_node, -+ filp->private_data); -+} -+ -+static struct ttm_bo_driver mwv207_bo_driver = { -+ .ttm_tt_create = mwv207_ttm_tt_create, -+ .ttm_tt_populate = mwv207_ttm_tt_populate, -+ .ttm_tt_unpopulate = mwv207_ttm_tt_unpopulate, -+ .ttm_tt_bind = &mwv207_ttm_tt_bind, -+ .ttm_tt_unbind = &mwv207_ttm_tt_unbind, -+ .ttm_tt_destroy = &mwv207_ttm_tt_destroy, -+ .eviction_valuable = ttm_bo_eviction_valuable, -+ .evict_flags = mwv207_evict_flags, -+ .move = mwv207_bo_move, -+ .io_mem_reserve = mwv207_ttm_io_mem_reserve, -+ .move_notify = mwv207_bo_move_notify, -+ .fault_reserve_notify = &mwv207_bo_fault_reserve_notify, -+ .verify_access = mwv207_bo_verify_access, -+}; -+ -+int mwv207_ttm_init(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ ret = ttm_bo_device_init(&jdev->bdev, -+ &mwv207_bo_driver, -+ jdev->base.anon_inode->i_mapping, -+ jdev->base.vma_offset_manager, -+ true); -+ if (ret) { -+ DRM_ERROR("failed to initialize buffer object driver(%d).\n", ret); -+ return ret; -+ } -+ -+ -+ ret = ttm_range_man_init(&jdev->bdev, TTM_PL_TT, true, -+ 0x80000000ULL >> PAGE_SHIFT); -+ if (ret) { -+ DRM_ERROR("failed to initialize GTT heap.\n"); -+ goto out_no_vram; -+ } -+ -+ -+ ret = ttm_range_man_init(&jdev->bdev, TTM_PL_VRAM, false, -+ jdev->vram_size >> PAGE_SHIFT); -+ if (ret) { -+ DRM_ERROR("failed to initialize VRAM heap.\n"); -+ goto out_no_vram; -+ } -+ DRM_INFO("mwv207: %lldM of VRAM memory size\n", jdev->vram_size / (1024 * 1024)); -+ return 0; -+ -+out_no_vram: -+ ttm_bo_device_release(&jdev->bdev); -+ return ret; -+} -+ -+void mwv207_ttm_fini(struct mwv207_device *jdev) -+{ -+ ttm_range_man_fini(&jdev->bdev, TTM_PL_VRAM); -+ ttm_range_man_fini(&jdev->bdev, TTM_PL_TT); -+ ttm_bo_device_release(&jdev->bdev); -+ DRM_INFO("mwv207: ttm finalized\n"); -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_ttm.h b/drivers/gpu/drm/mwv207/mwv207_ttm.h -new file mode 100644 -index 000000000..9cbf61ed3 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_ttm.h -@@ -0,0 +1,25 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_TTM_H_TJTW9M4R -+#define MWV207_TTM_H_TJTW9M4R -+#include -+#include -+#include -+#include "mwv207.h" -+ -+int mwv207_bo_fault_reserve_notify(struct ttm_buffer_object *bo); -+ -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_vbios.c b/drivers/gpu/drm/mwv207/mwv207_vbios.c -new file mode 100644 -index 000000000..0da8244ef ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_vbios.c -@@ -0,0 +1,189 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207.h" -+#include "mwv207_vbios.h" -+ -+/* -+ */ -+static inline u8 mwv207_flash_read8(struct mwv207_device *jdev, u32 offset) -+{ -+ return ioread8(jdev->mmio + 0x100000 + offset); -+} -+ -+static inline u16 mwv207_flash_read16(struct mwv207_device *jdev, u32 offset) -+{ -+ u16 dat = ioread16(jdev->mmio + 0x100000 + offset); -+ -+ return le16_to_cpu(dat); -+} -+ -+static inline u32 mwv207_flash_read32(struct mwv207_device *jdev, u32 offset) -+{ -+ u32 dat = ioread32(jdev->mmio + 0x100000 + offset); -+ -+ return le32_to_cpu(dat); -+} -+ -+static inline void mwv207_flash_cpy(struct mwv207_device *jdev, void *dst, u32 offset, u32 len) -+{ -+ memcpy_fromio(dst, jdev->mmio + 0x100000 + offset, len); -+} -+ -+static int mwv207_vbios_check_indexer(struct mwv207_device *jdev, u32 offset) -+{ -+ u16 count, chksum, calc; -+ -+ if (mwv207_flash_read16(jdev, offset) != 0xaa55) -+ return -EINVAL; -+ -+ count = mwv207_flash_read16(jdev, offset + 2); -+ chksum = mwv207_flash_read16(jdev, offset + 4); -+ -+ jdev->vbios.sector_count = count; -+ for (calc = 0, offset += 8, count *= 8; count > 0; count--) -+ calc += mwv207_flash_read8(jdev, offset++); -+ -+ if (calc != chksum) -+ return -EINVAL; -+ -+ jdev->vbios.indexer_valid = 1; -+ return 0; -+} -+ -+static inline int mwv207_vbios_sector(struct mwv207_device *jdev, u32 idx, u32 *poffset) -+{ -+ if (poffset == NULL || !jdev->vbios.indexer_valid || idx >= jdev->vbios.sector_count) -+ return -EINVAL; -+ -+ *poffset = mwv207_flash_read32(jdev, 0xa000 + 0x8 + idx * 8 + 4); -+ return 0; -+} -+ -+static inline int mwv207_vbios_insert_vdat(struct mwv207_device *jdev, u32 key, -+ struct mwv207_vdat *vdat) -+{ -+ int ret; -+ -+ mutex_lock(&jdev->vbios.cfg_lock); -+ ret = idr_alloc(&jdev->vbios.cfg_table, vdat, key, key + 1, GFP_KERNEL); -+ mutex_unlock(&jdev->vbios.cfg_lock); -+ -+ return ret; -+} -+ -+static void mwv207_vbios_parse_hdmi(struct mwv207_device *jdev) -+{ -+ u32 count, offset, chksum, len; -+ struct mwv207_vdat *vdat[4]; -+ u32 select[4]; -+ u8 magic[8]; -+ int ret, i; -+ -+ ret = mwv207_vbios_sector(jdev, 0xa, &offset); -+ if (ret) -+ return; -+ -+ mwv207_flash_cpy(jdev, magic, offset, 8); -+ if (memcmp(magic, "JMPHYCFG", 8)) -+ return; -+ -+ len = mwv207_flash_read32(jdev, offset + 0x18); -+ if (len > 0x1200 || (len % 1140)) -+ return; -+ count = len / 1140; -+ -+ for (chksum = 0, i = 0; i < len; i += 4) -+ chksum += mwv207_flash_read32(jdev, offset + 0x20 + i); -+ if (chksum != mwv207_flash_read32(jdev, offset + 0x14)) -+ return; -+ -+ for (i = 0; i < 4; i++) { -+ select[i] = mwv207_flash_read8(jdev, offset + 0x1c + i); -+ if (select[i] > min_t(u32, 3, count - 1)) -+ return; -+ } -+ -+ for (i = 0; i < 4; i++) { -+ void *dat; -+ -+ vdat[i] = devm_kzalloc(jdev->dev, sizeof(*vdat[i]), GFP_KERNEL); -+ if (!vdat[i]) -+ return; -+ vdat[i]->len = 1140; -+ dat = devm_kmalloc(jdev->dev, vdat[i]->len, GFP_KERNEL); -+ if (!dat) -+ return; -+ mwv207_flash_cpy(jdev, dat, -+ offset + 0x20 + select[i] * 1140, -+ 1140); -+ -+ vdat[i]->dat = dat; -+ -+ (void)mwv207_vbios_insert_vdat(jdev, 0xfff0 + i, vdat[i]); -+ } -+} -+ -+static void mwv207_vbios_parse_edp(struct mwv207_device *jdev) -+{ -+ -+} -+ -+static void mwv207_vbios_parse_cfg(struct mwv207_device *jdev) -+{ -+ -+} -+ -+const struct mwv207_vdat *mwv207_vbios_vdat(struct mwv207_device *jdev, u32 key) -+{ -+ struct mwv207_vdat *dat; -+ -+ mutex_lock(&jdev->vbios.cfg_lock); -+ dat = idr_find(&jdev->vbios.cfg_table, key); -+ mutex_unlock(&jdev->vbios.cfg_lock); -+ -+ return dat; -+} -+ -+void mwv207_vbios_init(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ mutex_init(&jdev->vbios.vcmd_lock); -+ mutex_init(&jdev->vbios.cfg_lock); -+ idr_init(&jdev->vbios.cfg_table); -+ -+ ret = mwv207_vbios_check_indexer(jdev, 0xa000); -+ if (ret) { -+ pr_warn("mwv207: vbios indexer is not valid"); -+ return; -+ } -+ -+ mwv207_vbios_parse_hdmi(jdev); -+ mwv207_vbios_parse_edp(jdev); -+ mwv207_vbios_parse_cfg(jdev); -+} -+ -+void mwv207_vbios_fini(struct mwv207_device *jdev) -+{ -+ struct mwv207_vdat *vdat; -+ u32 id; -+ -+ idr_for_each_entry(&jdev->vbios.cfg_table, vdat, id) { -+ devm_kfree(jdev->dev, vdat->dat); -+ devm_kfree(jdev->dev, vdat); -+ } -+ idr_destroy(&jdev->vbios.cfg_table); -+} -diff --git a/drivers/gpu/drm/mwv207/mwv207_vbios.h b/drivers/gpu/drm/mwv207/mwv207_vbios.h -new file mode 100644 -index 000000000..75796f865 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_vbios.h -@@ -0,0 +1,51 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#ifndef MWV207_VBIOS_H_D2JHN3FG -+#define MWV207_VBIOS_H_D2JHN3FG -+ -+struct mwv207_device; -+ -+enum pll_id { -+ MWV207_PLL_GPU = 0, -+ MWV207_PLL_GRAPH0, -+ MWV207_PLL_GRAPH1, -+ MWV207_PLL_GRAPH2, -+ MWV207_PLL_GRAPH3, -+ MWV207_PLL_GRAPH4, -+ MWV207_PLL_HD, -+ MWV207_PLL_GU3D0, -+ MWV207_PLL_EDP, -+ MWV207_PLL_GU3D1, -+ MWV207_PLL_RESERVED, -+ MWV207_PLL_GU2D_PLL, -+ MWV207_PLL_DDR, -+ MWV207_PLL_COUNT -+}; -+ -+struct mwv207_vdat { -+ const void *dat; -+ u32 len; -+}; -+ -+int mwv207_vbios_set_pll(struct mwv207_device *jdev, int pll_id, u32 kfreq); -+ -+int mwv207_vbios_get_pll(struct mwv207_device *jdev, int pll_idx, unsigned long *kfreq); -+ -+const struct mwv207_vdat *mwv207_vbios_vdat(struct mwv207_device *jdev, u32 key); -+ -+void mwv207_vbios_init(struct mwv207_device *jdev); -+void mwv207_vbios_fini(struct mwv207_device *jdev); -+#endif -diff --git a/drivers/gpu/drm/mwv207/mwv207_vcmd.c b/drivers/gpu/drm/mwv207/mwv207_vcmd.c -new file mode 100644 -index 000000000..ecb373c47 ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/mwv207_vcmd.c -@@ -0,0 +1,172 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include -+#include -+#include "mwv207.h" -+#include "mwv207_vbios.h" -+ -+ -+ -+ -+static inline int mwv207_vcmd_idle(struct mwv207_device *jdev) -+{ -+ u32 state; -+ -+ state = jdev_read(jdev, (0x9b0144)) >> 28; -+ -+ return state == 0; -+} -+ -+static inline int mwv207_vcmd_wait_idle(struct mwv207_device *jdev) -+{ -+ int i; -+ -+ -+ for (i = 0; i < 1000 && !mwv207_vcmd_idle(jdev); i++) -+ usleep_range(1000, 1001); -+ return mwv207_vcmd_idle(jdev) ? 0 : -ETIMEDOUT; -+} -+ -+static inline void mwv207_vcmd_req(struct mwv207_device *jdev, int cmd, -+ int idx, u32 value, int enable) -+{ -+ u32 req; -+ -+ req = cmd << 28; -+ req |= idx << 24; -+ req |= value << 1; -+ req |= enable ? 1 : 0; -+ -+ jdev_write(jdev, (0x9b0140), req); -+} -+ -+static inline void mwv207_vcmd_start(struct mwv207_device *jdev) -+{ -+ jdev_write(jdev, (0x9b0144), 1 << 28); -+} -+ -+static inline int mwv207_vcmd_result(struct mwv207_device *jdev) -+{ -+ return (jdev_read(jdev, (0x9b0144)) >> 24) & 0xf; -+} -+ -+static int mwv207_vcmd_execute(struct mwv207_device *jdev, int cmd, -+ int idx, u32 value, int enable) -+{ -+ int ret; -+ -+ mutex_lock(&jdev->vbios.vcmd_lock); -+ -+ -+ ret = mwv207_vcmd_wait_idle(jdev); -+ if (ret) -+ goto unlock; -+ -+ -+ mwv207_vcmd_req(jdev, cmd, idx, value, enable); -+ -+ -+ mwv207_vcmd_start(jdev); -+ -+ -+ ret = mwv207_vcmd_wait_idle(jdev); -+ if (ret) -+ goto unlock; -+ -+ ret = mwv207_vcmd_result(jdev); -+ switch (ret) { -+ case 0: -+ goto unlock; -+ case 1: -+ pr_err("unsupport pll type!)"); -+ break; -+ case 2: -+ -+ pr_info_once("pll set, invalid freq!"); -+ break; -+ case 3: -+ pr_err("pll busy!"); -+ break; -+ case 4: -+ pr_err("pll set, invalid argument!"); -+ break; -+ case 9: -+ pr_err("PLL REQ cmd code unsupport!"); -+ break; -+ default: -+ pr_err("unknown pll error! (code 0x%x)", ret); -+ break; -+ } -+ ret = -EIO; -+unlock: -+ mutex_unlock(&jdev->vbios.vcmd_lock); -+ return ret; -+} -+ -+int mwv207_vbios_set_pll(struct mwv207_device *jdev, int pll_idx, u32 kfreq) -+{ -+ if (pll_idx >= MWV207_PLL_COUNT) -+ return -EINVAL; -+ -+ return mwv207_vcmd_execute(jdev, 1, pll_idx, -+ kfreq, kfreq ? 1 : 0); -+} -+ -+int mwv207_vbios_get_pll(struct mwv207_device *jdev, int pll_idx, unsigned long *kfreq) -+{ -+ u32 port, state1, state2, state3; -+ u32 refdiv, fbintdiv, fbracdiv, postdiv1, postdiv2; -+ u32 postdiv_mask, postdiv_offset; -+ u64 freq; -+ -+ if (pll_idx >= MWV207_PLL_COUNT) -+ return -EINVAL; -+ -+ port = pll_idx ? 0 : 1; -+ -+ mutex_lock(&jdev->vbios.vcmd_lock); -+ state1 = jdev_read(jdev, ((0x9B0000 + 0xA00 + (0x100 * ((pll_idx) / 6) + 0x20 * ((pll_idx) % 6))) + 0x00) ); -+ state2 = jdev_read(jdev, ((0x9B0000 + 0xA00 + (0x100 * ((pll_idx) / 6) + 0x20 * ((pll_idx) % 6))) + 0x04)); -+ state3 = jdev_read(jdev, ((0x9B0000 + 0xA00 + (0x100 * ((pll_idx) / 6) + 0x20 * ((pll_idx) % 6))) + 0x08)); -+ mutex_unlock(&jdev->vbios.vcmd_lock); -+ -+ refdiv = state1 & 0x3f; -+ fbintdiv = (state1 & 0xfff0000) >> 16; -+ fbracdiv = state2 & 0xffffff; -+ postdiv1 = 4; -+ -+ postdiv_offset = 8 * (port % 4); -+ postdiv_mask = 0x7f << postdiv_offset; -+ postdiv2 = (state3 & postdiv_mask) >> postdiv_offset; -+ -+ if (!refdiv || !postdiv1 || !postdiv2) { -+ dev_dbg(jdev->dev, "get pll failed"); -+ return -EINVAL; -+ } -+ -+ freq = 100000 * 100000ull / refdiv; -+ freq = freq * fbintdiv + ((freq * fbracdiv) >> 24); -+ freq /= postdiv1; -+ freq /= postdiv2; -+ freq = DIV_ROUND_CLOSEST_ULL(freq, 100000); -+ -+ *kfreq = freq; -+ -+ dev_dbg(jdev->dev, "get pll result: freq %llu kHz\n", freq); -+ -+ return 0; -+} -+ -diff --git a/drivers/gpu/drm/mwv207/selftest/selftest.c b/drivers/gpu/drm/mwv207/selftest/selftest.c -new file mode 100644 -index 000000000..03cc940dd ---- /dev/null -+++ b/drivers/gpu/drm/mwv207/selftest/selftest.c -@@ -0,0 +1,107 @@ -+/* -+* SPDX-License-Identifier: GPL -+* -+* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. -+* All rights reserved. -+* -+* Author: -+* shanjinkui -+* -+* The software and information contained herein is proprietary and -+* confidential to JingJiaMicro Electronics. This software can only be -+* used by JingJiaMicro Electronics Corporation. Any use, reproduction, -+* or disclosure without the written permission of JingJiaMicro -+* Electronics Corporation is strictly prohibited. -+*/ -+#include "mwv207.h" -+#include "mwv207_bo.h" -+#include "mwv207_dma.h" -+ -+ -+static int mwv207_test_create_and_map_bo(struct mwv207_device *jdev, u64 size, -+ u32 domain, u32 flags, struct mwv207_bo **pjbo, void **plogical) -+{ -+ struct mwv207_bo *jbo; -+ void *logical; -+ int ret; -+ -+ ret = mwv207_bo_create(jdev, size, 0, ttm_bo_type_kernel, -+ domain, flags, &jbo); -+ if (ret) -+ return ret; -+ ret = mwv207_bo_reserve(jbo, true); -+ if (ret) -+ goto free_bo; -+ ret = mwv207_bo_kmap_reserved(jbo, &logical); -+ if (ret) -+ goto unreserve_bo; -+ -+ *pjbo = jbo; -+ *plogical = logical; -+ return 0; -+ -+unreserve_bo: -+ mwv207_bo_unreserve(jbo); -+free_bo: -+ mwv207_bo_unref(jbo); -+ return ret; -+} -+ -+static void mwv207_test_destroy_and_unmap_bo(struct mwv207_bo *jbo) -+{ -+ if (!jbo) -+ return; -+ -+ mwv207_bo_kunmap_reserved(jbo); -+ mwv207_bo_unreserve(jbo); -+ mwv207_bo_unref(jbo); -+} -+ -+ -+static int mwv207_test_bo_acc(struct mwv207_device *jdev) -+{ -+ struct mwv207_bo *jbo; -+ int i, ret; -+ void *logical; -+ -+ ret = mwv207_test_create_and_map_bo(jdev, 0x1000, -+ 0x2, (1<<0), &jbo, &logical); -+ if (ret) -+ return ret; -+ -+ memset(logical, 0x5a, 0x1000); -+ for (i = 0; i < 0x1000; i++) { -+ if (*((char *)logical + i) != 0x5a) { -+ ret = -EIO; -+ break; -+ } -+ } -+ -+ mwv207_test_destroy_and_unmap_bo(jbo); -+ -+ return ret; -+} -+ -+static int mwv207_test_bo(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ ret = mwv207_test_bo_acc(jdev); -+ if (ret) { -+ pr_err("mwv207: bo access test failed with %d", ret); -+ return ret; -+ } -+ -+ return ret; -+} -+ -+int mwv207_test(struct mwv207_device *jdev) -+{ -+ int ret; -+ -+ ret = mwv207_test_bo(jdev); -+ if (ret == 0) -+ pr_info("mwv207 selftest passed"); -+ -+ return ret; -+} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/Kconfig b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..54555694b45cd1afabee8d31040c93edec281688 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/Kconfig @@ -0,0 +1,11 @@ +config DRM_MWV207 + tristate "MWV207 chip" + depends on DRM && SND_PCM + select DRM_KMS_HELPER + select DRM_VRAM_HELPER + select DRM_TTM + select DRM_TTM_HELPER + help + Choose this option if you have a Jingjia graphics card. + If M is selected, the module will be called mwv207 (JH91、JM9100). + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/Makefile b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/Makefile new file mode 100644 index 0000000000000000000000000000000000000000..16451149c00f491d0f7e3c9b260876c4927480a5 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/Makefile @@ -0,0 +1,51 @@ +ifneq ($(KERNELRELEASE),) + +obj-$(CONFIG_DRM_MWV207)= mwv207.o +mwv207-objs := \ + mwv207_drv.o \ + mwv207_monitor.o \ + mwv207_irq.o \ + mwv207_db.o \ + mwv207_ctx.o \ + mwv207_submit.o \ + mwv207_sched.o \ + mwv207_pipe_codec_common.o \ + mwv207_devfreq.o \ + mwv207_pipe_2d.o \ + mwv207_pipe_3d.o \ + mwv207_pipe_dec.o \ + mwv207_pipe_enc.o \ + mwv207_pipe_dma.o \ + mwv207_gem.o \ + mwv207_bo.o \ + mwv207_ttm.o \ + mwv207_hw.o \ + mwv207_vcmd.o \ + mwv207_vbios.o \ + mwv207_debugfs.o \ + mwv207_info.o \ + dc/mwv207_kms.o \ + dc/mwv207_fb.o \ + dc/mwv207_va.o \ + dc/mwv207_dp.o \ + dc/mwv207_edp.o \ + dc/mwv207_hdmi.o \ + dc/mwv207_hdmi_audio.o \ + dc/mwv207_vga.o \ + dc/mwv207_dvo.o \ + dc/mwv207_vi.o \ + dc/mwv207_i2c.o \ + selftest/selftest.o \ + +ccflags-y := -I$(src) +else + +KERNELDIR ?= /lib/modules/$(shell uname -r)/build +PWD := $(shell pwd) + +default: + $(MAKE) -C $(KERNELDIR) M=$(PWD) modules +clean: + $(MAKE) -C $(KERNELDIR) M=$(PWD) clean + +endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/ciconfig/lint.yml b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/ciconfig/lint.yml new file mode 100644 index 0000000000000000000000000000000000000000..a64c047acd5b9246e86c16c8be7f6b2ef34f8bcd --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/ciconfig/lint.yml @@ -0,0 +1,46 @@ +checkpatch: + stage: lint + rules: + - if: $CI_MERGE_REQUEST_TARGET_BRANCH_NAME == "master" + - if: $JMCI_CHECKPATCH == "1" + tags: + - SHARED_CTS_RUNNER + script: + - cp /home/gitlab-runner/ci-jobs/mwv207opendriver/checkpatch.sh . && chmod +x checkpatch.sh + - ./checkpatch.sh + artifacts: + paths: + - ./checkpatch.log + expire_in: 8h + +buildlint: + stage: lint + tags: + - MESA_KYLINV10SP1_AARCH64 + rules: + - if: $JMCI_LINTBUILD == "1" + script: + - cp /home/gitlab-runner/ci-jobs/mwv207opendriver/buildlint.sh . && chmod +x buildlint.sh + - ./buildlint.sh + +installlint: + stage: build + tags: + - MESA_KYLINV10SP1_AARCH64 + rules: + - if: $CI_MERGE_REQUEST_TARGET_BRANCH_NAME == "master" + - if: $JMCI_LINTSMOKETEST == "1" + script: + - cp /home/gitlab-runner/ci-jobs/mwv207opendriver/installko.sh . && chmod +x installko.sh + - ./installko.sh ${CI_COMMIT_SHORT_SHA} deb + +smoketest: + stage: smoketest + tags: + - MESA_KYLINV10SP1_AARCH64 + rules: + - if: $CI_MERGE_REQUEST_TARGET_BRANCH_NAME == "master" + - if: $JMCI_LINTSMOKETEST == "1" + script: + - cp /home/gitlab-runner/ci-jobs/mwv207opendriver/smoketest.sh . && chmod +x smoketest.sh + - ./smoketest.sh diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/dw-hdmi.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/dw-hdmi.h new file mode 100644 index 0000000000000000000000000000000000000000..b57a2bbde54f8e0137e0021d6d58addd52c6e099 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/dw-hdmi.h @@ -0,0 +1,551 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef __DW_HDMI_H__ +#define __DW_HDMI_H__ + +#define HDMI_FC_AUDSCHNLS7 0x106e +#define HDMI_FC_AUDSCHNLS8 0x106f + +enum { + + HDMI_PRODUCT_ID0_HDMI_TX = 0xa0, + + HDMI_PRODUCT_ID1_HDCP = 0xc0, + HDMI_PRODUCT_ID1_HDMI_RX = 0x02, + HDMI_PRODUCT_ID1_HDMI_TX = 0x01, + + HDMI_CONFIG0_I2S = 0x10, + HDMI_CONFIG0_CEC = 0x02, + + HDMI_CONFIG1_AHB = 0x01, + + HDMI_CONFIG3_AHBAUDDMA = 0x02, + HDMI_CONFIG3_GPAUD = 0x01, + + HDMI_IH_FC_INT2_OVERFLOW_MASK = 0x03, + HDMI_IH_FC_INT2_LOW_PRIORITY_OVERFLOW = 0x02, + HDMI_IH_FC_INT2_HIGH_PRIORITY_OVERFLOW = 0x01, + + HDMI_IH_FC_STAT2_OVERFLOW_MASK = 0x03, + HDMI_IH_FC_STAT2_LOW_PRIORITY_OVERFLOW = 0x02, + HDMI_IH_FC_STAT2_HIGH_PRIORITY_OVERFLOW = 0x01, + + HDMI_IH_PHY_STAT0_RX_SENSE3 = 0x20, + HDMI_IH_PHY_STAT0_RX_SENSE2 = 0x10, + HDMI_IH_PHY_STAT0_RX_SENSE1 = 0x8, + HDMI_IH_PHY_STAT0_RX_SENSE0 = 0x4, + HDMI_IH_PHY_STAT0_TX_PHY_LOCK = 0x2, + HDMI_IH_PHY_STAT0_HPD = 0x1, + + HDMI_IH_I2CM_STAT0_DONE = 0x2, + HDMI_IH_I2CM_STAT0_ERROR = 0x1, + + HDMI_IH_MUTE_I2CMPHY_STAT0_I2CMPHYDONE = 0x2, + HDMI_IH_MUTE_I2CMPHY_STAT0_I2CMPHYERROR = 0x1, + + HDMI_IH_AHBDMAAUD_STAT0_BUFFOVERRUN = 0x40, + HDMI_IH_AHBDMAAUD_STAT0_ERROR = 0x20, + HDMI_IH_AHBDMAAUD_STAT0_LOST = 0x10, + HDMI_IH_AHBDMAAUD_STAT0_RETRY = 0x08, + HDMI_IH_AHBDMAAUD_STAT0_DONE = 0x04, + HDMI_IH_AHBDMAAUD_STAT0_BUFFFULL = 0x02, + HDMI_IH_AHBDMAAUD_STAT0_BUFFEMPTY = 0x01, + HDMI_IH_AHBDMAAUD_STAT0_MASK = + (HDMI_IH_AHBDMAAUD_STAT0_BUFFOVERRUN | + HDMI_IH_AHBDMAAUD_STAT0_ERROR | + HDMI_IH_AHBDMAAUD_STAT0_LOST | + HDMI_IH_AHBDMAAUD_STAT0_RETRY | + HDMI_IH_AHBDMAAUD_STAT0_DONE | + HDMI_IH_AHBDMAAUD_STAT0_BUFFFULL | + HDMI_IH_AHBDMAAUD_STAT0_BUFFEMPTY), + + HDMI_IH_MUTE_FC_STAT2_OVERFLOW_MASK = 0x03, + HDMI_IH_MUTE_FC_STAT2_LOW_PRIORITY_OVERFLOW = 0x02, + HDMI_IH_MUTE_FC_STAT2_HIGH_PRIORITY_OVERFLOW = 0x01, + + HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFOVERRUN = 0x40, + HDMI_IH_MUTE_AHBDMAAUD_STAT0_ERROR = 0x20, + HDMI_IH_MUTE_AHBDMAAUD_STAT0_LOST = 0x10, + HDMI_IH_MUTE_AHBDMAAUD_STAT0_RETRY = 0x08, + HDMI_IH_MUTE_AHBDMAAUD_STAT0_DONE = 0x04, + HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFFULL = 0x02, + HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFEMPTY = 0x01, + HDMI_IH_MUTE_AHBDMAAUD_STAT0_MASK = + (HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFOVERRUN | + HDMI_IH_MUTE_AHBDMAAUD_STAT0_ERROR | + HDMI_IH_MUTE_AHBDMAAUD_STAT0_LOST | + HDMI_IH_MUTE_AHBDMAAUD_STAT0_RETRY | + HDMI_IH_MUTE_AHBDMAAUD_STAT0_DONE | + HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFFULL | + HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFEMPTY), + + HDMI_IH_MUTE_MUTE_WAKEUP_INTERRUPT = 0x2, + HDMI_IH_MUTE_MUTE_ALL_INTERRUPT = 0x1, + + HDMI_TX_INVID0_INTERNAL_DE_GENERATOR_MASK = 0x80, + HDMI_TX_INVID0_INTERNAL_DE_GENERATOR_ENABLE = 0x80, + HDMI_TX_INVID0_INTERNAL_DE_GENERATOR_DISABLE = 0x00, + HDMI_TX_INVID0_VIDEO_MAPPING_MASK = 0x1F, + HDMI_TX_INVID0_VIDEO_MAPPING_OFFSET = 0, + + HDMI_TX_INSTUFFING_BDBDATA_STUFFING_MASK = 0x4, + HDMI_TX_INSTUFFING_BDBDATA_STUFFING_ENABLE = 0x4, + HDMI_TX_INSTUFFING_BDBDATA_STUFFING_DISABLE = 0x0, + HDMI_TX_INSTUFFING_RCRDATA_STUFFING_MASK = 0x2, + HDMI_TX_INSTUFFING_RCRDATA_STUFFING_ENABLE = 0x2, + HDMI_TX_INSTUFFING_RCRDATA_STUFFING_DISABLE = 0x0, + HDMI_TX_INSTUFFING_GYDATA_STUFFING_MASK = 0x1, + HDMI_TX_INSTUFFING_GYDATA_STUFFING_ENABLE = 0x1, + HDMI_TX_INSTUFFING_GYDATA_STUFFING_DISABLE = 0x0, + + HDMI_VP_PR_CD_COLOR_DEPTH_MASK = 0xF0, + HDMI_VP_PR_CD_COLOR_DEPTH_OFFSET = 4, + HDMI_VP_PR_CD_DESIRED_PR_FACTOR_MASK = 0x0F, + HDMI_VP_PR_CD_DESIRED_PR_FACTOR_OFFSET = 0, + + HDMI_VP_STUFF_IDEFAULT_PHASE_MASK = 0x20, + HDMI_VP_STUFF_IDEFAULT_PHASE_OFFSET = 5, + HDMI_VP_STUFF_IFIX_PP_TO_LAST_MASK = 0x10, + HDMI_VP_STUFF_IFIX_PP_TO_LAST_OFFSET = 4, + HDMI_VP_STUFF_ICX_GOTO_P0_ST_MASK = 0x8, + HDMI_VP_STUFF_ICX_GOTO_P0_ST_OFFSET = 3, + HDMI_VP_STUFF_YCC422_STUFFING_MASK = 0x4, + HDMI_VP_STUFF_YCC422_STUFFING_STUFFING_MODE = 0x4, + HDMI_VP_STUFF_YCC422_STUFFING_DIRECT_MODE = 0x0, + HDMI_VP_STUFF_PP_STUFFING_MASK = 0x2, + HDMI_VP_STUFF_PP_STUFFING_STUFFING_MODE = 0x2, + HDMI_VP_STUFF_PP_STUFFING_DIRECT_MODE = 0x0, + HDMI_VP_STUFF_PR_STUFFING_MASK = 0x1, + HDMI_VP_STUFF_PR_STUFFING_STUFFING_MODE = 0x1, + HDMI_VP_STUFF_PR_STUFFING_DIRECT_MODE = 0x0, + + HDMI_VP_CONF_BYPASS_EN_MASK = 0x40, + HDMI_VP_CONF_BYPASS_EN_ENABLE = 0x40, + HDMI_VP_CONF_BYPASS_EN_DISABLE = 0x00, + HDMI_VP_CONF_PP_EN_ENMASK = 0x20, + HDMI_VP_CONF_PP_EN_ENABLE = 0x20, + HDMI_VP_CONF_PP_EN_DISABLE = 0x00, + HDMI_VP_CONF_PR_EN_MASK = 0x10, + HDMI_VP_CONF_PR_EN_ENABLE = 0x10, + HDMI_VP_CONF_PR_EN_DISABLE = 0x00, + HDMI_VP_CONF_YCC422_EN_MASK = 0x8, + HDMI_VP_CONF_YCC422_EN_ENABLE = 0x8, + HDMI_VP_CONF_YCC422_EN_DISABLE = 0x0, + HDMI_VP_CONF_BYPASS_SELECT_MASK = 0x4, + HDMI_VP_CONF_BYPASS_SELECT_VID_PACKETIZER = 0x4, + HDMI_VP_CONF_BYPASS_SELECT_PIX_REPEATER = 0x0, + HDMI_VP_CONF_OUTPUT_SELECTOR_MASK = 0x3, + HDMI_VP_CONF_OUTPUT_SELECTOR_BYPASS = 0x3, + HDMI_VP_CONF_OUTPUT_SELECTOR_YCC422 = 0x1, + HDMI_VP_CONF_OUTPUT_SELECTOR_PP = 0x0, + + HDMI_VP_REMAP_MASK = 0x3, + HDMI_VP_REMAP_YCC422_24bit = 0x2, + HDMI_VP_REMAP_YCC422_20bit = 0x1, + HDMI_VP_REMAP_YCC422_16bit = 0x0, + + HDMI_FC_INVIDCONF_HDCP_KEEPOUT_MASK = 0x80, + HDMI_FC_INVIDCONF_HDCP_KEEPOUT_ACTIVE = 0x80, + HDMI_FC_INVIDCONF_HDCP_KEEPOUT_INACTIVE = 0x00, + HDMI_FC_INVIDCONF_VSYNC_IN_POLARITY_MASK = 0x40, + HDMI_FC_INVIDCONF_VSYNC_IN_POLARITY_ACTIVE_HIGH = 0x40, + HDMI_FC_INVIDCONF_VSYNC_IN_POLARITY_ACTIVE_LOW = 0x00, + HDMI_FC_INVIDCONF_HSYNC_IN_POLARITY_MASK = 0x20, + HDMI_FC_INVIDCONF_HSYNC_IN_POLARITY_ACTIVE_HIGH = 0x20, + HDMI_FC_INVIDCONF_HSYNC_IN_POLARITY_ACTIVE_LOW = 0x00, + HDMI_FC_INVIDCONF_DE_IN_POLARITY_MASK = 0x10, + HDMI_FC_INVIDCONF_DE_IN_POLARITY_ACTIVE_HIGH = 0x10, + HDMI_FC_INVIDCONF_DE_IN_POLARITY_ACTIVE_LOW = 0x00, + HDMI_FC_INVIDCONF_DVI_MODEZ_MASK = 0x8, + HDMI_FC_INVIDCONF_DVI_MODEZ_HDMI_MODE = 0x8, + HDMI_FC_INVIDCONF_DVI_MODEZ_DVI_MODE = 0x0, + HDMI_FC_INVIDCONF_R_V_BLANK_IN_OSC_MASK = 0x2, + HDMI_FC_INVIDCONF_R_V_BLANK_IN_OSC_ACTIVE_HIGH = 0x2, + HDMI_FC_INVIDCONF_R_V_BLANK_IN_OSC_ACTIVE_LOW = 0x0, + HDMI_FC_INVIDCONF_IN_I_P_MASK = 0x1, + HDMI_FC_INVIDCONF_IN_I_P_INTERLACED = 0x1, + HDMI_FC_INVIDCONF_IN_I_P_PROGRESSIVE = 0x0, + + HDMI_FC_AUDICONF0_CC_OFFSET = 4, + HDMI_FC_AUDICONF0_CC_MASK = 0x70, + HDMI_FC_AUDICONF0_CT_OFFSET = 0, + HDMI_FC_AUDICONF0_CT_MASK = 0xF, + + HDMI_FC_AUDICONF1_SS_OFFSET = 3, + HDMI_FC_AUDICONF1_SS_MASK = 0x18, + HDMI_FC_AUDICONF1_SF_OFFSET = 0, + HDMI_FC_AUDICONF1_SF_MASK = 0x7, + + HDMI_FC_AUDICONF3_LFEPBL_OFFSET = 5, + HDMI_FC_AUDICONF3_LFEPBL_MASK = 0x60, + HDMI_FC_AUDICONF3_DM_INH_OFFSET = 4, + HDMI_FC_AUDICONF3_DM_INH_MASK = 0x10, + HDMI_FC_AUDICONF3_LSV_OFFSET = 0, + HDMI_FC_AUDICONF3_LSV_MASK = 0xF, + + HDMI_FC_AUDSCHNLS0_CGMSA_OFFSET = 4, + HDMI_FC_AUDSCHNLS0_CGMSA_MASK = 0x30, + HDMI_FC_AUDSCHNLS0_COPYRIGHT_OFFSET = 0, + HDMI_FC_AUDSCHNLS0_COPYRIGHT_MASK = 0x01, + + HDMI_FC_AUDSCHNLS3_OIEC_CH0_OFFSET = 0, + HDMI_FC_AUDSCHNLS3_OIEC_CH0_MASK = 0x0f, + HDMI_FC_AUDSCHNLS3_OIEC_CH1_OFFSET = 4, + HDMI_FC_AUDSCHNLS3_OIEC_CH1_MASK = 0xf0, + HDMI_FC_AUDSCHNLS4_OIEC_CH2_OFFSET = 0, + HDMI_FC_AUDSCHNLS4_OIEC_CH2_MASK = 0x0f, + HDMI_FC_AUDSCHNLS4_OIEC_CH3_OFFSET = 4, + HDMI_FC_AUDSCHNLS4_OIEC_CH3_MASK = 0xf0, + + HDMI_FC_AUDSCHNLS5_OIEC_CH0_OFFSET = 0, + HDMI_FC_AUDSCHNLS5_OIEC_CH0_MASK = 0x0f, + HDMI_FC_AUDSCHNLS5_OIEC_CH1_OFFSET = 4, + HDMI_FC_AUDSCHNLS5_OIEC_CH1_MASK = 0xf0, + HDMI_FC_AUDSCHNLS6_OIEC_CH2_OFFSET = 0, + HDMI_FC_AUDSCHNLS6_OIEC_CH2_MASK = 0x0f, + HDMI_FC_AUDSCHNLS6_OIEC_CH3_OFFSET = 4, + HDMI_FC_AUDSCHNLS6_OIEC_CH3_MASK = 0xf0, + + HDMI_FC_AUDSCHNLS7_ACCURACY_OFFSET = 4, + HDMI_FC_AUDSCHNLS7_ACCURACY_MASK = 0x30, + + HDMI_FC_AUDSCHNLS8_ORIGSAMPFREQ_MASK = 0xf0, + HDMI_FC_AUDSCHNLS8_ORIGSAMPFREQ_OFFSET = 4, + HDMI_FC_AUDSCHNLS8_WORDLEGNTH_MASK = 0x0f, + HDMI_FC_AUDSCHNLS8_WORDLEGNTH_OFFSET = 0, + + HDMI_FC_AUDSCONF_AUD_PACKET_SAMPFIT_MASK = 0xF0, + HDMI_FC_AUDSCONF_AUD_PACKET_SAMPFIT_OFFSET = 4, + HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_MASK = 0x1, + HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_OFFSET = 0, + HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_LAYOUT1 = 0x1, + HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_LAYOUT0 = 0x0, + + HDMI_FC_STAT2_OVERFLOW_MASK = 0x03, + HDMI_FC_STAT2_LOW_PRIORITY_OVERFLOW = 0x02, + HDMI_FC_STAT2_HIGH_PRIORITY_OVERFLOW = 0x01, + + HDMI_FC_INT2_OVERFLOW_MASK = 0x03, + HDMI_FC_INT2_LOW_PRIORITY_OVERFLOW = 0x02, + HDMI_FC_INT2_HIGH_PRIORITY_OVERFLOW = 0x01, + + HDMI_FC_MASK2_OVERFLOW_MASK = 0x03, + HDMI_FC_MASK2_LOW_PRIORITY_OVERFLOW = 0x02, + HDMI_FC_MASK2_HIGH_PRIORITY_OVERFLOW = 0x01, + + HDMI_FC_PRCONF_INCOMING_PR_FACTOR_MASK = 0xF0, + HDMI_FC_PRCONF_INCOMING_PR_FACTOR_OFFSET = 4, + HDMI_FC_PRCONF_OUTPUT_PR_FACTOR_MASK = 0x0F, + HDMI_FC_PRCONF_OUTPUT_PR_FACTOR_OFFSET = 0, + + HDMI_FC_PACKET_TX_EN_DRM_MASK = 0x80, + HDMI_FC_PACKET_TX_EN_DRM_ENABLE = 0x80, + HDMI_FC_PACKET_TX_EN_DRM_DISABLE = 0x00, + + HDMI_FC_AVICONF0_PIX_FMT_MASK = 0x03, + HDMI_FC_AVICONF0_PIX_FMT_RGB = 0x00, + HDMI_FC_AVICONF0_PIX_FMT_YCBCR422 = 0x01, + HDMI_FC_AVICONF0_PIX_FMT_YCBCR444 = 0x02, + HDMI_FC_AVICONF0_ACTIVE_FMT_MASK = 0x40, + HDMI_FC_AVICONF0_ACTIVE_FMT_INFO_PRESENT = 0x40, + HDMI_FC_AVICONF0_ACTIVE_FMT_NO_INFO = 0x00, + HDMI_FC_AVICONF0_BAR_DATA_MASK = 0x0C, + HDMI_FC_AVICONF0_BAR_DATA_NO_DATA = 0x00, + HDMI_FC_AVICONF0_BAR_DATA_VERT_BAR = 0x04, + HDMI_FC_AVICONF0_BAR_DATA_HORIZ_BAR = 0x08, + HDMI_FC_AVICONF0_BAR_DATA_VERT_HORIZ_BAR = 0x0C, + HDMI_FC_AVICONF0_SCAN_INFO_MASK = 0x30, + HDMI_FC_AVICONF0_SCAN_INFO_OVERSCAN = 0x10, + HDMI_FC_AVICONF0_SCAN_INFO_UNDERSCAN = 0x20, + HDMI_FC_AVICONF0_SCAN_INFO_NODATA = 0x00, + + HDMI_FC_AVICONF1_ACTIVE_ASPECT_RATIO_MASK = 0x0F, + HDMI_FC_AVICONF1_ACTIVE_ASPECT_RATIO_USE_CODED = 0x08, + HDMI_FC_AVICONF1_ACTIVE_ASPECT_RATIO_4_3 = 0x09, + HDMI_FC_AVICONF1_ACTIVE_ASPECT_RATIO_16_9 = 0x0A, + HDMI_FC_AVICONF1_ACTIVE_ASPECT_RATIO_14_9 = 0x0B, + HDMI_FC_AVICONF1_CODED_ASPECT_RATIO_MASK = 0x30, + HDMI_FC_AVICONF1_CODED_ASPECT_RATIO_NO_DATA = 0x00, + HDMI_FC_AVICONF1_CODED_ASPECT_RATIO_4_3 = 0x10, + HDMI_FC_AVICONF1_CODED_ASPECT_RATIO_16_9 = 0x20, + HDMI_FC_AVICONF1_COLORIMETRY_MASK = 0xC0, + HDMI_FC_AVICONF1_COLORIMETRY_NO_DATA = 0x00, + HDMI_FC_AVICONF1_COLORIMETRY_SMPTE = 0x40, + HDMI_FC_AVICONF1_COLORIMETRY_ITUR = 0x80, + HDMI_FC_AVICONF1_COLORIMETRY_EXTENDED_INFO = 0xC0, + + HDMI_FC_AVICONF2_SCALING_MASK = 0x03, + HDMI_FC_AVICONF2_SCALING_NONE = 0x00, + HDMI_FC_AVICONF2_SCALING_HORIZ = 0x01, + HDMI_FC_AVICONF2_SCALING_VERT = 0x02, + HDMI_FC_AVICONF2_SCALING_HORIZ_VERT = 0x03, + HDMI_FC_AVICONF2_RGB_QUANT_MASK = 0x0C, + HDMI_FC_AVICONF2_RGB_QUANT_DEFAULT = 0x00, + HDMI_FC_AVICONF2_RGB_QUANT_LIMITED_RANGE = 0x04, + HDMI_FC_AVICONF2_RGB_QUANT_FULL_RANGE = 0x08, + HDMI_FC_AVICONF2_EXT_COLORIMETRY_MASK = 0x70, + HDMI_FC_AVICONF2_EXT_COLORIMETRY_XVYCC601 = 0x00, + HDMI_FC_AVICONF2_EXT_COLORIMETRY_XVYCC709 = 0x10, + HDMI_FC_AVICONF2_EXT_COLORIMETRY_SYCC601 = 0x20, + HDMI_FC_AVICONF2_EXT_COLORIMETRY_ADOBE_YCC601 = 0x30, + HDMI_FC_AVICONF2_EXT_COLORIMETRY_ADOBE_RGB = 0x40, + HDMI_FC_AVICONF2_IT_CONTENT_MASK = 0x80, + HDMI_FC_AVICONF2_IT_CONTENT_NO_DATA = 0x00, + HDMI_FC_AVICONF2_IT_CONTENT_VALID = 0x80, + + HDMI_FC_AVICONF3_IT_CONTENT_TYPE_MASK = 0x03, + HDMI_FC_AVICONF3_IT_CONTENT_TYPE_GRAPHICS = 0x00, + HDMI_FC_AVICONF3_IT_CONTENT_TYPE_PHOTO = 0x01, + HDMI_FC_AVICONF3_IT_CONTENT_TYPE_CINEMA = 0x02, + HDMI_FC_AVICONF3_IT_CONTENT_TYPE_GAME = 0x03, + HDMI_FC_AVICONF3_QUANT_RANGE_MASK = 0x0C, + HDMI_FC_AVICONF3_QUANT_RANGE_LIMITED = 0x00, + HDMI_FC_AVICONF3_QUANT_RANGE_FULL = 0x04, + + HDMI_FC_DBGFORCE_FORCEAUDIO = 0x10, + HDMI_FC_DBGFORCE_FORCEVIDEO = 0x1, + + HDMI_FC_DATAUTO0_VSD_MASK = 0x08, + HDMI_FC_DATAUTO0_VSD_OFFSET = 3, + + HDMI_PHY_CONF0_PDZ_MASK = 0x80, + HDMI_PHY_CONF0_PDZ_OFFSET = 7, + HDMI_PHY_CONF0_ENTMDS_MASK = 0x40, + HDMI_PHY_CONF0_ENTMDS_OFFSET = 6, + HDMI_PHY_CONF0_SVSRET_MASK = 0x20, + HDMI_PHY_CONF0_SVSRET_OFFSET = 5, + HDMI_PHY_CONF0_GEN2_PDDQ_MASK = 0x10, + HDMI_PHY_CONF0_GEN2_PDDQ_OFFSET = 4, + HDMI_PHY_CONF0_GEN2_TXPWRON_MASK = 0x8, + HDMI_PHY_CONF0_GEN2_TXPWRON_OFFSET = 3, + HDMI_PHY_CONF0_GEN2_ENHPDRXSENSE_MASK = 0x4, + HDMI_PHY_CONF0_GEN2_ENHPDRXSENSE_OFFSET = 2, + HDMI_PHY_CONF0_SELDATAENPOL_MASK = 0x2, + HDMI_PHY_CONF0_SELDATAENPOL_OFFSET = 1, + HDMI_PHY_CONF0_SELDIPIF_MASK = 0x1, + HDMI_PHY_CONF0_SELDIPIF_OFFSET = 0, + + HDMI_PHY_TST0_TSTCLR_MASK = 0x20, + HDMI_PHY_TST0_TSTCLR_OFFSET = 5, + HDMI_PHY_TST0_TSTEN_MASK = 0x10, + HDMI_PHY_TST0_TSTEN_OFFSET = 4, + HDMI_PHY_TST0_TSTCLK_MASK = 0x1, + HDMI_PHY_TST0_TSTCLK_OFFSET = 0, + + HDMI_PHY_RX_SENSE3 = 0x80, + HDMI_PHY_RX_SENSE2 = 0x40, + HDMI_PHY_RX_SENSE1 = 0x20, + HDMI_PHY_RX_SENSE0 = 0x10, + HDMI_PHY_HPD = 0x02, + HDMI_PHY_TX_PHY_LOCK = 0x01, + + HDMI_PHY_I2CM_SLAVE_ADDR_PHY_GEN2 = 0x69, + HDMI_PHY_I2CM_SLAVE_ADDR_HEAC_PHY = 0x49, + + HDMI_PHY_I2CM_OPERATION_ADDR_WRITE = 0x10, + HDMI_PHY_I2CM_OPERATION_ADDR_READ = 0x1, + + HDMI_PHY_I2CM_INT_ADDR_DONE_POL = 0x08, + HDMI_PHY_I2CM_INT_ADDR_DONE_MASK = 0x04, + + HDMI_PHY_I2CM_CTLINT_ADDR_NAC_POL = 0x80, + HDMI_PHY_I2CM_CTLINT_ADDR_NAC_MASK = 0x40, + HDMI_PHY_I2CM_CTLINT_ADDR_ARBITRATION_POL = 0x08, + HDMI_PHY_I2CM_CTLINT_ADDR_ARBITRATION_MASK = 0x04, + + HDMI_AUD_CONF0_SW_RESET = 0x80, + HDMI_AUD_CONF0_I2S_SELECT = 0x20, + HDMI_AUD_CONF0_I2S_EN3 = 0x08, + HDMI_AUD_CONF0_I2S_EN2 = 0x04, + HDMI_AUD_CONF0_I2S_EN1 = 0x02, + HDMI_AUD_CONF0_I2S_EN0 = 0x01, + + HDMI_AUD_CONF1_MODE_I2S = 0x00, + HDMI_AUD_CONF1_MODE_RIGHT_J = 0x20, + HDMI_AUD_CONF1_MODE_LEFT_J = 0x40, + HDMI_AUD_CONF1_MODE_BURST_1 = 0x60, + HDMI_AUD_CONF1_MODE_BURST_2 = 0x80, + HDMI_AUD_CONF1_WIDTH_16 = 0x10, + HDMI_AUD_CONF1_WIDTH_24 = 0x18, + + HDMI_AUD_CTS3_N_SHIFT_OFFSET = 5, + HDMI_AUD_CTS3_N_SHIFT_MASK = 0xe0, + HDMI_AUD_CTS3_N_SHIFT_1 = 0, + HDMI_AUD_CTS3_N_SHIFT_16 = 0x20, + HDMI_AUD_CTS3_N_SHIFT_32 = 0x40, + HDMI_AUD_CTS3_N_SHIFT_64 = 0x60, + HDMI_AUD_CTS3_N_SHIFT_128 = 0x80, + HDMI_AUD_CTS3_N_SHIFT_256 = 0xa0, + HDMI_AUD_CTS3_CTS_MANUAL = 0x10, + HDMI_AUD_CTS3_AUDCTS19_16_MASK = 0x0f, + + HDMI_AUD_INPUTCLKFS_128FS = 0, + HDMI_AUD_INPUTCLKFS_256FS = 1, + HDMI_AUD_INPUTCLKFS_512FS = 2, + HDMI_AUD_INPUTCLKFS_64FS = 4, + + HDMI_AHB_DMA_CONF0_SW_FIFO_RST_OFFSET = 7, + HDMI_AHB_DMA_CONF0_SW_FIFO_RST_MASK = 0x80, + HDMI_AHB_DMA_CONF0_INSERT_PCUV = 0x40, + HDMI_AHB_DMA_CONF0_HBR = 0x10, + HDMI_AHB_DMA_CONF0_EN_HLOCK_OFFSET = 3, + HDMI_AHB_DMA_CONF0_EN_HLOCK_MASK = 0x08, + HDMI_AHB_DMA_CONF0_INCR_TYPE_OFFSET = 1, + HDMI_AHB_DMA_CONF0_INCR_TYPE_MASK = 0x06, + HDMI_AHB_DMA_CONF0_INCR4 = 0x0, + HDMI_AHB_DMA_CONF0_INCR8 = 0x2, + HDMI_AHB_DMA_CONF0_INCR16 = 0x4, + HDMI_AHB_DMA_CONF0_BURST_MODE = 0x1, + + HDMI_AHB_DMA_START_START_OFFSET = 0, + HDMI_AHB_DMA_START_START_MASK = 0x01, + + HDMI_AHB_DMA_STOP_STOP_OFFSET = 0, + HDMI_AHB_DMA_STOP_STOP_MASK = 0x01, + + HDMI_AHB_DMA_DONE = 0x80, + HDMI_AHB_DMA_RETRY_SPLIT = 0x40, + HDMI_AHB_DMA_LOSTOWNERSHIP = 0x20, + HDMI_AHB_DMA_ERROR = 0x10, + HDMI_AHB_DMA_FIFO_THREMPTY = 0x04, + HDMI_AHB_DMA_FIFO_FULL = 0x02, + HDMI_AHB_DMA_FIFO_EMPTY = 0x01, + HDMI_AHB_DMA_MASK_MASK = + (HDMI_AHB_DMA_DONE | + HDMI_AHB_DMA_RETRY_SPLIT | + HDMI_AHB_DMA_LOSTOWNERSHIP | + HDMI_AHB_DMA_ERROR | + HDMI_AHB_DMA_FIFO_THREMPTY | + HDMI_AHB_DMA_FIFO_FULL | HDMI_AHB_DMA_FIFO_EMPTY), + + HDMI_AHB_DMA_BUFFSTAT_FULL = 0x02, + HDMI_AHB_DMA_BUFFSTAT_EMPTY = 0x01, + + HDMI_MC_CLKDIS_HDCPCLK_DISABLE = 0x40, + HDMI_MC_CLKDIS_CECCLK_DISABLE = 0x20, + HDMI_MC_CLKDIS_CSCCLK_DISABLE = 0x10, + HDMI_MC_CLKDIS_AUDCLK_DISABLE = 0x8, + HDMI_MC_CLKDIS_PREPCLK_DISABLE = 0x4, + HDMI_MC_CLKDIS_TMDSCLK_DISABLE = 0x2, + HDMI_MC_CLKDIS_PIXELCLK_DISABLE = 0x1, + + HDMI_MC_SWRSTZ_I2SSWRST_REQ = 0x08, + HDMI_MC_SWRSTZ_TMDSSWRST_REQ = 0x02, + + HDMI_MC_FLOWCTRL_FEED_THROUGH_OFF_MASK = 0x1, + HDMI_MC_FLOWCTRL_FEED_THROUGH_OFF_CSC_IN_PATH = 0x1, + HDMI_MC_FLOWCTRL_FEED_THROUGH_OFF_CSC_BYPASS = 0x0, + + HDMI_MC_PHYRSTZ_PHYRSTZ = 0x01, + + HDMI_MC_HEACPHY_RST_ASSERT = 0x1, + HDMI_MC_HEACPHY_RST_DEASSERT = 0x0, + + HDMI_CSC_CFG_INTMODE_MASK = 0x30, + HDMI_CSC_CFG_INTMODE_OFFSET = 4, + HDMI_CSC_CFG_INTMODE_DISABLE = 0x00, + HDMI_CSC_CFG_INTMODE_CHROMA_INT_FORMULA1 = 0x10, + HDMI_CSC_CFG_INTMODE_CHROMA_INT_FORMULA2 = 0x20, + HDMI_CSC_CFG_DECMODE_MASK = 0x3, + HDMI_CSC_CFG_DECMODE_OFFSET = 0, + HDMI_CSC_CFG_DECMODE_DISABLE = 0x0, + HDMI_CSC_CFG_DECMODE_CHROMA_INT_FORMULA1 = 0x1, + HDMI_CSC_CFG_DECMODE_CHROMA_INT_FORMULA2 = 0x2, + HDMI_CSC_CFG_DECMODE_CHROMA_INT_FORMULA3 = 0x3, + + HDMI_CSC_SCALE_CSC_COLORDE_PTH_MASK = 0xF0, + HDMI_CSC_SCALE_CSC_COLORDE_PTH_24BPP = 0x00, + HDMI_CSC_SCALE_CSC_COLORDE_PTH_30BPP = 0x50, + HDMI_CSC_SCALE_CSC_COLORDE_PTH_36BPP = 0x60, + HDMI_CSC_SCALE_CSC_COLORDE_PTH_48BPP = 0x70, + HDMI_CSC_SCALE_CSCSCALE_MASK = 0x03, + + HDMI_A_HDCPCFG0_ELVENA_MASK = 0x80, + HDMI_A_HDCPCFG0_ELVENA_ENABLE = 0x80, + HDMI_A_HDCPCFG0_ELVENA_DISABLE = 0x00, + HDMI_A_HDCPCFG0_I2CFASTMODE_MASK = 0x40, + HDMI_A_HDCPCFG0_I2CFASTMODE_ENABLE = 0x40, + HDMI_A_HDCPCFG0_I2CFASTMODE_DISABLE = 0x00, + HDMI_A_HDCPCFG0_BYPENCRYPTION_MASK = 0x20, + HDMI_A_HDCPCFG0_BYPENCRYPTION_ENABLE = 0x20, + HDMI_A_HDCPCFG0_BYPENCRYPTION_DISABLE = 0x00, + HDMI_A_HDCPCFG0_SYNCRICHECK_MASK = 0x10, + HDMI_A_HDCPCFG0_SYNCRICHECK_ENABLE = 0x10, + HDMI_A_HDCPCFG0_SYNCRICHECK_DISABLE = 0x00, + HDMI_A_HDCPCFG0_AVMUTE_MASK = 0x8, + HDMI_A_HDCPCFG0_AVMUTE_ENABLE = 0x8, + HDMI_A_HDCPCFG0_AVMUTE_DISABLE = 0x0, + HDMI_A_HDCPCFG0_RXDETECT_MASK = 0x4, + HDMI_A_HDCPCFG0_RXDETECT_ENABLE = 0x4, + HDMI_A_HDCPCFG0_RXDETECT_DISABLE = 0x0, + HDMI_A_HDCPCFG0_EN11FEATURE_MASK = 0x2, + HDMI_A_HDCPCFG0_EN11FEATURE_ENABLE = 0x2, + HDMI_A_HDCPCFG0_EN11FEATURE_DISABLE = 0x0, + HDMI_A_HDCPCFG0_HDMIDVI_MASK = 0x1, + HDMI_A_HDCPCFG0_HDMIDVI_HDMI = 0x1, + HDMI_A_HDCPCFG0_HDMIDVI_DVI = 0x0, + + HDMI_A_HDCPCFG1_DISSHA1CHECK_MASK = 0x8, + HDMI_A_HDCPCFG1_DISSHA1CHECK_DISABLE = 0x8, + HDMI_A_HDCPCFG1_DISSHA1CHECK_ENABLE = 0x0, + HDMI_A_HDCPCFG1_PH2UPSHFTENC_MASK = 0x4, + HDMI_A_HDCPCFG1_PH2UPSHFTENC_ENABLE = 0x4, + HDMI_A_HDCPCFG1_PH2UPSHFTENC_DISABLE = 0x0, + HDMI_A_HDCPCFG1_ENCRYPTIONDISABLE_MASK = 0x2, + HDMI_A_HDCPCFG1_ENCRYPTIONDISABLE_DISABLE = 0x2, + HDMI_A_HDCPCFG1_ENCRYPTIONDISABLE_ENABLE = 0x0, + HDMI_A_HDCPCFG1_SWRESET_MASK = 0x1, + HDMI_A_HDCPCFG1_SWRESET_ASSERT = 0x0, + + HDMI_A_VIDPOLCFG_UNENCRYPTCONF_MASK = 0x60, + HDMI_A_VIDPOLCFG_UNENCRYPTCONF_OFFSET = 5, + HDMI_A_VIDPOLCFG_DATAENPOL_MASK = 0x10, + HDMI_A_VIDPOLCFG_DATAENPOL_ACTIVE_HIGH = 0x10, + HDMI_A_VIDPOLCFG_DATAENPOL_ACTIVE_LOW = 0x0, + HDMI_A_VIDPOLCFG_VSYNCPOL_MASK = 0x8, + HDMI_A_VIDPOLCFG_VSYNCPOL_ACTIVE_HIGH = 0x8, + HDMI_A_VIDPOLCFG_VSYNCPOL_ACTIVE_LOW = 0x0, + HDMI_A_VIDPOLCFG_HSYNCPOL_MASK = 0x2, + HDMI_A_VIDPOLCFG_HSYNCPOL_ACTIVE_HIGH = 0x2, + HDMI_A_VIDPOLCFG_HSYNCPOL_ACTIVE_LOW = 0x0, + + HDMI_I2CM_OPERATION_WRITE = 0x10, + HDMI_I2CM_OPERATION_READ_EXT = 0x2, + HDMI_I2CM_OPERATION_READ = 0x1, + + HDMI_I2CM_INT_DONE_POL = 0x8, + HDMI_I2CM_INT_DONE_MASK = 0x4, + + HDMI_I2CM_CTLINT_NAC_POL = 0x80, + HDMI_I2CM_CTLINT_NAC_MASK = 0x40, + HDMI_I2CM_CTLINT_ARB_POL = 0x8, + HDMI_I2CM_CTLINT_ARB_MASK = 0x4, +}; + +#define HDMI_FC_AUDSCHNLS7 0x106e +#define HDMI_FC_AUDSCHNLS8 0x106f + +#define for_each_port(_card, _portid) \ + for ((_portid) = 0; (_portid) < (_card)->port_nr; (_portid)++) + +#define HDMI_TX_CTRL_OFFSET(_pipe) ((_pipe) * 0x40000) +#define HDMI_TX_REG(_pipe, _offset) \ + (0x1200000 + HDMI_TX_CTRL_OFFSET(_pipe) + ((_offset) << 2)) +#define VIDEO_IF_CTRL_OFFSET(_pipe) (((_pipe) * 0x100) + 0x400) +#define VIDEO_IF_REG(_pipe, _offset) \ + (0x9A0000 + VIDEO_IF_CTRL_OFFSET((_pipe)) + (_offset)) + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_dp.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_dp.c new file mode 100644 index 0000000000000000000000000000000000000000..e2f5ede2995c6b7f8f36a22fbcd24b1357960bdd --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_dp.c @@ -0,0 +1,749 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ + +#include +#include +#include + +#include "mwv207_dp.h" + +static const u8 mwv207_dp_edp_revisions[] = { 0x11, 0x12, 0x13, 0x14 }; + +static void mwv207_dp_link_caps_reset(struct mwv207_dp_link_caps *caps) +{ + caps->enhanced_framing = false; + caps->tps3_supported = false; + caps->fast_training = false; + caps->channel_coding = false; + caps->alternate_scrambler_reset = false; +} + +void mwv207_dp_link_caps_copy(struct mwv207_dp_link_caps *dest, + const struct mwv207_dp_link_caps *src) +{ + dest->enhanced_framing = src->enhanced_framing; + dest->tps3_supported = src->tps3_supported; + dest->fast_training = src->fast_training; + dest->channel_coding = src->channel_coding; + dest->alternate_scrambler_reset = src->alternate_scrambler_reset; +} + +static void mwv207_dp_link_reset(struct mwv207_dp_link *link) +{ + unsigned int i; + + if (!link) + return; + + link->revision = 0; + link->max_rate = 0; + link->max_lanes = 0; + + mwv207_dp_link_caps_reset(&link->caps); + link->aux_rd_interval.cr = 0; + link->aux_rd_interval.ce = 0; + link->edp = 0; + + link->rate = 0; + link->lanes = 0; + + for (i = 0; i < DP_MAX_SUPPORTED_RATES; i++) + link->rates[i] = 0; + + link->num_rates = 0; +} + +int mwv207_dp_link_add_rate(struct mwv207_dp_link *link, unsigned long rate) +{ + unsigned int i, pivot; + + if (link->num_rates == DP_MAX_SUPPORTED_RATES) + return -ENOSPC; + + for (pivot = 0; pivot < link->num_rates; pivot++) + if (rate <= link->rates[pivot]) + break; + + if (pivot != link->num_rates && rate == link->rates[pivot]) + return -EEXIST; + + for (i = link->num_rates; i > pivot; i--) + link->rates[i] = link->rates[i - 1]; + + link->rates[pivot] = rate; + link->num_rates++; + + return 0; +} + +int mwv207_dp_link_remove_rate(struct mwv207_dp_link *link, unsigned long rate) +{ + unsigned int i; + + for (i = 0; i < link->num_rates; i++) + if (rate == link->rates[i]) + break; + + if (i == link->num_rates) + return -EINVAL; + + link->num_rates--; + + while (i < link->num_rates) { + link->rates[i] = link->rates[i + 1]; + i++; + } + + return 0; +} + +void mwv207_dp_link_update_rates(struct mwv207_dp_link *link) +{ + unsigned int i, count = 0; + + for (i = 0; i < link->num_rates; i++) { + if (link->rates[i] != 0) + link->rates[count++] = link->rates[i]; + } + + for (i = count; i < link->num_rates; i++) + link->rates[i] = 0; + + link->num_rates = count; +} + +int mwv207_dp_link_probe(struct drm_dp_aux *aux, struct mwv207_dp_link *link) +{ + u8 dpcd[DP_RECEIVER_CAP_SIZE], value; + unsigned int rd_interval; + int err; + + mwv207_dp_link_reset(link); + + err = drm_dp_dpcd_read(aux, DP_DPCD_REV, dpcd, sizeof(dpcd)); + if (err < 0) + return err; + + link->revision = dpcd[DP_DPCD_REV]; + link->max_rate = drm_dp_max_link_rate(dpcd); + link->max_lanes = drm_dp_max_lane_count(dpcd); + + link->caps.enhanced_framing = drm_dp_enhanced_frame_cap(dpcd); + link->caps.tps3_supported = drm_dp_tps3_supported(dpcd); + link->caps.fast_training = drm_dp_fast_training_cap(dpcd); + link->caps.channel_coding = drm_dp_channel_coding_supported(dpcd); + + if (drm_dp_alternate_scrambler_reset_cap(dpcd)) { + link->caps.alternate_scrambler_reset = true; + + err = drm_dp_dpcd_readb(aux, DP_EDP_DPCD_REV, &value); + if (err < 0) + return err; + + if (value >= ARRAY_SIZE(mwv207_dp_edp_revisions)) + DRM_ERROR("unsupported eDP version: %02x\n", value); + else + link->edp = mwv207_dp_edp_revisions[value]; + } + + rd_interval = dpcd[DP_TRAINING_AUX_RD_INTERVAL] & + DP_TRAINING_AUX_RD_MASK; + + if (rd_interval > 4) { + DRM_DEBUG_KMS("AUX interval %u out of range (max. 4)\n", + rd_interval); + rd_interval = 4; + } + + rd_interval *= 4 * USEC_PER_MSEC; + + if (rd_interval == 0 || link->revision >= DP_DPCD_REV_14) + link->aux_rd_interval.cr = 100; + + if (rd_interval == 0) + link->aux_rd_interval.ce = 400; + + link->rate = link->max_rate; + link->lanes = link->max_lanes; + + if (link->edp >= 0x14) { + u8 supported_rates[DP_MAX_SUPPORTED_RATES * 2]; + unsigned int i; + u16 rate; + + err = drm_dp_dpcd_read(aux, DP_SUPPORTED_LINK_RATES, + supported_rates, + sizeof(supported_rates)); + if (err < 0) + return err; + + for (i = 0; i < DP_MAX_SUPPORTED_RATES; i++) { + rate = supported_rates[i * 2 + 1] << 8 | + supported_rates[i * 2 + 0]; + + mwv207_dp_link_add_rate(link, rate * 200); + } + } + + return 0; +} + +int mwv207_dp_link_power_up(struct drm_dp_aux *aux, struct mwv207_dp_link *link) +{ + u8 value; + int err; + + if (link->revision < 0x11) + return 0; + + err = drm_dp_dpcd_readb(aux, DP_SET_POWER, &value); + if (err < 0) + return err; + + value &= ~DP_SET_POWER_MASK; + value |= DP_SET_POWER_D0; + + err = drm_dp_dpcd_writeb(aux, DP_SET_POWER, value); + if (err < 0) + return err; + + usleep_range(1000, 2000); + + return 0; +} + +int mwv207_dp_link_power_down(struct drm_dp_aux *aux, struct mwv207_dp_link *link) +{ + u8 value; + int err; + + if (link->revision < 0x11) + return 0; + + err = drm_dp_dpcd_readb(aux, DP_SET_POWER, &value); + if (err < 0) + return err; + + value &= ~DP_SET_POWER_MASK; + value |= DP_SET_POWER_D3; + + err = drm_dp_dpcd_writeb(aux, DP_SET_POWER, value); + if (err < 0) + return err; + + return 0; +} + +int mwv207_dp_link_configure(struct drm_dp_aux *aux, struct mwv207_dp_link *link) +{ + u8 values[2], value; + int err; + + if (link->ops && link->ops->configure) { + err = link->ops->configure(link); + if (err < 0) { + DRM_ERROR("failed to configure DP link: %d\n", err); + return err; + } + } + + values[0] = drm_dp_link_rate_to_bw_code(link->rate); + values[1] = link->lanes; + + if (link->caps.enhanced_framing) + values[1] |= DP_LANE_COUNT_ENHANCED_FRAME_EN; + + err = drm_dp_dpcd_write(aux, DP_LINK_BW_SET, values, sizeof(values)); + if (err < 0) + return err; + + if (link->caps.channel_coding) + value = DP_SET_ANSI_8B10B; + else + value = 0; + + err = drm_dp_dpcd_writeb(aux, DP_MAIN_LINK_CHANNEL_CODING_SET, value); + if (err < 0) + return err; + + if (link->caps.alternate_scrambler_reset) { + err = drm_dp_dpcd_writeb(aux, DP_EDP_CONFIGURATION_SET, + DP_ALTERNATE_SCRAMBLER_RESET_ENABLE); + if (err < 0) + return err; + } + + return 0; +} + +int mwv207_dp_link_choose(struct mwv207_dp_link *link, + const struct drm_display_mode *mode, + const struct drm_display_info *info) +{ + + static const unsigned int rates[3] = { 162000, 270000, 540000 }; + + static const unsigned int lanes[3] = { 1, 2, 4 }; + unsigned long requirement, capacity; + unsigned int rate = link->max_rate; + unsigned int i, j; + + requirement = mode->clock * info->bpc * 3; + + for (i = 0; i < ARRAY_SIZE(lanes) && lanes[i] <= link->max_lanes; i++) { + for (j = 0; j < ARRAY_SIZE(rates) && rates[j] <= rate; j++) { + capacity = lanes[i] * (rates[j] * 10) * 8 / 10; + + if (capacity >= requirement) { + DRM_DEBUG_KMS("using %u lanes at %u kHz (%lu/%lu kbps)\n", + lanes[i], rates[j], requirement, + capacity); + + link->lanes = lanes[i]; + link->rate = rates[j]; + return 0; + } + } + } + + return -ERANGE; +} + +void mwv207_dp_link_train_init(struct mwv207_dp_link_train *train) +{ + struct mwv207_dp_link_train_set *request = &train->request; + struct mwv207_dp_link_train_set *adjust = &train->adjust; + unsigned int i; + + for (i = 0; i < 4; i++) { + request->voltage_swing[i] = 0; + adjust->voltage_swing[i] = 0; + + request->pre_emphasis[i] = 0; + adjust->pre_emphasis[i] = 0; + + request->post_cursor[i] = 0; + adjust->post_cursor[i] = 0; + } + + train->pattern = DP_TRAINING_PATTERN_DISABLE; + train->clock_recovered = false; + train->channel_equalized = false; +} + +static bool mwv207_dp_link_train_valid(const struct mwv207_dp_link_train *train) +{ + return train->clock_recovered && train->channel_equalized; +} + +static int mwv207_dp_link_apply_training(struct mwv207_dp_link *link) +{ + struct mwv207_dp_link_train_set *request = &link->train.request; + unsigned int lanes = link->lanes, *vs, *pe, *pc, i; + struct drm_dp_aux *aux = link->aux; + u8 values[4], pattern = 0; + int err; + + err = link->ops->apply_training(link); + if (err < 0) { + DRM_ERROR("failed to apply link training: %d\n", err); + return err; + } + + vs = request->voltage_swing; + pe = request->pre_emphasis; + pc = request->post_cursor; + + for (i = 0; i < lanes; i++) + values[i] = DP_TRAIN_VOLTAGE_SWING_LEVEL(vs[i]) | + DP_TRAIN_PRE_EMPHASIS_LEVEL(pe[i]); + + err = drm_dp_dpcd_write(aux, DP_TRAINING_LANE0_SET, values, lanes); + if (err < 0) { + DRM_ERROR("failed to set training parameters: %d\n", err); + return err; + } + + if (link->revision >= 0x12 && link->rate == 540000) { + values[0] = values[1] = 0; + + for (i = 0; i < lanes; i++) + values[i / 2] |= DP_LANE_POST_CURSOR(i, pc[i]); + + err = drm_dp_dpcd_write(aux, DP_TRAINING_LANE0_1_SET2, values, + DIV_ROUND_UP(lanes, 2)); + if (err < 0) { + DRM_ERROR("failed to set post-cursor: %d\n", err); + return err; + } + } + + if (link->train.pattern != DP_TRAINING_PATTERN_DISABLE) + pattern |= DP_LINK_SCRAMBLING_DISABLE; + + pattern |= link->train.pattern; + + err = drm_dp_dpcd_writeb(aux, DP_TRAINING_PATTERN_SET, pattern); + if (err < 0) { + DRM_ERROR("failed to set training pattern: %d\n", err); + return err; + } + + return 0; +} + +static void mwv207_dp_link_train_wait(struct mwv207_dp_link *link) +{ + unsigned long min = 0; + + switch (link->train.pattern) { + case DP_TRAINING_PATTERN_1: + min = link->aux_rd_interval.cr; + break; + + case DP_TRAINING_PATTERN_2: + case DP_TRAINING_PATTERN_3: + min = link->aux_rd_interval.ce; + break; + + default: + break; + } + + if (min > 0) + usleep_range(min, 2 * min); +} + +static void mwv207_dp_link_get_adjustments(struct mwv207_dp_link *link, + u8 status[DP_LINK_STATUS_SIZE]) +{ + struct mwv207_dp_link_train_set *adjust = &link->train.adjust; + unsigned int i; + u8 post_cursor; + int err; + + err = drm_dp_dpcd_read(link->aux, DP_ADJUST_REQUEST_POST_CURSOR2, + &post_cursor, sizeof(post_cursor)); + if (err < 0) { + DRM_ERROR("failed to read post_cursor2: %d\n", err); + post_cursor = 0; + } + + for (i = 0; i < link->lanes; i++) { + adjust->voltage_swing[i] = + drm_dp_get_adjust_request_voltage(status, i) >> + DP_TRAIN_VOLTAGE_SWING_SHIFT; + + adjust->pre_emphasis[i] = + drm_dp_get_adjust_request_pre_emphasis(status, i) >> + DP_TRAIN_PRE_EMPHASIS_SHIFT; + + adjust->post_cursor[i] = + (post_cursor >> (i << 1)) & 0x3; + } +} + +static void mwv207_dp_link_train_adjust(struct mwv207_dp_link_train *train) +{ + struct mwv207_dp_link_train_set *request = &train->request; + struct mwv207_dp_link_train_set *adjust = &train->adjust; + unsigned int i; + + for (i = 0; i < 4; i++) + if (request->voltage_swing[i] != adjust->voltage_swing[i]) + request->voltage_swing[i] = adjust->voltage_swing[i]; + + for (i = 0; i < 4; i++) + if (request->pre_emphasis[i] != adjust->pre_emphasis[i]) + request->pre_emphasis[i] = adjust->pre_emphasis[i]; + + for (i = 0; i < 4; i++) + if (request->post_cursor[i] != adjust->post_cursor[i]) + request->post_cursor[i] = adjust->post_cursor[i]; +} + +static int mwv207_dp_link_recover_clock(struct mwv207_dp_link *link) +{ + u8 status[DP_LINK_STATUS_SIZE]; + int err; + + err = mwv207_dp_link_apply_training(link); + if (err < 0) + return err; + + mwv207_dp_link_train_wait(link); + + err = drm_dp_dpcd_read_link_status(link->aux, status); + if (err < 0) { + DRM_ERROR("failed to read link status: %d\n", err); + return err; + } + + if (!drm_dp_clock_recovery_ok(status, link->lanes)) + mwv207_dp_link_get_adjustments(link, status); + else + link->train.clock_recovered = true; + + return 0; +} + +static int mwv207_dp_link_clock_recovery(struct mwv207_dp_link *link) +{ + unsigned int repeat; + int err; + + link->train.pattern = DP_TRAINING_PATTERN_1; + + for (repeat = 1; repeat < 5; repeat++) { + err = mwv207_dp_link_recover_clock(link); + if (err < 0) { + DRM_ERROR("failed to recover clock: %d\n", err); + return err; + } + + if (link->train.clock_recovered) + break; + + mwv207_dp_link_train_adjust(&link->train); + } + + return 0; +} + +static int mwv207_dp_link_equalize_channel(struct mwv207_dp_link *link) +{ + struct drm_dp_aux *aux = link->aux; + u8 status[DP_LINK_STATUS_SIZE]; + int err; + + err = mwv207_dp_link_apply_training(link); + if (err < 0) + return err; + + mwv207_dp_link_train_wait(link); + + err = drm_dp_dpcd_read_link_status(aux, status); + if (err < 0) { + DRM_ERROR("failed to read link status: %d\n", err); + return err; + } + + if (!drm_dp_clock_recovery_ok(status, link->lanes)) { + DRM_ERROR("clock recovery lost while equalizing channel\n"); + link->train.clock_recovered = false; + return 0; + } + + if (!drm_dp_channel_eq_ok(status, link->lanes)) + mwv207_dp_link_get_adjustments(link, status); + else + link->train.channel_equalized = true; + + return 0; +} + +static int mwv207_dp_link_channel_equalization(struct mwv207_dp_link *link) +{ + unsigned int repeat; + int err; + + if (link->caps.tps3_supported) + link->train.pattern = DP_TRAINING_PATTERN_3; + else + link->train.pattern = DP_TRAINING_PATTERN_2; + + for (repeat = 1; repeat < 5; repeat++) { + err = mwv207_dp_link_equalize_channel(link); + if (err < 0) { + DRM_ERROR("failed to equalize channel: %d\n", err); + return err; + } + + if (link->train.channel_equalized) + break; + + mwv207_dp_link_train_adjust(&link->train); + } + + return 0; +} + +static int mwv207_dp_link_downgrade(struct mwv207_dp_link *link) +{ + switch (link->rate) { + case 162000: + return -EINVAL; + + case 270000: + link->rate = 162000; + break; + + case 540000: + link->rate = 270000; + return 0; + } + + return 0; +} + +static void mwv207_dp_link_train_disable(struct mwv207_dp_link *link) +{ + int err; + + link->train.pattern = DP_TRAINING_PATTERN_DISABLE; + + err = mwv207_dp_link_apply_training(link); + if (err < 0) + DRM_ERROR("failed to disable link training: %d\n", err); +} + +static int mwv207_dp_link_train_full(struct mwv207_dp_link *link) +{ + int err; + +retry: + DRM_DEBUG_KMS("full-training link: %u lane%s at %u MHz\n", + link->lanes, (link->lanes > 1) ? "s" : "", + link->rate / 100); + + err = mwv207_dp_link_configure(link->aux, link); + if (err < 0) { + DRM_ERROR("failed to configure DP link: %d\n", err); + return err; + } + + err = mwv207_dp_link_clock_recovery(link); + if (err < 0) { + DRM_ERROR("clock recovery failed: %d\n", err); + goto out; + } + + if (!link->train.clock_recovered) { + DRM_ERROR("clock recovery failed, downgrading link\n"); + + err = mwv207_dp_link_downgrade(link); + if (err < 0) + goto out; + + goto retry; + } + + DRM_DEBUG_KMS("clock recovery succeeded\n"); + + err = mwv207_dp_link_channel_equalization(link); + if (err < 0) { + DRM_ERROR("channel equalization failed: %d\n", err); + goto out; + } + + if (!link->train.channel_equalized) { + DRM_ERROR("channel equalization failed, downgrading link\n"); + + err = mwv207_dp_link_downgrade(link); + if (err < 0) + goto out; + + goto retry; + } + + DRM_DEBUG_KMS("channel equalization succeeded\n"); + +out: + mwv207_dp_link_train_disable(link); + return err; +} + +static int mwv207_dp_link_train_fast(struct mwv207_dp_link *link) +{ + u8 status[DP_LINK_STATUS_SIZE]; + int err; + + DRM_DEBUG_KMS("fast-training link: %u lane%s at %u MHz\n", + link->lanes, (link->lanes > 1) ? "s" : "", + link->rate / 100); + + err = mwv207_dp_link_configure(link->aux, link); + if (err < 0) { + DRM_ERROR("failed to configure DP link: %d\n", err); + return err; + } + + link->train.pattern = DP_TRAINING_PATTERN_1; + + err = mwv207_dp_link_apply_training(link); + if (err < 0) + goto out; + + usleep_range(500, 1000); + + if (link->caps.tps3_supported) + link->train.pattern = DP_TRAINING_PATTERN_3; + else + link->train.pattern = DP_TRAINING_PATTERN_2; + + err = mwv207_dp_link_apply_training(link); + if (err < 0) + goto out; + + usleep_range(500, 1000); + + err = drm_dp_dpcd_read_link_status(link->aux, status); + if (err < 0) { + DRM_ERROR("failed to read link status: %d\n", err); + goto out; + } + + if (!drm_dp_clock_recovery_ok(status, link->lanes)) { + DRM_ERROR("clock recovery failed\n"); + err = -EIO; + } + + if (!drm_dp_channel_eq_ok(status, link->lanes)) { + DRM_ERROR("channel equalization failed\n"); + err = -EIO; + } + +out: + mwv207_dp_link_train_disable(link); + return err; +} + +int mwv207_dp_link_train(struct mwv207_dp_link *link) +{ + int err; + + mwv207_dp_link_train_init(&link->train); + + if (link->caps.fast_training) { + if (mwv207_dp_link_train_valid(&link->train)) { + err = mwv207_dp_link_train_fast(link); + if (err < 0) + DRM_ERROR("fast link training failed: %d\n", err); + else + return 0; + } else { + DRM_DEBUG_KMS("training parameters not available\n"); + } + } else { + DRM_DEBUG_KMS("fast link training not supported\n"); + } + + err = mwv207_dp_link_train_full(link); + if (err < 0) + DRM_ERROR("full link training failed: %d\n", err); + + return err; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_dp.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_dp.h new file mode 100644 index 0000000000000000000000000000000000000000..1e44979c4e46c009b678824b05911d4966d1a0f2 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_dp.h @@ -0,0 +1,110 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ + +#ifndef MWV207_DP_H +#define MWV207_DP_H + +#include + +struct drm_display_info; +struct drm_display_mode; +struct drm_dp_aux; +struct mwv207_dp_link; + +struct mwv207_dp_link_caps { + bool enhanced_framing; + + bool tps3_supported; + + bool fast_training; + + bool channel_coding; + + bool alternate_scrambler_reset; +}; + +void mwv207_dp_link_caps_copy(struct mwv207_dp_link_caps *dest, + const struct mwv207_dp_link_caps *src); + +struct mwv207_dp_link_ops { + int (*apply_training)(struct mwv207_dp_link *link); + + int (*configure)(struct mwv207_dp_link *link); +}; + +#define DP_TRAIN_VOLTAGE_SWING_LEVEL(x) ((x) << 0) +#define DP_TRAIN_PRE_EMPHASIS_LEVEL(x) ((x) << 3) +#define DP_LANE_POST_CURSOR(i, x) (((x) & 0x3) << (((i) & 1) << 2)) + +struct mwv207_dp_link_train_set { + unsigned int voltage_swing[4]; + unsigned int pre_emphasis[4]; + unsigned int post_cursor[4]; +}; + +struct mwv207_dp_link_train { + struct mwv207_dp_link_train_set request; + struct mwv207_dp_link_train_set adjust; + + unsigned int pattern; + + bool clock_recovered; + bool channel_equalized; +}; + +struct mwv207_dp_link { + unsigned char revision; + unsigned int max_rate; + unsigned int max_lanes; + + struct mwv207_dp_link_caps caps; + + struct { + unsigned int cr; + unsigned int ce; + } aux_rd_interval; + + unsigned char edp; + + unsigned int rate; + unsigned int lanes; + + unsigned long rates[DP_MAX_SUPPORTED_RATES]; + unsigned int num_rates; + + const struct mwv207_dp_link_ops *ops; + + struct drm_dp_aux *aux; + + struct mwv207_dp_link_train train; +}; + +int mwv207_dp_link_add_rate(struct mwv207_dp_link *link, unsigned long rate); +int mwv207_dp_link_remove_rate(struct mwv207_dp_link *link, unsigned long rate); +void mwv207_dp_link_update_rates(struct mwv207_dp_link *link); + +int mwv207_dp_link_probe(struct drm_dp_aux *aux, struct mwv207_dp_link *link); +int mwv207_dp_link_power_up(struct drm_dp_aux *aux, struct mwv207_dp_link *link); +int mwv207_dp_link_power_down(struct drm_dp_aux *aux, struct mwv207_dp_link *link); +int mwv207_dp_link_configure(struct drm_dp_aux *aux, struct mwv207_dp_link *link); +int mwv207_dp_link_choose(struct mwv207_dp_link *link, + const struct drm_display_mode *mode, + const struct drm_display_info *info); + +void mwv207_dp_link_train_init(struct mwv207_dp_link_train *train); +int mwv207_dp_link_train(struct mwv207_dp_link *link); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_dvo.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_dvo.c new file mode 100644 index 0000000000000000000000000000000000000000..eb7d41b44b7d06a185f2b4af356a9cab552031a9 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_dvo.c @@ -0,0 +1,189 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_vi.h" + +static void mwv207_dvo_switch(struct mwv207_output *output, bool on) +{ + mwv207_output_modify(output, 0x200, + 0x1 << 0, (on ? 1 : 0) << 0); +} + +static void mwv207_dvo_config(struct mwv207_output *output) +{ + struct drm_display_mode *mode = &output->cur_crtc->state->adjusted_mode; + int hpol, vpol; + + hpol = (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : 1; + vpol = (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : 1; + + mwv207_output_modify(output, 0x200, 0x1 << 9, hpol << 9); + mwv207_output_modify(output, 0x200, 0x1 << 8, vpol << 8); + +} + +static void mwv207_dvo_select_crtc(struct mwv207_output *output) +{ + + mwv207_output_modify(output, 0x200, 0x7 << 16, + drm_crtc_index(output->cur_crtc) << 16); + + jdev_modify(output->jdev, 0x9B003C, 0xf, + drm_crtc_index(output->cur_crtc)); +} +static enum drm_mode_status mwv207_dvo_mode_valid(struct mwv207_output *output, + const struct drm_display_mode *mode) +{ + + if (mode->clock > 162000) + return MODE_CLOCK_HIGH; + + return MODE_OK; +} + +static enum drm_mode_status mwv207_dvo_connector_mode_valid(struct drm_connector *connector, + struct drm_display_mode *mode) +{ + return mwv207_dvo_mode_valid(connector_to_output(connector), mode); +} + +static int mwv207_dvo_detect_ctx(struct drm_connector *connector, + struct drm_modeset_acquire_ctx *ctx, + bool force) +{ + struct mwv207_output *output = connector_to_output(connector); + + if (connector->force == DRM_FORCE_OFF) + return connector_status_disconnected; + + if (connector->force == DRM_FORCE_ON) + return connector_status_connected; + + if (output->forced_edid) + return connector_status_connected; + + if (mwv207_i2c_probe(output->ddc)) + return connector_status_connected; + else + return connector_status_disconnected; +} + +static void mwv207_dvo_destroy(struct drm_connector *conn) +{ + drm_connector_unregister(conn); + drm_connector_cleanup(conn); +} + +static const struct drm_connector_helper_funcs mwv207_dvo_connector_helper_funcs = { + .get_modes = mwv207_output_get_modes, + .mode_valid = mwv207_dvo_connector_mode_valid, + .detect_ctx = mwv207_dvo_detect_ctx +}; + +static const struct drm_connector_funcs mwv207_dvo_connector_funcs = { + .reset = drm_atomic_helper_connector_reset, + .fill_modes = drm_helper_probe_single_connector_modes, + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, + .destroy = mwv207_dvo_destroy, + .late_register = mwv207_output_late_register, + .early_unregister = mwv207_output_early_unregister, +}; + +static enum drm_mode_status mwv207_dvo_encoder_mode_valid(struct drm_encoder *encoder, + const struct drm_display_mode *mode) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + return mwv207_dvo_mode_valid(output, mode); +} + +static int mwv207_dvo_encoder_atomic_check(struct drm_encoder *encoder, + struct drm_crtc_state *crtc_state, + struct drm_connector_state *conn_state) +{ + return 0; +} + +static void mwv207_dvo_encoder_enable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_dvo_select_crtc(output); + + mwv207_dvo_config(output); + + mwv207_dvo_switch(output, true); +} + +static void mwv207_dvo_encoder_disable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_dvo_switch(output, false); +} + +static void mwv207_dvo_encoder_reset(struct drm_encoder *encoder) +{ + mwv207_dvo_encoder_disable(encoder); +} + +static const struct drm_encoder_funcs mwv207_dvo_encoder_funcs = { + .destroy = drm_encoder_cleanup, + .reset = mwv207_dvo_encoder_reset, +}; + +static const struct drm_encoder_helper_funcs mwv207_dvo_encoder_helper_funcs = { + .mode_valid = mwv207_dvo_encoder_mode_valid, + .atomic_check = mwv207_dvo_encoder_atomic_check, + .enable = mwv207_dvo_encoder_enable, + .disable = mwv207_dvo_encoder_disable, +}; + +int mwv207_dvo_init(struct mwv207_device *jdev) +{ + struct mwv207_output *output; + int ret; + output = mwv207_output_probe_and_init(jdev, sizeof(struct mwv207_output), 0, + 0x5, (20*0)); + if (!output) { + dev_info(jdev->dev, "dvo is disabled by firmware"); + return 0; + } + + if (IS_ERR(output)) + return PTR_ERR(output); + + output->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; + ret = drm_connector_init(&jdev->base, &output->connector, + &mwv207_dvo_connector_funcs, DRM_MODE_CONNECTOR_DVII); + if (ret) + return ret; + drm_connector_helper_add(&output->connector, &mwv207_dvo_connector_helper_funcs); + + output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; + ret = drm_encoder_init(&jdev->base, &output->encoder, + &mwv207_dvo_encoder_funcs, DRM_MODE_ENCODER_DAC, + "dvo-%d", output->idx); + if (ret) + return ret; + drm_encoder_helper_add(&output->encoder, &mwv207_dvo_encoder_helper_funcs); + + ret = drm_connector_attach_encoder(&output->connector, &output->encoder); + if (ret) + return ret; + + return drm_connector_register(&output->connector); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_edp.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_edp.c new file mode 100644 index 0000000000000000000000000000000000000000..4e49f22f4062b9e700ad98347f101bdf894bb31e --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_edp.c @@ -0,0 +1,917 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ + +#include "mwv207_vi.h" +#include "mwv207_edp.h" +#include +#include "mwv207_dp.h" +#include "mwv207_drv.h" +#include "mwv207_vbios.h" +#include +#include +#include +#include + +struct mwv207_edp_config { + u8 pre_emphasis[4]; + u8 voltage_swing[4]; +}; + +struct mwv207_edp_poll { + struct task_struct *poll_task; + wait_queue_head_t poll_wait; + spinlock_t hpd_lock; + u8 wait_cond; +}; + +struct mwv207_edp { + struct mwv207_output base; + + void __iomem *mmio; + int irq; + struct completion aux_comp; + struct mutex aux_mutex; + struct mwv207_edp_config phy_conf; + struct mwv207_edp_poll poll; + struct drm_dp_aux aux; + struct mwv207_dp_link link; +}; + +#define MWV207_GPIO_MULTIPLEX_BASE 0x9b0910 +#define MWV207_GPIO_MULTIPLEX32_39 (MWV207_GPIO_MULTIPLEX_BASE + 0x10) + +#define connector_to_edp(conn) container_of(conn, struct mwv207_edp, base.connector) +#define encoder_to_edp(encoder) container_of(encoder, struct mwv207_edp, base.encoder) +#define aux_to_edp(aux) container_of(aux, struct mwv207_edp, aux) +#define link_to_edp(link) container_of(link, struct mwv207_edp, link) + +#define MWV207_EDP_BASE(idx) (0x01380000 + 0x40000 * (idx)) + +static inline u32 mwv207_edp_readb(struct mwv207_edp *edp, u32 reg) +{ + return readl(edp->mmio + reg); +} + +static inline void mwv207_edp_writeb(struct mwv207_edp *edp, u32 reg, u32 value) +{ + writel_relaxed(value, edp->mmio + reg); +} + +static s32 mwv207_edp_hw_pre_emphasis_get(struct mwv207_edp *edp, + struct mwv207_dp_link *link, u32 lanenum) +{ + u8 lev = link->train.request.pre_emphasis[lanenum]; + + return edp->phy_conf.pre_emphasis[lev]; +} +static s32 mwv207_edp_hw_vol_sw_get(struct mwv207_edp *edp, + struct mwv207_dp_link *link, u32 lanenum) +{ + u8 lev = link->train.request.voltage_swing[lanenum]; + + return edp->phy_conf.voltage_swing[lev]; +} + +static u32 mwv207_edptx_tu_config(u8 lane_count, u32 rate, u32 pixclock) +{ + u32 pixel_clk = pixclock; + u8 kdefault_tu_size = 64; + u8 bits_per_color = 8; + u8 color_factor = 3; + u64 link_sr, vid_sr; + u64 data_per_tu; + u32 a, b; + u32 tu; + + rate = rate / 100; + link_sr = + (u64) pixel_clk * color_factor * bits_per_color * kdefault_tu_size * + 10; + vid_sr = (u64) lane_count * rate * 8; + data_per_tu = link_sr / vid_sr; + + a = (u32) data_per_tu / 1000; + b = (u32) (data_per_tu % 1000) * 16 / 1000; + tu = (b << 24) | (a << 16) | 0x40; + + DRM_DEBUG_DRIVER("EDP pixel_clk = %d khz, rate = %d, lane_count = %d", + pixel_clk, rate, lane_count); + DRM_DEBUG_DRIVER("link_sr = %llu, vid_sr = %llu, data_per_tu = %llu", + link_sr, vid_sr, data_per_tu); + DRM_DEBUG_DRIVER("a = %d, b = %d, tu size: 0x%x", a, b, tu); + return tu; +} + +static int mwv207_edp_phy_parse_cfg(struct mwv207_edp *edp) +{ + u8 pre_emphasis[4] = {0x1, 0x2, 0x3, 0x4}; + u8 voltage_swing[4] = {0x1f, 0x18, 0x1c, 0x1f}; + + memcpy(edp->phy_conf.pre_emphasis, pre_emphasis, sizeof(pre_emphasis)); + memcpy(edp->phy_conf.voltage_swing, voltage_swing, sizeof(voltage_swing)); + + return 0; +} + +static void mwv207_edp_reply_timeout_handle(struct mwv207_edp *edp) +{ + complete(&edp->aux_comp); + DRM_DEBUG_DRIVER("edp irq timeout!"); +} + +static void mwv207_edp_reply_handle(struct mwv207_edp *edp) +{ + complete(&edp->aux_comp); + DRM_DEBUG_DRIVER("edp irq recv!"); +} + +static void mwv207_edp_hpd_handle(struct mwv207_edp *edp) +{ + spin_lock(&edp->poll.hpd_lock); + edp->poll.wait_cond |= 0x4; + spin_unlock(&edp->poll.hpd_lock); + + wake_up_interruptible(&edp->poll.poll_wait); +} + +static irqreturn_t mwv207_edp_irq(int irq, void *dev_id) +{ + struct mwv207_edp *edp = dev_id; + u8 mask; + + mask = mwv207_edp_readb(edp, (0x1000+0x0130U)); + + DRM_DEBUG_DRIVER("edp recv irq %d\n", mask); + + while (mask) { + if (mask & (0x1 << 0)) { + + mwv207_edp_hpd_handle(edp); + } + + if (mask & (0x1 << 2)) { + + mwv207_edp_reply_handle(edp); + } + + if (mask & (0x1 << 3)) { + + mwv207_edp_reply_timeout_handle(edp); + } + + mwv207_edp_readb(edp, (0x1000+0x0140U)); + mask = mwv207_edp_readb(edp, (0x1000+0x0130U)); + } + + return IRQ_HANDLED; +} + +static u8 mwv207_edp_get_wait_cond(struct mwv207_edp *edp) +{ + unsigned long flags; + u8 wait_cond; + + spin_lock_irqsave(&edp->poll.hpd_lock, flags); + wait_cond = edp->poll.wait_cond; + edp->poll.wait_cond = 0; + spin_unlock_irqrestore(&edp->poll.hpd_lock, flags); + + return wait_cond; +} + +static int mwv207_edp_poll_task(void *arg) +{ + struct mwv207_edp *edp = (struct mwv207_edp *) arg; + int ret; + u8 wait_cond; + + set_freezable(); + while (!kthread_should_stop()) { + try_to_freeze(); + ret = wait_event_interruptible_timeout(edp->poll.poll_wait, + (wait_cond = + mwv207_edp_get_wait_cond + (edp)), + msecs_to_jiffies(1000)); + if (ret == 0) + continue; + + if (wait_cond & 0x4) { + drm_helper_hpd_irq_event(&edp->base.jdev->base); + } + } + return 0; +} + +static u32 mwv207_edptx_get_gtcconfig(u32 fapb) +{ + u32 n, b, d; + s32 a; + + n = 1000 / fapb; + a = (s32) n; + b = n - a; + d = b * (1 << 16); + d = a << 16 | d; + return d; +} + +static u32 mwv207_edp_get_link_speed(u32 edp_chan, u32 rate) +{ + switch (rate) { + case 162000: + return 0x06; + case 270000: + return 0x0a; + case 540000: + return 0x14; + } + + DRM_ERROR("edp(%d) rate(%d) didn't find speed", edp_chan, rate); + return 0; +} + +static void mwv207_edp_phy_config(struct mwv207_dp_link *link, u8 lane_count, + u32 rate) +{ + unsigned int edp_pll_value[3][8] = { + { 0x140067F2, 0x6C8024A6, 0x21653330, 0x474D900E, 0x9C1143D1, + 0x1, 0x0, 0x1143 }, + { 0x140067F2, 0x6C8024A6, 0x21653330, 0x474D900E, 0x9C1170D1, + 0x1, 0x0, 0x1170 }, + { 0x140067F2, 0x6C8024A6, 0x21653330, 0x47408110, 0x9C0570D1, + 0x1, 0x0, 0x1070 }, + }; + struct mwv207_edp *edp = link_to_edp(link); + u32 value; + u8 rate_inx = 1; + int status; + + mwv207_edp_writeb(edp, 0x2048, 0); + + mwv207_edp_writeb(edp, 0x2040, 0); + + mwv207_edp_writeb(edp, 0x204C, 0); + usleep_range(1, 2); + + switch (lane_count) { + case 1: + value = 0xf0 | 0x1; + break; + case 2: + value = 0xf0 | 0x3; + break; + case 3: + value = 0xf0 | 0x7; + break; + case 4: + value = 0xf0 | 0xf; + break; + default: + DRM_ERROR("lane_count(%d) num err\n", lane_count); + return; + } + + mwv207_edp_writeb(edp, 0x2044, value); + usleep_range(1, 2); + + mwv207_edp_writeb(edp, 0x2048, 3); + usleep_range(1, 2); + + value = 0xD9; + mwv207_edp_writeb(edp, 0x2380, value); + mwv207_edp_writeb(edp, 0x2384, value); + mwv207_edp_writeb(edp, 0x2388, value); + mwv207_edp_writeb(edp, 0x238C, value); + + mwv207_edp_writeb(edp, 0x23B8, 0); + mwv207_edp_writeb(edp, 0x20B4, 0); + if (0) { + mwv207_edp_writeb(edp, 0x23B0, + rate == 162000 ? 0x5528 : 0x6118); + } else { + mwv207_edp_writeb(edp, 0x23B0, 0); + } + mwv207_edp_writeb(edp, 0x20AC, 0); + mwv207_edp_writeb(edp, 0x23A8, 0); + + if (rate > 270000) + rate_inx = 2; + else if (rate < 270000) + rate_inx = 0; + else + rate_inx = 1; + + mwv207_edp_writeb(edp, 0x23A4, edp_pll_value[rate_inx][0]); + mwv207_edp_writeb(edp, 0x23A0, edp_pll_value[rate_inx][1]); + mwv207_edp_writeb(edp, 0x239C, edp_pll_value[rate_inx][2]); + mwv207_edp_writeb(edp, 0x2398, edp_pll_value[rate_inx][3]); + mwv207_edp_writeb(edp, 0x2394, edp_pll_value[rate_inx][4]); + mwv207_edp_writeb(edp, 0x20A8, edp_pll_value[rate_inx][5]); + mwv207_edp_writeb(edp, 0x20A0, edp_pll_value[rate_inx][6]); + mwv207_edp_writeb(edp, 0x20A4, edp_pll_value[rate_inx][7]); + usleep_range(10, 11); + + while (time_before(jiffies, msecs_to_jiffies(1))) { + status = mwv207_edp_readb(edp, 0x2054) & 0x1; + if (status) + break; + usleep_range(10, 20); + } + + if (!status) + DRM_DEBUG_DRIVER("edp pll lock timeout!"); + + mwv207_edp_writeb(edp, 0x2040, 1); + + switch (lane_count) { + case 1: + value = 0x1; + break; + case 2: + value = 0x3; + break; + case 3: + value = 0x7; + break; + case 4: + value = 0xf; + break; + default: + DRM_ERROR("invalid lanes\n"); + return; + } + mwv207_edp_writeb(edp, 0x204C, value); + usleep_range(1, 2); + + mwv207_edp_writeb(edp, 0x23A8, 0x1 << 19); + + mwv207_edp_writeb(edp, 0x2050, 1); +} + +static void mwv207_edp_train_config_link_and_phy(struct mwv207_dp_link *link) +{ + struct mwv207_edp *edp = link_to_edp(link); + u32 ichan = 0; + u8 speed; + + speed = mwv207_edp_get_link_speed(ichan, link->rate); + + mwv207_edp_writeb(edp, (0x1000+0x0000U), speed); + mwv207_edp_writeb(edp, (0x1000+0x0004U), link->lanes); + + mwv207_edp_writeb(edp, (0x1000+0x0008U), + link->caps.enhanced_framing); + usleep_range(400, 1000); + mwv207_edp_writeb(edp, (0x1000+0x001CU), + link->caps.alternate_scrambler_reset); + + drm_dp_dpcd_writeb(&edp->aux, DP_LINK_BW_SET, speed); + drm_dp_dpcd_writeb(&edp->aux, DP_LANE_COUNT_SET, + (s8) (link->lanes | 0x80)); + drm_dp_dpcd_writeb(&edp->aux, DP_SET_POWER, 1); + + mwv207_edp_phy_config(link, link->lanes, link->rate); +} + +static int mwv207_dp_configure(struct mwv207_dp_link *link) +{ + struct mwv207_edp *edp = link_to_edp(link); + + mwv207_edp_writeb(edp, (0x1000+0x0018U), 0); + + mwv207_edp_train_config_link_and_phy(link); + DRM_DEBUG_DRIVER("configure lane = %d, rate = %d", link->lanes, + link->rate); + return 0; +} + +static int mwv207_dp_apply_training(struct mwv207_dp_link *link) +{ + struct mwv207_edp *edp = link_to_edp(link); + unsigned int lane; + u32 voltage_swing = 0; + u32 pre_emphasis = 0; + u32 value; + + for (lane = 0; lane < link->lanes; lane++) { + pre_emphasis = mwv207_edp_hw_pre_emphasis_get(edp, link, lane); + voltage_swing = mwv207_edp_hw_vol_sw_get(edp, link, lane); + + value = + (u32) ((pre_emphasis << 6) | (voltage_swing << 1) | 0x1); + mwv207_edp_writeb(edp, 0x2380 + 0x4 * lane, + value); + mwv207_edp_writeb(edp, 0x2080 + 0x4 * lane, + voltage_swing); + mwv207_edp_writeb(edp, 0x2090 + 0x4 * lane, + pre_emphasis); + DRM_DEBUG_DRIVER + ("lane_%d pre_emphasis = 0x%x, voltage_swing = 0x%x", lane, + pre_emphasis, voltage_swing); + } + + mwv207_edp_writeb(edp, (0x1000+0x000CU), + link->train.pattern); + usleep_range(20, 100); + DRM_DEBUG_DRIVER("training lane = %d, rate = %d, pattern = %d", + link->lanes, link->rate, link->train.pattern); + + return 0; +} + +static const struct mwv207_dp_link_ops mwv207_dp_link_funcs = { + .apply_training = mwv207_dp_apply_training, + .configure = mwv207_dp_configure, +}; + +static void mwv207_edp_set_aux_clk(struct mwv207_edp *edp) +{ + int ret; + int freq_khz; + int aux_clk; + u8 value; + + struct mwv207_device *jdev = edp->base.jdev; + ret = mwv207_vbios_get_pll(jdev, MWV207_PLL_GPU, &freq_khz); + if (ret < 0) + DRM_ERROR("mwv207_vbios_get_pll failed"); + + aux_clk = freq_khz / 5 / 1000; + + mwv207_edp_writeb(edp, (0x1000+0x010CU), aux_clk); + + value = mwv207_edptx_get_gtcconfig(aux_clk); + mwv207_edp_writeb(edp, (0x1000+0x0354U), value); +} + +static void mwv207_edp_hw_init(struct mwv207_edp *edp) +{ + + jdev_modify(edp->base.jdev, MWV207_GPIO_MULTIPLEX32_39, 0x3 << (20 + edp->base.idx * 4), 1 << (20 + edp->base.idx * 4)); + + mwv207_edp_set_aux_clk(edp); + + mwv207_edp_writeb(edp, (0x1000+0x0110U), 400); + + mwv207_edp_writeb(edp, (0x1000+0x0144U), 0x0); +} + +static int mwv207_process_aux_ch(struct mwv207_edp *edp, u32 address, u8 *reply, + u8 *buffer, u32 size, u32 command) +{ + s32 i; + unsigned long time_left; + s32 ret = size; + s32 err; + u8 code_reply; + bool is_write = (command == DP_AUX_NATIVE_WRITE) || (command == DP_AUX_I2C_WRITE); + + err = mutex_lock_interruptible(&edp->aux_mutex); + if (err) + return err; + + mwv207_edp_writeb(edp, (0x1000+0x0108U), address); + + if (is_write) { + for (i = 0; i < size; i++) { + mwv207_edp_writeb(edp, (0x1000+0x0104U), + buffer[i]); + } + } + + reinit_completion(&edp->aux_comp); + if (size == 0) { + mwv207_edp_writeb(edp, (0x1000+0x0100U), + (command << 8) | (0x1 << 12)); + } else { + mwv207_edp_writeb(edp, (0x1000+0x0100U), + (command << 8) | (size - 1)); + } + + DRM_DEBUG_DRIVER("wait_for_completion"); + time_left = wait_for_completion_timeout(&edp->aux_comp, + msecs_to_jiffies(300)); + if (!time_left) { + pr_err("%s: aux timeout,\n", __func__); + ret = -ETIMEDOUT; + goto unlock_exit; + } + DRM_DEBUG_DRIVER("completion"); + + if (!is_write) { + for (i = 0; i < size; i++) { + buffer[i] = mwv207_edp_readb(edp, (0x1000+0x0134U)); + } + } + + code_reply = mwv207_edp_readb(edp, (0x1000+0x0138U)); + if (reply) + *reply = code_reply; + +unlock_exit: + mutex_unlock(&edp->aux_mutex); + return ret; +} + +static void mwv207_encoder_set_edp_timing(struct mwv207_edp *edp, + struct drm_display_mode *m) +{ + struct mwv207_dp_link *link = &edp->link; + u32 value; + u32 symbol; + u32 udc; + + if (link->lanes == 0 || link->rate == 0) { + DRM_ERROR + ("invalid lane_count(%d) or rate(%d), please check hw!", + link->lanes, link->rate); + return; + } + + mwv207_edp_writeb(edp, (0x1000+0x0014U), 0); + usleep_range(400, 401); + mwv207_edp_writeb(edp, (0x1000+0x0180U), m->crtc_htotal); + mwv207_edp_writeb(edp, (0x1000+0x0184U), m->crtc_vtotal); + + value = ((~(m->flags & DRM_MODE_FLAG_PVSYNC ? 1 : 0) & 1) << 1) | (~(m->flags & DRM_MODE_FLAG_PHSYNC ? 1 : 0) & 1); + mwv207_edp_writeb(edp, (0x1000+0x0188U), value); + + mwv207_edp_writeb(edp, (0x1000+0x018CU), + m->crtc_hsync_end - m->crtc_hsync_start); + mwv207_edp_writeb(edp, (0x1000+0x0190U), + m->crtc_vsync_end - m->crtc_vsync_start); + mwv207_edp_writeb(edp, (0x1000+0x0194U), m->crtc_hdisplay); + mwv207_edp_writeb(edp, (0x1000+0x0198U), m->crtc_vdisplay); + value = m->crtc_htotal - m->crtc_hdisplay - (m->crtc_hsync_start - m->crtc_hdisplay); + mwv207_edp_writeb(edp, (0x1000+0x019CU), value); + + value = m->crtc_vtotal - m->crtc_vdisplay - (m->crtc_vsync_start - m->crtc_vdisplay); + mwv207_edp_writeb(edp, (0x1000+0x01A0U), value); + + mwv207_edp_writeb(edp, (0x1000+0x01A8U), 0); + mwv207_edp_writeb(edp, (0x1000+0x01ACU), m->crtc_clock); + mwv207_edp_writeb(edp, (0x1000+0x01B0U), 0x40); + + symbol = ((m->crtc_hdisplay * 24) + 7) / 8; + udc = (symbol + link->lanes - 1) / link->lanes; + mwv207_edp_writeb(edp, (0x1000+0x01BCU), udc); + mwv207_edp_writeb(edp, (0x1000+0x01C0U), 0); + mwv207_edp_writeb(edp, (0x1000+0x01ACU), m->crtc_clock / 10); + mwv207_edp_writeb(edp, (0x1000+0x01C4U), 0xf); + mwv207_edp_writeb(edp, (0x1000+0x01B4U), link->rate / 10); + + mwv207_edp_writeb(edp, (0x1000+0x01A4U), 0x21); + mwv207_edp_writeb(edp, (0x1000+0x01A8U), 0); + + mwv207_edp_writeb(edp, (0x1000+0x01B8U), 1); + + value = mwv207_edptx_tu_config(link->lanes, link->rate, m->crtc_clock); + mwv207_edp_writeb(edp, (0x1000+0x01B0U), value); + mwv207_edp_writeb(edp, (0x1000+0x00C8U), 0x20042004); + mwv207_edp_writeb(edp, (0x1000+0x00CCU), 0x20042004); + mwv207_edp_writeb(edp, (0x1000+0x01ACU), m->crtc_clock / 10); + mwv207_edp_writeb(edp, (0x1000+0x01B4U), link->rate / 10); + + mwv207_edp_writeb(edp, (0x1000+0x002CU), 0); + mwv207_edp_writeb(edp, (0x1000+0x0094U), 0x1); + + mwv207_edp_writeb(edp, (0x1000+0x0084U), 1); +} + +static ssize_t mwv207_edp_aux_transfer(struct drm_dp_aux *aux, + struct drm_dp_aux_msg *msg) +{ + ssize_t result = 0; + struct mwv207_edp *edp = aux_to_edp(aux); + u32 request = msg->request & ~(DP_AUX_I2C_MOT | DP_AUX_I2C_WRITE_STATUS_UPDATE); + + if (WARN_ON(msg->size > 16)) + return -E2BIG; + + switch (request) { + case DP_AUX_NATIVE_WRITE: + case DP_AUX_I2C_WRITE: + case DP_AUX_NATIVE_READ: + case DP_AUX_I2C_READ: + result = mwv207_process_aux_ch(edp, msg->address, &msg->reply, + (u8 *) msg->buffer, msg->size, request); + break; + default: + return -EINVAL; + } + + if (((request == DP_AUX_NATIVE_WRITE) + || (request == DP_AUX_I2C_WRITE)) + && result >= 0) + result = msg->size; + + DRM_DEBUG_DRIVER("Op: %x, addr: 0x%04x, size: %ld, reply code = %x", + request, msg->address, msg->size, msg->reply); + return result; +} + +static void mwv207_edp_destroy(struct drm_connector *conn) +{ + drm_connector_unregister(conn); + drm_connector_cleanup(conn); +} + +static int mwv207_edp_output_late_register(struct drm_connector *connector) +{ + int ret; + struct mwv207_edp *edp = connector_to_edp(connector); + struct mwv207_output *output = connector_to_output(connector); + + edp->aux.name = "mwv207_edp_aux"; + edp->aux.dev = connector->dev->dev; + edp->aux.drm_dev = connector->dev; + edp->aux.transfer = mwv207_edp_aux_transfer; + ret = drm_dp_aux_register(&edp->aux); + if (ret) { + DRM_ERROR("failed to register drm aux: %d\n", ret); + return -EINVAL; + } + edp->link.ops = &mwv207_dp_link_funcs; + edp->link.aux = &edp->aux; + output->ddc = &edp->aux.ddc; + + return 0; +} + +static void mwv207_edp_output_early_unregister(struct drm_connector *connector) +{ + struct mwv207_edp *edp = connector_to_edp(connector); + drm_dp_aux_unregister(&edp->aux); +} + +static enum drm_mode_status mwv207_edp_mode_valid(struct mwv207_edp *edp, + const struct drm_display_mode *mode) +{ + + if (mode->clock > 594000) + return MODE_CLOCK_HIGH; + + return MODE_OK; +} + +static int mwv207_edp_get_modes(struct drm_connector *connector) +{ + return mwv207_output_get_modes(connector); +} + +static enum drm_mode_status mwv207_edp_connector_mode_valid(struct drm_connector *connector, + struct drm_display_mode *mode) +{ + return mwv207_edp_mode_valid(connector_to_edp(connector), mode); +} + +static int mwv207_edp_detect_ctx(struct drm_connector *connector, + struct drm_modeset_acquire_ctx *ctx, + bool force) +{ + struct mwv207_edp *edp = connector_to_edp(connector); + u32 value; + + value = mwv207_edp_readb(edp, (0x1000+0x0128U)); + if (value) + return connector_status_connected; + else + return connector_status_disconnected; +} + +static void mwv207_edp_switch(struct mwv207_output *output, bool on) +{ + mwv207_output_modify(output, MWV207_EDP_CTRL(output->idx), 1 << 3, (on ? 1 : 0) << 3); +} + +static void mwv207_edp_select_crtc(struct mwv207_output *output) +{ + jdev_modify(output->jdev, 0x9B0034, 0x1 << (8 + output->idx), 0); + jdev_modify(output->jdev, 0x9B0038, 0x1 << (8 + output->idx), 0); + + msleep(20); + jdev_modify(output->jdev, 0x9B0034, 0x1 << (8 + output->idx), + 0x1 << (8 + output->idx)); + jdev_modify(output->jdev, 0x9B0038, 0x1 << (8 + output->idx), + 0x1 << (8 + output->idx)); + msleep(20); + + mwv207_output_modify(output, MWV207_EDP_CTRL(output->idx), + 0x7, drm_crtc_index(output->cur_crtc)); + + jdev_modify(output->jdev, 0x9B003C, 0b111 << (24 + output->idx * 4), + drm_crtc_index(output->cur_crtc) << (24 + output->idx * 4)); +} + +static void mwv207_encoder_edp_config_para(struct mwv207_edp *edp) +{ + mwv207_edp_hw_init(edp); + + mwv207_edp_writeb(edp, (0x1000+0x0090U), 0x01); + + mwv207_edp_writeb(edp, (0x1000+0x0080U), 0x1); + + mwv207_edp_set_aux_clk(edp); + + mwv207_edp_writeb(edp, (0x1000+0x0024U), 0x12); + + mwv207_edp_writeb(edp, (0x1000+0x0014U), 1); +} + +static void mwv207_edp_set_timing(struct mwv207_edp *edp) +{ + struct drm_display_mode *mode; + struct drm_display_info *info; + int err; + mode = &edp->base.cur_crtc->state->adjusted_mode; + info = &edp->base.connector.display_info; + + mwv207_encoder_edp_config_para(edp); + + err = mwv207_dp_link_probe(edp->link.aux, &edp->link); + if (err < 0) + DRM_DEBUG_DRIVER("failed to probe DP link: %d\n", err); + + err = mwv207_dp_link_choose(&edp->link, mode, info); + if (err < 0) + DRM_DEBUG_DRIVER("failed to choose link: %d\n", err); + + err = mwv207_dp_link_train(&edp->link); + if (err < 0) + DRM_DEBUG_DRIVER("link training failed: %d\n", err); + + err = mwv207_dp_link_power_up(edp->link.aux, &edp->link); + if (err < 0) + DRM_DEBUG_DRIVER("failed to power up DP link: %d\n", err); + + mwv207_encoder_set_edp_timing(edp, mode); +} + +static void mwv207_edp_encoder_disable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + struct mwv207_edp *edp = encoder_to_edp(encoder); + int err; + + mwv207_edp_writeb(edp, (0x1000+0x0084U), 0); + mwv207_edp_switch(output, false); + err = mwv207_dp_link_power_down(edp->link.aux, &edp->link); + if (err < 0) + DRM_DEBUG_DRIVER("failed to power down DP link: %d\n", err); +} + +static void mwv207_edp_encoder_reset(struct drm_encoder *encoder) +{ + struct mwv207_edp *edp = encoder_to_edp(encoder); + mwv207_edp_encoder_disable(encoder); + + mwv207_edp_writeb(edp, (0x1000+0x0080U), 0x1); +} + +static enum drm_mode_status mwv207_edp_encoder_mode_valid(struct drm_encoder + *encoder, const struct + drm_display_mode * mode) +{ + return mwv207_edp_mode_valid(encoder_to_edp(encoder), mode); +} + +static int mwv207_edp_encoder_atomic_check(struct drm_encoder *encoder, + struct drm_crtc_state *crtc_state, + struct drm_connector_state + *conn_state) +{ + return 0; +} + +static void mwv207_edp_encoder_enable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + mwv207_edp_select_crtc(output); + mwv207_edp_set_timing(encoder_to_edp(encoder)); + mwv207_edp_switch(output, true); +} + +static const struct drm_connector_funcs mwv207_edp_connector_funcs = { + .reset = drm_atomic_helper_connector_reset, + .fill_modes = drm_helper_probe_single_connector_modes, + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, + .destroy = mwv207_edp_destroy, + .late_register = mwv207_edp_output_late_register, + .early_unregister = mwv207_edp_output_early_unregister, +}; + +static const struct drm_connector_helper_funcs mwv207_edp_connector_helper_funcs = { + .get_modes = mwv207_edp_get_modes, + .mode_valid = mwv207_edp_connector_mode_valid, + .detect_ctx = mwv207_edp_detect_ctx, +}; + +static const struct drm_encoder_funcs mwv207_edp_encoder_funcs = { + .destroy = drm_encoder_cleanup, + .reset = mwv207_edp_encoder_reset, +}; + +static const struct drm_encoder_helper_funcs mwv207_edp_encoder_helper_funcs = { + .mode_valid = mwv207_edp_encoder_mode_valid, + .atomic_check = mwv207_edp_encoder_atomic_check, + .enable = mwv207_edp_encoder_enable, + .disable = mwv207_edp_encoder_disable, +}; + +static int mwv207_edp_init_single(struct mwv207_device *jdev, int idx) +{ + struct mwv207_output *output; + struct mwv207_edp *edp; + int ret; + + edp = devm_kzalloc(jdev->dev, sizeof(*edp), GFP_KERNEL); + if (!edp) + return -ENOMEM; + + output = &edp->base; + output->jdev = jdev; + output->idx = idx; + output->mmio = jdev->mmio + 0x9A0000; + edp->mmio = jdev->mmio + MWV207_EDP_BASE(idx); + + init_completion(&edp->aux_comp); + mutex_init(&edp->aux_mutex); + spin_lock_init(&edp->poll.hpd_lock); + init_waitqueue_head(&edp->poll.poll_wait); + edp->poll.wait_cond = 0; + edp->poll.poll_task = + kthread_run(mwv207_edp_poll_task, edp, + "mwv207_dp_hpd_handler"); + if (IS_ERR(edp->poll.poll_task)) { + DRM_ERROR("unable to create kernel thread: %ld\n", + PTR_ERR(edp->poll.poll_task)); + } + + ret = mwv207_edp_phy_parse_cfg(edp); + if (ret) + return ret; + + output->connector.polled = DRM_CONNECTOR_POLL_HPD; + ret = drm_connector_init(&jdev->base, &output->connector, + &mwv207_edp_connector_funcs, DRM_MODE_CONNECTOR_DisplayPort); + if (ret) + return ret; + drm_connector_helper_add(&output->connector, &mwv207_edp_connector_helper_funcs); + + output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; + ret = drm_encoder_init(&jdev->base, &output->encoder, + &mwv207_edp_encoder_funcs, DRM_MODE_ENCODER_TMDS, + "edp-%d", output->idx); + if (ret) + return ret; + + drm_encoder_helper_add(&output->encoder, &mwv207_edp_encoder_helper_funcs); + + ret = drm_connector_attach_encoder(&output->connector, &output->encoder); + if (ret) + return ret; + + edp->irq = irq_find_mapping(jdev->irq_domain, output->idx + 0x28); + BUG_ON(edp->irq == 0); + + ret = devm_request_irq(jdev->dev, edp->irq, mwv207_edp_irq, 0, + output->encoder.name, edp); + if (ret < 0) { + dev_err(jdev->dev, "failed to request IRQ#%u: %d\n", + edp->irq, ret); + return ret; + } + + mwv207_edp_hw_init(edp); + return drm_connector_register(&output->connector); +} + +int mwv207_edp_init(struct mwv207_device *jdev) +{ + int i, ret; + + for (i = 0; i < 0x1; i++) { + ret = mwv207_edp_init_single(jdev, i); + if (ret) + return ret; + } + + pr_info("%s TBD", __func__); + return 0; +} + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_edp.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_edp.h new file mode 100644 index 0000000000000000000000000000000000000000..7ab5ae1a8f17943e3ca0c41dca7857474c815102 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_edp.h @@ -0,0 +1,23 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ + +#ifndef __MWV207_EDP_H__ +#define __MWV207_EDP_H__ + +#define MWV207_EDP_CTRL(idx) (0x800 + 0x4 * (idx)) + +#endif + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_fb.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_fb.c new file mode 100644 index 0000000000000000000000000000000000000000..6852fac8586a155be86f392299f91e3115ef4b70 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_fb.c @@ -0,0 +1,232 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "mwv207_drv.h" +#include "mwv207_bo.h" +#include "mwv207_drm.h" +#include "mwv207_gem.h" +#include "mwv207_kms.h" +#include "mwv207_drv.h" + +static struct fb_ops mwv207_fb_ops = { + .owner = THIS_MODULE, + DRM_FB_HELPER_DEFAULT_OPS, + .fb_fillrect = cfb_fillrect, + .fb_copyarea = cfb_copyarea, + .fb_imageblit = cfb_imageblit, +}; + +static int mwv207_fb_create(struct drm_fb_helper *fb_helper, + struct drm_fb_helper_surface_size *sizes) +{ + struct drm_mode_fb_cmd2 mode_cmd; + struct drm_framebuffer *fb; + struct mwv207_device *jdev; + struct mwv207_bo *jbo; + struct fb_info *info; + u32 bytes; + void *logical; + int ret; + + jdev = fb_helper->dev->dev_private; + memset(&mode_cmd, 0, sizeof(mode_cmd)); + mode_cmd.width = sizes->surface_width; + mode_cmd.height = sizes->surface_height; + if (sizes->surface_bpp == 24) + sizes->surface_bpp = 32; + + mode_cmd.pitches[0] = mode_cmd.width * ((sizes->surface_bpp + 7)/8); + mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, + sizes->surface_depth); + + info = drm_fb_helper_alloc_info(fb_helper); + if (IS_ERR(info)) + return PTR_ERR(info); + + bytes = mode_cmd.pitches[0] * mode_cmd.height; + bytes = ALIGN(bytes, PAGE_SIZE); + ret = mwv207_bo_create(jdev, bytes, 0x10000, true, + 0x2, + 0x1, + NULL, NULL, &jbo); + if (ret) + return ret; + + fb = kzalloc(sizeof(*fb), GFP_KERNEL); + if (fb == NULL) { + ret = -ENOMEM; + goto free_bo; + } + + ret = mwv207_framebuffer_init(jdev, fb, &mode_cmd, mwv207_gem_from_bo(jbo)); + if (ret) + goto free_fb; + + ret = mwv207_bo_reserve(jbo, true); + if (ret) + goto free_fb; + ret = mwv207_bo_pin_reserved(jbo, 0x2); + if (ret) + goto unreserve_bo; + + ret = mwv207_bo_kmap_reserved(jbo, &logical); + if (ret) + goto unpin_bo; + + memset(logical, 0x0, bytes); + + fb_helper->fb = fb; + info->skip_vt_switch = true; + info->fbops = &mwv207_fb_ops; + info->screen_size = fb->height * fb->pitches[0]; + info->fix.smem_len = info->screen_size; + info->screen_base = logical; + + drm_fb_helper_fill_info(info, fb_helper, sizes); + + mwv207_bo_unreserve(jbo); + return 0; + +unpin_bo: + mwv207_bo_unpin(jbo); +unreserve_bo: + mwv207_bo_unreserve(jbo); +free_fb: + kfree(fb); +free_bo: + mwv207_bo_unref(jbo); + return ret; +} + +static const struct drm_fb_helper_funcs mwv207_fb_helper_funcs = { + .fb_probe = mwv207_fb_create, +}; + +static void mwv207_fbdev_client_unregister(struct drm_client_dev *client) +{ + struct drm_fb_helper *fb_helper = drm_fb_helper_from_client(client); + + if (fb_helper->info) { + drm_fb_helper_unregister_info(fb_helper); + } else { + drm_client_release(&fb_helper->client); + drm_fb_helper_unprepare(fb_helper); + kfree(fb_helper); + } +} + +static int mwv207_fbdev_client_restore(struct drm_client_dev *client) +{ + drm_fb_helper_lastclose(client->dev); + + return 0; +} + +static int mwv207_fbdev_client_hotplug(struct drm_client_dev *client) +{ + struct drm_fb_helper *fb_helper = drm_fb_helper_from_client(client); + struct drm_device *dev = client->dev; + int ret; + + if (dev->fb_helper) + return drm_fb_helper_hotplug_event(dev->fb_helper); + + ret = drm_fb_helper_init(dev, fb_helper); + if (ret) + goto err_drm_err; + + if (!drm_drv_uses_atomic_modeset(dev)) + drm_helper_disable_unused_functions(dev); + + ret = drm_fb_helper_initial_config(fb_helper); + if (ret) + goto err_drm_fb_helper_fini; + + return 0; + +err_drm_fb_helper_fini: + drm_fb_helper_fini(fb_helper); +err_drm_err: + drm_err(dev, "Failed to setup fbdev emulation (ret=%d)\n", ret); + return ret; +} + +static const struct drm_client_funcs mwv207_fbdev_client_funcs = { + .owner = THIS_MODULE, + .unregister = mwv207_fbdev_client_unregister, + .restore = mwv207_fbdev_client_restore, + .hotplug = mwv207_fbdev_client_hotplug, +}; + +int mwv207_fbdev_init(struct mwv207_device *jdev) +{ + int preferred_bpp = 32; + struct drm_device *dev = &jdev->base; + struct mwv207_fbdev *fbdev; + int ret; + + fbdev = devm_kzalloc(jdev->dev, sizeof(*fbdev), GFP_KERNEL); + if (!fbdev) + return -ENOMEM; + + drm_fb_helper_prepare(dev,&fbdev->helper, preferred_bpp, &mwv207_fb_helper_funcs); + + ret = drm_client_init(dev, &fbdev->helper.client, "fbdev", &mwv207_fbdev_client_funcs); + if (ret) + goto err_drm_client_init; + + drm_client_register(&fbdev->helper.client); + + fbdev->helper.dev = dev; + jdev->fbdev = fbdev; + return 0; +err_drm_client_init: + drm_fb_helper_fini(&fbdev->helper); + return ret; +} + +void mwv207_fbdev_fini(struct mwv207_device *jdev) +{ + struct mwv207_fbdev *fbdev = jdev->fbdev; + + if (!fbdev) + return; + + drm_framebuffer_unregister_private(&fbdev->fb); + pr_info("Module refcount: %u\n", module_refcount(THIS_MODULE)); + drm_framebuffer_cleanup(&fbdev->fb); + pr_info("Module refcount: %u\n", module_refcount(THIS_MODULE)); + drm_fb_helper_fini(&fbdev->helper); + pr_info("Module refcount: %u\n", module_refcount(THIS_MODULE)); + + if (mwv207_bo_reserve(fbdev->jbo, false) == 0) { + pr_info("Module refcount: %u\n", module_refcount(THIS_MODULE)); + mwv207_bo_kunmap_reserved(fbdev->jbo); + mwv207_bo_unpin(fbdev->jbo); + mwv207_bo_unreserve(fbdev->jbo); + mwv207_bo_unref(fbdev->jbo); + } + pr_info("Module refcount: %u\n", module_refcount(THIS_MODULE)); + jdev->fbdev = NULL; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_hdmi.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_hdmi.c new file mode 100644 index 0000000000000000000000000000000000000000..06d991fac96c3e6f03072cdf3477c0e0a4138ae7 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_hdmi.c @@ -0,0 +1,1204 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ + +#include +#include +#include +#include "mwv207_vi.h" +#include "dw-hdmi.h" +#include "mwv207_vbios.h" + +#define MWV207_HDMI_BASE(idx) (0x1200000 + 0x40000 * (idx)) + +#define MWV207_HDMI_CTRL(idx) (0x400 + 0x100 * (idx)) +#define MWV207_HDMI_PHY(idx) (0x6000 + 0x800 * (idx)) + +#define connector_to_hdmi(conn) container_of(conn, struct mwv207_hdmi, base.connector) +#define encoder_to_hdmi(encoder) container_of(encoder, struct mwv207_hdmi, base.encoder) + +struct mwv207_hdmi_phy_data { + u32 min_freq_khz; + u32 max_freq_khz; + u32 bpp; + u8 config[0x2F]; + u8 padding; +} __packed; + +struct mwv207_hdmi { + struct mwv207_output base; + + void __iomem *mmio; + bool sink_is_hdmi; + bool sink_has_audio; + unsigned int tmdsclock; + int vic; + + int irq; + + struct delayed_work hotplug_work; + + u8 mc_clkdis; + bool rgb_limited_range; + struct mwv207_hdmi_phy_data phy_data[0x13]; +}; + +static bool mwv207_hdmi_support_scdc(struct mwv207_hdmi *hdmi, + const struct drm_display_info *display); + +static const u16 csc_coeff_default[3][4] = { + { 0x2000, 0x0000, 0x0000, 0x0000 }, + { 0x0000, 0x2000, 0x0000, 0x0000 }, + { 0x0000, 0x0000, 0x2000, 0x0000 } +}; + +static const u16 csc_coeff_rgb_full_to_rgb_limited[3][4] = { + { 0x1b7c, 0x0000, 0x0000, 0x0020 }, + { 0x0000, 0x1b7c, 0x0000, 0x0020 }, + { 0x0000, 0x0000, 0x1b7c, 0x0020 } +}; + +static inline u8 mwv207_hdmi_readb(struct mwv207_hdmi *hdmi, u32 reg) +{ + return readl(hdmi->mmio + reg * 4); +} + +static inline void mwv207_hdmi_writeb(struct mwv207_hdmi *hdmi, u8 value, u32 reg) +{ + writel_relaxed(value, hdmi->mmio + reg * 4); +} + +static inline void mwv207_hdmi_modb(struct mwv207_hdmi *hdmi, u8 value, u8 mask, u32 reg) +{ + u8 rvalue = mwv207_hdmi_readb(hdmi, reg); + + rvalue = (rvalue & ~mask) | (value & mask); + mwv207_hdmi_writeb(hdmi, rvalue, reg); +} + +static void mwv207_hdmi_mask_writeb(struct mwv207_hdmi *hdmi, u8 data, unsigned int reg, + u8 shift, u8 mask) +{ + mwv207_hdmi_modb(hdmi, data << shift, mask, reg); +} + +static int mwv207_hdmi_phy_data_init(struct mwv207_hdmi *hdmi, int idx) +{ + const struct mwv207_vdat *vdat; + int i; + + vdat = mwv207_vbios_vdat(hdmi->base.jdev, 0xFFF0 + idx); + if (!vdat && idx != 0) + vdat = mwv207_vbios_vdat(hdmi->base.jdev, 0xFFF0); + if (!vdat) + return -ENOENT; + if (vdat->len != sizeof(hdmi->phy_data)) + return -EINVAL; + + memcpy(hdmi->phy_data, vdat->dat, vdat->len); + for (i = 0; i < 0x13; ++i) { + hdmi->phy_data[i].min_freq_khz = + le32_to_cpu(hdmi->phy_data[i].min_freq_khz); + hdmi->phy_data[i].max_freq_khz = + le32_to_cpu(hdmi->phy_data[i].max_freq_khz); + hdmi->phy_data[i].bpp = + le32_to_cpu(hdmi->phy_data[i].bpp); + } + + return 0; +} + +static void mwv207_hdmi_set_high_tmds_clock_ratio(struct mwv207_hdmi *hdmi) +{ + struct drm_display_info *display = &hdmi->base.connector.display_info; + + if (mwv207_hdmi_support_scdc(hdmi, display)) { + if (hdmi->tmdsclock > 0x1443FD00) + drm_scdc_set_high_tmds_clock_ratio(&hdmi->base.connector, 1); + else + drm_scdc_set_high_tmds_clock_ratio(&hdmi->base.connector, 0); + } +} + +static void mwv207_hdmi_phy_configure_data(struct mwv207_hdmi *hdmi, int kfreq, int bpp) +{ + struct mwv207_output *output = &hdmi->base; + u32 regbase = MWV207_HDMI_PHY(output->idx); + int i, cfg, offset; + + for (i = 0; i < 0x13; ++i) { + if (kfreq >= hdmi->phy_data[i].min_freq_khz + && kfreq <= hdmi->phy_data[i].max_freq_khz + && bpp == hdmi->phy_data[i].bpp) + break; + } + if (i >= 0x13) { + pr_warn("mwv207: no matching hdmi phydata found"); + return; + } + + cfg = i; + mwv207_output_write(output, regbase + 0x70, 0xc8); + mwv207_output_write(output, regbase + 0x74, 0x2); + for (i = 0; i < 0x2F; i++) { + offset = 0x4 + i * 4; + if (offset == 0x84 || offset == 0x88 || offset == 0xB8) + continue; + + mwv207_output_write(output, regbase + offset, + hdmi->phy_data[cfg].config[i]); + } +} + +static void mwv207_hdmi_phy_switch(struct mwv207_hdmi *hdmi, int enable) +{ + struct mwv207_output *output = &hdmi->base; + u32 regbase = MWV207_HDMI_PHY(output->idx); + + if (enable) { + mwv207_output_write(output, regbase + 0x84, 0x80); + mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), + 1 << 28, 0 << 28); + } else { + mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), + 1 << 28, 1 << 28); + mwv207_output_write(output, regbase + 0x84, 0x00); + } +} + +static void mwv207_hdmi_phy_power_on(struct mwv207_hdmi *hdmi) +{ + u8 val; + int i; + + mwv207_hdmi_phy_switch(hdmi, 1); + + for (i = 0; i < 5; ++i) { + val = mwv207_hdmi_readb(hdmi, 0x3004) & HDMI_PHY_TX_PHY_LOCK; + if (val) + break; + usleep_range(1000, 2000); + } + + if (!val) + pr_warn("mwv207: hdmi PHY PLL failed to lock\n"); +} + +static void mwv207_hdmi_phy_power_off(struct mwv207_hdmi *hdmi) +{ + u8 val; + int i; + + mwv207_hdmi_phy_switch(hdmi, 0); + + for (i = 0; i < 5; ++i) { + val = mwv207_hdmi_readb(hdmi, 0x3004); + if (!(val & HDMI_PHY_TX_PHY_LOCK)) + break; + + usleep_range(1000, 2000); + } + + if (val & HDMI_PHY_TX_PHY_LOCK) + pr_warn("mwv207: PHY failed to power down\n"); +} + +static void mwv207_hdmi_phy_configure(struct mwv207_hdmi *hdmi, int kfreq, int bpp) +{ + mwv207_hdmi_phy_power_off(hdmi); + + mwv207_hdmi_set_high_tmds_clock_ratio(hdmi); + + mwv207_hdmi_phy_configure_data(hdmi, kfreq, bpp); + + if (hdmi->tmdsclock > 0x1443FD00) + msleep(100); + + mwv207_hdmi_phy_power_on(hdmi); +} + +static void mwv207_hdmi_clear_overflow(struct mwv207_hdmi *hdmi) +{ + u8 val; + + mwv207_hdmi_writeb(hdmi, (u8) ~HDMI_MC_SWRSTZ_TMDSSWRST_REQ, 0x4002); + + val = mwv207_hdmi_readb(hdmi, 0x1000); + mwv207_hdmi_writeb(hdmi, val, 0x1000); +} + +static void mwv207_hdmi_ih_mutes(struct mwv207_hdmi *hdmi) +{ + u8 ih_mute; + + ih_mute = mwv207_hdmi_readb(hdmi, 0x1FF) | + HDMI_IH_MUTE_MUTE_WAKEUP_INTERRUPT | + HDMI_IH_MUTE_MUTE_ALL_INTERRUPT; + + mwv207_hdmi_writeb(hdmi, ih_mute, 0x1FF); + + mwv207_hdmi_writeb(hdmi, 0xff, 0x807); + mwv207_hdmi_writeb(hdmi, 0xff, 0x10D2); + mwv207_hdmi_writeb(hdmi, 0xff, 0x10D6); + mwv207_hdmi_writeb(hdmi, 0xff, 0x10DA); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3006); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3027); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3028); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3102); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3302); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3404); + mwv207_hdmi_writeb(hdmi, 0xff, 0x3505); + mwv207_hdmi_writeb(hdmi, 0xff, 0x5008); + mwv207_hdmi_writeb(hdmi, 0xff, 0x7E05); + mwv207_hdmi_writeb(hdmi, 0xff, 0x7E06); + + mwv207_hdmi_writeb(hdmi, 0xff, 0x180); + mwv207_hdmi_writeb(hdmi, 0xff, 0x181); + mwv207_hdmi_writeb(hdmi, 0xff, 0x182); + mwv207_hdmi_writeb(hdmi, 0xff, 0x183); + mwv207_hdmi_writeb(hdmi, 0xff, 0x184); + mwv207_hdmi_writeb(hdmi, 0xff, 0x185); + mwv207_hdmi_writeb(hdmi, 0xff, 0x186); + mwv207_hdmi_writeb(hdmi, 0xff, 0x187); + mwv207_hdmi_writeb(hdmi, 0xff, 0x188); + mwv207_hdmi_writeb(hdmi, 0xff, 0x189); + + ih_mute &= ~(HDMI_IH_MUTE_MUTE_WAKEUP_INTERRUPT | + HDMI_IH_MUTE_MUTE_ALL_INTERRUPT); + mwv207_hdmi_writeb(hdmi, ih_mute, 0x1FF); +} + +static void mwv207_hdmi_phy_setup_hpd(struct mwv207_hdmi *hdmi) +{ + + mwv207_hdmi_writeb(hdmi, HDMI_PHY_HPD, 0x3007); + mwv207_hdmi_writeb(hdmi, HDMI_IH_PHY_STAT0_HPD, 0x104); + + mwv207_hdmi_writeb(hdmi, ~HDMI_PHY_HPD, 0x3006); + + mwv207_hdmi_writeb(hdmi, HDMI_IH_PHY_STAT0_HPD, 0x104); + mwv207_hdmi_writeb(hdmi, ~HDMI_IH_PHY_STAT0_HPD, 0x184); +} + +static int mwv207_hdmi_link_reset(struct mwv207_hdmi *hdmi, + struct drm_modeset_acquire_ctx *ctx) +{ + struct drm_crtc *crtc = hdmi->base.connector.state->crtc; + struct drm_atomic_state *state; + struct drm_crtc_state *crtc_state; + int ret; + + state = drm_atomic_state_alloc(crtc->dev); + if (!state) + return -ENOMEM; + + state->acquire_ctx = ctx; + + crtc_state = drm_atomic_get_crtc_state(state, crtc); + if (IS_ERR(crtc_state)) { + ret = PTR_ERR(crtc_state); + goto out; + } + + crtc_state->connectors_changed = true; + + ret = drm_atomic_commit(state); +out: + drm_atomic_state_put(state); + + return ret; +} + +static int mwv207_hdmi_get_modes(struct drm_connector *connector); +static int mwv207_hdmi_link_check(struct mwv207_hdmi *hdmi, + struct drm_modeset_acquire_ctx *ctx) +{ + struct drm_connector *connector = &hdmi->base.connector; + struct drm_device *dev = &hdmi->base.jdev->base; + struct drm_connector_state *conn_state; + struct drm_crtc *crtc; + int ret; + + if (connector->status != connector_status_connected) + return -EINVAL; + + ret = drm_modeset_lock(&dev->mode_config.connection_mutex, ctx); + if (ret) + return ret; + + conn_state = connector->state; + if (!conn_state) + return -EINVAL; + + crtc = conn_state->crtc; + if (!crtc) + return -EINVAL; + + ret = drm_modeset_lock(&crtc->mutex, ctx); + if (ret) + return ret; + + if (!crtc->state || !crtc->state->active) + return -EINVAL; + + if (conn_state->commit && + !try_wait_for_completion(&conn_state->commit->hw_done)) + return -EINVAL; + + mwv207_hdmi_get_modes(connector); + + if (!mwv207_hdmi_support_scdc(hdmi, &connector->display_info) || + hdmi->tmdsclock <= 0x1443FD00) + return -EINVAL; + + return 0; +} + +static void mwv207_hdmi_link_update(struct mwv207_hdmi *hdmi) +{ + struct drm_device *dev = &hdmi->base.jdev->base; + struct drm_modeset_acquire_ctx ctx; + int ret; + + drm_modeset_acquire_init(&ctx, 0); +retry: + ret = mwv207_hdmi_link_check(hdmi, &ctx); + + if (ret == 0) { + dev_dbg(dev->dev, "hdmi %d received hotplug event, do link reset", hdmi->base.idx); + ret = mwv207_hdmi_link_reset(hdmi, &ctx); + } + + if (ret == -EDEADLK) { + drm_modeset_backoff(&ctx); + goto retry; + } + + drm_modeset_drop_locks(&ctx); + drm_modeset_acquire_fini(&ctx); +} + +static void mwv207_hdmi_hotplug_work_func(struct work_struct *work) +{ + struct mwv207_hdmi *hdmi = container_of(work, struct mwv207_hdmi, hotplug_work.work); + struct drm_device *dev = &hdmi->base.jdev->base; + struct drm_connector *connector = &hdmi->base.connector; + enum drm_connector_status old_status; + bool changed; + + mutex_lock(&dev->mode_config.mutex); + + old_status = connector->status; + connector->status = drm_helper_probe_detect(connector, NULL, false); + changed = old_status != connector->status; + + dev_dbg(dev->dev, "[CONNECTOR:%d:%s] status updated from %s to %s\n", + connector->base.id, + connector->name, + drm_get_connector_status_name(old_status), + drm_get_connector_status_name(connector->status)); + + mwv207_hdmi_link_update(hdmi); + + mutex_unlock(&dev->mode_config.mutex); + + if (changed) + drm_kms_helper_hotplug_event(dev); +} + +static irqreturn_t mwv207_hdmi_hard_irq(int irq, void *dev_id) +{ + struct mwv207_hdmi *hdmi = dev_id; + irqreturn_t ret = IRQ_NONE; + u8 intr_stat; + + intr_stat = mwv207_hdmi_readb(hdmi, 0x104); + if (intr_stat) { + mwv207_hdmi_writeb(hdmi, ~0, 0x184); + return IRQ_WAKE_THREAD; + } + + return ret; +} + +static irqreturn_t mwv207_hdmi_irq(int irq, void *dev_id) +{ + u8 intr_stat, phy_int_pol, phy_pol_mask, phy_stat; + struct mwv207_hdmi *hdmi = dev_id; + + intr_stat = mwv207_hdmi_readb(hdmi, 0x104); + phy_int_pol = mwv207_hdmi_readb(hdmi, 0x3007); + phy_stat = mwv207_hdmi_readb(hdmi, 0x3004); + + phy_pol_mask = 0; + if (intr_stat & HDMI_IH_PHY_STAT0_HPD) + phy_pol_mask |= HDMI_PHY_HPD; + if (intr_stat & HDMI_IH_PHY_STAT0_RX_SENSE0) + phy_pol_mask |= HDMI_PHY_RX_SENSE0; + if (intr_stat & HDMI_IH_PHY_STAT0_RX_SENSE1) + phy_pol_mask |= HDMI_PHY_RX_SENSE1; + if (intr_stat & HDMI_IH_PHY_STAT0_RX_SENSE2) + phy_pol_mask |= HDMI_PHY_RX_SENSE2; + if (intr_stat & HDMI_IH_PHY_STAT0_RX_SENSE3) + phy_pol_mask |= HDMI_PHY_RX_SENSE3; + + if (phy_pol_mask) + mwv207_hdmi_modb(hdmi, ~phy_int_pol, phy_pol_mask, 0x3007); + + if (intr_stat & HDMI_IH_PHY_STAT0_HPD) + queue_delayed_work(system_wq, &hdmi->hotplug_work, 0); + + mwv207_hdmi_writeb(hdmi, intr_stat, 0x104); + mwv207_hdmi_writeb(hdmi, ~HDMI_IH_PHY_STAT0_HPD, 0x184); + + return IRQ_HANDLED; +} + +static void mwv207_hdmi_switch(struct mwv207_output *output, bool on) +{ + mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), 1, on ? 1 : 0); +} + +static void mwv207_hdmi_select_crtc(struct mwv207_output *output) +{ + + mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), + 0x3 << 4, drm_crtc_index(output->cur_crtc) << 4); + + jdev_modify(output->jdev, 0x9B003C, 0b111 << (8 + output->idx * 4), + drm_crtc_index(output->cur_crtc) << (8 + output->idx * 4)); +} + +static void mwv207_hdmi_disable_overflow_interrupts(struct mwv207_hdmi *hdmi) +{ + mwv207_hdmi_writeb(hdmi, HDMI_IH_MUTE_FC_STAT2_OVERFLOW_MASK, + 0x182); +} + +static bool mwv207_hdmi_support_scdc(struct mwv207_hdmi *hdmi, + const struct drm_display_info *display) +{ + + if (!display->hdmi.scdc.supported || + !display->hdmi.scdc.scrambling.supported) + return false; + + if (!display->hdmi.scdc.scrambling.low_rates && + display->max_tmds_clock <= 340000) + return false; + + return true; +} + +static void mwv207_hdmi_av_composer(struct mwv207_hdmi *hdmi, const struct drm_display_mode *mode) +{ + const struct drm_display_info *display = &hdmi->base.connector.display_info; + const struct drm_hdmi_info *hdmi_info = &display->hdmi; + int hblank, vblank, h_de_hs, v_de_vs, hsync_len, vsync_len; + struct mwv207_output *output = &hdmi->base; + unsigned int vdisplay, hdisplay; + u32 tmdsclock, rate; + u8 inv_val, bytes; + + hdmi->tmdsclock = tmdsclock = mode->clock * 1000; + + inv_val = (mwv207_hdmi_support_scdc(hdmi, display) && + (tmdsclock > 0x1443FD00 || + hdmi_info->scdc.scrambling.low_rates) ? + HDMI_FC_INVIDCONF_HDCP_KEEPOUT_ACTIVE : + HDMI_FC_INVIDCONF_HDCP_KEEPOUT_INACTIVE); + + inv_val |= mode->flags & DRM_MODE_FLAG_PVSYNC ? + HDMI_FC_INVIDCONF_VSYNC_IN_POLARITY_ACTIVE_HIGH : + HDMI_FC_INVIDCONF_VSYNC_IN_POLARITY_ACTIVE_LOW; + + inv_val |= mode->flags & DRM_MODE_FLAG_PHSYNC ? + HDMI_FC_INVIDCONF_HSYNC_IN_POLARITY_ACTIVE_HIGH : + HDMI_FC_INVIDCONF_HSYNC_IN_POLARITY_ACTIVE_LOW; + + inv_val |= HDMI_FC_INVIDCONF_DE_IN_POLARITY_ACTIVE_HIGH; + + if (hdmi->vic == 39) + inv_val |= HDMI_FC_INVIDCONF_R_V_BLANK_IN_OSC_ACTIVE_HIGH; + else + inv_val |= mode->flags & DRM_MODE_FLAG_INTERLACE ? + HDMI_FC_INVIDCONF_R_V_BLANK_IN_OSC_ACTIVE_HIGH : + HDMI_FC_INVIDCONF_R_V_BLANK_IN_OSC_ACTIVE_LOW; + + inv_val |= mode->flags & DRM_MODE_FLAG_INTERLACE ? + HDMI_FC_INVIDCONF_IN_I_P_INTERLACED : + HDMI_FC_INVIDCONF_IN_I_P_PROGRESSIVE; + + inv_val |= hdmi->sink_is_hdmi ? + HDMI_FC_INVIDCONF_DVI_MODEZ_HDMI_MODE : + HDMI_FC_INVIDCONF_DVI_MODEZ_DVI_MODE; + + mwv207_hdmi_writeb(hdmi, inv_val, 0x1000); + + rate = drm_mode_vrefresh(mode) * 1000; + mwv207_hdmi_writeb(hdmi, rate >> 16, 0x1010); + mwv207_hdmi_writeb(hdmi, rate >> 8, 0x100F); + mwv207_hdmi_writeb(hdmi, rate, 0x100E); + + mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), 0x1 << 9, + (mode->flags & DRM_MODE_FLAG_PHSYNC ? 1 : 0) << 9); + mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), 0x1 << 8, + (mode->flags & DRM_MODE_FLAG_PVSYNC ? 1 : 0) << 8); + mwv207_output_modify(output, MWV207_HDMI_CTRL(output->idx), 0x1 << 10, 1 << 10); + + hdisplay = mode->hdisplay; + hblank = mode->htotal - mode->hdisplay; + h_de_hs = mode->hsync_start - mode->hdisplay; + hsync_len = mode->hsync_end - mode->hsync_start; + + vdisplay = mode->vdisplay; + vblank = mode->vtotal - mode->vdisplay; + v_de_vs = mode->vsync_start - mode->vdisplay; + vsync_len = mode->vsync_end - mode->vsync_start; + + if (mode->flags & DRM_MODE_FLAG_INTERLACE) { + vdisplay /= 2; + vblank /= 2; + v_de_vs /= 2; + vsync_len /= 2; + } + + if (mwv207_hdmi_support_scdc(hdmi, display)) { + if (tmdsclock > 0x1443FD00 || + hdmi_info->scdc.scrambling.low_rates) { + drm_scdc_readb(hdmi->base.ddc, SCDC_SINK_VERSION, + &bytes); + drm_scdc_writeb(hdmi->base.ddc, SCDC_SOURCE_VERSION, + min_t(u8, bytes, 0x1)); + + drm_scdc_set_scrambling(&output->connector, 1); + drm_scdc_set_high_tmds_clock_ratio(&hdmi->base.connector, 1); + + mwv207_hdmi_writeb(hdmi, (u8)~HDMI_MC_SWRSTZ_TMDSSWRST_REQ, + 0x4002); + mwv207_hdmi_writeb(hdmi, 1, 0x10E1); + } else { + mwv207_hdmi_writeb(hdmi, 0, 0x10E1); + mwv207_hdmi_writeb(hdmi, (u8)~HDMI_MC_SWRSTZ_TMDSSWRST_REQ, + 0x4002); + drm_scdc_set_scrambling(&output->connector, 0); + drm_scdc_set_high_tmds_clock_ratio(&hdmi->base.connector, 0); + } + } + + mwv207_hdmi_writeb(hdmi, hdisplay >> 8, 0x1002); + mwv207_hdmi_writeb(hdmi, hdisplay, 0x1001); + + mwv207_hdmi_writeb(hdmi, vdisplay >> 8, 0x1006); + mwv207_hdmi_writeb(hdmi, vdisplay, 0x1005); + + mwv207_hdmi_writeb(hdmi, hblank >> 8, 0x1004); + mwv207_hdmi_writeb(hdmi, hblank, 0x1003); + + mwv207_hdmi_writeb(hdmi, vblank >> 8, 0x102E); + mwv207_hdmi_writeb(hdmi, vblank, 0x1007); + + mwv207_hdmi_writeb(hdmi, h_de_hs >> 8, 0x1009); + mwv207_hdmi_writeb(hdmi, h_de_hs, 0x1008); + + mwv207_hdmi_writeb(hdmi, v_de_vs >> 8, 0x102F); + mwv207_hdmi_writeb(hdmi, v_de_vs, 0x100C); + + mwv207_hdmi_writeb(hdmi, hsync_len >> 8, 0x100B); + mwv207_hdmi_writeb(hdmi, hsync_len, 0x100A); + + mwv207_hdmi_writeb(hdmi, vsync_len, 0x100D); +} + +static void mwv207_hdmi_enable_video_path(struct mwv207_hdmi *hdmi) +{ + + mwv207_hdmi_writeb(hdmi, 12, 0x1011); + mwv207_hdmi_writeb(hdmi, 32, 0x1012); + mwv207_hdmi_writeb(hdmi, 1, 0x1013); + + mwv207_hdmi_writeb(hdmi, 0x0B, 0x1014); + mwv207_hdmi_writeb(hdmi, 0x16, 0x1015); + mwv207_hdmi_writeb(hdmi, 0x21, 0x1016); + + hdmi->mc_clkdis |= HDMI_MC_CLKDIS_HDCPCLK_DISABLE | + HDMI_MC_CLKDIS_AUDCLK_DISABLE | + HDMI_MC_CLKDIS_CSCCLK_DISABLE | + HDMI_MC_CLKDIS_PREPCLK_DISABLE | + HDMI_MC_CLKDIS_TMDSCLK_DISABLE; + hdmi->mc_clkdis &= ~HDMI_MC_CLKDIS_PIXELCLK_DISABLE; + mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); + + hdmi->mc_clkdis &= ~HDMI_MC_CLKDIS_TMDSCLK_DISABLE; + mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); + + if (hdmi->rgb_limited_range) { + hdmi->mc_clkdis &= ~HDMI_MC_CLKDIS_CSCCLK_DISABLE; + mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); + + mwv207_hdmi_writeb(hdmi, HDMI_MC_FLOWCTRL_FEED_THROUGH_OFF_CSC_IN_PATH, + 0x4004); + } else { + hdmi->mc_clkdis |= HDMI_MC_CLKDIS_CSCCLK_DISABLE; + mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); + + mwv207_hdmi_writeb(hdmi, HDMI_MC_FLOWCTRL_FEED_THROUGH_OFF_CSC_BYPASS, + 0x4004); + } +} + +static void mwv207_hdmi_enable_audio_clk(struct mwv207_hdmi *hdmi, bool enable) +{ + if (enable) + hdmi->mc_clkdis &= ~HDMI_MC_CLKDIS_AUDCLK_DISABLE; + else + hdmi->mc_clkdis |= HDMI_MC_CLKDIS_AUDCLK_DISABLE; + mwv207_hdmi_writeb(hdmi, hdmi->mc_clkdis, 0x4001); +} + +static void mwv207_hdmi_config_AVI(struct mwv207_hdmi *hdmi, + struct drm_connector *connector, + const struct drm_display_mode *mode) +{ + struct hdmi_avi_infoframe frame; + u8 val; + + drm_hdmi_avi_infoframe_from_display_mode(&frame, connector, mode); + + drm_hdmi_avi_infoframe_quant_range(&frame, connector, mode, + hdmi->rgb_limited_range ? + HDMI_QUANTIZATION_RANGE_LIMITED : + HDMI_QUANTIZATION_RANGE_FULL); + + frame.colorspace = HDMI_COLORSPACE_RGB; + frame.colorimetry = HDMI_COLORIMETRY_NONE; + frame.extended_colorimetry = + HDMI_EXTENDED_COLORIMETRY_XV_YCC_601; + + val = (frame.scan_mode & 3) << 4 | (frame.colorspace & 3); + if (frame.active_aspect & 15) + val |= HDMI_FC_AVICONF0_ACTIVE_FMT_INFO_PRESENT; + if (frame.top_bar || frame.bottom_bar) + val |= HDMI_FC_AVICONF0_BAR_DATA_HORIZ_BAR; + if (frame.left_bar || frame.right_bar) + val |= HDMI_FC_AVICONF0_BAR_DATA_VERT_BAR; + mwv207_hdmi_writeb(hdmi, val, 0x1019); + + val = ((frame.colorimetry & 0x3) << 6) | + ((frame.picture_aspect & 0x3) << 4) | + (frame.active_aspect & 0xf); + mwv207_hdmi_writeb(hdmi, val, 0x101A); + + val = ((frame.extended_colorimetry & 0x7) << 4) | + ((frame.quantization_range & 0x3) << 2) | + (frame.nups & 0x3); + if (frame.itc) + val |= HDMI_FC_AVICONF2_IT_CONTENT_VALID; + mwv207_hdmi_writeb(hdmi, val, 0x101B); + + val = frame.video_code & 0x7f; + mwv207_hdmi_writeb(hdmi, val, 0x101C); + + val = ((1 << HDMI_FC_PRCONF_INCOMING_PR_FACTOR_OFFSET) & + HDMI_FC_PRCONF_INCOMING_PR_FACTOR_MASK); + mwv207_hdmi_writeb(hdmi, val, 0x10E0); + + val = ((frame.ycc_quantization_range & 0x3) << 2) | + (frame.content_type & 0x3); + mwv207_hdmi_writeb(hdmi, val, 0x1017); + + mwv207_hdmi_writeb(hdmi, frame.top_bar & 0xff, 0x101D); + mwv207_hdmi_writeb(hdmi, (frame.top_bar >> 8) & 0xff, 0x101E); + mwv207_hdmi_writeb(hdmi, frame.bottom_bar & 0xff, 0x101F); + mwv207_hdmi_writeb(hdmi, (frame.bottom_bar >> 8) & 0xff, 0x1020); + mwv207_hdmi_writeb(hdmi, frame.left_bar & 0xff, 0x1021); + mwv207_hdmi_writeb(hdmi, (frame.left_bar >> 8) & 0xff, 0x1022); + mwv207_hdmi_writeb(hdmi, frame.right_bar & 0xff, 0x1023); + mwv207_hdmi_writeb(hdmi, (frame.right_bar >> 8) & 0xff, 0x1024); +} + +static void mwv207_hdmi_config_vendor_specific_infoframe(struct mwv207_hdmi *hdmi, + struct drm_connector *connector, + const struct drm_display_mode *mode) +{ + struct hdmi_vendor_infoframe frame; + u8 buffer[10]; + ssize_t err; + + err = drm_hdmi_vendor_infoframe_from_display_mode(&frame, connector, + mode); + if (err < 0) + return; + + err = hdmi_vendor_infoframe_pack(&frame, buffer, sizeof(buffer)); + if (err < 0) { + DRM_ERROR("Failed to pack vendor infoframe: %zd\n", err); + return; + } + mwv207_hdmi_mask_writeb(hdmi, 0, 0x10B3, HDMI_FC_DATAUTO0_VSD_OFFSET, + HDMI_FC_DATAUTO0_VSD_MASK); + + mwv207_hdmi_writeb(hdmi, buffer[2], 0x102A); + + mwv207_hdmi_writeb(hdmi, buffer[4], 0x1029); + mwv207_hdmi_writeb(hdmi, buffer[5], 0x1030); + mwv207_hdmi_writeb(hdmi, buffer[6], 0x1031); + + mwv207_hdmi_writeb(hdmi, buffer[7], 0x1032); + mwv207_hdmi_writeb(hdmi, buffer[8], 0x1033); + + if (frame.s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF) + mwv207_hdmi_writeb(hdmi, buffer[9], 0x1034); + + mwv207_hdmi_writeb(hdmi, 1, 0x10B4); + + mwv207_hdmi_writeb(hdmi, 0x11, 0x10B5); + + mwv207_hdmi_mask_writeb(hdmi, 1, 0x10B3, HDMI_FC_DATAUTO0_VSD_OFFSET, + HDMI_FC_DATAUTO0_VSD_MASK); +} + +static void mwv207_hdmi_config_drm_infoframe(struct mwv207_hdmi *hdmi, + const struct drm_connector *connector) +{ + const struct drm_connector_state *conn_state = connector->state; + struct hdmi_drm_infoframe frame; + u8 buffer[30]; + ssize_t err; + int i; + + mwv207_hdmi_modb(hdmi, HDMI_FC_PACKET_TX_EN_DRM_DISABLE, + HDMI_FC_PACKET_TX_EN_DRM_MASK, 0x10E3); + + err = drm_hdmi_infoframe_set_hdr_metadata(&frame, conn_state); + if (err < 0) + return; + + err = hdmi_drm_infoframe_pack(&frame, buffer, sizeof(buffer)); + if (err < 0) + return; + + mwv207_hdmi_writeb(hdmi, frame.version, 0x1168); + mwv207_hdmi_writeb(hdmi, frame.length, 0x1169); + + for (i = 0; i < frame.length; i++) + mwv207_hdmi_writeb(hdmi, buffer[4 + i], 0x116A + i); + + mwv207_hdmi_writeb(hdmi, 1, 0x1167); + mwv207_hdmi_modb(hdmi, HDMI_FC_PACKET_TX_EN_DRM_ENABLE, + HDMI_FC_PACKET_TX_EN_DRM_MASK, 0x10E3); +} + +static void mwv207_hdmi_video_packetize(struct mwv207_hdmi *hdmi) +{ + unsigned int output_select = HDMI_VP_CONF_OUTPUT_SELECTOR_BYPASS; + unsigned int remap_size = HDMI_VP_REMAP_YCC422_16bit; + unsigned int color_depth = 4; + u8 val, vp_conf; + + val = ((color_depth << HDMI_VP_PR_CD_COLOR_DEPTH_OFFSET) & + HDMI_VP_PR_CD_COLOR_DEPTH_MASK); + mwv207_hdmi_writeb(hdmi, val, 0x801); + + mwv207_hdmi_modb(hdmi, HDMI_VP_STUFF_PR_STUFFING_STUFFING_MODE, + HDMI_VP_STUFF_PR_STUFFING_MASK, 0x802); + + vp_conf = HDMI_VP_CONF_PR_EN_DISABLE | + HDMI_VP_CONF_BYPASS_SELECT_VID_PACKETIZER; + + mwv207_hdmi_modb(hdmi, vp_conf, + HDMI_VP_CONF_PR_EN_MASK | + HDMI_VP_CONF_BYPASS_SELECT_MASK, 0x804); + + mwv207_hdmi_modb(hdmi, 1 << HDMI_VP_STUFF_IDEFAULT_PHASE_OFFSET, + HDMI_VP_STUFF_IDEFAULT_PHASE_MASK, 0x802); + + mwv207_hdmi_writeb(hdmi, remap_size, 0x803); + + vp_conf = HDMI_VP_CONF_BYPASS_EN_ENABLE | + HDMI_VP_CONF_PP_EN_DISABLE | + HDMI_VP_CONF_YCC422_EN_DISABLE; + + mwv207_hdmi_modb(hdmi, vp_conf, + HDMI_VP_CONF_BYPASS_EN_MASK | HDMI_VP_CONF_PP_EN_ENMASK | + HDMI_VP_CONF_YCC422_EN_MASK, 0x804); + + mwv207_hdmi_modb(hdmi, HDMI_VP_STUFF_PP_STUFFING_STUFFING_MODE | + HDMI_VP_STUFF_YCC422_STUFFING_STUFFING_MODE, + HDMI_VP_STUFF_PP_STUFFING_MASK | + HDMI_VP_STUFF_YCC422_STUFFING_MASK, 0x802); + + mwv207_hdmi_modb(hdmi, output_select, HDMI_VP_CONF_OUTPUT_SELECTOR_MASK, + 0x804); +} + +static void mwv207_hdmi_update_csc_coeffs(struct mwv207_hdmi *hdmi) +{ + const u16 (*csc_coeff)[3][4] = &csc_coeff_default; + unsigned int i; + u32 csc_scale = 1; + + if (hdmi->rgb_limited_range) + csc_coeff = &csc_coeff_rgb_full_to_rgb_limited; + else + csc_coeff = &csc_coeff_default; + + for (i = 0; i < ARRAY_SIZE(csc_coeff_default[0]); i++) { + u16 coeff_a = (*csc_coeff)[0][i]; + u16 coeff_b = (*csc_coeff)[1][i]; + u16 coeff_c = (*csc_coeff)[2][i]; + + mwv207_hdmi_writeb(hdmi, coeff_a & 0xff, 0x4103 + i * 2); + mwv207_hdmi_writeb(hdmi, coeff_a >> 8, 0x4102 + i * 2); + mwv207_hdmi_writeb(hdmi, coeff_b & 0xff, 0x410B + i * 2); + mwv207_hdmi_writeb(hdmi, coeff_b >> 8, 0x410A + i * 2); + mwv207_hdmi_writeb(hdmi, coeff_c & 0xff, 0x4113 + i * 2); + mwv207_hdmi_writeb(hdmi, coeff_c >> 8, 0x4112 + i * 2); + } + + mwv207_hdmi_modb(hdmi, csc_scale, HDMI_CSC_SCALE_CSCSCALE_MASK, + 0x4101); +} + +static void mwv207_hdmi_video_csc(struct mwv207_hdmi *hdmi) +{ + int color_depth = HDMI_CSC_SCALE_CSC_COLORDE_PTH_24BPP; + + mwv207_hdmi_writeb(hdmi, 0, 0x4100); + mwv207_hdmi_modb(hdmi, color_depth, HDMI_CSC_SCALE_CSC_COLORDE_PTH_MASK, + 0x4101); + + mwv207_hdmi_update_csc_coeffs(hdmi); +} + +static void mwv207_hdmi_video_sample(struct mwv207_hdmi *hdmi) +{ + int color_format = 1; + u8 val; + + val = HDMI_TX_INVID0_INTERNAL_DE_GENERATOR_DISABLE | + ((color_format << HDMI_TX_INVID0_VIDEO_MAPPING_OFFSET) & + HDMI_TX_INVID0_VIDEO_MAPPING_MASK); + mwv207_hdmi_writeb(hdmi, val, 0x200); + + val = HDMI_TX_INSTUFFING_BDBDATA_STUFFING_ENABLE | + HDMI_TX_INSTUFFING_RCRDATA_STUFFING_ENABLE | + HDMI_TX_INSTUFFING_GYDATA_STUFFING_ENABLE; + mwv207_hdmi_writeb(hdmi, val, 0x201); + mwv207_hdmi_writeb(hdmi, 0x0, 0x202); + mwv207_hdmi_writeb(hdmi, 0x0, 0x203); + mwv207_hdmi_writeb(hdmi, 0x0, 0x204); + mwv207_hdmi_writeb(hdmi, 0x0, 0x205); + mwv207_hdmi_writeb(hdmi, 0x0, 0x206); + mwv207_hdmi_writeb(hdmi, 0x0, 0x207); +} + +static void mwv207_hdmi_tx_hdcp_config(struct mwv207_hdmi *hdmi) +{ + u8 de = HDMI_A_VIDPOLCFG_DATAENPOL_ACTIVE_HIGH; + + mwv207_hdmi_modb(hdmi, HDMI_A_HDCPCFG0_RXDETECT_DISABLE, + HDMI_A_HDCPCFG0_RXDETECT_MASK, 0x5000); + + mwv207_hdmi_modb(hdmi, de, HDMI_A_VIDPOLCFG_DATAENPOL_MASK, 0x5009); + + mwv207_hdmi_modb(hdmi, HDMI_A_HDCPCFG1_ENCRYPTIONDISABLE_DISABLE, + HDMI_A_HDCPCFG1_ENCRYPTIONDISABLE_MASK, 0x5001); +} + +static void mwv207_hdmi_set_timing(struct mwv207_hdmi *hdmi) +{ + struct drm_display_mode *mode; + + mwv207_hdmi_disable_overflow_interrupts(hdmi); + + mode = &hdmi->base.cur_crtc->state->adjusted_mode; + hdmi->vic = drm_match_cea_mode(mode); + + hdmi->rgb_limited_range = hdmi->sink_is_hdmi && + drm_default_rgb_quant_range(mode) == + HDMI_QUANTIZATION_RANGE_LIMITED; + + mwv207_hdmi_av_composer(hdmi, mode); + + mwv207_hdmi_phy_configure(hdmi, mode->clock, 8); + + mwv207_hdmi_enable_video_path(hdmi); + + if (hdmi->sink_has_audio) { + + mwv207_hdmi_enable_audio_clk(hdmi, 1); + } + + if (hdmi->sink_is_hdmi) { + struct drm_connector *conn = &hdmi->base.connector; + + mwv207_hdmi_config_AVI(hdmi, conn, mode); + mwv207_hdmi_config_vendor_specific_infoframe(hdmi, conn, mode); + mwv207_hdmi_config_drm_infoframe(hdmi, conn); + } + + mwv207_hdmi_video_packetize(hdmi); + mwv207_hdmi_video_csc(hdmi); + mwv207_hdmi_video_sample(hdmi); + mwv207_hdmi_tx_hdcp_config(hdmi); + + mwv207_hdmi_clear_overflow(hdmi); + + if (hdmi->sink_has_audio) { + mwv207_audio_enable(hdmi->base.audio, hdmi->base.idx, + hdmi->base.connector.eld, hdmi->tmdsclock/1000, + true, true); + } +} + +static int mwv207_hdmi_get_modes(struct drm_connector *connector) +{ + struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); + int count; + + count = mwv207_output_get_modes(connector); + + if (connector->edid_blob_ptr) { + struct edid *edid; + + edid = (struct edid *)connector->edid_blob_ptr->data; + hdmi->sink_is_hdmi = drm_detect_hdmi_monitor(edid); + hdmi->sink_has_audio = drm_detect_monitor_audio(edid); + } else { + hdmi->sink_is_hdmi = false; + hdmi->sink_has_audio = false; + } + + return count; +} + +static enum drm_mode_status mwv207_hdmi_mode_valid(struct mwv207_hdmi *hdmi, + const struct drm_display_mode *mode) +{ + + if (mode->clock > 594000) + return MODE_CLOCK_HIGH; + + if (!hdmi->sink_is_hdmi && mode->clock >= 165000) + return MODE_CLOCK_HIGH; + + return MODE_OK; +} + +static enum drm_mode_status mwv207_hdmi_connector_mode_valid(struct drm_connector *connector, + struct drm_display_mode *mode) +{ + struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); + + return mwv207_hdmi_mode_valid(hdmi, mode); +} + +static int mwv207_hdmi_detect_ctx(struct drm_connector *connector, + struct drm_modeset_acquire_ctx *ctx, + bool force) +{ + struct mwv207_hdmi *hdmi = connector_to_hdmi(connector); + struct mwv207_output *output = connector_to_output(connector); + u32 value; + + if (connector->force == DRM_FORCE_OFF) + return connector_status_disconnected; + + if (connector->force == DRM_FORCE_ON) + return connector_status_connected; + + if (output->forced_edid) + return connector_status_connected; + + value = mwv207_hdmi_readb(hdmi, 0x3004); + if (value & 0x2) + return connector_status_connected; + else + return connector_status_disconnected; +} + +static void mwv207_hdmi_destroy(struct drm_connector *conn) +{ + struct mwv207_hdmi *hdmi = connector_to_hdmi(conn); + + free_irq(hdmi->irq, hdmi); + drm_connector_unregister(conn); + drm_connector_cleanup(conn); +} + +static const struct drm_connector_helper_funcs mwv207_hdmi_connector_helper_funcs = { + .get_modes = mwv207_hdmi_get_modes, + .mode_valid = mwv207_hdmi_connector_mode_valid, + .detect_ctx = mwv207_hdmi_detect_ctx +}; + +static const struct drm_connector_funcs mwv207_hdmi_connector_funcs = { + .reset = drm_atomic_helper_connector_reset, + .fill_modes = drm_helper_probe_single_connector_modes, + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, + .destroy = mwv207_hdmi_destroy, + .late_register = mwv207_output_late_register, + .early_unregister = mwv207_output_early_unregister, +}; + +static enum drm_mode_status mwv207_hdmi_encoder_mode_valid(struct drm_encoder *encoder, + const struct drm_display_mode *mode) +{ + struct mwv207_hdmi *hdmi = encoder_to_hdmi(encoder); + + return mwv207_hdmi_mode_valid(hdmi, mode); +} + +static int mwv207_hdmi_encoder_atomic_check(struct drm_encoder *encoder, + struct drm_crtc_state *crtc_state, + struct drm_connector_state *conn_state) +{ + return 0; +} + +static void mwv207_hdmi_encoder_enable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_hdmi_select_crtc(output); + + mwv207_hdmi_set_timing(encoder_to_hdmi(encoder)); + + mwv207_hdmi_switch(output, true); +} + +static void mwv207_hdmi_encoder_disable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + struct mwv207_hdmi *hdmi = encoder_to_hdmi(encoder); + bool hw_connected; + u32 value; + value = mwv207_hdmi_readb(hdmi, 0x3004); + if (value & 0x2) + hw_connected = true; + else + hw_connected = false; + + if (hdmi->sink_has_audio) { + mwv207_audio_enable(hdmi->base.audio, hdmi->base.idx, + NULL, 0, false, hw_connected); + } + mwv207_hdmi_switch(output, false); +} + +static void mwv207_hdmi_encoder_reset(struct drm_encoder *encoder) +{ + mwv207_hdmi_encoder_disable(encoder); + mwv207_hdmi_ih_mutes(encoder_to_hdmi(encoder)); + mwv207_hdmi_phy_setup_hpd(encoder_to_hdmi(encoder)); +} + +static const struct drm_encoder_funcs mwv207_hdmi_encoder_funcs = { + .destroy = drm_encoder_cleanup, + .reset = mwv207_hdmi_encoder_reset, +}; + +static const struct drm_encoder_helper_funcs mwv207_hdmi_encoder_helper_funcs = { + .mode_valid = mwv207_hdmi_encoder_mode_valid, + .atomic_check = mwv207_hdmi_encoder_atomic_check, + .enable = mwv207_hdmi_encoder_enable, + .disable = mwv207_hdmi_encoder_disable, +}; + +static int mwv207_hdmi_init_single(struct mwv207_device *jdev, int idx) +{ + struct mwv207_output *output; + struct mwv207_hdmi *hdmi; + int ret; + + hdmi = mwv207_output_probe_and_init(jdev, sizeof(struct mwv207_hdmi), idx, + 0x0 + idx, + (20*2) + idx * 20); + + if (!hdmi) { + dev_info(jdev->dev, "hdmi%d is disabled by firmware", idx); + return 0; + } + + if (IS_ERR(hdmi)) + return PTR_ERR(hdmi); + + output = &hdmi->base; + hdmi->mmio = jdev->mmio + MWV207_HDMI_BASE(idx); + hdmi->mc_clkdis = 0x7f; + + ret = mwv207_hdmi_phy_data_init(hdmi, idx); + if (ret) + return ret; + + output->connector.polled = DRM_CONNECTOR_POLL_HPD; + ret = drm_connector_init(&jdev->base, &output->connector, + &mwv207_hdmi_connector_funcs, DRM_MODE_CONNECTOR_HDMIA); + if (ret) + return ret; + drm_connector_helper_add(&output->connector, &mwv207_hdmi_connector_helper_funcs); + + output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; + ret = drm_encoder_init(&jdev->base, &output->encoder, + &mwv207_hdmi_encoder_funcs, DRM_MODE_ENCODER_TMDS, + "hdmi-%d", output->idx); + if (ret) + return ret; + drm_encoder_helper_add(&output->encoder, &mwv207_hdmi_encoder_helper_funcs); + + ret = drm_connector_attach_encoder(&output->connector, &output->encoder); + if (ret) + return ret; + + INIT_DELAYED_WORK(&hdmi->hotplug_work, mwv207_hdmi_hotplug_work_func); + + hdmi->irq = irq_find_mapping(jdev->irq_domain, output->idx + 0x20); + BUG_ON(hdmi->irq == 0); + + ret = request_threaded_irq(hdmi->irq, + mwv207_hdmi_hard_irq, mwv207_hdmi_irq, + IRQF_SHARED, output->encoder.name, hdmi); + if (ret) + return ret; + ret = request_irq(hdmi->irq, + mwv207_hdmi_audio_irq_handler, + IRQF_SHARED, "hdmi_audio", output); + if (ret) + return ret; + + ret = drm_connector_register(&output->connector); + if (ret) + free_irq(hdmi->irq, hdmi); + + return ret; +} + +int mwv207_hdmi_init(struct mwv207_device *jdev) +{ + int i, ret; + + for (i = 0; i < 0x4; i++) { + + if (jdev_read(jdev, MWV207_HDMI_BASE(i)) != 0x21) + continue; + ret = mwv207_hdmi_init_single(jdev, i); + if (ret) + return ret; + } + + return 0; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_hdmi_audio.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_hdmi_audio.c new file mode 100644 index 0000000000000000000000000000000000000000..bf50046393a9c7452f1fca5d08e91cdeb66d649a --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_hdmi_audio.c @@ -0,0 +1,1212 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ + +#include +#include +#include "mwv207_drv.h" +#include "mwv207_vi.h" +#include "dw-hdmi.h" +#include "mwv207_vbios.h" + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define DRIVER_NAME "mwv207" + +static int hdmi_card_index = SNDRV_DEFAULT_IDX1; +static char *hdmi_card_id = SNDRV_DEFAULT_STR1; +static const struct snd_pcm_hardware had_pcm_hardware; + +struct channel_config { + u8 conf1; + u8 ca; +}; + +static struct channel_config default_hdmi_channel_config[7] = { + { 0x03, 0x00 }, + { 0x0b, 0x02 }, + { 0x33, 0x08 }, + { 0x37, 0x09 }, + { 0x3f, 0x0b }, + { 0x7f, 0x0f }, + { 0xff, 0x13 }, +}; + +static const struct snd_pcm_hardware had_pcm_hardware = { + .info = (SNDRV_PCM_INFO_INTERLEAVED | + SNDRV_PCM_INFO_BLOCK_TRANSFER | + SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID), + .formats = SNDRV_PCM_FMTBIT_S24_LE, + .rates = (SNDRV_PCM_RATE_32000 | + SNDRV_PCM_RATE_44100 | + SNDRV_PCM_RATE_48000 | + SNDRV_PCM_RATE_88200 | + SNDRV_PCM_RATE_96000 | + SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_192000), + .channels_min = 0x2, + .channels_max = 0x8, + .rate_min = 0x7D00, + .rate_max = 0x2EE00, + .buffer_bytes_max = (1024*1024), + .period_bytes_min = 0x100, + .period_bytes_max = 0x2000, + .periods_min = 0x2, + .periods_max = 0x10, + .fifo_size = 0x0, +}; + +enum video_if_reg { + VIDEO_IF_CTRL = 0x00, + VIDEO_IF_TMDS_CTRL = 0x04, + VIDEO_IF_DMA_HADDR_L = 0x08, + VIDEO_IF_DMA_HADDR_H = 0x0C +}; + +struct pcm_stream_info { + struct snd_pcm_substream *substream; + int substream_refcount; +}; + +struct port_cfg { + const char *eld; + int clock; + bool enabled; + bool hw_connected; +}; + +struct mwv207_audio_port { + struct mwv207_audio_card *jcard; + bool is_dp; + bool running; + bool enabled; + bool has_jack; + struct pcm_stream_info stream_info; + + u8 eld[0x80]; + int id; + int pipe; + + struct device *dev; + + int clock; + + spinlock_t lock; + struct mutex mutex; + + u32 buf_offset; + u32 buf_period; + u32 buf_size; + u32 channels; + dma_addr_t dma_addr; + + struct snd_pcm *pcm; + struct snd_jack *jack; + + struct hrtimer fake_dma; + ktime_t period_time; + int use_fake_dma; + + struct delayed_work jack_work; + struct port_cfg cfg; + bool active; +}; + +struct mwv207_audio_card { + struct snd_card *card; + struct device *dev; + + phys_addr_t phys_base; + phys_addr_t phys_len; + void __iomem *mmio_base; + + int port_nr; + struct mwv207_audio_port port[0x3]; +}; + +struct mwv207_audio { + struct mwv207_audio_card *jcard; +}; + +static inline u32 had_reg_remap(struct mwv207_audio_card *jcard, u32 reg) +{ + if (unlikely(jcard->phys_len < 0x1200000)) { + BUG_ON(reg < 0x1200000 + || reg >= 0x1200000 + 0x200000); + reg -= 0x1200000; + reg += 0xA00000; + } + return reg; +} + +static inline u32 +had_read_hdmi_tx_reg_raw(struct mwv207_audio_port *port, u32 offset) +{ + return ioread32(port->jcard->mmio_base + + had_reg_remap(port->jcard, + HDMI_TX_REG(port->id, offset))); +} + +static inline u32 had_read_video_if_reg(struct mwv207_audio_port *port, u32 offset) +{ + if (port->is_dp) + return 0; + return ioread32(port->jcard->mmio_base + + VIDEO_IF_REG(port->id, offset)); +} + +static inline void +had_write_hdmi_tx_reg_raw(struct mwv207_audio_port *port, u32 offset, u32 value) +{ + iowrite32(value, port->jcard->mmio_base + + had_reg_remap(port->jcard, HDMI_TX_REG(port->id, offset))); +} + +static inline u32 had_read_hdmi_tx_reg(struct mwv207_audio_port *port, u32 offset) +{ + if (!port->enabled) + return 0; + return had_read_hdmi_tx_reg_raw(port, offset); +} + +static inline void +had_write_video_if_reg(struct mwv207_audio_port *port, u32 offset, u32 value) +{ + if (port->is_dp) + return; + iowrite32(value, port->jcard->mmio_base + + VIDEO_IF_REG(port->id, offset)); +} + +static inline void +had_write_hdmi_tx_reg(struct mwv207_audio_port *port, u32 offset, u32 value) +{ + if (port->enabled) + had_write_hdmi_tx_reg_raw(port, offset, value); +} + +static void had_init_dma_haddr(struct mwv207_audio_port *port) +{ + u32 axi_l, axi_h; + u64 axi_offset; + if (port->is_dp) + return; + + axi_offset = 0x800000000UL; + + axi_l = (u32) axi_offset; + axi_h = (u32) (axi_offset >> 32); + + had_write_video_if_reg(port, VIDEO_IF_DMA_HADDR_L, axi_l); + had_write_video_if_reg(port, VIDEO_IF_DMA_HADDR_H, axi_h); +} + +static void had_stop_dma(struct mwv207_audio_port *port) +{ + + had_write_hdmi_tx_reg_raw(port, 0x3614, ~0U); + + had_write_hdmi_tx_reg_raw(port, 0x3602, + HDMI_AHB_DMA_STOP_STOP_MASK); +} + +static void had_init_dma_interrupt(struct mwv207_audio_port *port) +{ + had_write_hdmi_tx_reg(port, 0x3602, + HDMI_AHB_DMA_STOP_STOP_MASK); + + had_init_dma_haddr(port); + + had_write_hdmi_tx_reg(port, 0x109, + HDMI_IH_AHBDMAAUD_STAT0_MASK); + + had_write_hdmi_tx_reg(port, 0x189, + HDMI_IH_MUTE_AHBDMAAUD_STAT0_MASK & + ~HDMI_IH_MUTE_AHBDMAAUD_STAT0_DONE); +} + +static void set_auds_sample(struct mwv207_audio_port *port, u32 samp_freq) +{ + u32 val; + + had_write_hdmi_tx_reg(port, 0x1065, 0x00); + had_write_hdmi_tx_reg(port, 0x1066, 0x00); + had_write_hdmi_tx_reg(port, 0x1067, 0x00); + had_write_hdmi_tx_reg(port, 0x1068, 0x00); + had_write_hdmi_tx_reg(port, 0x1069, 0x02); + had_write_hdmi_tx_reg(port, 0x106A, 0x02); + had_write_hdmi_tx_reg(port, 0x106B, 0x00); + had_write_hdmi_tx_reg(port, 0x106C, 0x01); + had_write_hdmi_tx_reg(port, 0x106D, 0x00); + + val = (samp_freq == 0xBB80) ? 0xc2 : 0xc0; + had_write_hdmi_tx_reg(port, HDMI_FC_AUDSCHNLS7, val); + + val = (samp_freq == 0xBB80) ? 0xd5 : 0xf5; + had_write_hdmi_tx_reg(port, HDMI_FC_AUDSCHNLS8, val); +} + +static void had_set_cts_n(struct mwv207_audio_port *port, u32 cts, u32 n) +{ + u32 value; + + value = had_read_hdmi_tx_reg(port, 0x3205); + value &= (u32) (~HDMI_AUD_CTS3_CTS_MANUAL); + had_write_hdmi_tx_reg(port, 0x3205, value); + + value = had_read_hdmi_tx_reg(port, 0x3205); + value &= (u32) (~HDMI_AUD_CTS3_N_SHIFT_MASK); + had_write_hdmi_tx_reg(port, 0x3205, value); + had_write_hdmi_tx_reg(port, 0x3202, ((n >> 16) & 0xff) | 0x80); + + had_write_hdmi_tx_reg(port, 0x3205, ((cts >> 16) + & + HDMI_AUD_CTS3_AUDCTS19_16_MASK) + | HDMI_AUD_CTS3_CTS_MANUAL); + had_write_hdmi_tx_reg(port, 0x3204, (cts >> 8) & 0xff); + had_write_hdmi_tx_reg(port, 0x3203, cts & 0xff); + + had_write_hdmi_tx_reg(port, 0x3202, ((n >> 16) & 0xff) | 0x80); + had_write_hdmi_tx_reg(port, 0x3201, (n >> 8) & 0xff); + had_write_hdmi_tx_reg(port, 0x3200, n & 0xff); +} + +static int had_calculate_maud_value(u32 aud_samp_freq, u32 link_rate) +{ + u32 maud_val; + + if (link_rate == 0x41EB0) { + switch (aud_samp_freq) { + case 0x7D00: + maud_val = 0x7C4; + break; + case 0xAC44: + maud_val = 0xAB4; + break; + case 0xBB80: + maud_val = 0xBA6; + break; + case 0x15888: + maud_val = 0x1568; + break; + case 0x17700: + maud_val = 0x174D; + break; + case 0x2B110: + maud_val = 0x2AD1; + break; + case 0x2EE00: + maud_val = 0x2E9A; + break; + default: + maud_val = -EINVAL; + break; + } + } else if (link_rate == 0x278D0) { + switch (aud_samp_freq) { + case 0x7D00: + maud_val = 0xCF2; + break; + case 0xAC44: + maud_val = 0x11D7; + break; + case 0xBB80: + maud_val = 0x136B; + break; + case 0x15888: + maud_val = 0x23AE; + break; + case 0x17700: + maud_val = 0x26D6; + break; + case 0x2B110: + maud_val = 0x475C; + break; + case 0x2EE00: + maud_val = 0x4DAC; + break; + default: + maud_val = -EINVAL; + break; + } + } else + maud_val = -EINVAL; + + return maud_val; +} + +static void had_program_cts(struct mwv207_audio_port *port, u32 samp_freq, + u32 clock, u32 n_param) +{ + u32 cts_val; + u64 dividend, divisor; + u32 config3 = 0; + + if (port->is_dp) { + + cts_val = had_calculate_maud_value(samp_freq, clock); + } else { + dividend = (u64) clock * n_param * 1000; + divisor = 128 * samp_freq; + cts_val = div64_u64(dividend, divisor); + } + + config3 = had_read_hdmi_tx_reg(port, 0x7); + + if (!(config3 & HDMI_CONFIG3_AHBAUDDMA)) + cts_val = 0; + + had_set_cts_n(port, cts_val, n_param); +} + +static int had_calculate_n_value(u32 samp_freq) +{ + int n_val; + + switch (samp_freq) { + case 0x7D00: + n_val = 4096; + break; + case 0xAC44: + n_val = 6272; + break; + case 0xBB80: + n_val = 6144; + break; + case 0x15888: + n_val = 12544; + break; + case 0x17700: + n_val = 12288; + break; + case 0x2B110: + n_val = 25088; + break; + case 0x2EE00: + n_val = 24576; + break; + default: + n_val = -EINVAL; + break; + } + return n_val; +} + +static int had_program_n(struct mwv207_audio_port *port, + u32 samp_freq, u32 *n_param) +{ + int n_val; + + if (port->is_dp) { + n_val = 0x8000; + } else { + n_val = had_calculate_n_value(samp_freq); + } + + if (n_val < 0) + return n_val; + + *n_param = n_val; + return 0; +} + +static int had_setup_sample_rate(struct mwv207_audio_port *port, u32 samp_freq) +{ + int error; + u32 n_param; + + error = had_program_n(port, samp_freq, &n_param); + if (error) { + pr_err("faild to programe N value %d\n", error); + return error; + } + + had_program_cts(port, samp_freq, port->clock, n_param); + + return error; +} + +static void had_init_audio_dip(struct mwv207_audio_port *port, + struct snd_pcm_substream *substream) +{ + int channels; + struct snd_pcm_runtime *runtime; + u8 ca, threshold, conf0, conf1, layout; + u32 value = 0; + + runtime = substream->runtime; + + threshold = 0x40; + runtime->hw.fifo_size = threshold * 32; + + conf0 = HDMI_AHB_DMA_CONF0_SW_FIFO_RST_MASK | + HDMI_AHB_DMA_CONF0_INSERT_PCUV | + HDMI_AHB_DMA_CONF0_INCR8 | HDMI_AHB_DMA_CONF0_BURST_MODE; + + channels = substream->runtime->channels; + if (channels <= 2) { + ca = 0x00; + layout = HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_LAYOUT0; + conf1 = 0x03; + } else { + ca = default_hdmi_channel_config[runtime->channels - 2].ca; + layout = HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_LAYOUT1; + conf1 = + default_hdmi_channel_config[runtime->channels - 2].conf1; + } + + had_write_hdmi_tx_reg(port, 0x3603, threshold); + had_write_hdmi_tx_reg(port, 0x3600, conf0); + had_write_hdmi_tx_reg(port, 0x3616, conf1); + + value = had_read_hdmi_tx_reg(port, 0x1063); + value &= (u32) (~HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_MASK); + value |= (layout & HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_MASK); + had_write_hdmi_tx_reg(port, 0x1063, value); + + value = had_read_hdmi_tx_reg(port, 0x1025); + value &= (u32) (~HDMI_FC_AUDICONF0_CC_MASK); + value |= (((channels - 1) << HDMI_FC_AUDICONF0_CC_OFFSET) & + HDMI_FC_AUDICONF0_CC_MASK); + had_write_hdmi_tx_reg(port, 0x1025, value); + + had_write_hdmi_tx_reg(port, 0x1027, ca); +} + +static int had_prepare_port(struct mwv207_audio_port *port, + struct snd_pcm_substream *substream) +{ + int error; + + if (port->use_fake_dma) + return 0; + +#if IS_ENABLED(CONFIG_SND_PCM_ELD) + error = snd_pcm_hw_constraint_eld(substream->runtime, port->eld); + if (error) { + pr_err("failed to setup pcm eld\n"); + goto out; + } +#endif + + had_init_audio_dip(port, substream); + + error = had_setup_sample_rate(port, substream->runtime->rate); + if (error) { + pr_err("failed to set pcm clk regenerator\n"); + goto out; + } + + set_auds_sample(port, substream->runtime->rate); + + had_init_dma_interrupt(port); +out: + return error; +} + +static void had_init_port_data_config(struct mwv207_audio_port *port, + struct snd_pcm_substream *substream) +{ + unsigned int period, rate; + long sec; + unsigned long nsecs; + + port->dma_addr = substream->runtime->dma_addr; + port->channels = substream->runtime->channels; + port->buf_size = snd_pcm_lib_buffer_bytes(substream); + port->buf_period = snd_pcm_lib_period_bytes(substream); + + if (!port->use_fake_dma) + return; + + period = substream->runtime->period_size; + rate = substream->runtime->rate; + sec = period / rate; + period %= rate; + nsecs = div_u64((u64) period * 1000000000UL + rate - 1, rate); + + port->period_time = ktime_set(sec, nsecs); + +} + +static int had_pcm_open(struct snd_pcm_substream *substream) +{ + int error; + unsigned long flags; + struct mwv207_audio_port *port; + struct snd_pcm_runtime *runtime; + port = snd_pcm_substream_chip(substream); + + runtime = substream->runtime; + runtime->hw = had_pcm_hardware; + + error = snd_pcm_limit_hw_rates(runtime); + if (error < 0) + return error; + + error = snd_pcm_hw_constraint_integer(runtime, + SNDRV_PCM_HW_PARAM_PERIODS); + if (error < 0) + return error; + + error = snd_pcm_hw_constraint_minmax(runtime, + SNDRV_PCM_HW_PARAM_BUFFER_SIZE, + 0, substream->dma_buffer.bytes); + if (error < 0) + return error; + + spin_lock_irqsave(&port->lock, flags); + port->stream_info.substream = substream; + port->stream_info.substream_refcount++; + spin_unlock_irqrestore(&port->lock, flags); + + return error; +} + +static void had_uninit_dma_interrupt(struct mwv207_audio_port *port) +{ + + had_write_hdmi_tx_reg(port, 0x189, + HDMI_IH_MUTE_AHBDMAAUD_STAT0_MASK); + + had_write_hdmi_tx_reg(port, 0x3614, HDMI_AHB_DMA_MASK_MASK); + + had_write_hdmi_tx_reg(port, 0x109, + HDMI_IH_AHBDMAAUD_STAT0_MASK); +} + +static int had_pcm_close(struct snd_pcm_substream *substream) +{ + unsigned long flags; + struct mwv207_audio_port *port; + port = snd_pcm_substream_chip(substream); + + spin_lock_irqsave(&port->lock, flags); + port->stream_info.substream_refcount--; + while (port->stream_info.substream_refcount > 0) { + spin_unlock_irqrestore(&port->lock, flags); + cpu_relax(); + spin_lock_irqsave(&port->lock, flags); + } + port->stream_info.substream = NULL; + spin_unlock_irqrestore(&port->lock, flags); + + had_uninit_dma_interrupt(port); + + hrtimer_cancel(&port->fake_dma); + + return 0; +} + +static int had_pcm_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params) +{ + return snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params)); +} + +static int had_pcm_hw_free(struct snd_pcm_substream *substream) +{ + return snd_pcm_lib_free_pages(substream); +} + +static int had_pcm_prepare(struct snd_pcm_substream *substream) +{ + struct mwv207_audio_port *port; + unsigned long flags; + int error; + port = snd_pcm_substream_chip(substream); + + spin_lock_irqsave(&port->lock, flags); + port->use_fake_dma = !port->enabled; + spin_unlock_irqrestore(&port->lock, flags); + + if (port->use_fake_dma) { + hrtimer_start(&port->fake_dma, ms_to_ktime(4), + HRTIMER_MODE_REL); + } else { + hrtimer_cancel(&port->fake_dma); + } + + switch (substream->runtime->format) { + case SNDRV_PCM_FORMAT_S24: + break; + default: + pr_err("unsupported pcm foramt %d on audio port %d\n", + substream->runtime->format, port->id); + return -EINVAL; + } + + had_init_port_data_config(port, substream); + error = had_prepare_port(port, substream); + if (error) + pr_err("failed to prepare audio port %d\n", port->id); + + return error; +} + +static void had_setup_dma_addr(struct mwv207_audio_port *port, u32 start, u32 stop) +{ + had_write_hdmi_tx_reg(port, 0x3604, + (start & 0xff)); + had_write_hdmi_tx_reg(port, 0x3605, + ((start >> 8) & 0xff)); + had_write_hdmi_tx_reg(port, 0x3606, + ((start >> 16) & 0xff)); + had_write_hdmi_tx_reg(port, 0x3607, + ((start >> 24) & 0xff)); + + had_write_hdmi_tx_reg(port, 0x3608, (stop & 0xff)); + had_write_hdmi_tx_reg(port, 0x3609, + ((stop >> 8) & 0xff)); + had_write_hdmi_tx_reg(port, 0x360A, + ((stop >> 16) & 0xff)); + had_write_hdmi_tx_reg(port, 0x360B, + ((stop >> 24) & 0xff)); +} + +static void had_setup_dma_buf_addr(struct mwv207_audio_port *port) +{ + u32 start, stop; + u32 period, offset; + + offset = port->buf_offset; + period = port->buf_period; + + start = port->dma_addr + offset; + stop = start + period - 1; + + had_setup_dma_addr(port, start, stop); + + offset += period; + if (offset >= port->buf_size) + offset = 0; + port->buf_offset = offset; +} + +static void had_start_dma_xfer(struct mwv207_audio_port *port) +{ + + had_write_hdmi_tx_reg(port, 0x3614, + (u32) (~HDMI_AHB_DMA_DONE)); + + had_write_hdmi_tx_reg(port, 0x3601, + HDMI_AHB_DMA_START_START_MASK); +} + +static void had_start_dma(struct mwv207_audio_port *port) +{ + had_setup_dma_buf_addr(port); + had_start_dma_xfer(port); +} + +static int had_pcm_trigger(struct snd_pcm_substream *substream, int cmd) +{ + int error = 0; + unsigned long flags; + struct mwv207_audio_port *port; + port = snd_pcm_substream_chip(substream); + + spin_lock_irqsave(&port->lock, flags); + switch (cmd) { + case SNDRV_PCM_TRIGGER_START: + port->buf_offset = 0; + port->running = true; + if (!port->use_fake_dma) + had_start_dma(port); + + substream->runtime->delay = substream->runtime->period_size; + break; + + case SNDRV_PCM_TRIGGER_SUSPEND: + case SNDRV_PCM_TRIGGER_STOP: + port->running = false; + if (!port->use_fake_dma) + had_stop_dma(port); + + break; + default: + error = -EINVAL; + break; + } + spin_unlock_irqrestore(&port->lock, flags); + + return error; +} + +static snd_pcm_uframes_t had_pcm_pointer(struct snd_pcm_substream *substream) +{ + struct mwv207_audio_port *port; + + port = substream->private_data; + + return bytes_to_frames(substream->runtime, port->buf_offset); +} + +static const struct snd_pcm_ops had_pcm_ops = { + .open = had_pcm_open, + .close = had_pcm_close, + .ioctl = snd_pcm_lib_ioctl, + .hw_params = had_pcm_hw_params, + .hw_free = had_pcm_hw_free, + .prepare = had_pcm_prepare, + .trigger = had_pcm_trigger, + .pointer = had_pcm_pointer, +}; + +static int mwv207_create_jack(struct mwv207_audio_port *port, struct snd_pcm *pcm) +{ + char hdmi_str[32]; + int err; + + snprintf(hdmi_str, sizeof(hdmi_str), "HDMI/DP,pcm=%d", pcm->device); + + err = snd_jack_new(port->jcard->card, hdmi_str, + SND_JACK_AVOUT, &port->jack, true, false); + if (err < 0) + return err; + + if (port->jack == NULL) + pr_info("sound jack is not supported."); + + return 0; +} + +static inline bool hdmi_is_enabled(struct mwv207_audio_port *port) +{ + u32 state; + u32 enabled = 1 << 0; + + state = had_read_video_if_reg(port, VIDEO_IF_CTRL); + + return !!(state & enabled); +} + +static void had_jack_switch(struct mwv207_audio_port *port, bool need_jack) +{ + if (need_jack && !port->has_jack) + snd_jack_report(port->jack, SND_JACK_AVOUT); + if (!need_jack && port->has_jack) + snd_jack_report(port->jack, 0); + port->has_jack = need_jack; +} + +static void had_jack_work(struct work_struct *work) +{ + struct mwv207_audio_port *port = container_of(to_delayed_work(work), + struct mwv207_audio_port, + jack_work); + + mutex_lock(&port->mutex); + if (port->enabled) { + BUG_ON(!port->cfg.hw_connected); + had_jack_switch(port, true); + } else { + bool new_state = port->cfg.hw_connected ? + hdmi_is_enabled(port) : false; + had_jack_switch(port, new_state); + } + mutex_unlock(&port->mutex); +} + +static void had_substream_put(struct mwv207_audio_port *port) +{ + unsigned long flags; + + spin_lock_irqsave(&port->lock, flags); + port->stream_info.substream_refcount--; + spin_unlock_irqrestore(&port->lock, flags); +} + +static struct snd_pcm_substream *had_substream_get(struct mwv207_audio_port *port) +{ + struct snd_pcm_substream *substream; + unsigned long flags; + + spin_lock_irqsave(&port->lock, flags); + substream = port->stream_info.substream; + if (substream) + port->stream_info.substream_refcount++; + spin_unlock_irqrestore(&port->lock, flags); + + return substream; +} + +static enum hrtimer_restart had_port_fake_dma_worker(struct hrtimer *timer) +{ + struct mwv207_audio_port *port = + container_of(timer, struct mwv207_audio_port, fake_dma); + struct snd_pcm_substream *substream; + unsigned long flags; + int elapse = 0; + + spin_lock_irqsave(&port->lock, flags); + if (port->running) { + u32 offset; + + offset = port->buf_offset + port->buf_period; + if (offset >= port->buf_size) + offset = 0; + port->buf_offset = offset; + elapse = 1; + } + spin_unlock_irqrestore(&port->lock, flags); + + substream = had_substream_get(port); + if (substream) { + if (elapse) + snd_pcm_period_elapsed(substream); + had_substream_put(port); + } + + hrtimer_forward_now(timer, port->period_time); + return HRTIMER_RESTART; +} + +static void had_port_init(struct mwv207_audio_card *jcard) +{ + int port_id; + struct mwv207_audio_port *port; + + jcard->port_nr = 0x3; + + for_each_port(jcard, port_id) { + port = &jcard->port[port_id]; + port->jcard = jcard; + port->dev = jcard->dev; + port->id = port_id; + port->running = false; + port->enabled = false; + port->has_jack = false; + port->is_dp = port_id > 3 ? true : false; + port->stream_info.substream_refcount = 0; + + spin_lock_init(&port->lock); + mutex_init(&port->mutex); + + hrtimer_init(&port->fake_dma, CLOCK_MONOTONIC, + HRTIMER_MODE_REL); + port->fake_dma.function = had_port_fake_dma_worker; + + port->cfg.eld = NULL; + port->cfg.clock = 0; + port->cfg.enabled = false; + port->cfg.hw_connected = false; + INIT_DELAYED_WORK(&port->jack_work, had_jack_work); + + port->active = false; + } +} + +static void had_private_free(struct snd_card *card) +{ + int port_id; + struct mwv207_audio_card *jcard; + + jcard = card->private_data; + + for_each_port(jcard, port_id) { + struct mwv207_audio_port *port = &jcard->port[port_id]; + + if (port->fake_dma.function) + hrtimer_cancel(&port->fake_dma); + + cancel_delayed_work_sync(&port->jack_work); + } +} + +static struct pci_dev *had_get_pci_dev(struct device *dev) +{ + struct pci_dev *pdev; + + pdev = to_pci_dev(dev); + if (!pdev) { + pr_err("failed to get jmgpu pci device\n"); + return ERR_PTR(-ENODEV); + } + + return pdev; +} + +int mwv207_audio_init(struct mwv207_device *jdev) +{ + int error, port_id; + struct snd_card *card; + struct snd_pcm *pcm; + struct pci_dev *pdev; + struct mwv207_audio *jaudio; + struct mwv207_audio_card *jcard; + struct mwv207_audio_port *port; + pdev = had_get_pci_dev(jdev->dev); + if (IS_ERR(pdev)) { + pr_err("failed to create mwv207 audio\n"); + return 1; + } + + jaudio = devm_kzalloc(&pdev->dev, sizeof(struct mwv207_audio), GFP_KERNEL); + if (!jaudio) { + pr_err("failed to allocate mem for jmgpu audio\n"); + return 1; + } + + error = snd_card_new(&pdev->dev, hdmi_card_index, + hdmi_card_id, THIS_MODULE, + sizeof(struct mwv207_audio_card), &card); + if (error) { + pr_err("failed to create snd card, error = %d\n", error); + return 1; + } + + strcpy(card->driver, DRIVER_NAME); + strcpy(card->shortname, DRIVER_NAME); + strcpy(card->longname, "Jingjia Micro HDMI/eDP Audio"); + card->private_free = had_private_free; + + jcard = card->private_data; + jcard->card = card; + jcard->dev = &pdev->dev; + jcard->phys_base = pci_resource_start(pdev, 0x1); + jcard->phys_len = pci_resource_len(pdev, 0x1); + + jcard->mmio_base = devm_ioremap(jcard->dev, jcard->phys_base, + jcard->phys_len); + if (!jcard->mmio_base) { + pr_err("failed to map io at range %#llx to %#llx\n", + jcard->phys_base, jcard->phys_len); + goto err_out; + } + + had_port_init(jcard); + + for_each_port(jcard, port_id) { + port = &jcard->port[port_id]; + error = snd_pcm_new(card, DRIVER_NAME, port_id, + 0x1, 0x0, &pcm); + if (error) { + pr_err("snd_pcm_new returned error %d\n", error); + goto err_out; + } + + pcm->private_data = port; + pcm->info_flags = 0; + port->pcm = pcm; + snprintf(pcm->name, sizeof(pcm->name), "%s %d", + card->shortname, port_id); + + snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &had_pcm_ops); + + snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV, + &pdev->dev, 128 * 1024, + 1024 * 1024); + + if (mwv207_create_jack(port, pcm)) + goto err_out; + } + + jaudio->jcard = jcard; + + error = snd_card_register(card); + if (error) { + pr_err("failed to call snd_card_register %d\n", error); + goto err_out; + } + + dev_info(jcard->dev, "jmgpu audio create done\n"); + + jdev->audio = jaudio; + + return 0; + +err_out: + snd_card_free(card); + return 1; +} + +void mwv207_audio_destroy(struct mwv207_audio *jaudio) +{ + if (!jaudio) + return; + + snd_card_free(jaudio->jcard->card); +} + +static void had_disable_port(struct mwv207_audio_port *port) +{ + struct snd_pcm_substream *substream; + unsigned int delayed_time; + unsigned long flags; + + spin_lock_irqsave(&port->lock, flags); + if (!port->enabled) { + spin_unlock_irqrestore(&port->lock, flags); + return; + } + had_stop_dma(port); + port->enabled = false; + spin_unlock_irqrestore(&port->lock, flags); + + substream = had_substream_get(port); + if (substream) { + snd_pcm_stop_xrun(substream); + had_substream_put(port); + } + delayed_time = port->cfg.hw_connected ? 3000 : 0; + schedule_delayed_work(&port->jack_work, msecs_to_jiffies(delayed_time)); +} + +static void had_enable_port(struct mwv207_audio_port *port) +{ + struct snd_pcm_substream *substream; + unsigned long flags; + + spin_lock_irqsave(&port->lock, flags); + if (!port->active || port->enabled) { + spin_unlock_irqrestore(&port->lock, flags); + return; + } + port->enabled = true; + spin_unlock_irqrestore(&port->lock, flags); + + substream = had_substream_get(port); + if (substream) { + snd_pcm_stop_xrun(substream); + had_substream_put(port); + } + + schedule_delayed_work(&port->jack_work, msecs_to_jiffies(50)); +} + +static void had_process_port_switch(struct mwv207_audio_port *port) +{ + struct port_cfg *cfg = &port->cfg; + if (port->is_dp) + return; + + port->active = cfg->enabled; + + if (cfg->enabled) { + if (!cfg->eld) + return; + port->clock = cfg->clock; + memcpy(port->eld, cfg->eld, sizeof(port->eld)); + had_enable_port(port); + } else { + port->clock = 0; + memset(port->eld, 0, sizeof(port->eld)); + had_disable_port(port); + } +} + +void mwv207_audio_enable(struct mwv207_audio *jaudio, u32 port_idx, + const char *eld, int clock, + bool enabled, bool hw_connected) +{ + struct mwv207_audio_port *port; + + port = &jaudio->jcard->port[port_idx]; + + mutex_lock(&port->mutex); + + port->cfg.eld = eld; + port->cfg.clock = clock; + port->cfg.enabled = enabled; + port->cfg.hw_connected = hw_connected; + + had_process_port_switch(port); + + pr_info("audio enable"); + + mutex_unlock(&port->mutex); +} + +irqreturn_t mwv207_hdmi_audio_irq_handler(int irq, void *dev_id) +{ + u32 stat; + struct mwv207_audio_port *port; + struct mwv207_output *output; + struct snd_pcm_substream *substream; + + if (!dev_id) + return IRQ_NONE; + + output = dev_id; + port = &output->audio->jcard->port[output->idx]; + + stat = had_read_hdmi_tx_reg_raw(port, 0x109); + if (!stat) + return IRQ_NONE; + + had_write_hdmi_tx_reg_raw(port, 0x109, stat); + + substream = had_substream_get(port); + if (!substream) + return IRQ_NONE; + + if (stat & HDMI_IH_AHBDMAAUD_STAT0_DONE) { + if (snd_pcm_playback_empty(substream)) + snd_pcm_stop_xrun(substream); + + spin_lock(&port->lock); + if (port->enabled && port->running) + had_start_dma(port); + spin_unlock(&port->lock); + + snd_pcm_period_elapsed(substream); + } + + had_substream_put(port); + return IRQ_HANDLED; +} + +int mwv207_audio_suspend(struct mwv207_device *jdev) +{ + struct mwv207_audio *jaudio = jdev->audio; + struct mwv207_audio_card *jcard = jaudio->jcard; + int port_id; + + snd_power_change_state(jcard->card, SNDRV_CTL_POWER_D3cold); + for_each_port(jcard, port_id) { + struct mwv207_audio_port *port = &jcard->port[port_id]; + + hrtimer_cancel(&port->fake_dma); + snd_pcm_suspend_all(port->pcm); + cancel_delayed_work_sync(&port->jack_work); + had_disable_port(port); + } + + return 0; +} + +int mwv207_audio_resume(struct mwv207_device *jdev) +{ + struct mwv207_audio *jaudio = jdev->audio; + struct mwv207_audio_card *jcard = jaudio->jcard; + int port_id; + + snd_power_change_state(jcard->card, SNDRV_CTL_POWER_D0); + + for_each_port(jcard, port_id) { + struct mwv207_audio_port *port = &jcard->port[port_id]; + had_enable_port(port); + } + + return 0; +} \ No newline at end of file diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_i2c.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_i2c.c new file mode 100644 index 0000000000000000000000000000000000000000..bfd01904698337e7eae1e17f9f78337d0d1a87f1 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_i2c.c @@ -0,0 +1,315 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include "mwv207_drv.h" +#include "mwv207_vi.h" + +#define MWV207_GPIO_MULTIPLEX_BASE 0x9b0910 +#define MWV207_GPIO_MULTIPLEX32_39 (MWV207_GPIO_MULTIPLEX_BASE + 0x10) + +static int i2c_scl_gpio[8] = {19, 21, 23, 25, 27, 29, 31, 33}; +static int i2c_sda_gpio[8] = {20, 22, 24, 26, 28, 30, 32, 34}; + +struct mwv207_i2c { + struct i2c_adapter adapter; + struct mwv207_device *jdev; + struct i2c_algo_bit_data bit; + struct mutex *mutex; + u32 sda_in_addr; + u32 sda_out_addr; + u32 sda_mask; + u32 sda_dir; + u32 scl_in_addr; + u32 scl_out_addr; + u32 scl_mask; + u32 scl_dir; +}; + +static inline void mwv207_i2c_set_dir(struct mwv207_i2c *i2c, u32 mask, + u32 reg, bool is_input) +{ + + mb(); + + jdev_modify(i2c->jdev, reg, mask, is_input ? mask : 0); + + mb(); +} + +static void mwv207_i2c_gpio_multi(struct mwv207_i2c *i2c, int mask) +{ + struct mwv207_device *jdev = i2c->jdev; + + switch (mask) { + case (1 << 19): + + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0x8), 0x3 << 12, 0); + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0x8), 0x3 << 16, 0); + break; + case (1 << 21): + + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0x8), 0x3 << 20, 0); + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0x8), 0x3 << 24, 0); + break; + case (1 << 23): + + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0x8), 0x3 << 28, 0); + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0xc), 0x3, 0); + break; + case (1 << 25): + + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0xc), 0x3 << 4, 0); + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0xc), 0x3 << 8, 0); + break; + case (1 << 27): + + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0xc), 0x3 << 12, 0); + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0xc), 0x3 << 16, 0); + break; + case (1 << 29): + + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0xc), 0x3 << 20, 0); + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0xc), 0x3 << 24, 0); + break; + case (1 << 31): + + jdev_modify(jdev, (MWV207_GPIO_MULTIPLEX_BASE+0xc), 0x3 << 28, 0); + jdev_modify(jdev, MWV207_GPIO_MULTIPLEX32_39, 0x3, 0); + break; + case (1 << 1): + + jdev_modify(jdev, MWV207_GPIO_MULTIPLEX32_39, 0x3 << 4, 0); + jdev_modify(jdev, MWV207_GPIO_MULTIPLEX32_39, 0x3 << 8, 0); + break; + default: + break; + } +} + +static int mwv207_i2c_pre_xfer(struct i2c_adapter *i2c_adap) +{ + struct mwv207_i2c *i2c = i2c_get_adapdata(i2c_adap); + struct mwv207_device *jdev = i2c->jdev; + + mutex_lock(i2c->mutex); + mwv207_i2c_gpio_multi(i2c, i2c->scl_mask); + + jdev_modify(jdev, i2c->scl_out_addr, i2c->scl_mask, 0); + jdev_modify(jdev, i2c->sda_out_addr, i2c->sda_mask, 0); + + mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 1); + mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); + + return 0; +} + +static void mwv207_i2c_post_xfer(struct i2c_adapter *i2c_adap) +{ + struct mwv207_i2c *i2c = i2c_get_adapdata(i2c_adap); + + mutex_unlock(i2c->mutex); +} + +static int mwv207_i2c_get_clock(void *i2c_priv) +{ + struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; + struct mwv207_device *jdev = i2c->jdev; + u32 val; + + mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 1); + + val = jdev_read(jdev, i2c->scl_in_addr); + val &= i2c->scl_mask; + + return val ? 1 : 0; +} + +static int mwv207_i2c_get_data(void *i2c_priv) +{ + struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; + struct mwv207_device *jdev = i2c->jdev; + u32 val; + + mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); + + val = jdev_read(jdev, i2c->sda_in_addr); + val &= i2c->sda_mask; + + return val ? 1 : 0; +} + +static void mwv207_i2c_set_clock(void *i2c_priv, int clock) +{ + struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; + struct mwv207_device *jdev = i2c->jdev; + + mwv207_i2c_set_dir(i2c, i2c->scl_mask, i2c->scl_dir, 0); + jdev_modify(jdev, i2c->scl_out_addr, i2c->scl_mask, clock ? i2c->scl_mask : 0); +} + +static void mwv207_i2c_set_data(void *i2c_priv, int data) +{ + struct mwv207_i2c *i2c = (struct mwv207_i2c *)i2c_priv; + + if (data) + mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 1); + else + mwv207_i2c_set_dir(i2c, i2c->sda_mask, i2c->sda_dir, 0); +} + +static int mwv207_i2c_set_addr(struct mwv207_i2c *i2c, int channel) +{ + switch (channel) { + case 0: + case 1: + case 2: + case 3: + case 4: + case 5: + i2c->sda_in_addr = 0x9AA000; + i2c->scl_in_addr = 0x9AA000; + i2c->sda_out_addr = 0x9AA004; + i2c->scl_out_addr = 0x9AA004; + i2c->scl_mask = (1 << i2c_scl_gpio[channel]); + i2c->sda_mask = (1 << i2c_sda_gpio[channel]); + i2c->scl_dir = 0x9AA008; + i2c->sda_dir = 0x9AA008; + break; + case 6: + i2c->sda_in_addr = 0x9AA000; + i2c->scl_in_addr = 0x9AA010; + i2c->sda_out_addr = 0x9AA004; + i2c->scl_out_addr = 0x9AA014; + i2c->scl_mask = (1 << i2c_scl_gpio[channel]); + i2c->sda_mask = (1 << (i2c_sda_gpio[channel] - 32)); + i2c->scl_dir = 0x9AA008; + i2c->sda_dir = 0x9AA018; + break; + case 7: + i2c->sda_in_addr = 0x9AA010; + i2c->scl_in_addr = 0x9AA010; + i2c->sda_out_addr = 0x9AA014; + i2c->scl_out_addr = 0x9AA014; + i2c->scl_mask = (1 << (i2c_scl_gpio[channel] - 32)); + i2c->sda_mask = (1 << (i2c_sda_gpio[channel] - 32)); + i2c->scl_dir = 0x9AA018; + i2c->sda_dir = 0x9AA018; + break; + } + + return 0; +} + +void mwv207_i2c_put_byte(struct i2c_adapter *i2c, + u8 slave_addr, + u8 addr, + u8 val) +{ + uint8_t out_buf[2]; + struct i2c_msg msg = { + .addr = slave_addr, + .flags = 0, + .len = 2, + .buf = out_buf, + }; + + out_buf[0] = addr; + out_buf[1] = val; + + if (i2c_transfer(i2c, &msg, 1) != 1) + pr_warn("i2c 0x%02x 0x%02x write failed\n", + addr, val); +} + +void mwv207_i2c_destroy(struct i2c_adapter *adapter) +{ + i2c_del_adapter(adapter); +} + +struct i2c_adapter *mwv207_i2c_create(struct mwv207_device *jdev, int i2c_chan) +{ + struct mwv207_i2c *i2c; + int ret; + + if (i2c_chan < 0 || i2c_chan >= 6) + return NULL; + + i2c = devm_kzalloc(jdev->dev, sizeof(*i2c), GFP_KERNEL); + if (!i2c) + return NULL; + + if (mwv207_i2c_set_addr(i2c, i2c_chan)) + return NULL; + + i2c->adapter.owner = THIS_MODULE; + i2c->adapter.class = I2C_CLASS_DDC; + i2c->adapter.dev.parent = jdev->dev; + i2c_set_adapdata(&i2c->adapter, i2c); + i2c->mutex = &jdev->gpio_lock; + i2c->jdev = jdev; + + snprintf(i2c->adapter.name, sizeof(i2c->adapter.name), + "MWV207_I2C_%d", i2c_chan); + i2c->adapter.algo_data = &i2c->bit; + i2c->bit.pre_xfer = mwv207_i2c_pre_xfer; + i2c->bit.post_xfer = mwv207_i2c_post_xfer; + i2c->bit.setsda = mwv207_i2c_set_data; + i2c->bit.setscl = mwv207_i2c_set_clock; + i2c->bit.getsda = mwv207_i2c_get_data; + i2c->bit.getscl = mwv207_i2c_get_clock; + i2c->bit.udelay = 10; + i2c->bit.timeout = usecs_to_jiffies(2200); + i2c->bit.data = i2c; + + ret = i2c_bit_add_bus(&i2c->adapter); + if (ret) + return NULL; + + return &i2c->adapter; +} + +bool mwv207_i2c_probe(struct i2c_adapter *i2c_bus) +{ + u8 out = 0x0; + u8 buf[8]; + int ret; + struct i2c_msg msgs[] = { + { + .addr = DDC_ADDR, + .flags = 0, + .len = 1, + .buf = &out, + }, + { + .addr = DDC_ADDR, + .flags = I2C_M_RD, + .len = 8, + .buf = buf, + } + }; + + ret = i2c_transfer(i2c_bus, msgs, 2); + if (ret != 2) { + + return false; + } + + if (drm_edid_header_is_valid(buf) < 6) { + return false; + } + return true; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_kms.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_kms.c new file mode 100644 index 0000000000000000000000000000000000000000..411d7898250de9e05b419446f950d54a5bec1d68 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_kms.c @@ -0,0 +1,207 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "mwv207_gem.h" +#include "mwv207_kms.h" +#include "mwv207_va.h" +#include "mwv207_vi.h" + +static const struct drm_framebuffer_funcs fb_funcs = { + .destroy = drm_gem_fb_destroy, + .create_handle = drm_gem_fb_create_handle, +}; + +int mwv207_framebuffer_init(struct mwv207_device *jdev, struct drm_framebuffer *fb, + const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object *gobj) +{ + int ret; + + fb->obj[0] = gobj; + drm_helper_mode_fill_fb_struct(&jdev->base, fb, mode_cmd); + + ret = drm_framebuffer_init(&jdev->base, fb, &fb_funcs); + return ret; +} + +static struct drm_framebuffer *mwv207_framebuffer_create( + struct drm_device *dev, + struct drm_file *filp, + const struct drm_mode_fb_cmd2 *mode_cmd) +{ + struct drm_gem_object *gobj = drm_gem_object_lookup(filp, mode_cmd->handles[0]); + struct drm_framebuffer *fb; + int err = -ENOENT; + + if (!gobj) { + DRM_DEBUG_DRIVER("fbdev failed to lookup gem object, handle = %d\n", + mode_cmd->handles[0]); + return ERR_PTR(-ENOENT); + } + + fb = kzalloc(sizeof(*fb), GFP_KERNEL); + if (!fb) { + err = -ENOMEM; + goto err_unref; + } + + err = mwv207_framebuffer_init(dev->dev_private, fb, mode_cmd, gobj); + if (err) + goto err_free; + + return fb; +err_free: + kfree(fb); +err_unref: + drm_gem_object_put(gobj); + return ERR_PTR(err); +} + +static void mwv207_atomic_prepare_vblank(struct drm_device *dev, + struct drm_atomic_state *old_state) +{ + struct drm_crtc_state *new_crtc_state; + struct drm_crtc *crtc; + int i; + + for_each_new_crtc_in_state(old_state, crtc, new_crtc_state, i) + mwv207_crtc_prepare_vblank(crtc); +} + +static void mwv207_atomic_commit_tail(struct drm_atomic_state *old_state) +{ + struct drm_device *dev = old_state->dev; + + drm_atomic_helper_commit_modeset_disables(dev, old_state); + drm_atomic_helper_commit_planes(dev, old_state, 0); + drm_atomic_helper_commit_modeset_enables(dev, old_state); + + mwv207_atomic_prepare_vblank(dev, old_state); + + drm_atomic_helper_commit_hw_done(old_state); + + drm_atomic_helper_wait_for_vblanks(dev, old_state); + drm_atomic_helper_cleanup_planes(dev, old_state); +} + +static struct drm_mode_config_helper_funcs mwv207_mode_config_helper_funcs = { + .atomic_commit_tail = mwv207_atomic_commit_tail, +}; + +static const struct drm_mode_config_funcs mwv207_mode_config_funcs = { + .fb_create = mwv207_framebuffer_create, + .atomic_check = drm_atomic_helper_check, + .atomic_commit = drm_atomic_helper_commit, + .output_poll_changed = drm_fb_helper_output_poll_changed, +}; + +static void mwv207_modeset_init(struct drm_device *dev) +{ + drm_mode_config_init(dev); + + dev->mode_config.min_width = 20; + dev->mode_config.min_height = 20; + + dev->mode_config.max_width = 4096 * 4; + dev->mode_config.max_height = 4096 * 4; + + dev->mode_config.preferred_depth = 24; + dev->mode_config.prefer_shadow = 1; + dev->mode_config.fb_modifiers_not_supported = false; + + dev->mode_config.async_page_flip = true; + + dev->mode_config.funcs = &mwv207_mode_config_funcs; + dev->mode_config.helper_private = &mwv207_mode_config_helper_funcs; + + dev->mode_config.cursor_width = 64; + dev->mode_config.cursor_height = 64; +} + +int mwv207_kms_suspend(struct mwv207_device *jdev) +{ + return drm_mode_config_helper_suspend(&jdev->base); +} + +int mwv207_kms_resume(struct mwv207_device *jdev) +{ + int ret; + + ret = drm_mode_config_helper_resume(&jdev->base); + if (ret) + pr_warn("mwv207: failed to resume kms, ret: %d", ret); + + return ret; +} + +int mwv207_kms_init(struct mwv207_device *jdev) +{ + int ret; + + mwv207_modeset_init(&jdev->base); + + ret = mwv207_va_init(jdev); + if (ret) + goto cleanup; + + ret = mwv207_vi_init(jdev); + if (ret) + goto cleanup; + + jdev->va_irq = irq_find_mapping(jdev->irq_domain, 42); + BUG_ON(jdev->va_irq == 0); + ret = request_irq(jdev->va_irq, mwv207_va_handle_vblank, 0, "mwv207_va", jdev); + if (ret) + goto cleanup; +#if defined(__aarch64__) + jdev->base.irq_enabled = true; +#endif + + ret = drm_vblank_init(&jdev->base, jdev->base.mode_config.num_crtc); + if (ret) + goto free_irq; + + drm_mode_config_reset(&jdev->base); + + drm_kms_helper_poll_init(&jdev->base); + + DRM_INFO("number of crtc: %d\n", jdev->base.mode_config.num_crtc); + DRM_INFO("number of encoder: %d\n", jdev->base.mode_config.num_encoder); + DRM_INFO("number of connector: %d\n", jdev->base.mode_config.num_connector); + + return 0; +free_irq: + free_irq(jdev->va_irq, jdev); +cleanup: + drm_mode_config_cleanup(&jdev->base); + return ret; +} + +void mwv207_kms_fini(struct mwv207_device *jdev) +{ + drm_kms_helper_poll_fini(&jdev->base); + drm_atomic_helper_shutdown(&jdev->base); + free_irq(jdev->va_irq, jdev); + drm_mode_config_cleanup(&jdev->base); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_kms.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_kms.h new file mode 100644 index 0000000000000000000000000000000000000000..1fdd104101e6e6f2e7608fe9509dc3b755477fdb --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_kms.h @@ -0,0 +1,33 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_KMS_H_VBCHTKVP +#define MWV207_KMS_H_VBCHTKVP + +#include +#include "mwv207_drv.h" + +int mwv207_framebuffer_init(struct mwv207_device *jdev, struct drm_framebuffer *fb, + const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object *gobj); + +int mwv207_kms_init(struct mwv207_device *jdev); +void mwv207_kms_fini(struct mwv207_device *jdev); + +int mwv207_fbdev_init(struct mwv207_device *jdev); +void mwv207_fbdev_fini(struct mwv207_device *jdev); + +int mwv207_kms_suspend(struct mwv207_device *jdev); +int mwv207_kms_resume(struct mwv207_device *jdev); +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_va.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_va.c new file mode 100644 index 0000000000000000000000000000000000000000..185c190414888e5f3c4db03f932997d541cc9fe4 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_va.c @@ -0,0 +1,696 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "mwv207_bo.h" +#include "mwv207_va.h" +#include "mwv207_vi.h" +#include "mwv207_vbios.h" + +#define MWV207_WIN_BASE(idx) (0x990000 + 0x100 * (idx) + ((idx) > 1 ? 0xC00 : 0)) + +#define MWV207_VA_BASE(idx) (0x990000 + 0x100 * (idx) + ((idx) > 1 ? 0x600 : 0)) + +#define crtc_to_va(crtc) container_of(crtc, struct mwv207_va, crtc) +#define plane_to_va(plane) (((plane)->type == DRM_PLANE_TYPE_PRIMARY) \ + ? container_of(plane, struct mwv207_va, primary) \ + : container_of(plane, struct mwv207_va, cursor)) +struct mwv207_va { + struct drm_crtc crtc; + struct drm_plane primary; + struct drm_plane cursor; + void __iomem *mmio; + struct mwv207_device *jdev; + struct drm_pending_vblank_event *event; + int idx; + uint16_t lutdata[768]; +}; + +static u32 rgb_formats[] = { + DRM_FORMAT_RGB565, + DRM_FORMAT_RGB888, + DRM_FORMAT_XRGB8888, + DRM_FORMAT_ARGB8888, + DRM_FORMAT_XRGB2101010, +}; + +static uint64_t format_modifiers[] = { + DRM_FORMAT_MOD_LINEAR, + DRM_FORMAT_MOD_INVALID +}; + +static u32 cursor_formats[] = { + DRM_FORMAT_ARGB8888, +}; + +static inline u32 mwv207_va_read(struct mwv207_va *va, u32 reg) +{ + return readl(va->mmio + reg); +} + +static inline void mwv207_va_write(struct mwv207_va *va, u32 reg, u32 value) +{ + writel_relaxed(value, va->mmio + reg); +} + +static inline void mwv207_va_modify(struct mwv207_va *va, u32 reg, + u32 mask, u32 value) +{ + u32 rvalue = mwv207_va_read(va, reg); + + rvalue = (rvalue & ~mask) | (value & mask); + mwv207_va_write(va, reg, rvalue); +} + +static bool mwv207_plane_format_mod_supported(struct drm_plane *plane, + uint32_t format, uint64_t modifier) +{ + if (modifier == DRM_FORMAT_MOD_LINEAR) + return true; + return false; +} + +static int mwv207_plane_atomic_check(struct drm_plane *plane, + struct drm_atomic_state *state) +{ + + return 0; +} + +static int mwv207_plane_prepare_fb(struct drm_plane *plane, + struct drm_plane_state *new_state) +{ + struct mwv207_bo *jbo; + int ret; + + if (!new_state->fb) + return 0; + + jbo = mwv207_bo_from_gem(new_state->fb->obj[0]); + + ret = mwv207_bo_reserve(jbo, false); + if (ret) + return ret; + + jbo->flags |= 0x1; + ret = mwv207_bo_pin_reserved(jbo, 0x2); + mwv207_bo_unreserve(jbo); + if (ret) + return ret; + + mwv207_bo_ref(jbo); + + ret = drm_gem_plane_helper_prepare_fb(plane, new_state); + if (ret) + goto unpin; + + return 0; +unpin: + BUG_ON(mwv207_bo_reserve(jbo, false)); + mwv207_bo_unpin(jbo); + mwv207_bo_unreserve(jbo); + mwv207_bo_unref(jbo); + return ret; +} + +static void mwv207_plane_cleanup_fb(struct drm_plane *plane, + struct drm_plane_state *old_state) +{ + struct mwv207_bo *jbo; + + if (!old_state->fb) + return; + + jbo = mwv207_bo_from_gem(old_state->fb->obj[0]); + if (!jbo) + return; + + mwv207_bo_unpin(jbo); + mwv207_bo_unref(jbo); +} + +static u64 mwv207_plane_fb_addr(struct drm_plane *plane) +{ + struct drm_framebuffer *fb; + struct mwv207_bo *bo; + u32 src_x, src_y; + u64 fbaddr; + + src_x = plane->state->src_x >> 16; + src_y = plane->state->src_y >> 16; + + fb = plane->state->fb; + bo = mwv207_bo_from_gem(fb->obj[0]); + fbaddr = mwv207_bo_gpu_phys(bo); + fbaddr += src_x * fb->format->cpp[0] + fb->pitches[0] * src_y; + + return fbaddr; +} + +static void mwv207_primary_atomic_update(struct drm_plane *plane, + struct drm_atomic_state *state) +{ + struct mwv207_va *va = plane_to_va(plane); + struct drm_framebuffer *fb; + u32 src_w, src_h; + u64 fbaddr; + + if (!plane->state->fb || !plane->state->crtc) + return; + + src_w = plane->state->src_w >> 16; + src_h = plane->state->src_h >> 16; + fbaddr = mwv207_plane_fb_addr(plane); + fb = plane->state->fb; + + mwv207_va_write(va, 0x434, fb->pitches[0] >> 4); + + mwv207_va_write(va, 0x43C, ((src_h - 1) << 16) | (src_w - 1) | 0x3); + + mwv207_va_write(va, 0x4F8, (src_w - 1) << 16); + + mwv207_va_write(va, 0x438, fbaddr >> 6); + + switch (fb->format->format) { + case DRM_FORMAT_RGB565: + mwv207_va_modify(va, 0x430, 1, 1); + break; + case DRM_FORMAT_XRGB2101010: + case DRM_FORMAT_ARGB2101010: + mwv207_va_modify(va, 0x430, 1 << 1, 1 << 1); + break; + case DRM_FORMAT_ARGB8888: + mwv207_va_modify(va, 0x430, 0x3, 0); + break; + default: + break; + } +} + +static void mwv207_primary_atomic_disable(struct drm_plane *plane, + struct drm_atomic_state *state) +{ + +} + +static void mwv207_cursor_switch(struct mwv207_va *va, bool on) +{ + mwv207_va_modify(va, 0x478, 0xff, on ? 6 : 0); +} + +static void mwv207_cursor_atomic_update(struct drm_plane *plane, + struct drm_atomic_state *state) +{ + int crtc_x, crtc_y, pos_x, pos_y, hot_x, hot_y; + struct mwv207_va *va = plane_to_va(plane); + u64 fbaddr; + + if (!plane->state->fb || !plane->state->crtc) + return; + + crtc_x = plane->state->crtc_x; + crtc_y = plane->state->crtc_y; + fbaddr = mwv207_plane_fb_addr(plane); + + mwv207_va_write(va, 0x4B4, fbaddr >> 6); + + pos_x = crtc_x < 0 ? 0 : crtc_x; + hot_x = crtc_x < 0 ? -crtc_x : 0; + pos_y = crtc_y < 0 ? 0 : crtc_y; + hot_y = crtc_y < 0 ? -crtc_y : 0; + mwv207_va_write(va, 0x454, (hot_x & 0x3f) | ((hot_y & 0x3f) << 16)); + mwv207_va_write(va, 0x4A8, (pos_x & 0xffff) | ((pos_y & 0xffff) << 16)); + + mwv207_cursor_switch(va, 1); +} + +static void mwv207_cursor_atomic_disable(struct drm_plane *plane, + struct drm_atomic_state *state) +{ + struct mwv207_va *va = plane_to_va(plane); + + mwv207_cursor_switch(va, 0); +} + +static const struct drm_plane_funcs mwv207_plane_funcs = { + .reset = drm_atomic_helper_plane_reset, + .update_plane = drm_atomic_helper_update_plane, + .disable_plane = drm_atomic_helper_disable_plane, + .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_plane_destroy_state, + .format_mod_supported = mwv207_plane_format_mod_supported, + .destroy = drm_plane_cleanup, +}; + +static const struct drm_plane_helper_funcs mwv207_primary_helper_funcs = { + .prepare_fb = mwv207_plane_prepare_fb, + .cleanup_fb = mwv207_plane_cleanup_fb, + .atomic_check = mwv207_plane_atomic_check, + .atomic_update = mwv207_primary_atomic_update, + .atomic_disable = mwv207_primary_atomic_disable, +}; + +static const struct drm_plane_helper_funcs mwv207_cursor_helper_funcs = { + .prepare_fb = mwv207_plane_prepare_fb, + .cleanup_fb = mwv207_plane_cleanup_fb, + .atomic_check = mwv207_plane_atomic_check, + .atomic_update = mwv207_cursor_atomic_update, + .atomic_disable = mwv207_cursor_atomic_disable, +}; + +static void mwv207_va_misc_reset(struct mwv207_va *va) +{ + struct mwv207_device *jdev = va->jdev; + + jdev_write(jdev, 0x9B001C, 0xfffff); + jdev_write(jdev, 0x9B0020, 0xfffff); + jdev_write(jdev, 0x9B0024, 0xfffff); + + jdev_write(jdev, 0x9B0028, 0x03020100); + + jdev_write(jdev, MWV207_WIN_BASE(va->idx) + 0x2C, 0); +} + +static int mwv207_va_lut_fifo_wait(struct mwv207_va *va, u32 used) +{ + int i; + + mb(); + for (i = 0; i < 120; ++i) { + if (mwv207_va_read(va, 0x450) <= used) + return 0; + usleep_range(1000, 1001); + } + + return -EBUSY; +} + +static void mwv207_va_lut_fifo_activate(struct mwv207_va *va, int rgb) +{ + + mb(); + mwv207_va_write(va, 0x44C, rgb); + mwv207_va_write(va, 0x448, 1); + udelay(2); + mwv207_va_write(va, 0x448, 0); + udelay(2); +} + +static int mwv207_va_lut_fifo_input(struct mwv207_va *va, u32 value) +{ + int ret; + + ret = mwv207_va_lut_fifo_wait(va, 10); + if (ret) + return ret; + + mb(); + mwv207_va_write(va, 0x444, value); + + return 0; +} + +static void mwv207_va_lut_enable(struct mwv207_va *va) +{ + u32 active_ram, value; + int i, ram, rgb; + u16 *data; + + mwv207_va_modify(va, 0x460, 1 << 31, 0 << 31); + value = (va->lutdata[384] * 15 / 8) | 0x80000000; + jdev_write(va->jdev, MWV207_WIN_BASE(va->idx) + 0x38, value); + + for (ram = 0; ram < 2; ram++) { + active_ram = mwv207_va_read(va, 0x440); + for (rgb = 0; rgb < 3; rgb++) { + data = &va->lutdata[rgb * 256]; + mwv207_va_lut_fifo_activate(va, rgb); + for (i = 0; i < 0x400; i++) { + + value = min_t(u32, 1024 - 5, (data[i / 4] << 2) | 0x03); + if (mwv207_va_lut_fifo_input(va, value)) + pr_warn("mwv207: failed to write lut"); + } + + if (mwv207_va_lut_fifo_wait(va, 0)) + pr_warn("mwv207: failed to configure lut"); + } + + mb(); + mwv207_va_write(va, 0x440, 1 - active_ram); + } +} + +static void mwv207_mode_fixup(struct drm_display_mode *adjusted_mode, struct drm_display_mode *mode) +{ + memcpy(adjusted_mode, mode, sizeof(*adjusted_mode)); + + mode->crtc_hdisplay = adjusted_mode->crtc_hdisplay * 2; + mode->crtc_hblank_start = adjusted_mode->crtc_hblank_start * 2; + mode->crtc_hblank_end = adjusted_mode->crtc_hblank_end * 2; + mode->crtc_hsync_start = adjusted_mode->crtc_hsync_start * 2; + mode->crtc_hsync_end = adjusted_mode->crtc_hsync_end * 2; + mode->crtc_htotal = adjusted_mode->crtc_htotal * 2; + mode->crtc_clock = adjusted_mode->crtc_clock * 2; +} + +static void mwv207_va_config_timing(struct mwv207_va *va) +{ + struct drm_display_mode *m = &va->crtc.state->adjusted_mode; + struct drm_display_mode *native = NULL; + u32 hsbegin, hsend, hblankbegin, hblankend, htotal, hhalf; + u32 vblank_1field_begin, vblank_1field_end; + u32 vblank_2field_begin, vblank_2field_end; + u32 vs_1field_begin, vs_1field_end; + u32 vs_2field_begin, vs_2field_end; + u32 is_interleaved; + u32 vfrontporch, vsync, vtotal; + int ret, value; + + ret = mwv207_vbios_set_pll(va->jdev, va->idx + MWV207_PLL_GRAPH0, m->crtc_clock); + if (ret) { + DRM_ERROR("mwv207: failed to set crtc clock: %d", ret); + return; + } + + is_interleaved = DRM_MODE_FLAG_INTERLACE & m->flags ? 1 : 0; + if (is_interleaved && m->crtc_hdisplay == 720) { + native = kmalloc(sizeof(*m), GFP_KERNEL); + if (!native) { + DRM_ERROR("mwv207: failed to kmalloc native mode\r\n"); + return; + } + mwv207_mode_fixup(m, native); + m = native; + } + + hblankbegin = 0; + hblankend = m->crtc_htotal - m->crtc_hdisplay; + htotal = m->crtc_htotal; + hsbegin = m->crtc_hsync_start - m->crtc_hdisplay; + hsend = m->crtc_hsync_end - m->crtc_hdisplay; + hhalf = is_interleaved ? (htotal / 2 + hsbegin) : htotal / 2; + + vblank_1field_begin = 0; + vblank_1field_end = is_interleaved ? + ((m->crtc_vtotal - m->crtc_vdisplay) * 2) + : (m->crtc_vtotal - m->crtc_vdisplay); + + vblank_2field_begin = + (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2; + vblank_2field_end = + (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + + (m->crtc_vtotal - m->crtc_vdisplay + 1) * 2; + + vtotal = m->crtc_vtotal; + vfrontporch = m->crtc_vsync_start - m->crtc_vdisplay; + vsync = m->crtc_vsync_end - m->crtc_vsync_start; + vs_1field_begin = is_interleaved ? (vfrontporch * 2) : (vfrontporch); + vs_1field_end = is_interleaved ? ((vfrontporch + vsync) * 2) + : (vfrontporch + vsync); + vs_2field_begin = + (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + + vfrontporch * 2 + 1; + vs_2field_end = + (m->crtc_vdisplay + (m->crtc_vtotal - m->crtc_vdisplay)) * 2 + + (vfrontporch + vsync) * 2 + 1; + + mwv207_va_write(va, 0x400, hsbegin | (hsend << 16)); + mwv207_va_write(va, 0x404, hblankbegin | (hblankend << 16)); + mwv207_va_write(va, 0x408, htotal | (hhalf << 16)); + + mwv207_va_write(va, 0x40C, vblank_1field_begin | (vblank_1field_end << 16)); + mwv207_va_write(va, 0x458, vblank_1field_begin | (vblank_1field_end << 16)); + mwv207_va_write(va, 0x410, vblank_2field_begin | (vblank_2field_end << 16)); + mwv207_va_write(va, 0x45C, vblank_2field_begin | (vblank_2field_end << 16)); + + mwv207_va_write(va, 0x418, vs_1field_begin | (vs_1field_end << 16)); + mwv207_va_write(va, 0x41C, vs_2field_begin | (vs_2field_end << 16)); + + mwv207_va_modify(va, 0x414, 0xffff, vtotal); + + value = is_interleaved; + if (is_interleaved && m->crtc_hdisplay == 1440) + value |= 0x2; + mwv207_va_write(va, 0x464, value); + + mwv207_va_write(va, 0x420, 1); + + value = mwv207_va_read(va, 0x2A0); + value &= ~0x6; + value |= 1; + mwv207_va_write(va, 0x2A0, value); + + kfree(native); +} + +static int mwv207_crtc_enable_vblank(struct drm_crtc *crtc) +{ + struct mwv207_va *va = crtc_to_va(crtc); + + jdev_modify(va->jdev, 0x9907F0, + 1 << (12 + va->idx), 1 << (12 + va->idx)); + jdev_modify(va->jdev, 0x9907F8, + 1 << (12 + va->idx), 1 << (12 + va->idx)); + return 0; +} + +static void mwv207_crtc_disable_vblank(struct drm_crtc *crtc) +{ + struct mwv207_va *va = crtc_to_va(crtc); + + jdev_modify(va->jdev, 0x9907F0, + 1 << (12 + va->idx), 0 << (12 + va->idx)); + jdev_modify(va->jdev, 0x9907F8, + 1 << (12 + va->idx), 0 << (12 + va->idx)); +} + +static int mwv207_crtc_atomic_check(struct drm_crtc *crtc, + struct drm_atomic_state *state) +{ + struct drm_crtc_state *crtc_state = drm_atomic_get_new_crtc_state(state, crtc); + if (crtc_state->gamma_lut && drm_color_lut_size(crtc_state->gamma_lut) != 256) + return -EINVAL; + return 0; +} + +static void mwv207_crtc_atomic_enable(struct drm_crtc *crtc, + struct drm_atomic_state *state) +{ + struct mwv207_va *va = crtc_to_va(crtc); + struct drm_encoder *encoder; + + drm_for_each_encoder_mask(encoder, crtc->dev, crtc->state->encoder_mask) + mwv207_output_set_crtc(encoder, crtc); + + mwv207_va_config_timing(va); + drm_crtc_vblank_on(crtc); +} + +static void mwv207_crtc_atomic_disable(struct drm_crtc *crtc, + struct drm_atomic_state *state) +{ + struct mwv207_va *va = crtc_to_va(crtc); + + drm_crtc_vblank_off(crtc); + + mwv207_va_write(va, 0x2C4, 0); + mwv207_va_write(va, 0x2C0, 0); + mwv207_va_write(va, 0x2A0, 2); + mwv207_va_write(va, 0x2C4, 1); + +} + +static void mwv207_crtc_atomic_flush(struct drm_crtc *crtc, + struct drm_atomic_state *state) +{ + struct mwv207_va *va = crtc_to_va(crtc); + struct drm_color_lut *lut; + int i; + + if (crtc->state->color_mgmt_changed) { + if (crtc->state->gamma_lut) { + lut = (struct drm_color_lut *)crtc->state->gamma_lut->data; + for (i = 0; i < 256; i++) { + va->lutdata[i] = drm_color_lut_extract(lut[i].red, 8); + va->lutdata[i + 256] = drm_color_lut_extract(lut[i].green, 8); + va->lutdata[i + 512] = drm_color_lut_extract(lut[i].blue, 8); + } + mwv207_va_lut_enable(va); + } + } +} + +static void mwv207_va_reset(struct drm_crtc *crtc) +{ + struct mwv207_va *va = crtc_to_va(crtc); + + mwv207_cursor_switch(va, 0); + + mwv207_va_lut_enable(va); + mwv207_va_misc_reset(va); + drm_atomic_helper_crtc_reset(crtc); +} + +static const struct drm_crtc_funcs mwv207_crtc_funcs = { + .reset = mwv207_va_reset, + .destroy = drm_crtc_cleanup, + .set_config = drm_atomic_helper_set_config, + .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state, + .page_flip = drm_atomic_helper_page_flip, + .enable_vblank = mwv207_crtc_enable_vblank, + .disable_vblank = mwv207_crtc_disable_vblank, +}; + +static const struct drm_crtc_helper_funcs mwv207_crtc_helper_funcs = { + .atomic_check = mwv207_crtc_atomic_check, + .atomic_flush = mwv207_crtc_atomic_flush, + .atomic_enable = mwv207_crtc_atomic_enable, + .atomic_disable = mwv207_crtc_atomic_disable, +}; + +void mwv207_crtc_prepare_vblank(struct drm_crtc *crtc) +{ + struct drm_pending_vblank_event *event = crtc->state->event; + struct mwv207_va *va = crtc_to_va(crtc); + unsigned long flags; + + if (event) { + if (crtc->state->active) { + WARN_ON(drm_crtc_vblank_get(crtc) != 0); + spin_lock_irqsave(&crtc->dev->event_lock, flags); + va->event = event; + spin_unlock_irqrestore(&crtc->dev->event_lock, flags); + } else { + spin_lock_irqsave(&crtc->dev->event_lock, flags); + drm_crtc_send_vblank_event(crtc, crtc->state->event); + spin_unlock_irqrestore(&crtc->dev->event_lock, flags); + } + crtc->state->event = NULL; + } +} + +void mwv207_crtc_finish_vblank(struct drm_crtc *crtc) +{ + struct mwv207_va *va = crtc_to_va(crtc); + int put_vblank = false; + unsigned long flags; + + spin_lock_irqsave(&crtc->dev->event_lock, flags); + if (va->event) { + drm_crtc_send_vblank_event(crtc, va->event); + va->event = NULL; + put_vblank = true; + } + spin_unlock_irqrestore(&crtc->dev->event_lock, flags); + + if (put_vblank) + drm_crtc_vblank_put(crtc); +} + +irqreturn_t mwv207_va_handle_vblank(int irq, void *data) +{ + struct mwv207_device *jdev = data; + struct drm_crtc *crtc; + u32 fired; + + fired = jdev_read(jdev, 0x9907F4); + if (!fired) + return IRQ_NONE; + jdev_write(jdev, 0x9907F4, fired); + + fired = (fired >> 12) & 0xf; + drm_for_each_crtc(crtc, &jdev->base) { + if (fired & (1 << drm_crtc_index(crtc))) { + drm_crtc_handle_vblank(crtc); + mwv207_crtc_finish_vblank(crtc); + } + } + + return IRQ_HANDLED; +} + +static int mwv207_va_init_single(struct mwv207_device *jdev, int idx) +{ + struct mwv207_va *va; + uint16_t *lut; + int ret, i; + + va = devm_kzalloc(jdev->dev, sizeof(*va), GFP_KERNEL); + if (!va) + return -ENOMEM; + + va->mmio = jdev->mmio + MWV207_VA_BASE(idx); + va->jdev = jdev; + va->idx = idx; + + ret = drm_universal_plane_init(&jdev->base, &va->primary, 1 << idx, + &mwv207_plane_funcs, + rgb_formats, ARRAY_SIZE(rgb_formats), + format_modifiers, DRM_PLANE_TYPE_PRIMARY, "primary_plane_%d", idx); + if (ret) + return ret; + ret = drm_universal_plane_init(&jdev->base, &va->cursor, 1 << idx, + &mwv207_plane_funcs, + cursor_formats, ARRAY_SIZE(cursor_formats), + format_modifiers, DRM_PLANE_TYPE_CURSOR, "cursor_%d", idx); + if (ret) + return ret; + + drm_plane_helper_add(&va->primary, &mwv207_primary_helper_funcs); + drm_plane_helper_add(&va->cursor, &mwv207_cursor_helper_funcs); + + ret = drm_crtc_init_with_planes(&jdev->base, &va->crtc, + &va->primary, &va->cursor, &mwv207_crtc_funcs, "crtc_%d", + idx); + if (ret) + return ret; + + drm_crtc_helper_add(&va->crtc, &mwv207_crtc_helper_funcs); + + lut = &va->lutdata[0]; + for (i = 0; i < 256; i++) + lut[i] = lut[i + 256] = lut[i + 512] = i; + drm_crtc_enable_color_mgmt(&va->crtc, 768, true, 768); + ret = drm_mode_crtc_set_gamma_size(&va->crtc, 256); + + BUG_ON(drm_crtc_index(&va->crtc) != va->idx); + + return ret; +} + +int mwv207_va_init(struct mwv207_device *jdev) +{ + int i, nr, ret; + + nr = jdev->lite ? 2 : 4; + for (i = 0; i < nr; i++) { + ret = mwv207_va_init_single(jdev, i); + if (ret) + return ret; + } + + return 0; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_va.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_va.h new file mode 100644 index 0000000000000000000000000000000000000000..98924bb316aaff0362a0fa39847ee6e481615f86 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_va.h @@ -0,0 +1,26 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#ifndef MWV207_VA_H_BSY8LF4F +#define MWV207_VA_H_BSY8LF4F + +struct drm_crtc; + +int mwv207_va_init(struct mwv207_device *jdev); + +void mwv207_crtc_prepare_vblank(struct drm_crtc *crtc); +irqreturn_t mwv207_va_handle_vblank(int irq, void *data); +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_vga.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_vga.c new file mode 100644 index 0000000000000000000000000000000000000000..3532c23ee7c0d77eda583cc2f9a31ef5bd5e72d4 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_vga.c @@ -0,0 +1,299 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_vi.h" + +#define MWV207_DAC_HPD_VS_CLC(_chan) (0x64 + (_chan) * 0x14) +#define MWV207_DAC_HPD_PULSE_H(_chan) (0x68 + (_chan) * 0x14) +#define MWV207_DAC_HPD_PULSE_L(_chan) (0x6C + (_chan) * 0x14) +#define MWV207_DAC_HPD_DET_PER(_chan) (0x70 + (_chan) * 0x14) +#define MWV207_DAC_HPD_DET_THR(_chan) (0x74 + (_chan) * 0x14) + +#define output_to_vga(output) container_of(output, struct mwv207_vga, base) + +static uint mwv207_vga_load_detect; +module_param(mwv207_vga_load_detect, uint, 0444); +MODULE_PARM_DESC(mwv207_vga_load_detect, "Enable vga load detect if set to 1, default is 1"); + +struct mwv207_vga { + struct mwv207_output base; + spinlock_t load_detect_lock; + bool active; +}; + +static void mwv207_vga_set_detect_mode(struct mwv207_output *output, bool active) +{ + u32 val, status, load_mode; + int i; + + mwv207_output_write(output, 0xA4, 0); + + val = 0x3ff * 7 / 10; + status = mwv207_output_read(output, 0xA8); + mwv207_output_write(output, 0xA8, status); + + status = val << 20 | val << 10 | val; + mwv207_output_write(output, 0xAC, status); + + load_mode = active ? 1 : 0; + status = load_mode << 20 | load_mode << 16 | load_mode << 12 | 0x1 << 8 | 0x1 << 4 | 0x1; + mwv207_output_write(output, 0xAC, status); + + for (i = 0; i < 3; i++) { + if (active) { + mwv207_output_write(output, MWV207_DAC_HPD_VS_CLC(i), 256); + mwv207_output_write(output, MWV207_DAC_HPD_PULSE_H(i), 48); + mwv207_output_write(output, MWV207_DAC_HPD_DET_PER(i), 188); + mwv207_output_write(output, MWV207_DAC_HPD_DET_THR(i), 164); + } else { + mwv207_output_write(output, MWV207_DAC_HPD_PULSE_H(i), 1600000); + mwv207_output_write(output, MWV207_DAC_HPD_PULSE_L(i), 798400000); + mwv207_output_write(output, MWV207_DAC_HPD_DET_PER(i), 1600128); + mwv207_output_write(output, MWV207_DAC_HPD_DET_THR(i), 8128); + } + } + + mwv207_output_write(output, 0xA4, 0x111111); +} + +static void mwv207_vga_switch(struct mwv207_output *output, bool on) +{ + struct mwv207_vga *vga = output_to_vga(output); + + if (!output->jdev->lite || !mwv207_vga_load_detect) { + mwv207_output_modify(output, 0x0, 1 << 31, (on ? 1 : 0) << 31); + return; + } + + spin_lock(&vga->load_detect_lock); + mwv207_output_modify(output, 0x0, 1 << 31, (on ? 1 : 0) << 31); + mwv207_vga_set_detect_mode(output, on); + vga->active = on; + spin_unlock(&vga->load_detect_lock); +} + +static void mwv207_vga_config(struct mwv207_output *output) +{ + struct drm_display_mode *mode = &output->cur_crtc->state->adjusted_mode; + int hpol, vpol; + + hpol = (mode->flags & DRM_MODE_FLAG_PHSYNC) ? 0 : 1; + vpol = (mode->flags & DRM_MODE_FLAG_PVSYNC) ? 0 : 1; + + mwv207_output_write(output, 0x4C, 0); + mwv207_output_modify(output, 0x0, 0x7 << 16, 0x7 << 16); + mwv207_output_modify(output, 0x0, 0x1 << 2, hpol << 2); + mwv207_output_modify(output, 0x0, 0x1 << 3, vpol << 3); + + mwv207_output_write(output, 0x4, 0x1666); + mwv207_output_write(output, 0x18, 0x1666); + mwv207_output_write(output, 0x2C, 0x1666); +} + +static void mwv207_vga_select_crtc(struct mwv207_output *output) +{ + + mwv207_output_modify(output, 0x0, 0x3 << 24, + drm_crtc_index(output->cur_crtc) << 24); + + jdev_modify(output->jdev, 0x9B0038, 0xf << 16, + drm_crtc_index(output->cur_crtc) << 16); +} +static enum drm_mode_status mwv207_vga_mode_valid(struct mwv207_output *output, + const struct drm_display_mode *mode) +{ + + if (mode->clock > 193250) + return MODE_CLOCK_HIGH; + + return MODE_OK; +} + +static enum drm_mode_status mwv207_vga_connector_mode_valid(struct drm_connector *connector, + struct drm_display_mode *mode) +{ + return mwv207_vga_mode_valid(connector_to_output(connector), mode); +} + +static int mwv207_vga_detect_load(struct mwv207_output *output) +{ + struct mwv207_vga *vga = output_to_vga(output); + u32 r_state, g_state, b_state, value; + bool active; + + if (mwv207_i2c_probe(output->ddc)) + return connector_status_connected; + + spin_lock(&vga->load_detect_lock); + value = mwv207_output_read(output, 0xA8); + active = vga->active; + spin_unlock(&vga->load_detect_lock); + + r_state = (value >> 8) & 0x1; + g_state = (value >> 4) & 0x1; + b_state = (value >> 0) & 0x1; + DRM_DEBUG_DRIVER("active %d r_state = 0x%x, g_state = 0x%x, b_state = 0x%x", + active, r_state, g_state, b_state); + + if (active) + return (r_state && g_state && b_state) ? + connector_status_disconnected : connector_status_connected; + + return (r_state || g_state || b_state) ? + connector_status_connected : connector_status_disconnected; +} + +static int mwv207_vga_detect_ctx(struct drm_connector *connector, + struct drm_modeset_acquire_ctx *ctx, + bool force) +{ + struct mwv207_output *output = connector_to_output(connector); + + if (connector->force == DRM_FORCE_OFF) + return connector_status_disconnected; + + if (connector->force == DRM_FORCE_ON) + return connector_status_connected; + + if (output->forced_edid) + return connector_status_connected; + + if (!output->jdev->lite || !mwv207_vga_load_detect) + return mwv207_i2c_probe(output->ddc) ? + connector_status_connected : connector_status_disconnected; + + return mwv207_vga_detect_load(output); +} + +static void mwv207_vga_destroy(struct drm_connector *conn) +{ + drm_connector_unregister(conn); + drm_connector_cleanup(conn); +} + +static const struct drm_connector_helper_funcs mwv207_vga_connector_helper_funcs = { + .get_modes = mwv207_output_get_modes, + .mode_valid = mwv207_vga_connector_mode_valid, + .detect_ctx = mwv207_vga_detect_ctx +}; + +static const struct drm_connector_funcs mwv207_vga_connector_funcs = { + .reset = drm_atomic_helper_connector_reset, + .fill_modes = drm_helper_probe_single_connector_modes, + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, + .destroy = mwv207_vga_destroy, + .late_register = mwv207_output_late_register, + .early_unregister = mwv207_output_early_unregister, +}; + +static enum drm_mode_status mwv207_vga_encoder_mode_valid(struct drm_encoder *encoder, + const struct drm_display_mode *mode) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + return mwv207_vga_mode_valid(output, mode); +} + +static int mwv207_vga_encoder_atomic_check(struct drm_encoder *encoder, + struct drm_crtc_state *crtc_state, + struct drm_connector_state *conn_state) +{ + return 0; +} + +static void mwv207_vga_encoder_enable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_vga_select_crtc(output); + + mwv207_vga_config(output); + + mwv207_vga_switch(output, true); +} + +static void mwv207_vga_encoder_disable(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + mwv207_vga_switch(output, false); +} + +static void mwv207_vga_encoder_reset(struct drm_encoder *encoder) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + if (output->jdev->lite && !mwv207_vga_load_detect) { + mwv207_output_write(output, 0xA4, 0); + mwv207_output_modify(output, 0x58, 0x1 << 16, 0); + } + + mwv207_vga_encoder_disable(encoder); +} + +static const struct drm_encoder_funcs mwv207_vga_encoder_funcs = { + .destroy = drm_encoder_cleanup, + .reset = mwv207_vga_encoder_reset, +}; + +static const struct drm_encoder_helper_funcs mwv207_vga_encoder_helper_funcs = { + .mode_valid = mwv207_vga_encoder_mode_valid, + .atomic_check = mwv207_vga_encoder_atomic_check, + .enable = mwv207_vga_encoder_enable, + .disable = mwv207_vga_encoder_disable, +}; + +int mwv207_vga_init(struct mwv207_device *jdev) +{ + struct mwv207_output *output; + struct mwv207_vga *vga; + int ret; + + vga = mwv207_output_probe_and_init(jdev, sizeof(struct mwv207_vga), 0, + 0x4, (20*1)); + + if (!vga) { + dev_info(jdev->dev, "vga is disabled by firmware"); + return 0; + } + + if (IS_ERR(vga)) + return PTR_ERR(vga); + + spin_lock_init(&vga->load_detect_lock); + output = &vga->base; + + output->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; + ret = drm_connector_init(&jdev->base, &output->connector, + &mwv207_vga_connector_funcs, DRM_MODE_CONNECTOR_VGA); + if (ret) + return ret; + drm_connector_helper_add(&output->connector, &mwv207_vga_connector_helper_funcs); + + output->encoder.possible_crtcs = (1 << jdev->base.mode_config.num_crtc) - 1; + ret = drm_encoder_init(&jdev->base, &output->encoder, + &mwv207_vga_encoder_funcs, DRM_MODE_ENCODER_DAC, + "vga-%d", output->idx); + if (ret) + return ret; + drm_encoder_helper_add(&output->encoder, &mwv207_vga_encoder_helper_funcs); + + ret = drm_connector_attach_encoder(&output->connector, &output->encoder); + if (ret) + return ret; + + return drm_connector_register(&output->connector); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_vi.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_vi.c new file mode 100644 index 0000000000000000000000000000000000000000..d7e1849ba22daf84fe6aac578addb57e7856b047 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_vi.c @@ -0,0 +1,154 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_vi.h" +#include "mwv207_vbios.h" + +bool mwv207_output_probe(struct mwv207_device *mdev, u32 key_offset) +{ + const struct mwv207_vdat *vdat; + + if (!mdev->has_cfg) + return true; + vdat = mwv207_vbios_vdat(mdev, + 0x0 + key_offset + 0x0); + + if (!vdat) + return false; + + return le32_to_cpu(*(uint32_t *)vdat->dat) != 0x0; +} + +static int mwv207_output_get_cfg_edid(struct mwv207_output *output, u32 key_offset) +{ + const struct mwv207_vdat *vdat; + struct edid *edid; + + vdat = mwv207_vbios_vdat(output->jdev, + 0x0 + key_offset + 0x2); + if (!vdat) + return 0; + edid = devm_kzalloc(output->jdev->dev, 256, GFP_KERNEL); + if (!edid) { + dev_err(output->jdev->dev, "output edid alloc failed"); + return -ENOMEM; + } + + memcpy(edid, vdat->dat, vdat->len); + output->forced_edid = edid; + + return 0; +} + +int mwv207_output_late_register(struct drm_connector *connector) +{ + struct mwv207_output *output = connector_to_output(connector); + + output->ddc = mwv207_i2c_create(output->jdev, output->i2c_chan); + connector->ddc = output->ddc; + if (!output->ddc) { + DRM_ERROR("Failed to create i2c adapter\n"); + return -ENODEV; + } + + return 0; +} + +void mwv207_output_early_unregister(struct drm_connector *connector) +{ + struct mwv207_output *output = connector_to_output(connector); + + mwv207_i2c_destroy(output->ddc); +} + +int mwv207_output_get_modes(struct drm_connector *connector) +{ + struct mwv207_output *output = connector_to_output(connector); + struct edid *edid; + int count; + + if (output->forced_edid) + edid = output->forced_edid; + else + edid = drm_get_edid(connector, output->ddc); + + output->has_audio = drm_detect_monitor_audio(edid); + drm_connector_update_edid_property(connector, edid); + count = drm_add_edid_modes(connector, edid); + + if (!output->forced_edid) + kfree(edid); + + return count; +} + +void mwv207_output_set_crtc(struct drm_encoder *encoder, struct drm_crtc *crtc) +{ + struct mwv207_output *output = encoder_to_output(encoder); + + output->cur_crtc = crtc; +} + +void *mwv207_output_probe_and_init(struct mwv207_device *mdev, + u32 size, int idx, + u32 i2c_chan, u32 key_offset) +{ + struct mwv207_output *output; + int ret; + + if (!mwv207_output_probe(mdev, key_offset)) + return NULL; + + output = devm_kzalloc(mdev->dev, size, GFP_KERNEL); + if (!output) + return ERR_PTR(-ENOMEM); + + output->jdev = mdev; + ret = mwv207_output_get_cfg_edid(output, key_offset); + if (ret) + return ERR_PTR(ret); + + output->idx = idx; + output->mmio = mdev->mmio + 0x9A0000; + output->i2c_chan = i2c_chan; + output->key_offset = key_offset; + output->audio = mdev->audio; + + return output; +} + +int mwv207_vi_init(struct mwv207_device *jdev) +{ + int ret; + + mutex_init(&jdev->gpio_lock); + ret = mwv207_audio_init(jdev); + if (ret) + return ret; + ret = mwv207_hdmi_init(jdev); + if (ret) + return ret; + ret = mwv207_edp_init(jdev); + if (ret) + return ret; + ret = mwv207_vga_init(jdev); + if (ret) + return ret; + ret = mwv207_dvo_init(jdev); + if (ret) + return ret; + + return 0; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_vi.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_vi.h new file mode 100644 index 0000000000000000000000000000000000000000..092727122dccd3b5070dee21f3b50f3c8f50d875 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dc/mwv207_vi.h @@ -0,0 +1,101 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_drv.h" +#include +#include +#include +#include +#include + +#ifndef MWV207_DAL_H_OUVHEJAX +#define MWV207_DAL_H_OUVHEJAX + +struct i2c_adapter; +struct mwv207_audio; + +struct mwv207_output { + struct drm_connector connector; + struct drm_encoder encoder; + + struct drm_crtc *cur_crtc; + struct mwv207_audio *audio; + + void __iomem *mmio; + struct mwv207_device *jdev; + + struct i2c_adapter *ddc; + struct edid *forced_edid; + u32 key_offset; + int i2c_chan; + + int idx; + bool has_audio; +}; +#define connector_to_output(conn) container_of(conn, struct mwv207_output, connector) +#define encoder_to_output(encoder) container_of(encoder, struct mwv207_output, encoder) + +int mwv207_audio_init(struct mwv207_device *jdev); +int mwv207_vi_init(struct mwv207_device *jdev); +int mwv207_edp_init(struct mwv207_device *jdev); +int mwv207_hdmi_init(struct mwv207_device *jdev); +int mwv207_vga_init(struct mwv207_device *jdev); +int mwv207_dvo_init(struct mwv207_device *jdev); + +void mwv207_audio_enable(struct mwv207_audio *jaudio, u32 port_idx, + const char *eld, int clock, + bool enabled, bool hw_connected); +void mwv207_audio_destroy(struct mwv207_audio *jaudio); +irqreturn_t mwv207_hdmi_audio_irq_handler(int irq, void *dev_id); +int mwv207_audio_suspend(struct mwv207_device *jdev); +int mwv207_audio_resume(struct mwv207_device *jdev); + +struct i2c_adapter *mwv207_i2c_create(struct mwv207_device *jdev, int i2c_chan); +void mwv207_i2c_destroy(struct i2c_adapter *adapter); +bool mwv207_i2c_probe(struct i2c_adapter *i2c_bus); + +int mwv207_output_late_register(struct drm_connector *connector); +void mwv207_output_early_unregister(struct drm_connector *connector); + +int mwv207_output_get_modes(struct drm_connector *connector); +void mwv207_output_set_crtc(struct drm_encoder *encoder, struct drm_crtc *crtc); +void *mwv207_output_probe_and_init(struct mwv207_device *mdev, + u32 size, int idx, + u32 i2c_chan, u32 key_offset); + +static inline u32 mwv207_output_read(struct mwv207_output *output, u32 reg) +{ + BUG_ON(reg >= 0x8000); + return readl(output->mmio + reg); +} + +static inline void mwv207_output_write(struct mwv207_output *output, u32 reg, u32 value) +{ + BUG_ON(reg >= 0x8000); + writel_relaxed(value, output->mmio + reg); +} + +static inline void mwv207_output_modify(struct mwv207_output *output, u32 reg, + u32 mask, u32 value) +{ + u32 rvalue; + + BUG_ON(reg >= 0x8000); + rvalue = mwv207_output_read(output, reg); + rvalue = (rvalue & ~mask) | (value & mask); + mwv207_output_write(output, reg, rvalue); +} + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dkms.conf b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dkms.conf new file mode 100644 index 0000000000000000000000000000000000000000..e4f48c1f435b941efbf7445aacbff7ff1908d414 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/dkms.conf @@ -0,0 +1,6 @@ +PACKAGE_NAME="mwv207" +PACKAGE_VERSION="6.6" +BUILT_MODULE_NAME[0]="$PACKAGE_NAME" +DEST_MODULE_LOCATION[0]="/updates/dkms" +AUTOINSTALL="YES" +REMAKE_INITRD="YES" diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_bo.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_bo.c new file mode 100644 index 0000000000000000000000000000000000000000..7cb6b933f0a756fab3f73fb01d5961d1ebdff75f --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_bo.c @@ -0,0 +1,431 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include "mwv207_drm.h" +#include "mwv207_bo.h" + +vm_fault_t mwv207_bo_fault_reserve_notify(struct ttm_buffer_object *bo) +{ + struct ttm_operation_ctx ctx = { + .interruptible = true, + .no_wait_gpu = false + }; + struct mwv207_device *jdev; + struct mwv207_bo *jbo; + u64 size, offset; + u32 domain; + int ret; + + if (!mwv207_ttm_bo_is_mwv207_bo(bo)) + return 0; + if (bo->resource->mem_type != TTM_PL_VRAM) + return 0; + + jbo = to_jbo(bo); + jdev = ddev_to_jdev(jbo->tbo.base.dev); + size = bo->base.size; + offset = bo->resource->start << PAGE_SHIFT; + + jbo->flags |= 0x1; + + if ((offset + size) <= jdev->visible_vram_size) + return 0; + + if (jbo->tbo.pin_count > 0) + return VM_FAULT_SIGBUS; + + domain = 0x2; +retry: + mwv207_bo_placement_from_domain(jbo, domain); + ret = ttm_bo_validate(bo, &jbo->placement, &ctx); + if (unlikely(ret)) { + if (ret != -ERESTARTSYS) { + if (domain == 0x2) { + + domain = 0x1; + goto retry; + } + } + return VM_FAULT_NOPAGE; + } + + offset = bo->resource->start << PAGE_SHIFT; + if (bo->resource->mem_type == TTM_PL_VRAM && + (offset + size) > jdev->visible_vram_size) { + DRM_ERROR("bo validation goes crazy"); + return VM_FAULT_SIGBUS; + } + + return 0; +} + +static void mwv207_ttm_bo_destroy(struct ttm_buffer_object *bo) +{ + struct mwv207_bo *jbo = to_jbo(bo); + + WARN_ON_ONCE(jbo->map_count > 0); + if (bo->base.import_attach) + drm_prime_gem_destroy(&bo->base, NULL); + drm_gem_object_release(&jbo->tbo.base); + kfree(jbo); +} + +bool mwv207_ttm_bo_is_mwv207_bo(struct ttm_buffer_object *jbo) +{ + if (jbo->destroy == &mwv207_ttm_bo_destroy) + return true; + return false; +} + +int mwv207_bo_kmap(struct mwv207_bo *jbo, void **ptr) +{ + bool is_iomem; + int ret; + + if (jbo->kptr) { + if (ptr) + *ptr = jbo->kptr; + return 0; + } + ret = ttm_bo_kmap(&jbo->tbo, 0, PFN_UP(jbo->tbo.base.size), &jbo->kmap); + if (ret) + return ret; + jbo->kptr = ttm_kmap_obj_virtual(&jbo->kmap, &is_iomem); + if (ptr) + *ptr = jbo->kptr; + return 0; +} + +void mwv207_bo_kunmap(struct mwv207_bo *jbo) +{ + if (!jbo->kptr) + return; + jbo->kptr = NULL; + ttm_bo_kunmap(&jbo->kmap); +} + +void mwv207_bo_placement_from_domain(struct mwv207_bo *jbo, u32 domain) +{ + struct mwv207_device *jdev = bdev_to_jdev(jbo->tbo.bdev); + u32 c = 0; + + jbo->placement.placement = jbo->placements; + jbo->placement.busy_placement = jbo->placements; + + if (domain & 0x2) { + jbo->placements[c].fpfn = 0; + jbo->placements[c].lpfn = 0; + jbo->placements[c].mem_type = TTM_PL_VRAM; + jbo->placements[c].flags = 0; + + if (jbo->flags & 0x4) + jbo->placements[c].lpfn = 0x100000000ul >> PAGE_SHIFT; + + if (jbo->flags & 0x1) + jbo->placements[c].lpfn = jdev->visible_vram_size >> PAGE_SHIFT; + else + jbo->placements[c].flags |= TTM_PL_FLAG_TOPDOWN; + c++; + } + + if (domain & 0x4) { + jbo->placements[c].fpfn = 0; + jbo->placements[c].lpfn = 0; + jbo->placements[c].mem_type = TTM_PL_TT; + jbo->placements[c++].flags = 0; + } + + if (domain & 0x1) { + jbo->placements[c].fpfn = 0; + jbo->placements[c].lpfn = 0; + jbo->placements[c].mem_type = TTM_PL_SYSTEM; + jbo->placements[c++].flags = 0; + } + + if (!c) { + jbo->placements[c].fpfn = 0; + jbo->placements[c].lpfn = 0; + jbo->placements[c].mem_type = TTM_PL_SYSTEM; + jbo->placements[c++].flags = 0; + } + + BUG_ON(c > 3); + jbo->placement.num_placement = c; + jbo->placement.num_busy_placement = c; +} + +int mwv207_bo_create(struct mwv207_device *jdev, u64 size, u64 byte_align, + bool kernel, u32 domain, u32 flags, struct sg_table *sg, + struct dma_resv *resv, struct mwv207_bo **pbo) +{ + unsigned long page_align = roundup(byte_align, PAGE_SIZE) >> PAGE_SHIFT; + struct mwv207_bo *jbo; + enum ttm_bo_type type; + int ret; + + if (kernel) + type = ttm_bo_type_kernel; + else if (sg) + type = ttm_bo_type_sg; + else + type = ttm_bo_type_device; + *pbo = NULL; + + if ((flags & 0x4) && + !(domain & 0x2)) + return -EINVAL; + + jbo = kzalloc(sizeof(struct mwv207_bo), GFP_KERNEL); + if (!jbo) + return -ENOMEM; + size = roundup(size, PAGE_SIZE); + ret = drm_gem_object_init(&jdev->base, &jbo->tbo.base, size); + if (unlikely(ret)) { + kfree(jbo); + return ret; + } + jbo->flags = flags; + jbo->domain = domain; + jbo->jdev = jdev; + jbo->tbo.bdev = &jdev->bdev; + + mwv207_bo_placement_from_domain(jbo, domain); + + ret = ttm_bo_init_validate(&jdev->bdev, &jbo->tbo, type, + &jbo->placement, page_align, !kernel, + sg, resv, &mwv207_ttm_bo_destroy); + if (unlikely(ret)) + return ret; + *pbo = jbo; + return 0; +} + +int mwv207_bo_reserve(struct mwv207_bo *jbo, bool no_intr) +{ + int ret; + + ret = ttm_bo_reserve(&jbo->tbo, !no_intr, false, NULL); + if (unlikely(ret)) { + if (ret != -ERESTARTSYS) + DRM_ERROR("bo reserve failed\n"); + return ret; + } + return 0; +} + +void mwv207_bo_unreserve(struct mwv207_bo *jbo) +{ + ttm_bo_unreserve(&jbo->tbo); +} + +int mwv207_bo_kmap_reserved(struct mwv207_bo *jbo, void **ptr) +{ + bool is_iomem; + int ret; + + if (!jbo->flags & 0x1) + return -EPERM; + + if (jbo->kptr) { + if (ptr) + *ptr = jbo->kptr; + jbo->map_count++; + return 0; + } + ret = ttm_bo_kmap(&jbo->tbo, 0, jbo->tbo.base.size >> PAGE_SHIFT, &jbo->kmap); + if (ret) + return ret; + + jbo->kptr = ttm_kmap_obj_virtual(&jbo->kmap, &is_iomem); + if (ptr) + *ptr = jbo->kptr; + jbo->map_count = 1; + return 0; +} + +void mwv207_bo_kunmap_reserved(struct mwv207_bo *jbo) +{ + if (WARN_ON_ONCE(jbo->kptr == NULL)) + return; + jbo->map_count--; + if (jbo->map_count > 0) + return; + jbo->kptr = NULL; + ttm_bo_kunmap(&jbo->kmap); +} + +void mwv207_bo_unref(struct mwv207_bo *jbo) +{ + if (jbo == NULL) + return; + + ttm_bo_put(&jbo->tbo); +} + +struct mwv207_bo *mwv207_bo_ref(struct mwv207_bo *jbo) +{ + if (jbo == NULL) + return NULL; + + ttm_bo_get(&jbo->tbo); + return jbo; +} + +int mwv207_bo_pin_reserved(struct mwv207_bo *jbo, u32 domain) +{ + struct ttm_operation_ctx ctx = {false, false}; + int ret; + + if (jbo->tbo.pin_count) { + ttm_bo_pin(&jbo->tbo); + return 0; + } + + jbo->flags |= 0x4; + mwv207_bo_placement_from_domain(jbo, domain); + ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); + if (ret) + return ret; + + ttm_bo_pin(&jbo->tbo); + + return 0; +} + +int mwv207_bo_unpin_reserved(struct mwv207_bo *jbo) +{ + if (WARN_ON_ONCE(!jbo->tbo.pin_count)) + return -1; + + ttm_bo_unpin(&jbo->tbo); + + return 0; +} + +int mwv207_bo_pin(struct mwv207_bo *jbo, u32 domain, u64 *gpu_addr) +{ + int ret; + struct mwv207_device *jdev = jbo->jdev; + + ret = mwv207_bo_reserve(jbo, true); + if (ret) + return ret; + + ret = mwv207_bo_pin_reserved(jbo, domain); + mwv207_bo_unreserve(jbo); + if (ret) + return ret; + + if (gpu_addr) + *gpu_addr = mwv207_bo_gpu_offset(jbo); + if (domain == 0x2) + jdev->vram_pinned_bytes += mwv207_bo_size(jbo); + else + jdev->gtt_pinned_bytes += mwv207_bo_size(jbo); + + return 0; +} + +int mwv207_bo_unpin(struct mwv207_bo *jbo) +{ + int ret; + + ret = mwv207_bo_unpin_reserved(jbo); + mwv207_bo_unreserve(jbo); + if (ret) + return ret; + + if (!jbo->tbo.pin_count) { + if (jbo->tbo.resource->mem_type == TTM_PL_VRAM) + jbo->jdev->vram_pinned_bytes -= mwv207_bo_size(jbo); + else + jbo->jdev->gtt_pinned_bytes -= mwv207_bo_size(jbo); + } + return 0; +} + +int mwv207_bo_wait(struct mwv207_bo *jbo, bool no_wait) +{ + struct ttm_operation_ctx ctx = { + .interruptible = true, + .no_wait_gpu = no_wait, + }; + int ret; + + ret = ttm_bo_reserve(&jbo->tbo, true, no_wait, NULL); + if (unlikely(ret)) { + if (ret != -ERESTARTSYS && ret != -EBUSY) + DRM_ERROR("bo reserve failed for wait\n"); + return ret; + } + ret = ttm_bo_wait_ctx(&jbo->tbo, &ctx); + ttm_bo_unreserve(&jbo->tbo); + return ret; +} + +int mwv207_bo_create_pin_mapped(struct mwv207_device *jdev, + u64 size, u64 align, u32 domain, u32 flags, + struct mwv207_bo **jbop, u64 *pap, void **vap) +{ + struct mwv207_bo *jbo; + void *va; + u64 pa; + int ret; + + ret = mwv207_bo_create(jdev, size, align, true, + domain, flags, NULL, NULL, &jbo); + if (ret) + return ret; + ret = mwv207_bo_pin(jbo, domain, &pa); + if (ret) + goto unreserve_bo; + ret = mwv207_bo_kmap(jbo, &va); + if (ret) + goto unpin_bo; + mwv207_bo_unreserve(jbo); + if (jbop) + *jbop = jbo; + if (pap) + *pap = pa; + if (vap) + *vap = va; + return 0; + +unpin_bo: + mwv207_bo_unpin(jbo); +unreserve_bo: + mwv207_bo_unreserve(jbo); +free_bo: + mwv207_bo_unref(jbo); + return ret; +} + +void mwv207_bo_destroy_pin_mapped(struct mwv207_bo *jbo) +{ + int ret; + + ret = mwv207_bo_reserve(jbo, true); + if (ret) { + pr_warn("failed to reserve bo: %d", ret); + return; + } + mwv207_bo_kunmap(jbo); + mwv207_bo_unpin(jbo); + mwv207_bo_unreserve(jbo); + mwv207_bo_unref(jbo); +} + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_bo.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_bo.h new file mode 100644 index 0000000000000000000000000000000000000000..23bf9150bc104adefc6ce9cc3385f49159be1d81 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_bo.h @@ -0,0 +1,129 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_BO_H_T4ETFCB2 +#define MWV207_BO_H_T4ETFCB2 +#include +#include +#include +#include +#include +#include +#include + +#include "mwv207_drv.h" +#include "mwv207_drm.h" + +#undef MWV207_DEBUG_BO_MIGRATION + +#define to_jbo(bo) container_of(bo, struct mwv207_bo, tbo) +struct mwv207_bo { + struct ttm_buffer_object tbo; + struct ttm_placement placement; + struct ttm_bo_kmap_obj kmap; + struct ttm_place placements[3]; + u32 domain; + u32 flags; + int pin_count; + struct iosys_map map; + int map_count; + void *kptr; + struct mwv207_device *jdev; +#ifdef MWV207_DEBUG_BO_MIGRATION + int toggle; +#endif +}; + +struct mwv207_ttm_tt { + struct ttm_tt ttm; + struct mwv207_device *jdev; +}; +#define to_gtt(ttm_tt) container_of(ttm_tt, struct mwv207_ttm_tt, ttm) + +static inline struct mwv207_bo *mwv207_bo_from_gem(struct drm_gem_object *gobj) +{ + struct ttm_buffer_object *tbo = container_of(gobj, struct ttm_buffer_object, base); + + return container_of(tbo, struct mwv207_bo, tbo); +} + +static inline struct drm_gem_object *mwv207_gem_from_bo(struct mwv207_bo *jbo) +{ + return &jbo->tbo.base; +} + +static inline u64 mwv207_bo_size(struct mwv207_bo *jbo) +{ + return jbo->tbo.base.size; +} + +static inline u64 mwv207_bo_mmap_offset(struct drm_gem_object *gobj) +{ + struct mwv207_bo *jbo = mwv207_bo_from_gem(gobj); + + return drm_vma_node_offset_addr(&jbo->tbo.base.vma_node); +} + +static inline u64 mwv207_bo_gpu_offset(struct mwv207_bo *jbo) +{ + u64 addr = jbo->tbo.resource->start << PAGE_SHIFT; + + if (jbo->tbo.resource->mem_type == TTM_PL_TT) + addr += 0x800000000ULL; + + return addr; +} + +static inline u64 mwv207_bo_gpu_phys(struct mwv207_bo *jbo) +{ + return jbo->tbo.resource->start << PAGE_SHIFT; +} + +void mwv207_bo_placement_from_domain(struct mwv207_bo *jbo, u32 domain); + +bool mwv207_ttm_bo_is_mwv207_bo(struct ttm_buffer_object *tbo); +void mwv207_bo_placement(struct mwv207_bo *jbo, int domain); + +int mwv207_bo_create(struct mwv207_device *jdev, u64 size, u64 byte_align, + bool kernel, u32 domain, u32 flags, struct sg_table *sg, + struct dma_resv *resv, struct mwv207_bo **pbo); +int mwv207_bo_create_pin_mapped(struct mwv207_device *jdev, + u64 size, u64 align, u32 domain, u32 flags, + struct mwv207_bo **jbop, u64 *pap, void **vap); +void mwv207_bo_destroy_pin_mapped(struct mwv207_bo *jbo); + +int mwv207_bo_reserve(struct mwv207_bo *jbo, bool no_intr); +void mwv207_bo_unreserve(struct mwv207_bo *jbo); + +int mwv207_bo_pin_reserved(struct mwv207_bo *jbo, u32 domain); +int mwv207_bo_unpin_reserved(struct mwv207_bo *jbo); + +int mwv207_bo_pin(struct mwv207_bo *jbo, u32 domain, u64 *gpu_addr); +int mwv207_bo_unpin(struct mwv207_bo *jbo); + +int mwv207_bo_kmap_reserved(struct mwv207_bo *jbo, void **ptr); +void mwv207_bo_kunmap_reserved(struct mwv207_bo *jbo); + +struct mwv207_bo *mwv207_bo_ref(struct mwv207_bo *jbo); +void mwv207_bo_unref(struct mwv207_bo *jbo); + +int mwv207_ttm_init(struct mwv207_device *jdev); +void mwv207_ttm_fini(struct mwv207_device *jdev); + +int mwv207_bo_wait(struct mwv207_bo *jbo, bool no_wait); + +vm_fault_t mwv207_bo_fault_reserve_notify(struct ttm_buffer_object *bo); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ctx.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ctx.c new file mode 100644 index 0000000000000000000000000000000000000000..2b7c36e5872b07453148cccce83ef3c3b7362e64 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ctx.c @@ -0,0 +1,315 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include "mwv207_drv.h" +#include "mwv207_drm.h" +#include "mwv207_ctx.h" + +#define MAX(a, b) ((a) > (b) ? (a) : (b)) + +int mwv207_sched_jobs = 32; +module_param(mwv207_sched_jobs, int, 0444); +MODULE_PARM_DESC(mwv207_sched_jobs, "max number of jobs in software queue(default=32)"); + +struct mwv207_ctx *mwv207_ctx_lookup(struct drm_device *dev, + struct drm_file *filp, u32 handle) +{ + struct mwv207_fpriv *fpriv = to_fpriv(filp); + struct mwv207_ctx_mgr *mgr = &fpriv->ctx_mgr; + struct mwv207_ctx *ctx; + + mutex_lock(&mgr->lock); + ctx = idr_find(&mgr->handle_table, handle); + if (ctx) + kref_get(&ctx->refcnt); + mutex_unlock(&mgr->lock); + + return ctx; +} + +static void mwv207_ctx_entity_fini(struct mwv207_ctx *ctx) +{ + int i, j, k; + + for (i = 0; i < 0x5; i++) { + for (j = 0; j < 0x2 + 1; j++) { + if (ctx->centities[i][j]) { + for (k = 0; k < mwv207_sched_jobs; k++) + dma_fence_put(ctx->centities[i][j]->fences[k]); + drm_sched_entity_destroy(&ctx->centities[i][j]->entity); + kfree(ctx->centities[i][j]); + ctx->centities[i][j] = NULL; + } + } + } +} + +static int mwv207_ctx_entity_init_single(struct mwv207_ctx *ctx, + struct drm_gpu_scheduler **sched, + struct mwv207_ctx_entity **centities, int nr) +{ + struct mwv207_ctx_entity *centity; + int i, ret; + + for (i = 0; i < nr; i++) { + centity = kzalloc(struct_size(centity, fences, mwv207_sched_jobs), + GFP_KERNEL); + if (!centity) + return -ENOMEM; + mutex_init(¢ity->qlock); + ret = drm_sched_entity_init(¢ity->entity, + DRM_SCHED_PRIORITY_NORMAL, + &sched[i], 1, &ctx->guilty); + if (ret) { + kfree(centity); + return ret; + } + centities[i] = centity; + } + if (i) { + + centity = kzalloc(struct_size(centity, fences, mwv207_sched_jobs), + GFP_KERNEL); + if (!centity) + return -ENOMEM; + mutex_init(¢ity->qlock); + ret = drm_sched_entity_init(¢ity->entity, + DRM_SCHED_PRIORITY_NORMAL, + sched, i, &ctx->guilty); + if (ret) { + kfree(centity); + return ret; + } + centities[i] = centity; + } + + return 0; +} + +static int mwv207_ctx_entity_init(struct drm_device *dev, + struct mwv207_ctx *ctx) +{ + struct mwv207_device *jdev = drm_to_jdev(dev); + int ret; + int i; + + for (i = 0; i < 0x5; i++) { + ret = mwv207_ctx_entity_init_single(ctx, jdev->sched[i], + &ctx->centities[i][0], + jdev->nr_pipe[i]); + if (ret) + goto fini; + } + + return 0; +fini: + mwv207_ctx_entity_fini(ctx); + return ret; +} + +static int mwv207_ctx_create(struct drm_device *dev, struct mwv207_ctx_mgr *mgr, + u32 flags, u32 *handle) +{ + struct mwv207_ctx *ctx; + int ret; + + ctx = kzalloc(sizeof(struct mwv207_ctx), GFP_KERNEL); + if (ctx == NULL) + return -ENOMEM; + + ctx->jdev = ddev_to_jdev(dev); + kref_init(&ctx->refcnt); + + ret = mwv207_ctx_entity_init(dev, ctx); + if (ret) + goto out_free; + + mutex_lock(&mgr->lock); + ret = idr_alloc(&mgr->handle_table, ctx, 1, 0, GFP_KERNEL); + mutex_unlock(&mgr->lock); + + if (ret < 0) + goto out_fini_entites; + + *handle = ret; + return 0; +out_fini_entites: + mwv207_ctx_entity_fini(ctx); +out_free: + kfree(ctx); + return ret; +} + +static void mwv207_ctx_release(struct kref *kref) +{ + struct mwv207_ctx *ctx = container_of(kref, struct mwv207_ctx, refcnt); + + mwv207_ctx_entity_fini(ctx); + kfree(ctx); +} + +void mwv207_ctx_add_fence(struct mwv207_ctx *ctx, + struct drm_sched_entity *entity, + struct dma_fence *fence) +{ + struct mwv207_ctx_entity *centity = to_mwv207_ctx_entity(entity); + struct dma_fence *prev; + unsigned int idx; + + BUG_ON(!mutex_is_locked(¢ity->qlock)); + + idx = centity->sequence & (mwv207_sched_jobs - 1); + prev = centity->fences[idx]; + + if (likely(prev)) { + BUG_ON(!dma_fence_is_signaled(prev)); + dma_fence_put(prev); + } + + centity->fences[idx] = dma_fence_get(fence); + centity->sequence++; +} + +int mwv207_ctx_wait_prev_fence(struct mwv207_ctx *ctx, + struct drm_sched_entity *entity) +{ + struct mwv207_ctx_entity *centity = to_mwv207_ctx_entity(entity); + struct dma_fence *prev; + unsigned int idx; + + BUG_ON(!mutex_is_locked(¢ity->qlock)); + + idx = centity->sequence & (mwv207_sched_jobs - 1); + prev = centity->fences[idx]; + if (likely(prev)) + return dma_fence_wait(prev, true); + + return 0; +} + +int mwv207_ctx_put(struct mwv207_ctx *ctx) +{ + return kref_put(&ctx->refcnt, mwv207_ctx_release); +} + +static int mwv207_ctx_destroy(struct drm_device *dev, struct mwv207_ctx_mgr *mgr, u32 handle) +{ + struct mwv207_ctx *ctx; + + mutex_lock(&mgr->lock); + ctx = idr_remove(&mgr->handle_table, handle); + mutex_unlock(&mgr->lock); + + if (ctx == NULL) + return -EINVAL; + + mwv207_ctx_put(ctx); + return 0; +} + +int mwv207_ctx_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + struct drm_mwv207_ctx *args = (struct drm_mwv207_ctx *)data; + struct mwv207_fpriv *fpriv = to_fpriv(filp); + + if (args->resv || args->flags) + return -EINVAL; + + switch (args->op) { + case 0x0: + return mwv207_ctx_create(dev, &fpriv->ctx_mgr, args->flags, &args->handle); + case 0x1: + return mwv207_ctx_destroy(dev, &fpriv->ctx_mgr, args->handle); + default: + return -EINVAL; + } +} + +int mwv207_ctx_mgr_init(struct drm_device *dev, struct mwv207_ctx_mgr *mgr) +{ + mutex_init(&mgr->lock); + idr_init(&mgr->handle_table); + return 0; +} + +void mwv207_ctx_mgr_fini(struct drm_device *dev, struct mwv207_ctx_mgr *mgr) +{ + struct mwv207_ctx *ctx; + uint32_t id; + + idr_for_each_entry(&mgr->handle_table, ctx, id) + mwv207_ctx_put(ctx); + + idr_destroy(&mgr->handle_table); + mutex_destroy(&mgr->lock); +} + +static struct drm_sched_entity *mwv207_create_kentity( + struct mwv207_device *jdev, int type) +{ + struct drm_gpu_scheduler **sched = jdev->sched[type]; + int nr_pipe = jdev->nr_pipe[type]; + struct drm_sched_entity *entity; + int ret; + + entity = devm_kzalloc(jdev->dev, + sizeof(struct drm_sched_entity), + GFP_KERNEL); + if (!entity) + return NULL; + + ret = drm_sched_entity_init(entity, + DRM_SCHED_PRIORITY_HIGH, + sched, nr_pipe, NULL); + if (ret) + return NULL; + + return entity; +} + +int mwv207_kctx_init(struct mwv207_device *jdev) +{ + if (mwv207_sched_jobs < 4) { + pr_warn("jobs(%d) at least 4", mwv207_sched_jobs); + mwv207_sched_jobs = 4; + } else if (!is_power_of_2(mwv207_sched_jobs)) { + pr_warn("jobs(%d) must be power of 2", mwv207_sched_jobs); + mwv207_sched_jobs = roundup_pow_of_two(mwv207_sched_jobs); + } + + jdev->dma_entity = mwv207_create_kentity(jdev, 0x4); + jdev->blt_entity = mwv207_create_kentity(jdev, 0x3); + + if (!jdev->dma_entity || !jdev->blt_entity) { + mwv207_kctx_fini(jdev); + return -ENOMEM; + } + mutex_init(&jdev->qlock); + + return 0; +} + +void mwv207_kctx_fini(struct mwv207_device *jdev) +{ + if (jdev->dma_entity) + drm_sched_entity_destroy(jdev->dma_entity); + if (jdev->blt_entity) + drm_sched_entity_destroy(jdev->blt_entity); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ctx.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ctx.h new file mode 100644 index 0000000000000000000000000000000000000000..41007af593a4379f75cdc98321fc6b8805b9a959 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ctx.h @@ -0,0 +1,58 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_CTX_H_QFMRESBO +#define MWV207_CTX_H_QFMRESBO +#include +#include +#include "mwv207_drv.h" + +#define to_mwv207_ctx_entity(entity) container_of(entity, struct mwv207_ctx_entity, entity) +struct mwv207_ctx_entity { + struct drm_sched_entity entity; + struct mutex qlock; + u32 sequence; + struct dma_fence *fences[]; +}; + +struct mwv207_ctx { + struct kref refcnt; + + struct mwv207_ctx_entity *centities[0xC][0x2 + 1]; + + struct mwv207_device *jdev; + atomic_t guilty; +}; + +void mwv207_ctx_add_fence(struct mwv207_ctx *ctx, + struct drm_sched_entity *entity, + struct dma_fence *fence); + +int mwv207_ctx_wait_prev_fence(struct mwv207_ctx *ctx, + struct drm_sched_entity *entity); +struct mwv207_ctx *mwv207_ctx_lookup(struct drm_device *dev, + struct drm_file *filp, u32 handle); +int mwv207_ctx_put(struct mwv207_ctx *ctx); + +int mwv207_ctx_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +int mwv207_ctx_mgr_init(struct drm_device *dev, struct mwv207_ctx_mgr *mgr); +void mwv207_ctx_mgr_fini(struct drm_device *dev, struct mwv207_ctx_mgr *mgr); + +int mwv207_kctx_init(struct mwv207_device *jdev); +void mwv207_kctx_fini(struct mwv207_device *jdev); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_db.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_db.c new file mode 100644 index 0000000000000000000000000000000000000000..c6c789ed7cea77cfefbbe789c33c661692613ef6 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_db.c @@ -0,0 +1,136 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include "mwv207_db.h" +#include "mwv207_drv.h" +#include "mwv207_drm.h" + +struct mwv207_db { + u32 nr; + u32 max_nr; + u32 sorted; + u32 pad; + struct drm_mwv207_info_rec *db; +}; + +int mwv207_db_init(struct mwv207_device *jdev) +{ + struct mwv207_db *db; + u32 size; + + size = sizeof(struct mwv207_db); + size += 0x800 * sizeof(struct drm_mwv207_info_rec); + db = devm_kmalloc(jdev->dev, size, GFP_KERNEL); + if (!db) + return -ENOMEM; + + db->db = (struct drm_mwv207_info_rec *)(db + 1); + db->max_nr = 0x800; + db->nr = 0; + db->sorted = 0; + jdev->db = db; + return 0; +} + +void mwv207_db_fini(struct mwv207_device *jdev) +{ + devm_kfree(jdev->dev, jdev->db); +} + +int mwv207_db_add(struct mwv207_device *jdev, u32 key, u32 val) +{ + struct mwv207_db *db = jdev->db; + + if (db->nr >= db->max_nr) { + WARN_ONCE(1, "mwv207: maximum key count reached"); + return -ENOMEM; + } + + db->db[db->nr].key = key; + db->db[db->nr].val = val; + db->nr++; + + if (db->sorted) + mwv207_db_sort(jdev); + + return 0; +} + +static int cmp_key(const void *a, const void *b) +{ + struct drm_mwv207_info_rec const *rec_a = a, *rec_b = b; + + if (rec_a->key < rec_b->key) + return -1; + else if (rec_a->key > rec_b->key) + return 1; + else + return 0; +} + +void mwv207_db_sort(struct mwv207_device *jdev) +{ + struct mwv207_db *db = jdev->db; + int i; + + db->sorted = 1; + if (db->nr < 2) + return; + + sort(db->db, db->nr, 8, cmp_key, NULL); + + for (i = 0; i < db->nr - 1; ++i) { + if (db->db[i].key == db->db[i + 1].key) { + WARN_ONCE(1, "mwv207 key: %d is duplicated", db->db[i].key); + break; + } + } +} + +int mwv207_db_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + struct mwv207_device *jdev = dev->dev_private; + struct drm_mwv207_info_rec rec, *result; + struct drm_mwv207_info *args = data; + struct mwv207_db *db = jdev->db; + + switch (args->op) { + case 0x1: + rec.key = args->nr_recs; + result = bsearch(&rec, db->db, db->nr, 8, cmp_key); + if (!result) { + args->recs = 0; + return -ENOENT; + } + args->recs = result->val; + + break; + case 0x0: + if (args->recs) + return copy_to_user((void __user *)args->recs, db->db, + db->nr * sizeof(struct drm_mwv207_info_rec)); + args->nr_recs = db->nr; + + break; + default: + return -EINVAL; + } + + return 0; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_db.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_db.h new file mode 100644 index 0000000000000000000000000000000000000000..fd5c685d4ca33e3c60cf7bf398e5c3ed74ced7b1 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_db.h @@ -0,0 +1,32 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include "mwv207_drm.h" +#ifndef MWV207_DB_H_AGPY6ZIQ +#define MWV207_DB_H_AGPY6ZIQ + +struct mwv207_device; + +int mwv207_db_init(struct mwv207_device *jdev); +void mwv207_db_fini(struct mwv207_device *jdev); +void mwv207_db_sort(struct mwv207_device *jdev); + +int mwv207_db_add(struct mwv207_device *jdev, u32 key, u32 val); + +int mwv207_db_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_debugfs.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_debugfs.c new file mode 100644 index 0000000000000000000000000000000000000000..055138e718f23a70f54deaa18e005608a6f90420 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_debugfs.c @@ -0,0 +1,270 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include "mwv207_bo.h" +#include "mwv207_drm.h" + +#ifdef CONFIG_DEBUG_FS + +static int mwv207_debugfs_vram_size_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%llu\n", mdev->hw.vram_size); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_vram_size); + +static int mwv207_debugfs_gtt_size_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%llu\n", mdev->gtt_size); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_gtt_size); + +static int mwv207_debugfs_moved_bytes_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%llu\n", atomic64_read(&mdev->moved_bytes)); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_moved_bytes); + +static int mwv207_debugfs_vram_used_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%llu\n", atomic64_read(&mdev->vram_used_bytes)); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_vram_used); + +static int mwv207_debugfs_visible_vram_used_show(struct seq_file *m, + void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%llu\n", + atomic64_read(&mdev->visible_vram_used_bytes)); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_visible_vram_used); + +static int mwv207_debugfs_gtt_used_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%llu\n", atomic64_read(&mdev->gtt_used_bytes)); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_gtt_used); + +static int mwv207_debugfs_vram_pinned_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%llu\n", mdev->vram_pinned_bytes); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_vram_pinned); + +static int mwv207_debugfs_gtt_pinned_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%llu\n", mdev->gtt_pinned_bytes); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_gtt_pinned); + +static int mwv207_debugfs_3d_clusters_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%d\n", mdev->hw.nr_3d_cluster); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_3d_clusters); + +static int mwv207_debugfs_2d_clusters_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%d\n", mdev->hw.nr_2d_cluster); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_2d_clusters); + +static int mwv207_debugfs_fus_clusters_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%d\n", mdev->hw.nr_fus_cluster); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_fus_clusters); + +static int mwv207_debugfs_num_dma_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%d\n", mdev->hw.nr_pipe[0x4]); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_num_dma); + +static int mwv207_debugfs_num_dec_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%d\n", mdev->hw.nr_pipe[0x1]); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_num_dec); + +static int mwv207_debugfs_num_enc_show(struct seq_file *m, void *unused) +{ + struct mwv207_device *mdev = m->private; + + seq_printf(m, "%d\n", mdev->hw.nr_pipe[0x2]); + + return 0; +} +DEFINE_SHOW_ATTRIBUTE(mwv207_debugfs_num_enc); + +int mwv207_debugfs_init(struct mwv207_device *mdev) +{ + struct dentry *root = mdev->base.primary->debugfs_root; + struct dentry *ent; + + ent = debugfs_create_file("vram_size", 0444, root, mdev, + &mwv207_debugfs_vram_size_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create vram size debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("gtt_size", 0444, root, mdev, + &mwv207_debugfs_gtt_size_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create gtt size debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("moved_bytes", 0444, root, mdev, + &mwv207_debugfs_moved_bytes_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create moved bytes debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("vram_used_bytes", 0444, root, mdev, + &mwv207_debugfs_vram_used_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create vram used bytes debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("visible_vram_used_bytes", 0444, root, mdev, + &mwv207_debugfs_visible_vram_used_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create visible vram used debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("gtt_used_bytes", 0444, root, mdev, + &mwv207_debugfs_gtt_used_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create gtt used bytes debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("vram_pinned_bytes", 0444, root, mdev, + &mwv207_debugfs_vram_pinned_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create vram pinned bytes debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("gtt_pinned_bytes", 0444, root, mdev, + &mwv207_debugfs_gtt_pinned_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create gtt pinned bytes debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("3d_clusters", 0444, root, mdev, + &mwv207_debugfs_3d_clusters_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create 3d clusters debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("2d_clusters", 0444, root, mdev, + &mwv207_debugfs_2d_clusters_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create 2d clusters debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("fus_clusters", 0444, root, mdev, + &mwv207_debugfs_fus_clusters_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create fus clusters debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("num_dma", 0444, root, mdev, + &mwv207_debugfs_num_dma_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create num dma debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("num_dec", 0444, root, mdev, + &mwv207_debugfs_num_dec_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create num dec debugsfs file\n"); + return PTR_ERR(ent); + } + + ent = debugfs_create_file("num_enc", 0444, root, mdev, + &mwv207_debugfs_num_enc_fops); + if (IS_ERR(ent)) { + DRM_ERROR("unable to create num enc debugsfs file\n"); + return PTR_ERR(ent); + } + + return 0; +} + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_debugfs.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_debugfs.h new file mode 100644 index 0000000000000000000000000000000000000000..e40dbfdff7342f1061ed71ff7c51d529db039084 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_debugfs.h @@ -0,0 +1,32 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_DEBUGFS_H +#define MWV207_DEBUGFS_H + +#ifdef CONFIG_DEBUG_FS + +int mwv207_debugfs_init(struct mwv207_device *jdev); + +#else + +static inline int mwv207_debugfs_init(struct mwv207_device *jdev) +{ + return 0; +} + +#endif + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_devfreq.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_devfreq.c new file mode 100644 index 0000000000000000000000000000000000000000..46ba99e3c01759bede991153240cc85443a00532 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_devfreq.c @@ -0,0 +1,274 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include "mwv207_devfreq.h" +#include "mwv207_vbios.h" +#include "mwv207_sched.h" + +static void mwv207_devfreq_update_utilization(struct mwv207_pipe *pipe) +{ + ktime_t now; + ktime_t last; + + now = ktime_get(); + last = pipe->time_last_update; + + dev_dbg(pipe->dev, "pipe [%s] busy_count: %d", pipe->fname, pipe->busy_count); + + if (pipe->busy_count > 0) + pipe->busy_time += ktime_sub(now, last); + else + pipe->idle_time += ktime_sub(now, last); + + pipe->time_last_update = now; +} + +static int mwv207_devfreq_get_cur_freq(struct device *dev, unsigned long *freq) +{ + struct mwv207_pipe *pipe = dev_get_drvdata(dev); + unsigned int freq_khz; + int ret; + + ret = mwv207_vbios_get_pll(pipe->jdev, pipe->pll_id, &freq_khz); + if (ret) + *freq = 0x32; + else + *freq = freq_khz / 1000; + + return 0; +} + +static int mwv207_devfreq_target(struct device *dev, unsigned long *freq, u32 flags) +{ + struct mwv207_pipe *pipe = dev_get_drvdata(dev); + struct dev_pm_opp *opp; + unsigned long target_freq; + int ret; + + opp = devfreq_recommended_opp(dev, freq, flags); + if (IS_ERR(opp)) + return PTR_ERR(opp); + + target_freq = dev_pm_opp_get_freq(opp); + dev_pm_opp_put(opp); + + dev_dbg(dev, "pipe [%s] target freq: %lu", pipe->fname, target_freq); + + ret = mwv207_vbios_set_pll(pipe->jdev, pipe->pll_id, target_freq * 1000); + if (ret) + return ret; + + return 0; +} + +static void mwv207_devfreq_pipe_reset(struct mwv207_pipe *pipe) +{ + pipe->busy_time = 0; + pipe->idle_time = 0; + pipe->time_last_update = ktime_get(); +} + +static int mwv207_devfreq_get_dev_status(struct device *dev, struct devfreq_dev_status *status) +{ + struct mwv207_pipe *pipe = dev_get_drvdata(dev); + unsigned long flags; + + mwv207_devfreq_get_cur_freq(dev, &status->current_frequency); + + spin_lock_irqsave(&pipe->devfreq_lock, flags); + + mwv207_devfreq_update_utilization(pipe); + + status->total_time = ktime_to_ns(ktime_add(pipe->busy_time, + pipe->idle_time)); + + status->busy_time = ktime_to_ns(pipe->busy_time); + + mwv207_devfreq_pipe_reset(pipe); + + spin_unlock_irqrestore(&pipe->devfreq_lock, flags); + + return 0; +} + +static struct devfreq_dev_profile mwv207_devfreq_profile = { + .polling_ms = 50, + .target = mwv207_devfreq_target, + .get_dev_status = mwv207_devfreq_get_dev_status, + .get_cur_freq = mwv207_devfreq_get_cur_freq, +}; + +static ssize_t utilization_show(struct device *dev, struct device_attribute *attr, char *buf) +{ + struct mwv207_pipe *pipe = dev_get_drvdata(dev); + unsigned long busy_time, total_time, flags; + + spin_lock_irqsave(&pipe->devfreq_lock, flags); + + mwv207_devfreq_update_utilization(pipe); + + total_time = ktime_to_ns(ktime_add(pipe->busy_time, pipe->idle_time)); + + busy_time = ktime_to_ns(pipe->busy_time); + + spin_unlock_irqrestore(&pipe->devfreq_lock, flags); + + if (total_time == 0) + return sprintf(buf, "%d\n", 100); + else + return sprintf(buf, "%llu\n", div_u64(busy_time, total_time / 100)); +} + +static DEVICE_ATTR_RO(utilization); + +void mwv207_devfreq_unregister(struct mwv207_pipe *pipe) +{ + if (!pipe->devfreq) + return; + + device_remove_file(pipe->dev, &dev_attr_utilization); + sysfs_remove_link(&pipe->dev->kobj, "stats"); + dev_pm_opp_remove_all_dynamic(pipe->dev); + device_unregister(pipe->dev); +} + +static void mwv207_devfreq_dev_release(struct device *dev) +{ + kfree(dev); +} + +int mwv207_devfreq_register(struct mwv207_pipe *pipe, unsigned long max_freq) +{ + struct device *dev; + unsigned long freq; + int ret; + + dev = kzalloc(sizeof(struct device), GFP_KERNEL); + if (!dev) + return -ENOMEM; + + dev->parent = pipe->jdev->dev; + dev->release = mwv207_devfreq_dev_release; + dev_set_name(dev, "devfreq_%s", pipe->fname); + dev_set_drvdata(dev, pipe); + + ret = device_register(dev); + if (ret) { + put_device(dev); + goto err_out; + } + + pipe->dev = dev; + pipe->busy_count = 0; + spin_lock_init(&pipe->devfreq_lock); + + mwv207_devfreq_profile.initial_freq = max_freq; + + for (freq = 0x32; freq <= max_freq; freq += 50) { + ret = dev_pm_opp_add(dev, freq, 0); + if (ret) + goto remove_opps; + } + + pipe->devfreq = devm_devfreq_add_device(dev, &mwv207_devfreq_profile, + DEVFREQ_GOV_PERFORMANCE, NULL); + if (IS_ERR(pipe->devfreq)) { + ret = PTR_ERR(pipe->devfreq); + dev_dbg(dev, "Couldn't initialize devfreq: %d", ret); + goto remove_opps; + } + + mwv207_devfreq_pipe_reset(pipe); + + pipe->devfreq->suspend_freq = 0x32; + + ret = sysfs_create_link(&dev->kobj, &pipe->devfreq->dev.kobj, "stats"); + if (ret) { + dev_dbg(dev, "Couldn't create sys link for stats: %d", ret); + goto remove_opps; + } + + ret = device_create_file(dev, &dev_attr_utilization); + if (ret) { + dev_dbg(dev, "Couldn't create device file for utilization: %d", ret); + goto remove_link; + } + + return 0; + +remove_link: + sysfs_remove_link(&dev->kobj, "stats"); +remove_opps: + dev_pm_opp_remove_all_dynamic(dev); + device_unregister(dev); +err_out: + return ret; +} + +int mwv207_devfreq_resume(struct mwv207_pipe *pipe) +{ + unsigned long flags; + + if (!pipe->devfreq) + return 0; + + spin_lock_irqsave(&pipe->devfreq_lock, flags); + + mwv207_devfreq_pipe_reset(pipe); + + spin_unlock_irqrestore(&pipe->devfreq_lock, flags); + + return devfreq_resume_device(pipe->devfreq); +} + +int mwv207_devfreq_suspend(struct mwv207_pipe *pipe) +{ + if (!pipe->devfreq) + return 0; + + return devfreq_suspend_device(pipe->devfreq); +} + +void mwv207_devfreq_record_busy(struct mwv207_pipe *pipe) +{ + unsigned long flags; + + if (!pipe->devfreq) + return; + + spin_lock_irqsave(&pipe->devfreq_lock, flags); + + mwv207_devfreq_update_utilization(pipe); + pipe->busy_count++; + + spin_unlock_irqrestore(&pipe->devfreq_lock, flags); +} + +void mwv207_devfreq_record_idle(struct mwv207_pipe *pipe) +{ + unsigned long flags; + + if (!pipe->devfreq) + return; + + spin_lock_irqsave(&pipe->devfreq_lock, flags); + + mwv207_devfreq_update_utilization(pipe); + WARN_ON(--pipe->busy_count < 0); + + spin_unlock_irqrestore(&pipe->devfreq_lock, flags); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_devfreq.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_devfreq.h new file mode 100644 index 0000000000000000000000000000000000000000..5cabf1c3a39c22f6d2e00d82080b4100be2a2272 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_devfreq.h @@ -0,0 +1,31 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ + +#ifndef __MWV207_DEVFREQ_H__ +#define __MWV207_DEVFREQ_H__ + +struct mwv207_pipe; + +void mwv207_devfreq_unregister(struct mwv207_pipe *pipe); +int mwv207_devfreq_register(struct mwv207_pipe *pipe, unsigned long max_freq); + +void mwv207_devfreq_record_busy(struct mwv207_pipe *pipe); +void mwv207_devfreq_record_idle(struct mwv207_pipe *pipe); + +int mwv207_devfreq_suspend(struct mwv207_pipe *pipe); +int mwv207_devfreq_resume(struct mwv207_pipe *pipe); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_dma.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_dma.h new file mode 100644 index 0000000000000000000000000000000000000000..3fb3863c0668451f67a44d532caa1aa9f0f9a8aa --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_dma.h @@ -0,0 +1,29 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_EDMA_H_EPAWCJ4N +#define MWV207_EDMA_H_EPAWCJ4N +#include "mwv207_drv.h" + +struct mwv207_dma; +struct mwv207_dma *mwv207_dma_create(struct device *dev, + void __iomem *regbase, u8 alignment); +void mwv207_dma_destroy(struct mwv207_dma *dma); + +int mwv207_dma_to_vram(struct mwv207_dma *dma, u64 vram_addr, void *va, u64 size); +int mwv207_dma_to_ram(struct mwv207_dma *dma, void *va, u64 vram_addr, u64 size); +int mwv207_dma_vram_vram(struct mwv207_dma *dma, u64 dst_vram_addr, u64 src_vram_addr, u64 size); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_drm.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_drm.h new file mode 100644 index 0000000000000000000000000000000000000000..38f101b467a8abcbb1d58c357fa06b6bc80aa4cd --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_drm.h @@ -0,0 +1,146 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef __MWV207_DRM_H__ +#define __MWV207_DRM_H__ + +#include "drm/drm.h" + +#if defined(__cplusplus) +extern "C" { +#endif + +struct drm_mwv207_gem_create_in { + __u64 size; + __u64 alignment; + __u32 preferred_domain; + __u32 flags; +}; +struct drm_mwv207_gem_create_out { + __u32 handle; + __u32 resv; +}; +union drm_mwv207_gem_create { + struct drm_mwv207_gem_create_in in; + struct drm_mwv207_gem_create_out out; +}; + +struct drm_mwv207_gem_mmap_in { + __u32 handle; + __u32 pad; +}; +struct drm_mwv207_gem_mmap_out { + __u64 offset; +}; +union drm_mwv207_gem_mmap { + struct drm_mwv207_gem_mmap_in in; + struct drm_mwv207_gem_mmap_out out; +}; + +struct drm_mwv207_gem_wait { + __u32 handle; + __u32 op; + __s64 timeout; +}; + +struct drm_mwv207_ctx { + __u32 op; + __u32 flags; + __u32 handle; + __u32 resv; +}; + +struct drm_mwv207_submit { + __u32 ctx; + __u32 engine_type; + __u32 engine_id; + __u32 flags; + __u32 fence_fd; + __u32 cmd_size; + __u32 nr_relocs; + __u32 nr_bos; + __u32 nr_cmd_dat; + __u32 padding; + __u64 cmds; + __u64 relocs; + __u64 bos; + __u64 cmd_dats; +}; + +struct drm_mwv207_submit_syncobj { + __u32 handle; + __u32 flags; + __u64 point; +}; + +struct drm_mwv207_bo_acc { + __u32 handle; + __u32 flags; +}; + +struct drm_mwv207_submit_reloc { + __u32 idx; + __u32 cmd_offset; + __u64 bo_offset; + __u32 type; + __u32 pad; +}; + +struct drm_mwv207_submit_cmd_dat { + __u32 nr_relocs; + __u32 dat_size; + __u64 relocs; + __u64 dat; +}; + +enum drm_mwv207_info_key { + DRM_MWV207_ACTIVE_3D_NR = 0, + DRM_MWV207_ACTIVE_DEC_NR, + DRM_MWV207_ACTIVE_ENC_NR, + DRM_MWV207_ACTIVE_2D_NR, + DRM_MWV207_ACTIVE_DMA_NR, + + DRM_MWV207_ACTIVE_FUS_NR, + DRM_MWV207_3D_CLUSTER_NR, + DRM_MWV207_2D_CLUSTER_NR, + DRM_MWV207_FUS_CLUSTER_NR, + DRM_MWV207_VRAM_SIZE, + DRM_MWV207_GTT_SIZE, + DRM_MWV207_VISIBLE_VRAM_SIZE, + DRM_MWV207_FAMILY, +}; + +struct drm_mwv207_info_rec { + __u32 key; + __u32 val; +}; + +struct drm_mwv207_info { + __u32 op; + __u32 nr_recs; + __u64 recs; +}; + +#define DRM_IOCTL_MWV207_INFO DRM_IOWR(DRM_COMMAND_BASE + 0x0, struct drm_mwv207_info) +#define DRM_IOCTL_MWV207_GEM_CREATE DRM_IOWR(DRM_COMMAND_BASE + 0x1, union drm_mwv207_gem_create) +#define DRM_IOCTL_MWV207_GEM_MMAP DRM_IOWR(DRM_COMMAND_BASE + 0x2, union drm_mwv207_gem_mmap) +#define DRM_IOCTL_MWV207_GEM_WAIT DRM_IOWR(DRM_COMMAND_BASE + 0x3, struct drm_mwv207_gem_wait) +#define DRM_IOCTL_MWV207_CTX DRM_IOWR(DRM_COMMAND_BASE + 0x4, struct drm_mwv207_ctx) +#define DRM_IOCTL_MWV207_SUBMIT DRM_IOWR(DRM_COMMAND_BASE + 0x5, struct drm_mwv207_submit) +#if defined(__cplusplus) +} +#endif + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_drv.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_drv.c new file mode 100644 index 0000000000000000000000000000000000000000..0d498526a3d8880beb4803dce298bd4ba953fce4 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_drv.c @@ -0,0 +1,504 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "mwv207_gem.h" +#include "mwv207_bo.h" +#include "dc/mwv207_kms.h" +#include "dc/mwv207_vi.h" +#include "mwv207_ctx.h" +#include "mwv207_submit.h" +#include "mwv207_sched.h" +#include "mwv207_irq.h" +#include "mwv207_db.h" +#include "mwv207_vbios.h" +#include "mwv207_monitor.h" +#include "mwv207_info.h" + +static int selftest; +module_param(selftest, int, 0644); +MODULE_PARM_DESC(selftest, "run selftest when startup"); + +int isr_poll; +module_param(isr_poll, int, 0444); +MODULE_PARM_DESC(isr_poll, "choose polling over interrupt"); + +static int mwv207_driver_open(struct drm_device *dev, struct drm_file *file_priv) +{ + struct mwv207_fpriv *fpriv; + + fpriv = kzalloc(sizeof(struct mwv207_fpriv), GFP_KERNEL); + if (fpriv == NULL) + return -ENOMEM; + + mwv207_ctx_mgr_init(dev, &fpriv->ctx_mgr); + + file_priv->driver_priv = fpriv; + + return 0; +} + +static void mwv207_driver_postclose(struct drm_device *dev, + struct drm_file *file_priv) +{ + struct mwv207_fpriv *fpriv = to_fpriv(file_priv); + + mwv207_ctx_mgr_fini(dev, &fpriv->ctx_mgr); + kfree(fpriv); +} + +static const struct file_operations mwv207_driver_fops = { + .owner = THIS_MODULE, + .open = drm_open, + .mmap = drm_gem_mmap, + .unlocked_ioctl = drm_ioctl, +#ifdef CONFIG_COMPAT + .compat_ioctl = drm_compat_ioctl, +#endif + .poll = drm_poll, + .read = drm_read, + .llseek = no_llseek, + .release = drm_release, +}; + +static const struct drm_ioctl_desc mwv207_ioctls_drm[] = { + DRM_IOCTL_DEF_DRV(MWV207_INFO, mwv207_db_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), + DRM_IOCTL_DEF_DRV(MWV207_GEM_CREATE, mwv207_gem_create_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), + DRM_IOCTL_DEF_DRV(MWV207_GEM_MMAP, mwv207_gem_mmap_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), + DRM_IOCTL_DEF_DRV(MWV207_GEM_WAIT, mwv207_gem_wait_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), + DRM_IOCTL_DEF_DRV(MWV207_CTX, mwv207_ctx_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), + DRM_IOCTL_DEF_DRV(MWV207_SUBMIT, mwv207_submit_ioctl, DRM_AUTH|DRM_RENDER_ALLOW), +}; + +static struct drm_driver mwv207_drm_driver = { + .driver_features = DRIVER_MODESET | DRIVER_ATOMIC | DRIVER_GEM | DRIVER_RENDER, + .fops = &mwv207_driver_fops, + .open = mwv207_driver_open, + .postclose = mwv207_driver_postclose, + + .dumb_create = mwv207_gem_dumb_create, + .dumb_map_offset = drm_gem_dumb_map_offset, + + .prime_handle_to_fd = drm_gem_prime_handle_to_fd, + .prime_fd_to_handle = drm_gem_prime_fd_to_handle, + .gem_prime_import = drm_gem_prime_import, +#if defined(__arch64__) + .gem_prime_mmap = drm_gem_prime_mmap, +#endif + + .ioctls = mwv207_ioctls_drm, + .num_ioctls = ARRAY_SIZE(mwv207_ioctls_drm), + + .name = DRIVER_NAME, + .desc = DRIVER_DESC, + .date = DRIVER_DATE, + .major = DRIVER_MAJOR, + .minor = DRIVER_MINOR, +}; + +static inline void iatu_write(struct mwv207_device *jdev, int index, u32 offset, u32 value) +{ + u32 region_base = 0x10000 + index * 0x200; + writel(value, jdev->iatu + region_base + offset); +} + +static inline u32 iatu_read(struct mwv207_device *jdev, int index, u32 offset) +{ + u32 region_base = 0x10000 + index * 0x200; + return readl(jdev->iatu + region_base + offset); +} + +static void mwv207_win_slide(struct mwv207_device *jdev, int region, + u64 pci_win_base, u64 axi_win_base) +{ + iatu_write(jdev, region, 0x108, pci_win_base & 0xffffffff); + iatu_write(jdev, region, 0x10C, pci_win_base >> 32); + + iatu_write(jdev, region, 0x114, axi_win_base & 0xffffffff); + iatu_write(jdev, region, 0x118, axi_win_base >> 32); + + iatu_write(jdev, region, 0x110, + (pci_win_base + 0x10000 - 1) & 0xffffffff); + iatu_write(jdev, region, 0x100, 0x0); + iatu_write(jdev, region, 0x104, + 1 << 0x1F + | 0x0 << 0x1E + | 6 << 0x8); + + mb(); + if (iatu_read(jdev, region, 0x118) != (axi_win_base >> 32)) + pr_warn("mwv207: sliding window failed"); +} + +static int mwv207_iatu_map_bar(struct mwv207_device *jdev, int bar, u64 axi_addr) +{ + iatu_write(jdev, bar + 9, 0x114, axi_addr & 0xffffffff); + iatu_write(jdev, bar + 9, 0x118, axi_addr >> 32); + iatu_write(jdev, bar + 9, 0x100, 0x0); + iatu_write(jdev, bar + 9, 0x104, + 1 << 0x1F + | 0x1 << 0x1E + | bar << 0x8); + + mb(); + if (iatu_read(jdev, bar + 9, 0x114) != (axi_addr & 0xffffffff)) + return -ENODEV; + + return 0; +} + +static int mwv207_iatu_init(struct mwv207_device *jdev) +{ + int ret; + + ret = mwv207_iatu_map_bar(jdev, 0, 0x10000000); + if (ret) + return ret; + + ret = mwv207_iatu_map_bar(jdev, 1, 0x0); + if (ret) + return ret; + + ret = mwv207_iatu_map_bar(jdev, 2, 0x10000000); + if (ret) + return ret; + + spin_lock_init(&jdev->win_lock); + + jdev->pci_win_base = pci_bus_address(to_pci_dev(jdev->dev), 2) + + pci_resource_len(to_pci_dev(jdev->dev), 2) - 0x10000; + + mwv207_win_slide(jdev, 0, jdev->pci_win_base, 0x10000000); + + jdev->vram_last_win = 0; + + return 0; +} + +static void *mwv207_remap_region(struct mwv207_device *jdev, u64 vram_addr, u32 *len) +{ + u64 vram_win_base = (vram_addr & (~(0x10000 - 1))); + u64 winlimit = vram_win_base + 0x10000; + + if (vram_win_base != jdev->vram_last_win) { + mwv207_win_slide(jdev, 0, jdev->pci_win_base, vram_win_base + 0x10000000); + jdev->vram_last_win = vram_win_base; + } + + if (*len > winlimit - vram_addr) + *len = winlimit - vram_addr; + + return jdev->win + vram_addr - vram_win_base; +} + +void jdev_write_vram(struct mwv207_device *jdev, u64 vram_addr, void *buf, int size) +{ + int remain, len; + void *va; + + for (remain = size; remain > 0; remain -= len, buf += len, vram_addr += len) { + len = remain; + spin_lock(&jdev->win_lock); + va = mwv207_remap_region(jdev, vram_addr, &len); + if (!va || len <= 0) { + spin_unlock(&jdev->win_lock); + pr_warn("mwv207: write vram faild"); + return; + } + memcpy_toio(va, buf, len); + spin_unlock(&jdev->win_lock); + } +} + +static int mwv207_pci_probe(struct pci_dev *pdev, + const struct pci_device_id *ent) +{ + struct mwv207_device *jdev; + int ret; + + dev_info(&pdev->dev, "probe pci: %04x:%04x", pdev->vendor, pdev->device); + dev_info(&pdev->dev, "%s ", + DRIVER_DESC, DRIVER_VERSION, DRIVER_DATE); + + ret = drm_aperture_remove_conflicting_pci_framebuffers( + pdev, &mwv207_drm_driver); + if (ret) + return ret; + + pci_set_master(pdev); + ret = pcim_enable_device(pdev); + if (ret) + return ret; + + jdev = devm_drm_dev_alloc(&pdev->dev, &mwv207_drm_driver, + struct mwv207_device, base); +if (!jdev) + return -ENOMEM; + jdev->dev = &pdev->dev; + jdev->is_haps = pdev->vendor == 0x10ee; + jdev->isr_poll = !!isr_poll; + jdev->has_cfg = false; + + jdev->dev = &pdev->dev; + jdev->base.dev_private = jdev; + + jdev->mmio = devm_ioremap(jdev->dev, + pci_resource_start(pdev, 1), pci_resource_len(pdev, 1)); + if (!jdev->mmio) + return -ENOMEM; + + jdev->iatu = devm_ioremap(jdev->dev, + pci_resource_start(pdev, 4), pci_resource_len(pdev, 4)); + if (!jdev->iatu) + return -ENOMEM; + + jdev->win = devm_ioremap(jdev->dev, + pci_resource_end(pdev, 2) - 0x10000 + 1, 0x10000); + if (!jdev->win) + return -ENOMEM; + + ret = mwv207_iatu_init(jdev); + if (ret) + return ret; + + jdev->lite = jdev_read(jdev, 0x12c0000) == 0x21 ? false : true; + + pci_set_drvdata(pdev, jdev); + + ret = mwv207_db_init(jdev); + if (ret) + goto err_master; + + mwv207_vbios_init(jdev); + + ret = mwv207_hw_init(jdev); + if (ret) + goto err_db; + + ret = mwv207_irq_init(jdev); + if (ret) + goto err_monitor; + + jdev->visible_vram_size = pci_resource_len(pdev, 2) - 0x10000; + jdev->vram_size = jdev->hw.vram_size; + jdev->vram_bar_base = pci_resource_start(pdev, 2); + + ret = mwv207_ttm_init(jdev); + if (ret) + goto err_irq; + + ret = mwv207_monitor_init(jdev); + if (ret) + goto err_hw; + + ret = mwv207_sched_init(jdev); + if (ret) + goto err_ttm; + + ret = mwv207_kctx_init(jdev); + if (ret) + goto err_sched; + + ret = mwv207_kms_init(jdev); + if (ret) + goto err_kctx; + + ret = mwv207_info_init(jdev); + if (ret) + goto err_kms; + + if (selftest) { + ret = mwv207_test(jdev); + if (ret) + goto err_info; + } + + mwv207_db_sort(jdev); + ret = drm_dev_register(&jdev->base, 0); + if (ret) + goto err_kms; + + return 0; + +err_info: + mwv207_info_fini(jdev); +err_kms: + mwv207_kms_fini(jdev); +err_kctx: + mwv207_kctx_fini(jdev); +err_sched: + mwv207_sched_fini(jdev); +err_ttm: + mwv207_ttm_fini(jdev); +err_irq: + mwv207_irq_fini(jdev); +err_vbios: + mwv207_vbios_fini(jdev); +err_monitor: + mwv207_monitor_fini(jdev); +err_hw: + mwv207_hw_fini(jdev); +err_db: + mwv207_db_fini(jdev); +err_master: + pci_clear_master(pdev); + pci_set_drvdata(pdev, NULL); + pr_err("mwv207: failed to probe device, ret = %d", ret); + return ret; +} + +static void mwv207_pci_remove(struct pci_dev *pdev) +{ + struct mwv207_device *jdev = pci_get_drvdata(pdev); + + mwv207_fbdev_fini(jdev); + drm_dev_unregister(&jdev->base); + mwv207_info_fini(jdev); + mwv207_kctx_fini(jdev); + mwv207_sched_fini(jdev); + mwv207_kms_fini(jdev); + mwv207_monitor_fini(jdev); + mwv207_ttm_fini(jdev); + mwv207_irq_fini(jdev); + mwv207_vbios_fini(jdev); + mwv207_db_fini(jdev); + pci_clear_master(pdev); + pci_set_drvdata(pdev, NULL); +} + +static int mwv207_pmops_suspend(struct device *dev) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + struct pci_dev *pdev = to_pci_dev(dev); + struct ttm_resource_manager *man; + int ret; + + ret = mwv207_kms_suspend(jdev); + if (ret) + return ret; + + man = ttm_manager_type(&jdev->bdev, TTM_PL_VRAM); + ret = ttm_resource_manager_evict_all(&jdev->bdev, man); + if (ret) + return ret; + + mwv207_audio_suspend(jdev); + + ret = mwv207_sched_suspend(jdev); + if (ret) + goto fail; + + mwv207_irq_suspend(jdev); + + pci_save_state(pdev); + pci_disable_device(pdev); + pci_set_power_state(pdev, PCI_D3hot); + udelay(200); + return 0; +fail: + mwv207_kms_resume(jdev); + return ret; +} + +static int mwv207_pmops_resume(struct device *dev) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + struct pci_dev *pdev = to_pci_dev(dev); + int ret; + + msleep(100); + mwv207_audio_resume(jdev); + pci_set_power_state(pdev, PCI_D0); + pci_restore_state(pdev); + ret = pci_enable_device(pdev); + if (ret) { + pr_err("mwv207: failed to enable pci device"); + return ret; + } + pci_set_master(pdev); + + ret = mwv207_iatu_init(jdev); + if (ret) + return ret; + + mwv207_irq_resume(jdev); + + ret = mwv207_sched_resume(jdev); + if (ret) + return ret; + + return mwv207_kms_resume(jdev); +} + +static SIMPLE_DEV_PM_OPS(mwv207_pm_ops, mwv207_pmops_suspend, mwv207_pmops_resume); + +#define MWV207_PCI_DEVICE_DATA(vend, dev, data) \ + .vendor = vend, .device = dev, .driver_data = (kernel_ulong_t)(data), \ + .subvendor = PCI_ANY_ID, .subdevice = PCI_ANY_ID, \ + .class = 0, .class_mask = 0 + +static const struct pci_device_id pciidlist[] = { + {MWV207_PCI_DEVICE_DATA(0x0731, 0x9100, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x9200, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x920a, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x920b, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x920c, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x9210, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x9211, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x9230, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x9231, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x9250, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x930a, NULL)}, + {MWV207_PCI_DEVICE_DATA(0x0731, 0x930b, NULL)}, + {0}, +}; + +MODULE_DEVICE_TABLE(pci, pciidlist); +static struct pci_driver mwv207_pci_driver = { + .name = DRIVER_NAME, + .id_table = pciidlist, + .probe = mwv207_pci_probe, + .remove = mwv207_pci_remove, + .driver.pm = &mwv207_pm_ops, +}; + +static int __init mwv207_init(void) +{ + return pci_register_driver(&mwv207_pci_driver); +} + +static void __exit mwv207_exit(void) +{ + pci_unregister_driver(&mwv207_pci_driver); +} + +module_init(mwv207_init); +module_exit(mwv207_exit); +MODULE_LICENSE("GPL"); diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_drv.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_drv.h new file mode 100644 index 0000000000000000000000000000000000000000..e534bc903cec1da21af200800dc90276c36227f0 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_drv.h @@ -0,0 +1,189 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ + +#ifndef MWV207_DRV_H_VTIQLF2Y +#define MWV207_DRV_H_VTIQLF2Y + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "mwv207_drm.h" + +#define DRIVER_NAME "mwv207" +#define DRIVER_DESC "mwv207 gpu driver" +#define DRIVER_DATE "20250221" +#define DRIVER_MAJOR 0 +#define DRIVER_MINOR 1 + +#define DRIVER_VERSION __stringify(DRIVER_MAJOR) "." __stringify(DRIVER_MINOR) + +struct mwv207_db; + +struct mwv207_vbios { + + struct mutex vcmd_lock; + + struct mutex cfg_lock; + struct idr cfg_table; + + int indexer_valid; + int sector_count; +}; + +struct mwv207_fbdev { + struct drm_fb_helper helper; + struct drm_framebuffer fb; + struct mwv207_bo *jbo; +}; + +struct mwv207_hwinfo { + bool is_pf; + int vf_sel; + u64 vram_size; + u64 vram_offset; + u64 vram_bit_wide; + u32 vram_freq; + u32 vram_rate; + u8 *vram_type; + u64 pipe_3d_freq; + u64 pipe_2d_freq; + int core_temp; + int nr_3d_cluster; + int nr_2d_cluster; + int nr_fus_cluster; + u64 nr_stream_processor; + int nr_pipe[0x7]; + char vbios_ver[0x800]; +}; + +#define ddev_to_jdev(ddev) ((struct mwv207_device *) (ddev)->dev_private) +#define drm_to_jdev(dev) container_of(dev, struct mwv207_device, base) +#define bdev_to_jdev(dev) container_of(dev, struct mwv207_device, bdev) +struct mwv207_device { + struct drm_device base; + struct ttm_device bdev; + + void __iomem *mmio; + void __iomem *iatu; + + void *win; + + u64 ap_base; + u64 ap_size; + void __iomem *ap_vaddr; + u64 gtt_size; + + spinlock_t win_lock; + u64 visible_vram_size; + u64 vram_size; + u64 vram_bar_base; + u64 vram_last_win; + u64 pci_win_base; + + struct device *dev; + struct mwv207_fbdev *fbdev; + struct drm_fb_helper *fb_helper; + + struct mwv207_audio *audio; + + struct mwv207_hwinfo hw; + + struct drm_gpu_scheduler + *sched[0x5][0x2]; + int nr_pipe[0x5]; + + struct drm_sched_entity *dma_entity; + struct drm_sched_entity *blt_entity; + struct mutex qlock; + + spinlock_t irq_lock; + struct irq_domain *irq_domain; + u32 irq_enable_reg[0x2]; + int va_irq; + + u64 vram_pinned_bytes; + u64 gtt_pinned_bytes; + + atomic64_t moved_bytes; + atomic64_t vram_used_bytes; + atomic64_t gtt_used_bytes; + atomic64_t visible_vram_used_bytes; + + bool is_haps; + bool isr_poll; + bool has_cfg; + + struct mwv207_vbios vbios; + struct mwv207_monitor *monitor; + + struct dentry *debugfs_root; + + struct mwv207_db *db; + + struct mutex gpio_lock; + + bool lite; +}; + +struct mwv207_ctx_mgr { + struct mutex lock; + struct idr handle_table; +}; + +struct mwv207_fpriv { + struct mwv207_ctx_mgr ctx_mgr; +}; + +int mwv207_test(struct mwv207_device *jdev); +void jdev_write_vram(struct mwv207_device *jdev, u64 vram_addr, void *buf, int size); + +static inline void jdev_write(struct mwv207_device *jdev, u32 reg, u32 value) +{ + BUG_ON(reg <= 0x100000); + writel_relaxed(value, jdev->mmio + reg); +} + +static inline u32 jdev_read(struct mwv207_device *jdev, u32 reg) +{ + return readl(jdev->mmio + reg); +} + +static inline void jdev_modify(struct mwv207_device *jdev, u32 reg, u32 mask, u32 value) +{ + u32 rvalue = jdev_read(jdev, reg); + + rvalue = (rvalue & ~mask) | (value & mask); + jdev_write(jdev, reg, rvalue); + BUG_ON(reg <= 0x100000); +} + +#define to_fpriv(drm_file) ((drm_file)->driver_priv) + +int mwv207_hw_init(struct mwv207_device *jdev); +void mwv207_hw_fini(struct mwv207_device *jdev); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_gem.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_gem.c new file mode 100644 index 0000000000000000000000000000000000000000..38c8b2e4ad84222efc6f4a97d257cf49ae12e620 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_gem.c @@ -0,0 +1,367 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include "mwv207_drm.h" +#include "mwv207_gem.h" +#include "mwv207_bo.h" + +const struct drm_gem_object_funcs mwv207_gem_object_funcs; + +static vm_fault_t mwv207_gem_fault(struct vm_fault *vmf) +{ + struct ttm_buffer_object *bo = vmf->vma->vm_private_data; + vm_fault_t ret; + + ret = ttm_bo_vm_reserve(bo, vmf); + if (ret) + goto unlock_resv; + + ret = mwv207_bo_fault_reserve_notify(bo); + if (ret) + goto unlock_resv; + + ret = ttm_bo_vm_fault_reserved(vmf, vmf->vma->vm_page_prot, TTM_BO_VM_NUM_PREFAULT); + if (ret == VM_FAULT_RETRY && !(vmf->flags & FAULT_FLAG_RETRY_NOWAIT)) + return ret; + +unlock_resv: + dma_resv_unlock(bo->base.resv); + return ret; +} + +static const struct vm_operations_struct mwv207_ttm_vm_ops = { + .fault = mwv207_gem_fault, + .open = ttm_bo_vm_open, + .close = ttm_bo_vm_close, + .access = ttm_bo_vm_access +}; + +int mwv207_gem_prime_pin(struct drm_gem_object *gem) +{ + struct mwv207_bo *jbo = mwv207_bo_from_gem(gem); + int ret; + + ret = mwv207_bo_reserve(jbo, true); + if (ret) + return ret; + ret = mwv207_bo_pin_reserved(jbo, 0x2); + mwv207_bo_unreserve(jbo); + return ret; +} + +void mwv207_gem_prime_unpin(struct drm_gem_object *gem) +{ + struct mwv207_bo *jbo = mwv207_bo_from_gem(gem); + int ret; + + ret = mwv207_bo_reserve(jbo, true); + if (ret) + return; + ret = mwv207_bo_unpin_reserved(jbo); + mwv207_bo_unreserve(jbo); +} + +int mwv207_bo_vmap(struct mwv207_bo *jbo, struct iosys_map *map) +{ + int ret; + + if (jbo->kptr) { + jbo->map_count++; + goto out; + } + + ret = ttm_bo_vmap(&jbo->tbo, &jbo->map); + if (ret) { + return ret; + } + jbo->map_count = 1; + + if (jbo->map.is_iomem) + jbo->kptr = (void *)jbo->map.vaddr_iomem; + else + jbo->kptr = jbo->map.vaddr; + +out: + *map = jbo->map; + return 0; +} + +int mwv207_gem_prime_vmap(struct drm_gem_object *gem, struct iosys_map *map) +{ + struct mwv207_bo *jbo = mwv207_bo_from_gem(gem); + int ret; + + ret = mwv207_bo_reserve(jbo, false); + if (ret) + return ret; + + jbo->flags |= 0x1; + ret = mwv207_bo_pin_reserved(jbo, 0x2); + if (unlikely(ret)) { + drm_err(gem->dev, "pin %p for vmap failed\n", jbo); + goto unreserve_bo; + } + + ret = mwv207_bo_vmap(jbo, map); + if (ret) { + drm_err(gem->dev, "ttm bo vmap failed\n"); + goto unpin_bo; + } + + mwv207_bo_unreserve(jbo); + return ret; + +unpin_bo: + ttm_bo_unpin(&jbo->tbo); +unreserve_bo: + mwv207_bo_unreserve(jbo); + return ret; +} + +void mwv207_bo_vunmap(struct mwv207_bo *jbo) +{ + if (WARN_ON_ONCE(jbo->kptr == NULL)) + return; + jbo->map_count--; + if (jbo->map_count > 0) + return; + jbo->kptr = NULL; + ttm_bo_vunmap(&jbo->tbo, &jbo->map); +} + +void mwv207_gem_prime_vunmap(struct drm_gem_object *gem, struct iosys_map *map) +{ + struct mwv207_bo *jbo = mwv207_bo_from_gem(gem); + int ret; + + ret = mwv207_bo_reserve(jbo, false); + if (ret) + return; + + mwv207_bo_vunmap(jbo); + ttm_bo_unpin(&jbo->tbo); + mwv207_bo_unreserve(jbo); +} + +static int mwv207_gem_object_open(struct drm_gem_object *obj, + struct drm_file *file_priv) +{ + return 0; +} + +static void mwv207_gem_object_close(struct drm_gem_object *obj, + struct drm_file *file_priv) +{ +} + +static struct sg_table * +mwv207_gem_prime_get_sg_table(struct drm_gem_object *obj) +{ + struct mwv207_bo *jbo = mwv207_bo_from_gem(obj); + + return drm_prime_pages_to_sg(obj->dev, jbo->tbo.ttm->pages, + jbo->tbo.ttm->num_pages); +} + +struct drm_gem_object * +mwv207_gem_prime_import_sg_table(struct drm_device *dev, + struct dma_buf_attachment *attach, + struct sg_table *sg) +{ + struct dma_resv *resv = attach->dmabuf->resv; + struct mwv207_device *jdev = ddev_to_jdev(dev); + struct mwv207_bo *jbo; + int ret; + + dma_resv_lock(resv, NULL); + ret = mwv207_bo_create(jdev, attach->dmabuf->size, PAGE_SIZE, false, + 0x4, 0, sg, resv, &jbo); + dma_resv_unlock(resv); + if (ret) + return ERR_PTR(ret); + + jbo->tbo.base.funcs = &mwv207_gem_object_funcs; + + return &jbo->tbo.base; +} + +static void mwv207_gem_object_free(struct drm_gem_object *gobj) +{ + struct mwv207_bo *jbo = mwv207_bo_from_gem(gobj); + + mwv207_bo_unref(jbo); +} + +struct dma_buf *mwv207_gem_prime_export(struct drm_gem_object *gobj, + int flags) +{ + return drm_gem_prime_export(gobj, flags); +} + +const struct drm_gem_object_funcs mwv207_gem_object_funcs = { + .free = mwv207_gem_object_free, + .open = mwv207_gem_object_open, + .close = mwv207_gem_object_close, + .export = mwv207_gem_prime_export, + .pin = mwv207_gem_prime_pin, + .unpin = mwv207_gem_prime_unpin, + .get_sg_table = mwv207_gem_prime_get_sg_table, + .vmap = mwv207_gem_prime_vmap, + .vunmap = mwv207_gem_prime_vunmap, + .mmap = drm_gem_ttm_mmap, + .vm_ops = &mwv207_ttm_vm_ops, +}; + +static int mwv207_gem_create(struct mwv207_device *jdev, + u64 size, u64 align, u32 preferred_domain, + u32 flags, struct drm_gem_object **gobj) +{ + struct mwv207_bo *jbo; + int ret; + +retry: + + ret = mwv207_bo_create(jdev, size, align, false, preferred_domain, + flags, NULL, NULL, &jbo); + if (ret) { + if (ret != -ERESTARTSYS) { + if (flags & 0x1) { + flags &= ~0x1; + goto retry; + } + if (preferred_domain == 0x2) { + preferred_domain |= 0x1; + goto retry; + } + DRM_DEBUG("Failed to allocate GEM object (%lld, %d, %llu, %d)\n", + size, preferred_domain, align, ret); + } + return ret; + } + + jbo->tbo.base.funcs = &mwv207_gem_object_funcs; + + *gobj = mwv207_gem_from_bo(jbo); + return 0; +} + +int mwv207_gem_dumb_create(struct drm_file *file, struct drm_device *dev, + struct drm_mode_create_dumb *args) +{ + struct mwv207_device *jdev = ddev_to_jdev(dev); + struct drm_gem_object *gobj; + u32 handle; + int ret; + + args->pitch = ALIGN(args->width * DIV_ROUND_UP(args->bpp, 8), 64); + args->size = args->pitch * args->height; + ret = mwv207_gem_create(jdev, args->size, 0x10000, + 0x2, + 0x1, + &gobj); + if (ret) + return ret; + + ret = drm_gem_handle_create(file, gobj, &handle); + drm_gem_object_put(gobj); + if (ret) + return ret; + + args->handle = handle; + return 0; +} + +void mwv207_gem_free_object(struct drm_gem_object *gobj) +{ + struct mwv207_bo *jbo; + + if (!gobj) + return; + + jbo = mwv207_bo_from_gem(gobj); + mwv207_bo_unref(jbo); +} + +int mwv207_gem_create_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + struct mwv207_device *jdev = ddev_to_jdev(dev); + union drm_mwv207_gem_create *args = data; + struct drm_gem_object *gobj; + int ret; + + if (args->in.size == 0) + return -EINVAL; + if (args->in.alignment & (args->in.alignment - 1)) + return -EINVAL; + if (args->in.preferred_domain & ~0x7) + return -EINVAL; + if (args->in.flags & ~0x7) + return -EINVAL; + + ret = mwv207_gem_create(jdev, args->in.size, args->in.alignment, + args->in.preferred_domain, + args->in.flags, &gobj); + if (ret) + return ret; + + ret = drm_gem_handle_create(filp, gobj, &args->out.handle); + drm_gem_object_put(gobj); + + return ret; +} + +int mwv207_gem_mmap_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + union drm_mwv207_gem_mmap *args = data; + struct drm_gem_object *obj; + + if (args->in.pad) + return -EINVAL; + + obj = drm_gem_object_lookup(filp, args->in.handle); + if (!obj) + return -ENOENT; + args->out.offset = mwv207_bo_mmap_offset(obj); + drm_gem_object_put(obj); + + return 0; +} + +int mwv207_gem_wait_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + struct drm_mwv207_gem_wait *args = (struct drm_mwv207_gem_wait *)data; + long timeout; + bool write; + int ret; + + if (args->op & ~(0x2 | 0x1)) + return -EINVAL; + + write = args->op & 0x2; + timeout = drm_timeout_abs_to_jiffies(args->timeout); + + ret = drm_gem_dma_resv_wait(filp, args->handle, write, timeout); + if (ret == -ETIME) + ret = timeout ? -ETIMEDOUT : -EBUSY; + + return ret; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_gem.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_gem.h new file mode 100644 index 0000000000000000000000000000000000000000..1cf05e2a3e2f37264c0a3862ec88fd99d5b86e9d --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_gem.h @@ -0,0 +1,37 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_GEM_H_TJTW9M4R +#define MWV207_GEM_H_TJTW9M4R +#include +#include +#include +#include "mwv207_drv.h" + +int mwv207_gem_dumb_create(struct drm_file *file, struct drm_device *dev, + struct drm_mode_create_dumb *args); + +void mwv207_gem_free_object(struct drm_gem_object *obj); + +int mwv207_gem_create_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +int mwv207_gem_mmap_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +int mwv207_gem_wait_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_hw.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_hw.c new file mode 100644 index 0000000000000000000000000000000000000000..8f992c3a4178b1469e80d807ddaf57bf0f148c16 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_hw.c @@ -0,0 +1,174 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include + +#include "mwv207_drv.h" +#include "mwv207_irq.h" +#include "mwv207_vbios.h" +#include "mwv207_db.h" + +static inline u32 hwinfo_read(struct mwv207_device *jdev, u32 reg) +{ + u32 regbase = jdev->hw.is_pf ? 0x25FC00 : 0xF000; + return jdev_read(jdev, regbase + reg); +} + +static u64 mwv207_vram_size(struct mwv207_device *jdev) +{ + int nr = 0; + u64 size; + + switch (jdev_read(jdev, 0x9B0190) & 0x7) { + case 0: + size = 2048; + break; + case 1: + size = 1024; + break; + case 2: + size = 4096; + break; + case 3: + size = 8192; + break; + default: + pr_warn("mwv207: ddr size default to 256MB"); + return 256UL * 1024 * 1024; + } + + if (jdev->lite) { + nr += jdev_read(jdev, 0xd101bc) & 0x1; + nr += jdev_read(jdev, 0xd11cbc) & 0x1; + } else { + nr += (jdev_read(jdev, 0x9702f4) & 0x02000000) ? 1 : 0; + nr += (jdev_read(jdev, 0x9802f4) & 0x02000000) ? 1 : 0; + } + if (!nr) { + nr = 1; + pr_warn("mwv207: ddr cnt default to 1"); + } + + return size * 1024 * 1024 * nr; +} + +static void mwv207_hwinfo_parse(struct mwv207_device *jdev) +{ + struct mwv207_hwinfo *hw = &jdev->hw; + u32 val; + + val = jdev_read(jdev,0xD10000); + hw->vram_type = (val & 0x20) ? "LPDDR4" : "DDR4"; + + hw->vram_size = mwv207_vram_size(jdev); + BUG_ON(!hw->vram_size); + + val = hwinfo_read(jdev, 0x4); + hw->nr_3d_cluster = val & 0x1f; + hw->nr_2d_cluster = (val >> 5) & 0x1f; + hw->nr_fus_cluster = (val >> 10) & 0x1f; + + hw->nr_stream_processor = 256; + hw->vram_bit_wide = 64; + + hw->nr_pipe[0x0] = 0x2; + hw->nr_pipe[0x3] = 0x1; + hw->nr_pipe[0x4] = 0x1; + hw->nr_pipe[0x1] = 0x2; + hw->nr_pipe[0x2] = 0x1; + + hw->vf_sel = hwinfo_read(jdev, 0x8) & 0xf; + hw->vram_offset = hwinfo_read(jdev, 0xC); + hw->vram_offset <<= 20; + + WARN(!hw->nr_pipe[0x0], "no 3d engine!"); + WARN(!hw->nr_pipe[0x3], "no 2d engine!"); + WARN(!hw->nr_pipe[0x4], "no dma engine!"); + + dev_info(jdev->dev, "running on %s", hw->is_pf ? "pf" : "vf"); + dev_info(jdev->dev, "3d cluster: %d", hw->nr_3d_cluster); + dev_info(jdev->dev, "2d cluster: %d", hw->nr_2d_cluster); + dev_info(jdev->dev, "fus cluster: %d", hw->nr_fus_cluster); + dev_info(jdev->dev, "dma engine: %d", hw->nr_pipe[0x4]); + dev_info(jdev->dev, "decoder: %d", hw->nr_pipe[0x1]); + dev_info(jdev->dev, "encoder: %d", hw->nr_pipe[0x2]); +} + +int mwv207_hw_init(struct mwv207_device *jdev) +{ + struct pci_dev *pdev = to_pci_dev(jdev->dev); + resource_size_t size; + + if (!jdev->mmio) { + dev_err(jdev->dev, "failed to map mmio"); + return -ENOMEM; + } + + size = pci_resource_len(pdev, 0x1); + jdev->hw.is_pf = size != SZ_2M; + + if (jdev->is_haps && !jdev->hw.is_pf && !jdev->isr_poll) { + pr_warn("warning, haps100 no irq, enable isr_poll"); + jdev->isr_poll = true; + } + + if (jdev->is_haps && jdev->hw.is_pf && !jdev->isr_poll) + pr_warn("warning, running on haps's pf with irq enabled"); + + jdev->gtt_size = SZ_2G; + jdev->ap_base = pci_resource_start(pdev, 0x0); + jdev->ap_size = pci_resource_len(pdev, 0x0); + if (!jdev->ap_base || !jdev->ap_size) { + dev_err(jdev->dev, "error, pci <%04x:%04x> bar%d no resource!", + pdev->vendor, pdev->device, 0x0); + return -ENODEV; + } + + mwv207_hwinfo_parse(jdev); + + jdev->visible_vram_size = min(jdev->hw.vram_size, jdev->ap_size); + + dev_info(jdev->dev, "%lluM VRAM, %lluM aperture, %lluM visible VRAM", + jdev->hw.vram_size >> 20, + jdev->ap_size >> 20, + jdev->visible_vram_size >> 20); + + jdev->ap_vaddr = devm_ioremap_wc(jdev->dev, jdev->ap_base, + jdev->visible_vram_size); + if (!jdev->ap_vaddr) { + dev_err(jdev->dev, "failed to mmap aperture vram"); + return -ENOMEM; + } + + mwv207_db_add(jdev, DRM_MWV207_3D_CLUSTER_NR, jdev->hw.nr_3d_cluster); + mwv207_db_add(jdev, DRM_MWV207_2D_CLUSTER_NR, jdev->hw.nr_2d_cluster); + mwv207_db_add(jdev, DRM_MWV207_FUS_CLUSTER_NR, + jdev->hw.nr_fus_cluster); + mwv207_db_add(jdev, DRM_MWV207_VRAM_SIZE, jdev->hw.vram_size); + mwv207_db_add(jdev, DRM_MWV207_GTT_SIZE, jdev->gtt_size); + mwv207_db_add(jdev, DRM_MWV207_VISIBLE_VRAM_SIZE, + jdev->visible_vram_size); + mwv207_db_add(jdev, DRM_MWV207_FAMILY, 0x1100); + + return 0; +} + +void mwv207_hw_fini(struct mwv207_device *jdev) +{ + mwv207_irq_fini(jdev); + if (jdev->hw.is_pf) + mwv207_vbios_fini(jdev); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_info.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_info.c new file mode 100644 index 0000000000000000000000000000000000000000..9f955ee00c973fec2a2ff90ef7e6d4419f601d54 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_info.c @@ -0,0 +1,355 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_drv.h" +#include "mwv207_info.h" +#include "mwv207_debugfs.h" +#include "mwv207_sched.h" +#include "mwv207_vbios.h" + +static ssize_t temperature_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + + struct mwv207_device *jdev = dev_get_drvdata(dev); + s16 temp = jdev_read(jdev,0x9B0150); + return sprintf(buf, "%u\n", (u32)temp); +} +static DEVICE_ATTR_RO(temperature); + +static ssize_t vram_type_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + return sprintf(buf, "%s\n", jdev->hw.vram_type); +} +static DEVICE_ATTR_RO(vram_type); + +static ssize_t nr_stream_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", jdev->hw.nr_stream_processor); +} +static DEVICE_ATTR_RO(nr_stream); + +static ssize_t vram_rate_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + u32 freq =0; + u32 rate =0; + + mwv207_vbios_get_vram_pll(jdev,&freq,&rate); + jdev->hw.vram_rate = rate; + jdev->hw.vram_freq = freq; + + return sprintf(buf, "%u\n", jdev->hw.vram_rate); +} +static DEVICE_ATTR_RO(vram_rate); + +static ssize_t vram_freq_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + u32 freq =0; + u32 rate =0; + + mwv207_vbios_get_vram_pll(jdev,&freq,&rate); + jdev->hw.vram_rate = rate; + jdev->hw.vram_freq = freq; + + return sprintf(buf, "%u\n", jdev->hw.vram_freq); +} +static DEVICE_ATTR_RO(vram_freq); + +static ssize_t vram_bit_wide_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", jdev->hw.vram_bit_wide); +} +static DEVICE_ATTR_RO(vram_bit_wide); + +static ssize_t fb_memory_total_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", jdev->hw.vram_size); +} +static DEVICE_ATTR_RO(fb_memory_total); + +static ssize_t fb_memory_used_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", atomic64_read(&jdev->vram_used_bytes)); +} +static DEVICE_ATTR_RO(fb_memory_used); + +static ssize_t bar_memory_total_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", jdev->visible_vram_size); +} +static DEVICE_ATTR_RO(bar_memory_total); + +static ssize_t bar_memory_used_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", + atomic64_read(&jdev->visible_vram_used_bytes)); +} +static DEVICE_ATTR_RO(bar_memory_used); + +static ssize_t gtt_memory_total_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", jdev->gtt_size); +} +static DEVICE_ATTR_RO(gtt_memory_total); + +static ssize_t gtt_memory_used_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", atomic64_read(&jdev->gtt_used_bytes)); +} +static DEVICE_ATTR_RO(gtt_memory_used); + +static ssize_t fb_memory_pinned_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", jdev->vram_pinned_bytes); +} +static DEVICE_ATTR_RO(fb_memory_pinned); + +static ssize_t gtt_memory_pinned_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", jdev->gtt_pinned_bytes); +} +static DEVICE_ATTR_RO(gtt_memory_pinned); + +static ssize_t memory_moved_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + + return sprintf(buf, "%llu\n", atomic64_read(&jdev->moved_bytes)); +} +static DEVICE_ATTR_RO(memory_moved); + +static ssize_t usage_2d_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + u32 usage = mwv207_pipe_get_usage(jdev, 0x3, 0); + + return sprintf(buf, "%d\n", usage); +} +static DEVICE_ATTR_RO(usage_2d); + +static ssize_t usage_3d_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + u32 usage = mwv207_pipe_get_usage(jdev, 0x0, 0); + + return sprintf(buf, "%d\n", usage); +} +static DEVICE_ATTR_RO(usage_3d); + +static ssize_t usage_enc0_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + u32 usage = mwv207_pipe_get_usage(jdev, 0x2, 0); + + return sprintf(buf, "%d\n", usage); +} +static DEVICE_ATTR_RO(usage_enc0); + +static ssize_t usage_dec0_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + u32 usage = mwv207_pipe_get_usage(jdev, 0x1, 0); + + return sprintf(buf, "%d\n", usage); +} +static DEVICE_ATTR_RO(usage_dec0); + +static ssize_t usage_enc1_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + u32 usage = mwv207_pipe_get_usage(jdev, 0x2, 1); + + return sprintf(buf, "%d\n", usage); +} +static DEVICE_ATTR_RO(usage_enc1); + +static ssize_t usage_dec1_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + u32 usage = mwv207_pipe_get_usage(jdev, 0x1, 1); + + return sprintf(buf, "%d\n", usage); +} +static DEVICE_ATTR_RO(usage_dec1); + +static ssize_t vbios_version_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + const struct mwv207_vdat *dat; + const char *ver; + dat = mwv207_vbios_vdat(jdev, 0x1FF0); + ver = (const char *)dat->dat; + + return sprintf(buf, "%s\n", ver? ver: "Unknown"); +} +static DEVICE_ATTR_RO(vbios_version); + +static ssize_t fan_speed_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + + return sprintf(buf, "%u\n", 0x1234u); +} +static DEVICE_ATTR_RO(fan_speed); + +static ssize_t power_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + + return sprintf(buf, "%u\n", 0xffffffffu); +} +static DEVICE_ATTR_RO(power); + +static ssize_t voltage_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct mwv207_device *jdev = dev_get_drvdata(dev); + u32 volt= jdev_read(jdev,0x9B0154); + + return sprintf(buf, "%u mv\n", volt); +} +static DEVICE_ATTR_RO(voltage); + +static struct attribute *mwv207_attrs[] = { + &dev_attr_vram_type.attr, + &dev_attr_vram_bit_wide.attr, + &dev_attr_vram_freq.attr, + &dev_attr_vram_rate.attr, + &dev_attr_fb_memory_total.attr, + &dev_attr_fb_memory_used.attr, + &dev_attr_nr_stream.attr, + &dev_attr_temperature.attr, + &dev_attr_bar_memory_total.attr, + &dev_attr_bar_memory_used.attr, + &dev_attr_usage_2d.attr, + &dev_attr_usage_3d.attr, + &dev_attr_usage_enc0.attr, + &dev_attr_usage_dec0.attr, + &dev_attr_usage_enc1.attr, + &dev_attr_usage_dec1.attr, + &dev_attr_vbios_version.attr, + &dev_attr_fan_speed.attr, + &dev_attr_power.attr, + &dev_attr_voltage.attr, + &dev_attr_gtt_memory_total.attr, + &dev_attr_gtt_memory_used.attr, + &dev_attr_fb_memory_pinned.attr, + &dev_attr_gtt_memory_pinned.attr, + &dev_attr_memory_moved.attr, + NULL, +}; + +static const struct attribute_group mwv207_group = { + .name = "mwv207_hwmon", + .attrs = mwv207_attrs, +}; + +static const struct attribute_group *mwv207_groups[] = { + &mwv207_group, + NULL, +}; + +int mwv207_info_init(struct mwv207_device *jdev) +{ + int ret; + + ret = sysfs_create_groups(&jdev->dev->kobj, mwv207_groups); + if (ret) { + dev_err(jdev->dev, "failed to create sysfs groups"); + return ret; + } + + ret = mwv207_debugfs_init(jdev); + if (ret) + dev_info(jdev->dev, "create debugfs files failed(%d)", ret); + + return 0; +} + +void mwv207_info_fini(struct mwv207_device *jdev) +{ + sysfs_remove_groups(&jdev->dev->kobj, mwv207_groups); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_info.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_info.h new file mode 100644 index 0000000000000000000000000000000000000000..2fcd96df1e77f64f511fc87e49142d8f1e245715 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_info.h @@ -0,0 +1,22 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_INFO_H +#define MWV207_INFO_H + +int mwv207_info_init(struct mwv207_device *jdev); +void mwv207_info_fini(struct mwv207_device *jdev); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_irq.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_irq.c new file mode 100644 index 0000000000000000000000000000000000000000..15e21e8aaebf1403d1e657903262765322149a89 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_irq.c @@ -0,0 +1,189 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include "mwv207_drv.h" +#include "mwv207_irq.h" + +static irqreturn_t mwv207_isr(int irq_unused, void *dev_id) +{ + struct mwv207_device *jdev = dev_id; + int i, j, hwirq, virq, ret = IRQ_NONE; + u32 stat; + + for (i = 0; i < 0x2; ++i) { + stat = jdev_read(jdev, 0x9A802C + i * 4); + stat &= jdev->irq_enable_reg[i]; + while ((j = ffs(stat))) { + j--; + hwirq = i * 32 + j; + virq = irq_find_mapping(jdev->irq_domain, hwirq); + if (virq) { + ret = generic_handle_irq(virq); + if (ret < 0) + pr_warn("mwv207: hwirq(%d) handled with %d", hwirq, ret); + } else + pr_warn("mwv207: no irq mapping set on %d", hwirq); + + jdev_write(jdev, 0x9A802C + i * 4, (1UL << j)); + stat &= ~(1UL << j); + ret = IRQ_HANDLED; + } + } + + return ret; +} + +static void mwv207_irq_mask(struct irq_data *d) +{ + struct mwv207_device *jdev = irq_data_get_irq_chip_data(d); + int irq = irqd_to_hwirq(d); + unsigned long flags; + u32 reg; + + reg = 0x9A8020 + (irq / 32) * 4; + + spin_lock_irqsave(&jdev->irq_lock, flags); + jdev_modify(jdev, reg, 1 << (irq % 32), 0); + jdev->irq_enable_reg[irq / 32] = jdev_read(jdev, reg); + spin_unlock_irqrestore(&jdev->irq_lock, flags); +} + +static void mwv207_irq_unmask(struct irq_data *d) +{ + struct mwv207_device *jdev = irq_data_get_irq_chip_data(d); + int irq = irqd_to_hwirq(d); + unsigned long flags; + u32 reg; + + reg = 0x9A8020 + (irq / 32) * 4; + + spin_lock_irqsave(&jdev->irq_lock, flags); + jdev_modify(jdev, reg, 1 << (irq % 32), 1 << (irq % 32)); + jdev->irq_enable_reg[irq / 32] = jdev_read(jdev, reg); + spin_unlock_irqrestore(&jdev->irq_lock, flags); +} + +void mwv207_irq_suspend(struct mwv207_device *jdev) +{ + int i; + + for (i = 0; i < 0x2; ++i) + jdev->irq_enable_reg[i] = jdev_read(jdev, + 0x9A8020 + i * 4); +} + +void mwv207_irq_resume(struct mwv207_device *jdev) +{ + int i; + + for (i = 0; i < 0x2; ++i) { + jdev_write(jdev, 0x9A802C + i * 4, 0xffffffff); + jdev_write(jdev, 0x9A8020 + i * 4, + jdev->irq_enable_reg[i]); + } +} + +static struct irq_chip mwv207_irq_chip = { + .name = "mwv207", + .irq_mask = mwv207_irq_mask, + .irq_unmask = mwv207_irq_unmask, +}; + +static int mwv207_irq_domain_map(struct irq_domain *d, unsigned int irq, + irq_hw_number_t hwirq) +{ + struct mwv207_device *jdev = d->host_data; + + if (hwirq >= 0x40) + return -EPERM; + + irq_set_chip_and_handler(irq, &mwv207_irq_chip, handle_simple_irq); + irq_set_chip_data(irq, jdev); + + return 0; +} + +static const struct irq_domain_ops mwv207_irq_domain_ops = { + .map = mwv207_irq_domain_map, +}; + +int mwv207_irq_init(struct mwv207_device *jdev) +{ + struct pci_dev *pdev = to_pci_dev(jdev->dev); + int ret, i; + + for (i = 0; i < 0x2; ++i) { + jdev_write(jdev, 0x9A802C + i * 4, 0xffffffff); + jdev_write(jdev, 0x9A8020 + i * 4, 0); + } + + spin_lock_init(&jdev->irq_lock); + + jdev->irq_domain = irq_domain_add_linear(NULL, 0x40, + &mwv207_irq_domain_ops, jdev); + if (!jdev->irq_domain) + return -ENODEV; + + for (i = 0; i < 0x40; ++i) + irq_create_mapping(jdev->irq_domain, i); + + ret = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_MSI | PCI_IRQ_LEGACY); + if (ret < 1) { + ret = -ENODEV; + goto free_mapping; + } + + ret = request_irq(pdev->irq, mwv207_isr, IRQF_SHARED, "mwv207_isr", jdev); + if (ret) + goto free_vec; + + return 0; + +free_vec: + pci_free_irq_vectors(pdev); +free_mapping: + for (i = 0; i < 0x40; ++i) { + int irq = irq_find_mapping(jdev->irq_domain, i); + + irq_dispose_mapping(irq); + } + + irq_domain_remove(jdev->irq_domain); + + return ret; +} + +void mwv207_irq_fini(struct mwv207_device *jdev) +{ + struct pci_dev *pdev = to_pci_dev(jdev->dev); + int i; + + free_irq(pdev->irq, jdev); + pci_free_irq_vectors(pdev); + + for (i = 0; i < 0x40; ++i) { + int irq = irq_find_mapping(jdev->irq_domain, i); + + if (irq){ + irq_dispose_mapping(irq); + } + } + + irq_domain_remove(jdev->irq_domain); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_irq.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_irq.h new file mode 100644 index 0000000000000000000000000000000000000000..eabcc61e62c479c5d865f3b251de76e2ef592b95 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_irq.h @@ -0,0 +1,26 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_IRQ_H_Z8YGVNB2 +#define MWV207_IRQ_H_Z8YGVNB2 + +struct mwv207_device; + +int mwv207_irq_init(struct mwv207_device *jdev); +void mwv207_irq_fini(struct mwv207_device *jdev); + +void mwv207_irq_suspend(struct mwv207_device *jdev); +void mwv207_irq_resume(struct mwv207_device *jdev); +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_monitor.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_monitor.c new file mode 100644 index 0000000000000000000000000000000000000000..17599684e0fb2c774d5988d4458c9f9fc456516b --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_monitor.c @@ -0,0 +1,145 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include "mwv207_monitor.h" +#include "mwv207_drv.h" +#include "mwv207_bo.h" + +#define EMPTY_INFO 0xffffffffu + +static int monitor_hb_period = 4000; +module_param(monitor_hb_period, int, 0444); +MODULE_PARM_DESC(monitor_hb_period, "heartbeat period, default 4000ms"); + +struct mwv207_monitor { + struct mwv207_bo *bo; + u64 gpu_addr; + u32 *vaddr; + struct delayed_work hb_work; + int hb_period; + u32 heartbeat; + bool inited; +}; + +static inline void monitor_update(struct mwv207_monitor *m, int idx, u32 val) { + WRITE_ONCE(m->vaddr[idx], val); +} + +static inline void monitor_get(struct mwv207_monitor *m, int idx, u32 *val) { + *val = READ_ONCE(m->vaddr[idx]); +} + +void mwv207_monitor_update_pipe_usage(struct mwv207_device *jdev, u8 pipe_type, + u8 pipe_id, u32 usage) { + struct mwv207_monitor *m = jdev->monitor; + int idx; + + if (unlikely((!m || !m->inited))) return; + + BUG_ON(pipe_type >= 0x5); + BUG_ON(pipe_id >= 0x2); + BUG_ON(pipe_id >= jdev->nr_pipe[pipe_type]); + + switch (pipe_type) { + case 0x0: + idx = 0x19; + break; + case 0x3: + idx = 0x18; + break; + case 0x2: + idx = 0x1A + pipe_id; + break; + case 0x1: + idx = 0x1B + pipe_id; + break; + default: + return; + } + + monitor_update(m, idx, usage); +} + +void mwv207_monitor_update_vram_used(struct mwv207_device *jdev) { + struct mwv207_monitor *m = jdev->monitor; + + if (unlikely((!m || !m->inited))) return; + + monitor_update(m, 0x8, + (u32)(atomic64_read(&jdev->vram_used_bytes) >> 10)); + monitor_update(m, 0x9, + (u32)(atomic64_read(&jdev->visible_vram_used_bytes) >> 10)); +} + +static void mwv207_monitor_info_init(struct mwv207_monitor *m) { + u32 version = 1 << 24 | DRIVER_MAJOR << 16 | DRIVER_MINOR << 8; + + monitor_update(m, 0x0, 0); + monitor_update(m, 0x1, version); + monitor_update(m, 0x18, EMPTY_INFO); + monitor_update(m, 0x19, EMPTY_INFO); + monitor_update(m, 0x1A, EMPTY_INFO); + monitor_update(m, 0x1B, EMPTY_INFO); + monitor_update(m, 0x1C, EMPTY_INFO); + monitor_update(m, 0x1D, EMPTY_INFO); +} + +static void monitor_hb_work(struct work_struct *work) { + struct mwv207_monitor *m = + container_of(to_delayed_work(work), struct mwv207_monitor, hb_work); + + monitor_update(m, 0x0, ++m->heartbeat); + schedule_delayed_work(&m->hb_work, msecs_to_jiffies(m->hb_period)); +} + +int mwv207_monitor_init(struct mwv207_device *jdev) { + struct mwv207_monitor *m; + int ret; + + m = devm_kzalloc(jdev->dev, sizeof(*m), GFP_KERNEL); + if (!m) return -ENOMEM; + jdev->monitor = m; + + ret = mwv207_bo_create_pin_mapped(jdev, SZ_4K, SZ_4K, 0x2, + 0x1, &m->bo, + &m->gpu_addr, (void **)&m->vaddr); + if (ret) { + pr_err("failed to allocate monitor bo"); + return ret; + } + m->inited = true; + + BUG_ON(m->gpu_addr != 0); + + mwv207_monitor_info_init(m); + + if (monitor_hb_period < 100) monitor_hb_period = 100; + if (monitor_hb_period > 7000) monitor_hb_period = 7000; + + m->hb_period = monitor_hb_period; + + INIT_DELAYED_WORK(&m->hb_work, monitor_hb_work); + + schedule_delayed_work(&m->hb_work, msecs_to_jiffies(m->hb_period)); + + return 0; +} + +void mwv207_monitor_fini(struct mwv207_device *jdev) { + cancel_delayed_work_sync(&jdev->monitor->hb_work); + jdev->monitor->inited = false; + mwv207_bo_destroy_pin_mapped(jdev->monitor->bo); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_monitor.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_monitor.h new file mode 100644 index 0000000000000000000000000000000000000000..1241f5c69727a1b6b359243893cd572cc1b7d290 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_monitor.h @@ -0,0 +1,29 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef mwv207_MONITOR_H_ZM8DG5W6 +#define mwv207_MONITOR_H_ZM8DG5W6 + +#include + +struct mwv207_device; +int mwv207_monitor_init(struct mwv207_device *jdev); +void mwv207_monitor_fini(struct mwv207_device *jdev); + +void mwv207_monitor_update_pipe_usage(struct mwv207_device *jdev, + u8 pipe_type, u8 pipe_id, u32 usage); +void mwv207_monitor_update_vram_used(struct mwv207_device *jdev); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_2d.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_2d.c new file mode 100644 index 0000000000000000000000000000000000000000..6db2e6e5afb02eb0567ad33d01bc97b9294c3d56 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_2d.c @@ -0,0 +1,555 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include + +#include "mwv207_bo.h" +#include "mwv207_sched.h" +#include "mwv207_vbios.h" +#include "mwv207_devfreq.h" + +#define wait_for(COND, MS) ({ \ + unsigned long timeout__ = jiffies + msecs_to_jiffies(MS) + 1; \ + int ret__ = 0; \ + while (!(COND)) { \ + if (time_after(jiffies, timeout__)) { \ + if (!(COND)) \ + ret__ = -ETIMEDOUT; \ + break; \ + } \ + msleep(1); \ + } \ + ret__; \ +}) + +struct mwv207_pipe_2d { + struct mwv207_pipe base; + struct mwv207_bo *ring_bo; + struct mwv207_device *jdev; + u32 *ring_start; + u32 *ring_end; + u32 *head; + u32 *tail; + u32 *last_wait; + u64 ring_start_addr; + int id; + unsigned int irq; + + u64 fence_ctx; + u32 next_fence; + u32 completed_fence; + spinlock_t fence_lock; + spinlock_t fence_queue_lock; + struct list_head fence_queue; +}; + +struct pipe_2d_fence { + struct dma_fence base; + struct mwv207_pipe_2d *pipe; + u32 *rpos; + + struct list_head q; +}; + +#define to_pipe_2d(p) container_of(p, struct mwv207_pipe_2d, base) +#define to_pipe_2d_fence(f) container_of(f, struct pipe_2d_fence, base) + +static inline void pipe_2d_write(struct mwv207_pipe_2d *pipe, + u32 reg, u32 value) +{ + pipe_write(&pipe->base, reg, value); +} + +static inline u32 pipe_2d_read(struct mwv207_pipe_2d *pipe, u32 reg) +{ + return pipe_read(&pipe->base, reg); +} + +static inline void pipe_2d_barrier(struct mwv207_pipe_2d *pipe) +{ + pipe_2d_read(pipe, 0x4100); + mb(); +} + +static inline bool fence16_after(u16 a, u16 b) +{ + return (s16)(a - b) > 0; +} + +static inline bool fence_after(u32 a, u32 b) +{ + return (s32)(a - b) > 0; +} + +static const char *pipe_2d_fence_get_driver_name(struct dma_fence *fence) +{ + return "mwv207"; +} + +static const char *pipe_2d_fence_get_timeline_name(struct dma_fence *fence) +{ + return to_pipe_2d_fence(fence)->pipe->base.fname; +} + +static bool pipe_2d_fence_signaled(struct dma_fence *fence) +{ + struct pipe_2d_fence *f = to_pipe_2d_fence(fence); + + return fence_after(f->pipe->completed_fence, f->base.seqno); +} + +static void pipe_2d_fence_release(struct dma_fence *fence) +{ + struct pipe_2d_fence *f = to_pipe_2d_fence(fence); + + kfree_rcu(f, base.rcu); +} + +static const struct dma_fence_ops pipe_2d_fence_ops = { + .get_driver_name = pipe_2d_fence_get_driver_name, + .get_timeline_name = pipe_2d_fence_get_timeline_name, + .signaled = pipe_2d_fence_signaled, + .release = pipe_2d_fence_release, +}; + +static inline u32 pipe_2d_ptr_span(void *end, void *start) +{ + return (unsigned long)end - (unsigned long)start; +} + +static inline u32 pipe_2d_gpu_addr(struct mwv207_pipe_2d *pipe, u32 *ptr) +{ + return pipe->ring_start_addr + pipe_2d_ptr_span(ptr, pipe->ring_start); +} + +static inline bool pipe_2d_idle_on_noc(struct mwv207_pipe_2d *pipe) +{ + struct mwv207_device *jdev = pipe->jdev; + u32 pending1, pending2; + u32 val; + + pending1 = jdev->lite ? 0x70038000 : 0xF87FC000; + pending2 = jdev->lite ? 0x0 : 0xF; + + val = jdev_read(jdev, 0x9B0194); + if ((val & pending1) != pending1) + return false; + val = jdev_read(jdev, 0x9B0198); + if ((val & pending2) != pending2) + return false; + return true; +} + +static int pipe_2d_hw_init(struct mwv207_pipe_2d *pipe) +{ + int ret; + u32 val; + + ret = wait_for(pipe_2d_idle_on_noc(pipe), 5000); + if (ret) { + pr_err("mwv207: failed to wait %s idle, %#x %#x", + pipe->base.fname, + jdev_read(pipe->jdev, 0x9B0194), + jdev_read(pipe->jdev, 0x9B0198)); + return ret; + } + + val = jdev_read(pipe->jdev, 0x9B0048); + val &= ~(1 << 8); + jdev_write(pipe->jdev, 0x9B0048, val); + + val = jdev_read(pipe->jdev, 0x9B0014); + val &= ~(1 << 16); + jdev_write(pipe->jdev, 0x9B0014, val); + + val = jdev_read(pipe->jdev, 0x9B0048); + val |= 1 << 8; + jdev_write(pipe->jdev, 0x9B0048, val); + + val = jdev_read(pipe->jdev, 0x9B0014); + val |= 1 << 16; + jdev_write(pipe->jdev, 0x9B0014, val); + + msleep(10); + + pipe_2d_write(pipe, 0x4800, 0); + + ret = wait_for(pipe_2d_read(pipe, 0x4800), 5000); + if (ret) { + pr_err("mwv207: failed to reset %s status RAM", + pipe->base.fname); + return ret; + } + + return 0; +} + +static void pipe_2d_reset_ring(struct mwv207_pipe_2d *pipe) +{ + struct pipe_2d_fence *fence, *p; + unsigned long flags; + + pipe->head = pipe->ring_start; + pipe->tail = pipe->ring_start; + + spin_lock_irqsave(&pipe->fence_queue_lock, flags); + list_for_each_entry_safe(fence, p, &pipe->fence_queue, q) { + list_del(&fence->q); + dma_fence_put(&fence->base); + } + spin_unlock_irqrestore(&pipe->fence_queue_lock, flags); +} + +static u32 *pipe_2d_append_wl(struct mwv207_pipe_2d *pipe) +{ + u32 *wait = pipe->tail; + + *pipe->tail++ = 0x88000000; + *pipe->tail++ = 0x80000000; + *pipe->tail++ = 0x89000000; + *pipe->tail++ = pipe_2d_gpu_addr(pipe, wait);; + + return wait; +} + +static void pipe_2d_start(struct mwv207_pipe_2d *pipe) +{ + u32 regval = pipe->ring_start_addr >> 4 | 1 << 29; + + pipe_2d_write(pipe, 0x4200, regval); + + *pipe->tail++ = 0x80000000; + *pipe->tail++ = 1; + *pipe->tail++ = 0x80000000; + *pipe->tail++ = 0x80000000; + + pipe->last_wait = pipe_2d_append_wl(pipe); + BUG_ON(pipe_2d_ptr_span(pipe->tail, pipe->ring_start) != 32); + pipe_2d_barrier(pipe); + pipe_2d_write(pipe, 0x4C00, 1); + + dev_dbg(pipe->base.jdev->dev, "start 2d wait link at 0x%llx", + pipe->ring_start_addr); +} + +static inline void pipe_2d_stop(struct mwv207_pipe_2d *pipe) +{ + pr_info("mwv207: %s %s TBD", pipe->base.fname, __func__); +} + +static void mwv207_pipe_2d_reset(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); + + if (pipe_2d_hw_init(pipe)) + return; + pipe_2d_reset_ring(pipe); + pipe_2d_start(pipe); +} + +static u32 *pipe_2d_wait_for_space(struct mwv207_pipe_2d *pipe, u32 size) +{ + int i; + + for (i = 0; i < 10000; i++) { + u32 *head = READ_ONCE(pipe->head); + if (head <= pipe->tail) { + if (pipe_2d_ptr_span(pipe->ring_end, pipe->tail) >= size) + return pipe->tail; + if (pipe_2d_ptr_span(head, pipe->ring_start) >= size) + return pipe->ring_start; + } else { + if (pipe_2d_ptr_span(head, pipe->tail) >= size) + return pipe->tail; + } + usleep_range(200, 200); + } + + return NULL; +} + +static struct dma_fence *pipe_2d_append_fence(struct mwv207_pipe_2d *pipe) +{ + struct pipe_2d_fence *fence; + unsigned long flags; + u32 regno; + + fence = kzalloc(sizeof(struct pipe_2d_fence), GFP_KERNEL); + if (!fence) { + pr_err("mwv207: failed to alloc memory for %s", + pipe->base.fname); + return ERR_PTR(-ENOMEM); + } + dma_fence_init(&fence->base, &pipe_2d_fence_ops, &pipe->fence_lock, + pipe->fence_ctx, ++pipe->next_fence); + fence->pipe = pipe; + fence->rpos = pipe->tail; + regno = (pipe->next_fence & 0x1f) + 1; + + spin_lock_irqsave(&pipe->fence_queue_lock, flags); + list_add_tail(&fence->q, &pipe->fence_queue); + spin_unlock_irqrestore(&pipe->fence_queue_lock, flags); + + *pipe->tail++ = (0x40000000 | 0x6000 | (0) << 2); + *pipe->tail++ = (u32)(fence->base.seqno & 0xffff); + *pipe->tail++ = (0x40000000 | 0x6000 | (regno) << 2); + *pipe->tail++ = regno; + + pipe_2d_write(pipe, 0x6000 + regno * 4, regno); + + dma_fence_get(&fence->base); + return &fence->base; +} + +static void pipe_2d_wtol(struct mwv207_pipe_2d *pipe, u32 *start, u32 *new_wait) +{ + u32 *pos = pipe->last_wait; + + pos[1] = pipe_2d_gpu_addr(pipe, start); + pipe_2d_barrier(pipe); + pos[0] = 0x89000000; + pipe_2d_barrier(pipe); + pipe_2d_write(pipe, 0x4C00, 1); + + pipe->last_wait = new_wait; +} + +static void mwv207_pipe_2d_dump_state(struct mwv207_pipe *mpipe) +{ + pr_info("%s %08x: %08x, %08x: %08x", mpipe->fname, + 0x4100, pipe_read(mpipe, 0x4100), + 0x961100, jdev_read(mpipe->jdev, 0x961100)); +} + +static struct dma_fence * +mwv207_pipe_2d_submit(struct mwv207_pipe *mpipe, struct mwv207_job *mjob) +{ + struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); + u32 size = ALIGN(mjob->cmd_size, 16) + 128; + u32 *start, *wait, *last_tail, nop_cnt; + struct dma_fence *fence; + + start = pipe_2d_wait_for_space(pipe, size); + if (!start) { + pr_err("mwv207: %s is stuck", mpipe->fname); + return ERR_PTR(-EBUSY); + } + last_tail = pipe->tail; + pipe->tail = start; + + *pipe->tail++ = 0x80000000; + pipe->tail++; + *pipe->tail++ = 0x80000000; + *pipe->tail++ = 0x80000000; + + memcpy_toio(pipe->tail, mjob->cmds, mjob->cmd_size); + pipe->tail += mjob->cmd_size >> 2; + for (nop_cnt = (ALIGN(mjob->cmd_size, 16) - mjob->cmd_size); + nop_cnt > 0; nop_cnt -= 4) + *pipe->tail++ = 0x80000000; + + fence = pipe_2d_append_fence(pipe); + if (IS_ERR(fence)) { + pipe->tail = last_tail; + return fence; + } + + wait = pipe_2d_append_wl(pipe); + + BUG_ON(pipe_2d_ptr_span(pipe->tail, start) & 0xf); + start[1] = pipe_2d_ptr_span(pipe->tail, start) / 16 - 1; + mwv207_pipe_record_busy(mpipe); + + pipe_2d_wtol(pipe, start, wait); + + BUG_ON(pipe_2d_ptr_span(pipe->tail, start) > size); + + return fence; +} + +static irqreturn_t mwv207_pipe_2d_isr(int irq_unused, void *data) +{ + struct mwv207_pipe_2d *pipe = data; + struct pipe_2d_fence *fence, *p; + u32 seqno; + + pipe_2d_write(pipe, 0x4308, 0xFFFFFFFF); + seqno = pipe_2d_read(pipe, 0x6000); + + spin_lock(&pipe->fence_queue_lock); + list_for_each_entry_safe(fence, p, &pipe->fence_queue, q) { + if (fence16_after(fence->base.seqno & 0xffff, seqno & 0xffff)) + break; + list_del(&fence->q); + pipe->completed_fence = fence->base.seqno; + WRITE_ONCE(pipe->head, fence->rpos); + mwv207_devfreq_record_idle(&pipe->base); + mwv207_pipe_record_idle(&pipe->base); + dma_fence_signal(&fence->base); + dma_fence_put(&fence->base); + } + spin_unlock(&pipe->fence_queue_lock); + + return IRQ_HANDLED; +} + +static void mwv207_pipe_2d_destroy(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_2d *pipe = to_pipe_2d(mpipe); + struct mwv207_bo *mbo = pipe->ring_bo; + int ret; + + free_irq(pipe->irq, pipe); + pipe_2d_stop(pipe); + + ret = mwv207_bo_reserve(mbo, true); + if (ret) { + pr_err("mwv207: failed to reserve bo"); + return; + } + mwv207_bo_kunmap_reserved(mbo); + mwv207_bo_unpin_reserved(mbo); + mwv207_bo_unreserve(mbo); + mwv207_bo_unref(mbo); + + mwv207_devfreq_unregister(mpipe); +} + +static unsigned long pipe_2d_max_freq_get(struct mwv207_device *jdev) +{ + unsigned long freq; + + switch (to_pci_dev(jdev->dev)->subsystem_device) { + case 0x9103: + freq = 600; + break; + case 0x9210: + case 0x9211: + freq = 800; + break; + case 0x930B: + freq = 1000; + break; + case 0x9101: + case 0x9102: + case 0x910A: + case 0x910B: + case 0x910C: + case 0x9200: + case 0x920A: + case 0x920B: + case 0x920C: + case 0x9230: + case 0x9231: + case 0x930A: + case 0x930C: + freq = 1200; + break; + default: + freq = 0x258; + break; + } + + return freq; +} + +struct mwv207_pipe *mwv207_pipe_2d_create(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info) +{ + struct mwv207_pipe_2d *pipe; + struct mwv207_bo *mbo; + void *addr; + int ret; + + pipe = devm_kzalloc(jdev->dev, sizeof(*pipe), GFP_KERNEL); + if (!pipe) + return NULL; + pipe->base.pll_id = MWV207_PLL_GU2D_PLL; + pipe->base.jdev = jdev; + pipe->base.fname = info->name; + pipe->base.regbase = jdev->mmio + info->reg_base; + pipe->base.iosize = 32 * 1024; + pipe->base.submit = mwv207_pipe_2d_submit; + pipe->base.reset = mwv207_pipe_2d_reset; + pipe->base.destroy = mwv207_pipe_2d_destroy; + pipe->base.dump_state = mwv207_pipe_2d_dump_state; + + pipe->jdev = jdev; + pipe->id = info->id; + pipe->fence_ctx = dma_fence_context_alloc(1); + INIT_LIST_HEAD(&pipe->fence_queue); + spin_lock_init(&pipe->fence_lock); + spin_lock_init(&pipe->fence_queue_lock); + + ret = mwv207_devfreq_register(&pipe->base, pipe_2d_max_freq_get(jdev)); + if (ret) + pipe->base.devfreq = NULL; + + ret = mwv207_bo_create(jdev, 0x40000, 0x1000, + true, 0x2, + 0x1, + NULL, NULL, &mbo); + if (ret) + goto unregister_devfreq; + + ret = mwv207_bo_reserve(mbo, true); + if (ret) + goto free_bo; + ret = mwv207_bo_pin_reserved(mbo, 0x2); + if (ret) + goto unreserve_bo; + ret = mwv207_bo_kmap_reserved(mbo, &addr); + if (ret) + goto unpin_bo; + pipe->ring_bo = mbo; + + pipe->ring_start = (u32 *)addr; + pipe->ring_start_addr = mwv207_bo_gpu_phys(mbo); + pipe->ring_end = pipe->ring_start + (0x40000 >> 2); + + mwv207_pipe_2d_reset(&pipe->base); + + pipe->irq = irq_find_mapping(jdev->irq_domain, 0x11 + info->id); + if (pipe->irq == 0) { + pr_err("mwv207: failed to find %s irq mapping", info->name); + goto unmap_bo; + } + + ret = request_irq(pipe->irq, mwv207_pipe_2d_isr, 0, info->name, pipe); + if (ret) { + pr_err("mwv207: failed to request irq for %s", info->name); + goto unmap_bo; + } + + mwv207_bo_unreserve(mbo); + + return &pipe->base; +unmap_bo: + mwv207_bo_kunmap_reserved(mbo); +unpin_bo: + mwv207_bo_unpin_reserved(mbo); +unreserve_bo: + mwv207_bo_unreserve(mbo); +free_bo: + mwv207_bo_unref(mbo); +unregister_devfreq: + mwv207_devfreq_unregister(&pipe->base); + return NULL; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_3d.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_3d.c new file mode 100644 index 0000000000000000000000000000000000000000..c43548ffb0fb7b88db3737917cc3de7508ac0c1b --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_3d.c @@ -0,0 +1,602 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include "mwv207_bo.h" +#include "mwv207_sched.h" +#include "mwv207_vbios.h" +#include "mwv207_devfreq.h" + +#define to_3d_pipe(pipe) container_of(pipe, struct mwv207_pipe_3d, base) +struct mwv207_pipe_3d { + struct mwv207_pipe base; + struct mwv207_bo *ringbuf_bo; + u32 *ringbuf; + u32 *head; + u32 *tail; + u32 *end; + u32 ringbuf_gpu_addr; + int unit; + unsigned int irq; + + u64 fence_ctx; + u32 next_fence; + u32 completed_fence; + spinlock_t fence_lock; + + DECLARE_BITMAP(event_bitmap, 0x1E); + struct dma_fence *event_fence[0x1E]; + spinlock_t event_lock; +}; + +#define to_pipe_3d_fence(f) container_of(f, struct pipe_3d_fence, base) +struct pipe_3d_fence { + struct dma_fence base; + u32 *rpos; + struct mwv207_pipe_3d *pipe; +}; + +static inline void pipe_3d_write(struct mwv207_pipe_3d *pipe, u32 reg, u32 value) +{ + pipe_write(&pipe->base, reg, value); +} + +static inline u32 pipe_3d_read(struct mwv207_pipe_3d *pipe, u32 reg) +{ + return pipe_read(&pipe->base, reg); +} + +static inline bool fence_after(u32 a, u32 b) +{ + return (s32)(a - b) > 0; +} + +static const char *pipe_3d_fence_get_driver_name(struct dma_fence *fence) +{ + return "mwv207"; +} + +static const char *pipe_3d_fence_get_timeline_name(struct dma_fence *fence) +{ + return to_pipe_3d_fence(fence)->pipe->base.fname; +} + +static bool pipe_3d_fence_signaled(struct dma_fence *fence) +{ + struct pipe_3d_fence *f = to_pipe_3d_fence(fence); + + return fence_after(f->pipe->completed_fence, f->base.seqno); +} + +static void pipe_3d_fence_release(struct dma_fence *fence) +{ + struct pipe_3d_fence *f = to_pipe_3d_fence(fence); + + kfree_rcu(f, base.rcu); +} + +static const struct dma_fence_ops pipe_3d_fence_ops = { + .get_driver_name = pipe_3d_fence_get_driver_name, + .get_timeline_name = pipe_3d_fence_get_timeline_name, + .signaled = pipe_3d_fence_signaled, + .release = pipe_3d_fence_release, +}; + +static inline struct dma_fence *pipe_3d_event_pop_irq(struct mwv207_pipe_3d *pipe, u32 event) +{ + struct dma_fence *fence; + + spin_lock(&pipe->event_lock); + fence = pipe->event_fence[event]; + pipe->event_fence[event] = NULL; + clear_bit(event, pipe->event_bitmap); + spin_unlock(&pipe->event_lock); + + return fence; +} + +static inline u32 pipe_3d_event_push(struct mwv207_pipe_3d *pipe, struct dma_fence *fence) +{ + u32 event; + + spin_lock_irq(&pipe->event_lock); + event = find_first_zero_bit(pipe->event_bitmap, 0x1E); + if (likely(event < 0x1E)) + pipe->event_fence[event] = dma_fence_get(fence); + set_bit(event, pipe->event_bitmap); + spin_unlock_irq(&pipe->event_lock); + + BUG_ON(event >= 0x1E); + + return event; +} + +static inline u32 pipe_3d_ptr_span(void *end, void *start) +{ + return (unsigned long)end - (unsigned long)start; +} + +static inline u32 pipe_3d_gpu_addr(struct mwv207_pipe_3d *pipe, u32 *ptr) +{ + return pipe->ringbuf_gpu_addr + pipe_3d_ptr_span(ptr, pipe->ringbuf); +} + +static inline void pipe_3d_link(struct mwv207_pipe_3d *pipe, u32 prefetch, u32 addr) +{ + pipe->tail = PTR_ALIGN(pipe->tail, 8); + BUG_ON(pipe->tail >= pipe->end - 1 + || (((prefetch + 7) / 8) & 0xffff0000) + || addr & 0x7); + *pipe->tail++ = 0x40000000 | ((prefetch + 7) / 8); + *pipe->tail++ = addr; +} + +static inline void pipe_3d_wait(struct mwv207_pipe_3d *pipe) +{ + pipe->tail = PTR_ALIGN(pipe->tail, 8); + BUG_ON(pipe->tail >= pipe->end); + + *pipe->tail++ = 0x38000000 | 200; +} + +static inline void pipe_3d_wl(struct mwv207_pipe_3d *pipe) +{ + pipe_3d_wait(pipe); + pipe_3d_link(pipe, 16, pipe_3d_gpu_addr(pipe, pipe->tail) - 4); +} + +static inline void pipe_3d_wtol(struct mwv207_pipe_3d *pipe, u32 *w, u32 target, u32 size) +{ + BUG_ON((((size + 7) / 8) & 0xffff0000) || target & 0x7 + || w < pipe->ringbuf || w >= pipe->end - 1); + w[1] = target; + pipe_3d_read(pipe, 0x4); + mb(); + w[0] = 0x40000000 | ((size + 7) / 8); +} + +static inline void pipe_3d_loadstate(struct mwv207_pipe_3d *pipe, u32 reg, u32 val) +{ + pipe->tail = PTR_ALIGN(pipe->tail, 8); + BUG_ON(pipe->tail >= pipe->end - 1); + + *pipe->tail++ = 0x8010000 | reg; + *pipe->tail++ = val; +} + +static inline void pipe_3d_sem(struct mwv207_pipe_3d *pipe, u32 to, u32 from) +{ + from &= 0x1f; + to &= 0x1f; + to <<= 8; + pipe_3d_loadstate(pipe, 0xE02, from | to); +} + +static inline void pipe_3d_stall(struct mwv207_pipe_3d *pipe, u32 to, u32 from) +{ + pipe->tail = PTR_ALIGN(pipe->tail, 8); + BUG_ON(pipe->tail >= pipe->end - 1); + from &= 0x1f; + to &= 0x1f; + to <<= 8; + *pipe->tail++ = 0x48000000; + *pipe->tail++ = from | to; +} + +static inline void pipe_3d_start(struct mwv207_pipe_3d *pipe) +{ + u32 *start = pipe->tail; + u32 len; + + dev_dbg(pipe->base.jdev->dev, "start wait link at 0x%x", pipe->ringbuf_gpu_addr); + pipe_3d_loadstate(pipe, 0x0e21, 0x00020202); + pipe_3d_loadstate(pipe, 0x0e44, 0x0000000f); + pipe_3d_loadstate(pipe, 0x0e80, 0x00000000); + pipe_3d_loadstate(pipe, 0x7003, 0x00000001); + + pipe_3d_wl(pipe); + + len = (pipe->tail - start) * 4; + pipe_3d_write(pipe, 0x14, 0xffffffff); + pipe_3d_write(pipe, 0x654, pipe->ringbuf_gpu_addr); + pipe_3d_read(pipe, 0x4); + mb(); + pipe_3d_write(pipe, 0x658, 0x10000 | (len / 8)); + pipe_3d_write(pipe, 0x3A4, 0x10000 | (len / 8)); +} + +static inline int pipe_3d_stop(struct mwv207_pipe_3d *pipe) +{ + pr_info("%s TBD", __func__); + return 0; +} + +static void pipe_3d_core_reset(struct mwv207_pipe_3d *pipe) +{ + int i; + + for (i = 0; i < 2; i++) { + + pipe_3d_write(pipe, 0x104, 0); + + pipe_3d_write(pipe, 0x10C, 0x015b0880); + pipe_3d_write(pipe, 0x10C, 0x015b0881); + pipe_3d_write(pipe, 0x10C, 0x015b0880); + + pipe_3d_write(pipe, 0x0, 0x00010b00); + pipe_3d_write(pipe, 0x0, 0x00010900); + + usleep_range(1000, 1001); + + pipe_3d_write(pipe, 0x0, 0x00090900); + + pipe_3d_write(pipe, 0x3A8, 1); + pipe_3d_write(pipe, 0x3A8, 0); + + usleep_range(1000, 1001); + + pipe_3d_write(pipe, 0x0, 0x00010900); + } +} + +static void pipe_3d_hw_init(struct mwv207_pipe_3d *pipe) +{ + pipe_3d_write(pipe, 0x0, 0x00010900); + pipe_3d_core_reset(pipe); + + pipe_3d_write(pipe, 0x55C, 0x00ffffff); + pipe_3d_write(pipe, 0x414, 0x3c000000); + pipe_3d_write(pipe, 0x90, + pipe_3d_read(pipe, 0x90) & 0xffffffbf); + + pipe_3d_write(pipe, 0x0, 0x00010900); + pipe_3d_write(pipe, 0x0, 0x00070100); + pipe_3d_write(pipe, 0x3AC, 0x00002300); + pipe_3d_write(pipe, 0x3A8, 0x2); + + pipe_3d_write(pipe, 0x3C, 0xffffffff); + pipe_3d_write(pipe, 0x3C, 0x00000000); + + pipe_3d_write(pipe, 0x100, 0x00140021); + + pipe_3d_write(pipe, 0x154, 0x1); + pipe_3d_write(pipe, 0x104, 0x00430408); + pipe_3d_write(pipe, 0x10C, 0x015b0880); +} + +static void mwv207_pipe_3d_reset(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); + int i; + + spin_lock_irq(&pipe->event_lock); + bitmap_zero(pipe->event_bitmap, 0x1E); + for (i = 0; i < 0x1E; i++) { + if (!pipe->event_fence[i]) + continue; + dma_fence_put(pipe->event_fence[i]); + pipe->event_fence[i] = NULL; + mwv207_pipe_record_idle(mpipe); + } + spin_unlock_irq(&pipe->event_lock); + + pipe_3d_hw_init(pipe); + pipe->tail = pipe->ringbuf; + pipe->head = pipe->ringbuf; + + pipe_3d_start(pipe); +} + +static u32 *pipe_3d_wait_for_space(struct mwv207_pipe_3d *pipe, u32 size) +{ + u32 *head; + int i; + + for (i = 0; i < 10000; ++i) { + head = READ_ONCE(pipe->head); + if (head <= pipe->tail) { + if (pipe_3d_ptr_span(pipe->end, pipe->tail) >= size) + return pipe->tail; + if (pipe_3d_ptr_span(head, pipe->ringbuf) >= size) + return pipe->ringbuf; + } else { + if (pipe_3d_ptr_span(head, pipe->tail) >= size) + return pipe->tail; + } + usleep_range(200, 200); + } + return NULL; +} + +static struct dma_fence *mwv207_pipe_3d_submit(struct mwv207_pipe *mpipe, + struct mwv207_job *mjob) +{ + struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); + struct pipe_3d_fence *fence; + u32 *last_tail, *start; + u32 size, event; + + size = ALIGN(mjob->cmd_size, 8) + 256; + last_tail = pipe->tail; + start = pipe_3d_wait_for_space(pipe, size); + if (start == NULL) { + pr_err("mwv207: engine 3d is stuck"); + + return ERR_PTR(-EBUSY); + } + memcpy_toio(start, mjob->cmds, mjob->cmd_size); + pipe->tail = start + mjob->cmd_size / 4; + + pipe_3d_loadstate(pipe, 0xE03, 0xc63); + pipe_3d_loadstate(pipe, 0x594, 0x41); + + pipe_3d_sem(pipe, 0x7, 0x1); + pipe_3d_stall(pipe, 0x7, 0x1); + pipe_3d_loadstate(pipe, 0x502E, 0x1); + pipe_3d_loadstate(pipe, 0x502B, 0x3); + pipe_3d_sem(pipe, 0x10, 0x1); + pipe_3d_stall(pipe, 0x10, 0x1); + pipe_3d_loadstate(pipe, 0x502E, 0x0); + + fence = kzalloc(sizeof(struct pipe_3d_fence), GFP_KERNEL); + if (!fence) { + pipe->tail = last_tail; + pr_err("mwv207: failed to alloc memory for 3d pipe"); + + return ERR_PTR(-ENOMEM); + } + dma_fence_init(&fence->base, &pipe_3d_fence_ops, &pipe->fence_lock, + pipe->fence_ctx, ++pipe->next_fence); + fence->rpos = pipe->tail; + fence->pipe = pipe; + event = pipe_3d_event_push(pipe, &fence->base); + + pipe_3d_loadstate(pipe, 0x502E, 0x1); + pipe_3d_loadstate(pipe, 0x50CE, 0xf); + pipe_3d_loadstate(pipe, 0xE01, 0x80 | event); + pipe_3d_loadstate(pipe, 0x502E, 0x0); + + mwv207_pipe_record_busy(mpipe); + + pipe_3d_wl(pipe); + BUG_ON(pipe_3d_ptr_span(pipe->tail, start) > size); + pipe_3d_wtol(pipe, last_tail - 4, pipe_3d_gpu_addr(pipe, start), + pipe_3d_ptr_span(pipe->tail, start)); + return &fence->base; +} + +static void mwv207_pipe_3d_dump_state(struct mwv207_pipe *mpipe) +{ + u32 state0, addr0; + u32 state1, addr1; + int i; + + state0 = pipe_read(mpipe, 0x660); + addr0 = pipe_read(mpipe, 0x664); + for (i = 0; i < 500; ++i) { + state1 = pipe_read(mpipe, 0x660); + addr1 = pipe_read(mpipe, 0x664); + if (state1 != state0 || addr1 != addr0) + break; + } + + if (state1 != state0) + pr_info("%s state changing, s0: 0x%08x, s1: 0x%08x", mpipe->fname, state0, state1); + pr_info("%s current stat: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x660)); + + if (addr1 != addr0) + pr_info("%s addr changing, a0: 0x%08x, a1: 0x%08x", mpipe->fname, addr0, addr1); + pr_info("%s current addr: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x664)); + + pr_info("%s current cmdl: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x668)); + pr_info("%s current cmdh: 0x%08x", mpipe->fname, pipe_read(mpipe, 0x66c)); +} + +static irqreturn_t mwv207_pipe_3d_isr(int irq_unused, void *dev_id) +{ + struct mwv207_pipe_3d *pipe = dev_id; + struct dma_fence *fence; + u32 event, intr; + + intr = pipe_3d_read(pipe, 0x10); + if (unlikely(!intr)) { + pr_warn("mwv207: 3d interrupt with no event"); + return IRQ_NONE; + } + if (unlikely(intr & 0x80000000)) { + pr_warn("mwv207: 3d axi bus error"); + intr &= ~0x80000000; + } + if (unlikely(intr & 0x40000000)) { + pr_warn("mwv207: 3d mmu error"); + intr &= ~0x40000000; + } + while ((event = ffs(intr))) { + event -= 1; + intr &= ~(1 << event); + + fence = pipe_3d_event_pop_irq(pipe, event); + if (!fence) { + pr_warn("unexpected event: %d", event); + continue; + } + + if (fence_after(fence->seqno, pipe->completed_fence)) { + struct pipe_3d_fence *pipe_fence = to_pipe_3d_fence(fence); + + pipe->completed_fence = fence->seqno; + pipe->head = pipe_fence->rpos; + } + mwv207_devfreq_record_idle(&pipe->base); + mwv207_pipe_record_idle(&pipe->base); + dma_fence_signal(fence); + dma_fence_put(fence); + } + return IRQ_HANDLED; +} + +static void mwv207_pipe_3d_destroy(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_3d *pipe = to_3d_pipe(mpipe); + struct mwv207_bo *jbo; + int ret; + + free_irq(pipe->irq, pipe); + pipe_3d_stop(pipe); + + jbo = pipe->ringbuf_bo; + ret = mwv207_bo_reserve(jbo, true); + if (ret) { + pr_info("failed to reserve bo"); + return; + } + mwv207_bo_kunmap_reserved(jbo); + mwv207_bo_unpin_reserved(jbo); + mwv207_bo_unreserve(jbo); + mwv207_bo_unref(jbo); + + mwv207_devfreq_unregister(mpipe); +} + +static unsigned long pipe_3d_max_freq_get(struct mwv207_device *jdev) +{ + unsigned long freq; + + switch (to_pci_dev(jdev->dev)->subsystem_device) { + case 0x9103: + freq = 600; + break; + case 0x9210: + case 0x9211: + freq = 800; + break; + case 0x9101: + case 0x9102: + case 0x910A: + case 0x910B: + case 0x910C: + case 0x920C: + case 0x930B: + freq = 1000; + break; + case 0x9200: + case 0x920A: + case 0x920B: + case 0x9230: + case 0x9231: + case 0x930A: + case 0x930C: + freq = 1200; + break; + default: + break; + freq = 0x258; + } + + return freq; +} + +struct mwv207_pipe *mwv207_pipe_3d_create(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info) +{ + struct mwv207_pipe_3d *pipe; + struct mwv207_bo *jbo; + void *logical; + int ret; + + if (jdev->lite && info->id) + return NULL; + + pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_3d), GFP_KERNEL); + if (!pipe) + return NULL; + + pipe->base.pll_id = info->id ? MWV207_PLL_GU3D1 : MWV207_PLL_GU3D0; + pipe->base.jdev = jdev; + pipe->base.fname = info->name; + pipe->base.regbase = jdev->mmio + info->reg_base; + pipe->base.iosize = 16 * 1024; + pipe->base.submit = mwv207_pipe_3d_submit; + pipe->base.reset = mwv207_pipe_3d_reset; + pipe->base.destroy = mwv207_pipe_3d_destroy; + pipe->base.dump_state = mwv207_pipe_3d_dump_state; + + pipe->unit = info->id; + pipe->fence_ctx = dma_fence_context_alloc(1); + spin_lock_init(&pipe->fence_lock); + spin_lock_init(&pipe->event_lock); + + ret = mwv207_devfreq_register(&pipe->base, pipe_3d_max_freq_get(jdev)); + if (ret) + pipe->base.devfreq = NULL; + + ret = mwv207_bo_create(jdev, 0x40000, PAGE_SIZE, true, + 0x2, + 0x1, + NULL, NULL, &jbo); + if (ret) + goto unregister_devfreq; + + ret = mwv207_bo_reserve(jbo, true); + if (ret) + goto free_bo; + + ret = mwv207_bo_pin_reserved(jbo, 0x2); + if (ret) + goto unreserve_bo; + + ret = mwv207_bo_kmap_reserved(jbo, &logical); + if (ret) + goto unpin_bo; + + pipe->ringbuf_bo = jbo; + + pipe->ringbuf = (u32 *)logical; + pipe->ringbuf_gpu_addr = mwv207_bo_gpu_phys(jbo); + pipe->end = pipe->ringbuf + (0x40000 / 4); + + mwv207_pipe_3d_reset(&pipe->base); + + pipe->irq = irq_find_mapping(jdev->irq_domain, 0x13 + info->id); + if (pipe->irq == 0) { + pr_err("mwv207: failed to create 3D irq mapping"); + goto unmap_bo; + } + + ret = request_irq(pipe->irq, mwv207_pipe_3d_isr, 0, info->name, pipe); + if (ret) { + pr_err("mwv207: failed to request 3d irq"); + goto unmap_bo; + } + + mwv207_bo_unreserve(jbo); + return &pipe->base; +unmap_bo: + mwv207_bo_kunmap_reserved(jbo); +unpin_bo: + mwv207_bo_unpin_reserved(jbo); +unreserve_bo: + mwv207_bo_unreserve(jbo); +free_bo: + mwv207_bo_unref(pipe->ringbuf_bo); +unregister_devfreq: + mwv207_devfreq_unregister(&pipe->base); + return NULL; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_codec_common.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_codec_common.c new file mode 100644 index 0000000000000000000000000000000000000000..8a376a11f0a5be6aa2a29b8538a1e18d8b1b3402 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_codec_common.c @@ -0,0 +1,86 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_pipe_codec_common.h" + +static void pipe_codec_sw_pp_submit_ex(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, + u64 vram, u32 reg, int nr) +{ + if (sw_pp->wb_cnt >= 0x10) { + dev_dbg(pipe->jdev->dev, "mwv207: too much write back entry"); + return; + } + + sw_pp->wb[sw_pp->wb_cnt].vram = vram; + sw_pp->wb[sw_pp->wb_cnt].reg = reg; + sw_pp->wb[sw_pp->wb_cnt].nr = nr; + + sw_pp->wb_cnt++; + sw_pp->pending = true; +} + +void pipe_codec_sw_pp_reset(struct pipe_codec_sw_pp *sw_pp) +{ + sw_pp->wb_cnt = 0; +} + +void pipe_codec_sw_pp_excute(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe) +{ + int i, j; + + if (!sw_pp->pending) + return; + + for (i = 0; i < sw_pp->wb_cnt; i++) { + for (j = 0; j < sw_pp->wb[i].nr && sw_pp->wb[i].reg + j * 4 <= pipe->iosize - 4; j++) + sw_pp->wb_buf[j] = pipe_read(pipe, sw_pp->wb[i].reg + j * 4); + + if (!j) + continue; + + jdev_write_vram(pipe->jdev, sw_pp->wb[i].vram, &sw_pp->wb_buf[0], j * 4); + } + + wmb(); + + sw_pp->wb_cnt = 0; + sw_pp->pending = false; +} + +void pipe_codec_sw_pp_submit(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, + struct mwv207_job *mjob, int pos, int *cmdlen) +{ + int nr, reg; + u64 vram; + u32 cmd; + + *cmdlen = 16; + + if (pos + 16 > mjob->cmd_size) { + dev_dbg(pipe->jdev->dev, + "mwv207: cmd %d write back out of range", pos); + return; + } + + cmd = *(u32 *)(mjob->cmds + pos); + reg = (cmd & 0xffff) * 4; + nr = (cmd >> 16) & 0x3ff; + if (nr == 0) + nr = 1024; + + vram = *(u64 *)(mjob->cmds + pos + 8); + pipe_codec_sw_pp_submit_ex(sw_pp, pipe, vram, reg, nr); +} + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_codec_common.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_codec_common.h new file mode 100644 index 0000000000000000000000000000000000000000..0cf644e04c7419c3b1724aae2cf175ec1467bd44 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_codec_common.h @@ -0,0 +1,37 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_sched.h" + +#define MAX(a, b) ((a) > (b) ? (a) : (b)) + +struct pipe_codec_wb_entry { + u64 vram; + u32 reg; + u32 nr; +}; + +struct pipe_codec_sw_pp { + struct pipe_codec_wb_entry wb[0x10]; + u32 wb_buf[MAX(0x1F4,0x1F7)]; + int wb_cnt; + bool pending; +}; + +void pipe_codec_sw_pp_reset(struct pipe_codec_sw_pp *sw_pp); +void pipe_codec_sw_pp_excute(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe); +void pipe_codec_sw_pp_submit(struct pipe_codec_sw_pp *sw_pp, struct mwv207_pipe *pipe, + struct mwv207_job *mjob, int pos, int *cmdlen); + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_dec.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_dec.c new file mode 100644 index 0000000000000000000000000000000000000000..e37fcbf359822c0548650b08afcd1f0951ae49e4 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_dec.c @@ -0,0 +1,255 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include "mwv207_pipe_codec_common.h" + +#define to_dec_pipe(pipe) container_of(pipe, struct mwv207_pipe_dec, base) +struct pipe_dec_fence; +struct mwv207_pipe_dec { + struct mwv207_pipe base; + + u64 fence_ctx; + u64 fence_seqno; + spinlock_t fence_lock; + + struct pipe_dec_fence *current_fence; + struct task_struct *poll_thread; + struct pipe_codec_sw_pp sw_pp; +}; + +#define to_pipe_dec_fence(f) container_of(f, struct pipe_dec_fence, base) +struct pipe_dec_fence { + struct dma_fence base; + struct mwv207_pipe_dec *pipe; + struct list_head node; +}; + +static inline void pipe_dec_write(struct mwv207_pipe_dec *pipe, u32 reg, u32 value) +{ + pipe_write(&pipe->base, reg, value); +} + +static inline u32 pipe_dec_read(struct mwv207_pipe_dec *pipe, u32 reg) +{ + return pipe_read(&pipe->base, reg); +} + +static const char *pipe_dec_fence_get_driver_name(struct dma_fence *fence) +{ + return "mwv207"; +} + +static const char *pipe_dec_fence_get_timeline_name(struct dma_fence *fence) +{ + return to_pipe_dec_fence(fence)->pipe->base.fname; +} + +static void pipe_dec_fence_release(struct dma_fence *fence) +{ + struct pipe_dec_fence *f = to_pipe_dec_fence(fence); + + kfree_rcu(f, base.rcu); +} + +static const struct dma_fence_ops pipe_dec_fence_ops = { + .get_driver_name = pipe_dec_fence_get_driver_name, + .get_timeline_name = pipe_dec_fence_get_timeline_name, + .release = pipe_dec_fence_release, +}; + +static void pipe_dec_stat_reset(struct mwv207_pipe_dec *pipe, u32 stat) +{ + pipe_dec_write(pipe, 0x4, 0x0); +} + +static int pipe_dec_polling(void *priv) +{ + struct mwv207_pipe_dec *pipe = priv; + struct pipe_dec_fence *fence; + u32 stat; + + set_freezable(); + while (!kthread_should_stop()) { + usleep_range(1000, 1001); + try_to_freeze(); + + fence = smp_load_acquire(&pipe->current_fence); + if (fence == NULL) + continue; + + stat = pipe_dec_read(pipe, 0x4); + if ((stat & 0x1100) != 0x1100) + continue; + + pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); + pipe_dec_stat_reset(pipe, stat); + + smp_store_release(&pipe->current_fence, NULL); + + dma_fence_signal(&fence->base); + dma_fence_put(&fence->base); + } + + return 0; +} + +static void mwv207_pipe_dec_reset(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); + struct pipe_dec_fence *fence; + u32 stat; + int i; + + pipe_codec_sw_pp_reset(&pipe->sw_pp); + + stat = pipe_dec_read(pipe, 0x4); + if (stat & 0x1) + pipe_dec_write(pipe, 0x4, + 0x20 | 0x30); + + pipe_dec_write(pipe, 0x4, 0); + pipe_dec_write(pipe, 0x8, 0x454); + + for (i = 12; i < pipe->base.iosize; i += 0x4) + pipe_dec_write(pipe, i, 0); + + fence = smp_load_acquire(&pipe->current_fence); + if (fence) { + dma_fence_put(&fence->base); + + smp_store_release(&pipe->current_fence, NULL); + } +} + +static struct dma_fence *mwv207_pipe_dec_submit(struct mwv207_pipe *mpipe, + struct mwv207_job *mjob) +{ + struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); + struct pipe_dec_fence *fence; + int i, nr, pos, cmdlen; + bool hw_run = 0; + u32 cmd, reg; + + fence = smp_load_acquire(&pipe->current_fence); + if (fence) + return ERR_PTR(-EBUSY); + + for (pos = 0; pos <= mjob->cmd_size - 4; pos += cmdlen) { + cmd = *(u32 *)(mjob->cmds + pos); + switch ((cmd >> 27) & 0x1f) { + case 0x01: + if ((cmd >> 26) & 0x1) + return ERR_PTR(-EINVAL); + reg = (cmd & 0xffff) * 4; + nr = (cmd >> 16) & 0x3ff; + if (nr == 0) + nr = 1024; + for (i = pos + 4; i <= pos + nr * 4 + && i <= mjob->cmd_size - 4 + && reg <= pipe->base.iosize - 4; + i += 4, reg += 4) { + if (reg == 4) { + pipe_dec_read(pipe, 0x4); + hw_run = (*(u32 *)(mjob->cmds + i)) & 0x1; + + mb(); + } + pipe_dec_write(pipe, reg, *(u32 *)(mjob->cmds + i)); + } + + if (i <= pos + nr * 4) + dev_dbg(mpipe->jdev->dev, + "mwv207: invalid dec register writes dropped"); + + cmdlen = ALIGN(4 + nr * 4, 8); + break; + case 0x02: + pipe_codec_sw_pp_submit(&pipe->sw_pp, &pipe->base, mjob, pos, &cmdlen); + break; + default: + + return ERR_PTR(-EINVAL); + } + } + + fence = kzalloc(sizeof(struct pipe_dec_fence), GFP_KERNEL); + if (!fence) + return ERR_PTR(-ENOMEM); + fence->pipe = pipe; + dma_fence_init(&fence->base, &pipe_dec_fence_ops, &pipe->fence_lock, + pipe->fence_ctx, ++pipe->fence_seqno); + + if (hw_run) { + dma_fence_get(&fence->base); + + smp_store_release(&pipe->current_fence, fence); + } else { + pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); + dma_fence_signal(&fence->base); + } + + return &fence->base; +} + +static void mwv207_pipe_dec_dump_state(struct mwv207_pipe *mpipe) +{ + pr_info("%s irq state reg: 0x%08x", mpipe->fname, + pipe_read(mpipe, 0x4)); +} + +static void mwv207_pipe_dec_destroy(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_dec *pipe = to_dec_pipe(mpipe); + + kthread_stop(pipe->poll_thread); +} + +struct mwv207_pipe *mwv207_pipe_dec_create(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info) +{ + struct mwv207_pipe_dec *pipe; + + if (jdev->lite && info->id) + return NULL; + + pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_dec), GFP_KERNEL); + if (!pipe) + return NULL; + + pipe->base.jdev = jdev; + pipe->base.fname = info->name; + pipe->base.regbase = jdev->mmio + info->reg_base; + pipe->base.iosize = 0x1F7 * 4; + pipe->base.submit = mwv207_pipe_dec_submit; + pipe->base.reset = mwv207_pipe_dec_reset; + pipe->base.destroy = mwv207_pipe_dec_destroy; + pipe->base.dump_state = mwv207_pipe_dec_dump_state; + + spin_lock_init(&pipe->fence_lock); + pipe->fence_ctx = dma_fence_context_alloc(1); + pipe->fence_seqno = 0; + + mwv207_pipe_dec_reset(&pipe->base); + + pipe->poll_thread = kthread_run(pipe_dec_polling, pipe, "dec_polling"); + if (IS_ERR(pipe->poll_thread)) + return NULL; + + return &pipe->base; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_dma.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_dma.c new file mode 100644 index 0000000000000000000000000000000000000000..cd82e0d4b68c5ea1be5fb7107f311016e7008873 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_dma.c @@ -0,0 +1,412 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include "mwv207_bo.h" +#include "mwv207_sched.h" +#include "mwv207_drv.h" + +#undef MWV207_DMA_DEBUG + +#define DMA_MAX_LLI_COUNT (0x400000 / sizeof(struct mwv207_lli)) + +#define DMA_TS_NOT_ALIGNED(size) ((size) - 1) +#define DMA_TS_ALIGNED(size, alignment) (((size) >= (alignment)) ? ((size) / (alignment) - 1) : 0) +#define DMA_CTL_NOT_ALIGNED ((1UL<<0x3F) \ + | (1UL<<0x3A) \ + | (1UL<<0x1E) \ + | (1UL<<0x26) \ + | (1UL<<0x2F) \ + | ((32ul & 0xFF)<<0x27) \ + | ((32ul & 0xFF)<<0x30) \ + | ((0UL & 0x7)<<0x8) \ + | ((0UL & 0x7)<<0xB)) + +#define DMA_CTL_ALIGNED(a) ((1UL<<0x3F) \ + | (1UL<<0x3A) \ + | (1UL<<0x1E) \ + | (1UL<<0x26) \ + | (1UL<<0x2F) \ + | ((32ul & 0xFF)<<0x27) \ + | ((32ul & 0xFF)<<0x30) \ + | (((((a) == 64)?6UL:5UL) & 0x7)<<0x8) \ + | (((((a) == 64)?6UL:5UL) & 0x7)<<0xB)) + +#define mwv207_timed_loop(tick, cond, timeout) \ + for ((tick) = jiffies; (cond) && time_before(jiffies, (tick) + msecs_to_jiffies(timeout));) + +struct mwv207_lli { + u64 sar; + u64 dar; + u32 ts; + u32 resv1; + u64 llp; + u64 ctl; + u32 sstat; + u32 dstat; + u64 llpstat; + u32 resv2; + u32 resv3; +}; + +#define to_dma_pipe(pipe) container_of(pipe, struct mwv207_pipe_dma, base) +struct mwv207_pipe_dma { + struct mwv207_pipe base; + int unit; + u32 alignment; + struct mwv207_lli *lli; + struct mwv207_lli *last_lli; + dma_addr_t lli_bus_addr; + int cur_idx; + + bool coherent; +}; + +struct mwv207_dma_cursor { + bool is_vram; + u64 line_pos; + u64 cur_pos; + + dma_addr_t *dma_address; + u64 nr_pages; + + u64 width; + u64 stride; +}; +static inline void pipe_dma_write(struct mwv207_pipe_dma *pipe, u32 reg, u32 value) +{ + pipe_write(&pipe->base, reg, value); +} + +static inline u32 pipe_dma_read(struct mwv207_pipe_dma *pipe, u32 reg) +{ + return pipe_read(&pipe->base, reg); +} + +static inline void pipe_dma_chan_write(struct mwv207_pipe_dma *pipe, int chan, u32 reg, u32 val) +{ + pipe_dma_write(pipe, chan * 0x200 + reg, val); +} + +static inline u32 pipe_dma_chan_read(struct mwv207_pipe_dma *pipe, int chan, u32 reg) +{ + return pipe_dma_read(pipe, chan * 0x200 + reg); +} + +static inline int pipe_dma_chan_done(struct mwv207_pipe_dma *pipe, int chan) +{ + u32 status; + + if (pipe->last_lli->ctl & (1UL << 0x3F)) + return 0; + + status = pipe_dma_chan_read(pipe, chan, 0x188); + return !!(status & (1 << 0x1)); +} + +static inline void pipe_dma_chan_clear(struct mwv207_pipe_dma *pipe, int chan) +{ + pipe_dma_chan_write(pipe, chan, 0x198, 1 << 0x1); +} + +static inline int pipe_dma_stop(struct mwv207_pipe_dma *pipe) +{ + pr_info("%s TBD", __func__); + return 0; +} + +static void mwv207_pipe_dma_reset(struct mwv207_pipe *mpipe) +{ + pr_info("%s todo", __func__); +} + +static void pipe_dma_commit(struct mwv207_pipe_dma *pipe) +{ + unsigned long tick; + int chan = 0; + u64 llp; + + if (pipe->cur_idx == 0) + return; + + pipe->last_lli = &pipe->lli[pipe->cur_idx - 1]; + pipe->last_lli->ctl |= (1UL << 0x3E); + + mb(); + + pipe_dma_chan_write(pipe, chan, 0x120, + (0x3<<0x2) + |(0x3<<0x0)); + pipe_dma_chan_write(pipe, chan, 0x124, 0x3b8e0000); + + llp = pipe->lli_bus_addr + 0x800000000ULL; + pipe_dma_chan_write(pipe, chan, 0x128, llp & 0xFFFFFFFF); + pipe_dma_chan_write(pipe, chan, 0x12C, llp >> 32); + + pipe_dma_write(pipe, 0x10, + (1 << 0x1) + |(1 << 0x0)); + + pipe_dma_write(pipe, 0x18, + ((1<cur_idx = 0; +} + +static void pipe_dma_fill_lli(struct mwv207_pipe_dma *pipe, u64 src, u64 dst, u64 len) +{ + struct mwv207_lli *lli; + + if (pipe->cur_idx >= DMA_MAX_LLI_COUNT) + pipe_dma_commit(pipe); + + lli = &pipe->lli[pipe->cur_idx]; + lli->sar = src; + lli->dar = dst; + + if (IS_ALIGNED(src, pipe->alignment) && + IS_ALIGNED(dst, pipe->alignment) && + IS_ALIGNED(len, pipe->alignment)) { + lli->ts = DMA_TS_ALIGNED(len, pipe->alignment); + lli->ctl = DMA_CTL_ALIGNED(pipe->alignment); + } else { + lli->ts = DMA_TS_NOT_ALIGNED(len); + lli->ctl = DMA_CTL_NOT_ALIGNED; + } + +#ifdef MWV207_DMA_DEBUG + { + pr_info("[dma]: lli[%04d] sar = 0x%010llx", pipe->cur_idx, lli->sar); + pr_info("[dma]: lli[%04d] dar = 0x%010llx", pipe->cur_idx, lli->dar); + pr_info("[dma]: lli[%04d] ts = 0x%08x", pipe->cur_idx, lli->ts); + pr_info("[dma]: lli[%04d] llp = 0x%010llx", pipe->cur_idx, lli->llp); + pr_info("[dma]: lli[%04d] ctl = 0x%010llx", pipe->cur_idx, lli->ctl); + } +#endif + pipe->cur_idx++; +} + +static void mwv207_cursor_init(struct mwv207_dma_cursor *cursor, struct mwv207_dma_loc *loc, + u64 width, u64 stride) +{ + cursor->width = width; + cursor->stride = stride; + cursor->is_vram = MWV207_DMA_IS_VRAM(loc->pg_nr_type); + if (cursor->is_vram) { + cursor->line_pos = loc->base + loc->offset; + cursor->cur_pos = cursor->line_pos; + cursor->dma_address = NULL; + cursor->nr_pages = ((loc->pg_nr_type) & ~(1ULL << 63)); + } else { + cursor->line_pos = loc->offset; + cursor->cur_pos = cursor->line_pos; + cursor->dma_address = (dma_addr_t *)loc->base; + cursor->nr_pages = ((loc->pg_nr_type) & ~(1ULL << 63)); + } +} + +static void mwv207_cursor_reset(struct mwv207_dma_cursor *cursor, struct mwv207_dma_loc *loc) +{ + if (cursor->is_vram) { + cursor->line_pos = loc->base + loc->offset; + cursor->cur_pos = cursor->line_pos; + } else { + cursor->line_pos = loc->offset; + cursor->cur_pos = cursor->line_pos; + } +} + +static inline u64 cursor_seg_len(struct mwv207_dma_cursor *cursor) +{ + u64 len = cursor->line_pos + cursor->width - cursor->cur_pos; + u64 offset, idx, contig_len; + + if (cursor->is_vram) + return len; + offset = cursor->cur_pos & (PAGE_SIZE - 1); + idx = cursor->cur_pos >> PAGE_SHIFT; + + contig_len = PAGE_SIZE - offset; + while (contig_len < len && + idx + 1 < cursor->nr_pages && + cursor->dma_address[idx] + PAGE_SIZE == cursor->dma_address[idx + 1]) { + contig_len += PAGE_SIZE; + idx++; + } + return min_t(u64, len, contig_len); +} + +static inline u64 cursor_axi(struct mwv207_dma_cursor *cursor) +{ + u64 idx, offset; + + if (cursor->is_vram) + return cursor->cur_pos; + + idx = cursor->cur_pos >> PAGE_SHIFT; + offset = cursor->cur_pos & (PAGE_SIZE - 1); + return 0x800000000ULL + cursor->dma_address[idx] + offset; +} + +static inline void cursor_advance(struct mwv207_dma_cursor *cursor, u64 len) +{ + BUG_ON(cursor->cur_pos + len > cursor->line_pos + cursor->width); + + if (cursor->cur_pos + len == cursor->line_pos + cursor->width) { + cursor->line_pos += cursor->stride; + cursor->cur_pos = cursor->line_pos; + } else + cursor->cur_pos += len; +} + +static void pipe_dma_flush(struct mwv207_pipe_dma *pipe, + struct mwv207_dma_cursor *cursor, u64 size) +{ + u64 remain, len; + + if (cursor->is_vram || pipe->coherent) + return; + + for (remain = size; remain > 0; remain -= len) { + len = min_t(u64, cursor_seg_len(cursor), remain); + dma_sync_single_for_device(pipe->base.jdev->dev, + cursor_axi(cursor) - 0x800000000ULL, + len, DMA_TO_DEVICE); + cursor_advance(cursor, len); + } +} + +static void pipe_dma_invalidate(struct mwv207_pipe_dma *pipe, + struct mwv207_dma_cursor *cursor, u64 size) +{ + u64 remain, len; + + if (cursor->is_vram || pipe->coherent) + return; + + for (remain = size; remain > 0; remain -= len) { + len = min_t(u64, cursor_seg_len(cursor), remain); + dma_sync_single_for_cpu(pipe->base.jdev->dev, + cursor_axi(cursor) - 0x800000000ULL, + len, DMA_FROM_DEVICE); + cursor_advance(cursor, len); + } +} + +static struct dma_fence *mwv207_pipe_dma_submit(struct mwv207_pipe *mpipe, + struct mwv207_job *mjob) +{ + struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); + struct mwv207_dma_cmd *cmd = (struct mwv207_dma_cmd *)mjob->cmds; + struct mwv207_dma_cursor src, dst; + u64 remain, len; + + BUG_ON(mjob->cmd_size != sizeof(struct mwv207_dma_cmd)); + + mwv207_cursor_init(&src, &cmd->src, cmd->width, cmd->src.stride); + pipe_dma_flush(pipe, &src, cmd->width * cmd->height); + + mwv207_cursor_reset(&src, &cmd->src); + mwv207_cursor_init(&dst, &cmd->dst, cmd->width, cmd->dst.stride); + for (remain = cmd->width * cmd->height; remain > 0; remain -= len) { + len = min_t(u64, cursor_seg_len(&src), 0x400000); + len = min_t(u64, cursor_seg_len(&dst), len); + len = min_t(u64, len, remain); + + pipe_dma_fill_lli(pipe, cursor_axi(&src), cursor_axi(&dst), len); + + cursor_advance(&src, len); + cursor_advance(&dst, len); + } + mwv207_pipe_record_busy(mpipe); + pipe_dma_commit(pipe); + + mwv207_cursor_reset(&dst, &cmd->dst); + pipe_dma_invalidate(pipe, &dst, cmd->width * cmd->height); + + return dma_fence_get_stub(); +} + +static void mwv207_pipe_dma_dump_state(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); + pr_info("%s todo: %p", __func__, pipe); +} + +static void mwv207_pipe_dma_destroy(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_dma *pipe = to_dma_pipe(mpipe); + + pr_info("%s todo: %p", __func__, pipe); + +} + +struct mwv207_pipe *mwv207_pipe_dma_create(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info) +{ + struct mwv207_pipe_dma *pipe; + u64 llp; + int i; + + pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_dma), GFP_KERNEL); + if (!pipe) + return NULL; + + pipe->base.jdev = jdev; + pipe->base.fname = info->name; + pipe->base.regbase = jdev->mmio + info->reg_base; + pipe->base.iosize = 16 * 1024; + pipe->base.submit = mwv207_pipe_dma_submit; + pipe->base.reset = mwv207_pipe_dma_reset; + pipe->base.destroy = mwv207_pipe_dma_destroy; + pipe->base.dump_state = mwv207_pipe_dma_dump_state; + + pipe->coherent = true; + + pipe->alignment = jdev->lite ? 32 : 64; + pipe->unit = info->id; + + pipe->lli = dmam_alloc_coherent(jdev->dev, + sizeof(struct mwv207_lli) * DMA_MAX_LLI_COUNT, + &pipe->lli_bus_addr, GFP_KERNEL); + if (!pipe->lli) + return NULL; + + memset(pipe->lli, 0, sizeof(struct mwv207_lli) * DMA_MAX_LLI_COUNT); + llp = pipe->lli_bus_addr + 0x800000000ULL; + for (i = 0; i < DMA_MAX_LLI_COUNT; i++) { + llp += sizeof(struct mwv207_lli); + pipe->lli[i].llp = llp; + } + pipe->cur_idx = 0; + + mwv207_pipe_dma_reset(&pipe->base); + return &pipe->base; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_enc.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_enc.c new file mode 100644 index 0000000000000000000000000000000000000000..c2b2affb2fca0aac2e4d14e74df100ce1b7a82a6 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_pipe_enc.c @@ -0,0 +1,257 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include "mwv207_pipe_codec_common.h" + +#define JPIPE_STATUS_ALL \ + (0x1000 | 0x200 | \ + 0x100 | 0x80 | \ + 0x40 | 0x20 | \ + 0x10 | 0x8 | 0x4) + +#define to_enc_pipe(pipe) container_of(pipe, struct mwv207_pipe_enc, base) +struct pipe_enc_fence; +struct mwv207_pipe_enc { + struct mwv207_pipe base; + + u64 fence_ctx; + u64 fence_seqno; + spinlock_t fence_lock; + + struct pipe_enc_fence *current_fence; + struct task_struct *poll_thread; + struct pipe_codec_sw_pp sw_pp; +}; + +#define to_pipe_enc_fence(f) container_of(f, struct pipe_enc_fence, base) +struct pipe_enc_fence { + struct dma_fence base; + struct mwv207_pipe_enc *pipe; + struct list_head node; +}; + +static inline void pipe_enc_write(struct mwv207_pipe_enc *pipe, u32 reg, u32 value) +{ + pipe_write(&pipe->base, reg, value); +} + +static inline u32 pipe_enc_read(struct mwv207_pipe_enc *pipe, u32 reg) +{ + return pipe_read(&pipe->base, reg); +} + +static const char *pipe_enc_fence_get_driver_name(struct dma_fence *fence) +{ + return "mwv207"; +} + +static const char *pipe_enc_fence_get_timeline_name(struct dma_fence *fence) +{ + return to_pipe_enc_fence(fence)->pipe->base.fname; +} + +static void pipe_enc_fence_release(struct dma_fence *fence) +{ + struct pipe_enc_fence *f = to_pipe_enc_fence(fence); + + kfree_rcu(f, base.rcu); +} + +static const struct dma_fence_ops pipe_enc_fence_ops = { + .get_driver_name = pipe_enc_fence_get_driver_name, + .get_timeline_name = pipe_enc_fence_get_timeline_name, + .release = pipe_enc_fence_release, +}; + +static void pipe_enc_stat_reset(struct mwv207_pipe_enc *pipe, u32 stat) +{ + if (stat & 0x20) + pipe_enc_write(pipe, 0x14, 0); + + pipe_enc_write(pipe, 0x4, stat & (~0x1FD)); +} + +static int pipe_enc_polling(void *priv) +{ + struct mwv207_pipe_enc *pipe = priv; + struct pipe_enc_fence *fence; + u32 stat; + + set_freezable(); + while (!kthread_should_stop()) { + usleep_range(1000, 1001); + try_to_freeze(); + + fence = smp_load_acquire(&pipe->current_fence); + if (fence == NULL) + continue; + + stat = pipe_enc_read(pipe, 0x4); + if (!(stat & JPIPE_STATUS_ALL)) + continue; + + pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); + pipe_enc_stat_reset(pipe, stat); + + smp_store_release(&pipe->current_fence, NULL); + + dma_fence_signal(&fence->base); + dma_fence_put(&fence->base); + } + + return 0; +} + +static void mwv207_pipe_enc_reset(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); + struct pipe_enc_fence *fence; + int i; + + pipe_codec_sw_pp_reset(&pipe->sw_pp); + + pipe_enc_write(pipe, 0x14, 0); + + for (i = 4; i < pipe->base.iosize; i += 0x4) + pipe_enc_write(pipe, i, 0); + + fence = smp_load_acquire(&pipe->current_fence); + if (fence) { + dma_fence_put(&fence->base); + + smp_store_release(&pipe->current_fence, NULL); + } +} + +static struct dma_fence *mwv207_pipe_enc_submit(struct mwv207_pipe *mpipe, + struct mwv207_job *mjob) +{ + struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); + struct pipe_enc_fence *fence; + int i, nr, pos, cmdlen; + bool hw_run = 0; + u32 cmd, reg; + + fence = smp_load_acquire(&pipe->current_fence); + if (fence) + return ERR_PTR(-EBUSY); + + for (pos = 0; pos <= mjob->cmd_size - 4; pos += cmdlen) { + cmd = *(u32 *)(mjob->cmds + pos); + switch ((cmd >> 27) & 0x1f) { + case 0x01: + if ((cmd >> 26) & 0x1) + return ERR_PTR(-EINVAL); + reg = (cmd & 0xffff) * 4; + nr = (cmd >> 16) & 0x3ff; + if (nr == 0) + nr = 1024; + for (i = pos + 4; i <= pos + nr * 4 + && i <= mjob->cmd_size - 4 + && reg <= pipe->base.iosize - 4; + i += 4, reg += 4) { + if (reg == 20) { + pipe_enc_read(pipe, 0x14); + hw_run = (*(u32 *)(mjob->cmds + i)) & 0x1; + + mb(); + } + pipe_enc_write(pipe, reg, *(u32 *)(mjob->cmds + i)); + } + + if (i <= pos + nr * 4) + dev_dbg(mpipe->jdev->dev, + "mwv207: invalid enc register writes dropped"); + + cmdlen = ALIGN(4 + nr * 4, 8); + break; + case 0x02: + pipe_codec_sw_pp_submit(&pipe->sw_pp, &pipe->base, mjob, pos, &cmdlen); + break; + default: + + return ERR_PTR(-EINVAL); + } + } + + fence = kzalloc(sizeof(struct pipe_enc_fence), GFP_KERNEL); + if (!fence) + return ERR_PTR(-ENOMEM); + fence->pipe = pipe; + dma_fence_init(&fence->base, &pipe_enc_fence_ops, &pipe->fence_lock, + pipe->fence_ctx, ++pipe->fence_seqno); + + if (hw_run) { + dma_fence_get(&fence->base); + + smp_store_release(&pipe->current_fence, fence); + } else { + pipe_codec_sw_pp_excute(&pipe->sw_pp, &pipe->base); + dma_fence_signal(&fence->base); + } + + return &fence->base; +} + +static void mwv207_pipe_enc_dump_state(struct mwv207_pipe *mpipe) +{ + pr_info("%s irq state reg: 0x%08x", mpipe->fname, + pipe_read(mpipe, 0x4)); +} + +static void mwv207_pipe_enc_destroy(struct mwv207_pipe *mpipe) +{ + struct mwv207_pipe_enc *pipe = to_enc_pipe(mpipe); + + kthread_stop(pipe->poll_thread); +} + +struct mwv207_pipe *mwv207_pipe_enc_create(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info) +{ + struct mwv207_pipe_enc *pipe; + + if (jdev->lite) + return NULL; + + pipe = devm_kzalloc(jdev->dev, sizeof(struct mwv207_pipe_enc), GFP_KERNEL); + if (!pipe) + return NULL; + + pipe->base.jdev = jdev; + pipe->base.fname = info->name; + pipe->base.regbase = jdev->mmio + info->reg_base; + pipe->base.iosize = 0x1F4 * 4; + pipe->base.submit = mwv207_pipe_enc_submit; + pipe->base.reset = mwv207_pipe_enc_reset; + pipe->base.destroy = mwv207_pipe_enc_destroy; + pipe->base.dump_state = mwv207_pipe_enc_dump_state; + + spin_lock_init(&pipe->fence_lock); + pipe->fence_ctx = dma_fence_context_alloc(1); + pipe->fence_seqno = 0; + + mwv207_pipe_enc_reset(&pipe->base); + + pipe->poll_thread = kthread_run(pipe_enc_polling, pipe, "enc_polling"); + if (IS_ERR(pipe->poll_thread)) + return NULL; + + return &pipe->base; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_sched.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_sched.c new file mode 100644 index 0000000000000000000000000000000000000000..361631be7c0fede4dab9db16c95d96a2e56b7691 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_sched.c @@ -0,0 +1,537 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include "mwv207_drv.h" +#include "mwv207_drm.h" +#include "mwv207_sched.h" +#include "mwv207_bo.h" +#include "mwv207_ctx.h" +#include "mwv207_db.h" +#include "mwv207_devfreq.h" +#include "mwv207_monitor.h" + +#define EMPTY_INFO 0xffffffffu + +static int dump_hang_job = 1; +module_param(dump_hang_job, int, 0644); +MODULE_PARM_DESC(dump_hang_job, "dump time out job"); + +static unsigned long pipe_usage_period = 50; +module_param(pipe_usage_period, ulong, 0444); +MODULE_PARM_DESC(pipe_usage_period, "pipe usage calculation period in ms"); + +struct mwv207_sched_info { + struct mwv207_pipe *(*create)(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info); + unsigned int hw_submission; + unsigned int hang_limit; + long timeout; + struct mwv207_pipe_info pipes[0x2]; +}; + +static struct mwv207_sched_info mwv207_sched_pipe_info[0x5] = { + [0x0] = { + .create = mwv207_pipe_3d_create, + .hw_submission = 30, + .hang_limit = 5, + .timeout = 2000, + .pipes = { + { "mwv207_3d0", 0, 0x900000, 64, 0 }, + { "mwv207_3d1", 1, 0x910000, 64, 0 }, + } + }, + [0x1] = { + .create = mwv207_pipe_dec_create, + .hw_submission = 1, + .hang_limit = 5, + .timeout = 2000, + .pipes = { + { "mwv207_dec0", 0, 0x930000, 104, 5 }, + { "mwv207_dec1", 1, 0x940000, 108, 6 }, + } + }, + [0x2] = { + .create = mwv207_pipe_enc_create, + .hw_submission = 1, + .hang_limit = 5, + .timeout = 2000, + .pipes = { + { "mwv207_enc0", 0, 0x920000, 96, 3 }, + } + }, + [0x3] = { + .create = mwv207_pipe_2d_create, + .hw_submission = 30, + .hang_limit = 5, + .timeout = 2000, + .pipes = { + { "mwv207_2d0", 0, 0x968000, 72, 1 }, + } + }, + [0x4] = { + .create = mwv207_pipe_dma_create, + .hw_submission = 1, + .hang_limit = 5, + .timeout = 2000, + .pipes = { + { "mwv207_dma0", 0, 0x9D0000, 88, 32 }, + } + }, +}; + +static u32 mwv207_pipe_update_usage(struct mwv207_pipe *pipe) +{ + struct mwv207_pipe_usage *usage = &pipe->usage; + unsigned long total_time; + unsigned long busy_time; + unsigned long delta; + u32 record; + ktime_t last; + ktime_t now; + + now = ktime_get(); + last = usage->last_update_time; + + delta = ktime_to_ms(ktime_sub(now, usage->period_start)); + + if (usage->busy_count > 0) + usage->busy_time += ktime_sub(now, last); + else + usage->idle_time += ktime_sub(now, last); + + usage->last_update_time = now; + + if (delta > pipe_usage_period) { + usage->last_busy_time = usage->busy_time; + usage->last_idle_time = usage->idle_time; + usage->busy_time = 0; + usage->idle_time = 0; + usage->period_start = now; + } + + total_time = ktime_to_ns(ktime_add(usage->last_busy_time, + usage->last_idle_time)); + busy_time = ktime_to_ns(usage->last_busy_time); + + if (total_time == 0) + record = 100; + else + record = (int)div64_u64(busy_time, total_time / 100); + + mwv207_monitor_update_pipe_usage(pipe->jdev, pipe->type, + pipe->id, record); + + return record; +} + +u32 mwv207_pipe_get_usage(struct mwv207_device *jdev, + u8 pipe_type, u8 pipe_id) +{ + struct mwv207_pipe *pipe; + unsigned long flags; + u32 usage; + + BUG_ON(pipe_type >= 0x5); + BUG_ON(pipe_id >= 0x2); + + if (pipe_id >= jdev->nr_pipe[pipe_type]) + return EMPTY_INFO; + if (!jdev->sched[pipe_type][pipe_id]) + return EMPTY_INFO; + + pipe = to_mwv207_sched(jdev->sched[pipe_type][pipe_id])->pipe; + + spin_lock_irqsave(&pipe->usage.lock, flags); + + usage = mwv207_pipe_update_usage(pipe); + + spin_unlock_irqrestore(&pipe->usage.lock, flags); + + return usage; +} + +void mwv207_pipe_record_busy(struct mwv207_pipe *pipe) +{ + unsigned long flags; + + spin_lock_irqsave(&pipe->usage.lock, flags); + + mwv207_pipe_update_usage(pipe); + + pipe->usage.busy_count++; + + spin_unlock_irqrestore(&pipe->usage.lock, flags); +} + +void mwv207_pipe_record_idle(struct mwv207_pipe *pipe) +{ + unsigned long flags; + + spin_lock_irqsave(&pipe->usage.lock, flags); + + mwv207_pipe_update_usage(pipe); + + WARN_ON(--pipe->usage.busy_count < 0); + + spin_unlock_irqrestore(&pipe->usage.lock, flags); +} + +static enum drm_mwv207_info_key sched_type_to_key(int type) +{ + switch (type) { + case 0x0: + return DRM_MWV207_ACTIVE_3D_NR; + case 0x1: + return DRM_MWV207_ACTIVE_DEC_NR; + case 0x2: + return DRM_MWV207_ACTIVE_ENC_NR; + case 0x3: + return DRM_MWV207_ACTIVE_2D_NR; + case 0x4: + return DRM_MWV207_ACTIVE_DMA_NR; + default: + BUG_ON(1); + return 0; + } +} + +struct mwv207_job *mwv207_job_alloc(void) +{ + struct mwv207_job *mjob; + + mjob = kzalloc(sizeof(*mjob), GFP_KERNEL); + if (!mjob) + return NULL; + + kref_init(&mjob->refcount); + INIT_LIST_HEAD(&mjob->tvblist); + return mjob; +} + +static void mwv207_job_fini(struct kref *kref) +{ + struct mwv207_job *mjob = container_of(kref, struct mwv207_job, refcount); + struct mwv207_tvb *mtvb; + struct mwv207_submit_cmd_dat *dat; + int i; + + dma_fence_put(mjob->fence_in); + if (mjob->base.s_fence) + drm_sched_job_cleanup(&mjob->base); + + mwv207_for_each_mtvb(mtvb, mjob) { + for (i = 0; i < mtvb->nr_shared; ++i) + dma_fence_put(mtvb->shared[i]); + dma_fence_put(mtvb->excl); + kfree(mtvb->shared); + if (mtvb->base.bo) + mwv207_bo_unref(to_jbo(mtvb->base.bo)); + } + + if (mjob->nr_cmd_dat) { + for (i = 0; i < mjob->nr_cmd_dat; ++i) { + dat = &mjob->cmd_dats[i]; + kvfree(dat->dat); + kvfree(dat->relocs); + mwv207_bo_unref(dat->jbo); + } + } + + if (mjob->ctx) + mwv207_ctx_put(mjob->ctx); + + kvfree(mjob->cmd_dats); + kvfree(mjob->mtvb); + kvfree(mjob->relocs); + kvfree(mjob->cmds); + + kfree(mjob); +} + +struct mwv207_job *mwv207_job_get(struct mwv207_job *mjob) +{ + kref_get(&mjob->refcount); + return mjob; +} + +void mwv207_job_put(struct mwv207_job *mjob) +{ + kref_put(&mjob->refcount, mwv207_job_fini); +} + +static void mwv207_sched_dump_job(struct mwv207_job *mjob) +{ + int lines, i; + u32 *cmd; + + cmd = (u32 *)mjob->cmds; + lines = (mjob->cmd_size / 4) & ~0x3; + for (i = 0; i < lines; i += 4) { + pr_info("0x%08x : %08x %08x %08x %08x", i, + cmd[i], cmd[i+1], cmd[i+2], cmd[i+3]); + } + + switch (mjob->cmd_size / 4 - lines) { + case 0: + return; + case 1: + pr_info("0x%08x : %08x", i, cmd[i]); + break; + case 2: + pr_info("0x%08x : %08x %08x", i, cmd[i], cmd[i+1]); + break; + case 3: + pr_info("0x%08x : %08x %08x %08x", i, + cmd[i], cmd[i+1], cmd[i+2]); + break; + default: + pr_err("should never happen"); + break; + + } +} + +static struct dma_fence *mwv207_sched_dependency(struct drm_sched_job *job, + struct drm_sched_entity *entity) +{ + struct mwv207_job *mjob = to_mwv207_job(job); + struct mwv207_tvb *mtvb; + struct dma_fence *fence; + int i; + + if (unlikely(mjob->fence_in)) { + fence = mjob->fence_in; + mjob->fence_in = NULL; + if (!dma_fence_is_signaled(fence)) + return fence; + dma_fence_put(fence); + } + + mwv207_for_each_mtvb(mtvb, mjob) { + if (mtvb->excl) { + fence = mtvb->excl; + mtvb->excl = NULL; + if (!dma_fence_is_signaled(fence)) + return fence; + dma_fence_put(fence); + } + + for (i = 0; i < mtvb->nr_shared; i++) { + if (!mtvb->shared[i]) + continue; + fence = mtvb->shared[i]; + mtvb->shared[i] = NULL; + if (!dma_fence_is_signaled(fence)) + return fence; + dma_fence_put(fence); + } + kfree(mtvb->shared); + mtvb->nr_shared = 0; + mtvb->shared = NULL; + } + + return NULL; +} + +static struct dma_fence *mwv207_sched_run_job(struct drm_sched_job *job) +{ + struct mwv207_sched *sched = to_mwv207_sched(job->sched); + struct dma_fence *fence; + + if (unlikely(job->s_fence->finished.error)) + return ERR_PTR(-ECANCELED); + + mwv207_devfreq_record_busy(sched->pipe); + + fence = sched->pipe->submit(sched->pipe, to_mwv207_job(job)); + if (IS_ERR_OR_NULL(fence)) + DRM_ERROR("%s: submit failed, errcode=%ld", + sched->pipe->fname, PTR_ERR(fence)); + return fence; +} + +static enum drm_gpu_sched_stat +mwv207_sched_timedout_job(struct drm_sched_job *job) +{ + struct mwv207_sched *sched = to_mwv207_sched(job->sched); + struct mwv207_job *mjob = to_mwv207_job(job); + struct drm_sched_job *timedout_job; + + pr_info("mwv207: job from '%s' to '%s', timed out!", + mjob->comm, sched->pipe->fname); + + drm_sched_stop(&sched->base, job); + + if (dump_hang_job) { + sched->pipe->dump_state(sched->pipe); + mwv207_sched_dump_job(mjob); + } + + drm_sched_increase_karma(job); + + sched->pipe->reset(sched->pipe); + + list_for_each_entry(timedout_job, &sched->base.pending_list, list) + mwv207_devfreq_record_idle(sched->pipe); + + drm_sched_resubmit_jobs(&sched->base); + + drm_sched_start(&sched->base, true); + + return DRM_GPU_SCHED_STAT_NOMINAL; +} + +static void mwv207_sched_free_job(struct drm_sched_job *job) +{ + struct mwv207_job *mjob = to_mwv207_job(job); + + mwv207_job_put(mjob); +} + +static const struct drm_sched_backend_ops mwv207_sched_ops = { + .prepare_job = mwv207_sched_dependency, + .run_job = mwv207_sched_run_job, + .timedout_job = mwv207_sched_timedout_job, + .free_job = mwv207_sched_free_job, +}; + +static struct drm_gpu_scheduler * +mwv207_sched_create(struct mwv207_device *jdev, struct mwv207_pipe *pipe, + unsigned int hw_submission, unsigned int hang_limit, + long timeout) +{ + struct mwv207_sched *sched; + int ret; + + if (pipe == NULL) + return NULL; + + sched = devm_kzalloc(jdev->dev, sizeof(struct mwv207_sched), GFP_KERNEL); + if (!sched) + goto err; + + sched->pipe = pipe; + + ret = drm_sched_init(&sched->base, &mwv207_sched_ops, hw_submission, hang_limit, + msecs_to_jiffies(timeout), NULL, NULL, pipe->fname, jdev->dev); + if (ret) + goto err; + + return &sched->base; +err: + sched->pipe->destroy(sched->pipe); + return NULL; +} + +static void mwv207_sched_destroy(struct drm_gpu_scheduler *sched) +{ + struct mwv207_sched *msched = to_mwv207_sched(sched); + + if (sched == NULL) + return; + + drm_sched_fini(sched); + msched->pipe->destroy(msched->pipe); +} + +static int mwv207_sched_pipe_create(struct mwv207_device *jdev, int type) +{ + struct mwv207_sched_info *info = &mwv207_sched_pipe_info[type]; + struct mwv207_pipe *pipe; + int i; + + BUG_ON(jdev->hw.nr_pipe[type] > 0x2); + + for (i = 0; i < jdev->hw.nr_pipe[type]; i++) { + if (!info->pipes[i].reg_base) + break; + pipe = info->create(jdev, &info->pipes[i]); + if (!pipe) + break; + jdev->sched[type][i] = mwv207_sched_create(jdev, pipe, + info->hw_submission, + info->hang_limit, + info->timeout); + if (!jdev->sched[type][i]) { + pr_err("error, create %s failed", info->pipes[i].name); + break; + } + } + + return i; +} + +int mwv207_sched_suspend(struct mwv207_device *jdev) +{ + struct mwv207_sched *sched; + int i, j; + + for (i = 0; i < 0x5; i++) { + for (j = 0; j < 0x2; j++) { + if (!jdev->sched[i][j]) + continue; + + sched = to_mwv207_sched(jdev->sched[i][j]); + + if (atomic_read(&jdev->sched[i][j]->hw_rq_count)) + return -EBUSY; + } + } + + return 0; +} + +int mwv207_sched_resume(struct mwv207_device *jdev) +{ + struct mwv207_sched *sched; + int i, j; + + for (i = 0; i < 0x5; i++) { + for (j = 0; j < 0x2; j++) { + if (!jdev->sched[i][j]) + continue; + sched = to_mwv207_sched(jdev->sched[i][j]); + sched->pipe->reset(sched->pipe); + } + } + + return 0; +} +int mwv207_sched_init(struct mwv207_device *jdev) +{ + int i; + + for (i = 0; i < 0x5; i++) { + jdev->nr_pipe[i] = mwv207_sched_pipe_create(jdev, i); + mwv207_db_add(jdev, sched_type_to_key(i), jdev->nr_pipe[i]); + } + + return 0; +} + +void mwv207_sched_fini(struct mwv207_device *jdev) +{ + int i, j; + + for (i = 0; i < 0x5; ++i) { + for (j = 0; j < 0x2; j++) { + if (!jdev->sched[i][j]) + continue; + mwv207_sched_destroy(jdev->sched[i][j]); + } + } + +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_sched.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_sched.h new file mode 100644 index 0000000000000000000000000000000000000000..12927279ac9069fb46879647bf026f4c945532d2 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_sched.h @@ -0,0 +1,177 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_SCHED_H_TGQQ2LXS +#define MWV207_SCHED_H_TGQQ2LXS +#include +#include +#include +#include "mwv207_drv.h" +#include "mwv207_bo.h" + +struct mwv207_submit_cmd_dat { + int nr_relocs; + int dat_size; + struct drm_mwv207_submit_reloc *relocs; + char *dat; + struct mwv207_bo *jbo; +}; + +struct mwv207_tvb { + struct ttm_validate_buffer base; + struct dma_fence *excl; + unsigned int nr_shared; + struct dma_fence **shared; +}; + +#define to_mwv207_job(job) container_of(job, struct mwv207_job, base) +struct mwv207_job { + struct drm_sched_job base; + + struct list_head tvblist; + struct mwv207_tvb *mtvb; + int nr_bos; + + struct drm_mwv207_submit_reloc *relocs; + int nr_relocs; + + struct mwv207_submit_cmd_dat *cmd_dats; + int nr_cmd_dat; + + char *cmds; + int cmd_size; + + struct dma_fence *fence_in; + struct mutex *qlock; + + struct mwv207_ctx *ctx; + struct drm_sched_entity *engine_entity; + + struct kref refcount; + + bool is_dma; + + char comm[TASK_COMM_LEN]; +}; +#define mwv207_for_each_mtvb(mtvb, mjob) list_for_each_entry(mtvb, &(mjob)->tvblist, base.head) + +struct mwv207_job *mwv207_job_alloc(void); +struct mwv207_job *mwv207_job_get(struct mwv207_job *mjob); +void mwv207_job_put(struct mwv207_job *mjob); + +static inline struct mwv207_bo *mwv207_job_bo(struct mwv207_job *mjob, int idx) +{ + BUG_ON(idx >= mjob->nr_bos + mjob->nr_cmd_dat); + return to_jbo(mjob->mtvb[idx].base.bo); +} + +struct mwv207_dma_loc { + u64 base; + u64 pg_nr_type; + u64 offset; + u64 stride; +}; +#define MWV207_DMA_NR_PAGES_VRAM(nr) ((nr) | (0ULL << 63)) +#define MWV207_DMA_NR_PAGES_RAM(nr) ((nr) | (1ULL << 63)) +#define MWV207_DMA_NR_PAGES(nr) ((nr) & ~(1ULL << 63)) +#define MWV207_DMA_IS_VRAM(nr) (((nr) >> 63) == 0) + +struct mwv207_dma_cmd { + struct mwv207_dma_loc src; + struct mwv207_dma_loc dst; + u64 width; + u64 height; +}; + +struct mwv207_pipe_info { + char name[12]; + int id; + u32 reg_base; + u32 pf_irq; + u32 vf_irq; +}; + +struct mwv207_pipe_usage { + spinlock_t lock; + ktime_t busy_time; + ktime_t idle_time; + ktime_t period_start; + ktime_t last_busy_time; + ktime_t last_idle_time; + ktime_t last_update_time; + int busy_count; +}; + +struct devfreq; +#define to_mwv207_sched(sched) container_of(sched, struct mwv207_sched, base) +struct mwv207_pipe { + struct dma_fence* (*submit)(struct mwv207_pipe *pipe, struct mwv207_job *job); + void (*reset)(struct mwv207_pipe *pipe); + void (*destroy)(struct mwv207_pipe *pipe); + void (*dump_state)(struct mwv207_pipe *pipe); + const char *fname; + int iosize; + void __iomem *regbase; + + struct device *dev; + struct devfreq *devfreq; + spinlock_t devfreq_lock; + int busy_count; + int pll_id; + u8 type; + u8 id; + ktime_t busy_time; + ktime_t idle_time; + ktime_t time_last_update; + struct mwv207_pipe_usage usage; + struct mwv207_device *jdev; +}; + +struct mwv207_sched { + struct drm_gpu_scheduler base; + struct mwv207_pipe *pipe; +}; + +static inline void pipe_write(struct mwv207_pipe *pipe, u32 reg, u32 value) +{ + writel_relaxed(value, pipe->regbase + reg); +} + +static inline u32 pipe_read(struct mwv207_pipe *pipe, u32 reg) +{ + return readl(pipe->regbase + reg); +} + +int mwv207_sched_init(struct mwv207_device *jdev); +void mwv207_sched_fini(struct mwv207_device *jdev); +int mwv207_sched_suspend(struct mwv207_device *jdev); +int mwv207_sched_resume(struct mwv207_device *jdev); + +void mwv207_pipe_record_busy(struct mwv207_pipe *pipe); +void mwv207_pipe_record_idle(struct mwv207_pipe *pipe); +u32 mwv207_pipe_get_usage(struct mwv207_device *mdev, + u8 pipe_type, u8 pipe_id); + +struct mwv207_pipe *mwv207_pipe_3d_create(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info); +struct mwv207_pipe *mwv207_pipe_2d_create(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info); +struct mwv207_pipe *mwv207_pipe_dma_create(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info); +struct mwv207_pipe *mwv207_pipe_dec_create(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info); +struct mwv207_pipe *mwv207_pipe_enc_create(struct mwv207_device *jdev, + const struct mwv207_pipe_info *info); +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_submit.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_submit.c new file mode 100644 index 0000000000000000000000000000000000000000..91f5dde313b221adfe894831c6637045f096fb18 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_submit.c @@ -0,0 +1,630 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include "mwv207_drm.h" +#include "mwv207_submit.h" +#include "mwv207_sched.h" +#include "mwv207_ctx.h" +#include "mwv207_bo.h" +#include "mwv207_gem.h" + +static inline int mwv207_submit_select_engine(struct drm_device *dev, + struct mwv207_job *mjob, + struct drm_mwv207_submit *args) +{ + struct mwv207_device *jdev = drm_to_jdev(dev); + struct mwv207_ctx_entity *centity; + int idmax, id; + + if (unlikely(args->engine_type >= 0x5)) + return -EINVAL; + idmax = jdev->nr_pipe[args->engine_type]; + if (unlikely(idmax <= 0)) + return -ENODEV; + + id = args->engine_id; + if (id == 0xFFFFFFFF) + id = idmax; + else if (unlikely(id < 0 || id > idmax)) + return -ENODEV; + centity = mjob->ctx->centities[args->engine_type][id]; + if (unlikely(!centity)) + return -ENODEV; + mjob->engine_entity = ¢ity->entity; + mjob->qlock = ¢ity->qlock; + + if (args->engine_type == 0x4) + mjob->is_dma = true; + + return 0; +} + +static int mwv207_submit_init_job_reloc(struct mwv207_job *mjob, struct drm_mwv207_submit *args) +{ + if ((int)args->nr_relocs < 0) + return -EINVAL; + mjob->nr_relocs = (int)args->nr_relocs; + if (mjob->nr_relocs == 0) + return 0; + if (args->relocs == 0) + return -EINVAL; + + mjob->relocs = kvmalloc_array(mjob->nr_relocs, + sizeof(struct drm_mwv207_submit_reloc), GFP_KERNEL); + + return copy_from_user(mjob->relocs, (void __user *)args->relocs, + sizeof(struct drm_mwv207_submit_reloc) * mjob->nr_relocs); +} + +static int mwv207_submit_init_job_bo(struct mwv207_job *mjob, + struct drm_mwv207_submit *args, struct drm_file *filp) +{ + struct drm_mwv207_bo_acc ubos_stack[0x20]; + struct drm_mwv207_bo_acc *ubos = ubos_stack; + struct ttm_validate_buffer *tvb; + struct drm_gem_object *gobj; + int ret = 0, i; + + if ((int)args->nr_bos < 0) + return -EINVAL; + + mjob->nr_bos = (int)args->nr_bos; + if (mjob->nr_bos == 0) { + if (mjob->nr_cmd_dat) + goto setup_mtvb; + return 0; + } + + if (!args->bos) + return -EINVAL; + + if (mjob->nr_bos > 0x20) + ubos = kvmalloc_array(mjob->nr_bos, sizeof(*ubos), GFP_KERNEL); + if (unlikely(!ubos)) + return -ENOMEM; + + ret = copy_from_user(ubos, (void __user *)args->bos, + mjob->nr_bos * sizeof(*ubos)); + if (ret) + goto out; +setup_mtvb: + mjob->mtvb = kvcalloc(mjob->nr_bos + mjob->nr_cmd_dat, + sizeof(struct mwv207_tvb), GFP_KERNEL); + if (!mjob->mtvb) { + ret = -ENOMEM; + goto out; + } + spin_lock(&filp->table_lock); + for (i = 0; i < mjob->nr_bos; i++) { + tvb = &mjob->mtvb[i].base; + tvb->num_shared = (ubos[i].flags & 0x1) ? 0 : 1; + gobj = idr_find(&filp->object_idr, ubos[i].handle); + if (unlikely(!gobj)) { + spin_unlock(&filp->table_lock); + ret = -ENOENT; + goto out; + } + tvb->bo = &mwv207_bo_ref(mwv207_bo_from_gem(gobj))->tbo; + list_add_tail(&tvb->head, &mjob->tvblist); + } + spin_unlock(&filp->table_lock); + for (i = 0; i < mjob->nr_cmd_dat; i++) { + tvb = &mjob->mtvb[mjob->nr_bos + i].base; + tvb->num_shared = 0; + tvb->bo = &mwv207_bo_ref(mjob->cmd_dats[i].jbo)->tbo; + list_add_tail(&tvb->head, &mjob->tvblist); + } +out: + if (unlikely(ubos != ubos_stack)) + kvfree(ubos); + + return ret; +} + +static int mwv207_submit_init_job_cmd(struct mwv207_job *mjob, struct drm_mwv207_submit *args) +{ + mjob->cmd_size = args->cmd_size; + if ((int)mjob->cmd_size <= 0) + return -EINVAL; + + if (mjob->cmd_size > 0x20000) + return -E2BIG; + + if (args->cmds == 0) + return -EINVAL; + + if (mjob->is_dma) + mjob->cmds = kmalloc(args->cmd_size, GFP_KERNEL); + else + mjob->cmds = kvmalloc(args->cmd_size, GFP_KERNEL); + if (!mjob->cmds) + return -ENOMEM; + + return copy_from_user(mjob->cmds, (void __user *)args->cmds, mjob->cmd_size); +} + +static int mwv207_submit_init_job_cmd_dat(struct drm_device *dev, + struct mwv207_job *mjob, struct drm_mwv207_submit *args) +{ + struct drm_mwv207_submit_cmd_dat udats_stack[0x8]; + struct drm_mwv207_submit_cmd_dat *udats = udats_stack; + struct mwv207_device *jdev = ddev_to_jdev(dev); + struct mwv207_submit_cmd_dat *mdat; + int ret, i; + + if ((int)args->nr_cmd_dat < 0) + return -EINVAL; + mjob->nr_cmd_dat = args->nr_cmd_dat; + if (mjob->nr_cmd_dat == 0) + return 0; + if (args->cmd_dats == 0) + return -EINVAL; + if (mjob->nr_cmd_dat > 0x8) + udats = kvmalloc_array(mjob->nr_cmd_dat, + sizeof(struct drm_mwv207_submit_cmd_dat), GFP_KERNEL); + + if (unlikely(!udats)) + return -ENOMEM; + + mjob->cmd_dats = kvcalloc(mjob->nr_cmd_dat, + sizeof(struct mwv207_submit_cmd_dat), GFP_KERNEL); + if (!mjob->cmd_dats) { + ret = -ENOMEM; + goto out; + } + + ret = copy_from_user(udats, (void __user *)args->cmd_dats, + mjob->nr_cmd_dat * sizeof(struct drm_mwv207_submit_cmd_dat)); + if (ret) + goto out; + + for (i = 0; i < mjob->nr_cmd_dat; ++i) { + if ((int)udats[i].nr_relocs < 0) { + ret = -EINVAL; + goto out; + } + if ((int)udats[i].dat_size <= 0 || udats[i].dat == 0) { + ret = -EINVAL; + goto out; + } + if (udats[i].nr_relocs != 0 && udats[i].relocs == 0) { + ret = -EINVAL; + goto out; + } + if (udats[i].dat_size > 0x20000) { + ret = -E2BIG; + goto out; + } + mdat = &mjob->cmd_dats[i]; + mdat->nr_relocs = udats[i].nr_relocs; + if (mdat->nr_relocs) { + mdat->relocs = kvmalloc_array(mdat->nr_relocs, + sizeof(struct drm_mwv207_submit_reloc), GFP_KERNEL); + if (!mdat->relocs) { + ret = -ENOMEM; + goto out; + } + ret = copy_from_user(mdat->relocs, (void __user *)udats[i].relocs, + mdat->nr_relocs * sizeof(struct drm_mwv207_submit_reloc)); + if (ret) + goto out; + } + mdat->dat_size = udats[i].dat_size; + mdat->dat = kvmalloc(mdat->dat_size, GFP_KERNEL); + if (!mdat->dat) { + ret = -ENOMEM; + goto out; + } + ret = copy_from_user(mdat->dat, (void __user *)udats[i].dat, mdat->dat_size); + if (ret) + goto out; + ret = mwv207_bo_create(jdev, mdat->dat_size, 0x1000, false, + 0x2, 0x1, + NULL, NULL, &mdat->jbo); + if (ret) + goto out; + } + +out: + if (unlikely(udats != udats_stack)) + kvfree(udats); + return ret; +} + +static int mwv207_submit_init_job(struct drm_device *dev, struct mwv207_job *mjob, + struct drm_mwv207_submit *args, struct drm_file *filp) +{ + int ret; + + get_task_comm(mjob->comm, current); + + mjob->ctx = mwv207_ctx_lookup(dev, filp, args->ctx); + if (!mjob->ctx) + return -ENOENT; + ret = mwv207_submit_select_engine(dev, mjob, args); + if (ret) + return ret; + ret = mwv207_submit_init_job_cmd_dat(dev, mjob, args); + if (ret) + return ret; + ret = mwv207_submit_init_job_bo(mjob, args, filp); + if (ret) + return ret; + ret = mwv207_submit_init_job_reloc(mjob, args); + if (ret) + return ret; + ret = mwv207_submit_init_job_cmd(mjob, args); + if (ret) + return ret; + + return 0; +} + +static struct mwv207_job *mwv207_submit_init(struct drm_device *dev, struct drm_file *filp, + struct drm_mwv207_submit *args) +{ + struct mwv207_job *mjob; + int ret; + + mjob = mwv207_job_alloc(); + if (!mjob) + return ERR_PTR(-ENOMEM); + + ret = mwv207_submit_init_job(dev, mjob, args, filp); + if (ret) + goto err; + + return mjob; +err: + mwv207_job_put(mjob); + return ERR_PTR(ret); +} + +static int mwv207_submit_patch_entry(struct mwv207_job *mjob, + struct drm_mwv207_submit_reloc *reloc, + struct mwv207_bo *jbo, char *dat, u32 dat_size) +{ + u64 addr, bo_size; + + if (reloc->pad) + return -EINVAL; + + bo_size = mwv207_bo_size(jbo); + if (reloc->bo_offset >= bo_size) + return -ERANGE; + addr = mwv207_bo_gpu_phys(jbo) + reloc->bo_offset; + + switch (reloc->type & 0xffff) { + case 0x0: + if (reloc->cmd_offset + 8 > dat_size) + return -ERANGE; + *(u64 *)(dat + reloc->cmd_offset) = addr; + break; + case 0x1: + if (reloc->cmd_offset + 4 > dat_size) + return -ERANGE; + *(u32 *)(dat + reloc->cmd_offset) = addr & 0xffffffff; + break; + case 0x2: + if (reloc->cmd_offset + 4 > dat_size) + return -ERANGE; + *(u32 *)(dat + reloc->cmd_offset) = addr >> 32; + break; + case 0x3: + if (reloc->cmd_offset + 2 > dat_size) + return -ERANGE; + *(u16 *)(dat + reloc->cmd_offset) = (addr >> 16) & 0xffff; + break; + default: + return -EINVAL; + } + + return 0; +} + +static int mwv207_submit_patch_single(struct mwv207_job *mjob, + struct drm_mwv207_submit_reloc *reloc, char *dat, u32 dat_size) +{ + struct mwv207_bo *jbo; + + if (reloc->type & 0x80000000) { + if (reloc->idx >= mjob->nr_cmd_dat) + return -EINVAL; + jbo = mwv207_job_bo(mjob, reloc->idx + mjob->nr_bos); + } else { + if (reloc->idx >= mjob->nr_bos) + return -EINVAL; + jbo = mwv207_job_bo(mjob, reloc->idx); + } + + return mwv207_submit_patch_entry(mjob, reloc, jbo, dat, dat_size); +} + +static int mwv207_submit_patch_dma_entry(struct mwv207_job *mjob, + struct mwv207_dma_loc *loc, struct mwv207_bo *jbo, + u64 width, u64 height) +{ + struct mwv207_ttm_tt *gtt; + + if (loc->stride == 0 || loc->pg_nr_type != 0 || width == 0 || height == 0) + return -EINVAL; + + switch (jbo->tbo.resource->mem_type) { + case TTM_PL_VRAM: + loc->base = mwv207_bo_gpu_phys(jbo); + loc->pg_nr_type = + ((jbo->tbo.base.size >> PAGE_SHIFT) | (0ULL << 63)); + break; + case TTM_PL_TT: + gtt = to_gtt(jbo->tbo.ttm); + loc->base = (u64)gtt->ttm.dma_address; + loc->pg_nr_type = + ((jbo->tbo.base.size >> PAGE_SHIFT) | (1ULL << 63)); + break; + default: + BUG_ON(1); + break; + } + + if (loc->offset >= mwv207_bo_size(jbo)) + return -ERANGE; + if (loc->offset + loc->stride * (height - 1) + width <= loc->offset) + return -ERANGE; + if (loc->offset + loc->stride * (height - 1) + width > mwv207_bo_size(jbo)) + return -ERANGE; + + if ((loc->offset % loc->stride) + width > loc->stride) + return -ERANGE; + + return 0; +} + +static int mwv207_submit_patch_dma(struct drm_device *dev, struct mwv207_job *mjob) +{ + struct mwv207_bo *src_bo, *dst_bo, *jbo; + struct drm_mwv207_submit_reloc *reloc; + struct mwv207_dma_cmd *dma_cmd; + int i, ret; + + if (mjob->nr_bos != 2 || mjob->nr_relocs != 2 || mjob->nr_cmd_dat) + return -EINVAL; + if (mjob->cmd_size != sizeof(struct mwv207_dma_cmd)) + return -EINVAL; + + src_bo = dst_bo = NULL; + for (i = 0; i < mjob->nr_relocs; i++) { + reloc = &mjob->relocs[i]; + if (reloc->type & 0x80000000) + return -EINVAL; + if ((reloc->type & 0xffff) != 0x0) + return -EINVAL; + if (reloc->bo_offset) + return -EINVAL; + jbo = mwv207_job_bo(mjob, reloc->idx); + if (reloc->cmd_offset == offsetof(struct mwv207_dma_cmd, src.base)) + src_bo = jbo; + else if (reloc->cmd_offset == offsetof(struct mwv207_dma_cmd, dst.base)) + dst_bo = jbo; + } + if (!src_bo || !dst_bo || src_bo == dst_bo) + return -EINVAL; + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + ret = mwv207_submit_patch_dma_entry(mjob, &dma_cmd->src, src_bo, + dma_cmd->width, dma_cmd->height); + if (ret) + return ret; + return mwv207_submit_patch_dma_entry(mjob, &dma_cmd->dst, dst_bo, + dma_cmd->width, dma_cmd->height); +} + +static int mwv207_submit_patch(struct drm_device *dev, struct mwv207_job *mjob) +{ + + struct ttm_operation_ctx ctx = { + .interruptible = true, + .no_wait_gpu = false, + }; + struct mwv207_bo *jbo; + int i, j, ret; + void *ptr; + + if (mjob->is_dma) + return mwv207_submit_patch_dma(dev, mjob); + + for (i = 0; i < mjob->nr_relocs; ++i) { + ret = mwv207_submit_patch_single(mjob, &mjob->relocs[i], + mjob->cmds, mjob->cmd_size); + if (ret) + return ret; + } + + for (i = 0; i < mjob->nr_cmd_dat; ++i) { + if (mjob->cmd_dats[i].nr_relocs) { + for (j = 0; j < mjob->cmd_dats[i].nr_relocs; j++) { + ret = mwv207_submit_patch_single(mjob, &mjob->cmd_dats[i].relocs[j], + mjob->cmd_dats[i].dat, mjob->cmd_dats[i].dat_size); + if (ret) + return ret; + } + } + + jbo = mjob->cmd_dats[i].jbo; + + ret = ttm_bo_wait_ctx(&jbo->tbo, &ctx); + if (ret) + return ret; + + ret = mwv207_bo_kmap_reserved(jbo, &ptr); + if (ret) + return ret; + memcpy_toio(ptr, mjob->cmd_dats[i].dat, mjob->cmd_dats[i].dat_size); + mwv207_bo_kunmap_reserved(jbo); + } + + return 0; +} + +static int mwv207_submit_validate(struct drm_device *dev, struct mwv207_job *mjob) +{ + struct ttm_operation_ctx ctx = { + .interruptible = true, + .no_wait_gpu = false + }; + struct mwv207_bo *jbo; + int i, ret; + + for (i = 0; i < mjob->nr_bos + mjob->nr_cmd_dat; ++i) { + jbo = mwv207_job_bo(mjob, i); + + if (jbo->pin_count) + continue; + + if (mjob->is_dma) { + if (jbo->tbo.resource->mem_type != TTM_PL_SYSTEM) + continue; + + mwv207_bo_placement_from_domain(jbo, 0x4); + } else { + + jbo->flags |= 0x4; + if (i >= mjob->nr_bos) + jbo->flags |= 0x1; + mwv207_bo_placement_from_domain(jbo, 0x2); + } + + ret = ttm_bo_validate(&jbo->tbo, &jbo->placement, &ctx); + if (ret) + return ret; + } + + return 0; +} + +static int mwv207_submit_attach_dependency(struct mwv207_job *mjob, struct drm_mwv207_submit *args) +{ + struct mwv207_tvb *mtvb; + struct drm_gem_object *gobj; + bool write; + int ret; + + mwv207_for_each_mtvb(mtvb, mjob) { + gobj = &mtvb->base.bo->base; + write = mtvb->base.num_shared == 0 ? 1 : 0; + ret = drm_sched_job_add_implicit_dependencies(&mjob->base, gobj, write); + if (ret) + return ret; + } + + if (unlikely(args->flags & 0x1)) { + mjob->fence_in = sync_file_get_fence(args->fence_fd); + if (!mjob->fence_in) + return -EINVAL; + } + + return 0; +} + +static int mwv207_submit_commit(struct mwv207_job *mjob, + struct drm_mwv207_submit *args, struct dma_fence **fence) +{ + if (args->flags & 0x2) { + struct sync_file *sync_file; + int fd; + + fd = get_unused_fd_flags(O_CLOEXEC); + if (fd < 0) + return fd; + sync_file = sync_file_create(&mjob->base.s_fence->finished); + if (!sync_file) { + put_unused_fd(fd); + return -ENOMEM; + } + fd_install(fd, sync_file->file); + args->fence_fd = fd; + } + + *fence = &mjob->base.s_fence->finished; + + mwv207_job_get(mjob); + + drm_sched_entity_push_job(&mjob->base); + return 0; +} + +int mwv207_submit_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp) +{ + struct drm_mwv207_submit *args = data; + struct ww_acquire_ctx ticket; + struct mwv207_job *mjob; + struct dma_fence *fence = NULL; + int ret; + + if (args->padding || (args->flags & ~0x3)) + return -EINVAL; + if (args->cmd_size == 0 || args->cmds == 0) + return -EINVAL; + + mjob = mwv207_submit_init(dev, filp, args); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + + ret = mutex_lock_interruptible(mjob->qlock); + if (ret) + goto put_job; + + ret = mwv207_ctx_wait_prev_fence(mjob->ctx, mjob->engine_entity); + if (ret) + goto unlock; + + ret = drm_sched_job_init(&mjob->base, mjob->engine_entity, mjob->ctx); + if (ret) + return ret; + drm_sched_job_arm(&mjob->base); + + ret = ttm_eu_reserve_buffers(&ticket, &mjob->tvblist, true, NULL); + if (ret) + goto put_job; + ret = mwv207_submit_validate(dev, mjob); + if (ret) + goto unreserve; + ret = mwv207_submit_patch(dev, mjob); + if (ret) + goto unreserve; + ret = mwv207_submit_attach_dependency(mjob, args); + if (ret) + goto unreserve; + smp_wmb(); + ret = mwv207_submit_commit(mjob, args, &fence); + if (ret) + goto unreserve; +unreserve: + if (likely(fence)){ + ttm_eu_fence_buffer_objects(&ticket, &mjob->tvblist, fence); + mwv207_ctx_add_fence(mjob->ctx, mjob->engine_entity, fence); + } + else + ttm_eu_backoff_reservation(&ticket, &mjob->tvblist); +unlock: + mutex_unlock(mjob->qlock); +put_job: + mwv207_job_put(mjob); + + return ret; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_submit.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_submit.h new file mode 100644 index 0000000000000000000000000000000000000000..194fceafa88eed72a966d63c12f94c34a0328c22 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_submit.h @@ -0,0 +1,23 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#ifndef MWV207_SUBMIT_H_2S1GH9LD +#define MWV207_SUBMIT_H_2S1GH9LD + +int mwv207_submit_ioctl(struct drm_device *dev, void *data, + struct drm_file *filp); + +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ttm.bak.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ttm.bak.c new file mode 100644 index 0000000000000000000000000000000000000000..477b41787f070d11e6cf7385f38f3a5f29e5d761 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ttm.bak.c @@ -0,0 +1,477 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include + +#include "mwv207_drv.h" +#include "mwv207_bo.h" +#include "mwv207_drm.h" +#include "mwv207_sched.h" +#include "mwv207_monitor.h" + +static int mwv207_mem_visible(struct mwv207_device *jdev, struct ttm_resource *mem) +{ + if (mem->mem_type == TTM_PL_SYSTEM || + mem->mem_type == TTM_PL_TT) + return true; + if (mem->mem_type != TTM_PL_VRAM) + return false; + + return ((mem->start << PAGE_SHIFT) + mem->size < jdev->visible_vram_size); +} + +static void mwv207_evict_flags(struct ttm_buffer_object *bo, + struct ttm_placement *placement) +{ + struct mwv207_device *jdev; + struct mwv207_bo *jbo; + static const struct ttm_place placements = { + .fpfn = 0, + .lpfn = 0, + .mem_type = TTM_PL_SYSTEM, + .flags = 0 + }; + + if (!mwv207_ttm_bo_is_mwv207_bo(bo)) { + placement->placement = &placements; + placement->busy_placement = &placements; + placement->num_placement = 1; + placement->num_busy_placement = 1; + return; + } + + jbo = to_jbo(bo); + jdev = ddev_to_jdev(jbo->tbo.base.dev); + + if (bo->resource->mem_type == TTM_PL_VRAM) { + if (jdev->visible_vram_size != jdev->vram_size + && mwv207_mem_visible(jdev, bo->resource)) { + jbo->flags &= ~(0x1 | 0x4); + mwv207_bo_placement_from_domain(jbo, + 0x2 | 0x4); + BUG_ON(!(jbo->placements[0].mem_type == TTM_PL_VRAM)); + BUG_ON(!(jbo->placements[1].mem_type == TTM_PL_TT)); + jbo->placements[0].fpfn = jdev->visible_vram_size >> PAGE_SHIFT; + jbo->placements[0].lpfn = 0; + jbo->placement.placement = &jbo->placements[0]; + jbo->placement.busy_placement = &jbo->placements[1]; + jbo->placement.num_placement = 1; + jbo->placement.num_busy_placement = 1; + } else + mwv207_bo_placement_from_domain(jbo, 0x4); + } else + mwv207_bo_placement_from_domain(jbo, 0x1); + + *placement = jbo->placement; +} + +static int mwv207_ttm_io_mem_reserve(struct ttm_device *bdev, + struct ttm_resource *mem) +{ + struct mwv207_device *jdev = bdev_to_jdev(bdev); + size_t bus_size = (size_t)mem->size; + + switch (mem->mem_type) { + case TTM_PL_SYSTEM: + case TTM_PL_TT: + break; + case TTM_PL_VRAM: + mem->bus.offset = mem->start << PAGE_SHIFT; + + if ((mem->bus.offset + bus_size) > jdev->visible_vram_size) + return -EINVAL; + mem->bus.offset += jdev->vram_bar_base; + mem->bus.is_iomem = true; + mem->bus.caching = ttm_write_combined; + break; + default: + return -EINVAL; + } + return 0; +} + +static struct ttm_tt *mwv207_ttm_tt_create(struct ttm_buffer_object *bo, + u32 page_flags) +{ + struct mwv207_ttm_tt *gtt; + + gtt = kzalloc(sizeof(*gtt), GFP_KERNEL); + if (!gtt) + return NULL; + + if (ttm_sg_tt_init(>t->ttm, bo, page_flags, ttm_cached)) { + kfree(gtt); + return NULL; + } + + return >t->ttm; +} + +static int mwv207_ttm_tt_populate(struct ttm_device *bdev, struct ttm_tt *ttm, + struct ttm_operation_ctx *ctx) +{ + return ttm_pool_alloc(&bdev->pool, ttm, ctx); +} + +static void mwv207_ttm_tt_unpopulate(struct ttm_device *bdev, struct ttm_tt *ttm) +{ + ttm_pool_free(&bdev->pool, ttm); +} + +static int mwv207_ttm_job_submit(struct mwv207_job *mjob, struct dma_fence **fence) +{ + *fence = &mjob->base.s_fence->finished; + + mwv207_job_get(mjob); + drm_sched_entity_push_job(&mjob->base); + + return 0; +} + +static struct mwv207_job *mwv207_ttm_job_alloc(struct ttm_buffer_object *bo) +{ + struct mwv207_job *mjob = mwv207_job_alloc(); + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_tvb *mtvb; + int ret; + + if (!mjob) + return ERR_PTR(-ENOMEM); + + dma_cmd = kmalloc(sizeof(*dma_cmd), GFP_KERNEL); + if (!dma_cmd) { + ret = -ENOMEM; + goto err; + } + dma_cmd->src.offset = 0; + dma_cmd->src.stride = bo->resource->size; + dma_cmd->dst.offset = 0; + dma_cmd->dst.stride = bo->resource->size; + dma_cmd->width = bo->resource->size; + dma_cmd->height = 1; + + mjob->cmds = (char *)dma_cmd; + mjob->cmd_size = sizeof(*dma_cmd); + mjob->engine_entity = ddev_to_jdev(bo->base.dev)->dma_entity; + mjob->is_dma = true; + + mjob->mtvb = kzalloc(sizeof(struct mwv207_tvb), GFP_KERNEL); + if (!mjob->mtvb) { + ret = -ENOMEM; + goto err; + } + mtvb = &mjob->mtvb[0]; + list_add_tail(&mtvb->base.head, &mjob->tvblist); + + ret = drm_sched_job_init(&mjob->base, mjob->engine_entity, NULL); + if (ret) + goto err; + + drm_sched_job_arm(&mjob->base); + + ret = drm_sched_job_add_implicit_dependencies(&mjob->base, &bo->base, true); + if (ret) + goto err; + + return mjob; +err: + mwv207_job_put(mjob); + return ERR_PTR(ret); +} + +static int mwv207_move_vram_gtt(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct ttm_tt *ttm = bo->ttm; + struct mwv207_ttm_tt *gtt = to_gtt(ttm); + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_job *mjob; + struct dma_fence *fence; + int ret; + + mjob = mwv207_ttm_job_alloc(bo); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + dma_cmd->src.base = bo->resource->start << PAGE_SHIFT; + dma_cmd->src.pg_nr_type = ((bo->resource->size >> PAGE_SHIFT) | (0ULL << 63)); + dma_cmd->dst.base = (u64)gtt->ttm.dma_address; + dma_cmd->dst.pg_nr_type = ((ttm->num_pages) | (1ULL << 63)); + + ret = mwv207_ttm_job_submit(mjob, &fence); + if (!ret) + ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); + + mwv207_job_put(mjob); + return ret; +} + +static int mwv207_move_gtt_vram(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct ttm_tt *ttm = bo->ttm; + struct mwv207_ttm_tt *gtt = to_gtt(ttm); + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_job *mjob; + struct dma_fence *fence; + int ret; + + mjob = mwv207_ttm_job_alloc(bo); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + dma_cmd->src.base = (u64)gtt->ttm.dma_address; + dma_cmd->src.pg_nr_type = ((ttm->num_pages) | (1ULL << 63)); + dma_cmd->dst.base = new_mem->start << PAGE_SHIFT; + dma_cmd->dst.pg_nr_type = ((bo->resource->size >> PAGE_SHIFT) | (0ULL << 63)); + + ret = mwv207_ttm_job_submit(mjob, &fence); + if (!ret) + ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); + + mwv207_job_put(mjob); + return ret; +} + +static int mwv207_move_vram_vram(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_job *mjob; + struct dma_fence *fence; + int ret; + + mjob = mwv207_ttm_job_alloc(bo); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + dma_cmd->src.base = bo->resource->start << PAGE_SHIFT; + dma_cmd->src.pg_nr_type = ((bo->resource->size >> PAGE_SHIFT) | (0ULL << 63)); + dma_cmd->dst.base = new_mem->start << PAGE_SHIFT; + dma_cmd->dst.pg_nr_type = ((new_mem->size >> PAGE_SHIFT) | (0ULL << 63)); + + ret = mwv207_ttm_job_submit(mjob, &fence); + if (!ret) + ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); + + mwv207_job_put(mjob); + return ret; +} + +static int mwv207_bo_move_blit(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + if (bo->resource->mem_type == TTM_PL_TT && + new_mem->mem_type == TTM_PL_VRAM) + return mwv207_move_gtt_vram(bo, evict, ctx, new_mem); + if (bo->resource->mem_type == TTM_PL_VRAM && + new_mem->mem_type == TTM_PL_TT) + return mwv207_move_vram_gtt(bo, evict, ctx, new_mem); + if (bo->resource->mem_type == TTM_PL_VRAM && + new_mem->mem_type == TTM_PL_VRAM) + return mwv207_move_vram_vram(bo, evict, ctx, new_mem); + return -EFAULT; +} + +static void mwv207_update_vram_usage(struct ttm_buffer_object *bo, bool add) +{ + struct mwv207_device *jdev = bdev_to_jdev(bo->bdev); + + if (add) + atomic64_add(bo->base.size, &jdev->vram_used_bytes); + else + atomic64_sub(bo->base.size, &jdev->vram_used_bytes); + + mwv207_monitor_update_vram_used(jdev); +} + +static void mwv207_update_memory_usage(struct ttm_buffer_object *bo, + int mem_type, bool add) +{ + struct mwv207_device *jdev; + + if (!mwv207_ttm_bo_is_mwv207_bo(bo)) + return; + + jdev = bdev_to_jdev(bo->bdev); + + switch (mem_type) { + case TTM_PL_TT: + if (add) + atomic64_add(bo->base.size, &jdev->gtt_used_bytes); + else + atomic64_sub(bo->base.size, &jdev->gtt_used_bytes); + break; + case TTM_PL_VRAM: + mwv207_update_vram_usage(bo, add); + break; + } +} + +static void mwv207_bo_move_notify(struct ttm_buffer_object *bo, + int old_type, + struct ttm_resource *new_mem) +{ + mwv207_update_memory_usage(bo, old_type, false); + if (new_mem) + mwv207_update_memory_usage(bo, new_mem->mem_type, true); + +} + +static int mwv207_bo_move(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem, + struct ttm_place *hop) +{ + struct ttm_resource *old_mem = bo->resource; + struct mwv207_bo *jbo = to_jbo(bo); + struct mwv207_device *jdev; + int ret, old_type; + + if (WARN_ON_ONCE(bo->pin_count > 0)) + return -EINVAL; + + if (old_mem == NULL || (old_mem->mem_type == TTM_PL_SYSTEM && bo->ttm == NULL)) { + + ttm_bo_move_null(bo, new_mem); + return 0; + } + + old_type = old_mem->mem_type; + + jdev = bdev_to_jdev(bo->bdev); + + if (old_mem->mem_type == TTM_PL_SYSTEM && new_mem->mem_type == TTM_PL_TT) { + ttm_bo_move_null(bo, new_mem); + return 0; + } + + if (old_mem->mem_type == TTM_PL_TT && + new_mem->mem_type == TTM_PL_SYSTEM) { + + return -EINVAL; + } + + if ((old_mem->mem_type == TTM_PL_SYSTEM && new_mem->mem_type == TTM_PL_VRAM) || + (old_mem->mem_type == TTM_PL_VRAM && new_mem->mem_type == TTM_PL_SYSTEM)) { + hop->fpfn = 0; + hop->lpfn = 0; + hop->mem_type = TTM_PL_TT; + hop->flags = 0; + return -EMULTIHOP; + } + + ret = mwv207_bo_move_blit(bo, evict, ctx, new_mem); + if (ret == 0) + goto moved; + + if (!mwv207_mem_visible(jdev, new_mem) + || !mwv207_mem_visible(jdev, old_mem)) { + pr_err("mwv207: can't move invisible mem by cpu"); + return ret; + } + ret = ttm_bo_move_memcpy(bo, ctx, new_mem); + if (ret) + return ret; +moved: + atomic64_add(bo->base.size, &jdev->moved_bytes); + mwv207_bo_move_notify(bo, old_type, new_mem); + if (!mwv207_mem_visible(jdev, new_mem)) + jbo->flags &= ~0x1; + + return 0; +} + +static void mwv207_ttm_delete_mem_notify(struct ttm_buffer_object *bo) +{ +} + +static void mwv207_ttm_tt_destroy(struct ttm_device *bdev, + struct ttm_tt *ttm) +{ + struct mwv207_ttm_tt *gtt = container_of(ttm, struct mwv207_ttm_tt, ttm); + + ttm_tt_fini(ttm); + kfree(gtt); +} + +static struct ttm_device_funcs mwv207_bo_driver = { + .ttm_tt_create = mwv207_ttm_tt_create, + .ttm_tt_destroy = mwv207_ttm_tt_destroy, + .ttm_tt_populate = mwv207_ttm_tt_populate, + .ttm_tt_unpopulate = mwv207_ttm_tt_unpopulate, + .eviction_valuable = ttm_bo_eviction_valuable, + .evict_flags = mwv207_evict_flags, + .move = mwv207_bo_move, + .io_mem_reserve = mwv207_ttm_io_mem_reserve, + .delete_mem_notify = mwv207_ttm_delete_mem_notify, +}; + +int mwv207_ttm_init(struct mwv207_device *jdev) +{ + int ret; + + ret = ttm_device_init(&jdev->bdev, &mwv207_bo_driver, jdev->dev, + jdev->base.anon_inode->i_mapping, + jdev->base.vma_offset_manager, + false, true); + if (ret) { + DRM_ERROR("failed to initialize buffer object driver(%d).\n", ret); + return ret; + } + + ret = ttm_range_man_init(&jdev->bdev, TTM_PL_TT, + true, SZ_2G >> PAGE_SHIFT); + if (ret) { + DRM_ERROR("failed to initialize GTT heap.\n"); + goto out_no_vram; + } + + ret = ttm_range_man_init(&jdev->bdev, TTM_PL_VRAM, + false, jdev->vram_size >> PAGE_SHIFT); + if (ret) { + DRM_ERROR("failed to initialize VRAM heap.\n"); + goto out_no_gtt; + } + DRM_INFO("mwv207: %lldM of VRAM memory size\n", jdev->vram_size / (1024 * 1024)); + return 0; + +out_no_gtt: + ttm_range_man_fini(&jdev->bdev, TTM_PL_TT); +out_no_vram: + ttm_device_fini(&jdev->bdev); + return ret; +} + +void mwv207_ttm_fini(struct mwv207_device *jdev) +{ + ttm_range_man_fini(&jdev->bdev, TTM_PL_VRAM); + ttm_range_man_fini(&jdev->bdev, TTM_PL_TT); + ttm_device_fini(&jdev->bdev); + DRM_INFO("mwv207: ttm finalized\n"); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ttm.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ttm.c new file mode 100644 index 0000000000000000000000000000000000000000..7c932759b24ed42b6de485279cdc35c4c6b6d1a8 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_ttm.c @@ -0,0 +1,493 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include +#include +#include +#include +#include + +#include "mwv207_drv.h" +#include "mwv207_bo.h" +#include "mwv207_drm.h" +#include "mwv207_sched.h" +#include "mwv207_monitor.h" + +static int mwv207_mem_visible(struct mwv207_device *jdev, struct ttm_resource *mem) +{ + if (mem->mem_type == TTM_PL_SYSTEM || + mem->mem_type == TTM_PL_TT) + return true; + if (mem->mem_type != TTM_PL_VRAM) + return false; + + return ((mem->start << PAGE_SHIFT) + mem->size < jdev->visible_vram_size); +} + +static void mwv207_evict_flags(struct ttm_buffer_object *bo, + struct ttm_placement *placement) +{ + struct mwv207_device *jdev; + struct mwv207_bo *jbo; + static const struct ttm_place placements = { + .fpfn = 0, + .lpfn = 0, + .mem_type = TTM_PL_SYSTEM, + .flags = 0 + }; + + if (!mwv207_ttm_bo_is_mwv207_bo(bo)) { + placement->placement = &placements; + placement->busy_placement = &placements; + placement->num_placement = 1; + placement->num_busy_placement = 1; + return; + } + + jbo = to_jbo(bo); + jdev = ddev_to_jdev(jbo->tbo.base.dev); + + if (bo->resource->mem_type == TTM_PL_VRAM) { + if (jdev->visible_vram_size != jdev->vram_size + && mwv207_mem_visible(jdev, bo->resource)) { + jbo->flags &= ~(0x1 | 0x4); + mwv207_bo_placement_from_domain(jbo, + 0x2 | 0x4); + BUG_ON(!(jbo->placements[0].mem_type == TTM_PL_VRAM)); + BUG_ON(!(jbo->placements[1].mem_type == TTM_PL_TT)); + jbo->placements[0].fpfn = jdev->visible_vram_size >> PAGE_SHIFT; + jbo->placements[0].lpfn = 0; + jbo->placement.placement = &jbo->placements[0]; + jbo->placement.busy_placement = &jbo->placements[1]; + jbo->placement.num_placement = 1; + jbo->placement.num_busy_placement = 1; + } else + mwv207_bo_placement_from_domain(jbo, 0x4); + } else + mwv207_bo_placement_from_domain(jbo, 0x1); + + *placement = jbo->placement; +} + +static int mwv207_ttm_io_mem_reserve(struct ttm_device *bdev, + struct ttm_resource *mem) +{ + struct mwv207_device *jdev = bdev_to_jdev(bdev); + size_t bus_size = (size_t)mem->size; + + switch (mem->mem_type) { + case TTM_PL_SYSTEM: + case TTM_PL_TT: + break; + case TTM_PL_VRAM: + mem->bus.offset = mem->start << PAGE_SHIFT; + + if ((mem->bus.offset + bus_size) > jdev->visible_vram_size) + return -EINVAL; + mem->bus.offset += jdev->vram_bar_base; + mem->bus.is_iomem = true; + mem->bus.caching = ttm_write_combined; + break; + default: + return -EINVAL; + } + return 0; +} + +static struct ttm_tt *mwv207_ttm_tt_create(struct ttm_buffer_object *bo, + u32 page_flags) +{ + struct mwv207_ttm_tt *gtt; + + gtt = kzalloc(sizeof(*gtt), GFP_KERNEL); + if (!gtt) + return NULL; + + if (ttm_sg_tt_init(>t->ttm, bo, page_flags, ttm_cached)) { + kfree(gtt); + return NULL; + } + + return >t->ttm; +} + +static int mwv207_ttm_tt_populate(struct ttm_device *bdev, struct ttm_tt *ttm, + struct ttm_operation_ctx *ctx) +{ + return ttm_pool_alloc(&bdev->pool, ttm, ctx); +} + +static void mwv207_ttm_tt_unpopulate(struct ttm_device *bdev, struct ttm_tt *ttm) +{ + ttm_pool_free(&bdev->pool, ttm); +} + +static int mwv207_ttm_job_submit(struct mwv207_job *mjob, struct dma_fence **fence) +{ + *fence = &mjob->base.s_fence->finished; + + mwv207_job_get(mjob); + drm_sched_entity_push_job(&mjob->base); + + return 0; +} + +static struct mwv207_job *mwv207_ttm_job_alloc(struct ttm_buffer_object *bo) +{ + struct mwv207_job *mjob = mwv207_job_alloc(); + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_tvb *mtvb; + int ret; + + if (!mjob) + return ERR_PTR(-ENOMEM); + + dma_cmd = kmalloc(sizeof(*dma_cmd), GFP_KERNEL); + if (!dma_cmd) { + ret = -ENOMEM; + goto err; + } + dma_cmd->src.offset = 0; + dma_cmd->src.stride = bo->resource->size; + dma_cmd->dst.offset = 0; + dma_cmd->dst.stride = bo->resource->size; + dma_cmd->width = bo->resource->size; + dma_cmd->height = 1; + + mjob->cmds = (char *)dma_cmd; + mjob->cmd_size = sizeof(*dma_cmd); + mjob->engine_entity = ddev_to_jdev(bo->base.dev)->dma_entity; + mjob->is_dma = true; + + mjob->mtvb = kzalloc(sizeof(struct mwv207_tvb), GFP_KERNEL); + if (!mjob->mtvb) { + ret = -ENOMEM; + goto err; + } + mtvb = &mjob->mtvb[0]; + list_add_tail(&mtvb->base.head, &mjob->tvblist); + + ret = drm_sched_job_init(&mjob->base, mjob->engine_entity, NULL); + if (ret) + goto err; + + drm_sched_job_arm(&mjob->base); + + ret = drm_sched_job_add_implicit_dependencies(&mjob->base, &bo->base, true); + if (ret) + goto err; + + return mjob; +err: + mwv207_job_put(mjob); + return ERR_PTR(ret); +} + +static int mwv207_move_vram_gtt(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct ttm_tt *ttm = bo->ttm; + struct mwv207_ttm_tt *gtt = to_gtt(ttm); + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_job *mjob; + struct dma_fence *fence; + int ret; + + mjob = mwv207_ttm_job_alloc(bo); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + dma_cmd->src.base = bo->resource->start << PAGE_SHIFT; + dma_cmd->src.pg_nr_type = ((bo->resource->size >> PAGE_SHIFT) | (0ULL << 63)); + dma_cmd->dst.base = (u64)gtt->ttm.dma_address; + dma_cmd->dst.pg_nr_type = ((ttm->num_pages) | (1ULL << 63)); + + ret = mwv207_ttm_job_submit(mjob, &fence); + if (!ret) + ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); + + mwv207_job_put(mjob); + return ret; +} + +static int mwv207_move_gtt_vram(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct ttm_tt *ttm = bo->ttm; + struct mwv207_ttm_tt *gtt = to_gtt(ttm); + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_job *mjob; + struct dma_fence *fence; + int ret; + + mjob = mwv207_ttm_job_alloc(bo); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + dma_cmd->src.base = (u64)gtt->ttm.dma_address; + dma_cmd->src.pg_nr_type = ((ttm->num_pages) | (1ULL << 63)); + dma_cmd->dst.base = new_mem->start << PAGE_SHIFT; + dma_cmd->dst.pg_nr_type = ((bo->resource->size >> PAGE_SHIFT) | (0ULL << 63)); + + ret = mwv207_ttm_job_submit(mjob, &fence); + if (!ret) + ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); + + mwv207_job_put(mjob); + return ret; +} + +static int mwv207_move_vram_vram(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + struct mwv207_dma_cmd *dma_cmd; + struct mwv207_job *mjob; + struct dma_fence *fence; + int ret; + + mjob = mwv207_ttm_job_alloc(bo); + if (IS_ERR(mjob)) + return PTR_ERR(mjob); + + dma_cmd = (struct mwv207_dma_cmd *)mjob->cmds; + dma_cmd->src.base = bo->resource->start << PAGE_SHIFT; + dma_cmd->src.pg_nr_type = ((bo->resource->size >> PAGE_SHIFT) | (0ULL << 63)); + dma_cmd->dst.base = new_mem->start << PAGE_SHIFT; + dma_cmd->dst.pg_nr_type = ((new_mem->size >> PAGE_SHIFT) | (0ULL << 63)); + + ret = mwv207_ttm_job_submit(mjob, &fence); + if (!ret) + ret = ttm_bo_move_accel_cleanup(bo, fence, evict, true, new_mem); + + mwv207_job_put(mjob); + return ret; +} + +static int mwv207_bo_move_blit(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem) +{ + if (bo->resource->mem_type == TTM_PL_TT && + new_mem->mem_type == TTM_PL_VRAM) + return mwv207_move_gtt_vram(bo, evict, ctx, new_mem); + if (bo->resource->mem_type == TTM_PL_VRAM && + new_mem->mem_type == TTM_PL_TT) + return mwv207_move_vram_gtt(bo, evict, ctx, new_mem); + if (bo->resource->mem_type == TTM_PL_VRAM && + new_mem->mem_type == TTM_PL_VRAM) + return mwv207_move_vram_vram(bo, evict, ctx, new_mem); + return -EFAULT; +} + +static void mwv207_update_vram_usage(struct ttm_buffer_object *bo, bool add, struct ttm_resource *new_mem) +{ + struct mwv207_device *jdev = bdev_to_jdev(bo->bdev); + + if (add){ + if ( new_mem != NULL && (new_mem->start << PAGE_SHIFT) + new_mem->size < jdev->visible_vram_size ){ + atomic64_add(bo->base.size, &jdev->visible_vram_used_bytes); + } + atomic64_add(bo->base.size, &jdev->vram_used_bytes); + } + else{ + if ( bo->resource != NULL && bo->resource != 0 && bo->resource->start && + ( (bo->resource->start << PAGE_SHIFT) + bo->resource->size) < jdev->visible_vram_size ){ + atomic64_sub(bo->base.size, &jdev->visible_vram_used_bytes); + } + atomic64_sub(bo->base.size, &jdev->vram_used_bytes); + } + + mwv207_monitor_update_vram_used(jdev); +} + +static void mwv207_update_memory_usage(struct ttm_buffer_object *bo, + int mem_type, bool add, struct ttm_resource *new_mem) +{ + struct mwv207_device *jdev; + + if (!mwv207_ttm_bo_is_mwv207_bo(bo)) + return; + + jdev = bdev_to_jdev(bo->bdev); + + switch (mem_type) { + case TTM_PL_TT: + if (add) + atomic64_add(bo->base.size, &jdev->gtt_used_bytes); + else + atomic64_sub(bo->base.size, &jdev->gtt_used_bytes); + break; + case TTM_PL_VRAM: + mwv207_update_vram_usage(bo, add, new_mem); + break; + } +} + +static void mwv207_bo_move_notify(struct ttm_buffer_object *bo, + int old_type, + struct ttm_resource *new_mem) +{ + mwv207_update_memory_usage(bo, old_type, false,NULL); + if (new_mem) + mwv207_update_memory_usage(bo, new_mem->mem_type, true, new_mem); +} + +static int mwv207_bo_move(struct ttm_buffer_object *bo, bool evict, + struct ttm_operation_ctx *ctx, + struct ttm_resource *new_mem, + struct ttm_place *hop) +{ + struct ttm_resource *old_mem = bo->resource; + struct mwv207_bo *jbo = to_jbo(bo); + struct mwv207_device *jdev; + int ret, old_type; + + if (WARN_ON_ONCE(bo->pin_count > 0)) + return -EINVAL; + + if (old_mem == NULL && new_mem != 0){ + mwv207_bo_move_notify(bo, old_type, new_mem); + } + if (old_mem == NULL || (old_mem->mem_type == TTM_PL_SYSTEM && bo->ttm == NULL)) { + + ttm_bo_move_null(bo, new_mem); + return 0; + } + + old_type = old_mem->mem_type; + jdev = bdev_to_jdev(bo->bdev); + + if (old_mem->mem_type == TTM_PL_SYSTEM && new_mem->mem_type == TTM_PL_TT) { + mwv207_bo_move_notify(bo, old_type, new_mem); + ttm_bo_move_null(bo, new_mem); + return 0; + } + + if (old_mem->mem_type == TTM_PL_TT && + new_mem->mem_type == TTM_PL_SYSTEM) { + + return -EINVAL; + } + + if ((old_mem->mem_type == TTM_PL_SYSTEM && new_mem->mem_type == TTM_PL_VRAM) || + (old_mem->mem_type == TTM_PL_VRAM && new_mem->mem_type == TTM_PL_SYSTEM)) { + hop->fpfn = 0; + hop->lpfn = 0; + hop->mem_type = TTM_PL_TT; + hop->flags = 0; + return -EMULTIHOP; + } + + ret = mwv207_bo_move_blit(bo, evict, ctx, new_mem); + if (ret == 0) + goto moved; + + if (!mwv207_mem_visible(jdev, new_mem) + || !mwv207_mem_visible(jdev, old_mem)) { + pr_err("mwv207: can't move invisible mem by cpu"); + return ret; + } + ret = ttm_bo_move_memcpy(bo, ctx, new_mem); + if (ret) + return ret; +moved: + atomic64_add(bo->base.size, &jdev->moved_bytes); + mwv207_bo_move_notify(bo, old_type, new_mem); + if (!mwv207_mem_visible(jdev, new_mem)) + jbo->flags &= ~0x1; + + return 0; +} + +static void mwv207_ttm_delete_mem_notify(struct ttm_buffer_object *bo) +{ + unsigned int old_type = TTM_PL_SYSTEM; + + if (bo->resource) + old_type = bo->resource->mem_type; + mwv207_bo_move_notify(bo, old_type, NULL); +} + +static void mwv207_ttm_tt_destroy(struct ttm_device *bdev, + struct ttm_tt *ttm) +{ + struct mwv207_ttm_tt *gtt = container_of(ttm, struct mwv207_ttm_tt, ttm); + + ttm_tt_fini(ttm); + kfree(gtt); +} + +static struct ttm_device_funcs mwv207_bo_driver = { + .ttm_tt_create = mwv207_ttm_tt_create, + .ttm_tt_destroy = mwv207_ttm_tt_destroy, + .ttm_tt_populate = mwv207_ttm_tt_populate, + .ttm_tt_unpopulate = mwv207_ttm_tt_unpopulate, + .eviction_valuable = ttm_bo_eviction_valuable, + .evict_flags = mwv207_evict_flags, + .move = mwv207_bo_move, + .io_mem_reserve = mwv207_ttm_io_mem_reserve, + .delete_mem_notify = mwv207_ttm_delete_mem_notify, +}; + +int mwv207_ttm_init(struct mwv207_device *jdev) +{ + int ret; + + ret = ttm_device_init(&jdev->bdev, &mwv207_bo_driver, jdev->dev, + jdev->base.anon_inode->i_mapping, + jdev->base.vma_offset_manager, + false, true); + if (ret) { + DRM_ERROR("failed to initialize buffer object driver(%d).\n", ret); + return ret; + } + + ret = ttm_range_man_init(&jdev->bdev, TTM_PL_TT, + true, SZ_2G >> PAGE_SHIFT); + if (ret) { + DRM_ERROR("failed to initialize GTT heap.\n"); + goto out_no_vram; + } + + ret = ttm_range_man_init(&jdev->bdev, TTM_PL_VRAM, + false, jdev->vram_size >> PAGE_SHIFT); + if (ret) { + DRM_ERROR("failed to initialize VRAM heap.\n"); + goto out_no_gtt; + } + DRM_INFO("mwv207: %lldM of VRAM memory size\n", jdev->vram_size / (1024 * 1024)); + return 0; + +out_no_gtt: + ttm_range_man_fini(&jdev->bdev, TTM_PL_TT); +out_no_vram: + ttm_device_fini(&jdev->bdev); + return ret; +} + +void mwv207_ttm_fini(struct mwv207_device *jdev) +{ + ttm_range_man_fini(&jdev->bdev, TTM_PL_VRAM); + ttm_range_man_fini(&jdev->bdev, TTM_PL_TT); + ttm_device_fini(&jdev->bdev); + DRM_INFO("mwv207: ttm finalized\n"); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_vbios.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_vbios.c new file mode 100644 index 0000000000000000000000000000000000000000..fa735c9e334a7e2a265c28209ceabfcf9d3dd64c --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_vbios.c @@ -0,0 +1,253 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_drv.h" +#include "mwv207_vbios.h" + +static inline u8 mwv207_flash_read8(struct mwv207_device *jdev, u32 offset) +{ + return ioread8(jdev->mmio + 0x100000 + offset); +} + +static inline u16 mwv207_flash_read16(struct mwv207_device *jdev, u32 offset) +{ + u16 dat = ioread16(jdev->mmio + 0x100000 + offset); + + return le16_to_cpu(dat); +} + +static inline u32 mwv207_flash_read32(struct mwv207_device *jdev, u32 offset) +{ + u32 dat = ioread32(jdev->mmio + 0x100000 + offset); + + return le32_to_cpu(dat); +} + +static inline void mwv207_flash_cpy(struct mwv207_device *jdev, void *dst, u32 offset, u32 len) +{ + memcpy_fromio(dst, jdev->mmio + 0x100000 + offset, len); +} + +static int mwv207_vbios_check_indexer(struct mwv207_device *jdev, u32 offset) +{ + u16 count, chksum, calc; + + if (mwv207_flash_read16(jdev, offset) != 0xaa55) + return -EINVAL; + + count = mwv207_flash_read16(jdev, offset + 2); + chksum = mwv207_flash_read16(jdev, offset + 4); + + jdev->vbios.sector_count = count; + for (calc = 0, offset += 8, count *= 8; count > 0; count--) + calc += mwv207_flash_read8(jdev, offset++); + + if (calc != chksum) + return -EINVAL; + + jdev->vbios.indexer_valid = 1; + return 0; +} + +static inline int mwv207_vbios_sector(struct mwv207_device *jdev, u32 idx, u32 *poffset) +{ + if (poffset == NULL || !jdev->vbios.indexer_valid || idx >= jdev->vbios.sector_count) + return -EINVAL; + + *poffset = mwv207_flash_read32(jdev, 0xA000 + 0x8 + idx * 8 + 4); + return 0; +} + +static inline int mwv207_vbios_insert_vdat(struct mwv207_device *jdev, u32 key, + struct mwv207_vdat *vdat) +{ + int ret; + + mutex_lock(&jdev->vbios.cfg_lock); + ret = idr_alloc(&jdev->vbios.cfg_table, vdat, key, key + 1, GFP_KERNEL); + mutex_unlock(&jdev->vbios.cfg_lock); + + return ret; +} + +static void mwv207_vbios_parse_hdmi(struct mwv207_device *jdev) +{ + u32 count, offset, chksum, len; + struct mwv207_vdat *vdat[4]; + u32 select[4]; + u8 magic[8]; + int ret, i; + + ret = mwv207_vbios_sector(jdev, 0xA, &offset); + if (ret) + return; + + mwv207_flash_cpy(jdev, magic, offset, 8); + if (memcmp(magic, "JMPHYCFG", 8)) + return; + + len = mwv207_flash_read32(jdev, offset + 0x18); + if (len > 0x1200 || (len % 0x474)) + return; + count = len / 0x474; + + for (chksum = 0, i = 0; i < len; i += 4) + chksum += mwv207_flash_read32(jdev, offset + 0x20 + i); + if (chksum != mwv207_flash_read32(jdev, offset + 0x14)) + return; + + for (i = 0; i < 4; i++) { + select[i] = mwv207_flash_read8(jdev, offset + 0x1c + i); + if (select[i] > min_t(u32, 3, count - 1)) + return; + } + + for (i = 0; i < 4; i++) { + void *dat; + + vdat[i] = devm_kzalloc(jdev->dev, sizeof(*vdat[i]), GFP_KERNEL); + if (!vdat[i]) + return; + vdat[i]->len = 0x474; + dat = devm_kmalloc(jdev->dev, vdat[i]->len, GFP_KERNEL); + if (!dat) + return; + mwv207_flash_cpy(jdev, dat, + offset + 0x20 + select[i] * 0x474, + 0x474); + + vdat[i]->dat = dat; + + (void)mwv207_vbios_insert_vdat(jdev, 0xfff0 + i, vdat[i]); + } +} + +static void mwv207_vbios_parse_edp(struct mwv207_device *jdev) +{ + +} + +static void mwv207_vbios_parse_cfg(struct mwv207_device *jdev) +{ + u32 offset, doffset, len; + struct mwv207_vdat *vdat; + u8 magic[4], chksum; + int ret, i; + + ret = mwv207_vbios_sector(jdev, 0x5, &offset); + if (ret) + return; + + mwv207_flash_cpy(jdev, magic, offset, 4); + if (memcmp(magic, "jcfg", 4)) + return; + jdev->has_cfg = true; + len = mwv207_flash_read32(jdev, offset + 0x8); + if (len < 1) + return; + + doffset = offset + 0xc; + for (i = 0; i < len; i++) { + void *dat; + u32 key; + vdat = devm_kzalloc(jdev->dev, sizeof(*vdat), GFP_KERNEL); + if (!vdat) + return; + key = mwv207_flash_read16(jdev, doffset); + vdat->len = mwv207_flash_read16(jdev, doffset + 0x2); + dat = devm_kmalloc(jdev->dev, vdat->len, GFP_KERNEL); + if (!dat) + return; + mwv207_flash_cpy(jdev, dat, doffset + 0x4, vdat->len); + vdat->dat = dat; + (void)mwv207_vbios_insert_vdat(jdev, key, vdat); + doffset += ALIGN(4 + (unsigned long)vdat->len, 4); + if (!doffset) { + pr_warn("mwv207: cfg data truncated %d -> %d", len, i); + break; + } + } +} + +static void mwv207_vbios_parse_basic(struct mwv207_device *jdev){ + u32 len, offset_ver, offset_odm, flash_size, i; + char *ver=NULL,*odm=NULL; + struct mwv207_vdat *vdat=NULL; + void *dat=NULL; + + offset_ver = mwv207_flash_read32(jdev,0xA000 + 12); + + for (i = 0, len=0; i<0x800; i++, len++){ + if ((char)mwv207_flash_read8(jdev,offset_ver +i) == 0) + break; + } + + vdat = devm_kzalloc(jdev->dev, sizeof(*vdat), GFP_KERNEL); + if (!vdat) + return; + dat = devm_kmalloc(jdev->dev, 0x800, GFP_KERNEL); + if (!dat) + return; + mwv207_flash_cpy(jdev, dat, offset_ver, len); + ((char *)dat)[len]=0; + + vdat->dat = dat; + vdat->len = len; + + (void)mwv207_vbios_insert_vdat(jdev,0x1FF0, vdat); +} + +const struct mwv207_vdat *mwv207_vbios_vdat(struct mwv207_device *jdev, u32 key) +{ + struct mwv207_vdat *dat; + + mutex_lock(&jdev->vbios.cfg_lock); + dat = idr_find(&jdev->vbios.cfg_table, key); + mutex_unlock(&jdev->vbios.cfg_lock); + + return dat; +} + +void mwv207_vbios_init(struct mwv207_device *jdev) +{ + int ret; + + mutex_init(&jdev->vbios.vcmd_lock); + mutex_init(&jdev->vbios.cfg_lock); + idr_init(&jdev->vbios.cfg_table); + + ret = mwv207_vbios_check_indexer(jdev, 0xA000); + if (ret) { + pr_warn("mwv207: vbios indexer is not valid"); + return; + } + + mwv207_vbios_parse_hdmi(jdev); + mwv207_vbios_parse_edp(jdev); + mwv207_vbios_parse_cfg(jdev); + mwv207_vbios_parse_basic(jdev); +} + +void mwv207_vbios_fini(struct mwv207_device *jdev) +{ + struct mwv207_vdat *vdat; + u32 id; + + idr_for_each_entry(&jdev->vbios.cfg_table, vdat, id) { + devm_kfree(jdev->dev, vdat->dat); + devm_kfree(jdev->dev, vdat); + } + idr_destroy(&jdev->vbios.cfg_table); +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_vbios.h b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_vbios.h new file mode 100644 index 0000000000000000000000000000000000000000..b4285d11ee0f8cbdbd487c6df3545bf2a228ac42 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_vbios.h @@ -0,0 +1,51 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#ifndef MWV207_VBIOS_H_D2JHN3FG +#define MWV207_VBIOS_H_D2JHN3FG + +struct mwv207_device; + +enum pll_id { + MWV207_PLL_GPU = 0, + MWV207_PLL_GRAPH0, + MWV207_PLL_GRAPH1, + MWV207_PLL_GRAPH2, + MWV207_PLL_GRAPH3, + MWV207_PLL_GRAPH4, + MWV207_PLL_HD, + MWV207_PLL_GU3D0, + MWV207_PLL_EDP, + MWV207_PLL_GU3D1, + MWV207_PLL_RESERVED, + MWV207_PLL_GU2D_PLL, + MWV207_PLL_DDR, + MWV207_PLL_COUNT +}; + +struct mwv207_vdat { + const void *dat; + u32 len; +}; + +int mwv207_vbios_set_pll(struct mwv207_device *jdev, int pll_id, u32 kfreq); +int mwv207_vbios_get_pll(struct mwv207_device *jdev, int pll_idx, u32 *kfreq); +int mwv207_vbios_get_vram_pll(struct mwv207_device *jdev, u32 *freq, u32 *rate); + +const struct mwv207_vdat *mwv207_vbios_vdat(struct mwv207_device *jdev, u32 key); + +void mwv207_vbios_init(struct mwv207_device *jdev); +void mwv207_vbios_fini(struct mwv207_device *jdev); +#endif diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_vcmd.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_vcmd.c new file mode 100644 index 0000000000000000000000000000000000000000..d736521ddd08faf818e12dc63ba74e9bbf581198 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/mwv207_vcmd.c @@ -0,0 +1,204 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include +#include +#include "mwv207_drv.h" +#include "mwv207_vbios.h" + +#define MWV207_PLL_BIT_MASK(_x) ((u32)(((u32)0x01U) << (_x))) +#define MWV207_PLL_BITS_MASK(_start, _end) ((u32)(((0xFFFFFFFFUL << (_start))) & (0xFFFFFFFFUL >> (31U - (u32)(_end))))) + +#define MWV207REG_PLL_STATE_BASE_ADDR(_id) (0x9B0000 + 0xA00 + 0x100 * ((_id)/6) + 0x20 * ((_id) % 6)) +#define MWV207REG_PLL_FBDIV_REFDIV_STATE(_id) (MWV207REG_PLL_STATE_BASE_ADDR(_id) + 0x00) +#define MWV207REG_PLL_FRAC_STATE(_id) (MWV207REG_PLL_STATE_BASE_ADDR(_id) + 0x04) +#define MWV207REG_PLL_POSTDIV3_0_STATE(_id) (MWV207REG_PLL_STATE_BASE_ADDR(_id) + 0x08) +#define MWV207REG_PLL_POSTDIV4_STATE(_id) (MWV207REG_PLL_STATE_BASE_ADDR(_id) + 0x0C) +#define MWV207REG_PLL_SSMOD_STATE(_id) (MWV207REG_PLL_STATE_BASE_ADDR(_id) + 0x10) + +#define PLL_RECFG_POSTDIV_OFFSET(_port) (8*((_port)%4)) +#define PLL_RECFG_POSTDIV_MASK(_port) (MWV207_PLL_BITS_MASK(0, 6) << (8*((_port)%4))) + +static int mwv207_vcmd_get_pll(struct mwv207_device *jdev, int pll_idx, u32 *kfreq) +{ + u32 port = 0; + u32 reg_val_0 = 0; + u32 reg_val_1 = 0; + u32 reg_val_2 = 0; + u64 temp = 0; + u32 refdiv; + u32 fbintdiv; + u32 fbracdiv; + u32 postdiv1; + u32 postdiv2; + + if (pll_idx == 0) + port = 1; + + mutex_lock(&jdev->vbios.vcmd_lock); + reg_val_0 = jdev_read(jdev, MWV207REG_PLL_FBDIV_REFDIV_STATE(pll_idx)); + reg_val_1 = jdev_read(jdev, MWV207REG_PLL_FRAC_STATE(pll_idx)); + reg_val_2 = jdev_read(jdev, MWV207REG_PLL_POSTDIV3_0_STATE(pll_idx)); + mutex_unlock(&jdev->vbios.vcmd_lock); + + refdiv = (reg_val_0 & MWV207_PLL_BITS_MASK(0,5)) >> 0x0; + fbintdiv = (reg_val_0 & MWV207_PLL_BITS_MASK(16,27)) >> 0x10; + fbracdiv = (reg_val_1 & MWV207_PLL_BITS_MASK(0,23)) >> 0x0; + postdiv1 = 0x4; + postdiv2 = + (reg_val_2 & PLL_RECFG_POSTDIV_MASK(port)) >> + PLL_RECFG_POSTDIV_OFFSET(port); + + if (!refdiv || !postdiv1 || !postdiv2) { + dev_err(jdev->dev, "idx %u: illegal divisor\n", pll_idx); + return -EINVAL; + } + + temp = (100000u) * 100000ull / refdiv; + temp = temp * fbintdiv + ((temp * fbracdiv) >> 24); + temp /= postdiv1; + temp /= postdiv2; + temp = DIV_ROUND_CLOSEST_ULL(temp, 100000); + *kfreq = (u32) temp; + + return 0; +} + +static inline int mwv207_vcmd_idle(struct mwv207_device *jdev) +{ + u32 state; + + state = jdev_read(jdev, 0x9B0144) >> 28; + + return state == 0x0; +} + +static inline int mwv207_vcmd_wait_idle(struct mwv207_device *jdev) +{ + int i; + + for (i = 0; i < 1000 && !mwv207_vcmd_idle(jdev); i++) + usleep_range(1000, 1001); + return mwv207_vcmd_idle(jdev) ? 0 : -ETIMEDOUT; +} + +static inline void mwv207_vcmd_req(struct mwv207_device *jdev, int cmd, + int idx, u32 value, int enable) +{ + u32 req; + + req = cmd << 28; + req |= idx << 24; + req |= value << 1; + req |= enable ? 1 : 0; + + jdev_write(jdev, 0x9B0140, req); +} + +static inline void mwv207_vcmd_start(struct mwv207_device *jdev) +{ + jdev_write(jdev, 0x9B0144, 0x1 << 28); +} + +static inline int mwv207_vcmd_result(struct mwv207_device *jdev) +{ + return (jdev_read(jdev, 0x9B0144) >> 24) & 0xf; +} + +static int mwv207_vcmd_execute(struct mwv207_device *jdev, int cmd, + int idx, u32 value, int enable) +{ + int ret; + + mutex_lock(&jdev->vbios.vcmd_lock); + + ret = mwv207_vcmd_wait_idle(jdev); + if (ret) + goto unlock; + + mwv207_vcmd_req(jdev, cmd, idx, value, enable); + + mwv207_vcmd_start(jdev); + + ret = mwv207_vcmd_wait_idle(jdev); + if (ret) + goto unlock; + + ret = mwv207_vcmd_result(jdev); + switch (ret) { + case 0: + goto unlock; + case 1: + pr_err("unsupport pll type!)"); + break; + case 2: + + pr_info_once("pll set, invalid freq!"); + break; + case 3: + pr_err("pll busy!"); + break; + case 4: + pr_err("pll set, invalid argument!"); + break; + case 9: + pr_err("PLL REQ cmd code unsupport!"); + break; + default: + pr_err("unknown pll error! (code 0x%x)", ret); + break; + } + ret = -EIO; +unlock: + mutex_unlock(&jdev->vbios.vcmd_lock); + return ret; +} + +int mwv207_vbios_set_pll(struct mwv207_device *jdev, int pll_idx, u32 kfreq) +{ + if (pll_idx >= MWV207_PLL_COUNT) + return -EINVAL; + + return mwv207_vcmd_execute(jdev, 0x1, pll_idx, + kfreq, kfreq ? 1 : 0); +} + +int mwv207_vbios_get_pll(struct mwv207_device *jdev, + int pll_idx, u32 *kfreq) +{ + if (pll_idx >= MWV207_PLL_COUNT) + return -EINVAL; + + return mwv207_vcmd_get_pll(jdev, pll_idx, kfreq); +} + +int mwv207_vbios_get_vram_pll(struct mwv207_device *jdev, u32 *freq, u32 *rate){ + u32 val, i; + u32 ddr4_rate[8][2] = { + {400,1600}, {465,1866}, {532,2133}, {600,2400}, + {655,2666}, {732,2933}, {800,3200}, {931,3733} + }; + + mwv207_vbios_get_pll(jdev, MWV207_PLL_DDR, &val); + val /= 1000; + for (i=0; i<8; i++){ + if ((val >= ddr4_rate[i][0] - 5) && (val <= ddr4_rate[i][0] + 5)){ + *freq = ddr4_rate[i][0]; + *rate = ddr4_rate[i][1]; + } + } + + return 0; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/readme.md b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/readme.md new file mode 100644 index 0000000000000000000000000000000000000000..d122dd256a2d084fee511c5d382fb43df6365f14 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/readme.md @@ -0,0 +1,7 @@ +* principles of this project + - aim for upstream inclusion + - comformant to kernel coding style + - don't reinvent wheels + - gem + ttm memory management + - kms with atomic commit + - clean display abstraction diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/selftest/selftest.c b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/selftest/selftest.c new file mode 100644 index 0000000000000000000000000000000000000000..178c4b07d9c9237de0df423fefb394b40d9308ec --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/selftest/selftest.c @@ -0,0 +1,105 @@ +/* +* SPDX-License-Identifier: GPL +* +* Copyright (c) 2020 ChangSha JingJiaMicro Electronics Co., Ltd. +* All rights reserved. +* +* Author: +* shanjinkui +* +* The software and information contained herein is proprietary and +* confidential to JingJiaMicro Electronics. This software can only be +* used by JingJiaMicro Electronics Corporation. Any use, reproduction, +* or disclosure without the written permission of JingJiaMicro +* Electronics Corporation is strictly prohibited. +*/ +#include "mwv207_drv.h" +#include "mwv207_bo.h" +#include "mwv207_dma.h" + +static int mwv207_test_create_and_map_bo(struct mwv207_device *jdev, u64 size, + u32 domain, u32 flags, struct mwv207_bo **pjbo, void **plogical) +{ + struct mwv207_bo *jbo; + void *logical; + int ret; + + ret = mwv207_bo_create(jdev, size, 0, true, + domain, flags, NULL, NULL, &jbo); + if (ret) + return ret; + ret = mwv207_bo_reserve(jbo, true); + if (ret) + goto free_bo; + ret = mwv207_bo_kmap_reserved(jbo, &logical); + if (ret) + goto unreserve_bo; + + *pjbo = jbo; + *plogical = logical; + return 0; + +unreserve_bo: + mwv207_bo_unreserve(jbo); +free_bo: + mwv207_bo_unref(jbo); + return ret; +} + +static void mwv207_test_destroy_and_unmap_bo(struct mwv207_bo *jbo) +{ + if (!jbo) + return; + + mwv207_bo_kunmap_reserved(jbo); + mwv207_bo_unreserve(jbo); + mwv207_bo_unref(jbo); +} + +static int mwv207_test_bo_acc(struct mwv207_device *jdev) +{ + struct mwv207_bo *jbo; + int i, ret; + void *logical; + + ret = mwv207_test_create_and_map_bo(jdev, 0x1000, + 0x2, 0x1, &jbo, &logical); + if (ret) + return ret; + + memset(logical, 0x5a, 0x1000); + for (i = 0; i < 0x1000; i++) { + if (*((char *)logical + i) != 0x5a) { + ret = -EIO; + break; + } + } + + mwv207_test_destroy_and_unmap_bo(jbo); + + return ret; +} + +static int mwv207_test_bo(struct mwv207_device *jdev) +{ + int ret; + + ret = mwv207_test_bo_acc(jdev); + if (ret) { + pr_err("mwv207: bo access test failed with %d", ret); + return ret; + } + + return ret; +} + +int mwv207_test(struct mwv207_device *jdev) +{ + int ret; + + ret = mwv207_test_bo(jdev); + if (ret == 0) + pr_info("mwv207 selftest passed"); + + return ret; +} diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/Kconfig b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/Kconfig new file mode 100644 index 0000000000000000000000000000000000000000..99d545df9885f09865b7a3503a29ca9b8394b54e --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/Kconfig @@ -0,0 +1,11 @@ +config DRM_MWV207 + tristate "MWV207 chip" + depends on DRM && SND_PCM + select DRM_KMS_HELPER + select DRM_VRAM_HELPER + select DRM_TTM + select DRM_TTM_HELPER + help + Choose this option if you have a Jingjia graphics card. + If M is selected, the module will be called mwv207 (JM9100). + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/build_export.sh b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/build_export.sh new file mode 100755 index 0000000000000000000000000000000000000000..9c9cca1cdaac03671643d3cb6e285707333418ac --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/build_export.sh @@ -0,0 +1,57 @@ +#!/bin/bash + +# set -x + +DEST="./opensource" + +rm -rf ${DEST} +mkdir -pv ${DEST}/{dc,selftest} + +# 复制所有 .c .h 文件到 opensource 目录 +cp -a Makefile ${DEST}/ +cp -a *.[ch] ${DEST}/ +cp -a dc/*.[ch] ${DEST}/dc/ +cp -a selftest/*.[ch] ${DEST}/selftest +# 复制 Kconfig 文件 +cp -a tools/Kconfig ${DEST}/ + +# 删除不需要的文件 +if [ -d ${DEST}/tools ]; then + rm -rf ${DEST}/tools +fi +if [ -d ${DEST}/ciconfig ]; then + rm -rf ${DEST}/ciconfig +fi + +# +TLSRC=tools/src + +# 需要进行宏替换的 .c 和 .h 文件 +SRCS=`ls ${TLSRC}/*.macro` +DC_SRCS=`ls ${TLSRC}/dc/*.macro` +SELF_SRCS=`ls ${TLSRC}/selftest/*.macro` + +for FL in ${SRCS} ${DC_SRCS} ${SELF_SRCS} +do + # mwv207_pipe_enc.c.macro + MACROSRC=`echo ${FL} | sed 's#tools/src/##'` + # mwv207_pipe_enc.c + SRC=`echo "${MACROSRC}" | sed 's/\.macro//'` + if [ -e ${DEST}/${SRC} ]; then + REPLINES=`cat ${TLSRC}/${MACROSRC}` + for RELINE in ${REPLINES} + do + KEY=`echo ${RELINE} | awk -F= '{ print $1 }'` + VAL=`echo ${RELINE} | awk -F= '{ print $2 }'` + sed -i "/define[ \t]*${KEY}[ \t]/d" ${DEST}/${SRC} + sed -i "s/${KEY}/${VAL}/g" ${DEST}/${SRC} + done + fi +done + +# mwv207_vbios.c +sed -i '/flash indexer table layout on little-endian flash/,/* 0x11F0 +---/d' ${DEST}/mwv207_vbios.c + +# dc/dw-hdmi.h +rm -rf ${DEST}/dc/dw-hdmi.h +sed -i '/dw-hdmi\.h/d' ${DEST}/dc/mwv207_hdmi.c diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_dvo.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_dvo.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..7f812e0fd5887ed4d239ed82c0186a04003a47b6 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_dvo.c.macro @@ -0,0 +1,12 @@ +MWV207_DVO_CTL=0x200 +MWV207_TOP_BASE=0x9b0000 +MWV207_HDMI_I2C_CHAN=0 +MWV207_VGA_I2C_CHAN=4 +MWV207_DVO_I2C_CHAN=5 +MWV207_HDMI_MAX_NR=4 +MWV207_VI_BASE=0x9a0000 +MWV207_TOP_VO_CFG1=0x9b0034 +MWV207_TOP_VO_CFG2=0x9b0038 +MWV207_TOP_VO_CFG3=0x9b003c +MWV207_OUTPUT_SWITCH_ON=true +MWV207_OUTPUT_SWITCH_OFF=false diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_fb.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_fb.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..409ffbbbe8c927d1bdeb76b1b130db1750aa4258 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_fb.c.macro @@ -0,0 +1,10 @@ +MWV207_GEM_DOMAIN_SYSTEM=0x1 +MWV207_GEM_DOMAIN_VRAM=0x2 +MWV207_GEM_DOMAIN_GTT=0x4 +MWV207_GEM_DOMAIN_MASK=0x7 +MWV207_GEM_CREATE_CPU_VISIBLE=(1<<0) +MWV207_GEM_CREATE_CPU_INVISIBLE=(1<<1) +MWV207_GEM_CREATE_GPU_PHYS32=(1<<2) +MWV207_GEM_CREATE_MASK=((1<<0)|(1<<1)|(1<<2)) +MWV207_GEM_WAIT_READ=0x00000001 +MWV207_GEM_WAIT_WRITE=0x00000002 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_hdmi.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_hdmi.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..55c31b17f020332974094628d057b2d9a59524b3 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_hdmi.c.macro @@ -0,0 +1,980 @@ +SCDC_MIN_SOURCE_VERSION=0x1 +MWV207_HDMI_PHY_DATA_NR=19 +MWV207_HDMI_PHY_DATA_LEN=47 +MWV207_HDMI_IRQ_BASE=32 +HDMI_VP_STUFF_YCC422_STUFFING_STUFFING_MODE=0x4 +HDMI_VP_STUFF_YCC422_STUFFING_MASK=0x4 +HDMI_VP_STUFF_YCC422_STUFFING_DIRECT_MODE=0x0 +HDMI_VP_STUFF_PR_STUFFING_STUFFING_MODE=0x1 +HDMI_VP_STUFF_PR_STUFFING_MASK=0x1 +HDMI_VP_STUFF_PR_STUFFING_DIRECT_MODE=0x0 +HDMI_VP_STUFF_PP_STUFFING_STUFFING_MODE=0x2 +HDMI_VP_STUFF_PP_STUFFING_MASK=0x2 +HDMI_VP_STUFF_PP_STUFFING_DIRECT_MODE=0x0 +HDMI_VP_STUFF_IFIX_PP_TO_LAST_OFFSET=4 +HDMI_VP_STUFF_IFIX_PP_TO_LAST_MASK=0x10 +HDMI_VP_STUFF_IDEFAULT_PHASE_OFFSET=5 +HDMI_VP_STUFF_IDEFAULT_PHASE_MASK=0x20 +HDMI_VP_STUFF_ICX_GOTO_P0_ST_OFFSET=3 +HDMI_VP_STUFF_ICX_GOTO_P0_ST_MASK=0x8 +HDMI_VP_STUFF=0x0802 +HDMI_VP_STATUS=0x0800 +HDMI_VP_STAT=0x0805 +HDMI_VP_REMAP_YCC422_24bit=0x2 +HDMI_VP_REMAP_YCC422_20bit=0x1 +HDMI_VP_REMAP_YCC422_16bit=0x0 +HDMI_VP_REMAP_MASK=0x3 +HDMI_VP_REMAP=0x0803 +HDMI_VP_PR_CD_DESIRED_PR_FACTOR_OFFSET=0 +HDMI_VP_PR_CD_DESIRED_PR_FACTOR_MASK=0x0F +HDMI_VP_PR_CD_COLOR_DEPTH_OFFSET=4 +HDMI_VP_PR_CD_COLOR_DEPTH_MASK=0xF0 +HDMI_VP_PR_CD=0x0801 +HDMI_VP_POL=0x0808 +HDMI_VP_MASK=0x0807 +HDMI_VP_INT=0x0806 +HDMI_VP_CONF_YCC422_EN_MASK=0x8 +HDMI_VP_CONF_YCC422_EN_ENABLE=0x8 +HDMI_VP_CONF_YCC422_EN_DISABLE=0x0 +HDMI_VP_CONF_PR_EN_MASK=0x10 +HDMI_VP_CONF_PR_EN_ENABLE=0x10 +HDMI_VP_CONF_PR_EN_DISABLE=0x00 +HDMI_VP_CONF_PP_EN_ENMASK=0x20 +HDMI_VP_CONF_PP_EN_ENABLE=0x20 +HDMI_VP_CONF_PP_EN_DISABLE=0x00 +HDMI_VP_CONF_OUTPUT_SELECTOR_YCC422=0x1 +HDMI_VP_CONF_OUTPUT_SELECTOR_PP=0x0 +HDMI_VP_CONF_OUTPUT_SELECTOR_MASK=0x3 +HDMI_VP_CONF_OUTPUT_SELECTOR_BYPASS=0x3 +HDMI_VP_CONF_BYPASS_SELECT_VID_PACKETIZER=0x4 +HDMI_VP_CONF_BYPASS_SELECT_PIX_REPEATER=0x0 +HDMI_VP_CONF_BYPASS_SELECT_MASK=0x4 +HDMI_VP_CONF_BYPASS_EN_MASK=0x40 +HDMI_VP_CONF_BYPASS_EN_ENABLE=0x40 +HDMI_VP_CONF_BYPASS_EN_DISABLE=0x00 +HDMI_VP_CONF=0x0804 +HDMI_TX_RCRDATA1=0x0205 +HDMI_TX_RCRDATA0=0x0204 +HDMI_TX_INVID0_VIDEO_MAPPING_OFFSET=0 +HDMI_TX_INVID0_VIDEO_MAPPING_MASK=0x1F +HDMI_TX_INVID0_INTERNAL_DE_GENERATOR_MASK=0x80 +HDMI_TX_INVID0_INTERNAL_DE_GENERATOR_ENABLE=0x80 +HDMI_TX_INVID0_INTERNAL_DE_GENERATOR_DISABLE=0x00 +HDMI_TX_INVID0=0x0200 +HDMI_TX_INSTUFFING_RCRDATA_STUFFING_MASK=0x2 +HDMI_TX_INSTUFFING_RCRDATA_STUFFING_ENABLE=0x2 +HDMI_TX_INSTUFFING_RCRDATA_STUFFING_DISABLE=0x0 +HDMI_TX_INSTUFFING_GYDATA_STUFFING_MASK=0x1 +HDMI_TX_INSTUFFING_GYDATA_STUFFING_ENABLE=0x1 +HDMI_TX_INSTUFFING_GYDATA_STUFFING_DISABLE=0x0 +HDMI_TX_INSTUFFING_BDBDATA_STUFFING_MASK=0x4 +HDMI_TX_INSTUFFING_BDBDATA_STUFFING_ENABLE=0x4 +HDMI_TX_INSTUFFING_BDBDATA_STUFFING_DISABLE=0x0 +HDMI_TX_INSTUFFING=0x0201 +HDMI_TX_GYDATA1=0x0203 +HDMI_TX_GYDATA0=0x0202 +HDMI_TX_BCBDATA1=0x0207 +HDMI_TX_BCBDATA0=0x0206 +HDMI_REVISION_ID=0x0001 +HDMI_PRODUCT_ID1_HDMI_TX=0x01 +HDMI_PRODUCT_ID1_HDMI_RX=0x02 +HDMI_PRODUCT_ID1_HDCP=0xc0 +HDMI_PRODUCT_ID1=0x0003 +HDMI_PRODUCT_ID0_HDMI_TX=0xa0 +HDMI_PRODUCT_ID0=0x0002 +HDMI_PHY_TX_PHY_LOCK=0x01 +HDMI_PHY_TST2=0x3003 +HDMI_PHY_TST1=0x3002 +HDMI_PHY_TST0_TSTEN_OFFSET=4 +HDMI_PHY_TST0_TSTEN_MASK=0x10 +HDMI_PHY_TST0_TSTCLR_OFFSET=5 +HDMI_PHY_TST0_TSTCLR_MASK=0x20 +HDMI_PHY_TST0_TSTCLK_OFFSET=0 +HDMI_PHY_TST0_TSTCLK_MASK=0x1 +HDMI_PHY_TST0=0x3001 +HDMI_PHY_STAT0=0x3004 +HDMI_PHY_RX_SENSE3=0x80 +HDMI_PHY_RX_SENSE2=0x40 +HDMI_PHY_RX_SENSE1=0x20 +HDMI_PHY_RX_SENSE0=0x10 +HDMI_PHY_POL0=0x3007 +HDMI_PHY_MASK0=0x3006 +HDMI_PHY_INT0=0x3005 +HDMI_PHY_I2CM_SS_SCL_LCNT_1_ADDR=0x302d +HDMI_PHY_I2CM_SS_SCL_LCNT_0_ADDR=0x302e +HDMI_PHY_I2CM_SS_SCL_HCNT_1_ADDR=0x302b +HDMI_PHY_I2CM_SS_SCL_HCNT_0_ADDR=0x302c +HDMI_PHY_I2CM_SOFTRSTZ_ADDR=0x302a +HDMI_PHY_I2CM_SLAVE_ADDR_PHY_GEN2=0x69 +HDMI_PHY_I2CM_SLAVE_ADDR_HEAC_PHY=0x49 +HDMI_PHY_I2CM_SLAVE_ADDR=0x3020 +HDMI_PHY_I2CM_OPERATION_ADDR_WRITE=0x10 +HDMI_PHY_I2CM_OPERATION_ADDR_READ=0x1 +HDMI_PHY_I2CM_OPERATION_ADDR=0x3026 +HDMI_PHY_I2CM_INT_ADDR_DONE_POL=0x08 +HDMI_PHY_I2CM_INT_ADDR_DONE_MASK=0x04 +HDMI_PHY_I2CM_INT_ADDR=0x3027 +HDMI_PHY_I2CM_FS_SCL_LCNT_1_ADDR=0x3031 +HDMI_PHY_I2CM_FS_SCL_LCNT_0_ADDR=0x3032 +HDMI_PHY_I2CM_FS_SCL_HCNT_1_ADDR=0x302f +HDMI_PHY_I2CM_FS_SCL_HCNT_0_ADDR=0x3030 +HDMI_PHY_I2CM_DIV_ADDR=0x3029 +HDMI_PHY_I2CM_DATAO_1_ADDR=0x3022 +HDMI_PHY_I2CM_DATAO_0_ADDR=0x3023 +HDMI_PHY_I2CM_DATAI_1_ADDR=0x3024 +HDMI_PHY_I2CM_DATAI_0_ADDR=0x3025 +HDMI_PHY_I2CM_CTLINT_ADDR_NAC_POL=0x80 +HDMI_PHY_I2CM_CTLINT_ADDR_NAC_MASK=0x40 +HDMI_PHY_I2CM_CTLINT_ADDR_ARBITRATION_POL=0x08 +HDMI_PHY_I2CM_CTLINT_ADDR_ARBITRATION_MASK=0x04 +HDMI_PHY_I2CM_CTLINT_ADDR=0x3028 +HDMI_PHY_I2CM_ADDRESS_ADDR=0x3021 +HDMI_PHY_HPD=0x02 +HDMI_PHY_CONF0_SVSRET_OFFSET=5 +HDMI_PHY_CONF0_SVSRET_MASK=0x20 +HDMI_PHY_CONF0_SELDIPIF_OFFSET=0 +HDMI_PHY_CONF0_SELDIPIF_MASK=0x1 +HDMI_PHY_CONF0_SELDATAENPOL_OFFSET=1 +HDMI_PHY_CONF0_SELDATAENPOL_MASK=0x2 +HDMI_PHY_CONF0_PDZ_OFFSET=7 +HDMI_PHY_CONF0_PDZ_MASK=0x80 +HDMI_PHY_CONF0_GEN2_TXPWRON_OFFSET=3 +HDMI_PHY_CONF0_GEN2_TXPWRON_MASK=0x8 +HDMI_PHY_CONF0_GEN2_PDDQ_OFFSET=4 +HDMI_PHY_CONF0_GEN2_PDDQ_MASK=0x10 +HDMI_PHY_CONF0_GEN2_ENHPDRXSENSE_OFFSET=2 +HDMI_PHY_CONF0_GEN2_ENHPDRXSENSE_MASK=0x4 +HDMI_PHY_CONF0_ENTMDS_OFFSET=6 +HDMI_PHY_CONF0_ENTMDS_MASK=0x40 +HDMI_PHY_CONF0=0x3000 +HDMI_MC_SWRSTZ_TMDSSWRST_REQ=0x02 +HDMI_MC_SWRSTZ_I2SSWRST_REQ=0x08 +HDMI_MC_SWRSTZ=0x4002 +HDMI_MC_SFRDIV=0x4000 +HDMI_MC_PHYRSTZ_PHYRSTZ=0x01 +HDMI_MC_PHYRSTZ=0x4005 +HDMI_MC_OPCTRL=0x4003 +HDMI_MC_LOCKONCLOCK=0x4006 +HDMI_MC_HEACPHY_RST_DEASSERT=0x0 +HDMI_MC_HEACPHY_RST_ASSERT=0x1 +HDMI_MC_HEACPHY_RST=0x4007 +HDMI_MC_FLOWCTRL_FEED_THROUGH_OFF_MASK=0x1 +HDMI_MC_FLOWCTRL_FEED_THROUGH_OFF_CSC_IN_PATH=0x1 +HDMI_MC_FLOWCTRL_FEED_THROUGH_OFF_CSC_BYPASS=0x0 +HDMI_MC_FLOWCTRL=0x4004 +HDMI_MC_CLKDIS_TMDSCLK_DISABLE=0x2 +HDMI_MC_CLKDIS_PREPCLK_DISABLE=0x4 +HDMI_MC_CLKDIS_PIXELCLK_DISABLE=0x1 +HDMI_MC_CLKDIS_HDCPCLK_DISABLE=0x40 +HDMI_MC_CLKDIS_CSCCLK_DISABLE=0x10 +HDMI_MC_CLKDIS_CECCLK_DISABLE=0x20 +HDMI_MC_CLKDIS_AUDCLK_DISABLE=0x8 +HDMI_MC_CLKDIS=0x4001 +HDMI_IH_VP_STAT0=0x0107 +HDMI_IH_PHY_STAT0_TX_PHY_LOCK=0x2 +HDMI_IH_PHY_STAT0_RX_SENSE3=0x20 +HDMI_IH_PHY_STAT0_RX_SENSE2=0x10 +HDMI_IH_PHY_STAT0_RX_SENSE1=0x8 +HDMI_IH_PHY_STAT0_RX_SENSE0=0x4 +HDMI_IH_PHY_STAT0_HPD=0x1 +HDMI_IH_PHY_STAT0=0x0104 +HDMI_IH_MUTE_VP_STAT0=0x0187 +HDMI_IH_MUTE_PHY_STAT0=0x0184 +HDMI_IH_MUTE_MUTE_WAKEUP_INTERRUPT=0x2 +HDMI_IH_MUTE_MUTE_ALL_INTERRUPT=0x1 +HDMI_IH_MUTE_I2CM_STAT0=0x0185 +HDMI_IH_MUTE_I2CMPHY_STAT0_I2CMPHYERROR=0x1 +HDMI_IH_MUTE_I2CMPHY_STAT0_I2CMPHYDONE=0x2 +HDMI_IH_MUTE_I2CMPHY_STAT0=0x0188 +HDMI_IH_MUTE_FC_STAT2_OVERFLOW_MASK=0x03 +HDMI_IH_MUTE_FC_STAT2_LOW_PRIORITY_OVERFLOW=0x02 +HDMI_IH_MUTE_FC_STAT2_HIGH_PRIORITY_OVERFLOW=0x01 +HDMI_IH_MUTE_FC_STAT2=0x0182 +HDMI_IH_MUTE_FC_STAT1=0x0181 +HDMI_IH_MUTE_FC_STAT0=0x0180 +HDMI_IH_MUTE_CEC_STAT0=0x0186 +HDMI_IH_MUTE_AS_STAT0=0x0183 +HDMI_IH_MUTE_AHBDMAAUD_STAT0_RETRY=0x08 +HDMI_IH_MUTE_AHBDMAAUD_STAT0_LOST=0x10 +HDMI_IH_MUTE_AHBDMAAUD_STAT0_ERROR=0x20 +HDMI_IH_MUTE_AHBDMAAUD_STAT0_DONE=0x04 +HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFFULL=0x02 +HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFEMPTY=0x01 +HDMI_IH_MUTE_AHBDMAAUD_STAT0=0x0189 +HDMI_IH_MUTE=0x01FF +HDMI_IH_I2CM_STAT0_ERROR=0x1 +HDMI_IH_I2CM_STAT0_DONE=0x2 +HDMI_IH_I2CM_STAT0=0x0105 +HDMI_IH_I2CMPHY_STAT0=0x0108 +HDMI_IH_FC_STAT2_OVERFLOW_MASK=0x03 +HDMI_IH_FC_STAT2_LOW_PRIORITY_OVERFLOW=0x02 +HDMI_IH_FC_STAT2_HIGH_PRIORITY_OVERFLOW=0x01 +HDMI_IH_FC_STAT2=0x0102 +HDMI_IH_FC_STAT1=0x0101 +HDMI_IH_FC_STAT0=0x0100 +HDMI_IH_FC_INT2_OVERFLOW_MASK=0x03 +HDMI_IH_FC_INT2_LOW_PRIORITY_OVERFLOW=0x02 +HDMI_IH_FC_INT2_HIGH_PRIORITY_OVERFLOW=0x01 +HDMI_IH_CEC_STAT0=0x0106 +HDMI_IH_AS_STAT0=0x0103 +HDMI_IH_AHBDMAAUD_STAT0_RETRY=0x08 +HDMI_IH_AHBDMAAUD_STAT0_LOST=0x10 +HDMI_IH_AHBDMAAUD_STAT0_ERROR=0x20 +HDMI_IH_AHBDMAAUD_STAT0_DONE=0x04 +HDMI_IH_AHBDMAAUD_STAT0_BUFFFULL=0x02 +HDMI_IH_AHBDMAAUD_STAT0_BUFFEMPTY=0x01 +HDMI_IH_AHBDMAAUD_STAT0=0x0109 +HDMI_I2CM_SS_SCL_LCNT_1_ADDR=0x7E0D +HDMI_I2CM_SS_SCL_LCNT_0_ADDR=0x7E0E +HDMI_I2CM_SS_SCL_HCNT_1_ADDR=0x7E0B +HDMI_I2CM_SS_SCL_HCNT_0_ADDR=0x7E0C +HDMI_I2CM_SOFTRSTZ=0x7E09 +HDMI_I2CM_SLAVE=0x7E00 +HDMI_I2CM_SEGPTR=0x7E0A +HDMI_I2CM_SEGADDR=0x7E08 +HDMI_I2CM_OPERATION_WRITE=0x10 +HDMI_I2CM_OPERATION_READ_EXT=0x2 +HDMI_I2CM_OPERATION_READ=0x1 +HDMI_I2CM_OPERATION=0x7E04 +HDMI_I2CM_INT_DONE_POL=0x8 +HDMI_I2CM_INT_DONE_MASK=0x4 +HDMI_I2CM_INT=0x7E05 +HDMI_I2CM_FS_SCL_LCNT_1_ADDR=0x7E11 +HDMI_I2CM_FS_SCL_LCNT_0_ADDR=0x7E12 +HDMI_I2CM_FS_SCL_HCNT_1_ADDR=0x7E0F +HDMI_I2CM_FS_SCL_HCNT_0_ADDR=0x7E10 +HDMI_I2CM_DIV=0x7E07 +HDMI_I2CM_DATAO=0x7E02 +HDMI_I2CM_DATAI=0x7E03 +HDMI_I2CM_CTLINT_NAC_POL=0x80 +HDMI_I2CM_CTLINT_NAC_MASK=0x40 +HDMI_I2CM_CTLINT_ARB_POL=0x8 +HDMI_I2CM_CTLINT_ARB_MASK=0x4 +HDMI_I2CM_CTLINT=0x7E06 +HDMI_I2CM_ADDRESS=0x7E01 +HDMI_GP_STAT=0x3503 +HDMI_GP_POL=0x3506 +HDMI_GP_MASK=0x3505 +HDMI_GP_INT=0x3504 +HDMI_GP_CONF2=0x3502 +HDMI_GP_CONF1=0x3501 +HDMI_GP_CONF0=0x3500 +HDMI_FC_VSYNCINWIDTH=0x100D +HDMI_FC_VSYNCINDELAY1=0x102F +HDMI_FC_VSYNCINDELAY0=0x100C +HDMI_FC_VSDSIZE=0x102A +HDMI_FC_VSDPAYLOAD9=0x103B +HDMI_FC_VSDPAYLOAD8=0x103A +HDMI_FC_VSDPAYLOAD7=0x1039 +HDMI_FC_VSDPAYLOAD6=0x1038 +HDMI_FC_VSDPAYLOAD5=0x1037 +HDMI_FC_VSDPAYLOAD4=0x1036 +HDMI_FC_VSDPAYLOAD3=0x1035 +HDMI_FC_VSDPAYLOAD23=0x1049 +HDMI_FC_VSDPAYLOAD22=0x1048 +HDMI_FC_VSDPAYLOAD21=0x1047 +HDMI_FC_VSDPAYLOAD2=0x1034 +HDMI_FC_VSDPAYLOAD20=0x1046 +HDMI_FC_VSDPAYLOAD19=0x1045 +HDMI_FC_VSDPAYLOAD18=0x1044 +HDMI_FC_VSDPAYLOAD17=0x1043 +HDMI_FC_VSDPAYLOAD16=0x1042 +HDMI_FC_VSDPAYLOAD15=0x1041 +HDMI_FC_VSDPAYLOAD14=0x1040 +HDMI_FC_VSDPAYLOAD13=0x103F +HDMI_FC_VSDPAYLOAD12=0x103E +HDMI_FC_VSDPAYLOAD11=0x103D +HDMI_FC_VSDPAYLOAD1=0x1033 +HDMI_FC_VSDPAYLOAD10=0x103C +HDMI_FC_VSDPAYLOAD0=0x1032 +HDMI_FC_VSDIEEEID2=0x1031 +HDMI_FC_VSDIEEEID1=0x1030 +HDMI_FC_VSDIEEEID0=0x1029 +HDMI_FC_STAT2_OVERFLOW_MASK=0x03 +HDMI_FC_STAT2_LOW_PRIORITY_OVERFLOW=0x02 +HDMI_FC_STAT2_HIGH_PRIORITY_OVERFLOW=0x01 +HDMI_FC_STAT2=0x10D8 +HDMI_FC_STAT1=0x10D4 +HDMI_FC_STAT0=0x10D0 +HDMI_FC_SPDVENDORNAME7=0x1051 +HDMI_FC_SPDVENDORNAME6=0x1050 +HDMI_FC_SPDVENDORNAME5=0x104F +HDMI_FC_SPDVENDORNAME4=0x104E +HDMI_FC_SPDVENDORNAME3=0x104D +HDMI_FC_SPDVENDORNAME2=0x104C +HDMI_FC_SPDVENDORNAME1=0x104B +HDMI_FC_SPDVENDORNAME0=0x104A +HDMI_FC_SPDPRODUCTNAME15=0x1061 +HDMI_FC_SPDDEVICEINF=0x1062 +HDMI_FC_SDPPRODUCTNAME9=0x105B +HDMI_FC_SDPPRODUCTNAME8=0x105A +HDMI_FC_SDPPRODUCTNAME7=0x1059 +HDMI_FC_SDPPRODUCTNAME6=0x1058 +HDMI_FC_SDPPRODUCTNAME5=0x1057 +HDMI_FC_SDPPRODUCTNAME4=0x1056 +HDMI_FC_SDPPRODUCTNAME3=0x1055 +HDMI_FC_SDPPRODUCTNAME2=0x1054 +HDMI_FC_SDPPRODUCTNAME14=0x1060 +HDMI_FC_SDPPRODUCTNAME13=0x105F +HDMI_FC_SDPPRODUCTNAME12=0x105E +HDMI_FC_SDPPRODUCTNAME11=0x105D +HDMI_FC_SDPPRODUCTNAME1=0x1053 +HDMI_FC_SDPPRODUCTNAME10=0x105C +HDMI_FC_SDPPRODUCTNAME0=0x1052 +HDMI_FC_SCRAMBLER_CTRL=0x10E1 +HDMI_FC_RDRB7=0x10BF +HDMI_FC_RDRB6=0x10BE +HDMI_FC_RDRB5=0x10BD +HDMI_FC_RDRB4=0x10BC +HDMI_FC_RDRB3=0x10BB +HDMI_FC_RDRB2=0x10BA +HDMI_FC_RDRB1=0x10B9 +HDMI_FC_RDRB0=0x10B8 +HDMI_FC_PRCONF_OUTPUT_PR_FACTOR_OFFSET=0 +HDMI_FC_PRCONF_OUTPUT_PR_FACTOR_MASK=0x0F +HDMI_FC_PRCONF_INCOMING_PR_FACTOR_OFFSET=4 +HDMI_FC_PRCONF_INCOMING_PR_FACTOR_MASK=0xF0 +HDMI_FC_PRCONF=0x10E0 +HDMI_FC_POL2=0x10DB +HDMI_FC_POL1=0x10D7 +HDMI_FC_POL0=0x10D3 +HDMI_FC_PACKET_TX_EN_DRM_MASK=0x80 +HDMI_FC_PACKET_TX_EN_DRM_ENABLE=0x80 +HDMI_FC_PACKET_TX_EN_DRM_DISABLE=0x00 +HDMI_FC_PACKET_TX_EN=0x10E3 +HDMI_FC_MASK2_OVERFLOW_MASK=0x03 +HDMI_FC_MASK2_LOW_PRIORITY_OVERFLOW=0x02 +HDMI_FC_MASK2_HIGH_PRIORITY_OVERFLOW=0x01 +HDMI_FC_MASK2=0x10DA +HDMI_FC_MASK1=0x10D6 +HDMI_FC_MASK0=0x10D2 +HDMI_FC_ISCR2_9=0x10A9 +HDMI_FC_ISCR2_8=0x10AA +HDMI_FC_ISCR2_7=0x10AB +HDMI_FC_ISCR2_6=0x10AC +HDMI_FC_ISCR2_5=0x10AD +HDMI_FC_ISCR2_4=0x10AE +HDMI_FC_ISCR2_3=0x10AF +HDMI_FC_ISCR2_2=0x10B0 +HDMI_FC_ISCR2_15=0x10A3 +HDMI_FC_ISCR2_14=0x10A4 +HDMI_FC_ISCR2_13=0x10A5 +HDMI_FC_ISCR2_12=0x10A6 +HDMI_FC_ISCR2_11=0x10A7 +HDMI_FC_ISCR2_1=0x10B1 +HDMI_FC_ISCR2_10=0x10A8 +HDMI_FC_ISCR2_0=0x10B2 +HDMI_FC_ISCR1_9=0x109A +HDMI_FC_ISCR1_8=0x109B +HDMI_FC_ISCR1_7=0x109C +HDMI_FC_ISCR1_6=0x109D +HDMI_FC_ISCR1_5=0x109E +HDMI_FC_ISCR1_4=0x109F +HDMI_FC_ISCR1_3=0x10A0 +HDMI_FC_ISCR1_2=0x10A1 +HDMI_FC_ISCR1_16=0x1093 +HDMI_FC_ISCR1_15=0x1094 +HDMI_FC_ISCR1_14=0x1095 +HDMI_FC_ISCR1_13=0x1096 +HDMI_FC_ISCR1_12=0x1097 +HDMI_FC_ISCR1_11=0x1098 +HDMI_FC_ISCR1_1=0x10A2 +HDMI_FC_ISCR1_10=0x1099 +HDMI_FC_ISCR1_0=0x1092 +HDMI_FC_INVIDCONF_VSYNC_IN_POLARITY_MASK=0x40 +HDMI_FC_INVIDCONF_VSYNC_IN_POLARITY_ACTIVE_LOW=0x00 +HDMI_FC_INVIDCONF_VSYNC_IN_POLARITY_ACTIVE_HIGH=0x40 +HDMI_FC_INVIDCONF_R_V_BLANK_IN_OSC_MASK=0x2 +HDMI_FC_INVIDCONF_R_V_BLANK_IN_OSC_ACTIVE_LOW=0x0 +HDMI_FC_INVIDCONF_R_V_BLANK_IN_OSC_ACTIVE_HIGH=0x2 +HDMI_FC_INVIDCONF_IN_I_P_PROGRESSIVE=0x0 +HDMI_FC_INVIDCONF_IN_I_P_MASK=0x1 +HDMI_FC_INVIDCONF_IN_I_P_INTERLACED=0x1 +HDMI_FC_INVIDCONF_HSYNC_IN_POLARITY_MASK=0x20 +HDMI_FC_INVIDCONF_HSYNC_IN_POLARITY_ACTIVE_LOW=0x00 +HDMI_FC_INVIDCONF_HSYNC_IN_POLARITY_ACTIVE_HIGH=0x20 +HDMI_FC_INVIDCONF_HDCP_KEEPOUT_MASK=0x80 +HDMI_FC_INVIDCONF_HDCP_KEEPOUT_INACTIVE=0x00 +HDMI_FC_INVIDCONF_HDCP_KEEPOUT_ACTIVE=0x80 +HDMI_FC_INVIDCONF_DVI_MODEZ_MASK=0x8 +HDMI_FC_INVIDCONF_DVI_MODEZ_HDMI_MODE=0x8 +HDMI_FC_INVIDCONF_DVI_MODEZ_DVI_MODE=0x0 +HDMI_FC_INVIDCONF_DE_IN_POLARITY_MASK=0x10 +HDMI_FC_INVIDCONF_DE_IN_POLARITY_ACTIVE_LOW=0x00 +HDMI_FC_INVIDCONF_DE_IN_POLARITY_ACTIVE_HIGH=0x10 +HDMI_FC_INVIDCONF=0x1000 +HDMI_FC_INVBLANK1=0x102E +HDMI_FC_INVBLANK0=0x1007 +HDMI_FC_INVACTV1=0x1006 +HDMI_FC_INVACTV0=0x1005 +HDMI_FC_INT2_OVERFLOW_MASK=0x03 +HDMI_FC_INT2_LOW_PRIORITY_OVERFLOW=0x02 +HDMI_FC_INT2_HIGH_PRIORITY_OVERFLOW=0x01 +HDMI_FC_INT2=0x10D9 +HDMI_FC_INT1=0x10D5 +HDMI_FC_INT0=0x10D1 +HDMI_FC_INHBLANK1=0x1004 +HDMI_FC_INHBLANK0=0x1003 +HDMI_FC_INHACTV1=0x1002 +HDMI_FC_INHACTV0=0x1001 +HDMI_FC_INFREQ2=0x1010 +HDMI_FC_INFREQ1=0x100F +HDMI_FC_INFREQ0=0x100E +HDMI_FC_HSYNCINWIDTH1=0x100B +HDMI_FC_HSYNCINWIDTH0=0x100A +HDMI_FC_HSYNCINDELAY1=0x1009 +HDMI_FC_HSYNCINDELAY0=0x1008 +HDMI_FC_GMD_UP=0x1102 +HDMI_FC_GMD_STAT=0x1100 +HDMI_FC_GMD_PB9=0x110E +HDMI_FC_GMD_PB8=0x110D +HDMI_FC_GMD_PB7=0x110C +HDMI_FC_GMD_PB6=0x110B +HDMI_FC_GMD_PB5=0x110A +HDMI_FC_GMD_PB4=0x1109 +HDMI_FC_GMD_PB3=0x1108 +HDMI_FC_GMD_PB27=0x1120 +HDMI_FC_GMD_PB26=0x111F +HDMI_FC_GMD_PB25=0x111E +HDMI_FC_GMD_PB24=0x111D +HDMI_FC_GMD_PB23=0x111C +HDMI_FC_GMD_PB22=0x111B +HDMI_FC_GMD_PB21=0x111A +HDMI_FC_GMD_PB2=0x1107 +HDMI_FC_GMD_PB20=0x1119 +HDMI_FC_GMD_PB19=0x1118 +HDMI_FC_GMD_PB18=0x1117 +HDMI_FC_GMD_PB17=0x1116 +HDMI_FC_GMD_PB16=0x1115 +HDMI_FC_GMD_PB15=0x1114 +HDMI_FC_GMD_PB14=0x1113 +HDMI_FC_GMD_PB13=0x1112 +HDMI_FC_GMD_PB12=0x1111 +HDMI_FC_GMD_PB11=0x1110 +HDMI_FC_GMD_PB1=0x1106 +HDMI_FC_GMD_PB10=0x110F +HDMI_FC_GMD_PB0=0x1105 +HDMI_FC_GMD_HB=0x1104 +HDMI_FC_GMD_EN=0x1101 +HDMI_FC_GMD_CONF=0x1103 +HDMI_FC_GCP=0x1018 +HDMI_FC_EXCTRLSPAC=0x1013 +HDMI_FC_EXCTRLDUR=0x1012 +HDMI_FC_DRM_UP=0x1167 +HDMI_FC_DRM_PB9=0x1173 +HDMI_FC_DRM_PB8=0x1172 +HDMI_FC_DRM_PB7=0x1171 +HDMI_FC_DRM_PB6=0x1170 +HDMI_FC_DRM_PB5=0x116F +HDMI_FC_DRM_PB4=0x116E +HDMI_FC_DRM_PB3=0x116D +HDMI_FC_DRM_PB26=0x1184 +HDMI_FC_DRM_PB25=0x1183 +HDMI_FC_DRM_PB24=0x1182 +HDMI_FC_DRM_PB23=0x1181 +HDMI_FC_DRM_PB22=0x1180 +HDMI_FC_DRM_PB21=0x117F +HDMI_FC_DRM_PB2=0x116C +HDMI_FC_DRM_PB20=0x117E +HDMI_FC_DRM_PB19=0x117D +HDMI_FC_DRM_PB18=0x117C +HDMI_FC_DRM_PB17=0x117B +HDMI_FC_DRM_PB16=0x117A +HDMI_FC_DRM_PB15=0x1179 +HDMI_FC_DRM_PB14=0x1178 +HDMI_FC_DRM_PB13=0x1177 +HDMI_FC_DRM_PB12=0x1176 +HDMI_FC_DRM_PB11=0x1175 +HDMI_FC_DRM_PB1=0x116B +HDMI_FC_DRM_PB10=0x1174 +HDMI_FC_DRM_PB0=0x116A +HDMI_FC_DRM_HB1=0x1169 +HDMI_FC_DRM_HB0=0x1168 +HDMI_FC_DBGTMDS2=0x121B +HDMI_FC_DBGTMDS1=0x121A +HDMI_FC_DBGTMDS0=0x1219 +HDMI_FC_DBGFORCE_FORCEVIDEO=0x1 +HDMI_FC_DBGFORCE_FORCEAUDIO=0x10 +HDMI_FC_DBGFORCE=0x1200 +HDMI_FC_DBGAUD2CH7=0x1218 +HDMI_FC_DBGAUD2CH6=0x1215 +HDMI_FC_DBGAUD2CH5=0x1212 +HDMI_FC_DBGAUD2CH4=0x120F +HDMI_FC_DBGAUD2CH3=0x120C +HDMI_FC_DBGAUD2CH2=0x1209 +HDMI_FC_DBGAUD2CH1=0x1206 +HDMI_FC_DBGAUD2CH0=0x1203 +HDMI_FC_DBGAUD1CH7=0x1217 +HDMI_FC_DBGAUD1CH6=0x1214 +HDMI_FC_DBGAUD1CH5=0x1211 +HDMI_FC_DBGAUD1CH4=0x120E +HDMI_FC_DBGAUD1CH3=0x120B +HDMI_FC_DBGAUD1CH2=0x1208 +HDMI_FC_DBGAUD1CH1=0x1205 +HDMI_FC_DBGAUD1CH0=0x1202 +HDMI_FC_DBGAUD0CH7=0x1216 +HDMI_FC_DBGAUD0CH6=0x1213 +HDMI_FC_DBGAUD0CH5=0x1210 +HDMI_FC_DBGAUD0CH4=0x120D +HDMI_FC_DBGAUD0CH3=0x120A +HDMI_FC_DBGAUD0CH2=0x1207 +HDMI_FC_DBGAUD0CH1=0x1204 +HDMI_FC_DBGAUD0CH0=0x1201 +HDMI_FC_DATMAN=0x10B6 +HDMI_FC_DATAUTO3=0x10B7 +HDMI_FC_DATAUTO2=0x10B5 +HDMI_FC_DATAUTO1=0x10B4 +HDMI_FC_DATAUTO0_VSD_OFFSET=3 +HDMI_FC_DATAUTO0_VSD_MASK=0x08 +HDMI_FC_DATAUTO0=0x10B3 +HDMI_FC_DATACH2FILL=0x1072 +HDMI_FC_DATACH1FILL=0x1071 +HDMI_FC_DATACH0FILL=0x1070 +HDMI_FC_CTRLQLOW=0x1074 +HDMI_FC_CTRLQHIGH=0x1073 +HDMI_FC_CTRLDUR=0x1011 +HDMI_FC_CH2PREAM=0x1016 +HDMI_FC_CH1PREAM=0x1015 +HDMI_FC_CH0PREAM=0x1014 +HDMI_FC_AVIVID=0x101C +HDMI_FC_AVISRB1=0x1024 +HDMI_FC_AVISRB0=0x1023 +HDMI_FC_AVISBB1=0x1020 +HDMI_FC_AVISBB0=0x101F +HDMI_FC_AVIETB1=0x101E +HDMI_FC_AVIETB0=0x101D +HDMI_FC_AVIELB1=0x1022 +HDMI_FC_AVIELB0=0x1021 +HDMI_FC_AVICONF3_QUANT_RANGE_MASK=0x0C +HDMI_FC_AVICONF3_QUANT_RANGE_LIMITED=0x00 +HDMI_FC_AVICONF3_QUANT_RANGE_FULL=0x04 +HDMI_FC_AVICONF3_IT_CONTENT_TYPE_PHOTO=0x01 +HDMI_FC_AVICONF3_IT_CONTENT_TYPE_MASK=0x03 +HDMI_FC_AVICONF3_IT_CONTENT_TYPE_GRAPHICS=0x00 +HDMI_FC_AVICONF3_IT_CONTENT_TYPE_GAME=0x03 +HDMI_FC_AVICONF3_IT_CONTENT_TYPE_CINEMA=0x02 +HDMI_FC_AVICONF3=0x1017 +HDMI_FC_AVICONF2_SCALING_VERT=0x02 +HDMI_FC_AVICONF2_SCALING_NONE=0x00 +HDMI_FC_AVICONF2_SCALING_MASK=0x03 +HDMI_FC_AVICONF2_SCALING_HORIZ_VERT=0x03 +HDMI_FC_AVICONF2_SCALING_HORIZ=0x01 +HDMI_FC_AVICONF2_RGB_QUANT_MASK=0x0C +HDMI_FC_AVICONF2_RGB_QUANT_LIMITED_RANGE=0x04 +HDMI_FC_AVICONF2_RGB_QUANT_FULL_RANGE=0x08 +HDMI_FC_AVICONF2_RGB_QUANT_DEFAULT=0x00 +HDMI_FC_AVICONF2_IT_CONTENT_VALID=0x80 +HDMI_FC_AVICONF2_IT_CONTENT_NO_DATA=0x00 +HDMI_FC_AVICONF2_IT_CONTENT_MASK=0x80 +HDMI_FC_AVICONF2_EXT_COLORIMETRY_XVYCC709=0x10 +HDMI_FC_AVICONF2_EXT_COLORIMETRY_XVYCC601=0x00 +HDMI_FC_AVICONF2_EXT_COLORIMETRY_SYCC601=0x20 +HDMI_FC_AVICONF2_EXT_COLORIMETRY_MASK=0x70 +HDMI_FC_AVICONF2_EXT_COLORIMETRY_ADOBE_YCC601=0x30 +HDMI_FC_AVICONF2_EXT_COLORIMETRY_ADOBE_RGB=0x40 +HDMI_FC_AVICONF2=0x101B +HDMI_FC_AVICONF1_COLORIMETRY_SMPTE=0x40 +HDMI_FC_AVICONF1_COLORIMETRY_NO_DATA=0x00 +HDMI_FC_AVICONF1_COLORIMETRY_MASK=0xC0 +HDMI_FC_AVICONF1_COLORIMETRY_ITUR=0x80 +HDMI_FC_AVICONF1_COLORIMETRY_EXTENDED_INFO=0xC0 +HDMI_FC_AVICONF1_CODED_ASPECT_RATIO_NO_DATA=0x00 +HDMI_FC_AVICONF1_CODED_ASPECT_RATIO_MASK=0x30 +HDMI_FC_AVICONF1_CODED_ASPECT_RATIO_4_3=0x10 +HDMI_FC_AVICONF1_CODED_ASPECT_RATIO_16_9=0x20 +HDMI_FC_AVICONF1_ACTIVE_ASPECT_RATIO_USE_CODED=0x08 +HDMI_FC_AVICONF1_ACTIVE_ASPECT_RATIO_MASK=0x0F +HDMI_FC_AVICONF1_ACTIVE_ASPECT_RATIO_4_3=0x09 +HDMI_FC_AVICONF1_ACTIVE_ASPECT_RATIO_16_9=0x0A +HDMI_FC_AVICONF1_ACTIVE_ASPECT_RATIO_14_9=0x0B +HDMI_FC_AVICONF1=0x101A +HDMI_FC_AVICONF0_SCAN_INFO_UNDERSCAN=0x20 +HDMI_FC_AVICONF0_SCAN_INFO_OVERSCAN=0x10 +HDMI_FC_AVICONF0_SCAN_INFO_NODATA=0x00 +HDMI_FC_AVICONF0_SCAN_INFO_MASK=0x30 +HDMI_FC_AVICONF0_PIX_FMT_YCBCR444=0x02 +HDMI_FC_AVICONF0_PIX_FMT_YCBCR422=0x01 +HDMI_FC_AVICONF0_PIX_FMT_RGB=0x00 +HDMI_FC_AVICONF0_PIX_FMT_MASK=0x03 +HDMI_FC_AVICONF0_BAR_DATA_VERT_HORIZ_BAR=0x0C +HDMI_FC_AVICONF0_BAR_DATA_VERT_BAR=0x04 +HDMI_FC_AVICONF0_BAR_DATA_NO_DATA=0x00 +HDMI_FC_AVICONF0_BAR_DATA_MASK=0x0C +HDMI_FC_AVICONF0_BAR_DATA_HORIZ_BAR=0x08 +HDMI_FC_AVICONF0_ACTIVE_FMT_NO_INFO=0x00 +HDMI_FC_AVICONF0_ACTIVE_FMT_MASK=0x40 +HDMI_FC_AVICONF0_ACTIVE_FMT_INFO_PRESENT=0x40 +HDMI_FC_AVICONF0=0x1019 +HDMI_FC_AUDSSTAT=0x1064 +HDMI_FC_AUDSCONF_AUD_PACKET_SAMPFIT_OFFSET=4 +HDMI_FC_AUDSCONF_AUD_PACKET_SAMPFIT_MASK=0xF0 +HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_OFFSET=0 +HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_MASK=0x1 +HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_LAYOUT1=0x1 +HDMI_FC_AUDSCONF_AUD_PACKET_LAYOUT_LAYOUT0=0x0 +HDMI_FC_AUDSCONF=0x1063 +HDMI_FC_AUDSCHNLS8_WORDLEGNTH_OFFSET=0 +HDMI_FC_AUDSCHNLS8_WORDLEGNTH_MASK=0x0f +HDMI_FC_AUDSCHNLS8_ORIGSAMPFREQ_OFFSET=4 +HDMI_FC_AUDSCHNLS8_ORIGSAMPFREQ_MASK=0xf0 +HDMI_FC_AUDSCHNLS8=0x106f +HDMI_FC_AUDSCHNLS7_ACCURACY_OFFSET=4 +HDMI_FC_AUDSCHNLS7_ACCURACY_MASK=0x30 +HDMI_FC_AUDSCHNLS7=0x106e +HDMI_FC_AUDSCHNLS6_OIEC_CH3_OFFSET=4 +HDMI_FC_AUDSCHNLS6_OIEC_CH3_MASK=0xf0 +HDMI_FC_AUDSCHNLS6_OIEC_CH2_OFFSET=0 +HDMI_FC_AUDSCHNLS6_OIEC_CH2_MASK=0x0f +HDMI_FC_AUDSCHNLS5_OIEC_CH1_OFFSET=4 +HDMI_FC_AUDSCHNLS5_OIEC_CH1_MASK=0xf0 +HDMI_FC_AUDSCHNLS5_OIEC_CH0_OFFSET=0 +HDMI_FC_AUDSCHNLS5_OIEC_CH0_MASK=0x0f +HDMI_FC_AUDSCHNLS4_OIEC_CH3_OFFSET=4 +HDMI_FC_AUDSCHNLS4_OIEC_CH3_MASK=0xf0 +HDMI_FC_AUDSCHNLS4_OIEC_CH2_OFFSET=0 +HDMI_FC_AUDSCHNLS4_OIEC_CH2_MASK=0x0f +HDMI_FC_AUDSCHNLS3_OIEC_CH1_OFFSET=4 +HDMI_FC_AUDSCHNLS3_OIEC_CH1_MASK=0xf0 +HDMI_FC_AUDSCHNLS3_OIEC_CH0_OFFSET=0 +HDMI_FC_AUDSCHNLS3_OIEC_CH0_MASK=0x0f +HDMI_FC_AUDSCHNLS0_COPYRIGHT_OFFSET=0 +HDMI_FC_AUDSCHNLS0_COPYRIGHT_MASK=0x01 +HDMI_FC_AUDSCHNLS0_CGMSA_OFFSET=4 +HDMI_FC_AUDSCHNLS0_CGMSA_MASK=0x30 +HDMI_FC_AUDICONF3_LSV_OFFSET=0 +HDMI_FC_AUDICONF3_LSV_MASK=0xF +HDMI_FC_AUDICONF3_LFEPBL_OFFSET=5 +HDMI_FC_AUDICONF3_LFEPBL_MASK=0x60 +HDMI_FC_AUDICONF3_DM_INH_OFFSET=4 +HDMI_FC_AUDICONF3_DM_INH_MASK=0x10 +HDMI_FC_AUDICONF3=0x1028 +HDMI_FC_AUDICONF2=0x1027 +HDMI_FC_AUDICONF1_SS_OFFSET=3 +HDMI_FC_AUDICONF1_SS_MASK=0x18 +HDMI_FC_AUDICONF1_SF_OFFSET=0 +HDMI_FC_AUDICONF1_SF_MASK=0x7 +HDMI_FC_AUDICONF1=0x1026 +HDMI_FC_AUDICONF0_CT_OFFSET=0 +HDMI_FC_AUDICONF0_CT_MASK=0xF +HDMI_FC_AUDICONF0_CC_OFFSET=4 +HDMI_FC_AUDICONF0_CC_MASK=0x70 +HDMI_FC_AUDICONF0=0x1025 +HDMI_FC_ACP9=0x1089 +HDMI_FC_ACP8=0x108A +HDMI_FC_ACP7=0x108B +HDMI_FC_ACP6=0x108C +HDMI_FC_ACP5=0x108D +HDMI_FC_ACP4=0x108E +HDMI_FC_ACP3=0x108F +HDMI_FC_ACP28=0x1076 +HDMI_FC_ACP27=0x1077 +HDMI_FC_ACP26=0x1078 +HDMI_FC_ACP25=0x1079 +HDMI_FC_ACP24=0x107A +HDMI_FC_ACP23=0x107B +HDMI_FC_ACP22=0x107C +HDMI_FC_ACP21=0x107D +HDMI_FC_ACP2=0x1090 +HDMI_FC_ACP20=0x107E +HDMI_FC_ACP19=0x107F +HDMI_FC_ACP18=0x1080 +HDMI_FC_ACP17=0x1081 +HDMI_FC_ACP16=0x1082 +HDMI_FC_ACP15=0x1083 +HDMI_FC_ACP14=0x1084 +HDMI_FC_ACP13=0x1085 +HDMI_FC_ACP12=0x1086 +HDMI_FC_ACP11=0x1087 +HDMI_FC_ACP1=0x1091 +HDMI_FC_ACP10=0x1088 +HDMI_FC_ACP0=0x1075 +HDMI_DESIGN_ID=0x0000 +HDMI_CSC_SCALE_CSCSCALE_MASK=0x03 +HDMI_CSC_SCALE_CSC_COLORDE_PTH_MASK=0xF0 +HDMI_CSC_SCALE_CSC_COLORDE_PTH_48BPP=0x70 +HDMI_CSC_SCALE_CSC_COLORDE_PTH_36BPP=0x60 +HDMI_CSC_SCALE_CSC_COLORDE_PTH_30BPP=0x50 +HDMI_CSC_SCALE_CSC_COLORDE_PTH_24BPP=0x00 +HDMI_CSC_SCALE=0x4101 +HDMI_CSC_COEF_C4_MSB=0x4118 +HDMI_CSC_COEF_C4_LSB=0x4119 +HDMI_CSC_COEF_C3_MSB=0x4116 +HDMI_CSC_COEF_C3_LSB=0x4117 +HDMI_CSC_COEF_C2_MSB=0x4114 +HDMI_CSC_COEF_C2_LSB=0x4115 +HDMI_CSC_COEF_C1_MSB=0x4112 +HDMI_CSC_COEF_C1_LSB=0x4113 +HDMI_CSC_COEF_B4_MSB=0x4110 +HDMI_CSC_COEF_B4_LSB=0x4111 +HDMI_CSC_COEF_B3_MSB=0x410E +HDMI_CSC_COEF_B3_LSB=0x410F +HDMI_CSC_COEF_B2_MSB=0x410C +HDMI_CSC_COEF_B2_LSB=0x410D +HDMI_CSC_COEF_B1_MSB=0x410A +HDMI_CSC_COEF_B1_LSB=0x410B +HDMI_CSC_COEF_A4_MSB=0x4108 +HDMI_CSC_COEF_A4_LSB=0x4109 +HDMI_CSC_COEF_A3_MSB=0x4106 +HDMI_CSC_COEF_A3_LSB=0x4107 +HDMI_CSC_COEF_A2_MSB=0x4104 +HDMI_CSC_COEF_A2_LSB=0x4105 +HDMI_CSC_COEF_A1_MSB=0x4102 +HDMI_CSC_COEF_A1_LSB=0x4103 +HDMI_CSC_CFG_INTMODE_OFFSET=4 +HDMI_CSC_CFG_INTMODE_MASK=0x30 +HDMI_CSC_CFG_INTMODE_DISABLE=0x00 +HDMI_CSC_CFG_INTMODE_CHROMA_INT_FORMULA2=0x20 +HDMI_CSC_CFG_INTMODE_CHROMA_INT_FORMULA1=0x10 +HDMI_CSC_CFG_DECMODE_OFFSET=0 +HDMI_CSC_CFG_DECMODE_MASK=0x3 +HDMI_CSC_CFG_DECMODE_DISABLE=0x0 +HDMI_CSC_CFG_DECMODE_CHROMA_INT_FORMULA3=0x3 +HDMI_CSC_CFG_DECMODE_CHROMA_INT_FORMULA2=0x2 +HDMI_CSC_CFG_DECMODE_CHROMA_INT_FORMULA1=0x1 +HDMI_CSC_CFG=0x4100 +HDMI_CONFIG3_ID=0x0007 +HDMI_CONFIG3_GPAUD=0x01 +HDMI_CONFIG3_AHBAUDDMA=0x02 +HDMI_CONFIG2_ID=0x0006 +HDMI_CONFIG1_ID=0x0005 +HDMI_CONFIG1_AHB=0x01 +HDMI_CONFIG0_ID=0x0004 +HDMI_CONFIG0_I2S=0x10 +HDMI_CONFIG0_CEC=0x02 +HDMI_A_VIDPOLCFG_VSYNCPOL_MASK=0x8 +HDMI_A_VIDPOLCFG_VSYNCPOL_ACTIVE_LOW=0x0 +HDMI_A_VIDPOLCFG_VSYNCPOL_ACTIVE_HIGH=0x8 +HDMI_A_VIDPOLCFG_UNENCRYPTCONF_OFFSET=5 +HDMI_A_VIDPOLCFG_UNENCRYPTCONF_MASK=0x60 +HDMI_A_VIDPOLCFG_HSYNCPOL_MASK=0x2 +HDMI_A_VIDPOLCFG_HSYNCPOL_ACTIVE_LOW=0x0 +HDMI_A_VIDPOLCFG_HSYNCPOL_ACTIVE_HIGH=0x2 +HDMI_A_VIDPOLCFG_DATAENPOL_MASK=0x10 +HDMI_A_VIDPOLCFG_DATAENPOL_ACTIVE_LOW=0x0 +HDMI_A_VIDPOLCFG_DATAENPOL_ACTIVE_HIGH=0x10 +HDMI_A_VIDPOLCFG=0x5009 +HDMI_AUD_SPDIFINT=0x3302 +HDMI_AUD_N3=0x3202 +HDMI_AUD_N2=0x3201 +HDMI_AUD_N1=0x3200 +HDMI_AUD_INT=0x3102 +HDMI_AUD_INPUTCLKFS_64FS=4 +HDMI_AUD_INPUTCLKFS_512FS=2 +HDMI_AUD_INPUTCLKFS_256FS=1 +HDMI_AUD_INPUTCLKFS_128FS=0 +HDMI_AUD_INPUTCLKFS=0x3206 +HDMI_AUD_HBR_STATUS=0x3401 +HDMI_AUD_HBR_POL=0x3403 +HDMI_AUD_HBR_MASK=0x3404 +HDMI_AUD_HBR_INT=0x3402 +HDMI_AUD_CTS3_N_SHIFT_OFFSET=5 +HDMI_AUD_CTS3_N_SHIFT_MASK=0xe0 +HDMI_AUD_CTS3_N_SHIFT_64=0x60 +HDMI_AUD_CTS3_N_SHIFT_32=0x40 +HDMI_AUD_CTS3_N_SHIFT_256=0xa0 +HDMI_AUD_CTS3_N_SHIFT_16=0x20 +HDMI_AUD_CTS3_N_SHIFT_128=0x80 +HDMI_AUD_CTS3_N_SHIFT_1=0 +HDMI_AUD_CTS3_CTS_MANUAL=0x10 +HDMI_AUD_CTS3_AUDCTS19_16_MASK=0x0f +HDMI_AUD_CTS3=0x3205 +HDMI_AUD_CTS2=0x3204 +HDMI_AUD_CTS1=0x3203 +HDMI_AUD_CONF2=0x3103 +HDMI_AUD_CONF1_WIDTH_24=0x18 +HDMI_AUD_CONF1_WIDTH_16=0x10 +HDMI_AUD_CONF1_MODE_RIGHT_J=0x20 +HDMI_AUD_CONF1_MODE_LEFT_J=0x40 +HDMI_AUD_CONF1_MODE_I2S=0x00 +HDMI_AUD_CONF1_MODE_BURST_2=0x80 +HDMI_AUD_CONF1_MODE_BURST_1=0x60 +HDMI_AUD_CONF1=0x3101 +HDMI_AUD_CONF0_SW_RESET=0x80 +HDMI_AUD_CONF0_I2S_SELECT=0x20 +HDMI_AUD_CONF0_I2S_EN3=0x08 +HDMI_AUD_CONF0_I2S_EN2=0x04 +HDMI_AUD_CONF0_I2S_EN1=0x02 +HDMI_AUD_CONF0_I2S_EN0=0x01 +HDMI_AUD_CONF0_HBR=0x3400 +HDMI_AUD_CONF0=0x3100 +HDMI_A_TIMER2SETUP1=0x500E +HDMI_A_TIMER2SETUP0=0x500D +HDMI_A_TIMER1SETUP1=0x500C +HDMI_A_TIMER1SETUP0=0x500B +HDMI_A_SRMVERMSB=0x5015 +HDMI_A_SRMVERLSB=0x5014 +HDMI_A_SRMCTRL=0x5016 +HDMI_A_SRM_BASE=0x5020 +HDMI_A_SFRSETUP=0x5017 +HDMI_A_PRESETUP=0x501A +HDMI_A_OESSWCFG=0x500A +HDMI_A_INTSETUP=0x5019 +HDMI_A_I2CHSETUP=0x5018 +HDMI_A_HDCPOBS3=0x5005 +HDMI_A_HDCPOBS2=0x5004 +HDMI_A_HDCPOBS1=0x5003 +HDMI_A_HDCPOBS0=0x5002 +HDMI_A_HDCPCFG1_SWRESET_MASK=0x1 +HDMI_A_HDCPCFG1_SWRESET_ASSERT=0x0 +HDMI_A_HDCPCFG1_PH2UPSHFTENC_MASK=0x4 +HDMI_A_HDCPCFG1_PH2UPSHFTENC_ENABLE=0x4 +HDMI_A_HDCPCFG1_PH2UPSHFTENC_DISABLE=0x0 +HDMI_A_HDCPCFG1_ENCRYPTIONDISABLE_MASK=0x2 +HDMI_A_HDCPCFG1_ENCRYPTIONDISABLE_ENABLE=0x0 +HDMI_A_HDCPCFG1_ENCRYPTIONDISABLE_DISABLE=0x2 +HDMI_A_HDCPCFG1_DISSHA1CHECK_MASK=0x8 +HDMI_A_HDCPCFG1_DISSHA1CHECK_ENABLE=0x0 +HDMI_A_HDCPCFG1_DISSHA1CHECK_DISABLE=0x8 +HDMI_A_HDCPCFG1=0x5001 +HDMI_A_HDCPCFG0_SYNCRICHECK_MASK=0x10 +HDMI_A_HDCPCFG0_SYNCRICHECK_ENABLE=0x10 +HDMI_A_HDCPCFG0_SYNCRICHECK_DISABLE=0x00 +HDMI_A_HDCPCFG0_RXDETECT_MASK=0x4 +HDMI_A_HDCPCFG0_RXDETECT_ENABLE=0x4 +HDMI_A_HDCPCFG0_RXDETECT_DISABLE=0x0 +HDMI_A_HDCPCFG0_I2CFASTMODE_MASK=0x40 +HDMI_A_HDCPCFG0_I2CFASTMODE_ENABLE=0x40 +HDMI_A_HDCPCFG0_I2CFASTMODE_DISABLE=0x00 +HDMI_A_HDCPCFG0_HDMIDVI_MASK=0x1 +HDMI_A_HDCPCFG0_HDMIDVI_HDMI=0x1 +HDMI_A_HDCPCFG0_HDMIDVI_DVI=0x0 +HDMI_A_HDCPCFG0_EN11FEATURE_MASK=0x2 +HDMI_A_HDCPCFG0_EN11FEATURE_ENABLE=0x2 +HDMI_A_HDCPCFG0_EN11FEATURE_DISABLE=0x0 +HDMI_A_HDCPCFG0_ELVENA_MASK=0x80 +HDMI_A_HDCPCFG0_ELVENA_ENABLE=0x80 +HDMI_A_HDCPCFG0_ELVENA_DISABLE=0x00 +HDMI_A_HDCPCFG0_BYPENCRYPTION_MASK=0x20 +HDMI_A_HDCPCFG0_BYPENCRYPTION_ENABLE=0x20 +HDMI_A_HDCPCFG0_BYPENCRYPTION_DISABLE=0x00 +HDMI_A_HDCPCFG0_AVMUTE_MASK=0x8 +HDMI_A_HDCPCFG0_AVMUTE_ENABLE=0x8 +HDMI_A_HDCPCFG0_AVMUTE_DISABLE=0x0 +HDMI_A_HDCPCFG0=0x5000 +HDMI_AHB_DMA_THRSLD=0x3603 +HDMI_AHB_DMA_STRADDR3=0x3607 +HDMI_AHB_DMA_STRADDR2=0x3606 +HDMI_AHB_DMA_STRADDR1=0x3605 +HDMI_AHB_DMA_STRADDR0=0x3604 +HDMI_AHB_DMA_STPADDR3=0x360b +HDMI_AHB_DMA_STPADDR2=0x360a +HDMI_AHB_DMA_STPADDR1=0x3609 +HDMI_AHB_DMA_STPADDR0=0x3608 +HDMI_AHB_DMA_STOP_STOP_OFFSET=0 +HDMI_AHB_DMA_STOP_STOP_MASK=0x01 +HDMI_AHB_DMA_STOP=0x3602 +HDMI_AHB_DMA_STAT=0x3612 +HDMI_AHB_DMA_START_START_OFFSET=0 +HDMI_AHB_DMA_START_START_MASK=0x01 +HDMI_AHB_DMA_START=0x3601 +HDMI_AHB_DMA_RETRY_SPLIT=0x40 +HDMI_AHB_DMA_POL=0x3615 +HDMI_AHB_DMA_MBLENGTH1=0x3611 +HDMI_AHB_DMA_MBLENGTH0=0x3610 +HDMI_AHB_DMA_MASK=0x3614 +HDMI_AHB_DMA_LOSTOWNERSHIP=0x20 +HDMI_AHB_DMA_INT=0x3613 +HDMI_AHB_DMA_FIFO_THREMPTY=0x04 +HDMI_AHB_DMA_FIFO_FULL=0x02 +HDMI_AHB_DMA_FIFO_EMPTY=0x01 +HDMI_AHB_DMA_ERROR=0x10 +HDMI_AHB_DMA_DONE=0x80 +HDMI_AHB_DMA_CONF1=0x3616 +HDMI_AHB_DMA_CONF0_SW_FIFO_RST_OFFSET=7 +HDMI_AHB_DMA_CONF0_SW_FIFO_RST_MASK=0x80 +HDMI_AHB_DMA_CONF0_INCR_TYPE_OFFSET=1 +HDMI_AHB_DMA_CONF0_INCR_TYPE_MASK=0x06 +HDMI_AHB_DMA_CONF0_INCR8=0x2 +HDMI_AHB_DMA_CONF0_INCR4=0x0 +HDMI_AHB_DMA_CONF0_INCR16=0x4 +HDMI_AHB_DMA_CONF0_HBR=0x10 +HDMI_AHB_DMA_CONF0_EN_HLOCK_OFFSET=3 +HDMI_AHB_DMA_CONF0_EN_HLOCK_MASK=0x08 +HDMI_AHB_DMA_CONF0_BURST_MODE=0x1 +HDMI_AHB_DMA_CONF0=0x3600 +HDMI_AHB_DMA_BUFFSTAT_FULL=0x02 +HDMI_AHB_DMA_BUFFSTAT_EMPTY=0x01 +HDMI_AHB_DMA_BUFFSTAT=0x3617 +HDMI_AHB_DMA_BUFFPOL=0x361a +HDMI_AHB_DMA_BUFFMASK=0x3619 +HDMI_AHB_DMA_BUFFINT=0x3618 +HDMI_AHB_DMA_BSTADDR3=0x360f +HDMI_AHB_DMA_BSTADDR2=0x360e +HDMI_AHB_DMA_BSTADDR1=0x360d +HDMI_AHB_DMA_BSTADDR0=0x360c +HDMI_A_APIINTSTAT=0x5007 +HDMI_A_APIINTMSK=0x5008 +HDMI_A_APIINTCLR=0x5006 +HDMI_A_5SCFG1=0x5013 +HDMI_A_5SCFG0=0x5012 +HDMI_A_2SCFG1=0x5011 +HDMI_A_2SCFG0=0x5010 +HDMI_A_100MSCFG=0x500F +HDMI_3D_TX_PHY_VLEVCTRL=0x0e +HDMI_3D_TX_PHY_TXTERM=0x19 +HDMI_3D_TX_PHY_TXRESCTRL=0x04 +HDMI_3D_TX_PHY_TXMEASCTRL=0x08 +HDMI_3D_TX_PHY_TXCLKMEASCTRL=0x07 +HDMI_3D_TX_PHY_STR_STATUS=0x1f +HDMI_3D_TX_PHY_SERDIVCTRL=0x01 +HDMI_3D_TX_PHY_SERCKKILLCTRL=0x03 +HDMI_3D_TX_PHY_SERCKCTRL=0x02 +HDMI_3D_TX_PHY_SDCAP_MODE=0x1c +HDMI_3D_TX_PHY_SCRPB_STATUS=0x18 +HDMI_3D_TX_PHY_SCOPESAMPLE=0x24 +HDMI_3D_TX_PHY_SCOPEMODE=0x1d +HDMI_3D_TX_PHY_SCOPECNTMSB2CK=0x26 +HDMI_3D_TX_PHY_SCOPECNTMSB01=0x25 +HDMI_3D_TX_PHY_SCOPECNTCLK=0x23 +HDMI_3D_TX_PHY_SCOPECNT2=0x22 +HDMI_3D_TX_PHY_SCOPECNT1=0x21 +HDMI_3D_TX_PHY_SCOPECNT0=0x20 +HDMI_3D_TX_PHY_PWRCTRL=0x00 +HDMI_3D_TX_PHY_PTRPT_ENBL_TX_READY=BIT(2) +HDMI_3D_TX_PHY_PTRPT_ENBL_TX_CLK_ALIGN_ENB=BIT(3) +HDMI_3D_TX_PHY_PTRPT_ENBL_REFCLK_ENB=BIT(0) +HDMI_3D_TX_PHY_PTRPT_ENBL_RCAL_ENB=BIT(4) +HDMI_3D_TX_PHY_PTRPT_ENBL_PG_SKIP_BIT2=BIT(8) +HDMI_3D_TX_PHY_PTRPT_ENBL_PG_SKIP_BIT1=BIT(7) +HDMI_3D_TX_PHY_PTRPT_ENBL_PG_SKIP_BIT0=BIT(6) +HDMI_3D_TX_PHY_PTRPT_ENBL_OVERRIDE=BIT(15) +HDMI_3D_TX_PHY_PTRPT_ENBL_CK_REF_ENB=BIT(5) +HDMI_3D_TX_PHY_PTRPT_ENBL_CKO_WORD_ENB=BIT(1) +HDMI_3D_TX_PHY_PTRPT_ENBL=0x1a +HDMI_3D_TX_PHY_PLLPHBYCTRL=0x13 +HDMI_3D_TX_PHY_PLLMEASCTRL=0x12 +HDMI_3D_TX_PHY_PATTERNGEN=0x1b +HDMI_3D_TX_PHY_MSM_CTRL_SCOPE_CK_SEL=BIT(0) +HDMI_3D_TX_PHY_MSM_CTRL_MPLL_PH_SEL_CK=BIT(13) +HDMI_3D_TX_PHY_MSM_CTRL_CKO_SEL_PCLK=(2<<1) +HDMI_3D_TX_PHY_MSM_CTRL_CKO_SEL_OFF=(1<<1) +HDMI_3D_TX_PHY_MSM_CTRL_CKO_SEL_FB_CLK=(3<<1) +HDMI_3D_TX_PHY_MSM_CTRL_CKO_SEL_CLK_REF_MPLL=(0<<1) +HDMI_3D_TX_PHY_MSM_CTRL=0x17 +HDMI_3D_TX_PHY_MPLLMEASCTRL=0x16 +HDMI_3D_TX_PHY_MEASCTRL=0x0d +HDMI_3D_TX_PHY_GRP_CTRL=0x14 +HDMI_3D_TX_PHY_GMPCTRL=0x15 +HDMI_3D_TX_PHY_DRVANACTRL=0x11 +HDMI_3D_TX_PHY_DIGTXMODE=0x1e +HDMI_3D_TX_PHY_D2ACTRL=0x0f +HDMI_3D_TX_PHY_CURRCTRL=0x10 +HDMI_3D_TX_PHY_CPCE_CTRL=0x06 +HDMI_3D_TX_PHY_CMPSEQCTRL=0x0a +HDMI_3D_TX_PHY_CMPPWRCTRL=0x0b +HDMI_3D_TX_PHY_CMPMODECTRL=0x0c +HDMI_3D_TX_PHY_CKSYMTXCTRL=0x09 +HDMI_3D_TX_PHY_CKCALCTRL_OVERRIDE=BIT(15) +HDMI_3D_TX_PHY_CKCALCTRL=0x05 +HDMI14_MAX_TMDSCLK=340000000 +MWV207_TOP_BASE=0x9b0000 +MWV207_HDMI_I2C_CHAN=0 +MWV207_VGA_I2C_CHAN=4 +MWV207_DVO_I2C_CHAN=5 +MWV207_HDMI_MAX_NR=4 +MWV207_VI_BASE=0x9a0000 +MWV207_TOP_VO_CFG1=0x9b0034 +MWV207_TOP_VO_CFG2=0x9b0038 +MWV207_TOP_VO_CFG3=0x9b003c +MWV207_OUTPUT_SWITCH_ON=true +MWV207_OUTPUT_SWITCH_OFF=false diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_i2c.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_i2c.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..872ec868e6758a85bc2d892d75fa37dddbe21f4c --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_i2c.c.macro @@ -0,0 +1,12 @@ +MWV207_GPIO_BASE=0x9aa000 +MWV207_GPIO_IN_L=(0x9aa000) +MWV207_GPIO_OUT_L=(0x9aa004) +MWV207_GPIO_DIR_L=(0x9aa008) +MWV207_GPIO_IN_H=(0x9aa010) +MWV207_GPIO_OUT_H=(0x9aa014) +MWV207_GPIO_DIR_H=(0x9aa018) +MWV207_GPIO_MULTIPLEX_BASE=0x9b0910 +MWV207_GPIO_MULTIPLEX16_23=(0x9b0918) +MWV207_GPIO_MULTIPLEX24_31=(0x9b091c) +MWV207_GPIO_MULTIPLEX32_39=(0x9b0910) +MWV207_GPIO_MULTIPLEX40_47=(0x9b0914) diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_va.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_va.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..5b4b82a90a08ec220c5c820b9ff53bb78811c102 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_va.c.macro @@ -0,0 +1,52 @@ +MWV207_TOP_VA_CFG1=(0x9b001c) +MWV207_TOP_VA_CFG2=(0x9b0020) +MWV207_TOP_VA_CFG3=(0x9b0024) +MWV207_TOP_VA_CFG4=(0x9b0028) +MWV207_VA_GLOBAL_BASE=0x990000 +MWV207_VA_GLOBAL_INT_EN=(0x9907f0) +MWV207_VA_GLOBAL_INT_STAT=(0x9907f4) +MWV207_VA_GLOBAL_INT_CTL=(0x9907f8) +MWV207_WIN_SEL=0x2c +MWV207_WIN_CONTRAST=0x38 +BACK_PROCESS_MODIFY=0x2c4 +BACK_PROCESS_ZOOM_FIX=0x2c0 +BACK_PROCESS_MODE=0x2a0 +HS_BEGIN_END=0x400 +HBLANK_BEGIN_END=0x404 +HTOTAL_HALF=0x408 +HTOTAL_HALF=0x408 +VTOTAL_TOPFIELD_BEGIN=0x414 +VS_1FIELD_BEGIN_END=0x418 +VS_2FIELD_BEGIN_END=0x41C +VBLANK_1FIELD_BEGIN_END_DAC=0x458 +VBLANK_2FIELD_BEGIN_END_DAC=0x45C +FRAME_DATA_SEL=0x420 +FRAME_FORMAT=0x430 +FRAME_STRIDE=0x434 +FRAME_ADDR=0x438 +FRAME_WxH=0x43C +CUT_OUT_GRAPH=0x4F8 +CURSOR_BMP=0x454 +CURSOR_ADD_MODE=0x478 +CURSOR_ADDR=0x4B4 +CURSOR_POS=0x4A8 +GRAPH_CONTRAST=0x460 +INTERLEAVED_OUT0=0x464 +LUT_RAM_SEL=0x440 +LUT_FIFO_DATA=0x444 +LUT_FIFO_ACLR=0x448 +LUT_RGB_SEL=0x44C +LUT_FIFO_USED=0x450 +MWV207_LUT_COLOR_NR=1024 +VBLANK_1FIELD_BEGIN_END=0x40C +VBLANK_2FIELD_BEGIN_END=0x410 +MWV207_GEM_DOMAIN_SYSTEM=0x1 +MWV207_GEM_DOMAIN_VRAM=0x2 +MWV207_GEM_DOMAIN_GTT=0x4 +MWV207_GEM_DOMAIN_MASK=0x7 +MWV207_GEM_CREATE_CPU_VISIBLE=(1<<0) +MWV207_GEM_CREATE_CPU_INVISIBLE=(1<<1) +MWV207_GEM_CREATE_GPU_PHYS32=(1<<2) +MWV207_GEM_CREATE_MASK=((1<<0)|(1<<1)|(1<<2)) +MWV207_GEM_WAIT_READ=0x00000001 +MWV207_GEM_WAIT_WRITE=0x00000002 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_vga.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_vga.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..9bb474c259699466db1e3ebae5871cec18b15f61 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_vga.c.macro @@ -0,0 +1,21 @@ +MWV207_DAC_CTL=0x0 +MWV207_DAC_YUV_Y1=0x4 +MWV207_DAC_YUV_U2=0x18 +MWV207_DAC_YUV_V3=0x2C +MWV207_DAC_DE_UNVALID=0x4C +MWV207_TOP_BASE=0x9b0000 +MWV207_HDMI_I2C_CHAN=0 +MWV207_VGA_I2C_CHAN=4 +MWV207_DVO_I2C_CHAN=5 +MWV207_HDMI_MAX_NR=4 +MWV207_VI_BASE=0x9a0000 +MWV207_TOP_VO_CFG1=0x9b0034 +MWV207_TOP_VO_CFG2=0x9b0038 +MWV207_TOP_VO_CFG3=0x9b003c +MWV207_OUTPUT_SWITCH_ON=true +MWV207_OUTPUT_SWITCH_OFF=false +MWV207_DAC_HPD_DIN=0xA0 +MWV207_DAC_HPD_EN=0xA4 +MWV207_DAC_HPD_STARUS=0xA8 +MWV207_DAC_HPD_MODE=0xAC +MWV207_DAC_PIN_SET=0x58 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_vi.h.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_vi.h.macro new file mode 100644 index 0000000000000000000000000000000000000000..a12894f39ea23e3658c4a8dc49a90e95fe0d5b1e --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/dc/mwv207_vi.h.macro @@ -0,0 +1,11 @@ +MWV207_TOP_BASE=0x9b0000 +MWV207_HDMI_I2C_CHAN=0 +MWV207_VGA_I2C_CHAN=4 +MWV207_DVO_I2C_CHAN=5 +MWV207_HDMI_MAX_NR=4 +MWV207_VI_BASE=0x9a0000 +MWV207_TOP_VO_CFG1=0x9a0034 +MWV207_TOP_VO_CFG2=0x9a0038 +MWV207_TOP_VO_CFG3=0x9a003c +MWV207_OUTPUT_SWITCH_ON=true +MWV207_OUTPUT_SWITCH_OFF=false diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207.h.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207.h.macro new file mode 100644 index 0000000000000000000000000000000000000000..c963bb2a5d9b25ef1ea72ce4e9dff2647c905fa8 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207.h.macro @@ -0,0 +1,8 @@ +MWV207_3D_NR=2 +MWV207_DEC_NR=1 +MWV207_ENC_NR=1 +MWV207_2D_NR=1 +MWV207_DMA_NR=1 +MWV207_SCHED_NR=6 +MWV207_IRQ_BANK=2 +MWV207_TOP_BASE=0x9b0000 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_bo.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_bo.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..409ffbbbe8c927d1bdeb76b1b130db1750aa4258 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_bo.c.macro @@ -0,0 +1,10 @@ +MWV207_GEM_DOMAIN_SYSTEM=0x1 +MWV207_GEM_DOMAIN_VRAM=0x2 +MWV207_GEM_DOMAIN_GTT=0x4 +MWV207_GEM_DOMAIN_MASK=0x7 +MWV207_GEM_CREATE_CPU_VISIBLE=(1<<0) +MWV207_GEM_CREATE_CPU_INVISIBLE=(1<<1) +MWV207_GEM_CREATE_GPU_PHYS32=(1<<2) +MWV207_GEM_CREATE_MASK=((1<<0)|(1<<1)|(1<<2)) +MWV207_GEM_WAIT_READ=0x00000001 +MWV207_GEM_WAIT_WRITE=0x00000002 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_ctx.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_ctx.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..98a51c111ee835d9689fd7c7200ab9539a4b5fcc --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_ctx.c.macro @@ -0,0 +1,9 @@ +MWV207_3D_NR=2 +MWV207_DEC_NR=1 +MWV207_ENC_NR=1 +MWV207_2D_NR=1 +MWV207_DMA_NR=1 +MWV207_SCHED_NR=6 +MWV207_ENTITY_NR=11 +MWV207_CTX_OP_CREATE=0 +MWV207_CTX_OP_DESTROY=1 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_ctx.h.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_ctx.h.macro new file mode 100644 index 0000000000000000000000000000000000000000..8776a678f1e291486222453ae3f1a2e4ca8518dc --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_ctx.h.macro @@ -0,0 +1 @@ +MWV207_ENTITY_NR=11 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_db.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_db.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..e1a1c6c2a596eaee4d873636ed0d3f78d80b469c --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_db.c.macro @@ -0,0 +1,3 @@ +MWV207_DB_MAX_NR=2048 +MWV207_INFO_OP_QUERY_ALL=0 +MWV207_INFO_OP_QUERY_REC=1 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_dma.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_dma.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..5f32de2d91cd73252d488d249fbf873667351452 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_dma.c.macro @@ -0,0 +1,46 @@ +DMA_CMEM_SIZE=0x400000 +DMA_MAX_LLI_COUNT=0x8000 +DMA_CHAN_REGION=0x200 +DMA_MAX_CHAN=2 +DMA_BURST_COUNT=32ul +DMA_INTSTATUS_DMATRANS_DONE_BIT=(1) +DMA_CTL_SHADOWREG_OR_LLI_VALID_BIT=(63) +DMA_CTL_SHADOWREG_OR_LLI_LAST_BIT=(62) +DMA_CTL_IOC_BLKTFR_BIT=(58) +DMA_CTL_DST_STAT_EN_BIT=(57) +DMA_CTL_SRC_STAT_EN_BIT=(56) +DMA_CTL_AWLEN_BIT=(48) +DMA_CTL_AWLEN_EN_BIT=(47) +DMA_CTL_ARLEN_BIT=(39) +DMA_CTL_ARLEN_EN_BIT=(38) +DMA_CTL_LAST_WR_NP_BIT=(30) +DMA_CTL_DST_TR_WIDTH_BIT=(11) +DMA_CTL_SRC_TR_WIDTH_BIT=(8) +DMA_CTL_AWLEN_MASK=(0xFF) +DMA_CTL_ARLEN_MASK=(0xFF) +DMA_CTL_DST_TR_WIDTH_MASK=(0x7) +DMA_CTL_SRC_TR_WIDTH_MASK=(0x7) +DMA_CFG_DST_MULTBLK_TYPE_BIT=(2) +DMA_CFG_SRC_MULTBLK_TYPE_BIT=(0) +DMA_CFG_DST_MULTBLK_TYPE_MASK=(0x3) +DMA_CFG_SRC_MULTBLK_TYPE_MASK=(0x3) +DMA_COMM_CFG_INTEN_BIT=(1) +DMA_COMM_CFG_DMACEN_BIT=(0) +DMA_COMM_CH_WREN_BIT=(8) +DMA_COMM_CH_EN_BIT=(0) +MWV207_DMA_SAR_LOW=(0x009d0100) +MWV207_DMA_SAR_HI=(0x009d0104) +MWV207_DMA_DAR_LOW=(0x009d0108) +MWV207_DMA_DAR_HI=(0x009d010c) +MWV207_DMA_CFG_LOW=(0x009d0120) +MWV207_DMA_CFG_HI=(0x009d0124) +MWV207_DMA_LLP_LOW=(0x009d0128) +MWV207_DMA_LLP_HI=(0x009d012C) +MWV207_DMA_INTCLEAR=(0x009d0198) +MWV207_DMA_INTSTATUS=(0x009d0188) +MWV207_DMA_COMM_RESET=(0x009d0058) +MWV207_DMA_COMM_CFG=(0x009d0010) +MWV207_DMA_COMM_CH_ENABLE_LOW=(0x009d0018) +MWV207_DMA_COMM_CH_ENABLE_HI=(0x009d001C) +MWV207_DMA_BASE_ADDR=(0x009d0000) +MWV207_OUTBOUND_BASE=0x800000000ULL diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_drm.h.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_drm.h.macro new file mode 100644 index 0000000000000000000000000000000000000000..0c2373c5cd3c4d21a084ce10f0d72a326717c34e --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_drm.h.macro @@ -0,0 +1,36 @@ +MWV207_GEM_DOMAIN_SYSTEM=0x1 +MWV207_GEM_DOMAIN_VRAM=0x2 +MWV207_GEM_DOMAIN_GTT=0x4 +MWV207_GEM_DOMAIN_MASK=0x7 +MWV207_GEM_CREATE_CPU_VISIBLE=(1<<0) +MWV207_GEM_CREATE_CPU_INVISIBLE=(1<<1) +MWV207_GEM_CREATE_GPU_PHYS32=(1<<2) +MWV207_GEM_CREATE_MASK=((1<<0)|(1<<1)|(1<<2)) +MWV207_GEM_WAIT_READ=0x00000001 +MWV207_GEM_WAIT_WRITE=0x00000002 +MWV207_CTX_OP_CREATE=0 +MWV207_CTX_OP_DESTROY=1 +MWV207_BO_ACC_FLAG_READ=0x00000000 +MWV207_BO_ACC_FLAG_WRITE=0x00000001 +MWV207_SUBMIT_ENGINE_ID_ANY=0xffffffff +MWV207_SUBMIT_ENGINE_TYPE_3D=0 +MWV207_SUBMIT_ENGINE_TYPE_DEC=1 +MWV207_SUBMIT_ENGINE_TYPE_ENC=2 +MWV207_SUBMIT_ENGINE_TYPE_2D=3 +MWV207_SUBMIT_ENGINE_TYPE_DMA=4 +MWV207_SUBMIT_FLAG_FENCE_FD_IN=0x00000001 +MWV207_SUBMIT_FLAG_FENCE_FD_OUT=0x00000002 +MWV207_SUBMIT_FLAG_MASK=0x00000003 +MWV207_SUBMIT_RELOC_WORD64=0 +MWV207_SUBMIT_RELOC_LOW32=1 +MWV207_SUBMIT_RELOC_HIGH32=2 +MWV207_SUBMIT_RELOC_32_16=3 +MWV207_SUBMIT_RELOC_FLAG_CMD_DAT=0x80000000 +MWV207_INFO_OP_QUERY_ALL=0 +MWV207_INFO_OP_QUERY_REC=1 +DRM_MWV207_INFO=0x00 +DRM_MWV207_GEM_CREATE=0x01 +DRM_MWV207_GEM_MMAP=0x02 +DRM_MWV207_GEM_WAIT=0x03 +DRM_MWV207_CTX=0x04 +DRM_MWV207_SUBMIT=0x05 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_drv.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_drv.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..fe222a998766413a9da6121115780042b4b9fc1b --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_drv.c.macro @@ -0,0 +1,13 @@ +MWV207_AXI_VRAM_BASE=0x10000000 +MWV207_AXI_REG_BASE=0x00000000 +IATU_BASE=0x10000 +IATU_INC=0x200 +IATU_REGION_TYPE_OFFSET=0x100 +IATU_REGION_CONTROL_OFFSET=0x104 +IATU_REGION_TARGET_LOW_OFFSET=0x114 +IATU_REGION_TARGET_HIGH_OFFSET=0x118 +IATU_REGION_TYPE_MEM=0x00 +IATU_REGION_MODE_BAR=1 +IATU_REGION_ENABLE_SHIFT=31 +IATU_REGION_MODE_SHIFT=30 +IATU_REGION_BAR_SHIFT=8 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_gem.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_gem.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..409ffbbbe8c927d1bdeb76b1b130db1750aa4258 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_gem.c.macro @@ -0,0 +1,10 @@ +MWV207_GEM_DOMAIN_SYSTEM=0x1 +MWV207_GEM_DOMAIN_VRAM=0x2 +MWV207_GEM_DOMAIN_GTT=0x4 +MWV207_GEM_DOMAIN_MASK=0x7 +MWV207_GEM_CREATE_CPU_VISIBLE=(1<<0) +MWV207_GEM_CREATE_CPU_INVISIBLE=(1<<1) +MWV207_GEM_CREATE_GPU_PHYS32=(1<<2) +MWV207_GEM_CREATE_MASK=((1<<0)|(1<<1)|(1<<2)) +MWV207_GEM_WAIT_READ=0x00000001 +MWV207_GEM_WAIT_WRITE=0x00000002 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_irq.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_irq.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..65a5bd9b15ae6d58211fb0e3ef6bc51ebd97fe12 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_irq.c.macro @@ -0,0 +1,5 @@ +MWV207_MAX_IRQ_NR=64 +MWV207REG_IRQ_BASE=(0x009A8000) +MWV207REG_IRQ_ENABLE=(0x009A8020) +MWV207REG_IRQ_STATE=(0x009A802c) +MWV207_IRQ_BANK=2 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_2d.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_2d.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..a71ff37460ef23fba9753cd6017b1cb4f79956b7 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_2d.c.macro @@ -0,0 +1,31 @@ +PIPE_2D_RING_SIZE=0x40000 +PIPE_2D_IRQ=17 +PIPE_2D_REG_STATUS=0x4100 +PIPE_2D_REG_CTRL=0x4200 +PIPE_2D_REG_INT_CLR=0x4308 +PIPE_2D_REG_INTSTAT_CLR=0x4800 +PIPE_2D_REG_UPDATE_WL=0x4C00 +PIPE_2D_REG_INTSTAT=0x6000 +PIPE_2D_OP_CFG=0x40000000 +PIPE_2D_OP_NOP=0x80000000 +PIPE_2D_OP_WAIT=0x88000000 +PIPE_2D_OP_LINK=0x89000000 +PIPE_2D_PENDING1_91=0x70038000 +PIPE_2D_PENDING2_91=0x00000000 +PIPE_2D_PENDING1_92=0xF87FC000 +PIPE_2D_PENDING2_92=0x0000000F +MWV207_TOP_REG_2D=(0x009B0014) +MWV207_TOP_REG_NOC=(0x009B0048) +MWV207_TOP_REG_PENDING1=(0x009B0194) +MWV207_TOP_REG_PENDING2=(0x009B0198) +MWV207_TOP_REG_BASE=0x009B0000 +MWV207_GEM_DOMAIN_SYSTEM=0x1 +MWV207_GEM_DOMAIN_VRAM=0x2 +MWV207_GEM_DOMAIN_GTT=0x4 +MWV207_GEM_DOMAIN_MASK=0x7 +MWV207_GEM_CREATE_CPU_VISIBLE=(1<<0) +MWV207_GEM_CREATE_CPU_INVISIBLE=(1<<1) +MWV207_GEM_CREATE_GPU_PHYS32=(1<<2) +MWV207_GEM_CREATE_MASK=((1<<0)|(1<<1)|(1<<2)) +MWV207_GEM_WAIT_READ=0x00000001 +MWV207_GEM_WAIT_WRITE=0x00000002 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_3d.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_3d.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..9e2dd5fc8ea9e9aca30bb528057a45f0a950a347 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_3d.c.macro @@ -0,0 +1,45 @@ +JPIPE_3D_RINGBUF_SIZE=0x40000 +JPIPE_3D_IRQ=19 +PIPE_3D_NR_EVENT=30 +JPIPE_3D_OP_WAIT=0x38000000 +JPIPE_3D_OP_LINK=0x40000000 +JPIPE_3D_OP_STALL=0x48000000 +JPIPE_3D_OP_STATE=0x08010000 +JPIPE_3D_EVENT=0x0e01 +JPIPE_3D_SEM=0x0e02 +JPIPE_3D_FLUSH_CACHE=0x0e03 +JPIPE_3D_BLT_CACHE=0x502b +JPIPE_3D_BLT_LOCK=0x502e +JPIPE_3D_BLT_CLUSTER=0x50ce +JPIPE_3D_FENCE_DATA_HI=0x0e26 +JPIPE_3D_FENCE_DATA_LOW=0x0e1b +JPIPE_3D_CLIENT_FE=0x1 +JPIPE_3D_CLIENT_PE=0x7 +JPIPE_3D_CLIENT_BLT=0x10 +JPIPE_3D_CLK_CTRL=0x000 +JPIPE_3D_INTERRUPT=0x014 +JPIPE_3D_MEM_COUNTERS=0x03c +JPIPE_3D_CLK_GATING_TOP=0x100 +JPIPE_3D_CLK_GATING=0x104 +JPIPE_3D_PULSE_EATER=0x10c +JPIPE_3D_AHB_PWR_CTRL=0x154 +JPIPE_3D_CMD_AHB_CTRL=0x3a4 +JPIPE_3D_AXI_CTRL2=0x3ac +JPIPE_3D_MEM_CTRL=0x414 +JPIPE_3D_L2_CTRL=0x55c +JPIPE_3D_FLUSH_TCACHE=0x594 +JPIPE_3D_CMD_ADDR=0x654 +JPIPE_3D_CMD_CTRL=0x658 +JPIPE_3D_AHB_CTRL=0x3a8 +JPIPE_3D_FENCE=0x0e1a +JPIPE_3D_AXI_CTRL=0x090 +MWV207_GEM_DOMAIN_SYSTEM=0x1 +MWV207_GEM_DOMAIN_VRAM=0x2 +MWV207_GEM_DOMAIN_GTT=0x4 +MWV207_GEM_DOMAIN_MASK=0x7 +MWV207_GEM_CREATE_CPU_VISIBLE=(1<<0) +MWV207_GEM_CREATE_CPU_INVISIBLE=(1<<1) +MWV207_GEM_CREATE_GPU_PHYS32=(1<<2) +MWV207_GEM_CREATE_MASK=((1<<0)|(1<<1)|(1<<2)) +MWV207_GEM_WAIT_READ=0x00000001 +MWV207_GEM_WAIT_WRITE=0x00000002 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_dec.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_dec.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..5ecf7173e4049cb58fc41d1b212741b4f3c8c820 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_dec.c.macro @@ -0,0 +1,4 @@ +JPIPE_DEC_STAT_REG=0x4 +JPIPE_DEC_STAT_RUNNING=0x1 +JPIPE_DEC_STAT_ABORT=0x20 +JPIPE_DEC_STAT_DISABLE_IRQ=0x30 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_dma.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_dma.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..52b61fcf61e0819bee052e6e37769224082f6f40 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_dma.c.macro @@ -0,0 +1,43 @@ +JPIPE_DMA_IRQ=43 +MWV207_OUTBOUND_BASE=0x800000000ULL +DMA_CHAN_REGION=0x200 +DMA_BURST_COUNT=32ul +DMA_INTSTATUS_DMATRANS_DONE_BIT=(1) +DMA_CTL_SHADOWREG_OR_LLI_VALID_BIT=(63) +DMA_CTL_SHADOWREG_OR_LLI_LAST_BIT=(62) +DMA_CTL_IOC_BLKTFR_BIT=(58) +DMA_CTL_DST_STAT_EN_BIT=(57) +DMA_CTL_SRC_STAT_EN_BIT=(56) +DMA_CTL_AWLEN_BIT=(48) +DMA_CTL_AWLEN_EN_BIT=(47) +DMA_CTL_ARLEN_BIT=(39) +DMA_CTL_ARLEN_EN_BIT=(38) +DMA_CTL_LAST_WR_NP_BIT=(30) +DMA_CTL_DST_TR_WIDTH_BIT=(11) +DMA_CTL_SRC_TR_WIDTH_BIT=(8) +DMA_CTL_AWLEN_MASK=(0xFF) +DMA_CTL_ARLEN_MASK=(0xFF) +DMA_CTL_DST_TR_WIDTH_MASK=(0x7) +DMA_CTL_SRC_TR_WIDTH_MASK=(0x7) +DMA_CFG_DST_MULTBLK_TYPE_BIT=(2) +DMA_CFG_SRC_MULTBLK_TYPE_BIT=(0) +DMA_CFG_DST_MULTBLK_TYPE_MASK=(0x3) +DMA_CFG_SRC_MULTBLK_TYPE_MASK=(0x3) +DMA_COMM_CFG_INTEN_BIT=(1) +DMA_COMM_CFG_DMACEN_BIT=(0) +DMA_COMM_CH_WREN_BIT=(8) +DMA_COMM_CH_EN_BIT=(0) +MWV207_DMA_SAR_LOW=(0x100) +MWV207_DMA_SAR_HI=(0x104) +MWV207_DMA_DAR_LOW=(0x108) +MWV207_DMA_DAR_HI=(0x10c) +MWV207_DMA_CFG_LOW=(0x120) +MWV207_DMA_CFG_HI=(0x124) +MWV207_DMA_LLP_LOW=(0x128) +MWV207_DMA_LLP_HI=(0x12C) +MWV207_DMA_INTCLEAR=(0x198) +MWV207_DMA_INTSTATUS=(0x188) +MWV207_DMA_COMM_RESET=(0x58) +MWV207_DMA_COMM_CFG=(0x10) +MWV207_DMA_COMM_CH_ENABLE_LOW=(0x18) +MWV207_DMA_COMM_CH_ENABLE_HI=(0x1C) diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_enc.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_enc.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..2c3b098c793e412c0e381fc3a4d3d19490423103 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_pipe_enc.c.macro @@ -0,0 +1,10 @@ +JPIPE_ENC_STAT_REG=0x4 +JPIPE_STATUS_FUSE_ERROR=0x200 +JPIPE_STATUS_SLICE_READY=0x100 +JPIPE_STATUS_LINE_BUFFER_DONE=0x080 +JPIPE_STATUS_HW_TIMEOUT=0x040 +JPIPE_STATUS_BUFF_FULL=0x020 +JPIPE_STATUS_HW_RESET=0x010 +JPIPE_STATUS_ERROR=0x008 +JPIPE_STATUS_FRAME_READY=0x004 +JPIPE_STATUS_SEGMENT_READY=0x1000 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_sched.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_sched.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..e74c1a52383d227a20a1bec8c5cfd7e44bfd353c --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_sched.c.macro @@ -0,0 +1,12 @@ +JPIPE_DMA0_REGBASE=0x9d0000 +JPIPE_3D0_REGBASE=0x900000 +JPIPE_3D1_REGBASE=0x910000 +JPIPE_DEC0_REGBASE=0x930000 +JPIPE_DEC1_REGBASE=0x940000 +JPIPE_ENC0_REGBASE=0x920000 +JPIPE_2D0_REGBASE=0x968000 +MWV207_3D_NR=2 +MWV207_DEC_NR=1 +MWV207_ENC_NR=1 +MWV207_2D_NR=1 +MWV207_SCHED_NR=6 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_sched.h.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_sched.h.macro new file mode 100644 index 0000000000000000000000000000000000000000..016e74f9e68b37734047f02eeda6ca9766dbb00a --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_sched.h.macro @@ -0,0 +1 @@ +MWV207_MAX_CMD_SIZE=0x20000 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_submit.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_submit.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..19b5b59b97f08d3a50a437095beaf8de9c61e0fb --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_submit.c.macro @@ -0,0 +1,28 @@ +MWV207_STACK_BO_NR=32 +MWV207_STACK_CMD_DAT_NR=8 +MWV207_BO_ACC_FLAG_WRITE=0x00000001 +MWV207_SUBMIT_ENGINE_ID_ANY=0xffffffff +MWV207_SUBMIT_ENGINE_TYPE_3D=0 +MWV207_SUBMIT_ENGINE_TYPE_DEC=1 +MWV207_SUBMIT_ENGINE_TYPE_ENC=2 +MWV207_SUBMIT_ENGINE_TYPE_2D=3 +MWV207_SUBMIT_ENGINE_TYPE_DMA=4 +MWV207_SUBMIT_FLAG_FENCE_FD_IN=0x00000001 +MWV207_SUBMIT_FLAG_FENCE_FD_OUT=0x00000002 +MWV207_SUBMIT_FLAG_MASK=0x00000003 +MWV207_SUBMIT_RELOC_WORD64=0 +MWV207_SUBMIT_RELOC_LOW32=1 +MWV207_SUBMIT_RELOC_HIGH32=2 +MWV207_SUBMIT_RELOC_32_16=3 +MWV207_SUBMIT_RELOC_FLAG_CMD_DAT=0x80000000 +MWV207_MAX_CMD_SIZE=0x20000 +MWV207_GEM_DOMAIN_SYSTEM=0x1 +MWV207_GEM_DOMAIN_VRAM=0x2 +MWV207_GEM_DOMAIN_GTT=0x4 +MWV207_GEM_DOMAIN_MASK=0x7 +MWV207_GEM_CREATE_CPU_VISIBLE=(1<<0) +MWV207_GEM_CREATE_CPU_INVISIBLE=(1<<1) +MWV207_GEM_CREATE_GPU_PHYS32=(1<<2) +MWV207_GEM_CREATE_MASK=((1<<0)|(1<<1)|(1<<2)) +MWV207_GEM_WAIT_READ=0x00000001 +MWV207_GEM_WAIT_WRITE=0x00000002 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_ttm.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_ttm.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..409ffbbbe8c927d1bdeb76b1b130db1750aa4258 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_ttm.c.macro @@ -0,0 +1,10 @@ +MWV207_GEM_DOMAIN_SYSTEM=0x1 +MWV207_GEM_DOMAIN_VRAM=0x2 +MWV207_GEM_DOMAIN_GTT=0x4 +MWV207_GEM_DOMAIN_MASK=0x7 +MWV207_GEM_CREATE_CPU_VISIBLE=(1<<0) +MWV207_GEM_CREATE_CPU_INVISIBLE=(1<<1) +MWV207_GEM_CREATE_GPU_PHYS32=(1<<2) +MWV207_GEM_CREATE_MASK=((1<<0)|(1<<1)|(1<<2)) +MWV207_GEM_WAIT_READ=0x00000001 +MWV207_GEM_WAIT_WRITE=0x00000002 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_vbios.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_vbios.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..c57981b81cbe2d4205034c2884b476223e5e55a4 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_vbios.c.macro @@ -0,0 +1,9 @@ +MWV207_FLASH_BASE=0x100000 +MWV207_FLASH_INDEXER_BASE=0xa000 +MWV207_FLASH_VER_IDX=0x0 +MWV207_FLASH_UVER_IDX=0x1 +MWV207_FLASH_CFG_IDX=0x5 +MWV207_FLASH_HDMI_IDX=0xa +MWV207_FLASH_HDMI_LIMIT=0x1200 +MWV207_FLASH_HDMI_LEN=1140 + diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_vcmd.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_vcmd.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..6b3ee0fc71e65d8d32f0b5593fce92308e91be6e --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/mwv207_vcmd.c.macro @@ -0,0 +1,9 @@ +MWV207REG_PLL_STATUS=(0x9b0144) +MWV207_PLL_STATE_IDLE=0 +MWV207_PLL_STATE_START=1 +MWV207_PLL_STATE_RECV=2 +MWV207_PLL_STATE_BUSY=3 +MWV207REG_PLL_REQ=(0x9b0140) +MWV207_VCMD_SET_FREQ=1 +MWV207_VCMD_SET_VOLT=2 +MWV207_TOP_BASE=0x9b0000 diff --git a/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/selftest/selftest.c.macro b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/selftest/selftest.c.macro new file mode 100644 index 0000000000000000000000000000000000000000..6f9585b5d0a5f5bfde79074524be10d97af64278 --- /dev/null +++ b/vendor_phytium/gpu_model/jm/kernel_source/linux-6.6/mwv207/tools/src/selftest/selftest.c.macro @@ -0,0 +1,12 @@ +MWV207_TEST_DMA_SIZE=0x800000 +MWV207_TEST_BO_SIZE=0x1000 +MWV207_GEM_DOMAIN_SYSTEM=0x1 +MWV207_GEM_DOMAIN_VRAM=0x2 +MWV207_GEM_DOMAIN_GTT=0x4 +MWV207_GEM_DOMAIN_MASK=0x7 +MWV207_GEM_CREATE_CPU_VISIBLE=(1<<0) +MWV207_GEM_CREATE_CPU_INVISIBLE=(1<<1) +MWV207_GEM_CREATE_GPU_PHYS32=(1<<2) +MWV207_GEM_CREATE_MASK=((1<<0)|(1<<1)|(1<<2)) +MWV207_GEM_WAIT_READ=0x00000001 +MWV207_GEM_WAIT_WRITE=0x00000002 diff --git a/vendor_phytium/gpu_model/jm/readme.txt b/vendor_phytium/gpu_model/jm/readme.txt index e1973670b38b6fde4bb60e22f7edfe709a75acdb..03f445bc1857f0821c92bade7ab98db6c27ff88e 100644 --- a/vendor_phytium/gpu_model/jm/readme.txt +++ b/vendor_phytium/gpu_model/jm/readme.txt @@ -1,12 +1,12 @@ GPU Vendor: Jemoic Support gpu model:jm9100 km version:[ - repo: https://gitee.com/jemoic/mesa.git - branch: openkylin/mesa-22.3.7 - commit: 23546f505dc922a21eaa538214618b13e9d49b77 + repo: https://gitee.com/jemoic/jemoic-openharmony-code-source.git + branch: OpenHarmony_5.0_release + commit: d2febaf0afe0580e833737ce078c294c16806380 ] um version:[ - repo: https://gitee.com/jemoic/phytium-linux-kernel.git - branch: xxxx + repo: https://gitee.com/jemoic/jemoic-openharmony-code-source.git + branch: OpenHarmony_5.0_release commit: xxxx ] diff --git a/vendor_phytium/gpu_model/sw/BUILD.gn b/vendor_phytium/gpu_model/sw/BUILD.gn index d12a4a3febf5dbf07a2941d2405a8119e33a420c..df37954f5ac8a8d788075813f1f1ec49978786d2 100644 --- a/vendor_phytium/gpu_model/sw/BUILD.gn +++ b/vendor_phytium/gpu_model/sw/BUILD.gn @@ -15,6 +15,6 @@ import("//build/ohos.gni") group("gpu_group") { deps = [ - "//vendor/phytium/gpu_model/${gpu_model}/gpu:mesa-pvr-gpu-libs", + "//vendor/phytium/gpu_model/sw/gpu:mesa-sw-gpu-libs", ] } \ No newline at end of file diff --git a/vendor_phytium/gpu_model/sw/gpu/BUILD.gn b/vendor_phytium/gpu_model/sw/gpu/BUILD.gn index 4eace0ede7e1561248b62cfc42531dc971b881bd..43c54d20b0997622f0fe801e4f486e7d9132e193 100644 --- a/vendor_phytium/gpu_model/sw/gpu/BUILD.gn +++ b/vendor_phytium/gpu_model/sw/gpu/BUILD.gn @@ -18,16 +18,18 @@ partname="device_${product_name}" mesa3d_libs_dir = "mesa3d_swrast" mesa3d_all_lib_items = [ - ["libEGL.so.1.0.0", ["libEGL.so.1","libEGL_impl.so"]], - ["libgbm.so.1.0.0", ["libgbm.so", "libgbm.so.1"]], - ["libglapi.so.0.0.0", ["libglapi.so", "libglapi.so.0"]], - ["libGLESv1_CM.so.1.1.0", ["libGLESv1_CM.so", "libGLESv1_CM.so.1","libGLESv1_impl.so"]], - ["libGLESv2.so.2.0.0", ["libGLESv2.so.2","libGLESv2_impl.so","libGLESv3_impl.so"]], + ["libEGL_sw", "libEGL.so.1.0.0", ["libEGL.so.1", "libEGL_impl.so"]], + ["libGLESv1_sw", "libGLESv1_CM.so.1.1.0", ["libGLESv1_CM.so","libGLESv1_impl.so"]], + ["libGLESv2_sw", "libGLESv2.so.2.0.0", ["libGLESv2.so", "libGLESv2_impl.so","libGLESv3_impl.so"]], + ["libglapi_sw", "libglapi.so.0.0.0", ["libglapi.so", "libglapi.so.0"]], + ["libgbm_sw", "libgbm.so.1.0.0", ["libgbm.so", "libgbm.so.1"]] +] +mesa3d_all_dri_items = [ ["kms_swrast_dri.so", ["kms_swrast_dri.so"]] ] mesa3d_all_lib_deps = [] -foreach(item, mesa3d_all_lib_items) { +foreach(item, mesa3d_all_dri_items) { name = item[0] ohos_prebuilt_shared_library(name) { source = "$mesa3d_libs_dir/$name" @@ -41,8 +43,22 @@ foreach(item, mesa3d_all_lib_items) { mesa3d_all_lib_deps += [ ":$name" ] } -group("mesa-pvr-gpu-libs"){ +foreach(item, mesa3d_all_lib_items) { + name = item[1] + prebuild_name = item[0] + ohos_prebuilt_shared_library(prebuild_name) { + source = "$mesa3d_libs_dir/$name" + symlink_target_name = item[2] + install_enable = true + install_images = [ chipset_base_dir ] + relative_install_dir = "chipsetsdk/sw" + subsystem_name = "phytium_products" + part_name = "${partname}" + } + mesa3d_all_lib_deps += [ ":$prebuild_name" ] +} + +group("mesa-sw-gpu-libs"){ deps = mesa3d_all_lib_deps } - diff --git a/vendor_phytium/gpu_model/x100/BUILD.gn b/vendor_phytium/gpu_model/x100/BUILD.gn index b6777e70f5802a63bdb78f80e4a9fa2e2df8d597..1e1085dddad9cbdbac3bc06ac0094f24b9dc2bf1 100644 --- a/vendor_phytium/gpu_model/x100/BUILD.gn +++ b/vendor_phytium/gpu_model/x100/BUILD.gn @@ -15,7 +15,7 @@ import("//build/ohos.gni") group("gpu_group") { deps = [ - "//vendor/phytium/gpu_model/${gpu_model}/gpu:mesa-pvr-gpu-libs", - "//vendor/phytium/gpu_model/${gpu_model}/vpu:vpu-libs", + "//vendor/phytium/gpu_model/x100/gpu:mesa-pvr-gpu-libs", + "//vendor/phytium/gpu_model/x100/vpu:vpu-libs", ] } diff --git a/vendor_phytium/gpu_model/x100/gpu/BUILD.gn b/vendor_phytium/gpu_model/x100/gpu/BUILD.gn index 67a43a5deae10f163f538be3a9f08a251fa89332..e3f9acc27279c0aeb498b6c6c836be8d5b578f8e 100644 --- a/vendor_phytium/gpu_model/x100/gpu/BUILD.gn +++ b/vendor_phytium/gpu_model/x100/gpu/BUILD.gn @@ -41,25 +41,25 @@ if (KERNEL_4_19) { }else{ mesa3d_pvr_libs_dir = "mesa3d_kernel_5.10" mesa3d_all_lib_items = [ - ["libEGL_", "libEGL.so.1.0.0", ["libEGL.so.1", "libEGL_impl.so"]], - ["libGLESv1", "libGLESv1_CM_PVR_MESA.so.1.16.6099580", ["libGLESv1_CM_PVR_MESA.so","libGLESv1_impl.so"]], - ["libGLESv2", "libGLESv2_PVR_MESA.so.1.16.6099580", ["libGLESv2_PVR_MESA.so", "libGLESv2_impl.so","libGLESv3_impl.so"]] + ["libEGL_x100", "libEGL.so.1.0.0", ["libEGL.so.1", "libEGL_impl.so"]], + ["libGLESv1_x100", "libGLESv1_CM_PVR_MESA.so.1.16.6099580", ["libGLESv1_CM_PVR_MESA.so","libGLESv1_impl.so"]], + ["libGLESv2_x100", "libGLESv2_PVR_MESA.so.1.16.6099580", ["libGLESv2_PVR_MESA.so", "libGLESv2_impl.so","libGLESv3_impl.so"]] ] mesa3d_all_relay_lib_items = [ - ["libgbm", "libgbm.so.1.0.0", ["libgbm.so", "libgbm.so.1"]], - ["libglapi", "libglapi.so.0.0.0", ["libglapi.so", "libglapi.so.0"]], - ["libglslcompiler", "libglslcompiler.so.1.16.6099580", ["libglslcompiler.so"]], + ["libgbm_x100", "libgbm.so.1.0.0", ["libgbm.so", "libgbm.so.1"]], + ["libglapi_x100", "libglapi.so.0.0.0", ["libglapi.so", "libglapi.so.0"]], + ["libglslcompiler_x100", "libglslcompiler.so.1.16.6099580", ["libglslcompiler.so"]], ["libdrm_pvr", "libdrm.so.2.4.0", ["libdrm.so.2", "libdrm.so"]], ["libexpat_pvr", "libexpat.so.1.6.11", ["libexpat.so.1", "libexpat.so"]], ["libxml2_pvr", "libxml2.so.2.9.10", ["libxml2.so.2", "libxml2.so"]], ["libpvr_dri_support", "libpvr_dri_support.so.1.16.6099580", ["libpvr_dri_support.so"]], ["libsrv_um", "libsrv_um.so.1.16.6099580", ["libsrv_um.so"]], - ["libusc", "libusc.so.1.16.6099580", ["libusc.so"]], + ["libusc_x100", "libusc.so.1.16.6099580", ["libusc.so"]], ["libz_pvr", "libz.so.1.2.11", ["libz.so.1"]], - ["libPVRScopeServices", "libPVRScopeServices.so.1.16.6099580", ["libPVRScopeServices.so"]], + ["libPVRScopeServices_x100", "libPVRScopeServices.so.1.16.6099580", ["libPVRScopeServices.so"]], ["libstdc_pvr", "libstdc++.so.6.0.29", ["libstdc++.so.6", "libstdc++.so"]], - ["libgcc_s", "libgcc_s.so.1", ["libgcc_s.so"]] - ] + ["libgcc_s_x100", "libgcc_s.so.1", ["libgcc_s.so"]] + ] } mesa3d_all_lib_deps = [] @@ -90,6 +90,7 @@ if (enable_ramdisk) { install_enable = true install_images = [ "ramdisk", + "updater" ] module_install_dir = "lib/firmware" } @@ -102,6 +103,7 @@ if (enable_ramdisk) { install_enable = true install_images = [ "ramdisk", + "updater" ] module_install_dir = "lib/firmware" } @@ -117,7 +119,7 @@ foreach(item, mesa3d_all_lib_items) { symlink_target_name = item[2] install_enable = true install_images = [ chipset_base_dir ] - relative_install_dir = "chipsetsdk" + relative_install_dir = "chipsetsdk/x100" subsystem_name = "phytium_products" part_name = "${partname}" } @@ -132,7 +134,7 @@ foreach(item, mesa3d_all_relay_lib_items) { symlink_target_name = item[2] install_enable = true install_images = [ chipset_base_dir ] - relative_install_dir = "chipsetsdk" + relative_install_dir = "chipsetsdk/x100" subsystem_name = "phytium_products" part_name = "${partname}" } @@ -140,6 +142,6 @@ foreach(item, mesa3d_all_relay_lib_items) { } group("mesa-pvr-gpu-libs"){ - deps = - mesa3d_all_lib_deps + deps = + mesa3d_all_lib_deps } diff --git a/vendor_phytium/gpu_model/x100/kernel_source/linux-5.10/.gitkeep b/vendor_phytium/gpu_model/x100/kernel_source/.gitkeep similarity index 100% rename from vendor_phytium/gpu_model/x100/kernel_source/linux-5.10/.gitkeep rename to vendor_phytium/gpu_model/x100/kernel_source/.gitkeep diff --git a/vendor_phytium/gpu_model/x100/kernel_source/linux-6.6/.gitkeep b/vendor_phytium/gpu_model/x100/kernel_source/linux-6.6/.gitkeep deleted file mode 100644 index e69de29bb2d1d6434b8b29ae775ad8c2e48c5391..0000000000000000000000000000000000000000 diff --git a/vendor_phytium/gpu_model/x100/vpu/BUILD.gn b/vendor_phytium/gpu_model/x100/vpu/BUILD.gn index b942edcf974608b4a4daa815cf51b6e6644f61e4..b6545415347b2f0e6327e41e6e9bd7a586beca92 100644 --- a/vendor_phytium/gpu_model/x100/vpu/BUILD.gn +++ b/vendor_phytium/gpu_model/x100/vpu/BUILD.gn @@ -13,26 +13,9 @@ import("//build/ohos.gni") import("//build/ohos/ndk/ndk.gni") -import("vpu_config.gni") - -#if (VPU_KERNEL_4_19) { -# vpu_libs_dir = "lib64_kenel_4.19" -#}else{ -# vpu_libs_dir = "lib64_kenel_5.10" -#} partname="device_${product_name}" vpu_all_lib_deps = [] -ohos_prebuilt_shared_library("libgstomx") { - source = "libgstomx.so" - install_enable = true - relative_install_dir = "media/plugins" - install_images = [ system_base_dir ] - subsystem_name = "phytium_products" - part_name = "${partname}" -} -vpu_all_lib_deps += [ ":libgstomx" ] - ohos_prebuilt_shared_library("libOMX_Core") { source = "libOMX_Core.z.so" install_enable = true @@ -43,26 +26,6 @@ ohos_prebuilt_shared_library("libOMX_Core") { } vpu_all_lib_deps += [ ":libOMX_Core" ] -ohos_prebuilt_shared_library("libgstyuvconvert") { - source = "libgstyuvconvert.z.so" - install_enable = true - relative_install_dir = "media/plugins" - install_images = [ system_base_dir ] - subsystem_name = "phytium_products" - part_name = "${partname}" -} -vpu_all_lib_deps += [ ":libgstyuvconvert" ] - -ohos_prebuilt_shared_library("gstomx.conf") { - source = "gstomx.conf" - install_enable = true - relative_install_dir = "media/plugins" - install_images = [ system_base_dir ] - subsystem_name = "phytium_products" - part_name = "${partname}" -} -vpu_all_lib_deps += [ ":gstomx.conf" ] - if (enable_ramdisk) { ohos_prebuilt_etc("pvdec_full_bin.fw") { source = "pvdec_full_bin.fw" @@ -71,6 +34,7 @@ if (enable_ramdisk) { install_enable = true install_images = [ "ramdisk", + "updater" ] module_install_dir = "lib/firmware" } diff --git a/vendor_phytium/gpu_model/x100/vpu/gstomx.conf b/vendor_phytium/gpu_model/x100/vpu/gstomx.conf deleted file mode 100644 index 1c6bcde7be36ba08343083c9eb4f04ef722fce52..0000000000000000000000000000000000000000 --- a/vendor_phytium/gpu_model/x100/vpu/gstomx.conf +++ /dev/null @@ -1,95 +0,0 @@ -[omxh264dec] -type-name=GstOMXH264Dec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.AVC -rank=260 -in-port-index=0 -out-port-index=1 -sink-template-caps=video/x-h264, parsed=(boolean) true, alignment=(string) au, stream-format=(string) byte-stream - -[omxh265dec] -type-name=GstOMXHEVCDec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.HEVC -rank=260 -in-port-index=0 -out-port-index=1 -sink-template-caps=video/x-h265, parsed=(boolean) true, alignment=(string) au - -[omxmpeg4videodec] -type-name=GstOMXMPEG4VideoDec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.MPEG4 -rank=260 -in-port-index=0 -out-port-index=1 -sink-template-caps=video/mpeg, mpegversion = (int) 4, parsed = (boolean) false, profile = (string) simple, systemstream = (boolean) false, level = (string) {0, 1, 2, 3}, width = (int) [16, 4096], height = (int) [16, 4096], framerate = (fraction) [0/1, 2147483647/1]; video/mpeg, mpegversion = (int) 4, parsed = (boolean) false, profile = (string) advanced, systemstream = (boolean) false, level = (string) {0, 1, 2, 3, 4, 5}, width = (int)[16, 4096], height = (int) [16, 4096], framerate = (fraction) [0/1, 2147483647/1]; video/mpeg, mpegversion = (int) 4, parsed = (boolean) true, systemstream = (boolean) false; video/x-divx, divxversion = (int)[ 3, 5], width = (int) [16, 4096], height = (int) [16, 4096], framerate = (fraction) [0/1, 2147483647/1]; video/x-xvid, width = (int) [16, 4096], height = (int) [16, 4096], framerate = (fraction) [0/1, 2147483647/1]; video/x-3ivx, width = (int) [16, 4096], height = (int) [16, 4096], framerate = (fraction) [0/1, 2147483647/1]; video/x-msmpeg, msmpegversion = (int) 4, width = (int) [16, 4096], height = (int) [16, 4096], framerate = (fraction) [0/1, 2147483647/1]; video/x-msmpeg, msmpegversion = (int)[ 41, 43], width = (int) [16, 4096], height = (int) [16, 4096], framerate = (fraction) [0/1, 2147483647/1] - -[omxmpeg2videodec] -type-name=GstOMXMPEG2VideoDec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.MPEG2 -rank=260 -in-port-index=0 -out-port-index=1 -sink-template-caps=video/mpeg, mpegversion=(int)2, systemstream=(boolean)false, parsed=(boolean)true;video/mpeg, mpegversion=(int)1, systemstream=(boolean)false, parsed=(boolean)true - -[omxh263dec] -type-name=GstOMXH263Dec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.H263 -rank=260 -in-port-index=0 -out-port-index=1 - -[omxmjpegdec] -type-name=GstOMXMJPEGDec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.JPEG -rank=260 -in-port-index=0 -out-port-index=1 - -[omxvc1dec] -type-name=GstOMXWMVDec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.VC1 -rank=260 -in-port-index=0 -out-port-index=1 -sink-template-caps=video/x-wmv,wmvversion=(int)3,format=(string){WMV3,WVC1} - -[omxvp6dec] -type-name=GstOMXVP6Dec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.VP6 -rank=260 -in-port-index=0 -out-port-index=1 -sink-template-caps=video/x-vp6; video/x-vp6-flash; video/x-vp6-alpha - -[omxvp8dec] -type-name=GstOMXVP8Dec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.VP8 -rank=260 -in-port-index=0 -out-port-index=1 - -[omxsorensondec] -type-name=GstOMXSORENSONDec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.SORENSON -sink-template-caps=video/x-flash-video -rank=260 -in-port-index=0 -out-port-index=1 - -[omxrealvideodec] -type-name=GstOMXREALVideoDec -core-name=libOMX_Core.z.so -component-name=OMX.IMG.MSVDX.Decoder.REAL -rank=260 -in-port-index=0 -out-port-index=1 - diff --git a/vendor_phytium/gpu_model/x100/vpu/libgstomx.so b/vendor_phytium/gpu_model/x100/vpu/libgstomx.so deleted file mode 100644 index 351d5517da69190ff5785588a208c9bb421a74fb..0000000000000000000000000000000000000000 Binary files a/vendor_phytium/gpu_model/x100/vpu/libgstomx.so and /dev/null differ diff --git a/vendor_phytium/gpu_model/x100/vpu/libgstyuvconvert.z.so b/vendor_phytium/gpu_model/x100/vpu/libgstyuvconvert.z.so deleted file mode 100755 index 1d724c3f426dfd2f0a0f80266f3469cc5c886033..0000000000000000000000000000000000000000 Binary files a/vendor_phytium/gpu_model/x100/vpu/libgstyuvconvert.z.so and /dev/null differ diff --git a/vendor_phytium/gpu_model/x100/vpu/vpu_config.gni b/vendor_phytium/gpu_model/x100/vpu/vpu_config.gni deleted file mode 100644 index 1c2e8a53dcac13d88a4c0ccb4ab473377014c03c..0000000000000000000000000000000000000000 --- a/vendor_phytium/gpu_model/x100/vpu/vpu_config.gni +++ /dev/null @@ -1,14 +0,0 @@ -declare_args() { - vpu_standard_feature_4_19 = false - VPU_KERNEL_4_19 = false - VPU_KERNEL_5_10 = true -} - -if (vpu_standard_feature_4_19) { - VPU_KERNEL_4_19 = true - VPU_KERNEL_5_10 = false -}else{ - VPU_KERNEL_5_10 = true - VPU_KERNEL_4_19 = false -} - diff --git a/vendor_phytium/phytiumpi-firefly/bundle.json b/vendor_phytium/phytiumpi-firefly/bundle.json new file mode 100755 index 0000000000000000000000000000000000000000..a7c6085c10bdd265dec907c47cc5e2c599cdfea4 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/bundle.json @@ -0,0 +1,28 @@ +{ + "name": "@ohos/phytium_phytiumpi-firefly", + "version": "4.1", + "license": "Apache License 2.0", + "private": false, + "scripts": {}, + "dirs": [""], + "component": { + "name": "product_phytiumpi-firefly", + "subsystem": "product_phytiumpi-firefly", + "syscap": [], + "features": [], + "deps": { + "components": [], + "third_party": [] + }, + "build": { + "sub_component": [ + "//vendor/phytium/phytiumpi-firefly/resourceschedule:resourceschedule", + "//vendor/phytium/phytiumpi-firefly/preinstall-config:preinstall-config", + "//vendor/phytium/phytiumpi-firefly/hdf_config/uhdf:hdf_config", + "//vendor/phytium/phytiumpi-firefly/etc:product_etc_conf", + "//vendor/phytium/phytiumpi-firefly/hals/audio:hdf_audio_config", + "//vendor/phytium/phytiumpi-firefly/window_config:window_config" + ] + } + } +} diff --git a/vendor_phytium/phytiumpi-firefly/config.json b/vendor_phytium/phytiumpi-firefly/config.json new file mode 100755 index 0000000000000000000000000000000000000000..052508845d91ee89617057e318ef755d5169c9c9 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/config.json @@ -0,0 +1,196 @@ +{ + "product_name": "phytiumpi-firefly", + "device_company": "phytium", + "device_build_path": "device/board/phytium/phytiumpi-firefly", + "target_cpu": "arm64", + "type": "standard", + "version": "3.0", + "board": "phytiumpi-firefly", + "enable_ramdisk": true, + "enable_absystem": false, + "build_selinux": false, + "build_seccomp": true, + "device_stack_size": 8388608, + "inherit": [ "productdefine/common/inherit/rich.json", "productdefine/common/inherit/chipset_common.json" ], + "subsystems": [ + { + "subsystem": "security", + "components": [ + { + "component": "selinux_adapter", + "features": [] + } + ] + }, + { + "subsystem": "communication", + "components": [ + { + "component": "netmanager_ext", + "features": [] + } + ] + }, + { + "subsystem": "phytium_products", + "components": [] + }, + { + "subsystem": "arkui", + "components": [ + { + "component": "ace_engine", + "features": [ + "ace_engine_feature_enable_accessibility = true", + "ace_engine_feature_enable_web = true" + ] + }, + { + "component": "ui_appearance", + "features": [] + } + ] + }, + { + "subsystem": "hdf", + "components": [ + { + "component": "drivers_interface_audio", + "features": [] + }, + { + "component": "drivers_peripheral_audio", + "features": [ + "drivers_peripheral_audio_feature_full_test_suite = true", + "drivers_peripheral_audio_feature_alsa_lib = true", + "drivers_peripheral_audio_feature_effect = false" + ] + }, + { + "component": "drivers_peripheral_display", + "features": [ + "drivers_peripheral_display_community = true", + "drivers_peripheral_display_vdi_default = true" + ] + } + ] + }, + { + "subsystem": "startup", + "components": [ + { + "component": "init", + "features": [ + "init_feature_ab_partition = true", + "init_feature_loader = true" + ] + } + ] + }, + { + "subsystem": "msdp", + "components": [ + { + "component": "device_status", + "features": [ + "device_status_interaction_coordination = false" + ] + } + ] + }, + { + "subsystem": "castplus", + "components": [ + { + "component": "sharing_framework", + "features": [] + }, + { + "component": "cast_engine", + "features": [] + } + ] + }, + { + "subsystem": "thirdparty", + "components": [ + { + "component": "libuv", + "features": [ + "libuv_use_ffrt = true" + ] + }, + { + "component": "wpa_supplicant", + "features": [ + "wpa_supplicant_driver_nl80211 = true" + ] + } + ] + }, + { + "subsystem": "usb", + "components": [ + { + "component": "usb_manager", + "features": [ + "usb_manager_feature_pop_up_func_switch_model = false" + ] + } + ] + }, + { + "subsystem": "graphic", + "components": [ + { + "component": "graphic_2d", + "features": [ + "graphic_2d_feature_ace_enable_gpu = true", + "graphic_2d_feature_rs_enable_eglimage = true", + "graphic_2d_feature_use_texgine = true" + ] + }, + { + "component": "graphic_surface", + "features": [] + }, + { + "component": "graphic_3d", + "features": [] + }, + { + "component": "vulkan-loader", + "features": [] + }, + { + "component": "vulkan-headers", + "features": [] + } + ] + }, + { + "subsystem":"hiviewdfx", + "components": [ + { + "component": "hiview", + "features": [ + "hiview_enable_leak_detector = true", + "hiview_enable_performance_monitor = true" + ] + } + ] + }, + { + "subsystem": "resourceschedule", + "components": [ + { + "component": "memmgr", + "features": [ + "memmgr_purgeable_memory = false", + "memmgr_hyperhold_memory = false" + ] + } + ] + } + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/etc/BUILD.gn b/vendor_phytium/phytiumpi-firefly/etc/BUILD.gn new file mode 100755 index 0000000000000000000000000000000000000000..836ac7d528e95e9af458b1e13b3c884d790be06d --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/etc/BUILD.gn @@ -0,0 +1,55 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//build/ohos.gni") + +ohos_prebuilt_etc("para_for_chip_prod") { + source = "./param/hardware_${device_name}.para" + install_images = [ chipset_base_dir ] + relative_install_dir = "param" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("para_for_sys_prod") { + source = "./param/product_${device_name}.para" + install_images = [ chipset_base_dir ] + relative_install_dir = "param" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("multi_gpu_json") { + source = "./multi_gpu.json" + part_name = "product_${device_name}" + install_images = [ + "system", + ] + install_enable = true +} + +ohos_prebuilt_etc("gpu_cur") { + source = "./gpu_cur" + part_name = "product_${device_name}" + install_images = [ + "system", + ] + install_enable = true +} + +group("product_etc_conf") { + deps = [ + ":para_for_chip_prod", + ":para_for_sys_prod", + ":multi_gpu_json", + ":gpu_cur", + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/etc/gpu_cur b/vendor_phytium/phytiumpi-firefly/etc/gpu_cur new file mode 100755 index 0000000000000000000000000000000000000000..094ac6affab90ffb0d12db5cb34d27c0eb0d5817 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/etc/gpu_cur @@ -0,0 +1 @@ +/vendor/lib64/chipsetsdk/sw/ diff --git a/vendor_phytium/phytiumpi-firefly/etc/multi_gpu.json b/vendor_phytium/phytiumpi-firefly/etc/multi_gpu.json new file mode 100755 index 0000000000000000000000000000000000000000..0e58e6b482065484cf81b6f157e4fb0e29197df5 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/etc/multi_gpu.json @@ -0,0 +1,3 @@ +{ + "sw": "/vendor/lib64/chipsetsdk/sw/" +} \ No newline at end of file diff --git a/vendor_phytium/phytiumpi-firefly/etc/param/hardware_phytiumpi-firefly.para b/vendor_phytium/phytiumpi-firefly/etc/param/hardware_phytiumpi-firefly.para new file mode 100755 index 0000000000000000000000000000000000000000..6c97e5a8a407bab099bcca5b3ae0830a7be544f4 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/etc/param/hardware_phytiumpi-firefly.para @@ -0,0 +1,14 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +const.product.hardwareversion=default diff --git a/vendor_phytium/phytiumpi-firefly/etc/param/product_phytiumpi-firefly.para b/vendor_phytium/phytiumpi-firefly/etc/param/product_phytiumpi-firefly.para new file mode 100755 index 0000000000000000000000000000000000000000..3673c1902bf187a20c45f02907536df232de2ee1 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/etc/param/product_phytiumpi-firefly.para @@ -0,0 +1,16 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +const.product.brand=default +const.build.product=default +const.product.name=Phytium phytiumpi-firefly diff --git a/vendor_phytium/phytiumpi-firefly/hals/audio/BUILD.gn b/vendor_phytium/phytiumpi-firefly/hals/audio/BUILD.gn new file mode 100755 index 0000000000000000000000000000000000000000..391f7f4db896d0ad7fb88c7017cc17a9332b3797 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/hals/audio/BUILD.gn @@ -0,0 +1,49 @@ +# Copyright (C) 2024 Phytium Open Source Organization . +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//build/ohos.gni") + +ohos_prebuilt_etc("hdf_alsa_adapter_json") { + source = "alsa_adapter.json" + + relative_install_dir = "hdfconfig" + install_images = [ chipset_base_dir ] + subsystem_name = "hdf" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("hdf_alsa_path_json") { + source = "alsa_paths.json" + + relative_install_dir = "hdfconfig" + install_images = [ chipset_base_dir ] + subsystem_name = "hdf" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("audio_policy_config") { + source = "config/audio_policy_config.xml" + subsystem_name = "hdf" + relative_install_dir = "audio" + install_images = [ chipset_base_dir ] + part_name = "product_${device_name}" +} + +group("hdf_audio_config") { + deps = [ + ":audio_policy_config", + ":hdf_alsa_adapter_json", + ":hdf_alsa_path_json", + ] +} + diff --git a/vendor_phytium/phytiumpi-firefly/hals/audio/alsa_adapter.json b/vendor_phytium/phytiumpi-firefly/hals/audio/alsa_adapter.json new file mode 100755 index 0000000000000000000000000000000000000000..c011eb2fdbe1fe774930f7a9b57b7ff1bb81a70e --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/hals/audio/alsa_adapter.json @@ -0,0 +1,8 @@ +{ + "adapters": [{ + "name": "primary", + "cardId": 1, + "cardName": "phytiumpe220xi2" + } + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/hals/audio/alsa_paths.json b/vendor_phytium/phytiumpi-firefly/hals/audio/alsa_paths.json new file mode 100755 index 0000000000000000000000000000000000000000..6474a1f3440599166a2850a3b277fdccd28ab735 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/hals/audio/alsa_paths.json @@ -0,0 +1,98 @@ +{ + "hdf_audio_codec_primary_dev0": [ + { + "deep-buffer-playback": [ + { + "headphones": [ + { + "name": "Headphone", + "value": 1 + } + ], + "Speaker": [ + { + "name": "Master", + "value": 1 + } + ], + "mic": [ + { + "name": "mic-in", + "value": 0 + } + ] + } + ], + "low-latency-communication": [ + { + "Speaker": [ + { + "name": "Playback Path", + "value": 2 + } + ], + "headphones": [ + { + "name": "Playback Path", + "value": 3 + } + ], + "mic": [ + { + "name": "Capture MIC Path", + "value": 1 + } + ] + } + ], + "ringtone-playback": [ + { + "Speaker": [ + { + "name": "Playback Path", + "value": 10 + } + ] + } + ], + "voice-call": [ + { + "Speaker": [ + { + "name": "Playback Path", + "value": 7 + } + ], + "Headphones": [ + { + "name": "Playback Path", + "value": 8 + } + ], + "MIC": [ + { + "name": "Capture MIC Path", + "value": 1 + } + ] + } + ], + "low-latency-noirq-playback": [ + { + "Speaker": [ + { + "name": "Playback Path", + "value": 2 + } + ], + "Headphones": [ + { + "name": "Playback Path", + "value": 3 + } + ] + } + ] + } + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/hals/audio/config/audio_policy_config.xml b/vendor_phytium/phytiumpi-firefly/hals/audio/config/audio_policy_config.xml new file mode 100755 index 0000000000000000000000000000000000000000..3b7f7830bf48b1d4ff19ce3439706182d8055530 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/hals/audio/config/audio_policy_config.xml @@ -0,0 +1,114 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + diff --git a/vendor_phytium/phytiumpi-firefly/hals/audio/product.gni b/vendor_phytium/phytiumpi-firefly/hals/audio/product.gni new file mode 100755 index 0000000000000000000000000000000000000000..9138d69e45856fbcb3f6c63fed369f5d280d69f4 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/hals/audio/product.gni @@ -0,0 +1,19 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +enable_audio_hal_hdf_log = true +enable_audio_alsa_mode = true +drivers_peripheral_audio_feature_hdf_proxy_stub = true +drivers_peripheral_audio_feature_hal_notsupport_pathselect = false +drivers_peripheral_audio_feature_policy_config = true +enable_audio_analog_headset = true diff --git a/vendor_phytium/phytiumpi-firefly/hals/wlan/product.gni b/vendor_phytium/phytiumpi-firefly/hals/wlan/product.gni new file mode 100755 index 0000000000000000000000000000000000000000..16376156987b8d851c1b39813b4d676510b267bb --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/hals/wlan/product.gni @@ -0,0 +1,15 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +enable_HDF_NL80211 = true +enable_HDF_UT = false diff --git a/vendor_phytium/phytiumpi-firefly/hdf_config/uhdf/BUILD.gn b/vendor_phytium/phytiumpi-firefly/hdf_config/uhdf/BUILD.gn new file mode 100755 index 0000000000000000000000000000000000000000..f3f1c8a6db202116f46cc2e76b129099658ec162 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/hdf_config/uhdf/BUILD.gn @@ -0,0 +1,42 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//drivers/hdf_core/adapter/uhdf2/hcs/hcs.gni") + +check_path = "//vendor/phytium/gpu_model/x100/uhdf/hdf.hcs" +test_result = exec_script(rebase_path("//build/scripts/check_file_exist.py"),[ rebase_path("${check_path}") ],"string") + +if (test_result != "") { + hdf_hcs_source = "//vendor/phytium/gpu_model/x100/uhdf/hdf.hcs" +} +else { + hdf_hcs_source = "./hdf.hcs" +} +hdf_hcb("hdf_default.hcb") { + source = hdf_hcs_source + part_name = "product_${device_name}" + subsystem_name = "product_${device_name}" +} + +hdf_cfg("hdf_devhost.cfg") { + source = hdf_hcs_source + part_name = "product_${device_name}" + subsystem_name = "product_${device_name}" +} + +group("hdf_config") { + deps = [ + ":hdf_default.hcb", + ":hdf_devhost.cfg", + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/hdf_config/uhdf/device_info.hcs b/vendor_phytium/phytiumpi-firefly/hdf_config/uhdf/device_info.hcs new file mode 100755 index 0000000000000000000000000000000000000000..a740544e09323d01c87024b30617d896b0867cfb --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/hdf_config/uhdf/device_info.hcs @@ -0,0 +1,447 @@ + root { + device_info { + match_attr = "hdf_manager"; + template host { + hostName = ""; + priority = 100; + uid = ""; + gid = [""]; + caps = [""]; + critical = []; + template device { + template deviceNode { + policy = 0; + priority = 100; + preload = 0; + permission = 0664; + moduleName = ""; + serviceName = ""; + deviceMatchAttr = ""; + } + } + } + platform :: host { + hostName = "sample_host"; + priority = 50; + gid = ["sample_host", "uhdf_driver"]; + sample_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "libsample_driver.z.so"; + serviceName = "sample_driver_service"; + } + device1 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "libsample1_driver.z.so"; + serviceName = "sample1_driver_service"; + } + } + } + bluetooth :: host { + hostName = "blue_host"; + priority = 50; + caps = ["NET_ADMIN"]; + bluetooth_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libbluetooth_hci_hdi_driver.z.so"; + serviceName = "hci_interface_service"; + } + } + } + audio_bluetooth :: host { + hostName = "a2dp_host"; + priority = 50; + bluetooth_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "libaudio_bluetooth_hdi_adapter_server.z.so"; + serviceName = "audio_bluetooth_hdi_service"; + } + } + } + power :: host { + hostName = "power_host"; + priority = 50; + uid = "power_host"; + gid = ["power_host", "system", "log"]; + caps = ["BLOCK_SUSPEND"]; + power_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libpower_driver.z.so"; + serviceName = "power_interface_service"; + } + } + battery_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libbattery_driver.z.so"; + serviceName = "battery_interface_service"; + } + } + thermal_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libthermal_driver.z.so"; + serviceName = "thermal_interface_service"; + } + } + } + wlan :: host { + hostName = "wifi_host"; + priority = 50; + gid = ["wifi_host", "wifi_group"]; + wifi_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libwifi_hdi_c_device.z.so"; + serviceName = "wlan_interface_service"; + } + } + } + audio :: host { + hostName = "audio_host"; + priority = 50; + gid = ["audio_host", "uhdf_driver", "root", "audio"]; + audio_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libhdi_audio_primary_server.z.so"; + serviceName = "audio_hdi_service"; + } + } + audio_usb_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libhdi_audio_usb_server.z.so"; + serviceName = "audio_hdi_usb_service"; + } + } + audio_a2dp_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libhdi_audio_a2dp_server.z.so"; + serviceName = "audio_hdi_a2dp_service"; + } + } + audio_pnp_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 110; + moduleName = "libhdi_audio_pnp_server.z.so"; + serviceName = "audio_hdi_pnp_service"; + } + } + idl_audio_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libaudio_primary_driver.z.so"; + serviceName = "audio_manager_service"; + } + } + effect_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libeffect_model_service.z.so"; + serviceName = "effect_model_service"; + } + } + trigger_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libintell_voice_trigger_driver.z.so"; + serviceName = "intell_voice_trigger_manager_service"; + } + } + + } + hdi_server :: host { + hostName = "camera_host"; + priority = 50; + gid = ["camera_host", "uhdf_driver", "vendor_mpp_driver"]; + camera_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libcamera_host_service_1.0.z.so"; + serviceName = "camera_service"; + } + } + display_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 120; + moduleName = "libhdi_media_layer_service.z.so"; + serviceName = "hdi_media_layer_service"; + } + } + } + input_hal :: host { + hostName = "input_user_host"; + priority = 50; + gid = ["input_user_host", "uhdf_driver"]; + input_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 150; + moduleName = "libhdf_input_hotplug.z.so"; + serviceName = "input_service"; + } + } + input_hdi_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libinput_driver.z.so"; + serviceName = "input_interfaces_service"; + } + } + } + display_composer :: host { + hostName = "composer_host"; + priority = 40; + processPriority = -8; + threadPriority = 1; + caps = ["SYS_NICE"]; + uid = ["composer_host"]; + gid = ["composer_host", "graphics", "vendor_mpp_driver"]; + composer_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 160; + moduleName = "libdisplay_composer_driver_1.0.z.so"; + serviceName = "display_composer_service"; + } + } + } + allocator :: host { + hostName = "allocator_host"; + priority = 40; + allocator_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 160; + moduleName = "liballocator_driver_1.0.z.so"; + serviceName = "allocator_service"; + } + } + } + sensor :: host { + hostName = "sensor_host"; + priority = 50; + gid = ["sensor_host", "uhdf_driver"]; + sensor_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libsensor_driver.z.so"; + serviceName = "sensor_interface_service"; + } + } + } + vibrator :: host { + hostName = "vibrator_host"; + priority = 50; + vibrator_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libvibrator_driver.z.so"; + serviceName = "vibrator_interface_service"; + } + } + } + light :: host { + hostName = "light_host"; + priority = 50; + light_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "liblight_driver.z.so"; + serviceName = "light_interface_service"; + } + } + } + distributed_camera_host :: host { + hostName = "dcamera_host"; + priority = 50; + distributed_camera_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "libdistributed_camera_host_config.z.so"; + serviceName = "distributed_camera_service"; + } + device1 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "libdistributed_camera_provider_config.z.so"; + serviceName = "distributed_camera_provider_service"; + } + } + } + + distributed_audio_host :: host { + hostName = "daudio_host"; + priority = 50; + distributed_audio_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "libdaudio_primary_driver.z.so"; + serviceName = "daudio_primary_service"; + } + device1 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "libdaudio_ext_driver.z.so"; + serviceName = "daudio_ext_service"; + } + } + } + + face_auth :: host { + hostName = "face_auth_host"; + priority = 50; + uid = "face_auth_host"; + gid = ["face_auth_host"]; + face_auth_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 200; + moduleName = "libface_auth_driver.z.so"; + serviceName = "face_auth_interface_service"; + } + } + } + + pin_auth :: host { + hostName = "pin_auth_host"; + priority = 50; + uid = "pin_auth_host"; + gid = ["pin_auth_host"]; + pin_auth_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 200; + moduleName = "libpin_auth_driver.z.so"; + serviceName = "pin_auth_interface_service"; + } + } + } + + user_auth :: host { + hostName = "user_auth_host"; + priority = 50; + uid = "user_auth_host"; + gid = ["user_auth_host"]; + user_auth_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 200; + moduleName = "libuser_auth_driver.z.so"; + serviceName = "user_auth_interface_service"; + } + } + } + + fingerprint_auth :: host { + hostName = "fingerprint_auth_host"; + priority = 50; + uid = "fingerprint_auth_host"; + gid = ["fingerprint_auth_host"]; + fingerprint_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 200; + moduleName = "libfingerprint_auth_driver.z.so"; + serviceName = "fingerprint_auth_interface_service"; + } + } + } + + location :: host { + hostName = "location_host"; + priority = 50; + uid = "location_host"; + gid = ["location_host"]; + location_gnss_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "liblocation_gnss_hdi_driver.z.so"; + serviceName = "gnss_interface_service"; + } + } + location_agnss_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "liblocation_agnss_hdi_driver.z.so"; + serviceName = "agnss_interface_service"; + } + } + location_geofence_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "liblocation_geofence_hdi_driver.z.so"; + serviceName = "geofence_interface_service"; + } + } + } + partitionslot :: host { + hostName = "partitionslot_host"; + priority = 100; + uid = "useriam"; + gid = ["useriam", "update"]; + partitionslot_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + preload = 2; + moduleName = "libpartitionslot_driver.z.so"; + serviceName = "partition_slot_service"; + } + } + } + intell_voice :: host { + hostName = "intell_voice_host"; + priority = 100; + intell_voice_device :: device { + device0 :: deviceNode { + policy = 2; + priority = 100; + moduleName = "libintell_voice_engine_driver.z.so"; + serviceName = "intell_voice_engine_manager_service"; + } + } + } + } +} diff --git a/vendor_phytium/phytiumpi-firefly/hdf_config/uhdf/hdf.hcs b/vendor_phytium/phytiumpi-firefly/hdf_config/uhdf/hdf.hcs new file mode 100755 index 0000000000000000000000000000000000000000..bf8dc250cb2744b277f7ffeac187299008b04d44 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/hdf_config/uhdf/hdf.hcs @@ -0,0 +1,5 @@ +#include "device_info.hcs" + +root { + module = "default"; +} diff --git a/vendor_phytium/phytiumpi-firefly/preinstall-config/BUILD.gn b/vendor_phytium/phytiumpi-firefly/preinstall-config/BUILD.gn new file mode 100755 index 0000000000000000000000000000000000000000..6015aa1be84f74a71bb84f404fd6c6bbfa25c6de --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/preinstall-config/BUILD.gn @@ -0,0 +1,48 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. +# + +import("//build/ohos.gni") + +ohos_prebuilt_etc("install_list_config") { + source = "./install_list.json" + relative_install_dir = "app" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("uninstall_list_config") { + source = "./uninstall_list.json" + relative_install_dir = "app" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("install_list_capability_config") { + source = "./install_list_capability.json" + relative_install_dir = "app" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("install_list_permissions_config") { + source = "./install_list_permissions.json" + relative_install_dir = "app" + part_name = "product_${device_name}" +} + +group("preinstall-config") { + deps = [ + ":install_list_capability_config", + ":install_list_config", + ":install_list_permissions_config", + ":uninstall_list_config", + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/preinstall-config/install_list.json b/vendor_phytium/phytiumpi-firefly/preinstall-config/install_list.json new file mode 100755 index 0000000000000000000000000000000000000000..bcd127ac0b07f91eb4a711e5a0bbc2b84d04cdcf --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/preinstall-config/install_list.json @@ -0,0 +1,204 @@ +{ + "install_list" : [ + { + "app_dir" : "/system/app/com.ohos.systemui", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.launcher", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.settings", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.note", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.settingsdata", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.screenshot", + "removable" : false + }, + { + "app_dir" : "/system/app/ohos.samples.clock", + "removable" : false + }, + { + "app_dir" : "/system/app/ohos.samples.airquality", + "removable" : false + }, + { + "app_dir" : "/system/app/com.example.distributedcalc", + "removable" : false + }, + { + "app_dir" : "/system/app/ohos.samples.flashlight", + "removable" : false + }, + { + "app_dir" : "/system/app/ohos.samples.ecg", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.photos", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.distributedmusicplayer", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.camera", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.devicemanagerui", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.dlpmanager", + "removable" : false + }, + { + "app_dir" : "/system/app/com.example.kikakeyboard", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.medialibrary.MediaLibraryData", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.callui", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.mms", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.contacts", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.permissionmanager", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.settings.faceauth", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.useriam.authwidget", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.adminprovisioning", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.filepicker", + "removable" : false + }, + { + "app_dir" : "/system/app/ohos.global.systemres", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.contactsdataability", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.nweb", + "removable" : false + }, + { + "app_dir" : "/system/app/ohos.telephony.resources", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.download", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.telephonydataability", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.UserFile.ExternalFileManager", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.gameperceptio", + "removable" : false + }, + { + "app_dir" : "/system/app/ohos.backgroundtaskmgr.resources", + "removable" : false + }, + { + "app_dir" : "/system/app/ohos.sample.shopping", + "removable" : false + }, + { + "app_dir" : "/system/app/com.ohos.wallpaper", + "removable" : true + }, + { + "app_dir" : "/system/app/cn.openharmony.inputmethodchoosedialog", + "removable" : false + }, + { + "app_dir": "/system/app/com.ohos.sharepickerdialog", + "removable": false + }, + { + "app_dir" : "/system/app/cn.openharmony.pasteboarddialog", + "removable" : true + }, + { + "app_dir": "/system/app/com.ohos.amsdialog", + "removable": false + }, + { + "app_dir": "/system/app/com.usb.right", + "removable": true + }, + { + "app_dir": "/system/app/com.ohos.certificatemanager", + "removable": true + }, + { + "app_dir": "/system/app/com.ohos.powerdialog", + "removable": false + }, + { + "app_dir": "/system/app/com.ohos.notificationdialog", + "removable": true + }, + { + "app_dir": "/system/app/com.ohos.formrenderservice", + "removable": false + }, + { + "app_dir": "/system/app/com.ohos.updateapp", + "removable": false + }, + { + "app_dir": "/system/app/com.ohos.spooler", + "removable": false + }, + { + "app_dir": "/system/app/com.ohos.calendardata", + "removable": false + }, + { + "app_dir": "/system/app/ohos.samples.browser1", + "removable": false + } + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/preinstall-config/install_list_capability.json b/vendor_phytium/phytiumpi-firefly/preinstall-config/install_list_capability.json new file mode 100755 index 0000000000000000000000000000000000000000..b75b2043640ba1a626029b53404b595f05dd5989 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/preinstall-config/install_list_capability.json @@ -0,0 +1,220 @@ +{ + "install_list": [ + { + "bundleName": "com.example.kikakeyboard", + "singleton": true, + "runningResourcesApply": false, + "associatedWakeUp": false, + "app_signature" : ["9AED2A79925ECA050CD2BB9D2A7F694E49E5E135D28EBDCE53836DE76B5080ED"], + "allowCommonEvent": [], + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.systemui", + "singleton": true, + "keepAlive": true, + "runningResourcesApply": false, + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "associatedWakeUp": false, + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.callui", + "app_signature" : ["E64B13B84E6D2167F73B46530C6E02E323DA43C9C2DA251D7C64D20E091B936F"], + "singleton": true, + "keepAlive": false, + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.contacts", + "app_signature" : ["04AC9C3F045EAB7DB992B7C4E38B59468CA3EABB7D654AE47641471B9785EA04"], + "singleton": true, + "keepAlive": false, + "allowCommonEvent": ["usual.event.INCOMING_CALL_MISSED","contact.event.CANCEL_MISSED"] + }, + { + "bundleName": "com.ohos.mms", + "app_signature" : ["04AC9C3F045EAB7DB992B7C4E38B59468CA3EABB7D654AE47641471B9785EA04"], + "singleton": true, + "keepAlive": false, + "allowCommonEvent": ["usual.event.SMS_RECEIVE_COMPLETED"] + }, + { + "bundleName": "com.ohos.settingsdata", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "singleton": true, + "keepAlive": true, + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "ohos.backgroundtaskmgr.resources", + "app_signature" : ["72BE2C651A9E0C57B4BB67825BA6F8180FC883858434712150A55C17C7E1A6F7"], + "singleton": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "ohos.global.systemres", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "singleton": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.devicetest", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "runningResourcesApply": true, + "associatedWakeUp": true, + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.contactsdataability", + "app_signature" : ["D729F438E1EF2E154994E2B077F6C0CD592BA9F9C938BB428FCDA564FF805EE4"], + "associatedWakeUp": true, + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.telephonydataability", + "app_signature" : ["D729F438E1EF2E154994E2B077F6C0CD592BA9F9C938BB428FCDA564FF805EE4"], + "associatedWakeUp": true, + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.huawei.ohos.hiviewx", + "singleton": true, + "keepAlive": true, + "app_signature" : ["57D4E9DFE7504D12EB6ACAF39876F420BCABCA2F4721989B90FD2E4F1FB7ED2B"], + "allowCommonEvent": [], + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "cn.openharmony.inputmethodchoosedialog", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "allowAppDesktopIconHide": true, + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "cn.openharmony.pasteboarddialog", + "app_signature": ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.amsdialog", + "app_signature": ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "allowAppUsePrivilegeExtension": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.devicemanagerui", + "app_signature": ["DFBBF5BC714865FCCCACA69F30BEF951B499329F66C98523795BAD817E49D1A0"], + "allowAppDesktopIconHide": true, + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.launcher", + "app_signature": ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.medialibrary.medialibrarydata", + "app_signature": ["F9431859ED7A3959B5D72EF36FBE8B210A00082B044063E4424F823A01B3B7CA"], + "allowAppUsePrivilegeExtension": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.permissionmanager", + "app_signature": ["68079CC9CB1BD69283D70790305645FFF61CD1E46CAFD7AA53B9FA8540432B81"], + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.dlpmanager", + "app_signature": [ + "E3F4322139E0109BAFAD8DA4096762068E31708C3CF201780E736D377D60B639", + "5FEDFF587F4109E565B96512404D606D539C8DFFCE1424ACBD1B2A7D3E843D4D" + ], + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.photos", + "app_signature": ["9AED2A79925ECA050CD2BB9D2A7F694E49E5E135D28EBDCE53836DE76B5080ED"], + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.powerdialog", + "app_signature": ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "allowAppUsePrivilegeExtension": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.sharepickerdialog", + "app_signature": ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.usb.right", + "app_signature": ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "allowAppUsePrivilegeExtension": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.screenshot", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "allowAppUsePrivilegeExtension": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.notificationdialog", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "allowAppUsePrivilegeExtension": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.nweb", + "app_signature" : [ + "49D779C85200D36A00DE63E2D85AEF22FE5C72FB268BE13923E589B49BFAFFDA", + "8AFD891FA100D478BEDB6962B157055F26CDD407ACAAD525CBA9FDE490BD23D9" + ], + "singleton": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.settings.faceauth", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "singleton": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.useriam.authwidget", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "singleton": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.formrenderservice", + "app_signature": ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "singleton": true, + "allowAppUsePrivilegeExtension": true, + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.updateapp", + "app_signature" : ["BA6EBDF53DD63B7D5616F3789F8C15FD4DE134B2587C577B01DA4D027B44A23C"], + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "com.ohos.spooler", + "app_signature" : ["B68D7BE6599CA7ADEDBC95CD1CE176AA96D996D3F41588A487E5F5C4E5DC9427"], + "allowAppDesktopIconHide": true + }, + { + "bundleName": "com.ohos.calendardata", + "app_signature" : ["1C6905C65DE22F5160790D34ADA462EE9ED3D9EEAA4FCBD4FEC7FFEE7D1D4FD2"], + "allowAppDesktopIconHide": true, + "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "ohos.samples.browser1", + "app_signature": ["208850C05E411A1EA7B1F26B4D5865208415D8D878D6CA42F9290BF6D6CA6D8A"], + "allowAppUsePrivilegeExtension": true, + "allowAppDesktopIconHide": false + } + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/preinstall-config/install_list_permissions.json b/vendor_phytium/phytiumpi-firefly/preinstall-config/install_list_permissions.json new file mode 100755 index 0000000000000000000000000000000000000000..f04487fad738142b71b9d9270d05f71ff78fccce --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/preinstall-config/install_list_permissions.json @@ -0,0 +1,362 @@ +[ + { + "bundleName" : "com.ohos.screenshot", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "permissions" : [ + { + "name" : "ohos.permission.MEDIA_LOCATION", + "userCancellable" : true + }, + { + "name" : "ohos.permission.READ_MEDIA", + "userCancellable" : true + }, + { + "name" : "ohos.permission.WRITE_MEDIA", + "userCancellable" : true + } + ] + }, + { + "bundleName" : "com.ohos.medialibrary.medialibrarydata", + "app_signature" : ["F9431859ED7A3959B5D72EF36FBE8B210A00082B044063E4424F823A01B3B7CA"], + "permissions" : [ + { + "name" : "ohos.permission.DISTRIBUTED_DATASYNC", + "userCancellable" : false + } + ] + }, + { + "bundleName" : "com.ohos.callui", + "app_signature" : ["E64B13B84E6D2167F73B46530C6E02E323DA43C9C2DA251D7C64D20E091B936F"], + "permissions" : [ + { + "name" : "ohos.permission.READ_CONTACTS", + "userCancellable" : false + }, + { + "name" : "ohos.permission.SEND_MESSAGES", + "userCancellable" : false + }, + { + "name" : "ohos.permission.ANSWER_CALL", + "userCancellable" : false + } + ] + }, + { + "bundleName" : "com.ohos.mms", + "app_signature" : ["04AC9C3F045EAB7DB992B7C4E38B59468CA3EABB7D654AE47641471B9785EA04"], + "permissions" : [ + { + "name" : "ohos.permission.READ_CONTACTS", + "userCancellable" : true + }, + { + "name" : "ohos.permission.READ_MESSAGES", + "userCancellable" : false + }, + { + "name" : "ohos.permission.SEND_MESSAGES", + "userCancellable" : false + }, + { + "name" : "ohos.permission.RECEIVE_SMS", + "userCancellable" : false + } + ] + }, + { + "bundleName": "com.ohos.systemui", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "permissions" : [ + { + "name" : "ohos.permission.DISTRIBUTED_DATASYNC", + "userCancellable" : false + }, + { + "name" : "ohos.permission.GET_INSTALLED_BUNDLE_LIST", + "userCancellable" : false + }, + { + "name" : "ohos.permission.ACCESS_BLUETOOTH", + "userCancellable" : false + } + ] + }, + { + "bundleName": "com.ohos.contacts", + "app_signature" : ["04AC9C3F045EAB7DB992B7C4E38B59468CA3EABB7D654AE47641471B9785EA04"], + "permissions" : [ + { + "name" : "ohos.permission.READ_CONTACTS", + "userCancellable" : false + }, + { + "name" : "ohos.permission.WRITE_CONTACTS", + "userCancellable" : false + }, + { + "name" : "ohos.permission.READ_CALL_LOG", + "userCancellable" : false + }, + { + "name" : "ohos.permission.WRITE_CALL_LOG", + "userCancellable" : false + }, + { + "name" : "ohos.permission.MANAGE_VOICEMAIL", + "userCancellable" : false + } + ] + }, + { + "bundleName": "com.ohos.photos", + "app_signature" : ["9AED2A79925ECA050CD2BB9D2A7F694E49E5E135D28EBDCE53836DE76B5080ED"], + "permissions" : [ + { + "name" : "ohos.permission.READ_IMAGEVIDEO", + "userCancellable" : false + }, + { + "name" : "ohos.permission.WRITE_IMAGEVIDEO", + "userCancellable" : false + }, + { + "name" : "ohos.permission.READ_MEDIA", + "userCancellable" : false + }, + { + "name" : "ohos.permission.WRITE_MEDIA", + "userCancellable" : false + }, + { + "name" : "ohos.permission.MEDIA_LOCATION", + "userCancellable" : false + }, + { + "name" : "ohos.permission.DISTRIBUTED_DATASYNC", + "userCancellable" : false + } + ] + }, + { + "bundleName": "com.ohos.filepicker", + "app_signature" : ["C902DDEE3286715B8BA26175A1EF967985D22AEF44BE747702B604D956A76CFA"], + "permissions" : [ + { + "name" : "ohos.permission.READ_MEDIA", + "userCancellable" : false + }, + { + "name" : "ohos.permission.WRITE_MEDIA", + "userCancellable" : false + }, + { + "name" : "ohos.permission.MEDIA_LOCATION", + "userCancellable" : false + } + ] + }, + { + "bundleName": "com.ohos.camera", + "app_signature" : ["62C298EE70BEEB3D58082FFEFFEAD4F26BE83350B46B75C393281BA6AAED2A91"], + "permissions" : [ + { + "name" : "ohos.permission.READ_IMAGEVIDEO", + "userCancellable" : false + }, + { + "name" : "ohos.permission.WRITE_IMAGEVIDEO", + "userCancellable" : false + }, + { + "name" : "ohos.permission.MEDIA_LOCATION", + "userCancellable" : false + }, + { + "name" : "ohos.permission.DISTRIBUTED_DATASYNC", + "userCancellable" : false + }, + { + "name" : "ohos.permission.CAMERA", + "userCancellable" : false + }, + { + "name" : "ohos.permission.MICROPHONE", + "userCancellable" : false + }, + { + "name" : "ohos.permission.LOCATION", + "userCancellable" : false + }, + { + "name" : "ohos.permission.LOCATION_IN_BACKGROUND", + "userCancellable" : false + }, + { + "name" : "ohos.permission.APPROXIMATELY_LOCATION", + "userCancellable" : false + } + ] + }, + { + "bundleName": "cn.openharmony.inputmethodchoosedialog", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "permissions" : [ + { + "name" : "ohos.permission.CONNECT_IME_ABILITY", + "userCancellable" : false + } + ] + }, + { + "bundleName": "com.huawei.ohos.hiviewx", + "app_signature" : ["57D4E9DFE7504D12EB6ACAF39876F420BCABCA2F4721989B90FD2E4F1FB7ED2B"], + "permissions" : [ + { + "name" : "ohos.permission.sec.ACCESS_UDID", + "userCancellable" : false + }, + { + "name" : "ohos.permission.GET_WIFI_INFO", + "userCancellable" : false + }, + { + "name" : "ohos.permission.GET_NETWORK_INFO", + "userCancellable" : false + }, + { + "name" : "ohos.permission.INTERNET", + "userCancellable" : false + }, + { + "name" : "ohos.permission.GET_BUNDLE_INFO_PRIVILEGED", + "userCancellable" : false + }, + { + "name" : "ohos.permission.READ_DFX_SYSEVENT", + "userCancellable" : false + } + ] + }, + { + "bundleName": "com.ohos.permissionmanager", + "app_signature" : ["68079CC9CB1BD69283D70790305645FFF61CD1E46CAFD7AA53B9FA8540432B81"], + "permissions" : [ + { + "name" : "ohos.permission.GET_INSTALLED_BUNDLE_LIST", + "userCancellable" : false + } + ] + }, + { + "bundleName": "com.ohos.dlpmanager", + "app_signature" : ["E3F4322139E0109BAFAD8DA4096762068E31708C3CF201780E736D377D60B639"], + "permissions" : [ + { + "name": "ohos.permission.READ_MEDIA", + "userCancellable" : false + }, + { + "name": "ohos.permission.WRITE_MEDIA", + "userCancellable" : false + }, + { + "name": "ohos.permission.ACCESS_DLP_FILE", + "userCancellable" : false + }, + { + "name": "ohos.permission.MANAGE_LOCAL_ACCOUNTS", + "userCancellable" : false + }, + { + "name":"ohos.permission.FILE_ACCESS_MANAGER", + "userCancellable" : false + }, + { + "name":"ohos.permission.START_ABILIIES_FROM_BACKGROUND", + "userCancellable" : false + }, + { + "name":"ohos.permission.GET_BUNDLE_INFO_PRIVILEGED", + "userCancellable" : false + }, + { + "name": "ohos.permission.MEDIA_LOCATION", + "userCancellable" : false + } + ] + }, + { + "bundleName": "com.ohos.useriam.authwidget", + "app_signature" : ["8E93863FC32EE238060BF69A9B37E2608FFFB21F93C862DD511CBAC9F30024B5"], + "permissions" : [ + { + "name" : "ohos.permission.ACCESS_PIN_AUTH", + "userCancellable" : false + }, + { + "name" : "ohos.permission.ACCESS_BIOMETRIC", + "userCancellable" : false + }, + { + "name" : "ohos.permission.SUPPORT_USER_AUTH", + "userCancellable" : false + } + ] + }, + { + "bundleName": "com.ohos.settings", + "app_signature" : ["EB5DBE52EE8DD7206DDE612E7484E88CE264E74958704D0712BFA774C87F4DA1"], + "permissions" : [ + { + "name" : "ohos.permission.GET_INSTALLED_BUNDLE_LIST", + "userCancellable" : false + } + ] + }, + { + "bundleName": "ohos.samples.browser1", + "app_signature" : ["208850C05E411A1EA7B1F26B4D5865208415D8D878D6CA42F9290BF6D6CA6D8A"], + "permissions" : [ + { + "name" : "ohos.permission.GET_INSTALLED_BUNDLE_LIST", + "userCancellable" : false + }, + { + "name": "ohos.permission.READ_MEDIA", + "userCancellable" : false + }, + { + "name": "ohos.permission.WRITE_MEDIA", + "userCancellable" : false + }, + { + "name": "ohos.permission.ACCESS_DLP_FILE", + "userCancellable" : false + }, + { + "name": "ohos.permission.MANAGE_LOCAL_ACCOUNTS", + "userCancellable" : false + }, + { + "name":"ohos.permission.FILE_ACCESS_MANAGER", + "userCancellable" : false + }, + { + "name":"ohos.permission.START_ABILIIES_FROM_BACKGROUND", + "userCancellable" : false + }, + { + "name":"ohos.permission.GET_BUNDLE_INFO_PRIVILEGED", + "userCancellable" : false + }, + { + "name": "ohos.permission.MEDIA_LOCATION", + "userCancellable" : false + } +] + } +] diff --git a/vendor_phytium/phytiumpi-firefly/preinstall-config/uninstall_list.json b/vendor_phytium/phytiumpi-firefly/preinstall-config/uninstall_list.json new file mode 100755 index 0000000000000000000000000000000000000000..0e0e7784a452341a6f996559c248e81323307a30 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/preinstall-config/uninstall_list.json @@ -0,0 +1,4 @@ +{ + "uninstall_list" : [], + "recover_list" : [] +} \ No newline at end of file diff --git a/vendor_phytium/phytiumpi-firefly/product.gni b/vendor_phytium/phytiumpi-firefly/product.gni new file mode 100755 index 0000000000000000000000000000000000000000..0c1ceed4740881b52ba8cd17e909ede9d0617505 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/product.gni @@ -0,0 +1,14 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//device/board/phytium/${device_name}/device.gni") diff --git a/vendor_phytium/phytiumpi-firefly/resourceschedule/BUILD.gn b/vendor_phytium/phytiumpi-firefly/resourceschedule/BUILD.gn new file mode 100755 index 0000000000000000000000000000000000000000..2495bb568da3082857881ef884b94084e1740d0e --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/resourceschedule/BUILD.gn @@ -0,0 +1,65 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. +# + +import("//build/ohos.gni") + +ohos_prebuilt_etc("res_sched_config") { + source = "./ressched/res_sched_config.xml" + install_enable = true + install_images = [ chipset_base_dir ] + module_install_dir = "etc/ressched" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("res_sched_plugin_switch") { + source = "./ressched/res_sched_plugin_switch.xml" + install_enable = true + install_images = [ chipset_base_dir ] + module_install_dir = "etc/ressched" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("cgroup_action_config") { + source = "./cgroup_sched/cgroup_action_config.json" + install_enable = true + install_images = [ chipset_base_dir ] + module_install_dir = "etc/cgroup_sched" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("socperf_boost_config") { + source = "./soc_perf/socperf_boost_config.xml" + install_enable = true + install_images = [ chipset_base_dir ] + module_install_dir = "etc/soc_perf" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("socperf_resource_config") { + source = "./soc_perf/socperf_resource_config.xml" + install_enable = true + install_images = [ chipset_base_dir ] + module_install_dir = "etc/soc_perf" + part_name = "product_${device_name}" +} + +group("resourceschedule") { + deps = [ + ":cgroup_action_config", + ":res_sched_config", + ":res_sched_plugin_switch", + ":socperf_boost_config", + ":socperf_resource_config", + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/resourceschedule/cgroup_sched/cgroup_action_config.json b/vendor_phytium/phytiumpi-firefly/resourceschedule/cgroup_sched/cgroup_action_config.json new file mode 100755 index 0000000000000000000000000000000000000000..62881f345656076f433deac4873b8eb832b5718d --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/resourceschedule/cgroup_sched/cgroup_action_config.json @@ -0,0 +1,26 @@ +{ + "Cgroups": [ + { + "controller": "cpu", + "path": "/dev/cpuctl", + "sched_policy": { + "sp_default": "", + "sp_background": "background", + "sp_foreground": "foreground", + "sp_system_background": "system-background", + "sp_top_app": "top-app" + } + }, + { + "controller": "cpuset", + "path": "/dev/cpuset", + "sched_policy": { + "sp_default": "", + "sp_background": "background", + "sp_foreground": "foreground", + "sp_system_background": "system-background", + "sp_top_app": "top-app" + } + } + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/resourceschedule/ressched/res_sched_config.xml b/vendor_phytium/phytiumpi-firefly/resourceschedule/ressched/res_sched_config.xml new file mode 100755 index 0000000000000000000000000000000000000000..0a86a8914d0ca84da81cbb5e9d9db3efb26e106d --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/resourceschedule/ressched/res_sched_config.xml @@ -0,0 +1,17 @@ + + + + diff --git a/vendor_phytium/phytiumpi-firefly/resourceschedule/ressched/res_sched_plugin_switch.xml b/vendor_phytium/phytiumpi-firefly/resourceschedule/ressched/res_sched_plugin_switch.xml new file mode 100755 index 0000000000000000000000000000000000000000..8a534ad80331762c6a2e7d4ec2fd65b01311a280 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/resourceschedule/ressched/res_sched_plugin_switch.xml @@ -0,0 +1,20 @@ + + + + + + + diff --git a/vendor_phytium/phytiumpi-firefly/resourceschedule/soc_perf/socperf_boost_config.xml b/vendor_phytium/phytiumpi-firefly/resourceschedule/soc_perf/socperf_boost_config.xml new file mode 100755 index 0000000000000000000000000000000000000000..8250df95569193d81d5d748e478893cc4338b419 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/resourceschedule/soc_perf/socperf_boost_config.xml @@ -0,0 +1,84 @@ + + + + + + 1500 + 1992000 + + + + + 400 + 1800000 + + + + + 400 + 1608000 + + + + + 250 + 1992000 + + + + + 300 + 1608000 + + + + + 5000 + 1992000 + + + + + 5000 + 1992000 + + + + + 100 + 1608000 + + + + + 200 + 1416000 + + + + + 800 + 1992000 + 800000000 + + + + + 400 + 1608000 + + + diff --git a/vendor_phytium/phytiumpi-firefly/resourceschedule/soc_perf/socperf_resource_config.xml b/vendor_phytium/phytiumpi-firefly/resourceschedule/soc_perf/socperf_resource_config.xml new file mode 100755 index 0000000000000000000000000000000000000000..f64f74c288a5dff461cd679132b1491d5e0104b3 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/resourceschedule/soc_perf/socperf_resource_config.xml @@ -0,0 +1,39 @@ + + + + + + 408000 + /sys/devices/system/cpu/cpufreq/policy0/scaling_min_freq + 408000 600000 816000 1104000 1416000 1608000 1800000 1992000 + + + 1992000 + /sys/devices/system/cpu/cpufreq/policy0/scaling_max_freq + 408000 600000 816000 1104000 1416000 1608000 1800000 1992000 + + + 200000000 + /sys/class/devfreq/fde60000.gpu/min_freq + 200000000 300000000 400000000 600000000 700000000 800000000 + + + 800000000 + /sys/class/devfreq/fde60000.gpu/max_freq + 200000000 300000000 400000000 600000000 700000000 800000000 + + + diff --git a/vendor_phytium/phytiumpi-firefly/window_config/BUILD.gn b/vendor_phytium/phytiumpi-firefly/window_config/BUILD.gn new file mode 100755 index 0000000000000000000000000000000000000000..5a5f55e616eb126d772c2f5068cba90eae8254f1 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/window_config/BUILD.gn @@ -0,0 +1,35 @@ +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. +# Licensed under the Apache License, Version 2.0 (the "License"); +# you may not use this file except in compliance with the License. +# You may obtain a copy of the License at +# +# http://www.apache.org/licenses/LICENSE-2.0 +# +# Unless required by applicable law or agreed to in writing, software +# distributed under the License is distributed on an "AS IS" BASIS, +# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +# See the License for the specific language governing permissions and +# limitations under the License. + +import("//build/ohos.gni") + +ohos_prebuilt_etc("window_manager_config") { + source = "window_manager_config.xml" + install_enable = true + relative_install_dir = "window/resources" + part_name = "product_${device_name}" +} + +ohos_prebuilt_etc("display_manager_config") { + source = "display_manager_config.xml" + install_enable = true + relative_install_dir = "window/resources" + part_name = "product_${device_name}" +} + +group("window_config") { + deps = [ + ":display_manager_config", + ":window_manager_config", + ] +} diff --git a/vendor_phytium/phytiumpi-firefly/window_config/display_manager_config.xml b/vendor_phytium/phytiumpi-firefly/window_config/display_manager_config.xml new file mode 100755 index 0000000000000000000000000000000000000000..b9f7c283399a4199b3d19abd3f6e73a09595eaba --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/window_config/display_manager_config.xml @@ -0,0 +1,57 @@ + + + + + 240 + + + 0 + + + + + + + + + + 0 0 0 0 + + + + + + + + + + + + + + + + + + + 0 + + + + + + 0 + diff --git a/vendor_phytium/phytiumpi-firefly/window_config/window_manager_config.xml b/vendor_phytium/phytiumpi-firefly/window_config/window_manager_config.xml new file mode 100755 index 0000000000000000000000000000000000000000..55c2bc32b5af387298c0fc26b6a450f71ed69936 --- /dev/null +++ b/vendor_phytium/phytiumpi-firefly/window_config/window_manager_config.xml @@ -0,0 +1,121 @@ + + + + + + + floating fullscreen + + + 100 + + + + 50 50 50 + + + + 0.1 0.9 + + 0.5 0.33 0.67 + + 1 + + + + + 350 + + + + + 0.7 0.7 + + 0 0 1 0 + + 0 0 + + 0 + + + + + + + + 150 + + 0.2 0.0 0.2 1.0 + + + + + + + 150 + + 0.2 0.0 0.2 1.0 + + + + + + + + 200 + + + + + 1 + + 0 + + + + + + + + + + off + off + off + + + + 0 + #000000 + 0 + 0 + 0 + + + 0 + #000000 + 0 + 0 + 0 + + + + + diff --git a/vendor_phytium/tenglong_e/etc/BUILD.gn b/vendor_phytium/tenglong_e/etc/BUILD.gn index cd296b8861a839ccae2aebe07a91cd12a7d4e4a3..836ac7d528e95e9af458b1e13b3c884d790be06d 100755 --- a/vendor_phytium/tenglong_e/etc/BUILD.gn +++ b/vendor_phytium/tenglong_e/etc/BUILD.gn @@ -27,9 +27,29 @@ ohos_prebuilt_etc("para_for_sys_prod") { part_name = "product_${device_name}" } +ohos_prebuilt_etc("multi_gpu_json") { + source = "./multi_gpu.json" + part_name = "product_${device_name}" + install_images = [ + "system", + ] + install_enable = true +} + +ohos_prebuilt_etc("gpu_cur") { + source = "./gpu_cur" + part_name = "product_${device_name}" + install_images = [ + "system", + ] + install_enable = true +} + group("product_etc_conf") { deps = [ ":para_for_chip_prod", ":para_for_sys_prod", + ":multi_gpu_json", + ":gpu_cur", ] } diff --git a/vendor_phytium/tenglong_e/etc/gpu_cur b/vendor_phytium/tenglong_e/etc/gpu_cur new file mode 100755 index 0000000000000000000000000000000000000000..70b0405c30d1eef6d8bf10a3d5dd9e51eb74d34e --- /dev/null +++ b/vendor_phytium/tenglong_e/etc/gpu_cur @@ -0,0 +1 @@ +/vendor/lib64/chipsetsdk/x100/ diff --git a/vendor_phytium/tenglong_e/etc/multi_gpu.json b/vendor_phytium/tenglong_e/etc/multi_gpu.json new file mode 100755 index 0000000000000000000000000000000000000000..d377e712a72a753a4c7cdf86e2f82350ac9bbe91 --- /dev/null +++ b/vendor_phytium/tenglong_e/etc/multi_gpu.json @@ -0,0 +1,9 @@ +{ + "pe220x": "/vendor/lib64/chipsetsdk/x100/", + "dc": "/vendor/lib64/chipsetsdk/x100/", + "pvr": "/vendor/lib64/chipsetsdk/x100/", + "radeonsi": "/vendor/lib64/chipsetsdk/amd/", + "amdgpu": "/vendor/lib64/chipsetsdk/amd/", + "mwv207": "/vendor/lib64/chipsetsdk/jm/", + "sw": "/vendor/lib64/chipsetsdk/sw/" +} \ No newline at end of file diff --git a/vendor_phytium/tenglong_e/hals/audio/BUILD.gn b/vendor_phytium/tenglong_e/hals/audio/BUILD.gn index daa90b0a19927383ba17b78b8601703a2c2349e8..391f7f4db896d0ad7fb88c7017cc17a9332b3797 100755 --- a/vendor_phytium/tenglong_e/hals/audio/BUILD.gn +++ b/vendor_phytium/tenglong_e/hals/audio/BUILD.gn @@ -1,4 +1,4 @@ -# Copyright (C) 2023 Phytium Open Source Organization . +# Copyright (C) 2024 Phytium Open Source Organization . # Licensed under the Apache License, Version 2.0 (the "License"); # you may not use this file except in compliance with the License. # You may obtain a copy of the License at diff --git a/vendor_phytium/tenglong_e/hals/audio/alsa_adapter.json b/vendor_phytium/tenglong_e/hals/audio/alsa_adapter.json index 9e33f16471a6796a24ecd6d488cde54e63a9015d..c011eb2fdbe1fe774930f7a9b57b7ff1bb81a70e 100755 --- a/vendor_phytium/tenglong_e/hals/audio/alsa_adapter.json +++ b/vendor_phytium/tenglong_e/hals/audio/alsa_adapter.json @@ -1,8 +1,8 @@ { "adapters": [{ "name": "primary", - "cardId": 0, - "cardName": "fthda" + "cardId": 1, + "cardName": "phytiumpe220xi2" } ] } diff --git a/vendor_phytium/tenglong_e/hals/audio/config/audio_policy_config.xml b/vendor_phytium/tenglong_e/hals/audio/config/audio_policy_config.xml index b1668570e6c15b142ba5b63870a1c4bd3bbc84b2..3b7f7830bf48b1d4ff19ce3439706182d8055530 100755 --- a/vendor_phytium/tenglong_e/hals/audio/config/audio_policy_config.xml +++ b/vendor_phytium/tenglong_e/hals/audio/config/audio_policy_config.xml @@ -1,6 +1,5 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - true - false - 90 - + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + - - + + - - + + - - + + - + + + + + + + + + + + + + + + + + + + + + + diff --git a/vendor_phytium/tenglong_e/hals/audio/product.gni b/vendor_phytium/tenglong_e/hals/audio/product.gni index 86dba9c8ee29837173acdfdffb560dbe8dc624c7..9138d69e45856fbcb3f6c63fed369f5d280d69f4 100755 --- a/vendor_phytium/tenglong_e/hals/audio/product.gni +++ b/vendor_phytium/tenglong_e/hals/audio/product.gni @@ -1,4 +1,4 @@ -# Copyright (c) 2023 Phytium Technology Co., Ltd. All rights reserved. +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. # Licensed under the Apache License, Version 2.0 (the "License"); # you may not use this file except in compliance with the License. # You may obtain a copy of the License at diff --git a/vendor_phytium/tenglong_e/hdf_config/uhdf/BUILD.gn b/vendor_phytium/tenglong_e/hdf_config/uhdf/BUILD.gn index 1dd123a066e31dc21d79142044d7bcf193d3131b..f3f1c8a6db202116f46cc2e76b129099658ec162 100755 --- a/vendor_phytium/tenglong_e/hdf_config/uhdf/BUILD.gn +++ b/vendor_phytium/tenglong_e/hdf_config/uhdf/BUILD.gn @@ -13,11 +13,11 @@ import("//drivers/hdf_core/adapter/uhdf2/hcs/hcs.gni") -check_path = "//vendor/phytium/gpu_model/${gpu_model}/uhdf/hdf.hcs" +check_path = "//vendor/phytium/gpu_model/x100/uhdf/hdf.hcs" test_result = exec_script(rebase_path("//build/scripts/check_file_exist.py"),[ rebase_path("${check_path}") ],"string") if (test_result != "") { - hdf_hcs_source = "//vendor/phytium/gpu_model/${gpu_model}/uhdf/hdf.hcs" + hdf_hcs_source = "//vendor/phytium/gpu_model/x100/uhdf/hdf.hcs" } else { hdf_hcs_source = "./hdf.hcs" diff --git a/vendor_phytium/tenglong_e/preinstall-config/BUILD.gn b/vendor_phytium/tenglong_e/preinstall-config/BUILD.gn index 01d645fd68afb8858321f6f8581de5972dd5dd23..6015aa1be84f74a71bb84f404fd6c6bbfa25c6de 100755 --- a/vendor_phytium/tenglong_e/preinstall-config/BUILD.gn +++ b/vendor_phytium/tenglong_e/preinstall-config/BUILD.gn @@ -10,6 +10,7 @@ # WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. # See the License for the specific language governing permissions and # limitations under the License. +# import("//build/ohos.gni") diff --git a/vendor_phytium/tenglong_e/preinstall-config/install_list.json b/vendor_phytium/tenglong_e/preinstall-config/install_list.json index 165920a15940cfde4751f49df89daa28a7c55d5a..bcd127ac0b07f91eb4a711e5a0bbc2b84d04cdcf 100755 --- a/vendor_phytium/tenglong_e/preinstall-config/install_list.json +++ b/vendor_phytium/tenglong_e/preinstall-config/install_list.json @@ -195,6 +195,10 @@ { "app_dir": "/system/app/com.ohos.calendardata", "removable": false + }, + { + "app_dir": "/system/app/ohos.samples.browser1", + "removable": false } ] } diff --git a/vendor_phytium/tenglong_e/preinstall-config/install_list_capability.json b/vendor_phytium/tenglong_e/preinstall-config/install_list_capability.json index 388a0da150a07564f6bed784d96065089416257b..b75b2043640ba1a626029b53404b595f05dd5989 100755 --- a/vendor_phytium/tenglong_e/preinstall-config/install_list_capability.json +++ b/vendor_phytium/tenglong_e/preinstall-config/install_list_capability.json @@ -209,6 +209,12 @@ "app_signature" : ["1C6905C65DE22F5160790D34ADA462EE9ED3D9EEAA4FCBD4FEC7FFEE7D1D4FD2"], "allowAppDesktopIconHide": true, "allowAppUsePrivilegeExtension": true + }, + { + "bundleName": "ohos.samples.browser1", + "app_signature": ["208850C05E411A1EA7B1F26B4D5865208415D8D878D6CA42F9290BF6D6CA6D8A"], + "allowAppUsePrivilegeExtension": true, + "allowAppDesktopIconHide": false } ] } diff --git a/vendor_phytium/tenglong_e/preinstall-config/install_list_permissions.json b/vendor_phytium/tenglong_e/preinstall-config/install_list_permissions.json index bc487ce8c78efad9aa9ec4c2f4dae33c80d48528..f04487fad738142b71b9d9270d05f71ff78fccce 100755 --- a/vendor_phytium/tenglong_e/preinstall-config/install_list_permissions.json +++ b/vendor_phytium/tenglong_e/preinstall-config/install_list_permissions.json @@ -316,5 +316,47 @@ "userCancellable" : false } ] + }, + { + "bundleName": "ohos.samples.browser1", + "app_signature" : ["208850C05E411A1EA7B1F26B4D5865208415D8D878D6CA42F9290BF6D6CA6D8A"], + "permissions" : [ + { + "name" : "ohos.permission.GET_INSTALLED_BUNDLE_LIST", + "userCancellable" : false + }, + { + "name": "ohos.permission.READ_MEDIA", + "userCancellable" : false + }, + { + "name": "ohos.permission.WRITE_MEDIA", + "userCancellable" : false + }, + { + "name": "ohos.permission.ACCESS_DLP_FILE", + "userCancellable" : false + }, + { + "name": "ohos.permission.MANAGE_LOCAL_ACCOUNTS", + "userCancellable" : false + }, + { + "name":"ohos.permission.FILE_ACCESS_MANAGER", + "userCancellable" : false + }, + { + "name":"ohos.permission.START_ABILIIES_FROM_BACKGROUND", + "userCancellable" : false + }, + { + "name":"ohos.permission.GET_BUNDLE_INFO_PRIVILEGED", + "userCancellable" : false + }, + { + "name": "ohos.permission.MEDIA_LOCATION", + "userCancellable" : false + } +] } ] diff --git a/vendor_phytium/tenglong_e/product.gni b/vendor_phytium/tenglong_e/product.gni index b8817f1f581d895a1c50a979b8b08c0ec769c8b2..0c1ceed4740881b52ba8cd17e909ede9d0617505 100755 --- a/vendor_phytium/tenglong_e/product.gni +++ b/vendor_phytium/tenglong_e/product.gni @@ -1,4 +1,4 @@ -# Copyright (c) 2022 Phytium Technology Co., Ltd. All rights reserved. +# Copyright (c) 2024 Phytium Technology Co., Ltd. All rights reserved. # Licensed under the Apache License, Version 2.0 (the "License"); # you may not use this file except in compliance with the License. # You may obtain a copy of the License at diff --git a/vendor_phytium/tenglong_e/resourceschedule/BUILD.gn b/vendor_phytium/tenglong_e/resourceschedule/BUILD.gn index 10887e3b97df72a111cd82621ffedbc22a8f0d7e..2495bb568da3082857881ef884b94084e1740d0e 100755 --- a/vendor_phytium/tenglong_e/resourceschedule/BUILD.gn +++ b/vendor_phytium/tenglong_e/resourceschedule/BUILD.gn @@ -10,6 +10,7 @@ # WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. # See the License for the specific language governing permissions and # limitations under the License. +# import("//build/ohos.gni") diff --git a/vendor_phytium/tengrui_d/etc/BUILD.gn b/vendor_phytium/tengrui_d/etc/BUILD.gn index cd296b8861a839ccae2aebe07a91cd12a7d4e4a3..836ac7d528e95e9af458b1e13b3c884d790be06d 100644 --- a/vendor_phytium/tengrui_d/etc/BUILD.gn +++ b/vendor_phytium/tengrui_d/etc/BUILD.gn @@ -27,9 +27,29 @@ ohos_prebuilt_etc("para_for_sys_prod") { part_name = "product_${device_name}" } +ohos_prebuilt_etc("multi_gpu_json") { + source = "./multi_gpu.json" + part_name = "product_${device_name}" + install_images = [ + "system", + ] + install_enable = true +} + +ohos_prebuilt_etc("gpu_cur") { + source = "./gpu_cur" + part_name = "product_${device_name}" + install_images = [ + "system", + ] + install_enable = true +} + group("product_etc_conf") { deps = [ ":para_for_chip_prod", ":para_for_sys_prod", + ":multi_gpu_json", + ":gpu_cur", ] } diff --git a/vendor_phytium/tengrui_d/etc/gpu_cur b/vendor_phytium/tengrui_d/etc/gpu_cur new file mode 100755 index 0000000000000000000000000000000000000000..70b0405c30d1eef6d8bf10a3d5dd9e51eb74d34e --- /dev/null +++ b/vendor_phytium/tengrui_d/etc/gpu_cur @@ -0,0 +1 @@ +/vendor/lib64/chipsetsdk/x100/ diff --git a/vendor_phytium/tengrui_d/etc/multi_gpu.json b/vendor_phytium/tengrui_d/etc/multi_gpu.json new file mode 100755 index 0000000000000000000000000000000000000000..d377e712a72a753a4c7cdf86e2f82350ac9bbe91 --- /dev/null +++ b/vendor_phytium/tengrui_d/etc/multi_gpu.json @@ -0,0 +1,9 @@ +{ + "pe220x": "/vendor/lib64/chipsetsdk/x100/", + "dc": "/vendor/lib64/chipsetsdk/x100/", + "pvr": "/vendor/lib64/chipsetsdk/x100/", + "radeonsi": "/vendor/lib64/chipsetsdk/amd/", + "amdgpu": "/vendor/lib64/chipsetsdk/amd/", + "mwv207": "/vendor/lib64/chipsetsdk/jm/", + "sw": "/vendor/lib64/chipsetsdk/sw/" +} \ No newline at end of file diff --git a/vendor_phytium/tengrui_d/hals/audio/config/audio_policy_config.xml b/vendor_phytium/tengrui_d/hals/audio/config/audio_policy_config.xml index b1668570e6c15b142ba5b63870a1c4bd3bbc84b2..3b7f7830bf48b1d4ff19ce3439706182d8055530 100644 --- a/vendor_phytium/tengrui_d/hals/audio/config/audio_policy_config.xml +++ b/vendor_phytium/tengrui_d/hals/audio/config/audio_policy_config.xml @@ -1,6 +1,5 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - true - false - 90 - + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + - - + + - - + + - - + + - + + + + + + + + + + + + + + + + + + + + + + diff --git a/vendor_phytium/tengrui_d/hdf_config/uhdf/BUILD.gn b/vendor_phytium/tengrui_d/hdf_config/uhdf/BUILD.gn index 1dd123a066e31dc21d79142044d7bcf193d3131b..f3f1c8a6db202116f46cc2e76b129099658ec162 100644 --- a/vendor_phytium/tengrui_d/hdf_config/uhdf/BUILD.gn +++ b/vendor_phytium/tengrui_d/hdf_config/uhdf/BUILD.gn @@ -13,11 +13,11 @@ import("//drivers/hdf_core/adapter/uhdf2/hcs/hcs.gni") -check_path = "//vendor/phytium/gpu_model/${gpu_model}/uhdf/hdf.hcs" +check_path = "//vendor/phytium/gpu_model/x100/uhdf/hdf.hcs" test_result = exec_script(rebase_path("//build/scripts/check_file_exist.py"),[ rebase_path("${check_path}") ],"string") if (test_result != "") { - hdf_hcs_source = "//vendor/phytium/gpu_model/${gpu_model}/uhdf/hdf.hcs" + hdf_hcs_source = "//vendor/phytium/gpu_model/x100/uhdf/hdf.hcs" } else { hdf_hcs_source = "./hdf.hcs"